diff --git a/kernel/tools/cpupowertools/files/patches/linux/patch-4.14.23.xz b/kernel/tools/cpupowertools/files/patches/linux/patch-4.14.23.xz new file mode 100644 index 00000000..7a2aa72a Binary files /dev/null and b/kernel/tools/cpupowertools/files/patches/linux/patch-4.14.23.xz differ diff --git a/kernel/tools/cpupowertools/files/patches/mageia/3rd-3rdparty-merge.patch b/kernel/tools/cpupowertools/files/patches/mageia/3rd-3rdparty-merge.patch index 72c6c8b0..35bab76a 100644 --- a/kernel/tools/cpupowertools/files/patches/mageia/3rd-3rdparty-merge.patch +++ b/kernel/tools/cpupowertools/files/patches/mageia/3rd-3rdparty-merge.patch @@ -83,10 +83,10 @@ diff -Nurp linux-4.2.2/Makefile linux-4.2.2-3rd/Makefile net-y := net/ libs-y := lib/ core-y := usr/ -diff -Nurp linux-4.9/scripts/kconfig/Makefile linux-4.9-3rd/scripts/kconfig/Makefile ---- linux-4.9/scripts/kconfig/Makefile -+++ linux-4.9-3rd/scripts/kconfig/Makefile -@@ -18,28 +18,28 @@ endif +diff -Nurp linux-4.14/scripts/kconfig/Makefile linux-4.14-3rd/scripts/kconfig/Makefile +--- linux-4.14/scripts/kconfig/Makefile ++++ linux-4.14-3rd/scripts/kconfig/Makefile +@@ -19,28 +19,28 @@ endif # We need this, in case the user has it in its environment unexport CONFIG_ @@ -122,7 +122,7 @@ diff -Nurp linux-4.9/scripts/kconfig/Makefile linux-4.9-3rd/scripts/kconfig/Make $(Q)mkdir -p include/config include/generated $(Q)perl $< --$@ $(srctree) $(Kconfig) > .tmp.config $(Q)if [ -f .config ]; then \ -@@ -82,7 +82,7 @@ simple-targets := oldconfig allnoconfig +@@ -83,7 +83,7 @@ simple-targets := oldconfig allnoconfig alldefconfig randconfig listnewconfig olddefconfig PHONY += $(simple-targets) @@ -131,7 +131,7 @@ diff -Nurp linux-4.9/scripts/kconfig/Makefile linux-4.9-3rd/scripts/kconfig/Make $< $(silent) --$@ $(Kconfig) PHONY += oldnoconfig savedefconfig defconfig -@@ -90,12 +90,12 @@ PHONY += oldnoconfig savedefconfig defco +@@ -91,12 +91,12 @@ PHONY += oldnoconfig savedefconfig defco # oldnoconfig is an alias of olddefconfig, because people already are dependent # on its behavior (sets new symbols to their default value but not 'n') with the # counter-intuitive name. @@ -147,7 +147,7 @@ diff -Nurp linux-4.9/scripts/kconfig/Makefile linux-4.9-3rd/scripts/kconfig/Make ifeq ($(KBUILD_DEFCONFIG),) $< $(silent) --defconfig $(Kconfig) else -@@ -108,26 +108,26 @@ else +@@ -109,26 +109,26 @@ else endif endif @@ -179,7 +179,7 @@ diff -Nurp linux-4.9/scripts/kconfig/Makefile linux-4.9-3rd/scripts/kconfig/Make $(Q)$(MAKE) -f $(srctree)/Makefile allnoconfig tiny.config # Help text used by make help -@@ -190,6 +190,9 @@ gconf-objs := gconf.o zconf.tab.o +@@ -191,6 +191,9 @@ gconf-objs := gconf.o zconf.tab.o hostprogs-y := conf nconf mconf kxgettext qconf gconf @@ -187,5 +187,5 @@ diff -Nurp linux-4.9/scripts/kconfig/Makefile linux-4.9-3rd/scripts/kconfig/Make + pushd $(srctree)/3rdparty ; $(PERL) ./mkbuild.pl ; popd + clean-files := qconf.moc .tmp_qtcheck .tmp_gtkcheck - clean-files += zconf.tab.c zconf.lex.c zconf.hash.c gconf.glade.h + clean-files += zconf.tab.c zconf.lex.c gconf.glade.h clean-files += config.pot linux.pot diff --git a/kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-1.60.patch b/kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-1.61.patch similarity index 98% rename from kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-1.60.patch rename to kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-1.61.patch index b328f41a..dea2842c 100644 --- a/kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-1.60.patch +++ b/kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-1.61.patch @@ -1,6 +1,6 @@ -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/crt.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/crt.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/crt.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/crt.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/crt.c linux-4.12.4-3rd/3rdparty/ndiswrapper/crt.c +--- linux-4.12.4/3rdparty/ndiswrapper/crt.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/crt.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,589 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -591,9 +591,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/crt.c linux-4.6-rc6-ndis/3rdparty/ + printk(KERN_DEBUG "%s: %p: %s\n", ctx, from, buf); + kfree(buf); +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/divdi3.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/divdi3.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/divdi3.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/divdi3.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/divdi3.c linux-4.12.4-3rd/3rdparty/ndiswrapper/divdi3.c +--- linux-4.12.4/3rdparty/ndiswrapper/divdi3.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/divdi3.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,329 @@ +/* 64-bit multiplication and division + Copyright (C) 1989, 1992-1999, 2000, 2001, 2002, 2003 @@ -924,9 +924,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/divdi3.c linux-4.6-rc6-ndis/3rdpar + __udivmoddi4 (u, v, &w); + return w; +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/hal.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/hal.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/hal.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/hal.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/hal.c linux-4.12.4-3rd/3rdparty/ndiswrapper/hal.c +--- linux-4.12.4/3rdparty/ndiswrapper/hal.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/hal.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,157 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -1085,9 +1085,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/hal.c linux-4.6-rc6-ndis/3rdparty/ +#endif + nt_spin_unlock(lock); +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/iw_ndis.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/iw_ndis.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/iw_ndis.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/iw_ndis.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/iw_ndis.c linux-4.12.4-3rd/3rdparty/ndiswrapper/iw_ndis.c +--- linux-4.12.4/3rdparty/ndiswrapper/iw_ndis.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/iw_ndis.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,2001 @@ + /* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -3090,9 +3090,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/iw_ndis.c linux-4.6-rc6-ndis/3rdpa +}; + +#endif -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/iw_ndis.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/iw_ndis.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/iw_ndis.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/iw_ndis.h 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/iw_ndis.h linux-4.12.4-3rd/3rdparty/ndiswrapper/iw_ndis.h +--- linux-4.12.4/3rdparty/ndiswrapper/iw_ndis.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/iw_ndis.h 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,194 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -3288,9 +3288,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/iw_ndis.h linux-4.6-rc6-ndis/3rdpa + KEY_MGMT_802_1X_NO_WPA, KEY_MGMT_WPA_NONE }; + +#endif // IW_NDIS_H -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/lin2win.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/lin2win.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/lin2win.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/lin2win.h 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/lin2win.h linux-4.12.4-3rd/3rdparty/ndiswrapper/lin2win.h +--- linux-4.12.4/3rdparty/ndiswrapper/lin2win.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/lin2win.h 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,111 @@ +/* + * Copyright (C) 2006 Giridhar Pemmasani @@ -3403,9 +3403,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/lin2win.h linux-4.6-rc6-ndis/3rdpa +}) + +#endif // CONFIG_X86_64 -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/lin2win.S linux-4.6-rc6-ndis/3rdparty/ndiswrapper/lin2win.S ---- linux-4.6-rc6/3rdparty/ndiswrapper/lin2win.S 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/lin2win.S 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/lin2win.S linux-4.12.4-3rd/3rdparty/ndiswrapper/lin2win.S +--- linux-4.12.4/3rdparty/ndiswrapper/lin2win.S 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/lin2win.S 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,138 @@ +/* + * Copyright (C) 2011 Pavel Roskin @@ -3545,9 +3545,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/lin2win.S linux-4.6-rc6-ndis/3rdpa +lin2win lin2win4, 4 +lin2win lin2win5, 5 +lin2win lin2win6, 6 -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/loader.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/loader.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/loader.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/loader.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/loader.c linux-4.12.4-3rd/3rdparty/ndiswrapper/loader.c +--- linux-4.12.4/3rdparty/ndiswrapper/loader.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/loader.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,967 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -4516,10 +4516,10 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/loader.c linux-4.6-rc6-ndis/3rdpar + mutex_unlock(&loader_mutex); + EXIT1(return); +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/loader.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/loader.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/loader.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/loader.h 2016-05-01 18:25:43.000000000 +0300 -@@ -0,0 +1,112 @@ +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/loader.h linux-4.12.4-3rd/3rdparty/ndiswrapper/loader.h +--- linux-4.12.4/3rdparty/ndiswrapper/loader.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/loader.h 2016-10-09 18:45:08.027226096 +0300 +@@ -0,0 +1,108 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani + * @@ -4538,10 +4538,6 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/loader.h linux-4.6-rc6-ndis/3rdpar +#ifndef _LOADER_H_ +#define _LOADER_H_ + -+#if LINUX_VERSION_CODE > KERNEL_VERSION(4,0,0) -+#include -+#endif -+ +#include "ndiswrapper.h" + +#ifndef __KERNEL__ @@ -4632,9 +4628,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/loader.h linux-4.6-rc6-ndis/3rdpar +#endif + +#endif /* LOADER_H */ -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/longlong.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/longlong.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/longlong.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/longlong.h 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/longlong.h linux-4.12.4-3rd/3rdparty/ndiswrapper/longlong.h +--- linux-4.12.4/3rdparty/ndiswrapper/longlong.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/longlong.h 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,1333 @@ +/* longlong.h -- definitions for mixed size 32/64 bit arithmetic. + Copyright (C) 1991, 1992, 1994, 1995, 1996, 1997, 1998, 1999, 2000 @@ -5969,9 +5965,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/longlong.h linux-4.6-rc6-ndis/3rdp +#ifndef UDIV_NEEDS_NORMALIZATION +#define UDIV_NEEDS_NORMALIZATION 0 +#endif -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/Makefile linux-4.6-rc6-ndis/3rdparty/ndiswrapper/Makefile ---- linux-4.6-rc6/3rdparty/ndiswrapper/Makefile 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/Makefile 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/Makefile linux-4.12.4-3rd/3rdparty/ndiswrapper/Makefile +--- linux-4.12.4/3rdparty/ndiswrapper/Makefile 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/Makefile 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,213 @@ +# Name of the module +MODNAME = ndiswrapper @@ -6186,9 +6182,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/Makefile linux-4.6-rc6-ndis/3rdpar + done + +.PHONY: all modules clean install config_check dist -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/mkexport.sh linux-4.6-rc6-ndis/3rdparty/ndiswrapper/mkexport.sh ---- linux-4.6-rc6/3rdparty/ndiswrapper/mkexport.sh 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/mkexport.sh 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/mkexport.sh linux-4.12.4-3rd/3rdparty/ndiswrapper/mkexport.sh +--- linux-4.12.4/3rdparty/ndiswrapper/mkexport.sh 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/mkexport.sh 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,42 @@ +#! /bin/sh + @@ -6232,9 +6228,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/mkexport.sh linux-4.6-rc6-ndis/3rd + +echo " {NULL, NULL}" +echo "};" -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/mkstubs.sh linux-4.6-rc6-ndis/3rdparty/ndiswrapper/mkstubs.sh ---- linux-4.6-rc6/3rdparty/ndiswrapper/mkstubs.sh 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/mkstubs.sh 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/mkstubs.sh linux-4.12.4-3rd/3rdparty/ndiswrapper/mkstubs.sh +--- linux-4.12.4/3rdparty/ndiswrapper/mkstubs.sh 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/mkstubs.sh 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,12 @@ +#! /bin/sh + @@ -6248,9 +6244,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/mkstubs.sh linux-4.6-rc6-ndis/3rdp + win2lin(\1, \2)/p' \ + $file | sed -e 's/[ \t ]\+//' | sort -u; \ +done -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ndis.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/ndis.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/ndis.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/ndis.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/ndis.c linux-4.12.4-3rd/3rdparty/ndiswrapper/ndis.c +--- linux-4.12.4/3rdparty/ndiswrapper/ndis.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/ndis.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,3025 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -9277,9 +9273,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ndis.c linux-4.6-rc6-ndis/3rdparty + destroy_workqueue(ndis_wq); + EXIT1(return); +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ndis.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/ndis.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/ndis.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/ndis.h 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/ndis.h linux-4.12.4-3rd/3rdparty/ndiswrapper/ndis.h +--- linux-4.12.4/3rdparty/ndiswrapper/ndis.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/ndis.h 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,1309 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -10590,9 +10586,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ndis.h linux-4.6-rc6-ndis/3rdparty +} + +#endif /* NDIS_H */ -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ndiswrapper.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/ndiswrapper.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/ndiswrapper.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/ndiswrapper.h 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/ndiswrapper.h linux-4.12.4-3rd/3rdparty/ndiswrapper/ndiswrapper.h +--- linux-4.12.4/3rdparty/ndiswrapper/ndiswrapper.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/ndiswrapper.h 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,219 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -10612,7 +10608,7 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ndiswrapper.h linux-4.6-rc6-ndis/3 +#ifndef _NDISWRAPPER_H_ +#define _NDISWRAPPER_H_ + -+#define DRIVER_VERSION "1.60" ++#define DRIVER_VERSION "1.61" +#define UTILS_VERSION "1.9" + +#define DRIVER_NAME "ndiswrapper" @@ -10813,9 +10809,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ndiswrapper.h linux-4.6-rc6-ndis/3 +#endif // __KERNEL__ + +#endif // NDISWRAPPER_H -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ntoskernel.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/ntoskernel.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/ntoskernel.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/ntoskernel.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/ntoskernel.c linux-4.12.4-3rd/3rdparty/ndiswrapper/ntoskernel.c +--- linux-4.12.4/3rdparty/ndiswrapper/ntoskernel.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/ntoskernel.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,2677 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -13494,10 +13490,10 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ntoskernel.c linux-4.6-rc6-ndis/3r + + EXIT2(return); +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ntoskernel.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/ntoskernel.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/ntoskernel.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/ntoskernel.h 2016-05-01 18:25:43.000000000 +0300 -@@ -0,0 +1,1090 @@ +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/ntoskernel.h linux-4.12.4-3rd/3rdparty/ndiswrapper/ntoskernel.h +--- linux-4.12.4/3rdparty/ndiswrapper/ntoskernel.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/ntoskernel.h 2016-10-09 18:45:08.027226096 +0300 +@@ -0,0 +1,1102 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani + * @@ -13546,6 +13542,8 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ntoskernel.h linux-4.6-rc6-ndis/3r +#include +#include +#include ++#include ++ + +#if !defined(CONFIG_X86) && !defined(CONFIG_X86_64) +#error "this module is for x86 or x86_64 architectures only" @@ -13858,8 +13856,18 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ntoskernel.h linux-4.6-rc6-ndis/3r +#define prandom_seed(seed) net_srandom(seed) +#endif + -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) -+#define strncasecmp strnicmp ++#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22) ++static int strncasecmp(const char *s1, const char *s2, size_t n) ++{ ++ strnicmp(s1, s2, n); ++} ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4,7,0) ++static inline void netif_trans_update(struct net_device *dev) ++{ ++ dev->trans_start = jiffies; ++} +#endif + +/* TICK is 100ns */ @@ -14588,9 +14596,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ntoskernel.h linux-4.6-rc6-ndis/3r +#endif + +#endif // _NTOSKERNEL_H_ -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ntoskernel_io.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/ntoskernel_io.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/ntoskernel_io.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/ntoskernel_io.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/ntoskernel_io.c linux-4.12.4-3rd/3rdparty/ndiswrapper/ntoskernel_io.c +--- linux-4.12.4/3rdparty/ndiswrapper/ntoskernel_io.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/ntoskernel_io.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,1161 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -15753,9 +15761,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/ntoskernel_io.c linux-4.6-rc6-ndis + IOTRACE("LowLimit: 0x%lx, HighLimit: 0x%lx", *LowLimit, *HighLimit); + IOEXIT(return); +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/pe_linker.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/pe_linker.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/pe_linker.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/pe_linker.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/pe_linker.c linux-4.12.4-3rd/3rdparty/ndiswrapper/pe_linker.c +--- linux-4.12.4/3rdparty/ndiswrapper/pe_linker.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/pe_linker.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,600 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -16357,9 +16365,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/pe_linker.c linux-4.6-rc6-ndis/3rd + } + return 0; +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/pe_linker.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/pe_linker.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/pe_linker.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/pe_linker.h 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/pe_linker.h linux-4.12.4-3rd/3rdparty/ndiswrapper/pe_linker.h +--- linux-4.12.4/3rdparty/ndiswrapper/pe_linker.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/pe_linker.h 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,992 @@ +/* + * This file is an excerpt of winnt.h from WINE, which bears the @@ -17353,9 +17361,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/pe_linker.h linux-4.6-rc6-ndis/3rd + WORD Length; + CHAR NameString[ 1 ]; +} IMAGE_RESOURCE_DIRECTORY_STRING,*PIMAGE_RESOURCE_DIRECTORY_STRING; -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/pnp.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/pnp.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/pnp.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/pnp.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/pnp.c linux-4.12.4-3rd/3rdparty/ndiswrapper/pnp.c +--- linux-4.12.4/3rdparty/ndiswrapper/pnp.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/pnp.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,697 @@ +/* + * Copyright (C) 2005 Giridhar Pemmasani @@ -18054,9 +18062,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/pnp.c linux-4.6-rc6-ndis/3rdparty/ +} + +#endif // USB -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/pnp.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/pnp.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/pnp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/pnp.h 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/pnp.h linux-4.12.4-3rd/3rdparty/ndiswrapper/pnp.h +--- linux-4.12.4/3rdparty/ndiswrapper/pnp.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/pnp.h 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,36 @@ +/* + * Copyright (C) 2005 Giridhar Pemmasani @@ -18094,9 +18102,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/pnp.h linux-4.6-rc6-ndis/3rdparty/ +int wrap_pnp_resume_usb_device(struct usb_interface *intf); + +#endif -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/proc.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/proc.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/proc.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/proc.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/proc.c linux-4.12.4-3rd/3rdparty/ndiswrapper/proc.c +--- linux-4.12.4/3rdparty/ndiswrapper/proc.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/proc.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,588 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -18686,9 +18694,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/proc.c linux-4.6-rc6-ndis/3rdparty + remove_proc_entry("debug", wrap_procfs_entry); + proc_remove(wrap_procfs_entry); +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/rtl.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/rtl.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/rtl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/rtl.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/rtl.c linux-4.12.4-3rd/3rdparty/ndiswrapper/rtl.c +--- linux-4.12.4/3rdparty/ndiswrapper/rtl.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/rtl.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,715 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -19405,9 +19413,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/rtl.c linux-4.6-rc6-ndis/3rdparty/ + TRACE1("version: %d", version); + return TRUE; +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/usb.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/usb.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/usb.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/usb.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/usb.c linux-4.12.4-3rd/3rdparty/ndiswrapper/usb.c +--- linux-4.12.4/3rdparty/ndiswrapper/usb.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/usb.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,1496 @@ +/* + * Copyright (C) 2004 Jan Kiszka @@ -20905,9 +20913,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/usb.c linux-4.6-rc6-ndis/3rdparty/ + kill_all_urbs(wd, 0); + USBEXIT(return); +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/usb.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/usb.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/usb.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/usb.h 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/usb.h linux-4.12.4-3rd/3rdparty/ndiswrapper/usb.h +--- linux-4.12.4/3rdparty/ndiswrapper/usb.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/usb.h 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,360 @@ +/* + * Copyright (C) 2004 Jan Kiszka @@ -21269,9 +21277,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/usb.h linux-4.6-rc6-ndis/3rdparty/ + struct io_stack_location *irp_sl); + +#endif /* USB_H */ -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/win2lin_stubs.S linux-4.6-rc6-ndis/3rdparty/ndiswrapper/win2lin_stubs.S ---- linux-4.6-rc6/3rdparty/ndiswrapper/win2lin_stubs.S 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/win2lin_stubs.S 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/win2lin_stubs.S linux-4.12.4-3rd/3rdparty/ndiswrapper/win2lin_stubs.S +--- linux-4.12.4/3rdparty/ndiswrapper/win2lin_stubs.S 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/win2lin_stubs.S 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,253 @@ +/* + * Copyright (C) 2005 Karl Vogel, Giridhar Pemmasani @@ -21526,9 +21534,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/win2lin_stubs.S linux-4.6-rc6-ndis +#include "win2lin_stubs.h" + +#endif /* CONFIG_X86_64 */ -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/winnt_types.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/winnt_types.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/winnt_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/winnt_types.h 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/winnt_types.h linux-4.12.4-3rd/3rdparty/ndiswrapper/winnt_types.h +--- linux-4.12.4/3rdparty/ndiswrapper/winnt_types.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/winnt_types.h 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,1701 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -23231,9 +23239,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/winnt_types.h linux-4.6-rc6-ndis/3 + + +#endif /* WINNT_TYPES_H */ -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/workqueue.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/workqueue.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/workqueue.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/workqueue.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/workqueue.c linux-4.12.4-3rd/3rdparty/ndiswrapper/workqueue.c +--- linux-4.12.4/3rdparty/ndiswrapper/workqueue.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/workqueue.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,279 @@ +/* + * Copyright (C) 2006 Giridhar Pemmasani @@ -23514,9 +23522,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/workqueue.c linux-4.6-rc6-ndis/3rd + wrap_destroy_wq_on(workq, i); + kfree(workq); +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/wrapmem.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/wrapmem.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/wrapmem.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/wrapmem.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/wrapmem.c linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapmem.c +--- linux-4.12.4/3rdparty/ndiswrapper/wrapmem.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapmem.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,366 @@ +/* + * Copyright (C) 2006 Giridhar Pemmasani @@ -23884,9 +23892,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/wrapmem.c linux-4.6-rc6-ndis/3rdpa +#endif + return; +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/wrapmem.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/wrapmem.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/wrapmem.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/wrapmem.h 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/wrapmem.h linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapmem.h +--- linux-4.12.4/3rdparty/ndiswrapper/wrapmem.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapmem.h 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,97 @@ +/* + * Copyright (C) 2006 Giridhar Pemmasani @@ -23985,9 +23993,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/wrapmem.h linux-4.6-rc6-ndis/3rdpa +#endif // ALLOC_DEBUG + +#endif -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/wrapndis.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/wrapndis.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/wrapndis.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/wrapndis.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/wrapndis.c linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapndis.c +--- linux-4.12.4/3rdparty/ndiswrapper/wrapndis.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapndis.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,2186 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -24695,7 +24703,7 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/wrapndis.c linux-4.6-rc6-ndis/3rdp + n = wnd->max_tx_packets; + n = mp_tx_packets(wnd, wnd->tx_ring_start, n); + if (n) { -+ wnd->net_dev->trans_start = jiffies; ++ netif_trans_update(wnd->net_dev); + wnd->tx_ring_start = + (wnd->tx_ring_start + n) % TX_RING_SIZE; + wnd->is_tx_ring_full = 0; @@ -26175,9 +26183,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/wrapndis.c linux-4.6-rc6-ndis/3rdp + if (wrapndis_wq) + destroy_workqueue(wrapndis_wq); +} -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/wrapndis.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/wrapndis.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/wrapndis.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/wrapndis.h 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/wrapndis.h linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapndis.h +--- linux-4.12.4/3rdparty/ndiswrapper/wrapndis.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapndis.h 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,86 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -26265,9 +26273,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/wrapndis.h linux-4.6-rc6-ndis/3rdp +struct iw_statistics *get_iw_stats(struct net_device *dev); + +#endif -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/wrapper.c linux-4.6-rc6-ndis/3rdparty/ndiswrapper/wrapper.c ---- linux-4.6-rc6/3rdparty/ndiswrapper/wrapper.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/wrapper.c 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/wrapper.c linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapper.c +--- linux-4.12.4/3rdparty/ndiswrapper/wrapper.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapper.c 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,111 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani @@ -26380,9 +26388,9 @@ diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/wrapper.c linux-4.6-rc6-ndis/3rdpa + +module_init(wrapper_init); +module_exit(wrapper_exit); -diff -Nurp linux-4.6-rc6/3rdparty/ndiswrapper/wrapper.h linux-4.6-rc6-ndis/3rdparty/ndiswrapper/wrapper.h ---- linux-4.6-rc6/3rdparty/ndiswrapper/wrapper.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.6-rc6-ndis/3rdparty/ndiswrapper/wrapper.h 2016-05-01 18:25:43.000000000 +0300 +diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/wrapper.h linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapper.h +--- linux-4.12.4/3rdparty/ndiswrapper/wrapper.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapper.h 2016-10-09 18:45:08.027226096 +0300 @@ -0,0 +1,24 @@ +/* + * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani diff --git a/kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-4.10-buildfix.patch b/kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-4.10-buildfix.patch new file mode 100644 index 00000000..bf5f1f81 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-4.10-buildfix.patch @@ -0,0 +1,43 @@ + +last_rx is gone, most drivers does not really need/use it anyway. + +Also, include signal.h to fix implicit deklaration of function ”signal_pending” + +Signed-off-by: Thomas Backlund + +--- linux/3rdparty/ndiswrapper/ndis.c.orig 2016-10-09 18:45:08.027226096 +0300 ++++ linux/3rdparty/ndiswrapper/ndis.c 2017-08-04 00:09:49.264110609 +0300 +@@ -2258,7 +2258,6 @@ wstdcall void NdisMIndicateReceivePacket + WARNING("empty packet ignored"); + continue; + } +- wnd->net_dev->last_rx = jiffies; + /* get total number of bytes in packet */ + NdisGetFirstBufferFromPacketSafe(packet, &buffer, &virt, + &length, &total_length, +@@ -2346,7 +2345,6 @@ wstdcall void EthRxIndicateHandler(struc + ERROR("nmb is NULL"); + EXIT3(return); + } +- wnd->net_dev->last_rx = jiffies; + + if (look_ahead_size < packet_size) { + struct ndis_packet *packet; +@@ -2461,7 +2459,6 @@ wstdcall void NdisMTransferDataComplete( + WARNING("illegal packet"); + EXIT3(return); + } +- wnd->net_dev->last_rx = jiffies; + oob_data = NDIS_PACKET_OOB_DATA(packet); + skb_size = sizeof(oob_data->header) + oob_data->look_ahead_size + + bytes_txed; +--- linux/3rdparty/ndiswrapper/ntoskernel.h.orig 2017-08-03 23:52:29.015367906 +0300 ++++ linux/3rdparty/ndiswrapper/ntoskernel.h 2017-08-04 00:17:41.334914691 +0300 +@@ -33,6 +33,7 @@ + #include + #include + #include ++#include + #include + #include + #include diff --git a/kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-4.13-buildfix.patch b/kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-4.13-buildfix.patch new file mode 100644 index 00000000..a2611504 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-4.13-buildfix.patch @@ -0,0 +1,16 @@ + +__GFP_REPEAT is now __GFP_RETRY_MAYFAIL + +Signed-off-by: Thomas Backlund + +--- linux/3rdparty/ndiswrapper/ntoskernel.h.orig 2017-10-15 01:11:56.041892449 +0300 ++++ linux/3rdparty/ndiswrapper/ntoskernel.h 2017-10-15 01:11:06.159204294 +0300 +@@ -122,7 +122,7 @@ static cpumask_t cpumasks[NR_CPUS]; + + #define PCI_DMA_ALLOC_COHERENT(pci_dev,size,dma_handle) \ + dma_alloc_coherent(&pci_dev->dev,size,dma_handle, \ +- GFP_KERNEL | __GFP_REPEAT) ++ GFP_KERNEL | __GFP_RETRY_MAYFAIL) + #define PCI_DMA_FREE_COHERENT(pci_dev,size,cpu_addr,dma_handle) \ + dma_free_coherent(&pci_dev->dev,size,cpu_addr,dma_handle) + #define PCI_DMA_MAP_SINGLE(pci_dev,addr,size,direction) \ diff --git a/kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-4.7-buildfix.patch b/kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-4.7-buildfix.patch deleted file mode 100644 index 6e984b38..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/3rd-ndiswrapper-4.7-buildfix.patch +++ /dev/null @@ -1,20 +0,0 @@ - -Add supprto for 4.7 series kernels. - -Signed-off-by: Thomas Backlund - -diff -urp linux/3rdparty/ndiswrapper.orig/wrapndis.c linux/3rdparty/ndiswrapper/wrapndis.c ---- linux/3rdparty/ndiswrapper.orig/wrapndis.c 2016-07-04 20:00:13.000000000 +0300 -+++ linux/3rdparty/ndiswrapper/wrapndis.c 2016-07-04 20:23:29.454819702 +0300 -@@ -704,7 +704,11 @@ static void tx_worker(struct work_struct - n = wnd->max_tx_packets; - n = mp_tx_packets(wnd, wnd->tx_ring_start, n); - if (n) { -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 7, 0) - wnd->net_dev->trans_start = jiffies; -+#else -+ netif_trans_update(wnd->net_dev); -+#endif - wnd->tx_ring_start = - (wnd->tx_ring_start + n) % TX_RING_SIZE; - wnd->is_tx_ring_full = 0; diff --git a/kernel/tools/cpupowertools/files/patches/mageia/3rd-rtl8723bs.patch b/kernel/tools/cpupowertools/files/patches/mageia/3rd-rtl8723bs.patch deleted file mode 100644 index 58379a12..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/3rd-rtl8723bs.patch +++ /dev/null @@ -1,110345 +0,0 @@ - -From https://github.com/hadess/rtl8723bs - -Tpomost commit: - -commit b3def82d8cbd0e7011bfaa6b70cd74725863e833 -Merge: aae04af 20822be -Author: lwfinger -Date: Thu Nov 3 10:33:33 2016 -0500 - - Merge pull request #110 from colin4124/patch-1 - - Add usage guide - - -Signed-off-by: Thomas Backlund - - 3rdparty/rtl8723bs/Kconfig | 11 - 3rdparty/rtl8723bs/Makefile | 251 - 3rdparty/rtl8723bs/core/rtw_ap.c | 2684 ++++++++ - 3rdparty/rtl8723bs/core/rtw_btcoex.c | 243 - 3rdparty/rtl8723bs/core/rtw_cmd.c | 2244 +++++++ - 3rdparty/rtl8723bs/core/rtw_debug.c | 1453 ++++ - 3rdparty/rtl8723bs/core/rtw_eeprom.c | 369 + - 3rdparty/rtl8723bs/core/rtw_efuse.c | 635 ++ - 3rdparty/rtl8723bs/core/rtw_ieee80211.c | 1433 ++++ - 3rdparty/rtl8723bs/core/rtw_io.c | 203 - 3rdparty/rtl8723bs/core/rtw_ioctl_set.c | 696 ++ - 3rdparty/rtl8723bs/core/rtw_mlme.c | 3155 ++++++++++ - 3rdparty/rtl8723bs/core/rtw_mlme_ext.c | 6940 ++++++++++++++++++++++ - 3rdparty/rtl8723bs/core/rtw_odm.c | 195 - 3rdparty/rtl8723bs/core/rtw_pwrctrl.c | 1421 ++++ - 3rdparty/rtl8723bs/core/rtw_recv.c | 2693 ++++++++ - 3rdparty/rtl8723bs/core/rtw_rf.c | 64 - 3rdparty/rtl8723bs/core/rtw_security.c | 2448 +++++++ - 3rdparty/rtl8723bs/core/rtw_sta_mgt.c | 641 ++ - 3rdparty/rtl8723bs/core/rtw_wlan_util.c | 2328 +++++++ - 3rdparty/rtl8723bs/core/rtw_xmit.c | 3100 +++++++++ - 3rdparty/rtl8723bs/hal/Hal8723BPwrSeq.c | 138 - 3rdparty/rtl8723bs/hal/Hal8723BReg.h | 442 + - 3rdparty/rtl8723bs/hal/HalBtc8723b1Ant.c | 3779 +++++++++++ - 3rdparty/rtl8723bs/hal/HalBtc8723b1Ant.h | 193 - 3rdparty/rtl8723bs/hal/HalBtc8723b2Ant.c | 3729 +++++++++++ - 3rdparty/rtl8723bs/hal/HalBtc8723b2Ant.h | 155 - 3rdparty/rtl8723bs/hal/HalBtcOutSrc.h | 565 + - 3rdparty/rtl8723bs/hal/HalHWImg8723B_BB.c | 643 ++ - 3rdparty/rtl8723bs/hal/HalHWImg8723B_BB.h | 48 - 3rdparty/rtl8723bs/hal/HalHWImg8723B_MAC.c | 302 - 3rdparty/rtl8723bs/hal/HalHWImg8723B_MAC.h | 28 - 3rdparty/rtl8723bs/hal/HalHWImg8723B_RF.c | 799 ++ - 3rdparty/rtl8723bs/hal/HalHWImg8723B_RF.h | 49 - 3rdparty/rtl8723bs/hal/HalPhyRf.c | 662 ++ - 3rdparty/rtl8723bs/hal/HalPhyRf.h | 63 - 3rdparty/rtl8723bs/hal/HalPhyRf_8723B.c | 2091 ++++++ - 3rdparty/rtl8723bs/hal/HalPhyRf_8723B.h | 83 - 3rdparty/rtl8723bs/hal/HalPwrSeqCmd.c | 205 - 3rdparty/rtl8723bs/hal/Mp_Precomp.h | 33 - 3rdparty/rtl8723bs/hal/hal_btcoex.c | 1720 +++++ - 3rdparty/rtl8723bs/hal/hal_com.c | 1753 +++++ - 3rdparty/rtl8723bs/hal/hal_com_phycfg.c | 3288 ++++++++++ - 3rdparty/rtl8723bs/hal/hal_intf.c | 474 + - 3rdparty/rtl8723bs/hal/hal_phy.c | 224 - 3rdparty/rtl8723bs/hal/hal_sdio.c | 115 - 3rdparty/rtl8723bs/hal/odm.c | 1446 ++++ - 3rdparty/rtl8723bs/hal/odm.h | 1465 ++++ - 3rdparty/rtl8723bs/hal/odm_AntDiv.c | 70 - 3rdparty/rtl8723bs/hal/odm_AntDiv.h | 38 - 3rdparty/rtl8723bs/hal/odm_CfoTracking.c | 338 + - 3rdparty/rtl8723bs/hal/odm_CfoTracking.h | 47 - 3rdparty/rtl8723bs/hal/odm_DIG.c | 1221 +++ - 3rdparty/rtl8723bs/hal/odm_DIG.h | 195 - 3rdparty/rtl8723bs/hal/odm_DynamicBBPowerSaving.c | 89 - 3rdparty/rtl8723bs/hal/odm_DynamicBBPowerSaving.h | 39 - 3rdparty/rtl8723bs/hal/odm_DynamicTxPower.c | 30 - 3rdparty/rtl8723bs/hal/odm_DynamicTxPower.h | 37 - 3rdparty/rtl8723bs/hal/odm_EdcaTurboCheck.c | 186 - 3rdparty/rtl8723bs/hal/odm_EdcaTurboCheck.h | 31 - 3rdparty/rtl8723bs/hal/odm_HWConfig.c | 535 + - 3rdparty/rtl8723bs/hal/odm_HWConfig.h | 162 - 3rdparty/rtl8723bs/hal/odm_NoiseMonitor.c | 175 - 3rdparty/rtl8723bs/hal/odm_NoiseMonitor.h | 47 - 3rdparty/rtl8723bs/hal/odm_PathDiv.c | 42 - 3rdparty/rtl8723bs/hal/odm_PathDiv.h | 29 - 3rdparty/rtl8723bs/hal/odm_RTL8723B.c | 45 - 3rdparty/rtl8723bs/hal/odm_RTL8723B.h | 22 - 3rdparty/rtl8723bs/hal/odm_RegConfig8723B.c | 257 - 3rdparty/rtl8723bs/hal/odm_RegConfig8723B.h | 65 - 3rdparty/rtl8723bs/hal/odm_RegDefine11N.h | 172 - 3rdparty/rtl8723bs/hal/odm_debug.c | 52 - 3rdparty/rtl8723bs/hal/odm_debug.h | 165 - 3rdparty/rtl8723bs/hal/odm_interface.h | 59 - 3rdparty/rtl8723bs/hal/odm_precomp.h | 60 - 3rdparty/rtl8723bs/hal/odm_reg.h | 103 - 3rdparty/rtl8723bs/hal/odm_types.h | 102 - 3rdparty/rtl8723bs/hal/rtl8723b_cmd.c | 2358 +++++++ - 3rdparty/rtl8723bs/hal/rtl8723b_dm.c | 300 - 3rdparty/rtl8723bs/hal/rtl8723b_hal_init.c | 4546 ++++++++++++++ - 3rdparty/rtl8723bs/hal/rtl8723b_phycfg.c | 1060 +++ - 3rdparty/rtl8723bs/hal/rtl8723b_rf6052.c | 230 - 3rdparty/rtl8723bs/hal/rtl8723b_rxdesc.c | 86 - 3rdparty/rtl8723bs/hal/rtl8723bs_recv.c | 490 + - 3rdparty/rtl8723bs/hal/rtl8723bs_xmit.c | 686 ++ - 3rdparty/rtl8723bs/hal/sdio_halinit.c | 1928 ++++++ - 3rdparty/rtl8723bs/hal/sdio_ops.c | 1296 ++++ - 3rdparty/rtl8723bs/include/Hal8192CPhyReg.h | 1126 +++ - 3rdparty/rtl8723bs/include/Hal8723BPhyCfg.h | 128 - 3rdparty/rtl8723bs/include/Hal8723BPhyReg.h | 77 - 3rdparty/rtl8723bs/include/Hal8723BPwrSeq.h | 232 - 3rdparty/rtl8723bs/include/HalPwrSeqCmd.h | 132 - 3rdparty/rtl8723bs/include/HalVerDef.h | 127 - 3rdparty/rtl8723bs/include/autoconf.h | 71 - 3rdparty/rtl8723bs/include/basic_types.h | 209 - 3rdparty/rtl8723bs/include/cmd_osdep.h | 26 - 3rdparty/rtl8723bs/include/drv_conf.h | 37 - 3rdparty/rtl8723bs/include/drv_types.h | 720 ++ - 3rdparty/rtl8723bs/include/drv_types_sdio.h | 39 - 3rdparty/rtl8723bs/include/ethernet.h | 22 - 3rdparty/rtl8723bs/include/hal_btcoex.h | 68 - 3rdparty/rtl8723bs/include/hal_com.h | 309 - 3rdparty/rtl8723bs/include/hal_com_h2c.h | 293 - 3rdparty/rtl8723bs/include/hal_com_phycfg.h | 275 - 3rdparty/rtl8723bs/include/hal_com_reg.h | 1725 +++++ - 3rdparty/rtl8723bs/include/hal_data.h | 485 + - 3rdparty/rtl8723bs/include/hal_intf.h | 410 + - 3rdparty/rtl8723bs/include/hal_pg.h | 81 - 3rdparty/rtl8723bs/include/hal_phy.h | 183 - 3rdparty/rtl8723bs/include/hal_phy_reg.h | 25 - 3rdparty/rtl8723bs/include/hal_sdio.h | 26 - 3rdparty/rtl8723bs/include/ieee80211.h | 1345 ++++ - 3rdparty/rtl8723bs/include/ioctl_cfg80211.h | 132 - 3rdparty/rtl8723bs/include/mlme_osdep.h | 27 - 3rdparty/rtl8723bs/include/osdep_intf.h | 88 - 3rdparty/rtl8723bs/include/osdep_service.h | 281 - 3rdparty/rtl8723bs/include/osdep_service_linux.h | 178 - 3rdparty/rtl8723bs/include/recv_osdep.h | 48 - 3rdparty/rtl8723bs/include/rtl8192c_recv.h | 50 - 3rdparty/rtl8723bs/include/rtl8192c_rf.h | 39 - 3rdparty/rtl8723bs/include/rtl8723b_cmd.h | 199 - 3rdparty/rtl8723bs/include/rtl8723b_dm.h | 41 - 3rdparty/rtl8723bs/include/rtl8723b_hal.h | 279 - 3rdparty/rtl8723bs/include/rtl8723b_recv.h | 144 - 3rdparty/rtl8723bs/include/rtl8723b_rf.h | 26 - 3rdparty/rtl8723bs/include/rtl8723b_spec.h | 262 - 3rdparty/rtl8723bs/include/rtl8723b_xmit.h | 458 + - 3rdparty/rtl8723bs/include/rtw_ap.h | 47 - 3rdparty/rtl8723bs/include/rtw_beamforming.h | 135 - 3rdparty/rtl8723bs/include/rtw_br_ext.h | 63 - 3rdparty/rtl8723bs/include/rtw_btcoex.h | 64 - 3rdparty/rtl8723bs/include/rtw_byteorder.h | 24 - 3rdparty/rtl8723bs/include/rtw_cmd.h | 980 +++ - 3rdparty/rtl8723bs/include/rtw_debug.h | 355 + - 3rdparty/rtl8723bs/include/rtw_eeprom.h | 128 - 3rdparty/rtl8723bs/include/rtw_efuse.h | 132 - 3rdparty/rtl8723bs/include/rtw_event.h | 117 - 3rdparty/rtl8723bs/include/rtw_ht.h | 118 - 3rdparty/rtl8723bs/include/rtw_io.h | 373 + - 3rdparty/rtl8723bs/include/rtw_ioctl.h | 80 - 3rdparty/rtl8723bs/include/rtw_ioctl_set.h | 41 - 3rdparty/rtl8723bs/include/rtw_mlme.h | 695 ++ - 3rdparty/rtl8723bs/include/rtw_mlme_ext.h | 888 ++ - 3rdparty/rtl8723bs/include/rtw_mp.h | 512 + - 3rdparty/rtl8723bs/include/rtw_odm.h | 36 - 3rdparty/rtl8723bs/include/rtw_pwrctrl.h | 375 + - 3rdparty/rtl8723bs/include/rtw_qos.h | 27 - 3rdparty/rtl8723bs/include/rtw_recv.h | 553 + - 3rdparty/rtl8723bs/include/rtw_rf.h | 159 - 3rdparty/rtl8723bs/include/rtw_security.h | 440 + - 3rdparty/rtl8723bs/include/rtw_version.h | 2 - 3rdparty/rtl8723bs/include/rtw_wifi_regd.h | 35 - 3rdparty/rtl8723bs/include/rtw_xmit.h | 528 + - 3rdparty/rtl8723bs/include/sdio_hal.h | 28 - 3rdparty/rtl8723bs/include/sdio_ops.h | 49 - 3rdparty/rtl8723bs/include/sdio_ops_linux.h | 40 - 3rdparty/rtl8723bs/include/sdio_osintf.h | 24 - 3rdparty/rtl8723bs/include/sta_info.h | 392 + - 3rdparty/rtl8723bs/include/wifi.h | 1158 +++ - 3rdparty/rtl8723bs/include/wlan_bssdef.h | 278 - 3rdparty/rtl8723bs/include/xmit_osdep.h | 54 - 3rdparty/rtl8723bs/os_dep/ioctl_cfg80211.c | 3608 +++++++++++ - 3rdparty/rtl8723bs/os_dep/ioctl_linux.c | 5820 ++++++++++++++++++ - 3rdparty/rtl8723bs/os_dep/mlme_linux.c | 206 - 3rdparty/rtl8723bs/os_dep/os_intfs.c | 1916 ++++++ - 3rdparty/rtl8723bs/os_dep/osdep_service.c | 481 + - 3rdparty/rtl8723bs/os_dep/recv_linux.c | 366 + - 3rdparty/rtl8723bs/os_dep/rtw_proc.c | 786 ++ - 3rdparty/rtl8723bs/os_dep/rtw_proc.h | 45 - 3rdparty/rtl8723bs/os_dep/sdio_intf.c | 727 ++ - 3rdparty/rtl8723bs/os_dep/sdio_ops_linux.c | 599 + - 3rdparty/rtl8723bs/os_dep/wifi_regd.c | 164 - 3rdparty/rtl8723bs/os_dep/xmit_linux.c | 298 - 173 files changed, 109461 insertions(+) - -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_ap.c linux/3rdparty/rtl8723bs/core/rtw_ap.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_ap.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_ap.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,2684 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_AP_C_ -+ -+#include -+#include -+ -+extern unsigned char RTW_WPA_OUI[]; -+extern unsigned char WMM_OUI[]; -+extern unsigned char WPS_OUI[]; -+extern unsigned char P2P_OUI[]; -+extern unsigned char WFD_OUI[]; -+ -+void init_mlme_ap_info(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ -+ -+ spin_lock_init(&pmlmepriv->bcn_update_lock); -+ -+ /* for ACL */ -+ _rtw_init_queue(&pacl_list->acl_node_q); -+ -+ /* pmlmeext->bstart_bss = false; */ -+ -+ start_ap_mode(padapter); -+} -+ -+void free_mlme_ap_info(struct adapter *padapter) -+{ -+ struct sta_info *psta = NULL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* stop_ap_mode(padapter); */ -+ -+ pmlmepriv->update_bcn = false; -+ pmlmeext->bstart_bss = false; -+ -+ rtw_sta_flush(padapter); -+ -+ pmlmeinfo->state = _HW_STATE_NOLINK_; -+ -+ /* free_assoc_sta_resources */ -+ rtw_free_all_stainfo(padapter); -+ -+ /* free bc/mc sta_info */ -+ psta = rtw_get_bcmc_stainfo(padapter); -+ rtw_free_stainfo(padapter, psta); -+} -+ -+static void update_BCNTIM(struct adapter *padapter) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *pnetwork_mlmeext = &(pmlmeinfo->network); -+ unsigned char *pie = pnetwork_mlmeext->IEs; -+ -+ /* DBG_871X("%s\n", __func__); */ -+ -+ /* update TIM IE */ -+ /* if (pstapriv->tim_bitmap) */ -+ if (true) { -+ -+ u8 *p, *dst_ie, *premainder_ie = NULL, *pbackup_remainder_ie = NULL; -+ __le16 tim_bitmap_le; -+ uint offset, tmp_len, tim_ielen, tim_ie_offset, remainder_ielen; -+ -+ tim_bitmap_le = cpu_to_le16(pstapriv->tim_bitmap); -+ -+ p = rtw_get_ie( -+ pie + _FIXED_IE_LENGTH_, -+ _TIM_IE_, -+ &tim_ielen, -+ pnetwork_mlmeext->IELength - _FIXED_IE_LENGTH_ -+ ); -+ if (p != NULL && tim_ielen > 0) { -+ -+ tim_ielen += 2; -+ -+ premainder_ie = p+tim_ielen; -+ -+ tim_ie_offset = (sint)(p - pie); -+ -+ remainder_ielen = pnetwork_mlmeext->IELength - tim_ie_offset - tim_ielen; -+ -+ /* append TIM IE from dst_ie offset */ -+ dst_ie = p; -+ } else{ -+ -+ -+ tim_ielen = 0; -+ -+ /* calucate head_len */ -+ offset = _FIXED_IE_LENGTH_; -+ -+ /* get ssid_ie len */ -+ p = rtw_get_ie( -+ pie + _BEACON_IE_OFFSET_, -+ _SSID_IE_, -+ &tmp_len, -+ (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_) -+ ); -+ if (p != NULL) -+ offset += tmp_len+2; -+ -+ /* get supported rates len */ -+ p = rtw_get_ie( -+ pie + _BEACON_IE_OFFSET_, -+ _SUPPORTEDRATES_IE_, &tmp_len, -+ (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_) -+ ); -+ if (p != NULL) -+ offset += tmp_len+2; -+ -+ -+ /* DS Parameter Set IE, len =3 */ -+ offset += 3; -+ -+ premainder_ie = pie + offset; -+ -+ remainder_ielen = pnetwork_mlmeext->IELength - offset - tim_ielen; -+ -+ /* append TIM IE from offset */ -+ dst_ie = pie + offset; -+ -+ } -+ -+ -+ if (remainder_ielen > 0) { -+ -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if (pbackup_remainder_ie && premainder_ie) -+ memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ *dst_ie++ = _TIM_IE_; -+ -+ if ((pstapriv->tim_bitmap&0xff00) && (pstapriv->tim_bitmap&0x00fe)) -+ tim_ielen = 5; -+ else -+ tim_ielen = 4; -+ -+ *dst_ie++ = tim_ielen; -+ -+ *dst_ie++ = 0;/* DTIM count */ -+ *dst_ie++ = 1;/* DTIM peroid */ -+ -+ if (pstapriv->tim_bitmap&BIT(0))/* for bc/mc frames */ -+ *dst_ie++ = BIT(0);/* bitmap ctrl */ -+ else -+ *dst_ie++ = 0; -+ -+ if (tim_ielen == 4) { -+ -+ __le16 pvb; -+ -+ if (pstapriv->tim_bitmap&0xff00) -+ pvb = cpu_to_le16(pstapriv->tim_bitmap >> 8); -+ else -+ pvb = tim_bitmap_le; -+ -+ *dst_ie++ = le16_to_cpu(pvb); -+ -+ } else if (tim_ielen == 5) { -+ -+ -+ memcpy(dst_ie, &tim_bitmap_le, 2); -+ dst_ie += 2; -+ } -+ -+ /* copy remainder IE */ -+ if (pbackup_remainder_ie) { -+ -+ memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ kfree(pbackup_remainder_ie); -+ } -+ -+ offset = (uint)(dst_ie - pie); -+ pnetwork_mlmeext->IELength = offset + remainder_ielen; -+ -+ } -+} -+ -+u8 chk_sta_is_alive(struct sta_info *psta); -+u8 chk_sta_is_alive(struct sta_info *psta) -+{ -+ #ifdef DBG_EXPIRATION_CHK -+ DBG_871X( -+ "sta:"MAC_FMT", rssi:%d, rx:"STA_PKTS_FMT", expire_to:%u, %s%ssq_len:%u\n" -+ , MAC_ARG(psta->hwaddr) -+ , psta->rssi_stat.UndecoratedSmoothedPWDB -+ /* STA_RX_PKTS_ARG(psta) */ -+ , STA_RX_PKTS_DIFF_ARG(psta) -+ , psta->expire_to -+ , psta->state&WIFI_SLEEP_STATE?"PS, ":"" -+ , psta->state&WIFI_STA_ALIVE_CHK_STATE?"SAC, ":"" -+ , psta->sleepq_len -+ ); -+ #endif -+ -+ sta_update_last_rx_pkts(psta); -+ -+ return true; -+} -+ -+void expire_timeout_chk(struct adapter *padapter) -+{ -+ struct list_head *phead, *plist; -+ u8 updated = false; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 chk_alive_num = 0; -+ char chk_alive_list[NUM_STA]; -+ int i; -+ -+ -+ spin_lock_bh(&pstapriv->auth_list_lock); -+ -+ phead = &pstapriv->auth_list; -+ plist = get_next(phead); -+ -+ /* check auth_queue */ -+ #ifdef DBG_EXPIRATION_CHK -+ if (phead != plist) { -+ DBG_871X(FUNC_NDEV_FMT" auth_list, cnt:%u\n" -+ , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->auth_list_cnt); -+ } -+ #endif -+ while (phead != plist) { -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, auth_list); -+ -+ plist = get_next(plist); -+ -+ if (psta->expire_to > 0) { -+ -+ psta->expire_to--; -+ if (psta->expire_to == 0) { -+ -+ list_del_init(&psta->auth_list); -+ pstapriv->auth_list_cnt--; -+ -+ DBG_871X( -+ "auth expire %02X%02X%02X%02X%02X%02X\n", -+ psta->hwaddr[0], -+ psta->hwaddr[1], -+ psta->hwaddr[2], -+ psta->hwaddr[3], -+ psta->hwaddr[4], -+ psta->hwaddr[5] -+ ); -+ -+ spin_unlock_bh(&pstapriv->auth_list_lock); -+ -+ rtw_free_stainfo(padapter, psta); -+ -+ spin_lock_bh(&pstapriv->auth_list_lock); -+ } -+ } -+ -+ } -+ -+ spin_unlock_bh(&pstapriv->auth_list_lock); -+ psta = NULL; -+ -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* check asoc_queue */ -+ #ifdef DBG_EXPIRATION_CHK -+ if (phead != plist) { -+ DBG_871X(FUNC_NDEV_FMT" asoc_list, cnt:%u\n" -+ , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->asoc_list_cnt); -+ } -+ #endif -+ while (phead != plist) { -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+#ifdef CONFIG_AUTO_AP_MODE -+ if (psta->isrc) -+ continue; -+#endif -+ if (chk_sta_is_alive(psta) || !psta->expire_to) { -+ psta->expire_to = pstapriv->expire_to; -+ psta->keep_alive_trycnt = 0; -+ psta->under_exist_checking = 0; -+ } else { -+ if (psta->expire_to > 0) -+ psta->expire_to--; -+ } -+ -+ if (psta->expire_to == 0) { -+ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (padapter->registrypriv.wifi_spec == 1) { -+ -+ psta->expire_to = pstapriv->expire_to; -+ continue; -+ } -+ -+ if (psta->state & WIFI_SLEEP_STATE) { -+ if (!(psta->state & WIFI_STA_ALIVE_CHK_STATE)) { -+ /* to check if alive by another methods if staion is at ps mode. */ -+ psta->expire_to = pstapriv->expire_to; -+ psta->state |= WIFI_STA_ALIVE_CHK_STATE; -+ -+ /* DBG_871X("alive chk, sta:" MAC_FMT " is at ps mode!\n", MAC_ARG(psta->hwaddr)); */ -+ -+ /* to update bcn with tim_bitmap for this station */ -+ pstapriv->tim_bitmap |= BIT(psta->aid); -+ update_beacon(padapter, _TIM_IE_, NULL, true); -+ -+ if (!pmlmeext->active_keep_alive_check) -+ continue; -+ } -+ } -+ if (pmlmeext->active_keep_alive_check) { -+ int stainfo_offset; -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ chk_alive_list[chk_alive_num++] = stainfo_offset; -+ -+ -+ continue; -+ } -+ list_del_init(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ DBG_871X( -+ "asoc expire "MAC_FMT", state = 0x%x\n", -+ MAC_ARG(psta->hwaddr), -+ psta->state -+ ); -+ updated = ap_free_sta(padapter, psta, false, WLAN_REASON_DEAUTH_LEAVING); -+ } else{ -+ -+ -+ /* TODO: Aging mechanism to digest frames in sleep_q to avoid running out of xmitframe */ -+ if (psta->sleepq_len > (NR_XMITFRAME/pstapriv->asoc_list_cnt) -+ && padapter->xmitpriv.free_xmitframe_cnt < (( -+ NR_XMITFRAME/pstapriv->asoc_list_cnt -+ )/2) -+ ) { -+ DBG_871X( -+ "%s sta:"MAC_FMT", sleepq_len:%u, free_xmitframe_cnt:%u, asoc_list_cnt:%u, clear sleep_q\n", -+ __func__, -+ MAC_ARG(psta->hwaddr), -+ psta->sleepq_len, -+ padapter->xmitpriv.free_xmitframe_cnt, -+ pstapriv->asoc_list_cnt -+ ); -+ wakeup_sta_to_xmit(padapter, psta); -+ } -+ } -+ } -+ -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+if (chk_alive_num) { -+ -+ u8 backup_oper_channel = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ /* switch to correct channel of current network before issue keep-alive frames */ -+ if (rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) { -+ backup_oper_channel = rtw_get_oper_ch(padapter); -+ SelectChannel(padapter, pmlmeext->cur_channel); -+ } -+ -+ /* issue null data to check sta alive*/ -+ for (i = 0; i < chk_alive_num; i++) { -+ int ret = _FAIL; -+ -+ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); -+ if (!(psta->state & _FW_LINKED)) -+ continue; -+ -+ if (psta->state & WIFI_SLEEP_STATE) -+ ret = issue_nulldata(padapter, psta->hwaddr, 0, 1, 50); -+ else -+ ret = issue_nulldata(padapter, psta->hwaddr, 0, 3, 50); -+ -+ psta->keep_alive_trycnt++; -+ if (ret == _SUCCESS) { -+ -+ DBG_871X( -+ "asoc check, sta(" MAC_FMT ") is alive\n", -+ MAC_ARG(psta->hwaddr) -+ ); -+ psta->expire_to = pstapriv->expire_to; -+ psta->keep_alive_trycnt = 0; -+ continue; -+ } else if (psta->keep_alive_trycnt <= 3) { -+ -+ -+ DBG_871X( -+ "ack check for asoc expire, keep_alive_trycnt =%d\n", -+ psta->keep_alive_trycnt -+ ); -+ psta->expire_to = 1; -+ continue; -+ } -+ -+ psta->keep_alive_trycnt = 0; -+ DBG_871X( -+ "asoc expire "MAC_FMT", state = 0x%x\n", -+ MAC_ARG(psta->hwaddr), -+ psta->state -+ ); -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ if (list_empty(&psta->asoc_list) == false) { -+ list_del_init(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, false, WLAN_REASON_DEAUTH_LEAVING); -+ } -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+ } -+ -+ if (backup_oper_channel > 0) /* back to the original operation channel */ -+ SelectChannel(padapter, backup_oper_channel); -+} -+ -+ associated_clients_update(padapter, updated); -+} -+ -+void add_RATid(struct adapter *padapter, struct sta_info *psta, u8 rssi_level) -+{ -+ unsigned char sta_band = 0, shortGIrate = false; -+ unsigned int tx_ra_bitmap = 0; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_bssid_ex -+ *pcur_network = (struct wlan_bssid_ex *)&pmlmepriv->cur_network.network; -+ -+ if (!psta) -+ return; -+ -+ if (!(psta->state & _FW_LINKED)) -+ return; -+ -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ tx_ra_bitmap = psta->ra_mask; -+ -+ shortGIrate = query_ra_short_GI(psta); -+ -+ if (pcur_network->Configuration.DSConfig > 14) { -+ -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_5N; -+ -+ if (tx_ra_bitmap & 0xff0) -+ sta_band |= WIRELESS_11A; -+ } else { -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_24N; -+ -+ if (tx_ra_bitmap & 0xff0) -+ sta_band |= WIRELESS_11G; -+ -+ if (tx_ra_bitmap & 0x0f) -+ sta_band |= WIRELESS_11B; -+ } -+ -+ psta->wireless_mode = sta_band; -+ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); -+ -+ if (psta->aid < NUM_STA) { -+ -+ u8 arg[4] = {0}; -+ -+ arg[0] = psta->mac_id; -+ arg[1] = psta->raid; -+ arg[2] = shortGIrate; -+ arg[3] = psta->init_rate; -+ -+ DBG_871X("%s => mac_id:%d , raid:%d , shortGIrate =%d, bitmap = 0x%x\n", -+ __func__, psta->mac_id, psta->raid, shortGIrate, tx_ra_bitmap); -+ -+ rtw_hal_add_ra_tid(padapter, tx_ra_bitmap, arg, rssi_level); -+ } else{ -+ -+ -+ DBG_871X("station aid %d exceed the max number\n", psta->aid); -+ } -+ -+} -+ -+void update_bmc_sta(struct adapter *padapter) -+{ -+ unsigned char network_type; -+ int supportRateNum = 0; -+ unsigned int tx_ra_bitmap = 0; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex -+ *pcur_network = (struct wlan_bssid_ex *)&pmlmepriv->cur_network.network; -+ struct sta_info *psta = rtw_get_bcmc_stainfo(padapter); -+ -+ if (psta) { -+ -+ psta->aid = 0;/* default set to 0 */ -+ /* psta->mac_id = psta->aid+4; */ -+ psta->mac_id = psta->aid + 1;/* mac_id = 1 for bc/mc stainfo */ -+ -+ pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta; -+ -+ psta->qos_option = 0; -+ psta->htpriv.ht_option = false; -+ -+ psta->ieee8021x_blocked = 0; -+ -+ memset((void *)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); -+ -+ /* psta->dot118021XPrivacy = _NO_PRIVACY_;//!!! remove it, because it has been set before this. */ -+ -+ /* prepare for add_RATid */ -+ supportRateNum = rtw_get_rateset_len((u8 *)&pcur_network->SupportedRates); -+ network_type = rtw_check_network_type( -+ (u8 *)&pcur_network->SupportedRates, -+ supportRateNum, -+ pcur_network->Configuration.DSConfig -+ ); -+ if (IsSupportedTxCCK(network_type)) { -+ network_type = WIRELESS_11B; -+ } else if (network_type == WIRELESS_INVALID) { /* error handling */ -+ -+ if (pcur_network->Configuration.DSConfig > 14) -+ network_type = WIRELESS_11A; -+ else -+ network_type = WIRELESS_11B; -+ } -+ update_sta_basic_rate(psta, network_type); -+ psta->wireless_mode = network_type; -+ -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ tx_ra_bitmap = psta->ra_mask; -+ -+ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); -+ -+ /* ap mode */ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, true); -+ -+ /* if (pHalData->fw_ractrl == true) */ -+ { -+ u8 arg[4] = {0}; -+ -+ arg[0] = psta->mac_id; -+ arg[1] = psta->raid; -+ arg[2] = 0; -+ arg[3] = psta->init_rate; -+ -+ DBG_871X("%s => mac_id:%d , raid:%d , bitmap = 0x%x\n", -+ __func__, psta->mac_id, psta->raid, tx_ra_bitmap); -+ -+ rtw_hal_add_ra_tid(padapter, tx_ra_bitmap, arg, 0); -+ } -+ -+ rtw_sta_media_status_rpt(padapter, psta, 1); -+ -+ spin_lock_bh(&psta->lock); -+ psta->state = _FW_LINKED; -+ spin_unlock_bh(&psta->lock); -+ -+ } else{ -+ -+ -+ DBG_871X("add_RATid_bmc_sta error!\n"); -+ } -+ -+} -+ -+/* notes: */ -+/* AID: 1~MAX for sta and 0 for bc/mc in ap/adhoc mode */ -+/* MAC_ID = AID+1 for sta in ap/adhoc mode */ -+/* MAC_ID = 1 for bc/mc for sta/ap/adhoc */ -+/* MAC_ID = 0 for bssid for sta/ap/adhoc */ -+/* CAM_ID = 0~3 for default key, cmd_id =macid + 3, macid =aid+1; */ -+ -+void update_sta_info_apmode(struct adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; -+ struct ht_priv *phtpriv_sta = &psta->htpriv; -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0; -+ /* set intf_tag to if1 */ -+ /* psta->intf_tag = 0; */ -+ -+ DBG_871X("%s\n", __func__); -+ -+ /* psta->mac_id = psta->aid+4; */ -+ /* psta->mac_id = psta->aid+1;//alloc macid when call rtw_alloc_stainfo(), */ -+ /* release macid when call rtw_free_stainfo() */ -+ -+ /* ap mode */ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, true); -+ -+ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) -+ psta->ieee8021x_blocked = true; -+ else -+ psta->ieee8021x_blocked = false; -+ -+ -+ /* update sta's cap */ -+ -+ /* ERP */ -+ VCS_update(padapter, psta); -+ -+ /* HT related cap */ -+ if (phtpriv_sta->ht_option) { -+ -+ /* check if sta supports rx ampdu */ -+ phtpriv_sta->ampdu_enable = phtpriv_ap->ampdu_enable; -+ -+ phtpriv_sta->rx_ampdu_min_spacing = ( -+ phtpriv_sta->ht_cap.ampdu_params_info&IEEE80211_HT_CAP_AMPDU_DENSITY -+ )>>2; -+ -+ /* bwmode */ -+ if (( -+ phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info -+ ) & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) -+ psta->bw_mode = CHANNEL_WIDTH_40; -+ else -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ -+ if (pmlmeext->cur_bwmode < psta->bw_mode) -+ psta->bw_mode = pmlmeext->cur_bwmode; -+ -+ phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; -+ -+ -+ /* check if sta support s Short GI 20M */ -+ if (( -+ phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info -+ ) & cpu_to_le16(IEEE80211_HT_CAP_SGI_20)) -+ phtpriv_sta->sgi_20m = true; -+ -+ /* check if sta support s Short GI 40M */ -+ if (( -+ phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info -+ ) & cpu_to_le16(IEEE80211_HT_CAP_SGI_40)) { -+ -+ if (psta->bw_mode == CHANNEL_WIDTH_40) /* according to psta->bw_mode */ -+ phtpriv_sta->sgi_40m = true; -+ else -+ phtpriv_sta->sgi_40m = false; -+ } -+ -+ psta->qos_option = true; -+ -+ /* B0 Config LDPC Coding Capability */ -+ if (TEST_FLAG(phtpriv_ap->ldpc_cap, LDPC_HT_ENABLE_TX) && -+ GET_HT_CAPABILITY_ELE_LDPC_CAP((u8 *)(&phtpriv_sta->ht_cap))) { -+ -+ SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX)); -+ DBG_871X("Enable HT Tx LDPC for STA(%d)\n", psta->aid); -+ } -+ -+ /* B7 B8 B9 Config STBC setting */ -+ if (TEST_FLAG(phtpriv_ap->stbc_cap, STBC_HT_ENABLE_TX) && -+ GET_HT_CAPABILITY_ELE_RX_STBC((u8 *)(&phtpriv_sta->ht_cap))) { -+ -+ SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX)); -+ DBG_871X("Enable HT Tx STBC for STA(%d)\n", psta->aid); -+ } -+ } else{ -+ -+ -+ phtpriv_sta->ampdu_enable = false; -+ -+ phtpriv_sta->sgi_20m = false; -+ phtpriv_sta->sgi_40m = false; -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ phtpriv_sta->ldpc_cap = cur_ldpc_cap; -+ phtpriv_sta->stbc_cap = cur_stbc_cap; -+ phtpriv_sta->beamform_cap = cur_beamform_cap; -+ -+ /* Rx AMPDU */ -+ send_delba(padapter, 0, psta->hwaddr);/* recipient */ -+ -+ /* TX AMPDU */ -+ send_delba(padapter, 1, psta->hwaddr);/* originator */ -+ phtpriv_sta->agg_enable_bitmap = 0x0;/* reset */ -+ phtpriv_sta->candidate_tid_bitmap = 0x0;/* reset */ -+ -+ update_ldpc_stbc_cap(psta); -+ -+ /* todo: init other variables */ -+ -+ memset((void *)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); -+ -+ -+ /* add ratid */ -+ /* add_RATid(padapter, psta);//move to ap_sta_info_defer_update() */ -+ -+ -+ spin_lock_bh(&psta->lock); -+ psta->state |= _FW_LINKED; -+ spin_unlock_bh(&psta->lock); -+ -+ -+} -+ -+static void update_ap_info(struct adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_bssid_ex -+ *pnetwork = (struct wlan_bssid_ex *)&pmlmepriv->cur_network.network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; -+ -+ psta->wireless_mode = pmlmeext->cur_wireless_mode; -+ -+ psta->bssratelen = rtw_get_rateset_len(pnetwork->SupportedRates); -+ memcpy(psta->bssrateset, pnetwork->SupportedRates, psta->bssratelen); -+ -+ /* HT related cap */ -+ if (phtpriv_ap->ht_option) { -+ -+ /* check if sta supports rx ampdu */ -+ /* phtpriv_ap->ampdu_enable = phtpriv_ap->ampdu_enable; */ -+ -+ /* check if sta support s Short GI 20M */ -+ if ((phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_20)) -+ phtpriv_ap->sgi_20m = true; -+ -+ /* check if sta support s Short GI 40M */ -+ if ((phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_40)) -+ phtpriv_ap->sgi_40m = true; -+ -+ -+ psta->qos_option = true; -+ } else{ -+ -+ -+ phtpriv_ap->ampdu_enable = false; -+ -+ phtpriv_ap->sgi_20m = false; -+ phtpriv_ap->sgi_40m = false; -+ } -+ -+ psta->bw_mode = pmlmeext->cur_bwmode; -+ phtpriv_ap->ch_offset = pmlmeext->cur_ch_offset; -+ -+ phtpriv_ap->agg_enable_bitmap = 0x0;/* reset */ -+ phtpriv_ap->candidate_tid_bitmap = 0x0;/* reset */ -+ -+ memcpy(&psta->htpriv, &pmlmepriv->htpriv, sizeof(struct ht_priv)); -+} -+ -+static void update_hw_ht_param(struct adapter *padapter) -+{ -+ unsigned char max_AMPDU_len; -+ unsigned char min_MPDU_spacing; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ DBG_871X("%s\n", __func__); -+ -+ -+ /* handle A-MPDU parameter field */ -+ /* -+ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k -+ AMPDU_para [4:2]:Min MPDU Start Spacing -+ */ -+ max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; -+ -+ min_MPDU_spacing = ( -+ pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c -+ ) >> 2; -+ -+ rtw_hal_set_hwreg( -+ padapter, -+ HW_VAR_AMPDU_MIN_SPACE, -+ (u8 *)(&min_MPDU_spacing) -+ ); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len)); -+ -+ /* */ -+ /* Config SM Power Save setting */ -+ /* */ -+ pmlmeinfo->SM_PS = (le16_to_cpu( -+ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info -+ ) & 0x0C) >> 2; -+ if (pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC) -+ DBG_871X("%s(): WLAN_HT_CAP_SM_PS_STATIC\n", __func__); -+ -+ /* */ -+ /* Config current HT Protection mode. */ -+ /* */ -+ /* pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; */ -+ -+} -+ -+void start_bss_network(struct adapter *padapter, u8 *pbuf) -+{ -+ u8 *p; -+ u8 val8, cur_channel, cur_bwmode, cur_ch_offset; -+ u16 bcn_interval; -+ u32 acparm; -+ int ie_len; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ struct wlan_bssid_ex -+ *pnetwork = (struct wlan_bssid_ex *)&pmlmepriv->cur_network.network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *pnetwork_mlmeext = &(pmlmeinfo->network); -+ struct HT_info_element *pht_info = NULL; -+ u8 cbw40_enable = 0; -+ -+ /* DBG_871X("%s\n", __func__); */ -+ -+ bcn_interval = (u16)pnetwork->Configuration.BeaconPeriod; -+ cur_channel = pnetwork->Configuration.DSConfig; -+ cur_bwmode = CHANNEL_WIDTH_20; -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ -+ /* check if there is wps ie, */ -+ /* if there is wpsie in beacon, the hostapd will update beacon twice when stating hostapd, */ -+ /* and at first time the security ie (RSN/WPA IE) will not include in beacon. */ -+ if (NULL == rtw_get_wps_ie( -+ pnetwork->IEs+_FIXED_IE_LENGTH_, -+ pnetwork->IELength-_FIXED_IE_LENGTH_, -+ NULL, -+ NULL -+ )) -+ pmlmeext->bstart_bss = true; -+ -+ -+ /* todo: update wmm, ht cap */ -+ /* pmlmeinfo->WMM_enable; */ -+ /* pmlmeinfo->HT_enable; */ -+ if (pmlmepriv->qospriv.qos_option) -+ pmlmeinfo->WMM_enable = true; -+ if (pmlmepriv->htpriv.ht_option) { -+ -+ pmlmeinfo->WMM_enable = true; -+ pmlmeinfo->HT_enable = true; -+ /* pmlmeinfo->HT_info_enable = true; */ -+ /* pmlmeinfo->HT_caps_enable = true; */ -+ -+ update_hw_ht_param(padapter); -+ } -+ -+ if (pmlmepriv->cur_network.join_res != true) { /* setting only at first time */ -+ -+ /* WEP Key will be set before this function, do not clear CAM. */ -+ if ( -+ (psecuritypriv->dot11PrivacyAlgrthm != _WEP40_) && -+ (psecuritypriv->dot11PrivacyAlgrthm != _WEP104_) -+ ) -+ flush_all_cam_entry(padapter); /* clear CAM */ -+ } -+ -+ /* set MSR to AP_Mode */ -+ Set_MSR(padapter, _HW_STATE_AP_); -+ -+ /* Set BSSID REG */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pnetwork->MacAddress); -+ -+ /* Set EDCA param reg */ -+ acparm = 0x002F3217; /* VO */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm)); -+ acparm = 0x005E4317; /* VI */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm)); -+ /* acparm = 0x00105320; // BE */ -+ acparm = 0x005ea42b; -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); -+ acparm = 0x0000A444; /* BK */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); -+ -+ /* Set Security */ -+ val8 = ( -+ psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X -+ ) ? 0xcc : 0xcf; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ -+ /* Beacon Control related register */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&bcn_interval)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, NULL); -+ -+ if (pmlmepriv->cur_network.join_res != true) { /* setting only at first time */ -+ -+ /* u32 initialgain; */ -+ -+ /* initialgain = 0x1e; */ -+ -+ -+ /* disable dynamic functions, such as high power, DIG */ -+ /* Save_DM_Func_Flag(padapter); */ -+ /* Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); */ -+ -+ /* turn on all dynamic functions */ -+ Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, true); -+ -+ /* rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); */ -+ -+ } -+ -+ /* set channel, bwmode */ -+ p = rtw_get_ie( -+ (pnetwork->IEs + sizeof(struct ndis_802_11_fix_ie)), -+ _HT_ADD_INFO_IE_, -+ &ie_len, -+ (pnetwork->IELength - sizeof(struct ndis_802_11_fix_ie)) -+ ); -+ if (p && ie_len) { -+ -+ pht_info = (struct HT_info_element *)(p+2); -+ -+ if (cur_channel > 14) { -+ if ((pregpriv->bw_mode & 0xf0) > 0) -+ cbw40_enable = 1; -+ } else { -+ if ((pregpriv->bw_mode & 0x0f) > 0) -+ cbw40_enable = 1; -+ } -+ -+ if ((cbw40_enable) && (pht_info->infos[0] & BIT(2))) { -+ -+ /* switch to the 40M Hz mode */ -+ /* pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; */ -+ cur_bwmode = CHANNEL_WIDTH_40; -+ switch (pht_info->infos[0] & 0x3) { -+ -+ case 1: -+ /* pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; */ -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case 3: -+ /* pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; */ -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ /* pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; */ -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ -+ } -+ -+ } -+ -+ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); -+ DBG_871X( -+ "CH =%d, BW =%d, offset =%d\n", -+ cur_channel, -+ cur_bwmode, -+ cur_ch_offset -+ ); -+ pmlmeext->cur_channel = cur_channel; -+ pmlmeext->cur_bwmode = cur_bwmode; -+ pmlmeext->cur_ch_offset = cur_ch_offset; -+ pmlmeext->cur_wireless_mode = pmlmepriv->cur_network.network_type; -+ -+ /* let pnetwork_mlmeext == pnetwork_mlme. */ -+ memcpy(pnetwork_mlmeext, pnetwork, pnetwork->Length); -+ -+ /* update cur_wireless_mode */ -+ update_wireless_mode(padapter); -+ -+ /* update RRSR after set channel and bandwidth */ -+ UpdateBrateTbl(padapter, pnetwork->SupportedRates); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, pnetwork->SupportedRates); -+ -+ /* udpate capability after cur_wireless_mode updated */ -+ update_capinfo( -+ padapter, -+ rtw_get_capability((struct wlan_bssid_ex *)pnetwork) -+ ); -+ -+ -+ if (true == pmlmeext->bstart_bss) { -+ -+ update_beacon(padapter, _TIM_IE_, NULL, true); -+ -+#ifndef CONFIG_INTERRUPT_BASED_TXBCN /* other case will tx beacon when bcn interrupt coming in. */ -+ /* issue beacon frame */ -+ if (send_beacon(padapter) == _FAIL) -+ DBG_871X("issue_beacon, fail!\n"); -+ -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN */ -+ -+ } -+ -+ -+ /* update bc/mc sta_info */ -+ update_bmc_sta(padapter); -+ -+ /* pmlmeext->bstart_bss = true; */ -+ -+} -+ -+int rtw_check_beacon_data(struct adapter *padapter, u8 *pbuf, int len) -+{ -+ int ret = _SUCCESS; -+ u8 *p; -+ u8 *pHT_caps_ie = NULL; -+ u8 *pHT_info_ie = NULL; -+ struct sta_info *psta = NULL; -+ u16 cap, ht_cap = false; -+ uint ie_len = 0; -+ int group_cipher, pairwise_cipher; -+ u8 channel, network_type, supportRate[NDIS_802_11_LENGTH_RATES_EX]; -+ int supportRateNum = 0; -+ u8 OUI1[] = {0x00, 0x50, 0xf2, 0x01}; -+ u8 WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_bssid_ex -+ *pbss_network = (struct wlan_bssid_ex *)&pmlmepriv->cur_network.network; -+ u8 *ie = pbss_network->IEs; -+ -+ /* SSID */ -+ /* Supported rates */ -+ /* DS Params */ -+ /* WLAN_EID_COUNTRY */ -+ /* ERP Information element */ -+ /* Extended supported rates */ -+ /* WPA/WPA2 */ -+ /* Wi-Fi Wireless Multimedia Extensions */ -+ /* ht_capab, ht_oper */ -+ /* WPS IE */ -+ -+ DBG_871X("%s, len =%d\n", __func__, len); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return _FAIL; -+ -+ -+ if (len > MAX_IE_SZ) -+ return _FAIL; -+ -+ pbss_network->IELength = len; -+ -+ memset(ie, 0, MAX_IE_SZ); -+ -+ memcpy(ie, pbuf, pbss_network->IELength); -+ -+ -+ if (pbss_network->InfrastructureMode != Ndis802_11APMode) -+ return _FAIL; -+ -+ pbss_network->Rssi = 0; -+ -+ memcpy(pbss_network->MacAddress, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ /* beacon interval */ -+ p = rtw_get_beacon_interval_from_ie(ie);/* ie + 8; 8: TimeStamp, 2: Beacon Interval 2:Capability */ -+ /* pbss_network->Configuration.BeaconPeriod = le16_to_cpu(*(unsigned short*)p); */ -+ pbss_network->Configuration.BeaconPeriod = RTW_GET_LE16(p); -+ -+ /* capability */ -+ /* cap = *(unsigned short *)rtw_get_capability_from_ie(ie); */ -+ /* cap = le16_to_cpu(cap); */ -+ cap = RTW_GET_LE16(ie); -+ -+ /* SSID */ -+ p = rtw_get_ie( -+ ie + _BEACON_IE_OFFSET_, -+ _SSID_IE_, -+ &ie_len, -+ (pbss_network->IELength - _BEACON_IE_OFFSET_) -+ ); -+ if (p && ie_len > 0) { -+ -+ memset(&pbss_network->Ssid, 0, sizeof(struct ndis_802_11_ssid)); -+ memcpy(pbss_network->Ssid.Ssid, (p + 2), ie_len); -+ pbss_network->Ssid.SsidLength = ie_len; -+ } -+ -+ /* chnnel */ -+ channel = 0; -+ pbss_network->Configuration.Length = 0; -+ p = rtw_get_ie( -+ ie + _BEACON_IE_OFFSET_, -+ _DSSET_IE_, &ie_len, -+ (pbss_network->IELength - _BEACON_IE_OFFSET_) -+ ); -+ if (p && ie_len > 0) -+ channel = *(p + 2); -+ -+ pbss_network->Configuration.DSConfig = channel; -+ -+ -+ memset(supportRate, 0, NDIS_802_11_LENGTH_RATES_EX); -+ /* get supported rates */ -+ p = rtw_get_ie( -+ ie + _BEACON_IE_OFFSET_, -+ _SUPPORTEDRATES_IE_, -+ &ie_len, -+ (pbss_network->IELength - _BEACON_IE_OFFSET_) -+ ); -+ if (p != NULL) { -+ -+ memcpy(supportRate, p+2, ie_len); -+ supportRateNum = ie_len; -+ } -+ -+ /* get ext_supported rates */ -+ p = rtw_get_ie( -+ ie + _BEACON_IE_OFFSET_, -+ _EXT_SUPPORTEDRATES_IE_, -+ &ie_len, -+ pbss_network->IELength - _BEACON_IE_OFFSET_ -+ ); -+ if (p != NULL) { -+ -+ memcpy(supportRate+supportRateNum, p+2, ie_len); -+ supportRateNum += ie_len; -+ -+ } -+ -+ network_type = rtw_check_network_type(supportRate, supportRateNum, channel); -+ -+ rtw_set_supported_rate(pbss_network->SupportedRates, network_type); -+ -+ -+ /* parsing ERP_IE */ -+ p = rtw_get_ie( -+ ie + _BEACON_IE_OFFSET_, -+ _ERPINFO_IE_, -+ &ie_len, -+ (pbss_network->IELength - _BEACON_IE_OFFSET_) -+ ); -+ if (p && ie_len > 0) -+ ERP_IE_handler(padapter, (struct ndis_80211_var_ie *)p); -+ -+ /* update privacy/security */ -+ if (cap & BIT(4)) -+ pbss_network->Privacy = 1; -+ else -+ pbss_network->Privacy = 0; -+ -+ psecuritypriv->wpa_psk = 0; -+ -+ /* wpa2 */ -+ group_cipher = 0; pairwise_cipher = 0; -+ psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_; -+ psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_; -+ p = rtw_get_ie( -+ ie + _BEACON_IE_OFFSET_, -+ _RSN_IE_2_, -+ &ie_len, -+ (pbss_network->IELength - _BEACON_IE_OFFSET_) -+ ); -+ if (p && ie_len > 0) { -+ -+ if (rtw_parse_wpa2_ie( -+ p, -+ ie_len+2, -+ &group_cipher, -+ &pairwise_cipher, -+ NULL -+ ) == _SUCCESS) { -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ -+ psecuritypriv->dot8021xalg = 1;/* psk, todo:802.1x */ -+ psecuritypriv->wpa_psk |= BIT(1); -+ -+ psecuritypriv->wpa2_group_cipher = group_cipher; -+ psecuritypriv->wpa2_pairwise_cipher = pairwise_cipher; -+ } -+ -+ } -+ -+ /* wpa */ -+ ie_len = 0; -+ group_cipher = 0; pairwise_cipher = 0; -+ psecuritypriv->wpa_group_cipher = _NO_PRIVACY_; -+ psecuritypriv->wpa_pairwise_cipher = _NO_PRIVACY_; -+ for (p = ie + _BEACON_IE_OFFSET_; ; p += (ie_len + 2)) { -+ -+ p = rtw_get_ie( -+ p, -+ _SSN_IE_1_, -+ &ie_len, -+ (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2)) -+ ); -+ if ((p) && (!memcmp(p+2, OUI1, 4))) { -+ -+ if (rtw_parse_wpa_ie( -+ p, -+ ie_len+2, -+ &group_cipher, -+ &pairwise_cipher, -+ NULL -+ ) == _SUCCESS) { -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ -+ psecuritypriv->dot8021xalg = 1;/* psk, todo:802.1x */ -+ -+ psecuritypriv->wpa_psk |= BIT(0); -+ -+ psecuritypriv->wpa_group_cipher = group_cipher; -+ psecuritypriv->wpa_pairwise_cipher = pairwise_cipher; -+ } -+ -+ break; -+ -+ } -+ -+ if ((p == NULL) || (ie_len == 0)) -+ break; -+ -+ -+ } -+ -+ /* wmm */ -+ ie_len = 0; -+ pmlmepriv->qospriv.qos_option = 0; -+ if (pregistrypriv->wmm_enable) { -+ -+ for (p = ie + _BEACON_IE_OFFSET_; ; p += (ie_len + 2)) { -+ -+ p = rtw_get_ie( -+ p, -+ _VENDOR_SPECIFIC_IE_, -+ &ie_len, -+ (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2)) -+ ); -+ if ((p) && !memcmp(p+2, WMM_PARA_IE, 6)) { -+ -+ pmlmepriv->qospriv.qos_option = 1; -+ -+ *(p+8) |= BIT(7);/* QoS Info, support U-APSD */ -+ -+ /* disable all ACM bits since the WMM admission control is not supported */ -+ *(p + 10) &= ~BIT(4); /* BE */ -+ *(p + 14) &= ~BIT(4); /* BK */ -+ *(p + 18) &= ~BIT(4); /* VI */ -+ *(p + 22) &= ~BIT(4); /* VO */ -+ -+ break; -+ } -+ -+ if ((p == NULL) || (ie_len == 0)) -+ break; -+ -+ } -+ } -+ -+ /* parsing HT_CAP_IE */ -+ p = rtw_get_ie( -+ ie + _BEACON_IE_OFFSET_, -+ _HT_CAPABILITY_IE_, -+ &ie_len, -+ (pbss_network->IELength - _BEACON_IE_OFFSET_) -+ ); -+ if (p && ie_len > 0) { -+ -+ u8 rf_type = 0; -+ u8 max_rx_ampdu_factor = 0; -+ struct rtw_ieee80211_ht_cap *pht_cap = (struct rtw_ieee80211_ht_cap *)(p+2); -+ -+ pHT_caps_ie = p; -+ -+ ht_cap = true; -+ network_type |= WIRELESS_11_24N; -+ -+ rtw_ht_use_default_setting(padapter); -+ -+ if (pmlmepriv->htpriv.sgi_20m == false) -+ pht_cap->cap_info &= cpu_to_le16(~(IEEE80211_HT_CAP_SGI_20)); -+ -+ if (pmlmepriv->htpriv.sgi_40m == false) -+ pht_cap->cap_info &= cpu_to_le16(~(IEEE80211_HT_CAP_SGI_40)); -+ -+ if (!TEST_FLAG(pmlmepriv->htpriv.ldpc_cap, LDPC_HT_ENABLE_RX)) -+ pht_cap->cap_info &= cpu_to_le16(~(IEEE80211_HT_CAP_LDPC_CODING)); -+ -+ -+ if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_TX)) -+ pht_cap->cap_info &= cpu_to_le16(~(IEEE80211_HT_CAP_TX_STBC)); -+ -+ -+ if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_RX)) -+ pht_cap->cap_info &= cpu_to_le16(~(IEEE80211_HT_CAP_RX_STBC_3R)); -+ -+ -+ pht_cap->ampdu_params_info &= ~( -+ IEEE80211_HT_CAP_AMPDU_FACTOR|IEEE80211_HT_CAP_AMPDU_DENSITY -+ ); -+ -+ if ((psecuritypriv->wpa_pairwise_cipher & WPA_CIPHER_CCMP) || -+ (psecuritypriv->wpa2_pairwise_cipher & WPA_CIPHER_CCMP)) { -+ -+ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&(0x07<<2)); -+ } else{ -+ -+ -+ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&0x00); -+ } -+ -+ rtw_hal_get_def_var( -+ padapter, -+ HW_VAR_MAX_RX_AMPDU_FACTOR, -+ &max_rx_ampdu_factor -+ ); -+ pht_cap->ampdu_params_info |= ( -+ IEEE80211_HT_CAP_AMPDU_FACTOR & max_rx_ampdu_factor -+ ); /* set Max Rx AMPDU size to 64K */ -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if (rf_type == RF_1T1R) { -+ -+ pht_cap->supp_mcs_set[0] = 0xff; -+ pht_cap->supp_mcs_set[1] = 0x0; -+ } -+ -+ memcpy(&pmlmepriv->htpriv.ht_cap, p+2, ie_len); -+ -+ } -+ -+ /* parsing HT_INFO_IE */ -+ p = rtw_get_ie( -+ ie + _BEACON_IE_OFFSET_, -+ _HT_ADD_INFO_IE_, -+ &ie_len, -+ (pbss_network->IELength - _BEACON_IE_OFFSET_) -+ ); -+ if (p && ie_len > 0) -+ pHT_info_ie = p; -+ -+ -+ switch (network_type) { -+ -+ case WIRELESS_11B: -+ pbss_network->NetworkTypeInUse = Ndis802_11DS; -+ break; -+ case WIRELESS_11G: -+ case WIRELESS_11BG: -+ case WIRELESS_11G_24N: -+ case WIRELESS_11BG_24N: -+ pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; -+ break; -+ case WIRELESS_11A: -+ pbss_network->NetworkTypeInUse = Ndis802_11OFDM5; -+ break; -+ default: -+ pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; -+ break; -+ } -+ -+ pmlmepriv->cur_network.network_type = network_type; -+ -+ pmlmepriv->htpriv.ht_option = false; -+ -+ if ((psecuritypriv->wpa2_pairwise_cipher&WPA_CIPHER_TKIP) || -+ (psecuritypriv->wpa_pairwise_cipher&WPA_CIPHER_TKIP)) { -+ -+ /* todo: */ -+ /* ht_cap = false; */ -+ } -+ -+ /* ht_cap */ -+ if (pregistrypriv->ht_enable && ht_cap == true) { -+ -+ pmlmepriv->htpriv.ht_option = true; -+ pmlmepriv->qospriv.qos_option = 1; -+ -+ if (pregistrypriv->ampdu_enable == 1) -+ pmlmepriv->htpriv.ampdu_enable = true; -+ -+ -+ HT_caps_handler(padapter, (struct ndis_80211_var_ie *)pHT_caps_ie); -+ -+ HT_info_handler(padapter, (struct ndis_80211_var_ie *)pHT_info_ie); -+ } -+ -+ pbss_network->Length = get_wlan_bssid_ex_sz( -+ (struct wlan_bssid_ex *)pbss_network -+ ); -+ -+ /* issue beacon to start bss network */ -+ /* start_bss_network(padapter, (u8 *)pbss_network); */ -+ rtw_startbss_cmd(padapter, RTW_CMDF_WAIT_ACK); -+ -+ -+ /* alloc sta_info for ap itself */ -+ psta = rtw_get_stainfo(&padapter->stapriv, pbss_network->MacAddress); -+ if (!psta) { -+ -+ psta = rtw_alloc_stainfo(&padapter->stapriv, pbss_network->MacAddress); -+ if (psta == NULL) -+ return _FAIL; -+ -+ } -+ -+ /* update AP's sta info */ -+ update_ap_info(padapter, psta); -+ -+ psta->state |= WIFI_AP_STATE; /* Aries, add, fix bug of flush_cam_entry at STOP AP mode , 0724 */ -+ rtw_indicate_connect(padapter); -+ -+ pmlmepriv->cur_network.join_res = true;/* for check if already set beacon */ -+ -+ /* update bc/mc sta_info */ -+ /* update_bmc_sta(padapter); */ -+ -+ return ret; -+ -+} -+ -+void rtw_set_macaddr_acl(struct adapter *padapter, int mode) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ -+ DBG_871X("%s, mode =%d\n", __func__, mode); -+ -+ pacl_list->mode = mode; -+} -+ -+int rtw_acl_add_sta(struct adapter *padapter, u8 *addr) -+{ -+ struct list_head *plist, *phead; -+ u8 added = false; -+ int i, ret = 0; -+ struct rtw_wlan_acl_node *paclnode; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ struct __queue *pacl_node_q = &pacl_list->acl_node_q; -+ -+ DBG_871X( -+ "%s(acl_num =%d) =" MAC_FMT "\n", -+ __func__, -+ pacl_list->num, -+ MAC_ARG(addr) -+ ); -+ -+ if ((NUM_ACL-1) < pacl_list->num) -+ return (-1); -+ -+ -+ spin_lock_bh(&(pacl_node_q->lock)); -+ -+ phead = get_list_head(pacl_node_q); -+ plist = get_next(phead); -+ -+ while (phead != plist) { -+ -+ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); -+ plist = get_next(plist); -+ -+ if (!memcmp(paclnode->addr, addr, ETH_ALEN)) { -+ -+ if (paclnode->valid == true) { -+ -+ added = true; -+ DBG_871X("%s, sta has been added\n", __func__); -+ break; -+ } -+ } -+ } -+ -+ spin_unlock_bh(&(pacl_node_q->lock)); -+ -+ -+ if (added == true) -+ return ret; -+ -+ -+ spin_lock_bh(&(pacl_node_q->lock)); -+ -+ for (i = 0; i < NUM_ACL; i++) { -+ -+ paclnode = &pacl_list->aclnode[i]; -+ -+ if (paclnode->valid == false) { -+ -+ INIT_LIST_HEAD(&paclnode->list); -+ -+ memcpy(paclnode->addr, addr, ETH_ALEN); -+ -+ paclnode->valid = true; -+ -+ list_add_tail(&paclnode->list, get_list_head(pacl_node_q)); -+ -+ pacl_list->num++; -+ -+ break; -+ } -+ } -+ -+ DBG_871X("%s, acl_num =%d\n", __func__, pacl_list->num); -+ -+ spin_unlock_bh(&(pacl_node_q->lock)); -+ -+ return ret; -+} -+ -+int rtw_acl_remove_sta(struct adapter *padapter, u8 *addr) -+{ -+ struct list_head *plist, *phead; -+ int ret = 0; -+ struct rtw_wlan_acl_node *paclnode; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ struct __queue *pacl_node_q = &pacl_list->acl_node_q; -+ u8 baddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; /* Baddr is used for clearing acl_list */ -+ -+ DBG_871X( -+ "%s(acl_num =%d) =" MAC_FMT "\n", -+ __func__, -+ pacl_list->num, -+ MAC_ARG(addr) -+ ); -+ -+ spin_lock_bh(&(pacl_node_q->lock)); -+ -+ phead = get_list_head(pacl_node_q); -+ plist = get_next(phead); -+ -+ while (phead != plist) { -+ -+ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); -+ plist = get_next(plist); -+ -+ if ( -+ !memcmp(paclnode->addr, addr, ETH_ALEN) || -+ !memcmp(baddr, addr, ETH_ALEN) -+ ) { -+ -+ if (paclnode->valid == true) { -+ -+ paclnode->valid = false; -+ -+ list_del_init(&paclnode->list); -+ -+ pacl_list->num--; -+ } -+ } -+ } -+ -+ spin_unlock_bh(&(pacl_node_q->lock)); -+ -+ DBG_871X("%s, acl_num =%d\n", __func__, pacl_list->num); -+ -+ return ret; -+ -+} -+ -+u8 rtw_ap_set_pairwise_key(struct adapter *padapter, struct sta_info *psta) -+{ -+ struct cmd_obj *ph2c; -+ struct set_stakey_parm *psetstakey_para; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ psetstakey_para = (struct set_stakey_parm *)rtw_zmalloc( -+ sizeof(struct set_stakey_parm) -+ ); -+ if (psetstakey_para == NULL) { -+ kfree((u8 *) ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); -+ -+ -+ psetstakey_para->algorithm = (u8)psta->dot118021XPrivacy; -+ -+ memcpy(psetstakey_para->addr, psta->hwaddr, ETH_ALEN); -+ -+ memcpy(psetstakey_para->key, &psta->dot118021x_UncstKey, 16); -+ -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+ -+static int rtw_ap_set_key( -+ struct adapter *padapter, -+ u8 *key, -+ u8 alg, -+ int keyid, -+ u8 set_tx -+) -+{ -+ u8 keylen; -+ struct cmd_obj *pcmd; -+ struct setkey_parm *psetkeyparm; -+ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ int res = _SUCCESS; -+ -+ /* DBG_871X("%s\n", __func__); */ -+ -+ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ psetkeyparm = (struct setkey_parm *)rtw_zmalloc(sizeof(struct setkey_parm)); -+ if (psetkeyparm == NULL) { -+ kfree((unsigned char *)pcmd); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ memset(psetkeyparm, 0, sizeof(struct setkey_parm)); -+ -+ psetkeyparm->keyid = (u8)keyid; -+ if (is_wep_enc(alg)) -+ padapter->securitypriv.key_mask |= BIT(psetkeyparm->keyid); -+ -+ psetkeyparm->algorithm = alg; -+ -+ psetkeyparm->set_tx = set_tx; -+ -+ switch (alg) { -+ -+ case _WEP40_: -+ keylen = 5; -+ break; -+ case _WEP104_: -+ keylen = 13; -+ break; -+ case _TKIP_: -+ case _TKIP_WTMIC_: -+ case _AES_: -+ default: -+ keylen = 16; -+ } -+ -+ memcpy(&(psetkeyparm->key[0]), key, keylen); -+ -+ pcmd->cmdcode = _SetKey_CMD_; -+ pcmd->parmbuf = (u8 *)psetkeyparm; -+ pcmd->cmdsz = (sizeof(struct setkey_parm)); -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ -+ INIT_LIST_HEAD(&pcmd->list); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ -+ return res; -+} -+ -+int rtw_ap_set_group_key(struct adapter *padapter, u8 *key, u8 alg, int keyid) -+{ -+ DBG_871X("%s\n", __func__); -+ -+ return rtw_ap_set_key(padapter, key, alg, keyid, 1); -+} -+ -+int rtw_ap_set_wep_key( -+ struct adapter *padapter, -+ u8 *key, -+ u8 keylen, -+ int keyid, -+ u8 set_tx -+) -+{ -+ u8 alg; -+ -+ switch (keylen) { -+ -+ case 5: -+ alg = _WEP40_; -+ break; -+ case 13: -+ alg = _WEP104_; -+ break; -+ default: -+ alg = _NO_PRIVACY_; -+ } -+ -+ DBG_871X("%s\n", __func__); -+ -+ return rtw_ap_set_key(padapter, key, alg, keyid, set_tx); -+} -+ -+static void update_bcn_fixed_ie(struct adapter *padapter) -+{ -+ DBG_871X("%s\n", __func__); -+ -+} -+ -+static void update_bcn_erpinfo_ie(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *pnetwork = &(pmlmeinfo->network); -+ unsigned char *p, *ie = pnetwork->IEs; -+ u32 len = 0; -+ -+ DBG_871X("%s, ERP_enable =%d\n", __func__, pmlmeinfo->ERP_enable); -+ -+ if (!pmlmeinfo->ERP_enable) -+ return; -+ -+ /* parsing ERP_IE */ -+ p = rtw_get_ie( -+ ie + _BEACON_IE_OFFSET_, -+ _ERPINFO_IE_, -+ &len, -+ (pnetwork->IELength - _BEACON_IE_OFFSET_) -+ ); -+ if (p && len > 0) { -+ -+ struct ndis_80211_var_ie *pIE = (struct ndis_80211_var_ie *)p; -+ -+ if (pmlmepriv->num_sta_non_erp == 1) -+ pIE->data[0] |= RTW_ERP_INFO_NON_ERP_PRESENT|RTW_ERP_INFO_USE_PROTECTION; -+ else -+ pIE->data[0] &= ~( -+ RTW_ERP_INFO_NON_ERP_PRESENT|RTW_ERP_INFO_USE_PROTECTION -+ ); -+ -+ if (pmlmepriv->num_sta_no_short_preamble > 0) -+ pIE->data[0] |= RTW_ERP_INFO_BARKER_PREAMBLE_MODE; -+ else -+ pIE->data[0] &= ~(RTW_ERP_INFO_BARKER_PREAMBLE_MODE); -+ -+ ERP_IE_handler(padapter, pIE); -+ } -+ -+} -+ -+static void update_bcn_htcap_ie(struct adapter *padapter) -+{ -+ DBG_871X("%s\n", __func__); -+ -+} -+ -+static void update_bcn_htinfo_ie(struct adapter *padapter) -+{ -+ DBG_871X("%s\n", __func__); -+ -+} -+ -+static void update_bcn_rsn_ie(struct adapter *padapter) -+{ -+ DBG_871X("%s\n", __func__); -+ -+} -+ -+static void update_bcn_wpa_ie(struct adapter *padapter) -+{ -+ DBG_871X("%s\n", __func__); -+ -+} -+ -+static void update_bcn_wmm_ie(struct adapter *padapter) -+{ -+ DBG_871X("%s\n", __func__); -+ -+} -+ -+static void update_bcn_wps_ie(struct adapter *padapter) -+{ -+ u8 *pwps_ie = NULL; -+ u8 *pwps_ie_src; -+ u8 *premainder_ie; -+ u8 *pbackup_remainder_ie = NULL; -+ -+ uint wps_ielen = 0, wps_offset, remainder_ielen; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *pnetwork = &(pmlmeinfo->network); -+ unsigned char *ie = pnetwork->IEs; -+ u32 ielen = pnetwork->IELength; -+ -+ -+ DBG_871X("%s\n", __func__); -+ -+ pwps_ie = rtw_get_wps_ie( -+ ie+_FIXED_IE_LENGTH_, -+ ielen-_FIXED_IE_LENGTH_, -+ NULL, -+ &wps_ielen -+ ); -+ -+ if (pwps_ie == NULL || wps_ielen == 0) -+ return; -+ -+ pwps_ie_src = pmlmepriv->wps_beacon_ie; -+ if (pwps_ie_src == NULL) -+ return; -+ -+ wps_offset = (uint)(pwps_ie-ie); -+ -+ premainder_ie = pwps_ie + wps_ielen; -+ -+ remainder_ielen = ielen - wps_offset - wps_ielen; -+ -+ if (remainder_ielen > 0) { -+ -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if (pbackup_remainder_ie) -+ memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ wps_ielen = (uint)pwps_ie_src[1];/* to get ie data len */ -+ if ((wps_offset+wps_ielen+2+remainder_ielen) <= MAX_IE_SZ) { -+ -+ memcpy(pwps_ie, pwps_ie_src, wps_ielen+2); -+ pwps_ie += (wps_ielen+2); -+ -+ if (pbackup_remainder_ie) -+ memcpy(pwps_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ /* update IELength */ -+ pnetwork->IELength = wps_offset + (wps_ielen+2) + remainder_ielen; -+ } -+ -+ if (pbackup_remainder_ie) -+ kfree(pbackup_remainder_ie); -+ -+ /* deal with the case without set_tx_beacon_cmd() in update_beacon() */ -+#if defined(CONFIG_INTERRUPT_BASED_TXBCN) -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) { -+ -+ u8 sr = 0; -+ -+ rtw_get_wps_attr_content( -+ pwps_ie_src, -+ wps_ielen, -+ WPS_ATTR_SELECTED_REGISTRAR, -+ (u8 *)(&sr), -+ NULL -+ ); -+ -+ if (sr) { -+ set_fwstate(pmlmepriv, WIFI_UNDER_WPS); -+ DBG_871X("%s, set WIFI_UNDER_WPS\n", __func__); -+ } -+ } -+#endif -+} -+ -+static void update_bcn_p2p_ie(struct adapter *padapter) -+{ -+ -+} -+ -+static void update_bcn_vendor_spec_ie(struct adapter *padapter, u8 *oui) -+{ -+ DBG_871X("%s\n", __func__); -+ -+ if (!memcmp(RTW_WPA_OUI, oui, 4)) -+ update_bcn_wpa_ie(padapter); -+ -+ else if (!memcmp(WMM_OUI, oui, 4)) -+ update_bcn_wmm_ie(padapter); -+ -+ else if (!memcmp(WPS_OUI, oui, 4)) -+ update_bcn_wps_ie(padapter); -+ -+ else if (!memcmp(P2P_OUI, oui, 4)) -+ update_bcn_p2p_ie(padapter); -+ -+ else -+ DBG_871X("unknown OUI type!\n"); -+ -+ -+ -+} -+ -+void update_beacon(struct adapter *padapter, u8 ie_id, u8 *oui, u8 tx) -+{ -+ struct mlme_priv *pmlmepriv; -+ struct mlme_ext_priv *pmlmeext; -+ /* struct mlme_ext_info *pmlmeinfo; */ -+ -+ /* DBG_871X("%s\n", __func__); */ -+ -+ if (!padapter) -+ return; -+ -+ pmlmepriv = &(padapter->mlmepriv); -+ pmlmeext = &(padapter->mlmeextpriv); -+ /* pmlmeinfo = &(pmlmeext->mlmext_info); */ -+ -+ if (false == pmlmeext->bstart_bss) -+ return; -+ -+ spin_lock_bh(&pmlmepriv->bcn_update_lock); -+ -+ switch (ie_id) { -+ -+ case 0xFF: -+ -+ update_bcn_fixed_ie(padapter);/* 8: TimeStamp, 2: Beacon Interval 2:Capability */ -+ -+ break; -+ -+ case _TIM_IE_: -+ -+ update_BCNTIM(padapter); -+ -+ break; -+ -+ case _ERPINFO_IE_: -+ -+ update_bcn_erpinfo_ie(padapter); -+ -+ break; -+ -+ case _HT_CAPABILITY_IE_: -+ -+ update_bcn_htcap_ie(padapter); -+ -+ break; -+ -+ case _RSN_IE_2_: -+ -+ update_bcn_rsn_ie(padapter); -+ -+ break; -+ -+ case _HT_ADD_INFO_IE_: -+ -+ update_bcn_htinfo_ie(padapter); -+ -+ break; -+ -+ case _VENDOR_SPECIFIC_IE_: -+ -+ update_bcn_vendor_spec_ie(padapter, oui); -+ -+ break; -+ -+ default: -+ break; -+ } -+ -+ pmlmepriv->update_bcn = true; -+ -+ spin_unlock_bh(&pmlmepriv->bcn_update_lock); -+ -+#ifndef CONFIG_INTERRUPT_BASED_TXBCN -+ if (tx) { -+ -+ /* send_beacon(padapter);//send_beacon must execute on TSR level */ -+ set_tx_beacon_cmd(padapter); -+ } -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN */ -+ -+} -+ -+/* -+op_mode -+Set to 0 (HT pure) under the followign conditions -+ - all STAs in the BSS are 20/40 MHz HT in 20/40 MHz BSS or -+ - all STAs in the BSS are 20 MHz HT in 20 MHz BSS -+Set to 1 (HT non-member protection) if there may be non-HT STAs -+ in both the primary and the secondary channel -+Set to 2 if only HT STAs are associated in BSS, -+ however and at least one 20 MHz HT STA is associated -+Set to 3 (HT mixed mode) when one or more non-HT STAs are associated -+ (currently non-GF HT station is considered as non-HT STA also) -+*/ -+static int rtw_ht_operation_update(struct adapter *padapter) -+{ -+ u16 cur_op_mode, new_op_mode; -+ int op_mode_changes = 0; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; -+ -+ if (pmlmepriv->htpriv.ht_option == true) -+ return 0; -+ -+ /* if (!iface->conf->ieee80211n || iface->conf->ht_op_mode_fixed) */ -+ /* return 0; */ -+ -+ DBG_871X("%s current operation mode = 0x%X\n", -+ __func__, pmlmepriv->ht_op_mode); -+ -+ if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT) -+ && pmlmepriv->num_sta_ht_no_gf) { -+ pmlmepriv->ht_op_mode |= -+ HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT; -+ op_mode_changes++; -+ } else if ((pmlmepriv->ht_op_mode & -+ HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT) && -+ pmlmepriv->num_sta_ht_no_gf == 0) { -+ pmlmepriv->ht_op_mode &= -+ ~HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT; -+ op_mode_changes++; -+ } -+ -+ if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) && -+ (pmlmepriv->num_sta_no_ht || pmlmepriv->olbc_ht)) { -+ pmlmepriv->ht_op_mode |= HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT; -+ op_mode_changes++; -+ } else if ((pmlmepriv->ht_op_mode & -+ HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) && -+ (pmlmepriv->num_sta_no_ht == 0 && !pmlmepriv->olbc_ht)) { -+ pmlmepriv->ht_op_mode &= -+ ~HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT; -+ op_mode_changes++; -+ } -+ -+ /* Note: currently we switch to the MIXED op mode if HT non-greenfield -+ * station is associated. Probably it's a theoretical case, since -+ * it looks like all known HT STAs support greenfield. -+ */ -+ new_op_mode = 0; -+ if (pmlmepriv->num_sta_no_ht || -+ (pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT)) -+ new_op_mode = OP_MODE_MIXED; -+ else if ( -+ (le16_to_cpu(phtpriv_ap->ht_cap.cap_info) & IEEE80211_HT_CAP_SUP_WIDTH) -+ && pmlmepriv->num_sta_ht_20mhz) -+ new_op_mode = OP_MODE_20MHZ_HT_STA_ASSOCED; -+ else if (pmlmepriv->olbc_ht) -+ new_op_mode = OP_MODE_MAY_BE_LEGACY_STAS; -+ else -+ new_op_mode = OP_MODE_PURE; -+ -+ cur_op_mode = pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_OP_MODE_MASK; -+ if (cur_op_mode != new_op_mode) { -+ pmlmepriv->ht_op_mode &= ~HT_INFO_OPERATION_MODE_OP_MODE_MASK; -+ pmlmepriv->ht_op_mode |= new_op_mode; -+ op_mode_changes++; -+ } -+ -+ DBG_871X("%s new operation mode = 0x%X changes =%d\n", -+ __func__, pmlmepriv->ht_op_mode, op_mode_changes); -+ -+ return op_mode_changes; -+ -+} -+ -+void associated_clients_update(struct adapter *padapter, u8 updated) -+{ -+ /* update associcated stations cap. */ -+ if (updated == true) { -+ -+ struct list_head *phead, *plist; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* check asoc_queue */ -+ while (phead != plist) { -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ VCS_update(padapter, psta); -+ } -+ -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+ } -+ -+} -+ -+/* called > TSR LEVEL for USB or SDIO Interface*/ -+void bss_cap_update_on_sta_join(struct adapter *padapter, struct sta_info *psta) -+{ -+ u8 beacon_updated = false; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ if (!(psta->flags & WLAN_STA_SHORT_PREAMBLE)) { -+ -+ if (!psta->no_short_preamble_set) { -+ -+ psta->no_short_preamble_set = 1; -+ -+ pmlmepriv->num_sta_no_short_preamble++; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_preamble == 1)) { -+ -+ beacon_updated = true; -+ update_beacon(padapter, 0xFF, NULL, true); -+ } -+ -+ } -+ } else{ -+ -+ -+ if (psta->no_short_preamble_set) { -+ -+ psta->no_short_preamble_set = 0; -+ -+ pmlmepriv->num_sta_no_short_preamble--; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_preamble == 0)) { -+ -+ beacon_updated = true; -+ update_beacon(padapter, 0xFF, NULL, true); -+ } -+ -+ } -+ } -+ -+ if (psta->flags & WLAN_STA_NONERP) { -+ -+ if (!psta->nonerp_set) { -+ -+ psta->nonerp_set = 1; -+ -+ pmlmepriv->num_sta_non_erp++; -+ -+ if (pmlmepriv->num_sta_non_erp == 1) { -+ -+ beacon_updated = true; -+ update_beacon(padapter, _ERPINFO_IE_, NULL, true); -+ } -+ } -+ -+ } else{ -+ -+ -+ if (psta->nonerp_set) { -+ -+ psta->nonerp_set = 0; -+ -+ pmlmepriv->num_sta_non_erp--; -+ -+ if (pmlmepriv->num_sta_non_erp == 0) { -+ -+ beacon_updated = true; -+ update_beacon(padapter, _ERPINFO_IE_, NULL, true); -+ } -+ } -+ -+ } -+ -+ -+ if (!(psta->capability & WLAN_CAPABILITY_SHORT_SLOT)) { -+ -+ if (!psta->no_short_slot_time_set) { -+ -+ psta->no_short_slot_time_set = 1; -+ -+ pmlmepriv->num_sta_no_short_slot_time++; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_slot_time == 1)) { -+ -+ beacon_updated = true; -+ update_beacon(padapter, 0xFF, NULL, true); -+ } -+ -+ } -+ } else{ -+ -+ -+ if (psta->no_short_slot_time_set) { -+ -+ psta->no_short_slot_time_set = 0; -+ -+ pmlmepriv->num_sta_no_short_slot_time--; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_slot_time == 0)) { -+ -+ beacon_updated = true; -+ update_beacon(padapter, 0xFF, NULL, true); -+ } -+ } -+ } -+ -+ if (psta->flags & WLAN_STA_HT) { -+ -+ u16 ht_capab = le16_to_cpu(psta->htpriv.ht_cap.cap_info); -+ -+ DBG_871X("HT: STA " MAC_FMT " HT Capabilities " -+ "Info: 0x%04x\n", MAC_ARG(psta->hwaddr), ht_capab); -+ -+ if (psta->no_ht_set) { -+ psta->no_ht_set = 0; -+ pmlmepriv->num_sta_no_ht--; -+ } -+ -+ if ((ht_capab & IEEE80211_HT_CAP_GRN_FLD) == 0) { -+ if (!psta->no_ht_gf_set) { -+ psta->no_ht_gf_set = 1; -+ pmlmepriv->num_sta_ht_no_gf++; -+ } -+ DBG_871X("%s STA " MAC_FMT " - no " -+ "greenfield, num of non-gf stations %d\n", -+ __func__, MAC_ARG(psta->hwaddr), -+ pmlmepriv->num_sta_ht_no_gf); -+ } -+ -+ if ((ht_capab & IEEE80211_HT_CAP_SUP_WIDTH) == 0) { -+ if (!psta->ht_20mhz_set) { -+ psta->ht_20mhz_set = 1; -+ pmlmepriv->num_sta_ht_20mhz++; -+ } -+ DBG_871X("%s STA " MAC_FMT " - 20 MHz HT, " -+ "num of 20MHz HT STAs %d\n", -+ __func__, MAC_ARG(psta->hwaddr), -+ pmlmepriv->num_sta_ht_20mhz); -+ } -+ -+ } else{ -+ -+ -+ if (!psta->no_ht_set) { -+ psta->no_ht_set = 1; -+ pmlmepriv->num_sta_no_ht++; -+ } -+ if (pmlmepriv->htpriv.ht_option == true) { -+ DBG_871X("%s STA " MAC_FMT -+ " - no HT, num of non-HT stations %d\n", -+ __func__, MAC_ARG(psta->hwaddr), -+ pmlmepriv->num_sta_no_ht); -+ } -+ } -+ -+ if (rtw_ht_operation_update(padapter) > 0) { -+ -+ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, false); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, true); -+ } -+ -+ /* update associcated stations cap. */ -+ associated_clients_update(padapter, beacon_updated); -+ -+ DBG_871X("%s, updated =%d\n", __func__, beacon_updated); -+ -+} -+ -+u8 bss_cap_update_on_sta_leave(struct adapter *padapter, struct sta_info *psta) -+{ -+ u8 beacon_updated = false; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ if (!psta) -+ return beacon_updated; -+ -+ if (psta->no_short_preamble_set) { -+ psta->no_short_preamble_set = 0; -+ pmlmepriv->num_sta_no_short_preamble--; -+ if (pmlmeext->cur_wireless_mode > WIRELESS_11B -+ && pmlmepriv->num_sta_no_short_preamble == 0){ -+ -+ beacon_updated = true; -+ update_beacon(padapter, 0xFF, NULL, true); -+ } -+ } -+ -+ if (psta->nonerp_set) { -+ psta->nonerp_set = 0; -+ pmlmepriv->num_sta_non_erp--; -+ if (pmlmepriv->num_sta_non_erp == 0) { -+ -+ beacon_updated = true; -+ update_beacon(padapter, _ERPINFO_IE_, NULL, true); -+ } -+ } -+ -+ if (psta->no_short_slot_time_set) { -+ psta->no_short_slot_time_set = 0; -+ pmlmepriv->num_sta_no_short_slot_time--; -+ if (pmlmeext->cur_wireless_mode > WIRELESS_11B -+ && pmlmepriv->num_sta_no_short_slot_time == 0){ -+ -+ beacon_updated = true; -+ update_beacon(padapter, 0xFF, NULL, true); -+ } -+ } -+ -+ if (psta->no_ht_gf_set) { -+ psta->no_ht_gf_set = 0; -+ pmlmepriv->num_sta_ht_no_gf--; -+ } -+ -+ if (psta->no_ht_set) { -+ psta->no_ht_set = 0; -+ pmlmepriv->num_sta_no_ht--; -+ } -+ -+ if (psta->ht_20mhz_set) { -+ psta->ht_20mhz_set = 0; -+ pmlmepriv->num_sta_ht_20mhz--; -+ } -+ -+ if (rtw_ht_operation_update(padapter) > 0) { -+ -+ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, false); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, true); -+ } -+ -+ /* update associcated stations cap. */ -+ /* associated_clients_update(padapter, beacon_updated); //move it to avoid deadlock */ -+ -+ DBG_871X("%s, updated =%d\n", __func__, beacon_updated); -+ -+ return beacon_updated; -+ -+} -+ -+u8 ap_free_sta( -+ struct adapter *padapter, -+ struct sta_info *psta, -+ bool active, -+ u16 reason -+) -+{ -+ u8 beacon_updated = false; -+ -+ if (!psta) -+ return beacon_updated; -+ -+ if (active == true) { -+ -+ /* tear down Rx AMPDU */ -+ send_delba(padapter, 0, psta->hwaddr);/* recipient */ -+ -+ /* tear down TX AMPDU */ -+ send_delba(padapter, 1, psta->hwaddr);/* // originator */ -+ -+ issue_deauth(padapter, psta->hwaddr, reason); -+ } -+ -+ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ -+ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ -+ -+ -+ /* report_del_sta_event(padapter, psta->hwaddr, reason); */ -+ -+ /* clear cam entry / key */ -+ rtw_clearstakey_cmd(padapter, psta, true); -+ -+ -+ spin_lock_bh(&psta->lock); -+ psta->state &= ~_FW_LINKED; -+ spin_unlock_bh(&psta->lock); -+ -+ rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason); -+ -+ report_del_sta_event(padapter, psta->hwaddr, reason); -+ -+ beacon_updated = bss_cap_update_on_sta_leave(padapter, psta); -+ -+ rtw_free_stainfo(padapter, psta); -+ -+ -+ return beacon_updated; -+ -+} -+ -+int rtw_sta_flush(struct adapter *padapter) -+{ -+ struct list_head *phead, *plist; -+ int ret = 0; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev)); -+ -+ if ((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) -+ return ret; -+ -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* free sta asoc_queue */ -+ while (phead != plist) { -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ list_del_init(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ -+ /* spin_unlock_bh(&pstapriv->asoc_list_lock); */ -+ ap_free_sta(padapter, psta, true, WLAN_REASON_DEAUTH_LEAVING); -+ /* spin_lock_bh(&pstapriv->asoc_list_lock); */ -+ } -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+ -+ issue_deauth(padapter, bc_addr, WLAN_REASON_DEAUTH_LEAVING); -+ -+ associated_clients_update(padapter, true); -+ -+ return ret; -+ -+} -+ -+/* called > TSR LEVEL for USB or SDIO Interface*/ -+void sta_info_update(struct adapter *padapter, struct sta_info *psta) -+{ -+ int flags = psta->flags; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ -+ /* update wmm cap. */ -+ if (WLAN_STA_WME&flags) -+ psta->qos_option = 1; -+ else -+ psta->qos_option = 0; -+ -+ if (pmlmepriv->qospriv.qos_option == 0) -+ psta->qos_option = 0; -+ -+ /* update 802.11n ht cap. */ -+ if (WLAN_STA_HT&flags) { -+ -+ psta->htpriv.ht_option = true; -+ psta->qos_option = 1; -+ } else{ -+ -+ -+ psta->htpriv.ht_option = false; -+ } -+ -+ if (pmlmepriv->htpriv.ht_option == false) -+ psta->htpriv.ht_option = false; -+ -+ update_sta_info_apmode(padapter, psta); -+ -+ -+} -+ -+/* called >= TSR LEVEL for USB or SDIO Interface*/ -+void ap_sta_info_defer_update(struct adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (psta->state & _FW_LINKED) { -+ -+ pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta; -+ -+ /* add ratid */ -+ add_RATid(padapter, psta, 0);/* DM_RATR_STA_INIT */ -+ } -+} -+/* restore hw setting from sw data structures */ -+void rtw_ap_restore_network(struct adapter *padapter) -+{ -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ struct list_head *phead, *plist; -+ u8 chk_alive_num = 0; -+ char chk_alive_list[NUM_STA]; -+ int i; -+ -+ rtw_setopmode_cmd(padapter, Ndis802_11APMode, false); -+ -+ set_channel_bwmode( -+ padapter, -+ pmlmeext->cur_channel, -+ pmlmeext->cur_ch_offset, -+ pmlmeext->cur_bwmode -+ ); -+ -+ start_bss_network(padapter, (u8 *)&mlmepriv->cur_network.network); -+ -+ if ((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) { -+ -+ /* restore group key, WEP keys is restored in ips_leave() */ -+ rtw_set_key( -+ padapter, -+ psecuritypriv, -+ psecuritypriv->dot118021XGrpKeyid, -+ 0, -+ false -+ ); -+ } -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ while (phead != plist) { -+ int stainfo_offset; -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ chk_alive_list[chk_alive_num++] = stainfo_offset; -+ -+ } -+ -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+ for (i = 0; i < chk_alive_num; i++) { -+ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); -+ -+ if (psta == NULL) { -+ DBG_871X(FUNC_ADPT_FMT" sta_info is null\n", FUNC_ADPT_ARG(padapter)); -+ } else if (psta->state & _FW_LINKED) { -+ rtw_sta_media_status_rpt(padapter, psta, 1); -+ Update_RA_Entry(padapter, psta); -+ /* pairwise key */ -+ /* per sta pairwise key and settings */ -+ if ((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) { -+ -+ rtw_setstakey_cmd(padapter, psta, true, false); -+ } -+ } -+ } -+ -+} -+ -+void start_ap_mode(struct adapter *padapter) -+{ -+ int i; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ -+ pmlmepriv->update_bcn = false; -+ -+ /* init_mlme_ap_info(padapter); */ -+ pmlmeext->bstart_bss = false; -+ -+ pmlmepriv->num_sta_non_erp = 0; -+ -+ pmlmepriv->num_sta_no_short_slot_time = 0; -+ -+ pmlmepriv->num_sta_no_short_preamble = 0; -+ -+ pmlmepriv->num_sta_ht_no_gf = 0; -+ pmlmepriv->num_sta_no_ht = 0; -+ pmlmepriv->num_sta_ht_20mhz = 0; -+ -+ pmlmepriv->olbc = false; -+ -+ pmlmepriv->olbc_ht = false; -+ -+ pmlmepriv->ht_op_mode = 0; -+ -+ for (i = 0; i < NUM_STA; i++) -+ pstapriv->sta_aid[i] = NULL; -+ -+ pmlmepriv->wps_beacon_ie = NULL; -+ pmlmepriv->wps_probe_resp_ie = NULL; -+ pmlmepriv->wps_assoc_resp_ie = NULL; -+ -+ pmlmepriv->p2p_beacon_ie = NULL; -+ pmlmepriv->p2p_probe_resp_ie = NULL; -+ -+ -+ /* for ACL */ -+ INIT_LIST_HEAD(&(pacl_list->acl_node_q.queue)); -+ pacl_list->num = 0; -+ pacl_list->mode = 0; -+ for (i = 0; i < NUM_ACL; i++) { -+ INIT_LIST_HEAD(&pacl_list->aclnode[i].list); -+ pacl_list->aclnode[i].valid = false; -+ } -+ -+} -+ -+void stop_ap_mode(struct adapter *padapter) -+{ -+ struct list_head *phead, *plist; -+ struct rtw_wlan_acl_node *paclnode; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ struct __queue *pacl_node_q = &pacl_list->acl_node_q; -+ -+ pmlmepriv->update_bcn = false; -+ pmlmeext->bstart_bss = false; -+ -+ /* reset and init security priv , this can refine with rtw_reset_securitypriv */ -+ memset( -+ (unsigned char *)&padapter->securitypriv, -+ 0, -+ sizeof(struct security_priv) -+ ); -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled; -+ -+ /* for ACL */ -+ spin_lock_bh(&(pacl_node_q->lock)); -+ phead = get_list_head(pacl_node_q); -+ plist = get_next(phead); -+ while (phead != plist) { -+ -+ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); -+ plist = get_next(plist); -+ -+ if (paclnode->valid == true) { -+ -+ paclnode->valid = false; -+ -+ list_del_init(&paclnode->list); -+ -+ pacl_list->num--; -+ } -+ } -+ spin_unlock_bh(&(pacl_node_q->lock)); -+ -+ DBG_871X("%s, free acl_node_queue, num =%d\n", __func__, pacl_list->num); -+ -+ rtw_sta_flush(padapter); -+ -+ /* free_assoc_sta_resources */ -+ rtw_free_all_stainfo(padapter); -+ -+ psta = rtw_get_bcmc_stainfo(padapter); -+ rtw_free_stainfo(padapter, psta); -+ -+ rtw_init_bcmc_stainfo(padapter); -+ -+ rtw_free_mlme_priv_ie_data(pmlmepriv); -+ -+ rtw_btcoex_MediaStatusNotify(padapter, 0); /* disconnect */ -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_btcoex.c linux/3rdparty/rtl8723bs/core/rtw_btcoex.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_btcoex.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_btcoex.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,243 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#include -+#include -+#include -+#include -+ -+ -+void rtw_btcoex_Initialize(struct adapter *padapter) -+{ -+ hal_btcoex_Initialize(padapter); -+} -+ -+void rtw_btcoex_PowerOnSetting(struct adapter *padapter) -+{ -+ hal_btcoex_PowerOnSetting(padapter); -+} -+ -+void rtw_btcoex_HAL_Initialize(struct adapter *padapter, u8 bWifiOnly) -+{ -+ hal_btcoex_InitHwConfig(padapter, bWifiOnly); -+} -+ -+void rtw_btcoex_IpsNotify(struct adapter *padapter, u8 type) -+{ -+ hal_btcoex_IpsNotify(padapter, type); -+} -+ -+void rtw_btcoex_LpsNotify(struct adapter *padapter, u8 type) -+{ -+ hal_btcoex_LpsNotify(padapter, type); -+} -+ -+void rtw_btcoex_ScanNotify(struct adapter *padapter, u8 type) -+{ -+ hal_btcoex_ScanNotify(padapter, type); -+} -+ -+void rtw_btcoex_ConnectNotify(struct adapter *padapter, u8 action) -+{ -+ hal_btcoex_ConnectNotify(padapter, action); -+} -+ -+void rtw_btcoex_MediaStatusNotify(struct adapter *padapter, u8 mediaStatus) -+{ -+ if ((RT_MEDIA_CONNECT == mediaStatus) -+ && (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == true)) { -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_RSVD_PAGE, NULL); -+ } -+ -+ hal_btcoex_MediaStatusNotify(padapter, mediaStatus); -+} -+ -+void rtw_btcoex_SpecialPacketNotify(struct adapter *padapter, u8 pktType) -+{ -+ hal_btcoex_SpecialPacketNotify(padapter, pktType); -+} -+ -+void rtw_btcoex_IQKNotify(struct adapter *padapter, u8 state) -+{ -+ hal_btcoex_IQKNotify(padapter, state); -+} -+ -+void rtw_btcoex_BtInfoNotify(struct adapter *padapter, u8 length, u8 *tmpBuf) -+{ -+ hal_btcoex_BtInfoNotify(padapter, length, tmpBuf); -+} -+ -+void rtw_btcoex_SuspendNotify(struct adapter *padapter, u8 state) -+{ -+ hal_btcoex_SuspendNotify(padapter, state); -+} -+ -+void rtw_btcoex_HaltNotify(struct adapter *padapter) -+{ -+ if (false == padapter->bup) { -+ DBG_871X(FUNC_ADPT_FMT ": bup =%d Skip!\n", -+ FUNC_ADPT_ARG(padapter), padapter->bup); -+ -+ return; -+ } -+ -+ if (true == padapter->bSurpriseRemoved) { -+ DBG_871X(FUNC_ADPT_FMT ": bSurpriseRemoved =%d Skip!\n", -+ FUNC_ADPT_ARG(padapter), padapter->bSurpriseRemoved); -+ -+ return; -+ } -+ -+ hal_btcoex_HaltNotify(padapter); -+} -+ -+u8 rtw_btcoex_IsBtDisabled(struct adapter *padapter) -+{ -+ return hal_btcoex_IsBtDisabled(padapter); -+} -+ -+void rtw_btcoex_Handler(struct adapter *padapter) -+{ -+ hal_btcoex_Hanlder(padapter); -+} -+ -+s32 rtw_btcoex_IsBTCoexCtrlAMPDUSize(struct adapter *padapter) -+{ -+ s32 coexctrl; -+ -+ coexctrl = hal_btcoex_IsBTCoexCtrlAMPDUSize(padapter); -+ -+ return coexctrl; -+} -+ -+void rtw_btcoex_SetManualControl(struct adapter *padapter, u8 manual) -+{ -+ if (true == manual) { -+ hal_btcoex_SetManualControl(padapter, true); -+ } else{ -+ hal_btcoex_SetManualControl(padapter, false); -+ } -+} -+ -+u8 rtw_btcoex_IsBtControlLps(struct adapter *padapter) -+{ -+ return hal_btcoex_IsBtControlLps(padapter); -+} -+ -+u8 rtw_btcoex_IsLpsOn(struct adapter *padapter) -+{ -+ return hal_btcoex_IsLpsOn(padapter); -+} -+ -+u8 rtw_btcoex_RpwmVal(struct adapter *padapter) -+{ -+ return hal_btcoex_RpwmVal(padapter); -+} -+ -+u8 rtw_btcoex_LpsVal(struct adapter *padapter) -+{ -+ return hal_btcoex_LpsVal(padapter); -+} -+ -+void rtw_btcoex_SetBTCoexist(struct adapter *padapter, u8 bBtExist) -+{ -+ hal_btcoex_SetBTCoexist(padapter, bBtExist); -+} -+ -+void rtw_btcoex_SetChipType(struct adapter *padapter, u8 chipType) -+{ -+ hal_btcoex_SetChipType(padapter, chipType); -+} -+ -+void rtw_btcoex_SetPGAntNum(struct adapter *padapter, u8 antNum) -+{ -+ hal_btcoex_SetPgAntNum(padapter, antNum); -+} -+ -+void rtw_btcoex_SetSingleAntPath(struct adapter *padapter, u8 singleAntPath) -+{ -+ hal_btcoex_SetSingleAntPath(padapter, singleAntPath); -+} -+ -+u32 rtw_btcoex_GetRaMask(struct adapter *padapter) -+{ -+ return hal_btcoex_GetRaMask(padapter); -+} -+ -+void rtw_btcoex_RecordPwrMode(struct adapter *padapter, u8 *pCmdBuf, u8 cmdLen) -+{ -+ hal_btcoex_RecordPwrMode(padapter, pCmdBuf, cmdLen); -+} -+ -+void rtw_btcoex_DisplayBtCoexInfo(struct adapter *padapter, u8 *pbuf, u32 bufsize) -+{ -+ hal_btcoex_DisplayBtCoexInfo(padapter, pbuf, bufsize); -+} -+ -+void rtw_btcoex_SetDBG(struct adapter *padapter, u32 *pDbgModule) -+{ -+ hal_btcoex_SetDBG(padapter, pDbgModule); -+} -+ -+u32 rtw_btcoex_GetDBG(struct adapter *padapter, u8 *pStrBuf, u32 bufSize) -+{ -+ return hal_btcoex_GetDBG(padapter, pStrBuf, bufSize); -+} -+ -+/* ================================================== */ -+/* Below Functions are called by BT-Coex */ -+/* ================================================== */ -+void rtw_btcoex_RejectApAggregatedPacket(struct adapter *padapter, u8 enable) -+{ -+ struct mlme_ext_info *pmlmeinfo; -+ struct sta_info *psta; -+ -+ pmlmeinfo = &padapter->mlmeextpriv.mlmext_info; -+ psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); -+ -+ if (true == enable) { -+ pmlmeinfo->bAcceptAddbaReq = false; -+ if (psta) -+ send_delba(padapter, 0, psta->hwaddr); -+ } else{ -+ pmlmeinfo->bAcceptAddbaReq = true; -+ } -+} -+ -+void rtw_btcoex_LPS_Enter(struct adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ u8 lpsVal; -+ -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ pwrpriv->bpower_saving = true; -+ lpsVal = rtw_btcoex_LpsVal(padapter); -+ rtw_set_ps_mode(padapter, PS_MODE_MIN, 0, lpsVal, "BTCOEX"); -+} -+ -+void rtw_btcoex_LPS_Leave(struct adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) { -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "BTCOEX"); -+ LPS_RF_ON_check(padapter, 100); -+ pwrpriv->bpower_saving = false; -+ } -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_cmd.c linux/3rdparty/rtl8723bs/core/rtw_cmd.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_cmd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_cmd.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,2244 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_CMD_C_ -+ -+#include -+#include -+#include -+ -+static struct _cmd_callback rtw_cmd_callback[] = { -+ {GEN_CMD_CODE(_Read_MACREG), NULL}, /*0*/ -+ {GEN_CMD_CODE(_Write_MACREG), NULL}, -+ {GEN_CMD_CODE(_Read_BBREG), &rtw_getbbrfreg_cmdrsp_callback}, -+ {GEN_CMD_CODE(_Write_BBREG), NULL}, -+ {GEN_CMD_CODE(_Read_RFREG), &rtw_getbbrfreg_cmdrsp_callback}, -+ {GEN_CMD_CODE(_Write_RFREG), NULL}, /*5*/ -+ {GEN_CMD_CODE(_Read_EEPROM), NULL}, -+ {GEN_CMD_CODE(_Write_EEPROM), NULL}, -+ {GEN_CMD_CODE(_Read_EFUSE), NULL}, -+ {GEN_CMD_CODE(_Write_EFUSE), NULL}, -+ -+ {GEN_CMD_CODE(_Read_CAM), NULL}, /*10*/ -+ {GEN_CMD_CODE(_Write_CAM), NULL}, -+ {GEN_CMD_CODE(_setBCNITV), NULL}, -+ {GEN_CMD_CODE(_setMBIDCFG), NULL}, -+ {GEN_CMD_CODE(_JoinBss), &rtw_joinbss_cmd_callback}, /*14*/ -+ {GEN_CMD_CODE(_DisConnect), &rtw_disassoc_cmd_callback}, /*15*/ -+ {GEN_CMD_CODE(_CreateBss), &rtw_createbss_cmd_callback}, -+ {GEN_CMD_CODE(_SetOpMode), NULL}, -+ {GEN_CMD_CODE(_SiteSurvey), &rtw_survey_cmd_callback}, /*18*/ -+ {GEN_CMD_CODE(_SetAuth), NULL}, -+ -+ {GEN_CMD_CODE(_SetKey), NULL}, /*20*/ -+ {GEN_CMD_CODE(_SetStaKey), &rtw_setstaKey_cmdrsp_callback}, -+ {GEN_CMD_CODE(_SetAssocSta), &rtw_setassocsta_cmdrsp_callback}, -+ {GEN_CMD_CODE(_DelAssocSta), NULL}, -+ {GEN_CMD_CODE(_SetStaPwrState), NULL}, -+ {GEN_CMD_CODE(_SetBasicRate), NULL}, /*25*/ -+ {GEN_CMD_CODE(_GetBasicRate), NULL}, -+ {GEN_CMD_CODE(_SetDataRate), NULL}, -+ {GEN_CMD_CODE(_GetDataRate), NULL}, -+ {GEN_CMD_CODE(_SetPhyInfo), NULL}, -+ -+ {GEN_CMD_CODE(_GetPhyInfo), NULL}, /*30*/ -+ {GEN_CMD_CODE(_SetPhy), NULL}, -+ {GEN_CMD_CODE(_GetPhy), NULL}, -+ {GEN_CMD_CODE(_readRssi), NULL}, -+ {GEN_CMD_CODE(_readGain), NULL}, -+ {GEN_CMD_CODE(_SetAtim), NULL}, /*35*/ -+ {GEN_CMD_CODE(_SetPwrMode), NULL}, -+ {GEN_CMD_CODE(_JoinbssRpt), NULL}, -+ {GEN_CMD_CODE(_SetRaTable), NULL}, -+ {GEN_CMD_CODE(_GetRaTable), NULL}, -+ -+ {GEN_CMD_CODE(_GetCCXReport), NULL}, /*40*/ -+ {GEN_CMD_CODE(_GetDTMReport), NULL}, -+ {GEN_CMD_CODE(_GetTXRateStatistics), NULL}, -+ {GEN_CMD_CODE(_SetUsbSuspend), NULL}, -+ {GEN_CMD_CODE(_SetH2cLbk), NULL}, -+ {GEN_CMD_CODE(_AddBAReq), NULL}, /*45*/ -+ {GEN_CMD_CODE(_SetChannel), NULL}, /*46*/ -+ {GEN_CMD_CODE(_SetTxPower), NULL}, -+ {GEN_CMD_CODE(_SwitchAntenna), NULL}, -+ {GEN_CMD_CODE(_SetCrystalCap), NULL}, -+ {GEN_CMD_CODE(_SetSingleCarrierTx), NULL}, /*50*/ -+ -+ {GEN_CMD_CODE(_SetSingleToneTx), NULL}, /*51*/ -+ {GEN_CMD_CODE(_SetCarrierSuppressionTx), NULL}, -+ {GEN_CMD_CODE(_SetContinuousTx), NULL}, -+ {GEN_CMD_CODE(_SwitchBandwidth), NULL}, /*54*/ -+ {GEN_CMD_CODE(_TX_Beacon), NULL},/*55*/ -+ -+ {GEN_CMD_CODE(_Set_MLME_EVT), NULL},/*56*/ -+ {GEN_CMD_CODE(_Set_Drv_Extra), NULL},/*57*/ -+ {GEN_CMD_CODE(_Set_H2C_MSG), NULL},/*58*/ -+ {GEN_CMD_CODE(_SetChannelPlan), NULL},/*59*/ -+ {GEN_CMD_CODE(_LedBlink), NULL},/*60*/ -+ -+ {GEN_CMD_CODE(_SetChannelSwitch), NULL},/*61*/ -+ {GEN_CMD_CODE(_TDLS), NULL},/*62*/ -+ {GEN_CMD_CODE(_ChkBMCSleepq), NULL}, /*63*/ -+ -+ {GEN_CMD_CODE(_RunInThreadCMD), NULL},/*64*/ -+}; -+ -+static struct cmd_hdl wlancmds[] = { -+ GEN_DRV_CMD_HANDLER(0, NULL) /*0*/ -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) /*10*/ -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct joinbss_parm), join_cmd_hdl) /*14*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct disconnect_parm), disconnect_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof(struct createbss_parm), createbss_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof(struct setopmode_parm), setopmode_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof(struct sitesurvey_parm), sitesurvey_cmd_hdl) /*18*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct setauth_parm), setauth_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof(struct setkey_parm), setkey_hdl) /*20*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct set_stakey_parm), set_stakey_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof(struct set_assocsta_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct del_assocsta_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct setstapwrstate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct setbasicrate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct getbasicrate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct setdatarate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct getdatarate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct setphyinfo_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct getphyinfo_parm), NULL) /*30*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct setphy_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct getphy_parm), NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) /*40*/ -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct addBaReq_parm), add_ba_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof(struct set_ch_parm), set_ch_hdl) /* 46 */ -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) /*50*/ -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct Tx_Beacon_param), tx_beacon_hdl) /*55*/ -+ -+ GEN_MLME_EXT_HANDLER(0, mlme_evt_hdl) /*56*/ -+ GEN_MLME_EXT_HANDLER(0, rtw_drvextra_cmd_hdl) /*57*/ -+ -+ GEN_MLME_EXT_HANDLER(0, h2c_msg_hdl) /*58*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct SetChannelPlan_param), set_chplan_hdl) /*59*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct LedBlink_param), led_blink_hdl) /*60*/ -+ -+ GEN_MLME_EXT_HANDLER(sizeof(struct SetChannelSwitch_param), set_csa_hdl) /*61*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct TDLSoption_param), tdls_hdl) /*62*/ -+ GEN_MLME_EXT_HANDLER(0, chk_bmc_sleepq_hdl) /*63*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct RunInThread_param), run_in_thread_hdl) /*63*/ -+}; -+ -+/* -+Caller and the rtw_cmd_thread can protect cmd_q by spin_lock. -+No irqsave is necessary. -+*/ -+ -+sint _rtw_init_cmd_priv(struct cmd_priv *pcmdpriv) -+{ -+ sint res = _SUCCESS; -+ -+ sema_init(&(pcmdpriv->cmd_queue_sema), 0); -+ /* sema_init(&(pcmdpriv->cmd_done_sema), 0); */ -+ sema_init(&(pcmdpriv->terminate_cmdthread_sema), 0); -+ -+ -+ _rtw_init_queue(&(pcmdpriv->cmd_queue)); -+ -+ /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */ -+ -+ pcmdpriv->cmd_seq = 1; -+ -+ pcmdpriv->cmd_allocated_buf = rtw_zmalloc(MAX_CMDSZ + CMDBUFF_ALIGN_SZ); -+ -+ if (pcmdpriv->cmd_allocated_buf == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pcmdpriv->cmd_buf = pcmdpriv->cmd_allocated_buf + CMDBUFF_ALIGN_SZ - ((SIZE_PTR)(pcmdpriv->cmd_allocated_buf) & (CMDBUFF_ALIGN_SZ-1)); -+ -+ pcmdpriv->rsp_allocated_buf = rtw_zmalloc(MAX_RSPSZ + 4); -+ -+ if (pcmdpriv->rsp_allocated_buf == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pcmdpriv->rsp_buf = pcmdpriv->rsp_allocated_buf + 4 - ((SIZE_PTR)(pcmdpriv->rsp_allocated_buf) & 3); -+ -+ pcmdpriv->cmd_issued_cnt = pcmdpriv->cmd_done_cnt = pcmdpriv->rsp_cnt = 0; -+ -+ mutex_init(&pcmdpriv->sctx_mutex); -+exit: -+ return res; -+} -+ -+static void c2h_wk_callback(_workitem *work); -+sint _rtw_init_evt_priv(struct evt_priv *pevtpriv) -+{ -+ sint res = _SUCCESS; -+ -+ /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */ -+ atomic_set(&pevtpriv->event_seq, 0); -+ pevtpriv->evt_done_cnt = 0; -+ -+ _init_workitem(&pevtpriv->c2h_wk, c2h_wk_callback, NULL); -+ pevtpriv->c2h_wk_alive = false; -+ pevtpriv->c2h_queue = rtw_cbuf_alloc(C2H_QUEUE_MAX_LEN+1); -+ -+ return res; -+} -+ -+void _rtw_free_evt_priv(struct evt_priv *pevtpriv) -+{ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, ("+_rtw_free_evt_priv\n")); -+ -+ _cancel_workitem_sync(&pevtpriv->c2h_wk); -+ while (pevtpriv->c2h_wk_alive) -+ msleep(10); -+ -+ while (!rtw_cbuf_empty(pevtpriv->c2h_queue)) { -+ void *c2h = rtw_cbuf_pop(pevtpriv->c2h_queue); -+ if (c2h != NULL && c2h != (void *)pevtpriv) { -+ kfree(c2h); -+ } -+ } -+ kfree(pevtpriv->c2h_queue); -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, ("-_rtw_free_evt_priv\n")); -+} -+ -+void _rtw_free_cmd_priv(struct cmd_priv *pcmdpriv) -+{ -+ if (pcmdpriv) { -+ if (pcmdpriv->cmd_allocated_buf) -+ kfree(pcmdpriv->cmd_allocated_buf); -+ -+ if (pcmdpriv->rsp_allocated_buf) -+ kfree(pcmdpriv->rsp_allocated_buf); -+ -+ mutex_destroy(&pcmdpriv->sctx_mutex); -+ } -+} -+ -+/* -+Calling Context: -+ -+rtw_enqueue_cmd can only be called between kernel thread, -+since only spin_lock is used. -+ -+ISR/Call-Back functions can't call this sub-function. -+ -+*/ -+ -+sint _rtw_enqueue_cmd(struct __queue *queue, struct cmd_obj *obj) -+{ -+ _irqL irqL; -+ -+ if (obj == NULL) -+ goto exit; -+ -+ /* spin_lock_bh(&queue->lock); */ -+ spin_lock_irqsave(&queue->lock, irqL); -+ -+ list_add_tail(&obj->list, &queue->queue); -+ -+ /* spin_unlock_bh(&queue->lock); */ -+ spin_unlock_irqrestore(&queue->lock, irqL); -+ -+exit: -+ return _SUCCESS; -+} -+ -+struct cmd_obj *_rtw_dequeue_cmd(struct __queue *queue) -+{ -+ _irqL irqL; -+ struct cmd_obj *obj; -+ -+ /* spin_lock_bh(&(queue->lock)); */ -+ spin_lock_irqsave(&queue->lock, irqL); -+ if (list_empty(&(queue->queue))) -+ obj = NULL; -+ else{ -+ obj = LIST_CONTAINOR(get_next(&(queue->queue)), struct cmd_obj, list); -+ list_del_init(&obj->list); -+ } -+ -+ /* spin_unlock_bh(&(queue->lock)); */ -+ spin_unlock_irqrestore(&queue->lock, irqL); -+ -+ return obj; -+} -+ -+u32 rtw_init_cmd_priv(struct cmd_priv *pcmdpriv) -+{ -+ u32 res; -+ -+ res = _rtw_init_cmd_priv(pcmdpriv); -+ return res; -+} -+ -+u32 rtw_init_evt_priv(struct evt_priv *pevtpriv) -+{ -+ int res; -+ -+ res = _rtw_init_evt_priv(pevtpriv); -+ return res; -+} -+ -+void rtw_free_evt_priv(struct evt_priv *pevtpriv) -+{ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, ("rtw_free_evt_priv\n")); -+ _rtw_free_evt_priv(pevtpriv); -+} -+ -+void rtw_free_cmd_priv(struct cmd_priv *pcmdpriv) -+{ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, ("rtw_free_cmd_priv\n")); -+ _rtw_free_cmd_priv(pcmdpriv); -+} -+ -+int rtw_cmd_filter(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj); -+int rtw_cmd_filter(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj) -+{ -+ u8 bAllow = false; /* set to true to allow enqueuing cmd when hw_init_completed is false */ -+ -+ if (cmd_obj->cmdcode == GEN_CMD_CODE(_SetChannelPlan)) -+ bAllow = true; -+ -+ if ((pcmdpriv->padapter->hw_init_completed == false && bAllow == false) -+ || atomic_read(&(pcmdpriv->cmdthd_running)) == false /* com_thread not running */ -+ ) { -+ /* DBG_871X("%s:%s: drop cmdcode:%u, hw_init_completed:%u, cmdthd_running:%u\n", caller_func, __func__, */ -+ /* cmd_obj->cmdcode, */ -+ /* pcmdpriv->padapter->hw_init_completed, */ -+ /* pcmdpriv->cmdthd_running */ -+ /* */ -+ -+ return _FAIL; -+ } -+ return _SUCCESS; -+} -+ -+ -+ -+u32 rtw_enqueue_cmd(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj) -+{ -+ int res = _FAIL; -+ struct adapter *padapter = pcmdpriv->padapter; -+ -+ if (cmd_obj == NULL) { -+ goto exit; -+ } -+ -+ cmd_obj->padapter = padapter; -+ -+ res = rtw_cmd_filter(pcmdpriv, cmd_obj); -+ if (_FAIL == res) { -+ rtw_free_cmd_obj(cmd_obj); -+ goto exit; -+ } -+ -+ res = _rtw_enqueue_cmd(&pcmdpriv->cmd_queue, cmd_obj); -+ -+ if (res == _SUCCESS) -+ up(&pcmdpriv->cmd_queue_sema); -+ -+exit: -+ return res; -+} -+ -+struct cmd_obj *rtw_dequeue_cmd(struct cmd_priv *pcmdpriv) -+{ -+ struct cmd_obj *cmd_obj; -+ -+ cmd_obj = _rtw_dequeue_cmd(&pcmdpriv->cmd_queue); -+ -+ return cmd_obj; -+} -+ -+void rtw_free_cmd_obj(struct cmd_obj *pcmd) -+{ -+ if ((pcmd->cmdcode != _JoinBss_CMD_) && -+ (pcmd->cmdcode != _CreateBss_CMD_)) { -+ /* free parmbuf in cmd_obj */ -+ kfree((unsigned char *)pcmd->parmbuf); -+ } -+ -+ if (pcmd->rsp != NULL) { -+ if (pcmd->rspsz != 0) { -+ /* free rsp in cmd_obj */ -+ kfree((unsigned char *)pcmd->rsp); -+ } -+ } -+ -+ /* free cmd_obj */ -+ kfree((unsigned char *)pcmd); -+} -+ -+ -+void rtw_stop_cmd_thread(struct adapter *adapter) -+{ -+ if (adapter->cmdThread && -+ atomic_read(&(adapter->cmdpriv.cmdthd_running)) == true && -+ adapter->cmdpriv.stop_req == 0) { -+ adapter->cmdpriv.stop_req = 1; -+ up(&adapter->cmdpriv.cmd_queue_sema); -+ down(&adapter->cmdpriv.terminate_cmdthread_sema); -+ } -+} -+ -+int rtw_cmd_thread(void *context) -+{ -+ u8 ret; -+ struct cmd_obj *pcmd; -+ u8 *pcmdbuf, *prspbuf; -+ unsigned long cmd_start_time; -+ unsigned long cmd_process_time; -+ u8 (*cmd_hdl)(struct adapter *padapter, u8 *pbuf); -+ void (*pcmd_callback)(struct adapter *dev, struct cmd_obj *pcmd); -+ struct adapter *padapter = (struct adapter *)context; -+ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ struct drvextra_cmd_parm *extra_parm = NULL; -+ -+ thread_enter("RTW_CMD_THREAD"); -+ -+ pcmdbuf = pcmdpriv->cmd_buf; -+ prspbuf = pcmdpriv->rsp_buf; -+ -+ pcmdpriv->stop_req = 0; -+ atomic_set(&(pcmdpriv->cmdthd_running), true); -+ up(&pcmdpriv->terminate_cmdthread_sema); -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, ("start r871x rtw_cmd_thread !!!!\n")); -+ -+ while (1) { -+ if (down_interruptible(&pcmdpriv->cmd_queue_sema)) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" down_interruptible(&pcmdpriv->cmd_queue_sema) return != 0, break\n", FUNC_ADPT_ARG(padapter)); -+ break; -+ } -+ -+ if ((padapter->bDriverStopped == true) || (padapter->bSurpriseRemoved == true)) { -+ DBG_871X_LEVEL(_drv_always_, "%s: DriverStopped(%d) SurpriseRemoved(%d) break at line %d\n", -+ __func__, padapter->bDriverStopped, padapter->bSurpriseRemoved, __LINE__); -+ break; -+ } -+ -+ if (pcmdpriv->stop_req) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" stop_req:%u, break\n", FUNC_ADPT_ARG(padapter), pcmdpriv->stop_req); -+ break; -+ } -+ -+ if (list_empty(&(pcmdpriv->cmd_queue.queue))) { -+ /* DBG_871X("%s: cmd queue is empty!\n", __func__); */ -+ continue; -+ } -+ -+ if (rtw_register_cmd_alive(padapter) != _SUCCESS) { -+ RT_TRACE(_module_hal_xmit_c_, _drv_notice_, -+ ("%s: wait to leave LPS_LCLK\n", __func__)); -+ continue; -+ } -+ -+_next: -+ if ((padapter->bDriverStopped == true) || (padapter->bSurpriseRemoved == true)) { -+ DBG_871X_LEVEL(_drv_always_, "%s: DriverStopped(%d) SurpriseRemoved(%d) break at line %d\n", -+ __func__, padapter->bDriverStopped, padapter->bSurpriseRemoved, __LINE__); -+ break; -+ } -+ -+ pcmd = rtw_dequeue_cmd(pcmdpriv); -+ if (!pcmd) { -+ rtw_unregister_cmd_alive(padapter); -+ continue; -+ } -+ -+ cmd_start_time = jiffies; -+ -+ if (_FAIL == rtw_cmd_filter(pcmdpriv, pcmd)) { -+ pcmd->res = H2C_DROPPED; -+ goto post_process; -+ } -+ -+ pcmdpriv->cmd_issued_cnt++; -+ -+ pcmd->cmdsz = _RND4((pcmd->cmdsz));/* _RND4 */ -+ -+ memcpy(pcmdbuf, pcmd->parmbuf, pcmd->cmdsz); -+ -+ if (pcmd->cmdcode < ARRAY_SIZE(wlancmds)) { -+ cmd_hdl = wlancmds[pcmd->cmdcode].h2cfuns; -+ -+ if (cmd_hdl) { -+ ret = cmd_hdl(pcmd->padapter, pcmdbuf); -+ pcmd->res = ret; -+ } -+ -+ pcmdpriv->cmd_seq++; -+ } else{ -+ pcmd->res = H2C_PARAMETERS_ERROR; -+ } -+ -+ cmd_hdl = NULL; -+ -+post_process: -+ -+ if (mutex_lock_interruptible(&(pcmd->padapter->cmdpriv.sctx_mutex)) == 0) { -+ if (pcmd->sctx) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" pcmd->sctx\n", -+ FUNC_ADPT_ARG(pcmd->padapter)); -+ -+ if (pcmd->res == H2C_SUCCESS) -+ rtw_sctx_done(&pcmd->sctx); -+ else -+ rtw_sctx_done_err(&pcmd->sctx, RTW_SCTX_DONE_CMD_ERROR); -+ } -+ mutex_unlock(&(pcmd->padapter->cmdpriv.sctx_mutex)); -+ } -+ -+ cmd_process_time = jiffies_to_msecs(jiffies - cmd_start_time); -+ if (cmd_process_time > 1000) { -+ if (pcmd->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { -+ DBG_871X(ADPT_FMT" cmd =%d process_time =%lu > 1 sec\n", -+ ADPT_ARG(pcmd->padapter), pcmd->cmdcode, cmd_process_time); -+ /* rtw_warn_on(1); */ -+ } else if (pcmd->cmdcode == GEN_CMD_CODE(_Set_MLME_EVT)) { -+ DBG_871X(ADPT_FMT" cmd =%d, process_time =%lu > 1 sec\n", -+ ADPT_ARG(pcmd->padapter), pcmd->cmdcode, cmd_process_time); -+ /* rtw_warn_on(1); */ -+ } else { -+ DBG_871X(ADPT_FMT" cmd =%d, process_time =%lu > 1 sec\n", -+ ADPT_ARG(pcmd->padapter), pcmd->cmdcode, cmd_process_time); -+ /* rtw_warn_on(1); */ -+ } -+ } -+ -+ /* call callback function for post-processed */ -+ if (pcmd->cmdcode < ARRAY_SIZE(rtw_cmd_callback)) { -+ pcmd_callback = rtw_cmd_callback[pcmd->cmdcode].callback; -+ if (pcmd_callback == NULL) { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, ("mlme_cmd_hdl(): pcmd_callback = 0x%p, cmdcode = 0x%x\n", pcmd_callback, pcmd->cmdcode)); -+ rtw_free_cmd_obj(pcmd); -+ } else{ -+ /* todo: !!! fill rsp_buf to pcmd->rsp if (pcmd->rsp!= NULL) */ -+ pcmd_callback(pcmd->padapter, pcmd);/* need conider that free cmd_obj in rtw_cmd_callback */ -+ } -+ } else{ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("%s: cmdcode = 0x%x callback not defined!\n", __func__, pcmd->cmdcode)); -+ rtw_free_cmd_obj(pcmd); -+ } -+ -+ flush_signals_thread(); -+ -+ goto _next; -+ -+ } -+ -+ /* free all cmd_obj resources */ -+ do { -+ pcmd = rtw_dequeue_cmd(pcmdpriv); -+ if (pcmd == NULL) { -+ rtw_unregister_cmd_alive(padapter); -+ break; -+ } -+ -+ /* DBG_871X("%s: leaving... drop cmdcode:%u size:%d\n", __func__, pcmd->cmdcode, pcmd->cmdsz); */ -+ -+ if (pcmd->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { -+ extra_parm = (struct drvextra_cmd_parm *)pcmd->parmbuf; -+ if (extra_parm->pbuf && extra_parm->size > 0) { -+ kfree(extra_parm->pbuf); -+ } -+ } -+ -+ rtw_free_cmd_obj(pcmd); -+ } while (1); -+ -+ up(&pcmdpriv->terminate_cmdthread_sema); -+ atomic_set(&(pcmdpriv->cmdthd_running), false); -+ -+ thread_exit(); -+} -+ -+/* -+rtw_sitesurvey_cmd(~) -+ ### NOTE:#### (!!!!) -+ MUST TAKE CARE THAT BEFORE CALLING THIS FUNC, YOU SHOULD HAVE LOCKED pmlmepriv->lock -+*/ -+u8 rtw_sitesurvey_cmd(struct adapter *padapter, struct ndis_802_11_ssid *ssid, int ssid_num, -+ struct rtw_ieee80211_channel *ch, int ch_num) -+{ -+ u8 res = _FAIL; -+ struct cmd_obj *ph2c; -+ struct sitesurvey_parm *psurveyPara; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SCAN, 1); -+ } -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) -+ return _FAIL; -+ -+ psurveyPara = (struct sitesurvey_parm *)rtw_zmalloc(sizeof(struct sitesurvey_parm)); -+ if (psurveyPara == NULL) { -+ kfree((unsigned char *) ph2c); -+ return _FAIL; -+ } -+ -+ rtw_free_network_queue(padapter, false); -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, ("%s: flush network queue\n", __func__)); -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psurveyPara, GEN_CMD_CODE(_SiteSurvey)); -+ -+ /* psurveyPara->bsslimit = 48; */ -+ psurveyPara->scan_mode = pmlmepriv->scan_mode; -+ -+ /* prepare ssid list */ -+ if (ssid) { -+ int i; -+ for (i = 0; i < ssid_num && i < RTW_SSID_SCAN_AMOUNT; i++) { -+ if (ssid[i].SsidLength) { -+ memcpy(&psurveyPara->ssid[i], &ssid[i], sizeof(struct ndis_802_11_ssid)); -+ psurveyPara->ssid_num++; -+ -+ DBG_871X(FUNC_ADPT_FMT" ssid:(%s, %d)\n", FUNC_ADPT_ARG(padapter), -+ psurveyPara->ssid[i].Ssid, psurveyPara->ssid[i].SsidLength); -+ } -+ } -+ } -+ -+ /* prepare channel list */ -+ if (ch) { -+ int i; -+ for (i = 0; i < ch_num && i < RTW_CHANNEL_SCAN_AMOUNT; i++) { -+ if (ch[i].hw_value && !(ch[i].flags & RTW_IEEE80211_CHAN_DISABLED)) { -+ memcpy(&psurveyPara->ch[i], &ch[i], sizeof(struct rtw_ieee80211_channel)); -+ psurveyPara->ch_num++; -+ -+ DBG_871X(FUNC_ADPT_FMT" ch:%u\n", FUNC_ADPT_ARG(padapter), -+ psurveyPara->ch[i].hw_value); -+ } -+ } -+ } -+ -+ set_fwstate(pmlmepriv, _FW_UNDER_SURVEY); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+ if (res == _SUCCESS) { -+ -+ pmlmepriv->scan_start_time = jiffies; -+ _set_timer(&pmlmepriv->scan_to_timer, SCANNING_TIMEOUT); -+ } else { -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ } -+ return res; -+} -+ -+u8 rtw_setdatarate_cmd(struct adapter *padapter, u8 *rateset) -+{ -+ struct cmd_obj *ph2c; -+ struct setdatarate_parm *pbsetdataratepara; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pbsetdataratepara = (struct setdatarate_parm *)rtw_zmalloc(sizeof(struct setdatarate_parm)); -+ if (pbsetdataratepara == NULL) { -+ kfree((u8 *) ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pbsetdataratepara, GEN_CMD_CODE(_SetDataRate)); -+ pbsetdataratepara->mac_id = 5; -+ memcpy(pbsetdataratepara->datarates, rateset, NumRates); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ return res; -+} -+ -+void rtw_getbbrfreg_cmdrsp_callback(struct adapter *padapter, struct cmd_obj *pcmd) -+{ -+ /* rtw_free_cmd_obj(pcmd); */ -+ kfree((unsigned char *) pcmd->parmbuf); -+ kfree((unsigned char *) pcmd); -+} -+ -+u8 rtw_createbss_cmd(struct adapter *padapter) -+{ -+ struct cmd_obj *pcmd; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_bssid_ex *pdev_network = &padapter->registrypriv.dev_network; -+ u8 res = _SUCCESS; -+ -+ if (pmlmepriv->assoc_ssid.SsidLength == 0) { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, (" createbss for Any SSid:%s\n", pmlmepriv->assoc_ssid.Ssid)); -+ } else { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, (" createbss for SSid:%s\n", pmlmepriv->assoc_ssid.Ssid)); -+ } -+ -+ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ INIT_LIST_HEAD(&pcmd->list); -+ pcmd->cmdcode = _CreateBss_CMD_; -+ pcmd->parmbuf = (unsigned char *)pdev_network; -+ pcmd->cmdsz = get_wlan_bssid_ex_sz((struct wlan_bssid_ex *)pdev_network); -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ pdev_network->Length = pcmd->cmdsz; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ return res; -+} -+ -+u8 rtw_startbss_cmd(struct adapter *padapter, int flags) -+{ -+ struct cmd_obj *pcmd; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; -+ -+ if (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ start_bss_network(padapter, (u8 *)&(padapter->mlmepriv.cur_network.network)); -+ } else { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ INIT_LIST_HEAD(&pcmd->list); -+ pcmd->cmdcode = GEN_CMD_CODE(_CreateBss); -+ pcmd->parmbuf = NULL; -+ pcmd->cmdsz = 0; -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ if (flags & RTW_CMDF_WAIT_ACK) { -+ pcmd->sctx = &sctx; -+ rtw_sctx_init(&sctx, 2000); -+ } -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+ if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { -+ rtw_sctx_wait(&sctx, __func__); -+ if (mutex_lock_interruptible(&pcmdpriv->sctx_mutex) == 0) { -+ if (sctx.status == RTW_SCTX_SUBMITTED) -+ pcmd->sctx = NULL; -+ mutex_unlock(&pcmdpriv->sctx_mutex); -+ } -+ } -+ } -+ -+exit: -+ return res; -+} -+ -+u8 rtw_joinbss_cmd(struct adapter *padapter, struct wlan_network *pnetwork) -+{ -+ u8 *auth, res = _SUCCESS; -+ uint t_len = 0; -+ struct wlan_bssid_ex *psecnetwork; -+ struct cmd_obj *pcmd; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ enum NDIS_802_11_NETWORK_INFRASTRUCTURE ndis_network_mode = pnetwork->network.InfrastructureMode; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u32 tmp_len; -+ u8 *ptmp = NULL; -+ -+ if (pmlmepriv->assoc_ssid.SsidLength == 0) { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, ("+Join cmd: Any SSid\n")); -+ } else { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_notice_, ("+Join cmd: SSid =[%s]\n", pmlmepriv->assoc_ssid.Ssid)); -+ } -+ -+ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd == NULL) { -+ res = _FAIL; -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("rtw_joinbss_cmd: memory allocate for cmd_obj fail!!!\n")); -+ goto exit; -+ } -+ /* for IEs is fix buf size */ -+ t_len = sizeof(struct wlan_bssid_ex); -+ -+ -+ /* for hidden ap to set fw_state here */ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) != true) { -+ switch (ndis_network_mode) { -+ case Ndis802_11IBSS: -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ break; -+ -+ case Ndis802_11Infrastructure: -+ set_fwstate(pmlmepriv, WIFI_STATION_STATE); -+ break; -+ -+ case Ndis802_11APMode: -+ case Ndis802_11AutoUnknown: -+ case Ndis802_11InfrastructureMax: -+ break; -+ -+ } -+ } -+ -+ psecnetwork = (struct wlan_bssid_ex *)&psecuritypriv->sec_bss; -+ if (psecnetwork == NULL) { -+ if (pcmd != NULL) -+ kfree((unsigned char *)pcmd); -+ -+ res = _FAIL; -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("rtw_joinbss_cmd :psecnetwork == NULL!!!\n")); -+ -+ goto exit; -+ } -+ -+ memset(psecnetwork, 0, t_len); -+ -+ memcpy(psecnetwork, &pnetwork->network, get_wlan_bssid_ex_sz(&pnetwork->network)); -+ -+ auth = &psecuritypriv->authenticator_ie[0]; -+ psecuritypriv->authenticator_ie[0] = (unsigned char)psecnetwork->IELength; -+ -+ if ((psecnetwork->IELength-12) < (256-1)) { -+ memcpy(&psecuritypriv->authenticator_ie[1], &psecnetwork->IEs[12], psecnetwork->IELength-12); -+ } else { -+ memcpy(&psecuritypriv->authenticator_ie[1], &psecnetwork->IEs[12], (256-1)); -+ } -+ -+ psecnetwork->IELength = 0; -+ /* Added by Albert 2009/02/18 */ -+ /* If the the driver wants to use the bssid to create the connection. */ -+ /* If not, we have to copy the connecting AP's MAC address to it so that */ -+ /* the driver just has the bssid information for PMKIDList searching. */ -+ -+ if (pmlmepriv->assoc_by_bssid == false) { -+ memcpy(&pmlmepriv->assoc_bssid[0], &pnetwork->network.MacAddress[0], ETH_ALEN); -+ } -+ -+ psecnetwork->IELength = rtw_restruct_sec_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], pnetwork->network.IELength); -+ -+ -+ pqospriv->qos_option = 0; -+ -+ if (pregistrypriv->wmm_enable) { -+ tmp_len = rtw_restruct_wmm_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], pnetwork->network.IELength, psecnetwork->IELength); -+ -+ if (psecnetwork->IELength != tmp_len) { -+ psecnetwork->IELength = tmp_len; -+ pqospriv->qos_option = 1; /* There is WMM IE in this corresp. beacon */ -+ } else{ -+ pqospriv->qos_option = 0;/* There is no WMM IE in this corresp. beacon */ -+ } -+ } -+ -+ phtpriv->ht_option = false; -+ ptmp = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &tmp_len, pnetwork->network.IELength-12); -+ if (pregistrypriv->ht_enable && ptmp && tmp_len > 0) { -+ /* Added by Albert 2010/06/23 */ -+ /* For the WEP mode, we will use the bg mode to do the connection to avoid some IOT issue. */ -+ /* Especially for Realtek 8192u SoftAP. */ -+ if ((padapter->securitypriv.dot11PrivacyAlgrthm != _WEP40_) && -+ (padapter->securitypriv.dot11PrivacyAlgrthm != _WEP104_) && -+ (padapter->securitypriv.dot11PrivacyAlgrthm != _TKIP_)) { -+ rtw_ht_use_default_setting(padapter); -+ -+ rtw_build_wmm_ie_ht(padapter, &psecnetwork->IEs[12], &psecnetwork->IELength); -+ -+ /* rtw_restructure_ht_ie */ -+ rtw_restructure_ht_ie(padapter, &pnetwork->network.IEs[12], &psecnetwork->IEs[0], -+ pnetwork->network.IELength-12, &psecnetwork->IELength, -+ pnetwork->network.Configuration.DSConfig); -+ } -+ } -+ -+ rtw_append_exented_cap(padapter, &psecnetwork->IEs[0], &psecnetwork->IELength); -+ -+ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->network.IEs, pnetwork->network.IELength); -+ -+ pcmd->cmdsz = get_wlan_bssid_ex_sz(psecnetwork);/* get cmdsz before endian conversion */ -+ -+ INIT_LIST_HEAD(&pcmd->list); -+ pcmd->cmdcode = _JoinBss_CMD_;/* GEN_CMD_CODE(_JoinBss) */ -+ pcmd->parmbuf = (unsigned char *)psecnetwork; -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ return res; -+} -+ -+u8 rtw_disassoc_cmd(struct adapter *padapter, u32 deauth_timeout_ms, bool enqueue) /* for sta_mode */ -+{ -+ struct cmd_obj *cmdobj = NULL; -+ struct disconnect_parm *param = NULL; -+ struct cmd_priv *cmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_notice_, ("+rtw_disassoc_cmd\n")); -+ -+ /* prepare cmd parameter */ -+ param = (struct disconnect_parm *)rtw_zmalloc(sizeof(*param)); -+ if (param == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ param->deauth_timeout_ms = deauth_timeout_ms; -+ -+ if (enqueue) { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ kfree((u8 *)param); -+ goto exit; -+ } -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, param, _DisConnect_CMD_); -+ res = rtw_enqueue_cmd(cmdpriv, cmdobj); -+ } else { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != disconnect_hdl(padapter, (u8 *)param)) -+ res = _FAIL; -+ kfree((u8 *)param); -+ } -+ -+exit: -+ return res; -+} -+ -+u8 rtw_setopmode_cmd(struct adapter *padapter, enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, bool enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct setopmode_parm *psetop; -+ -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ psetop = (struct setopmode_parm *)rtw_zmalloc(sizeof(struct setopmode_parm)); -+ -+ if (psetop == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ psetop->mode = (u8)networktype; -+ -+ if (enqueue) { -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ kfree((u8 *)psetop); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetop, _SetOpMode_CMD_); -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } else{ -+ setopmode_hdl(padapter, (u8 *)psetop); -+ kfree((u8 *)psetop); -+ } -+exit: -+ return res; -+} -+ -+u8 rtw_setstakey_cmd(struct adapter *padapter, struct sta_info *sta, u8 unicast_key, bool enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct set_stakey_parm *psetstakey_para; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct set_stakey_rsp *psetstakey_rsp = NULL; -+ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ u8 res = _SUCCESS; -+ -+ psetstakey_para = (struct set_stakey_parm *)rtw_zmalloc(sizeof(struct set_stakey_parm)); -+ if (psetstakey_para == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ psetstakey_para->algorithm = (unsigned char) psecuritypriv->dot11PrivacyAlgrthm; -+ } else { -+ GET_ENCRY_ALGO(psecuritypriv, sta, psetstakey_para->algorithm, false); -+ } -+ -+ if (unicast_key == true) { -+ memcpy(&psetstakey_para->key, &sta->dot118021x_UncstKey, 16); -+ } else{ -+ memcpy(&psetstakey_para->key, &psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey, 16); -+ } -+ -+ /* jeff: set this becasue at least sw key is ready */ -+ padapter->securitypriv.busetkipkey = true; -+ -+ if (enqueue) { -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ kfree((u8 *) psetstakey_para); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ psetstakey_rsp = (struct set_stakey_rsp *)rtw_zmalloc(sizeof(struct set_stakey_rsp)); -+ if (psetstakey_rsp == NULL) { -+ kfree((u8 *) ph2c); -+ kfree((u8 *) psetstakey_para); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); -+ ph2c->rsp = (u8 *) psetstakey_rsp; -+ ph2c->rspsz = sizeof(struct set_stakey_rsp); -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } else{ -+ set_stakey_hdl(padapter, (u8 *)psetstakey_para); -+ kfree((u8 *) psetstakey_para); -+ } -+exit: -+ return res; -+} -+ -+u8 rtw_clearstakey_cmd(struct adapter *padapter, struct sta_info *sta, u8 enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct set_stakey_parm *psetstakey_para; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct set_stakey_rsp *psetstakey_rsp = NULL; -+ s16 cam_id = 0; -+ u8 res = _SUCCESS; -+ -+ if (!enqueue) { -+ while ((cam_id = rtw_camid_search(padapter, sta->hwaddr, -1)) >= 0) { -+ DBG_871X_LEVEL(_drv_always_, "clear key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(sta->hwaddr), cam_id); -+ clear_cam_entry(padapter, cam_id); -+ rtw_camid_free(padapter, cam_id); -+ } -+ } else{ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ psetstakey_para = (struct set_stakey_parm *)rtw_zmalloc(sizeof(struct set_stakey_parm)); -+ if (psetstakey_para == NULL) { -+ kfree((u8 *) ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ psetstakey_rsp = (struct set_stakey_rsp *)rtw_zmalloc(sizeof(struct set_stakey_rsp)); -+ if (psetstakey_rsp == NULL) { -+ kfree((u8 *) ph2c); -+ kfree((u8 *) psetstakey_para); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); -+ ph2c->rsp = (u8 *) psetstakey_rsp; -+ ph2c->rspsz = sizeof(struct set_stakey_rsp); -+ -+ memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN); -+ -+ psetstakey_para->algorithm = _NO_PRIVACY_; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+ } -+ -+exit: -+ return res; -+} -+ -+u8 rtw_addbareq_cmd(struct adapter *padapter, u8 tid, u8 *addr) -+{ -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct cmd_obj *ph2c; -+ struct addBaReq_parm *paddbareq_parm; -+ -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ paddbareq_parm = (struct addBaReq_parm *)rtw_zmalloc(sizeof(struct addBaReq_parm)); -+ if (paddbareq_parm == NULL) { -+ kfree((unsigned char *)ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ paddbareq_parm->tid = tid; -+ memcpy(paddbareq_parm->addr, addr, ETH_ALEN); -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, paddbareq_parm, GEN_CMD_CODE(_AddBAReq)); -+ -+ /* DBG_871X("rtw_addbareq_cmd, tid =%d\n", tid); */ -+ -+ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+/* add for CONFIG_IEEE80211W, none 11w can use it */ -+u8 rtw_reset_securitypriv_cmd(struct adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ kfree((unsigned char *)ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = RESET_SECURITYPRIV; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ -+ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+u8 rtw_free_assoc_resources_cmd(struct adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ kfree((unsigned char *)ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = FREE_ASSOC_RESOURCES; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ -+ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+u8 rtw_dynamic_chk_wk_cmd(struct adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ /* only primary padapter does this cmd */ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ kfree((unsigned char *)ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = DYNAMIC_CHK_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ -+ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+u8 rtw_set_chplan_cmd(struct adapter *padapter, u8 chplan, u8 enqueue, u8 swconfig) -+{ -+ struct cmd_obj *pcmdobj; -+ struct SetChannelPlan_param *setChannelPlan_param; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res = _SUCCESS; -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_notice_, ("+rtw_set_chplan_cmd\n")); -+ -+ /* check if allow software config */ -+ if (swconfig && rtw_hal_is_disable_sw_channel_plan(padapter) == true) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ /* check input parameter */ -+ if (!rtw_is_channel_plan_valid(chplan)) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ /* prepare cmd parameter */ -+ setChannelPlan_param = (struct SetChannelPlan_param *)rtw_zmalloc(sizeof(struct SetChannelPlan_param)); -+ if (setChannelPlan_param == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ setChannelPlan_param->channel_plan = chplan; -+ -+ if (enqueue) { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmdobj == NULL) { -+ kfree((u8 *)setChannelPlan_param); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(pcmdobj, setChannelPlan_param, GEN_CMD_CODE(_SetChannelPlan)); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ } else{ -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != set_chplan_hdl(padapter, (unsigned char *)setChannelPlan_param)) -+ res = _FAIL; -+ -+ kfree((u8 *)setChannelPlan_param); -+ } -+ -+ /* do something based on res... */ -+ if (res == _SUCCESS) -+ padapter->mlmepriv.ChannelPlan = chplan; -+ -+exit: -+ return res; -+} -+ -+static void collect_traffic_statistics(struct adapter *padapter) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ -+ /* Tx */ -+ pdvobjpriv->traffic_stat.tx_bytes = padapter->xmitpriv.tx_bytes; -+ pdvobjpriv->traffic_stat.tx_pkts = padapter->xmitpriv.tx_pkts; -+ pdvobjpriv->traffic_stat.tx_drop = padapter->xmitpriv.tx_drop; -+ -+ /* Rx */ -+ pdvobjpriv->traffic_stat.rx_bytes = padapter->recvpriv.rx_bytes; -+ pdvobjpriv->traffic_stat.rx_pkts = padapter->recvpriv.rx_pkts; -+ pdvobjpriv->traffic_stat.rx_drop = padapter->recvpriv.rx_drop; -+ -+ /* Calculate throughput in last interval */ -+ pdvobjpriv->traffic_stat.cur_tx_bytes = pdvobjpriv->traffic_stat.tx_bytes - pdvobjpriv->traffic_stat.last_tx_bytes; -+ pdvobjpriv->traffic_stat.cur_rx_bytes = pdvobjpriv->traffic_stat.rx_bytes - pdvobjpriv->traffic_stat.last_rx_bytes; -+ pdvobjpriv->traffic_stat.last_tx_bytes = pdvobjpriv->traffic_stat.tx_bytes; -+ pdvobjpriv->traffic_stat.last_rx_bytes = pdvobjpriv->traffic_stat.rx_bytes; -+ -+ pdvobjpriv->traffic_stat.cur_tx_tp = (u32)(pdvobjpriv->traffic_stat.cur_tx_bytes * 8/2/1024/1024); -+ pdvobjpriv->traffic_stat.cur_rx_tp = (u32)(pdvobjpriv->traffic_stat.cur_rx_bytes * 8/2/1024/1024); -+} -+ -+u8 traffic_status_watchdog(struct adapter *padapter, u8 from_timer) -+{ -+ u8 bEnterPS = false; -+ u16 BusyThresholdHigh = 25; -+ u16 BusyThresholdLow = 10; -+ u16 BusyThreshold = BusyThresholdHigh; -+ u8 bBusyTraffic = false, bTxBusyTraffic = false, bRxBusyTraffic = false; -+ u8 bHigherBusyTraffic = false, bHigherBusyRxTraffic = false, bHigherBusyTxTraffic = false; -+ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ RT_LINK_DETECT_T *link_detect = &pmlmepriv->LinkDetectInfo; -+ -+ collect_traffic_statistics(padapter); -+ -+ /* */ -+ /* Determine if our traffic is busy now */ -+ /* */ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ /*&& !MgntInitAdapterInProgress(pMgntInfo)*/) { -+ /* if we raise bBusyTraffic in last watchdog, using lower threshold. */ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic) -+ BusyThreshold = BusyThresholdLow; -+ -+ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > BusyThreshold || -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > BusyThreshold) { -+ bBusyTraffic = true; -+ -+ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) -+ bRxBusyTraffic = true; -+ else -+ bTxBusyTraffic = true; -+ } -+ -+ /* Higher Tx/Rx data. */ -+ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > 4000 || -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > 4000) { -+ bHigherBusyTraffic = true; -+ -+ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) -+ bHigherBusyRxTraffic = true; -+ else -+ bHigherBusyTxTraffic = true; -+ } -+ -+#ifdef CONFIG_TRAFFIC_PROTECT -+#define TX_ACTIVE_TH 10 -+#define RX_ACTIVE_TH 20 -+#define TRAFFIC_PROTECT_PERIOD_MS 4500 -+ -+ if (link_detect->NumTxOkInPeriod > TX_ACTIVE_TH -+ || link_detect->NumRxUnicastOkInPeriod > RX_ACTIVE_TH) { -+ -+ DBG_871X_LEVEL(_drv_info_, FUNC_ADPT_FMT" acqiure wake_lock for %u ms(tx:%d, rx_unicast:%d)\n", -+ FUNC_ADPT_ARG(padapter), -+ TRAFFIC_PROTECT_PERIOD_MS, -+ link_detect->NumTxOkInPeriod, -+ link_detect->NumRxUnicastOkInPeriod); -+ } -+#endif -+ -+ /* check traffic for powersaving. */ -+ if (((pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod + pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) > 8) || -+ (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 2)) { -+ /* DBG_871X("(-)Tx = %d, Rx = %d\n", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); */ -+ bEnterPS = false; -+ -+ if (bBusyTraffic == true) { -+ if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount <= 4) -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 4; -+ -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount++; -+ -+ /* DBG_871X("Set TrafficTransitionCount to %d\n", pmlmepriv->LinkDetectInfo.TrafficTransitionCount); */ -+ -+ if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount > 30/*TrafficTransitionLevel*/) { -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 30; -+ } -+ } -+ } else{ -+ /* DBG_871X("(+)Tx = %d, Rx = %d\n", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); */ -+ -+ if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount >= 2) -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount -= 2; -+ else -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; -+ -+ if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount == 0) -+ bEnterPS = true; -+ } -+ -+ /* LeisurePS only work in infra mode. */ -+ if (bEnterPS) { -+ if (!from_timer) -+ LPS_Enter(padapter, "TRAFFIC_IDLE"); -+ } else { -+ if (!from_timer) -+ LPS_Leave(padapter, "TRAFFIC_BUSY"); -+ else -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_TRAFFIC_BUSY, 1); -+ } -+ } else{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ int n_assoc_iface = 0; -+ -+ if (check_fwstate(&(dvobj->padapters->mlmepriv), WIFI_ASOC_STATE)) -+ n_assoc_iface++; -+ -+ if (!from_timer && n_assoc_iface == 0) -+ LPS_Leave(padapter, "NON_LINKED"); -+ } -+ -+ pmlmepriv->LinkDetectInfo.NumRxOkInPeriod = 0; -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod = 0; -+ pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod = 0; -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = bBusyTraffic; -+ pmlmepriv->LinkDetectInfo.bTxBusyTraffic = bTxBusyTraffic; -+ pmlmepriv->LinkDetectInfo.bRxBusyTraffic = bRxBusyTraffic; -+ pmlmepriv->LinkDetectInfo.bHigherBusyTraffic = bHigherBusyTraffic; -+ pmlmepriv->LinkDetectInfo.bHigherBusyRxTraffic = bHigherBusyRxTraffic; -+ pmlmepriv->LinkDetectInfo.bHigherBusyTxTraffic = bHigherBusyTxTraffic; -+ -+ return bEnterPS; -+ -+} -+ -+static void dynamic_chk_wk_hdl(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv; -+ pmlmepriv = &(padapter->mlmepriv); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) { -+ expire_timeout_chk(padapter); -+ } -+ -+ /* for debug purpose */ -+ _linked_info_dump(padapter); -+ -+ -+ /* if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING|_FW_UNDER_SURVEY) ==false) */ -+ { -+ linked_status_chk(padapter); -+ traffic_status_watchdog(padapter, 0); -+ } -+ -+ rtw_hal_dm_watchdog(padapter); -+ -+ /* check_hw_pbc(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->type); */ -+ -+ /* */ -+ /* BT-Coexist */ -+ /* */ -+ rtw_btcoex_Handler(padapter); -+ -+ -+ /* always call rtw_ps_processor() at last one. */ -+ if (is_primary_adapter(padapter)) -+ rtw_ps_processor(padapter); -+} -+ -+void lps_ctrl_wk_hdl(struct adapter *padapter, u8 lps_ctrl_type); -+void lps_ctrl_wk_hdl(struct adapter *padapter, u8 lps_ctrl_type) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 mstatus; -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) -+ || (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true)) { -+ return; -+ } -+ -+ switch (lps_ctrl_type) { -+ case LPS_CTRL_SCAN: -+ /* DBG_871X("LPS_CTRL_SCAN\n"); */ -+ rtw_btcoex_ScanNotify(padapter, true); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { -+ /* connect */ -+ LPS_Leave(padapter, "LPS_CTRL_SCAN"); -+ } -+ break; -+ case LPS_CTRL_JOINBSS: -+ /* DBG_871X("LPS_CTRL_JOINBSS\n"); */ -+ LPS_Leave(padapter, "LPS_CTRL_JOINBSS"); -+ break; -+ case LPS_CTRL_CONNECT: -+ /* DBG_871X("LPS_CTRL_CONNECT\n"); */ -+ mstatus = 1;/* connect */ -+ /* Reset LPS Setting */ -+ pwrpriv->LpsIdleCount = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus)); -+ rtw_btcoex_MediaStatusNotify(padapter, mstatus); -+ break; -+ case LPS_CTRL_DISCONNECT: -+ /* DBG_871X("LPS_CTRL_DISCONNECT\n"); */ -+ mstatus = 0;/* disconnect */ -+ rtw_btcoex_MediaStatusNotify(padapter, mstatus); -+ LPS_Leave(padapter, "LPS_CTRL_DISCONNECT"); -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus)); -+ break; -+ case LPS_CTRL_SPECIAL_PACKET: -+ /* DBG_871X("LPS_CTRL_SPECIAL_PACKET\n"); */ -+ pwrpriv->DelayLPSLastTimeStamp = jiffies; -+ rtw_btcoex_SpecialPacketNotify(padapter, PACKET_DHCP); -+ LPS_Leave(padapter, "LPS_CTRL_SPECIAL_PACKET"); -+ break; -+ case LPS_CTRL_LEAVE: -+ /* DBG_871X("LPS_CTRL_LEAVE\n"); */ -+ LPS_Leave(padapter, "LPS_CTRL_LEAVE"); -+ break; -+ case LPS_CTRL_TRAFFIC_BUSY: -+ LPS_Leave(padapter, "LPS_CTRL_TRAFFIC_BUSY"); -+ default: -+ break; -+ } -+} -+ -+u8 rtw_lps_ctrl_wk_cmd(struct adapter *padapter, u8 lps_ctrl_type, u8 enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ /* struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); */ -+ u8 res = _SUCCESS; -+ -+ /* if (!pwrctrlpriv->bLeisurePs) */ -+ /* return res; */ -+ -+ if (enqueue) { -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ kfree((unsigned char *)ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = LPS_CTRL_WK_CID; -+ pdrvextra_cmd_parm->type = lps_ctrl_type; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } else{ -+ lps_ctrl_wk_hdl(padapter, lps_ctrl_type); -+ } -+ -+exit: -+ return res; -+} -+ -+static void rtw_dm_in_lps_hdl(struct adapter *padapter) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_IN_LPS, NULL); -+} -+ -+u8 rtw_dm_in_lps_wk_cmd(struct adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ kfree((unsigned char *)ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = DM_IN_LPS_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+ -+static void rtw_lps_change_dtim_hdl(struct adapter *padapter, u8 dtim) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ -+ if (dtim <= 0 || dtim > 16) -+ return; -+ -+ if (rtw_btcoex_IsBtControlLps(padapter) == true) -+ return; -+ -+ down(&pwrpriv->lock); -+ -+ if (pwrpriv->dtim != dtim) { -+ DBG_871X("change DTIM from %d to %d, bFwCurrentInPSMode =%d, ps_mode =%d\n", pwrpriv->dtim, dtim, -+ pwrpriv->bFwCurrentInPSMode, pwrpriv->pwr_mode); -+ -+ pwrpriv->dtim = dtim; -+ } -+ -+ if ((pwrpriv->bFwCurrentInPSMode == true) && (pwrpriv->pwr_mode > PS_MODE_ACTIVE)) { -+ u8 ps_mode = pwrpriv->pwr_mode; -+ -+ /* DBG_871X("change DTIM from %d to %d, ps_mode =%d\n", pwrpriv->dtim, dtim, ps_mode); */ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); -+ } -+ -+ up(&pwrpriv->lock); -+} -+ -+static void rtw_dm_ra_mask_hdl(struct adapter *padapter, struct sta_info *psta) -+{ -+ if (psta) { -+ set_sta_rate(padapter, psta); -+ } -+} -+ -+u8 rtw_dm_ra_mask_wk_cmd(struct adapter *padapter, u8 *psta) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ kfree((unsigned char *)ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = DM_RA_MSK_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = psta; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+ -+static void power_saving_wk_hdl(struct adapter *padapter) -+{ -+ rtw_ps_processor(padapter); -+} -+ -+/* add for CONFIG_IEEE80211W, none 11w can use it */ -+static void reset_securitypriv_hdl(struct adapter *padapter) -+{ -+ rtw_reset_securitypriv(padapter); -+} -+ -+static void free_assoc_resources_hdl(struct adapter *padapter) -+{ -+ rtw_free_assoc_resources(padapter, 1); -+} -+ -+u8 rtw_ps_cmd(struct adapter *padapter) -+{ -+ struct cmd_obj *ppscmd; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ppscmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ppscmd == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ kfree((unsigned char *)ppscmd); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = POWER_SAVING_CTRL_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ init_h2fwcmd_w_parm_no_rsp(ppscmd, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ppscmd); -+ -+exit: -+ return res; -+} -+ -+static void rtw_chk_hi_queue_hdl(struct adapter *padapter) -+{ -+ struct sta_info *psta_bmc; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ unsigned long start = jiffies; -+ u8 empty = false; -+ -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ if (!psta_bmc) -+ return; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); -+ -+ while (false == empty && jiffies_to_msecs(jiffies - start) < g_wait_hiq_empty) { -+ msleep(100); -+ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); -+ } -+ -+ if (psta_bmc->sleepq_len == 0) { -+ if (empty == _SUCCESS) { -+ bool update_tim = false; -+ -+ if (pstapriv->tim_bitmap & BIT(0)) -+ update_tim = true; -+ -+ pstapriv->tim_bitmap &= ~BIT(0); -+ pstapriv->sta_dz_bitmap &= ~BIT(0); -+ -+ if (update_tim == true) -+ update_beacon(padapter, _TIM_IE_, NULL, true); -+ } else{/* re check again */ -+ rtw_chk_hi_queue_cmd(padapter); -+ } -+ -+ } -+ -+} -+ -+u8 rtw_chk_hi_queue_cmd(struct adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ kfree((unsigned char *)ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = CHECK_HIQ_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+ -+struct btinfo { -+ u8 cid; -+ u8 len; -+ -+ u8 bConnection:1; -+ u8 bSCOeSCO:1; -+ u8 bInQPage:1; -+ u8 bACLBusy:1; -+ u8 bSCOBusy:1; -+ u8 bHID:1; -+ u8 bA2DP:1; -+ u8 bFTP:1; -+ -+ u8 retry_cnt:4; -+ u8 rsvd_34:1; -+ u8 rsvd_35:1; -+ u8 rsvd_36:1; -+ u8 rsvd_37:1; -+ -+ u8 rssi; -+ -+ u8 rsvd_50:1; -+ u8 rsvd_51:1; -+ u8 rsvd_52:1; -+ u8 rsvd_53:1; -+ u8 rsvd_54:1; -+ u8 rsvd_55:1; -+ u8 eSCO_SCO:1; -+ u8 Master_Slave:1; -+ -+ u8 rsvd_6; -+ u8 rsvd_7; -+}; -+ -+static void rtw_btinfo_hdl(struct adapter *adapter, u8 *buf, u16 buf_len) -+{ -+ #define BTINFO_WIFI_FETCH 0x23 -+ #define BTINFO_BT_AUTO_RPT 0x27 -+ struct btinfo *info = (struct btinfo *)buf; -+ u8 cmd_idx; -+ u8 len; -+ -+ cmd_idx = info->cid; -+ -+ if (info->len > buf_len-2) { -+ rtw_warn_on(1); -+ len = buf_len-2; -+ } else { -+ len = info->len; -+ } -+ -+/* define DBG_PROC_SET_BTINFO_EVT */ -+#ifdef DBG_PROC_SET_BTINFO_EVT -+ btinfo_evt_dump(RTW_DBGDUMP, info); -+#endif -+ -+ /* transform BT-FW btinfo to WiFI-FW C2H format and notify */ -+ if (cmd_idx == BTINFO_WIFI_FETCH) -+ buf[1] = 0; -+ else if (cmd_idx == BTINFO_BT_AUTO_RPT) -+ buf[1] = 2; -+ rtw_btcoex_BtInfoNotify(adapter, len+1, &buf[1]); -+} -+ -+u8 rtw_c2h_packet_wk_cmd(struct adapter *padapter, u8 *pbuf, u16 length) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ kfree((u8 *)ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = C2H_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = length; -+ pdrvextra_cmd_parm->pbuf = pbuf; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+/* dont call R/W in this function, beucase SDIO interrupt have claim host */ -+/* or deadlock will happen and cause special-systemserver-died in android */ -+u8 rtw_c2h_wk_cmd(struct adapter *padapter, u8 *c2h_evt) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ kfree((u8 *)ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = C2H_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = c2h_evt?16:0; -+ pdrvextra_cmd_parm->pbuf = c2h_evt; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+} -+ -+static void c2h_wk_callback(_workitem *work) -+{ -+ struct evt_priv *evtpriv = container_of(work, struct evt_priv, c2h_wk); -+ struct adapter *adapter = container_of(evtpriv, struct adapter, evtpriv); -+ u8 *c2h_evt; -+ c2h_id_filter ccx_id_filter = rtw_hal_c2h_id_filter_ccx(adapter); -+ -+ evtpriv->c2h_wk_alive = true; -+ -+ while (!rtw_cbuf_empty(evtpriv->c2h_queue)) { -+ c2h_evt = (u8 *)rtw_cbuf_pop(evtpriv->c2h_queue); -+ if (c2h_evt != NULL) { -+ /* This C2H event is read, clear it */ -+ c2h_evt_clear(adapter); -+ } else{ -+ c2h_evt = (u8 *)rtw_malloc(16); -+ if (c2h_evt != NULL) { -+ /* This C2H event is not read, read & clear now */ -+ if (rtw_hal_c2h_evt_read(adapter, c2h_evt) != _SUCCESS) { -+ kfree(c2h_evt); -+ continue; -+ } -+ } -+ } -+ -+ /* Special pointer to trigger c2h_evt_clear only */ -+ if ((void *)c2h_evt == (void *)evtpriv) -+ continue; -+ -+ if (!rtw_hal_c2h_valid(adapter, c2h_evt)) { -+ kfree(c2h_evt); -+ continue; -+ } -+ -+ if (ccx_id_filter(c2h_evt) == true) { -+ /* Handle CCX report here */ -+ rtw_hal_c2h_handler(adapter, c2h_evt); -+ kfree(c2h_evt); -+ } else{ -+ /* Enqueue into cmd_thread for others */ -+ rtw_c2h_wk_cmd(adapter, c2h_evt); -+ } -+ } -+ -+ evtpriv->c2h_wk_alive = false; -+} -+ -+u8 rtw_drvextra_cmd_hdl(struct adapter *padapter, unsigned char *pbuf) -+{ -+ struct drvextra_cmd_parm *pdrvextra_cmd; -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ pdrvextra_cmd = (struct drvextra_cmd_parm *)pbuf; -+ -+ switch (pdrvextra_cmd->ec_id) { -+ case DYNAMIC_CHK_WK_CID:/* only primary padapter go to this cmd, but execute dynamic_chk_wk_hdl() for two interfaces */ -+ dynamic_chk_wk_hdl(padapter); -+ break; -+ case POWER_SAVING_CTRL_WK_CID: -+ power_saving_wk_hdl(padapter); -+ break; -+ case LPS_CTRL_WK_CID: -+ lps_ctrl_wk_hdl(padapter, (u8)pdrvextra_cmd->type); -+ break; -+ case DM_IN_LPS_WK_CID: -+ rtw_dm_in_lps_hdl(padapter); -+ break; -+ case LPS_CHANGE_DTIM_CID: -+ rtw_lps_change_dtim_hdl(padapter, (u8)pdrvextra_cmd->type); -+ break; -+ case CHECK_HIQ_WK_CID: -+ rtw_chk_hi_queue_hdl(padapter); -+ break; -+#ifdef CONFIG_INTEL_WIDI -+ case INTEl_WIDI_WK_CID: -+ intel_widi_wk_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); -+ break; -+#endif /* CONFIG_INTEL_WIDI */ -+ /* add for CONFIG_IEEE80211W, none 11w can use it */ -+ case RESET_SECURITYPRIV: -+ reset_securitypriv_hdl(padapter); -+ break; -+ case FREE_ASSOC_RESOURCES: -+ free_assoc_resources_hdl(padapter); -+ break; -+ case C2H_WK_CID: -+ rtw_hal_set_hwreg_with_buf(padapter, HW_VAR_C2H_HANDLE, pdrvextra_cmd->pbuf, pdrvextra_cmd->size); -+ break; -+ case DM_RA_MSK_WK_CID: -+ rtw_dm_ra_mask_hdl(padapter, (struct sta_info *)pdrvextra_cmd->pbuf); -+ break; -+ case BTINFO_WK_CID: -+ rtw_btinfo_hdl(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->size); -+ break; -+ default: -+ break; -+ } -+ -+ if (pdrvextra_cmd->pbuf && pdrvextra_cmd->size > 0) { -+ kfree(pdrvextra_cmd->pbuf); -+ } -+ -+ return H2C_SUCCESS; -+} -+ -+void rtw_survey_cmd_callback(struct adapter *padapter, struct cmd_obj *pcmd) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (pcmd->res == H2C_DROPPED) { -+ /* TODO: cancel timer and do timeout handler directly... */ -+ /* need to make timeout handlerOS independent */ -+ _set_timer(&pmlmepriv->scan_to_timer, 1); -+ } else if (pcmd->res != H2C_SUCCESS) { -+ _set_timer(&pmlmepriv->scan_to_timer, 1); -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("\n ********Error: MgntActrtw_set_802_11_bssid_LIST_SCAN Fail ************\n\n.")); -+ } -+ -+ /* free cmd */ -+ rtw_free_cmd_obj(pcmd); -+} -+ -+void rtw_disassoc_cmd_callback(struct adapter *padapter, struct cmd_obj *pcmd) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (pcmd->res != H2C_SUCCESS) { -+ spin_lock_bh(&pmlmepriv->lock); -+ set_fwstate(pmlmepriv, _FW_LINKED); -+ spin_unlock_bh(&pmlmepriv->lock); -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("\n ***Error: disconnect_cmd_callback Fail ***\n.")); -+ return; -+ } -+ /* free cmd */ -+ rtw_free_cmd_obj(pcmd); -+} -+ -+void rtw_joinbss_cmd_callback(struct adapter *padapter, struct cmd_obj *pcmd) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (pcmd->res == H2C_DROPPED) { -+ /* TODO: cancel timer and do timeout handler directly... */ -+ /* need to make timeout handlerOS independent */ -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ } else if (pcmd->res != H2C_SUCCESS) { -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ } -+ -+ rtw_free_cmd_obj(pcmd); -+} -+ -+void rtw_createbss_cmd_callback(struct adapter *padapter, struct cmd_obj *pcmd) -+{ -+ u8 timer_cancelled; -+ struct sta_info *psta = NULL; -+ struct wlan_network *pwlan = NULL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_bssid_ex *pnetwork = (struct wlan_bssid_ex *)pcmd->parmbuf; -+ struct wlan_network *tgt_network = &(pmlmepriv->cur_network); -+ -+ if (pcmd->parmbuf == NULL) -+ goto exit; -+ -+ if ((pcmd->res != H2C_SUCCESS)) { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("\n ********Error: rtw_createbss_cmd_callback Fail ************\n\n.")); -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ } -+ -+ _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled); -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ psta = rtw_get_stainfo(&padapter->stapriv, pnetwork->MacAddress); -+ if (!psta) { -+ psta = rtw_alloc_stainfo(&padapter->stapriv, pnetwork->MacAddress); -+ if (psta == NULL) { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("\nCan't alloc sta_info when createbss_cmd_callback\n")); -+ goto createbss_cmd_fail; -+ } -+ } -+ -+ rtw_indicate_connect(padapter); -+ } else{ -+ pwlan = _rtw_alloc_network(pmlmepriv); -+ spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); -+ if (pwlan == NULL) { -+ pwlan = rtw_get_oldest_wlan_network(&pmlmepriv->scanned_queue); -+ if (pwlan == NULL) { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("\n Error: can't get pwlan in rtw_joinbss_event_callback\n")); -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ goto createbss_cmd_fail; -+ } -+ pwlan->last_scanned = jiffies; -+ } else{ -+ list_add_tail(&(pwlan->list), &pmlmepriv->scanned_queue.queue); -+ } -+ -+ pnetwork->Length = get_wlan_bssid_ex_sz(pnetwork); -+ memcpy(&(pwlan->network), pnetwork, pnetwork->Length); -+ /* pwlan->fixed = true; */ -+ -+ /* list_add_tail(&(pwlan->list), &pmlmepriv->scanned_queue.queue); */ -+ -+ /* copy pdev_network information to pmlmepriv->cur_network */ -+ memcpy(&tgt_network->network, pnetwork, (get_wlan_bssid_ex_sz(pnetwork))); -+ -+ /* reset DSConfig */ -+ /* tgt_network->network.Configuration.DSConfig = (u32)rtw_ch2freq(pnetwork->Configuration.DSConfig); */ -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ /* we will set _FW_LINKED when there is one more sat to join us (rtw_stassoc_event_callback) */ -+ -+ } -+ -+createbss_cmd_fail: -+ -+ spin_unlock_bh(&pmlmepriv->lock); -+exit: -+ rtw_free_cmd_obj(pcmd); -+} -+ -+ -+ -+void rtw_setstaKey_cmdrsp_callback(struct adapter *padapter, struct cmd_obj *pcmd) -+{ -+ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct set_stakey_rsp *psetstakey_rsp = (struct set_stakey_rsp *) (pcmd->rsp); -+ struct sta_info *psta = rtw_get_stainfo(pstapriv, psetstakey_rsp->addr); -+ -+ if (psta == NULL) { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("\nERROR: rtw_setstaKey_cmdrsp_callback => can't get sta_info\n\n")); -+ goto exit; -+ } -+exit: -+ rtw_free_cmd_obj(pcmd); -+} -+ -+void rtw_setassocsta_cmdrsp_callback(struct adapter *padapter, struct cmd_obj *pcmd) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct set_assocsta_parm *passocsta_parm = (struct set_assocsta_parm *)(pcmd->parmbuf); -+ struct set_assocsta_rsp *passocsta_rsp = (struct set_assocsta_rsp *) (pcmd->rsp); -+ struct sta_info *psta = rtw_get_stainfo(pstapriv, passocsta_parm->addr); -+ -+ if (psta == NULL) { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("\nERROR: setassocsta_cmdrsp_callbac => can't get sta_info\n\n")); -+ goto exit; -+ } -+ -+ psta->aid = psta->mac_id = passocsta_rsp->cam_id; -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) && (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true)) -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+ set_fwstate(pmlmepriv, _FW_LINKED); -+ spin_unlock_bh(&pmlmepriv->lock); -+ -+exit: -+ rtw_free_cmd_obj(pcmd); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_debug.c linux/3rdparty/rtl8723bs/core/rtw_debug.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_debug.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_debug.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1453 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_DEBUG_C_ -+ -+#include -+#include -+ -+u32 GlobalDebugLevel = _drv_err_; -+ -+#ifdef CONFIG_DEBUG_RTL871X -+ -+ u64 GlobalDebugComponents = \ -+ _module_rtl871x_xmit_c_ | -+ _module_xmit_osdep_c_ | -+ _module_rtl871x_recv_c_ | -+ _module_recv_osdep_c_ | -+ _module_rtl871x_mlme_c_ | -+ _module_mlme_osdep_c_ | -+ _module_rtl871x_sta_mgt_c_ | -+ _module_rtl871x_cmd_c_ | -+ _module_cmd_osdep_c_ | -+ _module_rtl871x_io_c_ | -+ _module_io_osdep_c_ | -+ _module_os_intfs_c_| -+ _module_rtl871x_security_c_| -+ _module_rtl871x_eeprom_c_| -+ _module_hal_init_c_| -+ _module_hci_hal_init_c_| -+ _module_rtl871x_ioctl_c_| -+ _module_rtl871x_ioctl_set_c_| -+ _module_rtl871x_ioctl_query_c_| -+ _module_rtl871x_pwrctrl_c_| -+ _module_hci_intfs_c_| -+ _module_hci_ops_c_| -+ _module_hci_ops_os_c_| -+ _module_rtl871x_ioctl_os_c| -+ _module_rtl8712_cmd_c_| -+ _module_hal_xmit_c_| -+ _module_rtl8712_recv_c_ | -+ _module_mp_ | -+ _module_efuse_; -+ -+#endif /* CONFIG_DEBUG_RTL871X */ -+ -+#include -+ -+void dump_drv_version(void *sel) -+{ -+ DBG_871X_SEL_NL(sel, "%s %s\n", "rtl8723bs", DRIVERVERSION); -+} -+ -+void dump_log_level(void *sel) -+{ -+ DBG_871X_SEL_NL(sel, "log_level:%d\n", GlobalDebugLevel); -+} -+ -+void sd_f0_reg_dump(void *sel, struct adapter *adapter) -+{ -+ int i; -+ -+ for (i = 0x0; i <= 0xff; i++) { -+ if (i%16 == 0) -+ DBG_871X_SEL_NL(sel, "0x%02x ", i); -+ -+ DBG_871X_SEL(sel, "%02x ", rtw_sd_f0_read8(adapter, i)); -+ -+ if (i%16 == 15) -+ DBG_871X_SEL(sel, "\n"); -+ else if (i%8 == 7) -+ DBG_871X_SEL(sel, "\t"); -+ } -+} -+ -+void mac_reg_dump(void *sel, struct adapter *adapter) -+{ -+ int i, j = 1; -+ -+ DBG_871X_SEL_NL(sel, "======= MAC REG =======\n"); -+ -+ for (i = 0x0; i < 0x800; i += 4) { -+ if (j%4 == 1) -+ DBG_871X_SEL_NL(sel, "0x%03x", i); -+ DBG_871X_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++)%4 == 0) -+ DBG_871X_SEL(sel, "\n"); -+ } -+} -+ -+void bb_reg_dump(void *sel, struct adapter *adapter) -+{ -+ int i, j = 1; -+ -+ DBG_871X_SEL_NL(sel, "======= BB REG =======\n"); -+ for (i = 0x800; i < 0x1000 ; i += 4) { -+ if (j%4 == 1) -+ DBG_871X_SEL_NL(sel, "0x%03x", i); -+ DBG_871X_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++)%4 == 0) -+ DBG_871X_SEL(sel, "\n"); -+ } -+} -+ -+void rf_reg_dump(void *sel, struct adapter *adapter) -+{ -+ int i, j = 1, path; -+ u32 value; -+ u8 rf_type = 0; -+ u8 path_nums = 0; -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if ((RF_1T2R == rf_type) || (RF_1T1R == rf_type)) -+ path_nums = 1; -+ else -+ path_nums = 2; -+ -+ DBG_871X_SEL_NL(sel, "======= RF REG =======\n"); -+ -+ for (path = 0; path < path_nums; path++) { -+ DBG_871X_SEL_NL(sel, "RF_Path(%x)\n", path); -+ for (i = 0; i < 0x100; i++) { -+ value = rtw_hal_read_rfreg(adapter, path, i, 0xffffffff); -+ if (j%4 == 1) -+ DBG_871X_SEL_NL(sel, "0x%02x ", i); -+ DBG_871X_SEL(sel, " 0x%08x ", value); -+ if ((j++)%4 == 0) -+ DBG_871X_SEL(sel, "\n"); -+ } -+ } -+} -+ -+#ifdef CONFIG_PROC_DEBUG -+ssize_t proc_set_write_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 addr, val, len; -+ -+ if (count < 3) { -+ DBG_871X("argument size is less than 3\n"); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%x %x %x", &addr, &val, &len); -+ -+ if (num != 3) { -+ DBG_871X("invalid write_reg parameter!\n"); -+ return count; -+ } -+ -+ switch (len) { -+ case 1: -+ rtw_write8(padapter, addr, (u8)val); -+ break; -+ case 2: -+ rtw_write16(padapter, addr, (u16)val); -+ break; -+ case 4: -+ rtw_write32(padapter, addr, val); -+ break; -+ default: -+ DBG_871X("error write length =%d", len); -+ break; -+ } -+ -+ } -+ -+ return count; -+ -+} -+ -+static u32 proc_get_read_addr = 0xeeeeeeee; -+static u32 proc_get_read_len = 0x4; -+ -+int proc_get_read_reg(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ if (proc_get_read_addr == 0xeeeeeeee) { -+ DBG_871X_SEL_NL(m, "address not initialized\n"); -+ return 0; -+ } -+ -+ switch (proc_get_read_len) { -+ case 1: -+ DBG_871X_SEL_NL(m, "rtw_read8(0x%x) = 0x%x\n", proc_get_read_addr, rtw_read8(padapter, proc_get_read_addr)); -+ break; -+ case 2: -+ DBG_871X_SEL_NL(m, "rtw_read16(0x%x) = 0x%x\n", proc_get_read_addr, rtw_read16(padapter, proc_get_read_addr)); -+ break; -+ case 4: -+ DBG_871X_SEL_NL(m, "rtw_read32(0x%x) = 0x%x\n", proc_get_read_addr, rtw_read32(padapter, proc_get_read_addr)); -+ break; -+ default: -+ DBG_871X_SEL_NL(m, "error read length =%d\n", proc_get_read_len); -+ break; -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_read_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ char tmp[16]; -+ u32 addr, len; -+ -+ if (count < 2) { -+ DBG_871X("argument size is less than 2\n"); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%x %x", &addr, &len); -+ -+ if (num != 2) { -+ DBG_871X("invalid read_reg parameter!\n"); -+ return count; -+ } -+ -+ proc_get_read_addr = addr; -+ -+ proc_get_read_len = len; -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_fwstate(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ DBG_871X_SEL_NL(m, "fwstate = 0x%x\n", get_fwstate(pmlmepriv)); -+ -+ return 0; -+} -+ -+int proc_get_sec_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct security_priv *sec = &padapter->securitypriv; -+ -+ DBG_871X_SEL_NL(m, "auth_alg = 0x%x, enc_alg = 0x%x, auth_type = 0x%x, enc_type = 0x%x\n", -+ sec->dot11AuthAlgrthm, sec->dot11PrivacyAlgrthm, -+ sec->ndisauthtype, sec->ndisencryptstatus); -+ -+ DBG_871X_SEL_NL(m, "hw_decrypted =%d\n", sec->hw_decrypted); -+ -+#ifdef DBG_SW_SEC_CNT -+ DBG_871X_SEL_NL(m, "wep_sw_enc_cnt =%llu, %llu, %llu\n" -+ , sec->wep_sw_enc_cnt_bc, sec->wep_sw_enc_cnt_mc, sec->wep_sw_enc_cnt_uc); -+ DBG_871X_SEL_NL(m, "wep_sw_dec_cnt =%llu, %llu, %llu\n" -+ , sec->wep_sw_dec_cnt_bc, sec->wep_sw_dec_cnt_mc, sec->wep_sw_dec_cnt_uc); -+ -+ DBG_871X_SEL_NL(m, "tkip_sw_enc_cnt =%llu, %llu, %llu\n" -+ , sec->tkip_sw_enc_cnt_bc, sec->tkip_sw_enc_cnt_mc, sec->tkip_sw_enc_cnt_uc); -+ DBG_871X_SEL_NL(m, "tkip_sw_dec_cnt =%llu, %llu, %llu\n" -+ , sec->tkip_sw_dec_cnt_bc, sec->tkip_sw_dec_cnt_mc, sec->tkip_sw_dec_cnt_uc); -+ -+ DBG_871X_SEL_NL(m, "aes_sw_enc_cnt =%llu, %llu, %llu\n" -+ , sec->aes_sw_enc_cnt_bc, sec->aes_sw_enc_cnt_mc, sec->aes_sw_enc_cnt_uc); -+ DBG_871X_SEL_NL(m, "aes_sw_dec_cnt =%llu, %llu, %llu\n" -+ , sec->aes_sw_dec_cnt_bc, sec->aes_sw_dec_cnt_mc, sec->aes_sw_dec_cnt_uc); -+#endif /* DBG_SW_SEC_CNT */ -+ -+ return 0; -+} -+ -+int proc_get_mlmext_state(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ DBG_871X_SEL_NL(m, "pmlmeinfo->state = 0x%x\n", pmlmeinfo->state); -+ -+ return 0; -+} -+ -+int proc_get_roam_flags(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X_SEL_NL(m, "0x%02x\n", rtw_roam_flags(adapter)); -+ -+ return 0; -+} -+ -+ssize_t proc_set_roam_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ char tmp[32]; -+ u8 flags; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%hhx", &flags); -+ -+ if (num == 1) -+ rtw_assign_roam_flags(adapter, flags); -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_roam_param(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ -+ DBG_871X_SEL_NL(m, "%12s %12s %11s\n", "rssi_diff_th", "scanr_exp_ms", "scan_int_ms"); -+ DBG_871X_SEL_NL(m, "%-12u %-12u %-11u\n" -+ , mlme->roam_rssi_diff_th -+ , mlme->roam_scanr_exp_ms -+ , mlme->roam_scan_int_ms -+ ); -+ -+ return 0; -+} -+ -+ssize_t proc_set_roam_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ -+ char tmp[32]; -+ u8 rssi_diff_th; -+ u32 scanr_exp_ms; -+ u32 scan_int_ms; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%hhu %u %u", &rssi_diff_th, &scanr_exp_ms, &scan_int_ms); -+ -+ if (num >= 1) -+ mlme->roam_rssi_diff_th = rssi_diff_th; -+ if (num >= 2) -+ mlme->roam_scanr_exp_ms = scanr_exp_ms; -+ if (num >= 3) -+ mlme->roam_scan_int_ms = scan_int_ms; -+ } -+ -+ return count; -+ -+} -+ -+ssize_t proc_set_roam_tgt_addr(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ char tmp[32]; -+ u8 addr[ETH_ALEN]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%hhx:%hhx:%hhx:%hhx:%hhx:%hhx", addr, addr+1, addr+2, addr+3, addr+4, addr+5); -+ if (num == 6) -+ memcpy(adapter->mlmepriv.roam_tgt_addr, addr, ETH_ALEN); -+ -+ DBG_871X("set roam_tgt_addr to "MAC_FMT"\n", MAC_ARG(adapter->mlmepriv.roam_tgt_addr)); -+ } -+ -+ return count; -+} -+ -+int proc_get_qos_option(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ DBG_871X_SEL_NL(m, "qos_option =%d\n", pmlmepriv->qospriv.qos_option); -+ -+ return 0; -+} -+ -+int proc_get_ht_option(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ DBG_871X_SEL_NL(m, "ht_option =%d\n", pmlmepriv->htpriv.ht_option); -+ -+ return 0; -+} -+ -+int proc_get_rf_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ DBG_871X_SEL_NL(m, "cur_ch =%d, cur_bw =%d, cur_ch_offet =%d\n", -+ pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ -+ DBG_871X_SEL_NL(m, "oper_ch =%d, oper_bw =%d, oper_ch_offet =%d\n", -+ rtw_get_oper_ch(padapter), rtw_get_oper_bw(padapter), rtw_get_oper_choffset(padapter)); -+ -+ return 0; -+} -+ -+int proc_get_survey_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct __queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ struct list_head *plist, *phead; -+ s32 notify_signal; -+ s16 notify_noise = 0; -+ u16 index = 0; -+ -+ spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); -+ phead = get_list_head(queue); -+ plist = phead ? get_next(phead) : NULL; -+ plist = get_next(phead); -+ if ((!phead) || (!plist)) { -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ return 0; -+ } -+ -+ DBG_871X_SEL_NL(m, "%5s %-17s %3s %-3s %-4s %-4s %5s %s\n", "index", "bssid", "ch", "RSSI", "SdBm", "Noise", "age", "ssid"); -+ while (1) { -+ if (phead == plist) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ if (!pnetwork) -+ break; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true && -+ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { -+ notify_signal = translate_percentage_to_dbm(padapter->recvpriv.signal_strength);/*dbm*/ -+ } else { -+ notify_signal = translate_percentage_to_dbm(pnetwork->network.PhyInfo.SignalStrength);/*dbm*/ -+ } -+ -+ #if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &(pnetwork->network.Configuration.DSConfig), &(notify_noise)); -+ #endif -+ -+ DBG_871X_SEL_NL(m, "%5d "MAC_FMT" %3d %3d %4d %4d %5d %s\n", -+ ++index, -+ MAC_ARG(pnetwork->network.MacAddress), -+ pnetwork->network.Configuration.DSConfig, -+ (int)pnetwork->network.Rssi, -+ notify_signal, -+ notify_noise, -+ jiffies_to_msecs(jiffies - pnetwork->last_scanned), -+ /*translate_percentage_to_dbm(pnetwork->network.PhyInfo.SignalStrength),*/ -+ pnetwork->network.Ssid.Ssid); -+ plist = get_next(plist); -+ } -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ -+ return 0; -+} -+ -+int proc_get_ap_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct sta_info *psta; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); -+ if (psta) { -+ int i; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ -+ DBG_871X_SEL_NL(m, "SSID =%s\n", cur_network->network.Ssid.Ssid); -+ DBG_871X_SEL_NL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ DBG_871X_SEL_NL(m, "cur_channel =%d, cur_bwmode =%d, cur_ch_offset =%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ DBG_871X_SEL_NL(m, "wireless_mode = 0x%x, rtsen =%d, cts2slef =%d\n", psta->wireless_mode, psta->rtsen, psta->cts2self); -+ DBG_871X_SEL_NL(m, "state = 0x%x, aid =%d, macid =%d, raid =%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); -+ DBG_871X_SEL_NL(m, "qos_en =%d, ht_en =%d, init_rate =%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ DBG_871X_SEL_NL(m, "bwmode =%d, ch_offset =%d, sgi_20m =%d, sgi_40m =%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); -+ DBG_871X_SEL_NL(m, "ampdu_enable = %d\n", psta->htpriv.ampdu_enable); -+ DBG_871X_SEL_NL(m, "agg_enable_bitmap =%x, candidate_tid_bitmap =%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); -+ DBG_871X_SEL_NL(m, "ldpc_cap = 0x%x, stbc_cap = 0x%x, beamform_cap = 0x%x\n", psta->htpriv.ldpc_cap, psta->htpriv.stbc_cap, psta->htpriv.beamform_cap); -+ -+ for (i = 0; i < 16; i++) { -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ if (preorder_ctrl->enable) { -+ DBG_871X_SEL_NL(m, "tid =%d, indicate_seq =%d\n", i, preorder_ctrl->indicate_seq); -+ } -+ } -+ -+ } else{ -+ DBG_871X_SEL_NL(m, "can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); -+ } -+ -+ return 0; -+} -+ -+int proc_get_adapter_state(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X_SEL_NL(m, "name =%s, bSurpriseRemoved =%d, bDriverStopped =%d\n", -+ dev->name, padapter->bSurpriseRemoved, padapter->bDriverStopped); -+ -+ return 0; -+} -+ -+int proc_get_trx_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ int i; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct hw_xmit *phwxmit; -+ -+ DBG_871X_SEL_NL(m, "free_xmitbuf_cnt =%d, free_xmitframe_cnt =%d\n" -+ , pxmitpriv->free_xmitbuf_cnt, pxmitpriv->free_xmitframe_cnt); -+ DBG_871X_SEL_NL(m, "free_ext_xmitbuf_cnt =%d, free_xframe_ext_cnt =%d\n" -+ , pxmitpriv->free_xmit_extbuf_cnt, pxmitpriv->free_xframe_ext_cnt); -+ DBG_871X_SEL_NL(m, "free_recvframe_cnt =%d\n" -+ , precvpriv->free_recvframe_cnt); -+ -+ for (i = 0; i < 4; i++) { -+ phwxmit = pxmitpriv->hwxmits + i; -+ DBG_871X_SEL_NL(m, "%d, hwq.accnt =%d\n", i, phwxmit->accnt); -+ } -+ -+ return 0; -+} -+ -+int proc_get_rate_ctl(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ if (adapter->fix_rate != 0xff) { -+ DBG_871X_SEL_NL(m, "FIX\n"); -+ DBG_871X_SEL_NL(m, "0x%02x\n", adapter->fix_rate); -+ } else { -+ DBG_871X_SEL_NL(m, "RA\n"); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_rate_ctl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 fix_rate; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%hhx", &fix_rate); -+ -+ if (num >= 1) -+ adapter->fix_rate = fix_rate; -+ } -+ -+ return count; -+} -+ -+u8 g_fwdl_chksum_fail = 0; -+u8 g_fwdl_wintint_rdy_fail = 0; -+ -+ssize_t proc_set_fwdl_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ char tmp[32]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ sscanf(tmp, "%hhu %hhu", &g_fwdl_chksum_fail, &g_fwdl_wintint_rdy_fail); -+ } -+ -+ return count; -+} -+ -+u32 g_wait_hiq_empty = 0; -+ -+ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ char tmp[32]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ sscanf(tmp, "%u", &g_wait_hiq_empty); -+ } -+ -+ return count; -+} -+ -+int proc_get_suspend_resume_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; -+ -+ DBG_871X_SEL_NL(m, "dbg_sdio_alloc_irq_cnt =%d\n", pdbgpriv->dbg_sdio_alloc_irq_cnt); -+ DBG_871X_SEL_NL(m, "dbg_sdio_free_irq_cnt =%d\n", pdbgpriv->dbg_sdio_free_irq_cnt); -+ DBG_871X_SEL_NL(m, "dbg_sdio_alloc_irq_error_cnt =%d\n", pdbgpriv->dbg_sdio_alloc_irq_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_sdio_free_irq_error_cnt =%d\n", pdbgpriv->dbg_sdio_free_irq_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_sdio_init_error_cnt =%d\n", pdbgpriv->dbg_sdio_init_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_sdio_deinit_error_cnt =%d\n", pdbgpriv->dbg_sdio_deinit_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_suspend_error_cnt =%d\n", pdbgpriv->dbg_suspend_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_suspend_cnt =%d\n", pdbgpriv->dbg_suspend_cnt); -+ DBG_871X_SEL_NL(m, "dbg_resume_cnt =%d\n", pdbgpriv->dbg_resume_cnt); -+ DBG_871X_SEL_NL(m, "dbg_resume_error_cnt =%d\n", pdbgpriv->dbg_resume_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_deinit_fail_cnt =%d\n", pdbgpriv->dbg_deinit_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_carddisable_cnt =%d\n", pdbgpriv->dbg_carddisable_cnt); -+ DBG_871X_SEL_NL(m, "dbg_ps_insuspend_cnt =%d\n", pdbgpriv->dbg_ps_insuspend_cnt); -+ DBG_871X_SEL_NL(m, "dbg_dev_unload_inIPS_cnt =%d\n", pdbgpriv->dbg_dev_unload_inIPS_cnt); -+ DBG_871X_SEL_NL(m, "dbg_scan_pwr_state_cnt =%d\n", pdbgpriv->dbg_scan_pwr_state_cnt); -+ DBG_871X_SEL_NL(m, "dbg_downloadfw_pwr_state_cnt =%d\n", pdbgpriv->dbg_downloadfw_pwr_state_cnt); -+ DBG_871X_SEL_NL(m, "dbg_carddisable_error_cnt =%d\n", pdbgpriv->dbg_carddisable_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_fw_read_ps_state_fail_cnt =%d\n", pdbgpriv->dbg_fw_read_ps_state_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_leave_ips_fail_cnt =%d\n", pdbgpriv->dbg_leave_ips_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_leave_lps_fail_cnt =%d\n", pdbgpriv->dbg_leave_lps_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_h2c_leave32k_fail_cnt =%d\n", pdbgpriv->dbg_h2c_leave32k_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_diswow_dload_fw_fail_cnt =%d\n", pdbgpriv->dbg_diswow_dload_fw_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_enwow_dload_fw_fail_cnt =%d\n", pdbgpriv->dbg_enwow_dload_fw_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_ips_drvopen_fail_cnt =%d\n", pdbgpriv->dbg_ips_drvopen_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_poll_fail_cnt =%d\n", pdbgpriv->dbg_poll_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_rpwm_toogle_cnt =%d\n", pdbgpriv->dbg_rpwm_toogle_cnt); -+ DBG_871X_SEL_NL(m, "dbg_rpwm_timeout_fail_cnt =%d\n", pdbgpriv->dbg_rpwm_timeout_fail_cnt); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_DBG_COUNTER -+ -+int proc_get_rx_logs(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct rx_logs *rx_logs = &padapter->rx_logs; -+ -+ DBG_871X_SEL_NL(m, -+ "intf_rx =%d\n" -+ "intf_rx_err_recvframe =%d\n" -+ "intf_rx_err_skb =%d\n" -+ "intf_rx_report =%d\n" -+ "core_rx =%d\n" -+ "core_rx_pre =%d\n" -+ "core_rx_pre_ver_err =%d\n" -+ "core_rx_pre_mgmt =%d\n" -+ "core_rx_pre_mgmt_err_80211w =%d\n" -+ "core_rx_pre_mgmt_err =%d\n" -+ "core_rx_pre_ctrl =%d\n" -+ "core_rx_pre_ctrl_err =%d\n" -+ "core_rx_pre_data =%d\n" -+ "core_rx_pre_data_wapi_seq_err =%d\n" -+ "core_rx_pre_data_wapi_key_err =%d\n" -+ "core_rx_pre_data_handled =%d\n" -+ "core_rx_pre_data_err =%d\n" -+ "core_rx_pre_data_unknown =%d\n" -+ "core_rx_pre_unknown =%d\n" -+ "core_rx_enqueue =%d\n" -+ "core_rx_dequeue =%d\n" -+ "core_rx_post =%d\n" -+ "core_rx_post_decrypt =%d\n" -+ "core_rx_post_decrypt_wep =%d\n" -+ "core_rx_post_decrypt_tkip =%d\n" -+ "core_rx_post_decrypt_aes =%d\n" -+ "core_rx_post_decrypt_wapi =%d\n" -+ "core_rx_post_decrypt_hw =%d\n" -+ "core_rx_post_decrypt_unknown =%d\n" -+ "core_rx_post_decrypt_err =%d\n" -+ "core_rx_post_defrag_err =%d\n" -+ "core_rx_post_portctrl_err =%d\n" -+ "core_rx_post_indicate =%d\n" -+ "core_rx_post_indicate_in_oder =%d\n" -+ "core_rx_post_indicate_reoder =%d\n" -+ "core_rx_post_indicate_err =%d\n" -+ "os_indicate =%d\n" -+ "os_indicate_ap_mcast =%d\n" -+ "os_indicate_ap_forward =%d\n" -+ "os_indicate_ap_self =%d\n" -+ "os_indicate_err =%d\n" -+ "os_netif_ok =%d\n" -+ "os_netif_err =%d\n", -+ rx_logs->intf_rx, -+ rx_logs->intf_rx_err_recvframe, -+ rx_logs->intf_rx_err_skb, -+ rx_logs->intf_rx_report, -+ rx_logs->core_rx, -+ rx_logs->core_rx_pre, -+ rx_logs->core_rx_pre_ver_err, -+ rx_logs->core_rx_pre_mgmt, -+ rx_logs->core_rx_pre_mgmt_err_80211w, -+ rx_logs->core_rx_pre_mgmt_err, -+ rx_logs->core_rx_pre_ctrl, -+ rx_logs->core_rx_pre_ctrl_err, -+ rx_logs->core_rx_pre_data, -+ rx_logs->core_rx_pre_data_wapi_seq_err, -+ rx_logs->core_rx_pre_data_wapi_key_err, -+ rx_logs->core_rx_pre_data_handled, -+ rx_logs->core_rx_pre_data_err, -+ rx_logs->core_rx_pre_data_unknown, -+ rx_logs->core_rx_pre_unknown, -+ rx_logs->core_rx_enqueue, -+ rx_logs->core_rx_dequeue, -+ rx_logs->core_rx_post, -+ rx_logs->core_rx_post_decrypt, -+ rx_logs->core_rx_post_decrypt_wep, -+ rx_logs->core_rx_post_decrypt_tkip, -+ rx_logs->core_rx_post_decrypt_aes, -+ rx_logs->core_rx_post_decrypt_wapi, -+ rx_logs->core_rx_post_decrypt_hw, -+ rx_logs->core_rx_post_decrypt_unknown, -+ rx_logs->core_rx_post_decrypt_err, -+ rx_logs->core_rx_post_defrag_err, -+ rx_logs->core_rx_post_portctrl_err, -+ rx_logs->core_rx_post_indicate, -+ rx_logs->core_rx_post_indicate_in_oder, -+ rx_logs->core_rx_post_indicate_reoder, -+ rx_logs->core_rx_post_indicate_err, -+ rx_logs->os_indicate, -+ rx_logs->os_indicate_ap_mcast, -+ rx_logs->os_indicate_ap_forward, -+ rx_logs->os_indicate_ap_self, -+ rx_logs->os_indicate_err, -+ rx_logs->os_netif_ok, -+ rx_logs->os_netif_err -+ ); -+ -+ return 0; -+} -+ -+int proc_get_tx_logs(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct tx_logs *tx_logs = &padapter->tx_logs; -+ -+ DBG_871X_SEL_NL(m, -+ "os_tx =%d\n" -+ "os_tx_err_up =%d\n" -+ "os_tx_err_xmit =%d\n" -+ "os_tx_m2u =%d\n" -+ "os_tx_m2u_ignore_fw_linked =%d\n" -+ "os_tx_m2u_ignore_self =%d\n" -+ "os_tx_m2u_entry =%d\n" -+ "os_tx_m2u_entry_err_xmit =%d\n" -+ "os_tx_m2u_entry_err_skb =%d\n" -+ "os_tx_m2u_stop =%d\n" -+ "core_tx =%d\n" -+ "core_tx_err_pxmitframe =%d\n" -+ "core_tx_err_brtx =%d\n" -+ "core_tx_upd_attrib =%d\n" -+ "core_tx_upd_attrib_adhoc =%d\n" -+ "core_tx_upd_attrib_sta =%d\n" -+ "core_tx_upd_attrib_ap =%d\n" -+ "core_tx_upd_attrib_unknown =%d\n" -+ "core_tx_upd_attrib_dhcp =%d\n" -+ "core_tx_upd_attrib_icmp =%d\n" -+ "core_tx_upd_attrib_active =%d\n" -+ "core_tx_upd_attrib_err_ucast_sta =%d\n" -+ "core_tx_upd_attrib_err_ucast_ap_link =%d\n" -+ "core_tx_upd_attrib_err_sta =%d\n" -+ "core_tx_upd_attrib_err_link =%d\n" -+ "core_tx_upd_attrib_err_sec =%d\n" -+ "core_tx_ap_enqueue_warn_fwstate =%d\n" -+ "core_tx_ap_enqueue_warn_sta =%d\n" -+ "core_tx_ap_enqueue_warn_nosta =%d\n" -+ "core_tx_ap_enqueue_warn_link =%d\n" -+ "core_tx_ap_enqueue_warn_trigger =%d\n" -+ "core_tx_ap_enqueue_mcast =%d\n" -+ "core_tx_ap_enqueue_ucast =%d\n" -+ "core_tx_ap_enqueue =%d\n" -+ "intf_tx =%d\n" -+ "intf_tx_pending_ac =%d\n" -+ "intf_tx_pending_fw_under_survey =%d\n" -+ "intf_tx_pending_fw_under_linking =%d\n" -+ "intf_tx_pending_xmitbuf =%d\n" -+ "intf_tx_enqueue =%d\n" -+ "core_tx_enqueue =%d\n" -+ "core_tx_enqueue_class =%d\n" -+ "core_tx_enqueue_class_err_sta =%d\n" -+ "core_tx_enqueue_class_err_nosta =%d\n" -+ "core_tx_enqueue_class_err_fwlink =%d\n" -+ "intf_tx_direct =%d\n" -+ "intf_tx_direct_err_coalesce =%d\n" -+ "intf_tx_dequeue =%d\n" -+ "intf_tx_dequeue_err_coalesce =%d\n" -+ "intf_tx_dump_xframe =%d\n" -+ "intf_tx_dump_xframe_err_txdesc =%d\n" -+ "intf_tx_dump_xframe_err_port =%d\n", -+ tx_logs->os_tx, -+ tx_logs->os_tx_err_up, -+ tx_logs->os_tx_err_xmit, -+ tx_logs->os_tx_m2u, -+ tx_logs->os_tx_m2u_ignore_fw_linked, -+ tx_logs->os_tx_m2u_ignore_self, -+ tx_logs->os_tx_m2u_entry, -+ tx_logs->os_tx_m2u_entry_err_xmit, -+ tx_logs->os_tx_m2u_entry_err_skb, -+ tx_logs->os_tx_m2u_stop, -+ tx_logs->core_tx, -+ tx_logs->core_tx_err_pxmitframe, -+ tx_logs->core_tx_err_brtx, -+ tx_logs->core_tx_upd_attrib, -+ tx_logs->core_tx_upd_attrib_adhoc, -+ tx_logs->core_tx_upd_attrib_sta, -+ tx_logs->core_tx_upd_attrib_ap, -+ tx_logs->core_tx_upd_attrib_unknown, -+ tx_logs->core_tx_upd_attrib_dhcp, -+ tx_logs->core_tx_upd_attrib_icmp, -+ tx_logs->core_tx_upd_attrib_active, -+ tx_logs->core_tx_upd_attrib_err_ucast_sta, -+ tx_logs->core_tx_upd_attrib_err_ucast_ap_link, -+ tx_logs->core_tx_upd_attrib_err_sta, -+ tx_logs->core_tx_upd_attrib_err_link, -+ tx_logs->core_tx_upd_attrib_err_sec, -+ tx_logs->core_tx_ap_enqueue_warn_fwstate, -+ tx_logs->core_tx_ap_enqueue_warn_sta, -+ tx_logs->core_tx_ap_enqueue_warn_nosta, -+ tx_logs->core_tx_ap_enqueue_warn_link, -+ tx_logs->core_tx_ap_enqueue_warn_trigger, -+ tx_logs->core_tx_ap_enqueue_mcast, -+ tx_logs->core_tx_ap_enqueue_ucast, -+ tx_logs->core_tx_ap_enqueue, -+ tx_logs->intf_tx, -+ tx_logs->intf_tx_pending_ac, -+ tx_logs->intf_tx_pending_fw_under_survey, -+ tx_logs->intf_tx_pending_fw_under_linking, -+ tx_logs->intf_tx_pending_xmitbuf, -+ tx_logs->intf_tx_enqueue, -+ tx_logs->core_tx_enqueue, -+ tx_logs->core_tx_enqueue_class, -+ tx_logs->core_tx_enqueue_class_err_sta, -+ tx_logs->core_tx_enqueue_class_err_nosta, -+ tx_logs->core_tx_enqueue_class_err_fwlink, -+ tx_logs->intf_tx_direct, -+ tx_logs->intf_tx_direct_err_coalesce, -+ tx_logs->intf_tx_dequeue, -+ tx_logs->intf_tx_dequeue_err_coalesce, -+ tx_logs->intf_tx_dump_xframe, -+ tx_logs->intf_tx_dump_xframe_err_txdesc, -+ tx_logs->intf_tx_dump_xframe_err_port -+ ); -+ -+ return 0; -+} -+ -+int proc_get_int_logs(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X_SEL_NL(m, -+ "all =%d\n" -+ "err =%d\n" -+ "tbdok =%d\n" -+ "tbder =%d\n" -+ "bcnderr =%d\n" -+ "bcndma =%d\n" -+ "bcndma_e =%d\n" -+ "rx =%d\n" -+ "rx_rdu =%d\n" -+ "rx_fovw =%d\n" -+ "txfovw =%d\n" -+ "mgntok =%d\n" -+ "highdok =%d\n" -+ "bkdok =%d\n" -+ "bedok =%d\n" -+ "vidok =%d\n" -+ "vodok =%d\n", -+ padapter->int_logs.all, -+ padapter->int_logs.err, -+ padapter->int_logs.tbdok, -+ padapter->int_logs.tbder, -+ padapter->int_logs.bcnderr, -+ padapter->int_logs.bcndma, -+ padapter->int_logs.bcndma_e, -+ padapter->int_logs.rx, -+ padapter->int_logs.rx_rdu, -+ padapter->int_logs.rx_fovw, -+ padapter->int_logs.txfovw, -+ padapter->int_logs.mgntok, -+ padapter->int_logs.highdok, -+ padapter->int_logs.bkdok, -+ padapter->int_logs.bedok, -+ padapter->int_logs.vidok, -+ padapter->int_logs.vodok -+ ); -+ -+ return 0; -+} -+ -+#endif /* CONFIG_DBG_COUNTER*/ -+ -+int proc_get_rx_signal(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X_SEL_NL(m, "rssi:%d\n", padapter->recvpriv.rssi); -+ /*DBG_871X_SEL_NL(m, "rxpwdb:%d\n", padapter->recvpriv.rxpwdb);*/ -+ DBG_871X_SEL_NL(m, "signal_strength:%u\n", padapter->recvpriv.signal_strength); -+ DBG_871X_SEL_NL(m, "signal_qual:%u\n", padapter->recvpriv.signal_qual); -+ DBG_871X_SEL_NL(m, "noise:%d\n", padapter->recvpriv.noise); -+ rtw_odm_get_perpkt_rssi(m, padapter); -+ #ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ rtw_get_raw_rssi_info(m, padapter); -+ #endif -+ return 0; -+} -+ -+ -+int proc_get_hw_status(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; -+ -+ DBG_871X_SEL_NL(m, "RX FIFO full count: last_time =%lld, current_time =%lld, differential =%lld\n" -+ , pdbgpriv->dbg_rx_fifo_last_overflow, pdbgpriv->dbg_rx_fifo_curr_overflow, pdbgpriv->dbg_rx_fifo_diff_overflow); -+ -+ return 0; -+} -+ -+ssize_t proc_set_rx_signal(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 is_signal_dbg, signal_strength; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%u %u", &is_signal_dbg, &signal_strength); -+ -+ is_signal_dbg = is_signal_dbg == 0?0:1; -+ -+ if (is_signal_dbg && num != 2) -+ return count; -+ -+ signal_strength = signal_strength > 100?100:signal_strength; -+ -+ padapter->recvpriv.is_signal_dbg = is_signal_dbg; -+ padapter->recvpriv.signal_strength_dbg = signal_strength; -+ -+ if (is_signal_dbg) -+ DBG_871X("set %s %u\n", "DBG_SIGNAL_STRENGTH", signal_strength); -+ else -+ DBG_871X("set %s\n", "HW_SIGNAL_STRENGTH"); -+ -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_ht_enable(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ if (pregpriv) -+ DBG_871X_SEL_NL(m, "%d\n", pregpriv->ht_enable); -+ -+ return 0; -+} -+ -+ssize_t proc_set_ht_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ sscanf(tmp, "%d ", &mode); -+ -+ if (pregpriv && mode >= 0 && mode < 2) { -+ pregpriv->ht_enable = mode; -+ printk("ht_enable =%d\n", pregpriv->ht_enable); -+ } -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_bw_mode(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ if (pregpriv) -+ DBG_871X_SEL_NL(m, "0x%02x\n", pregpriv->bw_mode); -+ -+ return 0; -+} -+ -+ssize_t proc_set_bw_mode(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ sscanf(tmp, "%d ", &mode); -+ -+ if (pregpriv && mode < 2) { -+ -+ pregpriv->bw_mode = mode; -+ printk("bw_mode =%d\n", mode); -+ -+ } -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_ampdu_enable(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ if (pregpriv) -+ DBG_871X_SEL_NL(m, "%d\n", pregpriv->ampdu_enable); -+ -+ return 0; -+} -+ -+ssize_t proc_set_ampdu_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ sscanf(tmp, "%d ", &mode); -+ -+ if (pregpriv && mode < 3) { -+ pregpriv->ampdu_enable = mode; -+ printk("ampdu_enable =%d\n", mode); -+ } -+ -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_rx_ampdu(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pregpriv) -+ DBG_871X_SEL_NL(m, -+ "bAcceptAddbaReq = %d , 0:Reject AP's Add BA req, 1:Accept AP's Add BA req.\n", pmlmeinfo->bAcceptAddbaReq -+ ); -+ -+ return 0; -+} -+ -+ssize_t proc_set_rx_ampdu(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ sscanf(tmp, "%d ", &mode); -+ -+ if (pregpriv && mode >= 0 && mode < 2) { -+ pmlmeinfo->bAcceptAddbaReq = mode; -+ DBG_871X("pmlmeinfo->bAcceptAddbaReq =%d\n", pmlmeinfo->bAcceptAddbaReq); -+ if (mode == 0) { -+ /*tear down Rx AMPDU*/ -+ send_delba(padapter, 0, get_my_bssid(&(pmlmeinfo->network)));/* recipient*/ -+ } -+ } -+ -+ } -+ -+ return count; -+} -+ -+int proc_get_en_fwps(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ if (pregpriv) -+ DBG_871X_SEL_NL(m, "check_fw_ps = %d , 1:enable get FW PS state , 0: disable get FW PS state\n" -+ , pregpriv->check_fw_ps); -+ -+ return 0; -+} -+ -+ssize_t proc_set_en_fwps(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ sscanf(tmp, "%d ", &mode); -+ -+ if (pregpriv && mode >= 0 && mode < 2) { -+ pregpriv->check_fw_ps = mode; -+ DBG_871X("pregpriv->check_fw_ps =%d\n", pregpriv->check_fw_ps); -+ } -+ } -+ return count; -+} -+ -+int proc_get_rx_stbc(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ if (pregpriv) -+ DBG_871X_SEL_NL(m, "%d\n", pregpriv->rx_stbc); -+ -+ return 0; -+} -+ -+ssize_t proc_set_rx_stbc(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ sscanf(tmp, "%d ", &mode); -+ -+ if (pregpriv && (mode == 0 || mode == 1 || -+ mode == 2 || mode == 3)) { -+ pregpriv->rx_stbc = mode; -+ printk("rx_stbc =%d\n", mode); -+ } -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_rssi_disp(struct seq_file *m, void *v) -+{ -+ return 0; -+} -+ -+ssize_t proc_set_rssi_disp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 enable = 0; -+ -+ if (count < 1) { -+ DBG_8192C("argument size is less than 1\n"); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ int num = sscanf(tmp, "%x", &enable); -+ -+ if (num != 1) { -+ DBG_8192C("invalid set_rssi_disp parameter!\n"); -+ return count; -+ } -+ -+ if (enable) { -+ DBG_8192C("Linked info Function Enable\n"); -+ padapter->bLinkInfoDump = enable; -+ } else { -+ DBG_8192C("Linked info Function Disable\n"); -+ padapter->bLinkInfoDump = 0; -+ } -+ } -+ return count; -+} -+ -+int proc_get_all_sta_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct sta_info *psta; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ int i, j; -+ struct list_head *plist, *phead; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ -+ DBG_871X_SEL_NL(m, "sta_dz_bitmap = 0x%x, tim_bitmap = 0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap); -+ -+ spin_lock_bh(&pstapriv->sta_hash_lock); -+ -+ for (i = 0; i < NUM_STA; i++) { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while (phead != plist) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ plist = get_next(plist); -+ -+ DBG_871X_SEL_NL(m, "==============================\n"); -+ DBG_871X_SEL_NL(m, "sta's macaddr:" MAC_FMT "\n", -+ MAC_ARG(psta->hwaddr)); -+ DBG_871X_SEL_NL(m, "rtsen =%d, cts2slef =%d\n", -+ psta->rtsen, psta->cts2self); -+ DBG_871X_SEL_NL(m, "state = 0x%x, aid =%d, macid =%d, raid =%d\n", -+ psta->state, psta->aid, psta->mac_id, -+ psta->raid); -+ DBG_871X_SEL_NL(m, "qos_en =%d, ht_en =%d, init_rate =%d\n", -+ psta->qos_option, -+ psta->htpriv.ht_option, -+ psta->init_rate); -+ DBG_871X_SEL_NL(m, "bwmode =%d, ch_offset =%d, sgi_20m =%d, sgi_40m =%d\n", -+ psta->bw_mode, psta->htpriv.ch_offset, -+ psta->htpriv.sgi_20m, -+ psta->htpriv.sgi_40m); -+ DBG_871X_SEL_NL(m, "ampdu_enable = %d\n", -+ psta->htpriv.ampdu_enable); -+ DBG_871X_SEL_NL(m, "agg_enable_bitmap =%x, candidate_tid_bitmap =%x\n", -+ psta->htpriv.agg_enable_bitmap, -+ psta->htpriv.candidate_tid_bitmap); -+ DBG_871X_SEL_NL(m, "sleepq_len =%d\n", -+ psta->sleepq_len); -+ DBG_871X_SEL_NL(m, "sta_xmitpriv.vo_q_qcnt =%d\n", -+ psta->sta_xmitpriv.vo_q.qcnt); -+ DBG_871X_SEL_NL(m, "sta_xmitpriv.vi_q_qcnt =%d\n", -+ psta->sta_xmitpriv.vi_q.qcnt); -+ DBG_871X_SEL_NL(m, "sta_xmitpriv.be_q_qcnt =%d\n", -+ psta->sta_xmitpriv.be_q.qcnt); -+ DBG_871X_SEL_NL(m, "sta_xmitpriv.bk_q_qcnt =%d\n", -+ psta->sta_xmitpriv.bk_q.qcnt); -+ -+ DBG_871X_SEL_NL(m, "capability = 0x%x\n", -+ psta->capability); -+ DBG_871X_SEL_NL(m, "flags = 0x%x\n", psta->flags); -+ DBG_871X_SEL_NL(m, "wpa_psk = 0x%x\n", psta->wpa_psk); -+ DBG_871X_SEL_NL(m, "wpa2_group_cipher = 0x%x\n", -+ psta->wpa2_group_cipher); -+ DBG_871X_SEL_NL(m, "wpa2_pairwise_cipher = 0x%x\n", -+ psta->wpa2_pairwise_cipher); -+ DBG_871X_SEL_NL(m, "qos_info = 0x%x\n", psta->qos_info); -+ DBG_871X_SEL_NL(m, "dot118021XPrivacy = 0x%x\n", -+ psta->dot118021XPrivacy); -+ -+ for (j = 0; j < 16; j++) { -+ preorder_ctrl = &psta->recvreorder_ctrl[j]; -+ if (preorder_ctrl->enable) -+ DBG_871X_SEL_NL(m, "tid =%d, indicate_seq =%d\n", -+ j, preorder_ctrl->indicate_seq); -+ } -+ DBG_871X_SEL_NL(m, "==============================\n"); -+ } -+ } -+ -+ spin_unlock_bh(&pstapriv->sta_hash_lock); -+ -+ return 0; -+} -+ -+int proc_get_btcoex_dbg(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter; -+ char buf[512] = {0}; -+ padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ rtw_btcoex_GetDBG(padapter, buf, 512); -+ -+ DBG_871X_SEL(m, "%s", buf); -+ -+ return 0; -+} -+ -+ssize_t proc_set_btcoex_dbg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *padapter; -+ u8 tmp[80] = {0}; -+ u32 module[2] = {0}; -+ u32 num; -+ -+ padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+/* DBG_871X("+" FUNC_ADPT_FMT "\n", FUNC_ADPT_ARG(padapter));*/ -+ -+ if (NULL == buffer) { -+ DBG_871X(FUNC_ADPT_FMT ": input buffer is NULL!\n", -+ FUNC_ADPT_ARG(padapter)); -+ -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ DBG_871X(FUNC_ADPT_FMT ": input length is 0!\n", -+ FUNC_ADPT_ARG(padapter)); -+ -+ return -EFAULT; -+ } -+ -+ num = count; -+ if (num > (sizeof(tmp) - 1)) -+ num = (sizeof(tmp) - 1); -+ -+ if (copy_from_user(tmp, buffer, num)) { -+ DBG_871X(FUNC_ADPT_FMT ": copy buffer from user space FAIL!\n", -+ FUNC_ADPT_ARG(padapter)); -+ -+ return -EFAULT; -+ } -+ -+ num = sscanf(tmp, "%x %x", module, module+1); -+ if (1 == num) { -+ if (0 == module[0]) -+ memset(module, 0, sizeof(module)); -+ else -+ memset(module, 0xFF, sizeof(module)); -+ } else if (2 != num) { -+ DBG_871X(FUNC_ADPT_FMT ": input(\"%s\") format incorrect!\n", -+ FUNC_ADPT_ARG(padapter), tmp); -+ -+ if (0 == num) -+ return -EFAULT; -+ } -+ -+ DBG_871X(FUNC_ADPT_FMT ": input 0x%08X 0x%08X\n", -+ FUNC_ADPT_ARG(padapter), module[0], module[1]); -+ rtw_btcoex_SetDBG(padapter, module); -+ -+ return count; -+} -+ -+int proc_get_btcoex_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter; -+ const u32 bufsize = 30*100; -+ u8 *pbuf = NULL; -+ -+ padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ pbuf = rtw_zmalloc(bufsize); -+ if (NULL == pbuf) { -+ return -ENOMEM; -+ } -+ -+ rtw_btcoex_DisplayBtCoexInfo(padapter, pbuf, bufsize); -+ -+ DBG_871X_SEL(m, "%s\n", pbuf); -+ -+ kfree(pbuf); -+ -+ return 0; -+} -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_eeprom.c linux/3rdparty/rtl8723bs/core/rtw_eeprom.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_eeprom.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_eeprom.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,369 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_EEPROM_C_ -+ -+#include -+#include -+#include -+ -+void up_clk(_adapter *padapter, u16 *x) -+{ -+_func_enter_; -+ *x = *x | _EESK; -+ rtw_write8(padapter, EE_9346CR, (u8)*x); -+ udelay(CLOCK_RATE); -+ -+_func_exit_; -+ -+} -+ -+void down_clk(_adapter *padapter, u16 *x) -+{ -+_func_enter_; -+ *x = *x & ~_EESK; -+ rtw_write8(padapter, EE_9346CR, (u8)*x); -+ udelay(CLOCK_RATE); -+_func_exit_; -+} -+ -+void shift_out_bits(_adapter *padapter, u16 data, u16 count) -+{ -+ u16 x, mask; -+_func_enter_; -+ -+ if (padapter->bSurpriseRemoved == true) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true")); -+ goto out; -+ } -+ mask = 0x01 << (count - 1); -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EEDO | _EEDI); -+ -+ do { -+ x &= ~_EEDI; -+ if (data & mask) -+ x |= _EEDI; -+ if (padapter->bSurpriseRemoved == true) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true")); -+ goto out; -+ } -+ rtw_write8(padapter, EE_9346CR, (u8)x); -+ udelay(CLOCK_RATE); -+ up_clk(padapter, &x); -+ down_clk(padapter, &x); -+ mask = mask >> 1; -+ } while (mask); -+ if (padapter->bSurpriseRemoved == true) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true")); -+ goto out; -+ } -+ x &= ~_EEDI; -+ rtw_write8(padapter, EE_9346CR, (u8)x); -+out: -+_func_exit_; -+} -+ -+u16 shift_in_bits(_adapter *padapter) -+{ -+ u16 x, d = 0, i; -+_func_enter_; -+ if (padapter->bSurpriseRemoved == true) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true")); -+ goto out; -+ } -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EEDO | _EEDI); -+ d = 0; -+ -+ for (i = 0; i < 16; i++) { -+ d = d << 1; -+ up_clk(padapter, &x); -+ if (padapter->bSurpriseRemoved == true) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true")); -+ goto out; -+ } -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EEDI); -+ if (x & _EEDO) -+ d |= 1; -+ -+ down_clk(padapter, &x); -+ } -+out: -+_func_exit_; -+ -+ return d; -+} -+ -+void standby(_adapter *padapter) -+{ -+ u8 x; -+_func_enter_; -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EECS | _EESK); -+ rtw_write8(padapter, EE_9346CR, x); -+ -+ udelay(CLOCK_RATE); -+ x |= _EECS; -+ rtw_write8(padapter, EE_9346CR, x); -+ udelay(CLOCK_RATE); -+_func_exit_; -+} -+ -+u16 wait_eeprom_cmd_done(_adapter *padapter) -+{ -+ u8 x; -+ u16 i, res = false; -+_func_enter_; -+ standby(padapter); -+ for (i = 0; i < 200; i++) { -+ x = rtw_read8(padapter, EE_9346CR); -+ if (x & _EEDO) { -+ res = true; -+ goto exit; -+ } -+ udelay(CLOCK_RATE); -+ } -+exit: -+_func_exit_; -+ return res; -+} -+ -+void eeprom_clean(_adapter *padapter) -+{ -+ u16 x; -+_func_enter_; -+ if (padapter->bSurpriseRemoved == true) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true")); -+ goto out; -+ } -+ x = rtw_read8(padapter, EE_9346CR); -+ if (padapter->bSurpriseRemoved == true) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true")); -+ goto out; -+ } -+ x &= ~(_EECS | _EEDI); -+ rtw_write8(padapter, EE_9346CR, (u8)x); -+ if (padapter->bSurpriseRemoved == true) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true")); -+ goto out; -+ } -+ up_clk(padapter, &x); -+ if (padapter->bSurpriseRemoved == true) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true")); -+ goto out; -+ } -+ down_clk(padapter, &x); -+out: -+_func_exit_; -+} -+ -+void eeprom_write16(_adapter *padapter, u16 reg, u16 data) -+{ -+ u8 x; -+ -+_func_enter_; -+ -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EEDI | _EEDO | _EESK | _EEM0); -+ x |= _EEM1 | _EECS; -+ rtw_write8(padapter, EE_9346CR, x); -+ -+ shift_out_bits(padapter, EEPROM_EWEN_OPCODE, 5); -+ -+ if (padapter->EepromAddressSize == 8) /*CF+ and SDIO*/ -+ shift_out_bits(padapter, 0, 6); -+ else /*USB*/ -+ shift_out_bits(padapter, 0, 4); -+ -+ standby(padapter); -+ -+/* Commented out by rcnjko, 2004.0 -+* Erase this particular word. Write the erase opcode and register -+* number in that order. The opcode is 3bits in length; reg is 6 bits long. -+* shift_out_bits(Adapter, EEPROM_ERASE_OPCODE, 3); -+* shift_out_bits(Adapter, reg, Adapter->EepromAddressSize); -+* -+* if (wait_eeprom_cmd_done(Adapter ) == false) -+* { -+* return; -+* } -+*/ -+ -+ standby(padapter); -+ -+ /* write the new word to the EEPROM*/ -+ -+ /* send the write opcode the EEPORM*/ -+ shift_out_bits(padapter, EEPROM_WRITE_OPCODE, 3); -+ -+ /* select which word in the EEPROM that we are writing to.*/ -+ shift_out_bits(padapter, reg, padapter->EepromAddressSize); -+ -+ /* write the data to the selected EEPROM word.*/ -+ shift_out_bits(padapter, data, 16); -+ -+ if (wait_eeprom_cmd_done(padapter) == false) { -+ -+ goto exit; -+ } -+ -+ standby(padapter); -+ -+ shift_out_bits(padapter, EEPROM_EWDS_OPCODE, 5); -+ shift_out_bits(padapter, reg, 4); -+ -+ eeprom_clean(padapter); -+exit: -+_func_exit_; -+ return; -+} -+ -+u16 eeprom_read16(_adapter *padapter, u16 reg) /*ReadEEprom*/ -+{ -+ -+ u16 x; -+ u16 data = 0; -+ -+_func_enter_; -+ -+ if (padapter->bSurpriseRemoved == true) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true")); -+ goto out; -+ } -+ /* select EEPROM, reset bits, set _EECS*/ -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ if (padapter->bSurpriseRemoved == true) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true")); -+ goto out; -+ } -+ -+ x &= ~(_EEDI | _EEDO | _EESK | _EEM0); -+ x |= _EEM1 | _EECS; -+ rtw_write8(padapter, EE_9346CR, (unsigned char)x); -+ -+ /* write the read opcode and register number in that order*/ -+ /* The opcode is 3bits in length, reg is 6 bits long*/ -+ shift_out_bits(padapter, EEPROM_READ_OPCODE, 3); -+ shift_out_bits(padapter, reg, padapter->EepromAddressSize); -+ -+ /* Now read the data (16 bits) in from the selected EEPROM word*/ -+ data = shift_in_bits(padapter); -+ -+ eeprom_clean(padapter); -+out: -+_func_exit_; -+ return data; -+ -+ -+} -+ -+ -+ -+ -+/*From even offset*/ -+void eeprom_read_sz(_adapter *padapter, u16 reg, u8 *data, u32 sz) -+{ -+ -+ u16 x, data16; -+ u32 i; -+_func_enter_; -+ if (padapter->bSurpriseRemoved == true) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true")); -+ goto out; -+ } -+ /* select EEPROM, reset bits, set _EECS*/ -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ if (padapter->bSurpriseRemoved == true) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true")); -+ goto out; -+ } -+ -+ x &= ~(_EEDI | _EEDO | _EESK | _EEM0); -+ x |= _EEM1 | _EECS; -+ rtw_write8(padapter, EE_9346CR, (unsigned char)x); -+ -+ /* write the read opcode and register number in that order*/ -+ /* The opcode is 3bits in length, reg is 6 bits long*/ -+ shift_out_bits(padapter, EEPROM_READ_OPCODE, 3); -+ shift_out_bits(padapter, reg, padapter->EepromAddressSize); -+ -+ -+ for (i = 0; i < sz; i += 2) { -+ data16 = shift_in_bits(padapter); -+ data[i] = data16 & 0xff; -+ data[i+1] = data16 >> 8; -+ } -+ -+ eeprom_clean(padapter); -+out: -+_func_exit_; -+ -+ -+ -+} -+ -+ -+/*addr_off : address offset of the entry in eeprom (not the tuple number of eeprom (reg); that is addr_off !=reg)*/ -+u8 eeprom_read(_adapter *padapter, u32 addr_off, u8 sz, u8 *rbuf) -+{ -+ u8 quotient, remainder, addr_2align_odd; -+ u16 reg, stmp, i = 0, idx = 0; -+_func_enter_; -+ reg = (u16)(addr_off >> 1); -+ addr_2align_odd = (u8)(addr_off & 0x1); -+ -+ /*read that start at high part: e.g 1,3,5,7,9,...*/ -+ if (addr_2align_odd) { -+ stmp = eeprom_read16(padapter, reg); -+ rbuf[idx++] = (u8) ((stmp>>8)&0xff); /*return hogh-part of the short*/ -+ reg++; sz--; -+ } -+ -+ quotient = sz >> 1; -+ remainder = sz & 0x1; -+ -+ for (i = 0; i < quotient; i++) { -+ stmp = eeprom_read16(padapter, reg+i); -+ rbuf[idx++] = (u8) (stmp&0xff); -+ rbuf[idx++] = (u8) ((stmp>>8)&0xff); -+ } -+ -+ reg = reg+i; -+ if (remainder) { /*end of read at lower part of short : 0,2,4,6,...*/ -+ stmp = eeprom_read16(padapter, reg); -+ rbuf[idx] = (u8)(stmp & 0xff); -+ } -+_func_exit_; -+ return true; -+} -+ -+ -+ -+void read_eeprom_content(_adapter *padapter) -+{ -+ -+_func_enter_; -+ -+ -+_func_exit_; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_efuse.c linux/3rdparty/rtl8723bs/core/rtw_efuse.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_efuse.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_efuse.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,635 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_EFUSE_C_ -+ -+#include -+#include -+#include -+#include -+ -+ -+/*------------------------Define local variable------------------------------*/ -+u8 fakeEfuseBank = 0; -+u32 fakeEfuseUsedBytes = 0; -+u8 fakeEfuseContent[EFUSE_MAX_HW_SIZE] = {0}; -+u8 fakeEfuseInitMap[EFUSE_MAX_MAP_LEN] = {0}; -+u8 fakeEfuseModifiedMap[EFUSE_MAX_MAP_LEN] = {0}; -+ -+u32 BTEfuseUsedBytes = 0; -+u8 BTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+u8 BTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN] = {0}; -+u8 BTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN] = {0}; -+ -+u32 fakeBTEfuseUsedBytes = 0; -+u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+u8 fakeBTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN] = {0}; -+u8 fakeBTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN] = {0}; -+/*------------------------Define local variable------------------------------*/ -+ -+/* */ -+#define REG_EFUSE_CTRL 0x0030 -+#define EFUSE_CTRL REG_EFUSE_CTRL /* E-Fuse Control. */ -+/* */ -+ -+bool -+Efuse_Read1ByteFromFakeContent( -+ struct adapter *padapter, -+ u16 Offset, -+ u8 *Value); -+bool -+Efuse_Read1ByteFromFakeContent( -+ struct adapter *padapter, -+ u16 Offset, -+ u8 *Value) -+{ -+ if (Offset >= EFUSE_MAX_HW_SIZE) { -+ return false; -+ } -+ /* DbgPrint("Read fake content, offset = %d\n", Offset); */ -+ if (fakeEfuseBank == 0) -+ *Value = fakeEfuseContent[Offset]; -+ else -+ *Value = fakeBTEfuseContent[fakeEfuseBank-1][Offset]; -+ return true; -+} -+ -+bool -+Efuse_Write1ByteToFakeContent( -+ struct adapter *padapter, -+ u16 Offset, -+ u8 Value); -+bool -+Efuse_Write1ByteToFakeContent( -+ struct adapter *padapter, -+ u16 Offset, -+ u8 Value) -+{ -+ if (Offset >= EFUSE_MAX_HW_SIZE) { -+ return false; -+ } -+ if (fakeEfuseBank == 0) -+ fakeEfuseContent[Offset] = Value; -+ else{ -+ fakeBTEfuseContent[fakeEfuseBank-1][Offset] = Value; -+ } -+ return true; -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: Efuse_PowerSwitch -+ * -+ * Overview: When we want to enable write operation, we should change to -+ * pwr on state. When we stop write, we should switch to 500k mode -+ * and disable LDO 2.5V. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/17/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+void -+Efuse_PowerSwitch( -+struct adapter *padapter, -+u8 bWrite, -+u8 PwrState) -+{ -+ padapter->HalFunc.EfusePowerSwitch(padapter, bWrite, PwrState); -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: Efuse_GetCurrentSize -+ * -+ * Overview: Get current efuse size!!! -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/16/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+u16 -+Efuse_GetCurrentSize( -+ struct adapter *padapter, -+ u8 efuseType, -+ bool bPseudoTest) -+{ -+ u16 ret = 0; -+ -+ ret = padapter->HalFunc.EfuseGetCurrentSize(padapter, efuseType, bPseudoTest); -+ -+ return ret; -+} -+ -+/* 11/16/2008 MH Add description. Get current efuse area enabled word!!. */ -+u8 -+Efuse_CalculateWordCnts(u8 word_en) -+{ -+ u8 word_cnts = 0; -+ if (!(word_en & BIT(0))) -+ word_cnts++; /* 0 : write enable */ -+ if (!(word_en & BIT(1))) -+ word_cnts++; -+ if (!(word_en & BIT(2))) -+ word_cnts++; -+ if (!(word_en & BIT(3))) -+ word_cnts++; -+ return word_cnts; -+} -+ -+/* */ -+/* Description: */ -+/* 1. Execute E-Fuse read byte operation according as map offset and */ -+/* save to E-Fuse table. */ -+/* 2. Refered from SD1 Richard. */ -+/* */ -+/* Assumption: */ -+/* 1. Boot from E-Fuse and successfully auto-load. */ -+/* 2. PASSIVE_LEVEL (USB interface) */ -+/* */ -+/* Created by Roger, 2008.10.21. */ -+/* */ -+/* 2008/12/12 MH 1. Reorganize code flow and reserve bytes. and add description. */ -+/* 2. Add efuse utilization collect. */ -+/* 2008/12/22 MH Read Efuse must check if we write section 1 data again!!! Sec1 */ -+/* write addr must be after sec5. */ -+/* */ -+ -+void -+efuse_ReadEFuse( -+ struct adapter *Adapter, -+ u8 efuseType, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+bool bPseudoTest -+ ); -+void -+efuse_ReadEFuse( -+ struct adapter *Adapter, -+ u8 efuseType, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+bool bPseudoTest -+ ) -+{ -+ Adapter->HalFunc.ReadEFuse(Adapter, efuseType, _offset, _size_byte, pbuf, bPseudoTest); -+} -+ -+void -+EFUSE_GetEfuseDefinition( -+ struct adapter *padapter, -+ u8 efuseType, -+ u8 type, -+ void *pOut, -+ bool bPseudoTest -+ ) -+{ -+ padapter->HalFunc.EFUSEGetEfuseDefinition(padapter, efuseType, type, pOut, bPseudoTest); -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: EFUSE_Read1Byte -+ * -+ * Overview: Copy from WMAC fot EFUSE read 1 byte. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 09/23/2008 MHC Copy from WMAC. -+ * -+ *---------------------------------------------------------------------------*/ -+u8 -+EFUSE_Read1Byte( -+struct adapter *Adapter, -+u16 Address) -+{ -+ u8 data; -+ u8 Bytetemp = {0x00}; -+ u8 temp = {0x00}; -+ u32 k = 0; -+ u16 contentLen = 0; -+ -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN, (void *)&contentLen, false); -+ -+ if (Address < contentLen) {/* E-fuse 512Byte */ -+ /* Write E-fuse Register address bit0~7 */ -+ temp = Address & 0xFF; -+ rtw_write8(Adapter, EFUSE_CTRL+1, temp); -+ Bytetemp = rtw_read8(Adapter, EFUSE_CTRL+2); -+ /* Write E-fuse Register address bit8~9 */ -+ temp = ((Address >> 8) & 0x03) | (Bytetemp & 0xFC); -+ rtw_write8(Adapter, EFUSE_CTRL+2, temp); -+ -+ /* Write 0x30[31]= 0 */ -+ Bytetemp = rtw_read8(Adapter, EFUSE_CTRL+3); -+ temp = Bytetemp & 0x7F; -+ rtw_write8(Adapter, EFUSE_CTRL+3, temp); -+ -+ /* Wait Write-ready (0x30[31]= 1) */ -+ Bytetemp = rtw_read8(Adapter, EFUSE_CTRL+3); -+ while (!(Bytetemp & 0x80)) { -+ Bytetemp = rtw_read8(Adapter, EFUSE_CTRL+3); -+ k++; -+ if (k == 1000) { -+ k = 0; -+ break; -+ } -+ } -+ data = rtw_read8(Adapter, EFUSE_CTRL); -+ return data; -+ } else -+ return 0xFF; -+ -+} /* EFUSE_Read1Byte */ -+ -+/* 11/16/2008 MH Read one byte from real Efuse. */ -+u8 -+efuse_OneByteRead( -+struct adapter *padapter, -+u16 addr, -+u8 *data, -+bool bPseudoTest) -+{ -+ u32 tmpidx = 0; -+ u8 bResult; -+ u8 readbyte; -+ -+ /* DBG_871X("===> EFUSE_OneByteRead(), addr = %x\n", addr); */ -+ /* DBG_871X("===> EFUSE_OneByteRead() start, 0x34 = 0x%X\n", rtw_read32(padapter, EFUSE_TEST)); */ -+ -+ if (bPseudoTest) { -+ bResult = Efuse_Read1ByteFromFakeContent(padapter, addr, data); -+ return bResult; -+ } -+ -+ /* <20130121, Kordan> For SMIC EFUSE specificatoin. */ -+ /* 0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) */ -+ /* PHY_SetMacReg(padapter, 0x34, BIT11, 0); */ -+ rtw_write16(padapter, 0x34, rtw_read16(padapter, 0x34) & (~BIT11)); -+ -+ /* -----------------e-fuse reg ctrl --------------------------------- */ -+ /* address */ -+ rtw_write8(padapter, EFUSE_CTRL+1, (u8)(addr&0xff)); -+ rtw_write8(padapter, EFUSE_CTRL+2, ((u8)((addr>>8) & 0x03)) | -+ (rtw_read8(padapter, EFUSE_CTRL+2)&0xFC)); -+ -+ /* rtw_write8(padapter, EFUSE_CTRL+3, 0x72); read cmd */ -+ /* Write bit 32 0 */ -+ readbyte = rtw_read8(padapter, EFUSE_CTRL+3); -+ rtw_write8(padapter, EFUSE_CTRL+3, (readbyte & 0x7f)); -+ -+ while (!(0x80 & rtw_read8(padapter, EFUSE_CTRL+3)) && (tmpidx < 1000)) { -+ mdelay(1); -+ tmpidx++; -+ } -+ if (tmpidx < 100) { -+ *data = rtw_read8(padapter, EFUSE_CTRL); -+ bResult = true; -+ } else{ -+ *data = 0xff; -+ bResult = false; -+ DBG_871X("%s: [ERROR] addr = 0x%x bResult =%d time out 1s !!!\n", __func__, addr, bResult); -+ DBG_871X("%s: [ERROR] EFUSE_CTRL = 0x%08x !!!\n", __func__, rtw_read32(padapter, EFUSE_CTRL)); -+ } -+ -+ return bResult; -+} -+ -+/* 11/16/2008 MH Write one byte to reald Efuse. */ -+u8 -+efuse_OneByteWrite( -+struct adapter *padapter, -+u16 addr, -+u8 data, -+bool bPseudoTest) -+{ -+ u8 tmpidx = 0; -+ u8 bResult = false; -+ u32 efuseValue = 0; -+ -+ /* DBG_871X("===> EFUSE_OneByteWrite(), addr = %x data =%x\n", addr, data); */ -+ /* DBG_871X("===> EFUSE_OneByteWrite() start, 0x34 = 0x%X\n", rtw_read32(padapter, EFUSE_TEST)); */ -+ -+ if (bPseudoTest) { -+ bResult = Efuse_Write1ByteToFakeContent(padapter, addr, data); -+ return bResult; -+ } -+ -+ -+ /* -----------------e-fuse reg ctrl --------------------------------- */ -+ /* address */ -+ -+ -+ efuseValue = rtw_read32(padapter, EFUSE_CTRL); -+ efuseValue |= (BIT21|BIT31); -+ efuseValue &= ~(0x3FFFF); -+ efuseValue |= ((addr<<8 | data) & 0x3FFFF); -+ -+ -+ /* <20130227, Kordan> 8192E MP chip A-cut had better not set 0x34[11] until B-Cut. */ -+ -+ /* <20130121, Kordan> For SMIC EFUSE specificatoin. */ -+ /* 0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) */ -+ /* PHY_SetMacReg(padapter, 0x34, BIT11, 1); */ -+ rtw_write16(padapter, 0x34, rtw_read16(padapter, 0x34) | (BIT11)); -+ rtw_write32(padapter, EFUSE_CTRL, 0x90600000|((addr<<8 | data))); -+ -+ while ((0x80 & rtw_read8(padapter, EFUSE_CTRL+3)) && (tmpidx < 100)) { -+ mdelay(1); -+ tmpidx++; -+ } -+ -+ if (tmpidx < 100) { -+ bResult = true; -+ } else{ -+ bResult = false; -+ DBG_871X("%s: [ERROR] addr = 0x%x , efuseValue = 0x%x , bResult =%d time out 1s !!!\n", -+ __func__, addr, efuseValue, bResult); -+ DBG_871X("%s: [ERROR] EFUSE_CTRL = 0x%08x !!!\n", __func__, rtw_read32(padapter, EFUSE_CTRL)); -+ } -+ -+ /* disable Efuse program enable */ -+ PHY_SetMacReg(padapter, EFUSE_TEST, BIT(11), 0); -+ -+ return bResult; -+} -+ -+int -+Efuse_PgPacketRead(struct adapter *padapter, -+ u8 offset, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ int ret = 0; -+ -+ ret = padapter->HalFunc.Efuse_PgPacketRead(padapter, offset, data, bPseudoTest); -+ -+ return ret; -+} -+ -+int -+Efuse_PgPacketWrite(struct adapter *padapter, -+ u8 offset, -+ u8 word_en, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ int ret; -+ -+ ret = padapter->HalFunc.Efuse_PgPacketWrite(padapter, offset, word_en, data, bPseudoTest); -+ -+ return ret; -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: efuse_WordEnableDataRead -+ * -+ * Overview: Read allowed word in current efuse section data. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/16/2008 MHC Create Version 0. -+ * 11/21/2008 MHC Fix Write bug when we only enable late word. -+ * -+ *---------------------------------------------------------------------------*/ -+void -+efuse_WordEnableDataRead(u8 word_en, -+ u8 *sourdata, -+ u8 *targetdata) -+{ -+ if (!(word_en&BIT(0))) { -+ targetdata[0] = sourdata[0]; -+ targetdata[1] = sourdata[1]; -+ } -+ if (!(word_en&BIT(1))) { -+ targetdata[2] = sourdata[2]; -+ targetdata[3] = sourdata[3]; -+ } -+ if (!(word_en&BIT(2))) { -+ targetdata[4] = sourdata[4]; -+ targetdata[5] = sourdata[5]; -+ } -+ if (!(word_en&BIT(3))) { -+ targetdata[6] = sourdata[6]; -+ targetdata[7] = sourdata[7]; -+ } -+} -+ -+ -+u8 -+Efuse_WordEnableDataWrite(struct adapter *padapter, -+ u16 efuse_addr, -+ u8 word_en, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ u8 ret = 0; -+ -+ ret = padapter->HalFunc.Efuse_WordEnableDataWrite(padapter, efuse_addr, word_en, data, bPseudoTest); -+ -+ return ret; -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: Efuse_ReadAllMap -+ * -+ * Overview: Read All Efuse content -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/11/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+void -+Efuse_ReadAllMap( -+ struct adapter *padapter, -+ u8 efuseType, -+ u8 *Efuse, -+ bool bPseudoTest); -+void -+Efuse_ReadAllMap( -+ struct adapter *padapter, -+ u8 efuseType, -+ u8 *Efuse, -+ bool bPseudoTest) -+{ -+ u16 mapLen = 0; -+ -+ Efuse_PowerSwitch(padapter, false, true); -+ -+ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, bPseudoTest); -+ -+ efuse_ReadEFuse(padapter, efuseType, 0, mapLen, Efuse, bPseudoTest); -+ -+ Efuse_PowerSwitch(padapter, false, false); -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: efuse_ShadowRead1Byte -+ * efuse_ShadowRead2Byte -+ * efuse_ShadowRead4Byte -+ * -+ * Overview: Read from efuse init map by one/two/four bytes !!!!! -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/12/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+static void -+efuse_ShadowRead1Byte( -+struct adapter *padapter, -+u16 Offset, -+ u8 *Value) -+{ -+ struct eeprom_priv *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ -+ *Value = pEEPROM->efuse_eeprom_data[Offset]; -+ -+} /* EFUSE_ShadowRead1Byte */ -+ -+/* Read Two Bytes */ -+static void -+efuse_ShadowRead2Byte( -+struct adapter *padapter, -+u16 Offset, -+ u16 *Value) -+{ -+ struct eeprom_priv *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ -+ *Value = pEEPROM->efuse_eeprom_data[Offset]; -+ *Value |= pEEPROM->efuse_eeprom_data[Offset+1]<<8; -+ -+} /* EFUSE_ShadowRead2Byte */ -+ -+/* Read Four Bytes */ -+static void -+efuse_ShadowRead4Byte( -+struct adapter *padapter, -+u16 Offset, -+ u32 *Value) -+{ -+ struct eeprom_priv *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ -+ *Value = pEEPROM->efuse_eeprom_data[Offset]; -+ *Value |= pEEPROM->efuse_eeprom_data[Offset+1]<<8; -+ *Value |= pEEPROM->efuse_eeprom_data[Offset+2]<<16; -+ *Value |= pEEPROM->efuse_eeprom_data[Offset+3]<<24; -+ -+} /* efuse_ShadowRead4Byte */ -+ -+/*----------------------------------------------------------------------------- -+ * Function: EFUSE_ShadowMapUpdate -+ * -+ * Overview: Transfer current EFUSE content to shadow init and modify map. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/13/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+void EFUSE_ShadowMapUpdate( -+ struct adapter *padapter, -+ u8 efuseType, -+ bool bPseudoTest) -+{ -+ struct eeprom_priv *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ u16 mapLen = 0; -+ -+ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, bPseudoTest); -+ -+ if (pEEPROM->bautoload_fail_flag == true) { -+ memset(pEEPROM->efuse_eeprom_data, 0xFF, mapLen); -+ } else{ -+ Efuse_ReadAllMap(padapter, efuseType, pEEPROM->efuse_eeprom_data, bPseudoTest); -+ } -+ -+ /* PlatformMoveMemory((void *)&pHalData->EfuseMap[EFUSE_MODIFY_MAP][0], */ -+ /* void *)&pHalData->EfuseMap[EFUSE_INIT_MAP][0], mapLen); */ -+} /* EFUSE_ShadowMapUpdate */ -+ -+ -+/*----------------------------------------------------------------------------- -+ * Function: EFUSE_ShadowRead -+ * -+ * Overview: Read from efuse init map !!!!! -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/12/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+void -+EFUSE_ShadowRead( -+ struct adapter *padapter, -+ u8 Type, -+ u16 Offset, -+ u32 *Value) -+{ -+ if (Type == 1) -+ efuse_ShadowRead1Byte(padapter, Offset, (u8 *)Value); -+ else if (Type == 2) -+ efuse_ShadowRead2Byte(padapter, Offset, (u16 *)Value); -+ else if (Type == 4) -+ efuse_ShadowRead4Byte(padapter, Offset, (u32 *)Value); -+ -+} /* EFUSE_ShadowRead*/ -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_ieee80211.c linux/3rdparty/rtl8723bs/core/rtw_ieee80211.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_ieee80211.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_ieee80211.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1433 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _IEEE80211_C -+ -+#include -+#include -+ -+ -+u8 RTW_WPA_OUI_TYPE[] = { 0x00, 0x50, 0xf2, 1 }; -+u16 RTW_WPA_VERSION = 1; -+u8 WPA_AUTH_KEY_MGMT_NONE[] = { 0x00, 0x50, 0xf2, 0 }; -+u8 WPA_AUTH_KEY_MGMT_UNSPEC_802_1X[] = { 0x00, 0x50, 0xf2, 1 }; -+u8 WPA_AUTH_KEY_MGMT_PSK_OVER_802_1X[] = { 0x00, 0x50, 0xf2, 2 }; -+u8 WPA_CIPHER_SUITE_NONE[] = { 0x00, 0x50, 0xf2, 0 }; -+u8 WPA_CIPHER_SUITE_WEP40[] = { 0x00, 0x50, 0xf2, 1 }; -+u8 WPA_CIPHER_SUITE_TKIP[] = { 0x00, 0x50, 0xf2, 2 }; -+u8 WPA_CIPHER_SUITE_WRAP[] = { 0x00, 0x50, 0xf2, 3 }; -+u8 WPA_CIPHER_SUITE_CCMP[] = { 0x00, 0x50, 0xf2, 4 }; -+u8 WPA_CIPHER_SUITE_WEP104[] = { 0x00, 0x50, 0xf2, 5 }; -+ -+u16 RSN_VERSION_BSD = 1; -+u8 RSN_AUTH_KEY_MGMT_UNSPEC_802_1X[] = { 0x00, 0x0f, 0xac, 1 }; -+u8 RSN_AUTH_KEY_MGMT_PSK_OVER_802_1X[] = { 0x00, 0x0f, 0xac, 2 }; -+u8 RSN_CIPHER_SUITE_NONE[] = { 0x00, 0x0f, 0xac, 0 }; -+u8 RSN_CIPHER_SUITE_WEP40[] = { 0x00, 0x0f, 0xac, 1 }; -+u8 RSN_CIPHER_SUITE_TKIP[] = { 0x00, 0x0f, 0xac, 2 }; -+u8 RSN_CIPHER_SUITE_WRAP[] = { 0x00, 0x0f, 0xac, 3 }; -+u8 RSN_CIPHER_SUITE_CCMP[] = { 0x00, 0x0f, 0xac, 4 }; -+u8 RSN_CIPHER_SUITE_WEP104[] = { 0x00, 0x0f, 0xac, 5 }; -+/* */ -+/* for adhoc-master to generate ie and provide supported-rate to fw */ -+/* */ -+ -+static u8 WIFI_CCKRATES[] = { -+ (IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK), -+ (IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK), -+ (IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK), -+ (IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK) -+}; -+ -+static u8 WIFI_OFDMRATES[] = { -+ (IEEE80211_OFDM_RATE_6MB), -+ (IEEE80211_OFDM_RATE_9MB), -+ (IEEE80211_OFDM_RATE_12MB), -+ (IEEE80211_OFDM_RATE_18MB), -+ (IEEE80211_OFDM_RATE_24MB), -+ IEEE80211_OFDM_RATE_36MB, -+ IEEE80211_OFDM_RATE_48MB, -+ IEEE80211_OFDM_RATE_54MB -+}; -+ -+ -+int rtw_get_bit_value_from_ieee_value(u8 val) -+{ -+ unsigned char dot11_rate_table[] = {2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108, 0}; /* last element must be zero!! */ -+ -+ int i = 0; -+ while (dot11_rate_table[i] != 0) { -+ if (dot11_rate_table[i] == val) -+ return BIT(i); -+ i++; -+ } -+ return 0; -+} -+ -+uint rtw_is_cckrates_included(u8 *rate) -+{ -+ u32 i = 0; -+ -+ while (rate[i] != 0) { -+ if ((((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || -+ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22)) -+ return true; -+ i++; -+ } -+ -+ return false; -+} -+ -+uint rtw_is_cckratesonly_included(u8 *rate) -+{ -+ u32 i = 0; -+ -+ -+ while (rate[i] != 0) { -+ if ((((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && -+ (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22)) -+ -+ return false; -+ -+ i++; -+ } -+ -+ return true; -+ -+} -+ -+int rtw_check_network_type(unsigned char *rate, int ratelen, int channel) -+{ -+ if (channel > 14) { -+ if ((rtw_is_cckrates_included(rate)) == true) -+ return WIRELESS_INVALID; -+ else -+ return WIRELESS_11A; -+ } else{ /* could be pure B, pure G, or B/G */ -+ if ((rtw_is_cckratesonly_included(rate)) == true) -+ return WIRELESS_11B; -+ else if ((rtw_is_cckrates_included(rate)) == true) -+ return WIRELESS_11BG; -+ else -+ return WIRELESS_11G; -+ } -+ -+} -+ -+u8 *rtw_set_fixed_ie(unsigned char *pbuf, unsigned int len, unsigned char *source, -+ unsigned int *frlen) -+{ -+ memcpy((void *)pbuf, (void *)source, len); -+ *frlen = *frlen + len; -+ return (pbuf + len); -+} -+ -+/* rtw_set_ie will update frame length */ -+u8 *rtw_set_ie -+( -+ u8 *pbuf, -+ sint index, -+ uint len, -+ u8 *source, -+ uint *frlen /* frame length */ -+) -+{ -+ *pbuf = (u8)index; -+ -+ *(pbuf + 1) = (u8)len; -+ -+ if (len > 0) -+ memcpy((void *)(pbuf + 2), (void *)source, len); -+ -+ *frlen = *frlen + (len + 2); -+ -+ return (pbuf + len + 2); -+} -+ -+/*---------------------------------------------------------------------------- -+index: the information element id index, limit is the limit for search -+-----------------------------------------------------------------------------*/ -+u8 *rtw_get_ie(u8 *pbuf, sint index, sint *len, sint limit) -+{ -+ sint tmp, i; -+ u8 *p; -+ -+ if (limit < 1) { -+ return NULL; -+ } -+ -+ p = pbuf; -+ i = 0; -+ *len = 0; -+ while (1) { -+ if (*p == index) { -+ *len = *(p + 1); -+ return p; -+ } else{ -+ tmp = *(p + 1); -+ p += (tmp + 2); -+ i += (tmp + 2); -+ } -+ if (i >= limit) -+ break; -+ } -+ return NULL; -+} -+ -+/** -+ * rtw_get_ie_ex - Search specific IE from a series of IEs -+ * @in_ie: Address of IEs to search -+ * @in_len: Length limit from in_ie -+ * @eid: Element ID to match -+ * @oui: OUI to match -+ * @oui_len: OUI length -+ * @ie: If not NULL and the specific IE is found, the IE will be copied to the buf starting from the specific IE -+ * @ielen: If not NULL and the specific IE is found, will set to the length of the entire IE -+ * -+ * Returns: The address of the specific IE found, or NULL -+ */ -+u8 *rtw_get_ie_ex(u8 *in_ie, uint in_len, u8 eid, u8 *oui, u8 oui_len, u8 *ie, uint *ielen) -+{ -+ uint cnt; -+ u8 *target_ie = NULL; -+ -+ -+ if (ielen) -+ *ielen = 0; -+ -+ if (!in_ie || in_len <= 0) -+ return target_ie; -+ -+ cnt = 0; -+ -+ while (cnt < in_len) { -+ if (eid == in_ie[cnt] -+ && (!oui || !memcmp(&in_ie[cnt+2], oui, oui_len))) { -+ target_ie = &in_ie[cnt]; -+ -+ if (ie) -+ memcpy(ie, &in_ie[cnt], in_ie[cnt+1]+2); -+ -+ if (ielen) -+ *ielen = in_ie[cnt+1]+2; -+ -+ break; -+ } else{ -+ cnt += in_ie[cnt+1]+2; /* goto next */ -+ } -+ -+ } -+ -+ return target_ie; -+} -+ -+/** -+ * rtw_ies_remove_ie - Find matching IEs and remove -+ * @ies: Address of IEs to search -+ * @ies_len: Pointer of length of ies, will update to new length -+ * @offset: The offset to start scarch -+ * @eid: Element ID to match -+ * @oui: OUI to match -+ * @oui_len: OUI length -+ * -+ * Returns: _SUCCESS: ies is updated, _FAIL: not updated -+ */ -+int rtw_ies_remove_ie(u8 *ies, uint *ies_len, uint offset, u8 eid, u8 *oui, u8 oui_len) -+{ -+ int ret = _FAIL; -+ u8 *target_ie; -+ u32 target_ielen; -+ u8 *start; -+ uint search_len; -+ -+ if (!ies || !ies_len || *ies_len <= offset) -+ goto exit; -+ -+ start = ies + offset; -+ search_len = *ies_len - offset; -+ -+ while (1) { -+ target_ie = rtw_get_ie_ex(start, search_len, eid, oui, oui_len, NULL, &target_ielen); -+ if (target_ie && target_ielen) { -+ u8 buf[MAX_IE_SZ] = {0}; -+ u8 *remain_ies = target_ie + target_ielen; -+ uint remain_len = search_len - (remain_ies - start); -+ -+ memcpy(buf, remain_ies, remain_len); -+ memcpy(target_ie, buf, remain_len); -+ *ies_len = *ies_len - target_ielen; -+ ret = _SUCCESS; -+ -+ start = target_ie; -+ search_len = remain_len; -+ } else { -+ break; -+ } -+ } -+exit: -+ return ret; -+} -+ -+void rtw_set_supported_rate(u8 *SupportedRates, uint mode) -+{ -+ memset(SupportedRates, 0, NDIS_802_11_LENGTH_RATES_EX); -+ -+ switch (mode) { -+ case WIRELESS_11B: -+ memcpy(SupportedRates, WIFI_CCKRATES, IEEE80211_CCK_RATE_LEN); -+ break; -+ -+ case WIRELESS_11G: -+ case WIRELESS_11A: -+ case WIRELESS_11_5N: -+ case WIRELESS_11A_5N:/* Todo: no basic rate for ofdm ? */ -+ case WIRELESS_11_5AC: -+ memcpy(SupportedRates, WIFI_OFDMRATES, IEEE80211_NUM_OFDM_RATESLEN); -+ break; -+ -+ case WIRELESS_11BG: -+ case WIRELESS_11G_24N: -+ case WIRELESS_11_24N: -+ case WIRELESS_11BG_24N: -+ memcpy(SupportedRates, WIFI_CCKRATES, IEEE80211_CCK_RATE_LEN); -+ memcpy(SupportedRates + IEEE80211_CCK_RATE_LEN, WIFI_OFDMRATES, IEEE80211_NUM_OFDM_RATESLEN); -+ break; -+ -+ } -+} -+ -+uint rtw_get_rateset_len(u8 *rateset) -+{ -+ uint i = 0; -+ -+ while (1) { -+ if ((rateset[i]) == 0) -+ break; -+ -+ if (i > 12) -+ break; -+ -+ i++; -+ } -+ return i; -+} -+ -+int rtw_generate_ie(struct registry_priv *pregistrypriv) -+{ -+ u8 wireless_mode; -+ int sz = 0, rateLen; -+ struct wlan_bssid_ex *pdev_network = &pregistrypriv->dev_network; -+ u8 *ie = pdev_network->IEs; -+ -+ /* timestamp will be inserted by hardware */ -+ sz += 8; -+ ie += sz; -+ -+ /* beacon interval : 2bytes */ -+ *(__le16 *)ie = cpu_to_le16((u16)pdev_network->Configuration.BeaconPeriod);/* BCN_INTERVAL; */ -+ sz += 2; -+ ie += 2; -+ -+ /* capability info */ -+ *(u16 *)ie = 0; -+ -+ *(__le16 *)ie |= cpu_to_le16(cap_IBSS); -+ -+ if (pregistrypriv->preamble == PREAMBLE_SHORT) -+ *(__le16 *)ie |= cpu_to_le16(cap_ShortPremble); -+ -+ if (pdev_network->Privacy) -+ *(__le16 *)ie |= cpu_to_le16(cap_Privacy); -+ -+ sz += 2; -+ ie += 2; -+ -+ /* SSID */ -+ ie = rtw_set_ie(ie, _SSID_IE_, pdev_network->Ssid.SsidLength, pdev_network->Ssid.Ssid, &sz); -+ -+ /* supported rates */ -+ if (pregistrypriv->wireless_mode == WIRELESS_11ABGN) { -+ if (pdev_network->Configuration.DSConfig > 14) -+ wireless_mode = WIRELESS_11A_5N; -+ else -+ wireless_mode = WIRELESS_11BG_24N; -+ } else{ -+ wireless_mode = pregistrypriv->wireless_mode; -+ } -+ -+ rtw_set_supported_rate(pdev_network->SupportedRates, wireless_mode); -+ -+ rateLen = rtw_get_rateset_len(pdev_network->SupportedRates); -+ -+ if (rateLen > 8) { -+ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, 8, pdev_network->SupportedRates, &sz); -+ /* ie = rtw_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rateLen - 8), (pdev_network->SupportedRates + 8), &sz); */ -+ } else{ -+ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, rateLen, pdev_network->SupportedRates, &sz); -+ } -+ -+ /* DS parameter set */ -+ ie = rtw_set_ie(ie, _DSSET_IE_, 1, (u8 *)&(pdev_network->Configuration.DSConfig), &sz); -+ -+ -+ /* IBSS Parameter Set */ -+ -+ ie = rtw_set_ie(ie, _IBSS_PARA_IE_, 2, (u8 *)&(pdev_network->Configuration.ATIMWindow), &sz); -+ -+ if (rateLen > 8) { -+ ie = rtw_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rateLen - 8), (pdev_network->SupportedRates + 8), &sz); -+ } -+ -+ /* HT Cap. */ -+ if (((pregistrypriv->wireless_mode&WIRELESS_11_5N) || (pregistrypriv->wireless_mode&WIRELESS_11_24N)) -+ && (pregistrypriv->ht_enable == true)) { -+ /* todo: */ -+ } -+ -+ /* pdev_network->IELength = sz; update IELength */ -+ -+ /* return _SUCCESS; */ -+ -+ return sz; -+} -+ -+unsigned char *rtw_get_wpa_ie(unsigned char *pie, int *wpa_ie_len, int limit) -+{ -+ int len; -+ u16 val16; -+ unsigned char wpa_oui_type[] = {0x00, 0x50, 0xf2, 0x01}; -+ u8 *pbuf = pie; -+ int limit_new = limit; -+ __le16 le_tmp; -+ -+ while (1) { -+ pbuf = rtw_get_ie(pbuf, _WPA_IE_ID_, &len, limit_new); -+ -+ if (pbuf) { -+ -+ /* check if oui matches... */ -+ if (memcmp((pbuf + 2), wpa_oui_type, sizeof(wpa_oui_type))) { -+ -+ goto check_next_ie; -+ } -+ -+ /* check version... */ -+ memcpy((u8 *)&le_tmp, (pbuf + 6), sizeof(val16)); -+ -+ val16 = le16_to_cpu(le_tmp); -+ if (val16 != 0x0001) -+ goto check_next_ie; -+ -+ *wpa_ie_len = *(pbuf + 1); -+ -+ return pbuf; -+ -+ } else{ -+ -+ *wpa_ie_len = 0; -+ return NULL; -+ } -+ -+check_next_ie: -+ -+ limit_new = limit - (pbuf - pie) - 2 - len; -+ -+ if (limit_new <= 0) -+ break; -+ -+ pbuf += (2 + len); -+ -+ } -+ -+ *wpa_ie_len = 0; -+ -+ return NULL; -+ -+} -+ -+unsigned char *rtw_get_wpa2_ie(unsigned char *pie, int *rsn_ie_len, int limit) -+{ -+ -+ return rtw_get_ie(pie, _WPA2_IE_ID_, rsn_ie_len, limit); -+ -+} -+ -+int rtw_get_wpa_cipher_suite(u8 *s) -+{ -+ if (!memcmp(s, WPA_CIPHER_SUITE_NONE, WPA_SELECTOR_LEN)) -+ return WPA_CIPHER_NONE; -+ if (!memcmp(s, WPA_CIPHER_SUITE_WEP40, WPA_SELECTOR_LEN)) -+ return WPA_CIPHER_WEP40; -+ if (!memcmp(s, WPA_CIPHER_SUITE_TKIP, WPA_SELECTOR_LEN)) -+ return WPA_CIPHER_TKIP; -+ if (!memcmp(s, WPA_CIPHER_SUITE_CCMP, WPA_SELECTOR_LEN)) -+ return WPA_CIPHER_CCMP; -+ if (!memcmp(s, WPA_CIPHER_SUITE_WEP104, WPA_SELECTOR_LEN)) -+ return WPA_CIPHER_WEP104; -+ -+ return 0; -+} -+ -+int rtw_get_wpa2_cipher_suite(u8 *s) -+{ -+ if (!memcmp(s, RSN_CIPHER_SUITE_NONE, RSN_SELECTOR_LEN)) -+ return WPA_CIPHER_NONE; -+ if (!memcmp(s, RSN_CIPHER_SUITE_WEP40, RSN_SELECTOR_LEN)) -+ return WPA_CIPHER_WEP40; -+ if (!memcmp(s, RSN_CIPHER_SUITE_TKIP, RSN_SELECTOR_LEN)) -+ return WPA_CIPHER_TKIP; -+ if (!memcmp(s, RSN_CIPHER_SUITE_CCMP, RSN_SELECTOR_LEN)) -+ return WPA_CIPHER_CCMP; -+ if (!memcmp(s, RSN_CIPHER_SUITE_WEP104, RSN_SELECTOR_LEN)) -+ return WPA_CIPHER_WEP104; -+ -+ return 0; -+} -+ -+ -+int rtw_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x) -+{ -+ int i, ret = _SUCCESS; -+ int left, count; -+ u8 *pos; -+ u8 SUITE_1X[4] = {0x00, 0x50, 0xf2, 1}; -+ -+ if (wpa_ie_len <= 0) { -+ /* No WPA IE - fail silently */ -+ return _FAIL; -+ } -+ -+ -+ if ((*wpa_ie != _WPA_IE_ID_) || (*(wpa_ie+1) != (u8)(wpa_ie_len - 2)) || -+ (memcmp(wpa_ie+2, RTW_WPA_OUI_TYPE, WPA_SELECTOR_LEN))) { -+ return _FAIL; -+ } -+ -+ pos = wpa_ie; -+ -+ pos += 8; -+ left = wpa_ie_len - 8; -+ -+ -+ /* group_cipher */ -+ if (left >= WPA_SELECTOR_LEN) { -+ -+ *group_cipher = rtw_get_wpa_cipher_suite(pos); -+ -+ pos += WPA_SELECTOR_LEN; -+ left -= WPA_SELECTOR_LEN; -+ -+ } else if (left > 0) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("%s: ie length mismatch, %u too much", __func__, left)); -+ -+ return _FAIL; -+ } -+ -+ -+ /* pairwise_cipher */ -+ if (left >= 2) { -+ /* count = le16_to_cpu(*(u16*)pos); */ -+ count = RTW_GET_LE16(pos); -+ pos += 2; -+ left -= 2; -+ -+ if (count == 0 || left < count * WPA_SELECTOR_LEN) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("%s: ie count botch (pairwise), " -+ "count %u left %u", __func__, count, left)); -+ return _FAIL; -+ } -+ -+ for (i = 0; i < count; i++) { -+ *pairwise_cipher |= rtw_get_wpa_cipher_suite(pos); -+ -+ pos += WPA_SELECTOR_LEN; -+ left -= WPA_SELECTOR_LEN; -+ } -+ -+ } else if (left == 1) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("%s: ie too short (for key mgmt)", __func__)); -+ return _FAIL; -+ } -+ -+ if (is_8021x) { -+ if (left >= 6) { -+ pos += 2; -+ if (!memcmp(pos, SUITE_1X, 4)) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("%s : there has 802.1x auth\n", __func__)); -+ *is_8021x = 1; -+ } -+ } -+ } -+ -+ return ret; -+ -+} -+ -+int rtw_parse_wpa2_ie(u8 *rsn_ie, int rsn_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x) -+{ -+ int i, ret = _SUCCESS; -+ int left, count; -+ u8 *pos; -+ u8 SUITE_1X[4] = {0x00, 0x0f, 0xac, 0x01}; -+ -+ if (rsn_ie_len <= 0) { -+ /* No RSN IE - fail silently */ -+ return _FAIL; -+ } -+ -+ -+ if ((*rsn_ie != _WPA2_IE_ID_) || (*(rsn_ie+1) != (u8)(rsn_ie_len - 2))) { -+ return _FAIL; -+ } -+ -+ pos = rsn_ie; -+ pos += 4; -+ left = rsn_ie_len - 4; -+ -+ /* group_cipher */ -+ if (left >= RSN_SELECTOR_LEN) { -+ -+ *group_cipher = rtw_get_wpa2_cipher_suite(pos); -+ -+ pos += RSN_SELECTOR_LEN; -+ left -= RSN_SELECTOR_LEN; -+ -+ } else if (left > 0) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("%s: ie length mismatch, %u too much", __func__, left)); -+ return _FAIL; -+ } -+ -+ /* pairwise_cipher */ -+ if (left >= 2) { -+ /* count = le16_to_cpu(*(u16*)pos); */ -+ count = RTW_GET_LE16(pos); -+ pos += 2; -+ left -= 2; -+ -+ if (count == 0 || left < count * RSN_SELECTOR_LEN) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("%s: ie count botch (pairwise), " -+ "count %u left %u", __func__, count, left)); -+ return _FAIL; -+ } -+ -+ for (i = 0; i < count; i++) { -+ *pairwise_cipher |= rtw_get_wpa2_cipher_suite(pos); -+ -+ pos += RSN_SELECTOR_LEN; -+ left -= RSN_SELECTOR_LEN; -+ } -+ -+ } else if (left == 1) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("%s: ie too short (for key mgmt)", __func__)); -+ -+ return _FAIL; -+ } -+ -+ if (is_8021x) { -+ if (left >= 6) { -+ pos += 2; -+ if (!memcmp(pos, SUITE_1X, 4)) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("%s (): there has 802.1x auth\n", __func__)); -+ *is_8021x = 1; -+ } -+ } -+ } -+ -+ return ret; -+ -+} -+ -+/* ifdef CONFIG_WAPI_SUPPORT */ -+int rtw_get_wapi_ie(u8 *in_ie, uint in_len, u8 *wapi_ie, u16 *wapi_len) -+{ -+ int len = 0; -+ u8 authmode, i; -+ uint cnt; -+ u8 wapi_oui1[4] = {0x0, 0x14, 0x72, 0x01}; -+ u8 wapi_oui2[4] = {0x0, 0x14, 0x72, 0x02}; -+ -+ if (wapi_len) -+ *wapi_len = 0; -+ -+ if (!in_ie || in_len <= 0) -+ return len; -+ -+ cnt = (_TIMESTAMP_ + _BEACON_ITERVAL_ + _CAPABILITY_); -+ -+ while (cnt < in_len) { -+ authmode = in_ie[cnt]; -+ -+ /* if (authmode == _WAPI_IE_) */ -+ if (authmode == _WAPI_IE_ && (!memcmp(&in_ie[cnt+6], wapi_oui1, 4) || -+ !memcmp(&in_ie[cnt+6], wapi_oui2, 4))) { -+ if (wapi_ie) { -+ memcpy(wapi_ie, &in_ie[cnt], in_ie[cnt+1]+2); -+ -+ for (i = 0; i < (in_ie[cnt+1]+2); i = i+8) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("\n %2x,%2x,%2x,%2x,%2x,%2x,%2x,%2x\n", -+ wapi_ie[i], wapi_ie[i+1], wapi_ie[i+2], wapi_ie[i+3], wapi_ie[i+4], -+ wapi_ie[i+5], wapi_ie[i+6], wapi_ie[i+7])); -+ } -+ } -+ -+ if (wapi_len) -+ *wapi_len = in_ie[cnt+1]+2; -+ -+ cnt += in_ie[cnt+1]+2; /* get next */ -+ } else{ -+ cnt += in_ie[cnt+1]+2; /* get next */ -+ } -+ } -+ -+ if (wapi_len) -+ len = *wapi_len; -+ -+ return len; -+} -+/* endif */ -+ -+int rtw_get_sec_ie(u8 *in_ie, uint in_len, u8 *rsn_ie, u16 *rsn_len, u8 *wpa_ie, u16 *wpa_len) -+{ -+ u8 authmode, sec_idx, i; -+ u8 wpa_oui[4] = {0x0, 0x50, 0xf2, 0x01}; -+ uint cnt; -+ -+ /* Search required WPA or WPA2 IE and copy to sec_ie[ ] */ -+ -+ cnt = (_TIMESTAMP_ + _BEACON_ITERVAL_ + _CAPABILITY_); -+ -+ sec_idx = 0; -+ -+ while (cnt < in_len) { -+ authmode = in_ie[cnt]; -+ -+ if ((authmode == _WPA_IE_ID_) && (!memcmp(&in_ie[cnt+2], &wpa_oui[0], 4))) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("\n rtw_get_wpa_ie: sec_idx =%d in_ie[cnt+1]+2 =%d\n", sec_idx, in_ie[cnt+1]+2)); -+ -+ if (wpa_ie) { -+ memcpy(wpa_ie, &in_ie[cnt], in_ie[cnt+1]+2); -+ -+ for (i = 0; i < (in_ie[cnt+1]+2); i = i+8) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("\n %2x,%2x,%2x,%2x,%2x,%2x,%2x,%2x\n", -+ wpa_ie[i], wpa_ie[i+1], wpa_ie[i+2], wpa_ie[i+3], wpa_ie[i+4], -+ wpa_ie[i+5], wpa_ie[i+6], wpa_ie[i+7])); -+ } -+ } -+ -+ *wpa_len = in_ie[cnt+1]+2; -+ cnt += in_ie[cnt+1]+2; /* get next */ -+ } else{ -+ if (authmode == _WPA2_IE_ID_) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("\n get_rsn_ie: sec_idx =%d in_ie[cnt+1]+2 =%d\n", sec_idx, in_ie[cnt+1]+2)); -+ -+ if (rsn_ie) { -+ memcpy(rsn_ie, &in_ie[cnt], in_ie[cnt+1]+2); -+ -+ for (i = 0; i < (in_ie[cnt+1]+2); i = i+8) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("\n %2x,%2x,%2x,%2x,%2x,%2x,%2x,%2x\n", -+ rsn_ie[i], rsn_ie[i+1], rsn_ie[i+2], rsn_ie[i+3], rsn_ie[i+4], -+ rsn_ie[i+5], rsn_ie[i+6], rsn_ie[i+7])); -+ } -+ } -+ -+ *rsn_len = in_ie[cnt+1]+2; -+ cnt += in_ie[cnt+1]+2; /* get next */ -+ } else{ -+ cnt += in_ie[cnt+1]+2; /* get next */ -+ } -+ } -+ -+ } -+ -+ return (*rsn_len + *wpa_len); -+} -+ -+u8 rtw_is_wps_ie(u8 *ie_ptr, uint *wps_ielen) -+{ -+ u8 match = false; -+ u8 eid, wps_oui[4] = {0x0, 0x50, 0xf2, 0x04}; -+ -+ if (ie_ptr == NULL) -+ return match; -+ -+ eid = ie_ptr[0]; -+ -+ if ((eid == _WPA_IE_ID_) && (!memcmp(&ie_ptr[2], wps_oui, 4))) { -+ /* DBG_8192C("==> found WPS_IE.....\n"); */ -+ *wps_ielen = ie_ptr[1]+2; -+ match = true; -+ } -+ return match; -+} -+ -+/** -+ * rtw_get_wps_ie - Search WPS IE from a series of IEs -+ * @in_ie: Address of IEs to search -+ * @in_len: Length limit from in_ie -+ * @wps_ie: If not NULL and WPS IE is found, WPS IE will be copied to the buf starting from wps_ie -+ * @wps_ielen: If not NULL and WPS IE is found, will set to the length of the entire WPS IE -+ * -+ * Returns: The address of the WPS IE found, or NULL -+ */ -+u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen) -+{ -+ uint cnt; -+ u8 *wpsie_ptr = NULL; -+ u8 eid, wps_oui[4] = {0x0, 0x50, 0xf2, 0x04}; -+ -+ if (wps_ielen) -+ *wps_ielen = 0; -+ -+ if (!in_ie || in_len <= 0) -+ return wpsie_ptr; -+ -+ cnt = 0; -+ -+ while (cnt < in_len) { -+ eid = in_ie[cnt]; -+ -+ if ((eid == _WPA_IE_ID_) && (!memcmp(&in_ie[cnt+2], wps_oui, 4))) { -+ wpsie_ptr = &in_ie[cnt]; -+ -+ if (wps_ie) -+ memcpy(wps_ie, &in_ie[cnt], in_ie[cnt+1]+2); -+ -+ if (wps_ielen) -+ *wps_ielen = in_ie[cnt+1]+2; -+ -+ cnt += in_ie[cnt+1]+2; -+ -+ break; -+ } else{ -+ cnt += in_ie[cnt+1]+2; /* goto next */ -+ } -+ -+ } -+ -+ return wpsie_ptr; -+} -+ -+/** -+ * rtw_get_wps_attr - Search a specific WPS attribute from a given WPS IE -+ * @wps_ie: Address of WPS IE to search -+ * @wps_ielen: Length limit from wps_ie -+ * @target_attr_id: The attribute ID of WPS attribute to search -+ * @buf_attr: If not NULL and the WPS attribute is found, WPS attribute will be copied to the buf starting from buf_attr -+ * @len_attr: If not NULL and the WPS attribute is found, will set to the length of the entire WPS attribute -+ * -+ * Returns: the address of the specific WPS attribute found, or NULL -+ */ -+u8 *rtw_get_wps_attr(u8 *wps_ie, uint wps_ielen, u16 target_attr_id, u8 *buf_attr, u32 *len_attr) -+{ -+ u8 *attr_ptr = NULL; -+ u8 *target_attr_ptr = NULL; -+ u8 wps_oui[4] = {0x00, 0x50, 0xF2, 0x04}; -+ -+ if (len_attr) -+ *len_attr = 0; -+ -+ if ((wps_ie[0] != _VENDOR_SPECIFIC_IE_) || -+ (memcmp(wps_ie + 2, wps_oui, 4))) { -+ return attr_ptr; -+ } -+ -+ /* 6 = 1(Element ID) + 1(Length) + 4(WPS OUI) */ -+ attr_ptr = wps_ie + 6; /* goto first attr */ -+ -+ while (attr_ptr - wps_ie < wps_ielen) { -+ /* 4 = 2(Attribute ID) + 2(Length) */ -+ u16 attr_id = RTW_GET_BE16(attr_ptr); -+ u16 attr_data_len = RTW_GET_BE16(attr_ptr + 2); -+ u16 attr_len = attr_data_len + 4; -+ -+ /* DBG_871X("%s attr_ptr:%p, id:%u, length:%u\n", __func__, attr_ptr, attr_id, attr_data_len); */ -+ if (attr_id == target_attr_id) { -+ target_attr_ptr = attr_ptr; -+ -+ if (buf_attr) -+ memcpy(buf_attr, attr_ptr, attr_len); -+ -+ if (len_attr) -+ *len_attr = attr_len; -+ -+ break; -+ } else{ -+ attr_ptr += attr_len; /* goto next */ -+ } -+ -+ } -+ -+ return target_attr_ptr; -+} -+ -+/** -+ * rtw_get_wps_attr_content - Search a specific WPS attribute content from a given WPS IE -+ * @wps_ie: Address of WPS IE to search -+ * @wps_ielen: Length limit from wps_ie -+ * @target_attr_id: The attribute ID of WPS attribute to search -+ * @buf_content: If not NULL and the WPS attribute is found, WPS attribute content will be copied to the buf starting from buf_content -+ * @len_content: If not NULL and the WPS attribute is found, will set to the length of the WPS attribute content -+ * -+ * Returns: the address of the specific WPS attribute content found, or NULL -+ */ -+u8 *rtw_get_wps_attr_content(u8 *wps_ie, uint wps_ielen, u16 target_attr_id, u8 *buf_content, uint *len_content) -+{ -+ u8 *attr_ptr; -+ u32 attr_len; -+ -+ if (len_content) -+ *len_content = 0; -+ -+ attr_ptr = rtw_get_wps_attr(wps_ie, wps_ielen, target_attr_id, NULL, &attr_len); -+ -+ if (attr_ptr && attr_len) { -+ if (buf_content) -+ memcpy(buf_content, attr_ptr+4, attr_len-4); -+ -+ if (len_content) -+ *len_content = attr_len-4; -+ -+ return attr_ptr+4; -+ } -+ -+ return NULL; -+} -+ -+static int rtw_ieee802_11_parse_vendor_specific(u8 *pos, uint elen, -+ struct rtw_ieee802_11_elems *elems, -+ int show_errors) -+{ -+ unsigned int oui; -+ -+ /* first 3 bytes in vendor specific information element are the IEEE -+ * OUI of the vendor. The following byte is used a vendor specific -+ * sub-type. */ -+ if (elen < 4) { -+ if (show_errors) { -+ DBG_871X("short vendor specific " -+ "information element ignored (len =%lu)\n", -+ (unsigned long) elen); -+ } -+ return -1; -+ } -+ -+ oui = RTW_GET_BE24(pos); -+ switch (oui) { -+ case OUI_MICROSOFT: -+ /* Microsoft/Wi-Fi information elements are further typed and -+ * subtyped */ -+ switch (pos[3]) { -+ case 1: -+ /* Microsoft OUI (00:50:F2) with OUI Type 1: -+ * real WPA information element */ -+ elems->wpa_ie = pos; -+ elems->wpa_ie_len = elen; -+ break; -+ case WME_OUI_TYPE: /* this is a Wi-Fi WME info. element */ -+ if (elen < 5) { -+ DBG_871X("short WME " -+ "information element ignored " -+ "(len =%lu)\n", -+ (unsigned long) elen); -+ return -1; -+ } -+ switch (pos[4]) { -+ case WME_OUI_SUBTYPE_INFORMATION_ELEMENT: -+ case WME_OUI_SUBTYPE_PARAMETER_ELEMENT: -+ elems->wme = pos; -+ elems->wme_len = elen; -+ break; -+ case WME_OUI_SUBTYPE_TSPEC_ELEMENT: -+ elems->wme_tspec = pos; -+ elems->wme_tspec_len = elen; -+ break; -+ default: -+ DBG_871X("unknown WME " -+ "information element ignored " -+ "(subtype =%d len =%lu)\n", -+ pos[4], (unsigned long) elen); -+ return -1; -+ } -+ break; -+ case 4: -+ /* Wi-Fi Protected Setup (WPS) IE */ -+ elems->wps_ie = pos; -+ elems->wps_ie_len = elen; -+ break; -+ default: -+ DBG_871X("Unknown Microsoft " -+ "information element ignored " -+ "(type =%d len =%lu)\n", -+ pos[3], (unsigned long) elen); -+ return -1; -+ } -+ break; -+ -+ case OUI_BROADCOM: -+ switch (pos[3]) { -+ case VENDOR_HT_CAPAB_OUI_TYPE: -+ elems->vendor_ht_cap = pos; -+ elems->vendor_ht_cap_len = elen; -+ break; -+ default: -+ DBG_871X("Unknown Broadcom " -+ "information element ignored " -+ "(type =%d len =%lu)\n", -+ pos[3], (unsigned long) elen); -+ return -1; -+ } -+ break; -+ -+ default: -+ DBG_871X("unknown vendor specific information " -+ "element ignored (vendor OUI %02x:%02x:%02x " -+ "len =%lu)\n", -+ pos[0], pos[1], pos[2], (unsigned long) elen); -+ return -1; -+ } -+ -+ return 0; -+ -+} -+ -+/** -+ * ieee802_11_parse_elems - Parse information elements in management frames -+ * @start: Pointer to the start of IEs -+ * @len: Length of IE buffer in octets -+ * @elems: Data structure for parsed elements -+ * @show_errors: Whether to show parsing errors in debug log -+ * Returns: Parsing result -+ */ -+ParseRes rtw_ieee802_11_parse_elems(u8 *start, uint len, -+ struct rtw_ieee802_11_elems *elems, -+ int show_errors) -+{ -+ uint left = len; -+ u8 *pos = start; -+ int unknown = 0; -+ -+ memset(elems, 0, sizeof(*elems)); -+ -+ while (left >= 2) { -+ u8 id, elen; -+ -+ id = *pos++; -+ elen = *pos++; -+ left -= 2; -+ -+ if (elen > left) { -+ if (show_errors) { -+ DBG_871X("IEEE 802.11 element " -+ "parse failed (id =%d elen =%d " -+ "left =%lu)\n", -+ id, elen, (unsigned long) left); -+ } -+ return ParseFailed; -+ } -+ -+ switch (id) { -+ case WLAN_EID_SSID: -+ elems->ssid = pos; -+ elems->ssid_len = elen; -+ break; -+ case WLAN_EID_SUPP_RATES: -+ elems->supp_rates = pos; -+ elems->supp_rates_len = elen; -+ break; -+ case WLAN_EID_FH_PARAMS: -+ elems->fh_params = pos; -+ elems->fh_params_len = elen; -+ break; -+ case WLAN_EID_DS_PARAMS: -+ elems->ds_params = pos; -+ elems->ds_params_len = elen; -+ break; -+ case WLAN_EID_CF_PARAMS: -+ elems->cf_params = pos; -+ elems->cf_params_len = elen; -+ break; -+ case WLAN_EID_TIM: -+ elems->tim = pos; -+ elems->tim_len = elen; -+ break; -+ case WLAN_EID_IBSS_PARAMS: -+ elems->ibss_params = pos; -+ elems->ibss_params_len = elen; -+ break; -+ case WLAN_EID_CHALLENGE: -+ elems->challenge = pos; -+ elems->challenge_len = elen; -+ break; -+ case WLAN_EID_ERP_INFO: -+ elems->erp_info = pos; -+ elems->erp_info_len = elen; -+ break; -+ case WLAN_EID_EXT_SUPP_RATES: -+ elems->ext_supp_rates = pos; -+ elems->ext_supp_rates_len = elen; -+ break; -+ case WLAN_EID_VENDOR_SPECIFIC: -+ if (rtw_ieee802_11_parse_vendor_specific(pos, elen, -+ elems, -+ show_errors)) -+ unknown++; -+ break; -+ case WLAN_EID_RSN: -+ elems->rsn_ie = pos; -+ elems->rsn_ie_len = elen; -+ break; -+ case WLAN_EID_PWR_CAPABILITY: -+ elems->power_cap = pos; -+ elems->power_cap_len = elen; -+ break; -+ case WLAN_EID_SUPPORTED_CHANNELS: -+ elems->supp_channels = pos; -+ elems->supp_channels_len = elen; -+ break; -+ case WLAN_EID_MOBILITY_DOMAIN: -+ elems->mdie = pos; -+ elems->mdie_len = elen; -+ break; -+ case WLAN_EID_FAST_BSS_TRANSITION: -+ elems->ftie = pos; -+ elems->ftie_len = elen; -+ break; -+ case WLAN_EID_TIMEOUT_INTERVAL: -+ elems->timeout_int = pos; -+ elems->timeout_int_len = elen; -+ break; -+ case WLAN_EID_HT_CAP: -+ elems->ht_capabilities = pos; -+ elems->ht_capabilities_len = elen; -+ break; -+ case WLAN_EID_HT_OPERATION: -+ elems->ht_operation = pos; -+ elems->ht_operation_len = elen; -+ break; -+ case WLAN_EID_VHT_CAPABILITY: -+ elems->vht_capabilities = pos; -+ elems->vht_capabilities_len = elen; -+ break; -+ case WLAN_EID_VHT_OPERATION: -+ elems->vht_operation = pos; -+ elems->vht_operation_len = elen; -+ break; -+ case WLAN_EID_VHT_OP_MODE_NOTIFY: -+ elems->vht_op_mode_notify = pos; -+ elems->vht_op_mode_notify_len = elen; -+ break; -+ default: -+ unknown++; -+ if (!show_errors) -+ break; -+ DBG_871X("IEEE 802.11 element parse " -+ "ignored unknown element (id =%d elen =%d)\n", -+ id, elen); -+ break; -+ } -+ -+ left -= elen; -+ pos += elen; -+ } -+ -+ if (left) -+ return ParseFailed; -+ -+ return unknown ? ParseUnknown : ParseOK; -+ -+} -+ -+static u8 key_char2num(u8 ch); -+static u8 key_char2num(u8 ch) -+{ -+ if ((ch >= '0') && (ch <= '9')) -+ return ch - '0'; -+ else if ((ch >= 'a') && (ch <= 'f')) -+ return ch - 'a' + 10; -+ else if ((ch >= 'A') && (ch <= 'F')) -+ return ch - 'A' + 10; -+ else -+ return 0xff; -+} -+ -+u8 key_2char2num(u8 hch, u8 lch); -+u8 key_2char2num(u8 hch, u8 lch) -+{ -+ return ((key_char2num(hch) << 4) | key_char2num(lch)); -+} -+ -+void rtw_macaddr_cfg(struct device *dev, u8 *mac_addr) -+{ -+ u8 mac[ETH_ALEN]; -+ struct device_node *np = dev->of_node; -+ const unsigned char *addr; -+ int len; -+ -+ if (mac_addr == NULL) -+ return; -+ -+ if (rtw_initmac) { /* Users specify the mac address */ -+ int jj, kk; -+ -+ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) { -+ mac[jj] = key_2char2num(rtw_initmac[kk], rtw_initmac[kk + 1]); -+ } -+ memcpy(mac_addr, mac, ETH_ALEN); -+ } else{ /* Use the mac address stored in the Efuse */ -+ memcpy(mac, mac_addr, ETH_ALEN); -+ } -+ -+ if (((mac[0] == 0xff) && (mac[1] == 0xff) && (mac[2] == 0xff) && -+ (mac[3] == 0xff) && (mac[4] == 0xff) && (mac[5] == 0xff)) || -+ ((mac[0] == 0x00) && (mac[1] == 0x00) && (mac[2] == 0x00) && -+ (mac[3] == 0x00) && (mac[4] == 0x00) && (mac[5] == 0x00))) { -+ if (np && -+ (addr = of_get_property(np, "local-mac-address", &len)) && -+ len == ETH_ALEN) { -+ memcpy(mac_addr, addr, ETH_ALEN); -+ } else { -+ mac[0] = 0x00; -+ mac[1] = 0xe0; -+ mac[2] = 0x4c; -+ mac[3] = 0x87; -+ mac[4] = 0x00; -+ mac[5] = 0x00; -+ /* use default mac addresss */ -+ memcpy(mac_addr, mac, ETH_ALEN); -+ DBG_871X("MAC Address from efuse error, assign default one !!!\n"); -+ } -+ } -+ -+ DBG_871X("rtw_macaddr_cfg MAC Address = "MAC_FMT"\n", MAC_ARG(mac_addr)); -+} -+ -+static int rtw_get_cipher_info(struct wlan_network *pnetwork) -+{ -+ u32 wpa_ielen; -+ unsigned char *pbuf; -+ int group_cipher = 0, pairwise_cipher = 0, is8021x = 0; -+ int ret = _FAIL; -+ pbuf = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength-12); -+ -+ if (pbuf && (wpa_ielen > 0)) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_get_cipher_info: wpa_ielen: %d", wpa_ielen)); -+ if (_SUCCESS == rtw_parse_wpa_ie(pbuf, wpa_ielen+2, &group_cipher, &pairwise_cipher, &is8021x)) { -+ -+ pnetwork->BcnInfo.pairwise_cipher = pairwise_cipher; -+ pnetwork->BcnInfo.group_cipher = group_cipher; -+ pnetwork->BcnInfo.is_8021x = is8021x; -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("%s: pnetwork->pairwise_cipher: %d, is_8021x is %d", -+ __func__, pnetwork->BcnInfo.pairwise_cipher, pnetwork->BcnInfo.is_8021x)); -+ ret = _SUCCESS; -+ } -+ } else { -+ -+ pbuf = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength-12); -+ -+ if (pbuf && (wpa_ielen > 0)) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("get RSN IE\n")); -+ if (_SUCCESS == rtw_parse_wpa2_ie(pbuf, wpa_ielen+2, &group_cipher, &pairwise_cipher, &is8021x)) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("get RSN IE OK!!!\n")); -+ pnetwork->BcnInfo.pairwise_cipher = pairwise_cipher; -+ pnetwork->BcnInfo.group_cipher = group_cipher; -+ pnetwork->BcnInfo.is_8021x = is8021x; -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("%s: pnetwork->pairwise_cipher: %d," -+ "pnetwork->group_cipher is %d, is_8021x is %d", __func__, pnetwork->BcnInfo.pairwise_cipher, -+ pnetwork->BcnInfo.group_cipher, pnetwork->BcnInfo.is_8021x)); -+ ret = _SUCCESS; -+ } -+ } -+ } -+ -+ return ret; -+} -+ -+void rtw_get_bcn_info(struct wlan_network *pnetwork) -+{ -+ unsigned short cap = 0; -+ u8 bencrypt = 0; -+ /* u8 wpa_ie[255], rsn_ie[255]; */ -+ u16 wpa_len = 0, rsn_len = 0; -+ struct HT_info_element *pht_info = NULL; -+ struct ieee80211_ht_cap *pht_cap = NULL; -+ unsigned int len; -+ unsigned char *p; -+ __le16 le_cap; -+ -+ memcpy((u8 *)&le_cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); -+ cap = le16_to_cpu(le_cap); -+ if (cap & WLAN_CAPABILITY_PRIVACY) { -+ bencrypt = 1; -+ pnetwork->network.Privacy = 1; -+ } else { -+ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_OPENSYS; -+ } -+ rtw_get_sec_ie(pnetwork->network.IEs, pnetwork->network.IELength, NULL, &rsn_len, NULL, &wpa_len); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_get_bcn_info: ssid =%s\n", pnetwork->network.Ssid.Ssid)); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_get_bcn_info: wpa_len =%d rsn_len =%d\n", wpa_len, rsn_len)); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_get_bcn_info: ssid =%s\n", pnetwork->network.Ssid.Ssid)); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_get_bcn_info: wpa_len =%d rsn_len =%d\n", wpa_len, rsn_len)); -+ -+ if (rsn_len > 0) { -+ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_WPA2; -+ } else if (wpa_len > 0) { -+ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_WPA; -+ } else { -+ if (bencrypt) -+ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_WEP; -+ } -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_get_bcn_info: pnetwork->encryp_protocol is %x\n", -+ pnetwork->BcnInfo.encryp_protocol)); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_get_bcn_info: pnetwork->encryp_protocol is %x\n", -+ pnetwork->BcnInfo.encryp_protocol)); -+ rtw_get_cipher_info(pnetwork); -+ -+ /* get bwmode and ch_offset */ -+ /* parsing HT_CAP_IE */ -+ p = rtw_get_ie(pnetwork->network.IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, pnetwork->network.IELength - _FIXED_IE_LENGTH_); -+ if (p && len > 0) { -+ pht_cap = (struct ieee80211_ht_cap *)(p + 2); -+ pnetwork->BcnInfo.ht_cap_info = le16_to_cpu(pht_cap->cap_info); -+ } else { -+ pnetwork->BcnInfo.ht_cap_info = 0; -+ } -+ /* parsing HT_INFO_IE */ -+ p = rtw_get_ie(pnetwork->network.IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, pnetwork->network.IELength - _FIXED_IE_LENGTH_); -+ if (p && len > 0) { -+ pht_info = (struct HT_info_element *)(p + 2); -+ pnetwork->BcnInfo.ht_info_infos_0 = pht_info->infos[0]; -+ } else { -+ pnetwork->BcnInfo.ht_info_infos_0 = 0; -+ } -+} -+ -+/* show MCS rate, unit: 100Kbps */ -+u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI, unsigned char *MCS_rate) -+{ -+ u16 max_rate = 0; -+ -+ if (rf_type == RF_1T1R) { -+ if (MCS_rate[0] & BIT(7)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1500:1350):((short_GI)?722:650); -+ else if (MCS_rate[0] & BIT(6)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1350:1215):((short_GI)?650:585); -+ else if (MCS_rate[0] & BIT(5)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1200:1080):((short_GI)?578:520); -+ else if (MCS_rate[0] & BIT(4)) -+ max_rate = (bw_40MHz) ? ((short_GI)?900:810):((short_GI)?433:390); -+ else if (MCS_rate[0] & BIT(3)) -+ max_rate = (bw_40MHz) ? ((short_GI)?600:540):((short_GI)?289:260); -+ else if (MCS_rate[0] & BIT(2)) -+ max_rate = (bw_40MHz) ? ((short_GI)?450:405):((short_GI)?217:195); -+ else if (MCS_rate[0] & BIT(1)) -+ max_rate = (bw_40MHz) ? ((short_GI)?300:270):((short_GI)?144:130); -+ else if (MCS_rate[0] & BIT(0)) -+ max_rate = (bw_40MHz) ? ((short_GI)?150:135):((short_GI)?72:65); -+ } else{ -+ if (MCS_rate[1]) { -+ if (MCS_rate[1] & BIT(7)) -+ max_rate = (bw_40MHz) ? ((short_GI)?3000:2700):((short_GI)?1444:1300); -+ else if (MCS_rate[1] & BIT(6)) -+ max_rate = (bw_40MHz) ? ((short_GI)?2700:2430):((short_GI)?1300:1170); -+ else if (MCS_rate[1] & BIT(5)) -+ max_rate = (bw_40MHz) ? ((short_GI)?2400:2160):((short_GI)?1156:1040); -+ else if (MCS_rate[1] & BIT(4)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1800:1620):((short_GI)?867:780); -+ else if (MCS_rate[1] & BIT(3)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1200:1080):((short_GI)?578:520); -+ else if (MCS_rate[1] & BIT(2)) -+ max_rate = (bw_40MHz) ? ((short_GI)?900:810):((short_GI)?433:390); -+ else if (MCS_rate[1] & BIT(1)) -+ max_rate = (bw_40MHz) ? ((short_GI)?600:540):((short_GI)?289:260); -+ else if (MCS_rate[1] & BIT(0)) -+ max_rate = (bw_40MHz) ? ((short_GI)?300:270):((short_GI)?144:130); -+ } else{ -+ if (MCS_rate[0] & BIT(7)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1500:1350):((short_GI)?722:650); -+ else if (MCS_rate[0] & BIT(6)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1350:1215):((short_GI)?650:585); -+ else if (MCS_rate[0] & BIT(5)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1200:1080):((short_GI)?578:520); -+ else if (MCS_rate[0] & BIT(4)) -+ max_rate = (bw_40MHz) ? ((short_GI)?900:810):((short_GI)?433:390); -+ else if (MCS_rate[0] & BIT(3)) -+ max_rate = (bw_40MHz) ? ((short_GI)?600:540):((short_GI)?289:260); -+ else if (MCS_rate[0] & BIT(2)) -+ max_rate = (bw_40MHz) ? ((short_GI)?450:405):((short_GI)?217:195); -+ else if (MCS_rate[0] & BIT(1)) -+ max_rate = (bw_40MHz) ? ((short_GI)?300:270):((short_GI)?144:130); -+ else if (MCS_rate[0] & BIT(0)) -+ max_rate = (bw_40MHz) ? ((short_GI)?150:135):((short_GI)?72:65); -+ } -+ } -+ return max_rate; -+} -+ -+int rtw_action_frame_parse(const u8 *frame, u32 frame_len, u8 *category, u8 *action) -+{ -+ const u8 *frame_body = frame + sizeof(struct ieee80211_hdr_3addr); -+ u16 fc; -+ u8 c; -+ u8 a = ACT_PUBLIC_MAX; -+ -+ fc = le16_to_cpu(((struct ieee80211_hdr_3addr *)frame)->frame_control); -+ -+ if ((fc & (RTW_IEEE80211_FCTL_FTYPE|RTW_IEEE80211_FCTL_STYPE)) -+ != (RTW_IEEE80211_FTYPE_MGMT|RTW_IEEE80211_STYPE_ACTION) -+ ) { -+ return false; -+ } -+ -+ c = frame_body[0]; -+ -+ switch (c) { -+ case RTW_WLAN_CATEGORY_P2P: /* vendor-specific */ -+ break; -+ default: -+ a = frame_body[1]; -+ } -+ -+ if (category) -+ *category = c; -+ if (action) -+ *action = a; -+ -+ return true; -+} -+ -+static const char *_action_public_str[] = { -+ "ACT_PUB_BSSCOEXIST", -+ "ACT_PUB_DSE_ENABLE", -+ "ACT_PUB_DSE_DEENABLE", -+ "ACT_PUB_DSE_REG_LOCATION", -+ "ACT_PUB_EXT_CHL_SWITCH", -+ "ACT_PUB_DSE_MSR_REQ", -+ "ACT_PUB_DSE_MSR_RPRT", -+ "ACT_PUB_MP", -+ "ACT_PUB_DSE_PWR_CONSTRAINT", -+ "ACT_PUB_VENDOR", -+ "ACT_PUB_GAS_INITIAL_REQ", -+ "ACT_PUB_GAS_INITIAL_RSP", -+ "ACT_PUB_GAS_COMEBACK_REQ", -+ "ACT_PUB_GAS_COMEBACK_RSP", -+ "ACT_PUB_TDLS_DISCOVERY_RSP", -+ "ACT_PUB_LOCATION_TRACK", -+ "ACT_PUB_RSVD", -+}; -+ -+const char *action_public_str(u8 action) -+{ -+ action = (action >= ACT_PUBLIC_MAX) ? ACT_PUBLIC_MAX : action; -+ return _action_public_str[action]; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_io.c linux/3rdparty/rtl8723bs/core/rtw_io.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_io.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_io.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,203 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/* -+ -+The purpose of rtw_io.c -+ -+a. provides the API -+ -+b. provides the protocol engine -+ -+c. provides the software interface between caller and the hardware interface -+ -+ -+Compiler Flag Option: -+ -+1. CONFIG_SDIO_HCI: -+ a. USE_SYNC_IRP: Only sync operations are provided. -+ b. USE_ASYNC_IRP:Both sync/async operations are provided. -+ -+jackson@realtek.com.tw -+ -+*/ -+ -+#define _RTW_IO_C_ -+ -+#include -+#include -+ -+#define rtw_le16_to_cpu(val) val -+#define rtw_le32_to_cpu(val) val -+#define rtw_cpu_to_le16(val) val -+#define rtw_cpu_to_le32(val) val -+ -+u8 _rtw_read8(struct adapter *adapter, u32 addr) -+{ -+ u8 r_val; -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u8 (*_read8)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _read8 = pintfhdl->io_ops._read8; -+ -+ r_val = _read8(pintfhdl, addr); -+ return r_val; -+} -+ -+u16 _rtw_read16(struct adapter *adapter, u32 addr) -+{ -+ u16 r_val; -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u16 (*_read16)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _read16 = pintfhdl->io_ops._read16; -+ -+ r_val = _read16(pintfhdl, addr); -+ return rtw_le16_to_cpu(r_val); -+} -+ -+u32 _rtw_read32(struct adapter *adapter, u32 addr) -+{ -+ u32 r_val; -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u32 (*_read32)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _read32 = pintfhdl->io_ops._read32; -+ -+ r_val = _read32(pintfhdl, addr); -+ return rtw_le32_to_cpu(r_val); -+ -+} -+ -+int _rtw_write8(struct adapter *adapter, u32 addr, u8 val) -+{ -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int ret; -+ -+ _write8 = pintfhdl->io_ops._write8; -+ -+ ret = _write8(pintfhdl, addr, val); -+ -+ return RTW_STATUS_CODE(ret); -+} -+int _rtw_write16(struct adapter *adapter, u32 addr, u16 val) -+{ -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int ret; -+ -+ _write16 = pintfhdl->io_ops._write16; -+ -+ ret = _write16(pintfhdl, addr, val); -+ return RTW_STATUS_CODE(ret); -+} -+int _rtw_write32(struct adapter *adapter, u32 addr, u32 val) -+{ -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ int ret; -+ -+ _write32 = pintfhdl->io_ops._write32; -+ -+ ret = _write32(pintfhdl, addr, val); -+ -+ return RTW_STATUS_CODE(ret); -+} -+ -+u8 _rtw_sd_f0_read8(struct adapter *adapter, u32 addr) -+{ -+ u8 r_val = 0x00; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u8 (*_sd_f0_read8)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _sd_f0_read8 = pintfhdl->io_ops._sd_f0_read8; -+ -+ if (_sd_f0_read8) -+ r_val = _sd_f0_read8(pintfhdl, addr); -+ else -+ DBG_871X_LEVEL(_drv_warning_, FUNC_ADPT_FMT" _sd_f0_read8 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return r_val; -+} -+ -+u32 _rtw_write_port(struct adapter *adapter, u32 addr, u32 cnt, u8 *pmem) -+{ -+ u32 (*_write_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u32 ret = _SUCCESS; -+ -+ _write_port = pintfhdl->io_ops._write_port; -+ -+ ret = _write_port(pintfhdl, addr, cnt, pmem); -+ -+ return ret; -+} -+ -+int rtw_init_io_priv(struct adapter *padapter, void (*set_intf_ops)(struct adapter *padapter, struct _io_ops *pops)) -+{ -+ struct io_priv *piopriv = &padapter->iopriv; -+ struct intf_hdl *pintf = &piopriv->intf; -+ -+ if (set_intf_ops == NULL) -+ return _FAIL; -+ -+ piopriv->padapter = padapter; -+ pintf->padapter = padapter; -+ pintf->pintf_dev = adapter_to_dvobj(padapter); -+ -+ set_intf_ops(padapter, &pintf->io_ops); -+ -+ return _SUCCESS; -+} -+ -+/* -+* Increase and check if the continual_io_error of this @param dvobjprive is larger than MAX_CONTINUAL_IO_ERR -+* @return true: -+* @return false: -+*/ -+int rtw_inc_and_chk_continual_io_error(struct dvobj_priv *dvobj) -+{ -+ int ret = false; -+ int value = atomic_inc_return(&dvobj->continual_io_error); -+ if (value > MAX_CONTINUAL_IO_ERR) { -+ DBG_871X("[dvobj:%p][ERROR] continual_io_error:%d > %d\n", dvobj, value, MAX_CONTINUAL_IO_ERR); -+ ret = true; -+ } else { -+ /* DBG_871X("[dvobj:%p] continual_io_error:%d\n", dvobj, value); */ -+ } -+ return ret; -+} -+ -+/* -+* Set the continual_io_error of this @param dvobjprive to 0 -+*/ -+void rtw_reset_continual_io_error(struct dvobj_priv *dvobj) -+{ -+ atomic_set(&dvobj->continual_io_error, 0); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_ioctl_set.c linux/3rdparty/rtl8723bs/core/rtw_ioctl_set.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_ioctl_set.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_ioctl_set.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,696 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_IOCTL_SET_C_ -+ -+#include -+#include -+ -+#define IS_MAC_ADDRESS_BROADCAST(addr) \ -+(\ -+ ((addr[0] == 0xff) && (addr[1] == 0xff) && \ -+ (addr[2] == 0xff) && (addr[3] == 0xff) && \ -+ (addr[4] == 0xff) && (addr[5] == 0xff)) ? true : false \ -+) -+ -+u8 rtw_validate_bssid(u8 *bssid) -+{ -+ u8 ret = true; -+ -+ if (is_zero_mac_addr(bssid) -+ || is_broadcast_mac_addr(bssid) -+ || is_multicast_mac_addr(bssid) -+ ) { -+ ret = false; -+ } -+ -+ return ret; -+} -+ -+u8 rtw_validate_ssid(struct ndis_802_11_ssid *ssid) -+{ -+ u8 ret = true; -+ -+ if (ssid->SsidLength > 32) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid length >32\n")); -+ ret = false; -+ goto exit; -+ } -+ -+#ifdef CONFIG_VALIDATE_SSID -+ for (i = 0; i < ssid->SsidLength; i++) { -+ /* wifi, printable ascii code must be supported */ -+ if (!((ssid->Ssid[i] >= 0x20) && (ssid->Ssid[i] <= 0x7e))) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid has nonprintabl ascii\n")); -+ ret = false; -+ break; -+ } -+ } -+#endif /* CONFIG_VALIDATE_SSID */ -+ -+exit: -+ return ret; -+} -+ -+u8 rtw_do_join(struct adapter *padapter); -+u8 rtw_do_join(struct adapter *padapter) -+{ -+ struct list_head *plist, *phead; -+ u8 *pibss = NULL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct __queue *queue = &(pmlmepriv->scanned_queue); -+ u8 ret = _SUCCESS; -+ -+ spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("\n rtw_do_join: phead = %p; plist = %p\n\n\n", phead, plist)); -+ -+ pmlmepriv->cur_network.join_res = -2; -+ -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ -+ pmlmepriv->pscanned = plist; -+ -+ pmlmepriv->to_join = true; -+ -+ if (list_empty(&queue->queue)) { -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+ /* when set_ssid/set_bssid for rtw_do_join(), but scanning queue is empty */ -+ /* we try to issue sitesurvey firstly */ -+ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == false -+ || rtw_to_roam(padapter) > 0 -+ ) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("rtw_do_join(): site survey if scanned_queue is empty\n.")); -+ /* submit site_survey_cmd */ -+ ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); -+ if (_SUCCESS != ret) { -+ pmlmepriv->to_join = false; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("rtw_do_join(): site survey return error\n.")); -+ } -+ } else{ -+ pmlmepriv->to_join = false; -+ ret = _FAIL; -+ } -+ -+ goto exit; -+ } else{ -+ int select_ret; -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ select_ret = rtw_select_and_join_from_scanned_queue(pmlmepriv); -+ if (select_ret == _SUCCESS) { -+ pmlmepriv->to_join = false; -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); -+ } else{ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) { -+ /* submit createbss_cmd to change to a ADHOC_MASTER */ -+ -+ /* pmlmepriv->lock has been acquired by caller... */ -+ struct wlan_bssid_ex *pdev_network = &(padapter->registrypriv.dev_network); -+ -+ pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE; -+ -+ pibss = padapter->registrypriv.dev_network.MacAddress; -+ -+ memset(&pdev_network->Ssid, 0, sizeof(struct ndis_802_11_ssid)); -+ memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(struct ndis_802_11_ssid)); -+ -+ rtw_update_registrypriv_dev_network(padapter); -+ -+ rtw_generate_random_ibss(pibss); -+ -+ if (rtw_createbss_cmd(padapter) != _SUCCESS) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("***Error =>do_goin: rtw_createbss_cmd status FAIL***\n ")); -+ ret = false; -+ goto exit; -+ } -+ -+ pmlmepriv->to_join = false; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("***Error => rtw_select_and_join_from_scanned_queue FAIL under STA_Mode***\n ")); -+ -+ } else{ -+ /* can't associate ; reset under-linking */ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+ /* when set_ssid/set_bssid for rtw_do_join(), but there are no desired bss in scanning queue */ -+ /* we try to issue sitesurvey firstly */ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == false -+ || rtw_to_roam(padapter) > 0 -+ ) { -+ /* DBG_871X("rtw_do_join() when no desired bss in scanning queue\n"); */ -+ ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); -+ if (_SUCCESS != ret) { -+ pmlmepriv->to_join = false; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("do_join(): site survey return error\n.")); -+ } -+ } else{ -+ ret = _FAIL; -+ pmlmepriv->to_join = false; -+ } -+ } -+ -+ } -+ -+ } -+ -+exit: -+ return ret; -+} -+ -+u8 rtw_set_802_11_bssid(struct adapter *padapter, u8 *bssid) -+{ -+ u8 status = _SUCCESS; -+ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ DBG_871X_LEVEL(_drv_always_, "set bssid:%pM\n", bssid); -+ -+ if ((bssid[0] == 0x00 && bssid[1] == 0x00 && bssid[2] == 0x00 && bssid[3] == 0x00 && bssid[4] == 0x00 && bssid[5] == 0x00) || -+ (bssid[0] == 0xFF && bssid[1] == 0xFF && bssid[2] == 0xFF && bssid[3] == 0xFF && bssid[4] == 0xFF && bssid[5] == 0xFF)) { -+ status = _FAIL; -+ goto exit; -+ } -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ -+ DBG_871X("Set BSSID under fw_state = 0x%08x\n", get_fwstate(pmlmepriv)); -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { -+ goto handle_tkip_countermeasure; -+ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) { -+ goto release_mlme_lock; -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_bssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n")); -+ -+ if (!memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid, ETH_ALEN)) { -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == false) -+ goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */ -+ } else { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("Set BSSID not the same bssid\n")); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_bssid ="MAC_FMT"\n", MAC_ARG(bssid))); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("cur_bssid ="MAC_FMT"\n", MAC_ARG(pmlmepriv->cur_network.network.MacAddress))); -+ -+ rtw_disassoc_cmd(padapter, 0, true); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ rtw_indicate_disconnect(padapter); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) { -+ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ } -+ } -+ } -+ -+handle_tkip_countermeasure: -+ if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { -+ status = _FAIL; -+ goto release_mlme_lock; -+ } -+ -+ memset(&pmlmepriv->assoc_ssid, 0, sizeof(struct ndis_802_11_ssid)); -+ memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN); -+ pmlmepriv->assoc_by_bssid = true; -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { -+ pmlmepriv->to_join = true; -+ } else { -+ status = rtw_do_join(padapter); -+ } -+ -+release_mlme_lock: -+ spin_unlock_bh(&pmlmepriv->lock); -+ -+exit: -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, -+ ("rtw_set_802_11_bssid: status =%d\n", status)); -+ -+ return status; -+} -+ -+u8 rtw_set_802_11_ssid(struct adapter *padapter, struct ndis_802_11_ssid *ssid) -+{ -+ u8 status = _SUCCESS; -+ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *pnetwork = &pmlmepriv->cur_network; -+ -+ DBG_871X_LEVEL(_drv_always_, "set ssid [%s] fw_state = 0x%08x\n", -+ ssid->Ssid, get_fwstate(pmlmepriv)); -+ -+ if (padapter->hw_init_completed == false) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, -+ ("set_ssid: hw_init_completed ==false =>exit!!!\n")); -+ status = _FAIL; -+ goto exit; -+ } -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ DBG_871X("Set SSID under fw_state = 0x%08x\n", get_fwstate(pmlmepriv)); -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { -+ goto handle_tkip_countermeasure; -+ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) { -+ goto release_mlme_lock; -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, -+ ("set_ssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n")); -+ -+ if ((pmlmepriv->assoc_ssid.SsidLength == ssid->SsidLength) && -+ (!memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid, ssid->SsidLength))) { -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == false)) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, -+ ("Set SSID is the same ssid, fw_state = 0x%08x\n", -+ get_fwstate(pmlmepriv))); -+ -+ if (rtw_is_same_ibss(padapter, pnetwork) == false) { -+ /* if in WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE, create bss or rejoin again */ -+ rtw_disassoc_cmd(padapter, 0, true); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ rtw_indicate_disconnect(padapter); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) { -+ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ } -+ } else{ -+ goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */ -+ } -+ } else { -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_JOINBSS, 1); -+ } -+ } else{ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("Set SSID not the same ssid\n")); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_ssid =[%s] len = 0x%x\n", ssid->Ssid, (unsigned int)ssid->SsidLength)); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("assoc_ssid =[%s] len = 0x%x\n", pmlmepriv->assoc_ssid.Ssid, (unsigned int)pmlmepriv->assoc_ssid.SsidLength)); -+ -+ rtw_disassoc_cmd(padapter, 0, true); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ rtw_indicate_disconnect(padapter); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) { -+ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ } -+ } -+ } -+ -+handle_tkip_countermeasure: -+ if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { -+ status = _FAIL; -+ goto release_mlme_lock; -+ } -+ -+ if (rtw_validate_ssid(ssid) == false) { -+ status = _FAIL; -+ goto release_mlme_lock; -+ } -+ -+ memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct ndis_802_11_ssid)); -+ pmlmepriv->assoc_by_bssid = false; -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { -+ pmlmepriv->to_join = true; -+ } else { -+ status = rtw_do_join(padapter); -+ } -+ -+release_mlme_lock: -+ spin_unlock_bh(&pmlmepriv->lock); -+ -+exit: -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, -+ ("-rtw_set_802_11_ssid: status =%d\n", status)); -+ -+ return status; -+} -+ -+u8 rtw_set_802_11_connect(struct adapter *padapter, u8 *bssid, struct ndis_802_11_ssid *ssid) -+{ -+ u8 status = _SUCCESS; -+ bool bssid_valid = true; -+ bool ssid_valid = true; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (!ssid || rtw_validate_ssid(ssid) == false) -+ ssid_valid = false; -+ -+ if (!bssid || rtw_validate_bssid(bssid) == false) -+ bssid_valid = false; -+ -+ if (ssid_valid == false && bssid_valid == false) { -+ DBG_871X(FUNC_ADPT_FMT" ssid:%p, ssid_valid:%d, bssid:%p, bssid_valid:%d\n", -+ FUNC_ADPT_ARG(padapter), ssid, ssid_valid, bssid, bssid_valid); -+ status = _FAIL; -+ goto exit; -+ } -+ -+ if (padapter->hw_init_completed == false) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, -+ ("set_ssid: hw_init_completed ==false =>exit!!!\n")); -+ status = _FAIL; -+ goto exit; -+ } -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" fw_state = 0x%08x\n", -+ FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { -+ goto handle_tkip_countermeasure; -+ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) { -+ goto release_mlme_lock; -+ } -+ -+handle_tkip_countermeasure: -+ if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { -+ status = _FAIL; -+ goto release_mlme_lock; -+ } -+ -+ if (ssid && ssid_valid) -+ memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct ndis_802_11_ssid)); -+ else -+ memset(&pmlmepriv->assoc_ssid, 0, sizeof(struct ndis_802_11_ssid)); -+ -+ if (bssid && bssid_valid) { -+ memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN); -+ pmlmepriv->assoc_by_bssid = true; -+ } else { -+ pmlmepriv->assoc_by_bssid = false; -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { -+ pmlmepriv->to_join = true; -+ } else { -+ status = rtw_do_join(padapter); -+ } -+ -+release_mlme_lock: -+ spin_unlock_bh(&pmlmepriv->lock); -+ -+exit: -+ return status; -+} -+ -+u8 rtw_set_802_11_infrastructure_mode(struct adapter *padapter, -+ enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ enum NDIS_802_11_NETWORK_INFRASTRUCTURE *pold_state = &(cur_network->network.InfrastructureMode); -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_notice_, -+ ("+rtw_set_802_11_infrastructure_mode: old =%d new =%d fw_state = 0x%08x\n", -+ *pold_state, networktype, get_fwstate(pmlmepriv))); -+ -+ if (*pold_state != networktype) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, (" change mode!")); -+ /* DBG_871X("change mode, old_mode =%d, new_mode =%d, fw_state = 0x%x\n", *pold_state, networktype, get_fwstate(pmlmepriv)); */ -+ -+ if (*pold_state == Ndis802_11APMode) { -+ /* change to other mode from Ndis802_11APMode */ -+ cur_network->join_res = -1; -+ -+ stop_ap_mode(padapter); -+ } -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) || (*pold_state == Ndis802_11IBSS)) -+ rtw_disassoc_cmd(padapter, 0, true); -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) -+ rtw_free_assoc_resources(padapter, 1); -+ -+ if ((*pold_state == Ndis802_11Infrastructure) || (*pold_state == Ndis802_11IBSS)) { -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { -+ rtw_indicate_disconnect(padapter); /* will clr Linked_state; before this function, we must have chked whether issue dis-assoc_cmd or not */ -+ } -+ } -+ -+ *pold_state = networktype; -+ -+ _clr_fwstate_(pmlmepriv, ~WIFI_NULL_STATE); -+ -+ switch (networktype) { -+ case Ndis802_11IBSS: -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ break; -+ -+ case Ndis802_11Infrastructure: -+ set_fwstate(pmlmepriv, WIFI_STATION_STATE); -+ break; -+ -+ case Ndis802_11APMode: -+ set_fwstate(pmlmepriv, WIFI_AP_STATE); -+ start_ap_mode(padapter); -+ /* rtw_indicate_connect(padapter); */ -+ -+ break; -+ -+ case Ndis802_11AutoUnknown: -+ case Ndis802_11InfrastructureMax: -+ break; -+ } -+ -+ /* SecClearAllKeys(adapter); */ -+ -+ /* RT_TRACE(COMP_OID_SET, DBG_LOUD, ("set_infrastructure: fw_state:%x after changing mode\n", */ -+ /* get_fwstate(pmlmepriv))); */ -+ -+ spin_unlock_bh(&pmlmepriv->lock); -+ } -+ return true; -+} -+ -+ -+u8 rtw_set_802_11_disassociate(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_disassociate: rtw_indicate_disconnect\n")); -+ -+ rtw_disassoc_cmd(padapter, 0, true); -+ rtw_indicate_disconnect(padapter); -+ /* modify for CONFIG_IEEE80211W, none 11w can use it */ -+ rtw_free_assoc_resources_cmd(padapter); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) -+ DBG_871X("%s(): rtw_pwr_wakeup fail !!!\n", __func__); -+ } -+ -+ spin_unlock_bh(&pmlmepriv->lock); -+ -+ return true; -+} -+ -+u8 rtw_set_802_11_bssid_list_scan(struct adapter *padapter, struct ndis_802_11_ssid *pssid, int ssid_max_num) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 res = true; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("+rtw_set_802_11_bssid_list_scan(), fw_state =%x\n", get_fwstate(pmlmepriv))); -+ -+ if (padapter == NULL) { -+ res = false; -+ goto exit; -+ } -+ if (padapter->hw_init_completed == false) { -+ res = false; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n ===rtw_set_802_11_bssid_list_scan:hw_init_completed ==false ===\n")); -+ goto exit; -+ } -+ -+ if ((check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) || -+ (pmlmepriv->LinkDetectInfo.bBusyTraffic == true)) { -+ /* Scan or linking is in progress, do nothing. */ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("rtw_set_802_11_bssid_list_scan fail since fw_state = %x\n", get_fwstate(pmlmepriv))); -+ res = true; -+ -+ if (check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING)) == true) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n###_FW_UNDER_SURVEY|_FW_UNDER_LINKING\n\n")); -+ } else { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n###pmlmepriv->sitesurveyctrl.traffic_busy ==true\n\n")); -+ } -+ } else { -+ if (rtw_is_scan_deny(padapter)) { -+ DBG_871X(FUNC_ADPT_FMT": scan deny\n", FUNC_ADPT_ARG(padapter)); -+ indicate_wx_scan_complete_event(padapter); -+ return _SUCCESS; -+ } -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, NULL, 0); -+ -+ spin_unlock_bh(&pmlmepriv->lock); -+ } -+exit: -+ -+ return res; -+} -+ -+u8 rtw_set_802_11_authentication_mode(struct adapter *padapter, enum NDIS_802_11_AUTHENTICATION_MODE authmode) -+{ -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ int res; -+ u8 ret; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_802_11_auth.mode(): mode =%x\n", authmode)); -+ -+ psecuritypriv->ndisauthtype = authmode; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("rtw_set_802_11_authentication_mode:psecuritypriv->ndisauthtype =%d", psecuritypriv->ndisauthtype)); -+ -+ if (psecuritypriv->ndisauthtype > 3) -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ -+ res = rtw_set_auth(padapter, psecuritypriv); -+ -+ if (res == _SUCCESS) -+ ret = true; -+ else -+ ret = false; -+ -+ return ret; -+} -+ -+u8 rtw_set_802_11_add_wep(struct adapter *padapter, struct ndis_802_11_wep *wep) -+{ -+ -+ u8 bdefaultkey; -+ u8 btransmitkey; -+ sint keyid, res; -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ u8 ret = _SUCCESS; -+ -+ bdefaultkey = (wep->KeyIndex & 0x40000000) > 0 ? false : true; /* for ??? */ -+ btransmitkey = (wep->KeyIndex & 0x80000000) > 0 ? true : false; /* for ??? */ -+ keyid = wep->KeyIndex & 0x3fffffff; -+ -+ if (keyid >= 4) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("MgntActrtw_set_802_11_add_wep:keyid>4 =>fail\n")); -+ ret = false; -+ goto exit; -+ } -+ -+ switch (wep->KeyLength) { -+ case 5: -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength =5\n")); -+ break; -+ case 13: -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength = 13\n")); -+ break; -+ default: -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength!=5 or 13\n")); -+ break; -+ } -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("rtw_set_802_11_add_wep:befor memcpy, wep->KeyLength = 0x%x wep->KeyIndex = 0x%x keyid =%x\n", wep->KeyLength, wep->KeyIndex, keyid)); -+ -+ memcpy(&(psecuritypriv->dot11DefKey[keyid].skey[0]), &(wep->KeyMaterial), wep->KeyLength); -+ -+ psecuritypriv->dot11DefKeylen[keyid] = wep->KeyLength; -+ -+ psecuritypriv->dot11PrivacyKeyIndex = keyid; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("rtw_set_802_11_add_wep:security key material : %x %x %x %x %x %x %x %x %x %x %x %x %x\n", -+ psecuritypriv->dot11DefKey[keyid].skey[0], psecuritypriv->dot11DefKey[keyid].skey[1], psecuritypriv->dot11DefKey[keyid].skey[2], -+ psecuritypriv->dot11DefKey[keyid].skey[3], psecuritypriv->dot11DefKey[keyid].skey[4], psecuritypriv->dot11DefKey[keyid].skey[5], -+ psecuritypriv->dot11DefKey[keyid].skey[6], psecuritypriv->dot11DefKey[keyid].skey[7], psecuritypriv->dot11DefKey[keyid].skey[8], -+ psecuritypriv->dot11DefKey[keyid].skey[9], psecuritypriv->dot11DefKey[keyid].skey[10], psecuritypriv->dot11DefKey[keyid].skey[11], -+ psecuritypriv->dot11DefKey[keyid].skey[12])); -+ -+ res = rtw_set_key(padapter, psecuritypriv, keyid, 1, true); -+ -+ if (res == _FAIL) -+ ret = false; -+exit: -+ -+ return ret; -+} -+ -+/* -+* rtw_get_cur_max_rate - -+* @adapter: pointer to struct adapter structure -+* -+* Return 0 or 100Kbps -+*/ -+u16 rtw_get_cur_max_rate(struct adapter *adapter) -+{ -+ int i = 0; -+ u16 rate = 0, max_rate = 0; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct wlan_bssid_ex *pcur_bss = &pmlmepriv->cur_network.network; -+ struct sta_info *psta = NULL; -+ u8 short_GI = 0; -+ u8 rf_type = 0; -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) != true) -+ && (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != true)) -+ return 0; -+ -+ psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) -+ return 0; -+ -+ short_GI = query_ra_short_GI(psta); -+ -+ if (IsSupportedHT(psta->wireless_mode)) { -+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ max_rate = rtw_mcs_rate( -+ rf_type, -+ ((psta->bw_mode == CHANNEL_WIDTH_40)?1:0), -+ short_GI, -+ psta->htpriv.ht_cap.supp_mcs_set -+ ); -+ } else{ -+ while ((pcur_bss->SupportedRates[i] != 0) && (pcur_bss->SupportedRates[i] != 0xFF)) { -+ rate = pcur_bss->SupportedRates[i]&0x7F; -+ if (rate > max_rate) -+ max_rate = rate; -+ i++; -+ } -+ -+ max_rate = max_rate*10/2; -+ } -+ -+ return max_rate; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_mlme.c linux/3rdparty/rtl8723bs/core/rtw_mlme.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_mlme.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_mlme.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,3155 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_MLME_C_ -+ -+#include -+#include -+#include -+ -+extern u8 rtw_do_join(struct adapter *padapter); -+ -+sint _rtw_init_mlme_priv(struct adapter *padapter) -+{ -+ sint i; -+ u8 *pbuf; -+ struct wlan_network *pnetwork; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ sint res = _SUCCESS; -+ -+ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by vzalloc(). */ -+ /* memset((u8 *)pmlmepriv, 0, sizeof(struct mlme_priv)); */ -+ -+ pmlmepriv->nic_hdl = (u8 *)padapter; -+ -+ pmlmepriv->pscanned = NULL; -+ pmlmepriv->fw_state = WIFI_STATION_STATE; /* Must sync with rtw_wdev_alloc() */ -+ /* wdev->iftype = NL80211_IFTYPE_STATION */ -+ pmlmepriv->cur_network.network.InfrastructureMode = Ndis802_11AutoUnknown; -+ pmlmepriv->scan_mode = SCAN_ACTIVE;/* 1: active, 0: pasive. Maybe someday we should rename this varable to "active_mode" (Jeff) */ -+ -+ spin_lock_init(&(pmlmepriv->lock)); -+ _rtw_init_queue(&(pmlmepriv->free_bss_pool)); -+ _rtw_init_queue(&(pmlmepriv->scanned_queue)); -+ -+ set_scanned_network_val(pmlmepriv, 0); -+ -+ memset(&pmlmepriv->assoc_ssid, 0, sizeof(struct ndis_802_11_ssid)); -+ -+ pbuf = vzalloc(MAX_BSS_CNT * (sizeof(struct wlan_network))); -+ -+ if (pbuf == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ pmlmepriv->free_bss_buf = pbuf; -+ -+ pnetwork = (struct wlan_network *)pbuf; -+ -+ for (i = 0; i < MAX_BSS_CNT; i++) { -+ INIT_LIST_HEAD(&(pnetwork->list)); -+ -+ list_add_tail(&(pnetwork->list), &(pmlmepriv->free_bss_pool.queue)); -+ -+ pnetwork++; -+ } -+ -+ /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */ -+ -+ rtw_clear_scan_deny(padapter); -+ -+ #define RTW_ROAM_SCAN_RESULT_EXP_MS 5000 -+ #define RTW_ROAM_RSSI_DIFF_TH 10 -+ #define RTW_ROAM_SCAN_INTERVAL_MS 10000 -+ -+ pmlmepriv->roam_flags = 0 -+ | RTW_ROAM_ON_EXPIRED -+ | RTW_ROAM_ON_RESUME -+ #ifdef CONFIG_LAYER2_ROAMING_ACTIVE /* FIXME */ -+ | RTW_ROAM_ACTIVE -+ #endif -+ ; -+ -+ pmlmepriv->roam_scanr_exp_ms = RTW_ROAM_SCAN_RESULT_EXP_MS; -+ pmlmepriv->roam_rssi_diff_th = RTW_ROAM_RSSI_DIFF_TH; -+ pmlmepriv->roam_scan_int_ms = RTW_ROAM_SCAN_INTERVAL_MS; -+ -+ rtw_init_mlme_timer(padapter); -+ -+exit: -+ -+ return res; -+} -+ -+static void rtw_free_mlme_ie_data(u8 **ppie, u32 *plen) -+{ -+ if (*ppie) { -+ kfree(*ppie); -+ *plen = 0; -+ *ppie = NULL; -+ } -+} -+ -+void rtw_free_mlme_priv_ie_data(struct mlme_priv *pmlmepriv) -+{ -+ rtw_buf_free(&pmlmepriv->assoc_req, &pmlmepriv->assoc_req_len); -+ rtw_buf_free(&pmlmepriv->assoc_rsp, &pmlmepriv->assoc_rsp_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wps_beacon_ie, &pmlmepriv->wps_beacon_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wps_probe_req_ie, &pmlmepriv->wps_probe_req_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wps_probe_resp_ie, &pmlmepriv->wps_probe_resp_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wps_assoc_resp_ie, &pmlmepriv->wps_assoc_resp_ie_len); -+ -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_beacon_ie, &pmlmepriv->p2p_beacon_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_probe_req_ie, &pmlmepriv->p2p_probe_req_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_probe_resp_ie, &pmlmepriv->p2p_probe_resp_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_go_probe_resp_ie, &pmlmepriv->p2p_go_probe_resp_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_assoc_req_ie, &pmlmepriv->p2p_assoc_req_ie_len); -+} -+ -+void _rtw_free_mlme_priv(struct mlme_priv *pmlmepriv) -+{ -+ rtw_free_mlme_priv_ie_data(pmlmepriv); -+ -+ if (pmlmepriv) { -+ if (pmlmepriv->free_bss_buf) { -+ vfree(pmlmepriv->free_bss_buf); -+ } -+ } -+} -+ -+/* -+struct wlan_network *_rtw_dequeue_network(struct __queue *queue) -+{ -+ _irqL irqL; -+ -+ struct wlan_network *pnetwork; -+ -+ spin_lock_bh(&queue->lock); -+ -+ if (list_empty(&queue->queue)) -+ -+ pnetwork = NULL; -+ -+ else -+ { -+ pnetwork = LIST_CONTAINOR(get_next(&queue->queue), struct wlan_network, list); -+ -+ list_del_init(&(pnetwork->list)); -+ } -+ -+ spin_unlock_bh(&queue->lock); -+ -+ return pnetwork; -+} -+*/ -+ -+struct wlan_network *_rtw_alloc_network(struct mlme_priv *pmlmepriv)/* _queue *free_queue) */ -+{ -+ struct wlan_network *pnetwork; -+ struct __queue *free_queue = &pmlmepriv->free_bss_pool; -+ struct list_head *plist = NULL; -+ -+ spin_lock_bh(&free_queue->lock); -+ -+ if (list_empty(&free_queue->queue)) { -+ pnetwork = NULL; -+ goto exit; -+ } -+ plist = get_next(&(free_queue->queue)); -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ list_del_init(&pnetwork->list); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("_rtw_alloc_network: ptr =%p\n", plist)); -+ pnetwork->network_type = 0; -+ pnetwork->fixed = false; -+ pnetwork->last_scanned = jiffies; -+ pnetwork->aid = 0; -+ pnetwork->join_res = 0; -+ -+ pmlmepriv->num_of_scanned++; -+ -+exit: -+ spin_unlock_bh(&free_queue->lock); -+ -+ return pnetwork; -+} -+ -+void _rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 isfreeall) -+{ -+ unsigned int delta_time; -+ u32 lifetime = SCANQUEUE_LIFETIME; -+/* _irqL irqL; */ -+ struct __queue *free_queue = &(pmlmepriv->free_bss_pool); -+ -+ if (pnetwork == NULL) -+ return; -+ -+ if (pnetwork->fixed == true) -+ return; -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true)) -+ lifetime = 1; -+ -+ if (!isfreeall) { -+ delta_time = jiffies_to_msecs(jiffies - pnetwork->last_scanned); -+ if (delta_time < lifetime)/* unit:msec */ -+ return; -+ } -+ -+ spin_lock_bh(&free_queue->lock); -+ -+ list_del_init(&(pnetwork->list)); -+ -+ list_add_tail(&(pnetwork->list), &(free_queue->queue)); -+ -+ pmlmepriv->num_of_scanned--; -+ -+ -+ /* DBG_871X("_rtw_free_network:SSID =%s\n", pnetwork->network.Ssid.Ssid); */ -+ -+ spin_unlock_bh(&free_queue->lock); -+} -+ -+void _rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork) -+{ -+ -+ struct __queue *free_queue = &(pmlmepriv->free_bss_pool); -+ -+ if (pnetwork == NULL) -+ return; -+ -+ if (pnetwork->fixed == true) -+ return; -+ -+ /* spin_lock_irqsave(&free_queue->lock, irqL); */ -+ -+ list_del_init(&(pnetwork->list)); -+ -+ list_add_tail(&(pnetwork->list), get_list_head(free_queue)); -+ -+ pmlmepriv->num_of_scanned--; -+ -+ /* spin_unlock_irqrestore(&free_queue->lock, irqL); */ -+} -+ -+/* -+ return the wlan_network with the matching addr -+ -+ Shall be calle under atomic context... to avoid possible racing condition... -+*/ -+struct wlan_network *_rtw_find_network(struct __queue *scanned_queue, u8 *addr) -+{ -+ struct list_head *phead, *plist; -+ struct wlan_network *pnetwork = NULL; -+ u8 zero_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; -+ -+ if (!memcmp(zero_addr, addr, ETH_ALEN)) { -+ pnetwork = NULL; -+ goto exit; -+ } -+ -+ /* spin_lock_bh(&scanned_queue->lock); */ -+ -+ phead = get_list_head(scanned_queue); -+ plist = get_next(phead); -+ -+ while (plist != phead) { -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ if (!memcmp(addr, pnetwork->network.MacAddress, ETH_ALEN)) -+ break; -+ -+ plist = get_next(plist); -+ } -+ -+ if (plist == phead) -+ pnetwork = NULL; -+ -+ /* spin_unlock_bh(&scanned_queue->lock); */ -+ -+exit: -+ return pnetwork; -+} -+ -+void _rtw_free_network_queue(struct adapter *padapter, u8 isfreeall) -+{ -+ struct list_head *phead, *plist; -+ struct wlan_network *pnetwork; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct __queue *scanned_queue = &pmlmepriv->scanned_queue; -+ -+ spin_lock_bh(&scanned_queue->lock); -+ -+ phead = get_list_head(scanned_queue); -+ plist = get_next(phead); -+ -+ while (phead != plist) { -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ plist = get_next(plist); -+ -+ _rtw_free_network(pmlmepriv, pnetwork, isfreeall); -+ -+ } -+ -+ spin_unlock_bh(&scanned_queue->lock); -+} -+ -+ -+ -+ -+sint rtw_if_up(struct adapter *padapter) -+{ -+ -+ sint res; -+ -+ if (padapter->bDriverStopped || padapter->bSurpriseRemoved || -+ (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == false)) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_if_up:bDriverStopped(%d) OR bSurpriseRemoved(%d)", padapter->bDriverStopped, padapter->bSurpriseRemoved)); -+ res = false; -+ } else -+ res = true; -+ return res; -+} -+ -+ -+void rtw_generate_random_ibss(u8 *pibss) -+{ -+ unsigned long curtime = jiffies; -+ -+ pibss[0] = 0x02; /* in ad-hoc mode bit1 must set to 1 */ -+ pibss[1] = 0x11; -+ pibss[2] = 0x87; -+ pibss[3] = (u8)(curtime & 0xff) ;/* p[0]; */ -+ pibss[4] = (u8)((curtime>>8) & 0xff) ;/* p[1]; */ -+ pibss[5] = (u8)((curtime>>16) & 0xff) ;/* p[2]; */ -+ return; -+} -+ -+u8 *rtw_get_capability_from_ie(u8 *ie) -+{ -+ return (ie + 8 + 2); -+} -+ -+ -+u16 rtw_get_capability(struct wlan_bssid_ex *bss) -+{ -+ __le16 val; -+ -+ memcpy((u8 *)&val, rtw_get_capability_from_ie(bss->IEs), 2); -+ -+ return le16_to_cpu(val); -+} -+ -+u8 *rtw_get_beacon_interval_from_ie(u8 *ie) -+{ -+ return (ie + 8); -+} -+ -+ -+int rtw_init_mlme_priv(struct adapter *padapter)/* struct mlme_priv *pmlmepriv) */ -+{ -+ int res; -+ -+ res = _rtw_init_mlme_priv(padapter);/* (pmlmepriv); */ -+ return res; -+} -+ -+void rtw_free_mlme_priv(struct mlme_priv *pmlmepriv) -+{ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("rtw_free_mlme_priv\n")); -+ _rtw_free_mlme_priv(pmlmepriv); -+} -+ -+/* -+static struct wlan_network *rtw_dequeue_network(struct __queue *queue) -+{ -+ struct wlan_network *pnetwork; -+ -+ pnetwork = _rtw_dequeue_network(queue); -+ return pnetwork; -+} -+*/ -+ -+struct wlan_network *rtw_alloc_network(struct mlme_priv *pmlmepriv); -+struct wlan_network *rtw_alloc_network(struct mlme_priv *pmlmepriv)/* _queue *free_queue) */ -+{ -+ struct wlan_network *pnetwork; -+ -+ pnetwork = _rtw_alloc_network(pmlmepriv); -+ return pnetwork; -+} -+ -+void rtw_free_network_nolock(struct adapter *padapter, struct wlan_network *pnetwork); -+void rtw_free_network_nolock(struct adapter *padapter, struct wlan_network *pnetwork) -+{ -+ /* RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("rtw_free_network ==> ssid = %s\n\n" , pnetwork->network.Ssid.Ssid)); */ -+ _rtw_free_network_nolock(&(padapter->mlmepriv), pnetwork); -+ rtw_cfg80211_unlink_bss(padapter, pnetwork); -+} -+ -+ -+void rtw_free_network_queue(struct adapter *dev, u8 isfreeall) -+{ -+ _rtw_free_network_queue(dev, isfreeall); -+} -+ -+/* -+ return the wlan_network with the matching addr -+ -+ Shall be calle under atomic context... to avoid possible racing condition... -+*/ -+struct wlan_network *rtw_find_network(struct __queue *scanned_queue, u8 *addr) -+{ -+ struct wlan_network *pnetwork = _rtw_find_network(scanned_queue, addr); -+ -+ return pnetwork; -+} -+ -+int rtw_is_same_ibss(struct adapter *adapter, struct wlan_network *pnetwork) -+{ -+ int ret = true; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ -+ if ((psecuritypriv->dot11PrivacyAlgrthm != _NO_PRIVACY_) && -+ (pnetwork->network.Privacy == 0)) -+ ret = false; -+ else if ((psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_) && -+ (pnetwork->network.Privacy == 1)) -+ ret = false; -+ else -+ ret = true; -+ -+ return ret; -+ -+} -+ -+inline int is_same_ess(struct wlan_bssid_ex *a, struct wlan_bssid_ex *b) -+{ -+ /* RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("(%s,%d)(%s,%d)\n", */ -+ /* a->Ssid.Ssid, a->Ssid.SsidLength, b->Ssid.Ssid, b->Ssid.SsidLength)); */ -+ return (a->Ssid.SsidLength == b->Ssid.SsidLength) -+ && !memcmp(a->Ssid.Ssid, b->Ssid.Ssid, a->Ssid.SsidLength); -+} -+ -+int is_same_network(struct wlan_bssid_ex *src, struct wlan_bssid_ex *dst, u8 feature) -+{ -+ u16 s_cap, d_cap; -+ __le16 tmps, tmpd; -+ -+ if (rtw_bug_check(dst, src, &s_cap, &d_cap) == false) -+ return false; -+ -+ memcpy((u8 *)&tmps, rtw_get_capability_from_ie(src->IEs), 2); -+ memcpy((u8 *)&tmpd, rtw_get_capability_from_ie(dst->IEs), 2); -+ -+ -+ s_cap = le16_to_cpu(tmps); -+ d_cap = le16_to_cpu(tmpd); -+ -+ return ((src->Ssid.SsidLength == dst->Ssid.SsidLength) && -+ /* (src->Configuration.DSConfig == dst->Configuration.DSConfig) && */ -+ ((!memcmp(src->MacAddress, dst->MacAddress, ETH_ALEN))) && -+ ((!memcmp(src->Ssid.Ssid, dst->Ssid.Ssid, src->Ssid.SsidLength))) && -+ ((s_cap & WLAN_CAPABILITY_IBSS) == -+ (d_cap & WLAN_CAPABILITY_IBSS)) && -+ ((s_cap & WLAN_CAPABILITY_BSS) == -+ (d_cap & WLAN_CAPABILITY_BSS))); -+ -+} -+ -+struct wlan_network *_rtw_find_same_network(struct __queue *scanned_queue, struct wlan_network *network) -+{ -+ struct list_head *phead, *plist; -+ struct wlan_network *found = NULL; -+ -+ phead = get_list_head(scanned_queue); -+ plist = get_next(phead); -+ -+ while (plist != phead) { -+ found = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ if (is_same_network(&network->network, &found->network, 0)) -+ break; -+ -+ plist = get_next(plist); -+ } -+ -+ if (plist == phead) -+ found = NULL; -+ -+ return found; -+} -+ -+struct wlan_network *rtw_get_oldest_wlan_network(struct __queue *scanned_queue) -+{ -+ struct list_head *plist, *phead; -+ -+ -+ struct wlan_network *pwlan = NULL; -+ struct wlan_network *oldest = NULL; -+ -+ phead = get_list_head(scanned_queue); -+ -+ plist = get_next(phead); -+ -+ while (1) { -+ -+ if (phead == plist) -+ break; -+ -+ pwlan = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ if (pwlan->fixed != true) { -+ if (oldest == NULL || time_after(oldest->last_scanned, pwlan->last_scanned)) -+ oldest = pwlan; -+ } -+ -+ plist = get_next(plist); -+ } -+ return oldest; -+ -+} -+ -+void update_network(struct wlan_bssid_ex *dst, struct wlan_bssid_ex *src, -+ struct adapter *padapter, bool update_ie) -+{ -+ long rssi_ori = dst->Rssi; -+ -+ u8 sq_smp = src->PhyInfo.SignalQuality; -+ -+ u8 ss_final; -+ u8 sq_final; -+ long rssi_final; -+ -+ #if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) && 1 -+ if (strcmp(dst->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { -+ DBG_871X(FUNC_ADPT_FMT" %s("MAC_FMT", ch%u) ss_ori:%3u, sq_ori:%3u, rssi_ori:%3ld, ss_smp:%3u, sq_smp:%3u, rssi_smp:%3ld\n" -+ , FUNC_ADPT_ARG(padapter) -+ , src->Ssid.Ssid, MAC_ARG(src->MacAddress), src->Configuration.DSConfig -+ , ss_ori, sq_ori, rssi_ori -+ , ss_smp, sq_smp, rssi_smp -+ ); -+ } -+ #endif -+ -+ /* The rule below is 1/5 for sample value, 4/5 for history value */ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) && is_same_network(&(padapter->mlmepriv.cur_network.network), src, 0)) { -+ /* Take the recvpriv's value for the connected AP*/ -+ ss_final = padapter->recvpriv.signal_strength; -+ sq_final = padapter->recvpriv.signal_qual; -+ /* the rssi value here is undecorated, and will be used for antenna diversity */ -+ if (sq_smp != 101) /* from the right channel */ -+ rssi_final = (src->Rssi+dst->Rssi*4)/5; -+ else -+ rssi_final = rssi_ori; -+ } else { -+ if (sq_smp != 101) { /* from the right channel */ -+ ss_final = ((u32)(src->PhyInfo.SignalStrength)+(u32)(dst->PhyInfo.SignalStrength)*4)/5; -+ sq_final = ((u32)(src->PhyInfo.SignalQuality)+(u32)(dst->PhyInfo.SignalQuality)*4)/5; -+ rssi_final = (src->Rssi+dst->Rssi*4)/5; -+ } else { -+ /* bss info not receving from the right channel, use the original RX signal infos */ -+ ss_final = dst->PhyInfo.SignalStrength; -+ sq_final = dst->PhyInfo.SignalQuality; -+ rssi_final = dst->Rssi; -+ } -+ -+ } -+ -+ if (update_ie) { -+ dst->Reserved[0] = src->Reserved[0]; -+ dst->Reserved[1] = src->Reserved[1]; -+ memcpy((u8 *)dst, (u8 *)src, get_wlan_bssid_ex_sz(src)); -+ } -+ -+ dst->PhyInfo.SignalStrength = ss_final; -+ dst->PhyInfo.SignalQuality = sq_final; -+ dst->Rssi = rssi_final; -+ -+ #if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) && 1 -+ if (strcmp(dst->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { -+ DBG_871X(FUNC_ADPT_FMT" %s("MAC_FMT"), SignalStrength:%u, SignalQuality:%u, RawRSSI:%ld\n" -+ , FUNC_ADPT_ARG(padapter) -+ , dst->Ssid.Ssid, MAC_ARG(dst->MacAddress), dst->PhyInfo.SignalStrength, dst->PhyInfo.SignalQuality, dst->Rssi); -+ } -+ #endif -+} -+ -+static void update_current_network(struct adapter *adapter, struct wlan_bssid_ex *pnetwork) -+{ -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ rtw_bug_check(&(pmlmepriv->cur_network.network), -+ &(pmlmepriv->cur_network.network), -+ &(pmlmepriv->cur_network.network), -+ &(pmlmepriv->cur_network.network)); -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) && (is_same_network(&(pmlmepriv->cur_network.network), pnetwork, 0))) { -+ /* RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_,"Same Network\n"); */ -+ -+ /* if (pmlmepriv->cur_network.network.IELength<= pnetwork->IELength) */ -+ { -+ update_network(&(pmlmepriv->cur_network.network), pnetwork, adapter, true); -+ rtw_update_protection(adapter, (pmlmepriv->cur_network.network.IEs) + sizeof(struct ndis_802_11_fix_ie), -+ pmlmepriv->cur_network.network.IELength); -+ } -+ } -+} -+ -+ -+/* -+ -+Caller must hold pmlmepriv->lock first. -+ -+ -+*/ -+void rtw_update_scanned_network(struct adapter *adapter, struct wlan_bssid_ex *target) -+{ -+ struct list_head *plist, *phead; -+ u32 bssid_ex_sz; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct __queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ struct wlan_network *oldest = NULL; -+ int target_find = 0; -+ u8 feature = 0; -+ -+ spin_lock_bh(&queue->lock); -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ if (phead == plist) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ rtw_bug_check(pnetwork, pnetwork, pnetwork, pnetwork); -+ -+ if (is_same_network(&(pnetwork->network), target, feature)) { -+ target_find = 1; -+ break; -+ } -+ -+ if (rtw_roam_flags(adapter)) { -+ /* TODO: don't select netowrk in the same ess as oldest if it's new enough*/ -+ } -+ -+ if (oldest == NULL || time_after(oldest->last_scanned, pnetwork->last_scanned)) -+ oldest = pnetwork; -+ -+ plist = get_next(plist); -+ -+ } -+ -+ -+ /* If we didn't find a match, then get a new network slot to initialize -+ * with this beacon's information */ -+ /* if (phead == plist) { */ -+ if (!target_find) { -+ if (list_empty(&pmlmepriv->free_bss_pool.queue)) { -+ /* If there are no more slots, expire the oldest */ -+ /* list_del_init(&oldest->list); */ -+ pnetwork = oldest; -+ if (pnetwork == NULL) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("\n\n\nsomething wrong here\n\n\n")); -+ goto exit; -+ } -+ memcpy(&(pnetwork->network), target, get_wlan_bssid_ex_sz(target)); -+ /* variable initialize */ -+ pnetwork->fixed = false; -+ pnetwork->last_scanned = jiffies; -+ -+ pnetwork->network_type = 0; -+ pnetwork->aid = 0; -+ pnetwork->join_res = 0; -+ -+ /* bss info not receving from the right channel */ -+ if (pnetwork->network.PhyInfo.SignalQuality == 101) -+ pnetwork->network.PhyInfo.SignalQuality = 0; -+ } else { -+ /* Otherwise just pull from the free list */ -+ -+ pnetwork = rtw_alloc_network(pmlmepriv); /* will update scan_time */ -+ -+ if (pnetwork == NULL) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("\n\n\nsomething wrong here\n\n\n")); -+ goto exit; -+ } -+ -+ bssid_ex_sz = get_wlan_bssid_ex_sz(target); -+ target->Length = bssid_ex_sz; -+ memcpy(&(pnetwork->network), target, bssid_ex_sz); -+ -+ pnetwork->last_scanned = jiffies; -+ -+ /* bss info not receving from the right channel */ -+ if (pnetwork->network.PhyInfo.SignalQuality == 101) -+ pnetwork->network.PhyInfo.SignalQuality = 0; -+ -+ list_add_tail(&(pnetwork->list), &(queue->queue)); -+ -+ } -+ } else { -+ /* we have an entry and we are going to update it. But this entry may -+ * be already expired. In this case we do the same as we found a new -+ * net and call the new_net handler -+ */ -+ bool update_ie = true; -+ -+ pnetwork->last_scanned = jiffies; -+ -+ /* target.Reserved[0]== 1, means that scaned network is a bcn frame. */ -+ if ((pnetwork->network.IELength > target->IELength) && (target->Reserved[0] == 1)) -+ update_ie = false; -+ -+ /* probe resp(3) > beacon(1) > probe req(2) */ -+ if ((target->Reserved[0] != 2) && -+ (target->Reserved[0] >= pnetwork->network.Reserved[0]) -+ ) { -+ update_ie = true; -+ } else { -+ update_ie = false; -+ } -+ -+ update_network(&(pnetwork->network), target, adapter, update_ie); -+ } -+ -+exit: -+ spin_unlock_bh(&queue->lock); -+} -+ -+void rtw_add_network(struct adapter *adapter, struct wlan_bssid_ex *pnetwork); -+void rtw_add_network(struct adapter *adapter, struct wlan_bssid_ex *pnetwork) -+{ -+ /* struct __queue *queue = &(pmlmepriv->scanned_queue); */ -+ -+ /* spin_lock_bh(&queue->lock); */ -+ -+ update_current_network(adapter, pnetwork); -+ -+ rtw_update_scanned_network(adapter, pnetwork); -+ -+ /* spin_unlock_bh(&queue->lock); */ -+} -+ -+/* select the desired network based on the capability of the (i)bss. */ -+/* check items: (1) security */ -+/* (2) network_type */ -+/* (3) WMM */ -+/* (4) HT */ -+/* (5) others */ -+int rtw_is_desired_network(struct adapter *adapter, struct wlan_network *pnetwork); -+int rtw_is_desired_network(struct adapter *adapter, struct wlan_network *pnetwork) -+{ -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u32 desired_encmode; -+ u32 privacy; -+ -+ /* u8 wps_ie[512]; */ -+ uint wps_ielen; -+ -+ int bselected = true; -+ -+ desired_encmode = psecuritypriv->ndisencryptstatus; -+ privacy = pnetwork->network.Privacy; -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { -+ if (rtw_get_wps_ie(pnetwork->network.IEs+_FIXED_IE_LENGTH_, pnetwork->network.IELength-_FIXED_IE_LENGTH_, NULL, &wps_ielen) != NULL) -+ return true; -+ else -+ return false; -+ -+ } -+ if (adapter->registrypriv.wifi_spec == 1) { /* for correct flow of 8021X to do.... */ -+ u8 *p = NULL; -+ uint ie_len = 0; -+ -+ if ((desired_encmode == Ndis802_11EncryptionDisabled) && (privacy != 0)) -+ bselected = false; -+ -+ if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) { -+ p = rtw_get_ie(pnetwork->network.IEs + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pnetwork->network.IELength - _BEACON_IE_OFFSET_)); -+ if (p && ie_len > 0) { -+ bselected = true; -+ } else { -+ bselected = false; -+ } -+ } -+ } -+ -+ -+ if ((desired_encmode != Ndis802_11EncryptionDisabled) && (privacy == 0)) { -+ DBG_871X("desired_encmode: %d, privacy: %d\n", desired_encmode, privacy); -+ bselected = false; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) { -+ if (pnetwork->network.InfrastructureMode != pmlmepriv->cur_network.network.InfrastructureMode) -+ bselected = false; -+ } -+ -+ -+ return bselected; -+} -+ -+/* TODO: Perry : For Power Management */ -+void rtw_atimdone_event_callback(struct adapter *adapter, u8 *pbuf) -+{ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("receive atimdone_evet\n")); -+} -+ -+ -+void rtw_survey_event_callback(struct adapter *adapter, u8 *pbuf) -+{ -+ u32 len; -+ struct wlan_bssid_ex *pnetwork; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ pnetwork = (struct wlan_bssid_ex *)pbuf; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_survey_event_callback, ssid =%s\n", pnetwork->Ssid.Ssid)); -+ -+ len = get_wlan_bssid_ex_sz(pnetwork); -+ if (len > (sizeof(struct wlan_bssid_ex))) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("\n ****rtw_survey_event_callback: return a wrong bss ***\n")); -+ return; -+ } -+ -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ /* update IBSS_network 's timestamp */ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == true) { -+ /* RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_,"rtw_survey_event_callback : WIFI_ADHOC_MASTER_STATE\n\n"); */ -+ if (!memcmp(&(pmlmepriv->cur_network.network.MacAddress), pnetwork->MacAddress, ETH_ALEN)) { -+ struct wlan_network *ibss_wlan = NULL; -+ -+ memcpy(pmlmepriv->cur_network.network.IEs, pnetwork->IEs, 8); -+ spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); -+ ibss_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->MacAddress); -+ if (ibss_wlan) { -+ memcpy(ibss_wlan->network.IEs, pnetwork->IEs, 8); -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ goto exit; -+ } -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ } -+ } -+ -+ /* lock pmlmepriv->lock when you accessing network_q */ -+ if ((check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) == false) { -+ if (pnetwork->Ssid.Ssid[0] == 0) { -+ pnetwork->Ssid.SsidLength = 0; -+ } -+ rtw_add_network(adapter, pnetwork); -+ } -+ -+exit: -+ -+ spin_unlock_bh(&pmlmepriv->lock); -+ -+ return; -+} -+ -+ -+ -+void rtw_surveydone_event_callback(struct adapter *adapter, u8 *pbuf) -+{ -+ u8 timer_cancelled = false; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ if (pmlmepriv->wps_probe_req_ie) { -+ pmlmepriv->wps_probe_req_ie_len = 0; -+ kfree(pmlmepriv->wps_probe_req_ie); -+ pmlmepriv->wps_probe_req_ie = NULL; -+ } -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_surveydone_event_callback: fw_state:%x\n\n", get_fwstate(pmlmepriv))); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { -+ /* u8 timer_cancelled; */ -+ -+ timer_cancelled = true; -+ /* _cancel_timer(&pmlmepriv->scan_to_timer, &timer_cancelled); */ -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ } else { -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("nic status =%x, survey done event comes too late!\n", get_fwstate(pmlmepriv))); -+ } -+ spin_unlock_bh(&pmlmepriv->lock); -+ -+ if (timer_cancelled) -+ _cancel_timer(&pmlmepriv->scan_to_timer, &timer_cancelled); -+ -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ rtw_set_signal_stat_timer(&adapter->recvpriv); -+ -+ if (pmlmepriv->to_join == true) { -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true)) { -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == false) { -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ -+ if (rtw_select_and_join_from_scanned_queue(pmlmepriv) == _SUCCESS) { -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); -+ } else{ -+ struct wlan_bssid_ex *pdev_network = &(adapter->registrypriv.dev_network); -+ u8 *pibss = adapter->registrypriv.dev_network.MacAddress; -+ -+ /* pmlmepriv->fw_state ^= _FW_UNDER_SURVEY;because don't set assoc_timer */ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("switching to adhoc master\n")); -+ -+ memset(&pdev_network->Ssid, 0, sizeof(struct ndis_802_11_ssid)); -+ memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(struct ndis_802_11_ssid)); -+ -+ rtw_update_registrypriv_dev_network(adapter); -+ rtw_generate_random_ibss(pibss); -+ -+ pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE; -+ -+ if (rtw_createbss_cmd(adapter) != _SUCCESS) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("Error =>rtw_createbss_cmd status FAIL\n")); -+ } -+ -+ pmlmepriv->to_join = false; -+ } -+ } -+ } else{ -+ int s_ret; -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ pmlmepriv->to_join = false; -+ s_ret = rtw_select_and_join_from_scanned_queue(pmlmepriv); -+ if (_SUCCESS == s_ret) { -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); -+ } else if (s_ret == 2) {/* there is no need to wait for join */ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ rtw_indicate_connect(adapter); -+ } else{ -+ DBG_871X("try_to_join, but select scanning queue fail, to_roam:%d\n", rtw_to_roam(adapter)); -+ -+ if (rtw_to_roam(adapter) != 0) { -+ if (rtw_dec_to_roam(adapter) == 0 -+ || _SUCCESS != rtw_sitesurvey_cmd(adapter, &pmlmepriv->assoc_ssid, 1, NULL, 0) -+ ) { -+ rtw_set_to_roam(adapter, 0); -+#ifdef CONFIG_INTEL_WIDI -+ if (adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) { -+ memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); -+ intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL, 0); -+ DBG_871X("change to widi listen\n"); -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ rtw_free_assoc_resources(adapter, 1); -+ rtw_indicate_disconnect(adapter); -+ } else { -+ pmlmepriv->to_join = true; -+ } -+ } else -+ rtw_indicate_disconnect(adapter); -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ } -+ } -+ } else { -+ if (rtw_chk_roam_flags(adapter, RTW_ROAM_ACTIVE)) { -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, _FW_LINKED)) { -+ if (rtw_select_roaming_candidate(pmlmepriv) == _SUCCESS) { -+ receive_disconnect(adapter, pmlmepriv->cur_network.network.MacAddress -+ , WLAN_REASON_ACTIVE_ROAM); -+ } -+ } -+ } -+ } -+ -+ /* DBG_871X("scan complete in %dms\n", jiffies_to_msecs(jiffies - pmlmepriv->scan_start_time)); */ -+ -+ spin_unlock_bh(&pmlmepriv->lock); -+ -+ rtw_os_xmit_schedule(adapter); -+ -+ rtw_cfg80211_surveydone_event_callback(adapter); -+ -+ rtw_indicate_scan_done(adapter, false); -+} -+ -+void rtw_dummy_event_callback(struct adapter *adapter, u8 *pbuf) -+{ -+} -+ -+void rtw_fwdbg_event_callback(struct adapter *adapter, u8 *pbuf) -+{ -+} -+ -+static void free_scanqueue(struct mlme_priv *pmlmepriv) -+{ -+ struct __queue *free_queue = &pmlmepriv->free_bss_pool; -+ struct __queue *scan_queue = &pmlmepriv->scanned_queue; -+ struct list_head *plist, *phead, *ptemp; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, ("+free_scanqueue\n")); -+ spin_lock_bh(&scan_queue->lock); -+ spin_lock_bh(&free_queue->lock); -+ -+ phead = get_list_head(scan_queue); -+ plist = get_next(phead); -+ -+ while (plist != phead) { -+ ptemp = get_next(plist); -+ list_del_init(plist); -+ list_add_tail(plist, &free_queue->queue); -+ plist = ptemp; -+ pmlmepriv->num_of_scanned--; -+ } -+ -+ spin_unlock_bh(&free_queue->lock); -+ spin_unlock_bh(&scan_queue->lock); -+} -+ -+static void rtw_reset_rx_info(struct debug_priv *pdbgpriv) -+{ -+ pdbgpriv->dbg_rx_ampdu_drop_count = 0; -+ pdbgpriv->dbg_rx_ampdu_forced_indicate_count = 0; -+ pdbgpriv->dbg_rx_ampdu_loss_count = 0; -+ pdbgpriv->dbg_rx_dup_mgt_frame_drop_count = 0; -+ pdbgpriv->dbg_rx_ampdu_window_shift_cnt = 0; -+} -+ -+static void find_network(struct adapter *adapter) -+{ -+ struct wlan_network *pwlan = NULL; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct wlan_network *tgt_network = &pmlmepriv->cur_network; -+ -+ pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); -+ if (pwlan) -+ pwlan->fixed = false; -+ else -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("rtw_free_assoc_resources : pwlan == NULL\n\n")); -+ -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) && -+ (adapter->stapriv.asoc_sta_count == 1)) -+ rtw_free_network_nolock(adapter, pwlan); -+} -+ -+/* -+*rtw_free_assoc_resources: the caller has to lock pmlmepriv->lock -+*/ -+void rtw_free_assoc_resources(struct adapter *adapter, int lock_scanned_queue) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct wlan_network *tgt_network = &pmlmepriv->cur_network; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct dvobj_priv *psdpriv = adapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, ("+rtw_free_assoc_resources\n")); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("tgt_network->network.MacAddress ="MAC_FMT" ssid =%s\n", -+ MAC_ARG(tgt_network->network.MacAddress), tgt_network->network.Ssid.Ssid)); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_AP_STATE)) { -+ struct sta_info *psta; -+ -+ psta = rtw_get_stainfo(&adapter->stapriv, tgt_network->network.MacAddress); -+ spin_lock_bh(&(pstapriv->sta_hash_lock)); -+ rtw_free_stainfo(adapter, psta); -+ -+ spin_unlock_bh(&(pstapriv->sta_hash_lock)); -+ -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE|WIFI_AP_STATE)) { -+ struct sta_info *psta; -+ -+ rtw_free_all_stainfo(adapter); -+ -+ psta = rtw_get_bcmc_stainfo(adapter); -+ rtw_free_stainfo(adapter, psta); -+ -+ rtw_init_bcmc_stainfo(adapter); -+ } -+ -+ if (lock_scanned_queue) { -+ find_network(adapter); -+ } else { -+ find_network(adapter); -+ } -+ -+ if (lock_scanned_queue) -+ -+ adapter->securitypriv.key_mask = 0; -+ -+ rtw_reset_rx_info(pdbgpriv); -+} -+ -+/* -+*rtw_indicate_connect: the caller has to lock pmlmepriv->lock -+*/ -+void rtw_indicate_connect(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("+rtw_indicate_connect\n")); -+ -+ pmlmepriv->to_join = false; -+ -+ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { -+ -+ set_fwstate(pmlmepriv, _FW_LINKED); -+ -+ rtw_os_indicate_connect(padapter); -+ } -+ -+ rtw_set_to_roam(padapter, 0); -+#ifdef CONFIG_INTEL_WIDI -+ if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) { -+ memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_WK, NULL, 0); -+ DBG_871X("change to widi listen\n"); -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ rtw_set_scan_deny(padapter, 3000); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("-rtw_indicate_connect: fw_state = 0x%08x\n", get_fwstate(pmlmepriv))); -+} -+ -+/* -+*rtw_indicate_disconnect: the caller has to lock pmlmepriv->lock -+*/ -+void rtw_indicate_disconnect(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("+rtw_indicate_disconnect\n")); -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING|WIFI_UNDER_WPS); -+ -+ /* DBG_871X("clear wps when %s\n", __func__); */ -+ -+ if (rtw_to_roam(padapter) > 0) -+ _clr_fwstate_(pmlmepriv, _FW_LINKED); -+ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) -+ || (rtw_to_roam(padapter) <= 0) -+ ) { -+ rtw_os_indicate_disconnect(padapter); -+ -+ /* set ips_deny_time to avoid enter IPS before LPS leave */ -+ rtw_set_ips_deny(padapter, 3000); -+ -+ _clr_fwstate_(pmlmepriv, _FW_LINKED); -+ -+ rtw_clear_scan_deny(padapter); -+ } -+ -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_DISCONNECT, 1); -+} -+ -+inline void rtw_indicate_scan_done(struct adapter *padapter, bool aborted) -+{ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ rtw_os_indicate_scan_done(padapter, aborted); -+ -+ if (is_primary_adapter(padapter) && -+ (!adapter_to_pwrctl(padapter)->bInSuspend) && -+ (!check_fwstate(&padapter->mlmepriv, -+ WIFI_ASOC_STATE|WIFI_UNDER_LINKING))) { -+ struct pwrctrl_priv *pwrpriv; -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ rtw_set_ips_deny(padapter, 0); -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 1); -+ } -+} -+ -+void rtw_scan_abort(struct adapter *adapter) -+{ -+ unsigned long start; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ -+ start = jiffies; -+ pmlmeext->scan_abort = true; -+ while (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) -+ && jiffies_to_msecs(start) <= 200) { -+ -+ if (adapter->bDriverStopped || adapter->bSurpriseRemoved) -+ break; -+ -+ DBG_871X(FUNC_NDEV_FMT"fw_state = _FW_UNDER_SURVEY!\n", FUNC_NDEV_ARG(adapter->pnetdev)); -+ msleep(20); -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { -+ if (!adapter->bDriverStopped && !adapter->bSurpriseRemoved) -+ DBG_871X(FUNC_NDEV_FMT"waiting for scan_abort time out!\n", FUNC_NDEV_ARG(adapter->pnetdev)); -+ rtw_indicate_scan_done(adapter, true); -+ } -+ pmlmeext->scan_abort = false; -+} -+ -+static struct sta_info *rtw_joinbss_update_stainfo(struct adapter *padapter, struct wlan_network *pnetwork) -+{ -+ int i; -+ struct sta_info *bmc_sta, *psta = NULL; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ psta = rtw_get_stainfo(pstapriv, pnetwork->network.MacAddress); -+ if (psta == NULL) { -+ psta = rtw_alloc_stainfo(pstapriv, pnetwork->network.MacAddress); -+ } -+ -+ if (psta) { /* update ptarget_sta */ -+ -+ DBG_871X("%s\n", __func__); -+ -+ psta->aid = pnetwork->join_res; -+ -+ update_sta_info(padapter, psta); -+ -+ /* update station supportRate */ -+ psta->bssratelen = rtw_get_rateset_len(pnetwork->network.SupportedRates); -+ memcpy(psta->bssrateset, pnetwork->network.SupportedRates, psta->bssratelen); -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ -+ psta->wireless_mode = pmlmeext->cur_wireless_mode; -+ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); -+ -+ -+ /* sta mode */ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, true); -+ -+ /* security related */ -+ if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { -+ padapter->securitypriv.binstallGrpkey = false; -+ padapter->securitypriv.busetkipkey = false; -+ padapter->securitypriv.bgrpkey_handshake = false; -+ -+ psta->ieee8021x_blocked = true; -+ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ -+ memset((u8 *)&psta->dot118021x_UncstKey, 0, sizeof(union Keytype)); -+ -+ memset((u8 *)&psta->dot11tkiprxmickey, 0, sizeof(union Keytype)); -+ memset((u8 *)&psta->dot11tkiptxmickey, 0, sizeof(union Keytype)); -+ -+ memset((u8 *)&psta->dot11txpn, 0, sizeof(union pn48)); -+ psta->dot11txpn.val = psta->dot11txpn.val + 1; -+ memset((u8 *)&psta->dot11wtxpn, 0, sizeof(union pn48)); -+ memset((u8 *)&psta->dot11rxpn, 0, sizeof(union pn48)); -+ } -+ -+ /* Commented by Albert 2012/07/21 */ -+ /* When doing the WPS, the wps_ie_len won't equal to 0 */ -+ /* And the Wi-Fi driver shouldn't allow the data packet to be tramsmitted. */ -+ if (padapter->securitypriv.wps_ie_len != 0) { -+ psta->ieee8021x_blocked = true; -+ padapter->securitypriv.wps_ie_len = 0; -+ } -+ -+ -+ /* for A-MPDU Rx reordering buffer control for bmc_sta & sta_info */ -+ /* if A-MPDU Rx is enabled, reseting rx_ordering_ctrl wstart_b(indicate_seq) to default value = 0xffff */ -+ /* todo: check if AP can send A-MPDU packets */ -+ for (i = 0; i < 16 ; i++) { -+ /* preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; */ -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = false; -+ preorder_ctrl->indicate_seq = 0xffff; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq); -+ #endif -+ preorder_ctrl->wend_b = 0xffff; -+ preorder_ctrl->wsize_b = 64;/* max_ampdu_sz;ex. 32(kbytes) -> wsize_b =32 */ -+ } -+ -+ -+ bmc_sta = rtw_get_bcmc_stainfo(padapter); -+ if (bmc_sta) { -+ for (i = 0; i < 16 ; i++) { -+ /* preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; */ -+ preorder_ctrl = &bmc_sta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = false; -+ preorder_ctrl->indicate_seq = 0xffff; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq); -+ #endif -+ preorder_ctrl->wend_b = 0xffff; -+ preorder_ctrl->wsize_b = 64;/* max_ampdu_sz;ex. 32(kbytes) -> wsize_b =32 */ -+ } -+ } -+ } -+ -+ return psta; -+ -+} -+ -+/* pnetwork : returns from rtw_joinbss_event_callback */ -+/* ptarget_wlan: found from scanned_queue */ -+static void rtw_joinbss_update_network(struct adapter *padapter, struct wlan_network *ptarget_wlan, struct wlan_network *pnetwork) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ -+ DBG_871X("%s\n", __func__); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("\nfw_state:%x, BSSID:"MAC_FMT"\n" -+ , get_fwstate(pmlmepriv), MAC_ARG(pnetwork->network.MacAddress))); -+ -+ -+ /* why not use ptarget_wlan?? */ -+ memcpy(&cur_network->network, &pnetwork->network, pnetwork->network.Length); -+ /* some IEs in pnetwork is wrong, so we should use ptarget_wlan IEs */ -+ cur_network->network.IELength = ptarget_wlan->network.IELength; -+ memcpy(&cur_network->network.IEs[0], &ptarget_wlan->network.IEs[0], MAX_IE_SZ); -+ -+ cur_network->aid = pnetwork->join_res; -+ -+ -+ rtw_set_signal_stat_timer(&padapter->recvpriv); -+ -+ padapter->recvpriv.signal_strength = ptarget_wlan->network.PhyInfo.SignalStrength; -+ padapter->recvpriv.signal_qual = ptarget_wlan->network.PhyInfo.SignalQuality; -+ /* the ptarget_wlan->network.Rssi is raw data, we use ptarget_wlan->network.PhyInfo.SignalStrength instead (has scaled) */ -+ padapter->recvpriv.rssi = translate_percentage_to_dbm(ptarget_wlan->network.PhyInfo.SignalStrength); -+ #if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 -+ DBG_871X(FUNC_ADPT_FMT" signal_strength:%3u, rssi:%3d, signal_qual:%3u" -+ "\n" -+ , FUNC_ADPT_ARG(padapter) -+ , padapter->recvpriv.signal_strength -+ , padapter->recvpriv.rssi -+ , padapter->recvpriv.signal_qual -+ ); -+ #endif -+ -+ rtw_set_signal_stat_timer(&padapter->recvpriv); -+ -+ /* update fw_state will clr _FW_UNDER_LINKING here indirectly */ -+ switch (pnetwork->network.InfrastructureMode) { -+ case Ndis802_11Infrastructure: -+ -+ if (pmlmepriv->fw_state&WIFI_UNDER_WPS) -+ pmlmepriv->fw_state = WIFI_STATION_STATE|WIFI_UNDER_WPS; -+ else -+ pmlmepriv->fw_state = WIFI_STATION_STATE; -+ -+ break; -+ case Ndis802_11IBSS: -+ pmlmepriv->fw_state = WIFI_ADHOC_STATE; -+ break; -+ default: -+ pmlmepriv->fw_state = WIFI_NULL_STATE; -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("Invalid network_mode\n")); -+ break; -+ } -+ -+ rtw_update_protection(padapter, (cur_network->network.IEs) + sizeof(struct ndis_802_11_fix_ie), -+ (cur_network->network.IELength)); -+ -+ rtw_update_ht_cap(padapter, cur_network->network.IEs, cur_network->network.IELength, (u8) cur_network->network.Configuration.DSConfig); -+} -+ -+/* Notes: the fucntion could be > passive_level (the same context as Rx tasklet) */ -+/* pnetwork : returns from rtw_joinbss_event_callback */ -+/* ptarget_wlan: found from scanned_queue */ -+/* if join_res > 0, for (fw_state ==WIFI_STATION_STATE), we check if "ptarget_sta" & "ptarget_wlan" exist. */ -+/* if join_res > 0, for (fw_state ==WIFI_ADHOC_STATE), we only check if "ptarget_wlan" exist. */ -+/* if join_res > 0, update "cur_network->network" from "pnetwork->network" if (ptarget_wlan != NULL). */ -+/* */ -+/* define REJOIN */ -+void rtw_joinbss_event_prehandle(struct adapter *adapter, u8 *pbuf) -+{ -+ static u8 retry = 0; -+ u8 timer_cancelled; -+ struct sta_info *ptarget_sta = NULL, *pcur_sta = NULL; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct wlan_network *pnetwork = (struct wlan_network *)pbuf; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct wlan_network *pcur_wlan = NULL, *ptarget_wlan = NULL; -+ unsigned int the_same_macaddr = false; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("joinbss event call back received with res =%d\n", pnetwork->join_res)); -+ -+ rtw_get_encrypt_decrypt_from_registrypriv(adapter); -+ -+ -+ if (pmlmepriv->assoc_ssid.SsidLength == 0) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("@@@@@ joinbss event call back for Any SSid\n")); -+ } else{ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("@@@@@ rtw_joinbss_event_callback for SSid:%s\n", pmlmepriv->assoc_ssid.Ssid)); -+ } -+ -+ the_same_macaddr = !memcmp(pnetwork->network.MacAddress, cur_network->network.MacAddress, ETH_ALEN); -+ -+ pnetwork->network.Length = get_wlan_bssid_ex_sz(&pnetwork->network); -+ if (pnetwork->network.Length > sizeof(struct wlan_bssid_ex)) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("\n\n ***joinbss_evt_callback return a wrong bss ***\n\n")); -+ return; -+ } -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("\n rtw_joinbss_event_callback !! spin_lock_irqsave\n")); -+ -+ if (pnetwork->join_res > 0) { -+ spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); -+ retry = 0; -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) { -+ /* s1. find ptarget_wlan */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) { -+ if (the_same_macaddr == true) { -+ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); -+ } else{ -+ pcur_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); -+ if (pcur_wlan) -+ pcur_wlan->fixed = false; -+ -+ pcur_sta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); -+ if (pcur_sta) -+ rtw_free_stainfo(adapter, pcur_sta); -+ -+ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->network.MacAddress); -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) { -+ if (ptarget_wlan) -+ ptarget_wlan->fixed = true; -+ } -+ } -+ -+ } else{ -+ ptarget_wlan = _rtw_find_same_network(&pmlmepriv->scanned_queue, pnetwork); -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) { -+ if (ptarget_wlan) -+ ptarget_wlan->fixed = true; -+ } -+ } -+ -+ /* s2. update cur_network */ -+ if (ptarget_wlan) { -+ rtw_joinbss_update_network(adapter, ptarget_wlan, pnetwork); -+ } else{ -+ DBG_871X_LEVEL(_drv_always_, "Can't find ptarget_wlan when joinbss_event callback\n"); -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ goto ignore_joinbss_callback; -+ } -+ -+ -+ /* s3. find ptarget_sta & update ptarget_sta after update cur_network only for station mode */ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) { -+ ptarget_sta = rtw_joinbss_update_stainfo(adapter, pnetwork); -+ if (ptarget_sta == NULL) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("Can't update stainfo when joinbss_event callback\n")); -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ goto ignore_joinbss_callback; -+ } -+ } -+ -+ /* s4. indicate connect */ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) { -+ pmlmepriv->cur_network_scanned = ptarget_wlan; -+ rtw_indicate_connect(adapter); -+ } else{ -+ /* adhoc mode will rtw_indicate_connect when rtw_stassoc_event_callback */ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("adhoc mode, fw_state:%x", get_fwstate(pmlmepriv))); -+ } -+ -+ -+ /* s5. Cancle assoc_timer */ -+ _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("Cancle assoc_timer\n")); -+ -+ } else{ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("rtw_joinbss_event_callback err: fw_state:%x", get_fwstate(pmlmepriv))); -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ goto ignore_joinbss_callback; -+ } -+ -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ -+ } else if (pnetwork->join_res == -4) { -+ rtw_reset_securitypriv(adapter); -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ -+ /* rtw_free_assoc_resources(adapter, 1); */ -+ -+ if ((check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) == true) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("fail! clear _FW_UNDER_LINKING ^^^fw_state =%x\n", get_fwstate(pmlmepriv))); -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ } -+ -+ } else{/* if join_res < 0 (join fails), then try again */ -+ -+ #ifdef REJOIN -+ res = _FAIL; -+ if (retry < 2) { -+ res = rtw_select_and_join_from_scanned_queue(pmlmepriv); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("rtw_select_and_join_from_scanned_queue again! res:%d\n", res)); -+ } -+ -+ if (res == _SUCCESS) { -+ /* extend time of assoc_timer */ -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); -+ retry++; -+ } else if (res == 2) {/* there is no need to wait for join */ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ rtw_indicate_connect(adapter); -+ } else{ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("Set Assoc_Timer = 1; can't find match ssid in scanned_q\n")); -+ #endif -+ -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ /* rtw_free_assoc_resources(adapter, 1); */ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+ #ifdef REJOIN -+ retry = 0; -+ } -+ #endif -+ } -+ -+ignore_joinbss_callback: -+ -+ spin_unlock_bh(&pmlmepriv->lock); -+} -+ -+void rtw_joinbss_event_callback(struct adapter *adapter, u8 *pbuf) -+{ -+ struct wlan_network *pnetwork = (struct wlan_network *)pbuf; -+ -+ mlmeext_joinbss_event_callback(adapter, pnetwork->join_res); -+ -+ rtw_os_xmit_schedule(adapter); -+} -+ -+/* FOR STA, AP , AD-HOC mode */ -+void rtw_sta_media_status_rpt(struct adapter *adapter, struct sta_info *psta, u32 mstatus) -+{ -+ u16 media_status_rpt; -+ -+ if (psta == NULL) -+ return; -+ -+ media_status_rpt = (u16)((psta->mac_id<<8)|mstatus); /* MACID|OPMODE:1 connect */ -+ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_MEDIA_STATUS_RPT, (u8 *)&media_status_rpt); -+} -+ -+void rtw_stassoc_event_callback(struct adapter *adapter, u8 *pbuf) -+{ -+ struct sta_info *psta; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct stassoc_event *pstassoc = (struct stassoc_event *)pbuf; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct wlan_network *ptarget_wlan = NULL; -+ -+ if (rtw_access_ctrl(adapter, pstassoc->macaddr) == false) -+ return; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ psta = rtw_get_stainfo(&adapter->stapriv, pstassoc->macaddr); -+ if (psta) { -+ u8 *passoc_req = NULL; -+ u32 assoc_req_len = 0; -+ -+ rtw_sta_media_status_rpt(adapter, psta, 1); -+ -+#ifndef CONFIG_AUTO_AP_MODE -+ -+ ap_sta_info_defer_update(adapter, psta); -+ -+ /* report to upper layer */ -+ DBG_871X("indicate_sta_assoc_event to upper layer - hostapd\n"); -+ spin_lock_bh(&psta->lock); -+ if (psta->passoc_req && psta->assoc_req_len > 0) { -+ passoc_req = rtw_zmalloc(psta->assoc_req_len); -+ if (passoc_req) { -+ assoc_req_len = psta->assoc_req_len; -+ memcpy(passoc_req, psta->passoc_req, assoc_req_len); -+ -+ kfree(psta->passoc_req); -+ psta->passoc_req = NULL; -+ psta->assoc_req_len = 0; -+ } -+ } -+ spin_unlock_bh(&psta->lock); -+ -+ if (passoc_req && assoc_req_len > 0) { -+ rtw_cfg80211_indicate_sta_assoc(adapter, passoc_req, assoc_req_len); -+ -+ kfree(passoc_req); -+ } -+#endif /* CONFIG_AUTO_AP_MODE */ -+ } -+ return; -+ } -+ -+ /* for AD-HOC mode */ -+ psta = rtw_get_stainfo(&adapter->stapriv, pstassoc->macaddr); -+ if (psta != NULL) { -+ /* the sta have been in sta_info_queue => do nothing */ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("Error: rtw_stassoc_event_callback: sta has been in sta_hash_queue\n")); -+ -+ return; /* between drv has received this event before and fw have not yet to set key to CAM_ENTRY) */ -+ } -+ -+ psta = rtw_alloc_stainfo(&adapter->stapriv, pstassoc->macaddr); -+ if (psta == NULL) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("Can't alloc sta_info when rtw_stassoc_event_callback\n")); -+ return; -+ } -+ -+ /* to do : init sta_info variable */ -+ psta->qos_option = 0; -+ psta->mac_id = (uint)pstassoc->cam_id; -+ /* psta->aid = (uint)pstassoc->cam_id; */ -+ DBG_871X("%s\n", __func__); -+ /* for ad-hoc mode */ -+ rtw_hal_set_odm_var(adapter, HAL_ODM_STA_INFO, psta, true); -+ -+ rtw_sta_media_status_rpt(adapter, psta, 1); -+ -+ if (adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) -+ psta->dot118021XPrivacy = adapter->securitypriv.dot11PrivacyAlgrthm; -+ -+ -+ psta->ieee8021x_blocked = false; -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true)) { -+ if (adapter->stapriv.asoc_sta_count == 2) { -+ spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); -+ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); -+ pmlmepriv->cur_network_scanned = ptarget_wlan; -+ if (ptarget_wlan) -+ ptarget_wlan->fixed = true; -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ /* a sta + bc/mc_stainfo (not Ibss_stainfo) */ -+ rtw_indicate_connect(adapter); -+ } -+ } -+ -+ spin_unlock_bh(&pmlmepriv->lock); -+ -+ -+ mlmeext_sta_add_event_callback(adapter, psta); -+} -+ -+void rtw_stadel_event_callback(struct adapter *adapter, u8 *pbuf) -+{ -+ int mac_id = (-1); -+ struct sta_info *psta; -+ struct wlan_network *pwlan = NULL; -+ struct wlan_bssid_ex *pdev_network = NULL; -+ u8 *pibss = NULL; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct stadel_event *pstadel = (struct stadel_event *)pbuf; -+ struct wlan_network *tgt_network = &(pmlmepriv->cur_network); -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ psta = rtw_get_stainfo(&adapter->stapriv, pstadel->macaddr); -+ if (psta) -+ mac_id = psta->mac_id; -+ else -+ mac_id = pstadel->mac_id; -+ -+ DBG_871X("%s(mac_id =%d) =" MAC_FMT "\n", __func__, mac_id, MAC_ARG(pstadel->macaddr)); -+ -+ if (mac_id >= 0) { -+ u16 media_status; -+ media_status = (mac_id<<8)|0; /* MACID|OPMODE:0 means disconnect */ -+ /* for STA, AP, ADHOC mode, report disconnect stauts to FW */ -+ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_MEDIA_STATUS_RPT, (u8 *)&media_status); -+ } -+ -+ /* if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) */ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ return; -+ -+ -+ mlmeext_sta_del_event_callback(adapter); -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ u16 reason = *((unsigned short *)(pstadel->rsvd)); -+ bool roam = false; -+ struct wlan_network *roam_target = NULL; -+ -+ if (adapter->registrypriv.wifi_spec == 1) { -+ roam = false; -+ } else if (reason == WLAN_REASON_EXPIRATION_CHK && rtw_chk_roam_flags(adapter, RTW_ROAM_ON_EXPIRED)) { -+ roam = true; -+ } else if (reason == WLAN_REASON_ACTIVE_ROAM && rtw_chk_roam_flags(adapter, RTW_ROAM_ACTIVE)) { -+ roam = true; -+ roam_target = pmlmepriv->roam_network; -+ } -+#ifdef CONFIG_INTEL_WIDI -+ else if (adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_CONNECTED) { -+ roam = true; -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ if (roam == true) { -+ if (rtw_to_roam(adapter) > 0) -+ rtw_dec_to_roam(adapter); /* this stadel_event is caused by roaming, decrease to_roam */ -+ else if (rtw_to_roam(adapter) == 0) -+ rtw_set_to_roam(adapter, adapter->registrypriv.max_roaming_times); -+ } else { -+ rtw_set_to_roam(adapter, 0); -+ } -+ -+ rtw_free_uc_swdec_pending_queue(adapter); -+ -+ rtw_free_assoc_resources(adapter, 1); -+ rtw_indicate_disconnect(adapter); -+ -+ spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); -+ /* remove the network entry in scanned_queue */ -+ pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); -+ if (pwlan) { -+ pwlan->fixed = false; -+ rtw_free_network_nolock(adapter, pwlan); -+ } -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ -+#ifdef CONFIG_INTEL_WIDI -+ if (!rtw_to_roam(adapter)) -+ process_intel_widi_disconnect(adapter, 1); -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ _rtw_roaming(adapter, roam_target); -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) || -+ check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { -+ -+ rtw_free_stainfo(adapter, psta); -+ -+ if (adapter->stapriv.asoc_sta_count == 1) {/* a sta + bc/mc_stainfo (not Ibss_stainfo) */ -+ /* rtw_indicate_disconnect(adapter);removed@20091105 */ -+ spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); -+ /* free old ibss network */ -+ /* pwlan = rtw_find_network(&pmlmepriv->scanned_queue, pstadel->macaddr); */ -+ pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); -+ if (pwlan) { -+ pwlan->fixed = false; -+ rtw_free_network_nolock(adapter, pwlan); -+ } -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ /* re-create ibss */ -+ pdev_network = &(adapter->registrypriv.dev_network); -+ pibss = adapter->registrypriv.dev_network.MacAddress; -+ -+ memcpy(pdev_network, &tgt_network->network, get_wlan_bssid_ex_sz(&tgt_network->network)); -+ -+ memset(&pdev_network->Ssid, 0, sizeof(struct ndis_802_11_ssid)); -+ memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(struct ndis_802_11_ssid)); -+ -+ rtw_update_registrypriv_dev_network(adapter); -+ -+ rtw_generate_random_ibss(pibss); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { -+ set_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_STATE); -+ } -+ -+ if (rtw_createbss_cmd(adapter) != _SUCCESS) { -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("***Error =>stadel_event_callback: rtw_createbss_cmd status FAIL***\n ")); -+ -+ } -+ -+ -+ } -+ -+ } -+ -+ spin_unlock_bh(&pmlmepriv->lock); -+} -+ -+void rtw_cpwm_event_callback(struct adapter *padapter, u8 *pbuf) -+{ -+ struct reportpwrstate_parm *preportpwrstate; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("+rtw_cpwm_event_callback !!!\n")); -+ preportpwrstate = (struct reportpwrstate_parm *)pbuf; -+ preportpwrstate->state |= (u8)(adapter_to_pwrctl(padapter)->cpwm_tog + 0x80); -+ cpwm_int_hdl(padapter, preportpwrstate); -+} -+ -+ -+void rtw_wmm_event_callback(struct adapter *padapter, u8 *pbuf) -+{ -+ WMMOnAssocRsp(padapter); -+} -+ -+/* -+* _rtw_join_timeout_handler - Timeout/faliure handler for CMD JoinBss -+* @adapter: pointer to struct adapter structure -+*/ -+void _rtw_join_timeout_handler (struct adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ DBG_871X("%s, fw_state =%x\n", __func__, get_fwstate(pmlmepriv)); -+ -+ if (adapter->bDriverStopped || adapter->bSurpriseRemoved) -+ return; -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ if (rtw_to_roam(adapter) > 0) { /* join timeout caused by roaming */ -+ while (1) { -+ rtw_dec_to_roam(adapter); -+ if (rtw_to_roam(adapter) != 0) { /* try another */ -+ int do_join_r; -+ DBG_871X("%s try another roaming\n", __func__); -+ do_join_r = rtw_do_join(adapter); -+ if (_SUCCESS != do_join_r) { -+ DBG_871X("%s roaming do_join return %d\n", __func__, do_join_r); -+ continue; -+ } -+ break; -+ } else { -+#ifdef CONFIG_INTEL_WIDI -+ if (adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) { -+ memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); -+ intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL, 0); -+ DBG_871X("change to widi listen\n"); -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ DBG_871X("%s We've try roaming but fail\n", __func__); -+ rtw_indicate_disconnect(adapter); -+ break; -+ } -+ } -+ -+ } else{ -+ rtw_indicate_disconnect(adapter); -+ free_scanqueue(pmlmepriv);/* */ -+ -+ /* indicate disconnect for the case that join_timeout and check_fwstate != FW_LINKED */ -+ rtw_cfg80211_indicate_disconnect(adapter); -+ -+ } -+ -+ spin_unlock_bh(&pmlmepriv->lock); -+} -+ -+/* -+* rtw_scan_timeout_handler - Timeout/Faliure handler for CMD SiteSurvey -+* @adapter: pointer to struct adapter structure -+*/ -+void rtw_scan_timeout_handler (struct adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ DBG_871X(FUNC_ADPT_FMT" fw_state =%x\n", FUNC_ADPT_ARG(adapter), get_fwstate(pmlmepriv)); -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ -+ spin_unlock_bh(&pmlmepriv->lock); -+ -+ rtw_indicate_scan_done(adapter, true); -+} -+ -+void rtw_mlme_reset_auto_scan_int(struct adapter *adapter) -+{ -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pmlmeinfo->VHT_enable) /* disable auto scan when connect to 11AC AP */ -+ mlme->auto_scan_int_ms = 0; -+ else if (adapter->registrypriv.wifi_spec && is_client_associated_to_ap(adapter) == true) -+ mlme->auto_scan_int_ms = 60*1000; -+ else if (rtw_chk_roam_flags(adapter, RTW_ROAM_ACTIVE)) { -+ if (check_fwstate(mlme, WIFI_STATION_STATE) && check_fwstate(mlme, _FW_LINKED)) -+ mlme->auto_scan_int_ms = mlme->roam_scan_int_ms; -+ } else -+ mlme->auto_scan_int_ms = 0; /* disabled */ -+ -+ return; -+} -+ -+static void rtw_auto_scan_handler(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ rtw_mlme_reset_auto_scan_int(padapter); -+ -+ if (pmlmepriv->auto_scan_int_ms != 0 -+ && jiffies_to_msecs(jiffies - pmlmepriv->scan_start_time) > pmlmepriv->auto_scan_int_ms) { -+ -+ if (!padapter->registrypriv.wifi_spec) { -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) { -+ DBG_871X(FUNC_ADPT_FMT" _FW_UNDER_SURVEY|_FW_UNDER_LINKING\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == true) { -+ DBG_871X(FUNC_ADPT_FMT" exit BusyTraffic\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ } -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ rtw_set_802_11_bssid_list_scan(padapter, NULL, 0); -+ } -+ -+exit: -+ return; -+} -+ -+void rtw_dynamic_check_timer_handlder(struct adapter *adapter) -+{ -+ if (!adapter) -+ return; -+ -+ if (adapter->hw_init_completed == false) -+ return; -+ -+ if ((adapter->bDriverStopped == true) || (adapter->bSurpriseRemoved == true)) -+ return; -+ -+ if (adapter->net_closed == true) -+ return; -+ -+ if (is_primary_adapter(adapter)) -+ DBG_871X("IsBtDisabled =%d, IsBtControlLps =%d\n", rtw_btcoex_IsBtDisabled(adapter), rtw_btcoex_IsBtControlLps(adapter)); -+ -+ if ((adapter_to_pwrctl(adapter)->bFwCurrentInPSMode == true) -+ && (rtw_btcoex_IsBtControlLps(adapter) == false) -+ ) { -+ u8 bEnterPS; -+ -+ linked_status_chk(adapter); -+ -+ bEnterPS = traffic_status_watchdog(adapter, 1); -+ if (bEnterPS) { -+ /* rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_ENTER, 1); */ -+ rtw_hal_dm_watchdog_in_lps(adapter); -+ } else{ -+ /* call rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1) in traffic_status_watchdog() */ -+ } -+ -+ } else{ -+ if (is_primary_adapter(adapter)) { -+ rtw_dynamic_chk_wk_cmd(adapter); -+ } -+ } -+ -+ /* auto site survey */ -+ rtw_auto_scan_handler(adapter); -+} -+ -+ -+inline bool rtw_is_scan_deny(struct adapter *adapter) -+{ -+ struct mlme_priv *mlmepriv = &adapter->mlmepriv; -+ return (atomic_read(&mlmepriv->set_scan_deny) != 0) ? true : false; -+} -+ -+inline void rtw_clear_scan_deny(struct adapter *adapter) -+{ -+ struct mlme_priv *mlmepriv = &adapter->mlmepriv; -+ atomic_set(&mlmepriv->set_scan_deny, 0); -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+} -+ -+void rtw_set_scan_deny_timer_hdl(struct adapter *adapter) -+{ -+ rtw_clear_scan_deny(adapter); -+} -+ -+void rtw_set_scan_deny(struct adapter *adapter, u32 ms) -+{ -+ struct mlme_priv *mlmepriv = &adapter->mlmepriv; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+ atomic_set(&mlmepriv->set_scan_deny, 1); -+ _set_timer(&mlmepriv->set_scan_deny_timer, ms); -+} -+ -+/* -+* Select a new roaming candidate from the original @param candidate and @param competitor -+* @return true: candidate is updated -+* @return false: candidate is not updated -+*/ -+static int rtw_check_roaming_candidate(struct mlme_priv *mlme -+ , struct wlan_network **candidate, struct wlan_network *competitor) -+{ -+ int updated = false; -+ struct adapter *adapter = container_of(mlme, struct adapter, mlmepriv); -+ -+ if (is_same_ess(&competitor->network, &mlme->cur_network.network) == false) -+ goto exit; -+ -+ if (rtw_is_desired_network(adapter, competitor) == false) -+ goto exit; -+ -+ DBG_871X("roam candidate:%s %s("MAC_FMT", ch%3u) rssi:%d, age:%5d\n", -+ (competitor == mlme->cur_network_scanned)?"*":" ", -+ competitor->network.Ssid.Ssid, -+ MAC_ARG(competitor->network.MacAddress), -+ competitor->network.Configuration.DSConfig, -+ (int)competitor->network.Rssi, -+ jiffies_to_msecs(jiffies - competitor->last_scanned) -+ ); -+ -+ /* got specific addr to roam */ -+ if (!is_zero_mac_addr(mlme->roam_tgt_addr)) { -+ if (!memcmp(mlme->roam_tgt_addr, competitor->network.MacAddress, ETH_ALEN)) -+ goto update; -+ else -+ goto exit; -+ } -+ if (jiffies_to_msecs(jiffies - competitor->last_scanned) >= mlme->roam_scanr_exp_ms) -+ goto exit; -+ -+ if (competitor->network.Rssi - mlme->cur_network_scanned->network.Rssi < mlme->roam_rssi_diff_th) -+ goto exit; -+ -+ if (*candidate != NULL && (*candidate)->network.Rssi >= competitor->network.Rssi) -+ goto exit; -+ -+update: -+ *candidate = competitor; -+ updated = true; -+ -+exit: -+ return updated; -+} -+ -+int rtw_select_roaming_candidate(struct mlme_priv *mlme) -+{ -+ int ret = _FAIL; -+ struct list_head *phead; -+ struct adapter *adapter; -+ struct __queue *queue = &(mlme->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ struct wlan_network *candidate = NULL; -+ -+ if (mlme->cur_network_scanned == NULL) { -+ rtw_warn_on(1); -+ return ret; -+ } -+ -+ spin_lock_bh(&(mlme->scanned_queue.lock)); -+ phead = get_list_head(queue); -+ adapter = (struct adapter *)mlme->nic_hdl; -+ -+ mlme->pscanned = get_next(phead); -+ -+ while (phead != mlme->pscanned) { -+ -+ pnetwork = LIST_CONTAINOR(mlme->pscanned, struct wlan_network, list); -+ if (pnetwork == NULL) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("%s return _FAIL:(pnetwork == NULL)\n", __func__)); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ mlme->pscanned = get_next(mlme->pscanned); -+ -+ DBG_871X("%s("MAC_FMT", ch%u) rssi:%d\n" -+ , pnetwork->network.Ssid.Ssid -+ , MAC_ARG(pnetwork->network.MacAddress) -+ , pnetwork->network.Configuration.DSConfig -+ , (int)pnetwork->network.Rssi); -+ -+ rtw_check_roaming_candidate(mlme, &candidate, pnetwork); -+ -+ } -+ -+ if (candidate == NULL) { -+ DBG_871X("%s: return _FAIL(candidate == NULL)\n", __func__); -+ ret = _FAIL; -+ goto exit; -+ } else { -+ DBG_871X("%s: candidate: %s("MAC_FMT", ch:%u)\n", __func__, -+ candidate->network.Ssid.Ssid, MAC_ARG(candidate->network.MacAddress), -+ candidate->network.Configuration.DSConfig); -+ -+ mlme->roam_network = candidate; -+ -+ if (!memcmp(candidate->network.MacAddress, mlme->roam_tgt_addr, ETH_ALEN)) -+ memset(mlme->roam_tgt_addr, 0, ETH_ALEN); -+ } -+ -+ ret = _SUCCESS; -+exit: -+ spin_unlock_bh(&(mlme->scanned_queue.lock)); -+ -+ return ret; -+} -+ -+/* -+* Select a new join candidate from the original @param candidate and @param competitor -+* @return true: candidate is updated -+* @return false: candidate is not updated -+*/ -+static int rtw_check_join_candidate(struct mlme_priv *mlme -+ , struct wlan_network **candidate, struct wlan_network *competitor) -+{ -+ int updated = false; -+ struct adapter *adapter = container_of(mlme, struct adapter, mlmepriv); -+ -+ -+ /* check bssid, if needed */ -+ if (mlme->assoc_by_bssid == true) { -+ if (memcmp(competitor->network.MacAddress, mlme->assoc_bssid, ETH_ALEN)) -+ goto exit; -+ } -+ -+ /* check ssid, if needed */ -+ if (mlme->assoc_ssid.Ssid[0] && mlme->assoc_ssid.SsidLength) { -+ if (competitor->network.Ssid.SsidLength != mlme->assoc_ssid.SsidLength -+ || memcmp(competitor->network.Ssid.Ssid, mlme->assoc_ssid.Ssid, mlme->assoc_ssid.SsidLength) -+ ) -+ goto exit; -+ } -+ -+ if (rtw_is_desired_network(adapter, competitor) == false) -+ goto exit; -+ -+ if (rtw_to_roam(adapter) > 0) { -+ if (jiffies_to_msecs(jiffies - competitor->last_scanned) >= mlme->roam_scanr_exp_ms -+ || is_same_ess(&competitor->network, &mlme->cur_network.network) == false -+ ) -+ goto exit; -+ } -+ -+ if (*candidate == NULL || (*candidate)->network.Rssi < competitor->network.Rssi) { -+ *candidate = competitor; -+ updated = true; -+ } -+ -+ if (updated) { -+ DBG_871X("[by_bssid:%u][assoc_ssid:%s]" -+ "[to_roam:%u] " -+ "new candidate: %s("MAC_FMT", ch%u) rssi:%d\n", -+ mlme->assoc_by_bssid, -+ mlme->assoc_ssid.Ssid, -+ rtw_to_roam(adapter), -+ (*candidate)->network.Ssid.Ssid, -+ MAC_ARG((*candidate)->network.MacAddress), -+ (*candidate)->network.Configuration.DSConfig, -+ (int)(*candidate)->network.Rssi -+ ); -+ } -+ -+exit: -+ return updated; -+} -+ -+/* -+Calling context: -+The caller of the sub-routine will be in critical section... -+ -+The caller must hold the following spinlock -+ -+pmlmepriv->lock -+ -+ -+*/ -+ -+int rtw_select_and_join_from_scanned_queue(struct mlme_priv *pmlmepriv) -+{ -+ int ret; -+ struct list_head *phead; -+ struct adapter *adapter; -+ struct __queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ struct wlan_network *candidate = NULL; -+ -+ adapter = (struct adapter *)pmlmepriv->nic_hdl; -+ -+ spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); -+ -+ if (pmlmepriv->roam_network) { -+ candidate = pmlmepriv->roam_network; -+ pmlmepriv->roam_network = NULL; -+ goto candidate_exist; -+ } -+ -+ phead = get_list_head(queue); -+ pmlmepriv->pscanned = get_next(phead); -+ -+ while (phead != pmlmepriv->pscanned) { -+ -+ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); -+ if (pnetwork == NULL) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("%s return _FAIL:(pnetwork == NULL)\n", __func__)); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); -+ -+ DBG_871X("%s("MAC_FMT", ch%u) rssi:%d\n" -+ , pnetwork->network.Ssid.Ssid -+ , MAC_ARG(pnetwork->network.MacAddress) -+ , pnetwork->network.Configuration.DSConfig -+ , (int)pnetwork->network.Rssi); -+ -+ rtw_check_join_candidate(pmlmepriv, &candidate, pnetwork); -+ -+ } -+ -+ if (candidate == NULL) { -+ DBG_871X("%s: return _FAIL(candidate == NULL)\n", __func__); -+#ifdef CONFIG_WOWLAN -+ _clr_fwstate_(pmlmepriv, _FW_LINKED|_FW_UNDER_LINKING); -+#endif -+ ret = _FAIL; -+ goto exit; -+ } else { -+ DBG_871X("%s: candidate: %s("MAC_FMT", ch:%u)\n", __func__, -+ candidate->network.Ssid.Ssid, MAC_ARG(candidate->network.MacAddress), -+ candidate->network.Configuration.DSConfig); -+ goto candidate_exist; -+ } -+ -+candidate_exist: -+ -+ /* check for situation of _FW_LINKED */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { -+ DBG_871X("%s: _FW_LINKED while ask_for_joinbss!!!\n", __func__); -+ -+ rtw_disassoc_cmd(adapter, 0, true); -+ rtw_indicate_disconnect(adapter); -+ rtw_free_assoc_resources(adapter, 0); -+ } -+ -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ ret = rtw_joinbss_cmd(adapter, candidate); -+ -+exit: -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ return ret; -+} -+ -+sint rtw_set_auth(struct adapter *adapter, struct security_priv *psecuritypriv) -+{ -+ struct cmd_obj *pcmd; -+ struct setauth_parm *psetauthparm; -+ struct cmd_priv *pcmdpriv = &(adapter->cmdpriv); -+ sint res = _SUCCESS; -+ -+ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd == NULL) { -+ res = _FAIL; /* try again */ -+ goto exit; -+ } -+ -+ psetauthparm = (struct setauth_parm *)rtw_zmalloc(sizeof(struct setauth_parm)); -+ if (psetauthparm == NULL) { -+ kfree((unsigned char *)pcmd); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ memset(psetauthparm, 0, sizeof(struct setauth_parm)); -+ psetauthparm->mode = (unsigned char)psecuritypriv->dot11AuthAlgrthm; -+ -+ pcmd->cmdcode = _SetAuth_CMD_; -+ pcmd->parmbuf = (unsigned char *)psetauthparm; -+ pcmd->cmdsz = (sizeof(struct setauth_parm)); -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ -+ INIT_LIST_HEAD(&pcmd->list); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("after enqueue set_auth_cmd, auth_mode =%x\n", psecuritypriv->dot11AuthAlgrthm)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ return res; -+} -+ -+sint rtw_set_key(struct adapter *adapter, struct security_priv *psecuritypriv, sint keyid, u8 set_tx, bool enqueue) -+{ -+ u8 keylen; -+ struct cmd_obj *pcmd; -+ struct setkey_parm *psetkeyparm; -+ struct cmd_priv *pcmdpriv = &(adapter->cmdpriv); -+ sint res = _SUCCESS; -+ -+ psetkeyparm = (struct setkey_parm *)rtw_zmalloc(sizeof(struct setkey_parm)); -+ if (psetkeyparm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ memset(psetkeyparm, 0, sizeof(struct setkey_parm)); -+ -+ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { -+ psetkeyparm->algorithm = (unsigned char)psecuritypriv->dot118021XGrpPrivacy; -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("\n rtw_set_key: psetkeyparm->algorithm =(unsigned char)psecuritypriv->dot118021XGrpPrivacy =%d\n", psetkeyparm->algorithm)); -+ } else { -+ psetkeyparm->algorithm = (u8)psecuritypriv->dot11PrivacyAlgrthm; -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("\n rtw_set_key: psetkeyparm->algorithm =(u8)psecuritypriv->dot11PrivacyAlgrthm =%d\n", psetkeyparm->algorithm)); -+ -+ } -+ psetkeyparm->keyid = (u8)keyid;/* 0~3 */ -+ psetkeyparm->set_tx = set_tx; -+ if (is_wep_enc(psetkeyparm->algorithm)) -+ adapter->securitypriv.key_mask |= BIT(psetkeyparm->keyid); -+ -+ DBG_871X("==> rtw_set_key algorithm(%x), keyid(%x), key_mask(%x)\n", psetkeyparm->algorithm, psetkeyparm->keyid, adapter->securitypriv.key_mask); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("\n rtw_set_key: psetkeyparm->algorithm =%d psetkeyparm->keyid =(u8)keyid =%d\n", psetkeyparm->algorithm, keyid)); -+ -+ switch (psetkeyparm->algorithm) { -+ -+ case _WEP40_: -+ keylen = 5; -+ memcpy(&(psetkeyparm->key[0]), &(psecuritypriv->dot11DefKey[keyid].skey[0]), keylen); -+ break; -+ case _WEP104_: -+ keylen = 13; -+ memcpy(&(psetkeyparm->key[0]), &(psecuritypriv->dot11DefKey[keyid].skey[0]), keylen); -+ break; -+ case _TKIP_: -+ keylen = 16; -+ memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); -+ psetkeyparm->grpkey = 1; -+ break; -+ case _AES_: -+ keylen = 16; -+ memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); -+ psetkeyparm->grpkey = 1; -+ break; -+ default: -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("\n rtw_set_key:psecuritypriv->dot11PrivacyAlgrthm = %x (must be 1 or 2 or 4 or 5)\n", psecuritypriv->dot11PrivacyAlgrthm)); -+ res = _FAIL; -+ kfree((unsigned char *)psetkeyparm); -+ goto exit; -+ } -+ -+ -+ if (enqueue) { -+ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd == NULL) { -+ kfree((unsigned char *)psetkeyparm); -+ res = _FAIL; /* try again */ -+ goto exit; -+ } -+ -+ pcmd->cmdcode = _SetKey_CMD_; -+ pcmd->parmbuf = (u8 *)psetkeyparm; -+ pcmd->cmdsz = (sizeof(struct setkey_parm)); -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ INIT_LIST_HEAD(&pcmd->list); -+ -+ /* sema_init(&(pcmd->cmd_sem), 0); */ -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ } else{ -+ setkey_hdl(adapter, (u8 *)psetkeyparm); -+ kfree((u8 *) psetkeyparm); -+ } -+exit: -+ return res; -+} -+ -+/* adjust IEs for rtw_joinbss_cmd in WMM */ -+int rtw_restruct_wmm_ie(struct adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len, uint initial_out_len) -+{ -+ unsigned int ielength = 0; -+ unsigned int i, j; -+ -+ i = 12; /* after the fixed IE */ -+ while (i < in_len) { -+ ielength = initial_out_len; -+ -+ if (in_ie[i] == 0xDD && in_ie[i+2] == 0x00 && in_ie[i+3] == 0x50 && in_ie[i+4] == 0xF2 && in_ie[i+5] == 0x02 && i+5 < in_len) { /* WMM element ID and OUI */ -+ for (j = i; j < i + 9; j++) { -+ out_ie[ielength] = in_ie[j]; -+ ielength++; -+ } -+ out_ie[initial_out_len + 1] = 0x07; -+ out_ie[initial_out_len + 6] = 0x00; -+ out_ie[initial_out_len + 8] = 0x00; -+ -+ break; -+ } -+ -+ i += (in_ie[i+1]+2); /* to the next IE element */ -+ } -+ -+ return ielength; -+ -+} -+ -+ -+/* */ -+/* Ported from 8185: IsInPreAuthKeyList(). (Renamed from SecIsInPreAuthKeyList(), 2006-10-13.) */ -+/* Added by Annie, 2006-05-07. */ -+/* */ -+/* Search by BSSID, */ -+/* Return Value: */ -+/* -1 :if there is no pre-auth key in the table */ -+/* >= 0 :if there is pre-auth key, and return the entry id */ -+/* */ -+/* */ -+ -+static int SecIsInPMKIDList(struct adapter *Adapter, u8 *bssid) -+{ -+ struct security_priv *psecuritypriv = &Adapter->securitypriv; -+ int i = 0; -+ -+ do { -+ if ((psecuritypriv->PMKIDList[i].bUsed) && -+ (!memcmp(psecuritypriv->PMKIDList[i].Bssid, bssid, ETH_ALEN))) { -+ break; -+ } else{ -+ i++; -+ /* continue; */ -+ } -+ -+ } while (i < NUM_PMKID_CACHE); -+ -+ if (i == NUM_PMKID_CACHE) { -+ i = -1;/* Could not find. */ -+ } else { -+ /* There is one Pre-Authentication Key for the specific BSSID. */ -+ } -+ -+ return i; -+ -+} -+ -+/* */ -+/* Check the RSN IE length */ -+/* If the RSN IE length <= 20, the RSN IE didn't include the PMKID information */ -+/* 0-11th element in the array are the fixed IE */ -+/* 12th element in the array is the IE */ -+/* 13th element in the array is the IE length */ -+/* */ -+ -+static int rtw_append_pmkid(struct adapter *Adapter, int iEntry, u8 *ie, uint ie_len) -+{ -+ struct security_priv *psecuritypriv = &Adapter->securitypriv; -+ -+ if (ie[13] <= 20) { -+ /* The RSN IE didn't include the PMK ID, append the PMK information */ -+ ie[ie_len] = 1; -+ ie_len++; -+ ie[ie_len] = 0; /* PMKID count = 0x0100 */ -+ ie_len++; -+ memcpy(&ie[ie_len], &psecuritypriv->PMKIDList[iEntry].PMKID, 16); -+ -+ ie_len += 16; -+ ie[13] += 18;/* PMKID length = 2+16 */ -+ -+ } -+ return ie_len; -+} -+ -+sint rtw_restruct_sec_ie(struct adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len) -+{ -+ u8 authmode = 0x0; -+ uint ielength; -+ int iEntry; -+ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ uint ndisauthmode = psecuritypriv->ndisauthtype; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, -+ ("+rtw_restruct_sec_ie: ndisauthmode =%d ndissecuritytype =%d\n", -+ ndisauthmode, ndissecuritytype)); -+ -+ /* copy fixed ie only */ -+ memcpy(out_ie, in_ie, 12); -+ ielength = 12; -+ if ((ndisauthmode == Ndis802_11AuthModeWPA) || (ndisauthmode == Ndis802_11AuthModeWPAPSK)) -+ authmode = _WPA_IE_ID_; -+ if ((ndisauthmode == Ndis802_11AuthModeWPA2) || (ndisauthmode == Ndis802_11AuthModeWPA2PSK)) -+ authmode = _WPA2_IE_ID_; -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { -+ memcpy(out_ie+ielength, psecuritypriv->wps_ie, psecuritypriv->wps_ie_len); -+ -+ ielength += psecuritypriv->wps_ie_len; -+ } else if ((authmode == _WPA_IE_ID_) || (authmode == _WPA2_IE_ID_)) { -+ /* copy RSN or SSN */ -+ memcpy(&out_ie[ielength], &psecuritypriv->supplicant_ie[0], psecuritypriv->supplicant_ie[1]+2); -+ /* debug for CONFIG_IEEE80211W -+ { -+ int jj; -+ printk("supplicant_ie_length =%d &&&&&&&&&&&&&&&&&&&\n", psecuritypriv->supplicant_ie[1]+2); -+ for (jj = 0; jj < psecuritypriv->supplicant_ie[1]+2; jj++) -+ printk(" %02x ", psecuritypriv->supplicant_ie[jj]); -+ printk("\n"); -+ }*/ -+ ielength += psecuritypriv->supplicant_ie[1]+2; -+ rtw_report_sec_ie(adapter, authmode, psecuritypriv->supplicant_ie); -+ } -+ -+ iEntry = SecIsInPMKIDList(adapter, pmlmepriv->assoc_bssid); -+ if (iEntry < 0) { -+ return ielength; -+ } else{ -+ if (authmode == _WPA2_IE_ID_) -+ ielength = rtw_append_pmkid(adapter, iEntry, out_ie, ielength); -+ } -+ return ielength; -+} -+ -+void rtw_init_registrypriv_dev_network(struct adapter *adapter) -+{ -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ struct eeprom_priv *peepriv = &adapter->eeprompriv; -+ struct wlan_bssid_ex *pdev_network = &pregistrypriv->dev_network; -+ u8 *myhwaddr = myid(peepriv); -+ -+ memcpy(pdev_network->MacAddress, myhwaddr, ETH_ALEN); -+ -+ memcpy(&pdev_network->Ssid, &pregistrypriv->ssid, sizeof(struct ndis_802_11_ssid)); -+ -+ pdev_network->Configuration.Length = sizeof(struct ndis_802_11_conf); -+ pdev_network->Configuration.BeaconPeriod = 100; -+ pdev_network->Configuration.FHConfig.Length = 0; -+ pdev_network->Configuration.FHConfig.HopPattern = 0; -+ pdev_network->Configuration.FHConfig.HopSet = 0; -+ pdev_network->Configuration.FHConfig.DwellTime = 0; -+} -+ -+void rtw_update_registrypriv_dev_network(struct adapter *adapter) -+{ -+ int sz = 0; -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ struct wlan_bssid_ex *pdev_network = &pregistrypriv->dev_network; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct wlan_network *cur_network = &adapter->mlmepriv.cur_network; -+ /* struct xmit_priv *pxmitpriv = &adapter->xmitpriv; */ -+ -+ pdev_network->Privacy = (psecuritypriv->dot11PrivacyAlgrthm > 0 ? 1 : 0) ; /* adhoc no 802.1x */ -+ -+ pdev_network->Rssi = 0; -+ -+ switch (pregistrypriv->wireless_mode) { -+ case WIRELESS_11B: -+ pdev_network->NetworkTypeInUse = (Ndis802_11DS); -+ break; -+ case WIRELESS_11G: -+ case WIRELESS_11BG: -+ case WIRELESS_11_24N: -+ case WIRELESS_11G_24N: -+ case WIRELESS_11BG_24N: -+ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM24); -+ break; -+ case WIRELESS_11A: -+ case WIRELESS_11A_5N: -+ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM5); -+ break; -+ case WIRELESS_11ABGN: -+ if (pregistrypriv->channel > 14) -+ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM5); -+ else -+ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM24); -+ break; -+ default: -+ /* TODO */ -+ break; -+ } -+ -+ pdev_network->Configuration.DSConfig = (pregistrypriv->channel); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("pregistrypriv->channel =%d, pdev_network->Configuration.DSConfig = 0x%x\n", pregistrypriv->channel, pdev_network->Configuration.DSConfig)); -+ -+ if (cur_network->network.InfrastructureMode == Ndis802_11IBSS) -+ pdev_network->Configuration.ATIMWindow = (0); -+ -+ pdev_network->InfrastructureMode = (cur_network->network.InfrastructureMode); -+ -+ /* 1. Supported rates */ -+ /* 2. IE */ -+ -+ /* rtw_set_supported_rate(pdev_network->SupportedRates, pregistrypriv->wireless_mode) ; will be called in rtw_generate_ie */ -+ sz = rtw_generate_ie(pregistrypriv); -+ -+ pdev_network->IELength = sz; -+ -+ pdev_network->Length = get_wlan_bssid_ex_sz((struct wlan_bssid_ex *)pdev_network); -+ -+ /* notes: translate IELength & Length after assign the Length to cmdsz in createbss_cmd(); */ -+ /* pdev_network->IELength = cpu_to_le32(sz); */ -+} -+ -+void rtw_get_encrypt_decrypt_from_registrypriv(struct adapter *adapter) -+{ -+} -+ -+/* the fucntion is at passive_level */ -+void rtw_joinbss_reset(struct adapter *padapter) -+{ -+ u8 threshold; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ -+ /* todo: if you want to do something io/reg/hw setting before join_bss, please add code here */ -+ -+ pmlmepriv->num_FortyMHzIntolerant = 0; -+ -+ pmlmepriv->num_sta_no_ht = 0; -+ -+ phtpriv->ampdu_enable = false;/* reset to disabled */ -+ -+ /* TH = 1 => means that invalidate usb rx aggregation */ -+ /* TH = 0 => means that validate usb rx aggregation, use init value. */ -+ if (phtpriv->ht_option) { -+ if (padapter->registrypriv.wifi_spec == 1) -+ threshold = 1; -+ else -+ threshold = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); -+ } else{ -+ threshold = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); -+ } -+} -+ -+void rtw_ht_use_default_setting(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ bool bHwLDPCSupport = false, bHwSTBCSupport = false; -+ bool bHwSupportBeamformer = false, bHwSupportBeamformee = false; -+ -+ if (pregistrypriv->wifi_spec) -+ phtpriv->bss_coexist = 1; -+ else -+ phtpriv->bss_coexist = 0; -+ -+ phtpriv->sgi_40m = TEST_FLAG(pregistrypriv->short_gi, BIT1) ? true : false; -+ phtpriv->sgi_20m = TEST_FLAG(pregistrypriv->short_gi, BIT0) ? true : false; -+ -+ /* LDPC support */ -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_LDPC, (u8 *)&bHwLDPCSupport); -+ CLEAR_FLAGS(phtpriv->ldpc_cap); -+ if (bHwLDPCSupport) { -+ if (TEST_FLAG(pregistrypriv->ldpc_cap, BIT4)) -+ SET_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_RX); -+ } -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_LDPC, (u8 *)&bHwLDPCSupport); -+ if (bHwLDPCSupport) { -+ if (TEST_FLAG(pregistrypriv->ldpc_cap, BIT5)) -+ SET_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX); -+ } -+ if (phtpriv->ldpc_cap) -+ DBG_871X("[HT] Support LDPC = 0x%02X\n", phtpriv->ldpc_cap); -+ -+ /* STBC */ -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_STBC, (u8 *)&bHwSTBCSupport); -+ CLEAR_FLAGS(phtpriv->stbc_cap); -+ if (bHwSTBCSupport) { -+ if (TEST_FLAG(pregistrypriv->stbc_cap, BIT5)) -+ SET_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX); -+ } -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_STBC, (u8 *)&bHwSTBCSupport); -+ if (bHwSTBCSupport) { -+ if (TEST_FLAG(pregistrypriv->stbc_cap, BIT4)) -+ SET_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX); -+ } -+ if (phtpriv->stbc_cap) -+ DBG_871X("[HT] Support STBC = 0x%02X\n", phtpriv->stbc_cap); -+ -+ /* Beamforming setting */ -+ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMER, (u8 *)&bHwSupportBeamformer); -+ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMEE, (u8 *)&bHwSupportBeamformee); -+ CLEAR_FLAGS(phtpriv->beamform_cap); -+ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT4) && bHwSupportBeamformer) { -+ SET_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); -+ DBG_871X("[HT] Support Beamformer\n"); -+ } -+ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT5) && bHwSupportBeamformee) { -+ SET_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); -+ DBG_871X("[HT] Support Beamformee\n"); -+ } -+} -+ -+void rtw_build_wmm_ie_ht(struct adapter *padapter, u8 *out_ie, uint *pout_len) -+{ -+ unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01, 0x00}; -+ int out_len; -+ u8 *pframe; -+ -+ if (padapter->mlmepriv.qospriv.qos_option == 0) { -+ out_len = *pout_len; -+ pframe = rtw_set_ie(out_ie+out_len, _VENDOR_SPECIFIC_IE_, -+ _WMM_IE_Length_, WMM_IE, pout_len); -+ -+ padapter->mlmepriv.qospriv.qos_option = 1; -+ } -+} -+ -+/* the fucntion is >= passive_level */ -+unsigned int rtw_restructure_ht_ie(struct adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len, u8 channel) -+{ -+ u32 ielen, out_len; -+ enum HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor; -+ unsigned char *p, *pframe; -+ struct rtw_ieee80211_ht_cap ht_capie; -+ u8 cbw40_enable = 0, stbc_rx_enable = 0, rf_type = 0, operation_bw = 0; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ phtpriv->ht_option = false; -+ -+ out_len = *pout_len; -+ -+ memset(&ht_capie, 0, sizeof(struct rtw_ieee80211_ht_cap)); -+ -+ ht_capie.cap_info = cpu_to_le16(IEEE80211_HT_CAP_DSSSCCK40); -+ -+ if (phtpriv->sgi_20m) -+ ht_capie.cap_info |= cpu_to_le16(IEEE80211_HT_CAP_SGI_20); -+ -+ /* Get HT BW */ -+ if (in_ie == NULL) { -+ /* TDLS: TODO 20/40 issue */ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ operation_bw = padapter->mlmeextpriv.cur_bwmode; -+ if (operation_bw > CHANNEL_WIDTH_40) -+ operation_bw = CHANNEL_WIDTH_40; -+ } else -+ /* TDLS: TODO 40? */ -+ operation_bw = CHANNEL_WIDTH_40; -+ } else { -+ p = rtw_get_ie(in_ie, _HT_ADD_INFO_IE_, &ielen, in_len); -+ if (p && (ielen == sizeof(struct ieee80211_ht_addt_info))) { -+ struct HT_info_element *pht_info = (struct HT_info_element *)(p+2); -+ if (pht_info->infos[0] & BIT(2)) { -+ switch (pht_info->infos[0] & 0x3) { -+ case 1: -+ case 3: -+ operation_bw = CHANNEL_WIDTH_40; -+ break; -+ default: -+ operation_bw = CHANNEL_WIDTH_20; -+ break; -+ } -+ } else { -+ operation_bw = CHANNEL_WIDTH_20; -+ } -+ } -+ } -+ -+ /* to disable 40M Hz support while gd_bw_40MHz_en = 0 */ -+ if (channel > 14) { -+ if ((pregistrypriv->bw_mode & 0xf0) > 0) -+ cbw40_enable = 1; -+ } else { -+ if ((pregistrypriv->bw_mode & 0x0f) > 0) -+ cbw40_enable = 1; -+ } -+ -+ if ((cbw40_enable == 1) && (operation_bw == CHANNEL_WIDTH_40)) { -+ ht_capie.cap_info |= cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH); -+ if (phtpriv->sgi_40m) -+ ht_capie.cap_info |= cpu_to_le16(IEEE80211_HT_CAP_SGI_40); -+ } -+ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX)) -+ ht_capie.cap_info |= cpu_to_le16(IEEE80211_HT_CAP_TX_STBC); -+ -+ /* todo: disable SM power save mode */ -+ ht_capie.cap_info |= cpu_to_le16(IEEE80211_HT_CAP_SM_PS); -+ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX)) { -+ if ((channel <= 14 && pregistrypriv->rx_stbc == 0x1) || /* enable for 2.4GHz */ -+ (pregistrypriv->wifi_spec == 1)) { -+ stbc_rx_enable = 1; -+ DBG_871X("declare supporting RX STBC\n"); -+ } -+ } -+ -+ /* fill default supported_mcs_set */ -+ memcpy(ht_capie.supp_mcs_set, pmlmeext->default_supported_mcs_set, 16); -+ -+ /* update default supported_mcs_set */ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ switch (rf_type) { -+ case RF_1T1R: -+ if (stbc_rx_enable) -+ ht_capie.cap_info |= cpu_to_le16(IEEE80211_HT_CAP_RX_STBC_1R);/* RX STBC One spatial stream */ -+ -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_1R); -+ break; -+ -+ case RF_2T2R: -+ case RF_1T2R: -+ default: -+ if (stbc_rx_enable) -+ ht_capie.cap_info |= cpu_to_le16(IEEE80211_HT_CAP_RX_STBC_2R);/* RX STBC two spatial stream */ -+ -+ #ifdef CONFIG_DISABLE_MCS13TO15 -+ if (((cbw40_enable == 1) && (operation_bw == CHANNEL_WIDTH_40)) && (pregistrypriv->wifi_spec != 1)) -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R_13TO15_OFF); -+ else -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R); -+ #else /* CONFIG_DISABLE_MCS13TO15 */ -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R); -+ #endif /* CONFIG_DISABLE_MCS13TO15 */ -+ break; -+ } -+ -+ { -+ u32 rx_packet_offset, max_recvbuf_sz; -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_PACKET_OFFSET, &rx_packet_offset); -+ rtw_hal_get_def_var(padapter, HAL_DEF_MAX_RECVBUF_SZ, &max_recvbuf_sz); -+ } -+ -+ if (padapter->driver_rx_ampdu_factor != 0xFF) -+ max_rx_ampdu_factor = -+ (enum HT_CAP_AMPDU_FACTOR)padapter->driver_rx_ampdu_factor; -+ else -+ rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, -+ &max_rx_ampdu_factor); -+ -+ /* rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); */ -+ ht_capie.ampdu_params_info = (max_rx_ampdu_factor&0x03); -+ -+ if (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) -+ ht_capie.ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&(0x07<<2)); -+ else -+ ht_capie.ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&0x00); -+ -+ pframe = rtw_set_ie(out_ie+out_len, _HT_CAPABILITY_IE_, -+ sizeof(struct rtw_ieee80211_ht_cap), (unsigned char *)&ht_capie, pout_len); -+ -+ phtpriv->ht_option = true; -+ -+ if (in_ie != NULL) { -+ p = rtw_get_ie(in_ie, _HT_ADD_INFO_IE_, &ielen, in_len); -+ if (p && (ielen == sizeof(struct ieee80211_ht_addt_info))) { -+ out_len = *pout_len; -+ pframe = rtw_set_ie(out_ie+out_len, _HT_ADD_INFO_IE_, ielen, p+2, pout_len); -+ } -+ } -+ -+ return phtpriv->ht_option; -+ -+} -+ -+/* the fucntion is > passive_level (in critical_section) */ -+void rtw_update_ht_cap(struct adapter *padapter, u8 *pie, uint ie_len, u8 channel) -+{ -+ u8 *p, max_ampdu_sz; -+ int len; -+ /* struct sta_info *bmc_sta, *psta; */ -+ struct rtw_ieee80211_ht_cap *pht_capie; -+ struct ieee80211_ht_addt_info *pht_addtinfo; -+ /* struct recv_reorder_ctrl *preorder_ctrl; */ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ /* struct recv_priv *precvpriv = &padapter->recvpriv; */ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ /* struct wlan_network *pcur_network = &(pmlmepriv->cur_network);; */ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 cbw40_enable = 0; -+ -+ -+ if (!phtpriv->ht_option) -+ return; -+ -+ if ((!pmlmeinfo->HT_info_enable) || (!pmlmeinfo->HT_caps_enable)) -+ return; -+ -+ DBG_871X("+rtw_update_ht_cap()\n"); -+ -+ /* maybe needs check if ap supports rx ampdu. */ -+ if ((phtpriv->ampdu_enable == false) && (pregistrypriv->ampdu_enable == 1)) { -+ if (pregistrypriv->wifi_spec == 1) { -+ /* remove this part because testbed AP should disable RX AMPDU */ -+ /* phtpriv->ampdu_enable = false; */ -+ phtpriv->ampdu_enable = true; -+ } else { -+ phtpriv->ampdu_enable = true; -+ } -+ } else if (pregistrypriv->ampdu_enable == 2) { -+ /* remove this part because testbed AP should disable RX AMPDU */ -+ /* phtpriv->ampdu_enable = true; */ -+ } -+ -+ -+ /* check Max Rx A-MPDU Size */ -+ len = 0; -+ p = rtw_get_ie(pie+sizeof(struct ndis_802_11_fix_ie), _HT_CAPABILITY_IE_, &len, ie_len-sizeof(struct ndis_802_11_fix_ie)); -+ if (p && len > 0) { -+ pht_capie = (struct rtw_ieee80211_ht_cap *)(p+2); -+ max_ampdu_sz = (pht_capie->ampdu_params_info & IEEE80211_HT_CAP_AMPDU_FACTOR); -+ max_ampdu_sz = 1 << (max_ampdu_sz+3); /* max_ampdu_sz (kbytes); */ -+ -+ /* DBG_871X("rtw_update_ht_cap(): max_ampdu_sz =%d\n", max_ampdu_sz); */ -+ phtpriv->rx_ampdu_maxlen = max_ampdu_sz; -+ -+ } -+ -+ -+ len = 0; -+ p = rtw_get_ie(pie+sizeof(struct ndis_802_11_fix_ie), _HT_ADD_INFO_IE_, &len, ie_len-sizeof(struct ndis_802_11_fix_ie)); -+ if (p && len > 0) { -+ pht_addtinfo = (struct ieee80211_ht_addt_info *)(p+2); -+ /* todo: */ -+ } -+ -+ if (channel > 14) { -+ if ((pregistrypriv->bw_mode & 0xf0) > 0) -+ cbw40_enable = 1; -+ } else { -+ if ((pregistrypriv->bw_mode & 0x0f) > 0) -+ cbw40_enable = 1; -+ } -+ -+ /* update cur_bwmode & cur_ch_offset */ -+ if ((cbw40_enable) && -+ (le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info) & -+ BIT(1)) && (pmlmeinfo->HT_info.infos[0] & BIT(2))) { -+ int i; -+ u8 rf_type; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ /* update the MCS set */ -+ for (i = 0; i < 16; i++) -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= pmlmeext->default_supported_mcs_set[i]; -+ -+ /* update the MCS rates */ -+ switch (rf_type) { -+ case RF_1T1R: -+ case RF_1T2R: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_1R); -+ break; -+ case RF_2T2R: -+ default: -+#ifdef CONFIG_DISABLE_MCS13TO15 -+ if (pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && pregistrypriv->wifi_spec != 1) -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R_13TO15_OFF); -+ else -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+#else /* CONFIG_DISABLE_MCS13TO15 */ -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+#endif /* CONFIG_DISABLE_MCS13TO15 */ -+ } -+ -+ /* switch to the 40M Hz mode accoring to the AP */ -+ /* pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; */ -+ switch ((pmlmeinfo->HT_info.infos[0] & 0x3)) { -+ case EXTCHNL_OFFSET_UPPER: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case EXTCHNL_OFFSET_LOWER: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ } -+ -+ /* */ -+ /* Config SM Power Save setting */ -+ /* */ -+ pmlmeinfo->SM_PS = -+ (le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info) & -+ 0x0C) >> 2; -+ if (pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC) -+ DBG_871X("%s(): WLAN_HT_CAP_SM_PS_STATIC\n", __func__); -+ -+ /* */ -+ /* Config current HT Protection mode. */ -+ /* */ -+ pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; -+} -+ -+void rtw_issue_addbareq_cmd(struct adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ u8 issued; -+ int priority; -+ struct sta_info *psta = NULL; -+ struct ht_priv *phtpriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ s32 bmcst = IS_MCAST(pattrib->ra); -+ -+ /* if (bmcst || (padapter->mlmepriv.LinkDetectInfo.bTxBusyTraffic == false)) */ -+ if (bmcst || (padapter->mlmepriv.LinkDetectInfo.NumTxOkInPeriod < 100)) -+ return; -+ -+ priority = pattrib->priority; -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if (pattrib->psta != psta) { -+ DBG_871X("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return; -+ } -+ -+ if (psta == NULL) { -+ DBG_871X("%s, psta ==NUL\n", __func__); -+ return; -+ } -+ -+ if (!(psta->state & _FW_LINKED)) { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return; -+ } -+ -+ -+ phtpriv = &psta->htpriv; -+ -+ if ((phtpriv->ht_option == true) && (phtpriv->ampdu_enable == true)) { -+ issued = (phtpriv->agg_enable_bitmap>>priority)&0x1; -+ issued |= (phtpriv->candidate_tid_bitmap>>priority)&0x1; -+ -+ if (0 == issued) { -+ DBG_871X("rtw_issue_addbareq_cmd, p =%d\n", priority); -+ psta->htpriv.candidate_tid_bitmap |= BIT((u8)priority); -+ rtw_addbareq_cmd(padapter, (u8) priority, pattrib->ra); -+ } -+ } -+ -+} -+ -+void rtw_append_exented_cap(struct adapter *padapter, u8 *out_ie, uint *pout_len) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ u8 cap_content[8] = {0}; -+ u8 *pframe; -+ -+ -+ if (phtpriv->bss_coexist) { -+ SET_EXT_CAPABILITY_ELE_BSS_COEXIST(cap_content, 1); -+ } -+ -+ pframe = rtw_set_ie(out_ie + *pout_len, EID_EXTCapability, 8, cap_content, pout_len); -+} -+ -+inline void rtw_set_to_roam(struct adapter *adapter, u8 to_roam) -+{ -+ if (to_roam == 0) -+ adapter->mlmepriv.to_join = false; -+ adapter->mlmepriv.to_roam = to_roam; -+} -+ -+inline u8 rtw_dec_to_roam(struct adapter *adapter) -+{ -+ adapter->mlmepriv.to_roam--; -+ return adapter->mlmepriv.to_roam; -+} -+ -+inline u8 rtw_to_roam(struct adapter *adapter) -+{ -+ return adapter->mlmepriv.to_roam; -+} -+ -+void rtw_roaming(struct adapter *padapter, struct wlan_network *tgt_network) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ _rtw_roaming(padapter, tgt_network); -+ spin_unlock_bh(&pmlmepriv->lock); -+} -+void _rtw_roaming(struct adapter *padapter, struct wlan_network *tgt_network) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ int do_join_r; -+ -+ if (0 < rtw_to_roam(padapter)) { -+ DBG_871X("roaming from %s("MAC_FMT"), length:%d\n", -+ cur_network->network.Ssid.Ssid, MAC_ARG(cur_network->network.MacAddress), -+ cur_network->network.Ssid.SsidLength); -+ memcpy(&pmlmepriv->assoc_ssid, &cur_network->network.Ssid, sizeof(struct ndis_802_11_ssid)); -+ -+ pmlmepriv->assoc_by_bssid = false; -+ -+ while (1) { -+ do_join_r = rtw_do_join(padapter); -+ if (_SUCCESS == do_join_r) { -+ break; -+ } else { -+ DBG_871X("roaming do_join return %d\n", do_join_r); -+ rtw_dec_to_roam(padapter); -+ -+ if (rtw_to_roam(padapter) > 0) { -+ continue; -+ } else { -+ DBG_871X("%s(%d) -to roaming fail, indicate_disconnect\n", __func__, __LINE__); -+ rtw_indicate_disconnect(padapter); -+ break; -+ } -+ } -+ } -+ } -+ -+} -+ -+sint rtw_linked_check(struct adapter *padapter) -+{ -+ if ((check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == true) || -+ (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE) == true)) { -+ if (padapter->stapriv.asoc_sta_count > 2) -+ return true; -+ } else{ /* Station mode */ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == true) -+ return true; -+ } -+ return false; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_mlme_ext.c linux/3rdparty/rtl8723bs/core/rtw_mlme_ext.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_mlme_ext.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_mlme_ext.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,6940 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_MLME_EXT_C_ -+ -+#include -+#include -+#include -+ -+ -+static struct mlme_handler mlme_sta_tbl[] = { -+ {WIFI_ASSOCREQ, "OnAssocReq", &OnAssocReq}, -+ {WIFI_ASSOCRSP, "OnAssocRsp", &OnAssocRsp}, -+ {WIFI_REASSOCREQ, "OnReAssocReq", &OnAssocReq}, -+ {WIFI_REASSOCRSP, "OnReAssocRsp", &OnAssocRsp}, -+ {WIFI_PROBEREQ, "OnProbeReq", &OnProbeReq}, -+ {WIFI_PROBERSP, "OnProbeRsp", &OnProbeRsp}, -+ -+ /*---------------------------------------------------------- -+ below 2 are reserved -+ -----------------------------------------------------------*/ -+ {0, "DoReserved", &DoReserved}, -+ {0, "DoReserved", &DoReserved}, -+ {WIFI_BEACON, "OnBeacon", &OnBeacon}, -+ {WIFI_ATIM, "OnATIM", &OnAtim}, -+ {WIFI_DISASSOC, "OnDisassoc", &OnDisassoc}, -+ {WIFI_AUTH, "OnAuth", &OnAuthClient}, -+ {WIFI_DEAUTH, "OnDeAuth", &OnDeAuth}, -+ {WIFI_ACTION, "OnAction", &OnAction}, -+ {WIFI_ACTION_NOACK, "OnActionNoAck", &OnAction}, -+}; -+ -+static struct action_handler OnAction_tbl[] = { -+ {RTW_WLAN_CATEGORY_SPECTRUM_MGMT, "ACTION_SPECTRUM_MGMT", on_action_spct}, -+ {RTW_WLAN_CATEGORY_QOS, "ACTION_QOS", &DoReserved}, -+ {RTW_WLAN_CATEGORY_DLS, "ACTION_DLS", &DoReserved}, -+ {RTW_WLAN_CATEGORY_BACK, "ACTION_BACK", &OnAction_back}, -+ {RTW_WLAN_CATEGORY_PUBLIC, "ACTION_PUBLIC", on_action_public}, -+ {RTW_WLAN_CATEGORY_RADIO_MEASUREMENT, "ACTION_RADIO_MEASUREMENT", &DoReserved}, -+ {RTW_WLAN_CATEGORY_FT, "ACTION_FT", &DoReserved}, -+ {RTW_WLAN_CATEGORY_HT, "ACTION_HT", &OnAction_ht}, -+ {RTW_WLAN_CATEGORY_SA_QUERY, "ACTION_SA_QUERY", &OnAction_sa_query}, -+ {RTW_WLAN_CATEGORY_UNPROTECTED_WNM, "ACTION_UNPROTECTED_WNM", &DoReserved}, -+ {RTW_WLAN_CATEGORY_SELF_PROTECTED, "ACTION_SELF_PROTECTED", &DoReserved}, -+ {RTW_WLAN_CATEGORY_WMM, "ACTION_WMM", &DoReserved}, -+ {RTW_WLAN_CATEGORY_VHT, "ACTION_VHT", &DoReserved}, -+ {RTW_WLAN_CATEGORY_P2P, "ACTION_P2P", &DoReserved}, -+}; -+ -+ -+static u8 null_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; -+ -+/************************************************** -+OUI definitions for the vendor specific IE -+***************************************************/ -+unsigned char RTW_WPA_OUI[] = {0x00, 0x50, 0xf2, 0x01}; -+unsigned char WMM_OUI[] = {0x00, 0x50, 0xf2, 0x02}; -+unsigned char WPS_OUI[] = {0x00, 0x50, 0xf2, 0x04}; -+unsigned char P2P_OUI[] = {0x50, 0x6F, 0x9A, 0x09}; -+unsigned char WFD_OUI[] = {0x50, 0x6F, 0x9A, 0x0A}; -+ -+unsigned char WMM_INFO_OUI[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01}; -+unsigned char WMM_PARA_OUI[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; -+ -+static unsigned char REALTEK_96B_IE[] = {0x00, 0xe0, 0x4c, 0x02, 0x01, 0x20}; -+ -+/******************************************************** -+ChannelPlan definitions -+*********************************************************/ -+static RT_CHANNEL_PLAN_2G RTW_ChannelPlan2G[RT_CHANNEL_DOMAIN_2G_MAX] = { -+ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, /* 0x00, RT_CHANNEL_DOMAIN_2G_WORLD , Passive scan CH 12, 13 */ -+ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, /* 0x01, RT_CHANNEL_DOMAIN_2G_ETSI1 */ -+ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11}, 11}, /* 0x02, RT_CHANNEL_DOMAIN_2G_FCC1 */ -+ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14}, /* 0x03, RT_CHANNEL_DOMAIN_2G_MIKK1 */ -+ {{10, 11, 12, 13}, 4}, /* 0x04, RT_CHANNEL_DOMAIN_2G_ETSI2 */ -+ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14}, /* 0x05, RT_CHANNEL_DOMAIN_2G_GLOBAL , Passive scan CH 12, 13, 14 */ -+ {{}, 0}, /* 0x06, RT_CHANNEL_DOMAIN_2G_NULL */ -+}; -+ -+static RT_CHANNEL_PLAN_5G RTW_ChannelPlan5G[RT_CHANNEL_DOMAIN_5G_MAX] = { -+ {{}, 0}, /* 0x00, RT_CHANNEL_DOMAIN_5G_NULL */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 19}, /* 0x01, RT_CHANNEL_DOMAIN_5G_ETSI1 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165}, 24}, /* 0x02, RT_CHANNEL_DOMAIN_5G_ETSI2 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 149, 153, 157, 161, 165}, 22}, /* 0x03, RT_CHANNEL_DOMAIN_5G_ETSI3 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165}, 24}, /* 0x04, RT_CHANNEL_DOMAIN_5G_FCC1 */ -+ {{36, 40, 44, 48, 149, 153, 157, 161, 165}, 9}, /* 0x05, RT_CHANNEL_DOMAIN_5G_FCC2 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165}, 13}, /* 0x06, RT_CHANNEL_DOMAIN_5G_FCC3 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161}, 12}, /* 0x07, RT_CHANNEL_DOMAIN_5G_FCC4 */ -+ {{149, 153, 157, 161, 165}, 5}, /* 0x08, RT_CHANNEL_DOMAIN_5G_FCC5 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64}, 8}, /* 0x09, RT_CHANNEL_DOMAIN_5G_FCC6 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 20}, /* 0x0A, RT_CHANNEL_DOMAIN_5G_FCC7_IC1 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161, 165}, 20}, /* 0x0B, RT_CHANNEL_DOMAIN_5G_KCC1 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 19}, /* 0x0C, RT_CHANNEL_DOMAIN_5G_MKK1 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64}, 8}, /* 0x0D, RT_CHANNEL_DOMAIN_5G_MKK2 */ -+ {{100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 11}, /* 0x0E, RT_CHANNEL_DOMAIN_5G_MKK3 */ -+ {{56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 15}, /* 0x0F, RT_CHANNEL_DOMAIN_5G_NCC1 */ -+ {{56, 60, 64, 149, 153, 157, 161, 165}, 8}, /* 0x10, RT_CHANNEL_DOMAIN_5G_NCC2 */ -+ {{149, 153, 157, 161, 165}, 5}, /* 0x11, RT_CHANNEL_DOMAIN_5G_NCC3 */ -+ {{36, 40, 44, 48}, 4}, /* 0x12, RT_CHANNEL_DOMAIN_5G_ETSI4 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 20}, /* 0x13, RT_CHANNEL_DOMAIN_5G_ETSI5 */ -+ {{149, 153, 157, 161}, 4}, /* 0x14, RT_CHANNEL_DOMAIN_5G_FCC8 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64}, 8}, /* 0x15, RT_CHANNEL_DOMAIN_5G_ETSI6 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165}, 13}, /* 0x16, RT_CHANNEL_DOMAIN_5G_ETSI7 */ -+ {{36, 40, 44, 48, 149, 153, 157, 161, 165}, 9}, /* 0x17, RT_CHANNEL_DOMAIN_5G_ETSI8 */ -+ {{100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 11}, /* 0x18, RT_CHANNEL_DOMAIN_5G_ETSI9 */ -+ {{149, 153, 157, 161, 165}, 5}, /* 0x19, RT_CHANNEL_DOMAIN_5G_ETSI10 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140, 149, 153, 157, 161, 165}, 16}, /* 0x1A, RT_CHANNEL_DOMAIN_5G_ETSI11 */ -+ {{52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165}, 17}, /* 0x1B, RT_CHANNEL_DOMAIN_5G_NCC4 */ -+ {{149, 153, 157, 161}, 4}, /* 0x1C, RT_CHANNEL_DOMAIN_5G_ETSI12 */ -+ {{36, 40, 44, 48, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165}, 17}, /* 0x1D, RT_CHANNEL_DOMAIN_5G_FCC9 */ -+ {{36, 40, 44, 48, 100, 104, 108, 112, 116, 132, 136, 140}, 12}, /* 0x1E, RT_CHANNEL_DOMAIN_5G_ETSI13 */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161}, 20}, /* 0x1F, RT_CHANNEL_DOMAIN_5G_FCC10 */ -+ -+ /* Driver self defined for old channel plan Compatible , Remember to modify if have new channel plan definition ===== */ -+ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165}, 21}, /* 0x20, RT_CHANNEL_DOMAIN_5G_FCC */ -+ {{36, 40, 44, 48}, 4}, /* 0x21, RT_CHANNEL_DOMAIN_5G_JAPAN_NO_DFS */ -+ {{36, 40, 44, 48, 149, 153, 157, 161}, 8}, /* 0x22, RT_CHANNEL_DOMAIN_5G_FCC4_NO_DFS */ -+}; -+ -+static RT_CHANNEL_PLAN_MAP RTW_ChannelPlanMap[RT_CHANNEL_DOMAIN_MAX] = { -+ /* 0x00 ~ 0x1F , Old Define ===== */ -+ {0x02, 0x20}, /* 0x00, RT_CHANNEL_DOMAIN_FCC */ -+ {0x02, 0x0A}, /* 0x01, RT_CHANNEL_DOMAIN_IC */ -+ {0x01, 0x01}, /* 0x02, RT_CHANNEL_DOMAIN_ETSI */ -+ {0x01, 0x00}, /* 0x03, RT_CHANNEL_DOMAIN_SPAIN */ -+ {0x01, 0x00}, /* 0x04, RT_CHANNEL_DOMAIN_FRANCE */ -+ {0x03, 0x00}, /* 0x05, RT_CHANNEL_DOMAIN_MKK */ -+ {0x03, 0x00}, /* 0x06, RT_CHANNEL_DOMAIN_MKK1 */ -+ {0x01, 0x09}, /* 0x07, RT_CHANNEL_DOMAIN_ISRAEL */ -+ {0x03, 0x09}, /* 0x08, RT_CHANNEL_DOMAIN_TELEC */ -+ {0x03, 0x00}, /* 0x09, RT_CHANNEL_DOMAIN_GLOBAL_DOAMIN */ -+ {0x00, 0x00}, /* 0x0A, RT_CHANNEL_DOMAIN_WORLD_WIDE_13 */ -+ {0x02, 0x0F}, /* 0x0B, RT_CHANNEL_DOMAIN_TAIWAN */ -+ {0x01, 0x08}, /* 0x0C, RT_CHANNEL_DOMAIN_CHINA */ -+ {0x02, 0x06}, /* 0x0D, RT_CHANNEL_DOMAIN_SINGAPORE_INDIA_MEXICO */ -+ {0x02, 0x0B}, /* 0x0E, RT_CHANNEL_DOMAIN_KOREA */ -+ {0x02, 0x09}, /* 0x0F, RT_CHANNEL_DOMAIN_TURKEY */ -+ {0x01, 0x01}, /* 0x10, RT_CHANNEL_DOMAIN_JAPAN */ -+ {0x02, 0x05}, /* 0x11, RT_CHANNEL_DOMAIN_FCC_NO_DFS */ -+ {0x01, 0x21}, /* 0x12, RT_CHANNEL_DOMAIN_JAPAN_NO_DFS */ -+ {0x00, 0x04}, /* 0x13, RT_CHANNEL_DOMAIN_WORLD_WIDE_5G */ -+ {0x02, 0x10}, /* 0x14, RT_CHANNEL_DOMAIN_TAIWAN_NO_DFS */ -+ {0x00, 0x21}, /* 0x15, RT_CHANNEL_DOMAIN_ETSI_NO_DFS */ -+ {0x00, 0x22}, /* 0x16, RT_CHANNEL_DOMAIN_KOREA_NO_DFS */ -+ {0x03, 0x21}, /* 0x17, RT_CHANNEL_DOMAIN_JAPAN_NO_DFS */ -+ {0x06, 0x08}, /* 0x18, RT_CHANNEL_DOMAIN_PAKISTAN_NO_DFS */ -+ {0x02, 0x08}, /* 0x19, RT_CHANNEL_DOMAIN_TAIWAN2_NO_DFS */ -+ {0x00, 0x00}, /* 0x1A, */ -+ {0x00, 0x00}, /* 0x1B, */ -+ {0x00, 0x00}, /* 0x1C, */ -+ {0x00, 0x00}, /* 0x1D, */ -+ {0x00, 0x00}, /* 0x1E, */ -+ {0x06, 0x04}, /* 0x1F, RT_CHANNEL_DOMAIN_WORLD_WIDE_ONLY_5G */ -+ /* 0x20 ~ 0x7F , New Define ===== */ -+ {0x00, 0x00}, /* 0x20, RT_CHANNEL_DOMAIN_WORLD_NULL */ -+ {0x01, 0x00}, /* 0x21, RT_CHANNEL_DOMAIN_ETSI1_NULL */ -+ {0x02, 0x00}, /* 0x22, RT_CHANNEL_DOMAIN_FCC1_NULL */ -+ {0x03, 0x00}, /* 0x23, RT_CHANNEL_DOMAIN_MKK1_NULL */ -+ {0x04, 0x00}, /* 0x24, RT_CHANNEL_DOMAIN_ETSI2_NULL */ -+ {0x02, 0x04}, /* 0x25, RT_CHANNEL_DOMAIN_FCC1_FCC1 */ -+ {0x00, 0x01}, /* 0x26, RT_CHANNEL_DOMAIN_WORLD_ETSI1 */ -+ {0x03, 0x0C}, /* 0x27, RT_CHANNEL_DOMAIN_MKK1_MKK1 */ -+ {0x00, 0x0B}, /* 0x28, RT_CHANNEL_DOMAIN_WORLD_KCC1 */ -+ {0x00, 0x05}, /* 0x29, RT_CHANNEL_DOMAIN_WORLD_FCC2 */ -+ {0x00, 0x00}, /* 0x2A, */ -+ {0x00, 0x00}, /* 0x2B, */ -+ {0x00, 0x00}, /* 0x2C, */ -+ {0x00, 0x00}, /* 0x2D, */ -+ {0x00, 0x00}, /* 0x2E, */ -+ {0x00, 0x00}, /* 0x2F, */ -+ {0x00, 0x06}, /* 0x30, RT_CHANNEL_DOMAIN_WORLD_FCC3 */ -+ {0x00, 0x07}, /* 0x31, RT_CHANNEL_DOMAIN_WORLD_FCC4 */ -+ {0x00, 0x08}, /* 0x32, RT_CHANNEL_DOMAIN_WORLD_FCC5 */ -+ {0x00, 0x09}, /* 0x33, RT_CHANNEL_DOMAIN_WORLD_FCC6 */ -+ {0x02, 0x0A}, /* 0x34, RT_CHANNEL_DOMAIN_FCC1_FCC7 */ -+ {0x00, 0x02}, /* 0x35, RT_CHANNEL_DOMAIN_WORLD_ETSI2 */ -+ {0x00, 0x03}, /* 0x36, RT_CHANNEL_DOMAIN_WORLD_ETSI3 */ -+ {0x03, 0x0D}, /* 0x37, RT_CHANNEL_DOMAIN_MKK1_MKK2 */ -+ {0x03, 0x0E}, /* 0x38, RT_CHANNEL_DOMAIN_MKK1_MKK3 */ -+ {0x02, 0x0F}, /* 0x39, RT_CHANNEL_DOMAIN_FCC1_NCC1 */ -+ {0x00, 0x00}, /* 0x3A, */ -+ {0x00, 0x00}, /* 0x3B, */ -+ {0x00, 0x00}, /* 0x3C, */ -+ {0x00, 0x00}, /* 0x3D, */ -+ {0x00, 0x00}, /* 0x3E, */ -+ {0x00, 0x00}, /* 0x3F, */ -+ {0x02, 0x10}, /* 0x40, RT_CHANNEL_DOMAIN_FCC1_NCC2 */ -+ {0x05, 0x00}, /* 0x41, RT_CHANNEL_DOMAIN_GLOBAL_NULL */ -+ {0x01, 0x12}, /* 0x42, RT_CHANNEL_DOMAIN_ETSI1_ETSI4 */ -+ {0x02, 0x05}, /* 0x43, RT_CHANNEL_DOMAIN_FCC1_FCC2 */ -+ {0x02, 0x11}, /* 0x44, RT_CHANNEL_DOMAIN_FCC1_NCC3 */ -+ {0x00, 0x13}, /* 0x45, RT_CHANNEL_DOMAIN_WORLD_ETSI5 */ -+ {0x02, 0x14}, /* 0x46, RT_CHANNEL_DOMAIN_FCC1_FCC8 */ -+ {0x00, 0x15}, /* 0x47, RT_CHANNEL_DOMAIN_WORLD_ETSI6 */ -+ {0x00, 0x16}, /* 0x48, RT_CHANNEL_DOMAIN_WORLD_ETSI7 */ -+ {0x00, 0x17}, /* 0x49, RT_CHANNEL_DOMAIN_WORLD_ETSI8 */ -+ {0x00, 0x18}, /* 0x50, RT_CHANNEL_DOMAIN_WORLD_ETSI9 */ -+ {0x00, 0x19}, /* 0x51, RT_CHANNEL_DOMAIN_WORLD_ETSI10 */ -+ {0x00, 0x1A}, /* 0x52, RT_CHANNEL_DOMAIN_WORLD_ETSI11 */ -+ {0x02, 0x1B}, /* 0x53, RT_CHANNEL_DOMAIN_FCC1_NCC4 */ -+ {0x00, 0x1C}, /* 0x54, RT_CHANNEL_DOMAIN_WORLD_ETSI12 */ -+ {0x02, 0x1D}, /* 0x55, RT_CHANNEL_DOMAIN_FCC1_FCC9 */ -+ {0x00, 0x1E}, /* 0x56, RT_CHANNEL_DOMAIN_WORLD_ETSI13 */ -+ {0x02, 0x1F}, /* 0x57, RT_CHANNEL_DOMAIN_FCC1_FCC10 */ -+}; -+ -+static RT_CHANNEL_PLAN_MAP RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE = {0x03, 0x02}; /* use the conbination for max channel numbers */ -+ -+/* -+ * Search the @param ch in given @param ch_set -+ * @ch_set: the given channel set -+ * @ch: the given channel number -+ * -+ * return the index of channel_num in channel_set, -1 if not found -+ */ -+int rtw_ch_set_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch) -+{ -+ int i; -+ for (i = 0; ch_set[i].ChannelNum != 0; i++) { -+ if (ch == ch_set[i].ChannelNum) -+ break; -+ } -+ -+ if (i >= ch_set[i].ChannelNum) -+ return -1; -+ return i; -+} -+ -+/* -+ * Check the @param ch is fit with setband setting of @param adapter -+ * @adapter: the given adapter -+ * @ch: the given channel number -+ * -+ * return true when check valid, false not valid -+ */ -+bool rtw_mlme_band_check(struct adapter *adapter, const u32 ch) -+{ -+ if (adapter->setband == GHZ24_50 /* 2.4G and 5G */ -+ || (adapter->setband == GHZ_24 && ch < 35) /* 2.4G only */ -+ || (adapter->setband == GHZ_50 && ch > 35) /* 5G only */ -+ ) { -+ return true; -+ } -+ return false; -+} -+ -+/**************************************************************************** -+ -+Following are the initialization functions for WiFi MLME -+ -+*****************************************************************************/ -+ -+int init_hw_mlme_ext(struct adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ return _SUCCESS; -+} -+ -+void init_mlme_default_rate_set(struct adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ unsigned char mixed_datarate[NumRates] = {_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_, _6M_RATE_, _9M_RATE_, _12M_RATE_, _18M_RATE_, _24M_RATE_, _36M_RATE_, _48M_RATE_, _54M_RATE_, 0xff}; -+ unsigned char mixed_basicrate[NumRates] = {_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_, _6M_RATE_, _12M_RATE_, _24M_RATE_, 0xff,}; -+ unsigned char supported_mcs_set[16] = {0xff, 0xff, 0x00, 0x00, 0x01, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; -+ -+ memcpy(pmlmeext->datarate, mixed_datarate, NumRates); -+ memcpy(pmlmeext->basicrate, mixed_basicrate, NumRates); -+ -+ memcpy(pmlmeext->default_supported_mcs_set, supported_mcs_set, sizeof(pmlmeext->default_supported_mcs_set)); -+} -+ -+static void init_mlme_ext_priv_value(struct adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ atomic_set(&pmlmeext->event_seq, 0); -+ pmlmeext->mgnt_seq = 0;/* reset to zero when disconnect at client mode */ -+ pmlmeext->sa_query_seq = 0; -+ pmlmeext->mgnt_80211w_IPN = 0; -+ pmlmeext->mgnt_80211w_IPN_rx = 0; -+ pmlmeext->cur_channel = padapter->registrypriv.channel; -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ pmlmeext->retry = 0; -+ -+ pmlmeext->cur_wireless_mode = padapter->registrypriv.wireless_mode; -+ -+ init_mlme_default_rate_set(padapter); -+ -+ if (pmlmeext->cur_channel > 14) -+ pmlmeext->tx_rate = IEEE80211_OFDM_RATE_6MB; -+ else -+ pmlmeext->tx_rate = IEEE80211_CCK_RATE_1MB; -+ -+ pmlmeext->sitesurvey_res.state = SCAN_DISABLE; -+ pmlmeext->sitesurvey_res.channel_idx = 0; -+ pmlmeext->sitesurvey_res.bss_cnt = 0; -+ pmlmeext->scan_abort = false; -+ -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ pmlmeinfo->reauth_count = 0; -+ pmlmeinfo->reassoc_count = 0; -+ pmlmeinfo->link_count = 0; -+ pmlmeinfo->auth_seq = 0; -+ pmlmeinfo->auth_algo = dot11AuthAlgrthm_Open; -+ pmlmeinfo->key_index = 0; -+ pmlmeinfo->iv = 0; -+ -+ pmlmeinfo->enc_algo = _NO_PRIVACY_; -+ pmlmeinfo->authModeToggle = 0; -+ -+ memset(pmlmeinfo->chg_txt, 0, 128); -+ -+ pmlmeinfo->slotTime = SHORT_SLOT_TIME; -+ pmlmeinfo->preamble_mode = PREAMBLE_AUTO; -+ -+ pmlmeinfo->dialogToken = 0; -+ -+ pmlmeext->action_public_rxseq = 0xffff; -+ pmlmeext->action_public_dialog_token = 0xff; -+} -+ -+static int has_channel(RT_CHANNEL_INFO *channel_set, -+ u8 chanset_size, -+ u8 chan) { -+ int i; -+ -+ for (i = 0; i < chanset_size; i++) { -+ if (channel_set[i].ChannelNum == chan) { -+ return 1; -+ } -+ } -+ -+ return 0; -+} -+ -+static void init_channel_list(struct adapter *padapter, RT_CHANNEL_INFO *channel_set, -+ u8 chanset_size, -+ struct p2p_channels *channel_list) { -+ -+ struct p2p_oper_class_map op_class[] = { -+ { IEEE80211G, 81, 1, 13, 1, BW20 }, -+ { IEEE80211G, 82, 14, 14, 1, BW20 }, -+ { IEEE80211A, 115, 36, 48, 4, BW20 }, -+ { IEEE80211A, 116, 36, 44, 8, BW40PLUS }, -+ { IEEE80211A, 117, 40, 48, 8, BW40MINUS }, -+ { IEEE80211A, 124, 149, 161, 4, BW20 }, -+ { IEEE80211A, 125, 149, 169, 4, BW20 }, -+ { IEEE80211A, 126, 149, 157, 8, BW40PLUS }, -+ { IEEE80211A, 127, 153, 161, 8, BW40MINUS }, -+ { -1, 0, 0, 0, 0, BW20 } -+ }; -+ -+ int cla, op; -+ -+ cla = 0; -+ -+ for (op = 0; op_class[op].op_class; op++) { -+ u8 ch; -+ struct p2p_oper_class_map *o = &op_class[op]; -+ struct p2p_reg_class *reg = NULL; -+ -+ for (ch = o->min_chan; ch <= o->max_chan; ch += o->inc) { -+ if (!has_channel(channel_set, chanset_size, ch)) { -+ continue; -+ } -+ -+ if ((0 == padapter->registrypriv.ht_enable) && (8 == o->inc)) -+ continue; -+ -+ if ((0 < (padapter->registrypriv.bw_mode & 0xf0)) && -+ ((BW40MINUS == o->bw) || (BW40PLUS == o->bw))) -+ continue; -+ -+ if (reg == NULL) { -+ reg = &channel_list->reg_class[cla]; -+ cla++; -+ reg->reg_class = o->op_class; -+ reg->channels = 0; -+ } -+ reg->channel[reg->channels] = ch; -+ reg->channels++; -+ } -+ } -+ channel_list->reg_classes = cla; -+ -+} -+ -+static u8 init_channel_set(struct adapter *padapter, u8 ChannelPlan, RT_CHANNEL_INFO *channel_set) -+{ -+ u8 index, chanset_size = 0; -+ u8 b5GBand = false, b2_4GBand = false; -+ u8 Index2G = 0, Index5G = 0; -+ -+ memset(channel_set, 0, sizeof(RT_CHANNEL_INFO)*MAX_CHANNEL_NUM); -+ -+ if (ChannelPlan >= RT_CHANNEL_DOMAIN_MAX && ChannelPlan != RT_CHANNEL_DOMAIN_REALTEK_DEFINE) { -+ DBG_871X("ChannelPlan ID %x error !!!!!\n", ChannelPlan); -+ return chanset_size; -+ } -+ -+ if (IsSupported24G(padapter->registrypriv.wireless_mode)) { -+ b2_4GBand = true; -+ if (RT_CHANNEL_DOMAIN_REALTEK_DEFINE == ChannelPlan) -+ Index2G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index2G; -+ else -+ Index2G = RTW_ChannelPlanMap[ChannelPlan].Index2G; -+ } -+ -+ if (b2_4GBand) { -+ for (index = 0; index < RTW_ChannelPlan2G[Index2G].Len; index++) { -+ channel_set[chanset_size].ChannelNum = RTW_ChannelPlan2G[Index2G].Channel[index]; -+ -+ if ((RT_CHANNEL_DOMAIN_GLOBAL_DOAMIN == ChannelPlan) ||/* Channel 1~11 is active, and 12~14 is passive */ -+ (RT_CHANNEL_DOMAIN_GLOBAL_NULL == ChannelPlan)) { -+ if (channel_set[chanset_size].ChannelNum >= 1 && channel_set[chanset_size].ChannelNum <= 11) -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ else if ((channel_set[chanset_size].ChannelNum >= 12 && channel_set[chanset_size].ChannelNum <= 14)) -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ } else if (RT_CHANNEL_DOMAIN_WORLD_WIDE_13 == ChannelPlan || -+ RT_CHANNEL_DOMAIN_WORLD_WIDE_5G == ChannelPlan || -+ RT_CHANNEL_DOMAIN_2G_WORLD == Index2G) { /* channel 12~13, passive scan */ -+ if (channel_set[chanset_size].ChannelNum <= 11) -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ else -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ } else -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ -+ chanset_size++; -+ } -+ } -+ -+ if (b5GBand) { -+ for (index = 0; index < RTW_ChannelPlan5G[Index5G].Len; index++) { -+ if (RTW_ChannelPlan5G[Index5G].Channel[index] <= 48 -+ || RTW_ChannelPlan5G[Index5G].Channel[index] >= 149) { -+ channel_set[chanset_size].ChannelNum = RTW_ChannelPlan5G[Index5G].Channel[index]; -+ if (RT_CHANNEL_DOMAIN_WORLD_WIDE_5G == ChannelPlan)/* passive scan for all 5G channels */ -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ else -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ DBG_871X("%s(): channel_set[%d].ChannelNum = %d\n", __func__, chanset_size, channel_set[chanset_size].ChannelNum); -+ chanset_size++; -+ } -+ } -+ } -+ -+ DBG_871X("%s ChannelPlan ID %x Chan num:%d \n", __func__, ChannelPlan, chanset_size); -+ return chanset_size; -+} -+ -+int init_mlme_ext_priv(struct adapter *padapter) -+{ -+ int res = _SUCCESS; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by vzalloc(). */ -+ /* memset((u8 *)pmlmeext, 0, sizeof(struct mlme_ext_priv)); */ -+ -+ pmlmeext->padapter = padapter; -+ -+ /* fill_fwpriv(padapter, &(pmlmeext->fwpriv)); */ -+ -+ init_mlme_ext_priv_value(padapter); -+ pmlmeinfo->bAcceptAddbaReq = pregistrypriv->bAcceptAddbaReq; -+ -+ init_mlme_ext_timer(padapter); -+ -+ init_mlme_ap_info(padapter); -+ -+ pmlmeext->max_chan_nums = init_channel_set(padapter, pmlmepriv->ChannelPlan, pmlmeext->channel_set); -+ init_channel_list(padapter, pmlmeext->channel_set, pmlmeext->max_chan_nums, &pmlmeext->channel_list); -+ pmlmeext->last_scan_time = 0; -+ pmlmeext->chan_scan_time = SURVEY_TO; -+ pmlmeext->mlmeext_init = true; -+ pmlmeext->active_keep_alive_check = true; -+ -+#ifdef DBG_FIXED_CHAN -+ pmlmeext->fixed_chan = 0xFF; -+#endif -+ -+ return res; -+ -+} -+ -+void free_mlme_ext_priv(struct mlme_ext_priv *pmlmeext) -+{ -+ struct adapter *padapter = pmlmeext->padapter; -+ -+ if (!padapter) -+ return; -+ -+ if (padapter->bDriverStopped == true) { -+ del_timer_sync(&pmlmeext->survey_timer); -+ del_timer_sync(&pmlmeext->link_timer); -+ /* del_timer_sync(&pmlmeext->ADDBA_timer); */ -+ } -+} -+ -+static void _mgt_dispatcher(struct adapter *padapter, struct mlme_handler *ptable, union recv_frame *precv_frame) -+{ -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ -+ if (ptable->func) { -+ /* receive the frames that ra(a1) is my address or ra(a1) is bc address. */ -+ if (memcmp(GetAddr1Ptr(pframe), myid(&padapter->eeprompriv), ETH_ALEN) && -+ memcmp(GetAddr1Ptr(pframe), bc_addr, ETH_ALEN)) -+ return; -+ -+ ptable->func(padapter, precv_frame); -+ } -+ -+} -+ -+void mgt_dispatcher(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ int index; -+ struct mlme_handler *ptable; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, GetAddr2Ptr(pframe)); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, -+ ("+mgt_dispatcher: type(0x%x) subtype(0x%x)\n", -+ GetFrameType(pframe), GetFrameSubType(pframe))); -+ -+ if (GetFrameType(pframe) != WIFI_MGT_TYPE) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("mgt_dispatcher: type(0x%x) error!\n", GetFrameType(pframe))); -+ return; -+ } -+ -+ /* receive the frames that ra(a1) is my address or ra(a1) is bc address. */ -+ if (memcmp(GetAddr1Ptr(pframe), myid(&padapter->eeprompriv), ETH_ALEN) && -+ memcmp(GetAddr1Ptr(pframe), bc_addr, ETH_ALEN)) { -+ return; -+ } -+ -+ ptable = mlme_sta_tbl; -+ -+ index = GetFrameSubType(pframe) >> 4; -+ -+ if (index >= (sizeof(mlme_sta_tbl) / sizeof(struct mlme_handler))) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("Currently we do not support reserved sub-fr-type =%d\n", index)); -+ return; -+ } -+ ptable += index; -+ -+ if (psta != NULL) { -+ if (GetRetry(pframe)) { -+ if (precv_frame->u.hdr.attrib.seq_num == psta->RxMgmtFrameSeqNum) { -+ /* drop the duplicate management frame */ -+ pdbgpriv->dbg_rx_dup_mgt_frame_drop_count++; -+ DBG_871X("Drop duplicate management frame with seq_num = %d.\n", precv_frame->u.hdr.attrib.seq_num); -+ return; -+ } -+ } -+ psta->RxMgmtFrameSeqNum = precv_frame->u.hdr.attrib.seq_num; -+ } -+ -+ switch (GetFrameSubType(pframe)) { -+ case WIFI_AUTH: -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ ptable->func = &OnAuth; -+ else -+ ptable->func = &OnAuthClient; -+ /* pass through */ -+ case WIFI_ASSOCREQ: -+ case WIFI_REASSOCREQ: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ break; -+ case WIFI_PROBEREQ: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ break; -+ case WIFI_BEACON: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ break; -+ case WIFI_ACTION: -+ /* if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) */ -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ break; -+ default: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ break; -+ } -+} -+ -+/**************************************************************************** -+ -+Following are the callback functions for each subtype of the management frames -+ -+*****************************************************************************/ -+ -+unsigned int OnProbeReq(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned int ielen; -+ unsigned char *p; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *cur = &(pmlmeinfo->network); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ u8 is_valid_p2p_probereq = false; -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ return _SUCCESS; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == false && -+ check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE|WIFI_AP_STATE) == false) { -+ return _SUCCESS; -+ } -+ -+ -+ /* DBG_871X("+OnProbeReq\n"); */ -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true && -+ pmlmepriv->cur_network.join_res == true) { -+ struct sta_info *psta; -+ u8 *mac_addr, *peer_addr; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 RC_OUI[4] = {0x00, 0xE0, 0x4C, 0x0A}; -+ /* EID[1] + EID_LEN[1] + RC_OUI[4] + MAC[6] + PairingID[2] + ChannelNum[2] */ -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, (int *)&ielen, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); -+ -+ if (!p || ielen != 14) -+ goto _non_rc_device; -+ -+ if (memcmp(p+2, RC_OUI, sizeof(RC_OUI))) -+ goto _non_rc_device; -+ -+ if (memcmp(p+6, get_sa(pframe), ETH_ALEN)) { -+ DBG_871X("%s, do rc pairing ("MAC_FMT"), but mac addr mismatch!("MAC_FMT")\n", __func__, -+ MAC_ARG(get_sa(pframe)), MAC_ARG(p+6)); -+ -+ goto _non_rc_device; -+ } -+ -+ DBG_871X("%s, got the pairing device("MAC_FMT")\n", __func__, MAC_ARG(get_sa(pframe))); -+ -+ /* new a station */ -+ psta = rtw_get_stainfo(pstapriv, get_sa(pframe)); -+ if (psta == NULL) { -+ /* allocate a new one */ -+ DBG_871X("going to alloc stainfo for rc ="MAC_FMT"\n", MAC_ARG(get_sa(pframe))); -+ psta = rtw_alloc_stainfo(pstapriv, get_sa(pframe)); -+ if (psta == NULL) { -+ /* TODO: */ -+ DBG_871X(" Exceed the upper limit of supported clients...\n"); -+ return _SUCCESS; -+ } -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ if (list_empty(&psta->asoc_list)) { -+ psta->expire_to = pstapriv->expire_to; -+ list_add_tail(&psta->asoc_list, &pstapriv->asoc_list); -+ pstapriv->asoc_list_cnt++; -+ } -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+ /* generate pairing ID */ -+ mac_addr = myid(&(padapter->eeprompriv)); -+ peer_addr = psta->hwaddr; -+ psta->pid = (u16)(((mac_addr[4]<<8) + mac_addr[5]) + ((peer_addr[4]<<8) + peer_addr[5])); -+ -+ /* update peer stainfo */ -+ psta->isrc = true; -+ /* psta->aid = 0; */ -+ /* psta->mac_id = 2; */ -+ -+ /* get a unique AID */ -+ if (psta->aid > 0) { -+ DBG_871X("old AID %d\n", psta->aid); -+ } else { -+ for (psta->aid = 1; psta->aid <= NUM_STA; psta->aid++) -+ if (pstapriv->sta_aid[psta->aid - 1] == NULL) -+ break; -+ -+ if (psta->aid > pstapriv->max_num_sta) { -+ psta->aid = 0; -+ DBG_871X("no room for more AIDs\n"); -+ return _SUCCESS; -+ } else { -+ pstapriv->sta_aid[psta->aid - 1] = psta; -+ DBG_871X("allocate new AID = (%d)\n", psta->aid); -+ } -+ } -+ -+ psta->qos_option = 1; -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ psta->ieee8021x_blocked = false; -+ psta->htpriv.ht_option = true; -+ psta->htpriv.ampdu_enable = false; -+ psta->htpriv.sgi_20m = false; -+ psta->htpriv.sgi_40m = false; -+ psta->htpriv.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ -+ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, true); -+ -+ memset((void *)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); -+ -+ spin_lock_bh(&psta->lock); -+ psta->state |= _FW_LINKED; -+ spin_unlock_bh(&psta->lock); -+ -+ report_add_sta_event(padapter, psta->hwaddr, psta->aid); -+ -+ } -+ -+ issue_probersp(padapter, get_sa(pframe), false); -+ -+ return _SUCCESS; -+ -+ } -+ -+_non_rc_device: -+ -+ return _SUCCESS; -+ -+#endif /* CONFIG_AUTO_AP_MODE */ -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _SSID_IE_, (int *)&ielen, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); -+ -+ -+ /* check (wildcard) SSID */ -+ if (p != NULL) { -+ if (is_valid_p2p_probereq == true) -+ goto _issue_probersp; -+ -+ if ((ielen != 0 && false == !memcmp((void *)(p+2), (void *)cur->Ssid.Ssid, cur->Ssid.SsidLength)) -+ || (ielen == 0 && pmlmeinfo->hidden_ssid_mode) -+ ) -+ return _SUCCESS; -+ -+_issue_probersp: -+ if (((check_fwstate(pmlmepriv, _FW_LINKED) == true && -+ pmlmepriv->cur_network.join_res == true)) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) { -+ /* DBG_871X("+issue_probersp during ap mode\n"); */ -+ issue_probersp(padapter, get_sa(pframe), is_valid_p2p_probereq); -+ } -+ -+ } -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnProbeRsp(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (pmlmeext->sitesurvey_res.state == SCAN_PROCESS) { -+ report_survey_event(padapter, precv_frame); -+ return _SUCCESS; -+ } -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnBeacon(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ int cam_idx; -+ struct sta_info *psta; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ struct wlan_bssid_ex *pbss; -+ int ret = _SUCCESS; -+ u8 *p = NULL; -+ u32 ielen = 0; -+ -+ p = rtw_get_ie(pframe + sizeof(struct ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ielen, precv_frame->u.hdr.len - sizeof(struct ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_); -+ if ((p != NULL) && (ielen > 0)) { -+ if ((*(p + 1 + ielen) == 0x2D) && (*(p + 2 + ielen) != 0x2D)) { -+ /* Invalid value 0x2D is detected in Extended Supported Rates (ESR) IE. Try to fix the IE length to avoid failed Beacon parsing. */ -+ DBG_871X("[WIFIDBG] Error in ESR IE is detected in Beacon of BSSID:"MAC_FMT". Fix the length of ESR IE to avoid failed Beacon parsing.\n", MAC_ARG(GetAddr3Ptr(pframe))); -+ *(p + 1) = ielen - 1; -+ } -+ } -+ -+ if (pmlmeext->sitesurvey_res.state == SCAN_PROCESS) { -+ report_survey_event(padapter, precv_frame); -+ return _SUCCESS; -+ } -+ -+ if (!memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN)) { -+ if (pmlmeinfo->state & WIFI_FW_AUTH_NULL) { -+ /* we should update current network before auth, or some IE is wrong */ -+ pbss = (struct wlan_bssid_ex *)rtw_malloc(sizeof(struct wlan_bssid_ex)); -+ if (pbss) { -+ if (collect_bss_info(padapter, precv_frame, pbss) == _SUCCESS) { -+ update_network(&(pmlmepriv->cur_network.network), pbss, padapter, true); -+ rtw_get_bcn_info(&(pmlmepriv->cur_network)); -+ } -+ kfree((u8 *)pbss); -+ } -+ -+ /* check the vendor of the assoc AP */ -+ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pframe+sizeof(struct ieee80211_hdr_3addr), len-sizeof(struct ieee80211_hdr_3addr)); -+ -+ /* update TSF Value */ -+ update_TSF(pmlmeext, pframe, len); -+ -+ /* reset for adaptive_early_32k */ -+ pmlmeext->adaptive_tsf_done = false; -+ pmlmeext->DrvBcnEarly = 0xff; -+ pmlmeext->DrvBcnTimeOut = 0xff; -+ pmlmeext->bcn_cnt = 0; -+ memset(pmlmeext->bcn_delay_cnt, 0, sizeof(pmlmeext->bcn_delay_cnt)); -+ memset(pmlmeext->bcn_delay_ratio, 0, sizeof(pmlmeext->bcn_delay_ratio)); -+ -+ /* start auth */ -+ start_clnt_auth(padapter); -+ -+ return _SUCCESS; -+ } -+ -+ if (((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) && (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta != NULL) { -+ ret = rtw_check_bcn_info(padapter, pframe, len); -+ if (!ret) { -+ DBG_871X_LEVEL(_drv_always_, "ap has changed, disconnect now\n "); -+ receive_disconnect(padapter, pmlmeinfo->network.MacAddress, 0); -+ return _SUCCESS; -+ } -+ /* update WMM, ERP in the beacon */ -+ /* todo: the timer is used instead of the number of the beacon received */ -+ if ((sta_rx_pkts(psta) & 0xf) == 0) -+ /* DBG_871X("update_bcn_info\n"); */ -+ update_beacon_info(padapter, pframe, len, psta); -+ -+ adaptive_early_32k(pmlmeext, pframe, len); -+ } -+ } else if ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) { -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta != NULL) { -+ /* update WMM, ERP in the beacon */ -+ /* todo: the timer is used instead of the number of the beacon received */ -+ if ((sta_rx_pkts(psta) & 0xf) == 0) { -+ /* DBG_871X("update_bcn_info\n"); */ -+ update_beacon_info(padapter, pframe, len, psta); -+ } -+ } else{ -+ /* allocate a new CAM entry for IBSS station */ -+ cam_idx = allocate_fw_sta_entry(padapter); -+ if (cam_idx == NUM_STA) -+ goto _END_ONBEACON_; -+ -+ /* get supported rate */ -+ if (update_sta_support_rate(padapter, (pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_), (len - WLAN_HDR_A3_LEN - _BEACON_IE_OFFSET_), cam_idx) == _FAIL) { -+ pmlmeinfo->FW_sta_info[cam_idx].status = 0; -+ goto _END_ONBEACON_; -+ } -+ -+ /* update TSF Value */ -+ update_TSF(pmlmeext, pframe, len); -+ -+ /* report sta add event */ -+ report_add_sta_event(padapter, GetAddr2Ptr(pframe), cam_idx); -+ } -+ } -+ } -+ -+_END_ONBEACON_: -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnAuth(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned int auth_mode, seq, ie_len; -+ unsigned char *sa, *p; -+ u16 algorithm; -+ int status; -+ static struct sta_info stat; -+ struct sta_info *pstat = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ u8 offset = 0; -+ -+ if ((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) -+ return _FAIL; -+ -+ DBG_871X("+OnAuth\n"); -+ -+ sa = GetAddr2Ptr(pframe); -+ -+ auth_mode = psecuritypriv->dot11AuthAlgrthm; -+ -+ if (GetPrivacy(pframe)) { -+ u8 *iv; -+ struct rx_pkt_attrib *prxattrib = &(precv_frame->u.hdr.attrib); -+ -+ prxattrib->hdrlen = WLAN_HDR_A3_LEN; -+ prxattrib->encrypt = _WEP40_; -+ -+ iv = pframe+prxattrib->hdrlen; -+ prxattrib->key_index = ((iv[3]>>6)&0x3); -+ -+ prxattrib->iv_len = 4; -+ prxattrib->icv_len = 4; -+ -+ rtw_wep_decrypt(padapter, (u8 *)precv_frame); -+ -+ offset = 4; -+ } -+ -+ algorithm = le16_to_cpu(*(__le16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset)); -+ seq = le16_to_cpu(*(__le16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 2)); -+ -+ DBG_871X("auth alg =%x, seq =%X\n", algorithm, seq); -+ -+ if (auth_mode == 2 && -+ psecuritypriv->dot11PrivacyAlgrthm != _WEP40_ && -+ psecuritypriv->dot11PrivacyAlgrthm != _WEP104_) -+ auth_mode = 0; -+ -+ if ((algorithm > 0 && auth_mode == 0) || /* rx a shared-key auth but shared not enabled */ -+ (algorithm == 0 && auth_mode == 1)) { /* rx a open-system auth but shared-key is enabled */ -+ DBG_871X("auth rejected due to bad alg [alg =%d, auth_mib =%d] %02X%02X%02X%02X%02X%02X\n", -+ algorithm, auth_mode, sa[0], sa[1], sa[2], sa[3], sa[4], sa[5]); -+ -+ status = _STATS_NO_SUPP_ALG_; -+ -+ goto auth_fail; -+ } -+ -+ if (rtw_access_ctrl(padapter, sa) == false) { -+ status = _STATS_UNABLE_HANDLE_STA_; -+ goto auth_fail; -+ } -+ -+ pstat = rtw_get_stainfo(pstapriv, sa); -+ if (pstat == NULL) { -+ -+ /* allocate a new one */ -+ DBG_871X("going to alloc stainfo for sa ="MAC_FMT"\n", MAC_ARG(sa)); -+ pstat = rtw_alloc_stainfo(pstapriv, sa); -+ if (pstat == NULL) { -+ DBG_871X(" Exceed the upper limit of supported clients...\n"); -+ status = _STATS_UNABLE_HANDLE_STA_; -+ goto auth_fail; -+ } -+ -+ pstat->state = WIFI_FW_AUTH_NULL; -+ pstat->auth_seq = 0; -+ -+ /* pstat->flags = 0; */ -+ /* pstat->capability = 0; */ -+ } else{ -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ if (list_empty(&pstat->asoc_list) == false) { -+ list_del_init(&pstat->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ if (pstat->expire_to > 0) { -+ /* TODO: STA re_auth within expire_to */ -+ } -+ } -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+ if (seq == 1) { -+ /* TODO: STA re_auth and auth timeout */ -+ } -+ } -+ -+ spin_lock_bh(&pstapriv->auth_list_lock); -+ if (list_empty(&pstat->auth_list)) { -+ -+ list_add_tail(&pstat->auth_list, &pstapriv->auth_list); -+ pstapriv->auth_list_cnt++; -+ } -+ spin_unlock_bh(&pstapriv->auth_list_lock); -+ -+ if (pstat->auth_seq == 0) -+ pstat->expire_to = pstapriv->auth_to; -+ -+ -+ if ((pstat->auth_seq + 1) != seq) { -+ DBG_871X("(1)auth rejected because out of seq [rx_seq =%d, exp_seq =%d]!\n", -+ seq, pstat->auth_seq+1); -+ status = _STATS_OUT_OF_AUTH_SEQ_; -+ goto auth_fail; -+ } -+ -+ if (algorithm == 0 && (auth_mode == 0 || auth_mode == 2 || auth_mode == 3)) { -+ if (seq == 1) { -+ pstat->state &= ~WIFI_FW_AUTH_NULL; -+ pstat->state |= WIFI_FW_AUTH_SUCCESS; -+ pstat->expire_to = pstapriv->assoc_to; -+ pstat->authalg = algorithm; -+ } else{ -+ DBG_871X("(2)auth rejected because out of seq [rx_seq =%d, exp_seq =%d]!\n", -+ seq, pstat->auth_seq+1); -+ status = _STATS_OUT_OF_AUTH_SEQ_; -+ goto auth_fail; -+ } -+ } else{ /* shared system or auto authentication */ -+ if (seq == 1) { -+ /* prepare for the challenging txt... */ -+ memset((void *)pstat->chg_txt, 78, 128); -+ -+ pstat->state &= ~WIFI_FW_AUTH_NULL; -+ pstat->state |= WIFI_FW_AUTH_STATE; -+ pstat->authalg = algorithm; -+ pstat->auth_seq = 2; -+ } else if (seq == 3) { -+ /* checking for challenging txt... */ -+ DBG_871X("checking for challenging txt...\n"); -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + 4 + _AUTH_IE_OFFSET_, _CHLGETXT_IE_, (int *)&ie_len, -+ len - WLAN_HDR_A3_LEN - _AUTH_IE_OFFSET_ - 4); -+ -+ if ((p == NULL) || (ie_len <= 0)) { -+ DBG_871X("auth rejected because challenge failure!(1)\n"); -+ status = _STATS_CHALLENGE_FAIL_; -+ goto auth_fail; -+ } -+ -+ if (!memcmp((void *)(p + 2), pstat->chg_txt, 128)) { -+ pstat->state &= (~WIFI_FW_AUTH_STATE); -+ pstat->state |= WIFI_FW_AUTH_SUCCESS; -+ /* challenging txt is correct... */ -+ pstat->expire_to = pstapriv->assoc_to; -+ } else{ -+ DBG_871X("auth rejected because challenge failure!\n"); -+ status = _STATS_CHALLENGE_FAIL_; -+ goto auth_fail; -+ } -+ } else{ -+ DBG_871X("(3)auth rejected because out of seq [rx_seq =%d, exp_seq =%d]!\n", -+ seq, pstat->auth_seq+1); -+ status = _STATS_OUT_OF_AUTH_SEQ_; -+ goto auth_fail; -+ } -+ } -+ -+ -+ /* Now, we are going to issue_auth... */ -+ pstat->auth_seq = seq + 1; -+ -+ issue_auth(padapter, pstat, (unsigned short)(_STATS_SUCCESSFUL_)); -+ -+ if (pstat->state & WIFI_FW_AUTH_SUCCESS) -+ pstat->auth_seq = 0; -+ -+ -+ return _SUCCESS; -+ -+auth_fail: -+ -+ if (pstat) -+ rtw_free_stainfo(padapter, pstat); -+ -+ pstat = &stat; -+ memset((char *)pstat, '\0', sizeof(stat)); -+ pstat->auth_seq = 2; -+ memcpy(pstat->hwaddr, sa, 6); -+ -+ issue_auth(padapter, pstat, (unsigned short)status); -+ -+ return _FAIL; -+ -+} -+ -+unsigned int OnAuthClient(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned int seq, len, status, algthm, offset; -+ unsigned char *p; -+ unsigned int go2asoc = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint pkt_len = precv_frame->u.hdr.len; -+ -+ DBG_871X("%s\n", __func__); -+ -+ /* check A1 matches or not */ -+ if (memcmp(myid(&(padapter->eeprompriv)), get_da(pframe), ETH_ALEN)) -+ return _SUCCESS; -+ -+ if (!(pmlmeinfo->state & WIFI_FW_AUTH_STATE)) -+ return _SUCCESS; -+ -+ offset = (GetPrivacy(pframe)) ? 4 : 0; -+ -+ algthm = le16_to_cpu(*(__le16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset)); -+ seq = le16_to_cpu(*(__le16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 2)); -+ status = le16_to_cpu(*(__le16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 4)); -+ -+ if (status != 0) { -+ DBG_871X("clnt auth fail, status: %d\n", status); -+ if (status == 13) { /* pmlmeinfo->auth_algo == dot11AuthAlgrthm_Auto) */ -+ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) -+ pmlmeinfo->auth_algo = dot11AuthAlgrthm_Open; -+ else -+ pmlmeinfo->auth_algo = dot11AuthAlgrthm_Shared; -+ /* pmlmeinfo->reauth_count = 0; */ -+ } -+ -+ set_link_timer(pmlmeext, 1); -+ goto authclnt_fail; -+ } -+ -+ if (seq == 2) { -+ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) { -+ /* legendary shared system */ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _AUTH_IE_OFFSET_, _CHLGETXT_IE_, (int *)&len, -+ pkt_len - WLAN_HDR_A3_LEN - _AUTH_IE_OFFSET_); -+ -+ if (p == NULL) { -+ /* DBG_871X("marc: no challenge text?\n"); */ -+ goto authclnt_fail; -+ } -+ -+ memcpy((void *)(pmlmeinfo->chg_txt), (void *)(p + 2), len); -+ pmlmeinfo->auth_seq = 3; -+ issue_auth(padapter, NULL, 0); -+ set_link_timer(pmlmeext, REAUTH_TO); -+ -+ return _SUCCESS; -+ } else{ -+ /* open system */ -+ go2asoc = 1; -+ } -+ } else if (seq == 4) { -+ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) { -+ go2asoc = 1; -+ } else{ -+ goto authclnt_fail; -+ } -+ } else{ -+ /* this is also illegal */ -+ /* DBG_871X("marc: clnt auth failed due to illegal seq =%x\n", seq); */ -+ goto authclnt_fail; -+ } -+ -+ if (go2asoc) { -+ DBG_871X_LEVEL(_drv_always_, "auth success, start assoc\n"); -+ start_clnt_assoc(padapter); -+ return _SUCCESS; -+ } -+ -+authclnt_fail: -+ -+ /* pmlmeinfo->state &= ~(WIFI_FW_AUTH_STATE); */ -+ -+ return _FAIL; -+ -+} -+ -+unsigned int OnAssocReq(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ u16 capab_info, listen_interval; -+ struct rtw_ieee802_11_elems elems; -+ struct sta_info *pstat; -+ unsigned char reassoc, *p, *pos, *wpa_ie; -+ unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01}; -+ int i, ie_len, wpa_ie_len, left; -+ unsigned char supportRate[16]; -+ int supportRateNum; -+ unsigned short status = _STATS_SUCCESSFUL_; -+ unsigned short frame_type, ie_offset = 0; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *cur = &(pmlmeinfo->network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint pkt_len = precv_frame->u.hdr.len; -+ -+ if ((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) -+ return _FAIL; -+ -+ frame_type = GetFrameSubType(pframe); -+ if (frame_type == WIFI_ASSOCREQ) { -+ reassoc = 0; -+ ie_offset = _ASOCREQ_IE_OFFSET_; -+ } else{ /* WIFI_REASSOCREQ */ -+ reassoc = 1; -+ ie_offset = _REASOCREQ_IE_OFFSET_; -+ } -+ -+ -+ if (pkt_len < IEEE80211_3ADDR_LEN + ie_offset) { -+ DBG_871X("handle_assoc(reassoc =%d) - too short payload (len =%lu)" -+ "\n", reassoc, (unsigned long)pkt_len); -+ return _FAIL; -+ } -+ -+ pstat = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (pstat == (struct sta_info *)NULL) { -+ status = _RSON_CLS2_; -+ goto asoc_class2_error; -+ } -+ -+ capab_info = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN); -+ /* capab_info = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); */ -+ /* listen_interval = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN+2)); */ -+ listen_interval = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN+2); -+ -+ left = pkt_len - (IEEE80211_3ADDR_LEN + ie_offset); -+ pos = pframe + (IEEE80211_3ADDR_LEN + ie_offset); -+ -+ -+ DBG_871X("%s\n", __func__); -+ -+ /* check if this stat has been successfully authenticated/assocated */ -+ if (!((pstat->state) & WIFI_FW_AUTH_SUCCESS)) { -+ if (!((pstat->state) & WIFI_FW_ASSOC_SUCCESS)) { -+ status = _RSON_CLS2_; -+ goto asoc_class2_error; -+ } else{ -+ pstat->state &= (~WIFI_FW_ASSOC_SUCCESS); -+ pstat->state |= WIFI_FW_ASSOC_STATE; -+ } -+ } else{ -+ pstat->state &= (~WIFI_FW_AUTH_SUCCESS); -+ pstat->state |= WIFI_FW_ASSOC_STATE; -+ } -+ -+ -+ pstat->capability = capab_info; -+ -+ /* now parse all ieee802_11 ie to point to elems */ -+ if (rtw_ieee802_11_parse_elems(pos, left, &elems, 1) == ParseFailed || -+ !elems.ssid) { -+ DBG_871X("STA " MAC_FMT " sent invalid association request\n", -+ MAC_ARG(pstat->hwaddr)); -+ status = _STATS_FAILURE_; -+ goto OnAssocReqFail; -+ } -+ -+ -+ /* now we should check all the fields... */ -+ /* checking SSID */ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + ie_offset, _SSID_IE_, &ie_len, -+ pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+ if (p == NULL) { -+ status = _STATS_FAILURE_; -+ } -+ -+ if (ie_len == 0) /* broadcast ssid, however it is not allowed in assocreq */ -+ status = _STATS_FAILURE_; -+ else { -+ /* check if ssid match */ -+ if (memcmp((void *)(p+2), cur->Ssid.Ssid, cur->Ssid.SsidLength)) -+ status = _STATS_FAILURE_; -+ -+ if (ie_len != cur->Ssid.SsidLength) -+ status = _STATS_FAILURE_; -+ } -+ -+ if (_STATS_SUCCESSFUL_ != status) -+ goto OnAssocReqFail; -+ -+ /* check if the supported rate is ok */ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + ie_offset, _SUPPORTEDRATES_IE_, &ie_len, pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+ if (p == NULL) { -+ DBG_871X("Rx a sta assoc-req which supported rate is empty!\n"); -+ /* use our own rate set as statoin used */ -+ /* memcpy(supportRate, AP_BSSRATE, AP_BSSRATE_LEN); */ -+ /* supportRateNum = AP_BSSRATE_LEN; */ -+ -+ status = _STATS_FAILURE_; -+ goto OnAssocReqFail; -+ } else { -+ memcpy(supportRate, p+2, ie_len); -+ supportRateNum = ie_len; -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + ie_offset, _EXT_SUPPORTEDRATES_IE_, &ie_len, -+ pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+ if (p != NULL) { -+ -+ if (supportRateNum <= sizeof(supportRate)) { -+ memcpy(supportRate+supportRateNum, p+2, ie_len); -+ supportRateNum += ie_len; -+ } -+ } -+ } -+ -+ /* todo: mask supportRate between AP & STA -> move to update raid */ -+ /* get_matched_rate(pmlmeext, supportRate, &supportRateNum, 0); */ -+ -+ /* update station supportRate */ -+ pstat->bssratelen = supportRateNum; -+ memcpy(pstat->bssrateset, supportRate, supportRateNum); -+ UpdateBrateTblForSoftAP(pstat->bssrateset, pstat->bssratelen); -+ -+ /* check RSN/WPA/WPS */ -+ pstat->dot8021xalg = 0; -+ pstat->wpa_psk = 0; -+ pstat->wpa_group_cipher = 0; -+ pstat->wpa2_group_cipher = 0; -+ pstat->wpa_pairwise_cipher = 0; -+ pstat->wpa2_pairwise_cipher = 0; -+ memset(pstat->wpa_ie, 0, sizeof(pstat->wpa_ie)); -+ if ((psecuritypriv->wpa_psk & BIT(1)) && elems.rsn_ie) { -+ -+ int group_cipher = 0, pairwise_cipher = 0; -+ -+ wpa_ie = elems.rsn_ie; -+ wpa_ie_len = elems.rsn_ie_len; -+ -+ if (rtw_parse_wpa2_ie(wpa_ie-2, wpa_ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { -+ pstat->dot8021xalg = 1;/* psk, todo:802.1x */ -+ pstat->wpa_psk |= BIT(1); -+ -+ pstat->wpa2_group_cipher = group_cipher&psecuritypriv->wpa2_group_cipher; -+ pstat->wpa2_pairwise_cipher = pairwise_cipher&psecuritypriv->wpa2_pairwise_cipher; -+ -+ if (!pstat->wpa2_group_cipher) -+ status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; -+ -+ if (!pstat->wpa2_pairwise_cipher) -+ status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; -+ } else{ -+ status = WLAN_STATUS_INVALID_IE; -+ } -+ -+ } else if ((psecuritypriv->wpa_psk & BIT(0)) && elems.wpa_ie) { -+ -+ int group_cipher = 0, pairwise_cipher = 0; -+ -+ wpa_ie = elems.wpa_ie; -+ wpa_ie_len = elems.wpa_ie_len; -+ -+ if (rtw_parse_wpa_ie(wpa_ie-2, wpa_ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { -+ pstat->dot8021xalg = 1;/* psk, todo:802.1x */ -+ pstat->wpa_psk |= BIT(0); -+ -+ pstat->wpa_group_cipher = group_cipher&psecuritypriv->wpa_group_cipher; -+ pstat->wpa_pairwise_cipher = pairwise_cipher&psecuritypriv->wpa_pairwise_cipher; -+ -+ if (!pstat->wpa_group_cipher) -+ status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; -+ -+ if (!pstat->wpa_pairwise_cipher) -+ status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; -+ -+ } else{ -+ status = WLAN_STATUS_INVALID_IE; -+ } -+ -+ } else { -+ wpa_ie = NULL; -+ wpa_ie_len = 0; -+ } -+ -+ if (_STATS_SUCCESSFUL_ != status) -+ goto OnAssocReqFail; -+ -+ pstat->flags &= ~(WLAN_STA_WPS | WLAN_STA_MAYBE_WPS); -+ if (wpa_ie == NULL) { -+ if (elems.wps_ie) { -+ DBG_871X("STA included WPS IE in " -+ "(Re)Association Request - assume WPS is " -+ "used\n"); -+ pstat->flags |= WLAN_STA_WPS; -+ /* wpabuf_free(sta->wps_ie); */ -+ /* sta->wps_ie = wpabuf_alloc_copy(elems.wps_ie + 4, */ -+ /* elems.wps_ie_len - 4); */ -+ } else { -+ DBG_871X("STA did not include WPA/RSN IE " -+ "in (Re)Association Request - possible WPS " -+ "use\n"); -+ pstat->flags |= WLAN_STA_MAYBE_WPS; -+ } -+ -+ -+ /* AP support WPA/RSN, and sta is going to do WPS, but AP is not ready */ -+ /* that the selected registrar of AP is _FLASE */ -+ if ((psecuritypriv->wpa_psk > 0) -+ && (pstat->flags & (WLAN_STA_WPS|WLAN_STA_MAYBE_WPS))) { -+ if (pmlmepriv->wps_beacon_ie) { -+ u8 selected_registrar = 0; -+ -+ rtw_get_wps_attr_content(pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len, WPS_ATTR_SELECTED_REGISTRAR, &selected_registrar, NULL); -+ -+ if (!selected_registrar) { -+ DBG_871X("selected_registrar is false , or AP is not ready to do WPS\n"); -+ -+ status = _STATS_UNABLE_HANDLE_STA_; -+ -+ goto OnAssocReqFail; -+ } -+ } -+ } -+ -+ } else{ -+ int copy_len; -+ -+ if (psecuritypriv->wpa_psk == 0) { -+ DBG_871X("STA " MAC_FMT ": WPA/RSN IE in association " -+ "request, but AP don't support WPA/RSN\n", MAC_ARG(pstat->hwaddr)); -+ -+ status = WLAN_STATUS_INVALID_IE; -+ -+ goto OnAssocReqFail; -+ -+ } -+ -+ if (elems.wps_ie) { -+ DBG_871X("STA included WPS IE in " -+ "(Re)Association Request - WPS is " -+ "used\n"); -+ pstat->flags |= WLAN_STA_WPS; -+ copy_len = 0; -+ } else{ -+ copy_len = ((wpa_ie_len+2) > sizeof(pstat->wpa_ie)) ? (sizeof(pstat->wpa_ie)):(wpa_ie_len+2); -+ } -+ -+ -+ if (copy_len > 0) -+ memcpy(pstat->wpa_ie, wpa_ie-2, copy_len); -+ -+ } -+ -+ -+ /* check if there is WMM IE & support WWM-PS */ -+ pstat->flags &= ~WLAN_STA_WME; -+ pstat->qos_option = 0; -+ pstat->qos_info = 0; -+ pstat->has_legacy_ac = true; -+ pstat->uapsd_vo = 0; -+ pstat->uapsd_vi = 0; -+ pstat->uapsd_be = 0; -+ pstat->uapsd_bk = 0; -+ if (pmlmepriv->qospriv.qos_option) { -+ p = pframe + WLAN_HDR_A3_LEN + ie_offset; ie_len = 0; -+ for (;;) { -+ p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &ie_len, pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+ if (p != NULL) { -+ if (!memcmp(p+2, WMM_IE, 6)) { -+ -+ pstat->flags |= WLAN_STA_WME; -+ -+ pstat->qos_option = 1; -+ pstat->qos_info = *(p+8); -+ -+ pstat->max_sp_len = (pstat->qos_info>>5)&0x3; -+ -+ if ((pstat->qos_info&0xf) != 0xf) -+ pstat->has_legacy_ac = true; -+ else -+ pstat->has_legacy_ac = false; -+ -+ if (pstat->qos_info&0xf) { -+ if (pstat->qos_info&BIT(0)) -+ pstat->uapsd_vo = BIT(0)|BIT(1); -+ else -+ pstat->uapsd_vo = 0; -+ -+ if (pstat->qos_info&BIT(1)) -+ pstat->uapsd_vi = BIT(0)|BIT(1); -+ else -+ pstat->uapsd_vi = 0; -+ -+ if (pstat->qos_info&BIT(2)) -+ pstat->uapsd_bk = BIT(0)|BIT(1); -+ else -+ pstat->uapsd_bk = 0; -+ -+ if (pstat->qos_info&BIT(3)) -+ pstat->uapsd_be = BIT(0)|BIT(1); -+ else -+ pstat->uapsd_be = 0; -+ -+ } -+ -+ break; -+ } -+ } else { -+ break; -+ } -+ p = p + ie_len + 2; -+ } -+ } -+ -+ /* save HT capabilities in the sta object */ -+ memset(&pstat->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap)); -+ if (elems.ht_capabilities && elems.ht_capabilities_len >= sizeof(struct rtw_ieee80211_ht_cap)) { -+ pstat->flags |= WLAN_STA_HT; -+ -+ pstat->flags |= WLAN_STA_WME; -+ -+ memcpy(&pstat->htpriv.ht_cap, elems.ht_capabilities, sizeof(struct rtw_ieee80211_ht_cap)); -+ -+ } else -+ pstat->flags &= ~WLAN_STA_HT; -+ -+ -+ if ((pmlmepriv->htpriv.ht_option == false) && (pstat->flags&WLAN_STA_HT)) { -+ status = _STATS_FAILURE_; -+ goto OnAssocReqFail; -+ } -+ -+ -+ if ((pstat->flags & WLAN_STA_HT) && -+ ((pstat->wpa2_pairwise_cipher&WPA_CIPHER_TKIP) || -+ (pstat->wpa_pairwise_cipher&WPA_CIPHER_TKIP))) { -+ DBG_871X("HT: " MAC_FMT " tried to " -+ "use TKIP with HT association\n", MAC_ARG(pstat->hwaddr)); -+ -+ /* status = WLAN_STATUS_CIPHER_REJECTED_PER_POLICY; */ -+ /* goto OnAssocReqFail; */ -+ } -+ pstat->flags |= WLAN_STA_NONERP; -+ for (i = 0; i < pstat->bssratelen; i++) { -+ if ((pstat->bssrateset[i] & 0x7f) > 22) { -+ pstat->flags &= ~WLAN_STA_NONERP; -+ break; -+ } -+ } -+ -+ if (pstat->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) -+ pstat->flags |= WLAN_STA_SHORT_PREAMBLE; -+ else -+ pstat->flags &= ~WLAN_STA_SHORT_PREAMBLE; -+ -+ -+ -+ if (status != _STATS_SUCCESSFUL_) -+ goto OnAssocReqFail; -+ -+ /* TODO: identify_proprietary_vendor_ie(); */ -+ /* Realtek proprietary IE */ -+ /* identify if this is Broadcom sta */ -+ /* identify if this is ralink sta */ -+ /* Customer proprietary IE */ -+ -+ -+ -+ /* get a unique AID */ -+ if (pstat->aid > 0) { -+ DBG_871X(" old AID %d\n", pstat->aid); -+ } else { -+ for (pstat->aid = 1; pstat->aid <= NUM_STA; pstat->aid++) -+ if (pstapriv->sta_aid[pstat->aid - 1] == NULL) -+ break; -+ -+ /* if (pstat->aid > NUM_STA) { */ -+ if (pstat->aid > pstapriv->max_num_sta) { -+ -+ pstat->aid = 0; -+ -+ DBG_871X(" no room for more AIDs\n"); -+ -+ status = WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA; -+ -+ goto OnAssocReqFail; -+ -+ -+ } else { -+ pstapriv->sta_aid[pstat->aid - 1] = pstat; -+ DBG_871X("allocate new AID = (%d)\n", pstat->aid); -+ } -+ } -+ -+ -+ pstat->state &= (~WIFI_FW_ASSOC_STATE); -+ pstat->state |= WIFI_FW_ASSOC_SUCCESS; -+ -+ spin_lock_bh(&pstapriv->auth_list_lock); -+ if (!list_empty(&pstat->auth_list)) { -+ list_del_init(&pstat->auth_list); -+ pstapriv->auth_list_cnt--; -+ } -+ spin_unlock_bh(&pstapriv->auth_list_lock); -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ if (list_empty(&pstat->asoc_list)) { -+ pstat->expire_to = pstapriv->expire_to; -+ list_add_tail(&pstat->asoc_list, &pstapriv->asoc_list); -+ pstapriv->asoc_list_cnt++; -+ } -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+ /* now the station is qualified to join our BSS... */ -+ if (pstat && (pstat->state & WIFI_FW_ASSOC_SUCCESS) && (_STATS_SUCCESSFUL_ == status)) { -+ /* 1 bss_cap_update & sta_info_update */ -+ bss_cap_update_on_sta_join(padapter, pstat); -+ sta_info_update(padapter, pstat); -+ -+ /* 2 issue assoc rsp before notify station join event. */ -+ if (frame_type == WIFI_ASSOCREQ) -+ issue_asocrsp(padapter, status, pstat, WIFI_ASSOCRSP); -+ else -+ issue_asocrsp(padapter, status, pstat, WIFI_REASSOCRSP); -+ -+ spin_lock_bh(&pstat->lock); -+ if (pstat->passoc_req) { -+ kfree(pstat->passoc_req); -+ pstat->passoc_req = NULL; -+ pstat->assoc_req_len = 0; -+ } -+ -+ pstat->passoc_req = rtw_zmalloc(pkt_len); -+ if (pstat->passoc_req) { -+ memcpy(pstat->passoc_req, pframe, pkt_len); -+ pstat->assoc_req_len = pkt_len; -+ } -+ spin_unlock_bh(&pstat->lock); -+ -+ /* 3-(1) report sta add event */ -+ report_add_sta_event(padapter, pstat->hwaddr, pstat->aid); -+ } -+ -+ return _SUCCESS; -+ -+asoc_class2_error: -+ -+ issue_deauth(padapter, (void *)GetAddr2Ptr(pframe), status); -+ -+ return _FAIL; -+ -+OnAssocReqFail: -+ -+ pstat->aid = 0; -+ if (frame_type == WIFI_ASSOCREQ) -+ issue_asocrsp(padapter, status, pstat, WIFI_ASSOCRSP); -+ else -+ issue_asocrsp(padapter, status, pstat, WIFI_REASSOCRSP); -+ -+ return _FAIL; -+} -+ -+unsigned int OnAssocRsp(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ uint i; -+ int res; -+ unsigned short status; -+ struct ndis_80211_var_ie *pIE; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ /* struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network); */ -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint pkt_len = precv_frame->u.hdr.len; -+ -+ DBG_871X("%s\n", __func__); -+ -+ /* check A1 matches or not */ -+ if (memcmp(myid(&(padapter->eeprompriv)), get_da(pframe), ETH_ALEN)) -+ return _SUCCESS; -+ -+ if (!(pmlmeinfo->state & (WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE))) -+ return _SUCCESS; -+ -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ return _SUCCESS; -+ -+ del_timer_sync(&pmlmeext->link_timer); -+ -+ /* status */ -+ status = le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN + 2)); -+ if (status > 0) { -+ DBG_871X("assoc reject, status code: %d\n", status); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ res = -4; -+ goto report_assoc_result; -+ } -+ -+ /* get capabilities */ -+ pmlmeinfo->capability = le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN)); -+ -+ /* set slot time */ -+ pmlmeinfo->slotTime = (pmlmeinfo->capability & BIT(10)) ? 9 : 20; -+ -+ /* AID */ -+ res = pmlmeinfo->aid = (int)(le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN + 4))&0x3fff); -+ -+ /* following are moved to join event callback function */ -+ /* to handle HT, WMM, rate adaptive, update MAC reg */ -+ /* for not to handle the synchronous IO in the tasklet */ -+ for (i = (6 + WLAN_HDR_A3_LEN); i < pkt_len;) { -+ pIE = (struct ndis_80211_var_ie *)(pframe + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_: -+ if (!memcmp(pIE->data, WMM_PARA_OUI, 6)) /* WMM */ -+ WMM_param_handler(padapter, pIE); -+ break; -+ -+ case _HT_CAPABILITY_IE_: /* HT caps */ -+ HT_caps_handler(padapter, pIE); -+ break; -+ -+ case _HT_EXTRA_INFO_IE_: /* HT info */ -+ HT_info_handler(padapter, pIE); -+ break; -+ -+ case _ERPINFO_IE_: -+ ERP_IE_handler(padapter, pIE); -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ pmlmeinfo->state &= (~WIFI_FW_ASSOC_STATE); -+ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; -+ -+ /* Update Basic Rate Table for spec, 2010-12-28 , by thomas */ -+ UpdateBrateTbl(padapter, pmlmeinfo->network.SupportedRates); -+ -+report_assoc_result: -+ if (res > 0) { -+ rtw_buf_update(&pmlmepriv->assoc_rsp, &pmlmepriv->assoc_rsp_len, pframe, pkt_len); -+ } else { -+ rtw_buf_free(&pmlmepriv->assoc_rsp, &pmlmepriv->assoc_rsp_len); -+ } -+ -+ report_join_res(padapter, res); -+ -+ return _SUCCESS; -+} -+ -+unsigned int OnDeAuth(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned short reason; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ -+ /* check A3 */ -+ if (memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN)) -+ return _SUCCESS; -+ -+ reason = le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN)); -+ -+ DBG_871X("%s Reason code(%d)\n", __func__, reason); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) { -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ /* spin_lock_bh(&(pstapriv->sta_hash_lock)); */ -+ /* rtw_free_stainfo(padapter, psta); */ -+ /* spin_unlock_bh(&(pstapriv->sta_hash_lock)); */ -+ -+ DBG_871X_LEVEL(_drv_always_, "ap recv deauth reason code(%d) sta:%pM\n", -+ reason, GetAddr2Ptr(pframe)); -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta) { -+ u8 updated = false; -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ if (list_empty(&psta->asoc_list) == false) { -+ list_del_init(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, false, reason); -+ -+ } -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+ associated_clients_update(padapter, updated); -+ } -+ -+ -+ return _SUCCESS; -+ } else{ -+ int ignore_received_deauth = 0; -+ -+ /* Commented by Albert 20130604 */ -+ /* Before sending the auth frame to start the STA/GC mode connection with AP/GO, */ -+ /* we will send the deauth first. */ -+ /* However, the Win8.1 with BRCM Wi-Fi will send the deauth with reason code 6 to us after receieving our deauth. */ -+ /* Added the following code to avoid this case. */ -+ if ((pmlmeinfo->state & WIFI_FW_AUTH_STATE) || -+ (pmlmeinfo->state & WIFI_FW_ASSOC_STATE)) { -+ if (reason == WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA) { -+ ignore_received_deauth = 1; -+ } else if (WLAN_REASON_PREV_AUTH_NOT_VALID == reason) { -+ /* TODO: 802.11r */ -+ ignore_received_deauth = 1; -+ } -+ } -+ -+ DBG_871X_LEVEL(_drv_always_, "sta recv deauth reason code(%d) sta:%pM, ignore = %d\n", -+ reason, GetAddr3Ptr(pframe), ignore_received_deauth); -+ -+ if (0 == ignore_received_deauth) { -+ receive_disconnect(padapter, GetAddr3Ptr(pframe), reason); -+ } -+ } -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = false; -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnDisassoc(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned short reason; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ -+ /* check A3 */ -+ if (memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN)) -+ return _SUCCESS; -+ -+ reason = le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN)); -+ -+ DBG_871X("%s Reason code(%d)\n", __func__, reason); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) { -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ /* spin_lock_bh(&(pstapriv->sta_hash_lock)); */ -+ /* rtw_free_stainfo(padapter, psta); */ -+ /* spin_unlock_bh(&(pstapriv->sta_hash_lock)); */ -+ -+ DBG_871X_LEVEL(_drv_always_, "ap recv disassoc reason code(%d) sta:%pM\n", -+ reason, GetAddr2Ptr(pframe)); -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta) { -+ u8 updated = false; -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ if (list_empty(&psta->asoc_list) == false) { -+ list_del_init(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, false, reason); -+ -+ } -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+ associated_clients_update(padapter, updated); -+ } -+ -+ return _SUCCESS; -+ } else{ -+ DBG_871X_LEVEL(_drv_always_, "sta recv disassoc reason code(%d) sta:%pM\n", -+ reason, GetAddr3Ptr(pframe)); -+ -+ receive_disconnect(padapter, GetAddr3Ptr(pframe), reason); -+ } -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = false; -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnAtim(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ DBG_871X("%s\n", __func__); -+ return _SUCCESS; -+} -+ -+unsigned int on_action_spct(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned int ret = _FAIL; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ u8 *frame_body = (u8 *)(pframe + sizeof(struct ieee80211_hdr_3addr)); -+ u8 category; -+ u8 action; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev)); -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ -+ if (!psta) -+ goto exit; -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_SPECTRUM_MGMT) -+ goto exit; -+ -+ action = frame_body[1]; -+ switch (action) { -+ case RTW_WLAN_ACTION_SPCT_MSR_REQ: -+ case RTW_WLAN_ACTION_SPCT_MSR_RPRT: -+ case RTW_WLAN_ACTION_SPCT_TPC_REQ: -+ case RTW_WLAN_ACTION_SPCT_TPC_RPRT: -+ case RTW_WLAN_ACTION_SPCT_CHL_SWITCH: -+ break; -+ default: -+ break; -+ } -+ -+exit: -+ return ret; -+} -+ -+unsigned int OnAction_back(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ u8 *addr; -+ struct sta_info *psta = NULL; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ unsigned char *frame_body; -+ unsigned char category, action; -+ unsigned short tid, status, reason_code = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("%s\n", __func__); -+ -+ /* check RA matches or not */ -+ if (memcmp(myid(&(padapter->eeprompriv)), GetAddr1Ptr(pframe), ETH_ALEN))/* for if1, sta/ap mode */ -+ return _SUCCESS; -+ -+ if ((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) -+ if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) -+ return _SUCCESS; -+ -+ addr = GetAddr2Ptr(pframe); -+ psta = rtw_get_stainfo(pstapriv, addr); -+ -+ if (psta == NULL) -+ return _SUCCESS; -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct ieee80211_hdr_3addr)); -+ -+ category = frame_body[0]; -+ if (category == RTW_WLAN_CATEGORY_BACK) {/* representing Block Ack */ -+ if (!pmlmeinfo->HT_enable) { -+ return _SUCCESS; -+ } -+ -+ action = frame_body[1]; -+ DBG_871X("%s, action =%d\n", __func__, action); -+ switch (action) { -+ case RTW_WLAN_ACTION_ADDBA_REQ: /* ADDBA request */ -+ -+ memcpy(&(pmlmeinfo->ADDBA_req), &(frame_body[2]), sizeof(struct ADDBA_request)); -+ /* process_addba_req(padapter, (u8 *)&(pmlmeinfo->ADDBA_req), GetAddr3Ptr(pframe)); */ -+ process_addba_req(padapter, (u8 *)&(pmlmeinfo->ADDBA_req), addr); -+ -+ if (pmlmeinfo->bAcceptAddbaReq == true) { -+ issue_action_BA(padapter, addr, RTW_WLAN_ACTION_ADDBA_RESP, 0); -+ } else{ -+ issue_action_BA(padapter, addr, RTW_WLAN_ACTION_ADDBA_RESP, 37);/* reject ADDBA Req */ -+ } -+ -+ break; -+ -+ case RTW_WLAN_ACTION_ADDBA_RESP: /* ADDBA response */ -+ status = RTW_GET_LE16(&frame_body[3]); -+ tid = ((frame_body[5] >> 2) & 0x7); -+ -+ if (status == 0) { -+ /* successful */ -+ DBG_871X("agg_enable for TID =%d\n", tid); -+ psta->htpriv.agg_enable_bitmap |= 1 << tid; -+ psta->htpriv.candidate_tid_bitmap &= ~BIT(tid); -+ } else{ -+ psta->htpriv.agg_enable_bitmap &= ~BIT(tid); -+ } -+ -+ if (psta->state & WIFI_STA_ALIVE_CHK_STATE) { -+ DBG_871X("%s alive check - rx ADDBA response\n", __func__); -+ psta->htpriv.agg_enable_bitmap &= ~BIT(tid); -+ psta->expire_to = pstapriv->expire_to; -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ } -+ -+ /* DBG_871X("marc: ADDBA RSP: %x\n", pmlmeinfo->agg_enable_bitmap); */ -+ break; -+ -+ case RTW_WLAN_ACTION_DELBA: /* DELBA */ -+ if ((frame_body[3] & BIT(3)) == 0) { -+ psta->htpriv.agg_enable_bitmap &= ~(1 << ((frame_body[3] >> 4) & 0xf)); -+ psta->htpriv.candidate_tid_bitmap &= ~(1 << ((frame_body[3] >> 4) & 0xf)); -+ -+ /* reason_code = frame_body[4] | (frame_body[5] << 8); */ -+ reason_code = RTW_GET_LE16(&frame_body[4]); -+ } else if ((frame_body[3] & BIT(3)) == BIT(3)) { -+ tid = (frame_body[3] >> 4) & 0x0F; -+ -+ preorder_ctrl = &psta->recvreorder_ctrl[tid]; -+ preorder_ctrl->enable = false; -+ preorder_ctrl->indicate_seq = 0xffff; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq); -+ #endif -+ } -+ -+ DBG_871X("%s(): DELBA: %x(%x)\n", __func__, pmlmeinfo->agg_enable_bitmap, reason_code); -+ /* todo: how to notify the host while receiving DELETE BA */ -+ break; -+ -+ default: -+ break; -+ } -+ } -+ return _SUCCESS; -+} -+ -+static s32 rtw_action_public_decache(union recv_frame *recv_frame, s32 token) -+{ -+ struct adapter *adapter = recv_frame->u.hdr.adapter; -+ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); -+ u8 *frame = recv_frame->u.hdr.rx_data; -+ u16 seq_ctrl = ((recv_frame->u.hdr.attrib.seq_num&0xffff) << 4) | -+ (recv_frame->u.hdr.attrib.frag_num & 0xf); -+ -+ if (GetRetry(frame)) { -+ if (token >= 0) { -+ if ((seq_ctrl == mlmeext->action_public_rxseq) -+ && (token == mlmeext->action_public_dialog_token)) { -+ DBG_871X(FUNC_ADPT_FMT" seq_ctrl = 0x%x, rxseq = 0x%x, token:%d\n", -+ FUNC_ADPT_ARG(adapter), seq_ctrl, mlmeext->action_public_rxseq, token); -+ return _FAIL; -+ } -+ } else { -+ if (seq_ctrl == mlmeext->action_public_rxseq) { -+ DBG_871X(FUNC_ADPT_FMT" seq_ctrl = 0x%x, rxseq = 0x%x\n", -+ FUNC_ADPT_ARG(adapter), seq_ctrl, mlmeext->action_public_rxseq); -+ return _FAIL; -+ } -+ } -+ } -+ -+ mlmeext->action_public_rxseq = seq_ctrl; -+ -+ if (token >= 0) -+ mlmeext->action_public_dialog_token = token; -+ -+ return _SUCCESS; -+} -+ -+static unsigned int on_action_public_p2p(union recv_frame *precv_frame) -+{ -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ u8 *frame_body; -+ u8 dialogToken = 0; -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct ieee80211_hdr_3addr)); -+ -+ dialogToken = frame_body[7]; -+ -+ if (rtw_action_public_decache(precv_frame, dialogToken) == _FAIL) -+ return _FAIL; -+ -+ return _SUCCESS; -+} -+ -+static unsigned int on_action_public_vendor(union recv_frame *precv_frame) -+{ -+ unsigned int ret = _FAIL; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ u8 *frame_body = pframe + sizeof(struct ieee80211_hdr_3addr); -+ -+ if (!memcmp(frame_body + 2, P2P_OUI, 4)) { -+ ret = on_action_public_p2p(precv_frame); -+ } -+ -+ return ret; -+} -+ -+static unsigned int on_action_public_default(union recv_frame *precv_frame, u8 action) -+{ -+ unsigned int ret = _FAIL; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint frame_len = precv_frame->u.hdr.len; -+ u8 *frame_body = pframe + sizeof(struct ieee80211_hdr_3addr); -+ u8 token; -+ struct adapter *adapter = precv_frame->u.hdr.adapter; -+ int cnt = 0; -+ char msg[64]; -+ -+ token = frame_body[2]; -+ -+ if (rtw_action_public_decache(precv_frame, token) == _FAIL) -+ goto exit; -+ -+ cnt += sprintf((msg+cnt), "%s(token:%u)", action_public_str(action), token); -+ rtw_cfg80211_rx_action(adapter, pframe, frame_len, msg); -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+unsigned int on_action_public(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned int ret = _FAIL; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ u8 *frame_body = pframe + sizeof(struct ieee80211_hdr_3addr); -+ u8 category, action; -+ -+ /* check RA matches or not */ -+ if (memcmp(myid(&(padapter->eeprompriv)), GetAddr1Ptr(pframe), ETH_ALEN)) -+ goto exit; -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_PUBLIC) -+ goto exit; -+ -+ action = frame_body[1]; -+ switch (action) { -+ case ACT_PUBLIC_VENDOR: -+ ret = on_action_public_vendor(precv_frame); -+ break; -+ default: -+ ret = on_action_public_default(precv_frame, action); -+ break; -+ } -+ -+exit: -+ return ret; -+} -+ -+unsigned int OnAction_ht(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ u8 *frame_body = pframe + sizeof(struct ieee80211_hdr_3addr); -+ u8 category, action; -+ -+ /* check RA matches or not */ -+ if (memcmp(myid(&(padapter->eeprompriv)), GetAddr1Ptr(pframe), ETH_ALEN)) -+ goto exit; -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_HT) -+ goto exit; -+ -+ action = frame_body[1]; -+ switch (action) { -+ case RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING: -+ break; -+ default: -+ break; -+ } -+ -+exit: -+ -+ return _SUCCESS; -+} -+ -+unsigned int OnAction_sa_query(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ unsigned short tid; -+ /* Baron */ -+ -+ DBG_871X("OnAction_sa_query\n"); -+ -+ switch (pframe[WLAN_HDR_A3_LEN+1]) { -+ case 0: /* SA Query req */ -+ memcpy(&tid, &pframe[WLAN_HDR_A3_LEN+2], sizeof(unsigned short)); -+ DBG_871X("OnAction_sa_query request, action =%d, tid =%04x\n", pframe[WLAN_HDR_A3_LEN+1], tid); -+ issue_action_SA_Query(padapter, GetAddr2Ptr(pframe), 1, tid); -+ break; -+ -+ case 1: /* SA Query rsp */ -+ del_timer_sync(&pmlmeext->sa_query_timer); -+ DBG_871X("OnAction_sa_query response, action =%d, tid =%04x, cancel timer\n", pframe[WLAN_HDR_A3_LEN+1], pframe[WLAN_HDR_A3_LEN+2]); -+ break; -+ default: -+ break; -+ } -+ if (0) { -+ int pp; -+ printk("pattrib->pktlen = %d =>", pattrib->pkt_len); -+ for (pp = 0; pp < pattrib->pkt_len; pp++) -+ printk(" %02x ", pframe[pp]); -+ printk("\n"); -+ } -+ -+ return _SUCCESS; -+} -+ -+unsigned int OnAction(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ int i; -+ unsigned char category; -+ struct action_handler *ptable; -+ unsigned char *frame_body; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct ieee80211_hdr_3addr)); -+ -+ category = frame_body[0]; -+ -+ for (i = 0; i < sizeof(OnAction_tbl)/sizeof(struct action_handler); i++) { -+ ptable = &OnAction_tbl[i]; -+ -+ if (category == ptable->num) -+ ptable->func(padapter, precv_frame); -+ -+ } -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int DoReserved(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ -+ /* DBG_871X("rcvd mgt frame(%x, %x)\n", (GetFrameSubType(pframe) >> 4), *(unsigned int *)GetAddr1Ptr(pframe)); */ -+ return _SUCCESS; -+} -+ -+static struct xmit_frame *_alloc_mgtxmitframe(struct xmit_priv *pxmitpriv, bool once) -+{ -+ struct xmit_frame *pmgntframe; -+ struct xmit_buf *pxmitbuf; -+ -+ if (once) -+ pmgntframe = rtw_alloc_xmitframe_once(pxmitpriv); -+ else -+ pmgntframe = rtw_alloc_xmitframe_ext(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ DBG_871X(FUNC_ADPT_FMT" alloc xmitframe fail, once:%d\n", FUNC_ADPT_ARG(pxmitpriv->adapter), once); -+ goto exit; -+ } -+ -+ pxmitbuf = rtw_alloc_xmitbuf_ext(pxmitpriv); -+ if (pxmitbuf == NULL) { -+ DBG_871X(FUNC_ADPT_FMT" alloc xmitbuf fail\n", FUNC_ADPT_ARG(pxmitpriv->adapter)); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ pmgntframe = NULL; -+ goto exit; -+ } -+ -+ pmgntframe->frame_tag = MGNT_FRAMETAG; -+ pmgntframe->pxmitbuf = pxmitbuf; -+ pmgntframe->buf_addr = pxmitbuf->pbuf; -+ pxmitbuf->priv_data = pmgntframe; -+ -+exit: -+ return pmgntframe; -+ -+} -+ -+inline struct xmit_frame *alloc_mgtxmitframe(struct xmit_priv *pxmitpriv) -+{ -+ return _alloc_mgtxmitframe(pxmitpriv, false); -+} -+ -+/**************************************************************************** -+ -+Following are some TX fuctions for WiFi MLME -+ -+*****************************************************************************/ -+ -+void update_mgnt_tx_rate(struct adapter *padapter, u8 rate) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ pmlmeext->tx_rate = rate; -+ /* DBG_871X("%s(): rate = %x\n", __func__, rate); */ -+} -+ -+void update_mgntframe_attrib(struct adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ u8 wireless_mode; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ /* memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib)); */ -+ -+ pattrib->hdrlen = 24; -+ pattrib->nr_frags = 1; -+ pattrib->priority = 7; -+ pattrib->mac_id = 0; -+ pattrib->qsel = 0x12; -+ -+ pattrib->pktlen = 0; -+ -+ if (pmlmeext->tx_rate == IEEE80211_CCK_RATE_1MB) -+ wireless_mode = WIRELESS_11B; -+ else -+ wireless_mode = WIRELESS_11G; -+ pattrib->raid = rtw_get_mgntframe_raid(padapter, wireless_mode); -+ pattrib->rate = pmlmeext->tx_rate; -+ -+ pattrib->encrypt = _NO_PRIVACY_; -+ pattrib->bswenc = false; -+ -+ pattrib->qos_en = false; -+ pattrib->ht_en = false; -+ pattrib->bwmode = CHANNEL_WIDTH_20; -+ pattrib->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ pattrib->sgi = false; -+ -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ -+ pattrib->retry_ctrl = true; -+ -+ pattrib->mbssid = 0; -+ -+} -+ -+void update_mgntframe_attrib_addr(struct adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ u8 *pframe; -+ struct pkt_attrib *pattrib = &pmgntframe->attrib; -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ memcpy(pattrib->ra, GetAddr1Ptr(pframe), ETH_ALEN); -+ memcpy(pattrib->ta, GetAddr2Ptr(pframe), ETH_ALEN); -+} -+ -+void dump_mgntframe(struct adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ if (padapter->bSurpriseRemoved == true || -+ padapter->bDriverStopped == true) { -+ rtw_free_xmitbuf(&padapter->xmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(&padapter->xmitpriv, pmgntframe); -+ return; -+ } -+ -+ rtw_hal_mgnt_xmit(padapter, pmgntframe); -+} -+ -+s32 dump_mgntframe_and_wait(struct adapter *padapter, struct xmit_frame *pmgntframe, int timeout_ms) -+{ -+ s32 ret = _FAIL; -+ _irqL irqL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct xmit_buf *pxmitbuf = pmgntframe->pxmitbuf; -+ struct submit_ctx sctx; -+ -+ if (padapter->bSurpriseRemoved == true || -+ padapter->bDriverStopped == true) { -+ rtw_free_xmitbuf(&padapter->xmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(&padapter->xmitpriv, pmgntframe); -+ return ret; -+ } -+ -+ rtw_sctx_init(&sctx, timeout_ms); -+ pxmitbuf->sctx = &sctx; -+ -+ ret = rtw_hal_mgnt_xmit(padapter, pmgntframe); -+ -+ if (ret == _SUCCESS) -+ ret = rtw_sctx_wait(&sctx, __func__); -+ -+ spin_lock_irqsave(&pxmitpriv->lock_sctx, irqL); -+ pxmitbuf->sctx = NULL; -+ spin_unlock_irqrestore(&pxmitpriv->lock_sctx, irqL); -+ -+ return ret; -+} -+ -+s32 dump_mgntframe_and_wait_ack(struct adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ static u8 seq_no = 0; -+ s32 ret = _FAIL; -+ u32 timeout_ms = 500;/* 500ms */ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ if (padapter->bSurpriseRemoved == true || -+ padapter->bDriverStopped == true) { -+ rtw_free_xmitbuf(&padapter->xmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(&padapter->xmitpriv, pmgntframe); -+ return -1; -+ } -+ -+ if (mutex_lock_interruptible(&pxmitpriv->ack_tx_mutex) == 0) { -+ pxmitpriv->ack_tx = true; -+ pxmitpriv->seq_no = seq_no++; -+ pmgntframe->ack_report = 1; -+ if (rtw_hal_mgnt_xmit(padapter, pmgntframe) == _SUCCESS) { -+ ret = rtw_ack_tx_wait(pxmitpriv, timeout_ms); -+ } -+ -+ pxmitpriv->ack_tx = false; -+ mutex_unlock(&pxmitpriv->ack_tx_mutex); -+ } -+ -+ return ret; -+} -+ -+static int update_hidden_ssid(u8 *ies, u32 ies_len, u8 hidden_ssid_mode) -+{ -+ u8 *ssid_ie; -+ sint ssid_len_ori; -+ int len_diff = 0; -+ -+ ssid_ie = rtw_get_ie(ies, WLAN_EID_SSID, &ssid_len_ori, ies_len); -+ -+ /* DBG_871X("%s hidden_ssid_mode:%u, ssid_ie:%p, ssid_len_ori:%d\n", __func__, hidden_ssid_mode, ssid_ie, ssid_len_ori); */ -+ -+ if (ssid_ie && ssid_len_ori > 0) { -+ switch (hidden_ssid_mode) { -+ case 1: -+ { -+ u8 *next_ie = ssid_ie + 2 + ssid_len_ori; -+ u32 remain_len = 0; -+ -+ remain_len = ies_len - (next_ie-ies); -+ -+ ssid_ie[1] = 0; -+ memcpy(ssid_ie+2, next_ie, remain_len); -+ len_diff -= ssid_len_ori; -+ -+ break; -+ } -+ case 2: -+ memset(&ssid_ie[2], 0, ssid_len_ori); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ return len_diff; -+} -+ -+void issue_beacon(struct adapter *padapter, int timeout_ms) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ unsigned int rate_len; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network); -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ /* DBG_871X("%s\n", __func__); */ -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ DBG_871X("%s, alloc mgnt frame fail\n", __func__); -+ return; -+ } -+ -+ spin_lock_bh(&pmlmepriv->bcn_update_lock); -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->qsel = 0x10; -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ -+ memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ /* pmlmeext->mgnt_seq++; */ -+ SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct ieee80211_hdr_3addr); -+ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) { -+ /* DBG_871X("ie len =%d\n", cur_network->IELength); */ -+ { -+ int len_diff; -+ memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ len_diff = update_hidden_ssid( -+ pframe+_BEACON_IE_OFFSET_ -+ , cur_network->IELength-_BEACON_IE_OFFSET_ -+ , pmlmeinfo->hidden_ssid_mode -+ ); -+ pframe += (cur_network->IELength+len_diff); -+ pattrib->pktlen += (cur_network->IELength+len_diff); -+ } -+ -+ { -+ u8 *wps_ie; -+ uint wps_ielen; -+ u8 sr = 0; -+ wps_ie = rtw_get_wps_ie(pmgntframe->buf_addr+TXDESC_OFFSET+sizeof(struct ieee80211_hdr_3addr)+_BEACON_IE_OFFSET_, -+ pattrib->pktlen-sizeof(struct ieee80211_hdr_3addr)-_BEACON_IE_OFFSET_, NULL, &wps_ielen); -+ if (wps_ie && wps_ielen > 0) { -+ rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8 *)(&sr), NULL); -+ } -+ if (sr != 0) -+ set_fwstate(pmlmepriv, WIFI_UNDER_WPS); -+ else -+ _clr_fwstate_(pmlmepriv, WIFI_UNDER_WPS); -+ } -+ -+ goto _issue_bcn; -+ -+ } -+ -+ /* below for ad-hoc mode */ -+ -+ /* timestamp will be inserted by hardware */ -+ pframe += 8; -+ pattrib->pktlen += 8; -+ -+ /* beacon interval: 2 bytes */ -+ -+ memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ /* capability info: 2 bytes */ -+ -+ memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ /* SSID */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pattrib->pktlen); -+ -+ /* supported rates... */ -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pattrib->pktlen); -+ -+ /* DS parameter set */ -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pattrib->pktlen); -+ -+ /* if ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) */ -+ { -+ u8 erpinfo = 0; -+ u32 ATIMWindow; -+ /* IBSS Parameter Set... */ -+ /* ATIMWindow = cur->Configuration.ATIMWindow; */ -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pattrib->pktlen); -+ -+ /* ERP IE */ -+ pframe = rtw_set_ie(pframe, _ERPINFO_IE_, 1, &erpinfo, &pattrib->pktlen); -+ } -+ -+ -+ /* EXTERNDED SUPPORTED RATE */ -+ if (rate_len > 8) { -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pattrib->pktlen); -+ } -+ -+ -+ /* todo:HT for adhoc */ -+ -+_issue_bcn: -+ -+ pmlmepriv->update_bcn = false; -+ -+ spin_unlock_bh(&pmlmepriv->bcn_update_lock); -+ -+ if ((pattrib->pktlen + TXDESC_SIZE) > 512) { -+ DBG_871X("beacon frame too large\n"); -+ return; -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ /* DBG_871X("issue bcn_sz =%d\n", pattrib->last_txcmdsz); */ -+ if (timeout_ms > 0) -+ dump_mgntframe_and_wait(padapter, pmgntframe, timeout_ms); -+ else -+ dump_mgntframe(padapter, pmgntframe); -+ -+} -+ -+void issue_probersp(struct adapter *padapter, unsigned char *da, u8 is_valid_p2p_probereq) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ unsigned char *mac, *bssid; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ -+ u8 *pwps_ie; -+ uint wps_ielen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network); -+ unsigned int rate_len; -+ -+ /* DBG_871X("%s\n", __func__); */ -+ -+ if (da == NULL) -+ return; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ DBG_871X("%s, alloc mgnt frame fail\n", __func__); -+ return; -+ } -+ -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ mac = myid(&(padapter->eeprompriv)); -+ bssid = cur_network->MacAddress; -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ memcpy(pwlanhdr->addr3, bssid, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(fctrl, WIFI_PROBERSP); -+ -+ pattrib->hdrlen = sizeof(struct ieee80211_hdr_3addr); -+ pattrib->pktlen = pattrib->hdrlen; -+ pframe += pattrib->hdrlen; -+ -+ -+ if (cur_network->IELength > MAX_IE_SZ) -+ return; -+ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) { -+ pwps_ie = rtw_get_wps_ie(cur_network->IEs+_FIXED_IE_LENGTH_, cur_network->IELength-_FIXED_IE_LENGTH_, NULL, &wps_ielen); -+ -+ /* inerset & update wps_probe_resp_ie */ -+ if ((pmlmepriv->wps_probe_resp_ie != NULL) && pwps_ie && (wps_ielen > 0)) { -+ uint wps_offset, remainder_ielen; -+ u8 *premainder_ie; -+ -+ wps_offset = (uint)(pwps_ie - cur_network->IEs); -+ -+ premainder_ie = pwps_ie + wps_ielen; -+ -+ remainder_ielen = cur_network->IELength - wps_offset - wps_ielen; -+ -+ memcpy(pframe, cur_network->IEs, wps_offset); -+ pframe += wps_offset; -+ pattrib->pktlen += wps_offset; -+ -+ wps_ielen = (uint)pmlmepriv->wps_probe_resp_ie[1];/* to get ie data len */ -+ if ((wps_offset+wps_ielen+2) <= MAX_IE_SZ) { -+ memcpy(pframe, pmlmepriv->wps_probe_resp_ie, wps_ielen+2); -+ pframe += wps_ielen+2; -+ pattrib->pktlen += wps_ielen+2; -+ } -+ -+ if ((wps_offset+wps_ielen+2+remainder_ielen) <= MAX_IE_SZ) { -+ memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; -+ pattrib->pktlen += remainder_ielen; -+ } -+ } else{ -+ memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ pframe += cur_network->IELength; -+ pattrib->pktlen += cur_network->IELength; -+ } -+ -+ /* retrieve SSID IE from cur_network->Ssid */ -+ { -+ u8 *ssid_ie; -+ sint ssid_ielen; -+ sint ssid_ielen_diff; -+ u8 buf[MAX_IE_SZ]; -+ u8 *ies = pmgntframe->buf_addr+TXDESC_OFFSET+sizeof(struct ieee80211_hdr_3addr); -+ -+ ssid_ie = rtw_get_ie(ies+_FIXED_IE_LENGTH_, _SSID_IE_, &ssid_ielen, -+ (pframe-ies)-_FIXED_IE_LENGTH_); -+ -+ ssid_ielen_diff = cur_network->Ssid.SsidLength - ssid_ielen; -+ -+ if (ssid_ie && cur_network->Ssid.SsidLength) { -+ uint remainder_ielen; -+ u8 *remainder_ie; -+ remainder_ie = ssid_ie+2; -+ remainder_ielen = (pframe-remainder_ie); -+ -+ if (remainder_ielen > MAX_IE_SZ) { -+ DBG_871X_LEVEL(_drv_warning_, FUNC_ADPT_FMT" remainder_ielen > MAX_IE_SZ\n", FUNC_ADPT_ARG(padapter)); -+ remainder_ielen = MAX_IE_SZ; -+ } -+ -+ memcpy(buf, remainder_ie, remainder_ielen); -+ memcpy(remainder_ie+ssid_ielen_diff, buf, remainder_ielen); -+ *(ssid_ie+1) = cur_network->Ssid.SsidLength; -+ memcpy(ssid_ie+2, cur_network->Ssid.Ssid, cur_network->Ssid.SsidLength); -+ -+ pframe += ssid_ielen_diff; -+ pattrib->pktlen += ssid_ielen_diff; -+ } -+ } -+ } else{ -+ /* timestamp will be inserted by hardware */ -+ pframe += 8; -+ pattrib->pktlen += 8; -+ -+ /* beacon interval: 2 bytes */ -+ -+ memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ /* capability info: 2 bytes */ -+ -+ memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ /* below for ad-hoc mode */ -+ -+ /* SSID */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pattrib->pktlen); -+ -+ /* supported rates... */ -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pattrib->pktlen); -+ -+ /* DS parameter set */ -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pattrib->pktlen); -+ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) { -+ u8 erpinfo = 0; -+ u32 ATIMWindow; -+ /* IBSS Parameter Set... */ -+ /* ATIMWindow = cur->Configuration.ATIMWindow; */ -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pattrib->pktlen); -+ -+ /* ERP IE */ -+ pframe = rtw_set_ie(pframe, _ERPINFO_IE_, 1, &erpinfo, &pattrib->pktlen); -+ } -+ -+ -+ /* EXTERNDED SUPPORTED RATE */ -+ if (rate_len > 8) { -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pattrib->pktlen); -+ } -+ -+ -+ /* todo:HT for adhoc */ -+ -+ } -+ -+#ifdef CONFIG_AUTO_AP_MODE -+{ -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("(%s)\n", __func__); -+ -+ /* check rc station */ -+ psta = rtw_get_stainfo(pstapriv, da); -+ if (psta && psta->isrc && psta->pid > 0) { -+ u8 RC_OUI[4] = {0x00, 0xE0, 0x4C, 0x0A}; -+ u8 RC_INFO[14] = {0}; -+ /* EID[1] + EID_LEN[1] + RC_OUI[4] + MAC[6] + PairingID[2] + ChannelNum[2] */ -+ u16 cu_ch = (u16)cur_network->Configuration.DSConfig; -+ -+ DBG_871X("%s, reply rc(pid = 0x%x) device "MAC_FMT" in ch =%d\n", __func__, -+ psta->pid, MAC_ARG(psta->hwaddr), cu_ch); -+ -+ /* append vendor specific ie */ -+ memcpy(RC_INFO, RC_OUI, sizeof(RC_OUI)); -+ memcpy(&RC_INFO[4], mac, ETH_ALEN); -+ memcpy(&RC_INFO[10], (u8 *)&psta->pid, 2); -+ memcpy(&RC_INFO[12], (u8 *)&cu_ch, 2); -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, sizeof(RC_INFO), RC_INFO, &pattrib->pktlen); -+ } -+} -+#endif /* CONFIG_AUTO_AP_MODE */ -+ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+static int _issue_probereq(struct adapter *padapter, struct ndis_802_11_ssid *pssid, u8 *da, u8 ch, bool append_wps, int wait_ack) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ unsigned char *mac; -+ unsigned char bssrate[NumRates]; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ int bssrate_len = 0; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, ("+issue_probereq\n")); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ mac = myid(&(padapter->eeprompriv)); -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ -+ if (da) { -+ /* unicast probe request frame */ -+ memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ memcpy(pwlanhdr->addr3, da, ETH_ALEN); -+ } else{ -+ /* broadcast probe request frame */ -+ memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ memcpy(pwlanhdr->addr3, bc_addr, ETH_ALEN); -+ } -+ -+ memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_PROBEREQ); -+ -+ pframe += sizeof(struct ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct ieee80211_hdr_3addr); -+ -+ if (pssid) -+ pframe = rtw_set_ie(pframe, _SSID_IE_, pssid->SsidLength, pssid->Ssid, &(pattrib->pktlen)); -+ else -+ pframe = rtw_set_ie(pframe, _SSID_IE_, 0, NULL, &(pattrib->pktlen)); -+ -+ get_rate_set(padapter, bssrate, &bssrate_len); -+ -+ if (bssrate_len > 8) { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, bssrate, &(pattrib->pktlen)); -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); -+ } else{ -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, bssrate_len, bssrate, &(pattrib->pktlen)); -+ } -+ -+ if (ch) -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, &ch, &pattrib->pktlen); -+ -+ if (append_wps) { -+ /* add wps_ie for wps2.0 */ -+ if (pmlmepriv->wps_probe_req_ie_len > 0 && pmlmepriv->wps_probe_req_ie) { -+ memcpy(pframe, pmlmepriv->wps_probe_req_ie, pmlmepriv->wps_probe_req_ie_len); -+ pframe += pmlmepriv->wps_probe_req_ie_len; -+ pattrib->pktlen += pmlmepriv->wps_probe_req_ie_len; -+ } -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, ("issuing probe_req, tx_len =%d\n", pattrib->last_txcmdsz)); -+ -+ if (wait_ack) { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+inline void issue_probereq(struct adapter *padapter, struct ndis_802_11_ssid *pssid, u8 *da) -+{ -+ _issue_probereq(padapter, pssid, da, 0, 1, false); -+} -+ -+int issue_probereq_ex(struct adapter *padapter, struct ndis_802_11_ssid *pssid, u8 *da, u8 ch, bool append_wps, -+ int try_cnt, int wait_ms) -+{ -+ int ret; -+ int i = 0; -+ -+ do { -+ ret = _issue_probereq(padapter, pssid, da, ch, append_wps, wait_ms > 0?true:false); -+ -+ i++; -+ -+ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ msleep(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+ #ifndef DBG_XMIT_ACK -+ goto exit; -+ #endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ if (da) -+ DBG_871X(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS?", acked":"", i, try_cnt, (i + 1) * wait_ms); -+ else -+ DBG_871X(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS?", acked":"", i, try_cnt, (i + 1) * wait_ms); -+ } -+exit: -+ return ret; -+} -+ -+/* if psta == NULL, indiate we are station(client) now... */ -+void issue_auth(struct adapter *padapter, struct sta_info *psta, unsigned short status) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ unsigned int val32; -+ unsigned short val16; -+ int use_shared_key = 0; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ __le16 le_tmp; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_AUTH); -+ -+ pframe += sizeof(struct ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct ieee80211_hdr_3addr); -+ -+ -+ if (psta) { /* for AP mode */ -+ memcpy(pwlanhdr->addr1, psta->hwaddr, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ /* setting auth algo number */ -+ val16 = (u16)psta->authalg; -+ -+ if (status != _STATS_SUCCESSFUL_) -+ val16 = 0; -+ -+ if (val16) -+ use_shared_key = 1; -+ -+ le_tmp = cpu_to_le16(val16); -+ -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_ALGM_NUM_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ /* setting auth seq number */ -+ val16 = (u16)psta->auth_seq; -+ le_tmp = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_SEQ_NUM_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ /* setting status code... */ -+ val16 = status; -+ le_tmp = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ /* added challenging text... */ -+ if ((psta->auth_seq == 2) && (psta->state & WIFI_FW_AUTH_STATE) && (use_shared_key == 1)) -+ pframe = rtw_set_ie(pframe, _CHLGETXT_IE_, 128, psta->chg_txt, &(pattrib->pktlen)); -+ -+ } else{ -+ memcpy(pwlanhdr->addr1, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&padapter->eeprompriv), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ -+ /* setting auth algo number */ -+ val16 = (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) ? 1 : 0;/* 0:OPEN System, 1:Shared key */ -+ if (val16) { -+ use_shared_key = 1; -+ } -+ le_tmp = cpu_to_le16(val16); -+ /* DBG_871X("%s auth_algo = %s auth_seq =%d\n", __func__, (pmlmeinfo->auth_algo == 0)?"OPEN":"SHARED", pmlmeinfo->auth_seq); */ -+ -+ /* setting IV for auth seq #3 */ -+ if ((pmlmeinfo->auth_seq == 3) && (pmlmeinfo->state & WIFI_FW_AUTH_STATE) && (use_shared_key == 1)) { -+ __le32 le_tmp32; -+ -+ /* DBG_871X("==> iv(%d), key_index(%d)\n", pmlmeinfo->iv, pmlmeinfo->key_index); */ -+ val32 = ((pmlmeinfo->iv++) | (pmlmeinfo->key_index << 30)); -+ le_tmp32 = cpu_to_le32(val32); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *)&le_tmp32, &(pattrib->pktlen)); -+ -+ pattrib->iv_len = 4; -+ } -+ -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_ALGM_NUM_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ /* setting auth seq number */ -+ le_tmp = cpu_to_le16(pmlmeinfo->auth_seq); -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_SEQ_NUM_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ -+ /* setting status code... */ -+ le_tmp = cpu_to_le16(status); -+ pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ /* then checking to see if sending challenging text... */ -+ if ((pmlmeinfo->auth_seq == 3) && (pmlmeinfo->state & WIFI_FW_AUTH_STATE) && (use_shared_key == 1)) { -+ pframe = rtw_set_ie(pframe, _CHLGETXT_IE_, 128, pmlmeinfo->chg_txt, &(pattrib->pktlen)); -+ -+ SetPrivacy(fctrl); -+ -+ pattrib->hdrlen = sizeof(struct ieee80211_hdr_3addr); -+ -+ pattrib->encrypt = _WEP40_; -+ -+ pattrib->icv_len = 4; -+ -+ pattrib->pktlen += pattrib->icv_len; -+ -+ } -+ -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ rtw_wep_encrypt(padapter, (u8 *)pmgntframe); -+ DBG_871X("%s\n", __func__); -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+} -+ -+ -+void issue_asocrsp(struct adapter *padapter, unsigned short status, struct sta_info *pstat, int pkt_type) -+{ -+ struct xmit_frame *pmgntframe; -+ struct ieee80211_hdr *pwlanhdr; -+ struct pkt_attrib *pattrib; -+ unsigned char *pbuf, *pframe; -+ unsigned short val; -+ __le16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *pnetwork = &(pmlmeinfo->network); -+ u8 *ie = pnetwork->IEs; -+ __le16 lestatus, le_tmp; -+ -+ DBG_871X("%s\n", __func__); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ -+ memcpy((void *)GetAddr1Ptr(pwlanhdr), pstat->hwaddr, ETH_ALEN); -+ memcpy((void *)GetAddr2Ptr(pwlanhdr), myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy((void *)GetAddr3Ptr(pwlanhdr), get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ if ((pkt_type == WIFI_ASSOCRSP) || (pkt_type == WIFI_REASSOCRSP)) -+ SetFrameSubType(pwlanhdr, pkt_type); -+ else -+ return; -+ -+ pattrib->hdrlen = sizeof(struct ieee80211_hdr_3addr); -+ pattrib->pktlen += pattrib->hdrlen; -+ pframe += pattrib->hdrlen; -+ -+ /* capability */ -+ val = *(unsigned short *)rtw_get_capability_from_ie(ie); -+ -+ pframe = rtw_set_fixed_ie(pframe, _CAPABILITY_, (unsigned char *)&val, &(pattrib->pktlen)); -+ -+ lestatus = cpu_to_le16(status); -+ pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&lestatus, &(pattrib->pktlen)); -+ -+ le_tmp = cpu_to_le16(pstat->aid | BIT(14) | BIT(15)); -+ pframe = rtw_set_fixed_ie(pframe, _ASOC_ID_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ if (pstat->bssratelen <= 8) { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, pstat->bssratelen, pstat->bssrateset, &(pattrib->pktlen)); -+ } else{ -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pstat->bssrateset, &(pattrib->pktlen)); -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (pstat->bssratelen-8), pstat->bssrateset+8, &(pattrib->pktlen)); -+ } -+ -+ if ((pstat->flags & WLAN_STA_HT) && (pmlmepriv->htpriv.ht_option)) { -+ uint ie_len = 0; -+ -+ /* FILL HT CAP INFO IE */ -+ /* p = hostapd_eid_ht_capabilities_info(hapd, p); */ -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (pbuf && ie_len > 0) { -+ memcpy(pframe, pbuf, ie_len+2); -+ pframe += (ie_len+2); -+ pattrib->pktlen += (ie_len+2); -+ } -+ -+ /* FILL HT ADD INFO IE */ -+ /* p = hostapd_eid_ht_operation(hapd, p); */ -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (pbuf && ie_len > 0) { -+ memcpy(pframe, pbuf, ie_len+2); -+ pframe += (ie_len+2); -+ pattrib->pktlen += (ie_len+2); -+ } -+ -+ } -+ -+ /* FILL WMM IE */ -+ if ((pstat->flags & WLAN_STA_WME) && (pmlmepriv->qospriv.qos_option)) { -+ uint ie_len = 0; -+ unsigned char WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; -+ -+ for (pbuf = ie + _BEACON_IE_OFFSET_; ; pbuf += (ie_len + 2)) { -+ pbuf = rtw_get_ie(pbuf, _VENDOR_SPECIFIC_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); -+ if (pbuf && !memcmp(pbuf+2, WMM_PARA_IE, 6)) { -+ memcpy(pframe, pbuf, ie_len+2); -+ pframe += (ie_len+2); -+ pattrib->pktlen += (ie_len+2); -+ -+ break; -+ } -+ -+ if ((pbuf == NULL) || (ie_len == 0)) { -+ break; -+ } -+ } -+ -+ } -+ -+ -+ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK) { -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 6, REALTEK_96B_IE, &(pattrib->pktlen)); -+ } -+ -+ /* add WPS IE ie for wps 2.0 */ -+ if (pmlmepriv->wps_assoc_resp_ie && pmlmepriv->wps_assoc_resp_ie_len > 0) { -+ memcpy(pframe, pmlmepriv->wps_assoc_resp_ie, pmlmepriv->wps_assoc_resp_ie_len); -+ -+ pframe += pmlmepriv->wps_assoc_resp_ie_len; -+ pattrib->pktlen += pmlmepriv->wps_assoc_resp_ie_len; -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+} -+ -+void issue_assocreq(struct adapter *padapter) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ __le16 val16; -+ unsigned int i, j, index = 0; -+ unsigned char bssrate[NumRates], sta_bssrate[NumRates]; -+ struct ndis_80211_var_ie *pIE; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int bssrate_len = 0, sta_bssrate_len = 0; -+ u8 vs_ie_length = 0; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ASSOCREQ); -+ -+ pframe += sizeof(struct ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct ieee80211_hdr_3addr); -+ -+ /* caps */ -+ memcpy(pframe, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ /* listen interval */ -+ /* todo: listen interval for power saving */ -+ val16 = cpu_to_le16(3); -+ memcpy(pframe, (unsigned char *)&val16, 2); -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ /* SSID */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, pmlmeinfo->network.Ssid.SsidLength, pmlmeinfo->network.Ssid.Ssid, &(pattrib->pktlen)); -+ -+ /* supported rate & extended supported rate */ -+ -+ /* Check if the AP's supported rates are also supported by STA. */ -+ get_rate_set(padapter, sta_bssrate, &sta_bssrate_len); -+ /* DBG_871X("sta_bssrate_len =%d\n", sta_bssrate_len); */ -+ -+ if (pmlmeext->cur_channel == 14) /* for JAPAN, channel 14 can only uses B Mode(CCK) */ -+ sta_bssrate_len = 4; -+ -+ -+ /* for (i = 0; i < sta_bssrate_len; i++) { */ -+ /* DBG_871X("sta_bssrate[%d]=%02X\n", i, sta_bssrate[i]); */ -+ /* */ -+ -+ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { -+ if (pmlmeinfo->network.SupportedRates[i] == 0) -+ break; -+ DBG_871X("network.SupportedRates[%d]=%02X\n", i, pmlmeinfo->network.SupportedRates[i]); -+ } -+ -+ -+ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { -+ if (pmlmeinfo->network.SupportedRates[i] == 0) -+ break; -+ -+ -+ /* Check if the AP's supported rates are also supported by STA. */ -+ for (j = 0; j < sta_bssrate_len; j++) { -+ /* Avoid the proprietary data rate (22Mbps) of Handlink WSG-4000 AP */ -+ if ((pmlmeinfo->network.SupportedRates[i]|IEEE80211_BASIC_RATE_MASK) -+ == (sta_bssrate[j]|IEEE80211_BASIC_RATE_MASK)) { -+ /* DBG_871X("match i = %d, j =%d\n", i, j); */ -+ break; -+ } else { -+ /* DBG_871X("not match: %02X != %02X\n", (pmlmeinfo->network.SupportedRates[i]|IEEE80211_BASIC_RATE_MASK), (sta_bssrate[j]|IEEE80211_BASIC_RATE_MASK)); */ -+ } -+ } -+ -+ if (j == sta_bssrate_len) { -+ /* the rate is not supported by STA */ -+ DBG_871X("%s(): the rate[%d]=%02X is not supported by STA!\n", __func__, i, pmlmeinfo->network.SupportedRates[i]); -+ } else { -+ /* the rate is supported by STA */ -+ bssrate[index++] = pmlmeinfo->network.SupportedRates[i]; -+ } -+ } -+ -+ bssrate_len = index; -+ DBG_871X("bssrate_len = %d\n", bssrate_len); -+ -+ if (bssrate_len == 0) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; /* don't connect to AP if no joint supported rate */ -+ } -+ -+ -+ if (bssrate_len > 8) { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, bssrate, &(pattrib->pktlen)); -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); -+ } else -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, bssrate_len, bssrate, &(pattrib->pktlen)); -+ -+ /* vendor specific IE, such as WPA, WMM, WPS */ -+ for (i = sizeof(struct ndis_802_11_fix_ie); i < pmlmeinfo->network.IELength;) { -+ pIE = (struct ndis_80211_var_ie *)(pmlmeinfo->network.IEs + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_: -+ if ((!memcmp(pIE->data, RTW_WPA_OUI, 4)) || -+ (!memcmp(pIE->data, WMM_OUI, 4)) || -+ (!memcmp(pIE->data, WPS_OUI, 4))) { -+ vs_ie_length = pIE->Length; -+ if ((!padapter->registrypriv.wifi_spec) && (!memcmp(pIE->data, WPS_OUI, 4))) { -+ /* Commented by Kurt 20110629 */ -+ /* In some older APs, WPS handshake */ -+ /* would be fail if we append vender extensions informations to AP */ -+ -+ vs_ie_length = 14; -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, vs_ie_length, pIE->data, &(pattrib->pktlen)); -+ } -+ break; -+ -+ case EID_WPA2: -+ pframe = rtw_set_ie(pframe, EID_WPA2, pIE->Length, pIE->data, &(pattrib->pktlen)); -+ break; -+ case EID_HTCapability: -+ if (padapter->mlmepriv.htpriv.ht_option == true) { -+ if (!(is_ap_in_tkip(padapter))) { -+ memcpy(&(pmlmeinfo->HT_caps), pIE->data, sizeof(struct HT_caps_element)); -+ pframe = rtw_set_ie(pframe, EID_HTCapability, pIE->Length, (u8 *)(&(pmlmeinfo->HT_caps)), &(pattrib->pktlen)); -+ } -+ } -+ break; -+ -+ case EID_EXTCapability: -+ if (padapter->mlmepriv.htpriv.ht_option == true) -+ pframe = rtw_set_ie(pframe, EID_EXTCapability, pIE->Length, pIE->data, &(pattrib->pktlen)); -+ break; -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK) -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 6, REALTEK_96B_IE, &(pattrib->pktlen)); -+ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ -+ ret = _SUCCESS; -+ -+exit: -+ if (ret == _SUCCESS) -+ rtw_buf_update(&pmlmepriv->assoc_req, &pmlmepriv->assoc_req_len, (u8 *)pwlanhdr, pattrib->pktlen); -+ else -+ rtw_buf_free(&pmlmepriv->assoc_req, &pmlmepriv->assoc_req_len); -+ -+ return; -+} -+ -+/* when wait_ack is ture, this function shoule be called at process context */ -+static int _issue_nulldata(struct adapter *padapter, unsigned char *da, unsigned int power_mode, int wait_ack) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ -+ /* DBG_871X("%s:%d\n", __func__, power_mode); */ -+ -+ if (!padapter) -+ goto exit; -+ -+ pxmitpriv = &(padapter->xmitpriv); -+ pmlmeext = &(padapter->mlmeextpriv); -+ pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = false; -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ SetFrDs(fctrl); -+ else if ((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) -+ SetToDs(fctrl); -+ -+ if (power_mode) -+ SetPwrMgt(fctrl); -+ -+ memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_DATA_NULL); -+ -+ pframe += sizeof(struct ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct ieee80211_hdr_3addr); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if (wait_ack) { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } else{ -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+/* -+ * [IMPORTANT] Don't call this function in interrupt context -+ * -+ * When wait_ms > 0, this function shoule be called at process context -+ * da == NULL for station mode -+ */ -+int issue_nulldata(struct adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) -+{ -+ int ret; -+ int i = 0; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_info *psta; -+ -+ -+ /* da == NULL, assum it's null data for sta to ap*/ -+ if (da == NULL) -+ da = get_my_bssid(&(pmlmeinfo->network)); -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, da); -+ if (psta) { -+ if (power_mode) -+ rtw_hal_macid_sleep(padapter, psta->mac_id); -+ else -+ rtw_hal_macid_wakeup(padapter, psta->mac_id); -+ } else { -+ DBG_871X(FUNC_ADPT_FMT ": Can't find sta info for " MAC_FMT ", skip macid %s!!\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), power_mode?"sleep":"wakeup"); -+ rtw_warn_on(1); -+ } -+ -+ do { -+ ret = _issue_nulldata(padapter, da, power_mode, wait_ms > 0?true:false); -+ -+ i++; -+ -+ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ msleep(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+ #ifndef DBG_XMIT_ACK -+ goto exit; -+ #endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ if (da) -+ DBG_871X(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS?", acked":"", i, try_cnt, (i + 1) * wait_ms); -+ else -+ DBG_871X(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS?", acked":"", i, try_cnt, (i + 1) * wait_ms); -+ } -+exit: -+ return ret; -+} -+ -+/* -+ * [IMPORTANT] This function run in interrupt context -+ * -+ * The null data packet would be sent without power bit, -+ * and not guarantee success. -+ */ -+s32 issue_nulldata_in_interrupt(struct adapter *padapter, u8 *da) -+{ -+ int ret; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ /* da == NULL, assum it's null data for sta to ap*/ -+ if (da == NULL) -+ da = get_my_bssid(&(pmlmeinfo->network)); -+ -+ ret = _issue_nulldata(padapter, da, 0, false); -+ -+ return ret; -+} -+ -+/* when wait_ack is ture, this function shoule be called at process context */ -+static int _issue_qos_nulldata(struct adapter *padapter, unsigned char *da, u16 tid, int wait_ack) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ u16 *qc; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ DBG_871X("%s\n", __func__); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ pattrib->hdrlen += 2; -+ pattrib->qos_en = true; -+ pattrib->eosp = 1; -+ pattrib->ack_policy = 0; -+ pattrib->mdata = 0; -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ SetFrDs(fctrl); -+ else if ((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) -+ SetToDs(fctrl); -+ -+ if (pattrib->mdata) -+ SetMData(fctrl); -+ -+ qc = (unsigned short *)(pframe + pattrib->hdrlen - 2); -+ -+ SetPriority(qc, tid); -+ -+ SetEOSP(qc, pattrib->eosp); -+ -+ SetAckpolicy(qc, pattrib->ack_policy); -+ -+ memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); -+ -+ pframe += sizeof(struct ieee80211_qos_hdr); -+ pattrib->pktlen = sizeof(struct ieee80211_qos_hdr); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if (wait_ack) { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } else{ -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+/* when wait_ms >0 , this function shoule be called at process context */ -+/* da == NULL for station mode */ -+int issue_qos_nulldata(struct adapter *padapter, unsigned char *da, u16 tid, int try_cnt, int wait_ms) -+{ -+ int ret; -+ int i = 0; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* da == NULL, assum it's null data for sta to ap*/ -+ if (da == NULL) -+ da = get_my_bssid(&(pmlmeinfo->network)); -+ -+ do { -+ ret = _issue_qos_nulldata(padapter, da, tid, wait_ms > 0?true:false); -+ -+ i++; -+ -+ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ msleep(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+ #ifndef DBG_XMIT_ACK -+ goto exit; -+ #endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ if (da) -+ DBG_871X(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS?", acked":"", i, try_cnt, (i + 1) * wait_ms); -+ else -+ DBG_871X(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS?", acked":"", i, try_cnt, (i + 1) * wait_ms); -+ } -+exit: -+ return ret; -+} -+ -+static int _issue_deauth(struct adapter *padapter, unsigned char *da, unsigned short reason, u8 wait_ack) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int ret = _FAIL; -+ __le16 le_tmp; -+ -+ /* DBG_871X("%s to "MAC_FMT"\n", __func__, MAC_ARG(da)); */ -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ goto exit; -+ } -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = false; -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ -+ memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_DEAUTH); -+ -+ pframe += sizeof(struct ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct ieee80211_hdr_3addr); -+ -+ le_tmp = cpu_to_le16(reason); -+ pframe = rtw_set_fixed_ie(pframe, _RSON_CODE_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ -+ if (wait_ack) { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } else{ -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+int issue_deauth(struct adapter *padapter, unsigned char *da, unsigned short reason) -+{ -+ DBG_871X("%s to "MAC_FMT"\n", __func__, MAC_ARG(da)); -+ return _issue_deauth(padapter, da, reason, false); -+} -+ -+int issue_deauth_ex(struct adapter *padapter, u8 *da, unsigned short reason, int try_cnt, -+ int wait_ms) -+{ -+ int ret; -+ int i = 0; -+ -+ do { -+ ret = _issue_deauth(padapter, da, reason, wait_ms > 0?true:false); -+ -+ i++; -+ -+ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ msleep(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+ #ifndef DBG_XMIT_ACK -+ goto exit; -+ #endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ if (da) -+ DBG_871X(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS?", acked":"", i, try_cnt, (i + 1) * wait_ms); -+ else -+ DBG_871X(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS?", acked":"", i, try_cnt, (i + 1) * wait_ms); -+ } -+exit: -+ return ret; -+} -+ -+void issue_action_SA_Query(struct adapter *padapter, unsigned char *raddr, unsigned char action, unsigned short tid) -+{ -+ u8 category = RTW_WLAN_CATEGORY_SA_QUERY; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ u8 *pframe; -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ __le16 le_tmp; -+ -+ DBG_871X("%s\n", __func__); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ DBG_871X("%s: alloc_mgtxmitframe fail\n", __func__); -+ return; -+ } -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ -+ if (raddr) -+ memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ else -+ memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &category, &pattrib->pktlen); -+ pframe = rtw_set_fixed_ie(pframe, 1, &action, &pattrib->pktlen); -+ -+ switch (action) { -+ case 0: /* SA Query req */ -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)&pmlmeext->sa_query_seq, &pattrib->pktlen); -+ pmlmeext->sa_query_seq++; -+ /* send sa query request to AP, AP should reply sa query response in 1 second */ -+ set_sa_query_timer(pmlmeext, 1000); -+ break; -+ -+ case 1: /* SA Query rsp */ -+ le_tmp = cpu_to_le16(tid); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)&le_tmp, &pattrib->pktlen); -+ break; -+ default: -+ break; -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+} -+ -+void issue_action_BA(struct adapter *padapter, unsigned char *raddr, unsigned char action, unsigned short status) -+{ -+ u8 category = RTW_WLAN_CATEGORY_BACK; -+ u16 start_seq; -+ u16 BA_para_set; -+ u16 reason_code; -+ u16 BA_timeout_value; -+ u16 BA_starting_seqctrl = 0; -+ enum HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ u8 *pframe; -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ __le16 le_tmp; -+ -+ DBG_871X("%s, category =%d, action =%d, status =%d\n", __func__, category, action, status); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ -+ /* memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); */ -+ memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ -+ if (category == 3) { -+ switch (action) { -+ case 0: /* ADDBA req */ -+ do { -+ pmlmeinfo->dialogToken++; -+ } while (pmlmeinfo->dialogToken == 0); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(pmlmeinfo->dialogToken), &(pattrib->pktlen)); -+ -+ if (rtw_btcoex_IsBTCoexCtrlAMPDUSize(padapter)) { -+ /* A-MSDU NOT Supported */ -+ BA_para_set = 0; -+ /* immediate Block Ack */ -+ BA_para_set |= (1 << 1) & IEEE80211_ADDBA_PARAM_POLICY_MASK; -+ /* TID */ -+ BA_para_set |= (status << 2) & IEEE80211_ADDBA_PARAM_TID_MASK; -+ /* max buffer size is 8 MSDU */ -+ BA_para_set |= (8 << 6) & RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; -+ } else { -+ BA_para_set = (0x1002 | ((status & 0xf) << 2)); /* immediate ack & 64 buffer size */ -+ } -+ le_tmp = cpu_to_le16(BA_para_set); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); -+ -+ BA_timeout_value = 5000;/* 5ms */ -+ le_tmp = cpu_to_le16(BA_timeout_value); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); -+ -+ /* if ((psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress)) != NULL) */ -+ psta = rtw_get_stainfo(pstapriv, raddr); -+ if (psta != NULL) { -+ start_seq = (psta->sta_xmitpriv.txseq_tid[status & 0x07]&0xfff) + 1; -+ -+ DBG_871X("BA_starting_seqctrl = %d for TID =%d\n", start_seq, status & 0x07); -+ -+ psta->BA_starting_seqctrl[status & 0x07] = start_seq; -+ -+ BA_starting_seqctrl = start_seq << 4; -+ } -+ -+ le_tmp = cpu_to_le16(BA_starting_seqctrl); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); -+ break; -+ -+ case 1: /* ADDBA rsp */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(pmlmeinfo->ADDBA_req.dialog_token), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&status), &(pattrib->pktlen)); -+ if (padapter->driver_rx_ampdu_factor != 0xFF) -+ max_rx_ampdu_factor = -+ (enum HT_CAP_AMPDU_FACTOR)padapter->driver_rx_ampdu_factor; -+ else -+ rtw_hal_get_def_var(padapter, -+ HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); -+ -+ if (MAX_AMPDU_FACTOR_64K == max_rx_ampdu_factor) -+ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x1000); /* 64 buffer size */ -+ else if (MAX_AMPDU_FACTOR_32K == max_rx_ampdu_factor) -+ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x0800); /* 32 buffer size */ -+ else if (MAX_AMPDU_FACTOR_16K == max_rx_ampdu_factor) -+ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x0400); /* 16 buffer size */ -+ else if (MAX_AMPDU_FACTOR_8K == max_rx_ampdu_factor) -+ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x0200); /* 8 buffer size */ -+ else -+ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x1000); /* 64 buffer size */ -+ -+ if (rtw_btcoex_IsBTCoexCtrlAMPDUSize(padapter) && -+ padapter->driver_rx_ampdu_factor == 0xFF) { -+ /* max buffer size is 8 MSDU */ -+ BA_para_set &= ~RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; -+ BA_para_set |= (8 << 6) & RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; -+ } -+ -+ if (pregpriv->ampdu_amsdu == 0)/* disabled */ -+ le_tmp = cpu_to_le16(BA_para_set & ~BIT(0)); -+ else if (pregpriv->ampdu_amsdu == 1)/* enabled */ -+ le_tmp = cpu_to_le16(BA_para_set | BIT(0)); -+ else /* auto */ -+ le_tmp = cpu_to_le16(BA_para_set); -+ -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(pmlmeinfo->ADDBA_req.BA_timeout_value)), &(pattrib->pktlen)); -+ break; -+ case 2:/* DELBA */ -+ BA_para_set = (status & 0x1F) << 3; -+ le_tmp = cpu_to_le16(BA_para_set); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); -+ -+ reason_code = 37; -+ le_tmp = cpu_to_le16(reason_code); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+} -+ -+static void issue_action_BSSCoexistPacket(struct adapter *padapter) -+{ -+ struct list_head *plist, *phead; -+ unsigned char category, action; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct wlan_network *pnetwork = NULL; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct __queue *queue = &(pmlmepriv->scanned_queue); -+ u8 InfoContent[16] = {0}; -+ u8 ICS[8][15]; -+ -+ if ((pmlmepriv->num_FortyMHzIntolerant == 0) || (pmlmepriv->num_sta_no_ht == 0)) -+ return; -+ -+ if (true == pmlmeinfo->bwmode_updated) -+ return; -+ -+ -+ DBG_871X("%s\n", __func__); -+ -+ -+ category = RTW_WLAN_CATEGORY_PUBLIC; -+ action = ACT_PUBLIC_BSSCOEXIST; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ return; -+ } -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ -+ memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ -+ -+ /* */ -+ if (pmlmepriv->num_FortyMHzIntolerant > 0) { -+ u8 iedata = 0; -+ -+ iedata |= BIT(2);/* 20 MHz BSS Width Request */ -+ -+ pframe = rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); -+ -+ } -+ -+ -+ /* */ -+ memset(ICS, 0, sizeof(ICS)); -+ if (pmlmepriv->num_sta_no_ht > 0) { -+ int i; -+ -+ spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ int len; -+ u8 *p; -+ struct wlan_bssid_ex *pbss_network; -+ -+ if (phead == plist) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ plist = get_next(plist); -+ -+ pbss_network = (struct wlan_bssid_ex *)&pnetwork->network; -+ -+ p = rtw_get_ie(pbss_network->IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, pbss_network->IELength - _FIXED_IE_LENGTH_); -+ if ((p == NULL) || (len == 0)) {/* non-HT */ -+ -+ if ((pbss_network->Configuration.DSConfig <= 0) || (pbss_network->Configuration.DSConfig > 14)) -+ continue; -+ -+ ICS[0][pbss_network->Configuration.DSConfig] = 1; -+ -+ if (ICS[0][0] == 0) -+ ICS[0][0] = 1; -+ } -+ -+ } -+ -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ -+ -+ for (i = 0; i < 8; i++) { -+ if (ICS[i][0] == 1) { -+ int j, k = 0; -+ -+ InfoContent[k] = i; -+ /* SET_BSS_INTOLERANT_ELE_REG_CLASS(InfoContent, i); */ -+ k++; -+ -+ for (j = 1; j <= 14; j++) { -+ if (ICS[i][j] == 1) { -+ if (k < 16) { -+ InfoContent[k] = j; /* channel number */ -+ /* SET_BSS_INTOLERANT_ELE_CHANNEL(InfoContent+k, j); */ -+ k++; -+ } -+ } -+ } -+ -+ pframe = rtw_set_ie(pframe, EID_BSSIntolerantChlReport, k, InfoContent, &(pattrib->pktlen)); -+ -+ } -+ -+ } -+ -+ -+ } -+ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+} -+ -+unsigned int send_delba(struct adapter *padapter, u8 initiator, u8 *addr) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+ /* struct recv_reorder_ctrl *preorder_ctrl; */ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u16 tid; -+ -+ if ((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) -+ if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) -+ return _SUCCESS; -+ -+ psta = rtw_get_stainfo(pstapriv, addr); -+ if (psta == NULL) -+ return _SUCCESS; -+ -+ /* DBG_871X("%s:%s\n", __func__, (initiator == 0)?"RX_DIR":"TX_DIR"); */ -+ -+ if (initiator == 0) {/* recipient */ -+ for (tid = 0; tid < MAXTID; tid++) { -+ if (psta->recvreorder_ctrl[tid].enable == true) { -+ DBG_871X("rx agg disable tid(%d)\n", tid); -+ issue_action_BA(padapter, addr, RTW_WLAN_ACTION_DELBA, (((tid << 1) | initiator)&0x1F)); -+ psta->recvreorder_ctrl[tid].enable = false; -+ psta->recvreorder_ctrl[tid].indicate_seq = 0xffff; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __func__, __LINE__, -+ psta->recvreorder_ctrl[tid].indicate_seq); -+ #endif -+ } -+ } -+ } else if (initiator == 1) {/* originator */ -+ /* DBG_871X("tx agg_enable_bitmap(0x%08x)\n", psta->htpriv.agg_enable_bitmap); */ -+ for (tid = 0; tid < MAXTID; tid++) { -+ if (psta->htpriv.agg_enable_bitmap & BIT(tid)) { -+ DBG_871X("tx agg disable tid(%d)\n", tid); -+ issue_action_BA(padapter, addr, RTW_WLAN_ACTION_DELBA, (((tid << 1) | initiator)&0x1F)); -+ psta->htpriv.agg_enable_bitmap &= ~BIT(tid); -+ psta->htpriv.candidate_tid_bitmap &= ~BIT(tid); -+ -+ } -+ } -+ } -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int send_beacon(struct adapter *padapter) -+{ -+ u8 bxmitok = false; -+ int issue = 0; -+ int poll = 0; -+ unsigned long start = jiffies; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ do { -+ issue_beacon(padapter, 100); -+ issue++; -+ do { -+ yield(); -+ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8 *)(&bxmitok)); -+ poll++; -+ } while ((poll%10) != 0 && false == bxmitok && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); -+ -+ } while (false == bxmitok && issue < 100 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); -+ -+ if (padapter->bSurpriseRemoved || padapter->bDriverStopped) { -+ return _FAIL; -+ } -+ -+ -+ if (false == bxmitok) { -+ DBG_871X("%s fail! %u ms\n", __func__, jiffies_to_msecs(jiffies - start)); -+ return _FAIL; -+ } else{ -+ unsigned long passing_time = jiffies_to_msecs(jiffies - start); -+ -+ if (passing_time > 100 || issue > 3) -+ DBG_871X("%s success, issue:%d, poll:%d, %lu ms\n", __func__, issue, poll, passing_time); -+ /* else */ -+ /* DBG_871X("%s success, issue:%d, poll:%d, %u ms\n", __func__, issue, poll, passing_time); */ -+ -+ return _SUCCESS; -+ } -+} -+ -+/**************************************************************************** -+ -+Following are some utitity fuctions for WiFi MLME -+ -+*****************************************************************************/ -+ -+void site_survey(struct adapter *padapter) -+{ -+ unsigned char survey_channel = 0, val8; -+ RT_SCAN_TYPE ScanType = SCAN_PASSIVE; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u32 initialgain = 0; -+ u32 channel_scan_time_ms = 0; -+ -+ { -+ struct rtw_ieee80211_channel *ch; -+ if (pmlmeext->sitesurvey_res.channel_idx < pmlmeext->sitesurvey_res.ch_num) { -+ ch = &pmlmeext->sitesurvey_res.ch[pmlmeext->sitesurvey_res.channel_idx]; -+ survey_channel = ch->hw_value; -+ ScanType = (ch->flags & RTW_IEEE80211_CHAN_PASSIVE_SCAN) ? SCAN_PASSIVE : SCAN_ACTIVE; -+ } -+ } -+ -+ DBG_871X(FUNC_ADPT_FMT" ch:%u (cnt:%u) at %dms, %c%c%c\n" -+ , FUNC_ADPT_ARG(padapter) -+ , survey_channel -+ , pmlmeext->sitesurvey_res.channel_idx -+ , jiffies_to_msecs(jiffies - padapter->mlmepriv.scan_start_time) -+ , ScanType?'A':'P', pmlmeext->sitesurvey_res.scan_mode?'A':'P' -+ , pmlmeext->sitesurvey_res.ssid[0].SsidLength?'S':' ' -+ ); -+#ifdef DBG_FIXED_CHAN -+ DBG_871X(FUNC_ADPT_FMT" fixed_chan:%u\n", pmlmeext->fixed_chan); -+#endif -+ -+ if (survey_channel != 0) { -+ /* PAUSE 4-AC Queue when site_survey */ -+ /* rtw_hal_get_hwreg(padapter, HW_VAR_TXPAUSE, (u8 *)(&val8)); */ -+ /* val8 |= 0x0f; */ -+ /* rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, (u8 *)(&val8)); */ -+ if (pmlmeext->sitesurvey_res.channel_idx == 0) { -+#ifdef DBG_FIXED_CHAN -+ if (pmlmeext->fixed_chan != 0xff) -+ set_channel_bwmode(padapter, pmlmeext->fixed_chan, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ else -+#endif -+ set_channel_bwmode(padapter, survey_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } else{ -+#ifdef DBG_FIXED_CHAN -+ if (pmlmeext->fixed_chan != 0xff) -+ SelectChannel(padapter, pmlmeext->fixed_chan); -+ else -+#endif -+ SelectChannel(padapter, survey_channel); -+ } -+ -+ if (ScanType == SCAN_ACTIVE) { /* obey the channel plan setting... */ -+ { -+ int i; -+ for (i = 0; i < RTW_SSID_SCAN_AMOUNT; i++) { -+ if (pmlmeext->sitesurvey_res.ssid[i].SsidLength) { -+ /* IOT issue, When wifi_spec is not set, send one probe req without WPS IE. */ -+ if (padapter->registrypriv.wifi_spec) -+ issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); -+ else -+ issue_probereq_ex(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL, 0, 0, 0, 0); -+ issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); -+ } -+ } -+ -+ if (pmlmeext->sitesurvey_res.scan_mode == SCAN_ACTIVE) { -+ /* IOT issue, When wifi_spec is not set, send one probe req without WPS IE. */ -+ if (padapter->registrypriv.wifi_spec) -+ issue_probereq(padapter, NULL, NULL); -+ else -+ issue_probereq_ex(padapter, NULL, NULL, 0, 0, 0, 0); -+ issue_probereq(padapter, NULL, NULL); -+ } -+ } -+ } -+ -+ channel_scan_time_ms = pmlmeext->chan_scan_time; -+ -+ set_survey_timer(pmlmeext, channel_scan_time_ms); -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ { -+ struct noise_info info; -+ info.bPauseDIG = false; -+ info.IGIValue = 0; -+ info.max_time = channel_scan_time_ms/2;/* ms */ -+ info.chan = survey_channel; -+ rtw_hal_set_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &info, false); -+ } -+#endif -+ -+ } else{ -+ -+ /* channel number is 0 or this channel is not valid. */ -+ -+ { -+ pmlmeext->sitesurvey_res.state = SCAN_COMPLETE; -+ -+ /* switch back to the original channel */ -+ /* SelectChannel(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset); */ -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ /* flush 4-AC Queue after site_survey */ -+ /* val8 = 0; */ -+ /* rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, (u8 *)(&val8)); */ -+ -+ /* config MSR */ -+ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); -+ -+ initialgain = 0xff; /* restore RX GAIN */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); -+ /* turn on dynamic functions */ -+ Restore_DM_Func_Flag(padapter); -+ /* Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, true); */ -+ -+ if (is_client_associated_to_ap(padapter) == true) -+ issue_nulldata(padapter, NULL, 0, 3, 500); -+ -+ val8 = 0; /* survey done */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ -+ report_surveydone_event(padapter); -+ -+ pmlmeext->chan_scan_time = SURVEY_TO; -+ pmlmeext->sitesurvey_res.state = SCAN_DISABLE; -+ -+ issue_action_BSSCoexistPacket(padapter); -+ issue_action_BSSCoexistPacket(padapter); -+ issue_action_BSSCoexistPacket(padapter); -+ } -+ } -+ -+ return; -+ -+} -+ -+/* collect bss info from Beacon and Probe request/response frames. */ -+u8 collect_bss_info(struct adapter *padapter, union recv_frame *precv_frame, struct wlan_bssid_ex *bssid) -+{ -+ int i; -+ u32 len; -+ u8 *p; -+ u16 val16, subtype; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ u32 packet_len = precv_frame->u.hdr.len; -+ u8 ie_offset; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ __le32 le32_tmp; -+ -+ len = packet_len - sizeof(struct ieee80211_hdr_3addr); -+ -+ if (len > MAX_IE_SZ) { -+ /* DBG_871X("IE too long for survey event\n"); */ -+ return _FAIL; -+ } -+ -+ memset(bssid, 0, sizeof(struct wlan_bssid_ex)); -+ -+ subtype = GetFrameSubType(pframe); -+ -+ if (subtype == WIFI_BEACON) { -+ bssid->Reserved[0] = 1; -+ ie_offset = _BEACON_IE_OFFSET_; -+ } else { -+ /* FIXME : more type */ -+ if (subtype == WIFI_PROBERSP) { -+ ie_offset = _PROBERSP_IE_OFFSET_; -+ bssid->Reserved[0] = 3; -+ } else if (subtype == WIFI_PROBEREQ) { -+ ie_offset = _PROBEREQ_IE_OFFSET_; -+ bssid->Reserved[0] = 2; -+ } else { -+ bssid->Reserved[0] = 0; -+ ie_offset = _FIXED_IE_LENGTH_; -+ } -+ } -+ -+ bssid->Length = sizeof(struct wlan_bssid_ex) - MAX_IE_SZ + len; -+ -+ /* below is to copy the information element */ -+ bssid->IELength = len; -+ memcpy(bssid->IEs, (pframe + sizeof(struct ieee80211_hdr_3addr)), bssid->IELength); -+ -+ /* get the signal strength */ -+ bssid->Rssi = precv_frame->u.hdr.attrib.phy_info.RecvSignalPower; /* in dBM.raw data */ -+ bssid->PhyInfo.SignalQuality = precv_frame->u.hdr.attrib.phy_info.SignalQuality;/* in percentage */ -+ bssid->PhyInfo.SignalStrength = precv_frame->u.hdr.attrib.phy_info.SignalStrength;/* in percentage */ -+ -+ /* checking SSID */ -+ p = rtw_get_ie(bssid->IEs + ie_offset, _SSID_IE_, &len, bssid->IELength - ie_offset); -+ if (p == NULL) { -+ DBG_871X("marc: cannot find SSID for survey event\n"); -+ return _FAIL; -+ } -+ -+ if (*(p + 1)) { -+ if (len > NDIS_802_11_LENGTH_SSID) { -+ DBG_871X("%s()-%d: IE too long (%d) for survey event\n", __func__, __LINE__, len); -+ return _FAIL; -+ } -+ memcpy(bssid->Ssid.Ssid, (p + 2), *(p + 1)); -+ bssid->Ssid.SsidLength = *(p + 1); -+ } else -+ bssid->Ssid.SsidLength = 0; -+ -+ memset(bssid->SupportedRates, 0, NDIS_802_11_LENGTH_RATES_EX); -+ -+ /* checking rate info... */ -+ i = 0; -+ p = rtw_get_ie(bssid->IEs + ie_offset, _SUPPORTEDRATES_IE_, &len, bssid->IELength - ie_offset); -+ if (p != NULL) { -+ if (len > NDIS_802_11_LENGTH_RATES_EX) { -+ DBG_871X("%s()-%d: IE too long (%d) for survey event\n", __func__, __LINE__, len); -+ return _FAIL; -+ } -+ memcpy(bssid->SupportedRates, (p + 2), len); -+ i = len; -+ } -+ -+ p = rtw_get_ie(bssid->IEs + ie_offset, _EXT_SUPPORTEDRATES_IE_, &len, bssid->IELength - ie_offset); -+ if (p != NULL) { -+ if (len > (NDIS_802_11_LENGTH_RATES_EX-i)) { -+ DBG_871X("%s()-%d: IE too long (%d) for survey event\n", __func__, __LINE__, len); -+ return _FAIL; -+ } -+ memcpy(bssid->SupportedRates + i, (p + 2), len); -+ } -+ -+ bssid->NetworkTypeInUse = Ndis802_11OFDM24; -+ -+ if (bssid->IELength < 12) -+ return _FAIL; -+ -+ /* Checking for DSConfig */ -+ p = rtw_get_ie(bssid->IEs + ie_offset, _DSSET_IE_, &len, bssid->IELength - ie_offset); -+ -+ bssid->Configuration.DSConfig = 0; -+ bssid->Configuration.Length = 0; -+ -+ if (p) { -+ bssid->Configuration.DSConfig = *(p + 2); -+ } else { -+ /* In 5G, some ap do not have DSSET IE */ -+ /* checking HT info for channel */ -+ p = rtw_get_ie(bssid->IEs + ie_offset, _HT_ADD_INFO_IE_, &len, bssid->IELength - ie_offset); -+ if (p) { -+ struct HT_info_element *HT_info = (struct HT_info_element *)(p + 2); -+ bssid->Configuration.DSConfig = HT_info->primary_channel; -+ } else { /* use current channel */ -+ bssid->Configuration.DSConfig = rtw_get_oper_ch(padapter); -+ } -+ } -+ -+ memcpy(&le32_tmp, rtw_get_beacon_interval_from_ie(bssid->IEs), 2); -+ bssid->Configuration.BeaconPeriod = le32_to_cpu(le32_tmp); -+ -+ val16 = rtw_get_capability((struct wlan_bssid_ex *)bssid); -+ -+ if (val16 & BIT(0)) { -+ bssid->InfrastructureMode = Ndis802_11Infrastructure; -+ memcpy(bssid->MacAddress, GetAddr2Ptr(pframe), ETH_ALEN); -+ } else { -+ bssid->InfrastructureMode = Ndis802_11IBSS; -+ memcpy(bssid->MacAddress, GetAddr3Ptr(pframe), ETH_ALEN); -+ } -+ -+ if (val16 & BIT(4)) -+ bssid->Privacy = 1; -+ else -+ bssid->Privacy = 0; -+ -+ bssid->Configuration.ATIMWindow = 0; -+ -+ /* 20/40 BSS Coexistence check */ -+ if ((pregistrypriv->wifi_spec == 1) && (false == pmlmeinfo->bwmode_updated)) { -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ p = rtw_get_ie(bssid->IEs + ie_offset, _HT_CAPABILITY_IE_, &len, bssid->IELength - ie_offset); -+ if (p && len > 0) { -+ struct HT_caps_element *pHT_caps; -+ pHT_caps = (struct HT_caps_element *)(p + 2); -+ -+ if (le16_to_cpu(pHT_caps->u.HT_cap_element.HT_caps_info) & BIT(14)) -+ pmlmepriv->num_FortyMHzIntolerant++; -+ } else -+ pmlmepriv->num_sta_no_ht++; -+ } -+ -+#ifdef CONFIG_INTEL_WIDI -+ /* process_intel_widi_query_or_tigger(padapter, bssid); */ -+ if (process_intel_widi_query_or_tigger(padapter, bssid)) -+ return _FAIL; -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ #if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) & 1 -+ if (strcmp(bssid->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { -+ DBG_871X("Receiving %s("MAC_FMT", DSConfig:%u) from ch%u with ss:%3u, sq:%3u, RawRSSI:%3ld\n" -+ , bssid->Ssid.Ssid, MAC_ARG(bssid->MacAddress), bssid->Configuration.DSConfig -+ , rtw_get_oper_ch(padapter) -+ , bssid->PhyInfo.SignalStrength, bssid->PhyInfo.SignalQuality, bssid->Rssi -+ ); -+ } -+ #endif -+ -+ /* mark bss info receving from nearby channel as SignalQuality 101 */ -+ if (bssid->Configuration.DSConfig != rtw_get_oper_ch(padapter)) -+ bssid->PhyInfo.SignalQuality = 101; -+ -+ return _SUCCESS; -+} -+ -+void start_create_ibss(struct adapter *padapter) -+{ -+ unsigned short caps; -+ u8 val8; -+ u8 join_type; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *pnetwork = (struct wlan_bssid_ex *)(&(pmlmeinfo->network)); -+ pmlmeext->cur_channel = (u8)pnetwork->Configuration.DSConfig; -+ pmlmeinfo->bcn_interval = get_beacon_interval(pnetwork); -+ -+ /* update wireless mode */ -+ update_wireless_mode(padapter); -+ -+ /* udpate capability */ -+ caps = rtw_get_capability((struct wlan_bssid_ex *)pnetwork); -+ update_capinfo(padapter, caps); -+ if (caps&cap_IBSS) {/* adhoc master */ -+ val8 = 0xcf; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, NULL); -+ -+ /* switch channel */ -+ /* SelectChannel(padapter, pmlmeext->cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE); */ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ -+ beacon_timing_control(padapter); -+ -+ /* set msr to WIFI_FW_ADHOC_STATE */ -+ pmlmeinfo->state = WIFI_FW_ADHOC_STATE; -+ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); -+ -+ /* issue beacon */ -+ if (send_beacon(padapter) == _FAIL) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("issuing beacon frame fail....\n")); -+ -+ report_join_res(padapter, -1); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ } else{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, padapter->registrypriv.dev_network.MacAddress); -+ join_type = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ -+ report_join_res(padapter, 1); -+ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; -+ rtw_indicate_connect(padapter); -+ } -+ } else{ -+ DBG_871X("start_create_ibss, invalid cap:%x\n", caps); -+ return; -+ } -+ /* update bc/mc sta_info */ -+ update_bmc_sta(padapter); -+ -+} -+ -+void start_clnt_join(struct adapter *padapter) -+{ -+ unsigned short caps; -+ u8 val8; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *pnetwork = (struct wlan_bssid_ex *)(&(pmlmeinfo->network)); -+ int beacon_timeout; -+ -+ /* update wireless mode */ -+ update_wireless_mode(padapter); -+ -+ /* udpate capability */ -+ caps = rtw_get_capability((struct wlan_bssid_ex *)pnetwork); -+ update_capinfo(padapter, caps); -+ if (caps&cap_ESS) { -+ Set_MSR(padapter, WIFI_FW_STATION_STATE); -+ -+ val8 = (pmlmeinfo->auth_algo == dot11AuthAlgrthm_8021X) ? 0xcc : 0xcf; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ -+ /* Because of AP's not receiving deauth before */ -+ /* AP may: 1)not response auth or 2)deauth us after link is complete */ -+ /* issue deauth before issuing auth to deal with the situation */ -+ -+ /* Commented by Albert 2012/07/21 */ -+ /* For the Win8 P2P connection, it will be hard to have a successful connection if this Wi-Fi doesn't connect to it. */ -+ { -+ /* To avoid connecting to AP fail during resume process, change retry count from 5 to 1 */ -+ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 1, 100); -+ } -+ -+ /* here wait for receiving the beacon to start auth */ -+ /* and enable a timer */ -+ beacon_timeout = decide_wait_for_beacon_timeout(pmlmeinfo->bcn_interval); -+ set_link_timer(pmlmeext, beacon_timeout); -+ _set_timer(&padapter->mlmepriv.assoc_timer, -+ (REAUTH_TO * REAUTH_LIMIT) + (REASSOC_TO*REASSOC_LIMIT) + beacon_timeout); -+ -+ pmlmeinfo->state = WIFI_FW_AUTH_NULL | WIFI_FW_STATION_STATE; -+ } else if (caps&cap_IBSS) { /* adhoc client */ -+ Set_MSR(padapter, WIFI_FW_ADHOC_STATE); -+ -+ val8 = 0xcf; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ -+ beacon_timing_control(padapter); -+ -+ pmlmeinfo->state = WIFI_FW_ADHOC_STATE; -+ -+ report_join_res(padapter, 1); -+ } else{ -+ /* DBG_871X("marc: invalid cap:%x\n", caps); */ -+ return; -+ } -+ -+} -+ -+void start_clnt_auth(struct adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ del_timer_sync(&pmlmeext->link_timer); -+ -+ pmlmeinfo->state &= (~WIFI_FW_AUTH_NULL); -+ pmlmeinfo->state |= WIFI_FW_AUTH_STATE; -+ -+ pmlmeinfo->auth_seq = 1; -+ pmlmeinfo->reauth_count = 0; -+ pmlmeinfo->reassoc_count = 0; -+ pmlmeinfo->link_count = 0; -+ pmlmeext->retry = 0; -+ -+ -+ DBG_871X_LEVEL(_drv_always_, "start auth\n"); -+ issue_auth(padapter, NULL, 0); -+ -+ set_link_timer(pmlmeext, REAUTH_TO); -+ -+} -+ -+ -+void start_clnt_assoc(struct adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ del_timer_sync(&pmlmeext->link_timer); -+ -+ pmlmeinfo->state &= (~(WIFI_FW_AUTH_NULL | WIFI_FW_AUTH_STATE)); -+ pmlmeinfo->state |= (WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE); -+ -+ issue_assocreq(padapter); -+ -+ set_link_timer(pmlmeext, REASSOC_TO); -+} -+ -+unsigned int receive_disconnect(struct adapter *padapter, unsigned char *MacAddr, unsigned short reason) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* check A3 */ -+ if (!(!memcmp(MacAddr, get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) -+ return _SUCCESS; -+ -+ DBG_871X("%s\n", __func__); -+ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) { -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) { -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ report_del_sta_event(padapter, MacAddr, reason); -+ -+ } else if (pmlmeinfo->state & WIFI_FW_LINKING_STATE) { -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ report_join_res(padapter, -2); -+ } -+ } -+ -+ return _SUCCESS; -+} -+ -+static void process_80211d(struct adapter *padapter, struct wlan_bssid_ex *bssid) -+{ -+ struct registry_priv *pregistrypriv; -+ struct mlme_ext_priv *pmlmeext; -+ RT_CHANNEL_INFO *chplan_new; -+ u8 channel; -+ u8 i; -+ -+ -+ pregistrypriv = &padapter->registrypriv; -+ pmlmeext = &padapter->mlmeextpriv; -+ -+ /* Adjust channel plan by AP Country IE */ -+ if (pregistrypriv->enable80211d && -+ (!pmlmeext->update_channel_plan_by_ap_done)) { -+ u8 *ie, *p; -+ u32 len; -+ RT_CHANNEL_PLAN chplan_ap; -+ RT_CHANNEL_INFO chplan_sta[MAX_CHANNEL_NUM]; -+ u8 country[4]; -+ u8 fcn; /* first channel number */ -+ u8 noc; /* number of channel */ -+ u8 j, k; -+ -+ ie = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _COUNTRY_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (!ie) -+ return; -+ if (len < 6) -+ return; -+ -+ ie += 2; -+ p = ie; -+ ie += len; -+ -+ memset(country, 0, 4); -+ memcpy(country, p, 3); -+ p += 3; -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, -+ ("%s: 802.11d country =%s\n", __func__, country)); -+ -+ i = 0; -+ while ((ie - p) >= 3) { -+ fcn = *(p++); -+ noc = *(p++); -+ p++; -+ -+ for (j = 0; j < noc; j++) { -+ if (fcn <= 14) -+ channel = fcn + j; /* 2.4 GHz */ -+ else -+ channel = fcn + j*4; /* 5 GHz */ -+ -+ chplan_ap.Channel[i++] = channel; -+ } -+ } -+ chplan_ap.Len = i; -+ -+#ifdef CONFIG_DEBUG_RTL871X -+ i = 0; -+ DBG_871X("%s: AP[%s] channel plan {", __func__, bssid->Ssid.Ssid); -+ while ((i < chplan_ap.Len) && (chplan_ap.Channel[i] != 0)) { -+ DBG_8192C("%02d,", chplan_ap.Channel[i]); -+ i++; -+ } -+ DBG_871X("}\n"); -+#endif -+ -+ memcpy(chplan_sta, pmlmeext->channel_set, sizeof(chplan_sta)); -+#ifdef CONFIG_DEBUG_RTL871X -+ i = 0; -+ DBG_871X("%s: STA channel plan {", __func__); -+ while ((i < MAX_CHANNEL_NUM) && (chplan_sta[i].ChannelNum != 0)) { -+ DBG_871X("%02d(%c),", chplan_sta[i].ChannelNum, chplan_sta[i].ScanType == SCAN_PASSIVE?'p':'a'); -+ i++; -+ } -+ DBG_871X("}\n"); -+#endif -+ -+ memset(pmlmeext->channel_set, 0, sizeof(pmlmeext->channel_set)); -+ chplan_new = pmlmeext->channel_set; -+ -+ i = j = k = 0; -+ if (pregistrypriv->wireless_mode & WIRELESS_11G) { -+ do { -+ if ((i == MAX_CHANNEL_NUM) || -+ (chplan_sta[i].ChannelNum == 0) || -+ (chplan_sta[i].ChannelNum > 14)) -+ break; -+ -+ if ((j == chplan_ap.Len) || (chplan_ap.Channel[j] > 14)) -+ break; -+ -+ if (chplan_sta[i].ChannelNum == chplan_ap.Channel[j]) { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ i++; -+ j++; -+ k++; -+ } else if (chplan_sta[i].ChannelNum < chplan_ap.Channel[j]) { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+/* chplan_new[k].ScanType = chplan_sta[i].ScanType; */ -+ chplan_new[k].ScanType = SCAN_PASSIVE; -+ i++; -+ k++; -+ } else if (chplan_sta[i].ChannelNum > chplan_ap.Channel[j]) { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ j++; -+ k++; -+ } -+ } while (1); -+ -+ /* change AP not support channel to Passive scan */ -+ while ((i < MAX_CHANNEL_NUM) && -+ (chplan_sta[i].ChannelNum != 0) && -+ (chplan_sta[i].ChannelNum <= 14)) { -+ -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+/* chplan_new[k].ScanType = chplan_sta[i].ScanType; */ -+ chplan_new[k].ScanType = SCAN_PASSIVE; -+ i++; -+ k++; -+ } -+ -+ /* add channel AP supported */ -+ while ((j < chplan_ap.Len) && (chplan_ap.Channel[j] <= 14)) { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ j++; -+ k++; -+ } -+ } else{ -+ /* keep original STA 2.4G channel plan */ -+ while ((i < MAX_CHANNEL_NUM) && -+ (chplan_sta[i].ChannelNum != 0) && -+ (chplan_sta[i].ChannelNum <= 14)) { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+ chplan_new[k].ScanType = chplan_sta[i].ScanType; -+ i++; -+ k++; -+ } -+ -+ /* skip AP 2.4G channel plan */ -+ while ((j < chplan_ap.Len) && (chplan_ap.Channel[j] <= 14)) { -+ j++; -+ } -+ } -+ -+ if (pregistrypriv->wireless_mode & WIRELESS_11A) { -+ do { -+ if ((i == MAX_CHANNEL_NUM) || -+ (chplan_sta[i].ChannelNum == 0)) -+ break; -+ -+ if ((j == chplan_ap.Len) || (chplan_ap.Channel[j] == 0)) -+ break; -+ -+ if (chplan_sta[i].ChannelNum == chplan_ap.Channel[j]) { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ i++; -+ j++; -+ k++; -+ } else if (chplan_sta[i].ChannelNum < chplan_ap.Channel[j]) { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+/* chplan_new[k].ScanType = chplan_sta[i].ScanType; */ -+ chplan_new[k].ScanType = SCAN_PASSIVE; -+ i++; -+ k++; -+ } else if (chplan_sta[i].ChannelNum > chplan_ap.Channel[j]) { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ j++; -+ k++; -+ } -+ } while (1); -+ -+ /* change AP not support channel to Passive scan */ -+ while ((i < MAX_CHANNEL_NUM) && (chplan_sta[i].ChannelNum != 0)) { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+/* chplan_new[k].ScanType = chplan_sta[i].ScanType; */ -+ chplan_new[k].ScanType = SCAN_PASSIVE; -+ i++; -+ k++; -+ } -+ -+ /* add channel AP supported */ -+ while ((j < chplan_ap.Len) && (chplan_ap.Channel[j] != 0)) { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ j++; -+ k++; -+ } -+ } else{ -+ /* keep original STA 5G channel plan */ -+ while ((i < MAX_CHANNEL_NUM) && (chplan_sta[i].ChannelNum != 0)) { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+ chplan_new[k].ScanType = chplan_sta[i].ScanType; -+ i++; -+ k++; -+ } -+ } -+ -+ pmlmeext->update_channel_plan_by_ap_done = 1; -+ -+#ifdef CONFIG_DEBUG_RTL871X -+ k = 0; -+ DBG_871X("%s: new STA channel plan {", __func__); -+ while ((k < MAX_CHANNEL_NUM) && (chplan_new[k].ChannelNum != 0)) { -+ DBG_871X("%02d(%c),", chplan_new[k].ChannelNum, chplan_new[k].ScanType == SCAN_PASSIVE?'p':'c'); -+ k++; -+ } -+ DBG_871X("}\n"); -+#endif -+ } -+ -+ /* If channel is used by AP, set channel scan type to active */ -+ channel = bssid->Configuration.DSConfig; -+ chplan_new = pmlmeext->channel_set; -+ i = 0; -+ while ((i < MAX_CHANNEL_NUM) && (chplan_new[i].ChannelNum != 0)) { -+ if (chplan_new[i].ChannelNum == channel) { -+ if (chplan_new[i].ScanType == SCAN_PASSIVE) { -+ /* 5G Bnad 2, 3 (DFS) doesn't change to active scan */ -+ if (channel >= 52 && channel <= 144) -+ break; -+ -+ chplan_new[i].ScanType = SCAN_ACTIVE; -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, -+ ("%s: change channel %d scan type from passive to active\n", -+ __func__, channel)); -+ } -+ break; -+ } -+ i++; -+ } -+} -+ -+/**************************************************************************** -+ -+Following are the functions to report events -+ -+*****************************************************************************/ -+ -+void report_survey_event(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct survey_event *psurvey_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext; -+ struct cmd_priv *pcmdpriv; -+ /* u8 *pframe = precv_frame->u.hdr.rx_data; */ -+ /* uint len = precv_frame->u.hdr.len; */ -+ -+ if (!padapter) -+ return; -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pcmdpriv = &padapter->cmdpriv; -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) -+ return; -+ -+ cmdsz = (sizeof(struct survey_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ kfree((u8 *)pcmd_obj); -+ return; -+ } -+ -+ INIT_LIST_HEAD(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct survey_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_Survey); -+ pc2h_evt_hdr->seq = atomic_inc_return(&pmlmeext->event_seq); -+ -+ psurvey_evt = (struct survey_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ -+ if (collect_bss_info(padapter, precv_frame, (struct wlan_bssid_ex *)&psurvey_evt->bss) == _FAIL) { -+ kfree((u8 *)pcmd_obj); -+ kfree((u8 *)pevtcmd); -+ return; -+ } -+ -+ process_80211d(padapter, &psurvey_evt->bss); -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ pmlmeext->sitesurvey_res.bss_cnt++; -+ -+ return; -+ -+} -+ -+void report_surveydone_event(struct adapter *padapter) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct surveydone_event *psurveydone_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) -+ return; -+ -+ cmdsz = (sizeof(struct surveydone_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ kfree((u8 *)pcmd_obj); -+ return; -+ } -+ -+ INIT_LIST_HEAD(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct surveydone_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_SurveyDone); -+ pc2h_evt_hdr->seq = atomic_inc_return(&pmlmeext->event_seq); -+ -+ psurveydone_evt = (struct surveydone_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ psurveydone_evt->bss_cnt = pmlmeext->sitesurvey_res.bss_cnt; -+ -+ DBG_871X("survey done event(%x) band:%d for "ADPT_FMT"\n", psurveydone_evt->bss_cnt, padapter->setband, ADPT_ARG(padapter)); -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+ -+} -+ -+void report_join_res(struct adapter *padapter, int res) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct joinbss_event *pjoinbss_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) -+ return; -+ -+ cmdsz = (sizeof(struct joinbss_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ kfree((u8 *)pcmd_obj); -+ return; -+ } -+ -+ INIT_LIST_HEAD(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct joinbss_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_JoinBss); -+ pc2h_evt_hdr->seq = atomic_inc_return(&pmlmeext->event_seq); -+ -+ pjoinbss_evt = (struct joinbss_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ memcpy((unsigned char *)(&(pjoinbss_evt->network.network)), &(pmlmeinfo->network), sizeof(struct wlan_bssid_ex)); -+ pjoinbss_evt->network.join_res = pjoinbss_evt->network.aid = res; -+ -+ DBG_871X("report_join_res(%d)\n", res); -+ -+ -+ rtw_joinbss_event_prehandle(padapter, (u8 *)&pjoinbss_evt->network); -+ -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+ -+} -+ -+void report_wmm_edca_update(struct adapter *padapter) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct wmm_event *pwmm_event; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) -+ return; -+ -+ cmdsz = (sizeof(struct wmm_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ kfree((u8 *)pcmd_obj); -+ return; -+ } -+ -+ INIT_LIST_HEAD(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct wmm_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_WMM); -+ pc2h_evt_hdr->seq = atomic_inc_return(&pmlmeext->event_seq); -+ -+ pwmm_event = (struct wmm_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ pwmm_event->wmm = 0; -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+ -+} -+ -+void report_del_sta_event(struct adapter *padapter, unsigned char *MacAddr, unsigned short reason) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct sta_info *psta; -+ int mac_id; -+ struct stadel_event *pdel_sta_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) { -+ return; -+ } -+ -+ cmdsz = (sizeof(struct stadel_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ kfree((u8 *)pcmd_obj); -+ return; -+ } -+ -+ INIT_LIST_HEAD(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct stadel_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_DelSTA); -+ pc2h_evt_hdr->seq = atomic_inc_return(&pmlmeext->event_seq); -+ -+ pdel_sta_evt = (struct stadel_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ memcpy((unsigned char *)(&(pdel_sta_evt->macaddr)), MacAddr, ETH_ALEN); -+ memcpy((unsigned char *)(pdel_sta_evt->rsvd), (unsigned char *)(&reason), 2); -+ -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, MacAddr); -+ if (psta) -+ mac_id = (int)psta->mac_id; -+ else -+ mac_id = (-1); -+ -+ pdel_sta_evt->mac_id = mac_id; -+ -+ DBG_871X("report_del_sta_event: delete STA, mac_id =%d\n", mac_id); -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+} -+ -+void report_add_sta_event(struct adapter *padapter, unsigned char *MacAddr, int cam_idx) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct stassoc_event *padd_sta_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) -+ return; -+ -+ cmdsz = (sizeof(struct stassoc_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ kfree((u8 *)pcmd_obj); -+ return; -+ } -+ -+ INIT_LIST_HEAD(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct stassoc_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_AddSTA); -+ pc2h_evt_hdr->seq = atomic_inc_return(&pmlmeext->event_seq); -+ -+ padd_sta_evt = (struct stassoc_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ memcpy((unsigned char *)(&(padd_sta_evt->macaddr)), MacAddr, ETH_ALEN); -+ padd_sta_evt->cam_id = cam_idx; -+ -+ DBG_871X("report_add_sta_event: add STA\n"); -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+} -+ -+ -+bool rtw_port_switch_chk(struct adapter *adapter) -+{ -+ bool switch_needed = false; -+ return switch_needed; -+} -+ -+/**************************************************************************** -+ -+Following are the event callback functions -+ -+*****************************************************************************/ -+ -+/* for sta/adhoc mode */ -+void update_sta_info(struct adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* ERP */ -+ VCS_update(padapter, psta); -+ -+ /* HT */ -+ if (pmlmepriv->htpriv.ht_option) { -+ psta->htpriv.ht_option = true; -+ -+ psta->htpriv.ampdu_enable = pmlmepriv->htpriv.ampdu_enable; -+ -+ psta->htpriv.rx_ampdu_min_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para&IEEE80211_HT_CAP_AMPDU_DENSITY)>>2; -+ -+ if (support_short_GI(padapter, &(pmlmeinfo->HT_caps), CHANNEL_WIDTH_20)) -+ psta->htpriv.sgi_20m = true; -+ -+ if (support_short_GI(padapter, &(pmlmeinfo->HT_caps), CHANNEL_WIDTH_40)) -+ psta->htpriv.sgi_40m = true; -+ -+ psta->qos_option = true; -+ -+ psta->htpriv.ldpc_cap = pmlmepriv->htpriv.ldpc_cap; -+ psta->htpriv.stbc_cap = pmlmepriv->htpriv.stbc_cap; -+ psta->htpriv.beamform_cap = pmlmepriv->htpriv.beamform_cap; -+ -+ memcpy(&psta->htpriv.ht_cap, &pmlmeinfo->HT_caps, sizeof(struct rtw_ieee80211_ht_cap)); -+ } else{ -+ psta->htpriv.ht_option = false; -+ -+ psta->htpriv.ampdu_enable = false; -+ -+ psta->htpriv.sgi_20m = false; -+ psta->htpriv.sgi_40m = false; -+ psta->qos_option = false; -+ -+ } -+ -+ psta->htpriv.ch_offset = pmlmeext->cur_ch_offset; -+ -+ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ -+ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ -+ -+ psta->bw_mode = pmlmeext->cur_bwmode; -+ -+ /* QoS */ -+ if (pmlmepriv->qospriv.qos_option) -+ psta->qos_option = true; -+ -+ update_ldpc_stbc_cap(psta); -+ -+ spin_lock_bh(&psta->lock); -+ psta->state = _FW_LINKED; -+ spin_unlock_bh(&psta->lock); -+ -+} -+ -+static void rtw_mlmeext_disconnect(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *pnetwork = (struct wlan_bssid_ex *)(&(pmlmeinfo->network)); -+ u8 state_backup = (pmlmeinfo->state&0x03); -+ -+ /* set_opmode_cmd(padapter, infra_client_with_mlme); */ -+ -+ /* -+ * For safety, prevent from keeping macid sleep. -+ * If we can sure all power mode enter/leave are paired, -+ * this check can be removed. -+ * Lucas@20131113 -+ */ -+ /* wakeup macid after disconnect. */ -+ { -+ struct sta_info *psta; -+ psta = rtw_get_stainfo(&padapter->stapriv, get_my_bssid(pnetwork)); -+ if (psta) -+ rtw_hal_macid_wakeup(padapter, psta->mac_id); -+ } -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, NULL); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); -+ -+ /* set MSR to no link state -> infra. mode */ -+ Set_MSR(padapter, _HW_STATE_STATION_); -+ -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+ if (state_backup == WIFI_FW_STATION_STATE) { -+ if (rtw_port_switch_chk(padapter) == true) { -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); -+ { -+ struct adapter *port0_iface = dvobj_get_port0_adapter(adapter_to_dvobj(padapter)); -+ if (port0_iface) -+ rtw_lps_ctrl_wk_cmd(port0_iface, LPS_CTRL_CONNECT, 0); -+ } -+ } -+ } -+ -+ /* switch to the 20M Hz mode after disconnect */ -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ flush_all_cam_entry(padapter); -+ -+ del_timer_sync(&pmlmeext->link_timer); -+ -+ /* pmlmepriv->LinkDetectInfo.TrafficBusyState = false; */ -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; -+ -+} -+ -+void mlmeext_joinbss_event_callback(struct adapter *padapter, int join_res) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 join_type; -+ struct sta_info *psta; -+ if (join_res < 0) { -+ join_type = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); -+ -+ goto exit_mlmeext_joinbss_event_callback; -+ } -+ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) -+ /* update bc/mc sta_info */ -+ update_bmc_sta(padapter); -+ -+ -+ /* turn on dynamic functions */ -+ Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, true); -+ -+ /* update IOT-releated issue */ -+ update_IOT_info(padapter); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, cur_network->SupportedRates); -+ -+ /* BCN interval */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&pmlmeinfo->bcn_interval)); -+ -+ /* udpate capability */ -+ update_capinfo(padapter, pmlmeinfo->capability); -+ -+ /* WMM, Update EDCA param */ -+ WMMOnAssocRsp(padapter); -+ -+ /* HT */ -+ HTOnAssocRsp(padapter); -+ -+ /* Set cur_channel&cur_bwmode&cur_ch_offset */ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); -+ if (psta) { /* only for infra. mode */ -+ -+ pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta; -+ -+ /* DBG_871X("set_sta_rate\n"); */ -+ -+ psta->wireless_mode = pmlmeext->cur_wireless_mode; -+ -+ /* set per sta rate after updating HT cap. */ -+ set_sta_rate(padapter, psta); -+ -+ rtw_sta_media_status_rpt(padapter, psta, 1); -+ -+ /* wakeup macid after join bss successfully to ensure -+ the subsequent data frames can be sent out normally */ -+ rtw_hal_macid_wakeup(padapter, psta->mac_id); -+ } -+ -+ if (rtw_port_switch_chk(padapter) == true) -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); -+ -+ join_type = 2; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) { -+ /* correcting TSF */ -+ correct_TSF(padapter, pmlmeext); -+ -+ /* set_link_timer(pmlmeext, DISCONNECT_TO); */ -+ } -+ -+ if (get_iface_type(padapter) == IFACE_PORT0) -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_CONNECT, 0); -+ -+exit_mlmeext_joinbss_event_callback: -+ -+ DBG_871X("=>%s\n", __func__); -+ -+} -+ -+/* currently only adhoc mode will go here */ -+void mlmeext_sta_add_event_callback(struct adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 join_type; -+ -+ DBG_871X("%s\n", __func__); -+ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) { -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) { /* adhoc master or sta_count>1 */ -+ -+ /* nothing to do */ -+ } else{ /* adhoc client */ -+ /* update TSF Value */ -+ /* update_TSF(pmlmeext, pframe, len); */ -+ -+ /* correcting TSF */ -+ correct_TSF(padapter, pmlmeext); -+ -+ /* start beacon */ -+ if (send_beacon(padapter) == _FAIL) { -+ pmlmeinfo->FW_sta_info[psta->mac_id].status = 0; -+ -+ pmlmeinfo->state ^= WIFI_FW_ADHOC_STATE; -+ -+ return; -+ } -+ -+ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; -+ -+ } -+ -+ join_type = 2; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ } -+ -+ pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta; -+ -+ psta->bssratelen = rtw_get_rateset_len(pmlmeinfo->FW_sta_info[psta->mac_id].SupportedRates); -+ memcpy(psta->bssrateset, pmlmeinfo->FW_sta_info[psta->mac_id].SupportedRates, psta->bssratelen); -+ -+ /* update adhoc sta_info */ -+ update_sta_info(padapter, psta); -+ -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ -+ /* ToDo: HT for Ad-hoc */ -+ psta->wireless_mode = rtw_check_network_type(psta->bssrateset, psta->bssratelen, pmlmeext->cur_channel); -+ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); -+ -+ /* rate radaptive */ -+ Update_RA_Entry(padapter, psta); -+} -+ -+void mlmeext_sta_del_event_callback(struct adapter *padapter) -+{ -+ if (is_client_associated_to_ap(padapter) || is_IBSS_empty(padapter)) -+ rtw_mlmeext_disconnect(padapter); -+} -+ -+/**************************************************************************** -+ -+Following are the functions for the timer handlers -+ -+*****************************************************************************/ -+void _linked_info_dump(struct adapter *padapter) -+{ -+ int i; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int UndecoratedSmoothedPWDB; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ -+ if (padapter->bLinkInfoDump) { -+ -+ DBG_871X("\n ============["ADPT_FMT"] linked status check ===================\n", ADPT_ARG(padapter)); -+ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) { -+ rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); -+ -+ DBG_871X("AP[" MAC_FMT "] - UndecoratedSmoothedPWDB:%d\n", -+ MAC_ARG(padapter->mlmepriv.cur_network.network.MacAddress), UndecoratedSmoothedPWDB); -+ } else if ((pmlmeinfo->state&0x03) == _HW_STATE_AP_) { -+ struct list_head *phead, *plist; -+ -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ while (phead != plist) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ DBG_871X("STA[" MAC_FMT "]:UndecoratedSmoothedPWDB:%d\n", -+ MAC_ARG(psta->hwaddr), psta->rssi_stat.UndecoratedSmoothedPWDB); -+ } -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+ } -+ for (i = 0; i < NUM_STA; i++) { -+ if (pdvobj->macid[i] == true) { -+ if (i != 1) /* skip bc/mc sta */ -+ /* tx info ============ */ -+ rtw_hal_get_def_var(padapter, HW_DEF_RA_INFO_DUMP, &i); -+ } -+ } -+ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_RX_INFO_DUMP, NULL); -+ -+ -+ } -+ -+ -+} -+ -+static u8 chk_ap_is_alive(struct adapter *padapter, struct sta_info *psta) -+{ -+ u8 ret = false; -+ -+ #ifdef DBG_EXPIRATION_CHK -+ DBG_871X(FUNC_ADPT_FMT" rx:"STA_PKTS_FMT", beacon:%llu, probersp_to_self:%llu" -+ /*", probersp_bm:%llu, probersp_uo:%llu, probereq:%llu, BI:%u"*/ -+ ", retry:%u\n" -+ , FUNC_ADPT_ARG(padapter) -+ , STA_RX_PKTS_DIFF_ARG(psta) -+ , psta->sta_stats.rx_beacon_pkts - psta->sta_stats.last_rx_beacon_pkts -+ , psta->sta_stats.rx_probersp_pkts - psta->sta_stats.last_rx_probersp_pkts -+ /*, psta->sta_stats.rx_probersp_bm_pkts - psta->sta_stats.last_rx_probersp_bm_pkts -+ , psta->sta_stats.rx_probersp_uo_pkts - psta->sta_stats.last_rx_probersp_uo_pkts -+ , psta->sta_stats.rx_probereq_pkts - psta->sta_stats.last_rx_probereq_pkts -+ , pmlmeinfo->bcn_interval*/ -+ , pmlmeext->retry -+ ); -+ -+ DBG_871X(FUNC_ADPT_FMT" tx_pkts:%llu, link_count:%u\n", FUNC_ADPT_ARG(padapter) -+ , padapter->xmitpriv.tx_pkts -+ , pmlmeinfo->link_count -+ ); -+ #endif -+ -+ if ((sta_rx_data_pkts(psta) == sta_last_rx_data_pkts(psta)) -+ && sta_rx_beacon_pkts(psta) == sta_last_rx_beacon_pkts(psta) -+ && sta_rx_probersp_pkts(psta) == sta_last_rx_probersp_pkts(psta) -+ ) { -+ ret = false; -+ } else{ -+ ret = true; -+ } -+ -+ sta_update_last_rx_pkts(psta); -+ -+ return ret; -+} -+ -+void linked_status_chk(struct adapter *padapter) -+{ -+ u32 i; -+ struct sta_info *psta; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ -+ if (is_client_associated_to_ap(padapter)) { -+ /* linked infrastructure client mode */ -+ -+ int tx_chk = _SUCCESS, rx_chk = _SUCCESS; -+ int rx_chk_limit; -+ int link_count_limit; -+ -+ #if defined(DBG_ROAMING_TEST) -+ rx_chk_limit = 1; -+ #else -+ rx_chk_limit = 8; -+ #endif -+ link_count_limit = 7; /* 16 sec */ -+ -+ /* Marked by Kurt 20130715 */ -+ /* For WiDi 3.5 and latered on, they don't ask WiDi sink to do roaming, so we could not check rx limit that strictly. */ -+ /* todo: To check why we under miracast session, rx_chk would be false */ -+ /* ifdef CONFIG_INTEL_WIDI */ -+ /* if (padapter->mlmepriv.widi_state != INTEL_WIDI_STATE_NONE) */ -+ /* rx_chk_limit = 1; */ -+ /* endif */ -+ -+ psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); -+ if (psta != NULL) { -+ if (chk_ap_is_alive(padapter, psta) == false) -+ rx_chk = _FAIL; -+ -+ if (pxmitpriv->last_tx_pkts == pxmitpriv->tx_pkts) -+ tx_chk = _FAIL; -+ -+ { -+ if (rx_chk != _SUCCESS) { -+ if (pmlmeext->retry == 0) { -+ #ifdef DBG_EXPIRATION_CHK -+ DBG_871X("issue_probereq to trigger probersp, retry =%d\n", pmlmeext->retry); -+ #endif -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); -+ } -+ } -+ -+ if (tx_chk != _SUCCESS && pmlmeinfo->link_count++ == link_count_limit) { -+ #ifdef DBG_EXPIRATION_CHK -+ DBG_871X("%s issue_nulldata 0\n", __func__); -+ #endif -+ tx_chk = issue_nulldata_in_interrupt(padapter, NULL); -+ } -+ } -+ -+ if (rx_chk == _FAIL) { -+ pmlmeext->retry++; -+ if (pmlmeext->retry > rx_chk_limit) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" disconnect or roaming\n", -+ FUNC_ADPT_ARG(padapter)); -+ receive_disconnect(padapter, pmlmeinfo->network.MacAddress -+ , WLAN_REASON_EXPIRATION_CHK); -+ return; -+ } -+ } else { -+ pmlmeext->retry = 0; -+ } -+ -+ if (tx_chk == _FAIL) { -+ pmlmeinfo->link_count %= (link_count_limit+1); -+ } else { -+ pxmitpriv->last_tx_pkts = pxmitpriv->tx_pkts; -+ pmlmeinfo->link_count = 0; -+ } -+ -+ } /* end of if ((psta = rtw_get_stainfo(pstapriv, passoc_res->network.MacAddress)) != NULL) */ -+ } else if (is_client_associated_to_ibss(padapter)) { -+ /* linked IBSS mode */ -+ /* for each assoc list entry to check the rx pkt counter */ -+ for (i = IBSS_START_MAC_ID; i < NUM_STA; i++) { -+ if (pmlmeinfo->FW_sta_info[i].status == 1) { -+ psta = pmlmeinfo->FW_sta_info[i].psta; -+ -+ if (NULL == psta) -+ continue; -+ -+ if (pmlmeinfo->FW_sta_info[i].rx_pkt == sta_rx_pkts(psta)) { -+ -+ if (pmlmeinfo->FW_sta_info[i].retry < 3) { -+ pmlmeinfo->FW_sta_info[i].retry++; -+ } else{ -+ pmlmeinfo->FW_sta_info[i].retry = 0; -+ pmlmeinfo->FW_sta_info[i].status = 0; -+ report_del_sta_event(padapter, psta->hwaddr -+ , 65535/* indicate disconnect caused by no rx */ -+ ); -+ } -+ } else{ -+ pmlmeinfo->FW_sta_info[i].retry = 0; -+ pmlmeinfo->FW_sta_info[i].rx_pkt = (u32)sta_rx_pkts(psta); -+ } -+ } -+ } -+ -+ /* set_link_timer(pmlmeext, DISCONNECT_TO); */ -+ -+ } -+ -+} -+ -+void survey_timer_hdl(struct adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct sitesurvey_parm *psurveyPara; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ /* DBG_871X("marc: survey timer\n"); */ -+ -+ /* issue rtw_sitesurvey_cmd */ -+ if (pmlmeext->sitesurvey_res.state > SCAN_START) { -+ if (pmlmeext->sitesurvey_res.state == SCAN_PROCESS) { -+ pmlmeext->sitesurvey_res.channel_idx++; -+ } -+ -+ if (pmlmeext->scan_abort == true) { -+ { -+ pmlmeext->sitesurvey_res.channel_idx = pmlmeext->sitesurvey_res.ch_num; -+ DBG_871X("%s idx:%d\n", __func__ -+ , pmlmeext->sitesurvey_res.channel_idx -+ ); -+ } -+ -+ pmlmeext->scan_abort = false;/* reset */ -+ } -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ goto exit_survey_timer_hdl; -+ } -+ -+ psurveyPara = (struct sitesurvey_parm *)rtw_zmalloc(sizeof(struct sitesurvey_parm)); -+ if (psurveyPara == NULL) { -+ kfree((unsigned char *)ph2c); -+ goto exit_survey_timer_hdl; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psurveyPara, GEN_CMD_CODE(_SiteSurvey)); -+ rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } -+ -+ -+exit_survey_timer_hdl: -+ -+ return; -+} -+ -+void link_timer_hdl(struct adapter *padapter) -+{ -+ /* static unsigned int rx_pkt = 0; */ -+ /* static u64 tx_cnt = 0; */ -+ /* struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); */ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ /* struct sta_priv *pstapriv = &padapter->stapriv; */ -+ -+ -+ if (pmlmeinfo->state & WIFI_FW_AUTH_NULL) { -+ DBG_871X("link_timer_hdl:no beacon while connecting\n"); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ report_join_res(padapter, -3); -+ } else if (pmlmeinfo->state & WIFI_FW_AUTH_STATE) { -+ /* re-auth timer */ -+ if (++pmlmeinfo->reauth_count > REAUTH_LIMIT) { -+ /* if (pmlmeinfo->auth_algo != dot11AuthAlgrthm_Auto) */ -+ /* */ -+ pmlmeinfo->state = 0; -+ report_join_res(padapter, -1); -+ return; -+ /* */ -+ /* else */ -+ /* */ -+ /* pmlmeinfo->auth_algo = dot11AuthAlgrthm_Shared; */ -+ /* pmlmeinfo->reauth_count = 0; */ -+ /* */ -+ } -+ -+ DBG_871X("link_timer_hdl: auth timeout and try again\n"); -+ pmlmeinfo->auth_seq = 1; -+ issue_auth(padapter, NULL, 0); -+ set_link_timer(pmlmeext, REAUTH_TO); -+ } else if (pmlmeinfo->state & WIFI_FW_ASSOC_STATE) { -+ /* re-assoc timer */ -+ if (++pmlmeinfo->reassoc_count > REASSOC_LIMIT) { -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ report_join_res(padapter, -2); -+ return; -+ } -+ -+ DBG_871X("link_timer_hdl: assoc timeout and try again\n"); -+ issue_assocreq(padapter); -+ set_link_timer(pmlmeext, REASSOC_TO); -+ } -+ -+ return; -+} -+ -+void addba_timer_hdl(struct sta_info *psta) -+{ -+ struct ht_priv *phtpriv; -+ -+ if (!psta) -+ return; -+ -+ phtpriv = &psta->htpriv; -+ -+ if ((phtpriv->ht_option == true) && (phtpriv->ampdu_enable == true)) { -+ if (phtpriv->candidate_tid_bitmap) -+ phtpriv->candidate_tid_bitmap = 0x0; -+ -+ } -+} -+ -+void sa_query_timer_hdl(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ /* disconnect */ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { -+ rtw_disassoc_cmd(padapter, 0, true); -+ rtw_indicate_disconnect(padapter); -+ rtw_free_assoc_resources(padapter, 1); -+ } -+ -+ spin_unlock_bh(&pmlmepriv->lock); -+ DBG_871X("SA query timeout disconnect\n"); -+} -+ -+u8 NULL_hdl(struct adapter *padapter, u8 *pbuf) -+{ -+ return H2C_SUCCESS; -+} -+ -+#ifdef CONFIG_AUTO_AP_MODE -+static int rtw_auto_ap_start_beacon(struct adapter *adapter) -+{ -+ int ret = 0; -+ u8 *pbuf = NULL; -+ uint len; -+ u8 supportRate[16]; -+ int sz = 0, rateLen; -+ u8 *ie; -+ u8 wireless_mode, oper_channel; -+ u8 ssid[3] = {0}; /* hidden ssid */ -+ u32 ssid_len = sizeof(ssid); -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ -+ len = 128; -+ pbuf = rtw_zmalloc(len); -+ if (!pbuf) -+ return -ENOMEM; -+ -+ -+ /* generate beacon */ -+ ie = pbuf; -+ -+ /* timestamp will be inserted by hardware */ -+ sz += 8; -+ ie += sz; -+ -+ /* beacon interval : 2bytes */ -+ *(u16 *)ie = cpu_to_le16((u16)100);/* BCN_INTERVAL = 100; */ -+ sz += 2; -+ ie += 2; -+ -+ /* capability info */ -+ *(u16 *)ie = 0; -+ *(u16 *)ie |= cpu_to_le16(cap_ESS); -+ *(u16 *)ie |= cpu_to_le16(cap_ShortPremble); -+ /* u16*)ie |= cpu_to_le16(cap_Privacy); */ -+ sz += 2; -+ ie += 2; -+ -+ /* SSID */ -+ ie = rtw_set_ie(ie, _SSID_IE_, ssid_len, ssid, &sz); -+ -+ /* supported rates */ -+ wireless_mode = WIRELESS_11BG_24N; -+ rtw_set_supported_rate(supportRate, wireless_mode); -+ rateLen = rtw_get_rateset_len(supportRate); -+ if (rateLen > 8) { -+ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, 8, supportRate, &sz); -+ } else{ -+ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, rateLen, supportRate, &sz); -+ } -+ -+ -+ /* DS parameter set */ -+ if (check_buddy_fwstate(adapter, _FW_LINKED) && -+ check_buddy_fwstate(adapter, WIFI_STATION_STATE)) { -+ struct adapter *pbuddystruct adapter = adapter->pbuddystruct adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddystruct adapter->mlmeextpriv; -+ -+ oper_channel = pbuddy_mlmeext->cur_channel; -+ } else{ -+ oper_channel = adapter_to_dvobj(adapter)->oper_channel; -+ } -+ ie = rtw_set_ie(ie, _DSSET_IE_, 1, &oper_channel, &sz); -+ -+ /* ext supported rates */ -+ if (rateLen > 8) { -+ ie = rtw_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rateLen - 8), (supportRate + 8), &sz); -+ } -+ -+ DBG_871X("%s, start auto ap beacon sz =%d\n", __func__, sz); -+ -+ /* lunch ap mode & start to issue beacon */ -+ if (rtw_check_beacon_data(adapter, pbuf, sz) == _SUCCESS) { -+ -+ } else{ -+ ret = -EINVAL; -+ } -+ -+ -+ kfree(pbuf); -+ -+ return ret; -+ -+} -+#endif/* CONFIG_AUTO_AP_MODE */ -+ -+u8 setopmode_hdl(struct adapter *padapter, u8 *pbuf) -+{ -+ u8 type; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct setopmode_parm *psetop = (struct setopmode_parm *)pbuf; -+ -+ if (psetop->mode == Ndis802_11APMode) { -+ pmlmeinfo->state = WIFI_FW_AP_STATE; -+ type = _HW_STATE_AP_; -+ /* start_ap_mode(padapter); */ -+ } else if (psetop->mode == Ndis802_11Infrastructure) { -+ pmlmeinfo->state &= ~(BIT(0)|BIT(1));/* clear state */ -+ pmlmeinfo->state |= WIFI_FW_STATION_STATE;/* set to STATION_STATE */ -+ type = _HW_STATE_STATION_; -+ } else if (psetop->mode == Ndis802_11IBSS) { -+ type = _HW_STATE_ADHOC_; -+ } else{ -+ type = _HW_STATE_NOLINK_; -+ } -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_OPMODE, (u8 *)(&type)); -+ /* Set_NETYPE0_MSR(padapter, type); */ -+ -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if (psetop->mode == Ndis802_11APMode) -+ rtw_auto_ap_start_beacon(padapter); -+#endif -+ -+ if (rtw_port_switch_chk(padapter) == true) { -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); -+ -+ if (psetop->mode == Ndis802_11APMode) -+ adapter_to_pwrctl(padapter)->fw_psmode_iface_id = 0xff; /* ap mode won't dowload rsvd pages */ -+ else if (psetop->mode == Ndis802_11Infrastructure) { -+ struct adapter *port0_iface = dvobj_get_port0_adapter(adapter_to_dvobj(padapter)); -+ if (port0_iface) -+ rtw_lps_ctrl_wk_cmd(port0_iface, LPS_CTRL_CONNECT, 0); -+ } -+ } -+ -+ if (psetop->mode == Ndis802_11APMode) { -+ /* Do this after port switch to */ -+ /* prevent from downloading rsvd page to wrong port */ -+ rtw_btcoex_MediaStatusNotify(padapter, 1); /* connect */ -+ } -+ -+ return H2C_SUCCESS; -+ -+} -+ -+u8 createbss_hdl(struct adapter *padapter, u8 *pbuf) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *pnetwork = (struct wlan_bssid_ex *)(&(pmlmeinfo->network)); -+ struct joinbss_parm *pparm = (struct joinbss_parm *)pbuf; -+ /* u32 initialgain; */ -+ -+ if (pmlmeinfo->state == WIFI_FW_AP_STATE) { -+ struct wlan_bssid_ex *network = &padapter->mlmepriv.cur_network.network; -+ start_bss_network(padapter, (u8 *)network); -+ return H2C_SUCCESS; -+ } -+ -+ /* below is for ad-hoc master */ -+ if (pparm->network.InfrastructureMode == Ndis802_11IBSS) { -+ rtw_joinbss_reset(padapter); -+ -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ pmlmeinfo->ERP_enable = 0; -+ pmlmeinfo->WMM_enable = 0; -+ pmlmeinfo->HT_enable = 0; -+ pmlmeinfo->HT_caps_enable = 0; -+ pmlmeinfo->HT_info_enable = 0; -+ pmlmeinfo->agg_enable_bitmap = 0; -+ pmlmeinfo->candidate_tid_bitmap = 0; -+ -+ /* disable dynamic functions, such as high power, DIG */ -+ Save_DM_Func_Flag(padapter); -+ Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); -+ -+ /* config the initial gain under linking, need to write the BB registers */ -+ /* initialgain = 0x1E; */ -+ /* rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); */ -+ -+ /* cancel link timer */ -+ del_timer_sync(&pmlmeext->link_timer); -+ -+ /* clear CAM */ -+ flush_all_cam_entry(padapter); -+ -+ memcpy(pnetwork, pbuf, FIELD_OFFSET(struct wlan_bssid_ex, IELength)); -+ pnetwork->IELength = ((struct wlan_bssid_ex *)pbuf)->IELength; -+ -+ if (pnetwork->IELength > MAX_IE_SZ)/* Check pbuf->IELength */ -+ return H2C_PARAMETERS_ERROR; -+ -+ memcpy(pnetwork->IEs, ((struct wlan_bssid_ex *)pbuf)->IEs, pnetwork->IELength); -+ -+ start_create_ibss(padapter); -+ -+ } -+ -+ return H2C_SUCCESS; -+ -+} -+ -+u8 join_cmd_hdl(struct adapter *padapter, u8 *pbuf) -+{ -+ u8 join_type; -+ struct ndis_80211_var_ie *pIE; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *pnetwork = (struct wlan_bssid_ex *)(&(pmlmeinfo->network)); -+ u32 i; -+ u8 cbw40_enable = 0; -+ /* u32 initialgain; */ -+ /* u32 acparm; */ -+ u8 ch, bw, offset; -+ -+ /* check already connecting to AP or not */ -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) { -+ if (pmlmeinfo->state & WIFI_FW_STATION_STATE) { -+ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 1, 100); -+ } -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+ /* clear CAM */ -+ flush_all_cam_entry(padapter); -+ -+ del_timer_sync(&pmlmeext->link_timer); -+ -+ /* set MSR to nolink -> infra. mode */ -+ /* Set_MSR(padapter, _HW_STATE_NOLINK_); */ -+ Set_MSR(padapter, _HW_STATE_STATION_); -+ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, NULL); -+ } -+ -+ rtw_joinbss_reset(padapter); -+ -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ pmlmeinfo->ERP_enable = 0; -+ pmlmeinfo->WMM_enable = 0; -+ pmlmeinfo->HT_enable = 0; -+ pmlmeinfo->HT_caps_enable = 0; -+ pmlmeinfo->HT_info_enable = 0; -+ pmlmeinfo->agg_enable_bitmap = 0; -+ pmlmeinfo->candidate_tid_bitmap = 0; -+ pmlmeinfo->bwmode_updated = false; -+ /* pmlmeinfo->assoc_AP_vendor = HT_IOT_PEER_MAX; */ -+ pmlmeinfo->VHT_enable = 0; -+ -+ memcpy(pnetwork, pbuf, FIELD_OFFSET(struct wlan_bssid_ex, IELength)); -+ pnetwork->IELength = ((struct wlan_bssid_ex *)pbuf)->IELength; -+ -+ if (pnetwork->IELength > MAX_IE_SZ)/* Check pbuf->IELength */ -+ return H2C_PARAMETERS_ERROR; -+ -+ memcpy(pnetwork->IEs, ((struct wlan_bssid_ex *)pbuf)->IEs, pnetwork->IELength); -+ -+ pmlmeext->cur_channel = (u8)pnetwork->Configuration.DSConfig; -+ pmlmeinfo->bcn_interval = get_beacon_interval(pnetwork); -+ -+ /* Check AP vendor to move rtw_joinbss_cmd() */ -+ /* pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->IEs, pnetwork->IELength); */ -+ -+ /* sizeof(struct ndis_802_11_fix_ie) */ -+ for (i = _FIXED_IE_LENGTH_; i < pnetwork->IELength;) { -+ pIE = (struct ndis_80211_var_ie *)(pnetwork->IEs + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_:/* Get WMM IE. */ -+ if (!memcmp(pIE->data, WMM_OUI, 4)) -+ WMM_param_handler(padapter, pIE); -+ break; -+ -+ case _HT_CAPABILITY_IE_: /* Get HT Cap IE. */ -+ pmlmeinfo->HT_caps_enable = 1; -+ break; -+ -+ case _HT_EXTRA_INFO_IE_: /* Get HT Info IE. */ -+ pmlmeinfo->HT_info_enable = 1; -+ -+ /* spec case only for cisco's ap because cisco's ap issue assoc rsp using mcs rate @40MHz or @20MHz */ -+ { -+ struct HT_info_element *pht_info = (struct HT_info_element *)(pIE->data); -+ -+ if (pnetwork->Configuration.DSConfig > 14) { -+ if ((pregpriv->bw_mode >> 4) > CHANNEL_WIDTH_20) -+ cbw40_enable = 1; -+ } else { -+ if ((pregpriv->bw_mode & 0x0f) > CHANNEL_WIDTH_20) -+ cbw40_enable = 1; -+ } -+ -+ if ((cbw40_enable) && (pht_info->infos[0] & BIT(2))) { -+ /* switch to the 40M Hz mode according to the AP */ -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; -+ switch (pht_info->infos[0] & 0x3) { -+ case 1: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case 3: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ break; -+ } -+ -+ DBG_871X("set HT ch/bw before connected\n"); -+ } -+ } -+ break; -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ /* check channel, bandwidth, offset and switch */ -+ if (rtw_chk_start_clnt_join(padapter, &ch, &bw, &offset) == _FAIL) { -+ report_join_res(padapter, (-4)); -+ return H2C_SUCCESS; -+ } -+ -+ /* disable dynamic functions, such as high power, DIG */ -+ /* Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); */ -+ -+ /* config the initial gain under linking, need to write the BB registers */ -+ /* initialgain = 0x1E; */ -+ /* rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); */ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress); -+ join_type = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, NULL); -+ -+ set_channel_bwmode(padapter, ch, offset, bw); -+ -+ /* cancel link timer */ -+ del_timer_sync(&pmlmeext->link_timer); -+ -+ start_clnt_join(padapter); -+ -+ return H2C_SUCCESS; -+ -+} -+ -+u8 disconnect_hdl(struct adapter *padapter, unsigned char *pbuf) -+{ -+ struct disconnect_parm *param = (struct disconnect_parm *)pbuf; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *pnetwork = (struct wlan_bssid_ex *)(&(pmlmeinfo->network)); -+ u8 val8; -+ -+ if (is_client_associated_to_ap(padapter)) { -+ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, param->deauth_timeout_ms/100, 100); -+ } -+ -+ if (((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) { -+ /* Stop BCN */ -+ val8 = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_FUNC, (u8 *)(&val8)); -+ } -+ -+ rtw_mlmeext_disconnect(padapter); -+ -+ rtw_free_uc_swdec_pending_queue(padapter); -+ -+ return H2C_SUCCESS; -+} -+ -+static int rtw_scan_ch_decision(struct adapter *padapter, struct rtw_ieee80211_channel *out, -+ u32 out_num, struct rtw_ieee80211_channel *in, u32 in_num) -+{ -+ int i, j; -+ int set_idx; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ /* clear first */ -+ memset(out, 0, sizeof(struct rtw_ieee80211_channel)*out_num); -+ -+ /* acquire channels from in */ -+ j = 0; -+ for (i = 0; i < in_num; i++) { -+ -+ DBG_871X(FUNC_ADPT_FMT" "CHAN_FMT"\n", FUNC_ADPT_ARG(padapter), CHAN_ARG(&in[i])); -+ -+ set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, in[i].hw_value); -+ if (in[i].hw_value && !(in[i].flags & RTW_IEEE80211_CHAN_DISABLED) -+ && set_idx >= 0 -+ && rtw_mlme_band_check(padapter, in[i].hw_value) == true -+ ) { -+ if (j >= out_num) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" out_num:%u not enough\n", -+ FUNC_ADPT_ARG(padapter), out_num); -+ break; -+ } -+ -+ memcpy(&out[j], &in[i], sizeof(struct rtw_ieee80211_channel)); -+ -+ if (pmlmeext->channel_set[set_idx].ScanType == SCAN_PASSIVE) -+ out[j].flags |= RTW_IEEE80211_CHAN_PASSIVE_SCAN; -+ -+ j++; -+ } -+ if (j >= out_num) -+ break; -+ } -+ -+ /* if out is empty, use channel_set as default */ -+ if (j == 0) { -+ for (i = 0; i < pmlmeext->max_chan_nums; i++) { -+ -+ DBG_871X(FUNC_ADPT_FMT" ch:%u\n", FUNC_ADPT_ARG(padapter), pmlmeext->channel_set[i].ChannelNum); -+ -+ if (rtw_mlme_band_check(padapter, pmlmeext->channel_set[i].ChannelNum) == true) { -+ -+ if (j >= out_num) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" out_num:%u not enough\n", -+ FUNC_ADPT_ARG(padapter), out_num); -+ break; -+ } -+ -+ out[j].hw_value = pmlmeext->channel_set[i].ChannelNum; -+ -+ if (pmlmeext->channel_set[i].ScanType == SCAN_PASSIVE) -+ out[j].flags |= RTW_IEEE80211_CHAN_PASSIVE_SCAN; -+ -+ j++; -+ } -+ } -+ } -+ -+ return j; -+} -+ -+u8 sitesurvey_cmd_hdl(struct adapter *padapter, u8 *pbuf) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct sitesurvey_parm *pparm = (struct sitesurvey_parm *)pbuf; -+ u8 bdelayscan = false; -+ u8 val8; -+ u32 initialgain; -+ u32 i; -+ -+ if (pmlmeext->sitesurvey_res.state == SCAN_DISABLE) { -+ pmlmeext->sitesurvey_res.state = SCAN_START; -+ pmlmeext->sitesurvey_res.bss_cnt = 0; -+ pmlmeext->sitesurvey_res.channel_idx = 0; -+ -+ for (i = 0; i < RTW_SSID_SCAN_AMOUNT; i++) { -+ if (pparm->ssid[i].SsidLength) { -+ memcpy(pmlmeext->sitesurvey_res.ssid[i].Ssid, pparm->ssid[i].Ssid, IW_ESSID_MAX_SIZE); -+ pmlmeext->sitesurvey_res.ssid[i].SsidLength = pparm->ssid[i].SsidLength; -+ } else { -+ pmlmeext->sitesurvey_res.ssid[i].SsidLength = 0; -+ } -+ } -+ -+ pmlmeext->sitesurvey_res.ch_num = rtw_scan_ch_decision(padapter -+ , pmlmeext->sitesurvey_res.ch, RTW_CHANNEL_SCAN_AMOUNT -+ , pparm->ch, pparm->ch_num -+ ); -+ -+ pmlmeext->sitesurvey_res.scan_mode = pparm->scan_mode; -+ -+ /* issue null data if associating to the AP */ -+ if (is_client_associated_to_ap(padapter) == true) { -+ pmlmeext->sitesurvey_res.state = SCAN_TXNULL; -+ -+ issue_nulldata(padapter, NULL, 1, 3, 500); -+ -+ bdelayscan = true; -+ } -+ if (bdelayscan) { -+ /* delay 50ms to protect nulldata(1). */ -+ set_survey_timer(pmlmeext, 50); -+ return H2C_SUCCESS; -+ } -+ } -+ -+ if ((pmlmeext->sitesurvey_res.state == SCAN_START) || (pmlmeext->sitesurvey_res.state == SCAN_TXNULL)) { -+ /* disable dynamic functions, such as high power, DIG */ -+ Save_DM_Func_Flag(padapter); -+ Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); -+ -+ /* config the initial gain under scaning, need to write the BB registers */ -+ initialgain = 0x1e; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); -+ -+ /* set MSR to no link state */ -+ Set_MSR(padapter, _HW_STATE_NOLINK_); -+ -+ val8 = 1; /* under site survey */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ -+ pmlmeext->sitesurvey_res.state = SCAN_PROCESS; -+ } -+ -+ site_survey(padapter); -+ -+ return H2C_SUCCESS; -+ -+} -+ -+u8 setauth_hdl(struct adapter *padapter, unsigned char *pbuf) -+{ -+ struct setauth_parm *pparm = (struct setauth_parm *)pbuf; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pparm->mode < 4) { -+ pmlmeinfo->auth_algo = pparm->mode; -+ } -+ -+ return H2C_SUCCESS; -+} -+ -+u8 setkey_hdl(struct adapter *padapter, u8 *pbuf) -+{ -+ u16 ctrl = 0; -+ s16 cam_id = 0; -+ struct setkey_parm *pparm = (struct setkey_parm *)pbuf; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ unsigned char null_addr[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ u8 *addr; -+ -+ /* main tx key for wep. */ -+ if (pparm->set_tx) -+ pmlmeinfo->key_index = pparm->keyid; -+ -+ cam_id = rtw_camid_alloc(padapter, NULL, pparm->keyid); -+ -+ if (cam_id < 0) { -+ } else { -+ if (cam_id > 3) /* not default key, searched by A2 */ -+ addr = get_bssid(&padapter->mlmepriv); -+ else -+ addr = null_addr; -+ -+ ctrl = BIT(15) | BIT6 | ((pparm->algorithm) << 2) | pparm->keyid; -+ write_cam(padapter, cam_id, ctrl, addr, pparm->key); -+ DBG_871X_LEVEL(_drv_always_, "set group key camid:%d, addr:"MAC_FMT", kid:%d, type:%s\n" -+ , cam_id, MAC_ARG(addr), pparm->keyid, security_type_str(pparm->algorithm)); -+ } -+ -+ if (cam_id >= 0 && cam_id <= 3) -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_DK_CFG, (u8 *)true); -+ -+ /* allow multicast packets to driver */ -+ padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_ON_RCR_AM, null_addr); -+ -+ return H2C_SUCCESS; -+} -+ -+u8 set_stakey_hdl(struct adapter *padapter, u8 *pbuf) -+{ -+ u16 ctrl = 0; -+ s16 cam_id = 0; -+ u8 ret = H2C_SUCCESS; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct set_stakey_parm *pparm = (struct set_stakey_parm *)pbuf; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ -+ if (pparm->algorithm == _NO_PRIVACY_) -+ goto write_to_cam; -+ -+ psta = rtw_get_stainfo(pstapriv, pparm->addr); -+ if (!psta) { -+ DBG_871X_LEVEL(_drv_always_, "%s sta:"MAC_FMT" not found\n", __func__, MAC_ARG(pparm->addr)); -+ ret = H2C_REJECTED; -+ goto exit; -+ } -+ -+ pmlmeinfo->enc_algo = pparm->algorithm; -+ cam_id = rtw_camid_alloc(padapter, psta, 0); -+ if (cam_id < 0) -+ goto exit; -+ -+write_to_cam: -+ if (pparm->algorithm == _NO_PRIVACY_) { -+ while ((cam_id = rtw_camid_search(padapter, pparm->addr, -1)) >= 0) { -+ DBG_871X_LEVEL(_drv_always_, "clear key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(pparm->addr), cam_id); -+ clear_cam_entry(padapter, cam_id); -+ rtw_camid_free(padapter, cam_id); -+ } -+ } else { -+ DBG_871X_LEVEL(_drv_always_, "set pairwise key camid:%d, addr:"MAC_FMT", kid:%d, type:%s\n", -+ cam_id, MAC_ARG(pparm->addr), pparm->keyid, security_type_str(pparm->algorithm)); -+ ctrl = BIT(15) | ((pparm->algorithm) << 2) | pparm->keyid; -+ write_cam(padapter, cam_id, ctrl, pparm->addr, pparm->key); -+ } -+ ret = H2C_SUCCESS_RSP; -+ -+exit: -+ return ret; -+} -+ -+u8 add_ba_hdl(struct adapter *padapter, unsigned char *pbuf) -+{ -+ struct addBaReq_parm *pparm = (struct addBaReq_parm *)pbuf; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, pparm->addr); -+ -+ if (!psta) -+ return H2C_SUCCESS; -+ -+ if (((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && (pmlmeinfo->HT_enable)) || -+ ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) { -+ /* pmlmeinfo->ADDBA_retry_count = 0; */ -+ /* pmlmeinfo->candidate_tid_bitmap |= (0x1 << pparm->tid); */ -+ /* psta->htpriv.candidate_tid_bitmap |= BIT(pparm->tid); */ -+ issue_action_BA(padapter, pparm->addr, RTW_WLAN_ACTION_ADDBA_REQ, (u16)pparm->tid); -+ /* _set_timer(&pmlmeext->ADDBA_timer, ADDBA_TO); */ -+ _set_timer(&psta->addba_retry_timer, ADDBA_TO); -+ } else{ -+ psta->htpriv.candidate_tid_bitmap &= ~BIT(pparm->tid); -+ } -+ return H2C_SUCCESS; -+} -+ -+ -+u8 chk_bmc_sleepq_cmd(struct adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_parm_rsp(ph2c, GEN_CMD_CODE(_ChkBMCSleepq)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+u8 set_tx_beacon_cmd(struct adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct Tx_Beacon_param *ptxBeacon_parm; -+ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 res = _SUCCESS; -+ int len_diff = 0; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ ptxBeacon_parm = (struct Tx_Beacon_param *)rtw_zmalloc(sizeof(struct Tx_Beacon_param)); -+ if (ptxBeacon_parm == NULL) { -+ kfree((unsigned char *)ph2c); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ memcpy(&(ptxBeacon_parm->network), &(pmlmeinfo->network), sizeof(struct wlan_bssid_ex)); -+ -+ len_diff = update_hidden_ssid( -+ ptxBeacon_parm->network.IEs+_BEACON_IE_OFFSET_ -+ , ptxBeacon_parm->network.IELength-_BEACON_IE_OFFSET_ -+ , pmlmeinfo->hidden_ssid_mode -+ ); -+ ptxBeacon_parm->network.IELength += len_diff; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, ptxBeacon_parm, GEN_CMD_CODE(_TX_Beacon)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+ -+u8 mlme_evt_hdl(struct adapter *padapter, unsigned char *pbuf) -+{ -+ u8 evt_code, evt_seq; -+ u16 evt_sz; -+ uint *peventbuf; -+ void (*event_callback)(struct adapter *dev, u8 *pbuf); -+ struct evt_priv *pevt_priv = &(padapter->evtpriv); -+ -+ if (pbuf == NULL) -+ goto _abort_event_; -+ -+ peventbuf = (uint *)pbuf; -+ evt_sz = (u16)(*peventbuf&0xffff); -+ evt_seq = (u8)((*peventbuf>>24)&0x7f); -+ evt_code = (u8)((*peventbuf>>16)&0xff); -+ -+ -+ #ifdef CHECK_EVENT_SEQ -+ /* checking event sequence... */ -+ if (evt_seq != (atomic_read(&pevt_priv->event_seq) & 0x7f)) { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, ("Evetn Seq Error! %d vs %d\n", (evt_seq & 0x7f), (atomic_read(&pevt_priv->event_seq) & 0x7f))); -+ -+ pevt_priv->event_seq = (evt_seq+1)&0x7f; -+ -+ goto _abort_event_; -+ } -+ #endif -+ -+ /* checking if event code is valid */ -+ if (evt_code >= MAX_C2HEVT) { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("\nEvent Code(%d) mismatch!\n", evt_code)); -+ goto _abort_event_; -+ } -+ -+ /* checking if event size match the event parm size */ -+ if ((wlanevents[evt_code].parmsize != 0) && -+ (wlanevents[evt_code].parmsize != evt_sz)) { -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("\nEvent(%d) Parm Size mismatch (%d vs %d)!\n", -+ evt_code, wlanevents[evt_code].parmsize, evt_sz)); -+ goto _abort_event_; -+ -+ } -+ -+ atomic_inc(&pevt_priv->event_seq); -+ -+ peventbuf += 2; -+ -+ if (peventbuf) { -+ event_callback = wlanevents[evt_code].event_callback; -+ event_callback(padapter, (u8 *)peventbuf); -+ -+ pevt_priv->evt_done_cnt++; -+ } -+ -+ -+_abort_event_: -+ -+ -+ return H2C_SUCCESS; -+ -+} -+ -+u8 h2c_msg_hdl(struct adapter *padapter, unsigned char *pbuf) -+{ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ return H2C_SUCCESS; -+} -+ -+u8 chk_bmc_sleepq_hdl(struct adapter *padapter, unsigned char *pbuf) -+{ -+ struct sta_info *psta_bmc; -+ struct list_head *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe = NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ /* for BC/MC Frames */ -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ if (!psta_bmc) -+ return H2C_SUCCESS; -+ -+ if ((pstapriv->tim_bitmap&BIT(0)) && (psta_bmc->sleepq_len > 0)) { -+ msleep(10);/* 10ms, ATIM(HIQ) Windows */ -+ -+ /* spin_lock_bh(&psta_bmc->sleep_q.lock); */ -+ spin_lock_bh(&pxmitpriv->lock); -+ -+ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while (xmitframe_phead != xmitframe_plist) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ list_del_init(&pxmitframe->list); -+ -+ psta_bmc->sleepq_len--; -+ if (psta_bmc->sleepq_len > 0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ pxmitframe->attrib.triggered = 1; -+ -+ if (xmitframe_hiq_filter(pxmitframe) == true) -+ pxmitframe->attrib.qsel = 0x11;/* HIQ */ -+ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ } -+ -+ /* spin_unlock_bh(&psta_bmc->sleep_q.lock); */ -+ spin_unlock_bh(&pxmitpriv->lock); -+ -+ /* check hi queue and bmc_sleepq */ -+ rtw_chk_hi_queue_cmd(padapter); -+ } -+ -+ return H2C_SUCCESS; -+} -+ -+u8 tx_beacon_hdl(struct adapter *padapter, unsigned char *pbuf) -+{ -+ if (send_beacon(padapter) == _FAIL) { -+ DBG_871X("issue_beacon, fail!\n"); -+ return H2C_PARAMETERS_ERROR; -+ } -+ -+ /* tx bc/mc frames after update TIM */ -+ chk_bmc_sleepq_hdl(padapter, NULL); -+ -+ return H2C_SUCCESS; -+} -+ -+int rtw_chk_start_clnt_join(struct adapter *padapter, u8 *ch, u8 *bw, u8 *offset) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ unsigned char cur_ch = pmlmeext->cur_channel; -+ unsigned char cur_bw = pmlmeext->cur_bwmode; -+ unsigned char cur_ch_offset = pmlmeext->cur_ch_offset; -+ bool connect_allow = true; -+ -+ if (!ch || !bw || !offset) { -+ rtw_warn_on(1); -+ connect_allow = false; -+ } -+ -+ if (connect_allow == true) { -+ DBG_871X("start_join_set_ch_bw: ch =%d, bwmode =%d, ch_offset =%d\n", cur_ch, cur_bw, cur_ch_offset); -+ *ch = cur_ch; -+ *bw = cur_bw; -+ *offset = cur_ch_offset; -+ } -+ -+ return connect_allow == true ? _SUCCESS : _FAIL; -+} -+ -+/* Find union about ch, bw, ch_offset of all linked/linking interfaces */ -+int rtw_get_ch_setting_union(struct adapter *adapter, u8 *ch, u8 *bw, u8 *offset) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct adapter *iface; -+ struct mlme_ext_priv *mlmeext; -+ u8 ch_ret = 0; -+ u8 bw_ret = CHANNEL_WIDTH_20; -+ u8 offset_ret = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if (ch) -+ *ch = 0; -+ if (bw) -+ *bw = CHANNEL_WIDTH_20; -+ if (offset) -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ iface = dvobj->padapters; -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (!check_fwstate(&iface->mlmepriv, _FW_LINKED|_FW_UNDER_LINKING)) -+ return 0; -+ -+ ch_ret = mlmeext->cur_channel; -+ bw_ret = mlmeext->cur_bwmode; -+ offset_ret = mlmeext->cur_ch_offset; -+ -+ return 1; -+} -+ -+u8 set_ch_hdl(struct adapter *padapter, u8 *pbuf) -+{ -+ struct set_ch_parm *set_ch_parm; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ set_ch_parm = (struct set_ch_parm *)pbuf; -+ -+ DBG_871X(FUNC_NDEV_FMT" ch:%u, bw:%u, ch_offset:%u\n", -+ FUNC_NDEV_ARG(padapter->pnetdev), -+ set_ch_parm->ch, set_ch_parm->bw, set_ch_parm->ch_offset); -+ -+ pmlmeext->cur_channel = set_ch_parm->ch; -+ pmlmeext->cur_ch_offset = set_ch_parm->ch_offset; -+ pmlmeext->cur_bwmode = set_ch_parm->bw; -+ -+ set_channel_bwmode(padapter, set_ch_parm->ch, set_ch_parm->ch_offset, set_ch_parm->bw); -+ -+ return H2C_SUCCESS; -+} -+ -+u8 set_chplan_hdl(struct adapter *padapter, unsigned char *pbuf) -+{ -+ struct SetChannelPlan_param *setChannelPlan_param; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ setChannelPlan_param = (struct SetChannelPlan_param *)pbuf; -+ -+ pmlmeext->max_chan_nums = init_channel_set(padapter, setChannelPlan_param->channel_plan, pmlmeext->channel_set); -+ init_channel_list(padapter, pmlmeext->channel_set, pmlmeext->max_chan_nums, &pmlmeext->channel_list); -+ -+ if ((padapter->rtw_wdev != NULL) && (padapter->rtw_wdev->wiphy)) { -+ struct regulatory_request request; -+ request.initiator = NL80211_REGDOM_SET_BY_DRIVER; -+ rtw_reg_notifier(padapter->rtw_wdev->wiphy, &request); -+ } -+ -+ return H2C_SUCCESS; -+} -+ -+u8 led_blink_hdl(struct adapter *padapter, unsigned char *pbuf) -+{ -+ struct LedBlink_param *ledBlink_param; -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ ledBlink_param = (struct LedBlink_param *)pbuf; -+ return H2C_SUCCESS; -+} -+ -+u8 set_csa_hdl(struct adapter *padapter, unsigned char *pbuf) -+{ -+ return H2C_REJECTED; -+} -+ -+/* TDLS_ESTABLISHED : write RCR DATA BIT */ -+/* TDLS_CS_OFF : go back to the channel linked with AP, terminating channel switch procedure */ -+/* TDLS_INIT_CH_SEN : init channel sensing, receive all data and mgnt frame */ -+/* TDLS_DONE_CH_SEN: channel sensing and report candidate channel */ -+/* TDLS_OFF_CH : first time set channel to off channel */ -+/* TDLS_BASE_CH : go back tp the channel linked with AP when set base channel as target channel */ -+/* TDLS_P_OFF_CH : periodically go to off channel */ -+/* TDLS_P_BASE_CH : periodically go back to base channel */ -+/* TDLS_RS_RCR : restore RCR */ -+/* TDLS_TEAR_STA : free tdls sta */ -+u8 tdls_hdl(struct adapter *padapter, unsigned char *pbuf) -+{ -+ return H2C_REJECTED; -+} -+ -+u8 run_in_thread_hdl(struct adapter *padapter, u8 *pbuf) -+{ -+ struct RunInThread_param *p; -+ -+ -+ if (NULL == pbuf) -+ return H2C_PARAMETERS_ERROR; -+ p = (struct RunInThread_param *)pbuf; -+ -+ if (p->func) -+ p->func(p->context); -+ -+ return H2C_SUCCESS; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_odm.c linux/3rdparty/rtl8723bs/core/rtw_odm.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_odm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_odm.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,195 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+#include -+#include -+ -+static const char *odm_comp_str[] = { -+ /* BIT0 */"ODM_COMP_DIG", -+ /* BIT1 */"ODM_COMP_RA_MASK", -+ /* BIT2 */"ODM_COMP_DYNAMIC_TXPWR", -+ /* BIT3 */"ODM_COMP_FA_CNT", -+ /* BIT4 */"ODM_COMP_RSSI_MONITOR", -+ /* BIT5 */"ODM_COMP_CCK_PD", -+ /* BIT6 */"ODM_COMP_ANT_DIV", -+ /* BIT7 */"ODM_COMP_PWR_SAVE", -+ /* BIT8 */"ODM_COMP_PWR_TRAIN", -+ /* BIT9 */"ODM_COMP_RATE_ADAPTIVE", -+ /* BIT10 */"ODM_COMP_PATH_DIV", -+ /* BIT11 */"ODM_COMP_PSD", -+ /* BIT12 */"ODM_COMP_DYNAMIC_PRICCA", -+ /* BIT13 */"ODM_COMP_RXHP", -+ /* BIT14 */"ODM_COMP_MP", -+ /* BIT15 */"ODM_COMP_DYNAMIC_ATC", -+ /* BIT16 */"ODM_COMP_EDCA_TURBO", -+ /* BIT17 */"ODM_COMP_EARLY_MODE", -+ /* BIT18 */NULL, -+ /* BIT19 */NULL, -+ /* BIT20 */NULL, -+ /* BIT21 */NULL, -+ /* BIT22 */NULL, -+ /* BIT23 */NULL, -+ /* BIT24 */"ODM_COMP_TX_PWR_TRACK", -+ /* BIT25 */"ODM_COMP_RX_GAIN_TRACK", -+ /* BIT26 */"ODM_COMP_CALIBRATION", -+ /* BIT27 */NULL, -+ /* BIT28 */NULL, -+ /* BIT29 */NULL, -+ /* BIT30 */"ODM_COMP_COMMON", -+ /* BIT31 */"ODM_COMP_INIT", -+}; -+ -+#define RTW_ODM_COMP_MAX 32 -+ -+static const char *odm_ability_str[] = { -+ /* BIT0 */"ODM_BB_DIG", -+ /* BIT1 */"ODM_BB_RA_MASK", -+ /* BIT2 */"ODM_BB_DYNAMIC_TXPWR", -+ /* BIT3 */"ODM_BB_FA_CNT", -+ /* BIT4 */"ODM_BB_RSSI_MONITOR", -+ /* BIT5 */"ODM_BB_CCK_PD", -+ /* BIT6 */"ODM_BB_ANT_DIV", -+ /* BIT7 */"ODM_BB_PWR_SAVE", -+ /* BIT8 */"ODM_BB_PWR_TRAIN", -+ /* BIT9 */"ODM_BB_RATE_ADAPTIVE", -+ /* BIT10 */"ODM_BB_PATH_DIV", -+ /* BIT11 */"ODM_BB_PSD", -+ /* BIT12 */"ODM_BB_RXHP", -+ /* BIT13 */"ODM_BB_ADAPTIVITY", -+ /* BIT14 */"ODM_BB_DYNAMIC_ATC", -+ /* BIT15 */NULL, -+ /* BIT16 */"ODM_MAC_EDCA_TURBO", -+ /* BIT17 */"ODM_MAC_EARLY_MODE", -+ /* BIT18 */NULL, -+ /* BIT19 */NULL, -+ /* BIT20 */NULL, -+ /* BIT21 */NULL, -+ /* BIT22 */NULL, -+ /* BIT23 */NULL, -+ /* BIT24 */"ODM_RF_TX_PWR_TRACK", -+ /* BIT25 */"ODM_RF_RX_GAIN_TRACK", -+ /* BIT26 */"ODM_RF_CALIBRATION", -+}; -+ -+#define RTW_ODM_ABILITY_MAX 27 -+ -+static const char *odm_dbg_level_str[] = { -+ NULL, -+ "ODM_DBG_OFF", -+ "ODM_DBG_SERIOUS", -+ "ODM_DBG_WARNING", -+ "ODM_DBG_LOUD", -+ "ODM_DBG_TRACE", -+}; -+ -+#define RTW_ODM_DBG_LEVEL_NUM 6 -+ -+void rtw_odm_dbg_comp_msg(void *sel, struct adapter *adapter) -+{ -+ u64 dbg_comp; -+ int i; -+ -+ rtw_hal_get_def_var(adapter, HW_DEF_ODM_DBG_FLAG, &dbg_comp); -+ DBG_871X_SEL_NL(sel, "odm.DebugComponents = 0x%016llx\n", dbg_comp); -+ for (i = 0; i < RTW_ODM_COMP_MAX; i++) { -+ if (odm_comp_str[i]) -+ DBG_871X_SEL_NL(sel, "%cBIT%-2d %s\n", -+ (BIT0 << i) & dbg_comp ? '+' : ' ', i, odm_comp_str[i]); -+ } -+} -+ -+inline void rtw_odm_dbg_comp_set(struct adapter *adapter, u64 comps) -+{ -+ rtw_hal_set_def_var(adapter, HW_DEF_ODM_DBG_FLAG, &comps); -+} -+ -+void rtw_odm_dbg_level_msg(void *sel, struct adapter *adapter) -+{ -+ u32 dbg_level; -+ int i; -+ -+ rtw_hal_get_def_var(adapter, HW_DEF_ODM_DBG_LEVEL, &dbg_level); -+ DBG_871X_SEL_NL(sel, "odm.DebugLevel = %u\n", dbg_level); -+ for (i = 0; i < RTW_ODM_DBG_LEVEL_NUM; i++) { -+ if (odm_dbg_level_str[i]) -+ DBG_871X_SEL_NL(sel, "%u %s\n", i, odm_dbg_level_str[i]); -+ } -+} -+ -+inline void rtw_odm_dbg_level_set(struct adapter *adapter, u32 level) -+{ -+ rtw_hal_set_def_var(adapter, HW_DEF_ODM_DBG_LEVEL, &level); -+} -+ -+void rtw_odm_ability_msg(void *sel, struct adapter *adapter) -+{ -+ u32 ability = 0; -+ int i; -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_DM_FLAG, (u8 *)&ability); -+ DBG_871X_SEL_NL(sel, "odm.SupportAbility = 0x%08x\n", ability); -+ for (i = 0; i < RTW_ODM_ABILITY_MAX; i++) { -+ if (odm_ability_str[i]) -+ DBG_871X_SEL_NL(sel, "%cBIT%-2d %s\n", -+ (BIT0 << i) & ability ? '+' : ' ', i, odm_ability_str[i]); -+ } -+} -+ -+inline void rtw_odm_ability_set(struct adapter *adapter, u32 ability) -+{ -+ rtw_hal_set_hwreg(adapter, HW_VAR_DM_FLAG, (u8 *)&ability); -+} -+ -+void rtw_odm_adaptivity_parm_msg(void *sel, struct adapter *adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &pHalData->odmpriv; -+ -+ DBG_871X_SEL_NL(sel, "%10s %16s %8s %10s %11s %14s\n" -+ , "TH_L2H_ini", "TH_EDCCA_HL_diff", "IGI_Base", "ForceEDCCA", "AdapEn_RSSI", "IGI_LowerBound"); -+ DBG_871X_SEL_NL(sel, "0x%-8x %-16d 0x%-6x %-10d %-11u %-14u\n" -+ , (u8)odm->TH_L2H_ini -+ , odm->TH_EDCCA_HL_diff -+ , odm->IGI_Base -+ , odm->ForceEDCCA -+ , odm->AdapEn_RSSI -+ , odm->IGI_LowerBound -+ ); -+} -+ -+void rtw_odm_adaptivity_parm_set(struct adapter *adapter, s8 TH_L2H_ini, s8 TH_EDCCA_HL_diff, -+ s8 IGI_Base, bool ForceEDCCA, u8 AdapEn_RSSI, u8 IGI_LowerBound) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &pHalData->odmpriv; -+ -+ odm->TH_L2H_ini = TH_L2H_ini; -+ odm->TH_EDCCA_HL_diff = TH_EDCCA_HL_diff; -+ odm->IGI_Base = IGI_Base; -+ odm->ForceEDCCA = ForceEDCCA; -+ odm->AdapEn_RSSI = AdapEn_RSSI; -+ odm->IGI_LowerBound = IGI_LowerBound; -+} -+ -+void rtw_odm_get_perpkt_rssi(void *sel, struct adapter *adapter) -+{ -+ struct hal_com_data *hal_data = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &(hal_data->odmpriv); -+ -+ DBG_871X_SEL_NL(sel, "RxRate = %s, RSSI_A = %d(%%), RSSI_B = %d(%%)\n", -+ HDATA_RATE(odm->RxRate), odm->RSSI_A, odm->RSSI_B); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_pwrctrl.c linux/3rdparty/rtl8723bs/core/rtw_pwrctrl.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_pwrctrl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_pwrctrl.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1421 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_PWRCTRL_C_ -+ -+#include -+#include -+#include -+#include -+ -+ -+void _ips_enter(struct adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ -+ pwrpriv->bips_processing = true; -+ -+ /* syn ips_mode with request */ -+ pwrpriv->ips_mode = pwrpriv->ips_mode_req; -+ -+ pwrpriv->ips_enter_cnts++; -+ DBG_871X("==>ips_enter cnts:%d\n", pwrpriv->ips_enter_cnts); -+ -+ if (rf_off == pwrpriv->change_rfpwrstate) { -+ pwrpriv->bpower_saving = true; -+ DBG_871X_LEVEL(_drv_always_, "nolinked power save enter\n"); -+ -+ if (pwrpriv->ips_mode == IPS_LEVEL_2) -+ pwrpriv->bkeepfwalive = true; -+ -+ rtw_ips_pwr_down(padapter); -+ pwrpriv->rf_pwrstate = rf_off; -+ } -+ pwrpriv->bips_processing = false; -+ -+} -+ -+void ips_enter(struct adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ -+ -+ rtw_btcoex_IpsNotify(padapter, pwrpriv->ips_mode_req); -+ -+ down(&pwrpriv->lock); -+ _ips_enter(padapter); -+ up(&pwrpriv->lock); -+} -+ -+int _ips_leave(struct adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ int result = _SUCCESS; -+ -+ if ((pwrpriv->rf_pwrstate == rf_off) && (!pwrpriv->bips_processing)) { -+ pwrpriv->bips_processing = true; -+ pwrpriv->change_rfpwrstate = rf_on; -+ pwrpriv->ips_leave_cnts++; -+ DBG_871X("==>ips_leave cnts:%d\n", pwrpriv->ips_leave_cnts); -+ -+ result = rtw_ips_pwr_up(padapter); -+ if (result == _SUCCESS) { -+ pwrpriv->rf_pwrstate = rf_on; -+ } -+ DBG_871X_LEVEL(_drv_always_, "nolinked power save leave\n"); -+ -+ DBG_871X("==> ips_leave.....LED(0x%08x)...\n", rtw_read32(padapter, 0x4c)); -+ pwrpriv->bips_processing = false; -+ -+ pwrpriv->bkeepfwalive = false; -+ pwrpriv->bpower_saving = false; -+ } -+ -+ return result; -+} -+ -+int ips_leave(struct adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ int ret; -+ -+ if (!is_primary_adapter(padapter)) -+ return _SUCCESS; -+ -+ down(&pwrpriv->lock); -+ ret = _ips_leave(padapter); -+ up(&pwrpriv->lock); -+ -+ if (_SUCCESS == ret) -+ rtw_btcoex_IpsNotify(padapter, IPS_NONE); -+ -+ return ret; -+} -+ -+static bool rtw_pwr_unassociated_idle(struct adapter *adapter) -+{ -+ struct adapter *buddy = adapter->pbuddy_adapter; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct xmit_priv *pxmit_priv = &adapter->xmitpriv; -+ -+ bool ret = false; -+ -+ if (adapter_to_pwrctl(adapter)->bpower_saving == true) { -+ /* DBG_871X("%s: already in LPS or IPS mode\n", __func__); */ -+ goto exit; -+ } -+ -+ if (time_before(jiffies, adapter_to_pwrctl(adapter)->ips_deny_time)) { -+ /* DBG_871X("%s ips_deny_time\n", __func__); */ -+ goto exit; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE|WIFI_SITE_MONITOR) -+ || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING|WIFI_UNDER_WPS) -+ || check_fwstate(pmlmepriv, WIFI_AP_STATE) -+ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE|WIFI_ADHOC_STATE) -+ ) -+ goto exit; -+ -+ /* consider buddy, if exist */ -+ if (buddy) { -+ struct mlme_priv *b_pmlmepriv = &(buddy->mlmepriv); -+ -+ if (check_fwstate(b_pmlmepriv, WIFI_ASOC_STATE|WIFI_SITE_MONITOR) -+ || check_fwstate(b_pmlmepriv, WIFI_UNDER_LINKING|WIFI_UNDER_WPS) -+ || check_fwstate(b_pmlmepriv, WIFI_AP_STATE) -+ || check_fwstate(b_pmlmepriv, WIFI_ADHOC_MASTER_STATE|WIFI_ADHOC_STATE) -+ ) -+ goto exit; -+ } -+ -+ if (pxmit_priv->free_xmitbuf_cnt != NR_XMITBUFF || -+ pxmit_priv->free_xmit_extbuf_cnt != NR_XMIT_EXTBUFF) { -+ DBG_871X_LEVEL(_drv_always_, "There are some pkts to transmit\n"); -+ DBG_871X_LEVEL(_drv_always_, "free_xmitbuf_cnt: %d, free_xmit_extbuf_cnt: %d\n", -+ pxmit_priv->free_xmitbuf_cnt, pxmit_priv->free_xmit_extbuf_cnt); -+ goto exit; -+ } -+ -+ ret = true; -+ -+exit: -+ return ret; -+} -+ -+ -+/* -+ * ATTENTION: -+ *rtw_ps_processor() doesn't handle LPS. -+ */ -+void rtw_ps_processor(struct adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ u32 ps_deny = 0; -+ -+ down(&adapter_to_pwrctl(padapter)->lock); -+ ps_deny = rtw_ps_deny_get(padapter); -+ up(&adapter_to_pwrctl(padapter)->lock); -+ if (ps_deny != 0) { -+ DBG_871X(FUNC_ADPT_FMT ": ps_deny = 0x%08X, skip power save!\n", -+ FUNC_ADPT_ARG(padapter), ps_deny); -+ goto exit; -+ } -+ -+ if (pwrpriv->bInSuspend == true) {/* system suspend or autosuspend */ -+ pdbgpriv->dbg_ps_insuspend_cnt++; -+ DBG_871X("%s, pwrpriv->bInSuspend == true ignore this process\n", __func__); -+ return; -+ } -+ -+ pwrpriv->ps_processing = true; -+ -+ if (pwrpriv->ips_mode_req == IPS_NONE) -+ goto exit; -+ -+ if (rtw_pwr_unassociated_idle(padapter) == false) -+ goto exit; -+ -+ if ((pwrpriv->rf_pwrstate == rf_on) && ((pwrpriv->pwr_state_check_cnts%4) == 0)) { -+ DBG_871X("==>%s\n", __func__); -+ pwrpriv->change_rfpwrstate = rf_off; -+ { -+ ips_enter(padapter); -+ } -+ } -+exit: -+ pwrpriv->ps_processing = false; -+ return; -+} -+ -+void pwr_state_check_handler(RTW_TIMER_HDL_ARGS); -+void pwr_state_check_handler(RTW_TIMER_HDL_ARGS) -+{ -+ struct adapter *padapter = (struct adapter *)FunctionContext; -+ rtw_ps_cmd(padapter); -+} -+ -+void traffic_check_for_leave_lps(struct adapter *padapter, u8 tx, u32 tx_packets) -+{ -+ static unsigned long start_time = 0; -+ static u32 xmit_cnt = 0; -+ u8 bLeaveLPS = false; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ -+ if (tx) { /* from tx */ -+ xmit_cnt += tx_packets; -+ -+ if (start_time == 0) -+ start_time = jiffies; -+ -+ if (jiffies_to_msecs(jiffies - start_time) > 2000) { /* 2 sec == watch dog timer */ -+ if (xmit_cnt > 8) { -+ if ((adapter_to_pwrctl(padapter)->bLeisurePs) -+ && (adapter_to_pwrctl(padapter)->pwr_mode != PS_MODE_ACTIVE) -+ && (rtw_btcoex_IsBtControlLps(padapter) == false) -+ ) { -+ DBG_871X("leave lps via Tx = %d\n", xmit_cnt); -+ bLeaveLPS = true; -+ } -+ } -+ -+ start_time = jiffies; -+ xmit_cnt = 0; -+ } -+ -+ } else { /* from rx path */ -+ if (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 4/*2*/) { -+ if ((adapter_to_pwrctl(padapter)->bLeisurePs) -+ && (adapter_to_pwrctl(padapter)->pwr_mode != PS_MODE_ACTIVE) -+ && (rtw_btcoex_IsBtControlLps(padapter) == false) -+ ) { -+ DBG_871X("leave lps via Rx = %d\n", pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); -+ bLeaveLPS = true; -+ } -+ } -+ } -+ -+ if (bLeaveLPS) -+ /* DBG_871X("leave lps via %s, Tx = %d, Rx = %d\n", tx?"Tx":"Rx", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); */ -+ /* rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); */ -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, tx?0:1); -+} -+ -+/* -+ * Description: -+ *This function MUST be called under power lock protect -+ * -+ * Parameters -+ *padapter -+ *pslv power state level, only could be PS_STATE_S0 ~ PS_STATE_S4 -+ * -+ */ -+void rtw_set_rpwm(struct adapter *padapter, u8 pslv) -+{ -+ u8 rpwm; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8 cpwm_orig; -+ -+ pslv = PS_STATE(pslv); -+ -+ if (pwrpriv->brpwmtimeout == true) { -+ DBG_871X("%s: RPWM timeout, force to set RPWM(0x%02X) again!\n", __func__, pslv); -+ } else{ -+ if ((pwrpriv->rpwm == pslv) -+ || ((pwrpriv->rpwm >= PS_STATE_S2) && (pslv >= PS_STATE_S2))) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_err_, -+ ("%s: Already set rpwm[0x%02X], new = 0x%02X!\n", __func__, pwrpriv->rpwm, pslv)); -+ return; -+ } -+ } -+ -+ if ((padapter->bSurpriseRemoved == true) || -+ (padapter->hw_init_completed == false)) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_err_, -+ ("%s: SurpriseRemoved(%d) hw_init_completed(%d)\n", -+ __func__, padapter->bSurpriseRemoved, padapter->hw_init_completed)); -+ -+ pwrpriv->cpwm = PS_STATE_S4; -+ -+ return; -+ } -+ -+ if (padapter->bDriverStopped == true) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_err_, -+ ("%s: change power state(0x%02X) when DriverStopped\n", __func__, pslv)); -+ -+ if (pslv < PS_STATE_S2) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_err_, -+ ("%s: Reject to enter PS_STATE(0x%02X) lower than S2 when DriverStopped!!\n", __func__, pslv)); -+ return; -+ } -+ } -+ -+ rpwm = pslv | pwrpriv->tog; -+ /* only when from PS_STATE S0/S1 to S2 and higher needs ACK */ -+ if ((pwrpriv->cpwm < PS_STATE_S2) && (pslv >= PS_STATE_S2)) -+ rpwm |= PS_ACK; -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("rtw_set_rpwm: rpwm = 0x%02x cpwm = 0x%02x\n", rpwm, pwrpriv->cpwm)); -+ -+ pwrpriv->rpwm = pslv; -+ -+ cpwm_orig = 0; -+ if (rpwm & PS_ACK) -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig); -+ -+ if (rpwm & PS_ACK) -+ _set_timer(&pwrpriv->pwr_rpwm_timer, LPS_RPWM_WAIT_MS); -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); -+ -+ pwrpriv->tog += 0x80; -+ -+ /* No LPS 32K, No Ack */ -+ if (rpwm & PS_ACK) { -+ unsigned long start_time; -+ u8 cpwm_now; -+ u8 poll_cnt = 0; -+ -+ start_time = jiffies; -+ -+ /* polling cpwm */ -+ do { -+ mdelay(1); -+ poll_cnt++; -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_now); -+ if ((cpwm_orig ^ cpwm_now) & 0x80) { -+ pwrpriv->cpwm = PS_STATE_S4; -+ pwrpriv->cpwm_tog = cpwm_now & PS_TOGGLE; -+ break; -+ } -+ -+ if (jiffies_to_msecs(jiffies - start_time) > LPS_RPWM_WAIT_MS) { -+ DBG_871X("%s: polling cpwm timeout! poll_cnt =%d, cpwm_orig =%02x, cpwm_now =%02x\n", __func__, poll_cnt, cpwm_orig, cpwm_now); -+ _set_timer(&pwrpriv->pwr_rpwm_timer, 1); -+ break; -+ } -+ } while (1); -+ } else -+ pwrpriv->cpwm = pslv; -+} -+ -+static u8 PS_RDY_CHECK(struct adapter *padapter) -+{ -+ unsigned long curr_time, delta_time; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ if (true == pwrpriv->bInSuspend && pwrpriv->wowlan_mode) -+ return true; -+ else if (true == pwrpriv->bInSuspend && pwrpriv->wowlan_ap_mode) -+ return true; -+ else if (true == pwrpriv->bInSuspend) -+ return false; -+#else -+ if (true == pwrpriv->bInSuspend) -+ return false; -+#endif -+ -+ curr_time = jiffies; -+ -+ delta_time = curr_time - pwrpriv->DelayLPSLastTimeStamp; -+ -+ if (delta_time < LPS_DELAY_TIME) -+ return false; -+ -+ if (check_fwstate(pmlmepriv, WIFI_SITE_MONITOR) -+ || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING|WIFI_UNDER_WPS) -+ || check_fwstate(pmlmepriv, WIFI_AP_STATE) -+ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE|WIFI_ADHOC_STATE) -+ || rtw_is_scan_deny(padapter) -+ ) -+ return false; -+ -+ if ((padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) && (padapter->securitypriv.binstallGrpkey == false)) { -+ DBG_871X("Group handshake still in progress !!!\n"); -+ return false; -+ } -+ -+ if (!rtw_cfg80211_pwr_mgmt(padapter)) -+ return false; -+ -+ return true; -+} -+ -+void rtw_set_ps_mode(struct adapter *padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode, const char *msg) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ struct debug_priv *pdbgpriv = &padapter->dvobj->drv_dbg; -+#endif -+ -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("%s: PowerMode =%d Smart_PS =%d\n", -+ __func__, ps_mode, smart_ps)); -+ -+ if (ps_mode > PM_Card_Disable) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_err_, ("ps_mode:%d error\n", ps_mode)); -+ return; -+ } -+ -+ if (pwrpriv->pwr_mode == ps_mode) -+ if (PS_MODE_ACTIVE == ps_mode) -+ return; -+ -+ -+ down(&pwrpriv->lock); -+ -+ /* if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) */ -+ if (ps_mode == PS_MODE_ACTIVE) { -+ if (1 -+ && (((rtw_btcoex_IsBtControlLps(padapter) == false) -+ ) -+ || ((rtw_btcoex_IsBtControlLps(padapter) == true) -+ && (rtw_btcoex_IsLpsOn(padapter) == false)) -+ ) -+ ) { -+ DBG_871X(FUNC_ADPT_FMT" Leave 802.11 power save - %s\n", -+ FUNC_ADPT_ARG(padapter), msg); -+ -+ pwrpriv->pwr_mode = ps_mode; -+ rtw_set_rpwm(padapter, PS_STATE_S4); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ if (pwrpriv->wowlan_mode == true || -+ pwrpriv->wowlan_ap_mode == true) { -+ unsigned long start_time; -+ u32 delay_ms; -+ u8 val8; -+ delay_ms = 20; -+ start_time = jiffies; -+ do { -+ rtw_hal_get_hwreg(padapter, HW_VAR_SYS_CLKR, &val8); -+ if (!(val8 & BIT(4))) { /* 0x08 bit4 = 1 --> in 32k, bit4 = 0 --> leave 32k */ -+ pwrpriv->cpwm = PS_STATE_S4; -+ break; -+ } -+ if (jiffies_to_msecs(jiffies - start_time) > delay_ms) { -+ DBG_871X("%s: Wait for FW 32K leave more than %u ms!!!\n", -+ __func__, delay_ms); -+ pdbgpriv->dbg_wow_leave_ps_fail_cnt++; -+ break; -+ } -+ msleep(1); -+ } while (1); -+ } -+#endif -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); -+ pwrpriv->bFwCurrentInPSMode = false; -+ -+ rtw_btcoex_LpsNotify(padapter, ps_mode); -+ } -+ } else{ -+ if ((PS_RDY_CHECK(padapter) && check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE)) -+ || ((rtw_btcoex_IsBtControlLps(padapter) == true) -+ && (rtw_btcoex_IsLpsOn(padapter) == true)) -+ ) { -+ u8 pslv; -+ -+ DBG_871X(FUNC_ADPT_FMT" Enter 802.11 power save - %s\n", -+ FUNC_ADPT_ARG(padapter), msg); -+ -+ rtw_btcoex_LpsNotify(padapter, ps_mode); -+ -+ pwrpriv->bFwCurrentInPSMode = true; -+ pwrpriv->pwr_mode = ps_mode; -+ pwrpriv->smart_ps = smart_ps; -+ pwrpriv->bcn_ant_mode = bcn_ant_mode; -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); -+ -+ pslv = PS_STATE_S2; -+ if (pwrpriv->alives == 0) -+ pslv = PS_STATE_S0; -+ -+ if ((rtw_btcoex_IsBtDisabled(padapter) == false) -+ && (rtw_btcoex_IsBtControlLps(padapter) == true)) { -+ u8 val8; -+ -+ val8 = rtw_btcoex_LpsVal(padapter); -+ if (val8 & BIT(4)) -+ pslv = PS_STATE_S2; -+ } -+ -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ up(&pwrpriv->lock); -+} -+ -+/* -+ * Return: -+ *0: Leave OK -+ *-1: Timeout -+ *-2: Other error -+ */ -+s32 LPS_RF_ON_check(struct adapter *padapter, u32 delay_ms) -+{ -+ unsigned long start_time; -+ u8 bAwake = false; -+ s32 err = 0; -+ -+ -+ start_time = jiffies; -+ while (1) { -+ rtw_hal_get_hwreg(padapter, HW_VAR_FWLPS_RF_ON, &bAwake); -+ if (true == bAwake) -+ break; -+ -+ if (true == padapter->bSurpriseRemoved) { -+ err = -2; -+ DBG_871X("%s: device surprise removed!!\n", __func__); -+ break; -+ } -+ -+ if (jiffies_to_msecs(jiffies - start_time) > delay_ms) { -+ err = -1; -+ DBG_871X("%s: Wait for FW LPS leave more than %u ms!!!\n", __func__, delay_ms); -+ break; -+ } -+ msleep(1); -+ } -+ -+ return err; -+} -+ -+/* */ -+/* Description: */ -+/* Enter the leisure power save mode. */ -+/* */ -+void LPS_Enter(struct adapter *padapter, const char *msg) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ int n_assoc_iface = 0; -+ char buf[32] = {0}; -+ -+ if (rtw_btcoex_IsBtControlLps(padapter) == true) -+ return; -+ -+ /* Skip lps enter request if number of assocated adapters is not 1 */ -+ if (check_fwstate(&(dvobj->padapters->mlmepriv), WIFI_ASOC_STATE)) -+ n_assoc_iface++; -+ if (n_assoc_iface != 1) -+ return; -+ -+ /* Skip lps enter request for adapter not port0 */ -+ if (get_iface_type(padapter) != IFACE_PORT0) -+ return; -+ -+ if (PS_RDY_CHECK(dvobj->padapters) == false) -+ return; -+ -+ if (pwrpriv->bLeisurePs) { -+ /* Idle for a while if we connect to AP a while ago. */ -+ if (pwrpriv->LpsIdleCount >= 2) { /* 4 Sec */ -+ if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) { -+ sprintf(buf, "WIFI-%s", msg); -+ pwrpriv->bpower_saving = true; -+ rtw_set_ps_mode(padapter, pwrpriv->power_mgnt, padapter->registrypriv.smart_ps, 0, buf); -+ } -+ } else -+ pwrpriv->LpsIdleCount++; -+ } -+ -+/* DBG_871X("-LeisurePSEnter\n"); */ -+} -+ -+/* */ -+/* Description: */ -+/* Leave the leisure power save mode. */ -+/* */ -+void LPS_Leave(struct adapter *padapter, const char *msg) -+{ -+#define LPS_LEAVE_TIMEOUT_MS 100 -+ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ char buf[32] = {0}; -+ -+/* DBG_871X("+LeisurePSLeave\n"); */ -+ -+ if (rtw_btcoex_IsBtControlLps(padapter) == true) -+ return; -+ -+ if (pwrpriv->bLeisurePs) { -+ if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) { -+ sprintf(buf, "WIFI-%s", msg); -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, buf); -+ -+ if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) -+ LPS_RF_ON_check(padapter, LPS_LEAVE_TIMEOUT_MS); -+ } -+ } -+ -+ pwrpriv->bpower_saving = false; -+/* DBG_871X("-LeisurePSLeave\n"); */ -+ -+} -+ -+void LeaveAllPowerSaveModeDirect(struct adapter *Adapter) -+{ -+ struct adapter *pri_padapter = GET_PRIMARY_ADAPTER(Adapter); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); -+ -+ DBG_871X("%s.....\n", __func__); -+ -+ if (true == Adapter->bSurpriseRemoved) { -+ DBG_871X(FUNC_ADPT_FMT ": bSurpriseRemoved =%d Skip!\n", -+ FUNC_ADPT_ARG(Adapter), Adapter->bSurpriseRemoved); -+ return; -+ } -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == true)) { /* connect */ -+ -+ if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) { -+ DBG_871X("%s: Driver Already Leave LPS\n", __func__); -+ return; -+ } -+ -+ down(&pwrpriv->lock); -+ -+ rtw_set_rpwm(Adapter, PS_STATE_S4); -+ -+ up(&pwrpriv->lock); -+ -+ rtw_lps_ctrl_wk_cmd(pri_padapter, LPS_CTRL_LEAVE, 0); -+ } else{ -+ if (pwrpriv->rf_pwrstate == rf_off) -+ if (false == ips_leave(pri_padapter)) -+ DBG_871X("======> ips_leave fail.............\n"); -+ } -+} -+ -+/* */ -+/* Description: Leave all power save mode: LPS, FwLPS, IPS if needed. */ -+/* Move code to function by tynli. 2010.03.26. */ -+/* */ -+void LeaveAllPowerSaveMode(struct adapter *Adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); -+ u8 enqueue = 0; -+ int n_assoc_iface = 0; -+ -+ if (!Adapter->bup) { -+ DBG_871X(FUNC_ADPT_FMT ": bup =%d Skip!\n", -+ FUNC_ADPT_ARG(Adapter), Adapter->bup); -+ return; -+ } -+ -+ if (Adapter->bSurpriseRemoved) { -+ DBG_871X(FUNC_ADPT_FMT ": bSurpriseRemoved =%d Skip!\n", -+ FUNC_ADPT_ARG(Adapter), Adapter->bSurpriseRemoved); -+ return; -+ } -+ -+ if (check_fwstate(&(dvobj->padapters->mlmepriv), WIFI_ASOC_STATE)) -+ n_assoc_iface++; -+ -+ if (n_assoc_iface) { /* connect */ -+ enqueue = 1; -+ -+ rtw_lps_ctrl_wk_cmd(Adapter, LPS_CTRL_LEAVE, enqueue); -+ -+ LPS_Leave_check(Adapter); -+ } else { -+ if (adapter_to_pwrctl(Adapter)->rf_pwrstate == rf_off) { -+ if (false == ips_leave(Adapter)) -+ DBG_871X("======> ips_leave fail.............\n"); -+ } -+ } -+} -+ -+void LPS_Leave_check( -+ struct adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ unsigned long start_time; -+ u8 bReady; -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ bReady = false; -+ start_time = jiffies; -+ -+ yield(); -+ -+ while (1) { -+ down(&pwrpriv->lock); -+ -+ if ((padapter->bSurpriseRemoved == true) -+ || (padapter->hw_init_completed == false) -+ || (pwrpriv->pwr_mode == PS_MODE_ACTIVE) -+ ) -+ bReady = true; -+ -+ up(&pwrpriv->lock); -+ -+ if (true == bReady) -+ break; -+ -+ if (jiffies_to_msecs(jiffies - start_time) > 100) { -+ DBG_871X("Wait for cpwm event than 100 ms!!!\n"); -+ break; -+ } -+ msleep(1); -+ } -+} -+ -+/* -+ * Caller:ISR handler... -+ * -+ * This will be called when CPWM interrupt is up. -+ * -+ * using to update cpwn of drv; and drv willl make a decision to up or down pwr level -+ */ -+void cpwm_int_hdl( -+ struct adapter *padapter, -+ struct reportpwrstate_parm *preportpwrstate) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ down(&pwrpriv->lock); -+ -+ if (pwrpriv->rpwm < PS_STATE_S2) { -+ DBG_871X("%s: Redundant CPWM Int. RPWM = 0x%02X CPWM = 0x%02x\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); -+ up(&pwrpriv->lock); -+ goto exit; -+ } -+ -+ pwrpriv->cpwm = PS_STATE(preportpwrstate->state); -+ pwrpriv->cpwm_tog = preportpwrstate->state & PS_TOGGLE; -+ -+ if (pwrpriv->cpwm >= PS_STATE_S2) { -+ if (pwrpriv->alives & CMD_ALIVE) -+ up(&padapter->cmdpriv.cmd_queue_sema); -+ -+ if (pwrpriv->alives & XMIT_ALIVE) -+ up(&padapter->xmitpriv.xmit_sema); -+ } -+ -+ up(&pwrpriv->lock); -+ -+exit: -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("cpwm_int_hdl: cpwm = 0x%02x\n", pwrpriv->cpwm)); -+} -+ -+static void cpwm_event_callback(struct work_struct *work) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, cpwm_event); -+ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); -+ struct adapter *adapter = dvobj->if1; -+ struct reportpwrstate_parm report; -+ -+ /* DBG_871X("%s\n", __func__); */ -+ -+ report.state = PS_STATE_S2; -+ cpwm_int_hdl(adapter, &report); -+} -+ -+static void rpwmtimeout_workitem_callback(struct work_struct *work) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *dvobj; -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+ pwrpriv = container_of(work, struct pwrctrl_priv, rpwmtimeoutwi); -+ dvobj = pwrctl_to_dvobj(pwrpriv); -+ padapter = dvobj->if1; -+/* DBG_871X("+%s: rpwm = 0x%02X cpwm = 0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); */ -+ -+ down(&pwrpriv->lock); -+ if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { -+ DBG_871X("%s: rpwm = 0x%02X cpwm = 0x%02X CPWM done!\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); -+ goto exit; -+ } -+ up(&pwrpriv->lock); -+ -+ if (rtw_read8(padapter, 0x100) != 0xEA) { -+ struct reportpwrstate_parm report; -+ -+ report.state = PS_STATE_S2; -+ DBG_871X("\n%s: FW already leave 32K!\n\n", __func__); -+ cpwm_int_hdl(padapter, &report); -+ -+ return; -+ } -+ -+ down(&pwrpriv->lock); -+ -+ if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { -+ DBG_871X("%s: cpwm =%d, nothing to do!\n", __func__, pwrpriv->cpwm); -+ goto exit; -+ } -+ pwrpriv->brpwmtimeout = true; -+ rtw_set_rpwm(padapter, pwrpriv->rpwm); -+ pwrpriv->brpwmtimeout = false; -+ -+exit: -+ up(&pwrpriv->lock); -+} -+ -+/* -+ * This function is a timer handler, can't do any IO in it. -+ */ -+static void pwr_rpwm_timeout_handler(void *FunctionContext) -+{ -+ struct adapter *padapter; -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+ padapter = (struct adapter *)FunctionContext; -+ pwrpriv = adapter_to_pwrctl(padapter); -+ DBG_871X("+%s: rpwm = 0x%02X cpwm = 0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); -+ -+ if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { -+ DBG_871X("+%s: cpwm =%d, nothing to do!\n", __func__, pwrpriv->cpwm); -+ return; -+ } -+ -+ _set_workitem(&pwrpriv->rpwmtimeoutwi); -+} -+ -+static __inline void register_task_alive(struct pwrctrl_priv *pwrctrl, u32 tag) -+{ -+ pwrctrl->alives |= tag; -+} -+ -+static __inline void unregister_task_alive(struct pwrctrl_priv *pwrctrl, u32 tag) -+{ -+ pwrctrl->alives &= ~tag; -+} -+ -+ -+/* -+ * Description: -+ *Check if the fw_pwrstate is okay for I/O. -+ *If not (cpwm is less than S2), then the sub-routine -+ *will raise the cpwm to be greater than or equal to S2. -+ * -+ *Calling Context: Passive -+ * -+ *Constraint: -+ * 1. this function will request pwrctrl->lock -+ * -+ * Return Value: -+ *_SUCCESS hardware is ready for I/O -+ *_FAIL can't I/O right now -+ */ -+s32 rtw_register_task_alive(struct adapter *padapter, u32 task) -+{ -+ s32 res; -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+ res = _SUCCESS; -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S2; -+ -+ down(&pwrctrl->lock); -+ -+ register_task_alive(pwrctrl, task); -+ -+ if (pwrctrl->bFwCurrentInPSMode == true) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("%s: task = 0x%x cpwm = 0x%02x alives = 0x%08x\n", -+ __func__, task, pwrctrl->cpwm, pwrctrl->alives)); -+ -+ if (pwrctrl->cpwm < pslv) { -+ if (pwrctrl->cpwm < PS_STATE_S2) -+ res = _FAIL; -+ if (pwrctrl->rpwm < pslv) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ up(&pwrctrl->lock); -+ -+ if (_FAIL == res) -+ if (pwrctrl->cpwm >= PS_STATE_S2) -+ res = _SUCCESS; -+ -+ return res; -+} -+ -+/* -+ * Description: -+ *If task is done, call this func. to power down firmware again. -+ * -+ *Constraint: -+ * 1. this function will request pwrctrl->lock -+ * -+ * Return Value: -+ *none -+ */ -+void rtw_unregister_task_alive(struct adapter *padapter, u32 task) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S0; -+ -+ if ((rtw_btcoex_IsBtDisabled(padapter) == false) -+ && (rtw_btcoex_IsBtControlLps(padapter) == true)) { -+ u8 val8; -+ -+ val8 = rtw_btcoex_LpsVal(padapter); -+ if (val8 & BIT(4)) -+ pslv = PS_STATE_S2; -+ } -+ -+ down(&pwrctrl->lock); -+ -+ unregister_task_alive(pwrctrl, task); -+ -+ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) -+ && (pwrctrl->bFwCurrentInPSMode == true)) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("%s: cpwm = 0x%02x alives = 0x%08x\n", -+ __func__, pwrctrl->cpwm, pwrctrl->alives)); -+ -+ if (pwrctrl->cpwm > pslv) -+ if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) -+ rtw_set_rpwm(padapter, pslv); -+ -+ } -+ -+ up(&pwrctrl->lock); -+} -+ -+/* -+ * Caller: rtw_xmit_thread -+ * -+ * Check if the fw_pwrstate is okay for xmit. -+ * If not (cpwm is less than S3), then the sub-routine -+ * will raise the cpwm to be greater than or equal to S3. -+ * -+ * Calling Context: Passive -+ * -+ * Return Value: -+ * _SUCCESS rtw_xmit_thread can write fifo/txcmd afterwards. -+ * _FAIL rtw_xmit_thread can not do anything. -+ */ -+s32 rtw_register_tx_alive(struct adapter *padapter) -+{ -+ s32 res; -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+ res = _SUCCESS; -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S2; -+ -+ down(&pwrctrl->lock); -+ -+ register_task_alive(pwrctrl, XMIT_ALIVE); -+ -+ if (pwrctrl->bFwCurrentInPSMode == true) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("rtw_register_tx_alive: cpwm = 0x%02x alives = 0x%08x\n", -+ pwrctrl->cpwm, pwrctrl->alives)); -+ -+ if (pwrctrl->cpwm < pslv) { -+ if (pwrctrl->cpwm < PS_STATE_S2) -+ res = _FAIL; -+ if (pwrctrl->rpwm < pslv) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ up(&pwrctrl->lock); -+ -+ if (_FAIL == res) -+ if (pwrctrl->cpwm >= PS_STATE_S2) -+ res = _SUCCESS; -+ -+ return res; -+} -+ -+/* -+ * Caller: rtw_cmd_thread -+ * -+ * Check if the fw_pwrstate is okay for issuing cmd. -+ * If not (cpwm should be is less than S2), then the sub-routine -+ * will raise the cpwm to be greater than or equal to S2. -+ * -+ * Calling Context: Passive -+ * -+ * Return Value: -+ *_SUCCESS rtw_cmd_thread can issue cmds to firmware afterwards. -+ *_FAIL rtw_cmd_thread can not do anything. -+ */ -+s32 rtw_register_cmd_alive(struct adapter *padapter) -+{ -+ s32 res; -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+ res = _SUCCESS; -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S2; -+ -+ down(&pwrctrl->lock); -+ -+ register_task_alive(pwrctrl, CMD_ALIVE); -+ -+ if (pwrctrl->bFwCurrentInPSMode == true) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_info_, -+ ("rtw_register_cmd_alive: cpwm = 0x%02x alives = 0x%08x\n", -+ pwrctrl->cpwm, pwrctrl->alives)); -+ -+ if (pwrctrl->cpwm < pslv) { -+ if (pwrctrl->cpwm < PS_STATE_S2) -+ res = _FAIL; -+ if (pwrctrl->rpwm < pslv) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ up(&pwrctrl->lock); -+ -+ if (_FAIL == res) -+ if (pwrctrl->cpwm >= PS_STATE_S2) -+ res = _SUCCESS; -+ -+ return res; -+} -+ -+/* -+ * Caller: ISR -+ * -+ * If ISR's txdone, -+ * No more pkts for TX, -+ * Then driver shall call this fun. to power down firmware again. -+ */ -+void rtw_unregister_tx_alive(struct adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S0; -+ -+ if ((rtw_btcoex_IsBtDisabled(padapter) == false) -+ && (rtw_btcoex_IsBtControlLps(padapter) == true)) { -+ u8 val8; -+ -+ val8 = rtw_btcoex_LpsVal(padapter); -+ if (val8 & BIT(4)) -+ pslv = PS_STATE_S2; -+ } -+ -+ down(&pwrctrl->lock); -+ -+ unregister_task_alive(pwrctrl, XMIT_ALIVE); -+ -+ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) -+ && (pwrctrl->bFwCurrentInPSMode == true)) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("%s: cpwm = 0x%02x alives = 0x%08x\n", -+ __func__, pwrctrl->cpwm, pwrctrl->alives)); -+ -+ if (pwrctrl->cpwm > pslv) -+ if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ -+ up(&pwrctrl->lock); -+} -+ -+/* -+ * Caller: ISR -+ * -+ * If all commands have been done, -+ * and no more command to do, -+ * then driver shall call this fun. to power down firmware again. -+ */ -+void rtw_unregister_cmd_alive(struct adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S0; -+ -+ if ((rtw_btcoex_IsBtDisabled(padapter) == false) -+ && (rtw_btcoex_IsBtControlLps(padapter) == true)) { -+ u8 val8; -+ -+ val8 = rtw_btcoex_LpsVal(padapter); -+ if (val8 & BIT(4)) -+ pslv = PS_STATE_S2; -+ } -+ -+ down(&pwrctrl->lock); -+ -+ unregister_task_alive(pwrctrl, CMD_ALIVE); -+ -+ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) -+ && (pwrctrl->bFwCurrentInPSMode == true)) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_info_, -+ ("%s: cpwm = 0x%02x alives = 0x%08x\n", -+ __func__, pwrctrl->cpwm, pwrctrl->alives)); -+ -+ if (pwrctrl->cpwm > pslv) { -+ if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ up(&pwrctrl->lock); -+} -+ -+void rtw_init_pwrctrl_priv(struct adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ sema_init(&pwrctrlpriv->lock, 1); -+ sema_init(&pwrctrlpriv->check_32k_lock, 1); -+ pwrctrlpriv->rf_pwrstate = rf_on; -+ pwrctrlpriv->ips_enter_cnts = 0; -+ pwrctrlpriv->ips_leave_cnts = 0; -+ pwrctrlpriv->bips_processing = false; -+ -+ pwrctrlpriv->ips_mode = padapter->registrypriv.ips_mode; -+ pwrctrlpriv->ips_mode_req = padapter->registrypriv.ips_mode; -+ -+ pwrctrlpriv->pwr_state_check_interval = RTW_PWR_STATE_CHK_INTERVAL; -+ pwrctrlpriv->pwr_state_check_cnts = 0; -+ pwrctrlpriv->bInternalAutoSuspend = false; -+ pwrctrlpriv->bInSuspend = false; -+ pwrctrlpriv->bkeepfwalive = false; -+ -+ pwrctrlpriv->LpsIdleCount = 0; -+ pwrctrlpriv->power_mgnt = padapter->registrypriv.power_mgnt;/* PS_MODE_MIN; */ -+ pwrctrlpriv->bLeisurePs = (PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt)?true:false; -+ -+ pwrctrlpriv->bFwCurrentInPSMode = false; -+ -+ pwrctrlpriv->rpwm = 0; -+ pwrctrlpriv->cpwm = PS_STATE_S4; -+ -+ pwrctrlpriv->pwr_mode = PS_MODE_ACTIVE; -+ pwrctrlpriv->smart_ps = padapter->registrypriv.smart_ps; -+ pwrctrlpriv->bcn_ant_mode = 0; -+ pwrctrlpriv->dtim = 0; -+ -+ pwrctrlpriv->tog = 0x80; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&pwrctrlpriv->rpwm)); -+ -+ _init_workitem(&pwrctrlpriv->cpwm_event, cpwm_event_callback, NULL); -+ -+ pwrctrlpriv->brpwmtimeout = false; -+ _init_workitem(&pwrctrlpriv->rpwmtimeoutwi, rpwmtimeout_workitem_callback, NULL); -+ _init_timer(&pwrctrlpriv->pwr_rpwm_timer, padapter->pnetdev, pwr_rpwm_timeout_handler, padapter); -+ -+ rtw_init_timer(&pwrctrlpriv->pwr_state_check_timer, padapter, pwr_state_check_handler); -+ -+ pwrctrlpriv->wowlan_mode = false; -+ pwrctrlpriv->wowlan_ap_mode = false; -+ -+#ifdef CONFIG_PNO_SUPPORT -+ pwrctrlpriv->pno_inited = false; -+ pwrctrlpriv->pnlo_info = NULL; -+ pwrctrlpriv->pscan_info = NULL; -+ pwrctrlpriv->pno_ssid_list = NULL; -+ pwrctrlpriv->pno_in_resume = true; -+#endif -+} -+ -+ -+void rtw_free_pwrctrl_priv(struct adapter *adapter) -+{ -+ /* memset((unsigned char *)pwrctrlpriv, 0, sizeof(struct pwrctrl_priv)); */ -+ -+#ifdef CONFIG_PNO_SUPPORT -+ if (pwrctrlpriv->pnlo_info != NULL) -+ printk("****** pnlo_info memory leak********\n"); -+ -+ if (pwrctrlpriv->pscan_info != NULL) -+ printk("****** pscan_info memory leak********\n"); -+ -+ if (pwrctrlpriv->pno_ssid_list != NULL) -+ printk("****** pno_ssid_list memory leak********\n"); -+#endif -+} -+ -+inline void rtw_set_ips_deny(struct adapter *padapter, u32 ms) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ pwrpriv->ips_deny_time = jiffies + msecs_to_jiffies(ms); -+} -+ -+/* -+* rtw_pwr_wakeup - Wake the NIC up from: 1)IPS. 2)USB autosuspend -+* @adapter: pointer to struct adapter structure -+* @ips_deffer_ms: the ms wiil prevent from falling into IPS after wakeup -+* Return _SUCCESS or _FAIL -+*/ -+ -+int _rtw_pwr_wakeup(struct adapter *padapter, u32 ips_deffer_ms, const char *caller) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ struct mlme_priv *pmlmepriv; -+ int ret = _SUCCESS; -+ unsigned long start = jiffies; -+ unsigned long deny_time = jiffies + msecs_to_jiffies(ips_deffer_ms); -+ -+ /* for LPS */ -+ LeaveAllPowerSaveMode(padapter); -+ -+ /* IPS still bound with primary adapter */ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ pmlmepriv = &padapter->mlmepriv; -+ -+ if (time_before(pwrpriv->ips_deny_time, deny_time)) -+ pwrpriv->ips_deny_time = deny_time; -+ -+ -+ if (pwrpriv->ps_processing) { -+ DBG_871X("%s wait ps_processing...\n", __func__); -+ while (pwrpriv->ps_processing && jiffies_to_msecs(jiffies - start) <= 3000) -+ msleep(10); -+ if (pwrpriv->ps_processing) -+ DBG_871X("%s wait ps_processing timeout\n", __func__); -+ else -+ DBG_871X("%s wait ps_processing done\n", __func__); -+ } -+ -+ if (pwrpriv->bInternalAutoSuspend == false && pwrpriv->bInSuspend) { -+ DBG_871X("%s wait bInSuspend...\n", __func__); -+ while (pwrpriv->bInSuspend -+ && jiffies_to_msecs(jiffies - start) <= 3000 -+ ) { -+ msleep(10); -+ } -+ if (pwrpriv->bInSuspend) -+ DBG_871X("%s wait bInSuspend timeout\n", __func__); -+ else -+ DBG_871X("%s wait bInSuspend done\n", __func__); -+ } -+ -+ /* System suspend is not allowed to wakeup */ -+ if ((pwrpriv->bInternalAutoSuspend == false) && (true == pwrpriv->bInSuspend)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* block??? */ -+ if ((pwrpriv->bInternalAutoSuspend == true) && (padapter->net_closed == true)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* I think this should be check in IPS, LPS, autosuspend functions... */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { -+ ret = _SUCCESS; -+ goto exit; -+ } -+ -+ if (rf_off == pwrpriv->rf_pwrstate) { -+ { -+ DBG_8192C("%s call ips_leave....\n", __func__); -+ if (_FAIL == ips_leave(padapter)) { -+ DBG_8192C("======> ips_leave fail.............\n"); -+ ret = _FAIL; -+ goto exit; -+ } -+ } -+ } -+ -+ /* TODO: the following checking need to be merged... */ -+ if (padapter->bDriverStopped -+ || !padapter->bup -+ || !padapter->hw_init_completed -+ ) { -+ DBG_8192C("%s: bDriverStopped =%d, bup =%d, hw_init_completed =%u\n" -+ , caller -+ , padapter->bDriverStopped -+ , padapter->bup -+ , padapter->hw_init_completed); -+ ret = false; -+ goto exit; -+ } -+ -+exit: -+ deny_time = jiffies + msecs_to_jiffies(ips_deffer_ms); -+ if (time_before(pwrpriv->ips_deny_time, deny_time)) -+ pwrpriv->ips_deny_time = deny_time; -+ return ret; -+ -+} -+ -+int rtw_pm_set_lps(struct adapter *padapter, u8 mode) -+{ -+ int ret = 0; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if (mode < PS_MODE_NUM) { -+ if (pwrctrlpriv->power_mgnt != mode) { -+ if (PS_MODE_ACTIVE == mode) -+ LeaveAllPowerSaveMode(padapter); -+ else -+ pwrctrlpriv->LpsIdleCount = 2; -+ -+ pwrctrlpriv->power_mgnt = mode; -+ pwrctrlpriv->bLeisurePs = (PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt)?true:false; -+ } -+ } else -+ ret = -EINVAL; -+ -+ return ret; -+} -+ -+int rtw_pm_set_ips(struct adapter *padapter, u8 mode) -+{ -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if (mode == IPS_NORMAL || mode == IPS_LEVEL_2) { -+ rtw_ips_mode_req(pwrctrlpriv, mode); -+ DBG_871X("%s %s\n", __func__, mode == IPS_NORMAL?"IPS_NORMAL":"IPS_LEVEL_2"); -+ return 0; -+ } else if (mode == IPS_NONE) { -+ rtw_ips_mode_req(pwrctrlpriv, mode); -+ DBG_871X("%s %s\n", __func__, "IPS_NONE"); -+ if ((padapter->bSurpriseRemoved == 0) && (_FAIL == rtw_pwr_wakeup(padapter))) -+ return -EFAULT; -+ } else -+ return -EINVAL; -+ -+ return 0; -+} -+ -+/* -+ * ATTENTION: -+ *This function will request pwrctrl LOCK! -+ */ -+void rtw_ps_deny(struct adapter *padapter, enum PS_DENY_REASON reason) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ -+/* DBG_871X("+" FUNC_ADPT_FMT ": Request PS deny for %d (0x%08X)\n", */ -+/* FUNC_ADPT_ARG(padapter), reason, BIT(reason)); */ -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ down(&pwrpriv->lock); -+ if (pwrpriv->ps_deny & BIT(reason)) { -+ DBG_871X(FUNC_ADPT_FMT ": [WARNING] Reason %d had been set before!!\n", -+ FUNC_ADPT_ARG(padapter), reason); -+ } -+ pwrpriv->ps_deny |= BIT(reason); -+ up(&pwrpriv->lock); -+ -+/* DBG_871X("-" FUNC_ADPT_FMT ": Now PS deny for 0x%08X\n", */ -+/* FUNC_ADPT_ARG(padapter), pwrpriv->ps_deny); */ -+} -+ -+/* -+ * ATTENTION: -+ *This function will request pwrctrl LOCK! -+ */ -+void rtw_ps_deny_cancel(struct adapter *padapter, enum PS_DENY_REASON reason) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+/* DBG_871X("+" FUNC_ADPT_FMT ": Cancel PS deny for %d(0x%08X)\n", */ -+/* FUNC_ADPT_ARG(padapter), reason, BIT(reason)); */ -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ down(&pwrpriv->lock); -+ if ((pwrpriv->ps_deny & BIT(reason)) == 0) { -+ DBG_871X(FUNC_ADPT_FMT ": [ERROR] Reason %d had been canceled before!!\n", -+ FUNC_ADPT_ARG(padapter), reason); -+ } -+ pwrpriv->ps_deny &= ~BIT(reason); -+ up(&pwrpriv->lock); -+ -+/* DBG_871X("-" FUNC_ADPT_FMT ": Now PS deny for 0x%08X\n", */ -+/* FUNC_ADPT_ARG(padapter), pwrpriv->ps_deny); */ -+} -+ -+/* -+ * ATTENTION: -+ *Before calling this function pwrctrl lock should be occupied already, -+ *otherwise it may return incorrect value. -+ */ -+u32 rtw_ps_deny_get(struct adapter *padapter) -+{ -+ u32 deny; -+ -+ -+ deny = adapter_to_pwrctl(padapter)->ps_deny; -+ -+ return deny; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_recv.c linux/3rdparty/rtl8723bs/core/rtw_recv.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_recv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_recv.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,2693 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_RECV_C_ -+ -+#include -+#include -+#include -+#include -+ -+static u8 SNAP_ETH_TYPE_IPX[2] = {0x81, 0x37}; -+static u8 SNAP_ETH_TYPE_APPLETALK_AARP[2] = {0x80, 0xf3}; -+ -+u8 rtw_rfc1042_header[] = { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00 }; -+/* Bridge-Tunnel header (for EtherTypes ETH_P_AARP and ETH_P_IPX) */ -+u8 rtw_bridge_tunnel_header[] = { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0xf8 }; -+ -+void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS); -+ -+void _rtw_init_sta_recv_priv(struct sta_recv_priv *psta_recvpriv) -+{ -+ memset((u8 *)psta_recvpriv, 0, sizeof(struct sta_recv_priv)); -+ -+ spin_lock_init(&psta_recvpriv->lock); -+ -+ /* for (i = 0; iblk_strms[i]); */ -+ -+ _rtw_init_queue(&psta_recvpriv->defrag_q); -+} -+ -+sint _rtw_init_recv_priv(struct recv_priv *precvpriv, struct adapter *padapter) -+{ -+ sint i; -+ union recv_frame *precvframe; -+ sint res = _SUCCESS; -+ -+ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by vzalloc(). */ -+ /* memset((unsigned char *)precvpriv, 0, sizeof (struct recv_priv)); */ -+ -+ spin_lock_init(&precvpriv->lock); -+ -+ _rtw_init_queue(&precvpriv->free_recv_queue); -+ _rtw_init_queue(&precvpriv->recv_pending_queue); -+ _rtw_init_queue(&precvpriv->uc_swdec_pending_queue); -+ -+ precvpriv->adapter = padapter; -+ -+ precvpriv->free_recvframe_cnt = NR_RECVFRAME; -+ -+ precvpriv->pallocated_frame_buf = vzalloc(NR_RECVFRAME * sizeof(union recv_frame) + RXFRAME_ALIGN_SZ); -+ -+ if (precvpriv->pallocated_frame_buf == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ /* memset(precvpriv->pallocated_frame_buf, 0, NR_RECVFRAME * sizeof(union recv_frame) + RXFRAME_ALIGN_SZ); */ -+ -+ precvpriv->precv_frame_buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(precvpriv->pallocated_frame_buf), RXFRAME_ALIGN_SZ); -+ /* precvpriv->precv_frame_buf = precvpriv->pallocated_frame_buf + RXFRAME_ALIGN_SZ - */ -+ /* ((SIZE_PTR) (precvpriv->pallocated_frame_buf) &(RXFRAME_ALIGN_SZ-1)); */ -+ -+ precvframe = (union recv_frame *) precvpriv->precv_frame_buf; -+ -+ -+ for (i = 0; i < NR_RECVFRAME; i++) { -+ INIT_LIST_HEAD(&(precvframe->u.list)); -+ -+ list_add_tail(&(precvframe->u.list), &(precvpriv->free_recv_queue.queue)); -+ -+ res = rtw_os_recv_resource_alloc(padapter, precvframe); -+ -+ precvframe->u.hdr.len = 0; -+ -+ precvframe->u.hdr.adapter = padapter; -+ precvframe++; -+ -+ } -+ -+ res = rtw_hal_init_recv_priv(padapter); -+ -+ rtw_init_timer(&precvpriv->signal_stat_timer, padapter, rtw_signal_stat_timer_hdl); -+ -+ precvpriv->signal_stat_sampling_interval = 2000; /* ms */ -+ -+ rtw_set_signal_stat_timer(precvpriv); -+ -+exit: -+ return res; -+} -+ -+void _rtw_free_recv_priv(struct recv_priv *precvpriv) -+{ -+ struct adapter *padapter = precvpriv->adapter; -+ -+ rtw_free_uc_swdec_pending_queue(padapter); -+ -+ rtw_os_recv_resource_free(precvpriv); -+ -+ if (precvpriv->pallocated_frame_buf) -+ vfree(precvpriv->pallocated_frame_buf); -+ -+ rtw_hal_free_recv_priv(padapter); -+} -+ -+union recv_frame *_rtw_alloc_recvframe(struct __queue *pfree_recv_queue) -+{ -+ -+ union recv_frame *precvframe; -+ struct list_head *plist, *phead; -+ struct adapter *padapter; -+ struct recv_priv *precvpriv; -+ -+ if (list_empty(&pfree_recv_queue->queue)) -+ precvframe = NULL; -+ else{ -+ phead = get_list_head(pfree_recv_queue); -+ -+ plist = get_next(phead); -+ -+ precvframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ -+ list_del_init(&precvframe->u.hdr.list); -+ padapter = precvframe->u.hdr.adapter; -+ if (padapter != NULL) { -+ precvpriv = &padapter->recvpriv; -+ if (pfree_recv_queue == &precvpriv->free_recv_queue) -+ precvpriv->free_recvframe_cnt--; -+ } -+ } -+ return precvframe; -+} -+ -+union recv_frame *rtw_alloc_recvframe(struct __queue *pfree_recv_queue) -+{ -+ union recv_frame *precvframe; -+ -+ spin_lock_bh(&pfree_recv_queue->lock); -+ -+ precvframe = _rtw_alloc_recvframe(pfree_recv_queue); -+ -+ spin_unlock_bh(&pfree_recv_queue->lock); -+ -+ return precvframe; -+} -+ -+int rtw_free_recvframe(union recv_frame *precvframe, struct __queue *pfree_recv_queue) -+{ -+ struct adapter *padapter = precvframe->u.hdr.adapter; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ rtw_os_free_recvframe(precvframe); -+ -+ -+ spin_lock_bh(&pfree_recv_queue->lock); -+ -+ list_del_init(&(precvframe->u.hdr.list)); -+ -+ precvframe->u.hdr.len = 0; -+ -+ list_add_tail(&(precvframe->u.hdr.list), get_list_head(pfree_recv_queue)); -+ -+ if (padapter != NULL) { -+ if (pfree_recv_queue == &precvpriv->free_recv_queue) -+ precvpriv->free_recvframe_cnt++; -+ } -+ spin_unlock_bh(&pfree_recv_queue->lock); -+ return _SUCCESS; -+} -+ -+ -+ -+ -+sint _rtw_enqueue_recvframe(union recv_frame *precvframe, struct __queue *queue) -+{ -+ -+ struct adapter *padapter = precvframe->u.hdr.adapter; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ /* INIT_LIST_HEAD(&(precvframe->u.hdr.list)); */ -+ list_del_init(&(precvframe->u.hdr.list)); -+ -+ -+ list_add_tail(&(precvframe->u.hdr.list), get_list_head(queue)); -+ -+ if (padapter != NULL) -+ if (queue == &precvpriv->free_recv_queue) -+ precvpriv->free_recvframe_cnt++; -+ -+ return _SUCCESS; -+} -+ -+sint rtw_enqueue_recvframe(union recv_frame *precvframe, struct __queue *queue) -+{ -+ sint ret; -+ -+ /* _spinlock(&pfree_recv_queue->lock); */ -+ spin_lock_bh(&queue->lock); -+ ret = _rtw_enqueue_recvframe(precvframe, queue); -+ /* spin_unlock(&pfree_recv_queue->lock); */ -+ spin_unlock_bh(&queue->lock); -+ -+ return ret; -+} -+ -+/* -+sint rtw_enqueue_recvframe(union recv_frame *precvframe, struct __queue *queue) -+{ -+ return rtw_free_recvframe(precvframe, queue); -+} -+*/ -+ -+ -+ -+ -+/* -+caller : defrag ; recvframe_chk_defrag in recv_thread (passive) -+pframequeue: defrag_queue : will be accessed in recv_thread (passive) -+ -+using spinlock to protect -+ -+*/ -+ -+void rtw_free_recvframe_queue(struct __queue *pframequeue, struct __queue *pfree_recv_queue) -+{ -+ union recv_frame *precvframe; -+ struct list_head *plist, *phead; -+ -+ spin_lock(&pframequeue->lock); -+ -+ phead = get_list_head(pframequeue); -+ plist = get_next(phead); -+ -+ while (phead != plist) { -+ precvframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ -+ plist = get_next(plist); -+ -+ rtw_free_recvframe(precvframe, pfree_recv_queue); -+ } -+ -+ spin_unlock(&pframequeue->lock); -+} -+ -+u32 rtw_free_uc_swdec_pending_queue(struct adapter *adapter) -+{ -+ u32 cnt = 0; -+ union recv_frame *pending_frame; -+ while ((pending_frame = rtw_alloc_recvframe(&adapter->recvpriv.uc_swdec_pending_queue))) { -+ rtw_free_recvframe(pending_frame, &adapter->recvpriv.free_recv_queue); -+ cnt++; -+ } -+ -+ if (cnt) -+ DBG_871X(FUNC_ADPT_FMT" dequeue %d\n", FUNC_ADPT_ARG(adapter), cnt); -+ -+ return cnt; -+} -+ -+ -+sint rtw_enqueue_recvbuf_to_head(struct recv_buf *precvbuf, struct __queue *queue) -+{ -+ spin_lock_bh(&queue->lock); -+ -+ list_del_init(&precvbuf->list); -+ list_add(&precvbuf->list, get_list_head(queue)); -+ -+ spin_unlock_bh(&queue->lock); -+ -+ return _SUCCESS; -+} -+ -+sint rtw_enqueue_recvbuf(struct recv_buf *precvbuf, struct __queue *queue) -+{ -+ spin_lock_bh(&queue->lock); -+ -+ list_del_init(&precvbuf->list); -+ -+ list_add_tail(&precvbuf->list, get_list_head(queue)); -+ spin_unlock_bh(&queue->lock); -+ return _SUCCESS; -+ -+} -+ -+struct recv_buf *rtw_dequeue_recvbuf(struct __queue *queue) -+{ -+ struct recv_buf *precvbuf; -+ struct list_head *plist, *phead; -+ -+ spin_lock_bh(&queue->lock); -+ -+ if (list_empty(&queue->queue)) -+ precvbuf = NULL; -+ else{ -+ phead = get_list_head(queue); -+ -+ plist = get_next(phead); -+ -+ precvbuf = LIST_CONTAINOR(plist, struct recv_buf, list); -+ -+ list_del_init(&precvbuf->list); -+ -+ } -+ -+ spin_unlock_bh(&queue->lock); -+ -+ return precvbuf; -+ -+} -+ -+sint recvframe_chkmic(struct adapter *adapter, union recv_frame *precvframe); -+sint recvframe_chkmic(struct adapter *adapter, union recv_frame *precvframe) -+{ -+ -+ sint i, res = _SUCCESS; -+ u32 datalen; -+ u8 miccode[8]; -+ u8 bmic_err = false, brpt_micerror = true; -+ u8 *pframe, *payload, *pframemic; -+ u8 *mickey; -+ /* u8 *iv, rxdata_key_idx = 0; */ -+ struct sta_info *stainfo; -+ struct rx_pkt_attrib *prxattrib = &precvframe->u.hdr.attrib; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ stainfo = rtw_get_stainfo(&adapter->stapriv, &prxattrib->ta[0]); -+ -+ if (prxattrib->encrypt == _TKIP_) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("\n recvframe_chkmic:prxattrib->encrypt == _TKIP_\n")); -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("\n recvframe_chkmic:da = 0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x\n", -+ prxattrib->ra[0], prxattrib->ra[1], prxattrib->ra[2], prxattrib->ra[3], prxattrib->ra[4], prxattrib->ra[5])); -+ -+ /* calculate mic code */ -+ if (stainfo != NULL) { -+ if (IS_MCAST(prxattrib->ra)) { -+ /* mickey =&psecuritypriv->dot118021XGrprxmickey.skey[0]; */ -+ /* iv = precvframe->u.hdr.rx_data+prxattrib->hdrlen; */ -+ /* rxdata_key_idx =(((iv[3])>>6)&0x3) ; */ -+ mickey = &psecuritypriv->dot118021XGrprxmickey[prxattrib->key_index].skey[0]; -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("\n recvframe_chkmic: bcmc key\n")); -+ /* DBG_871X("\n recvframe_chkmic: bcmc key psecuritypriv->dot118021XGrpKeyid(%d), pmlmeinfo->key_index(%d) , recv key_id(%d)\n", */ -+ /* psecuritypriv->dot118021XGrpKeyid, pmlmeinfo->key_index, rxdata_key_idx); */ -+ -+ if (psecuritypriv->binstallGrpkey == false) { -+ res = _FAIL; -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("\n recvframe_chkmic:didn't install group key!!!!!!!!!!\n")); -+ DBG_871X("\n recvframe_chkmic:didn't install group key!!!!!!!!!!\n"); -+ goto exit; -+ } -+ } else { -+ mickey = &stainfo->dot11tkiprxmickey.skey[0]; -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("\n recvframe_chkmic: unicast key\n")); -+ } -+ -+ datalen = precvframe->u.hdr.len-prxattrib->hdrlen-prxattrib->iv_len-prxattrib->icv_len-8;/* icv_len included the mic code */ -+ pframe = precvframe->u.hdr.rx_data; -+ payload = pframe+prxattrib->hdrlen+prxattrib->iv_len; -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("\n prxattrib->iv_len =%d prxattrib->icv_len =%d\n", prxattrib->iv_len, prxattrib->icv_len)); -+ -+ -+ rtw_seccalctkipmic(mickey, pframe, payload, datalen, &miccode[0], (unsigned char)prxattrib->priority); /* care the length of the data */ -+ -+ pframemic = payload+datalen; -+ -+ bmic_err = false; -+ -+ for (i = 0; i < 8; i++) { -+ if (miccode[i] != *(pframemic+i)) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("recvframe_chkmic:miccode[%d](%02x) != *(pframemic+%d)(%02x) ", i, miccode[i], i, *(pframemic+i))); -+ bmic_err = true; -+ } -+ } -+ -+ -+ if (bmic_err == true) { -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("\n *(pframemic-8)-*(pframemic-1) = 0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x\n", -+ *(pframemic-8), *(pframemic-7), *(pframemic-6), *(pframemic-5), *(pframemic-4), *(pframemic-3), *(pframemic-2), *(pframemic-1))); -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("\n *(pframemic-16)-*(pframemic-9) = 0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x\n", -+ *(pframemic-16), *(pframemic-15), *(pframemic-14), *(pframemic-13), *(pframemic-12), *(pframemic-11), *(pframemic-10), *(pframemic-9))); -+ -+ { -+ uint i; -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("\n ======demp packet (len =%d) ======\n", precvframe->u.hdr.len)); -+ for (i = 0; i < precvframe->u.hdr.len; i = i+8) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x", -+ *(precvframe->u.hdr.rx_data+i), *(precvframe->u.hdr.rx_data+i+1), -+ *(precvframe->u.hdr.rx_data+i+2), *(precvframe->u.hdr.rx_data+i+3), -+ *(precvframe->u.hdr.rx_data+i+4), *(precvframe->u.hdr.rx_data+i+5), -+ *(precvframe->u.hdr.rx_data+i+6), *(precvframe->u.hdr.rx_data+i+7))); -+ } -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("\n ======demp packet end [len =%d]======\n", precvframe->u.hdr.len)); -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("\n hrdlen =%d,\n", prxattrib->hdrlen)); -+ } -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("ra = 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x psecuritypriv->binstallGrpkey =%d ", -+ prxattrib->ra[0], prxattrib->ra[1], prxattrib->ra[2], -+ prxattrib->ra[3], prxattrib->ra[4], prxattrib->ra[5], psecuritypriv->binstallGrpkey)); -+ -+ /* double check key_index for some timing issue , */ -+ /* cannot compare with psecuritypriv->dot118021XGrpKeyid also cause timing issue */ -+ if ((IS_MCAST(prxattrib->ra) == true) && (prxattrib->key_index != pmlmeinfo->key_index)) -+ brpt_micerror = false; -+ -+ if ((prxattrib->bdecrypted == true) && (brpt_micerror == true)) { -+ rtw_handle_tkip_mic_err(adapter, (u8)IS_MCAST(prxattrib->ra)); -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, (" mic error :prxattrib->bdecrypted =%d ", prxattrib->bdecrypted)); -+ DBG_871X(" mic error :prxattrib->bdecrypted =%d\n", prxattrib->bdecrypted); -+ } else{ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, (" mic error :prxattrib->bdecrypted =%d ", prxattrib->bdecrypted)); -+ DBG_871X(" mic error :prxattrib->bdecrypted =%d\n", prxattrib->bdecrypted); -+ } -+ -+ res = _FAIL; -+ -+ } else { -+ /* mic checked ok */ -+ if ((psecuritypriv->bcheck_grpkey == false) && (IS_MCAST(prxattrib->ra) == true)) { -+ psecuritypriv->bcheck_grpkey = true; -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("psecuritypriv->bcheck_grpkey =true")); -+ } -+ } -+ -+ } else -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("recvframe_chkmic: rtw_get_stainfo == NULL!!!\n")); -+ -+ recvframe_pull_tail(precvframe, 8); -+ -+ } -+ -+exit: -+ return res; -+ -+} -+ -+/* decrypt and set the ivlen, icvlen of the recv_frame */ -+union recv_frame *decryptor(struct adapter *padapter, union recv_frame *precv_frame); -+union recv_frame *decryptor(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ -+ struct rx_pkt_attrib *prxattrib = &precv_frame->u.hdr.attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ union recv_frame *return_packet = precv_frame; -+ u32 res = _SUCCESS; -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt); -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("prxstat->decrypted =%x prxattrib->encrypt = 0x%03x\n", prxattrib->bdecrypted, prxattrib->encrypt)); -+ -+ if (prxattrib->encrypt > 0) { -+ u8 *iv = precv_frame->u.hdr.rx_data+prxattrib->hdrlen; -+ prxattrib->key_index = (((iv[3])>>6)&0x3); -+ -+ if (prxattrib->key_index > WEP_KEYS) { -+ DBG_871X("prxattrib->key_index(%d) > WEP_KEYS\n", prxattrib->key_index); -+ -+ switch (prxattrib->encrypt) { -+ case _WEP40_: -+ case _WEP104_: -+ prxattrib->key_index = psecuritypriv->dot11PrivacyKeyIndex; -+ break; -+ case _TKIP_: -+ case _AES_: -+ default: -+ prxattrib->key_index = psecuritypriv->dot118021XGrpKeyid; -+ break; -+ } -+ } -+ } -+ -+ if ((prxattrib->encrypt > 0) && ((prxattrib->bdecrypted == 0) || (psecuritypriv->sw_decrypt == true))) { -+ psecuritypriv->hw_decrypted = false; -+ -+ #ifdef DBG_RX_DECRYPTOR -+ DBG_871X("[%s] %d:prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n", -+ __func__, -+ __LINE__, -+ prxattrib->bdecrypted, -+ prxattrib->encrypt, -+ psecuritypriv->hw_decrypted); -+ #endif -+ -+ switch (prxattrib->encrypt) { -+ case _WEP40_: -+ case _WEP104_: -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_wep); -+ rtw_wep_decrypt(padapter, (u8 *)precv_frame); -+ break; -+ case _TKIP_: -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_tkip); -+ res = rtw_tkip_decrypt(padapter, (u8 *)precv_frame); -+ break; -+ case _AES_: -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_aes); -+ res = rtw_aes_decrypt(padapter, (u8 *)precv_frame); -+ break; -+ default: -+ break; -+ } -+ } else if (prxattrib->bdecrypted == 1 -+ && prxattrib->encrypt > 0 -+ && (psecuritypriv->busetkipkey == 1 || prxattrib->encrypt != _TKIP_) -+ ) { -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_hw); -+ -+ psecuritypriv->hw_decrypted = true; -+ #ifdef DBG_RX_DECRYPTOR -+ DBG_871X("[%s] %d:prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n", -+ __func__, -+ __LINE__, -+ prxattrib->bdecrypted, -+ prxattrib->encrypt, -+ psecuritypriv->hw_decrypted); -+ -+ #endif -+ } else { -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_unknown); -+ #ifdef DBG_RX_DECRYPTOR -+ DBG_871X("[%s] %d:prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n", -+ __func__, -+ __LINE__, -+ prxattrib->bdecrypted, -+ prxattrib->encrypt, -+ psecuritypriv->hw_decrypted); -+ #endif -+ } -+ -+ if (res == _FAIL) { -+ rtw_free_recvframe(return_packet, &padapter->recvpriv.free_recv_queue); -+ return_packet = NULL; -+ } else -+ prxattrib->bdecrypted = true; -+ -+ return return_packet; -+} -+ -+/* set the security information in the recv_frame */ -+union recv_frame *portctrl(struct adapter *adapter, union recv_frame *precv_frame); -+union recv_frame *portctrl(struct adapter *adapter, union recv_frame *precv_frame) -+{ -+ u8 *psta_addr = NULL; -+ u8 *ptr; -+ uint auth_alg; -+ struct recv_frame_hdr *pfhdr; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv; -+ union recv_frame *prtnframe; -+ u16 ether_type = 0; -+ u16 eapol_type = 0x888e;/* for Funia BD's WPA issue */ -+ struct rx_pkt_attrib *pattrib; -+ -+ pstapriv = &adapter->stapriv; -+ -+ auth_alg = adapter->securitypriv.dot11AuthAlgrthm; -+ -+ ptr = get_recvframe_data(precv_frame); -+ pfhdr = &precv_frame->u.hdr; -+ pattrib = &pfhdr->attrib; -+ psta_addr = pattrib->ta; -+ -+ prtnframe = NULL; -+ -+ psta = rtw_get_stainfo(pstapriv, psta_addr); -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("########portctrl:adapter->securitypriv.dot11AuthAlgrthm =%d\n", adapter->securitypriv.dot11AuthAlgrthm)); -+ -+ if (auth_alg == 2) { -+ if ((psta != NULL) && (psta->ieee8021x_blocked)) { -+ __be16 be_tmp; -+ -+ /* blocked */ -+ /* only accept EAPOL frame */ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("########portctrl:psta->ieee8021x_blocked == 1\n")); -+ -+ prtnframe = precv_frame; -+ -+ /* get ether_type */ -+ ptr = ptr+pfhdr->attrib.hdrlen+pfhdr->attrib.iv_len+LLC_HEADER_SIZE; -+ memcpy(&be_tmp, ptr, 2); -+ ether_type = ntohs(be_tmp); -+ -+ if (ether_type == eapol_type) -+ prtnframe = precv_frame; -+ else { -+ /* free this frame */ -+ rtw_free_recvframe(precv_frame, &adapter->recvpriv.free_recv_queue); -+ prtnframe = NULL; -+ } -+ } else{ -+ /* allowed */ -+ /* check decryption status, and decrypt the frame if needed */ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("########portctrl:psta->ieee8021x_blocked == 0\n")); -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("portctrl:precv_frame->hdr.attrib.privacy =%x\n", precv_frame->u.hdr.attrib.privacy)); -+ -+ if (pattrib->bdecrypted == 0) -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("portctrl:prxstat->decrypted =%x\n", pattrib->bdecrypted)); -+ -+ prtnframe = precv_frame; -+ /* check is the EAPOL frame or not (Rekey) */ -+ /* if (ether_type == eapol_type) { */ -+ /* RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("########portctrl:ether_type == 0x888e\n")); */ -+ /* check Rekey */ -+ -+ /* prtnframe =precv_frame; */ -+ /* */ -+ /* else { */ -+ /* RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("########portctrl:ether_type = 0x%04x\n", ether_type)); */ -+ /* */ -+ } -+ } else -+ prtnframe = precv_frame; -+ -+ return prtnframe; -+} -+ -+sint recv_decache(union recv_frame *precv_frame, u8 bretry, struct stainfo_rxcache *prxcache); -+sint recv_decache(union recv_frame *precv_frame, u8 bretry, struct stainfo_rxcache *prxcache) -+{ -+ sint tid = precv_frame->u.hdr.attrib.priority; -+ -+ u16 seq_ctrl = ((precv_frame->u.hdr.attrib.seq_num&0xffff) << 4) | -+ (precv_frame->u.hdr.attrib.frag_num & 0xf); -+ -+ if (tid > 15) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("recv_decache, (tid>15)! seq_ctrl = 0x%x, tid = 0x%x\n", seq_ctrl, tid)); -+ -+ return _FAIL; -+ } -+ -+ if (1) { /* if (bretry) */ -+ if (seq_ctrl == prxcache->tid_rxseq[tid]) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("recv_decache, seq_ctrl = 0x%x, tid = 0x%x, tid_rxseq = 0x%x\n", seq_ctrl, tid, prxcache->tid_rxseq[tid])); -+ -+ return _FAIL; -+ } -+ } -+ -+ prxcache->tid_rxseq[tid] = seq_ctrl; -+ -+ return _SUCCESS; -+ -+} -+ -+void process_pwrbit_data(struct adapter *padapter, union recv_frame *precv_frame); -+void process_pwrbit_data(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned char pwrbit; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+ -+ psta = rtw_get_stainfo(pstapriv, pattrib->src); -+ -+ pwrbit = GetPwrMgt(ptr); -+ -+ if (psta) { -+ if (pwrbit) { -+ if (!(psta->state & WIFI_SLEEP_STATE)) { -+ /* psta->state |= WIFI_SLEEP_STATE; */ -+ /* pstapriv->sta_dz_bitmap |= BIT(psta->aid); */ -+ -+ stop_sta_xmit(padapter, psta); -+ -+ /* DBG_871X("to sleep, sta_dz_bitmap =%x\n", pstapriv->sta_dz_bitmap); */ -+ } -+ } else{ -+ if (psta->state & WIFI_SLEEP_STATE) { -+ /* psta->state ^= WIFI_SLEEP_STATE; */ -+ /* pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); */ -+ -+ wakeup_sta_to_xmit(padapter, psta); -+ -+ /* DBG_871X("to wakeup, sta_dz_bitmap =%x\n", pstapriv->sta_dz_bitmap); */ -+ } -+ } -+ -+ } -+} -+ -+void process_wmmps_data(struct adapter *padapter, union recv_frame *precv_frame); -+void process_wmmps_data(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+ -+ psta = rtw_get_stainfo(pstapriv, pattrib->src); -+ -+ if (!psta) -+ return; -+ -+ if (!psta->qos_option) -+ return; -+ -+ if (!(psta->qos_info&0xf)) -+ return; -+ -+ if (psta->state&WIFI_SLEEP_STATE) { -+ u8 wmmps_ac = 0; -+ -+ switch (pattrib->priority) { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk&BIT(1); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi&BIT(1); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo&BIT(1); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be&BIT(1); -+ break; -+ } -+ -+ if (wmmps_ac) { -+ if (psta->sleepq_ac_len > 0) -+ /* process received triggered frame */ -+ xmit_delivery_enabled_frames(padapter, psta); -+ else -+ /* issue one qos null frame with More data bit = 0 and the EOSP bit set (= 1) */ -+ issue_qos_nulldata(padapter, psta->hwaddr, (u16)pattrib->priority, 0, 0); -+ } -+ } -+} -+ -+void count_rx_stats(struct adapter *padapter, union recv_frame *prframe, struct sta_info *sta); -+void count_rx_stats(struct adapter *padapter, union recv_frame *prframe, struct sta_info *sta) -+{ -+ int sz; -+ struct sta_info *psta = NULL; -+ struct stainfo_stats *pstats = NULL; -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ sz = get_recvframe_len(prframe); -+ precvpriv->rx_bytes += sz; -+ -+ padapter->mlmepriv.LinkDetectInfo.NumRxOkInPeriod++; -+ -+ if ((!MacAddr_isBcst(pattrib->dst)) && (!IS_MCAST(pattrib->dst))) { -+ padapter->mlmepriv.LinkDetectInfo.NumRxUnicastOkInPeriod++; -+ } -+ -+ if (sta) -+ psta = sta; -+ else -+ psta = prframe->u.hdr.psta; -+ -+ if (psta) { -+ pstats = &psta->sta_stats; -+ -+ pstats->rx_data_pkts++; -+ pstats->rx_bytes += sz; -+ } -+ -+ traffic_check_for_leave_lps(padapter, false, 0); -+} -+ -+sint sta2sta_data_frame( -+ struct adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info **psta -+); -+sint sta2sta_data_frame( -+ struct adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info **psta -+) -+{ -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ sint ret = _SUCCESS; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u8 *mybssid = get_bssid(pmlmepriv); -+ u8 *myhwaddr = myid(&adapter->eeprompriv); -+ u8 *sta_addr = NULL; -+ sint bmcast = IS_MCAST(pattrib->dst); -+ -+ /* DBG_871X("[%s] %d, seqnum:%d\n", __func__, __LINE__, pattrib->seq_num); */ -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) { -+ -+ /* filter packets that SA is myself or multicast or broadcast */ -+ if (!memcmp(myhwaddr, pattrib->src, ETH_ALEN)) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, (" SA ==myself\n")); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if ((memcmp(myhwaddr, pattrib->dst, ETH_ALEN)) && (!bmcast)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if (!memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ !memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ (memcmp(pattrib->bssid, mybssid, ETH_ALEN))) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ sta_addr = pattrib->src; -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) { -+ { -+ /* For Station mode, sa and bssid should always be BSSID, and DA is my mac-address */ -+ if (memcmp(pattrib->bssid, pattrib->src, ETH_ALEN)) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("bssid != TA under STATION_MODE; drop pkt\n")); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ sta_addr = pattrib->bssid; -+ } -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) { -+ if (bmcast) { -+ /* For AP mode, if DA == MCAST, then BSSID should be also MCAST */ -+ if (!IS_MCAST(pattrib->bssid)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ } else{ /* not mc-frame */ -+ /* For AP mode, if DA is non-MCAST, then it must be BSSID, and bssid == BSSID */ -+ if (memcmp(pattrib->bssid, pattrib->dst, ETH_ALEN)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ sta_addr = pattrib->src; -+ } -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) { -+ memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); -+ memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); -+ memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); -+ memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ sta_addr = mybssid; -+ } else -+ ret = _FAIL; -+ -+ -+ -+ if (bmcast) -+ *psta = rtw_get_bcmc_stainfo(adapter); -+ else -+ *psta = rtw_get_stainfo(pstapriv, sta_addr); /* get ap_info */ -+ -+ if (*psta == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("can't get psta under sta2sta_data_frame ; drop pkt\n")); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+sint ap2sta_data_frame( -+ struct adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info **psta); -+sint ap2sta_data_frame( -+ struct adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info **psta) -+{ -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ sint ret = _SUCCESS; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u8 *mybssid = get_bssid(pmlmepriv); -+ u8 *myhwaddr = myid(&adapter->eeprompriv); -+ sint bmcast = IS_MCAST(pattrib->dst); -+ -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) -+ && (check_fwstate(pmlmepriv, _FW_LINKED) == true -+ || check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) -+ ) { -+ -+ /* filter packets that SA is myself or multicast or broadcast */ -+ if (!memcmp(myhwaddr, pattrib->src, ETH_ALEN)) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, (" SA ==myself\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s SA ="MAC_FMT", myhwaddr ="MAC_FMT"\n", -+ __func__, MAC_ARG(pattrib->src), MAC_ARG(myhwaddr)); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* da should be for me */ -+ if ((memcmp(myhwaddr, pattrib->dst, ETH_ALEN)) && (!bmcast)) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, -+ (" ap2sta_data_frame: compare DA fail; DA ="MAC_FMT"\n", MAC_ARG(pattrib->dst))); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s DA ="MAC_FMT"\n", __func__, MAC_ARG(pattrib->dst)); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ -+ /* check BSSID */ -+ if (!memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ !memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ (memcmp(pattrib->bssid, mybssid, ETH_ALEN))) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, -+ (" ap2sta_data_frame: compare BSSID fail ; BSSID ="MAC_FMT"\n", MAC_ARG(pattrib->bssid))); -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("mybssid ="MAC_FMT"\n", MAC_ARG(mybssid))); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s BSSID ="MAC_FMT", mybssid ="MAC_FMT"\n", -+ __func__, MAC_ARG(pattrib->bssid), MAC_ARG(mybssid)); -+ DBG_871X("this adapter = %d, buddy adapter = %d\n", adapter->adapter_type, adapter->pbuddystruct adapter->adapter_type); -+ #endif -+ -+ if (!bmcast) { -+ DBG_871X("issue_deauth to the nonassociated ap =" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->bssid)); -+ issue_deauth(adapter, pattrib->bssid, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ } -+ -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if (bmcast) -+ *psta = rtw_get_bcmc_stainfo(adapter); -+ else -+ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get ap_info */ -+ -+ if (*psta == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("ap2sta: can't get psta under STATION_MODE ; drop pkt\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s can't get psta under STATION_MODE ; drop pkt\n", __func__); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) { -+ } -+ -+ if (GetFrameSubType(ptr) & BIT(6)) { -+ /* No data, will not indicate to upper layer, temporily count it here */ -+ count_rx_stats(adapter, precv_frame, *psta); -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ -+ } else if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) && -+ (check_fwstate(pmlmepriv, _FW_LINKED) == true)) { -+ memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); -+ memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); -+ memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); -+ memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ /* */ -+ memcpy(pattrib->bssid, mybssid, ETH_ALEN); -+ -+ -+ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get sta_info */ -+ if (*psta == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("can't get psta under MP_MODE ; drop pkt\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s can't get psta under WIFI_MP_STATE ; drop pkt\n", __func__); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) { -+ /* Special case */ -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } else{ -+ if (!memcmp(myhwaddr, pattrib->dst, ETH_ALEN) && (!bmcast)) { -+ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get sta_info */ -+ if (*psta == NULL) { -+ -+ /* for AP multicast issue , modify by yiwei */ -+ static unsigned long send_issue_deauth_time = 0; -+ -+ /* DBG_871X("After send deauth , %u ms has elapsed.\n", jiffies_to_msecs(jiffies - send_issue_deauth_time)); */ -+ -+ if (jiffies_to_msecs(jiffies - send_issue_deauth_time) > 10000 || send_issue_deauth_time == 0) { -+ send_issue_deauth_time = jiffies; -+ -+ DBG_871X("issue_deauth to the ap =" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->bssid)); -+ -+ issue_deauth(adapter, pattrib->bssid, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ } -+ } -+ } -+ -+ ret = _FAIL; -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s fw_state:0x%x\n", __func__, get_fwstate(pmlmepriv)); -+ #endif -+ } -+ -+exit: -+ return ret; -+} -+ -+sint sta2ap_data_frame( -+ struct adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info **psta); -+sint sta2ap_data_frame( -+ struct adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info **psta) -+{ -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ unsigned char *mybssid = get_bssid(pmlmepriv); -+ sint ret = _SUCCESS; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) { -+ /* For AP mode, RA =BSSID, TX =STA(SRC_ADDR), A3 =DST_ADDR */ -+ if (memcmp(pattrib->bssid, mybssid, ETH_ALEN)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ *psta = rtw_get_stainfo(pstapriv, pattrib->src); -+ if (*psta == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("can't get psta under AP_MODE; drop pkt\n")); -+ DBG_871X("issue_deauth to sta =" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->src)); -+ -+ issue_deauth(adapter, pattrib->src, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ -+ process_pwrbit_data(adapter, precv_frame); -+ -+ if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) { -+ process_wmmps_data(adapter, precv_frame); -+ } -+ -+ if (GetFrameSubType(ptr) & BIT(6)) { -+ /* No data, will not indicate to upper layer, temporily count it here */ -+ count_rx_stats(adapter, precv_frame, *psta); -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ } else { -+ u8 *myhwaddr = myid(&adapter->eeprompriv); -+ if (memcmp(pattrib->ra, myhwaddr, ETH_ALEN)) { -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ DBG_871X("issue_deauth to sta =" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->src)); -+ issue_deauth(adapter, pattrib->src, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+sint validate_recv_ctrl_frame(struct adapter *padapter, union recv_frame *precv_frame); -+sint validate_recv_ctrl_frame(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct sta_info *psta = NULL; -+ /* uint len = precv_frame->u.hdr.len; */ -+ -+ /* DBG_871X("+validate_recv_ctrl_frame\n"); */ -+ -+ if (GetFrameType(pframe) != WIFI_CTRL_TYPE) -+ return _FAIL; -+ -+ /* receive the frames that ra(a1) is my address */ -+ if (memcmp(GetAddr1Ptr(pframe), myid(&padapter->eeprompriv), ETH_ALEN)) -+ return _FAIL; -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta == NULL) -+ return _FAIL; -+ -+ /* for rx pkt statistics */ -+ psta->sta_stats.rx_ctrl_pkts++; -+ -+ /* only handle ps-poll */ -+ if (GetFrameSubType(pframe) == WIFI_PSPOLL) { -+ u16 aid; -+ u8 wmmps_ac = 0; -+ -+ aid = GetAid(pframe); -+ if (psta->aid != aid) -+ return _FAIL; -+ -+ switch (pattrib->priority) { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk&BIT(0); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi&BIT(0); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo&BIT(0); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be&BIT(0); -+ break; -+ } -+ -+ if (wmmps_ac) -+ return _FAIL; -+ -+ if (psta->state & WIFI_STA_ALIVE_CHK_STATE) { -+ DBG_871X("%s alive check-rx ps-poll\n", __func__); -+ psta->expire_to = pstapriv->expire_to; -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ } -+ -+ if ((psta->state&WIFI_SLEEP_STATE) && (pstapriv->sta_dz_bitmap&BIT(psta->aid))) { -+ struct list_head *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe = NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ /* spin_lock_bh(&psta->sleep_q.lock); */ -+ spin_lock_bh(&pxmitpriv->lock); -+ -+ xmitframe_phead = get_list_head(&psta->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ if (xmitframe_phead != xmitframe_plist) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ list_del_init(&pxmitframe->list); -+ -+ psta->sleepq_len--; -+ -+ if (psta->sleepq_len > 0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ pxmitframe->attrib.triggered = 1; -+ -+ /* DBG_871X("handling ps-poll, q_len =%d, tim =%x\n", psta->sleepq_len, pstapriv->tim_bitmap); */ -+ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ if (psta->sleepq_len == 0) { -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ /* DBG_871X("after handling ps-poll, tim =%x\n", pstapriv->tim_bitmap); */ -+ -+ /* upate BCN for TIM IE */ -+ /* update_BCNTIM(padapter); */ -+ update_beacon(padapter, _TIM_IE_, NULL, true); -+ } -+ -+ /* spin_unlock_bh(&psta->sleep_q.lock); */ -+ spin_unlock_bh(&pxmitpriv->lock); -+ -+ } else{ -+ /* spin_unlock_bh(&psta->sleep_q.lock); */ -+ spin_unlock_bh(&pxmitpriv->lock); -+ -+ /* DBG_871X("no buffered packets to xmit\n"); */ -+ if (pstapriv->tim_bitmap&BIT(psta->aid)) { -+ if (psta->sleepq_len == 0) { -+ DBG_871X("no buffered packets to xmit\n"); -+ -+ /* issue nulldata with More data bit = 0 to indicate we have no buffered packets */ -+ issue_nulldata_in_interrupt(padapter, psta->hwaddr); -+ } else{ -+ DBG_871X("error!psta->sleepq_len =%d\n", psta->sleepq_len); -+ psta->sleepq_len = 0; -+ } -+ -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ /* upate BCN for TIM IE */ -+ /* update_BCNTIM(padapter); */ -+ update_beacon(padapter, _TIM_IE_, NULL, true); -+ } -+ } -+ } -+ } -+ -+ return _FAIL; -+ -+} -+ -+union recv_frame *recvframe_chk_defrag(struct adapter *padapter, union recv_frame *precv_frame); -+sint validate_recv_mgnt_frame(struct adapter *padapter, union recv_frame *precv_frame); -+sint validate_recv_mgnt_frame(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ /* struct mlme_priv *pmlmepriv = &adapter->mlmepriv; */ -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("+validate_recv_mgnt_frame\n")); -+ -+ precv_frame = recvframe_chk_defrag(padapter, precv_frame); -+ if (precv_frame == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("%s: fragment packet\n", __func__)); -+ return _SUCCESS; -+ } -+ -+ { -+ /* for rx pkt statistics */ -+ struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, GetAddr2Ptr(precv_frame->u.hdr.rx_data)); -+ if (psta) { -+ psta->sta_stats.rx_mgnt_pkts++; -+ if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_BEACON) -+ psta->sta_stats.rx_beacon_pkts++; -+ else if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_PROBEREQ) -+ psta->sta_stats.rx_probereq_pkts++; -+ else if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_PROBERSP) { -+ if (!memcmp(padapter->eeprompriv.mac_addr, GetAddr1Ptr(precv_frame->u.hdr.rx_data), ETH_ALEN)) -+ psta->sta_stats.rx_probersp_pkts++; -+ else if (is_broadcast_mac_addr(GetAddr1Ptr(precv_frame->u.hdr.rx_data)) -+ || is_multicast_mac_addr(GetAddr1Ptr(precv_frame->u.hdr.rx_data))) -+ psta->sta_stats.rx_probersp_bm_pkts++; -+ else -+ psta->sta_stats.rx_probersp_uo_pkts++; -+ } -+ } -+ } -+ -+ mgt_dispatcher(padapter, precv_frame); -+ -+ return _SUCCESS; -+ -+} -+ -+sint validate_recv_data_frame(struct adapter *adapter, union recv_frame *precv_frame); -+sint validate_recv_data_frame(struct adapter *adapter, union recv_frame *precv_frame) -+{ -+ u8 bretry; -+ u8 *psa, *pda, *pbssid; -+ struct sta_info *psta = NULL; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ sint ret = _SUCCESS; -+ -+ bretry = GetRetry(ptr); -+ pda = get_da(ptr); -+ psa = get_sa(ptr); -+ pbssid = get_hdr_bssid(ptr); -+ -+ if (pbssid == NULL) { -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s pbssid == NULL\n", __func__); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ memcpy(pattrib->dst, pda, ETH_ALEN); -+ memcpy(pattrib->src, psa, ETH_ALEN); -+ -+ memcpy(pattrib->bssid, pbssid, ETH_ALEN); -+ -+ switch (pattrib->to_fr_ds) { -+ case 0: -+ memcpy(pattrib->ra, pda, ETH_ALEN); -+ memcpy(pattrib->ta, psa, ETH_ALEN); -+ ret = sta2sta_data_frame(adapter, precv_frame, &psta); -+ break; -+ -+ case 1: -+ memcpy(pattrib->ra, pda, ETH_ALEN); -+ memcpy(pattrib->ta, pbssid, ETH_ALEN); -+ ret = ap2sta_data_frame(adapter, precv_frame, &psta); -+ break; -+ -+ case 2: -+ memcpy(pattrib->ra, pbssid, ETH_ALEN); -+ memcpy(pattrib->ta, psa, ETH_ALEN); -+ ret = sta2ap_data_frame(adapter, precv_frame, &psta); -+ break; -+ -+ case 3: -+ memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); -+ ret = _FAIL; -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, (" case 3\n")); -+ break; -+ -+ default: -+ ret = _FAIL; -+ break; -+ -+ } -+ -+ if (ret == _FAIL) { -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s case:%d, res:%d\n", __func__, pattrib->to_fr_ds, ret); -+ #endif -+ goto exit; -+ } else if (ret == RTW_RX_HANDLED) { -+ goto exit; -+ } -+ -+ -+ if (psta == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, (" after to_fr_ds_chk; psta == NULL\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s psta == NULL\n", __func__); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* psta->rssi = prxcmd->rssi; */ -+ /* psta->signal_quality = prxcmd->sq; */ -+ precv_frame->u.hdr.psta = psta; -+ -+ -+ pattrib->amsdu = 0; -+ pattrib->ack_policy = 0; -+ /* parsing QC field */ -+ if (pattrib->qos == 1) { -+ pattrib->priority = GetPriority((ptr + 24)); -+ pattrib->ack_policy = GetAckpolicy((ptr + 24)); -+ pattrib->amsdu = GetAMsdu((ptr + 24)); -+ pattrib->hdrlen = pattrib->to_fr_ds == 3 ? 32 : 26; -+ -+ if (pattrib->priority != 0 && pattrib->priority != 3) -+ adapter->recvpriv.bIsAnyNonBEPkts = true; -+ -+ } else{ -+ pattrib->priority = 0; -+ pattrib->hdrlen = pattrib->to_fr_ds == 3 ? 30 : 24; -+ } -+ -+ -+ if (pattrib->order)/* HT-CTRL 11n */ -+ pattrib->hdrlen += 4; -+ -+ precv_frame->u.hdr.preorder_ctrl = &psta->recvreorder_ctrl[pattrib->priority]; -+ -+ /* decache, drop duplicate recv packets */ -+ if (recv_decache(precv_frame, bretry, &psta->sta_recvpriv.rxcache) == _FAIL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("decache : drop pkt\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s recv_decache return _FAIL\n", __func__); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if (pattrib->privacy) { -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("validate_recv_data_frame:pattrib->privacy =%x\n", pattrib->privacy)); -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("\n ^^^^^^^^^^^IS_MCAST(pattrib->ra(0x%02x)) =%d^^^^^^^^^^^^^^^6\n", pattrib->ra[0], IS_MCAST(pattrib->ra))); -+ -+ GET_ENCRY_ALGO(psecuritypriv, psta, pattrib->encrypt, IS_MCAST(pattrib->ra)); -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("\n pattrib->encrypt =%d\n", pattrib->encrypt)); -+ -+ SET_ICE_IV_LEN(pattrib->iv_len, pattrib->icv_len, pattrib->encrypt); -+ } else{ -+ pattrib->encrypt = 0; -+ pattrib->iv_len = pattrib->icv_len = 0; -+ } -+ -+exit: -+ return ret; -+} -+ -+static sint validate_80211w_mgmt(struct adapter *adapter, union recv_frame *precv_frame) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ u8 type; -+ u8 subtype; -+ -+ type = GetFrameType(ptr); -+ subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ -+ -+ /* only support station mode */ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && check_fwstate(pmlmepriv, _FW_LINKED) -+ && adapter->securitypriv.binstallBIPkey == true) { -+ /* unicast management frame decrypt */ -+ if (pattrib->privacy && !(IS_MCAST(GetAddr1Ptr(ptr))) && -+ (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || subtype == WIFI_ACTION)) { -+ u8 *ppp, *mgmt_DATA; -+ u32 data_len = 0; -+ ppp = GetAddr2Ptr(ptr); -+ -+ pattrib->bdecrypted = 0; -+ pattrib->encrypt = _AES_; -+ pattrib->hdrlen = sizeof(struct ieee80211_hdr_3addr); -+ /* set iv and icv length */ -+ SET_ICE_IV_LEN(pattrib->iv_len, pattrib->icv_len, pattrib->encrypt); -+ memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); -+ /* actual management data frame body */ -+ data_len = pattrib->pkt_len - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; -+ mgmt_DATA = rtw_zmalloc(data_len); -+ if (mgmt_DATA == NULL) { -+ DBG_871X("%s mgmt allocate fail !!!!!!!!!\n", __func__); -+ goto validate_80211w_fail; -+ } -+ precv_frame = decryptor(adapter, precv_frame); -+ /* save actual management data frame body */ -+ memcpy(mgmt_DATA, ptr+pattrib->hdrlen+pattrib->iv_len, data_len); -+ /* overwrite the iv field */ -+ memcpy(ptr+pattrib->hdrlen, mgmt_DATA, data_len); -+ /* remove the iv and icv length */ -+ pattrib->pkt_len = pattrib->pkt_len - pattrib->iv_len - pattrib->icv_len; -+ kfree(mgmt_DATA); -+ if (!precv_frame) { -+ DBG_871X("%s mgmt descrypt fail !!!!!!!!!\n", __func__); -+ goto validate_80211w_fail; -+ } -+ } else if (IS_MCAST(GetAddr1Ptr(ptr)) && -+ (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC)) { -+ sint BIP_ret = _SUCCESS; -+ /* verify BIP MME IE of broadcast/multicast de-auth/disassoc packet */ -+ BIP_ret = rtw_BIP_verify(adapter, (u8 *)precv_frame); -+ if (BIP_ret == _FAIL) { -+ /* DBG_871X("802.11w BIP verify fail\n"); */ -+ goto validate_80211w_fail; -+ } else if (BIP_ret == RTW_RX_HANDLED) { -+ /* DBG_871X("802.11w recv none protected packet\n"); */ -+ /* issue sa query request */ -+ issue_action_SA_Query(adapter, NULL, 0, 0); -+ goto validate_80211w_fail; -+ } -+ } else { /* 802.11w protect */ -+ if (subtype == WIFI_ACTION) { -+ /* according 802.11-2012 standard, these five types are not robust types */ -+ if (ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_PUBLIC && -+ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_HT && -+ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_UNPROTECTED_WNM && -+ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_SELF_PROTECTED && -+ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_P2P) { -+ DBG_871X("action frame category =%d should robust\n", ptr[WLAN_HDR_A3_LEN]); -+ goto validate_80211w_fail; -+ } -+ } else if (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC) { -+ DBG_871X("802.11w recv none protected packet\n"); -+ /* issue sa query request */ -+ issue_action_SA_Query(adapter, NULL, 0, 0); -+ goto validate_80211w_fail; -+ } -+ } -+ } -+ return _SUCCESS; -+ -+validate_80211w_fail: -+ return _FAIL; -+ -+} -+ -+static inline void dump_rx_packet(u8 *ptr) -+{ -+ int i; -+ -+ DBG_871X("#############################\n"); -+ for (i = 0; i < 64; i = i+8) -+ DBG_871X("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr+i), -+ *(ptr+i+1), *(ptr+i+2), *(ptr+i+3), *(ptr+i+4), *(ptr+i+5), *(ptr+i+6), *(ptr+i+7)); -+ DBG_871X("#############################\n"); -+} -+ -+sint validate_recv_frame(struct adapter *adapter, union recv_frame *precv_frame); -+sint validate_recv_frame(struct adapter *adapter, union recv_frame *precv_frame) -+{ -+ /* shall check frame subtype, to / from ds, da, bssid */ -+ -+ /* then call check if rx seq/frag. duplicated. */ -+ -+ u8 type; -+ u8 subtype; -+ sint retval = _SUCCESS; -+ -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ u8 ver = (unsigned char) (*ptr)&0x3; -+ -+ /* add version chk */ -+ if (ver != 0) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("validate_recv_data_frame fail! (ver!= 0)\n")); -+ retval = _FAIL; -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_ver_err); -+ goto exit; -+ } -+ -+ type = GetFrameType(ptr); -+ subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ -+ -+ pattrib->to_fr_ds = get_tofr_ds(ptr); -+ -+ pattrib->frag_num = GetFragNum(ptr); -+ pattrib->seq_num = GetSequence(ptr); -+ -+ pattrib->pw_save = GetPwrMgt(ptr); -+ pattrib->mfrag = GetMFrag(ptr); -+ pattrib->mdata = GetMData(ptr); -+ pattrib->privacy = GetPrivacy(ptr); -+ pattrib->order = GetOrder(ptr); -+{ -+ u8 bDumpRxPkt; -+ rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); -+ if (bDumpRxPkt == 1) /* dump all rx packets */ -+ dump_rx_packet(ptr); -+ else if ((bDumpRxPkt == 2) && (type == WIFI_MGT_TYPE)) -+ dump_rx_packet(ptr); -+ else if ((bDumpRxPkt == 3) && (type == WIFI_DATA_TYPE)) -+ dump_rx_packet(ptr); -+} -+ -+ switch (type) { -+ case WIFI_MGT_TYPE: /* mgnt */ -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt); -+ if (validate_80211w_mgmt(adapter, precv_frame) == _FAIL) { -+ retval = _FAIL; -+ DBG_COUNTER(padapter->rx_logs.core_rx_pre_mgmt_err_80211w); -+ break; -+ } -+ -+ retval = validate_recv_mgnt_frame(adapter, precv_frame); -+ if (retval == _FAIL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("validate_recv_mgnt_frame fail\n")); -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt_err); -+ } -+ retval = _FAIL; /* only data frame return _SUCCESS */ -+ break; -+ case WIFI_CTRL_TYPE: /* ctrl */ -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_ctrl); -+ retval = validate_recv_ctrl_frame(adapter, precv_frame); -+ if (retval == _FAIL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("validate_recv_ctrl_frame fail\n")); -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_ctrl_err); -+ } -+ retval = _FAIL; /* only data frame return _SUCCESS */ -+ break; -+ case WIFI_DATA_TYPE: /* data */ -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data); -+ -+ pattrib->qos = (subtype & BIT(7)) ? 1:0; -+ retval = validate_recv_data_frame(adapter, precv_frame); -+ if (retval == _FAIL) { -+ struct recv_priv *precvpriv = &adapter->recvpriv; -+ /* RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("validate_recv_data_frame fail\n")); */ -+ precvpriv->rx_drop++; -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_err); -+ } else if (retval == _SUCCESS) { -+#ifdef DBG_RX_DUMP_EAP -+ u8 bDumpRxPkt; -+ u16 eth_type; -+ -+ /* dump eapol */ -+ rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); -+ /* get ether_type */ -+ memcpy(ð_type, ptr + pattrib->hdrlen + pattrib->iv_len + LLC_HEADER_SIZE, 2); -+ eth_type = ntohs((unsigned short) eth_type); -+ if ((bDumpRxPkt == 4) && (eth_type == 0x888e)) -+ dump_rx_packet(ptr); -+#endif -+ } else -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_handled); -+ break; -+ default: -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_unknown); -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("validate_recv_data_frame fail! type = 0x%x\n", type)); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME validate_recv_data_frame fail! type = 0x%x\n", type); -+ #endif -+ retval = _FAIL; -+ break; -+ } -+ -+exit: -+ return retval; -+} -+ -+ -+/* remove the wlanhdr and add the eth_hdr */ -+sint wlanhdr_to_ethhdr(union recv_frame *precvframe); -+sint wlanhdr_to_ethhdr(union recv_frame *precvframe) -+{ -+ sint rmv_len; -+ u16 eth_type, len; -+ u8 bsnaphdr; -+ u8 *psnap_type; -+ struct ieee80211_snap_hdr *psnap; -+ __be16 be_tmp; -+ sint ret = _SUCCESS; -+ struct adapter *adapter = precvframe->u.hdr.adapter; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u8 *ptr = get_recvframe_data(precvframe) ; /* point to frame_ctrl field */ -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ -+ if (pattrib->encrypt) { -+ recvframe_pull_tail(precvframe, pattrib->icv_len); -+ } -+ -+ psnap = (struct ieee80211_snap_hdr *)(ptr+pattrib->hdrlen + pattrib->iv_len); -+ psnap_type = ptr+pattrib->hdrlen + pattrib->iv_len+SNAP_SIZE; -+ /* convert hdr + possible LLC headers into Ethernet header */ -+ /* eth_type = (psnap_type[0] << 8) | psnap_type[1]; */ -+ if ((!memcmp(psnap, rtw_rfc1042_header, SNAP_SIZE) && -+ (memcmp(psnap_type, SNAP_ETH_TYPE_IPX, 2)) && -+ (memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_AARP, 2))) || -+ /* eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) || */ -+ !memcmp(psnap, rtw_bridge_tunnel_header, SNAP_SIZE)) { -+ /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ -+ bsnaphdr = true; -+ } else -+ /* Leave Ethernet header part of hdr and full payload */ -+ bsnaphdr = false; -+ -+ rmv_len = pattrib->hdrlen + pattrib->iv_len + (bsnaphdr?SNAP_SIZE:0); -+ len = precvframe->u.hdr.len - rmv_len; -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("\n ===pattrib->hdrlen: %x, pattrib->iv_len:%x ===\n\n", pattrib->hdrlen, pattrib->iv_len)); -+ -+ memcpy(&be_tmp, ptr+rmv_len, 2); -+ eth_type = ntohs(be_tmp); /* pattrib->ether_type */ -+ pattrib->eth_type = eth_type; -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if (0x8899 == pattrib->eth_type) { -+ struct sta_info *psta = precvframe->u.hdr.psta; -+ -+ DBG_871X("wlan rx: got eth_type = 0x%x\n", pattrib->eth_type); -+ -+ if (psta && psta->isrc && psta->pid > 0) { -+ u16 rx_pid; -+ -+ rx_pid = *(u16 *)(ptr+rmv_len+2); -+ -+ DBG_871X("wlan rx(pid = 0x%x): sta("MAC_FMT") pid = 0x%x\n", -+ rx_pid, MAC_ARG(psta->hwaddr), psta->pid); -+ -+ if (rx_pid == psta->pid) { -+ int i; -+ u16 len = *(u16 *)(ptr+rmv_len+4); -+ /* u16 ctrl_type = *(u16*)(ptr+rmv_len+6); */ -+ -+ /* DBG_871X("RC: len = 0x%x, ctrl_type = 0x%x\n", len, ctrl_type); */ -+ DBG_871X("RC: len = 0x%x\n", len); -+ -+ for (i = 0; i < len ; i++) -+ DBG_871X("0x%x\n", *(ptr+rmv_len+6+i)); -+ /* DBG_871X("0x%x\n", *(ptr+rmv_len+8+i)); */ -+ -+ DBG_871X("RC-end\n"); -+ } -+ } -+ } -+#endif /* CONFIG_AUTO_AP_MODE */ -+ -+ if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == true)) { -+ ptr += rmv_len; -+ *ptr = 0x87; -+ *(ptr+1) = 0x12; -+ -+ eth_type = 0x8712; -+ /* append rx status for mp test packets */ -+ ptr = recvframe_pull(precvframe, (rmv_len-sizeof(struct ethhdr)+2)-24); -+ memcpy(ptr, get_rxmem(precvframe), 24); -+ ptr += 24; -+ } else -+ ptr = recvframe_pull(precvframe, (rmv_len-sizeof(struct ethhdr) + (bsnaphdr?2:0))); -+ -+ memcpy(ptr, pattrib->dst, ETH_ALEN); -+ memcpy(ptr+ETH_ALEN, pattrib->src, ETH_ALEN); -+ -+ if (!bsnaphdr) { -+ be_tmp = htons(len); -+ memcpy(ptr+12, &be_tmp, 2); -+ } -+ -+ return ret; -+} -+ -+/* perform defrag */ -+union recv_frame *recvframe_defrag(struct adapter *adapter, struct __queue *defrag_q) -+{ -+ struct list_head *plist, *phead; -+ u8 *data, wlanhdr_offset; -+ u8 curfragnum; -+ struct recv_frame_hdr *pfhdr, *pnfhdr; -+ union recv_frame *prframe, *pnextrframe; -+ struct __queue *pfree_recv_queue; -+ -+ curfragnum = 0; -+ pfree_recv_queue = &adapter->recvpriv.free_recv_queue; -+ -+ phead = get_list_head(defrag_q); -+ plist = get_next(phead); -+ prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pfhdr = &prframe->u.hdr; -+ list_del_init(&(prframe->u.list)); -+ -+ if (curfragnum != pfhdr->attrib.frag_num) { -+ /* the first fragment number must be 0 */ -+ /* free the whole queue */ -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); -+ -+ return NULL; -+ } -+ -+ curfragnum++; -+ -+ plist = get_list_head(defrag_q); -+ -+ plist = get_next(plist); -+ -+ data = get_recvframe_data(prframe); -+ -+ while (phead != plist) { -+ pnextrframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pnfhdr = &pnextrframe->u.hdr; -+ -+ -+ /* check the fragment sequence (2nd ~n fragment frame) */ -+ -+ if (curfragnum != pnfhdr->attrib.frag_num) { -+ /* the fragment number must be increasing (after decache) */ -+ /* release the defrag_q & prframe */ -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); -+ return NULL; -+ } -+ -+ curfragnum++; -+ -+ /* copy the 2nd~n fragment frame's payload to the first fragment */ -+ /* get the 2nd~last fragment frame's payload */ -+ -+ wlanhdr_offset = pnfhdr->attrib.hdrlen + pnfhdr->attrib.iv_len; -+ -+ recvframe_pull(pnextrframe, wlanhdr_offset); -+ -+ /* append to first fragment frame's tail (if privacy frame, pull the ICV) */ -+ recvframe_pull_tail(prframe, pfhdr->attrib.icv_len); -+ -+ /* memcpy */ -+ memcpy(pfhdr->rx_tail, pnfhdr->rx_data, pnfhdr->len); -+ -+ recvframe_put(prframe, pnfhdr->len); -+ -+ pfhdr->attrib.icv_len = pnfhdr->attrib.icv_len; -+ plist = get_next(plist); -+ -+ }; -+ -+ /* free the defrag_q queue and return the prframe */ -+ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("Performance defrag!!!!!\n")); -+ -+ return prframe; -+} -+ -+/* check if need to defrag, if needed queue the frame to defrag_q */ -+union recv_frame *recvframe_chk_defrag(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ u8 ismfrag; -+ u8 fragnum; -+ u8 *psta_addr; -+ struct recv_frame_hdr *pfhdr; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv; -+ struct list_head *phead; -+ union recv_frame *prtnframe = NULL; -+ struct __queue *pfree_recv_queue, *pdefrag_q; -+ -+ pstapriv = &padapter->stapriv; -+ -+ pfhdr = &precv_frame->u.hdr; -+ -+ pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+ /* need to define struct of wlan header frame ctrl */ -+ ismfrag = pfhdr->attrib.mfrag; -+ fragnum = pfhdr->attrib.frag_num; -+ -+ psta_addr = pfhdr->attrib.ta; -+ psta = rtw_get_stainfo(pstapriv, psta_addr); -+ if (psta == NULL) { -+ u8 type = GetFrameType(pfhdr->rx_data); -+ if (type != WIFI_DATA_TYPE) { -+ psta = rtw_get_bcmc_stainfo(padapter); -+ pdefrag_q = &psta->sta_recvpriv.defrag_q; -+ } else -+ pdefrag_q = NULL; -+ } else -+ pdefrag_q = &psta->sta_recvpriv.defrag_q; -+ -+ if ((ismfrag == 0) && (fragnum == 0)) -+ prtnframe = precv_frame;/* isn't a fragment frame */ -+ -+ if (ismfrag == 1) { -+ /* 0~(n-1) fragment frame */ -+ /* enqueue to defraf_g */ -+ if (pdefrag_q != NULL) { -+ if (fragnum == 0) -+ /* the first fragment */ -+ if (!list_empty(&pdefrag_q->queue)) -+ /* free current defrag_q */ -+ rtw_free_recvframe_queue(pdefrag_q, pfree_recv_queue); -+ -+ -+ /* Then enqueue the 0~(n-1) fragment into the defrag_q */ -+ -+ /* spin_lock(&pdefrag_q->lock); */ -+ phead = get_list_head(pdefrag_q); -+ list_add_tail(&pfhdr->list, phead); -+ /* spin_unlock(&pdefrag_q->lock); */ -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("Enqueuq: ismfrag = %d, fragnum = %d\n", ismfrag, fragnum)); -+ -+ prtnframe = NULL; -+ -+ } else{ -+ /* can't find this ta's defrag_queue, so free this recv_frame */ -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ prtnframe = NULL; -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("Free because pdefrag_q == NULL: ismfrag = %d, fragnum = %d\n", ismfrag, fragnum)); -+ } -+ -+ } -+ -+ if ((ismfrag == 0) && (fragnum != 0)) { -+ /* the last fragment frame */ -+ /* enqueue the last fragment */ -+ if (pdefrag_q != NULL) { -+ /* spin_lock(&pdefrag_q->lock); */ -+ phead = get_list_head(pdefrag_q); -+ list_add_tail(&pfhdr->list, phead); -+ /* spin_unlock(&pdefrag_q->lock); */ -+ -+ /* call recvframe_defrag to defrag */ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("defrag: ismfrag = %d, fragnum = %d\n", ismfrag, fragnum)); -+ precv_frame = recvframe_defrag(padapter, pdefrag_q); -+ prtnframe = precv_frame; -+ -+ } else{ -+ /* can't find this ta's defrag_queue, so free this recv_frame */ -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ prtnframe = NULL; -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("Free because pdefrag_q == NULL: ismfrag = %d, fragnum = %d\n", ismfrag, fragnum)); -+ } -+ -+ } -+ -+ -+ if ((prtnframe != NULL) && (prtnframe->u.hdr.attrib.privacy)) { -+ /* after defrag we must check tkip mic code */ -+ if (recvframe_chkmic(padapter, prtnframe) == _FAIL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("recvframe_chkmic(padapter, prtnframe) == _FAIL\n")); -+ rtw_free_recvframe(prtnframe, pfree_recv_queue); -+ prtnframe = NULL; -+ } -+ } -+ return prtnframe; -+} -+ -+static int amsdu_to_msdu(struct adapter *padapter, union recv_frame *prframe) -+{ -+ int a_len, padding_len; -+ u16 nSubframe_Length; -+ u8 nr_subframes, i; -+ u8 *pdata; -+ _pkt *sub_pkt, *subframes[MAX_SUBFRAME_COUNT]; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct __queue *pfree_recv_queue = &(precvpriv->free_recv_queue); -+ int ret = _SUCCESS; -+ -+ nr_subframes = 0; -+ -+ recvframe_pull(prframe, prframe->u.hdr.attrib.hdrlen); -+ -+ if (prframe->u.hdr.attrib.iv_len > 0) -+ recvframe_pull(prframe, prframe->u.hdr.attrib.iv_len); -+ -+ a_len = prframe->u.hdr.len; -+ -+ pdata = prframe->u.hdr.rx_data; -+ -+ while (a_len > ETH_HLEN) { -+ -+ /* Offset 12 denote 2 mac address */ -+ nSubframe_Length = RTW_GET_BE16(pdata + 12); -+ -+ if (a_len < (ETHERNET_HEADER_SIZE + nSubframe_Length)) { -+ DBG_871X("nRemain_Length is %d and nSubframe_Length is : %d\n", a_len, nSubframe_Length); -+ break; -+ } -+ -+ sub_pkt = rtw_os_alloc_msdu_pkt(prframe, nSubframe_Length, pdata); -+ if (sub_pkt == NULL) { -+ DBG_871X("%s(): allocate sub packet fail !!!\n", __func__); -+ break; -+ } -+ -+ /* move the data point to data content */ -+ pdata += ETH_HLEN; -+ a_len -= ETH_HLEN; -+ -+ subframes[nr_subframes++] = sub_pkt; -+ -+ if (nr_subframes >= MAX_SUBFRAME_COUNT) { -+ DBG_871X("ParseSubframe(): Too many Subframes! Packets dropped!\n"); -+ break; -+ } -+ -+ pdata += nSubframe_Length; -+ a_len -= nSubframe_Length; -+ if (a_len != 0) { -+ padding_len = 4 - ((nSubframe_Length + ETH_HLEN) & (4-1)); -+ if (padding_len == 4) { -+ padding_len = 0; -+ } -+ -+ if (a_len < padding_len) { -+ DBG_871X("ParseSubframe(): a_len < padding_len !\n"); -+ break; -+ } -+ pdata += padding_len; -+ a_len -= padding_len; -+ } -+ } -+ -+ for (i = 0; i < nr_subframes; i++) { -+ sub_pkt = subframes[i]; -+ -+ /* Indicat the packets to upper layer */ -+ if (sub_pkt) { -+ rtw_os_recv_indicate_pkt(padapter, sub_pkt, &prframe->u.hdr.attrib); -+ } -+ } -+ -+ prframe->u.hdr.len = 0; -+ rtw_free_recvframe(prframe, pfree_recv_queue);/* free this recv_frame */ -+ -+ return ret; -+} -+ -+int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num); -+int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num) -+{ -+ struct adapter *padapter = preorder_ctrl->padapter; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ u8 wsize = preorder_ctrl->wsize_b; -+ u16 wend = (preorder_ctrl->indicate_seq + wsize - 1) & 0xFFF;/* 4096; */ -+ -+ /* Rx Reorder initialize condition. */ -+ if (preorder_ctrl->indicate_seq == 0xFFFF) { -+ preorder_ctrl->indicate_seq = seq_num; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d init IndicateSeq: %d, NewSeq: %d\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq, seq_num); -+ #endif -+ -+ /* DbgPrint("check_indicate_seq, 1st->indicate_seq =%d\n", precvpriv->indicate_seq); */ -+ } -+ -+ /* DbgPrint("enter->check_indicate_seq(): IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ -+ -+ /* Drop out the packet which SeqNum is smaller than WinStart */ -+ if (SN_LESS(seq_num, preorder_ctrl->indicate_seq)) { -+ /* RT_TRACE(COMP_RX_REORDER, DBG_LOUD, ("CheckRxTsIndicateSeq(): Packet Drop! IndicateSeq: %d, NewSeq: %d\n", pTS->RxIndicateSeq, NewSeqNum)); */ -+ /* DbgPrint("CheckRxTsIndicateSeq(): Packet Drop! IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ -+ -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("%s IndicateSeq: %d > NewSeq: %d\n", __func__, -+ preorder_ctrl->indicate_seq, seq_num); -+ #endif -+ -+ -+ return false; -+ } -+ -+ /* */ -+ /* Sliding window manipulation. Conditions includes: */ -+ /* 1. Incoming SeqNum is equal to WinStart =>Window shift 1 */ -+ /* 2. Incoming SeqNum is larger than the WinEnd => Window shift N */ -+ /* */ -+ if (SN_EQUAL(seq_num, preorder_ctrl->indicate_seq)) { -+ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) & 0xFFF; -+ -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d SN_EQUAL IndicateSeq: %d, NewSeq: %d\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq, seq_num); -+ #endif -+ } else if (SN_LESS(wend, seq_num)) { -+ /* RT_TRACE(COMP_RX_REORDER, DBG_LOUD, ("CheckRxTsIndicateSeq(): Window Shift! IndicateSeq: %d, NewSeq: %d\n", pTS->RxIndicateSeq, NewSeqNum)); */ -+ /* DbgPrint("CheckRxTsIndicateSeq(): Window Shift! IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ -+ -+ /* boundary situation, when seq_num cross 0xFFF */ -+ if (seq_num >= (wsize - 1)) -+ preorder_ctrl->indicate_seq = seq_num + 1 - wsize; -+ else -+ preorder_ctrl->indicate_seq = 0xFFF - (wsize - (seq_num + 1)) + 1; -+ pdbgpriv->dbg_rx_ampdu_window_shift_cnt++; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d SN_LESS(wend, seq_num) IndicateSeq: %d, NewSeq: %d\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq, seq_num); -+ #endif -+ } -+ -+ /* DbgPrint("exit->check_indicate_seq(): IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ -+ -+ return true; -+} -+ -+int enqueue_reorder_recvframe(struct recv_reorder_ctrl *preorder_ctrl, union recv_frame *prframe); -+int enqueue_reorder_recvframe(struct recv_reorder_ctrl *preorder_ctrl, union recv_frame *prframe) -+{ -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ struct __queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ struct list_head *phead, *plist; -+ union recv_frame *pnextrframe; -+ struct rx_pkt_attrib *pnextattrib; -+ -+ /* DbgPrint("+enqueue_reorder_recvframe()\n"); */ -+ -+ /* spin_lock_irqsave(&ppending_recvframe_queue->lock, irql); */ -+ /* spin_lock(&ppending_recvframe_queue->lock); */ -+ -+ -+ phead = get_list_head(ppending_recvframe_queue); -+ plist = get_next(phead); -+ -+ while (phead != plist) { -+ pnextrframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pnextattrib = &pnextrframe->u.hdr.attrib; -+ -+ if (SN_LESS(pnextattrib->seq_num, pattrib->seq_num)) -+ plist = get_next(plist); -+ else if (SN_EQUAL(pnextattrib->seq_num, pattrib->seq_num)) -+ /* Duplicate entry is found!! Do not insert current entry. */ -+ /* RT_TRACE(COMP_RX_REORDER, DBG_TRACE, ("InsertRxReorderList(): Duplicate packet is dropped!! IndicateSeq: %d, NewSeq: %d\n", pTS->RxIndicateSeq, SeqNum)); */ -+ /* spin_unlock_irqrestore(&ppending_recvframe_queue->lock, irql); */ -+ return false; -+ else -+ break; -+ -+ /* DbgPrint("enqueue_reorder_recvframe():while\n"); */ -+ -+ } -+ -+ -+ /* spin_lock_irqsave(&ppending_recvframe_queue->lock, irql); */ -+ /* spin_lock(&ppending_recvframe_queue->lock); */ -+ -+ list_del_init(&(prframe->u.hdr.list)); -+ -+ list_add_tail(&(prframe->u.hdr.list), plist); -+ -+ /* spin_unlock(&ppending_recvframe_queue->lock); */ -+ /* spin_unlock_irqrestore(&ppending_recvframe_queue->lock, irql); */ -+ -+ -+ /* RT_TRACE(COMP_RX_REORDER, DBG_TRACE, ("InsertRxReorderList(): Pkt insert into buffer!! IndicateSeq: %d, NewSeq: %d\n", pTS->RxIndicateSeq, SeqNum)); */ -+ return true; -+ -+} -+ -+void recv_indicatepkts_pkt_loss_cnt(struct debug_priv *pdbgpriv, u64 prev_seq, u64 current_seq); -+void recv_indicatepkts_pkt_loss_cnt(struct debug_priv *pdbgpriv, u64 prev_seq, u64 current_seq) -+{ -+ if (current_seq < prev_seq) -+ pdbgpriv->dbg_rx_ampdu_loss_count += (4096 + current_seq - prev_seq); -+ else -+ pdbgpriv->dbg_rx_ampdu_loss_count += (current_seq - prev_seq); -+ -+} -+int recv_indicatepkts_in_order(struct adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced); -+int recv_indicatepkts_in_order(struct adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced) -+{ -+ struct list_head *phead, *plist; -+ union recv_frame *prframe; -+ struct rx_pkt_attrib *pattrib; -+ /* u8 index = 0; */ -+ int bPktInBuf = false; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct __queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_in_oder); -+ -+ /* DbgPrint("+recv_indicatepkts_in_order\n"); */ -+ -+ /* spin_lock_irqsave(&ppending_recvframe_queue->lock, irql); */ -+ /* spin_lock(&ppending_recvframe_queue->lock); */ -+ -+ phead = get_list_head(ppending_recvframe_queue); -+ plist = get_next(phead); -+ -+ /* Handling some condition for forced indicate case. */ -+ if (bforced == true) { -+ pdbgpriv->dbg_rx_ampdu_forced_indicate_count++; -+ if (list_empty(phead)) { -+ /* spin_unlock_irqrestore(&ppending_recvframe_queue->lock, irql); */ -+ /* spin_unlock(&ppending_recvframe_queue->lock); */ -+ return true; -+ } -+ -+ prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pattrib = &prframe->u.hdr.attrib; -+ -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+ #endif -+ recv_indicatepkts_pkt_loss_cnt(pdbgpriv, preorder_ctrl->indicate_seq, pattrib->seq_num); -+ preorder_ctrl->indicate_seq = pattrib->seq_num; -+ -+ } -+ -+ /* Prepare indication list and indication. */ -+ /* Check if there is any packet need indicate. */ -+ while (!list_empty(phead)) { -+ -+ prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pattrib = &prframe->u.hdr.attrib; -+ -+ if (!SN_LESS(preorder_ctrl->indicate_seq, pattrib->seq_num)) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, -+ ("recv_indicatepkts_in_order: indicate =%d seq =%d amsdu =%d\n", -+ preorder_ctrl->indicate_seq, pattrib->seq_num, pattrib->amsdu)); -+ -+ plist = get_next(plist); -+ list_del_init(&(prframe->u.hdr.list)); -+ -+ if (SN_EQUAL(preorder_ctrl->indicate_seq, pattrib->seq_num)) { -+ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) & 0xFFF; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+ #endif -+ } -+ -+ /* Set this as a lock to make sure that only one thread is indicating packet. */ -+ /* pTS->RxIndicateState = RXTS_INDICATE_PROCESSING; */ -+ -+ /* Indicate packets */ -+ /* RT_ASSERT((index<=REORDER_WIN_SIZE), ("RxReorderIndicatePacket(): Rx Reorder buffer full!!\n")); */ -+ -+ -+ /* indicate this recv_frame */ -+ /* DbgPrint("recv_indicatepkts_in_order, indicate_seq =%d, seq_num =%d\n", precvpriv->indicate_seq, pattrib->seq_num); */ -+ if (!pattrib->amsdu) { -+ /* DBG_871X("recv_indicatepkts_in_order, amsdu!= 1, indicate_seq =%d, seq_num =%d\n", preorder_ctrl->indicate_seq, pattrib->seq_num); */ -+ -+ if ((padapter->bDriverStopped == false) && -+ (padapter->bSurpriseRemoved == false)) -+ rtw_recv_indicatepkt(padapter, prframe);/* indicate this recv_frame */ -+ -+ } else if (pattrib->amsdu == 1) { -+ if (amsdu_to_msdu(padapter, prframe) != _SUCCESS) -+ rtw_free_recvframe(prframe, &precvpriv->free_recv_queue); -+ -+ } else{ -+ /* error condition; */ -+ } -+ -+ -+ /* Update local variables. */ -+ bPktInBuf = false; -+ -+ } else{ -+ bPktInBuf = true; -+ break; -+ } -+ -+ /* DbgPrint("recv_indicatepkts_in_order():while\n"); */ -+ -+ } -+ -+ /* spin_unlock(&ppending_recvframe_queue->lock); */ -+ /* spin_unlock_irqrestore(&ppending_recvframe_queue->lock, irql); */ -+ -+ return bPktInBuf; -+} -+ -+int recv_indicatepkt_reorder(struct adapter *padapter, union recv_frame *prframe); -+int recv_indicatepkt_reorder(struct adapter *padapter, union recv_frame *prframe) -+{ -+ int retval = _SUCCESS; -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ struct recv_reorder_ctrl *preorder_ctrl = prframe->u.hdr.preorder_ctrl; -+ struct __queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_reoder); -+ -+ if (!pattrib->amsdu) { -+ /* s1. */ -+ wlanhdr_to_ethhdr(prframe); -+ -+ if (pattrib->qos != 1) { -+ if ((padapter->bDriverStopped == false) && -+ (padapter->bSurpriseRemoved == false)) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("@@@@ recv_indicatepkt_reorder -recv_func recv_indicatepkt\n")); -+ -+ rtw_recv_indicatepkt(padapter, prframe); -+ return _SUCCESS; -+ -+ } -+ -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s pattrib->qos != 1\n", __func__); -+ #endif -+ -+ return _FAIL; -+ -+ } -+ -+ if (preorder_ctrl->enable == false) { -+ /* indicate this recv_frame */ -+ preorder_ctrl->indicate_seq = pattrib->seq_num; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+ #endif -+ -+ rtw_recv_indicatepkt(padapter, prframe); -+ -+ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1)%4096; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+ #endif -+ -+ return _SUCCESS; -+ } -+ } else if (pattrib->amsdu == 1) { /* temp filter -> means didn't support A-MSDUs in a A-MPDU */ -+ if (preorder_ctrl->enable == false) { -+ preorder_ctrl->indicate_seq = pattrib->seq_num; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+ #endif -+ -+ retval = amsdu_to_msdu(padapter, prframe); -+ -+ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1)%4096; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+ #endif -+ -+ if (retval != _SUCCESS) { -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s amsdu_to_msdu fail\n", __func__); -+ #endif -+ } -+ -+ return retval; -+ } -+ } -+ -+ spin_lock_bh(&ppending_recvframe_queue->lock); -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, -+ ("recv_indicatepkt_reorder: indicate =%d seq =%d\n", -+ preorder_ctrl->indicate_seq, pattrib->seq_num)); -+ -+ /* s2. check if winstart_b(indicate_seq) needs to been updated */ -+ if (!check_indicate_seq(preorder_ctrl, pattrib->seq_num)) { -+ pdbgpriv->dbg_rx_ampdu_drop_count++; -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s check_indicate_seq fail\n", __func__); -+ #endif -+ goto _err_exit; -+ } -+ -+ -+ /* s3. Insert all packet into Reorder Queue to maintain its ordering. */ -+ if (!enqueue_reorder_recvframe(preorder_ctrl, prframe)) { -+ /* DbgPrint("recv_indicatepkt_reorder, enqueue_reorder_recvframe fail!\n"); */ -+ /* spin_unlock_irqrestore(&ppending_recvframe_queue->lock, irql); */ -+ /* return _FAIL; */ -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s enqueue_reorder_recvframe fail\n", __func__); -+ #endif -+ goto _err_exit; -+ } -+ -+ -+ /* s4. */ -+ /* Indication process. */ -+ /* After Packet dropping and Sliding Window shifting as above, we can now just indicate the packets */ -+ /* with the SeqNum smaller than latest WinStart and buffer other packets. */ -+ /* */ -+ /* For Rx Reorder condition: */ -+ /* 1. All packets with SeqNum smaller than WinStart => Indicate */ -+ /* 2. All packets with SeqNum larger than or equal to WinStart => Buffer it. */ -+ /* */ -+ -+ /* recv_indicatepkts_in_order(padapter, preorder_ctrl, true); */ -+ if (recv_indicatepkts_in_order(padapter, preorder_ctrl, false) == true) { -+ _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); -+ spin_unlock_bh(&ppending_recvframe_queue->lock); -+ } else{ -+ spin_unlock_bh(&ppending_recvframe_queue->lock); -+ del_timer_sync(&preorder_ctrl->reordering_ctrl_timer); -+ } -+ -+ return _SUCCESS; -+ -+_err_exit: -+ spin_unlock_bh(&ppending_recvframe_queue->lock); -+ -+ return _FAIL; -+} -+ -+ -+void rtw_reordering_ctrl_timeout_handler(void *pcontext) -+{ -+ struct recv_reorder_ctrl *preorder_ctrl = (struct recv_reorder_ctrl *)pcontext; -+ struct adapter *padapter = preorder_ctrl->padapter; -+ struct __queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ -+ -+ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) -+ return; -+ -+ /* DBG_871X("+rtw_reordering_ctrl_timeout_handler() =>\n"); */ -+ -+ spin_lock_bh(&ppending_recvframe_queue->lock); -+ -+ if (recv_indicatepkts_in_order(padapter, preorder_ctrl, true) == true) -+ _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); -+ -+ spin_unlock_bh(&ppending_recvframe_queue->lock); -+ -+} -+ -+int process_recv_indicatepkts(struct adapter *padapter, union recv_frame *prframe); -+int process_recv_indicatepkts(struct adapter *padapter, union recv_frame *prframe) -+{ -+ int retval = _SUCCESS; -+ /* struct recv_priv *precvpriv = &padapter->recvpriv; */ -+ /* struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; */ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate); -+ -+ if (phtpriv->ht_option == true) { /* B/G/N Mode */ -+ /* prframe->u.hdr.preorder_ctrl = &precvpriv->recvreorder_ctrl[pattrib->priority]; */ -+ -+ if (recv_indicatepkt_reorder(padapter, prframe) != _SUCCESS) { /* including perform A-MPDU Rx Ordering Buffer Control */ -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s recv_indicatepkt_reorder error!\n", __func__); -+ #endif -+ -+ if ((padapter->bDriverStopped == false) && -+ (padapter->bSurpriseRemoved == false)) { -+ retval = _FAIL; -+ return retval; -+ } -+ } -+ } else { /* B/G mode */ -+ retval = wlanhdr_to_ethhdr(prframe); -+ if (retval != _SUCCESS) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("wlanhdr_to_ethhdr: drop pkt\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr error!\n", __func__); -+ #endif -+ return retval; -+ } -+ -+ if ((padapter->bDriverStopped == false) && (padapter->bSurpriseRemoved == false)) { -+ /* indicate this recv_frame */ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("@@@@ process_recv_indicatepkts- recv_func recv_indicatepkt\n")); -+ rtw_recv_indicatepkt(padapter, prframe); -+ -+ -+ } else{ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("@@@@ process_recv_indicatepkts- recv_func free_indicatepkt\n")); -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("recv_func:bDriverStopped(%d) OR bSurpriseRemoved(%d)", padapter->bDriverStopped, padapter->bSurpriseRemoved)); -+ retval = _FAIL; -+ return retval; -+ } -+ -+ } -+ -+ return retval; -+ -+} -+ -+static int recv_func_prehandle(struct adapter *padapter, union recv_frame *rframe) -+{ -+ int ret = _SUCCESS; -+ struct __queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_pre); -+ -+ /* check the frame crtl field and decache */ -+ ret = validate_recv_frame(padapter, rframe); -+ if (ret != _SUCCESS) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("recv_func: validate_recv_frame fail! drop pkt\n")); -+ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+static int recv_func_posthandle(struct adapter *padapter, union recv_frame *prframe) -+{ -+ int ret = _SUCCESS; -+ union recv_frame *orig_prframe = prframe; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct __queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post); -+ -+ prframe = decryptor(padapter, prframe); -+ if (prframe == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("decryptor: drop pkt\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s decryptor: drop pkt\n", __func__); -+ #endif -+ ret = _FAIL; -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_err); -+ goto _recv_data_drop; -+ } -+ -+ prframe = recvframe_chk_defrag(padapter, prframe); -+ if (prframe == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("recvframe_chk_defrag: drop pkt\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s recvframe_chk_defrag: drop pkt\n", __func__); -+ #endif -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_defrag_err); -+ goto _recv_data_drop; -+ } -+ -+ prframe = portctrl(padapter, prframe); -+ if (prframe == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("portctrl: drop pkt\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s portctrl: drop pkt\n", __func__); -+ #endif -+ ret = _FAIL; -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_portctrl_err); -+ goto _recv_data_drop; -+ } -+ -+ count_rx_stats(padapter, prframe, NULL); -+ -+ ret = process_recv_indicatepkts(padapter, prframe); -+ if (ret != _SUCCESS) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("recv_func: process_recv_indicatepkts fail!\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s process_recv_indicatepkts fail!\n", __func__); -+ #endif -+ rtw_free_recvframe(orig_prframe, pfree_recv_queue);/* free this recv_frame */ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_err); -+ goto _recv_data_drop; -+ } -+ -+_recv_data_drop: -+ precvpriv->rx_drop++; -+ return ret; -+} -+ -+ -+int recv_func(struct adapter *padapter, union recv_frame *rframe); -+int recv_func(struct adapter *padapter, union recv_frame *rframe) -+{ -+ int ret; -+ struct rx_pkt_attrib *prxattrib = &rframe->u.hdr.attrib; -+ struct recv_priv *recvpriv = &padapter->recvpriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ -+ /* check if need to handle uc_swdec_pending_queue*/ -+ if (check_fwstate(mlmepriv, WIFI_STATION_STATE) && psecuritypriv->busetkipkey) { -+ union recv_frame *pending_frame; -+ int cnt = 0; -+ -+ while ((pending_frame = rtw_alloc_recvframe(&padapter->recvpriv.uc_swdec_pending_queue))) { -+ cnt++; -+ DBG_COUNTER(padapter->rx_logs.core_rx_dequeue); -+ recv_func_posthandle(padapter, pending_frame); -+ } -+ -+ if (cnt) -+ DBG_871X(FUNC_ADPT_FMT" dequeue %d from uc_swdec_pending_queue\n", -+ FUNC_ADPT_ARG(padapter), cnt); -+ } -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx); -+ ret = recv_func_prehandle(padapter, rframe); -+ -+ if (ret == _SUCCESS) { -+ -+ /* check if need to enqueue into uc_swdec_pending_queue*/ -+ if (check_fwstate(mlmepriv, WIFI_STATION_STATE) && -+ !IS_MCAST(prxattrib->ra) && prxattrib->encrypt > 0 && -+ (prxattrib->bdecrypted == 0 || psecuritypriv->sw_decrypt == true) && -+ psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPAPSK && -+ !psecuritypriv->busetkipkey) { -+ DBG_COUNTER(padapter->rx_logs.core_rx_enqueue); -+ rtw_enqueue_recvframe(rframe, &padapter->recvpriv.uc_swdec_pending_queue); -+ /* DBG_871X("%s: no key, enqueue uc_swdec_pending_queue\n", __func__); */ -+ -+ if (recvpriv->free_recvframe_cnt < NR_RECVFRAME/4) { -+ /* to prevent from recvframe starvation, get recvframe from uc_swdec_pending_queue to free_recvframe_cnt */ -+ rframe = rtw_alloc_recvframe(&padapter->recvpriv.uc_swdec_pending_queue); -+ if (rframe) -+ goto do_posthandle; -+ } -+ goto exit; -+ } -+ -+do_posthandle: -+ ret = recv_func_posthandle(padapter, rframe); -+ } -+ -+exit: -+ return ret; -+} -+ -+ -+s32 rtw_recv_entry(union recv_frame *precvframe) -+{ -+ struct adapter *padapter; -+ struct recv_priv *precvpriv; -+ s32 ret = _SUCCESS; -+ -+/* RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("+rtw_recv_entry\n")); */ -+ -+ padapter = precvframe->u.hdr.adapter; -+ -+ precvpriv = &padapter->recvpriv; -+ -+ ret = recv_func(padapter, precvframe); -+ if (ret == _FAIL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("rtw_recv_entry: recv_func return fail!!!\n")); -+ goto _recv_entry_drop; -+ } -+ -+ -+ precvpriv->rx_pkts++; -+ -+ return ret; -+ -+_recv_entry_drop: -+ -+ /* RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("_recv_entry_drop\n")); */ -+ -+ return ret; -+} -+ -+void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS) -+{ -+ struct adapter *adapter = (struct adapter *)FunctionContext; -+ struct recv_priv *recvpriv = &adapter->recvpriv; -+ -+ u32 tmp_s, tmp_q; -+ u8 avg_signal_strength = 0; -+ u8 avg_signal_qual = 0; -+ u32 num_signal_strength = 0; -+ u32 num_signal_qual = 0; -+ u8 _alpha = 5; /* this value is based on converging_constant = 5000 and sampling_interval = 1000 */ -+ -+ if (adapter->recvpriv.is_signal_dbg) { -+ /* update the user specific value, signal_strength_dbg, to signal_strength, rssi */ -+ adapter->recvpriv.signal_strength = adapter->recvpriv.signal_strength_dbg; -+ adapter->recvpriv.rssi = (s8)translate_percentage_to_dbm((u8)adapter->recvpriv.signal_strength_dbg); -+ } else { -+ -+ if (recvpriv->signal_strength_data.update_req == 0) {/* update_req is clear, means we got rx */ -+ avg_signal_strength = recvpriv->signal_strength_data.avg_val; -+ num_signal_strength = recvpriv->signal_strength_data.total_num; -+ /* after avg_vals are accquired, we can re-stat the signal values */ -+ recvpriv->signal_strength_data.update_req = 1; -+ } -+ -+ if (recvpriv->signal_qual_data.update_req == 0) {/* update_req is clear, means we got rx */ -+ avg_signal_qual = recvpriv->signal_qual_data.avg_val; -+ num_signal_qual = recvpriv->signal_qual_data.total_num; -+ /* after avg_vals are accquired, we can re-stat the signal values */ -+ recvpriv->signal_qual_data.update_req = 1; -+ } -+ -+ if (num_signal_strength == 0) { -+ if (rtw_get_on_cur_ch_time(adapter) == 0 -+ || jiffies_to_msecs(jiffies - rtw_get_on_cur_ch_time(adapter)) < 2 * adapter->mlmeextpriv.mlmext_info.bcn_interval -+ ) { -+ goto set_timer; -+ } -+ } -+ -+ if (check_fwstate(&adapter->mlmepriv, _FW_UNDER_SURVEY) == true -+ || check_fwstate(&adapter->mlmepriv, _FW_LINKED) == false -+ ) { -+ goto set_timer; -+ } -+ -+ /* update value of signal_strength, rssi, signal_qual */ -+ tmp_s = (avg_signal_strength+(_alpha-1)*recvpriv->signal_strength); -+ if (tmp_s % _alpha) -+ tmp_s = tmp_s/_alpha + 1; -+ else -+ tmp_s = tmp_s/_alpha; -+ if (tmp_s > 100) -+ tmp_s = 100; -+ -+ tmp_q = (avg_signal_qual+(_alpha-1)*recvpriv->signal_qual); -+ if (tmp_q % _alpha) -+ tmp_q = tmp_q/_alpha + 1; -+ else -+ tmp_q = tmp_q/_alpha; -+ if (tmp_q > 100) -+ tmp_q = 100; -+ -+ recvpriv->signal_strength = tmp_s; -+ recvpriv->rssi = (s8)translate_percentage_to_dbm(tmp_s); -+ recvpriv->signal_qual = tmp_q; -+ -+ #if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 -+ DBG_871X(FUNC_ADPT_FMT" signal_strength:%3u, rssi:%3d, signal_qual:%3u" -+ ", num_signal_strength:%u, num_signal_qual:%u" -+ ", on_cur_ch_ms:%d" -+ "\n" -+ , FUNC_ADPT_ARG(adapter) -+ , recvpriv->signal_strength -+ , recvpriv->rssi -+ , recvpriv->signal_qual -+ , num_signal_strength, num_signal_qual -+ , rtw_get_on_cur_ch_time(adapter) ? jiffies_to_msecs(jiffies - rtw_get_on_cur_ch_time(adapter)) : 0 -+ ); -+ #endif -+ } -+ -+set_timer: -+ rtw_set_signal_stat_timer(recvpriv); -+ -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_rf.c linux/3rdparty/rtl8723bs/core/rtw_rf.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_rf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_rf.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,64 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_RF_C_ -+ -+#include -+ -+ -+struct ch_freq { -+ u32 channel; -+ u32 frequency; -+}; -+ -+static struct ch_freq ch_freq_map[] = { -+ {1, 2412}, {2, 2417}, {3, 2422}, {4, 2427}, {5, 2432}, -+ {6, 2437}, {7, 2442}, {8, 2447}, {9, 2452}, {10, 2457}, -+ {11, 2462}, {12, 2467}, {13, 2472}, {14, 2484}, -+ /* UNII */ -+ {36, 5180}, {40, 5200}, {44, 5220}, {48, 5240}, {52, 5260}, -+ {56, 5280}, {60, 5300}, {64, 5320}, {149, 5745}, {153, 5765}, -+ {157, 5785}, {161, 5805}, {165, 5825}, {167, 5835}, {169, 5845}, -+ {171, 5855}, {173, 5865}, -+ /* HiperLAN2 */ -+ {100, 5500}, {104, 5520}, {108, 5540}, {112, 5560}, {116, 5580}, -+ {120, 5600}, {124, 5620}, {128, 5640}, {132, 5660}, {136, 5680}, -+ {140, 5700}, -+ /* Japan MMAC */ -+ {34, 5170}, {38, 5190}, {42, 5210}, {46, 5230}, -+ /* Japan */ -+ {184, 4920}, {188, 4940}, {192, 4960}, {196, 4980}, -+ {208, 5040},/* Japan, means J08 */ -+ {212, 5060},/* Japan, means J12 */ -+ {216, 5080},/* Japan, means J16 */ -+}; -+ -+static int ch_freq_map_num = (sizeof(ch_freq_map) / sizeof(struct ch_freq)); -+ -+u32 rtw_ch2freq(u32 channel) -+{ -+ u8 i; -+ u32 freq = 0; -+ -+ for (i = 0; i < ch_freq_map_num; i++) { -+ if (channel == ch_freq_map[i].channel) { -+ freq = ch_freq_map[i].frequency; -+ break; -+ } -+ } -+ if (i == ch_freq_map_num) -+ freq = 2412; -+ -+ return freq; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_security.c linux/3rdparty/rtl8723bs/core/rtw_security.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_security.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_security.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,2448 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_SECURITY_C_ -+ -+#include -+#include -+ -+static const char *_security_type_str[] = { -+ "N/A", -+ "WEP40", -+ "TKIP", -+ "TKIP_WM", -+ "AES", -+ "WEP104", -+ "SMS4", -+ "WEP_WPA", -+ "BIP", -+}; -+ -+const char *security_type_str(u8 value) -+{ -+ if (value <= _BIP_) -+ return _security_type_str[value]; -+ return NULL; -+} -+ -+#ifdef DBG_SW_SEC_CNT -+#define WEP_SW_ENC_CNT_INC(sec, ra) \ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->wep_sw_enc_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->wep_sw_enc_cnt_mc++; \ -+ else \ -+ sec->wep_sw_enc_cnt_uc++; -+ -+#define WEP_SW_DEC_CNT_INC(sec, ra) \ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->wep_sw_dec_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->wep_sw_dec_cnt_mc++; \ -+ else \ -+ sec->wep_sw_dec_cnt_uc++; -+ -+#define TKIP_SW_ENC_CNT_INC(sec, ra) \ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->tkip_sw_enc_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->tkip_sw_enc_cnt_mc++; \ -+ else \ -+ sec->tkip_sw_enc_cnt_uc++; -+ -+#define TKIP_SW_DEC_CNT_INC(sec, ra) \ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->tkip_sw_dec_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->tkip_sw_dec_cnt_mc++; \ -+ else \ -+ sec->tkip_sw_dec_cnt_uc++; -+ -+#define AES_SW_ENC_CNT_INC(sec, ra) \ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->aes_sw_enc_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->aes_sw_enc_cnt_mc++; \ -+ else \ -+ sec->aes_sw_enc_cnt_uc++; -+ -+#define AES_SW_DEC_CNT_INC(sec, ra) \ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->aes_sw_dec_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->aes_sw_dec_cnt_mc++; \ -+ else \ -+ sec->aes_sw_dec_cnt_uc++; -+#else -+#define WEP_SW_ENC_CNT_INC(sec, ra) -+#define WEP_SW_DEC_CNT_INC(sec, ra) -+#define TKIP_SW_ENC_CNT_INC(sec, ra) -+#define TKIP_SW_DEC_CNT_INC(sec, ra) -+#define AES_SW_ENC_CNT_INC(sec, ra) -+#define AES_SW_DEC_CNT_INC(sec, ra) -+#endif /* DBG_SW_SEC_CNT */ -+ -+/* WEP related ===== */ -+ -+#define CRC32_POLY 0x04c11db7 -+ -+struct arc4context { -+ u32 x; -+ u32 y; -+ u8 state[256]; -+}; -+ -+ -+static void arcfour_init(struct arc4context *parc4ctx, u8 *key, u32 key_len) -+{ -+ u32 t, u; -+ u32 keyindex; -+ u32 stateindex; -+ u8 *state; -+ u32 counter; -+ -+ state = parc4ctx->state; -+ parc4ctx->x = 0; -+ parc4ctx->y = 0; -+ for (counter = 0; counter < 256; counter++) -+ state[counter] = (u8)counter; -+ keyindex = 0; -+ stateindex = 0; -+ for (counter = 0; counter < 256; counter++) { -+ t = state[counter]; -+ stateindex = (stateindex + key[keyindex] + t) & 0xff; -+ u = state[stateindex]; -+ state[stateindex] = (u8)t; -+ state[counter] = (u8)u; -+ if (++keyindex >= key_len) -+ keyindex = 0; -+ } -+} -+ -+static u32 arcfour_byte(struct arc4context *parc4ctx) -+{ -+ u32 x; -+ u32 y; -+ u32 sx, sy; -+ u8 *state; -+ -+ state = parc4ctx->state; -+ x = (parc4ctx->x + 1) & 0xff; -+ sx = state[x]; -+ y = (sx + parc4ctx->y) & 0xff; -+ sy = state[y]; -+ parc4ctx->x = x; -+ parc4ctx->y = y; -+ state[y] = (u8)sx; -+ state[x] = (u8)sy; -+ return state[(sx + sy) & 0xff]; -+} -+ -+static void arcfour_encrypt( -+ struct arc4context *parc4ctx, -+ u8 *dest, -+ u8 *src, -+ u32 len -+) -+{ -+ u32 i; -+ -+ for (i = 0; i < len; i++) -+ dest[i] = src[i] ^ (unsigned char)arcfour_byte(parc4ctx); -+} -+ -+static sint bcrc32initialized = 0; -+static u32 crc32_table[256]; -+ -+ -+static u8 crc32_reverseBit(u8 data) -+{ -+ return((u8)((data<<7)&0x80) | ((data<<5)&0x40) | ((data<<3)&0x20) | ((data<<1)&0x10) | ((data>>1)&0x08) | ((data>>3)&0x04) | ((data>>5)&0x02) | ((data>>7)&0x01)); -+} -+ -+static void crc32_init(void) -+{ -+ if (bcrc32initialized == 1) -+ return; -+ else { -+ sint i, j; -+ u32 c; -+ u8 *p = (u8 *)&c, *p1; -+ u8 k; -+ -+ c = 0x12340000; -+ -+ for (i = 0; i < 256; ++i) { -+ k = crc32_reverseBit((u8)i); -+ for (c = ((u32)k) << 24, j = 8; j > 0; --j) { -+ c = c & 0x80000000 ? (c << 1) ^ CRC32_POLY : (c << 1); -+ } -+ p1 = (u8 *)&crc32_table[i]; -+ -+ p1[0] = crc32_reverseBit(p[3]); -+ p1[1] = crc32_reverseBit(p[2]); -+ p1[2] = crc32_reverseBit(p[1]); -+ p1[3] = crc32_reverseBit(p[0]); -+ } -+ bcrc32initialized = 1; -+ } -+} -+ -+static __le32 getcrc32(u8 *buf, sint len) -+{ -+ u8 *p; -+ u32 crc; -+ -+ if (bcrc32initialized == 0) -+ crc32_init(); -+ -+ crc = 0xffffffff; /* preload shift register, per CRC-32 spec */ -+ -+ for (p = buf; len > 0; ++p, --len) { -+ crc = crc32_table[(crc ^ *p) & 0xff] ^ (crc >> 8); -+ } -+ return cpu_to_le32(~crc); /* transmit complement, per CRC-32 spec */ -+} -+ -+ -+/* -+ Need to consider the fragment situation -+*/ -+void rtw_wep_encrypt(struct adapter *padapter, u8 *pxmitframe) -+{ /* exclude ICV */ -+ -+ unsigned char crc[4]; -+ struct arc4context mycontext; -+ -+ sint curfragnum, length; -+ u32 keylength; -+ -+ u8 *pframe, *payload, *iv; /* wepkey */ -+ u8 wepkey[16]; -+ u8 hw_hdr_offset = 0; -+ struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ if (((struct xmit_frame *)pxmitframe)->buf_addr == NULL) -+ return; -+ -+ hw_hdr_offset = TXDESC_OFFSET; -+ pframe = ((struct xmit_frame *)pxmitframe)->buf_addr + hw_hdr_offset; -+ -+ /* start to encrypt each fragment */ -+ if ((pattrib->encrypt == _WEP40_) || (pattrib->encrypt == _WEP104_)) { -+ keylength = psecuritypriv->dot11DefKeylen[psecuritypriv->dot11PrivacyKeyIndex]; -+ -+ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { -+ iv = pframe+pattrib->hdrlen; -+ memcpy(&wepkey[0], iv, 3); -+ memcpy(&wepkey[3], &psecuritypriv->dot11DefKey[psecuritypriv->dot11PrivacyKeyIndex].skey[0], keylength); -+ payload = pframe+pattrib->iv_len+pattrib->hdrlen; -+ -+ if ((curfragnum+1) == pattrib->nr_frags) { /* the last fragment */ -+ -+ length = pattrib->last_txcmdsz-pattrib->hdrlen-pattrib->iv_len-pattrib->icv_len; -+ -+ *((__le32 *)crc) = getcrc32(payload, length); -+ -+ arcfour_init(&mycontext, wepkey, 3+keylength); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ arcfour_encrypt(&mycontext, payload+length, crc, 4); -+ -+ } else{ -+ length = pxmitpriv->frag_len-pattrib->hdrlen-pattrib->iv_len-pattrib->icv_len; -+ *((__le32 *)crc) = getcrc32(payload, length); -+ arcfour_init(&mycontext, wepkey, 3+keylength); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ arcfour_encrypt(&mycontext, payload+length, crc, 4); -+ -+ pframe += pxmitpriv->frag_len; -+ pframe = (u8 *)RND4((SIZE_PTR)(pframe)); -+ -+ } -+ -+ } -+ -+ WEP_SW_ENC_CNT_INC(psecuritypriv, pattrib->ra); -+ } -+} -+ -+void rtw_wep_decrypt(struct adapter *padapter, u8 *precvframe) -+{ -+ /* exclude ICV */ -+ u8 crc[4]; -+ struct arc4context mycontext; -+ sint length; -+ u32 keylength; -+ u8 *pframe, *payload, *iv, wepkey[16]; -+ u8 keyindex; -+ struct rx_pkt_attrib *prxattrib = &(((union recv_frame *)precvframe)->u.hdr.attrib); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; -+ -+ /* start to decrypt recvframe */ -+ if ((prxattrib->encrypt == _WEP40_) || (prxattrib->encrypt == _WEP104_)) { -+ iv = pframe+prxattrib->hdrlen; -+ /* keyindex =(iv[3]&0x3); */ -+ keyindex = prxattrib->key_index; -+ keylength = psecuritypriv->dot11DefKeylen[keyindex]; -+ memcpy(&wepkey[0], iv, 3); -+ /* memcpy(&wepkey[3], &psecuritypriv->dot11DefKey[psecuritypriv->dot11PrivacyKeyIndex].skey[0], keylength); */ -+ memcpy(&wepkey[3], &psecuritypriv->dot11DefKey[keyindex].skey[0], keylength); -+ length = ((union recv_frame *)precvframe)->u.hdr.len-prxattrib->hdrlen-prxattrib->iv_len; -+ -+ payload = pframe+prxattrib->iv_len+prxattrib->hdrlen; -+ -+ /* decrypt payload include icv */ -+ arcfour_init(&mycontext, wepkey, 3+keylength); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ -+ /* calculate icv and compare the icv */ -+ *((u32 *)crc) = le32_to_cpu(getcrc32(payload, length-4)); -+ -+ if (crc[3] != payload[length-1] || crc[2] != payload[length-2] || crc[1] != payload[length-3] || crc[0] != payload[length-4]) { -+ RT_TRACE(_module_rtl871x_security_c_, _drv_err_, ("rtw_wep_decrypt:icv error crc[3](%x)!=payload[length-1](%x) || crc[2](%x)!=payload[length-2](%x) || crc[1](%x)!=payload[length-3](%x) || crc[0](%x)!=payload[length-4](%x)\n", -+ crc[3], payload[length-1], crc[2], payload[length-2], crc[1], payload[length-3], crc[0], payload[length-4])); -+ } -+ -+ WEP_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); -+ } -+ return; -+} -+ -+/* 3 =====TKIP related ===== */ -+ -+static u32 secmicgetuint32(u8 *p) -+/* Convert from Byte[] to Us3232 in a portable way */ -+{ -+ s32 i; -+ u32 res = 0; -+ -+ for (i = 0; i < 4; i++) { -+ res |= ((u32)(*p++)) << (8*i); -+ } -+ -+ return res; -+} -+ -+static void secmicputuint32(u8 *p, u32 val) -+/* Convert from Us3232 to Byte[] in a portable way */ -+{ -+ long i; -+ -+ for (i = 0; i < 4; i++) { -+ *p++ = (u8) (val & 0xff); -+ val >>= 8; -+ } -+} -+ -+static void secmicclear(struct mic_data *pmicdata) -+{ -+/* Reset the state to the empty message. */ -+ pmicdata->L = pmicdata->K0; -+ pmicdata->R = pmicdata->K1; -+ pmicdata->nBytesInM = 0; -+ pmicdata->M = 0; -+} -+ -+void rtw_secmicsetkey(struct mic_data *pmicdata, u8 *key) -+{ -+ /* Set the key */ -+ pmicdata->K0 = secmicgetuint32(key); -+ pmicdata->K1 = secmicgetuint32(key + 4); -+ /* and reset the message */ -+ secmicclear(pmicdata); -+} -+ -+void rtw_secmicappendbyte(struct mic_data *pmicdata, u8 b) -+{ -+ /* Append the byte to our word-sized buffer */ -+ pmicdata->M |= ((unsigned long)b) << (8*pmicdata->nBytesInM); -+ pmicdata->nBytesInM++; -+ /* Process the word if it is full. */ -+ if (pmicdata->nBytesInM >= 4) { -+ pmicdata->L ^= pmicdata->M; -+ pmicdata->R ^= ROL32(pmicdata->L, 17); -+ pmicdata->L += pmicdata->R; -+ pmicdata->R ^= ((pmicdata->L & 0xff00ff00) >> 8) | ((pmicdata->L & 0x00ff00ff) << 8); -+ pmicdata->L += pmicdata->R; -+ pmicdata->R ^= ROL32(pmicdata->L, 3); -+ pmicdata->L += pmicdata->R; -+ pmicdata->R ^= ROR32(pmicdata->L, 2); -+ pmicdata->L += pmicdata->R; -+ /* Clear the buffer */ -+ pmicdata->M = 0; -+ pmicdata->nBytesInM = 0; -+ } -+} -+ -+void rtw_secmicappend(struct mic_data *pmicdata, u8 *src, u32 nbytes) -+{ -+ /* This is simple */ -+ while (nbytes > 0) { -+ rtw_secmicappendbyte(pmicdata, *src++); -+ nbytes--; -+ } -+} -+ -+void rtw_secgetmic(struct mic_data *pmicdata, u8 *dst) -+{ -+ /* Append the minimum padding */ -+ rtw_secmicappendbyte(pmicdata, 0x5a); -+ rtw_secmicappendbyte(pmicdata, 0); -+ rtw_secmicappendbyte(pmicdata, 0); -+ rtw_secmicappendbyte(pmicdata, 0); -+ rtw_secmicappendbyte(pmicdata, 0); -+ /* and then zeroes until the length is a multiple of 4 */ -+ while (pmicdata->nBytesInM != 0) { -+ rtw_secmicappendbyte(pmicdata, 0); -+ } -+ /* The appendByte function has already computed the result. */ -+ secmicputuint32(dst, pmicdata->L); -+ secmicputuint32(dst+4, pmicdata->R); -+ /* Reset to the empty message. */ -+ secmicclear(pmicdata); -+} -+ -+ -+void rtw_seccalctkipmic(u8 *key, u8 *header, u8 *data, u32 data_len, u8 *mic_code, u8 pri) -+{ -+ -+ struct mic_data micdata; -+ u8 priority[4] = {0x0, 0x0, 0x0, 0x0}; -+ -+ rtw_secmicsetkey(&micdata, key); -+ priority[0] = pri; -+ -+ /* Michael MIC pseudo header: DA, SA, 3 x 0, Priority */ -+ if (header[1]&1) { /* ToDS == 1 */ -+ rtw_secmicappend(&micdata, &header[16], 6); /* DA */ -+ if (header[1]&2) /* From Ds == 1 */ -+ rtw_secmicappend(&micdata, &header[24], 6); -+ else -+ rtw_secmicappend(&micdata, &header[10], 6); -+ } else { /* ToDS == 0 */ -+ rtw_secmicappend(&micdata, &header[4], 6); /* DA */ -+ if (header[1]&2) /* From Ds == 1 */ -+ rtw_secmicappend(&micdata, &header[16], 6); -+ else -+ rtw_secmicappend(&micdata, &header[10], 6); -+ -+ } -+ rtw_secmicappend(&micdata, &priority[0], 4); -+ -+ -+ rtw_secmicappend(&micdata, data, data_len); -+ -+ rtw_secgetmic(&micdata, mic_code); -+} -+ -+/* macros for extraction/creation of unsigned char/unsigned short values */ -+#define RotR1(v16) ((((v16) >> 1) & 0x7FFF) ^ (((v16) & 1) << 15)) -+#define Lo8(v16) ((u8)((v16) & 0x00FF)) -+#define Hi8(v16) ((u8)(((v16) >> 8) & 0x00FF)) -+#define Lo16(v32) ((u16)((v32) & 0xFFFF)) -+#define Hi16(v32) ((u16)(((v32) >> 16) & 0xFFFF)) -+#define Mk16(hi, lo) ((lo) ^ (((u16)(hi)) << 8)) -+ -+/* select the Nth 16-bit word of the temporal key unsigned char array TK[] */ -+#define TK16(N) Mk16(tk[2*(N)+1], tk[2*(N)]) -+ -+/* S-box lookup: 16 bits --> 16 bits */ -+#define _S_(v16) (Sbox1[0][Lo8(v16)] ^ Sbox1[1][Hi8(v16)]) -+ -+/* fixed algorithm "parameters" */ -+#define PHASE1_LOOP_CNT 8 /* this needs to be "big enough" */ -+#define TA_SIZE 6 /* 48-bit transmitter address */ -+#define TK_SIZE 16 /* 128-bit temporal key */ -+#define P1K_SIZE 10 /* 80-bit Phase1 key */ -+#define RC4_KEY_SIZE 16 /* 128-bit RC4KEY (104 bits unknown) */ -+ -+ -+/* 2-unsigned char by 2-unsigned char subset of the full AES S-box table */ -+static const unsigned short Sbox1[2][256] = { /* Sbox for hash (can be in ROM) */ -+{ -+ 0xC6A5, 0xF884, 0xEE99, 0xF68D, 0xFF0D, 0xD6BD, 0xDEB1, 0x9154, -+ 0x6050, 0x0203, 0xCEA9, 0x567D, 0xE719, 0xB562, 0x4DE6, 0xEC9A, -+ 0x8F45, 0x1F9D, 0x8940, 0xFA87, 0xEF15, 0xB2EB, 0x8EC9, 0xFB0B, -+ 0x41EC, 0xB367, 0x5FFD, 0x45EA, 0x23BF, 0x53F7, 0xE496, 0x9B5B, -+ 0x75C2, 0xE11C, 0x3DAE, 0x4C6A, 0x6C5A, 0x7E41, 0xF502, 0x834F, -+ 0x685C, 0x51F4, 0xD134, 0xF908, 0xE293, 0xAB73, 0x6253, 0x2A3F, -+ 0x080C, 0x9552, 0x4665, 0x9D5E, 0x3028, 0x37A1, 0x0A0F, 0x2FB5, -+ 0x0E09, 0x2436, 0x1B9B, 0xDF3D, 0xCD26, 0x4E69, 0x7FCD, 0xEA9F, -+ 0x121B, 0x1D9E, 0x5874, 0x342E, 0x362D, 0xDCB2, 0xB4EE, 0x5BFB, -+ 0xA4F6, 0x764D, 0xB761, 0x7DCE, 0x527B, 0xDD3E, 0x5E71, 0x1397, -+ 0xA6F5, 0xB968, 0x0000, 0xC12C, 0x4060, 0xE31F, 0x79C8, 0xB6ED, -+ 0xD4BE, 0x8D46, 0x67D9, 0x724B, 0x94DE, 0x98D4, 0xB0E8, 0x854A, -+ 0xBB6B, 0xC52A, 0x4FE5, 0xED16, 0x86C5, 0x9AD7, 0x6655, 0x1194, -+ 0x8ACF, 0xE910, 0x0406, 0xFE81, 0xA0F0, 0x7844, 0x25BA, 0x4BE3, -+ 0xA2F3, 0x5DFE, 0x80C0, 0x058A, 0x3FAD, 0x21BC, 0x7048, 0xF104, -+ 0x63DF, 0x77C1, 0xAF75, 0x4263, 0x2030, 0xE51A, 0xFD0E, 0xBF6D, -+ 0x814C, 0x1814, 0x2635, 0xC32F, 0xBEE1, 0x35A2, 0x88CC, 0x2E39, -+ 0x9357, 0x55F2, 0xFC82, 0x7A47, 0xC8AC, 0xBAE7, 0x322B, 0xE695, -+ 0xC0A0, 0x1998, 0x9ED1, 0xA37F, 0x4466, 0x547E, 0x3BAB, 0x0B83, -+ 0x8CCA, 0xC729, 0x6BD3, 0x283C, 0xA779, 0xBCE2, 0x161D, 0xAD76, -+ 0xDB3B, 0x6456, 0x744E, 0x141E, 0x92DB, 0x0C0A, 0x486C, 0xB8E4, -+ 0x9F5D, 0xBD6E, 0x43EF, 0xC4A6, 0x39A8, 0x31A4, 0xD337, 0xF28B, -+ 0xD532, 0x8B43, 0x6E59, 0xDAB7, 0x018C, 0xB164, 0x9CD2, 0x49E0, -+ 0xD8B4, 0xACFA, 0xF307, 0xCF25, 0xCAAF, 0xF48E, 0x47E9, 0x1018, -+ 0x6FD5, 0xF088, 0x4A6F, 0x5C72, 0x3824, 0x57F1, 0x73C7, 0x9751, -+ 0xCB23, 0xA17C, 0xE89C, 0x3E21, 0x96DD, 0x61DC, 0x0D86, 0x0F85, -+ 0xE090, 0x7C42, 0x71C4, 0xCCAA, 0x90D8, 0x0605, 0xF701, 0x1C12, -+ 0xC2A3, 0x6A5F, 0xAEF9, 0x69D0, 0x1791, 0x9958, 0x3A27, 0x27B9, -+ 0xD938, 0xEB13, 0x2BB3, 0x2233, 0xD2BB, 0xA970, 0x0789, 0x33A7, -+ 0x2DB6, 0x3C22, 0x1592, 0xC920, 0x8749, 0xAAFF, 0x5078, 0xA57A, -+ 0x038F, 0x59F8, 0x0980, 0x1A17, 0x65DA, 0xD731, 0x84C6, 0xD0B8, -+ 0x82C3, 0x29B0, 0x5A77, 0x1E11, 0x7BCB, 0xA8FC, 0x6DD6, 0x2C3A, -+ }, -+ -+ -+ { /* second half of table is unsigned char-reversed version of first! */ -+ 0xA5C6, 0x84F8, 0x99EE, 0x8DF6, 0x0DFF, 0xBDD6, 0xB1DE, 0x5491, -+ 0x5060, 0x0302, 0xA9CE, 0x7D56, 0x19E7, 0x62B5, 0xE64D, 0x9AEC, -+ 0x458F, 0x9D1F, 0x4089, 0x87FA, 0x15EF, 0xEBB2, 0xC98E, 0x0BFB, -+ 0xEC41, 0x67B3, 0xFD5F, 0xEA45, 0xBF23, 0xF753, 0x96E4, 0x5B9B, -+ 0xC275, 0x1CE1, 0xAE3D, 0x6A4C, 0x5A6C, 0x417E, 0x02F5, 0x4F83, -+ 0x5C68, 0xF451, 0x34D1, 0x08F9, 0x93E2, 0x73AB, 0x5362, 0x3F2A, -+ 0x0C08, 0x5295, 0x6546, 0x5E9D, 0x2830, 0xA137, 0x0F0A, 0xB52F, -+ 0x090E, 0x3624, 0x9B1B, 0x3DDF, 0x26CD, 0x694E, 0xCD7F, 0x9FEA, -+ 0x1B12, 0x9E1D, 0x7458, 0x2E34, 0x2D36, 0xB2DC, 0xEEB4, 0xFB5B, -+ 0xF6A4, 0x4D76, 0x61B7, 0xCE7D, 0x7B52, 0x3EDD, 0x715E, 0x9713, -+ 0xF5A6, 0x68B9, 0x0000, 0x2CC1, 0x6040, 0x1FE3, 0xC879, 0xEDB6, -+ 0xBED4, 0x468D, 0xD967, 0x4B72, 0xDE94, 0xD498, 0xE8B0, 0x4A85, -+ 0x6BBB, 0x2AC5, 0xE54F, 0x16ED, 0xC586, 0xD79A, 0x5566, 0x9411, -+ 0xCF8A, 0x10E9, 0x0604, 0x81FE, 0xF0A0, 0x4478, 0xBA25, 0xE34B, -+ 0xF3A2, 0xFE5D, 0xC080, 0x8A05, 0xAD3F, 0xBC21, 0x4870, 0x04F1, -+ 0xDF63, 0xC177, 0x75AF, 0x6342, 0x3020, 0x1AE5, 0x0EFD, 0x6DBF, -+ 0x4C81, 0x1418, 0x3526, 0x2FC3, 0xE1BE, 0xA235, 0xCC88, 0x392E, -+ 0x5793, 0xF255, 0x82FC, 0x477A, 0xACC8, 0xE7BA, 0x2B32, 0x95E6, -+ 0xA0C0, 0x9819, 0xD19E, 0x7FA3, 0x6644, 0x7E54, 0xAB3B, 0x830B, -+ 0xCA8C, 0x29C7, 0xD36B, 0x3C28, 0x79A7, 0xE2BC, 0x1D16, 0x76AD, -+ 0x3BDB, 0x5664, 0x4E74, 0x1E14, 0xDB92, 0x0A0C, 0x6C48, 0xE4B8, -+ 0x5D9F, 0x6EBD, 0xEF43, 0xA6C4, 0xA839, 0xA431, 0x37D3, 0x8BF2, -+ 0x32D5, 0x438B, 0x596E, 0xB7DA, 0x8C01, 0x64B1, 0xD29C, 0xE049, -+ 0xB4D8, 0xFAAC, 0x07F3, 0x25CF, 0xAFCA, 0x8EF4, 0xE947, 0x1810, -+ 0xD56F, 0x88F0, 0x6F4A, 0x725C, 0x2438, 0xF157, 0xC773, 0x5197, -+ 0x23CB, 0x7CA1, 0x9CE8, 0x213E, 0xDD96, 0xDC61, 0x860D, 0x850F, -+ 0x90E0, 0x427C, 0xC471, 0xAACC, 0xD890, 0x0506, 0x01F7, 0x121C, -+ 0xA3C2, 0x5F6A, 0xF9AE, 0xD069, 0x9117, 0x5899, 0x273A, 0xB927, -+ 0x38D9, 0x13EB, 0xB32B, 0x3322, 0xBBD2, 0x70A9, 0x8907, 0xA733, -+ 0xB62D, 0x223C, 0x9215, 0x20C9, 0x4987, 0xFFAA, 0x7850, 0x7AA5, -+ 0x8F03, 0xF859, 0x8009, 0x171A, 0xDA65, 0x31D7, 0xC684, 0xB8D0, -+ 0xC382, 0xB029, 0x775A, 0x111E, 0xCB7B, 0xFCA8, 0xD66D, 0x3A2C, -+ } -+}; -+ -+ /* -+********************************************************************** -+* Routine: Phase 1 -- generate P1K, given TA, TK, IV32 -+* -+* Inputs: -+* tk[] = temporal key [128 bits] -+* ta[] = transmitter's MAC address [ 48 bits] -+* iv32 = upper 32 bits of IV [ 32 bits] -+* Output: -+* p1k[] = Phase 1 key [ 80 bits] -+* -+* Note: -+* This function only needs to be called every 2**16 packets, -+* although in theory it could be called every packet. -+* -+********************************************************************** -+*/ -+static void phase1(u16 *p1k, const u8 *tk, const u8 *ta, u32 iv32) -+{ -+ sint i; -+ -+ /* Initialize the 80 bits of P1K[] from IV32 and TA[0..5] */ -+ p1k[0] = Lo16(iv32); -+ p1k[1] = Hi16(iv32); -+ p1k[2] = Mk16(ta[1], ta[0]); /* use TA[] as little-endian */ -+ p1k[3] = Mk16(ta[3], ta[2]); -+ p1k[4] = Mk16(ta[5], ta[4]); -+ -+ /* Now compute an unbalanced Feistel cipher with 80-bit block */ -+ /* size on the 80-bit block P1K[], using the 128-bit key TK[] */ -+ for (i = 0; i < PHASE1_LOOP_CNT; i++) { -+ /* Each add operation here is mod 2**16 */ -+ p1k[0] += _S_(p1k[4] ^ TK16((i&1)+0)); -+ p1k[1] += _S_(p1k[0] ^ TK16((i&1)+2)); -+ p1k[2] += _S_(p1k[1] ^ TK16((i&1)+4)); -+ p1k[3] += _S_(p1k[2] ^ TK16((i&1)+6)); -+ p1k[4] += _S_(p1k[3] ^ TK16((i&1)+0)); -+ p1k[4] += (unsigned short)i; /* avoid "slide attacks" */ -+ } -+} -+ -+ -+/* -+********************************************************************** -+* Routine: Phase 2 -- generate RC4KEY, given TK, P1K, IV16 -+* -+* Inputs: -+* tk[] = Temporal key [128 bits] -+* p1k[] = Phase 1 output key [ 80 bits] -+* iv16 = low 16 bits of IV counter [ 16 bits] -+* Output: -+* rc4key[] = the key used to encrypt the packet [128 bits] -+* -+* Note: -+* The value {TA, IV32, IV16} for Phase1/Phase2 must be unique -+* across all packets using the same key TK value. Then, for a -+* given value of TK[], this TKIP48 construction guarantees that -+* the final RC4KEY value is unique across all packets. -+* -+* Suggested implementation optimization: if PPK[] is "overlaid" -+* appropriately on RC4KEY[], there is no need for the final -+* for loop below that copies the PPK[] result into RC4KEY[]. -+* -+********************************************************************** -+*/ -+static void phase2(u8 *rc4key, const u8 *tk, const u16 *p1k, u16 iv16) -+{ -+ sint i; -+ u16 PPK[6]; /* temporary key for mixing */ -+ -+ /* Note: all adds in the PPK[] equations below are mod 2**16 */ -+ for (i = 0; i < 5; i++) -+ PPK[i] = p1k[i]; /* first, copy P1K to PPK */ -+ -+ PPK[5] = p1k[4]+iv16; /* next, add in IV16 */ -+ -+ /* Bijective non-linear mixing of the 96 bits of PPK[0..5] */ -+ PPK[0] += _S_(PPK[5] ^ TK16(0)); /* Mix key in each "round" */ -+ PPK[1] += _S_(PPK[0] ^ TK16(1)); -+ PPK[2] += _S_(PPK[1] ^ TK16(2)); -+ PPK[3] += _S_(PPK[2] ^ TK16(3)); -+ PPK[4] += _S_(PPK[3] ^ TK16(4)); -+ PPK[5] += _S_(PPK[4] ^ TK16(5)); /* Total # S-box lookups == 6 */ -+ -+ /* Final sweep: bijective, "linear". Rotates kill LSB correlations */ -+ PPK[0] += RotR1(PPK[5] ^ TK16(6)); -+ PPK[1] += RotR1(PPK[0] ^ TK16(7)); /* Use all of TK[] in Phase2 */ -+ PPK[2] += RotR1(PPK[1]); -+ PPK[3] += RotR1(PPK[2]); -+ PPK[4] += RotR1(PPK[3]); -+ PPK[5] += RotR1(PPK[4]); -+ /* Note: At this point, for a given key TK[0..15], the 96-bit output */ -+ /* value PPK[0..5] is guaranteed to be unique, as a function */ -+ /* of the 96-bit "input" value {TA, IV32, IV16}. That is, P1K */ -+ /* is now a keyed permutation of {TA, IV32, IV16}. */ -+ -+ /* Set RC4KEY[0..3], which includes "cleartext" portion of RC4 key */ -+ rc4key[0] = Hi8(iv16); /* RC4KEY[0..2] is the WEP IV */ -+ rc4key[1] = (Hi8(iv16) | 0x20) & 0x7F; /* Help avoid weak (FMS) keys */ -+ rc4key[2] = Lo8(iv16); -+ rc4key[3] = Lo8((PPK[5] ^ TK16(0)) >> 1); -+ -+ -+ /* Copy 96 bits of PPK[0..5] to RC4KEY[4..15] (little-endian) */ -+ for (i = 0; i < 6; i++) { -+ rc4key[4+2*i] = Lo8(PPK[i]); -+ rc4key[5+2*i] = Hi8(PPK[i]); -+ } -+} -+ -+ -+/* The hlen isn't include the IV */ -+u32 rtw_tkip_encrypt(struct adapter *padapter, u8 *pxmitframe) -+{ /* exclude ICV */ -+ u16 pnl; -+ u32 pnh; -+ u8 rc4key[16]; -+ u8 ttkey[16]; -+ u8 crc[4]; -+ u8 hw_hdr_offset = 0; -+ struct arc4context mycontext; -+ sint curfragnum, length; -+ u32 prwskeylen; -+ -+ u8 *pframe, *payload, *iv, *prwskey; -+ union pn48 dot11txpn; -+ /* struct sta_info *stainfo; */ -+ struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ u32 res = _SUCCESS; -+ -+ if (((struct xmit_frame *)pxmitframe)->buf_addr == NULL) -+ return _FAIL; -+ -+ hw_hdr_offset = TXDESC_OFFSET; -+ pframe = ((struct xmit_frame *)pxmitframe)->buf_addr + hw_hdr_offset; -+ -+ /* 4 start to encrypt each fragment */ -+ if (pattrib->encrypt == _TKIP_) { -+ -+/* -+ if (pattrib->psta) -+ { -+ stainfo = pattrib->psta; -+ } -+ else -+ { -+ DBG_871X("%s, call rtw_get_stainfo()\n", __func__); -+ stainfo =rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0]); -+ } -+*/ -+ /* if (stainfo!= NULL) */ -+ { -+/* -+ if (!(stainfo->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, stainfo->state); -+ return _FAIL; -+ } -+*/ -+ RT_TRACE(_module_rtl871x_security_c_, _drv_err_, ("rtw_tkip_encrypt: stainfo!= NULL!!!\n")); -+ -+ if (IS_MCAST(pattrib->ra)) -+ prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; -+ else -+ /* prwskey =&stainfo->dot118021x_UncstKey.skey[0]; */ -+ prwskey = pattrib->dot118021x_UncstKey.skey; -+ -+ prwskeylen = 16; -+ -+ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { -+ iv = pframe+pattrib->hdrlen; -+ payload = pframe+pattrib->iv_len+pattrib->hdrlen; -+ -+ GET_TKIP_PN(iv, dot11txpn); -+ -+ pnl = (u16)(dot11txpn.val); -+ pnh = (u32)(dot11txpn.val>>16); -+ -+ phase1((u16 *)&ttkey[0], prwskey, &pattrib->ta[0], pnh); -+ -+ phase2(&rc4key[0], prwskey, (u16 *)&ttkey[0], pnl); -+ -+ if ((curfragnum+1) == pattrib->nr_frags) { /* 4 the last fragment */ -+ length = pattrib->last_txcmdsz-pattrib->hdrlen-pattrib->iv_len-pattrib->icv_len; -+ RT_TRACE(_module_rtl871x_security_c_, _drv_info_, ("pattrib->iv_len =%x, pattrib->icv_len =%x\n", pattrib->iv_len, pattrib->icv_len)); -+ *((__le32 *)crc) = getcrc32(payload, length);/* modified by Amy*/ -+ -+ arcfour_init(&mycontext, rc4key, 16); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ arcfour_encrypt(&mycontext, payload+length, crc, 4); -+ -+ } else { -+ length = pxmitpriv->frag_len-pattrib->hdrlen-pattrib->iv_len-pattrib->icv_len; -+ *((__le32 *)crc) = getcrc32(payload, length);/* modified by Amy*/ -+ arcfour_init(&mycontext, rc4key, 16); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ arcfour_encrypt(&mycontext, payload+length, crc, 4); -+ -+ pframe += pxmitpriv->frag_len; -+ pframe = (u8 *)RND4((SIZE_PTR)(pframe)); -+ -+ } -+ } -+ -+ TKIP_SW_ENC_CNT_INC(psecuritypriv, pattrib->ra); -+ } -+/* -+ else { -+ RT_TRACE(_module_rtl871x_security_c_, _drv_err_, ("rtw_tkip_encrypt: stainfo == NULL!!!\n")); -+ DBG_871X("%s, psta ==NUL\n", __func__); -+ res = _FAIL; -+ } -+*/ -+ -+ } -+ return res; -+} -+ -+ -+/* The hlen isn't include the IV */ -+u32 rtw_tkip_decrypt(struct adapter *padapter, u8 *precvframe) -+{ /* exclude ICV */ -+ u16 pnl; -+ u32 pnh; -+ u8 rc4key[16]; -+ u8 ttkey[16]; -+ u8 crc[4]; -+ struct arc4context mycontext; -+ sint length; -+ u32 prwskeylen; -+ -+ u8 *pframe, *payload, *iv, *prwskey; -+ union pn48 dot11txpn; -+ struct sta_info *stainfo; -+ struct rx_pkt_attrib *prxattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+/* struct recv_priv *precvpriv =&padapter->recvpriv; */ -+ u32 res = _SUCCESS; -+ -+ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; -+ -+ /* 4 start to decrypt recvframe */ -+ if (prxattrib->encrypt == _TKIP_) { -+ -+ stainfo = rtw_get_stainfo(&padapter->stapriv, &prxattrib->ta[0]); -+ if (stainfo != NULL) { -+ -+ if (IS_MCAST(prxattrib->ra)) { -+ static unsigned long start = 0; -+ static u32 no_gkey_bc_cnt = 0; -+ static u32 no_gkey_mc_cnt = 0; -+ -+ if (psecuritypriv->binstallGrpkey == false) { -+ res = _FAIL; -+ -+ if (start == 0) -+ start = jiffies; -+ -+ if (is_broadcast_mac_addr(prxattrib->ra)) -+ no_gkey_bc_cnt++; -+ else -+ no_gkey_mc_cnt++; -+ -+ if (jiffies_to_msecs(jiffies - start) > 1000) { -+ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", -+ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); -+ } -+ start = jiffies; -+ no_gkey_bc_cnt = 0; -+ no_gkey_mc_cnt = 0; -+ } -+ goto exit; -+ } -+ -+ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" gkey installed. no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", -+ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); -+ } -+ start = 0; -+ no_gkey_bc_cnt = 0; -+ no_gkey_mc_cnt = 0; -+ -+ /* DBG_871X("rx bc/mc packets, to perform sw rtw_tkip_decrypt\n"); */ -+ /* prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; */ -+ prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; -+ prwskeylen = 16; -+ } else{ -+ prwskey = &stainfo->dot118021x_UncstKey.skey[0]; -+ prwskeylen = 16; -+ } -+ -+ iv = pframe+prxattrib->hdrlen; -+ payload = pframe+prxattrib->iv_len+prxattrib->hdrlen; -+ length = ((union recv_frame *)precvframe)->u.hdr.len-prxattrib->hdrlen-prxattrib->iv_len; -+ -+ GET_TKIP_PN(iv, dot11txpn); -+ -+ pnl = (u16)(dot11txpn.val); -+ pnh = (u32)(dot11txpn.val>>16); -+ -+ phase1((u16 *)&ttkey[0], prwskey, &prxattrib->ta[0], pnh); -+ phase2(&rc4key[0], prwskey, (unsigned short *)&ttkey[0], pnl); -+ -+ /* 4 decrypt payload include icv */ -+ -+ arcfour_init(&mycontext, rc4key, 16); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ -+ *((u32 *)crc) = le32_to_cpu(getcrc32(payload, length-4)); -+ -+ if (crc[3] != payload[length-1] || crc[2] != payload[length-2] || crc[1] != payload[length-3] || crc[0] != payload[length-4]) { -+ RT_TRACE(_module_rtl871x_security_c_, _drv_err_, ("rtw_wep_decrypt:icv error crc[3](%x)!=payload[length-1](%x) || crc[2](%x)!=payload[length-2](%x) || crc[1](%x)!=payload[length-3](%x) || crc[0](%x)!=payload[length-4](%x)\n", -+ crc[3], payload[length-1], crc[2], payload[length-2], crc[1], payload[length-3], crc[0], payload[length-4])); -+ res = _FAIL; -+ } -+ -+ TKIP_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); -+ } else { -+ RT_TRACE(_module_rtl871x_security_c_, _drv_err_, ("rtw_tkip_decrypt: stainfo == NULL!!!\n")); -+ res = _FAIL; -+ } -+ -+ } -+exit: -+ return res; -+ -+} -+ -+ -+/* 3 =====AES related ===== */ -+ -+ -+ -+#define MAX_MSG_SIZE 2048 -+/*****************************/ -+/******** SBOX Table *********/ -+/*****************************/ -+ -+ static u8 sbox_table[256] = { -+ 0x63, 0x7c, 0x77, 0x7b, 0xf2, 0x6b, 0x6f, 0xc5, -+ 0x30, 0x01, 0x67, 0x2b, 0xfe, 0xd7, 0xab, 0x76, -+ 0xca, 0x82, 0xc9, 0x7d, 0xfa, 0x59, 0x47, 0xf0, -+ 0xad, 0xd4, 0xa2, 0xaf, 0x9c, 0xa4, 0x72, 0xc0, -+ 0xb7, 0xfd, 0x93, 0x26, 0x36, 0x3f, 0xf7, 0xcc, -+ 0x34, 0xa5, 0xe5, 0xf1, 0x71, 0xd8, 0x31, 0x15, -+ 0x04, 0xc7, 0x23, 0xc3, 0x18, 0x96, 0x05, 0x9a, -+ 0x07, 0x12, 0x80, 0xe2, 0xeb, 0x27, 0xb2, 0x75, -+ 0x09, 0x83, 0x2c, 0x1a, 0x1b, 0x6e, 0x5a, 0xa0, -+ 0x52, 0x3b, 0xd6, 0xb3, 0x29, 0xe3, 0x2f, 0x84, -+ 0x53, 0xd1, 0x00, 0xed, 0x20, 0xfc, 0xb1, 0x5b, -+ 0x6a, 0xcb, 0xbe, 0x39, 0x4a, 0x4c, 0x58, 0xcf, -+ 0xd0, 0xef, 0xaa, 0xfb, 0x43, 0x4d, 0x33, 0x85, -+ 0x45, 0xf9, 0x02, 0x7f, 0x50, 0x3c, 0x9f, 0xa8, -+ 0x51, 0xa3, 0x40, 0x8f, 0x92, 0x9d, 0x38, 0xf5, -+ 0xbc, 0xb6, 0xda, 0x21, 0x10, 0xff, 0xf3, 0xd2, -+ 0xcd, 0x0c, 0x13, 0xec, 0x5f, 0x97, 0x44, 0x17, -+ 0xc4, 0xa7, 0x7e, 0x3d, 0x64, 0x5d, 0x19, 0x73, -+ 0x60, 0x81, 0x4f, 0xdc, 0x22, 0x2a, 0x90, 0x88, -+ 0x46, 0xee, 0xb8, 0x14, 0xde, 0x5e, 0x0b, 0xdb, -+ 0xe0, 0x32, 0x3a, 0x0a, 0x49, 0x06, 0x24, 0x5c, -+ 0xc2, 0xd3, 0xac, 0x62, 0x91, 0x95, 0xe4, 0x79, -+ 0xe7, 0xc8, 0x37, 0x6d, 0x8d, 0xd5, 0x4e, 0xa9, -+ 0x6c, 0x56, 0xf4, 0xea, 0x65, 0x7a, 0xae, 0x08, -+ 0xba, 0x78, 0x25, 0x2e, 0x1c, 0xa6, 0xb4, 0xc6, -+ 0xe8, 0xdd, 0x74, 0x1f, 0x4b, 0xbd, 0x8b, 0x8a, -+ 0x70, 0x3e, 0xb5, 0x66, 0x48, 0x03, 0xf6, 0x0e, -+ 0x61, 0x35, 0x57, 0xb9, 0x86, 0xc1, 0x1d, 0x9e, -+ 0xe1, 0xf8, 0x98, 0x11, 0x69, 0xd9, 0x8e, 0x94, -+ 0x9b, 0x1e, 0x87, 0xe9, 0xce, 0x55, 0x28, 0xdf, -+ 0x8c, 0xa1, 0x89, 0x0d, 0xbf, 0xe6, 0x42, 0x68, -+ 0x41, 0x99, 0x2d, 0x0f, 0xb0, 0x54, 0xbb, 0x16 -+ }; -+ -+/*****************************/ -+/**** Function Prototypes ****/ -+/*****************************/ -+ -+static void bitwise_xor(u8 *ina, u8 *inb, u8 *out); -+static void construct_mic_iv( -+ u8 *mic_header1, -+ sint qc_exists, -+ sint a4_exists, -+ u8 *mpdu, -+ uint payload_length, -+ u8 *pn_vector, -+ uint frtype -+);/* add for CONFIG_IEEE80211W, none 11w also can use */ -+static void construct_mic_header1( -+ u8 *mic_header1, -+ sint header_length, -+ u8 *mpdu, -+ uint frtype -+);/* add for CONFIG_IEEE80211W, none 11w also can use */ -+static void construct_mic_header2( -+ u8 *mic_header2, -+ u8 *mpdu, -+ sint a4_exists, -+ sint qc_exists -+); -+static void construct_ctr_preload( -+ u8 *ctr_preload, -+ sint a4_exists, -+ sint qc_exists, -+ u8 *mpdu, -+ u8 *pn_vector, -+ sint c, -+ uint frtype -+);/* add for CONFIG_IEEE80211W, none 11w also can use */ -+static void xor_128(u8 *a, u8 *b, u8 *out); -+static void xor_32(u8 *a, u8 *b, u8 *out); -+static u8 sbox(u8 a); -+static void next_key(u8 *key, sint round); -+static void byte_sub(u8 *in, u8 *out); -+static void shift_row(u8 *in, u8 *out); -+static void mix_column(u8 *in, u8 *out); -+static void aes128k128d(u8 *key, u8 *data, u8 *ciphertext); -+ -+ -+/****************************************/ -+/* aes128k128d() */ -+/* Performs a 128 bit AES encrypt with */ -+/* 128 bit data. */ -+/****************************************/ -+static void xor_128(u8 *a, u8 *b, u8 *out) -+{ -+ sint i; -+ -+ for (i = 0; i < 16; i++) { -+ out[i] = a[i] ^ b[i]; -+ } -+} -+ -+ -+static void xor_32(u8 *a, u8 *b, u8 *out) -+{ -+ sint i; -+ -+ for (i = 0; i < 4; i++) { -+ out[i] = a[i] ^ b[i]; -+ } -+} -+ -+ -+static u8 sbox(u8 a) -+{ -+ return sbox_table[(sint)a]; -+} -+ -+ -+static void next_key(u8 *key, sint round) -+{ -+ u8 rcon; -+ u8 sbox_key[4]; -+ u8 rcon_table[12] = { -+ 0x01, 0x02, 0x04, 0x08, -+ 0x10, 0x20, 0x40, 0x80, -+ 0x1b, 0x36, 0x36, 0x36 -+ }; -+ sbox_key[0] = sbox(key[13]); -+ sbox_key[1] = sbox(key[14]); -+ sbox_key[2] = sbox(key[15]); -+ sbox_key[3] = sbox(key[12]); -+ -+ rcon = rcon_table[round]; -+ -+ xor_32(&key[0], sbox_key, &key[0]); -+ key[0] = key[0] ^ rcon; -+ -+ xor_32(&key[4], &key[0], &key[4]); -+ xor_32(&key[8], &key[4], &key[8]); -+ xor_32(&key[12], &key[8], &key[12]); -+} -+ -+ -+static void byte_sub(u8 *in, u8 *out) -+{ -+ sint i; -+ -+ for (i = 0; i < 16; i++) { -+ out[i] = sbox(in[i]); -+ } -+} -+ -+ -+static void shift_row(u8 *in, u8 *out) -+{ -+ out[0] = in[0]; -+ out[1] = in[5]; -+ out[2] = in[10]; -+ out[3] = in[15]; -+ out[4] = in[4]; -+ out[5] = in[9]; -+ out[6] = in[14]; -+ out[7] = in[3]; -+ out[8] = in[8]; -+ out[9] = in[13]; -+ out[10] = in[2]; -+ out[11] = in[7]; -+ out[12] = in[12]; -+ out[13] = in[1]; -+ out[14] = in[6]; -+ out[15] = in[11]; -+} -+ -+ -+static void mix_column(u8 *in, u8 *out) -+{ -+ sint i; -+ u8 add1b[4]; -+ u8 add1bf7[4]; -+ u8 rotl[4]; -+ u8 swap_halfs[4]; -+ u8 andf7[4]; -+ u8 rotr[4]; -+ u8 temp[4]; -+ u8 tempb[4]; -+ -+ for (i = 0; i < 4; i++) { -+ if ((in[i] & 0x80) == 0x80) -+ add1b[i] = 0x1b; -+ else -+ add1b[i] = 0x00; -+ } -+ -+ swap_halfs[0] = in[2]; /* Swap halfs */ -+ swap_halfs[1] = in[3]; -+ swap_halfs[2] = in[0]; -+ swap_halfs[3] = in[1]; -+ -+ rotl[0] = in[3]; /* Rotate left 8 bits */ -+ rotl[1] = in[0]; -+ rotl[2] = in[1]; -+ rotl[3] = in[2]; -+ -+ andf7[0] = in[0] & 0x7f; -+ andf7[1] = in[1] & 0x7f; -+ andf7[2] = in[2] & 0x7f; -+ andf7[3] = in[3] & 0x7f; -+ -+ for (i = 3; i > 0; i--) { /* logical shift left 1 bit */ -+ andf7[i] = andf7[i] << 1; -+ if ((andf7[i-1] & 0x80) == 0x80) -+ andf7[i] = (andf7[i] | 0x01); -+ } -+ andf7[0] = andf7[0] << 1; -+ andf7[0] = andf7[0] & 0xfe; -+ -+ xor_32(add1b, andf7, add1bf7); -+ -+ xor_32(in, add1bf7, rotr); -+ -+ temp[0] = rotr[0]; /* Rotate right 8 bits */ -+ rotr[0] = rotr[1]; -+ rotr[1] = rotr[2]; -+ rotr[2] = rotr[3]; -+ rotr[3] = temp[0]; -+ -+ xor_32(add1bf7, rotr, temp); -+ xor_32(swap_halfs, rotl, tempb); -+ xor_32(temp, tempb, out); -+} -+ -+static void aes128k128d(u8 *key, u8 *data, u8 *ciphertext) -+{ -+ sint round; -+ sint i; -+ u8 intermediatea[16]; -+ u8 intermediateb[16]; -+ u8 round_key[16]; -+ -+ for (i = 0; i < 16; i++) -+ round_key[i] = key[i]; -+ -+ for (round = 0; round < 11; round++) { -+ if (round == 0) { -+ xor_128(round_key, data, ciphertext); -+ next_key(round_key, round); -+ } else if (round == 10) { -+ byte_sub(ciphertext, intermediatea); -+ shift_row(intermediatea, intermediateb); -+ xor_128(intermediateb, round_key, ciphertext); -+ } else{ /* 1 - 9 */ -+ byte_sub(ciphertext, intermediatea); -+ shift_row(intermediatea, intermediateb); -+ mix_column(&intermediateb[0], &intermediatea[0]); -+ mix_column(&intermediateb[4], &intermediatea[4]); -+ mix_column(&intermediateb[8], &intermediatea[8]); -+ mix_column(&intermediateb[12], &intermediatea[12]); -+ xor_128(intermediatea, round_key, ciphertext); -+ next_key(round_key, round); -+ } -+ } -+} -+ -+ -+/************************************************/ -+/* construct_mic_iv() */ -+/* Builds the MIC IV from header fields and PN */ -+/* Baron think the function is construct CCM */ -+/* nonce */ -+/************************************************/ -+static void construct_mic_iv( -+ u8 *mic_iv, -+ sint qc_exists, -+ sint a4_exists, -+ u8 *mpdu, -+ uint payload_length, -+ u8 *pn_vector, -+ uint frtype/* add for CONFIG_IEEE80211W, none 11w also can use */ -+) -+{ -+ sint i; -+ -+ mic_iv[0] = 0x59; -+ -+ if (qc_exists && a4_exists) -+ mic_iv[1] = mpdu[30] & 0x0f; /* QoS_TC */ -+ -+ if (qc_exists && !a4_exists) -+ mic_iv[1] = mpdu[24] & 0x0f; /* mute bits 7-4 */ -+ -+ if (!qc_exists) -+ mic_iv[1] = 0x00; -+ -+ /* 802.11w management frame should set management bit(4) */ -+ if (frtype == WIFI_MGT_TYPE) -+ mic_iv[1] |= BIT(4); -+ -+ for (i = 2; i < 8; i++) -+ mic_iv[i] = mpdu[i + 8]; /* mic_iv[2:7] = A2[0:5] = mpdu[10:15] */ -+ #ifdef CONSISTENT_PN_ORDER -+ for (i = 8; i < 14; i++) -+ mic_iv[i] = pn_vector[i - 8]; /* mic_iv[8:13] = PN[0:5] */ -+ #else -+ for (i = 8; i < 14; i++) -+ mic_iv[i] = pn_vector[13 - i]; /* mic_iv[8:13] = PN[5:0] */ -+ #endif -+ mic_iv[14] = (unsigned char) (payload_length / 256); -+ mic_iv[15] = (unsigned char) (payload_length % 256); -+} -+ -+ -+/************************************************/ -+/* construct_mic_header1() */ -+/* Builds the first MIC header block from */ -+/* header fields. */ -+/* Build AAD SC, A1, A2 */ -+/************************************************/ -+static void construct_mic_header1( -+ u8 *mic_header1, -+ sint header_length, -+ u8 *mpdu, -+ uint frtype/* add for CONFIG_IEEE80211W, none 11w also can use */ -+) -+{ -+ mic_header1[0] = (u8)((header_length - 2) / 256); -+ mic_header1[1] = (u8)((header_length - 2) % 256); -+ -+ /* 802.11w management frame don't AND subtype bits 4, 5, 6 of frame control field */ -+ if (frtype == WIFI_MGT_TYPE) -+ mic_header1[2] = mpdu[0]; -+ else -+ mic_header1[2] = mpdu[0] & 0xcf; /* Mute CF poll & CF ack bits */ -+ -+ mic_header1[3] = mpdu[1] & 0xc7; /* Mute retry, more data and pwr mgt bits */ -+ mic_header1[4] = mpdu[4]; /* A1 */ -+ mic_header1[5] = mpdu[5]; -+ mic_header1[6] = mpdu[6]; -+ mic_header1[7] = mpdu[7]; -+ mic_header1[8] = mpdu[8]; -+ mic_header1[9] = mpdu[9]; -+ mic_header1[10] = mpdu[10]; /* A2 */ -+ mic_header1[11] = mpdu[11]; -+ mic_header1[12] = mpdu[12]; -+ mic_header1[13] = mpdu[13]; -+ mic_header1[14] = mpdu[14]; -+ mic_header1[15] = mpdu[15]; -+} -+ -+ -+/************************************************/ -+/* construct_mic_header2() */ -+/* Builds the last MIC header block from */ -+/* header fields. */ -+/************************************************/ -+static void construct_mic_header2( -+ u8 *mic_header2, -+ u8 *mpdu, -+ sint a4_exists, -+ sint qc_exists -+) -+{ -+ sint i; -+ -+ for (i = 0; i < 16; i++) -+ mic_header2[i] = 0x00; -+ -+ mic_header2[0] = mpdu[16]; /* A3 */ -+ mic_header2[1] = mpdu[17]; -+ mic_header2[2] = mpdu[18]; -+ mic_header2[3] = mpdu[19]; -+ mic_header2[4] = mpdu[20]; -+ mic_header2[5] = mpdu[21]; -+ -+ mic_header2[6] = 0x00; -+ mic_header2[7] = 0x00; /* mpdu[23]; */ -+ -+ -+ if (!qc_exists && a4_exists) { -+ for (i = 0; i < 6; i++) -+ mic_header2[8+i] = mpdu[24+i]; /* A4 */ -+ -+ } -+ -+ if (qc_exists && !a4_exists) { -+ mic_header2[8] = mpdu[24] & 0x0f; /* mute bits 15 - 4 */ -+ mic_header2[9] = mpdu[25] & 0x00; -+ } -+ -+ if (qc_exists && a4_exists) { -+ for (i = 0; i < 6; i++) -+ mic_header2[8+i] = mpdu[24+i]; /* A4 */ -+ -+ mic_header2[14] = mpdu[30] & 0x0f; -+ mic_header2[15] = mpdu[31] & 0x00; -+ } -+ -+} -+ -+/************************************************/ -+/* construct_mic_header2() */ -+/* Builds the last MIC header block from */ -+/* header fields. */ -+/* Baron think the function is construct CCM */ -+/* nonce */ -+/************************************************/ -+static void construct_ctr_preload( -+ u8 *ctr_preload, -+ sint a4_exists, -+ sint qc_exists, -+ u8 *mpdu, -+ u8 *pn_vector, -+ sint c, -+ uint frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+) -+{ -+ sint i = 0; -+ -+ for (i = 0; i < 16; i++) -+ ctr_preload[i] = 0x00; -+ i = 0; -+ -+ ctr_preload[0] = 0x01; /* flag */ -+ if (qc_exists && a4_exists) -+ ctr_preload[1] = mpdu[30] & 0x0f; /* QoC_Control */ -+ if (qc_exists && !a4_exists) -+ ctr_preload[1] = mpdu[24] & 0x0f; -+ -+ /* 802.11w management frame should set management bit(4) */ -+ if (frtype == WIFI_MGT_TYPE) -+ ctr_preload[1] |= BIT(4); -+ -+ for (i = 2; i < 8; i++) -+ ctr_preload[i] = mpdu[i + 8]; /* ctr_preload[2:7] = A2[0:5] = mpdu[10:15] */ -+#ifdef CONSISTENT_PN_ORDER -+ for (i = 8; i < 14; i++) -+ ctr_preload[i] = pn_vector[i - 8]; /* ctr_preload[8:13] = PN[0:5] */ -+#else -+ for (i = 8; i < 14; i++) -+ ctr_preload[i] = pn_vector[13 - i]; /* ctr_preload[8:13] = PN[5:0] */ -+#endif -+ ctr_preload[14] = (unsigned char) (c / 256); /* Ctr */ -+ ctr_preload[15] = (unsigned char) (c % 256); -+} -+ -+ -+/************************************/ -+/* bitwise_xor() */ -+/* A 128 bit, bitwise exclusive or */ -+/************************************/ -+static void bitwise_xor(u8 *ina, u8 *inb, u8 *out) -+{ -+ sint i; -+ -+ for (i = 0; i < 16; i++) { -+ out[i] = ina[i] ^ inb[i]; -+ } -+} -+ -+ -+static sint aes_cipher(u8 *key, uint hdrlen, -+ u8 *pframe, uint plen) -+{ -+ uint qc_exists, a4_exists, i, j, payload_remainder, -+ num_blocks, payload_index; -+ -+ u8 pn_vector[6]; -+ u8 mic_iv[16]; -+ u8 mic_header1[16]; -+ u8 mic_header2[16]; -+ u8 ctr_preload[16]; -+ -+ /* Intermediate Buffers */ -+ u8 chain_buffer[16]; -+ u8 aes_out[16]; -+ u8 padded_buffer[16]; -+ u8 mic[8]; -+ uint frtype = GetFrameType(pframe); -+ uint frsubtype = GetFrameSubType(pframe); -+ -+ frsubtype = frsubtype>>4; -+ -+ -+ memset((void *)mic_iv, 0, 16); -+ memset((void *)mic_header1, 0, 16); -+ memset((void *)mic_header2, 0, 16); -+ memset((void *)ctr_preload, 0, 16); -+ memset((void *)chain_buffer, 0, 16); -+ memset((void *)aes_out, 0, 16); -+ memset((void *)padded_buffer, 0, 16); -+ -+ if ((hdrlen == WLAN_HDR_A3_LEN) || (hdrlen == WLAN_HDR_A3_QOS_LEN)) -+ a4_exists = 0; -+ else -+ a4_exists = 1; -+ -+ if ( -+ ((frtype|frsubtype) == WIFI_DATA_CFACK) || -+ ((frtype|frsubtype) == WIFI_DATA_CFPOLL) || -+ ((frtype|frsubtype) == WIFI_DATA_CFACKPOLL)) { -+ qc_exists = 1; -+ if (hdrlen != WLAN_HDR_A3_QOS_LEN) -+ hdrlen += 2; -+ -+ } else if ((frtype == WIFI_DATA) && /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ ((frsubtype == 0x08) || -+ (frsubtype == 0x09) || -+ (frsubtype == 0x0a) || -+ (frsubtype == 0x0b))) { -+ if (hdrlen != WLAN_HDR_A3_QOS_LEN) -+ hdrlen += 2; -+ -+ qc_exists = 1; -+ } else -+ qc_exists = 0; -+ -+ pn_vector[0] = pframe[hdrlen]; -+ pn_vector[1] = pframe[hdrlen+1]; -+ pn_vector[2] = pframe[hdrlen+4]; -+ pn_vector[3] = pframe[hdrlen+5]; -+ pn_vector[4] = pframe[hdrlen+6]; -+ pn_vector[5] = pframe[hdrlen+7]; -+ -+ construct_mic_iv( -+ mic_iv, -+ qc_exists, -+ a4_exists, -+ pframe, /* message, */ -+ plen, -+ pn_vector, -+ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ ); -+ -+ construct_mic_header1( -+ mic_header1, -+ hdrlen, -+ pframe, /* message */ -+ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ ); -+ construct_mic_header2( -+ mic_header2, -+ pframe, /* message, */ -+ a4_exists, -+ qc_exists -+ ); -+ -+ -+ payload_remainder = plen % 16; -+ num_blocks = plen / 16; -+ -+ /* Find start of payload */ -+ payload_index = (hdrlen + 8); -+ -+ /* Calculate MIC */ -+ aes128k128d(key, mic_iv, aes_out); -+ bitwise_xor(aes_out, mic_header1, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ bitwise_xor(aes_out, mic_header2, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ -+ for (i = 0; i < num_blocks; i++) { -+ bitwise_xor(aes_out, &pframe[payload_index], chain_buffer);/* bitwise_xor(aes_out, &message[payload_index], chain_buffer); */ -+ -+ payload_index += 16; -+ aes128k128d(key, chain_buffer, aes_out); -+ } -+ -+ /* Add on the final payload block if it needs padding */ -+ if (payload_remainder > 0) { -+ for (j = 0; j < 16; j++) -+ padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) { -+ padded_buffer[j] = pframe[payload_index++];/* padded_buffer[j] = message[payload_index++]; */ -+ } -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ -+ } -+ -+ for (j = 0 ; j < 8; j++) -+ mic[j] = aes_out[j]; -+ -+ /* Insert MIC into payload */ -+ for (j = 0; j < 8; j++) -+ pframe[payload_index+j] = mic[j]; /* message[payload_index+j] = mic[j]; */ -+ -+ payload_index = hdrlen + 8; -+ for (i = 0; i < num_blocks; i++) { -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ pframe, /* message, */ -+ pn_vector, -+ i+1, -+ frtype -+ ); /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, &pframe[payload_index], chain_buffer);/* bitwise_xor(aes_out, &message[payload_index], chain_buffer); */ -+ for (j = 0; j < 16; j++) -+ pframe[payload_index++] = chain_buffer[j];/* for (j = 0; j<16;j++) message[payload_index++] = chain_buffer[j]; */ -+ } -+ -+ if (payload_remainder > 0) { -+ /* If there is a short final block, then pad it,*/ -+ /* encrypt it and copy the unpadded part back */ -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ pframe, /* message, */ -+ pn_vector, -+ num_blocks+1, -+ frtype -+ ); /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ -+ for (j = 0; j < 16; j++) -+ padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) { -+ padded_buffer[j] = pframe[payload_index+j];/* padded_buffer[j] = message[payload_index+j]; */ -+ } -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ for (j = 0; j < payload_remainder; j++) -+ pframe[payload_index++] = chain_buffer[j];/* for (j = 0; jattrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+/* uint offset = 0; */ -+ u32 res = _SUCCESS; -+ -+ if (((struct xmit_frame *)pxmitframe)->buf_addr == NULL) -+ return _FAIL; -+ -+ hw_hdr_offset = TXDESC_OFFSET; -+ pframe = ((struct xmit_frame *)pxmitframe)->buf_addr + hw_hdr_offset; -+ -+ /* 4 start to encrypt each fragment */ -+ if ((pattrib->encrypt == _AES_)) { -+ RT_TRACE(_module_rtl871x_security_c_, _drv_err_, ("rtw_aes_encrypt: stainfo!= NULL!!!\n")); -+ -+ if (IS_MCAST(pattrib->ra)) -+ prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; -+ else -+ /* prwskey =&stainfo->dot118021x_UncstKey.skey[0]; */ -+ prwskey = pattrib->dot118021x_UncstKey.skey; -+ -+ prwskeylen = 16; -+ -+ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { -+ -+ if ((curfragnum+1) == pattrib->nr_frags) { /* 4 the last fragment */ -+ length = pattrib->last_txcmdsz-pattrib->hdrlen-pattrib->iv_len-pattrib->icv_len; -+ -+ aes_cipher(prwskey, pattrib->hdrlen, pframe, length); -+ } else { -+ length = pxmitpriv->frag_len-pattrib->hdrlen-pattrib->iv_len-pattrib->icv_len; -+ -+ aes_cipher(prwskey, pattrib->hdrlen, pframe, length); -+ pframe += pxmitpriv->frag_len; -+ pframe = (u8 *)RND4((SIZE_PTR)(pframe)); -+ -+ } -+ } -+ -+ AES_SW_ENC_CNT_INC(psecuritypriv, pattrib->ra); -+ } -+ return res; -+} -+ -+static sint aes_decipher(u8 *key, uint hdrlen, -+ u8 *pframe, uint plen) -+{ -+ static u8 message[MAX_MSG_SIZE]; -+ uint qc_exists, a4_exists, i, j, payload_remainder, -+ num_blocks, payload_index; -+ sint res = _SUCCESS; -+ u8 pn_vector[6]; -+ u8 mic_iv[16]; -+ u8 mic_header1[16]; -+ u8 mic_header2[16]; -+ u8 ctr_preload[16]; -+ -+ /* Intermediate Buffers */ -+ u8 chain_buffer[16]; -+ u8 aes_out[16]; -+ u8 padded_buffer[16]; -+ u8 mic[8]; -+ -+ -+/* uint offset = 0; */ -+ uint frtype = GetFrameType(pframe); -+ uint frsubtype = GetFrameSubType(pframe); -+ -+ frsubtype = frsubtype>>4; -+ -+ -+ memset((void *)mic_iv, 0, 16); -+ memset((void *)mic_header1, 0, 16); -+ memset((void *)mic_header2, 0, 16); -+ memset((void *)ctr_preload, 0, 16); -+ memset((void *)chain_buffer, 0, 16); -+ memset((void *)aes_out, 0, 16); -+ memset((void *)padded_buffer, 0, 16); -+ -+ /* start to decrypt the payload */ -+ -+ num_blocks = (plen-8) / 16; /* plen including LLC, payload_length and mic) */ -+ -+ payload_remainder = (plen-8) % 16; -+ -+ pn_vector[0] = pframe[hdrlen]; -+ pn_vector[1] = pframe[hdrlen+1]; -+ pn_vector[2] = pframe[hdrlen+4]; -+ pn_vector[3] = pframe[hdrlen+5]; -+ pn_vector[4] = pframe[hdrlen+6]; -+ pn_vector[5] = pframe[hdrlen+7]; -+ -+ if ((hdrlen == WLAN_HDR_A3_LEN) || (hdrlen == WLAN_HDR_A3_QOS_LEN)) -+ a4_exists = 0; -+ else -+ a4_exists = 1; -+ -+ if ( -+ ((frtype|frsubtype) == WIFI_DATA_CFACK) || -+ ((frtype|frsubtype) == WIFI_DATA_CFPOLL) || -+ ((frtype|frsubtype) == WIFI_DATA_CFACKPOLL)) { -+ qc_exists = 1; -+ if (hdrlen != WLAN_HDR_A3_QOS_LEN) { -+ -+ hdrlen += 2; -+ } -+ } else if ((frtype == WIFI_DATA) && /* only for data packet . add for CONFIG_IEEE80211W, none 11w also can use */ -+ ((frsubtype == 0x08) || -+ (frsubtype == 0x09) || -+ (frsubtype == 0x0a) || -+ (frsubtype == 0x0b))) { -+ if (hdrlen != WLAN_HDR_A3_QOS_LEN) { -+ -+ hdrlen += 2; -+ } -+ qc_exists = 1; -+ } else -+ qc_exists = 0; -+ -+ -+ /* now, decrypt pframe with hdrlen offset and plen long */ -+ -+ payload_index = hdrlen + 8; /* 8 is for extiv */ -+ -+ for (i = 0; i < num_blocks; i++) { -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ pframe, -+ pn_vector, -+ i+1, -+ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ ); -+ -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, &pframe[payload_index], chain_buffer); -+ -+ for (j = 0; j < 16; j++) -+ pframe[payload_index++] = chain_buffer[j]; -+ } -+ -+ if (payload_remainder > 0) { -+ /* If there is a short final block, then pad it,*/ -+ /* encrypt it and copy the unpadded part back */ -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ pframe, -+ pn_vector, -+ num_blocks+1, -+ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ ); -+ -+ for (j = 0; j < 16; j++) -+ padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) { -+ padded_buffer[j] = pframe[payload_index+j]; -+ } -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ for (j = 0; j < payload_remainder; j++) -+ pframe[payload_index++] = chain_buffer[j]; -+ } -+ -+ /* start to calculate the mic */ -+ if ((hdrlen + plen+8) <= MAX_MSG_SIZE) -+ memcpy((void *)message, pframe, (hdrlen + plen+8)); /* 8 is for ext iv len */ -+ -+ -+ pn_vector[0] = pframe[hdrlen]; -+ pn_vector[1] = pframe[hdrlen+1]; -+ pn_vector[2] = pframe[hdrlen+4]; -+ pn_vector[3] = pframe[hdrlen+5]; -+ pn_vector[4] = pframe[hdrlen+6]; -+ pn_vector[5] = pframe[hdrlen+7]; -+ -+ -+ -+ construct_mic_iv( -+ mic_iv, -+ qc_exists, -+ a4_exists, -+ message, -+ plen-8, -+ pn_vector, -+ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ ); -+ -+ construct_mic_header1( -+ mic_header1, -+ hdrlen, -+ message, -+ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ ); -+ construct_mic_header2( -+ mic_header2, -+ message, -+ a4_exists, -+ qc_exists -+ ); -+ -+ -+ payload_remainder = (plen-8) % 16; -+ num_blocks = (plen-8) / 16; -+ -+ /* Find start of payload */ -+ payload_index = (hdrlen + 8); -+ -+ /* Calculate MIC */ -+ aes128k128d(key, mic_iv, aes_out); -+ bitwise_xor(aes_out, mic_header1, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ bitwise_xor(aes_out, mic_header2, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ -+ for (i = 0; i < num_blocks; i++) { -+ bitwise_xor(aes_out, &message[payload_index], chain_buffer); -+ -+ payload_index += 16; -+ aes128k128d(key, chain_buffer, aes_out); -+ } -+ -+ /* Add on the final payload block if it needs padding */ -+ if (payload_remainder > 0) { -+ for (j = 0; j < 16; j++) -+ padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) { -+ padded_buffer[j] = message[payload_index++]; -+ } -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ -+ } -+ -+ for (j = 0; j < 8; j++) -+ mic[j] = aes_out[j]; -+ -+ /* Insert MIC into payload */ -+ for (j = 0; j < 8; j++) -+ message[payload_index+j] = mic[j]; -+ -+ payload_index = hdrlen + 8; -+ for (i = 0; i < num_blocks; i++) { -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ message, -+ pn_vector, -+ i+1, -+ frtype -+ ); /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, &message[payload_index], chain_buffer); -+ for (j = 0; j < 16; j++) -+ message[payload_index++] = chain_buffer[j]; -+ } -+ -+ if (payload_remainder > 0) { -+ /* If there is a short final block, then pad it,*/ -+ /* encrypt it and copy the unpadded part back */ -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ message, -+ pn_vector, -+ num_blocks+1, -+ frtype -+ ); /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ -+ for (j = 0; j < 16; j++) -+ padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) { -+ padded_buffer[j] = message[payload_index+j]; -+ } -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ for (j = 0; j < payload_remainder; j++) -+ message[payload_index++] = chain_buffer[j]; -+ } -+ -+ /* Encrypt the MIC */ -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ message, -+ pn_vector, -+ 0, -+ frtype -+ ); /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ -+ for (j = 0; j < 16; j++) -+ padded_buffer[j] = 0x00; -+ for (j = 0; j < 8; j++) { -+ padded_buffer[j] = message[j+hdrlen+8+plen-8]; -+ } -+ -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ for (j = 0; j < 8; j++) -+ message[payload_index++] = chain_buffer[j]; -+ -+ /* compare the mic */ -+ for (i = 0; i < 8; i++) { -+ if (pframe[hdrlen+8+plen-8+i] != message[hdrlen+8+plen-8+i]) { -+ RT_TRACE(_module_rtl871x_security_c_, _drv_err_, ("aes_decipher:mic check error mic[%d]: pframe(%x) != message(%x)\n", -+ i, pframe[hdrlen+8+plen-8+i], message[hdrlen+8+plen-8+i])); -+ DBG_871X("aes_decipher:mic check error mic[%d]: pframe(%x) != message(%x)\n", -+ i, pframe[hdrlen+8+plen-8+i], message[hdrlen+8+plen-8+i]); -+ res = _FAIL; -+ } -+ } -+ return res; -+} -+ -+u32 rtw_aes_decrypt(struct adapter *padapter, u8 *precvframe) -+{ /* exclude ICV */ -+ -+ -+ /*static*/ -+/* unsigned char message[MAX_MSG_SIZE]; */ -+ -+ -+ /* Intermediate Buffers */ -+ -+ -+ sint length; -+ u8 *pframe, *prwskey; /* *payload,*iv */ -+ struct sta_info *stainfo; -+ struct rx_pkt_attrib *prxattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+/* struct recv_priv *precvpriv =&padapter->recvpriv; */ -+ u32 res = _SUCCESS; -+ -+ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; -+ /* 4 start to encrypt each fragment */ -+ if ((prxattrib->encrypt == _AES_)) { -+ -+ stainfo = rtw_get_stainfo(&padapter->stapriv, &prxattrib->ta[0]); -+ if (stainfo != NULL) { -+ RT_TRACE(_module_rtl871x_security_c_, _drv_err_, ("rtw_aes_decrypt: stainfo!= NULL!!!\n")); -+ -+ if (IS_MCAST(prxattrib->ra)) { -+ static unsigned long start = 0; -+ static u32 no_gkey_bc_cnt = 0; -+ static u32 no_gkey_mc_cnt = 0; -+ -+ /* DBG_871X("rx bc/mc packets, to perform sw rtw_aes_decrypt\n"); */ -+ /* prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; */ -+ if (psecuritypriv->binstallGrpkey == false) { -+ res = _FAIL; -+ -+ if (start == 0) -+ start = jiffies; -+ -+ if (is_broadcast_mac_addr(prxattrib->ra)) -+ no_gkey_bc_cnt++; -+ else -+ no_gkey_mc_cnt++; -+ -+ if (jiffies_to_msecs(jiffies - start) > 1000) { -+ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", -+ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); -+ } -+ start = jiffies; -+ no_gkey_bc_cnt = 0; -+ no_gkey_mc_cnt = 0; -+ } -+ -+ goto exit; -+ } -+ -+ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" gkey installed. no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", -+ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); -+ } -+ start = 0; -+ no_gkey_bc_cnt = 0; -+ no_gkey_mc_cnt = 0; -+ -+ prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; -+ if (psecuritypriv->dot118021XGrpKeyid != prxattrib->key_index) { -+ DBG_871X("not match packet_index =%d, install_index =%d\n" -+ , prxattrib->key_index, psecuritypriv->dot118021XGrpKeyid); -+ res = _FAIL; -+ goto exit; -+ } -+ } else -+ prwskey = &stainfo->dot118021x_UncstKey.skey[0]; -+ -+ -+ length = ((union recv_frame *)precvframe)->u.hdr.len-prxattrib->hdrlen-prxattrib->iv_len; -+ -+ res = aes_decipher(prwskey, prxattrib->hdrlen, pframe, length); -+ -+ AES_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); -+ } else { -+ RT_TRACE(_module_rtl871x_security_c_, _drv_err_, ("rtw_aes_decrypt: stainfo == NULL!!!\n")); -+ res = _FAIL; -+ } -+ } -+exit: -+ return res; -+} -+ -+u32 rtw_BIP_verify(struct adapter *padapter, u8 *precvframe) -+{ -+ struct rx_pkt_attrib *pattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; -+ u8 *pframe; -+ u8 *BIP_AAD, *p; -+ u32 res = _FAIL; -+ uint len, ori_len; -+ struct ieee80211_hdr *pwlanhdr; -+ u8 mic[16]; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ __le16 le_tmp; -+ __le64 le_tmp64; -+ -+ ori_len = pattrib->pkt_len-WLAN_HDR_A3_LEN+BIP_AAD_SIZE; -+ BIP_AAD = rtw_zmalloc(ori_len); -+ -+ if (BIP_AAD == NULL) { -+ DBG_871X("BIP AAD allocate fail\n"); -+ return _FAIL; -+ } -+ /* PKT start */ -+ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; -+ /* mapping to wlan header */ -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ /* save the frame body + MME */ -+ memcpy(BIP_AAD+BIP_AAD_SIZE, pframe+WLAN_HDR_A3_LEN, pattrib->pkt_len-WLAN_HDR_A3_LEN); -+ /* find MME IE pointer */ -+ p = rtw_get_ie(BIP_AAD+BIP_AAD_SIZE, _MME_IE_, &len, pattrib->pkt_len-WLAN_HDR_A3_LEN); -+ /* Baron */ -+ if (p) { -+ u16 keyid = 0; -+ u64 temp_ipn = 0; -+ /* save packet number */ -+ memcpy(&le_tmp64, p+4, 6); -+ temp_ipn = le64_to_cpu(le_tmp64); -+ /* BIP packet number should bigger than previous BIP packet */ -+ if (temp_ipn <= pmlmeext->mgnt_80211w_IPN_rx) { -+ DBG_871X("replay BIP packet\n"); -+ goto BIP_exit; -+ } -+ /* copy key index */ -+ memcpy(&le_tmp, p+2, 2); -+ keyid = le16_to_cpu(le_tmp); -+ if (keyid != padapter->securitypriv.dot11wBIPKeyid) { -+ DBG_871X("BIP key index error!\n"); -+ goto BIP_exit; -+ } -+ /* clear the MIC field of MME to zero */ -+ memset(p+2+len-8, 0, 8); -+ -+ /* conscruct AAD, copy frame control field */ -+ memcpy(BIP_AAD, &pwlanhdr->frame_control, 2); -+ ClearRetry(BIP_AAD); -+ ClearPwrMgt(BIP_AAD); -+ ClearMData(BIP_AAD); -+ /* conscruct AAD, copy address 1 to address 3 */ -+ memcpy(BIP_AAD+2, pwlanhdr->addr1, 18); -+ -+ if (omac1_aes_128(padapter->securitypriv.dot11wBIPKey[padapter->securitypriv.dot11wBIPKeyid].skey -+ , BIP_AAD, ori_len, mic)) -+ goto BIP_exit; -+ -+ /* MIC field should be last 8 bytes of packet (packet without FCS) */ -+ if (!memcmp(mic, pframe+pattrib->pkt_len-8, 8)) { -+ pmlmeext->mgnt_80211w_IPN_rx = temp_ipn; -+ res = _SUCCESS; -+ } else -+ DBG_871X("BIP MIC error!\n"); -+ -+ } else -+ res = RTW_RX_HANDLED; -+BIP_exit: -+ -+ kfree(BIP_AAD); -+ return res; -+} -+ -+/* AES tables*/ -+const u32 Te0[256] = { -+ 0xc66363a5U, 0xf87c7c84U, 0xee777799U, 0xf67b7b8dU, -+ 0xfff2f20dU, 0xd66b6bbdU, 0xde6f6fb1U, 0x91c5c554U, -+ 0x60303050U, 0x02010103U, 0xce6767a9U, 0x562b2b7dU, -+ 0xe7fefe19U, 0xb5d7d762U, 0x4dababe6U, 0xec76769aU, -+ 0x8fcaca45U, 0x1f82829dU, 0x89c9c940U, 0xfa7d7d87U, -+ 0xeffafa15U, 0xb25959ebU, 0x8e4747c9U, 0xfbf0f00bU, -+ 0x41adadecU, 0xb3d4d467U, 0x5fa2a2fdU, 0x45afafeaU, -+ 0x239c9cbfU, 0x53a4a4f7U, 0xe4727296U, 0x9bc0c05bU, -+ 0x75b7b7c2U, 0xe1fdfd1cU, 0x3d9393aeU, 0x4c26266aU, -+ 0x6c36365aU, 0x7e3f3f41U, 0xf5f7f702U, 0x83cccc4fU, -+ 0x6834345cU, 0x51a5a5f4U, 0xd1e5e534U, 0xf9f1f108U, -+ 0xe2717193U, 0xabd8d873U, 0x62313153U, 0x2a15153fU, -+ 0x0804040cU, 0x95c7c752U, 0x46232365U, 0x9dc3c35eU, -+ 0x30181828U, 0x379696a1U, 0x0a05050fU, 0x2f9a9ab5U, -+ 0x0e070709U, 0x24121236U, 0x1b80809bU, 0xdfe2e23dU, -+ 0xcdebeb26U, 0x4e272769U, 0x7fb2b2cdU, 0xea75759fU, -+ 0x1209091bU, 0x1d83839eU, 0x582c2c74U, 0x341a1a2eU, -+ 0x361b1b2dU, 0xdc6e6eb2U, 0xb45a5aeeU, 0x5ba0a0fbU, -+ 0xa45252f6U, 0x763b3b4dU, 0xb7d6d661U, 0x7db3b3ceU, -+ 0x5229297bU, 0xdde3e33eU, 0x5e2f2f71U, 0x13848497U, -+ 0xa65353f5U, 0xb9d1d168U, 0x00000000U, 0xc1eded2cU, -+ 0x40202060U, 0xe3fcfc1fU, 0x79b1b1c8U, 0xb65b5bedU, -+ 0xd46a6abeU, 0x8dcbcb46U, 0x67bebed9U, 0x7239394bU, -+ 0x944a4adeU, 0x984c4cd4U, 0xb05858e8U, 0x85cfcf4aU, -+ 0xbbd0d06bU, 0xc5efef2aU, 0x4faaaae5U, 0xedfbfb16U, -+ 0x864343c5U, 0x9a4d4dd7U, 0x66333355U, 0x11858594U, -+ 0x8a4545cfU, 0xe9f9f910U, 0x04020206U, 0xfe7f7f81U, -+ 0xa05050f0U, 0x783c3c44U, 0x259f9fbaU, 0x4ba8a8e3U, -+ 0xa25151f3U, 0x5da3a3feU, 0x804040c0U, 0x058f8f8aU, -+ 0x3f9292adU, 0x219d9dbcU, 0x70383848U, 0xf1f5f504U, -+ 0x63bcbcdfU, 0x77b6b6c1U, 0xafdada75U, 0x42212163U, -+ 0x20101030U, 0xe5ffff1aU, 0xfdf3f30eU, 0xbfd2d26dU, -+ 0x81cdcd4cU, 0x180c0c14U, 0x26131335U, 0xc3ecec2fU, -+ 0xbe5f5fe1U, 0x359797a2U, 0x884444ccU, 0x2e171739U, -+ 0x93c4c457U, 0x55a7a7f2U, 0xfc7e7e82U, 0x7a3d3d47U, -+ 0xc86464acU, 0xba5d5de7U, 0x3219192bU, 0xe6737395U, -+ 0xc06060a0U, 0x19818198U, 0x9e4f4fd1U, 0xa3dcdc7fU, -+ 0x44222266U, 0x542a2a7eU, 0x3b9090abU, 0x0b888883U, -+ 0x8c4646caU, 0xc7eeee29U, 0x6bb8b8d3U, 0x2814143cU, -+ 0xa7dede79U, 0xbc5e5ee2U, 0x160b0b1dU, 0xaddbdb76U, -+ 0xdbe0e03bU, 0x64323256U, 0x743a3a4eU, 0x140a0a1eU, -+ 0x924949dbU, 0x0c06060aU, 0x4824246cU, 0xb85c5ce4U, -+ 0x9fc2c25dU, 0xbdd3d36eU, 0x43acacefU, 0xc46262a6U, -+ 0x399191a8U, 0x319595a4U, 0xd3e4e437U, 0xf279798bU, -+ 0xd5e7e732U, 0x8bc8c843U, 0x6e373759U, 0xda6d6db7U, -+ 0x018d8d8cU, 0xb1d5d564U, 0x9c4e4ed2U, 0x49a9a9e0U, -+ 0xd86c6cb4U, 0xac5656faU, 0xf3f4f407U, 0xcfeaea25U, -+ 0xca6565afU, 0xf47a7a8eU, 0x47aeaee9U, 0x10080818U, -+ 0x6fbabad5U, 0xf0787888U, 0x4a25256fU, 0x5c2e2e72U, -+ 0x381c1c24U, 0x57a6a6f1U, 0x73b4b4c7U, 0x97c6c651U, -+ 0xcbe8e823U, 0xa1dddd7cU, 0xe874749cU, 0x3e1f1f21U, -+ 0x964b4bddU, 0x61bdbddcU, 0x0d8b8b86U, 0x0f8a8a85U, -+ 0xe0707090U, 0x7c3e3e42U, 0x71b5b5c4U, 0xcc6666aaU, -+ 0x904848d8U, 0x06030305U, 0xf7f6f601U, 0x1c0e0e12U, -+ 0xc26161a3U, 0x6a35355fU, 0xae5757f9U, 0x69b9b9d0U, -+ 0x17868691U, 0x99c1c158U, 0x3a1d1d27U, 0x279e9eb9U, -+ 0xd9e1e138U, 0xebf8f813U, 0x2b9898b3U, 0x22111133U, -+ 0xd26969bbU, 0xa9d9d970U, 0x078e8e89U, 0x339494a7U, -+ 0x2d9b9bb6U, 0x3c1e1e22U, 0x15878792U, 0xc9e9e920U, -+ 0x87cece49U, 0xaa5555ffU, 0x50282878U, 0xa5dfdf7aU, -+ 0x038c8c8fU, 0x59a1a1f8U, 0x09898980U, 0x1a0d0d17U, -+ 0x65bfbfdaU, 0xd7e6e631U, 0x844242c6U, 0xd06868b8U, -+ 0x824141c3U, 0x299999b0U, 0x5a2d2d77U, 0x1e0f0f11U, -+ 0x7bb0b0cbU, 0xa85454fcU, 0x6dbbbbd6U, 0x2c16163aU, -+}; -+const u32 Td0[256] = { -+ 0x51f4a750U, 0x7e416553U, 0x1a17a4c3U, 0x3a275e96U, -+ 0x3bab6bcbU, 0x1f9d45f1U, 0xacfa58abU, 0x4be30393U, -+ 0x2030fa55U, 0xad766df6U, 0x88cc7691U, 0xf5024c25U, -+ 0x4fe5d7fcU, 0xc52acbd7U, 0x26354480U, 0xb562a38fU, -+ 0xdeb15a49U, 0x25ba1b67U, 0x45ea0e98U, 0x5dfec0e1U, -+ 0xc32f7502U, 0x814cf012U, 0x8d4697a3U, 0x6bd3f9c6U, -+ 0x038f5fe7U, 0x15929c95U, 0xbf6d7aebU, 0x955259daU, -+ 0xd4be832dU, 0x587421d3U, 0x49e06929U, 0x8ec9c844U, -+ 0x75c2896aU, 0xf48e7978U, 0x99583e6bU, 0x27b971ddU, -+ 0xbee14fb6U, 0xf088ad17U, 0xc920ac66U, 0x7dce3ab4U, -+ 0x63df4a18U, 0xe51a3182U, 0x97513360U, 0x62537f45U, -+ 0xb16477e0U, 0xbb6bae84U, 0xfe81a01cU, 0xf9082b94U, -+ 0x70486858U, 0x8f45fd19U, 0x94de6c87U, 0x527bf8b7U, -+ 0xab73d323U, 0x724b02e2U, 0xe31f8f57U, 0x6655ab2aU, -+ 0xb2eb2807U, 0x2fb5c203U, 0x86c57b9aU, 0xd33708a5U, -+ 0x302887f2U, 0x23bfa5b2U, 0x02036abaU, 0xed16825cU, -+ 0x8acf1c2bU, 0xa779b492U, 0xf307f2f0U, 0x4e69e2a1U, -+ 0x65daf4cdU, 0x0605bed5U, 0xd134621fU, 0xc4a6fe8aU, -+ 0x342e539dU, 0xa2f355a0U, 0x058ae132U, 0xa4f6eb75U, -+ 0x0b83ec39U, 0x4060efaaU, 0x5e719f06U, 0xbd6e1051U, -+ 0x3e218af9U, 0x96dd063dU, 0xdd3e05aeU, 0x4de6bd46U, -+ 0x91548db5U, 0x71c45d05U, 0x0406d46fU, 0x605015ffU, -+ 0x1998fb24U, 0xd6bde997U, 0x894043ccU, 0x67d99e77U, -+ 0xb0e842bdU, 0x07898b88U, 0xe7195b38U, 0x79c8eedbU, -+ 0xa17c0a47U, 0x7c420fe9U, 0xf8841ec9U, 0x00000000U, -+ 0x09808683U, 0x322bed48U, 0x1e1170acU, 0x6c5a724eU, -+ 0xfd0efffbU, 0x0f853856U, 0x3daed51eU, 0x362d3927U, -+ 0x0a0fd964U, 0x685ca621U, 0x9b5b54d1U, 0x24362e3aU, -+ 0x0c0a67b1U, 0x9357e70fU, 0xb4ee96d2U, 0x1b9b919eU, -+ 0x80c0c54fU, 0x61dc20a2U, 0x5a774b69U, 0x1c121a16U, -+ 0xe293ba0aU, 0xc0a02ae5U, 0x3c22e043U, 0x121b171dU, -+ 0x0e090d0bU, 0xf28bc7adU, 0x2db6a8b9U, 0x141ea9c8U, -+ 0x57f11985U, 0xaf75074cU, 0xee99ddbbU, 0xa37f60fdU, -+ 0xf701269fU, 0x5c72f5bcU, 0x44663bc5U, 0x5bfb7e34U, -+ 0x8b432976U, 0xcb23c6dcU, 0xb6edfc68U, 0xb8e4f163U, -+ 0xd731dccaU, 0x42638510U, 0x13972240U, 0x84c61120U, -+ 0x854a247dU, 0xd2bb3df8U, 0xaef93211U, 0xc729a16dU, -+ 0x1d9e2f4bU, 0xdcb230f3U, 0x0d8652ecU, 0x77c1e3d0U, -+ 0x2bb3166cU, 0xa970b999U, 0x119448faU, 0x47e96422U, -+ 0xa8fc8cc4U, 0xa0f03f1aU, 0x567d2cd8U, 0x223390efU, -+ 0x87494ec7U, 0xd938d1c1U, 0x8ccaa2feU, 0x98d40b36U, -+ 0xa6f581cfU, 0xa57ade28U, 0xdab78e26U, 0x3fadbfa4U, -+ 0x2c3a9de4U, 0x5078920dU, 0x6a5fcc9bU, 0x547e4662U, -+ 0xf68d13c2U, 0x90d8b8e8U, 0x2e39f75eU, 0x82c3aff5U, -+ 0x9f5d80beU, 0x69d0937cU, 0x6fd52da9U, 0xcf2512b3U, -+ 0xc8ac993bU, 0x10187da7U, 0xe89c636eU, 0xdb3bbb7bU, -+ 0xcd267809U, 0x6e5918f4U, 0xec9ab701U, 0x834f9aa8U, -+ 0xe6956e65U, 0xaaffe67eU, 0x21bccf08U, 0xef15e8e6U, -+ 0xbae79bd9U, 0x4a6f36ceU, 0xea9f09d4U, 0x29b07cd6U, -+ 0x31a4b2afU, 0x2a3f2331U, 0xc6a59430U, 0x35a266c0U, -+ 0x744ebc37U, 0xfc82caa6U, 0xe090d0b0U, 0x33a7d815U, -+ 0xf104984aU, 0x41ecdaf7U, 0x7fcd500eU, 0x1791f62fU, -+ 0x764dd68dU, 0x43efb04dU, 0xccaa4d54U, 0xe49604dfU, -+ 0x9ed1b5e3U, 0x4c6a881bU, 0xc12c1fb8U, 0x4665517fU, -+ 0x9d5eea04U, 0x018c355dU, 0xfa877473U, 0xfb0b412eU, -+ 0xb3671d5aU, 0x92dbd252U, 0xe9105633U, 0x6dd64713U, -+ 0x9ad7618cU, 0x37a10c7aU, 0x59f8148eU, 0xeb133c89U, -+ 0xcea927eeU, 0xb761c935U, 0xe11ce5edU, 0x7a47b13cU, -+ 0x9cd2df59U, 0x55f2733fU, 0x1814ce79U, 0x73c737bfU, -+ 0x53f7cdeaU, 0x5ffdaa5bU, 0xdf3d6f14U, 0x7844db86U, -+ 0xcaaff381U, 0xb968c43eU, 0x3824342cU, 0xc2a3405fU, -+ 0x161dc372U, 0xbce2250cU, 0x283c498bU, 0xff0d9541U, -+ 0x39a80171U, 0x080cb3deU, 0xd8b4e49cU, 0x6456c190U, -+ 0x7bcb8461U, 0xd532b670U, 0x486c5c74U, 0xd0b85742U, -+}; -+const u8 Td4s[256] = { -+ 0x52U, 0x09U, 0x6aU, 0xd5U, 0x30U, 0x36U, 0xa5U, 0x38U, -+ 0xbfU, 0x40U, 0xa3U, 0x9eU, 0x81U, 0xf3U, 0xd7U, 0xfbU, -+ 0x7cU, 0xe3U, 0x39U, 0x82U, 0x9bU, 0x2fU, 0xffU, 0x87U, -+ 0x34U, 0x8eU, 0x43U, 0x44U, 0xc4U, 0xdeU, 0xe9U, 0xcbU, -+ 0x54U, 0x7bU, 0x94U, 0x32U, 0xa6U, 0xc2U, 0x23U, 0x3dU, -+ 0xeeU, 0x4cU, 0x95U, 0x0bU, 0x42U, 0xfaU, 0xc3U, 0x4eU, -+ 0x08U, 0x2eU, 0xa1U, 0x66U, 0x28U, 0xd9U, 0x24U, 0xb2U, -+ 0x76U, 0x5bU, 0xa2U, 0x49U, 0x6dU, 0x8bU, 0xd1U, 0x25U, -+ 0x72U, 0xf8U, 0xf6U, 0x64U, 0x86U, 0x68U, 0x98U, 0x16U, -+ 0xd4U, 0xa4U, 0x5cU, 0xccU, 0x5dU, 0x65U, 0xb6U, 0x92U, -+ 0x6cU, 0x70U, 0x48U, 0x50U, 0xfdU, 0xedU, 0xb9U, 0xdaU, -+ 0x5eU, 0x15U, 0x46U, 0x57U, 0xa7U, 0x8dU, 0x9dU, 0x84U, -+ 0x90U, 0xd8U, 0xabU, 0x00U, 0x8cU, 0xbcU, 0xd3U, 0x0aU, -+ 0xf7U, 0xe4U, 0x58U, 0x05U, 0xb8U, 0xb3U, 0x45U, 0x06U, -+ 0xd0U, 0x2cU, 0x1eU, 0x8fU, 0xcaU, 0x3fU, 0x0fU, 0x02U, -+ 0xc1U, 0xafU, 0xbdU, 0x03U, 0x01U, 0x13U, 0x8aU, 0x6bU, -+ 0x3aU, 0x91U, 0x11U, 0x41U, 0x4fU, 0x67U, 0xdcU, 0xeaU, -+ 0x97U, 0xf2U, 0xcfU, 0xceU, 0xf0U, 0xb4U, 0xe6U, 0x73U, -+ 0x96U, 0xacU, 0x74U, 0x22U, 0xe7U, 0xadU, 0x35U, 0x85U, -+ 0xe2U, 0xf9U, 0x37U, 0xe8U, 0x1cU, 0x75U, 0xdfU, 0x6eU, -+ 0x47U, 0xf1U, 0x1aU, 0x71U, 0x1dU, 0x29U, 0xc5U, 0x89U, -+ 0x6fU, 0xb7U, 0x62U, 0x0eU, 0xaaU, 0x18U, 0xbeU, 0x1bU, -+ 0xfcU, 0x56U, 0x3eU, 0x4bU, 0xc6U, 0xd2U, 0x79U, 0x20U, -+ 0x9aU, 0xdbU, 0xc0U, 0xfeU, 0x78U, 0xcdU, 0x5aU, 0xf4U, -+ 0x1fU, 0xddU, 0xa8U, 0x33U, 0x88U, 0x07U, 0xc7U, 0x31U, -+ 0xb1U, 0x12U, 0x10U, 0x59U, 0x27U, 0x80U, 0xecU, 0x5fU, -+ 0x60U, 0x51U, 0x7fU, 0xa9U, 0x19U, 0xb5U, 0x4aU, 0x0dU, -+ 0x2dU, 0xe5U, 0x7aU, 0x9fU, 0x93U, 0xc9U, 0x9cU, 0xefU, -+ 0xa0U, 0xe0U, 0x3bU, 0x4dU, 0xaeU, 0x2aU, 0xf5U, 0xb0U, -+ 0xc8U, 0xebU, 0xbbU, 0x3cU, 0x83U, 0x53U, 0x99U, 0x61U, -+ 0x17U, 0x2bU, 0x04U, 0x7eU, 0xbaU, 0x77U, 0xd6U, 0x26U, -+ 0xe1U, 0x69U, 0x14U, 0x63U, 0x55U, 0x21U, 0x0cU, 0x7dU, -+}; -+const u8 rcons[] = { -+ 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x1B, 0x36 -+ /* for 128-bit blocks, Rijndael never uses more than 10 rcon values */ -+}; -+ -+/** -+ * Expand the cipher key into the encryption key schedule. -+ * -+ * @return the number of rounds for the given cipher key size. -+ */ -+static void rijndaelKeySetupEnc(u32 rk[/*44*/], const u8 cipherKey[]) -+{ -+ int i; -+ u32 temp; -+ -+ rk[0] = GETU32(cipherKey); -+ rk[1] = GETU32(cipherKey + 4); -+ rk[2] = GETU32(cipherKey + 8); -+ rk[3] = GETU32(cipherKey + 12); -+ for (i = 0; i < 10; i++) { -+ temp = rk[3]; -+ rk[4] = rk[0] ^ -+ TE421(temp) ^ TE432(temp) ^ TE443(temp) ^ TE414(temp) ^ -+ RCON(i); -+ rk[5] = rk[1] ^ rk[4]; -+ rk[6] = rk[2] ^ rk[5]; -+ rk[7] = rk[3] ^ rk[6]; -+ rk += 4; -+ } -+} -+ -+static void rijndaelEncrypt(u32 rk[/*44*/], u8 pt[16], u8 ct[16]) -+{ -+ u32 s0, s1, s2, s3, t0, t1, t2, t3; -+ int Nr = 10; -+ int r; -+ -+ /* -+ * map byte array block to cipher state -+ * and add initial round key: -+ */ -+ s0 = GETU32(pt) ^ rk[0]; -+ s1 = GETU32(pt + 4) ^ rk[1]; -+ s2 = GETU32(pt + 8) ^ rk[2]; -+ s3 = GETU32(pt + 12) ^ rk[3]; -+ -+#define ROUND(i, d, s) \ -+d##0 = TE0(s##0) ^ TE1(s##1) ^ TE2(s##2) ^ TE3(s##3) ^ rk[4 * i]; \ -+d##1 = TE0(s##1) ^ TE1(s##2) ^ TE2(s##3) ^ TE3(s##0) ^ rk[4 * i + 1]; \ -+d##2 = TE0(s##2) ^ TE1(s##3) ^ TE2(s##0) ^ TE3(s##1) ^ rk[4 * i + 2]; \ -+d##3 = TE0(s##3) ^ TE1(s##0) ^ TE2(s##1) ^ TE3(s##2) ^ rk[4 * i + 3] -+ -+ /* Nr - 1 full rounds: */ -+ r = Nr >> 1; -+ for (;;) { -+ ROUND(1, t, s); -+ rk += 8; -+ if (--r == 0) -+ break; -+ ROUND(0, s, t); -+ } -+ -+#undef ROUND -+ -+ /* -+ * apply last round and -+ * map cipher state to byte array block: -+ */ -+ s0 = TE41(t0) ^ TE42(t1) ^ TE43(t2) ^ TE44(t3) ^ rk[0]; -+ PUTU32(ct, s0); -+ s1 = TE41(t1) ^ TE42(t2) ^ TE43(t3) ^ TE44(t0) ^ rk[1]; -+ PUTU32(ct + 4, s1); -+ s2 = TE41(t2) ^ TE42(t3) ^ TE43(t0) ^ TE44(t1) ^ rk[2]; -+ PUTU32(ct + 8, s2); -+ s3 = TE41(t3) ^ TE42(t0) ^ TE43(t1) ^ TE44(t2) ^ rk[3]; -+ PUTU32(ct + 12, s3); -+} -+ -+static void *aes_encrypt_init(u8 *key, size_t len) -+{ -+ u32 *rk; -+ if (len != 16) -+ return NULL; -+ rk = (u32 *)rtw_malloc(AES_PRIV_SIZE); -+ if (rk == NULL) -+ return NULL; -+ rijndaelKeySetupEnc(rk, key); -+ return rk; -+} -+ -+static void aes_128_encrypt(void *ctx, u8 *plain, u8 *crypt) -+{ -+ rijndaelEncrypt(ctx, plain, crypt); -+} -+ -+ -+static void gf_mulx(u8 *pad) -+{ -+ int i, carry; -+ -+ carry = pad[0] & 0x80; -+ for (i = 0; i < AES_BLOCK_SIZE - 1; i++) -+ pad[i] = (pad[i] << 1) | (pad[i + 1] >> 7); -+ -+ pad[AES_BLOCK_SIZE - 1] <<= 1; -+ if (carry) -+ pad[AES_BLOCK_SIZE - 1] ^= 0x87; -+} -+ -+static void aes_encrypt_deinit(void *ctx) -+{ -+ memset(ctx, 0, AES_PRIV_SIZE); -+ kfree(ctx); -+} -+ -+ -+/** -+ * omac1_aes_128_vector - One-Key CBC MAC (OMAC1) hash with AES-128 -+ * @key: 128-bit key for the hash operation -+ * @num_elem: Number of elements in the data vector -+ * @addr: Pointers to the data areas -+ * @len: Lengths of the data blocks -+ * @mac: Buffer for MAC (128 bits, i.e., 16 bytes) -+ * Returns: 0 on success, -1 on failure -+ * -+ * This is a mode for using block cipher (AES in this case) for authentication. -+ * OMAC1 was standardized with the name CMAC by NIST in a Special Publication -+ * (SP) 800-38B. -+ */ -+static int omac1_aes_128_vector(u8 *key, size_t num_elem, -+ u8 *addr[], size_t *len, u8 *mac) -+{ -+ void *ctx; -+ u8 cbc[AES_BLOCK_SIZE], pad[AES_BLOCK_SIZE]; -+ u8 *pos, *end; -+ size_t i, e, left, total_len; -+ -+ ctx = aes_encrypt_init(key, 16); -+ if (ctx == NULL) -+ return -1; -+ memset(cbc, 0, AES_BLOCK_SIZE); -+ -+ total_len = 0; -+ for (e = 0; e < num_elem; e++) -+ total_len += len[e]; -+ left = total_len; -+ -+ e = 0; -+ pos = addr[0]; -+ end = pos + len[0]; -+ -+ while (left >= AES_BLOCK_SIZE) { -+ for (i = 0; i < AES_BLOCK_SIZE; i++) { -+ cbc[i] ^= *pos++; -+ if (pos >= end) { -+ e++; -+ pos = addr[e]; -+ end = pos + len[e]; -+ } -+ } -+ if (left > AES_BLOCK_SIZE) -+ aes_128_encrypt(ctx, cbc, cbc); -+ left -= AES_BLOCK_SIZE; -+ } -+ -+ memset(pad, 0, AES_BLOCK_SIZE); -+ aes_128_encrypt(ctx, pad, pad); -+ gf_mulx(pad); -+ -+ if (left || total_len == 0) { -+ for (i = 0; i < left; i++) { -+ cbc[i] ^= *pos++; -+ if (pos >= end) { -+ e++; -+ pos = addr[e]; -+ end = pos + len[e]; -+ } -+ } -+ cbc[left] ^= 0x80; -+ gf_mulx(pad); -+ } -+ -+ for (i = 0; i < AES_BLOCK_SIZE; i++) -+ pad[i] ^= cbc[i]; -+ aes_128_encrypt(ctx, pad, mac); -+ aes_encrypt_deinit(ctx); -+ return 0; -+} -+ -+ -+/** -+ * omac1_aes_128 - One-Key CBC MAC (OMAC1) hash with AES-128 (aka AES-CMAC) -+ * @key: 128-bit key for the hash operation -+ * @data: Data buffer for which a MAC is determined -+ * @data_len: Length of data buffer in bytes -+ * @mac: Buffer for MAC (128 bits, i.e., 16 bytes) -+ * Returns: 0 on success, -1 on failure -+ * -+ * This is a mode for using block cipher (AES in this case) for authentication. -+ * OMAC1 was standardized with the name CMAC by NIST in a Special Publication -+ * (SP) 800-38B. -+ * modify for CONFIG_IEEE80211W */ -+int omac1_aes_128(u8 *key, u8 *data, size_t data_len, u8 *mac) -+{ -+ return omac1_aes_128_vector(key, 1, &data, &data_len, mac); -+} -+ -+/* Restore HW wep key setting according to key_mask */ -+void rtw_sec_restore_wep_key(struct adapter *adapter) -+{ -+ struct security_priv *securitypriv = &(adapter->securitypriv); -+ sint keyid; -+ -+ if ((_WEP40_ == securitypriv->dot11PrivacyAlgrthm) || (_WEP104_ == securitypriv->dot11PrivacyAlgrthm)) { -+ for (keyid = 0; keyid < 4; keyid++) { -+ if (securitypriv->key_mask & BIT(keyid)) { -+ if (keyid == securitypriv->dot11PrivacyKeyIndex) -+ rtw_set_key(adapter, securitypriv, keyid, 1, false); -+ else -+ rtw_set_key(adapter, securitypriv, keyid, 0, false); -+ } -+ } -+ } -+} -+ -+u8 rtw_handle_tkip_countermeasure(struct adapter *adapter, const char *caller) -+{ -+ struct security_priv *securitypriv = &(adapter->securitypriv); -+ u8 status = _SUCCESS; -+ -+ if (securitypriv->btkip_countermeasure == true) { -+ unsigned long passing_ms = jiffies_to_msecs(jiffies - securitypriv->btkip_countermeasure_time); -+ if (passing_ms > 60*1000) { -+ DBG_871X_LEVEL(_drv_always_, "%s("ADPT_FMT") countermeasure time:%lus > 60s\n", -+ caller, ADPT_ARG(adapter), passing_ms/1000); -+ securitypriv->btkip_countermeasure = false; -+ securitypriv->btkip_countermeasure_time = 0; -+ } else { -+ DBG_871X_LEVEL(_drv_always_, "%s("ADPT_FMT") countermeasure time:%lus < 60s\n", -+ caller, ADPT_ARG(adapter), passing_ms/1000); -+ status = _FAIL; -+ } -+ } -+ -+ return status; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_sta_mgt.c linux/3rdparty/rtl8723bs/core/rtw_sta_mgt.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_sta_mgt.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_sta_mgt.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,641 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_STA_MGT_C_ -+ -+#include -+#include -+ -+void _rtw_init_stainfo(struct sta_info *psta); -+void _rtw_init_stainfo(struct sta_info *psta) -+{ -+ memset((u8 *)psta, 0, sizeof(struct sta_info)); -+ -+ spin_lock_init(&psta->lock); -+ INIT_LIST_HEAD(&psta->list); -+ INIT_LIST_HEAD(&psta->hash_list); -+ /* INIT_LIST_HEAD(&psta->asoc_list); */ -+ /* INIT_LIST_HEAD(&psta->sleep_list); */ -+ /* INIT_LIST_HEAD(&psta->wakeup_list); */ -+ -+ _rtw_init_queue(&psta->sleep_q); -+ psta->sleepq_len = 0; -+ -+ _rtw_init_sta_xmit_priv(&psta->sta_xmitpriv); -+ _rtw_init_sta_recv_priv(&psta->sta_recvpriv); -+ -+ INIT_LIST_HEAD(&psta->asoc_list); -+ -+ INIT_LIST_HEAD(&psta->auth_list); -+ -+ psta->expire_to = 0; -+ -+ psta->flags = 0; -+ -+ psta->capability = 0; -+ -+ psta->bpairwise_key_installed = false; -+ -+ psta->nonerp_set = 0; -+ psta->no_short_slot_time_set = 0; -+ psta->no_short_preamble_set = 0; -+ psta->no_ht_gf_set = 0; -+ psta->no_ht_set = 0; -+ psta->ht_20mhz_set = 0; -+ -+ psta->under_exist_checking = 0; -+ -+ psta->keep_alive_trycnt = 0; -+} -+ -+u32 _rtw_init_sta_priv(struct sta_priv *pstapriv) -+{ -+ struct sta_info *psta; -+ s32 i; -+ -+ pstapriv->pallocated_stainfo_buf = vzalloc(sizeof(struct sta_info) * NUM_STA+4); -+ -+ if (!pstapriv->pallocated_stainfo_buf) -+ return _FAIL; -+ -+ pstapriv->pstainfo_buf = pstapriv->pallocated_stainfo_buf + 4 - -+ ((SIZE_PTR)(pstapriv->pallocated_stainfo_buf) & 3); -+ -+ _rtw_init_queue(&pstapriv->free_sta_queue); -+ -+ spin_lock_init(&pstapriv->sta_hash_lock); -+ -+ /* _rtw_init_queue(&pstapriv->asoc_q); */ -+ pstapriv->asoc_sta_count = 0; -+ _rtw_init_queue(&pstapriv->sleep_q); -+ _rtw_init_queue(&pstapriv->wakeup_q); -+ -+ psta = (struct sta_info *)(pstapriv->pstainfo_buf); -+ -+ -+ for (i = 0; i < NUM_STA; i++) { -+ _rtw_init_stainfo(psta); -+ -+ INIT_LIST_HEAD(&(pstapriv->sta_hash[i])); -+ -+ list_add_tail(&psta->list, get_list_head(&pstapriv->free_sta_queue)); -+ -+ psta++; -+ } -+ -+ pstapriv->sta_dz_bitmap = 0; -+ pstapriv->tim_bitmap = 0; -+ -+ INIT_LIST_HEAD(&pstapriv->asoc_list); -+ INIT_LIST_HEAD(&pstapriv->auth_list); -+ spin_lock_init(&pstapriv->asoc_list_lock); -+ spin_lock_init(&pstapriv->auth_list_lock); -+ pstapriv->asoc_list_cnt = 0; -+ pstapriv->auth_list_cnt = 0; -+ -+ pstapriv->auth_to = 3; /* 3*2 = 6 sec */ -+ pstapriv->assoc_to = 3; -+ pstapriv->expire_to = 3; /* 3*2 = 6 sec */ -+ pstapriv->max_num_sta = NUM_STA; -+ return _SUCCESS; -+} -+ -+inline int rtw_stainfo_offset(struct sta_priv *stapriv, struct sta_info *sta) -+{ -+ int offset = (((u8 *)sta) - stapriv->pstainfo_buf)/sizeof(struct sta_info); -+ -+ if (!stainfo_offset_valid(offset)) -+ DBG_871X("%s invalid offset(%d), out of range!!!", __func__, offset); -+ -+ return offset; -+} -+ -+inline struct sta_info *rtw_get_stainfo_by_offset(struct sta_priv *stapriv, int offset) -+{ -+ if (!stainfo_offset_valid(offset)) -+ DBG_871X("%s invalid offset(%d), out of range!!!", __func__, offset); -+ -+ return (struct sta_info *)(stapriv->pstainfo_buf + offset * sizeof(struct sta_info)); -+} -+ -+/* this function is used to free the memory of lock || sema for all stainfos */ -+void kfree_all_stainfo(struct sta_priv *pstapriv); -+void kfree_all_stainfo(struct sta_priv *pstapriv) -+{ -+ struct list_head *plist, *phead; -+ struct sta_info *psta = NULL; -+ -+ spin_lock_bh(&pstapriv->sta_hash_lock); -+ -+ phead = get_list_head(&pstapriv->free_sta_queue); -+ plist = get_next(phead); -+ -+ while (phead != plist) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, list); -+ plist = get_next(plist); -+ } -+ -+ spin_unlock_bh(&pstapriv->sta_hash_lock); -+} -+ -+void kfree_sta_priv_lock(struct sta_priv *pstapriv); -+void kfree_sta_priv_lock(struct sta_priv *pstapriv) -+{ -+ kfree_all_stainfo(pstapriv); /* be done before free sta_hash_lock */ -+} -+ -+u32 _rtw_free_sta_priv(struct sta_priv *pstapriv) -+{ -+ struct list_head *phead, *plist; -+ struct sta_info *psta = NULL; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ int index; -+ -+ if (pstapriv) { -+ -+ /*delete all reordering_ctrl_timer */ -+ spin_lock_bh(&pstapriv->sta_hash_lock); -+ for (index = 0; index < NUM_STA; index++) { -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ while (phead != plist) { -+ int i; -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ plist = get_next(plist); -+ -+ for (i = 0; i < 16 ; i++) { -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ del_timer_sync(&preorder_ctrl->reordering_ctrl_timer); -+ } -+ } -+ } -+ spin_unlock_bh(&pstapriv->sta_hash_lock); -+ /*===============================*/ -+ -+ kfree_sta_priv_lock(pstapriv); -+ -+ if (pstapriv->pallocated_stainfo_buf) -+ vfree(pstapriv->pallocated_stainfo_buf); -+ -+ } -+ return _SUCCESS; -+} -+ -+/* struct sta_info *rtw_alloc_stainfo(_queue *pfree_sta_queue, unsigned char *hwaddr) */ -+struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) -+{ -+ uint tmp_aid; -+ s32 index; -+ struct list_head *phash_list; -+ struct sta_info *psta; -+ struct __queue *pfree_sta_queue; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ int i = 0; -+ u16 wRxSeqInitialValue = 0xffff; -+ -+ pfree_sta_queue = &pstapriv->free_sta_queue; -+ -+ /* spin_lock_bh(&(pfree_sta_queue->lock)); */ -+ spin_lock_bh(&(pstapriv->sta_hash_lock)); -+ if (list_empty(&pfree_sta_queue->queue)) { -+ /* spin_unlock_bh(&(pfree_sta_queue->lock)); */ -+ spin_unlock_bh(&(pstapriv->sta_hash_lock)); -+ psta = NULL; -+ return psta; -+ } else{ -+ psta = LIST_CONTAINOR(get_next(&pfree_sta_queue->queue), struct sta_info, list); -+ -+ list_del_init(&(psta->list)); -+ -+ /* spin_unlock_bh(&(pfree_sta_queue->lock)); */ -+ -+ tmp_aid = psta->aid; -+ -+ _rtw_init_stainfo(psta); -+ -+ psta->padapter = pstapriv->padapter; -+ -+ memcpy(psta->hwaddr, hwaddr, ETH_ALEN); -+ -+ index = wifi_mac_hash(hwaddr); -+ -+ RT_TRACE(_module_rtl871x_sta_mgt_c_, _drv_info_, ("rtw_alloc_stainfo: index = %x", index)); -+ -+ if (index >= NUM_STA) { -+ RT_TRACE(_module_rtl871x_sta_mgt_c_, _drv_err_, ("ERROR => rtw_alloc_stainfo: index >= NUM_STA")); -+ spin_unlock_bh(&(pstapriv->sta_hash_lock)); -+ psta = NULL; -+ goto exit; -+ } -+ phash_list = &(pstapriv->sta_hash[index]); -+ -+ /* spin_lock_bh(&(pstapriv->sta_hash_lock)); */ -+ -+ list_add_tail(&psta->hash_list, phash_list); -+ -+ pstapriv->asoc_sta_count++; -+ -+ /* spin_unlock_bh(&(pstapriv->sta_hash_lock)); */ -+ -+/* Commented by Albert 2009/08/13 */ -+/* For the SMC router, the sequence number of first packet of WPS handshake will be 0. */ -+/* In this case, this packet will be dropped by recv_decache function if we use the 0x00 as the default value for tid_rxseq variable. */ -+/* So, we initialize the tid_rxseq variable as the 0xffff. */ -+ -+ for (i = 0; i < 16; i++) { -+ memcpy(&psta->sta_recvpriv.rxcache.tid_rxseq[i], &wRxSeqInitialValue, 2); -+ } -+ -+ RT_TRACE( -+ _module_rtl871x_sta_mgt_c_, -+ _drv_info_, ( -+ "alloc number_%d stainfo with hwaddr = %x %x %x %x %x %x \n", -+ pstapriv->asoc_sta_count, -+ hwaddr[0], -+ hwaddr[1], -+ hwaddr[2], -+ hwaddr[3], -+ hwaddr[4], -+ hwaddr[5] -+ ) -+ ); -+ -+ init_addba_retry_timer(pstapriv->padapter, psta); -+ -+ /* for A-MPDU Rx reordering buffer control */ -+ for (i = 0; i < 16 ; i++) { -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ -+ preorder_ctrl->padapter = pstapriv->padapter; -+ -+ preorder_ctrl->enable = false; -+ -+ preorder_ctrl->indicate_seq = 0xffff; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq); -+ #endif -+ preorder_ctrl->wend_b = 0xffff; -+ /* preorder_ctrl->wsize_b = (NR_RECVBUFF-2); */ -+ preorder_ctrl->wsize_b = 64;/* 64; */ -+ -+ _rtw_init_queue(&preorder_ctrl->pending_recvframe_queue); -+ -+ rtw_init_recv_timer(preorder_ctrl); -+ } -+ -+ -+ /* init for DM */ -+ psta->rssi_stat.UndecoratedSmoothedPWDB = (-1); -+ psta->rssi_stat.UndecoratedSmoothedCCK = (-1); -+ -+ /* init for the sequence number of received management frame */ -+ psta->RxMgmtFrameSeqNum = 0xffff; -+ spin_unlock_bh(&(pstapriv->sta_hash_lock)); -+ /* alloc mac id for non-bc/mc station, */ -+ rtw_alloc_macid(pstapriv->padapter, psta); -+ -+ } -+ -+exit: -+ -+ -+ return psta; -+} -+ -+/* using pstapriv->sta_hash_lock to protect */ -+u32 rtw_free_stainfo(struct adapter *padapter, struct sta_info *psta) -+{ -+ int i; -+ struct __queue *pfree_sta_queue; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ struct sta_xmit_priv *pstaxmitpriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct hw_xmit *phwxmit; -+ -+ if (psta == NULL) -+ goto exit; -+ -+ -+ spin_lock_bh(&psta->lock); -+ psta->state &= ~_FW_LINKED; -+ spin_unlock_bh(&psta->lock); -+ -+ pfree_sta_queue = &pstapriv->free_sta_queue; -+ -+ -+ pstaxmitpriv = &psta->sta_xmitpriv; -+ -+ /* list_del_init(&psta->sleep_list); */ -+ -+ /* list_del_init(&psta->wakeup_list); */ -+ -+ spin_lock_bh(&pxmitpriv->lock); -+ -+ rtw_free_xmitframe_queue(pxmitpriv, &psta->sleep_q); -+ psta->sleepq_len = 0; -+ -+ /* vo */ -+ /* spin_lock_bh(&(pxmitpriv->vo_pending.lock)); */ -+ rtw_free_xmitframe_queue(pxmitpriv, &pstaxmitpriv->vo_q.sta_pending); -+ list_del_init(&(pstaxmitpriv->vo_q.tx_pending)); -+ phwxmit = pxmitpriv->hwxmits; -+ phwxmit->accnt -= pstaxmitpriv->vo_q.qcnt; -+ pstaxmitpriv->vo_q.qcnt = 0; -+ /* spin_unlock_bh(&(pxmitpriv->vo_pending.lock)); */ -+ -+ /* vi */ -+ /* spin_lock_bh(&(pxmitpriv->vi_pending.lock)); */ -+ rtw_free_xmitframe_queue(pxmitpriv, &pstaxmitpriv->vi_q.sta_pending); -+ list_del_init(&(pstaxmitpriv->vi_q.tx_pending)); -+ phwxmit = pxmitpriv->hwxmits+1; -+ phwxmit->accnt -= pstaxmitpriv->vi_q.qcnt; -+ pstaxmitpriv->vi_q.qcnt = 0; -+ /* spin_unlock_bh(&(pxmitpriv->vi_pending.lock)); */ -+ -+ /* be */ -+ /* spin_lock_bh(&(pxmitpriv->be_pending.lock)); */ -+ rtw_free_xmitframe_queue(pxmitpriv, &pstaxmitpriv->be_q.sta_pending); -+ list_del_init(&(pstaxmitpriv->be_q.tx_pending)); -+ phwxmit = pxmitpriv->hwxmits+2; -+ phwxmit->accnt -= pstaxmitpriv->be_q.qcnt; -+ pstaxmitpriv->be_q.qcnt = 0; -+ /* spin_unlock_bh(&(pxmitpriv->be_pending.lock)); */ -+ -+ /* bk */ -+ /* spin_lock_bh(&(pxmitpriv->bk_pending.lock)); */ -+ rtw_free_xmitframe_queue(pxmitpriv, &pstaxmitpriv->bk_q.sta_pending); -+ list_del_init(&(pstaxmitpriv->bk_q.tx_pending)); -+ phwxmit = pxmitpriv->hwxmits+3; -+ phwxmit->accnt -= pstaxmitpriv->bk_q.qcnt; -+ pstaxmitpriv->bk_q.qcnt = 0; -+ /* spin_unlock_bh(&(pxmitpriv->bk_pending.lock)); */ -+ -+ spin_unlock_bh(&pxmitpriv->lock); -+ -+ list_del_init(&psta->hash_list); -+ RT_TRACE( -+ _module_rtl871x_sta_mgt_c_, -+ _drv_err_, ( -+ "\n free number_%d stainfo with hwaddr = 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x \n", -+ pstapriv->asoc_sta_count, -+ psta->hwaddr[0], -+ psta->hwaddr[1], -+ psta->hwaddr[2], -+ psta->hwaddr[3], -+ psta->hwaddr[4], -+ psta->hwaddr[5] -+ ) -+ ); -+ pstapriv->asoc_sta_count--; -+ -+ -+ /* re-init sta_info; 20061114 will be init in alloc_stainfo */ -+ /* _rtw_init_sta_xmit_priv(&psta->sta_xmitpriv); */ -+ /* _rtw_init_sta_recv_priv(&psta->sta_recvpriv); */ -+ -+ del_timer_sync(&psta->addba_retry_timer); -+ -+ /* for A-MPDU Rx reordering buffer control, cancel reordering_ctrl_timer */ -+ for (i = 0; i < 16 ; i++) { -+ struct list_head *phead, *plist; -+ union recv_frame *prframe; -+ struct __queue *ppending_recvframe_queue; -+ struct __queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ -+ del_timer_sync(&preorder_ctrl->reordering_ctrl_timer); -+ -+ -+ ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ -+ spin_lock_bh(&ppending_recvframe_queue->lock); -+ -+ phead = get_list_head(ppending_recvframe_queue); -+ plist = get_next(phead); -+ -+ while (!list_empty(phead)) { -+ prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ -+ plist = get_next(plist); -+ -+ list_del_init(&(prframe->u.hdr.list)); -+ -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ } -+ -+ spin_unlock_bh(&ppending_recvframe_queue->lock); -+ -+ } -+ -+ if (!(psta->state & WIFI_AP_STATE)) -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, false); -+ -+ -+ /* release mac id for non-bc/mc station, */ -+ rtw_release_macid(pstapriv->padapter, psta); -+ -+/* -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ list_del_init(&psta->asoc_list); -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+*/ -+ spin_lock_bh(&pstapriv->auth_list_lock); -+ if (!list_empty(&psta->auth_list)) { -+ list_del_init(&psta->auth_list); -+ pstapriv->auth_list_cnt--; -+ } -+ spin_unlock_bh(&pstapriv->auth_list_lock); -+ -+ psta->expire_to = 0; -+ psta->sleepq_ac_len = 0; -+ psta->qos_info = 0; -+ -+ psta->max_sp_len = 0; -+ psta->uapsd_bk = 0; -+ psta->uapsd_be = 0; -+ psta->uapsd_vi = 0; -+ psta->uapsd_vo = 0; -+ -+ psta->has_legacy_ac = 0; -+ -+ pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ if ((psta->aid > 0) && (pstapriv->sta_aid[psta->aid - 1] == psta)) { -+ pstapriv->sta_aid[psta->aid - 1] = NULL; -+ psta->aid = 0; -+ } -+ -+ psta->under_exist_checking = 0; -+ -+ /* spin_lock_bh(&(pfree_sta_queue->lock)); */ -+ list_add_tail(&psta->list, get_list_head(pfree_sta_queue)); -+ /* spin_unlock_bh(&(pfree_sta_queue->lock)); */ -+ -+exit: -+ return _SUCCESS; -+} -+ -+/* free all stainfo which in sta_hash[all] */ -+void rtw_free_all_stainfo(struct adapter *padapter) -+{ -+ struct list_head *plist, *phead; -+ s32 index; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *pbcmc_stainfo = rtw_get_bcmc_stainfo(padapter); -+ -+ if (pstapriv->asoc_sta_count == 1) -+ return; -+ -+ spin_lock_bh(&pstapriv->sta_hash_lock); -+ -+ for (index = 0; index < NUM_STA; index++) { -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ while (phead != plist) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ plist = get_next(plist); -+ -+ if (pbcmc_stainfo != psta) -+ rtw_free_stainfo(padapter, psta); -+ -+ } -+ } -+ -+ spin_unlock_bh(&pstapriv->sta_hash_lock); -+} -+ -+/* any station allocated can be searched by hash list */ -+struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) -+{ -+ struct list_head *plist, *phead; -+ struct sta_info *psta = NULL; -+ u32 index; -+ u8 *addr; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ if (hwaddr == NULL) -+ return NULL; -+ -+ if (IS_MCAST(hwaddr)) -+ addr = bc_addr; -+ else -+ addr = hwaddr; -+ -+ index = wifi_mac_hash(addr); -+ -+ spin_lock_bh(&pstapriv->sta_hash_lock); -+ -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ -+ while (phead != plist) { -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ if ((!memcmp(psta->hwaddr, addr, ETH_ALEN))) -+ /* if found the matched address */ -+ break; -+ -+ psta = NULL; -+ plist = get_next(plist); -+ } -+ -+ spin_unlock_bh(&pstapriv->sta_hash_lock); -+ return psta; -+} -+ -+u32 rtw_init_bcmc_stainfo(struct adapter *padapter) -+{ -+ -+ struct sta_info *psta; -+ struct tx_servq *ptxservq; -+ u32 res = _SUCCESS; -+ NDIS_802_11_MAC_ADDRESS bcast_addr = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ /* struct __queue *pstapending = &padapter->xmitpriv.bm_pending; */ -+ -+ psta = rtw_alloc_stainfo(pstapriv, bcast_addr); -+ -+ if (psta == NULL) { -+ res = _FAIL; -+ RT_TRACE(_module_rtl871x_sta_mgt_c_, _drv_err_, ("rtw_alloc_stainfo fail")); -+ goto exit; -+ } -+ -+ /* default broadcast & multicast use macid 1 */ -+ psta->mac_id = 1; -+ -+ ptxservq = &(psta->sta_xmitpriv.be_q); -+exit: -+ return _SUCCESS; -+} -+ -+ -+struct sta_info *rtw_get_bcmc_stainfo(struct adapter *padapter) -+{ -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ psta = rtw_get_stainfo(pstapriv, bc_addr); -+ return psta; -+} -+ -+u8 rtw_access_ctrl(struct adapter *padapter, u8 *mac_addr) -+{ -+ u8 res = true; -+ struct list_head *plist, *phead; -+ struct rtw_wlan_acl_node *paclnode; -+ u8 match = false; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ struct __queue *pacl_node_q = &pacl_list->acl_node_q; -+ -+ spin_lock_bh(&(pacl_node_q->lock)); -+ phead = get_list_head(pacl_node_q); -+ plist = get_next(phead); -+ while (phead != plist) { -+ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); -+ plist = get_next(plist); -+ -+ if (!memcmp(paclnode->addr, mac_addr, ETH_ALEN)) -+ if (paclnode->valid == true) { -+ match = true; -+ break; -+ } -+ -+ } -+ spin_unlock_bh(&(pacl_node_q->lock)); -+ -+ -+ if (pacl_list->mode == 1) /* accept unless in deny list */ -+ res = (match == true) ? false:true; -+ -+ else if (pacl_list->mode == 2)/* deny unless in accept list */ -+ res = (match == true) ? true:false; -+ else -+ res = true; -+ -+ return res; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_wlan_util.c linux/3rdparty/rtl8723bs/core/rtw_wlan_util.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_wlan_util.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_wlan_util.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,2328 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_WLAN_UTIL_C_ -+ -+#include -+#include -+#include -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+#include -+#endif -+ -+static unsigned char ARTHEROS_OUI1[] = {0x00, 0x03, 0x7f}; -+static unsigned char ARTHEROS_OUI2[] = {0x00, 0x13, 0x74}; -+ -+static unsigned char BROADCOM_OUI1[] = {0x00, 0x10, 0x18}; -+static unsigned char BROADCOM_OUI2[] = {0x00, 0x0a, 0xf7}; -+static unsigned char BROADCOM_OUI3[] = {0x00, 0x05, 0xb5}; -+ -+static unsigned char CISCO_OUI[] = {0x00, 0x40, 0x96}; -+static unsigned char MARVELL_OUI[] = {0x00, 0x50, 0x43}; -+static unsigned char RALINK_OUI[] = {0x00, 0x0c, 0x43}; -+static unsigned char REALTEK_OUI[] = {0x00, 0xe0, 0x4c}; -+static unsigned char AIRGOCAP_OUI[] = {0x00, 0x0a, 0xf5}; -+static unsigned char RSN_TKIP_CIPHER[4] = {0x00, 0x0f, 0xac, 0x02}; -+static unsigned char WPA_TKIP_CIPHER[4] = {0x00, 0x50, 0xf2, 0x02}; -+ -+extern unsigned char RTW_WPA_OUI[]; -+extern unsigned char WPA_TKIP_CIPHER[4]; -+ -+#define R2T_PHY_DELAY (0) -+ -+/* define WAIT_FOR_BCN_TO_MIN (3000) */ -+#define WAIT_FOR_BCN_TO_MIN (6000) -+#define WAIT_FOR_BCN_TO_MAX (20000) -+ -+#define DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS 1000 -+#define DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD 3 -+ -+static u8 rtw_basic_rate_cck[4] = { -+ IEEE80211_CCK_RATE_1MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_2MB|IEEE80211_BASIC_RATE_MASK, -+ IEEE80211_CCK_RATE_5MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_11MB|IEEE80211_BASIC_RATE_MASK -+}; -+ -+static u8 rtw_basic_rate_ofdm[3] = { -+ IEEE80211_OFDM_RATE_6MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_OFDM_RATE_12MB|IEEE80211_BASIC_RATE_MASK, -+ IEEE80211_OFDM_RATE_24MB|IEEE80211_BASIC_RATE_MASK -+}; -+ -+int cckrates_included(unsigned char *rate, int ratelen) -+{ -+ int i; -+ -+ for (i = 0; i < ratelen; i++) { -+ if ((((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || -+ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22)) -+ return true; -+ } -+ -+ return false; -+ -+} -+ -+int cckratesonly_included(unsigned char *rate, int ratelen) -+{ -+ int i; -+ -+ for (i = 0; i < ratelen; i++) { -+ if ((((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && -+ (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22)) -+ return false; -+ } -+ -+ return true; -+} -+ -+u8 networktype_to_raid_ex(struct adapter *adapter, struct sta_info *psta) -+{ -+ u8 raid, cur_rf_type, rf_type = RF_1T1R; -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&cur_rf_type)); -+ -+ if (cur_rf_type == RF_1T1R) { -+ rf_type = RF_1T1R; -+ } else if (IsSupportedVHT(psta->wireless_mode)) { -+ if (psta->ra_mask & 0xffc00000) -+ rf_type = RF_2T2R; -+ } else if (IsSupportedHT(psta->wireless_mode)) { -+ if (psta->ra_mask & 0xfff00000) -+ rf_type = RF_2T2R; -+ } -+ -+ switch (psta->wireless_mode) { -+ case WIRELESS_11B: -+ raid = RATEID_IDX_B; -+ break; -+ case WIRELESS_11A: -+ case WIRELESS_11G: -+ raid = RATEID_IDX_G; -+ break; -+ case WIRELESS_11BG: -+ raid = RATEID_IDX_BG; -+ break; -+ case WIRELESS_11_24N: -+ case WIRELESS_11_5N: -+ case WIRELESS_11A_5N: -+ case WIRELESS_11G_24N: -+ if (rf_type == RF_2T2R) -+ raid = RATEID_IDX_GN_N2SS; -+ else -+ raid = RATEID_IDX_GN_N1SS; -+ break; -+ case WIRELESS_11B_24N: -+ case WIRELESS_11BG_24N: -+ if (psta->bw_mode == CHANNEL_WIDTH_20) { -+ if (rf_type == RF_2T2R) -+ raid = RATEID_IDX_BGN_20M_2SS_BN; -+ else -+ raid = RATEID_IDX_BGN_20M_1SS_BN; -+ } else { -+ if (rf_type == RF_2T2R) -+ raid = RATEID_IDX_BGN_40M_2SS; -+ else -+ raid = RATEID_IDX_BGN_40M_1SS; -+ } -+ break; -+ default: -+ raid = RATEID_IDX_BGN_40M_2SS; -+ break; -+ -+ } -+ return raid; -+ -+} -+ -+unsigned char ratetbl_val_2wifirate(unsigned char rate); -+unsigned char ratetbl_val_2wifirate(unsigned char rate) -+{ -+ unsigned char val = 0; -+ -+ switch (rate & 0x7f) { -+ case 0: -+ val = IEEE80211_CCK_RATE_1MB; -+ break; -+ -+ case 1: -+ val = IEEE80211_CCK_RATE_2MB; -+ break; -+ -+ case 2: -+ val = IEEE80211_CCK_RATE_5MB; -+ break; -+ -+ case 3: -+ val = IEEE80211_CCK_RATE_11MB; -+ break; -+ -+ case 4: -+ val = IEEE80211_OFDM_RATE_6MB; -+ break; -+ -+ case 5: -+ val = IEEE80211_OFDM_RATE_9MB; -+ break; -+ -+ case 6: -+ val = IEEE80211_OFDM_RATE_12MB; -+ break; -+ -+ case 7: -+ val = IEEE80211_OFDM_RATE_18MB; -+ break; -+ -+ case 8: -+ val = IEEE80211_OFDM_RATE_24MB; -+ break; -+ -+ case 9: -+ val = IEEE80211_OFDM_RATE_36MB; -+ break; -+ -+ case 10: -+ val = IEEE80211_OFDM_RATE_48MB; -+ break; -+ -+ case 11: -+ val = IEEE80211_OFDM_RATE_54MB; -+ break; -+ -+ } -+ -+ return val; -+ -+} -+ -+int is_basicrate(struct adapter *padapter, unsigned char rate); -+int is_basicrate(struct adapter *padapter, unsigned char rate) -+{ -+ int i; -+ unsigned char val; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ for (i = 0; i < NumRates; i++) { -+ val = pmlmeext->basicrate[i]; -+ -+ if ((val != 0xff) && (val != 0xfe)) -+ if (rate == ratetbl_val_2wifirate(val)) -+ return true; -+ } -+ -+ return false; -+} -+ -+unsigned int ratetbl2rateset(struct adapter *padapter, unsigned char *rateset); -+unsigned int ratetbl2rateset(struct adapter *padapter, unsigned char *rateset) -+{ -+ int i; -+ unsigned char rate; -+ unsigned int len = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ for (i = 0; i < NumRates; i++) { -+ rate = pmlmeext->datarate[i]; -+ -+ switch (rate) { -+ case 0xff: -+ return len; -+ -+ case 0xfe: -+ continue; -+ -+ default: -+ rate = ratetbl_val_2wifirate(rate); -+ -+ if (is_basicrate(padapter, rate) == true) -+ rate |= IEEE80211_BASIC_RATE_MASK; -+ -+ rateset[len] = rate; -+ len++; -+ break; -+ } -+ } -+ return len; -+} -+ -+void get_rate_set(struct adapter *padapter, unsigned char *pbssrate, int *bssrate_len) -+{ -+ unsigned char supportedrates[NumRates]; -+ -+ memset(supportedrates, 0, NumRates); -+ *bssrate_len = ratetbl2rateset(padapter, supportedrates); -+ memcpy(pbssrate, supportedrates, *bssrate_len); -+} -+ -+void set_mcs_rate_by_mask(u8 *mcs_set, u32 mask) -+{ -+ u8 mcs_rate_1r = (u8)(mask&0xff); -+ u8 mcs_rate_2r = (u8)((mask>>8)&0xff); -+ u8 mcs_rate_3r = (u8)((mask>>16)&0xff); -+ u8 mcs_rate_4r = (u8)((mask>>24)&0xff); -+ -+ mcs_set[0] &= mcs_rate_1r; -+ mcs_set[1] &= mcs_rate_2r; -+ mcs_set[2] &= mcs_rate_3r; -+ mcs_set[3] &= mcs_rate_4r; -+} -+ -+void UpdateBrateTbl(struct adapter *Adapter, u8 *mBratesOS) -+{ -+ u8 i; -+ u8 rate; -+ -+ /* 1M, 2M, 5.5M, 11M, 6M, 12M, 24M are mandatory. */ -+ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { -+ rate = mBratesOS[i] & 0x7f; -+ switch (rate) { -+ case IEEE80211_CCK_RATE_1MB: -+ case IEEE80211_CCK_RATE_2MB: -+ case IEEE80211_CCK_RATE_5MB: -+ case IEEE80211_CCK_RATE_11MB: -+ case IEEE80211_OFDM_RATE_6MB: -+ case IEEE80211_OFDM_RATE_12MB: -+ case IEEE80211_OFDM_RATE_24MB: -+ mBratesOS[i] |= IEEE80211_BASIC_RATE_MASK; -+ break; -+ } -+ } -+ -+} -+ -+void UpdateBrateTblForSoftAP(u8 *bssrateset, u32 bssratelen) -+{ -+ u8 i; -+ u8 rate; -+ -+ for (i = 0; i < bssratelen; i++) { -+ rate = bssrateset[i] & 0x7f; -+ switch (rate) { -+ case IEEE80211_CCK_RATE_1MB: -+ case IEEE80211_CCK_RATE_2MB: -+ case IEEE80211_CCK_RATE_5MB: -+ case IEEE80211_CCK_RATE_11MB: -+ bssrateset[i] |= IEEE80211_BASIC_RATE_MASK; -+ break; -+ } -+ } -+ -+} -+ -+void Save_DM_Func_Flag(struct adapter *padapter) -+{ -+ u8 bSaveFlag = true; -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_OP, (u8 *)(&bSaveFlag)); -+} -+ -+void Restore_DM_Func_Flag(struct adapter *padapter) -+{ -+ u8 bSaveFlag = false; -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_OP, (u8 *)(&bSaveFlag)); -+} -+ -+void Switch_DM_Func(struct adapter *padapter, u32 mode, u8 enable) -+{ -+ if (enable == true) -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_SET, (u8 *)(&mode)); -+ else -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_CLR, (u8 *)(&mode)); -+} -+ -+static void Set_NETYPE0_MSR(struct adapter *padapter, u8 type) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MEDIA_STATUS, (u8 *)(&type)); -+} -+ -+void Set_MSR(struct adapter *padapter, u8 type) -+{ -+ Set_NETYPE0_MSR(padapter, type); -+} -+ -+inline u8 rtw_get_oper_ch(struct adapter *adapter) -+{ -+ return adapter_to_dvobj(adapter)->oper_channel; -+} -+ -+inline void rtw_set_oper_ch(struct adapter *adapter, u8 ch) -+{ -+#ifdef DBG_CH_SWITCH -+ const int len = 128; -+ char msg[128] = {0}; -+ int cnt = 0; -+ int i = 0; -+#endif /* DBG_CH_SWITCH */ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ if (dvobj->oper_channel != ch) { -+ dvobj->on_oper_ch_time = jiffies; -+ -+#ifdef DBG_CH_SWITCH -+ cnt += snprintf(msg+cnt, len-cnt, "switch to ch %3u", ch); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ struct adapter *iface = dvobj->padapters[i]; -+ cnt += snprintf(msg+cnt, len-cnt, " ["ADPT_FMT":", ADPT_ARG(iface)); -+ if (iface->mlmeextpriv.cur_channel == ch) -+ cnt += snprintf(msg+cnt, len-cnt, "C"); -+ else -+ cnt += snprintf(msg+cnt, len-cnt, "_"); -+ if (iface->wdinfo.listen_channel == ch && !rtw_p2p_chk_state(&iface->wdinfo, P2P_STATE_NONE)) -+ cnt += snprintf(msg+cnt, len-cnt, "L"); -+ else -+ cnt += snprintf(msg+cnt, len-cnt, "_"); -+ cnt += snprintf(msg+cnt, len-cnt, "]"); -+ } -+ -+ DBG_871X(FUNC_ADPT_FMT" %s\n", FUNC_ADPT_ARG(adapter), msg); -+#endif /* DBG_CH_SWITCH */ -+ } -+ -+ dvobj->oper_channel = ch; -+} -+ -+inline u8 rtw_get_oper_bw(struct adapter *adapter) -+{ -+ return adapter_to_dvobj(adapter)->oper_bwmode; -+} -+ -+inline void rtw_set_oper_bw(struct adapter *adapter, u8 bw) -+{ -+ adapter_to_dvobj(adapter)->oper_bwmode = bw; -+} -+ -+inline u8 rtw_get_oper_choffset(struct adapter *adapter) -+{ -+ return adapter_to_dvobj(adapter)->oper_ch_offset; -+} -+ -+inline void rtw_set_oper_choffset(struct adapter *adapter, u8 offset) -+{ -+ adapter_to_dvobj(adapter)->oper_ch_offset = offset; -+} -+ -+u8 rtw_get_center_ch(u8 channel, u8 chnl_bw, u8 chnl_offset) -+{ -+ u8 center_ch = channel; -+ -+ if (chnl_bw == CHANNEL_WIDTH_80) { -+ if ((channel == 36) || (channel == 40) || (channel == 44) || (channel == 48)) -+ center_ch = 42; -+ if ((channel == 52) || (channel == 56) || (channel == 60) || (channel == 64)) -+ center_ch = 58; -+ if ((channel == 100) || (channel == 104) || (channel == 108) || (channel == 112)) -+ center_ch = 106; -+ if ((channel == 116) || (channel == 120) || (channel == 124) || (channel == 128)) -+ center_ch = 122; -+ if ((channel == 132) || (channel == 136) || (channel == 140) || (channel == 144)) -+ center_ch = 138; -+ if ((channel == 149) || (channel == 153) || (channel == 157) || (channel == 161)) -+ center_ch = 155; -+ else if (channel <= 14) -+ center_ch = 7; -+ } else if (chnl_bw == CHANNEL_WIDTH_40) { -+ if (chnl_offset == HAL_PRIME_CHNL_OFFSET_LOWER) -+ center_ch = channel + 2; -+ else -+ center_ch = channel - 2; -+ } -+ -+ return center_ch; -+} -+ -+inline unsigned long rtw_get_on_cur_ch_time(struct adapter *adapter) -+{ -+ if (adapter->mlmeextpriv.cur_channel == adapter_to_dvobj(adapter)->oper_channel) -+ return adapter_to_dvobj(adapter)->on_oper_ch_time; -+ else -+ return 0; -+} -+ -+void SelectChannel(struct adapter *padapter, unsigned char channel) -+{ -+ if (mutex_lock_interruptible(&(adapter_to_dvobj(padapter)->setch_mutex))) -+ return; -+ -+ /* saved channel info */ -+ rtw_set_oper_ch(padapter, channel); -+ -+ rtw_hal_set_chan(padapter, channel); -+ -+ mutex_unlock(&(adapter_to_dvobj(padapter)->setch_mutex)); -+} -+ -+void set_channel_bwmode(struct adapter *padapter, unsigned char channel, unsigned char channel_offset, unsigned short bwmode) -+{ -+ u8 center_ch, chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if (padapter->bNotifyChannelChange) -+ DBG_871X("[%s] ch = %d, offset = %d, bwmode = %d\n", __func__, channel, channel_offset, bwmode); -+ -+ center_ch = rtw_get_center_ch(channel, bwmode, channel_offset); -+ -+ if (bwmode == CHANNEL_WIDTH_80) { -+ if (center_ch > channel) -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else if (center_ch < channel) -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ /* set Channel */ -+ if (mutex_lock_interruptible(&(adapter_to_dvobj(padapter)->setch_mutex))) -+ return; -+ -+ /* saved channel/bw info */ -+ rtw_set_oper_ch(padapter, channel); -+ rtw_set_oper_bw(padapter, bwmode); -+ rtw_set_oper_choffset(padapter, channel_offset); -+ -+ rtw_hal_set_chnl_bw(padapter, center_ch, bwmode, channel_offset, chnl_offset80); /* set center channel */ -+ -+ mutex_unlock(&(adapter_to_dvobj(padapter)->setch_mutex)); -+} -+ -+__inline u8 *get_my_bssid(struct wlan_bssid_ex *pnetwork) -+{ -+ return pnetwork->MacAddress; -+} -+ -+u16 get_beacon_interval(struct wlan_bssid_ex *bss) -+{ -+ __le16 val; -+ memcpy((unsigned char *)&val, rtw_get_beacon_interval_from_ie(bss->IEs), 2); -+ -+ return le16_to_cpu(val); -+ -+} -+ -+int is_client_associated_to_ap(struct adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ -+ if (!padapter) -+ return _FAIL; -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && ((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE)) -+ return true; -+ else -+ return _FAIL; -+} -+ -+int is_client_associated_to_ibss(struct adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE)) -+ return true; -+ else -+ return _FAIL; -+} -+ -+int is_IBSS_empty(struct adapter *padapter) -+{ -+ unsigned int i; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ for (i = IBSS_START_MAC_ID; i < NUM_STA; i++) { -+ if (pmlmeinfo->FW_sta_info[i].status == 1) -+ return _FAIL; -+ } -+ -+ return true; -+ -+} -+ -+unsigned int decide_wait_for_beacon_timeout(unsigned int bcn_interval) -+{ -+ if ((bcn_interval << 2) < WAIT_FOR_BCN_TO_MIN) -+ return WAIT_FOR_BCN_TO_MIN; -+ else if ((bcn_interval << 2) > WAIT_FOR_BCN_TO_MAX) -+ return WAIT_FOR_BCN_TO_MAX; -+ else -+ return ((bcn_interval << 2)); -+} -+ -+void invalidate_cam_all(struct adapter *padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_INVALID_ALL, NULL); -+ -+ spin_lock_bh(&cam_ctl->lock); -+ cam_ctl->bitmap = 0; -+ memset(dvobj->cam_cache, 0, sizeof(struct cam_entry_cache)*TOTAL_CAM_ENTRY); -+ spin_unlock_bh(&cam_ctl->lock); -+} -+ -+static u32 _ReadCAM(struct adapter *padapter, u32 addr) -+{ -+ u32 count = 0, cmd; -+ cmd = CAM_POLLINIG | addr; -+ rtw_write32(padapter, RWCAM, cmd); -+ -+ do { -+ if (0 == (rtw_read32(padapter, REG_CAMCMD) & CAM_POLLINIG)) -+ break; -+ } while (count++ < 100); -+ -+ return rtw_read32(padapter, REG_CAMREAD); -+} -+void read_cam(struct adapter *padapter, u8 entry, u8 *get_key) -+{ -+ u32 j, addr, cmd; -+ addr = entry << 3; -+ -+ /* DBG_8192C("********* DUMP CAM Entry_#%02d***************\n", entry); */ -+ for (j = 0; j < 6; j++) { -+ cmd = _ReadCAM(padapter, addr+j); -+ /* DBG_8192C("offset:0x%02x => 0x%08x\n", addr+j, cmd); */ -+ if (j > 1) /* get key from cam */ -+ memcpy(get_key+(j-2)*4, &cmd, 4); -+ } -+ /* DBG_8192C("*********************************\n"); */ -+} -+ -+void _write_cam(struct adapter *padapter, u8 entry, u16 ctrl, u8 *mac, u8 *key) -+{ -+ unsigned int i, val, addr; -+ int j; -+ u32 cam_val[2]; -+ -+ addr = entry << 3; -+ -+ for (j = 5; j >= 0; j--) { -+ switch (j) { -+ case 0: -+ val = (ctrl | (mac[0] << 16) | (mac[1] << 24)); -+ break; -+ case 1: -+ val = (mac[2] | (mac[3] << 8) | (mac[4] << 16) | (mac[5] << 24)); -+ break; -+ default: -+ i = (j - 2) << 2; -+ val = (key[i] | (key[i+1] << 8) | (key[i+2] << 16) | (key[i+3] << 24)); -+ break; -+ } -+ -+ cam_val[0] = val; -+ cam_val[1] = addr + (unsigned int)j; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_WRITE, (u8 *)cam_val); -+ } -+} -+ -+void _clear_cam_entry(struct adapter *padapter, u8 entry) -+{ -+ unsigned char null_sta[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ unsigned char null_key[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ -+ _write_cam(padapter, entry, 0, null_sta, null_key); -+} -+ -+inline void write_cam(struct adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) -+{ -+ _write_cam(adapter, id, ctrl, mac, key); -+ write_cam_cache(adapter, id, ctrl, mac, key); -+} -+ -+inline void clear_cam_entry(struct adapter *adapter, u8 id) -+{ -+ _clear_cam_entry(adapter, id); -+ clear_cam_cache(adapter, id); -+} -+ -+inline void write_cam_from_cache(struct adapter *adapter, u8 id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ struct cam_entry_cache cache; -+ -+ spin_lock_bh(&cam_ctl->lock); -+ memcpy(&cache, &dvobj->cam_cache[id], sizeof(struct cam_entry_cache)); -+ spin_unlock_bh(&cam_ctl->lock); -+ -+ _write_cam(adapter, id, cache.ctrl, cache.mac, cache.key); -+} -+ -+void write_cam_cache(struct adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ spin_lock_bh(&cam_ctl->lock); -+ -+ dvobj->cam_cache[id].ctrl = ctrl; -+ memcpy(dvobj->cam_cache[id].mac, mac, ETH_ALEN); -+ memcpy(dvobj->cam_cache[id].key, key, 16); -+ -+ spin_unlock_bh(&cam_ctl->lock); -+} -+ -+void clear_cam_cache(struct adapter *adapter, u8 id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ spin_lock_bh(&cam_ctl->lock); -+ -+ memset(&(dvobj->cam_cache[id]), 0, sizeof(struct cam_entry_cache)); -+ -+ spin_unlock_bh(&cam_ctl->lock); -+} -+ -+static bool _rtw_camid_is_gk(struct adapter *adapter, u8 cam_id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ bool ret = false; -+ -+ if (cam_id >= TOTAL_CAM_ENTRY) -+ goto exit; -+ -+ if (!(cam_ctl->bitmap & BIT(cam_id))) -+ goto exit; -+ -+ ret = (dvobj->cam_cache[cam_id].ctrl&BIT6)?true:false; -+ -+exit: -+ return ret; -+} -+ -+static s16 _rtw_camid_search(struct adapter *adapter, u8 *addr, s16 kid) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ int i; -+ s16 cam_id = -1; -+ -+ for (i = 0; i < TOTAL_CAM_ENTRY; i++) { -+ if (addr && memcmp(dvobj->cam_cache[i].mac, addr, ETH_ALEN)) -+ continue; -+ if (kid >= 0 && kid != (dvobj->cam_cache[i].ctrl&0x03)) -+ continue; -+ -+ cam_id = i; -+ break; -+ } -+ -+ if (addr) -+ DBG_871X(FUNC_ADPT_FMT" addr:"MAC_FMT" kid:%d, return cam_id:%d\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), kid, cam_id); -+ else -+ DBG_871X(FUNC_ADPT_FMT" addr:%p kid:%d, return cam_id:%d\n" -+ , FUNC_ADPT_ARG(adapter), addr, kid, cam_id); -+ -+ return cam_id; -+} -+ -+s16 rtw_camid_search(struct adapter *adapter, u8 *addr, s16 kid) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ s16 cam_id = -1; -+ -+ spin_lock_bh(&cam_ctl->lock); -+ cam_id = _rtw_camid_search(adapter, addr, kid); -+ spin_unlock_bh(&cam_ctl->lock); -+ -+ return cam_id; -+} -+ -+s16 rtw_camid_alloc(struct adapter *adapter, struct sta_info *sta, u8 kid) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ s16 cam_id = -1; -+ struct mlme_ext_info *mlmeinfo; -+ -+ spin_lock_bh(&cam_ctl->lock); -+ -+ mlmeinfo = &adapter->mlmeextpriv.mlmext_info; -+ -+ if ((((mlmeinfo->state&0x03) == WIFI_FW_AP_STATE) || ((mlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE)) -+ && !sta) { -+ /* AP/Ad-hoc mode group key: static alloction to default key by key ID */ -+ if (kid > 3) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" group key with invalid key id:%u\n" -+ , FUNC_ADPT_ARG(adapter), kid); -+ rtw_warn_on(1); -+ goto bitmap_handle; -+ } -+ -+ cam_id = kid; -+ } else { -+ int i; -+ u8 *addr = sta?sta->hwaddr:NULL; -+ -+ if (!sta) { -+ if (!(mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { -+ /* bypass STA mode group key setting before connected(ex:WEP) because bssid is not ready */ -+ goto bitmap_handle; -+ } -+ -+ addr = get_bssid(&adapter->mlmepriv); -+ } -+ -+ i = _rtw_camid_search(adapter, addr, kid); -+ if (i >= 0) { -+ /* Fix issue that pairwise and group key have same key id. Pairwise key first, group key can overwirte group only(ex: rekey) */ -+ if (sta || _rtw_camid_is_gk(adapter, i) == true) -+ cam_id = i; -+ else -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" group key id:%u the same key id as pairwise key\n" -+ , FUNC_ADPT_ARG(adapter), kid); -+ goto bitmap_handle; -+ } -+ -+ for (i = 4; i < TOTAL_CAM_ENTRY; i++) -+ if (!(cam_ctl->bitmap & BIT(i))) -+ break; -+ -+ if (i == TOTAL_CAM_ENTRY) { -+ if (sta) -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" pairwise key with "MAC_FMT" id:%u no room\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->hwaddr), kid); -+ else -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" group key id:%u no room\n" -+ , FUNC_ADPT_ARG(adapter), kid); -+ rtw_warn_on(1); -+ goto bitmap_handle; -+ } -+ -+ cam_id = i; -+ } -+ -+bitmap_handle: -+ if (cam_id >= 0) -+ cam_ctl->bitmap |= BIT(cam_id); -+ -+ spin_unlock_bh(&cam_ctl->lock); -+ -+ return cam_id; -+} -+ -+void rtw_camid_free(struct adapter *adapter, u8 cam_id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ spin_lock_bh(&cam_ctl->lock); -+ -+ if (cam_id < TOTAL_CAM_ENTRY) -+ cam_ctl->bitmap &= ~(BIT(cam_id)); -+ -+ spin_unlock_bh(&cam_ctl->lock); -+} -+ -+int allocate_fw_sta_entry(struct adapter *padapter) -+{ -+ unsigned int mac_id; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ for (mac_id = IBSS_START_MAC_ID; mac_id < NUM_STA; mac_id++) { -+ if (pmlmeinfo->FW_sta_info[mac_id].status == 0) { -+ pmlmeinfo->FW_sta_info[mac_id].status = 1; -+ pmlmeinfo->FW_sta_info[mac_id].retry = 0; -+ break; -+ } -+ } -+ -+ return mac_id; -+} -+ -+void flush_all_cam_entry(struct adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ invalidate_cam_all(padapter); -+ /* clear default key related key search setting */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_DK_CFG, (u8 *)false); -+ -+ memset((u8 *)(pmlmeinfo->FW_sta_info), 0, sizeof(pmlmeinfo->FW_sta_info)); -+ -+} -+ -+int WMM_param_handler(struct adapter *padapter, struct ndis_80211_var_ie *pIE) -+{ -+ /* struct registry_priv *pregpriv = &padapter->registrypriv; */ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pmlmepriv->qospriv.qos_option == 0) { -+ pmlmeinfo->WMM_enable = 0; -+ return false; -+ } -+ -+ if (!memcmp(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element))) -+ return false; -+ else -+ memcpy(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element)); -+ -+ pmlmeinfo->WMM_enable = 1; -+ return true; -+} -+ -+void WMMOnAssocRsp(struct adapter *padapter) -+{ -+ u8 ACI, ACM, AIFS, ECWMin, ECWMax, aSifsTime; -+ u8 acm_mask; -+ u16 TXOP; -+ u32 acParm, i; -+ u32 edca[4], inx[4]; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ acm_mask = 0; -+ -+ if (pmlmeext->cur_wireless_mode & WIRELESS_11_24N) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ if (pmlmeinfo->WMM_enable == 0) { -+ padapter->mlmepriv.acm_mask = 0; -+ -+ AIFS = aSifsTime + (2 * pmlmeinfo->slotTime); -+ -+ if (pmlmeext->cur_wireless_mode & (WIRELESS_11G | WIRELESS_11A)) { -+ ECWMin = 4; -+ ECWMax = 10; -+ } else if (pmlmeext->cur_wireless_mode & WIRELESS_11B) { -+ ECWMin = 5; -+ ECWMax = 10; -+ } else { -+ ECWMin = 4; -+ ECWMax = 10; -+ } -+ -+ TXOP = 0; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); -+ -+ ECWMin = 2; -+ ECWMax = 3; -+ TXOP = 0x2f; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); -+ } else{ -+ edca[0] = edca[1] = edca[2] = edca[3] = 0; -+ -+ for (i = 0; i < 4; i++) { -+ ACI = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 5) & 0x03; -+ ACM = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 4) & 0x01; -+ -+ /* AIFS = AIFSN * slot time + SIFS - r2t phy delay */ -+ AIFS = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN & 0x0f) * pmlmeinfo->slotTime + aSifsTime; -+ -+ ECWMin = (pmlmeinfo->WMM_param.ac_param[i].CW & 0x0f); -+ ECWMax = (pmlmeinfo->WMM_param.ac_param[i].CW & 0xf0) >> 4; -+ TXOP = le16_to_cpu(pmlmeinfo->WMM_param.ac_param[i].TXOP_limit); -+ -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ -+ switch (ACI) { -+ case 0x0: -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); -+ acm_mask |= (ACM ? BIT(1):0); -+ edca[XMIT_BE_QUEUE] = acParm; -+ break; -+ -+ case 0x1: -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); -+ /* acm_mask |= (ACM? BIT(0):0); */ -+ edca[XMIT_BK_QUEUE] = acParm; -+ break; -+ -+ case 0x2: -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); -+ acm_mask |= (ACM ? BIT(2):0); -+ edca[XMIT_VI_QUEUE] = acParm; -+ break; -+ -+ case 0x3: -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); -+ acm_mask |= (ACM ? BIT(3):0); -+ edca[XMIT_VO_QUEUE] = acParm; -+ break; -+ } -+ -+ DBG_871X("WMM(%x): %x, %x\n", ACI, ACM, acParm); -+ } -+ -+ if (padapter->registrypriv.acm_method == 1) -+ rtw_hal_set_hwreg(padapter, HW_VAR_ACM_CTRL, (u8 *)(&acm_mask)); -+ else -+ padapter->mlmepriv.acm_mask = acm_mask; -+ -+ inx[0] = 0; inx[1] = 1; inx[2] = 2; inx[3] = 3; -+ -+ if (pregpriv->wifi_spec == 1) { -+ u32 j, tmp, change_inx = false; -+ -+ /* entry indx: 0->vo, 1->vi, 2->be, 3->bk. */ -+ for (i = 0; i < 4; i++) { -+ for (j = i+1; j < 4; j++) { -+ /* compare CW and AIFS */ -+ if ((edca[j] & 0xFFFF) < (edca[i] & 0xFFFF)) { -+ change_inx = true; -+ } else if ((edca[j] & 0xFFFF) == (edca[i] & 0xFFFF)) { -+ /* compare TXOP */ -+ if ((edca[j] >> 16) > (edca[i] >> 16)) -+ change_inx = true; -+ } -+ -+ if (change_inx) { -+ tmp = edca[i]; -+ edca[i] = edca[j]; -+ edca[j] = tmp; -+ -+ tmp = inx[i]; -+ inx[i] = inx[j]; -+ inx[j] = tmp; -+ -+ change_inx = false; -+ } -+ } -+ } -+ } -+ -+ for (i = 0; i < 4; i++) { -+ pxmitpriv->wmm_para_seq[i] = inx[i]; -+ DBG_871X("wmm_para_seq(%d): %d\n", i, pxmitpriv->wmm_para_seq[i]); -+ } -+ } -+} -+ -+static void bwmode_update_check(struct adapter *padapter, struct ndis_80211_var_ie *pIE) -+{ -+ unsigned char new_bwmode; -+ unsigned char new_ch_offset; -+ struct HT_info_element *pHT_info; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ u8 cbw40_enable = 0; -+ -+ if (!pIE) -+ return; -+ -+ if (phtpriv->ht_option == false) -+ return; -+ -+ if (pmlmeext->cur_bwmode >= CHANNEL_WIDTH_80) -+ return; -+ -+ if (pIE->Length > sizeof(struct HT_info_element)) -+ return; -+ -+ pHT_info = (struct HT_info_element *)pIE->data; -+ -+ if (pmlmeext->cur_channel > 14) { -+ if ((pregistrypriv->bw_mode & 0xf0) > 0) -+ cbw40_enable = 1; -+ } else -+ if ((pregistrypriv->bw_mode & 0x0f) > 0) -+ cbw40_enable = 1; -+ -+ if ((pHT_info->infos[0] & BIT(2)) && cbw40_enable) { -+ new_bwmode = CHANNEL_WIDTH_40; -+ -+ switch (pHT_info->infos[0] & 0x3) { -+ case 1: -+ new_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case 3: -+ new_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ new_bwmode = CHANNEL_WIDTH_20; -+ new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ } else{ -+ new_bwmode = CHANNEL_WIDTH_20; -+ new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ -+ if ((new_bwmode != pmlmeext->cur_bwmode) || (new_ch_offset != pmlmeext->cur_ch_offset)) { -+ pmlmeinfo->bwmode_updated = true; -+ -+ pmlmeext->cur_bwmode = new_bwmode; -+ pmlmeext->cur_ch_offset = new_ch_offset; -+ -+ /* update HT info also */ -+ HT_info_handler(padapter, pIE); -+ } else -+ pmlmeinfo->bwmode_updated = false; -+ -+ -+ if (true == pmlmeinfo->bwmode_updated) { -+ struct sta_info *psta; -+ struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ /* set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */ -+ -+ -+ /* update ap's stainfo */ -+ psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); -+ if (psta) { -+ struct ht_priv *phtpriv_sta = &psta->htpriv; -+ -+ if (phtpriv_sta->ht_option) { -+ /* bwmode */ -+ psta->bw_mode = pmlmeext->cur_bwmode; -+ phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; -+ } else{ -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ rtw_dm_ra_mask_wk_cmd(padapter, (u8 *)psta); -+ } -+ } -+} -+ -+void HT_caps_handler(struct adapter *padapter, struct ndis_80211_var_ie *pIE) -+{ -+ unsigned int i; -+ u8 rf_type; -+ u8 max_AMPDU_len, min_MPDU_spacing; -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ -+ if (pIE == NULL) -+ return; -+ -+ if (phtpriv->ht_option == false) -+ return; -+ -+ pmlmeinfo->HT_caps_enable = 1; -+ -+ for (i = 0; i < (pIE->Length); i++) { -+ if (i != 2) { -+ /* Commented by Albert 2010/07/12 */ -+ /* Got the endian issue here. */ -+ pmlmeinfo->HT_caps.u.HT_cap[i] &= (pIE->data[i]); -+ } else{ -+ /* modify from fw by Thomas 2010/11/17 */ -+ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3) > (pIE->data[i] & 0x3)) -+ max_AMPDU_len = (pIE->data[i] & 0x3); -+ else -+ max_AMPDU_len = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3); -+ -+ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) > (pIE->data[i] & 0x1c)) -+ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c); -+ else -+ min_MPDU_spacing = (pIE->data[i] & 0x1c); -+ -+ pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para = max_AMPDU_len | min_MPDU_spacing; -+ } -+ } -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ /* update the MCS set */ -+ for (i = 0; i < 16; i++) -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= pmlmeext->default_supported_mcs_set[i]; -+ -+ /* update the MCS rates */ -+ switch (rf_type) { -+ case RF_1T1R: -+ case RF_1T2R: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_1R); -+ break; -+ case RF_2T2R: -+ default: -+#ifdef CONFIG_DISABLE_MCS13TO15 -+ if (pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && pregistrypriv->wifi_spec != 1) -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R_13TO15_OFF); -+ else -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+#else /* CONFIG_DISABLE_MCS13TO15 */ -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+#endif /* CONFIG_DISABLE_MCS13TO15 */ -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ /* Config STBC setting */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAPABILITY_ELE_TX_STBC(pIE->data)) { -+ SET_FLAG(cur_stbc_cap, STBC_HT_ENABLE_TX); -+ DBG_871X("Enable HT Tx STBC !\n"); -+ } -+ phtpriv->stbc_cap = cur_stbc_cap; -+ } else { -+ /* Config LDPC Coding Capability */ -+ if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX) && GET_HT_CAPABILITY_ELE_LDPC_CAP(pIE->data)) { -+ SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX)); -+ DBG_871X("Enable HT Tx LDPC!\n"); -+ } -+ phtpriv->ldpc_cap = cur_ldpc_cap; -+ -+ /* Config STBC setting */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAPABILITY_ELE_RX_STBC(pIE->data)) { -+ SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX)); -+ DBG_871X("Enable HT Tx STBC!\n"); -+ } -+ phtpriv->stbc_cap = cur_stbc_cap; -+ } -+} -+ -+void HT_info_handler(struct adapter *padapter, struct ndis_80211_var_ie *pIE) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ -+ if (pIE == NULL) -+ return; -+ -+ if (phtpriv->ht_option == false) -+ return; -+ -+ -+ if (pIE->Length > sizeof(struct HT_info_element)) -+ return; -+ -+ pmlmeinfo->HT_info_enable = 1; -+ memcpy(&(pmlmeinfo->HT_info), pIE->data, pIE->Length); -+ -+ return; -+} -+ -+void HTOnAssocRsp(struct adapter *padapter) -+{ -+ unsigned char max_AMPDU_len; -+ unsigned char min_MPDU_spacing; -+ /* struct registry_priv *pregpriv = &padapter->registrypriv; */ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ DBG_871X("%s\n", __func__); -+ -+ if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable)) { -+ pmlmeinfo->HT_enable = 1; -+ } else{ -+ pmlmeinfo->HT_enable = 0; -+ /* set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */ -+ return; -+ } -+ -+ /* handle A-MPDU parameter field */ -+ /* -+ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k -+ AMPDU_para [4:2]:Min MPDU Start Spacing -+ */ -+ max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; -+ -+ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MIN_SPACE, (u8 *)(&min_MPDU_spacing)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len)); -+} -+ -+void ERP_IE_handler(struct adapter *padapter, struct ndis_80211_var_ie *pIE) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pIE->Length > 1) -+ return; -+ -+ pmlmeinfo->ERP_enable = 1; -+ memcpy(&(pmlmeinfo->ERP_IE), pIE->data, pIE->Length); -+} -+ -+void VCS_update(struct adapter *padapter, struct sta_info *psta) -+{ -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ switch (pregpriv->vrtl_carrier_sense) {/* 0:off 1:on 2:auto */ -+ case 0: /* off */ -+ psta->rtsen = 0; -+ psta->cts2self = 0; -+ break; -+ -+ case 1: /* on */ -+ if (pregpriv->vcs_type == 1) { /* 1:RTS/CTS 2:CTS to self */ -+ psta->rtsen = 1; -+ psta->cts2self = 0; -+ } else{ -+ psta->rtsen = 0; -+ psta->cts2self = 1; -+ } -+ break; -+ -+ case 2: /* auto */ -+ default: -+ if ((pmlmeinfo->ERP_enable) && (pmlmeinfo->ERP_IE & BIT(1))) { -+ if (pregpriv->vcs_type == 1) { -+ psta->rtsen = 1; -+ psta->cts2self = 0; -+ } else{ -+ psta->rtsen = 0; -+ psta->cts2self = 1; -+ } -+ } else{ -+ psta->rtsen = 0; -+ psta->cts2self = 0; -+ } -+ break; -+ } -+} -+ -+void update_ldpc_stbc_cap(struct sta_info *psta) -+{ -+ if (psta->htpriv.ht_option) { -+ if (TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_ENABLE_TX)) -+ psta->ldpc = 1; -+ -+ if (TEST_FLAG(psta->htpriv.stbc_cap, STBC_HT_ENABLE_TX)) -+ psta->stbc = 1; -+ } else { -+ psta->ldpc = 0; -+ psta->stbc = 0; -+ } -+} -+ -+int rtw_check_bcn_info(struct adapter *Adapter, u8 *pframe, u32 packet_len) -+{ -+ unsigned int len; -+ unsigned char *p; -+ unsigned short val16, subtype; -+ struct wlan_network *cur_network = &(Adapter->mlmepriv.cur_network); -+ /* u8 wpa_ie[255], rsn_ie[255]; */ -+ u16 wpa_len = 0, rsn_len = 0; -+ u8 encryp_protocol = 0; -+ struct wlan_bssid_ex *bssid; -+ int group_cipher = 0, pairwise_cipher = 0, is_8021x = 0; -+ unsigned char *pbuf; -+ u32 wpa_ielen = 0; -+ u8 *pbssid = GetAddr3Ptr(pframe); -+ u32 hidden_ssid = 0; -+ struct HT_info_element *pht_info = NULL; -+ struct rtw_ieee80211_ht_cap *pht_cap = NULL; -+ u32 bcn_channel; -+ unsigned short ht_cap_info; -+ unsigned char ht_info_infos_0; -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ -+ if (is_client_associated_to_ap(Adapter) == false) -+ return true; -+ -+ len = packet_len - sizeof(struct ieee80211_hdr_3addr); -+ -+ if (len > MAX_IE_SZ) { -+ DBG_871X("%s IE too long for survey event\n", __func__); -+ return _FAIL; -+ } -+ -+ if (memcmp(cur_network->network.MacAddress, pbssid, 6)) { -+ DBG_871X("Oops: rtw_check_network_encrypt linked but recv other bssid bcn\n" MAC_FMT MAC_FMT, -+ MAC_ARG(pbssid), MAC_ARG(cur_network->network.MacAddress)); -+ return true; -+ } -+ -+ bssid = (struct wlan_bssid_ex *)rtw_zmalloc(sizeof(struct wlan_bssid_ex)); -+ if (bssid == NULL) { -+ DBG_871X("%s rtw_zmalloc fail !!!\n", __func__); -+ return true; -+ } -+ -+ if ((pmlmepriv->timeBcnInfoChkStart != 0) && (jiffies_to_msecs(jiffies - pmlmepriv->timeBcnInfoChkStart) > DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS)) { -+ pmlmepriv->timeBcnInfoChkStart = 0; -+ pmlmepriv->NumOfBcnInfoChkFail = 0; -+ } -+ -+ subtype = GetFrameSubType(pframe) >> 4; -+ -+ if (subtype == WIFI_BEACON) -+ bssid->Reserved[0] = 1; -+ -+ bssid->Length = sizeof(struct wlan_bssid_ex) - MAX_IE_SZ + len; -+ -+ /* below is to copy the information element */ -+ bssid->IELength = len; -+ memcpy(bssid->IEs, (pframe + sizeof(struct ieee80211_hdr_3addr)), bssid->IELength); -+ -+ /* check bw and channel offset */ -+ /* parsing HT_CAP_IE */ -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (p && len > 0) { -+ pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); -+ ht_cap_info = le16_to_cpu(pht_cap->cap_info); -+ } else { -+ ht_cap_info = 0; -+ } -+ /* parsing HT_INFO_IE */ -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (p && len > 0) { -+ pht_info = (struct HT_info_element *)(p + 2); -+ ht_info_infos_0 = pht_info->infos[0]; -+ } else { -+ ht_info_infos_0 = 0; -+ } -+ if (ht_cap_info != cur_network->BcnInfo.ht_cap_info || -+ ((ht_info_infos_0&0x03) != (cur_network->BcnInfo.ht_info_infos_0&0x03))) { -+ DBG_871X("%s bcn now: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, -+ ht_cap_info, ht_info_infos_0); -+ DBG_871X("%s bcn link: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, -+ cur_network->BcnInfo.ht_cap_info, cur_network->BcnInfo.ht_info_infos_0); -+ DBG_871X("%s bw mode change\n", __func__); -+ { -+ /* bcn_info_update */ -+ cur_network->BcnInfo.ht_cap_info = ht_cap_info; -+ cur_network->BcnInfo.ht_info_infos_0 = ht_info_infos_0; -+ /* to do : need to check that whether modify related register of BB or not */ -+ } -+ /* goto _mismatch; */ -+ } -+ -+ /* Checking for channel */ -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _DSSET_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (p) { -+ bcn_channel = *(p + 2); -+ } else {/* In 5G, some ap do not have DSSET IE checking HT info for channel */ -+ rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (pht_info) { -+ bcn_channel = pht_info->primary_channel; -+ } else { /* we don't find channel IE, so don't check it */ -+ /* DBG_871X("Oops: %s we don't find channel IE, so don't check it\n", __func__); */ -+ bcn_channel = Adapter->mlmeextpriv.cur_channel; -+ } -+ } -+ if (bcn_channel != Adapter->mlmeextpriv.cur_channel) { -+ DBG_871X("%s beacon channel:%d cur channel:%d disconnect\n", __func__, -+ bcn_channel, Adapter->mlmeextpriv.cur_channel); -+ goto _mismatch; -+ } -+ -+ /* checking SSID */ -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _SSID_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (p == NULL) { -+ DBG_871X("%s marc: cannot find SSID for survey event\n", __func__); -+ hidden_ssid = true; -+ } else { -+ hidden_ssid = false; -+ } -+ -+ if ((NULL != p) && (false == hidden_ssid && (*(p + 1)))) { -+ memcpy(bssid->Ssid.Ssid, (p + 2), *(p + 1)); -+ bssid->Ssid.SsidLength = *(p + 1); -+ } else { -+ bssid->Ssid.SsidLength = 0; -+ bssid->Ssid.Ssid[0] = '\0'; -+ } -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("%s bssid.Ssid.Ssid:%s bssid.Ssid.SsidLength:%d " -+ "cur_network->network.Ssid.Ssid:%s len:%d\n", __func__, bssid->Ssid.Ssid, -+ bssid->Ssid.SsidLength, cur_network->network.Ssid.Ssid, -+ cur_network->network.Ssid.SsidLength)); -+ -+ if (memcmp(bssid->Ssid.Ssid, cur_network->network.Ssid.Ssid, 32) || -+ bssid->Ssid.SsidLength != cur_network->network.Ssid.SsidLength) { -+ if (bssid->Ssid.Ssid[0] != '\0' && bssid->Ssid.SsidLength != 0) { /* not hidden ssid */ -+ DBG_871X("%s(), SSID is not match\n", __func__); -+ goto _mismatch; -+ } -+ } -+ -+ /* check encryption info */ -+ val16 = rtw_get_capability((struct wlan_bssid_ex *)bssid); -+ -+ if (val16 & BIT(4)) -+ bssid->Privacy = 1; -+ else -+ bssid->Privacy = 0; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, -+ ("%s(): cur_network->network.Privacy is %d, bssid.Privacy is %d\n", -+ __func__, cur_network->network.Privacy, bssid->Privacy)); -+ if (cur_network->network.Privacy != bssid->Privacy) { -+ DBG_871X("%s(), privacy is not match\n", __func__); -+ goto _mismatch; -+ } -+ -+ rtw_get_sec_ie(bssid->IEs, bssid->IELength, NULL, &rsn_len, NULL, &wpa_len); -+ -+ if (rsn_len > 0) { -+ encryp_protocol = ENCRYP_PROTOCOL_WPA2; -+ } else if (wpa_len > 0) { -+ encryp_protocol = ENCRYP_PROTOCOL_WPA; -+ } else { -+ if (bssid->Privacy) -+ encryp_protocol = ENCRYP_PROTOCOL_WEP; -+ } -+ -+ if (cur_network->BcnInfo.encryp_protocol != encryp_protocol) { -+ DBG_871X("%s(): enctyp is not match\n", __func__); -+ goto _mismatch; -+ } -+ -+ if (encryp_protocol == ENCRYP_PROTOCOL_WPA || encryp_protocol == ENCRYP_PROTOCOL_WPA2) { -+ pbuf = rtw_get_wpa_ie(&bssid->IEs[12], &wpa_ielen, bssid->IELength-12); -+ if (pbuf && (wpa_ielen > 0)) { -+ if (_SUCCESS == rtw_parse_wpa_ie(pbuf, wpa_ielen+2, &group_cipher, &pairwise_cipher, &is_8021x)) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, -+ ("%s pnetwork->pairwise_cipher: %d, group_cipher is %d, is_8021x is %d\n", __func__, -+ pairwise_cipher, group_cipher, is_8021x)); -+ } -+ } else { -+ pbuf = rtw_get_wpa2_ie(&bssid->IEs[12], &wpa_ielen, bssid->IELength-12); -+ -+ if (pbuf && (wpa_ielen > 0)) { -+ if (_SUCCESS == rtw_parse_wpa2_ie(pbuf, wpa_ielen+2, &group_cipher, &pairwise_cipher, &is_8021x)) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, -+ ("%s pnetwork->pairwise_cipher: %d, pnetwork->group_cipher is %d, is_802x is %d\n", -+ __func__, pairwise_cipher, group_cipher, is_8021x)); -+ } -+ } -+ } -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, -+ ("%s cur_network->group_cipher is %d: %d\n", __func__, cur_network->BcnInfo.group_cipher, group_cipher)); -+ if (pairwise_cipher != cur_network->BcnInfo.pairwise_cipher || group_cipher != cur_network->BcnInfo.group_cipher) { -+ DBG_871X("%s pairwise_cipher(%x:%x) or group_cipher(%x:%x) is not match\n", __func__, -+ pairwise_cipher, cur_network->BcnInfo.pairwise_cipher, -+ group_cipher, cur_network->BcnInfo.group_cipher); -+ goto _mismatch; -+ } -+ -+ if (is_8021x != cur_network->BcnInfo.is_8021x) { -+ DBG_871X("%s authentication is not match\n", __func__); -+ goto _mismatch; -+ } -+ } -+ -+ kfree((u8 *)bssid); -+ return _SUCCESS; -+ -+_mismatch: -+ kfree((u8 *)bssid); -+ -+ if (pmlmepriv->NumOfBcnInfoChkFail == 0) -+ pmlmepriv->timeBcnInfoChkStart = jiffies; -+ -+ pmlmepriv->NumOfBcnInfoChkFail++; -+ DBG_871X("%s by "ADPT_FMT" - NumOfChkFail = %d (SeqNum of this Beacon frame = %d).\n", __func__, ADPT_ARG(Adapter), pmlmepriv->NumOfBcnInfoChkFail, GetSequence(pframe)); -+ -+ if ((pmlmepriv->timeBcnInfoChkStart != 0) && (jiffies_to_msecs(jiffies - pmlmepriv->timeBcnInfoChkStart) <= DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS) -+ && (pmlmepriv->NumOfBcnInfoChkFail >= DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD)) { -+ DBG_871X("%s by "ADPT_FMT" - NumOfChkFail = %d >= threshold : %d (in %d ms), return FAIL.\n", __func__, ADPT_ARG(Adapter), pmlmepriv->NumOfBcnInfoChkFail, -+ DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD, jiffies_to_msecs(jiffies - pmlmepriv->timeBcnInfoChkStart)); -+ pmlmepriv->timeBcnInfoChkStart = 0; -+ pmlmepriv->NumOfBcnInfoChkFail = 0; -+ return _FAIL; -+ } -+ -+ return _SUCCESS; -+} -+ -+void update_beacon_info(struct adapter *padapter, u8 *pframe, uint pkt_len, struct sta_info *psta) -+{ -+ unsigned int i; -+ unsigned int len; -+ struct ndis_80211_var_ie *pIE; -+ -+ len = pkt_len - (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN); -+ -+ for (i = 0; i < len;) { -+ pIE = (struct ndis_80211_var_ie *)(pframe + (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN) + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_: -+ /* to update WMM paramter set while receiving beacon */ -+ if (!memcmp(pIE->data, WMM_PARA_OUI, 6) && pIE->Length == WLAN_WMM_LEN) /* WMM */ -+ if (WMM_param_handler(padapter, pIE)) -+ report_wmm_edca_update(padapter); -+ -+ break; -+ -+ case _HT_EXTRA_INFO_IE_: /* HT info */ -+ /* HT_info_handler(padapter, pIE); */ -+ bwmode_update_check(padapter, pIE); -+ break; -+ -+ case _ERPINFO_IE_: -+ ERP_IE_handler(padapter, pIE); -+ VCS_update(padapter, psta); -+ break; -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+} -+ -+unsigned int is_ap_in_tkip(struct adapter *padapter) -+{ -+ u32 i; -+ struct ndis_80211_var_ie *pIE; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network); -+ -+ if (rtw_get_capability((struct wlan_bssid_ex *)cur_network) & WLAN_CAPABILITY_PRIVACY) { -+ for (i = sizeof(struct ndis_802_11_fix_ie); i < pmlmeinfo->network.IELength;) { -+ pIE = (struct ndis_80211_var_ie *)(pmlmeinfo->network.IEs + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_: -+ if ((!memcmp(pIE->data, RTW_WPA_OUI, 4)) && (!memcmp((pIE->data + 12), WPA_TKIP_CIPHER, 4))) -+ return true; -+ -+ break; -+ -+ case _RSN_IE_2_: -+ if (!memcmp((pIE->data + 8), RSN_TKIP_CIPHER, 4)) -+ return true; -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ return false; -+ } else -+ return false; -+ -+} -+ -+int support_short_GI(struct adapter *padapter, struct HT_caps_element *pHT_caps, u8 bwmode) -+{ -+ unsigned char bit_offset; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (!(pmlmeinfo->HT_enable)) -+ return _FAIL; -+ -+ bit_offset = (bwmode & CHANNEL_WIDTH_40) ? 6 : 5; -+ -+ if (le16_to_cpu(pHT_caps->u.HT_cap_element.HT_caps_info) & (0x1 << bit_offset)) -+ return _SUCCESS; -+ else -+ return _FAIL; -+} -+ -+unsigned char get_highest_rate_idx(u32 mask) -+{ -+ int i; -+ unsigned char rate_idx = 0; -+ -+ for (i = 31; i >= 0; i--) { -+ if (mask & BIT(i)) { -+ rate_idx = i; -+ break; -+ } -+ } -+ -+ return rate_idx; -+} -+ -+void Update_RA_Entry(struct adapter *padapter, struct sta_info *psta) -+{ -+ rtw_hal_update_ra_mask(psta, 0); -+} -+ -+void enable_rate_adaptive(struct adapter *padapter, struct sta_info *psta); -+void enable_rate_adaptive(struct adapter *padapter, struct sta_info *psta) -+{ -+ Update_RA_Entry(padapter, psta); -+} -+ -+void set_sta_rate(struct adapter *padapter, struct sta_info *psta) -+{ -+ /* rate adaptive */ -+ enable_rate_adaptive(padapter, psta); -+} -+ -+unsigned char check_assoc_AP(u8 *pframe, uint len) -+{ -+ unsigned int i; -+ struct ndis_80211_var_ie *pIE; -+ -+ for (i = sizeof(struct ndis_802_11_fix_ie); i < len;) { -+ pIE = (struct ndis_80211_var_ie *)(pframe + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_: -+ if ((!memcmp(pIE->data, ARTHEROS_OUI1, 3)) || (!memcmp(pIE->data, ARTHEROS_OUI2, 3))) { -+ DBG_871X("link to Artheros AP\n"); -+ return HT_IOT_PEER_ATHEROS; -+ } else if ((!memcmp(pIE->data, BROADCOM_OUI1, 3)) -+ || (!memcmp(pIE->data, BROADCOM_OUI2, 3)) -+ || (!memcmp(pIE->data, BROADCOM_OUI3, 3))) { -+ DBG_871X("link to Broadcom AP\n"); -+ return HT_IOT_PEER_BROADCOM; -+ } else if (!memcmp(pIE->data, MARVELL_OUI, 3)) { -+ DBG_871X("link to Marvell AP\n"); -+ return HT_IOT_PEER_MARVELL; -+ } else if (!memcmp(pIE->data, RALINK_OUI, 3)) { -+ DBG_871X("link to Ralink AP\n"); -+ return HT_IOT_PEER_RALINK; -+ } else if (!memcmp(pIE->data, CISCO_OUI, 3)) { -+ DBG_871X("link to Cisco AP\n"); -+ return HT_IOT_PEER_CISCO; -+ } else if (!memcmp(pIE->data, REALTEK_OUI, 3)) { -+ u32 Vender = HT_IOT_PEER_REALTEK; -+ -+ if (pIE->Length >= 5) { -+ if (pIE->data[4] == 1) -+ /* if (pIE->data[5] & RT_HT_CAP_USE_LONG_PREAMBLE) */ -+ /* bssDesc->BssHT.RT2RT_HT_Mode |= RT_HT_CAP_USE_LONG_PREAMBLE; */ -+ if (pIE->data[5] & RT_HT_CAP_USE_92SE) -+ /* bssDesc->BssHT.RT2RT_HT_Mode |= RT_HT_CAP_USE_92SE; */ -+ Vender = HT_IOT_PEER_REALTEK_92SE; -+ -+ if (pIE->data[5] & RT_HT_CAP_USE_SOFTAP) -+ Vender = HT_IOT_PEER_REALTEK_SOFTAP; -+ -+ if (pIE->data[4] == 2) { -+ if (pIE->data[6] & RT_HT_CAP_USE_JAGUAR_BCUT) { -+ Vender = HT_IOT_PEER_REALTEK_JAGUAR_BCUTAP; -+ DBG_871X("link to Realtek JAGUAR_BCUTAP\n"); -+ } -+ if (pIE->data[6] & RT_HT_CAP_USE_JAGUAR_CCUT) { -+ Vender = HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP; -+ DBG_871X("link to Realtek JAGUAR_CCUTAP\n"); -+ } -+ } -+ } -+ -+ DBG_871X("link to Realtek AP\n"); -+ return Vender; -+ } else if (!memcmp(pIE->data, AIRGOCAP_OUI, 3)) { -+ DBG_871X("link to Airgo Cap\n"); -+ return HT_IOT_PEER_AIRGO; -+ } else -+ break; -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ DBG_871X("link to new AP\n"); -+ return HT_IOT_PEER_UNKNOWN; -+} -+ -+void update_IOT_info(struct adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ switch (pmlmeinfo->assoc_AP_vendor) { -+ case HT_IOT_PEER_MARVELL: -+ pmlmeinfo->turboMode_cts2self = 1; -+ pmlmeinfo->turboMode_rtsen = 0; -+ break; -+ -+ case HT_IOT_PEER_RALINK: -+ pmlmeinfo->turboMode_cts2self = 0; -+ pmlmeinfo->turboMode_rtsen = 1; -+ /* disable high power */ -+ Switch_DM_Func(padapter, (~DYNAMIC_BB_DYNAMIC_TXPWR), false); -+ break; -+ case HT_IOT_PEER_REALTEK: -+ /* rtw_write16(padapter, 0x4cc, 0xffff); */ -+ /* rtw_write16(padapter, 0x546, 0x01c0); */ -+ /* disable high power */ -+ Switch_DM_Func(padapter, (~DYNAMIC_BB_DYNAMIC_TXPWR), false); -+ break; -+ default: -+ pmlmeinfo->turboMode_cts2self = 0; -+ pmlmeinfo->turboMode_rtsen = 1; -+ break; -+ } -+ -+} -+ -+void update_capinfo(struct adapter *Adapter, u16 updateCap) -+{ -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ bool ShortPreamble; -+ -+ /* Check preamble mode, 2005.01.06, by rcnjko. */ -+ /* Mark to update preamble value forever, 2008.03.18 by lanhsin */ -+ /* if (pMgntInfo->RegPreambleMode == PREAMBLE_AUTO) */ -+ { -+ -+ if (updateCap & cShortPreamble) { -+ /* Short Preamble */ -+ if (pmlmeinfo->preamble_mode != PREAMBLE_SHORT) { /* PREAMBLE_LONG or PREAMBLE_AUTO */ -+ ShortPreamble = true; -+ pmlmeinfo->preamble_mode = PREAMBLE_SHORT; -+ rtw_hal_set_hwreg(Adapter, HW_VAR_ACK_PREAMBLE, (u8 *)&ShortPreamble); -+ } -+ } else{ -+ /* Long Preamble */ -+ if (pmlmeinfo->preamble_mode != PREAMBLE_LONG) { /* PREAMBLE_SHORT or PREAMBLE_AUTO */ -+ ShortPreamble = false; -+ pmlmeinfo->preamble_mode = PREAMBLE_LONG; -+ rtw_hal_set_hwreg(Adapter, HW_VAR_ACK_PREAMBLE, (u8 *)&ShortPreamble); -+ } -+ } -+ } -+ -+ if (updateCap & cIBSS) -+ /* Filen: See 802.11-2007 p.91 */ -+ pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; -+ else { -+ /* Filen: See 802.11-2007 p.90 */ -+ if (pmlmeext->cur_wireless_mode & (WIRELESS_11_24N | WIRELESS_11A | WIRELESS_11_5N | WIRELESS_11AC)) -+ pmlmeinfo->slotTime = SHORT_SLOT_TIME; -+ else if (pmlmeext->cur_wireless_mode & (WIRELESS_11G)) { -+ if ((updateCap & cShortSlotTime) /* && (!(pMgntInfo->pHTInfo->RT2RT_HT_Mode & RT_HT_CAP_USE_LONG_PREAMBLE)) */) -+ /* Short Slot Time */ -+ pmlmeinfo->slotTime = SHORT_SLOT_TIME; -+ else -+ /* Long Slot Time */ -+ pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; -+ } else -+ /* B Mode */ -+ pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; -+ } -+ -+ rtw_hal_set_hwreg(Adapter, HW_VAR_SLOT_TIME, &pmlmeinfo->slotTime); -+ -+} -+ -+void update_wireless_mode(struct adapter *padapter) -+{ -+ int ratelen, network_type = 0; -+ u32 SIFS_Timer; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network); -+ unsigned char *rate = cur_network->SupportedRates; -+ -+ ratelen = rtw_get_rateset_len(cur_network->SupportedRates); -+ -+ if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable)) -+ pmlmeinfo->HT_enable = 1; -+ -+ if (pmlmeext->cur_channel > 14) { -+ if (pmlmeinfo->VHT_enable) -+ network_type = WIRELESS_11AC; -+ else if (pmlmeinfo->HT_enable) -+ network_type = WIRELESS_11_5N; -+ -+ network_type |= WIRELESS_11A; -+ } else{ -+ if (pmlmeinfo->VHT_enable) -+ network_type = WIRELESS_11AC; -+ else if (pmlmeinfo->HT_enable) -+ network_type = WIRELESS_11_24N; -+ -+ if ((cckratesonly_included(rate, ratelen)) == true) -+ network_type |= WIRELESS_11B; -+ else if ((cckrates_included(rate, ratelen)) == true) -+ network_type |= WIRELESS_11BG; -+ else -+ network_type |= WIRELESS_11G; -+ } -+ -+ pmlmeext->cur_wireless_mode = network_type & padapter->registrypriv.wireless_mode; -+ -+ SIFS_Timer = 0x0a0a0808; /* 0x0808 -> for CCK, 0x0a0a -> for OFDM */ -+ /* change this value if having IOT issues. */ -+ -+ padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_RESP_SIFS, (u8 *)&SIFS_Timer); -+ -+ padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_WIRELESS_MODE, (u8 *)&(pmlmeext->cur_wireless_mode)); -+ -+ if (pmlmeext->cur_wireless_mode & WIRELESS_11B) -+ update_mgnt_tx_rate(padapter, IEEE80211_CCK_RATE_1MB); -+ else -+ update_mgnt_tx_rate(padapter, IEEE80211_OFDM_RATE_6MB); -+} -+ -+void update_sta_basic_rate(struct sta_info *psta, u8 wireless_mode) -+{ -+ if (IsSupportedTxCCK(wireless_mode)) { -+ /* Only B, B/G, and B/G/N AP could use CCK rate */ -+ memcpy(psta->bssrateset, rtw_basic_rate_cck, 4); -+ psta->bssratelen = 4; -+ } else{ -+ memcpy(psta->bssrateset, rtw_basic_rate_ofdm, 3); -+ psta->bssratelen = 3; -+ } -+} -+ -+int update_sta_support_rate(struct adapter *padapter, u8 *pvar_ie, uint var_ie_len, int cam_idx) -+{ -+ unsigned int ie_len; -+ struct ndis_80211_var_ie *pIE; -+ int supportRateNum = 0; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ pIE = (struct ndis_80211_var_ie *)rtw_get_ie(pvar_ie, _SUPPORTEDRATES_IE_, &ie_len, var_ie_len); -+ if (pIE == NULL) -+ return _FAIL; -+ -+ memcpy(pmlmeinfo->FW_sta_info[cam_idx].SupportedRates, pIE->data, ie_len); -+ supportRateNum = ie_len; -+ -+ pIE = (struct ndis_80211_var_ie *)rtw_get_ie(pvar_ie, _EXT_SUPPORTEDRATES_IE_, &ie_len, var_ie_len); -+ if (pIE) -+ memcpy((pmlmeinfo->FW_sta_info[cam_idx].SupportedRates + supportRateNum), pIE->data, ie_len); -+ -+ return _SUCCESS; -+ -+} -+ -+void process_addba_req(struct adapter *padapter, u8 *paddba_req, u8 *addr) -+{ -+ struct sta_info *psta; -+ u16 tid, start_seq, param; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct ADDBA_request *preq = (struct ADDBA_request *)paddba_req; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ psta = rtw_get_stainfo(pstapriv, addr); -+ -+ if (psta) { -+ start_seq = le16_to_cpu(preq->BA_starting_seqctrl) >> 4; -+ -+ param = le16_to_cpu(preq->BA_para_set); -+ tid = (param>>2)&0x0f; -+ -+ preorder_ctrl = &psta->recvreorder_ctrl[tid]; -+ -+ #ifdef CONFIG_UPDATE_INDICATE_SEQ_WHILE_PROCESS_ADDBA_REQ -+ preorder_ctrl->indicate_seq = start_seq; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, start_seq: %d\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq, start_seq); -+ #endif -+ #else -+ preorder_ctrl->indicate_seq = 0xffff; -+ #endif -+ -+ preorder_ctrl->enable = (pmlmeinfo->bAcceptAddbaReq == true) ? true : false; -+ } -+ -+} -+ -+void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len) -+{ -+ u8 *pIE; -+ __le32 *pbuf; -+ -+ pIE = pframe + sizeof(struct ieee80211_hdr_3addr); -+ pbuf = (__le32 *)pIE; -+ -+ pmlmeext->TSFValue = le32_to_cpu(*(pbuf+1)); -+ -+ pmlmeext->TSFValue = pmlmeext->TSFValue << 32; -+ -+ pmlmeext->TSFValue |= le32_to_cpu(*pbuf); -+} -+ -+void correct_TSF(struct adapter *padapter, struct mlme_ext_priv *pmlmeext) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CORRECT_TSF, NULL); -+} -+ -+void adaptive_early_32k(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len) -+{ -+ int i; -+ u8 *pIE; -+ __le32 *pbuf; -+ u64 tsf = 0; -+ u32 delay_ms; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ pmlmeext->bcn_cnt++; -+ -+ pIE = pframe + sizeof(struct ieee80211_hdr_3addr); -+ pbuf = (__le32 *)pIE; -+ -+ tsf = le32_to_cpu(*(pbuf+1)); -+ tsf = tsf << 32; -+ tsf |= le32_to_cpu(*pbuf); -+ -+ /* DBG_871X("%s(): tsf_upper = 0x%08x, tsf_lower = 0x%08x\n", __func__, (u32)(tsf>>32), (u32)tsf); */ -+ -+ /* delay = (timestamp mod 1024*100)/1000 (unit: ms) */ -+ /* delay_ms = do_div(tsf, (pmlmeinfo->bcn_interval*1024))/1000; */ -+ delay_ms = rtw_modular64(tsf, (pmlmeinfo->bcn_interval*1024)); -+ delay_ms = delay_ms/1000; -+ -+ if (delay_ms >= 8) -+ pmlmeext->bcn_delay_cnt[8]++; -+ /* pmlmeext->bcn_delay_ratio[8] = (pmlmeext->bcn_delay_cnt[8] * 100) /pmlmeext->bcn_cnt; */ -+ else -+ pmlmeext->bcn_delay_cnt[delay_ms]++; -+ /* pmlmeext->bcn_delay_ratio[delay_ms] = (pmlmeext->bcn_delay_cnt[delay_ms] * 100) /pmlmeext->bcn_cnt; */ -+ -+/* -+ DBG_871X("%s(): (a)bcn_cnt = %d\n", __func__, pmlmeext->bcn_cnt); -+ -+ -+ for (i = 0; i<9; i++) -+ { -+ DBG_871X("%s():bcn_delay_cnt[%d]=%d, bcn_delay_ratio[%d]=%d\n", __func__, i, -+ pmlmeext->bcn_delay_cnt[i] , i, pmlmeext->bcn_delay_ratio[i]); -+ } -+*/ -+ -+ /* dump for adaptive_early_32k */ -+ if (pmlmeext->bcn_cnt > 100 && (pmlmeext->adaptive_tsf_done == true)) { -+ u8 ratio_20_delay, ratio_80_delay; -+ u8 DrvBcnEarly, DrvBcnTimeOut; -+ -+ ratio_20_delay = 0; -+ ratio_80_delay = 0; -+ DrvBcnEarly = 0xff; -+ DrvBcnTimeOut = 0xff; -+ -+ DBG_871X("%s(): bcn_cnt = %d\n", __func__, pmlmeext->bcn_cnt); -+ -+ for (i = 0; i < 9; i++) { -+ pmlmeext->bcn_delay_ratio[i] = (pmlmeext->bcn_delay_cnt[i] * 100) / pmlmeext->bcn_cnt; -+ -+ -+ DBG_871X("%s():bcn_delay_cnt[%d]=%d, bcn_delay_ratio[%d]=%d\n", __func__, i, -+ pmlmeext->bcn_delay_cnt[i], i, pmlmeext->bcn_delay_ratio[i]); -+ -+ ratio_20_delay += pmlmeext->bcn_delay_ratio[i]; -+ ratio_80_delay += pmlmeext->bcn_delay_ratio[i]; -+ -+ if (ratio_20_delay > 20 && DrvBcnEarly == 0xff) { -+ DrvBcnEarly = i; -+ DBG_871X("%s(): DrvBcnEarly = %d\n", __func__, DrvBcnEarly); -+ } -+ -+ if (ratio_80_delay > 80 && DrvBcnTimeOut == 0xff) { -+ DrvBcnTimeOut = i; -+ DBG_871X("%s(): DrvBcnTimeOut = %d\n", __func__, DrvBcnTimeOut); -+ } -+ -+ /* reset adaptive_early_32k cnt */ -+ pmlmeext->bcn_delay_cnt[i] = 0; -+ pmlmeext->bcn_delay_ratio[i] = 0; -+ } -+ -+ pmlmeext->DrvBcnEarly = DrvBcnEarly; -+ pmlmeext->DrvBcnTimeOut = DrvBcnTimeOut; -+ -+ pmlmeext->bcn_cnt = 0; -+ } -+ -+} -+ -+ -+void beacon_timing_control(struct adapter *padapter) -+{ -+ rtw_hal_bcn_related_reg_setting(padapter); -+} -+ -+void rtw_alloc_macid(struct adapter *padapter, struct sta_info *psta) -+{ -+ int i; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ -+ -+ if (!memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) -+ return; -+ -+ if (!memcmp(psta->hwaddr, myid(&padapter->eeprompriv), ETH_ALEN)) { -+ psta->mac_id = NUM_STA; -+ return; -+ } -+ -+ spin_lock_bh(&pdvobj->lock); -+ for (i = 0; i < NUM_STA; i++) { -+ if (pdvobj->macid[i] == false) { -+ pdvobj->macid[i] = true; -+ break; -+ } -+ } -+ spin_unlock_bh(&pdvobj->lock); -+ -+ if (i > (NUM_STA-1)) { -+ psta->mac_id = NUM_STA; -+ DBG_871X(" no room for more MACIDs\n"); -+ } else{ -+ psta->mac_id = i; -+ DBG_871X("%s = %d\n", __func__, psta->mac_id); -+ } -+ -+} -+ -+void rtw_release_macid(struct adapter *padapter, struct sta_info *psta) -+{ -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ -+ -+ if (!memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) -+ return; -+ -+ if (!memcmp(psta->hwaddr, myid(&padapter->eeprompriv), ETH_ALEN)) -+ return; -+ -+ spin_lock_bh(&pdvobj->lock); -+ if (psta->mac_id < NUM_STA && psta->mac_id != 1) { -+ if (pdvobj->macid[psta->mac_id] == true) { -+ DBG_871X("%s = %d\n", __func__, psta->mac_id); -+ pdvobj->macid[psta->mac_id] = false; -+ psta->mac_id = NUM_STA; -+ } -+ -+ } -+ spin_unlock_bh(&pdvobj->lock); -+ -+} -+/* For 8188E RA */ -+u8 rtw_search_max_mac_id(struct adapter *padapter) -+{ -+ u8 max_mac_id = 0; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ int i; -+ spin_lock_bh(&pdvobj->lock); -+ for (i = (NUM_STA-1); i >= 0 ; i--) { -+ if (pdvobj->macid[i] == true) -+ break; -+ } -+ max_mac_id = i; -+ spin_unlock_bh(&pdvobj->lock); -+ -+ return max_mac_id; -+ -+} -+ -+struct adapter *dvobj_get_port0_adapter(struct dvobj_priv *dvobj) -+{ -+ if (get_iface_type(dvobj->padapters[i]) != IFACE_PORT0) -+ return NULL; -+ -+ return dvobj->padapters; -+} -+ -+#ifdef CONFIG_GPIO_API -+int rtw_get_gpio(struct net_device *netdev, int gpio_num) -+{ -+ u8 value; -+ u8 direction; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(netdev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ -+ DBG_871X("rf_pwrstate = 0x%02x\n", pwrpriv->rf_pwrstate); -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ /* Read GPIO Direction */ -+ direction = (rtw_read8(adapter, REG_GPIO_PIN_CTRL + 2) & BIT(gpio_num)) >> gpio_num; -+ -+ /* According the direction to read register value */ -+ if (direction) -+ value = (rtw_read8(adapter, REG_GPIO_PIN_CTRL + 1) & BIT(gpio_num)) >> gpio_num; -+ else -+ value = (rtw_read8(adapter, REG_GPIO_PIN_CTRL) & BIT(gpio_num)) >> gpio_num; -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ DBG_871X("%s direction =%d value =%d\n", __func__, direction, value); -+ -+ return value; -+} -+EXPORT_SYMBOL(rtw_get_gpio); -+ -+int rtw_set_gpio_output_value(struct net_device *netdev, int gpio_num, bool isHigh) -+{ -+ u8 direction = 0; -+ u8 res = -1; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(netdev); -+ -+ /* Check GPIO is 4~7 */ -+ if (gpio_num > 7 || gpio_num < 4) { -+ DBG_871X("%s The gpio number does not included 4~7.\n", __func__); -+ return -1; -+ } -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ /* Read GPIO direction */ -+ direction = (rtw_read8(adapter, REG_GPIO_PIN_CTRL + 2) & BIT(gpio_num)) >> gpio_num; -+ -+ /* If GPIO is output direction, setting value. */ -+ if (direction) { -+ if (isHigh) -+ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 1, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 1) | BIT(gpio_num)); -+ else -+ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 1, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 1) & ~BIT(gpio_num)); -+ -+ DBG_871X("%s Set gpio %x[%d]=%d\n", __func__, REG_GPIO_PIN_CTRL+1, gpio_num, isHigh); -+ res = 0; -+ } else{ -+ DBG_871X("%s The gpio is input, not be set!\n", __func__); -+ res = -1; -+ } -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ return res; -+} -+EXPORT_SYMBOL(rtw_set_gpio_output_value); -+ -+int rtw_config_gpio(struct net_device *netdev, int gpio_num, bool isOutput) -+{ -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(netdev); -+ -+ if (gpio_num > 7 || gpio_num < 4) { -+ DBG_871X("%s The gpio number does not included 4~7.\n", __func__); -+ return -1; -+ } -+ -+ DBG_871X("%s gpio_num =%d direction =%d\n", __func__, gpio_num, isOutput); -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ if (isOutput) -+ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 2, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 2) | BIT(gpio_num)); -+ else -+ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 2, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 2) & ~BIT(gpio_num)); -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ -+ return 0; -+} -+EXPORT_SYMBOL(rtw_config_gpio); -+#endif -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void rtw_get_current_ip_address(struct adapter *padapter, u8 *pcurrentip) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct in_device *my_ip_ptr = padapter->pnetdev->ip_ptr; -+ u8 ipaddress[4]; -+ -+ if ((pmlmeinfo->state & WIFI_FW_LINKING_STATE) || -+ pmlmeinfo->state & WIFI_FW_AP_STATE) { -+ if (my_ip_ptr != NULL) { -+ struct in_ifaddr *my_ifa_list = my_ip_ptr->ifa_list; -+ if (my_ifa_list != NULL) { -+ ipaddress[0] = my_ifa_list->ifa_address & 0xFF; -+ ipaddress[1] = (my_ifa_list->ifa_address >> 8) & 0xFF; -+ ipaddress[2] = (my_ifa_list->ifa_address >> 16) & 0xFF; -+ ipaddress[3] = my_ifa_list->ifa_address >> 24; -+ DBG_871X("%s: %d.%d.%d.%d ==========\n", __func__, -+ ipaddress[0], ipaddress[1], ipaddress[2], ipaddress[3]); -+ memcpy(pcurrentip, ipaddress, 4); -+ } -+ } -+ } -+} -+#endif -+#ifdef CONFIG_WOWLAN -+void rtw_get_sec_iv(struct adapter *padapter, u8 *pcur_dot11txpn, u8 *StaAddr) -+{ -+ struct sta_info *psta; -+ struct security_priv *psecpriv = &padapter->securitypriv; -+ -+ memset(pcur_dot11txpn, 0, 8); -+ if (NULL == StaAddr) -+ return; -+ psta = rtw_get_stainfo(&padapter->stapriv, StaAddr); -+ DBG_871X("%s(): StaAddr: %02x %02x %02x %02x %02x %02x\n", -+ __func__, StaAddr[0], StaAddr[1], StaAddr[2], -+ StaAddr[3], StaAddr[4], StaAddr[5]); -+ -+ if (psta) { -+ if (psecpriv->dot11PrivacyAlgrthm != _NO_PRIVACY_ && psta->dot11txpn.val > 0) -+ psta->dot11txpn.val--; -+ AES_IV(pcur_dot11txpn, psta->dot11txpn, 0); -+ -+ DBG_871X("%s(): CurrentIV: %02x %02x %02x %02x %02x %02x %02x %02x\n" -+ , __func__, pcur_dot11txpn[0], pcur_dot11txpn[1], -+ pcur_dot11txpn[2], pcur_dot11txpn[3], pcur_dot11txpn[4], -+ pcur_dot11txpn[5], pcur_dot11txpn[6], pcur_dot11txpn[7]); -+ } -+} -+void rtw_set_sec_pn(struct adapter *padapter) -+{ -+ struct sta_info *psta; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct security_priv *psecpriv = &padapter->securitypriv; -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, -+ get_my_bssid(&pmlmeinfo->network)); -+ -+ if (psta) { -+ if (pwrpriv->wowlan_fw_iv > psta->dot11txpn.val) { -+ if (psecpriv->dot11PrivacyAlgrthm != _NO_PRIVACY_) -+ psta->dot11txpn.val = pwrpriv->wowlan_fw_iv + 2; -+ } else { -+ DBG_871X("%s(): FW IV is smaller than driver\n", __func__); -+ psta->dot11txpn.val += 2; -+ } -+ DBG_871X("%s: dot11txpn: 0x%016llx\n", __func__, psta->dot11txpn.val); -+ } -+} -+#endif /* CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_PNO_SUPPORT -+#define CSCAN_TLV_TYPE_SSID_IE 'S' -+#define CIPHER_IE "key_mgmt =" -+#define CIPHER_NONE "NONE" -+#define CIPHER_WPA_PSK "WPA-PSK" -+#define CIPHER_WPA_EAP "WPA-EAP IEEE8021X" -+ -+#endif /* CONFIG_PNO_SUPPORT */ -diff -Nurp linux.old/3rdparty/rtl8723bs/core/rtw_xmit.c linux/3rdparty/rtl8723bs/core/rtw_xmit.c ---- linux.old/3rdparty/rtl8723bs/core/rtw_xmit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/core/rtw_xmit.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,3100 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_XMIT_C_ -+ -+#include -+#include -+ -+static u8 P802_1H_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0xf8 }; -+static u8 RFC1042_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0x00 }; -+ -+static void _init_txservq(struct tx_servq *ptxservq) -+{ -+ INIT_LIST_HEAD(&ptxservq->tx_pending); -+ _rtw_init_queue(&ptxservq->sta_pending); -+ ptxservq->qcnt = 0; -+} -+ -+void _rtw_init_sta_xmit_priv(struct sta_xmit_priv *psta_xmitpriv) -+{ -+ memset((unsigned char *)psta_xmitpriv, 0, sizeof(struct sta_xmit_priv)); -+ -+ spin_lock_init(&psta_xmitpriv->lock); -+ -+ /* for (i = 0 ; i < MAX_NUMBLKS; i++) */ -+ /* _init_txservq(&(psta_xmitpriv->blk_q[i])); */ -+ -+ _init_txservq(&psta_xmitpriv->be_q); -+ _init_txservq(&psta_xmitpriv->bk_q); -+ _init_txservq(&psta_xmitpriv->vi_q); -+ _init_txservq(&psta_xmitpriv->vo_q); -+ INIT_LIST_HEAD(&psta_xmitpriv->legacy_dz); -+ INIT_LIST_HEAD(&psta_xmitpriv->apsd); -+} -+ -+s32 _rtw_init_xmit_priv(struct xmit_priv *pxmitpriv, struct adapter *padapter) -+{ -+ int i; -+ struct xmit_buf *pxmitbuf; -+ struct xmit_frame *pxframe; -+ sint res = _SUCCESS; -+ -+ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by vzalloc(). */ -+ /* memset((unsigned char *)pxmitpriv, 0, sizeof(struct xmit_priv)); */ -+ -+ spin_lock_init(&pxmitpriv->lock); -+ spin_lock_init(&pxmitpriv->lock_sctx); -+ sema_init(&pxmitpriv->xmit_sema, 0); -+ sema_init(&pxmitpriv->terminate_xmitthread_sema, 0); -+ -+ /* -+ Please insert all the queue initializaiton using _rtw_init_queue below -+ */ -+ -+ pxmitpriv->adapter = padapter; -+ -+ /* for (i = 0 ; i < MAX_NUMBLKS; i++) */ -+ /* _rtw_init_queue(&pxmitpriv->blk_strms[i]); */ -+ -+ _rtw_init_queue(&pxmitpriv->be_pending); -+ _rtw_init_queue(&pxmitpriv->bk_pending); -+ _rtw_init_queue(&pxmitpriv->vi_pending); -+ _rtw_init_queue(&pxmitpriv->vo_pending); -+ _rtw_init_queue(&pxmitpriv->bm_pending); -+ -+ /* _rtw_init_queue(&pxmitpriv->legacy_dz_queue); */ -+ /* _rtw_init_queue(&pxmitpriv->apsd_queue); */ -+ -+ _rtw_init_queue(&pxmitpriv->free_xmit_queue); -+ -+ /* -+ Please allocate memory with the sz = (struct xmit_frame) * NR_XMITFRAME, -+ and initialize free_xmit_frame below. -+ Please also apply free_txobj to link_up all the xmit_frames... -+ */ -+ -+ pxmitpriv->pallocated_frame_buf = vzalloc(NR_XMITFRAME * sizeof(struct xmit_frame) + 4); -+ -+ if (pxmitpriv->pallocated_frame_buf == NULL) { -+ pxmitpriv->pxmit_frame_buf = NULL; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("alloc xmit_frame fail!\n")); -+ res = _FAIL; -+ goto exit; -+ } -+ pxmitpriv->pxmit_frame_buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_frame_buf), 4); -+ /* pxmitpriv->pxmit_frame_buf = pxmitpriv->pallocated_frame_buf + 4 - */ -+ /* ((SIZE_PTR) (pxmitpriv->pallocated_frame_buf) &3); */ -+ -+ pxframe = (struct xmit_frame *) pxmitpriv->pxmit_frame_buf; -+ -+ for (i = 0; i < NR_XMITFRAME; i++) { -+ INIT_LIST_HEAD(&(pxframe->list)); -+ -+ pxframe->padapter = padapter; -+ pxframe->frame_tag = NULL_FRAMETAG; -+ -+ pxframe->pkt = NULL; -+ -+ pxframe->buf_addr = NULL; -+ pxframe->pxmitbuf = NULL; -+ -+ list_add_tail(&(pxframe->list), &(pxmitpriv->free_xmit_queue.queue)); -+ -+ pxframe++; -+ } -+ -+ pxmitpriv->free_xmitframe_cnt = NR_XMITFRAME; -+ -+ pxmitpriv->frag_len = MAX_FRAG_THRESHOLD; -+ -+ -+ /* init xmit_buf */ -+ _rtw_init_queue(&pxmitpriv->free_xmitbuf_queue); -+ _rtw_init_queue(&pxmitpriv->pending_xmitbuf_queue); -+ -+ pxmitpriv->pallocated_xmitbuf = vzalloc(NR_XMITBUFF * sizeof(struct xmit_buf) + 4); -+ -+ if (pxmitpriv->pallocated_xmitbuf == NULL) { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("alloc xmit_buf fail!\n")); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pxmitpriv->pxmitbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_xmitbuf), 4); -+ /* pxmitpriv->pxmitbuf = pxmitpriv->pallocated_xmitbuf + 4 - */ -+ /* ((SIZE_PTR) (pxmitpriv->pallocated_xmitbuf) &3); */ -+ -+ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf; -+ -+ for (i = 0; i < NR_XMITBUFF; i++) { -+ INIT_LIST_HEAD(&pxmitbuf->list); -+ -+ pxmitbuf->priv_data = NULL; -+ pxmitbuf->padapter = padapter; -+ pxmitbuf->buf_tag = XMITBUF_DATA; -+ -+ /* Tx buf allocation may fail sometimes, so sleep and retry. */ -+ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, (MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), true); -+ if (res == _FAIL) { -+ msleep(10); -+ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, (MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), true); -+ if (res == _FAIL) -+ goto exit; -+ } -+ -+ pxmitbuf->phead = pxmitbuf->pbuf; -+ pxmitbuf->pend = pxmitbuf->pbuf + MAX_XMITBUF_SZ; -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+ -+ pxmitbuf->flags = XMIT_VO_QUEUE; -+ -+ list_add_tail(&pxmitbuf->list, &(pxmitpriv->free_xmitbuf_queue.queue)); -+ #ifdef DBG_XMIT_BUF -+ pxmitbuf->no = i; -+ #endif -+ -+ pxmitbuf++; -+ -+ } -+ -+ pxmitpriv->free_xmitbuf_cnt = NR_XMITBUFF; -+ -+ /* init xframe_ext queue, the same count as extbuf */ -+ _rtw_init_queue(&pxmitpriv->free_xframe_ext_queue); -+ -+ pxmitpriv->xframe_ext_alloc_addr = vzalloc(NR_XMIT_EXTBUFF * sizeof(struct xmit_frame) + 4); -+ -+ if (pxmitpriv->xframe_ext_alloc_addr == NULL) { -+ pxmitpriv->xframe_ext = NULL; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("alloc xframe_ext fail!\n")); -+ res = _FAIL; -+ goto exit; -+ } -+ pxmitpriv->xframe_ext = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->xframe_ext_alloc_addr), 4); -+ pxframe = (struct xmit_frame *)pxmitpriv->xframe_ext; -+ -+ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { -+ INIT_LIST_HEAD(&(pxframe->list)); -+ -+ pxframe->padapter = padapter; -+ pxframe->frame_tag = NULL_FRAMETAG; -+ -+ pxframe->pkt = NULL; -+ -+ pxframe->buf_addr = NULL; -+ pxframe->pxmitbuf = NULL; -+ -+ pxframe->ext_tag = 1; -+ -+ list_add_tail(&(pxframe->list), &(pxmitpriv->free_xframe_ext_queue.queue)); -+ -+ pxframe++; -+ } -+ pxmitpriv->free_xframe_ext_cnt = NR_XMIT_EXTBUFF; -+ -+ /* Init xmit extension buff */ -+ _rtw_init_queue(&pxmitpriv->free_xmit_extbuf_queue); -+ -+ pxmitpriv->pallocated_xmit_extbuf = vzalloc(NR_XMIT_EXTBUFF * sizeof(struct xmit_buf) + 4); -+ -+ if (pxmitpriv->pallocated_xmit_extbuf == NULL) { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("alloc xmit_extbuf fail!\n")); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pxmitpriv->pxmit_extbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_xmit_extbuf), 4); -+ -+ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; -+ -+ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { -+ INIT_LIST_HEAD(&pxmitbuf->list); -+ -+ pxmitbuf->priv_data = NULL; -+ pxmitbuf->padapter = padapter; -+ pxmitbuf->buf_tag = XMITBUF_MGNT; -+ -+ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, MAX_XMIT_EXTBUF_SZ + XMITBUF_ALIGN_SZ, true); -+ if (res == _FAIL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pxmitbuf->phead = pxmitbuf->pbuf; -+ pxmitbuf->pend = pxmitbuf->pbuf + MAX_XMIT_EXTBUF_SZ; -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+ -+ list_add_tail(&pxmitbuf->list, &(pxmitpriv->free_xmit_extbuf_queue.queue)); -+ #ifdef DBG_XMIT_BUF_EXT -+ pxmitbuf->no = i; -+ #endif -+ pxmitbuf++; -+ -+ } -+ -+ pxmitpriv->free_xmit_extbuf_cnt = NR_XMIT_EXTBUFF; -+ -+ for (i = 0; i < CMDBUF_MAX; i++) { -+ pxmitbuf = &pxmitpriv->pcmd_xmitbuf[i]; -+ if (pxmitbuf) { -+ INIT_LIST_HEAD(&pxmitbuf->list); -+ -+ pxmitbuf->priv_data = NULL; -+ pxmitbuf->padapter = padapter; -+ pxmitbuf->buf_tag = XMITBUF_CMD; -+ -+ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, MAX_CMDBUF_SZ+XMITBUF_ALIGN_SZ, true); -+ if (res == _FAIL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pxmitbuf->phead = pxmitbuf->pbuf; -+ pxmitbuf->pend = pxmitbuf->pbuf + MAX_CMDBUF_SZ; -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+ pxmitbuf->alloc_sz = MAX_CMDBUF_SZ+XMITBUF_ALIGN_SZ; -+ } -+ } -+ -+ rtw_alloc_hwxmits(padapter); -+ rtw_init_hwxmits(pxmitpriv->hwxmits, pxmitpriv->hwxmit_entry); -+ -+ for (i = 0; i < 4; i++) { -+ pxmitpriv->wmm_para_seq[i] = i; -+ } -+ -+ pxmitpriv->ack_tx = false; -+ mutex_init(&pxmitpriv->ack_tx_mutex); -+ rtw_sctx_init(&pxmitpriv->ack_tx_ops, 0); -+ -+ rtw_hal_init_xmit_priv(padapter); -+ -+exit: -+ return res; -+} -+ -+void _rtw_free_xmit_priv(struct xmit_priv *pxmitpriv) -+{ -+ int i; -+ struct adapter *padapter = pxmitpriv->adapter; -+ struct xmit_frame *pxmitframe = (struct xmit_frame *) pxmitpriv->pxmit_frame_buf; -+ struct xmit_buf *pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf; -+ -+ rtw_hal_free_xmit_priv(padapter); -+ -+ if (pxmitpriv->pxmit_frame_buf == NULL) -+ return; -+ -+ for (i = 0; i < NR_XMITFRAME; i++) { -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ -+ pxmitframe++; -+ } -+ -+ for (i = 0; i < NR_XMITBUFF; i++) { -+ rtw_os_xmit_resource_free(padapter, pxmitbuf, (MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), true); -+ -+ pxmitbuf++; -+ } -+ -+ if (pxmitpriv->pallocated_frame_buf) -+ vfree(pxmitpriv->pallocated_frame_buf); -+ -+ -+ if (pxmitpriv->pallocated_xmitbuf) -+ vfree(pxmitpriv->pallocated_xmitbuf); -+ -+ /* free xframe_ext queue, the same count as extbuf */ -+ pxmitframe = (struct xmit_frame *)pxmitpriv->xframe_ext; -+ if (pxmitframe) { -+ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ pxmitframe++; -+ } -+ } -+ if (pxmitpriv->xframe_ext_alloc_addr) -+ vfree(pxmitpriv->xframe_ext_alloc_addr); -+ -+ /* free xmit extension buff */ -+ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; -+ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { -+ rtw_os_xmit_resource_free(padapter, pxmitbuf, (MAX_XMIT_EXTBUF_SZ + XMITBUF_ALIGN_SZ), true); -+ -+ pxmitbuf++; -+ } -+ -+ if (pxmitpriv->pallocated_xmit_extbuf) { -+ vfree(pxmitpriv->pallocated_xmit_extbuf); -+ } -+ -+ for (i = 0; i < CMDBUF_MAX; i++) { -+ pxmitbuf = &pxmitpriv->pcmd_xmitbuf[i]; -+ if (pxmitbuf != NULL) -+ rtw_os_xmit_resource_free(padapter, pxmitbuf, MAX_CMDBUF_SZ+XMITBUF_ALIGN_SZ, true); -+ } -+ -+ rtw_free_hwxmits(padapter); -+ -+ mutex_destroy(&pxmitpriv->ack_tx_mutex); -+} -+ -+u8 query_ra_short_GI(struct sta_info *psta) -+{ -+ u8 sgi = false, sgi_20m = false, sgi_40m = false, sgi_80m = false; -+ -+ sgi_20m = psta->htpriv.sgi_20m; -+ sgi_40m = psta->htpriv.sgi_40m; -+ -+ switch (psta->bw_mode) { -+ case CHANNEL_WIDTH_80: -+ sgi = sgi_80m; -+ break; -+ case CHANNEL_WIDTH_40: -+ sgi = sgi_40m; -+ break; -+ case CHANNEL_WIDTH_20: -+ default: -+ sgi = sgi_20m; -+ break; -+ } -+ -+ return sgi; -+} -+ -+static void update_attrib_vcs_info(struct adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ u32 sz; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ /* struct sta_info *psta = pattrib->psta; */ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pattrib->nr_frags != 1) -+ sz = padapter->xmitpriv.frag_len; -+ else /* no frag */ -+ sz = pattrib->last_txcmdsz; -+ -+ /* (1) RTS_Threshold is compared to the MPDU, not MSDU. */ -+ /* (2) If there are more than one frag in this MSDU, only the first frag uses protection frame. */ -+ /* Other fragments are protected by previous fragment. */ -+ /* So we only need to check the length of first fragment. */ -+ if (pmlmeext->cur_wireless_mode < WIRELESS_11_24N || padapter->registrypriv.wifi_spec) { -+ if (sz > padapter->registrypriv.rts_thresh) -+ pattrib->vcs_mode = RTS_CTS; -+ else{ -+ if (pattrib->rtsen) -+ pattrib->vcs_mode = RTS_CTS; -+ else if (pattrib->cts2self) -+ pattrib->vcs_mode = CTS_TO_SELF; -+ else -+ pattrib->vcs_mode = NONE_VCS; -+ } -+ } else{ -+ while (true) { -+ /* IOT action */ -+ if ((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_ATHEROS) && (pattrib->ampdu_en == true) && -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) { -+ pattrib->vcs_mode = CTS_TO_SELF; -+ break; -+ } -+ -+ -+ /* check ERP protection */ -+ if (pattrib->rtsen || pattrib->cts2self) { -+ if (pattrib->rtsen) -+ pattrib->vcs_mode = RTS_CTS; -+ else if (pattrib->cts2self) -+ pattrib->vcs_mode = CTS_TO_SELF; -+ -+ break; -+ } -+ -+ /* check HT op mode */ -+ if (pattrib->ht_en) { -+ u8 HTOpMode = pmlmeinfo->HT_protection; -+ if ((pmlmeext->cur_bwmode && (HTOpMode == 2 || HTOpMode == 3)) || -+ (!pmlmeext->cur_bwmode && HTOpMode == 3)) { -+ pattrib->vcs_mode = RTS_CTS; -+ break; -+ } -+ } -+ -+ /* check rts */ -+ if (sz > padapter->registrypriv.rts_thresh) { -+ pattrib->vcs_mode = RTS_CTS; -+ break; -+ } -+ -+ /* to do list: check MIMO power save condition. */ -+ -+ /* check AMPDU aggregation for TXOP */ -+ if (pattrib->ampdu_en == true) { -+ pattrib->vcs_mode = RTS_CTS; -+ break; -+ } -+ -+ pattrib->vcs_mode = NONE_VCS; -+ break; -+ } -+ } -+ -+ /* for debug : force driver control vrtl_carrier_sense. */ -+ if (padapter->driver_vcs_en == 1) -+ pattrib->vcs_mode = padapter->driver_vcs_type; -+} -+ -+static void update_attrib_phy_info(struct adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) -+{ -+ struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; -+ -+ pattrib->rtsen = psta->rtsen; -+ pattrib->cts2self = psta->cts2self; -+ -+ pattrib->mdata = 0; -+ pattrib->eosp = 0; -+ pattrib->triggered = 0; -+ pattrib->ampdu_spacing = 0; -+ -+ /* qos_en, ht_en, init rate, , bw, ch_offset, sgi */ -+ pattrib->qos_en = psta->qos_option; -+ -+ pattrib->raid = psta->raid; -+ -+ if (mlmeext->cur_bwmode < psta->bw_mode) -+ pattrib->bwmode = mlmeext->cur_bwmode; -+ else -+ pattrib->bwmode = psta->bw_mode; -+ -+ pattrib->sgi = query_ra_short_GI(psta); -+ -+ pattrib->ldpc = psta->ldpc; -+ pattrib->stbc = psta->stbc; -+ -+ pattrib->ht_en = psta->htpriv.ht_option; -+ pattrib->ch_offset = psta->htpriv.ch_offset; -+ pattrib->ampdu_en = false; -+ -+ if (padapter->driver_ampdu_spacing != 0xFF) /* driver control AMPDU Density for peer sta's rx */ -+ pattrib->ampdu_spacing = padapter->driver_ampdu_spacing; -+ else -+ pattrib->ampdu_spacing = psta->htpriv.rx_ampdu_min_spacing; -+ -+ /* if (pattrib->ht_en && psta->htpriv.ampdu_enable) */ -+ /* */ -+ /* if (psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) */ -+ /* pattrib->ampdu_en = true; */ -+ /* */ -+ -+ -+ pattrib->retry_ctrl = false; -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if (psta->isrc && psta->pid > 0) -+ pattrib->pctrl = true; -+#endif -+ -+} -+ -+static s32 update_attrib_sec_info(struct adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) -+{ -+ sint res = _SUCCESS; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ sint bmcast = IS_MCAST(pattrib->ra); -+ -+ memset(pattrib->dot118021x_UncstKey.skey, 0, 16); -+ memset(pattrib->dot11tkiptxmickey.skey, 0, 16); -+ pattrib->mac_id = psta->mac_id; -+ -+ if (psta->ieee8021x_blocked == true) { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("\n psta->ieee8021x_blocked == true\n")); -+ -+ pattrib->encrypt = 0; -+ -+ if ((pattrib->ether_type != 0x888e) && (check_fwstate(pmlmepriv, WIFI_MP_STATE) == false)) { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("\npsta->ieee8021x_blocked == true, pattrib->ether_type(%.4x) != 0x888e\n", pattrib->ether_type)); -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s psta->ieee8021x_blocked == true, pattrib->ether_type(%04x) != 0x888e\n", __func__, pattrib->ether_type); -+ #endif -+ res = _FAIL; -+ goto exit; -+ } -+ } else{ -+ GET_ENCRY_ALGO(psecuritypriv, psta, pattrib->encrypt, bmcast); -+ -+ switch (psecuritypriv->dot11AuthAlgrthm) { -+ case dot11AuthAlgrthm_Open: -+ case dot11AuthAlgrthm_Shared: -+ case dot11AuthAlgrthm_Auto: -+ pattrib->key_idx = (u8)psecuritypriv->dot11PrivacyKeyIndex; -+ break; -+ case dot11AuthAlgrthm_8021X: -+ if (bmcast) -+ pattrib->key_idx = (u8)psecuritypriv->dot118021XGrpKeyid; -+ else -+ pattrib->key_idx = 0; -+ break; -+ default: -+ pattrib->key_idx = 0; -+ break; -+ } -+ -+ /* For WPS 1.0 WEP, driver should not encrypt EAPOL Packet for WPS handshake. */ -+ if (((pattrib->encrypt == _WEP40_) || (pattrib->encrypt == _WEP104_)) && (pattrib->ether_type == 0x888e)) -+ pattrib->encrypt = _NO_PRIVACY_; -+ -+ } -+ -+ switch (pattrib->encrypt) { -+ case _WEP40_: -+ case _WEP104_: -+ pattrib->iv_len = 4; -+ pattrib->icv_len = 4; -+ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ break; -+ -+ case _TKIP_: -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 4; -+ -+ if (psecuritypriv->busetkipkey == _FAIL) { -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s psecuritypriv->busetkipkey(%d) == _FAIL drop packet\n", __func__, psecuritypriv->busetkipkey); -+ #endif -+ res = _FAIL; -+ goto exit; -+ } -+ -+ if (bmcast) -+ TKIP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ TKIP_IV(pattrib->iv, psta->dot11txpn, 0); -+ -+ -+ memcpy(pattrib->dot11tkiptxmickey.skey, psta->dot11tkiptxmickey.skey, 16); -+ -+ break; -+ -+ case _AES_: -+ -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 8; -+ -+ if (bmcast) -+ AES_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ AES_IV(pattrib->iv, psta->dot11txpn, 0); -+ -+ break; -+ -+ default: -+ pattrib->iv_len = 0; -+ pattrib->icv_len = 0; -+ break; -+ } -+ -+ if (pattrib->encrypt > 0) -+ memcpy(pattrib->dot118021x_UncstKey.skey, psta->dot118021x_UncstKey.skey, 16); -+ -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, -+ ("update_attrib: encrypt =%d securitypriv.sw_encrypt =%d\n", -+ pattrib->encrypt, padapter->securitypriv.sw_encrypt)); -+ -+ if (pattrib->encrypt && -+ ((padapter->securitypriv.sw_encrypt == true) || (psecuritypriv->hw_decrypted == false))) { -+ pattrib->bswenc = true; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, -+ ("update_attrib: encrypt =%d securitypriv.hw_decrypted =%d bswenc =true\n", -+ pattrib->encrypt, padapter->securitypriv.sw_encrypt)); -+ } else { -+ pattrib->bswenc = false; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ("update_attrib: bswenc =false\n")); -+ } -+ -+exit: -+ -+ return res; -+ -+} -+ -+u8 qos_acm(u8 acm_mask, u8 priority) -+{ -+ u8 change_priority = priority; -+ -+ switch (priority) { -+ case 0: -+ case 3: -+ if (acm_mask & BIT(1)) -+ change_priority = 1; -+ break; -+ case 1: -+ case 2: -+ break; -+ case 4: -+ case 5: -+ if (acm_mask & BIT(2)) -+ change_priority = 0; -+ break; -+ case 6: -+ case 7: -+ if (acm_mask & BIT(3)) -+ change_priority = 5; -+ break; -+ default: -+ DBG_871X("qos_acm(): invalid pattrib->priority: %d!!!\n", priority); -+ break; -+ } -+ -+ return change_priority; -+} -+ -+static void set_qos(struct pkt_file *ppktfile, struct pkt_attrib *pattrib) -+{ -+ struct ethhdr etherhdr; -+ struct iphdr ip_hdr; -+ s32 UserPriority = 0; -+ -+ -+ _rtw_open_pktfile(ppktfile->pkt, ppktfile); -+ _rtw_pktfile_read(ppktfile, (unsigned char *)ðerhdr, ETH_HLEN); -+ -+ /* get UserPriority from IP hdr */ -+ if (pattrib->ether_type == 0x0800) { -+ _rtw_pktfile_read(ppktfile, (u8 *)&ip_hdr, sizeof(ip_hdr)); -+/* UserPriority = (ntohs(ip_hdr.tos) >> 5) & 0x3; */ -+ UserPriority = ip_hdr.tos >> 5; -+ } -+ pattrib->priority = UserPriority; -+ pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN; -+ pattrib->subtype = WIFI_QOS_DATA_TYPE; -+} -+ -+static s32 update_attrib(struct adapter *padapter, _pkt *pkt, struct pkt_attrib *pattrib) -+{ -+ uint i; -+ struct pkt_file pktfile; -+ struct sta_info *psta = NULL; -+ struct ethhdr etherhdr; -+ -+ sint bmcast; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ sint res = _SUCCESS; -+ -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib); -+ -+ _rtw_open_pktfile(pkt, &pktfile); -+ i = _rtw_pktfile_read(&pktfile, (u8 *)ðerhdr, ETH_HLEN); -+ -+ pattrib->ether_type = ntohs(etherhdr.h_proto); -+ -+ -+ memcpy(pattrib->dst, ðerhdr.h_dest, ETH_ALEN); -+ memcpy(pattrib->src, ðerhdr.h_source, ETH_ALEN); -+ -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) { -+ memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_adhoc); -+ } else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_sta); -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ memcpy(pattrib->ta, get_bssid(pmlmepriv), ETH_ALEN); -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_ap); -+ } else -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_unknown); -+ -+ pattrib->pktlen = pktfile.pkt_len; -+ -+ if (ETH_P_IP == pattrib->ether_type) { -+ /* The following is for DHCP and ARP packet, we use cck1M to tx these packets and let LPS awake some time */ -+ /* to prevent DHCP protocol fail */ -+ -+ u8 tmp[24]; -+ -+ _rtw_pktfile_read(&pktfile, &tmp[0], 24); -+ -+ pattrib->dhcp_pkt = 0; -+ if (pktfile.pkt_len > 282) {/* MINIMUM_DHCP_PACKET_SIZE) { */ -+ if (ETH_P_IP == pattrib->ether_type) {/* IP header */ -+ if (((tmp[21] == 68) && (tmp[23] == 67)) || -+ ((tmp[21] == 67) && (tmp[23] == 68))) { -+ /* 68 : UDP BOOTP client */ -+ /* 67 : UDP BOOTP server */ -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("======================update_attrib: get DHCP Packet\n")); -+ pattrib->dhcp_pkt = 1; -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_dhcp); -+ } -+ } -+ } -+ -+ /* for parsing ICMP pakcets */ -+ { -+ struct iphdr *piphdr = (struct iphdr *)tmp; -+ -+ pattrib->icmp_pkt = 0; -+ if (piphdr->protocol == 0x1) { /* protocol type in ip header 0x1 is ICMP */ -+ pattrib->icmp_pkt = 1; -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_icmp); -+ } -+ } -+ -+ -+ } else if (0x888e == pattrib->ether_type) { -+ DBG_871X_LEVEL(_drv_always_, "send eapol packet\n"); -+ } -+ -+ if ((pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1)) -+ rtw_set_scan_deny(padapter, 3000); -+ -+ /* If EAPOL , ARP , OR DHCP packet, driver must be in active mode. */ -+ if (pattrib->icmp_pkt == 1) -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); -+ else if (pattrib->dhcp_pkt == 1) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_active); -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SPECIAL_PACKET, 1); -+ } -+ -+ bmcast = IS_MCAST(pattrib->ra); -+ -+ /* get sta_info */ -+ if (bmcast) { -+ psta = rtw_get_bcmc_stainfo(padapter); -+ } else { -+ psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ if (psta == NULL) { /* if we cannot get psta => drop the pkt */ -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_ucast_sta); -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_alert_, ("\nupdate_attrib => get sta_info fail, ra:" MAC_FMT"\n", MAC_ARG(pattrib->ra))); -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s get sta_info fail, ra:" MAC_FMT"\n", __func__, MAC_ARG(pattrib->ra)); -+ #endif -+ res = _FAIL; -+ goto exit; -+ } else if ((check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) && (!(psta->state & _FW_LINKED))) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_ucast_ap_link); -+ res = _FAIL; -+ goto exit; -+ } -+ } -+ -+ if (psta == NULL) { -+ /* if we cannot get psta => drop the pkt */ -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_sta); -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_alert_, ("\nupdate_attrib => get sta_info fail, ra:" MAC_FMT "\n", MAC_ARG(pattrib->ra))); -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s get sta_info fail, ra:" MAC_FMT"\n", __func__, MAC_ARG(pattrib->ra)); -+ #endif -+ res = _FAIL; -+ goto exit; -+ } -+ -+ if (!(psta->state & _FW_LINKED)) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_link); -+ DBG_871X("%s, psta("MAC_FMT")->state(0x%x) != _FW_LINKED\n", __func__, MAC_ARG(psta->hwaddr), psta->state); -+ return _FAIL; -+ } -+ -+ -+ -+ /* TODO:_lock */ -+ if (update_attrib_sec_info(padapter, pattrib, psta) == _FAIL) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_sec); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ update_attrib_phy_info(padapter, pattrib, psta); -+ -+ /* DBG_8192C("%s ==> mac_id(%d)\n", __func__, pattrib->mac_id); */ -+ -+ pattrib->psta = psta; -+ /* TODO:_unlock */ -+ -+ pattrib->pctrl = 0; -+ -+ pattrib->ack_policy = 0; -+ /* get ether_hdr_len */ -+ pattrib->pkt_hdrlen = ETH_HLEN;/* pattrib->ether_type == 0x8100) ? (14 + 4): 14; vlan tag */ -+ -+ pattrib->hdrlen = WLAN_HDR_A3_LEN; -+ pattrib->subtype = WIFI_DATA_TYPE; -+ pattrib->priority = 0; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE|WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE)) { -+ if (pattrib->qos_en) -+ set_qos(&pktfile, pattrib); -+ } else{ -+ if (pqospriv->qos_option) { -+ set_qos(&pktfile, pattrib); -+ -+ if (pmlmepriv->acm_mask != 0) -+ pattrib->priority = qos_acm(pmlmepriv->acm_mask, pattrib->priority); -+ -+ } -+ } -+ -+ /* pattrib->priority = 5; force to used VI queue, for testing */ -+ -+ rtw_set_tx_chksum_offload(pkt, pattrib); -+ -+exit: -+ return res; -+} -+ -+static s32 xmitframe_addmic(struct adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ sint curfragnum, length; -+ u8 *pframe, *payload, mic[8]; -+ struct mic_data micdata; -+ /* struct sta_info *stainfo; */ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ u8 priority[4] = {0x0, 0x0, 0x0, 0x0}; -+ u8 hw_hdr_offset = 0; -+ sint bmcst = IS_MCAST(pattrib->ra); -+ -+/* -+ if (pattrib->psta) -+ { -+ stainfo = pattrib->psta; -+ } -+ else -+ { -+ DBG_871X("%s, call rtw_get_stainfo()\n", __func__); -+ stainfo =rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0]); -+ } -+ -+ if (stainfo == NULL) -+ { -+ DBG_871X("%s, psta ==NUL\n", __func__); -+ return _FAIL; -+ } -+ -+ if (!(stainfo->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, stainfo->state); -+ return _FAIL; -+ } -+*/ -+ -+ hw_hdr_offset = TXDESC_OFFSET; -+ -+ if (pattrib->encrypt == _TKIP_) { /* if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_PRIVACY_) */ -+ /* encode mic code */ -+ /* if (stainfo!= NULL) */ -+ { -+ u8 null_key[16] = {0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; -+ -+ pframe = pxmitframe->buf_addr + hw_hdr_offset; -+ -+ if (bmcst) { -+ if (!memcmp(psecuritypriv->dot118021XGrptxmickey[psecuritypriv->dot118021XGrpKeyid].skey, null_key, 16)) { -+ /* DbgPrint("\nxmitframe_addmic:stainfo->dot11tkiptxmickey == 0\n"); */ -+ /* msleep(10); */ -+ return _FAIL; -+ } -+ /* start to calculate the mic code */ -+ rtw_secmicsetkey(&micdata, psecuritypriv->dot118021XGrptxmickey[psecuritypriv->dot118021XGrpKeyid].skey); -+ } else { -+ if (!memcmp(&pattrib->dot11tkiptxmickey.skey[0], null_key, 16)) { -+ /* DbgPrint("\nxmitframe_addmic:stainfo->dot11tkiptxmickey == 0\n"); */ -+ /* msleep(10); */ -+ return _FAIL; -+ } -+ /* start to calculate the mic code */ -+ rtw_secmicsetkey(&micdata, &pattrib->dot11tkiptxmickey.skey[0]); -+ } -+ -+ if (pframe[1]&1) { /* ToDS == 1 */ -+ rtw_secmicappend(&micdata, &pframe[16], 6); /* DA */ -+ if (pframe[1]&2) /* From Ds == 1 */ -+ rtw_secmicappend(&micdata, &pframe[24], 6); -+ else -+ rtw_secmicappend(&micdata, &pframe[10], 6); -+ } else { /* ToDS == 0 */ -+ rtw_secmicappend(&micdata, &pframe[4], 6); /* DA */ -+ if (pframe[1]&2) /* From Ds == 1 */ -+ rtw_secmicappend(&micdata, &pframe[16], 6); -+ else -+ rtw_secmicappend(&micdata, &pframe[10], 6); -+ -+ } -+ -+ /* if (pqospriv->qos_option == 1) */ -+ if (pattrib->qos_en) -+ priority[0] = (u8)pxmitframe->attrib.priority; -+ -+ -+ rtw_secmicappend(&micdata, &priority[0], 4); -+ -+ payload = pframe; -+ -+ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { -+ payload = (u8 *)RND4((SIZE_PTR)(payload)); -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("===curfragnum =%d, pframe = 0x%.2x, 0x%.2x, 0x%.2x, 0x%.2x, 0x%.2x, 0x%.2x, 0x%.2x, 0x%.2x,!!!\n", -+ curfragnum, *payload, *(payload+1), *(payload+2), *(payload+3), *(payload+4), *(payload+5), *(payload+6), *(payload+7))); -+ -+ payload = payload+pattrib->hdrlen+pattrib->iv_len; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("curfragnum =%d pattrib->hdrlen =%d pattrib->iv_len =%d", curfragnum, pattrib->hdrlen, pattrib->iv_len)); -+ if ((curfragnum+1) == pattrib->nr_frags) { -+ length = pattrib->last_txcmdsz-pattrib->hdrlen-pattrib->iv_len-((pattrib->bswenc) ? pattrib->icv_len : 0); -+ rtw_secmicappend(&micdata, payload, length); -+ payload = payload+length; -+ } else{ -+ length = pxmitpriv->frag_len-pattrib->hdrlen-pattrib->iv_len-((pattrib->bswenc) ? pattrib->icv_len : 0); -+ rtw_secmicappend(&micdata, payload, length); -+ payload = payload+length+pattrib->icv_len; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("curfragnum =%d length =%d pattrib->icv_len =%d", curfragnum, length, pattrib->icv_len)); -+ } -+ } -+ rtw_secgetmic(&micdata, &(mic[0])); -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("xmitframe_addmic: before add mic code!!!\n")); -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("xmitframe_addmic: pattrib->last_txcmdsz =%d!!!\n", pattrib->last_txcmdsz)); -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("xmitframe_addmic: mic[0]= 0x%.2x , mic[1]= 0x%.2x , mic[2]= 0x%.2x , mic[3]= 0x%.2x\n\ -+ mic[4]= 0x%.2x , mic[5]= 0x%.2x , mic[6]= 0x%.2x , mic[7]= 0x%.2x !!!!\n", -+ mic[0], mic[1], mic[2], mic[3], mic[4], mic[5], mic[6], mic[7])); -+ /* add mic code and add the mic code length in last_txcmdsz */ -+ -+ memcpy(payload, &(mic[0]), 8); -+ pattrib->last_txcmdsz += 8; -+ -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ("\n ========last pkt ========\n")); -+ payload = payload-pattrib->last_txcmdsz+8; -+ for (curfragnum = 0; curfragnum < pattrib->last_txcmdsz; curfragnum = curfragnum+8) -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, (" %.2x, %.2x, %.2x, %.2x, %.2x, %.2x, %.2x, %.2x ", -+ *(payload+curfragnum), *(payload+curfragnum+1), *(payload+curfragnum+2), *(payload+curfragnum+3), -+ *(payload+curfragnum+4), *(payload+curfragnum+5), *(payload+curfragnum+6), *(payload+curfragnum+7))); -+ } -+/* -+ else { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("xmitframe_addmic: rtw_get_stainfo == NULL!!!\n")); -+ } -+*/ -+ } -+ return _SUCCESS; -+} -+ -+static s32 xmitframe_swencrypt(struct adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ /* struct security_priv *psecuritypriv =&padapter->securitypriv; */ -+ -+ /* if ((psecuritypriv->sw_encrypt)||(pattrib->bswenc)) */ -+ if (pattrib->bswenc) { -+ /* DBG_871X("start xmitframe_swencrypt\n"); */ -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_alert_, ("### xmitframe_swencrypt\n")); -+ switch (pattrib->encrypt) { -+ case _WEP40_: -+ case _WEP104_: -+ rtw_wep_encrypt(padapter, (u8 *)pxmitframe); -+ break; -+ case _TKIP_: -+ rtw_tkip_encrypt(padapter, (u8 *)pxmitframe); -+ break; -+ case _AES_: -+ rtw_aes_encrypt(padapter, (u8 *)pxmitframe); -+ break; -+ default: -+ break; -+ } -+ -+ } else -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_notice_, ("### xmitframe_hwencrypt\n")); -+ -+ return _SUCCESS; -+} -+ -+s32 rtw_make_wlanhdr(struct adapter *padapter, u8 *hdr, struct pkt_attrib *pattrib) -+{ -+ u16 *qc; -+ -+ struct ieee80211_hdr *pwlanhdr = (struct ieee80211_hdr *)hdr; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ u8 qos_option = false; -+ sint res = _SUCCESS; -+ __le16 *fctrl = &pwlanhdr->frame_control; -+ -+ memset(hdr, 0, WLANHDR_OFFSET); -+ -+ SetFrameSubType(fctrl, pattrib->subtype); -+ -+ if (pattrib->subtype & WIFI_DATA_TYPE) { -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true)) { -+ /* to_ds = 1, fr_ds = 0; */ -+ -+ { -+ /* 1.Data transfer to AP */ -+ /* 2.Arp pkt will relayed by AP */ -+ SetToDs(fctrl); -+ memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); -+ memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); -+ } -+ -+ if (pqospriv->qos_option) -+ qos_option = true; -+ -+ } else if ((check_fwstate(pmlmepriv, WIFI_AP_STATE) == true)) { -+ /* to_ds = 0, fr_ds = 1; */ -+ SetFrDs(fctrl); -+ memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, get_bssid(pmlmepriv), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, pattrib->src, ETH_ALEN); -+ -+ if (pattrib->qos_en) -+ qos_option = true; -+ } else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) { -+ memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); -+ -+ if (pattrib->qos_en) -+ qos_option = true; -+ } else { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("fw_state:%x is not allowed to xmit frame\n", get_fwstate(pmlmepriv))); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ if (pattrib->mdata) -+ SetMData(fctrl); -+ -+ if (pattrib->encrypt) -+ SetPrivacy(fctrl); -+ -+ if (qos_option) { -+ qc = (unsigned short *)(hdr + pattrib->hdrlen - 2); -+ -+ if (pattrib->priority) -+ SetPriority(qc, pattrib->priority); -+ -+ SetEOSP(qc, pattrib->eosp); -+ -+ SetAckpolicy(qc, pattrib->ack_policy); -+ } -+ -+ /* TODO: fill HT Control Field */ -+ -+ /* Update Seq Num will be handled by f/w */ -+ { -+ struct sta_info *psta; -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if (pattrib->psta != psta) { -+ DBG_871X("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return _FAIL; -+ } -+ -+ if (psta == NULL) { -+ DBG_871X("%s, psta ==NUL\n", __func__); -+ return _FAIL; -+ } -+ -+ if (!(psta->state & _FW_LINKED)) { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return _FAIL; -+ } -+ -+ -+ if (psta) { -+ psta->sta_xmitpriv.txseq_tid[pattrib->priority]++; -+ psta->sta_xmitpriv.txseq_tid[pattrib->priority] &= 0xFFF; -+ pattrib->seqnum = psta->sta_xmitpriv.txseq_tid[pattrib->priority]; -+ -+ SetSeqNum(hdr, pattrib->seqnum); -+ -+ /* check if enable ampdu */ -+ if (pattrib->ht_en && psta->htpriv.ampdu_enable) -+ if (psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) -+ pattrib->ampdu_en = true; -+ -+ -+ /* re-check if enable ampdu by BA_starting_seqctrl */ -+ if (pattrib->ampdu_en == true) { -+ u16 tx_seq; -+ -+ tx_seq = psta->BA_starting_seqctrl[pattrib->priority & 0x0f]; -+ -+ /* check BA_starting_seqctrl */ -+ if (SN_LESS(pattrib->seqnum, tx_seq)) { -+ /* DBG_871X("tx ampdu seqnum(%d) < tx_seq(%d)\n", pattrib->seqnum, tx_seq); */ -+ pattrib->ampdu_en = false;/* AGG BK */ -+ } else if (SN_EQUAL(pattrib->seqnum, tx_seq)) { -+ psta->BA_starting_seqctrl[pattrib->priority & 0x0f] = (tx_seq+1)&0xfff; -+ -+ pattrib->ampdu_en = true;/* AGG EN */ -+ } else{ -+ /* DBG_871X("tx ampdu over run\n"); */ -+ psta->BA_starting_seqctrl[pattrib->priority & 0x0f] = (pattrib->seqnum+1)&0xfff; -+ pattrib->ampdu_en = true;/* AGG EN */ -+ } -+ -+ } -+ } -+ } -+ -+ } else{ -+ -+ } -+ -+exit: -+ return res; -+} -+ -+s32 rtw_txframes_pending(struct adapter *padapter) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ return ((!list_empty(&pxmitpriv->be_pending.queue)) || -+ (!list_empty(&pxmitpriv->bk_pending.queue)) || -+ (!list_empty(&pxmitpriv->vi_pending.queue)) || -+ (!list_empty(&pxmitpriv->vo_pending.queue))); -+} -+ -+/* -+ * Calculate wlan 802.11 packet MAX size from pkt_attrib -+ * This function doesn't consider fragment case -+ */ -+u32 rtw_calculate_wlan_pkt_size_by_attribue(struct pkt_attrib *pattrib) -+{ -+ u32 len = 0; -+ -+ len = pattrib->hdrlen + pattrib->iv_len; /* WLAN Header and IV */ -+ len += SNAP_SIZE + sizeof(u16); /* LLC */ -+ len += pattrib->pktlen; -+ if (pattrib->encrypt == _TKIP_) -+ len += 8; /* MIC */ -+ len += ((pattrib->bswenc) ? pattrib->icv_len : 0); /* ICV */ -+ -+ return len; -+} -+ -+/* -+ -+This sub-routine will perform all the following: -+ -+1. remove 802.3 header. -+2. create wlan_header, based on the info in pxmitframe -+3. append sta's iv/ext-iv -+4. append LLC -+5. move frag chunk from pframe to pxmitframe->mem -+6. apply sw-encrypt, if necessary. -+ -+*/ -+s32 rtw_xmitframe_coalesce(struct adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe) -+{ -+ struct pkt_file pktfile; -+ -+ s32 frg_inx, frg_len, mpdu_len, llc_sz, mem_sz; -+ -+ SIZE_PTR addr; -+ -+ u8 *pframe, *mem_start; -+ u8 hw_hdr_offset; -+ -+ /* struct sta_info *psta; */ -+ /* struct sta_priv *pstapriv = &padapter->stapriv; */ -+ /* struct mlme_priv *pmlmepriv = &padapter->mlmepriv; */ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+ u8 *pbuf_start; -+ -+ s32 bmcst = IS_MCAST(pattrib->ra); -+ s32 res = _SUCCESS; -+ -+/* -+ if (pattrib->psta) -+ { -+ psta = pattrib->psta; -+ } else -+ { -+ DBG_871X("%s, call rtw_get_stainfo()\n", __func__); -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ } -+ -+ if (psta == NULL) -+ { -+ -+ DBG_871X("%s, psta ==NUL\n", __func__); -+ return _FAIL; -+ } -+ -+ -+ if (!(psta->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return _FAIL; -+ } -+*/ -+ if (pxmitframe->buf_addr == NULL) { -+ DBG_8192C("==> %s buf_addr == NULL\n", __func__); -+ return _FAIL; -+ } -+ -+ pbuf_start = pxmitframe->buf_addr; -+ -+ hw_hdr_offset = TXDESC_OFFSET; -+ mem_start = pbuf_start + hw_hdr_offset; -+ -+ if (rtw_make_wlanhdr(padapter, mem_start, pattrib) == _FAIL) { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("rtw_xmitframe_coalesce: rtw_make_wlanhdr fail; drop pkt\n")); -+ DBG_8192C("rtw_xmitframe_coalesce: rtw_make_wlanhdr fail; drop pkt\n"); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_open_pktfile(pkt, &pktfile); -+ _rtw_pktfile_read(&pktfile, NULL, pattrib->pkt_hdrlen); -+ -+ frg_inx = 0; -+ frg_len = pxmitpriv->frag_len - 4;/* 2346-4 = 2342 */ -+ -+ while (1) { -+ llc_sz = 0; -+ -+ mpdu_len = frg_len; -+ -+ pframe = mem_start; -+ -+ SetMFrag(mem_start); -+ -+ pframe += pattrib->hdrlen; -+ mpdu_len -= pattrib->hdrlen; -+ -+ /* adding icv, if necessary... */ -+ if (pattrib->iv_len) { -+ memcpy(pframe, pattrib->iv, pattrib->iv_len); -+ -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_notice_, -+ ("rtw_xmitframe_coalesce: keyid =%d pattrib->iv[3]=%.2x pframe =%.2x %.2x %.2x %.2x\n", -+ padapter->securitypriv.dot11PrivacyKeyIndex, pattrib->iv[3], *pframe, *(pframe+1), *(pframe+2), *(pframe+3))); -+ -+ pframe += pattrib->iv_len; -+ -+ mpdu_len -= pattrib->iv_len; -+ } -+ -+ if (frg_inx == 0) { -+ llc_sz = rtw_put_snap(pframe, pattrib->ether_type); -+ pframe += llc_sz; -+ mpdu_len -= llc_sz; -+ } -+ -+ if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { -+ mpdu_len -= pattrib->icv_len; -+ } -+ -+ -+ if (bmcst) { -+ /* don't do fragment to broadcat/multicast packets */ -+ mem_sz = _rtw_pktfile_read(&pktfile, pframe, pattrib->pktlen); -+ } else { -+ mem_sz = _rtw_pktfile_read(&pktfile, pframe, mpdu_len); -+ } -+ -+ pframe += mem_sz; -+ -+ if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { -+ memcpy(pframe, pattrib->icv, pattrib->icv_len); -+ pframe += pattrib->icv_len; -+ } -+ -+ frg_inx++; -+ -+ if (bmcst || (rtw_endofpktfile(&pktfile) == true)) { -+ pattrib->nr_frags = frg_inx; -+ -+ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len + ((pattrib->nr_frags == 1) ? llc_sz:0) + -+ ((pattrib->bswenc) ? pattrib->icv_len : 0) + mem_sz; -+ -+ ClearMFrag(mem_start); -+ -+ break; -+ } else -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("%s: There're still something in packet!\n", __func__)); -+ -+ addr = (SIZE_PTR)(pframe); -+ -+ mem_start = (unsigned char *)RND4(addr) + hw_hdr_offset; -+ memcpy(mem_start, pbuf_start + hw_hdr_offset, pattrib->hdrlen); -+ -+ } -+ -+ if (xmitframe_addmic(padapter, pxmitframe) == _FAIL) { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("xmitframe_addmic(padapter, pxmitframe) == _FAIL\n")); -+ DBG_8192C("xmitframe_addmic(padapter, pxmitframe) == _FAIL\n"); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ xmitframe_swencrypt(padapter, pxmitframe); -+ -+ if (bmcst == false) -+ update_attrib_vcs_info(padapter, pxmitframe); -+ else -+ pattrib->vcs_mode = NONE_VCS; -+ -+exit: -+ return res; -+} -+ -+/* broadcast or multicast management pkt use BIP, unicast management pkt use CCMP encryption */ -+s32 rtw_mgmt_xmitframe_coalesce(struct adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe) -+{ -+ u8 *pframe, *mem_start = NULL, *tmp_buf = NULL; -+ u8 subtype; -+ struct sta_info *psta = NULL; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ s32 bmcst = IS_MCAST(pattrib->ra); -+ u8 *BIP_AAD = NULL; -+ u8 *MGMT_body = NULL; -+ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ieee80211_hdr *pwlanhdr; -+ u8 MME[_MME_IE_LENGTH_]; -+ u32 ori_len; -+ mem_start = pframe = (u8 *)(pxmitframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ ori_len = BIP_AAD_SIZE+pattrib->pktlen; -+ tmp_buf = BIP_AAD = rtw_zmalloc(ori_len); -+ subtype = GetFrameSubType(pframe); /* bit(7)~bit(2) */ -+ -+ if (BIP_AAD == NULL) -+ return _FAIL; -+ -+ spin_lock_bh(&padapter->security_key_mutex); -+ -+ /* only support station mode */ -+ if (!check_fwstate(pmlmepriv, WIFI_STATION_STATE) || !check_fwstate(pmlmepriv, _FW_LINKED)) -+ goto xmitframe_coalesce_success; -+ -+ /* IGTK key is not install, it may not support 802.11w */ -+ if (padapter->securitypriv.binstallBIPkey != true) { -+ DBG_871X("no instll BIP key\n"); -+ goto xmitframe_coalesce_success; -+ } -+ /* station mode doesn't need TX BIP, just ready the code */ -+ if (bmcst) { -+ int frame_body_len; -+ u8 mic[16]; -+ -+ memset(MME, 0, 18); -+ -+ /* other types doesn't need the BIP */ -+ if (GetFrameSubType(pframe) != WIFI_DEAUTH && GetFrameSubType(pframe) != WIFI_DISASSOC) -+ goto xmitframe_coalesce_fail; -+ -+ MGMT_body = pframe + sizeof(struct ieee80211_hdr_3addr); -+ pframe += pattrib->pktlen; -+ -+ /* octent 0 and 1 is key index , BIP keyid is 4 or 5, LSB only need octent 0 */ -+ MME[0] = padapter->securitypriv.dot11wBIPKeyid; -+ /* copy packet number */ -+ memcpy(&MME[2], &pmlmeext->mgnt_80211w_IPN, 6); -+ /* increase the packet number */ -+ pmlmeext->mgnt_80211w_IPN++; -+ -+ /* add MME IE with MIC all zero, MME string doesn't include element id and length */ -+ pframe = rtw_set_ie(pframe, _MME_IE_, 16, MME, &(pattrib->pktlen)); -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ /* total frame length - header length */ -+ frame_body_len = pattrib->pktlen - sizeof(struct ieee80211_hdr_3addr); -+ -+ /* conscruct AAD, copy frame control field */ -+ memcpy(BIP_AAD, &pwlanhdr->frame_control, 2); -+ ClearRetry(BIP_AAD); -+ ClearPwrMgt(BIP_AAD); -+ ClearMData(BIP_AAD); -+ /* conscruct AAD, copy address 1 to address 3 */ -+ memcpy(BIP_AAD+2, pwlanhdr->addr1, 18); -+ /* copy management fram body */ -+ memcpy(BIP_AAD+BIP_AAD_SIZE, MGMT_body, frame_body_len); -+ /* calculate mic */ -+ if (omac1_aes_128(padapter->securitypriv.dot11wBIPKey[padapter->securitypriv.dot11wBIPKeyid].skey -+ , BIP_AAD, BIP_AAD_SIZE+frame_body_len, mic)) -+ goto xmitframe_coalesce_fail; -+ -+ /* copy right BIP mic value, total is 128bits, we use the 0~63 bits */ -+ memcpy(pframe-8, mic, 8); -+ } else { /* unicast mgmt frame TX */ -+ /* start to encrypt mgmt frame */ -+ if (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || -+ subtype == WIFI_REASSOCREQ || subtype == WIFI_ACTION) { -+ if (pattrib->psta) -+ psta = pattrib->psta; -+ else -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ -+ if (psta == NULL) { -+ -+ DBG_871X("%s, psta ==NUL\n", __func__); -+ goto xmitframe_coalesce_fail; -+ } -+ -+ if (!(psta->state & _FW_LINKED) || pxmitframe->buf_addr == NULL) { -+ DBG_871X("%s, not _FW_LINKED or addr null\n", __func__); -+ goto xmitframe_coalesce_fail; -+ } -+ -+ /* DBG_871X("%s, action frame category =%d\n", __func__, pframe[WLAN_HDR_A3_LEN]); */ -+ /* according 802.11-2012 standard, these five types are not robust types */ -+ if (subtype == WIFI_ACTION && -+ (pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_PUBLIC || -+ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_HT || -+ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_UNPROTECTED_WNM || -+ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_SELF_PROTECTED || -+ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_P2P)) -+ goto xmitframe_coalesce_fail; -+ /* before encrypt dump the management packet content */ -+ if (pattrib->encrypt > 0) -+ memcpy(pattrib->dot118021x_UncstKey.skey, psta->dot118021x_UncstKey.skey, 16); -+ /* bakeup original management packet */ -+ memcpy(tmp_buf, pframe, pattrib->pktlen); -+ /* move to data portion */ -+ pframe += pattrib->hdrlen; -+ -+ /* 802.11w unicast management packet must be _AES_ */ -+ pattrib->iv_len = 8; -+ /* it's MIC of AES */ -+ pattrib->icv_len = 8; -+ -+ switch (pattrib->encrypt) { -+ case _AES_: -+ /* set AES IV header */ -+ AES_IV(pattrib->iv, psta->dot11wtxpn, 0); -+ break; -+ default: -+ goto xmitframe_coalesce_fail; -+ } -+ /* insert iv header into management frame */ -+ memcpy(pframe, pattrib->iv, pattrib->iv_len); -+ pframe += pattrib->iv_len; -+ /* copy mgmt data portion after CCMP header */ -+ memcpy(pframe, tmp_buf+pattrib->hdrlen, pattrib->pktlen-pattrib->hdrlen); -+ /* move pframe to end of mgmt pkt */ -+ pframe += pattrib->pktlen-pattrib->hdrlen; -+ /* add 8 bytes CCMP IV header to length */ -+ pattrib->pktlen += pattrib->iv_len; -+ if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { -+ memcpy(pframe, pattrib->icv, pattrib->icv_len); -+ pframe += pattrib->icv_len; -+ } -+ /* add 8 bytes MIC */ -+ pattrib->pktlen += pattrib->icv_len; -+ /* set final tx command size */ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ /* set protected bit must be beofre SW encrypt */ -+ SetPrivacy(mem_start); -+ /* software encrypt */ -+ xmitframe_swencrypt(padapter, pxmitframe); -+ } -+ } -+ -+xmitframe_coalesce_success: -+ spin_unlock_bh(&padapter->security_key_mutex); -+ kfree(BIP_AAD); -+ return _SUCCESS; -+ -+xmitframe_coalesce_fail: -+ spin_unlock_bh(&padapter->security_key_mutex); -+ kfree(BIP_AAD); -+ return _FAIL; -+} -+ -+/* Logical Link Control(LLC) SubNetwork Attachment Point(SNAP) header -+ * IEEE LLC/SNAP header contains 8 octets -+ * First 3 octets comprise the LLC portion -+ * SNAP portion, 5 octets, is divided into two fields: -+ *Organizationally Unique Identifier(OUI), 3 octets, -+ *type, defined by that organization, 2 octets. -+ */ -+s32 rtw_put_snap(u8 *data, u16 h_proto) -+{ -+ struct ieee80211_snap_hdr *snap; -+ u8 *oui; -+ -+ snap = (struct ieee80211_snap_hdr *)data; -+ snap->dsap = 0xaa; -+ snap->ssap = 0xaa; -+ snap->ctrl = 0x03; -+ -+ if (h_proto == 0x8137 || h_proto == 0x80f3) -+ oui = P802_1H_OUI; -+ else -+ oui = RFC1042_OUI; -+ -+ snap->oui[0] = oui[0]; -+ snap->oui[1] = oui[1]; -+ snap->oui[2] = oui[2]; -+ -+ *(__be16 *)(data + SNAP_SIZE) = htons(h_proto); -+ -+ return SNAP_SIZE + sizeof(u16); -+} -+ -+void rtw_update_protection(struct adapter *padapter, u8 *ie, uint ie_len) -+{ -+ -+ uint protection; -+ u8 *perp; -+ sint erp_len; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ switch (pxmitpriv->vcs_setting) { -+ case DISABLE_VCS: -+ pxmitpriv->vcs = NONE_VCS; -+ break; -+ -+ case ENABLE_VCS: -+ break; -+ -+ case AUTO_VCS: -+ default: -+ perp = rtw_get_ie(ie, _ERPINFO_IE_, &erp_len, ie_len); -+ if (perp == NULL) -+ pxmitpriv->vcs = NONE_VCS; -+ else{ -+ protection = (*(perp + 2)) & BIT(1); -+ if (protection) { -+ if (pregistrypriv->vcs_type == RTS_CTS) -+ pxmitpriv->vcs = RTS_CTS; -+ else -+ pxmitpriv->vcs = CTS_TO_SELF; -+ } else -+ pxmitpriv->vcs = NONE_VCS; -+ } -+ -+ break; -+ -+ } -+} -+ -+void rtw_count_tx_stats(struct adapter *padapter, struct xmit_frame *pxmitframe, int sz) -+{ -+ struct sta_info *psta = NULL; -+ struct stainfo_stats *pstats = NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 pkt_num = 1; -+ -+ if ((pxmitframe->frame_tag&0x0f) == DATA_FRAMETAG) { -+ pkt_num = pxmitframe->agg_num; -+ -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod += pkt_num; -+ -+ pxmitpriv->tx_pkts += pkt_num; -+ -+ pxmitpriv->tx_bytes += sz; -+ -+ psta = pxmitframe->attrib.psta; -+ if (psta) { -+ pstats = &psta->sta_stats; -+ -+ pstats->tx_pkts += pkt_num; -+ -+ pstats->tx_bytes += sz; -+ } -+ } -+} -+ -+static struct xmit_buf *__rtw_alloc_cmd_xmitbuf(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type) -+{ -+ struct xmit_buf *pxmitbuf = NULL; -+ -+ pxmitbuf = &pxmitpriv->pcmd_xmitbuf[buf_type]; -+ if (pxmitbuf != NULL) { -+ pxmitbuf->priv_data = NULL; -+ -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+ pxmitbuf->agg_num = 0; -+ pxmitbuf->pg_num = 0; -+ -+ if (pxmitbuf->sctx) { -+ DBG_871X("%s pxmitbuf->sctx is not NULL\n", __func__); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_ALLOC); -+ } -+ } else -+ DBG_871X("%s fail, no xmitbuf available !!!\n", __func__); -+ -+ return pxmitbuf; -+} -+ -+struct xmit_frame *__rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type) -+{ -+ struct xmit_frame *pcmdframe; -+ struct xmit_buf *pxmitbuf; -+ -+ pcmdframe = rtw_alloc_xmitframe(pxmitpriv); -+ if (pcmdframe == NULL) { -+ DBG_871X("%s, alloc xmitframe fail\n", __func__); -+ return NULL; -+ } -+ -+ pxmitbuf = __rtw_alloc_cmd_xmitbuf(pxmitpriv, buf_type); -+ if (pxmitbuf == NULL) { -+ DBG_871X("%s, alloc xmitbuf fail\n", __func__); -+ rtw_free_xmitframe(pxmitpriv, pcmdframe); -+ return NULL; -+ } -+ -+ pcmdframe->frame_tag = MGNT_FRAMETAG; -+ -+ pcmdframe->pxmitbuf = pxmitbuf; -+ -+ pcmdframe->buf_addr = pxmitbuf->pbuf; -+ -+ pxmitbuf->priv_data = pcmdframe; -+ -+ return pcmdframe; -+ -+} -+ -+struct xmit_buf *rtw_alloc_xmitbuf_ext(struct xmit_priv *pxmitpriv) -+{ -+ _irqL irqL; -+ struct xmit_buf *pxmitbuf = NULL; -+ struct list_head *plist, *phead; -+ struct __queue *pfree_queue = &pxmitpriv->free_xmit_extbuf_queue; -+ -+ spin_lock_irqsave(&pfree_queue->lock, irqL); -+ -+ if (list_empty(&pfree_queue->queue)) { -+ pxmitbuf = NULL; -+ } else { -+ -+ phead = get_list_head(pfree_queue); -+ -+ plist = get_next(phead); -+ -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ -+ list_del_init(&(pxmitbuf->list)); -+ } -+ -+ if (pxmitbuf != NULL) { -+ pxmitpriv->free_xmit_extbuf_cnt--; -+ #ifdef DBG_XMIT_BUF_EXT -+ DBG_871X("DBG_XMIT_BUF_EXT ALLOC no =%d, free_xmit_extbuf_cnt =%d\n", pxmitbuf->no, pxmitpriv->free_xmit_extbuf_cnt); -+ #endif -+ -+ -+ pxmitbuf->priv_data = NULL; -+ -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+ pxmitbuf->agg_num = 1; -+ -+ if (pxmitbuf->sctx) { -+ DBG_871X("%s pxmitbuf->sctx is not NULL\n", __func__); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_ALLOC); -+ } -+ -+ } -+ -+ spin_unlock_irqrestore(&pfree_queue->lock, irqL); -+ -+ return pxmitbuf; -+} -+ -+s32 rtw_free_xmitbuf_ext(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf) -+{ -+ _irqL irqL; -+ struct __queue *pfree_queue = &pxmitpriv->free_xmit_extbuf_queue; -+ -+ if (pxmitbuf == NULL) -+ return _FAIL; -+ -+ spin_lock_irqsave(&pfree_queue->lock, irqL); -+ -+ list_del_init(&pxmitbuf->list); -+ -+ list_add_tail(&(pxmitbuf->list), get_list_head(pfree_queue)); -+ pxmitpriv->free_xmit_extbuf_cnt++; -+ #ifdef DBG_XMIT_BUF_EXT -+ DBG_871X("DBG_XMIT_BUF_EXT FREE no =%d, free_xmit_extbuf_cnt =%d\n", pxmitbuf->no, pxmitpriv->free_xmit_extbuf_cnt); -+ #endif -+ -+ spin_unlock_irqrestore(&pfree_queue->lock, irqL); -+ -+ return _SUCCESS; -+} -+ -+struct xmit_buf *rtw_alloc_xmitbuf(struct xmit_priv *pxmitpriv) -+{ -+ _irqL irqL; -+ struct xmit_buf *pxmitbuf = NULL; -+ struct list_head *plist, *phead; -+ struct __queue *pfree_xmitbuf_queue = &pxmitpriv->free_xmitbuf_queue; -+ -+ /* DBG_871X("+rtw_alloc_xmitbuf\n"); */ -+ -+ spin_lock_irqsave(&pfree_xmitbuf_queue->lock, irqL); -+ -+ if (list_empty(&pfree_xmitbuf_queue->queue)) { -+ pxmitbuf = NULL; -+ } else { -+ -+ phead = get_list_head(pfree_xmitbuf_queue); -+ -+ plist = get_next(phead); -+ -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ -+ list_del_init(&(pxmitbuf->list)); -+ } -+ -+ if (pxmitbuf != NULL) { -+ pxmitpriv->free_xmitbuf_cnt--; -+ #ifdef DBG_XMIT_BUF -+ DBG_871X("DBG_XMIT_BUF ALLOC no =%d, free_xmitbuf_cnt =%d\n", pxmitbuf->no, pxmitpriv->free_xmitbuf_cnt); -+ #endif -+ /* DBG_871X("alloc, free_xmitbuf_cnt =%d\n", pxmitpriv->free_xmitbuf_cnt); */ -+ -+ pxmitbuf->priv_data = NULL; -+ -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+ pxmitbuf->agg_num = 0; -+ pxmitbuf->pg_num = 0; -+ -+ if (pxmitbuf->sctx) { -+ DBG_871X("%s pxmitbuf->sctx is not NULL\n", __func__); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_ALLOC); -+ } -+ } -+ #ifdef DBG_XMIT_BUF -+ else -+ DBG_871X("DBG_XMIT_BUF rtw_alloc_xmitbuf return NULL\n"); -+ #endif -+ -+ spin_unlock_irqrestore(&pfree_xmitbuf_queue->lock, irqL); -+ -+ return pxmitbuf; -+} -+ -+s32 rtw_free_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf) -+{ -+ _irqL irqL; -+ struct __queue *pfree_xmitbuf_queue = &pxmitpriv->free_xmitbuf_queue; -+ -+ /* DBG_871X("+rtw_free_xmitbuf\n"); */ -+ -+ if (pxmitbuf == NULL) -+ return _FAIL; -+ -+ if (pxmitbuf->sctx) { -+ DBG_871X("%s pxmitbuf->sctx is not NULL\n", __func__); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_FREE); -+ } -+ -+ if (pxmitbuf->buf_tag == XMITBUF_CMD) { -+ } else if (pxmitbuf->buf_tag == XMITBUF_MGNT) { -+ rtw_free_xmitbuf_ext(pxmitpriv, pxmitbuf); -+ } else{ -+ spin_lock_irqsave(&pfree_xmitbuf_queue->lock, irqL); -+ -+ list_del_init(&pxmitbuf->list); -+ -+ list_add_tail(&(pxmitbuf->list), get_list_head(pfree_xmitbuf_queue)); -+ -+ pxmitpriv->free_xmitbuf_cnt++; -+ /* DBG_871X("FREE, free_xmitbuf_cnt =%d\n", pxmitpriv->free_xmitbuf_cnt); */ -+ #ifdef DBG_XMIT_BUF -+ DBG_871X("DBG_XMIT_BUF FREE no =%d, free_xmitbuf_cnt =%d\n", pxmitbuf->no, pxmitpriv->free_xmitbuf_cnt); -+ #endif -+ spin_unlock_irqrestore(&pfree_xmitbuf_queue->lock, irqL); -+ } -+ return _SUCCESS; -+} -+ -+static void rtw_init_xmitframe(struct xmit_frame *pxframe) -+{ -+ if (pxframe != NULL) { /* default value setting */ -+ pxframe->buf_addr = NULL; -+ pxframe->pxmitbuf = NULL; -+ -+ memset(&pxframe->attrib, 0, sizeof(struct pkt_attrib)); -+ /* pxframe->attrib.psta = NULL; */ -+ -+ pxframe->frame_tag = DATA_FRAMETAG; -+ -+ pxframe->pg_num = 1; -+ pxframe->agg_num = 1; -+ pxframe->ack_report = 0; -+ } -+} -+ -+/* -+Calling context: -+1. OS_TXENTRY -+2. RXENTRY (rx_thread or RX_ISR/RX_CallBack) -+ -+If we turn on USE_RXTHREAD, then, no need for critical section. -+Otherwise, we must use _enter/_exit critical to protect free_xmit_queue... -+ -+Must be very very cautious... -+ -+*/ -+struct xmit_frame *rtw_alloc_xmitframe(struct xmit_priv *pxmitpriv)/* _queue *pfree_xmit_queue) */ -+{ -+ /* -+ Please remember to use all the osdep_service api, -+ and lock/unlock or _enter/_exit critical to protect -+ pfree_xmit_queue -+ */ -+ -+ struct xmit_frame *pxframe = NULL; -+ struct list_head *plist, *phead; -+ struct __queue *pfree_xmit_queue = &pxmitpriv->free_xmit_queue; -+ -+ spin_lock_bh(&pfree_xmit_queue->lock); -+ -+ if (list_empty(&pfree_xmit_queue->queue)) { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ("rtw_alloc_xmitframe:%d\n", pxmitpriv->free_xmitframe_cnt)); -+ pxframe = NULL; -+ } else { -+ phead = get_list_head(pfree_xmit_queue); -+ -+ plist = get_next(phead); -+ -+ pxframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ -+ list_del_init(&(pxframe->list)); -+ pxmitpriv->free_xmitframe_cnt--; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ("rtw_alloc_xmitframe():free_xmitframe_cnt =%d\n", pxmitpriv->free_xmitframe_cnt)); -+ } -+ -+ spin_unlock_bh(&pfree_xmit_queue->lock); -+ -+ rtw_init_xmitframe(pxframe); -+ return pxframe; -+} -+ -+struct xmit_frame *rtw_alloc_xmitframe_ext(struct xmit_priv *pxmitpriv) -+{ -+ struct xmit_frame *pxframe = NULL; -+ struct list_head *plist, *phead; -+ struct __queue *queue = &pxmitpriv->free_xframe_ext_queue; -+ -+ spin_lock_bh(&queue->lock); -+ -+ if (list_empty(&queue->queue)) { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ("rtw_alloc_xmitframe_ext:%d\n", pxmitpriv->free_xframe_ext_cnt)); -+ pxframe = NULL; -+ } else { -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ pxframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ -+ list_del_init(&(pxframe->list)); -+ pxmitpriv->free_xframe_ext_cnt--; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ("rtw_alloc_xmitframe_ext():free_xmitframe_cnt =%d\n", pxmitpriv->free_xframe_ext_cnt)); -+ } -+ -+ spin_unlock_bh(&queue->lock); -+ -+ rtw_init_xmitframe(pxframe); -+ -+ return pxframe; -+} -+ -+struct xmit_frame *rtw_alloc_xmitframe_once(struct xmit_priv *pxmitpriv) -+{ -+ struct xmit_frame *pxframe = NULL; -+ u8 *alloc_addr; -+ -+ alloc_addr = rtw_zmalloc(sizeof(struct xmit_frame) + 4); -+ -+ if (alloc_addr == NULL) -+ goto exit; -+ -+ pxframe = (struct xmit_frame *)N_BYTE_ALIGMENT((SIZE_PTR)(alloc_addr), 4); -+ pxframe->alloc_addr = alloc_addr; -+ -+ pxframe->padapter = pxmitpriv->adapter; -+ pxframe->frame_tag = NULL_FRAMETAG; -+ -+ pxframe->pkt = NULL; -+ -+ pxframe->buf_addr = NULL; -+ pxframe->pxmitbuf = NULL; -+ -+ rtw_init_xmitframe(pxframe); -+ -+ DBG_871X("################## %s ##################\n", __func__); -+ -+exit: -+ return pxframe; -+} -+ -+s32 rtw_free_xmitframe(struct xmit_priv *pxmitpriv, struct xmit_frame *pxmitframe) -+{ -+ struct __queue *queue = NULL; -+ struct adapter *padapter = pxmitpriv->adapter; -+ _pkt *pndis_pkt = NULL; -+ -+ if (pxmitframe == NULL) { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("======rtw_free_xmitframe():pxmitframe == NULL!!!!!!!!!!\n")); -+ goto exit; -+ } -+ -+ if (pxmitframe->pkt) { -+ pndis_pkt = pxmitframe->pkt; -+ pxmitframe->pkt = NULL; -+ } -+ -+ if (pxmitframe->alloc_addr) { -+ DBG_871X("################## %s with alloc_addr ##################\n", __func__); -+ kfree(pxmitframe->alloc_addr); -+ goto check_pkt_complete; -+ } -+ -+ if (pxmitframe->ext_tag == 0) -+ queue = &pxmitpriv->free_xmit_queue; -+ else if (pxmitframe->ext_tag == 1) -+ queue = &pxmitpriv->free_xframe_ext_queue; -+ else { -+ -+ } -+ -+ spin_lock_bh(&queue->lock); -+ -+ list_del_init(&pxmitframe->list); -+ list_add_tail(&pxmitframe->list, get_list_head(queue)); -+ if (pxmitframe->ext_tag == 0) { -+ pxmitpriv->free_xmitframe_cnt++; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_debug_, ("rtw_free_xmitframe():free_xmitframe_cnt =%d\n", pxmitpriv->free_xmitframe_cnt)); -+ } else if (pxmitframe->ext_tag == 1) { -+ pxmitpriv->free_xframe_ext_cnt++; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_debug_, ("rtw_free_xmitframe():free_xframe_ext_cnt =%d\n", pxmitpriv->free_xframe_ext_cnt)); -+ } else { -+ } -+ -+ spin_unlock_bh(&queue->lock); -+ -+check_pkt_complete: -+ -+ if (pndis_pkt) -+ rtw_os_pkt_complete(padapter, pndis_pkt); -+ -+exit: -+ return _SUCCESS; -+} -+ -+void rtw_free_xmitframe_queue(struct xmit_priv *pxmitpriv, struct __queue *pframequeue) -+{ -+ struct list_head *plist, *phead; -+ struct xmit_frame *pxmitframe; -+ -+ spin_lock_bh(&(pframequeue->lock)); -+ -+ phead = get_list_head(pframequeue); -+ plist = get_next(phead); -+ -+ while (phead != plist) { -+ -+ pxmitframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ -+ plist = get_next(plist); -+ -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ } -+ spin_unlock_bh(&(pframequeue->lock)); -+} -+ -+s32 rtw_xmitframe_enqueue(struct adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue); -+ if (rtw_xmit_classifier(padapter, pxmitframe) == _FAIL) { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, -+ ("rtw_xmitframe_enqueue: drop xmit pkt for classifier fail\n")); -+/* pxmitframe->pkt = NULL; */ -+ return _FAIL; -+ } -+ -+ return _SUCCESS; -+} -+ -+struct tx_servq *rtw_get_sta_pending(struct adapter *padapter, struct sta_info *psta, sint up, u8 *ac) -+{ -+ struct tx_servq *ptxservq = NULL; -+ -+ switch (up) { -+ case 1: -+ case 2: -+ ptxservq = &(psta->sta_xmitpriv.bk_q); -+ *(ac) = 3; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ("rtw_get_sta_pending : BK\n")); -+ break; -+ -+ case 4: -+ case 5: -+ ptxservq = &(psta->sta_xmitpriv.vi_q); -+ *(ac) = 1; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ("rtw_get_sta_pending : VI\n")); -+ break; -+ -+ case 6: -+ case 7: -+ ptxservq = &(psta->sta_xmitpriv.vo_q); -+ *(ac) = 0; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ("rtw_get_sta_pending : VO\n")); -+ break; -+ -+ case 0: -+ case 3: -+ default: -+ ptxservq = &(psta->sta_xmitpriv.be_q); -+ *(ac) = 2; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ("rtw_get_sta_pending : BE\n")); -+ break; -+ -+ } -+ -+ return ptxservq; -+} -+ -+/* -+ * Will enqueue pxmitframe to the proper queue, -+ * and indicate it to xx_pending list..... -+ */ -+s32 rtw_xmit_classifier(struct adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ /* _irqL irqL0; */ -+ u8 ac_index; -+ struct sta_info *psta; -+ struct tx_servq *ptxservq; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; -+ sint res = _SUCCESS; -+ -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class); -+ -+/* -+ if (pattrib->psta) { -+ psta = pattrib->psta; -+ } else { -+ DBG_871X("%s, call rtw_get_stainfo()\n", __func__); -+ psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ } -+*/ -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if (pattrib->psta != psta) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_sta); -+ DBG_871X("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return _FAIL; -+ } -+ -+ if (psta == NULL) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_nosta); -+ res = _FAIL; -+ DBG_8192C("rtw_xmit_classifier: psta == NULL\n"); -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("rtw_xmit_classifier: psta == NULL\n")); -+ goto exit; -+ } -+ -+ if (!(psta->state & _FW_LINKED)) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_fwlink); -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return _FAIL; -+ } -+ -+ ptxservq = rtw_get_sta_pending(padapter, psta, pattrib->priority, (u8 *)(&ac_index)); -+ -+ /* spin_lock_irqsave(&pstapending->lock, irqL0); */ -+ -+ if (list_empty(&ptxservq->tx_pending)) { -+ list_add_tail(&ptxservq->tx_pending, get_list_head(phwxmits[ac_index].sta_queue)); -+ } -+ -+ /* spin_lock_irqsave(&ptxservq->sta_pending.lock, irqL1); */ -+ -+ list_add_tail(&pxmitframe->list, get_list_head(&ptxservq->sta_pending)); -+ ptxservq->qcnt++; -+ phwxmits[ac_index].accnt++; -+ -+ /* spin_unlock_irqrestore(&ptxservq->sta_pending.lock, irqL1); */ -+ -+ /* spin_unlock_irqrestore(&pstapending->lock, irqL0); */ -+ -+exit: -+ -+ return res; -+} -+ -+void rtw_alloc_hwxmits(struct adapter *padapter) -+{ -+ struct hw_xmit *hwxmits; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ pxmitpriv->hwxmit_entry = HWXMIT_ENTRY; -+ -+ pxmitpriv->hwxmits = NULL; -+ -+ pxmitpriv->hwxmits = (struct hw_xmit *)rtw_zmalloc(sizeof(struct hw_xmit) * pxmitpriv->hwxmit_entry); -+ -+ if (pxmitpriv->hwxmits == NULL) { -+ DBG_871X("alloc hwxmits fail!...\n"); -+ return; -+ } -+ -+ hwxmits = pxmitpriv->hwxmits; -+ -+ if (pxmitpriv->hwxmit_entry == 5) { -+ /* pxmitpriv->bmc_txqueue.head = 0; */ -+ /* hwxmits[0] .phwtxqueue = &pxmitpriv->bmc_txqueue; */ -+ hwxmits[0] .sta_queue = &pxmitpriv->bm_pending; -+ -+ /* pxmitpriv->vo_txqueue.head = 0; */ -+ /* hwxmits[1] .phwtxqueue = &pxmitpriv->vo_txqueue; */ -+ hwxmits[1] .sta_queue = &pxmitpriv->vo_pending; -+ -+ /* pxmitpriv->vi_txqueue.head = 0; */ -+ /* hwxmits[2] .phwtxqueue = &pxmitpriv->vi_txqueue; */ -+ hwxmits[2] .sta_queue = &pxmitpriv->vi_pending; -+ -+ /* pxmitpriv->bk_txqueue.head = 0; */ -+ /* hwxmits[3] .phwtxqueue = &pxmitpriv->bk_txqueue; */ -+ hwxmits[3] .sta_queue = &pxmitpriv->bk_pending; -+ -+ /* pxmitpriv->be_txqueue.head = 0; */ -+ /* hwxmits[4] .phwtxqueue = &pxmitpriv->be_txqueue; */ -+ hwxmits[4] .sta_queue = &pxmitpriv->be_pending; -+ -+ } else if (pxmitpriv->hwxmit_entry == 4) { -+ -+ /* pxmitpriv->vo_txqueue.head = 0; */ -+ /* hwxmits[0] .phwtxqueue = &pxmitpriv->vo_txqueue; */ -+ hwxmits[0] .sta_queue = &pxmitpriv->vo_pending; -+ -+ /* pxmitpriv->vi_txqueue.head = 0; */ -+ /* hwxmits[1] .phwtxqueue = &pxmitpriv->vi_txqueue; */ -+ hwxmits[1] .sta_queue = &pxmitpriv->vi_pending; -+ -+ /* pxmitpriv->be_txqueue.head = 0; */ -+ /* hwxmits[2] .phwtxqueue = &pxmitpriv->be_txqueue; */ -+ hwxmits[2] .sta_queue = &pxmitpriv->be_pending; -+ -+ /* pxmitpriv->bk_txqueue.head = 0; */ -+ /* hwxmits[3] .phwtxqueue = &pxmitpriv->bk_txqueue; */ -+ hwxmits[3] .sta_queue = &pxmitpriv->bk_pending; -+ } else { -+ -+ } -+ -+ -+} -+ -+void rtw_free_hwxmits(struct adapter *padapter) -+{ -+ struct hw_xmit *hwxmits; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ hwxmits = pxmitpriv->hwxmits; -+ if (hwxmits) -+ kfree((u8 *)hwxmits); -+} -+ -+void rtw_init_hwxmits(struct hw_xmit *phwxmit, sint entry) -+{ -+ sint i; -+ -+ for (i = 0; i < entry; i++, phwxmit++) { -+ /* spin_lock_init(&phwxmit->xmit_lock); */ -+ /* INIT_LIST_HEAD(&phwxmit->pending); */ -+ /* phwxmit->txcmdcnt = 0; */ -+ phwxmit->accnt = 0; -+ } -+} -+ -+u32 rtw_get_ff_hwaddr(struct xmit_frame *pxmitframe) -+{ -+ u32 addr; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+ switch (pattrib->qsel) { -+ case 0: -+ case 3: -+ addr = BE_QUEUE_INX; -+ break; -+ case 1: -+ case 2: -+ addr = BK_QUEUE_INX; -+ break; -+ case 4: -+ case 5: -+ addr = VI_QUEUE_INX; -+ break; -+ case 6: -+ case 7: -+ addr = VO_QUEUE_INX; -+ break; -+ case 0x10: -+ addr = BCN_QUEUE_INX; -+ break; -+ case 0x11:/* BC/MC in PS (HIQ) */ -+ addr = HIGH_QUEUE_INX; -+ break; -+ case 0x12: -+ default: -+ addr = MGT_QUEUE_INX; -+ break; -+ -+ } -+ -+ return addr; -+ -+} -+ -+static void do_queue_select(struct adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ u8 qsel; -+ -+ qsel = pattrib->priority; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ("### do_queue_select priority =%d , qsel = %d\n", pattrib->priority, qsel)); -+ -+ pattrib->qsel = qsel; -+} -+ -+/* -+ * The main transmit(tx) entry -+ * -+ * Return -+ *1 enqueue -+ *0 success, hardware will handle this xmit frame(packet) -+ *<0 fail -+ */ -+s32 rtw_xmit(struct adapter *padapter, _pkt **ppkt) -+{ -+ static unsigned long start = 0; -+ static u32 drop_cnt = 0; -+ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct xmit_frame *pxmitframe = NULL; -+ -+ s32 res; -+ -+ DBG_COUNTER(padapter->tx_logs.core_tx); -+ -+ if (start == 0) -+ start = jiffies; -+ -+ pxmitframe = rtw_alloc_xmitframe(pxmitpriv); -+ -+ if (jiffies_to_msecs(jiffies - start) > 2000) { -+ if (drop_cnt) -+ DBG_871X("DBG_TX_DROP_FRAME %s no more pxmitframe, drop_cnt:%u\n", __func__, drop_cnt); -+ start = jiffies; -+ drop_cnt = 0; -+ } -+ -+ if (pxmitframe == NULL) { -+ drop_cnt++; -+ RT_TRACE(_module_xmit_osdep_c_, _drv_err_, ("rtw_xmit: no more pxmitframe\n")); -+ DBG_COUNTER(padapter->tx_logs.core_tx_err_pxmitframe); -+ return -1; -+ } -+ -+ res = update_attrib(padapter, *ppkt, &pxmitframe->attrib); -+ -+ if (res == _FAIL) { -+ RT_TRACE(_module_xmit_osdep_c_, _drv_err_, ("rtw_xmit: update attrib fail\n")); -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s update attrib fail\n", __func__); -+ #endif -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ return -1; -+ } -+ pxmitframe->pkt = *ppkt; -+ -+ do_queue_select(padapter, &pxmitframe->attrib); -+ -+ spin_lock_bh(&pxmitpriv->lock); -+ if (xmitframe_enqueue_for_sleeping_sta(padapter, pxmitframe) == true) { -+ spin_unlock_bh(&pxmitpriv->lock); -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue); -+ return 1; -+ } -+ spin_unlock_bh(&pxmitpriv->lock); -+ -+ /* pre_xmitframe */ -+ if (rtw_hal_xmit(padapter, pxmitframe) == false) -+ return 1; -+ -+ return 0; -+} -+ -+#define RTW_HIQ_FILTER_ALLOW_ALL 0 -+#define RTW_HIQ_FILTER_ALLOW_SPECIAL 1 -+#define RTW_HIQ_FILTER_DENY_ALL 2 -+ -+inline bool xmitframe_hiq_filter(struct xmit_frame *xmitframe) -+{ -+ bool allow = false; -+ struct adapter *adapter = xmitframe->padapter; -+ struct registry_priv *registry = &adapter->registrypriv; -+ -+ if (registry->hiq_filter == RTW_HIQ_FILTER_ALLOW_SPECIAL) { -+ -+ struct pkt_attrib *attrib = &xmitframe->attrib; -+ -+ if (attrib->ether_type == 0x0806 -+ || attrib->ether_type == 0x888e -+ || attrib->dhcp_pkt -+ ) { -+ DBG_871X(FUNC_ADPT_FMT" ether_type:0x%04x%s\n", FUNC_ADPT_ARG(xmitframe->padapter) -+ , attrib->ether_type, attrib->dhcp_pkt?" DHCP":""); -+ allow = true; -+ } -+ } else if (registry->hiq_filter == RTW_HIQ_FILTER_ALLOW_ALL) -+ allow = true; -+ else if (registry->hiq_filter == RTW_HIQ_FILTER_DENY_ALL) { -+ } else -+ rtw_warn_on(1); -+ -+ return allow; -+} -+ -+sint xmitframe_enqueue_for_sleeping_sta(struct adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ sint ret = false; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ sint bmcst = IS_MCAST(pattrib->ra); -+ bool update_tim = false; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == false) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_fwstate); -+ return ret; -+ } -+/* -+ if (pattrib->psta) -+ { -+ psta = pattrib->psta; -+ } -+ else -+ { -+ DBG_871X("%s, call rtw_get_stainfo()\n", __func__); -+ psta =rtw_get_stainfo(pstapriv, pattrib->ra); -+ } -+*/ -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if (pattrib->psta != psta) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_sta); -+ DBG_871X("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return false; -+ } -+ -+ if (psta == NULL) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_nosta); -+ DBG_871X("%s, psta ==NUL\n", __func__); -+ return false; -+ } -+ -+ if (!(psta->state & _FW_LINKED)) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_link); -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return false; -+ } -+ -+ if (pattrib->triggered == 1) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_trigger); -+ /* DBG_871X("directly xmit pspoll_triggered packet\n"); */ -+ -+ /* pattrib->triggered = 0; */ -+ if (bmcst && xmitframe_hiq_filter(pxmitframe) == true) -+ pattrib->qsel = 0x11;/* HIQ */ -+ -+ return ret; -+ } -+ -+ -+ if (bmcst) { -+ spin_lock_bh(&psta->sleep_q.lock); -+ -+ if (pstapriv->sta_dz_bitmap) { /* if anyone sta is in ps mode */ -+ /* pattrib->qsel = 0x11;HIQ */ -+ -+ list_del_init(&pxmitframe->list); -+ -+ /* spin_lock_bh(&psta->sleep_q.lock); */ -+ -+ list_add_tail(&pxmitframe->list, get_list_head(&psta->sleep_q)); -+ -+ psta->sleepq_len++; -+ -+ if (!(pstapriv->tim_bitmap & BIT(0))) -+ update_tim = true; -+ -+ pstapriv->tim_bitmap |= BIT(0);/* */ -+ pstapriv->sta_dz_bitmap |= BIT(0); -+ -+ /* DBG_871X("enqueue, sq_len =%d, tim =%x\n", psta->sleepq_len, pstapriv->tim_bitmap); */ -+ -+ if (update_tim == true) { -+ update_beacon(padapter, _TIM_IE_, NULL, true); -+ } else { -+ chk_bmc_sleepq_cmd(padapter); -+ } -+ -+ /* spin_unlock_bh(&psta->sleep_q.lock); */ -+ -+ ret = true; -+ -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_mcast); -+ -+ } -+ -+ spin_unlock_bh(&psta->sleep_q.lock); -+ -+ return ret; -+ -+ } -+ -+ -+ spin_lock_bh(&psta->sleep_q.lock); -+ -+ if (psta->state&WIFI_SLEEP_STATE) { -+ u8 wmmps_ac = 0; -+ -+ if (pstapriv->sta_dz_bitmap & BIT(psta->aid)) { -+ list_del_init(&pxmitframe->list); -+ -+ /* spin_lock_bh(&psta->sleep_q.lock); */ -+ -+ list_add_tail(&pxmitframe->list, get_list_head(&psta->sleep_q)); -+ -+ psta->sleepq_len++; -+ -+ switch (pattrib->priority) { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk&BIT(0); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi&BIT(0); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo&BIT(0); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be&BIT(0); -+ break; -+ } -+ -+ if (wmmps_ac) -+ psta->sleepq_ac_len++; -+ -+ if (((psta->has_legacy_ac) && (!wmmps_ac)) || ((!psta->has_legacy_ac) && (wmmps_ac))) { -+ if (!(pstapriv->tim_bitmap & BIT(psta->aid))) -+ update_tim = true; -+ -+ pstapriv->tim_bitmap |= BIT(psta->aid); -+ -+ /* DBG_871X("enqueue, sq_len =%d, tim =%x\n", psta->sleepq_len, pstapriv->tim_bitmap); */ -+ -+ if (update_tim == true) -+ /* DBG_871X("sleepq_len == 1, update BCNTIM\n"); */ -+ /* upate BCN for TIM IE */ -+ update_beacon(padapter, _TIM_IE_, NULL, true); -+ } -+ -+ /* spin_unlock_bh(&psta->sleep_q.lock); */ -+ -+ /* if (psta->sleepq_len > (NR_XMITFRAME>>3)) */ -+ /* */ -+ /* wakeup_sta_to_xmit(padapter, psta); */ -+ /* */ -+ -+ ret = true; -+ -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_ucast); -+ } -+ -+ } -+ -+ spin_unlock_bh(&psta->sleep_q.lock); -+ -+ return ret; -+ -+} -+ -+static void dequeue_xmitframes_to_sleeping_queue(struct adapter *padapter, struct sta_info *psta, struct __queue *pframequeue) -+{ -+ sint ret; -+ struct list_head *plist, *phead; -+ u8 ac_index; -+ struct tx_servq *ptxservq; -+ struct pkt_attrib *pattrib; -+ struct xmit_frame *pxmitframe; -+ struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; -+ -+ phead = get_list_head(pframequeue); -+ plist = get_next(phead); -+ -+ while (phead != plist) { -+ pxmitframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ -+ plist = get_next(plist); -+ -+ pattrib = &pxmitframe->attrib; -+ -+ pattrib->triggered = 0; -+ -+ ret = xmitframe_enqueue_for_sleeping_sta(padapter, pxmitframe); -+ -+ if (true == ret) { -+ ptxservq = rtw_get_sta_pending(padapter, psta, pattrib->priority, (u8 *)(&ac_index)); -+ -+ ptxservq->qcnt--; -+ phwxmits[ac_index].accnt--; -+ } else { -+ /* DBG_871X("xmitframe_enqueue_for_sleeping_sta return false\n"); */ -+ } -+ -+ } -+ -+} -+ -+void stop_sta_xmit(struct adapter *padapter, struct sta_info *psta) -+{ -+ struct sta_info *psta_bmc; -+ struct sta_xmit_priv *pstaxmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ pstaxmitpriv = &psta->sta_xmitpriv; -+ -+ /* for BC/MC Frames */ -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ -+ -+ spin_lock_bh(&pxmitpriv->lock); -+ -+ psta->state |= WIFI_SLEEP_STATE; -+ -+ pstapriv->sta_dz_bitmap |= BIT(psta->aid); -+ -+ -+ -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->vo_q.sta_pending); -+ list_del_init(&(pstaxmitpriv->vo_q.tx_pending)); -+ -+ -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->vi_q.sta_pending); -+ list_del_init(&(pstaxmitpriv->vi_q.tx_pending)); -+ -+ -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->be_q.sta_pending); -+ list_del_init(&(pstaxmitpriv->be_q.tx_pending)); -+ -+ -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->bk_q.sta_pending); -+ list_del_init(&(pstaxmitpriv->bk_q.tx_pending)); -+ -+ /* for BC/MC Frames */ -+ pstaxmitpriv = &psta_bmc->sta_xmitpriv; -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta_bmc, &pstaxmitpriv->be_q.sta_pending); -+ list_del_init(&(pstaxmitpriv->be_q.tx_pending)); -+ -+ spin_unlock_bh(&pxmitpriv->lock); -+} -+ -+void wakeup_sta_to_xmit(struct adapter *padapter, struct sta_info *psta) -+{ -+ u8 update_mask = 0, wmmps_ac = 0; -+ struct sta_info *psta_bmc; -+ struct list_head *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ -+ -+ /* spin_lock_bh(&psta->sleep_q.lock); */ -+ spin_lock_bh(&pxmitpriv->lock); -+ -+ xmitframe_phead = get_list_head(&psta->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while (xmitframe_phead != xmitframe_plist) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ list_del_init(&pxmitframe->list); -+ -+ switch (pxmitframe->attrib.priority) { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk&BIT(1); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi&BIT(1); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo&BIT(1); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be&BIT(1); -+ break; -+ } -+ -+ psta->sleepq_len--; -+ if (psta->sleepq_len > 0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ if (wmmps_ac) { -+ psta->sleepq_ac_len--; -+ if (psta->sleepq_ac_len > 0) { -+ pxmitframe->attrib.mdata = 1; -+ pxmitframe->attrib.eosp = 0; -+ } else{ -+ pxmitframe->attrib.mdata = 0; -+ pxmitframe->attrib.eosp = 1; -+ } -+ } -+ -+ pxmitframe->attrib.triggered = 1; -+ -+/* -+ spin_unlock_bh(&psta->sleep_q.lock); -+ if (rtw_hal_xmit(padapter, pxmitframe) == true) -+ { -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ } -+ spin_lock_bh(&psta->sleep_q.lock); -+*/ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ -+ } -+ -+ if (psta->sleepq_len == 0) { -+ if (pstapriv->tim_bitmap & BIT(psta->aid)) { -+ /* DBG_871X("wakeup to xmit, qlen == 0, update_BCNTIM, tim =%x\n", pstapriv->tim_bitmap); */ -+ /* upate BCN for TIM IE */ -+ /* update_BCNTIM(padapter); */ -+ update_mask = BIT(0); -+ } -+ -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ if (psta->state&WIFI_SLEEP_STATE) -+ psta->state ^= WIFI_SLEEP_STATE; -+ -+ if (psta->state & WIFI_STA_ALIVE_CHK_STATE) { -+ DBG_871X("%s alive check\n", __func__); -+ psta->expire_to = pstapriv->expire_to; -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ } -+ -+ pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); -+ } -+ -+ /* for BC/MC Frames */ -+ if (!psta_bmc) -+ goto _exit; -+ -+ if ((pstapriv->sta_dz_bitmap&0xfffe) == 0x0) { /* no any sta in ps mode */ -+ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while (xmitframe_phead != xmitframe_plist) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ list_del_init(&pxmitframe->list); -+ -+ psta_bmc->sleepq_len--; -+ if (psta_bmc->sleepq_len > 0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ -+ pxmitframe->attrib.triggered = 1; -+/* -+ spin_unlock_bh(&psta_bmc->sleep_q.lock); -+ if (rtw_hal_xmit(padapter, pxmitframe) == true) -+ { -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ } -+ spin_lock_bh(&psta_bmc->sleep_q.lock); -+ -+*/ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ } -+ -+ if (psta_bmc->sleepq_len == 0) { -+ if (pstapriv->tim_bitmap & BIT(0)) { -+ /* DBG_871X("wakeup to xmit, qlen == 0, update_BCNTIM, tim =%x\n", pstapriv->tim_bitmap); */ -+ /* upate BCN for TIM IE */ -+ /* update_BCNTIM(padapter); */ -+ update_mask |= BIT(1); -+ } -+ pstapriv->tim_bitmap &= ~BIT(0); -+ pstapriv->sta_dz_bitmap &= ~BIT(0); -+ } -+ -+ } -+ -+_exit: -+ -+ /* spin_unlock_bh(&psta_bmc->sleep_q.lock); */ -+ spin_unlock_bh(&pxmitpriv->lock); -+ -+ if (update_mask) -+ /* update_BCNTIM(padapter); */ -+ /* printk("%s => call update_beacon\n", __func__); */ -+ update_beacon(padapter, _TIM_IE_, NULL, true); -+ -+} -+ -+void xmit_delivery_enabled_frames(struct adapter *padapter, struct sta_info *psta) -+{ -+ u8 wmmps_ac = 0; -+ struct list_head *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ -+ /* spin_lock_bh(&psta->sleep_q.lock); */ -+ spin_lock_bh(&pxmitpriv->lock); -+ -+ xmitframe_phead = get_list_head(&psta->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while (xmitframe_phead != xmitframe_plist) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ switch (pxmitframe->attrib.priority) { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk&BIT(1); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi&BIT(1); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo&BIT(1); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be&BIT(1); -+ break; -+ } -+ -+ if (!wmmps_ac) -+ continue; -+ -+ list_del_init(&pxmitframe->list); -+ -+ psta->sleepq_len--; -+ psta->sleepq_ac_len--; -+ -+ if (psta->sleepq_ac_len > 0) { -+ pxmitframe->attrib.mdata = 1; -+ pxmitframe->attrib.eosp = 0; -+ } else{ -+ pxmitframe->attrib.mdata = 0; -+ pxmitframe->attrib.eosp = 1; -+ } -+ -+ pxmitframe->attrib.triggered = 1; -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ if ((psta->sleepq_ac_len == 0) && (!psta->has_legacy_ac) && (wmmps_ac)) { -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ /* DBG_871X("wakeup to xmit, qlen == 0, update_BCNTIM, tim =%x\n", pstapriv->tim_bitmap); */ -+ /* upate BCN for TIM IE */ -+ /* update_BCNTIM(padapter); */ -+ update_beacon(padapter, _TIM_IE_, NULL, true); -+ /* update_mask = BIT(0); */ -+ } -+ -+ } -+ -+ /* spin_unlock_bh(&psta->sleep_q.lock); */ -+ spin_unlock_bh(&pxmitpriv->lock); -+ -+ return; -+} -+ -+void enqueue_pending_xmitbuf( -+ struct xmit_priv *pxmitpriv, -+ struct xmit_buf *pxmitbuf) -+{ -+ struct __queue *pqueue; -+ struct adapter *pri_adapter = pxmitpriv->adapter; -+ -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ spin_lock_bh(&pqueue->lock); -+ list_del_init(&pxmitbuf->list); -+ list_add_tail(&pxmitbuf->list, get_list_head(pqueue)); -+ spin_unlock_bh(&pqueue->lock); -+ -+ up(&(pri_adapter->xmitpriv.xmit_sema)); -+} -+ -+void enqueue_pending_xmitbuf_to_head( -+ struct xmit_priv *pxmitpriv, -+ struct xmit_buf *pxmitbuf) -+{ -+ struct __queue *pqueue; -+ -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ spin_lock_bh(&pqueue->lock); -+ list_del_init(&pxmitbuf->list); -+ list_add(&pxmitbuf->list, get_list_head(pqueue)); -+ spin_unlock_bh(&pqueue->lock); -+} -+ -+struct xmit_buf *dequeue_pending_xmitbuf( -+ struct xmit_priv *pxmitpriv) -+{ -+ struct xmit_buf *pxmitbuf; -+ struct __queue *pqueue; -+ -+ -+ pxmitbuf = NULL; -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ spin_lock_bh(&pqueue->lock); -+ -+ if (!list_empty(&pqueue->queue)) { -+ struct list_head *plist, *phead; -+ -+ phead = get_list_head(pqueue); -+ plist = get_next(phead); -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ list_del_init(&pxmitbuf->list); -+ } -+ -+ spin_unlock_bh(&pqueue->lock); -+ -+ return pxmitbuf; -+} -+ -+struct xmit_buf *dequeue_pending_xmitbuf_under_survey( -+ struct xmit_priv *pxmitpriv) -+{ -+ struct xmit_buf *pxmitbuf; -+ struct __queue *pqueue; -+ -+ -+ pxmitbuf = NULL; -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ spin_lock_bh(&pqueue->lock); -+ -+ if (!list_empty(&pqueue->queue)) { -+ struct list_head *plist, *phead; -+ u8 type; -+ -+ phead = get_list_head(pqueue); -+ plist = phead; -+ do { -+ plist = get_next(plist); -+ if (plist == phead) -+ break; -+ -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ -+ type = GetFrameSubType(pxmitbuf->pbuf + TXDESC_OFFSET); -+ -+ if ((type == WIFI_PROBEREQ) || -+ (type == WIFI_DATA_NULL) || -+ (type == WIFI_QOS_DATA_NULL)) { -+ list_del_init(&pxmitbuf->list); -+ break; -+ } -+ pxmitbuf = NULL; -+ } while (1); -+ } -+ -+ spin_unlock_bh(&pqueue->lock); -+ -+ return pxmitbuf; -+} -+ -+sint check_pending_xmitbuf( -+ struct xmit_priv *pxmitpriv) -+{ -+ struct __queue *pqueue; -+ sint ret = false; -+ -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ spin_lock_bh(&pqueue->lock); -+ -+ if (!list_empty(&pqueue->queue)) -+ ret = true; -+ -+ spin_unlock_bh(&pqueue->lock); -+ -+ return ret; -+} -+ -+int rtw_xmit_thread(void *context) -+{ -+ s32 err; -+ struct adapter *padapter; -+ -+ -+ err = _SUCCESS; -+ padapter = (struct adapter *)context; -+ -+ thread_enter("RTW_XMIT_THREAD"); -+ -+ do { -+ err = rtw_hal_xmit_thread_handler(padapter); -+ flush_signals_thread(); -+ } while (_SUCCESS == err); -+ -+ up(&padapter->xmitpriv.terminate_xmitthread_sema); -+ -+ thread_exit(); -+} -+ -+void rtw_sctx_init(struct submit_ctx *sctx, int timeout_ms) -+{ -+ sctx->timeout_ms = timeout_ms; -+ sctx->submit_time = jiffies; -+ init_completion(&sctx->done); -+ sctx->status = RTW_SCTX_SUBMITTED; -+} -+ -+int rtw_sctx_wait(struct submit_ctx *sctx, const char *msg) -+{ -+ int ret = _FAIL; -+ unsigned long expire; -+ int status = 0; -+ -+ expire = sctx->timeout_ms ? msecs_to_jiffies(sctx->timeout_ms) : MAX_SCHEDULE_TIMEOUT; -+ if (!wait_for_completion_timeout(&sctx->done, expire)) { -+ /* timeout, do something?? */ -+ status = RTW_SCTX_DONE_TIMEOUT; -+ DBG_871X("%s timeout: %s\n", __func__, msg); -+ } else { -+ status = sctx->status; -+ } -+ -+ if (status == RTW_SCTX_DONE_SUCCESS) { -+ ret = _SUCCESS; -+ } -+ -+ return ret; -+} -+ -+static bool rtw_sctx_chk_waring_status(int status) -+{ -+ switch (status) { -+ case RTW_SCTX_DONE_UNKNOWN: -+ case RTW_SCTX_DONE_BUF_ALLOC: -+ case RTW_SCTX_DONE_BUF_FREE: -+ -+ case RTW_SCTX_DONE_DRV_STOP: -+ case RTW_SCTX_DONE_DEV_REMOVE: -+ return true; -+ default: -+ return false; -+ } -+} -+ -+void rtw_sctx_done_err(struct submit_ctx **sctx, int status) -+{ -+ if (*sctx) { -+ if (rtw_sctx_chk_waring_status(status)) -+ DBG_871X("%s status:%d\n", __func__, status); -+ (*sctx)->status = status; -+ complete(&((*sctx)->done)); -+ *sctx = NULL; -+ } -+} -+ -+void rtw_sctx_done(struct submit_ctx **sctx) -+{ -+ rtw_sctx_done_err(sctx, RTW_SCTX_DONE_SUCCESS); -+} -+ -+int rtw_ack_tx_wait(struct xmit_priv *pxmitpriv, u32 timeout_ms) -+{ -+ struct submit_ctx *pack_tx_ops = &pxmitpriv->ack_tx_ops; -+ -+ pack_tx_ops->submit_time = jiffies; -+ pack_tx_ops->timeout_ms = timeout_ms; -+ pack_tx_ops->status = RTW_SCTX_SUBMITTED; -+ -+ return rtw_sctx_wait(pack_tx_ops, __func__); -+} -+ -+void rtw_ack_tx_done(struct xmit_priv *pxmitpriv, int status) -+{ -+ struct submit_ctx *pack_tx_ops = &pxmitpriv->ack_tx_ops; -+ -+ if (pxmitpriv->ack_tx) { -+ rtw_sctx_done_err(&pack_tx_ops, status); -+ } else { -+ DBG_871X("%s ack_tx not set\n", __func__); -+ } -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/Hal8723BPwrSeq.c linux/3rdparty/rtl8723bs/hal/Hal8723BPwrSeq.c ---- linux.old/3rdparty/rtl8723bs/hal/Hal8723BPwrSeq.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/Hal8723BPwrSeq.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,138 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+/* -+* -+This file includes all kinds of Power Action event for RTL8723B -+and corresponding hardware configurtions which are released from HW SD. -+ -+Major Change History: -+ When Who What -+ ---------- --------------- ------------------------------- -+ 2011-08-08 Roger Create. -+ -+*/ -+ -+#include "Hal8723BPwrSeq.h" -+ -+/* drivers should parse below arrays and do the corresponding actions */ -+/* 3 Power on Array */ -+WLAN_PWR_CFG rtl8723B_power_on_flow[ -+ RTL8723B_TRANS_CARDEMU_TO_ACT_STEPS+ -+ RTL8723B_TRANS_END_STEPS -+] = { -+ RTL8723B_TRANS_CARDEMU_TO_ACT -+ RTL8723B_TRANS_END -+}; -+ -+/* 3Radio off GPIO Array */ -+WLAN_PWR_CFG rtl8723B_radio_off_flow[ -+ RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+ -+ RTL8723B_TRANS_END_STEPS -+] = { -+ RTL8723B_TRANS_ACT_TO_CARDEMU -+ RTL8723B_TRANS_END -+}; -+ -+/* 3Card Disable Array */ -+WLAN_PWR_CFG rtl8723B_card_disable_flow[ -+ RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+ -+ RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS+ -+ RTL8723B_TRANS_END_STEPS -+] = { -+ RTL8723B_TRANS_ACT_TO_CARDEMU -+ RTL8723B_TRANS_CARDEMU_TO_CARDDIS -+ RTL8723B_TRANS_END -+}; -+ -+/* 3 Card Enable Array */ -+WLAN_PWR_CFG rtl8723B_card_enable_flow[ -+ RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+ -+ RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS+ -+ RTL8723B_TRANS_END_STEPS -+] = { -+ RTL8723B_TRANS_CARDDIS_TO_CARDEMU -+ RTL8723B_TRANS_CARDEMU_TO_ACT -+ RTL8723B_TRANS_END -+}; -+ -+/* 3Suspend Array */ -+WLAN_PWR_CFG rtl8723B_suspend_flow[ -+ RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+ -+ RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS+ -+ RTL8723B_TRANS_END_STEPS -+] = { -+ RTL8723B_TRANS_ACT_TO_CARDEMU -+ RTL8723B_TRANS_CARDEMU_TO_SUS -+ RTL8723B_TRANS_END -+}; -+ -+/* 3 Resume Array */ -+WLAN_PWR_CFG rtl8723B_resume_flow[ -+ RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+ -+ RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS+ -+ RTL8723B_TRANS_END_STEPS -+] = { -+ RTL8723B_TRANS_SUS_TO_CARDEMU -+ RTL8723B_TRANS_CARDEMU_TO_ACT -+ RTL8723B_TRANS_END -+}; -+ -+/* 3HWPDN Array */ -+WLAN_PWR_CFG rtl8723B_hwpdn_flow[ -+ RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+ -+ RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS+ -+ RTL8723B_TRANS_END_STEPS -+] = { -+ RTL8723B_TRANS_ACT_TO_CARDEMU -+ RTL8723B_TRANS_CARDEMU_TO_PDN -+ RTL8723B_TRANS_END -+}; -+ -+/* 3 Enter LPS */ -+WLAN_PWR_CFG rtl8723B_enter_lps_flow[ -+ RTL8723B_TRANS_ACT_TO_LPS_STEPS+RTL8723B_TRANS_END_STEPS -+] = { -+ /* FW behavior */ -+ RTL8723B_TRANS_ACT_TO_LPS -+ RTL8723B_TRANS_END -+}; -+ -+/* 3 Leave LPS */ -+WLAN_PWR_CFG rtl8723B_leave_lps_flow[ -+ RTL8723B_TRANS_LPS_TO_ACT_STEPS+RTL8723B_TRANS_END_STEPS -+] = { -+ /* FW behavior */ -+ RTL8723B_TRANS_LPS_TO_ACT -+ RTL8723B_TRANS_END -+}; -+ -+/* 3 Enter SW LPS */ -+WLAN_PWR_CFG rtl8723B_enter_swlps_flow[ -+ RTL8723B_TRANS_ACT_TO_SWLPS_STEPS+RTL8723B_TRANS_END_STEPS -+] = { -+ /* SW behavior */ -+ RTL8723B_TRANS_ACT_TO_SWLPS -+ RTL8723B_TRANS_END -+}; -+ -+/* 3 Leave SW LPS */ -+WLAN_PWR_CFG rtl8723B_leave_swlps_flow[ -+ RTL8723B_TRANS_SWLPS_TO_ACT_STEPS+RTL8723B_TRANS_END_STEPS -+] = { -+ /* SW behavior */ -+ RTL8723B_TRANS_SWLPS_TO_ACT -+ RTL8723B_TRANS_END -+}; -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/Hal8723BReg.h linux/3rdparty/rtl8723bs/hal/Hal8723BReg.h ---- linux.old/3rdparty/rtl8723bs/hal/Hal8723BReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/Hal8723BReg.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,442 @@ -+/***************************************************************************** -+ *Copyright(c) 2009, RealTEK Technology Inc. All Right Reserved. -+ * -+ * Module: __INC_HAL8723BREG_H -+ * -+ * -+ * Note: 1. Define Mac register address and corresponding bit mask map -+ * -+ * -+ * Export: Constants, macro, functions(API), global variables(None). -+ * -+ * Abbrev: -+ * -+ * History: -+ * Data Who Remark -+ * -+ *****************************************************************************/ -+#ifndef __INC_HAL8723BREG_H -+#define __INC_HAL8723BREG_H -+ -+ -+ -+/* */ -+/* */ -+/* */ -+ -+/* */ -+/* */ -+/* 0x0000h ~ 0x00FFh System Configuration */ -+/* */ -+/* */ -+#define REG_SYS_ISO_CTRL_8723B 0x0000 /* 2 Byte */ -+#define REG_SYS_FUNC_EN_8723B 0x0002 /* 2 Byte */ -+#define REG_APS_FSMCO_8723B 0x0004 /* 4 Byte */ -+#define REG_SYS_CLKR_8723B 0x0008 /* 2 Byte */ -+#define REG_9346CR_8723B 0x000A /* 2 Byte */ -+#define REG_EE_VPD_8723B 0x000C /* 2 Byte */ -+#define REG_AFE_MISC_8723B 0x0010 /* 1 Byte */ -+#define REG_SPS0_CTRL_8723B 0x0011 /* 7 Byte */ -+#define REG_SPS_OCP_CFG_8723B 0x0018 /* 4 Byte */ -+#define REG_RSV_CTRL_8723B 0x001C /* 3 Byte */ -+#define REG_RF_CTRL_8723B 0x001F /* 1 Byte */ -+#define REG_LPLDO_CTRL_8723B 0x0023 /* 1 Byte */ -+#define REG_AFE_XTAL_CTRL_8723B 0x0024 /* 4 Byte */ -+#define REG_AFE_PLL_CTRL_8723B 0x0028 /* 4 Byte */ -+#define REG_MAC_PLL_CTRL_EXT_8723B 0x002c /* 4 Byte */ -+#define REG_EFUSE_CTRL_8723B 0x0030 -+#define REG_EFUSE_TEST_8723B 0x0034 -+#define REG_PWR_DATA_8723B 0x0038 -+#define REG_CAL_TIMER_8723B 0x003C -+#define REG_ACLK_MON_8723B 0x003E -+#define REG_GPIO_MUXCFG_8723B 0x0040 -+#define REG_GPIO_IO_SEL_8723B 0x0042 -+#define REG_MAC_PINMUX_CFG_8723B 0x0043 -+#define REG_GPIO_PIN_CTRL_8723B 0x0044 -+#define REG_GPIO_INTM_8723B 0x0048 -+#define REG_LEDCFG0_8723B 0x004C -+#define REG_LEDCFG1_8723B 0x004D -+#define REG_LEDCFG2_8723B 0x004E -+#define REG_LEDCFG3_8723B 0x004F -+#define REG_FSIMR_8723B 0x0050 -+#define REG_FSISR_8723B 0x0054 -+#define REG_HSIMR_8723B 0x0058 -+#define REG_HSISR_8723B 0x005c -+#define REG_GPIO_EXT_CTRL 0x0060 -+#define REG_MULTI_FUNC_CTRL_8723B 0x0068 -+#define REG_GPIO_STATUS_8723B 0x006C -+#define REG_SDIO_CTRL_8723B 0x0070 -+#define REG_OPT_CTRL_8723B 0x0074 -+#define REG_AFE_XTAL_CTRL_EXT_8723B 0x0078 -+#define REG_MCUFWDL_8723B 0x0080 -+#define REG_BT_PATCH_STATUS_8723B 0x0088 -+#define REG_HIMR0_8723B 0x00B0 -+#define REG_HISR0_8723B 0x00B4 -+#define REG_HIMR1_8723B 0x00B8 -+#define REG_HISR1_8723B 0x00BC -+#define REG_PMC_DBG_CTRL2_8723B 0x00CC -+#define REG_EFUSE_BURN_GNT_8723B 0x00CF -+#define REG_HPON_FSM_8723B 0x00EC -+#define REG_SYS_CFG_8723B 0x00F0 -+#define REG_SYS_CFG1_8723B 0x00FC -+#define REG_ROM_VERSION 0x00FD -+ -+/* */ -+/* */ -+/* 0x0100h ~ 0x01FFh MACTOP General Configuration */ -+/* */ -+/* */ -+#define REG_CR_8723B 0x0100 -+#define REG_PBP_8723B 0x0104 -+#define REG_PKT_BUFF_ACCESS_CTRL_8723B 0x0106 -+#define REG_TRXDMA_CTRL_8723B 0x010C -+#define REG_TRXFF_BNDY_8723B 0x0114 -+#define REG_TRXFF_STATUS_8723B 0x0118 -+#define REG_RXFF_PTR_8723B 0x011C -+#define REG_CPWM_8723B 0x012F -+#define REG_FWIMR_8723B 0x0130 -+#define REG_FWISR_8723B 0x0134 -+#define REG_FTIMR_8723B 0x0138 -+#define REG_PKTBUF_DBG_CTRL_8723B 0x0140 -+#define REG_RXPKTBUF_CTRL_8723B 0x0142 -+#define REG_PKTBUF_DBG_DATA_L_8723B 0x0144 -+#define REG_PKTBUF_DBG_DATA_H_8723B 0x0148 -+ -+#define REG_TC0_CTRL_8723B 0x0150 -+#define REG_TC1_CTRL_8723B 0x0154 -+#define REG_TC2_CTRL_8723B 0x0158 -+#define REG_TC3_CTRL_8723B 0x015C -+#define REG_TC4_CTRL_8723B 0x0160 -+#define REG_TCUNIT_BASE_8723B 0x0164 -+#define REG_RSVD3_8723B 0x0168 -+#define REG_C2HEVT_MSG_NORMAL_8723B 0x01A0 -+#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 -+#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 -+#define REG_C2HEVT_CMD_LEN_88XX 0x01AE -+#define REG_C2HEVT_CLEAR_8723B 0x01AF -+#define REG_MCUTST_1_8723B 0x01C0 -+#define REG_MCUTST_WOWLAN_8723B 0x01C7 -+#define REG_FMETHR_8723B 0x01C8 -+#define REG_HMETFR_8723B 0x01CC -+#define REG_HMEBOX_0_8723B 0x01D0 -+#define REG_HMEBOX_1_8723B 0x01D4 -+#define REG_HMEBOX_2_8723B 0x01D8 -+#define REG_HMEBOX_3_8723B 0x01DC -+#define REG_LLT_INIT_8723B 0x01E0 -+#define REG_HMEBOX_EXT0_8723B 0x01F0 -+#define REG_HMEBOX_EXT1_8723B 0x01F4 -+#define REG_HMEBOX_EXT2_8723B 0x01F8 -+#define REG_HMEBOX_EXT3_8723B 0x01FC -+ -+/* */ -+/* */ -+/* 0x0200h ~ 0x027Fh TXDMA Configuration */ -+/* */ -+/* */ -+#define REG_RQPN_8723B 0x0200 -+#define REG_FIFOPAGE_8723B 0x0204 -+#define REG_DWBCN0_CTRL_8723B REG_TDECTRL -+#define REG_TXDMA_OFFSET_CHK_8723B 0x020C -+#define REG_TXDMA_STATUS_8723B 0x0210 -+#define REG_RQPN_NPQ_8723B 0x0214 -+#define REG_DWBCN1_CTRL_8723B 0x0228 -+ -+ -+/* */ -+/* */ -+/* 0x0280h ~ 0x02FFh RXDMA Configuration */ -+/* */ -+/* */ -+#define REG_RXDMA_AGG_PG_TH_8723B 0x0280 -+#define REG_FW_UPD_RDPTR_8723B 0x0284 /* FW shall update this register before FW write RXPKT_RELEASE_POLL to 1 */ -+#define REG_RXDMA_CONTROL_8723B 0x0286 /* Control the RX DMA. */ -+#define REG_RXPKT_NUM_8723B 0x0287 /* The number of packets in RXPKTBUF. */ -+#define REG_RXDMA_STATUS_8723B 0x0288 -+#define REG_RXDMA_PRO_8723B 0x0290 -+#define REG_EARLY_MODE_CONTROL_8723B 0x02BC -+#define REG_RSVD5_8723B 0x02F0 -+#define REG_RSVD6_8723B 0x02F4 -+ -+ -+/* */ -+/* */ -+/* 0x0300h ~ 0x03FFh PCIe */ -+/* */ -+/* */ -+#define REG_PCIE_CTRL_REG_8723B 0x0300 -+#define REG_INT_MIG_8723B 0x0304 /* Interrupt Migration */ -+#define REG_BCNQ_DESA_8723B 0x0308 /* TX Beacon Descriptor Address */ -+#define REG_HQ_DESA_8723B 0x0310 /* TX High Queue Descriptor Address */ -+#define REG_MGQ_DESA_8723B 0x0318 /* TX Manage Queue Descriptor Address */ -+#define REG_VOQ_DESA_8723B 0x0320 /* TX VO Queue Descriptor Address */ -+#define REG_VIQ_DESA_8723B 0x0328 /* TX VI Queue Descriptor Address */ -+#define REG_BEQ_DESA_8723B 0x0330 /* TX BE Queue Descriptor Address */ -+#define REG_BKQ_DESA_8723B 0x0338 /* TX BK Queue Descriptor Address */ -+#define REG_RX_DESA_8723B 0x0340 /* RX Queue Descriptor Address */ -+#define REG_DBI_WDATA_8723B 0x0348 /* DBI Write Data */ -+#define REG_DBI_RDATA_8723B 0x034C /* DBI Read Data */ -+#define REG_DBI_ADDR_8723B 0x0350 /* DBI Address */ -+#define REG_DBI_FLAG_8723B 0x0352 /* DBI Read/Write Flag */ -+#define REG_MDIO_WDATA_8723B 0x0354 /* MDIO for Write PCIE PHY */ -+#define REG_MDIO_RDATA_8723B 0x0356 /* MDIO for Reads PCIE PHY */ -+#define REG_MDIO_CTL_8723B 0x0358 /* MDIO for Control */ -+#define REG_DBG_SEL_8723B 0x0360 /* Debug Selection Register */ -+#define REG_PCIE_HRPWM_8723B 0x0361 /* PCIe RPWM */ -+#define REG_PCIE_HCPWM_8723B 0x0363 /* PCIe CPWM */ -+#define REG_PCIE_MULTIFET_CTRL_8723B 0x036A /* PCIE Multi-Fethc Control */ -+ -+/* spec version 11 */ -+/* */ -+/* */ -+/* 0x0400h ~ 0x047Fh Protocol Configuration */ -+/* */ -+/* */ -+#define REG_VOQ_INFORMATION_8723B 0x0400 -+#define REG_VIQ_INFORMATION_8723B 0x0404 -+#define REG_BEQ_INFORMATION_8723B 0x0408 -+#define REG_BKQ_INFORMATION_8723B 0x040C -+#define REG_MGQ_INFORMATION_8723B 0x0410 -+#define REG_HGQ_INFORMATION_8723B 0x0414 -+#define REG_BCNQ_INFORMATION_8723B 0x0418 -+#define REG_TXPKT_EMPTY_8723B 0x041A -+ -+#define REG_FWHW_TXQ_CTRL_8723B 0x0420 -+#define REG_HWSEQ_CTRL_8723B 0x0423 -+#define REG_TXPKTBUF_BCNQ_BDNY_8723B 0x0424 -+#define REG_TXPKTBUF_MGQ_BDNY_8723B 0x0425 -+#define REG_LIFECTRL_CTRL_8723B 0x0426 -+#define REG_MULTI_BCNQ_OFFSET_8723B 0x0427 -+#define REG_SPEC_SIFS_8723B 0x0428 -+#define REG_RL_8723B 0x042A -+#define REG_TXBF_CTRL_8723B 0x042C -+#define REG_DARFRC_8723B 0x0430 -+#define REG_RARFRC_8723B 0x0438 -+#define REG_RRSR_8723B 0x0440 -+#define REG_ARFR0_8723B 0x0444 -+#define REG_ARFR1_8723B 0x044C -+#define REG_CCK_CHECK_8723B 0x0454 -+#define REG_AMPDU_MAX_TIME_8723B 0x0456 -+#define REG_TXPKTBUF_BCNQ_BDNY1_8723B 0x0457 -+ -+#define REG_AMPDU_MAX_LENGTH_8723B 0x0458 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8723B 0x045D -+#define REG_NDPA_OPT_CTRL_8723B 0x045F -+#define REG_FAST_EDCA_CTRL_8723B 0x0460 -+#define REG_RD_RESP_PKT_TH_8723B 0x0463 -+#define REG_DATA_SC_8723B 0x0483 -+#define REG_TXRPT_START_OFFSET 0x04AC -+#define REG_POWER_STAGE1_8723B 0x04B4 -+#define REG_POWER_STAGE2_8723B 0x04B8 -+#define REG_AMPDU_BURST_MODE_8723B 0x04BC -+#define REG_PKT_VO_VI_LIFE_TIME_8723B 0x04C0 -+#define REG_PKT_BE_BK_LIFE_TIME_8723B 0x04C2 -+#define REG_STBC_SETTING_8723B 0x04C4 -+#define REG_HT_SINGLE_AMPDU_8723B 0x04C7 -+#define REG_PROT_MODE_CTRL_8723B 0x04C8 -+#define REG_MAX_AGGR_NUM_8723B 0x04CA -+#define REG_RTS_MAX_AGGR_NUM_8723B 0x04CB -+#define REG_BAR_MODE_CTRL_8723B 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8723B 0x04CF -+#define REG_MACID_PKT_DROP0_8723B 0x04D0 -+#define REG_MACID_PKT_SLEEP_8723B 0x04D4 -+ -+/* */ -+/* */ -+/* 0x0500h ~ 0x05FFh EDCA Configuration */ -+/* */ -+/* */ -+#define REG_EDCA_VO_PARAM_8723B 0x0500 -+#define REG_EDCA_VI_PARAM_8723B 0x0504 -+#define REG_EDCA_BE_PARAM_8723B 0x0508 -+#define REG_EDCA_BK_PARAM_8723B 0x050C -+#define REG_BCNTCFG_8723B 0x0510 -+#define REG_PIFS_8723B 0x0512 -+#define REG_RDG_PIFS_8723B 0x0513 -+#define REG_SIFS_CTX_8723B 0x0514 -+#define REG_SIFS_TRX_8723B 0x0516 -+#define REG_AGGR_BREAK_TIME_8723B 0x051A -+#define REG_SLOT_8723B 0x051B -+#define REG_TX_PTCL_CTRL_8723B 0x0520 -+#define REG_TXPAUSE_8723B 0x0522 -+#define REG_DIS_TXREQ_CLR_8723B 0x0523 -+#define REG_RD_CTRL_8723B 0x0524 -+/* */ -+/* Format for offset 540h-542h: */ -+/* [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. */ -+/* [7:4]: Reserved. */ -+/* [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. */ -+/* [23:20]: Reserved */ -+/* Description: */ -+/* | */ -+/* |<--Setup--|--Hold------------>| */ -+/* --------------|---------------------- */ -+/* | */ -+/* TBTT */ -+/* Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. */ -+/* Described by Designer Tim and Bruce, 2011-01-14. */ -+/* */ -+#define REG_TBTT_PROHIBIT_8723B 0x0540 -+#define REG_RD_NAV_NXT_8723B 0x0544 -+#define REG_NAV_PROT_LEN_8723B 0x0546 -+#define REG_BCN_CTRL_8723B 0x0550 -+#define REG_BCN_CTRL_1_8723B 0x0551 -+#define REG_MBID_NUM_8723B 0x0552 -+#define REG_DUAL_TSF_RST_8723B 0x0553 -+#define REG_BCN_INTERVAL_8723B 0x0554 -+#define REG_DRVERLYINT_8723B 0x0558 -+#define REG_BCNDMATIM_8723B 0x0559 -+#define REG_ATIMWND_8723B 0x055A -+#define REG_USTIME_TSF_8723B 0x055C -+#define REG_BCN_MAX_ERR_8723B 0x055D -+#define REG_RXTSF_OFFSET_CCK_8723B 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8723B 0x055F -+#define REG_TSFTR_8723B 0x0560 -+#define REG_CTWND_8723B 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8723B 0x0577 -+#define REG_PSTIMER_8723B 0x0580 -+#define REG_TIMER0_8723B 0x0584 -+#define REG_TIMER1_8723B 0x0588 -+#define REG_ACMHWCTRL_8723B 0x05C0 -+#define REG_SCH_TXCMD_8723B 0x05F8 -+ -+/* 0x0600h ~ 0x07FFh WMAC Configuration */ -+#define REG_MAC_CR_8723B 0x0600 -+#define REG_TCR_8723B 0x0604 -+#define REG_RCR_8723B 0x0608 -+#define REG_RX_PKT_LIMIT_8723B 0x060C -+#define REG_RX_DLK_TIME_8723B 0x060D -+#define REG_RX_DRVINFO_SZ_8723B 0x060F -+ -+#define REG_MACID_8723B 0x0610 -+#define REG_BSSID_8723B 0x0618 -+#define REG_MAR_8723B 0x0620 -+#define REG_MBIDCAMCFG_8723B 0x0628 -+ -+#define REG_USTIME_EDCA_8723B 0x0638 -+#define REG_MAC_SPEC_SIFS_8723B 0x063A -+#define REG_RESP_SIFP_CCK_8723B 0x063C -+#define REG_RESP_SIFS_OFDM_8723B 0x063E -+#define REG_ACKTO_8723B 0x0640 -+#define REG_CTS2TO_8723B 0x0641 -+#define REG_EIFS_8723B 0x0642 -+ -+#define REG_NAV_UPPER_8723B 0x0652 /* unit of 128 */ -+#define REG_TRXPTCL_CTL_8723B 0x0668 -+ -+/* Security */ -+#define REG_CAMCMD_8723B 0x0670 -+#define REG_CAMWRITE_8723B 0x0674 -+#define REG_CAMREAD_8723B 0x0678 -+#define REG_CAMDBG_8723B 0x067C -+#define REG_SECCFG_8723B 0x0680 -+ -+/* Power */ -+#define REG_WOW_CTRL_8723B 0x0690 -+#define REG_PS_RX_INFO_8723B 0x0692 -+#define REG_UAPSD_TID_8723B 0x0693 -+#define REG_WKFMCAM_CMD_8723B 0x0698 -+#define REG_WKFMCAM_NUM_8723B 0x0698 -+#define REG_WKFMCAM_RWD_8723B 0x069C -+#define REG_RXFLTMAP0_8723B 0x06A0 -+#define REG_RXFLTMAP1_8723B 0x06A2 -+#define REG_RXFLTMAP2_8723B 0x06A4 -+#define REG_BCN_PSR_RPT_8723B 0x06A8 -+#define REG_BT_COEX_TABLE_8723B 0x06C0 -+#define REG_BFMER0_INFO_8723B 0x06E4 -+#define REG_BFMER1_INFO_8723B 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8723B 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8723B 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8723B 0x06FC -+ -+/* Hardware Port 2 */ -+#define REG_MACID1_8723B 0x0700 -+#define REG_BSSID1_8723B 0x0708 -+#define REG_BFMEE_SEL_8723B 0x0714 -+#define REG_SND_PTCL_CTRL_8723B 0x0718 -+ -+ -+/* Redifine 8192C register definition for compatibility */ -+ -+/* TODO: use these definition when using REG_xxx naming rule. */ -+/* NOTE: DO NOT Remove these definition. Use later. */ -+#define EFUSE_CTRL_8723B REG_EFUSE_CTRL_8723B /* E-Fuse Control. */ -+#define EFUSE_TEST_8723B REG_EFUSE_TEST_8723B /* E-Fuse Test. */ -+#define MSR_8723B (REG_CR_8723B + 2) /* Media Status register */ -+#define ISR_8723B REG_HISR0_8723B -+#define TSFR_8723B REG_TSFTR_8723B /* Timing Sync Function Timer Register. */ -+ -+#define PBP_8723B REG_PBP_8723B -+ -+/* Redifine MACID register, to compatible prior ICs. */ -+#define IDR0_8723B REG_MACID_8723B /* MAC ID Register, Offset 0x0050-0x0053 */ -+#define IDR4_8723B (REG_MACID_8723B + 4) /* MAC ID Register, Offset 0x0054-0x0055 */ -+ -+/* 9. Security Control Registers (Offset:) */ -+#define RWCAM_8723B REG_CAMCMD_8723B /* IN 8190 Data Sheet is called CAMcmd */ -+#define WCAMI_8723B REG_CAMWRITE_8723B /* Software write CAM input content */ -+#define RCAMO_8723B REG_CAMREAD_8723B /* Software read/write CAM config */ -+#define CAMDBG_8723B REG_CAMDBG_8723B -+#define SECR_8723B REG_SECCFG_8723B /* Security Configuration Register */ -+ -+/* 8195 IMR/ISR bits (offset 0xB0, 8bits) */ -+#define IMR_DISABLED_8723B 0 -+/* IMR DW0(0x00B0-00B3) Bit 0-31 */ -+#define IMR_TIMER2_8723B BIT31 /* Timeout interrupt 2 */ -+#define IMR_TIMER1_8723B BIT30 /* Timeout interrupt 1 */ -+#define IMR_PSTIMEOUT_8723B BIT29 /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_8723B BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_8723B BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TXBCN0ERR_8723B BIT26 /* Transmit Beacon0 Error */ -+#define IMR_TXBCN0OK_8723B BIT25 /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_8723B BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -+#define IMR_BCNDMAINT0_8723B BIT20 /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_8723B BIT16 /* Beacon Queue DMA OK0 */ -+#define IMR_HSISR_IND_ON_INT_8723B BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_8723B BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_8723B BIT12 /* CTWidnow End or ATIM Window End */ -+#define IMR_C2HCMD_8723B BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_8723B BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_8723B BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_8723B BIT7 /* High Queue DMA OK */ -+#define IMR_MGNTDOK_8723B BIT6 /* Management Queue DMA OK */ -+#define IMR_BKDOK_8723B BIT5 /* AC_BK DMA OK */ -+#define IMR_BEDOK_8723B BIT4 /* AC_BE DMA OK */ -+#define IMR_VIDOK_8723B BIT3 /* AC_VI DMA OK */ -+#define IMR_VODOK_8723B BIT2 /* AC_VO DMA OK */ -+#define IMR_RDU_8723B BIT1 /* Rx Descriptor Unavailable */ -+#define IMR_ROK_8723B BIT0 /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_8723B BIT27 /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_8723B BIT26 /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_8723B BIT25 /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_8723B BIT24 /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_8723B BIT23 /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_8723B BIT22 /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_8723B BIT21 /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_8723B BIT20 /* Beacon Queue DMA OK Interrup 7 */ -+#define IMR_BCNDOK6_8723B BIT19 /* Beacon Queue DMA OK Interrup 6 */ -+#define IMR_BCNDOK5_8723B BIT18 /* Beacon Queue DMA OK Interrup 5 */ -+#define IMR_BCNDOK4_8723B BIT17 /* Beacon Queue DMA OK Interrup 4 */ -+#define IMR_BCNDOK3_8723B BIT16 /* Beacon Queue DMA OK Interrup 3 */ -+#define IMR_BCNDOK2_8723B BIT15 /* Beacon Queue DMA OK Interrup 2 */ -+#define IMR_BCNDOK1_8723B BIT14 /* Beacon Queue DMA OK Interrup 1 */ -+#define IMR_ATIMEND_E_8723B BIT13 /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_8723B BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_8723B BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_8723B BIT9 /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_8723B BIT8 /* Receive FIFO Overflow */ -+ -+/* 2 ACMHWCTRL 0x05C0 */ -+#define AcmHw_HwEn_8723B BIT(0) -+#define AcmHw_VoqEn_8723B BIT(1) -+#define AcmHw_ViqEn_8723B BIT(2) -+#define AcmHw_BeqEn_8723B BIT(3) -+#define AcmHw_VoqStatus_8723B BIT(5) -+#define AcmHw_ViqStatus_8723B BIT(6) -+#define AcmHw_BeqStatus_8723B BIT(7) -+ -+/* 8195 (RCR) Receive Configuration Register (Offset 0x608, 32 bits) */ -+#define RCR_TCPOFLD_EN BIT25 /* Enable TCP checksum offload */ -+ -+#endif /* #ifndef __INC_HAL8723BREG_H */ -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalBtc8723b1Ant.c linux/3rdparty/rtl8723bs/hal/HalBtc8723b1Ant.c ---- linux.old/3rdparty/rtl8723bs/hal/HalBtc8723b1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalBtc8723b1Ant.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,3779 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "Mp_Precomp.h" -+ -+/* Global variables, these are static variables */ -+static COEX_DM_8723B_1ANT GLCoexDm8723b1Ant; -+static PCOEX_DM_8723B_1ANT pCoexDm = &GLCoexDm8723b1Ant; -+static COEX_STA_8723B_1ANT GLCoexSta8723b1Ant; -+static PCOEX_STA_8723B_1ANT pCoexSta = &GLCoexSta8723b1Ant; -+ -+static const char *const GLBtInfoSrc8723b1Ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+static u32 GLCoexVerDate8723b1Ant = 20140507; -+static u32 GLCoexVer8723b1Ant = 0x4e; -+ -+/* local function proto type if needed */ -+/* local function start with halbtc8723b1ant_ */ -+static u8 halbtc8723b1ant_BtRssiState( -+ u8 levelNum, u8 rssiThresh, u8 rssiThresh1 -+) -+{ -+ s32 btRssi = 0; -+ u8 btRssiState = pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if (levelNum == 2) { -+ if ( -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW) -+ ) { -+ if (btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) { -+ -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_RSSI_STATE, -+ ("[BTCoex], BT Rssi state switch to High\n") -+ ); -+ } else { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_RSSI_STATE, -+ ("[BTCoex], BT Rssi state stay at Low\n") -+ ); -+ } -+ } else { -+ if (btRssi < rssiThresh) { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_RSSI_STATE, -+ ("[BTCoex], BT Rssi state switch to Low\n") -+ ); -+ } else { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_RSSI_STATE, -+ ("[BTCoex], BT Rssi state stay at High\n") -+ ); -+ } -+ } -+ } else if (levelNum == 3) { -+ if (rssiThresh > rssiThresh1) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_RSSI_STATE, -+ ("[BTCoex], BT Rssi thresh error!!\n") -+ ); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if ( -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW) -+ ) { -+ if (btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_RSSI_STATE, -+ ("[BTCoex], BT Rssi state switch to Medium\n") -+ ); -+ } else { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_RSSI_STATE, -+ ("[BTCoex], BT Rssi state stay at Low\n") -+ ); -+ } -+ } else if ( -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM) -+ ) { -+ if (btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_RSSI_STATE, -+ ("[BTCoex], BT Rssi state switch to High\n") -+ ); -+ } else if (btRssi < rssiThresh) { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_RSSI_STATE, -+ ("[BTCoex], BT Rssi state switch to Low\n") -+ ); -+ } else { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_RSSI_STATE, -+ ("[BTCoex], BT Rssi state stay at Medium\n") -+ ); -+ } -+ } else { -+ if (btRssi < rssiThresh1) { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_RSSI_STATE, -+ ("[BTCoex], BT Rssi state switch to Medium\n") -+ ); -+ } else { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_RSSI_STATE, -+ ("[BTCoex], BT Rssi state stay at High\n") -+ ); -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+static void halbtc8723b1ant_UpdateRaMask( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, u32 disRateMask -+) -+{ -+ pCoexDm->curRaMask = disRateMask; -+ -+ if (bForceExec || (pCoexDm->preRaMask != pCoexDm->curRaMask)) -+ pBtCoexist->fBtcSet( -+ pBtCoexist, -+ BTC_SET_ACT_UPDATE_RAMASK, -+ &pCoexDm->curRaMask -+ ); -+ pCoexDm->preRaMask = pCoexDm->curRaMask; -+} -+ -+static void halbtc8723b1ant_AutoRateFallbackRetry( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, u8 type -+) -+{ -+ bool bWifiUnderBMode = false; -+ -+ pCoexDm->curArfrType = type; -+ -+ if (bForceExec || (pCoexDm->preArfrType != pCoexDm->curArfrType)) { -+ switch (pCoexDm->curArfrType) { -+ case 0: /* normal mode */ -+ pBtCoexist->fBtcWrite4Byte( -+ pBtCoexist, 0x430, pCoexDm->backupArfrCnt1 -+ ); -+ pBtCoexist->fBtcWrite4Byte( -+ pBtCoexist, 0x434, pCoexDm->backupArfrCnt2 -+ ); -+ break; -+ case 1: -+ pBtCoexist->fBtcGet( -+ pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode -+ ); -+ if (bWifiUnderBMode) { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x01010101); -+ } else { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preArfrType = pCoexDm->curArfrType; -+} -+ -+static void halbtc8723b1ant_RetryLimit( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, u8 type -+) -+{ -+ pCoexDm->curRetryLimitType = type; -+ -+ if ( -+ bForceExec || -+ (pCoexDm->preRetryLimitType != pCoexDm->curRetryLimitType) -+ ) { -+ switch (pCoexDm->curRetryLimitType) { -+ case 0: /* normal mode */ -+ pBtCoexist->fBtcWrite2Byte( -+ pBtCoexist, 0x42a, pCoexDm->backupRetryLimit -+ ); -+ break; -+ case 1: /* retry limit =8 */ -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preRetryLimitType = pCoexDm->curRetryLimitType; -+} -+ -+static void halbtc8723b1ant_AmpduMaxTime( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, u8 type -+) -+{ -+ pCoexDm->curAmpduTimeType = type; -+ -+ if ( -+ bForceExec || (pCoexDm->preAmpduTimeType != pCoexDm->curAmpduTimeType) -+ ) { -+ switch (pCoexDm->curAmpduTimeType) { -+ case 0: /* normal mode */ -+ pBtCoexist->fBtcWrite1Byte( -+ pBtCoexist, 0x456, pCoexDm->backupAmpduMaxTime -+ ); -+ break; -+ case 1: /* AMPDU timw = 0x38 * 32us */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preAmpduTimeType = pCoexDm->curAmpduTimeType; -+} -+ -+static void halbtc8723b1ant_LimitedTx( -+ PBTC_COEXIST pBtCoexist, -+ bool bForceExec, -+ u8 raMaskType, -+ u8 arfrType, -+ u8 retryLimitType, -+ u8 ampduTimeType -+) -+{ -+ switch (raMaskType) { -+ case 0: /* normal mode */ -+ halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0); -+ break; -+ case 1: /* disable cck 1/2 */ -+ halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x00000003); -+ break; -+ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ -+ halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8723b1ant_AutoRateFallbackRetry(pBtCoexist, bForceExec, arfrType); -+ halbtc8723b1ant_RetryLimit(pBtCoexist, bForceExec, retryLimitType); -+ halbtc8723b1ant_AmpduMaxTime(pBtCoexist, bForceExec, ampduTimeType); -+} -+ -+static void halbtc8723b1ant_LimitedRx( -+ PBTC_COEXIST pBtCoexist, -+ bool bForceExec, -+ bool bRejApAggPkt, -+ bool bBtCtrlAggBufSize, -+ u8 aggBufSize -+) -+{ -+ bool bRejectRxAgg = bRejApAggPkt; -+ bool bBtCtrlRxAggSize = bBtCtrlAggBufSize; -+ u8 rxAggSize = aggBufSize; -+ -+ /* */ -+ /* Rx Aggregation related setting */ -+ /* */ -+ pBtCoexist->fBtcSet( -+ pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg -+ ); -+ /* decide BT control aggregation buf size or not */ -+ pBtCoexist->fBtcSet( -+ pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize -+ ); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize); -+ /* real update aggregation setting */ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+static void halbtc8723b1ant_QueryBtInfo(PBTC_COEXIST pBtCoexist) -+{ -+ u8 H2C_Parameter[1] = {0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = true; -+ -+ H2C_Parameter[0] |= BIT0; /* trigger */ -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_EXEC, -+ ("[BTCoex], Query Bt Info, FW write 0x61 = 0x%x\n", H2C_Parameter[0]) -+ ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter); -+} -+ -+static void halbtc8723b1ant_MonitorBtCtr(PBTC_COEXIST pBtCoexist) -+{ -+ u32 regHPTxRx, regLPTxRx, u4Tmp; -+ u32 regHPTx = 0, regHPRx = 0, regLPTx = 0, regLPRx = 0; -+ static u8 NumOfBtCounterChk; -+ -+ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ -+ /* if (! (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e) & 0x8)) */ -+ -+ if (pCoexSta->bUnderIps) { -+ pCoexSta->highPriorityTx = 65535; -+ pCoexSta->highPriorityRx = 65535; -+ pCoexSta->lowPriorityTx = 65535; -+ pCoexSta->lowPriorityRx = 65535; -+ return; -+ } -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ if ((pCoexSta->lowPriorityTx >= 1050) && (!pCoexSta->bC2hBtInquiryPage)) -+ pCoexSta->popEventCnt++; -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ( -+ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", -+ regHPRx, -+ regHPTx, -+ regLPRx, -+ regLPTx -+ ) -+ ); -+ -+ /* reset counter */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+ -+ if ((regHPTx == 0) && (regHPRx == 0) && (regLPTx == 0) && (regLPRx == 0)) { -+ NumOfBtCounterChk++; -+ if (NumOfBtCounterChk >= 3) { -+ halbtc8723b1ant_QueryBtInfo(pBtCoexist); -+ NumOfBtCounterChk = 0; -+ } -+ } -+} -+ -+ -+static void halbtc8723b1ant_MonitorWiFiCtr(PBTC_COEXIST pBtCoexist) -+{ -+ s32 wifiRssi = 0; -+ bool bWifiBusy = false, bWifiUnderBMode = false; -+ static u8 nCCKLockCounter = 0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ pBtCoexist->fBtcGet( -+ pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode -+ ); -+ -+ if (pCoexSta->bUnderIps) { -+ pCoexSta->nCRCOK_CCK = 0; -+ pCoexSta->nCRCOK_11g = 0; -+ pCoexSta->nCRCOK_11n = 0; -+ pCoexSta->nCRCOK_11nAgg = 0; -+ -+ pCoexSta->nCRCErr_CCK = 0; -+ pCoexSta->nCRCErr_11g = 0; -+ pCoexSta->nCRCErr_11n = 0; -+ pCoexSta->nCRCErr_11nAgg = 0; -+ } else { -+ pCoexSta->nCRCOK_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf88); -+ pCoexSta->nCRCOK_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf94); -+ pCoexSta->nCRCOK_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf90); -+ pCoexSta->nCRCOK_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfb8); -+ -+ pCoexSta->nCRCErr_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf84); -+ pCoexSta->nCRCErr_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf96); -+ pCoexSta->nCRCErr_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf92); -+ pCoexSta->nCRCErr_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfba); -+ } -+ -+ -+ /* reset counter */ -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x1); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x0); -+ -+ if (bWifiBusy && (wifiRssi >= 30) && !bWifiUnderBMode) { -+ if ( -+ (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_ACL_BUSY) || -+ (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY) || -+ (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_SCO_BUSY) -+ ) { -+ if ( -+ pCoexSta->nCRCOK_CCK > ( -+ pCoexSta->nCRCOK_11g + -+ pCoexSta->nCRCOK_11n + -+ pCoexSta->nCRCOK_11nAgg -+ ) -+ ) { -+ if (nCCKLockCounter < 5) -+ nCCKLockCounter++; -+ } else { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ -+ } else { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ } else { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ -+ if (!pCoexSta->bPreCCKLock) { -+ -+ if (nCCKLockCounter >= 5) -+ pCoexSta->bCCKLock = true; -+ else -+ pCoexSta->bCCKLock = false; -+ } else { -+ if (nCCKLockCounter == 0) -+ pCoexSta->bCCKLock = false; -+ else -+ pCoexSta->bCCKLock = true; -+ } -+ -+ pCoexSta->bPreCCKLock = pCoexSta->bCCKLock; -+ -+ -+} -+ -+static bool halbtc8723b1ant_IsWifiStatusChanged(PBTC_COEXIST pBtCoexist) -+{ -+ static bool bPreWifiBusy = false, bPreUnder4way = false, bPreBtHsOn = false; -+ bool bWifiBusy = false, bUnder4way = false, bBtHsOn = false; -+ bool bWifiConnected = false; -+ -+ pBtCoexist->fBtcGet( -+ pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected -+ ); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet( -+ pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way -+ ); -+ -+ if (bWifiConnected) { -+ if (bWifiBusy != bPreWifiBusy) { -+ bPreWifiBusy = bWifiBusy; -+ return true; -+ } -+ -+ if (bUnder4way != bPreUnder4way) { -+ bPreUnder4way = bUnder4way; -+ return true; -+ } -+ -+ if (bBtHsOn != bPreBtHsOn) { -+ bPreBtHsOn = bBtHsOn; -+ return true; -+ } -+ } -+ -+ return false; -+} -+ -+static void halbtc8723b1ant_UpdateBtLinkInfo(PBTC_COEXIST pBtCoexist) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ bool bBtHsOn = false; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pCoexSta->bScoExist; -+ pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist; -+ pBtLinkInfo->bPanExist = pCoexSta->bPanExist; -+ pBtLinkInfo->bHidExist = pCoexSta->bHidExist; -+ -+ /* work around for HS mode. */ -+ if (bBtHsOn) { -+ pBtLinkInfo->bPanExist = true; -+ pBtLinkInfo->bBtLinkExist = true; -+ } -+ -+ /* check if Sco only */ -+ if ( -+ pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist -+ ) -+ pBtLinkInfo->bScoOnly = true; -+ else -+ pBtLinkInfo->bScoOnly = false; -+ -+ /* check if A2dp only */ -+ if ( -+ !pBtLinkInfo->bScoExist && -+ pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist -+ ) -+ pBtLinkInfo->bA2dpOnly = true; -+ else -+ pBtLinkInfo->bA2dpOnly = false; -+ -+ /* check if Pan only */ -+ if ( -+ !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist -+ ) -+ pBtLinkInfo->bPanOnly = true; -+ else -+ pBtLinkInfo->bPanOnly = false; -+ -+ /* check if Hid only */ -+ if ( -+ !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bHidExist -+ ) -+ pBtLinkInfo->bHidOnly = true; -+ else -+ pBtLinkInfo->bHidOnly = false; -+} -+ -+static u8 halbtc8723b1ant_ActionAlgorithm(PBTC_COEXIST pBtCoexist) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ bool bBtHsOn = false; -+ u8 algorithm = BT_8723B_1ANT_COEX_ALGO_UNDEFINED; -+ u8 numOfDiffProfile = 0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if (!pBtLinkInfo->bBtLinkExist) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], No BT link exists!!!\n") -+ ); -+ return algorithm; -+ } -+ -+ if (pBtLinkInfo->bScoExist) -+ numOfDiffProfile++; -+ if (pBtLinkInfo->bHidExist) -+ numOfDiffProfile++; -+ if (pBtLinkInfo->bPanExist) -+ numOfDiffProfile++; -+ if (pBtLinkInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if (numOfDiffProfile == 1) { -+ if (pBtLinkInfo->bScoExist) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = SCO only\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_SCO; -+ } else { -+ if (pBtLinkInfo->bHidExist) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = HID only\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID; -+ } else if (pBtLinkInfo->bA2dpExist) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = A2DP only\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_A2DP; -+ } else if (pBtLinkInfo->bPanExist) { -+ if (bBtHsOn) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = PAN(HS) only\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = PAN(EDR) only\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (numOfDiffProfile == 2) { -+ if (pBtLinkInfo->bScoExist) { -+ if (pBtLinkInfo->bHidExist) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = SCO + HID\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID; -+ } else if (pBtLinkInfo->bA2dpExist) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = SCO + A2DP ==> SCO\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_SCO; -+ } else if (pBtLinkInfo->bPanExist) { -+ if (bBtHsOn) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = SCO + PAN(HS)\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = SCO + PAN(EDR)\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (pBtLinkInfo->bHidExist && pBtLinkInfo->bA2dpExist) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = HID + A2DP\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP; -+ } else if (pBtLinkInfo->bHidExist && pBtLinkInfo->bPanExist) { -+ if (bBtHsOn) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = HID + PAN(HS)\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = HID + PAN(EDR)\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (pBtLinkInfo->bPanExist && pBtLinkInfo->bA2dpExist) { -+ if (bBtHsOn) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = A2DP + PAN(HS)\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = A2DP + PAN(EDR)\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (numOfDiffProfile == 3) { -+ if (pBtLinkInfo->bScoExist) { -+ if (pBtLinkInfo->bHidExist && pBtLinkInfo->bA2dpExist) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID; -+ } else if ( -+ pBtLinkInfo->bHidExist && pBtLinkInfo->bPanExist -+ ) { -+ if (bBtHsOn) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BT Profile = SCO + HID + PAN(HS)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (pBtLinkInfo->bPanExist && pBtLinkInfo->bA2dpExist) { -+ if (bBtHsOn) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if ( -+ pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist -+ ) { -+ if (bBtHsOn) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (numOfDiffProfile >= 3) { -+ if (pBtLinkInfo->bScoExist) { -+ if ( -+ pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist -+ ) { -+ if (bBtHsOn) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n") -+ ); -+ -+ } else { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR) ==>PAN(EDR)+HID\n") -+ ); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+static void halbtc8723b1ant_SetSwPenaltyTxRateAdaptive( -+ PBTC_COEXIST pBtCoexist, bool bLowPenaltyRa -+) -+{ -+ u8 H2C_Parameter[6] = {0}; -+ -+ H2C_Parameter[0] = 0x6; /* opCode, 0x6 = Retry_Penalty */ -+ -+ if (bLowPenaltyRa) { -+ H2C_Parameter[1] |= BIT0; -+ H2C_Parameter[2] = 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ H2C_Parameter[3] = 0xf7; /* MCS7 or OFDM54 */ -+ H2C_Parameter[4] = 0xf8; /* MCS6 or OFDM48 */ -+ H2C_Parameter[5] = 0xf9; /* MCS5 or OFDM36 */ -+ } -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_EXEC, -+ ( -+ "[BTCoex], set WiFi Low-Penalty Retry: %s", -+ (bLowPenaltyRa ? "ON!!" : "OFF!!") -+ ) -+ ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter); -+} -+ -+static void halbtc8723b1ant_LowPenaltyRa( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, bool bLowPenaltyRa -+) -+{ -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if (!bForceExec) { -+ if (pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8723b1ant_SetSwPenaltyTxRateAdaptive( -+ pBtCoexist, pCoexDm->bCurLowPenaltyRa -+ ); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+static void halbtc8723b1ant_SetCoexTable( -+ PBTC_COEXIST pBtCoexist, -+ u32 val0x6c0, -+ u32 val0x6c4, -+ u32 val0x6c8, -+ u8 val0x6cc -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_EXEC, -+ ("[BTCoex], set coex table, set 0x6c0 = 0x%x\n", val0x6c0) -+ ); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_EXEC, -+ ("[BTCoex], set coex table, set 0x6c4 = 0x%x\n", val0x6c4) -+ ); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_EXEC, -+ ("[BTCoex], set coex table, set 0x6c8 = 0x%x\n", val0x6c8) -+ ); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_EXEC, -+ ("[BTCoex], set coex table, set 0x6cc = 0x%x\n", val0x6cc) -+ ); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+static void halbtc8723b1ant_CoexTable( -+ PBTC_COEXIST pBtCoexist, -+ bool bForceExec, -+ u32 val0x6c0, -+ u32 val0x6c4, -+ u32 val0x6c8, -+ u8 val0x6cc -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW, -+ ( -+ "[BTCoex], %s write Coex Table 0x6c0 = 0x%x, 0x6c4 = 0x%x, 0x6cc = 0x%x\n", -+ (bForceExec ? "force to" : ""), -+ val0x6c0, val0x6c4, val0x6cc -+ ) -+ ); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if (!bForceExec) { -+ if ( -+ (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) -+ ) -+ return; -+ } -+ -+ halbtc8723b1ant_SetCoexTable( -+ pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc -+ ); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+static void halbtc8723b1ant_CoexTableWithType( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, u8 type -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], ********** CoexTable(%d) **********\n", type) -+ ); -+ -+ pCoexSta->nCoexTableType = type; -+ -+ switch (type) { -+ case 0: -+ halbtc8723b1ant_CoexTable( -+ pBtCoexist, bForceExec, 0x55555555, 0x55555555, 0xffffff, 0x3 -+ ); -+ break; -+ case 1: -+ halbtc8723b1ant_CoexTable( -+ pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3 -+ ); -+ break; -+ case 2: -+ halbtc8723b1ant_CoexTable( -+ pBtCoexist, bForceExec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3 -+ ); -+ break; -+ case 3: -+ halbtc8723b1ant_CoexTable( -+ pBtCoexist, bForceExec, 0xaaaa5555, 0xaaaa5a5a, 0xffffff, 0x3 -+ ); -+ break; -+ case 4: -+ halbtc8723b1ant_CoexTable( -+ pBtCoexist, bForceExec, 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3 -+ ); -+ break; -+ case 5: -+ halbtc8723b1ant_CoexTable( -+ pBtCoexist, bForceExec, 0x5a5a5a5a, 0xaaaa5a5a, 0xffffff, 0x3 -+ ); -+ break; -+ case 6: -+ halbtc8723b1ant_CoexTable( -+ pBtCoexist, bForceExec, 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3 -+ ); -+ break; -+ case 7: -+ halbtc8723b1ant_CoexTable( -+ pBtCoexist, bForceExec, 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3 -+ ); -+ break; -+ default: -+ break; -+ } -+} -+ -+static void halbtc8723b1ant_SetFwIgnoreWlanAct( -+ PBTC_COEXIST pBtCoexist, bool bEnable -+) -+{ -+ u8 H2C_Parameter[1] = {0}; -+ -+ if (bEnable) -+ H2C_Parameter[0] |= BIT0; /* function enable */ -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_EXEC, -+ ( -+ "[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63 = 0x%x\n", -+ H2C_Parameter[0] -+ ) -+ ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter); -+} -+ -+static void halbtc8723b1ant_IgnoreWlanAct( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, bool bEnable -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW, -+ ( -+ "[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec ? "force to" : ""), -+ (bEnable ? "ON" : "OFF") -+ ) -+ ); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if (!bForceExec) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_DETAIL, -+ ( -+ "[BTCoex], bPreIgnoreWlanAct = %d, bCurIgnoreWlanAct = %d!!\n", -+ pCoexDm->bPreIgnoreWlanAct, -+ pCoexDm->bCurIgnoreWlanAct -+ ) -+ ); -+ -+ if (pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8723b1ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+static void halbtc8723b1ant_SetLpsRpwm( -+ PBTC_COEXIST pBtCoexist, u8 lpsVal, u8 rpwmVal -+) -+{ -+ u8 lps = lpsVal; -+ u8 rpwm = rpwmVal; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+static void halbtc8723b1ant_LpsRpwm( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, u8 lpsVal, u8 rpwmVal -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW, -+ ( -+ "[BTCoex], %s set lps/rpwm = 0x%x/0x%x\n", -+ (bForceExec ? "force to" : ""), -+ lpsVal, -+ rpwmVal -+ ) -+ ); -+ pCoexDm->curLps = lpsVal; -+ pCoexDm->curRpwm = rpwmVal; -+ -+ if (!bForceExec) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_DETAIL, -+ ( -+ "[BTCoex], LPS-RxBeaconMode = 0x%x , LPS-RPWM = 0x%x!!\n", -+ pCoexDm->curLps, -+ pCoexDm->curRpwm -+ ) -+ ); -+ -+ if ( -+ (pCoexDm->preLps == pCoexDm->curLps) && -+ (pCoexDm->preRpwm == pCoexDm->curRpwm) -+ ) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_DETAIL, -+ ( -+ "[BTCoex], LPS-RPWM_Last = 0x%x , LPS-RPWM_Now = 0x%x!!\n", -+ pCoexDm->preRpwm, -+ pCoexDm->curRpwm -+ ) -+ ); -+ -+ return; -+ } -+ } -+ halbtc8723b1ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal); -+ -+ pCoexDm->preLps = pCoexDm->curLps; -+ pCoexDm->preRpwm = pCoexDm->curRpwm; -+} -+ -+static void halbtc8723b1ant_SwMechanism( -+ PBTC_COEXIST pBtCoexist, bool bLowPenaltyRA -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_MONITOR, -+ ("[BTCoex], SM[LpRA] = %d\n", bLowPenaltyRA) -+ ); -+ -+ halbtc8723b1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA); -+} -+ -+static void halbtc8723b1ant_SetAntPath( -+ PBTC_COEXIST pBtCoexist, u8 antPosType, bool bInitHwCfg, bool bWifiOff -+) -+{ -+ PBTC_BOARD_INFO pBoardInfo = &pBtCoexist->boardInfo; -+ u32 fwVer = 0, u4Tmp = 0, cntBtCalChk = 0; -+ bool bPgExtSwitch = false; -+ bool bUseExtSwitch = false; -+ bool bIsInMpMode = false; -+ u8 H2C_Parameter[2] = {0}, u1Tmp = 0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_EXT_SWITCH, &bPgExtSwitch); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); /* [31:16]=fw ver, [15:0]=fw sub ver */ -+ -+ if ((fwVer > 0 && fwVer < 0xc0000) || bPgExtSwitch) -+ bUseExtSwitch = true; -+ -+ if (bInitHwCfg) { -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); /* WiFi TRx Mask on */ -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); /* BT TRx Mask on */ -+ -+ if (fwVer >= 0x180000) { -+ /* Use H2C to set GNT_BT to HIGH */ -+ H2C_Parameter[0] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } else /* set grant_bt to high */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ -+ /* set wlan_act control by PTA */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); /* BT select s0/s1 is controlled by WiFi */ -+ -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x39, 0x8, 0x1); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x974, 0xff); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x944, 0x3, 0x3); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x930, 0x77); -+ } else if (bWifiOff) { -+ if (fwVer >= 0x180000) { -+ /* Use H2C to set GNT_BT to HIGH */ -+ H2C_Parameter[0] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } else /* set grant_bt to high */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ -+ /* set wlan_act to always low */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, &bIsInMpMode); -+ if (!bIsInMpMode) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x0); /* BT select s0/s1 is controlled by BT */ -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); /* BT select s0/s1 is controlled by WiFi */ -+ -+ /* 0x4c[24:23]= 00, Set Antenna control by BT_RFE_CTRL BT Vendor 0xac = 0xf002 */ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp &= ~BIT23; -+ u4Tmp &= ~BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ } else { -+ /* Use H2C to set GNT_BT to LOW */ -+ if (fwVer >= 0x180000) { -+ if (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765) != 0) { -+ H2C_Parameter[0] = 0; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } -+ } else { -+ /* BT calibration check */ -+ while (cntBtCalChk <= 20) { -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49d); -+ cntBtCalChk++; -+ -+ if (u1Tmp & BIT0) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ########### BT is calibrating (wait cnt =%d) ###########\n", cntBtCalChk)); -+ mdelay(50); -+ } else { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ********** BT is NOT calibrating (wait cnt =%d)**********\n", cntBtCalChk)); -+ break; -+ } -+ } -+ -+ /* set grant_bt to PTA */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x0); -+ } -+ -+ if (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e) != 0xc) -+ /* set wlan_act control by PTA */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+ } -+ -+ if (bUseExtSwitch) { -+ if (bInitHwCfg) { -+ /* 0x4c[23]= 0, 0x4c[24]= 1 Antenna control by WL/BT */ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp &= ~BIT23; -+ u4Tmp |= BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); /* fixed internal switch S1->WiFi, S0->BT */ -+ -+ if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) { -+ /* tell firmware "no antenna inverse" */ -+ H2C_Parameter[0] = 0; -+ H2C_Parameter[1] = 1; /* ext switch type */ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } else { -+ /* tell firmware "antenna inverse" */ -+ H2C_Parameter[0] = 1; -+ H2C_Parameter[1] = 1; /* ext switch type */ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } -+ } -+ -+ -+ /* ext switch setting */ -+ switch (antPosType) { -+ case BTC_ANT_PATH_WIFI: -+ if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1); -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2); -+ break; -+ case BTC_ANT_PATH_BT: -+ if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2); -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1); -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2); -+ break; -+ } -+ -+ } else { -+ if (bInitHwCfg) { -+ /* 0x4c[23]= 1, 0x4c[24]= 0 Antenna control by 0x64 */ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp |= BIT23; -+ u4Tmp &= ~BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ -+ /* Fix Ext switch Main->S1, Aux->S0 */ -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x64, 0x1, 0x0); -+ -+ if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) { -+ -+ /* tell firmware "no antenna inverse" */ -+ H2C_Parameter[0] = 0; -+ H2C_Parameter[1] = 0; /* internal switch type */ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } else { -+ -+ /* tell firmware "antenna inverse" */ -+ H2C_Parameter[0] = 1; -+ H2C_Parameter[1] = 0; /* internal switch type */ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } -+ } -+ -+ -+ /* internal switch setting */ -+ switch (antPosType) { -+ case BTC_ANT_PATH_WIFI: -+ if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ else -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280); -+ break; -+ case BTC_ANT_PATH_BT: -+ if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280); -+ else -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x200); -+ else -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x80); -+ break; -+ } -+ } -+} -+ -+static void halbtc8723b1ant_SetFwPstdma( -+ PBTC_COEXIST pBtCoexist, u8 byte1, u8 byte2, u8 byte3, u8 byte4, u8 byte5 -+) -+{ -+ u8 H2C_Parameter[5] = {0}; -+ u8 realByte1 = byte1, realByte5 = byte5; -+ bool bApEnable = false; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ if (bApEnable) { -+ if (byte1&BIT4 && !(byte1&BIT5)) { -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, -+ INTF_NOTIFY, -+ ("[BTCoex], FW for 1Ant AP mode\n") -+ ); -+ realByte1 &= ~BIT4; -+ realByte1 |= BIT5; -+ -+ realByte5 |= BIT5; -+ realByte5 &= ~BIT6; -+ } -+ } -+ -+ H2C_Parameter[0] = realByte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = realByte5; -+ -+ pCoexDm->psTdmaPara[0] = realByte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = realByte5; -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_EXEC, -+ ( -+ "[BTCoex], PS-TDMA H2C cmd = 0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24| -+ H2C_Parameter[2]<<16| -+ H2C_Parameter[3]<<8| -+ H2C_Parameter[4] -+ ) -+ ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter); -+} -+ -+ -+static void halbtc8723b1ant_PsTdma( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, bool bTurnOn, u8 type -+) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ bool bWifiBusy = false; -+ u8 rssiAdjustVal = 0; -+ u8 psTdmaByte4Val = 0x50, psTdmaByte0Val = 0x51, psTdmaByte3Val = 0x10; -+ s8 nWiFiDurationAdjust = 0x0; -+ /* u32 fwVer = 0; */ -+ -+ /* BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW, ("[BTCoex], %s turn %s PS TDMA, type =%d\n", */ -+ /* (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); */ -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if (pCoexDm->bCurPsTdmaOn) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ( -+ "[BTCoex], ********** TDMA(on, %d) **********\n", -+ pCoexDm->curPsTdma -+ ) -+ ); -+ } else { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ( -+ "[BTCoex], ********** TDMA(off, %d) **********\n", -+ pCoexDm->curPsTdma -+ ) -+ ); -+ } -+ -+ if (!bForceExec) { -+ if ( -+ (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) -+ ) -+ return; -+ } -+ -+ if (pCoexSta->nScanAPNum <= 5) -+ nWiFiDurationAdjust = 5; -+ else if (pCoexSta->nScanAPNum >= 40) -+ nWiFiDurationAdjust = -15; -+ else if (pCoexSta->nScanAPNum >= 20) -+ nWiFiDurationAdjust = -10; -+ -+ if (!pCoexSta->bForceLpsOn) { /* only for A2DP-only case 1/2/9/11 */ -+ psTdmaByte0Val = 0x61; /* no null-pkt */ -+ psTdmaByte3Val = 0x11; /* no tx-pause at BT-slot */ -+ psTdmaByte4Val = 0x10; /* 0x778 = d/1 toggle */ -+ } -+ -+ -+ if (bTurnOn) { -+ if (pBtLinkInfo->bSlaveRole == true) -+ psTdmaByte4Val = psTdmaByte4Val | 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -+ -+ -+ switch (type) { -+ default: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x51, 0x1a, 0x1a, 0x0, psTdmaByte4Val -+ ); -+ break; -+ case 1: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, -+ psTdmaByte0Val, -+ 0x3a+nWiFiDurationAdjust, -+ 0x03, -+ psTdmaByte3Val, -+ psTdmaByte4Val -+ ); -+ break; -+ case 2: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, -+ psTdmaByte0Val, -+ 0x2d+nWiFiDurationAdjust, -+ 0x03, -+ psTdmaByte3Val, -+ psTdmaByte4Val -+ ); -+ break; -+ case 3: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x51, 0x1d, 0x1d, 0x0, 0x10 -+ ); -+ break; -+ case 4: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x93, 0x15, 0x3, 0x14, 0x0 -+ ); -+ break; -+ case 5: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x61, 0x15, 0x3, 0x11, 0x10 -+ ); -+ break; -+ case 6: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x61, 0x20, 0x3, 0x11, 0x11 -+ ); -+ break; -+ case 7: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xc, 0x5, 0x0, 0x0); -+ break; -+ case 8: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0 -+ ); -+ break; -+ case 9: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, -+ psTdmaByte0Val, -+ 0x21, -+ 0x3, -+ psTdmaByte3Val, -+ psTdmaByte4Val -+ ); -+ break; -+ case 10: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 11: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, -+ psTdmaByte0Val, -+ 0x21, -+ 0x03, -+ psTdmaByte3Val, -+ psTdmaByte4Val -+ ); -+ break; -+ case 12: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x51, 0x0a, 0x0a, 0x0, 0x50 -+ ); -+ break; -+ case 13: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x51, 0x12, 0x12, 0x0, 0x10 -+ ); -+ break; -+ case 14: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x51, 0x21, 0x3, 0x10, psTdmaByte4Val -+ ); -+ break; -+ case 15: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x13, 0xa, 0x3, 0x8, 0x0 -+ ); -+ break; -+ case 16: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x93, 0x15, 0x3, 0x10, 0x0 -+ ); -+ break; -+ case 18: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0 -+ ); -+ break; -+ case 20: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x61, 0x3f, 0x03, 0x11, 0x10 -+ -+ ); -+ break; -+ case 21: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x11 -+ ); -+ break; -+ case 22: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x10 -+ ); -+ break; -+ case 23: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x18 -+ ); -+ break; -+ case 24: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0xe3, 0x15, 0x3, 0x31, 0x18 -+ ); -+ break; -+ case 25: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18 -+ ); -+ break; -+ case 26: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18 -+ ); -+ break; -+ case 27: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x98 -+ ); -+ break; -+ case 28: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x69, 0x25, 0x3, 0x31, 0x0 -+ ); -+ break; -+ case 29: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0xab, 0x1a, 0x1a, 0x1, 0x10 -+ ); -+ break; -+ case 30: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x51, 0x30, 0x3, 0x10, 0x10 -+ ); -+ break; -+ case 31: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0xd3, 0x1a, 0x1a, 0x0, 0x58 -+ ); -+ break; -+ case 32: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x61, 0x35, 0x3, 0x11, 0x11 -+ ); -+ break; -+ case 33: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0xa3, 0x25, 0x3, 0x30, 0x90 -+ ); -+ break; -+ case 34: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x53, 0x1a, 0x1a, 0x0, 0x10 -+ ); -+ break; -+ case 35: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x63, 0x1a, 0x1a, 0x0, 0x10 -+ ); -+ break; -+ case 36: -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0xd3, 0x12, 0x3, 0x14, 0x50 -+ ); -+ break; -+ case 40: /* SoftAP only with no sta associated, BT disable , TDMA mode for power saving */ -+ /* here softap mode screen off will cost 70-80mA for phone */ -+ halbtc8723b1ant_SetFwPstdma( -+ pBtCoexist, 0x23, 0x18, 0x00, 0x10, 0x24 -+ ); -+ break; -+ } -+ } else { -+ -+ /* disable PS tdma */ -+ switch (type) { -+ case 8: /* PTA Control */ -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x8, 0x0, 0x0, 0x0, 0x0); -+ halbtc8723b1ant_SetAntPath( -+ pBtCoexist, BTC_ANT_PATH_PTA, false, false -+ ); -+ break; -+ case 0: -+ default: /* Software control, Antenna at BT side */ -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ halbtc8723b1ant_SetAntPath( -+ pBtCoexist, BTC_ANT_PATH_BT, false, false -+ ); -+ break; -+ case 9: /* Software control, Antenna at WiFi side */ -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ halbtc8723b1ant_SetAntPath( -+ pBtCoexist, BTC_ANT_PATH_WIFI, false, false -+ ); -+ break; -+ } -+ } -+ -+ rssiAdjustVal = 0; -+ pBtCoexist->fBtcSet( -+ pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssiAdjustVal -+ ); -+ -+ /* update pre state */ -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+static bool halbtc8723b1ant_IsCommonAction(PBTC_COEXIST pBtCoexist) -+{ -+ bool bCommon = false, bWifiConnected = false, bWifiBusy = false; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if ( -+ !bWifiConnected && -+ BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus -+ ) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n") -+ ); -+ -+ /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */ -+ -+ bCommon = true; -+ } else if ( -+ bWifiConnected && -+ (BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) -+ ) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], Wifi connected + BT non connected-idle!!\n") -+ ); -+ -+ /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */ -+ -+ bCommon = true; -+ } else if ( -+ !bWifiConnected && -+ (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) -+ ) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], Wifi non connected-idle + BT connected-idle!!\n") -+ ); -+ -+ /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */ -+ -+ bCommon = true; -+ } else if ( -+ bWifiConnected && -+ (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) -+ ) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Wifi connected + BT connected-idle!!\n")); -+ -+ /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */ -+ -+ bCommon = true; -+ } else if ( -+ !bWifiConnected && -+ (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) -+ ) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], Wifi non connected-idle + BT Busy!!\n") -+ ); -+ -+ /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */ -+ -+ bCommon = true; -+ } else { -+ if (bWifiBusy) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n") -+ ); -+ } else { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n") -+ ); -+ } -+ -+ bCommon = false; -+ } -+ -+ return bCommon; -+} -+ -+ -+static void halbtc8723b1ant_TdmaDurationAdjustForAcl( -+ PBTC_COEXIST pBtCoexist, u8 wifiStatus -+) -+{ -+ static s32 up, dn, m, n, WaitCount; -+ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ -+ u8 retryCount = 0, btInfoExt; -+ bool bWifiBusy = false; -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW, -+ ("[BTCoex], TdmaDurationAdjustForAcl()\n") -+ ); -+ -+ if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifiStatus) -+ bWifiBusy = true; -+ else -+ bWifiBusy = false; -+ -+ if ( -+ (BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == wifiStatus) || -+ (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifiStatus) || -+ (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT == wifiStatus) -+ ) { -+ if ( -+ pCoexDm->curPsTdma != 1 && -+ pCoexDm->curPsTdma != 2 && -+ pCoexDm->curPsTdma != 3 && -+ pCoexDm->curPsTdma != 9 -+ ) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ return; -+ } -+ -+ if (!pCoexDm->bAutoTdmaAdjust) { -+ pCoexDm->bAutoTdmaAdjust = true; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_DETAIL, -+ ("[BTCoex], first run TdmaDurationAdjust()!!\n") -+ ); -+ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ /* */ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ WaitCount = 0; -+ } else { -+ /* accquire the BT TRx retry count from BT_Info byte2 */ -+ retryCount = pCoexSta->btRetryCnt; -+ btInfoExt = pCoexSta->btInfoExt; -+ /* BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], retryCount = %d\n", retryCount)); */ -+ /* BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], up =%d, dn =%d, m =%d, n =%d, WaitCount =%d\n", */ -+ /* up, dn, m, n, WaitCount)); */ -+ -+ if (pCoexSta->lowPriorityTx > 1050 || pCoexSta->lowPriorityRx > 1250) -+ retryCount++; -+ -+ result = 0; -+ WaitCount++; -+ -+ if (retryCount == 0) { /* no retry in the last 2-second duration */ -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if (up >= n) { /* if 連續 n 個2秒 retry count為0, 則調寬WiFi duration */ -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_DETAIL, -+ ("[BTCoex], Increase wifi duration!!\n") -+ ); -+ } -+ } else if (retryCount <= 3) { /* <=3 retry in the last 2-second duration */ -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) { /* if 連續 2 個2秒 retry count< 3, 則調窄WiFi duration */ -+ if (WaitCount <= 2) -+ m++; /* 避免一直在兩個level中來回 */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* m 最大值 = 20 ' 最大120秒 recheck是否調整 WiFi duration. */ -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } else { /* retry count > 3, 只要1次 retry count > 3, 則調窄WiFi duration */ -+ if (WaitCount == 1) -+ m++; /* 避免一直在兩個level中來回 */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* m 最大值 = 20 ' 最大120秒 recheck是否調整 WiFi duration. */ -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_DETAIL, -+ ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n") -+ ); -+ } -+ -+ if (result == -1) { -+ if ( -+ BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(btInfoExt) && -+ ((pCoexDm->curPsTdma == 1) || (pCoexDm->curPsTdma == 2)) -+ ) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } else if (pCoexDm->curPsTdma == 1) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } else if (pCoexDm->curPsTdma == 2) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } else if (pCoexDm->curPsTdma == 9) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } else if (result == 1) { -+ if ( -+ BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(btInfoExt) && -+ ((pCoexDm->curPsTdma == 1) || (pCoexDm->curPsTdma == 2)) -+ ) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } else if (pCoexDm->curPsTdma == 11) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } else if (pCoexDm->curPsTdma == 9) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } else if (pCoexDm->curPsTdma == 2) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ } else { /* no change */ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_DETAIL, -+ ( -+ "[BTCoex], ********** TDMA(on, %d) **********\n", -+ pCoexDm->curPsTdma -+ ) -+ ); -+ } -+ -+ if ( -+ pCoexDm->curPsTdma != 1 && -+ pCoexDm->curPsTdma != 2 && -+ pCoexDm->curPsTdma != 9 && -+ pCoexDm->curPsTdma != 11 -+ ) /* recover to previous adjust type */ -+ halbtc8723b1ant_PsTdma( -+ pBtCoexist, NORMAL_EXEC, true, pCoexDm->psTdmaDuAdjType -+ ); -+ } -+} -+ -+static void halbtc8723b1ant_PsTdmaCheckForPowerSaveState( -+ PBTC_COEXIST pBtCoexist, bool bNewPsState -+) -+{ -+ u8 lpsMode = 0x0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode); -+ -+ if (lpsMode) { /* already under LPS state */ -+ if (bNewPsState) { -+ /* keep state under LPS, do nothing. */ -+ } else /* will leave LPS state, turn off psTdma first */ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 0); -+ } else { /* NO PS state */ -+ if (bNewPsState) /* will enter LPS state, turn off psTdma first */ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 0); -+ else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+static void halbtc8723b1ant_PowerSaveState( -+ PBTC_COEXIST pBtCoexist, u8 psType, u8 lpsVal, u8 rpwmVal -+) -+{ -+ bool bLowPwrDisable = false; -+ -+ switch (psType) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ bLowPwrDisable = false; -+ pBtCoexist->fBtcSet( -+ pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable -+ ); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ pCoexSta->bForceLpsOn = false; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8723b1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, true); -+ halbtc8723b1ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ bLowPwrDisable = true; -+ pBtCoexist->fBtcSet( -+ pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable -+ ); -+ /* power save must executed before psTdma. */ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); -+ pCoexSta->bForceLpsOn = true; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8723b1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, false); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pCoexSta->bForceLpsOn = false; -+ break; -+ default: -+ break; -+ } -+} -+ -+/* */ -+/* */ -+/* Software Coex Mechanism start */ -+/* */ -+/* */ -+ -+/* */ -+/* */ -+/* Non-Software Coex Mechanism start */ -+/* */ -+/* */ -+static void halbtc8723b1ant_ActionWifiMultiPort(PBTC_COEXIST pBtCoexist) -+{ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+} -+ -+static void halbtc8723b1ant_ActionHs(PBTC_COEXIST pBtCoexist) -+{ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 5); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+} -+ -+static void halbtc8723b1ant_ActionBtInquiry(PBTC_COEXIST pBtCoexist) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ bool bWifiConnected = false; -+ bool bApEnable = false; -+ bool bWifiBusy = false; -+ bool bBtBusy = false; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ if (!bWifiConnected && !pCoexSta->bWiFiIsHighPriTask) { -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } else if ( -+ pBtLinkInfo->bScoExist || -+ pBtLinkInfo->bHidExist || -+ pBtLinkInfo->bA2dpExist -+ ) { -+ /* SCO/HID/A2DP busy */ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32); -+ -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } else if (pBtLinkInfo->bPanExist || bWifiBusy) { -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20); -+ -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+} -+ -+static void halbtc8723b1ant_ActionBtScoHidOnlyBusy( -+ PBTC_COEXIST pBtCoexist, u8 wifiStatus -+) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ bool bWifiConnected = false; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ /* tdma and coex table */ -+ -+ if (pBtLinkInfo->bScoExist) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 5); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } else { /* HID */ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 6); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+} -+ -+static void halbtc8723b1ant_ActionWifiConnectedBtAclBusy( -+ PBTC_COEXIST pBtCoexist, u8 wifiStatus -+) -+{ -+ u8 btRssiState; -+ -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ btRssiState = halbtc8723b1ant_BtRssiState(2, 28, 0); -+ -+ if ((pCoexSta->lowPriorityRx >= 1000) && (pCoexSta->lowPriorityRx != 65535)) -+ pBtLinkInfo->bSlaveRole = true; -+ else -+ pBtLinkInfo->bSlaveRole = false; -+ -+ if (pBtLinkInfo->bHidOnly) { /* HID */ -+ halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, wifiStatus); -+ pCoexDm->bAutoTdmaAdjust = false; -+ return; -+ } else if (pBtLinkInfo->bA2dpOnly) { /* A2DP */ -+ if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifiStatus) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = false; -+ } else { -+ halbtc8723b1ant_TdmaDurationAdjustForAcl(pBtCoexist, wifiStatus); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = true; -+ } -+ } else if (pBtLinkInfo->bHidExist && pBtLinkInfo->bA2dpExist) { /* HID+A2DP */ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 14); -+ pCoexDm->bAutoTdmaAdjust = false; -+ -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } else if ( -+ pBtLinkInfo->bPanOnly || -+ (pBtLinkInfo->bHidExist && pBtLinkInfo->bPanExist) -+ ) { /* PAN(OPP, FTP), HID+PAN(OPP, FTP) */ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = false; -+ } else if ( -+ (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) || -+ (pBtLinkInfo->bHidExist && pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) -+ ) { /* A2DP+PAN(OPP, FTP), HID+A2DP+PAN(OPP, FTP) */ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 13); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = false; -+ } else { -+ /* BT no-profile busy (0x9) */ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = false; -+ } -+} -+ -+static void halbtc8723b1ant_ActionWifiNotConnected(PBTC_COEXIST pBtCoexist) -+{ -+ /* power save state */ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ /* tdma and coex table */ -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 8); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+static void halbtc8723b1ant_ActionWifiNotConnectedScan( -+ PBTC_COEXIST pBtCoexist -+) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ /* tdma and coex table */ -+ if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) { -+ if (pBtLinkInfo->bA2dpExist) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 22); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ } else if ( -+ (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) -+ ) { -+ halbtc8723b1ant_ActionBtScoHidOnlyBusy( -+ pBtCoexist, BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN -+ ); -+ } else { -+ /* Bryant Add */ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+static void halbtc8723b1ant_ActionWifiNotConnectedAssoAuth( -+ PBTC_COEXIST pBtCoexist -+) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ /* tdma and coex table */ -+ if ( -+ (pBtLinkInfo->bScoExist) || -+ (pBtLinkInfo->bHidExist) || -+ (pBtLinkInfo->bA2dpExist) -+ ) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } else if (pBtLinkInfo->bPanExist) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+static void halbtc8723b1ant_ActionWifiConnectedScan(PBTC_COEXIST pBtCoexist) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ /* tdma and coex table */ -+ if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) { -+ if (pBtLinkInfo->bA2dpExist) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 22); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ } else if ( -+ (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) -+ ) { -+ halbtc8723b1ant_ActionBtScoHidOnlyBusy( -+ pBtCoexist, BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN -+ ); -+ } else { -+ /* Bryant Add */ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+static void halbtc8723b1ant_ActionWifiConnectedSpecialPacket( -+ PBTC_COEXIST pBtCoexist -+) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ /* tdma and coex table */ -+ if ( -+ (pBtLinkInfo->bScoExist) || -+ (pBtLinkInfo->bHidExist) || -+ (pBtLinkInfo->bA2dpExist) -+ ) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } else if (pBtLinkInfo->bPanExist) { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+static void halbtc8723b1ant_ActionWifiConnected(PBTC_COEXIST pBtCoexist) -+{ -+ bool bWifiBusy = false; -+ bool bScan = false, bLink = false, bRoam = false; -+ bool bUnder4way = false, bApEnable = false; -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], CoexForWifiConnect() ===>\n") -+ ); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ if (bUnder4way) { -+ halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n") -+ ); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ if (bScan || bLink || bRoam) { -+ if (bScan) -+ halbtc8723b1ant_ActionWifiConnectedScan(pBtCoexist); -+ else -+ halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n") -+ ); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ /* power save state */ -+ if ( -+ !bApEnable && -+ BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus && -+ !pBtCoexist->btLinkInfo.bHidOnly -+ ) { -+ if (pBtCoexist->btLinkInfo.bA2dpOnly) { /* A2DP */ -+ if (!bWifiBusy) -+ halbtc8723b1ant_PowerSaveState( -+ pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0 -+ ); -+ else { /* busy */ -+ if (pCoexSta->nScanAPNum >= BT_8723B_1ANT_WIFI_NOISY_THRESH) /* no force LPS, no PS-TDMA, use pure TDMA */ -+ halbtc8723b1ant_PowerSaveState( -+ pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0 -+ ); -+ else -+ halbtc8723b1ant_PowerSaveState( -+ pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4 -+ ); -+ } -+ } else if ( -+ (pCoexSta->bPanExist == false) && -+ (pCoexSta->bA2dpExist == false) && -+ (pCoexSta->bHidExist == false) -+ ) -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } else -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ /* tdma and coex table */ -+ if (!bWifiBusy) { -+ if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) { -+ halbtc8723b1ant_ActionWifiConnectedBtAclBusy( -+ pBtCoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE -+ ); -+ } else if ( -+ (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) -+ ) { -+ halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8); -+ -+ if ((pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60) -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } else { -+ if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) { -+ halbtc8723b1ant_ActionWifiConnectedBtAclBusy( -+ pBtCoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY -+ ); -+ } else if ( -+ (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) -+ ) { -+ halbtc8723b1ant_ActionBtScoHidOnlyBusy( -+ pBtCoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY -+ ); -+ } else { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8); -+ -+ if ((pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60) -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+} -+ -+static void halbtc8723b1ant_RunSwCoexistMechanism(PBTC_COEXIST pBtCoexist) -+{ -+ u8 algorithm = 0; -+ -+ algorithm = halbtc8723b1ant_ActionAlgorithm(pBtCoexist); -+ pCoexDm->curAlgorithm = algorithm; -+ -+ if (halbtc8723b1ant_IsCommonAction(pBtCoexist)) { -+ -+ } else { -+ switch (pCoexDm->curAlgorithm) { -+ case BT_8723B_1ANT_COEX_ALGO_SCO: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = SCO.\n")); -+ /* halbtc8723b1ant_ActionSco(pBtCoexist); */ -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_HID: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = HID.\n")); -+ /* halbtc8723b1ant_ActionHid(pBtCoexist); */ -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_A2DP: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = A2DP.\n")); -+ /* halbtc8723b1ant_ActionA2dp(pBtCoexist); */ -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = A2DP+PAN(HS).\n")); -+ /* halbtc8723b1ant_ActionA2dpPanHs(pBtCoexist); */ -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_PANEDR: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = PAN(EDR).\n")); -+ /* halbtc8723b1ant_ActionPanEdr(pBtCoexist); */ -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_PANHS: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = HS mode.\n")); -+ /* halbtc8723b1ant_ActionPanHs(pBtCoexist); */ -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = PAN+A2DP.\n")); -+ /* halbtc8723b1ant_ActionPanEdrA2dp(pBtCoexist); */ -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_PANEDR_HID: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = PAN(EDR)+HID.\n")); -+ /* halbtc8723b1ant_ActionPanEdrHid(pBtCoexist); */ -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = HID+A2DP+PAN.\n")); -+ /* halbtc8723b1ant_ActionHidA2dpPanEdr(pBtCoexist); */ -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_HID_A2DP: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = HID+A2DP.\n")); -+ /* halbtc8723b1ant_ActionHidA2dp(pBtCoexist); */ -+ break; -+ default: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = coexist All Off!!\n")); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+} -+ -+static void halbtc8723b1ant_RunCoexistMechanism(PBTC_COEXIST pBtCoexist) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ bool bWifiConnected = false, bBtHsOn = false; -+ bool bIncreaseScanDevNum = false; -+ bool bBtCtrlAggBufSize = false; -+ u8 aggBufSize = 5; -+ u32 wifiLinkStatus = 0; -+ u32 numOfWifiLink = 0; -+ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], RunCoexistMechanism() ===>\n")); -+ -+ if (pBtCoexist->bManualControl) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n")); -+ return; -+ } -+ -+ if (pBtCoexist->bStopCoexDm) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n")); -+ return; -+ } -+ -+ if (pCoexSta->bUnderIps) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], wifi is under IPS !!!\n")); -+ return; -+ } -+ -+ if ( -+ (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) -+ ){ -+ bIncreaseScanDevNum = true; -+ } -+ -+ pBtCoexist->fBtcSet( -+ pBtCoexist, -+ BTC_SET_BL_INC_SCAN_DEV_NUM, -+ &bIncreaseScanDevNum -+ ); -+ pBtCoexist->fBtcGet( -+ pBtCoexist, -+ BTC_GET_BL_WIFI_CONNECTED, -+ &bWifiConnected -+ ); -+ -+ pBtCoexist->fBtcGet( -+ pBtCoexist, -+ BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifiLinkStatus -+ ); -+ numOfWifiLink = wifiLinkStatus>>16; -+ -+ if ((numOfWifiLink >= 2) || (wifiLinkStatus&WIFI_P2P_GO_CONNECTED)) { -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, -+ INTF_NOTIFY, -+ ( -+ "############# [BTCoex], Multi-Port numOfWifiLink = %d, wifiLinkStatus = 0x%x\n", -+ numOfWifiLink, -+ wifiLinkStatus -+ ) -+ ); -+ halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, bBtCtrlAggBufSize, aggBufSize); -+ -+ if ((pBtLinkInfo->bA2dpExist) && (pCoexSta->bC2hBtInquiryPage)) { -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, -+ INTF_NOTIFY, -+ ("############# [BTCoex], BT Is Inquirying\n") -+ ); -+ halbtc8723b1ant_ActionBtInquiry(pBtCoexist); -+ } else -+ halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist); -+ -+ return; -+ } -+ -+ if ((pBtLinkInfo->bBtLinkExist) && (bWifiConnected)) { -+ halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ -+ if (pBtLinkInfo->bScoExist) -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, true, 0x5); -+ else -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, true, 0x8); -+ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, true); -+ halbtc8723b1ant_RunSwCoexistMechanism(pBtCoexist); /* just print debug message */ -+ } else { -+ halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x5); -+ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, false); -+ halbtc8723b1ant_RunSwCoexistMechanism(pBtCoexist); /* just print debug message */ -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if (pCoexSta->bC2hBtInquiryPage) { -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, -+ INTF_NOTIFY, -+ ("############# [BTCoex], BT Is Inquirying\n") -+ ); -+ halbtc8723b1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } else if (bBtHsOn) { -+ halbtc8723b1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ -+ if (!bWifiConnected) { -+ bool bScan = false, bLink = false, bRoam = false; -+ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], wifi is non connected-idle !!!\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if (bScan || bLink || bRoam) { -+ if (bScan) -+ halbtc8723b1ant_ActionWifiNotConnectedScan(pBtCoexist); -+ else -+ halbtc8723b1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist); -+ } else -+ halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist); -+ } else /* wifi LPS/Busy */ -+ halbtc8723b1ant_ActionWifiConnected(pBtCoexist); -+} -+ -+static void halbtc8723b1ant_InitCoexDm(PBTC_COEXIST pBtCoexist) -+{ -+ /* force to reset coex mechanism */ -+ -+ /* sw all off */ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, false); -+ -+ /* halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 8); */ -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ pCoexSta->popEventCnt = 0; -+} -+ -+static void halbtc8723b1ant_InitHwConfig( -+ PBTC_COEXIST pBtCoexist, -+ bool bBackUp, -+ bool bWifiOnly -+) -+{ -+ u32 u4Tmp = 0;/* fwVer; */ -+ u8 u1Tmpa = 0, u1Tmpb = 0; -+ -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, -+ INTF_INIT, -+ ("[BTCoex], 1Ant Init HW Config!!\n") -+ ); -+ -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x550, 0x8, 0x1); /* enable TBTT nterrupt */ -+ -+ /* 0x790[5:0]= 0x5 */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, 0x5); -+ -+ /* Enable counter statistics */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x1); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0x20, 0x1); -+ -+ /* Antenna config */ -+ if (bWifiOnly) { -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_WIFI, true, false); -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 9); -+ } else -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, true, false); -+ -+ /* PTA parameter */ -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67); -+ -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, -+ INTF_NOTIFY, -+ ( -+ "############# [BTCoex], 0x948 = 0x%x, 0x765 = 0x%x, 0x67 = 0x%x\n", -+ u4Tmp, -+ u1Tmpa, -+ u1Tmpb -+ ) -+ ); -+} -+ -+/* */ -+/* work around function start with wa_halbtc8723b1ant_ */ -+/* */ -+/* */ -+/* extern function start with EXhalbtc8723b1ant_ */ -+/* */ -+void EXhalbtc8723b1ant_PowerOnSetting(PBTC_COEXIST pBtCoexist) -+{ -+ PBTC_BOARD_INFO pBoardInfo = &pBtCoexist->boardInfo; -+ u8 u1Tmp = 0x0; -+ u16 u2Tmp = 0x0; -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x67, 0x20); -+ -+ /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ -+ u2Tmp = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x2); -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x2, u2Tmp|BIT0|BIT1); -+ -+ /* set GRAN_BT = 1 */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ /* set WLAN_ACT = 0 */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ /* */ -+ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1 = 0 and BIT2 = 0 */ -+ if (pBtCoexist->chipInterface == BTC_INTF_USB) { -+ /* fixed at S0 for USB interface */ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ -+ u1Tmp |= 0x1; /* antenna inverse */ -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0xfe08, u1Tmp); -+ -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } else { -+ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ -+ if (pBoardInfo->singleAntPath == 0) { -+ /* set to S1 */ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280); -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+ } else if (pBoardInfo->singleAntPath == 1) { -+ /* set to S0 */ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ u1Tmp |= 0x1; /* antenna inverse */ -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ -+ if (pBtCoexist->chipInterface == BTC_INTF_PCI) -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x384, u1Tmp); -+ else if (pBtCoexist->chipInterface == BTC_INTF_SDIO) -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x60, u1Tmp); -+ } -+} -+ -+void EXhalbtc8723b1ant_InitHwConfig(PBTC_COEXIST pBtCoexist, bool bWifiOnly) -+{ -+ halbtc8723b1ant_InitHwConfig(pBtCoexist, true, bWifiOnly); -+} -+ -+void EXhalbtc8723b1ant_InitCoexDm(PBTC_COEXIST pBtCoexist) -+{ -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, -+ INTF_INIT, -+ ("[BTCoex], Coex Mechanism Init!!\n") -+ ); -+ -+ pBtCoexist->bStopCoexDm = false; -+ -+ halbtc8723b1ant_InitCoexDm(pBtCoexist); -+ -+ halbtc8723b1ant_QueryBtInfo(pBtCoexist); -+} -+ -+void EXhalbtc8723b1ant_DisplayCoexInfo(PBTC_COEXIST pBtCoexist) -+{ -+ PBTC_BOARD_INFO pBoardInfo = &pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo = &pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ u8 *cliBuf = pBtCoexist->cliBuf; -+ u8 u1Tmp[4], i, btInfoExt, psTdmaCase = 0; -+ u16 u2Tmp[4]; -+ u32 u4Tmp[4]; -+ bool bRoam = false; -+ bool bScan = false; -+ bool bLink = false; -+ bool bWifiUnder5G = false; -+ bool bWifiUnderBMode = false; -+ bool bBtHsOn = false; -+ bool bWifiBusy = false; -+ s32 wifiRssi = 0, btHsRssi = 0; -+ u32 wifiBw, wifiTrafficDir, faOfdm, faCck, wifiLinkStatus; -+ u8 wifiDot11Chnl, wifiHsChnl; -+ u32 fwVer = 0, btPatchVer = 0; -+ static u8 PopReportIn10s = 0; -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============" -+ ); -+ CL_PRINTF(cliBuf); -+ -+ if (pBtCoexist->bManualControl) { -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============" -+ ); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n ==========================================" -+ ); -+ CL_PRINTF(cliBuf); -+ } -+ if (pBtCoexist->bStopCoexDm) { -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n ============[Coex is STOPPED]============" -+ ); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n ==========================================" -+ ); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d", "Ant PG Num/ Ant Mech/ Ant Pos:", \ -+ pBoardInfo->pgAntNum, -+ pBoardInfo->btdmAntNum, -+ pBoardInfo->btdmAntPos -+ ); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified) ? "Yes" : "No"), -+ pStackInfo->hciVersion -+ ); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", "CoexVer/ FwVer/ PatchVer", \ -+ GLCoexVerDate8723b1Ant, -+ GLCoexVer8723b1Ant, -+ fwVer, -+ btPatchVer, -+ btPatchVer -+ ); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_DOT11_CHNL, &wifiDot11Chnl); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_HS_CHNL, &wifiHsChnl); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d / %d(%d)", "Dot11 channel / HsChnl(HsMode)", \ -+ wifiDot11Chnl, -+ wifiHsChnl, -+ bBtHsOn -+ ); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x ", "H2C Wifi inform bt chnl Info", \ -+ pCoexDm->wifiChnlInfo[0], -+ pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2] -+ ); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_HS_RSSI, &btHsRssi); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d", "Wifi rssi/ HS rssi", \ -+ wifiRssi-100, btHsRssi-100 -+ ); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d/ %s", "Wifi bLink/ bRoam/ bScan/ bHi-Pri", \ -+ bLink, bRoam, bScan, ((pCoexSta->bWiFiIsHighPriTask) ? "1" : "0") -+ ); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet( -+ pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir -+ ); -+ pBtCoexist->fBtcGet( -+ pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode -+ ); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s / %s/ %s/ AP =%d/ %s ", "Wifi status", \ -+ (bWifiUnder5G ? "5G" : "2.4G"), -+ ((bWifiUnderBMode) ? "11b" : ((BTC_WIFI_BW_LEGACY == wifiBw) ? "11bg" : (((BTC_WIFI_BW_HT40 == wifiBw) ? "HT40" : "HT20")))), -+ ((!bWifiBusy) ? "idle" : ((BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ? "uplink" : "downlink")), -+ pCoexSta->nScanAPNum, -+ (pCoexSta->bCCKLock) ? "Lock" : "noLock" -+ ); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet( -+ pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus -+ ); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d/ %d/ %d", "sta/vwifi/hs/p2pGo/p2pGc", \ -+ ((wifiLinkStatus&WIFI_STA_CONNECTED) ? 1 : 0), -+ ((wifiLinkStatus&WIFI_AP_CONNECTED) ? 1 : 0), -+ ((wifiLinkStatus&WIFI_HS_CONNECTED) ? 1 : 0), -+ ((wifiLinkStatus&WIFI_P2P_GO_CONNECTED) ? 1 : 0), -+ ((wifiLinkStatus&WIFI_P2P_GC_CONNECTED) ? 1 : 0) -+ ); -+ CL_PRINTF(cliBuf); -+ -+ -+ PopReportIn10s++; -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = [%s/ %d/ %d/ %d] ", "BT [status/ rssi/ retryCnt/ popCnt]", \ -+ ((pBtCoexist->btInfo.bBtDisabled) ? ("disabled") : ((pCoexSta->bC2hBtInquiryPage) ? ("inquiry/page scan") : ((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) ? "non-connected idle" : -+ ((BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ? "connected-idle" : "busy")))), -+ pCoexSta->btRssi, pCoexSta->btRetryCnt, pCoexSta->popEventCnt -+ ); -+ CL_PRINTF(cliBuf); -+ -+ if (PopReportIn10s >= 5) { -+ pCoexSta->popEventCnt = 0; -+ PopReportIn10s = 0; -+ } -+ -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pBtLinkInfo->bScoExist, -+ pBtLinkInfo->bHidExist, -+ pBtLinkInfo->bPanExist, -+ pBtLinkInfo->bA2dpExist -+ ); -+ CL_PRINTF(cliBuf); -+ -+ if (pStackInfo->bProfileNotified) { -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } else { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Role", \ -+ (pBtLinkInfo->bSlaveRole) ? "Slave" : "Master"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0) ? "Basic rate" : "EDR rate" -+ ); -+ CL_PRINTF(cliBuf); -+ -+ for (i = 0; i < BT_INFO_SRC_8723B_1ANT_MAX; i++) { -+ if (pCoexSta->btInfoC2hCnt[i]) { -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723b1Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i] -+ ); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s/%s, (0x%x/0x%x)", "PS state, IPS/LPS, (lps/rpwm)", \ -+ (pCoexSta->bUnderIps ? "IPS ON" : "IPS OFF"), -+ (pCoexSta->bUnderLps ? "LPS ON" : "LPS OFF"), -+ pBtCoexist->btInfo.lpsVal, -+ pBtCoexist->btInfo.rpwmVal -+ ); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_FW_PWR_MODE_CMD); -+ -+ if (!pBtCoexist->bManualControl) { -+ /* Sw mechanism */ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s", "============[Sw mechanism]============" -+ ); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d", "SM[LowPenaltyRA]", \ -+ pCoexDm->bCurLowPenaltyRa -+ ); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s/ %s/ %d ", "DelBA/ BtCtrlAgg/ AggSize", \ -+ (pBtCoexist->btInfo.bRejectAggPkt ? "Yes" : "No"), -+ (pBtCoexist->btInfo.bBtCtrlAggBufSize ? "Yes" : "No"), -+ pBtCoexist->btInfo.aggBufSize -+ ); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x ", "Rate Mask", \ -+ pBtCoexist->btInfo.raMask -+ ); -+ CL_PRINTF(cliBuf); -+ -+ /* Fw mechanism */ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase, pCoexDm->bAutoTdmaAdjust); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Coex Table Type", \ -+ pCoexSta->nCoexTableType); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "IgnWlanAct", \ -+ pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ -+ /* -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Latest error condition(should be 0)", \ -+ pCoexDm->errorCondition); -+ CL_PRINTF(cliBuf); -+ */ -+ } -+ -+ /* Hw setting */ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "backup ARFR1/ARFR2/RL/AMaxTime", \ -+ pCoexDm->backupArfrCnt1, pCoexDm->backupArfrCnt2, pCoexDm->backupRetryLimit, pCoexDm->backupAmpduMaxTime); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ u2Tmp[0] = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "0x430/0x434/0x42a/0x456", \ -+ u4Tmp[0], u4Tmp[1], u2Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); -+ CL_SPRINTF( -+ cliBuf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/0x6cc/0x880[29:25]", \ -+ u1Tmp[0], u4Tmp[0], (u4Tmp[1]&0x3e000000) >> 25 -+ ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x764); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x948/ 0x67[5] / 0x764 / 0x76e", \ -+ u4Tmp[0], ((u1Tmp[0]&0x20) >> 5), (u4Tmp[1] & 0xffff), u1Tmp[1] -+ ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x92c); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x930); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x944); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", \ -+ u4Tmp[0]&0x3, u4Tmp[1]&0xff, u4Tmp[2]&0x3 -+ ); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x39); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x64); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x38[11]/0x40/0x4c[24:23]/0x64[0]", \ -+ ((u1Tmp[0] & 0x8)>>3), -+ u1Tmp[1], -+ ((u4Tmp[0]&0x01800000)>>23), -+ u1Tmp[2]&0x1 -+ ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0] -+ ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49c); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x", "0xc50(dig)/0x49c(null-drop)", \ -+ u4Tmp[0]&0xff, u1Tmp[0] -+ ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); -+ u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xcf0); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5b); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5c); -+ -+ faOfdm = -+ ((u4Tmp[0]&0xffff0000) >> 16) + -+ ((u4Tmp[1]&0xffff0000) >> 16) + -+ (u4Tmp[1] & 0xffff) + (u4Tmp[2] & 0xffff) + \ -+ ((u4Tmp[3]&0xffff0000) >> 16) + (u4Tmp[3] & 0xffff); -+ faCck = (u1Tmp[0] << 8) + u1Tmp[1]; -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "OFDM-CCA/OFDM-FA/CCK-FA", \ -+ u4Tmp[0]&0xffff, faOfdm, faCck -+ ); -+ CL_PRINTF(cliBuf); -+ -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_OK CCK/11g/11n/11n-Agg", \ -+ pCoexSta->nCRCOK_CCK, -+ pCoexSta->nCRCOK_11g, -+ pCoexSta->nCRCOK_11n, -+ pCoexSta->nCRCOK_11nAgg -+ ); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_Err CCK/11g/11n/11n-Agg", \ -+ pCoexSta->nCRCErr_CCK, -+ pCoexSta->nCRCErr_11g, -+ pCoexSta->nCRCErr_11n, -+ pCoexSta->nCRCErr_11nAgg -+ ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d", "0x770(high-pri rx/tx)", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx -+ ); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d", "0x774(low-pri rx/tx)", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx -+ ); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void EXhalbtc8723b1ant_IpsNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ if (pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm) -+ return; -+ -+ if (BTC_IPS_ENTER == type) { -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], IPS ENTER notify\n") -+ ); -+ pCoexSta->bUnderIps = true; -+ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 0); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, false, true); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], IPS LEAVE notify\n") -+ ); -+ pCoexSta->bUnderIps = false; -+ -+ halbtc8723b1ant_InitHwConfig(pBtCoexist, false, false); -+ halbtc8723b1ant_InitCoexDm(pBtCoexist); -+ halbtc8723b1ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+void EXhalbtc8723b1ant_LpsNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ if (pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm) -+ return; -+ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], LPS ENABLE notify\n") -+ ); -+ pCoexSta->bUnderLps = true; -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], LPS DISABLE notify\n") -+ ); -+ pCoexSta->bUnderLps = false; -+ } -+} -+ -+void EXhalbtc8723b1ant_ScanNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ bool bWifiConnected = false, bBtHsOn = false; -+ u32 wifiLinkStatus = 0; -+ u32 numOfWifiLink = 0; -+ bool bBtCtrlAggBufSize = false; -+ u8 aggBufSize = 5; -+ -+ u8 u1Tmpa, u1Tmpb; -+ u32 u4Tmp; -+ -+ if (pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm) -+ return; -+ -+ if (BTC_SCAN_START == type) { -+ pCoexSta->bWiFiIsHighPriTask = true; -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN START notify\n") -+ ); -+ -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 8); /* Force antenna setup for no scan result issue */ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67); -+ -+ -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, -+ INTF_NOTIFY, -+ ( -+ "[BTCoex], 0x948 = 0x%x, 0x765 = 0x%x, 0x67 = 0x%x\n", -+ u4Tmp, -+ u1Tmpa, -+ u1Tmpb -+ ) -+ ); -+ } else { -+ pCoexSta->bWiFiIsHighPriTask = false; -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN FINISH notify\n") -+ ); -+ -+ pBtCoexist->fBtcGet( -+ pBtCoexist, BTC_GET_U1_AP_NUM, &pCoexSta->nScanAPNum -+ ); -+ } -+ -+ if (pBtCoexist->btInfo.bBtDisabled) -+ return; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ halbtc8723b1ant_QueryBtInfo(pBtCoexist); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ -+ if (numOfWifiLink >= 2) { -+ halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8723b1ant_LimitedRx( -+ pBtCoexist, NORMAL_EXEC, false, bBtCtrlAggBufSize, aggBufSize -+ ); -+ halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ if (pCoexSta->bC2hBtInquiryPage) { -+ halbtc8723b1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } else if (bBtHsOn) { -+ halbtc8723b1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if (BTC_SCAN_START == type) { -+ /* BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN START notify\n")); */ -+ if (!bWifiConnected) /* non-connected scan */ -+ halbtc8723b1ant_ActionWifiNotConnectedScan(pBtCoexist); -+ else /* wifi is connected */ -+ halbtc8723b1ant_ActionWifiConnectedScan(pBtCoexist); -+ } else if (BTC_SCAN_FINISH == type) { -+ /* BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN FINISH notify\n")); */ -+ if (!bWifiConnected) /* non-connected scan */ -+ halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist); -+ else -+ halbtc8723b1ant_ActionWifiConnected(pBtCoexist); -+ } -+} -+ -+void EXhalbtc8723b1ant_ConnectNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ bool bWifiConnected = false, bBtHsOn = false; -+ u32 wifiLinkStatus = 0; -+ u32 numOfWifiLink = 0; -+ bool bBtCtrlAggBufSize = false; -+ u8 aggBufSize = 5; -+ -+ if ( -+ pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled -+ ) -+ return; -+ -+ if (BTC_ASSOCIATE_START == type) { -+ pCoexSta->bWiFiIsHighPriTask = true; -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT START notify\n")); -+ pCoexDm->nArpCnt = 0; -+ } else { -+ pCoexSta->bWiFiIsHighPriTask = false; -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT FINISH notify\n")); -+ /* pCoexDm->nArpCnt = 0; */ -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if (numOfWifiLink >= 2) { -+ halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if (pCoexSta->bC2hBtInquiryPage) { -+ halbtc8723b1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } else if (bBtHsOn) { -+ halbtc8723b1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if (BTC_ASSOCIATE_START == type) { -+ /* BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT START notify\n")); */ -+ halbtc8723b1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist); -+ } else if (BTC_ASSOCIATE_FINISH == type) { -+ /* BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT FINISH notify\n")); */ -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if (!bWifiConnected) /* non-connected scan */ -+ halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist); -+ else -+ halbtc8723b1ant_ActionWifiConnected(pBtCoexist); -+ } -+} -+ -+void EXhalbtc8723b1ant_MediaStatusNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ u8 H2C_Parameter[3] = {0}; -+ u32 wifiBw; -+ u8 wifiCentralChnl; -+ bool bWifiUnderBMode = false; -+ -+ if ( -+ pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled -+ ) -+ return; -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], MEDIA connect notify\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ -+ /* Set CCK Tx/Rx high Pri except 11b mode */ -+ if (bWifiUnderBMode) { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x00); /* CCK Tx */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x00); /* CCK Rx */ -+ } else { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x10); /* CCK Tx */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x10); /* CCK Rx */ -+ } -+ -+ pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ } else { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], MEDIA disconnect notify\n")); -+ pCoexDm->nArpCnt = 0; -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x0); /* CCK Tx */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x0); /* CCK Rx */ -+ } -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if ((BTC_MEDIA_CONNECT == type) && (wifiCentralChnl <= 14)) { -+ /* H2C_Parameter[0] = 0x1; */ -+ H2C_Parameter[0] = 0x0; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_EXEC, -+ ( -+ "[BTCoex], FW write 0x66 = 0x%x\n", -+ H2C_Parameter[0]<<16 | H2C_Parameter[1]<<8 | H2C_Parameter[2] -+ ) -+ ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter); -+} -+ -+void EXhalbtc8723b1ant_SpecialPacketNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ bool bBtHsOn = false; -+ u32 wifiLinkStatus = 0; -+ u32 numOfWifiLink = 0; -+ bool bBtCtrlAggBufSize = false; -+ u8 aggBufSize = 5; -+ -+ if ( -+ pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled -+ ) -+ return; -+ -+ if ( -+ BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ BTC_PACKET_ARP == type -+ ) { -+ if (BTC_PACKET_ARP == type) { -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, -+ INTF_NOTIFY, -+ ("[BTCoex], special Packet ARP notify\n") -+ ); -+ -+ pCoexDm->nArpCnt++; -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, -+ INTF_NOTIFY, -+ ("[BTCoex], ARP Packet Count = %d\n", pCoexDm->nArpCnt) -+ ); -+ -+ if (pCoexDm->nArpCnt >= 10) /* if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecialPacket(pBtCoexist) */ -+ pCoexSta->bWiFiIsHighPriTask = false; -+ else -+ pCoexSta->bWiFiIsHighPriTask = true; -+ } else { -+ pCoexSta->bWiFiIsHighPriTask = true; -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, -+ INTF_NOTIFY, -+ ("[BTCoex], special Packet DHCP or EAPOL notify\n") -+ ); -+ } -+ } else { -+ pCoexSta->bWiFiIsHighPriTask = false; -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, -+ INTF_NOTIFY, -+ ("[BTCoex], special Packet [Type = %d] notify\n", type) -+ ); -+ } -+ -+ pCoexSta->specialPktPeriodCnt = 0; -+ -+ pBtCoexist->fBtcGet( -+ pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus -+ ); -+ numOfWifiLink = wifiLinkStatus>>16; -+ -+ if (numOfWifiLink >= 2) { -+ halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8723b1ant_LimitedRx( -+ pBtCoexist, NORMAL_EXEC, false, bBtCtrlAggBufSize, aggBufSize -+ ); -+ halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if (pCoexSta->bC2hBtInquiryPage) { -+ halbtc8723b1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } else if (bBtHsOn) { -+ halbtc8723b1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if ( -+ BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ ((BTC_PACKET_ARP == type) && (pCoexSta->bWiFiIsHighPriTask)) -+ ) -+ halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+} -+ -+void EXhalbtc8723b1ant_BtInfoNotify( -+ PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 length -+) -+{ -+ u8 btInfo = 0; -+ u8 i, rspSource = 0; -+ bool bWifiConnected = false; -+ bool bBtBusy = false; -+ -+ pCoexSta->bC2hBtInfoReqSent = false; -+ -+ rspSource = tmpBuf[0]&0xf; -+ if (rspSource >= BT_INFO_SRC_8723B_1ANT_MAX) -+ rspSource = BT_INFO_SRC_8723B_1ANT_WIFI_FW; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, -+ INTF_NOTIFY, -+ ("[BTCoex], Bt info[%d], length =%d, hex data =[", -+ rspSource, -+ length) -+ ); -+ for (i = 0; i < length; i++) { -+ pCoexSta->btInfoC2h[rspSource][i] = tmpBuf[i]; -+ if (i == 1) -+ btInfo = tmpBuf[i]; -+ if (i == length-1) -+ BTC_PRINT( -+ BTC_MSG_INTERFACE, INTF_NOTIFY, ("0x%02x]\n", tmpBuf[i]) -+ ); -+ else -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("0x%02x, ", tmpBuf[i])); -+ } -+ -+ if (BT_INFO_SRC_8723B_1ANT_WIFI_FW != rspSource) { -+ pCoexSta->btRetryCnt = pCoexSta->btInfoC2h[rspSource][2]&0xf; -+ -+ if (pCoexSta->btRetryCnt >= 1) -+ pCoexSta->popEventCnt++; -+ -+ if (pCoexSta->btInfoC2h[rspSource][2]&0x20) -+ pCoexSta->bC2hBtPage = true; -+ else -+ pCoexSta->bC2hBtPage = false; -+ -+ pCoexSta->btRssi = pCoexSta->btInfoC2h[rspSource][3]*2-90; -+ /* pCoexSta->btInfoC2h[rspSource][3]*2+10; */ -+ -+ pCoexSta->btInfoExt = pCoexSta->btInfoC2h[rspSource][4]; -+ -+ pCoexSta->bBtTxRxMask = (pCoexSta->btInfoC2h[rspSource][2]&0x40); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TX_RX_MASK, &pCoexSta->bBtTxRxMask); -+ -+ if (!pCoexSta->bBtTxRxMask) { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n")); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); -+ } -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ if (pCoexSta->btInfoExt & BIT1) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n") -+ ); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if (bWifiConnected) -+ EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT); -+ else -+ EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ -+ if (pCoexSta->btInfoExt & BIT3) { -+ if (!pBtCoexist->bManualControl && !pBtCoexist->bStopCoexDm) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n") -+ ); -+ halbtc8723b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, false); -+ } -+ } else { -+ /* BT already NOT ignore Wlan active, do nothing here. */ -+ } -+ } -+ -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (btInfo & BT_INFO_8723B_1ANT_B_INQ_PAGE) -+ pCoexSta->bC2hBtInquiryPage = true; -+ else -+ pCoexSta->bC2hBtInquiryPage = false; -+ -+ /* set link exist status */ -+ if (!(btInfo&BT_INFO_8723B_1ANT_B_CONNECTION)) { -+ pCoexSta->bBtLinkExist = false; -+ pCoexSta->bPanExist = false; -+ pCoexSta->bA2dpExist = false; -+ pCoexSta->bHidExist = false; -+ pCoexSta->bScoExist = false; -+ } else { /* connection exists */ -+ pCoexSta->bBtLinkExist = true; -+ if (btInfo & BT_INFO_8723B_1ANT_B_FTP) -+ pCoexSta->bPanExist = true; -+ else -+ pCoexSta->bPanExist = false; -+ -+ if (btInfo & BT_INFO_8723B_1ANT_B_A2DP) -+ pCoexSta->bA2dpExist = true; -+ else -+ pCoexSta->bA2dpExist = false; -+ -+ if (btInfo & BT_INFO_8723B_1ANT_B_HID) -+ pCoexSta->bHidExist = true; -+ else -+ pCoexSta->bHidExist = false; -+ -+ if (btInfo & BT_INFO_8723B_1ANT_B_SCO_ESCO) -+ pCoexSta->bScoExist = true; -+ else -+ pCoexSta->bScoExist = false; -+ } -+ -+ halbtc8723b1ant_UpdateBtLinkInfo(pBtCoexist); -+ -+ btInfo = btInfo & 0x1f; /* mask profile bit for connect-ilde identification (for CSR case: A2DP idle --> 0x41) */ -+ -+ if (!(btInfo&BT_INFO_8723B_1ANT_B_CONNECTION)) { -+ pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n")); -+ } else if (btInfo == BT_INFO_8723B_1ANT_B_CONNECTION) { -+ /* connection exists but no busy */ -+ pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n")); -+ } else if ( -+ (btInfo&BT_INFO_8723B_1ANT_B_SCO_ESCO) || -+ (btInfo&BT_INFO_8723B_1ANT_B_SCO_BUSY) -+ ) { -+ pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_SCO_BUSY; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n")); -+ } else if (btInfo&BT_INFO_8723B_1ANT_B_ACL_BUSY) { -+ if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY != pCoexDm->btStatus) -+ pCoexDm->bAutoTdmaAdjust = false; -+ -+ pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_ACL_BUSY; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n")); -+ } else { -+ pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_MAX; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n")); -+ } -+ -+ if ( -+ (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) -+ ) -+ bBtBusy = true; -+ else -+ bBtBusy = false; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ halbtc8723b1ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+void EXhalbtc8723b1ant_HaltNotify(PBTC_COEXIST pBtCoexist) -+{ -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 0); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, false, true); -+ -+ halbtc8723b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, true); -+ -+ EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ -+ pBtCoexist->bStopCoexDm = true; -+} -+ -+void EXhalbtc8723b1ant_PnpNotify(PBTC_COEXIST pBtCoexist, u8 pnpState) -+{ -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Pnp notify\n")); -+ -+ if (BTC_WIFI_PNP_SLEEP == pnpState) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Pnp notify to SLEEP\n")); -+ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 0); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, false, true); -+ -+ pBtCoexist->bStopCoexDm = true; -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnpState) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Pnp notify to WAKE UP\n")); -+ pBtCoexist->bStopCoexDm = false; -+ halbtc8723b1ant_InitHwConfig(pBtCoexist, false, false); -+ halbtc8723b1ant_InitCoexDm(pBtCoexist); -+ halbtc8723b1ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+void EXhalbtc8723b1ant_Periodical(PBTC_COEXIST pBtCoexist) -+{ -+ static u8 disVerInfoCnt = 0; -+ u32 fwVer = 0, btPatchVer = 0; -+ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], ==========================Periodical ===========================\n")); -+ -+ if (disVerInfoCnt <= 5) { -+ disVerInfoCnt += 1; -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ****************************************************************\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", \ -+ GLCoexVerDate8723b1Ant, GLCoexVer8723b1Ant, fwVer, btPatchVer, btPatchVer)); -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ****************************************************************\n")); -+ } -+ -+ halbtc8723b1ant_MonitorBtCtr(pBtCoexist); -+ halbtc8723b1ant_MonitorWiFiCtr(pBtCoexist); -+ -+ if ( -+ halbtc8723b1ant_IsWifiStatusChanged(pBtCoexist) || -+ pCoexDm->bAutoTdmaAdjust -+ ) -+ halbtc8723b1ant_RunCoexistMechanism(pBtCoexist); -+ -+ pCoexSta->specialPktPeriodCnt++; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalBtc8723b1Ant.h linux/3rdparty/rtl8723bs/hal/HalBtc8723b1Ant.h ---- linux.old/3rdparty/rtl8723bs/hal/HalBtc8723b1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalBtc8723b1Ant.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,193 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/* The following is for 8723B 1ANT BT Co-exist definition */ -+#define BT_INFO_8723B_1ANT_B_FTP BIT7 -+#define BT_INFO_8723B_1ANT_B_A2DP BIT6 -+#define BT_INFO_8723B_1ANT_B_HID BIT5 -+#define BT_INFO_8723B_1ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8723B_1ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8723B_1ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8723B_1ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8723B_1ANT_B_CONNECTION BIT0 -+ -+#define BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT0)) ? true : false) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT 2 -+ -+#define BT_8723B_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ -+ -+typedef enum _BT_INFO_SRC_8723B_1ANT { -+ BT_INFO_SRC_8723B_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8723B_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8723B_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8723B_1ANT_MAX -+} BT_INFO_SRC_8723B_1ANT, *PBT_INFO_SRC_8723B_1ANT; -+ -+typedef enum _BT_8723B_1ANT_BT_STATUS { -+ BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8723B_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8723B_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8723B_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8723B_1ANT_BT_STATUS_MAX -+} BT_8723B_1ANT_BT_STATUS, *PBT_8723B_1ANT_BT_STATUS; -+ -+typedef enum _BT_8723B_1ANT_WIFI_STATUS { -+ BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT = 0x3, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8723B_1ANT_WIFI_STATUS_MAX -+} BT_8723B_1ANT_WIFI_STATUS, *PBT_8723B_1ANT_WIFI_STATUS; -+ -+typedef enum _BT_8723B_1ANT_COEX_ALGO { -+ BT_8723B_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8723B_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8723B_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8723B_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8723B_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8723B_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8723B_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8723B_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8723B_1ANT_COEX_ALGO_MAX = 0xb, -+} BT_8723B_1ANT_COEX_ALGO, *PBT_8723B_1ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8723B_1ANT { -+ /* fw mechanism */ -+ bool bCurIgnoreWlanAct; -+ bool bPreIgnoreWlanAct; -+ u8 prePsTdma; -+ u8 curPsTdma; -+ u8 psTdmaPara[5]; -+ u8 psTdmaDuAdjType; -+ bool bAutoTdmaAdjust; -+ bool bPrePsTdmaOn; -+ bool bCurPsTdmaOn; -+ bool bPreBtAutoReport; -+ bool bCurBtAutoReport; -+ u8 preLps; -+ u8 curLps; -+ u8 preRpwm; -+ u8 curRpwm; -+ -+ /* sw mechanism */ -+ bool bPreLowPenaltyRa; -+ bool bCurLowPenaltyRa; -+ u32 preVal0x6c0; -+ u32 curVal0x6c0; -+ u32 preVal0x6c4; -+ u32 curVal0x6c4; -+ u32 preVal0x6c8; -+ u32 curVal0x6c8; -+ u8 preVal0x6cc; -+ u8 curVal0x6cc; -+ bool bLimitedDig; -+ -+ u32 backupArfrCnt1; /* Auto Rate Fallback Retry cnt */ -+ u32 backupArfrCnt2; /* Auto Rate Fallback Retry cnt */ -+ u16 backupRetryLimit; -+ u8 backupAmpduMaxTime; -+ -+ /* algorithm related */ -+ u8 preAlgorithm; -+ u8 curAlgorithm; -+ u8 btStatus; -+ u8 wifiChnlInfo[3]; -+ -+ u32 preRaMask; -+ u32 curRaMask; -+ u8 preArfrType; -+ u8 curArfrType; -+ u8 preRetryLimitType; -+ u8 curRetryLimitType; -+ u8 preAmpduTimeType; -+ u8 curAmpduTimeType; -+ u32 nArpCnt; -+ -+ u8 errorCondition; -+} COEX_DM_8723B_1ANT, *PCOEX_DM_8723B_1ANT; -+ -+typedef struct _COEX_STA_8723B_1ANT { -+ bool bBtLinkExist; -+ bool bScoExist; -+ bool bA2dpExist; -+ bool bHidExist; -+ bool bPanExist; -+ -+ bool bUnderLps; -+ bool bUnderIps; -+ u32 specialPktPeriodCnt; -+ u32 highPriorityTx; -+ u32 highPriorityRx; -+ u32 lowPriorityTx; -+ u32 lowPriorityRx; -+ s8 btRssi; -+ bool bBtTxRxMask; -+ u8 preBtRssiState; -+ u8 preWifiRssiState[4]; -+ bool bC2hBtInfoReqSent; -+ u8 btInfoC2h[BT_INFO_SRC_8723B_1ANT_MAX][10]; -+ u32 btInfoC2hCnt[BT_INFO_SRC_8723B_1ANT_MAX]; -+ bool bC2hBtInquiryPage; -+ bool bC2hBtPage; /* Add for win8.1 page out issue */ -+ bool bWiFiIsHighPriTask; /* Add for win8.1 page out issue */ -+ u8 btRetryCnt; -+ u8 btInfoExt; -+ u32 popEventCnt; -+ u8 nScanAPNum; -+ -+ u32 nCRCOK_CCK; -+ u32 nCRCOK_11g; -+ u32 nCRCOK_11n; -+ u32 nCRCOK_11nAgg; -+ -+ u32 nCRCErr_CCK; -+ u32 nCRCErr_11g; -+ u32 nCRCErr_11n; -+ u32 nCRCErr_11nAgg; -+ -+ bool bCCKLock; -+ bool bPreCCKLock; -+ u8 nCoexTableType; -+ -+ bool bForceLpsOn; -+} COEX_STA_8723B_1ANT, *PCOEX_STA_8723B_1ANT; -+ -+/* */ -+/* The following is interface which will notify coex module. */ -+/* */ -+void EXhalbtc8723b1ant_PowerOnSetting(PBTC_COEXIST pBtCoexist); -+void EXhalbtc8723b1ant_InitHwConfig(PBTC_COEXIST pBtCoexist, bool bWifiOnly); -+void EXhalbtc8723b1ant_InitCoexDm(PBTC_COEXIST pBtCoexist); -+void EXhalbtc8723b1ant_IpsNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtc8723b1ant_LpsNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtc8723b1ant_ScanNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtc8723b1ant_ConnectNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtc8723b1ant_MediaStatusNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtc8723b1ant_SpecialPacketNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtc8723b1ant_BtInfoNotify( -+ PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 length -+); -+void EXhalbtc8723b1ant_HaltNotify(PBTC_COEXIST pBtCoexist); -+void EXhalbtc8723b1ant_PnpNotify(PBTC_COEXIST pBtCoexist, u8 pnpState); -+void EXhalbtc8723b1ant_Periodical(PBTC_COEXIST pBtCoexist); -+void EXhalbtc8723b1ant_DisplayCoexInfo(PBTC_COEXIST pBtCoexist); -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalBtc8723b2Ant.c linux/3rdparty/rtl8723bs/hal/HalBtc8723b2Ant.c ---- linux.old/3rdparty/rtl8723bs/hal/HalBtc8723b2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalBtc8723b2Ant.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,3729 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "Mp_Precomp.h" -+ -+/* Global variables, these are static variables */ -+static COEX_DM_8723B_2ANT GLCoexDm8723b2Ant; -+static PCOEX_DM_8723B_2ANT pCoexDm = &GLCoexDm8723b2Ant; -+static COEX_STA_8723B_2ANT GLCoexSta8723b2Ant; -+static PCOEX_STA_8723B_2ANT pCoexSta = &GLCoexSta8723b2Ant; -+ -+static const char *const GLBtInfoSrc8723b2Ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+static u32 GLCoexVerDate8723b2Ant = 20131211; -+static u32 GLCoexVer8723b2Ant = 0x40; -+ -+/* local function start with halbtc8723b2ant_ */ -+static u8 halbtc8723b2ant_BtRssiState( -+ u8 levelNum, u8 rssiThresh, u8 rssiThresh1 -+) -+{ -+ s32 btRssi = 0; -+ u8 btRssiState = pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if (levelNum == 2) { -+ if ( -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW) -+ ) { -+ if (btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_BT_RSSI_STATE, ("[BTCoex], BT Rssi state switch to High\n")); -+ } else { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_BT_RSSI_STATE, ("[BTCoex], BT Rssi state stay at Low\n")); -+ } -+ } else { -+ if (btRssi < rssiThresh) { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_BT_RSSI_STATE, ("[BTCoex], BT Rssi state switch to Low\n")); -+ } else { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_BT_RSSI_STATE, ("[BTCoex], BT Rssi state stay at High\n")); -+ } -+ } -+ } else if (levelNum == 3) { -+ if (rssiThresh > rssiThresh1) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_BT_RSSI_STATE, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if ( -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW) -+ ) { -+ if (btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_BT_RSSI_STATE, ("[BTCoex], BT Rssi state switch to Medium\n")); -+ } else { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_BT_RSSI_STATE, ("[BTCoex], BT Rssi state stay at Low\n")); -+ } -+ } else if ( -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM) -+ ) { -+ if (btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_BT_RSSI_STATE, ("[BTCoex], BT Rssi state switch to High\n")); -+ } else if (btRssi < rssiThresh) { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_BT_RSSI_STATE, ("[BTCoex], BT Rssi state switch to Low\n")); -+ } else { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_BT_RSSI_STATE, ("[BTCoex], BT Rssi state stay at Medium\n")); -+ } -+ } else { -+ if (btRssi < rssiThresh1) { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_BT_RSSI_STATE, ("[BTCoex], BT Rssi state switch to Medium\n")); -+ } else { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_BT_RSSI_STATE, ("[BTCoex], BT Rssi state stay at High\n")); -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+static u8 halbtc8723b2ant_WifiRssiState( -+ PBTC_COEXIST pBtCoexist, -+ u8 index, -+ u8 levelNum, -+ u8 rssiThresh, -+ u8 rssiThresh1 -+) -+{ -+ s32 wifiRssi = 0; -+ u8 wifiRssiState = pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if (levelNum == 2) { -+ if ( -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW) -+ ) { -+ if (wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_WIFI_RSSI_STATE, ("[BTCoex], wifi RSSI state switch to High\n")); -+ } else { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_WIFI_RSSI_STATE, ("[BTCoex], wifi RSSI state stay at Low\n")); -+ } -+ } else { -+ if (wifiRssi < rssiThresh) { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_WIFI_RSSI_STATE, ("[BTCoex], wifi RSSI state switch to Low\n")); -+ } else { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_WIFI_RSSI_STATE, ("[BTCoex], wifi RSSI state stay at High\n")); -+ } -+ } -+ } else if (levelNum == 3) { -+ if (rssiThresh > rssiThresh1) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_WIFI_RSSI_STATE, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if ( -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW) -+ ) { -+ if (wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_WIFI_RSSI_STATE, ("[BTCoex], wifi RSSI state switch to Medium\n")); -+ } else { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_WIFI_RSSI_STATE, ("[BTCoex], wifi RSSI state stay at Low\n")); -+ } -+ } else if ( -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM) -+ ) { -+ if (wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_WIFI_RSSI_STATE, ("[BTCoex], wifi RSSI state switch to High\n")); -+ } else if (wifiRssi < rssiThresh) { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_WIFI_RSSI_STATE, ("[BTCoex], wifi RSSI state switch to Low\n")); -+ } else { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_WIFI_RSSI_STATE, ("[BTCoex], wifi RSSI state stay at Medium\n")); -+ } -+ } else { -+ if (wifiRssi < rssiThresh1) { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_WIFI_RSSI_STATE, ("[BTCoex], wifi RSSI state switch to Medium\n")); -+ } else { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_WIFI_RSSI_STATE, ("[BTCoex], wifi RSSI state stay at High\n")); -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+static void halbtc8723b2ant_LimitedRx( -+ PBTC_COEXIST pBtCoexist, -+ bool bForceExec, -+ bool bRejApAggPkt, -+ bool bBtCtrlAggBufSize, -+ u8 aggBufSize -+) -+{ -+ bool bRejectRxAgg = bRejApAggPkt; -+ bool bBtCtrlRxAggSize = bBtCtrlAggBufSize; -+ u8 rxAggSize = aggBufSize; -+ -+ /* */ -+ /* Rx Aggregation related setting */ -+ /* */ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg); -+ /* decide BT control aggregation buf size or not */ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize); -+ /* real update aggregation setting */ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+} -+ -+static void halbtc8723b2ant_MonitorBtCtr(PBTC_COEXIST pBtCoexist) -+{ -+ u32 regHPTxRx, regLPTxRx, u4Tmp; -+ u32 regHPTx = 0, regHPRx = 0, regLPTx = 0, regLPRx = 0; -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_MONITOR, -+ ( -+ "[BTCoex], High Priority Tx/Rx (reg 0x%x) = 0x%x(%d)/0x%x(%d)\n", -+ regHPTxRx, -+ regHPTx, -+ regHPTx, -+ regHPRx, -+ regHPRx -+ ) -+ ); -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_BT_MONITOR, -+ ( -+ "[BTCoex], Low Priority Tx/Rx (reg 0x%x) = 0x%x(%d)/0x%x(%d)\n", -+ regLPTxRx, -+ regLPTx, -+ regLPTx, -+ regLPRx, -+ regLPRx -+ ) -+ ); -+ -+ /* reset counter */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+} -+ -+static void halbtc8723b2ant_QueryBtInfo(PBTC_COEXIST pBtCoexist) -+{ -+ u8 H2C_Parameter[1] = {0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = true; -+ -+ H2C_Parameter[0] |= BIT0; /* trigger */ -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_EXEC, -+ ("[BTCoex], Query Bt Info, FW write 0x61 = 0x%x\n", H2C_Parameter[0]) -+ ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter); -+} -+ -+static bool halbtc8723b2ant_IsWifiStatusChanged(PBTC_COEXIST pBtCoexist) -+{ -+ static bool bPreWifiBusy = false, bPreUnder4way = false, bPreBtHsOn = false; -+ bool bWifiBusy = false, bUnder4way = false, bBtHsOn = false; -+ bool bWifiConnected = false; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ -+ if (bWifiConnected) { -+ if (bWifiBusy != bPreWifiBusy) { -+ bPreWifiBusy = bWifiBusy; -+ return true; -+ } -+ -+ if (bUnder4way != bPreUnder4way) { -+ bPreUnder4way = bUnder4way; -+ return true; -+ } -+ -+ if (bBtHsOn != bPreBtHsOn) { -+ bPreBtHsOn = bBtHsOn; -+ return true; -+ } -+ } -+ -+ return false; -+} -+ -+static void halbtc8723b2ant_UpdateBtLinkInfo(PBTC_COEXIST pBtCoexist) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ bool bBtHsOn = false; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pCoexSta->bScoExist; -+ pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist; -+ pBtLinkInfo->bPanExist = pCoexSta->bPanExist; -+ pBtLinkInfo->bHidExist = pCoexSta->bHidExist; -+ -+ /* work around for HS mode. */ -+ if (bBtHsOn) { -+ pBtLinkInfo->bPanExist = true; -+ pBtLinkInfo->bBtLinkExist = true; -+ } -+ -+ /* check if Sco only */ -+ if ( -+ pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist -+ ) -+ pBtLinkInfo->bScoOnly = true; -+ else -+ pBtLinkInfo->bScoOnly = false; -+ -+ /* check if A2dp only */ -+ if ( -+ !pBtLinkInfo->bScoExist && -+ pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist -+ ) -+ pBtLinkInfo->bA2dpOnly = true; -+ else -+ pBtLinkInfo->bA2dpOnly = false; -+ -+ /* check if Pan only */ -+ if ( -+ !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist -+ ) -+ pBtLinkInfo->bPanOnly = true; -+ else -+ pBtLinkInfo->bPanOnly = false; -+ -+ /* check if Hid only */ -+ if ( -+ !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bHidExist -+ ) -+ pBtLinkInfo->bHidOnly = true; -+ else -+ pBtLinkInfo->bHidOnly = false; -+} -+ -+static u8 halbtc8723b2ant_ActionAlgorithm(PBTC_COEXIST pBtCoexist) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ bool bBtHsOn = false; -+ u8 algorithm = BT_8723B_2ANT_COEX_ALGO_UNDEFINED; -+ u8 numOfDiffProfile = 0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if (!pBtLinkInfo->bBtLinkExist) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], No BT link exists!!!\n")); -+ return algorithm; -+ } -+ -+ if (pBtLinkInfo->bScoExist) -+ numOfDiffProfile++; -+ -+ if (pBtLinkInfo->bHidExist) -+ numOfDiffProfile++; -+ -+ if (pBtLinkInfo->bPanExist) -+ numOfDiffProfile++; -+ -+ if (pBtLinkInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if (numOfDiffProfile == 1) { -+ if (pBtLinkInfo->bScoExist) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], SCO only\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_SCO; -+ } else { -+ if (pBtLinkInfo->bHidExist) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], HID only\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_HID; -+ } else if (pBtLinkInfo->bA2dpExist) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], A2DP only\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_A2DP; -+ } else if (pBtLinkInfo->bPanExist) { -+ if (bBtHsOn) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], PAN(HS) only\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], PAN(EDR) only\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (numOfDiffProfile == 2) { -+ if (pBtLinkInfo->bScoExist) { -+ if (pBtLinkInfo->bHidExist) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], SCO + HID\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } else if (pBtLinkInfo->bA2dpExist) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } else if (pBtLinkInfo->bPanExist) { -+ if (bBtHsOn) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], SCO + PAN(HS)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], SCO + PAN(EDR)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if ( -+ pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist -+ ) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], HID + A2DP\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_HID_A2DP; -+ } else if ( -+ pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist -+ ) { -+ if (bBtHsOn) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], HID + PAN(HS)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_HID; -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], HID + PAN(EDR)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if ( -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist -+ ) { -+ if (bBtHsOn) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], A2DP + PAN(HS)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], A2DP + PAN(EDR)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (numOfDiffProfile == 3) { -+ if (pBtLinkInfo->bScoExist) { -+ if ( -+ pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist -+ ) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], SCO + HID + A2DP ==> HID\n") -+ ); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } else if ( -+ pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist -+ ) { -+ if (bBtHsOn) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], SCO + HID + PAN(HS)\n") -+ ); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } else { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ("[BTCoex], SCO + HID + PAN(EDR)\n") -+ ); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if ( -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist -+ ) { -+ if (bBtHsOn) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if ( -+ pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist -+ ) { -+ if (bBtHsOn) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (numOfDiffProfile >= 3) { -+ if (pBtLinkInfo->bScoExist) { -+ if ( -+ pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist -+ ) { -+ if (bBtHsOn) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], SCO + HID + A2DP + PAN(EDR) ==>PAN(EDR)+HID\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+static void halbtc8723b2ant_SetFwDacSwingLevel( -+ PBTC_COEXIST pBtCoexist, u8 dacSwingLvl -+) -+{ -+ u8 H2C_Parameter[1] = {0}; -+ -+ /* There are several type of dacswing */ -+ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ -+ H2C_Parameter[0] = dacSwingLvl; -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_EXEC, -+ ("[BTCoex], Set Dac Swing Level = 0x%x\n", dacSwingLvl) -+ ); -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_EXEC, -+ ("[BTCoex], FW write 0x64 = 0x%x\n", H2C_Parameter[0]) -+ ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x64, 1, H2C_Parameter); -+} -+ -+static void halbtc8723b2ant_SetFwDecBtPwr( -+ PBTC_COEXIST pBtCoexist, u8 decBtPwrLvl -+) -+{ -+ u8 H2C_Parameter[1] = {0}; -+ -+ H2C_Parameter[0] = decBtPwrLvl; -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_EXEC, -+ ( -+ "[BTCoex], decrease Bt Power level = %d, FW write 0x62 = 0x%x\n", -+ decBtPwrLvl, -+ H2C_Parameter[0] -+ ) -+ ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x62, 1, H2C_Parameter); -+} -+ -+static void halbtc8723b2ant_DecBtPwr( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, u8 decBtPwrLvl -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW, -+ ( -+ "[BTCoex], %s Dec BT power level = %d\n", -+ (bForceExec ? "force to" : ""), -+ decBtPwrLvl -+ ) -+ ); -+ pCoexDm->curBtDecPwrLvl = decBtPwrLvl; -+ -+ if (!bForceExec) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_DETAIL, -+ ( -+ "[BTCoex], preBtDecPwrLvl =%d, curBtDecPwrLvl =%d\n", -+ pCoexDm->preBtDecPwrLvl, -+ pCoexDm->curBtDecPwrLvl -+ ) -+ ); -+ -+ if (pCoexDm->preBtDecPwrLvl == pCoexDm->curBtDecPwrLvl) -+ return; -+ } -+ halbtc8723b2ant_SetFwDecBtPwr(pBtCoexist, pCoexDm->curBtDecPwrLvl); -+ -+ pCoexDm->preBtDecPwrLvl = pCoexDm->curBtDecPwrLvl; -+} -+ -+static void halbtc8723b2ant_FwDacSwingLvl( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, u8 fwDacSwingLvl -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW, -+ ( -+ "[BTCoex], %s set FW Dac Swing level = %d\n", -+ (bForceExec ? "force to" : ""), -+ fwDacSwingLvl -+ ) -+ ); -+ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; -+ -+ if (!bForceExec) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_DETAIL, -+ ( -+ "[BTCoex], preFwDacSwingLvl =%d, curFwDacSwingLvl =%d\n", -+ pCoexDm->preFwDacSwingLvl, -+ pCoexDm->curFwDacSwingLvl -+ ) -+ ); -+ -+ if (pCoexDm->preFwDacSwingLvl == pCoexDm->curFwDacSwingLvl) -+ return; -+ } -+ -+ halbtc8723b2ant_SetFwDacSwingLevel(pBtCoexist, pCoexDm->curFwDacSwingLvl); -+ -+ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -+} -+ -+static void halbtc8723b2ant_SetSwRfRxLpfCorner( -+ PBTC_COEXIST pBtCoexist, -+ bool bRxRfShrinkOn -+) -+{ -+ if (bRxRfShrinkOn) { -+ /* Shrink RF Rx LPF corner */ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_EXEC, -+ ("[BTCoex], Shrink RF Rx LPF corner!!\n") -+ ); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xffffc); -+ } else { -+ /* Resume RF Rx LPF corner */ -+ /* After initialized, we can use pCoexDm->btRf0x1eBackup */ -+ if (pBtCoexist->bInitilized) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_SW_EXEC, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+static void halbtc8723b2ant_RfShrink( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, bool bRxRfShrinkOn -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW, -+ ( -+ "[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec ? "force to" : ""), -+ (bRxRfShrinkOn ? "ON" : "OFF") -+ ) -+ ); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if (!bForceExec) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_DETAIL, -+ ( -+ "[BTCoex], bPreRfRxLpfShrink =%d, bCurRfRxLpfShrink =%d\n", -+ pCoexDm->bPreRfRxLpfShrink, -+ pCoexDm->bCurRfRxLpfShrink -+ ) -+ ); -+ -+ if (pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8723b2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+static void halbtc8723b2ant_SetSwPenaltyTxRateAdaptive( -+ PBTC_COEXIST pBtCoexist, bool bLowPenaltyRa -+) -+{ -+ u8 H2C_Parameter[6] = {0}; -+ -+ H2C_Parameter[0] = 0x6; /* opCode, 0x6 = Retry_Penalty */ -+ -+ if (bLowPenaltyRa) { -+ H2C_Parameter[1] |= BIT0; -+ H2C_Parameter[2] = 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ H2C_Parameter[3] = 0xf7; /* MCS7 or OFDM54 */ -+ H2C_Parameter[4] = 0xf8; /* MCS6 or OFDM48 */ -+ H2C_Parameter[5] = 0xf9; /* MCS5 or OFDM36 */ -+ } -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_EXEC, -+ ( -+ "[BTCoex], set WiFi Low-Penalty Retry: %s", -+ (bLowPenaltyRa ? "ON!!" : "OFF!!") -+ ) -+ ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter); -+} -+ -+static void halbtc8723b2ant_LowPenaltyRa( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, bool bLowPenaltyRa -+) -+{ -+ /* return; */ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW, -+ ( -+ "[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec ? "force to" : ""), -+ (bLowPenaltyRa ? "ON" : "OFF") -+ ) -+ ); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if (!bForceExec) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_DETAIL, -+ ( -+ "[BTCoex], bPreLowPenaltyRa =%d, bCurLowPenaltyRa =%d\n", -+ pCoexDm->bPreLowPenaltyRa, -+ pCoexDm->bCurLowPenaltyRa -+ ) -+ ); -+ -+ if (pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8723b2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+static void halbtc8723b2ant_SetDacSwingReg(PBTC_COEXIST pBtCoexist, u32 level) -+{ -+ u8 val = (u8)level; -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_EXEC, -+ ("[BTCoex], Write SwDacSwing = 0x%x\n", level) -+ ); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x883, 0x3e, val); -+} -+ -+static void halbtc8723b2ant_SetSwFullTimeDacSwing( -+ PBTC_COEXIST pBtCoexist, bool bSwDacSwingOn, u32 swDacSwingLvl -+) -+{ -+ if (bSwDacSwingOn) -+ halbtc8723b2ant_SetDacSwingReg(pBtCoexist, swDacSwingLvl); -+ else -+ halbtc8723b2ant_SetDacSwingReg(pBtCoexist, 0x18); -+} -+ -+ -+static void halbtc8723b2ant_DacSwing( -+ PBTC_COEXIST pBtCoexist, -+ bool bForceExec, -+ bool bDacSwingOn, -+ u32 dacSwingLvl -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW, -+ ( -+ "[BTCoex], %s turn DacSwing =%s, dacSwingLvl = 0x%x\n", -+ (bForceExec ? "force to" : ""), -+ (bDacSwingOn ? "ON" : "OFF"), -+ dacSwingLvl -+ ) -+ ); -+ pCoexDm->bCurDacSwingOn = bDacSwingOn; -+ pCoexDm->curDacSwingLvl = dacSwingLvl; -+ -+ if (!bForceExec) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_DETAIL, -+ ( -+ "[BTCoex], bPreDacSwingOn =%d, preDacSwingLvl = 0x%x, bCurDacSwingOn =%d, curDacSwingLvl = 0x%x\n", -+ pCoexDm->bPreDacSwingOn, -+ pCoexDm->preDacSwingLvl, -+ pCoexDm->bCurDacSwingOn, -+ pCoexDm->curDacSwingLvl -+ ) -+ ); -+ -+ if ((pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && -+ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl)) -+ return; -+ } -+ mdelay(30); -+ halbtc8723b2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); -+ -+ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; -+ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -+} -+ -+static void halbtc8723b2ant_SetAgcTable( -+ PBTC_COEXIST pBtCoexist, bool bAgcTableEn -+) -+{ -+ u8 rssiAdjustVal = 0; -+ -+ /* BB AGC Gain Table */ -+ if (bAgcTableEn) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_SW_EXEC, ("[BTCoex], BB Agc Table On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6e1A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6d1B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6c1C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6b1D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6a1E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x691F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x68200001); -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_SW_EXEC, ("[BTCoex], BB Agc Table Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xaa1A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa91B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa81C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa71D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa61E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa51F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa4200001); -+ } -+ -+ -+ /* RF Gain */ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); -+ if (bAgcTableEn) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_SW_EXEC, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x38fff); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x38ffe); -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_SW_EXEC, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x380c3); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x28ce6); -+ } -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xed, 0xfffff, 0x1); -+ if (bAgcTableEn) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_SW_EXEC, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x38fff); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x38ffe); -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_SW_EXEC, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x380c3); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x28ce6); -+ } -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xed, 0xfffff, 0x0); -+ -+ /* set rssiAdjustVal for wifi module. */ -+ if (bAgcTableEn) -+ rssiAdjustVal = 8; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -+} -+ -+static void halbtc8723b2ant_AgcTable( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, bool bAgcTableEn -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW, -+ ( -+ "[BTCoex], %s %s Agc Table\n", -+ (bForceExec ? "force to" : ""), -+ (bAgcTableEn ? "Enable" : "Disable") -+ ) -+ ); -+ pCoexDm->bCurAgcTableEn = bAgcTableEn; -+ -+ if (!bForceExec) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_DETAIL, -+ ( -+ "[BTCoex], bPreAgcTableEn =%d, bCurAgcTableEn =%d\n", -+ pCoexDm->bPreAgcTableEn, -+ pCoexDm->bCurAgcTableEn -+ ) -+ ); -+ -+ if (pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) -+ return; -+ } -+ halbtc8723b2ant_SetAgcTable(pBtCoexist, bAgcTableEn); -+ -+ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -+} -+ -+static void halbtc8723b2ant_SetCoexTable( -+ PBTC_COEXIST pBtCoexist, -+ u32 val0x6c0, -+ u32 val0x6c4, -+ u32 val0x6c8, -+ u8 val0x6cc -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_EXEC, -+ ("[BTCoex], set coex table, set 0x6c0 = 0x%x\n", val0x6c0) -+ ); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_EXEC, -+ ("[BTCoex], set coex table, set 0x6c4 = 0x%x\n", val0x6c4) -+ ); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_EXEC, -+ ("[BTCoex], set coex table, set 0x6c8 = 0x%x\n", val0x6c8) -+ ); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_EXEC, -+ ("[BTCoex], set coex table, set 0x6cc = 0x%x\n", val0x6cc) -+ ); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+static void halbtc8723b2ant_CoexTable( -+ PBTC_COEXIST pBtCoexist, -+ bool bForceExec, -+ u32 val0x6c0, -+ u32 val0x6c4, -+ u32 val0x6c8, -+ u8 val0x6cc -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW, -+ ( -+ "[BTCoex], %s write Coex Table 0x6c0 = 0x%x, 0x6c4 = 0x%x, 0x6c8 = 0x%x, 0x6cc = 0x%x\n", -+ (bForceExec ? "force to" : ""), -+ val0x6c0, -+ val0x6c4, -+ val0x6c8, -+ val0x6cc -+ ) -+ ); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if (!bForceExec) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_DETAIL, -+ ( -+ "[BTCoex], preVal0x6c0 = 0x%x, preVal0x6c4 = 0x%x, preVal0x6c8 = 0x%x, preVal0x6cc = 0x%x !!\n", -+ pCoexDm->preVal0x6c0, -+ pCoexDm->preVal0x6c4, -+ pCoexDm->preVal0x6c8, -+ pCoexDm->preVal0x6cc -+ ) -+ ); -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_SW_DETAIL, -+ ( -+ "[BTCoex], curVal0x6c0 = 0x%x, curVal0x6c4 = 0x%x, curVal0x6c8 = 0x%x, curVal0x6cc = 0x%x !!\n", -+ pCoexDm->curVal0x6c0, -+ pCoexDm->curVal0x6c4, -+ pCoexDm->curVal0x6c8, -+ pCoexDm->curVal0x6cc -+ ) -+ ); -+ -+ if ( -+ (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) -+ ) -+ return; -+ } -+ halbtc8723b2ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+static void halbtc8723b2ant_CoexTableWithType( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, u8 type -+) -+{ -+ switch (type) { -+ case 0: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x55555555, 0xffff, 0x3); -+ break; -+ case 1: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5afa5afa, 0xffff, 0x3); -+ break; -+ case 2: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffff, 0x3); -+ break; -+ case 3: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0xaaaaaaaa, 0xaaaaaaaa, 0xffff, 0x3); -+ break; -+ case 4: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0xffffffff, 0xffffffff, 0xffff, 0x3); -+ break; -+ case 5: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0x5fff5fff, 0xffff, 0x3); -+ break; -+ case 6: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); -+ break; -+ case 7: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55ff55ff, 0xfafafafa, 0xffff, 0x3); -+ break; -+ case 8: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x5aea5aea, 0x5aea5aea, 0xffff, 0x3); -+ break; -+ case 9: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55ff55ff, 0x5aea5aea, 0xffff, 0x3); -+ break; -+ case 10: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55ff55ff, 0x5aff5aff, 0xffff, 0x3); -+ break; -+ case 11: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55ff55ff, 0x5a5f5a5f, 0xffff, 0x3); -+ break; -+ case 12: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55ff55ff, 0x5f5f5f5f, 0xffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+static void halbtc8723b2ant_SetFwIgnoreWlanAct( -+ PBTC_COEXIST pBtCoexist, bool bEnable -+) -+{ -+ u8 H2C_Parameter[1] = {0}; -+ -+ if (bEnable) -+ H2C_Parameter[0] |= BIT0; /* function enable */ -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_EXEC, -+ ( -+ "[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63 = 0x%x\n", -+ H2C_Parameter[0] -+ ) -+ ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter); -+} -+ -+static void halbtc8723b2ant_IgnoreWlanAct( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, bool bEnable -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW, -+ ( -+ "[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec ? "force to" : ""), -+ (bEnable ? "ON" : "OFF") -+ ) -+ ); -+ -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if (!bForceExec) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], bPreIgnoreWlanAct = %d, bCurIgnoreWlanAct = %d!!\n", -+ pCoexDm->bPreIgnoreWlanAct, pCoexDm->bCurIgnoreWlanAct)); -+ -+ if (pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8723b2ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+static void halbtc8723b2ant_SetFwPstdma( -+ PBTC_COEXIST pBtCoexist, -+ u8 byte1, -+ u8 byte2, -+ u8 byte3, -+ u8 byte4, -+ u8 byte5 -+) -+{ -+ u8 H2C_Parameter[5] = {0}; -+ -+ H2C_Parameter[0] = byte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = byte5; -+ -+ pCoexDm->psTdmaPara[0] = byte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = byte5; -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_EXEC, -+ ( -+ "[BTCoex], FW write 0x60(5bytes) = 0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24| -+ H2C_Parameter[2]<<16| -+ H2C_Parameter[3]<<8| -+ H2C_Parameter[4] -+ ) -+ ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter); -+} -+ -+static void halbtc8723b2ant_SwMechanism1( -+ PBTC_COEXIST pBtCoexist, -+ bool bShrinkRxLPF, -+ bool bLowPenaltyRA, -+ bool bLimitedDIG, -+ bool bBTLNAConstrain -+) -+{ -+ halbtc8723b2ant_RfShrink(pBtCoexist, NORMAL_EXEC, bShrinkRxLPF); -+ halbtc8723b2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA); -+} -+ -+static void halbtc8723b2ant_SwMechanism2( -+ PBTC_COEXIST pBtCoexist, -+ bool bAGCTableShift, -+ bool bADCBackOff, -+ bool bSWDACSwing, -+ u32 dacSwingLvl -+) -+{ -+ halbtc8723b2ant_AgcTable(pBtCoexist, NORMAL_EXEC, bAGCTableShift); -+ halbtc8723b2ant_DacSwing(pBtCoexist, NORMAL_EXEC, bSWDACSwing, dacSwingLvl); -+} -+ -+static void halbtc8723b2ant_SetAntPath( -+ PBTC_COEXIST pBtCoexist, u8 antPosType, bool bInitHwCfg, bool bWifiOff -+) -+{ -+ PBTC_BOARD_INFO pBoardInfo = &pBtCoexist->boardInfo; -+ u32 fwVer = 0, u4Tmp = 0; -+ bool bPgExtSwitch = false; -+ bool bUseExtSwitch = false; -+ u8 H2C_Parameter[2] = {0}; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_EXT_SWITCH, &bPgExtSwitch); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); /* [31:16]=fw ver, [15:0]=fw sub ver */ -+ -+ if ((fwVer > 0 && fwVer < 0xc0000) || bPgExtSwitch) -+ bUseExtSwitch = true; -+ -+ if (bInitHwCfg) { -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x39, 0x8, 0x1); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x974, 0xff); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x944, 0x3, 0x3); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x930, 0x77); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); -+ -+ if (fwVer >= 0x180000) { -+ /* Use H2C to set GNT_BT to LOW */ -+ H2C_Parameter[0] = 0; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } else { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x0); -+ } -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); /* WiFi TRx Mask off */ -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x01); /* BT TRx Mask off */ -+ -+ if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) { -+ /* tell firmware "no antenna inverse" */ -+ H2C_Parameter[0] = 0; -+ } else { -+ /* tell firmware "antenna inverse" */ -+ H2C_Parameter[0] = 1; -+ } -+ -+ if (bUseExtSwitch) { -+ /* ext switch type */ -+ H2C_Parameter[1] = 1; -+ } else { -+ /* int switch type */ -+ H2C_Parameter[1] = 0; -+ } -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } -+ -+ /* ext switch setting */ -+ if (bUseExtSwitch) { -+ if (bInitHwCfg) { -+ /* 0x4c[23]= 0, 0x4c[24]= 1 Antenna control by WL/BT */ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp &= ~BIT23; -+ u4Tmp |= BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ } -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); /* fixed internal switch S1->WiFi, S0->BT */ -+ switch (antPosType) { -+ case BTC_ANT_WIFI_AT_MAIN: -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1); /* ext switch main at wifi */ -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2); /* ext switch aux at wifi */ -+ break; -+ } -+ } else { /* internal switch */ -+ if (bInitHwCfg) { -+ /* 0x4c[23]= 0, 0x4c[24]= 1 Antenna control by WL/BT */ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp |= BIT23; -+ u4Tmp &= ~BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ } -+ -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x64, 0x1, 0x0); /* fixed external switch S1->Main, S0->Aux */ -+ switch (antPosType) { -+ case BTC_ANT_WIFI_AT_MAIN: -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); /* fixed internal switch S1->WiFi, S0->BT */ -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280); /* fixed internal switch S0->WiFi, S1->BT */ -+ break; -+ } -+ } -+} -+ -+static void halbtc8723b2ant_PsTdma( -+ PBTC_COEXIST pBtCoexist, bool bForceExec, bool bTurnOn, u8 type -+) -+{ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW, -+ ( -+ "[BTCoex], %s turn %s PS TDMA, type =%d\n", -+ (bForceExec ? "force to" : ""), -+ (bTurnOn ? "ON" : "OFF"), -+ type -+ ) -+ ); -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ if (!bForceExec) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_DETAIL, -+ ( -+ "[BTCoex], bPrePsTdmaOn = %d, bCurPsTdmaOn = %d!!\n", -+ pCoexDm->bPrePsTdmaOn, -+ pCoexDm->bCurPsTdmaOn -+ ) -+ ); -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_DETAIL, -+ ( -+ "[BTCoex], prePsTdma = %d, curPsTdma = %d!!\n", -+ pCoexDm->prePsTdma, pCoexDm->curPsTdma -+ ) -+ ); -+ -+ if ( -+ (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) -+ ) -+ return; -+ } -+ -+ if (bTurnOn) { -+ switch (type) { -+ case 1: -+ default: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ break; -+ case 2: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); -+ break; -+ case 3: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0xf1, 0x90); -+ break; -+ case 4: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x10, 0x03, 0xf1, 0x90); -+ break; -+ case 5: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); -+ break; -+ case 6: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); -+ break; -+ case 7: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0x70, 0x90); -+ break; -+ case 8: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x10, 0x3, 0x70, 0x90); -+ break; -+ case 9: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ break; -+ case 10: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); -+ break; -+ case 11: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0xe1, 0x90); -+ break; -+ case 12: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 13: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); -+ break; -+ case 14: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); -+ break; -+ case 15: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0x60, 0x90); -+ break; -+ case 16: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0x60, 0x90); -+ break; -+ case 17: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x2f, 0x2f, 0x60, 0x90); -+ break; -+ case 18: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 19: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0xe1, 0x90); -+ break; -+ case 20: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0x60, 0x90); -+ break; -+ case 21: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x03, 0x70, 0x90); -+ break; -+ case 71: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ break; -+ } -+ } else { -+ /* disable PS tdma */ -+ switch (type) { -+ case 0: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x40, 0x0); -+ break; -+ case 1: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x48, 0x0); -+ break; -+ default: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x40, 0x0); -+ break; -+ } -+ } -+ -+ /* update pre state */ -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+static void halbtc8723b2ant_CoexAllOff(PBTC_COEXIST pBtCoexist) -+{ -+ /* fw all off */ -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 1); -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ -+ /* hw all off */ -+ /* pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+static void halbtc8723b2ant_InitCoexDm(PBTC_COEXIST pBtCoexist) -+{ -+ /* force to reset coex mechanism */ -+ -+ halbtc8723b2ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 1); -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 6); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, FORCE_EXEC, 0); -+ -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+} -+ -+static void halbtc8723b2ant_ActionBtInquiry(PBTC_COEXIST pBtCoexist) -+{ -+ bool bWifiConnected = false; -+ bool bLowPwrDisable = true; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ if (bWifiConnected) { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ } else { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 1); -+ } -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 6); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ -+ pCoexDm->bNeedRecover0x948 = true; -+ pCoexDm->backup0x948 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ -+ halbtc8723b2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_AUX, false, false); -+} -+ -+static bool halbtc8723b2ant_IsCommonAction(PBTC_COEXIST pBtCoexist) -+{ -+ u8 btRssiState = BTC_RSSI_STATE_HIGH; -+ bool bCommon = false, bWifiConnected = false, bWifiBusy = false; -+ bool bBtHsOn = false, bLowPwrDisable = false; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if (!bWifiConnected) { -+ bLowPwrDisable = false; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Wifi non-connected idle!!\n")); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 1); -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ -+ bCommon = true; -+ } else { -+ if (BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) { -+ bLowPwrDisable = false; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Wifi connected + BT non connected-idle!!\n")); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 1); -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0xb); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ -+ bCommon = true; -+ } else if (BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) { -+ bLowPwrDisable = true; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ if (bBtHsOn) -+ return false; -+ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Wifi connected + BT connected-idle!!\n")); -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 1); -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0xb); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ -+ bCommon = true; -+ } else { -+ bLowPwrDisable = true; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ if (bWifiBusy) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n")); -+ bCommon = false; -+ } else { -+ if (bBtHsOn) -+ return false; -+ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n")); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, 29, 0); -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 21); -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0xb); -+ -+ if (BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ bCommon = true; -+ } -+ } -+ } -+ -+ return bCommon; -+} -+ -+static void halbtc8723b2ant_TdmaDurationAdjust( -+ PBTC_COEXIST pBtCoexist, bool bScoHid, bool bTxPause, u8 maxInterval -+) -+{ -+ static s32 up, dn, m, n, WaitCount; -+ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ -+ u8 retryCount = 0; -+ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW, ("[BTCoex], TdmaDurationAdjust()\n")); -+ -+ if (!pCoexDm->bAutoTdmaAdjust) { -+ pCoexDm->bAutoTdmaAdjust = true; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ { -+ if (bScoHid) { -+ if (bTxPause) { -+ if (maxInterval == 1) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } else if (maxInterval == 2) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } else if (maxInterval == 3) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } else { -+ if (maxInterval == 1) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } else if (maxInterval == 2) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } else if (maxInterval == 3) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } else { -+ if (bTxPause) { -+ if (maxInterval == 1) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } else if (maxInterval == 2) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } else if (maxInterval == 3) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ } else { -+ if (maxInterval == 1) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } else if (maxInterval == 2) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } else if (maxInterval == 3) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ } -+ } -+ } -+ /* */ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ WaitCount = 0; -+ } else { -+ /* accquire the BT TRx retry count from BT_Info byte2 */ -+ retryCount = pCoexSta->btRetryCnt; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], retryCount = %d\n", retryCount)); -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_DETAIL, -+ ( -+ "[BTCoex], up =%d, dn =%d, m =%d, n =%d, WaitCount =%d\n", -+ up, dn, m, n, WaitCount -+ ) -+ ); -+ result = 0; -+ WaitCount++; -+ -+ if (retryCount == 0) { /* no retry in the last 2-second duration */ -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if (up >= n) { /* if 連續 n 個2秒 retry count為0, 則調寬WiFi duration */ -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } else if (retryCount <= 3) { /* <=3 retry in the last 2-second duration */ -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) { /* if 連續 2 個2秒 retry count< 3, 則調窄WiFi duration */ -+ if (WaitCount <= 2) -+ m++; /* 避免一直在兩個level中來回 */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* m 最大值 = 20 ' 最大120秒 recheck是否調整 WiFi duration. */ -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } else { /* retry count > 3, 只要1次 retry count > 3, 則調窄WiFi duration */ -+ if (WaitCount == 1) -+ m++; /* 避免一直在兩個level中來回 */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* m 最大值 = 20 ' 最大120秒 recheck是否調整 WiFi duration. */ -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], max Interval = %d\n", maxInterval)); -+ if (maxInterval == 1) { -+ if (bTxPause) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], TxPause = 1\n")); -+ -+ if (pCoexDm->curPsTdma == 71) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } else if (pCoexDm->curPsTdma == 1) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } else if (pCoexDm->curPsTdma == 2) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } else if (pCoexDm->curPsTdma == 3) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 4) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ -+ if (pCoexDm->curPsTdma == 9) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } else if (pCoexDm->curPsTdma == 10) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } else if (pCoexDm->curPsTdma == 11) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else if (pCoexDm->curPsTdma == 12) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ -+ if (result == -1) { -+ if (pCoexDm->curPsTdma == 5) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } else if (pCoexDm->curPsTdma == 6) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 7) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } else if (pCoexDm->curPsTdma == 13) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } else if (pCoexDm->curPsTdma == 14) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else if (pCoexDm->curPsTdma == 15) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } else if (result == 1) { -+ if (pCoexDm->curPsTdma == 8) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 7) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } else if (pCoexDm->curPsTdma == 6) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } else if (pCoexDm->curPsTdma == 16) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else if (pCoexDm->curPsTdma == 15) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } else if (pCoexDm->curPsTdma == 14) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ } -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], TxPause = 0\n")); -+ if (pCoexDm->curPsTdma == 5) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 71); -+ pCoexDm->psTdmaDuAdjType = 71; -+ } else if (pCoexDm->curPsTdma == 6) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } else if (pCoexDm->curPsTdma == 7) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 8) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ -+ if (pCoexDm->curPsTdma == 13) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } else if (pCoexDm->curPsTdma == 14) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } else if (pCoexDm->curPsTdma == 15) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else if (pCoexDm->curPsTdma == 16) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ -+ if (result == -1) { -+ if (pCoexDm->curPsTdma == 71) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } else if (pCoexDm->curPsTdma == 1) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } else if (pCoexDm->curPsTdma == 2) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 3) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } else if (pCoexDm->curPsTdma == 9) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } else if (pCoexDm->curPsTdma == 10) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else if (pCoexDm->curPsTdma == 11) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } else if (result == 1) { -+ if (pCoexDm->curPsTdma == 4) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 3) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } else if (pCoexDm->curPsTdma == 2) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } else if (pCoexDm->curPsTdma == 1) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 71); -+ pCoexDm->psTdmaDuAdjType = 71; -+ } else if (pCoexDm->curPsTdma == 12) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else if (pCoexDm->curPsTdma == 11) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } else if (pCoexDm->curPsTdma == 10) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ } -+ } -+ } else if (maxInterval == 2) { -+ if (bTxPause) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], TxPause = 1\n")); -+ if (pCoexDm->curPsTdma == 1) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } else if (pCoexDm->curPsTdma == 2) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } else if (pCoexDm->curPsTdma == 3) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 4) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ -+ if (pCoexDm->curPsTdma == 9) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } else if (pCoexDm->curPsTdma == 10) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } else if (pCoexDm->curPsTdma == 11) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else if (pCoexDm->curPsTdma == 12) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ -+ if (result == -1) { -+ if (pCoexDm->curPsTdma == 5) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } else if (pCoexDm->curPsTdma == 6) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 7) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } else if (pCoexDm->curPsTdma == 13) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } else if (pCoexDm->curPsTdma == 14) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else if (pCoexDm->curPsTdma == 15) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } else if (result == 1) { -+ if (pCoexDm->curPsTdma == 8) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 7) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } else if (pCoexDm->curPsTdma == 6) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } else if (pCoexDm->curPsTdma == 16) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else if (pCoexDm->curPsTdma == 15) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } else if (pCoexDm->curPsTdma == 14) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ } -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], TxPause = 0\n")); -+ if (pCoexDm->curPsTdma == 5) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } else if (pCoexDm->curPsTdma == 6) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } else if (pCoexDm->curPsTdma == 7) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 8) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ -+ if (pCoexDm->curPsTdma == 13) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } else if (pCoexDm->curPsTdma == 14) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } else if (pCoexDm->curPsTdma == 15) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else if (pCoexDm->curPsTdma == 16) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ -+ if (result == -1) { -+ if (pCoexDm->curPsTdma == 1) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } else if (pCoexDm->curPsTdma == 2) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 3) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } else if (pCoexDm->curPsTdma == 9) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } else if (pCoexDm->curPsTdma == 10) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else if (pCoexDm->curPsTdma == 11) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } else if (result == 1) { -+ if (pCoexDm->curPsTdma == 4) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 3) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } else if (pCoexDm->curPsTdma == 2) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } else if (pCoexDm->curPsTdma == 12) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else if (pCoexDm->curPsTdma == 11) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } else if (pCoexDm->curPsTdma == 10) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ } -+ } -+ } else if (maxInterval == 3) { -+ if (bTxPause) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], TxPause = 1\n")); -+ if (pCoexDm->curPsTdma == 1) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 2) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 3) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 4) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ -+ if (pCoexDm->curPsTdma == 9) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else if (pCoexDm->curPsTdma == 10) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else if (pCoexDm->curPsTdma == 11) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else if (pCoexDm->curPsTdma == 12) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ -+ if (result == -1) { -+ if (pCoexDm->curPsTdma == 5) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 6) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 7) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } else if (pCoexDm->curPsTdma == 13) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else if (pCoexDm->curPsTdma == 14) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else if (pCoexDm->curPsTdma == 15) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } else if (result == 1) { -+ if (pCoexDm->curPsTdma == 8) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 7) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 6) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } else if (pCoexDm->curPsTdma == 16) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else if (pCoexDm->curPsTdma == 15) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } else if (pCoexDm->curPsTdma == 14) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ } else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], TxPause = 0\n")); -+ if (pCoexDm->curPsTdma == 5) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 6) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 7) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 8) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ -+ if (pCoexDm->curPsTdma == 13) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else if (pCoexDm->curPsTdma == 14) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else if (pCoexDm->curPsTdma == 15) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else if (pCoexDm->curPsTdma == 16) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ -+ if (result == -1) { -+ if (pCoexDm->curPsTdma == 1) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 2) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 3) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } else if (pCoexDm->curPsTdma == 9) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else if (pCoexDm->curPsTdma == 10) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else if (pCoexDm->curPsTdma == 11) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } else if (result == 1) { -+ if (pCoexDm->curPsTdma == 4) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 3) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 2) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } else if (pCoexDm->curPsTdma == 12) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else if (pCoexDm->curPsTdma == 11) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } else if (pCoexDm->curPsTdma == 10) { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ } -+ } -+ -+ /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ -+ /* then we have to adjust it back to the previous record one. */ -+ if (pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) { -+ bool bScan = false, bLink = false, bRoam = false; -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_DETAIL, -+ ( -+ "[BTCoex], PsTdma type dismatch!!!, curPsTdma =%d, recordPsTdma =%d\n", -+ pCoexDm->curPsTdma, -+ pCoexDm->psTdmaDuAdjType -+ ) -+ ); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if (!bScan && !bLink && !bRoam) -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, pCoexDm->psTdmaDuAdjType); -+ else { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); -+ } -+ } -+} -+ -+/* SCO only or SCO+PAN(HS) */ -+static void halbtc8723b2ant_ActionSco(PBTC_COEXIST pBtCoexist) -+{ -+ u8 wifiRssiState, btRssiState; -+ u32 wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, 29, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 4); -+ -+ if (BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) /* for SCO quality at 11b/g mode */ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else /* for SCO quality & wifi performance balance at 11n mode */ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 0); /* for voice quality */ -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifiBw) { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, true, 0x4); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, true, 0x4); -+ } -+ } else { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, true, 0x4); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, true, 0x4); -+ } -+ } -+} -+ -+ -+static void halbtc8723b2ant_ActionHid(PBTC_COEXIST pBtCoexist) -+{ -+ u8 wifiRssiState, btRssiState; -+ u32 wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, 29, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) /* for HID at 11b/g mode */ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ else /* for HID quality & wifi performance balance at 11n mode */ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 9); -+ -+ if ( -+ (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9); -+ else -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 13); -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifiBw) { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } else { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } -+} -+ -+/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -+static void halbtc8723b2ant_ActionA2dp(PBTC_COEXIST pBtCoexist) -+{ -+ u8 wifiRssiState, wifiRssiState1, btRssiState; -+ u32 wifiBw; -+ u8 apNum = 0; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8723b2ant_WifiRssiState(pBtCoexist, 1, 2, 40, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, 29, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ -+ /* define the office environment */ -+ if (apNum >= 10 && BTC_RSSI_HIGH(wifiRssiState1)) { -+ /* DbgPrint(" AP#>10(%d)\n", apNum); */ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 1); -+ -+ /* sw mechanism */ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if (BTC_WIFI_BW_HT40 == wifiBw) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, true, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, true, 0x18); -+ } -+ return; -+ } -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ -+ if ( -+ (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, false, false, 1); -+ else -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, false, true, 1); -+ -+ /* sw mechanism */ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if (BTC_WIFI_BW_HT40 == wifiBw) { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } else { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } -+} -+ -+static void halbtc8723b2ant_ActionA2dpPanHs(PBTC_COEXIST pBtCoexist) -+{ -+ u8 wifiRssiState, btRssiState; -+ u32 wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, 29, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, false, true, 2); -+ -+ /* sw mechanism */ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if (BTC_WIFI_BW_HT40 == wifiBw) { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } else { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } -+} -+ -+static void halbtc8723b2ant_ActionPanEdr(PBTC_COEXIST pBtCoexist) -+{ -+ u8 wifiRssiState, btRssiState; -+ u32 wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, 29, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 10); -+ -+ if ( -+ (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 1); -+ else -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 5); -+ -+ /* sw mechanism */ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if (BTC_WIFI_BW_HT40 == wifiBw) { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } else { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } -+} -+ -+ -+/* PAN(HS) only */ -+static void halbtc8723b2ant_ActionPanHs(PBTC_COEXIST pBtCoexist) -+{ -+ u8 wifiRssiState, btRssiState; -+ u32 wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, 29, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 1); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if (BTC_WIFI_BW_HT40 == wifiBw) { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } else { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } -+} -+ -+/* PAN(EDR)+A2DP */ -+static void halbtc8723b2ant_ActionPanEdrA2dp(PBTC_COEXIST pBtCoexist) -+{ -+ u8 wifiRssiState, btRssiState; -+ u32 wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, 29, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if ( -+ (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 12); -+ if (BTC_WIFI_BW_HT40 == wifiBw) -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, false, true, 3); -+ else -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, false, false, 3); -+ } else { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, false, true, 3); -+ } -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifiBw) { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } else { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, false, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } -+} -+ -+static void halbtc8723b2ant_ActionPanEdrHid(PBTC_COEXIST pBtCoexist) -+{ -+ u8 wifiRssiState, btRssiState; -+ u32 wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, 29, 0); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ if (BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if ( -+ (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ if (BTC_WIFI_BW_HT40 == wifiBw) { -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 3); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 11); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); -+ } else { -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ } -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, true, false, 2); -+ } else { -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 11); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, true, true, 2); -+ } -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifiBw) { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } else { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } -+} -+ -+/* HID+A2DP+PAN(EDR) */ -+static void halbtc8723b2ant_ActionHidA2dpPanEdr(PBTC_COEXIST pBtCoexist) -+{ -+ u8 wifiRssiState, btRssiState; -+ u32 wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, 29, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ -+ if ( -+ (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ if (BTC_WIFI_BW_HT40 == wifiBw) -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, true, true, 2); -+ else -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, true, false, 3); -+ } else -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, true, true, 3); -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifiBw) { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } else { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } -+} -+ -+static void halbtc8723b2ant_ActionHidA2dp(PBTC_COEXIST pBtCoexist) -+{ -+ u8 wifiRssiState, btRssiState; -+ u32 wifiBw; -+ u8 apNum = 0; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ /* btRssiState = halbtc8723b2ant_BtRssiState(2, 29, 0); */ -+ btRssiState = halbtc8723b2ant_BtRssiState(3, 29, 37); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, true, 0x5); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if (BTC_WIFI_BW_LEGACY == wifiBw) { -+ if (BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else if (BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ } else { -+ /* only 802.11N mode we have to dec bt power to 4 degree */ -+ if (BTC_RSSI_HIGH(btRssiState)) { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ /* need to check ap Number of Not */ -+ if (apNum < 10) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ } else if (BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ -+ if ( -+ (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, true, false, 2); -+ else -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, true, true, 2); -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifiBw) { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, true, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } else { -+ if ( -+ (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) -+ ) { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, true, false, false, 0x18); -+ } else { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist, false, true, false, false); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist, false, false, false, 0x18); -+ } -+ } -+} -+ -+static void halbtc8723b2ant_RunCoexistMechanism(PBTC_COEXIST pBtCoexist) -+{ -+ u8 algorithm = 0; -+ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], RunCoexistMechanism() ===>\n")); -+ -+ if (pBtCoexist->bManualControl) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n")); -+ return; -+ } -+ -+ if (pCoexSta->bUnderIps) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], wifi is under IPS !!!\n")); -+ return; -+ } -+ -+ algorithm = halbtc8723b2ant_ActionAlgorithm(pBtCoexist); -+ if (pCoexSta->bC2hBtInquiryPage && (BT_8723B_2ANT_COEX_ALGO_PANHS != algorithm)) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BT is under inquiry/page scan !!\n")); -+ halbtc8723b2ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } else { -+ if (pCoexDm->bNeedRecover0x948) { -+ pCoexDm->bNeedRecover0x948 = false; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, pCoexDm->backup0x948); -+ } -+ } -+ -+ pCoexDm->curAlgorithm = algorithm; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Algorithm = %d\n", pCoexDm->curAlgorithm)); -+ -+ if (halbtc8723b2ant_IsCommonAction(pBtCoexist)) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action 2-Ant common.\n")); -+ pCoexDm->bAutoTdmaAdjust = false; -+ } else { -+ if (pCoexDm->curAlgorithm != pCoexDm->preAlgorithm) { -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE, -+ ( -+ "[BTCoex], preAlgorithm =%d, curAlgorithm =%d\n", -+ pCoexDm->preAlgorithm, -+ pCoexDm->curAlgorithm -+ ) -+ ); -+ pCoexDm->bAutoTdmaAdjust = false; -+ } -+ -+ -+ switch (pCoexDm->curAlgorithm) { -+ case BT_8723B_2ANT_COEX_ALGO_SCO: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action 2-Ant, algorithm = SCO.\n")); -+ halbtc8723b2ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_HID: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action 2-Ant, algorithm = HID.\n")); -+ halbtc8723b2ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_A2DP: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action 2-Ant, algorithm = A2DP.\n")); -+ halbtc8723b2ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n")); -+ halbtc8723b2ant_ActionA2dpPanHs(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_PANEDR: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n")); -+ halbtc8723b2ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_PANHS: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action 2-Ant, algorithm = HS mode.\n")); -+ halbtc8723b2ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n")); -+ halbtc8723b2ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_PANEDR_HID: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n")); -+ halbtc8723b2ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n")); -+ halbtc8723b2ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_HID_A2DP: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n")); -+ halbtc8723b2ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n")); -+ halbtc8723b2ant_CoexAllOff(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+} -+ -+static void halbtc8723b2ant_WifiOffHwCfg(PBTC_COEXIST pBtCoexist) -+{ -+ bool bIsInMpMode = false; -+ u8 H2C_Parameter[2] = {0}; -+ u32 fwVer = 0; -+ -+ /* set wlan_act to low */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); /* WiFi goto standby while GNT_BT 0-->1 */ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ if (fwVer >= 0x180000) { -+ /* Use H2C to set GNT_BT to HIGH */ -+ H2C_Parameter[0] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } else -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, &bIsInMpMode); -+ if (!bIsInMpMode) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x0); /* BT select s0/s1 is controlled by BT */ -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); /* BT select s0/s1 is controlled by WiFi */ -+} -+ -+static void halbtc8723b2ant_InitHwConfig(PBTC_COEXIST pBtCoexist, bool bBackUp) -+{ -+ u8 u1Tmp = 0; -+ -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], 2Ant Init HW Config!!\n")); -+ -+ /* backup rf 0x1e value */ -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ /* 0x790[5:0]= 0x5 */ -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x790); -+ u1Tmp &= 0xc0; -+ u1Tmp |= 0x5; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, u1Tmp); -+ -+ /* Antenna config */ -+ halbtc8723b2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_MAIN, true, false); -+ -+ /* PTA parameter */ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ /* Enable counter statistics */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); /* 0x76e[3] = 1, WLAN_Act control by PTA */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x3); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0x20, 0x1); -+} -+ -+/* */ -+/* work around function start with wa_halbtc8723b2ant_ */ -+/* */ -+/* */ -+/* extern function start with EXhalbtc8723b2ant_ */ -+/* */ -+void EXhalbtc8723b2ant_PowerOnSetting(PBTC_COEXIST pBtCoexist) -+{ -+ PBTC_BOARD_INFO pBoardInfo = &pBtCoexist->boardInfo; -+ u8 u1Tmp = 0x4; /* Set BIT2 by default since it's 2ant case */ -+ u16 u2Tmp = 0x0; -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x67, 0x20); -+ -+ /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ -+ u2Tmp = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x2); -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x2, u2Tmp|BIT0|BIT1); -+ -+ /* set GRAN_BT = 1 */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ /* set WLAN_ACT = 0 */ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ /* */ -+ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1 = 0 and BIT2 = 0 */ -+ if (pBtCoexist->chipInterface == BTC_INTF_USB) { -+ /* fixed at S0 for USB interface */ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ -+ u1Tmp |= 0x1; /* antenna inverse */ -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0xfe08, u1Tmp); -+ -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } else { -+ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ -+ if (pBoardInfo->singleAntPath == 0) { -+ /* set to S1 */ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280); -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+ } else if (pBoardInfo->singleAntPath == 1) { -+ /* set to S0 */ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ u1Tmp |= 0x1; /* antenna inverse */ -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ -+ if (pBtCoexist->chipInterface == BTC_INTF_PCI) -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x384, u1Tmp); -+ else if (pBtCoexist->chipInterface == BTC_INTF_SDIO) -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x60, u1Tmp); -+ } -+} -+ -+void EXhalbtc8723b2ant_InitHwConfig(PBTC_COEXIST pBtCoexist, bool bWifiOnly) -+{ -+ halbtc8723b2ant_InitHwConfig(pBtCoexist, true); -+} -+ -+void EXhalbtc8723b2ant_InitCoexDm(PBTC_COEXIST pBtCoexist) -+{ -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8723b2ant_InitCoexDm(pBtCoexist); -+} -+ -+void EXhalbtc8723b2ant_DisplayCoexInfo(PBTC_COEXIST pBtCoexist) -+{ -+ PBTC_BOARD_INFO pBoardInfo = &pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo = &pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo; -+ u8 *cliBuf = pBtCoexist->cliBuf; -+ u8 u1Tmp[4], i, btInfoExt, psTdmaCase = 0; -+ u32 u4Tmp[4]; -+ bool bRoam = false, bScan = false, bLink = false, bWifiUnder5G = false; -+ bool bBtHsOn = false, bWifiBusy = false; -+ s32 wifiRssi = 0, btHsRssi = 0; -+ u32 wifiBw, wifiTrafficDir, faOfdm, faCck; -+ u8 wifiDot11Chnl, wifiHsChnl; -+ u32 fwVer = 0, btPatchVer = 0; -+ u8 apNum = 0; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ if (pBtCoexist->bManualControl) { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, -+ pBoardInfo->btdmAntNum -+ ); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ (pStackInfo->bProfileNotified ? "Yes" : "No"), -+ pStackInfo->hciVersion -+ ); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", "CoexVer/ FwVer/ PatchVer", \ -+ GLCoexVerDate8723b2Ant, GLCoexVer8723b2Ant, fwVer, btPatchVer, btPatchVer); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_DOT11_CHNL, &wifiDot11Chnl); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_HS_CHNL, &wifiHsChnl); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d / %d(%d)", "Dot11 channel / HsChnl(HsMode)", \ -+ wifiDot11Chnl, -+ wifiHsChnl, -+ bBtHsOn -+ ); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x ", "H2C Wifi inform bt chnl Info", \ -+ pCoexDm->wifiChnlInfo[0], -+ pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2] -+ ); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_HS_RSSI, &btHsRssi); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d", "Wifi rssi/ HS rssi/ AP#", \ -+ wifiRssi, -+ btHsRssi, -+ apNum -+ ); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d ", "Wifi bLink/ bRoam/ bScan", \ -+ bLink, -+ bRoam, -+ bScan -+ ); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s / %s/ %s ", "Wifi status", \ -+ (bWifiUnder5G ? "5G" : "2.4G"), -+ ((BTC_WIFI_BW_LEGACY == wifiBw) ? "Legacy" : (((BTC_WIFI_BW_HT40 == wifiBw) ? "HT40" : "HT20"))), -+ ((!bWifiBusy) ? "idle" : ((BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ? "uplink" : "downlink")) -+ ); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ -+ ((pBtCoexist->btInfo.bBtDisabled) ? ("disabled") : ((pCoexSta->bC2hBtInquiryPage) ? ("inquiry/page scan") : ((BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) ? "non-connected idle" : -+ ((BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ? "connected-idle" : "busy")))), -+ pCoexSta->btRssi, -+ pCoexSta->btRetryCnt -+ ); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pBtLinkInfo->bScoExist, -+ pBtLinkInfo->bHidExist, -+ pBtLinkInfo->bPanExist, -+ pBtLinkInfo->bA2dpExist -+ ); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0) ? "Basic rate" : "EDR rate" -+ ); -+ CL_PRINTF(cliBuf); -+ -+ for (i = 0; i < BT_INFO_SRC_8723B_2ANT_MAX; i++) { -+ if (pCoexSta->btInfoC2hCnt[i]) { -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723b2Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], -+ pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], -+ pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], -+ pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], -+ pCoexSta->btInfoC2hCnt[i] -+ ); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s/%s", "PS state, IPS/LPS", \ -+ ((pCoexSta->bUnderIps ? "IPS ON" : "IPS OFF")), -+ ((pCoexSta->bUnderLps ? "LPS ON" : "LPS OFF")) -+ ); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_FW_PWR_MODE_CMD); -+ -+ /* Sw mechanism */ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s", "============[Sw mechanism]============" -+ ); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d ", "SM1[ShRf/ LpRA/ LimDig]", \ -+ pCoexDm->bCurRfRxLpfShrink, -+ pCoexDm->bCurLowPenaltyRa, -+ pCoexDm->bLimitedDig -+ ); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d(0x%x) ", -+ "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ -+ pCoexDm->bCurAgcTableEn, -+ pCoexDm->bCurAdcBackOff, -+ pCoexDm->bCurDacSwingOn, -+ pCoexDm->curDacSwingLvl -+ ); -+ CL_PRINTF(cliBuf); -+ -+ /* Fw mechanism */ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], -+ pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], -+ pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], -+ psTdmaCase, pCoexDm->bAutoTdmaAdjust -+ ); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d ", "DecBtPwr/ IgnWlanAct", \ -+ pCoexDm->curBtDecPwrLvl, -+ pCoexDm->bCurIgnoreWlanAct -+ ); -+ CL_PRINTF(cliBuf); -+ -+ /* Hw setting */ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup -+ ); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x", "0x778/0x880[29:25]", \ -+ u1Tmp[0], -+ (u4Tmp[0]&0x3e000000) >> 25 -+ ); -+ CL_PRINTF(cliBuf); -+ -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x948/ 0x67[5] / 0x765", \ -+ u4Tmp[0], -+ ((u1Tmp[0]&0x20)>>5), -+ u1Tmp[1] -+ ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x92c); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x930); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x944); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", \ -+ u4Tmp[0]&0x3, -+ u4Tmp[1]&0xff, -+ u4Tmp[2]&0x3 -+ ); -+ CL_PRINTF(cliBuf); -+ -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x39); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x64); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x38[11]/0x40/0x4c[24:23]/0x64[0]", \ -+ ((u1Tmp[0] & 0x8)>>3), -+ u1Tmp[1], -+ ((u4Tmp[0]&0x01800000)>>23), -+ u1Tmp[2]&0x1 -+ ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], -+ u1Tmp[0] -+ ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49c); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x", "0xc50(dig)/0x49c(null-drop)", \ -+ u4Tmp[0]&0xff, -+ u1Tmp[0] -+ ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); -+ u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xcf0); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5b); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5c); -+ -+ faOfdm = -+ ((u4Tmp[0]&0xffff0000) >> 16) + -+ ((u4Tmp[1]&0xffff0000) >> 16) + -+ (u4Tmp[1] & 0xffff) + (u4Tmp[2] & 0xffff) + \ -+ ((u4Tmp[3]&0xffff0000) >> 16) + -+ (u4Tmp[3] & 0xffff); -+ -+ faCck = (u1Tmp[0] << 8) + u1Tmp[1]; -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "OFDM-CCA/OFDM-FA/CCK-FA", \ -+ u4Tmp[0]&0xffff, -+ faOfdm, -+ faCck -+ ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], -+ u4Tmp[1], -+ u4Tmp[2], -+ u1Tmp[0] -+ ); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d", "0x770(high-pri rx/tx)", \ -+ pCoexSta->highPriorityRx, -+ pCoexSta->highPriorityTx -+ ); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF( -+ cliBuf, -+ BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d", "0x774(low-pri rx/tx)", \ -+ pCoexSta->lowPriorityRx, -+ pCoexSta->lowPriorityTx -+ ); -+ CL_PRINTF(cliBuf); -+ -+ halbtc8723b2ant_MonitorBtCtr(pBtCoexist); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void EXhalbtc8723b2ant_IpsNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ if (BTC_IPS_ENTER == type) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], IPS ENTER notify\n")); -+ pCoexSta->bUnderIps = true; -+ halbtc8723b2ant_WifiOffHwCfg(pBtCoexist); -+ halbtc8723b2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, true); -+ halbtc8723b2ant_CoexAllOff(pBtCoexist); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], IPS LEAVE notify\n")); -+ pCoexSta->bUnderIps = false; -+ halbtc8723b2ant_InitHwConfig(pBtCoexist, false); -+ halbtc8723b2ant_InitCoexDm(pBtCoexist); -+ halbtc8723b2ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+void EXhalbtc8723b2ant_LpsNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], LPS ENABLE notify\n")); -+ pCoexSta->bUnderLps = true; -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], LPS DISABLE notify\n")); -+ pCoexSta->bUnderLps = false; -+ } -+} -+ -+void EXhalbtc8723b2ant_ScanNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ if (BTC_SCAN_START == type) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN START notify\n")); -+ } else if (BTC_SCAN_FINISH == type) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN FINISH notify\n")); -+ } -+} -+ -+void EXhalbtc8723b2ant_ConnectNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ if (BTC_ASSOCIATE_START == type) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT START notify\n")); -+ } else if (BTC_ASSOCIATE_FINISH == type) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT FINISH notify\n")); -+ } -+} -+ -+void EXhalbtc8723b2ant_MediaStatusNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ u8 H2C_Parameter[3] = {0}; -+ u32 wifiBw; -+ u8 wifiCentralChnl; -+ u8 apNum = 0; -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], MEDIA connect notify\n")); -+ } else { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if ((BTC_MEDIA_CONNECT == type) && (wifiCentralChnl <= 14)) { -+ H2C_Parameter[0] = 0x1; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if (BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ if (apNum < 10) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ BTC_PRINT( -+ BTC_MSG_ALGORITHM, -+ ALGO_TRACE_FW_EXEC, -+ ( -+ "[BTCoex], FW write 0x66 = 0x%x\n", -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2] -+ ) -+ ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter); -+} -+ -+void EXhalbtc8723b2ant_SpecialPacketNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ if (type == BTC_PACKET_DHCP) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], DHCP Packet notify\n")); -+ } -+} -+ -+void EXhalbtc8723b2ant_BtInfoNotify( -+ PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 length -+) -+{ -+ u8 btInfo = 0; -+ u8 i, rspSource = 0; -+ bool bBtBusy = false, bLimitedDig = false; -+ bool bWifiConnected = false; -+ -+ pCoexSta->bC2hBtInfoReqSent = false; -+ -+ rspSource = tmpBuf[0]&0xf; -+ if (rspSource >= BT_INFO_SRC_8723B_2ANT_MAX) -+ rspSource = BT_INFO_SRC_8723B_2ANT_WIFI_FW; -+ -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Bt info[%d], length =%d, hex data =[", rspSource, length)); -+ for (i = 0; i < length; i++) { -+ pCoexSta->btInfoC2h[rspSource][i] = tmpBuf[i]; -+ if (i == 1) -+ btInfo = tmpBuf[i]; -+ -+ if (i == length-1) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("0x%02x]\n", tmpBuf[i])); -+ } else { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ if (pBtCoexist->bManualControl) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), return for Manual CTRL<===\n")); -+ return; -+ } -+ -+ if (BT_INFO_SRC_8723B_2ANT_WIFI_FW != rspSource) { -+ pCoexSta->btRetryCnt = pCoexSta->btInfoC2h[rspSource][2]&0xf; /* [3:0] */ -+ -+ pCoexSta->btRssi = pCoexSta->btInfoC2h[rspSource][3]*2+10; -+ -+ pCoexSta->btInfoExt = pCoexSta->btInfoC2h[rspSource][4]; -+ -+ pCoexSta->bBtTxRxMask = (pCoexSta->btInfoC2h[rspSource][2]&0x40); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TX_RX_MASK, &pCoexSta->bBtTxRxMask); -+ if (pCoexSta->bBtTxRxMask) { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x01 => Need to switch BT TRx Mask */ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x01\n")); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x01); -+ } -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ if ((pCoexSta->btInfoExt & BIT1)) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ if (bWifiConnected) -+ EXhalbtc8723b2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT); -+ else -+ EXhalbtc8723b2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ -+ if ((pCoexSta->btInfoExt & BIT3)) { -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")); -+ halbtc8723b2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, false); -+ } else { -+ /* BT already NOT ignore Wlan active, do nothing here. */ -+ } -+ } -+ -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (btInfo & BT_INFO_8723B_2ANT_B_INQ_PAGE) -+ pCoexSta->bC2hBtInquiryPage = true; -+ else -+ pCoexSta->bC2hBtInquiryPage = false; -+ -+ /* set link exist status */ -+ if (!(btInfo&BT_INFO_8723B_2ANT_B_CONNECTION)) { -+ pCoexSta->bBtLinkExist = false; -+ pCoexSta->bPanExist = false; -+ pCoexSta->bA2dpExist = false; -+ pCoexSta->bHidExist = false; -+ pCoexSta->bScoExist = false; -+ } else { /* connection exists */ -+ pCoexSta->bBtLinkExist = true; -+ if (btInfo & BT_INFO_8723B_2ANT_B_FTP) -+ pCoexSta->bPanExist = true; -+ else -+ pCoexSta->bPanExist = false; -+ if (btInfo & BT_INFO_8723B_2ANT_B_A2DP) -+ pCoexSta->bA2dpExist = true; -+ else -+ pCoexSta->bA2dpExist = false; -+ if (btInfo & BT_INFO_8723B_2ANT_B_HID) -+ pCoexSta->bHidExist = true; -+ else -+ pCoexSta->bHidExist = false; -+ if (btInfo & BT_INFO_8723B_2ANT_B_SCO_ESCO) -+ pCoexSta->bScoExist = true; -+ else -+ pCoexSta->bScoExist = false; -+ } -+ -+ halbtc8723b2ant_UpdateBtLinkInfo(pBtCoexist); -+ -+ if (!(btInfo&BT_INFO_8723B_2ANT_B_CONNECTION)) { -+ pCoexDm->btStatus = BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n")); -+ } else if (btInfo == BT_INFO_8723B_2ANT_B_CONNECTION) { /* connection exists but no busy */ -+ pCoexDm->btStatus = BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n")); -+ } else if ( -+ (btInfo&BT_INFO_8723B_2ANT_B_SCO_ESCO) || -+ (btInfo&BT_INFO_8723B_2ANT_B_SCO_BUSY) -+ ) { -+ pCoexDm->btStatus = BT_8723B_2ANT_BT_STATUS_SCO_BUSY; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n")); -+ } else if (btInfo&BT_INFO_8723B_2ANT_B_ACL_BUSY) { -+ pCoexDm->btStatus = BT_8723B_2ANT_BT_STATUS_ACL_BUSY; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n")); -+ } else { -+ pCoexDm->btStatus = BT_8723B_2ANT_BT_STATUS_MAX; -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n")); -+ } -+ -+ if ( -+ (BT_8723B_2ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_2ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_2ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) -+ ) { -+ bBtBusy = true; -+ bLimitedDig = true; -+ } else { -+ bBtBusy = false; -+ bLimitedDig = false; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ pCoexDm->bLimitedDig = bLimitedDig; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bLimitedDig); -+ -+ halbtc8723b2ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+void EXhalbtc8723b2ant_HaltNotify(PBTC_COEXIST pBtCoexist) -+{ -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8723b2ant_WifiOffHwCfg(pBtCoexist); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); /* BT goto standby while GNT_BT 1-->0 */ -+ halbtc8723b2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, true); -+ -+ EXhalbtc8723b2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+void EXhalbtc8723b2ant_PnpNotify(PBTC_COEXIST pBtCoexist, u8 pnpState) -+{ -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Pnp notify\n")); -+ -+ if (BTC_WIFI_PNP_SLEEP == pnpState) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Pnp notify to SLEEP\n")); -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnpState) { -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Pnp notify to WAKE UP\n")); -+ halbtc8723b2ant_InitHwConfig(pBtCoexist, false); -+ halbtc8723b2ant_InitCoexDm(pBtCoexist); -+ halbtc8723b2ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+void EXhalbtc8723b2ant_Periodical(PBTC_COEXIST pBtCoexist) -+{ -+ static u8 disVerInfoCnt = 0; -+ u32 fwVer = 0, btPatchVer = 0; -+ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], ==========================Periodical ===========================\n")); -+ -+ if (disVerInfoCnt <= 5) { -+ disVerInfoCnt += 1; -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ****************************************************************\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", \ -+ GLCoexVerDate8723b2Ant, GLCoexVer8723b2Ant, fwVer, btPatchVer, btPatchVer)); -+ BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ****************************************************************\n")); -+ } -+ -+ if ( -+ halbtc8723b2ant_IsWifiStatusChanged(pBtCoexist) || -+ pCoexDm->bAutoTdmaAdjust -+ ) -+ halbtc8723b2ant_RunCoexistMechanism(pBtCoexist); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalBtc8723b2Ant.h linux/3rdparty/rtl8723bs/hal/HalBtc8723b2Ant.h ---- linux.old/3rdparty/rtl8723bs/hal/HalBtc8723b2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalBtc8723b2Ant.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,155 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/* The following is for 8723B 2Ant BT Co-exist definition */ -+#define BT_INFO_8723B_2ANT_B_FTP BIT7 -+#define BT_INFO_8723B_2ANT_B_A2DP BIT6 -+#define BT_INFO_8723B_2ANT_B_HID BIT5 -+#define BT_INFO_8723B_2ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8723B_2ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8723B_2ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8723B_2ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8723B_2ANT_B_CONNECTION BIT0 -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT 2 -+ -+typedef enum _BT_INFO_SRC_8723B_2ANT { -+ BT_INFO_SRC_8723B_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8723B_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8723B_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8723B_2ANT_MAX -+} BT_INFO_SRC_8723B_2ANT, *PBT_INFO_SRC_8723B_2ANT; -+ -+typedef enum _BT_8723B_2ANT_BT_STATUS { -+ BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8723B_2ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8723B_2ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8723B_2ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8723B_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8723B_2ANT_BT_STATUS_MAX -+} BT_8723B_2ANT_BT_STATUS, *PBT_8723B_2ANT_BT_STATUS; -+ -+typedef enum _BT_8723B_2ANT_COEX_ALGO { -+ BT_8723B_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8723B_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8723B_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8723B_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8723B_2ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8723B_2ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8723B_2ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8723B_2ANT_COEX_ALGO_MAX = 0xb, -+} BT_8723B_2ANT_COEX_ALGO, *PBT_8723B_2ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8723B_2ANT { -+ /* fw mechanism */ -+ u8 preBtDecPwrLvl; -+ u8 curBtDecPwrLvl; -+ u8 preFwDacSwingLvl; -+ u8 curFwDacSwingLvl; -+ bool bCurIgnoreWlanAct; -+ bool bPreIgnoreWlanAct; -+ u8 prePsTdma; -+ u8 curPsTdma; -+ u8 psTdmaPara[5]; -+ u8 psTdmaDuAdjType; -+ bool bResetTdmaAdjust; -+ bool bAutoTdmaAdjust; -+ bool bPrePsTdmaOn; -+ bool bCurPsTdmaOn; -+ bool bPreBtAutoReport; -+ bool bCurBtAutoReport; -+ -+ /* sw mechanism */ -+ bool bPreRfRxLpfShrink; -+ bool bCurRfRxLpfShrink; -+ u32 btRf0x1eBackup; -+ bool bPreLowPenaltyRa; -+ bool bCurLowPenaltyRa; -+ bool bPreDacSwingOn; -+ u32 preDacSwingLvl; -+ bool bCurDacSwingOn; -+ u32 curDacSwingLvl; -+ bool bPreAdcBackOff; -+ bool bCurAdcBackOff; -+ bool bPreAgcTableEn; -+ bool bCurAgcTableEn; -+ u32 preVal0x6c0; -+ u32 curVal0x6c0; -+ u32 preVal0x6c4; -+ u32 curVal0x6c4; -+ u32 preVal0x6c8; -+ u32 curVal0x6c8; -+ u8 preVal0x6cc; -+ u8 curVal0x6cc; -+ bool bLimitedDig; -+ -+ /* algorithm related */ -+ u8 preAlgorithm; -+ u8 curAlgorithm; -+ u8 btStatus; -+ u8 wifiChnlInfo[3]; -+ -+ bool bNeedRecover0x948; -+ u32 backup0x948; -+} COEX_DM_8723B_2ANT, *PCOEX_DM_8723B_2ANT; -+ -+typedef struct _COEX_STA_8723B_2ANT { -+ bool bBtLinkExist; -+ bool bScoExist; -+ bool bA2dpExist; -+ bool bHidExist; -+ bool bPanExist; -+ -+ bool bUnderLps; -+ bool bUnderIps; -+ u32 highPriorityTx; -+ u32 highPriorityRx; -+ u32 lowPriorityTx; -+ u32 lowPriorityRx; -+ u8 btRssi; -+ bool bBtTxRxMask; -+ u8 preBtRssiState; -+ u8 preWifiRssiState[4]; -+ bool bC2hBtInfoReqSent; -+ u8 btInfoC2h[BT_INFO_SRC_8723B_2ANT_MAX][10]; -+ u32 btInfoC2hCnt[BT_INFO_SRC_8723B_2ANT_MAX]; -+ bool bC2hBtInquiryPage; -+ u8 btRetryCnt; -+ u8 btInfoExt; -+} COEX_STA_8723B_2ANT, *PCOEX_STA_8723B_2ANT; -+ -+/* */ -+/* The following is interface which will notify coex module. */ -+/* */ -+void EXhalbtc8723b2ant_PowerOnSetting(PBTC_COEXIST pBtCoexist); -+void EXhalbtc8723b2ant_InitHwConfig(PBTC_COEXIST pBtCoexist, bool bWifiOnly); -+void EXhalbtc8723b2ant_InitCoexDm(PBTC_COEXIST pBtCoexist); -+void EXhalbtc8723b2ant_IpsNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtc8723b2ant_LpsNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtc8723b2ant_ScanNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtc8723b2ant_ConnectNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtc8723b2ant_MediaStatusNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtc8723b2ant_SpecialPacketNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtc8723b2ant_BtInfoNotify( -+ PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 length -+); -+void EXhalbtc8723b2ant_HaltNotify(PBTC_COEXIST pBtCoexist); -+void EXhalbtc8723b2ant_PnpNotify(PBTC_COEXIST pBtCoexist, u8 pnpState); -+void EXhalbtc8723b2ant_Periodical(PBTC_COEXIST pBtCoexist); -+void EXhalbtc8723b2ant_DisplayCoexInfo(PBTC_COEXIST pBtCoexist); -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/hal_btcoex.c linux/3rdparty/rtl8723bs/hal/hal_btcoex.c ---- linux.old/3rdparty/rtl8723bs/hal/hal_btcoex.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/hal_btcoex.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1720 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define __HAL_BTCOEX_C__ -+ -+#include -+#include -+#include -+#include -+ -+/* Global variables */ -+static const char *const BtProfileString[] = { -+ "NONE", -+ "A2DP", -+ "PAN", -+ "HID", -+ "SCO", -+}; -+ -+static const char *const BtSpecString[] = { -+ "1.0b", -+ "1.1", -+ "1.2", -+ "2.0+EDR", -+ "2.1+EDR", -+ "3.0+HS", -+ "4.0", -+}; -+ -+static const char *const BtLinkRoleString[] = { -+ "Master", -+ "Slave", -+}; -+ -+static const char *const h2cStaString[] = { -+ "successful", -+ "h2c busy", -+ "rf off", -+ "fw not read", -+}; -+ -+static const char *const ioStaString[] = { -+ "success", -+ "can not IO", -+ "rf off", -+ "fw not read", -+ "wait io timeout", -+ "invalid len", -+ "idle Q empty", -+ "insert waitQ fail", -+ "unknown fail", -+ "wrong level", -+ "h2c stopped", -+}; -+ -+BTC_COEXIST GLBtCoexist; -+static u8 GLBtcWiFiInScanState; -+static u8 GLBtcWiFiInIQKState; -+ -+u32 GLBtcDbgType[BTC_MSG_MAX]; -+static u8 GLBtcDbgBuf[BT_TMP_BUF_SIZE]; -+ -+typedef struct _btcoexdbginfo { -+ u8 *info; -+ u32 size; /* buffer total size */ -+ u32 len; /* now used length */ -+} BTCDBGINFO, *PBTCDBGINFO; -+ -+static BTCDBGINFO GLBtcDbgInfo; -+ -+#define BT_Operation(Adapter) false -+ -+static void DBG_BT_INFO_INIT(PBTCDBGINFO pinfo, u8 *pbuf, u32 size) -+{ -+ if (NULL == pinfo) -+ return; -+ -+ memset(pinfo, 0, sizeof(BTCDBGINFO)); -+ -+ if (pbuf && size) { -+ pinfo->info = pbuf; -+ pinfo->size = size; -+ } -+} -+ -+void DBG_BT_INFO(u8 *dbgmsg) -+{ -+ PBTCDBGINFO pinfo; -+ u32 msglen; -+ u8 *pbuf; -+ -+ -+ pinfo = &GLBtcDbgInfo; -+ -+ if (NULL == pinfo->info) -+ return; -+ -+ msglen = strlen(dbgmsg); -+ if (pinfo->len + msglen > pinfo->size) -+ return; -+ -+ pbuf = pinfo->info + pinfo->len; -+ memcpy(pbuf, dbgmsg, msglen); -+ pinfo->len += msglen; -+} -+ -+/* */ -+/* Debug related function */ -+/* */ -+static u8 halbtcoutsrc_IsBtCoexistAvailable(PBTC_COEXIST pBtCoexist) -+{ -+ if (!pBtCoexist->bBinded || -+ NULL == pBtCoexist->Adapter){ -+ return false; -+ } -+ return true; -+} -+ -+static void halbtcoutsrc_DbgInit(void) -+{ -+ u8 i; -+ -+ for (i = 0; i < BTC_MSG_MAX; i++) -+ GLBtcDbgType[i] = 0; -+ -+ GLBtcDbgType[BTC_MSG_INTERFACE] = \ -+/* INTF_INIT | */ -+/* INTF_NOTIFY | */ -+ 0; -+ -+ GLBtcDbgType[BTC_MSG_ALGORITHM] = \ -+/* ALGO_BT_RSSI_STATE | */ -+/* ALGO_WIFI_RSSI_STATE | */ -+/* ALGO_BT_MONITOR | */ -+/* ALGO_TRACE | */ -+/* ALGO_TRACE_FW | */ -+/* ALGO_TRACE_FW_DETAIL | */ -+/* ALGO_TRACE_FW_EXEC | */ -+/* ALGO_TRACE_SW | */ -+/* ALGO_TRACE_SW_DETAIL | */ -+/* ALGO_TRACE_SW_EXEC | */ -+ 0; -+} -+ -+static void halbtcoutsrc_LeaveLps(PBTC_COEXIST pBtCoexist) -+{ -+ struct adapter *padapter; -+ -+ -+ padapter = pBtCoexist->Adapter; -+ -+ pBtCoexist->btInfo.bBtCtrlLps = true; -+ pBtCoexist->btInfo.bBtLpsOn = false; -+ -+ rtw_btcoex_LPS_Leave(padapter); -+} -+ -+static void halbtcoutsrc_EnterLps(PBTC_COEXIST pBtCoexist) -+{ -+ struct adapter *padapter; -+ -+ -+ padapter = pBtCoexist->Adapter; -+ -+ pBtCoexist->btInfo.bBtCtrlLps = true; -+ pBtCoexist->btInfo.bBtLpsOn = true; -+ -+ rtw_btcoex_LPS_Enter(padapter); -+} -+ -+static void halbtcoutsrc_NormalLps(PBTC_COEXIST pBtCoexist) -+{ -+ struct adapter *padapter; -+ -+ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Normal LPS behavior!!!\n")); -+ -+ padapter = pBtCoexist->Adapter; -+ -+ if (pBtCoexist->btInfo.bBtCtrlLps) { -+ pBtCoexist->btInfo.bBtLpsOn = false; -+ rtw_btcoex_LPS_Leave(padapter); -+ pBtCoexist->btInfo.bBtCtrlLps = false; -+ -+ /* recover the LPS state to the original */ -+ } -+} -+ -+/* -+ * Constraint: -+ * 1. this function will request pwrctrl->lock -+ */ -+static void halbtcoutsrc_LeaveLowPower(PBTC_COEXIST pBtCoexist) -+{ -+ struct adapter *padapter; -+ struct hal_com_data *pHalData; -+ s32 ready; -+ unsigned long stime; -+ unsigned long utime; -+ u32 timeout; /* unit: ms */ -+ -+ -+ padapter = pBtCoexist->Adapter; -+ pHalData = GET_HAL_DATA(padapter); -+ ready = _FAIL; -+#ifdef LPS_RPWM_WAIT_MS -+ timeout = LPS_RPWM_WAIT_MS; -+#else /* !LPS_RPWM_WAIT_MS */ -+ timeout = 30; -+#endif /* !LPS_RPWM_WAIT_MS */ -+ -+ stime = jiffies; -+ do { -+ ready = rtw_register_task_alive(padapter, BTCOEX_ALIVE); -+ if (_SUCCESS == ready) -+ break; -+ -+ utime = jiffies_to_msecs(jiffies - stime); -+ if (utime > timeout) -+ break; -+ -+ msleep(1); -+ } while (1); -+} -+ -+/* -+ * Constraint: -+ * 1. this function will request pwrctrl->lock -+ */ -+static void halbtcoutsrc_NormalLowPower(PBTC_COEXIST pBtCoexist) -+{ -+ struct adapter *padapter; -+ -+ -+ padapter = pBtCoexist->Adapter; -+ rtw_unregister_task_alive(padapter, BTCOEX_ALIVE); -+} -+ -+static void halbtcoutsrc_DisableLowPower(PBTC_COEXIST pBtCoexist, u8 bLowPwrDisable) -+{ -+ pBtCoexist->btInfo.bBtDisableLowPwr = bLowPwrDisable; -+ if (bLowPwrDisable) -+ halbtcoutsrc_LeaveLowPower(pBtCoexist); /* leave 32k low power. */ -+ else -+ halbtcoutsrc_NormalLowPower(pBtCoexist); /* original 32k low power behavior. */ -+} -+ -+static void halbtcoutsrc_AggregationCheck(PBTC_COEXIST pBtCoexist) -+{ -+ struct adapter *padapter; -+ bool bNeedToAct; -+ -+ -+ padapter = pBtCoexist->Adapter; -+ bNeedToAct = false; -+ -+ if (pBtCoexist->btInfo.bRejectAggPkt) -+ rtw_btcoex_RejectApAggregatedPacket(padapter, true); -+ else{ -+ -+ if (pBtCoexist->btInfo.bPreBtCtrlAggBufSize != -+ pBtCoexist->btInfo.bBtCtrlAggBufSize){ -+ -+ bNeedToAct = true; -+ pBtCoexist->btInfo.bPreBtCtrlAggBufSize = pBtCoexist->btInfo.bBtCtrlAggBufSize; -+ } -+ -+ if (pBtCoexist->btInfo.bBtCtrlAggBufSize) { -+ if (pBtCoexist->btInfo.preAggBufSize != -+ pBtCoexist->btInfo.aggBufSize){ -+ bNeedToAct = true; -+ } -+ pBtCoexist->btInfo.preAggBufSize = pBtCoexist->btInfo.aggBufSize; -+ } -+ -+ if (bNeedToAct) { -+ rtw_btcoex_RejectApAggregatedPacket(padapter, true); -+ rtw_btcoex_RejectApAggregatedPacket(padapter, false); -+ } -+ } -+} -+ -+static u8 halbtcoutsrc_IsWifiBusy(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv; -+ -+ -+ pmlmepriv = &padapter->mlmepriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == true) { -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ return true; -+ if (true == pmlmepriv->LinkDetectInfo.bBusyTraffic) -+ return true; -+ } -+ -+ return false; -+} -+ -+static u32 _halbtcoutsrc_GetWifiLinkStatus(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv; -+ u8 bp2p; -+ u32 portConnectedStatus; -+ -+ -+ pmlmepriv = &padapter->mlmepriv; -+ bp2p = false; -+ portConnectedStatus = 0; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == true) { -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) { -+ if (true == bp2p) -+ portConnectedStatus |= WIFI_P2P_GO_CONNECTED; -+ else -+ portConnectedStatus |= WIFI_AP_CONNECTED; -+ } else { -+ if (true == bp2p) -+ portConnectedStatus |= WIFI_P2P_GC_CONNECTED; -+ else -+ portConnectedStatus |= WIFI_STA_CONNECTED; -+ } -+ } -+ -+ return portConnectedStatus; -+} -+ -+static u32 halbtcoutsrc_GetWifiLinkStatus(PBTC_COEXIST pBtCoexist) -+{ -+ /* */ -+ /* return value: */ -+ /* [31:16]=> connected port number */ -+ /* [15:0]=> port connected bit define */ -+ /* */ -+ -+ struct adapter *padapter; -+ u32 retVal; -+ u32 portConnectedStatus, numOfConnectedPort; -+ -+ -+ padapter = pBtCoexist->Adapter; -+ portConnectedStatus = 0; -+ numOfConnectedPort = 0; -+ -+ retVal = _halbtcoutsrc_GetWifiLinkStatus(padapter); -+ if (retVal) { -+ portConnectedStatus |= retVal; -+ numOfConnectedPort++; -+ } -+ -+ retVal = (numOfConnectedPort << 16) | portConnectedStatus; -+ -+ return retVal; -+} -+ -+static u32 halbtcoutsrc_GetBtPatchVer(PBTC_COEXIST pBtCoexist) -+{ -+ return pBtCoexist->btInfo.btRealFwVer; -+} -+ -+static s32 halbtcoutsrc_GetWifiRssi(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ s32 UndecoratedSmoothedPWDB = 0; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ UndecoratedSmoothedPWDB = pHalData->dmpriv.EntryMinUndecoratedSmoothedPWDB; -+ -+ return UndecoratedSmoothedPWDB; -+} -+ -+static u8 halbtcoutsrc_GetWifiScanAPNum(struct adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext; -+ static u8 scan_AP_num = 0; -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ -+ if (GLBtcWiFiInScanState == false) { -+ if (pmlmeext->sitesurvey_res.bss_cnt > 0xFF) -+ scan_AP_num = 0xFF; -+ else -+ scan_AP_num = (u8)pmlmeext->sitesurvey_res.bss_cnt; -+ } -+ -+ return scan_AP_num; -+} -+ -+static u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ struct hal_com_data *pHalData; -+ struct mlme_ext_priv *mlmeext; -+ u8 *pu8; -+ s32 *pS4Tmp; -+ u32 *pU4Tmp; -+ u8 *pU1Tmp; -+ u8 ret; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return false; -+ -+ padapter = pBtCoexist->Adapter; -+ pHalData = GET_HAL_DATA(padapter); -+ mlmeext = &padapter->mlmeextpriv; -+ pu8 = (u8 *)pOutBuf; -+ pS4Tmp = (s32 *)pOutBuf; -+ pU4Tmp = (u32 *)pOutBuf; -+ pU1Tmp = (u8 *)pOutBuf; -+ ret = true; -+ -+ switch (getType) { -+ case BTC_GET_BL_HS_OPERATION: -+ *pu8 = false; -+ ret = false; -+ break; -+ -+ case BTC_GET_BL_HS_CONNECTING: -+ *pu8 = false; -+ ret = false; -+ break; -+ -+ case BTC_GET_BL_WIFI_CONNECTED: -+ *pu8 = check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE); -+ break; -+ -+ case BTC_GET_BL_WIFI_BUSY: -+ *pu8 = halbtcoutsrc_IsWifiBusy(padapter); -+ break; -+ -+ case BTC_GET_BL_WIFI_SCAN: -+ /* Use the value of the new variable GLBtcWiFiInScanState to judge whether WiFi is in scan state or not, since the originally used flag -+ WIFI_SITE_MONITOR in fwstate may not be cleared in time */ -+ *pu8 = GLBtcWiFiInScanState; -+ break; -+ -+ case BTC_GET_BL_WIFI_LINK: -+ *pu8 = check_fwstate(&padapter->mlmepriv, WIFI_UNDER_LINKING); -+ break; -+ -+ case BTC_GET_BL_WIFI_ROAM: -+ *pu8 = check_fwstate(&padapter->mlmepriv, WIFI_UNDER_LINKING); -+ break; -+ -+ case BTC_GET_BL_WIFI_4_WAY_PROGRESS: -+ *pu8 = false; -+ break; -+ -+ case BTC_GET_BL_WIFI_UNDER_5G: -+ *pu8 = (pHalData->CurrentBandType == 1) ? true : false; -+ break; -+ -+ case BTC_GET_BL_WIFI_AP_MODE_ENABLE: -+ *pu8 = check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE); -+ break; -+ -+ case BTC_GET_BL_WIFI_ENABLE_ENCRYPTION: -+ *pu8 = padapter->securitypriv.dot11PrivacyAlgrthm == 0 ? false : true; -+ break; -+ -+ case BTC_GET_BL_WIFI_UNDER_B_MODE: -+ if (mlmeext->cur_wireless_mode == WIRELESS_11B) -+ *pu8 = true; -+ else -+ *pu8 = false; -+ break; -+ -+ case BTC_GET_BL_WIFI_IS_IN_MP_MODE: -+ *pu8 = false; -+ break; -+ -+ case BTC_GET_BL_EXT_SWITCH: -+ *pu8 = false; -+ break; -+ -+ case BTC_GET_S4_WIFI_RSSI: -+ *pS4Tmp = halbtcoutsrc_GetWifiRssi(padapter); -+ break; -+ -+ case BTC_GET_S4_HS_RSSI: -+ *pS4Tmp = 0; -+ ret = false; -+ break; -+ -+ case BTC_GET_U4_WIFI_BW: -+ if (IsLegacyOnly(mlmeext->cur_wireless_mode)) -+ *pU4Tmp = BTC_WIFI_BW_LEGACY; -+ else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) -+ *pU4Tmp = BTC_WIFI_BW_HT20; -+ else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) -+ *pU4Tmp = BTC_WIFI_BW_HT40; -+ else -+ *pU4Tmp = BTC_WIFI_BW_HT40; /* todo */ -+ break; -+ -+ case BTC_GET_U4_WIFI_TRAFFIC_DIRECTION: -+ { -+ PRT_LINK_DETECT_T plinkinfo; -+ plinkinfo = &padapter->mlmepriv.LinkDetectInfo; -+ -+ if (plinkinfo->NumTxOkInPeriod > plinkinfo->NumRxOkInPeriod) -+ *pU4Tmp = BTC_WIFI_TRAFFIC_TX; -+ else -+ *pU4Tmp = BTC_WIFI_TRAFFIC_RX; -+ } -+ break; -+ -+ case BTC_GET_U4_WIFI_FW_VER: -+ *pU4Tmp = pHalData->FirmwareVersion << 16; -+ *pU4Tmp |= pHalData->FirmwareSubVersion; -+ break; -+ -+ case BTC_GET_U4_WIFI_LINK_STATUS: -+ *pU4Tmp = halbtcoutsrc_GetWifiLinkStatus(pBtCoexist); -+ break; -+ -+ case BTC_GET_U4_BT_PATCH_VER: -+ *pU4Tmp = halbtcoutsrc_GetBtPatchVer(pBtCoexist); -+ break; -+ -+ case BTC_GET_U1_WIFI_DOT11_CHNL: -+ *pU1Tmp = padapter->mlmeextpriv.cur_channel; -+ break; -+ -+ case BTC_GET_U1_WIFI_CENTRAL_CHNL: -+ *pU1Tmp = pHalData->CurrentChannel; -+ break; -+ -+ case BTC_GET_U1_WIFI_HS_CHNL: -+ *pU1Tmp = 0; -+ ret = false; -+ break; -+ -+ case BTC_GET_U1_MAC_PHY_MODE: -+ *pU1Tmp = BTC_SMSP; -+/* *pU1Tmp = BTC_DMSP; */ -+/* *pU1Tmp = BTC_DMDP; */ -+/* *pU1Tmp = BTC_MP_UNKNOWN; */ -+ break; -+ -+ case BTC_GET_U1_AP_NUM: -+ *pU1Tmp = halbtcoutsrc_GetWifiScanAPNum(padapter); -+ break; -+ -+ /* 1Ant =========== */ -+ case BTC_GET_U1_LPS_MODE: -+ *pU1Tmp = padapter->dvobj->pwrctl_priv.pwr_mode; -+ break; -+ -+ default: -+ ret = false; -+ break; -+ } -+ -+ return ret; -+} -+ -+static u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ struct hal_com_data *pHalData; -+ u8 *pu8; -+ u8 *pU1Tmp; -+ u32 *pU4Tmp; -+ u8 ret; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ pHalData = GET_HAL_DATA(padapter); -+ pu8 = (u8 *)pInBuf; -+ pU1Tmp = (u8 *)pInBuf; -+ pU4Tmp = (u32 *)pInBuf; -+ ret = true; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return false; -+ -+ switch (setType) { -+ /* set some u8 type variables. */ -+ case BTC_SET_BL_BT_DISABLE: -+ pBtCoexist->btInfo.bBtDisabled = *pu8; -+ break; -+ -+ case BTC_SET_BL_BT_TRAFFIC_BUSY: -+ pBtCoexist->btInfo.bBtBusy = *pu8; -+ break; -+ -+ case BTC_SET_BL_BT_LIMITED_DIG: -+ pBtCoexist->btInfo.bLimitedDig = *pu8; -+ break; -+ -+ case BTC_SET_BL_FORCE_TO_ROAM: -+ pBtCoexist->btInfo.bForceToRoam = *pu8; -+ break; -+ -+ case BTC_SET_BL_TO_REJ_AP_AGG_PKT: -+ pBtCoexist->btInfo.bRejectAggPkt = *pu8; -+ break; -+ -+ case BTC_SET_BL_BT_CTRL_AGG_SIZE: -+ pBtCoexist->btInfo.bBtCtrlAggBufSize = *pu8; -+ break; -+ -+ case BTC_SET_BL_INC_SCAN_DEV_NUM: -+ pBtCoexist->btInfo.bIncreaseScanDevNum = *pu8; -+ break; -+ -+ case BTC_SET_BL_BT_TX_RX_MASK: -+ pBtCoexist->btInfo.bBtTxRxMask = *pu8; -+ break; -+ -+ /* set some u8 type variables. */ -+ case BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON: -+ pBtCoexist->btInfo.rssiAdjustForAgcTableOn = *pU1Tmp; -+ break; -+ -+ case BTC_SET_U1_AGG_BUF_SIZE: -+ pBtCoexist->btInfo.aggBufSize = *pU1Tmp; -+ break; -+ -+ /* the following are some action which will be triggered */ -+ case BTC_SET_ACT_GET_BT_RSSI: -+ ret = false; -+ break; -+ -+ case BTC_SET_ACT_AGGREGATE_CTRL: -+ halbtcoutsrc_AggregationCheck(pBtCoexist); -+ break; -+ -+ /* 1Ant =========== */ -+ /* set some u8 type variables. */ -+ case BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE: -+ pBtCoexist->btInfo.rssiAdjustFor1AntCoexType = *pU1Tmp; -+ break; -+ -+ case BTC_SET_U1_LPS_VAL: -+ pBtCoexist->btInfo.lpsVal = *pU1Tmp; -+ break; -+ -+ case BTC_SET_U1_RPWM_VAL: -+ pBtCoexist->btInfo.rpwmVal = *pU1Tmp; -+ break; -+ -+ /* the following are some action which will be triggered */ -+ case BTC_SET_ACT_LEAVE_LPS: -+ halbtcoutsrc_LeaveLps(pBtCoexist); -+ break; -+ -+ case BTC_SET_ACT_ENTER_LPS: -+ halbtcoutsrc_EnterLps(pBtCoexist); -+ break; -+ -+ case BTC_SET_ACT_NORMAL_LPS: -+ halbtcoutsrc_NormalLps(pBtCoexist); -+ break; -+ -+ case BTC_SET_ACT_DISABLE_LOW_POWER: -+ halbtcoutsrc_DisableLowPower(pBtCoexist, *pu8); -+ break; -+ -+ case BTC_SET_ACT_UPDATE_RAMASK: -+ pBtCoexist->btInfo.raMask = *pU4Tmp; -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) == true) { -+ struct sta_info *psta; -+ struct wlan_bssid_ex *cur_network; -+ -+ cur_network = &padapter->mlmeextpriv.mlmext_info.network; -+ psta = rtw_get_stainfo(&padapter->stapriv, cur_network->MacAddress); -+ rtw_hal_update_ra_mask(psta, 0); -+ } -+ break; -+ -+ case BTC_SET_ACT_SEND_MIMO_PS: -+ ret = false; -+ break; -+ -+ case BTC_SET_ACT_CTRL_BT_INFO: -+ ret = false; -+ break; -+ -+ case BTC_SET_ACT_CTRL_BT_COEX: -+ ret = false; -+ break; -+ case BTC_SET_ACT_CTRL_8723B_ANT: -+ ret = false; -+ break; -+ /* */ -+ default: -+ ret = false; -+ break; -+ } -+ -+ return ret; -+} -+ -+static void halbtcoutsrc_DisplayFwPwrModeCmd(PBTC_COEXIST pBtCoexist) -+{ -+ u8 *cliBuf = pBtCoexist->cliBuf; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x ", "Power mode cmd ", \ -+ pBtCoexist->pwrModeVal[0], pBtCoexist->pwrModeVal[1], -+ pBtCoexist->pwrModeVal[2], pBtCoexist->pwrModeVal[3], -+ pBtCoexist->pwrModeVal[4], pBtCoexist->pwrModeVal[5]); -+ CL_PRINTF(cliBuf); -+} -+ -+/* */ -+/* IO related function */ -+/* */ -+static u8 halbtcoutsrc_Read1Byte(void *pBtcContext, u32 RegAddr) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return rtw_read8(padapter, RegAddr); -+} -+ -+static u16 halbtcoutsrc_Read2Byte(void *pBtcContext, u32 RegAddr) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return rtw_read16(padapter, RegAddr); -+} -+ -+static u32 halbtcoutsrc_Read4Byte(void *pBtcContext, u32 RegAddr) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return rtw_read32(padapter, RegAddr); -+} -+ -+static void halbtcoutsrc_Write1Byte(void *pBtcContext, u32 RegAddr, u8 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ rtw_write8(padapter, RegAddr, Data); -+} -+ -+static void halbtcoutsrc_BitMaskWrite1Byte(void *pBtcContext, u32 regAddr, u8 bitMask, u8 data1b) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ u8 originalValue, bitShift; -+ u8 i; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ originalValue = 0; -+ bitShift = 0; -+ -+ if (bitMask != 0xFF) { -+ originalValue = rtw_read8(padapter, regAddr); -+ -+ for (i = 0; i <= 7; i++) { -+ if ((bitMask>>i)&0x1) -+ break; -+ } -+ bitShift = i; -+ -+ data1b = (originalValue & ~bitMask) | ((data1b << bitShift) & bitMask); -+ } -+ -+ rtw_write8(padapter, regAddr, data1b); -+} -+ -+static void halbtcoutsrc_Write2Byte(void *pBtcContext, u32 RegAddr, u16 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ rtw_write16(padapter, RegAddr, Data); -+} -+ -+static void halbtcoutsrc_Write4Byte(void *pBtcContext, u32 RegAddr, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ rtw_write32(padapter, RegAddr, Data); -+} -+ -+static void halbtcoutsrc_WriteLocalReg1Byte(void *pBtcContext, u32 RegAddr, u8 Data) -+{ -+ PBTC_COEXIST pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ struct adapter *Adapter = pBtCoexist->Adapter; -+ -+ if (BTC_INTF_SDIO == pBtCoexist->chipInterface) { -+ rtw_write8(Adapter, SDIO_LOCAL_BASE | RegAddr, Data); -+ } else { -+ rtw_write8(Adapter, RegAddr, Data); -+ } -+} -+ -+static void halbtcoutsrc_SetBbReg(void *pBtcContext, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ PHY_SetBBReg(padapter, RegAddr, BitMask, Data); -+} -+ -+ -+static u32 halbtcoutsrc_GetBbReg(void *pBtcContext, u32 RegAddr, u32 BitMask) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return PHY_QueryBBReg(padapter, RegAddr, BitMask); -+} -+ -+static void halbtcoutsrc_SetRfReg(void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ PHY_SetRFReg(padapter, eRFPath, RegAddr, BitMask, Data); -+} -+ -+static u32 halbtcoutsrc_GetRfReg(void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMask) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return PHY_QueryRFReg(padapter, eRFPath, RegAddr, BitMask); -+} -+ -+static void halbtcoutsrc_SetBtReg(void *pBtcContext, u8 RegType, u32 RegAddr, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ u8 CmdBuffer1[4] = {0}; -+ u8 CmdBuffer2[4] = {0}; -+ u8 *AddrToSet = (u8 *)&RegAddr; -+ u8 *ValueToSet = (u8 *)&Data; -+ u8 OperVer = 0; -+ u8 ReqNum = 0; -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ CmdBuffer1[0] |= (OperVer & 0x0f); /* Set OperVer */ -+ CmdBuffer1[0] |= ((ReqNum << 4) & 0xf0); /* Set ReqNum */ -+ CmdBuffer1[1] = 0x0d; /* Set OpCode to BT_LO_OP_WRITE_REG_VALUE */ -+ CmdBuffer1[2] = ValueToSet[0]; /* Set WriteRegValue */ -+ rtw_hal_fill_h2c_cmd(padapter, 0x67, 4, &(CmdBuffer1[0])); -+ -+ msleep(200); -+ ReqNum++; -+ -+ CmdBuffer2[0] |= (OperVer & 0x0f); /* Set OperVer */ -+ CmdBuffer2[0] |= ((ReqNum << 4) & 0xf0); /* Set ReqNum */ -+ CmdBuffer2[1] = 0x0c; /* Set OpCode of BT_LO_OP_WRITE_REG_ADDR */ -+ CmdBuffer2[3] = AddrToSet[0]; /* Set WriteRegAddr */ -+ rtw_hal_fill_h2c_cmd(padapter, 0x67, 4, &(CmdBuffer2[0])); -+} -+ -+static u32 halbtcoutsrc_GetBtReg(void *pBtcContext, u8 RegType, u32 RegAddr) -+{ -+ /* To be implemented. Always return 0 temporarily */ -+ return 0; -+} -+ -+static void halbtcoutsrc_FillH2cCmd(void *pBtcContext, u8 elementId, u32 cmdLen, u8 *pCmdBuffer) -+{ -+ PBTC_COEXIST pBtCoexist; -+ struct adapter *padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ rtw_hal_fill_h2c_cmd(padapter, elementId, cmdLen, pCmdBuffer); -+} -+ -+static void halbtcoutsrc_DisplayDbgMsg(void *pBtcContext, u8 dispType) -+{ -+ PBTC_COEXIST pBtCoexist; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ switch (dispType) { -+ case BTC_DBG_DISP_COEX_STATISTICS: -+ break; -+ case BTC_DBG_DISP_BT_LINK_INFO: -+ break; -+ case BTC_DBG_DISP_FW_PWR_MODE_CMD: -+ halbtcoutsrc_DisplayFwPwrModeCmd(pBtCoexist); -+ break; -+ default: -+ break; -+ } -+} -+ -+/* */ -+/* Extern functions called by other module */ -+/* */ -+static u8 EXhalbtcoutsrc_BindBtCoexWithAdapter(void *padapter) -+{ -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ -+ if (pBtCoexist->bBinded) -+ return false; -+ else -+ pBtCoexist->bBinded = true; -+ -+ pBtCoexist->statistics.cntBind++; -+ -+ pBtCoexist->Adapter = padapter; -+ -+ pBtCoexist->stackInfo.bProfileNotified = false; -+ -+ pBtCoexist->btInfo.bBtCtrlAggBufSize = false; -+ pBtCoexist->btInfo.aggBufSize = 5; -+ -+ pBtCoexist->btInfo.bIncreaseScanDevNum = false; -+ -+ /* set default antenna position to main port */ -+ pBtCoexist->boardInfo.btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+ -+ return true; -+} -+ -+u8 EXhalbtcoutsrc_InitlizeVariables(void *padapter) -+{ -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ -+ /* pBtCoexist->statistics.cntBind++; */ -+ -+ halbtcoutsrc_DbgInit(); -+ -+ pBtCoexist->chipInterface = BTC_INTF_SDIO; -+ -+ EXhalbtcoutsrc_BindBtCoexWithAdapter(padapter); -+ -+ pBtCoexist->fBtcRead1Byte = halbtcoutsrc_Read1Byte; -+ pBtCoexist->fBtcWrite1Byte = halbtcoutsrc_Write1Byte; -+ pBtCoexist->fBtcWrite1ByteBitMask = halbtcoutsrc_BitMaskWrite1Byte; -+ pBtCoexist->fBtcRead2Byte = halbtcoutsrc_Read2Byte; -+ pBtCoexist->fBtcWrite2Byte = halbtcoutsrc_Write2Byte; -+ pBtCoexist->fBtcRead4Byte = halbtcoutsrc_Read4Byte; -+ pBtCoexist->fBtcWrite4Byte = halbtcoutsrc_Write4Byte; -+ pBtCoexist->fBtcWriteLocalReg1Byte = halbtcoutsrc_WriteLocalReg1Byte; -+ -+ pBtCoexist->fBtcSetBbReg = halbtcoutsrc_SetBbReg; -+ pBtCoexist->fBtcGetBbReg = halbtcoutsrc_GetBbReg; -+ -+ pBtCoexist->fBtcSetRfReg = halbtcoutsrc_SetRfReg; -+ pBtCoexist->fBtcGetRfReg = halbtcoutsrc_GetRfReg; -+ -+ pBtCoexist->fBtcFillH2c = halbtcoutsrc_FillH2cCmd; -+ pBtCoexist->fBtcDispDbgMsg = halbtcoutsrc_DisplayDbgMsg; -+ -+ pBtCoexist->fBtcGet = halbtcoutsrc_Get; -+ pBtCoexist->fBtcSet = halbtcoutsrc_Set; -+ pBtCoexist->fBtcGetBtReg = halbtcoutsrc_GetBtReg; -+ pBtCoexist->fBtcSetBtReg = halbtcoutsrc_SetBtReg; -+ -+ pBtCoexist->cliBuf = &GLBtcDbgBuf[0]; -+ -+ pBtCoexist->boardInfo.singleAntPath = 0; -+ -+ GLBtcWiFiInScanState = false; -+ -+ GLBtcWiFiInIQKState = false; -+ -+ return true; -+} -+ -+void EXhalbtcoutsrc_PowerOnSetting(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ /* Power on setting function is only added in 8723B currently */ -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_PowerOnSetting(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_PowerOnSetting(pBtCoexist); -+} -+ -+void EXhalbtcoutsrc_InitHwConfig(PBTC_COEXIST pBtCoexist, u8 bWifiOnly) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntInitHwConfig++; -+ -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_InitHwConfig(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_InitHwConfig(pBtCoexist, bWifiOnly); -+} -+ -+void EXhalbtcoutsrc_InitCoexDm(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntInitCoexDm++; -+ -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_InitCoexDm(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_InitCoexDm(pBtCoexist); -+ -+ pBtCoexist->bInitilized = true; -+} -+ -+void EXhalbtcoutsrc_IpsNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ u8 ipsType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntIpsNotify++; -+ if (pBtCoexist->bManualControl) -+ return; -+ -+ if (IPS_NONE == type) -+ ipsType = BTC_IPS_LEAVE; -+ else -+ ipsType = BTC_IPS_ENTER; -+ -+ /* All notify is called in cmd thread, don't need to leave low power again */ -+/* halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_IpsNotify(pBtCoexist, ipsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_IpsNotify(pBtCoexist, ipsType); -+ -+/* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_LpsNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ u8 lpsType; -+ -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntLpsNotify++; -+ if (pBtCoexist->bManualControl) -+ return; -+ -+ if (PS_MODE_ACTIVE == type) -+ lpsType = BTC_LPS_DISABLE; -+ else -+ lpsType = BTC_LPS_ENABLE; -+ -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_LpsNotify(pBtCoexist, lpsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_LpsNotify(pBtCoexist, lpsType); -+} -+ -+void EXhalbtcoutsrc_ScanNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ u8 scanType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cntScanNotify++; -+ if (pBtCoexist->bManualControl) -+ return; -+ -+ if (type) { -+ scanType = BTC_SCAN_START; -+ GLBtcWiFiInScanState = true; -+ } else { -+ scanType = BTC_SCAN_FINISH; -+ GLBtcWiFiInScanState = false; -+ } -+ -+ /* All notify is called in cmd thread, don't need to leave low power again */ -+/* halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_ScanNotify(pBtCoexist, scanType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_ScanNotify(pBtCoexist, scanType); -+ -+/* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_ConnectNotify(PBTC_COEXIST pBtCoexist, u8 action) -+{ -+ u8 assoType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cntConnectNotify++; -+ if (pBtCoexist->bManualControl) -+ return; -+ -+ if (action) -+ assoType = BTC_ASSOCIATE_START; -+ else -+ assoType = BTC_ASSOCIATE_FINISH; -+ -+ /* All notify is called in cmd thread, don't need to leave low power again */ -+/* halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_ConnectNotify(pBtCoexist, assoType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_ConnectNotify(pBtCoexist, assoType); -+ -+/* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_MediaStatusNotify(PBTC_COEXIST pBtCoexist, RT_MEDIA_STATUS mediaStatus) -+{ -+ u8 mStatus; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntMediaStatusNotify++; -+ if (pBtCoexist->bManualControl) -+ return; -+ -+ if (RT_MEDIA_CONNECT == mediaStatus) -+ mStatus = BTC_MEDIA_CONNECT; -+ else -+ mStatus = BTC_MEDIA_DISCONNECT; -+ -+ /* All notify is called in cmd thread, don't need to leave low power again */ -+/* halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_MediaStatusNotify(pBtCoexist, mStatus); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, mStatus); -+ -+/* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_SpecialPacketNotify(PBTC_COEXIST pBtCoexist, u8 pktType) -+{ -+ u8 packetType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cntSpecialPacketNotify++; -+ if (pBtCoexist->bManualControl) -+ return; -+ -+ if (PACKET_DHCP == pktType) -+ packetType = BTC_PACKET_DHCP; -+ else if (PACKET_EAPOL == pktType) -+ packetType = BTC_PACKET_EAPOL; -+ else if (PACKET_ARP == pktType) -+ packetType = BTC_PACKET_ARP; -+ else{ -+ packetType = BTC_PACKET_UNKNOWN; -+ return; -+ } -+ -+ /* All notify is called in cmd thread, don't need to leave low power again */ -+/* halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_SpecialPacketNotify(pBtCoexist, packetType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_SpecialPacketNotify(pBtCoexist, packetType); -+ -+/* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_BtInfoNotify(PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 length) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntBtInfoNotify++; -+ -+ /* All notify is called in cmd thread, don't need to leave low power again */ -+/* halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_BtInfoNotify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_BtInfoNotify(pBtCoexist, tmpBuf, length); -+ -+/* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_HaltNotify(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_HaltNotify(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_HaltNotify(pBtCoexist); -+ -+ pBtCoexist->bBinded = false; -+} -+ -+void EXhalbtcoutsrc_PnpNotify(PBTC_COEXIST pBtCoexist, u8 pnpState) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ /* */ -+ /* currently only 1ant we have to do the notification, */ -+ /* once pnp is notified to sleep state, we have to leave LPS that we can sleep normally. */ -+ /* */ -+ -+ if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_PnpNotify(pBtCoexist, pnpState); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_PnpNotify(pBtCoexist, pnpState); -+} -+ -+void EXhalbtcoutsrc_Periodical(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cntPeriodical++; -+ -+ /* Periodical should be called in cmd thread, */ -+ /* don't need to leave low power again */ -+/* halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_Periodical(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_Periodical(pBtCoexist); -+ -+/* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_SetChipType(u8 chipType) -+{ -+ GLBtCoexist.boardInfo.btChipType = BTC_CHIP_RTL8723B; -+} -+ -+void EXhalbtcoutsrc_SetAntNum(u8 type, u8 antNum) -+{ -+ if (BT_COEX_ANT_TYPE_PG == type) { -+ GLBtCoexist.boardInfo.pgAntNum = antNum; -+ GLBtCoexist.boardInfo.btdmAntNum = antNum; -+ } else if (BT_COEX_ANT_TYPE_ANTDIV == type) { -+ GLBtCoexist.boardInfo.btdmAntNum = antNum; -+ /* GLBtCoexist.boardInfo.btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; */ -+ } else if (BT_COEX_ANT_TYPE_DETECTED == type) { -+ GLBtCoexist.boardInfo.btdmAntNum = antNum; -+ /* GLBtCoexist.boardInfo.btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; */ -+ } -+} -+ -+/* */ -+/* Currently used by 8723b only, S0 or S1 */ -+/* */ -+void EXhalbtcoutsrc_SetSingleAntPath(u8 singleAntPath) -+{ -+ GLBtCoexist.boardInfo.singleAntPath = singleAntPath; -+} -+ -+void EXhalbtcoutsrc_DisplayBtCoexInfo(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_DisplayCoexInfo(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_DisplayCoexInfo(pBtCoexist); -+ -+ halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+/* -+ * Description: -+ *Run BT-Coexist mechansim or not -+ * -+ */ -+void hal_btcoex_SetBTCoexist(struct adapter *padapter, u8 bBtExist) -+{ -+ struct hal_com_data *pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pHalData->bt_coexist.bBtExist = bBtExist; -+} -+ -+/* -+ * Dewcription: -+ *Check is co-exist mechanism enabled or not -+ * -+ * Return: -+ *true Enable BT co-exist mechanism -+ *false Disable BT co-exist mechanism -+ */ -+u8 hal_btcoex_IsBtExist(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ return pHalData->bt_coexist.bBtExist; -+} -+ -+u8 hal_btcoex_IsBtDisabled(struct adapter *padapter) -+{ -+ if (!hal_btcoex_IsBtExist(padapter)) -+ return true; -+ -+ if (GLBtCoexist.btInfo.bBtDisabled) -+ return true; -+ else -+ return false; -+} -+ -+void hal_btcoex_SetChipType(struct adapter *padapter, u8 chipType) -+{ -+ struct hal_com_data *pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pHalData->bt_coexist.btChipType = chipType; -+ -+ EXhalbtcoutsrc_SetChipType(chipType); -+} -+ -+void hal_btcoex_SetPgAntNum(struct adapter *padapter, u8 antNum) -+{ -+ struct hal_com_data *pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ pHalData->bt_coexist.btTotalAntNum = antNum; -+ EXhalbtcoutsrc_SetAntNum(BT_COEX_ANT_TYPE_PG, antNum); -+} -+ -+void hal_btcoex_SetSingleAntPath(struct adapter *padapter, u8 singleAntPath) -+{ -+ EXhalbtcoutsrc_SetSingleAntPath(singleAntPath); -+} -+ -+u8 hal_btcoex_Initialize(struct adapter *padapter) -+{ -+ u8 ret1; -+ u8 ret2; -+ -+ -+ memset(&GLBtCoexist, 0, sizeof(GLBtCoexist)); -+ ret1 = EXhalbtcoutsrc_InitlizeVariables((void *)padapter); -+ ret2 = (ret1 == true) ? true : false; -+ -+ return ret2; -+} -+ -+void hal_btcoex_PowerOnSetting(struct adapter *padapter) -+{ -+ EXhalbtcoutsrc_PowerOnSetting(&GLBtCoexist); -+} -+ -+void hal_btcoex_InitHwConfig(struct adapter *padapter, u8 bWifiOnly) -+{ -+ if (!hal_btcoex_IsBtExist(padapter)) -+ return; -+ -+ EXhalbtcoutsrc_InitHwConfig(&GLBtCoexist, bWifiOnly); -+ EXhalbtcoutsrc_InitCoexDm(&GLBtCoexist); -+} -+ -+void hal_btcoex_IpsNotify(struct adapter *padapter, u8 type) -+{ -+ EXhalbtcoutsrc_IpsNotify(&GLBtCoexist, type); -+} -+ -+void hal_btcoex_LpsNotify(struct adapter *padapter, u8 type) -+{ -+ EXhalbtcoutsrc_LpsNotify(&GLBtCoexist, type); -+} -+ -+void hal_btcoex_ScanNotify(struct adapter *padapter, u8 type) -+{ -+ EXhalbtcoutsrc_ScanNotify(&GLBtCoexist, type); -+} -+ -+void hal_btcoex_ConnectNotify(struct adapter *padapter, u8 action) -+{ -+ EXhalbtcoutsrc_ConnectNotify(&GLBtCoexist, action); -+} -+ -+void hal_btcoex_MediaStatusNotify(struct adapter *padapter, u8 mediaStatus) -+{ -+ EXhalbtcoutsrc_MediaStatusNotify(&GLBtCoexist, mediaStatus); -+} -+ -+void hal_btcoex_SpecialPacketNotify(struct adapter *padapter, u8 pktType) -+{ -+ EXhalbtcoutsrc_SpecialPacketNotify(&GLBtCoexist, pktType); -+} -+ -+void hal_btcoex_IQKNotify(struct adapter *padapter, u8 state) -+{ -+ GLBtcWiFiInIQKState = state; -+} -+ -+void hal_btcoex_BtInfoNotify(struct adapter *padapter, u8 length, u8 *tmpBuf) -+{ -+ if (GLBtcWiFiInIQKState == true) -+ return; -+ -+ EXhalbtcoutsrc_BtInfoNotify(&GLBtCoexist, tmpBuf, length); -+} -+ -+void hal_btcoex_SuspendNotify(struct adapter *padapter, u8 state) -+{ -+ if (state == 1) -+ state = BTC_WIFI_PNP_SLEEP; -+ else -+ state = BTC_WIFI_PNP_WAKE_UP; -+ -+ EXhalbtcoutsrc_PnpNotify(&GLBtCoexist, state); -+} -+ -+void hal_btcoex_HaltNotify(struct adapter *padapter) -+{ -+ EXhalbtcoutsrc_HaltNotify(&GLBtCoexist); -+} -+ -+void hal_btcoex_Hanlder(struct adapter *padapter) -+{ -+ EXhalbtcoutsrc_Periodical(&GLBtCoexist); -+} -+ -+s32 hal_btcoex_IsBTCoexCtrlAMPDUSize(struct adapter *padapter) -+{ -+ return (s32)GLBtCoexist.btInfo.bBtCtrlAggBufSize; -+} -+ -+void hal_btcoex_SetManualControl(struct adapter *padapter, u8 bmanual) -+{ -+ GLBtCoexist.bManualControl = bmanual; -+} -+ -+u8 hal_btcoex_IsBtControlLps(struct adapter *padapter) -+{ -+ if (hal_btcoex_IsBtExist(padapter) == false) -+ return false; -+ -+ if (GLBtCoexist.btInfo.bBtDisabled) -+ return false; -+ -+ if (GLBtCoexist.btInfo.bBtCtrlLps) -+ return true; -+ -+ return false; -+} -+ -+u8 hal_btcoex_IsLpsOn(struct adapter *padapter) -+{ -+ if (hal_btcoex_IsBtExist(padapter) == false) -+ return false; -+ -+ if (GLBtCoexist.btInfo.bBtDisabled) -+ return false; -+ -+ if (GLBtCoexist.btInfo.bBtLpsOn) -+ return true; -+ -+ return false; -+} -+ -+u8 hal_btcoex_RpwmVal(struct adapter *padapter) -+{ -+ return GLBtCoexist.btInfo.rpwmVal; -+} -+ -+u8 hal_btcoex_LpsVal(struct adapter *padapter) -+{ -+ return GLBtCoexist.btInfo.lpsVal; -+} -+ -+u32 hal_btcoex_GetRaMask(struct adapter *padapter) -+{ -+ if (!hal_btcoex_IsBtExist(padapter)) -+ return 0; -+ -+ if (GLBtCoexist.btInfo.bBtDisabled) -+ return 0; -+ -+ if (GLBtCoexist.boardInfo.btdmAntNum != 1) -+ return 0; -+ -+ return GLBtCoexist.btInfo.raMask; -+} -+ -+void hal_btcoex_RecordPwrMode(struct adapter *padapter, u8 *pCmdBuf, u8 cmdLen) -+{ -+ BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_EXEC, ("[BTCoex], FW write pwrModeCmd = 0x%04x%08x\n", -+ pCmdBuf[0]<<8|pCmdBuf[1], -+ pCmdBuf[2]<<24|pCmdBuf[3]<<16|pCmdBuf[4]<<8|pCmdBuf[5])); -+ -+ memcpy(GLBtCoexist.pwrModeVal, pCmdBuf, cmdLen); -+} -+ -+void hal_btcoex_DisplayBtCoexInfo(struct adapter *padapter, u8 *pbuf, u32 bufsize) -+{ -+ PBTCDBGINFO pinfo; -+ -+ -+ pinfo = &GLBtcDbgInfo; -+ DBG_BT_INFO_INIT(pinfo, pbuf, bufsize); -+ EXhalbtcoutsrc_DisplayBtCoexInfo(&GLBtCoexist); -+ DBG_BT_INFO_INIT(pinfo, NULL, 0); -+} -+ -+void hal_btcoex_SetDBG(struct adapter *padapter, u32 *pDbgModule) -+{ -+ u32 i; -+ -+ -+ if (NULL == pDbgModule) -+ return; -+ -+ for (i = 0; i < BTC_MSG_MAX; i++) -+ GLBtcDbgType[i] = pDbgModule[i]; -+} -+ -+u32 hal_btcoex_GetDBG(struct adapter *padapter, u8 *pStrBuf, u32 bufSize) -+{ -+ s32 count; -+ u8 *pstr; -+ u32 leftSize; -+ -+ -+ if ((NULL == pStrBuf) || (0 == bufSize)) -+ return 0; -+ -+ pstr = pStrBuf; -+ leftSize = bufSize; -+/* DBG_871X(FUNC_ADPT_FMT ": bufsize =%d\n", FUNC_ADPT_ARG(padapter), bufSize); */ -+ -+ count = rtw_sprintf(pstr, leftSize, "#define DBG\t%d\n", DBG); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ -+ count = rtw_sprintf(pstr, leftSize, "BTCOEX Debug Setting:\n"); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ -+ count = rtw_sprintf(pstr, leftSize, -+ "INTERFACE / ALGORITHM: 0x%08X / 0x%08X\n\n", -+ GLBtcDbgType[BTC_MSG_INTERFACE], -+ GLBtcDbgType[BTC_MSG_ALGORITHM]); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ -+ count = rtw_sprintf(pstr, leftSize, "INTERFACE Debug Setting Definition:\n"); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[0]=%d for INTF_INIT\n", -+ (GLBtcDbgType[BTC_MSG_INTERFACE]&INTF_INIT)?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[2]=%d for INTF_NOTIFY\n\n", -+ (GLBtcDbgType[BTC_MSG_INTERFACE]&INTF_NOTIFY)?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ -+ count = rtw_sprintf(pstr, leftSize, "ALGORITHM Debug Setting Definition:\n"); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[0]=%d for BT_RSSI_STATE\n", -+ (GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_BT_RSSI_STATE)?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[1]=%d for WIFI_RSSI_STATE\n", -+ (GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_WIFI_RSSI_STATE)?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[2]=%d for BT_MONITOR\n", -+ (GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_BT_MONITOR)?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[3]=%d for TRACE\n", -+ (GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE)?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[4]=%d for TRACE_FW\n", -+ (GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE_FW)?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[5]=%d for TRACE_FW_DETAIL\n", -+ (GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE_FW_DETAIL)?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[6]=%d for TRACE_FW_EXEC\n", -+ (GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE_FW_EXEC)?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[7]=%d for TRACE_SW\n", -+ (GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE_SW)?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[8]=%d for TRACE_SW_DETAIL\n", -+ (GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE_SW_DETAIL)?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[9]=%d for TRACE_SW_EXEC\n", -+ (GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE_SW_EXEC)?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ -+exit: -+ count = pstr - pStrBuf; -+/* DBG_871X(FUNC_ADPT_FMT ": usedsize =%d\n", FUNC_ADPT_ARG(padapter), count); */ -+ -+ return count; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalBtcOutSrc.h linux/3rdparty/rtl8723bs/hal/HalBtcOutSrc.h ---- linux.old/3rdparty/rtl8723bs/hal/HalBtcOutSrc.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalBtcOutSrc.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,565 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HALBTC_OUT_SRC_H__ -+#define __HALBTC_OUT_SRC_H__ -+ -+#define NORMAL_EXEC false -+#define FORCE_EXEC true -+ -+#define BTC_RF_OFF 0x0 -+#define BTC_RF_ON 0x1 -+ -+#define BTC_RF_A 0x0 -+#define BTC_RF_B 0x1 -+#define BTC_RF_C 0x2 -+#define BTC_RF_D 0x3 -+ -+#define BTC_SMSP SINGLEMAC_SINGLEPHY -+#define BTC_DMDP DUALMAC_DUALPHY -+#define BTC_DMSP DUALMAC_SINGLEPHY -+#define BTC_MP_UNKNOWN 0xff -+ -+#define BT_COEX_ANT_TYPE_PG 0 -+#define BT_COEX_ANT_TYPE_ANTDIV 1 -+#define BT_COEX_ANT_TYPE_DETECTED 2 -+ -+#define BTC_MIMO_PS_STATIC 0 /* 1ss */ -+#define BTC_MIMO_PS_DYNAMIC 1 /* 2ss */ -+ -+#define BTC_RATE_DISABLE 0 -+#define BTC_RATE_ENABLE 1 -+ -+/* single Antenna definition */ -+#define BTC_ANT_PATH_WIFI 0 -+#define BTC_ANT_PATH_BT 1 -+#define BTC_ANT_PATH_PTA 2 -+/* dual Antenna definition */ -+#define BTC_ANT_WIFI_AT_MAIN 0 -+#define BTC_ANT_WIFI_AT_AUX 1 -+/* coupler Antenna definition */ -+#define BTC_ANT_WIFI_AT_CPL_MAIN 0 -+#define BTC_ANT_WIFI_AT_CPL_AUX 1 -+ -+typedef enum _BTC_POWERSAVE_TYPE{ -+ BTC_PS_WIFI_NATIVE = 0, /* wifi original power save behavior */ -+ BTC_PS_LPS_ON = 1, -+ BTC_PS_LPS_OFF = 2, -+ BTC_PS_MAX -+} BTC_POWERSAVE_TYPE, *PBTC_POWERSAVE_TYPE; -+ -+typedef enum _BTC_BT_REG_TYPE{ -+ BTC_BT_REG_RF = 0, -+ BTC_BT_REG_MODEM = 1, -+ BTC_BT_REG_BLUEWIZE = 2, -+ BTC_BT_REG_VENDOR = 3, -+ BTC_BT_REG_LE = 4, -+ BTC_BT_REG_MAX -+} BTC_BT_REG_TYPE, *PBTC_BT_REG_TYPE; -+ -+typedef enum _BTC_CHIP_INTERFACE{ -+ BTC_INTF_UNKNOWN = 0, -+ BTC_INTF_PCI = 1, -+ BTC_INTF_USB = 2, -+ BTC_INTF_SDIO = 3, -+ BTC_INTF_MAX -+} BTC_CHIP_INTERFACE, *PBTC_CHIP_INTERFACE; -+ -+typedef enum _BTC_CHIP_TYPE { -+ BTC_CHIP_UNDEF = 0, -+ BTC_CHIP_CSR_BC4 = 1, -+ BTC_CHIP_CSR_BC8 = 2, -+ BTC_CHIP_RTL8723A = 3, -+ BTC_CHIP_RTL8821 = 4, -+ BTC_CHIP_RTL8723B = 5, -+ BTC_CHIP_MAX -+} BTC_CHIP_TYPE, *PBTC_CHIP_TYPE; -+ -+typedef enum _BTC_MSG_TYPE { -+ BTC_MSG_INTERFACE = 0x0, -+ BTC_MSG_ALGORITHM = 0x1, -+ BTC_MSG_MAX -+} BTC_MSG_TYPE; -+extern u32 GLBtcDbgType[]; -+ -+/* following is for BTC_MSG_INTERFACE */ -+#define INTF_INIT BIT0 -+#define INTF_NOTIFY BIT2 -+ -+/* following is for BTC_ALGORITHM */ -+#define ALGO_BT_RSSI_STATE BIT0 -+#define ALGO_WIFI_RSSI_STATE BIT1 -+#define ALGO_BT_MONITOR BIT2 -+#define ALGO_TRACE BIT3 -+#define ALGO_TRACE_FW BIT4 -+#define ALGO_TRACE_FW_DETAIL BIT5 -+#define ALGO_TRACE_FW_EXEC BIT6 -+#define ALGO_TRACE_SW BIT7 -+#define ALGO_TRACE_SW_DETAIL BIT8 -+#define ALGO_TRACE_SW_EXEC BIT9 -+ -+/* following is for wifi link status */ -+#define WIFI_STA_CONNECTED BIT0 -+#define WIFI_AP_CONNECTED BIT1 -+#define WIFI_HS_CONNECTED BIT2 -+#define WIFI_P2P_GO_CONNECTED BIT3 -+#define WIFI_P2P_GC_CONNECTED BIT4 -+ -+/* following is for command line utility */ -+#define CL_SPRINTF snprintf -+#define CL_PRINTF DCMD_Printf -+ -+/* The following is for dbgview print */ -+#if DBG -+#define BTC_PRINT(dbgtype, dbgflag, printstr)\ -+{\ -+ if (GLBtcDbgType[dbgtype] & dbgflag)\ -+ DbgPrint printstr;\ -+} -+ -+#define BTC_PRINT_F(dbgtype, dbgflag, printstr)\ -+{\ -+ if (GLBtcDbgType[dbgtype] & dbgflag) {\ -+ DbgPrint("%s(): ", __func__);\ -+ DbgPrint printstr;\ -+ } \ -+} -+ -+#define BTC_PRINT_ADDR(dbgtype, dbgflag, printstr, _Ptr)\ -+{\ -+ if (GLBtcDbgType[dbgtype] & dbgflag) {\ -+ int __i;\ -+ u8 *ptr = (u8 *)_Ptr;\ -+ DbgPrint printstr;\ -+ DbgPrint(" ");\ -+ for (__i = 0; __i < 6; __i++)\ -+ DbgPrint("%02X%s", ptr[__i], (__i == 5) ? "" : "-");\ -+ DbgPrint("\n");\ -+ } \ -+} -+ -+#define BTC_PRINT_DATA(dbgtype, dbgflag, _TitleString, _HexData, _HexDataLen)\ -+{\ -+ if (GLBtcDbgType[dbgtype] & dbgflag) {\ -+ int __i;\ -+ u8 *ptr = (u8 *)_HexData;\ -+ DbgPrint(_TitleString);\ -+ for (__i = 0; __i < (int)_HexDataLen; __i++) {\ -+ DbgPrint("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " ");\ -+ if (((__i + 1) % 16) == 0)\ -+ DbgPrint("\n");\ -+ } \ -+ DbgPrint("\n");\ -+ } \ -+} -+ -+#else -+#define BTC_PRINT(dbgtype, dbgflag, printstr) -+#define BTC_PRINT_F(dbgtype, dbgflag, printstr) -+#define BTC_PRINT_ADDR(dbgtype, dbgflag, printstr, _Ptr) -+#define BTC_PRINT_DATA(dbgtype, dbgflag, _TitleString, _HexData, _HexDataLen) -+#endif -+ -+typedef struct _BTC_BOARD_INFO { -+ /* The following is some board information */ -+ u8 btChipType; -+ u8 pgAntNum; /* pg ant number */ -+ u8 btdmAntNum; /* ant number for btdm */ -+ u8 btdmAntPos; /* Bryant Add to indicate Antenna Position for (pgAntNum = 2) && (btdmAntNum = 1) (DPDT+1Ant case) */ -+ u8 singleAntPath; /* current used for 8723b only, 1 =>s0, 0 =>s1 */ -+ /* bool bBtExist; */ -+} BTC_BOARD_INFO, *PBTC_BOARD_INFO; -+ -+typedef enum _BTC_DBG_OPCODE { -+ BTC_DBG_SET_COEX_NORMAL = 0x0, -+ BTC_DBG_SET_COEX_WIFI_ONLY = 0x1, -+ BTC_DBG_SET_COEX_BT_ONLY = 0x2, -+ BTC_DBG_SET_COEX_DEC_BT_PWR = 0x3, -+ BTC_DBG_SET_COEX_BT_AFH_MAP = 0x4, -+ BTC_DBG_SET_COEX_BT_IGNORE_WLAN_ACT = 0x5, -+ BTC_DBG_MAX -+} BTC_DBG_OPCODE, *PBTC_DBG_OPCODE; -+ -+typedef enum _BTC_RSSI_STATE { -+ BTC_RSSI_STATE_HIGH = 0x0, -+ BTC_RSSI_STATE_MEDIUM = 0x1, -+ BTC_RSSI_STATE_LOW = 0x2, -+ BTC_RSSI_STATE_STAY_HIGH = 0x3, -+ BTC_RSSI_STATE_STAY_MEDIUM = 0x4, -+ BTC_RSSI_STATE_STAY_LOW = 0x5, -+ BTC_RSSI_MAX -+} BTC_RSSI_STATE, *PBTC_RSSI_STATE; -+#define BTC_RSSI_HIGH(_rssi_) ((_rssi_ == BTC_RSSI_STATE_HIGH || _rssi_ == BTC_RSSI_STATE_STAY_HIGH) ? true : false) -+#define BTC_RSSI_MEDIUM(_rssi_) ((_rssi_ == BTC_RSSI_STATE_MEDIUM || _rssi_ == BTC_RSSI_STATE_STAY_MEDIUM) ? true : false) -+#define BTC_RSSI_LOW(_rssi_) ((_rssi_ == BTC_RSSI_STATE_LOW || _rssi_ == BTC_RSSI_STATE_STAY_LOW) ? true : false) -+ -+typedef enum _BTC_WIFI_ROLE { -+ BTC_ROLE_STATION = 0x0, -+ BTC_ROLE_AP = 0x1, -+ BTC_ROLE_IBSS = 0x2, -+ BTC_ROLE_HS_MODE = 0x3, -+ BTC_ROLE_MAX -+} BTC_WIFI_ROLE, *PBTC_WIFI_ROLE; -+ -+typedef enum _BTC_WIFI_BW_MODE { -+ BTC_WIFI_BW_LEGACY = 0x0, -+ BTC_WIFI_BW_HT20 = 0x1, -+ BTC_WIFI_BW_HT40 = 0x2, -+ BTC_WIFI_BW_MAX -+} BTC_WIFI_BW_MODE, *PBTC_WIFI_BW_MODE; -+ -+typedef enum _BTC_WIFI_TRAFFIC_DIR { -+ BTC_WIFI_TRAFFIC_TX = 0x0, -+ BTC_WIFI_TRAFFIC_RX = 0x1, -+ BTC_WIFI_TRAFFIC_MAX -+} BTC_WIFI_TRAFFIC_DIR, *PBTC_WIFI_TRAFFIC_DIR; -+ -+typedef enum _BTC_WIFI_PNP { -+ BTC_WIFI_PNP_WAKE_UP = 0x0, -+ BTC_WIFI_PNP_SLEEP = 0x1, -+ BTC_WIFI_PNP_MAX -+} BTC_WIFI_PNP, *PBTC_WIFI_PNP; -+ -+/* for 8723b-d cut large current issue */ -+typedef enum _BT_WIFI_COEX_STATE { -+ BTC_WIFI_STAT_INIT, -+ BTC_WIFI_STAT_IQK, -+ BTC_WIFI_STAT_NORMAL_OFF, -+ BTC_WIFI_STAT_MP_OFF, -+ BTC_WIFI_STAT_NORMAL, -+ BTC_WIFI_STAT_ANT_DIV, -+ BTC_WIFI_STAT_MAX -+} BT_WIFI_COEX_STATE, *PBT_WIFI_COEX_STATE; -+ -+/* defined for BFP_BTC_GET */ -+typedef enum _BTC_GET_TYPE { -+ /* type bool */ -+ BTC_GET_BL_HS_OPERATION, -+ BTC_GET_BL_HS_CONNECTING, -+ BTC_GET_BL_WIFI_CONNECTED, -+ BTC_GET_BL_WIFI_BUSY, -+ BTC_GET_BL_WIFI_SCAN, -+ BTC_GET_BL_WIFI_LINK, -+ BTC_GET_BL_WIFI_ROAM, -+ BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ BTC_GET_BL_WIFI_UNDER_5G, -+ BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ BTC_GET_BL_WIFI_ENABLE_ENCRYPTION, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ BTC_GET_BL_EXT_SWITCH, -+ BTC_GET_BL_WIFI_IS_IN_MP_MODE, -+ -+ /* type s32 */ -+ BTC_GET_S4_WIFI_RSSI, -+ BTC_GET_S4_HS_RSSI, -+ -+ /* type u32 */ -+ BTC_GET_U4_WIFI_BW, -+ BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, -+ BTC_GET_U4_WIFI_FW_VER, -+ BTC_GET_U4_WIFI_LINK_STATUS, -+ BTC_GET_U4_BT_PATCH_VER, -+ -+ /* type u8 */ -+ BTC_GET_U1_WIFI_DOT11_CHNL, -+ BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ BTC_GET_U1_WIFI_HS_CHNL, -+ BTC_GET_U1_MAC_PHY_MODE, -+ BTC_GET_U1_AP_NUM, -+ -+ /* for 1Ant ====== */ -+ BTC_GET_U1_LPS_MODE, -+ -+ BTC_GET_MAX -+} BTC_GET_TYPE, *PBTC_GET_TYPE; -+ -+/* defined for BFP_BTC_SET */ -+typedef enum _BTC_SET_TYPE { -+ /* type bool */ -+ BTC_SET_BL_BT_DISABLE, -+ BTC_SET_BL_BT_TRAFFIC_BUSY, -+ BTC_SET_BL_BT_LIMITED_DIG, -+ BTC_SET_BL_FORCE_TO_ROAM, -+ BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ BTC_SET_BL_INC_SCAN_DEV_NUM, -+ BTC_SET_BL_BT_TX_RX_MASK, -+ -+ /* type u8 */ -+ BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, -+ BTC_SET_U1_AGG_BUF_SIZE, -+ -+ /* type trigger some action */ -+ BTC_SET_ACT_GET_BT_RSSI, -+ BTC_SET_ACT_AGGREGATE_CTRL, -+ /* for 1Ant ====== */ -+ /* type bool */ -+ -+ /* type u8 */ -+ BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, -+ BTC_SET_U1_LPS_VAL, -+ BTC_SET_U1_RPWM_VAL, -+ /* type trigger some action */ -+ BTC_SET_ACT_LEAVE_LPS, -+ BTC_SET_ACT_ENTER_LPS, -+ BTC_SET_ACT_NORMAL_LPS, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ BTC_SET_ACT_UPDATE_RAMASK, -+ BTC_SET_ACT_SEND_MIMO_PS, -+ /* BT Coex related */ -+ BTC_SET_ACT_CTRL_BT_INFO, -+ BTC_SET_ACT_CTRL_BT_COEX, -+ BTC_SET_ACT_CTRL_8723B_ANT, -+ /* */ -+ BTC_SET_MAX -+} BTC_SET_TYPE, *PBTC_SET_TYPE; -+ -+typedef enum _BTC_DBG_DISP_TYPE { -+ BTC_DBG_DISP_COEX_STATISTICS = 0x0, -+ BTC_DBG_DISP_BT_LINK_INFO = 0x1, -+ BTC_DBG_DISP_FW_PWR_MODE_CMD = 0x2, -+ BTC_DBG_DISP_MAX -+} BTC_DBG_DISP_TYPE, *PBTC_DBG_DISP_TYPE; -+ -+typedef enum _BTC_NOTIFY_TYPE_IPS { -+ BTC_IPS_LEAVE = 0x0, -+ BTC_IPS_ENTER = 0x1, -+ BTC_IPS_MAX -+} BTC_NOTIFY_TYPE_IPS, *PBTC_NOTIFY_TYPE_IPS; -+ -+typedef enum _BTC_NOTIFY_TYPE_LPS { -+ BTC_LPS_DISABLE = 0x0, -+ BTC_LPS_ENABLE = 0x1, -+ BTC_LPS_MAX -+} BTC_NOTIFY_TYPE_LPS, *PBTC_NOTIFY_TYPE_LPS; -+ -+typedef enum _BTC_NOTIFY_TYPE_SCAN { -+ BTC_SCAN_FINISH = 0x0, -+ BTC_SCAN_START = 0x1, -+ BTC_SCAN_MAX -+} BTC_NOTIFY_TYPE_SCAN, *PBTC_NOTIFY_TYPE_SCAN; -+ -+typedef enum _BTC_NOTIFY_TYPE_ASSOCIATE { -+ BTC_ASSOCIATE_FINISH = 0x0, -+ BTC_ASSOCIATE_START = 0x1, -+ BTC_ASSOCIATE_MAX -+} BTC_NOTIFY_TYPE_ASSOCIATE, *PBTC_NOTIFY_TYPE_ASSOCIATE; -+ -+typedef enum _BTC_NOTIFY_TYPE_MEDIA_STATUS { -+ BTC_MEDIA_DISCONNECT = 0x0, -+ BTC_MEDIA_CONNECT = 0x1, -+ BTC_MEDIA_MAX -+} BTC_NOTIFY_TYPE_MEDIA_STATUS, *PBTC_NOTIFY_TYPE_MEDIA_STATUS; -+ -+typedef enum _BTC_NOTIFY_TYPE_SPECIAL_PACKET { -+ BTC_PACKET_UNKNOWN = 0x0, -+ BTC_PACKET_DHCP = 0x1, -+ BTC_PACKET_ARP = 0x2, -+ BTC_PACKET_EAPOL = 0x3, -+ BTC_PACKET_MAX -+} BTC_NOTIFY_TYPE_SPECIAL_PACKET, *PBTC_NOTIFY_TYPE_SPECIAL_PACKET; -+ -+typedef enum _BTC_NOTIFY_TYPE_STACK_OPERATION { -+ BTC_STACK_OP_NONE = 0x0, -+ BTC_STACK_OP_INQ_PAGE_PAIR_START = 0x1, -+ BTC_STACK_OP_INQ_PAGE_PAIR_FINISH = 0x2, -+ BTC_STACK_OP_MAX -+} BTC_NOTIFY_TYPE_STACK_OPERATION, *PBTC_NOTIFY_TYPE_STACK_OPERATION; -+ -+/* Bryant Add */ -+typedef enum _BTC_ANTENNA_POS { -+ BTC_ANTENNA_AT_MAIN_PORT = 0x1, -+ BTC_ANTENNA_AT_AUX_PORT = 0x2, -+} BTC_ANTENNA_POS, *PBTC_ANTENNA_POS; -+ -+typedef u8 (*BFP_BTC_R1)(void *pBtcContext, u32 RegAddr); -+typedef u16(*BFP_BTC_R2)(void *pBtcContext, u32 RegAddr); -+typedef u32 (*BFP_BTC_R4)(void *pBtcContext, u32 RegAddr); -+typedef void (*BFP_BTC_W1)(void *pBtcContext, u32 RegAddr, u8 Data); -+typedef void(*BFP_BTC_W1_BIT_MASK)( -+ void *pBtcContext, u32 regAddr, u8 bitMask, u8 data1b -+); -+typedef void (*BFP_BTC_W2)(void *pBtcContext, u32 RegAddr, u16 Data); -+typedef void (*BFP_BTC_W4)(void *pBtcContext, u32 RegAddr, u32 Data); -+typedef void (*BFP_BTC_LOCAL_REG_W1)(void *pBtcContext, u32 RegAddr, u8 Data); -+typedef void (*BFP_BTC_SET_BB_REG)( -+ void *pBtcContext, u32 RegAddr, u32 BitMask, u32 Data -+); -+typedef u32 (*BFP_BTC_GET_BB_REG)(void *pBtcContext, u32 RegAddr, u32 BitMask); -+typedef void (*BFP_BTC_SET_RF_REG)( -+ void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMask, u32 Data -+); -+typedef u32 (*BFP_BTC_GET_RF_REG)( -+ void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMask -+); -+typedef void (*BFP_BTC_FILL_H2C)( -+ void *pBtcContext, u8 elementId, u32 cmdLen, u8 *pCmdBuffer -+); -+ -+typedef u8 (*BFP_BTC_GET)(void *pBtCoexist, u8 getType, void *pOutBuf); -+ -+typedef u8 (*BFP_BTC_SET)(void *pBtCoexist, u8 setType, void *pInBuf); -+typedef void (*BFP_BTC_SET_BT_REG)( -+ void *pBtcContext, u8 regType, u32 offset, u32 value -+); -+typedef u32 (*BFP_BTC_GET_BT_REG)(void *pBtcContext, u8 regType, u32 offset); -+typedef void (*BFP_BTC_DISP_DBG_MSG)(void *pBtCoexist, u8 dispType); -+ -+typedef struct _BTC_BT_INFO { -+ bool bBtDisabled; -+ u8 rssiAdjustForAgcTableOn; -+ u8 rssiAdjustFor1AntCoexType; -+ bool bPreBtCtrlAggBufSize; -+ bool bBtCtrlAggBufSize; -+ bool bRejectAggPkt; -+ bool bIncreaseScanDevNum; -+ bool bBtTxRxMask; -+ u8 preAggBufSize; -+ u8 aggBufSize; -+ bool bBtBusy; -+ bool bLimitedDig; -+ u16 btHciVer; -+ u16 btRealFwVer; -+ u8 btFwVer; -+ u32 getBtFwVerCnt; -+ -+ bool bBtDisableLowPwr; -+ -+ bool bBtCtrlLps; -+ bool bBtLpsOn; -+ bool bForceToRoam; /* for 1Ant solution */ -+ u8 lpsVal; -+ u8 rpwmVal; -+ u32 raMask; -+} BTC_BT_INFO, *PBTC_BT_INFO; -+ -+typedef struct _BTC_STACK_INFO { -+ bool bProfileNotified; -+ u16 hciVersion; /* stack hci version */ -+ u8 numOfLink; -+ bool bBtLinkExist; -+ bool bScoExist; -+ bool bAclExist; -+ bool bA2dpExist; -+ bool bHidExist; -+ u8 numOfHid; -+ bool bPanExist; -+ bool bUnknownAclExist; -+ s8 minBtRssi; -+} BTC_STACK_INFO, *PBTC_STACK_INFO; -+ -+typedef struct _BTC_BT_LINK_INFO { -+ bool bBtLinkExist; -+ bool bScoExist; -+ bool bScoOnly; -+ bool bA2dpExist; -+ bool bA2dpOnly; -+ bool bHidExist; -+ bool bHidOnly; -+ bool bPanExist; -+ bool bPanOnly; -+ bool bSlaveRole; -+} BTC_BT_LINK_INFO, *PBTC_BT_LINK_INFO; -+ -+typedef struct _BTC_STATISTICS { -+ u32 cntBind; -+ u32 cntPowerOn; -+ u32 cntInitHwConfig; -+ u32 cntInitCoexDm; -+ u32 cntIpsNotify; -+ u32 cntLpsNotify; -+ u32 cntScanNotify; -+ u32 cntConnectNotify; -+ u32 cntMediaStatusNotify; -+ u32 cntSpecialPacketNotify; -+ u32 cntBtInfoNotify; -+ u32 cntRfStatusNotify; -+ u32 cntPeriodical; -+ u32 cntCoexDmSwitch; -+ u32 cntStackOperationNotify; -+ u32 cntDbgCtrl; -+} BTC_STATISTICS, *PBTC_STATISTICS; -+ -+typedef struct _BTC_COEXIST { -+ bool bBinded; /* make sure only one adapter can bind the data context */ -+ void *Adapter; /* default adapter */ -+ BTC_BOARD_INFO boardInfo; -+ BTC_BT_INFO btInfo; /* some bt info referenced by non-bt module */ -+ BTC_STACK_INFO stackInfo; -+ BTC_BT_LINK_INFO btLinkInfo; -+ BTC_CHIP_INTERFACE chipInterface; -+ -+ bool bInitilized; -+ bool bStopCoexDm; -+ bool bManualControl; -+ u8 *cliBuf; -+ BTC_STATISTICS statistics; -+ u8 pwrModeVal[10]; -+ -+ /* function pointers */ -+ /* io related */ -+ BFP_BTC_R1 fBtcRead1Byte; -+ BFP_BTC_W1 fBtcWrite1Byte; -+ BFP_BTC_W1_BIT_MASK fBtcWrite1ByteBitMask; -+ BFP_BTC_R2 fBtcRead2Byte; -+ BFP_BTC_W2 fBtcWrite2Byte; -+ BFP_BTC_R4 fBtcRead4Byte; -+ BFP_BTC_W4 fBtcWrite4Byte; -+ BFP_BTC_LOCAL_REG_W1 fBtcWriteLocalReg1Byte; -+ /* read/write bb related */ -+ BFP_BTC_SET_BB_REG fBtcSetBbReg; -+ BFP_BTC_GET_BB_REG fBtcGetBbReg; -+ -+ /* read/write rf related */ -+ BFP_BTC_SET_RF_REG fBtcSetRfReg; -+ BFP_BTC_GET_RF_REG fBtcGetRfReg; -+ -+ /* fill h2c related */ -+ BFP_BTC_FILL_H2C fBtcFillH2c; -+ /* other */ -+ BFP_BTC_DISP_DBG_MSG fBtcDispDbgMsg; -+ /* normal get/set related */ -+ BFP_BTC_GET fBtcGet; -+ BFP_BTC_SET fBtcSet; -+ -+ BFP_BTC_GET_BT_REG fBtcGetBtReg; -+ BFP_BTC_SET_BT_REG fBtcSetBtReg; -+} BTC_COEXIST, *PBTC_COEXIST; -+ -+extern BTC_COEXIST GLBtCoexist; -+ -+u8 EXhalbtcoutsrc_InitlizeVariables(void *Adapter); -+void EXhalbtcoutsrc_PowerOnSetting(PBTC_COEXIST pBtCoexist); -+void EXhalbtcoutsrc_InitHwConfig(PBTC_COEXIST pBtCoexist, u8 bWifiOnly); -+void EXhalbtcoutsrc_InitCoexDm(PBTC_COEXIST pBtCoexist); -+void EXhalbtcoutsrc_IpsNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtcoutsrc_LpsNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtcoutsrc_ScanNotify(PBTC_COEXIST pBtCoexist, u8 type); -+void EXhalbtcoutsrc_ConnectNotify(PBTC_COEXIST pBtCoexist, u8 action); -+void EXhalbtcoutsrc_MediaStatusNotify( -+ PBTC_COEXIST pBtCoexist, RT_MEDIA_STATUS mediaStatus -+); -+void EXhalbtcoutsrc_SpecialPacketNotify(PBTC_COEXIST pBtCoexist, u8 pktType); -+void EXhalbtcoutsrc_BtInfoNotify( -+ PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 length -+); -+void EXhalbtcoutsrc_HaltNotify(PBTC_COEXIST pBtCoexist); -+void EXhalbtcoutsrc_PnpNotify(PBTC_COEXIST pBtCoexist, u8 pnpState); -+void EXhalbtcoutsrc_Periodical(PBTC_COEXIST pBtCoexist); -+void EXhalbtcoutsrc_SetChipType(u8 chipType); -+void EXhalbtcoutsrc_SetAntNum(u8 type, u8 antNum); -+void EXhalbtcoutsrc_SetSingleAntPath(u8 singleAntPath); -+void EXhalbtcoutsrc_DisplayBtCoexInfo(PBTC_COEXIST pBtCoexist); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/hal_com.c linux/3rdparty/rtl8723bs/hal/hal_com.c ---- linux.old/3rdparty/rtl8723bs/hal/hal_com.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/hal_com.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1753 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _HAL_COM_C_ -+ -+#include -+#include -+#include "hal_com_h2c.h" -+ -+#include "odm_precomp.h" -+ -+u8 rtw_hal_data_init(struct adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) { /* if (padapter->isprimary) */ -+ padapter->hal_data_sz = sizeof(struct hal_com_data); -+ padapter->HalData = vzalloc(padapter->hal_data_sz); -+ if (padapter->HalData == NULL) { -+ DBG_8192C("cant not alloc memory for HAL DATA\n"); -+ return _FAIL; -+ } -+ } -+ return _SUCCESS; -+} -+ -+void rtw_hal_data_deinit(struct adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) { /* if (padapter->isprimary) */ -+ if (padapter->HalData) { -+ #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ phy_free_filebuf(padapter); -+ #endif -+ vfree(padapter->HalData); -+ padapter->HalData = NULL; -+ padapter->hal_data_sz = 0; -+ } -+ } -+} -+ -+ -+void dump_chip_info(HAL_VERSION ChipVersion) -+{ -+ int cnt = 0; -+ u8 buf[128]; -+ -+ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8723B_"); -+ cnt += sprintf((buf+cnt), "%s_", IS_NORMAL_CHIP(ChipVersion) ? "Normal_Chip" : "Test_Chip"); -+ if (IS_CHIP_VENDOR_TSMC(ChipVersion)) -+ cnt += sprintf((buf+cnt), "%s_", "TSMC"); -+ else if (IS_CHIP_VENDOR_UMC(ChipVersion)) -+ cnt += sprintf((buf+cnt), "%s_", "UMC"); -+ else if (IS_CHIP_VENDOR_SMIC(ChipVersion)) -+ cnt += sprintf((buf+cnt), "%s_", "SMIC"); -+ -+ if (IS_A_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "A_CUT_"); -+ else if (IS_B_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "B_CUT_"); -+ else if (IS_C_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "C_CUT_"); -+ else if (IS_D_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "D_CUT_"); -+ else if (IS_E_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "E_CUT_"); -+ else if (IS_I_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "I_CUT_"); -+ else if (IS_J_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "J_CUT_"); -+ else if (IS_K_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "K_CUT_"); -+ else -+ cnt += sprintf((buf+cnt), "UNKNOWN_CUT(%d)_", ChipVersion.CUTVersion); -+ -+ if (IS_1T1R(ChipVersion)) -+ cnt += sprintf((buf+cnt), "1T1R_"); -+ else if (IS_1T2R(ChipVersion)) -+ cnt += sprintf((buf+cnt), "1T2R_"); -+ else if (IS_2T2R(ChipVersion)) -+ cnt += sprintf((buf+cnt), "2T2R_"); -+ else -+ cnt += sprintf((buf+cnt), "UNKNOWN_RFTYPE(%d)_", ChipVersion.RFType); -+ -+ cnt += sprintf((buf+cnt), "RomVer(%d)\n", ChipVersion.ROMVer); -+ -+ DBG_871X("%s", buf); -+} -+ -+ -+#define EEPROM_CHANNEL_PLAN_BY_HW_MASK 0x80 -+ -+/* -+ * Description: -+ *Use hardware(efuse), driver parameter(registry) and default channel plan -+ *to decide which one should be used. -+ * -+ * Parameters: -+ *padapter pointer of adapter -+ *hw_channel_plan channel plan from HW (efuse/eeprom) -+ * BIT[7] software configure mode; 0:Enable, 1:disable -+ * BIT[6:0] Channel Plan -+ *sw_channel_plan channel plan from SW (registry/module param) -+ *def_channel_plan channel plan used when HW/SW both invalid -+ *AutoLoadFail efuse autoload fail or not -+ * -+ * Return: -+ *Final channel plan decision -+ * -+ */ -+u8 hal_com_config_channel_plan( -+ struct adapter *padapter, -+ u8 hw_channel_plan, -+ u8 sw_channel_plan, -+ u8 def_channel_plan, -+ bool AutoLoadFail -+) -+{ -+ struct hal_com_data *pHalData; -+ u8 chnlPlan; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pHalData->bDisableSWChannelPlan = false; -+ chnlPlan = def_channel_plan; -+ -+ if (0xFF == hw_channel_plan) -+ AutoLoadFail = true; -+ -+ if (false == AutoLoadFail) { -+ u8 hw_chnlPlan; -+ -+ hw_chnlPlan = hw_channel_plan & (~EEPROM_CHANNEL_PLAN_BY_HW_MASK); -+ if (rtw_is_channel_plan_valid(hw_chnlPlan)) { -+#ifndef CONFIG_SW_CHANNEL_PLAN -+ if (hw_channel_plan & EEPROM_CHANNEL_PLAN_BY_HW_MASK) -+ pHalData->bDisableSWChannelPlan = true; -+#endif /* !CONFIG_SW_CHANNEL_PLAN */ -+ -+ chnlPlan = hw_chnlPlan; -+ } -+ } -+ -+ if ( -+ (false == pHalData->bDisableSWChannelPlan) && -+ rtw_is_channel_plan_valid(sw_channel_plan) -+ ) -+ chnlPlan = sw_channel_plan; -+ -+ return chnlPlan; -+} -+ -+bool HAL_IsLegalChannel(struct adapter *Adapter, u32 Channel) -+{ -+ bool bLegalChannel = true; -+ -+ if (Channel > 14) { -+ bLegalChannel = false; -+ DBG_871X("Channel > 14 but wireless_mode do not support 5G\n"); -+ } else if ((Channel <= 14) && (Channel >= 1)) { -+ if (IsSupported24G(Adapter->registrypriv.wireless_mode) == false) { -+ bLegalChannel = false; -+ DBG_871X("(Channel <= 14) && (Channel >= 1) but wireless_mode do not support 2.4G\n"); -+ } -+ } else { -+ bLegalChannel = false; -+ DBG_871X("Channel is Invalid !!!\n"); -+ } -+ -+ return bLegalChannel; -+} -+ -+u8 MRateToHwRate(u8 rate) -+{ -+ u8 ret = DESC_RATE1M; -+ -+ switch (rate) { -+ case MGN_1M: -+ ret = DESC_RATE1M; -+ break; -+ case MGN_2M: -+ ret = DESC_RATE2M; -+ break; -+ case MGN_5_5M: -+ ret = DESC_RATE5_5M; -+ break; -+ case MGN_11M: -+ ret = DESC_RATE11M; -+ break; -+ case MGN_6M: -+ ret = DESC_RATE6M; -+ break; -+ case MGN_9M: -+ ret = DESC_RATE9M; -+ break; -+ case MGN_12M: -+ ret = DESC_RATE12M; -+ break; -+ case MGN_18M: -+ ret = DESC_RATE18M; -+ break; -+ case MGN_24M: -+ ret = DESC_RATE24M; -+ break; -+ case MGN_36M: -+ ret = DESC_RATE36M; -+ break; -+ case MGN_48M: -+ ret = DESC_RATE48M; -+ break; -+ case MGN_54M: -+ ret = DESC_RATE54M; -+ break; -+ case MGN_MCS0: -+ ret = DESC_RATEMCS0; -+ break; -+ case MGN_MCS1: -+ ret = DESC_RATEMCS1; -+ break; -+ case MGN_MCS2: -+ ret = DESC_RATEMCS2; -+ break; -+ case MGN_MCS3: -+ ret = DESC_RATEMCS3; -+ break; -+ case MGN_MCS4: -+ ret = DESC_RATEMCS4; -+ break; -+ case MGN_MCS5: -+ ret = DESC_RATEMCS5; -+ break; -+ case MGN_MCS6: -+ ret = DESC_RATEMCS6; -+ break; -+ case MGN_MCS7: -+ ret = DESC_RATEMCS7; -+ break; -+ case MGN_MCS8: -+ ret = DESC_RATEMCS8; -+ break; -+ case MGN_MCS9: -+ ret = DESC_RATEMCS9; -+ break; -+ case MGN_MCS10: -+ ret = DESC_RATEMCS10; -+ break; -+ case MGN_MCS11: -+ ret = DESC_RATEMCS11; -+ break; -+ case MGN_MCS12: -+ ret = DESC_RATEMCS12; -+ break; -+ case MGN_MCS13: -+ ret = DESC_RATEMCS13; -+ break; -+ case MGN_MCS14: -+ ret = DESC_RATEMCS14; -+ break; -+ case MGN_MCS15: -+ ret = DESC_RATEMCS15; -+ break; -+ case MGN_MCS16: -+ ret = DESC_RATEMCS16; -+ break; -+ case MGN_MCS17: -+ ret = DESC_RATEMCS17; -+ break; -+ case MGN_MCS18: -+ ret = DESC_RATEMCS18; -+ break; -+ case MGN_MCS19: -+ ret = DESC_RATEMCS19; -+ break; -+ case MGN_MCS20: -+ ret = DESC_RATEMCS20; -+ break; -+ case MGN_MCS21: -+ ret = DESC_RATEMCS21; -+ break; -+ case MGN_MCS22: -+ ret = DESC_RATEMCS22; -+ break; -+ case MGN_MCS23: -+ ret = DESC_RATEMCS23; -+ break; -+ case MGN_MCS24: -+ ret = DESC_RATEMCS24; -+ break; -+ case MGN_MCS25: -+ ret = DESC_RATEMCS25; -+ break; -+ case MGN_MCS26: -+ ret = DESC_RATEMCS26; -+ break; -+ case MGN_MCS27: -+ ret = DESC_RATEMCS27; -+ break; -+ case MGN_MCS28: -+ ret = DESC_RATEMCS28; -+ break; -+ case MGN_MCS29: -+ ret = DESC_RATEMCS29; -+ break; -+ case MGN_MCS30: -+ ret = DESC_RATEMCS30; -+ break; -+ case MGN_MCS31: -+ ret = DESC_RATEMCS31; -+ break; -+ case MGN_VHT1SS_MCS0: -+ ret = DESC_RATEVHTSS1MCS0; -+ break; -+ case MGN_VHT1SS_MCS1: -+ ret = DESC_RATEVHTSS1MCS1; -+ break; -+ case MGN_VHT1SS_MCS2: -+ ret = DESC_RATEVHTSS1MCS2; -+ break; -+ case MGN_VHT1SS_MCS3: -+ ret = DESC_RATEVHTSS1MCS3; -+ break; -+ case MGN_VHT1SS_MCS4: -+ ret = DESC_RATEVHTSS1MCS4; -+ break; -+ case MGN_VHT1SS_MCS5: -+ ret = DESC_RATEVHTSS1MCS5; -+ break; -+ case MGN_VHT1SS_MCS6: -+ ret = DESC_RATEVHTSS1MCS6; -+ break; -+ case MGN_VHT1SS_MCS7: -+ ret = DESC_RATEVHTSS1MCS7; -+ break; -+ case MGN_VHT1SS_MCS8: -+ ret = DESC_RATEVHTSS1MCS8; -+ break; -+ case MGN_VHT1SS_MCS9: -+ ret = DESC_RATEVHTSS1MCS9; -+ break; -+ case MGN_VHT2SS_MCS0: -+ ret = DESC_RATEVHTSS2MCS0; -+ break; -+ case MGN_VHT2SS_MCS1: -+ ret = DESC_RATEVHTSS2MCS1; -+ break; -+ case MGN_VHT2SS_MCS2: -+ ret = DESC_RATEVHTSS2MCS2; -+ break; -+ case MGN_VHT2SS_MCS3: -+ ret = DESC_RATEVHTSS2MCS3; -+ break; -+ case MGN_VHT2SS_MCS4: -+ ret = DESC_RATEVHTSS2MCS4; -+ break; -+ case MGN_VHT2SS_MCS5: -+ ret = DESC_RATEVHTSS2MCS5; -+ break; -+ case MGN_VHT2SS_MCS6: -+ ret = DESC_RATEVHTSS2MCS6; -+ break; -+ case MGN_VHT2SS_MCS7: -+ ret = DESC_RATEVHTSS2MCS7; -+ break; -+ case MGN_VHT2SS_MCS8: -+ ret = DESC_RATEVHTSS2MCS8; -+ break; -+ case MGN_VHT2SS_MCS9: -+ ret = DESC_RATEVHTSS2MCS9; -+ break; -+ case MGN_VHT3SS_MCS0: -+ ret = DESC_RATEVHTSS3MCS0; -+ break; -+ case MGN_VHT3SS_MCS1: -+ ret = DESC_RATEVHTSS3MCS1; -+ break; -+ case MGN_VHT3SS_MCS2: -+ ret = DESC_RATEVHTSS3MCS2; -+ break; -+ case MGN_VHT3SS_MCS3: -+ ret = DESC_RATEVHTSS3MCS3; -+ break; -+ case MGN_VHT3SS_MCS4: -+ ret = DESC_RATEVHTSS3MCS4; -+ break; -+ case MGN_VHT3SS_MCS5: -+ ret = DESC_RATEVHTSS3MCS5; -+ break; -+ case MGN_VHT3SS_MCS6: -+ ret = DESC_RATEVHTSS3MCS6; -+ break; -+ case MGN_VHT3SS_MCS7: -+ ret = DESC_RATEVHTSS3MCS7; -+ break; -+ case MGN_VHT3SS_MCS8: -+ ret = DESC_RATEVHTSS3MCS8; -+ break; -+ case MGN_VHT3SS_MCS9: -+ ret = DESC_RATEVHTSS3MCS9; -+ break; -+ case MGN_VHT4SS_MCS0: -+ ret = DESC_RATEVHTSS4MCS0; -+ break; -+ case MGN_VHT4SS_MCS1: -+ ret = DESC_RATEVHTSS4MCS1; -+ break; -+ case MGN_VHT4SS_MCS2: -+ ret = DESC_RATEVHTSS4MCS2; -+ break; -+ case MGN_VHT4SS_MCS3: -+ ret = DESC_RATEVHTSS4MCS3; -+ break; -+ case MGN_VHT4SS_MCS4: -+ ret = DESC_RATEVHTSS4MCS4; -+ break; -+ case MGN_VHT4SS_MCS5: -+ ret = DESC_RATEVHTSS4MCS5; -+ break; -+ case MGN_VHT4SS_MCS6: -+ ret = DESC_RATEVHTSS4MCS6; -+ break; -+ case MGN_VHT4SS_MCS7: -+ ret = DESC_RATEVHTSS4MCS7; -+ break; -+ case MGN_VHT4SS_MCS8: -+ ret = DESC_RATEVHTSS4MCS8; -+ break; -+ case MGN_VHT4SS_MCS9: -+ ret = DESC_RATEVHTSS4MCS9; -+ break; -+ default: -+ break; -+ } -+ -+ return ret; -+} -+ -+u8 HwRateToMRate(u8 rate) -+{ -+ u8 ret_rate = MGN_1M; -+ -+ switch (rate) { -+ case DESC_RATE1M: -+ ret_rate = MGN_1M; -+ break; -+ case DESC_RATE2M: -+ ret_rate = MGN_2M; -+ break; -+ case DESC_RATE5_5M: -+ ret_rate = MGN_5_5M; -+ break; -+ case DESC_RATE11M: -+ ret_rate = MGN_11M; -+ break; -+ case DESC_RATE6M: -+ ret_rate = MGN_6M; -+ break; -+ case DESC_RATE9M: -+ ret_rate = MGN_9M; -+ break; -+ case DESC_RATE12M: -+ ret_rate = MGN_12M; -+ break; -+ case DESC_RATE18M: -+ ret_rate = MGN_18M; -+ break; -+ case DESC_RATE24M: -+ ret_rate = MGN_24M; -+ break; -+ case DESC_RATE36M: -+ ret_rate = MGN_36M; -+ break; -+ case DESC_RATE48M: -+ ret_rate = MGN_48M; -+ break; -+ case DESC_RATE54M: -+ ret_rate = MGN_54M; -+ break; -+ case DESC_RATEMCS0: -+ ret_rate = MGN_MCS0; -+ break; -+ case DESC_RATEMCS1: -+ ret_rate = MGN_MCS1; -+ break; -+ case DESC_RATEMCS2: -+ ret_rate = MGN_MCS2; -+ break; -+ case DESC_RATEMCS3: -+ ret_rate = MGN_MCS3; -+ break; -+ case DESC_RATEMCS4: -+ ret_rate = MGN_MCS4; -+ break; -+ case DESC_RATEMCS5: -+ ret_rate = MGN_MCS5; -+ break; -+ case DESC_RATEMCS6: -+ ret_rate = MGN_MCS6; -+ break; -+ case DESC_RATEMCS7: -+ ret_rate = MGN_MCS7; -+ break; -+ case DESC_RATEMCS8: -+ ret_rate = MGN_MCS8; -+ break; -+ case DESC_RATEMCS9: -+ ret_rate = MGN_MCS9; -+ break; -+ case DESC_RATEMCS10: -+ ret_rate = MGN_MCS10; -+ break; -+ case DESC_RATEMCS11: -+ ret_rate = MGN_MCS11; -+ break; -+ case DESC_RATEMCS12: -+ ret_rate = MGN_MCS12; -+ break; -+ case DESC_RATEMCS13: -+ ret_rate = MGN_MCS13; -+ break; -+ case DESC_RATEMCS14: -+ ret_rate = MGN_MCS14; -+ break; -+ case DESC_RATEMCS15: -+ ret_rate = MGN_MCS15; -+ break; -+ case DESC_RATEMCS16: -+ ret_rate = MGN_MCS16; -+ break; -+ case DESC_RATEMCS17: -+ ret_rate = MGN_MCS17; -+ break; -+ case DESC_RATEMCS18: -+ ret_rate = MGN_MCS18; -+ break; -+ case DESC_RATEMCS19: -+ ret_rate = MGN_MCS19; -+ break; -+ case DESC_RATEMCS20: -+ ret_rate = MGN_MCS20; -+ break; -+ case DESC_RATEMCS21: -+ ret_rate = MGN_MCS21; -+ break; -+ case DESC_RATEMCS22: -+ ret_rate = MGN_MCS22; -+ break; -+ case DESC_RATEMCS23: -+ ret_rate = MGN_MCS23; -+ break; -+ case DESC_RATEMCS24: -+ ret_rate = MGN_MCS24; -+ break; -+ case DESC_RATEMCS25: -+ ret_rate = MGN_MCS25; -+ break; -+ case DESC_RATEMCS26: -+ ret_rate = MGN_MCS26; -+ break; -+ case DESC_RATEMCS27: -+ ret_rate = MGN_MCS27; -+ break; -+ case DESC_RATEMCS28: -+ ret_rate = MGN_MCS28; -+ break; -+ case DESC_RATEMCS29: -+ ret_rate = MGN_MCS29; -+ break; -+ case DESC_RATEMCS30: -+ ret_rate = MGN_MCS30; -+ break; -+ case DESC_RATEMCS31: -+ ret_rate = MGN_MCS31; -+ break; -+ case DESC_RATEVHTSS1MCS0: -+ ret_rate = MGN_VHT1SS_MCS0; -+ break; -+ case DESC_RATEVHTSS1MCS1: -+ ret_rate = MGN_VHT1SS_MCS1; -+ break; -+ case DESC_RATEVHTSS1MCS2: -+ ret_rate = MGN_VHT1SS_MCS2; -+ break; -+ case DESC_RATEVHTSS1MCS3: -+ ret_rate = MGN_VHT1SS_MCS3; -+ break; -+ case DESC_RATEVHTSS1MCS4: -+ ret_rate = MGN_VHT1SS_MCS4; -+ break; -+ case DESC_RATEVHTSS1MCS5: -+ ret_rate = MGN_VHT1SS_MCS5; -+ break; -+ case DESC_RATEVHTSS1MCS6: -+ ret_rate = MGN_VHT1SS_MCS6; -+ break; -+ case DESC_RATEVHTSS1MCS7: -+ ret_rate = MGN_VHT1SS_MCS7; -+ break; -+ case DESC_RATEVHTSS1MCS8: -+ ret_rate = MGN_VHT1SS_MCS8; -+ break; -+ case DESC_RATEVHTSS1MCS9: -+ ret_rate = MGN_VHT1SS_MCS9; -+ break; -+ case DESC_RATEVHTSS2MCS0: -+ ret_rate = MGN_VHT2SS_MCS0; -+ break; -+ case DESC_RATEVHTSS2MCS1: -+ ret_rate = MGN_VHT2SS_MCS1; -+ break; -+ case DESC_RATEVHTSS2MCS2: -+ ret_rate = MGN_VHT2SS_MCS2; -+ break; -+ case DESC_RATEVHTSS2MCS3: -+ ret_rate = MGN_VHT2SS_MCS3; -+ break; -+ case DESC_RATEVHTSS2MCS4: -+ ret_rate = MGN_VHT2SS_MCS4; -+ break; -+ case DESC_RATEVHTSS2MCS5: -+ ret_rate = MGN_VHT2SS_MCS5; -+ break; -+ case DESC_RATEVHTSS2MCS6: -+ ret_rate = MGN_VHT2SS_MCS6; -+ break; -+ case DESC_RATEVHTSS2MCS7: -+ ret_rate = MGN_VHT2SS_MCS7; -+ break; -+ case DESC_RATEVHTSS2MCS8: -+ ret_rate = MGN_VHT2SS_MCS8; -+ break; -+ case DESC_RATEVHTSS2MCS9: -+ ret_rate = MGN_VHT2SS_MCS9; -+ break; -+ case DESC_RATEVHTSS3MCS0: -+ ret_rate = MGN_VHT3SS_MCS0; -+ break; -+ case DESC_RATEVHTSS3MCS1: -+ ret_rate = MGN_VHT3SS_MCS1; -+ break; -+ case DESC_RATEVHTSS3MCS2: -+ ret_rate = MGN_VHT3SS_MCS2; -+ break; -+ case DESC_RATEVHTSS3MCS3: -+ ret_rate = MGN_VHT3SS_MCS3; -+ break; -+ case DESC_RATEVHTSS3MCS4: -+ ret_rate = MGN_VHT3SS_MCS4; -+ break; -+ case DESC_RATEVHTSS3MCS5: -+ ret_rate = MGN_VHT3SS_MCS5; -+ break; -+ case DESC_RATEVHTSS3MCS6: -+ ret_rate = MGN_VHT3SS_MCS6; -+ break; -+ case DESC_RATEVHTSS3MCS7: -+ ret_rate = MGN_VHT3SS_MCS7; -+ break; -+ case DESC_RATEVHTSS3MCS8: -+ ret_rate = MGN_VHT3SS_MCS8; -+ break; -+ case DESC_RATEVHTSS3MCS9: -+ ret_rate = MGN_VHT3SS_MCS9; -+ break; -+ case DESC_RATEVHTSS4MCS0: -+ ret_rate = MGN_VHT4SS_MCS0; -+ break; -+ case DESC_RATEVHTSS4MCS1: -+ ret_rate = MGN_VHT4SS_MCS1; -+ break; -+ case DESC_RATEVHTSS4MCS2: -+ ret_rate = MGN_VHT4SS_MCS2; -+ break; -+ case DESC_RATEVHTSS4MCS3: -+ ret_rate = MGN_VHT4SS_MCS3; -+ break; -+ case DESC_RATEVHTSS4MCS4: -+ ret_rate = MGN_VHT4SS_MCS4; -+ break; -+ case DESC_RATEVHTSS4MCS5: -+ ret_rate = MGN_VHT4SS_MCS5; -+ break; -+ case DESC_RATEVHTSS4MCS6: -+ ret_rate = MGN_VHT4SS_MCS6; -+ break; -+ case DESC_RATEVHTSS4MCS7: -+ ret_rate = MGN_VHT4SS_MCS7; -+ break; -+ case DESC_RATEVHTSS4MCS8: -+ ret_rate = MGN_VHT4SS_MCS8; -+ break; -+ case DESC_RATEVHTSS4MCS9: -+ ret_rate = MGN_VHT4SS_MCS9; -+ break; -+ -+ default: -+ DBG_871X("HwRateToMRate(): Non supported Rate [%x]!!!\n", rate); -+ break; -+ } -+ -+ return ret_rate; -+} -+ -+void HalSetBrateCfg(struct adapter *Adapter, u8 *mBratesOS, u16 *pBrateCfg) -+{ -+ u8 i, is_brate, brate; -+ -+ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { -+ -+ is_brate = mBratesOS[i] & IEEE80211_BASIC_RATE_MASK; -+ brate = mBratesOS[i] & 0x7f; -+ -+ if (is_brate) { -+ switch (brate) { -+ case IEEE80211_CCK_RATE_1MB: -+ *pBrateCfg |= RATE_1M; -+ break; -+ case IEEE80211_CCK_RATE_2MB: -+ *pBrateCfg |= RATE_2M; -+ break; -+ case IEEE80211_CCK_RATE_5MB: -+ *pBrateCfg |= RATE_5_5M; -+ break; -+ case IEEE80211_CCK_RATE_11MB: -+ *pBrateCfg |= RATE_11M; -+ break; -+ case IEEE80211_OFDM_RATE_6MB: -+ *pBrateCfg |= RATE_6M; -+ break; -+ case IEEE80211_OFDM_RATE_9MB: -+ *pBrateCfg |= RATE_9M; -+ break; -+ case IEEE80211_OFDM_RATE_12MB: -+ *pBrateCfg |= RATE_12M; -+ break; -+ case IEEE80211_OFDM_RATE_18MB: -+ *pBrateCfg |= RATE_18M; -+ break; -+ case IEEE80211_OFDM_RATE_24MB: -+ *pBrateCfg |= RATE_24M; -+ break; -+ case IEEE80211_OFDM_RATE_36MB: -+ *pBrateCfg |= RATE_36M; -+ break; -+ case IEEE80211_OFDM_RATE_48MB: -+ *pBrateCfg |= RATE_48M; -+ break; -+ case IEEE80211_OFDM_RATE_54MB: -+ *pBrateCfg |= RATE_54M; -+ break; -+ } -+ } -+ } -+} -+ -+static void _OneOutPipeMapping(struct adapter *padapter) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];/* VI */ -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[0];/* BE */ -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[0];/* BK */ -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ -+} -+ -+static void _TwoOutPipeMapping(struct adapter *padapter, bool bWIFICfg) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ -+ if (bWIFICfg) { /* WMM */ -+ -+ /* BK, BE, VI, VO, BCN, CMD, MGT, HIGH, HCCA */ -+ /* 0, 1, 0, 1, 0, 0, 0, 0, 0 }; */ -+ /* 0:ep_0 num, 1:ep_1 num */ -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[1];/* VO */ -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];/* VI */ -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[1];/* BE */ -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[0];/* BK */ -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ -+ -+ } else { /* typical setting */ -+ -+ -+ /* BK, BE, VI, VO, BCN, CMD, MGT, HIGH, HCCA */ -+ /* 1, 1, 0, 0, 0, 0, 0, 0, 0 }; */ -+ /* 0:ep_0 num, 1:ep_1 num */ -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];/* VI */ -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[1];/* BE */ -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];/* BK */ -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ -+ -+ } -+ -+} -+ -+static void _ThreeOutPipeMapping(struct adapter *padapter, bool bWIFICfg) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ -+ if (bWIFICfg) { /* for WMM */ -+ -+ /* BK, BE, VI, VO, BCN, CMD, MGT, HIGH, HCCA */ -+ /* 1, 2, 1, 0, 0, 0, 0, 0, 0 }; */ -+ /* 0:H, 1:N, 2:L */ -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];/* VI */ -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];/* BE */ -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];/* BK */ -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ -+ -+ } else { /* typical setting */ -+ -+ -+ /* BK, BE, VI, VO, BCN, CMD, MGT, HIGH, HCCA */ -+ /* 2, 2, 1, 0, 0, 0, 0, 0, 0 }; */ -+ /* 0:H, 1:N, 2:L */ -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];/* VI */ -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];/* BE */ -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[2];/* BK */ -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ -+ } -+ -+} -+ -+bool Hal_MappingOutPipe(struct adapter *padapter, u8 NumOutPipe) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ bool bWIFICfg = (pregistrypriv->wifi_spec) ? true : false; -+ -+ bool result = true; -+ -+ switch (NumOutPipe) { -+ case 2: -+ _TwoOutPipeMapping(padapter, bWIFICfg); -+ break; -+ case 3: -+ case 4: -+ _ThreeOutPipeMapping(padapter, bWIFICfg); -+ break; -+ case 1: -+ _OneOutPipeMapping(padapter); -+ break; -+ default: -+ result = false; -+ break; -+ } -+ -+ return result; -+ -+} -+ -+void hal_init_macaddr(struct adapter *adapter) -+{ -+ rtw_hal_set_hwreg(adapter, HW_VAR_MAC_ADDR, adapter->eeprompriv.mac_addr); -+} -+ -+void rtw_init_hal_com_default_value(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ pHalData->AntDetection = 1; -+} -+ -+/* -+* C2H event format: -+* Field TRIGGER CONTENT CMD_SEQ CMD_LEN CMD_ID -+* BITS [127:120] [119:16] [15:8] [7:4] [3:0] -+*/ -+ -+void c2h_evt_clear(struct adapter *adapter) -+{ -+ rtw_write8(adapter, REG_C2HEVT_CLEAR, C2H_EVT_HOST_CLOSE); -+} -+ -+/* -+* C2H event format: -+* Field TRIGGER CMD_LEN CONTENT CMD_SEQ CMD_ID -+* BITS [127:120] [119:112] [111:16] [15:8] [7:0] -+*/ -+s32 c2h_evt_read_88xx(struct adapter *adapter, u8 *buf) -+{ -+ s32 ret = _FAIL; -+ struct c2h_evt_hdr_88xx *c2h_evt; -+ int i; -+ u8 trigger; -+ -+ if (buf == NULL) -+ goto exit; -+ -+ trigger = rtw_read8(adapter, REG_C2HEVT_CLEAR); -+ -+ if (trigger == C2H_EVT_HOST_CLOSE) -+ goto exit; /* Not ready */ -+ else if (trigger != C2H_EVT_FW_CLOSE) -+ goto clear_evt; /* Not a valid value */ -+ -+ c2h_evt = (struct c2h_evt_hdr_88xx *)buf; -+ -+ memset(c2h_evt, 0, 16); -+ -+ c2h_evt->id = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL); -+ c2h_evt->seq = rtw_read8(adapter, REG_C2HEVT_CMD_SEQ_88XX); -+ c2h_evt->plen = rtw_read8(adapter, REG_C2HEVT_CMD_LEN_88XX); -+ -+ RT_PRINT_DATA( -+ _module_hal_init_c_, -+ _drv_info_, -+ "c2h_evt_read(): ", -+ &c2h_evt, -+ sizeof(c2h_evt) -+ ); -+ -+ DBG_871X( -+ "%s id:%u, len:%u, seq:%u, trigger:0x%02x\n", -+ __func__, -+ c2h_evt->id, -+ c2h_evt->plen, -+ c2h_evt->seq, -+ trigger -+ ); -+ -+ /* Read the content */ -+ for (i = 0; i < c2h_evt->plen; i++) -+ c2h_evt->payload[i] = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL + 2 + i); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_info_, "c2h_evt_read(): Command Content:\n", -+ c2h_evt->payload, c2h_evt->plen); -+ -+ ret = _SUCCESS; -+ -+clear_evt: -+ /* -+ * Clear event to notify FW we have read the command. -+ * If this field isn't clear, the FW won't update the next command message. -+ */ -+ c2h_evt_clear(adapter); -+exit: -+ return ret; -+} -+ -+ -+u8 rtw_hal_networktype_to_raid(struct adapter *adapter, struct sta_info *psta) -+{ -+ return networktype_to_raid_ex(adapter, psta); -+} -+ -+u8 rtw_get_mgntframe_raid(struct adapter *adapter, unsigned char network_type) -+{ -+ -+ u8 raid; -+ raid = (network_type & WIRELESS_11B) ? RATEID_IDX_B : RATEID_IDX_G; -+ return raid; -+} -+ -+void rtw_hal_update_sta_rate_mask(struct adapter *padapter, struct sta_info *psta) -+{ -+ u8 i, rf_type, limit; -+ u32 tx_ra_bitmap; -+ -+ if (psta == NULL) -+ return; -+ -+ tx_ra_bitmap = 0; -+ -+ /* b/g mode ra_bitmap */ -+ for (i = 0; i < sizeof(psta->bssrateset); i++) { -+ if (psta->bssrateset[i]) -+ tx_ra_bitmap |= rtw_get_bit_value_from_ieee_value(psta->bssrateset[i]&0x7f); -+ } -+ -+ /* n mode ra_bitmap */ -+ if (psta->htpriv.ht_option) { -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if (rf_type == RF_2T2R) -+ limit = 16; /* 2R */ -+ else -+ limit = 8; /* 1R */ -+ -+ for (i = 0; i < limit; i++) { -+ if (psta->htpriv.ht_cap.supp_mcs_set[i/8] & BIT(i%8)) -+ tx_ra_bitmap |= BIT(i+12); -+ } -+ } -+ -+ psta->ra_mask = tx_ra_bitmap; -+ psta->init_rate = get_highest_rate_idx(tx_ra_bitmap)&0x3f; -+} -+ -+void hw_var_port_switch(struct adapter *adapter) -+{ -+} -+ -+void SetHwReg(struct adapter *adapter, u8 variable, u8 *val) -+{ -+ struct hal_com_data *hal_data = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &(hal_data->odmpriv); -+ -+ switch (variable) { -+ case HW_VAR_PORT_SWITCH: -+ hw_var_port_switch(adapter); -+ break; -+ case HW_VAR_INIT_RTS_RATE: -+ rtw_warn_on(1); -+ break; -+ case HW_VAR_SEC_CFG: -+ { -+ u16 reg_scr; -+ -+ reg_scr = rtw_read16(adapter, REG_SECCFG); -+ rtw_write16(adapter, REG_SECCFG, reg_scr|SCR_CHK_KEYID|SCR_RxDecEnable|SCR_TxEncEnable); -+ } -+ break; -+ case HW_VAR_SEC_DK_CFG: -+ { -+ struct security_priv *sec = &adapter->securitypriv; -+ u8 reg_scr = rtw_read8(adapter, REG_SECCFG); -+ -+ if (val) { /* Enable default key related setting */ -+ reg_scr |= SCR_TXBCUSEDK; -+ if (sec->dot11AuthAlgrthm != dot11AuthAlgrthm_8021X) -+ reg_scr |= (SCR_RxUseDK|SCR_TxUseDK); -+ } else /* Disable default key related setting */ -+ reg_scr &= ~(SCR_RXBCUSEDK|SCR_TXBCUSEDK|SCR_RxUseDK|SCR_TxUseDK); -+ -+ rtw_write8(adapter, REG_SECCFG, reg_scr); -+ } -+ break; -+ case HW_VAR_DM_FLAG: -+ odm->SupportAbility = *((u32 *)val); -+ break; -+ case HW_VAR_DM_FUNC_OP: -+ if (*((u8 *)val) == true) { -+ /* save dm flag */ -+ odm->BK_SupportAbility = odm->SupportAbility; -+ } else { -+ /* restore dm flag */ -+ odm->SupportAbility = odm->BK_SupportAbility; -+ } -+ break; -+ case HW_VAR_DM_FUNC_SET: -+ if (*((u32 *)val) == DYNAMIC_ALL_FUNC_ENABLE) { -+ struct dm_priv *dm = &hal_data->dmpriv; -+ dm->DMFlag = dm->InitDMFlag; -+ odm->SupportAbility = dm->InitODMFlag; -+ } else { -+ odm->SupportAbility |= *((u32 *)val); -+ } -+ break; -+ case HW_VAR_DM_FUNC_CLR: -+ /* -+ * input is already a mask to clear function -+ * don't invert it again! George, Lucas@20130513 -+ */ -+ odm->SupportAbility &= *((u32 *)val); -+ break; -+ case HW_VAR_AMPDU_MIN_SPACE: -+ /* TODO - Is something needed here? */ -+ break; -+ case HW_VAR_WIRELESS_MODE: -+ /* TODO - Is something needed here? */ -+ break; -+ default: -+ DBG_871X_LEVEL( -+ _drv_always_, -+ FUNC_ADPT_FMT" variable(%d) not defined!\n", -+ FUNC_ADPT_ARG(adapter), -+ variable -+ ); -+ break; -+ } -+} -+ -+void GetHwReg(struct adapter *adapter, u8 variable, u8 *val) -+{ -+ struct hal_com_data *hal_data = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &(hal_data->odmpriv); -+ -+ switch (variable) { -+ case HW_VAR_BASIC_RATE: -+ *((u16 *)val) = hal_data->BasicRateSet; -+ break; -+ case HW_VAR_DM_FLAG: -+ *((u32 *)val) = odm->SupportAbility; -+ break; -+ case HW_VAR_RF_TYPE: -+ *((u8 *)val) = hal_data->rf_type; -+ break; -+ default: -+ DBG_871X_LEVEL( -+ _drv_always_, -+ FUNC_ADPT_FMT" variable(%d) not defined!\n", -+ FUNC_ADPT_ARG(adapter), -+ variable -+ ); -+ break; -+ } -+} -+ -+ -+ -+ -+u8 SetHalDefVar( -+ struct adapter *adapter, enum HAL_DEF_VARIABLE variable, void *value -+) -+{ -+ struct hal_com_data *hal_data = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &(hal_data->odmpriv); -+ u8 bResult = _SUCCESS; -+ -+ switch (variable) { -+ case HW_DEF_FA_CNT_DUMP: -+ /* ODM_COMP_COMMON */ -+ if (*((u8 *)value)) -+ odm->DebugComponents |= (ODM_COMP_DIG | ODM_COMP_FA_CNT); -+ else -+ odm->DebugComponents &= ~(ODM_COMP_DIG | ODM_COMP_FA_CNT); -+ break; -+ case HAL_DEF_DBG_RX_INFO_DUMP: -+ DBG_871X("============ Rx Info dump ===================\n"); -+ DBG_871X("bLinked = %d, RSSI_Min = %d(%%)\n", -+ odm->bLinked, odm->RSSI_Min); -+ -+ if (odm->bLinked) { -+ DBG_871X("RxRate = %s, RSSI_A = %d(%%), RSSI_B = %d(%%)\n", -+ HDATA_RATE(odm->RxRate), odm->RSSI_A, odm->RSSI_B); -+ -+ #ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ rtw_dump_raw_rssi_info(adapter); -+ #endif -+ } -+ break; -+ case HW_DEF_ODM_DBG_FLAG: -+ ODM_CmnInfoUpdate(odm, ODM_CMNINFO_DBG_COMP, *((u64 *)value)); -+ break; -+ case HW_DEF_ODM_DBG_LEVEL: -+ ODM_CmnInfoUpdate(odm, ODM_CMNINFO_DBG_LEVEL, *((u32 *)value)); -+ break; -+ case HAL_DEF_DBG_DM_FUNC: -+ { -+ u8 dm_func = *((u8 *)value); -+ struct dm_priv *dm = &hal_data->dmpriv; -+ -+ if (dm_func == 0) { /* disable all dynamic func */ -+ odm->SupportAbility = DYNAMIC_FUNC_DISABLE; -+ DBG_8192C("==> Disable all dynamic function...\n"); -+ } else if (dm_func == 1) {/* disable DIG */ -+ odm->SupportAbility &= (~DYNAMIC_BB_DIG); -+ DBG_8192C("==> Disable DIG...\n"); -+ } else if (dm_func == 2) {/* disable High power */ -+ odm->SupportAbility &= (~DYNAMIC_BB_DYNAMIC_TXPWR); -+ } else if (dm_func == 3) {/* disable tx power tracking */ -+ odm->SupportAbility &= (~DYNAMIC_RF_CALIBRATION); -+ DBG_8192C("==> Disable tx power tracking...\n"); -+ } else if (dm_func == 4) {/* disable BT coexistence */ -+ dm->DMFlag &= (~DYNAMIC_FUNC_BT); -+ } else if (dm_func == 5) {/* disable antenna diversity */ -+ odm->SupportAbility &= (~DYNAMIC_BB_ANT_DIV); -+ } else if (dm_func == 6) {/* turn on all dynamic func */ -+ if (!(odm->SupportAbility & DYNAMIC_BB_DIG)) { -+ DIG_T *pDigTable = &odm->DM_DigTable; -+ pDigTable->CurIGValue = rtw_read8(adapter, 0xc50); -+ } -+ dm->DMFlag |= DYNAMIC_FUNC_BT; -+ odm->SupportAbility = DYNAMIC_ALL_FUNC_ENABLE; -+ DBG_8192C("==> Turn on all dynamic function...\n"); -+ } -+ } -+ break; -+ case HAL_DEF_DBG_DUMP_RXPKT: -+ hal_data->bDumpRxPkt = *((u8 *)value); -+ break; -+ case HAL_DEF_DBG_DUMP_TXPKT: -+ hal_data->bDumpTxPkt = *((u8 *)value); -+ break; -+ case HAL_DEF_ANT_DETECT: -+ hal_data->AntDetection = *((u8 *)value); -+ break; -+ default: -+ DBG_871X_LEVEL(_drv_always_, "%s: [WARNING] HAL_DEF_VARIABLE(%d) not defined!\n", __func__, variable); -+ bResult = _FAIL; -+ break; -+ } -+ -+ return bResult; -+} -+ -+u8 GetHalDefVar( -+ struct adapter *adapter, enum HAL_DEF_VARIABLE variable, void *value -+) -+{ -+ struct hal_com_data *hal_data = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &(hal_data->odmpriv); -+ u8 bResult = _SUCCESS; -+ -+ switch (variable) { -+ case HAL_DEF_UNDERCORATEDSMOOTHEDPWDB: -+ { -+ struct mlme_priv *pmlmepriv; -+ struct sta_priv *pstapriv; -+ struct sta_info *psta; -+ -+ pmlmepriv = &adapter->mlmepriv; -+ pstapriv = &adapter->stapriv; -+ psta = rtw_get_stainfo(pstapriv, pmlmepriv->cur_network.network.MacAddress); -+ if (psta) -+ *((int *)value) = psta->rssi_stat.UndecoratedSmoothedPWDB; -+ } -+ break; -+ case HW_DEF_ODM_DBG_FLAG: -+ *((u64 *)value) = odm->DebugComponents; -+ break; -+ case HW_DEF_ODM_DBG_LEVEL: -+ *((u32 *)value) = odm->DebugLevel; -+ break; -+ case HAL_DEF_DBG_DM_FUNC: -+ *((u32 *)value) = hal_data->odmpriv.SupportAbility; -+ break; -+ case HAL_DEF_DBG_DUMP_RXPKT: -+ *((u8 *)value) = hal_data->bDumpRxPkt; -+ break; -+ case HAL_DEF_DBG_DUMP_TXPKT: -+ *((u8 *)value) = hal_data->bDumpTxPkt; -+ break; -+ case HAL_DEF_ANT_DETECT: -+ *((u8 *)value) = hal_data->AntDetection; -+ break; -+ case HAL_DEF_MACID_SLEEP: -+ *(u8 *)value = false; -+ break; -+ case HAL_DEF_TX_PAGE_SIZE: -+ *((u32 *)value) = PAGE_SIZE_128; -+ break; -+ default: -+ DBG_871X_LEVEL(_drv_always_, "%s: [WARNING] HAL_DEF_VARIABLE(%d) not defined!\n", __func__, variable); -+ bResult = _FAIL; -+ break; -+ } -+ -+ return bResult; -+} -+ -+void GetHalODMVar( -+ struct adapter *Adapter, -+ enum HAL_ODM_VARIABLE eVariable, -+ void *pValue1, -+ void *pValue2 -+) -+{ -+ switch (eVariable) { -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ case HAL_ODM_NOISE_MONITOR: -+ { -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ u8 chan = *(u8 *)pValue1; -+ *(s16 *)pValue2 = pHalData->noise[chan]; -+ #ifdef DBG_NOISE_MONITOR -+ DBG_8192C("### Noise monitor chan(%d)-noise:%d (dBm) ###\n", -+ chan, pHalData->noise[chan]); -+ #endif -+ -+ } -+ break; -+#endif/* ifdef CONFIG_BACKGROUND_NOISE_MONITOR */ -+ default: -+ break; -+ } -+} -+ -+void SetHalODMVar( -+ struct adapter *Adapter, -+ enum HAL_ODM_VARIABLE eVariable, -+ void *pValue1, -+ bool bSet -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ /* _irqL irqL; */ -+ switch (eVariable) { -+ case HAL_ODM_STA_INFO: -+ { -+ struct sta_info *psta = (struct sta_info *)pValue1; -+ if (bSet) { -+ DBG_8192C("### Set STA_(%d) info ###\n", psta->mac_id); -+ ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS, psta->mac_id, psta); -+ } else { -+ DBG_8192C("### Clean STA_(%d) info ###\n", psta->mac_id); -+ /* spin_lock_bh(&pHalData->odm_stainfo_lock); */ -+ ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS, psta->mac_id, NULL); -+ -+ /* spin_unlock_bh(&pHalData->odm_stainfo_lock); */ -+ } -+ } -+ break; -+ case HAL_ODM_P2P_STATE: -+ ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_WIFI_DIRECT, bSet); -+ break; -+ case HAL_ODM_WIFI_DISPLAY_STATE: -+ ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_WIFI_DISPLAY, bSet); -+ break; -+ #if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ case HAL_ODM_NOISE_MONITOR: -+ { -+ struct noise_info *pinfo = (struct noise_info *)pValue1; -+ -+ #ifdef DBG_NOISE_MONITOR -+ DBG_8192C("### Noise monitor chan(%d)-bPauseDIG:%d, IGIValue:0x%02x, max_time:%d (ms) ###\n", -+ pinfo->chan, pinfo->bPauseDIG, pinfo->IGIValue, pinfo->max_time); -+ #endif -+ -+ pHalData->noise[pinfo->chan] = ODM_InbandNoise_Monitor(podmpriv, pinfo->bPauseDIG, pinfo->IGIValue, pinfo->max_time); -+ DBG_871X("chan_%d, noise = %d (dBm)\n", pinfo->chan, pHalData->noise[pinfo->chan]); -+ #ifdef DBG_NOISE_MONITOR -+ DBG_871X("noise_a = %d, noise_b = %d noise_all:%d\n", -+ podmpriv->noise_level.noise[ODM_RF_PATH_A], -+ podmpriv->noise_level.noise[ODM_RF_PATH_B], -+ podmpriv->noise_level.noise_all); -+ #endif -+ } -+ break; -+ #endif/* ifdef CONFIG_BACKGROUND_NOISE_MONITOR */ -+ -+ default: -+ break; -+ } -+} -+ -+ -+bool eqNByte(u8 *str1, u8 *str2, u32 num) -+{ -+ if (num == 0) -+ return false; -+ while (num > 0) { -+ num--; -+ if (str1[num] != str2[num]) -+ return false; -+ } -+ return true; -+} -+ -+/* */ -+/* Description: */ -+/* Return true if chTmp is represent for hex digit and */ -+/* false otherwise. */ -+/* */ -+/* */ -+bool IsHexDigit(char chTmp) -+{ -+ if ( -+ (chTmp >= '0' && chTmp <= '9') || -+ (chTmp >= 'a' && chTmp <= 'f') || -+ (chTmp >= 'A' && chTmp <= 'F') -+ ) -+ return true; -+ else -+ return false; -+} -+ -+ -+/* */ -+/* Description: */ -+/* Translate a character to hex digit. */ -+/* */ -+u32 MapCharToHexDigit(char chTmp) -+{ -+ if (chTmp >= '0' && chTmp <= '9') -+ return (chTmp - '0'); -+ else if (chTmp >= 'a' && chTmp <= 'f') -+ return (10 + (chTmp - 'a')); -+ else if (chTmp >= 'A' && chTmp <= 'F') -+ return (10 + (chTmp - 'A')); -+ else -+ return 0; -+} -+ -+ -+ -+/* Description: */ -+/* Parse hex number from the string pucStr. */ -+bool GetHexValueFromString(char *szStr, u32 *pu4bVal, u32 *pu4bMove) -+{ -+ char *szScan = szStr; -+ -+ /* Check input parameter. */ -+ if (szStr == NULL || pu4bVal == NULL || pu4bMove == NULL) { -+ DBG_871X("GetHexValueFromString(): Invalid inpur argumetns! szStr: %p, pu4bVal: %p, pu4bMove: %p\n", szStr, pu4bVal, pu4bMove); -+ return false; -+ } -+ -+ /* Initialize output. */ -+ *pu4bMove = 0; -+ *pu4bVal = 0; -+ -+ /* Skip leading space. */ -+ while (*szScan != '\0' && (*szScan == ' ' || *szScan == '\t')) { -+ szScan++; -+ (*pu4bMove)++; -+ } -+ -+ /* Skip leading '0x' or '0X'. */ -+ if (*szScan == '0' && (*(szScan+1) == 'x' || *(szScan+1) == 'X')) { -+ szScan += 2; -+ (*pu4bMove) += 2; -+ } -+ -+ /* Check if szScan is now pointer to a character for hex digit, */ -+ /* if not, it means this is not a valid hex number. */ -+ if (!IsHexDigit(*szScan)) -+ return false; -+ -+ /* Parse each digit. */ -+ do { -+ (*pu4bVal) <<= 4; -+ *pu4bVal += MapCharToHexDigit(*szScan); -+ -+ szScan++; -+ (*pu4bMove)++; -+ } while (IsHexDigit(*szScan)); -+ -+ return true; -+} -+ -+bool GetFractionValueFromString( -+ char *szStr, u8 *pInteger, u8 *pFraction, u32 *pu4bMove -+) -+{ -+ char *szScan = szStr; -+ -+ /* Initialize output. */ -+ *pu4bMove = 0; -+ *pInteger = 0; -+ *pFraction = 0; -+ -+ /* Skip leading space. */ -+ while (*szScan != '\0' && (*szScan == ' ' || *szScan == '\t')) { -+ ++szScan; -+ ++(*pu4bMove); -+ } -+ -+ /* Parse each digit. */ -+ do { -+ (*pInteger) *= 10; -+ *pInteger += (*szScan - '0'); -+ -+ ++szScan; -+ ++(*pu4bMove); -+ -+ if (*szScan == '.') { -+ ++szScan; -+ ++(*pu4bMove); -+ -+ if (*szScan < '0' || *szScan > '9') -+ return false; -+ else { -+ *pFraction = *szScan - '0'; -+ ++szScan; -+ ++(*pu4bMove); -+ return true; -+ } -+ } -+ } while (*szScan >= '0' && *szScan <= '9'); -+ -+ return true; -+} -+ -+/* */ -+/* Description: */ -+/* Return true if szStr is comment out with leading "//". */ -+/* */ -+bool IsCommentString(char *szStr) -+{ -+ if (*szStr == '/' && *(szStr+1) == '/') -+ return true; -+ else -+ return false; -+} -+ -+bool GetU1ByteIntegerFromStringInDecimal(char *Str, u8 *pInt) -+{ -+ u16 i = 0; -+ *pInt = 0; -+ -+ while (Str[i] != '\0') { -+ if (Str[i] >= '0' && Str[i] <= '9') { -+ *pInt *= 10; -+ *pInt += (Str[i] - '0'); -+ } else -+ return false; -+ -+ ++i; -+ } -+ -+ return true; -+} -+ -+/* <20121004, Kordan> For example, -+ * ParseQualifiedString(inString, 0, outString, '[', ']') gets "Kordan" from -+ * a string "Hello [Kordan]". -+ * If RightQualifier does not exist, it will hang in the while loop -+ */ -+bool ParseQualifiedString( -+ char *In, u32 *Start, char *Out, char LeftQualifier, char RightQualifier -+) -+{ -+ u32 i = 0, j = 0; -+ char c = In[(*Start)++]; -+ -+ if (c != LeftQualifier) -+ return false; -+ -+ i = (*Start); -+ while ((c = In[(*Start)++]) != RightQualifier) -+ ; /* find ']' */ -+ j = (*Start) - 2; -+ strncpy((char *)Out, (const char *)(In+i), j-i+1); -+ -+ return true; -+} -+ -+bool isAllSpaceOrTab(u8 *data, u8 size) -+{ -+ u8 cnt = 0, NumOfSpaceAndTab = 0; -+ -+ while (size > cnt) { -+ if (data[cnt] == ' ' || data[cnt] == '\t' || data[cnt] == '\0') -+ ++NumOfSpaceAndTab; -+ -+ ++cnt; -+ } -+ -+ return size == NumOfSpaceAndTab; -+} -+ -+ -+void rtw_hal_check_rxfifo_full(struct adapter *adapter) -+{ -+ struct dvobj_priv *psdpriv = adapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ int save_cnt = false; -+ -+ /* switch counter to RX fifo */ -+ /* printk("8723b or 8192e , MAC_667 set 0xf0\n"); */ -+ rtw_write8(adapter, REG_RXERR_RPT+3, rtw_read8(adapter, REG_RXERR_RPT+3)|0xf0); -+ save_cnt = true; -+ /* todo: other chips */ -+ -+ if (save_cnt) { -+ /* rtw_write8(adapter, REG_RXERR_RPT+3, rtw_read8(adapter, REG_RXERR_RPT+3)|0xa0); */ -+ pdbgpriv->dbg_rx_fifo_last_overflow = pdbgpriv->dbg_rx_fifo_curr_overflow; -+ pdbgpriv->dbg_rx_fifo_curr_overflow = rtw_read16(adapter, REG_RXERR_RPT); -+ pdbgpriv->dbg_rx_fifo_diff_overflow = pdbgpriv->dbg_rx_fifo_curr_overflow-pdbgpriv->dbg_rx_fifo_last_overflow; -+ } -+} -+ -+void linked_info_dump(struct adapter *padapter, u8 benable) -+{ -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if (padapter->bLinkInfoDump == benable) -+ return; -+ -+ DBG_871X("%s %s\n", __func__, (benable) ? "enable" : "disable"); -+ -+ if (benable) { -+ pwrctrlpriv->org_power_mgnt = pwrctrlpriv->power_mgnt;/* keep org value */ -+ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); -+ -+ pwrctrlpriv->ips_org_mode = pwrctrlpriv->ips_mode;/* keep org value */ -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ } else { -+ rtw_pm_set_ips(padapter, pwrctrlpriv->ips_org_mode); -+ -+ rtw_pm_set_lps(padapter, pwrctrlpriv->ips_org_mode); -+ } -+ padapter->bLinkInfoDump = benable; -+} -+ -+#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+void rtw_get_raw_rssi_info(void *sel, struct adapter *padapter) -+{ -+ u8 isCCKrate, rf_path; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; -+ -+ DBG_871X_SEL_NL( -+ sel, -+ "RxRate = %s, PWDBALL = %d(%%), rx_pwr_all = %d(dBm)\n", -+ HDATA_RATE(psample_pkt_rssi->data_rate), -+ psample_pkt_rssi->pwdball, psample_pkt_rssi->pwr_all -+ ); -+ -+ isCCKrate = (psample_pkt_rssi->data_rate <= DESC_RATE11M) ? true : false; -+ -+ if (isCCKrate) -+ psample_pkt_rssi->mimo_singal_strength[0] = psample_pkt_rssi->pwdball; -+ -+ for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { -+ DBG_871X_SEL_NL( -+ sel, -+ "RF_PATH_%d =>singal_strength:%d(%%), singal_quality:%d(%%)\n", -+ rf_path, psample_pkt_rssi->mimo_singal_strength[rf_path], -+ psample_pkt_rssi->mimo_singal_quality[rf_path] -+ ); -+ -+ if (!isCCKrate) { -+ DBG_871X_SEL_NL( -+ sel, -+ "\trx_ofdm_pwr:%d(dBm), rx_ofdm_snr:%d(dB)\n", -+ psample_pkt_rssi->ofdm_pwr[rf_path], -+ psample_pkt_rssi->ofdm_snr[rf_path] -+ ); -+ } -+ } -+} -+ -+void rtw_dump_raw_rssi_info(struct adapter *padapter) -+{ -+ u8 isCCKrate, rf_path; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; -+ DBG_871X("============ RAW Rx Info dump ===================\n"); -+ DBG_871X("RxRate = %s, PWDBALL = %d(%%), rx_pwr_all = %d(dBm)\n", -+ HDATA_RATE(psample_pkt_rssi->data_rate), psample_pkt_rssi->pwdball, psample_pkt_rssi->pwr_all); -+ -+ isCCKrate = (psample_pkt_rssi->data_rate <= DESC_RATE11M) ? true : false; -+ -+ if (isCCKrate) -+ psample_pkt_rssi->mimo_singal_strength[0] = psample_pkt_rssi->pwdball; -+ -+ for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { -+ DBG_871X("RF_PATH_%d =>singal_strength:%d(%%), singal_quality:%d(%%)" -+ , rf_path, psample_pkt_rssi->mimo_singal_strength[rf_path], psample_pkt_rssi->mimo_singal_quality[rf_path]); -+ -+ if (!isCCKrate) { -+ printk(", rx_ofdm_pwr:%d(dBm), rx_ofdm_snr:%d(dB)\n", -+ psample_pkt_rssi->ofdm_pwr[rf_path], psample_pkt_rssi->ofdm_snr[rf_path]); -+ } else { -+ printk("\n"); -+ } -+ } -+} -+ -+void rtw_store_phy_info(struct adapter *padapter, union recv_frame *prframe) -+{ -+ u8 isCCKrate, rf_path; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ -+ PODM_PHY_INFO_T pPhyInfo = (PODM_PHY_INFO_T)(&pattrib->phy_info); -+ struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; -+ -+ psample_pkt_rssi->data_rate = pattrib->data_rate; -+ isCCKrate = (pattrib->data_rate <= DESC_RATE11M) ? true : false; -+ -+ psample_pkt_rssi->pwdball = pPhyInfo->RxPWDBAll; -+ psample_pkt_rssi->pwr_all = pPhyInfo->RecvSignalPower; -+ -+ for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { -+ psample_pkt_rssi->mimo_singal_strength[rf_path] = pPhyInfo->RxMIMOSignalStrength[rf_path]; -+ psample_pkt_rssi->mimo_singal_quality[rf_path] = pPhyInfo->RxMIMOSignalQuality[rf_path]; -+ if (!isCCKrate) { -+ psample_pkt_rssi->ofdm_pwr[rf_path] = pPhyInfo->RxPwr[rf_path]; -+ psample_pkt_rssi->ofdm_snr[rf_path] = pPhyInfo->RxSNR[rf_path]; -+ } -+ } -+} -+#endif -+ -+static u32 Array_kfreemap[] = { -+ 0xf8, 0xe, -+ 0xf6, 0xc, -+ 0xf4, 0xa, -+ 0xf2, 0x8, -+ 0xf0, 0x6, -+ 0xf3, 0x4, -+ 0xf5, 0x2, -+ 0xf7, 0x0, -+ 0xf9, 0x0, -+ 0xfc, 0x0, -+}; -+ -+void rtw_bb_rf_gain_offset(struct adapter *padapter) -+{ -+ u8 value = padapter->eeprompriv.EEPROMRFGainOffset; -+ u32 res, i = 0; -+ u32 ArrayLen = sizeof(Array_kfreemap)/sizeof(u32); -+ u32 *Array = Array_kfreemap; -+ u32 v1 = 0, v2 = 0, target = 0; -+ /* DBG_871X("+%s value: 0x%02x+\n", __func__, value); */ -+ -+ if (value & BIT4) { -+ DBG_871X("Offset RF Gain.\n"); -+ DBG_871X("Offset RF Gain. padapter->eeprompriv.EEPROMRFGainVal = 0x%x\n", padapter->eeprompriv.EEPROMRFGainVal); -+ if (padapter->eeprompriv.EEPROMRFGainVal != 0xff) { -+ res = rtw_hal_read_rfreg(padapter, RF_PATH_A, 0x7f, 0xffffffff); -+ res &= 0xfff87fff; -+ DBG_871X("Offset RF Gain. before reg 0x7f = 0x%08x\n", res); -+ /* res &= 0xfff87fff; */ -+ for (i = 0; i < ArrayLen; i += 2) { -+ v1 = Array[i]; -+ v2 = Array[i+1]; -+ if (v1 == padapter->eeprompriv.EEPROMRFGainVal) { -+ DBG_871X("Offset RF Gain. got v1 = 0x%x , v2 = 0x%x\n", v1, v2); -+ target = v2; -+ break; -+ } -+ } -+ DBG_871X("padapter->eeprompriv.EEPROMRFGainVal = 0x%x , Gain offset Target Value = 0x%x\n", padapter->eeprompriv.EEPROMRFGainVal, target); -+ PHY_SetRFReg(padapter, RF_PATH_A, REG_RF_BB_GAIN_OFFSET, BIT18|BIT17|BIT16|BIT15, target); -+ -+ /* res |= (padapter->eeprompriv.EEPROMRFGainVal & 0x0f)<< 15; */ -+ /* rtw_hal_write_rfreg(padapter, RF_PATH_A, REG_RF_BB_GAIN_OFFSET, RF_GAIN_OFFSET_MASK, res); */ -+ res = rtw_hal_read_rfreg(padapter, RF_PATH_A, 0x7f, 0xffffffff); -+ DBG_871X("Offset RF Gain. After reg 0x7f = 0x%08x\n", res); -+ } else -+ DBG_871X("Offset RF Gain. padapter->eeprompriv.EEPROMRFGainVal = 0x%x != 0xff, didn't run Kfree\n", padapter->eeprompriv.EEPROMRFGainVal); -+ } else -+ DBG_871X("Using the default RF gain.\n"); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/hal_com_phycfg.c linux/3rdparty/rtl8723bs/hal/hal_com_phycfg.c ---- linux.old/3rdparty/rtl8723bs/hal/hal_com_phycfg.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/hal_com_phycfg.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,3288 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _HAL_COM_PHYCFG_C_ -+ -+#include -+#include -+#include -+ -+u8 PHY_GetTxPowerByRateBase(struct adapter *Adapter, u8 Band, u8 RfPath, -+ u8 TxNum, enum RATE_SECTION RateSection) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ u8 value = 0; -+ -+ if (RfPath > ODM_RF_PATH_D) { -+ DBG_871X("Invalid Rf Path %d in PHY_GetTxPowerByRateBase()\n", RfPath); -+ return 0; -+ } -+ -+ if (Band == BAND_ON_2_4G) { -+ switch (RateSection) { -+ case CCK: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][0]; -+ break; -+ case OFDM: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][1]; -+ break; -+ case HT_MCS0_MCS7: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][2]; -+ break; -+ case HT_MCS8_MCS15: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][3]; -+ break; -+ case HT_MCS16_MCS23: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][4]; -+ break; -+ case HT_MCS24_MCS31: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][5]; -+ break; -+ case VHT_1SSMCS0_1SSMCS9: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][6]; -+ break; -+ case VHT_2SSMCS0_2SSMCS9: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][7]; -+ break; -+ case VHT_3SSMCS0_3SSMCS9: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][8]; -+ break; -+ case VHT_4SSMCS0_4SSMCS9: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][9]; -+ break; -+ default: -+ DBG_871X("Invalid RateSection %d in Band 2.4G, Rf Path %d, %dTx in PHY_GetTxPowerByRateBase()\n", -+ RateSection, RfPath, TxNum); -+ break; -+ -+ }; -+ } else if (Band == BAND_ON_5G) { -+ switch (RateSection) { -+ case OFDM: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][0]; -+ break; -+ case HT_MCS0_MCS7: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][1]; -+ break; -+ case HT_MCS8_MCS15: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][2]; -+ break; -+ case HT_MCS16_MCS23: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][3]; -+ break; -+ case HT_MCS24_MCS31: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][4]; -+ break; -+ case VHT_1SSMCS0_1SSMCS9: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][5]; -+ break; -+ case VHT_2SSMCS0_2SSMCS9: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][6]; -+ break; -+ case VHT_3SSMCS0_3SSMCS9: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][7]; -+ break; -+ case VHT_4SSMCS0_4SSMCS9: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][8]; -+ break; -+ default: -+ DBG_871X("Invalid RateSection %d in Band 5G, Rf Path %d, %dTx in PHY_GetTxPowerByRateBase()\n", -+ RateSection, RfPath, TxNum); -+ break; -+ }; -+ } else -+ DBG_871X("Invalid Band %d in PHY_GetTxPowerByRateBase()\n", Band); -+ -+ return value; -+} -+ -+static void -+phy_SetTxPowerByRateBase( -+ struct adapter *Adapter, -+ u8 Band, -+ u8 RfPath, -+ enum RATE_SECTION RateSection, -+ u8 TxNum, -+ u8 Value -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ if (RfPath > ODM_RF_PATH_D) { -+ DBG_871X("Invalid Rf Path %d in phy_SetTxPowerByRatBase()\n", RfPath); -+ return; -+ } -+ -+ if (Band == BAND_ON_2_4G) { -+ switch (RateSection) { -+ case CCK: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][0] = Value; -+ break; -+ case OFDM: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][1] = Value; -+ break; -+ case HT_MCS0_MCS7: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][2] = Value; -+ break; -+ case HT_MCS8_MCS15: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][3] = Value; -+ break; -+ case HT_MCS16_MCS23: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][4] = Value; -+ break; -+ case HT_MCS24_MCS31: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][5] = Value; -+ break; -+ case VHT_1SSMCS0_1SSMCS9: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][6] = Value; -+ break; -+ case VHT_2SSMCS0_2SSMCS9: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][7] = Value; -+ break; -+ case VHT_3SSMCS0_3SSMCS9: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][8] = Value; -+ break; -+ case VHT_4SSMCS0_4SSMCS9: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][9] = Value; -+ break; -+ default: -+ DBG_871X("Invalid RateSection %d in Band 2.4G, Rf Path %d, %dTx in phy_SetTxPowerByRateBase()\n", -+ RateSection, RfPath, TxNum); -+ break; -+ }; -+ } else if (Band == BAND_ON_5G) { -+ switch (RateSection) { -+ case OFDM: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][0] = Value; -+ break; -+ case HT_MCS0_MCS7: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][1] = Value; -+ break; -+ case HT_MCS8_MCS15: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][2] = Value; -+ break; -+ case HT_MCS16_MCS23: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][3] = Value; -+ break; -+ case HT_MCS24_MCS31: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][4] = Value; -+ break; -+ case VHT_1SSMCS0_1SSMCS9: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][5] = Value; -+ break; -+ case VHT_2SSMCS0_2SSMCS9: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][6] = Value; -+ break; -+ case VHT_3SSMCS0_3SSMCS9: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][7] = Value; -+ break; -+ case VHT_4SSMCS0_4SSMCS9: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][8] = Value; -+ break; -+ default: -+ DBG_871X("Invalid RateSection %d in Band 5G, Rf Path %d, %dTx in phy_SetTxPowerByRateBase()\n", -+ RateSection, RfPath, TxNum); -+ break; -+ }; -+ } else -+ DBG_871X("Invalid Band %d in phy_SetTxPowerByRateBase()\n", Band); -+} -+ -+static void -+phy_StoreTxPowerByRateBase( -+struct adapter *padapter -+ ) -+{ -+ u8 path, base; -+ -+ /* DBG_871X("===>%s\n", __func__); */ -+ -+ for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_B; ++path) { -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_2_4G, path, RF_1TX, MGN_11M); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_2_4G, path, CCK, RF_1TX, base); -+ /* DBG_871X("Power index base of 2.4G path %d 1Tx CCK = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_2_4G, path, RF_1TX, MGN_54M); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_2_4G, path, OFDM, RF_1TX, base); -+ /* DBG_871X("Power index base of 2.4G path %d 1Tx OFDM = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_2_4G, path, RF_1TX, MGN_MCS7); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_2_4G, path, HT_MCS0_MCS7, RF_1TX, base); -+ /* DBG_871X("Power index base of 2.4G path %d 1Tx MCS0-7 = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_2_4G, path, RF_2TX, MGN_MCS15); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_2_4G, path, HT_MCS8_MCS15, RF_2TX, base); -+ /* DBG_871X("Power index base of 2.4G path %d 2Tx MCS8-15 = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_2_4G, path, RF_3TX, MGN_MCS23); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_2_4G, path, HT_MCS16_MCS23, RF_3TX, base); -+ /* DBG_871X("Power index base of 2.4G path %d 3Tx MCS16-23 = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_2_4G, path, RF_1TX, MGN_VHT1SS_MCS7); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_2_4G, path, VHT_1SSMCS0_1SSMCS9, RF_1TX, base); -+ /* DBG_871X("Power index base of 2.4G path %d 1Tx VHT1SS = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_2_4G, path, RF_2TX, MGN_VHT2SS_MCS7); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_2_4G, path, VHT_2SSMCS0_2SSMCS9, RF_2TX, base); -+ /* DBG_871X("Power index base of 2.4G path %d 2Tx VHT2SS = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_2_4G, path, RF_3TX, MGN_VHT3SS_MCS7); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_2_4G, path, VHT_3SSMCS0_3SSMCS9, RF_3TX, base); -+ /* DBG_871X("Power index base of 2.4G path %d 3Tx VHT3SS = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_5G, path, RF_1TX, MGN_54M); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_5G, path, OFDM, RF_1TX, base); -+ /* DBG_871X("Power index base of 5G path %d 1Tx OFDM = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_5G, path, RF_1TX, MGN_MCS7); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_5G, path, HT_MCS0_MCS7, RF_1TX, base); -+ /* DBG_871X("Power index base of 5G path %d 1Tx MCS0~7 = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_5G, path, RF_2TX, MGN_MCS15); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_5G, path, HT_MCS8_MCS15, RF_2TX, base); -+ /* DBG_871X("Power index base of 5G path %d 2Tx MCS8~15 = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_5G, path, RF_3TX, MGN_MCS23); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_5G, path, HT_MCS16_MCS23, RF_3TX, base); -+ /* DBG_871X("Power index base of 5G path %d 3Tx MCS16~23 = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_5G, path, RF_1TX, MGN_VHT1SS_MCS7); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_5G, path, VHT_1SSMCS0_1SSMCS9, RF_1TX, base); -+ /* DBG_871X("Power index base of 5G path %d 1Tx VHT1SS = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_5G, path, RF_2TX, MGN_VHT2SS_MCS7); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_5G, path, VHT_2SSMCS0_2SSMCS9, RF_2TX, base); -+ /* DBG_871X("Power index base of 5G path %d 2Tx VHT2SS = > 0x%x\n", path, base); */ -+ -+ base = PHY_GetTxPowerByRate(padapter, BAND_ON_5G, path, RF_3TX, MGN_VHT2SS_MCS7); -+ phy_SetTxPowerByRateBase(padapter, BAND_ON_5G, path, VHT_3SSMCS0_3SSMCS9, RF_3TX, base); -+ /* DBG_871X("Power index base of 5G path %d 3Tx VHT3SS = > 0x%x\n", path, base); */ -+ } -+ -+ /* DBG_871X("<===%s\n", __func__); */ -+} -+ -+u8 PHY_GetRateSectionIndexOfTxPowerByRate( -+ struct adapter *padapter, u32 RegAddr, u32 BitMask -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ u8 index = 0; -+ -+ if (pDM_Odm->PhyRegPgVersion == 0) { -+ switch (RegAddr) { -+ case rTxAGC_A_Rate18_06: -+ index = 0; -+ break; -+ case rTxAGC_A_Rate54_24: -+ index = 1; -+ break; -+ case rTxAGC_A_CCK1_Mcs32: -+ index = 6; -+ break; -+ case rTxAGC_B_CCK11_A_CCK2_11: -+ if (BitMask == bMaskH3Bytes) -+ index = 7; -+ else if (BitMask == 0x000000ff) -+ index = 15; -+ break; -+ -+ case rTxAGC_A_Mcs03_Mcs00: -+ index = 2; -+ break; -+ case rTxAGC_A_Mcs07_Mcs04: -+ index = 3; -+ break; -+ case rTxAGC_A_Mcs11_Mcs08: -+ index = 4; -+ break; -+ case rTxAGC_A_Mcs15_Mcs12: -+ index = 5; -+ break; -+ case rTxAGC_B_Rate18_06: -+ index = 8; -+ break; -+ case rTxAGC_B_Rate54_24: -+ index = 9; -+ break; -+ case rTxAGC_B_CCK1_55_Mcs32: -+ index = 14; -+ break; -+ case rTxAGC_B_Mcs03_Mcs00: -+ index = 10; -+ break; -+ case rTxAGC_B_Mcs07_Mcs04: -+ index = 11; -+ break; -+ case rTxAGC_B_Mcs11_Mcs08: -+ index = 12; -+ break; -+ case rTxAGC_B_Mcs15_Mcs12: -+ index = 13; -+ break; -+ default: -+ DBG_871X("Invalid RegAddr 0x3%x in PHY_GetRateSectionIndexOfTxPowerByRate()", RegAddr); -+ break; -+ }; -+ } -+ -+ return index; -+} -+ -+void -+PHY_GetRateValuesOfTxPowerByRate( -+ struct adapter *padapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Value, -+ u8 *RateIndex, -+ s8 *PwrByRateVal, -+ u8 *RateNum -+) -+{ -+ u8 i = 0; -+ -+ switch (RegAddr) { -+ case rTxAGC_A_Rate18_06: -+ case rTxAGC_B_Rate18_06: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_6M); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_9M); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_12M); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_18M); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_Rate54_24: -+ case rTxAGC_B_Rate54_24: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_24M); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_36M); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_48M); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_54M); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_CCK1_Mcs32: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_1M); -+ PwrByRateVal[0] = (s8) ((((Value >> (8 + 4)) & 0xF)) * 10 + -+ ((Value >> 8) & 0xF)); -+ *RateNum = 1; -+ break; -+ -+ case rTxAGC_B_CCK11_A_CCK2_11: -+ if (BitMask == 0xffffff00) { -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_2M); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_5_5M); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_11M); -+ for (i = 1; i < 4; ++i) { -+ PwrByRateVal[i - 1] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 3; -+ } else if (BitMask == 0x000000ff) { -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_11M); -+ PwrByRateVal[0] = (s8) ((((Value >> 4) & 0xF)) * 10 + (Value & 0xF)); -+ *RateNum = 1; -+ } -+ break; -+ -+ case rTxAGC_A_Mcs03_Mcs00: -+ case rTxAGC_B_Mcs03_Mcs00: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS0); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS1); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS2); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS3); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_Mcs07_Mcs04: -+ case rTxAGC_B_Mcs07_Mcs04: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS4); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS5); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS6); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS7); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_Mcs11_Mcs08: -+ case rTxAGC_B_Mcs11_Mcs08: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS8); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS9); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS10); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS11); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_Mcs15_Mcs12: -+ case rTxAGC_B_Mcs15_Mcs12: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS12); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS13); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS14); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS15); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ -+ break; -+ -+ case rTxAGC_B_CCK1_55_Mcs32: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_1M); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_2M); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_5_5M); -+ for (i = 1; i < 4; ++i) { -+ PwrByRateVal[i - 1] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 3; -+ break; -+ -+ case 0xC20: -+ case 0xE20: -+ case 0x1820: -+ case 0x1a20: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_1M); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_2M); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_5_5M); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_11M); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC24: -+ case 0xE24: -+ case 0x1824: -+ case 0x1a24: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_6M); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_9M); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_12M); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_18M); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC28: -+ case 0xE28: -+ case 0x1828: -+ case 0x1a28: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_24M); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_36M); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_48M); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_54M); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC2C: -+ case 0xE2C: -+ case 0x182C: -+ case 0x1a2C: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS0); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS1); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS2); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS3); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC30: -+ case 0xE30: -+ case 0x1830: -+ case 0x1a30: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS4); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS5); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS6); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS7); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC34: -+ case 0xE34: -+ case 0x1834: -+ case 0x1a34: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS8); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS9); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS10); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS11); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC38: -+ case 0xE38: -+ case 0x1838: -+ case 0x1a38: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS12); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS13); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS14); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS15); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC3C: -+ case 0xE3C: -+ case 0x183C: -+ case 0x1a3C: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT1SS_MCS0); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT1SS_MCS1); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT1SS_MCS2); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT1SS_MCS3); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC40: -+ case 0xE40: -+ case 0x1840: -+ case 0x1a40: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT1SS_MCS4); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT1SS_MCS5); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT1SS_MCS6); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT1SS_MCS7); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC44: -+ case 0xE44: -+ case 0x1844: -+ case 0x1a44: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT1SS_MCS8); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT1SS_MCS9); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT2SS_MCS0); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT2SS_MCS1); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC48: -+ case 0xE48: -+ case 0x1848: -+ case 0x1a48: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT2SS_MCS2); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT2SS_MCS3); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT2SS_MCS4); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT2SS_MCS5); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC4C: -+ case 0xE4C: -+ case 0x184C: -+ case 0x1a4C: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT2SS_MCS6); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT2SS_MCS7); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT2SS_MCS8); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT2SS_MCS9); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xCD8: -+ case 0xED8: -+ case 0x18D8: -+ case 0x1aD8: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS16); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS17); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS18); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS19); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xCDC: -+ case 0xEDC: -+ case 0x18DC: -+ case 0x1aDC: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS20); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS21); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS22); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_MCS23); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xCE0: -+ case 0xEE0: -+ case 0x18E0: -+ case 0x1aE0: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT3SS_MCS0); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT3SS_MCS1); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT3SS_MCS2); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT3SS_MCS3); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xCE4: -+ case 0xEE4: -+ case 0x18E4: -+ case 0x1aE4: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT3SS_MCS4); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT3SS_MCS5); -+ RateIndex[2] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT3SS_MCS6); -+ RateIndex[3] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT3SS_MCS7); -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xCE8: -+ case 0xEE8: -+ case 0x18E8: -+ case 0x1aE8: -+ RateIndex[0] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT3SS_MCS8); -+ RateIndex[1] = PHY_GetRateIndexOfTxPowerByRate(MGN_VHT3SS_MCS9); -+ for (i = 0; i < 2; ++i) { -+ PwrByRateVal[i] = (s8) ((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ default: -+ DBG_871X("Invalid RegAddr 0x%x in %s()\n", RegAddr, __func__); -+ break; -+ }; -+} -+ -+static void PHY_StoreTxPowerByRateNew( -+ struct adapter *padapter, -+ u32 Band, -+ u32 RfPath, -+ u32 TxNum, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u8 i = 0, rateIndex[4] = {0}, rateNum = 0; -+ s8 PwrByRateVal[4] = {0}; -+ -+ PHY_GetRateValuesOfTxPowerByRate(padapter, RegAddr, BitMask, Data, rateIndex, PwrByRateVal, &rateNum); -+ -+ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { -+ DBG_871X("Invalid Band %d\n", Band); -+ return; -+ } -+ -+ if (RfPath > ODM_RF_PATH_D) { -+ DBG_871X("Invalid RfPath %d\n", RfPath); -+ return; -+ } -+ -+ if (TxNum > ODM_RF_PATH_D) { -+ DBG_871X("Invalid TxNum %d\n", TxNum); -+ return; -+ } -+ -+ for (i = 0; i < rateNum; ++i) { -+ if (rateIndex[i] == PHY_GetRateIndexOfTxPowerByRate(MGN_VHT2SS_MCS0) || -+ rateIndex[i] == PHY_GetRateIndexOfTxPowerByRate(MGN_VHT2SS_MCS1)) -+ TxNum = RF_2TX; -+ -+ pHalData->TxPwrByRateOffset[Band][RfPath][TxNum][rateIndex[i]] = PwrByRateVal[i]; -+ } -+} -+ -+static void PHY_StoreTxPowerByRateOld( -+ struct adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u8 index = PHY_GetRateSectionIndexOfTxPowerByRate(padapter, RegAddr, BitMask); -+ -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][index] = Data; -+ /* DBG_871X("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x\n", pHalData->pwrGroupCnt, */ -+ /* pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][0]); */ -+} -+ -+void PHY_InitTxPowerByRate(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u8 band, rfPath, TxNum, rate; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band) -+ for (rfPath = 0; rfPath < TX_PWR_BY_RATE_NUM_RF; ++rfPath) -+ for (TxNum = 0; TxNum < TX_PWR_BY_RATE_NUM_RF; ++TxNum) -+ for (rate = 0; rate < TX_PWR_BY_RATE_NUM_RATE; ++rate) -+ pHalData->TxPwrByRateOffset[band][rfPath][TxNum][rate] = 0; -+} -+ -+void PHY_StoreTxPowerByRate( -+ struct adapter *padapter, -+ u32 Band, -+ u32 RfPath, -+ u32 TxNum, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ if (pDM_Odm->PhyRegPgVersion > 0) -+ PHY_StoreTxPowerByRateNew(padapter, Band, RfPath, TxNum, RegAddr, BitMask, Data); -+ else if (pDM_Odm->PhyRegPgVersion == 0) { -+ PHY_StoreTxPowerByRateOld(padapter, RegAddr, BitMask, Data); -+ -+ if (RegAddr == rTxAGC_A_Mcs15_Mcs12 && pHalData->rf_type == RF_1T1R) -+ pHalData->pwrGroupCnt++; -+ else if (RegAddr == rTxAGC_B_Mcs15_Mcs12 && pHalData->rf_type != RF_1T1R) -+ pHalData->pwrGroupCnt++; -+ } else -+ DBG_871X("Invalid PHY_REG_PG.txt version %d\n", pDM_Odm->PhyRegPgVersion); -+ -+} -+ -+static void -+phy_ConvertTxPowerByRateInDbmToRelativeValues( -+struct adapter *padapter -+ ) -+{ -+ u8 base = 0, i = 0, value = 0, band = 0, path = 0, txNum = 0; -+ u8 cckRates[4] = { -+ MGN_1M, MGN_2M, MGN_5_5M, MGN_11M -+ }; -+ u8 ofdmRates[8] = { -+ MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M -+ }; -+ u8 mcs0_7Rates[8] = { -+ MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7 -+ }; -+ u8 mcs8_15Rates[8] = { -+ MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15 -+ }; -+ u8 mcs16_23Rates[8] = { -+ MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23 -+ }; -+ u8 vht1ssRates[10] = { -+ MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4, -+ MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9 -+ }; -+ u8 vht2ssRates[10] = { -+ MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, -+ MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9 -+ }; -+ u8 vht3ssRates[10] = { -+ MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4, -+ MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9 -+ }; -+ -+ /* DBG_871X("===>PHY_ConvertTxPowerByRateInDbmToRelativeValues()\n"); */ -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band) { -+ for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_D; ++path) { -+ for (txNum = RF_1TX; txNum < RF_MAX_TX_NUM; ++txNum) { -+ /* CCK */ -+ base = PHY_GetTxPowerByRate(padapter, band, path, txNum, MGN_11M); -+ for (i = 0; i < sizeof(cckRates); ++i) { -+ value = PHY_GetTxPowerByRate(padapter, band, path, txNum, cckRates[i]); -+ PHY_SetTxPowerByRate(padapter, band, path, txNum, cckRates[i], value - base); -+ } -+ -+ /* OFDM */ -+ base = PHY_GetTxPowerByRate(padapter, band, path, txNum, MGN_54M); -+ for (i = 0; i < sizeof(ofdmRates); ++i) { -+ value = PHY_GetTxPowerByRate(padapter, band, path, txNum, ofdmRates[i]); -+ PHY_SetTxPowerByRate(padapter, band, path, txNum, ofdmRates[i], value - base); -+ } -+ -+ /* HT MCS0~7 */ -+ base = PHY_GetTxPowerByRate(padapter, band, path, txNum, MGN_MCS7); -+ for (i = 0; i < sizeof(mcs0_7Rates); ++i) { -+ value = PHY_GetTxPowerByRate(padapter, band, path, txNum, mcs0_7Rates[i]); -+ PHY_SetTxPowerByRate(padapter, band, path, txNum, mcs0_7Rates[i], value - base); -+ } -+ -+ /* HT MCS8~15 */ -+ base = PHY_GetTxPowerByRate(padapter, band, path, txNum, MGN_MCS15); -+ for (i = 0; i < sizeof(mcs8_15Rates); ++i) { -+ value = PHY_GetTxPowerByRate(padapter, band, path, txNum, mcs8_15Rates[i]); -+ PHY_SetTxPowerByRate(padapter, band, path, txNum, mcs8_15Rates[i], value - base); -+ } -+ -+ /* HT MCS16~23 */ -+ base = PHY_GetTxPowerByRate(padapter, band, path, txNum, MGN_MCS23); -+ for (i = 0; i < sizeof(mcs16_23Rates); ++i) { -+ value = PHY_GetTxPowerByRate(padapter, band, path, txNum, mcs16_23Rates[i]); -+ PHY_SetTxPowerByRate(padapter, band, path, txNum, mcs16_23Rates[i], value - base); -+ } -+ -+ /* VHT 1SS */ -+ base = PHY_GetTxPowerByRate(padapter, band, path, txNum, MGN_VHT1SS_MCS7); -+ for (i = 0; i < sizeof(vht1ssRates); ++i) { -+ value = PHY_GetTxPowerByRate(padapter, band, path, txNum, vht1ssRates[i]); -+ PHY_SetTxPowerByRate(padapter, band, path, txNum, vht1ssRates[i], value - base); -+ } -+ -+ /* VHT 2SS */ -+ base = PHY_GetTxPowerByRate(padapter, band, path, txNum, MGN_VHT2SS_MCS7); -+ for (i = 0; i < sizeof(vht2ssRates); ++i) { -+ value = PHY_GetTxPowerByRate(padapter, band, path, txNum, vht2ssRates[i]); -+ PHY_SetTxPowerByRate(padapter, band, path, txNum, vht2ssRates[i], value - base); -+ } -+ -+ /* VHT 3SS */ -+ base = PHY_GetTxPowerByRate(padapter, band, path, txNum, MGN_VHT3SS_MCS7); -+ for (i = 0; i < sizeof(vht3ssRates); ++i) { -+ value = PHY_GetTxPowerByRate(padapter, band, path, txNum, vht3ssRates[i]); -+ PHY_SetTxPowerByRate(padapter, band, path, txNum, vht3ssRates[i], value - base); -+ } -+ } -+ } -+ } -+ -+ /* DBG_871X("<===PHY_ConvertTxPowerByRateInDbmToRelativeValues()\n"); */ -+} -+ -+/* -+ * This function must be called if the value in the PHY_REG_PG.txt(or header) -+ * is exact dBm values -+ */ -+void PHY_TxPowerByRateConfiguration(struct adapter *padapter) -+{ -+ phy_StoreTxPowerByRateBase(padapter); -+ phy_ConvertTxPowerByRateInDbmToRelativeValues(padapter); -+} -+ -+void PHY_SetTxPowerIndexByRateSection( -+ struct adapter *padapter, u8 RFPath, u8 Channel, u8 RateSection -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+ if (RateSection == CCK) { -+ u8 cckRates[] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}; -+ if (pHalData->CurrentBandType == BAND_ON_2_4G) -+ PHY_SetTxPowerIndexByRateArray(padapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ cckRates, sizeof(cckRates)/sizeof(u8)); -+ -+ } else if (RateSection == OFDM) { -+ u8 ofdmRates[] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M}; -+ PHY_SetTxPowerIndexByRateArray(padapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ ofdmRates, sizeof(ofdmRates)/sizeof(u8)); -+ -+ } else if (RateSection == HT_MCS0_MCS7) { -+ u8 htRates1T[] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}; -+ PHY_SetTxPowerIndexByRateArray(padapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ htRates1T, sizeof(htRates1T)/sizeof(u8)); -+ -+ } else if (RateSection == HT_MCS8_MCS15) { -+ u8 htRates2T[] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}; -+ PHY_SetTxPowerIndexByRateArray(padapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ htRates2T, sizeof(htRates2T)/sizeof(u8)); -+ -+ } else if (RateSection == HT_MCS16_MCS23) { -+ u8 htRates3T[] = {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23}; -+ PHY_SetTxPowerIndexByRateArray(padapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ htRates3T, sizeof(htRates3T)/sizeof(u8)); -+ -+ } else if (RateSection == HT_MCS24_MCS31) { -+ u8 htRates4T[] = {MGN_MCS24, MGN_MCS25, MGN_MCS26, MGN_MCS27, MGN_MCS28, MGN_MCS29, MGN_MCS30, MGN_MCS31}; -+ PHY_SetTxPowerIndexByRateArray(padapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ htRates4T, sizeof(htRates4T)/sizeof(u8)); -+ -+ } else if (RateSection == VHT_1SSMCS0_1SSMCS9) { -+ u8 vhtRates1T[] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4, -+ MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9}; -+ PHY_SetTxPowerIndexByRateArray(padapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ vhtRates1T, sizeof(vhtRates1T)/sizeof(u8)); -+ -+ } else if (RateSection == VHT_2SSMCS0_2SSMCS9) { -+ u8 vhtRates2T[] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, -+ MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9}; -+ -+ PHY_SetTxPowerIndexByRateArray(padapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ vhtRates2T, sizeof(vhtRates2T)/sizeof(u8)); -+ } else if (RateSection == VHT_3SSMCS0_3SSMCS9) { -+ u8 vhtRates3T[] = {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4, -+ MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9}; -+ -+ PHY_SetTxPowerIndexByRateArray(padapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ vhtRates3T, sizeof(vhtRates3T)/sizeof(u8)); -+ } else if (RateSection == VHT_4SSMCS0_4SSMCS9) { -+ u8 vhtRates4T[] = {MGN_VHT4SS_MCS0, MGN_VHT4SS_MCS1, MGN_VHT4SS_MCS2, MGN_VHT4SS_MCS3, MGN_VHT4SS_MCS4, -+ MGN_VHT4SS_MCS5, MGN_VHT4SS_MCS6, MGN_VHT4SS_MCS7, MGN_VHT4SS_MCS8, MGN_VHT4SS_MCS9}; -+ -+ PHY_SetTxPowerIndexByRateArray(padapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ vhtRates4T, sizeof(vhtRates4T)/sizeof(u8)); -+ } else -+ DBG_871X("Invalid RateSection %d in %s", RateSection, __func__); -+} -+ -+static bool phy_GetChnlIndex(u8 Channel, u8 *ChannelIdx) -+{ -+ u8 channel5G[CHANNEL_MAX_NUMBER_5G] = { -+ 36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, 60, 62, 64, 100, 102, -+ 104, 106, 108, 110, 112, 114, 116, 118, 120, 122, 124, 126, 128, 130, -+ 132, 134, 136, 138, 140, 142, 144, 149, 151, 153, 155, 157, 159, 161, -+ 163, 165, 167, 168, 169, 171, 173, 175, 177 -+ }; -+ u8 i = 0; -+ bool bIn24G = true; -+ -+ if (Channel <= 14) { -+ bIn24G = true; -+ *ChannelIdx = Channel-1; -+ } else { -+ bIn24G = false; -+ -+ for (i = 0; i < sizeof(channel5G)/sizeof(u8); ++i) { -+ if (channel5G[i] == Channel) { -+ *ChannelIdx = i; -+ return bIn24G; -+ } -+ } -+ } -+ -+ return bIn24G; -+} -+ -+u8 PHY_GetTxPowerIndexBase( -+ struct adapter *padapter, -+ u8 RFPath, -+ u8 Rate, -+ enum CHANNEL_WIDTH BandWidth, -+ u8 Channel, -+ bool *bIn24G -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u8 i = 0; /* default set to 1S */ -+ u8 txPower = 0; -+ u8 chnlIdx = (Channel-1); -+ -+ if (HAL_IsLegalChannel(padapter, Channel) == false) { -+ chnlIdx = 0; -+ DBG_871X("Illegal channel!!\n"); -+ } -+ -+ *bIn24G = phy_GetChnlIndex(Channel, &chnlIdx); -+ -+ /* DBG_871X("[%s] Channel Index: %d\n", (*bIn24G?"2.4G":"5G"), chnlIdx); */ -+ -+ if (*bIn24G) { /* 3 ============================== 2.4 G ============================== */ -+ if (IS_CCK_RATE(Rate)) -+ txPower = pHalData->Index24G_CCK_Base[RFPath][chnlIdx]; -+ else if (MGN_6M <= Rate) -+ txPower = pHalData->Index24G_BW40_Base[RFPath][chnlIdx]; -+ else -+ DBG_871X("PHY_GetTxPowerIndexBase: INVALID Rate.\n"); -+ -+ /* DBG_871X("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", */ -+ /* ((RFPath == 0)?'A':'B'), Rate, chnlIdx, txPower); */ -+ -+ /* OFDM-1T */ -+ if ((MGN_6M <= Rate && Rate <= MGN_54M) && !IS_CCK_RATE(Rate)) { -+ txPower += pHalData->OFDM_24G_Diff[RFPath][TX_1S]; -+ /* DBG_871X("+PowerDiff 2.4G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath == 0)?'A':'B'), pHalData->OFDM_24G_Diff[RFPath][TX_1S]); */ -+ } -+ if (BandWidth == CHANNEL_WIDTH_20) { /* BW20-1S, BW20-2S */ -+ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_1S]; -+ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_2S]; -+ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_3S]; -+ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_4S]; -+ -+ /* DBG_871X("+PowerDiff 2.4G (RF-%c): (BW20-1S, BW20-2S, BW20-3S, BW20-4S) = (%d, %d, %d, %d)\n", ((RFPath == 0)?'A':(RFPath == 1)?'B':(RFPath ==2)?'C':'D'), */ -+ /* pHalData->BW20_24G_Diff[RFPath][TX_1S], pHalData->BW20_24G_Diff[RFPath][TX_2S], */ -+ /* pHalData->BW20_24G_Diff[RFPath][TX_3S], pHalData->BW20_24G_Diff[RFPath][TX_4S]); */ -+ } else if (BandWidth == CHANNEL_WIDTH_40) { /* BW40-1S, BW40-2S */ -+ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; -+ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; -+ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_3S]; -+ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_4S]; -+ -+ /* DBG_871X("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S, BW40-3S, BW40-4S) = (%d, %d, %d, %d)\n", ((RFPath == 0)?'A':(RFPath == 1)?'B':(RFPath ==2)?'C':'D'), */ -+ /* pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S], */ -+ /* pHalData->BW40_24G_Diff[RFPath][TX_3S], pHalData->BW40_24G_Diff[RFPath][TX_4S]); */ -+ } -+ /* Willis suggest adopt BW 40M power index while in BW 80 mode */ -+ else if (BandWidth == CHANNEL_WIDTH_80) { -+ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; -+ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; -+ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_3S]; -+ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_4S]; -+ -+ /* DBG_871X("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S, BW40-3S, BW40-4T) = (%d, %d, %d, %d) P.S. Current is in BW 80MHz\n", ((RFPath == 0)?'A':(RFPath == 1)?'B':(RFPath ==2)?'C':'D'), */ -+ /* pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S], */ -+ /* pHalData->BW40_24G_Diff[RFPath][TX_3S], pHalData->BW40_24G_Diff[RFPath][TX_4S]); */ -+ } -+ } else {/* 3 ============================== 5 G ============================== */ -+ if (MGN_6M <= Rate) -+ txPower = pHalData->Index5G_BW40_Base[RFPath][chnlIdx]; -+ else -+ DBG_871X("===> mpt_ProQueryCalTxPower_Jaguar: INVALID Rate.\n"); -+ -+ /* DBG_871X("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", */ -+ /* ((RFPath == 0)?'A':'B'), Rate, chnlIdx, txPower); */ -+ -+ /* OFDM-1T */ -+ if ((MGN_6M <= Rate && Rate <= MGN_54M) && !IS_CCK_RATE(Rate)) { -+ txPower += pHalData->OFDM_5G_Diff[RFPath][TX_1S]; -+ /* DBG_871X("+PowerDiff 5G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath == 0)?'A':'B'), pHalData->OFDM_5G_Diff[RFPath][TX_1S]); */ -+ } -+ -+ /* BW20-1S, BW20-2S */ -+ if (BandWidth == CHANNEL_WIDTH_20) { -+ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_1S]; -+ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_2S]; -+ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_3S]; -+ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_4S]; -+ -+ /* DBG_871X("+PowerDiff 5G (RF-%c): (BW20-1S, BW20-2S, BW20-3S, BW20-4S) = (%d, %d, %d, %d)\n", ((RFPath == 0)?'A':(RFPath == 1)?'B':(RFPath ==2)?'C':'D'), */ -+ /* pHalData->BW20_5G_Diff[RFPath][TX_1S], pHalData->BW20_5G_Diff[RFPath][TX_2S], */ -+ /* pHalData->BW20_5G_Diff[RFPath][TX_3S], pHalData->BW20_5G_Diff[RFPath][TX_4S]); */ -+ } else if (BandWidth == CHANNEL_WIDTH_40) { /* BW40-1S, BW40-2S */ -+ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_1S]; -+ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_2S]; -+ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_3S]; -+ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_4S]; -+ -+ /* DBG_871X("+PowerDiff 5G(RF-%c): (BW40-1S, BW40-2S) = (%d, %d, %d, %d)\n", ((RFPath == 0)?'A':(RFPath == 1)?'B':(RFPath ==2)?'C':'D'), */ -+ /* pHalData->BW40_5G_Diff[RFPath][TX_1S], pHalData->BW40_5G_Diff[RFPath][TX_2S], */ -+ /* pHalData->BW40_5G_Diff[RFPath][TX_3S], pHalData->BW40_5G_Diff[RFPath][TX_4S]); */ -+ } else if (BandWidth == CHANNEL_WIDTH_80) { /* BW80-1S, BW80-2S */ -+ /* <20121220, Kordan> Get the index of array "Index5G_BW80_Base". */ -+ u8 channel5G_80M[CHANNEL_MAX_NUMBER_5G_80M] = {42, 58, 106, 122, 138, 155, 171}; -+ for (i = 0; i < sizeof(channel5G_80M)/sizeof(u8); ++i) -+ if (channel5G_80M[i] == Channel) -+ chnlIdx = i; -+ -+ txPower = pHalData->Index5G_BW80_Base[RFPath][chnlIdx]; -+ -+ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += + pHalData->BW80_5G_Diff[RFPath][TX_1S]; -+ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW80_5G_Diff[RFPath][TX_2S]; -+ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW80_5G_Diff[RFPath][TX_3S]; -+ if ((MGN_MCS23 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW80_5G_Diff[RFPath][TX_4S]; -+ -+ /* DBG_871X("+PowerDiff 5G(RF-%c): (BW80-1S, BW80-2S, BW80-3S, BW80-4S) = (%d, %d, %d, %d)\n", ((RFPath == 0)?'A':(RFPath == 1)?'B':(RFPath ==2)?'C':'D'), */ -+ /* pHalData->BW80_5G_Diff[RFPath][TX_1S], pHalData->BW80_5G_Diff[RFPath][TX_2S], */ -+ /* pHalData->BW80_5G_Diff[RFPath][TX_3S], pHalData->BW80_5G_Diff[RFPath][TX_4S]); */ -+ } -+ } -+ -+ return txPower; -+} -+ -+s8 PHY_GetTxPowerTrackingOffset(struct adapter *padapter, u8 RFPath, u8 Rate) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ s8 offset = 0; -+ -+ if (pDM_Odm->RFCalibrateInfo.TxPowerTrackControl == false) -+ return offset; -+ -+ if ((Rate == MGN_1M) || (Rate == MGN_2M) || (Rate == MGN_5_5M) || (Rate == MGN_11M)) { -+ offset = pDM_Odm->Remnant_CCKSwingIdx; -+ /* DBG_871X("+Remnant_CCKSwingIdx = 0x%x\n", RFPath, Rate, pDM_Odm->Remnant_CCKSwingIdx); */ -+ } else { -+ offset = pDM_Odm->Remnant_OFDMSwingIdx[RFPath]; -+ /* DBG_871X("+Remanant_OFDMSwingIdx[RFPath %u][Rate 0x%x] = 0x%x\n", RFPath, Rate, pDM_Odm->Remnant_OFDMSwingIdx[RFPath]); */ -+ -+ } -+ -+ return offset; -+} -+ -+u8 PHY_GetRateIndexOfTxPowerByRate(u8 Rate) -+{ -+ u8 index = 0; -+ switch (Rate) { -+ case MGN_1M: -+ index = 0; -+ break; -+ case MGN_2M: -+ index = 1; -+ break; -+ case MGN_5_5M: -+ index = 2; -+ break; -+ case MGN_11M: -+ index = 3; -+ break; -+ case MGN_6M: -+ index = 4; -+ break; -+ case MGN_9M: -+ index = 5; -+ break; -+ case MGN_12M: -+ index = 6; -+ break; -+ case MGN_18M: -+ index = 7; -+ break; -+ case MGN_24M: -+ index = 8; -+ break; -+ case MGN_36M: -+ index = 9; -+ break; -+ case MGN_48M: -+ index = 10; -+ break; -+ case MGN_54M: -+ index = 11; -+ break; -+ case MGN_MCS0: -+ index = 12; -+ break; -+ case MGN_MCS1: -+ index = 13; -+ break; -+ case MGN_MCS2: -+ index = 14; -+ break; -+ case MGN_MCS3: -+ index = 15; -+ break; -+ case MGN_MCS4: -+ index = 16; -+ break; -+ case MGN_MCS5: -+ index = 17; -+ break; -+ case MGN_MCS6: -+ index = 18; -+ break; -+ case MGN_MCS7: -+ index = 19; -+ break; -+ case MGN_MCS8: -+ index = 20; -+ break; -+ case MGN_MCS9: -+ index = 21; -+ break; -+ case MGN_MCS10: -+ index = 22; -+ break; -+ case MGN_MCS11: -+ index = 23; -+ break; -+ case MGN_MCS12: -+ index = 24; -+ break; -+ case MGN_MCS13: -+ index = 25; -+ break; -+ case MGN_MCS14: -+ index = 26; -+ break; -+ case MGN_MCS15: -+ index = 27; -+ break; -+ case MGN_MCS16: -+ index = 28; -+ break; -+ case MGN_MCS17: -+ index = 29; -+ break; -+ case MGN_MCS18: -+ index = 30; -+ break; -+ case MGN_MCS19: -+ index = 31; -+ break; -+ case MGN_MCS20: -+ index = 32; -+ break; -+ case MGN_MCS21: -+ index = 33; -+ break; -+ case MGN_MCS22: -+ index = 34; -+ break; -+ case MGN_MCS23: -+ index = 35; -+ break; -+ case MGN_MCS24: -+ index = 36; -+ break; -+ case MGN_MCS25: -+ index = 37; -+ break; -+ case MGN_MCS26: -+ index = 38; -+ break; -+ case MGN_MCS27: -+ index = 39; -+ break; -+ case MGN_MCS28: -+ index = 40; -+ break; -+ case MGN_MCS29: -+ index = 41; -+ break; -+ case MGN_MCS30: -+ index = 42; -+ break; -+ case MGN_MCS31: -+ index = 43; -+ break; -+ case MGN_VHT1SS_MCS0: -+ index = 44; -+ break; -+ case MGN_VHT1SS_MCS1: -+ index = 45; -+ break; -+ case MGN_VHT1SS_MCS2: -+ index = 46; -+ break; -+ case MGN_VHT1SS_MCS3: -+ index = 47; -+ break; -+ case MGN_VHT1SS_MCS4: -+ index = 48; -+ break; -+ case MGN_VHT1SS_MCS5: -+ index = 49; -+ break; -+ case MGN_VHT1SS_MCS6: -+ index = 50; -+ break; -+ case MGN_VHT1SS_MCS7: -+ index = 51; -+ break; -+ case MGN_VHT1SS_MCS8: -+ index = 52; -+ break; -+ case MGN_VHT1SS_MCS9: -+ index = 53; -+ break; -+ case MGN_VHT2SS_MCS0: -+ index = 54; -+ break; -+ case MGN_VHT2SS_MCS1: -+ index = 55; -+ break; -+ case MGN_VHT2SS_MCS2: -+ index = 56; -+ break; -+ case MGN_VHT2SS_MCS3: -+ index = 57; -+ break; -+ case MGN_VHT2SS_MCS4: -+ index = 58; -+ break; -+ case MGN_VHT2SS_MCS5: -+ index = 59; -+ break; -+ case MGN_VHT2SS_MCS6: -+ index = 60; -+ break; -+ case MGN_VHT2SS_MCS7: -+ index = 61; -+ break; -+ case MGN_VHT2SS_MCS8: -+ index = 62; -+ break; -+ case MGN_VHT2SS_MCS9: -+ index = 63; -+ break; -+ case MGN_VHT3SS_MCS0: -+ index = 64; -+ break; -+ case MGN_VHT3SS_MCS1: -+ index = 65; -+ break; -+ case MGN_VHT3SS_MCS2: -+ index = 66; -+ break; -+ case MGN_VHT3SS_MCS3: -+ index = 67; -+ break; -+ case MGN_VHT3SS_MCS4: -+ index = 68; -+ break; -+ case MGN_VHT3SS_MCS5: -+ index = 69; -+ break; -+ case MGN_VHT3SS_MCS6: -+ index = 70; -+ break; -+ case MGN_VHT3SS_MCS7: -+ index = 71; -+ break; -+ case MGN_VHT3SS_MCS8: -+ index = 72; -+ break; -+ case MGN_VHT3SS_MCS9: -+ index = 73; -+ break; -+ case MGN_VHT4SS_MCS0: -+ index = 74; -+ break; -+ case MGN_VHT4SS_MCS1: -+ index = 75; -+ break; -+ case MGN_VHT4SS_MCS2: -+ index = 76; -+ break; -+ case MGN_VHT4SS_MCS3: -+ index = 77; -+ break; -+ case MGN_VHT4SS_MCS4: -+ index = 78; -+ break; -+ case MGN_VHT4SS_MCS5: -+ index = 79; -+ break; -+ case MGN_VHT4SS_MCS6: -+ index = 80; -+ break; -+ case MGN_VHT4SS_MCS7: -+ index = 81; -+ break; -+ case MGN_VHT4SS_MCS8: -+ index = 82; -+ break; -+ case MGN_VHT4SS_MCS9: -+ index = 83; -+ break; -+ default: -+ DBG_871X("Invalid rate 0x%x in %s\n", Rate, __func__); -+ break; -+ }; -+ -+ return index; -+} -+ -+s8 PHY_GetTxPowerByRate( -+ struct adapter *padapter, u8 Band, u8 RFPath, u8 TxNum, u8 Rate -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ s8 value = 0; -+ u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate(Rate); -+ -+ if ((padapter->registrypriv.RegEnableTxPowerByRate == 2 && pHalData->EEPROMRegulatory == 2) || -+ padapter->registrypriv.RegEnableTxPowerByRate == 0) -+ return 0; -+ -+ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { -+ DBG_871X("Invalid band %d in %s\n", Band, __func__); -+ return value; -+ } -+ if (RFPath > ODM_RF_PATH_D) { -+ DBG_871X("Invalid RfPath %d in %s\n", RFPath, __func__); -+ return value; -+ } -+ if (TxNum >= RF_MAX_TX_NUM) { -+ DBG_871X("Invalid TxNum %d in %s\n", TxNum, __func__); -+ return value; -+ } -+ if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) { -+ DBG_871X("Invalid RateIndex %d in %s\n", rateIndex, __func__); -+ return value; -+ } -+ -+ value = pHalData->TxPwrByRateOffset[Band][RFPath][TxNum][rateIndex]; -+ -+ return value; -+ -+} -+ -+void PHY_SetTxPowerByRate( -+ struct adapter *padapter, -+ u8 Band, -+ u8 RFPath, -+ u8 TxNum, -+ u8 Rate, -+ s8 Value -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate(Rate); -+ -+ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { -+ DBG_871X("Invalid band %d in %s\n", Band, __func__); -+ return; -+ } -+ if (RFPath > ODM_RF_PATH_D) { -+ DBG_871X("Invalid RfPath %d in %s\n", RFPath, __func__); -+ return; -+ } -+ if (TxNum >= RF_MAX_TX_NUM) { -+ DBG_871X("Invalid TxNum %d in %s\n", TxNum, __func__); -+ return; -+ } -+ if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) { -+ DBG_871X("Invalid RateIndex %d in %s\n", rateIndex, __func__); -+ return; -+ } -+ -+ pHalData->TxPwrByRateOffset[Band][RFPath][TxNum][rateIndex] = Value; -+} -+ -+void PHY_SetTxPowerLevelByPath(struct adapter *Adapter, u8 channel, u8 path) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ bool bIsIn24G = (pHalData->CurrentBandType == BAND_ON_2_4G); -+ -+ /* if (pMgntInfo->RegNByteAccess == 0) */ -+ { -+ if (bIsIn24G) -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, CCK); -+ -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, OFDM); -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, HT_MCS0_MCS7); -+ -+ if (pHalData->NumTotalRFPath >= 2) -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, HT_MCS8_MCS15); -+ -+ } -+} -+ -+void PHY_SetTxPowerIndexByRateArray( -+ struct adapter *padapter, -+ u8 RFPath, -+ enum CHANNEL_WIDTH BandWidth, -+ u8 Channel, -+ u8 *Rates, -+ u8 RateArraySize -+) -+{ -+ u32 powerIndex = 0; -+ int i = 0; -+ -+ for (i = 0; i < RateArraySize; ++i) { -+ powerIndex = PHY_GetTxPowerIndex(padapter, RFPath, Rates[i], BandWidth, Channel); -+ PHY_SetTxPowerIndex(padapter, powerIndex, RFPath, Rates[i]); -+ } -+} -+ -+static s8 phy_GetWorldWideLimit(s8 *LimitTable) -+{ -+ s8 min = LimitTable[0]; -+ u8 i = 0; -+ -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) { -+ if (LimitTable[i] < min) -+ min = LimitTable[i]; -+ } -+ -+ return min; -+} -+ -+static s8 phy_GetChannelIndexOfTxPowerLimit(u8 Band, u8 Channel) -+{ -+ s8 channelIndex = -1; -+ u8 channel5G[CHANNEL_MAX_NUMBER_5G] = { -+ 36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, 60, 62, 64, 100, 102, -+ 104, 106, 108, 110, 112, 114, 116, 118, 120, 122, 124, 126, 128, 130, -+ 132, 134, 136, 138, 140, 142, 144, 149, 151, 153, 155, 157, 159, 161, -+ 163, 165, 167, 168, 169, 171, 173, 175, 177 -+ }; -+ u8 i = 0; -+ if (Band == BAND_ON_2_4G) -+ channelIndex = Channel - 1; -+ else if (Band == BAND_ON_5G) { -+ for (i = 0; i < sizeof(channel5G)/sizeof(u8); ++i) { -+ if (channel5G[i] == Channel) -+ channelIndex = i; -+ } -+ } else -+ DBG_871X("Invalid Band %d in %s", Band, __func__); -+ -+ if (channelIndex == -1) -+ DBG_871X("Invalid Channel %d of Band %d in %s", Channel, Band, __func__); -+ -+ return channelIndex; -+} -+ -+s8 PHY_GetTxPowerLimit( -+ struct adapter *Adapter, -+ u32 RegPwrTblSel, -+ enum BAND_TYPE Band, -+ enum CHANNEL_WIDTH Bandwidth, -+ u8 RfPath, -+ u8 DataRate, -+ u8 Channel -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ s16 band = -1, regulation = -1, bandwidth = -1, rateSection = -1, channel = -1; -+ s8 powerLimit = MAX_POWER_INDEX; -+ -+ if ((Adapter->registrypriv.RegEnableTxPowerLimit == 2 && pHalData->EEPROMRegulatory != 1) || -+ Adapter->registrypriv.RegEnableTxPowerLimit == 0) -+ return MAX_POWER_INDEX; -+ -+ switch (Adapter->registrypriv.RegPwrTblSel) { -+ case 1: -+ regulation = TXPWR_LMT_ETSI; -+ break; -+ case 2: -+ regulation = TXPWR_LMT_MKK; -+ break; -+ case 3: -+ regulation = TXPWR_LMT_FCC; -+ break; -+ -+ case 4: -+ regulation = TXPWR_LMT_WW; -+ break; -+ -+ default: -+ regulation = (Band == BAND_ON_2_4G) ? pHalData->Regulation2_4G : pHalData->Regulation5G; -+ break; -+ } -+ -+ /* DBG_871X("pMgntInfo->RegPwrTblSel %d, final regulation %d\n", Adapter->registrypriv.RegPwrTblSel, regulation); */ -+ -+ -+ if (Band == BAND_ON_2_4G) -+ band = 0; -+ else if (Band == BAND_ON_5G) -+ band = 1; -+ -+ if (Bandwidth == CHANNEL_WIDTH_20) -+ bandwidth = 0; -+ else if (Bandwidth == CHANNEL_WIDTH_40) -+ bandwidth = 1; -+ else if (Bandwidth == CHANNEL_WIDTH_80) -+ bandwidth = 2; -+ else if (Bandwidth == CHANNEL_WIDTH_160) -+ bandwidth = 3; -+ -+ switch (DataRate) { -+ case MGN_1M: case MGN_2M: case MGN_5_5M: case MGN_11M: -+ rateSection = 0; -+ break; -+ -+ case MGN_6M: case MGN_9M: case MGN_12M: case MGN_18M: -+ case MGN_24M: case MGN_36M: case MGN_48M: case MGN_54M: -+ rateSection = 1; -+ break; -+ -+ case MGN_MCS0: case MGN_MCS1: case MGN_MCS2: case MGN_MCS3: -+ case MGN_MCS4: case MGN_MCS5: case MGN_MCS6: case MGN_MCS7: -+ rateSection = 2; -+ break; -+ -+ case MGN_MCS8: case MGN_MCS9: case MGN_MCS10: case MGN_MCS11: -+ case MGN_MCS12: case MGN_MCS13: case MGN_MCS14: case MGN_MCS15: -+ rateSection = 3; -+ break; -+ -+ case MGN_MCS16: case MGN_MCS17: case MGN_MCS18: case MGN_MCS19: -+ case MGN_MCS20: case MGN_MCS21: case MGN_MCS22: case MGN_MCS23: -+ rateSection = 4; -+ break; -+ -+ case MGN_MCS24: case MGN_MCS25: case MGN_MCS26: case MGN_MCS27: -+ case MGN_MCS28: case MGN_MCS29: case MGN_MCS30: case MGN_MCS31: -+ rateSection = 5; -+ break; -+ -+ case MGN_VHT1SS_MCS0: case MGN_VHT1SS_MCS1: case MGN_VHT1SS_MCS2: -+ case MGN_VHT1SS_MCS3: case MGN_VHT1SS_MCS4: case MGN_VHT1SS_MCS5: -+ case MGN_VHT1SS_MCS6: case MGN_VHT1SS_MCS7: case MGN_VHT1SS_MCS8: -+ case MGN_VHT1SS_MCS9: -+ rateSection = 6; -+ break; -+ -+ case MGN_VHT2SS_MCS0: case MGN_VHT2SS_MCS1: case MGN_VHT2SS_MCS2: -+ case MGN_VHT2SS_MCS3: case MGN_VHT2SS_MCS4: case MGN_VHT2SS_MCS5: -+ case MGN_VHT2SS_MCS6: case MGN_VHT2SS_MCS7: case MGN_VHT2SS_MCS8: -+ case MGN_VHT2SS_MCS9: -+ rateSection = 7; -+ break; -+ -+ case MGN_VHT3SS_MCS0: case MGN_VHT3SS_MCS1: case MGN_VHT3SS_MCS2: -+ case MGN_VHT3SS_MCS3: case MGN_VHT3SS_MCS4: case MGN_VHT3SS_MCS5: -+ case MGN_VHT3SS_MCS6: case MGN_VHT3SS_MCS7: case MGN_VHT3SS_MCS8: -+ case MGN_VHT3SS_MCS9: -+ rateSection = 8; -+ break; -+ -+ case MGN_VHT4SS_MCS0: case MGN_VHT4SS_MCS1: case MGN_VHT4SS_MCS2: -+ case MGN_VHT4SS_MCS3: case MGN_VHT4SS_MCS4: case MGN_VHT4SS_MCS5: -+ case MGN_VHT4SS_MCS6: case MGN_VHT4SS_MCS7: case MGN_VHT4SS_MCS8: -+ case MGN_VHT4SS_MCS9: -+ rateSection = 9; -+ break; -+ -+ default: -+ DBG_871X("Wrong rate 0x%x\n", DataRate); -+ break; -+ } -+ -+ if (Band == BAND_ON_5G && rateSection == 0) -+ DBG_871X("Wrong rate 0x%x: No CCK in 5G Band\n", DataRate); -+ -+ /* workaround for wrong index combination to obtain tx power limit, */ -+ /* OFDM only exists in BW 20M */ -+ if (rateSection == 1) -+ bandwidth = 0; -+ -+ /* workaround for wrong index combination to obtain tx power limit, */ -+ /* CCK table will only be given in BW 20M */ -+ if (rateSection == 0) -+ bandwidth = 0; -+ -+ /* workaround for wrong indxe combination to obtain tx power limit, */ -+ /* HT on 80M will reference to HT on 40M */ -+ if ((rateSection == 2 || rateSection == 3) && Band == BAND_ON_5G && bandwidth == 2) { -+ bandwidth = 1; -+ } -+ -+ if (Band == BAND_ON_2_4G) -+ channel = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_2_4G, Channel); -+ else if (Band == BAND_ON_5G) -+ channel = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_5G, Channel); -+ else if (Band == BAND_ON_BOTH) { -+ /* BAND_ON_BOTH don't care temporarily */ -+ } -+ -+ if (band == -1 || regulation == -1 || bandwidth == -1 || -+ rateSection == -1 || channel == -1) { -+ /* DBG_871X("Wrong index value to access power limit table [band %d][regulation %d][bandwidth %d][rf_path %d][rate_section %d][chnlGroup %d]\n", */ -+ /* band, regulation, bandwidth, RfPath, rateSection, channelGroup); */ -+ -+ return MAX_POWER_INDEX; -+ } -+ -+ if (Band == BAND_ON_2_4G) { -+ s8 limits[10] = {0}; u8 i = 0; -+ for (i = 0; i < MAX_REGULATION_NUM; i++) -+ limits[i] = pHalData->TxPwrLimit_2_4G[i][bandwidth][rateSection][channel][RfPath]; -+ -+ powerLimit = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : -+ pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channel][RfPath]; -+ -+ } else if (Band == BAND_ON_5G) { -+ s8 limits[10] = {0}; u8 i = 0; -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) -+ limits[i] = pHalData->TxPwrLimit_5G[i][bandwidth][rateSection][channel][RfPath]; -+ -+ powerLimit = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : -+ pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channel][RfPath]; -+ } else -+ DBG_871X("No power limit table of the specified band\n"); -+ -+ /* combine 5G VHT & HT rate */ -+ /* 5G 20M and 40M HT and VHT can cross reference */ -+ /* -+ if (Band == BAND_ON_5G && powerLimit == MAX_POWER_INDEX) { -+ if (bandwidth == 0 || bandwidth == 1) { -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("No power limit table of the specified band %d, bandwidth %d, ratesection %d, rf path %d\n", -+ band, bandwidth, rateSection, RfPath)); -+ if (rateSection == 2) -+ powerLimit = pHalData->TxPwrLimit_5G[regulation] -+ [bandwidth][4][channelGroup][RfPath]; -+ else if (rateSection == 4) -+ powerLimit = pHalData->TxPwrLimit_5G[regulation] -+ [bandwidth][2][channelGroup][RfPath]; -+ else if (rateSection == 3) -+ powerLimit = pHalData->TxPwrLimit_5G[regulation] -+ [bandwidth][5][channelGroup][RfPath]; -+ else if (rateSection == 5) -+ powerLimit = pHalData->TxPwrLimit_5G[regulation] -+ [bandwidth][3][channelGroup][RfPath]; -+ } -+ } -+ */ -+ /* DBG_871X("TxPwrLmt[Regulation %d][Band %d][BW %d][RFPath %d][Rate 0x%x][Chnl %d] = %d\n", */ -+ /* regulation, pHalData->CurrentBandType, Bandwidth, RfPath, DataRate, Channel, powerLimit); */ -+ return powerLimit; -+} -+ -+static void phy_CrossReferenceHTAndVHTTxPowerLimit(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u8 regulation, bw, channel, rateSection; -+ s8 tempPwrLmt = 0; -+ -+ for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) { -+ for (bw = 0; bw < MAX_5G_BANDWITH_NUM; ++bw) { -+ for (channel = 0; channel < CHANNEL_MAX_NUMBER_5G; ++channel) { -+ for (rateSection = 0; rateSection < MAX_RATE_SECTION_NUM; ++rateSection) { -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation][bw][rateSection][channel][ODM_RF_PATH_A]; -+ if (tempPwrLmt == MAX_POWER_INDEX) { -+ u8 baseSection = 2, refSection = 6; -+ if (bw == 0 || bw == 1) { /* 5G 20M 40M VHT and HT can cross reference */ -+ /* DBG_871X("No power limit table of the specified band %d, bandwidth %d, ratesection %d, channel %d, rf path %d\n", */ -+ /* 1, bw, rateSection, channel, ODM_RF_PATH_A); */ -+ if (rateSection >= 2 && rateSection <= 9) { -+ if (rateSection == 2) { -+ baseSection = 2; -+ refSection = 6; -+ } else if (rateSection == 3) { -+ baseSection = 3; -+ refSection = 7; -+ } else if (rateSection == 4) { -+ baseSection = 4; -+ refSection = 8; -+ } else if (rateSection == 5) { -+ baseSection = 5; -+ refSection = 9; -+ } else if (rateSection == 6) { -+ baseSection = 6; -+ refSection = 2; -+ } else if (rateSection == 7) { -+ baseSection = 7; -+ refSection = 3; -+ } else if (rateSection == 8) { -+ baseSection = 8; -+ refSection = 4; -+ } else if (rateSection == 9) { -+ baseSection = 9; -+ refSection = 5; -+ } -+ pHalData->TxPwrLimit_5G[regulation][bw][baseSection][channel][ODM_RF_PATH_A] = -+ pHalData->TxPwrLimit_5G[regulation][bw][refSection][channel][ODM_RF_PATH_A]; -+ } -+ -+ /* DBG_871X("use other value %d", tempPwrLmt); */ -+ } -+ } -+ } -+ } -+ } -+ } -+} -+ -+void PHY_ConvertTxPowerLimitToPowerIndex(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ u8 BW40PwrBasedBm2_4G = 0x2E; -+ u8 regulation, bw, channel, rateSection; -+ s8 tempValue = 0, tempPwrLmt = 0; -+ u8 rfPath = 0; -+ -+ /* DBG_871X("=====> PHY_ConvertTxPowerLimitToPowerIndex()\n"); */ -+ -+ phy_CrossReferenceHTAndVHTTxPowerLimit(Adapter); -+ -+ for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) { -+ for (bw = 0; bw < MAX_2_4G_BANDWITH_NUM; ++bw) { -+ for (channel = 0; channel < CHANNEL_MAX_NUMBER_2G; ++channel) { -+ for (rateSection = 0; rateSection < MAX_RATE_SECTION_NUM; ++rateSection) { -+ tempPwrLmt = pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][channel][ODM_RF_PATH_A]; -+ -+ for (rfPath = ODM_RF_PATH_A; rfPath < MAX_RF_PATH_NUM; ++rfPath) { -+ if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE) { -+ if (rateSection == 5) /* HT 4T */ -+ BW40PwrBasedBm2_4G = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_2_4G, rfPath, RF_4TX, HT_MCS24_MCS31); -+ else if (rateSection == 4) /* HT 3T */ -+ BW40PwrBasedBm2_4G = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_2_4G, rfPath, RF_3TX, HT_MCS16_MCS23); -+ else if (rateSection == 3) /* HT 2T */ -+ BW40PwrBasedBm2_4G = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_2_4G, rfPath, RF_2TX, HT_MCS8_MCS15); -+ else if (rateSection == 2) /* HT 1T */ -+ BW40PwrBasedBm2_4G = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_2_4G, rfPath, RF_1TX, HT_MCS0_MCS7); -+ else if (rateSection == 1) /* OFDM */ -+ BW40PwrBasedBm2_4G = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_2_4G, rfPath, RF_1TX, OFDM); -+ else if (rateSection == 0) /* CCK */ -+ BW40PwrBasedBm2_4G = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_2_4G, rfPath, RF_1TX, CCK); -+ } else -+ BW40PwrBasedBm2_4G = Adapter->registrypriv.RegPowerBase * 2; -+ -+ if (tempPwrLmt != MAX_POWER_INDEX) { -+ tempValue = tempPwrLmt - BW40PwrBasedBm2_4G; -+ pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][channel][rfPath] = tempValue; -+ } -+ } -+ } -+ } -+ } -+ } -+ -+ /* DBG_871X("<===== PHY_ConvertTxPowerLimitToPowerIndex()\n"); */ -+} -+ -+void PHY_InitTxPowerLimit(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ u8 i, j, k, l, m; -+ -+ /* DBG_871X("=====> PHY_InitTxPowerLimit()!\n"); */ -+ -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) { -+ for (j = 0; j < MAX_2_4G_BANDWITH_NUM; ++j) -+ for (k = 0; k < MAX_RATE_SECTION_NUM; ++k) -+ for (m = 0; m < CHANNEL_MAX_NUMBER_2G; ++m) -+ for (l = 0; l < MAX_RF_PATH_NUM; ++l) -+ pHalData->TxPwrLimit_2_4G[i][j][k][m][l] = MAX_POWER_INDEX; -+ } -+ -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) { -+ for (j = 0; j < MAX_5G_BANDWITH_NUM; ++j) -+ for (k = 0; k < MAX_RATE_SECTION_NUM; ++k) -+ for (m = 0; m < CHANNEL_MAX_NUMBER_5G; ++m) -+ for (l = 0; l < MAX_RF_PATH_NUM; ++l) -+ pHalData->TxPwrLimit_5G[i][j][k][m][l] = MAX_POWER_INDEX; -+ } -+ -+ /* DBG_871X("<===== PHY_InitTxPowerLimit()!\n"); */ -+} -+ -+void PHY_SetTxPowerLimit( -+ struct adapter *Adapter, -+ u8 *Regulation, -+ u8 *Band, -+ u8 *Bandwidth, -+ u8 *RateSection, -+ u8 *RfPath, -+ u8 *Channel, -+ u8 *PowerLimit -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ u8 regulation = 0, bandwidth = 0, rateSection = 0, channel; -+ s8 powerLimit = 0, prevPowerLimit, channelIndex; -+ -+ /* DBG_871X("Index of power limit table [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s][val %s]\n", */ -+ /* Band, Regulation, Bandwidth, RateSection, RfPath, Channel, PowerLimit); */ -+ -+ if (!GetU1ByteIntegerFromStringInDecimal((s8 *)Channel, &channel) || -+ !GetU1ByteIntegerFromStringInDecimal((s8 *)PowerLimit, &powerLimit)) -+ DBG_871X("Illegal index of power limit table [chnl %s][val %s]\n", Channel, PowerLimit); -+ -+ powerLimit = powerLimit > MAX_POWER_INDEX ? MAX_POWER_INDEX : powerLimit; -+ -+ if (eqNByte(Regulation, (u8 *)("FCC"), 3)) -+ regulation = 0; -+ else if (eqNByte(Regulation, (u8 *)("MKK"), 3)) -+ regulation = 1; -+ else if (eqNByte(Regulation, (u8 *)("ETSI"), 4)) -+ regulation = 2; -+ else if (eqNByte(Regulation, (u8 *)("WW13"), 4)) -+ regulation = 3; -+ -+ if (eqNByte(RateSection, (u8 *)("CCK"), 3) && eqNByte(RfPath, (u8 *)("1T"), 2)) -+ rateSection = 0; -+ else if (eqNByte(RateSection, (u8 *)("OFDM"), 4) && eqNByte(RfPath, (u8 *)("1T"), 2)) -+ rateSection = 1; -+ else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("1T"), 2)) -+ rateSection = 2; -+ else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("2T"), 2)) -+ rateSection = 3; -+ else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("3T"), 2)) -+ rateSection = 4; -+ else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("4T"), 2)) -+ rateSection = 5; -+ else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("1T"), 2)) -+ rateSection = 6; -+ else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("2T"), 2)) -+ rateSection = 7; -+ else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("3T"), 2)) -+ rateSection = 8; -+ else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("4T"), 2)) -+ rateSection = 9; -+ else { -+ DBG_871X("Wrong rate section!\n"); -+ return; -+ } -+ -+ -+ if (eqNByte(Bandwidth, (u8 *)("20M"), 3)) -+ bandwidth = 0; -+ else if (eqNByte(Bandwidth, (u8 *)("40M"), 3)) -+ bandwidth = 1; -+ else if (eqNByte(Bandwidth, (u8 *)("80M"), 3)) -+ bandwidth = 2; -+ else if (eqNByte(Bandwidth, (u8 *)("160M"), 4)) -+ bandwidth = 3; -+ -+ if (eqNByte(Band, (u8 *)("2.4G"), 4)) { -+ channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_2_4G, channel); -+ -+ if (channelIndex == -1) -+ return; -+ -+ prevPowerLimit = pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A]; -+ -+ if (powerLimit < prevPowerLimit) -+ pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A] = powerLimit; -+ -+ /* DBG_871X("2.4G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n", */ -+ /* regulation, bandwidth, rateSection, channelIndex, pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A]); */ -+ } else if (eqNByte(Band, (u8 *)("5G"), 2)) { -+ channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_5G, channel); -+ -+ if (channelIndex == -1) -+ return; -+ -+ prevPowerLimit = pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A]; -+ -+ if (powerLimit < prevPowerLimit) -+ pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A] = powerLimit; -+ -+ /* DBG_871X("5G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n", */ -+ /* regulation, bandwidth, rateSection, channel, pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A]); */ -+ } else { -+ DBG_871X("Cannot recognize the band info in %s\n", Band); -+ return; -+ } -+} -+ -+u8 PHY_GetTxPowerIndex( -+ struct adapter *padapter, -+ u8 RFPath, -+ u8 Rate, -+ enum CHANNEL_WIDTH BandWidth, -+ u8 Channel -+) -+{ -+ return PHY_GetTxPowerIndex_8723B(padapter, RFPath, Rate, BandWidth, Channel); -+} -+ -+void PHY_SetTxPowerIndex( -+ struct adapter *padapter, u32 PowerIndex, u8 RFPath, u8 Rate -+) -+{ -+ PHY_SetTxPowerIndex_8723B(padapter, PowerIndex, RFPath, Rate); -+} -+ -+void Hal_ChannelPlanToRegulation(struct adapter *Adapter, u16 ChannelPlan) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ pHalData->Regulation2_4G = TXPWR_LMT_WW; -+ pHalData->Regulation5G = TXPWR_LMT_WW; -+ -+ switch (ChannelPlan) { -+ case RT_CHANNEL_DOMAIN_WORLD_NULL: -+ pHalData->Regulation2_4G = TXPWR_LMT_WW; -+ break; -+ case RT_CHANNEL_DOMAIN_ETSI1_NULL: -+ pHalData->Regulation2_4G = TXPWR_LMT_ETSI; -+ break; -+ case RT_CHANNEL_DOMAIN_FCC1_NULL: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_MKK1_NULL: -+ pHalData->Regulation2_4G = TXPWR_LMT_MKK; -+ break; -+ case RT_CHANNEL_DOMAIN_ETSI2_NULL: -+ pHalData->Regulation2_4G = TXPWR_LMT_ETSI; -+ break; -+ case RT_CHANNEL_DOMAIN_FCC1_FCC1: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_ETSI1: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_ETSI; -+ break; -+ case RT_CHANNEL_DOMAIN_MKK1_MKK1: -+ pHalData->Regulation2_4G = TXPWR_LMT_MKK; -+ pHalData->Regulation5G = TXPWR_LMT_MKK; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_KCC1: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_MKK; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_FCC2: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_FCC3: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_FCC4: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_FCC5: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_FCC6: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_FCC1_FCC7: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_ETSI2: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_ETSI3: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_MKK1_MKK2: -+ pHalData->Regulation2_4G = TXPWR_LMT_MKK; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_MKK1_MKK3: -+ pHalData->Regulation2_4G = TXPWR_LMT_MKK; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_FCC1_NCC1: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_FCC1_NCC2: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_GLOBAL_NULL: -+ pHalData->Regulation2_4G = TXPWR_LMT_WW; -+ pHalData->Regulation5G = TXPWR_LMT_WW; -+ break; -+ case RT_CHANNEL_DOMAIN_ETSI1_ETSI4: -+ pHalData->Regulation2_4G = TXPWR_LMT_ETSI; -+ pHalData->Regulation5G = TXPWR_LMT_ETSI; -+ break; -+ case RT_CHANNEL_DOMAIN_FCC1_FCC2: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_FCC1_NCC3: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_ETSI5: -+ pHalData->Regulation2_4G = TXPWR_LMT_ETSI; -+ pHalData->Regulation5G = TXPWR_LMT_ETSI; -+ break; -+ case RT_CHANNEL_DOMAIN_FCC1_FCC8: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_ETSI6: -+ pHalData->Regulation2_4G = TXPWR_LMT_ETSI; -+ pHalData->Regulation5G = TXPWR_LMT_ETSI; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_ETSI7: -+ pHalData->Regulation2_4G = TXPWR_LMT_ETSI; -+ pHalData->Regulation5G = TXPWR_LMT_ETSI; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_ETSI8: -+ pHalData->Regulation2_4G = TXPWR_LMT_ETSI; -+ pHalData->Regulation5G = TXPWR_LMT_ETSI; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_ETSI9: -+ pHalData->Regulation2_4G = TXPWR_LMT_ETSI; -+ pHalData->Regulation5G = TXPWR_LMT_ETSI; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_ETSI10: -+ pHalData->Regulation2_4G = TXPWR_LMT_ETSI; -+ pHalData->Regulation5G = TXPWR_LMT_ETSI; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_ETSI11: -+ pHalData->Regulation2_4G = TXPWR_LMT_ETSI; -+ pHalData->Regulation5G = TXPWR_LMT_ETSI; -+ break; -+ case RT_CHANNEL_DOMAIN_FCC1_NCC4: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_ETSI12: -+ pHalData->Regulation2_4G = TXPWR_LMT_ETSI; -+ pHalData->Regulation5G = TXPWR_LMT_ETSI; -+ break; -+ case RT_CHANNEL_DOMAIN_FCC1_FCC9: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_WORLD_ETSI13: -+ pHalData->Regulation2_4G = TXPWR_LMT_ETSI; -+ pHalData->Regulation5G = TXPWR_LMT_ETSI; -+ break; -+ case RT_CHANNEL_DOMAIN_FCC1_FCC10: -+ pHalData->Regulation2_4G = TXPWR_LMT_FCC; -+ pHalData->Regulation5G = TXPWR_LMT_FCC; -+ break; -+ case RT_CHANNEL_DOMAIN_REALTEK_DEFINE: /* Realtek Reserve */ -+ pHalData->Regulation2_4G = TXPWR_LMT_WW; -+ pHalData->Regulation5G = TXPWR_LMT_WW; -+ break; -+ default: -+ break; -+ } -+} -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ -+static char file_path_bs[PATH_MAX]; -+ -+#define GetLineFromBuffer(buffer) strsep(&buffer, "\n") -+ -+int phy_ConfigMACWithParaFile(struct adapter *Adapter, char *pFileName) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegValue, u4bMove; -+ -+ if (!(Adapter->registrypriv.load_phy_file & LOAD_MAC_PARA_FILE)) -+ return rtStatus; -+ -+ memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pHalData->mac_reg_len == 0) && (pHalData->mac_reg == NULL)) { -+ rtw_merge_string(file_path_bs, PATH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(file_path_bs) == true) { -+ rlen = rtw_retrive_from_file(file_path_bs, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) { -+ rtStatus = _SUCCESS; -+ pHalData->mac_reg = vzalloc(rlen); -+ if (pHalData->mac_reg) { -+ memcpy(pHalData->mac_reg, pHalData->para_file_buf, rlen); -+ pHalData->mac_reg_len = rlen; -+ } else -+ DBG_871X("%s mac_reg alloc fail !\n", __func__); -+ } -+ } -+ } else { -+ if ((pHalData->mac_reg_len != 0) && (pHalData->mac_reg != NULL)) { -+ memcpy(pHalData->para_file_buf, pHalData->mac_reg, pHalData->mac_reg_len); -+ rtStatus = _SUCCESS; -+ } else -+ DBG_871X("%s(): Critical Error !!!\n", __func__); -+ } -+ -+ if (rtStatus == _SUCCESS) { -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ if (!IsCommentString(szLine)) { -+ /* Get 1st hex value as register offset */ -+ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { -+ if (u4bRegOffset == 0xffff) /* Ending. */ -+ break; -+ -+ /* Get 2nd hex value as register value. */ -+ szLine += u4bMove; -+ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) -+ rtw_write8(Adapter, u4bRegOffset, (u8)u4bRegValue); -+ } -+ } -+ } -+ } else -+ DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __func__, pFileName); -+ -+ return rtStatus; -+} -+ -+int phy_ConfigBBWithParaFile( -+ struct adapter *Adapter, char *pFileName, u32 ConfigType -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegValue, u4bMove; -+ char *pBuf = NULL; -+ u32 *pBufLen = NULL; -+ -+ if (!(Adapter->registrypriv.load_phy_file & LOAD_BB_PARA_FILE)) -+ return rtStatus; -+ -+ switch (ConfigType) { -+ case CONFIG_BB_PHY_REG: -+ pBuf = pHalData->bb_phy_reg; -+ pBufLen = &pHalData->bb_phy_reg_len; -+ break; -+ case CONFIG_BB_AGC_TAB: -+ pBuf = pHalData->bb_agc_tab; -+ pBufLen = &pHalData->bb_agc_tab_len; -+ break; -+ default: -+ DBG_871X("Unknown ConfigType!! %d\r\n", ConfigType); -+ break; -+ } -+ -+ memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) { -+ rtw_merge_string(file_path_bs, PATH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(file_path_bs) == true) { -+ rlen = rtw_retrive_from_file(file_path_bs, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) { -+ rtStatus = _SUCCESS; -+ pBuf = vzalloc(rlen); -+ if (pBuf) { -+ memcpy(pBuf, pHalData->para_file_buf, rlen); -+ *pBufLen = rlen; -+ -+ switch (ConfigType) { -+ case CONFIG_BB_PHY_REG: -+ pHalData->bb_phy_reg = pBuf; -+ break; -+ case CONFIG_BB_AGC_TAB: -+ pHalData->bb_agc_tab = pBuf; -+ break; -+ } -+ } else -+ DBG_871X("%s(): ConfigType %d alloc fail !\n", __func__, ConfigType); -+ } -+ } -+ } else { -+ if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) { -+ memcpy(pHalData->para_file_buf, pBuf, *pBufLen); -+ rtStatus = _SUCCESS; -+ } else -+ DBG_871X("%s(): Critical Error !!!\n", __func__); -+ } -+ -+ if (rtStatus == _SUCCESS) { -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ if (!IsCommentString(szLine)) { -+ /* Get 1st hex value as register offset. */ -+ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { -+ if (u4bRegOffset == 0xffff) /* Ending. */ -+ break; -+ else if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) -+ msleep(50); -+ else if (u4bRegOffset == 0xfd) -+ mdelay(5); -+ else if (u4bRegOffset == 0xfc) -+ mdelay(1); -+ else if (u4bRegOffset == 0xfb) -+ udelay(50); -+ else if (u4bRegOffset == 0xfa) -+ udelay(5); -+ else if (u4bRegOffset == 0xf9) -+ udelay(1); -+ -+ /* Get 2nd hex value as register value. */ -+ szLine += u4bMove; -+ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { -+ /* DBG_871X("[BB-ADDR]%03lX =%08lX\n", u4bRegOffset, u4bRegValue); */ -+ PHY_SetBBReg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); -+ -+ if (u4bRegOffset == 0xa24) -+ pHalData->odmpriv.RFCalibrateInfo.RegA24 = u4bRegValue; -+ -+ /* Add 1us delay between BB/RF register setting. */ -+ udelay(1); -+ } -+ } -+ } -+ } -+ } else -+ DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __func__, pFileName); -+ -+ return rtStatus; -+} -+ -+static void phy_DecryptBBPgParaFile(struct adapter *Adapter, char *buffer) -+{ -+ u32 i = 0, j = 0; -+ u8 map[95] = {0}; -+ u8 currentChar; -+ char *BufOfLines, *ptmp; -+ -+ /* DBG_871X("=====>phy_DecryptBBPgParaFile()\n"); */ -+ /* 32 the ascii code of the first visable char, 126 the last one */ -+ for (i = 0; i < 95; ++i) -+ map[i] = (u8) (94 - i); -+ -+ ptmp = buffer; -+ i = 0; -+ for (BufOfLines = GetLineFromBuffer(ptmp); BufOfLines != NULL; BufOfLines = GetLineFromBuffer(ptmp)) { -+ /* DBG_871X("Encrypted Line: %s\n", BufOfLines); */ -+ -+ for (j = 0; j < strlen(BufOfLines); ++j) { -+ currentChar = BufOfLines[j]; -+ -+ if (currentChar == '\0') -+ break; -+ -+ currentChar -= (u8) ((((i + j) * 3) % 128)); -+ -+ BufOfLines[j] = map[currentChar - 32] + 32; -+ } -+ /* DBG_871X("Decrypted Line: %s\n", BufOfLines); */ -+ if (strlen(BufOfLines) != 0) -+ i++; -+ BufOfLines[strlen(BufOfLines)] = '\n'; -+ } -+} -+ -+static int phy_ParseBBPgParaFile(struct adapter *Adapter, char *buffer) -+{ -+ int rtStatus = _SUCCESS; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegMask, u4bRegValue; -+ u32 u4bMove; -+ bool firstLine = true; -+ u8 tx_num = 0; -+ u8 band = 0, rf_path = 0; -+ -+ /* DBG_871X("=====>phy_ParseBBPgParaFile()\n"); */ -+ -+ if (Adapter->registrypriv.RegDecryptCustomFile == 1) -+ phy_DecryptBBPgParaFile(Adapter, buffer); -+ -+ ptmp = buffer; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ if (!IsCommentString(szLine)) { -+ if (isAllSpaceOrTab(szLine, sizeof(*szLine))) -+ continue; -+ -+ /* Get header info (relative value or exact value) */ -+ if (firstLine) { -+ if (eqNByte(szLine, (u8 *)("#[v1]"), 5)) { -+ -+ pHalData->odmpriv.PhyRegPgVersion = szLine[3] - '0'; -+ /* DBG_871X("This is a new format PHY_REG_PG.txt\n"); */ -+ } else if (eqNByte(szLine, (u8 *)("#[v0]"), 5)) { -+ pHalData->odmpriv.PhyRegPgVersion = szLine[3] - '0'; -+ /* DBG_871X("This is a old format PHY_REG_PG.txt ok\n"); */ -+ } else { -+ DBG_871X("The format in PHY_REG_PG are invalid %s\n", szLine); -+ return _FAIL; -+ } -+ -+ if (eqNByte(szLine + 5, (u8 *)("[Exact]#"), 8)) { -+ pHalData->odmpriv.PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; -+ /* DBG_871X("The values in PHY_REG_PG are exact values ok\n"); */ -+ firstLine = false; -+ continue; -+ } else if (eqNByte(szLine + 5, (u8 *)("[Relative]#"), 11)) { -+ pHalData->odmpriv.PhyRegPgValueType = PHY_REG_PG_RELATIVE_VALUE; -+ /* DBG_871X("The values in PHY_REG_PG are relative values ok\n"); */ -+ firstLine = false; -+ continue; -+ } else { -+ DBG_871X("The values in PHY_REG_PG are invalid %s\n", szLine); -+ return _FAIL; -+ } -+ } -+ -+ if (pHalData->odmpriv.PhyRegPgVersion == 0) { -+ /* Get 1st hex value as register offset. */ -+ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { -+ szLine += u4bMove; -+ if (u4bRegOffset == 0xffff) /* Ending. */ -+ break; -+ -+ /* Get 2nd hex value as register mask. */ -+ if (GetHexValueFromString(szLine, &u4bRegMask, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_RELATIVE_VALUE) { -+ /* Get 3rd hex value as register value. */ -+ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { -+ PHY_StoreTxPowerByRate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, u4bRegValue); -+ /* DBG_871X("[ADDR] %03X =%08X Mask =%08x\n", u4bRegOffset, u4bRegValue, u4bRegMask); */ -+ } else -+ return _FAIL; -+ } else if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE) { -+ u32 combineValue = 0; -+ u8 integer = 0, fraction = 0; -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* DBG_871X(" %d", integer); */ -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue <<= 8; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* DBG_871X(" %d", integer); */ -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue <<= 8; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* DBG_871X(" %d", integer); */ -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue <<= 8; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* DBG_871X(" %d", integer); */ -+ PHY_StoreTxPowerByRate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, combineValue); -+ -+ /* DBG_871X("[ADDR] 0x%3x = 0x%4x\n", u4bRegOffset, combineValue); */ -+ } -+ } -+ } else if (pHalData->odmpriv.PhyRegPgVersion > 0) { -+ u32 index = 0; -+ -+ if (eqNByte(szLine, "0xffff", 6)) -+ break; -+ -+ if (!eqNByte("#[END]#", szLine, 7)) { -+ /* load the table label info */ -+ if (szLine[0] == '#') { -+ index = 0; -+ if (eqNByte(szLine, "#[2.4G]", 7)) { -+ band = BAND_ON_2_4G; -+ index += 8; -+ } else if (eqNByte(szLine, "#[5G]", 5)) { -+ band = BAND_ON_5G; -+ index += 6; -+ } else { -+ DBG_871X("Invalid band %s in PHY_REG_PG.txt\n", szLine); -+ return _FAIL; -+ } -+ -+ rf_path = szLine[index] - 'A'; -+ /* DBG_871X(" Table label Band %d, RfPath %d\n", band, rf_path); */ -+ } else { /* load rows of tables */ -+ if (szLine[1] == '1') -+ tx_num = RF_1TX; -+ else if (szLine[1] == '2') -+ tx_num = RF_2TX; -+ else if (szLine[1] == '3') -+ tx_num = RF_3TX; -+ else if (szLine[1] == '4') -+ tx_num = RF_4TX; -+ else { -+ DBG_871X("Invalid row in PHY_REG_PG.txt %c\n", szLine[1]); -+ return _FAIL; -+ } -+ -+ while (szLine[index] != ']') -+ ++index; -+ ++index;/* skip ] */ -+ -+ /* Get 2nd hex value as register offset. */ -+ szLine += index; -+ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ /* Get 2nd hex value as register mask. */ -+ if (GetHexValueFromString(szLine, &u4bRegMask, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_RELATIVE_VALUE) { -+ /* Get 3rd hex value as register value. */ -+ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { -+ PHY_StoreTxPowerByRate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, u4bRegValue); -+ /* DBG_871X("[ADDR] %03X (tx_num %d) =%08X Mask =%08x\n", u4bRegOffset, tx_num, u4bRegValue, u4bRegMask); */ -+ } else -+ return _FAIL; -+ } else if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE) { -+ u32 combineValue = 0; -+ u8 integer = 0, fraction = 0; -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* DBG_871X(" %d", integer); */ -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue <<= 8; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* DBG_871X(" %d", integer); */ -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue <<= 8; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* DBG_871X(" %d", integer); */ -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue <<= 8; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* DBG_871X(" %d", integer); */ -+ PHY_StoreTxPowerByRate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, combineValue); -+ -+ /* DBG_871X("[ADDR] 0x%3x (tx_num %d) = 0x%4x\n", u4bRegOffset, tx_num, combineValue); */ -+ } -+ } -+ } -+ } -+ } -+ } -+ /* DBG_871X("<=====phy_ParseBBPgParaFile()\n"); */ -+ return rtStatus; -+} -+ -+int phy_ConfigBBWithPgParaFile(struct adapter *Adapter, char *pFileName) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ -+ if (!(Adapter->registrypriv.load_phy_file & LOAD_BB_PG_PARA_FILE)) -+ return rtStatus; -+ -+ memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pHalData->bb_phy_reg_pg_len == 0) && (pHalData->bb_phy_reg_pg == NULL)) { -+ rtw_merge_string(file_path_bs, PATH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(file_path_bs) == true) { -+ rlen = rtw_retrive_from_file(file_path_bs, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) { -+ rtStatus = _SUCCESS; -+ pHalData->bb_phy_reg_pg = vzalloc(rlen); -+ if (pHalData->bb_phy_reg_pg) { -+ memcpy(pHalData->bb_phy_reg_pg, pHalData->para_file_buf, rlen); -+ pHalData->bb_phy_reg_pg_len = rlen; -+ } else -+ DBG_871X("%s bb_phy_reg_pg alloc fail !\n", __func__); -+ } -+ } -+ } else { -+ if ((pHalData->bb_phy_reg_pg_len != 0) && (pHalData->bb_phy_reg_pg != NULL)) { -+ memcpy(pHalData->para_file_buf, pHalData->bb_phy_reg_pg, pHalData->bb_phy_reg_pg_len); -+ rtStatus = _SUCCESS; -+ } else -+ DBG_871X("%s(): Critical Error !!!\n", __func__); -+ } -+ -+ if (rtStatus == _SUCCESS) { -+ /* DBG_871X("phy_ConfigBBWithPgParaFile(): read %s ok\n", pFileName); */ -+ phy_ParseBBPgParaFile(Adapter, pHalData->para_file_buf); -+ } else -+ DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __func__, pFileName); -+ -+ return rtStatus; -+} -+ -+int PHY_ConfigRFWithParaFile( -+ struct adapter *Adapter, char *pFileName, u8 eRFPath -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegValue, u4bMove; -+ u16 i; -+ char *pBuf = NULL; -+ u32 *pBufLen = NULL; -+ -+ if (!(Adapter->registrypriv.load_phy_file & LOAD_RF_PARA_FILE)) -+ return rtStatus; -+ -+ switch (eRFPath) { -+ case ODM_RF_PATH_A: -+ pBuf = pHalData->rf_radio_a; -+ pBufLen = &pHalData->rf_radio_a_len; -+ break; -+ case ODM_RF_PATH_B: -+ pBuf = pHalData->rf_radio_b; -+ pBufLen = &pHalData->rf_radio_b_len; -+ break; -+ default: -+ DBG_871X("Unknown RF path!! %d\r\n", eRFPath); -+ break; -+ } -+ -+ memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) { -+ rtw_merge_string(file_path_bs, PATH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(file_path_bs) == true) { -+ rlen = rtw_retrive_from_file(file_path_bs, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) { -+ rtStatus = _SUCCESS; -+ pBuf = vzalloc(rlen); -+ if (pBuf) { -+ memcpy(pBuf, pHalData->para_file_buf, rlen); -+ *pBufLen = rlen; -+ -+ switch (eRFPath) { -+ case ODM_RF_PATH_A: -+ pHalData->rf_radio_a = pBuf; -+ break; -+ case ODM_RF_PATH_B: -+ pHalData->rf_radio_b = pBuf; -+ break; -+ } -+ } else -+ DBG_871X("%s(): eRFPath =%d alloc fail !\n", __func__, eRFPath); -+ } -+ } -+ } else { -+ if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) { -+ memcpy(pHalData->para_file_buf, pBuf, *pBufLen); -+ rtStatus = _SUCCESS; -+ } else -+ DBG_871X("%s(): Critical Error !!!\n", __func__); -+ } -+ -+ if (rtStatus == _SUCCESS) { -+ /* DBG_871X("%s(): read %s successfully\n", __func__, pFileName); */ -+ -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ if (!IsCommentString(szLine)) { -+ /* Get 1st hex value as register offset. */ -+ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { -+ if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) /* Deay specific ms. Only RF configuration require delay. */ -+ msleep(50); -+ else if (u4bRegOffset == 0xfd) { -+ /* mdelay(5); */ -+ for (i = 0; i < 100; i++) -+ udelay(MAX_STALL_TIME); -+ } else if (u4bRegOffset == 0xfc) { -+ /* mdelay(1); */ -+ for (i = 0; i < 20; i++) -+ udelay(MAX_STALL_TIME); -+ } else if (u4bRegOffset == 0xfb) -+ udelay(50); -+ else if (u4bRegOffset == 0xfa) -+ udelay(5); -+ else if (u4bRegOffset == 0xf9) -+ udelay(1); -+ else if (u4bRegOffset == 0xffff) -+ break; -+ -+ /* Get 2nd hex value as register value. */ -+ szLine += u4bMove; -+ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { -+ PHY_SetRFReg(Adapter, eRFPath, u4bRegOffset, bRFRegOffsetMask, u4bRegValue); -+ -+ /* Temp add, for frequency lock, if no delay, that may cause */ -+ /* frequency shift, ex: 2412MHz => 2417MHz */ -+ /* If frequency shift, the following action may works. */ -+ /* Fractional-N table in radio_a.txt */ -+ /* 0x2a 0x00001 channel 1 */ -+ /* 0x2b 0x00808 frequency divider. */ -+ /* 0x2b 0x53333 */ -+ /* 0x2c 0x0000c */ -+ udelay(1); -+ } -+ } -+ } -+ } -+ } else -+ DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __func__, pFileName); -+ -+ return rtStatus; -+} -+ -+static void initDeltaSwingIndexTables( -+ struct adapter *Adapter, -+ char *Band, -+ char *Path, -+ char *Sign, -+ char *Channel, -+ char *Rate, -+ char *Data -+) -+{ -+ #define STR_EQUAL_5G(_band, _path, _sign, _rate, _chnl) \ -+ ((strcmp(Band, _band) == 0) && (strcmp(Path, _path) == 0) && (strcmp(Sign, _sign) == 0) &&\ -+ (strcmp(Rate, _rate) == 0) && (strcmp(Channel, _chnl) == 0)\ -+ ) -+ #define STR_EQUAL_2G(_band, _path, _sign, _rate) \ -+ ((strcmp(Band, _band) == 0) && (strcmp(Path, _path) == 0) && (strcmp(Sign, _sign) == 0) &&\ -+ (strcmp(Rate, _rate) == 0)\ -+ ) -+ -+ #define STORE_SWING_TABLE(_array, _iteratedIdx) \ -+ for (token = strsep(&Data, delim); token != NULL; token = strsep(&Data, delim)) {\ -+ sscanf(token, "%d", &idx);\ -+ _array[_iteratedIdx++] = (u8)idx;\ -+ } \ -+ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ u32 j = 0; -+ char *token; -+ char delim[] = ","; -+ u32 idx = 0; -+ -+ /* DBG_871X("===>initDeltaSwingIndexTables(): Band: %s;\nPath: %s;\nSign: %s;\nChannel: %s;\nRate: %s;\n, Data: %s;\n", */ -+ /* Band, Path, Sign, Channel, Rate, Data); */ -+ -+ if (STR_EQUAL_2G("2G", "A", "+", "CCK")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, j); -+ } else if (STR_EQUAL_2G("2G", "A", "-", "CCK")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, j); -+ } else if (STR_EQUAL_2G("2G", "B", "+", "CCK")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, j); -+ } else if (STR_EQUAL_2G("2G", "B", "-", "CCK")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, j); -+ } else if (STR_EQUAL_2G("2G", "A", "+", "ALL")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, j); -+ } else if (STR_EQUAL_2G("2G", "A", "-", "ALL")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, j); -+ } else if (STR_EQUAL_2G("2G", "B", "+", "ALL")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, j); -+ } else if (STR_EQUAL_2G("2G", "B", "-", "ALL")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, j); -+ } else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "0")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0], j); -+ } else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "0")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0], j); -+ } else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "0")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0], j); -+ } else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "0")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0], j); -+ } else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "1")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1], j); -+ } else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "1")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1], j); -+ } else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "1")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1], j); -+ } else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "1")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1], j); -+ } else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "2")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2], j); -+ } else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "2")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2], j); -+ } else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "2")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2], j); -+ } else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "2")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2], j); -+ } else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "3")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[3], j); -+ } else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "3")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[3], j); -+ } else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "3")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[3], j); -+ } else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "3")) { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[3], j); -+ } else -+ DBG_871X("===>initDeltaSwingIndexTables(): The input is invalid!!\n"); -+} -+ -+int PHY_ConfigRFWithTxPwrTrackParaFile(struct adapter *Adapter, char *pFileName) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 i = 0; -+ -+ if (!(Adapter->registrypriv.load_phy_file & LOAD_RF_TXPWR_TRACK_PARA_FILE)) -+ return rtStatus; -+ -+ memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pHalData->rf_tx_pwr_track_len == 0) && (pHalData->rf_tx_pwr_track == NULL)) { -+ rtw_merge_string(file_path_bs, PATH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(file_path_bs) == true) { -+ rlen = rtw_retrive_from_file(file_path_bs, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) { -+ rtStatus = _SUCCESS; -+ pHalData->rf_tx_pwr_track = vzalloc(rlen); -+ if (pHalData->rf_tx_pwr_track) { -+ memcpy(pHalData->rf_tx_pwr_track, pHalData->para_file_buf, rlen); -+ pHalData->rf_tx_pwr_track_len = rlen; -+ } else -+ DBG_871X("%s rf_tx_pwr_track alloc fail !\n", __func__); -+ } -+ } -+ } else { -+ if ((pHalData->rf_tx_pwr_track_len != 0) && (pHalData->rf_tx_pwr_track != NULL)) { -+ memcpy(pHalData->para_file_buf, pHalData->rf_tx_pwr_track, pHalData->rf_tx_pwr_track_len); -+ rtStatus = _SUCCESS; -+ } else -+ DBG_871X("%s(): Critical Error !!!\n", __func__); -+ } -+ -+ if (rtStatus == _SUCCESS) { -+ /* DBG_871X("%s(): read %s successfully\n", __func__, pFileName); */ -+ -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ if (!IsCommentString(szLine)) { -+ char band[5] = "", path[5] = "", sign[5] = ""; -+ char chnl[5] = "", rate[10] = ""; -+ char data[300] = ""; /* 100 is too small */ -+ -+ if (strlen(szLine) < 10 || szLine[0] != '[') -+ continue; -+ -+ strncpy(band, szLine+1, 2); -+ strncpy(path, szLine+5, 1); -+ strncpy(sign, szLine+8, 1); -+ -+ i = 10; /* szLine+10 */ -+ if (!ParseQualifiedString(szLine, &i, rate, '[', ']')) { -+ /* DBG_871X("Fail to parse rate!\n"); */ -+ } -+ if (!ParseQualifiedString(szLine, &i, chnl, '[', ']')) { -+ /* DBG_871X("Fail to parse channel group!\n"); */ -+ } -+ while (szLine[i] != '{' && i < strlen(szLine)) -+ i++; -+ if (!ParseQualifiedString(szLine, &i, data, '{', '}')) { -+ /* DBG_871X("Fail to parse data!\n"); */ -+ } -+ -+ initDeltaSwingIndexTables(Adapter, band, path, sign, chnl, rate, data); -+ } -+ } -+ } else -+ DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __func__, pFileName); -+ -+ return rtStatus; -+} -+ -+static int phy_ParsePowerLimitTableFile(struct adapter *Adapter, char *buffer) -+{ -+ u32 i = 0, forCnt = 0; -+ u8 loadingStage = 0, limitValue = 0, fraction = 0; -+ char *szLine, *ptmp; -+ int rtStatus = _SUCCESS; -+ char band[10], bandwidth[10], rateSection[10], -+ regulation[TXPWR_LMT_MAX_REGULATION_NUM][10], rfPath[10], colNumBuf[10]; -+ u8 colNum = 0; -+ -+ DBG_871X("===>phy_ParsePowerLimitTableFile()\n"); -+ -+ if (Adapter->registrypriv.RegDecryptCustomFile == 1) -+ phy_DecryptBBPgParaFile(Adapter, buffer); -+ -+ ptmp = buffer; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ /* skip comment */ -+ if (IsCommentString(szLine)) { -+ continue; -+ } -+ -+ if (loadingStage == 0) { -+ for (forCnt = 0; forCnt < TXPWR_LMT_MAX_REGULATION_NUM; ++forCnt) -+ memset((void *) regulation[forCnt], 0, 10); -+ -+ memset((void *) band, 0, 10); -+ memset((void *) bandwidth, 0, 10); -+ memset((void *) rateSection, 0, 10); -+ memset((void *) rfPath, 0, 10); -+ memset((void *) colNumBuf, 0, 10); -+ -+ if (szLine[0] != '#' || szLine[1] != '#') -+ continue; -+ -+ /* skip the space */ -+ i = 2; -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ szLine[--i] = ' '; /* return the space in front of the regulation info */ -+ -+ /* Parse the label of the table */ -+ if (!ParseQualifiedString(szLine, &i, band, ' ', ',')) { -+ DBG_871X("Fail to parse band!\n"); -+ return _FAIL; -+ } -+ if (!ParseQualifiedString(szLine, &i, bandwidth, ' ', ',')) { -+ DBG_871X("Fail to parse bandwidth!\n"); -+ return _FAIL; -+ } -+ if (!ParseQualifiedString(szLine, &i, rfPath, ' ', ',')) { -+ DBG_871X("Fail to parse rf path!\n"); -+ return _FAIL; -+ } -+ if (!ParseQualifiedString(szLine, &i, rateSection, ' ', ',')) { -+ DBG_871X("Fail to parse rate!\n"); -+ return _FAIL; -+ } -+ -+ loadingStage = 1; -+ } else if (loadingStage == 1) { -+ if (szLine[0] != '#' || szLine[1] != '#') -+ continue; -+ -+ /* skip the space */ -+ i = 2; -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ if (!eqNByte((u8 *)(szLine + i), (u8 *)("START"), 5)) { -+ DBG_871X("Lost \"## START\" label\n"); -+ return _FAIL; -+ } -+ -+ loadingStage = 2; -+ } else if (loadingStage == 2) { -+ if (szLine[0] != '#' || szLine[1] != '#') -+ continue; -+ -+ /* skip the space */ -+ i = 2; -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ if (!ParseQualifiedString(szLine, &i, colNumBuf, '#', '#')) { -+ DBG_871X("Fail to parse column number!\n"); -+ return _FAIL; -+ } -+ -+ if (!GetU1ByteIntegerFromStringInDecimal(colNumBuf, &colNum)) -+ return _FAIL; -+ -+ if (colNum > TXPWR_LMT_MAX_REGULATION_NUM) { -+ DBG_871X( -+ "unvalid col number %d (greater than max %d)\n", -+ colNum, TXPWR_LMT_MAX_REGULATION_NUM -+ ); -+ return _FAIL; -+ } -+ -+ for (forCnt = 0; forCnt < colNum; ++forCnt) { -+ u8 regulation_name_cnt = 0; -+ -+ /* skip the space */ -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ while (szLine[i] != ' ' && szLine[i] != '\t' && szLine[i] != '\0') -+ regulation[forCnt][regulation_name_cnt++] = szLine[i++]; -+ /* DBG_871X("regulation %s!\n", regulation[forCnt]); */ -+ -+ if (regulation_name_cnt == 0) { -+ DBG_871X("unvalid number of regulation!\n"); -+ return _FAIL; -+ } -+ } -+ -+ loadingStage = 3; -+ } else if (loadingStage == 3) { -+ char channel[10] = {0}, powerLimit[10] = {0}; -+ u8 cnt = 0; -+ -+ /* the table ends */ -+ if (szLine[0] == '#' && szLine[1] == '#') { -+ i = 2; -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ if (eqNByte((u8 *)(szLine + i), (u8 *)("END"), 3)) { -+ loadingStage = 0; -+ continue; -+ } else { -+ DBG_871X("Wrong format\n"); -+ DBG_871X("<===== phy_ParsePowerLimitTableFile()\n"); -+ return _FAIL; -+ } -+ } -+ -+ if ((szLine[0] != 'c' && szLine[0] != 'C') || -+ (szLine[1] != 'h' && szLine[1] != 'H')) { -+ DBG_871X("Meet wrong channel => power limt pair\n"); -+ continue; -+ } -+ i = 2;/* move to the location behind 'h' */ -+ -+ /* load the channel number */ -+ cnt = 0; -+ while (szLine[i] >= '0' && szLine[i] <= '9') { -+ channel[cnt] = szLine[i]; -+ ++cnt; -+ ++i; -+ } -+ /* DBG_871X("chnl %s!\n", channel); */ -+ -+ for (forCnt = 0; forCnt < colNum; ++forCnt) { -+ /* skip the space between channel number and the power limit value */ -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ /* load the power limit value */ -+ cnt = 0; -+ fraction = 0; -+ memset((void *) powerLimit, 0, 10); -+ while ((szLine[i] >= '0' && szLine[i] <= '9') || szLine[i] == '.') { -+ if (szLine[i] == '.') { -+ if ((szLine[i+1] >= '0' && szLine[i+1] <= '9')) { -+ fraction = szLine[i+1]; -+ i += 2; -+ } else { -+ DBG_871X("Wrong fraction in TXPWR_LMT.txt\n"); -+ return _FAIL; -+ } -+ -+ break; -+ } -+ -+ powerLimit[cnt] = szLine[i]; -+ ++cnt; -+ ++i; -+ } -+ -+ if (powerLimit[0] == '\0') { -+ powerLimit[0] = '6'; -+ powerLimit[1] = '3'; -+ i += 2; -+ } else { -+ if (!GetU1ByteIntegerFromStringInDecimal(powerLimit, &limitValue)) -+ return _FAIL; -+ -+ limitValue *= 2; -+ cnt = 0; -+ if (fraction == '5') -+ ++limitValue; -+ -+ /* the value is greater or equal to 100 */ -+ if (limitValue >= 100) { -+ powerLimit[cnt++] = limitValue/100 + '0'; -+ limitValue %= 100; -+ -+ if (limitValue >= 10) { -+ powerLimit[cnt++] = limitValue/10 + '0'; -+ limitValue %= 10; -+ } else -+ powerLimit[cnt++] = '0'; -+ -+ powerLimit[cnt++] = limitValue + '0'; -+ } else if (limitValue >= 10) { /* the value is greater or equal to 10 */ -+ powerLimit[cnt++] = limitValue/10 + '0'; -+ limitValue %= 10; -+ powerLimit[cnt++] = limitValue + '0'; -+ } -+ /* the value is less than 10 */ -+ else -+ powerLimit[cnt++] = limitValue + '0'; -+ -+ powerLimit[cnt] = '\0'; -+ } -+ -+ /* DBG_871X("ch%s => %s\n", channel, powerLimit); */ -+ -+ /* store the power limit value */ -+ PHY_SetTxPowerLimit(Adapter, (u8 *)regulation[forCnt], (u8 *)band, -+ (u8 *)bandwidth, (u8 *)rateSection, (u8 *)rfPath, (u8 *)channel, (u8 *)powerLimit); -+ -+ } -+ } else { -+ DBG_871X("Abnormal loading stage in phy_ParsePowerLimitTableFile()!\n"); -+ rtStatus = _FAIL; -+ break; -+ } -+ } -+ -+ DBG_871X("<===phy_ParsePowerLimitTableFile()\n"); -+ return rtStatus; -+} -+ -+int PHY_ConfigRFWithPowerLimitTableParaFile( -+ struct adapter *Adapter, char *pFileName -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ -+ if (!(Adapter->registrypriv.load_phy_file & LOAD_RF_TXPWR_LMT_PARA_FILE)) -+ return rtStatus; -+ -+ memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pHalData->rf_tx_pwr_lmt_len == 0) && (pHalData->rf_tx_pwr_lmt == NULL)) { -+ rtw_merge_string(file_path_bs, PATH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(file_path_bs) == true) { -+ rlen = rtw_retrive_from_file(file_path_bs, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) { -+ rtStatus = _SUCCESS; -+ pHalData->rf_tx_pwr_lmt = vzalloc(rlen); -+ if (pHalData->rf_tx_pwr_lmt) { -+ memcpy(pHalData->rf_tx_pwr_lmt, pHalData->para_file_buf, rlen); -+ pHalData->rf_tx_pwr_lmt_len = rlen; -+ } else -+ DBG_871X("%s rf_tx_pwr_lmt alloc fail !\n", __func__); -+ } -+ } -+ } else { -+ if ((pHalData->rf_tx_pwr_lmt_len != 0) && (pHalData->rf_tx_pwr_lmt != NULL)) { -+ memcpy(pHalData->para_file_buf, pHalData->rf_tx_pwr_lmt, pHalData->rf_tx_pwr_lmt_len); -+ rtStatus = _SUCCESS; -+ } else -+ DBG_871X("%s(): Critical Error !!!\n", __func__); -+ } -+ -+ if (rtStatus == _SUCCESS) { -+ /* DBG_871X("%s(): read %s ok\n", __func__, pFileName); */ -+ rtStatus = phy_ParsePowerLimitTableFile(Adapter, pHalData->para_file_buf); -+ } else -+ DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __func__, pFileName); -+ -+ return rtStatus; -+} -+ -+void phy_free_filebuf(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+ if (pHalData->mac_reg) -+ vfree(pHalData->mac_reg); -+ if (pHalData->bb_phy_reg) -+ vfree(pHalData->bb_phy_reg); -+ if (pHalData->bb_agc_tab) -+ vfree(pHalData->bb_agc_tab); -+ if (pHalData->bb_phy_reg_pg) -+ vfree(pHalData->bb_phy_reg_pg); -+ if (pHalData->bb_phy_reg_mp) -+ vfree(pHalData->bb_phy_reg_mp); -+ if (pHalData->rf_radio_a) -+ vfree(pHalData->rf_radio_a); -+ if (pHalData->rf_radio_b) -+ vfree(pHalData->rf_radio_b); -+ if (pHalData->rf_tx_pwr_track) -+ vfree(pHalData->rf_tx_pwr_track); -+ if (pHalData->rf_tx_pwr_lmt) -+ vfree(pHalData->rf_tx_pwr_lmt); -+ -+} -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalHWImg8723B_BB.c linux/3rdparty/rtl8723bs/hal/HalHWImg8723B_BB.c ---- linux.old/3rdparty/rtl8723bs/hal/HalHWImg8723B_BB.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalHWImg8723B_BB.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,643 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+ -+#include "odm_precomp.h" -+ -+static bool CheckPositive( -+ PDM_ODM_T pDM_Odm, const u32 Condition1, const u32 Condition2 -+) -+{ -+ u8 _BoardType = -+ ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA */ -+ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA */ -+ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA */ -+ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ -+ ((pDM_Odm->BoardType & BIT2) >> 2) << 4; /* _BT */ -+ -+ u32 cond1 = Condition1, cond2 = Condition2; -+ u32 driver1 = -+ pDM_Odm->CutVersion << 24 | -+ pDM_Odm->SupportPlatform << 16 | -+ pDM_Odm->PackageType << 12 | -+ pDM_Odm->SupportInterface << 8 | -+ _BoardType; -+ -+ u32 driver2 = -+ pDM_Odm->TypeGLNA << 0 | -+ pDM_Odm->TypeGPA << 8 | -+ pDM_Odm->TypeALNA << 16 | -+ pDM_Odm->TypeAPA << 24; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ "===> [8812A] CheckPositive (cond1, cond2) = (0x%X 0x%X)\n", -+ cond1, -+ cond2 -+ ) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ "===> [8812A] CheckPositive (driver1, driver2) = (0x%X 0x%X)\n", -+ driver1, -+ driver2 -+ ) -+ ); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ (" (Platform, Interface) = (0x%X, 0x%X)\n", -+ pDM_Odm->SupportPlatform, -+ pDM_Odm->SupportInterface -+ ) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ " (Board, Package) = (0x%X, 0x%X)\n", -+ pDM_Odm->BoardType, -+ pDM_Odm->PackageType -+ ) -+ ); -+ -+ -+ /* Value Defined Check =============== */ -+ /* QFN Type [15:12] and Cut Version [27:24] need to do value check */ -+ -+ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return false; -+ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return false; -+ -+ /* Bit Defined Check ================ */ -+ /* We don't care [31:28] and [23:20] */ -+ /* */ -+ cond1 &= 0x000F0FFF; -+ driver1 &= 0x000F0FFF; -+ -+ if ((cond1 & driver1) == cond1) { -+ u32 bitMask = 0; -+ -+ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE */ -+ return true; -+ -+ if ((cond1 & BIT0) != 0) /* GLNA */ -+ bitMask |= 0x000000FF; -+ if ((cond1 & BIT1) != 0) /* GPA */ -+ bitMask |= 0x0000FF00; -+ if ((cond1 & BIT2) != 0) /* ALNA */ -+ bitMask |= 0x00FF0000; -+ if ((cond1 & BIT3) != 0) /* APA */ -+ bitMask |= 0xFF000000; -+ -+ /* BoardType of each RF path is matched */ -+ if ((cond2 & bitMask) == (driver2 & bitMask)) -+ return true; -+ } -+ return false; -+} -+ -+static bool CheckNegative( -+ PDM_ODM_T pDM_Odm, const u32 Condition1, const u32 Condition2 -+) -+{ -+ return true; -+} -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+static u32 Array_MP_8723B_AGC_TAB[] = { -+ 0xC78, 0xFD000001, -+ 0xC78, 0xFC010001, -+ 0xC78, 0xFB020001, -+ 0xC78, 0xFA030001, -+ 0xC78, 0xF9040001, -+ 0xC78, 0xF8050001, -+ 0xC78, 0xF7060001, -+ 0xC78, 0xF6070001, -+ 0xC78, 0xF5080001, -+ 0xC78, 0xF4090001, -+ 0xC78, 0xF30A0001, -+ 0xC78, 0xF20B0001, -+ 0xC78, 0xF10C0001, -+ 0xC78, 0xF00D0001, -+ 0xC78, 0xEF0E0001, -+ 0xC78, 0xEE0F0001, -+ 0xC78, 0xED100001, -+ 0xC78, 0xEC110001, -+ 0xC78, 0xEB120001, -+ 0xC78, 0xEA130001, -+ 0xC78, 0xE9140001, -+ 0xC78, 0xE8150001, -+ 0xC78, 0xE7160001, -+ 0xC78, 0xE6170001, -+ 0xC78, 0xE5180001, -+ 0xC78, 0xE4190001, -+ 0xC78, 0xE31A0001, -+ 0xC78, 0xA51B0001, -+ 0xC78, 0xA41C0001, -+ 0xC78, 0xA31D0001, -+ 0xC78, 0x671E0001, -+ 0xC78, 0x661F0001, -+ 0xC78, 0x65200001, -+ 0xC78, 0x64210001, -+ 0xC78, 0x63220001, -+ 0xC78, 0x4A230001, -+ 0xC78, 0x49240001, -+ 0xC78, 0x48250001, -+ 0xC78, 0x47260001, -+ 0xC78, 0x46270001, -+ 0xC78, 0x45280001, -+ 0xC78, 0x44290001, -+ 0xC78, 0x432A0001, -+ 0xC78, 0x422B0001, -+ 0xC78, 0x292C0001, -+ 0xC78, 0x282D0001, -+ 0xC78, 0x272E0001, -+ 0xC78, 0x262F0001, -+ 0xC78, 0x0A300001, -+ 0xC78, 0x09310001, -+ 0xC78, 0x08320001, -+ 0xC78, 0x07330001, -+ 0xC78, 0x06340001, -+ 0xC78, 0x05350001, -+ 0xC78, 0x04360001, -+ 0xC78, 0x03370001, -+ 0xC78, 0x02380001, -+ 0xC78, 0x01390001, -+ 0xC78, 0x013A0001, -+ 0xC78, 0x013B0001, -+ 0xC78, 0x013C0001, -+ 0xC78, 0x013D0001, -+ 0xC78, 0x013E0001, -+ 0xC78, 0x013F0001, -+ 0xC78, 0xFC400001, -+ 0xC78, 0xFB410001, -+ 0xC78, 0xFA420001, -+ 0xC78, 0xF9430001, -+ 0xC78, 0xF8440001, -+ 0xC78, 0xF7450001, -+ 0xC78, 0xF6460001, -+ 0xC78, 0xF5470001, -+ 0xC78, 0xF4480001, -+ 0xC78, 0xF3490001, -+ 0xC78, 0xF24A0001, -+ 0xC78, 0xF14B0001, -+ 0xC78, 0xF04C0001, -+ 0xC78, 0xEF4D0001, -+ 0xC78, 0xEE4E0001, -+ 0xC78, 0xED4F0001, -+ 0xC78, 0xEC500001, -+ 0xC78, 0xEB510001, -+ 0xC78, 0xEA520001, -+ 0xC78, 0xE9530001, -+ 0xC78, 0xE8540001, -+ 0xC78, 0xE7550001, -+ 0xC78, 0xE6560001, -+ 0xC78, 0xE5570001, -+ 0xC78, 0xE4580001, -+ 0xC78, 0xE3590001, -+ 0xC78, 0xA65A0001, -+ 0xC78, 0xA55B0001, -+ 0xC78, 0xA45C0001, -+ 0xC78, 0xA35D0001, -+ 0xC78, 0x675E0001, -+ 0xC78, 0x665F0001, -+ 0xC78, 0x65600001, -+ 0xC78, 0x64610001, -+ 0xC78, 0x63620001, -+ 0xC78, 0x62630001, -+ 0xC78, 0x61640001, -+ 0xC78, 0x48650001, -+ 0xC78, 0x47660001, -+ 0xC78, 0x46670001, -+ 0xC78, 0x45680001, -+ 0xC78, 0x44690001, -+ 0xC78, 0x436A0001, -+ 0xC78, 0x426B0001, -+ 0xC78, 0x286C0001, -+ 0xC78, 0x276D0001, -+ 0xC78, 0x266E0001, -+ 0xC78, 0x256F0001, -+ 0xC78, 0x24700001, -+ 0xC78, 0x09710001, -+ 0xC78, 0x08720001, -+ 0xC78, 0x07730001, -+ 0xC78, 0x06740001, -+ 0xC78, 0x05750001, -+ 0xC78, 0x04760001, -+ 0xC78, 0x03770001, -+ 0xC78, 0x02780001, -+ 0xC78, 0x01790001, -+ 0xC78, 0x017A0001, -+ 0xC78, 0x017B0001, -+ 0xC78, 0x017C0001, -+ 0xC78, 0x017D0001, -+ 0xC78, 0x017E0001, -+ 0xC78, 0x017F0001, -+ 0xC50, 0x69553422, -+ 0xC50, 0x69553420, -+ 0x824, 0x00390204, -+ -+}; -+ -+void ODM_ReadAndConfig_MP_8723B_AGC_TAB(PDM_ODM_T pDM_Odm) -+{ -+ u32 i = 0; -+ u32 ArrayLen = sizeof(Array_MP_8723B_AGC_TAB)/sizeof(u32); -+ u32 *Array = Array_MP_8723B_AGC_TAB; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_LOUD, -+ ("===> ODM_ReadAndConfig_MP_8723B_AGC_TAB\n") -+ ); -+ -+ for (i = 0; i < ArrayLen; i += 2) { -+ u32 v1 = Array[i]; -+ u32 v2 = Array[i+1]; -+ -+ /* This (offset, data) pair doesn't care the condition. */ -+ if (v1 < 0x40000000) { -+ odm_ConfigBB_AGC_8723B(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } else { -+ /* This line is the beginning of branch. */ -+ bool bMatched = true; -+ u8 cCond = (u8)((v1 & (BIT29|BIT28)) >> 28); -+ -+ if (cCond == COND_ELSE) { /* ELSE, ENDIF */ -+ bMatched = true; -+ READ_NEXT_PAIR(v1, v2, i); -+ } else if (!CheckPositive(pDM_Odm, v1, v2)) { -+ bMatched = false; -+ READ_NEXT_PAIR(v1, v2, i); -+ READ_NEXT_PAIR(v1, v2, i); -+ } else { -+ READ_NEXT_PAIR(v1, v2, i); -+ if (!CheckNegative(pDM_Odm, v1, v2)) -+ bMatched = false; -+ else -+ bMatched = true; -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ if (bMatched == false) { -+ /* Condition isn't matched. -+ * Discard the following (offset, data) pairs. -+ */ -+ while (v1 < 0x40000000 && i < ArrayLen-2) -+ READ_NEXT_PAIR(v1, v2, i); -+ -+ i -= 2; /* prevent from for-loop += 2 */ -+ } else { -+ /* Configure matched pairs and skip to end of if-else. */ -+ while (v1 < 0x40000000 && i < ArrayLen-2) { -+ odm_ConfigBB_AGC_8723B(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ /* Keeps reading until ENDIF. */ -+ cCond = (u8)((v1 & (BIT29|BIT28)) >> 28); -+ while (cCond != COND_ENDIF && i < ArrayLen-2) { -+ READ_NEXT_PAIR(v1, v2, i); -+ cCond = (u8)((v1 & (BIT29|BIT28)) >> 28); -+ } -+ } -+ } -+ } -+} -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+static u32 Array_MP_8723B_PHY_REG[] = { -+ 0x800, 0x80040000, -+ 0x804, 0x00000003, -+ 0x808, 0x0000FC00, -+ 0x80C, 0x0000000A, -+ 0x810, 0x10001331, -+ 0x814, 0x020C3D10, -+ 0x818, 0x02200385, -+ 0x81C, 0x00000000, -+ 0x820, 0x01000100, -+ 0x824, 0x00190204, -+ 0x828, 0x00000000, -+ 0x82C, 0x00000000, -+ 0x830, 0x00000000, -+ 0x834, 0x00000000, -+ 0x838, 0x00000000, -+ 0x83C, 0x00000000, -+ 0x840, 0x00010000, -+ 0x844, 0x00000000, -+ 0x848, 0x00000000, -+ 0x84C, 0x00000000, -+ 0x850, 0x00000000, -+ 0x854, 0x00000000, -+ 0x858, 0x569A11A9, -+ 0x85C, 0x01000014, -+ 0x860, 0x66F60110, -+ 0x864, 0x061F0649, -+ 0x868, 0x00000000, -+ 0x86C, 0x27272700, -+ 0x870, 0x07000760, -+ 0x874, 0x25004000, -+ 0x878, 0x00000808, -+ 0x87C, 0x00000000, -+ 0x880, 0xB0000C1C, -+ 0x884, 0x00000001, -+ 0x888, 0x00000000, -+ 0x88C, 0xCCC000C0, -+ 0x890, 0x00000800, -+ 0x894, 0xFFFFFFFE, -+ 0x898, 0x40302010, -+ 0x89C, 0x00706050, -+ 0x900, 0x00000000, -+ 0x904, 0x00000023, -+ 0x908, 0x00000000, -+ 0x90C, 0x81121111, -+ 0x910, 0x00000002, -+ 0x914, 0x00000201, -+ 0xA00, 0x00D047C8, -+ 0xA04, 0x80FF800C, -+ 0xA08, 0x8C838300, -+ 0xA0C, 0x2E7F120F, -+ 0xA10, 0x9500BB78, -+ 0xA14, 0x1114D028, -+ 0xA18, 0x00881117, -+ 0xA1C, 0x89140F00, -+ 0xA20, 0x1A1B0000, -+ 0xA24, 0x090E1317, -+ 0xA28, 0x00000204, -+ 0xA2C, 0x00D30000, -+ 0xA70, 0x101FBF00, -+ 0xA74, 0x00000007, -+ 0xA78, 0x00000900, -+ 0xA7C, 0x225B0606, -+ 0xA80, 0x21806490, -+ 0xB2C, 0x00000000, -+ 0xC00, 0x48071D40, -+ 0xC04, 0x03A05611, -+ 0xC08, 0x000000E4, -+ 0xC0C, 0x6C6C6C6C, -+ 0xC10, 0x08800000, -+ 0xC14, 0x40000100, -+ 0xC18, 0x08800000, -+ 0xC1C, 0x40000100, -+ 0xC20, 0x00000000, -+ 0xC24, 0x00000000, -+ 0xC28, 0x00000000, -+ 0xC2C, 0x00000000, -+ 0xC30, 0x69E9AC44, -+ 0xC34, 0x469652AF, -+ 0xC38, 0x49795994, -+ 0xC3C, 0x0A97971C, -+ 0xC40, 0x1F7C403F, -+ 0xC44, 0x000100B7, -+ 0xC48, 0xEC020107, -+ 0xC4C, 0x007F037F, -+ 0xC50, 0x69553420, -+ 0xC54, 0x43BC0094, -+ 0xC58, 0x00013149, -+ 0xC5C, 0x00250492, -+ 0xC60, 0x00000000, -+ 0xC64, 0x7112848B, -+ 0xC68, 0x47C00BFF, -+ 0xC6C, 0x00000036, -+ 0xC70, 0x2C7F000D, -+ 0xC74, 0x020610DB, -+ 0xC78, 0x0000001F, -+ 0xC7C, 0x00B91612, -+ 0xC80, 0x390000E4, -+ 0xC84, 0x20F60000, -+ 0xC88, 0x40000100, -+ 0xC8C, 0x20200000, -+ 0xC90, 0x00020E1A, -+ 0xC94, 0x00000000, -+ 0xC98, 0x00020E1A, -+ 0xC9C, 0x00007F7F, -+ 0xCA0, 0x00000000, -+ 0xCA4, 0x000300A0, -+ 0xCA8, 0x00000000, -+ 0xCAC, 0x00000000, -+ 0xCB0, 0x00000000, -+ 0xCB4, 0x00000000, -+ 0xCB8, 0x00000000, -+ 0xCBC, 0x28000000, -+ 0xCC0, 0x00000000, -+ 0xCC4, 0x00000000, -+ 0xCC8, 0x00000000, -+ 0xCCC, 0x00000000, -+ 0xCD0, 0x00000000, -+ 0xCD4, 0x00000000, -+ 0xCD8, 0x64B22427, -+ 0xCDC, 0x00766932, -+ 0xCE0, 0x00222222, -+ 0xCE4, 0x00000000, -+ 0xCE8, 0x37644302, -+ 0xCEC, 0x2F97D40C, -+ 0xD00, 0x00000740, -+ 0xD04, 0x40020401, -+ 0xD08, 0x0000907F, -+ 0xD0C, 0x20010201, -+ 0xD10, 0xA0633333, -+ 0xD14, 0x3333BC53, -+ 0xD18, 0x7A8F5B6F, -+ 0xD2C, 0xCC979975, -+ 0xD30, 0x00000000, -+ 0xD34, 0x80608000, -+ 0xD38, 0x00000000, -+ 0xD3C, 0x00127353, -+ 0xD40, 0x00000000, -+ 0xD44, 0x00000000, -+ 0xD48, 0x00000000, -+ 0xD4C, 0x00000000, -+ 0xD50, 0x6437140A, -+ 0xD54, 0x00000000, -+ 0xD58, 0x00000282, -+ 0xD5C, 0x30032064, -+ 0xD60, 0x4653DE68, -+ 0xD64, 0x04518A3C, -+ 0xD68, 0x00002101, -+ 0xD6C, 0x2A201C16, -+ 0xD70, 0x1812362E, -+ 0xD74, 0x322C2220, -+ 0xD78, 0x000E3C24, -+ 0xE00, 0x2D2D2D2D, -+ 0xE04, 0x2D2D2D2D, -+ 0xE08, 0x0390272D, -+ 0xE10, 0x2D2D2D2D, -+ 0xE14, 0x2D2D2D2D, -+ 0xE18, 0x2D2D2D2D, -+ 0xE1C, 0x2D2D2D2D, -+ 0xE28, 0x00000000, -+ 0xE30, 0x1000DC1F, -+ 0xE34, 0x10008C1F, -+ 0xE38, 0x02140102, -+ 0xE3C, 0x681604C2, -+ 0xE40, 0x01007C00, -+ 0xE44, 0x01004800, -+ 0xE48, 0xFB000000, -+ 0xE4C, 0x000028D1, -+ 0xE50, 0x1000DC1F, -+ 0xE54, 0x10008C1F, -+ 0xE58, 0x02140102, -+ 0xE5C, 0x28160D05, -+ 0xE60, 0x00000008, -+ 0xE68, 0x001B2556, -+ 0xE6C, 0x00C00096, -+ 0xE70, 0x00C00096, -+ 0xE74, 0x01000056, -+ 0xE78, 0x01000014, -+ 0xE7C, 0x01000056, -+ 0xE80, 0x01000014, -+ 0xE84, 0x00C00096, -+ 0xE88, 0x01000056, -+ 0xE8C, 0x00C00096, -+ 0xED0, 0x00C00096, -+ 0xED4, 0x00C00096, -+ 0xED8, 0x00C00096, -+ 0xEDC, 0x000000D6, -+ 0xEE0, 0x000000D6, -+ 0xEEC, 0x01C00016, -+ 0xF14, 0x00000003, -+ 0xF4C, 0x00000000, -+ 0xF00, 0x00000300, -+ 0x820, 0x01000100, -+ 0x800, 0x83040000, -+ -+}; -+ -+void ODM_ReadAndConfig_MP_8723B_PHY_REG(PDM_ODM_T pDM_Odm) -+{ -+ u32 i = 0; -+ u32 ArrayLen = sizeof(Array_MP_8723B_PHY_REG)/sizeof(u32); -+ u32 *Array = Array_MP_8723B_PHY_REG; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_LOUD, -+ ("===> ODM_ReadAndConfig_MP_8723B_PHY_REG\n") -+ ); -+ -+ for (i = 0; i < ArrayLen; i += 2) { -+ u32 v1 = Array[i]; -+ u32 v2 = Array[i+1]; -+ -+ /* This (offset, data) pair doesn't care the condition. */ -+ if (v1 < 0x40000000) { -+ odm_ConfigBB_PHY_8723B(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } else { -+ /* This line is the beginning of branch. */ -+ bool bMatched = true; -+ u8 cCond = (u8)((v1 & (BIT29|BIT28)) >> 28); -+ -+ if (cCond == COND_ELSE) { /* ELSE, ENDIF */ -+ bMatched = true; -+ READ_NEXT_PAIR(v1, v2, i); -+ } else if (!CheckPositive(pDM_Odm, v1, v2)) { -+ bMatched = false; -+ READ_NEXT_PAIR(v1, v2, i); -+ READ_NEXT_PAIR(v1, v2, i); -+ } else { -+ READ_NEXT_PAIR(v1, v2, i); -+ if (!CheckNegative(pDM_Odm, v1, v2)) -+ bMatched = false; -+ else -+ bMatched = true; -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ if (bMatched == false) { -+ /* Condition isn't matched. -+ * Discard the following (offset, data) pairs. -+ */ -+ while (v1 < 0x40000000 && i < ArrayLen-2) -+ READ_NEXT_PAIR(v1, v2, i); -+ -+ i -= 2; /* prevent from for-loop += 2 */ -+ } else { /* Configure matched pairs and skip to end of if-else. */ -+ while (v1 < 0x40000000 && i < ArrayLen-2) { -+ odm_ConfigBB_PHY_8723B(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ /* Keeps reading until ENDIF. */ -+ cCond = (u8)((v1 & (BIT29|BIT28)) >> 28); -+ while (cCond != COND_ENDIF && i < ArrayLen-2) { -+ READ_NEXT_PAIR(v1, v2, i); -+ cCond = (u8)((v1 & (BIT29|BIT28)) >> 28); -+ } -+ } -+ } -+ } -+} -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+static u32 Array_MP_8723B_PHY_REG_PG[] = { -+ 0, 0, 0, 0x00000e08, 0x0000ff00, 0x00003800, -+ 0, 0, 0, 0x0000086c, 0xffffff00, 0x32343600, -+ 0, 0, 0, 0x00000e00, 0xffffffff, 0x40424444, -+ 0, 0, 0, 0x00000e04, 0xffffffff, 0x28323638, -+ 0, 0, 0, 0x00000e10, 0xffffffff, 0x38404244, -+ 0, 0, 0, 0x00000e14, 0xffffffff, 0x26303436 -+}; -+ -+void ODM_ReadAndConfig_MP_8723B_PHY_REG_PG(PDM_ODM_T pDM_Odm) -+{ -+ u32 i = 0; -+ u32 ArrayLen = sizeof(Array_MP_8723B_PHY_REG_PG)/sizeof(u32); -+ u32 *Array = Array_MP_8723B_PHY_REG_PG; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_LOUD, -+ ("===> ODM_ReadAndConfig_MP_8723B_PHY_REG_PG\n") -+ ); -+ -+ pDM_Odm->PhyRegPgVersion = 1; -+ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; -+ -+ for (i = 0; i < ArrayLen; i += 6) { -+ u32 v1 = Array[i]; -+ u32 v2 = Array[i+1]; -+ u32 v3 = Array[i+2]; -+ u32 v4 = Array[i+3]; -+ u32 v5 = Array[i+4]; -+ u32 v6 = Array[i+5]; -+ -+ odm_ConfigBB_PHY_REG_PG_8723B(pDM_Odm, v1, v2, v3, v4, v5, v6); -+ } -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalHWImg8723B_BB.h linux/3rdparty/rtl8723bs/hal/HalHWImg8723B_BB.h ---- linux.old/3rdparty/rtl8723bs/hal/HalHWImg8723B_BB.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalHWImg8723B_BB.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_MP_BB_HW_IMG_8723B_H -+#define __INC_MP_BB_HW_IMG_8723B_H -+ -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723B_AGC_TAB(/* TC: Test Chip, MP: MP Chip */ -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723B_PHY_REG(/* TC: Test Chip, MP: MP Chip */ -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723B_PHY_REG_PG(/* TC: Test Chip, MP: MP Chip */ -+ PDM_ODM_T pDM_Odm -+); -+u32 ODM_GetVersion_MP_8723B_PHY_REG_PG(void); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalHWImg8723B_MAC.c linux/3rdparty/rtl8723bs/hal/HalHWImg8723B_MAC.c ---- linux.old/3rdparty/rtl8723bs/hal/HalHWImg8723B_MAC.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalHWImg8723B_MAC.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,302 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+ -+#include "odm_precomp.h" -+ -+static bool CheckPositive( -+ PDM_ODM_T pDM_Odm, const u32 Condition1, const u32 Condition2 -+) -+{ -+ u8 _BoardType = -+ ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA */ -+ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA */ -+ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA */ -+ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ -+ ((pDM_Odm->BoardType & BIT2) >> 2) << 4; /* _BT */ -+ -+ u32 cond1 = Condition1, cond2 = Condition2; -+ u32 driver1 = -+ pDM_Odm->CutVersion << 24 | -+ pDM_Odm->SupportPlatform << 16 | -+ pDM_Odm->PackageType << 12 | -+ pDM_Odm->SupportInterface << 8 | -+ _BoardType; -+ -+ u32 driver2 = -+ pDM_Odm->TypeGLNA << 0 | -+ pDM_Odm->TypeGPA << 8 | -+ pDM_Odm->TypeALNA << 16 | -+ pDM_Odm->TypeAPA << 24; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ "===> [8812A] CheckPositive (cond1, cond2) = (0x%X 0x%X)\n", -+ cond1, -+ cond2 -+ ) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ "===> [8812A] CheckPositive (driver1, driver2) = (0x%X 0x%X)\n", -+ driver1, -+ driver2 -+ ) -+ ); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ " (Platform, Interface) = (0x%X, 0x%X)\n", -+ pDM_Odm->SupportPlatform, -+ pDM_Odm->SupportInterface -+ ) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ " (Board, Package) = (0x%X, 0x%X)\n", -+ pDM_Odm->BoardType, -+ pDM_Odm->PackageType -+ ) -+ ); -+ -+ -+ /* Value Defined Check =============== */ -+ /* QFN Type [15:12] and Cut Version [27:24] need to do value check */ -+ -+ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return false; -+ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return false; -+ -+ /* Bit Defined Check ================ */ -+ /* We don't care [31:28] and [23:20] */ -+ /* */ -+ cond1 &= 0x000F0FFF; -+ driver1 &= 0x000F0FFF; -+ -+ if ((cond1 & driver1) == cond1) { -+ u32 bitMask = 0; -+ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE */ -+ return true; -+ -+ if ((cond1 & BIT0) != 0) /* GLNA */ -+ bitMask |= 0x000000FF; -+ if ((cond1 & BIT1) != 0) /* GPA */ -+ bitMask |= 0x0000FF00; -+ if ((cond1 & BIT2) != 0) /* ALNA */ -+ bitMask |= 0x00FF0000; -+ if ((cond1 & BIT3) != 0) /* APA */ -+ bitMask |= 0xFF000000; -+ -+ if ((cond2 & bitMask) == (driver2 & bitMask)) /* BoardType of each RF path is matched */ -+ return true; -+ } -+ return false; -+} -+ -+static bool CheckNegative( -+ PDM_ODM_T pDM_Odm, const u32 Condition1, const u32 Condition2 -+) -+{ -+ return true; -+} -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+static u32 Array_MP_8723B_MAC_REG[] = { -+ 0x02F, 0x00000030, -+ 0x035, 0x00000000, -+ 0x039, 0x00000008, -+ 0x04E, 0x000000E0, -+ 0x064, 0x00000000, -+ 0x067, 0x00000020, -+ 0x428, 0x0000000A, -+ 0x429, 0x00000010, -+ 0x430, 0x00000000, -+ 0x431, 0x00000000, -+ 0x432, 0x00000000, -+ 0x433, 0x00000001, -+ 0x434, 0x00000004, -+ 0x435, 0x00000005, -+ 0x436, 0x00000007, -+ 0x437, 0x00000008, -+ 0x43C, 0x00000004, -+ 0x43D, 0x00000005, -+ 0x43E, 0x00000007, -+ 0x43F, 0x00000008, -+ 0x440, 0x0000005D, -+ 0x441, 0x00000001, -+ 0x442, 0x00000000, -+ 0x444, 0x00000010, -+ 0x445, 0x00000000, -+ 0x446, 0x00000000, -+ 0x447, 0x00000000, -+ 0x448, 0x00000000, -+ 0x449, 0x000000F0, -+ 0x44A, 0x0000000F, -+ 0x44B, 0x0000003E, -+ 0x44C, 0x00000010, -+ 0x44D, 0x00000000, -+ 0x44E, 0x00000000, -+ 0x44F, 0x00000000, -+ 0x450, 0x00000000, -+ 0x451, 0x000000F0, -+ 0x452, 0x0000000F, -+ 0x453, 0x00000000, -+ 0x456, 0x0000005E, -+ 0x460, 0x00000066, -+ 0x461, 0x00000066, -+ 0x4C8, 0x000000FF, -+ 0x4C9, 0x00000008, -+ 0x4CC, 0x000000FF, -+ 0x4CD, 0x000000FF, -+ 0x4CE, 0x00000001, -+ 0x500, 0x00000026, -+ 0x501, 0x000000A2, -+ 0x502, 0x0000002F, -+ 0x503, 0x00000000, -+ 0x504, 0x00000028, -+ 0x505, 0x000000A3, -+ 0x506, 0x0000005E, -+ 0x507, 0x00000000, -+ 0x508, 0x0000002B, -+ 0x509, 0x000000A4, -+ 0x50A, 0x0000005E, -+ 0x50B, 0x00000000, -+ 0x50C, 0x0000004F, -+ 0x50D, 0x000000A4, -+ 0x50E, 0x00000000, -+ 0x50F, 0x00000000, -+ 0x512, 0x0000001C, -+ 0x514, 0x0000000A, -+ 0x516, 0x0000000A, -+ 0x525, 0x0000004F, -+ 0x550, 0x00000010, -+ 0x551, 0x00000010, -+ 0x559, 0x00000002, -+ 0x55C, 0x00000050, -+ 0x55D, 0x000000FF, -+ 0x605, 0x00000030, -+ 0x608, 0x0000000E, -+ 0x609, 0x0000002A, -+ 0x620, 0x000000FF, -+ 0x621, 0x000000FF, -+ 0x622, 0x000000FF, -+ 0x623, 0x000000FF, -+ 0x624, 0x000000FF, -+ 0x625, 0x000000FF, -+ 0x626, 0x000000FF, -+ 0x627, 0x000000FF, -+ 0x638, 0x00000050, -+ 0x63C, 0x0000000A, -+ 0x63D, 0x0000000A, -+ 0x63E, 0x0000000E, -+ 0x63F, 0x0000000E, -+ 0x640, 0x00000040, -+ 0x642, 0x00000040, -+ 0x643, 0x00000000, -+ 0x652, 0x000000C8, -+ 0x66E, 0x00000005, -+ 0x700, 0x00000021, -+ 0x701, 0x00000043, -+ 0x702, 0x00000065, -+ 0x703, 0x00000087, -+ 0x708, 0x00000021, -+ 0x709, 0x00000043, -+ 0x70A, 0x00000065, -+ 0x70B, 0x00000087, -+ 0x765, 0x00000018, -+ 0x76E, 0x00000004, -+ -+}; -+ -+void ODM_ReadAndConfig_MP_8723B_MAC_REG(PDM_ODM_T pDM_Odm) -+{ -+ u32 i = 0; -+ u32 ArrayLen = sizeof(Array_MP_8723B_MAC_REG)/sizeof(u32); -+ u32 *Array = Array_MP_8723B_MAC_REG; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_LOUD, -+ ("===> ODM_ReadAndConfig_MP_8723B_MAC_REG\n") -+ ); -+ -+ for (i = 0; i < ArrayLen; i += 2) { -+ u32 v1 = Array[i]; -+ u32 v2 = Array[i+1]; -+ -+ /* This (offset, data) pair doesn't care the condition. */ -+ if (v1 < 0x40000000) { -+ odm_ConfigMAC_8723B(pDM_Odm, v1, (u8)v2); -+ continue; -+ } else { -+ /* This line is the beginning of branch. */ -+ bool bMatched = true; -+ u8 cCond = (u8)((v1 & (BIT29|BIT28)) >> 28); -+ -+ if (cCond == COND_ELSE) { /* ELSE, ENDIF */ -+ bMatched = true; -+ READ_NEXT_PAIR(v1, v2, i); -+ } else if (!CheckPositive(pDM_Odm, v1, v2)) { -+ bMatched = false; -+ READ_NEXT_PAIR(v1, v2, i); -+ READ_NEXT_PAIR(v1, v2, i); -+ } else { -+ READ_NEXT_PAIR(v1, v2, i); -+ if (!CheckNegative(pDM_Odm, v1, v2)) -+ bMatched = false; -+ else -+ bMatched = true; -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ if (bMatched == false) { -+ /* Condition isn't matched. Discard the following (offset, data) pairs. */ -+ while (v1 < 0x40000000 && i < ArrayLen-2) -+ READ_NEXT_PAIR(v1, v2, i); -+ -+ i -= 2; /* prevent from for-loop += 2 */ -+ } else { /* Configure matched pairs and skip to end of if-else. */ -+ while (v1 < 0x40000000 && i < ArrayLen-2) { -+ odm_ConfigMAC_8723B(pDM_Odm, v1, (u8)v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ /* Keeps reading until ENDIF. */ -+ cCond = (u8)((v1 & (BIT29|BIT28)) >> 28); -+ while (cCond != COND_ENDIF && i < ArrayLen-2) { -+ READ_NEXT_PAIR(v1, v2, i); -+ cCond = (u8)((v1 & (BIT29|BIT28)) >> 28); -+ } -+ } -+ } -+ } -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalHWImg8723B_MAC.h linux/3rdparty/rtl8723bs/hal/HalHWImg8723B_MAC.h ---- linux.old/3rdparty/rtl8723bs/hal/HalHWImg8723B_MAC.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalHWImg8723B_MAC.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_MP_MAC_HW_IMG_8723B_H -+#define __INC_MP_MAC_HW_IMG_8723B_H -+ -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723B_MAC_REG(/* TC: Test Chip, MP: MP Chip */ -+ PDM_ODM_T pDM_Odm -+); -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalHWImg8723B_RF.c linux/3rdparty/rtl8723bs/hal/HalHWImg8723B_RF.c ---- linux.old/3rdparty/rtl8723bs/hal/HalHWImg8723B_RF.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalHWImg8723B_RF.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,799 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+ -+#include "odm_precomp.h" -+ -+static bool CheckPositive( -+ PDM_ODM_T pDM_Odm, const u32 Condition1, const u32 Condition2 -+) -+{ -+ u8 _BoardType = -+ ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA */ -+ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA */ -+ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA */ -+ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ -+ ((pDM_Odm->BoardType & BIT2) >> 2) << 4; /* _BT */ -+ -+ u32 cond1 = Condition1, cond2 = Condition2; -+ u32 driver1 = -+ pDM_Odm->CutVersion << 24 | -+ pDM_Odm->SupportPlatform << 16 | -+ pDM_Odm->PackageType << 12 | -+ pDM_Odm->SupportInterface << 8 | -+ _BoardType; -+ -+ u32 driver2 = -+ pDM_Odm->TypeGLNA << 0 | -+ pDM_Odm->TypeGPA << 8 | -+ pDM_Odm->TypeALNA << 16 | -+ pDM_Odm->TypeAPA << 24; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ "===> [8812A] CheckPositive (cond1, cond2) = (0x%X 0x%X)\n", -+ cond1, -+ cond2 -+ ) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ "===> [8812A] CheckPositive (driver1, driver2) = (0x%X 0x%X)\n", -+ driver1, -+ driver2 -+ ) -+ ); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ " (Platform, Interface) = (0x%X, 0x%X)\n", -+ pDM_Odm->SupportPlatform, -+ pDM_Odm->SupportInterface -+ ) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ " (Board, Package) = (0x%X, 0x%X)\n", -+ pDM_Odm->BoardType, -+ pDM_Odm->PackageType -+ ) -+ ); -+ -+ /* Value Defined Check =============== */ -+ /* QFN Type [15:12] and Cut Version [27:24] need to do value check */ -+ -+ if ( -+ ((cond1 & 0x0000F000) != 0) && -+ ((cond1 & 0x0000F000) != (driver1 & 0x0000F000)) -+ ) -+ return false; -+ -+ if ( -+ ((cond1 & 0x0F000000) != 0) && -+ ((cond1 & 0x0F000000) != (driver1 & 0x0F000000)) -+ ) -+ return false; -+ -+ /* Bit Defined Check ================ */ -+ /* We don't care [31:28] and [23:20] */ -+ cond1 &= 0x000F0FFF; -+ driver1 &= 0x000F0FFF; -+ -+ if ((cond1 & driver1) == cond1) { -+ u32 bitMask = 0; -+ -+ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE */ -+ return true; -+ -+ if ((cond1 & BIT0) != 0) /* GLNA */ -+ bitMask |= 0x000000FF; -+ if ((cond1 & BIT1) != 0) /* GPA */ -+ bitMask |= 0x0000FF00; -+ if ((cond1 & BIT2) != 0) /* ALNA */ -+ bitMask |= 0x00FF0000; -+ if ((cond1 & BIT3) != 0) /* APA */ -+ bitMask |= 0xFF000000; -+ -+ /* BoardType of each RF path is matched */ -+ if ((cond2 & bitMask) == (driver2 & bitMask)) -+ return true; -+ -+ return false; -+ } -+ -+ return false; -+} -+ -+static bool CheckNegative( -+ PDM_ODM_T pDM_Odm, const u32 Condition1, const u32 Condition2 -+) -+{ -+ return true; -+} -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+static u32 Array_MP_8723B_RadioA[] = { -+ 0x000, 0x00010000, -+ 0x0B0, 0x000DFFE0, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0B1, 0x00000018, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0B2, 0x00084C00, -+ 0x0B5, 0x0000D2CC, -+ 0x0B6, 0x000925AA, -+ 0x0B7, 0x00000010, -+ 0x0B8, 0x0000907F, -+ 0x05C, 0x00000002, -+ 0x07C, 0x00000002, -+ 0x07E, 0x00000005, -+ 0x08B, 0x0006FC00, -+ 0x0B0, 0x000FF9F0, -+ 0x01C, 0x000739D2, -+ 0x01E, 0x00000000, -+ 0x0DF, 0x00000780, -+ 0x050, 0x00067435, -+ 0x80002000, 0x00000000, 0x40000000, 0x00000000, -+ 0x051, 0x0006B10E, -+ 0x90003000, 0x00000000, 0x40000000, 0x00000000, -+ 0x051, 0x0006B10E, -+ 0x90004000, 0x00000000, 0x40000000, 0x00000000, -+ 0x051, 0x0006B10E, -+ 0xA0000000, 0x00000000, -+ 0x051, 0x0006B04E, -+ 0xB0000000, 0x00000000, -+ 0x052, 0x000007D2, -+ 0x053, 0x00000000, -+ 0x054, 0x00050400, -+ 0x055, 0x0004026E, -+ 0x0DD, 0x0000004C, -+ 0x070, 0x00067435, -+ 0x80002000, 0x00000000, 0x40000000, 0x00000000, -+ 0x071, 0x0006B10E, -+ 0x90003000, 0x00000000, 0x40000000, 0x00000000, -+ 0x071, 0x0006B10E, -+ 0x90004000, 0x00000000, 0x40000000, 0x00000000, -+ 0x071, 0x0006B10E, -+ 0xA0000000, 0x00000000, -+ 0x071, 0x0006B04E, -+ 0xB0000000, 0x00000000, -+ 0x072, 0x000007D2, -+ 0x073, 0x00000000, -+ 0x074, 0x00050400, -+ 0x075, 0x0004026E, -+ 0x0EF, 0x00000100, -+ 0x034, 0x0000ADD7, -+ 0x035, 0x00005C00, -+ 0x034, 0x00009DD4, -+ 0x035, 0x00005000, -+ 0x034, 0x00008DD1, -+ 0x035, 0x00004400, -+ 0x034, 0x00007DCE, -+ 0x035, 0x00003800, -+ 0x034, 0x00006CD1, -+ 0x035, 0x00004400, -+ 0x034, 0x00005CCE, -+ 0x035, 0x00003800, -+ 0x034, 0x000048CE, -+ 0x035, 0x00004400, -+ 0x034, 0x000034CE, -+ 0x035, 0x00003800, -+ 0x034, 0x00002451, -+ 0x035, 0x00004400, -+ 0x034, 0x0000144E, -+ 0x035, 0x00003800, -+ 0x034, 0x00000051, -+ 0x035, 0x00004400, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000100, -+ 0x0ED, 0x00000010, -+ 0x044, 0x0000ADD7, -+ 0x044, 0x00009DD4, -+ 0x044, 0x00008DD1, -+ 0x044, 0x00007DCE, -+ 0x044, 0x00006CC1, -+ 0x044, 0x00005CCE, -+ 0x044, 0x000044D1, -+ 0x044, 0x000034CE, -+ 0x044, 0x00002451, -+ 0x044, 0x0000144E, -+ 0x044, 0x00000051, -+ 0x0EF, 0x00000000, -+ 0x0ED, 0x00000000, -+ 0x07F, 0x00020080, -+ 0x0EF, 0x00002000, -+ 0x03B, 0x000380EF, -+ 0x03B, 0x000302FE, -+ 0x03B, 0x00028CE6, -+ 0x03B, 0x000200BC, -+ 0x03B, 0x000188A5, -+ 0x03B, 0x00010FBC, -+ 0x03B, 0x00008F71, -+ 0x03B, 0x00000900, -+ 0x0EF, 0x00000000, -+ 0x0ED, 0x00000001, -+ 0x040, 0x000380EF, -+ 0x040, 0x000302FE, -+ 0x040, 0x00028CE6, -+ 0x040, 0x000200BC, -+ 0x040, 0x000188A5, -+ 0x040, 0x00010FBC, -+ 0x040, 0x00008F71, -+ 0x040, 0x00000900, -+ 0x0ED, 0x00000000, -+ 0x082, 0x00080000, -+ 0x083, 0x00008000, -+ 0x084, 0x00048D80, -+ 0x085, 0x00068000, -+ 0x0A2, 0x00080000, -+ 0x0A3, 0x00008000, -+ 0x0A4, 0x00048D80, -+ 0x0A5, 0x00068000, -+ 0x0ED, 0x00000002, -+ 0x0EF, 0x00000002, -+ 0x056, 0x00000032, -+ 0x076, 0x00000032, -+ 0x001, 0x00000780, -+ -+}; -+ -+void ODM_ReadAndConfig_MP_8723B_RadioA(PDM_ODM_T pDM_Odm) -+{ -+ u32 i = 0; -+ u32 ArrayLen = sizeof(Array_MP_8723B_RadioA)/sizeof(u32); -+ u32 *Array = Array_MP_8723B_RadioA; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_LOUD, -+ ("===> ODM_ReadAndConfig_MP_8723B_RadioA\n") -+ ); -+ -+ for (i = 0; i < ArrayLen; i += 2) { -+ u32 v1 = Array[i]; -+ u32 v2 = Array[i+1]; -+ -+ /* This (offset, data) pair doesn't care the condition. */ -+ if (v1 < 0x40000000) { -+ odm_ConfigRF_RadioA_8723B(pDM_Odm, v1, v2); -+ continue; -+ } else { -+ /* This line is the beginning of branch. */ -+ bool bMatched = true; -+ u8 cCond = (u8)((v1 & (BIT29|BIT28)) >> 28); -+ -+ if (cCond == COND_ELSE) { /* ELSE, ENDIF */ -+ bMatched = true; -+ READ_NEXT_PAIR(v1, v2, i); -+ } else if (!CheckPositive(pDM_Odm, v1, v2)) { -+ bMatched = false; -+ READ_NEXT_PAIR(v1, v2, i); -+ READ_NEXT_PAIR(v1, v2, i); -+ } else { -+ READ_NEXT_PAIR(v1, v2, i); -+ if (!CheckNegative(pDM_Odm, v1, v2)) -+ bMatched = false; -+ else -+ bMatched = true; -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ if (bMatched == false) { -+ /* Condition isn't matched. -+ * Discard the following (offset, data) pairs. -+ */ -+ while (v1 < 0x40000000 && i < ArrayLen-2) -+ READ_NEXT_PAIR(v1, v2, i); -+ -+ i -= 2; /* prevent from for-loop += 2 */ -+ } else { -+ /* Configure matched pairs and skip to end of if-else. */ -+ while (v1 < 0x40000000 && i < ArrayLen-2) { -+ odm_ConfigRF_RadioA_8723B(pDM_Odm, v1, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ /* Keeps reading until ENDIF. */ -+ cCond = (u8)((v1 & (BIT29|BIT28)) >> 28); -+ while (cCond != COND_ENDIF && i < ArrayLen-2) { -+ READ_NEXT_PAIR(v1, v2, i); -+ cCond = (u8)((v1 & (BIT29|BIT28)) >> 28); -+ } -+ } -+ } -+ } -+} -+ -+/****************************************************************************** -+* TxPowerTrack_SDIO.TXT -+******************************************************************************/ -+ -+static u8 gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_SDIO_8723B[][DELTA_SWINGIDX_SIZE] = { -+ { -+ 0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, -+ 9, 10, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14 -+ }, -+ { -+ 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, -+ 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14 -+ }, -+ { -+ 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, -+ 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14 -+ }, -+}; -+static u8 gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_SDIO_8723B[][DELTA_SWINGIDX_SIZE] = { -+ { -+ 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, -+ 12, 13, 14, 15, 15, 16, 16, 17, 17, 18, 19, 20, 20, 20 -+ }, -+ { -+ 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, -+ 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20 -+ }, -+ { -+ 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, -+ 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21 -+ }, -+}; -+static u8 gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_SDIO_8723B[][DELTA_SWINGIDX_SIZE] = { -+ { -+ 0, 1, 2, 3, 3, 4, 4, 5, 5, 6, 7, 8, 8, 9, 9, 10, -+ 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14 -+ }, -+ { -+ 0, 1, 2, 3, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, -+ 11, 11, 12, 13, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16 -+ }, -+ { -+ 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, -+ 11, 12, 13, 14, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16 -+ }, -+}; -+static u8 gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_SDIO_8723B[][DELTA_SWINGIDX_SIZE] = { -+ { -+ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -+ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 -+ }, -+ { -+ 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, -+ 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21 -+ }, -+ { -+ 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, -+ 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21 -+ }, -+}; -+static u8 gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_SDIO_8723B[] = { -+ 0, 0, 1, 2, 2, 2, 3, 3, 3, 4, 5, 5, 6, 6, 6, 6, -+ 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 12, 13, 14, 15 -+}; -+static u8 gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_SDIO_8723B[] = { -+ 0, 0, 1, 2, 2, 3, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, -+ 9, 9, 10, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15 -+}; -+static u8 gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_SDIO_8723B[] = { -+ 0, 0, 1, 2, 2, 2, 3, 3, 3, 4, 5, 5, 6, 6, 6, 6, -+ 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 12, 13, 14, 15 -+}; -+static u8 gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_SDIO_8723B[] = { -+ 0, 0, 1, 2, 2, 3, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, -+ 9, 9, 10, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15 -+}; -+static u8 gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_SDIO_8723B[] = { -+ 0, 0, 1, 2, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 7, 8, -+ 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13, 14, 15 -+}; -+static u8 gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_SDIO_8723B[] = { -+ 0, 0, 1, 2, 2, 2, 3, 3, 3, 4, 5, 5, 6, 6, 7, 7, -+ 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13, 14, 15 -+}; -+static u8 gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_SDIO_8723B[] = { -+ 0, 0, 1, 2, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 7, 8, -+ 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13, 14, 15 -+}; -+static u8 gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_SDIO_8723B[] = { -+ 0, 0, 1, 2, 2, 2, 3, 3, 3, 4, 5, 5, 6, 6, 7, 7, -+ 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13, 14, 15 -+}; -+ -+void ODM_ReadAndConfig_MP_8723B_TxPowerTrack_SDIO(PDM_ODM_T pDM_Odm) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_LOUD, -+ ("===> ODM_ReadAndConfig_MP_MP_8723B\n") -+ ); -+ -+ -+ memcpy( -+ pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, -+ gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_SDIO_8723B, -+ DELTA_SWINGIDX_SIZE -+ ); -+ memcpy( -+ pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, -+ gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_SDIO_8723B, -+ DELTA_SWINGIDX_SIZE -+ ); -+ memcpy( -+ pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, -+ gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_SDIO_8723B, -+ DELTA_SWINGIDX_SIZE -+ ); -+ memcpy( -+ pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, -+ gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_SDIO_8723B, -+ DELTA_SWINGIDX_SIZE -+ ); -+ -+ memcpy( -+ pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, -+ gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_SDIO_8723B, -+ DELTA_SWINGIDX_SIZE -+ ); -+ memcpy( -+ pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, -+ gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_SDIO_8723B, -+ DELTA_SWINGIDX_SIZE -+ ); -+ memcpy( -+ pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, -+ gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_SDIO_8723B, -+ DELTA_SWINGIDX_SIZE -+ ); -+ memcpy( -+ pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, -+ gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_SDIO_8723B, -+ DELTA_SWINGIDX_SIZE -+ ); -+ -+ memcpy( -+ pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, -+ gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_SDIO_8723B, -+ DELTA_SWINGIDX_SIZE*3 -+ ); -+ memcpy( -+ pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, -+ gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_SDIO_8723B, -+ DELTA_SWINGIDX_SIZE*3 -+ ); -+ memcpy( -+ pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, -+ gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_SDIO_8723B, -+ DELTA_SWINGIDX_SIZE*3 -+ ); -+ memcpy( -+ pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, -+ gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_SDIO_8723B, -+ DELTA_SWINGIDX_SIZE*3 -+ ); -+} -+ -+/****************************************************************************** -+* TXPWR_LMT.TXT -+******************************************************************************/ -+ -+static u8 *Array_MP_8723B_TXPWR_LMT[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "28", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "28", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "28", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "28", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63" -+}; -+ -+void ODM_ReadAndConfig_MP_8723B_TXPWR_LMT(PDM_ODM_T pDM_Odm) -+{ -+ u32 i = 0; -+ u32 ArrayLen = sizeof(Array_MP_8723B_TXPWR_LMT)/sizeof(u8 *); -+ u8 **Array = Array_MP_8723B_TXPWR_LMT; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_LOUD, -+ ("===> ODM_ReadAndConfig_MP_8723B_TXPWR_LMT\n") -+ ); -+ -+ for (i = 0; i < ArrayLen; i += 7) { -+ u8 *regulation = Array[i]; -+ u8 *band = Array[i+1]; -+ u8 *bandwidth = Array[i+2]; -+ u8 *rate = Array[i+3]; -+ u8 *rfPath = Array[i+4]; -+ u8 *chnl = Array[i+5]; -+ u8 *val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8723B( -+ pDM_Odm, -+ regulation, -+ band, -+ bandwidth, -+ rate, -+ rfPath, -+ chnl, -+ val -+ ); -+ } -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalHWImg8723B_RF.h linux/3rdparty/rtl8723bs/hal/HalHWImg8723B_RF.h ---- linux.old/3rdparty/rtl8723bs/hal/HalHWImg8723B_RF.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalHWImg8723B_RF.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_MP_RF_HW_IMG_8723B_H -+#define __INC_MP_RF_HW_IMG_8723B_H -+ -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723B_RadioA(/* TC: Test Chip, MP: MP Chip */ -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_SDIO.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723B_TxPowerTrack_SDIO(/* TC: Test Chip, MP: MP Chip */ -+ PDM_ODM_T pDM_Odm -+); -+u32 ODM_GetVersion_MP_8723B_TxPowerTrack_SDIO(void); -+ -+/****************************************************************************** -+* TXPWR_LMT.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723B_TXPWR_LMT(/* TC: Test Chip, MP: MP Chip */ -+ PDM_ODM_T pDM_Odm -+); -+u32 ODM_GetVersion_MP_8723B_TXPWR_LMT(void); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/hal_intf.c linux/3rdparty/rtl8723bs/hal/hal_intf.c ---- linux.old/3rdparty/rtl8723bs/hal/hal_intf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/hal_intf.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,474 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#define _HAL_INTF_C_ -+ -+#include -+#include -+#include -+ -+void rtw_hal_chip_configure(struct adapter *padapter) -+{ -+ if (padapter->HalFunc.intf_chip_configure) -+ padapter->HalFunc.intf_chip_configure(padapter); -+} -+ -+void rtw_hal_read_chip_info(struct adapter *padapter) -+{ -+ if (padapter->HalFunc.read_adapter_info) -+ padapter->HalFunc.read_adapter_info(padapter); -+} -+ -+void rtw_hal_read_chip_version(struct adapter *padapter) -+{ -+ if (padapter->HalFunc.read_chip_version) -+ padapter->HalFunc.read_chip_version(padapter); -+} -+ -+void rtw_hal_def_value_init(struct adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) -+ if (padapter->HalFunc.init_default_value) -+ padapter->HalFunc.init_default_value(padapter); -+} -+ -+void rtw_hal_free_data(struct adapter *padapter) -+{ -+ /* free HAL Data */ -+ rtw_hal_data_deinit(padapter); -+ -+ if (is_primary_adapter(padapter)) -+ if (padapter->HalFunc.free_hal_data) -+ padapter->HalFunc.free_hal_data(padapter); -+} -+ -+void rtw_hal_dm_init(struct adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) -+ if (padapter->HalFunc.dm_init) -+ padapter->HalFunc.dm_init(padapter); -+} -+ -+void rtw_hal_dm_deinit(struct adapter *padapter) -+{ -+ /* cancel dm timer */ -+ if (is_primary_adapter(padapter)) -+ if (padapter->HalFunc.dm_deinit) -+ padapter->HalFunc.dm_deinit(padapter); -+} -+ -+static void rtw_hal_init_opmode(struct adapter *padapter) -+{ -+ enum NDIS_802_11_NETWORK_INFRASTRUCTURE networkType = Ndis802_11InfrastructureMax; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ sint fw_state; -+ -+ fw_state = get_fwstate(pmlmepriv); -+ -+ if (fw_state & WIFI_ADHOC_STATE) -+ networkType = Ndis802_11IBSS; -+ else if (fw_state & WIFI_STATION_STATE) -+ networkType = Ndis802_11Infrastructure; -+ else if (fw_state & WIFI_AP_STATE) -+ networkType = Ndis802_11APMode; -+ else -+ return; -+ -+ rtw_setopmode_cmd(padapter, networkType, false); -+} -+ -+uint rtw_hal_init(struct adapter *padapter) -+{ -+ uint status; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ status = padapter->HalFunc.hal_init(padapter); -+ -+ if (status == _SUCCESS) { -+ rtw_hal_init_opmode(padapter); -+ -+ dvobj->padapters->hw_init_completed = true; -+ -+ if (padapter->registrypriv.notch_filter == 1) -+ rtw_hal_notch_filter(padapter, 1); -+ -+ rtw_hal_reset_security_engine(padapter); -+ -+ rtw_sec_restore_wep_key(dvobj->padapters); -+ -+ init_hw_mlme_ext(padapter); -+ -+ rtw_bb_rf_gain_offset(padapter); -+ } else { -+ dvobj->padapters->hw_init_completed = false; -+ DBG_871X("rtw_hal_init: hal__init fail\n"); -+ } -+ -+ RT_TRACE(_module_hal_init_c_, _drv_err_, ("-rtl871x_hal_init:status = 0x%x\n", status)); -+ -+ return status; -+ -+} -+ -+uint rtw_hal_deinit(struct adapter *padapter) -+{ -+ uint status = _SUCCESS; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ status = padapter->HalFunc.hal_deinit(padapter); -+ -+ if (status == _SUCCESS) { -+ padapter = dvobj->padapters; -+ padapter->hw_init_completed = false; -+ } else { -+ DBG_871X("\n rtw_hal_deinit: hal_init fail\n"); -+ } -+ return status; -+} -+ -+void rtw_hal_set_hwreg(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ if (padapter->HalFunc.SetHwRegHandler) -+ padapter->HalFunc.SetHwRegHandler(padapter, variable, val); -+} -+ -+void rtw_hal_get_hwreg(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ if (padapter->HalFunc.GetHwRegHandler) -+ padapter->HalFunc.GetHwRegHandler(padapter, variable, val); -+} -+ -+void rtw_hal_set_hwreg_with_buf(struct adapter *padapter, u8 variable, u8 *pbuf, int len) -+{ -+ if (padapter->HalFunc.SetHwRegHandlerWithBuf) -+ padapter->HalFunc.SetHwRegHandlerWithBuf(padapter, variable, pbuf, len); -+} -+ -+u8 rtw_hal_set_def_var(struct adapter *padapter, enum HAL_DEF_VARIABLE eVariable, void *pValue) -+{ -+ if (padapter->HalFunc.SetHalDefVarHandler) -+ return padapter->HalFunc.SetHalDefVarHandler(padapter, eVariable, pValue); -+ return _FAIL; -+} -+ -+u8 rtw_hal_get_def_var(struct adapter *padapter, enum HAL_DEF_VARIABLE eVariable, void *pValue) -+{ -+ if (padapter->HalFunc.GetHalDefVarHandler) -+ return padapter->HalFunc.GetHalDefVarHandler(padapter, eVariable, pValue); -+ return _FAIL; -+} -+ -+void rtw_hal_set_odm_var(struct adapter *padapter, enum HAL_ODM_VARIABLE eVariable, void *pValue1, bool bSet) -+{ -+ if (padapter->HalFunc.SetHalODMVarHandler) -+ padapter->HalFunc.SetHalODMVarHandler(padapter, eVariable, pValue1, bSet); -+} -+ -+void rtw_hal_get_odm_var(struct adapter *padapter, enum HAL_ODM_VARIABLE eVariable, void *pValue1, void *pValue2) -+{ -+ if (padapter->HalFunc.GetHalODMVarHandler) -+ padapter->HalFunc.GetHalODMVarHandler(padapter, eVariable, pValue1, pValue2); -+} -+ -+void rtw_hal_enable_interrupt(struct adapter *padapter) -+{ -+ if (padapter->HalFunc.enable_interrupt) -+ padapter->HalFunc.enable_interrupt(padapter); -+ else -+ DBG_871X("%s: HalFunc.enable_interrupt is NULL!\n", __func__); -+ -+} -+ -+void rtw_hal_disable_interrupt(struct adapter *padapter) -+{ -+ if (padapter->HalFunc.disable_interrupt) -+ padapter->HalFunc.disable_interrupt(padapter); -+ else -+ DBG_871X("%s: HalFunc.disable_interrupt is NULL!\n", __func__); -+ -+} -+ -+u8 rtw_hal_check_ips_status(struct adapter *padapter) -+{ -+ u8 val = false; -+ if (padapter->HalFunc.check_ips_status) -+ val = padapter->HalFunc.check_ips_status(padapter); -+ else -+ DBG_871X("%s: HalFunc.check_ips_status is NULL!\n", __func__); -+ -+ return val; -+} -+ -+s32 rtw_hal_xmitframe_enqueue(struct adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ if (padapter->HalFunc.hal_xmitframe_enqueue) -+ return padapter->HalFunc.hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ return false; -+} -+ -+s32 rtw_hal_xmit(struct adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ if (padapter->HalFunc.hal_xmit) -+ return padapter->HalFunc.hal_xmit(padapter, pxmitframe); -+ -+ return false; -+} -+ -+/* -+ * [IMPORTANT] This function would be run in interrupt context. -+ */ -+s32 rtw_hal_mgnt_xmit(struct adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ s32 ret = _FAIL; -+ update_mgntframe_attrib_addr(padapter, pmgntframe); -+ /* pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; */ -+ /* pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; */ -+ /* memcpy(pmgntframe->attrib.ra, pwlanhdr->addr1, ETH_ALEN); */ -+ -+ if (padapter->securitypriv.binstallBIPkey == true) { -+ if (IS_MCAST(pmgntframe->attrib.ra)) { -+ pmgntframe->attrib.encrypt = _BIP_; -+ /* pmgntframe->attrib.bswenc = true; */ -+ } else { -+ pmgntframe->attrib.encrypt = _AES_; -+ pmgntframe->attrib.bswenc = true; -+ } -+ rtw_mgmt_xmitframe_coalesce(padapter, pmgntframe->pkt, pmgntframe); -+ } -+ -+ if (padapter->HalFunc.mgnt_xmit) -+ ret = padapter->HalFunc.mgnt_xmit(padapter, pmgntframe); -+ return ret; -+} -+ -+s32 rtw_hal_init_xmit_priv(struct adapter *padapter) -+{ -+ if (padapter->HalFunc.init_xmit_priv != NULL) -+ return padapter->HalFunc.init_xmit_priv(padapter); -+ return _FAIL; -+} -+ -+void rtw_hal_free_xmit_priv(struct adapter *padapter) -+{ -+ if (padapter->HalFunc.free_xmit_priv != NULL) -+ padapter->HalFunc.free_xmit_priv(padapter); -+} -+ -+s32 rtw_hal_init_recv_priv(struct adapter *padapter) -+{ -+ if (padapter->HalFunc.init_recv_priv) -+ return padapter->HalFunc.init_recv_priv(padapter); -+ -+ return _FAIL; -+} -+ -+void rtw_hal_free_recv_priv(struct adapter *padapter) -+{ -+ -+ if (padapter->HalFunc.free_recv_priv) -+ padapter->HalFunc.free_recv_priv(padapter); -+} -+ -+void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level) -+{ -+ struct adapter *padapter; -+ struct mlme_priv *pmlmepriv; -+ -+ if (!psta) -+ return; -+ -+ padapter = psta->padapter; -+ -+ pmlmepriv = &(padapter->mlmepriv); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ add_RATid(padapter, psta, rssi_level); -+ else { -+ if (padapter->HalFunc.UpdateRAMaskHandler) -+ padapter->HalFunc.UpdateRAMaskHandler(padapter, psta->mac_id, rssi_level); -+ } -+} -+ -+void rtw_hal_add_ra_tid(struct adapter *padapter, u32 bitmap, u8 *arg, u8 rssi_level) -+{ -+ if (padapter->HalFunc.Add_RateATid) -+ padapter->HalFunc.Add_RateATid(padapter, bitmap, arg, rssi_level); -+} -+ -+/*Start specifical interface thread */ -+void rtw_hal_start_thread(struct adapter *padapter) -+{ -+ if (padapter->HalFunc.run_thread) -+ padapter->HalFunc.run_thread(padapter); -+} -+/*Start specifical interface thread */ -+void rtw_hal_stop_thread(struct adapter *padapter) -+{ -+ if (padapter->HalFunc.cancel_thread) -+ padapter->HalFunc.cancel_thread(padapter); -+} -+ -+u32 rtw_hal_read_bbreg(struct adapter *padapter, u32 RegAddr, u32 BitMask) -+{ -+ u32 data = 0; -+ if (padapter->HalFunc.read_bbreg) -+ data = padapter->HalFunc.read_bbreg(padapter, RegAddr, BitMask); -+ return data; -+} -+void rtw_hal_write_bbreg(struct adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ if (padapter->HalFunc.write_bbreg) -+ padapter->HalFunc.write_bbreg(padapter, RegAddr, BitMask, Data); -+} -+ -+u32 rtw_hal_read_rfreg(struct adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask) -+{ -+ u32 data = 0; -+ if (padapter->HalFunc.read_rfreg) -+ data = padapter->HalFunc.read_rfreg(padapter, eRFPath, RegAddr, BitMask); -+ return data; -+} -+void rtw_hal_write_rfreg(struct adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ if (padapter->HalFunc.write_rfreg) -+ padapter->HalFunc.write_rfreg(padapter, eRFPath, RegAddr, BitMask, Data); -+} -+ -+void rtw_hal_set_chan(struct adapter *padapter, u8 channel) -+{ -+ if (padapter->HalFunc.set_channel_handler) -+ padapter->HalFunc.set_channel_handler(padapter, channel); -+} -+ -+void rtw_hal_set_chnl_bw(struct adapter *padapter, u8 channel, -+ enum CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80) -+{ -+ if (padapter->HalFunc.set_chnl_bw_handler) -+ padapter->HalFunc.set_chnl_bw_handler(padapter, channel, -+ Bandwidth, Offset40, -+ Offset80); -+} -+ -+void rtw_hal_dm_watchdog(struct adapter *padapter) -+{ -+ if (padapter->HalFunc.hal_dm_watchdog) -+ padapter->HalFunc.hal_dm_watchdog(padapter); -+ -+} -+ -+void rtw_hal_dm_watchdog_in_lps(struct adapter *padapter) -+{ -+ if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == true) { -+ if (padapter->HalFunc.hal_dm_watchdog_in_lps) -+ padapter->HalFunc.hal_dm_watchdog_in_lps(padapter); /* this fuction caller is in interrupt context */ -+ } -+} -+ -+void rtw_hal_bcn_related_reg_setting(struct adapter *padapter) -+{ -+ if (padapter->HalFunc.SetBeaconRelatedRegistersHandler) -+ padapter->HalFunc.SetBeaconRelatedRegistersHandler(padapter); -+} -+ -+ -+s32 rtw_hal_xmit_thread_handler(struct adapter *padapter) -+{ -+ if (padapter->HalFunc.xmit_thread_handler) -+ return padapter->HalFunc.xmit_thread_handler(padapter); -+ return _FAIL; -+} -+ -+void rtw_hal_notch_filter(struct adapter *adapter, bool enable) -+{ -+ if (adapter->HalFunc.hal_notch_filter) -+ adapter->HalFunc.hal_notch_filter(adapter, enable); -+} -+ -+void rtw_hal_reset_security_engine(struct adapter *adapter) -+{ -+ if (adapter->HalFunc.hal_reset_security_engine) -+ adapter->HalFunc.hal_reset_security_engine(adapter); -+} -+ -+bool rtw_hal_c2h_valid(struct adapter *adapter, u8 *buf) -+{ -+ return c2h_evt_valid((struct c2h_evt_hdr_88xx *)buf); -+} -+ -+s32 rtw_hal_c2h_evt_read(struct adapter *adapter, u8 *buf) -+{ -+ return c2h_evt_read_88xx(adapter, buf); -+} -+ -+s32 rtw_hal_c2h_handler(struct adapter *adapter, u8 *c2h_evt) -+{ -+ s32 ret = _FAIL; -+ if (adapter->HalFunc.c2h_handler) -+ ret = adapter->HalFunc.c2h_handler(adapter, c2h_evt); -+ return ret; -+} -+ -+c2h_id_filter rtw_hal_c2h_id_filter_ccx(struct adapter *adapter) -+{ -+ return adapter->HalFunc.c2h_id_filter_ccx; -+} -+ -+s32 rtw_hal_is_disable_sw_channel_plan(struct adapter *padapter) -+{ -+ return GET_HAL_DATA(padapter)->bDisableSWChannelPlan; -+} -+ -+s32 rtw_hal_macid_sleep(struct adapter *padapter, u32 macid) -+{ -+ u8 support; -+ -+ -+ support = false; -+ rtw_hal_get_def_var(padapter, HAL_DEF_MACID_SLEEP, &support); -+ if (false == support) -+ return _FAIL; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MACID_SLEEP, (u8 *)&macid); -+ -+ return _SUCCESS; -+} -+ -+s32 rtw_hal_macid_wakeup(struct adapter *padapter, u32 macid) -+{ -+ u8 support; -+ -+ -+ support = false; -+ rtw_hal_get_def_var(padapter, HAL_DEF_MACID_SLEEP, &support); -+ if (false == support) -+ return _FAIL; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MACID_WAKEUP, (u8 *)&macid); -+ -+ return _SUCCESS; -+} -+ -+s32 rtw_hal_fill_h2c_cmd(struct adapter *padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) -+{ -+ s32 ret = _FAIL; -+ -+ if (padapter->HalFunc.fill_h2c_cmd) -+ ret = padapter->HalFunc.fill_h2c_cmd(padapter, ElementID, CmdLen, pCmdBuffer); -+ else -+ DBG_871X("%s: func[fill_h2c_cmd] not defined!\n", __func__); -+ -+ return ret; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/hal_phy.c linux/3rdparty/rtl8723bs/hal/hal_phy.c ---- linux.old/3rdparty/rtl8723bs/hal/hal_phy.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/hal_phy.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,224 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _HAL_PHY_C_ -+ -+#include -+ -+/** -+* Function: PHY_CalculateBitShift -+* -+* OverView: Get shifted position of the BitMask -+* -+* Input: -+* u32 BitMask, -+* -+* Output: none -+* Return: u32 Return the shift bit bit position of the mask -+*/ -+u32 PHY_CalculateBitShift(u32 BitMask) -+{ -+ u32 i; -+ -+ for (i = 0; i <= 31; i++) { -+ if (((BitMask>>i) & 0x1) == 1) -+ break; -+ } -+ -+ return i; -+} -+ -+ -+/* */ -+/* ==> RF shadow Operation API Code Section!!! */ -+/* */ -+/*----------------------------------------------------------------------------- -+ * Function: PHY_RFShadowRead -+ * PHY_RFShadowWrite -+ * PHY_RFShadowCompare -+ * PHY_RFShadowRecorver -+ * PHY_RFShadowCompareAll -+ * PHY_RFShadowRecorverAll -+ * PHY_RFShadowCompareFlagSet -+ * PHY_RFShadowRecorverFlagSet -+ * -+ * Overview: When we set RF register, we must write shadow at first. -+ * When we are running, we must compare shadow abd locate error addr. -+ * Decide to recorver or not. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/20/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+u32 PHY_RFShadowRead(IN PADAPTER Adapter, IN u8 eRFPath, IN u32 Offset) -+{ -+ return RF_Shadow[eRFPath][Offset].Value; -+ -+} /* PHY_RFShadowRead */ -+ -+ -+void PHY_RFShadowWrite( -+ IN PADAPTER Adapter, IN u8 eRFPath, IN u32 Offset, IN u32 Data -+) -+{ -+ RF_Shadow[eRFPath][Offset].Value = (Data & bRFRegOffsetMask); -+ RF_Shadow[eRFPath][Offset].Driver_Write = true; -+ -+} /* PHY_RFShadowWrite */ -+ -+ -+bool PHY_RFShadowCompare(IN PADAPTER Adapter, IN u8 eRFPath, IN u32 Offset) -+{ -+ u32 reg; -+ /* Check if we need to check the register */ -+ if (RF_Shadow[eRFPath][Offset].Compare == true) { -+ reg = rtw_hal_read_rfreg(Adapter, eRFPath, Offset, bRFRegOffsetMask); -+ /* Compare shadow and real rf register for 20bits!! */ -+ if (RF_Shadow[eRFPath][Offset].Value != reg) { -+ /* Locate error position. */ -+ RF_Shadow[eRFPath][Offset].ErrorOrNot = true; -+ /* RT_TRACE(COMP_INIT, DBG_LOUD, */ -+ /* PHY_RFShadowCompare RF-%d Addr%02lx Err = %05lx\n", */ -+ /* eRFPath, Offset, reg)); */ -+ } -+ return RF_Shadow[eRFPath][Offset].ErrorOrNot; -+ } -+ return false; -+} /* PHY_RFShadowCompare */ -+ -+ -+void PHY_RFShadowRecorver(IN PADAPTER Adapter, IN u8 eRFPath, IN u32 Offset) -+{ -+ /* Check if the address is error */ -+ if (RF_Shadow[eRFPath][Offset].ErrorOrNot == true) { -+ /* Check if we need to recorver the register. */ -+ if (RF_Shadow[eRFPath][Offset].Recorver == true) { -+ rtw_hal_write_rfreg(Adapter, eRFPath, Offset, bRFRegOffsetMask, -+ RF_Shadow[eRFPath][Offset].Value); -+ /* RT_TRACE(COMP_INIT, DBG_LOUD, */ -+ /* PHY_RFShadowRecorver RF-%d Addr%02lx=%05lx", */ -+ /* eRFPath, Offset, RF_Shadow[eRFPath][Offset].Value)); */ -+ } -+ } -+ -+} /* PHY_RFShadowRecorver */ -+ -+ -+void PHY_RFShadowCompareAll(IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { -+ for (Offset = 0; Offset < maxReg; Offset++) { -+ PHY_RFShadowCompare(Adapter, eRFPath, Offset); -+ } -+ } -+ -+} /* PHY_RFShadowCompareAll */ -+ -+ -+void PHY_RFShadowRecorverAll(IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { -+ for (Offset = 0; Offset < maxReg; Offset++) { -+ PHY_RFShadowRecorver(Adapter, eRFPath, Offset); -+ } -+ } -+ -+} /* PHY_RFShadowRecorverAll */ -+ -+ -+void -+PHY_RFShadowCompareFlagSet( -+ IN PADAPTER Adapter, IN u8 eRFPath, IN u32 Offset, IN u8 Type -+) -+{ -+ /* Set True or False!!! */ -+ RF_Shadow[eRFPath][Offset].Compare = Type; -+ -+} /* PHY_RFShadowCompareFlagSet */ -+ -+ -+void PHY_RFShadowRecorverFlagSet( -+ IN PADAPTER Adapter, IN u8 eRFPath, IN u32 Offset, IN u8 Type -+) -+{ -+ /* Set True or False!!! */ -+ RF_Shadow[eRFPath][Offset].Recorver = Type; -+ -+} /* PHY_RFShadowRecorverFlagSet */ -+ -+ -+void PHY_RFShadowCompareFlagSetAll(IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { -+ for (Offset = 0; Offset < maxReg; Offset++) { -+ /* 2008/11/20 MH For S3S4 test, we only check reg 26/27 now!!!! */ -+ if (Offset != 0x26 && Offset != 0x27) -+ PHY_RFShadowCompareFlagSet(Adapter, eRFPath, Offset, false); -+ else -+ PHY_RFShadowCompareFlagSet(Adapter, eRFPath, Offset, true); -+ } -+ } -+ -+} /* PHY_RFShadowCompareFlagSetAll */ -+ -+ -+void PHY_RFShadowRecorverFlagSetAll(IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { -+ for (Offset = 0; Offset < maxReg; Offset++) { -+ /* 2008/11/20 MH For S3S4 test, we only check reg 26/27 now!!!! */ -+ if (Offset != 0x26 && Offset != 0x27) -+ PHY_RFShadowRecorverFlagSet(Adapter, eRFPath, Offset, false); -+ else -+ PHY_RFShadowRecorverFlagSet(Adapter, eRFPath, Offset, true); -+ } -+ } -+ -+} /* PHY_RFShadowCompareFlagSetAll */ -+ -+void PHY_RFShadowRefresh(IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { -+ for (Offset = 0; Offset < maxReg; Offset++) { -+ RF_Shadow[eRFPath][Offset].Value = 0; -+ RF_Shadow[eRFPath][Offset].Compare = false; -+ RF_Shadow[eRFPath][Offset].Recorver = false; -+ RF_Shadow[eRFPath][Offset].ErrorOrNot = false; -+ RF_Shadow[eRFPath][Offset].Driver_Write = false; -+ } -+ } -+ -+} /* PHY_RFShadowRead */ -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalPhyRf_8723B.c linux/3rdparty/rtl8723bs/hal/HalPhyRf_8723B.c ---- linux.old/3rdparty/rtl8723bs/hal/HalPhyRf_8723B.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalPhyRf_8723B.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,2091 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+#include "odm_precomp.h" -+ -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+/* 2010/04/25 MH Define the max tx power tracking tx agc power. */ -+#define ODM_TXPWRTRACK_MAX_IDX8723B 6 -+ -+/* MACRO definition for pRFCalibrateInfo->TxIQC_8723B[0] */ -+#define PATH_S0 1 /* RF_PATH_B */ -+#define IDX_0xC94 0 -+#define IDX_0xC80 1 -+#define IDX_0xC4C 2 -+#define IDX_0xC14 0 -+#define IDX_0xCA0 1 -+#define KEY 0 -+#define VAL 1 -+ -+/* MACRO definition for pRFCalibrateInfo->TxIQC_8723B[1] */ -+#define PATH_S1 0 /* RF_PATH_A */ -+#define IDX_0xC9C 0 -+#define IDX_0xC88 1 -+#define IDX_0xC4C 2 -+#define IDX_0xC1C 0 -+#define IDX_0xC78 1 -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+/* In the case that we fail to read TxPowerTrack.txt, we use the table for -+ * 88E as the default table. -+ */ -+static u8 DeltaSwingTableIdx_2GA_N_8188E[] = { -+ 0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, -+ 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11 -+}; -+static u8 DeltaSwingTableIdx_2GA_P_8188E[] = { -+ 0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, -+ 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9 -+}; -+ -+/* 3 ============================================================ */ -+/* 3 Tx Power Tracking */ -+/* 3 ============================================================ */ -+ -+ -+static void setIqkMatrix_8723B( -+ PDM_ODM_T pDM_Odm, -+ u8 OFDM_index, -+ u8 RFPath, -+ s32 IqkResult_X, -+ s32 IqkResult_Y -+) -+{ -+ s32 ele_A = 0, ele_D, ele_C = 0, value32; -+ -+ if (OFDM_index >= OFDM_TABLE_SIZE) -+ OFDM_index = OFDM_TABLE_SIZE-1; -+ -+ ele_D = (OFDMSwingTable_New[OFDM_index] & 0xFFC00000)>>22; -+ -+ /* new element A = element D x X */ -+ if ((IqkResult_X != 0) && (*(pDM_Odm->pBandType) == ODM_BAND_2_4G)) { -+ if ((IqkResult_X & 0x00000200) != 0) /* consider minus */ -+ IqkResult_X = IqkResult_X | 0xFFFFFC00; -+ ele_A = ((IqkResult_X * ele_D)>>8)&0x000003FF; -+ -+ /* new element C = element D x Y */ -+ if ((IqkResult_Y & 0x00000200) != 0) -+ IqkResult_Y = IqkResult_Y | 0xFFFFFC00; -+ ele_C = ((IqkResult_Y * ele_D)>>8)&0x000003FF; -+ -+ /* if (RFPath == ODM_RF_PATH_A) */ -+ switch (RFPath) { -+ case ODM_RF_PATH_A: -+ /* wirte new elements A, C, D to regC80 and regC94, element B is always 0 */ -+ value32 = (ele_D<<22)|((ele_C&0x3F)<<16)|ele_A; -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XATxIQImbalance, bMaskDWord, value32); -+ -+ value32 = (ele_C&0x000003C0)>>6; -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XCTxAFE, bMaskH4Bits, value32); -+ -+ value32 = ((IqkResult_X * ele_D)>>7)&0x01; -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, BIT24, value32); -+ break; -+ case ODM_RF_PATH_B: -+ /* wirte new elements A, C, D to regC88 and regC9C, element B is always 0 */ -+ value32 = (ele_D<<22)|((ele_C&0x3F)<<16)|ele_A; -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XBTxIQImbalance, bMaskDWord, value32); -+ -+ value32 = (ele_C&0x000003C0)>>6; -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XDTxAFE, bMaskH4Bits, value32); -+ -+ value32 = ((IqkResult_X * ele_D)>>7)&0x01; -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, BIT28, value32); -+ -+ break; -+ default: -+ break; -+ } -+ } else { -+ switch (RFPath) { -+ case ODM_RF_PATH_A: -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XATxIQImbalance, bMaskDWord, OFDMSwingTable_New[OFDM_index]); -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XCTxAFE, bMaskH4Bits, 0x00); -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, BIT24, 0x00); -+ break; -+ -+ case ODM_RF_PATH_B: -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XBTxIQImbalance, bMaskDWord, OFDMSwingTable_New[OFDM_index]); -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XDTxAFE, bMaskH4Bits, 0x00); -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, BIT28, 0x00); -+ break; -+ -+ default: -+ break; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("TxPwrTracking path B: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x 0xeb4 = 0x%x 0xebc = 0x%x\n", -+ (u32)IqkResult_X, (u32)IqkResult_Y, (u32)ele_A, (u32)ele_C, (u32)ele_D, (u32)IqkResult_X, (u32)IqkResult_Y)); -+} -+ -+ -+static void setCCKFilterCoefficient(PDM_ODM_T pDM_Odm, u8 CCKSwingIndex) -+{ -+ if (!pDM_Odm->RFCalibrateInfo.bCCKinCH14) { -+ rtw_write8(pDM_Odm->Adapter, 0xa22, CCKSwingTable_Ch1_Ch13_New[CCKSwingIndex][0]); -+ rtw_write8(pDM_Odm->Adapter, 0xa23, CCKSwingTable_Ch1_Ch13_New[CCKSwingIndex][1]); -+ rtw_write8(pDM_Odm->Adapter, 0xa24, CCKSwingTable_Ch1_Ch13_New[CCKSwingIndex][2]); -+ rtw_write8(pDM_Odm->Adapter, 0xa25, CCKSwingTable_Ch1_Ch13_New[CCKSwingIndex][3]); -+ rtw_write8(pDM_Odm->Adapter, 0xa26, CCKSwingTable_Ch1_Ch13_New[CCKSwingIndex][4]); -+ rtw_write8(pDM_Odm->Adapter, 0xa27, CCKSwingTable_Ch1_Ch13_New[CCKSwingIndex][5]); -+ rtw_write8(pDM_Odm->Adapter, 0xa28, CCKSwingTable_Ch1_Ch13_New[CCKSwingIndex][6]); -+ rtw_write8(pDM_Odm->Adapter, 0xa29, CCKSwingTable_Ch1_Ch13_New[CCKSwingIndex][7]); -+ } else { -+ rtw_write8(pDM_Odm->Adapter, 0xa22, CCKSwingTable_Ch14_New[CCKSwingIndex][0]); -+ rtw_write8(pDM_Odm->Adapter, 0xa23, CCKSwingTable_Ch14_New[CCKSwingIndex][1]); -+ rtw_write8(pDM_Odm->Adapter, 0xa24, CCKSwingTable_Ch14_New[CCKSwingIndex][2]); -+ rtw_write8(pDM_Odm->Adapter, 0xa25, CCKSwingTable_Ch14_New[CCKSwingIndex][3]); -+ rtw_write8(pDM_Odm->Adapter, 0xa26, CCKSwingTable_Ch14_New[CCKSwingIndex][4]); -+ rtw_write8(pDM_Odm->Adapter, 0xa27, CCKSwingTable_Ch14_New[CCKSwingIndex][5]); -+ rtw_write8(pDM_Odm->Adapter, 0xa28, CCKSwingTable_Ch14_New[CCKSwingIndex][6]); -+ rtw_write8(pDM_Odm->Adapter, 0xa29, CCKSwingTable_Ch14_New[CCKSwingIndex][7]); -+ } -+} -+ -+void DoIQK_8723B( -+ PDM_ODM_T pDM_Odm, -+ u8 DeltaThermalIndex, -+ u8 ThermalValue, -+ u8 Threshold -+) -+{ -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: odm_TxPwrTrackSetPwr88E() -+ * -+ * Overview: 88E change all channel tx power accordign to flag. -+ * OFDM & CCK are all different. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ *When Who Remark -+ *04/23/2012 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+void ODM_TxPwrTrackSetPwr_8723B( -+ PDM_ODM_T pDM_Odm, -+ PWRTRACK_METHOD Method, -+ u8 RFPath, -+ u8 ChannelMappedIndex -+) -+{ -+ struct adapter *Adapter = pDM_Odm->Adapter; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ u8 PwrTrackingLimit_OFDM = 34; /* 0dB */ -+ u8 PwrTrackingLimit_CCK = 28; /* 2dB */ -+ u8 TxRate = 0xFF; -+ u8 Final_OFDM_Swing_Index = 0; -+ u8 Final_CCK_Swing_Index = 0; -+ -+ { -+ u16 rate = *(pDM_Odm->pForcedDataRate); -+ -+ if (!rate) { /* auto rate */ -+ if (pDM_Odm->TxRate != 0xFF) -+ TxRate = HwRateToMRate(pDM_Odm->TxRate); -+ } else /* force rate */ -+ TxRate = (u8)rate; -+ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("===>ODM_TxPwrTrackSetPwr8723B\n")); -+ -+ if (TxRate != 0xFF) { -+ /* 2 CCK */ -+ if ((TxRate >= MGN_1M) && (TxRate <= MGN_11M)) -+ PwrTrackingLimit_CCK = 28; /* 2dB */ -+ /* 2 OFDM */ -+ else if ((TxRate >= MGN_6M) && (TxRate <= MGN_48M)) -+ PwrTrackingLimit_OFDM = 36; /* 3dB */ -+ else if (TxRate == MGN_54M) -+ PwrTrackingLimit_OFDM = 34; /* 2dB */ -+ -+ /* 2 HT */ -+ else if ((TxRate >= MGN_MCS0) && (TxRate <= MGN_MCS2)) /* QPSK/BPSK */ -+ PwrTrackingLimit_OFDM = 38; /* 4dB */ -+ else if ((TxRate >= MGN_MCS3) && (TxRate <= MGN_MCS4)) /* 16QAM */ -+ PwrTrackingLimit_OFDM = 36; /* 3dB */ -+ else if ((TxRate >= MGN_MCS5) && (TxRate <= MGN_MCS7)) /* 64QAM */ -+ PwrTrackingLimit_OFDM = 34; /* 2dB */ -+ -+ else -+ PwrTrackingLimit_OFDM = pDM_Odm->DefaultOfdmIndex; /* Default OFDM index = 30 */ -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("TxRate = 0x%x, PwrTrackingLimit =%d\n", TxRate, PwrTrackingLimit_OFDM)); -+ -+ if (Method == TXAGC) { -+ struct adapter *Adapter = pDM_Odm->Adapter; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("odm_TxPwrTrackSetPwr8723B CH =%d\n", *(pDM_Odm->pChannel))); -+ -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = pDM_Odm->Absolute_OFDMSwingIdx[RFPath]; -+ -+ pDM_Odm->Modify_TxAGC_Flag_PathA = true; -+ pDM_Odm->Modify_TxAGC_Flag_PathA_CCK = true; -+ -+ PHY_SetTxPowerIndexByRateSection(Adapter, RFPath, pHalData->CurrentChannel, CCK); -+ PHY_SetTxPowerIndexByRateSection(Adapter, RFPath, pHalData->CurrentChannel, OFDM); -+ PHY_SetTxPowerIndexByRateSection(Adapter, RFPath, pHalData->CurrentChannel, HT_MCS0_MCS7); -+ } else if (Method == BBSWING) { -+ Final_OFDM_Swing_Index = pDM_Odm->DefaultOfdmIndex + pDM_Odm->Absolute_OFDMSwingIdx[RFPath]; -+ Final_CCK_Swing_Index = pDM_Odm->DefaultCckIndex + pDM_Odm->Absolute_OFDMSwingIdx[RFPath]; -+ -+ /* Adjust BB swing by OFDM IQ matrix */ -+ if (Final_OFDM_Swing_Index >= PwrTrackingLimit_OFDM) -+ Final_OFDM_Swing_Index = PwrTrackingLimit_OFDM; -+ else if (Final_OFDM_Swing_Index <= 0) -+ Final_OFDM_Swing_Index = 0; -+ -+ if (Final_CCK_Swing_Index >= CCK_TABLE_SIZE) -+ Final_CCK_Swing_Index = CCK_TABLE_SIZE-1; -+ else if (pDM_Odm->BbSwingIdxCck <= 0) -+ Final_CCK_Swing_Index = 0; -+ -+ setIqkMatrix_8723B(pDM_Odm, Final_OFDM_Swing_Index, RFPath, -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); -+ -+ setCCKFilterCoefficient(pDM_Odm, Final_CCK_Swing_Index); -+ -+ } else if (Method == MIX_MODE) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("pDM_Odm->DefaultOfdmIndex =%d, pDM_Odm->DefaultCCKIndex =%d, pDM_Odm->Absolute_OFDMSwingIdx[RFPath]=%d, RF_Path = %d\n", -+ pDM_Odm->DefaultOfdmIndex, pDM_Odm->DefaultCckIndex, pDM_Odm->Absolute_OFDMSwingIdx[RFPath], RFPath)); -+ -+ Final_OFDM_Swing_Index = pDM_Odm->DefaultOfdmIndex + pDM_Odm->Absolute_OFDMSwingIdx[RFPath]; -+ Final_CCK_Swing_Index = pDM_Odm->DefaultCckIndex + pDM_Odm->Absolute_OFDMSwingIdx[RFPath]; -+ -+ if (Final_OFDM_Swing_Index > PwrTrackingLimit_OFDM) { /* BBSwing higher then Limit */ -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit_OFDM; -+ -+ setIqkMatrix_8723B(pDM_Odm, PwrTrackingLimit_OFDM, RFPath, -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); -+ -+ pDM_Odm->Modify_TxAGC_Flag_PathA = true; -+ PHY_SetTxPowerIndexByRateSection(Adapter, RFPath, pHalData->CurrentChannel, OFDM); -+ PHY_SetTxPowerIndexByRateSection(Adapter, RFPath, pHalData->CurrentChannel, HT_MCS0_MCS7); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Path_A Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d\n", -+ PwrTrackingLimit_OFDM, pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); -+ } else if (Final_OFDM_Swing_Index <= 0) { -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index; -+ -+ setIqkMatrix_8723B(pDM_Odm, 0, RFPath, -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); -+ -+ pDM_Odm->Modify_TxAGC_Flag_PathA = true; -+ PHY_SetTxPowerIndexByRateSection(Adapter, RFPath, pHalData->CurrentChannel, OFDM); -+ PHY_SetTxPowerIndexByRateSection(Adapter, RFPath, pHalData->CurrentChannel, HT_MCS0_MCS7); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Path_A Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d\n", -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); -+ } else { -+ setIqkMatrix_8723B(pDM_Odm, Final_OFDM_Swing_Index, RFPath, -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Path_A Compensate with BBSwing , Final_OFDM_Swing_Index = %d\n", Final_OFDM_Swing_Index)); -+ -+ if (pDM_Odm->Modify_TxAGC_Flag_PathA) { /* If TxAGC has changed, reset TxAGC again */ -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = 0; -+ PHY_SetTxPowerIndexByRateSection(Adapter, RFPath, pHalData->CurrentChannel, OFDM); -+ PHY_SetTxPowerIndexByRateSection(Adapter, RFPath, pHalData->CurrentChannel, HT_MCS0_MCS7); -+ pDM_Odm->Modify_TxAGC_Flag_PathA = false; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Path_A pDM_Odm->Modify_TxAGC_Flag = false\n")); -+ } -+ } -+ -+ if (Final_CCK_Swing_Index > PwrTrackingLimit_CCK) { -+ pDM_Odm->Remnant_CCKSwingIdx = Final_CCK_Swing_Index - PwrTrackingLimit_CCK; -+ setCCKFilterCoefficient(pDM_Odm, PwrTrackingLimit_CCK); -+ pDM_Odm->Modify_TxAGC_Flag_PathA_CCK = true; -+ PHY_SetTxPowerIndexByRateSection(Adapter, RFPath, pHalData->CurrentChannel, CCK); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Path_A CCK Over Limit , PwrTrackingLimit_CCK = %d , pDM_Odm->Remnant_CCKSwingIdx = %d\n", PwrTrackingLimit_CCK, pDM_Odm->Remnant_CCKSwingIdx)); -+ } else if (Final_CCK_Swing_Index <= 0) { /* Lowest CCK Index = 0 */ -+ pDM_Odm->Remnant_CCKSwingIdx = Final_CCK_Swing_Index; -+ setCCKFilterCoefficient(pDM_Odm, 0); -+ pDM_Odm->Modify_TxAGC_Flag_PathA_CCK = true; -+ PHY_SetTxPowerIndexByRateSection(Adapter, RFPath, pHalData->CurrentChannel, CCK); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Path_A CCK Under Limit , PwrTrackingLimit_CCK = %d , pDM_Odm->Remnant_CCKSwingIdx = %d\n", 0, pDM_Odm->Remnant_CCKSwingIdx)); -+ } else { -+ setCCKFilterCoefficient(pDM_Odm, Final_CCK_Swing_Index); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Path_A CCK Compensate with BBSwing , Final_CCK_Swing_Index = %d\n", Final_CCK_Swing_Index)); -+ -+ if (pDM_Odm->Modify_TxAGC_Flag_PathA_CCK) { /* If TxAGC has changed, reset TxAGC again */ -+ pDM_Odm->Remnant_CCKSwingIdx = 0; -+ PHY_SetTxPowerIndexByRateSection(Adapter, RFPath, pHalData->CurrentChannel, CCK); -+ pDM_Odm->Modify_TxAGC_Flag_PathA_CCK = false; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Path_A pDM_Odm->Modify_TxAGC_Flag_CCK = false\n")); -+ } -+ } -+ } else -+ return; /* This method is not supported. */ -+} -+ -+static void GetDeltaSwingTable_8723B( -+ PDM_ODM_T pDM_Odm, -+ u8 **TemperatureUP_A, -+ u8 **TemperatureDOWN_A, -+ u8 **TemperatureUP_B, -+ u8 **TemperatureDOWN_B -+) -+{ -+ struct adapter *Adapter = pDM_Odm->Adapter; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ u16 rate = *(pDM_Odm->pForcedDataRate); -+ u8 channel = pHalData->CurrentChannel; -+ -+ if (1 <= channel && channel <= 14) { -+ if (IS_CCK_RATE(rate)) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N; -+ } else { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N; -+ } -+ } /*else if (36 <= channel && channel <= 64) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0]; -+ } else if (100 <= channel && channel <= 140) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1]; -+ } else if (149 <= channel && channel <= 173) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2]; -+ }*/else { -+ *TemperatureUP_A = (u8 *)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_A = (u8 *)DeltaSwingTableIdx_2GA_N_8188E; -+ *TemperatureUP_B = (u8 *)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_B = (u8 *)DeltaSwingTableIdx_2GA_N_8188E; -+ } -+ -+ return; -+} -+ -+ -+void ConfigureTxpowerTrack_8723B(PTXPWRTRACK_CFG pConfig) -+{ -+ pConfig->SwingTableSize_CCK = CCK_TABLE_SIZE; -+ pConfig->SwingTableSize_OFDM = OFDM_TABLE_SIZE; -+ pConfig->Threshold_IQK = IQK_THRESHOLD; -+ pConfig->AverageThermalNum = AVG_THERMAL_NUM_8723B; -+ pConfig->RfPathCount = MAX_PATH_NUM_8723B; -+ pConfig->ThermalRegAddr = RF_T_METER_8723B; -+ -+ pConfig->ODM_TxPwrTrackSetPwr = ODM_TxPwrTrackSetPwr_8723B; -+ pConfig->DoIQK = DoIQK_8723B; -+ pConfig->PHY_LCCalibrate = PHY_LCCalibrate_8723B; -+ pConfig->GetDeltaSwingTable = GetDeltaSwingTable_8723B; -+} -+ -+/* 1 7. IQK */ -+#define MAX_TOLERANCE 5 -+#define IQK_DELAY_TIME 1 /* ms */ -+ -+/* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -+static u8 phy_PathA_IQK_8723B( -+ struct adapter *padapter, bool configPathB, u8 RF_Path -+) -+{ -+ u32 regEAC, regE94, regE9C, tmp, Path_SEL_BB /*, regEA4*/; -+ u8 result = 0x00; -+ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ /* Save RF Path */ -+ Path_SEL_BB = PHY_QueryBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A IQK!\n")); -+ -+ /* leave IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ -+ /* enable path A PA in TXIQK mode */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_RCK_OS, bRFRegOffsetMask, 0x18000); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G1, bRFRegOffsetMask, 0x0003f); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G2, bRFRegOffsetMask, 0xc7f87); -+ /* disable path B PA in TXIQK mode */ -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xed, bRFRegOffsetMask, 0x00020); */ -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0x43, bRFRegOffsetMask, 0x40ec1); */ -+ -+ /* 1 Tx IQK */ -+ /* IQK setting */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK, bMaskDWord, 0x01007c00); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK, bMaskDWord, 0x01004800); -+ /* path-A IQK setting */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-A IQK setting!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_Tone_A, bMaskDWord, 0x18008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_Tone_A, bMaskDWord, 0x38008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+/* PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_A, bMaskDWord, 0x8214010a); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_A, bMaskDWord, 0x821303ea); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_A, bMaskDWord, 0x28110000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_B, bMaskDWord, 0x82110000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_B, bMaskDWord, 0x28110000); -+ -+ /* LO calibration setting */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Rsp, bMaskDWord, 0x00462911); -+ -+ /* enter IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x808000); -+ -+ /* Ant switch */ -+ if (configPathB || (RF_Path == 0)) -+ /* wifi switch to S1 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, 0x00000000); -+ else -+ /* wifi switch to S0 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, 0x00000280); -+ -+ /* GNT_BT = 0 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord, 0x00000800); -+ -+ /* One shot, path A LOK & IQK */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ /* delay x ms */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_8723B)); */ -+ /* PlatformStallExecution(IQK_DELAY_TIME_8723B*1000); */ -+ mdelay(IQK_DELAY_TIME_8723B); -+ -+ /* restore Ant Path */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, Path_SEL_BB); -+ /* GNT_BT = 1 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord, 0x00001800); -+ -+ /* leave IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ -+ -+ /* Check failed */ -+ regEAC = PHY_QueryBBReg(pDM_Odm->Adapter, rRx_Power_After_IQK_A_2, bMaskDWord); -+ regE94 = PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_Before_IQK_A, bMaskDWord); -+ regE9C = PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_After_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", regEAC)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x, 0xe9c = 0x%x\n", regE94, regE9C)); -+ /* monitor image power before & after IQK */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe90(before IQK) = 0x%x, 0xe98(afer IQK) = 0x%x\n", -+ PHY_QueryBBReg(pDM_Odm->Adapter, 0xe90, bMaskDWord), PHY_QueryBBReg(pDM_Odm->Adapter, 0xe98, bMaskDWord))); -+ -+ -+ /* Allen 20131125 */ -+ tmp = (regE9C & 0x03FF0000)>>16; -+ if ((tmp & 0x200) > 0) -+ tmp = 0x400 - tmp; -+ -+ if ( -+ !(regEAC & BIT28) && -+ (((regE94 & 0x03FF0000)>>16) != 0x142) && -+ (((regE9C & 0x03FF0000)>>16) != 0x42) && -+ (((regE94 & 0x03FF0000)>>16) < 0x110) && -+ (((regE94 & 0x03FF0000)>>16) > 0xf0) && -+ (tmp < 0xf) -+ ) -+ result |= 0x01; -+ else /* if Tx not OK, ignore Rx */ -+ return result; -+ -+ return result; -+} -+ -+/* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -+static u8 phy_PathA_RxIQK8723B( -+ struct adapter *padapter, bool configPathB, u8 RF_Path -+) -+{ -+ u32 regEAC, regE94, regE9C, regEA4, u4tmp, tmp, Path_SEL_BB; -+ u8 result = 0x00; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A Rx IQK!\n")); */ -+ -+ /* Save RF Path */ -+ Path_SEL_BB = PHY_QueryBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord); -+ -+ /* leave IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A RX IQK:Get TXIMR setting\n")); -+ /* 1 Get TXIMR setting */ -+ /* modify RXIQK mode table */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-A Rx IQK modify RXIQK mode table!\n")); */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_RCK_OS, bRFRegOffsetMask, 0x18000); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G1, bRFRegOffsetMask, 0x0001f); -+ /* LNA2 off, PA on for Dcut */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G2, bRFRegOffsetMask, 0xf7fb7); -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x0); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x808000); -+ -+ /* IQK setting */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK, bMaskDWord, 0x01007c00); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ /* path-A IQK setting */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_Tone_A, bMaskDWord, 0x18008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_Tone_A, bMaskDWord, 0x38008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ -+/* PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_A, bMaskDWord, 0x82160c1f); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_A, bMaskDWord, 0x82130ff0); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_A, bMaskDWord, 0x28110000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_B, bMaskDWord, 0x82110000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_B, bMaskDWord, 0x28110000); -+ -+ /* LO calibration setting */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Rsp, bMaskDWord, 0x0046a911); -+ -+ /* enter IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x808000); -+ -+ /* Ant switch */ -+ if (configPathB || (RF_Path == 0)) -+ /* wifi switch to S1 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, 0x00000000); -+ else -+ /* wifi switch to S0 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, 0x00000280); -+ -+ /* GNT_BT = 0 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord, 0x00000800); -+ -+ /* One shot, path A LOK & IQK */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ /* delay x ms */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_8723B)); */ -+ /* PlatformStallExecution(IQK_DELAY_TIME_8723B*1000); */ -+ mdelay(IQK_DELAY_TIME_8723B); -+ -+ /* restore Ant Path */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, Path_SEL_BB); -+ /* GNT_BT = 1 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord, 0x00001800); -+ -+ /* leave IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ -+ /* Check failed */ -+ regEAC = PHY_QueryBBReg(pDM_Odm->Adapter, rRx_Power_After_IQK_A_2, bMaskDWord); -+ regE94 = PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_Before_IQK_A, bMaskDWord); -+ regE9C = PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_After_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", regEAC)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x, 0xe9c = 0x%x\n", regE94, regE9C)); -+ /* monitor image power before & after IQK */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe90(before IQK) = 0x%x, 0xe98(afer IQK) = 0x%x\n", -+ PHY_QueryBBReg(pDM_Odm->Adapter, 0xe90, bMaskDWord), PHY_QueryBBReg(pDM_Odm->Adapter, 0xe98, bMaskDWord))); -+ -+ /* Allen 20131125 */ -+ tmp = (regE9C & 0x03FF0000)>>16; -+ if ((tmp & 0x200) > 0) -+ tmp = 0x400 - tmp; -+ -+ if ( -+ !(regEAC & BIT28) && -+ (((regE94 & 0x03FF0000)>>16) != 0x142) && -+ (((regE9C & 0x03FF0000)>>16) != 0x42) && -+ (((regE94 & 0x03FF0000)>>16) < 0x110) && -+ (((regE94 & 0x03FF0000)>>16) > 0xf0) && -+ (tmp < 0xf) -+ ) -+ result |= 0x01; -+ else /* if Tx not OK, ignore Rx */ -+ return result; -+ -+ u4tmp = 0x80007C00 | (regE94&0x3FF0000) | ((regE9C&0x3FF0000) >> 16); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK, bMaskDWord, u4tmp); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe40 = 0x%x u4tmp = 0x%x\n", PHY_QueryBBReg(pDM_Odm->Adapter, rTx_IQK, bMaskDWord), u4tmp)); -+ -+ -+ /* 1 RX IQK */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A RX IQK\n")); -+ -+ /* modify RXIQK mode table */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-A Rx IQK modify RXIQK mode table 2!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_RCK_OS, bRFRegOffsetMask, 0x18000); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G1, bRFRegOffsetMask, 0x0001f); -+ /* LAN2 on, PA off for Dcut */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G2, bRFRegOffsetMask, 0xf7d77); -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x0); */ -+ -+ /* PA, PAD setting */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xdf, bRFRegOffsetMask, 0xf80); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0x55, bRFRegOffsetMask, 0x4021f); -+ -+ -+ /* IQK setting */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ /* path-A IQK setting */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_Tone_A, bMaskDWord, 0x38008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_Tone_A, bMaskDWord, 0x18008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_A, bMaskDWord, 0x82110000); -+/* PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_A, bMaskDWord, 0x281604c2); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_A, bMaskDWord, 0x2813001f); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_B, bMaskDWord, 0x82110000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_B, bMaskDWord, 0x28110000); -+ -+ /* LO calibration setting */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Rsp, bMaskDWord, 0x0046a8d1); -+ -+ /* enter IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x808000); -+ -+ /* Ant switch */ -+ if (configPathB || (RF_Path == 0)) -+ /* wifi switch to S1 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, 0x00000000); -+ else -+ /* wifi switch to S0 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, 0x00000280); -+ -+ /* GNT_BT = 0 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord, 0x00000800); -+ -+ /* One shot, path A LOK & IQK */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ /* delay x ms */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E)); */ -+ /* PlatformStallExecution(IQK_DELAY_TIME_8723B*1000); */ -+ mdelay(IQK_DELAY_TIME_8723B); -+ -+ /* restore Ant Path */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, Path_SEL_BB); -+ /* GNT_BT = 1 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord, 0x00001800); -+ -+ /* leave IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ -+ /* Check failed */ -+ regEAC = PHY_QueryBBReg(pDM_Odm->Adapter, rRx_Power_After_IQK_A_2, bMaskDWord); -+ regEA4 = PHY_QueryBBReg(pDM_Odm->Adapter, rRx_Power_Before_IQK_A_2, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", regEAC)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xea4 = 0x%x, 0xeac = 0x%x\n", regEA4, regEAC)); -+ /* monitor image power before & after IQK */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xea0(before IQK) = 0x%x, 0xea8(afer IQK) = 0x%x\n", -+ PHY_QueryBBReg(pDM_Odm->Adapter, 0xea0, bMaskDWord), PHY_QueryBBReg(pDM_Odm->Adapter, 0xea8, bMaskDWord))); -+ -+ /* PA/PAD controlled by 0x0 */ -+ /* leave IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xdf, bRFRegOffsetMask, 0x780); -+ -+ /* Allen 20131125 */ -+ tmp = (regEAC & 0x03FF0000)>>16; -+ if ((tmp & 0x200) > 0) -+ tmp = 0x400 - tmp; -+ -+ if ( -+ !(regEAC & BIT27) && /* if Tx is OK, check whether Rx is OK */ -+ (((regEA4 & 0x03FF0000)>>16) != 0x132) && -+ (((regEAC & 0x03FF0000)>>16) != 0x36) && -+ (((regEA4 & 0x03FF0000)>>16) < 0x110) && -+ (((regEA4 & 0x03FF0000)>>16) > 0xf0) && -+ (tmp < 0xf) -+ ) -+ result |= 0x02; -+ else /* if Tx not OK, ignore Rx */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A Rx IQK fail!!\n")); -+ return result; -+} -+ -+/* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -+static u8 phy_PathB_IQK_8723B(struct adapter *padapter) -+{ -+ u32 regEAC, regE94, regE9C, tmp, Path_SEL_BB/*, regEC4, regECC, Path_SEL_BB*/; -+ u8 result = 0x00; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path B IQK!\n")); -+ -+ /* Save RF Path */ -+ Path_SEL_BB = PHY_QueryBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord); -+ -+ /* leave IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ -+ /* in TXIQK mode */ -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); */ -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_RCK_OS, bRFRegOffsetMask, 0x20000); */ -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G1, bRFRegOffsetMask, 0x0003f); */ -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G2, bRFRegOffsetMask, 0xc7f87); */ -+ /* enable path B PA in TXIQK mode */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xed, 0x20, 0x1); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0x43, bRFRegOffsetMask, 0x30fc1); -+ -+ -+ -+ /* 1 Tx IQK */ -+ /* IQK setting */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK, bMaskDWord, 0x01007c00); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK, bMaskDWord, 0x01004800); -+ /* path-A IQK setting */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-B IQK setting!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_Tone_A, bMaskDWord, 0x18008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_Tone_A, bMaskDWord, 0x38008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ -+/* PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_A, bMaskDWord, 0x82140114); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_A, bMaskDWord, 0x821303ea); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_A, bMaskDWord, 0x28110000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_B, bMaskDWord, 0x82110000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_B, bMaskDWord, 0x28110000); -+ -+ /* LO calibration setting */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Rsp, bMaskDWord, 0x00462911); -+ -+ /* enter IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x808000); -+ -+ /* switch to path B */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, 0x00000280); -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xb0, bRFRegOffsetMask, 0xeffe0); */ -+ -+ /* GNT_BT = 0 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord, 0x00000800); -+ -+ /* One shot, path B LOK & IQK */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path B LOK & IQK!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ /* delay x ms */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay %d ms for One shot, path B LOK & IQK.\n", IQK_DELAY_TIME_88E)); */ -+ /* PlatformStallExecution(IQK_DELAY_TIME_88E*1000); */ -+ mdelay(IQK_DELAY_TIME_8723B); -+ -+ /* restore Ant Path */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, Path_SEL_BB); -+ /* GNT_BT = 1 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord, 0x00001800); -+ -+ /* leave IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0x948 = 0x%x\n", PHY_QueryBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord))); */ -+ -+ -+ /* Check failed */ -+ regEAC = PHY_QueryBBReg(pDM_Odm->Adapter, rRx_Power_After_IQK_A_2, bMaskDWord); -+ regE94 = PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_Before_IQK_A, bMaskDWord); -+ regE9C = PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_After_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", regEAC)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x, 0xe9c = 0x%x\n", regE94, regE9C)); -+ /* monitor image power before & after IQK */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe90(before IQK) = 0x%x, 0xe98(afer IQK) = 0x%x\n", -+ PHY_QueryBBReg(pDM_Odm->Adapter, 0xe90, bMaskDWord), PHY_QueryBBReg(pDM_Odm->Adapter, 0xe98, bMaskDWord))); -+ -+ /* Allen 20131125 */ -+ tmp = (regE9C & 0x03FF0000)>>16; -+ if ((tmp & 0x200) > 0) -+ tmp = 0x400 - tmp; -+ -+ if ( -+ !(regEAC & BIT28) && -+ (((regE94 & 0x03FF0000)>>16) != 0x142) && -+ (((regE9C & 0x03FF0000)>>16) != 0x42) && -+ (((regE94 & 0x03FF0000)>>16) < 0x110) && -+ (((regE94 & 0x03FF0000)>>16) > 0xf0) && -+ (tmp < 0xf) -+ ) -+ result |= 0x01; -+ -+ return result; -+} -+ -+/* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -+static u8 phy_PathB_RxIQK8723B(struct adapter *padapter, bool configPathB) -+{ -+ u32 regE94, regE9C, regEA4, regEAC, u4tmp, tmp, Path_SEL_BB; -+ u8 result = 0x00; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path B Rx IQK!\n")); */ -+ -+ /* Save RF Path */ -+ Path_SEL_BB = PHY_QueryBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord); -+ /* leave IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ -+ /* switch to path B */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, 0x00000280); -+ -+ /* 1 Get TXIMR setting */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path B RX IQK:Get TXIMR setting!\n")); -+ /* modify RXIQK mode table */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-A Rx IQK modify RXIQK mode table!\n")); */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_RCK_OS, bRFRegOffsetMask, 0x18000); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G1, bRFRegOffsetMask, 0x0001f); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G2, bRFRegOffsetMask, 0xf7fb7); -+ /* open PA S1 & SMIXER */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xed, 0x20, 0x1); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0x43, bRFRegOffsetMask, 0x30fcd); -+ -+ -+ /* IQK setting */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK, bMaskDWord, 0x01007c00); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ -+ /* path-B IQK setting */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_Tone_A, bMaskDWord, 0x18008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_Tone_A, bMaskDWord, 0x38008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ -+/* PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_A, bMaskDWord, 0x82160c1f); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_A, bMaskDWord, 0x82130ff0); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_A, bMaskDWord, 0x28110000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_B, bMaskDWord, 0x82110000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_B, bMaskDWord, 0x28110000); -+ -+ /* LO calibration setting */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Rsp, bMaskDWord, 0x0046a911); -+ -+ /* enter IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x808000); -+ -+ /* switch to path B */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, 0x00000280); -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xb0, bRFRegOffsetMask, 0xeffe0); */ -+ -+ /* GNT_BT = 0 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord, 0x00000800); -+ -+ /* One shot, path B TXIQK @ RXIQK */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path B LOK & IQK!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ -+ /* delay x ms */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E)); */ -+ /* PlatformStallExecution(IQK_DELAY_TIME_88E*1000); */ -+ mdelay(IQK_DELAY_TIME_8723B); -+ -+ /* restore Ant Path */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, Path_SEL_BB); -+ /* GNT_BT = 1 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord, 0x00001800); -+ -+ /* leave IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ -+ /* Check failed */ -+ regEAC = PHY_QueryBBReg(pDM_Odm->Adapter, rRx_Power_After_IQK_A_2, bMaskDWord); -+ regE94 = PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_Before_IQK_A, bMaskDWord); -+ regE9C = PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_After_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", regEAC)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x, 0xe9c = 0x%x\n", regE94, regE9C)); -+ /* monitor image power before & after IQK */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe90(before IQK) = 0x%x, 0xe98(afer IQK) = 0x%x\n", -+ PHY_QueryBBReg(pDM_Odm->Adapter, 0xe90, bMaskDWord), PHY_QueryBBReg(pDM_Odm->Adapter, 0xe98, bMaskDWord))); -+ -+ /* Allen 20131125 */ -+ tmp = (regE9C & 0x03FF0000)>>16; -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("tmp1 = 0x%x\n", tmp)); */ -+ if ((tmp & 0x200) > 0) -+ tmp = 0x400 - tmp; -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("tmp2 = 0x%x\n", tmp)); */ -+ -+ if ( -+ !(regEAC & BIT28) && -+ (((regE94 & 0x03FF0000)>>16) != 0x142) && -+ (((regE9C & 0x03FF0000)>>16) != 0x42) && -+ (((regE94 & 0x03FF0000)>>16) < 0x110) && -+ (((regE94 & 0x03FF0000)>>16) > 0xf0) && -+ (tmp < 0xf) -+ ) -+ result |= 0x01; -+ else /* if Tx not OK, ignore Rx */ -+ return result; -+ -+ u4tmp = 0x80007C00 | (regE94&0x3FF0000) | ((regE9C&0x3FF0000) >> 16); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK, bMaskDWord, u4tmp); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe40 = 0x%x u4tmp = 0x%x\n", PHY_QueryBBReg(pDM_Odm->Adapter, rTx_IQK, bMaskDWord), u4tmp)); -+ -+ /* 1 RX IQK */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path B RX IQK\n")); -+ -+ /* modify RXIQK mode table */ -+ /* 20121009, Kordan> RF Mode = 3 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_RCK_OS, bRFRegOffsetMask, 0x18000); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G1, bRFRegOffsetMask, 0x0001f); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G2, bRFRegOffsetMask, 0xf7d77); -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x0); */ -+ -+ /* open PA S1 & close SMIXER */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xed, 0x20, 0x1); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0x43, bRFRegOffsetMask, 0x30ebd); -+ -+ /* PA, PAD setting */ -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xdf, bRFRegOffsetMask, 0xf80); */ -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0x56, bRFRegOffsetMask, 0x51000); */ -+ -+ /* IQK setting */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ /* path-B IQK setting */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_Tone_A, bMaskDWord, 0x38008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_Tone_A, bMaskDWord, 0x18008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_A, bMaskDWord, 0x82110000); -+/* PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_A, bMaskDWord, 0x281604c2); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_A, bMaskDWord, 0x2813001f); -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_PI_B, bMaskDWord, 0x82110000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_PI_B, bMaskDWord, 0x28110000); -+ -+ /* LO calibration setting */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Rsp, bMaskDWord, 0x0046a8d1); -+ -+ /* enter IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x808000); -+ -+ /* switch to path B */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, 0x00000280); -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xb0, bRFRegOffsetMask, 0xeffe0); */ -+ -+ /* GNT_BT = 0 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord, 0x00000800); -+ -+ /* One shot, path B LOK & IQK */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path B LOK & IQK!\n")); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ PHY_SetBBReg(pDM_Odm->Adapter, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ /* delay x ms */ -+/* ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E)); */ -+ /* PlatformStallExecution(IQK_DELAY_TIME_88E*1000); */ -+ mdelay(IQK_DELAY_TIME_8723B); -+ -+ /* restore Ant Path */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, Path_SEL_BB); -+ /* GNT_BT = 1 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord, 0x00001800); -+ -+ /* leave IQK mode */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ -+ /* Check failed */ -+ regEAC = PHY_QueryBBReg(pDM_Odm->Adapter, rRx_Power_After_IQK_A_2, bMaskDWord); -+ regEA4 = PHY_QueryBBReg(pDM_Odm->Adapter, rRx_Power_Before_IQK_A_2, bMaskDWord);; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", regEAC)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xea4 = 0x%x, 0xeac = 0x%x\n", regEA4, regEAC)); -+ /* monitor image power before & after IQK */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xea0(before IQK) = 0x%x, 0xea8(afer IQK) = 0x%x\n", -+ PHY_QueryBBReg(pDM_Odm->Adapter, 0xea0, bMaskDWord), PHY_QueryBBReg(pDM_Odm->Adapter, 0xea8, bMaskDWord))); -+ -+ /* PA/PAD controlled by 0x0 */ -+ /* leave IQK mode */ -+/* PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, 0xffffff00, 0x00000000); */ -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_B, 0xdf, bRFRegOffsetMask, 0x180); */ -+ -+ -+ -+ /* Allen 20131125 */ -+ tmp = (regEAC & 0x03FF0000)>>16; -+ if ((tmp & 0x200) > 0) -+ tmp = 0x400 - tmp; -+ -+ if ( -+ !(regEAC & BIT27) && /* if Tx is OK, check whether Rx is OK */ -+ (((regEA4 & 0x03FF0000)>>16) != 0x132) && -+ (((regEAC & 0x03FF0000)>>16) != 0x36) && -+ (((regEA4 & 0x03FF0000)>>16) < 0x110) && -+ (((regEA4 & 0x03FF0000)>>16) > 0xf0) && -+ (tmp < 0xf) -+ ) -+ result |= 0x02; -+ else -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path B Rx IQK fail!!\n")); -+ -+ return result; -+} -+ -+static void _PHY_PathAFillIQKMatrix8723B( -+ struct adapter *padapter, -+ bool bIQKOK, -+ s32 result[][8], -+ u8 final_candidate, -+ bool bTxOnly -+) -+{ -+ u32 Oldval_0, X, TX0_A, reg; -+ s32 Y, TX0_C; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A IQ Calibration %s !\n", (bIQKOK)?"Success":"Failed")); -+ -+ if (final_candidate == 0xFF) -+ return; -+ -+ else if (bIQKOK) { -+ Oldval_0 = (PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_XATxIQImbalance, bMaskDWord) >> 22) & 0x3FF; -+ -+ X = result[final_candidate][0]; -+ if ((X & 0x00000200) != 0) -+ X = X | 0xFFFFFC00; -+ TX0_A = (X * Oldval_0) >> 8; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX0_A = 0x%x, Oldval_0 0x%x\n", X, TX0_A, Oldval_0)); -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XATxIQImbalance, 0x3FF, TX0_A); -+ -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, BIT(31), ((X*Oldval_0>>7) & 0x1)); -+ -+ Y = result[final_candidate][1]; -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ -+ /* 2 Tx IQC */ -+ TX0_C = (Y * Oldval_0) >> 8; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX = 0x%x\n", Y, TX0_C)); -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XCTxAFE, 0xF0000000, ((TX0_C&0x3C0)>>6)); -+ pRFCalibrateInfo->TxIQC_8723B[PATH_S1][IDX_0xC94][KEY] = rOFDM0_XCTxAFE; -+ pRFCalibrateInfo->TxIQC_8723B[PATH_S1][IDX_0xC94][VAL] = PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_XCTxAFE, bMaskDWord); -+ -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XATxIQImbalance, 0x003F0000, (TX0_C&0x3F)); -+ pRFCalibrateInfo->TxIQC_8723B[PATH_S1][IDX_0xC80][KEY] = rOFDM0_XATxIQImbalance; -+ pRFCalibrateInfo->TxIQC_8723B[PATH_S1][IDX_0xC80][VAL] = PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_XATxIQImbalance, bMaskDWord); -+ -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, BIT(29), ((Y*Oldval_0>>7) & 0x1)); -+ pRFCalibrateInfo->TxIQC_8723B[PATH_S1][IDX_0xC4C][KEY] = rOFDM0_ECCAThreshold; -+ pRFCalibrateInfo->TxIQC_8723B[PATH_S1][IDX_0xC4C][VAL] = PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, bMaskDWord); -+ -+ if (bTxOnly) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_PHY_PathAFillIQKMatrix8723B only Tx OK\n")); -+ -+ /* <20130226, Kordan> Saving RxIQC, otherwise not initialized. */ -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xCA0][KEY] = rOFDM0_RxIQExtAnta; -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xCA0][VAL] = 0xfffffff & PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_RxIQExtAnta, bMaskDWord); -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xC14][KEY] = rOFDM0_XARxIQImbalance; -+/* pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xC14][VAL] = PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_XARxIQImbalance, bMaskDWord); */ -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xC14][VAL] = 0x40000100; -+ return; -+ } -+ -+ reg = result[final_candidate][2]; -+ -+ /* 2 Rx IQC */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XARxIQImbalance, 0x3FF, reg); -+ reg = result[final_candidate][3] & 0x3F; -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XARxIQImbalance, 0xFC00, reg); -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xC14][KEY] = rOFDM0_XARxIQImbalance; -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xC14][VAL] = PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_XARxIQImbalance, bMaskDWord); -+ -+ reg = (result[final_candidate][3] >> 6) & 0xF; -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_RxIQExtAnta, 0xF0000000, reg); -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xCA0][KEY] = rOFDM0_RxIQExtAnta; -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xCA0][VAL] = PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_RxIQExtAnta, bMaskDWord); -+ -+ } -+} -+ -+static void _PHY_PathBFillIQKMatrix8723B( -+ struct adapter *padapter, -+ bool bIQKOK, -+ s32 result[][8], -+ u8 final_candidate, -+ bool bTxOnly /* do Tx only */ -+) -+{ -+ u32 Oldval_1, X, TX1_A, reg; -+ s32 Y, TX1_C; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path B IQ Calibration %s !\n", (bIQKOK)?"Success":"Failed")); -+ -+ if (final_candidate == 0xFF) -+ return; -+ -+ else if (bIQKOK) { -+ Oldval_1 = (PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_XBTxIQImbalance, bMaskDWord) >> 22) & 0x3FF; -+ -+ X = result[final_candidate][4]; -+ if ((X & 0x00000200) != 0) -+ X = X | 0xFFFFFC00; -+ TX1_A = (X * Oldval_1) >> 8; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX1_A = 0x%x\n", X, TX1_A)); -+ -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XBTxIQImbalance, 0x3FF, TX1_A); -+ -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, BIT(27), ((X*Oldval_1>>7) & 0x1)); -+ -+ Y = result[final_candidate][5]; -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ -+ TX1_C = (Y * Oldval_1) >> 8; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C)); -+ -+ /* 2 Tx IQC */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XDTxAFE, 0xF0000000, ((TX1_C&0x3C0)>>6)); -+/* pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC9C][KEY] = rOFDM0_XDTxAFE; */ -+/* pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC9C][VAL] = PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_XDTxAFE, bMaskDWord); */ -+ pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC94][KEY] = rOFDM0_XCTxAFE; -+ pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC94][VAL] = PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_XDTxAFE, bMaskDWord); -+ -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XBTxIQImbalance, 0x003F0000, (TX1_C&0x3F)); -+ pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC80][KEY] = rOFDM0_XATxIQImbalance; -+ pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC80][VAL] = PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_XBTxIQImbalance, bMaskDWord); -+ -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, BIT(25), ((Y*Oldval_1>>7) & 0x1)); -+ pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC4C][KEY] = rOFDM0_ECCAThreshold; -+ pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC4C][VAL] = PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, bMaskDWord); -+ -+ if (bTxOnly) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_PHY_PathBFillIQKMatrix8723B only Tx OK\n")); -+ -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xC14][KEY] = rOFDM0_XARxIQImbalance; -+/* pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xC14][VAL] = PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_XARxIQImbalance, bMaskDWord); */ -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xC14][VAL] = 0x40000100; -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xCA0][KEY] = rOFDM0_RxIQExtAnta; -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xCA0][VAL] = 0x0fffffff & PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_RxIQExtAnta, bMaskDWord); -+ return; -+ } -+ -+ /* 2 Rx IQC */ -+ reg = result[final_candidate][6]; -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XBRxIQImbalance, 0x3FF, reg); -+ reg = result[final_candidate][7] & 0x3F; -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XBRxIQImbalance, 0xFC00, reg); -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xC14][KEY] = rOFDM0_XARxIQImbalance; -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xC14][VAL] = PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_XBRxIQImbalance, bMaskDWord); -+ -+ reg = (result[final_candidate][7] >> 6) & 0xF; -+/* PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_AGCRSSITable, 0x0000F000, reg); */ -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xCA0][KEY] = rOFDM0_RxIQExtAnta; -+ pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xCA0][VAL] = (reg << 28)|(PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_RxIQExtAnta, bMaskDWord)&0x0fffffff); -+ } -+} -+ -+/* */ -+/* 2011/07/26 MH Add an API for testing IQK fail case. */ -+/* */ -+/* MP Already declare in odm.c */ -+ -+void ODM_SetIQCbyRFpath(PDM_ODM_T pDM_Odm, u32 RFpath) -+{ -+ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ if ( -+ (pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC80][VAL] != 0x0) && -+ (pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xC14][VAL] != 0x0) && -+ (pRFCalibrateInfo->TxIQC_8723B[PATH_S1][IDX_0xC80][VAL] != 0x0) && -+ (pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xC14][VAL] != 0x0) -+ ) { -+ if (RFpath) { /* S1: RFpath = 0, S0:RFpath = 1 */ -+ /* S0 TX IQC */ -+ PHY_SetBBReg(pDM_Odm->Adapter, pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC94][KEY], bMaskDWord, pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC94][VAL]); -+ PHY_SetBBReg(pDM_Odm->Adapter, pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC80][KEY], bMaskDWord, pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC80][VAL]); -+ PHY_SetBBReg(pDM_Odm->Adapter, pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC4C][KEY], bMaskDWord, pRFCalibrateInfo->TxIQC_8723B[PATH_S0][IDX_0xC4C][VAL]); -+ /* S0 RX IQC */ -+ PHY_SetBBReg(pDM_Odm->Adapter, pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xC14][KEY], bMaskDWord, pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xC14][VAL]); -+ PHY_SetBBReg(pDM_Odm->Adapter, pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xCA0][KEY], bMaskDWord, pRFCalibrateInfo->RxIQC_8723B[PATH_S0][IDX_0xCA0][VAL]); -+ } else { -+ /* S1 TX IQC */ -+ PHY_SetBBReg(pDM_Odm->Adapter, pRFCalibrateInfo->TxIQC_8723B[PATH_S1][IDX_0xC94][KEY], bMaskDWord, pRFCalibrateInfo->TxIQC_8723B[PATH_S1][IDX_0xC94][VAL]); -+ PHY_SetBBReg(pDM_Odm->Adapter, pRFCalibrateInfo->TxIQC_8723B[PATH_S1][IDX_0xC80][KEY], bMaskDWord, pRFCalibrateInfo->TxIQC_8723B[PATH_S1][IDX_0xC80][VAL]); -+ PHY_SetBBReg(pDM_Odm->Adapter, pRFCalibrateInfo->TxIQC_8723B[PATH_S1][IDX_0xC4C][KEY], bMaskDWord, pRFCalibrateInfo->TxIQC_8723B[PATH_S1][IDX_0xC4C][VAL]); -+ /* S1 RX IQC */ -+ PHY_SetBBReg(pDM_Odm->Adapter, pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xC14][KEY], bMaskDWord, pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xC14][VAL]); -+ PHY_SetBBReg(pDM_Odm->Adapter, pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xCA0][KEY], bMaskDWord, pRFCalibrateInfo->RxIQC_8723B[PATH_S1][IDX_0xCA0][VAL]); -+ } -+ } -+} -+ -+static bool ODM_CheckPowerStatus(struct adapter *Adapter) -+{ -+ return true; -+} -+ -+static void _PHY_SaveADDARegisters8723B( -+ struct adapter *padapter, -+ u32 *ADDAReg, -+ u32 *ADDABackup, -+ u32 RegisterNum -+) -+{ -+ u32 i; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ if (ODM_CheckPowerStatus(padapter) == false) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Save ADDA parameters.\n")); -+ for (i = 0 ; i < RegisterNum ; i++) { -+ ADDABackup[i] = PHY_QueryBBReg(pDM_Odm->Adapter, ADDAReg[i], bMaskDWord); -+ } -+} -+ -+ -+static void _PHY_SaveMACRegisters8723B( -+ struct adapter *padapter, u32 *MACReg, u32 *MACBackup -+) -+{ -+ u32 i; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Save MAC parameters.\n")); -+ for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) { -+ MACBackup[i] = rtw_read8(pDM_Odm->Adapter, MACReg[i]); -+ } -+ MACBackup[i] = rtw_read32(pDM_Odm->Adapter, MACReg[i]); -+ -+} -+ -+ -+static void _PHY_ReloadADDARegisters8723B( -+ struct adapter *padapter, -+ u32 *ADDAReg, -+ u32 *ADDABackup, -+ u32 RegiesterNum -+) -+{ -+ u32 i; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Reload ADDA power saving parameters !\n")); -+ for (i = 0 ; i < RegiesterNum; i++) { -+ PHY_SetBBReg(pDM_Odm->Adapter, ADDAReg[i], bMaskDWord, ADDABackup[i]); -+ } -+} -+ -+static void _PHY_ReloadMACRegisters8723B( -+ struct adapter *padapter, u32 *MACReg, u32 *MACBackup -+) -+{ -+ u32 i; -+ -+ for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) { -+ rtw_write8(padapter, MACReg[i], (u8)MACBackup[i]); -+ } -+ rtw_write32(padapter, MACReg[i], MACBackup[i]); -+} -+ -+ -+static void _PHY_PathADDAOn8723B( -+ struct adapter *padapter, -+ u32 *ADDAReg, -+ bool isPathAOn, -+ bool is2T -+) -+{ -+ u32 pathOn; -+ u32 i; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("ADDA ON.\n")); -+ -+ pathOn = isPathAOn ? 0x01c00014 : 0x01c00014; -+ if (false == is2T) { -+ pathOn = 0x01c00014; -+ PHY_SetBBReg(pDM_Odm->Adapter, ADDAReg[0], bMaskDWord, 0x01c00014); -+ } else { -+ PHY_SetBBReg(pDM_Odm->Adapter, ADDAReg[0], bMaskDWord, pathOn); -+ } -+ -+ for (i = 1 ; i < IQK_ADDA_REG_NUM ; i++) { -+ PHY_SetBBReg(pDM_Odm->Adapter, ADDAReg[i], bMaskDWord, pathOn); -+ } -+ -+} -+ -+static void _PHY_MACSettingCalibration8723B( -+ struct adapter *padapter, u32 *MACReg, u32 *MACBackup -+) -+{ -+ u32 i = 0; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("MAC settings for Calibration.\n")); -+ -+ rtw_write8(pDM_Odm->Adapter, MACReg[i], 0x3F); -+ -+ for (i = 1 ; i < (IQK_MAC_REG_NUM - 1); i++) { -+ rtw_write8(pDM_Odm->Adapter, MACReg[i], (u8)(MACBackup[i]&(~BIT3))); -+ } -+ rtw_write8(pDM_Odm->Adapter, MACReg[i], (u8)(MACBackup[i]&(~BIT5))); -+ -+} -+ -+static bool phy_SimularityCompare_8723B( -+ struct adapter *padapter, -+ s32 result[][8], -+ u8 c1, -+ u8 c2 -+) -+{ -+ u32 i, j, diff, SimularityBitMap, bound = 0; -+ u8 final_candidate[2] = {0xFF, 0xFF}; /* for path A and path B */ -+ bool bResult = true; -+ bool is2T = true; -+ s32 tmp1 = 0, tmp2 = 0; -+ -+ if (is2T) -+ bound = 8; -+ else -+ bound = 4; -+ -+ SimularityBitMap = 0; -+ -+ for (i = 0; i < bound; i++) { -+ -+ if ((i == 1) || (i == 3) || (i == 5) || (i == 7)) { -+ if ((result[c1][i] & 0x00000200) != 0) -+ tmp1 = result[c1][i] | 0xFFFFFC00; -+ else -+ tmp1 = result[c1][i]; -+ -+ if ((result[c2][i] & 0x00000200) != 0) -+ tmp2 = result[c2][i] | 0xFFFFFC00; -+ else -+ tmp2 = result[c2][i]; -+ } else { -+ tmp1 = result[c1][i]; -+ tmp2 = result[c2][i]; -+ } -+ -+ diff = (tmp1 > tmp2) ? (tmp1 - tmp2) : (tmp2 - tmp1); -+ -+ if (diff > MAX_TOLERANCE) { -+ if ((i == 2 || i == 6) && !SimularityBitMap) { -+ if (result[c1][i]+result[c1][i+1] == 0) -+ final_candidate[(i/4)] = c2; -+ else if (result[c2][i]+result[c2][i+1] == 0) -+ final_candidate[(i/4)] = c1; -+ else -+ SimularityBitMap = SimularityBitMap|(1<odmpriv; -+ -+ u32 i; -+ u8 PathAOK, PathBOK; -+ u8 tmp0xc50 = (u8)PHY_QueryBBReg(pDM_Odm->Adapter, 0xC50, bMaskByte0); -+ u8 tmp0xc58 = (u8)PHY_QueryBBReg(pDM_Odm->Adapter, 0xC58, bMaskByte0); -+ u32 ADDA_REG[IQK_ADDA_REG_NUM] = { -+ rFPGA0_XCD_SwitchControl, -+ rBlue_Tooth, -+ rRx_Wait_CCA, -+ rTx_CCK_RFON, -+ rTx_CCK_BBON, -+ rTx_OFDM_RFON, -+ rTx_OFDM_BBON, -+ rTx_To_Rx, -+ rTx_To_Tx, -+ rRx_CCK, -+ rRx_OFDM, -+ rRx_Wait_RIFS, -+ rRx_TO_Rx, -+ rStandby, -+ rSleep, -+ rPMPD_ANAEN -+ }; -+ u32 IQK_MAC_REG[IQK_MAC_REG_NUM] = { -+ REG_TXPAUSE, -+ REG_BCN_CTRL, -+ REG_BCN_CTRL_1, -+ REG_GPIO_MUXCFG -+ }; -+ -+ /* since 92C & 92D have the different define in IQK_BB_REG */ -+ u32 IQK_BB_REG_92C[IQK_BB_REG_NUM] = { -+ rOFDM0_TRxPathEnable, -+ rOFDM0_TRMuxPar, -+ rFPGA0_XCD_RFInterfaceSW, -+ rConfig_AntA, -+ rConfig_AntB, -+ rFPGA0_XAB_RFInterfaceSW, -+ rFPGA0_XA_RFInterfaceOE, -+ rFPGA0_XB_RFInterfaceOE, -+ rCCK0_AFESetting -+ }; -+ const u32 retryCount = 2; -+ -+ /* Note: IQ calibration must be performed after loading */ -+ /* PHY_REG.txt , and radio_a, radio_b.txt */ -+ -+ /* u32 bbvalue; */ -+ -+ if (t == 0) { -+/* bbvalue = PHY_QueryBBReg(pDM_Odm->Adapter, rFPGA0_RFMOD, bMaskDWord); */ -+/* RT_DISP(FINIT, INIT_IQK, ("phy_IQCalibrate_8188E() ==>0x%08x\n", bbvalue)); */ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQ Calibration for %s for %d times\n", (is2T ? "2T2R" : "1T1R"), t)); -+ -+ /* Save ADDA parameters, turn Path A ADDA on */ -+ _PHY_SaveADDARegisters8723B(padapter, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); -+ _PHY_SaveMACRegisters8723B(padapter, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); -+ _PHY_SaveADDARegisters8723B(padapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQ Calibration for %s for %d times\n", (is2T ? "2T2R" : "1T1R"), t)); -+ -+ _PHY_PathADDAOn8723B(padapter, ADDA_REG, true, is2T); -+ -+/* no serial mode */ -+ -+ /* save RF path for 8723B */ -+/* Path_SEL_BB = PHY_QueryBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord); */ -+/* Path_SEL_RF = PHY_QueryRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xb0, 0xfffff); */ -+ -+ /* MAC settings */ -+ _PHY_MACSettingCalibration8723B(padapter, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); -+ -+ /* BB setting */ -+ /* PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_RFMOD, BIT24, 0x00); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rCCK0_AFESetting, 0x0f000000, 0xf); -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_TRxPathEnable, bMaskDWord, 0x03a05600); -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_TRMuxPar, bMaskDWord, 0x000800e4); -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x22204000); -+ -+ -+/* PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0x01); */ -+/* PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0x01); */ -+/* PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_XA_RFInterfaceOE, BIT10, 0x00); */ -+/* PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0x00); */ -+ -+ -+/* RX IQ calibration setting for 8723B D cut large current issue when leaving IPS */ -+ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_RCK_OS, bRFRegOffsetMask, 0x30000); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G1, bRFRegOffsetMask, 0x0001f); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G2, bRFRegOffsetMask, 0xf7fb7); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xed, 0x20, 0x1); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0x43, bRFRegOffsetMask, 0x60fbd); -+ -+/* path A TX IQK */ -+ for (i = 0 ; i < retryCount ; i++) { -+ PathAOK = phy_PathA_IQK_8723B(padapter, is2T, RF_Path); -+/* if (PathAOK == 0x03) { */ -+ if (PathAOK == 0x01) { -+ /* Path A Tx IQK Success */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ pDM_Odm->RFCalibrateInfo.TxLOK[ODM_RF_PATH_A] = PHY_QueryRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0x8, bRFRegOffsetMask); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A Tx IQK Success!!\n")); -+ result[t][0] = (PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ result[t][1] = (PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ break; -+ } -+ } -+ -+/* path A RXIQK */ -+ for (i = 0 ; i < retryCount ; i++) { -+ PathAOK = phy_PathA_RxIQK8723B(padapter, is2T, RF_Path); -+ if (PathAOK == 0x03) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A Rx IQK Success!!\n")); -+/* result[t][0] = (PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; */ -+/* result[t][1] = (PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; */ -+ result[t][2] = (PHY_QueryBBReg(pDM_Odm->Adapter, rRx_Power_Before_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; -+ result[t][3] = (PHY_QueryBBReg(pDM_Odm->Adapter, rRx_Power_After_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; -+ break; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A Rx IQK Fail!!\n")); -+ } -+ } -+ -+ if (0x00 == PathAOK) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A IQK failed!!\n")); -+ } -+ -+/* path B IQK */ -+ if (is2T) { -+ -+ /* path B TX IQK */ -+ for (i = 0 ; i < retryCount ; i++) { -+ PathBOK = phy_PathB_IQK_8723B(padapter); -+ if (PathBOK == 0x01) { -+ /* Path B Tx IQK Success */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0x000000); -+ pDM_Odm->RFCalibrateInfo.TxLOK[ODM_RF_PATH_B] = PHY_QueryRFReg(pDM_Odm->Adapter, ODM_RF_PATH_B, 0x8, bRFRegOffsetMask); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path B Tx IQK Success!!\n")); -+ result[t][4] = (PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ result[t][5] = (PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ break; -+ } -+ } -+ -+/* path B RX IQK */ -+ for (i = 0 ; i < retryCount ; i++) { -+ PathBOK = phy_PathB_RxIQK8723B(padapter, is2T); -+ if (PathBOK == 0x03) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path B Rx IQK Success!!\n")); -+/* result[t][0] = (PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; */ -+/* result[t][1] = (PHY_QueryBBReg(pDM_Odm->Adapter, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; */ -+ result[t][6] = (PHY_QueryBBReg(pDM_Odm->Adapter, rRx_Power_Before_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; -+ result[t][7] = (PHY_QueryBBReg(pDM_Odm->Adapter, rRx_Power_After_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; -+ break; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path B Rx IQK Fail!!\n")); -+ } -+ } -+ -+/* Allen end */ -+ if (0x00 == PathBOK) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path B IQK failed!!\n")); -+ } -+ } -+ -+ /* Back to BB mode, load original value */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Back to BB mode, load original value!\n")); -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_IQK, bMaskH3Bytes, 0); -+ -+ if (t != 0) { -+ /* Reload ADDA power saving parameters */ -+ _PHY_ReloadADDARegisters8723B(padapter, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); -+ -+ /* Reload MAC parameters */ -+ _PHY_ReloadMACRegisters8723B(padapter, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); -+ -+ _PHY_ReloadADDARegisters8723B(padapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); -+ -+ /* Reload RF path */ -+/* PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, Path_SEL_BB); */ -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xb0, 0xfffff, Path_SEL_RF); */ -+ -+ /* Allen initial gain 0xc50 */ -+ /* Restore RX initial gain */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0xc50, bMaskByte0, 0x50); -+ PHY_SetBBReg(pDM_Odm->Adapter, 0xc50, bMaskByte0, tmp0xc50); -+ if (is2T) { -+ PHY_SetBBReg(pDM_Odm->Adapter, 0xc58, bMaskByte0, 0x50); -+ PHY_SetBBReg(pDM_Odm->Adapter, 0xc58, bMaskByte0, tmp0xc58); -+ } -+ -+ /* load 0xe30 IQC default value */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ PHY_SetBBReg(pDM_Odm->Adapter, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_IQCalibrate_8723B() <==\n")); -+ -+} -+ -+ -+static void phy_LCCalibrate_8723B(PDM_ODM_T pDM_Odm, bool is2T) -+{ -+ u8 tmpReg; -+ u32 RF_Amode = 0, RF_Bmode = 0, LC_Cal; -+ struct adapter *padapter = pDM_Odm->Adapter; -+ -+ /* Check continuous TX and Packet TX */ -+ tmpReg = rtw_read8(pDM_Odm->Adapter, 0xd03); -+ -+ if ((tmpReg&0x70) != 0) /* Deal with contisuous TX case */ -+ rtw_write8(pDM_Odm->Adapter, 0xd03, tmpReg&0x8F); /* disable all continuous TX */ -+ else /* Deal with Packet TX case */ -+ rtw_write8(pDM_Odm->Adapter, REG_TXPAUSE, 0xFF); /* block all queues */ -+ -+ if ((tmpReg&0x70) != 0) { -+ /* 1. Read original RF mode */ -+ /* Path-A */ -+ RF_Amode = PHY_QueryRFReg(padapter, ODM_RF_PATH_A, RF_AC, bMask12Bits); -+ -+ /* Path-B */ -+ if (is2T) -+ RF_Bmode = PHY_QueryRFReg(padapter, ODM_RF_PATH_B, RF_AC, bMask12Bits); -+ -+ /* 2. Set RF mode = standby mode */ -+ /* Path-A */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_AC, bMask12Bits, (RF_Amode&0x8FFFF)|0x10000); -+ -+ /* Path-B */ -+ if (is2T) -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_B, RF_AC, bMask12Bits, (RF_Bmode&0x8FFFF)|0x10000); -+ } -+ -+ /* 3. Read RF reg18 */ -+ LC_Cal = PHY_QueryRFReg(padapter, ODM_RF_PATH_A, RF_CHNLBW, bMask12Bits); -+ -+ /* 4. Set LC calibration begin bit15 */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xB0, bRFRegOffsetMask, 0xDFBE0); /* LDO ON */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_CHNLBW, bMask12Bits, LC_Cal|0x08000); -+ -+ mdelay(100); -+ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xB0, bRFRegOffsetMask, 0xDFFE0); /* LDO OFF */ -+ -+ /* Channel 10 LC calibration issue for 8723bs with 26M xtal */ -+ if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO && pDM_Odm->PackageType >= 0x2) { -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_CHNLBW, bMask12Bits, LC_Cal); -+ } -+ -+ /* Restore original situation */ -+ if ((tmpReg&0x70) != 0) { /* Deal with contisuous TX case */ -+ /* Path-A */ -+ rtw_write8(pDM_Odm->Adapter, 0xd03, tmpReg); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_AC, bMask12Bits, RF_Amode); -+ -+ /* Path-B */ -+ if (is2T) -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_B, RF_AC, bMask12Bits, RF_Bmode); -+ } else /* Deal with Packet TX case */ -+ rtw_write8(pDM_Odm->Adapter, REG_TXPAUSE, 0x00); -+} -+ -+/* Analog Pre-distortion calibration */ -+#define APK_BB_REG_NUM 8 -+#define APK_CURVE_REG_NUM 4 -+#define PATH_NUM 2 -+ -+#define DP_BB_REG_NUM 7 -+#define DP_RF_REG_NUM 1 -+#define DP_RETRY_LIMIT 10 -+#define DP_PATH_NUM 2 -+#define DP_DPK_NUM 3 -+#define DP_DPK_VALUE_NUM 2 -+ -+ -+ -+/* IQK version:V2.5 20140123 */ -+/* IQK is controlled by Is2ant, RF path */ -+void PHY_IQCalibrate_8723B( -+ struct adapter *padapter, -+ bool bReCovery, -+ bool bRestore, -+ bool Is2ant, /* false:1ant, true:2-ant */ -+ u8 RF_Path /* 0:S1, 1:S0 */ -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ s32 result[4][8]; /* last is final result */ -+ u8 i, final_candidate, Indexforchannel; -+ bool bPathAOK, bPathBOK; -+ s32 RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC, RegTmp = 0; -+ bool is12simular, is13simular, is23simular; -+ bool bSingleTone = false, bCarrierSuppression = false; -+ u32 IQK_BB_REG_92C[IQK_BB_REG_NUM] = { -+ rOFDM0_XARxIQImbalance, -+ rOFDM0_XBRxIQImbalance, -+ rOFDM0_ECCAThreshold, -+ rOFDM0_AGCRSSITable, -+ rOFDM0_XATxIQImbalance, -+ rOFDM0_XBTxIQImbalance, -+ rOFDM0_XCTxAFE, -+ rOFDM0_XDTxAFE, -+ rOFDM0_RxIQExtAnta -+ }; -+/* u32 Path_SEL_BB = 0; */ -+ u32 GNT_BT_default; -+ u32 StartTime; -+ s32 ProgressingTime; -+ -+ if (ODM_CheckPowerStatus(padapter) == false) -+ return; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)) -+ return; -+ -+ /* 20120213 Turn on when continuous Tx to pass lab testing. (required by Edlu) */ -+ if (bSingleTone || bCarrierSuppression) -+ return; -+ -+#if DISABLE_BB_RF -+ return; -+#endif -+ if (pDM_Odm->RFCalibrateInfo.bIQKInProgress) -+ return; -+ -+ -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = true; -+ -+ if (bRestore) { -+ u32 offset, data; -+ u8 path, bResult = SUCCESS; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ path = (PHY_QueryBBReg(pDM_Odm->Adapter, rS0S1_PathSwitch, bMaskByte0) == 0x00) ? ODM_RF_PATH_A : ODM_RF_PATH_B; -+ -+ /* Restore TX IQK */ -+ for (i = 0; i < 3; ++i) { -+ offset = pRFCalibrateInfo->TxIQC_8723B[path][i][0]; -+ data = pRFCalibrateInfo->TxIQC_8723B[path][i][1]; -+ if ((offset == 0) || (data == 0)) { -+ DBG_871X( -+ "%s =>path:%s Restore TX IQK result failed\n", -+ __func__, -+ (path == ODM_RF_PATH_A)?"A":"B" -+ ); -+ bResult = FAIL; -+ break; -+ } -+ /* RT_TRACE(_module_mp_, _drv_notice_, ("Switch to S1 TxIQC(offset, data) = (0x%X, 0x%X)\n", offset, data)); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, offset, bMaskDWord, data); -+ } -+ -+ /* Restore RX IQK */ -+ for (i = 0; i < 2; ++i) { -+ offset = pRFCalibrateInfo->RxIQC_8723B[path][i][0]; -+ data = pRFCalibrateInfo->RxIQC_8723B[path][i][1]; -+ if ((offset == 0) || (data == 0)) { -+ DBG_871X( -+ "%s =>path:%s Restore RX IQK result failed\n", -+ __func__, -+ (path == ODM_RF_PATH_A)?"A":"B" -+ ); -+ bResult = FAIL; -+ break; -+ } -+ /* RT_TRACE(_module_mp_, _drv_notice_, ("Switch to S1 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data)); */ -+ PHY_SetBBReg(pDM_Odm->Adapter, offset, bMaskDWord, data); -+ } -+ -+ if (pDM_Odm->RFCalibrateInfo.TxLOK[ODM_RF_PATH_A] == 0) { -+ DBG_871X("%s => Restore Path-A TxLOK result failed\n", __func__); -+ bResult = FAIL; -+ } else { -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXM_IDAC, bRFRegOffsetMask, pDM_Odm->RFCalibrateInfo.TxLOK[ODM_RF_PATH_A]); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_B, RF_TXM_IDAC, bRFRegOffsetMask, pDM_Odm->RFCalibrateInfo.TxLOK[ODM_RF_PATH_B]); -+ } -+ -+ if (bResult == SUCCESS) -+ return; -+ } -+ -+ if (bReCovery) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("PHY_IQCalibrate_8723B: Return due to bReCovery!\n")); -+ _PHY_ReloadADDARegisters8723B(padapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, 9); -+ return; -+ } -+ StartTime = jiffies; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Start!!!\n")); -+ -+ /* save default GNT_BT */ -+ GNT_BT_default = PHY_QueryBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord); -+ /* Save RF Path */ -+/* Path_SEL_BB = PHY_QueryBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord); */ -+/* Path_SEL_RF = PHY_QueryRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xb0, 0xfffff); */ -+ -+ /* set GNT_BT = 0, pause BT traffic */ -+/* PHY_SetBBReg(pDM_Odm->Adapter, 0x764, BIT12, 0x0); */ -+/* PHY_SetBBReg(pDM_Odm->Adapter, 0x764, BIT11, 0x1); */ -+ -+ -+ for (i = 0; i < 8; i++) { -+ result[0][i] = 0; -+ result[1][i] = 0; -+ result[2][i] = 0; -+ result[3][i] = 0; -+ } -+ -+ final_candidate = 0xff; -+ bPathAOK = false; -+ bPathBOK = false; -+ is12simular = false; -+ is23simular = false; -+ is13simular = false; -+ -+ -+ for (i = 0; i < 3; i++) { -+ phy_IQCalibrate_8723B(padapter, result, i, Is2ant, RF_Path); -+ -+ if (i == 1) { -+ is12simular = phy_SimularityCompare_8723B(padapter, result, 0, 1); -+ if (is12simular) { -+ final_candidate = 0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is12simular final_candidate is %x\n", final_candidate)); -+ break; -+ } -+ } -+ -+ if (i == 2) { -+ is13simular = phy_SimularityCompare_8723B(padapter, result, 0, 2); -+ if (is13simular) { -+ final_candidate = 0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is13simular final_candidate is %x\n", final_candidate)); -+ -+ break; -+ } -+ -+ is23simular = phy_SimularityCompare_8723B(padapter, result, 1, 2); -+ if (is23simular) { -+ final_candidate = 1; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is23simular final_candidate is %x\n", final_candidate)); -+ } else { -+ for (i = 0; i < 8; i++) -+ RegTmp += result[3][i]; -+ -+ if (RegTmp != 0) -+ final_candidate = 3; -+ else -+ final_candidate = 0xFF; -+ } -+ } -+ } -+/* RT_TRACE(COMP_INIT, DBG_LOUD, ("Release Mutex in IQCalibrate\n")); */ -+ -+ for (i = 0; i < 4; i++) { -+ RegE94 = result[i][0]; -+ RegE9C = result[i][1]; -+ RegEA4 = result[i][2]; -+ RegEAC = result[i][3]; -+ RegEB4 = result[i][4]; -+ RegEBC = result[i][5]; -+ RegEC4 = result[i][6]; -+ RegECC = result[i][7]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: RegE94 =%x RegE9C =%x RegEA4 =%x RegEAC =%x RegEB4 =%x RegEBC =%x RegEC4 =%x RegECC =%x\n ", RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC)); -+ } -+ -+ if (final_candidate != 0xff) { -+ pDM_Odm->RFCalibrateInfo.RegE94 = RegE94 = result[final_candidate][0]; -+ pDM_Odm->RFCalibrateInfo.RegE9C = RegE9C = result[final_candidate][1]; -+ RegEA4 = result[final_candidate][2]; -+ RegEAC = result[final_candidate][3]; -+ pDM_Odm->RFCalibrateInfo.RegEB4 = RegEB4 = result[final_candidate][4]; -+ pDM_Odm->RFCalibrateInfo.RegEBC = RegEBC = result[final_candidate][5]; -+ RegEC4 = result[final_candidate][6]; -+ RegECC = result[final_candidate][7]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: final_candidate is %x\n", final_candidate)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: RegE94 =%x RegE9C =%x RegEA4 =%x RegEAC =%x RegEB4 =%x RegEBC =%x RegEC4 =%x RegECC =%x\n ", RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC)); -+ bPathAOK = bPathBOK = true; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: FAIL use default value\n")); -+ -+ pDM_Odm->RFCalibrateInfo.RegE94 = pDM_Odm->RFCalibrateInfo.RegEB4 = 0x100; /* X default value */ -+ pDM_Odm->RFCalibrateInfo.RegE9C = pDM_Odm->RFCalibrateInfo.RegEBC = 0x0; /* Y default value */ -+ } -+ -+ { -+ if (RegE94 != 0) -+ _PHY_PathAFillIQKMatrix8723B(padapter, bPathAOK, result, final_candidate, (RegEA4 == 0)); -+ } -+ { -+ if (RegEB4 != 0) -+ _PHY_PathBFillIQKMatrix8723B(padapter, bPathBOK, result, final_candidate, (RegEC4 == 0)); -+ } -+ -+ Indexforchannel = ODM_GetRightChnlPlaceforIQK(pHalData->CurrentChannel); -+ -+/* To Fix BSOD when final_candidate is 0xff */ -+/* by sherry 20120321 */ -+ if (final_candidate < 4) { -+ for (i = 0; i < IQK_Matrix_REG_NUM; i++) -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[Indexforchannel].Value[0][i] = result[final_candidate][i]; -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[Indexforchannel].bIQKDone = true; -+ } -+ /* RT_DISP(FINIT, INIT_IQK, ("\nIQK OK Indexforchannel %d.\n", Indexforchannel)); */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\nIQK OK Indexforchannel %d.\n", Indexforchannel)); -+ -+ _PHY_SaveADDARegisters8723B(padapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, 9); -+ -+ /* restore GNT_BT */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x764, bMaskDWord, GNT_BT_default); -+ /* Restore RF Path */ -+/* PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, Path_SEL_BB); */ -+/* PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xb0, 0xfffff, Path_SEL_RF); */ -+ -+ /* Resotr RX mode table parameter */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_RCK_OS, bRFRegOffsetMask, 0x18000); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G1, bRFRegOffsetMask, 0x0001f); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_TXPA_G2, bRFRegOffsetMask, 0xe6177); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0xed, 0x20, 0x1); -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, 0x43, bRFRegOffsetMask, 0x300bd); -+ -+ /* set GNT_BT = HW control */ -+/* PHY_SetBBReg(pDM_Odm->Adapter, 0x764, BIT12, 0x0); */ -+/* PHY_SetBBReg(pDM_Odm->Adapter, 0x764, BIT11, 0x0); */ -+ -+ if (Is2ant) { -+ if (RF_Path == 0x0) /* S1 */ -+ ODM_SetIQCbyRFpath(pDM_Odm, 0); -+ else /* S0 */ -+ ODM_SetIQCbyRFpath(pDM_Odm, 1); -+ } -+ -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = false; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK finished\n")); -+ ProgressingTime = jiffies_to_msecs(jiffies - StartTime); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK ProgressingTime = %d\n", ProgressingTime)); -+ -+ -+} -+ -+ -+void PHY_LCCalibrate_8723B(PDM_ODM_T pDM_Odm) -+{ -+ bool bSingleTone = false, bCarrierSuppression = false; -+ u32 timeout = 2000, timecount = 0; -+ u32 StartTime; -+ s32 ProgressingTime; -+ -+#if DISABLE_BB_RF -+ return; -+#endif -+ -+ if (!(pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)) -+ return; -+ -+ /* 20120213 Turn on when continuous Tx to pass lab testing. (required by Edlu) */ -+ if (bSingleTone || bCarrierSuppression) -+ return; -+ -+ StartTime = jiffies; -+ while (*(pDM_Odm->pbScanInProcess) && timecount < timeout) { -+ mdelay(50); -+ timecount += 50; -+ } -+ -+ pDM_Odm->RFCalibrateInfo.bLCKInProgress = true; -+ -+ -+ phy_LCCalibrate_8723B(pDM_Odm, false); -+ -+ -+ pDM_Odm->RFCalibrateInfo.bLCKInProgress = false; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK:Finish!!!interface %d\n", pDM_Odm->InterfaceIndex)); -+ ProgressingTime = jiffies_to_msecs(jiffies - StartTime); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK ProgressingTime = %d\n", ProgressingTime)); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalPhyRf_8723B.h linux/3rdparty/rtl8723bs/hal/HalPhyRf_8723B.h ---- linux.old/3rdparty/rtl8723bs/hal/HalPhyRf_8723B.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalPhyRf_8723B.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,83 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL_PHY_RF_8723B_H__ -+#define __HAL_PHY_RF_8723B_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define IQK_DELAY_TIME_8723B 20 /* ms */ -+#define IQK_DEFERRED_TIME_8723B 4 -+#define index_mapping_NUM_8723B 15 -+#define AVG_THERMAL_NUM_8723B 4 -+#define RF_T_METER_8723B 0x42 /* */ -+ -+ -+void ConfigureTxpowerTrack_8723B(PTXPWRTRACK_CFG pConfig); -+ -+void DoIQK_8723B( -+ PDM_ODM_T pDM_Odm, -+ u8 DeltaThermalIndex, -+ u8 ThermalValue, -+ u8 Threshold -+); -+ -+void ODM_TxPwrTrackSetPwr_8723B( -+ PDM_ODM_T pDM_Odm, -+ PWRTRACK_METHOD Method, -+ u8 RFPath, -+ u8 ChannelMappedIndex -+); -+ -+/* 1 7. IQK */ -+void PHY_IQCalibrate_8723B( -+ struct adapter *Adapter, -+ bool bReCovery, -+ bool bRestore, -+ bool Is2ant, -+ u8 RF_Path -+); -+ -+void ODM_SetIQCbyRFpath(PDM_ODM_T pDM_Odm, u32 RFpath); -+ -+/* */ -+/* LC calibrate */ -+/* */ -+void PHY_LCCalibrate_8723B(PDM_ODM_T pDM_Odm); -+ -+/* */ -+/* AP calibrate */ -+/* */ -+void PHY_DigitalPredistortion_8723B(struct adapter *padapter); -+ -+ -+void _PHY_SaveADDARegisters_8723B( -+ struct adapter *padapter, -+ u32 *ADDAReg, -+ u32 *ADDABackup, -+ u32 RegisterNum -+); -+ -+void _PHY_PathADDAOn_8723B( -+ struct adapter *padapter, -+ u32 *ADDAReg, -+ bool isPathAOn, -+ bool is2T -+); -+ -+void _PHY_MACSettingCalibration_8723B( -+ struct adapter *padapter, u32 *MACReg, u32 *MACBackup -+); -+ -+#endif /* #ifndef __HAL_PHY_RF_8188E_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalPhyRf.c linux/3rdparty/rtl8723bs/hal/HalPhyRf.c ---- linux.old/3rdparty/rtl8723bs/hal/HalPhyRf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalPhyRf.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,662 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+/* include "Mp_Precomp.h" */ -+#include "odm_precomp.h" -+ -+ -+#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ -+ do {\ -+ for (_offset = 0; _offset < _size; _offset++) {\ -+ if (_deltaThermal < thermalThreshold[_direction][_offset]) {\ -+ if (_offset != 0)\ -+ _offset--;\ -+ break;\ -+ } \ -+ } \ -+ if (_offset >= _size)\ -+ _offset = _size-1;\ -+ } while (0) -+ -+ -+void ConfigureTxpowerTrack(PDM_ODM_T pDM_Odm, PTXPWRTRACK_CFG pConfig) -+{ -+ ConfigureTxpowerTrack_8723B(pConfig); -+} -+ -+/* */ -+/* <20121113, Kordan> This function should be called when TxAGC changed. */ -+/* Otherwise the previous compensation is gone, because we record the */ -+/* delta of temperature between two TxPowerTracking watch dogs. */ -+/* */ -+/* NOTE: If Tx BB swing or Tx scaling is varified during run-time, still */ -+/* need to call this function. */ -+/* */ -+void ODM_ClearTxPowerTrackingState(PDM_ODM_T pDM_Odm) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(pDM_Odm->Adapter); -+ u8 p = 0; -+ -+ pDM_Odm->BbSwingIdxCckBase = pDM_Odm->DefaultCckIndex; -+ pDM_Odm->BbSwingIdxCck = pDM_Odm->DefaultCckIndex; -+ pDM_Odm->RFCalibrateInfo.CCK_index = 0; -+ -+ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) { -+ pDM_Odm->BbSwingIdxOfdmBase[p] = pDM_Odm->DefaultOfdmIndex; -+ pDM_Odm->BbSwingIdxOfdm[p] = pDM_Odm->DefaultOfdmIndex; -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pDM_Odm->DefaultOfdmIndex; -+ -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = 0; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] = 0; -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; -+ -+ /* Initial Mix mode power tracking */ -+ pDM_Odm->Absolute_OFDMSwingIdx[p] = 0; -+ pDM_Odm->Remnant_OFDMSwingIdx[p] = 0; -+ } -+ -+ /* Initial at Modify Tx Scaling Mode */ -+ pDM_Odm->Modify_TxAGC_Flag_PathA = false; -+ /* Initial at Modify Tx Scaling Mode */ -+ pDM_Odm->Modify_TxAGC_Flag_PathB = false; -+ pDM_Odm->Remnant_CCKSwingIdx = 0; -+ pDM_Odm->RFCalibrateInfo.ThermalValue = pHalData->EEPROMThermalMeter; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = pHalData->EEPROMThermalMeter; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = pHalData->EEPROMThermalMeter; -+} -+ -+void ODM_TXPowerTrackingCallback_ThermalMeter(struct adapter *Adapter) -+{ -+ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ u8 ThermalValue = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; -+ u8 ThermalValue_AVG_count = 0; -+ u32 ThermalValue_AVG = 0; -+ -+ u8 OFDM_min_index = 0; /* OFDM BB Swing should be less than +3.0dB, which is required by Arthur */ -+ u8 Indexforchannel = 0; /* GetRightChnlPlaceforIQK(pHalData->CurrentChannel) */ -+ -+ TXPWRTRACK_CFG c; -+ -+ -+ /* 4 1. The following TWO tables decide the final index of OFDM/CCK swing table. */ -+ u8 *deltaSwingTableIdx_TUP_A; -+ u8 *deltaSwingTableIdx_TDOWN_A; -+ u8 *deltaSwingTableIdx_TUP_B; -+ u8 *deltaSwingTableIdx_TDOWN_B; -+ -+ /* 4 2. Initilization (7 steps in total) */ -+ -+ ConfigureTxpowerTrack(pDM_Odm, &c); -+ -+ (*c.GetDeltaSwingTable)( -+ pDM_Odm, -+ (u8 **)&deltaSwingTableIdx_TUP_A, -+ (u8 **)&deltaSwingTableIdx_TDOWN_A, -+ (u8 **)&deltaSwingTableIdx_TUP_B, -+ (u8 **)&deltaSwingTableIdx_TDOWN_B -+ ); -+ -+ /* cosa add for debug */ -+ pDM_Odm->RFCalibrateInfo.TXPowerTrackingCallbackCnt++; -+ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = true; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "===>ODM_TXPowerTrackingCallback_ThermalMeter,\npDM_Odm->BbSwingIdxCckBase: %d, pDM_Odm->BbSwingIdxOfdmBase[A]: %d, pDM_Odm->DefaultOfdmIndex: %d\n", -+ pDM_Odm->BbSwingIdxCckBase, -+ pDM_Odm->BbSwingIdxOfdmBase[ODM_RF_PATH_A], -+ pDM_Odm->DefaultOfdmIndex -+ ) -+ ); -+ -+ ThermalValue = (u8)PHY_QueryRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ -+ if ( -+ !pDM_Odm->RFCalibrateInfo.TxPowerTrackControl || -+ pHalData->EEPROMThermalMeter == 0 || -+ pHalData->EEPROMThermalMeter == 0xFF -+ ) -+ return; -+ -+ /* 4 3. Initialize ThermalValues of RFCalibrateInfo */ -+ -+ if (pDM_Odm->RFCalibrateInfo.bReloadtxpowerindex) -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("reload ofdm index for band switch\n") -+ ); -+ -+ /* 4 4. Calculate average thermal meter */ -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; -+ if (pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) /* Average times = c.AverageThermalNum */ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; -+ -+ for (i = 0; i < c.AverageThermalNum; i++) { -+ if (pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) { -+ ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ /* Calculate Average ThermalValue after average enough times */ -+ if (ThermalValue_AVG_count) { -+ ThermalValue = (u8)(ThermalValue_AVG / ThermalValue_AVG_count); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "AVG Thermal Meter = 0x%X, EFUSE Thermal Base = 0x%X\n", -+ ThermalValue, -+ pHalData->EEPROMThermalMeter -+ ) -+ ); -+ } -+ -+ /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ -+ /* delta" here is used to determine whether thermal value changes or not. */ -+ delta = -+ (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue) ? -+ (ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue) : -+ (pDM_Odm->RFCalibrateInfo.ThermalValue - ThermalValue); -+ delta_LCK = -+ (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_LCK) ? -+ (ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK) : -+ (pDM_Odm->RFCalibrateInfo.ThermalValue_LCK - ThermalValue); -+ delta_IQK = -+ (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_IQK) ? -+ (ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK) : -+ (pDM_Odm->RFCalibrateInfo.ThermalValue_IQK - ThermalValue); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", -+ delta, -+ delta_LCK, -+ delta_IQK -+ ) -+ ); -+ -+ /* 4 6. If necessary, do LCK. */ -+ /* Delta temperature is equal to or larger than 20 centigrade. */ -+ if (delta_LCK >= c.Threshold_IQK) { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "delta_LCK(%d) >= Threshold_IQK(%d)\n", -+ delta_LCK, -+ c.Threshold_IQK -+ ) -+ ); -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; -+ if (c.PHY_LCCalibrate) -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ } -+ -+ /* 3 7. If necessary, move the index of swing table to adjust Tx power. */ -+ if (delta > 0 && pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) { -+ /* delta" here is used to record the absolute value of differrence. */ -+ delta = -+ ThermalValue > pHalData->EEPROMThermalMeter ? -+ (ThermalValue - pHalData->EEPROMThermalMeter) : -+ (pHalData->EEPROMThermalMeter - ThermalValue); -+ -+ if (delta >= TXPWR_TRACK_TABLE_SIZE) -+ delta = TXPWR_TRACK_TABLE_SIZE - 1; -+ -+ /* 4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset */ -+ if (ThermalValue > pHalData->EEPROMThermalMeter) { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "deltaSwingTableIdx_TUP_A[%d] = %d\n", -+ delta, -+ deltaSwingTableIdx_TUP_A[delta] -+ ) -+ ); -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[ODM_RF_PATH_A] = -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_A]; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_A] = -+ deltaSwingTableIdx_TUP_A[delta]; -+ -+ /* Record delta swing for mix mode power tracking */ -+ pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = -+ deltaSwingTableIdx_TUP_A[delta]; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", -+ pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] -+ ) -+ ); -+ -+ if (c.RfPathCount > 1) { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "deltaSwingTableIdx_TUP_B[%d] = %d\n", -+ delta, -+ deltaSwingTableIdx_TUP_B[delta] -+ ) -+ ); -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[ODM_RF_PATH_B] = -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_B]; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_B] = -+ deltaSwingTableIdx_TUP_B[delta]; -+ -+ /* Record delta swing for mix mode power tracking */ -+ pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = -+ deltaSwingTableIdx_TUP_B[delta]; -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", -+ pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] -+ ) -+ ); -+ } -+ -+ } else { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "deltaSwingTableIdx_TDOWN_A[%d] = %d\n", -+ delta, -+ deltaSwingTableIdx_TDOWN_A[delta] -+ ) -+ ); -+ -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[ODM_RF_PATH_A] = -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_A]; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_A] = -+ -1 * deltaSwingTableIdx_TDOWN_A[delta]; -+ -+ /* Record delta swing for mix mode power tracking */ -+ pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = -+ -1 * deltaSwingTableIdx_TDOWN_A[delta]; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", -+ pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] -+ ) -+ ); -+ -+ if (c.RfPathCount > 1) { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "deltaSwingTableIdx_TDOWN_B[%d] = %d\n", -+ delta, -+ deltaSwingTableIdx_TDOWN_B[delta] -+ ) -+ ); -+ -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[ODM_RF_PATH_B] = -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_B]; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_B] = -+ -1 * deltaSwingTableIdx_TDOWN_B[delta]; -+ -+ /* Record delta swing for mix mode power tracking */ -+ pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = -+ -1 * deltaSwingTableIdx_TDOWN_B[delta]; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", -+ pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] -+ ) -+ ); -+ } -+ } -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "\n\n ================================ [Path-%c] Calculating PowerIndexOffset ================================\n", -+ (p == ODM_RF_PATH_A ? 'A' : 'B') -+ ) -+ ); -+ -+ if ( -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] == -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] -+ ) /* If Thermal value changes but lookup table value still the same */ -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; -+ else -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] - pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p]; /* Power Index Diff between 2 times Power Tracking */ -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "[Path-%c] PowerIndexOffset(%d) = DeltaPowerIndex(%d) - DeltaPowerIndexLast(%d)\n", -+ ( -+ p == ODM_RF_PATH_A ? 'A' : 'B'), -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p], -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p], -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] -+ ) -+ ); -+ -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = -+ pDM_Odm->BbSwingIdxOfdmBase[p] + -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p]; -+ -+ pDM_Odm->RFCalibrateInfo.CCK_index = -+ pDM_Odm->BbSwingIdxCckBase + -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p]; -+ -+ pDM_Odm->BbSwingIdxCck = -+ pDM_Odm->RFCalibrateInfo.CCK_index; -+ -+ pDM_Odm->BbSwingIdxOfdm[p] = -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p]; -+ -+ /* *************Print BB Swing Base and Index Offset************* */ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", -+ pDM_Odm->BbSwingIdxCck, -+ pDM_Odm->BbSwingIdxCckBase, -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] -+ ) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "The 'OFDM' final index(%d) = BaseIndex[%c](%d) + PowerIndexOffset(%d)\n", -+ pDM_Odm->BbSwingIdxOfdm[p], -+ (p == ODM_RF_PATH_A ? 'A' : 'B'), -+ pDM_Odm->BbSwingIdxOfdmBase[p], -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] -+ ) -+ ); -+ -+ /* 4 7.1 Handle boundary conditions of index. */ -+ if (pDM_Odm->RFCalibrateInfo.OFDM_index[p] > c.SwingTableSize_OFDM-1) -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = c.SwingTableSize_OFDM-1; -+ else if (pDM_Odm->RFCalibrateInfo.OFDM_index[p] < OFDM_min_index) -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = OFDM_min_index; -+ } -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ("\n\n ========================================================================================================\n") -+ ); -+ if (pDM_Odm->RFCalibrateInfo.CCK_index > c.SwingTableSize_CCK-1) -+ pDM_Odm->RFCalibrateInfo.CCK_index = c.SwingTableSize_CCK-1; -+ /* else if (pDM_Odm->RFCalibrateInfo.CCK_index < 0) */ -+ /* pDM_Odm->RFCalibrateInfo.CCK_index = 0; */ -+ } else { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "The thermal meter is unchanged or TxPowerTracking OFF(%d): ThermalValue: %d , pDM_Odm->RFCalibrateInfo.ThermalValue: %d\n", -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl, -+ ThermalValue, -+ pDM_Odm->RFCalibrateInfo.ThermalValue -+ ) -+ ); -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; -+ } -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", -+ pDM_Odm->RFCalibrateInfo.CCK_index, -+ pDM_Odm->BbSwingIdxCckBase -+ ) -+ ); -+ -+ /* Print Swing base & current */ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index[%c]: %d\n", -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p], -+ (p == ODM_RF_PATH_A ? 'A' : 'B'), -+ pDM_Odm->BbSwingIdxOfdmBase[p] -+ ) -+ ); -+ } -+ -+ if ( -+ (pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_A] != 0 || -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_B] != 0) && -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl -+ ) { -+ /* 4 7.2 Configure the Swing Table to adjust Tx Power. */ -+ -+ pDM_Odm->RFCalibrateInfo.bTxPowerChanged = true; /* Always true after Tx Power is adjusted by power tracking. */ -+ /* */ -+ /* 2012/04/23 MH According to Luke's suggestion, we can not write BB digital */ -+ /* to increase TX power. Otherwise, EVM will be bad. */ -+ /* */ -+ /* 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. */ -+ if (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue) { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "Temperature Increasing(A): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_A], -+ delta, -+ ThermalValue, -+ pHalData->EEPROMThermalMeter, -+ pDM_Odm->RFCalibrateInfo.ThermalValue -+ ) -+ ); -+ -+ if (c.RfPathCount > 1) -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "Temperature Increasing(B): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_B], -+ delta, -+ ThermalValue, -+ pHalData->EEPROMThermalMeter, -+ pDM_Odm->RFCalibrateInfo.ThermalValue -+ ) -+ ); -+ -+ } else if (ThermalValue < pDM_Odm->RFCalibrateInfo.ThermalValue) { /* Low temperature */ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "Temperature Decreasing(A): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_A], -+ delta, -+ ThermalValue, -+ pHalData->EEPROMThermalMeter, -+ pDM_Odm->RFCalibrateInfo.ThermalValue -+ ) -+ ); -+ -+ if (c.RfPathCount > 1) -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "Temperature Decreasing(B): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_B], -+ delta, -+ ThermalValue, -+ pHalData->EEPROMThermalMeter, -+ pDM_Odm->RFCalibrateInfo.ThermalValue -+ ) -+ ); -+ -+ } -+ -+ if (ThermalValue > pHalData->EEPROMThermalMeter) { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "Temperature(%d) higher than PG value(%d)\n", -+ ThermalValue, -+ pHalData->EEPROMThermalMeter -+ ) -+ ); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ("**********Enter POWER Tracking MIX_MODE**********\n") -+ ); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); -+ } else { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ( -+ "Temperature(%d) lower than PG value(%d)\n", -+ ThermalValue, -+ pHalData->EEPROMThermalMeter -+ ) -+ ); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ("**********Enter POWER Tracking MIX_MODE**********\n") -+ ); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); -+ } -+ -+ /* Record last time Power Tracking result as base. */ -+ pDM_Odm->BbSwingIdxCckBase = pDM_Odm->BbSwingIdxCck; -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ pDM_Odm->BbSwingIdxOfdmBase[p] = pDM_Odm->BbSwingIdxOfdm[p]; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ( -+ "pDM_Odm->RFCalibrateInfo.ThermalValue = %d ThermalValue = %d\n", -+ pDM_Odm->RFCalibrateInfo.ThermalValue, -+ ThermalValue -+ ) -+ ); -+ -+ /* Record last Power Tracking Thermal Value */ -+ pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; -+ } -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_TX_PWR_TRACK, -+ ODM_DBG_LOUD, -+ ("<===ODM_TXPowerTrackingCallback_ThermalMeter\n") -+ ); -+ -+ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; -+} -+ -+ -+ -+ -+/* 3 ============================================================ */ -+/* 3 IQ Calibration */ -+/* 3 ============================================================ */ -+ -+u8 ODM_GetRightChnlPlaceforIQK(u8 chnl) -+{ -+ u8 channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = { -+ 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, -+ 36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, -+ 60, 62, 64, 100, 102, 104, 106, 108, 110, 112, -+ 114, 116, 118, 120, 122, 124, 126, 128, 130, 132, -+ 134, 136, 138, 140, 149, 151, 153, 155, 157, 159, -+ 161, 163, 165 -+ }; -+ u8 place = chnl; -+ -+ -+ if (chnl > 14) { -+ for (place = 14; place < sizeof(channel_all); place++) { -+ if (channel_all[place] == chnl) -+ return place-13; -+ } -+ } -+ return 0; -+ -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalPhyRf.h linux/3rdparty/rtl8723bs/hal/HalPhyRf.h ---- linux.old/3rdparty/rtl8723bs/hal/HalPhyRf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalPhyRf.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,63 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ #ifndef __HAL_PHY_RF_H__ -+ #define __HAL_PHY_RF_H__ -+ -+typedef enum _SPUR_CAL_METHOD { -+ PLL_RESET, -+ AFE_PHASE_SEL -+} SPUR_CAL_METHOD; -+ -+typedef enum _PWRTRACK_CONTROL_METHOD { -+ BBSWING, -+ TXAGC, -+ MIX_MODE -+} PWRTRACK_METHOD; -+ -+typedef void (*FuncSetPwr)(PDM_ODM_T, PWRTRACK_METHOD, u8, u8); -+typedef void (*FuncIQK)(PDM_ODM_T, u8, u8, u8); -+typedef void (*FuncLCK)(PDM_ODM_T); -+typedef void (*FuncSwing)(PDM_ODM_T, u8 **, u8 **, u8 **, u8 **); -+ -+typedef struct _TXPWRTRACK_CFG { -+ u8 SwingTableSize_CCK; -+ u8 SwingTableSize_OFDM; -+ u8 Threshold_IQK; -+ u8 AverageThermalNum; -+ u8 RfPathCount; -+ u32 ThermalRegAddr; -+ FuncSetPwr ODM_TxPwrTrackSetPwr; -+ FuncIQK DoIQK; -+ FuncLCK PHY_LCCalibrate; -+ FuncSwing GetDeltaSwingTable; -+} TXPWRTRACK_CFG, *PTXPWRTRACK_CFG; -+ -+void ConfigureTxpowerTrack(PDM_ODM_T pDM_Odm, PTXPWRTRACK_CFG pConfig); -+ -+ -+void ODM_ClearTxPowerTrackingState(PDM_ODM_T pDM_Odm); -+ -+void ODM_TXPowerTrackingCallback_ThermalMeter(struct adapter *Adapter); -+ -+ -+ -+#define ODM_TARGET_CHNL_NUM_2G_5G 59 -+ -+ -+u8 ODM_GetRightChnlPlaceforIQK(u8 chnl); -+ -+ -+#endif /* #ifndef __HAL_PHY_RF_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/HalPwrSeqCmd.c linux/3rdparty/rtl8723bs/hal/HalPwrSeqCmd.c ---- linux.old/3rdparty/rtl8723bs/hal/HalPwrSeqCmd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/HalPwrSeqCmd.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,205 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/*++ -+Copyright (c) Realtek Semiconductor Corp. All rights reserved. -+ -+Module Name: -+ HalPwrSeqCmd.c -+ -+Abstract: -+ Implement HW Power sequence configuration CMD handling routine for Realtek devices. -+ -+Major Change History: -+ When Who What -+ ---------- --------------- ------------------------------- -+ 2011-10-26 Lucas Modify to be compatible with SD4-CE driver. -+ 2011-07-07 Roger Create. -+ -+--*/ -+#include -+#include -+#include -+ -+ -+/* */ -+/* Description: */ -+/* This routine deal with the Power Configuration CMDs parsing for RTL8723/RTL8188E Series IC. */ -+/* */ -+/* Assumption: */ -+/* We should follow specific format which was released from HW SD. */ -+/* */ -+/* 2011.07.07, added by Roger. */ -+/* */ -+u8 HalPwrSeqCmdParsing( -+ struct adapter *padapter, -+ u8 CutVersion, -+ u8 FabVersion, -+ u8 InterfaceType, -+ WLAN_PWR_CFG PwrSeqCmd[] -+) -+{ -+ WLAN_PWR_CFG PwrCfgCmd = {0}; -+ u8 bPollingBit = false; -+ u32 AryIdx = 0; -+ u8 value = 0; -+ u32 offset = 0; -+ u32 pollingCount = 0; /* polling autoload done. */ -+ u32 maxPollingCnt = 5000; -+ -+ do { -+ PwrCfgCmd = PwrSeqCmd[AryIdx]; -+ -+ RT_TRACE( -+ _module_hal_init_c_, -+ _drv_info_, -+ ( -+ "HalPwrSeqCmdParsing: offset(%#x) cut_msk(%#x) fab_msk(%#x) interface_msk(%#x) base(%#x) cmd(%#x) msk(%#x) value(%#x)\n", -+ GET_PWR_CFG_OFFSET(PwrCfgCmd), -+ GET_PWR_CFG_CUT_MASK(PwrCfgCmd), -+ GET_PWR_CFG_FAB_MASK(PwrCfgCmd), -+ GET_PWR_CFG_INTF_MASK(PwrCfgCmd), -+ GET_PWR_CFG_BASE(PwrCfgCmd), -+ GET_PWR_CFG_CMD(PwrCfgCmd), -+ GET_PWR_CFG_MASK(PwrCfgCmd), -+ GET_PWR_CFG_VALUE(PwrCfgCmd) -+ ) -+ ); -+ -+ /* 2 Only Handle the command whose FAB, CUT, and Interface are matched */ -+ if ( -+ (GET_PWR_CFG_FAB_MASK(PwrCfgCmd) & FabVersion) && -+ (GET_PWR_CFG_CUT_MASK(PwrCfgCmd) & CutVersion) && -+ (GET_PWR_CFG_INTF_MASK(PwrCfgCmd) & InterfaceType) -+ ) { -+ switch (GET_PWR_CFG_CMD(PwrCfgCmd)) { -+ case PWR_CMD_READ: -+ RT_TRACE( -+ _module_hal_init_c_, -+ _drv_info_, -+ ("HalPwrSeqCmdParsing: PWR_CMD_READ\n") -+ ); -+ break; -+ -+ case PWR_CMD_WRITE: -+ RT_TRACE( -+ _module_hal_init_c_, -+ _drv_info_, -+ ("HalPwrSeqCmdParsing: PWR_CMD_WRITE\n") -+ ); -+ offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); -+ -+ /* */ -+ /* We should deal with interface specific address mapping for some interfaces, e.g., SDIO interface */ -+ /* 2011.07.07. */ -+ /* */ -+ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) { -+ /* Read Back SDIO Local value */ -+ value = SdioLocalCmd52Read1Byte(padapter, offset); -+ -+ value &= ~(GET_PWR_CFG_MASK(PwrCfgCmd)); -+ value |= ( -+ GET_PWR_CFG_VALUE(PwrCfgCmd) & -+ GET_PWR_CFG_MASK(PwrCfgCmd) -+ ); -+ -+ /* Write Back SDIO Local value */ -+ SdioLocalCmd52Write1Byte(padapter, offset, value); -+ } else { -+ /* Read the value from system register */ -+ value = rtw_read8(padapter, offset); -+ -+ value &= (~(GET_PWR_CFG_MASK(PwrCfgCmd))); -+ value |= ( -+ GET_PWR_CFG_VALUE(PwrCfgCmd) -+ &GET_PWR_CFG_MASK(PwrCfgCmd) -+ ); -+ -+ /* Write the value back to sytem register */ -+ rtw_write8(padapter, offset, value); -+ } -+ break; -+ -+ case PWR_CMD_POLLING: -+ RT_TRACE( -+ _module_hal_init_c_, -+ _drv_info_, -+ ("HalPwrSeqCmdParsing: PWR_CMD_POLLING\n") -+ ); -+ -+ bPollingBit = false; -+ offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); -+ do { -+ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) -+ value = SdioLocalCmd52Read1Byte(padapter, offset); -+ else -+ value = rtw_read8(padapter, offset); -+ -+ value = value&GET_PWR_CFG_MASK(PwrCfgCmd); -+ if ( -+ value == (GET_PWR_CFG_VALUE(PwrCfgCmd) & -+ GET_PWR_CFG_MASK(PwrCfgCmd)) -+ ) -+ bPollingBit = true; -+ else -+ udelay(10); -+ -+ if (pollingCount++ > maxPollingCnt) { -+ DBG_871X( -+ "Fail to polling Offset[%#x]=%02x\n", -+ offset, -+ value -+ ); -+ return false; -+ } -+ } while (!bPollingBit); -+ -+ break; -+ -+ case PWR_CMD_DELAY: -+ RT_TRACE( -+ _module_hal_init_c_, -+ _drv_info_, -+ ("HalPwrSeqCmdParsing: PWR_CMD_DELAY\n") -+ ); -+ if (GET_PWR_CFG_VALUE(PwrCfgCmd) == PWRSEQ_DELAY_US) -+ udelay(GET_PWR_CFG_OFFSET(PwrCfgCmd)); -+ else -+ udelay(GET_PWR_CFG_OFFSET(PwrCfgCmd)*1000); -+ break; -+ -+ case PWR_CMD_END: -+ /* When this command is parsed, end the process */ -+ RT_TRACE( -+ _module_hal_init_c_, -+ _drv_info_, -+ ("HalPwrSeqCmdParsing: PWR_CMD_END\n") -+ ); -+ return true; -+ -+ default: -+ RT_TRACE( -+ _module_hal_init_c_, -+ _drv_err_, -+ ("HalPwrSeqCmdParsing: Unknown CMD!!\n") -+ ); -+ break; -+ } -+ } -+ -+ AryIdx++;/* Add Array Index */ -+ } while (1); -+ -+ return true; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/hal_sdio.c linux/3rdparty/rtl8723bs/hal/hal_sdio.c ---- linux.old/3rdparty/rtl8723bs/hal/hal_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/hal_sdio.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,115 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _HAL_SDIO_C_ -+ -+#include -+#include -+#include -+ -+u8 rtw_hal_sdio_max_txoqt_free_space(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+ if (pHalData->SdioTxOQTMaxFreeSpace < 8) -+ pHalData->SdioTxOQTMaxFreeSpace = 8; -+ -+ return pHalData->SdioTxOQTMaxFreeSpace; -+} -+ -+u8 rtw_hal_sdio_query_tx_freepage( -+ struct adapter *padapter, u8 PageIdx, u8 RequiredPageNum -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+ if ((pHalData->SdioTxFIFOFreePage[PageIdx]+pHalData->SdioTxFIFOFreePage[PUBLIC_QUEUE_IDX]) >= (RequiredPageNum)) -+ return true; -+ else -+ return false; -+} -+ -+void rtw_hal_sdio_update_tx_freepage( -+ struct adapter *padapter, u8 PageIdx, u8 RequiredPageNum -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u8 DedicatedPgNum = 0; -+ u8 RequiredPublicFreePgNum = 0; -+ /* _irqL irql; */ -+ -+ /* spin_lock_bh(&pHalData->SdioTxFIFOFreePageLock); */ -+ -+ DedicatedPgNum = pHalData->SdioTxFIFOFreePage[PageIdx]; -+ if (RequiredPageNum <= DedicatedPgNum) { -+ pHalData->SdioTxFIFOFreePage[PageIdx] -= RequiredPageNum; -+ } else { -+ pHalData->SdioTxFIFOFreePage[PageIdx] = 0; -+ RequiredPublicFreePgNum = RequiredPageNum - DedicatedPgNum; -+ pHalData->SdioTxFIFOFreePage[PUBLIC_QUEUE_IDX] -= RequiredPublicFreePgNum; -+ } -+ -+ /* spin_unlock_bh(&pHalData->SdioTxFIFOFreePageLock); */ -+} -+ -+void rtw_hal_set_sdio_tx_max_length( -+ struct adapter *padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u32 page_size; -+ u32 lenHQ, lenNQ, lenLQ; -+ -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_PAGE_SIZE, &page_size); -+ -+ lenHQ = ((numHQ + numPubQ) >> 1) * page_size; -+ lenNQ = ((numNQ + numPubQ) >> 1) * page_size; -+ lenLQ = ((numLQ + numPubQ) >> 1) * page_size; -+ -+ pHalData->sdio_tx_max_len[HI_QUEUE_IDX] = -+ (lenHQ > MAX_XMITBUF_SZ) ? MAX_XMITBUF_SZ : lenHQ; -+ pHalData->sdio_tx_max_len[MID_QUEUE_IDX] = -+ (lenNQ > MAX_XMITBUF_SZ) ? MAX_XMITBUF_SZ : lenNQ; -+ pHalData->sdio_tx_max_len[LOW_QUEUE_IDX] = -+ (lenLQ > MAX_XMITBUF_SZ) ? MAX_XMITBUF_SZ : lenLQ; -+} -+ -+u32 rtw_hal_get_sdio_tx_max_length(struct adapter *padapter, u8 queue_idx) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u32 deviceId, max_len; -+ -+ -+ deviceId = ffaddr2deviceId(pdvobjpriv, queue_idx); -+ switch (deviceId) { -+ case WLAN_TX_HIQ_DEVICE_ID: -+ max_len = pHalData->sdio_tx_max_len[HI_QUEUE_IDX]; -+ break; -+ -+ case WLAN_TX_MIQ_DEVICE_ID: -+ max_len = pHalData->sdio_tx_max_len[MID_QUEUE_IDX]; -+ break; -+ -+ case WLAN_TX_LOQ_DEVICE_ID: -+ max_len = pHalData->sdio_tx_max_len[LOW_QUEUE_IDX]; -+ break; -+ -+ default: -+ max_len = pHalData->sdio_tx_max_len[MID_QUEUE_IDX]; -+ break; -+ } -+ -+ return max_len; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/Mp_Precomp.h linux/3rdparty/rtl8723bs/hal/Mp_Precomp.h ---- linux.old/3rdparty/rtl8723bs/hal/Mp_Precomp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/Mp_Precomp.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,33 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __MP_PRECOMP_H__ -+#define __MP_PRECOMP_H__ -+ -+#include -+#include -+ -+#define BT_TMP_BUF_SIZE 100 -+ -+#define DCMD_Printf DBG_BT_INFO -+ -+#ifdef bEnable -+#undef bEnable -+#endif -+ -+#include "HalBtcOutSrc.h" -+#include "HalBtc8723b1Ant.h" -+#include "HalBtc8723b2Ant.h" -+ -+#endif /* __MP_PRECOMP_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_AntDiv.c linux/3rdparty/rtl8723bs/hal/odm_AntDiv.c ---- linux.old/3rdparty/rtl8723bs/hal/odm_AntDiv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_AntDiv.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,70 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "odm_precomp.h" -+ -+//====================================================== -+// when antenna test utility is on or some testing -+// need to disable antenna diversity -+// call this function to disable all ODM related mechanisms -+// which will switch antenna. -+//====================================================== -+void ODM_StopAntennaSwitchDm(PDM_ODM_T pDM_Odm) -+{ -+ // disable ODM antenna diversity -+ pDM_Odm->SupportAbility &= ~ODM_BB_ANT_DIV; -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_ANT_DIV, -+ ODM_DBG_LOUD, -+ ("STOP Antenna Diversity\n") -+ ); -+} -+ -+void ODM_SetAntConfig(PDM_ODM_T pDM_Odm, u8 antSetting)// 0=A, 1=B, 2=C, .... -+{ -+ if (antSetting == 0) // ant A -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, 0x00000000); -+ else if (antSetting == 1) -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x948, bMaskDWord, 0x00000280); -+} -+ -+//====================================================== -+ -+ -+void ODM_SwAntDivRestAfterLink(PDM_ODM_T pDM_Odm) -+{ -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u32 i; -+ -+ pDM_Odm->RSSI_test = false; -+ pDM_SWAT_Table->try_flag = 0xff; -+ pDM_SWAT_Table->RSSI_Trying = 0; -+ pDM_SWAT_Table->Double_chk_flag = 0; -+ -+ pDM_FatTable->RxIdleAnt = MAIN_ANT; -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ pDM_FatTable->MainAnt_Sum[i] = 0; -+ pDM_FatTable->AuxAnt_Sum[i] = 0; -+ pDM_FatTable->MainAnt_Cnt[i] = 0; -+ pDM_FatTable->AuxAnt_Cnt[i] = 0; -+ } -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_AntDiv.h linux/3rdparty/rtl8723bs/hal/odm_AntDiv.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_AntDiv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_AntDiv.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,38 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODMANTDIV_H__ -+#define __ODMANTDIV_H__ -+ -+ -+ -+#define ANT1_2G 0 /* = ANT2_5G */ -+#define ANT2_2G 1 /* = ANT1_5G */ -+ -+/* Antenna Diversty Control Type */ -+#define ODM_AUTO_ANT 0 -+#define ODM_FIX_MAIN_ANT 1 -+#define ODM_FIX_AUX_ANT 2 -+ -+#define TX_BY_REG 0 -+ -+#define ANTDIV_ON 1 -+#define ANTDIV_OFF 0 -+ -+#define INIT_ANTDIV_TIMMER 0 -+#define CANCEL_ANTDIV_TIMMER 1 -+#define RELEASE_ANTDIV_TIMMER 2 -+ -+#endif /* ifndef __ODMANTDIV_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm.c linux/3rdparty/rtl8723bs/hal/odm.c ---- linux.old/3rdparty/rtl8723bs/hal/odm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1446 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+static const u16 dB_Invert_Table[8][12] = { -+ {1, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4}, -+ {4, 5, 6, 6, 7, 8, 9, 10, 11, 13, 14, 16}, -+ {18, 20, 22, 25, 28, 32, 35, 40, 45, 50, 56, 63}, -+ {71, 79, 89, 100, 112, 126, 141, 158, 178, 200, 224, 251}, -+ {282, 316, 355, 398, 447, 501, 562, 631, 708, 794, 891, 1000}, -+ {1122, 1259, 1413, 1585, 1778, 1995, 2239, 2512, 2818, 3162, 3548, 3981}, -+ {4467, 5012, 5623, 6310, 7079, 7943, 8913, 10000, 11220, 12589, 14125, -+ 15849}, -+ {17783, 19953, 22387, 25119, 28184, 31623, 35481, 39811, 44668, 50119, -+ 56234, 65535} -+ }; -+ -+/* Global var */ -+ -+u32 OFDMSwingTable[OFDM_TABLE_SIZE] = { -+ 0x7f8001fe, /* 0, +6.0dB */ -+ 0x788001e2, /* 1, +5.5dB */ -+ 0x71c001c7, /* 2, +5.0dB */ -+ 0x6b8001ae, /* 3, +4.5dB */ -+ 0x65400195, /* 4, +4.0dB */ -+ 0x5fc0017f, /* 5, +3.5dB */ -+ 0x5a400169, /* 6, +3.0dB */ -+ 0x55400155, /* 7, +2.5dB */ -+ 0x50800142, /* 8, +2.0dB */ -+ 0x4c000130, /* 9, +1.5dB */ -+ 0x47c0011f, /* 10, +1.0dB */ -+ 0x43c0010f, /* 11, +0.5dB */ -+ 0x40000100, /* 12, +0dB */ -+ 0x3c8000f2, /* 13, -0.5dB */ -+ 0x390000e4, /* 14, -1.0dB */ -+ 0x35c000d7, /* 15, -1.5dB */ -+ 0x32c000cb, /* 16, -2.0dB */ -+ 0x300000c0, /* 17, -2.5dB */ -+ 0x2d4000b5, /* 18, -3.0dB */ -+ 0x2ac000ab, /* 19, -3.5dB */ -+ 0x288000a2, /* 20, -4.0dB */ -+ 0x26000098, /* 21, -4.5dB */ -+ 0x24000090, /* 22, -5.0dB */ -+ 0x22000088, /* 23, -5.5dB */ -+ 0x20000080, /* 24, -6.0dB */ -+ 0x1e400079, /* 25, -6.5dB */ -+ 0x1c800072, /* 26, -7.0dB */ -+ 0x1b00006c, /* 27. -7.5dB */ -+ 0x19800066, /* 28, -8.0dB */ -+ 0x18000060, /* 29, -8.5dB */ -+ 0x16c0005b, /* 30, -9.0dB */ -+ 0x15800056, /* 31, -9.5dB */ -+ 0x14400051, /* 32, -10.0dB */ -+ 0x1300004c, /* 33, -10.5dB */ -+ 0x12000048, /* 34, -11.0dB */ -+ 0x11000044, /* 35, -11.5dB */ -+ 0x10000040, /* 36, -12.0dB */ -+}; -+ -+u8 CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, /* 0, +0dB */ -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 1, -0.5dB */ -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 2, -1.0dB */ -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 3, -1.5dB */ -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 4, -2.0dB */ -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 5, -2.5dB */ -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 6, -3.0dB */ -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 7, -3.5dB */ -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 8, -4.0dB */ -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 9, -4.5dB */ -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 10, -5.0dB */ -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 11, -5.5dB */ -+ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /* 12, -6.0dB <== default */ -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 13, -6.5dB */ -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 14, -7.0dB */ -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 15, -7.5dB */ -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 17, -8.5dB */ -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 18, -9.0dB */ -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 19, -9.5dB */ -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 20, -10.0dB */ -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 21, -10.5dB */ -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 22, -11.0dB */ -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 23, -11.5dB */ -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 24, -12.0dB */ -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 25, -12.5dB */ -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 26, -13.0dB */ -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 27, -13.5dB */ -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 28, -14.0dB */ -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 29, -14.5dB */ -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 30, -15.0dB */ -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 31, -15.5dB */ -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} /* 32, -16.0dB */ -+}; -+ -+u8 CCKSwingTable_Ch14[CCK_TABLE_SIZE][8] = { -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, /* 0, +0dB */ -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 1, -0.5dB */ -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 2, -1.0dB */ -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /* 3, -1.5dB */ -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 4, -2.0dB */ -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /* 5, -2.5dB */ -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 6, -3.0dB */ -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 7, -3.5dB */ -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 8, -4.0dB */ -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /* 9, -4.5dB */ -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 10, -5.0dB */ -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 11, -5.5dB */ -+ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 12, -6.0dB <== default */ -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 13, -6.5dB */ -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 14, -7.0dB */ -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 15, -7.5dB */ -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 17, -8.5dB */ -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 18, -9.0dB */ -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 19, -9.5dB */ -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 20, -10.0dB */ -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 21, -10.5dB */ -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 22, -11.0dB */ -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 23, -11.5dB */ -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 24, -12.0dB */ -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 25, -12.5dB */ -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 26, -13.0dB */ -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 27, -13.5dB */ -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 28, -14.0dB */ -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 29, -14.5dB */ -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 30, -15.0dB */ -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 31, -15.5dB */ -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00} /* 32, -16.0dB */ -+}; -+ -+u32 OFDMSwingTable_New[OFDM_TABLE_SIZE] = { -+ 0x0b40002d, /* 0, -15.0dB */ -+ 0x0c000030, /* 1, -14.5dB */ -+ 0x0cc00033, /* 2, -14.0dB */ -+ 0x0d800036, /* 3, -13.5dB */ -+ 0x0e400039, /* 4, -13.0dB */ -+ 0x0f00003c, /* 5, -12.5dB */ -+ 0x10000040, /* 6, -12.0dB */ -+ 0x11000044, /* 7, -11.5dB */ -+ 0x12000048, /* 8, -11.0dB */ -+ 0x1300004c, /* 9, -10.5dB */ -+ 0x14400051, /* 10, -10.0dB */ -+ 0x15800056, /* 11, -9.5dB */ -+ 0x16c0005b, /* 12, -9.0dB */ -+ 0x18000060, /* 13, -8.5dB */ -+ 0x19800066, /* 14, -8.0dB */ -+ 0x1b00006c, /* 15, -7.5dB */ -+ 0x1c800072, /* 16, -7.0dB */ -+ 0x1e400079, /* 17, -6.5dB */ -+ 0x20000080, /* 18, -6.0dB */ -+ 0x22000088, /* 19, -5.5dB */ -+ 0x24000090, /* 20, -5.0dB */ -+ 0x26000098, /* 21, -4.5dB */ -+ 0x288000a2, /* 22, -4.0dB */ -+ 0x2ac000ab, /* 23, -3.5dB */ -+ 0x2d4000b5, /* 24, -3.0dB */ -+ 0x300000c0, /* 25, -2.5dB */ -+ 0x32c000cb, /* 26, -2.0dB */ -+ 0x35c000d7, /* 27, -1.5dB */ -+ 0x390000e4, /* 28, -1.0dB */ -+ 0x3c8000f2, /* 29, -0.5dB */ -+ 0x40000100, /* 30, +0dB */ -+ 0x43c0010f, /* 31, +0.5dB */ -+ 0x47c0011f, /* 32, +1.0dB */ -+ 0x4c000130, /* 33, +1.5dB */ -+ 0x50800142, /* 34, +2.0dB */ -+ 0x55400155, /* 35, +2.5dB */ -+ 0x5a400169, /* 36, +3.0dB */ -+ 0x5fc0017f, /* 37, +3.5dB */ -+ 0x65400195, /* 38, +4.0dB */ -+ 0x6b8001ae, /* 39, +4.5dB */ -+ 0x71c001c7, /* 40, +5.0dB */ -+ 0x788001e2, /* 41, +5.5dB */ -+ 0x7f8001fe /* 42, +6.0dB */ -+}; -+ -+u8 CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, /* 0, -16.0dB */ -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 1, -15.5dB */ -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 2, -15.0dB */ -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 3, -14.5dB */ -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 4, -14.0dB */ -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 5, -13.5dB */ -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 6, -13.0dB */ -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 7, -12.5dB */ -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 8, -12.0dB */ -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 9, -11.5dB */ -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 10, -11.0dB */ -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 11, -10.5dB */ -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 12, -10.0dB */ -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 13, -9.5dB */ -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 14, -9.0dB */ -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 15, -8.5dB */ -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 17, -7.5dB */ -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 18, -7.0dB */ -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 19, -6.5dB */ -+ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /* 20, -6.0dB */ -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 21, -5.5dB */ -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 22, -5.0dB */ -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 23, -4.5dB */ -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 24, -4.0dB */ -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 25, -3.5dB */ -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 26, -3.0dB */ -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 27, -2.5dB */ -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 28, -2.0dB */ -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 29, -1.5dB */ -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 30, -1.0dB */ -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 31, -0.5dB */ -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} /* 32, +0dB */ -+}; -+ -+u8 CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8] = { -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, /* 0, -16.0dB */ -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 1, -15.5dB */ -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 2, -15.0dB */ -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 3, -14.5dB */ -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 4, -14.0dB */ -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 5, -13.5dB */ -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 6, -13.0dB */ -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 7, -12.5dB */ -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 8, -12.0dB */ -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 9, -11.5dB */ -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 10, -11.0dB */ -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 11, -10.5dB */ -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 12, -10.0dB */ -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 13, -9.5dB */ -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 14, -9.0dB */ -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 15, -8.5dB */ -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 17, -7.5dB */ -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 18, -7.0dB */ -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 19, -6.5dB */ -+ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 20, -6.0dB */ -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 21, -5.5dB */ -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 22, -5.0dB */ -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /* 23, -4.5dB */ -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 24, -4.0dB */ -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 25, -3.5dB */ -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 26, -3.0dB */ -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /* 27, -2.5dB */ -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 28, -2.0dB */ -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /* 29, -1.5dB */ -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 30, -1.0dB */ -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 31, -0.5dB */ -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} /* 32, +0dB */ -+}; -+ -+u32 TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = { -+ 0x081, /* 0, -12.0dB */ -+ 0x088, /* 1, -11.5dB */ -+ 0x090, /* 2, -11.0dB */ -+ 0x099, /* 3, -10.5dB */ -+ 0x0A2, /* 4, -10.0dB */ -+ 0x0AC, /* 5, -9.5dB */ -+ 0x0B6, /* 6, -9.0dB */ -+ 0x0C0, /* 7, -8.5dB */ -+ 0x0CC, /* 8, -8.0dB */ -+ 0x0D8, /* 9, -7.5dB */ -+ 0x0E5, /* 10, -7.0dB */ -+ 0x0F2, /* 11, -6.5dB */ -+ 0x101, /* 12, -6.0dB */ -+ 0x110, /* 13, -5.5dB */ -+ 0x120, /* 14, -5.0dB */ -+ 0x131, /* 15, -4.5dB */ -+ 0x143, /* 16, -4.0dB */ -+ 0x156, /* 17, -3.5dB */ -+ 0x16A, /* 18, -3.0dB */ -+ 0x180, /* 19, -2.5dB */ -+ 0x197, /* 20, -2.0dB */ -+ 0x1AF, /* 21, -1.5dB */ -+ 0x1C8, /* 22, -1.0dB */ -+ 0x1E3, /* 23, -0.5dB */ -+ 0x200, /* 24, +0 dB */ -+ 0x21E, /* 25, +0.5dB */ -+ 0x23E, /* 26, +1.0dB */ -+ 0x261, /* 27, +1.5dB */ -+ 0x285, /* 28, +2.0dB */ -+ 0x2AB, /* 29, +2.5dB */ -+ 0x2D3, /* 30, +3.0dB */ -+ 0x2FE, /* 31, +3.5dB */ -+ 0x32B, /* 32, +4.0dB */ -+ 0x35C, /* 33, +4.5dB */ -+ 0x38E, /* 34, +5.0dB */ -+ 0x3C4, /* 35, +5.5dB */ -+ 0x3FE /* 36, +6.0dB */ -+}; -+ -+/* Local Function predefine. */ -+ -+/* START------------COMMON INFO RELATED--------------- */ -+void odm_CommonInfoSelfInit(PDM_ODM_T pDM_Odm); -+ -+void odm_CommonInfoSelfUpdate(PDM_ODM_T pDM_Odm); -+ -+void odm_CmnInfoInit_Debug(PDM_ODM_T pDM_Odm); -+ -+void odm_BasicDbgMessage(PDM_ODM_T pDM_Odm); -+ -+/* END------------COMMON INFO RELATED--------------- */ -+ -+/* START---------------DIG--------------------------- */ -+ -+/* Remove by Yuchen */ -+ -+/* END---------------DIG--------------------------- */ -+ -+/* START-------BB POWER SAVE----------------------- */ -+/* Remove BB power Saving by YuChen */ -+/* END---------BB POWER SAVE----------------------- */ -+ -+void odm_RefreshRateAdaptiveMaskCE(PDM_ODM_T pDM_Odm); -+ -+/* Remove by YuChen */ -+ -+void odm_RSSIMonitorInit(PDM_ODM_T pDM_Odm); -+ -+void odm_RSSIMonitorCheckCE(PDM_ODM_T pDM_Odm); -+ -+void odm_RSSIMonitorCheck(PDM_ODM_T pDM_Odm); -+ -+void odm_SwAntDetectInit(PDM_ODM_T pDM_Odm); -+ -+void odm_SwAntDivChkAntSwitchCallback(void *FunctionContext); -+ -+ -+ -+void odm_GlobalAdapterCheck(void); -+ -+void odm_RefreshRateAdaptiveMask(PDM_ODM_T pDM_Odm); -+ -+void ODM_TXPowerTrackingCheck(PDM_ODM_T pDM_Odm); -+ -+void odm_RateAdaptiveMaskInit(PDM_ODM_T pDM_Odm); -+ -+void odm_TXPowerTrackingThermalMeterInit(PDM_ODM_T pDM_Odm); -+ -+ -+void odm_TXPowerTrackingInit(PDM_ODM_T pDM_Odm); -+ -+void odm_TXPowerTrackingCheckCE(PDM_ODM_T pDM_Odm); -+ -+/* Remove Edca by Yu Chen */ -+ -+ -+#define RxDefaultAnt1 0x65a9 -+#define RxDefaultAnt2 0x569a -+ -+void odm_InitHybridAntDiv(PDM_ODM_T pDM_Odm); -+ -+bool odm_StaDefAntSel( -+ PDM_ODM_T pDM_Odm, -+ u32 OFDM_Ant1_Cnt, -+ u32 OFDM_Ant2_Cnt, -+ u32 CCK_Ant1_Cnt, -+ u32 CCK_Ant2_Cnt, -+ u8 *pDefAnt -+); -+ -+void odm_SetRxIdleAnt(PDM_ODM_T pDM_Odm, u8 Ant, bool bDualPath); -+ -+ -+ -+void odm_HwAntDiv(PDM_ODM_T pDM_Odm); -+ -+ -+/* */ -+/* 3 Export Interface */ -+/* */ -+ -+/* */ -+/* 2011/09/21 MH Add to describe different team necessary resource allocate?? */ -+/* */ -+void ODM_DMInit(PDM_ODM_T pDM_Odm) -+{ -+ -+ odm_CommonInfoSelfInit(pDM_Odm); -+ odm_CmnInfoInit_Debug(pDM_Odm); -+ odm_DIGInit(pDM_Odm); -+ odm_NHMCounterStatisticsInit(pDM_Odm); -+ odm_AdaptivityInit(pDM_Odm); -+ odm_RateAdaptiveMaskInit(pDM_Odm); -+ ODM_CfoTrackingInit(pDM_Odm); -+ ODM_EdcaTurboInit(pDM_Odm); -+ odm_RSSIMonitorInit(pDM_Odm); -+ odm_TXPowerTrackingInit(pDM_Odm); -+ -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+ -+ if (*(pDM_Odm->mp_mode) != 1) -+ odm_PathDiversityInit(pDM_Odm); -+ -+ odm_DynamicBBPowerSavingInit(pDM_Odm); -+ odm_DynamicTxPowerInit(pDM_Odm); -+ -+ odm_SwAntDetectInit(pDM_Odm); -+} -+ -+/* */ -+/* 2011/09/20 MH This is the entry pointer for all team to execute HW out source DM. */ -+/* You can not add any dummy function here, be care, you can only use DM structure */ -+/* to perform any new ODM_DM. */ -+/* */ -+void ODM_DMWatchdog(PDM_ODM_T pDM_Odm) -+{ -+ odm_CommonInfoSelfUpdate(pDM_Odm); -+ odm_BasicDbgMessage(pDM_Odm); -+ odm_FalseAlarmCounterStatistics(pDM_Odm); -+ odm_NHMCounterStatistics(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): RSSI = 0x%x\n", pDM_Odm->RSSI_Min)); -+ -+ odm_RSSIMonitorCheck(pDM_Odm); -+ -+ /* For CE Platform(SPRD or Tablet) */ -+ /* 8723A or 8189ES platform */ -+ /* NeilChen--2012--08--24-- */ -+ /* Fix Leave LPS issue */ -+ if ((adapter_to_pwrctl(pDM_Odm->Adapter)->pwr_mode != PS_MODE_ACTIVE) /* in LPS mode */ -+ /* */ -+ /* (pDM_Odm->SupportICType & (ODM_RTL8723A))|| */ -+ /* (pDM_Odm->SupportICType & (ODM_RTL8188E) &&(&&(((pDM_Odm->SupportInterface == ODM_ITRF_SDIO))) */ -+ /* */ -+ ) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("----Step1: odm_DIG is in LPS mode\n")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("---Step2: 8723AS is in LPS mode\n")); -+ odm_DIGbyRSSI_LPS(pDM_Odm); -+ } else -+ odm_DIG(pDM_Odm); -+ -+ { -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ odm_Adaptivity(pDM_Odm, pDM_DigTable->CurIGValue); -+ } -+ odm_CCKPacketDetectionThresh(pDM_Odm); -+ -+ if (*(pDM_Odm->pbPowerSaving) == true) -+ return; -+ -+ -+ odm_RefreshRateAdaptiveMask(pDM_Odm); -+ odm_EdcaTurboCheck(pDM_Odm); -+ odm_PathDiversity(pDM_Odm); -+ ODM_CfoTracking(pDM_Odm); -+ -+ ODM_TXPowerTrackingCheck(pDM_Odm); -+ -+ /* odm_EdcaTurboCheck(pDM_Odm); */ -+ -+ /* 2010.05.30 LukeLee: For CE platform, files in IC subfolders may not be included to be compiled, */ -+ /* so compile flags must be left here to prevent from compile errors */ -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt = 0; -+} -+ -+ -+/* */ -+/* Init /.. Fixed HW value. Only init time. */ -+/* */ -+void ODM_CmnInfoInit(PDM_ODM_T pDM_Odm, ODM_CMNINFO_E CmnInfo, u32 Value) -+{ -+ /* */ -+ /* This section is used for init value */ -+ /* */ -+ switch (CmnInfo) { -+ /* */ -+ /* Fixed ODM value. */ -+ /* */ -+ case ODM_CMNINFO_ABILITY: -+ pDM_Odm->SupportAbility = (u32)Value; -+ break; -+ -+ case ODM_CMNINFO_RF_TYPE: -+ pDM_Odm->RFType = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_PLATFORM: -+ pDM_Odm->SupportPlatform = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_INTERFACE: -+ pDM_Odm->SupportInterface = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_MP_TEST_CHIP: -+ pDM_Odm->bIsMPChip = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_IC_TYPE: -+ pDM_Odm->SupportICType = Value; -+ break; -+ -+ case ODM_CMNINFO_CUT_VER: -+ pDM_Odm->CutVersion = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_FAB_VER: -+ pDM_Odm->FabVersion = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_RFE_TYPE: -+ pDM_Odm->RFEType = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_RF_ANTENNA_TYPE: -+ pDM_Odm->AntDivType = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_BOARD_TYPE: -+ pDM_Odm->BoardType = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_PACKAGE_TYPE: -+ pDM_Odm->PackageType = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_EXT_LNA: -+ pDM_Odm->ExtLNA = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_5G_EXT_LNA: -+ pDM_Odm->ExtLNA5G = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_EXT_PA: -+ pDM_Odm->ExtPA = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_5G_EXT_PA: -+ pDM_Odm->ExtPA5G = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_GPA: -+ pDM_Odm->TypeGPA = (ODM_TYPE_GPA_E)Value; -+ break; -+ case ODM_CMNINFO_APA: -+ pDM_Odm->TypeAPA = (ODM_TYPE_APA_E)Value; -+ break; -+ case ODM_CMNINFO_GLNA: -+ pDM_Odm->TypeGLNA = (ODM_TYPE_GLNA_E)Value; -+ break; -+ case ODM_CMNINFO_ALNA: -+ pDM_Odm->TypeALNA = (ODM_TYPE_ALNA_E)Value; -+ break; -+ -+ case ODM_CMNINFO_EXT_TRSW: -+ pDM_Odm->ExtTRSW = (u8)Value; -+ break; -+ case ODM_CMNINFO_PATCH_ID: -+ pDM_Odm->PatchID = (u8)Value; -+ break; -+ case ODM_CMNINFO_BINHCT_TEST: -+ pDM_Odm->bInHctTest = (bool)Value; -+ break; -+ case ODM_CMNINFO_BWIFI_TEST: -+ pDM_Odm->bWIFITest = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_SMART_CONCURRENT: -+ pDM_Odm->bDualMacSmartConcurrent = (bool)Value; -+ break; -+ -+ /* To remove the compiler warning, must add an empty default statement to handle the other values. */ -+ default: -+ /* do nothing */ -+ break; -+ } -+ -+} -+ -+ -+void ODM_CmnInfoHook(PDM_ODM_T pDM_Odm, ODM_CMNINFO_E CmnInfo, void *pValue) -+{ -+ /* */ -+ /* Hook call by reference pointer. */ -+ /* */ -+ switch (CmnInfo) { -+ /* */ -+ /* Dynamic call by reference pointer. */ -+ /* */ -+ case ODM_CMNINFO_MAC_PHY_MODE: -+ pDM_Odm->pMacPhyMode = (u8 *)pValue; -+ break; -+ -+ case ODM_CMNINFO_TX_UNI: -+ pDM_Odm->pNumTxBytesUnicast = (u64 *)pValue; -+ break; -+ -+ case ODM_CMNINFO_RX_UNI: -+ pDM_Odm->pNumRxBytesUnicast = (u64 *)pValue; -+ break; -+ -+ case ODM_CMNINFO_WM_MODE: -+ pDM_Odm->pwirelessmode = (u8 *)pValue; -+ break; -+ -+ case ODM_CMNINFO_BAND: -+ pDM_Odm->pBandType = (u8 *)pValue; -+ break; -+ -+ case ODM_CMNINFO_SEC_CHNL_OFFSET: -+ pDM_Odm->pSecChOffset = (u8 *)pValue; -+ break; -+ -+ case ODM_CMNINFO_SEC_MODE: -+ pDM_Odm->pSecurity = (u8 *)pValue; -+ break; -+ -+ case ODM_CMNINFO_BW: -+ pDM_Odm->pBandWidth = (u8 *)pValue; -+ break; -+ -+ case ODM_CMNINFO_CHNL: -+ pDM_Odm->pChannel = (u8 *)pValue; -+ break; -+ -+ case ODM_CMNINFO_DMSP_GET_VALUE: -+ pDM_Odm->pbGetValueFromOtherMac = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_BUDDY_ADAPTOR: -+ pDM_Odm->pBuddyAdapter = (struct adapter **)pValue; -+ break; -+ -+ case ODM_CMNINFO_DMSP_IS_MASTER: -+ pDM_Odm->pbMasterOfDMSP = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_SCAN: -+ pDM_Odm->pbScanInProcess = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_POWER_SAVING: -+ pDM_Odm->pbPowerSaving = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_ONE_PATH_CCA: -+ pDM_Odm->pOnePathCCA = (u8 *)pValue; -+ break; -+ -+ case ODM_CMNINFO_DRV_STOP: -+ pDM_Odm->pbDriverStopped = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_PNP_IN: -+ pDM_Odm->pbDriverIsGoingToPnpSetPowerSleep = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_INIT_ON: -+ pDM_Odm->pinit_adpt_in_progress = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_ANT_TEST: -+ pDM_Odm->pAntennaTest = (u8 *)pValue; -+ break; -+ -+ case ODM_CMNINFO_NET_CLOSED: -+ pDM_Odm->pbNet_closed = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_FORCED_RATE: -+ pDM_Odm->pForcedDataRate = (u16 *)pValue; -+ break; -+ -+ case ODM_CMNINFO_FORCED_IGI_LB: -+ pDM_Odm->pu1ForcedIgiLb = (u8 *)pValue; -+ break; -+ -+ case ODM_CMNINFO_MP_MODE: -+ pDM_Odm->mp_mode = (u8 *)pValue; -+ break; -+ -+ /* case ODM_CMNINFO_RTSTA_AID: */ -+ /* pDM_Odm->pAidMap = (u8 *)pValue; */ -+ /* break; */ -+ -+ /* case ODM_CMNINFO_BT_COEXIST: */ -+ /* pDM_Odm->BTCoexist = (bool *)pValue; */ -+ -+ /* case ODM_CMNINFO_STA_STATUS: */ -+ /* pDM_Odm->pODM_StaInfo[] = (PSTA_INFO_T)pValue; */ -+ /* break; */ -+ -+ /* case ODM_CMNINFO_PHY_STATUS: */ -+ /* pDM_Odm->pPhyInfo = (ODM_PHY_INFO *)pValue; */ -+ /* break; */ -+ -+ /* case ODM_CMNINFO_MAC_STATUS: */ -+ /* pDM_Odm->pMacInfo = (ODM_MAC_INFO *)pValue; */ -+ /* break; */ -+ /* To remove the compiler warning, must add an empty default statement to handle the other values. */ -+ default: -+ /* do nothing */ -+ break; -+ } -+ -+} -+ -+ -+void ODM_CmnInfoPtrArrayHook( -+ PDM_ODM_T pDM_Odm, -+ ODM_CMNINFO_E CmnInfo, -+ u16 Index, -+ void *pValue -+) -+{ -+ /* */ -+ /* Hook call by reference pointer. */ -+ /* */ -+ switch (CmnInfo) { -+ /* */ -+ /* Dynamic call by reference pointer. */ -+ /* */ -+ case ODM_CMNINFO_STA_STATUS: -+ pDM_Odm->pODM_StaInfo[Index] = (PSTA_INFO_T)pValue; -+ break; -+ /* To remove the compiler warning, must add an empty default statement to handle the other values. */ -+ default: -+ /* do nothing */ -+ break; -+ } -+ -+} -+ -+ -+/* */ -+/* Update Band/CHannel/.. The values are dynamic but non-per-packet. */ -+/* */ -+void ODM_CmnInfoUpdate(PDM_ODM_T pDM_Odm, u32 CmnInfo, u64 Value) -+{ -+ /* */ -+ /* This init variable may be changed in run time. */ -+ /* */ -+ switch (CmnInfo) { -+ case ODM_CMNINFO_LINK_IN_PROGRESS: -+ pDM_Odm->bLinkInProcess = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_ABILITY: -+ pDM_Odm->SupportAbility = (u32)Value; -+ break; -+ -+ case ODM_CMNINFO_RF_TYPE: -+ pDM_Odm->RFType = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_WIFI_DIRECT: -+ pDM_Odm->bWIFI_Direct = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_WIFI_DISPLAY: -+ pDM_Odm->bWIFI_Display = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_LINK: -+ pDM_Odm->bLinked = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_STATION_STATE: -+ pDM_Odm->bsta_state = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_RSSI_MIN: -+ pDM_Odm->RSSI_Min = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_DBG_COMP: -+ pDM_Odm->DebugComponents = Value; -+ break; -+ -+ case ODM_CMNINFO_DBG_LEVEL: -+ pDM_Odm->DebugLevel = (u32)Value; -+ break; -+ case ODM_CMNINFO_RA_THRESHOLD_HIGH: -+ pDM_Odm->RateAdaptive.HighRSSIThresh = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_RA_THRESHOLD_LOW: -+ pDM_Odm->RateAdaptive.LowRSSIThresh = (u8)Value; -+ break; -+ /* The following is for BT HS mode and BT coexist mechanism. */ -+ case ODM_CMNINFO_BT_ENABLED: -+ pDM_Odm->bBtEnabled = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_HS_CONNECT_PROCESS: -+ pDM_Odm->bBtConnectProcess = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_HS_RSSI: -+ pDM_Odm->btHsRssi = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_OPERATION: -+ pDM_Odm->bBtHsOperation = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_LIMITED_DIG: -+ pDM_Odm->bBtLimitedDig = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_DISABLE_EDCA: -+ pDM_Odm->bBtDisableEdcaTurbo = (bool)Value; -+ break; -+ -+/* -+ case ODM_CMNINFO_OP_MODE: -+ pDM_Odm->OPMode = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_WM_MODE: -+ pDM_Odm->WirelessMode = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_BAND: -+ pDM_Odm->BandType = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_SEC_CHNL_OFFSET: -+ pDM_Odm->SecChOffset = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_SEC_MODE: -+ pDM_Odm->Security = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_BW: -+ pDM_Odm->BandWidth = (u8)Value; -+ break; -+ -+ case ODM_CMNINFO_CHNL: -+ pDM_Odm->Channel = (u8)Value; -+ break; -+*/ -+ default: -+ /* do nothing */ -+ break; -+ } -+ -+ -+} -+ -+void odm_CommonInfoSelfInit(PDM_ODM_T pDM_Odm) -+{ -+ pDM_Odm->bCckHighPower = (bool) PHY_QueryBBReg(pDM_Odm->Adapter, ODM_REG(CCK_RPT_FORMAT, pDM_Odm), ODM_BIT(CCK_RPT_FORMAT, pDM_Odm)); -+ pDM_Odm->RFPathRxEnable = (u8) PHY_QueryBBReg(pDM_Odm->Adapter, ODM_REG(BB_RX_PATH, pDM_Odm), ODM_BIT(BB_RX_PATH, pDM_Odm)); -+ -+ ODM_InitDebugSetting(pDM_Odm); -+ -+ pDM_Odm->TxRate = 0xFF; -+} -+ -+void odm_CommonInfoSelfUpdate(PDM_ODM_T pDM_Odm) -+{ -+ u8 EntryCnt = 0; -+ u8 i; -+ PSTA_INFO_T pEntry; -+ -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) { -+ if (*(pDM_Odm->pSecChOffset) == 1) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel)-2; -+ else if (*(pDM_Odm->pSecChOffset) == 2) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel)+2; -+ } else -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel); -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ pEntry = pDM_Odm->pODM_StaInfo[i]; -+ if (IS_STA_VALID(pEntry)) -+ EntryCnt++; -+ } -+ -+ if (EntryCnt == 1) -+ pDM_Odm->bOneEntryOnly = true; -+ else -+ pDM_Odm->bOneEntryOnly = false; -+} -+ -+void odm_CmnInfoInit_Debug(PDM_ODM_T pDM_Odm) -+{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_CmnInfoInit_Debug ==>\n")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("SupportPlatform =%d\n", pDM_Odm->SupportPlatform)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("SupportAbility = 0x%x\n", pDM_Odm->SupportAbility)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("SupportInterface =%d\n", pDM_Odm->SupportInterface)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("SupportICType = 0x%x\n", pDM_Odm->SupportICType)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("CutVersion =%d\n", pDM_Odm->CutVersion)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("FabVersion =%d\n", pDM_Odm->FabVersion)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("RFType =%d\n", pDM_Odm->RFType)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("BoardType =%d\n", pDM_Odm->BoardType)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("ExtLNA =%d\n", pDM_Odm->ExtLNA)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("ExtPA =%d\n", pDM_Odm->ExtPA)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("ExtTRSW =%d\n", pDM_Odm->ExtTRSW)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("PatchID =%d\n", pDM_Odm->PatchID)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("bInHctTest =%d\n", pDM_Odm->bInHctTest)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("bWIFITest =%d\n", pDM_Odm->bWIFITest)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("bDualMacSmartConcurrent =%d\n", pDM_Odm->bDualMacSmartConcurrent)); -+ -+} -+ -+void odm_BasicDbgMessage(PDM_ODM_T pDM_Odm) -+{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_BasicDbgMsg ==>\n")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("bLinked = %d, RSSI_Min = %d,\n", -+ pDM_Odm->bLinked, pDM_Odm->RSSI_Min)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("RxRate = 0x%x, RSSI_A = %d, RSSI_B = %d\n", -+ pDM_Odm->RxRate, pDM_Odm->RSSI_A, pDM_Odm->RSSI_B)); -+} -+ -+/* 3 ============================================================ */ -+/* 3 DIG */ -+/* 3 ============================================================ */ -+/*----------------------------------------------------------------------------- -+ * Function: odm_DIGInit() -+ * -+ * Overview: Set DIG scheme init value. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ *When Who Remark -+ * -+ *--------------------------------------------------------------------------- -+ */ -+ -+/* Remove DIG by yuchen */ -+ -+/* Remove DIG and FA check by Yu Chen */ -+ -+ -+/* 3 ============================================================ */ -+/* 3 BB Power Save */ -+/* 3 ============================================================ */ -+ -+/* Remove BB power saving by Yuchen */ -+ -+/* 3 ============================================================ */ -+/* 3 RATR MASK */ -+/* 3 ============================================================ */ -+/* 3 ============================================================ */ -+/* 3 Rate Adaptive */ -+/* 3 ============================================================ */ -+ -+void odm_RateAdaptiveMaskInit(PDM_ODM_T pDM_Odm) -+{ -+ PODM_RATE_ADAPTIVE pOdmRA = &pDM_Odm->RateAdaptive; -+ -+ pOdmRA->Type = DM_Type_ByDriver; -+ if (pOdmRA->Type == DM_Type_ByDriver) -+ pDM_Odm->bUseRAMask = true; -+ else -+ pDM_Odm->bUseRAMask = false; -+ -+ pOdmRA->RATRState = DM_RATR_STA_INIT; -+ pOdmRA->LdpcThres = 35; -+ pOdmRA->bUseLdpc = false; -+ pOdmRA->HighRSSIThresh = 50; -+ pOdmRA->LowRSSIThresh = 20; -+} -+ -+u32 ODM_Get_Rate_Bitmap( -+ PDM_ODM_T pDM_Odm, -+ u32 macid, -+ u32 ra_mask, -+ u8 rssi_level -+) -+{ -+ PSTA_INFO_T pEntry; -+ u32 rate_bitmap = 0; -+ u8 WirelessMode; -+ -+ pEntry = pDM_Odm->pODM_StaInfo[macid]; -+ if (!IS_STA_VALID(pEntry)) -+ return ra_mask; -+ -+ WirelessMode = pEntry->wireless_mode; -+ -+ switch (WirelessMode) { -+ case ODM_WM_B: -+ if (ra_mask & 0x0000000c) /* 11M or 5.5M enable */ -+ rate_bitmap = 0x0000000d; -+ else -+ rate_bitmap = 0x0000000f; -+ break; -+ -+ case (ODM_WM_G): -+ case (ODM_WM_A): -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x00000f00; -+ else -+ rate_bitmap = 0x00000ff0; -+ break; -+ -+ case (ODM_WM_B|ODM_WM_G): -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x00000f00; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x00000ff0; -+ else -+ rate_bitmap = 0x00000ff5; -+ break; -+ -+ case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G): -+ case (ODM_WM_B|ODM_WM_N24G): -+ case (ODM_WM_G|ODM_WM_N24G): -+ case (ODM_WM_A|ODM_WM_N5G): -+ if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) { -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x000f0000; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x000ff000; -+ else { -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x000ff015; -+ else -+ rate_bitmap = 0x000ff005; -+ } -+ } else { -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x0f8f0000; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x0f8ff000; -+ else { -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x0f8ff015; -+ else -+ rate_bitmap = 0x0f8ff005; -+ } -+ } -+ break; -+ -+ case (ODM_WM_AC|ODM_WM_G): -+ if (rssi_level == 1) -+ rate_bitmap = 0xfc3f0000; -+ else if (rssi_level == 2) -+ rate_bitmap = 0xfffff000; -+ else -+ rate_bitmap = 0xffffffff; -+ break; -+ -+ case (ODM_WM_AC|ODM_WM_A): -+ -+ if (pDM_Odm->RFType == RF_1T1R) { -+ if (rssi_level == 1) /* add by Gary for ac-series */ -+ rate_bitmap = 0x003f8000; -+ else if (rssi_level == 2) -+ rate_bitmap = 0x003ff000; -+ else -+ rate_bitmap = 0x003ff010; -+ } else { -+ if (rssi_level == 1) /* add by Gary for ac-series */ -+ rate_bitmap = 0xfe3f8000; /* VHT 2SS MCS3~9 */ -+ else if (rssi_level == 2) -+ rate_bitmap = 0xfffff000; /* VHT 2SS MCS0~9 */ -+ else -+ rate_bitmap = 0xfffff010; /* All */ -+ } -+ break; -+ -+ default: -+ if (pDM_Odm->RFType == RF_1T2R) -+ rate_bitmap = 0x000fffff; -+ else -+ rate_bitmap = 0x0fffffff; -+ break; -+ } -+ -+ /* printk("%s ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x\n", __func__, rssi_level, WirelessMode, rate_bitmap); */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, (" ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x\n", rssi_level, WirelessMode, rate_bitmap)); -+ -+ return (ra_mask&rate_bitmap); -+ -+} -+ -+/*----------------------------------------------------------------------------- -+* Function: odm_RefreshRateAdaptiveMask() -+* -+* Overview: Update rate table mask according to rssi -+* -+* Input: NONE -+* -+* Output: NONE -+* -+* Return: NONE -+* -+* Revised History: -+*When Who Remark -+*05/27/2009 hpfan Create Version 0. -+* -+* -------------------------------------------------------------------------- -+*/ -+void odm_RefreshRateAdaptiveMask(PDM_ODM_T pDM_Odm) -+{ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("odm_RefreshRateAdaptiveMask()---------->\n")); -+ if (!(pDM_Odm->SupportAbility & ODM_BB_RA_MASK)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("odm_RefreshRateAdaptiveMask(): Return cos not supported\n")); -+ return; -+ } -+ odm_RefreshRateAdaptiveMaskCE(pDM_Odm); -+} -+ -+void odm_RefreshRateAdaptiveMaskCE(PDM_ODM_T pDM_Odm) -+{ -+ u8 i; -+ struct adapter *padapter = pDM_Odm->Adapter; -+ -+ if (padapter->bDriverStopped) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_RefreshRateAdaptiveMask(): driver is going to unload\n")); -+ return; -+ } -+ -+ if (!pDM_Odm->bUseRAMask) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_RefreshRateAdaptiveMask(): driver does not control rate adaptive mask\n")); -+ return; -+ } -+ -+ /* printk("==> %s\n", __func__); */ -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ PSTA_INFO_T pstat = pDM_Odm->pODM_StaInfo[i]; -+ -+ if (IS_STA_VALID(pstat)) { -+ if (IS_MCAST(pstat->hwaddr)) /* if (psta->mac_id == 1) */ -+ continue; -+ if (IS_MCAST(pstat->hwaddr)) -+ continue; -+ -+ if (true == ODM_RAStateCheck(pDM_Odm, pstat->rssi_stat.UndecoratedSmoothedPWDB, false, &pstat->rssi_level)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pstat->rssi_stat.UndecoratedSmoothedPWDB, pstat->rssi_level)); -+ /* printk("RSSI:%d, RSSI_LEVEL:%d\n", pstat->rssi_stat.UndecoratedSmoothedPWDB, pstat->rssi_level); */ -+ rtw_hal_update_ra_mask(pstat, pstat->rssi_level); -+ } -+ -+ } -+ } -+} -+ -+/* Return Value: bool */ -+/* - true: RATRState is changed. */ -+bool ODM_RAStateCheck( -+ PDM_ODM_T pDM_Odm, -+ s32 RSSI, -+ bool bForceUpdate, -+ u8 *pRATRState -+) -+{ -+ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; -+ const u8 GoUpGap = 5; -+ u8 HighRSSIThreshForRA = pRA->HighRSSIThresh; -+ u8 LowRSSIThreshForRA = pRA->LowRSSIThresh; -+ u8 RATRState; -+ -+ /* Threshold Adjustment: */ -+ /* when RSSI state trends to go up one or two levels, make sure RSSI is high enough. */ -+ /* Here GoUpGap is added to solve the boundary's level alternation issue. */ -+ switch (*pRATRState) { -+ case DM_RATR_STA_INIT: -+ case DM_RATR_STA_HIGH: -+ break; -+ -+ case DM_RATR_STA_MIDDLE: -+ HighRSSIThreshForRA += GoUpGap; -+ break; -+ -+ case DM_RATR_STA_LOW: -+ HighRSSIThreshForRA += GoUpGap; -+ LowRSSIThreshForRA += GoUpGap; -+ break; -+ -+ default: -+ ODM_RT_ASSERT(pDM_Odm, false, ("wrong rssi level setting %d !", *pRATRState)); -+ break; -+ } -+ -+ /* Decide RATRState by RSSI. */ -+ if (RSSI > HighRSSIThreshForRA) -+ RATRState = DM_RATR_STA_HIGH; -+ else if (RSSI > LowRSSIThreshForRA) -+ RATRState = DM_RATR_STA_MIDDLE; -+ else -+ RATRState = DM_RATR_STA_LOW; -+ /* printk("==>%s, RATRState:0x%02x , RSSI:%d\n", __func__, RATRState, RSSI); */ -+ -+ if (*pRATRState != RATRState || bForceUpdate) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI Level %d -> %d\n", *pRATRState, RATRState)); -+ *pRATRState = RATRState; -+ return true; -+ } -+ -+ return false; -+} -+ -+ -+/* */ -+ -+/* 3 ============================================================ */ -+/* 3 Dynamic Tx Power */ -+/* 3 ============================================================ */ -+ -+/* Remove BY YuChen */ -+ -+/* 3 ============================================================ */ -+/* 3 RSSI Monitor */ -+/* 3 ============================================================ */ -+ -+void odm_RSSIMonitorInit(PDM_ODM_T pDM_Odm) -+{ -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ pRA_Table->firstconnect = false; -+ -+} -+ -+void odm_RSSIMonitorCheck(PDM_ODM_T pDM_Odm) -+{ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)) -+ return; -+ -+ odm_RSSIMonitorCheckCE(pDM_Odm); -+ -+} /* odm_RSSIMonitorCheck */ -+ -+static void FindMinimumRSSI(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ /* 1 1.Determine the minimum RSSI */ -+ -+ if ( -+ (pDM_Odm->bLinked != true) && -+ (pdmpriv->EntryMinUndecoratedSmoothedPWDB == 0) -+ ) { -+ pdmpriv->MinUndecoratedPWDBForDM = 0; -+ /* ODM_RT_TRACE(pDM_Odm, COMP_BB_POWERSAVING, DBG_LOUD, ("Not connected to any\n")); */ -+ } else -+ pdmpriv->MinUndecoratedPWDBForDM = pdmpriv->EntryMinUndecoratedSmoothedPWDB; -+ -+ /* DBG_8192C("%s =>MinUndecoratedPWDBForDM(%d)\n", __func__, pdmpriv->MinUndecoratedPWDBForDM); */ -+ /* ODM_RT_TRACE(pDM_Odm, COMP_DIG, DBG_LOUD, ("MinUndecoratedPWDBForDM =%d\n", pHalData->MinUndecoratedPWDBForDM)); */ -+} -+ -+void odm_RSSIMonitorCheckCE(PDM_ODM_T pDM_Odm) -+{ -+ struct adapter *Adapter = pDM_Odm->Adapter; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ int i; -+ int tmpEntryMaxPWDB = 0, tmpEntryMinPWDB = 0xff; -+ u8 sta_cnt = 0; -+ u32 PWDB_rssi[NUM_STA] = {0};/* 0~15]:MACID, [16~31]:PWDB_rssi */ -+ bool FirstConnect = false; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ if (pDM_Odm->bLinked != true) -+ return; -+ -+ FirstConnect = (pDM_Odm->bLinked) && (pRA_Table->firstconnect == false); -+ pRA_Table->firstconnect = pDM_Odm->bLinked; -+ -+ /* if (check_fwstate(&Adapter->mlmepriv, WIFI_AP_STATE|WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE) == true) */ -+ { -+ struct sta_info *psta; -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ psta = pDM_Odm->pODM_StaInfo[i]; -+ if (IS_STA_VALID(psta)) { -+ if (IS_MCAST(psta->hwaddr)) /* if (psta->mac_id == 1) */ -+ continue; -+ -+ if (psta->rssi_stat.UndecoratedSmoothedPWDB == (-1)) -+ continue; -+ -+ if (psta->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB) -+ tmpEntryMinPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ if (psta->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB) -+ tmpEntryMaxPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ if (psta->rssi_stat.UndecoratedSmoothedPWDB != (-1)) -+ PWDB_rssi[sta_cnt++] = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB<<16)); -+ } -+ } -+ -+ /* printk("%s ==> sta_cnt(%d)\n", __func__, sta_cnt); */ -+ -+ for (i = 0; i < sta_cnt; i++) { -+ if (PWDB_rssi[i] != (0)) { -+ if (pHalData->fw_ractrl == true)/* Report every sta's RSSI to FW */ -+ rtl8723b_set_rssi_cmd(Adapter, (u8 *)(&PWDB_rssi[i])); -+ } -+ } -+ } -+ -+ -+ -+ if (tmpEntryMaxPWDB != 0) /* If associated entry is found */ -+ pdmpriv->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB; -+ else -+ pdmpriv->EntryMaxUndecoratedSmoothedPWDB = 0; -+ -+ if (tmpEntryMinPWDB != 0xff) /* If associated entry is found */ -+ pdmpriv->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB; -+ else -+ pdmpriv->EntryMinUndecoratedSmoothedPWDB = 0; -+ -+ FindMinimumRSSI(Adapter);/* get pdmpriv->MinUndecoratedPWDBForDM */ -+ -+ pDM_Odm->RSSI_Min = pdmpriv->MinUndecoratedPWDBForDM; -+ /* ODM_CmnInfoUpdate(&pHalData->odmpriv , ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM); */ -+} -+ -+/* 3 ============================================================ */ -+/* 3 Tx Power Tracking */ -+/* 3 ============================================================ */ -+ -+void odm_TXPowerTrackingInit(PDM_ODM_T pDM_Odm) -+{ -+ odm_TXPowerTrackingThermalMeterInit(pDM_Odm); -+} -+ -+static u8 getSwingIndex(PDM_ODM_T pDM_Odm) -+{ -+ struct adapter *Adapter = pDM_Odm->Adapter; -+ u8 i = 0; -+ u32 bbSwing; -+ u32 swingTableSize; -+ u32 *pSwingTable; -+ -+ bbSwing = PHY_QueryBBReg(Adapter, rOFDM0_XATxIQImbalance, 0xFFC00000); -+ -+ pSwingTable = OFDMSwingTable_New; -+ swingTableSize = OFDM_TABLE_SIZE; -+ -+ for (i = 0; i < swingTableSize; ++i) { -+ u32 tableValue = pSwingTable[i]; -+ -+ if (tableValue >= 0x100000) -+ tableValue >>= 22; -+ if (bbSwing == tableValue) -+ break; -+ } -+ return i; -+} -+ -+void odm_TXPowerTrackingThermalMeterInit(PDM_ODM_T pDM_Odm) -+{ -+ u8 defaultSwingIndex = getSwingIndex(pDM_Odm); -+ u8 p = 0; -+ struct adapter *Adapter = pDM_Odm->Adapter; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ -+ pdmpriv->bTXPowerTracking = true; -+ pdmpriv->TXPowercount = 0; -+ pdmpriv->bTXPowerTrackingInit = false; -+ -+ if (*(pDM_Odm->mp_mode) != 1) -+ pdmpriv->TxPowerTrackControl = true; -+ else -+ pdmpriv->TxPowerTrackControl = false; -+ -+ -+ /* MSG_8192C("pdmpriv->TxPowerTrackControl = %d\n", pdmpriv->TxPowerTrackControl); */ -+ -+ /* pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = true; */ -+ pDM_Odm->RFCalibrateInfo.ThermalValue = pHalData->EEPROMThermalMeter; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = pHalData->EEPROMThermalMeter; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = pHalData->EEPROMThermalMeter; -+ -+ /* The index of "0 dB" in SwingTable. */ -+ pDM_Odm->DefaultOfdmIndex = (defaultSwingIndex >= OFDM_TABLE_SIZE) ? 30 : defaultSwingIndex; -+ pDM_Odm->DefaultCckIndex = 20; -+ -+ pDM_Odm->BbSwingIdxCckBase = pDM_Odm->DefaultCckIndex; -+ pDM_Odm->RFCalibrateInfo.CCK_index = pDM_Odm->DefaultCckIndex; -+ -+ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) { -+ pDM_Odm->BbSwingIdxOfdmBase[p] = pDM_Odm->DefaultOfdmIndex; -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pDM_Odm->DefaultOfdmIndex; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = 0; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] = 0; -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; -+ } -+ -+} -+ -+ -+void ODM_TXPowerTrackingCheck(PDM_ODM_T pDM_Odm) -+{ -+ odm_TXPowerTrackingCheckCE(pDM_Odm); -+} -+ -+void odm_TXPowerTrackingCheckCE(PDM_ODM_T pDM_Odm) -+{ -+ struct adapter *Adapter = pDM_Odm->Adapter; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) -+ return; -+ -+ if (!pDM_Odm->RFCalibrateInfo.TM_Trigger) { /* at least delay 1 sec */ -+ PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_T_METER_NEW, (BIT17 | BIT16), 0x03); -+ -+ /* DBG_871X("Trigger Thermal Meter!!\n"); */ -+ -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; -+ return; -+ } else { -+ /* DBG_871X("Schedule TxPowerTracking direct call!!\n"); */ -+ ODM_TXPowerTrackingCallback_ThermalMeter(Adapter); -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; -+ } -+} -+ -+/* 3 ============================================================ */ -+/* 3 SW Antenna Diversity */ -+/* 3 ============================================================ */ -+void odm_SwAntDetectInit(PDM_ODM_T pDM_Odm) -+{ -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ pDM_SWAT_Table->SWAS_NoLink_BK_Reg92c = rtw_read32(pDM_Odm->Adapter, rDPDT_control); -+ pDM_SWAT_Table->PreAntenna = MAIN_ANT; -+ pDM_SWAT_Table->CurAntenna = MAIN_ANT; -+ pDM_SWAT_Table->SWAS_NoLink_State = 0; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_CfoTracking.c linux/3rdparty/rtl8723bs/hal/odm_CfoTracking.c ---- linux.old/3rdparty/rtl8723bs/hal/odm_CfoTracking.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_CfoTracking.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,338 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+static void odm_SetCrystalCap(void *pDM_VOID, u8 CrystalCap) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = &pDM_Odm->DM_CfoTrack; -+ bool bEEPROMCheck; -+ struct adapter *Adapter = pDM_Odm->Adapter; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ bEEPROMCheck = (pHalData->EEPROMVersion >= 0x01) ? true : false; -+ -+ if (pCfoTrack->CrystalCap == CrystalCap) -+ return; -+ -+ pCfoTrack->CrystalCap = CrystalCap; -+ -+ /* 0x2C[23:18] = 0x2C[17:12] = CrystalCap */ -+ CrystalCap = CrystalCap & 0x3F; -+ PHY_SetBBReg( -+ pDM_Odm->Adapter, -+ REG_MAC_PHY_CTRL, -+ 0x00FFF000, -+ (CrystalCap | (CrystalCap << 6)) -+ ); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CFO_TRACKING, -+ ODM_DBG_LOUD, -+ ( -+ "odm_SetCrystalCap(): CrystalCap = 0x%x\n", -+ CrystalCap -+ ) -+ ); -+} -+ -+static u8 odm_GetDefaultCrytaltalCap(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u8 CrystalCap = 0x20; -+ -+ struct adapter *Adapter = pDM_Odm->Adapter; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ CrystalCap = pHalData->CrystalCap; -+ -+ CrystalCap = CrystalCap & 0x3f; -+ -+ return CrystalCap; -+} -+ -+static void odm_SetATCStatus(void *pDM_VOID, bool ATCStatus) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = &pDM_Odm->DM_CfoTrack; -+ -+ if (pCfoTrack->bATCStatus == ATCStatus) -+ return; -+ -+ PHY_SetBBReg( -+ pDM_Odm->Adapter, -+ ODM_REG(BB_ATC, pDM_Odm), -+ ODM_BIT(BB_ATC, pDM_Odm), -+ ATCStatus -+ ); -+ pCfoTrack->bATCStatus = ATCStatus; -+} -+ -+static bool odm_GetATCStatus(void *pDM_VOID) -+{ -+ bool ATCStatus; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ATCStatus = (bool)PHY_QueryBBReg( -+ pDM_Odm->Adapter, -+ ODM_REG(BB_ATC, pDM_Odm), -+ ODM_BIT(BB_ATC, pDM_Odm) -+ ); -+ return ATCStatus; -+} -+ -+void ODM_CfoTrackingReset(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = &pDM_Odm->DM_CfoTrack; -+ -+ pCfoTrack->DefXCap = odm_GetDefaultCrytaltalCap(pDM_Odm); -+ pCfoTrack->bAdjust = true; -+ -+ odm_SetCrystalCap(pDM_Odm, pCfoTrack->DefXCap); -+ odm_SetATCStatus(pDM_Odm, true); -+} -+ -+void ODM_CfoTrackingInit(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = &pDM_Odm->DM_CfoTrack; -+ -+ pCfoTrack->DefXCap = -+ pCfoTrack->CrystalCap = odm_GetDefaultCrytaltalCap(pDM_Odm); -+ pCfoTrack->bATCStatus = odm_GetATCStatus(pDM_Odm); -+ pCfoTrack->bAdjust = true; -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CFO_TRACKING, -+ ODM_DBG_LOUD, -+ ("ODM_CfoTracking_init() =========>\n") -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CFO_TRACKING, -+ ODM_DBG_LOUD, -+ ( -+ "ODM_CfoTracking_init(): bATCStatus = %d, CrystalCap = 0x%x\n", -+ pCfoTrack->bATCStatus, -+ pCfoTrack->DefXCap -+ ) -+ ); -+} -+ -+void ODM_CfoTracking(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = &pDM_Odm->DM_CfoTrack; -+ int CFO_kHz_A, CFO_kHz_B, CFO_ave = 0; -+ int CFO_ave_diff; -+ int CrystalCap = (int)pCfoTrack->CrystalCap; -+ u8 Adjust_Xtal = 1; -+ -+ /* 4 Support ability */ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)) { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CFO_TRACKING, -+ ODM_DBG_LOUD, -+ ("ODM_CfoTracking(): Return: SupportAbility ODM_BB_CFO_TRACKING is disabled\n") -+ ); -+ return; -+ } -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CFO_TRACKING, -+ ODM_DBG_LOUD, -+ ("ODM_CfoTracking() =========>\n") -+ ); -+ -+ if (!pDM_Odm->bLinked || !pDM_Odm->bOneEntryOnly) { -+ /* 4 No link or more than one entry */ -+ ODM_CfoTrackingReset(pDM_Odm); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CFO_TRACKING, -+ ODM_DBG_LOUD, -+ ( -+ "ODM_CfoTracking(): Reset: bLinked = %d, bOneEntryOnly = %d\n", -+ pDM_Odm->bLinked, -+ pDM_Odm->bOneEntryOnly -+ ) -+ ); -+ } else { -+ /* 3 1. CFO Tracking */ -+ /* 4 1.1 No new packet */ -+ if (pCfoTrack->packetCount == pCfoTrack->packetCount_pre) { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CFO_TRACKING, -+ ODM_DBG_LOUD, -+ ( -+ "ODM_CfoTracking(): packet counter doesn't change\n" -+ ) -+ ); -+ return; -+ } -+ pCfoTrack->packetCount_pre = pCfoTrack->packetCount; -+ -+ /* 4 1.2 Calculate CFO */ -+ CFO_kHz_A = (int)(pCfoTrack->CFO_tail[0] * 3125) / 1280; -+ CFO_kHz_B = (int)(pCfoTrack->CFO_tail[1] * 3125) / 1280; -+ -+ if (pDM_Odm->RFType < ODM_2T2R) -+ CFO_ave = CFO_kHz_A; -+ else -+ CFO_ave = (int)(CFO_kHz_A + CFO_kHz_B) >> 1; -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CFO_TRACKING, -+ ODM_DBG_LOUD, -+ ( -+ "ODM_CfoTracking(): CFO_kHz_A = %dkHz, CFO_kHz_B = %dkHz, CFO_ave = %dkHz\n", -+ CFO_kHz_A, -+ CFO_kHz_B, -+ CFO_ave -+ ) -+ ); -+ -+ /* 4 1.3 Avoid abnormal large CFO */ -+ CFO_ave_diff = -+ (pCfoTrack->CFO_ave_pre >= CFO_ave) ? -+ (pCfoTrack->CFO_ave_pre-CFO_ave) : -+ (CFO_ave-pCfoTrack->CFO_ave_pre); -+ -+ if ( -+ CFO_ave_diff > 20 && -+ pCfoTrack->largeCFOHit == 0 && -+ !pCfoTrack->bAdjust -+ ) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): first large CFO hit\n")); -+ pCfoTrack->largeCFOHit = 1; -+ return; -+ } else -+ pCfoTrack->largeCFOHit = 0; -+ pCfoTrack->CFO_ave_pre = CFO_ave; -+ -+ /* 4 1.4 Dynamic Xtal threshold */ -+ if (pCfoTrack->bAdjust == false) { -+ if (CFO_ave > CFO_TH_XTAL_HIGH || CFO_ave < (-CFO_TH_XTAL_HIGH)) -+ pCfoTrack->bAdjust = true; -+ } else { -+ if (CFO_ave < CFO_TH_XTAL_LOW && CFO_ave > (-CFO_TH_XTAL_LOW)) -+ pCfoTrack->bAdjust = false; -+ } -+ -+ /* 4 1.5 BT case: Disable CFO tracking */ -+ if (pDM_Odm->bBtEnabled) { -+ pCfoTrack->bAdjust = false; -+ odm_SetCrystalCap(pDM_Odm, pCfoTrack->DefXCap); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CFO_TRACKING, -+ ODM_DBG_LOUD, -+ ("ODM_CfoTracking(): Disable CFO tracking for BT!!\n") -+ ); -+ } -+ -+ /* 4 1.6 Big jump */ -+ if (pCfoTrack->bAdjust) { -+ if (CFO_ave > CFO_TH_XTAL_LOW) -+ Adjust_Xtal = Adjust_Xtal+((CFO_ave-CFO_TH_XTAL_LOW)>>2); -+ else if (CFO_ave < (-CFO_TH_XTAL_LOW)) -+ Adjust_Xtal = Adjust_Xtal+((CFO_TH_XTAL_LOW-CFO_ave)>>2); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CFO_TRACKING, -+ ODM_DBG_LOUD, -+ ( -+ "ODM_CfoTracking(): Crystal cap offset = %d\n", -+ Adjust_Xtal -+ ) -+ ); -+ } -+ -+ /* 4 1.7 Adjust Crystal Cap. */ -+ if (pCfoTrack->bAdjust) { -+ if (CFO_ave > CFO_TH_XTAL_LOW) -+ CrystalCap = CrystalCap + Adjust_Xtal; -+ else if (CFO_ave < (-CFO_TH_XTAL_LOW)) -+ CrystalCap = CrystalCap - Adjust_Xtal; -+ -+ if (CrystalCap > 0x3f) -+ CrystalCap = 0x3f; -+ else if (CrystalCap < 0) -+ CrystalCap = 0; -+ -+ odm_SetCrystalCap(pDM_Odm, (u8)CrystalCap); -+ } -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CFO_TRACKING, -+ ODM_DBG_LOUD, -+ ( -+ "ODM_CfoTracking(): Crystal cap = 0x%x, Default Crystal cap = 0x%x\n", -+ pCfoTrack->CrystalCap, -+ pCfoTrack->DefXCap -+ ) -+ ); -+ -+ /* 3 2. Dynamic ATC switch */ -+ if (CFO_ave < CFO_TH_ATC && CFO_ave > -CFO_TH_ATC) { -+ odm_SetATCStatus(pDM_Odm, false); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CFO_TRACKING, -+ ODM_DBG_LOUD, -+ ("ODM_CfoTracking(): Disable ATC!!\n") -+ ); -+ } else { -+ odm_SetATCStatus(pDM_Odm, true); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CFO_TRACKING, -+ ODM_DBG_LOUD, -+ ("ODM_CfoTracking(): Enable ATC!!\n") -+ ); -+ } -+ } -+} -+ -+void ODM_ParsingCFO(void *pDM_VOID, void *pPktinfo_VOID, s8 *pcfotail) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_PACKET_INFO_T pPktinfo = (PODM_PACKET_INFO_T)pPktinfo_VOID; -+ PCFO_TRACKING pCfoTrack = &pDM_Odm->DM_CfoTrack; -+ u8 i; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)) -+ return; -+ -+ if (pPktinfo->StationID != 0) { -+ /* 3 Update CFO report for path-A & path-B */ -+ /* Only paht-A and path-B have CFO tail and short CFO */ -+ for (i = ODM_RF_PATH_A; i <= ODM_RF_PATH_B; i++) -+ pCfoTrack->CFO_tail[i] = (int)pcfotail[i]; -+ -+ /* 3 Update packet counter */ -+ if (pCfoTrack->packetCount == 0xffffffff) -+ pCfoTrack->packetCount = 0; -+ else -+ pCfoTrack->packetCount++; -+ } -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_CfoTracking.h linux/3rdparty/rtl8723bs/hal/odm_CfoTracking.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_CfoTracking.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_CfoTracking.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,47 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODMCFOTRACK_H__ -+#define __ODMCFOTRACK_H__ -+ -+#define CFO_TH_XTAL_HIGH 20 /* kHz */ -+#define CFO_TH_XTAL_LOW 10 /* kHz */ -+#define CFO_TH_ATC 80 /* kHz */ -+ -+typedef struct _CFO_TRACKING_ { -+ bool bATCStatus; -+ bool largeCFOHit; -+ bool bAdjust; -+ u8 CrystalCap; -+ u8 DefXCap; -+ int CFO_tail[2]; -+ int CFO_ave_pre; -+ u32 packetCount; -+ u32 packetCount_pre; -+ -+ bool bForceXtalCap; -+ bool bReset; -+} CFO_TRACKING, *PCFO_TRACKING; -+ -+void ODM_CfoTrackingReset(void *pDM_VOID -+); -+ -+void ODM_CfoTrackingInit(void *pDM_VOID); -+ -+void ODM_CfoTracking(void *pDM_VOID); -+ -+void ODM_ParsingCFO(void *pDM_VOID, void *pPktinfo_VOID, s8 *pcfotail); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_debug.c linux/3rdparty/rtl8723bs/hal/odm_debug.c ---- linux.old/3rdparty/rtl8723bs/hal/odm_debug.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_debug.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,52 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+void ODM_InitDebugSetting(PDM_ODM_T pDM_Odm) -+{ -+ pDM_Odm->DebugLevel = ODM_DBG_LOUD; -+ -+ pDM_Odm->DebugComponents = -+/* BB Functions */ -+/* ODM_COMP_DIG | */ -+/* ODM_COMP_RA_MASK | */ -+/* ODM_COMP_DYNAMIC_TXPWR | */ -+/* ODM_COMP_FA_CNT | */ -+/* ODM_COMP_RSSI_MONITOR | */ -+/* ODM_COMP_CCK_PD | */ -+/* ODM_COMP_ANT_DIV | */ -+/* ODM_COMP_PWR_SAVE | */ -+/* ODM_COMP_PWR_TRAIN | */ -+/* ODM_COMP_RATE_ADAPTIVE | */ -+/* ODM_COMP_PATH_DIV | */ -+/* ODM_COMP_DYNAMIC_PRICCA | */ -+/* ODM_COMP_RXHP | */ -+/* ODM_COMP_MP | */ -+/* ODM_COMP_CFO_TRACKING | */ -+ -+/* MAC Functions */ -+/* ODM_COMP_EDCA_TURBO | */ -+/* ODM_COMP_EARLY_MODE | */ -+/* RF Functions */ -+/* ODM_COMP_TX_PWR_TRACK | */ -+/* ODM_COMP_RX_GAIN_TRACK | */ -+/* ODM_COMP_CALIBRATION | */ -+/* Common */ -+/* ODM_COMP_COMMON | */ -+/* ODM_COMP_INIT | */ -+/* ODM_COMP_PSD | */ -+0; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_debug.h linux/3rdparty/rtl8723bs/hal/odm_debug.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_debug.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_debug.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,165 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODM_DBG_H__ -+#define __ODM_DBG_H__ -+ -+ -+/* */ -+/* Define the debug levels */ -+/* */ -+/* 1. DBG_TRACE and DBG_LOUD are used for normal cases. */ -+/* So that, they can help SW engineer to develope or trace states changed */ -+/* and also help HW enginner to trace every operation to and from HW, */ -+/* e.g IO, Tx, Rx. */ -+/* */ -+/* 2. DBG_WARNNING and DBG_SERIOUS are used for unusual or error cases, */ -+/* which help us to debug SW or HW. */ -+/* */ -+/* */ -+/* */ -+/* Never used in a call to ODM_RT_TRACE()! */ -+/* */ -+#define ODM_DBG_OFF 1 -+ -+/* */ -+/* Fatal bug. */ -+/* For example, Tx/Rx/IO locked up, OS hangs, memory access violation, */ -+/* resource allocation failed, unexpected HW behavior, HW BUG and so on. */ -+/* */ -+#define ODM_DBG_SERIOUS 2 -+ -+/* */ -+/* Abnormal, rare, or unexpeted cases. */ -+/* For example, */ -+/* IRP/Packet/OID canceled, */ -+/* device suprisely unremoved and so on. */ -+/* */ -+#define ODM_DBG_WARNING 3 -+ -+/* */ -+/* Normal case with useful information about current SW or HW state. */ -+/* For example, Tx/Rx descriptor to fill, Tx/Rx descriptor completed status, */ -+/* SW protocol state change, dynamic mechanism state change and so on. */ -+/* */ -+#define ODM_DBG_LOUD 4 -+ -+/* */ -+/* Normal case with detail execution flow or information. */ -+/* */ -+#define ODM_DBG_TRACE 5 -+ -+/* */ -+/* Define the tracing components */ -+/* */ -+/* */ -+/* BB Functions */ -+#define ODM_COMP_DIG BIT0 -+#define ODM_COMP_RA_MASK BIT1 -+#define ODM_COMP_DYNAMIC_TXPWR BIT2 -+#define ODM_COMP_FA_CNT BIT3 -+#define ODM_COMP_RSSI_MONITOR BIT4 -+#define ODM_COMP_CCK_PD BIT5 -+#define ODM_COMP_ANT_DIV BIT6 -+#define ODM_COMP_PWR_SAVE BIT7 -+#define ODM_COMP_PWR_TRAIN BIT8 -+#define ODM_COMP_RATE_ADAPTIVE BIT9 -+#define ODM_COMP_PATH_DIV BIT10 -+#define ODM_COMP_PSD BIT11 -+#define ODM_COMP_DYNAMIC_PRICCA BIT12 -+#define ODM_COMP_RXHP BIT13 -+#define ODM_COMP_MP BIT14 -+#define ODM_COMP_CFO_TRACKING BIT15 -+/* MAC Functions */ -+#define ODM_COMP_EDCA_TURBO BIT16 -+#define ODM_COMP_EARLY_MODE BIT17 -+/* RF Functions */ -+#define ODM_COMP_TX_PWR_TRACK BIT24 -+#define ODM_COMP_RX_GAIN_TRACK BIT25 -+#define ODM_COMP_CALIBRATION BIT26 -+/* Common Functions */ -+#define ODM_COMP_COMMON BIT30 -+#define ODM_COMP_INIT BIT31 -+ -+/*------------------------Export Marco Definition---------------------------*/ -+ #define DbgPrint printk -+ #define RT_PRINTK(fmt, args...)\ -+ DbgPrint("%s(): " fmt, __func__, ## args) -+ #define RT_DISP(dbgtype, dbgflag, printstr) -+ -+#ifndef ASSERT -+ #define ASSERT(expr) -+#endif -+ -+#if DBG -+#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt)\ -+ if (\ -+ (comp & pDM_Odm->DebugComponents) &&\ -+ (level <= pDM_Odm->DebugLevel || level == ODM_DBG_SERIOUS)\ -+ ) {\ -+ RT_PRINTK fmt;\ -+ } -+ -+#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt)\ -+ if (\ -+ (comp & pDM_Odm->DebugComponents) &&\ -+ (level <= pDM_Odm->DebugLevel)\ -+ ) {\ -+ RT_PRINTK fmt;\ -+ } -+ -+#define ODM_RT_ASSERT(pDM_Odm, expr, fmt)\ -+ if (!expr) {\ -+ DbgPrint("Assertion failed! %s at ......\n", #expr);\ -+ DbgPrint(\ -+ " ......%s,%s, line =%d\n",\ -+ __FILE__,\ -+ __func__,\ -+ __LINE__\ -+ );\ -+ RT_PRINTK fmt;\ -+ ASSERT(false);\ -+ } -+#define ODM_dbg_enter() { DbgPrint("==> %s\n", __func__); } -+#define ODM_dbg_exit() { DbgPrint("<== %s\n", __func__); } -+#define ODM_dbg_trace(str) { DbgPrint("%s:%s\n", __func__, str); } -+ -+#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr)\ -+ if (\ -+ (comp & pDM_Odm->DebugComponents) &&\ -+ (level <= pDM_Odm->DebugLevel)\ -+ ) {\ -+ int __i;\ -+ u8 *__ptr = (u8 *)ptr;\ -+ DbgPrint("[ODM] ");\ -+ DbgPrint(title_str);\ -+ DbgPrint(" ");\ -+ for (__i = 0; __i < 6; __i++)\ -+ DbgPrint("%02X%s", __ptr[__i], (__i == 5) ? "" : "-");\ -+ DbgPrint("\n");\ -+ } -+#else -+#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt) -+#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt) -+#define ODM_RT_ASSERT(pDM_Odm, expr, fmt) -+#define ODM_dbg_enter() -+#define ODM_dbg_exit() -+#define ODM_dbg_trace(str) -+#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr) -+#endif -+ -+void ODM_InitDebugSetting(PDM_ODM_T pDM_Odm); -+ -+#endif /* __ODM_DBG_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_DIG.c linux/3rdparty/rtl8723bs/hal/odm_DIG.c ---- linux.old/3rdparty/rtl8723bs/hal/odm_DIG.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_DIG.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1221 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+#define ADAPTIVITY_VERSION "5.0" -+ -+void odm_NHMCounterStatisticsInit(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /* PHY parameters initialize for n series */ -+ rtw_write16(pDM_Odm->Adapter, ODM_REG_NHM_TIMER_11N+2, 0x2710); /* 0x894[31:16]= 0x2710 Time duration for NHM unit: 4us, 0x2710 =40ms */ -+ /* rtw_write16(pDM_Odm->Adapter, ODM_REG_NHM_TIMER_11N+2, 0x4e20); 0x894[31:16]= 0x4e20 Time duration for NHM unit: 4us, 0x4e20 =80ms */ -+ rtw_write16(pDM_Odm->Adapter, ODM_REG_NHM_TH9_TH10_11N+2, 0xffff); /* 0x890[31:16]= 0xffff th_9, th_10 */ -+ /* rtw_write32(pDM_Odm->Adapter, ODM_REG_NHM_TH3_TO_TH0_11N, 0xffffff5c); 0x898 = 0xffffff5c th_3, th_2, th_1, th_0 */ -+ rtw_write32(pDM_Odm->Adapter, ODM_REG_NHM_TH3_TO_TH0_11N, 0xffffff52); /* 0x898 = 0xffffff52 th_3, th_2, th_1, th_0 */ -+ rtw_write32(pDM_Odm->Adapter, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffffff); /* 0x89c = 0xffffffff th_7, th_6, th_5, th_4 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, ODM_REG_FPGA0_IQK_11N, bMaskByte0, 0xff); /* 0xe28[7:0]= 0xff th_8 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, ODM_REG_NHM_TH9_TH10_11N, BIT10|BIT9|BIT8, 0x7); /* 0x890[9:8]=3 enable CCX */ -+ PHY_SetBBReg(pDM_Odm->Adapter, ODM_REG_OFDM_FA_RSTC_11N, BIT7, 0x1); /* 0xc0c[7]= 1 max power among all RX ants */ -+} -+ -+void odm_NHMCounterStatistics(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /* Get NHM report */ -+ odm_GetNHMCounterStatistics(pDM_Odm); -+ -+ /* Reset NHM counter */ -+ odm_NHMCounterStatisticsReset(pDM_Odm); -+} -+ -+void odm_GetNHMCounterStatistics(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u32 value32 = 0; -+ -+ value32 = PHY_QueryBBReg(pDM_Odm->Adapter, ODM_REG_NHM_CNT_11N, bMaskDWord); -+ -+ pDM_Odm->NHM_cnt_0 = (u8)(value32 & bMaskByte0); -+} -+ -+void odm_NHMCounterStatisticsReset(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ PHY_SetBBReg(pDM_Odm->Adapter, ODM_REG_NHM_TH9_TH10_11N, BIT1, 0); -+ PHY_SetBBReg(pDM_Odm->Adapter, ODM_REG_NHM_TH9_TH10_11N, BIT1, 1); -+} -+ -+void odm_NHMBBInit(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ pDM_Odm->adaptivity_flag = 0; -+ pDM_Odm->tolerance_cnt = 3; -+ pDM_Odm->NHMLastTxOkcnt = 0; -+ pDM_Odm->NHMLastRxOkcnt = 0; -+ pDM_Odm->NHMCurTxOkcnt = 0; -+ pDM_Odm->NHMCurRxOkcnt = 0; -+} -+ -+/* */ -+void odm_NHMBB(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ /* u8 test_status; */ -+ /* Pfalse_ALARM_STATISTICS pFalseAlmCnt = &(pDM_Odm->FalseAlmCnt); */ -+ -+ pDM_Odm->NHMCurTxOkcnt = -+ *(pDM_Odm->pNumTxBytesUnicast)-pDM_Odm->NHMLastTxOkcnt; -+ pDM_Odm->NHMCurRxOkcnt = -+ *(pDM_Odm->pNumRxBytesUnicast)-pDM_Odm->NHMLastRxOkcnt; -+ pDM_Odm->NHMLastTxOkcnt = -+ *(pDM_Odm->pNumTxBytesUnicast); -+ pDM_Odm->NHMLastRxOkcnt = -+ *(pDM_Odm->pNumRxBytesUnicast); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ( -+ "NHM_cnt_0 =%d, NHMCurTxOkcnt = %llu, NHMCurRxOkcnt = %llu\n", -+ pDM_Odm->NHM_cnt_0, -+ pDM_Odm->NHMCurTxOkcnt, -+ pDM_Odm->NHMCurRxOkcnt -+ ) -+ ); -+ -+ -+ if ((pDM_Odm->NHMCurTxOkcnt) + 1 > (u64)(pDM_Odm->NHMCurRxOkcnt<<2) + 1) { /* Tx > 4*Rx possible for adaptivity test */ -+ if (pDM_Odm->NHM_cnt_0 >= 190 || pDM_Odm->adaptivity_flag == true) { -+ /* Enable EDCCA since it is possible running Adaptivity testing */ -+ /* test_status = 1; */ -+ pDM_Odm->adaptivity_flag = true; -+ pDM_Odm->tolerance_cnt = 0; -+ } else { -+ if (pDM_Odm->tolerance_cnt < 3) -+ pDM_Odm->tolerance_cnt = pDM_Odm->tolerance_cnt + 1; -+ else -+ pDM_Odm->tolerance_cnt = 4; -+ /* test_status = 5; */ -+ if (pDM_Odm->tolerance_cnt > 3) { -+ /* test_status = 3; */ -+ pDM_Odm->adaptivity_flag = false; -+ } -+ } -+ } else { /* TXadaptivity_flag == true && pDM_Odm->NHM_cnt_0 <= 200) { -+ /* test_status = 2; */ -+ pDM_Odm->tolerance_cnt = 0; -+ } else { -+ if (pDM_Odm->tolerance_cnt < 3) -+ pDM_Odm->tolerance_cnt = pDM_Odm->tolerance_cnt + 1; -+ else -+ pDM_Odm->tolerance_cnt = 4; -+ /* test_status = 5; */ -+ if (pDM_Odm->tolerance_cnt > 3) { -+ /* test_status = 4; */ -+ pDM_Odm->adaptivity_flag = false; -+ } -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("adaptivity_flag = %d\n ", pDM_Odm->adaptivity_flag)); -+} -+ -+void odm_SearchPwdBLowerBound(void *pDM_VOID, u8 IGI_target) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u32 value32 = 0; -+ u8 cnt, IGI; -+ bool bAdjust = true; -+ s8 TH_L2H_dmc, TH_H2L_dmc; -+ s8 Diff; -+ -+ IGI = 0x50; /* find H2L, L2H lower bound */ -+ ODM_Write_DIG(pDM_Odm, IGI); -+ -+ -+ Diff = IGI_target-(s8)IGI; -+ TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; -+ if (TH_L2H_dmc > 10) -+ TH_L2H_dmc = 10; -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, bMaskByte0, (u8)TH_L2H_dmc); -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, bMaskByte2, (u8)TH_H2L_dmc); -+ -+ mdelay(5); -+ -+ while (bAdjust) { -+ for (cnt = 0; cnt < 20; cnt++) { -+ value32 = PHY_QueryBBReg(pDM_Odm->Adapter, ODM_REG_RPT_11N, bMaskDWord); -+ -+ if (value32 & BIT30) -+ pDM_Odm->txEdcca1 = pDM_Odm->txEdcca1 + 1; -+ else if (value32 & BIT29) -+ pDM_Odm->txEdcca1 = pDM_Odm->txEdcca1 + 1; -+ else -+ pDM_Odm->txEdcca0 = pDM_Odm->txEdcca0 + 1; -+ } -+ /* DbgPrint("txEdcca1 = %d, txEdcca0 = %d\n", pDM_Odm->txEdcca1, pDM_Odm->txEdcca0); */ -+ -+ if (pDM_Odm->txEdcca1 > 5) { -+ IGI = IGI-1; -+ TH_L2H_dmc = TH_L2H_dmc + 1; -+ if (TH_L2H_dmc > 10) -+ TH_L2H_dmc = 10; -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, bMaskByte0, (u8)TH_L2H_dmc); -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, bMaskByte2, (u8)TH_H2L_dmc); -+ -+ pDM_Odm->TxHangFlg = true; -+ pDM_Odm->txEdcca1 = 0; -+ pDM_Odm->txEdcca0 = 0; -+ -+ if (TH_L2H_dmc == 10) { -+ bAdjust = false; -+ pDM_Odm->TxHangFlg = false; -+ pDM_Odm->txEdcca1 = 0; -+ pDM_Odm->txEdcca0 = 0; -+ pDM_Odm->H2L_lb = TH_H2L_dmc; -+ pDM_Odm->L2H_lb = TH_L2H_dmc; -+ pDM_Odm->Adaptivity_IGI_upper = IGI; -+ } -+ } else { -+ bAdjust = false; -+ pDM_Odm->TxHangFlg = false; -+ pDM_Odm->txEdcca1 = 0; -+ pDM_Odm->txEdcca0 = 0; -+ pDM_Odm->H2L_lb = TH_H2L_dmc; -+ pDM_Odm->L2H_lb = TH_L2H_dmc; -+ pDM_Odm->Adaptivity_IGI_upper = IGI; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("IGI = 0x%x, H2L_lb = 0x%x, L2H_lb = 0x%x\n", IGI, pDM_Odm->H2L_lb, pDM_Odm->L2H_lb)); -+} -+ -+void odm_AdaptivityInit(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->Carrier_Sense_enable == false) -+ pDM_Odm->TH_L2H_ini = 0xf7; /* -7 */ -+ else -+ pDM_Odm->TH_L2H_ini = 0xa; -+ -+ pDM_Odm->AdapEn_RSSI = 20; -+ pDM_Odm->TH_EDCCA_HL_diff = 7; -+ -+ pDM_Odm->IGI_Base = 0x32; -+ pDM_Odm->IGI_target = 0x1c; -+ pDM_Odm->ForceEDCCA = 0; -+ pDM_Odm->NHM_disable = false; -+ pDM_Odm->TxHangFlg = true; -+ pDM_Odm->txEdcca0 = 0; -+ pDM_Odm->txEdcca1 = 0; -+ pDM_Odm->H2L_lb = 0; -+ pDM_Odm->L2H_lb = 0; -+ pDM_Odm->Adaptivity_IGI_upper = 0; -+ odm_NHMBBInit(pDM_Odm); -+ -+ PHY_SetBBReg(pDM_Odm->Adapter, REG_RD_CTRL, BIT11, 1); /* stop counting if EDCCA is asserted */ -+} -+ -+ -+void odm_Adaptivity(void *pDM_VOID, u8 IGI) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ s8 TH_L2H_dmc, TH_H2L_dmc; -+ s8 Diff, IGI_target; -+ bool EDCCA_State = false; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Go to odm_DynamicEDCCA()\n")); -+ return; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_Adaptivity() =====>\n")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("ForceEDCCA =%d, IGI_Base = 0x%x, TH_L2H_ini = %d, TH_EDCCA_HL_diff = %d, AdapEn_RSSI = %d\n", -+ pDM_Odm->ForceEDCCA, pDM_Odm->IGI_Base, pDM_Odm->TH_L2H_ini, pDM_Odm->TH_EDCCA_HL_diff, pDM_Odm->AdapEn_RSSI)); -+ -+ if (*pDM_Odm->pBandWidth == ODM_BW20M) /* CHANNEL_WIDTH_20 */ -+ IGI_target = pDM_Odm->IGI_Base; -+ else if (*pDM_Odm->pBandWidth == ODM_BW40M) -+ IGI_target = pDM_Odm->IGI_Base + 2; -+ else if (*pDM_Odm->pBandWidth == ODM_BW80M) -+ IGI_target = pDM_Odm->IGI_Base + 2; -+ else -+ IGI_target = pDM_Odm->IGI_Base; -+ pDM_Odm->IGI_target = (u8) IGI_target; -+ -+ /* Search pwdB lower bound */ -+ if (pDM_Odm->TxHangFlg == true) { -+ PHY_SetBBReg(pDM_Odm->Adapter, ODM_REG_DBG_RPT_11N, bMaskDWord, 0x208); -+ odm_SearchPwdBLowerBound(pDM_Odm, pDM_Odm->IGI_target); -+ } -+ -+ if ((!pDM_Odm->bLinked) || (*pDM_Odm->pChannel > 149)) { /* Band4 doesn't need adaptivity */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, bMaskByte0, 0x7f); -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, bMaskByte2, 0x7f); -+ return; -+ } -+ -+ if (!pDM_Odm->ForceEDCCA) { -+ if (pDM_Odm->RSSI_Min > pDM_Odm->AdapEn_RSSI) -+ EDCCA_State = 1; -+ else if (pDM_Odm->RSSI_Min < (pDM_Odm->AdapEn_RSSI - 5)) -+ EDCCA_State = 0; -+ } else -+ EDCCA_State = 1; -+ -+ if ( -+ pDM_Odm->bLinked && -+ pDM_Odm->Carrier_Sense_enable == false && -+ pDM_Odm->NHM_disable == false && -+ pDM_Odm->TxHangFlg == false -+ ) -+ odm_NHMBB(pDM_Odm); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ( -+ "BandWidth =%s, IGI_target = 0x%x, EDCCA_State =%d\n", -+ (*pDM_Odm->pBandWidth == ODM_BW80M) ? "80M" : -+ ((*pDM_Odm->pBandWidth == ODM_BW40M) ? "40M" : "20M"), -+ IGI_target, -+ EDCCA_State -+ ) -+ ); -+ -+ if (EDCCA_State == 1) { -+ Diff = IGI_target-(s8)IGI; -+ TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; -+ if (TH_L2H_dmc > 10) -+ TH_L2H_dmc = 10; -+ -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ -+ /* replace lower bound to prevent EDCCA always equal */ -+ if (TH_H2L_dmc < pDM_Odm->H2L_lb) -+ TH_H2L_dmc = pDM_Odm->H2L_lb; -+ if (TH_L2H_dmc < pDM_Odm->L2H_lb) -+ TH_L2H_dmc = pDM_Odm->L2H_lb; -+ } else { -+ TH_L2H_dmc = 0x7f; -+ TH_H2L_dmc = 0x7f; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("IGI = 0x%x, TH_L2H_dmc = %d, TH_H2L_dmc = %d\n", -+ IGI, TH_L2H_dmc, TH_H2L_dmc)); -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, bMaskByte0, (u8)TH_L2H_dmc); -+ PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_ECCAThreshold, bMaskByte2, (u8)TH_H2L_dmc); -+} -+ -+void ODM_Write_DIG(void *pDM_VOID, u8 CurrentIGI) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ if (pDM_DigTable->bStopDIG) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Stop Writing IGI\n")); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("ODM_REG(IGI_A, pDM_Odm) = 0x%x, ODM_BIT(IGI, pDM_Odm) = 0x%x\n", -+ ODM_REG(IGI_A, pDM_Odm), ODM_BIT(IGI, pDM_Odm))); -+ -+ if (pDM_DigTable->CurIGValue != CurrentIGI) { -+ /* 1 Check initial gain by upper bound */ -+ if (!pDM_DigTable->bPSDInProgress) { -+ if (CurrentIGI > pDM_DigTable->rx_gain_range_max) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("CurrentIGI(0x%02x) is larger than upper bound !!\n", pDM_DigTable->rx_gain_range_max)); -+ CurrentIGI = pDM_DigTable->rx_gain_range_max; -+ } -+ -+ } -+ -+ /* 1 Set IGI value */ -+ PHY_SetBBReg(pDM_Odm->Adapter, ODM_REG(IGI_A, pDM_Odm), ODM_BIT(IGI, pDM_Odm), CurrentIGI); -+ -+ if (pDM_Odm->RFType > ODM_1T1R) -+ PHY_SetBBReg(pDM_Odm->Adapter, ODM_REG(IGI_B, pDM_Odm), ODM_BIT(IGI, pDM_Odm), CurrentIGI); -+ -+ pDM_DigTable->CurIGValue = CurrentIGI; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("CurrentIGI(0x%02x).\n", CurrentIGI)); -+ -+} -+ -+void odm_PauseDIG( -+ void *pDM_VOID, -+ ODM_Pause_DIG_TYPE PauseType, -+ u8 IGIValue -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ static bool bPaused = false; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG() =========>\n")); -+ -+ if ( -+ (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) && -+ pDM_Odm->TxHangFlg == true -+ ) { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ("odm_PauseDIG(): Dynamic adjust threshold in progress !!\n") -+ ); -+ return; -+ } -+ -+ if ( -+ !bPaused && (!(pDM_Odm->SupportAbility & ODM_BB_DIG) || -+ !(pDM_Odm->SupportAbility & ODM_BB_FA_CNT)) -+ ){ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ("odm_PauseDIG(): Return: SupportAbility ODM_BB_DIG or ODM_BB_FA_CNT is disabled\n") -+ ); -+ return; -+ } -+ -+ switch (PauseType) { -+ /* 1 Pause DIG */ -+ case ODM_PAUSE_DIG: -+ /* 2 Disable DIG */ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility & (~ODM_BB_DIG)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Pause DIG !!\n")); -+ -+ /* 2 Backup IGI value */ -+ if (!bPaused) { -+ pDM_DigTable->IGIBackup = pDM_DigTable->CurIGValue; -+ bPaused = true; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Backup IGI = 0x%x\n", pDM_DigTable->IGIBackup)); -+ -+ /* 2 Write new IGI value */ -+ ODM_Write_DIG(pDM_Odm, IGIValue); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Write new IGI = 0x%x\n", IGIValue)); -+ break; -+ -+ /* 1 Resume DIG */ -+ case ODM_RESUME_DIG: -+ if (bPaused) { -+ /* 2 Write backup IGI value */ -+ ODM_Write_DIG(pDM_Odm, pDM_DigTable->IGIBackup); -+ bPaused = false; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Write original IGI = 0x%x\n", pDM_DigTable->IGIBackup)); -+ -+ /* 2 Enable DIG */ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility | ODM_BB_DIG); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Resume DIG !!\n")); -+ } -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Wrong type !!\n")); -+ break; -+ } -+} -+ -+bool odm_DigAbort(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /* SupportAbility */ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: SupportAbility ODM_BB_FA_CNT is disabled\n")); -+ return true; -+ } -+ -+ /* SupportAbility */ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_DIG)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: SupportAbility ODM_BB_DIG is disabled\n")); -+ return true; -+ } -+ -+ /* ScanInProcess */ -+ if (*(pDM_Odm->pbScanInProcess)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: In Scan Progress\n")); -+ return true; -+ } -+ -+ /* add by Neil Chen to avoid PSD is processing */ -+ if (pDM_Odm->bDMInitialGainEnable == false) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: PSD is Processing\n")); -+ return true; -+ } -+ -+ return false; -+} -+ -+void odm_DIGInit(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ pDM_DigTable->bStopDIG = false; -+ pDM_DigTable->bPSDInProgress = false; -+ pDM_DigTable->CurIGValue = (u8) PHY_QueryBBReg(pDM_Odm->Adapter, ODM_REG(IGI_A, pDM_Odm), ODM_BIT(IGI, pDM_Odm)); -+ pDM_DigTable->RssiLowThresh = DM_DIG_THRESH_LOW; -+ pDM_DigTable->RssiHighThresh = DM_DIG_THRESH_HIGH; -+ pDM_DigTable->FALowThresh = DMfalseALARM_THRESH_LOW; -+ pDM_DigTable->FAHighThresh = DMfalseALARM_THRESH_HIGH; -+ pDM_DigTable->BackoffVal = DM_DIG_BACKOFF_DEFAULT; -+ pDM_DigTable->BackoffVal_range_max = DM_DIG_BACKOFF_MAX; -+ pDM_DigTable->BackoffVal_range_min = DM_DIG_BACKOFF_MIN; -+ pDM_DigTable->PreCCK_CCAThres = 0xFF; -+ pDM_DigTable->CurCCK_CCAThres = 0x83; -+ pDM_DigTable->ForbiddenIGI = DM_DIG_MIN_NIC; -+ pDM_DigTable->LargeFAHit = 0; -+ pDM_DigTable->Recover_cnt = 0; -+ pDM_DigTable->bMediaConnect_0 = false; -+ pDM_DigTable->bMediaConnect_1 = false; -+ -+ /* To Initialize pDM_Odm->bDMInitialGainEnable == false to avoid DIG error */ -+ pDM_Odm->bDMInitialGainEnable = true; -+ -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DM_DIG_MIN_NIC; -+ pDM_DigTable->DIG_Dynamic_MIN_1 = DM_DIG_MIN_NIC; -+ -+ /* To Initi BT30 IGI */ -+ pDM_DigTable->BT30_CurIGI = 0x32; -+ -+ if (pDM_Odm->BoardType & (ODM_BOARD_EXT_PA|ODM_BOARD_EXT_LNA)) { -+ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; -+ pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; -+ } else { -+ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; -+ pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; -+ } -+ -+} -+ -+ -+void odm_DIG(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /* Common parameters */ -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ Pfalse_ALARM_STATISTICS pFalseAlmCnt = &pDM_Odm->FalseAlmCnt; -+ bool FirstConnect, FirstDisConnect; -+ u8 DIG_MaxOfMin, DIG_Dynamic_MIN; -+ u8 dm_dig_max, dm_dig_min; -+ u8 CurrentIGI = pDM_DigTable->CurIGValue; -+ u8 offset; -+ u32 dm_FA_thres[3]; -+ u8 Adap_IGI_Upper = 0; -+ u32 TxTp = 0, RxTp = 0; -+ bool bDFSBand = false; -+ bool bPerformance = true, bFirstTpTarget = false, bFirstCoverage = false; -+ -+ if (odm_DigAbort(pDM_Odm) == true) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() ===========================>\n\n")); -+ -+ if (pDM_Odm->adaptivity_flag == true) -+ Adap_IGI_Upper = pDM_Odm->Adaptivity_IGI_upper; -+ -+ -+ /* 1 Update status */ -+ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_0; -+ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == false); -+ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == true); -+ -+ /* 1 Boundary Decision */ -+ /* 2 For WIN\CE */ -+ dm_dig_max = 0x5A; -+ dm_dig_min = DM_DIG_MIN_NIC; -+ DIG_MaxOfMin = DM_DIG_MAX_AP; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Absolutly upper bound = 0x%x, lower bound = 0x%x\n", dm_dig_max, dm_dig_min)); -+ -+ /* 1 Adjust boundary by RSSI */ -+ if (pDM_Odm->bLinked && bPerformance) { -+ /* 2 Modify DIG upper bound */ -+ /* 4 Modify DIG upper bound for 92E, 8723A\B, 8821 & 8812 BT */ -+ if (pDM_Odm->bBtLimitedDig == 1) { -+ offset = 10; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Coex. case: Force upper bound to RSSI + %d !!!!!!\n", offset)); -+ } else -+ offset = 15; -+ -+ if ((pDM_Odm->RSSI_Min + offset) > dm_dig_max) -+ pDM_DigTable->rx_gain_range_max = dm_dig_max; -+ else if ((pDM_Odm->RSSI_Min + offset) < dm_dig_min) -+ pDM_DigTable->rx_gain_range_max = dm_dig_min; -+ else -+ pDM_DigTable->rx_gain_range_max = pDM_Odm->RSSI_Min + offset; -+ -+ /* 2 Modify DIG lower bound */ -+ /* if (pDM_Odm->bOneEntryOnly) */ -+ { -+ if (pDM_Odm->RSSI_Min < dm_dig_min) -+ DIG_Dynamic_MIN = dm_dig_min; -+ else if (pDM_Odm->RSSI_Min > DIG_MaxOfMin) -+ DIG_Dynamic_MIN = DIG_MaxOfMin; -+ else -+ DIG_Dynamic_MIN = pDM_Odm->RSSI_Min; -+ } -+ } else { -+ pDM_DigTable->rx_gain_range_max = dm_dig_max; -+ DIG_Dynamic_MIN = dm_dig_min; -+ } -+ -+ /* 1 Force Lower Bound for AntDiv */ -+ if (pDM_Odm->bLinked && !pDM_Odm->bOneEntryOnly) { -+ if (pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) { -+ if ( -+ pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV || -+ pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV || -+ pDM_Odm->AntDivType == S0S1_SW_ANTDIV -+ ) { -+ if (pDM_DigTable->AntDiv_RSSI_max > DIG_MaxOfMin) -+ DIG_Dynamic_MIN = DIG_MaxOfMin; -+ else -+ DIG_Dynamic_MIN = (u8) pDM_DigTable->AntDiv_RSSI_max; -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_ANT_DIV, -+ ODM_DBG_LOUD, -+ ( -+ "odm_DIG(): Antenna diversity case: Force lower bound to 0x%x !!!!!!\n", -+ DIG_Dynamic_MIN -+ ) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_ANT_DIV, -+ ODM_DBG_LOUD, -+ ( -+ "odm_DIG(): Antenna diversity case: RSSI_max = 0x%x !!!!!!\n", -+ pDM_DigTable->AntDiv_RSSI_max -+ ) -+ ); -+ } -+ } -+ } -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ( -+ "odm_DIG(): Adjust boundary by RSSI Upper bound = 0x%x, Lower bound = 0x%x\n", -+ pDM_DigTable->rx_gain_range_max, -+ DIG_Dynamic_MIN -+ ) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ( -+ "odm_DIG(): Link status: bLinked = %d, RSSI = %d, bFirstConnect = %d, bFirsrDisConnect = %d\n\n", -+ pDM_Odm->bLinked, -+ pDM_Odm->RSSI_Min, -+ FirstConnect, -+ FirstDisConnect -+ ) -+ ); -+ -+ /* 1 Modify DIG lower bound, deal with abnormal case */ -+ /* 2 Abnormal false alarm case */ -+ if (FirstDisConnect) { -+ pDM_DigTable->rx_gain_range_min = DIG_Dynamic_MIN; -+ pDM_DigTable->ForbiddenIGI = DIG_Dynamic_MIN; -+ } else -+ pDM_DigTable->rx_gain_range_min = -+ odm_ForbiddenIGICheck(pDM_Odm, DIG_Dynamic_MIN, CurrentIGI); -+ -+ if (pDM_Odm->bLinked && !FirstConnect) { -+ if ( -+ (pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 5) && -+ pDM_Odm->bsta_state -+ ) { -+ pDM_DigTable->rx_gain_range_min = dm_dig_min; -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ( -+ "odm_DIG(): Abnrormal #beacon (%d) case in STA mode: Force lower bound to 0x%x !!!!!!\n\n", -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt, -+ pDM_DigTable->rx_gain_range_min -+ ) -+ ); -+ } -+ } -+ -+ /* 2 Abnormal lower bound case */ -+ if (pDM_DigTable->rx_gain_range_min > pDM_DigTable->rx_gain_range_max) { -+ pDM_DigTable->rx_gain_range_min = pDM_DigTable->rx_gain_range_max; -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ( -+ "odm_DIG(): Abnrormal lower bound case: Force lower bound to 0x%x !!!!!!\n\n", -+ pDM_DigTable->rx_gain_range_min -+ ) -+ ); -+ } -+ -+ -+ /* 1 False alarm threshold decision */ -+ odm_FAThresholdCheck(pDM_Odm, bDFSBand, bPerformance, RxTp, TxTp, dm_FA_thres); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): False alarm threshold = %d, %d, %d\n\n", dm_FA_thres[0], dm_FA_thres[1], dm_FA_thres[2])); -+ -+ /* 1 Adjust initial gain by false alarm */ -+ if (pDM_Odm->bLinked && bPerformance) { -+ /* 2 After link */ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ("odm_DIG(): Adjust IGI after link\n") -+ ); -+ -+ if (bFirstTpTarget || (FirstConnect && bPerformance)) { -+ pDM_DigTable->LargeFAHit = 0; -+ -+ if (pDM_Odm->RSSI_Min < DIG_MaxOfMin) { -+ if (CurrentIGI < pDM_Odm->RSSI_Min) -+ CurrentIGI = pDM_Odm->RSSI_Min; -+ } else { -+ if (CurrentIGI < DIG_MaxOfMin) -+ CurrentIGI = DIG_MaxOfMin; -+ } -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ( -+ "odm_DIG(): First connect case: IGI does on-shot to 0x%x\n", -+ CurrentIGI -+ ) -+ ); -+ -+ } else { -+ if (pFalseAlmCnt->Cnt_all > dm_FA_thres[2]) -+ CurrentIGI = CurrentIGI + 4; -+ else if (pFalseAlmCnt->Cnt_all > dm_FA_thres[1]) -+ CurrentIGI = CurrentIGI + 2; -+ else if (pFalseAlmCnt->Cnt_all < dm_FA_thres[0]) -+ CurrentIGI = CurrentIGI - 2; -+ -+ if ( -+ (pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 5) && -+ (pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH1) && -+ (pDM_Odm->bsta_state) -+ ) { -+ CurrentIGI = pDM_DigTable->rx_gain_range_min; -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ( -+ "odm_DIG(): Abnormal #beacon (%d) case: IGI does one-shot to 0x%x\n", -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt, -+ CurrentIGI -+ ) -+ ); -+ } -+ } -+ } else { -+ /* 2 Before link */ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ("odm_DIG(): Adjust IGI before link\n") -+ ); -+ -+ if (FirstDisConnect || bFirstCoverage) { -+ CurrentIGI = dm_dig_min; -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ("odm_DIG(): First disconnect case: IGI does on-shot to lower bound\n") -+ ); -+ } else { -+ if (pFalseAlmCnt->Cnt_all > dm_FA_thres[2]) -+ CurrentIGI = CurrentIGI + 4; -+ else if (pFalseAlmCnt->Cnt_all > dm_FA_thres[1]) -+ CurrentIGI = CurrentIGI + 2; -+ else if (pFalseAlmCnt->Cnt_all < dm_FA_thres[0]) -+ CurrentIGI = CurrentIGI - 2; -+ } -+ } -+ -+ /* 1 Check initial gain by upper/lower bound */ -+ if (CurrentIGI < pDM_DigTable->rx_gain_range_min) -+ CurrentIGI = pDM_DigTable->rx_gain_range_min; -+ -+ if (CurrentIGI > pDM_DigTable->rx_gain_range_max) -+ CurrentIGI = pDM_DigTable->rx_gain_range_max; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ( -+ "odm_DIG(): CurIGValue = 0x%x, TotalFA = %d\n\n", -+ CurrentIGI, -+ pFalseAlmCnt->Cnt_all -+ ) -+ ); -+ -+ /* 1 Force upper bound and lower bound for adaptivity */ -+ if ( -+ pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY && -+ pDM_Odm->adaptivity_flag == true -+ ) { -+ if (CurrentIGI > Adap_IGI_Upper) -+ CurrentIGI = Adap_IGI_Upper; -+ -+ if (pDM_Odm->IGI_LowerBound != 0) { -+ if (CurrentIGI < pDM_Odm->IGI_LowerBound) -+ CurrentIGI = pDM_Odm->IGI_LowerBound; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adaptivity case: Force upper bound to 0x%x !!!!!!\n", Adap_IGI_Upper)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adaptivity case: Force lower bound to 0x%x !!!!!!\n\n", pDM_Odm->IGI_LowerBound)); -+ } -+ -+ -+ /* 1 Update status */ -+ if (pDM_Odm->bBtHsOperation) { -+ if (pDM_Odm->bLinked) { -+ if (pDM_DigTable->BT30_CurIGI > (CurrentIGI)) -+ ODM_Write_DIG(pDM_Odm, CurrentIGI); -+ else -+ ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI); -+ -+ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; -+ } else { -+ if (pDM_Odm->bLinkInProcess) -+ ODM_Write_DIG(pDM_Odm, 0x1c); -+ else if (pDM_Odm->bBtConnectProcess) -+ ODM_Write_DIG(pDM_Odm, 0x28); -+ else -+ ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI);/* ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); */ -+ } -+ } else { /* BT is not using */ -+ ODM_Write_DIG(pDM_Odm, CurrentIGI);/* ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); */ -+ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; -+ } -+} -+ -+void odm_DIGbyRSSI_LPS(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ Pfalse_ALARM_STATISTICS pFalseAlmCnt = &pDM_Odm->FalseAlmCnt; -+ -+ u8 RSSI_Lower = DM_DIG_MIN_NIC; /* 0x1E or 0x1C */ -+ u8 CurrentIGI = pDM_Odm->RSSI_Min; -+ -+ CurrentIGI = CurrentIGI+RSSI_OFFSET_DIG; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ("odm_DIGbyRSSI_LPS() ==>\n") -+ ); -+ -+ /* Using FW PS mode to make IGI */ -+ /* Adjust by FA in LPS MODE */ -+ if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH2_LPS) -+ CurrentIGI = CurrentIGI+4; -+ else if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH1_LPS) -+ CurrentIGI = CurrentIGI+2; -+ else if (pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0_LPS) -+ CurrentIGI = CurrentIGI-2; -+ -+ -+ /* Lower bound checking */ -+ -+ /* RSSI Lower bound check */ -+ if ((pDM_Odm->RSSI_Min-10) > DM_DIG_MIN_NIC) -+ RSSI_Lower = pDM_Odm->RSSI_Min-10; -+ else -+ RSSI_Lower = DM_DIG_MIN_NIC; -+ -+ /* Upper and Lower Bound checking */ -+ if (CurrentIGI > DM_DIG_MAX_NIC) -+ CurrentIGI = DM_DIG_MAX_NIC; -+ else if (CurrentIGI < RSSI_Lower) -+ CurrentIGI = RSSI_Lower; -+ -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ("odm_DIGbyRSSI_LPS(): pFalseAlmCnt->Cnt_all = %d\n", pFalseAlmCnt->Cnt_all) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ("odm_DIGbyRSSI_LPS(): pDM_Odm->RSSI_Min = %d\n", pDM_Odm->RSSI_Min) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_DIG, -+ ODM_DBG_LOUD, -+ ("odm_DIGbyRSSI_LPS(): CurrentIGI = 0x%x\n", CurrentIGI) -+ ); -+ -+ ODM_Write_DIG(pDM_Odm, CurrentIGI); -+ /* ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); */ -+} -+ -+/* 3 ============================================================ */ -+/* 3 FASLE ALARM CHECK */ -+/* 3 ============================================================ */ -+ -+void odm_FalseAlarmCounterStatistics(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ Pfalse_ALARM_STATISTICS FalseAlmCnt = &(pDM_Odm->FalseAlmCnt); -+ u32 ret_value; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT)) -+ return; -+ -+ /* hold ofdm counter */ -+ /* hold page C counter */ -+ PHY_SetBBReg(pDM_Odm->Adapter, ODM_REG_OFDM_FA_HOLDC_11N, BIT31, 1); -+ /* hold page D counter */ -+ PHY_SetBBReg(pDM_Odm->Adapter, ODM_REG_OFDM_FA_RSTD_11N, BIT31, 1); -+ -+ ret_value = PHY_QueryBBReg( -+ pDM_Odm->Adapter, ODM_REG_OFDM_FA_TYPE1_11N, bMaskDWord -+ ); -+ FalseAlmCnt->Cnt_Fast_Fsync = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_SB_Search_fail = ((ret_value&0xffff0000)>>16); -+ -+ ret_value = PHY_QueryBBReg( -+ pDM_Odm->Adapter, ODM_REG_OFDM_FA_TYPE2_11N, bMaskDWord -+ ); -+ FalseAlmCnt->Cnt_OFDM_CCA = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_Parity_Fail = ((ret_value&0xffff0000)>>16); -+ -+ ret_value = PHY_QueryBBReg( -+ pDM_Odm->Adapter, ODM_REG_OFDM_FA_TYPE3_11N, bMaskDWord -+ ); -+ FalseAlmCnt->Cnt_Rate_Illegal = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_Crc8_fail = ((ret_value&0xffff0000)>>16); -+ -+ ret_value = PHY_QueryBBReg( -+ pDM_Odm->Adapter, ODM_REG_OFDM_FA_TYPE4_11N, bMaskDWord -+ ); -+ FalseAlmCnt->Cnt_Mcs_fail = (ret_value&0xffff); -+ -+ FalseAlmCnt->Cnt_Ofdm_fail = -+ FalseAlmCnt->Cnt_Parity_Fail + -+ FalseAlmCnt->Cnt_Rate_Illegal + -+ FalseAlmCnt->Cnt_Crc8_fail + -+ FalseAlmCnt->Cnt_Mcs_fail + -+ FalseAlmCnt->Cnt_Fast_Fsync + -+ FalseAlmCnt->Cnt_SB_Search_fail; -+ -+ { -+ /* hold cck counter */ -+ PHY_SetBBReg(pDM_Odm->Adapter, ODM_REG_CCK_FA_RST_11N, BIT12, 1); -+ PHY_SetBBReg(pDM_Odm->Adapter, ODM_REG_CCK_FA_RST_11N, BIT14, 1); -+ -+ ret_value = PHY_QueryBBReg( -+ pDM_Odm->Adapter, ODM_REG_CCK_FA_LSB_11N, bMaskByte0 -+ ); -+ FalseAlmCnt->Cnt_Cck_fail = ret_value; -+ -+ ret_value = PHY_QueryBBReg( -+ pDM_Odm->Adapter, ODM_REG_CCK_FA_MSB_11N, bMaskByte3 -+ ); -+ FalseAlmCnt->Cnt_Cck_fail += (ret_value&0xff)<<8; -+ -+ ret_value = PHY_QueryBBReg( -+ pDM_Odm->Adapter, ODM_REG_CCK_CCA_CNT_11N, bMaskDWord -+ ); -+ FalseAlmCnt->Cnt_CCK_CCA = -+ ((ret_value&0xFF)<<8) | ((ret_value&0xFF00)>>8); -+ } -+ -+ FalseAlmCnt->Cnt_all = ( -+ FalseAlmCnt->Cnt_Fast_Fsync + -+ FalseAlmCnt->Cnt_SB_Search_fail + -+ FalseAlmCnt->Cnt_Parity_Fail + -+ FalseAlmCnt->Cnt_Rate_Illegal + -+ FalseAlmCnt->Cnt_Crc8_fail + -+ FalseAlmCnt->Cnt_Mcs_fail + -+ FalseAlmCnt->Cnt_Cck_fail -+ ); -+ -+ FalseAlmCnt->Cnt_CCA_all = -+ FalseAlmCnt->Cnt_OFDM_CCA + FalseAlmCnt->Cnt_CCK_CCA; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_FA_CNT, -+ ODM_DBG_LOUD, -+ ("Enter odm_FalseAlarmCounterStatistics\n") -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_FA_CNT, -+ ODM_DBG_LOUD, -+ ( -+ "Cnt_Fast_Fsync =%d, Cnt_SB_Search_fail =%d\n", -+ FalseAlmCnt->Cnt_Fast_Fsync, -+ FalseAlmCnt->Cnt_SB_Search_fail -+ ) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_FA_CNT, -+ ODM_DBG_LOUD, -+ ( -+ "Cnt_Parity_Fail =%d, Cnt_Rate_Illegal =%d\n", -+ FalseAlmCnt->Cnt_Parity_Fail, -+ FalseAlmCnt->Cnt_Rate_Illegal -+ ) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_FA_CNT, -+ ODM_DBG_LOUD, -+ ( -+ "Cnt_Crc8_fail =%d, Cnt_Mcs_fail =%d\n", -+ FalseAlmCnt->Cnt_Crc8_fail, -+ FalseAlmCnt->Cnt_Mcs_fail -+ ) -+ ); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_FA_CNT, -+ ODM_DBG_LOUD, -+ ("Cnt_OFDM_CCA =%d\n", FalseAlmCnt->Cnt_OFDM_CCA) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_FA_CNT, -+ ODM_DBG_LOUD, -+ ("Cnt_CCK_CCA =%d\n", FalseAlmCnt->Cnt_CCK_CCA) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_FA_CNT, -+ ODM_DBG_LOUD, -+ ("Cnt_CCA_all =%d\n", FalseAlmCnt->Cnt_CCA_all) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_FA_CNT, -+ ODM_DBG_LOUD, -+ ("Cnt_Ofdm_fail =%d\n", FalseAlmCnt->Cnt_Ofdm_fail) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_FA_CNT, -+ ODM_DBG_LOUD, -+ ("Cnt_Cck_fail =%d\n", FalseAlmCnt->Cnt_Cck_fail) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_FA_CNT, -+ ODM_DBG_LOUD, -+ ("Cnt_Ofdm_fail =%d\n", FalseAlmCnt->Cnt_Ofdm_fail) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_FA_CNT, -+ ODM_DBG_LOUD, -+ ("Total False Alarm =%d\n", FalseAlmCnt->Cnt_all) -+ ); -+} -+ -+ -+void odm_FAThresholdCheck( -+ void *pDM_VOID, -+ bool bDFSBand, -+ bool bPerformance, -+ u32 RxTp, -+ u32 TxTp, -+ u32 *dm_FA_thres -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->bLinked && (bPerformance || bDFSBand)) { -+ /* For NIC */ -+ dm_FA_thres[0] = DM_DIG_FA_TH0; -+ dm_FA_thres[1] = DM_DIG_FA_TH1; -+ dm_FA_thres[2] = DM_DIG_FA_TH2; -+ } else { -+ dm_FA_thres[0] = 2000; -+ dm_FA_thres[1] = 4000; -+ dm_FA_thres[2] = 5000; -+ } -+ return; -+} -+ -+u8 odm_ForbiddenIGICheck(void *pDM_VOID, u8 DIG_Dynamic_MIN, u8 CurrentIGI) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ Pfalse_ALARM_STATISTICS pFalseAlmCnt = &(pDM_Odm->FalseAlmCnt); -+ u8 rx_gain_range_min = pDM_DigTable->rx_gain_range_min; -+ -+ if (pFalseAlmCnt->Cnt_all > 10000) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormally false alarm case.\n")); -+ -+ if (pDM_DigTable->LargeFAHit != 3) -+ pDM_DigTable->LargeFAHit++; -+ -+ /* if (pDM_DigTable->ForbiddenIGI < pDM_DigTable->CurIGValue) */ -+ if (pDM_DigTable->ForbiddenIGI < CurrentIGI) { -+ pDM_DigTable->ForbiddenIGI = CurrentIGI; -+ /* pDM_DigTable->ForbiddenIGI = pDM_DigTable->CurIGValue; */ -+ pDM_DigTable->LargeFAHit = 1; -+ } -+ -+ if (pDM_DigTable->LargeFAHit >= 3) { -+ if ((pDM_DigTable->ForbiddenIGI + 2) > pDM_DigTable->rx_gain_range_max) -+ rx_gain_range_min = pDM_DigTable->rx_gain_range_max; -+ else -+ rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 2); -+ pDM_DigTable->Recover_cnt = 1800; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormally false alarm case: Recover_cnt = %d\n", pDM_DigTable->Recover_cnt)); -+ } -+ } else { -+ if (pDM_DigTable->Recover_cnt != 0) { -+ pDM_DigTable->Recover_cnt--; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: Recover_cnt = %d\n", pDM_DigTable->Recover_cnt)); -+ } else { -+ if (pDM_DigTable->LargeFAHit < 3) { -+ if ((pDM_DigTable->ForbiddenIGI - 2) < DIG_Dynamic_MIN) { /* DM_DIG_MIN) */ -+ pDM_DigTable->ForbiddenIGI = DIG_Dynamic_MIN; /* DM_DIG_MIN; */ -+ rx_gain_range_min = DIG_Dynamic_MIN; /* DM_DIG_MIN; */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: At Lower Bound\n")); -+ } else { -+ pDM_DigTable->ForbiddenIGI -= 2; -+ rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 2); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: Approach Lower Bound\n")); -+ } -+ } else -+ pDM_DigTable->LargeFAHit = 0; -+ } -+ } -+ -+ return rx_gain_range_min; -+ -+} -+ -+/* 3 ============================================================ */ -+/* 3 CCK Packet Detect Threshold */ -+/* 3 ============================================================ */ -+ -+void odm_CCKPacketDetectionThresh(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ Pfalse_ALARM_STATISTICS FalseAlmCnt = &(pDM_Odm->FalseAlmCnt); -+ u8 CurCCK_CCAThres; -+ -+ -+ if ( -+ !(pDM_Odm->SupportAbility & ODM_BB_CCK_PD) || -+ !(pDM_Odm->SupportAbility & ODM_BB_FA_CNT) -+ ) { -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CCK_PD, -+ ODM_DBG_LOUD, -+ ("odm_CCKPacketDetectionThresh() return ==========\n") -+ ); -+ return; -+ } -+ -+ if (pDM_Odm->ExtLNA) -+ return; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CCK_PD, -+ ODM_DBG_LOUD, -+ ("odm_CCKPacketDetectionThresh() ==========>\n") -+ ); -+ -+ if (pDM_Odm->bLinked) { -+ if (pDM_Odm->RSSI_Min > 25) -+ CurCCK_CCAThres = 0xcd; -+ else if ((pDM_Odm->RSSI_Min <= 25) && (pDM_Odm->RSSI_Min > 10)) -+ CurCCK_CCAThres = 0x83; -+ else { -+ if (FalseAlmCnt->Cnt_Cck_fail > 1000) -+ CurCCK_CCAThres = 0x83; -+ else -+ CurCCK_CCAThres = 0x40; -+ } -+ } else { -+ if (FalseAlmCnt->Cnt_Cck_fail > 1000) -+ CurCCK_CCAThres = 0x83; -+ else -+ CurCCK_CCAThres = 0x40; -+ } -+ -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, CurCCK_CCAThres); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_CCK_PD, -+ ODM_DBG_LOUD, -+ ( -+ "odm_CCKPacketDetectionThresh() CurCCK_CCAThres = 0x%x\n", -+ CurCCK_CCAThres -+ ) -+ ); -+} -+ -+void ODM_Write_CCK_CCA_Thres(void *pDM_VOID, u8 CurCCK_CCAThres) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ /* modify by Guo.Mingzhi 2012-01-03 */ -+ if (pDM_DigTable->CurCCK_CCAThres != CurCCK_CCAThres) -+ rtw_write8(pDM_Odm->Adapter, ODM_REG(CCK_CCA, pDM_Odm), CurCCK_CCAThres); -+ -+ pDM_DigTable->PreCCK_CCAThres = pDM_DigTable->CurCCK_CCAThres; -+ pDM_DigTable->CurCCK_CCAThres = CurCCK_CCAThres; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_DIG.h linux/3rdparty/rtl8723bs/hal/odm_DIG.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_DIG.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_DIG.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,195 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODMDIG_H__ -+#define __ODMDIG_H__ -+ -+typedef struct _Dynamic_Initial_Gain_Threshold_ { -+ bool bStopDIG; -+ bool bPSDInProgress; -+ -+ u8 Dig_Enable_Flag; -+ u8 Dig_Ext_Port_Stage; -+ -+ int RssiLowThresh; -+ int RssiHighThresh; -+ -+ u32 FALowThresh; -+ u32 FAHighThresh; -+ -+ u8 CurSTAConnectState; -+ u8 PreSTAConnectState; -+ u8 CurMultiSTAConnectState; -+ -+ u8 PreIGValue; -+ u8 CurIGValue; -+ u8 BackupIGValue; /* MP DIG */ -+ u8 BT30_CurIGI; -+ u8 IGIBackup; -+ -+ s8 BackoffVal; -+ s8 BackoffVal_range_max; -+ s8 BackoffVal_range_min; -+ u8 rx_gain_range_max; -+ u8 rx_gain_range_min; -+ u8 Rssi_val_min; -+ -+ u8 PreCCK_CCAThres; -+ u8 CurCCK_CCAThres; -+ u8 PreCCKPDState; -+ u8 CurCCKPDState; -+ u8 CCKPDBackup; -+ -+ u8 LargeFAHit; -+ u8 ForbiddenIGI; -+ u32 Recover_cnt; -+ -+ u8 DIG_Dynamic_MIN_0; -+ u8 DIG_Dynamic_MIN_1; -+ bool bMediaConnect_0; -+ bool bMediaConnect_1; -+ -+ u32 AntDiv_RSSI_max; -+ u32 RSSI_max; -+ -+ u8 *pbP2pLinkInProgress; -+} DIG_T, *pDIG_T; -+ -+typedef struct false_ALARM_STATISTICS { -+ u32 Cnt_Parity_Fail; -+ u32 Cnt_Rate_Illegal; -+ u32 Cnt_Crc8_fail; -+ u32 Cnt_Mcs_fail; -+ u32 Cnt_Ofdm_fail; -+ u32 Cnt_Ofdm_fail_pre; /* For RTL8881A */ -+ u32 Cnt_Cck_fail; -+ u32 Cnt_all; -+ u32 Cnt_Fast_Fsync; -+ u32 Cnt_SB_Search_fail; -+ u32 Cnt_OFDM_CCA; -+ u32 Cnt_CCK_CCA; -+ u32 Cnt_CCA_all; -+ u32 Cnt_BW_USC; /* Gary */ -+ u32 Cnt_BW_LSC; /* Gary */ -+} false_ALARM_STATISTICS, *Pfalse_ALARM_STATISTICS; -+ -+typedef enum tag_Dynamic_Init_Gain_Operation_Type_Definition { -+ DIG_TYPE_THRESH_HIGH = 0, -+ DIG_TYPE_THRESH_LOW = 1, -+ DIG_TYPE_BACKOFF = 2, -+ DIG_TYPE_RX_GAIN_MIN = 3, -+ DIG_TYPE_RX_GAIN_MAX = 4, -+ DIG_TYPE_ENABLE = 5, -+ DIG_TYPE_DISABLE = 6, -+ DIG_OP_TYPE_MAX -+} DM_DIG_OP_E; -+ -+typedef enum tag_ODM_PauseDIG_Type { -+ ODM_PAUSE_DIG = BIT0, -+ ODM_RESUME_DIG = BIT1 -+} ODM_Pause_DIG_TYPE; -+ -+typedef enum tag_ODM_PauseCCKPD_Type { -+ ODM_PAUSE_CCKPD = BIT0, -+ ODM_RESUME_CCKPD = BIT1 -+} ODM_Pause_CCKPD_TYPE; -+ -+#define DM_DIG_THRESH_HIGH 40 -+#define DM_DIG_THRESH_LOW 35 -+ -+#define DMfalseALARM_THRESH_LOW 400 -+#define DMfalseALARM_THRESH_HIGH 1000 -+ -+#define DM_DIG_MAX_NIC 0x3e -+#define DM_DIG_MIN_NIC 0x1e /* 0x22//0x1c */ -+#define DM_DIG_MAX_OF_MIN_NIC 0x3e -+ -+#define DM_DIG_MAX_AP 0x3e -+#define DM_DIG_MIN_AP 0x1c -+#define DM_DIG_MAX_OF_MIN 0x2A /* 0x32 */ -+#define DM_DIG_MIN_AP_DFS 0x20 -+ -+#define DM_DIG_MAX_NIC_HP 0x46 -+#define DM_DIG_MIN_NIC_HP 0x2e -+ -+#define DM_DIG_MAX_AP_HP 0x42 -+#define DM_DIG_MIN_AP_HP 0x30 -+ -+#define DM_DIG_FA_TH0 0x200/* 0x20 */ -+ -+#define DM_DIG_FA_TH1 0x300 -+#define DM_DIG_FA_TH2 0x400 -+/* this is for 92d */ -+#define DM_DIG_FA_TH0_92D 0x100 -+#define DM_DIG_FA_TH1_92D 0x400 -+#define DM_DIG_FA_TH2_92D 0x600 -+ -+#define DM_DIG_BACKOFF_MAX 12 -+#define DM_DIG_BACKOFF_MIN -4 -+#define DM_DIG_BACKOFF_DEFAULT 10 -+ -+#define DM_DIG_FA_TH0_LPS 4 /* 4 in lps */ -+#define DM_DIG_FA_TH1_LPS 15 /* 15 lps */ -+#define DM_DIG_FA_TH2_LPS 30 /* 30 lps */ -+#define RSSI_OFFSET_DIG 0x05 -+ -+void odm_NHMCounterStatisticsInit(void *pDM_VOID); -+ -+void odm_NHMCounterStatistics(void *pDM_VOID); -+ -+void odm_NHMBBInit(void *pDM_VOID); -+ -+void odm_NHMBB(void *pDM_VOID); -+ -+void odm_NHMCounterStatisticsReset(void *pDM_VOID); -+ -+void odm_GetNHMCounterStatistics(void *pDM_VOID); -+ -+void odm_SearchPwdBLowerBound(void *pDM_VOID, u8 IGI_target); -+ -+void odm_AdaptivityInit(void *pDM_VOID); -+ -+void odm_Adaptivity(void *pDM_VOID, u8 IGI); -+ -+void ODM_Write_DIG(void *pDM_VOID, u8 CurrentIGI); -+ -+void odm_PauseDIG(void *pDM_VOID, ODM_Pause_DIG_TYPE PauseType, u8 IGIValue); -+ -+void odm_DIGInit(void *pDM_VOID); -+ -+void odm_DIG(void *pDM_VOID); -+ -+void odm_DIGbyRSSI_LPS(void *pDM_VOID); -+ -+void odm_FalseAlarmCounterStatistics(void *pDM_VOID); -+ -+void odm_FAThresholdCheck( -+ void *pDM_VOID, -+ bool bDFSBand, -+ bool bPerformance, -+ u32 RxTp, -+ u32 TxTp, -+ u32 *dm_FA_thres -+); -+ -+u8 odm_ForbiddenIGICheck(void *pDM_VOID, u8 DIG_Dynamic_MIN, u8 CurrentIGI); -+ -+bool odm_DigAbort(void *pDM_VOID); -+ -+void odm_CCKPacketDetectionThresh(void *pDM_VOID); -+ -+void ODM_Write_CCK_CCA_Thres(void *pDM_VOID, u8 CurCCK_CCAThres); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_DynamicBBPowerSaving.c linux/3rdparty/rtl8723bs/hal/odm_DynamicBBPowerSaving.c ---- linux.old/3rdparty/rtl8723bs/hal/odm_DynamicBBPowerSaving.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_DynamicBBPowerSaving.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,89 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+void odm_DynamicBBPowerSavingInit(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; -+ -+ pDM_PSTable->PreCCAState = CCA_MAX; -+ pDM_PSTable->CurCCAState = CCA_MAX; -+ pDM_PSTable->PreRFState = RF_MAX; -+ pDM_PSTable->CurRFState = RF_MAX; -+ pDM_PSTable->Rssi_val_min = 0; -+ pDM_PSTable->initialize = 0; -+} -+ -+void ODM_RF_Saving(void *pDM_VOID, u8 bForceInNormal) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; -+ u8 Rssi_Up_bound = 30; -+ u8 Rssi_Low_bound = 25; -+ -+ if (pDM_Odm->PatchID == 40) { /* RT_CID_819x_FUNAI_TV */ -+ Rssi_Up_bound = 50; -+ Rssi_Low_bound = 45; -+ } -+ -+ if (pDM_PSTable->initialize == 0) { -+ -+ pDM_PSTable->Reg874 = (PHY_QueryBBReg(pDM_Odm->Adapter, 0x874, bMaskDWord)&0x1CC000)>>14; -+ pDM_PSTable->RegC70 = (PHY_QueryBBReg(pDM_Odm->Adapter, 0xc70, bMaskDWord)&BIT3)>>3; -+ pDM_PSTable->Reg85C = (PHY_QueryBBReg(pDM_Odm->Adapter, 0x85c, bMaskDWord)&0xFF000000)>>24; -+ pDM_PSTable->RegA74 = (PHY_QueryBBReg(pDM_Odm->Adapter, 0xa74, bMaskDWord)&0xF000)>>12; -+ /* Reg818 = PHY_QueryBBReg(padapter, 0x818, bMaskDWord); */ -+ pDM_PSTable->initialize = 1; -+ } -+ -+ if (!bForceInNormal) { -+ if (pDM_Odm->RSSI_Min != 0xFF) { -+ if (pDM_PSTable->PreRFState == RF_Normal) { -+ if (pDM_Odm->RSSI_Min >= Rssi_Up_bound) -+ pDM_PSTable->CurRFState = RF_Save; -+ else -+ pDM_PSTable->CurRFState = RF_Normal; -+ } else { -+ if (pDM_Odm->RSSI_Min <= Rssi_Low_bound) -+ pDM_PSTable->CurRFState = RF_Normal; -+ else -+ pDM_PSTable->CurRFState = RF_Save; -+ } -+ } else -+ pDM_PSTable->CurRFState = RF_MAX; -+ } else -+ pDM_PSTable->CurRFState = RF_Normal; -+ -+ if (pDM_PSTable->PreRFState != pDM_PSTable->CurRFState) { -+ if (pDM_PSTable->CurRFState == RF_Save) { -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x874, 0x1C0000, 0x2); /* Reg874[20:18]=3'b010 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0xc70, BIT3, 0); /* RegC70[3]= 1'b0 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x85c, 0xFF000000, 0x63); /* Reg85C[31:24]= 0x63 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x874, 0xC000, 0x2); /* Reg874[15:14]=2'b10 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0xa74, 0xF000, 0x3); /* RegA75[7:4]= 0x3 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x818, BIT28, 0x0); /* Reg818[28]= 1'b0 */ -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x818, BIT28, 0x1); /* Reg818[28]= 1'b1 */ -+ } else { -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x874, 0x1CC000, pDM_PSTable->Reg874); -+ PHY_SetBBReg(pDM_Odm->Adapter, 0xc70, BIT3, pDM_PSTable->RegC70); -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x85c, 0xFF000000, pDM_PSTable->Reg85C); -+ PHY_SetBBReg(pDM_Odm->Adapter, 0xa74, 0xF000, pDM_PSTable->RegA74); -+ PHY_SetBBReg(pDM_Odm->Adapter, 0x818, BIT28, 0x0); -+ } -+ pDM_PSTable->PreRFState = pDM_PSTable->CurRFState; -+ } -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_DynamicBBPowerSaving.h linux/3rdparty/rtl8723bs/hal/odm_DynamicBBPowerSaving.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_DynamicBBPowerSaving.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_DynamicBBPowerSaving.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,39 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODMDYNAMICBBPOWERSAVING_H__ -+#define __ODMDYNAMICBBPOWERSAVING_H__ -+ -+typedef struct _Dynamic_Power_Saving_ { -+ u8 PreCCAState; -+ u8 CurCCAState; -+ -+ u8 PreRFState; -+ u8 CurRFState; -+ -+ int Rssi_val_min; -+ -+ u8 initialize; -+ u32 Reg874, RegC70, Reg85C, RegA74; -+ -+} PS_T, *pPS_T; -+ -+#define dm_RF_Saving ODM_RF_Saving -+ -+void ODM_RF_Saving(void *pDM_VOID, u8 bForceInNormal); -+ -+void odm_DynamicBBPowerSavingInit(void *pDM_VOID); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_DynamicTxPower.c linux/3rdparty/rtl8723bs/hal/odm_DynamicTxPower.c ---- linux.old/3rdparty/rtl8723bs/hal/odm_DynamicTxPower.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_DynamicTxPower.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+void odm_DynamicTxPowerInit(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ struct adapter *Adapter = pDM_Odm->Adapter; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ -+ pdmpriv->bDynamicTxPowerEnable = false; -+ -+ pdmpriv->LastDTPLvl = TxHighPwrLevel_Normal; -+ pdmpriv->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_DynamicTxPower.h linux/3rdparty/rtl8723bs/hal/odm_DynamicTxPower.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_DynamicTxPower.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_DynamicTxPower.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,37 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODMDYNAMICTXPOWER_H__ -+#define __ODMDYNAMICTXPOWER_H__ -+ -+#define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 -+#define TX_POWER_NEAR_FIELD_THRESH_LVL1 67 -+#define TX_POWER_NEAR_FIELD_THRESH_AP 0x3F -+#define TX_POWER_NEAR_FIELD_THRESH_8812 60 -+ -+#define TxHighPwrLevel_Normal 0 -+#define TxHighPwrLevel_Level1 1 -+#define TxHighPwrLevel_Level2 2 -+#define TxHighPwrLevel_BT1 3 -+#define TxHighPwrLevel_BT2 4 -+#define TxHighPwrLevel_15 5 -+#define TxHighPwrLevel_35 6 -+#define TxHighPwrLevel_50 7 -+#define TxHighPwrLevel_70 8 -+#define TxHighPwrLevel_100 9 -+ -+void odm_DynamicTxPowerInit(void *pDM_VOID); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_EdcaTurboCheck.c linux/3rdparty/rtl8723bs/hal/odm_EdcaTurboCheck.c ---- linux.old/3rdparty/rtl8723bs/hal/odm_EdcaTurboCheck.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_EdcaTurboCheck.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,186 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+static u32 edca_setting_DL_GMode[HT_IOT_PEER_MAX] = { -+/*UNKNOWN, REALTEK_90, ALTEK_92SE BROADCOM, LINK ATHEROS, -+ *CISCO, MERU, MARVELL, 92U_AP, SELF_AP -+ */ -+ 0x4322, 0xa44f, 0x5e4322, 0xa42b, 0x5e4322, 0x4322, -+ 0xa42b, 0x5ea42b, 0xa44f, 0x5e4322, 0x5ea42b -+}; -+ -+static u32 edca_setting_UL[HT_IOT_PEER_MAX] = { -+/*UNKNOWN, REALTEK_90, REALTEK_92SE, BROADCOM, RALINK, ATHEROS, -+ *CISCO, MERU, MARVELL, 92U_AP, SELF_AP(DownLink/Tx) -+ */ -+ 0x5e4322, 0xa44f, 0x5e4322, 0x5ea32b, 0x5ea422, 0x5ea322, -+ 0x3ea430, 0x5ea42b, 0x5ea44f, 0x5e4322, 0x5e4322}; -+ -+static u32 edca_setting_DL[HT_IOT_PEER_MAX] = { -+/*UNKNOWN, REALTEK_90, REALTEK_92SE, BROADCOM, RALINK, ATHEROS, -+ *CISCO, MERU, MARVELL, 92U_AP, SELF_AP(UpLink/Rx) -+ */ -+ 0xa44f, 0x5ea44f, 0x5e4322, 0x5ea42b, 0xa44f, 0xa630, -+ 0x5ea630, 0x5ea42b, 0xa44f, 0xa42b, 0xa42b}; -+ -+void ODM_EdcaTurboInit(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ struct adapter *Adapter = pDM_Odm->Adapter; -+ -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = false; -+ pDM_Odm->DM_EDCA_Table.bIsCurRDLState = false; -+ Adapter->recvpriv.bIsAnyNonBEPkts = false; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, -+ ("Orginial VO PARAM: 0x%x\n", -+ rtw_read32(pDM_Odm->Adapter, ODM_EDCA_VO_PARAM))); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, -+ ("Orginial VI PARAM: 0x%x\n", -+ rtw_read32(pDM_Odm->Adapter, ODM_EDCA_VI_PARAM))); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, -+ ("Orginial BE PARAM: 0x%x\n", -+ rtw_read32(pDM_Odm->Adapter, ODM_EDCA_BE_PARAM))); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, -+ ("Orginial BK PARAM: 0x%x\n", -+ rtw_read32(pDM_Odm->Adapter, ODM_EDCA_BK_PARAM))); -+} /* ODM_InitEdcaTurbo */ -+ -+void odm_EdcaTurboCheck(void *pDM_VOID) -+{ -+ /* In HW integration first stage, we provide 4 different handles to -+ * operate at the same time. In stage2/3, we need to prove universal -+ * interface and merge all HW dynamic mechanism. -+ */ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, -+ ("odm_EdcaTurboCheck ========================>\n")); -+ -+ if (!(pDM_Odm->SupportAbility & ODM_MAC_EDCA_TURBO)) -+ return; -+ -+ odm_EdcaTurboCheckCE(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, -+ ("<========================odm_EdcaTurboCheck\n")); -+} /* odm_CheckEdcaTurbo */ -+ -+void odm_EdcaTurboCheckCE(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ struct adapter *Adapter = pDM_Odm->Adapter; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ struct recv_priv *precvpriv = &(Adapter->recvpriv); -+ struct registry_priv *pregpriv = &Adapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &(Adapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u32 EDCA_BE_UL = 0x5ea42b; -+ u32 EDCA_BE_DL = 0x5ea42b; -+ u32 iot_peer = 0; -+ u8 wirelessmode = 0xFF; /* invalid value */ -+ u32 trafficIndex; -+ u32 edca_param; -+ u64 cur_tx_bytes = 0; -+ u64 cur_rx_bytes = 0; -+ u8 bbtchange = false; -+ u8 biasonrx = false; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ if (!pDM_Odm->bLinked) { -+ precvpriv->bIsAnyNonBEPkts = false; -+ return; -+ } -+ -+ if ((pregpriv->wifi_spec == 1)) { -+ precvpriv->bIsAnyNonBEPkts = false; -+ return; -+ } -+ -+ if (pDM_Odm->pwirelessmode) -+ wirelessmode = *(pDM_Odm->pwirelessmode); -+ -+ iot_peer = pmlmeinfo->assoc_AP_vendor; -+ -+ if (iot_peer >= HT_IOT_PEER_MAX) { -+ precvpriv->bIsAnyNonBEPkts = false; -+ return; -+ } -+ -+ /* Check if the status needs to be changed. */ -+ if ((bbtchange) || (!precvpriv->bIsAnyNonBEPkts)) { -+ cur_tx_bytes = pdvobjpriv->traffic_stat.cur_tx_bytes; -+ cur_rx_bytes = pdvobjpriv->traffic_stat.cur_rx_bytes; -+ -+ /* traffic, TX or RX */ -+ if (biasonrx) { -+ if (cur_tx_bytes > (cur_rx_bytes << 2)) { -+ /* Uplink TP is present. */ -+ trafficIndex = UP_LINK; -+ } else { /* Balance TP is present. */ -+ trafficIndex = DOWN_LINK; -+ } -+ } else { -+ if (cur_rx_bytes > (cur_tx_bytes << 2)) { -+ /* Downlink TP is present. */ -+ trafficIndex = DOWN_LINK; -+ } else { /* Balance TP is present. */ -+ trafficIndex = UP_LINK; -+ } -+ } -+ -+ /* 92D txop can't be set to 0x3e for cisco1250 */ -+ if ((iot_peer == HT_IOT_PEER_CISCO) && -+ (wirelessmode == ODM_WM_N24G)) { -+ EDCA_BE_DL = edca_setting_DL[iot_peer]; -+ EDCA_BE_UL = edca_setting_UL[iot_peer]; -+ } else if ((iot_peer == HT_IOT_PEER_CISCO) && -+ ((wirelessmode == ODM_WM_G) || -+ (wirelessmode == (ODM_WM_B | ODM_WM_G)) || -+ (wirelessmode == ODM_WM_A) || -+ (wirelessmode == ODM_WM_B))) { -+ EDCA_BE_DL = edca_setting_DL_GMode[iot_peer]; -+ } else if ((iot_peer == HT_IOT_PEER_AIRGO) && -+ ((wirelessmode == ODM_WM_G) || -+ (wirelessmode == ODM_WM_A))) { -+ EDCA_BE_DL = 0xa630; -+ } else if (iot_peer == HT_IOT_PEER_MARVELL) { -+ EDCA_BE_DL = edca_setting_DL[iot_peer]; -+ EDCA_BE_UL = edca_setting_UL[iot_peer]; -+ } else if (iot_peer == HT_IOT_PEER_ATHEROS) { -+ /* Set DL EDCA for Atheros peer to 0x3ea42b. */ -+ EDCA_BE_DL = edca_setting_DL[iot_peer]; -+ } -+ -+ if (trafficIndex == DOWN_LINK) -+ edca_param = EDCA_BE_DL; -+ else -+ edca_param = EDCA_BE_UL; -+ -+ rtw_write32(Adapter, REG_EDCA_BE_PARAM, edca_param); -+ -+ pDM_Odm->DM_EDCA_Table.prv_traffic_idx = trafficIndex; -+ -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = true; -+ } else { -+ /* Turn Off EDCA turbo here. */ -+ /* Restore original EDCA according to the declaration of AP. */ -+ if (pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA) { -+ rtw_write32(Adapter, REG_EDCA_BE_PARAM, pHalData->AcParam_BE); -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = false; -+ } -+ } -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_EdcaTurboCheck.h linux/3rdparty/rtl8723bs/hal/odm_EdcaTurboCheck.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_EdcaTurboCheck.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_EdcaTurboCheck.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODMEDCATURBOCHECK_H__ -+#define __ODMEDCATURBOCHECK_H__ -+ -+typedef struct _EDCA_TURBO_ { -+ bool bCurrentTurboEDCA; -+ bool bIsCurRDLState; -+ -+ u32 prv_traffic_idx; /* edca turbo */ -+} EDCA_T, *pEDCA_T; -+ -+void odm_EdcaTurboCheck(void *pDM_VOID); -+void ODM_EdcaTurboInit(void *pDM_VOID); -+ -+void odm_EdcaTurboCheckCE(void *pDM_VOID); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm.h linux/3rdparty/rtl8723bs/hal/odm.h ---- linux.old/3rdparty/rtl8723bs/hal/odm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1465 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __HALDMOUTSRC_H__ -+#define __HALDMOUTSRC_H__ -+ -+ -+#include "odm_EdcaTurboCheck.h" -+#include "odm_DIG.h" -+#include "odm_PathDiv.h" -+#include "odm_DynamicBBPowerSaving.h" -+#include "odm_DynamicTxPower.h" -+#include "odm_CfoTracking.h" -+#include "odm_NoiseMonitor.h" -+ -+#define TP_MODE 0 -+#define RSSI_MODE 1 -+#define TRAFFIC_LOW 0 -+#define TRAFFIC_HIGH 1 -+#define NONE 0 -+ -+ -+/* 3 Tx Power Tracking */ -+/* 3 ============================================================ */ -+#define DPK_DELTA_MAPPING_NUM 13 -+#define index_mapping_HP_NUM 15 -+#define OFDM_TABLE_SIZE 43 -+#define CCK_TABLE_SIZE 33 -+#define TXSCALE_TABLE_SIZE 37 -+#define TXPWR_TRACK_TABLE_SIZE 30 -+#define DELTA_SWINGIDX_SIZE 30 -+#define BAND_NUM 4 -+ -+/* 3 PSD Handler */ -+/* 3 ============================================================ */ -+ -+#define AFH_PSD 1 /* 0:normal PSD scan, 1: only do 20 pts PSD */ -+#define MODE_40M 0 /* 0:20M, 1:40M */ -+#define PSD_TH2 3 -+#define PSD_CHMIN 20 /* Minimum channel number for BT AFH */ -+#define SIR_STEP_SIZE 3 -+#define Smooth_Size_1 5 -+#define Smooth_TH_1 3 -+#define Smooth_Size_2 10 -+#define Smooth_TH_2 4 -+#define Smooth_Size_3 20 -+#define Smooth_TH_3 4 -+#define Smooth_Step_Size 5 -+#define Adaptive_SIR 1 -+#define PSD_RESCAN 4 -+#define PSD_SCAN_INTERVAL 700 /* ms */ -+ -+/* 8723A High Power IGI Setting */ -+#define DM_DIG_HIGH_PWR_IGI_LOWER_BOUND 0x22 -+#define DM_DIG_Gmode_HIGH_PWR_IGI_LOWER_BOUND 0x28 -+#define DM_DIG_HIGH_PWR_THRESHOLD 0x3a -+#define DM_DIG_LOW_PWR_THRESHOLD 0x14 -+ -+/* ANT Test */ -+#define ANTTESTALL 0x00 /* Ant A or B will be Testing */ -+#define ANTTESTA 0x01 /* Ant A will be Testing */ -+#define ANTTESTB 0x02 /* Ant B will be testing */ -+ -+#define PS_MODE_ACTIVE 0x01 -+ -+/* for 8723A Ant Definition--2012--06--07 due to different IC may be different ANT define */ -+#define MAIN_ANT 1 /* Ant A or Ant Main */ -+#define AUX_ANT 2 /* AntB or Ant Aux */ -+#define MAX_ANT 3 /* 3 for AP using */ -+ -+ -+/* Antenna Diversity Type */ -+#define SW_ANTDIV 0 -+#define HW_ANTDIV 1 -+/* structure and define */ -+ -+/* Remove DIG by Yuchen */ -+ -+/* Remoce BB power saving by Yuchn */ -+ -+/* Remove DIG by yuchen */ -+ -+typedef struct _Dynamic_Primary_CCA { -+ u8 PriCCA_flag; -+ u8 intf_flag; -+ u8 intf_type; -+ u8 DupRTS_flag; -+ u8 Monitor_flag; -+ u8 CH_offset; -+ u8 MF_state; -+} Pri_CCA_T, *pPri_CCA_T; -+ -+typedef struct _Rate_Adaptive_Table_ { -+ u8 firstconnect; -+} RA_T, *pRA_T; -+ -+typedef struct _RX_High_Power_ { -+ u8 RXHP_flag; -+ u8 PSD_func_trigger; -+ u8 PSD_bitmap_RXHP[80]; -+ u8 Pre_IGI; -+ u8 Cur_IGI; -+ u8 Pre_pw_th; -+ u8 Cur_pw_th; -+ bool First_time_enter; -+ bool RXHP_enable; -+ u8 TP_Mode; -+ RT_TIMER PSDTimer; -+} RXHP_T, *pRXHP_T; -+ -+#define ASSOCIATE_ENTRY_NUM 32 /* Max size of AsocEntry[]. */ -+#define ODM_ASSOCIATE_ENTRY_NUM ASSOCIATE_ENTRY_NUM -+ -+/* This indicates two different the steps. */ -+/* In SWAW_STEP_PEAK, driver needs to switch antenna and listen to the signal on the air. */ -+/* In SWAW_STEP_DETERMINE, driver just compares the signal captured in SWAW_STEP_PEAK */ -+/* with original RSSI to determine if it is necessary to switch antenna. */ -+#define SWAW_STEP_PEAK 0 -+#define SWAW_STEP_DETERMINE 1 -+ -+#define TP_MODE 0 -+#define RSSI_MODE 1 -+#define TRAFFIC_LOW 0 -+#define TRAFFIC_HIGH 1 -+#define TRAFFIC_UltraLOW 2 -+ -+typedef struct _SW_Antenna_Switch_ { -+ u8 Double_chk_flag; -+ u8 try_flag; -+ s32 PreRSSI; -+ u8 CurAntenna; -+ u8 PreAntenna; -+ u8 RSSI_Trying; -+ u8 TestMode; -+ u8 bTriggerAntennaSwitch; -+ u8 SelectAntennaMap; -+ u8 RSSI_target; -+ u8 reset_idx; -+ u16 Single_Ant_Counter; -+ u16 Dual_Ant_Counter; -+ u16 Aux_FailDetec_Counter; -+ u16 Retry_Counter; -+ -+ /* Before link Antenna Switch check */ -+ u8 SWAS_NoLink_State; -+ u32 SWAS_NoLink_BK_Reg860; -+ u32 SWAS_NoLink_BK_Reg92c; -+ u32 SWAS_NoLink_BK_Reg948; -+ bool ANTA_ON; /* To indicate Ant A is or not */ -+ bool ANTB_ON; /* To indicate Ant B is on or not */ -+ bool Pre_Aux_FailDetec; -+ bool RSSI_AntDect_bResult; -+ u8 Ant5G; -+ u8 Ant2G; -+ -+ s32 RSSI_sum_A; -+ s32 RSSI_sum_B; -+ s32 RSSI_cnt_A; -+ s32 RSSI_cnt_B; -+ -+ u64 lastTxOkCnt; -+ u64 lastRxOkCnt; -+ u64 TXByteCnt_A; -+ u64 TXByteCnt_B; -+ u64 RXByteCnt_A; -+ u64 RXByteCnt_B; -+ u8 TrafficLoad; -+ u8 Train_time; -+ u8 Train_time_flag; -+ RT_TIMER SwAntennaSwitchTimer; -+ RT_TIMER SwAntennaSwitchTimer_8723B; -+ u32 PktCnt_SWAntDivByCtrlFrame; -+ bool bSWAntDivByCtrlFrame; -+} SWAT_T, *pSWAT_T; -+ -+/* Remove Edca by YuChen */ -+ -+ -+typedef struct _ODM_RATE_ADAPTIVE { -+ u8 Type; /* DM_Type_ByFW/DM_Type_ByDriver */ -+ u8 LdpcThres; /* if RSSI > LdpcThres => switch from LPDC to BCC */ -+ bool bUseLdpc; -+ bool bLowerRtsRate; -+ u8 HighRSSIThresh; /* if RSSI > HighRSSIThresh => RATRState is DM_RATR_STA_HIGH */ -+ u8 LowRSSIThresh; /* if RSSI <= LowRSSIThresh => RATRState is DM_RATR_STA_LOW */ -+ u8 RATRState; /* Current RSSI level, DM_RATR_STA_HIGH/DM_RATR_STA_MIDDLE/DM_RATR_STA_LOW */ -+ -+} ODM_RATE_ADAPTIVE, *PODM_RATE_ADAPTIVE; -+ -+ -+#define IQK_MAC_REG_NUM 4 -+#define IQK_ADDA_REG_NUM 16 -+#define IQK_BB_REG_NUM_MAX 10 -+#define IQK_BB_REG_NUM 9 -+#define HP_THERMAL_NUM 8 -+ -+#define AVG_THERMAL_NUM 8 -+#define IQK_Matrix_REG_NUM 8 -+#define IQK_Matrix_Settings_NUM 14+24+21 /* Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G */ -+ -+#define DM_Type_ByFW 0 -+#define DM_Type_ByDriver 1 -+ -+/* */ -+/* Declare for common info */ -+/* */ -+#define MAX_PATH_NUM_92CS 2 -+#define MAX_PATH_NUM_8188E 1 -+#define MAX_PATH_NUM_8192E 2 -+#define MAX_PATH_NUM_8723B 1 -+#define MAX_PATH_NUM_8812A 2 -+#define MAX_PATH_NUM_8821A 1 -+#define MAX_PATH_NUM_8814A 4 -+#define MAX_PATH_NUM_8822B 2 -+ -+ -+#define IQK_THRESHOLD 8 -+#define DPK_THRESHOLD 4 -+ -+typedef struct _ODM_Phy_Status_Info_ { -+ /* */ -+ /* Be care, if you want to add any element please insert between */ -+ /* RxPWDBAll & SignalStrength. */ -+ /* */ -+ u8 RxPWDBAll; -+ -+ u8 SignalQuality; /* in 0-100 index. */ -+ s8 RxMIMOSignalQuality[4]; /* per-path's EVM */ -+ u8 RxMIMOEVMdbm[4]; /* per-path's EVM dbm */ -+ -+ u8 RxMIMOSignalStrength[4];/* in 0~100 index */ -+ -+ u16 Cfo_short[4]; /* per-path's Cfo_short */ -+ u16 Cfo_tail[4]; /* per-path's Cfo_tail */ -+ -+ s8 RxPower; /* in dBm Translate from PWdB */ -+ s8 RecvSignalPower; /* Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. */ -+ u8 BTRxRSSIPercentage; -+ u8 SignalStrength; /* in 0-100 index. */ -+ -+ s8 RxPwr[4]; /* per-path's pwdb */ -+ -+ u8 RxSNR[4]; /* per-path's SNR */ -+ u8 BandWidth; -+ u8 btCoexPwrAdjust; -+} ODM_PHY_INFO_T, *PODM_PHY_INFO_T; -+ -+ -+typedef struct _ODM_Per_Pkt_Info_ { -+ /* u8 Rate; */ -+ u8 DataRate; -+ u8 StationID; -+ bool bPacketMatchBSSID; -+ bool bPacketToSelf; -+ bool bPacketBeacon; -+ bool bToSelf; -+} ODM_PACKET_INFO_T, *PODM_PACKET_INFO_T; -+ -+ -+typedef struct _ODM_Phy_Dbg_Info_ { -+ /* ODM Write, debug info */ -+ s8 RxSNRdB[4]; -+ u32 NumQryPhyStatus; -+ u32 NumQryPhyStatusCCK; -+ u32 NumQryPhyStatusOFDM; -+ u8 NumQryBeaconPkt; -+ /* Others */ -+ s32 RxEVM[4]; -+ -+} ODM_PHY_DBG_INFO_T; -+ -+ -+typedef struct _ODM_Mac_Status_Info_ { -+ u8 test; -+} ODM_MAC_INFO; -+ -+ -+typedef enum tag_Dynamic_ODM_Support_Ability_Type { -+ /* BB Team */ -+ ODM_DIG = 0x00000001, -+ ODM_HIGH_POWER = 0x00000002, -+ ODM_CCK_CCA_TH = 0x00000004, -+ ODM_FA_STATISTICS = 0x00000008, -+ ODM_RAMASK = 0x00000010, -+ ODM_RSSI_MONITOR = 0x00000020, -+ ODM_SW_ANTDIV = 0x00000040, -+ ODM_HW_ANTDIV = 0x00000080, -+ ODM_BB_PWRSV = 0x00000100, -+ ODM_2TPATHDIV = 0x00000200, -+ ODM_1TPATHDIV = 0x00000400, -+ ODM_PSD2AFH = 0x00000800 -+} ODM_Ability_E; -+ -+/* */ -+/* 2011/20/20 MH For MP driver RT_WLAN_STA = STA_INFO_T */ -+/* Please declare below ODM relative info in your STA info structure. */ -+/* */ -+typedef struct _ODM_STA_INFO { -+ /* Driver Write */ -+ bool bUsed; /* record the sta status link or not? */ -+ /* u8 WirelessMode; */ -+ u8 IOTPeer; /* Enum value. HT_IOT_PEER_E */ -+ -+ /* ODM Write */ -+ /* 1 PHY_STATUS_INFO */ -+ u8 RSSI_Path[4]; /* */ -+ u8 RSSI_Ave; -+ u8 RXEVM[4]; -+ u8 RXSNR[4]; -+ -+ /* ODM Write */ -+ /* 1 TX_INFO (may changed by IC) */ -+ /* TX_INFO_T pTxInfo; Define in IC folder. Move lower layer. */ -+ -+ /* */ -+ /* Please use compile flag to disabe the strcutrue for other IC except 88E. */ -+ /* Move To lower layer. */ -+ /* */ -+ /* ODM Write Wilson will handle this part(said by Luke.Lee) */ -+ /* TX_RPT_T pTxRpt; Define in IC folder. Move lower layer. */ -+} ODM_STA_INFO_T, *PODM_STA_INFO_T; -+ -+/* */ -+/* 2011/10/20 MH Define Common info enum for all team. */ -+/* */ -+typedef enum _ODM_Common_Info_Definition { -+ /* Fixed value: */ -+ -+ /* HOOK BEFORE REG INIT----------- */ -+ ODM_CMNINFO_PLATFORM = 0, -+ ODM_CMNINFO_ABILITY, /* ODM_ABILITY_E */ -+ ODM_CMNINFO_INTERFACE, /* ODM_INTERFACE_E */ -+ ODM_CMNINFO_MP_TEST_CHIP, -+ ODM_CMNINFO_IC_TYPE, /* ODM_IC_TYPE_E */ -+ ODM_CMNINFO_CUT_VER, /* ODM_CUT_VERSION_E */ -+ ODM_CMNINFO_FAB_VER, /* ODM_FAB_E */ -+ ODM_CMNINFO_RF_TYPE, /* ODM_RF_PATH_E or ODM_RF_TYPE_E? */ -+ ODM_CMNINFO_RFE_TYPE, -+ ODM_CMNINFO_BOARD_TYPE, /* ODM_BOARD_TYPE_E */ -+ ODM_CMNINFO_PACKAGE_TYPE, -+ ODM_CMNINFO_EXT_LNA, /* true */ -+ ODM_CMNINFO_5G_EXT_LNA, -+ ODM_CMNINFO_EXT_PA, -+ ODM_CMNINFO_5G_EXT_PA, -+ ODM_CMNINFO_GPA, -+ ODM_CMNINFO_APA, -+ ODM_CMNINFO_GLNA, -+ ODM_CMNINFO_ALNA, -+ ODM_CMNINFO_EXT_TRSW, -+ ODM_CMNINFO_PATCH_ID, /* CUSTOMER ID */ -+ ODM_CMNINFO_BINHCT_TEST, -+ ODM_CMNINFO_BWIFI_TEST, -+ ODM_CMNINFO_SMART_CONCURRENT, -+ /* HOOK BEFORE REG INIT----------- */ -+ -+ -+ /* Dynamic value: */ -+/* POINTER REFERENCE----------- */ -+ ODM_CMNINFO_MAC_PHY_MODE, /* ODM_MAC_PHY_MODE_E */ -+ ODM_CMNINFO_TX_UNI, -+ ODM_CMNINFO_RX_UNI, -+ ODM_CMNINFO_WM_MODE, /* ODM_WIRELESS_MODE_E */ -+ ODM_CMNINFO_BAND, /* ODM_BAND_TYPE_E */ -+ ODM_CMNINFO_SEC_CHNL_OFFSET, /* ODM_SEC_CHNL_OFFSET_E */ -+ ODM_CMNINFO_SEC_MODE, /* ODM_SECURITY_E */ -+ ODM_CMNINFO_BW, /* ODM_BW_E */ -+ ODM_CMNINFO_CHNL, -+ ODM_CMNINFO_FORCED_RATE, -+ -+ ODM_CMNINFO_DMSP_GET_VALUE, -+ ODM_CMNINFO_BUDDY_ADAPTOR, -+ ODM_CMNINFO_DMSP_IS_MASTER, -+ ODM_CMNINFO_SCAN, -+ ODM_CMNINFO_POWER_SAVING, -+ ODM_CMNINFO_ONE_PATH_CCA, /* ODM_CCA_PATH_E */ -+ ODM_CMNINFO_DRV_STOP, -+ ODM_CMNINFO_PNP_IN, -+ ODM_CMNINFO_INIT_ON, -+ ODM_CMNINFO_ANT_TEST, -+ ODM_CMNINFO_NET_CLOSED, -+ ODM_CMNINFO_MP_MODE, -+ /* ODM_CMNINFO_RTSTA_AID, For win driver only? */ -+ ODM_CMNINFO_FORCED_IGI_LB, -+ ODM_CMNINFO_IS1ANTENNA, -+ ODM_CMNINFO_RFDEFAULTPATH, -+/* POINTER REFERENCE----------- */ -+ -+/* CALL BY VALUE------------- */ -+ ODM_CMNINFO_WIFI_DIRECT, -+ ODM_CMNINFO_WIFI_DISPLAY, -+ ODM_CMNINFO_LINK_IN_PROGRESS, -+ ODM_CMNINFO_LINK, -+ ODM_CMNINFO_STATION_STATE, -+ ODM_CMNINFO_RSSI_MIN, -+ ODM_CMNINFO_DBG_COMP, /* u64 */ -+ ODM_CMNINFO_DBG_LEVEL, /* u32 */ -+ ODM_CMNINFO_RA_THRESHOLD_HIGH, /* u8 */ -+ ODM_CMNINFO_RA_THRESHOLD_LOW, /* u8 */ -+ ODM_CMNINFO_RF_ANTENNA_TYPE, /* u8 */ -+ ODM_CMNINFO_BT_ENABLED, -+ ODM_CMNINFO_BT_HS_CONNECT_PROCESS, -+ ODM_CMNINFO_BT_HS_RSSI, -+ ODM_CMNINFO_BT_OPERATION, -+ ODM_CMNINFO_BT_LIMITED_DIG, /* Need to Limited Dig or not */ -+ ODM_CMNINFO_BT_DISABLE_EDCA, -+/* CALL BY VALUE------------- */ -+ -+ /* Dynamic ptr array hook itms. */ -+ ODM_CMNINFO_STA_STATUS, -+ ODM_CMNINFO_PHY_STATUS, -+ ODM_CMNINFO_MAC_STATUS, -+ -+ ODM_CMNINFO_MAX, -+ -+ -+} ODM_CMNINFO_E; -+ -+/* 2011/10/20 MH Define ODM support ability. ODM_CMNINFO_ABILITY */ -+typedef enum _ODM_Support_Ability_Definition { -+ /* */ -+ /* BB ODM section BIT 0-15 */ -+ /* */ -+ ODM_BB_DIG = BIT0, -+ ODM_BB_RA_MASK = BIT1, -+ ODM_BB_DYNAMIC_TXPWR = BIT2, -+ ODM_BB_FA_CNT = BIT3, -+ ODM_BB_RSSI_MONITOR = BIT4, -+ ODM_BB_CCK_PD = BIT5, -+ ODM_BB_ANT_DIV = BIT6, -+ ODM_BB_PWR_SAVE = BIT7, -+ ODM_BB_PWR_TRAIN = BIT8, -+ ODM_BB_RATE_ADAPTIVE = BIT9, -+ ODM_BB_PATH_DIV = BIT10, -+ ODM_BB_PSD = BIT11, -+ ODM_BB_RXHP = BIT12, -+ ODM_BB_ADAPTIVITY = BIT13, -+ ODM_BB_CFO_TRACKING = BIT14, -+ -+ /* MAC DM section BIT 16-23 */ -+ ODM_MAC_EDCA_TURBO = BIT16, -+ ODM_MAC_EARLY_MODE = BIT17, -+ -+ /* RF ODM section BIT 24-31 */ -+ ODM_RF_TX_PWR_TRACK = BIT24, -+ ODM_RF_RX_GAIN_TRACK = BIT25, -+ ODM_RF_CALIBRATION = BIT26, -+} ODM_ABILITY_E; -+ -+/* ODM_CMNINFO_INTERFACE */ -+typedef enum tag_ODM_Support_Interface_Definition { -+ ODM_ITRF_SDIO = 0x4, -+ ODM_ITRF_ALL = 0x7, -+} ODM_INTERFACE_E; -+ -+/* ODM_CMNINFO_IC_TYPE */ -+typedef enum tag_ODM_Support_IC_Type_Definition { -+ ODM_RTL8723B = BIT8, -+} ODM_IC_TYPE_E; -+ -+/* ODM_CMNINFO_CUT_VER */ -+typedef enum tag_ODM_Cut_Version_Definition { -+ ODM_CUT_A = 0, -+ ODM_CUT_B = 1, -+ ODM_CUT_C = 2, -+ ODM_CUT_D = 3, -+ ODM_CUT_E = 4, -+ ODM_CUT_F = 5, -+ -+ ODM_CUT_I = 8, -+ ODM_CUT_J = 9, -+ ODM_CUT_K = 10, -+ ODM_CUT_TEST = 15, -+} ODM_CUT_VERSION_E; -+ -+/* ODM_CMNINFO_FAB_VER */ -+typedef enum tag_ODM_Fab_Version_Definition { -+ ODM_TSMC = 0, -+ ODM_UMC = 1, -+} ODM_FAB_E; -+ -+/* ODM_CMNINFO_RF_TYPE */ -+/* */ -+/* For example 1T2R (A+AB = BIT0|BIT4|BIT5) */ -+/* */ -+typedef enum tag_ODM_RF_Path_Bit_Definition { -+ ODM_RF_TX_A = BIT0, -+ ODM_RF_TX_B = BIT1, -+ ODM_RF_TX_C = BIT2, -+ ODM_RF_TX_D = BIT3, -+ ODM_RF_RX_A = BIT4, -+ ODM_RF_RX_B = BIT5, -+ ODM_RF_RX_C = BIT6, -+ ODM_RF_RX_D = BIT7, -+} ODM_RF_PATH_E; -+ -+ -+typedef enum tag_ODM_RF_Type_Definition { -+ ODM_1T1R = 0, -+ ODM_1T2R = 1, -+ ODM_2T2R = 2, -+ ODM_2T3R = 3, -+ ODM_2T4R = 4, -+ ODM_3T3R = 5, -+ ODM_3T4R = 6, -+ ODM_4T4R = 7, -+} ODM_RF_TYPE_E; -+ -+ -+/* */ -+/* ODM Dynamic common info value definition */ -+/* */ -+ -+/* typedef enum _MACPHY_MODE_8192D{ */ -+/* SINGLEMAC_SINGLEPHY, */ -+/* DUALMAC_DUALPHY, */ -+/* DUALMAC_SINGLEPHY, */ -+/* MACPHY_MODE_8192D,*PMACPHY_MODE_8192D; */ -+/* Above is the original define in MP driver. Please use the same define. THX. */ -+typedef enum tag_ODM_MAC_PHY_Mode_Definition { -+ ODM_SMSP = 0, -+ ODM_DMSP = 1, -+ ODM_DMDP = 2, -+} ODM_MAC_PHY_MODE_E; -+ -+ -+typedef enum tag_BT_Coexist_Definition { -+ ODM_BT_BUSY = 1, -+ ODM_BT_ON = 2, -+ ODM_BT_OFF = 3, -+ ODM_BT_NONE = 4, -+} ODM_BT_COEXIST_E; -+ -+/* ODM_CMNINFO_OP_MODE */ -+typedef enum tag_Operation_Mode_Definition { -+ ODM_NO_LINK = BIT0, -+ ODM_LINK = BIT1, -+ ODM_SCAN = BIT2, -+ ODM_POWERSAVE = BIT3, -+ ODM_AP_MODE = BIT4, -+ ODM_CLIENT_MODE = BIT5, -+ ODM_AD_HOC = BIT6, -+ ODM_WIFI_DIRECT = BIT7, -+ ODM_WIFI_DISPLAY = BIT8, -+} ODM_OPERATION_MODE_E; -+ -+/* ODM_CMNINFO_WM_MODE */ -+typedef enum tag_Wireless_Mode_Definition { -+ ODM_WM_UNKNOW = 0x0, -+ ODM_WM_B = BIT0, -+ ODM_WM_G = BIT1, -+ ODM_WM_A = BIT2, -+ ODM_WM_N24G = BIT3, -+ ODM_WM_N5G = BIT4, -+ ODM_WM_AUTO = BIT5, -+ ODM_WM_AC = BIT6, -+} ODM_WIRELESS_MODE_E; -+ -+/* ODM_CMNINFO_BAND */ -+typedef enum tag_Band_Type_Definition { -+ ODM_BAND_2_4G = 0, -+ ODM_BAND_5G, -+ ODM_BAND_ON_BOTH, -+ ODM_BANDMAX -+} ODM_BAND_TYPE_E; -+ -+/* ODM_CMNINFO_SEC_CHNL_OFFSET */ -+typedef enum tag_Secondary_Channel_Offset_Definition { -+ ODM_DONT_CARE = 0, -+ ODM_BELOW = 1, -+ ODM_ABOVE = 2 -+} ODM_SEC_CHNL_OFFSET_E; -+ -+/* ODM_CMNINFO_SEC_MODE */ -+typedef enum tag_Security_Definition { -+ ODM_SEC_OPEN = 0, -+ ODM_SEC_WEP40 = 1, -+ ODM_SEC_TKIP = 2, -+ ODM_SEC_RESERVE = 3, -+ ODM_SEC_AESCCMP = 4, -+ ODM_SEC_WEP104 = 5, -+ ODM_WEP_WPA_MIXED = 6, /* WEP + WPA */ -+ ODM_SEC_SMS4 = 7, -+} ODM_SECURITY_E; -+ -+/* ODM_CMNINFO_BW */ -+typedef enum tag_Bandwidth_Definition { -+ ODM_BW20M = 0, -+ ODM_BW40M = 1, -+ ODM_BW80M = 2, -+ ODM_BW160M = 3, -+ ODM_BW10M = 4, -+} ODM_BW_E; -+ -+ -+/* ODM_CMNINFO_BOARD_TYPE */ -+/* For non-AC-series IC , ODM_BOARD_5G_EXT_PA and ODM_BOARD_5G_EXT_LNA are ignored */ -+/* For AC-series IC, external PA & LNA can be indivisuallly added on 2.4G and/or 5G */ -+typedef enum tag_Board_Definition { -+ ODM_BOARD_DEFAULT = 0, /* The DEFAULT case. */ -+ ODM_BOARD_MINICARD = BIT(0), /* 0 = non-mini card, 1 = mini card. */ -+ ODM_BOARD_SLIM = BIT(1), /* 0 = non-slim card, 1 = slim card */ -+ ODM_BOARD_BT = BIT(2), /* 0 = without BT card, 1 = with BT */ -+ ODM_BOARD_EXT_PA = BIT(3), /* 0 = no 2G ext-PA, 1 = existing 2G ext-PA */ -+ ODM_BOARD_EXT_LNA = BIT(4), /* 0 = no 2G ext-LNA, 1 = existing 2G ext-LNA */ -+ ODM_BOARD_EXT_TRSW = BIT(5), /* 0 = no ext-TRSW, 1 = existing ext-TRSW */ -+ ODM_BOARD_EXT_PA_5G = BIT(6), /* 0 = no 5G ext-PA, 1 = existing 5G ext-PA */ -+ ODM_BOARD_EXT_LNA_5G = BIT(7), /* 0 = no 5G ext-LNA, 1 = existing 5G ext-LNA */ -+} ODM_BOARD_TYPE_E; -+ -+typedef enum tag_ODM_Package_Definition { -+ ODM_PACKAGE_DEFAULT = 0, -+ ODM_PACKAGE_QFN68 = BIT(0), -+ ODM_PACKAGE_TFBGA90 = BIT(1), -+ ODM_PACKAGE_TFBGA79 = BIT(2), -+} ODM_Package_TYPE_E; -+ -+typedef enum tag_ODM_TYPE_GPA_Definition { -+ TYPE_GPA0 = 0, -+ TYPE_GPA1 = BIT(1)|BIT(0) -+} ODM_TYPE_GPA_E; -+ -+typedef enum tag_ODM_TYPE_APA_Definition { -+ TYPE_APA0 = 0, -+ TYPE_APA1 = BIT(1)|BIT(0) -+} ODM_TYPE_APA_E; -+ -+typedef enum tag_ODM_TYPE_GLNA_Definition { -+ TYPE_GLNA0 = 0, -+ TYPE_GLNA1 = BIT(2)|BIT(0), -+ TYPE_GLNA2 = BIT(3)|BIT(1), -+ TYPE_GLNA3 = BIT(3)|BIT(2)|BIT(1)|BIT(0) -+} ODM_TYPE_GLNA_E; -+ -+typedef enum tag_ODM_TYPE_ALNA_Definition { -+ TYPE_ALNA0 = 0, -+ TYPE_ALNA1 = BIT(2)|BIT(0), -+ TYPE_ALNA2 = BIT(3)|BIT(1), -+ TYPE_ALNA3 = BIT(3)|BIT(2)|BIT(1)|BIT(0) -+} ODM_TYPE_ALNA_E; -+ -+/* ODM_CMNINFO_ONE_PATH_CCA */ -+typedef enum tag_CCA_Path { -+ ODM_CCA_2R = 0, -+ ODM_CCA_1R_A = 1, -+ ODM_CCA_1R_B = 2, -+} ODM_CCA_PATH_E; -+ -+ -+typedef struct _ODM_RA_Info_ { -+ u8 RateID; -+ u32 RateMask; -+ u32 RAUseRate; -+ u8 RateSGI; -+ u8 RssiStaRA; -+ u8 PreRssiStaRA; -+ u8 SGIEnable; -+ u8 DecisionRate; -+ u8 PreRate; -+ u8 HighestRate; -+ u8 LowestRate; -+ u32 NscUp; -+ u32 NscDown; -+ u16 RTY[5]; -+ u32 TOTAL; -+ u16 DROP; -+ u8 Active; -+ u16 RptTime; -+ u8 RAWaitingCounter; -+ u8 RAPendingCounter; -+ u8 PTActive; /* on or off */ -+ u8 PTTryState; /* 0 trying state, 1 for decision state */ -+ u8 PTStage; /* 0~6 */ -+ u8 PTStopCount; /* Stop PT counter */ -+ u8 PTPreRate; /* if rate change do PT */ -+ u8 PTPreRssi; /* if RSSI change 5% do PT */ -+ u8 PTModeSS; /* decide whitch rate should do PT */ -+ u8 RAstage; /* StageRA, decide how many times RA will be done between PT */ -+ u8 PTSmoothFactor; -+} ODM_RA_INFO_T, *PODM_RA_INFO_T; -+ -+typedef struct _IQK_MATRIX_REGS_SETTING { -+ bool bIQKDone; -+ s32 Value[3][IQK_Matrix_REG_NUM]; -+ bool bBWIqkResultSaved[3]; -+} IQK_MATRIX_REGS_SETTING, *PIQK_MATRIX_REGS_SETTING; -+ -+ -+/* Remove PATHDIV_PARA struct to odm_PathDiv.h */ -+ -+typedef struct ODM_RF_Calibration_Structure { -+ /* for tx power tracking */ -+ -+ u32 RegA24; /* for TempCCK */ -+ s32 RegE94; -+ s32 RegE9C; -+ s32 RegEB4; -+ s32 RegEBC; -+ -+ u8 TXPowercount; -+ bool bTXPowerTrackingInit; -+ bool bTXPowerTracking; -+ u8 TxPowerTrackControl; /* for mp mode, turn off txpwrtracking as default */ -+ u8 TM_Trigger; -+ u8 InternalPA5G[2]; /* pathA / pathB */ -+ -+ u8 ThermalMeter[2]; /* ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 */ -+ u8 ThermalValue; -+ u8 ThermalValue_LCK; -+ u8 ThermalValue_IQK; -+ u8 ThermalValue_DPK; -+ u8 ThermalValue_AVG[AVG_THERMAL_NUM]; -+ u8 ThermalValue_AVG_index; -+ u8 ThermalValue_RxGain; -+ u8 ThermalValue_Crystal; -+ u8 ThermalValue_DPKstore; -+ u8 ThermalValue_DPKtrack; -+ bool TxPowerTrackingInProgress; -+ -+ bool bReloadtxpowerindex; -+ u8 bRfPiEnable; -+ u32 TXPowerTrackingCallbackCnt; /* cosa add for debug */ -+ -+ -+ /* Tx power Tracking ------------------------- */ -+ u8 bCCKinCH14; -+ u8 CCK_index; -+ u8 OFDM_index[MAX_RF_PATH]; -+ s8 PowerIndexOffset[MAX_RF_PATH]; -+ s8 DeltaPowerIndex[MAX_RF_PATH]; -+ s8 DeltaPowerIndexLast[MAX_RF_PATH]; -+ bool bTxPowerChanged; -+ -+ u8 ThermalValue_HP[HP_THERMAL_NUM]; -+ u8 ThermalValue_HP_index; -+ IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; -+ bool bNeedIQK; -+ bool bIQKInProgress; -+ u8 Delta_IQK; -+ u8 Delta_LCK; -+ s8 BBSwingDiff2G, BBSwingDiff5G; /* Unit: dB */ -+ u8 DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; -+ u8 DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; -+ u8 DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; -+ u8 DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; -+ u8 DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; -+ u8 DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; -+ u8 DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; -+ u8 DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; -+ u8 DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; -+ u8 DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; -+ -+ /* */ -+ -+ /* for IQK */ -+ u32 RegC04; -+ u32 Reg874; -+ u32 RegC08; -+ u32 RegB68; -+ u32 RegB6C; -+ u32 Reg870; -+ u32 Reg860; -+ u32 Reg864; -+ -+ bool bIQKInitialized; -+ bool bLCKInProgress; -+ bool bAntennaDetected; -+ u32 ADDA_backup[IQK_ADDA_REG_NUM]; -+ u32 IQK_MAC_backup[IQK_MAC_REG_NUM]; -+ u32 IQK_BB_backup_recover[9]; -+ u32 IQK_BB_backup[IQK_BB_REG_NUM]; -+ u32 TxIQC_8723B[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ -+ u32 RxIQC_8723B[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ -+ -+ -+ /* for APK */ -+ u32 APKoutput[2][2]; /* path A/B; output1_1a/output1_2a */ -+ u8 bAPKdone; -+ u8 bAPKThermalMeterIgnore; -+ -+ /* DPK */ -+ bool bDPKFail; -+ u8 bDPdone; -+ u8 bDPPathAOK; -+ u8 bDPPathBOK; -+ -+ u32 TxLOK[2]; -+ -+} ODM_RF_CAL_T, *PODM_RF_CAL_T; -+/* */ -+/* ODM Dynamic common info value definition */ -+/* */ -+ -+typedef struct _FAST_ANTENNA_TRAINNING_ { -+ u8 Bssid[6]; -+ u8 antsel_rx_keep_0; -+ u8 antsel_rx_keep_1; -+ u8 antsel_rx_keep_2; -+ u8 antsel_rx_keep_3; -+ u32 antSumRSSI[7]; -+ u32 antRSSIcnt[7]; -+ u32 antAveRSSI[7]; -+ u8 FAT_State; -+ u32 TrainIdx; -+ u8 antsel_a[ODM_ASSOCIATE_ENTRY_NUM]; -+ u8 antsel_b[ODM_ASSOCIATE_ENTRY_NUM]; -+ u8 antsel_c[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 MainAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 AuxAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 MainAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 AuxAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u8 RxIdleAnt; -+ bool bBecomeLinked; -+ u32 MinMaxRSSI; -+ u8 idx_AntDiv_counter_2G; -+ u8 idx_AntDiv_counter_5G; -+ u32 AntDiv_2G_5G; -+ u32 CCK_counter_main; -+ u32 CCK_counter_aux; -+ u32 OFDM_counter_main; -+ u32 OFDM_counter_aux; -+ -+ -+ u32 CCK_CtrlFrame_Cnt_main; -+ u32 CCK_CtrlFrame_Cnt_aux; -+ u32 OFDM_CtrlFrame_Cnt_main; -+ u32 OFDM_CtrlFrame_Cnt_aux; -+ u32 MainAnt_CtrlFrame_Sum; -+ u32 AuxAnt_CtrlFrame_Sum; -+ u32 MainAnt_CtrlFrame_Cnt; -+ u32 AuxAnt_CtrlFrame_Cnt; -+ -+} FAT_T, *pFAT_T; -+ -+typedef enum _FAT_STATE { -+ FAT_NORMAL_STATE = 0, -+ FAT_TRAINING_STATE = 1, -+} FAT_STATE_E, *PFAT_STATE_E; -+ -+typedef enum _ANT_DIV_TYPE { -+ NO_ANTDIV = 0xFF, -+ CG_TRX_HW_ANTDIV = 0x01, -+ CGCS_RX_HW_ANTDIV = 0x02, -+ FIXED_HW_ANTDIV = 0x03, -+ CG_TRX_SMART_ANTDIV = 0x04, -+ CGCS_RX_SW_ANTDIV = 0x05, -+ S0S1_SW_ANTDIV = 0x06 /* 8723B intrnal switch S0 S1 */ -+} ANT_DIV_TYPE_E, *PANT_DIV_TYPE_E; -+ -+typedef struct _ODM_PATH_DIVERSITY_ { -+ u8 RespTxPath; -+ u8 PathSel[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 PathA_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 PathB_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 PathA_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 PathB_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+} PATHDIV_T, *pPATHDIV_T; -+ -+ -+typedef enum _BASEBAND_CONFIG_PHY_REG_PG_VALUE_TYPE{ -+ PHY_REG_PG_RELATIVE_VALUE = 0, -+ PHY_REG_PG_EXACT_VALUE = 1 -+} PHY_REG_PG_TYPE; -+ -+ -+/* */ -+/* Antenna detection information from single tone mechanism, added by Roger, 2012.11.27. */ -+/* */ -+typedef struct _ANT_DETECTED_INFO { -+ bool bAntDetected; -+ u32 dBForAntA; -+ u32 dBForAntB; -+ u32 dBForAntO; -+} ANT_DETECTED_INFO, *PANT_DETECTED_INFO; -+ -+/* */ -+/* 2011/09/22 MH Copy from SD4 defined structure. We use to support PHY DM integration. */ -+/* */ -+typedef struct DM_Out_Source_Dynamic_Mechanism_Structure { -+ /* RT_TIMER FastAntTrainingTimer; */ -+ /* */ -+ /* Add for different team use temporarily */ -+ /* */ -+ struct adapter *Adapter; /* For CE/NIC team */ -+ /* WHen you use Adapter or priv pointer, you must make sure the pointer is ready. */ -+ bool odm_ready; -+ -+ PHY_REG_PG_TYPE PhyRegPgValueType; -+ u8 PhyRegPgVersion; -+ -+ u64 DebugComponents; -+ u32 DebugLevel; -+ -+ u32 NumQryPhyStatusAll; /* CCK + OFDM */ -+ u32 LastNumQryPhyStatusAll; -+ u32 RxPWDBAve; -+ bool MPDIG_2G; /* off MPDIG */ -+ u8 Times_2G; -+ -+/* ODM HANDLE, DRIVER NEEDS NOT TO HOOK------ */ -+ bool bCckHighPower; -+ u8 RFPathRxEnable; /* ODM_CMNINFO_RFPATH_ENABLE */ -+ u8 ControlChannel; -+/* ODM HANDLE, DRIVER NEEDS NOT TO HOOK------ */ -+ -+/* REMOVED COMMON INFO---------- */ -+ /* u8 PseudoMacPhyMode; */ -+ /* bool *BTCoexist; */ -+ /* bool PseudoBtCoexist; */ -+ /* u8 OPMode; */ -+ /* bool bAPMode; */ -+ /* bool bClientMode; */ -+ /* bool bAdHocMode; */ -+ /* bool bSlaveOfDMSP; */ -+/* REMOVED COMMON INFO---------- */ -+ -+ -+/* 1 COMMON INFORMATION */ -+ -+ /* */ -+ /* Init Value */ -+ /* */ -+/* HOOK BEFORE REG INIT----------- */ -+ /* ODM Platform info AP/ADSL/CE/MP = 1/2/3/4 */ -+ u8 SupportPlatform; -+ /* ODM Support Ability DIG/RATR/TX_PWR_TRACK/ ?K?K = 1/2/3/?K */ -+ u32 SupportAbility; -+ /* ODM PCIE/USB/SDIO = 1/2/3 */ -+ u8 SupportInterface; -+ /* ODM composite or independent. Bit oriented/ 92C+92D+ .... or any other type = 1/2/3/... */ -+ u32 SupportICType; -+ /* Cut Version TestChip/A-cut/B-cut... = 0/1/2/3/... */ -+ u8 CutVersion; -+ /* Fab Version TSMC/UMC = 0/1 */ -+ u8 FabVersion; -+ /* RF Type 4T4R/3T3R/2T2R/1T2R/1T1R/... */ -+ u8 RFType; -+ u8 RFEType; -+ /* Board Type Normal/HighPower/MiniCard/SLIM/Combo/... = 0/1/2/3/4/... */ -+ u8 BoardType; -+ u8 PackageType; -+ u8 TypeGLNA; -+ u8 TypeGPA; -+ u8 TypeALNA; -+ u8 TypeAPA; -+ /* with external LNA NO/Yes = 0/1 */ -+ u8 ExtLNA; -+ u8 ExtLNA5G; -+ /* with external PA NO/Yes = 0/1 */ -+ u8 ExtPA; -+ u8 ExtPA5G; -+ /* with external TRSW NO/Yes = 0/1 */ -+ u8 ExtTRSW; -+ u8 PatchID; /* Customer ID */ -+ bool bInHctTest; -+ bool bWIFITest; -+ -+ bool bDualMacSmartConcurrent; -+ u32 BK_SupportAbility; -+ u8 AntDivType; -+/* HOOK BEFORE REG INIT----------- */ -+ -+ /* */ -+ /* Dynamic Value */ -+ /* */ -+/* POINTER REFERENCE----------- */ -+ -+ u8 u8_temp; -+ bool bool_temp; -+ struct adapter *adapter_temp; -+ -+ /* MAC PHY Mode SMSP/DMSP/DMDP = 0/1/2 */ -+ u8 *pMacPhyMode; -+ /* TX Unicast byte count */ -+ u64 *pNumTxBytesUnicast; -+ /* RX Unicast byte count */ -+ u64 *pNumRxBytesUnicast; -+ /* Wireless mode B/G/A/N = BIT0/BIT1/BIT2/BIT3 */ -+ u8 *pwirelessmode; /* ODM_WIRELESS_MODE_E */ -+ /* Frequence band 2.4G/5G = 0/1 */ -+ u8 *pBandType; -+ /* Secondary channel offset don't_care/below/above = 0/1/2 */ -+ u8 *pSecChOffset; -+ /* Security mode Open/WEP/AES/TKIP = 0/1/2/3 */ -+ u8 *pSecurity; -+ /* BW info 20M/40M/80M = 0/1/2 */ -+ u8 *pBandWidth; -+ /* Central channel location Ch1/Ch2/.... */ -+ u8 *pChannel; /* central channel number */ -+ bool DPK_Done; -+ /* Common info for 92D DMSP */ -+ -+ bool *pbGetValueFromOtherMac; -+ struct adapter **pBuddyAdapter; -+ bool *pbMasterOfDMSP; /* MAC0: master, MAC1: slave */ -+ /* Common info for Status */ -+ bool *pbScanInProcess; -+ bool *pbPowerSaving; -+ /* CCA Path 2-path/path-A/path-B = 0/1/2; using ODM_CCA_PATH_E. */ -+ u8 *pOnePathCCA; -+ /* pMgntInfo->AntennaTest */ -+ u8 *pAntennaTest; -+ bool *pbNet_closed; -+ u8 *mp_mode; -+ /* u8 *pAidMap; */ -+ u8 *pu1ForcedIgiLb; -+/* For 8723B IQK----------- */ -+ bool *pIs1Antenna; -+ u8 *pRFDefaultPath; -+ /* 0:S1, 1:S0 */ -+ -+/* POINTER REFERENCE----------- */ -+ u16 *pForcedDataRate; -+/* CALL BY VALUE------------- */ -+ bool bLinkInProcess; -+ bool bWIFI_Direct; -+ bool bWIFI_Display; -+ bool bLinked; -+ -+ bool bsta_state; -+ u8 RSSI_Min; -+ u8 InterfaceIndex; /* Add for 92D dual MAC: 0--Mac0 1--Mac1 */ -+ bool bIsMPChip; -+ bool bOneEntryOnly; -+ /* Common info for BTDM */ -+ bool bBtEnabled; /* BT is disabled */ -+ bool bBtConnectProcess; /* BT HS is under connection progress. */ -+ u8 btHsRssi; /* BT HS mode wifi rssi value. */ -+ bool bBtHsOperation; /* BT HS mode is under progress */ -+ bool bBtDisableEdcaTurbo; /* Under some condition, don't enable the EDCA Turbo */ -+ bool bBtLimitedDig; /* BT is busy. */ -+/* CALL BY VALUE------------- */ -+ u8 RSSI_A; -+ u8 RSSI_B; -+ u64 RSSI_TRSW; -+ u64 RSSI_TRSW_H; -+ u64 RSSI_TRSW_L; -+ u64 RSSI_TRSW_iso; -+ -+ u8 RxRate; -+ bool bNoisyState; -+ u8 TxRate; -+ u8 LinkedInterval; -+ u8 preChannel; -+ u32 TxagcOffsetValueA; -+ bool IsTxagcOffsetPositiveA; -+ u32 TxagcOffsetValueB; -+ bool IsTxagcOffsetPositiveB; -+ u64 lastTxOkCnt; -+ u64 lastRxOkCnt; -+ u32 BbSwingOffsetA; -+ bool IsBbSwingOffsetPositiveA; -+ u32 BbSwingOffsetB; -+ bool IsBbSwingOffsetPositiveB; -+ s8 TH_L2H_ini; -+ s8 TH_EDCCA_HL_diff; -+ s8 IGI_Base; -+ u8 IGI_target; -+ bool ForceEDCCA; -+ u8 AdapEn_RSSI; -+ s8 Force_TH_H; -+ s8 Force_TH_L; -+ u8 IGI_LowerBound; -+ u8 antdiv_rssi; -+ u8 AntType; -+ u8 pre_AntType; -+ u8 antdiv_period; -+ u8 antdiv_select; -+ u8 NdpaPeriod; -+ bool H2C_RARpt_connect; -+ -+ /* add by Yu Cehn for adaptivtiy */ -+ bool adaptivity_flag; -+ bool NHM_disable; -+ bool TxHangFlg; -+ bool Carrier_Sense_enable; -+ u8 tolerance_cnt; -+ u64 NHMCurTxOkcnt; -+ u64 NHMCurRxOkcnt; -+ u64 NHMLastTxOkcnt; -+ u64 NHMLastRxOkcnt; -+ u8 txEdcca1; -+ u8 txEdcca0; -+ s8 H2L_lb; -+ s8 L2H_lb; -+ u8 Adaptivity_IGI_upper; -+ u8 NHM_cnt_0; -+ -+ -+ ODM_NOISE_MONITOR noise_level;/* ODM_MAX_CHANNEL_NUM]; */ -+ /* */ -+ /* 2 Define STA info. */ -+ /* _ODM_STA_INFO */ -+ /* 2012/01/12 MH For MP, we need to reduce one array pointer for default port.?? */ -+ PSTA_INFO_T pODM_StaInfo[ODM_ASSOCIATE_ENTRY_NUM]; -+ -+ /* */ -+ /* 2012/02/14 MH Add to share 88E ra with other SW team. */ -+ /* We need to colelct all support abilit to a proper area. */ -+ /* */ -+ bool RaSupport88E; -+ -+ /* Define ........... */ -+ -+ /* Latest packet phy info (ODM write) */ -+ ODM_PHY_DBG_INFO_T PhyDbgInfo; -+ /* PHY_INFO_88E PhyInfo; */ -+ -+ /* Latest packet phy info (ODM write) */ -+ ODM_MAC_INFO *pMacInfo; -+ /* MAC_INFO_88E MacInfo; */ -+ -+ /* Different Team independt structure?? */ -+ -+ /* */ -+ /* TX_RTP_CMN TX_retrpo; */ -+ /* TX_RTP_88E TX_retrpo; */ -+ /* TX_RTP_8195 TX_retrpo; */ -+ -+ /* */ -+ /* ODM Structure */ -+ /* */ -+ FAT_T DM_FatTable; -+ DIG_T DM_DigTable; -+ PS_T DM_PSTable; -+ Pri_CCA_T DM_PriCCA; -+ RXHP_T DM_RXHP_Table; -+ RA_T DM_RA_Table; -+ false_ALARM_STATISTICS FalseAlmCnt; -+ false_ALARM_STATISTICS FlaseAlmCntBuddyAdapter; -+ SWAT_T DM_SWAT_Table; -+ bool RSSI_test; -+ CFO_TRACKING DM_CfoTrack; -+ -+ EDCA_T DM_EDCA_Table; -+ u32 WMMEDCA_BE; -+ PATHDIV_T DM_PathDiv; -+ /* Copy from SD4 structure */ -+ /* */ -+ /* ================================================== */ -+ /* */ -+ -+ /* common */ -+ /* u8 DM_Type; */ -+ /* u8 PSD_Report_RXHP[80]; Add By Gary */ -+ /* u8 PSD_func_flag; Add By Gary */ -+ /* for DIG */ -+ /* u8 bDMInitialGainEnable; */ -+ /* u8 binitialized; for dm_initial_gain_Multi_STA use. */ -+ /* for Antenna diversity */ -+ /* u8 AntDivCfg; 0:OFF , 1:ON, 2:by efuse */ -+ /* PSTA_INFO_T RSSI_target; */ -+ -+ bool *pbDriverStopped; -+ bool *pbDriverIsGoingToPnpSetPowerSleep; -+ bool *pinit_adpt_in_progress; -+ -+ /* PSD */ -+ bool bUserAssignLevel; -+ RT_TIMER PSDTimer; -+ u8 RSSI_BT; /* come from BT */ -+ bool bPSDinProcess; -+ bool bPSDactive; -+ bool bDMInitialGainEnable; -+ -+ /* MPT DIG */ -+ RT_TIMER MPT_DIGTimer; -+ -+ /* for rate adaptive, in fact, 88c/92c fw will handle this */ -+ u8 bUseRAMask; -+ -+ ODM_RATE_ADAPTIVE RateAdaptive; -+ -+ ANT_DETECTED_INFO AntDetectedInfo; /* Antenna detected information for RSSI tool */ -+ -+ ODM_RF_CAL_T RFCalibrateInfo; -+ -+ /* */ -+ /* TX power tracking */ -+ /* */ -+ u8 BbSwingIdxOfdm[MAX_RF_PATH]; -+ u8 BbSwingIdxOfdmCurrent; -+ u8 BbSwingIdxOfdmBase[MAX_RF_PATH]; -+ bool BbSwingFlagOfdm; -+ u8 BbSwingIdxCck; -+ u8 BbSwingIdxCckCurrent; -+ u8 BbSwingIdxCckBase; -+ u8 DefaultOfdmIndex; -+ u8 DefaultCckIndex; -+ bool BbSwingFlagCck; -+ -+ s8 Absolute_OFDMSwingIdx[MAX_RF_PATH]; -+ s8 Remnant_OFDMSwingIdx[MAX_RF_PATH]; -+ s8 Remnant_CCKSwingIdx; -+ s8 Modify_TxAGC_Value; /* Remnat compensate value at TxAGC */ -+ bool Modify_TxAGC_Flag_PathA; -+ bool Modify_TxAGC_Flag_PathB; -+ bool Modify_TxAGC_Flag_PathC; -+ bool Modify_TxAGC_Flag_PathD; -+ bool Modify_TxAGC_Flag_PathA_CCK; -+ -+ s8 KfreeOffset[MAX_RF_PATH]; -+ /* */ -+ /* ODM system resource. */ -+ /* */ -+ -+ /* ODM relative time. */ -+ RT_TIMER PathDivSwitchTimer; -+ /* 2011.09.27 add for Path Diversity */ -+ RT_TIMER CCKPathDiversityTimer; -+ RT_TIMER FastAntTrainingTimer; -+ -+ /* ODM relative workitem. */ -+ -+ #if (BEAMFORMING_SUPPORT == 1) -+ RT_BEAMFORMING_INFO BeamformingInfo; -+ #endif -+} DM_ODM_T, *PDM_ODM_T; /* DM_Dynamic_Mechanism_Structure */ -+ -+#define ODM_RF_PATH_MAX 2 -+ -+typedef enum _ODM_RF_RADIO_PATH { -+ ODM_RF_PATH_A = 0, /* Radio Path A */ -+ ODM_RF_PATH_B = 1, /* Radio Path B */ -+ ODM_RF_PATH_C = 2, /* Radio Path C */ -+ ODM_RF_PATH_D = 3, /* Radio Path D */ -+ ODM_RF_PATH_AB, -+ ODM_RF_PATH_AC, -+ ODM_RF_PATH_AD, -+ ODM_RF_PATH_BC, -+ ODM_RF_PATH_BD, -+ ODM_RF_PATH_CD, -+ ODM_RF_PATH_ABC, -+ ODM_RF_PATH_ACD, -+ ODM_RF_PATH_BCD, -+ ODM_RF_PATH_ABCD, -+ /* ODM_RF_PATH_MAX, Max RF number 90 support */ -+} ODM_RF_RADIO_PATH_E, *PODM_RF_RADIO_PATH_E; -+ -+ typedef enum _ODM_RF_CONTENT { -+ odm_radioa_txt = 0x1000, -+ odm_radiob_txt = 0x1001, -+ odm_radioc_txt = 0x1002, -+ odm_radiod_txt = 0x1003 -+} ODM_RF_CONTENT; -+ -+typedef enum _ODM_BB_Config_Type { -+ CONFIG_BB_PHY_REG, -+ CONFIG_BB_AGC_TAB, -+ CONFIG_BB_AGC_TAB_2G, -+ CONFIG_BB_AGC_TAB_5G, -+ CONFIG_BB_PHY_REG_PG, -+ CONFIG_BB_PHY_REG_MP, -+ CONFIG_BB_AGC_TAB_DIFF, -+} ODM_BB_Config_Type, *PODM_BB_Config_Type; -+ -+typedef enum _ODM_RF_Config_Type { -+ CONFIG_RF_RADIO, -+ CONFIG_RF_TXPWR_LMT, -+} ODM_RF_Config_Type, *PODM_RF_Config_Type; -+ -+typedef enum _ODM_FW_Config_Type { -+ CONFIG_FW_NIC, -+ CONFIG_FW_NIC_2, -+ CONFIG_FW_AP, -+ CONFIG_FW_WoWLAN, -+ CONFIG_FW_WoWLAN_2, -+ CONFIG_FW_AP_WoWLAN, -+ CONFIG_FW_BT, -+} ODM_FW_Config_Type; -+ -+/* Status code */ -+typedef enum _RT_STATUS { -+ RT_STATUS_SUCCESS, -+ RT_STATUS_FAILURE, -+ RT_STATUS_PENDING, -+ RT_STATUS_RESOURCE, -+ RT_STATUS_INVALID_CONTEXT, -+ RT_STATUS_INVALID_PARAMETER, -+ RT_STATUS_NOT_SUPPORT, -+ RT_STATUS_OS_API_FAILED, -+} RT_STATUS, *PRT_STATUS; -+ -+#ifdef REMOVE_PACK -+#pragma pack() -+#endif -+ -+/* include "odm_function.h" */ -+ -+/* 3 =========================================================== */ -+/* 3 DIG */ -+/* 3 =========================================================== */ -+ -+/* Remove DIG by Yuchen */ -+ -+/* 3 =========================================================== */ -+/* 3 AGC RX High Power Mode */ -+/* 3 =========================================================== */ -+#define LNA_Low_Gain_1 0x64 -+#define LNA_Low_Gain_2 0x5A -+#define LNA_Low_Gain_3 0x58 -+ -+#define FA_RXHP_TH1 5000 -+#define FA_RXHP_TH2 1500 -+#define FA_RXHP_TH3 800 -+#define FA_RXHP_TH4 600 -+#define FA_RXHP_TH5 500 -+ -+/* 3 =========================================================== */ -+/* 3 EDCA */ -+/* 3 =========================================================== */ -+ -+/* 3 =========================================================== */ -+/* 3 Dynamic Tx Power */ -+/* 3 =========================================================== */ -+/* Dynamic Tx Power Control Threshold */ -+ -+/* 3 =========================================================== */ -+/* 3 Rate Adaptive */ -+/* 3 =========================================================== */ -+#define DM_RATR_STA_INIT 0 -+#define DM_RATR_STA_HIGH 1 -+#define DM_RATR_STA_MIDDLE 2 -+#define DM_RATR_STA_LOW 3 -+ -+/* 3 =========================================================== */ -+/* 3 BB Power Save */ -+/* 3 =========================================================== */ -+ -+typedef enum tag_1R_CCA_Type_Definition { -+ CCA_1R = 0, -+ CCA_2R = 1, -+ CCA_MAX = 2, -+} DM_1R_CCA_E; -+ -+typedef enum tag_RF_Type_Definition { -+ RF_Save = 0, -+ RF_Normal = 1, -+ RF_MAX = 2, -+} DM_RF_E; -+ -+/* 3 =========================================================== */ -+/* 3 Antenna Diversity */ -+/* 3 =========================================================== */ -+typedef enum tag_SW_Antenna_Switch_Definition { -+ Antenna_A = 1, -+ Antenna_B = 2, -+ Antenna_MAX = 3, -+} DM_SWAS_E; -+ -+ -+/* Maximal number of antenna detection mechanism needs to perform, added by Roger, 2011.12.28. */ -+#define MAX_ANTENNA_DETECTION_CNT 10 -+ -+/* */ -+/* Extern Global Variables. */ -+/* */ -+extern u32 OFDMSwingTable[OFDM_TABLE_SIZE]; -+extern u8 CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; -+extern u8 CCKSwingTable_Ch14[CCK_TABLE_SIZE][8]; -+ -+extern u32 OFDMSwingTable_New[OFDM_TABLE_SIZE]; -+extern u8 CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; -+extern u8 CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]; -+ -+extern u32 TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; -+ -+/* */ -+/* check Sta pointer valid or not */ -+/* */ -+#define IS_STA_VALID(pSta) (pSta) -+/* 20100514 Joseph: Add definition for antenna switching test after link. */ -+/* This indicates two different the steps. */ -+/* In SWAW_STEP_PEAK, driver needs to switch antenna and listen to the signal on the air. */ -+/* In SWAW_STEP_DETERMINE, driver just compares the signal captured in SWAW_STEP_PEAK */ -+/* with original RSSI to determine if it is necessary to switch antenna. */ -+#define SWAW_STEP_PEAK 0 -+#define SWAW_STEP_DETERMINE 1 -+ -+/* Remove DIG by yuchen */ -+ -+void ODM_SetAntenna(PDM_ODM_T pDM_Odm, u8 Antenna); -+ -+ -+/* Remove BB power saving by Yuchen */ -+ -+#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck -+void ODM_TXPowerTrackingCheck(PDM_ODM_T pDM_Odm); -+ -+bool ODM_RAStateCheck( -+ PDM_ODM_T pDM_Odm, -+ s32 RSSI, -+ bool bForceUpdate, -+ u8 *pRATRState -+); -+ -+#define dm_SWAW_RSSI_Check ODM_SwAntDivChkPerPktRssi -+void ODM_SwAntDivChkPerPktRssi( -+ PDM_ODM_T pDM_Odm, -+ u8 StationID, -+ PODM_PHY_INFO_T pPhyInfo -+); -+ -+u32 ODM_Get_Rate_Bitmap( -+ PDM_ODM_T pDM_Odm, -+ u32 macid, -+ u32 ra_mask, -+ u8 rssi_level -+); -+ -+#if (BEAMFORMING_SUPPORT == 1) -+BEAMFORMING_CAP Beamforming_GetEntryBeamCapByMacId(PMGNT_INFO pMgntInfo, u8 MacId); -+#endif -+ -+void odm_TXPowerTrackingInit(PDM_ODM_T pDM_Odm); -+ -+void ODM_DMInit(PDM_ODM_T pDM_Odm); -+ -+void ODM_DMWatchdog(PDM_ODM_T pDM_Odm); /* For common use in the future */ -+ -+void ODM_CmnInfoInit(PDM_ODM_T pDM_Odm, ODM_CMNINFO_E CmnInfo, u32 Value); -+ -+void ODM_CmnInfoHook(PDM_ODM_T pDM_Odm, ODM_CMNINFO_E CmnInfo, void *pValue); -+ -+void ODM_CmnInfoPtrArrayHook( -+ PDM_ODM_T pDM_Odm, -+ ODM_CMNINFO_E CmnInfo, -+ u16 Index, -+ void *pValue -+); -+ -+void ODM_CmnInfoUpdate(PDM_ODM_T pDM_Odm, u32 CmnInfo, u64 Value); -+ -+void ODM_InitAllTimers(PDM_ODM_T pDM_Odm); -+ -+void ODM_CancelAllTimers(PDM_ODM_T pDM_Odm); -+ -+void ODM_ReleaseAllTimers(PDM_ODM_T pDM_Odm); -+ -+void ODM_AntselStatistics_88C( -+ PDM_ODM_T pDM_Odm, -+ u8 MacId, -+ u32 PWDBAll, -+ bool isCCKrate -+); -+ -+void ODM_DynamicARFBSelect(PDM_ODM_T pDM_Odm, u8 rate, bool Collision_State); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_HWConfig.c linux/3rdparty/rtl8723bs/hal/odm_HWConfig.c ---- linux.old/3rdparty/rtl8723bs/hal/odm_HWConfig.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_HWConfig.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,535 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+#define READ_AND_CONFIG_MP(ic, txt) (ODM_ReadAndConfig_MP_##ic##txt(pDM_Odm)) -+#define READ_AND_CONFIG READ_AND_CONFIG_MP -+#define GET_VERSION_MP(ic, txt) (ODM_GetVersion_MP_##ic##txt()) -+#define GET_VERSION(ic, txt) (pDM_Odm->bIsMPChip?GET_VERSION_MP(ic, txt):GET_VERSION_TC(ic, txt)) -+ -+static u8 odm_QueryRxPwrPercentage(s8 AntPower) -+{ -+ if ((AntPower <= -100) || (AntPower >= 20)) -+ return 0; -+ else if (AntPower >= 0) -+ return 100; -+ else -+ return (100+AntPower); -+ -+} -+ -+static s32 odm_SignalScaleMapping_92CSeries(PDM_ODM_T pDM_Odm, s32 CurrSig) -+{ -+ s32 RetSig = 0; -+ -+ if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) { -+ if (CurrSig >= 51 && CurrSig <= 100) -+ RetSig = 100; -+ else if (CurrSig >= 41 && CurrSig <= 50) -+ RetSig = 80 + ((CurrSig - 40)*2); -+ else if (CurrSig >= 31 && CurrSig <= 40) -+ RetSig = 66 + (CurrSig - 30); -+ else if (CurrSig >= 21 && CurrSig <= 30) -+ RetSig = 54 + (CurrSig - 20); -+ else if (CurrSig >= 10 && CurrSig <= 20) -+ RetSig = 42 + (((CurrSig - 10) * 2) / 3); -+ else if (CurrSig >= 5 && CurrSig <= 9) -+ RetSig = 22 + (((CurrSig - 5) * 3) / 2); -+ else if (CurrSig >= 1 && CurrSig <= 4) -+ RetSig = 6 + (((CurrSig - 1) * 3) / 2); -+ else -+ RetSig = CurrSig; -+ } -+ -+ return RetSig; -+} -+ -+s32 odm_SignalScaleMapping(PDM_ODM_T pDM_Odm, s32 CurrSig) -+{ -+ return odm_SignalScaleMapping_92CSeries(pDM_Odm, CurrSig); -+} -+ -+static u8 odm_EVMdbToPercentage(s8 Value) -+{ -+ /* */ -+ /* -33dB~0dB to 0%~99% */ -+ /* */ -+ s8 ret_val; -+ -+ ret_val = Value; -+ ret_val /= 2; -+ -+ /* DbgPrint("Value =%d\n", Value); */ -+ /* ODM_RT_DISP(FRX, RX_PHY_SQ, ("EVMdbToPercentage92C Value =%d / %x\n", ret_val, ret_val)); */ -+ -+ if (ret_val >= 0) -+ ret_val = 0; -+ if (ret_val <= -33) -+ ret_val = -33; -+ -+ ret_val = 0 - ret_val; -+ ret_val *= 3; -+ -+ if (ret_val == 99) -+ ret_val = 100; -+ -+ return ret_val; -+} -+ -+static void odm_RxPhyStatus92CSeries_Parsing( -+ PDM_ODM_T pDM_Odm, -+ PODM_PHY_INFO_T pPhyInfo, -+ u8 *pPhyStatus, -+ PODM_PACKET_INFO_T pPktinfo -+) -+{ -+ u8 i, Max_spatial_stream; -+ s8 rx_pwr[4], rx_pwr_all = 0; -+ u8 EVM, PWDB_ALL = 0, PWDB_ALL_BT; -+ u8 RSSI, total_rssi = 0; -+ bool isCCKrate = false; -+ u8 rf_rx_num = 0; -+ u8 cck_highpwr = 0; -+ u8 LNA_idx, VGA_idx; -+ PPHY_STATUS_RPT_8192CD_T pPhyStaRpt = (PPHY_STATUS_RPT_8192CD_T)pPhyStatus; -+ -+ isCCKrate = (pPktinfo->DataRate <= DESC_RATE11M) ? true : false; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = -1; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; -+ -+ -+ if (isCCKrate) { -+ u8 cck_agc_rpt; -+ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; -+ /* */ -+ /* (1)Hardware does not provide RSSI for CCK */ -+ /* (2)PWDB, Average PWDB cacluated by hardware (for rate adaptive) */ -+ /* */ -+ -+ /* if (pHalData->eRFPowerState == eRfOn) */ -+ cck_highpwr = pDM_Odm->bCckHighPower; -+ /* else */ -+ /* cck_highpwr = false; */ -+ -+ cck_agc_rpt = pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a ; -+ -+ /* 2011.11.28 LukeLee: 88E use different LNA & VGA gain table */ -+ /* The RSSI formula should be modified according to the gain table */ -+ /* In 88E, cck_highpwr is always set to 1 */ -+ LNA_idx = ((cck_agc_rpt & 0xE0)>>5); -+ VGA_idx = (cck_agc_rpt & 0x1F); -+ rx_pwr_all = odm_CCKRSSI_8723B(LNA_idx, VGA_idx); -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ if (PWDB_ALL > 100) -+ PWDB_ALL = 100; -+ -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+ /* */ -+ /* (3) Get Signal Quality (EVM) */ -+ /* */ -+ /* if (pPktinfo->bPacketMatchBSSID) */ -+ { -+ u8 SQ, SQ_rpt; -+ -+ if (pPhyInfo->RxPWDBAll > 40 && !pDM_Odm->bInHctTest) -+ SQ = 100; -+ else { -+ SQ_rpt = pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all; -+ -+ if (SQ_rpt > 64) -+ SQ = 0; -+ else if (SQ_rpt < 20) -+ SQ = 100; -+ else -+ SQ = ((64-SQ_rpt) * 100) / 44; -+ -+ } -+ -+ /* DbgPrint("cck SQ = %d\n", SQ); */ -+ pPhyInfo->SignalQuality = SQ; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = SQ; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; -+ } -+ } else { /* is OFDM rate */ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; -+ -+ /* */ -+ /* (1)Get RSSI for HT rate */ -+ /* */ -+ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) { -+ /* 2008/01/30 MH we will judge RF RX path now. */ -+ if (pDM_Odm->RFPathRxEnable & BIT(i)) -+ rf_rx_num++; -+ /* else */ -+ /* continue; */ -+ -+ rx_pwr[i] = ((pPhyStaRpt->path_agc[i].gain&0x3F)*2) - 110; -+ -+ -+ pPhyInfo->RxPwr[i] = rx_pwr[i]; -+ -+ /* Translate DBM to percentage. */ -+ RSSI = odm_QueryRxPwrPercentage(rx_pwr[i]); -+ total_rssi += RSSI; -+ /* RT_DISP(FRX, RX_PHY_SS, ("RF-%d RXPWR =%x RSSI =%d\n", i, rx_pwr[i], RSSI)); */ -+ -+ pPhyInfo->RxMIMOSignalStrength[i] = (u8) RSSI; -+ -+ /* Get Rx snr value in DB */ -+ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = (s32)(pPhyStaRpt->path_rxsnr[i]/2); -+ } -+ -+ -+ /* */ -+ /* (2)PWDB, Average PWDB cacluated by hardware (for rate adaptive) */ -+ /* */ -+ rx_pwr_all = (((pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all) >> 1)&0x7f)-110; -+ -+ PWDB_ALL_BT = PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ /* RT_DISP(FRX, RX_PHY_SS, ("PWDB_ALL =%d\n", PWDB_ALL)); */ -+ -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+ /* ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("ODM OFDM RSSI =%d\n", pPhyInfo->RxPWDBAll)); */ -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL_BT; -+ pPhyInfo->RxPower = rx_pwr_all; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+ -+ {/* pMgntInfo->CustomerID != RT_CID_819x_Lenovo */ -+ /* */ -+ /* (3)EVM of HT rate */ -+ /* */ -+ if (pPktinfo->DataRate >= DESC_RATEMCS8 && pPktinfo->DataRate <= DESC_RATEMCS15) -+ Max_spatial_stream = 2; /* both spatial stream make sense */ -+ else -+ Max_spatial_stream = 1; /* only spatial stream 1 makes sense */ -+ -+ for (i = 0; i < Max_spatial_stream; i++) { -+ /* Do not use shift operation like "rx_evmX >>= 1" because the compilor of free build environment */ -+ /* fill most significant bit to "zero" when doing shifting operation which may change a negative */ -+ /* value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore. */ -+ EVM = odm_EVMdbToPercentage((pPhyStaRpt->stream_rxevm[i])); /* dbm */ -+ -+ /* RT_DISP(FRX, RX_PHY_SQ, ("RXRATE =%x RXEVM =%x EVM =%s%d\n", */ -+ /* GET_RX_STATUS_DESC_RX_MCS(pDesc), pDrvInfo->rxevm[i], "%", EVM)); */ -+ -+ /* if (pPktinfo->bPacketMatchBSSID) */ -+ { -+ if (i == ODM_RF_PATH_A) /* Fill value in RFD, Get the first spatial stream only */ -+ pPhyInfo->SignalQuality = (u8)(EVM & 0xff); -+ -+ pPhyInfo->RxMIMOSignalQuality[i] = (u8)(EVM & 0xff); -+ } -+ } -+ } -+ -+ ODM_ParsingCFO(pDM_Odm, pPktinfo, pPhyStaRpt->path_cfotail); -+ -+ } -+ -+ /* UI BSS List signal strength(in percentage), make it good looking, from 0~100. */ -+ /* It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp(). */ -+ if (isCCKrate) { -+#ifdef CONFIG_SKIP_SIGNAL_SCALE_MAPPING -+ pPhyInfo->SignalStrength = (u8)PWDB_ALL; -+#else -+ pPhyInfo->SignalStrength = (u8)(odm_SignalScaleMapping(pDM_Odm, PWDB_ALL));/* PWDB_ALL; */ -+#endif -+ } else { -+ if (rf_rx_num != 0) { -+#ifdef CONFIG_SKIP_SIGNAL_SCALE_MAPPING -+ total_rssi /= rf_rx_num; -+ pPhyInfo->SignalStrength = (u8)total_rssi; -+#else -+ pPhyInfo->SignalStrength = (u8)(odm_SignalScaleMapping(pDM_Odm, total_rssi /= rf_rx_num)); -+#endif -+ } -+ } -+ -+ /* DbgPrint("isCCKrate = %d, pPhyInfo->RxPWDBAll = %d, pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a = 0x%x\n", */ -+ /* isCCKrate, pPhyInfo->RxPWDBAll, pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a); */ -+} -+ -+static void odm_Process_RSSIForDM( -+ PDM_ODM_T pDM_Odm, PODM_PHY_INFO_T pPhyInfo, PODM_PACKET_INFO_T pPktinfo -+) -+{ -+ -+ s32 UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK, UndecoratedSmoothedOFDM, RSSI_Ave; -+ u8 isCCKrate = 0; -+ u8 RSSI_max, RSSI_min, i; -+ u32 OFDM_pkt = 0; -+ u32 Weighting = 0; -+ PSTA_INFO_T pEntry; -+ -+ -+ if (pPktinfo->StationID == 0xFF) -+ return; -+ -+ pEntry = pDM_Odm->pODM_StaInfo[pPktinfo->StationID]; -+ -+ if (!IS_STA_VALID(pEntry)) -+ return; -+ -+ if ((!pPktinfo->bPacketMatchBSSID)) -+ return; -+ -+ if (pPktinfo->bPacketBeacon) -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt++; -+ -+ isCCKrate = ((pPktinfo->DataRate <= DESC_RATE11M)) ? true : false; -+ pDM_Odm->RxRate = pPktinfo->DataRate; -+ -+ /* Statistic for antenna/path diversity------------------ */ -+ if (pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) { -+ -+ } -+ -+ /* Smart Antenna Debug Message------------------ */ -+ -+ UndecoratedSmoothedCCK = pEntry->rssi_stat.UndecoratedSmoothedCCK; -+ UndecoratedSmoothedOFDM = pEntry->rssi_stat.UndecoratedSmoothedOFDM; -+ UndecoratedSmoothedPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ if (pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon) { -+ -+ if (!isCCKrate) { /* ofdm rate */ -+ if (pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B] == 0) { -+ RSSI_Ave = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_B = 0; -+ } else { -+ /* DbgPrint("pRfd->Status.RxMIMOSignalStrength[0] = %d, pRfd->Status.RxMIMOSignalStrength[1] = %d\n", */ -+ /* pRfd->Status.RxMIMOSignalStrength[0], pRfd->Status.RxMIMOSignalStrength[1]); */ -+ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ -+ if ( -+ pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A] > -+ pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B] -+ ) { -+ RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ } else { -+ RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ } -+ -+ if ((RSSI_max-RSSI_min) < 3) -+ RSSI_Ave = RSSI_max; -+ else if ((RSSI_max-RSSI_min) < 6) -+ RSSI_Ave = RSSI_max - 1; -+ else if ((RSSI_max-RSSI_min) < 10) -+ RSSI_Ave = RSSI_max - 2; -+ else -+ RSSI_Ave = RSSI_max - 3; -+ } -+ -+ /* 1 Process OFDM RSSI */ -+ if (UndecoratedSmoothedOFDM <= 0) /* initialize */ -+ UndecoratedSmoothedOFDM = pPhyInfo->RxPWDBAll; -+ else { -+ if (pPhyInfo->RxPWDBAll > (u32)UndecoratedSmoothedOFDM) { -+ UndecoratedSmoothedOFDM = -+ ((UndecoratedSmoothedOFDM*(Rx_Smooth_Factor-1)) + -+ RSSI_Ave)/Rx_Smooth_Factor; -+ UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM + 1; -+ } else { -+ UndecoratedSmoothedOFDM = -+ ((UndecoratedSmoothedOFDM*(Rx_Smooth_Factor-1)) + -+ RSSI_Ave)/Rx_Smooth_Factor; -+ } -+ } -+ -+ pEntry->rssi_stat.PacketMap = (pEntry->rssi_stat.PacketMap<<1) | BIT0; -+ -+ } else { -+ RSSI_Ave = pPhyInfo->RxPWDBAll; -+ pDM_Odm->RSSI_A = (u8) pPhyInfo->RxPWDBAll; -+ pDM_Odm->RSSI_B = 0; -+ -+ /* 1 Process CCK RSSI */ -+ if (UndecoratedSmoothedCCK <= 0) /* initialize */ -+ UndecoratedSmoothedCCK = pPhyInfo->RxPWDBAll; -+ else { -+ if (pPhyInfo->RxPWDBAll > (u32)UndecoratedSmoothedCCK) { -+ UndecoratedSmoothedCCK = -+ ((UndecoratedSmoothedCCK*(Rx_Smooth_Factor-1)) + -+ pPhyInfo->RxPWDBAll)/Rx_Smooth_Factor; -+ UndecoratedSmoothedCCK = UndecoratedSmoothedCCK + 1; -+ } else { -+ UndecoratedSmoothedCCK = -+ ((UndecoratedSmoothedCCK*(Rx_Smooth_Factor-1)) + -+ pPhyInfo->RxPWDBAll)/Rx_Smooth_Factor; -+ } -+ } -+ pEntry->rssi_stat.PacketMap = pEntry->rssi_stat.PacketMap<<1; -+ } -+ -+ /* if (pEntry) */ -+ { -+ /* 2011.07.28 LukeLee: modified to prevent unstable CCK RSSI */ -+ if (pEntry->rssi_stat.ValidBit >= 64) -+ pEntry->rssi_stat.ValidBit = 64; -+ else -+ pEntry->rssi_stat.ValidBit++; -+ -+ for (i = 0; i < pEntry->rssi_stat.ValidBit; i++) -+ OFDM_pkt += (u8)(pEntry->rssi_stat.PacketMap>>i)&BIT0; -+ -+ if (pEntry->rssi_stat.ValidBit == 64) { -+ Weighting = ((OFDM_pkt<<4) > 64)?64:(OFDM_pkt<<4); -+ UndecoratedSmoothedPWDB = (Weighting*UndecoratedSmoothedOFDM+(64-Weighting)*UndecoratedSmoothedCCK)>>6; -+ } else { -+ if (pEntry->rssi_stat.ValidBit != 0) -+ UndecoratedSmoothedPWDB = (OFDM_pkt*UndecoratedSmoothedOFDM+(pEntry->rssi_stat.ValidBit-OFDM_pkt)*UndecoratedSmoothedCCK)/pEntry->rssi_stat.ValidBit; -+ else -+ UndecoratedSmoothedPWDB = 0; -+ } -+ -+ pEntry->rssi_stat.UndecoratedSmoothedCCK = UndecoratedSmoothedCCK; -+ pEntry->rssi_stat.UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM; -+ pEntry->rssi_stat.UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; -+ -+ /* DbgPrint("OFDM_pkt =%d, Weighting =%d\n", OFDM_pkt, Weighting); */ -+ /* DbgPrint("UndecoratedSmoothedOFDM =%d, UndecoratedSmoothedPWDB =%d, UndecoratedSmoothedCCK =%d\n", */ -+ /* UndecoratedSmoothedOFDM, UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK); */ -+ -+ } -+ -+ } -+} -+ -+ -+/* */ -+/* Endianness before calling this API */ -+/* */ -+static void ODM_PhyStatusQuery_92CSeries( -+ PDM_ODM_T pDM_Odm, -+ PODM_PHY_INFO_T pPhyInfo, -+ u8 *pPhyStatus, -+ PODM_PACKET_INFO_T pPktinfo -+) -+{ -+ -+ odm_RxPhyStatus92CSeries_Parsing(pDM_Odm, pPhyInfo, pPhyStatus, pPktinfo); -+ -+ if (!pDM_Odm->RSSI_test) -+ odm_Process_RSSIForDM(pDM_Odm, pPhyInfo, pPktinfo); -+} -+ -+void ODM_PhyStatusQuery( -+ PDM_ODM_T pDM_Odm, -+ PODM_PHY_INFO_T pPhyInfo, -+ u8 *pPhyStatus, -+ PODM_PACKET_INFO_T pPktinfo -+) -+{ -+ -+ ODM_PhyStatusQuery_92CSeries(pDM_Odm, pPhyInfo, pPhyStatus, pPktinfo); -+} -+ -+/* */ -+/* If you want to add a new IC, Please follow below template and generate a new one. */ -+/* */ -+/* */ -+ -+HAL_STATUS ODM_ConfigRFWithHeaderFile( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_Config_Type ConfigType, -+ ODM_RF_RADIO_PATH_E eRFPath -+) -+{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("===>ODM_ConfigRFWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); -+ -+ if (ConfigType == CONFIG_RF_RADIO) -+ READ_AND_CONFIG(8723B, _RadioA); -+ else if (ConfigType == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG(8723B, _TXPWR_LMT); -+ -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS ODM_ConfigRFWithTxPwrTrackHeaderFile(PDM_ODM_T pDM_Odm) -+{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("===>ODM_ConfigRFWithTxPwrTrackHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); -+ -+ if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG(8723B, _TxPowerTrack_SDIO); -+ -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS ODM_ConfigBBWithHeaderFile( -+ PDM_ODM_T pDM_Odm, ODM_BB_Config_Type ConfigType -+) -+{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("===>ODM_ConfigBBWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); -+ -+ if (ConfigType == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG(8723B, _PHY_REG); -+ else if (ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG(8723B, _AGC_TAB); -+ else if (ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG(8723B, _PHY_REG_PG); -+ -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS ODM_ConfigMACWithHeaderFile(PDM_ODM_T pDM_Odm) -+{ -+ u8 result = HAL_STATUS_SUCCESS; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_LOUD, -+ ( -+ "===>ODM_ConfigMACWithHeaderFile (%s)\n", -+ (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip" -+ ) -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_LOUD, -+ ( -+ "pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, -+ pDM_Odm->SupportInterface, -+ pDM_Odm->BoardType -+ ) -+ ); -+ -+ READ_AND_CONFIG(8723B, _MAC_REG); -+ -+ return result; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_HWConfig.h linux/3rdparty/rtl8723bs/hal/odm_HWConfig.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_HWConfig.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_HWConfig.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,162 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __HALHWOUTSRC_H__ -+#define __HALHWOUTSRC_H__ -+ -+ -+/*--------------------------Define -------------------------------------------*/ -+/* define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while (0) */ -+#define AGC_DIFF_CONFIG_MP(ic, band) (ODM_ReadAndConfig_MP_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_MP_##ic##_AGC_TAB_DIFF_##band, \ -+ sizeof(Array_MP_##ic##_AGC_TAB_DIFF_##band)/sizeof(u32))) -+#define AGC_DIFF_CONFIG_TC(ic, band) (ODM_ReadAndConfig_TC_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_TC_##ic##_AGC_TAB_DIFF_##band, \ -+ sizeof(Array_TC_##ic##_AGC_TAB_DIFF_##band)/sizeof(u32))) -+ -+#define AGC_DIFF_CONFIG(ic, band)\ -+ do {\ -+ if (pDM_Odm->bIsMPChip)\ -+ AGC_DIFF_CONFIG_MP(ic, band);\ -+ else\ -+ AGC_DIFF_CONFIG_TC(ic, band);\ -+ } while (0) -+ -+ -+/* */ -+/* structure and define */ -+/* */ -+ -+typedef struct _Phy_Rx_AGC_Info { -+ #if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 gain:7, trsw:1; -+ #else -+ u8 trsw:1, gain:7; -+ #endif -+} PHY_RX_AGC_INFO_T, *pPHY_RX_AGC_INFO_T; -+ -+typedef struct _Phy_Status_Rpt_8192cd { -+ PHY_RX_AGC_INFO_T path_agc[2]; -+ u8 ch_corr[2]; -+ u8 cck_sig_qual_ofdm_pwdb_all; -+ u8 cck_agc_rpt_ofdm_cfosho_a; -+ u8 cck_rpt_b_ofdm_cfosho_b; -+ u8 rsvd_1;/* ch_corr_msb; */ -+ u8 noise_power_db_msb; -+ s8 path_cfotail[2]; -+ u8 pcts_mask[2]; -+ s8 stream_rxevm[2]; -+ u8 path_rxsnr[2]; -+ u8 noise_power_db_lsb; -+ u8 rsvd_2[3]; -+ u8 stream_csi[2]; -+ u8 stream_target_csi[2]; -+ s8 sig_evm; -+ u8 rsvd_3; -+ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antsel_rx_keep_2:1; /* ex_intf_flg:1; */ -+ u8 sgi_en:1; -+ u8 rxsc:2; -+ u8 idle_long:1; -+ u8 r_ant_train_en:1; -+ u8 ant_sel_b:1; -+ u8 ant_sel:1; -+#else /* _BIG_ENDIAN_ */ -+ u8 ant_sel:1; -+ u8 ant_sel_b:1; -+ u8 r_ant_train_en:1; -+ u8 idle_long:1; -+ u8 rxsc:2; -+ u8 sgi_en:1; -+ u8 antsel_rx_keep_2:1; /* ex_intf_flg:1; */ -+#endif -+} PHY_STATUS_RPT_8192CD_T, *PPHY_STATUS_RPT_8192CD_T; -+ -+ -+typedef struct _Phy_Status_Rpt_8812 { -+ /* 2012.05.24 LukeLee: This structure should take big/little endian in consideration later..... */ -+ -+ /* DWORD 0 */ -+ u8 gain_trsw[2]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u16 chl_num:10; -+ u16 sub_chnl:4; -+ u16 r_RFMOD:2; -+#else /* _BIG_ENDIAN_ */ -+ u16 r_RFMOD:2; -+ u16 sub_chnl:4; -+ u16 chl_num:10; -+#endif -+ -+ /* DWORD 1 */ -+ u8 pwdb_all; -+ u8 cfosho[4]; /* DW 1 byte 1 DW 2 byte 0 */ -+ -+ /* DWORD 2 */ -+ s8 cfotail[4]; /* DW 2 byte 1 DW 3 byte 0 */ -+ -+ /* DWORD 3 */ -+ s8 rxevm[2]; /* DW 3 byte 1 DW 3 byte 2 */ -+ s8 rxsnr[2]; /* DW 3 byte 3 DW 4 byte 0 */ -+ -+ /* DWORD 4 */ -+ u8 PCTS_MSK_RPT[2]; -+ u8 pdsnr[2]; /* DW 4 byte 3 DW 5 Byte 0 */ -+ -+ /* DWORD 5 */ -+ u8 csi_current[2]; -+ u8 rx_gain_c; -+ -+ /* DWORD 6 */ -+ u8 rx_gain_d; -+ s8 sigevm; -+ u8 resvd_0; -+ u8 antidx_anta:3; -+ u8 antidx_antb:3; -+ u8 resvd_1:2; -+} PHY_STATUS_RPT_8812_T, *PPHY_STATUS_RPT_8812_T; -+ -+ -+void ODM_PhyStatusQuery( -+ PDM_ODM_T pDM_Odm, -+ PODM_PHY_INFO_T pPhyInfo, -+ u8 *pPhyStatus, -+ PODM_PACKET_INFO_T pPktinfo -+); -+ -+HAL_STATUS ODM_ConfigRFWithTxPwrTrackHeaderFile(PDM_ODM_T pDM_Odm); -+ -+HAL_STATUS ODM_ConfigRFWithHeaderFile( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_Config_Type ConfigType, -+ ODM_RF_RADIO_PATH_E eRFPath -+); -+ -+HAL_STATUS ODM_ConfigBBWithHeaderFile( -+ PDM_ODM_T pDM_Odm, ODM_BB_Config_Type ConfigType -+); -+ -+HAL_STATUS ODM_ConfigMACWithHeaderFile(PDM_ODM_T pDM_Odm); -+ -+HAL_STATUS ODM_ConfigFWWithHeaderFile( -+ PDM_ODM_T pDM_Odm, -+ ODM_FW_Config_Type ConfigType, -+ u8 *pFirmware, -+ u32 *pSize -+); -+ -+s32 odm_SignalScaleMapping(PDM_ODM_T pDM_Odm, s32 CurrSig); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_interface.h linux/3rdparty/rtl8723bs/hal/odm_interface.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_interface.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_interface.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,59 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __ODM_INTERFACE_H__ -+#define __ODM_INTERFACE_H__ -+ -+ -+ -+/* =========== Constant/Structure/Enum/... Define */ -+ -+/* =========== Macro Define */ -+ -+#define _reg_all(_name) ODM_##_name -+#define _reg_ic(_name, _ic) ODM_##_name##_ic -+#define _bit_all(_name) BIT_##_name -+#define _bit_ic(_name, _ic) BIT_##_name##_ic -+ -+/*=================================== -+ -+#define ODM_REG_DIG_11N 0xC50 -+#define ODM_REG_DIG_11AC 0xDDD -+ -+ODM_REG(DIG, _pDM_Odm) -+=====================================*/ -+ -+#define _reg_11N(_name) ODM_REG_##_name##_11N -+#define _bit_11N(_name) ODM_BIT_##_name##_11N -+ -+#define _cat(_name, _ic_type, _func) _func##_11N(_name) -+ -+/* _name: name of register or bit. */ -+/* Example: "ODM_REG(R_A_AGC_CORE1, pDM_Odm)" */ -+/* gets "ODM_R_A_AGC_CORE1" or "ODM_R_A_AGC_CORE1_8192C", depends on SupportICType. */ -+#define ODM_REG(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _reg) -+#define ODM_BIT(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _bit) -+ -+typedef enum _ODM_H2C_CMD { -+ ODM_H2C_RSSI_REPORT = 0, -+ ODM_H2C_PSD_RESULT = 1, -+ ODM_H2C_PathDiv = 2, -+ ODM_H2C_WIFI_CALIBRATION = 3, -+ ODM_MAX_H2CCMD -+} ODM_H2C_CMD; -+ -+ -+#endif /* __ODM_INTERFACE_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_NoiseMonitor.c linux/3rdparty/rtl8723bs/hal/odm_NoiseMonitor.c ---- linux.old/3rdparty/rtl8723bs/hal/odm_NoiseMonitor.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_NoiseMonitor.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,175 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+/* This function is for inband noise test utility only */ -+/* To obtain the inband noise level(dbm), do the following. */ -+/* 1. disable DIG and Power Saving */ -+/* 2. Set initial gain = 0x1a */ -+/* 3. Stop updating idle time pwer report (for driver read) */ -+/* - 0x80c[25] */ -+ -+#define Valid_Min -35 -+#define Valid_Max 10 -+#define ValidCnt 5 -+ -+static s16 odm_InbandNoise_Monitor_NSeries( -+ PDM_ODM_T pDM_Odm, -+ u8 bPauseDIG, -+ u8 IGIValue, -+ u32 max_time -+) -+{ -+ u32 tmp4b; -+ u8 max_rf_path = 0, rf_path; -+ u8 reg_c50, reg_c58, valid_done = 0; -+ struct noise_level noise_data; -+ u32 start = 0, func_start = 0, func_end = 0; -+ -+ func_start = jiffies; -+ pDM_Odm->noise_level.noise_all = 0; -+ -+ if ((pDM_Odm->RFType == ODM_1T2R) || (pDM_Odm->RFType == ODM_2T2R)) -+ max_rf_path = 2; -+ else -+ max_rf_path = 1; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_DebugControlInbandNoise_Nseries() ==>\n")); -+ -+ memset(&noise_data, 0, sizeof(struct noise_level)); -+ -+ /* */ -+ /* Step 1. Disable DIG && Set initial gain. */ -+ /* */ -+ -+ if (bPauseDIG) -+ odm_PauseDIG(pDM_Odm, ODM_PAUSE_DIG, IGIValue); -+ /* */ -+ /* Step 2. Disable all power save for read registers */ -+ /* */ -+ /* dcmd_DebugControlPowerSave(padapter, PSDisable); */ -+ -+ /* */ -+ /* Step 3. Get noise power level */ -+ /* */ -+ start = jiffies; -+ while (1) { -+ -+ /* Stop updating idle time pwer report (for driver read) */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_TxGainStage, BIT25, 1); -+ -+ /* Read Noise Floor Report */ -+ tmp4b = PHY_QueryBBReg(pDM_Odm->Adapter, 0x8f8, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Noise Floor Report (0x8f8) = 0x%08x\n", tmp4b)); -+ -+ /* PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XAAGCCore1, bMaskByte0, TestInitialGain); */ -+ /* if (max_rf_path == 2) */ -+ /* PHY_SetBBReg(pDM_Odm->Adapter, rOFDM0_XBAGCCore1, bMaskByte0, TestInitialGain); */ -+ -+ /* update idle time pwer report per 5us */ -+ PHY_SetBBReg(pDM_Odm->Adapter, rFPGA0_TxGainStage, BIT25, 0); -+ -+ noise_data.value[ODM_RF_PATH_A] = (u8)(tmp4b&0xff); -+ noise_data.value[ODM_RF_PATH_B] = (u8)((tmp4b&0xff00)>>8); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("value_a = 0x%x(%d), value_b = 0x%x(%d)\n", -+ noise_data.value[ODM_RF_PATH_A], noise_data.value[ODM_RF_PATH_A], noise_data.value[ODM_RF_PATH_B], noise_data.value[ODM_RF_PATH_B])); -+ -+ for (rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) { -+ noise_data.sval[rf_path] = (s8)noise_data.value[rf_path]; -+ noise_data.sval[rf_path] /= 2; -+ } -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("sval_a = %d, sval_b = %d\n", -+ noise_data.sval[ODM_RF_PATH_A], noise_data.sval[ODM_RF_PATH_B])); -+ /* mdelay(10); */ -+ /* msleep(10); */ -+ -+ for (rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) { -+ if ((noise_data.valid_cnt[rf_path] < ValidCnt) && (noise_data.sval[rf_path] < Valid_Max && noise_data.sval[rf_path] >= Valid_Min)) { -+ noise_data.valid_cnt[rf_path]++; -+ noise_data.sum[rf_path] += noise_data.sval[rf_path]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("RF_Path:%d Valid sval = %d\n", rf_path, noise_data.sval[rf_path])); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Sum of sval = %d,\n", noise_data.sum[rf_path])); -+ if (noise_data.valid_cnt[rf_path] == ValidCnt) { -+ valid_done++; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("After divided, RF_Path:%d , sum = %d\n", rf_path, noise_data.sum[rf_path])); -+ } -+ -+ } -+ -+ } -+ -+ /* printk("####### valid_done:%d #############\n", valid_done); */ -+ if ((valid_done == max_rf_path) || (jiffies_to_msecs(jiffies - start) > max_time)) { -+ for (rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) { -+ /* printk("%s PATH_%d - sum = %d, valid_cnt = %d\n", __func__, rf_path, noise_data.sum[rf_path], noise_data.valid_cnt[rf_path]); */ -+ if (noise_data.valid_cnt[rf_path]) -+ noise_data.sum[rf_path] /= noise_data.valid_cnt[rf_path]; -+ else -+ noise_data.sum[rf_path] = 0; -+ } -+ break; -+ } -+ } -+ reg_c50 = (s32)PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_XAAGCCore1, bMaskByte0); -+ reg_c50 &= ~BIT7; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("0x%x = 0x%02x(%d)\n", rOFDM0_XAAGCCore1, reg_c50, reg_c50)); -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_A] = -110 + reg_c50 + noise_data.sum[ODM_RF_PATH_A]; -+ pDM_Odm->noise_level.noise_all += pDM_Odm->noise_level.noise[ODM_RF_PATH_A]; -+ -+ if (max_rf_path == 2) { -+ reg_c58 = (s32)PHY_QueryBBReg(pDM_Odm->Adapter, rOFDM0_XBAGCCore1, bMaskByte0); -+ reg_c58 &= ~BIT7; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("0x%x = 0x%02x(%d)\n", rOFDM0_XBAGCCore1, reg_c58, reg_c58)); -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_B] = -110 + reg_c58 + noise_data.sum[ODM_RF_PATH_B]; -+ pDM_Odm->noise_level.noise_all += pDM_Odm->noise_level.noise[ODM_RF_PATH_B]; -+ } -+ pDM_Odm->noise_level.noise_all /= max_rf_path; -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_COMMON, -+ ODM_DBG_LOUD, -+ ( -+ "noise_a = %d, noise_b = %d\n", -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_A], -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_B] -+ ) -+ ); -+ -+ /* */ -+ /* Step 4. Recover the Dig */ -+ /* */ -+ if (bPauseDIG) -+ odm_PauseDIG(pDM_Odm, ODM_RESUME_DIG, IGIValue); -+ -+ func_end = jiffies_to_msecs(jiffies - func_start); -+ /* printk("%s noise_a = %d, noise_b = %d noise_all:%d (%d ms)\n", __func__, */ -+ /* pDM_Odm->noise_level.noise[ODM_RF_PATH_A], */ -+ /* pDM_Odm->noise_level.noise[ODM_RF_PATH_B], */ -+ /* pDM_Odm->noise_level.noise_all, func_end); */ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_DebugControlInbandNoise_Nseries() <==\n")); -+ return pDM_Odm->noise_level.noise_all; -+ -+} -+ -+s16 ODM_InbandNoise_Monitor(void *pDM_VOID, u8 bPauseDIG, u8 IGIValue, u32 max_time) -+{ -+ return odm_InbandNoise_Monitor_NSeries(pDM_VOID, bPauseDIG, IGIValue, max_time); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_NoiseMonitor.h linux/3rdparty/rtl8723bs/hal/odm_NoiseMonitor.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_NoiseMonitor.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_NoiseMonitor.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,47 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+#ifndef __ODMNOISEMONITOR_H__ -+#define __ODMNOISEMONITOR_H__ -+ -+#define ODM_MAX_CHANNEL_NUM 38/* 14+24 */ -+struct noise_level { -+ /* u8 value_a, value_b; */ -+ u8 value[MAX_RF_PATH]; -+ /* s8 sval_a, sval_b; */ -+ s8 sval[MAX_RF_PATH]; -+ -+ /* s32 noise_a = 0, noise_b = 0, sum_a = 0, sum_b = 0; */ -+ /* s32 noise[ODM_RF_PATH_MAX]; */ -+ s32 sum[MAX_RF_PATH]; -+ /* u8 valid_cnt_a = 0, valid_cnt_b = 0, */ -+ u8 valid[MAX_RF_PATH]; -+ u8 valid_cnt[MAX_RF_PATH]; -+ -+}; -+ -+ -+typedef struct _ODM_NOISE_MONITOR_ { -+ s8 noise[MAX_RF_PATH]; -+ s16 noise_all; -+} ODM_NOISE_MONITOR; -+ -+s16 ODM_InbandNoise_Monitor( -+ void *pDM_VOID, -+ u8 bPauseDIG, -+ u8 IGIValue, -+ u32 max_time -+); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_PathDiv.c linux/3rdparty/rtl8723bs/hal/odm_PathDiv.c ---- linux.old/3rdparty/rtl8723bs/hal/odm_PathDiv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_PathDiv.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,42 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+void odm_PathDiversityInit(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_PATH_DIV, -+ ODM_DBG_LOUD, -+ ("Return: Not Support PathDiv\n") -+ ); -+} -+ -+void odm_PathDiversity(void *pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_PATH_DIV, -+ ODM_DBG_LOUD, -+ ("Return: Not Support PathDiv\n") -+ ); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_PathDiv.h linux/3rdparty/rtl8723bs/hal/odm_PathDiv.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_PathDiv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_PathDiv.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODMPATHDIV_H__ -+#define __ODMPATHDIV_H__ -+ -+void -+odm_PathDiversityInit( -+ void *pDM_VOID -+ ); -+ -+void -+odm_PathDiversity( -+ void *pDM_VOID -+ ); -+ -+ #endif /* ifndef __ODMPATHDIV_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_precomp.h linux/3rdparty/rtl8723bs/hal/odm_precomp.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_precomp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_precomp.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,60 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODM_PRECOMP_H__ -+#define __ODM_PRECOMP_H__ -+ -+#include "odm_types.h" -+ -+#define TEST_FALG___ 1 -+ -+/* 2 Config Flags and Structs - defined by each ODM Type */ -+ -+ /* include */ -+ /* include */ -+ /* include */ -+ /* include */ -+ /* include */ -+#define BEAMFORMING_SUPPORT 0 -+ -+/* 2 Hardware Parameter Files */ -+ -+/* 2 OutSrc Header Files */ -+ -+#include "odm.h" -+#include "odm_HWConfig.h" -+#include "odm_debug.h" -+#include "odm_RegDefine11N.h" -+#include "odm_AntDiv.h" -+#include "odm_EdcaTurboCheck.h" -+#include "odm_DIG.h" -+#include "odm_PathDiv.h" -+#include "odm_DynamicBBPowerSaving.h" -+#include "odm_DynamicTxPower.h" -+#include "odm_CfoTracking.h" -+#include "odm_NoiseMonitor.h" -+#include "HalPhyRf.h" -+#include "HalPhyRf_8723B.h"/* for IQK, LCK, Power-tracking */ -+#include "rtl8723b_hal.h" -+#include "odm_interface.h" -+#include "odm_reg.h" -+#include "HalHWImg8723B_MAC.h" -+#include "HalHWImg8723B_RF.h" -+#include "HalHWImg8723B_BB.h" -+#include "Hal8723BReg.h" -+#include "odm_RTL8723B.h" -+#include "odm_RegConfig8723B.h" -+ -+#endif /* __ODM_PRECOMP_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_RegConfig8723B.c linux/3rdparty/rtl8723bs/hal/odm_RegConfig8723B.c ---- linux.old/3rdparty/rtl8723bs/hal/odm_RegConfig8723B.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_RegConfig8723B.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,257 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+void odm_ConfigRFReg_8723B( -+ PDM_ODM_T pDM_Odm, -+ u32 Addr, -+ u32 Data, -+ ODM_RF_RADIO_PATH_E RF_PATH, -+ u32 RegAddr -+) -+{ -+ if (Addr == 0xfe || Addr == 0xffe) -+ msleep(50); -+ else { -+ PHY_SetRFReg(pDM_Odm->Adapter, RF_PATH, RegAddr, bRFRegOffsetMask, Data); -+ /* Add 1us delay between BB/RF register setting. */ -+ udelay(1); -+ -+ /* For disable/enable test in high temperature, the B6 value will fail to fill. Suggestion by BB Stanley, 2013.06.25. */ -+ if (Addr == 0xb6) { -+ u32 getvalue = 0; -+ u8 count = 0; -+ -+ getvalue = PHY_QueryRFReg( -+ pDM_Odm->Adapter, RF_PATH, Addr, bMaskDWord -+ ); -+ -+ udelay(1); -+ -+ while ((getvalue>>8) != (Data>>8)) { -+ count++; -+ PHY_SetRFReg(pDM_Odm->Adapter, RF_PATH, RegAddr, bRFRegOffsetMask, Data); -+ udelay(1); -+ getvalue = PHY_QueryRFReg(pDM_Odm->Adapter, RF_PATH, Addr, bMaskDWord); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ "===> ODM_ConfigRFWithHeaderFile: [B6] getvalue 0x%x, Data 0x%x, count %d\n", -+ getvalue, -+ Data, -+ count -+ ) -+ ); -+ if (count > 5) -+ break; -+ } -+ } -+ -+ if (Addr == 0xb2) { -+ u32 getvalue = 0; -+ u8 count = 0; -+ -+ getvalue = PHY_QueryRFReg( -+ pDM_Odm->Adapter, RF_PATH, Addr, bMaskDWord -+ ); -+ -+ udelay(1); -+ -+ while (getvalue != Data) { -+ count++; -+ PHY_SetRFReg( -+ pDM_Odm->Adapter, -+ RF_PATH, -+ RegAddr, -+ bRFRegOffsetMask, -+ Data -+ ); -+ udelay(1); -+ /* Do LCK againg */ -+ PHY_SetRFReg( -+ pDM_Odm->Adapter, -+ RF_PATH, -+ 0x18, -+ bRFRegOffsetMask, -+ 0x0fc07 -+ ); -+ udelay(1); -+ getvalue = PHY_QueryRFReg( -+ pDM_Odm->Adapter, RF_PATH, Addr, bMaskDWord -+ ); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ "===> ODM_ConfigRFWithHeaderFile: [B2] getvalue 0x%x, Data 0x%x, count %d\n", -+ getvalue, -+ Data, -+ count -+ ) -+ ); -+ -+ if (count > 5) -+ break; -+ } -+ } -+ } -+} -+ -+ -+void odm_ConfigRF_RadioA_8723B(PDM_ODM_T pDM_Odm, u32 Addr, u32 Data) -+{ -+ u32 content = 0x1000; /* RF_Content: radioa_txt */ -+ u32 maskforPhySet = (u32)(content&0xE000); -+ -+ odm_ConfigRFReg_8723B( -+ pDM_Odm, -+ Addr, -+ Data, -+ ODM_RF_PATH_A, -+ Addr|maskforPhySet -+ ); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ "===> ODM_ConfigRFWithHeaderFile: [RadioA] %08X %08X\n", -+ Addr, -+ Data -+ ) -+ ); -+} -+ -+void odm_ConfigMAC_8723B(PDM_ODM_T pDM_Odm, u32 Addr, u8 Data) -+{ -+ rtw_write8(pDM_Odm->Adapter, Addr, Data); -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ "===> ODM_ConfigMACWithHeaderFile: [MAC_REG] %08X %08X\n", -+ Addr, -+ Data -+ ) -+ ); -+} -+ -+void odm_ConfigBB_AGC_8723B( -+ PDM_ODM_T pDM_Odm, -+ u32 Addr, -+ u32 Bitmask, -+ u32 Data -+) -+{ -+ PHY_SetBBReg(pDM_Odm->Adapter, Addr, Bitmask, Data); -+ /* Add 1us delay between BB/RF register setting. */ -+ udelay(1); -+ -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_TRACE, -+ ( -+ "===> ODM_ConfigBBWithHeaderFile: [AGC_TAB] %08X %08X\n", -+ Addr, -+ Data -+ ) -+ ); -+} -+ -+void odm_ConfigBB_PHY_REG_PG_8723B( -+ PDM_ODM_T pDM_Odm, -+ u32 Band, -+ u32 RfPath, -+ u32 TxNum, -+ u32 Addr, -+ u32 Bitmask, -+ u32 Data -+) -+{ -+ if (Addr == 0xfe || Addr == 0xffe) -+ msleep(50); -+ else { -+ PHY_StoreTxPowerByRate(pDM_Odm->Adapter, Band, RfPath, TxNum, Addr, Bitmask, Data); -+ } -+ ODM_RT_TRACE( -+ pDM_Odm, -+ ODM_COMP_INIT, -+ ODM_DBG_LOUD, -+ ( -+ "===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X %08X\n", -+ Addr, -+ Bitmask, -+ Data -+ ) -+ ); -+} -+ -+void odm_ConfigBB_PHY_8723B( -+ PDM_ODM_T pDM_Odm, -+ u32 Addr, -+ u32 Bitmask, -+ u32 Data -+) -+{ -+ if (Addr == 0xfe) -+ msleep(50); -+ else if (Addr == 0xfd) -+ mdelay(5); -+ else if (Addr == 0xfc) -+ mdelay(1); -+ else if (Addr == 0xfb) -+ udelay(50); -+ else if (Addr == 0xfa) -+ udelay(5); -+ else if (Addr == 0xf9) -+ udelay(1); -+ else { -+ PHY_SetBBReg(pDM_Odm->Adapter, Addr, Bitmask, Data); -+ } -+ -+ /* Add 1us delay between BB/RF register setting. */ -+ udelay(1); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X\n", Addr, Data)); -+} -+ -+void odm_ConfigBB_TXPWR_LMT_8723B( -+ PDM_ODM_T pDM_Odm, -+ u8 *Regulation, -+ u8 *Band, -+ u8 *Bandwidth, -+ u8 *RateSection, -+ u8 *RfPath, -+ u8 *Channel, -+ u8 *PowerLimit -+) -+{ -+ PHY_SetTxPowerLimit( -+ pDM_Odm->Adapter, -+ Regulation, -+ Band, -+ Bandwidth, -+ RateSection, -+ RfPath, -+ Channel, -+ PowerLimit -+ ); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_RegConfig8723B.h linux/3rdparty/rtl8723bs/hal/odm_RegConfig8723B.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_RegConfig8723B.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_RegConfig8723B.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,65 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __INC_ODM_REGCONFIG_H_8723B -+#define __INC_ODM_REGCONFIG_H_8723B -+ -+void odm_ConfigRFReg_8723B( -+ PDM_ODM_T pDM_Odm, -+ u32 Addr, -+ u32 Data, -+ ODM_RF_RADIO_PATH_E RF_PATH, -+ u32 RegAddr -+); -+ -+void odm_ConfigRF_RadioA_8723B(PDM_ODM_T pDM_Odm, u32 Addr, u32 Data); -+ -+void odm_ConfigMAC_8723B(PDM_ODM_T pDM_Odm, u32 Addr, u8 Data); -+ -+void odm_ConfigBB_AGC_8723B( -+ PDM_ODM_T pDM_Odm, -+ u32 Addr, -+ u32 Bitmask, -+ u32 Data -+); -+ -+void odm_ConfigBB_PHY_REG_PG_8723B( -+ PDM_ODM_T pDM_Odm, -+ u32 Band, -+ u32 RfPath, -+ u32 TxNum, -+ u32 Addr, -+ u32 Bitmask, -+ u32 Data -+); -+ -+void odm_ConfigBB_PHY_8723B( -+ PDM_ODM_T pDM_Odm, -+ u32 Addr, -+ u32 Bitmask, -+ u32 Data -+); -+ -+void odm_ConfigBB_TXPWR_LMT_8723B( -+ PDM_ODM_T pDM_Odm, -+ u8 *Regulation, -+ u8 *Band, -+ u8 *Bandwidth, -+ u8 *RateSection, -+ u8 *RfPath, -+ u8 *Channel, -+ u8 *PowerLimit -+); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_RegDefine11N.h linux/3rdparty/rtl8723bs/hal/odm_RegDefine11N.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_RegDefine11N.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_RegDefine11N.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,172 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODM_REGDEFINE11N_H__ -+#define __ODM_REGDEFINE11N_H__ -+ -+ -+/* 2 RF REG LIST */ -+#define ODM_REG_RF_MODE_11N 0x00 -+#define ODM_REG_RF_0B_11N 0x0B -+#define ODM_REG_CHNBW_11N 0x18 -+#define ODM_REG_T_METER_11N 0x24 -+#define ODM_REG_RF_25_11N 0x25 -+#define ODM_REG_RF_26_11N 0x26 -+#define ODM_REG_RF_27_11N 0x27 -+#define ODM_REG_RF_2B_11N 0x2B -+#define ODM_REG_RF_2C_11N 0x2C -+#define ODM_REG_RXRF_A3_11N 0x3C -+#define ODM_REG_T_METER_92D_11N 0x42 -+#define ODM_REG_T_METER_88E_11N 0x42 -+ -+/* 2 BB REG LIST */ -+/* PAGE 8 */ -+#define ODM_REG_BB_CTRL_11N 0x800 -+#define ODM_REG_RF_PIN_11N 0x804 -+#define ODM_REG_PSD_CTRL_11N 0x808 -+#define ODM_REG_TX_ANT_CTRL_11N 0x80C -+#define ODM_REG_BB_PWR_SAV5_11N 0x818 -+#define ODM_REG_CCK_RPT_FORMAT_11N 0x824 -+#define ODM_REG_RX_DEFUALT_A_11N 0x858 -+#define ODM_REG_RX_DEFUALT_B_11N 0x85A -+#define ODM_REG_BB_PWR_SAV3_11N 0x85C -+#define ODM_REG_ANTSEL_CTRL_11N 0x860 -+#define ODM_REG_RX_ANT_CTRL_11N 0x864 -+#define ODM_REG_PIN_CTRL_11N 0x870 -+#define ODM_REG_BB_PWR_SAV1_11N 0x874 -+#define ODM_REG_ANTSEL_PATH_11N 0x878 -+#define ODM_REG_BB_3WIRE_11N 0x88C -+#define ODM_REG_SC_CNT_11N 0x8C4 -+#define ODM_REG_PSD_DATA_11N 0x8B4 -+#define ODM_REG_PSD_DATA_11N 0x8B4 -+#define ODM_REG_NHM_TIMER_11N 0x894 -+#define ODM_REG_NHM_TH9_TH10_11N 0x890 -+#define ODM_REG_NHM_TH3_TO_TH0_11N 0x898 -+#define ODM_REG_NHM_TH7_TO_TH4_11N 0x89c -+#define ODM_REG_NHM_CNT_11N 0x8d8 -+/* PAGE 9 */ -+#define ODM_REG_DBG_RPT_11N 0x908 -+#define ODM_REG_ANT_MAPPING1_11N 0x914 -+#define ODM_REG_ANT_MAPPING2_11N 0x918 -+/* PAGE A */ -+#define ODM_REG_CCK_ANTDIV_PARA1_11N 0xA00 -+#define ODM_REG_CCK_CCA_11N 0xA0A -+#define ODM_REG_CCK_ANTDIV_PARA2_11N 0xA0C -+#define ODM_REG_CCK_ANTDIV_PARA3_11N 0xA10 -+#define ODM_REG_CCK_ANTDIV_PARA4_11N 0xA14 -+#define ODM_REG_CCK_FILTER_PARA1_11N 0xA22 -+#define ODM_REG_CCK_FILTER_PARA2_11N 0xA23 -+#define ODM_REG_CCK_FILTER_PARA3_11N 0xA24 -+#define ODM_REG_CCK_FILTER_PARA4_11N 0xA25 -+#define ODM_REG_CCK_FILTER_PARA5_11N 0xA26 -+#define ODM_REG_CCK_FILTER_PARA6_11N 0xA27 -+#define ODM_REG_CCK_FILTER_PARA7_11N 0xA28 -+#define ODM_REG_CCK_FILTER_PARA8_11N 0xA29 -+#define ODM_REG_CCK_FA_RST_11N 0xA2C -+#define ODM_REG_CCK_FA_MSB_11N 0xA58 -+#define ODM_REG_CCK_FA_LSB_11N 0xA5C -+#define ODM_REG_CCK_CCA_CNT_11N 0xA60 -+#define ODM_REG_BB_PWR_SAV4_11N 0xA74 -+/* PAGE B */ -+#define ODM_REG_LNA_SWITCH_11N 0xB2C -+#define ODM_REG_PATH_SWITCH_11N 0xB30 -+#define ODM_REG_RSSI_CTRL_11N 0xB38 -+#define ODM_REG_CONFIG_ANTA_11N 0xB68 -+#define ODM_REG_RSSI_BT_11N 0xB9C -+/* PAGE C */ -+#define ODM_REG_OFDM_FA_HOLDC_11N 0xC00 -+#define ODM_REG_BB_RX_PATH_11N 0xC04 -+#define ODM_REG_TRMUX_11N 0xC08 -+#define ODM_REG_OFDM_FA_RSTC_11N 0xC0C -+#define ODM_REG_RXIQI_MATRIX_11N 0xC14 -+#define ODM_REG_TXIQK_MATRIX_LSB1_11N 0xC4C -+#define ODM_REG_IGI_A_11N 0xC50 -+#define ODM_REG_ANTDIV_PARA2_11N 0xC54 -+#define ODM_REG_IGI_B_11N 0xC58 -+#define ODM_REG_ANTDIV_PARA3_11N 0xC5C -+#define ODM_REG_L1SBD_PD_CH_11N 0XC6C -+#define ODM_REG_BB_PWR_SAV2_11N 0xC70 -+#define ODM_REG_RX_OFF_11N 0xC7C -+#define ODM_REG_TXIQK_MATRIXA_11N 0xC80 -+#define ODM_REG_TXIQK_MATRIXB_11N 0xC88 -+#define ODM_REG_TXIQK_MATRIXA_LSB2_11N 0xC94 -+#define ODM_REG_TXIQK_MATRIXB_LSB2_11N 0xC9C -+#define ODM_REG_RXIQK_MATRIX_LSB_11N 0xCA0 -+#define ODM_REG_ANTDIV_PARA1_11N 0xCA4 -+#define ODM_REG_OFDM_FA_TYPE1_11N 0xCF0 -+/* PAGE D */ -+#define ODM_REG_OFDM_FA_RSTD_11N 0xD00 -+#define ODM_REG_BB_ATC_11N 0xD2C -+#define ODM_REG_OFDM_FA_TYPE2_11N 0xDA0 -+#define ODM_REG_OFDM_FA_TYPE3_11N 0xDA4 -+#define ODM_REG_OFDM_FA_TYPE4_11N 0xDA8 -+#define ODM_REG_RPT_11N 0xDF4 -+/* PAGE E */ -+#define ODM_REG_TXAGC_A_6_18_11N 0xE00 -+#define ODM_REG_TXAGC_A_24_54_11N 0xE04 -+#define ODM_REG_TXAGC_A_1_MCS32_11N 0xE08 -+#define ODM_REG_TXAGC_A_MCS0_3_11N 0xE10 -+#define ODM_REG_TXAGC_A_MCS4_7_11N 0xE14 -+#define ODM_REG_TXAGC_A_MCS8_11_11N 0xE18 -+#define ODM_REG_TXAGC_A_MCS12_15_11N 0xE1C -+#define ODM_REG_FPGA0_IQK_11N 0xE28 -+#define ODM_REG_TXIQK_TONE_A_11N 0xE30 -+#define ODM_REG_RXIQK_TONE_A_11N 0xE34 -+#define ODM_REG_TXIQK_PI_A_11N 0xE38 -+#define ODM_REG_RXIQK_PI_A_11N 0xE3C -+#define ODM_REG_TXIQK_11N 0xE40 -+#define ODM_REG_RXIQK_11N 0xE44 -+#define ODM_REG_IQK_AGC_PTS_11N 0xE48 -+#define ODM_REG_IQK_AGC_RSP_11N 0xE4C -+#define ODM_REG_BLUETOOTH_11N 0xE6C -+#define ODM_REG_RX_WAIT_CCA_11N 0xE70 -+#define ODM_REG_TX_CCK_RFON_11N 0xE74 -+#define ODM_REG_TX_CCK_BBON_11N 0xE78 -+#define ODM_REG_OFDM_RFON_11N 0xE7C -+#define ODM_REG_OFDM_BBON_11N 0xE80 -+#define ODM_REG_TX2RX_11N 0xE84 -+#define ODM_REG_TX2TX_11N 0xE88 -+#define ODM_REG_RX_CCK_11N 0xE8C -+#define ODM_REG_RX_OFDM_11N 0xED0 -+#define ODM_REG_RX_WAIT_RIFS_11N 0xED4 -+#define ODM_REG_RX2RX_11N 0xED8 -+#define ODM_REG_STANDBY_11N 0xEDC -+#define ODM_REG_SLEEP_11N 0xEE0 -+#define ODM_REG_PMPD_ANAEN_11N 0xEEC -+#define ODM_REG_IGI_C_11N 0xF84 -+#define ODM_REG_IGI_D_11N 0xF88 -+ -+/* 2 MAC REG LIST */ -+#define ODM_REG_BB_RST_11N 0x02 -+#define ODM_REG_ANTSEL_PIN_11N 0x4C -+#define ODM_REG_EARLY_MODE_11N 0x4D0 -+#define ODM_REG_RSSI_MONITOR_11N 0x4FE -+#define ODM_REG_EDCA_VO_11N 0x500 -+#define ODM_REG_EDCA_VI_11N 0x504 -+#define ODM_REG_EDCA_BE_11N 0x508 -+#define ODM_REG_EDCA_BK_11N 0x50C -+#define ODM_REG_TXPAUSE_11N 0x522 -+#define ODM_REG_RESP_TX_11N 0x6D8 -+#define ODM_REG_ANT_TRAIN_PARA1_11N 0x7b0 -+#define ODM_REG_ANT_TRAIN_PARA2_11N 0x7b4 -+ -+ -+/* DIG Related */ -+#define ODM_BIT_IGI_11N 0x0000007F -+#define ODM_BIT_CCK_RPT_FORMAT_11N BIT9 -+#define ODM_BIT_BB_RX_PATH_11N 0xF -+#define ODM_BIT_BB_ATC_11N BIT11 -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_reg.h linux/3rdparty/rtl8723bs/hal/odm_reg.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_reg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_reg.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,103 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/* File Name: odm_reg.h */ -+/* Description: */ -+/* This file is for general register definition. */ -+#ifndef __HAL_ODM_REG_H__ -+#define __HAL_ODM_REG_H__ -+ -+/* Register Definition */ -+ -+/* MAC REG */ -+#define ODM_BB_RESET 0x002 -+#define ODM_DUMMY 0x4fe -+#define RF_T_METER_OLD 0x24 -+#define RF_T_METER_NEW 0x42 -+ -+#define ODM_EDCA_VO_PARAM 0x500 -+#define ODM_EDCA_VI_PARAM 0x504 -+#define ODM_EDCA_BE_PARAM 0x508 -+#define ODM_EDCA_BK_PARAM 0x50C -+#define ODM_TXPAUSE 0x522 -+ -+/* BB REG */ -+#define ODM_FPGA_PHY0_PAGE8 0x800 -+#define ODM_PSD_SETTING 0x808 -+#define ODM_AFE_SETTING 0x818 -+#define ODM_TXAGC_B_24_54 0x834 -+#define ODM_TXAGC_B_MCS32_5 0x838 -+#define ODM_TXAGC_B_MCS0_MCS3 0x83c -+#define ODM_TXAGC_B_MCS4_MCS7 0x848 -+#define ODM_TXAGC_B_MCS8_MCS11 0x84c -+#define ODM_ANALOG_REGISTER 0x85c -+#define ODM_RF_INTERFACE_OUTPUT 0x860 -+#define ODM_TXAGC_B_MCS12_MCS15 0x868 -+#define ODM_TXAGC_B_11_A_2_11 0x86c -+#define ODM_AD_DA_LSB_MASK 0x874 -+#define ODM_ENABLE_3_WIRE 0x88c -+#define ODM_PSD_REPORT 0x8b4 -+#define ODM_R_ANT_SELECT 0x90c -+#define ODM_CCK_ANT_SELECT 0xa07 -+#define ODM_CCK_PD_THRESH 0xa0a -+#define ODM_CCK_RF_REG1 0xa11 -+#define ODM_CCK_MATCH_FILTER 0xa20 -+#define ODM_CCK_RAKE_MAC 0xa2e -+#define ODM_CCK_CNT_RESET 0xa2d -+#define ODM_CCK_TX_DIVERSITY 0xa2f -+#define ODM_CCK_FA_CNT_MSB 0xa5b -+#define ODM_CCK_FA_CNT_LSB 0xa5c -+#define ODM_CCK_NEW_FUNCTION 0xa75 -+#define ODM_OFDM_PHY0_PAGE_C 0xc00 -+#define ODM_OFDM_RX_ANT 0xc04 -+#define ODM_R_A_RXIQI 0xc14 -+#define ODM_R_A_AGC_CORE1 0xc50 -+#define ODM_R_A_AGC_CORE2 0xc54 -+#define ODM_R_B_AGC_CORE1 0xc58 -+#define ODM_R_AGC_PAR 0xc70 -+#define ODM_R_HTSTF_AGC_PAR 0xc7c -+#define ODM_TX_PWR_TRAINING_A 0xc90 -+#define ODM_TX_PWR_TRAINING_B 0xc98 -+#define ODM_OFDM_FA_CNT1 0xcf0 -+#define ODM_OFDM_PHY0_PAGE_D 0xd00 -+#define ODM_OFDM_FA_CNT2 0xda0 -+#define ODM_OFDM_FA_CNT3 0xda4 -+#define ODM_OFDM_FA_CNT4 0xda8 -+#define ODM_TXAGC_A_6_18 0xe00 -+#define ODM_TXAGC_A_24_54 0xe04 -+#define ODM_TXAGC_A_1_MCS32 0xe08 -+#define ODM_TXAGC_A_MCS0_MCS3 0xe10 -+#define ODM_TXAGC_A_MCS4_MCS7 0xe14 -+#define ODM_TXAGC_A_MCS8_MCS11 0xe18 -+#define ODM_TXAGC_A_MCS12_MCS15 0xe1c -+ -+/* RF REG */ -+#define ODM_GAIN_SETTING 0x00 -+#define ODM_CHANNEL 0x18 -+ -+/* Ant Detect Reg */ -+#define ODM_DPDT 0x300 -+ -+/* PSD Init */ -+#define ODM_PSDREG 0x808 -+ -+/* 92D Path Div */ -+#define PATHDIV_REG 0xB30 -+#define PATHDIV_TRI 0xBA0 -+ -+/* Bitmap Definition */ -+ -+#define BIT_FA_RESET BIT0 -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_RTL8723B.c linux/3rdparty/rtl8723bs/hal/odm_RTL8723B.c ---- linux.old/3rdparty/rtl8723bs/hal/odm_RTL8723B.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_RTL8723B.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,45 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+s8 odm_CCKRSSI_8723B(u8 LNA_idx, u8 VGA_idx) -+{ -+ s8 rx_pwr_all = 0x00; -+ -+ switch (LNA_idx) { -+ /* 46 53 73 95 201301231630 */ -+ /* 46 53 77 99 201301241630 */ -+ -+ case 6: -+ rx_pwr_all = -34 - (2 * VGA_idx); -+ break; -+ case 4: -+ rx_pwr_all = -14 - (2 * VGA_idx); -+ break; -+ case 1: -+ rx_pwr_all = 6 - (2 * VGA_idx); -+ break; -+ case 0: -+ rx_pwr_all = 16 - (2 * VGA_idx); -+ break; -+ default: -+ /* rx_pwr_all = -53+(2*(31-VGA_idx)); */ -+ /* DbgPrint("wrong LNA index\n"); */ -+ break; -+ -+ } -+ return rx_pwr_all; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_RTL8723B.h linux/3rdparty/rtl8723bs/hal/odm_RTL8723B.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_RTL8723B.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_RTL8723B.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,22 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __ODM_RTL8723B_H__ -+#define __ODM_RTL8723B_H__ -+ -+#define DM_DIG_MIN_NIC_8723 0x1C -+ -+s8 odm_CCKRSSI_8723B(u8 LNA_idx, u8 VGA_idx); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/odm_types.h linux/3rdparty/rtl8723bs/hal/odm_types.h ---- linux.old/3rdparty/rtl8723bs/hal/odm_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/odm_types.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,102 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __ODM_TYPES_H__ -+#define __ODM_TYPES_H__ -+ -+#include -+ -+/* Deifne HW endian support */ -+#define ODM_ENDIAN_BIG 0 -+#define ODM_ENDIAN_LITTLE 1 -+ -+#define GET_ODM(__padapter) ((PDM_ODM_T)(&((GET_HAL_DATA(__padapter))->odmpriv))) -+ -+typedef enum _HAL_STATUS { -+ HAL_STATUS_SUCCESS, -+ HAL_STATUS_FAILURE, -+ /*RT_STATUS_PENDING, -+ RT_STATUS_RESOURCE, -+ RT_STATUS_INVALID_CONTEXT, -+ RT_STATUS_INVALID_PARAMETER, -+ RT_STATUS_NOT_SUPPORT, -+ RT_STATUS_OS_API_FAILED,*/ -+} HAL_STATUS, *PHAL_STATUS; -+ -+ -+/* */ -+/* Declare for ODM spin lock defintion temporarily fro compile pass. */ -+/* */ -+typedef enum _RT_SPINLOCK_TYPE { -+ RT_TX_SPINLOCK = 1, -+ RT_RX_SPINLOCK = 2, -+ RT_RM_SPINLOCK = 3, -+ RT_CAM_SPINLOCK = 4, -+ RT_SCAN_SPINLOCK = 5, -+ RT_LOG_SPINLOCK = 7, -+ RT_BW_SPINLOCK = 8, -+ RT_CHNLOP_SPINLOCK = 9, -+ RT_RF_OPERATE_SPINLOCK = 10, -+ RT_INITIAL_SPINLOCK = 11, -+ RT_RF_STATE_SPINLOCK = 12, /* For RF state. Added by Bruce, 2007-10-30. */ -+ /* Shall we define Ndis 6.2 SpinLock Here ? */ -+ RT_PORT_SPINLOCK = 16, -+ RT_H2C_SPINLOCK = 20, /* For H2C cmd. Added by tynli. 2009.11.09. */ -+ -+ RT_BTData_SPINLOCK = 25, -+ -+ RT_WAPI_OPTION_SPINLOCK = 26, -+ RT_WAPI_RX_SPINLOCK = 27, -+ -+ /* add for 92D CCK control issue */ -+ RT_CCK_PAGEA_SPINLOCK = 28, -+ RT_BUFFER_SPINLOCK = 29, -+ RT_CHANNEL_AND_BANDWIDTH_SPINLOCK = 30, -+ RT_GEN_TEMP_BUF_SPINLOCK = 31, -+ RT_AWB_SPINLOCK = 32, -+ RT_FW_PS_SPINLOCK = 33, -+ RT_HW_TIMER_SPIN_LOCK = 34, -+ RT_MPT_WI_SPINLOCK = 35, -+ RT_P2P_SPIN_LOCK = 36, /* Protect P2P context */ -+ RT_DBG_SPIN_LOCK = 37, -+ RT_IQK_SPINLOCK = 38, -+ RT_PENDED_OID_SPINLOCK = 39, -+ RT_CHNLLIST_SPINLOCK = 40, -+ RT_INDIC_SPINLOCK = 41, /* protect indication */ -+} RT_SPINLOCK_TYPE; -+ -+ #if defined(__LITTLE_ENDIAN) -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE -+ #else -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG -+ #endif -+ -+ typedef struct timer_list RT_TIMER, *PRT_TIMER; -+ typedef void *RT_TIMER_CALL_BACK; -+ #define STA_INFO_T struct sta_info -+ #define PSTA_INFO_T struct sta_info * -+ -+ #define SET_TX_DESC_ANTSEL_A_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 1, __Value) -+ #define SET_TX_DESC_ANTSEL_B_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 25, 1, __Value) -+ #define SET_TX_DESC_ANTSEL_C_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 29, 1, __Value) -+ -+ /* define useless flag to avoid compile warning */ -+ #define USE_WORKITEM 0 -+ #define FPGA_TWO_MAC_VERIFICATION 0 -+ -+#define READ_NEXT_PAIR(v1, v2, i) do { if (i+2 >= ArrayLen) break; i += 2; v1 = Array[i]; v2 = Array[i+1]; } while (0) -+#define COND_ELSE 2 -+#define COND_ENDIF 3 -+ -+#endif /* __ODM_TYPES_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/rtl8723b_cmd.c linux/3rdparty/rtl8723bs/hal/rtl8723b_cmd.c ---- linux.old/3rdparty/rtl8723bs/hal/rtl8723b_cmd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/rtl8723b_cmd.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,2358 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8723B_CMD_C_ -+ -+#include -+#include -+#include -+#include "hal_com_h2c.h" -+ -+#define MAX_H2C_BOX_NUMS 4 -+#define MESSAGE_BOX_SIZE 4 -+ -+#define RTL8723B_MAX_CMD_LEN 7 -+#define RTL8723B_EX_MESSAGE_BOX_SIZE 4 -+ -+static u8 _is_fw_read_cmd_down(struct adapter *padapter, u8 msgbox_num) -+{ -+ u8 read_down = false; -+ int retry_cnts = 100; -+ -+ u8 valid; -+ -+ /* DBG_8192C(" _is_fw_read_cmd_down , reg_1cc(%x), msg_box(%d)...\n", rtw_read8(padapter, REG_HMETFR), msgbox_num); */ -+ -+ do { -+ valid = rtw_read8(padapter, REG_HMETFR) & BIT(msgbox_num); -+ if (0 == valid) { -+ read_down = true; -+ } -+#ifdef CONFIG_WOWLAN -+ else -+ msleep(1); -+#endif -+ } while ((!read_down) && (retry_cnts--)); -+ -+ return read_down; -+ -+} -+ -+ -+/***************************************** -+* H2C Msg format : -+*| 31 - 8 |7-5 | 4 - 0 | -+*| h2c_msg |Class |CMD_ID | -+*| 31-0 | -+*| Ext msg | -+* -+******************************************/ -+s32 FillH2CCmd8723B(struct adapter *padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) -+{ -+ u8 h2c_box_num; -+ u32 msgbox_addr; -+ u32 msgbox_ex_addr = 0; -+ struct hal_com_data *pHalData; -+ u32 h2c_cmd = 0; -+ u32 h2c_cmd_ex = 0; -+ s32 ret = _FAIL; -+ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ pHalData = GET_HAL_DATA(padapter); -+ if (mutex_lock_interruptible(&(adapter_to_dvobj(padapter)->h2c_fwcmd_mutex))) -+ return ret; -+ -+ if (!pCmdBuffer) { -+ goto exit; -+ } -+ -+ if (CmdLen > RTL8723B_MAX_CMD_LEN) { -+ goto exit; -+ } -+ -+ if (padapter->bSurpriseRemoved == true) -+ goto exit; -+ -+ /* pay attention to if race condition happened in H2C cmd setting. */ -+ do { -+ h2c_box_num = pHalData->LastHMEBoxNum; -+ -+ if (!_is_fw_read_cmd_down(padapter, h2c_box_num)) { -+ DBG_8192C(" fw read cmd failed...\n"); -+ /* DBG_8192C(" 0x1c0: 0x%8x\n", rtw_read32(padapter, 0x1c0)); */ -+ /* DBG_8192C(" 0x1c4: 0x%8x\n", rtw_read32(padapter, 0x1c4)); */ -+ goto exit; -+ } -+ -+ if (CmdLen <= 3) -+ memcpy((u8 *)(&h2c_cmd)+1, pCmdBuffer, CmdLen); -+ else { -+ memcpy((u8 *)(&h2c_cmd)+1, pCmdBuffer, 3); -+ memcpy((u8 *)(&h2c_cmd_ex), pCmdBuffer+3, CmdLen-3); -+/* *(u8 *)(&h2c_cmd) |= BIT(7); */ -+ } -+ -+ *(u8 *)(&h2c_cmd) |= ElementID; -+ -+ if (CmdLen > 3) { -+ msgbox_ex_addr = REG_HMEBOX_EXT0_8723B + (h2c_box_num*RTL8723B_EX_MESSAGE_BOX_SIZE); -+ rtw_write32(padapter, msgbox_ex_addr, h2c_cmd_ex); -+ } -+ msgbox_addr = REG_HMEBOX_0 + (h2c_box_num*MESSAGE_BOX_SIZE); -+ rtw_write32(padapter, msgbox_addr, h2c_cmd); -+ -+ /* DBG_8192C("MSG_BOX:%d, CmdLen(%d), CmdID(0x%x), reg:0x%x =>h2c_cmd:0x%.8x, reg:0x%x =>h2c_cmd_ex:0x%.8x\n" */ -+ /* , pHalData->LastHMEBoxNum , CmdLen, ElementID, msgbox_addr, h2c_cmd, msgbox_ex_addr, h2c_cmd_ex); */ -+ -+ pHalData->LastHMEBoxNum = (h2c_box_num+1) % MAX_H2C_BOX_NUMS; -+ -+ } while (0); -+ -+ ret = _SUCCESS; -+ -+exit: -+ -+ mutex_unlock(&(adapter_to_dvobj(padapter)->h2c_fwcmd_mutex)); -+ return ret; -+} -+ -+static void ConstructBeacon(struct adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ u32 rate_len, pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network); -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ -+ /* DBG_871X("%s\n", __func__); */ -+ -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ -+ memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ /* pmlmeext->mgnt_seq++; */ -+ SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct ieee80211_hdr_3addr); -+ pktlen = sizeof (struct ieee80211_hdr_3addr); -+ -+ /* timestamp will be inserted by hardware */ -+ pframe += 8; -+ pktlen += 8; -+ -+ /* beacon interval: 2 bytes */ -+ memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ /* capability info: 2 bytes */ -+ memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) { -+ /* DBG_871X("ie len =%d\n", cur_network->IELength); */ -+ pktlen += cur_network->IELength - sizeof(struct ndis_802_11_fix_ie); -+ memcpy(pframe, cur_network->IEs+sizeof(struct ndis_802_11_fix_ie), pktlen); -+ -+ goto _ConstructBeacon; -+ } -+ -+ /* below for ad-hoc mode */ -+ -+ /* SSID */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pktlen); -+ -+ /* supported rates... */ -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pktlen); -+ -+ /* DS parameter set */ -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pktlen); -+ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) { -+ u32 ATIMWindow; -+ /* IBSS Parameter Set... */ -+ /* ATIMWindow = cur->Configuration.ATIMWindow; */ -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pktlen); -+ } -+ -+ -+ /* todo: ERP IE */ -+ -+ -+ /* EXTERNDED SUPPORTED RATE */ -+ if (rate_len > 8) -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen); -+ -+ -+ /* todo:HT for adhoc */ -+ -+_ConstructBeacon: -+ -+ if ((pktlen + TXDESC_SIZE) > 512) { -+ DBG_871X("beacon frame too large\n"); -+ return; -+ } -+ -+ *pLength = pktlen; -+ -+ /* DBG_871X("%s bcn_sz =%d\n", __func__, pktlen); */ -+ -+} -+ -+static void ConstructPSPoll(struct adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* DBG_871X("%s\n", __func__); */ -+ -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ /* Frame control. */ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ SetPwrMgt(fctrl); -+ SetFrameSubType(pframe, WIFI_PSPOLL); -+ -+ /* AID. */ -+ SetDuration(pframe, (pmlmeinfo->aid | 0xc000)); -+ -+ /* BSSID. */ -+ memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ /* TA. */ -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ *pLength = 16; -+} -+ -+static void ConstructNullFunctionData( -+ struct adapter *padapter, -+ u8 *pframe, -+ u32 *pLength, -+ u8 *StaAddr, -+ u8 bQoS, -+ u8 AC, -+ u8 bEosp, -+ u8 bForcePowerSave -+) -+{ -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ u32 pktlen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ /* DBG_871X("%s:%d\n", __func__, bForcePowerSave); */ -+ -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_control; -+ *(fctrl) = 0; -+ if (bForcePowerSave) -+ SetPwrMgt(fctrl); -+ -+ switch (cur_network->network.InfrastructureMode) { -+ case Ndis802_11Infrastructure: -+ SetToDs(fctrl); -+ memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, StaAddr, ETH_ALEN); -+ break; -+ case Ndis802_11APMode: -+ SetFrDs(fctrl); -+ memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ break; -+ case Ndis802_11IBSS: -+ default: -+ memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ break; -+ } -+ -+ SetSeqNum(pwlanhdr, 0); -+ -+ if (bQoS == true) { -+ struct ieee80211_qos_hdr *pwlanqoshdr; -+ -+ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); -+ -+ pwlanqoshdr = (struct ieee80211_qos_hdr *)pframe; -+ SetPriority(&pwlanqoshdr->qos_ctrl, AC); -+ SetEOSP(&pwlanqoshdr->qos_ctrl, bEosp); -+ -+ pktlen = sizeof(struct ieee80211_qos_hdr); -+ } else { -+ SetFrameSubType(pframe, WIFI_DATA_NULL); -+ -+ pktlen = sizeof(struct ieee80211_hdr_3addr); -+ } -+ -+ *pLength = pktlen; -+} -+ -+ -+#ifdef CONFIG_WOWLAN -+/* */ -+/* Description: */ -+/* Construct the ARP response packet to support ARP offload. */ -+/* */ -+static void ConstructARPResponse( -+ struct adapter *padapter, -+ u8 *pframe, -+ u32 *pLength, -+ u8 *pIPAddress -+) -+{ -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ static u8 ARPLLCHeader[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x08, 0x06}; -+ u8 *pARPRspPkt = pframe; -+ /* for TKIP Cal MIC */ -+ u8 *payload = pframe; -+ u8 EncryptionHeadOverhead = 0; -+ /* DBG_871X("%s:%d\n", __func__, bForcePowerSave); */ -+ -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_control; -+ *(fctrl) = 0; -+ -+ /* */ -+ /* MAC Header. */ -+ /* */ -+ SetFrameType(fctrl, WIFI_DATA); -+ /* SetFrameSubType(fctrl, 0); */ -+ SetToDs(fctrl); -+ memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetDuration(pwlanhdr, 0); -+ /* SET_80211_HDR_FRAME_CONTROL(pARPRspPkt, 0); */ -+ /* SET_80211_HDR_TYPE_AND_SUBTYPE(pARPRspPkt, Type_Data); */ -+ /* SET_80211_HDR_TO_DS(pARPRspPkt, 1); */ -+ /* SET_80211_HDR_ADDRESS1(pARPRspPkt, pMgntInfo->Bssid); */ -+ /* SET_80211_HDR_ADDRESS2(pARPRspPkt, Adapter->CurrentAddress); */ -+ /* SET_80211_HDR_ADDRESS3(pARPRspPkt, pMgntInfo->Bssid); */ -+ -+ /* SET_80211_HDR_DURATION(pARPRspPkt, 0); */ -+ /* SET_80211_HDR_FRAGMENT_SEQUENCE(pARPRspPkt, 0); */ -+ *pLength = 24; -+ -+ /* */ -+ /* Security Header: leave space for it if necessary. */ -+ /* */ -+ -+ switch (psecuritypriv->dot11PrivacyAlgrthm) { -+ case _WEP40_: -+ case _WEP104_: -+ EncryptionHeadOverhead = 4; -+ break; -+ case _TKIP_: -+ EncryptionHeadOverhead = 8; -+ break; -+ case _AES_: -+ EncryptionHeadOverhead = 8; -+ break; -+ default: -+ EncryptionHeadOverhead = 0; -+ } -+ -+ if (EncryptionHeadOverhead > 0) { -+ memset(&(pframe[*pLength]), 0, EncryptionHeadOverhead); -+ *pLength += EncryptionHeadOverhead; -+ SetPrivacy(fctrl); -+ } -+ -+ /* */ -+ /* Frame Body. */ -+ /* */ -+ pARPRspPkt = (u8 *)(pframe + *pLength); -+ payload = pARPRspPkt; /* Get Payload pointer */ -+ /* LLC header */ -+ memcpy(pARPRspPkt, ARPLLCHeader, 8); -+ *pLength += 8; -+ -+ /* ARP element */ -+ pARPRspPkt += 8; -+ SET_ARP_PKT_HW(pARPRspPkt, 0x0100); -+ SET_ARP_PKT_PROTOCOL(pARPRspPkt, 0x0008); /* IP protocol */ -+ SET_ARP_PKT_HW_ADDR_LEN(pARPRspPkt, 6); -+ SET_ARP_PKT_PROTOCOL_ADDR_LEN(pARPRspPkt, 4); -+ SET_ARP_PKT_OPERATION(pARPRspPkt, 0x0200); /* ARP response */ -+ SET_ARP_PKT_SENDER_MAC_ADDR(pARPRspPkt, myid(&(padapter->eeprompriv))); -+ SET_ARP_PKT_SENDER_IP_ADDR(pARPRspPkt, pIPAddress); -+ { -+ SET_ARP_PKT_TARGET_MAC_ADDR(pARPRspPkt, get_my_bssid(&(pmlmeinfo->network))); -+ SET_ARP_PKT_TARGET_IP_ADDR(pARPRspPkt, pIPAddress); -+ DBG_871X("%s Target Mac Addr:" MAC_FMT "\n", __func__, MAC_ARG(get_my_bssid(&(pmlmeinfo->network)))); -+ DBG_871X("%s Target IP Addr" IP_FMT "\n", __func__, IP_ARG(pIPAddress)); -+ } -+ -+ *pLength += 28; -+ -+ if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) { -+ u8 mic[8]; -+ struct mic_data micdata; -+ struct sta_info *psta = NULL; -+ u8 priority[4] = { -+ 0x0, 0x0, 0x0, 0x0 -+ }; -+ u8 null_key[16] = { -+ 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, -+ 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0 -+ }; -+ -+ DBG_871X("%s(): Add MIC\n", __func__); -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, get_my_bssid(&(pmlmeinfo->network))); -+ if (psta != NULL) { -+ if (!memcmp(&psta->dot11tkiptxmickey.skey[0], null_key, 16)) { -+ DBG_871X("%s(): STA dot11tkiptxmickey == 0\n", __func__); -+ } -+ /* start to calculate the mic code */ -+ rtw_secmicsetkey(&micdata, &psta->dot11tkiptxmickey.skey[0]); -+ } -+ -+ rtw_secmicappend(&micdata, pwlanhdr->addr3, 6); /* DA */ -+ -+ rtw_secmicappend(&micdata, pwlanhdr->addr2, 6); /* SA */ -+ -+ priority[0] = 0; -+ rtw_secmicappend(&micdata, &priority[0], 4); -+ -+ rtw_secmicappend(&micdata, payload, 36); /* payload length = 8 + 28 */ -+ -+ rtw_secgetmic(&micdata, &(mic[0])); -+ -+ pARPRspPkt += 28; -+ memcpy(pARPRspPkt, &(mic[0]), 8); -+ -+ *pLength += 8; -+ } -+} -+ -+#ifdef CONFIG_PNO_SUPPORT -+static void ConstructPnoInfo( -+ struct adapter *padapter, u8 *pframe, u32 *pLength -+) -+{ -+ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ -+ u8 *pPnoInfoPkt = pframe; -+ pPnoInfoPkt = (u8 *)(pframe + *pLength); -+ memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_num, 4); -+ -+ *pLength += 4; -+ pPnoInfoPkt += 4; -+ memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->fast_scan_period, 4); -+ -+ *pLength += 4; -+ pPnoInfoPkt += 4; -+ memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->fast_scan_iterations, 4); -+ -+ *pLength += 4; -+ pPnoInfoPkt += 4; -+ memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->slow_scan_period, 4); -+ -+ *pLength += 4; -+ pPnoInfoPkt += 4; -+ memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_length, -+ MAX_PNO_LIST_COUNT); -+ -+ *pLength += MAX_PNO_LIST_COUNT; -+ pPnoInfoPkt += MAX_PNO_LIST_COUNT; -+ memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_cipher_info, -+ MAX_PNO_LIST_COUNT); -+ -+ *pLength += MAX_PNO_LIST_COUNT; -+ pPnoInfoPkt += MAX_PNO_LIST_COUNT; -+ memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_channel_info, -+ MAX_PNO_LIST_COUNT); -+ -+ *pLength += MAX_PNO_LIST_COUNT; -+ pPnoInfoPkt += MAX_PNO_LIST_COUNT; -+} -+ -+static void ConstructSSIDList( -+ struct adapter *padapter, u8 *pframe, u32 *pLength -+) -+{ -+ int i = 0; -+ u8 *pSSIDListPkt = pframe; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ -+ pSSIDListPkt = (u8 *)(pframe + *pLength); -+ -+ for (i = 0; i < pwrctl->pnlo_info->ssid_num ; i++) { -+ memcpy(pSSIDListPkt, &pwrctl->pno_ssid_list->node[i].SSID, -+ pwrctl->pnlo_info->ssid_length[i]); -+ -+ *pLength += WLAN_SSID_MAXLEN; -+ pSSIDListPkt += WLAN_SSID_MAXLEN; -+ } -+} -+ -+static void ConstructScanInfo( -+ struct adapter *padapter, u8 *pframe, u32 *pLength -+) -+{ -+ int i = 0; -+ u8 *pScanInfoPkt = pframe; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ -+ pScanInfoPkt = (u8 *)(pframe + *pLength); -+ -+ memcpy(pScanInfoPkt, &pwrctl->pscan_info->channel_num, 1); -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_ch, 1); -+ -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_bw, 1); -+ -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_40_offset, 1); -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_80_offset, 1); -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ memcpy(pScanInfoPkt, &pwrctl->pscan_info->periodScan, 1); -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ memcpy(pScanInfoPkt, &pwrctl->pscan_info->period_scan_time, 1); -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ memcpy(pScanInfoPkt, &pwrctl->pscan_info->enableRFE, 1); -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ memcpy(pScanInfoPkt, &pwrctl->pscan_info->rfe_type, 8); -+ -+ *pLength += 8; -+ pScanInfoPkt += 8; -+ -+ for (i = 0; i < MAX_SCAN_LIST_COUNT; i++) { -+ memcpy(pScanInfoPkt, &pwrctl->pscan_info->ssid_channel_info[i], 4); -+ *pLength += 4; -+ pScanInfoPkt += 4; -+ } -+} -+#endif -+ -+#ifdef CONFIG_GTK_OL -+static void ConstructGTKResponse( -+ struct adapter *padapter, u8 *pframe, u32 *pLength -+) -+{ -+ struct ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ static u8 LLCHeader[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x88, 0x8E}; -+ static u8 GTKbody_a[11] = {0x01, 0x03, 0x00, 0x5F, 0x02, 0x03, 0x12, 0x00, 0x10, 0x42, 0x0B}; -+ u8 *pGTKRspPkt = pframe; -+ u8 EncryptionHeadOverhead = 0; -+ /* DBG_871X("%s:%d\n", __func__, bForcePowerSave); */ -+ -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_control; -+ *(fctrl) = 0; -+ -+ /* */ -+ /* MAC Header. */ -+ /* */ -+ SetFrameType(fctrl, WIFI_DATA); -+ /* SetFrameSubType(fctrl, 0); */ -+ SetToDs(fctrl); -+ memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetDuration(pwlanhdr, 0); -+ -+ *pLength = 24; -+ -+ /* */ -+ /* Security Header: leave space for it if necessary. */ -+ /* */ -+ -+ switch (psecuritypriv->dot11PrivacyAlgrthm) { -+ case _WEP40_: -+ case _WEP104_: -+ EncryptionHeadOverhead = 4; -+ break; -+ case _TKIP_: -+ EncryptionHeadOverhead = 8; -+ break; -+ case _AES_: -+ EncryptionHeadOverhead = 8; -+ break; -+ default: -+ EncryptionHeadOverhead = 0; -+ } -+ -+ if (EncryptionHeadOverhead > 0) { -+ memset(&(pframe[*pLength]), 0, EncryptionHeadOverhead); -+ *pLength += EncryptionHeadOverhead; -+ /* GTK's privacy bit is done by FW */ -+ /* SetPrivacy(fctrl); */ -+ } -+ -+ /* */ -+ /* Frame Body. */ -+ /* */ -+ pGTKRspPkt = (u8 *)(pframe + *pLength); -+ /* LLC header */ -+ memcpy(pGTKRspPkt, LLCHeader, 8); -+ *pLength += 8; -+ -+ /* GTK element */ -+ pGTKRspPkt += 8; -+ -+ /* GTK frame body after LLC, part 1 */ -+ memcpy(pGTKRspPkt, GTKbody_a, 11); -+ *pLength += 11; -+ pGTKRspPkt += 11; -+ /* GTK frame body after LLC, part 2 */ -+ memset(&(pframe[*pLength]), 0, 88); -+ *pLength += 88; -+ pGTKRspPkt += 88; -+ -+} -+#endif /* CONFIG_GTK_OL */ -+ -+#ifdef CONFIG_PNO_SUPPORT -+static void ConstructProbeReq(struct adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ struct ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ unsigned char *mac; -+ unsigned char bssrate[NumRates]; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int bssrate_len = 0; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ mac = myid(&(padapter->eeprompriv)); -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ -+ /* broadcast probe request frame */ -+ memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ memcpy(pwlanhdr->addr3, bc_addr, ETH_ALEN); -+ -+ memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(pframe, WIFI_PROBEREQ); -+ -+ pktlen = sizeof(struct ieee80211_hdr_3addr); -+ pframe += pktlen; -+ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, 0, NULL, &pktlen); -+ -+ get_rate_set(padapter, bssrate, &bssrate_len); -+ -+ if (bssrate_len > 8) { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, bssrate, &pktlen); -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (bssrate_len - 8), (bssrate + 8), &pktlen); -+ } else -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, bssrate_len, bssrate, &pktlen); -+ -+ *pLength = pktlen; -+} -+#endif /* CONFIG_PNO_SUPPORT */ -+#endif /* CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_AP_WOWLAN -+static void ConstructProbeRsp(struct adapter *padapter, u8 *pframe, u32 *pLength, u8 *StaAddr, bool bHideSSID) -+{ -+ struct ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u8 *mac, *bssid; -+ u32 pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network); -+ u8 *pwps_ie; -+ uint wps_ielen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ /* DBG_871X("%s\n", __func__); */ -+ -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ -+ mac = myid(&(padapter->eeprompriv)); -+ bssid = cur_network->MacAddress; -+ -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ memcpy(pwlanhdr->addr3, bssid, ETH_ALEN); -+ -+ DBG_871X("%s FW Mac Addr:" MAC_FMT "\n", __func__, MAC_ARG(mac)); -+ DBG_871X("%s FW IP Addr" IP_FMT "\n", __func__, IP_ARG(StaAddr)); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(fctrl, WIFI_PROBERSP); -+ -+ pktlen = sizeof(struct ieee80211_hdr_3addr); -+ pframe += pktlen; -+ -+ if (cur_network->IELength > MAX_IE_SZ) -+ return; -+ -+ pwps_ie = rtw_get_wps_ie(cur_network->IEs+_FIXED_IE_LENGTH_, -+ cur_network->IELength-_FIXED_IE_LENGTH_, NULL, &wps_ielen); -+ -+ /* inerset & update wps_probe_resp_ie */ -+ if ((pmlmepriv->wps_probe_resp_ie != NULL) && pwps_ie && (wps_ielen > 0)) { -+ uint wps_offset, remainder_ielen; -+ u8 *premainder_ie; -+ -+ wps_offset = (uint)(pwps_ie - cur_network->IEs); -+ -+ premainder_ie = pwps_ie + wps_ielen; -+ -+ remainder_ielen = cur_network->IELength - wps_offset - wps_ielen; -+ -+ memcpy(pframe, cur_network->IEs, wps_offset); -+ pframe += wps_offset; -+ pktlen += wps_offset; -+ -+ wps_ielen = (uint)pmlmepriv->wps_probe_resp_ie[1];/* to get ie data len */ -+ if ((wps_offset+wps_ielen+2) <= MAX_IE_SZ) { -+ memcpy(pframe, pmlmepriv->wps_probe_resp_ie, wps_ielen+2); -+ pframe += wps_ielen+2; -+ pktlen += wps_ielen+2; -+ } -+ -+ if ((wps_offset+wps_ielen+2+remainder_ielen) <= MAX_IE_SZ) { -+ memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; -+ pktlen += remainder_ielen; -+ } -+ } else { -+ memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ pframe += cur_network->IELength; -+ pktlen += cur_network->IELength; -+ } -+ -+ /* retrieve SSID IE from cur_network->Ssid */ -+ { -+ u8 *ssid_ie; -+ sint ssid_ielen; -+ sint ssid_ielen_diff; -+ u8 buf[MAX_IE_SZ]; -+ u8 *ies = pframe + sizeof(struct ieee80211_hdr_3addr); -+ -+ ssid_ie = rtw_get_ie(ies+_FIXED_IE_LENGTH_, _SSID_IE_, &ssid_ielen, -+ (pframe-ies)-_FIXED_IE_LENGTH_); -+ -+ ssid_ielen_diff = cur_network->Ssid.SsidLength - ssid_ielen; -+ -+ if (ssid_ie && cur_network->Ssid.SsidLength) { -+ uint remainder_ielen; -+ u8 *remainder_ie; -+ remainder_ie = ssid_ie+2; -+ remainder_ielen = (pframe-remainder_ie); -+ -+ if (remainder_ielen > MAX_IE_SZ) { -+ DBG_871X_LEVEL(_drv_warning_, FUNC_ADPT_FMT" remainder_ielen > MAX_IE_SZ\n", FUNC_ADPT_ARG(padapter)); -+ remainder_ielen = MAX_IE_SZ; -+ } -+ -+ memcpy(buf, remainder_ie, remainder_ielen); -+ memcpy(remainder_ie+ssid_ielen_diff, buf, remainder_ielen); -+ *(ssid_ie+1) = cur_network->Ssid.SsidLength; -+ memcpy(ssid_ie+2, cur_network->Ssid.Ssid, cur_network->Ssid.SsidLength); -+ pframe += ssid_ielen_diff; -+ pktlen += ssid_ielen_diff; -+ } -+ } -+ -+ *pLength = pktlen; -+ -+} -+#endif /* CONFIG_AP_WOWLAN */ -+ -+/* To check if reserved page content is destroyed by beacon beacuse beacon is too large. */ -+/* 2010.06.23. Added by tynli. */ -+void CheckFwRsvdPageContent(struct adapter *Adapter) -+{ -+} -+ -+static void rtl8723b_set_FwRsvdPage_cmd(struct adapter *padapter, PRSVDPAGE_LOC rsvdpageloc) -+{ -+ u8 u1H2CRsvdPageParm[H2C_RSVDPAGE_LOC_LEN] = {0}; -+ -+ DBG_871X("8723BRsvdPageLoc: ProbeRsp =%d PsPoll =%d Null =%d QoSNull =%d BTNull =%d\n", -+ rsvdpageloc->LocProbeRsp, rsvdpageloc->LocPsPoll, -+ rsvdpageloc->LocNullData, rsvdpageloc->LocQosNull, -+ rsvdpageloc->LocBTQosNull); -+ -+ SET_8723B_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(u1H2CRsvdPageParm, rsvdpageloc->LocProbeRsp); -+ SET_8723B_H2CCMD_RSVDPAGE_LOC_PSPOLL(u1H2CRsvdPageParm, rsvdpageloc->LocPsPoll); -+ SET_8723B_H2CCMD_RSVDPAGE_LOC_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocNullData); -+ SET_8723B_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocQosNull); -+ SET_8723B_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocBTQosNull); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CRsvdPageParm:", u1H2CRsvdPageParm, H2C_RSVDPAGE_LOC_LEN); -+ FillH2CCmd8723B(padapter, H2C_8723B_RSVD_PAGE, H2C_RSVDPAGE_LOC_LEN, u1H2CRsvdPageParm); -+} -+ -+static void rtl8723b_set_FwAoacRsvdPage_cmd(struct adapter *padapter, PRSVDPAGE_LOC rsvdpageloc) -+{ -+#ifdef CONFIG_WOWLAN -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 u1H2CAoacRsvdPageParm[H2C_AOAC_RSVDPAGE_LOC_LEN] = {0}; -+ -+ DBG_871X("8723BAOACRsvdPageLoc: RWC =%d ArpRsp =%d NbrAdv =%d GtkRsp =%d GtkInfo =%d ProbeReq =%d NetworkList =%d\n", -+ rsvdpageloc->LocRemoteCtrlInfo, rsvdpageloc->LocArpRsp, -+ rsvdpageloc->LocNbrAdv, rsvdpageloc->LocGTKRsp, -+ rsvdpageloc->LocGTKInfo, rsvdpageloc->LocProbeReq, -+ rsvdpageloc->LocNetList); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) { -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocRemoteCtrlInfo); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocArpRsp); -+ /* SET_H2CCMD_AOAC_RSVDPAGE_LOC_NEIGHBOR_ADV(u1H2CAoacRsvdPageParm, rsvdpageloc->LocNbrAdv); */ -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKRsp); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKInfo); -+#ifdef CONFIG_GTK_OL -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_EXT_MEM(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKEXTMEM); -+#endif /* CONFIG_GTK_OL */ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CAoacRsvdPageParm:", u1H2CAoacRsvdPageParm, H2C_AOAC_RSVDPAGE_LOC_LEN); -+ FillH2CCmd8723B(padapter, H2C_8723B_AOAC_RSVD_PAGE, H2C_AOAC_RSVDPAGE_LOC_LEN, u1H2CAoacRsvdPageParm); -+ } else { -+#ifdef CONFIG_PNO_SUPPORT -+ if (!pwrpriv->pno_in_resume) { -+ DBG_871X("NLO_INFO =%d\n", rsvdpageloc->LocPNOInfo); -+ memset(&u1H2CAoacRsvdPageParm, 0, sizeof(u1H2CAoacRsvdPageParm)); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_NLO_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocPNOInfo); -+ FillH2CCmd8723B(padapter, H2C_AOAC_RSVDPAGE3, H2C_AOAC_RSVDPAGE_LOC_LEN, u1H2CAoacRsvdPageParm); -+ msleep(10); -+ } -+#endif -+ } -+ -+#endif /* CONFIG_WOWLAN */ -+} -+ -+#ifdef CONFIG_AP_WOWLAN -+static void rtl8723b_set_ap_wow_rsvdpage_cmd( -+ struct adapter *padapter, PRSVDPAGE_LOC rsvdpageloc -+) -+{ -+ u8 header; -+ u8 rsvdparm[H2C_AOAC_RSVDPAGE_LOC_LEN] = {0}; -+ -+ header = rtw_read8(padapter, REG_BCNQ_BDNY); -+ -+ DBG_871X("%s: beacon: %d, probeRsp: %d, header:0x%02x\n", __func__, -+ rsvdpageloc->LocApOffloadBCN, -+ rsvdpageloc->LocProbeRsp, -+ header); -+ -+ SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_BCN(rsvdparm, -+ rsvdpageloc->LocApOffloadBCN + header); -+ -+ FillH2CCmd8723B(padapter, H2C_8723B_BCN_RSVDPAGE, -+ H2C_BCN_RSVDPAGE_LEN, rsvdparm); -+ -+ msleep(10); -+ -+ memset(&rsvdparm, 0, sizeof(rsvdparm)); -+ -+ SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_ProbeRsp( -+ rsvdparm, -+ rsvdpageloc->LocProbeRsp + header); -+ -+ FillH2CCmd8723B(padapter, H2C_8723B_PROBERSP_RSVDPAGE, -+ H2C_PROBERSP_RSVDPAGE_LEN, rsvdparm); -+ -+ msleep(10); -+} -+#endif /* CONFIG_AP_WOWLAN */ -+ -+void rtl8723b_set_FwMediaStatusRpt_cmd(struct adapter *padapter, u8 mstatus, u8 macid) -+{ -+ u8 u1H2CMediaStatusRptParm[H2C_MEDIA_STATUS_RPT_LEN] = {0}; -+ u8 macid_end = 0; -+ -+ DBG_871X("%s(): mstatus = %d macid =%d\n", __func__, mstatus, macid); -+ -+ SET_8723B_H2CCMD_MSRRPT_PARM_OPMODE(u1H2CMediaStatusRptParm, mstatus); -+ SET_8723B_H2CCMD_MSRRPT_PARM_MACID_IND(u1H2CMediaStatusRptParm, 0); -+ SET_8723B_H2CCMD_MSRRPT_PARM_MACID(u1H2CMediaStatusRptParm, macid); -+ SET_8723B_H2CCMD_MSRRPT_PARM_MACID_END(u1H2CMediaStatusRptParm, macid_end); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CMediaStatusRptParm:", u1H2CMediaStatusRptParm, H2C_MEDIA_STATUS_RPT_LEN); -+ FillH2CCmd8723B(padapter, H2C_8723B_MEDIA_STATUS_RPT, H2C_MEDIA_STATUS_RPT_LEN, u1H2CMediaStatusRptParm); -+} -+ -+#ifdef CONFIG_WOWLAN -+static void rtl8723b_set_FwKeepAlive_cmd(struct adapter *padapter, u8 benable, u8 pkt_type) -+{ -+ u8 u1H2CKeepAliveParm[H2C_KEEP_ALIVE_CTRL_LEN] = {0}; -+ u8 adopt = 1, check_period = 5; -+ -+ DBG_871X("%s(): benable = %d\n", __func__, benable); -+ SET_8723B_H2CCMD_KEEPALIVE_PARM_ENABLE(u1H2CKeepAliveParm, benable); -+ SET_8723B_H2CCMD_KEEPALIVE_PARM_ADOPT(u1H2CKeepAliveParm, adopt); -+ SET_8723B_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(u1H2CKeepAliveParm, pkt_type); -+ SET_8723B_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(u1H2CKeepAliveParm, check_period); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CKeepAliveParm:", u1H2CKeepAliveParm, H2C_KEEP_ALIVE_CTRL_LEN); -+ -+ FillH2CCmd8723B(padapter, H2C_8723B_KEEP_ALIVE, H2C_KEEP_ALIVE_CTRL_LEN, u1H2CKeepAliveParm); -+} -+ -+static void rtl8723b_set_FwDisconDecision_cmd(struct adapter *padapter, u8 benable) -+{ -+ u8 u1H2CDisconDecisionParm[H2C_DISCON_DECISION_LEN] = {0}; -+ u8 adopt = 1, check_period = 10, trypkt_num = 0; -+ -+ DBG_871X("%s(): benable = %d\n", __func__, benable); -+ SET_8723B_H2CCMD_DISCONDECISION_PARM_ENABLE(u1H2CDisconDecisionParm, benable); -+ SET_8723B_H2CCMD_DISCONDECISION_PARM_ADOPT(u1H2CDisconDecisionParm, adopt); -+ SET_8723B_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(u1H2CDisconDecisionParm, check_period); -+ SET_8723B_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(u1H2CDisconDecisionParm, trypkt_num); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CDisconDecisionParm:", u1H2CDisconDecisionParm, H2C_DISCON_DECISION_LEN); -+ -+ FillH2CCmd8723B(padapter, H2C_8723B_DISCON_DECISION, H2C_DISCON_DECISION_LEN, u1H2CDisconDecisionParm); -+} -+#endif /* CONFIG_WOWLAN */ -+ -+void rtl8723b_set_FwMacIdConfig_cmd(struct adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask) -+{ -+ u8 u1H2CMacIdConfigParm[H2C_MACID_CFG_LEN] = {0}; -+ -+ DBG_871X("%s(): mac_id =%d raid = 0x%x bw =%d mask = 0x%x\n", __func__, mac_id, raid, bw, mask); -+ -+ SET_8723B_H2CCMD_MACID_CFG_MACID(u1H2CMacIdConfigParm, mac_id); -+ SET_8723B_H2CCMD_MACID_CFG_RAID(u1H2CMacIdConfigParm, raid); -+ SET_8723B_H2CCMD_MACID_CFG_SGI_EN(u1H2CMacIdConfigParm, sgi ? 1 : 0); -+ SET_8723B_H2CCMD_MACID_CFG_BW(u1H2CMacIdConfigParm, bw); -+ SET_8723B_H2CCMD_MACID_CFG_RATE_MASK0(u1H2CMacIdConfigParm, (u8)(mask & 0x000000ff)); -+ SET_8723B_H2CCMD_MACID_CFG_RATE_MASK1(u1H2CMacIdConfigParm, (u8)((mask & 0x0000ff00) >> 8)); -+ SET_8723B_H2CCMD_MACID_CFG_RATE_MASK2(u1H2CMacIdConfigParm, (u8)((mask & 0x00ff0000) >> 16)); -+ SET_8723B_H2CCMD_MACID_CFG_RATE_MASK3(u1H2CMacIdConfigParm, (u8)((mask & 0xff000000) >> 24)); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CMacIdConfigParm:", u1H2CMacIdConfigParm, H2C_MACID_CFG_LEN); -+ FillH2CCmd8723B(padapter, H2C_8723B_MACID_CFG, H2C_MACID_CFG_LEN, u1H2CMacIdConfigParm); -+} -+ -+static void rtl8723b_set_FwRssiSetting_cmd(struct adapter *padapter, u8 *param) -+{ -+ u8 u1H2CRssiSettingParm[H2C_RSSI_SETTING_LEN] = {0}; -+ u8 mac_id = *param; -+ u8 rssi = *(param+2); -+ u8 uldl_state = 0; -+ -+ /* DBG_871X("%s(): param =%.2x-%.2x-%.2x\n", __func__, *param, *(param+1), *(param+2)); */ -+ /* DBG_871X("%s(): mac_id =%d rssi =%d\n", __func__, mac_id, rssi); */ -+ -+ SET_8723B_H2CCMD_RSSI_SETTING_MACID(u1H2CRssiSettingParm, mac_id); -+ SET_8723B_H2CCMD_RSSI_SETTING_RSSI(u1H2CRssiSettingParm, rssi); -+ SET_8723B_H2CCMD_RSSI_SETTING_ULDL_STATE(u1H2CRssiSettingParm, uldl_state); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_notice_, "u1H2CRssiSettingParm:", u1H2CRssiSettingParm, H2C_RSSI_SETTING_LEN); -+ FillH2CCmd8723B(padapter, H2C_8723B_RSSI_SETTING, H2C_RSSI_SETTING_LEN, u1H2CRssiSettingParm); -+} -+ -+void rtl8723b_set_FwPwrMode_cmd(struct adapter *padapter, u8 psmode) -+{ -+ int i; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u8 u1H2CPwrModeParm[H2C_PWRMODE_LEN] = {0}; -+ u8 PowerState = 0, awake_intvl = 1, byte5 = 0, rlbm = 0; -+ -+ if (pwrpriv->dtim > 0) -+ DBG_871X("%s(): FW LPS mode = %d, SmartPS =%d, dtim =%d\n", __func__, psmode, pwrpriv->smart_ps, pwrpriv->dtim); -+ else -+ DBG_871X("%s(): FW LPS mode = %d, SmartPS =%d\n", __func__, psmode, pwrpriv->smart_ps); -+ -+#ifdef CONFIG_WOWLAN -+ if (psmode == PS_MODE_DTIM) { /* For WOWLAN LPS, DTIM = (awake_intvl - 1) */ -+ awake_intvl = 3;/* DTIM =2 */ -+ rlbm = 2; -+ } else -+#endif /* CONFIG_WOWLAN */ -+ { -+ if (pwrpriv->dtim > 0 && pwrpriv->dtim < 16) -+ awake_intvl = pwrpriv->dtim+1;/* DTIM = (awake_intvl - 1) */ -+ else -+ awake_intvl = 3;/* DTIM =2 */ -+ -+ rlbm = 2; -+ } -+ -+ -+ if (padapter->registrypriv.wifi_spec == 1) { -+ awake_intvl = 2; -+ rlbm = 2; -+ } -+ -+ if (psmode > 0) { -+ if (rtw_btcoex_IsBtControlLps(padapter) == true) { -+ PowerState = rtw_btcoex_RpwmVal(padapter); -+ byte5 = rtw_btcoex_LpsVal(padapter); -+ -+ if ((rlbm == 2) && (byte5 & BIT(4))) { -+ /* Keep awake interval to 1 to prevent from */ -+ /* decreasing coex performance */ -+ awake_intvl = 2; -+ rlbm = 2; -+ } -+ } else { -+ PowerState = 0x00;/* AllON(0x0C), RFON(0x04), RFOFF(0x00) */ -+ byte5 = 0x40; -+ } -+ } else { -+ PowerState = 0x0C;/* AllON(0x0C), RFON(0x04), RFOFF(0x00) */ -+ byte5 = 0x40; -+ } -+ -+ SET_8723B_H2CCMD_PWRMODE_PARM_MODE(u1H2CPwrModeParm, (psmode > 0) ? 1 : 0); -+ SET_8723B_H2CCMD_PWRMODE_PARM_SMART_PS(u1H2CPwrModeParm, pwrpriv->smart_ps); -+ SET_8723B_H2CCMD_PWRMODE_PARM_RLBM(u1H2CPwrModeParm, rlbm); -+ SET_8723B_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(u1H2CPwrModeParm, awake_intvl); -+ SET_8723B_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(u1H2CPwrModeParm, padapter->registrypriv.uapsd_enable); -+ SET_8723B_H2CCMD_PWRMODE_PARM_PWR_STATE(u1H2CPwrModeParm, PowerState); -+ SET_8723B_H2CCMD_PWRMODE_PARM_BYTE5(u1H2CPwrModeParm, byte5); -+ if (psmode != PS_MODE_ACTIVE) { -+ if (pmlmeext->adaptive_tsf_done == false && pmlmeext->bcn_cnt > 0) { -+ u8 ratio_20_delay, ratio_80_delay; -+ -+ /* byte 6 for adaptive_early_32k */ -+ /* 0:3] = DrvBcnEarly (ms) , [4:7] = DrvBcnTimeOut (ms) */ -+ /* 20% for DrvBcnEarly, 80% for DrvBcnTimeOut */ -+ ratio_20_delay = 0; -+ ratio_80_delay = 0; -+ pmlmeext->DrvBcnEarly = 0xff; -+ pmlmeext->DrvBcnTimeOut = 0xff; -+ -+ DBG_871X("%s(): bcn_cnt = %d\n", __func__, pmlmeext->bcn_cnt); -+ -+ for (i = 0; i < 9; i++) { -+ pmlmeext->bcn_delay_ratio[i] = (pmlmeext->bcn_delay_cnt[i]*100)/pmlmeext->bcn_cnt; -+ -+ DBG_871X( -+ "%s(): bcn_delay_cnt[%d]=%d, bcn_delay_ratio[%d] = %d\n", -+ __func__, -+ i, -+ pmlmeext->bcn_delay_cnt[i], -+ i, -+ pmlmeext->bcn_delay_ratio[i] -+ ); -+ -+ ratio_20_delay += pmlmeext->bcn_delay_ratio[i]; -+ ratio_80_delay += pmlmeext->bcn_delay_ratio[i]; -+ -+ if (ratio_20_delay > 20 && pmlmeext->DrvBcnEarly == 0xff) { -+ pmlmeext->DrvBcnEarly = i; -+ DBG_871X("%s(): DrvBcnEarly = %d\n", __func__, pmlmeext->DrvBcnEarly); -+ } -+ -+ if (ratio_80_delay > 80 && pmlmeext->DrvBcnTimeOut == 0xff) { -+ pmlmeext->DrvBcnTimeOut = i; -+ DBG_871X("%s(): DrvBcnTimeOut = %d\n", __func__, pmlmeext->DrvBcnTimeOut); -+ } -+ -+ /* reset adaptive_early_32k cnt */ -+ pmlmeext->bcn_delay_cnt[i] = 0; -+ pmlmeext->bcn_delay_ratio[i] = 0; -+ -+ } -+ -+ pmlmeext->bcn_cnt = 0; -+ pmlmeext->adaptive_tsf_done = true; -+ -+ } else { -+ DBG_871X("%s(): DrvBcnEarly = %d\n", __func__, pmlmeext->DrvBcnEarly); -+ DBG_871X("%s(): DrvBcnTimeOut = %d\n", __func__, pmlmeext->DrvBcnTimeOut); -+ } -+ -+/* offload to FW if fw version > v15.10 -+ pmlmeext->DrvBcnEarly = 0; -+ pmlmeext->DrvBcnTimeOut =7; -+ -+ if ((pmlmeext->DrvBcnEarly!= 0Xff) && (pmlmeext->DrvBcnTimeOut!= 0xff)) -+ u1H2CPwrModeParm[H2C_PWRMODE_LEN-1] = BIT(0) | ((pmlmeext->DrvBcnEarly<<1)&0x0E) |((pmlmeext->DrvBcnTimeOut<<4)&0xf0) ; -+*/ -+ -+ } -+ -+ rtw_btcoex_RecordPwrMode(padapter, u1H2CPwrModeParm, H2C_PWRMODE_LEN); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CPwrModeParm:", u1H2CPwrModeParm, H2C_PWRMODE_LEN); -+ -+ FillH2CCmd8723B(padapter, H2C_8723B_SET_PWR_MODE, H2C_PWRMODE_LEN, u1H2CPwrModeParm); -+} -+ -+void rtl8723b_set_FwPsTuneParam_cmd(struct adapter *padapter) -+{ -+ u8 u1H2CPsTuneParm[H2C_PSTUNEPARAM_LEN] = {0}; -+ u8 bcn_to_limit = 10; /* 10 * 100 * awakeinterval (ms) */ -+ u8 dtim_timeout = 5; /* ms wait broadcast data timer */ -+ u8 ps_timeout = 20; /* ms Keep awake when tx */ -+ u8 dtim_period = 3; -+ -+ /* DBG_871X("%s(): FW LPS mode = %d\n", __func__, psmode); */ -+ -+ SET_8723B_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(u1H2CPsTuneParm, bcn_to_limit); -+ SET_8723B_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(u1H2CPsTuneParm, dtim_timeout); -+ SET_8723B_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(u1H2CPsTuneParm, ps_timeout); -+ SET_8723B_H2CCMD_PSTUNE_PARM_ADOPT(u1H2CPsTuneParm, 1); -+ SET_8723B_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(u1H2CPsTuneParm, dtim_period); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CPsTuneParm:", u1H2CPsTuneParm, H2C_PSTUNEPARAM_LEN); -+ -+ FillH2CCmd8723B(padapter, H2C_8723B_PS_TUNING_PARA, H2C_PSTUNEPARAM_LEN, u1H2CPsTuneParm); -+} -+ -+void rtl8723b_set_FwPwrModeInIPS_cmd(struct adapter *padapter, u8 cmd_param) -+{ -+ /* BIT0:enable, BIT1:NoConnect32k */ -+ -+ DBG_871X("%s()\n", __func__); -+ -+ FillH2CCmd8723B(padapter, H2C_8723B_FWLPS_IN_IPS_, 1, &cmd_param); -+} -+ -+#ifdef CONFIG_WOWLAN -+static void rtl8723b_set_FwWoWlanCtrl_Cmd(struct adapter *padapter, u8 bFuncEn) -+{ -+ struct security_priv *psecpriv = &padapter->securitypriv; -+ u8 u1H2CWoWlanCtrlParm[H2C_WOWLAN_LEN] = {0}; -+ u8 discont_wake = 1, gpionum = 0, gpio_dur = 0, hw_unicast = 0; -+ u8 sdio_wakeup_enable = 1; -+ u8 gpio_high_active = 0; /* 0: low active, 1: high active */ -+ u8 magic_pkt = 0; -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ gpionum = WAKEUP_GPIO_IDX; -+ sdio_wakeup_enable = 0; -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+ if (!ppwrpriv->wowlan_pno_enable) -+ magic_pkt = 1; -+#endif -+ -+ if (psecpriv->dot11PrivacyAlgrthm == _WEP40_ || psecpriv->dot11PrivacyAlgrthm == _WEP104_) -+ hw_unicast = 1; -+ -+ DBG_871X("%s(): bFuncEn =%d\n", __func__, bFuncEn); -+ -+ SET_H2CCMD_WOWLAN_FUNC_ENABLE(u1H2CWoWlanCtrlParm, bFuncEn); -+ SET_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(u1H2CWoWlanCtrlParm, 0); -+ SET_H2CCMD_WOWLAN_MAGIC_PKT_ENABLE(u1H2CWoWlanCtrlParm, magic_pkt); -+ SET_H2CCMD_WOWLAN_UNICAST_PKT_ENABLE(u1H2CWoWlanCtrlParm, hw_unicast); -+ SET_H2CCMD_WOWLAN_ALL_PKT_DROP(u1H2CWoWlanCtrlParm, 0); -+ SET_H2CCMD_WOWLAN_GPIO_ACTIVE(u1H2CWoWlanCtrlParm, gpio_high_active); -+ SET_H2CCMD_WOWLAN_DISCONNECT_WAKE_UP(u1H2CWoWlanCtrlParm, discont_wake); -+ SET_H2CCMD_WOWLAN_GPIONUM(u1H2CWoWlanCtrlParm, gpionum); -+ SET_H2CCMD_WOWLAN_DATAPIN_WAKE_UP(u1H2CWoWlanCtrlParm, sdio_wakeup_enable); -+ SET_H2CCMD_WOWLAN_GPIO_DURATION(u1H2CWoWlanCtrlParm, gpio_dur); -+ /* SET_H2CCMD_WOWLAN_GPIO_PULSE_EN(u1H2CWoWlanCtrlParm, 1); */ -+ SET_H2CCMD_WOWLAN_GPIO_PULSE_COUNT(u1H2CWoWlanCtrlParm, 0x09); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CWoWlanCtrlParm:", u1H2CWoWlanCtrlParm, H2C_WOWLAN_LEN); -+ -+ FillH2CCmd8723B(padapter, H2C_8723B_WOWLAN, H2C_WOWLAN_LEN, u1H2CWoWlanCtrlParm); -+} -+ -+static void rtl8723b_set_FwRemoteWakeCtrl_Cmd(struct adapter *padapter, u8 benable) -+{ -+ u8 u1H2CRemoteWakeCtrlParm[H2C_REMOTE_WAKE_CTRL_LEN] = {0}; -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(padapter); -+ -+ DBG_871X("%s(): Enable =%d\n", __func__, benable); -+ -+ if (!ppwrpriv->wowlan_pno_enable) { -+ SET_H2CCMD_REMOTE_WAKECTRL_ENABLE(u1H2CRemoteWakeCtrlParm, benable); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN(u1H2CRemoteWakeCtrlParm, 1); -+#ifdef CONFIG_GTK_OL -+ if (psecuritypriv->binstallKCK_KEK && -+ psecuritypriv->dot11PrivacyAlgrthm == _AES_) { -+ SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN(u1H2CRemoteWakeCtrlParm, 1); -+ } else { -+ DBG_871X("no kck or security is not AES\n"); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN(u1H2CRemoteWakeCtrlParm, 0); -+ } -+#endif /* CONFIG_GTK_OL */ -+ -+ SET_H2CCMD_REMOTE_WAKE_CTRL_FW_UNICAST_EN(u1H2CRemoteWakeCtrlParm, 1); -+ -+ if ((psecuritypriv->dot11PrivacyAlgrthm == _AES_) || -+ (psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_)) -+ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION(u1H2CRemoteWakeCtrlParm, 0); -+ else -+ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION(u1H2CRemoteWakeCtrlParm, 1); -+ } -+#ifdef CONFIG_PNO_SUPPORT -+ else { -+ SET_H2CCMD_REMOTE_WAKECTRL_ENABLE(u1H2CRemoteWakeCtrlParm, benable); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_NLO_OFFLOAD_EN(u1H2CRemoteWakeCtrlParm, benable); -+ } -+#endif -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CRemoteWakeCtrlParm:", u1H2CRemoteWakeCtrlParm, H2C_REMOTE_WAKE_CTRL_LEN); -+ FillH2CCmd8723B(padapter, H2C_8723B_REMOTE_WAKE_CTRL, -+ H2C_REMOTE_WAKE_CTRL_LEN, u1H2CRemoteWakeCtrlParm); -+#ifdef CONFIG_PNO_SUPPORT -+ if (ppwrpriv->wowlan_pno_enable && ppwrpriv->pno_in_resume == false) { -+ res = rtw_read8(padapter, REG_PNO_STATUS); -+ DBG_871X("cmd: 0x81 REG_PNO_STATUS: 0x%02x\n", res); -+ while (!(res&BIT(7)) && count < 25) { -+ DBG_871X("[%d] cmd: 0x81 REG_PNO_STATUS: 0x%02x\n", count, res); -+ res = rtw_read8(padapter, REG_PNO_STATUS); -+ count++; -+ msleep(2); -+ } -+ DBG_871X("cmd: 0x81 REG_PNO_STATUS: 0x%02x\n", res); -+ } -+#endif /* CONFIG_PNO_SUPPORT */ -+} -+ -+static void rtl8723b_set_FwAOACGlobalInfo_Cmd(struct adapter *padapter, u8 group_alg, u8 pairwise_alg) -+{ -+ u8 u1H2CAOACGlobalInfoParm[H2C_AOAC_GLOBAL_INFO_LEN] = {0}; -+ -+ DBG_871X("%s(): group_alg =%d pairwise_alg =%d\n", __func__, group_alg, pairwise_alg); -+ -+ SET_H2CCMD_AOAC_GLOBAL_INFO_PAIRWISE_ENC_ALG(u1H2CAOACGlobalInfoParm, pairwise_alg); -+ SET_H2CCMD_AOAC_GLOBAL_INFO_GROUP_ENC_ALG(u1H2CAOACGlobalInfoParm, group_alg); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CAOACGlobalInfoParm:", u1H2CAOACGlobalInfoParm, H2C_AOAC_GLOBAL_INFO_LEN); -+ -+ FillH2CCmd8723B(padapter, H2C_8723B_AOAC_GLOBAL_INFO, H2C_AOAC_GLOBAL_INFO_LEN, u1H2CAOACGlobalInfoParm); -+} -+ -+#ifdef CONFIG_PNO_SUPPORT -+static void rtl8723b_set_FwScanOffloadInfo_cmd(struct adapter *padapter, PRSVDPAGE_LOC rsvdpageloc, u8 enable) -+{ -+ u8 u1H2CScanOffloadInfoParm[H2C_SCAN_OFFLOAD_CTRL_LEN] = {0}; -+ u8 res = 0, count = 0; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ -+ DBG_871X("%s: loc_probe_packet:%d, loc_scan_info: %d loc_ssid_info:%d\n", -+ __func__, rsvdpageloc->LocProbePacket, rsvdpageloc->LocScanInfo, rsvdpageloc->LocSSIDInfo); -+ -+ SET_H2CCMD_AOAC_NLO_FUN_EN(u1H2CScanOffloadInfoParm, enable); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_SCAN_INFO(u1H2CScanOffloadInfoParm, rsvdpageloc->LocScanInfo); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_PROBE_PACKET(u1H2CScanOffloadInfoParm, rsvdpageloc->LocProbePacket); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_SSID_INFO(u1H2CScanOffloadInfoParm, rsvdpageloc->LocSSIDInfo); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CScanOffloadInfoParm:", u1H2CScanOffloadInfoParm, H2C_SCAN_OFFLOAD_CTRL_LEN); -+ FillH2CCmd8723B(padapter, H2C_8723B_D0_SCAN_OFFLOAD_INFO, H2C_SCAN_OFFLOAD_CTRL_LEN, u1H2CScanOffloadInfoParm); -+ -+ msleep(20); -+} -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+static void rtl8723b_set_FwWoWlanRelated_cmd(struct adapter *padapter, u8 enable) -+{ -+ struct security_priv *psecpriv = &padapter->securitypriv; -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_info *psta = NULL; -+ u8 pkt_type = 0; -+ -+ DBG_871X_LEVEL(_drv_always_, "+%s()+: enable =%d\n", __func__, enable); -+ if (enable) { -+ rtl8723b_set_FwAOACGlobalInfo_Cmd(padapter, psecpriv->dot118021XGrpPrivacy, psecpriv->dot11PrivacyAlgrthm); -+ -+ rtl8723b_set_FwJoinBssRpt_cmd(padapter, RT_MEDIA_CONNECT); /* RT_MEDIA_CONNECT will confuse in the future */ -+ -+ if (!(ppwrpriv->wowlan_pno_enable)) { -+ psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(pmlmepriv)); -+ if (psta != NULL) -+ rtl8723b_set_FwMediaStatusRpt_cmd(padapter, RT_MEDIA_CONNECT, psta->mac_id); -+ } else -+ DBG_871X("%s(): Disconnected, no FwMediaStatusRpt CONNECT\n", __func__); -+ -+ msleep(2); -+ -+ if (!(ppwrpriv->wowlan_pno_enable)) { -+ rtl8723b_set_FwDisconDecision_cmd(padapter, enable); -+ msleep(2); -+ -+ if ((psecpriv->dot11PrivacyAlgrthm != _WEP40_) || (psecpriv->dot11PrivacyAlgrthm != _WEP104_)) -+ pkt_type = 1; -+ -+ rtl8723b_set_FwKeepAlive_cmd(padapter, enable, pkt_type); -+ msleep(2); -+ } -+ -+ rtl8723b_set_FwWoWlanCtrl_Cmd(padapter, enable); -+ msleep(2); -+ -+ rtl8723b_set_FwRemoteWakeCtrl_Cmd(padapter, enable); -+ } else { -+ rtl8723b_set_FwRemoteWakeCtrl_Cmd(padapter, enable); -+ msleep(2); -+ rtl8723b_set_FwWoWlanCtrl_Cmd(padapter, enable); -+ } -+ -+ DBG_871X_LEVEL(_drv_always_, "-%s()-\n", __func__); -+} -+ -+void rtl8723b_set_wowlan_cmd(struct adapter *padapter, u8 enable) -+{ -+ rtl8723b_set_FwWoWlanRelated_cmd(padapter, enable); -+} -+#endif /* CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_AP_WOWLAN -+static void rtl8723b_set_FwAPWoWlanCtrl_Cmd(struct adapter *padapter, u8 bFuncEn) -+{ -+ u8 u1H2CAPWoWlanCtrlParm[H2C_WOWLAN_LEN] = {0}; -+ u8 gpionum = 0, gpio_dur = 0; -+ u8 gpio_high_active = 1; /* 0: low active, 1: high active */ -+ u8 gpio_pulse = bFuncEn; -+#ifdef CONFIG_GPIO_WAKEUP -+ gpionum = WAKEUP_GPIO_IDX; -+#endif -+ -+ DBG_871X("%s(): bFuncEn =%d\n", __func__, bFuncEn); -+ -+ if (bFuncEn) -+ gpio_dur = 16; -+ else -+ gpio_dur = 0; -+ -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_INDEX(u1H2CAPWoWlanCtrlParm, -+ gpionum); -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_PLUS(u1H2CAPWoWlanCtrlParm, -+ gpio_pulse); -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_HIGH_ACTIVE(u1H2CAPWoWlanCtrlParm, -+ gpio_high_active); -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_EN(u1H2CAPWoWlanCtrlParm, -+ bFuncEn); -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_DURATION(u1H2CAPWoWlanCtrlParm, -+ gpio_dur); -+ -+ FillH2CCmd8723B(padapter, H2C_8723B_AP_WOW_GPIO_CTRL, -+ H2C_AP_WOW_GPIO_CTRL_LEN, u1H2CAPWoWlanCtrlParm); -+} -+ -+static void rtl8723b_set_Fw_AP_Offload_Cmd(struct adapter *padapter, u8 bFuncEn) -+{ -+ u8 u1H2CAPOffloadCtrlParm[H2C_WOWLAN_LEN] = {0}; -+ -+ DBG_871X("%s(): bFuncEn =%d\n", __func__, bFuncEn); -+ -+ SET_H2CCMD_AP_WOWLAN_EN(u1H2CAPOffloadCtrlParm, bFuncEn); -+ -+ FillH2CCmd8723B(padapter, H2C_8723B_AP_OFFLOAD, -+ H2C_AP_OFFLOAD_LEN, u1H2CAPOffloadCtrlParm); -+} -+ -+static void rtl8723b_set_AP_FwWoWlan_cmd(struct adapter *padapter, u8 enable) -+{ -+ DBG_871X_LEVEL(_drv_always_, "+%s()+: enable =%d\n", __func__, enable); -+ if (enable) { -+ rtl8723b_set_FwJoinBssRpt_cmd(padapter, RT_MEDIA_CONNECT); -+ issue_beacon(padapter, 0); -+ } -+ -+ rtl8723b_set_FwAPWoWlanCtrl_Cmd(padapter, enable); -+ msleep(10); -+ rtl8723b_set_Fw_AP_Offload_Cmd(padapter, enable); -+ msleep(10); -+ DBG_871X_LEVEL(_drv_always_, "-%s()-\n", __func__); -+ return ; -+} -+ -+void rtl8723b_set_ap_wowlan_cmd(struct adapter *padapter, u8 enable) -+{ -+ rtl8723b_set_AP_FwWoWlan_cmd(padapter, enable); -+} -+#endif /* CONFIG_AP_WOWLAN */ -+ -+/* */ -+/* Description: Fill the reserved packets that FW will use to RSVD page. */ -+/* Now we just send 4 types packet to rsvd page. */ -+/* (1)Beacon, (2)Ps-poll, (3)Null data, (4)ProbeRsp. */ -+/* Input: */ -+/* bDLFinished - false: At the first time we will send all the packets as a large packet to Hw, */ -+/* so we need to set the packet length to total lengh. */ -+/* true: At the second time, we should send the first packet (default:beacon) */ -+/* to Hw again and set the lengh in descriptor to the real beacon lengh. */ -+/* 2009.10.15 by tynli. */ -+static void rtl8723b_set_FwRsvdPagePkt( -+ struct adapter *padapter, bool bDLFinished -+) -+{ -+ struct hal_com_data *pHalData; -+ struct xmit_frame *pcmdframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ struct pwrctrl_priv *pwrctl; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u32 BeaconLength = 0, PSPollLength = 0; -+ u32 NullDataLength = 0, QosNullLength = 0, BTQosNullLength = 0; -+ u8 *ReservedPagePacket; -+ u8 TxDescLen = TXDESC_SIZE, TxDescOffset = TXDESC_OFFSET; -+ u8 TotalPageNum = 0, CurtPktPageNum = 0, RsvdPageNum = 0; -+ u16 BufIndex, PageSize = 128; -+ u32 TotalPacketLen, MaxRsvdPageBufSize = 0; -+ RSVDPAGE_LOC RsvdPageLoc; -+#ifdef CONFIG_WOWLAN -+ u32 ARPLegnth = 0, GTKLegnth = 0; -+ u8 currentip[4]; -+ u8 cur_dot11txpn[8]; -+#ifdef CONFIG_GTK_OL -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ u8 kek[RTW_KEK_LEN]; -+ u8 kck[RTW_KCK_LEN]; -+#endif -+#endif -+ -+ /* DBG_871X("%s---->\n", __func__); */ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pxmitpriv = &padapter->xmitpriv; -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ pwrctl = adapter_to_pwrctl(padapter); -+ -+ RsvdPageNum = BCNQ_PAGE_NUM_8723B + WOWLAN_PAGE_NUM_8723B; -+ MaxRsvdPageBufSize = RsvdPageNum*PageSize; -+ -+ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); -+ if (pcmdframe == NULL) { -+ DBG_871X("%s: alloc ReservedPagePacket fail!\n", __func__); -+ return; -+ } -+ -+ ReservedPagePacket = pcmdframe->buf_addr; -+ memset(&RsvdPageLoc, 0, sizeof(RSVDPAGE_LOC)); -+ -+ /* 3 (1) beacon */ -+ BufIndex = TxDescOffset; -+ ConstructBeacon(padapter, &ReservedPagePacket[BufIndex], &BeaconLength); -+ -+ /* When we count the first page size, we need to reserve description size for the RSVD */ -+ /* packet, it will be filled in front of the packet in TXPKTBUF. */ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + BeaconLength); -+ /* If we don't add 1 more page, the WOWLAN function has a problem. Baron thinks it's a bug of firmware */ -+ if (CurtPktPageNum == 1) -+ CurtPktPageNum += 1; -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* 3 (2) ps-poll */ -+ RsvdPageLoc.LocPsPoll = TotalPageNum; -+ ConstructPSPoll(padapter, &ReservedPagePacket[BufIndex], &PSPollLength); -+ rtl8723b_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], PSPollLength, true, false, false); -+ -+ /* DBG_871X("%s(): HW_VAR_SET_TX_CMD: PS-POLL %p %d\n", */ -+ /* __func__, &ReservedPagePacket[BufIndex-TxDescLen], (PSPollLength+TxDescLen)); */ -+ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + PSPollLength); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* 3 (3) null data */ -+ RsvdPageLoc.LocNullData = TotalPageNum; -+ ConstructNullFunctionData( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ &NullDataLength, -+ get_my_bssid(&pmlmeinfo->network), -+ false, 0, 0, false -+ ); -+ rtl8723b_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], NullDataLength, false, false, false); -+ -+ /* DBG_871X("%s(): HW_VAR_SET_TX_CMD: NULL DATA %p %d\n", */ -+ /* __func__, &ReservedPagePacket[BufIndex-TxDescLen], (NullDataLength+TxDescLen)); */ -+ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + NullDataLength); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* 3 (5) Qos null data */ -+ RsvdPageLoc.LocQosNull = TotalPageNum; -+ ConstructNullFunctionData( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ &QosNullLength, -+ get_my_bssid(&pmlmeinfo->network), -+ true, 0, 0, false -+ ); -+ rtl8723b_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], QosNullLength, false, false, false); -+ -+ /* DBG_871X("%s(): HW_VAR_SET_TX_CMD: QOS NULL DATA %p %d\n", */ -+ /* __func__, &ReservedPagePacket[BufIndex-TxDescLen], (QosNullLength+TxDescLen)); */ -+ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + QosNullLength); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* 3 (6) BT Qos null data */ -+ RsvdPageLoc.LocBTQosNull = TotalPageNum; -+ ConstructNullFunctionData( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ &BTQosNullLength, -+ get_my_bssid(&pmlmeinfo->network), -+ true, 0, 0, false -+ ); -+ rtl8723b_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], BTQosNullLength, false, true, false); -+ -+ /* DBG_871X("%s(): HW_VAR_SET_TX_CMD: BT QOS NULL DATA %p %d\n", */ -+ /* __func__, &ReservedPagePacket[BufIndex-TxDescLen], (BTQosNullLength+TxDescLen)); */ -+ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + BTQosNullLength); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+#ifdef CONFIG_WOWLAN -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) { -+ /* if (pwrctl->wowlan_mode == true) { */ -+ /* BufIndex += (CurtPktPageNum*PageSize); */ -+ -+ /* 3(7) ARP RSP */ -+ rtw_get_current_ip_address(padapter, currentip); -+ RsvdPageLoc.LocArpRsp = TotalPageNum; -+ { -+ ConstructARPResponse( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ &ARPLegnth, -+ currentip -+ ); -+ rtl8723b_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], ARPLegnth, false, false, true); -+ -+ /* DBG_871X("%s(): HW_VAR_SET_TX_CMD: ARP RSP %p %d\n", */ -+ /* __func__, &ReservedPagePacket[BufIndex-TxDescLen], (ARPLegnth+TxDescLen)); */ -+ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + ARPLegnth); -+ } -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* 3(8) SEC IV */ -+ rtw_get_sec_iv(padapter, cur_dot11txpn, get_my_bssid(&pmlmeinfo->network)); -+ RsvdPageLoc.LocRemoteCtrlInfo = TotalPageNum; -+ memcpy(ReservedPagePacket+BufIndex-TxDescLen, cur_dot11txpn, _AES_IV_LEN_); -+ -+ /* DBG_871X("%s(): HW_VAR_SET_TX_CMD: SEC IV %p %d\n", */ -+ /* __func__, &ReservedPagePacket[BufIndex-TxDescLen], _AES_IV_LEN_); */ -+ -+ CurtPktPageNum = (u8)PageNum_128(_AES_IV_LEN_); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+#ifdef CONFIG_GTK_OL -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* if the ap staion info. exists, get the kek, kck from staion info. */ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ memset(kek, 0, RTW_KEK_LEN); -+ memset(kck, 0, RTW_KCK_LEN); -+ DBG_8192C("%s, KEK, KCK download rsvd page all zero\n", __func__); -+ } else { -+ memcpy(kek, psta->kek, RTW_KEK_LEN); -+ memcpy(kck, psta->kck, RTW_KCK_LEN); -+ } -+ -+ /* 3(9) KEK, KCK */ -+ RsvdPageLoc.LocGTKInfo = TotalPageNum; -+ memcpy(ReservedPagePacket+BufIndex-TxDescLen, kck, RTW_KCK_LEN); -+ memcpy(ReservedPagePacket+BufIndex-TxDescLen+RTW_KCK_LEN, kek, RTW_KEK_LEN); -+ -+ /* DBG_871X("%s(): HW_VAR_SET_TX_CMD: KEK KCK %p %d\n", */ -+ /* __func__, &ReservedPagePacket[BufIndex-TxDescLen], (TxDescLen + RTW_KCK_LEN + RTW_KEK_LEN)); */ -+ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + RTW_KCK_LEN + RTW_KEK_LEN); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* 3(10) GTK Response */ -+ RsvdPageLoc.LocGTKRsp = TotalPageNum; -+ ConstructGTKResponse( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ >KLegnth -+ ); -+ -+ rtl8723b_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], GTKLegnth, false, false, true); -+ /* DBG_871X("%s(): HW_VAR_SET_TX_CMD: GTK RSP %p %d\n", */ -+ /* __func__, &ReservedPagePacket[BufIndex-TxDescLen], (TxDescLen + GTKLegnth)); */ -+ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + GTKLegnth); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* below page is empty for GTK extension memory */ -+ /* 3(11) GTK EXT MEM */ -+ RsvdPageLoc.LocGTKEXTMEM = TotalPageNum; -+ -+ CurtPktPageNum = 2; -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ TotalPacketLen = BufIndex-TxDescLen + 256; /* extension memory for FW */ -+#else -+ TotalPacketLen = BufIndex-TxDescLen + sizeof (union pn48); /* IV len */ -+#endif /* CONFIG_GTK_OL */ -+ } else -+#endif /* CONFIG_WOWLAN */ -+ { -+#ifdef CONFIG_PNO_SUPPORT -+ if (pwrctl->pno_in_resume == false && pwrctl->pno_inited == true) { -+ /* Probe Request */ -+ RsvdPageLoc.LocProbePacket = TotalPageNum; -+ ConstructProbeReq( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ &ProbeReqLength); -+ -+ rtl8723b_fill_fake_txdesc(padapter, -+ &ReservedPagePacket[BufIndex-TxDescLen], -+ ProbeReqLength, false, false, false); -+#ifdef CONFIG_PNO_SET_DEBUG -+ { -+ int gj; -+ printk("probe req pkt =>\n"); -+ for (gj = 0; gj < ProbeReqLength+TxDescLen; gj++) { -+ printk(" %02x ", ReservedPagePacket[BufIndex-TxDescLen+gj]); -+ if ((gj+1)%8 == 0) -+ printk("\n"); -+ } -+ printk(" <=end\n"); -+ } -+#endif -+ CurtPktPageNum = -+ (u8)PageNum_128(TxDescLen + ProbeReqLength); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* PNO INFO Page */ -+ RsvdPageLoc.LocPNOInfo = TotalPageNum; -+ ConstructPnoInfo(padapter, &ReservedPagePacket[BufIndex-TxDescLen], &PNOLength); -+#ifdef CONFIG_PNO_SET_DEBUG -+ { -+ int gj; -+ printk("PNO pkt =>\n"); -+ for (gj = 0; gj < PNOLength; gj++) { -+ printk(" %02x ", ReservedPagePacket[BufIndex-TxDescLen+gj]); -+ if ((gj + 1)%8 == 0) -+ printk("\n"); -+ } -+ printk(" <=end\n"); -+ } -+#endif -+ -+ CurtPktPageNum = (u8)PageNum_128(PNOLength); -+ TotalPageNum += CurtPktPageNum; -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* SSID List Page */ -+ RsvdPageLoc.LocSSIDInfo = TotalPageNum; -+ ConstructSSIDList(padapter, &ReservedPagePacket[BufIndex-TxDescLen], &SSIDLegnth); -+#ifdef CONFIG_PNO_SET_DEBUG -+ { -+ int gj; -+ printk("SSID list pkt =>\n"); -+ for (gj = 0; gj < SSIDLegnth; gj++) { -+ printk(" %02x ", ReservedPagePacket[BufIndex-TxDescLen+gj]); -+ if ((gj + 1)%8 == 0) -+ printk("\n"); -+ } -+ printk(" <=end\n"); -+ } -+#endif -+ CurtPktPageNum = (u8)PageNum_128(SSIDLegnth); -+ TotalPageNum += CurtPktPageNum; -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* Scan Info Page */ -+ RsvdPageLoc.LocScanInfo = TotalPageNum; -+ ConstructScanInfo(padapter, &ReservedPagePacket[BufIndex-TxDescLen], &ScanInfoLength); -+#ifdef CONFIG_PNO_SET_DEBUG -+ { -+ int gj; -+ printk("Scan info pkt =>\n"); -+ for (gj = 0; gj < ScanInfoLength; gj++) { -+ printk(" %02x ", ReservedPagePacket[BufIndex-TxDescLen+gj]); -+ if ((gj + 1)%8 == 0) -+ printk("\n"); -+ } -+ printk(" <=end\n"); -+ } -+#endif -+ CurtPktPageNum = (u8)PageNum_128(ScanInfoLength); -+ TotalPageNum += CurtPktPageNum; -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ TotalPacketLen = BufIndex + ScanInfoLength; -+ } else { -+ TotalPacketLen = BufIndex + BTQosNullLength; -+ } -+#else /* CONFIG_PNO_SUPPORT */ -+ TotalPacketLen = BufIndex + BTQosNullLength; -+#endif -+ } -+ -+ if (TotalPacketLen > MaxRsvdPageBufSize) { -+ DBG_871X("%s(): ERROR: The rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n", __func__, -+ TotalPacketLen, MaxRsvdPageBufSize); -+ goto error; -+ } else { -+ /* update attribute */ -+ pattrib = &pcmdframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->qsel = 0x10; -+ pattrib->pktlen = pattrib->last_txcmdsz = TotalPacketLen - TxDescOffset; -+ dump_mgntframe_and_wait(padapter, pcmdframe, 100); -+ } -+ -+ DBG_871X("%s: Set RSVD page location to Fw , TotalPacketLen(%d), TotalPageNum(%d)\n", __func__, TotalPacketLen, TotalPageNum); -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) { -+ rtl8723b_set_FwRsvdPage_cmd(padapter, &RsvdPageLoc); -+ rtl8723b_set_FwAoacRsvdPage_cmd(padapter, &RsvdPageLoc); -+ } else { -+ rtl8723b_set_FwAoacRsvdPage_cmd(padapter, &RsvdPageLoc); -+#ifdef CONFIG_PNO_SUPPORT -+ if (pwrctl->pno_in_resume) -+ rtl8723b_set_FwScanOffloadInfo_cmd(padapter, -+ &RsvdPageLoc, 0); -+ else -+ rtl8723b_set_FwScanOffloadInfo_cmd(padapter, -+ &RsvdPageLoc, 1); -+#endif -+ } -+ return; -+ -+error: -+ -+ rtw_free_xmitframe(pxmitpriv, pcmdframe); -+} -+ -+#ifdef CONFIG_AP_WOWLAN -+/* */ -+/* Description: Fill the reserved packets that FW will use to RSVD page. */ -+/* Now we just send 2 types packet to rsvd page. (1)Beacon, (2)ProbeRsp. */ -+/* */ -+/* Input: bDLFinished */ -+/* */ -+/* false: At the first time we will send all the packets as a large packet to Hw, */ -+/* so we need to set the packet length to total lengh. */ -+/* */ -+/* true: At the second time, we should send the first packet (default:beacon) */ -+/* to Hw again and set the lengh in descriptor to the real beacon lengh. */ -+/* 2009.10.15 by tynli. */ -+static void rtl8723b_set_AP_FwRsvdPagePkt( -+ struct adapter *padapter, bool bDLFinished -+) -+{ -+ struct hal_com_data *pHalData; -+ struct xmit_frame *pcmdframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ struct pwrctrl_priv *pwrctl; -+ u32 BeaconLength = 0, ProbeRspLength = 0; -+ u8 *ReservedPagePacket; -+ u8 TxDescLen = TXDESC_SIZE, TxDescOffset = TXDESC_OFFSET; -+ u8 TotalPageNum = 0, CurtPktPageNum = 0, RsvdPageNum = 0; -+ u8 currentip[4]; -+ u16 BufIndex, PageSize = 128; -+ u32 TotalPacketLen = 0, MaxRsvdPageBufSize = 0; -+ RSVDPAGE_LOC RsvdPageLoc; -+ -+ /* DBG_871X("%s---->\n", __func__); */ -+ DBG_8192C("+" FUNC_ADPT_FMT ": iface_type =%d\n", -+ FUNC_ADPT_ARG(padapter), get_iface_type(padapter)); -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pxmitpriv = &padapter->xmitpriv; -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ pwrctl = adapter_to_pwrctl(padapter); -+ -+ RsvdPageNum = BCNQ_PAGE_NUM_8723B + AP_WOWLAN_PAGE_NUM_8723B; -+ MaxRsvdPageBufSize = RsvdPageNum*PageSize; -+ -+ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); -+ if (pcmdframe == NULL) { -+ DBG_871X("%s: alloc ReservedPagePacket fail!\n", __func__); -+ return; -+ } -+ -+ ReservedPagePacket = pcmdframe->buf_addr; -+ memset(&RsvdPageLoc, 0, sizeof(RSVDPAGE_LOC)); -+ -+ /* 3 (1) beacon */ -+ BufIndex = TxDescOffset; -+ ConstructBeacon(padapter, &ReservedPagePacket[BufIndex], &BeaconLength); -+ -+ /* When we count the first page size, we need to reserve description size for the RSVD */ -+ /* packet, it will be filled in front of the packet in TXPKTBUF. */ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + BeaconLength); -+ /* If we don't add 1 more page, the WOWLAN function has a problem. Baron thinks it's a bug of firmware */ -+ if (CurtPktPageNum == 1) -+ CurtPktPageNum += 1; -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* 2 (4) probe response */ -+ RsvdPageLoc.LocProbeRsp = TotalPageNum; -+ -+ rtw_get_current_ip_address(padapter, currentip); -+ -+ ConstructProbeRsp( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ &ProbeRspLength, -+ currentip, -+ false); -+ rtl8723b_fill_fake_txdesc(padapter, -+ &ReservedPagePacket[BufIndex-TxDescLen], -+ ProbeRspLength, -+ false, false, false); -+ -+ DBG_871X("%s(): HW_VAR_SET_TX_CMD: PROBE RSP %p %d\n", -+ __func__, &ReservedPagePacket[BufIndex-TxDescLen], -+ (ProbeRspLength+TxDescLen)); -+ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + ProbeRspLength); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ TotalPacketLen = BufIndex + ProbeRspLength; -+ -+ if (TotalPacketLen > MaxRsvdPageBufSize) { -+ DBG_871X("%s(): ERROR: The rsvd page size is not enough \ -+ !!TotalPacketLen %d, MaxRsvdPageBufSize %d\n", -+ __func__, TotalPacketLen, MaxRsvdPageBufSize); -+ goto error; -+ } else { -+ /* update attribute */ -+ pattrib = &pcmdframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->qsel = 0x10; -+ pattrib->pktlen = TotalPacketLen - TxDescOffset; -+ pattrib->last_txcmdsz = TotalPacketLen - TxDescOffset; -+ dump_mgntframe_and_wait(padapter, pcmdframe, 100); -+ } -+ -+ DBG_871X("%s: Set RSVD page location to Fw , TotalPacketLen(%d), TotalPageNum(%d)\n", __func__, TotalPacketLen, TotalPageNum); -+ rtl8723b_set_ap_wow_rsvdpage_cmd(padapter, &RsvdPageLoc); -+ -+ return; -+error: -+ rtw_free_xmitframe(pxmitpriv, pcmdframe); -+} -+#endif /* CONFIG_AP_WOWLAN */ -+ -+void rtl8723b_download_rsvd_page(struct adapter *padapter, u8 mstatus) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+#ifdef CONFIG_AP_WOWLAN -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+#endif -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ bool bcn_valid = false; -+ u8 DLBcnCount = 0; -+ u32 poll = 0; -+ u8 val8; -+ -+ DBG_8192C("+" FUNC_ADPT_FMT ": iface_type =%d mstatus(%x)\n", -+ FUNC_ADPT_ARG(padapter), get_iface_type(padapter), mstatus); -+ -+ if (mstatus == RT_MEDIA_CONNECT) { -+ bool bRecover = false; -+ u8 v8; -+ -+ /* We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. */ -+ /* Suggested by filen. Added by tynli. */ -+ rtw_write16(padapter, REG_BCN_PSR_RPT, (0xC000|pmlmeinfo->aid)); -+ -+ /* set REG_CR bit 8 */ -+ v8 = rtw_read8(padapter, REG_CR+1); -+ v8 |= BIT(0); /* ENSWBCN */ -+ rtw_write8(padapter, REG_CR+1, v8); -+ -+ /* Disable Hw protection for a time which revserd for Hw sending beacon. */ -+ /* Fix download reserved page packet fail that access collision with the protection time. */ -+ /* 2010.05.11. Added by tynli. */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 &= ~EN_BCN_FUNCTION; -+ val8 |= DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ /* Set FWHW_TXQ_CTRL 0x422[6]= 0 to tell Hw the packet is not a real beacon frame. */ -+ if (pHalData->RegFwHwTxQCtrl & BIT(6)) -+ bRecover = true; -+ -+ /* To tell Hw the packet is not a real beacon frame. */ -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, pHalData->RegFwHwTxQCtrl & ~BIT(6)); -+ pHalData->RegFwHwTxQCtrl &= ~BIT(6); -+ -+ /* Clear beacon valid check bit. */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ -+ DLBcnCount = 0; -+ poll = 0; -+ do { -+#ifdef CONFIG_AP_WOWLAN -+ if (pwrpriv->wowlan_ap_mode) -+ rtl8723b_set_AP_FwRsvdPagePkt(padapter, 0); -+ else -+ rtl8723b_set_FwRsvdPagePkt(padapter, 0); -+#else -+ /* download rsvd page. */ -+ rtl8723b_set_FwRsvdPagePkt(padapter, 0); -+#endif -+ DLBcnCount++; -+ do { -+ yield(); -+ /* mdelay(10); */ -+ /* check rsvd page download OK. */ -+ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8 *)(&bcn_valid)); -+ poll++; -+ } while (!bcn_valid && (poll%10) != 0 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); -+ -+ } while (!bcn_valid && DLBcnCount <= 100 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); -+ -+ if (padapter->bSurpriseRemoved || padapter->bDriverStopped) { -+ } else if (!bcn_valid) -+ DBG_871X(ADPT_FMT": 1 DL RSVD page failed! DLBcnCount:%u, poll:%u\n", -+ ADPT_ARG(padapter), DLBcnCount, poll); -+ else { -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ pwrctl->fw_psmode_iface_id = padapter->iface_id; -+ DBG_871X(ADPT_FMT": 1 DL RSVD page success! DLBcnCount:%u, poll:%u\n", -+ ADPT_ARG(padapter), DLBcnCount, poll); -+ } -+ -+ /* 2010.05.11. Added by tynli. */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 |= EN_BCN_FUNCTION; -+ val8 &= ~DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ /* To make sure that if there exists an adapter which would like to send beacon. */ -+ /* If exists, the origianl value of 0x422[6] will be 1, we should check this to */ -+ /* prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ -+ /* the beacon cannot be sent by HW. */ -+ /* 2010.06.23. Added by tynli. */ -+ if (bRecover) { -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, pHalData->RegFwHwTxQCtrl | BIT(6)); -+ pHalData->RegFwHwTxQCtrl |= BIT(6); -+ } -+ -+ /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ -+ v8 = rtw_read8(padapter, REG_CR+1); -+ v8 &= ~BIT(0); /* ~ENSWBCN */ -+ rtw_write8(padapter, REG_CR+1, v8); -+ } -+} -+ -+void rtl8723b_set_rssi_cmd(struct adapter *padapter, u8 *param) -+{ -+ rtl8723b_set_FwRssiSetting_cmd(padapter, param); -+} -+ -+void rtl8723b_set_FwJoinBssRpt_cmd(struct adapter *padapter, u8 mstatus) -+{ -+ if (mstatus == 1) -+ rtl8723b_download_rsvd_page(padapter, RT_MEDIA_CONNECT); -+} -+ -+/* arg[0] = macid */ -+/* arg[1] = raid */ -+/* arg[2] = shortGIrate */ -+/* arg[3] = init_rate */ -+void rtl8723b_Add_RateATid( -+ struct adapter *padapter, -+ u32 bitmap, -+ u8 *arg, -+ u8 rssi_level -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_info *psta; -+ u8 mac_id = arg[0]; -+ u8 raid = arg[1]; -+ u8 shortGI = arg[2]; -+ u8 bw; -+ u32 mask = bitmap&0x0FFFFFFF; -+ -+ psta = pmlmeinfo->FW_sta_info[mac_id].psta; -+ if (psta == NULL) -+ return; -+ -+ bw = psta->bw_mode; -+ -+ if (rssi_level != DM_RATR_STA_INIT) -+ mask = ODM_Get_Rate_Bitmap(&pHalData->odmpriv, mac_id, mask, rssi_level); -+ -+ DBG_871X("%s(): mac_id =%d raid = 0x%x bw =%d mask = 0x%x\n", __func__, mac_id, raid, bw, mask); -+ rtl8723b_set_FwMacIdConfig_cmd(padapter, mac_id, raid, bw, shortGI, mask); -+} -+ -+static void ConstructBtNullFunctionData( -+ struct adapter *padapter, -+ u8 *pframe, -+ u32 *pLength, -+ u8 *StaAddr, -+ u8 bQoS, -+ u8 AC, -+ u8 bEosp, -+ u8 bForcePowerSave -+) -+{ -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ u32 pktlen; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ u8 bssid[ETH_ALEN]; -+ -+ -+ DBG_871X("+" FUNC_ADPT_FMT ": qos =%d eosp =%d ps =%d\n", -+ FUNC_ADPT_ARG(padapter), bQoS, bEosp, bForcePowerSave); -+ -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ if (NULL == StaAddr) { -+ memcpy(bssid, myid(&padapter->eeprompriv), ETH_ALEN); -+ StaAddr = bssid; -+ } -+ -+ fctrl = &pwlanhdr->frame_control; -+ *fctrl = 0; -+ if (bForcePowerSave) -+ SetPwrMgt(fctrl); -+ -+ SetFrDs(fctrl); -+ memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ memcpy(pwlanhdr->addr2, myid(&padapter->eeprompriv), ETH_ALEN); -+ memcpy(pwlanhdr->addr3, myid(&padapter->eeprompriv), ETH_ALEN); -+ -+ SetDuration(pwlanhdr, 0); -+ SetSeqNum(pwlanhdr, 0); -+ -+ if (bQoS == true) { -+ struct ieee80211_qos_hdr *pwlanqoshdr; -+ -+ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); -+ -+ pwlanqoshdr = (struct ieee80211_qos_hdr *)pframe; -+ SetPriority(&pwlanqoshdr->qos_ctrl, AC); -+ SetEOSP(&pwlanqoshdr->qos_ctrl, bEosp); -+ -+ pktlen = sizeof(struct ieee80211_qos_hdr); -+ } else { -+ SetFrameSubType(pframe, WIFI_DATA_NULL); -+ -+ pktlen = sizeof(struct ieee80211_hdr_3addr); -+ } -+ -+ *pLength = pktlen; -+} -+ -+static void SetFwRsvdPagePkt_BTCoex(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ struct xmit_frame *pcmdframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ u32 BeaconLength = 0; -+ u32 BTQosNullLength = 0; -+ u8 *ReservedPagePacket; -+ u8 TxDescLen, TxDescOffset; -+ u8 TotalPageNum = 0, CurtPktPageNum = 0, RsvdPageNum = 0; -+ u16 BufIndex, PageSize; -+ u32 TotalPacketLen, MaxRsvdPageBufSize = 0; -+ RSVDPAGE_LOC RsvdPageLoc; -+ -+ -+/* DBG_8192C("+" FUNC_ADPT_FMT "\n", FUNC_ADPT_ARG(padapter)); */ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pxmitpriv = &padapter->xmitpriv; -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ TxDescLen = TXDESC_SIZE; -+ TxDescOffset = TXDESC_OFFSET; -+ PageSize = PAGE_SIZE_TX_8723B; -+ -+ RsvdPageNum = BCNQ_PAGE_NUM_8723B; -+ MaxRsvdPageBufSize = RsvdPageNum*PageSize; -+ -+ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); -+ if (pcmdframe == NULL) { -+ DBG_8192C("%s: alloc ReservedPagePacket fail!\n", __func__); -+ return; -+ } -+ -+ ReservedPagePacket = pcmdframe->buf_addr; -+ memset(&RsvdPageLoc, 0, sizeof(RSVDPAGE_LOC)); -+ -+ /* 3 (1) beacon */ -+ BufIndex = TxDescOffset; -+ ConstructBeacon(padapter, &ReservedPagePacket[BufIndex], &BeaconLength); -+ -+ /* When we count the first page size, we need to reserve description size for the RSVD */ -+ /* packet, it will be filled in front of the packet in TXPKTBUF. */ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + BeaconLength); -+ /* If we don't add 1 more page, the WOWLAN function has a problem. Baron thinks it's a bug of firmware */ -+ if (CurtPktPageNum == 1) -+ CurtPktPageNum += 1; -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* Jump to lastest page */ -+ if (BufIndex < (MaxRsvdPageBufSize - PageSize)) { -+ BufIndex = TxDescOffset + (MaxRsvdPageBufSize - PageSize); -+ TotalPageNum = BCNQ_PAGE_NUM_8723B - 1; -+ } -+ -+ /* 3 (6) BT Qos null data */ -+ RsvdPageLoc.LocBTQosNull = TotalPageNum; -+ ConstructBtNullFunctionData( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ &BTQosNullLength, -+ NULL, -+ true, 0, 0, false -+ ); -+ rtl8723b_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], BTQosNullLength, false, true, false); -+ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + BTQosNullLength); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ TotalPacketLen = BufIndex + BTQosNullLength; -+ if (TotalPacketLen > MaxRsvdPageBufSize) { -+ DBG_8192C(FUNC_ADPT_FMT ": ERROR: The rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n", -+ FUNC_ADPT_ARG(padapter), TotalPacketLen, MaxRsvdPageBufSize); -+ goto error; -+ } -+ -+ /* update attribute */ -+ pattrib = &pcmdframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->qsel = 0x10; -+ pattrib->pktlen = pattrib->last_txcmdsz = TotalPacketLen - TxDescOffset; -+ dump_mgntframe_and_wait(padapter, pcmdframe, 100); -+ -+/* DBG_8192C(FUNC_ADPT_FMT ": Set RSVD page location to Fw, TotalPacketLen(%d), TotalPageNum(%d)\n", */ -+/* FUNC_ADPT_ARG(padapter), TotalPacketLen, TotalPageNum); */ -+ rtl8723b_set_FwRsvdPage_cmd(padapter, &RsvdPageLoc); -+ rtl8723b_set_FwAoacRsvdPage_cmd(padapter, &RsvdPageLoc); -+ -+ return; -+ -+error: -+ rtw_free_xmitframe(pxmitpriv, pcmdframe); -+} -+ -+void rtl8723b_download_BTCoex_AP_mode_rsvd_page(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ u8 bRecover = false; -+ u8 bcn_valid = false; -+ u8 DLBcnCount = 0; -+ u32 poll = 0; -+ u8 val8; -+ -+ -+ DBG_8192C("+" FUNC_ADPT_FMT ": iface_type =%d fw_state = 0x%08X\n", -+ FUNC_ADPT_ARG(padapter), get_iface_type(padapter), get_fwstate(&padapter->mlmepriv)); -+ -+#ifdef CONFIG_DEBUG -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == false) { -+ DBG_8192C(FUNC_ADPT_FMT ": [WARNING] not in AP mode!!\n", -+ FUNC_ADPT_ARG(padapter)); -+ } -+#endif /* CONFIG_DEBUG */ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ /* We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. */ -+ /* Suggested by filen. Added by tynli. */ -+ rtw_write16(padapter, REG_BCN_PSR_RPT, (0xC000|pmlmeinfo->aid)); -+ -+ /* set REG_CR bit 8 */ -+ val8 = rtw_read8(padapter, REG_CR+1); -+ val8 |= BIT(0); /* ENSWBCN */ -+ rtw_write8(padapter, REG_CR+1, val8); -+ -+ /* Disable Hw protection for a time which revserd for Hw sending beacon. */ -+ /* Fix download reserved page packet fail that access collision with the protection time. */ -+ /* 2010.05.11. Added by tynli. */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 &= ~EN_BCN_FUNCTION; -+ val8 |= DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ /* Set FWHW_TXQ_CTRL 0x422[6]= 0 to tell Hw the packet is not a real beacon frame. */ -+ if (pHalData->RegFwHwTxQCtrl & BIT(6)) -+ bRecover = true; -+ -+ /* To tell Hw the packet is not a real beacon frame. */ -+ pHalData->RegFwHwTxQCtrl &= ~BIT(6); -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, pHalData->RegFwHwTxQCtrl); -+ -+ /* Clear beacon valid check bit. */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ -+ DLBcnCount = 0; -+ poll = 0; -+ do { -+ SetFwRsvdPagePkt_BTCoex(padapter); -+ DLBcnCount++; -+ do { -+ yield(); -+/* mdelay(10); */ -+ /* check rsvd page download OK. */ -+ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, &bcn_valid); -+ poll++; -+ } while (!bcn_valid && (poll%10) != 0 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); -+ } while (!bcn_valid && (DLBcnCount <= 100) && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); -+ -+ if (true == bcn_valid) { -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ pwrctl->fw_psmode_iface_id = padapter->iface_id; -+ DBG_8192C(ADPT_FMT": DL RSVD page success! DLBcnCount:%d, poll:%d\n", -+ ADPT_ARG(padapter), DLBcnCount, poll); -+ } else { -+ DBG_8192C(ADPT_FMT": DL RSVD page fail! DLBcnCount:%d, poll:%d\n", -+ ADPT_ARG(padapter), DLBcnCount, poll); -+ DBG_8192C(ADPT_FMT": DL RSVD page fail! bSurpriseRemoved =%d\n", -+ ADPT_ARG(padapter), padapter->bSurpriseRemoved); -+ DBG_8192C(ADPT_FMT": DL RSVD page fail! bDriverStopped =%d\n", -+ ADPT_ARG(padapter), padapter->bDriverStopped); -+ } -+ -+ /* 2010.05.11. Added by tynli. */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 |= EN_BCN_FUNCTION; -+ val8 &= ~DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ /* To make sure that if there exists an adapter which would like to send beacon. */ -+ /* If exists, the origianl value of 0x422[6] will be 1, we should check this to */ -+ /* prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ -+ /* the beacon cannot be sent by HW. */ -+ /* 2010.06.23. Added by tynli. */ -+ if (bRecover) { -+ pHalData->RegFwHwTxQCtrl |= BIT(6); -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, pHalData->RegFwHwTxQCtrl); -+ } -+ -+ /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ -+ val8 = rtw_read8(padapter, REG_CR+1); -+ val8 &= ~BIT(0); /* ~ENSWBCN */ -+ rtw_write8(padapter, REG_CR+1, val8); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/rtl8723b_dm.c linux/3rdparty/rtl8723bs/hal/rtl8723b_dm.c ---- linux.old/3rdparty/rtl8723bs/hal/rtl8723b_dm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/rtl8723b_dm.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,300 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/* Description: */ -+/* This file is for 92CE/92CU dynamic mechanism only */ -+ -+#define _RTL8723B_DM_C_ -+ -+#include -+#include -+#include -+ -+/* Global var */ -+ -+static void dm_CheckStatistics(struct adapter *Adapter) -+{ -+} -+/* */ -+/* functions */ -+/* */ -+static void Init_ODM_ComInfo_8723b(struct adapter *Adapter) -+{ -+ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ u8 cut_ver, fab_ver; -+ -+ /* */ -+ /* Init Value */ -+ /* */ -+ memset(pDM_Odm, 0, sizeof(*pDM_Odm)); -+ -+ pDM_Odm->Adapter = Adapter; -+#define ODM_CE 0x04 -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PLATFORM, ODM_CE); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_INTERFACE, RTW_SDIO); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PACKAGE_TYPE, pHalData->PackageType); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_IC_TYPE, ODM_RTL8723B); -+ -+ fab_ver = ODM_TSMC; -+ cut_ver = ODM_CUT_A; -+ -+ DBG_871X("%s(): fab_ver =%d cut_ver =%d\n", __func__, fab_ver, cut_ver); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_FAB_VER, fab_ver); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_CUT_VER, cut_ver); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_MP_TEST_CHIP, IS_NORMAL_CHIP(pHalData->VersionID)); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PATCH_ID, pHalData->CustomerID); -+ /* ODM_CMNINFO_BINHCT_TEST only for MP Team */ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BWIFI_TEST, Adapter->registrypriv.wifi_spec); -+ -+ -+ if (pHalData->rf_type == RF_1T1R) { -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_1T1R); -+ } else if (pHalData->rf_type == RF_2T2R) { -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T2R); -+ } else if (pHalData->rf_type == RF_1T2R) { -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_1T2R); -+ } -+ -+ pdmpriv->InitODMFlag = ODM_RF_CALIBRATION|ODM_RF_TX_PWR_TRACK; -+ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pdmpriv->InitODMFlag); -+} -+ -+static void Update_ODM_ComInfo_8723b(struct adapter *Adapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(Adapter); -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ int i; -+ u8 zero = 0; -+ -+ pdmpriv->InitODMFlag = 0 -+ | ODM_BB_DIG -+ | ODM_BB_RA_MASK -+ | ODM_BB_DYNAMIC_TXPWR -+ | ODM_BB_FA_CNT -+ | ODM_BB_RSSI_MONITOR -+ | ODM_BB_CCK_PD -+ | ODM_BB_PWR_SAVE -+ | ODM_BB_CFO_TRACKING -+ | ODM_MAC_EDCA_TURBO -+ | ODM_RF_TX_PWR_TRACK -+ | ODM_RF_CALIBRATION -+#ifdef CONFIG_ODM_ADAPTIVITY -+ | ODM_BB_ADAPTIVITY -+#endif -+ ; -+ -+ /* */ -+ /* Pointer reference */ -+ /* */ -+ /* ODM_CMNINFO_MAC_PHY_MODE pHalData->MacPhyMode92D */ -+ /* ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_MAC_PHY_MODE,&(pDM_Odm->u8_temp)); */ -+ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pdmpriv->InitODMFlag); -+ -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_TX_UNI, &(dvobj->traffic_stat.tx_bytes)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_RX_UNI, &(dvobj->traffic_stat.rx_bytes)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_WM_MODE, &(pmlmeext->cur_wireless_mode)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SEC_CHNL_OFFSET, &(pHalData->nCur40MhzPrimeSC)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SEC_MODE, &(Adapter->securitypriv.dot11PrivacyAlgrthm)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BW, &(pHalData->CurrentChannelBW)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_CHNL, &(pHalData->CurrentChannel)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_NET_CLOSED, &(Adapter->net_closed)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_MP_MODE, &zero); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BAND, &(pHalData->CurrentBandType)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_FORCED_IGI_LB, &(pHalData->u1ForcedIgiLb)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_FORCED_RATE, &(pHalData->ForcedDataRate)); -+ -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SCAN, &(pmlmepriv->bScanInProcess)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_POWER_SAVING, &(pwrctrlpriv->bpower_saving)); -+ -+ -+ for (i = 0; i < NUM_STA; i++) -+ ODM_CmnInfoPtrArrayHook(pDM_Odm, ODM_CMNINFO_STA_STATUS, i, NULL); -+} -+ -+void rtl8723b_InitHalDm(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ pdmpriv->DM_Type = DM_Type_ByDriver; -+ pdmpriv->DMFlag = DYNAMIC_FUNC_DISABLE; -+ -+ pdmpriv->DMFlag |= DYNAMIC_FUNC_BT; -+ -+ pdmpriv->InitDMFlag = pdmpriv->DMFlag; -+ -+ Update_ODM_ComInfo_8723b(Adapter); -+ -+ ODM_DMInit(pDM_Odm); -+} -+ -+void rtl8723b_HalDmWatchDog(struct adapter *Adapter) -+{ -+ bool bFwCurrentInPSMode = false; -+ bool bFwPSAwake = true; -+ u8 hw_init_completed = false; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ hw_init_completed = Adapter->hw_init_completed; -+ -+ if (hw_init_completed == false) -+ goto skip_dm; -+ -+ bFwCurrentInPSMode = adapter_to_pwrctl(Adapter)->bFwCurrentInPSMode; -+ rtw_hal_get_hwreg(Adapter, HW_VAR_FWLPS_RF_ON, (u8 *)(&bFwPSAwake)); -+ -+ if ( -+ (hw_init_completed == true) && -+ ((!bFwCurrentInPSMode) && bFwPSAwake) -+ ) { -+ /* */ -+ /* Calculate Tx/Rx statistics. */ -+ /* */ -+ dm_CheckStatistics(Adapter); -+ rtw_hal_check_rxfifo_full(Adapter); -+ } -+ -+ /* ODM */ -+ if (hw_init_completed == true) { -+ u8 bLinked = false; -+ u8 bsta_state = false; -+ u8 bBtDisabled = true; -+ -+ if (rtw_linked_check(Adapter)) { -+ bLinked = true; -+ if (check_fwstate(&Adapter->mlmepriv, WIFI_STATION_STATE)) -+ bsta_state = true; -+ } -+ -+ ODM_CmnInfoUpdate(&pHalData->odmpriv, ODM_CMNINFO_LINK, bLinked); -+ ODM_CmnInfoUpdate(&pHalData->odmpriv, ODM_CMNINFO_STATION_STATE, bsta_state); -+ -+ /* ODM_CmnInfoUpdate(&pHalData->odmpriv , ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM); */ -+ -+ bBtDisabled = rtw_btcoex_IsBtDisabled(Adapter); -+ -+ ODM_CmnInfoUpdate(&pHalData->odmpriv, ODM_CMNINFO_BT_ENABLED, ((bBtDisabled == true)?false:true)); -+ -+ ODM_DMWatchdog(&pHalData->odmpriv); -+ } -+ -+skip_dm: -+ return; -+} -+ -+void rtl8723b_hal_dm_in_lps(struct adapter *padapter) -+{ -+ u32 PWDB_rssi = 0; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+ -+ DBG_871X("%s, RSSI_Min =%d\n", __func__, pDM_Odm->RSSI_Min); -+ -+ /* update IGI */ -+ ODM_Write_DIG(pDM_Odm, pDM_Odm->RSSI_Min); -+ -+ -+ /* set rssi to fw */ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta && (psta->rssi_stat.UndecoratedSmoothedPWDB > 0)) { -+ PWDB_rssi = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB<<16)); -+ -+ rtl8723b_set_rssi_cmd(padapter, (u8 *)&PWDB_rssi); -+ } -+ -+} -+ -+void rtl8723b_HalDmWatchDog_in_LPS(struct adapter *Adapter) -+{ -+ u8 bLinked = false; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ struct sta_priv *pstapriv = &Adapter->stapriv; -+ struct sta_info *psta = NULL; -+ -+ if (Adapter->hw_init_completed == false) -+ goto skip_lps_dm; -+ -+ -+ if (rtw_linked_check(Adapter)) -+ bLinked = true; -+ -+ ODM_CmnInfoUpdate(&pHalData->odmpriv, ODM_CMNINFO_LINK, bLinked); -+ -+ if (bLinked == false) -+ goto skip_lps_dm; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)) -+ goto skip_lps_dm; -+ -+ -+ /* ODM_DMWatchdog(&pHalData->odmpriv); */ -+ /* Do DIG by RSSI In LPS-32K */ -+ -+ /* 1 Find MIN-RSSI */ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) -+ goto skip_lps_dm; -+ -+ pdmpriv->EntryMinUndecoratedSmoothedPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ DBG_871X("CurIGValue =%d, EntryMinUndecoratedSmoothedPWDB = %d\n", pDM_DigTable->CurIGValue, pdmpriv->EntryMinUndecoratedSmoothedPWDB); -+ -+ if (pdmpriv->EntryMinUndecoratedSmoothedPWDB <= 0) -+ goto skip_lps_dm; -+ -+ pdmpriv->MinUndecoratedPWDBForDM = pdmpriv->EntryMinUndecoratedSmoothedPWDB; -+ -+ pDM_Odm->RSSI_Min = pdmpriv->MinUndecoratedPWDBForDM; -+ -+ /* if (pDM_DigTable->CurIGValue != pDM_Odm->RSSI_Min) */ -+ if ( -+ (pDM_DigTable->CurIGValue > pDM_Odm->RSSI_Min + 5) || -+ (pDM_DigTable->CurIGValue < pDM_Odm->RSSI_Min - 5) -+ ) -+ rtw_dm_in_lps_wk_cmd(Adapter); -+ -+ -+skip_lps_dm: -+ -+ return; -+ -+} -+ -+void rtl8723b_init_dm_priv(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ -+ memset(pdmpriv, 0, sizeof(struct dm_priv)); -+ Init_ODM_ComInfo_8723b(Adapter); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/rtl8723b_hal_init.c linux/3rdparty/rtl8723bs/hal/rtl8723b_hal_init.c ---- linux.old/3rdparty/rtl8723bs/hal/rtl8723b_hal_init.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/rtl8723b_hal_init.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,4546 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _HAL_INIT_C_ -+ -+#include -+#include -+#include -+#include -+#include -+#include "hal_com_h2c.h" -+ -+static void _FWDownloadEnable(struct adapter *padapter, bool enable) -+{ -+ u8 tmp, count = 0; -+ -+ if (enable) { -+ /* 8051 enable */ -+ tmp = rtw_read8(padapter, REG_SYS_FUNC_EN+1); -+ rtw_write8(padapter, REG_SYS_FUNC_EN+1, tmp|0x04); -+ -+ tmp = rtw_read8(padapter, REG_MCUFWDL); -+ rtw_write8(padapter, REG_MCUFWDL, tmp|0x01); -+ -+ do { -+ tmp = rtw_read8(padapter, REG_MCUFWDL); -+ if (tmp & 0x01) -+ break; -+ rtw_write8(padapter, REG_MCUFWDL, tmp|0x01); -+ msleep(1); -+ } while (count++ < 100); -+ -+ if (count > 0) -+ DBG_871X("%s: !!!!!!!!Write 0x80 Fail!: count = %d\n", __func__, count); -+ -+ /* 8051 reset */ -+ tmp = rtw_read8(padapter, REG_MCUFWDL+2); -+ rtw_write8(padapter, REG_MCUFWDL+2, tmp&0xf7); -+ } else { -+ /* MCU firmware download disable. */ -+ tmp = rtw_read8(padapter, REG_MCUFWDL); -+ rtw_write8(padapter, REG_MCUFWDL, tmp&0xfe); -+ } -+} -+ -+static int _BlockWrite(struct adapter *padapter, void *buffer, u32 buffSize) -+{ -+ int ret = _SUCCESS; -+ -+ u32 blockSize_p1 = 4; /* (Default) Phase #1 : PCI muse use 4-byte write to download FW */ -+ u32 blockSize_p2 = 8; /* Phase #2 : Use 8-byte, if Phase#1 use big size to write FW. */ -+ u32 blockSize_p3 = 1; /* Phase #3 : Use 1-byte, the remnant of FW image. */ -+ u32 blockCount_p1 = 0, blockCount_p2 = 0, blockCount_p3 = 0; -+ u32 remainSize_p1 = 0, remainSize_p2 = 0; -+ u8 *bufferPtr = (u8 *)buffer; -+ u32 i = 0, offset = 0; -+ -+/* printk("====>%s %d\n", __func__, __LINE__); */ -+ -+ /* 3 Phase #1 */ -+ blockCount_p1 = buffSize / blockSize_p1; -+ remainSize_p1 = buffSize % blockSize_p1; -+ -+ if (blockCount_p1) { -+ RT_TRACE( -+ _module_hal_init_c_, -+ _drv_notice_, -+ ( -+ "_BlockWrite: [P1] buffSize(%d) blockSize_p1(%d) blockCount_p1(%d) remainSize_p1(%d)\n", -+ buffSize, -+ blockSize_p1, -+ blockCount_p1, -+ remainSize_p1 -+ ) -+ ); -+ } -+ -+ for (i = 0; i < blockCount_p1; i++) { -+ ret = rtw_write32(padapter, (FW_8723B_START_ADDRESS + i * blockSize_p1), *((u32 *)(bufferPtr + i * blockSize_p1))); -+ if (ret == _FAIL) { -+ printk("====>%s %d i:%d\n", __func__, __LINE__, i); -+ goto exit; -+ } -+ } -+ -+ /* 3 Phase #2 */ -+ if (remainSize_p1) { -+ offset = blockCount_p1 * blockSize_p1; -+ -+ blockCount_p2 = remainSize_p1/blockSize_p2; -+ remainSize_p2 = remainSize_p1%blockSize_p2; -+ -+ if (blockCount_p2) { -+ RT_TRACE( -+ _module_hal_init_c_, -+ _drv_notice_, -+ ( -+ "_BlockWrite: [P2] buffSize_p2(%d) blockSize_p2(%d) blockCount_p2(%d) remainSize_p2(%d)\n", -+ (buffSize-offset), -+ blockSize_p2, -+ blockCount_p2, -+ remainSize_p2 -+ ) -+ ); -+ } -+ -+ } -+ -+ /* 3 Phase #3 */ -+ if (remainSize_p2) { -+ offset = (blockCount_p1 * blockSize_p1) + (blockCount_p2 * blockSize_p2); -+ -+ blockCount_p3 = remainSize_p2 / blockSize_p3; -+ -+ RT_TRACE(_module_hal_init_c_, _drv_notice_, -+ ("_BlockWrite: [P3] buffSize_p3(%d) blockSize_p3(%d) blockCount_p3(%d)\n", -+ (buffSize-offset), blockSize_p3, blockCount_p3)); -+ -+ for (i = 0; i < blockCount_p3; i++) { -+ ret = rtw_write8(padapter, (FW_8723B_START_ADDRESS + offset + i), *(bufferPtr + offset + i)); -+ -+ if (ret == _FAIL) { -+ printk("====>%s %d i:%d\n", __func__, __LINE__, i); -+ goto exit; -+ } -+ } -+ } -+exit: -+ return ret; -+} -+ -+static int _PageWrite( -+ struct adapter *padapter, -+ u32 page, -+ void *buffer, -+ u32 size -+) -+{ -+ u8 value8; -+ u8 u8Page = (u8) (page & 0x07); -+ -+ value8 = (rtw_read8(padapter, REG_MCUFWDL+2) & 0xF8) | u8Page; -+ rtw_write8(padapter, REG_MCUFWDL+2, value8); -+ -+ return _BlockWrite(padapter, buffer, size); -+} -+ -+static int _WriteFW(struct adapter *padapter, void *buffer, u32 size) -+{ -+ /* Since we need dynamic decide method of dwonload fw, so we call this function to get chip version. */ -+ /* We can remove _ReadChipVersion from ReadpadapterInfo8192C later. */ -+ int ret = _SUCCESS; -+ u32 pageNums, remainSize; -+ u32 page, offset; -+ u8 *bufferPtr = (u8 *)buffer; -+ -+ pageNums = size / MAX_DLFW_PAGE_SIZE; -+ /* RT_ASSERT((pageNums <= 4), ("Page numbers should not greater then 4\n")); */ -+ remainSize = size % MAX_DLFW_PAGE_SIZE; -+ -+ for (page = 0; page < pageNums; page++) { -+ offset = page * MAX_DLFW_PAGE_SIZE; -+ ret = _PageWrite(padapter, page, bufferPtr+offset, MAX_DLFW_PAGE_SIZE); -+ -+ if (ret == _FAIL) { -+ printk("====>%s %d\n", __func__, __LINE__); -+ goto exit; -+ } -+ } -+ -+ if (remainSize) { -+ offset = pageNums * MAX_DLFW_PAGE_SIZE; -+ page = pageNums; -+ ret = _PageWrite(padapter, page, bufferPtr+offset, remainSize); -+ -+ if (ret == _FAIL) { -+ printk("====>%s %d\n", __func__, __LINE__); -+ goto exit; -+ } -+ } -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("_WriteFW Done- for Normal chip.\n")); -+ -+exit: -+ return ret; -+} -+ -+void _8051Reset8723(struct adapter *padapter) -+{ -+ u8 cpu_rst; -+ u8 io_rst; -+ -+ -+ /* Reset 8051(WLMCU) IO wrapper */ -+ /* 0x1c[8] = 0 */ -+ /* Suggested by Isaac@SD1 and Gimmy@SD1, coding by Lucas@20130624 */ -+ io_rst = rtw_read8(padapter, REG_RSV_CTRL+1); -+ io_rst &= ~BIT(0); -+ rtw_write8(padapter, REG_RSV_CTRL+1, io_rst); -+ -+ cpu_rst = rtw_read8(padapter, REG_SYS_FUNC_EN+1); -+ cpu_rst &= ~BIT(2); -+ rtw_write8(padapter, REG_SYS_FUNC_EN+1, cpu_rst); -+ -+ /* Enable 8051 IO wrapper */ -+ /* 0x1c[8] = 1 */ -+ io_rst = rtw_read8(padapter, REG_RSV_CTRL+1); -+ io_rst |= BIT(0); -+ rtw_write8(padapter, REG_RSV_CTRL+1, io_rst); -+ -+ cpu_rst = rtw_read8(padapter, REG_SYS_FUNC_EN+1); -+ cpu_rst |= BIT(2); -+ rtw_write8(padapter, REG_SYS_FUNC_EN+1, cpu_rst); -+ -+ DBG_8192C("%s: Finish\n", __func__); -+} -+ -+static s32 polling_fwdl_chksum( -+ struct adapter *adapter, u32 min_cnt, u32 timeout_ms -+) -+{ -+ s32 ret = _FAIL; -+ u32 value32; -+ unsigned long start = jiffies; -+ u32 cnt = 0; -+ -+ /* polling CheckSum report */ -+ do { -+ cnt++; -+ value32 = rtw_read32(adapter, REG_MCUFWDL); -+ if (value32 & FWDL_ChkSum_rpt || adapter->bSurpriseRemoved || adapter->bDriverStopped) -+ break; -+ yield(); -+ } while (jiffies_to_msecs(jiffies-start) < timeout_ms || cnt < min_cnt); -+ -+ if (!(value32 & FWDL_ChkSum_rpt)) { -+ goto exit; -+ } -+ -+ if (g_fwdl_chksum_fail) { -+ DBG_871X("%s: fwdl test case: fwdl_chksum_fail\n", __func__); -+ g_fwdl_chksum_fail--; -+ goto exit; -+ } -+ -+ ret = _SUCCESS; -+ -+exit: -+ DBG_871X( -+ "%s: Checksum report %s! (%u, %dms), REG_MCUFWDL:0x%08x\n", -+ __func__, -+ (ret == _SUCCESS) ? "OK" : "Fail", -+ cnt, -+ jiffies_to_msecs(jiffies-start), -+ value32 -+ ); -+ -+ return ret; -+} -+ -+static s32 _FWFreeToGo(struct adapter *adapter, u32 min_cnt, u32 timeout_ms) -+{ -+ s32 ret = _FAIL; -+ u32 value32; -+ unsigned long start = jiffies; -+ u32 cnt = 0; -+ -+ value32 = rtw_read32(adapter, REG_MCUFWDL); -+ value32 |= MCUFWDL_RDY; -+ value32 &= ~WINTINI_RDY; -+ rtw_write32(adapter, REG_MCUFWDL, value32); -+ -+ _8051Reset8723(adapter); -+ -+ /* polling for FW ready */ -+ do { -+ cnt++; -+ value32 = rtw_read32(adapter, REG_MCUFWDL); -+ if (value32 & WINTINI_RDY || adapter->bSurpriseRemoved || adapter->bDriverStopped) -+ break; -+ yield(); -+ } while (jiffies_to_msecs(jiffies - start) < timeout_ms || cnt < min_cnt); -+ -+ if (!(value32 & WINTINI_RDY)) { -+ goto exit; -+ } -+ -+ if (g_fwdl_wintint_rdy_fail) { -+ DBG_871X("%s: fwdl test case: wintint_rdy_fail\n", __func__); -+ g_fwdl_wintint_rdy_fail--; -+ goto exit; -+ } -+ -+ ret = _SUCCESS; -+ -+exit: -+ DBG_871X( -+ "%s: Polling FW ready %s! (%u, %dms), REG_MCUFWDL:0x%08x\n", -+ __func__, -+ (ret == _SUCCESS) ? "OK" : "Fail", -+ cnt, -+ jiffies_to_msecs(jiffies-start), -+ value32 -+ ); -+ -+ return ret; -+} -+ -+#define IS_FW_81xxC(padapter) (((GET_HAL_DATA(padapter))->FirmwareSignature & 0xFFF0) == 0x88C0) -+ -+void rtl8723b_FirmwareSelfReset(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u8 u1bTmp; -+ u8 Delay = 100; -+ -+ if ( -+ !(IS_FW_81xxC(padapter) && ((pHalData->FirmwareVersion < 0x21) || (pHalData->FirmwareVersion == 0x21 && pHalData->FirmwareSubVersion < 0x01))) -+ ) { /* after 88C Fw v33.1 */ -+ /* 0x1cf = 0x20. Inform 8051 to reset. 2009.12.25. tynli_test */ -+ rtw_write8(padapter, REG_HMETFR+3, 0x20); -+ -+ u1bTmp = rtw_read8(padapter, REG_SYS_FUNC_EN+1); -+ while (u1bTmp & BIT2) { -+ Delay--; -+ if (Delay == 0) -+ break; -+ udelay(50); -+ u1bTmp = rtw_read8(padapter, REG_SYS_FUNC_EN+1); -+ } -+ RT_TRACE(_module_hal_init_c_, _drv_notice_, ("-%s: 8051 reset success (%d)\n", __func__, Delay)); -+ -+ if (Delay == 0) { -+ RT_TRACE(_module_hal_init_c_, _drv_notice_, ("%s: Force 8051 reset!!!\n", __func__)); -+ /* force firmware reset */ -+ u1bTmp = rtw_read8(padapter, REG_SYS_FUNC_EN+1); -+ rtw_write8(padapter, REG_SYS_FUNC_EN+1, u1bTmp&(~BIT2)); -+ } -+ } -+} -+ -+/* */ -+/* Description: */ -+/* Download 8192C firmware code. */ -+/* */ -+/* */ -+s32 rtl8723b_FirmwareDownload(struct adapter *padapter, bool bUsedWoWLANFw) -+{ -+ s32 rtStatus = _SUCCESS; -+ u8 write_fw = 0; -+ unsigned long fwdl_start_time; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ struct rt_firmware *pFirmware; -+ struct rt_firmware *pBTFirmware; -+ struct rt_firmware_hdr *pFwHdr = NULL; -+ u8 *pFirmwareBuf; -+ u32 FirmwareLen; -+ const struct firmware *fw; -+ struct device *device = dvobj_to_dev(padapter->dvobj); -+ u8 *fwfilepath; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ u8 tmp_ps; -+ -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("+%s\n", __func__)); -+#ifdef CONFIG_WOWLAN -+ RT_TRACE(_module_hal_init_c_, _drv_notice_, ("+%s, bUsedWoWLANFw:%d\n", __func__, bUsedWoWLANFw)); -+#endif -+ pFirmware = kzalloc(sizeof(struct rt_firmware), GFP_KERNEL); -+ pBTFirmware = kzalloc(sizeof(struct rt_firmware), GFP_KERNEL); -+ -+ if (!pFirmware || !pBTFirmware) { -+ rtStatus = _FAIL; -+ goto exit; -+ } -+ -+ tmp_ps = rtw_read8(padapter, 0xa3); -+ tmp_ps &= 0xf8; -+ tmp_ps |= 0x02; -+ /* 1. write 0xA3[:2:0] = 3b'010 */ -+ rtw_write8(padapter, 0xa3, tmp_ps); -+ /* 2. read power_state = 0xA0[1:0] */ -+ tmp_ps = rtw_read8(padapter, 0xa0); -+ tmp_ps &= 0x03; -+ if (tmp_ps != 0x01) { -+ DBG_871X(FUNC_ADPT_FMT" tmp_ps =%x\n", FUNC_ADPT_ARG(padapter), tmp_ps); -+ pdbgpriv->dbg_downloadfw_pwr_state_cnt++; -+ } -+ -+#ifdef CONFIG_WOWLAN -+ if (bUsedWoWLANFw) -+ fwfilepath = "rtlwifi/rtl8723bs_wowlan.bin"; -+ else -+#endif /* CONFIG_WOWLAN */ -+ fwfilepath = "rtlwifi/rtl8723bs_nic.bin"; -+ -+ pr_info("rtl8723bs: accquire FW from file:%s\n", fwfilepath); -+ -+ rtStatus = request_firmware(&fw, fwfilepath, device); -+ if (rtStatus) { -+ pr_err("Request firmware failed with error 0x%x\n", rtStatus); -+ rtStatus = _FAIL; -+ goto exit; -+ } -+ -+ if (!fw) { -+ pr_err("Firmware %s not available\n", fwfilepath); -+ rtStatus = _FAIL; -+ goto exit; -+ } -+ -+ if (fw->size > FW_8723B_SIZE) { -+ rtStatus = _FAIL; -+ RT_TRACE( -+ _module_hal_init_c_, -+ _drv_err_, -+ ("Firmware size exceed 0x%X. Check it.\n", FW_8188E_SIZE) -+ ); -+ goto exit; -+ } -+ -+ pFirmware->szFwBuffer = kzalloc(fw->size, GFP_KERNEL); -+ if (!pFirmware->szFwBuffer) { -+ rtStatus = _FAIL; -+ goto exit; -+ } -+ -+ memcpy(pFirmware->szFwBuffer, fw->data, fw->size); -+ pFirmware->ulFwLength = fw->size; -+ release_firmware(fw); -+ if (pFirmware->ulFwLength > FW_8723B_SIZE) { -+ rtStatus = _FAIL; -+ DBG_871X_LEVEL(_drv_emerg_, "Firmware size:%u exceed %u\n", pFirmware->ulFwLength, FW_8723B_SIZE); -+ goto exit; -+ } -+ -+ pFirmwareBuf = pFirmware->szFwBuffer; -+ FirmwareLen = pFirmware->ulFwLength; -+ -+ /* To Check Fw header. Added by tynli. 2009.12.04. */ -+ pFwHdr = (struct rt_firmware_hdr *)pFirmwareBuf; -+ -+ pHalData->FirmwareVersion = le16_to_cpu(pFwHdr->Version); -+ pHalData->FirmwareSubVersion = le16_to_cpu(pFwHdr->Subversion); -+ pHalData->FirmwareSignature = le16_to_cpu(pFwHdr->Signature); -+ -+ DBG_871X( -+ "%s: fw_ver =%x fw_subver =%04x sig = 0x%x, Month =%02x, Date =%02x, Hour =%02x, Minute =%02x\n", -+ __func__, -+ pHalData->FirmwareVersion, -+ pHalData->FirmwareSubVersion, -+ pHalData->FirmwareSignature, -+ pFwHdr->Month, -+ pFwHdr->Date, -+ pFwHdr->Hour, -+ pFwHdr->Minute -+ ); -+ -+ if (IS_FW_HEADER_EXIST_8723B(pFwHdr)) { -+ DBG_871X("%s(): Shift for fw header!\n", __func__); -+ /* Shift 32 bytes for FW header */ -+ pFirmwareBuf = pFirmwareBuf + 32; -+ FirmwareLen = FirmwareLen - 32; -+ } -+ -+ /* Suggested by Filen. If 8051 is running in RAM code, driver should inform Fw to reset by itself, */ -+ /* or it will cause download Fw fail. 2010.02.01. by tynli. */ -+ if (rtw_read8(padapter, REG_MCUFWDL) & RAM_DL_SEL) { /* 8051 RAM code */ -+ rtw_write8(padapter, REG_MCUFWDL, 0x00); -+ rtl8723b_FirmwareSelfReset(padapter); -+ } -+ -+ _FWDownloadEnable(padapter, true); -+ fwdl_start_time = jiffies; -+ while ( -+ !padapter->bDriverStopped && -+ !padapter->bSurpriseRemoved && -+ (write_fw++ < 3 || jiffies_to_msecs(jiffies - fwdl_start_time) < 500) -+ ) { -+ /* reset FWDL chksum */ -+ rtw_write8(padapter, REG_MCUFWDL, rtw_read8(padapter, REG_MCUFWDL)|FWDL_ChkSum_rpt); -+ -+ rtStatus = _WriteFW(padapter, pFirmwareBuf, FirmwareLen); -+ if (rtStatus != _SUCCESS) -+ continue; -+ -+ rtStatus = polling_fwdl_chksum(padapter, 5, 50); -+ if (rtStatus == _SUCCESS) -+ break; -+ } -+ _FWDownloadEnable(padapter, false); -+ if (_SUCCESS != rtStatus) -+ goto fwdl_stat; -+ -+ rtStatus = _FWFreeToGo(padapter, 10, 200); -+ if (_SUCCESS != rtStatus) -+ goto fwdl_stat; -+ -+fwdl_stat: -+ DBG_871X( -+ "FWDL %s. write_fw:%u, %dms\n", -+ (rtStatus == _SUCCESS)?"success":"fail", -+ write_fw, -+ jiffies_to_msecs(jiffies - fwdl_start_time) -+ ); -+ -+exit: -+ kfree(pFirmware->szFwBuffer); -+ kfree(pFirmware); -+ kfree(pBTFirmware); -+ DBG_871X(" <=== rtl8723b_FirmwareDownload()\n"); -+ return rtStatus; -+} -+ -+void rtl8723b_InitializeFirmwareVars(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+ /* Init Fw LPS related. */ -+ adapter_to_pwrctl(padapter)->bFwCurrentInPSMode = false; -+ -+ /* Init H2C cmd. */ -+ rtw_write8(padapter, REG_HMETFR, 0x0f); -+ -+ /* Init H2C counter. by tynli. 2009.12.09. */ -+ pHalData->LastHMEBoxNum = 0; -+/* pHalData->H2CQueueHead = 0; */ -+/* pHalData->H2CQueueTail = 0; */ -+/* pHalData->H2CStopInsertQueue = false; */ -+} -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+/* */ -+ -+/* */ -+/* Description: Prepare some information to Fw for WoWLAN. */ -+/* (1) Download wowlan Fw. */ -+/* (2) Download RSVD page packets. */ -+/* (3) Enable AP offload if needed. */ -+/* */ -+/* 2011.04.12 by tynli. */ -+/* */ -+void SetFwRelatedForWoWLAN8723b( -+ struct adapter *padapter, u8 bHostIsGoingtoSleep -+) -+{ -+ int status = _FAIL; -+ /* */ -+ /* 1. Before WoWLAN we need to re-download WoWLAN Fw. */ -+ /* */ -+ status = rtl8723b_FirmwareDownload(padapter, bHostIsGoingtoSleep); -+ if (status != _SUCCESS) { -+ DBG_871X("SetFwRelatedForWoWLAN8723b(): Re-Download Firmware failed!!\n"); -+ return; -+ } else { -+ DBG_871X("SetFwRelatedForWoWLAN8723b(): Re-Download Firmware Success !!\n"); -+ } -+ /* */ -+ /* 2. Re-Init the variables about Fw related setting. */ -+ /* */ -+ rtl8723b_InitializeFirmwareVars(padapter); -+} -+#endif /* CONFIG_WOWLAN */ -+ -+static void rtl8723b_free_hal_data(struct adapter *padapter) -+{ -+} -+ -+/* */ -+/* Efuse related code */ -+/* */ -+static u8 hal_EfuseSwitchToBank( -+ struct adapter *padapter, u8 bank, bool bPseudoTest -+) -+{ -+ u8 bRet = false; -+ u32 value32 = 0; -+#ifdef HAL_EFUSE_MEMORY -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+#endif -+ -+ -+ DBG_8192C("%s: Efuse switch bank to %d\n", __func__, bank); -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ pEfuseHal->fakeEfuseBank = bank; -+#else -+ fakeEfuseBank = bank; -+#endif -+ bRet = true; -+ } else { -+ value32 = rtw_read32(padapter, EFUSE_TEST); -+ bRet = true; -+ switch (bank) { -+ case 0: -+ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_WIFI_SEL_0); -+ break; -+ case 1: -+ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_BT_SEL_0); -+ break; -+ case 2: -+ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_BT_SEL_1); -+ break; -+ case 3: -+ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_BT_SEL_2); -+ break; -+ default: -+ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_WIFI_SEL_0); -+ bRet = false; -+ break; -+ } -+ rtw_write32(padapter, EFUSE_TEST, value32); -+ } -+ -+ return bRet; -+} -+ -+static void Hal_GetEfuseDefinition( -+ struct adapter *padapter, -+ u8 efuseType, -+ u8 type, -+ void *pOut, -+ bool bPseudoTest -+) -+{ -+ switch (type) { -+ case TYPE_EFUSE_MAX_SECTION: -+ { -+ u8 *pMax_section; -+ pMax_section = (u8 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pMax_section = EFUSE_MAX_SECTION_8723B; -+ else -+ *pMax_section = EFUSE_BT_MAX_SECTION; -+ } -+ break; -+ -+ case TYPE_EFUSE_REAL_CONTENT_LEN: -+ { -+ u16 *pu2Tmp; -+ pu2Tmp = (u16 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pu2Tmp = EFUSE_REAL_CONTENT_LEN_8723B; -+ else -+ *pu2Tmp = EFUSE_BT_REAL_CONTENT_LEN; -+ } -+ break; -+ -+ case TYPE_AVAILABLE_EFUSE_BYTES_BANK: -+ { -+ u16 *pu2Tmp; -+ pu2Tmp = (u16 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pu2Tmp = (EFUSE_REAL_CONTENT_LEN_8723B-EFUSE_OOB_PROTECT_BYTES); -+ else -+ *pu2Tmp = (EFUSE_BT_REAL_BANK_CONTENT_LEN-EFUSE_PROTECT_BYTES_BANK); -+ } -+ break; -+ -+ case TYPE_AVAILABLE_EFUSE_BYTES_TOTAL: -+ { -+ u16 *pu2Tmp; -+ pu2Tmp = (u16 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pu2Tmp = (EFUSE_REAL_CONTENT_LEN_8723B-EFUSE_OOB_PROTECT_BYTES); -+ else -+ *pu2Tmp = (EFUSE_BT_REAL_CONTENT_LEN-(EFUSE_PROTECT_BYTES_BANK*3)); -+ } -+ break; -+ -+ case TYPE_EFUSE_MAP_LEN: -+ { -+ u16 *pu2Tmp; -+ pu2Tmp = (u16 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pu2Tmp = EFUSE_MAX_MAP_LEN; -+ else -+ *pu2Tmp = EFUSE_BT_MAP_LEN; -+ } -+ break; -+ -+ case TYPE_EFUSE_PROTECT_BYTES_BANK: -+ { -+ u8 *pu1Tmp; -+ pu1Tmp = (u8 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pu1Tmp = EFUSE_OOB_PROTECT_BYTES; -+ else -+ *pu1Tmp = EFUSE_PROTECT_BYTES_BANK; -+ } -+ break; -+ -+ case TYPE_EFUSE_CONTENT_LEN_BANK: -+ { -+ u16 *pu2Tmp; -+ pu2Tmp = (u16 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pu2Tmp = EFUSE_REAL_CONTENT_LEN_8723B; -+ else -+ *pu2Tmp = EFUSE_BT_REAL_BANK_CONTENT_LEN; -+ } -+ break; -+ -+ default: -+ { -+ u8 *pu1Tmp; -+ pu1Tmp = (u8 *)pOut; -+ *pu1Tmp = 0; -+ } -+ break; -+ } -+} -+ -+#define VOLTAGE_V25 0x03 -+#define LDOE25_SHIFT 28 -+ -+/* */ -+/* The following is for compile ok */ -+/* That should be merged with the original in the future */ -+/* */ -+#define EFUSE_ACCESS_ON_8723 0x69 /* For RTL8723 only. */ -+#define EFUSE_ACCESS_OFF_8723 0x00 /* For RTL8723 only. */ -+#define REG_EFUSE_ACCESS_8723 0x00CF /* Efuse access protection for RTL8723 */ -+ -+/* */ -+static void Hal_BT_EfusePowerSwitch( -+ struct adapter *padapter, u8 bWrite, u8 PwrState -+) -+{ -+ u8 tempval; -+ if (PwrState == true) { -+ /* enable BT power cut */ -+ /* 0x6A[14] = 1 */ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval |= BIT(6); -+ rtw_write8(padapter, 0x6B, tempval); -+ -+ /* Attention!! Between 0x6A[14] and 0x6A[15] setting need 100us delay */ -+ /* So don't wirte 0x6A[14]= 1 and 0x6A[15]= 0 together! */ -+ msleep(1); -+ /* disable BT output isolation */ -+ /* 0x6A[15] = 0 */ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval &= ~BIT(7); -+ rtw_write8(padapter, 0x6B, tempval); -+ } else { -+ /* enable BT output isolation */ -+ /* 0x6A[15] = 1 */ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval |= BIT(7); -+ rtw_write8(padapter, 0x6B, tempval); -+ -+ /* Attention!! Between 0x6A[14] and 0x6A[15] setting need 100us delay */ -+ /* So don't wirte 0x6A[14]= 1 and 0x6A[15]= 0 together! */ -+ -+ /* disable BT power cut */ -+ /* 0x6A[14] = 1 */ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval &= ~BIT(6); -+ rtw_write8(padapter, 0x6B, tempval); -+ } -+ -+} -+static void Hal_EfusePowerSwitch( -+ struct adapter *padapter, u8 bWrite, u8 PwrState -+) -+{ -+ u8 tempval; -+ u16 tmpV16; -+ -+ -+ if (PwrState == true) { -+ /* To avoid cannot access efuse regsiters after disable/enable several times during DTM test. */ -+ /* Suggested by SD1 IsaacHsu. 2013.07.08, added by tynli. */ -+ tempval = rtw_read8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HSUS_CTRL); -+ if (tempval & BIT(0)) { /* SDIO local register is suspend */ -+ u8 count = 0; -+ -+ -+ tempval &= ~BIT(0); -+ rtw_write8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HSUS_CTRL, tempval); -+ -+ /* check 0x86[1:0]= 10'2h, wait power state to leave suspend */ -+ do { -+ tempval = rtw_read8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HSUS_CTRL); -+ tempval &= 0x3; -+ if (tempval == 0x02) -+ break; -+ -+ count++; -+ if (count >= 100) -+ break; -+ -+ mdelay(10); -+ } while (1); -+ -+ if (count >= 100) { -+ DBG_8192C(FUNC_ADPT_FMT ": Leave SDIO local register suspend fail! Local 0x86 =%#X\n", -+ FUNC_ADPT_ARG(padapter), tempval); -+ } else { -+ DBG_8192C(FUNC_ADPT_FMT ": Leave SDIO local register suspend OK! Local 0x86 =%#X\n", -+ FUNC_ADPT_ARG(padapter), tempval); -+ } -+ } -+ -+ rtw_write8(padapter, REG_EFUSE_ACCESS_8723, EFUSE_ACCESS_ON_8723); -+ -+ /* Reset: 0x0000h[28], default valid */ -+ tmpV16 = rtw_read16(padapter, REG_SYS_FUNC_EN); -+ if (!(tmpV16 & FEN_ELDR)) { -+ tmpV16 |= FEN_ELDR; -+ rtw_write16(padapter, REG_SYS_FUNC_EN, tmpV16); -+ } -+ -+ /* Clock: Gated(0x0008h[5]) 8M(0x0008h[1]) clock from ANA, default valid */ -+ tmpV16 = rtw_read16(padapter, REG_SYS_CLKR); -+ if ((!(tmpV16 & LOADER_CLK_EN)) || (!(tmpV16 & ANA8M))) { -+ tmpV16 |= (LOADER_CLK_EN | ANA8M); -+ rtw_write16(padapter, REG_SYS_CLKR, tmpV16); -+ } -+ -+ if (bWrite == true) { -+ /* Enable LDO 2.5V before read/write action */ -+ tempval = rtw_read8(padapter, EFUSE_TEST+3); -+ tempval &= 0x0F; -+ tempval |= (VOLTAGE_V25 << 4); -+ rtw_write8(padapter, EFUSE_TEST+3, (tempval | 0x80)); -+ -+ /* rtw_write8(padapter, REG_EFUSE_ACCESS, EFUSE_ACCESS_ON); */ -+ } -+ } else { -+ rtw_write8(padapter, REG_EFUSE_ACCESS, EFUSE_ACCESS_OFF); -+ -+ if (bWrite == true) { -+ /* Disable LDO 2.5V after read/write action */ -+ tempval = rtw_read8(padapter, EFUSE_TEST+3); -+ rtw_write8(padapter, EFUSE_TEST+3, (tempval & 0x7F)); -+ } -+ -+ } -+} -+ -+static void hal_ReadEFuse_WiFi( -+ struct adapter *padapter, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ bool bPseudoTest -+) -+{ -+#ifdef HAL_EFUSE_MEMORY -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+#endif -+ u8 *efuseTbl = NULL; -+ u16 eFuse_Addr = 0; -+ u8 offset, wden; -+ u8 efuseHeader, efuseExtHdr, efuseData; -+ u16 i, total, used; -+ u8 efuse_usage = 0; -+ -+ /* DBG_871X("YJ: ====>%s():_offset =%d _size_byte =%d bPseudoTest =%d\n", __func__, _offset, _size_byte, bPseudoTest); */ -+ /* */ -+ /* Do NOT excess total size of EFuse table. Added by Roger, 2008.11.10. */ -+ /* */ -+ if ((_offset+_size_byte) > EFUSE_MAX_MAP_LEN) { -+ DBG_8192C("%s: Invalid offset(%#x) with read bytes(%#x)!!\n", __func__, _offset, _size_byte); -+ return; -+ } -+ -+ efuseTbl = (u8 *)rtw_malloc(EFUSE_MAX_MAP_LEN); -+ if (efuseTbl == NULL) { -+ DBG_8192C("%s: alloc efuseTbl fail!\n", __func__); -+ return; -+ } -+ /* 0xff will be efuse default value instead of 0x00. */ -+ memset(efuseTbl, 0xFF, EFUSE_MAX_MAP_LEN); -+ -+ -+#ifdef CONFIG_DEBUG -+if (0) { -+ for (i = 0; i < 256; i++) -+ efuse_OneByteRead(padapter, i, &efuseTbl[i], false); -+ DBG_871X("Efuse Content:\n"); -+ for (i = 0; i < 256; i++) { -+ if (i % 16 == 0) -+ printk("\n"); -+ printk("%02X ", efuseTbl[i]); -+ } -+ printk("\n"); -+} -+#endif -+ -+ -+ /* switch bank back to bank 0 for later BT and wifi use. */ -+ hal_EfuseSwitchToBank(padapter, 0, bPseudoTest); -+ -+ while (AVAILABLE_EFUSE_ADDR(eFuse_Addr)) { -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); -+ if (efuseHeader == 0xFF) { -+ DBG_8192C("%s: data end at address =%#x\n", __func__, eFuse_Addr-1); -+ break; -+ } -+ /* DBG_8192C("%s: efuse[0x%X]= 0x%02X\n", __func__, eFuse_Addr-1, efuseHeader); */ -+ -+ /* Check PG header for section num. */ -+ if (EXT_HEADER(efuseHeader)) { /* extended header */ -+ offset = GET_HDR_OFFSET_2_0(efuseHeader); -+ /* DBG_8192C("%s: extended header offset = 0x%X\n", __func__, offset); */ -+ -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); -+ /* DBG_8192C("%s: efuse[0x%X]= 0x%02X\n", __func__, eFuse_Addr-1, efuseExtHdr); */ -+ if (ALL_WORDS_DISABLED(efuseExtHdr)) -+ continue; -+ -+ offset |= ((efuseExtHdr & 0xF0) >> 1); -+ wden = (efuseExtHdr & 0x0F); -+ } else { -+ offset = ((efuseHeader >> 4) & 0x0f); -+ wden = (efuseHeader & 0x0f); -+ } -+ /* DBG_8192C("%s: Offset =%d Worden = 0x%X\n", __func__, offset, wden); */ -+ -+ if (offset < EFUSE_MAX_SECTION_8723B) { -+ u16 addr; -+ /* Get word enable value from PG header */ -+/* DBG_8192C("%s: Offset =%d Worden = 0x%X\n", __func__, offset, wden); */ -+ -+ addr = offset * PGPKT_DATA_SIZE; -+ for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { -+ /* Check word enable condition in the section */ -+ if (!(wden & (0x01<fakeEfuseUsedBytes = used; -+#else -+ fakeEfuseUsedBytes = used; -+#endif -+ } else { -+ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&used); -+ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_USAGE, (u8 *)&efuse_usage); -+ } -+ -+ if (efuseTbl) -+ kfree(efuseTbl); -+} -+ -+static void hal_ReadEFuse_BT( -+ struct adapter *padapter, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ bool bPseudoTest -+) -+{ -+#ifdef HAL_EFUSE_MEMORY -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+#endif -+ u8 *efuseTbl; -+ u8 bank; -+ u16 eFuse_Addr; -+ u8 efuseHeader, efuseExtHdr, efuseData; -+ u8 offset, wden; -+ u16 i, total, used; -+ u8 efuse_usage; -+ -+ -+ /* */ -+ /* Do NOT excess total size of EFuse table. Added by Roger, 2008.11.10. */ -+ /* */ -+ if ((_offset+_size_byte) > EFUSE_BT_MAP_LEN) { -+ DBG_8192C("%s: Invalid offset(%#x) with read bytes(%#x)!!\n", __func__, _offset, _size_byte); -+ return; -+ } -+ -+ efuseTbl = rtw_malloc(EFUSE_BT_MAP_LEN); -+ if (efuseTbl == NULL) { -+ DBG_8192C("%s: efuseTbl malloc fail!\n", __func__); -+ return; -+ } -+ /* 0xff will be efuse default value instead of 0x00. */ -+ memset(efuseTbl, 0xFF, EFUSE_BT_MAP_LEN); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_BANK, &total, bPseudoTest); -+ -+ for (bank = 1; bank < 3; bank++) { /* 8723b Max bake 0~2 */ -+ if (hal_EfuseSwitchToBank(padapter, bank, bPseudoTest) == false) { -+ DBG_8192C("%s: hal_EfuseSwitchToBank Fail!!\n", __func__); -+ goto exit; -+ } -+ -+ eFuse_Addr = 0; -+ -+ while (AVAILABLE_EFUSE_ADDR(eFuse_Addr)) { -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); -+ if (efuseHeader == 0xFF) -+ break; -+ DBG_8192C("%s: efuse[%#X]= 0x%02x (header)\n", __func__, (((bank-1)*EFUSE_REAL_CONTENT_LEN_8723B)+eFuse_Addr-1), efuseHeader); -+ -+ /* Check PG header for section num. */ -+ if (EXT_HEADER(efuseHeader)) { /* extended header */ -+ offset = GET_HDR_OFFSET_2_0(efuseHeader); -+ DBG_8192C("%s: extended header offset_2_0 = 0x%X\n", __func__, offset); -+ -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); -+ DBG_8192C("%s: efuse[%#X]= 0x%02x (ext header)\n", __func__, (((bank-1)*EFUSE_REAL_CONTENT_LEN_8723B)+eFuse_Addr-1), efuseExtHdr); -+ if (ALL_WORDS_DISABLED(efuseExtHdr)) -+ continue; -+ -+ -+ offset |= ((efuseExtHdr & 0xF0) >> 1); -+ wden = (efuseExtHdr & 0x0F); -+ } else { -+ offset = ((efuseHeader >> 4) & 0x0f); -+ wden = (efuseHeader & 0x0f); -+ } -+ -+ if (offset < EFUSE_BT_MAX_SECTION) { -+ u16 addr; -+ -+ /* Get word enable value from PG header */ -+ DBG_8192C("%s: Offset =%d Worden =%#X\n", __func__, offset, wden); -+ -+ addr = offset * PGPKT_DATA_SIZE; -+ for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { -+ /* Check word enable condition in the section */ -+ if (!(wden & (0x01<fakeBTEfuseUsedBytes = used; -+#else -+ fakeBTEfuseUsedBytes = used; -+#endif -+ } else { -+ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BT_BYTES, (u8 *)&used); -+ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BT_USAGE, (u8 *)&efuse_usage); -+ } -+ -+exit: -+ if (efuseTbl) -+ kfree(efuseTbl); -+} -+ -+static void Hal_ReadEFuse( -+ struct adapter *padapter, -+ u8 efuseType, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ bool bPseudoTest -+) -+{ -+ if (efuseType == EFUSE_WIFI) -+ hal_ReadEFuse_WiFi(padapter, _offset, _size_byte, pbuf, bPseudoTest); -+ else -+ hal_ReadEFuse_BT(padapter, _offset, _size_byte, pbuf, bPseudoTest); -+} -+ -+static u16 hal_EfuseGetCurrentSize_WiFi( -+ struct adapter *padapter, bool bPseudoTest -+) -+{ -+#ifdef HAL_EFUSE_MEMORY -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+#endif -+ u16 efuse_addr = 0; -+ u16 start_addr = 0; /* for debug */ -+ u8 hoffset = 0, hworden = 0; -+ u8 efuse_data, word_cnts = 0; -+ u32 count = 0; /* for debug */ -+ -+ -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ efuse_addr = (u16)pEfuseHal->fakeEfuseUsedBytes; -+#else -+ efuse_addr = (u16)fakeEfuseUsedBytes; -+#endif -+ } else -+ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&efuse_addr); -+ -+ start_addr = efuse_addr; -+ DBG_8192C("%s: start_efuse_addr = 0x%X\n", __func__, efuse_addr); -+ -+ /* switch bank back to bank 0 for later BT and wifi use. */ -+ hal_EfuseSwitchToBank(padapter, 0, bPseudoTest); -+ -+ count = 0; -+ while (AVAILABLE_EFUSE_ADDR(efuse_addr)) { -+ if (efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest) == false) { -+ DBG_8192C(KERN_ERR "%s: efuse_OneByteRead Fail! addr = 0x%X !!\n", __func__, efuse_addr); -+ goto error; -+ } -+ -+ if (efuse_data == 0xFF) -+ break; -+ -+ if ((start_addr != 0) && (efuse_addr == start_addr)) { -+ count++; -+ DBG_8192C(FUNC_ADPT_FMT ": [WARNING] efuse raw 0x%X = 0x%02X not 0xFF!!(%d times)\n", -+ FUNC_ADPT_ARG(padapter), efuse_addr, efuse_data, count); -+ -+ efuse_data = 0xFF; -+ if (count < 4) { -+ /* try again! */ -+ -+ if (count > 2) { -+ /* try again form address 0 */ -+ efuse_addr = 0; -+ start_addr = 0; -+ } -+ -+ continue; -+ } -+ -+ goto error; -+ } -+ -+ if (EXT_HEADER(efuse_data)) { -+ hoffset = GET_HDR_OFFSET_2_0(efuse_data); -+ efuse_addr++; -+ efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest); -+ if (ALL_WORDS_DISABLED(efuse_data)) -+ continue; -+ -+ hoffset |= ((efuse_data & 0xF0) >> 1); -+ hworden = efuse_data & 0x0F; -+ } else { -+ hoffset = (efuse_data>>4) & 0x0F; -+ hworden = efuse_data & 0x0F; -+ } -+ -+ word_cnts = Efuse_CalculateWordCnts(hworden); -+ efuse_addr += (word_cnts*2)+1; -+ } -+ -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ pEfuseHal->fakeEfuseUsedBytes = efuse_addr; -+#else -+ fakeEfuseUsedBytes = efuse_addr; -+#endif -+ } else -+ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&efuse_addr); -+ -+ goto exit; -+ -+error: -+ /* report max size to prevent wirte efuse */ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &efuse_addr, bPseudoTest); -+ -+exit: -+ DBG_8192C("%s: CurrentSize =%d\n", __func__, efuse_addr); -+ -+ return efuse_addr; -+} -+ -+static u16 hal_EfuseGetCurrentSize_BT(struct adapter *padapter, u8 bPseudoTest) -+{ -+#ifdef HAL_EFUSE_MEMORY -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+#endif -+ u16 btusedbytes; -+ u16 efuse_addr; -+ u8 bank, startBank; -+ u8 hoffset = 0, hworden = 0; -+ u8 efuse_data, word_cnts = 0; -+ u16 retU2 = 0; -+ -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ btusedbytes = pEfuseHal->fakeBTEfuseUsedBytes; -+#else -+ btusedbytes = fakeBTEfuseUsedBytes; -+#endif -+ } else -+ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BT_BYTES, (u8 *)&btusedbytes); -+ -+ efuse_addr = (u16)((btusedbytes%EFUSE_BT_REAL_BANK_CONTENT_LEN)); -+ startBank = (u8)(1+(btusedbytes/EFUSE_BT_REAL_BANK_CONTENT_LEN)); -+ -+ DBG_8192C("%s: start from bank =%d addr = 0x%X\n", __func__, startBank, efuse_addr); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_BANK, &retU2, bPseudoTest); -+ -+ for (bank = startBank; bank < 3; bank++) { -+ if (hal_EfuseSwitchToBank(padapter, bank, bPseudoTest) == false) { -+ DBG_8192C(KERN_ERR "%s: switch bank(%d) Fail!!\n", __func__, bank); -+ /* bank = EFUSE_MAX_BANK; */ -+ break; -+ } -+ -+ /* only when bank is switched we have to reset the efuse_addr. */ -+ if (bank != startBank) -+ efuse_addr = 0; -+#if 1 -+ -+ while (AVAILABLE_EFUSE_ADDR(efuse_addr)) { -+ if (efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest) == false) { -+ DBG_8192C(KERN_ERR "%s: efuse_OneByteRead Fail! addr = 0x%X !!\n", __func__, efuse_addr); -+ /* bank = EFUSE_MAX_BANK; */ -+ break; -+ } -+ DBG_8192C("%s: efuse_OneByteRead ! addr = 0x%X !efuse_data = 0x%X! bank =%d\n", __func__, efuse_addr, efuse_data, bank); -+ -+ if (efuse_data == 0xFF) -+ break; -+ -+ if (EXT_HEADER(efuse_data)) { -+ hoffset = GET_HDR_OFFSET_2_0(efuse_data); -+ efuse_addr++; -+ efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest); -+ DBG_8192C("%s: efuse_OneByteRead EXT_HEADER ! addr = 0x%X !efuse_data = 0x%X! bank =%d\n", __func__, efuse_addr, efuse_data, bank); -+ -+ if (ALL_WORDS_DISABLED(efuse_data)) { -+ efuse_addr++; -+ continue; -+ } -+ -+/* hoffset = ((hoffset & 0xE0) >> 5) | ((efuse_data & 0xF0) >> 1); */ -+ hoffset |= ((efuse_data & 0xF0) >> 1); -+ hworden = efuse_data & 0x0F; -+ } else { -+ hoffset = (efuse_data>>4) & 0x0F; -+ hworden = efuse_data & 0x0F; -+ } -+ -+ DBG_8192C(FUNC_ADPT_FMT": Offset =%d Worden =%#X\n", -+ FUNC_ADPT_ARG(padapter), hoffset, hworden); -+ -+ word_cnts = Efuse_CalculateWordCnts(hworden); -+ /* read next header */ -+ efuse_addr += (word_cnts*2)+1; -+ } -+#else -+ while ( -+ bContinual && -+ efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest) && -+ AVAILABLE_EFUSE_ADDR(efuse_addr) -+ ) { -+ if (efuse_data != 0xFF) { -+ if ((efuse_data&0x1F) == 0x0F) { /* extended header */ -+ hoffset = efuse_data; -+ efuse_addr++; -+ efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest); -+ if ((efuse_data & 0x0F) == 0x0F) { -+ efuse_addr++; -+ continue; -+ } else { -+ hoffset = ((hoffset & 0xE0) >> 5) | ((efuse_data & 0xF0) >> 1); -+ hworden = efuse_data & 0x0F; -+ } -+ } else { -+ hoffset = (efuse_data>>4) & 0x0F; -+ hworden = efuse_data & 0x0F; -+ } -+ word_cnts = Efuse_CalculateWordCnts(hworden); -+ /* read next header */ -+ efuse_addr = efuse_addr + (word_cnts*2)+1; -+ } else -+ bContinual = false; -+ } -+#endif -+ -+ -+ /* Check if we need to check next bank efuse */ -+ if (efuse_addr < retU2) -+ break; /* don't need to check next bank. */ -+ } -+ -+ retU2 = ((bank-1)*EFUSE_BT_REAL_BANK_CONTENT_LEN)+efuse_addr; -+ if (bPseudoTest) { -+ pEfuseHal->fakeBTEfuseUsedBytes = retU2; -+ /* RT_DISP(FEEPROM, EFUSE_PG, ("Hal_EfuseGetCurrentSize_BT92C(), already use %u bytes\n", pEfuseHal->fakeBTEfuseUsedBytes)); */ -+ } else { -+ pEfuseHal->BTEfuseUsedBytes = retU2; -+ /* RT_DISP(FEEPROM, EFUSE_PG, ("Hal_EfuseGetCurrentSize_BT92C(), already use %u bytes\n", pEfuseHal->BTEfuseUsedBytes)); */ -+ } -+ -+ DBG_8192C("%s: CurrentSize =%d\n", __func__, retU2); -+ return retU2; -+} -+ -+static u16 Hal_EfuseGetCurrentSize( -+ struct adapter *padapter, u8 efuseType, bool bPseudoTest -+) -+{ -+ u16 ret = 0; -+ -+ if (efuseType == EFUSE_WIFI) -+ ret = hal_EfuseGetCurrentSize_WiFi(padapter, bPseudoTest); -+ else -+ ret = hal_EfuseGetCurrentSize_BT(padapter, bPseudoTest); -+ -+ return ret; -+} -+ -+static u8 Hal_EfuseWordEnableDataWrite( -+ struct adapter *padapter, -+ u16 efuse_addr, -+ u8 word_en, -+ u8 *data, -+ bool bPseudoTest -+) -+{ -+ u16 tmpaddr = 0; -+ u16 start_addr = efuse_addr; -+ u8 badworden = 0x0F; -+ u8 tmpdata[PGPKT_DATA_SIZE]; -+ -+ -+/* DBG_8192C("%s: efuse_addr =%#x word_en =%#x\n", __func__, efuse_addr, word_en); */ -+ memset(tmpdata, 0xFF, PGPKT_DATA_SIZE); -+ -+ if (!(word_en & BIT(0))) { -+ tmpaddr = start_addr; -+ efuse_OneByteWrite(padapter, start_addr++, data[0], bPseudoTest); -+ efuse_OneByteWrite(padapter, start_addr++, data[1], bPseudoTest); -+ -+ efuse_OneByteRead(padapter, tmpaddr, &tmpdata[0], bPseudoTest); -+ efuse_OneByteRead(padapter, tmpaddr+1, &tmpdata[1], bPseudoTest); -+ if ((data[0] != tmpdata[0]) || (data[1] != tmpdata[1])) { -+ badworden &= (~BIT(0)); -+ } -+ } -+ if (!(word_en & BIT(1))) { -+ tmpaddr = start_addr; -+ efuse_OneByteWrite(padapter, start_addr++, data[2], bPseudoTest); -+ efuse_OneByteWrite(padapter, start_addr++, data[3], bPseudoTest); -+ -+ efuse_OneByteRead(padapter, tmpaddr, &tmpdata[2], bPseudoTest); -+ efuse_OneByteRead(padapter, tmpaddr+1, &tmpdata[3], bPseudoTest); -+ if ((data[2] != tmpdata[2]) || (data[3] != tmpdata[3])) { -+ badworden &= (~BIT(1)); -+ } -+ } -+ -+ if (!(word_en & BIT(2))) { -+ tmpaddr = start_addr; -+ efuse_OneByteWrite(padapter, start_addr++, data[4], bPseudoTest); -+ efuse_OneByteWrite(padapter, start_addr++, data[5], bPseudoTest); -+ -+ efuse_OneByteRead(padapter, tmpaddr, &tmpdata[4], bPseudoTest); -+ efuse_OneByteRead(padapter, tmpaddr+1, &tmpdata[5], bPseudoTest); -+ if ((data[4] != tmpdata[4]) || (data[5] != tmpdata[5])) { -+ badworden &= (~BIT(2)); -+ } -+ } -+ -+ if (!(word_en & BIT(3))) { -+ tmpaddr = start_addr; -+ efuse_OneByteWrite(padapter, start_addr++, data[6], bPseudoTest); -+ efuse_OneByteWrite(padapter, start_addr++, data[7], bPseudoTest); -+ -+ efuse_OneByteRead(padapter, tmpaddr, &tmpdata[6], bPseudoTest); -+ efuse_OneByteRead(padapter, tmpaddr+1, &tmpdata[7], bPseudoTest); -+ if ((data[6] != tmpdata[6]) || (data[7] != tmpdata[7])) { -+ badworden &= (~BIT(3)); -+ } -+ } -+ -+ return badworden; -+} -+ -+static s32 Hal_EfusePgPacketRead( -+ struct adapter *padapter, -+ u8 offset, -+ u8 *data, -+ bool bPseudoTest -+) -+{ -+ u8 efuse_data, word_cnts = 0; -+ u16 efuse_addr = 0; -+ u8 hoffset = 0, hworden = 0; -+ u8 i; -+ u8 max_section = 0; -+ s32 ret; -+ -+ -+ if (data == NULL) -+ return false; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAX_SECTION, &max_section, bPseudoTest); -+ if (offset > max_section) { -+ DBG_8192C("%s: Packet offset(%d) is illegal(>%d)!\n", __func__, offset, max_section); -+ return false; -+ } -+ -+ memset(data, 0xFF, PGPKT_DATA_SIZE); -+ ret = true; -+ -+ /* */ -+ /* Efuse has been pre-programmed dummy 5Bytes at the end of Efuse by CP. */ -+ /* Skip dummy parts to prevent unexpected data read from Efuse. */ -+ /* By pass right now. 2009.02.19. */ -+ /* */ -+ while (AVAILABLE_EFUSE_ADDR(efuse_addr)) { -+ if (efuse_OneByteRead(padapter, efuse_addr++, &efuse_data, bPseudoTest) == false) { -+ ret = false; -+ break; -+ } -+ -+ if (efuse_data == 0xFF) -+ break; -+ -+ if (EXT_HEADER(efuse_data)) { -+ hoffset = GET_HDR_OFFSET_2_0(efuse_data); -+ efuse_OneByteRead(padapter, efuse_addr++, &efuse_data, bPseudoTest); -+ if (ALL_WORDS_DISABLED(efuse_data)) { -+ DBG_8192C("%s: Error!! All words disabled!\n", __func__); -+ continue; -+ } -+ -+ hoffset |= ((efuse_data & 0xF0) >> 1); -+ hworden = efuse_data & 0x0F; -+ } else { -+ hoffset = (efuse_data>>4) & 0x0F; -+ hworden = efuse_data & 0x0F; -+ } -+ -+ if (hoffset == offset) { -+ for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { -+ /* Check word enable condition in the section */ -+ if (!(hworden & (0x01<= max_available) { -+ DBG_8192C("%s: Error!! current_size(%d)>max_available(%d)\n", __func__, current_size, max_available); -+ return false; -+ } -+ return true; -+} -+ -+static void hal_EfuseConstructPGPkt( -+ u8 offset, -+ u8 word_en, -+ u8 *pData, -+ PPGPKT_STRUCT pTargetPkt -+) -+{ -+ memset(pTargetPkt->data, 0xFF, PGPKT_DATA_SIZE); -+ pTargetPkt->offset = offset; -+ pTargetPkt->word_en = word_en; -+ efuse_WordEnableDataRead(word_en, pData, pTargetPkt->data); -+ pTargetPkt->word_cnts = Efuse_CalculateWordCnts(pTargetPkt->word_en); -+} -+ -+static u8 hal_EfusePartialWriteCheck( -+ struct adapter *padapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+ u8 bRet = false; -+ u16 startAddr = 0, efuse_max_available_len = 0, efuse_max = 0; -+ u8 efuse_data = 0; -+ -+ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &efuse_max_available_len, bPseudoTest); -+ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_CONTENT_LEN_BANK, &efuse_max, bPseudoTest); -+ -+ if (efuseType == EFUSE_WIFI) { -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ startAddr = (u16)pEfuseHal->fakeEfuseUsedBytes; -+#else -+ startAddr = (u16)fakeEfuseUsedBytes; -+#endif -+ } else -+ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&startAddr); -+ } else { -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ startAddr = (u16)pEfuseHal->fakeBTEfuseUsedBytes; -+#else -+ startAddr = (u16)fakeBTEfuseUsedBytes; -+#endif -+ } else -+ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BT_BYTES, (u8 *)&startAddr); -+ } -+ startAddr %= efuse_max; -+ DBG_8192C("%s: startAddr =%#X\n", __func__, startAddr); -+ -+ while (1) { -+ if (startAddr >= efuse_max_available_len) { -+ bRet = false; -+ DBG_8192C("%s: startAddr(%d) >= efuse_max_available_len(%d)\n", __func__, startAddr, efuse_max_available_len); -+ break; -+ } -+ -+ if (efuse_OneByteRead(padapter, startAddr, &efuse_data, bPseudoTest) && (efuse_data != 0xFF)) { -+#if 1 -+ bRet = false; -+ DBG_8192C("%s: Something Wrong! last bytes(%#X = 0x%02X) is not 0xFF\n", -+ __func__, startAddr, efuse_data); -+ break; -+#else -+ if (EXT_HEADER(efuse_data)) { -+ cur_header = efuse_data; -+ startAddr++; -+ efuse_OneByteRead(padapter, startAddr, &efuse_data, bPseudoTest); -+ if (ALL_WORDS_DISABLED(efuse_data)) { -+ DBG_8192C("%s: Error condition, all words disabled!", __func__); -+ bRet = false; -+ break; -+ } else { -+ curPkt.offset = ((cur_header & 0xE0) >> 5) | ((efuse_data & 0xF0) >> 1); -+ curPkt.word_en = efuse_data & 0x0F; -+ } -+ } else { -+ cur_header = efuse_data; -+ curPkt.offset = (cur_header>>4) & 0x0F; -+ curPkt.word_en = cur_header & 0x0F; -+ } -+ -+ curPkt.word_cnts = Efuse_CalculateWordCnts(curPkt.word_en); -+ /* if same header is found but no data followed */ -+ /* write some part of data followed by the header. */ -+ if ( -+ (curPkt.offset == pTargetPkt->offset) && -+ (hal_EfuseCheckIfDatafollowed(padapter, curPkt.word_cnts, startAddr+1, bPseudoTest) == false) && -+ wordEnMatched(pTargetPkt, &curPkt, &matched_wden) == true -+ ) { -+ DBG_8192C("%s: Need to partial write data by the previous wrote header\n", __func__); -+ /* Here to write partial data */ -+ badworden = Efuse_WordEnableDataWrite(padapter, startAddr+1, matched_wden, pTargetPkt->data, bPseudoTest); -+ if (badworden != 0x0F) { -+ u32 PgWriteSuccess = 0; -+ /* if write fail on some words, write these bad words again */ -+ if (efuseType == EFUSE_WIFI) -+ PgWriteSuccess = Efuse_PgPacketWrite(padapter, pTargetPkt->offset, badworden, pTargetPkt->data, bPseudoTest); -+ else -+ PgWriteSuccess = Efuse_PgPacketWrite_BT(padapter, pTargetPkt->offset, badworden, pTargetPkt->data, bPseudoTest); -+ -+ if (!PgWriteSuccess) { -+ bRet = false; /* write fail, return */ -+ break; -+ } -+ } -+ /* partial write ok, update the target packet for later use */ -+ for (i = 0; i < 4; i++) { -+ if ((matched_wden & (0x1<word_en |= (0x1<word_cnts = Efuse_CalculateWordCnts(pTargetPkt->word_en); -+ } -+ /* read from next header */ -+ startAddr = startAddr + (curPkt.word_cnts*2) + 1; -+#endif -+ } else { -+ /* not used header, 0xff */ -+ *pAddr = startAddr; -+/* DBG_8192C("%s: Started from unused header offset =%d\n", __func__, startAddr)); */ -+ bRet = true; -+ break; -+ } -+ } -+ -+ return bRet; -+} -+ -+static u8 hal_EfusePgPacketWrite1ByteHeader( -+ struct adapter *padapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest -+) -+{ -+ u8 pg_header = 0, tmp_header = 0; -+ u16 efuse_addr = *pAddr; -+ u8 repeatcnt = 0; -+ -+ -+/* DBG_8192C("%s\n", __func__); */ -+ pg_header = ((pTargetPkt->offset << 4) & 0xf0) | pTargetPkt->word_en; -+ -+ do { -+ efuse_OneByteWrite(padapter, efuse_addr, pg_header, bPseudoTest); -+ efuse_OneByteRead(padapter, efuse_addr, &tmp_header, bPseudoTest); -+ if (tmp_header != 0xFF) -+ break; -+ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { -+ DBG_8192C("%s: Repeat over limit for pg_header!!\n", __func__); -+ return false; -+ } -+ } while (1); -+ -+ if (tmp_header != pg_header) { -+ DBG_8192C(KERN_ERR "%s: PG Header Fail!!(pg = 0x%02X read = 0x%02X)\n", __func__, pg_header, tmp_header); -+ return false; -+ } -+ -+ *pAddr = efuse_addr; -+ -+ return true; -+} -+ -+static u8 hal_EfusePgPacketWrite2ByteHeader( -+ struct adapter *padapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest -+) -+{ -+ u16 efuse_addr, efuse_max_available_len = 0; -+ u8 pg_header = 0, tmp_header = 0; -+ u8 repeatcnt = 0; -+ -+ -+/* DBG_8192C("%s\n", __func__); */ -+ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_BANK, &efuse_max_available_len, bPseudoTest); -+ -+ efuse_addr = *pAddr; -+ if (efuse_addr >= efuse_max_available_len) { -+ DBG_8192C("%s: addr(%d) over avaliable(%d)!!\n", __func__, efuse_addr, efuse_max_available_len); -+ return false; -+ } -+ -+ pg_header = ((pTargetPkt->offset & 0x07) << 5) | 0x0F; -+/* DBG_8192C("%s: pg_header = 0x%x\n", __func__, pg_header); */ -+ -+ do { -+ efuse_OneByteWrite(padapter, efuse_addr, pg_header, bPseudoTest); -+ efuse_OneByteRead(padapter, efuse_addr, &tmp_header, bPseudoTest); -+ if (tmp_header != 0xFF) -+ break; -+ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { -+ DBG_8192C("%s: Repeat over limit for pg_header!!\n", __func__); -+ return false; -+ } -+ } while (1); -+ -+ if (tmp_header != pg_header) { -+ DBG_8192C(KERN_ERR "%s: PG Header Fail!!(pg = 0x%02X read = 0x%02X)\n", __func__, pg_header, tmp_header); -+ return false; -+ } -+ -+ /* to write ext_header */ -+ efuse_addr++; -+ pg_header = ((pTargetPkt->offset & 0x78) << 1) | pTargetPkt->word_en; -+ -+ do { -+ efuse_OneByteWrite(padapter, efuse_addr, pg_header, bPseudoTest); -+ efuse_OneByteRead(padapter, efuse_addr, &tmp_header, bPseudoTest); -+ if (tmp_header != 0xFF) -+ break; -+ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { -+ DBG_8192C("%s: Repeat over limit for ext_header!!\n", __func__); -+ return false; -+ } -+ } while (1); -+ -+ if (tmp_header != pg_header) { /* offset PG fail */ -+ DBG_8192C(KERN_ERR "%s: PG EXT Header Fail!!(pg = 0x%02X read = 0x%02X)\n", __func__, pg_header, tmp_header); -+ return false; -+ } -+ -+ *pAddr = efuse_addr; -+ -+ return true; -+} -+ -+static u8 hal_EfusePgPacketWriteHeader( -+ struct adapter *padapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest -+) -+{ -+ u8 bRet = false; -+ -+ if (pTargetPkt->offset >= EFUSE_MAX_SECTION_BASE) -+ bRet = hal_EfusePgPacketWrite2ByteHeader(padapter, efuseType, pAddr, pTargetPkt, bPseudoTest); -+ else -+ bRet = hal_EfusePgPacketWrite1ByteHeader(padapter, efuseType, pAddr, pTargetPkt, bPseudoTest); -+ -+ return bRet; -+} -+ -+static u8 hal_EfusePgPacketWriteData( -+ struct adapter *padapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest -+) -+{ -+ u16 efuse_addr; -+ u8 badworden; -+ -+ -+ efuse_addr = *pAddr; -+ badworden = Efuse_WordEnableDataWrite(padapter, efuse_addr+1, pTargetPkt->word_en, pTargetPkt->data, bPseudoTest); -+ if (badworden != 0x0F) { -+ DBG_8192C("%s: Fail!!\n", __func__); -+ return false; -+ } -+ -+/* DBG_8192C("%s: ok\n", __func__); */ -+ return true; -+} -+ -+static s32 Hal_EfusePgPacketWrite( -+ struct adapter *padapter, -+ u8 offset, -+ u8 word_en, -+ u8 *pData, -+ bool bPseudoTest -+) -+{ -+ PGPKT_STRUCT targetPkt; -+ u16 startAddr = 0; -+ u8 efuseType = EFUSE_WIFI; -+ -+ if (!hal_EfusePgCheckAvailableAddr(padapter, efuseType, bPseudoTest)) -+ return false; -+ -+ hal_EfuseConstructPGPkt(offset, word_en, pData, &targetPkt); -+ -+ if (!hal_EfusePartialWriteCheck(padapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return false; -+ -+ if (!hal_EfusePgPacketWriteHeader(padapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return false; -+ -+ if (!hal_EfusePgPacketWriteData(padapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return false; -+ -+ return true; -+} -+ -+static bool Hal_EfusePgPacketWrite_BT( -+ struct adapter *padapter, -+ u8 offset, -+ u8 word_en, -+ u8 *pData, -+ bool bPseudoTest -+) -+{ -+ PGPKT_STRUCT targetPkt; -+ u16 startAddr = 0; -+ u8 efuseType = EFUSE_BT; -+ -+ if (!hal_EfusePgCheckAvailableAddr(padapter, efuseType, bPseudoTest)) -+ return false; -+ -+ hal_EfuseConstructPGPkt(offset, word_en, pData, &targetPkt); -+ -+ if (!hal_EfusePartialWriteCheck(padapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return false; -+ -+ if (!hal_EfusePgPacketWriteHeader(padapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return false; -+ -+ if (!hal_EfusePgPacketWriteData(padapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return false; -+ -+ return true; -+} -+ -+static HAL_VERSION ReadChipVersion8723B(struct adapter *padapter) -+{ -+ u32 value32; -+ HAL_VERSION ChipVersion; -+ struct hal_com_data *pHalData; -+ -+/* YJ, TODO, move read chip type here */ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ value32 = rtw_read32(padapter, REG_SYS_CFG); -+ ChipVersion.ICType = CHIP_8723B; -+ ChipVersion.ChipType = ((value32 & RTL_ID) ? TEST_CHIP : NORMAL_CHIP); -+ ChipVersion.RFType = RF_TYPE_1T1R; -+ ChipVersion.VendorType = ((value32 & VENDOR_ID) ? CHIP_VENDOR_UMC : CHIP_VENDOR_TSMC); -+ ChipVersion.CUTVersion = (value32 & CHIP_VER_RTL_MASK)>>CHIP_VER_RTL_SHIFT; /* IC version (CUT) */ -+ -+ /* For regulator mode. by tynli. 2011.01.14 */ -+ pHalData->RegulatorMode = ((value32 & SPS_SEL) ? RT_LDO_REGULATOR : RT_SWITCHING_REGULATOR); -+ -+ value32 = rtw_read32(padapter, REG_GPIO_OUTSTS); -+ ChipVersion.ROMVer = ((value32 & RF_RL_ID) >> 20); /* ROM code version. */ -+ -+ /* For multi-function consideration. Added by Roger, 2010.10.06. */ -+ pHalData->MultiFunc = RT_MULTI_FUNC_NONE; -+ value32 = rtw_read32(padapter, REG_MULTI_FUNC_CTRL); -+ pHalData->MultiFunc |= ((value32 & WL_FUNC_EN) ? RT_MULTI_FUNC_WIFI : 0); -+ pHalData->MultiFunc |= ((value32 & BT_FUNC_EN) ? RT_MULTI_FUNC_BT : 0); -+ pHalData->MultiFunc |= ((value32 & GPS_FUNC_EN) ? RT_MULTI_FUNC_GPS : 0); -+ pHalData->PolarityCtl = ((value32 & WL_HWPDN_SL) ? RT_POLARITY_HIGH_ACT : RT_POLARITY_LOW_ACT); -+#if 1 -+ dump_chip_info(ChipVersion); -+#endif -+ pHalData->VersionID = ChipVersion; -+ if (IS_1T2R(ChipVersion)) -+ pHalData->rf_type = RF_1T2R; -+ else if (IS_2T2R(ChipVersion)) -+ pHalData->rf_type = RF_2T2R; -+ else -+ pHalData->rf_type = RF_1T1R; -+ -+ MSG_8192C("RF_Type is %x!!\n", pHalData->rf_type); -+ -+ return ChipVersion; -+} -+ -+static void rtl8723b_read_chip_version(struct adapter *padapter) -+{ -+ ReadChipVersion8723B(padapter); -+} -+ -+void rtl8723b_InitBeaconParameters(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u16 val16; -+ u8 val8; -+ -+ -+ val8 = DIS_TSF_UDT; -+ val16 = val8 | (val8 << 8); /* port0 and port1 */ -+ -+ /* Enable prot0 beacon function for PSTDMA */ -+ val16 |= EN_BCN_FUNCTION; -+ -+ rtw_write16(padapter, REG_BCN_CTRL, val16); -+ -+ /* TODO: Remove these magic number */ -+ rtw_write16(padapter, REG_TBTT_PROHIBIT, 0x6404);/* ms */ -+ /* Firmware will control REG_DRVERLYINT when power saving is enable, */ -+ /* so don't set this register on STA mode. */ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) == false) -+ rtw_write8(padapter, REG_DRVERLYINT, DRIVER_EARLY_INT_TIME_8723B); /* 5ms */ -+ rtw_write8(padapter, REG_BCNDMATIM, BCN_DMA_ATIME_INT_TIME_8723B); /* 2ms */ -+ -+ /* Suggested by designer timchen. Change beacon AIFS to the largest number */ -+ /* beacause test chip does not contension before sending beacon. by tynli. 2009.11.03 */ -+ rtw_write16(padapter, REG_BCNTCFG, 0x660F); -+ -+ pHalData->RegBcnCtrlVal = rtw_read8(padapter, REG_BCN_CTRL); -+ pHalData->RegTxPause = rtw_read8(padapter, REG_TXPAUSE); -+ pHalData->RegFwHwTxQCtrl = rtw_read8(padapter, REG_FWHW_TXQ_CTRL+2); -+ pHalData->RegReg542 = rtw_read8(padapter, REG_TBTT_PROHIBIT+2); -+ pHalData->RegCR_1 = rtw_read8(padapter, REG_CR+1); -+} -+ -+void _InitBurstPktLen_8723BS(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ rtw_write8(Adapter, 0x4c7, rtw_read8(Adapter, 0x4c7)|BIT(7)); /* enable single pkt ampdu */ -+ rtw_write8(Adapter, REG_RX_PKT_LIMIT_8723B, 0x18); /* for VHT packet length 11K */ -+ rtw_write8(Adapter, REG_MAX_AGGR_NUM_8723B, 0x1F); -+ rtw_write8(Adapter, REG_PIFS_8723B, 0x00); -+ rtw_write8(Adapter, REG_FWHW_TXQ_CTRL_8723B, rtw_read8(Adapter, REG_FWHW_TXQ_CTRL)&(~BIT(7))); -+ if (pHalData->AMPDUBurstMode) -+ rtw_write8(Adapter, REG_AMPDU_BURST_MODE_8723B, 0x5F); -+ rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8723B, 0x70); -+ -+ /* ARFB table 9 for 11ac 5G 2SS */ -+ rtw_write32(Adapter, REG_ARFR0_8723B, 0x00000010); -+ if (IS_NORMAL_CHIP(pHalData->VersionID)) -+ rtw_write32(Adapter, REG_ARFR0_8723B+4, 0xfffff000); -+ else -+ rtw_write32(Adapter, REG_ARFR0_8723B+4, 0x3e0ff000); -+ -+ /* ARFB table 10 for 11ac 5G 1SS */ -+ rtw_write32(Adapter, REG_ARFR1_8723B, 0x00000010); -+ rtw_write32(Adapter, REG_ARFR1_8723B+4, 0x003ff000); -+} -+ -+static void ResumeTxBeacon(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+ -+ /* 2010.03.01. Marked by tynli. No need to call workitem beacause we record the value */ -+ /* which should be read from register to a global variable. */ -+ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("+ResumeTxBeacon\n")); -+ -+ pHalData->RegFwHwTxQCtrl |= BIT(6); -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, pHalData->RegFwHwTxQCtrl); -+ rtw_write8(padapter, REG_TBTT_PROHIBIT+1, 0xff); -+ pHalData->RegReg542 |= BIT(0); -+ rtw_write8(padapter, REG_TBTT_PROHIBIT+2, pHalData->RegReg542); -+} -+ -+static void StopTxBeacon(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+ -+ /* 2010.03.01. Marked by tynli. No need to call workitem beacause we record the value */ -+ /* which should be read from register to a global variable. */ -+ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("+StopTxBeacon\n")); -+ -+ pHalData->RegFwHwTxQCtrl &= ~BIT(6); -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, pHalData->RegFwHwTxQCtrl); -+ rtw_write8(padapter, REG_TBTT_PROHIBIT+1, 0x64); -+ pHalData->RegReg542 &= ~BIT(0); -+ rtw_write8(padapter, REG_TBTT_PROHIBIT+2, pHalData->RegReg542); -+ -+ CheckFwRsvdPageContent(padapter); /* 2010.06.23. Added by tynli. */ -+} -+ -+static void _BeaconFunctionEnable(struct adapter *padapter, u8 Enable, u8 Linked) -+{ -+ rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); -+ rtw_write8(padapter, REG_RD_CTRL+1, 0x6F); -+} -+ -+static void rtl8723b_SetBeaconRelatedRegisters(struct adapter *padapter) -+{ -+ u8 val8; -+ u32 value32; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ u32 bcn_ctrl_reg; -+ -+ /* reset TSF, enable update TSF, correcting TSF On Beacon */ -+ -+ /* REG_BCN_INTERVAL */ -+ /* REG_BCNDMATIM */ -+ /* REG_ATIMWND */ -+ /* REG_TBTT_PROHIBIT */ -+ /* REG_DRVERLYINT */ -+ /* REG_BCN_MAX_ERR */ -+ /* REG_BCNTCFG (0x510) */ -+ /* REG_DUAL_TSF_RST */ -+ /* REG_BCN_CTRL (0x550) */ -+ -+ -+ bcn_ctrl_reg = REG_BCN_CTRL; -+ -+ /* */ -+ /* ATIM window */ -+ /* */ -+ rtw_write16(padapter, REG_ATIMWND, 2); -+ -+ /* */ -+ /* Beacon interval (in unit of TU). */ -+ /* */ -+ rtw_write16(padapter, REG_BCN_INTERVAL, pmlmeinfo->bcn_interval); -+ -+ rtl8723b_InitBeaconParameters(padapter); -+ -+ rtw_write8(padapter, REG_SLOT, 0x09); -+ -+ /* */ -+ /* Reset TSF Timer to zero, added by Roger. 2008.06.24 */ -+ /* */ -+ value32 = rtw_read32(padapter, REG_TCR); -+ value32 &= ~TSFRST; -+ rtw_write32(padapter, REG_TCR, value32); -+ -+ value32 |= TSFRST; -+ rtw_write32(padapter, REG_TCR, value32); -+ -+ /* NOTE: Fix test chip's bug (about contention windows's randomness) */ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE|WIFI_AP_STATE) == true) { -+ rtw_write8(padapter, REG_RXTSF_OFFSET_CCK, 0x50); -+ rtw_write8(padapter, REG_RXTSF_OFFSET_OFDM, 0x50); -+ } -+ -+ _BeaconFunctionEnable(padapter, true, true); -+ -+ ResumeTxBeacon(padapter); -+ val8 = rtw_read8(padapter, bcn_ctrl_reg); -+ val8 |= DIS_BCNQ_SUB; -+ rtw_write8(padapter, bcn_ctrl_reg, val8); -+} -+ -+static void rtl8723b_GetHalODMVar( -+ struct adapter *Adapter, -+ enum HAL_ODM_VARIABLE eVariable, -+ void *pValue1, -+ void *pValue2 -+) -+{ -+ GetHalODMVar(Adapter, eVariable, pValue1, pValue2); -+} -+ -+static void rtl8723b_SetHalODMVar( -+ struct adapter *Adapter, -+ enum HAL_ODM_VARIABLE eVariable, -+ void *pValue1, -+ bool bSet -+) -+{ -+ SetHalODMVar(Adapter, eVariable, pValue1, bSet); -+} -+ -+static void hal_notch_filter_8723b(struct adapter *adapter, bool enable) -+{ -+ if (enable) { -+ DBG_871X("Enable notch filter\n"); -+ rtw_write8(adapter, rOFDM0_RxDSP+1, rtw_read8(adapter, rOFDM0_RxDSP+1) | BIT1); -+ } else { -+ DBG_871X("Disable notch filter\n"); -+ rtw_write8(adapter, rOFDM0_RxDSP+1, rtw_read8(adapter, rOFDM0_RxDSP+1) & ~BIT1); -+ } -+} -+ -+static void UpdateHalRAMask8723B(struct adapter *padapter, u32 mac_id, u8 rssi_level) -+{ -+ u32 mask, rate_bitmap; -+ u8 shortGIrate = false; -+ struct sta_info *psta; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ DBG_871X("%s(): mac_id =%d rssi_level =%d\n", __func__, mac_id, rssi_level); -+ -+ if (mac_id >= NUM_STA) /* CAM_SIZE */ -+ return; -+ -+ psta = pmlmeinfo->FW_sta_info[mac_id].psta; -+ if (psta == NULL) -+ return; -+ -+ shortGIrate = query_ra_short_GI(psta); -+ -+ mask = psta->ra_mask; -+ -+ rate_bitmap = 0xffffffff; -+ rate_bitmap = ODM_Get_Rate_Bitmap(&pHalData->odmpriv, mac_id, mask, rssi_level); -+ DBG_871X("%s => mac_id:%d, networkType:0x%02x, mask:0x%08x\n\t ==> rssi_level:%d, rate_bitmap:0x%08x\n", -+ __func__, mac_id, psta->wireless_mode, mask, rssi_level, rate_bitmap); -+ -+ mask &= rate_bitmap; -+ -+ rate_bitmap = rtw_btcoex_GetRaMask(padapter); -+ mask &= ~rate_bitmap; -+ -+#ifdef CONFIG_CMCC_TEST -+ if (pmlmeext->cur_wireless_mode & WIRELESS_11G) { -+ if (mac_id == 0) { -+ DBG_871X("CMCC_BT update raid entry, mask = 0x%x\n", mask); -+ mask &= 0xffffff00; /* disable CCK & <24M OFDM rate for 11G mode for CMCC */ -+ DBG_871X("CMCC_BT update raid entry, mask = 0x%x\n", mask); -+ } -+ } -+#endif -+ -+ if (pHalData->fw_ractrl == true) { -+ rtl8723b_set_FwMacIdConfig_cmd(padapter, mac_id, psta->raid, psta->bw_mode, shortGIrate, mask); -+ } -+ -+ /* set correct initial date rate for each mac_id */ -+ pdmpriv->INIDATA_RATE[mac_id] = psta->init_rate; -+ DBG_871X("%s(): mac_id =%d raid = 0x%x bw =%d mask = 0x%x init_rate = 0x%x\n", __func__, mac_id, psta->raid, psta->bw_mode, mask, psta->init_rate); -+} -+ -+ -+void rtl8723b_set_hal_ops(struct hal_ops *pHalFunc) -+{ -+ pHalFunc->free_hal_data = &rtl8723b_free_hal_data; -+ -+ pHalFunc->dm_init = &rtl8723b_init_dm_priv; -+ -+ pHalFunc->read_chip_version = &rtl8723b_read_chip_version; -+ -+ pHalFunc->UpdateRAMaskHandler = &UpdateHalRAMask8723B; -+ -+ pHalFunc->set_bwmode_handler = &PHY_SetBWMode8723B; -+ pHalFunc->set_channel_handler = &PHY_SwChnl8723B; -+ pHalFunc->set_chnl_bw_handler = &PHY_SetSwChnlBWMode8723B; -+ -+ pHalFunc->set_tx_power_level_handler = &PHY_SetTxPowerLevel8723B; -+ pHalFunc->get_tx_power_level_handler = &PHY_GetTxPowerLevel8723B; -+ -+ pHalFunc->hal_dm_watchdog = &rtl8723b_HalDmWatchDog; -+ pHalFunc->hal_dm_watchdog_in_lps = &rtl8723b_HalDmWatchDog_in_LPS; -+ -+ -+ pHalFunc->SetBeaconRelatedRegistersHandler = &rtl8723b_SetBeaconRelatedRegisters; -+ -+ pHalFunc->Add_RateATid = &rtl8723b_Add_RateATid; -+ -+ pHalFunc->run_thread = &rtl8723b_start_thread; -+ pHalFunc->cancel_thread = &rtl8723b_stop_thread; -+ -+ pHalFunc->read_bbreg = &PHY_QueryBBReg_8723B; -+ pHalFunc->write_bbreg = &PHY_SetBBReg_8723B; -+ pHalFunc->read_rfreg = &PHY_QueryRFReg_8723B; -+ pHalFunc->write_rfreg = &PHY_SetRFReg_8723B; -+ -+ /* Efuse related function */ -+ pHalFunc->BTEfusePowerSwitch = &Hal_BT_EfusePowerSwitch; -+ pHalFunc->EfusePowerSwitch = &Hal_EfusePowerSwitch; -+ pHalFunc->ReadEFuse = &Hal_ReadEFuse; -+ pHalFunc->EFUSEGetEfuseDefinition = &Hal_GetEfuseDefinition; -+ pHalFunc->EfuseGetCurrentSize = &Hal_EfuseGetCurrentSize; -+ pHalFunc->Efuse_PgPacketRead = &Hal_EfusePgPacketRead; -+ pHalFunc->Efuse_PgPacketWrite = &Hal_EfusePgPacketWrite; -+ pHalFunc->Efuse_WordEnableDataWrite = &Hal_EfuseWordEnableDataWrite; -+ pHalFunc->Efuse_PgPacketWrite_BT = &Hal_EfusePgPacketWrite_BT; -+ -+ pHalFunc->GetHalODMVarHandler = &rtl8723b_GetHalODMVar; -+ pHalFunc->SetHalODMVarHandler = &rtl8723b_SetHalODMVar; -+ -+ pHalFunc->xmit_thread_handler = &hal_xmit_handler; -+ pHalFunc->hal_notch_filter = &hal_notch_filter_8723b; -+ -+ pHalFunc->c2h_handler = c2h_handler_8723b; -+ pHalFunc->c2h_id_filter_ccx = c2h_id_filter_ccx_8723b; -+ -+ pHalFunc->fill_h2c_cmd = &FillH2CCmd8723B; -+} -+ -+void rtl8723b_InitAntenna_Selection(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ u8 val; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ val = rtw_read8(padapter, REG_LEDCFG2); -+ /* Let 8051 take control antenna settting */ -+ val |= BIT(7); /* DPDT_SEL_EN, 0x4C[23] */ -+ rtw_write8(padapter, REG_LEDCFG2, val); -+} -+ -+void rtl8723b_init_default_value(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ struct dm_priv *pdmpriv; -+ u8 i; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pdmpriv = &pHalData->dmpriv; -+ -+ padapter->registrypriv.wireless_mode = WIRELESS_11BG_24N; -+ -+ /* init default value */ -+ pHalData->fw_ractrl = false; -+ pHalData->bIQKInitialized = false; -+ if (!adapter_to_pwrctl(padapter)->bkeepfwalive) -+ pHalData->LastHMEBoxNum = 0; -+ -+ pHalData->bIQKInitialized = false; -+ -+ /* init dm default value */ -+ pdmpriv->TM_Trigger = 0;/* for IQK */ -+/* pdmpriv->binitialized = false; */ -+/* pdmpriv->prv_traffic_idx = 3; */ -+/* pdmpriv->initialize = 0; */ -+ -+ pdmpriv->ThermalValue_HP_index = 0; -+ for (i = 0; i < HP_THERMAL_NUM; i++) -+ pdmpriv->ThermalValue_HP[i] = 0; -+ -+ /* init Efuse variables */ -+ pHalData->EfuseUsedBytes = 0; -+ pHalData->EfuseUsedPercentage = 0; -+#ifdef HAL_EFUSE_MEMORY -+ pHalData->EfuseHal.fakeEfuseBank = 0; -+ pHalData->EfuseHal.fakeEfuseUsedBytes = 0; -+ memset(pHalData->EfuseHal.fakeEfuseContent, 0xFF, EFUSE_MAX_HW_SIZE); -+ memset(pHalData->EfuseHal.fakeEfuseInitMap, 0xFF, EFUSE_MAX_MAP_LEN); -+ memset(pHalData->EfuseHal.fakeEfuseModifiedMap, 0xFF, EFUSE_MAX_MAP_LEN); -+ pHalData->EfuseHal.BTEfuseUsedBytes = 0; -+ pHalData->EfuseHal.BTEfuseUsedPercentage = 0; -+ memset(pHalData->EfuseHal.BTEfuseContent, 0xFF, EFUSE_MAX_BT_BANK*EFUSE_MAX_HW_SIZE); -+ memset(pHalData->EfuseHal.BTEfuseInitMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); -+ memset(pHalData->EfuseHal.BTEfuseModifiedMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); -+ pHalData->EfuseHal.fakeBTEfuseUsedBytes = 0; -+ memset(pHalData->EfuseHal.fakeBTEfuseContent, 0xFF, EFUSE_MAX_BT_BANK*EFUSE_MAX_HW_SIZE); -+ memset(pHalData->EfuseHal.fakeBTEfuseInitMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); -+ memset(pHalData->EfuseHal.fakeBTEfuseModifiedMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); -+#endif -+} -+ -+u8 GetEEPROMSize8723B(struct adapter *padapter) -+{ -+ u8 size = 0; -+ u32 cr; -+ -+ cr = rtw_read16(padapter, REG_9346CR); -+ /* 6: EEPROM used is 93C46, 4: boot from E-Fuse. */ -+ size = (cr & BOOT_FROM_EEPROM) ? 6 : 4; -+ -+ MSG_8192C("EEPROM type is %s\n", size == 4 ? "E-FUSE" : "93C46"); -+ -+ return size; -+} -+ -+/* */ -+/* */ -+/* LLT R/W/Init function */ -+/* */ -+/* */ -+s32 rtl8723b_InitLLTTable(struct adapter *padapter) -+{ -+ unsigned long start, passing_time; -+ u32 val32; -+ s32 ret; -+ -+ -+ ret = _FAIL; -+ -+ val32 = rtw_read32(padapter, REG_AUTO_LLT); -+ val32 |= BIT_AUTO_INIT_LLT; -+ rtw_write32(padapter, REG_AUTO_LLT, val32); -+ -+ start = jiffies; -+ -+ do { -+ val32 = rtw_read32(padapter, REG_AUTO_LLT); -+ if (!(val32 & BIT_AUTO_INIT_LLT)) { -+ ret = _SUCCESS; -+ break; -+ } -+ -+ passing_time = jiffies_to_msecs(jiffies - start); -+ if (passing_time > 1000) { -+ DBG_8192C( -+ "%s: FAIL!! REG_AUTO_LLT(0x%X) =%08x\n", -+ __func__, -+ REG_AUTO_LLT, -+ val32 -+ ); -+ break; -+ } -+ -+ msleep(1); -+ } while (1); -+ -+ return ret; -+} -+ -+static bool Hal_GetChnlGroup8723B(u8 Channel, u8 *pGroup) -+{ -+ bool bIn24G = true; -+ -+ if (Channel <= 14) { -+ bIn24G = true; -+ -+ if (1 <= Channel && Channel <= 2) -+ *pGroup = 0; -+ else if (3 <= Channel && Channel <= 5) -+ *pGroup = 1; -+ else if (6 <= Channel && Channel <= 8) -+ *pGroup = 2; -+ else if (9 <= Channel && Channel <= 11) -+ *pGroup = 3; -+ else if (12 <= Channel && Channel <= 14) -+ *pGroup = 4; -+ else { -+ RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("==>Hal_GetChnlGroup8723B in 2.4 G, but Channel %d in Group not found\n", Channel)); -+ } -+ } else { -+ bIn24G = false; -+ -+ if (36 <= Channel && Channel <= 42) -+ *pGroup = 0; -+ else if (44 <= Channel && Channel <= 48) -+ *pGroup = 1; -+ else if (50 <= Channel && Channel <= 58) -+ *pGroup = 2; -+ else if (60 <= Channel && Channel <= 64) -+ *pGroup = 3; -+ else if (100 <= Channel && Channel <= 106) -+ *pGroup = 4; -+ else if (108 <= Channel && Channel <= 114) -+ *pGroup = 5; -+ else if (116 <= Channel && Channel <= 122) -+ *pGroup = 6; -+ else if (124 <= Channel && Channel <= 130) -+ *pGroup = 7; -+ else if (132 <= Channel && Channel <= 138) -+ *pGroup = 8; -+ else if (140 <= Channel && Channel <= 144) -+ *pGroup = 9; -+ else if (149 <= Channel && Channel <= 155) -+ *pGroup = 10; -+ else if (157 <= Channel && Channel <= 161) -+ *pGroup = 11; -+ else if (165 <= Channel && Channel <= 171) -+ *pGroup = 12; -+ else if (173 <= Channel && Channel <= 177) -+ *pGroup = 13; -+ else { -+ RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("==>Hal_GetChnlGroup8723B in 5G, but Channel %d in Group not found\n", Channel)); -+ } -+ -+ } -+ RT_TRACE( -+ _module_hci_hal_init_c_, -+ _drv_info_, -+ ( -+ "<==Hal_GetChnlGroup8723B, (%s) Channel = %d, Group =%d,\n", -+ bIn24G ? "2.4G" : "5G", -+ Channel, -+ *pGroup -+ ) -+ ); -+ return bIn24G; -+} -+ -+void Hal_InitPGData(struct adapter *padapter, u8 *PROMContent) -+{ -+ struct eeprom_priv *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ -+ if (false == pEEPROM->bautoload_fail_flag) { /* autoload OK. */ -+ if (!pEEPROM->EepromOrEfuse) { -+ /* Read EFUSE real map to shadow. */ -+ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, false); -+ memcpy((void *)PROMContent, (void *)pEEPROM->efuse_eeprom_data, HWSET_MAX_SIZE_8723B); -+ } -+ } else {/* autoload fail */ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("AutoLoad Fail reported from CR9346!!\n")); -+ if (false == pEEPROM->EepromOrEfuse) -+ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, false); -+ memcpy((void *)PROMContent, (void *)pEEPROM->efuse_eeprom_data, HWSET_MAX_SIZE_8723B); -+ } -+} -+ -+void Hal_EfuseParseIDCode(struct adapter *padapter, u8 *hwinfo) -+{ -+ struct eeprom_priv *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+/* struct hal_com_data *pHalData = GET_HAL_DATA(padapter); */ -+ u16 EEPROMId; -+ -+ -+ /* Checl 0x8129 again for making sure autoload status!! */ -+ EEPROMId = le16_to_cpu(*((__le16 *)hwinfo)); -+ if (EEPROMId != RTL_EEPROM_ID) { -+ DBG_8192C("EEPROM ID(%#x) is invalid!!\n", EEPROMId); -+ pEEPROM->bautoload_fail_flag = true; -+ } else -+ pEEPROM->bautoload_fail_flag = false; -+ -+ RT_TRACE(_module_hal_init_c_, _drv_notice_, ("EEPROM ID = 0x%04x\n", EEPROMId)); -+} -+ -+static void Hal_ReadPowerValueFromPROM_8723B( -+ struct adapter *Adapter, -+ struct TxPowerInfo24G *pwrInfo24G, -+ u8 *PROMContent, -+ bool AutoLoadFail -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ u32 rfPath, eeAddr = EEPROM_TX_PWR_INX_8723B, group, TxCount = 0; -+ -+ memset(pwrInfo24G, 0, sizeof(struct TxPowerInfo24G)); -+ -+ if (0xFF == PROMContent[eeAddr+1]) -+ AutoLoadFail = true; -+ -+ if (AutoLoadFail) { -+ DBG_871X("%s(): Use Default value!\n", __func__); -+ for (rfPath = 0; rfPath < MAX_RF_PATH; rfPath++) { -+ /* 2.4G default value */ -+ for (group = 0; group < MAX_CHNL_GROUP_24G; group++) { -+ pwrInfo24G->IndexCCK_Base[rfPath][group] = EEPROM_DEFAULT_24G_INDEX; -+ pwrInfo24G->IndexBW40_Base[rfPath][group] = EEPROM_DEFAULT_24G_INDEX; -+ } -+ -+ for (TxCount = 0; TxCount < MAX_TX_COUNT; TxCount++) { -+ if (TxCount == 0) { -+ pwrInfo24G->BW20_Diff[rfPath][0] = EEPROM_DEFAULT_24G_HT20_DIFF; -+ pwrInfo24G->OFDM_Diff[rfPath][0] = EEPROM_DEFAULT_24G_OFDM_DIFF; -+ } else { -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ pwrInfo24G->BW40_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ pwrInfo24G->CCK_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ } -+ } -+ } -+ -+ return; -+ } -+ -+ pHalData->bTXPowerDataReadFromEEPORM = true; /* YJ, move, 120316 */ -+ -+ for (rfPath = 0; rfPath < MAX_RF_PATH; rfPath++) { -+ /* 2 2.4G default value */ -+ for (group = 0; group < MAX_CHNL_GROUP_24G; group++) { -+ pwrInfo24G->IndexCCK_Base[rfPath][group] = PROMContent[eeAddr++]; -+ if (pwrInfo24G->IndexCCK_Base[rfPath][group] == 0xFF) -+ pwrInfo24G->IndexCCK_Base[rfPath][group] = EEPROM_DEFAULT_24G_INDEX; -+ } -+ -+ for (group = 0; group < MAX_CHNL_GROUP_24G-1; group++) { -+ pwrInfo24G->IndexBW40_Base[rfPath][group] = PROMContent[eeAddr++]; -+ if (pwrInfo24G->IndexBW40_Base[rfPath][group] == 0xFF) -+ pwrInfo24G->IndexBW40_Base[rfPath][group] = EEPROM_DEFAULT_24G_INDEX; -+ } -+ -+ for (TxCount = 0; TxCount < MAX_TX_COUNT; TxCount++) { -+ if (TxCount == 0) { -+ pwrInfo24G->BW40_Diff[rfPath][TxCount] = 0; -+ if (PROMContent[eeAddr] == 0xFF) -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] = EEPROM_DEFAULT_24G_HT20_DIFF; -+ else { -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; -+ if (pwrInfo24G->BW20_Diff[rfPath][TxCount] & BIT3) /* 4bit sign number to 8 bit sign number */ -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ -+ if (PROMContent[eeAddr] == 0xFF) -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] = EEPROM_DEFAULT_24G_OFDM_DIFF; -+ else { -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); -+ if (pwrInfo24G->OFDM_Diff[rfPath][TxCount] & BIT3) /* 4bit sign number to 8 bit sign number */ -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ pwrInfo24G->CCK_Diff[rfPath][TxCount] = 0; -+ eeAddr++; -+ } else { -+ if (PROMContent[eeAddr] == 0xFF) -+ pwrInfo24G->BW40_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ else { -+ pwrInfo24G->BW40_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; -+ if (pwrInfo24G->BW40_Diff[rfPath][TxCount] & BIT3) /* 4bit sign number to 8 bit sign number */ -+ pwrInfo24G->BW40_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ -+ if (PROMContent[eeAddr] == 0xFF) -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ else { -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); -+ if (pwrInfo24G->BW20_Diff[rfPath][TxCount] & BIT3) /* 4bit sign number to 8 bit sign number */ -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ eeAddr++; -+ -+ if (PROMContent[eeAddr] == 0xFF) -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ else { -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; -+ if (pwrInfo24G->OFDM_Diff[rfPath][TxCount] & BIT3) /* 4bit sign number to 8 bit sign number */ -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ -+ if (PROMContent[eeAddr] == 0xFF) -+ pwrInfo24G->CCK_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ else { -+ pwrInfo24G->CCK_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); -+ if (pwrInfo24G->CCK_Diff[rfPath][TxCount] & BIT3) /* 4bit sign number to 8 bit sign number */ -+ pwrInfo24G->CCK_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ eeAddr++; -+ } -+ } -+ } -+} -+ -+ -+void Hal_EfuseParseTxPowerInfo_8723B( -+ struct adapter *padapter, u8 *PROMContent, bool AutoLoadFail -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ struct TxPowerInfo24G pwrInfo24G; -+ u8 rfPath, ch, TxCount = 1; -+ -+ Hal_ReadPowerValueFromPROM_8723B(padapter, &pwrInfo24G, PROMContent, AutoLoadFail); -+ for (rfPath = 0 ; rfPath < MAX_RF_PATH ; rfPath++) { -+ for (ch = 0 ; ch < CHANNEL_MAX_NUMBER; ch++) { -+ u8 group = 0; -+ -+ Hal_GetChnlGroup8723B(ch+1, &group); -+ -+ if (ch == 14-1) { -+ pHalData->Index24G_CCK_Base[rfPath][ch] = pwrInfo24G.IndexCCK_Base[rfPath][5]; -+ pHalData->Index24G_BW40_Base[rfPath][ch] = pwrInfo24G.IndexBW40_Base[rfPath][group]; -+ } else { -+ pHalData->Index24G_CCK_Base[rfPath][ch] = pwrInfo24G.IndexCCK_Base[rfPath][group]; -+ pHalData->Index24G_BW40_Base[rfPath][ch] = pwrInfo24G.IndexBW40_Base[rfPath][group]; -+ } -+#ifdef CONFIG_DEBUG -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("======= Path %d, ChannelIndex %d, Group %d =======\n", rfPath, ch, group)); -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("Index24G_CCK_Base[%d][%d] = 0x%x\n", rfPath, ch, pHalData->Index24G_CCK_Base[rfPath][ch])); -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("Index24G_BW40_Base[%d][%d] = 0x%x\n", rfPath, ch, pHalData->Index24G_BW40_Base[rfPath][ch])); -+#endif -+ } -+ -+ for (TxCount = 0; TxCount < MAX_TX_COUNT; TxCount++) { -+ pHalData->CCK_24G_Diff[rfPath][TxCount] = pwrInfo24G.CCK_Diff[rfPath][TxCount]; -+ pHalData->OFDM_24G_Diff[rfPath][TxCount] = pwrInfo24G.OFDM_Diff[rfPath][TxCount]; -+ pHalData->BW20_24G_Diff[rfPath][TxCount] = pwrInfo24G.BW20_Diff[rfPath][TxCount]; -+ pHalData->BW40_24G_Diff[rfPath][TxCount] = pwrInfo24G.BW40_Diff[rfPath][TxCount]; -+ -+#ifdef CONFIG_DEBUG -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("--------------------------------------- 2.4G ---------------------------------------\n")); -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("CCK_24G_Diff[%d][%d]= %d\n", rfPath, TxCount, pHalData->CCK_24G_Diff[rfPath][TxCount])); -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("OFDM_24G_Diff[%d][%d]= %d\n", rfPath, TxCount, pHalData->OFDM_24G_Diff[rfPath][TxCount])); -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("BW20_24G_Diff[%d][%d]= %d\n", rfPath, TxCount, pHalData->BW20_24G_Diff[rfPath][TxCount])); -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("BW40_24G_Diff[%d][%d]= %d\n", rfPath, TxCount, pHalData->BW40_24G_Diff[rfPath][TxCount])); -+#endif -+ } -+ } -+ -+ /* 2010/10/19 MH Add Regulator recognize for CU. */ -+ if (!AutoLoadFail) { -+ pHalData->EEPROMRegulatory = (PROMContent[EEPROM_RF_BOARD_OPTION_8723B]&0x7); /* bit0~2 */ -+ if (PROMContent[EEPROM_RF_BOARD_OPTION_8723B] == 0xFF) -+ pHalData->EEPROMRegulatory = (EEPROM_DEFAULT_BOARD_OPTION&0x7); /* bit0~2 */ -+ } else -+ pHalData->EEPROMRegulatory = 0; -+ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("EEPROMRegulatory = 0x%x\n", pHalData->EEPROMRegulatory)); -+} -+ -+void Hal_EfuseParseBTCoexistInfo_8723B( -+ struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u8 tempval; -+ u32 tmpu4; -+ -+ if (!AutoLoadFail) { -+ tmpu4 = rtw_read32(padapter, REG_MULTI_FUNC_CTRL); -+ if (tmpu4 & BT_FUNC_EN) -+ pHalData->EEPROMBluetoothCoexist = true; -+ else -+ pHalData->EEPROMBluetoothCoexist = false; -+ -+ pHalData->EEPROMBluetoothType = BT_RTL8723B; -+ -+ tempval = hwinfo[EEPROM_RF_BT_SETTING_8723B]; -+ if (tempval != 0xFF) { -+ pHalData->EEPROMBluetoothAntNum = tempval & BIT(0); -+ /* EFUSE_0xC3[6] == 0, S1(Main)-ODM_RF_PATH_A; */ -+ /* EFUSE_0xC3[6] == 1, S0(Aux)-ODM_RF_PATH_B */ -+ pHalData->ant_path = (tempval & BIT(6))?ODM_RF_PATH_B:ODM_RF_PATH_A; -+ } else { -+ pHalData->EEPROMBluetoothAntNum = Ant_x1; -+ if (pHalData->PackageType == PACKAGE_QFN68) -+ pHalData->ant_path = ODM_RF_PATH_B; -+ else -+ pHalData->ant_path = ODM_RF_PATH_A; -+ } -+ } else { -+ pHalData->EEPROMBluetoothCoexist = false; -+ pHalData->EEPROMBluetoothType = BT_RTL8723B; -+ pHalData->EEPROMBluetoothAntNum = Ant_x1; -+ pHalData->ant_path = ODM_RF_PATH_A; -+ } -+ -+ if (padapter->registrypriv.ant_num > 0) { -+ DBG_8192C( -+ "%s: Apply driver defined antenna number(%d) to replace origin(%d)\n", -+ __func__, -+ padapter->registrypriv.ant_num, -+ pHalData->EEPROMBluetoothAntNum == Ant_x2 ? 2 : 1 -+ ); -+ -+ switch (padapter->registrypriv.ant_num) { -+ case 1: -+ pHalData->EEPROMBluetoothAntNum = Ant_x1; -+ break; -+ case 2: -+ pHalData->EEPROMBluetoothAntNum = Ant_x2; -+ break; -+ default: -+ DBG_8192C( -+ "%s: Discard invalid driver defined antenna number(%d)!\n", -+ __func__, -+ padapter->registrypriv.ant_num -+ ); -+ break; -+ } -+ } -+ -+ rtw_btcoex_SetBTCoexist(padapter, pHalData->EEPROMBluetoothCoexist); -+ rtw_btcoex_SetChipType(padapter, pHalData->EEPROMBluetoothType); -+ rtw_btcoex_SetPGAntNum(padapter, pHalData->EEPROMBluetoothAntNum == Ant_x2 ? 2 : 1); -+ if (pHalData->EEPROMBluetoothAntNum == Ant_x1) -+ rtw_btcoex_SetSingleAntPath(padapter, pHalData->ant_path); -+ -+ DBG_8192C( -+ "%s: %s BT-coex, ant_num =%d\n", -+ __func__, -+ pHalData->EEPROMBluetoothCoexist == true ? "Enable" : "Disable", -+ pHalData->EEPROMBluetoothAntNum == Ant_x2 ? 2 : 1 -+ ); -+} -+ -+void Hal_EfuseParseEEPROMVer_8723B( -+ struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+/* RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("%s(): AutoLoadFail = %d\n", __func__, AutoLoadFail)); */ -+ if (!AutoLoadFail) -+ pHalData->EEPROMVersion = hwinfo[EEPROM_VERSION_8723B]; -+ else -+ pHalData->EEPROMVersion = 1; -+ RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("Hal_EfuseParseEEPROMVer(), EEVer = %d\n", -+ pHalData->EEPROMVersion)); -+} -+ -+ -+ -+void Hal_EfuseParsePackageType_8723B( -+ struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u8 package; -+ u8 efuseContent; -+ -+ Efuse_PowerSwitch(padapter, false, true); -+ efuse_OneByteRead(padapter, 0x1FB, &efuseContent, false); -+ DBG_871X("%s phy efuse read 0x1FB =%x\n", __func__, efuseContent); -+ Efuse_PowerSwitch(padapter, false, false); -+ -+ package = efuseContent & 0x7; -+ switch (package) { -+ case 0x4: -+ pHalData->PackageType = PACKAGE_TFBGA79; -+ break; -+ case 0x5: -+ pHalData->PackageType = PACKAGE_TFBGA90; -+ break; -+ case 0x6: -+ pHalData->PackageType = PACKAGE_QFN68; -+ break; -+ case 0x7: -+ pHalData->PackageType = PACKAGE_TFBGA80; -+ break; -+ -+ default: -+ pHalData->PackageType = PACKAGE_DEFAULT; -+ break; -+ } -+ -+ DBG_871X("PackageType = 0x%X\n", pHalData->PackageType); -+} -+ -+ -+void Hal_EfuseParseVoltage_8723B( -+ struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail -+) -+{ -+ struct eeprom_priv *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ -+ /* memcpy(pEEPROM->adjuseVoltageVal, &hwinfo[EEPROM_Voltage_ADDR_8723B], 1); */ -+ DBG_871X("%s hwinfo[EEPROM_Voltage_ADDR_8723B] =%02x\n", __func__, hwinfo[EEPROM_Voltage_ADDR_8723B]); -+ pEEPROM->adjuseVoltageVal = (hwinfo[EEPROM_Voltage_ADDR_8723B] & 0xf0) >> 4; -+ DBG_871X("%s pEEPROM->adjuseVoltageVal =%x\n", __func__, pEEPROM->adjuseVoltageVal); -+} -+ -+void Hal_EfuseParseChnlPlan_8723B( -+ struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail -+) -+{ -+ padapter->mlmepriv.ChannelPlan = hal_com_config_channel_plan( -+ padapter, -+ hwinfo ? hwinfo[EEPROM_ChannelPlan_8723B] : 0xFF, -+ padapter->registrypriv.channel_plan, -+ RT_CHANNEL_DOMAIN_WORLD_NULL, -+ AutoLoadFail -+ ); -+ -+ Hal_ChannelPlanToRegulation(padapter, padapter->mlmepriv.ChannelPlan); -+ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("EEPROM ChannelPlan = 0x%02x\n", padapter->mlmepriv.ChannelPlan)); -+} -+ -+void Hal_EfuseParseCustomerID_8723B( -+ struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+/* RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("%s(): AutoLoadFail = %d\n", __func__, AutoLoadFail)); */ -+ if (!AutoLoadFail) -+ pHalData->EEPROMCustomerID = hwinfo[EEPROM_CustomID_8723B]; -+ else -+ pHalData->EEPROMCustomerID = 0; -+ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("EEPROM Customer ID: 0x%2x\n", pHalData->EEPROMCustomerID)); -+} -+ -+void Hal_EfuseParseAntennaDiversity_8723B( -+ struct adapter *padapter, -+ u8 *hwinfo, -+ bool AutoLoadFail -+) -+{ -+} -+ -+void Hal_EfuseParseXtal_8723B( -+ struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+/* RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("%s(): AutoLoadFail = %d\n", __func__, AutoLoadFail)); */ -+ if (!AutoLoadFail) { -+ pHalData->CrystalCap = hwinfo[EEPROM_XTAL_8723B]; -+ if (pHalData->CrystalCap == 0xFF) -+ pHalData->CrystalCap = EEPROM_Default_CrystalCap_8723B; /* what value should 8812 set? */ -+ } else -+ pHalData->CrystalCap = EEPROM_Default_CrystalCap_8723B; -+ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("EEPROM CrystalCap: 0x%2x\n", pHalData->CrystalCap)); -+} -+ -+ -+void Hal_EfuseParseThermalMeter_8723B( -+ struct adapter *padapter, u8 *PROMContent, u8 AutoLoadFail -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+/* RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("%s(): AutoLoadFail = %d\n", __func__, AutoLoadFail)); */ -+ /* */ -+ /* ThermalMeter from EEPROM */ -+ /* */ -+ if (false == AutoLoadFail) -+ pHalData->EEPROMThermalMeter = PROMContent[EEPROM_THERMAL_METER_8723B]; -+ else -+ pHalData->EEPROMThermalMeter = EEPROM_Default_ThermalMeter_8723B; -+ -+ if ((pHalData->EEPROMThermalMeter == 0xff) || (true == AutoLoadFail)) { -+ pHalData->bAPKThermalMeterIgnore = true; -+ pHalData->EEPROMThermalMeter = EEPROM_Default_ThermalMeter_8723B; -+ } -+ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("EEPROM ThermalMeter = 0x%x\n", pHalData->EEPROMThermalMeter)); -+} -+ -+ -+void Hal_ReadRFGainOffset( -+ struct adapter *Adapter, u8 *PROMContent, bool AutoloadFail -+) -+{ -+ /* */ -+ /* BB_RF Gain Offset from EEPROM */ -+ /* */ -+ -+ if (!AutoloadFail) { -+ Adapter->eeprompriv.EEPROMRFGainOffset = PROMContent[EEPROM_RF_GAIN_OFFSET]; -+ DBG_871X("AutoloadFail =%x,\n", AutoloadFail); -+ Adapter->eeprompriv.EEPROMRFGainVal = EFUSE_Read1Byte(Adapter, EEPROM_RF_GAIN_VAL); -+ DBG_871X("Adapter->eeprompriv.EEPROMRFGainVal =%x\n", Adapter->eeprompriv.EEPROMRFGainVal); -+ } else { -+ Adapter->eeprompriv.EEPROMRFGainOffset = 0; -+ Adapter->eeprompriv.EEPROMRFGainVal = 0xFF; -+ DBG_871X("else AutoloadFail =%x,\n", AutoloadFail); -+ } -+ DBG_871X("EEPRORFGainOffset = 0x%02x\n", Adapter->eeprompriv.EEPROMRFGainOffset); -+} -+ -+u8 BWMapping_8723B(struct adapter *Adapter, struct pkt_attrib *pattrib) -+{ -+ u8 BWSettingOfDesc = 0; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ /* DBG_871X("BWMapping pHalData->CurrentChannelBW %d, pattrib->bwmode %d\n", pHalData->CurrentChannelBW, pattrib->bwmode); */ -+ -+ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) { -+ if (pattrib->bwmode == CHANNEL_WIDTH_80) -+ BWSettingOfDesc = 2; -+ else if (pattrib->bwmode == CHANNEL_WIDTH_40) -+ BWSettingOfDesc = 1; -+ else -+ BWSettingOfDesc = 0; -+ } else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) { -+ if ((pattrib->bwmode == CHANNEL_WIDTH_40) || (pattrib->bwmode == CHANNEL_WIDTH_80)) -+ BWSettingOfDesc = 1; -+ else -+ BWSettingOfDesc = 0; -+ } else -+ BWSettingOfDesc = 0; -+ -+ /* if (pTcb->bBTTxPacket) */ -+ /* BWSettingOfDesc = 0; */ -+ -+ return BWSettingOfDesc; -+} -+ -+u8 SCMapping_8723B(struct adapter *Adapter, struct pkt_attrib *pattrib) -+{ -+ u8 SCSettingOfDesc = 0; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ /* DBG_871X("SCMapping: pHalData->CurrentChannelBW %d, pHalData->nCur80MhzPrimeSC %d, pHalData->nCur40MhzPrimeSC %d\n", pHalData->CurrentChannelBW, pHalData->nCur80MhzPrimeSC, pHalData->nCur40MhzPrimeSC); */ -+ -+ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) { -+ if (pattrib->bwmode == CHANNEL_WIDTH_80) { -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ } else if (pattrib->bwmode == CHANNEL_WIDTH_40) { -+ if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOfDesc = VHT_DATA_SC_40_LOWER_OF_80MHZ; -+ else if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOfDesc = VHT_DATA_SC_40_UPPER_OF_80MHZ; -+ else -+ DBG_871X("SCMapping: Not Correct Primary40MHz Setting\n"); -+ } else { -+ if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWEST_OF_80MHZ; -+ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPERST_OF_80MHZ; -+ else -+ DBG_871X("SCMapping: Not Correct Primary40MHz Setting\n"); -+ } -+ } else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) { -+ /* DBG_871X("SCMapping: HT Case: pHalData->CurrentChannelBW %d, pHalData->nCur40MhzPrimeSC %d\n", pHalData->CurrentChannelBW, pHalData->nCur40MhzPrimeSC); */ -+ -+ if (pattrib->bwmode == CHANNEL_WIDTH_40) { -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ } else if (pattrib->bwmode == CHANNEL_WIDTH_20) { -+ if (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) { -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ } else if (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) { -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ } else { -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ } -+ } -+ } else { -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ } -+ -+ return SCSettingOfDesc; -+} -+ -+static void rtl8723b_cal_txdesc_chksum(struct tx_desc *ptxdesc) -+{ -+ u16 *usPtr = (u16 *)ptxdesc; -+ u32 count; -+ u32 index; -+ u16 checksum = 0; -+ -+ -+ /* Clear first */ -+ ptxdesc->txdw7 &= cpu_to_le32(0xffff0000); -+ -+ /* checksume is always calculated by first 32 bytes, */ -+ /* and it doesn't depend on TX DESC length. */ -+ /* Thomas, Lucas@SD4, 20130515 */ -+ count = 16; -+ -+ for (index = 0; index < count; index++) { -+ checksum |= le16_to_cpu(*(__le16 *)(usPtr + index)); -+ } -+ -+ ptxdesc->txdw7 |= cpu_to_le32(checksum & 0x0000ffff); -+} -+ -+static u8 fill_txdesc_sectype(struct pkt_attrib *pattrib) -+{ -+ u8 sectype = 0; -+ if ((pattrib->encrypt > 0) && !pattrib->bswenc) { -+ switch (pattrib->encrypt) { -+ /* SEC_TYPE */ -+ case _WEP40_: -+ case _WEP104_: -+ case _TKIP_: -+ case _TKIP_WTMIC_: -+ sectype = 1; -+ break; -+ -+ case _AES_: -+ sectype = 3; -+ break; -+ -+ case _NO_PRIVACY_: -+ default: -+ break; -+ } -+ } -+ return sectype; -+} -+ -+static void fill_txdesc_vcs_8723b(struct adapter *padapter, struct pkt_attrib *pattrib, PTXDESC_8723B ptxdesc) -+{ -+ /* DBG_8192C("cvs_mode =%d\n", pattrib->vcs_mode); */ -+ -+ if (pattrib->vcs_mode) { -+ switch (pattrib->vcs_mode) { -+ case RTS_CTS: -+ ptxdesc->rtsen = 1; -+ /* ENABLE HW RTS */ -+ ptxdesc->hw_rts_en = 1; -+ break; -+ -+ case CTS_TO_SELF: -+ ptxdesc->cts2self = 1; -+ break; -+ -+ case NONE_VCS: -+ default: -+ break; -+ } -+ -+ ptxdesc->rtsrate = 8; /* RTS Rate =24M */ -+ ptxdesc->rts_ratefb_lmt = 0xF; -+ -+ if (padapter->mlmeextpriv.mlmext_info.preamble_mode == PREAMBLE_SHORT) -+ ptxdesc->rts_short = 1; -+ -+ /* Set RTS BW */ -+ if (pattrib->ht_en) -+ ptxdesc->rts_sc = SCMapping_8723B(padapter, pattrib); -+ } -+} -+ -+static void fill_txdesc_phy_8723b(struct adapter *padapter, struct pkt_attrib *pattrib, PTXDESC_8723B ptxdesc) -+{ -+ /* DBG_8192C("bwmode =%d, ch_off =%d\n", pattrib->bwmode, pattrib->ch_offset); */ -+ -+ if (pattrib->ht_en) { -+ ptxdesc->data_bw = BWMapping_8723B(padapter, pattrib); -+ -+ ptxdesc->data_sc = SCMapping_8723B(padapter, pattrib); -+ } -+} -+ -+static void rtl8723b_fill_default_txdesc( -+ struct xmit_frame *pxmitframe, u8 *pbuf -+) -+{ -+ struct adapter *padapter; -+ struct hal_com_data *pHalData; -+ struct dm_priv *pdmpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ struct pkt_attrib *pattrib; -+ PTXDESC_8723B ptxdesc; -+ s32 bmcst; -+ -+ memset(pbuf, 0, TXDESC_SIZE); -+ -+ padapter = pxmitframe->padapter; -+ pHalData = GET_HAL_DATA(padapter); -+ pdmpriv = &pHalData->dmpriv; -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ pattrib = &pxmitframe->attrib; -+ bmcst = IS_MCAST(pattrib->ra); -+ -+ ptxdesc = (PTXDESC_8723B)pbuf; -+ -+ if (pxmitframe->frame_tag == DATA_FRAMETAG) { -+ u8 drv_userate = 0; -+ -+ ptxdesc->macid = pattrib->mac_id; /* CAM_ID(MAC_ID) */ -+ ptxdesc->rate_id = pattrib->raid; -+ ptxdesc->qsel = pattrib->qsel; -+ ptxdesc->seq = pattrib->seqnum; -+ -+ ptxdesc->sectype = fill_txdesc_sectype(pattrib); -+ fill_txdesc_vcs_8723b(padapter, pattrib, ptxdesc); -+ -+ if (pattrib->icmp_pkt == 1 && padapter->registrypriv.wifi_spec == 1) -+ drv_userate = 1; -+ -+ if ( -+ (pattrib->ether_type != 0x888e) && -+ (pattrib->ether_type != 0x0806) && -+ (pattrib->ether_type != 0x88B4) && -+ (pattrib->dhcp_pkt != 1) && -+ (drv_userate != 1) -+#ifdef CONFIG_AUTO_AP_MODE -+ && (pattrib->pctrl != true) -+#endif -+ ) { -+ /* Non EAP & ARP & DHCP type data packet */ -+ -+ if (pattrib->ampdu_en == true) { -+ ptxdesc->agg_en = 1; /* AGG EN */ -+ ptxdesc->max_agg_num = 0x1f; -+ ptxdesc->ampdu_density = pattrib->ampdu_spacing; -+ } else -+ ptxdesc->bk = 1; /* AGG BK */ -+ -+ fill_txdesc_phy_8723b(padapter, pattrib, ptxdesc); -+ -+ ptxdesc->data_ratefb_lmt = 0x1F; -+ -+ if (pHalData->fw_ractrl == false) { -+ ptxdesc->userate = 1; -+ -+ if (pHalData->dmpriv.INIDATA_RATE[pattrib->mac_id] & BIT(7)) -+ ptxdesc->data_short = 1; -+ -+ ptxdesc->datarate = pHalData->dmpriv.INIDATA_RATE[pattrib->mac_id] & 0x7F; -+ } -+ -+ if (padapter->fix_rate != 0xFF) { /* modify data rate by iwpriv */ -+ ptxdesc->userate = 1; -+ if (padapter->fix_rate & BIT(7)) -+ ptxdesc->data_short = 1; -+ -+ ptxdesc->datarate = (padapter->fix_rate & 0x7F); -+ ptxdesc->disdatafb = 1; -+ } -+ -+ if (pattrib->ldpc) -+ ptxdesc->data_ldpc = 1; -+ if (pattrib->stbc) -+ ptxdesc->data_stbc = 1; -+ -+#ifdef CONFIG_CMCC_TEST -+ ptxdesc->data_short = 1; /* use cck short premble */ -+#endif -+ } else { -+ /* EAP data packet and ARP packet. */ -+ /* Use the 1M data rate to send the EAP/ARP packet. */ -+ /* This will maybe make the handshake smooth. */ -+ -+ ptxdesc->bk = 1; /* AGG BK */ -+ ptxdesc->userate = 1; /* driver uses rate */ -+ if (pmlmeinfo->preamble_mode == PREAMBLE_SHORT) -+ ptxdesc->data_short = 1;/* DATA_SHORT */ -+ ptxdesc->datarate = MRateToHwRate(pmlmeext->tx_rate); -+ DBG_871X("YJ: %s(): ARP Data: userate =%d, datarate = 0x%x\n", __func__, ptxdesc->userate, ptxdesc->datarate); -+ } -+ -+ ptxdesc->usb_txagg_num = pxmitframe->agg_num; -+ } else if (pxmitframe->frame_tag == MGNT_FRAMETAG) { -+/* RT_TRACE(_module_hal_xmit_c_, _drv_notice_, ("%s: MGNT_FRAMETAG\n", __func__)); */ -+ -+ ptxdesc->macid = pattrib->mac_id; /* CAM_ID(MAC_ID) */ -+ ptxdesc->qsel = pattrib->qsel; -+ ptxdesc->rate_id = pattrib->raid; /* Rate ID */ -+ ptxdesc->seq = pattrib->seqnum; -+ ptxdesc->userate = 1; /* driver uses rate, 1M */ -+ -+ ptxdesc->mbssid = pattrib->mbssid & 0xF; -+ -+ ptxdesc->rty_lmt_en = 1; /* retry limit enable */ -+ if (pattrib->retry_ctrl == true) { -+ ptxdesc->data_rt_lmt = 6; -+ } else { -+ ptxdesc->data_rt_lmt = 12; -+ } -+ -+ ptxdesc->datarate = MRateToHwRate(pmlmeext->tx_rate); -+ -+ /* CCX-TXRPT ack for xmit mgmt frames. */ -+ if (pxmitframe->ack_report) { -+ #ifdef DBG_CCX -+ DBG_8192C("%s set spe_rpt\n", __func__); -+ #endif -+ ptxdesc->spe_rpt = 1; -+ ptxdesc->sw_define = (u8)(GET_PRIMARY_ADAPTER(padapter)->xmitpriv.seq_no); -+ } -+ } else if (pxmitframe->frame_tag == TXAGG_FRAMETAG) { -+ RT_TRACE(_module_hal_xmit_c_, _drv_warning_, ("%s: TXAGG_FRAMETAG\n", __func__)); -+ } else { -+ RT_TRACE(_module_hal_xmit_c_, _drv_warning_, ("%s: frame_tag = 0x%x\n", __func__, pxmitframe->frame_tag)); -+ -+ ptxdesc->macid = pattrib->mac_id; /* CAM_ID(MAC_ID) */ -+ ptxdesc->rate_id = pattrib->raid; /* Rate ID */ -+ ptxdesc->qsel = pattrib->qsel; -+ ptxdesc->seq = pattrib->seqnum; -+ ptxdesc->userate = 1; /* driver uses rate */ -+ ptxdesc->datarate = MRateToHwRate(pmlmeext->tx_rate); -+ } -+ -+ ptxdesc->pktlen = pattrib->last_txcmdsz; -+ ptxdesc->offset = TXDESC_SIZE + OFFSET_SZ; -+ -+ if (bmcst) -+ ptxdesc->bmc = 1; -+ -+ /* 2009.11.05. tynli_test. Suggested by SD4 Filen for FW LPS. */ -+ /* (1) The sequence number of each non-Qos frame / broadcast / multicast / */ -+ /* mgnt frame should be controled by Hw because Fw will also send null data */ -+ /* which we cannot control when Fw LPS enable. */ -+ /* --> default enable non-Qos data sequense number. 2010.06.23. by tynli. */ -+ /* (2) Enable HW SEQ control for beacon packet, because we use Hw beacon. */ -+ /* (3) Use HW Qos SEQ to control the seq num of Ext port non-Qos packets. */ -+ /* 2010.06.23. Added by tynli. */ -+ if (!pattrib->qos_en) /* Hw set sequence number */ -+ ptxdesc->en_hwseq = 1; /* HWSEQ_EN */ -+} -+ -+/* -+ *Description: -+ * -+ *Parameters: -+ * pxmitframe xmitframe -+ * pbuf where to fill tx desc -+ */ -+void rtl8723b_update_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf) -+{ -+ struct tx_desc *pdesc; -+ -+ rtl8723b_fill_default_txdesc(pxmitframe, pbuf); -+ -+ pdesc = (struct tx_desc *)pbuf; -+ pdesc->txdw0 = pdesc->txdw0; -+ pdesc->txdw1 = pdesc->txdw1; -+ pdesc->txdw2 = pdesc->txdw2; -+ pdesc->txdw3 = pdesc->txdw3; -+ pdesc->txdw4 = pdesc->txdw4; -+ pdesc->txdw5 = pdesc->txdw5; -+ pdesc->txdw6 = pdesc->txdw6; -+ pdesc->txdw7 = pdesc->txdw7; -+ pdesc->txdw8 = pdesc->txdw8; -+ pdesc->txdw9 = pdesc->txdw9; -+ -+ rtl8723b_cal_txdesc_chksum(pdesc); -+} -+ -+/* */ -+/* Description: In normal chip, we should send some packet to Hw which will be used by Fw */ -+/* in FW LPS mode. The function is to fill the Tx descriptor of this packets, then */ -+/* Fw can tell Hw to send these packet derectly. */ -+/* Added by tynli. 2009.10.15. */ -+/* */ -+/* type1:pspoll, type2:null */ -+void rtl8723b_fill_fake_txdesc( -+ struct adapter *padapter, -+ u8 *pDesc, -+ u32 BufferLen, -+ u8 IsPsPoll, -+ u8 IsBTQosNull, -+ u8 bDataFrame -+) -+{ -+ /* Clear all status */ -+ memset(pDesc, 0, TXDESC_SIZE); -+ -+ SET_TX_DESC_FIRST_SEG_8723B(pDesc, 1); /* bFirstSeg; */ -+ SET_TX_DESC_LAST_SEG_8723B(pDesc, 1); /* bLastSeg; */ -+ -+ SET_TX_DESC_OFFSET_8723B(pDesc, 0x28); /* Offset = 32 */ -+ -+ SET_TX_DESC_PKT_SIZE_8723B(pDesc, BufferLen); /* Buffer size + command header */ -+ SET_TX_DESC_QUEUE_SEL_8723B(pDesc, QSLT_MGNT); /* Fixed queue of Mgnt queue */ -+ -+ /* Set NAVUSEHDR to prevent Ps-poll AId filed to be changed to error vlaue by Hw. */ -+ if (true == IsPsPoll) { -+ SET_TX_DESC_NAV_USE_HDR_8723B(pDesc, 1); -+ } else { -+ SET_TX_DESC_HWSEQ_EN_8723B(pDesc, 1); /* Hw set sequence number */ -+ SET_TX_DESC_HWSEQ_SEL_8723B(pDesc, 0); -+ } -+ -+ if (true == IsBTQosNull) { -+ SET_TX_DESC_BT_INT_8723B(pDesc, 1); -+ } -+ -+ SET_TX_DESC_USE_RATE_8723B(pDesc, 1); /* use data rate which is set by Sw */ -+ SET_TX_DESC_OWN_8723B((u8 *)pDesc, 1); -+ -+ SET_TX_DESC_TX_RATE_8723B(pDesc, DESC8723B_RATE1M); -+ -+ /* */ -+ /* Encrypt the data frame if under security mode excepct null data. Suggested by CCW. */ -+ /* */ -+ if (true == bDataFrame) { -+ u32 EncAlg; -+ -+ EncAlg = padapter->securitypriv.dot11PrivacyAlgrthm; -+ switch (EncAlg) { -+ case _NO_PRIVACY_: -+ SET_TX_DESC_SEC_TYPE_8723B(pDesc, 0x0); -+ break; -+ case _WEP40_: -+ case _WEP104_: -+ case _TKIP_: -+ SET_TX_DESC_SEC_TYPE_8723B(pDesc, 0x1); -+ break; -+ case _SMS4_: -+ SET_TX_DESC_SEC_TYPE_8723B(pDesc, 0x2); -+ break; -+ case _AES_: -+ SET_TX_DESC_SEC_TYPE_8723B(pDesc, 0x3); -+ break; -+ default: -+ SET_TX_DESC_SEC_TYPE_8723B(pDesc, 0x0); -+ break; -+ } -+ } -+ -+ /* USB interface drop packet if the checksum of descriptor isn't correct. */ -+ /* Using this checksum can let hardware recovery from packet bulk out error (e.g. Cancel URC, Bulk out error.). */ -+ rtl8723b_cal_txdesc_chksum((struct tx_desc *)pDesc); -+} -+ -+static void hw_var_set_opmode(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ u8 val8; -+ u8 mode = *((u8 *)val); -+ -+ { -+ /* disable Port0 TSF update */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 |= DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ /* set net_type */ -+ Set_MSR(padapter, mode); -+ DBG_871X("#### %s() -%d iface_type(0) mode = %d ####\n", __func__, __LINE__, mode); -+ -+ if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) { -+ { -+ StopTxBeacon(padapter); -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ rtw_write8(padapter, REG_DRVERLYINT, 0x05); /* restore early int time to 5ms */ -+ UpdateInterruptMask8812AU(padapter, true, 0, IMR_BCNDMAINT0_8723B); -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ -+ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8812AU(padapter, true, 0, (IMR_TXBCN0ERR_8723B|IMR_TXBCN0OK_8723B)); -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR */ -+ -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN */ -+ } -+ -+ /* disable atim wnd */ -+ rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT|EN_BCN_FUNCTION|DIS_ATIM); -+ /* rtw_write8(padapter, REG_BCN_CTRL, 0x18); */ -+ } else if ((mode == _HW_STATE_ADHOC_) /*|| (mode == _HW_STATE_AP_)*/) { -+ ResumeTxBeacon(padapter); -+ rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT|EN_BCN_FUNCTION|DIS_BCNQ_SUB); -+ } else if (mode == _HW_STATE_AP_) { -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ UpdateInterruptMask8723BU(padapter, true, IMR_BCNDMAINT0_8723B, 0); -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ -+ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8723BU(padapter, true, (IMR_TXBCN0ERR_8723B|IMR_TXBCN0OK_8723B), 0); -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR */ -+ -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN */ -+ -+ ResumeTxBeacon(padapter); -+ -+ rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT|DIS_BCNQ_SUB); -+ -+ /* Set RCR */ -+ rtw_write32(padapter, REG_RCR, 0x7000208e);/* CBSSID_DATA must set to 0, reject ICV_ERR packet */ -+ /* enable to rx data frame */ -+ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); -+ /* enable to rx ps-poll */ -+ rtw_write16(padapter, REG_RXFLTMAP1, 0x0400); -+ -+ /* Beacon Control related register for first time */ -+ rtw_write8(padapter, REG_BCNDMATIM, 0x02); /* 2ms */ -+ -+ /* rtw_write8(padapter, REG_BCN_MAX_ERR, 0xFF); */ -+ rtw_write8(padapter, REG_ATIMWND, 0x0a); /* 10ms */ -+ rtw_write16(padapter, REG_BCNTCFG, 0x00); -+ rtw_write16(padapter, REG_TBTT_PROHIBIT, 0xff04); -+ rtw_write16(padapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ -+ -+ /* reset TSF */ -+ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(0)); -+ -+ /* enable BCN0 Function for if1 */ -+ /* don't enable update TSF0 for if1 (due to TSF update when beacon/probe rsp are received) */ -+ rtw_write8(padapter, REG_BCN_CTRL, (DIS_TSF_UDT|EN_BCN_FUNCTION|EN_TXBCN_RPT|DIS_BCNQ_SUB)); -+ -+ /* SW_BCN_SEL - Port0 */ -+ /* rtw_write8(Adapter, REG_DWBCN1_CTRL_8192E+2, rtw_read8(Adapter, REG_DWBCN1_CTRL_8192E+2) & ~BIT4); */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ -+ /* select BCN on port 0 */ -+ rtw_write8( -+ padapter, -+ REG_CCK_CHECK_8723B, -+ (rtw_read8(padapter, REG_CCK_CHECK_8723B)&~BIT_BCN_PORT_SEL) -+ ); -+ -+ /* dis BCN1 ATIM WND if if2 is station */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL_1); -+ val8 |= DIS_ATIM; -+ rtw_write8(padapter, REG_BCN_CTRL_1, val8); -+ } -+ } -+} -+ -+static void hw_var_set_macaddr(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ u8 idx = 0; -+ u32 reg_macid; -+ -+ reg_macid = REG_MACID; -+ -+ for (idx = 0 ; idx < 6; idx++) -+ rtw_write8(GET_PRIMARY_ADAPTER(padapter), (reg_macid+idx), val[idx]); -+} -+ -+static void hw_var_set_bssid(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ u8 idx = 0; -+ u32 reg_bssid; -+ -+ reg_bssid = REG_BSSID; -+ -+ for (idx = 0 ; idx < 6; idx++) -+ rtw_write8(padapter, (reg_bssid+idx), val[idx]); -+} -+ -+static void hw_var_set_bcn_func(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ u32 bcn_ctrl_reg; -+ -+ bcn_ctrl_reg = REG_BCN_CTRL; -+ -+ if (*(u8 *)val) -+ rtw_write8(padapter, bcn_ctrl_reg, (EN_BCN_FUNCTION | EN_TXBCN_RPT)); -+ else { -+ u8 val8; -+ val8 = rtw_read8(padapter, bcn_ctrl_reg); -+ val8 &= ~(EN_BCN_FUNCTION | EN_TXBCN_RPT); -+ -+ /* Always enable port0 beacon function for PSTDMA */ -+ if (REG_BCN_CTRL == bcn_ctrl_reg) -+ val8 |= EN_BCN_FUNCTION; -+ -+ rtw_write8(padapter, bcn_ctrl_reg, val8); -+ } -+} -+ -+static void hw_var_set_correct_tsf(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ u8 val8; -+ u64 tsf; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ tsf = pmlmeext->TSFValue-rtw_modular64(pmlmeext->TSFValue, (pmlmeinfo->bcn_interval*1024))-1024; /* us */ -+ -+ if ( -+ ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || -+ ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ ) -+ StopTxBeacon(padapter); -+ -+ { -+ /* disable related TSF function */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 &= ~EN_BCN_FUNCTION; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ rtw_write32(padapter, REG_TSFTR, tsf); -+ rtw_write32(padapter, REG_TSFTR+4, tsf>>32); -+ -+ /* enable related TSF function */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 |= EN_BCN_FUNCTION; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ } -+ -+ if ( -+ ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || -+ ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ ) -+ ResumeTxBeacon(padapter); -+} -+ -+static void hw_var_set_mlme_disconnect(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ u8 val8; -+ -+ /* Set RCR to not to receive data frame when NO LINK state */ -+ /* rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR) & ~RCR_ADF); */ -+ /* reject all data frames */ -+ rtw_write16(padapter, REG_RXFLTMAP2, 0); -+ -+ /* reset TSF */ -+ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(0)); -+ -+ /* disable update TSF */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 |= DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+} -+ -+static void hw_var_set_mlme_sitesurvey(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ u32 value_rcr, rcr_clear_bit, reg_bcn_ctl; -+ u16 value_rxfltmap2; -+ u8 val8; -+ struct hal_com_data *pHalData; -+ struct mlme_priv *pmlmepriv; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pmlmepriv = &padapter->mlmepriv; -+ -+ reg_bcn_ctl = REG_BCN_CTRL; -+ -+ rcr_clear_bit = RCR_CBSSID_BCN; -+ -+ /* config RCR to receive different BSSID & not to receive data frame */ -+ value_rxfltmap2 = 0; -+ -+ if ((check_fwstate(pmlmepriv, WIFI_AP_STATE) == true)) -+ rcr_clear_bit = RCR_CBSSID_BCN; -+ -+ value_rcr = rtw_read32(padapter, REG_RCR); -+ -+ if (*((u8 *)val)) { -+ /* under sitesurvey */ -+ value_rcr &= ~(rcr_clear_bit); -+ rtw_write32(padapter, REG_RCR, value_rcr); -+ -+ rtw_write16(padapter, REG_RXFLTMAP2, value_rxfltmap2); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { -+ /* disable update TSF */ -+ val8 = rtw_read8(padapter, reg_bcn_ctl); -+ val8 |= DIS_TSF_UDT; -+ rtw_write8(padapter, reg_bcn_ctl, val8); -+ } -+ -+ /* Save orignal RRSR setting. */ -+ pHalData->RegRRSR = rtw_read16(padapter, REG_RRSR); -+ } else { -+ /* sitesurvey done */ -+ if (check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE))) -+ /* enable to rx data frame */ -+ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { -+ /* enable update TSF */ -+ val8 = rtw_read8(padapter, reg_bcn_ctl); -+ val8 &= ~DIS_TSF_UDT; -+ rtw_write8(padapter, reg_bcn_ctl, val8); -+ } -+ -+ value_rcr |= rcr_clear_bit; -+ rtw_write32(padapter, REG_RCR, value_rcr); -+ -+ /* Restore orignal RRSR setting. */ -+ rtw_write16(padapter, REG_RRSR, pHalData->RegRRSR); -+ } -+} -+ -+static void hw_var_set_mlme_join(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ u8 val8; -+ u16 val16; -+ u32 val32; -+ u8 RetryLimit; -+ u8 type; -+ struct hal_com_data *pHalData; -+ struct mlme_priv *pmlmepriv; -+ struct eeprom_priv *pEEPROM; -+ -+ -+ RetryLimit = 0x30; -+ type = *(u8 *)val; -+ pHalData = GET_HAL_DATA(padapter); -+ pmlmepriv = &padapter->mlmepriv; -+ pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ -+ if (type == 0) { /* prepare to join */ -+ /* enable to rx data frame.Accept all data frame */ -+ /* rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_ADF); */ -+ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); -+ -+ val32 = rtw_read32(padapter, REG_RCR); -+ if (padapter->in_cta_test) -+ val32 &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN);/* RCR_ADF */ -+ else -+ val32 |= RCR_CBSSID_DATA|RCR_CBSSID_BCN; -+ rtw_write32(padapter, REG_RCR, val32); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) -+ RetryLimit = (pEEPROM->CustomerID == RT_CID_CCX) ? 7 : 48; -+ else /* Ad-hoc Mode */ -+ RetryLimit = 0x7; -+ } else if (type == 1) /* joinbss_event call back when join res < 0 */ -+ rtw_write16(padapter, REG_RXFLTMAP2, 0x00); -+ else if (type == 2) { /* sta add event call back */ -+ /* enable update TSF */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 &= ~DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE)) -+ RetryLimit = 0x7; -+ } -+ -+ val16 = (RetryLimit << RETRY_LIMIT_SHORT_SHIFT) | (RetryLimit << RETRY_LIMIT_LONG_SHIFT); -+ rtw_write16(padapter, REG_RL, val16); -+} -+ -+void CCX_FwC2HTxRpt_8723b(struct adapter *padapter, u8 *pdata, u8 len) -+{ -+ u8 seq_no; -+ -+#define GET_8723B_C2H_TX_RPT_LIFE_TIME_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 6, 1) -+#define GET_8723B_C2H_TX_RPT_RETRY_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 7, 1) -+ -+ /* DBG_871X("%s, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n", __func__, */ -+ /* *pdata, *(pdata+1), *(pdata+2), *(pdata+3), *(pdata+4), *(pdata+5), *(pdata+6), *(pdata+7)); */ -+ -+ seq_no = *(pdata+6); -+ -+ if (GET_8723B_C2H_TX_RPT_RETRY_OVER(pdata) | GET_8723B_C2H_TX_RPT_LIFE_TIME_OVER(pdata)) { -+ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_CCX_PKT_FAIL); -+ } -+/* -+ else if (seq_no != padapter->xmitpriv.seq_no) { -+ DBG_871X("tx_seq_no =%d, rpt_seq_no =%d\n", padapter->xmitpriv.seq_no, seq_no); -+ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_CCX_PKT_FAIL); -+ } -+*/ -+ else -+ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_SUCCESS); -+} -+ -+s32 c2h_id_filter_ccx_8723b(u8 *buf) -+{ -+ struct c2h_evt_hdr_88xx *c2h_evt = (struct c2h_evt_hdr_88xx *)buf; -+ s32 ret = false; -+ if (c2h_evt->id == C2H_CCX_TX_RPT) -+ ret = true; -+ -+ return ret; -+} -+ -+ -+s32 c2h_handler_8723b(struct adapter *padapter, u8 *buf) -+{ -+ struct c2h_evt_hdr_88xx *pC2hEvent = (struct c2h_evt_hdr_88xx *)buf; -+ s32 ret = _SUCCESS; -+ u8 index = 0; -+ -+ if (pC2hEvent == NULL) { -+ DBG_8192C("%s(): pC2hEventis NULL\n", __func__); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ switch (pC2hEvent->id) { -+ case C2H_AP_RPT_RSP: -+ break; -+ case C2H_DBG: -+ { -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("c2h_handler_8723b: %s\n", pC2hEvent->payload)); -+ } -+ break; -+ -+ case C2H_CCX_TX_RPT: -+/* CCX_FwC2HTxRpt(padapter, QueueID, pC2hEvent->payload); */ -+ break; -+ -+ case C2H_EXT_RA_RPT: -+/* C2HExtRaRptHandler(padapter, pC2hEvent->payload, C2hEvent.CmdLen); */ -+ break; -+ -+ case C2H_HW_INFO_EXCH: -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("[BT], C2H_HW_INFO_EXCH\n")); -+ for (index = 0; index < pC2hEvent->plen; index++) { -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("[BT], tmpBuf[%d]= 0x%x\n", index, pC2hEvent->payload[index])); -+ } -+ break; -+ -+ case C2H_8723B_BT_INFO: -+ rtw_btcoex_BtInfoNotify(padapter, pC2hEvent->plen, pC2hEvent->payload); -+ break; -+ -+ default: -+ break; -+ } -+ -+ /* Clear event to notify FW we have read the command. */ -+ /* Note: */ -+ /* If this field isn't clear, the FW won't update the next command message. */ -+/* rtw_write8(padapter, REG_C2HEVT_CLEAR, C2H_EVT_HOST_CLOSE); */ -+exit: -+ return ret; -+} -+ -+static void process_c2h_event(struct adapter *padapter, PC2H_EVT_HDR pC2hEvent, u8 *c2hBuf) -+{ -+ u8 index = 0; -+ -+ if (c2hBuf == NULL) { -+ DBG_8192C("%s c2hbuff is NULL\n", __func__); -+ return; -+ } -+ -+ switch (pC2hEvent->CmdID) { -+ case C2H_AP_RPT_RSP: -+ break; -+ case C2H_DBG: -+ { -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("C2HCommandHandler: %s\n", c2hBuf)); -+ } -+ break; -+ -+ case C2H_CCX_TX_RPT: -+/* CCX_FwC2HTxRpt(padapter, QueueID, tmpBuf); */ -+ break; -+ -+ case C2H_EXT_RA_RPT: -+/* C2HExtRaRptHandler(padapter, tmpBuf, C2hEvent.CmdLen); */ -+ break; -+ -+ case C2H_HW_INFO_EXCH: -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("[BT], C2H_HW_INFO_EXCH\n")); -+ for (index = 0; index < pC2hEvent->CmdLen; index++) { -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("[BT], tmpBuf[%d]= 0x%x\n", index, c2hBuf[index])); -+ } -+ break; -+ -+ case C2H_8723B_BT_INFO: -+ rtw_btcoex_BtInfoNotify(padapter, pC2hEvent->CmdLen, c2hBuf); -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+void C2HPacketHandler_8723B(struct adapter *padapter, u8 *pbuffer, u16 length) -+{ -+ C2H_EVT_HDR C2hEvent; -+ u8 *tmpBuf = NULL; -+#ifdef CONFIG_WOWLAN -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ -+ if (pwrpriv->wowlan_mode == true) { -+ DBG_871X("%s(): return because wowolan_mode ==true! CMDID =%d\n", __func__, pbuffer[0]); -+ return; -+ } -+#endif -+ C2hEvent.CmdID = pbuffer[0]; -+ C2hEvent.CmdSeq = pbuffer[1]; -+ C2hEvent.CmdLen = length-2; -+ tmpBuf = pbuffer+2; -+ -+ /* DBG_871X("%s C2hEvent.CmdID:%x C2hEvent.CmdLen:%x C2hEvent.CmdSeq:%x\n", */ -+ /* __func__, C2hEvent.CmdID, C2hEvent.CmdLen, C2hEvent.CmdSeq); */ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_notice_, "C2HPacketHandler_8723B(): Command Content:\n", tmpBuf, C2hEvent.CmdLen); -+ -+ process_c2h_event(padapter, &C2hEvent, tmpBuf); -+ /* c2h_handler_8723b(padapter,&C2hEvent); */ -+ return; -+} -+ -+void SetHwReg8723B(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u8 val8; -+ u32 val32; -+ -+ switch (variable) { -+ case HW_VAR_MEDIA_STATUS: -+ val8 = rtw_read8(padapter, MSR) & 0x0c; -+ val8 |= *val; -+ rtw_write8(padapter, MSR, val8); -+ break; -+ -+ case HW_VAR_MEDIA_STATUS1: -+ val8 = rtw_read8(padapter, MSR) & 0x03; -+ val8 |= *val << 2; -+ rtw_write8(padapter, MSR, val8); -+ break; -+ -+ case HW_VAR_SET_OPMODE: -+ hw_var_set_opmode(padapter, variable, val); -+ break; -+ -+ case HW_VAR_MAC_ADDR: -+ hw_var_set_macaddr(padapter, variable, val); -+ break; -+ -+ case HW_VAR_BSSID: -+ hw_var_set_bssid(padapter, variable, val); -+ break; -+ -+ case HW_VAR_BASIC_RATE: -+ { -+ struct mlme_ext_info *mlmext_info = &padapter->mlmeextpriv.mlmext_info; -+ u16 input_b = 0, masked = 0, ioted = 0, BrateCfg = 0; -+ u16 rrsr_2g_force_mask = (RRSR_11M|RRSR_5_5M|RRSR_1M); -+ u16 rrsr_2g_allow_mask = (RRSR_24M|RRSR_12M|RRSR_6M|RRSR_CCK_RATES); -+ -+ HalSetBrateCfg(padapter, val, &BrateCfg); -+ input_b = BrateCfg; -+ -+ /* apply force and allow mask */ -+ BrateCfg |= rrsr_2g_force_mask; -+ BrateCfg &= rrsr_2g_allow_mask; -+ masked = BrateCfg; -+ -+ #ifdef CONFIG_CMCC_TEST -+ BrateCfg |= (RRSR_11M|RRSR_5_5M|RRSR_1M); /* use 11M to send ACK */ -+ BrateCfg |= (RRSR_24M|RRSR_18M|RRSR_12M); /* CMCC_OFDM_ACK 12/18/24M */ -+ #endif -+ -+ /* IOT consideration */ -+ if (mlmext_info->assoc_AP_vendor == HT_IOT_PEER_CISCO) { -+ /* if peer is cisco and didn't use ofdm rate, we enable 6M ack */ -+ if ((BrateCfg & (RRSR_24M|RRSR_12M|RRSR_6M)) == 0) -+ BrateCfg |= RRSR_6M; -+ } -+ ioted = BrateCfg; -+ -+ pHalData->BasicRateSet = BrateCfg; -+ -+ DBG_8192C("HW_VAR_BASIC_RATE: %#x -> %#x -> %#x\n", input_b, masked, ioted); -+ -+ /* Set RRSR rate table. */ -+ rtw_write16(padapter, REG_RRSR, BrateCfg); -+ rtw_write8(padapter, REG_RRSR+2, rtw_read8(padapter, REG_RRSR+2)&0xf0); -+ } -+ break; -+ -+ case HW_VAR_TXPAUSE: -+ rtw_write8(padapter, REG_TXPAUSE, *val); -+ break; -+ -+ case HW_VAR_BCN_FUNC: -+ hw_var_set_bcn_func(padapter, variable, val); -+ break; -+ -+ case HW_VAR_CORRECT_TSF: -+ hw_var_set_correct_tsf(padapter, variable, val); -+ break; -+ -+ case HW_VAR_CHECK_BSSID: -+ { -+ u32 val32; -+ val32 = rtw_read32(padapter, REG_RCR); -+ if (*val) -+ val32 |= RCR_CBSSID_DATA|RCR_CBSSID_BCN; -+ else -+ val32 &= ~(RCR_CBSSID_DATA|RCR_CBSSID_BCN); -+ rtw_write32(padapter, REG_RCR, val32); -+ } -+ break; -+ -+ case HW_VAR_MLME_DISCONNECT: -+ hw_var_set_mlme_disconnect(padapter, variable, val); -+ break; -+ -+ case HW_VAR_MLME_SITESURVEY: -+ hw_var_set_mlme_sitesurvey(padapter, variable, val); -+ -+ rtw_btcoex_ScanNotify(padapter, *val?true:false); -+ break; -+ -+ case HW_VAR_MLME_JOIN: -+ hw_var_set_mlme_join(padapter, variable, val); -+ -+ switch (*val) { -+ case 0: -+ /* prepare to join */ -+ rtw_btcoex_ConnectNotify(padapter, true); -+ break; -+ case 1: -+ /* joinbss_event callback when join res < 0 */ -+ rtw_btcoex_ConnectNotify(padapter, false); -+ break; -+ case 2: -+ /* sta add event callback */ -+/* rtw_btcoex_MediaStatusNotify(padapter, RT_MEDIA_CONNECT); */ -+ break; -+ } -+ break; -+ -+ case HW_VAR_ON_RCR_AM: -+ val32 = rtw_read32(padapter, REG_RCR); -+ val32 |= RCR_AM; -+ rtw_write32(padapter, REG_RCR, val32); -+ DBG_8192C("%s, %d, RCR = %x\n", __func__, __LINE__, rtw_read32(padapter, REG_RCR)); -+ break; -+ -+ case HW_VAR_OFF_RCR_AM: -+ val32 = rtw_read32(padapter, REG_RCR); -+ val32 &= ~RCR_AM; -+ rtw_write32(padapter, REG_RCR, val32); -+ DBG_8192C("%s, %d, RCR = %x\n", __func__, __LINE__, rtw_read32(padapter, REG_RCR)); -+ break; -+ -+ case HW_VAR_BEACON_INTERVAL: -+ rtw_write16(padapter, REG_BCN_INTERVAL, *((u16 *)val)); -+ break; -+ -+ case HW_VAR_SLOT_TIME: -+ rtw_write8(padapter, REG_SLOT, *val); -+ break; -+ -+ case HW_VAR_RESP_SIFS: -+ /* SIFS_Timer = 0x0a0a0808; */ -+ /* RESP_SIFS for CCK */ -+ rtw_write8(padapter, REG_RESP_SIFS_CCK, val[0]); /* SIFS_T2T_CCK (0x08) */ -+ rtw_write8(padapter, REG_RESP_SIFS_CCK+1, val[1]); /* SIFS_R2T_CCK(0x08) */ -+ /* RESP_SIFS for OFDM */ -+ rtw_write8(padapter, REG_RESP_SIFS_OFDM, val[2]); /* SIFS_T2T_OFDM (0x0a) */ -+ rtw_write8(padapter, REG_RESP_SIFS_OFDM+1, val[3]); /* SIFS_R2T_OFDM(0x0a) */ -+ break; -+ -+ case HW_VAR_ACK_PREAMBLE: -+ { -+ u8 regTmp; -+ u8 bShortPreamble = *val; -+ -+ /* Joseph marked out for Netgear 3500 TKIP channel 7 issue.(Temporarily) */ -+ /* regTmp = (pHalData->nCur40MhzPrimeSC)<<5; */ -+ regTmp = 0; -+ if (bShortPreamble) -+ regTmp |= 0x80; -+ rtw_write8(padapter, REG_RRSR+2, regTmp); -+ } -+ break; -+ -+ case HW_VAR_CAM_EMPTY_ENTRY: -+ { -+ u8 ucIndex = *val; -+ u8 i; -+ u32 ulCommand = 0; -+ u32 ulContent = 0; -+ u32 ulEncAlgo = CAM_AES; -+ -+ for (i = 0; i < CAM_CONTENT_COUNT; i++) { -+ /* filled id in CAM config 2 byte */ -+ if (i == 0) { -+ ulContent |= (ucIndex & 0x03) | ((u16)(ulEncAlgo)<<2); -+ /* ulContent |= CAM_VALID; */ -+ } else -+ ulContent = 0; -+ -+ /* polling bit, and No Write enable, and address */ -+ ulCommand = CAM_CONTENT_COUNT*ucIndex+i; -+ ulCommand = ulCommand | CAM_POLLINIG | CAM_WRITE; -+ /* write content 0 is equall to mark invalid */ -+ rtw_write32(padapter, WCAMI, ulContent); /* mdelay(40); */ -+ /* RT_TRACE(COMP_SEC, DBG_LOUD, ("CAM_empty_entry(): WRITE A4: %lx\n", ulContent)); */ -+ rtw_write32(padapter, RWCAM, ulCommand); /* mdelay(40); */ -+ /* RT_TRACE(COMP_SEC, DBG_LOUD, ("CAM_empty_entry(): WRITE A0: %lx\n", ulCommand)); */ -+ } -+ } -+ break; -+ -+ case HW_VAR_CAM_INVALID_ALL: -+ rtw_write32(padapter, RWCAM, BIT(31)|BIT(30)); -+ break; -+ -+ case HW_VAR_CAM_WRITE: -+ { -+ u32 cmd; -+ u32 *cam_val = (u32 *)val; -+ -+ rtw_write32(padapter, WCAMI, cam_val[0]); -+ -+ cmd = CAM_POLLINIG | CAM_WRITE | cam_val[1]; -+ rtw_write32(padapter, RWCAM, cmd); -+ } -+ break; -+ -+ case HW_VAR_AC_PARAM_VO: -+ rtw_write32(padapter, REG_EDCA_VO_PARAM, *((u32 *)val)); -+ break; -+ -+ case HW_VAR_AC_PARAM_VI: -+ rtw_write32(padapter, REG_EDCA_VI_PARAM, *((u32 *)val)); -+ break; -+ -+ case HW_VAR_AC_PARAM_BE: -+ pHalData->AcParam_BE = ((u32 *)(val))[0]; -+ rtw_write32(padapter, REG_EDCA_BE_PARAM, *((u32 *)val)); -+ break; -+ -+ case HW_VAR_AC_PARAM_BK: -+ rtw_write32(padapter, REG_EDCA_BK_PARAM, *((u32 *)val)); -+ break; -+ -+ case HW_VAR_ACM_CTRL: -+ { -+ u8 ctrl = *((u8 *)val); -+ u8 hwctrl = 0; -+ -+ if (ctrl != 0) { -+ hwctrl |= AcmHw_HwEn; -+ -+ if (ctrl & BIT(1)) /* BE */ -+ hwctrl |= AcmHw_BeqEn; -+ -+ if (ctrl & BIT(2)) /* VI */ -+ hwctrl |= AcmHw_ViqEn; -+ -+ if (ctrl & BIT(3)) /* VO */ -+ hwctrl |= AcmHw_VoqEn; -+ } -+ -+ DBG_8192C("[HW_VAR_ACM_CTRL] Write 0x%02X\n", hwctrl); -+ rtw_write8(padapter, REG_ACMHWCTRL, hwctrl); -+ } -+ break; -+ -+ case HW_VAR_AMPDU_FACTOR: -+ { -+ u32 AMPDULen = (*((u8 *)val)); -+ -+ if (AMPDULen < HT_AGG_SIZE_32K) -+ AMPDULen = (0x2000 << (*((u8 *)val)))-1; -+ else -+ AMPDULen = 0x7fff; -+ -+ rtw_write32(padapter, REG_AMPDU_MAX_LENGTH_8723B, AMPDULen); -+ } -+ break; -+ -+ case HW_VAR_H2C_FW_PWRMODE: -+ { -+ u8 psmode = *val; -+ -+ /* Forece leave RF low power mode for 1T1R to prevent conficting setting in Fw power */ -+ /* saving sequence. 2010.06.07. Added by tynli. Suggested by SD3 yschang. */ -+ if (psmode != PS_MODE_ACTIVE) { -+ ODM_RF_Saving(&pHalData->odmpriv, true); -+ } -+ -+ /* if (psmode != PS_MODE_ACTIVE) { */ -+ /* rtl8723b_set_lowpwr_lps_cmd(padapter, true); */ -+ /* else { */ -+ /* rtl8723b_set_lowpwr_lps_cmd(padapter, false); */ -+ /* */ -+ rtl8723b_set_FwPwrMode_cmd(padapter, psmode); -+ } -+ break; -+ case HW_VAR_H2C_PS_TUNE_PARAM: -+ rtl8723b_set_FwPsTuneParam_cmd(padapter); -+ break; -+ -+ case HW_VAR_H2C_FW_JOINBSSRPT: -+ rtl8723b_set_FwJoinBssRpt_cmd(padapter, *val); -+ break; -+ -+ case HW_VAR_INITIAL_GAIN: -+ { -+ DIG_T *pDigTable = &pHalData->odmpriv.DM_DigTable; -+ u32 rx_gain = *(u32 *)val; -+ -+ if (rx_gain == 0xff) {/* restore rx gain */ -+ ODM_Write_DIG(&pHalData->odmpriv, pDigTable->BackupIGValue); -+ } else { -+ pDigTable->BackupIGValue = pDigTable->CurIGValue; -+ ODM_Write_DIG(&pHalData->odmpriv, rx_gain); -+ } -+ } -+ break; -+ -+ case HW_VAR_EFUSE_USAGE: -+ pHalData->EfuseUsedPercentage = *val; -+ break; -+ -+ case HW_VAR_EFUSE_BYTES: -+ pHalData->EfuseUsedBytes = *((u16 *)val); -+ break; -+ -+ case HW_VAR_EFUSE_BT_USAGE: -+#ifdef HAL_EFUSE_MEMORY -+ pHalData->EfuseHal.BTEfuseUsedPercentage = *val; -+#endif -+ break; -+ -+ case HW_VAR_EFUSE_BT_BYTES: -+#ifdef HAL_EFUSE_MEMORY -+ pHalData->EfuseHal.BTEfuseUsedBytes = *((u16 *)val); -+#else -+ BTEfuseUsedBytes = *((u16 *)val); -+#endif -+ break; -+ -+ case HW_VAR_FIFO_CLEARN_UP: -+ { -+ #define RW_RELEASE_EN BIT(18) -+ #define RXDMA_IDLE BIT(17) -+ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8 trycnt = 100; -+ -+ /* pause tx */ -+ rtw_write8(padapter, REG_TXPAUSE, 0xff); -+ -+ /* keep sn */ -+ padapter->xmitpriv.nqos_ssn = rtw_read16(padapter, REG_NQOS_SEQ); -+ -+ if (pwrpriv->bkeepfwalive != true) { -+ /* RX DMA stop */ -+ val32 = rtw_read32(padapter, REG_RXPKT_NUM); -+ val32 |= RW_RELEASE_EN; -+ rtw_write32(padapter, REG_RXPKT_NUM, val32); -+ do { -+ val32 = rtw_read32(padapter, REG_RXPKT_NUM); -+ val32 &= RXDMA_IDLE; -+ if (val32) -+ break; -+ -+ DBG_871X("%s: [HW_VAR_FIFO_CLEARN_UP] val =%x times:%d\n", __func__, val32, trycnt); -+ } while (--trycnt); -+ -+ if (trycnt == 0) { -+ DBG_8192C("[HW_VAR_FIFO_CLEARN_UP] Stop RX DMA failed......\n"); -+ } -+ -+ /* RQPN Load 0 */ -+ rtw_write16(padapter, REG_RQPN_NPQ, 0); -+ rtw_write32(padapter, REG_RQPN, 0x80000000); -+ mdelay(2); -+ } -+ } -+ break; -+ -+ case HW_VAR_APFM_ON_MAC: -+ pHalData->bMacPwrCtrlOn = *val; -+ DBG_8192C("%s: bMacPwrCtrlOn =%d\n", __func__, pHalData->bMacPwrCtrlOn); -+ break; -+ -+ case HW_VAR_NAV_UPPER: -+ { -+ u32 usNavUpper = *((u32 *)val); -+ -+ if (usNavUpper > HAL_NAV_UPPER_UNIT_8723B * 0xFF) { -+ RT_TRACE(_module_hal_init_c_, _drv_notice_, ("The setting value (0x%08X us) of NAV_UPPER is larger than (%d * 0xFF)!!!\n", usNavUpper, HAL_NAV_UPPER_UNIT_8723B)); -+ break; -+ } -+ -+ /* The value of ((usNavUpper + HAL_NAV_UPPER_UNIT_8723B - 1) / HAL_NAV_UPPER_UNIT_8723B) */ -+ /* is getting the upper integer. */ -+ usNavUpper = (usNavUpper + HAL_NAV_UPPER_UNIT_8723B - 1) / HAL_NAV_UPPER_UNIT_8723B; -+ rtw_write8(padapter, REG_NAV_UPPER, (u8)usNavUpper); -+ } -+ break; -+ -+ case HW_VAR_H2C_MEDIA_STATUS_RPT: -+ { -+ u16 mstatus_rpt = (*(u16 *)val); -+ u8 mstatus, macId; -+ -+ mstatus = (u8) (mstatus_rpt & 0xFF); -+ macId = (u8)(mstatus_rpt >> 8); -+ rtl8723b_set_FwMediaStatusRpt_cmd(padapter, mstatus, macId); -+ } -+ break; -+ case HW_VAR_BCN_VALID: -+ { -+ /* BCN_VALID, BIT16 of REG_TDECTRL = BIT0 of REG_TDECTRL+2, write 1 to clear, Clear by sw */ -+ val8 = rtw_read8(padapter, REG_TDECTRL+2); -+ val8 |= BIT(0); -+ rtw_write8(padapter, REG_TDECTRL+2, val8); -+ } -+ break; -+ -+ case HW_VAR_DL_BCN_SEL: -+ { -+ /* SW_BCN_SEL - Port0 */ -+ val8 = rtw_read8(padapter, REG_DWBCN1_CTRL_8723B+2); -+ val8 &= ~BIT(4); -+ rtw_write8(padapter, REG_DWBCN1_CTRL_8723B+2, val8); -+ } -+ break; -+ -+ case HW_VAR_DO_IQK: -+ pHalData->bNeedIQK = true; -+ break; -+ -+ case HW_VAR_DL_RSVD_PAGE: -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == true) -+ rtl8723b_download_BTCoex_AP_mode_rsvd_page(padapter); -+ else -+ rtl8723b_download_rsvd_page(padapter, RT_MEDIA_CONNECT); -+ break; -+ -+ case HW_VAR_MACID_SLEEP: -+ /* Input is MACID */ -+ val32 = *(u32 *)val; -+ if (val32 > 31) { -+ DBG_8192C(FUNC_ADPT_FMT ": [HW_VAR_MACID_SLEEP] Invalid macid(%d)\n", -+ FUNC_ADPT_ARG(padapter), val32); -+ break; -+ } -+ val8 = (u8)val32; /* macid is between 0~31 */ -+ -+ val32 = rtw_read32(padapter, REG_MACID_SLEEP); -+ DBG_8192C(FUNC_ADPT_FMT ": [HW_VAR_MACID_SLEEP] macid =%d, org MACID_SLEEP = 0x%08X\n", -+ FUNC_ADPT_ARG(padapter), val8, val32); -+ if (val32 & BIT(val8)) -+ break; -+ val32 |= BIT(val8); -+ rtw_write32(padapter, REG_MACID_SLEEP, val32); -+ break; -+ -+ case HW_VAR_MACID_WAKEUP: -+ /* Input is MACID */ -+ val32 = *(u32 *)val; -+ if (val32 > 31) { -+ DBG_8192C(FUNC_ADPT_FMT ": [HW_VAR_MACID_WAKEUP] Invalid macid(%d)\n", -+ FUNC_ADPT_ARG(padapter), val32); -+ break; -+ } -+ val8 = (u8)val32; /* macid is between 0~31 */ -+ -+ val32 = rtw_read32(padapter, REG_MACID_SLEEP); -+ DBG_8192C(FUNC_ADPT_FMT ": [HW_VAR_MACID_WAKEUP] macid =%d, org MACID_SLEEP = 0x%08X\n", -+ FUNC_ADPT_ARG(padapter), val8, val32); -+ if (!(val32 & BIT(val8))) -+ break; -+ val32 &= ~BIT(val8); -+ rtw_write32(padapter, REG_MACID_SLEEP, val32); -+ break; -+ -+ default: -+ SetHwReg(padapter, variable, val); -+ break; -+ } -+} -+ -+void GetHwReg8723B(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u8 val8; -+ u16 val16; -+ -+ switch (variable) { -+ case HW_VAR_TXPAUSE: -+ *val = rtw_read8(padapter, REG_TXPAUSE); -+ break; -+ -+ case HW_VAR_BCN_VALID: -+ { -+ /* BCN_VALID, BIT16 of REG_TDECTRL = BIT0 of REG_TDECTRL+2 */ -+ val8 = rtw_read8(padapter, REG_TDECTRL+2); -+ *val = (BIT(0) & val8) ? true : false; -+ } -+ break; -+ -+ case HW_VAR_FWLPS_RF_ON: -+ { -+ /* When we halt NIC, we should check if FW LPS is leave. */ -+ u32 valRCR; -+ -+ if ( -+ (padapter->bSurpriseRemoved == true) || -+ (adapter_to_pwrctl(padapter)->rf_pwrstate == rf_off) -+ ) { -+ /* If it is in HW/SW Radio OFF or IPS state, we do not check Fw LPS Leave, */ -+ /* because Fw is unload. */ -+ *val = true; -+ } else { -+ valRCR = rtw_read32(padapter, REG_RCR); -+ valRCR &= 0x00070000; -+ if (valRCR) -+ *val = false; -+ else -+ *val = true; -+ } -+ } -+ break; -+ -+ case HW_VAR_EFUSE_USAGE: -+ *val = pHalData->EfuseUsedPercentage; -+ break; -+ -+ case HW_VAR_EFUSE_BYTES: -+ *((u16 *)val) = pHalData->EfuseUsedBytes; -+ break; -+ -+ case HW_VAR_EFUSE_BT_USAGE: -+#ifdef HAL_EFUSE_MEMORY -+ *val = pHalData->EfuseHal.BTEfuseUsedPercentage; -+#endif -+ break; -+ -+ case HW_VAR_EFUSE_BT_BYTES: -+#ifdef HAL_EFUSE_MEMORY -+ *((u16 *)val) = pHalData->EfuseHal.BTEfuseUsedBytes; -+#else -+ *((u16 *)val) = BTEfuseUsedBytes; -+#endif -+ break; -+ -+ case HW_VAR_APFM_ON_MAC: -+ *val = pHalData->bMacPwrCtrlOn; -+ break; -+ case HW_VAR_CHK_HI_QUEUE_EMPTY: -+ val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); -+ *val = (val16 & BIT(10)) ? true:false; -+ break; -+#ifdef CONFIG_WOWLAN -+ case HW_VAR_RPWM_TOG: -+ *val = rtw_read8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HRPWM1) & BIT7; -+ break; -+ case HW_VAR_WAKEUP_REASON: -+ *val = rtw_read8(padapter, REG_WOWLAN_WAKE_REASON); -+ if (*val == 0xEA) -+ *val = 0; -+ break; -+ case HW_VAR_SYS_CLKR: -+ *val = rtw_read8(padapter, REG_SYS_CLKR); -+ break; -+#endif -+ default: -+ GetHwReg(padapter, variable, val); -+ break; -+ } -+} -+ -+/* -+ *Description: -+ * Change default setting of specified variable. -+ */ -+u8 SetHalDefVar8723B(struct adapter *padapter, enum HAL_DEF_VARIABLE variable, void *pval) -+{ -+ struct hal_com_data *pHalData; -+ u8 bResult; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ bResult = _SUCCESS; -+ -+ switch (variable) { -+ default: -+ bResult = SetHalDefVar(padapter, variable, pval); -+ break; -+ } -+ -+ return bResult; -+} -+ -+/* -+ *Description: -+ * Query setting of specified variable. -+ */ -+u8 GetHalDefVar8723B(struct adapter *padapter, enum HAL_DEF_VARIABLE variable, void *pval) -+{ -+ struct hal_com_data *pHalData; -+ u8 bResult; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ bResult = _SUCCESS; -+ -+ switch (variable) { -+ case HAL_DEF_MAX_RECVBUF_SZ: -+ *((u32 *)pval) = MAX_RECVBUF_SZ; -+ break; -+ -+ case HAL_DEF_RX_PACKET_OFFSET: -+ *((u32 *)pval) = RXDESC_SIZE + DRVINFO_SZ*8; -+ break; -+ -+ case HW_VAR_MAX_RX_AMPDU_FACTOR: -+ /* Stanley@BB.SD3 suggests 16K can get stable performance */ -+ /* The experiment was done on SDIO interface */ -+ /* coding by Lucas@20130730 */ -+ *(u32 *)pval = MAX_AMPDU_FACTOR_16K; -+ break; -+ case HAL_DEF_TX_LDPC: -+ case HAL_DEF_RX_LDPC: -+ *((u8 *)pval) = false; -+ break; -+ case HAL_DEF_TX_STBC: -+ *((u8 *)pval) = 0; -+ break; -+ case HAL_DEF_RX_STBC: -+ *((u8 *)pval) = 1; -+ break; -+ case HAL_DEF_EXPLICIT_BEAMFORMER: -+ case HAL_DEF_EXPLICIT_BEAMFORMEE: -+ *((u8 *)pval) = false; -+ break; -+ -+ case HW_DEF_RA_INFO_DUMP: -+ { -+ u8 mac_id = *(u8 *)pval; -+ u32 cmd; -+ u32 ra_info1, ra_info2; -+ u32 rate_mask1, rate_mask2; -+ u8 curr_tx_rate, curr_tx_sgi, hight_rate, lowest_rate; -+ -+ DBG_8192C("============ RA status check Mac_id:%d ===================\n", mac_id); -+ -+ cmd = 0x40000100 | mac_id; -+ rtw_write32(padapter, REG_HMEBOX_DBG_2_8723B, cmd); -+ msleep(10); -+ ra_info1 = rtw_read32(padapter, 0x2F0); -+ curr_tx_rate = ra_info1&0x7F; -+ curr_tx_sgi = (ra_info1>>7)&0x01; -+ DBG_8192C("[ ra_info1:0x%08x ] =>cur_tx_rate = %s, cur_sgi:%d, PWRSTS = 0x%02x \n", -+ ra_info1, -+ HDATA_RATE(curr_tx_rate), -+ curr_tx_sgi, -+ (ra_info1>>8) & 0x07); -+ -+ cmd = 0x40000400 | mac_id; -+ rtw_write32(padapter, REG_HMEBOX_DBG_2_8723B, cmd); -+ msleep(10); -+ ra_info1 = rtw_read32(padapter, 0x2F0); -+ ra_info2 = rtw_read32(padapter, 0x2F4); -+ rate_mask1 = rtw_read32(padapter, 0x2F8); -+ rate_mask2 = rtw_read32(padapter, 0x2FC); -+ hight_rate = ra_info2&0xFF; -+ lowest_rate = (ra_info2>>8) & 0xFF; -+ -+ DBG_8192C("[ ra_info1:0x%08x ] =>RSSI =%d, BW_setting = 0x%02x, DISRA = 0x%02x, VHT_EN = 0x%02x\n", -+ ra_info1, -+ ra_info1&0xFF, -+ (ra_info1>>8) & 0xFF, -+ (ra_info1>>16) & 0xFF, -+ (ra_info1>>24) & 0xFF); -+ -+ DBG_8192C("[ ra_info2:0x%08x ] =>hight_rate =%s, lowest_rate =%s, SGI = 0x%02x, RateID =%d\n", -+ ra_info2, -+ HDATA_RATE(hight_rate), -+ HDATA_RATE(lowest_rate), -+ (ra_info2>>16) & 0xFF, -+ (ra_info2>>24) & 0xFF); -+ -+ DBG_8192C("rate_mask2 = 0x%08x, rate_mask1 = 0x%08x\n", rate_mask2, rate_mask1); -+ -+ } -+ break; -+ -+ case HAL_DEF_TX_PAGE_BOUNDARY: -+ if (!padapter->registrypriv.wifi_spec) { -+ *(u8 *)pval = TX_PAGE_BOUNDARY_8723B; -+ } else { -+ *(u8 *)pval = WMM_NORMAL_TX_PAGE_BOUNDARY_8723B; -+ } -+ break; -+ -+ case HAL_DEF_MACID_SLEEP: -+ *(u8 *)pval = true; /* support macid sleep */ -+ break; -+ -+ default: -+ bResult = GetHalDefVar(padapter, variable, pval); -+ break; -+ } -+ -+ return bResult; -+} -+ -+#ifdef CONFIG_WOWLAN -+void Hal_DetectWoWMode(struct adapter *padapter) -+{ -+ adapter_to_pwrctl(padapter)->bSupportRemoteWakeup = true; -+ DBG_871X("%s\n", __func__); -+} -+#endif /* CONFIG_WOWLAN */ -+ -+void rtl8723b_start_thread(struct adapter *padapter) -+{ -+#ifndef CONFIG_SDIO_TX_TASKLET -+ struct xmit_priv *xmitpriv = &padapter->xmitpriv; -+ -+ xmitpriv->SdioXmitThread = kthread_run(rtl8723bs_xmit_thread, padapter, "RTWHALXT"); -+ if (IS_ERR(xmitpriv->SdioXmitThread)) { -+ RT_TRACE(_module_hal_xmit_c_, _drv_err_, ("%s: start rtl8723bs_xmit_thread FAIL!!\n", __func__)); -+ } -+#endif -+} -+ -+void rtl8723b_stop_thread(struct adapter *padapter) -+{ -+#ifndef CONFIG_SDIO_TX_TASKLET -+ struct xmit_priv *xmitpriv = &padapter->xmitpriv; -+ -+ /* stop xmit_buf_thread */ -+ if (xmitpriv->SdioXmitThread) { -+ up(&xmitpriv->SdioXmitSema); -+ down(&xmitpriv->SdioXmitTerminateSema); -+ xmitpriv->SdioXmitThread = NULL; -+ } -+#endif -+} -+ -+#if defined(CONFIG_CHECK_BT_HANG) -+extern void check_bt_status_work(void *data); -+void rtl8723bs_init_checkbthang_workqueue(struct adapter *adapter) -+{ -+ adapter->priv_checkbt_wq = alloc_workqueue("sdio_wq", 0, 0); -+ INIT_DELAYED_WORK(&adapter->checkbt_work, (void *)check_bt_status_work); -+} -+ -+void rtl8723bs_free_checkbthang_workqueue(struct adapter *adapter) -+{ -+ if (adapter->priv_checkbt_wq) { -+ cancel_delayed_work_sync(&adapter->checkbt_work); -+ flush_workqueue(adapter->priv_checkbt_wq); -+ destroy_workqueue(adapter->priv_checkbt_wq); -+ adapter->priv_checkbt_wq = NULL; -+ } -+} -+ -+void rtl8723bs_cancle_checkbthang_workqueue(struct adapter *adapter) -+{ -+ if (adapter->priv_checkbt_wq) -+ cancel_delayed_work_sync(&adapter->checkbt_work); -+} -+ -+void rtl8723bs_hal_check_bt_hang(struct adapter *adapter) -+{ -+ if (adapter->priv_checkbt_wq) -+ queue_delayed_work(adapter->priv_checkbt_wq, &(adapter->checkbt_work), 0); -+} -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/rtl8723b_phycfg.c linux/3rdparty/rtl8723bs/hal/rtl8723b_phycfg.c ---- linux.old/3rdparty/rtl8723bs/hal/rtl8723b_phycfg.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/rtl8723b_phycfg.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1060 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8723B_PHYCFG_C_ -+ -+#include -+#include -+#include -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+/* Channel switch:The size of command tables for switch channel*/ -+#define MAX_PRECMD_CNT 16 -+#define MAX_RFDEPENDCMD_CNT 16 -+#define MAX_POSTCMD_CNT 16 -+ -+#define MAX_DOZE_WAITING_TIMES_9x 64 -+ -+/** -+* Function: phy_CalculateBitShift -+* -+* OverView: Get shifted position of the BitMask -+* -+* Input: -+* u32 BitMask, -+* -+* Output: none -+* Return: u32 Return the shift bit bit position of the mask -+*/ -+static u32 phy_CalculateBitShift(u32 BitMask) -+{ -+ u32 i; -+ -+ for (i = 0; i <= 31; i++) { -+ if (((BitMask>>i) & 0x1) == 1) -+ break; -+ } -+ return i; -+} -+ -+ -+/** -+* Function: PHY_QueryBBReg -+* -+* OverView: Read "sepcific bits" from BB register -+* -+* Input: -+* struct adapter * Adapter, -+* u32 RegAddr, The target address to be readback -+* u32 BitMask The target bit position in the target address -+* to be readback -+* Output: None -+* Return: u32 Data The readback register value -+* Note: This function is equal to "GetRegSetting" in PHY programming guide -+*/ -+u32 PHY_QueryBBReg_8723B(struct adapter *Adapter, u32 RegAddr, u32 BitMask) -+{ -+ u32 ReturnValue = 0, OriginalValue, BitShift; -+ -+#if (DISABLE_BB_RF == 1) -+ return 0; -+#endif -+ -+ /* RT_TRACE(COMP_RF, DBG_TRACE, ("--->PHY_QueryBBReg(): RegAddr(%#lx), BitMask(%#lx)\n", RegAddr, BitMask)); */ -+ -+ OriginalValue = rtw_read32(Adapter, RegAddr); -+ BitShift = phy_CalculateBitShift(BitMask); -+ ReturnValue = (OriginalValue & BitMask) >> BitShift; -+ -+ return ReturnValue; -+ -+} -+ -+ -+/** -+* Function: PHY_SetBBReg -+* -+* OverView: Write "Specific bits" to BB register (page 8~) -+* -+* Input: -+* struct adapter * Adapter, -+* u32 RegAddr, The target address to be modified -+* u32 BitMask The target bit position in the target address -+* to be modified -+* u32 Data The new register value in the target bit position -+* of the target address -+* -+* Output: None -+* Return: None -+* Note: This function is equal to "PutRegSetting" in PHY programming guide -+*/ -+ -+void PHY_SetBBReg_8723B( -+ struct adapter *Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+) -+{ -+ /* u16 BBWaitCounter = 0; */ -+ u32 OriginalValue, BitShift; -+ -+#if (DISABLE_BB_RF == 1) -+ return; -+#endif -+ -+ /* RT_TRACE(COMP_RF, DBG_TRACE, ("--->PHY_SetBBReg(): RegAddr(%#lx), BitMask(%#lx), Data(%#lx)\n", RegAddr, BitMask, Data)); */ -+ -+ if (BitMask != bMaskDWord) { /* if not "double word" write */ -+ OriginalValue = rtw_read32(Adapter, RegAddr); -+ BitShift = phy_CalculateBitShift(BitMask); -+ Data = ((OriginalValue & (~BitMask)) | ((Data << BitShift) & BitMask)); -+ } -+ -+ rtw_write32(Adapter, RegAddr, Data); -+ -+} -+ -+ -+/* */ -+/* 2. RF register R/W API */ -+/* */ -+ -+static u32 phy_RFSerialRead_8723B( -+ struct adapter *Adapter, enum RF_PATH eRFPath, u32 Offset -+) -+{ -+ u32 retValue = 0; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ struct bb_register_def *pPhyReg = &pHalData->PHYRegDef[eRFPath]; -+ u32 NewOffset; -+ u32 tmplong2; -+ u8 RfPiEnable = 0; -+ u32 MaskforPhySet = 0; -+ int i = 0; -+ -+ /* */ -+ /* Make sure RF register offset is correct */ -+ /* */ -+ Offset &= 0xff; -+ -+ NewOffset = Offset; -+ -+ if (eRFPath == RF_PATH_A) { -+ tmplong2 = PHY_QueryBBReg(Adapter, rFPGA0_XA_HSSIParameter2|MaskforPhySet, bMaskDWord);; -+ tmplong2 = (tmplong2 & (~bLSSIReadAddress)) | (NewOffset<<23) | bLSSIReadEdge; /* T65 RF */ -+ PHY_SetBBReg(Adapter, rFPGA0_XA_HSSIParameter2|MaskforPhySet, bMaskDWord, tmplong2&(~bLSSIReadEdge)); -+ } else { -+ tmplong2 = PHY_QueryBBReg(Adapter, rFPGA0_XB_HSSIParameter2|MaskforPhySet, bMaskDWord); -+ tmplong2 = (tmplong2 & (~bLSSIReadAddress)) | (NewOffset<<23) | bLSSIReadEdge; /* T65 RF */ -+ PHY_SetBBReg(Adapter, rFPGA0_XB_HSSIParameter2|MaskforPhySet, bMaskDWord, tmplong2&(~bLSSIReadEdge)); -+ } -+ -+ tmplong2 = PHY_QueryBBReg(Adapter, rFPGA0_XA_HSSIParameter2|MaskforPhySet, bMaskDWord); -+ PHY_SetBBReg(Adapter, rFPGA0_XA_HSSIParameter2|MaskforPhySet, bMaskDWord, tmplong2 & (~bLSSIReadEdge)); -+ PHY_SetBBReg(Adapter, rFPGA0_XA_HSSIParameter2|MaskforPhySet, bMaskDWord, tmplong2 | bLSSIReadEdge); -+ -+ udelay(10); -+ -+ for (i = 0; i < 2; i++) -+ udelay(MAX_STALL_TIME); -+ udelay(10); -+ -+ if (eRFPath == RF_PATH_A) -+ RfPiEnable = (u8)PHY_QueryBBReg(Adapter, rFPGA0_XA_HSSIParameter1|MaskforPhySet, BIT8); -+ else if (eRFPath == RF_PATH_B) -+ RfPiEnable = (u8)PHY_QueryBBReg(Adapter, rFPGA0_XB_HSSIParameter1|MaskforPhySet, BIT8); -+ -+ if (RfPiEnable) { -+ /* Read from BBreg8b8, 12 bits for 8190, 20bits for T65 RF */ -+ retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBackPi|MaskforPhySet, bLSSIReadBackData); -+ -+ /* RT_DISP(FINIT, INIT_RF, ("Readback from RF-PI : 0x%x\n", retValue)); */ -+ } else { -+ /* Read from BBreg8a0, 12 bits for 8190, 20 bits for T65 RF */ -+ retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBack|MaskforPhySet, bLSSIReadBackData); -+ -+ /* RT_DISP(FINIT, INIT_RF, ("Readback from RF-SI : 0x%x\n", retValue)); */ -+ } -+ return retValue; -+ -+} -+ -+/** -+* Function: phy_RFSerialWrite_8723B -+* -+* OverView: Write data to RF register (page 8~) -+* -+* Input: -+* struct adapter * Adapter, -+* RF_PATH eRFPath, Radio path of A/B/C/D -+* u32 Offset, The target address to be read -+* u32 Data The new register Data in the target bit position -+* of the target to be read -+* -+* Output: None -+* Return: None -+* Note: Threre are three types of serial operations: -+* 1. Software serial write -+* 2. Hardware LSSI-Low Speed Serial Interface -+* 3. Hardware HSSI-High speed -+* serial write. Driver need to implement (1) and (2). -+* This function is equal to the combination of RF_ReadReg() and RFLSSIRead() -+ * -+ * Note: For RF8256 only -+ * The total count of RTL8256(Zebra4) register is around 36 bit it only employs -+ * 4-bit RF address. RTL8256 uses "register mode control bit" (Reg00[12], Reg00[10]) -+ * to access register address bigger than 0xf. See "Appendix-4 in PHY Configuration -+ * programming guide" for more details. -+ * Thus, we define a sub-finction for RTL8526 register address conversion -+ * =========================================================== -+ * Register Mode RegCTL[1] RegCTL[0] Note -+ * (Reg00[12]) (Reg00[10]) -+ * =========================================================== -+ * Reg_Mode0 0 x Reg 0 ~15(0x0 ~ 0xf) -+ * ------------------------------------------------------------------ -+ * Reg_Mode1 1 0 Reg 16 ~30(0x1 ~ 0xf) -+ * ------------------------------------------------------------------ -+ * Reg_Mode2 1 1 Reg 31 ~ 45(0x1 ~ 0xf) -+ * ------------------------------------------------------------------ -+ * -+ *2008/09/02 MH Add 92S RF definition -+ * -+ * -+ * -+*/ -+static void phy_RFSerialWrite_8723B( -+ struct adapter *Adapter, -+ enum RF_PATH eRFPath, -+ u32 Offset, -+ u32 Data -+) -+{ -+ u32 DataAndAddr = 0; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ struct bb_register_def *pPhyReg = &pHalData->PHYRegDef[eRFPath]; -+ u32 NewOffset; -+ -+ Offset &= 0xff; -+ -+ /* */ -+ /* Switch page for 8256 RF IC */ -+ /* */ -+ NewOffset = Offset; -+ -+ /* */ -+ /* Put write addr in [5:0] and write data in [31:16] */ -+ /* */ -+ /* DataAndAddr = (Data<<16) | (NewOffset&0x3f); */ -+ DataAndAddr = ((NewOffset<<20) | (Data&0x000fffff)) & 0x0fffffff; /* T65 RF */ -+ -+ /* */ -+ /* Write Operation */ -+ /* */ -+ PHY_SetBBReg(Adapter, pPhyReg->rf3wireOffset, bMaskDWord, DataAndAddr); -+ /* RTPRINT(FPHY, PHY_RFW, ("RFW-%d Addr[0x%lx]= 0x%lx\n", eRFPath, pPhyReg->rf3wireOffset, DataAndAddr)); */ -+ -+} -+ -+ -+/** -+* Function: PHY_QueryRFReg -+* -+* OverView: Query "Specific bits" to RF register (page 8~) -+* -+* Input: -+* struct adapter * Adapter, -+* RF_PATH eRFPath, Radio path of A/B/C/D -+* u32 RegAddr, The target address to be read -+* u32 BitMask The target bit position in the target address -+* to be read -+* -+* Output: None -+* Return: u32 Readback value -+* Note: This function is equal to "GetRFRegSetting" in PHY programming guide -+*/ -+u32 PHY_QueryRFReg_8723B( -+ struct adapter *Adapter, -+ u8 eRFPath, -+ u32 RegAddr, -+ u32 BitMask -+) -+{ -+ u32 Original_Value, Readback_Value, BitShift; -+ -+#if (DISABLE_BB_RF == 1) -+ return 0; -+#endif -+ -+ Original_Value = phy_RFSerialRead_8723B(Adapter, eRFPath, RegAddr); -+ -+ BitShift = phy_CalculateBitShift(BitMask); -+ Readback_Value = (Original_Value & BitMask) >> BitShift; -+ -+ return Readback_Value; -+} -+ -+/** -+* Function: PHY_SetRFReg -+* -+* OverView: Write "Specific bits" to RF register (page 8~) -+* -+* Input: -+* struct adapter * Adapter, -+* RF_PATH eRFPath, Radio path of A/B/C/D -+* u32 RegAddr, The target address to be modified -+* u32 BitMask The target bit position in the target address -+* to be modified -+* u32 Data The new register Data in the target bit position -+* of the target address -+* -+* Output: None -+* Return: None -+* Note: This function is equal to "PutRFRegSetting" in PHY programming guide -+*/ -+void PHY_SetRFReg_8723B( -+ struct adapter *Adapter, -+ u8 eRFPath, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+) -+{ -+ u32 Original_Value, BitShift; -+ -+#if (DISABLE_BB_RF == 1) -+ return; -+#endif -+ -+ /* RF data is 12 bits only */ -+ if (BitMask != bRFRegOffsetMask) { -+ Original_Value = phy_RFSerialRead_8723B(Adapter, eRFPath, RegAddr); -+ BitShift = phy_CalculateBitShift(BitMask); -+ Data = ((Original_Value & (~BitMask)) | (Data<odmpriv); -+ rtStatus = _SUCCESS; -+ } -+ -+ return rtStatus; -+} -+ -+/** -+* Function: phy_InitBBRFRegisterDefinition -+* -+* OverView: Initialize Register definition offset for Radio Path A/B/C/D -+* -+* Input: -+* struct adapter * Adapter, -+* -+* Output: None -+* Return: None -+* Note: The initialization value is constant and it should never be changes -+*/ -+static void phy_InitBBRFRegisterDefinition(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ /* RF Interface Sowrtware Control */ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfs = rFPGA0_XAB_RFInterfaceSW; /* 16 LSBs if read 32-bit from 0x870 */ -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfs = rFPGA0_XAB_RFInterfaceSW; /* 16 MSBs if read 32-bit from 0x870 (16-bit for 0x872) */ -+ -+ /* RF Interface Output (and Enable) */ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfo = rFPGA0_XA_RFInterfaceOE; /* 16 LSBs if read 32-bit from 0x860 */ -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfo = rFPGA0_XB_RFInterfaceOE; /* 16 LSBs if read 32-bit from 0x864 */ -+ -+ /* RF Interface (Output and) Enable */ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfe = rFPGA0_XA_RFInterfaceOE; /* 16 MSBs if read 32-bit from 0x860 (16-bit for 0x862) */ -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfe = rFPGA0_XB_RFInterfaceOE; /* 16 MSBs if read 32-bit from 0x864 (16-bit for 0x866) */ -+ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rf3wireOffset = rFPGA0_XA_LSSIParameter; /* LSSI Parameter */ -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rf3wireOffset = rFPGA0_XB_LSSIParameter; -+ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfHSSIPara2 = rFPGA0_XA_HSSIParameter2; /* wire control parameter2 */ -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfHSSIPara2 = rFPGA0_XB_HSSIParameter2; /* wire control parameter2 */ -+ -+ /* Tranceiver Readback LSSI/HSPI mode */ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfLSSIReadBack = rFPGA0_XA_LSSIReadBack; -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfLSSIReadBack = rFPGA0_XB_LSSIReadBack; -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfLSSIReadBackPi = TransceiverA_HSPI_Readback; -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfLSSIReadBackPi = TransceiverB_HSPI_Readback; -+ -+} -+ -+static int phy_BB8723b_Config_ParaFile(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ int rtStatus = _SUCCESS; -+ u8 sz8723BBRegFile[] = RTL8723B_PHY_REG; -+ u8 sz8723AGCTableFile[] = RTL8723B_AGC_TAB; -+ u8 sz8723BBBRegPgFile[] = RTL8723B_PHY_REG_PG; -+ u8 sz8723BBRegMpFile[] = RTL8723B_PHY_REG_MP; -+ u8 sz8723BRFTxPwrLmtFile[] = RTL8723B_TXPWR_LMT; -+ u8 *pszBBRegFile = NULL, *pszAGCTableFile = NULL, *pszBBRegPgFile = NULL, *pszBBRegMpFile = NULL, *pszRFTxPwrLmtFile = NULL; -+ -+ pszBBRegFile = sz8723BBRegFile; -+ pszAGCTableFile = sz8723AGCTableFile; -+ pszBBRegPgFile = sz8723BBBRegPgFile; -+ pszBBRegMpFile = sz8723BBRegMpFile; -+ pszRFTxPwrLmtFile = sz8723BRFTxPwrLmtFile; -+ -+ /* Read Tx Power Limit File */ -+ PHY_InitTxPowerLimit(Adapter); -+ if ( -+ Adapter->registrypriv.RegEnableTxPowerLimit == 1 || -+ (Adapter->registrypriv.RegEnableTxPowerLimit == 2 && pHalData->EEPROMRegulatory == 1) -+ ) { -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (PHY_ConfigRFWithPowerLimitTableParaFile(Adapter, pszRFTxPwrLmtFile) == _FAIL) -+#endif -+ { -+ if (HAL_STATUS_SUCCESS != ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv, CONFIG_RF_TXPWR_LMT, (ODM_RF_RADIO_PATH_E)0)) -+ rtStatus = _FAIL; -+ } -+ -+ if (rtStatus != _SUCCESS) { -+ DBG_871X("%s():Read Tx power limit fail\n", __func__); -+ goto phy_BB8190_Config_ParaFile_Fail; -+ } -+ } -+ -+ /* */ -+ /* 1. Read PHY_REG.TXT BB INIT!! */ -+ /* */ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (phy_ConfigBBWithParaFile(Adapter, pszBBRegFile, CONFIG_BB_PHY_REG) == _FAIL) -+#endif -+ { -+ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG)) -+ rtStatus = _FAIL; -+ } -+ -+ if (rtStatus != _SUCCESS) { -+ DBG_8192C("%s():Write BB Reg Fail!!", __func__); -+ goto phy_BB8190_Config_ParaFile_Fail; -+ } -+ -+ /* If EEPROM or EFUSE autoload OK, We must config by PHY_REG_PG.txt */ -+ PHY_InitTxPowerByRate(Adapter); -+ if ( -+ Adapter->registrypriv.RegEnableTxPowerByRate == 1 || -+ (Adapter->registrypriv.RegEnableTxPowerByRate == 2 && pHalData->EEPROMRegulatory != 2) -+ ) { -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (phy_ConfigBBWithPgParaFile(Adapter, pszBBRegPgFile) == _FAIL) -+#endif -+ { -+ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG_PG)) -+ rtStatus = _FAIL; -+ } -+ -+ if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE) -+ PHY_TxPowerByRateConfiguration(Adapter); -+ -+ if ( -+ Adapter->registrypriv.RegEnableTxPowerLimit == 1 || -+ (Adapter->registrypriv.RegEnableTxPowerLimit == 2 && pHalData->EEPROMRegulatory == 1) -+ ) -+ PHY_ConvertTxPowerLimitToPowerIndex(Adapter); -+ -+ if (rtStatus != _SUCCESS) { -+ DBG_8192C("%s():BB_PG Reg Fail!!\n", __func__); -+ } -+ } -+ -+ /* */ -+ /* 2. Read BB AGC table Initialization */ -+ /* */ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (phy_ConfigBBWithParaFile(Adapter, pszAGCTableFile, CONFIG_BB_AGC_TAB) == _FAIL) -+#endif -+ { -+ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_AGC_TAB)) -+ rtStatus = _FAIL; -+ } -+ -+ if (rtStatus != _SUCCESS) { -+ DBG_8192C("%s():AGC Table Fail\n", __func__); -+ goto phy_BB8190_Config_ParaFile_Fail; -+ } -+ -+phy_BB8190_Config_ParaFile_Fail: -+ -+ return rtStatus; -+} -+ -+ -+int PHY_BBConfig8723B(struct adapter *Adapter) -+{ -+ int rtStatus = _SUCCESS; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ u32 RegVal; -+ u8 CrystalCap; -+ -+ phy_InitBBRFRegisterDefinition(Adapter); -+ -+ /* Enable BB and RF */ -+ RegVal = rtw_read16(Adapter, REG_SYS_FUNC_EN); -+ rtw_write16(Adapter, REG_SYS_FUNC_EN, (u16)(RegVal|BIT13|BIT0|BIT1)); -+ -+ rtw_write32(Adapter, 0x948, 0x280); /* Others use Antenna S1 */ -+ -+ rtw_write8(Adapter, REG_RF_CTRL, RF_EN|RF_RSTB|RF_SDMRSTB); -+ -+ msleep(1); -+ -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, 0x1, 0xfffff, 0x780); -+ -+ rtw_write8(Adapter, REG_SYS_FUNC_EN, FEN_PPLL|FEN_PCIEA|FEN_DIO_PCIE|FEN_BB_GLB_RSTn|FEN_BBRSTB); -+ -+ rtw_write8(Adapter, REG_AFE_XTAL_CTRL+1, 0x80); -+ -+ /* */ -+ /* Config BB and AGC */ -+ /* */ -+ rtStatus = phy_BB8723b_Config_ParaFile(Adapter); -+ -+ /* 0x2C[23:18] = 0x2C[17:12] = CrystalCap */ -+ CrystalCap = pHalData->CrystalCap & 0x3F; -+ PHY_SetBBReg(Adapter, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCap | (CrystalCap << 6))); -+ -+ return rtStatus; -+} -+ -+static void phy_LCK_8723B(struct adapter *Adapter) -+{ -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0xB0, bRFRegOffsetMask, 0xDFBE0); -+ PHY_SetRFReg(Adapter, RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, 0x8C01); -+ mdelay(200); -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0xB0, bRFRegOffsetMask, 0xDFFE0); -+} -+ -+int PHY_RFConfig8723B(struct adapter *Adapter) -+{ -+ int rtStatus = _SUCCESS; -+ -+ /* */ -+ /* RF config */ -+ /* */ -+ rtStatus = PHY_RF6052_Config8723B(Adapter); -+ -+ phy_LCK_8723B(Adapter); -+ /* PHY_BB8723B_Config_1T(Adapter); */ -+ -+ return rtStatus; -+} -+ -+/************************************************************************************************************** -+ * Description: -+ * The low-level interface to set TxAGC , called by both MP and Normal Driver. -+ * -+ * <20120830, Kordan> -+ **************************************************************************************************************/ -+ -+void PHY_SetTxPowerIndex_8723B( -+ struct adapter *Adapter, -+ u32 PowerIndex, -+ u8 RFPath, -+ u8 Rate -+) -+{ -+ if (RFPath == ODM_RF_PATH_A || RFPath == ODM_RF_PATH_B) { -+ switch (Rate) { -+ case MGN_1M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, PowerIndex); -+ break; -+ case MGN_2M: -+ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte1, PowerIndex); -+ break; -+ case MGN_5_5M: -+ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte2, PowerIndex); -+ break; -+ case MGN_11M: -+ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte3, PowerIndex); -+ break; -+ -+ case MGN_6M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte0, PowerIndex); -+ break; -+ case MGN_9M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte1, PowerIndex); -+ break; -+ case MGN_12M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte2, PowerIndex); -+ break; -+ case MGN_18M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte3, PowerIndex); -+ break; -+ -+ case MGN_24M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte0, PowerIndex); -+ break; -+ case MGN_36M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte1, PowerIndex); -+ break; -+ case MGN_48M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte2, PowerIndex); -+ break; -+ case MGN_54M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte3, PowerIndex); -+ break; -+ -+ case MGN_MCS0: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte0, PowerIndex); -+ break; -+ case MGN_MCS1: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte1, PowerIndex); -+ break; -+ case MGN_MCS2: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte2, PowerIndex); -+ break; -+ case MGN_MCS3: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte3, PowerIndex); -+ break; -+ -+ case MGN_MCS4: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte0, PowerIndex); -+ break; -+ case MGN_MCS5: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte1, PowerIndex); -+ break; -+ case MGN_MCS6: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte2, PowerIndex); -+ break; -+ case MGN_MCS7: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte3, PowerIndex); -+ break; -+ -+ default: -+ DBG_871X("Invalid Rate!!\n"); -+ break; -+ } -+ } else { -+ RT_TRACE(_module_hal_init_c_, _drv_err_, ("Invalid RFPath!!\n")); -+ } -+} -+ -+u8 PHY_GetTxPowerIndex_8723B( -+ struct adapter *padapter, -+ u8 RFPath, -+ u8 Rate, -+ enum CHANNEL_WIDTH BandWidth, -+ u8 Channel -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ s8 txPower = 0, powerDiffByRate = 0, limit = 0; -+ bool bIn24G = false; -+ -+ /* DBG_871X("===>%s\n", __func__); */ -+ -+ txPower = (s8) PHY_GetTxPowerIndexBase(padapter, RFPath, Rate, BandWidth, Channel, &bIn24G); -+ powerDiffByRate = PHY_GetTxPowerByRate(padapter, BAND_ON_2_4G, ODM_RF_PATH_A, RF_1TX, Rate); -+ -+ limit = PHY_GetTxPowerLimit( -+ padapter, -+ padapter->registrypriv.RegPwrTblSel, -+ (u8)(!bIn24G), -+ pHalData->CurrentChannelBW, -+ RFPath, -+ Rate, -+ pHalData->CurrentChannel -+ ); -+ -+ powerDiffByRate = powerDiffByRate > limit ? limit : powerDiffByRate; -+ txPower += powerDiffByRate; -+ -+ txPower += PHY_GetTxPowerTrackingOffset(padapter, RFPath, Rate); -+ -+ if (txPower > MAX_POWER_INDEX) -+ txPower = MAX_POWER_INDEX; -+ -+ /* DBG_871X("Final Tx Power(RF-%c, Channel: %d) = %d(0x%X)\n", ((RFPath == 0)?'A':'B'), Channel, txPower, txPower)); */ -+ return (u8) txPower; -+} -+ -+void PHY_SetTxPowerLevel8723B(struct adapter *Adapter, u8 Channel) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u8 RFPath = ODM_RF_PATH_A; -+ -+ if (pHalData->AntDivCfg) {/* antenna diversity Enable */ -+ RFPath = ((pDM_FatTable->RxIdleAnt == MAIN_ANT) ? ODM_RF_PATH_A : ODM_RF_PATH_B); -+ } else { /* antenna diversity disable */ -+ RFPath = pHalData->ant_path; -+ } -+ -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("==>PHY_SetTxPowerLevel8723B()\n")); -+ -+ PHY_SetTxPowerLevelByPath(Adapter, Channel, RFPath); -+ -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("<==PHY_SetTxPowerLevel8723B()\n")); -+} -+ -+void PHY_GetTxPowerLevel8723B(struct adapter *Adapter, s32 *powerlevel) -+{ -+} -+ -+static void phy_SetRegBW_8723B( -+ struct adapter *Adapter, enum CHANNEL_WIDTH CurrentBW -+) -+{ -+ u16 RegRfMod_BW, u2tmp = 0; -+ RegRfMod_BW = rtw_read16(Adapter, REG_TRXPTCL_CTL_8723B); -+ -+ switch (CurrentBW) { -+ case CHANNEL_WIDTH_20: -+ rtw_write16(Adapter, REG_TRXPTCL_CTL_8723B, (RegRfMod_BW & 0xFE7F)); /* BIT 7 = 0, BIT 8 = 0 */ -+ break; -+ -+ case CHANNEL_WIDTH_40: -+ u2tmp = RegRfMod_BW | BIT7; -+ rtw_write16(Adapter, REG_TRXPTCL_CTL_8723B, (u2tmp & 0xFEFF)); /* BIT 7 = 1, BIT 8 = 0 */ -+ break; -+ -+ case CHANNEL_WIDTH_80: -+ u2tmp = RegRfMod_BW | BIT8; -+ rtw_write16(Adapter, REG_TRXPTCL_CTL_8723B, (u2tmp & 0xFF7F)); /* BIT 7 = 0, BIT 8 = 1 */ -+ break; -+ -+ default: -+ DBG_871X("phy_PostSetBWMode8723B(): unknown Bandwidth: %#X\n", CurrentBW); -+ break; -+ } -+} -+ -+static u8 phy_GetSecondaryChnl_8723B(struct adapter *Adapter) -+{ -+ u8 SCSettingOf40 = 0, SCSettingOf20 = 0; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ RT_TRACE( -+ _module_hal_init_c_, -+ _drv_info_, -+ ( -+ "SCMapping: VHT Case: pHalData->CurrentChannelBW %d, pHalData->nCur80MhzPrimeSC %d, pHalData->nCur40MhzPrimeSC %d\n", -+ pHalData->CurrentChannelBW, -+ pHalData->nCur80MhzPrimeSC, -+ pHalData->nCur40MhzPrimeSC -+ ) -+ ); -+ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) { -+ if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOf40 = VHT_DATA_SC_40_LOWER_OF_80MHZ; -+ else if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOf40 = VHT_DATA_SC_40_UPPER_OF_80MHZ; -+ else -+ RT_TRACE(_module_hal_init_c_, _drv_err_, ("SCMapping: Not Correct Primary40MHz Setting\n")); -+ -+ if ( -+ (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && -+ (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ ) -+ SCSettingOf20 = VHT_DATA_SC_20_LOWEST_OF_80MHZ; -+ else if ( -+ (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && -+ (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ ) -+ SCSettingOf20 = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else if ( -+ (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && -+ (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ ) -+ SCSettingOf20 = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if ( -+ (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && -+ (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ ) -+ SCSettingOf20 = VHT_DATA_SC_20_UPPERST_OF_80MHZ; -+ else -+ RT_TRACE(_module_hal_init_c_, _drv_err_, ("SCMapping: Not Correct Primary40MHz Setting\n")); -+ } else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) { -+ RT_TRACE( -+ _module_hal_init_c_, -+ _drv_info_, -+ ( -+ "SCMapping: VHT Case: pHalData->CurrentChannelBW %d, pHalData->nCur40MhzPrimeSC %d\n", -+ pHalData->CurrentChannelBW, -+ pHalData->nCur40MhzPrimeSC -+ ) -+ ); -+ -+ if (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOf20 = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOf20 = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else -+ RT_TRACE(_module_hal_init_c_, _drv_err_, ("SCMapping: Not Correct Primary40MHz Setting\n")); -+ } -+ -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("SCMapping: SC Value %x\n", ((SCSettingOf40 << 4) | SCSettingOf20))); -+ return ((SCSettingOf40 << 4) | SCSettingOf20); -+} -+ -+static void phy_PostSetBwMode8723B(struct adapter *Adapter) -+{ -+ u8 SubChnlNum = 0; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ -+ /* 3 Set Reg668 Reg440 BW */ -+ phy_SetRegBW_8723B(Adapter, pHalData->CurrentChannelBW); -+ -+ /* 3 Set Reg483 */ -+ SubChnlNum = phy_GetSecondaryChnl_8723B(Adapter); -+ rtw_write8(Adapter, REG_DATA_SC_8723B, SubChnlNum); -+ -+ /* 3 */ -+ /* 3<2>Set PHY related register */ -+ /* 3 */ -+ switch (pHalData->CurrentChannelBW) { -+ /* 20 MHz channel*/ -+ case CHANNEL_WIDTH_20: -+ PHY_SetBBReg(Adapter, rFPGA0_RFMOD, bRFMOD, 0x0); -+ -+ PHY_SetBBReg(Adapter, rFPGA1_RFMOD, bRFMOD, 0x0); -+ -+/* PHY_SetBBReg(Adapter, rFPGA0_AnalogParameter2, BIT10, 1); */ -+ -+ PHY_SetBBReg(Adapter, rOFDM0_TxPseudoNoiseWgt, (BIT31|BIT30), 0x0); -+ break; -+ -+ /* 40 MHz channel*/ -+ case CHANNEL_WIDTH_40: -+ PHY_SetBBReg(Adapter, rFPGA0_RFMOD, bRFMOD, 0x1); -+ -+ PHY_SetBBReg(Adapter, rFPGA1_RFMOD, bRFMOD, 0x1); -+ -+ /* Set Control channel to upper or lower. These settings are required only for 40MHz */ -+ PHY_SetBBReg(Adapter, rCCK0_System, bCCKSideBand, (pHalData->nCur40MhzPrimeSC>>1)); -+ -+ PHY_SetBBReg(Adapter, rOFDM1_LSTF, 0xC00, pHalData->nCur40MhzPrimeSC); -+ -+/* PHY_SetBBReg(Adapter, rFPGA0_AnalogParameter2, BIT10, 0); */ -+ -+ PHY_SetBBReg(Adapter, 0x818, (BIT26|BIT27), (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) ? 2 : 1); -+ -+ break; -+ -+ default: -+ /*RT_TRACE(COMP_DBG, DBG_LOUD, ("phy_SetBWMode8723B(): unknown Bandwidth: %#X\n"\ -+ , pHalData->CurrentChannelBW));*/ -+ break; -+ } -+ -+ /* 3<3>Set RF related register */ -+ PHY_RF6052SetBandwidth8723B(Adapter, pHalData->CurrentChannelBW); -+} -+ -+static void phy_SwChnl8723B(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ u8 channelToSW = pHalData->CurrentChannel; -+ -+ if (pHalData->rf_chip == RF_PSEUDO_11N) { -+ /* RT_TRACE(COMP_MLME, DBG_LOUD, ("phy_SwChnl8723B: return for PSEUDO\n")); */ -+ return; -+ } -+ pHalData->RfRegChnlVal[0] = ((pHalData->RfRegChnlVal[0] & 0xfffff00) | channelToSW); -+ PHY_SetRFReg(padapter, ODM_RF_PATH_A, RF_CHNLBW, 0x3FF, pHalData->RfRegChnlVal[0]); -+ PHY_SetRFReg(padapter, ODM_RF_PATH_B, RF_CHNLBW, 0x3FF, pHalData->RfRegChnlVal[0]); -+ -+ DBG_8192C("===>phy_SwChnl8723B: Channel = %d\n", channelToSW); -+} -+ -+static void phy_SwChnlAndSetBwMode8723B(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ /* RT_TRACE(COMP_SCAN, DBG_LOUD, ("phy_SwChnlAndSetBwMode8723B(): bSwChnl %d, bSetChnlBW %d\n", pHalData->bSwChnl, pHalData->bSetChnlBW)); */ -+ if (Adapter->bNotifyChannelChange) { -+ DBG_871X("[%s] bSwChnl =%d, ch =%d, bSetChnlBW =%d, bw =%d\n", -+ __func__, -+ pHalData->bSwChnl, -+ pHalData->CurrentChannel, -+ pHalData->bSetChnlBW, -+ pHalData->CurrentChannelBW); -+ } -+ -+ if (Adapter->bDriverStopped || Adapter->bSurpriseRemoved) -+ return; -+ -+ if (pHalData->bSwChnl) { -+ phy_SwChnl8723B(Adapter); -+ pHalData->bSwChnl = false; -+ } -+ -+ if (pHalData->bSetChnlBW) { -+ phy_PostSetBwMode8723B(Adapter); -+ pHalData->bSetChnlBW = false; -+ } -+ -+ PHY_SetTxPowerLevel8723B(Adapter, pHalData->CurrentChannel); -+} -+ -+static void PHY_HandleSwChnlAndSetBW8723B( -+ struct adapter *Adapter, -+ bool bSwitchChannel, -+ bool bSetBandWidth, -+ u8 ChannelNum, -+ enum CHANNEL_WIDTH ChnlWidth, -+ enum EXTCHNL_OFFSET ExtChnlOffsetOf40MHz, -+ enum EXTCHNL_OFFSET ExtChnlOffsetOf80MHz, -+ u8 CenterFrequencyIndex1 -+) -+{ -+ /* static bool bInitialzed = false; */ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ u8 tmpChannel = pHalData->CurrentChannel; -+ enum CHANNEL_WIDTH tmpBW = pHalData->CurrentChannelBW; -+ u8 tmpnCur40MhzPrimeSC = pHalData->nCur40MhzPrimeSC; -+ u8 tmpnCur80MhzPrimeSC = pHalData->nCur80MhzPrimeSC; -+ u8 tmpCenterFrequencyIndex1 = pHalData->CurrentCenterFrequencyIndex1; -+ -+ /* DBG_871X("=> PHY_HandleSwChnlAndSetBW8812: bSwitchChannel %d, bSetBandWidth %d\n", bSwitchChannel, bSetBandWidth); */ -+ -+ /* check is swchnl or setbw */ -+ if (!bSwitchChannel && !bSetBandWidth) { -+ DBG_871X("PHY_HandleSwChnlAndSetBW8812: not switch channel and not set bandwidth\n"); -+ return; -+ } -+ -+ /* skip change for channel or bandwidth is the same */ -+ if (bSwitchChannel) { -+ /* if (pHalData->CurrentChannel != ChannelNum) */ -+ { -+ if (HAL_IsLegalChannel(Adapter, ChannelNum)) -+ pHalData->bSwChnl = true; -+ } -+ } -+ -+ if (bSetBandWidth) -+ pHalData->bSetChnlBW = true; -+ -+ if (!pHalData->bSetChnlBW && !pHalData->bSwChnl) { -+ /* DBG_871X("<= PHY_HandleSwChnlAndSetBW8812: bSwChnl %d, bSetChnlBW %d\n", pHalData->bSwChnl, pHalData->bSetChnlBW); */ -+ return; -+ } -+ -+ -+ if (pHalData->bSwChnl) { -+ pHalData->CurrentChannel = ChannelNum; -+ pHalData->CurrentCenterFrequencyIndex1 = ChannelNum; -+ } -+ -+ -+ if (pHalData->bSetChnlBW) { -+ pHalData->CurrentChannelBW = ChnlWidth; -+ pHalData->nCur40MhzPrimeSC = ExtChnlOffsetOf40MHz; -+ pHalData->nCur80MhzPrimeSC = ExtChnlOffsetOf80MHz; -+ pHalData->CurrentCenterFrequencyIndex1 = CenterFrequencyIndex1; -+ } -+ -+ /* Switch workitem or set timer to do switch channel or setbandwidth operation */ -+ if ((!Adapter->bDriverStopped) && (!Adapter->bSurpriseRemoved)) { -+ phy_SwChnlAndSetBwMode8723B(Adapter); -+ } else { -+ if (pHalData->bSwChnl) { -+ pHalData->CurrentChannel = tmpChannel; -+ pHalData->CurrentCenterFrequencyIndex1 = tmpChannel; -+ } -+ -+ if (pHalData->bSetChnlBW) { -+ pHalData->CurrentChannelBW = tmpBW; -+ pHalData->nCur40MhzPrimeSC = tmpnCur40MhzPrimeSC; -+ pHalData->nCur80MhzPrimeSC = tmpnCur80MhzPrimeSC; -+ pHalData->CurrentCenterFrequencyIndex1 = tmpCenterFrequencyIndex1; -+ } -+ } -+} -+ -+void PHY_SetBWMode8723B( -+ struct adapter *Adapter, -+ enum CHANNEL_WIDTH Bandwidth, /* 20M or 40M */ -+ unsigned char Offset /* Upper, Lower, or Don't care */ -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ PHY_HandleSwChnlAndSetBW8723B(Adapter, false, true, pHalData->CurrentChannel, Bandwidth, Offset, Offset, pHalData->CurrentChannel); -+} -+ -+/* Call after initialization */ -+void PHY_SwChnl8723B(struct adapter *Adapter, u8 channel) -+{ -+ PHY_HandleSwChnlAndSetBW8723B(Adapter, true, false, channel, 0, 0, 0, channel); -+} -+ -+void PHY_SetSwChnlBWMode8723B( -+ struct adapter *Adapter, -+ u8 channel, -+ enum CHANNEL_WIDTH Bandwidth, -+ u8 Offset40, -+ u8 Offset80 -+) -+{ -+ /* DBG_871X("%s() ===>\n", __func__); */ -+ -+ PHY_HandleSwChnlAndSetBW8723B(Adapter, true, true, channel, Bandwidth, Offset40, Offset80, channel); -+ -+ /* DBG_871X("<==%s()\n", __func__); */ -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/rtl8723b_rf6052.c linux/3rdparty/rtl8723bs/hal/rtl8723b_rf6052.c ---- linux.old/3rdparty/rtl8723bs/hal/rtl8723b_rf6052.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/rtl8723b_rf6052.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,230 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/****************************************************************************** -+ * -+ * -+ * Module: rtl8192c_rf6052.c (Source C File) -+ * -+ * Note: Provide RF 6052 series relative API. -+ * -+ * Function: -+ * -+ * Export: -+ * -+ * Abbrev: -+ * -+ * History: -+ * Data Who Remark -+ * -+ * 09/25/2008 MHC Create initial version. -+ * 11/05/2008 MHC Add API for tw power setting. -+ * -+ * -+******************************************************************************/ -+ -+#include -+ -+/*---------------------------Define Local Constant---------------------------*/ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+ -+/*------------------------Define global variable-----------------------------*/ -+/*------------------------Define global variable-----------------------------*/ -+ -+ -+/*------------------------Define local variable------------------------------*/ -+/* 2008/11/20 MH For Debug only, RF */ -+/*------------------------Define local variable------------------------------*/ -+ -+/*----------------------------------------------------------------------------- -+ * Function: PHY_RF6052SetBandwidth() -+ * -+ * Overview: This function is called by SetBWModeCallback8190Pci() only -+ * -+ * Input: struct adapter * Adapter -+ * WIRELESS_BANDWIDTH_E Bandwidth 20M or 40M -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Note: For RF type 0222D -+ *---------------------------------------------------------------------------*/ -+void PHY_RF6052SetBandwidth8723B( -+ struct adapter *Adapter, enum CHANNEL_WIDTH Bandwidth -+) /* 20M or 40M */ -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ switch (Bandwidth) { -+ case CHANNEL_WIDTH_20: -+ pHalData->RfRegChnlVal[0] = ((pHalData->RfRegChnlVal[0] & 0xfffff3ff) | BIT10 | BIT11); -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, pHalData->RfRegChnlVal[0]); -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_B, RF_CHNLBW, bRFRegOffsetMask, pHalData->RfRegChnlVal[0]); -+ break; -+ -+ case CHANNEL_WIDTH_40: -+ pHalData->RfRegChnlVal[0] = ((pHalData->RfRegChnlVal[0] & 0xfffff3ff) | BIT10); -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, pHalData->RfRegChnlVal[0]); -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_B, RF_CHNLBW, bRFRegOffsetMask, pHalData->RfRegChnlVal[0]); -+ break; -+ -+ default: -+ /* RT_TRACE(COMP_DBG, DBG_LOUD, ("PHY_SetRF8225Bandwidth(): unknown Bandwidth: %#X\n", Bandwidth)); */ -+ break; -+ } -+ -+} -+ -+static int phy_RF6052_Config_ParaFile(struct adapter *Adapter) -+{ -+ u32 u4RegValue = 0; -+ u8 eRFPath; -+ struct bb_register_def *pPhyReg; -+ -+ int rtStatus = _SUCCESS; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ static char sz8723RadioAFile[] = RTL8723B_PHY_RADIO_A; -+ static char sz8723RadioBFile[] = RTL8723B_PHY_RADIO_B; -+ static s8 sz8723BTxPwrTrackFile[] = RTL8723B_TXPWR_TRACK; -+ char *pszRadioAFile, *pszRadioBFile, *pszTxPwrTrackFile; -+ -+ pszRadioAFile = sz8723RadioAFile; -+ pszRadioBFile = sz8723RadioBFile; -+ pszTxPwrTrackFile = sz8723BTxPwrTrackFile; -+ -+ /* 3----------------------------------------------------------------- */ -+ /* 3 <2> Initialize RF */ -+ /* 3----------------------------------------------------------------- */ -+ /* for (eRFPath = RF_PATH_A; eRFPath NumTotalRFPath; eRFPath++) */ -+ for (eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) { -+ -+ pPhyReg = &pHalData->PHYRegDef[eRFPath]; -+ -+ /*----Store original RFENV control type----*/ -+ switch (eRFPath) { -+ case RF_PATH_A: -+ case RF_PATH_C: -+ u4RegValue = PHY_QueryBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV); -+ break; -+ case RF_PATH_B: -+ case RF_PATH_D: -+ u4RegValue = PHY_QueryBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV<<16); -+ break; -+ } -+ -+ /*----Set RF_ENV enable----*/ -+ PHY_SetBBReg(Adapter, pPhyReg->rfintfe, bRFSI_RFENV<<16, 0x1); -+ udelay(1);/* PlatformStallExecution(1); */ -+ -+ /*----Set RF_ENV output high----*/ -+ PHY_SetBBReg(Adapter, pPhyReg->rfintfo, bRFSI_RFENV, 0x1); -+ udelay(1);/* PlatformStallExecution(1); */ -+ -+ /* Set bit number of Address and Data for RF register */ -+ PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, b3WireAddressLength, 0x0); /* Set 1 to 4 bits for 8255 */ -+ udelay(1);/* PlatformStallExecution(1); */ -+ -+ PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, b3WireDataLength, 0x0); /* Set 0 to 12 bits for 8255 */ -+ udelay(1);/* PlatformStallExecution(1); */ -+ -+ /*----Initialize RF fom connfiguration file----*/ -+ switch (eRFPath) { -+ case RF_PATH_A: -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (PHY_ConfigRFWithParaFile(Adapter, pszRadioAFile, eRFPath) == _FAIL) -+#endif -+ { -+ if (HAL_STATUS_FAILURE == ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv, CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) -+ rtStatus = _FAIL; -+ } -+ break; -+ case RF_PATH_B: -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (PHY_ConfigRFWithParaFile(Adapter, pszRadioBFile, eRFPath) == _FAIL) -+#endif -+ { -+ if (HAL_STATUS_FAILURE == ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv, CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) -+ rtStatus = _FAIL; -+ } -+ break; -+ case RF_PATH_C: -+ break; -+ case RF_PATH_D: -+ break; -+ } -+ -+ /*----Restore RFENV control type----*/; -+ switch (eRFPath) { -+ case RF_PATH_A: -+ case RF_PATH_C: -+ PHY_SetBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV, u4RegValue); -+ break; -+ case RF_PATH_B: -+ case RF_PATH_D: -+ PHY_SetBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV<<16, u4RegValue); -+ break; -+ } -+ -+ if (rtStatus != _SUCCESS) { -+ /* RT_TRACE(COMP_FPGA, DBG_LOUD, ("phy_RF6052_Config_ParaFile():Radio[%d] Fail!!", eRFPath)); */ -+ goto phy_RF6052_Config_ParaFile_Fail; -+ } -+ -+ } -+ -+ /* 3 ----------------------------------------------------------------- */ -+ /* 3 Configuration of Tx Power Tracking */ -+ /* 3 ----------------------------------------------------------------- */ -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (PHY_ConfigRFWithTxPwrTrackParaFile(Adapter, pszTxPwrTrackFile) == _FAIL) -+#endif -+ { -+ ODM_ConfigRFWithTxPwrTrackHeaderFile(&pHalData->odmpriv); -+ } -+ -+ /* RT_TRACE(COMP_INIT, DBG_LOUD, ("<---phy_RF6052_Config_ParaFile()\n")); */ -+ return rtStatus; -+ -+phy_RF6052_Config_ParaFile_Fail: -+ return rtStatus; -+} -+ -+ -+int PHY_RF6052_Config8723B(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ int rtStatus = _SUCCESS; -+ -+ /* */ -+ /* Initialize general global value */ -+ /* */ -+ /* TODO: Extend RF_PATH_C and RF_PATH_D in the future */ -+ if (pHalData->rf_type == RF_1T1R) -+ pHalData->NumTotalRFPath = 1; -+ else -+ pHalData->NumTotalRFPath = 2; -+ -+ /* */ -+ /* Config BB and RF */ -+ /* */ -+ rtStatus = phy_RF6052_Config_ParaFile(Adapter); -+ return rtStatus; -+ -+} -+ -+/* End of HalRf6052.c */ -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/rtl8723b_rxdesc.c linux/3rdparty/rtl8723bs/hal/rtl8723b_rxdesc.c ---- linux.old/3rdparty/rtl8723bs/hal/rtl8723b_rxdesc.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/rtl8723b_rxdesc.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,86 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8723B_REDESC_C_ -+ -+#include -+ -+static void process_rssi(struct adapter *padapter, union recv_frame *prframe) -+{ -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ struct signal_stat *signal_stat = &padapter->recvpriv.signal_strength_data; -+ -+ /* DBG_8192C("process_rssi => pattrib->rssil(%d) signal_strength(%d)\n ", pattrib->RecvSignalPower, pattrib->signal_strength); */ -+ /* if (pRfd->Status.bPacketToSelf || pRfd->Status.bPacketBeacon) */ -+ { -+ if (signal_stat->update_req) { -+ signal_stat->total_num = 0; -+ signal_stat->total_val = 0; -+ signal_stat->update_req = 0; -+ } -+ -+ signal_stat->total_num++; -+ signal_stat->total_val += pattrib->phy_info.SignalStrength; -+ signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; -+ } -+ -+} /* Process_UI_RSSI_8192C */ -+ -+static void process_link_qual(struct adapter *padapter, union recv_frame *prframe) -+{ -+ struct rx_pkt_attrib *pattrib; -+ struct signal_stat *signal_stat; -+ -+ if (prframe == NULL || padapter == NULL) -+ return; -+ -+ pattrib = &prframe->u.hdr.attrib; -+ signal_stat = &padapter->recvpriv.signal_qual_data; -+ -+ /* DBG_8192C("process_link_qual => pattrib->signal_qual(%d)\n ", pattrib->signal_qual); */ -+ -+ if (signal_stat->update_req) { -+ signal_stat->total_num = 0; -+ signal_stat->total_val = 0; -+ signal_stat->update_req = 0; -+ } -+ -+ signal_stat->total_num++; -+ signal_stat->total_val += pattrib->phy_info.SignalQuality; -+ signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; -+} /* Process_UiLinkQuality8192S */ -+ -+ -+void rtl8723b_process_phy_info(struct adapter *padapter, void *prframe) -+{ -+ union recv_frame *precvframe = (union recv_frame *)prframe; -+ /* */ -+ /* Check RSSI */ -+ /* */ -+ process_rssi(padapter, precvframe); -+ /* */ -+ /* Check PWDB. */ -+ /* */ -+ /* process_PWDB(padapter, precvframe); */ -+ -+ /* UpdateRxSignalStatistics8192C(Adapter, pRfd); */ -+ /* */ -+ /* Check EVM */ -+ /* */ -+ process_link_qual(padapter, precvframe); -+ #ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ rtw_store_phy_info(padapter, prframe); -+ #endif -+ -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/rtl8723bs_recv.c linux/3rdparty/rtl8723bs/hal/rtl8723bs_recv.c ---- linux.old/3rdparty/rtl8723bs/hal/rtl8723bs_recv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/rtl8723bs_recv.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,490 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8723BS_RECV_C_ -+ -+#include -+#include -+#include -+ -+ -+static s32 initrecvbuf(struct recv_buf *precvbuf, struct adapter *padapter) -+{ -+ INIT_LIST_HEAD(&precvbuf->list); -+ spin_lock_init(&precvbuf->recvbuf_lock); -+ -+ precvbuf->adapter = padapter; -+ -+ return _SUCCESS; -+} -+ -+static void update_recvframe_attrib( -+ struct adapter *padapter, union recv_frame *precvframe, struct recv_stat *prxstat -+) -+{ -+ struct rx_pkt_attrib *pattrib; -+ struct recv_stat report; -+ PRXREPORT prxreport = (PRXREPORT)&report; -+ -+ report.rxdw0 = prxstat->rxdw0; -+ report.rxdw1 = prxstat->rxdw1; -+ report.rxdw2 = prxstat->rxdw2; -+ report.rxdw3 = prxstat->rxdw3; -+ report.rxdw4 = prxstat->rxdw4; -+ report.rxdw5 = prxstat->rxdw5; -+ -+ pattrib = &precvframe->u.hdr.attrib; -+ memset(pattrib, 0, sizeof(struct rx_pkt_attrib)); -+ -+ /* update rx report to recv_frame attribute */ -+ pattrib->pkt_rpt_type = prxreport->c2h_ind?C2H_PACKET:NORMAL_RX; -+/* DBG_871X("%s: pkt_rpt_type =%d\n", __func__, pattrib->pkt_rpt_type); */ -+ -+ if (pattrib->pkt_rpt_type == NORMAL_RX) { -+ /* Normal rx packet */ -+ /* update rx report to recv_frame attribute */ -+ pattrib->pkt_len = (u16)prxreport->pktlen; -+ pattrib->drvinfo_sz = (u8)(prxreport->drvinfosize << 3); -+ pattrib->physt = (u8)prxreport->physt; -+ -+ pattrib->crc_err = (u8)prxreport->crc32; -+ pattrib->icv_err = (u8)prxreport->icverr; -+ -+ pattrib->bdecrypted = (u8)(prxreport->swdec ? 0 : 1); -+ pattrib->encrypt = (u8)prxreport->security; -+ -+ pattrib->qos = (u8)prxreport->qos; -+ pattrib->priority = (u8)prxreport->tid; -+ -+ pattrib->amsdu = (u8)prxreport->amsdu; -+ -+ pattrib->seq_num = (u16)prxreport->seq; -+ pattrib->frag_num = (u8)prxreport->frag; -+ pattrib->mfrag = (u8)prxreport->mf; -+ pattrib->mdata = (u8)prxreport->md; -+ -+ pattrib->data_rate = (u8)prxreport->rx_rate; -+ } else -+ pattrib->pkt_len = (u16)prxreport->pktlen; -+} -+ -+/* -+ * Notice: -+ *Before calling this function, -+ *precvframe->u.hdr.rx_data should be ready! -+ */ -+static void update_recvframe_phyinfo( -+ union recv_frame *precvframe, struct phy_stat *pphy_status -+) -+{ -+ struct adapter *padapter = precvframe->u.hdr.adapter; -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PODM_PHY_INFO_T pPHYInfo = (PODM_PHY_INFO_T)(&pattrib->phy_info); -+ -+ u8 *wlanhdr; -+ ODM_PACKET_INFO_T pkt_info; -+ u8 *sa = NULL; -+ /* _irqL irqL; */ -+ struct sta_priv *pstapriv; -+ struct sta_info *psta; -+ -+ pkt_info.bPacketMatchBSSID = false; -+ pkt_info.bPacketToSelf = false; -+ pkt_info.bPacketBeacon = false; -+ -+ -+ wlanhdr = get_recvframe_data(precvframe); -+ -+ pkt_info.bPacketMatchBSSID = ((!IsFrameTypeCtrl(wlanhdr)) && -+ !pattrib->icv_err && !pattrib->crc_err && -+ !memcmp(get_hdr_bssid(wlanhdr), get_bssid(&padapter->mlmepriv), ETH_ALEN)); -+ -+ pkt_info.bPacketToSelf = pkt_info.bPacketMatchBSSID && (!memcmp(get_ra(wlanhdr), myid(&padapter->eeprompriv), ETH_ALEN)); -+ -+ pkt_info.bPacketBeacon = pkt_info.bPacketMatchBSSID && (GetFrameSubType(wlanhdr) == WIFI_BEACON); -+ -+ sa = get_ta(wlanhdr); -+ -+ pkt_info.StationID = 0xFF; -+ -+ pstapriv = &padapter->stapriv; -+ psta = rtw_get_stainfo(pstapriv, sa); -+ if (psta) { -+ pkt_info.StationID = psta->mac_id; -+ /* DBG_8192C("%s ==> StationID(%d)\n", __func__, pkt_info.StationID); */ -+ } -+ pkt_info.DataRate = pattrib->data_rate; -+ -+ /* rtl8723b_query_rx_phy_status(precvframe, pphy_status); */ -+ /* spin_lock_bh(&pHalData->odm_stainfo_lock); */ -+ ODM_PhyStatusQuery(&pHalData->odmpriv, pPHYInfo, (u8 *)pphy_status, &(pkt_info)); -+ if (psta) -+ psta->rssi = pattrib->phy_info.RecvSignalPower; -+ /* spin_unlock_bh(&pHalData->odm_stainfo_lock); */ -+ precvframe->u.hdr.psta = NULL; -+ if ( -+ pkt_info.bPacketMatchBSSID && -+ (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == true) -+ ) { -+ if (psta) { -+ precvframe->u.hdr.psta = psta; -+ rtl8723b_process_phy_info(padapter, precvframe); -+ } -+ } else if (pkt_info.bPacketToSelf || pkt_info.bPacketBeacon) { -+ if (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE) == true) -+ if (psta) -+ precvframe->u.hdr.psta = psta; -+ rtl8723b_process_phy_info(padapter, precvframe); -+ } -+} -+ -+static void rtl8723bs_c2h_packet_handler(struct adapter *padapter, u8 *pbuf, u16 length) -+{ -+ u8 *tmpBuf = NULL; -+ u8 res = false; -+ -+ if (length == 0) -+ return; -+ -+ /* DBG_871X("+%s() length =%d\n", __func__, length); */ -+ -+ tmpBuf = rtw_zmalloc(length); -+ if (tmpBuf == NULL) -+ return; -+ -+ memcpy(tmpBuf, pbuf, length); -+ -+ res = rtw_c2h_packet_wk_cmd(padapter, tmpBuf, length); -+ -+ if (res == false) -+ kfree(tmpBuf); -+ -+ /* DBG_871X("-%s res(%d)\n", __func__, res); */ -+ -+ return; -+} -+ -+static void rtl8723bs_recv_tasklet(void *priv) -+{ -+ struct adapter *padapter; -+ struct hal_com_data *pHalData; -+ struct recv_priv *precvpriv; -+ struct recv_buf *precvbuf; -+ union recv_frame *precvframe; -+ struct rx_pkt_attrib *pattrib; -+ u8 *ptr; -+ u32 pkt_offset, skb_len, alloc_sz; -+ _pkt *pkt_copy = NULL; -+ u8 shift_sz = 0, rx_report_sz = 0; -+ -+ -+ padapter = (struct adapter *)priv; -+ pHalData = GET_HAL_DATA(padapter); -+ precvpriv = &padapter->recvpriv; -+ -+ do { -+ precvbuf = rtw_dequeue_recvbuf(&precvpriv->recv_buf_pending_queue); -+ if (NULL == precvbuf) -+ break; -+ -+ ptr = precvbuf->pdata; -+ -+ while (ptr < precvbuf->ptail) { -+ precvframe = rtw_alloc_recvframe(&precvpriv->free_recv_queue); -+ if (precvframe == NULL) { -+ DBG_8192C("%s: no enough recv frame!\n", __func__); -+ rtw_enqueue_recvbuf_to_head(precvbuf, &precvpriv->recv_buf_pending_queue); -+ -+ /* The case of can't allocte recvframe should be temporary, */ -+ /* schedule again and hope recvframe is available next time. */ -+ tasklet_schedule(&precvpriv->recv_tasklet); -+ return; -+ } -+ -+ /* rx desc parsing */ -+ update_recvframe_attrib(padapter, precvframe, (struct recv_stat *)ptr); -+ -+ pattrib = &precvframe->u.hdr.attrib; -+ -+ /* fix Hardware RX data error, drop whole recv_buffer */ -+ if ((!(pHalData->ReceiveConfig & RCR_ACRC32)) && pattrib->crc_err) { -+ DBG_8192C("%s()-%d: RX Warning! rx CRC ERROR !!\n", __func__, __LINE__); -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ break; -+ } -+ -+ rx_report_sz = RXDESC_SIZE + pattrib->drvinfo_sz; -+ pkt_offset = rx_report_sz + pattrib->shift_sz + pattrib->pkt_len; -+ -+ if ((ptr + pkt_offset) > precvbuf->ptail) { -+ DBG_8192C("%s()-%d: : next pkt len(%p,%d) exceed ptail(%p)!\n", __func__, __LINE__, ptr, pkt_offset, precvbuf->ptail); -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ break; -+ } -+ -+ if ((pattrib->crc_err) || (pattrib->icv_err)) { -+ { -+ DBG_8192C("%s: crc_err =%d icv_err =%d, skip!\n", __func__, pattrib->crc_err, pattrib->icv_err); -+ } -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ } else { -+ /* Modified by Albert 20101213 */ -+ /* For 8 bytes IP header alignment. */ -+ if (pattrib->qos) /* Qos data, wireless lan header length is 26 */ -+ shift_sz = 6; -+ else -+ shift_sz = 0; -+ -+ skb_len = pattrib->pkt_len; -+ -+ /* for first fragment packet, driver need allocate 1536+drvinfo_sz+RXDESC_SIZE to defrag packet. */ -+ /* modify alloc_sz for recvive crc error packet by thomas 2011-06-02 */ -+ if ((pattrib->mfrag == 1) && (pattrib->frag_num == 0)) { -+ if (skb_len <= 1650) -+ alloc_sz = 1664; -+ else -+ alloc_sz = skb_len + 14; -+ } else { -+ alloc_sz = skb_len; -+ /* 6 is for IP header 8 bytes alignment in QoS packet case. */ -+ /* 8 is for skb->data 4 bytes alignment. */ -+ alloc_sz += 14; -+ } -+ -+ pkt_copy = rtw_skb_alloc(alloc_sz); -+ -+ if (pkt_copy) { -+ pkt_copy->dev = padapter->pnetdev; -+ precvframe->u.hdr.pkt = pkt_copy; -+ skb_reserve(pkt_copy, 8 - ((SIZE_PTR)(pkt_copy->data) & 7));/* force pkt_copy->data at 8-byte alignment address */ -+ skb_reserve(pkt_copy, shift_sz);/* force ip_hdr at 8-byte alignment address according to shift_sz. */ -+ memcpy(pkt_copy->data, (ptr + rx_report_sz + pattrib->shift_sz), skb_len); -+ precvframe->u.hdr.rx_head = pkt_copy->head; -+ precvframe->u.hdr.rx_data = precvframe->u.hdr.rx_tail = pkt_copy->data; -+ precvframe->u.hdr.rx_end = skb_end_pointer(pkt_copy); -+ } else { -+ if ((pattrib->mfrag == 1) && (pattrib->frag_num == 0)) { -+ DBG_8192C("%s: alloc_skb fail, drop frag frame\n", __func__); -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ break; -+ } -+ -+ precvframe->u.hdr.pkt = rtw_skb_clone(precvbuf->pskb); -+ if (precvframe->u.hdr.pkt) { -+ _pkt *pkt_clone = precvframe->u.hdr.pkt; -+ -+ pkt_clone->data = ptr + rx_report_sz + pattrib->shift_sz; -+ skb_reset_tail_pointer(pkt_clone); -+ precvframe->u.hdr.rx_head = precvframe->u.hdr.rx_data = precvframe->u.hdr.rx_tail -+ = pkt_clone->data; -+ precvframe->u.hdr.rx_end = pkt_clone->data + skb_len; -+ } else { -+ DBG_8192C("%s: rtw_skb_clone fail\n", __func__); -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ break; -+ } -+ } -+ -+ recvframe_put(precvframe, skb_len); -+ /* recvframe_pull(precvframe, drvinfo_sz + RXDESC_SIZE); */ -+ -+ if (pHalData->ReceiveConfig & RCR_APPFCS) -+ recvframe_pull_tail(precvframe, IEEE80211_FCS_LEN); -+ -+ /* move to drv info position */ -+ ptr += RXDESC_SIZE; -+ -+ /* update drv info */ -+ if (pHalData->ReceiveConfig & RCR_APP_BA_SSN) { -+ /* rtl8723s_update_bassn(padapter, pdrvinfo); */ -+ ptr += 4; -+ } -+ -+ if (pattrib->pkt_rpt_type == NORMAL_RX) { /* Normal rx packet */ -+ if (pattrib->physt) -+ update_recvframe_phyinfo(precvframe, (struct phy_stat *)ptr); -+ -+ if (rtw_recv_entry(precvframe) != _SUCCESS) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_dump_, ("%s: rtw_recv_entry(precvframe) != _SUCCESS\n", __func__)); -+ } -+ } else if (pattrib->pkt_rpt_type == C2H_PACKET) { -+ C2H_EVT_HDR C2hEvent; -+ -+ u16 len_c2h = pattrib->pkt_len; -+ u8 *pbuf_c2h = precvframe->u.hdr.rx_data; -+ u8 *pdata_c2h; -+ -+ C2hEvent.CmdID = pbuf_c2h[0]; -+ C2hEvent.CmdSeq = pbuf_c2h[1]; -+ C2hEvent.CmdLen = (len_c2h-2); -+ pdata_c2h = pbuf_c2h+2; -+ -+ if (C2hEvent.CmdID == C2H_CCX_TX_RPT) -+ CCX_FwC2HTxRpt_8723b(padapter, pdata_c2h, C2hEvent.CmdLen); -+ else -+ rtl8723bs_c2h_packet_handler(padapter, precvframe->u.hdr.rx_data, pattrib->pkt_len); -+ -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ -+ } -+ } -+ -+ pkt_offset = _RND8(pkt_offset); -+ precvbuf->pdata += pkt_offset; -+ ptr = precvbuf->pdata; -+ precvframe = NULL; -+ pkt_copy = NULL; -+ } -+ -+ rtw_enqueue_recvbuf(precvbuf, &precvpriv->free_recv_buf_queue); -+ } while (1); -+ -+} -+ -+/* -+ * Initialize recv private variable for hardware dependent -+ * 1. recv buf -+ * 2. recv tasklet -+ * -+ */ -+s32 rtl8723bs_init_recv_priv(struct adapter *padapter) -+{ -+ s32 res; -+ u32 i, n; -+ struct recv_priv *precvpriv; -+ struct recv_buf *precvbuf; -+ -+ -+ res = _SUCCESS; -+ precvpriv = &padapter->recvpriv; -+ -+ /* 3 1. init recv buffer */ -+ _rtw_init_queue(&precvpriv->free_recv_buf_queue); -+ _rtw_init_queue(&precvpriv->recv_buf_pending_queue); -+ -+ n = NR_RECVBUFF * sizeof(struct recv_buf) + 4; -+ precvpriv->pallocated_recv_buf = rtw_zmalloc(n); -+ if (precvpriv->pallocated_recv_buf == NULL) { -+ res = _FAIL; -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("alloc recv_buf fail!\n")); -+ goto exit; -+ } -+ -+ precvpriv->precv_buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(precvpriv->pallocated_recv_buf), 4); -+ -+ /* init each recv buffer */ -+ precvbuf = (struct recv_buf *)precvpriv->precv_buf; -+ for (i = 0; i < NR_RECVBUFF; i++) { -+ res = initrecvbuf(precvbuf, padapter); -+ if (res == _FAIL) -+ break; -+ -+ if (precvbuf->pskb == NULL) { -+ SIZE_PTR tmpaddr = 0; -+ SIZE_PTR alignment = 0; -+ -+ precvbuf->pskb = rtw_skb_alloc(MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ); -+ -+ if (precvbuf->pskb) { -+ precvbuf->pskb->dev = padapter->pnetdev; -+ -+ tmpaddr = (SIZE_PTR)precvbuf->pskb->data; -+ alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1); -+ skb_reserve(precvbuf->pskb, (RECVBUFF_ALIGN_SZ - alignment)); -+ } -+ -+ if (precvbuf->pskb == NULL) { -+ DBG_871X("%s: alloc_skb fail!\n", __func__); -+ } -+ } -+ -+ list_add_tail(&precvbuf->list, &precvpriv->free_recv_buf_queue.queue); -+ -+ precvbuf++; -+ } -+ precvpriv->free_recv_buf_queue_cnt = i; -+ -+ if (res == _FAIL) -+ goto initbuferror; -+ -+ /* 3 2. init tasklet */ -+ tasklet_init( -+ &precvpriv->recv_tasklet, -+ (void(*)(unsigned long))rtl8723bs_recv_tasklet, -+ (unsigned long)padapter -+ ); -+ -+ goto exit; -+ -+initbuferror: -+ precvbuf = (struct recv_buf *)precvpriv->precv_buf; -+ if (precvbuf) { -+ n = precvpriv->free_recv_buf_queue_cnt; -+ precvpriv->free_recv_buf_queue_cnt = 0; -+ for (i = 0; i < n ; i++) { -+ list_del_init(&precvbuf->list); -+ rtw_os_recvbuf_resource_free(padapter, precvbuf); -+ precvbuf++; -+ } -+ precvpriv->precv_buf = NULL; -+ } -+ -+ if (precvpriv->pallocated_recv_buf) { -+ n = NR_RECVBUFF * sizeof(struct recv_buf) + 4; -+ kfree(precvpriv->pallocated_recv_buf); -+ precvpriv->pallocated_recv_buf = NULL; -+ } -+ -+exit: -+ return res; -+} -+ -+/* -+ * Free recv private variable of hardware dependent -+ * 1. recv buf -+ * 2. recv tasklet -+ * -+ */ -+void rtl8723bs_free_recv_priv(struct adapter *padapter) -+{ -+ u32 i, n; -+ struct recv_priv *precvpriv; -+ struct recv_buf *precvbuf; -+ -+ -+ precvpriv = &padapter->recvpriv; -+ -+ /* 3 1. kill tasklet */ -+ tasklet_kill(&precvpriv->recv_tasklet); -+ -+ /* 3 2. free all recv buffers */ -+ precvbuf = (struct recv_buf *)precvpriv->precv_buf; -+ if (precvbuf) { -+ n = NR_RECVBUFF; -+ precvpriv->free_recv_buf_queue_cnt = 0; -+ for (i = 0; i < n ; i++) { -+ list_del_init(&precvbuf->list); -+ rtw_os_recvbuf_resource_free(padapter, precvbuf); -+ precvbuf++; -+ } -+ precvpriv->precv_buf = NULL; -+ } -+ -+ if (precvpriv->pallocated_recv_buf) { -+ n = NR_RECVBUFF * sizeof(struct recv_buf) + 4; -+ kfree(precvpriv->pallocated_recv_buf); -+ precvpriv->pallocated_recv_buf = NULL; -+ } -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/rtl8723bs_xmit.c linux/3rdparty/rtl8723bs/hal/rtl8723bs_xmit.c ---- linux.old/3rdparty/rtl8723bs/hal/rtl8723bs_xmit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/rtl8723bs_xmit.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,686 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8723BS_XMIT_C_ -+ -+#include -+#include -+#include -+ -+static u8 rtw_sdio_wait_enough_TxOQT_space(struct adapter *padapter, u8 agg_num) -+{ -+ u32 n = 0; -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+ while (pHalData->SdioTxOQTFreeSpace < agg_num) -+ { -+ if ( -+ (padapter->bSurpriseRemoved == true) || -+ (padapter->bDriverStopped == true) -+ ) { -+ DBG_871X("%s: bSurpriseRemoved or bDriverStopped (wait TxOQT)\n", __func__); -+ return false; -+ } -+ -+ HalQueryTxOQTBufferStatus8723BSdio(padapter); -+ -+ if ((++n % 60) == 0) { -+ if ((n % 300) == 0) { -+ DBG_871X("%s(%d): QOT free space(%d), agg_num: %d\n", -+ __func__, n, pHalData->SdioTxOQTFreeSpace, agg_num); -+ } -+ msleep(1); -+ /* yield(); */ -+ } -+ } -+ -+ pHalData->SdioTxOQTFreeSpace -= agg_num; -+ -+ /* if (n > 1) */ -+ /* ++priv->pshare->nr_out_of_txoqt_space; */ -+ -+ return true; -+} -+ -+static s32 rtl8723_dequeue_writeport(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct xmit_buf *pxmitbuf; -+ struct adapter * pri_padapter = padapter; -+ s32 ret = 0; -+ u8 PageIdx = 0; -+ u32 deviceId; -+ u8 bUpdatePageNum = false; -+ -+ ret = ret || check_fwstate(pmlmepriv, _FW_UNDER_SURVEY); -+ -+ if (true == ret) -+ pxmitbuf = dequeue_pending_xmitbuf_under_survey(pxmitpriv); -+ else -+ pxmitbuf = dequeue_pending_xmitbuf(pxmitpriv); -+ -+ if (pxmitbuf == NULL) -+ return true; -+ -+ deviceId = ffaddr2deviceId(pdvobjpriv, pxmitbuf->ff_hwaddr); -+ -+ /* translate fifo addr to queue index */ -+ switch (deviceId) { -+ case WLAN_TX_HIQ_DEVICE_ID: -+ PageIdx = HI_QUEUE_IDX; -+ break; -+ -+ case WLAN_TX_MIQ_DEVICE_ID: -+ PageIdx = MID_QUEUE_IDX; -+ break; -+ -+ case WLAN_TX_LOQ_DEVICE_ID: -+ PageIdx = LOW_QUEUE_IDX; -+ break; -+ } -+ -+query_free_page: -+ /* check if hardware tx fifo page is enough */ -+ if (false == rtw_hal_sdio_query_tx_freepage(pri_padapter, PageIdx, pxmitbuf->pg_num)) { -+ if (!bUpdatePageNum) { -+ /* Total number of page is NOT available, so update current FIFO status */ -+ HalQueryTxBufferStatus8723BSdio(padapter); -+ bUpdatePageNum = true; -+ goto query_free_page; -+ } else { -+ bUpdatePageNum = false; -+ enqueue_pending_xmitbuf_to_head(pxmitpriv, pxmitbuf); -+ return true; -+ } -+ } -+ -+ if ( -+ (padapter->bSurpriseRemoved == true) || -+ (padapter->bDriverStopped == true) -+ ) { -+ RT_TRACE( -+ _module_hal_xmit_c_, -+ _drv_notice_, -+ ("%s: bSurpriseRemoved(wirte port)\n", __func__) -+ ); -+ goto free_xmitbuf; -+ } -+ -+ if (rtw_sdio_wait_enough_TxOQT_space(padapter, pxmitbuf->agg_num) == false) -+ goto free_xmitbuf; -+ -+ traffic_check_for_leave_lps(padapter, true, pxmitbuf->agg_num); -+ -+ rtw_write_port(padapter, deviceId, pxmitbuf->len, (u8 *)pxmitbuf); -+ -+ rtw_hal_sdio_update_tx_freepage(pri_padapter, PageIdx, pxmitbuf->pg_num); -+ -+free_xmitbuf: -+ /* rtw_free_xmitframe(pxmitpriv, pframe); */ -+ /* pxmitbuf->priv_data = NULL; */ -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ -+#ifdef CONFIG_SDIO_TX_TASKLET -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+#endif -+ -+ return _FAIL; -+} -+ -+/* -+ * Description -+ *Transmit xmitbuf to hardware tx fifo -+ * -+ * Return -+ *_SUCCESS ok -+ *_FAIL something error -+ */ -+s32 rtl8723bs_xmit_buf_handler(struct adapter *padapter) -+{ -+ struct xmit_priv *pxmitpriv; -+ u8 queue_empty, queue_pending; -+ s32 ret; -+ -+ -+ pxmitpriv = &padapter->xmitpriv; -+ -+ if (down_interruptible(&pxmitpriv->xmit_sema)) { -+ DBG_871X_LEVEL(_drv_emerg_, "%s: down SdioXmitBufSema fail!\n", __func__); -+ return _FAIL; -+ } -+ -+ ret = (padapter->bDriverStopped == true) || (padapter->bSurpriseRemoved == true); -+ if (ret) { -+ RT_TRACE( -+ _module_hal_xmit_c_, -+ _drv_err_, -+ ( -+ "%s: bDriverStopped(%d) bSurpriseRemoved(%d)!\n", -+ __func__, -+ padapter->bDriverStopped, -+ padapter->bSurpriseRemoved -+ ) -+ ); -+ return _FAIL; -+ } -+ -+ queue_pending = check_pending_xmitbuf(pxmitpriv); -+ -+ if (queue_pending == false) -+ return _SUCCESS; -+ -+ ret = rtw_register_tx_alive(padapter); -+ if (ret != _SUCCESS) { -+ return _SUCCESS; -+ } -+ -+ do { -+ queue_empty = rtl8723_dequeue_writeport(padapter); -+/* dump secondary adapter xmitbuf */ -+ } while (!queue_empty); -+ -+ rtw_unregister_tx_alive(padapter); -+ -+ return _SUCCESS; -+} -+ -+/* -+ * Description: -+ *Aggregation packets and send to hardware -+ * -+ * Return: -+ *0 Success -+ *-1 Hardware resource(TX FIFO) not ready -+ *-2 Software resource(xmitbuf) not ready -+ */ -+static s32 xmit_xmitframes(struct adapter *padapter, struct xmit_priv *pxmitpriv) -+{ -+ s32 err, ret; -+ u32 k = 0; -+ struct hw_xmit *hwxmits, *phwxmit; -+ u8 no_res, idx, hwentry; -+ struct tx_servq *ptxservq; -+ struct list_head *sta_plist, *sta_phead, *frame_plist, *frame_phead; -+ struct xmit_frame *pxmitframe; -+ struct __queue *pframe_queue; -+ struct xmit_buf *pxmitbuf; -+ u32 txlen, max_xmit_len; -+ u8 txdesc_size = TXDESC_SIZE; -+ int inx[4]; -+ -+ err = 0; -+ no_res = false; -+ hwxmits = pxmitpriv->hwxmits; -+ hwentry = pxmitpriv->hwxmit_entry; -+ ptxservq = NULL; -+ pxmitframe = NULL; -+ pframe_queue = NULL; -+ pxmitbuf = NULL; -+ -+ if (padapter->registrypriv.wifi_spec == 1) { -+ for (idx = 0; idx<4; idx++) -+ inx[idx] = pxmitpriv->wmm_para_seq[idx]; -+ } else { -+ inx[0] = 0; -+ inx[1] = 1; -+ inx[2] = 2; -+ inx[3] = 3; -+ } -+ -+ /* 0(VO), 1(VI), 2(BE), 3(BK) */ -+ for (idx = 0; idx < hwentry; idx++) { -+ phwxmit = hwxmits + inx[idx]; -+ -+ if ( -+ (check_pending_xmitbuf(pxmitpriv) == true) && -+ (padapter->mlmepriv.LinkDetectInfo.bHigherBusyTxTraffic == true) -+ ) { -+ if ((phwxmit->accnt > 0) && (phwxmit->accnt < 5)) { -+ err = -2; -+ break; -+ } -+ } -+ -+ max_xmit_len = rtw_hal_get_sdio_tx_max_length(padapter, inx[idx]); -+ -+ spin_lock_bh(&pxmitpriv->lock); -+ -+ sta_phead = get_list_head(phwxmit->sta_queue); -+ sta_plist = get_next(sta_phead); -+ /* because stop_sta_xmit may delete sta_plist at any time */ -+ /* so we should add lock here, or while loop can not exit */ -+ while (sta_phead != sta_plist) { -+ ptxservq = LIST_CONTAINOR(sta_plist, struct tx_servq, tx_pending); -+ sta_plist = get_next(sta_plist); -+ -+#ifdef DBG_XMIT_BUF -+ DBG_871X( -+ "%s idx:%d hwxmit_pkt_num:%d ptxservq_pkt_num:%d\n", -+ __func__, -+ idx, -+ phwxmit->accnt, -+ ptxservq->qcnt -+ ); -+ DBG_871X( -+ "%s free_xmit_extbuf_cnt =%d free_xmitbuf_cnt =%d free_xmitframe_cnt =%d\n", -+ __func__, -+ pxmitpriv->free_xmit_extbuf_cnt, -+ pxmitpriv->free_xmitbuf_cnt, -+ pxmitpriv->free_xmitframe_cnt -+ ); -+#endif -+ pframe_queue = &ptxservq->sta_pending; -+ -+ frame_phead = get_list_head(pframe_queue); -+ -+ while (list_empty(frame_phead) == false) { -+ frame_plist = get_next(frame_phead); -+ pxmitframe = LIST_CONTAINOR(frame_plist, struct xmit_frame, list); -+ -+ /* check xmit_buf size enough or not */ -+ txlen = txdesc_size + rtw_wlan_pkt_size(pxmitframe); -+ if ( -+ (NULL == pxmitbuf) || -+ ((_RND(pxmitbuf->len, 8) + txlen) > max_xmit_len) || -+ (k >= (rtw_hal_sdio_max_txoqt_free_space(padapter)-1)) -+ ) { -+ if (pxmitbuf) { -+ /* pxmitbuf->priv_data will be NULL, and will crash here */ -+ if (pxmitbuf->len > 0 && pxmitbuf->priv_data) { -+ struct xmit_frame *pframe; -+ pframe = (struct xmit_frame*)pxmitbuf->priv_data; -+ pframe->agg_num = k; -+ pxmitbuf->agg_num = k; -+ rtl8723b_update_txdesc(pframe, pframe->buf_addr); -+ rtw_free_xmitframe(pxmitpriv, pframe); -+ pxmitbuf->priv_data = NULL; -+ enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf); -+ /* can not yield under lock */ -+ /* yield(); */ -+ } else -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ } -+ -+ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); -+ if (pxmitbuf == NULL) { -+#ifdef DBG_XMIT_BUF -+ DBG_871X_LEVEL(_drv_err_, "%s: xmit_buf is not enough!\n", __func__); -+#endif -+ err = -2; -+ up(&(pxmitpriv->xmit_sema)); -+ break; -+ } -+ k = 0; -+ } -+ -+ /* ok to send, remove frame from queue */ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == true) { -+ if ( -+ (pxmitframe->attrib.psta->state & WIFI_SLEEP_STATE) && -+ (pxmitframe->attrib.triggered == 0) -+ ) { -+ DBG_871X( -+ "%s: one not triggered pkt in queue when this STA sleep," -+ " break and goto next sta\n", -+ __func__ -+ ); -+ break; -+ } -+ } -+ -+ list_del_init(&pxmitframe->list); -+ ptxservq->qcnt--; -+ phwxmit->accnt--; -+ -+ if (k == 0) { -+ pxmitbuf->ff_hwaddr = rtw_get_ff_hwaddr(pxmitframe); -+ pxmitbuf->priv_data = (u8 *)pxmitframe; -+ } -+ -+ /* coalesce the xmitframe to xmitbuf */ -+ pxmitframe->pxmitbuf = pxmitbuf; -+ pxmitframe->buf_addr = pxmitbuf->ptail; -+ -+ ret = rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe); -+ if (ret == _FAIL) { -+ DBG_871X_LEVEL(_drv_err_, "%s: coalesce FAIL!", __func__); -+ /* Todo: error handler */ -+ } else { -+ k++; -+ if (k != 1) -+ rtl8723b_update_txdesc(pxmitframe, pxmitframe->buf_addr); -+ rtw_count_tx_stats(padapter, pxmitframe, pxmitframe->attrib.last_txcmdsz); -+ -+ txlen = txdesc_size + pxmitframe->attrib.last_txcmdsz; -+ pxmitframe->pg_num = (txlen + 127)/128; -+ pxmitbuf->pg_num += (txlen + 127)/128; -+ /* if (k != 1) */ -+ /* ((struct xmit_frame*)pxmitbuf->priv_data)->pg_num += pxmitframe->pg_num; */ -+ pxmitbuf->ptail += _RND(txlen, 8); /* round to 8 bytes alignment */ -+ pxmitbuf->len = _RND(pxmitbuf->len, 8) + txlen; -+ } -+ -+ if (k != 1) -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ pxmitframe = NULL; -+ } -+ -+ if (list_empty(&pframe_queue->queue)) -+ list_del_init(&ptxservq->tx_pending); -+ -+ if (err) -+ break; -+ } -+ spin_unlock_bh(&pxmitpriv->lock); -+ -+ /* dump xmit_buf to hw tx fifo */ -+ if (pxmitbuf) { -+ RT_TRACE(_module_hal_xmit_c_, _drv_info_, ("pxmitbuf->len =%d enqueue\n", pxmitbuf->len)); -+ -+ if (pxmitbuf->len > 0) { -+ struct xmit_frame *pframe; -+ pframe = (struct xmit_frame*)pxmitbuf->priv_data; -+ pframe->agg_num = k; -+ pxmitbuf->agg_num = k; -+ rtl8723b_update_txdesc(pframe, pframe->buf_addr); -+ rtw_free_xmitframe(pxmitpriv, pframe); -+ pxmitbuf->priv_data = NULL; -+ enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf); -+ yield(); -+ } -+ else -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ pxmitbuf = NULL; -+ } -+ -+ if (err) -+ break; -+ } -+ -+ return err; -+} -+ -+/* -+ * Description -+ *Transmit xmitframe from queue -+ * -+ * Return -+ *_SUCCESS ok -+ *_FAIL something error -+ */ -+static s32 rtl8723bs_xmit_handler(struct adapter *padapter) -+{ -+ struct xmit_priv *pxmitpriv; -+ s32 ret; -+ -+ -+ pxmitpriv = &padapter->xmitpriv; -+ -+ if (down_interruptible(&pxmitpriv->SdioXmitSema)) { -+ DBG_871X_LEVEL(_drv_emerg_, "%s: down sema fail!\n", __func__); -+ return _FAIL; -+ } -+ -+next: -+ if ( -+ (padapter->bDriverStopped == true) || -+ (padapter->bSurpriseRemoved == true) -+ ) { -+ RT_TRACE( -+ _module_hal_xmit_c_, -+ _drv_notice_, -+ ( -+ "%s: bDriverStopped(%d) bSurpriseRemoved(%d)\n", -+ __func__, -+ padapter->bDriverStopped, -+ padapter->bSurpriseRemoved -+ ) -+ ); -+ return _FAIL; -+ } -+ -+ spin_lock_bh(&pxmitpriv->lock); -+ ret = rtw_txframes_pending(padapter); -+ spin_unlock_bh(&pxmitpriv->lock); -+ if (ret == 0) { -+ return _SUCCESS; -+ } -+ -+ /* dequeue frame and write to hardware */ -+ -+ ret = xmit_xmitframes(padapter, pxmitpriv); -+ if (ret == -2) { -+ /* here sleep 1ms will cause big TP loss of TX */ -+ /* from 50+ to 40+ */ -+ if (padapter->registrypriv.wifi_spec) -+ msleep(1); -+ else -+ yield(); -+ goto next; -+ } -+ -+ spin_lock_bh(&pxmitpriv->lock); -+ ret = rtw_txframes_pending(padapter); -+ spin_unlock_bh(&pxmitpriv->lock); -+ if (ret == 1) { -+ goto next; -+ } -+ -+ return _SUCCESS; -+} -+ -+int rtl8723bs_xmit_thread(void *context) -+{ -+ s32 ret; -+ struct adapter *padapter; -+ struct xmit_priv *pxmitpriv; -+ u8 thread_name[20] = "RTWHALXT"; -+ -+ -+ ret = _SUCCESS; -+ padapter = (struct adapter *)context; -+ pxmitpriv = &padapter->xmitpriv; -+ -+ rtw_sprintf(thread_name, 20, "%s-"ADPT_FMT, thread_name, ADPT_ARG(padapter)); -+ thread_enter(thread_name); -+ -+ DBG_871X("start "FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ /* For now, no one would down sema to check thread is running, */ -+ /* so mark this temporary, Lucas@20130820 */ -+/* up(&pxmitpriv->SdioXmitTerminateSema); */ -+ -+ do { -+ ret = rtl8723bs_xmit_handler(padapter); -+ if (signal_pending(current)) { -+ flush_signals(current); -+ } -+ } while (_SUCCESS == ret); -+ -+ up(&pxmitpriv->SdioXmitTerminateSema); -+ -+ RT_TRACE(_module_hal_xmit_c_, _drv_notice_, ("-%s\n", __func__)); -+ -+ thread_exit(); -+} -+ -+s32 rtl8723bs_mgnt_xmit( -+ struct adapter *padapter, struct xmit_frame *pmgntframe -+) -+{ -+ s32 ret = _SUCCESS; -+ struct pkt_attrib *pattrib; -+ struct xmit_buf *pxmitbuf; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ u8 *pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ u8 txdesc_size = TXDESC_SIZE; -+ -+ RT_TRACE(_module_hal_xmit_c_, _drv_info_, ("+%s\n", __func__)); -+ -+ pattrib = &pmgntframe->attrib; -+ pxmitbuf = pmgntframe->pxmitbuf; -+ -+ rtl8723b_update_txdesc(pmgntframe, pmgntframe->buf_addr); -+ -+ pxmitbuf->len = txdesc_size + pattrib->last_txcmdsz; -+ pxmitbuf->pg_num = (pxmitbuf->len + 127)/128; /* 128 is tx page size */ -+ pxmitbuf->ptail = pmgntframe->buf_addr + pxmitbuf->len; -+ pxmitbuf->ff_hwaddr = rtw_get_ff_hwaddr(pmgntframe); -+ -+ rtw_count_tx_stats(padapter, pmgntframe, pattrib->last_txcmdsz); -+ -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ -+ pxmitbuf->priv_data = NULL; -+ -+ if (GetFrameSubType(pframe) == WIFI_BEACON) { /* dump beacon directly */ -+ ret = rtw_write_port(padapter, pdvobjpriv->Queue2Pipe[pxmitbuf->ff_hwaddr], pxmitbuf->len, (u8 *)pxmitbuf); -+ if (ret != _SUCCESS) -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_WRITE_PORT_ERR); -+ -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ } else -+ enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf); -+ -+ return ret; -+} -+ -+/* -+ * Description: -+ *Handle xmitframe(packet) come from rtw_xmit() -+ * -+ * Return: -+ *true dump packet directly ok -+ *false enqueue, temporary can't transmit packets to hardware -+ */ -+s32 rtl8723bs_hal_xmit( -+ struct adapter *padapter, struct xmit_frame *pxmitframe -+) -+{ -+ struct xmit_priv *pxmitpriv; -+ s32 err; -+ -+ -+ pxmitframe->attrib.qsel = pxmitframe->attrib.priority; -+ pxmitpriv = &padapter->xmitpriv; -+ -+ if ( -+ (pxmitframe->frame_tag == DATA_FRAMETAG) && -+ (pxmitframe->attrib.ether_type != 0x0806) && -+ (pxmitframe->attrib.ether_type != 0x888e) && -+ (pxmitframe->attrib.dhcp_pkt != 1) -+ ) { -+ if (padapter->mlmepriv.LinkDetectInfo.bBusyTraffic == true) -+ rtw_issue_addbareq_cmd(padapter, pxmitframe); -+ } -+ -+ spin_lock_bh(&pxmitpriv->lock); -+ err = rtw_xmitframe_enqueue(padapter, pxmitframe); -+ spin_unlock_bh(&pxmitpriv->lock); -+ if (err != _SUCCESS) { -+ RT_TRACE(_module_hal_xmit_c_, _drv_err_, ("rtl8723bs_hal_xmit: enqueue xmitframe fail\n")); -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ pxmitpriv->tx_drop++; -+ return true; -+ } -+ -+ up(&pxmitpriv->SdioXmitSema); -+ -+ return false; -+} -+ -+s32 rtl8723bs_hal_xmitframe_enqueue( -+ struct adapter *padapter, struct xmit_frame *pxmitframe -+) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ s32 err; -+ -+ if ((err = rtw_xmitframe_enqueue(padapter, pxmitframe)) != _SUCCESS) { -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ pxmitpriv->tx_drop++; -+ } else { -+#ifdef CONFIG_SDIO_TX_TASKLET -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+#else -+ up(&pxmitpriv->SdioXmitSema); -+#endif -+ } -+ -+ return err; -+ -+} -+ -+/* -+ * Return -+ *_SUCCESS start thread ok -+ *_FAIL start thread fail -+ * -+ */ -+s32 rtl8723bs_init_xmit_priv(struct adapter *padapter) -+{ -+ struct xmit_priv *xmitpriv = &padapter->xmitpriv; -+ struct hal_com_data *phal; -+ -+ -+ phal = GET_HAL_DATA(padapter); -+ -+ spin_lock_init(&phal->SdioTxFIFOFreePageLock); -+ sema_init(&xmitpriv->SdioXmitSema, 0); -+ sema_init(&xmitpriv->SdioXmitTerminateSema, 0); -+ -+ return _SUCCESS; -+} -+ -+void rtl8723bs_free_xmit_priv(struct adapter *padapter) -+{ -+ struct hal_com_data *phal; -+ struct xmit_priv *pxmitpriv; -+ struct xmit_buf *pxmitbuf; -+ struct __queue *pqueue; -+ struct list_head *plist, *phead; -+ struct list_head tmplist; -+ -+ -+ phal = GET_HAL_DATA(padapter); -+ pxmitpriv = &padapter->xmitpriv; -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ phead = get_list_head(pqueue); -+ INIT_LIST_HEAD(&tmplist); -+ -+ spin_lock_bh(&pqueue->lock); -+ if (!list_empty(&pqueue->queue)) { -+ /* Insert tmplist to end of queue, and delete phead */ -+ /* then tmplist become head of queue. */ -+ list_add_tail(&tmplist, phead); -+ list_del_init(phead); -+ } -+ spin_unlock_bh(&pqueue->lock); -+ -+ phead = &tmplist; -+ while (list_empty(phead) == false) { -+ plist = get_next(phead); -+ list_del_init(plist); -+ -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ rtw_free_xmitframe(pxmitpriv, (struct xmit_frame *)pxmitbuf->priv_data); -+ pxmitbuf->priv_data = NULL; -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ } -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/sdio_halinit.c linux/3rdparty/rtl8723bs/hal/sdio_halinit.c ---- linux.old/3rdparty/rtl8723bs/hal/sdio_halinit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/sdio_halinit.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1928 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _SDIO_HALINIT_C_ -+ -+#include -+#include -+#include -+ -+#include "hal_com_h2c.h" -+/* -+ * Description: -+ *Call power on sequence to enable card -+ * -+ * Return: -+ *_SUCCESS enable success -+ *_FAIL enable fail -+ */ -+static u8 CardEnable(struct adapter *padapter) -+{ -+ u8 bMacPwrCtrlOn; -+ u8 ret = _FAIL; -+ -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if (bMacPwrCtrlOn == false) { -+ /* RSV_CTRL 0x1C[7:0] = 0x00 */ -+ /* unlock ISO/CLK/Power control register */ -+ rtw_write8(padapter, REG_RSV_CTRL, 0x0); -+ -+ ret = HalPwrSeqCmdParsing(padapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, rtl8723B_card_enable_flow); -+ if (ret == _SUCCESS) { -+ u8 bMacPwrCtrlOn = true; -+ rtw_hal_set_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ } -+ } else -+ ret = _SUCCESS; -+ -+ return ret; -+} -+ -+#ifdef CONFIG_GPIO_WAKEUP -+/* we set it high under init and fw will */ -+/* give us Low Pulse when host wake up */ -+void HostWakeUpGpioClear(struct adapter *Adapter) -+{ -+ u32 value32; -+ -+ value32 = rtw_read32(Adapter, REG_GPIO_PIN_CTRL_2); -+ -+ /* set GPIO 12 1 */ -+ value32 |= BIT(12);/* 4+8 */ -+ /* GPIO 12 out put */ -+ value32 |= BIT(20);/* 4+16 */ -+ -+ rtw_write32(Adapter, REG_GPIO_PIN_CTRL_2, value32); -+} /* HostWakeUpGpioClear */ -+ -+void HalSetOutPutGPIO(struct adapter *padapter, u8 index, u8 OutPutValue) -+{ -+ if (index <= 7) { -+ /* config GPIO mode */ -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 3, rtw_read8(padapter, REG_GPIO_PIN_CTRL + 3) & ~BIT(index)); -+ -+ /* config GPIO Sel */ -+ /* 0: input */ -+ /* 1: output */ -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 2, rtw_read8(padapter, REG_GPIO_PIN_CTRL + 2) | BIT(index)); -+ -+ /* set output value */ -+ if (OutPutValue) -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 1, rtw_read8(padapter, REG_GPIO_PIN_CTRL + 1) | BIT(index)); -+ else -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 1, rtw_read8(padapter, REG_GPIO_PIN_CTRL + 1) & ~BIT(index)); -+ } else { -+ /* 88C Series: */ -+ /* index: 11~8 transform to 3~0 */ -+ /* 8723 Series: */ -+ /* index: 12~8 transform to 4~0 */ -+ index -= 8; -+ -+ /* config GPIO mode */ -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 3, rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 3) & ~BIT(index)); -+ -+ /* config GPIO Sel */ -+ /* 0: input */ -+ /* 1: output */ -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 2, rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 2) | BIT(index)); -+ -+ /* set output value */ -+ if (OutPutValue) -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 1, rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 1) | BIT(index)); -+ else -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 1, rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 1) & ~BIT(index)); -+ } -+} -+#endif -+ -+static -+u8 _InitPowerOn_8723BS(struct adapter *padapter) -+{ -+ u8 value8; -+ u16 value16; -+ u32 value32; -+ u8 ret; -+/* u8 bMacPwrCtrlOn; */ -+ -+ -+ /* all of these MUST be configured before power on */ -+#ifdef CONFIG_EXT_CLK -+ /* Use external crystal(XTAL) */ -+ value8 = rtw_read8(padapter, REG_PAD_CTRL1_8723B+2); -+ value8 |= BIT(7); -+ rtw_write8(padapter, REG_PAD_CTRL1_8723B+2, value8); -+ -+ /* CLK_REQ High active or Low Active */ -+ /* Request GPIO polarity: */ -+ /* 0: low active */ -+ /* 1: high active */ -+ value8 = rtw_read8(padapter, REG_MULTI_FUNC_CTRL+1); -+ value8 |= BIT(5); -+ rtw_write8(padapter, REG_MULTI_FUNC_CTRL+1, value8); -+#endif /* CONFIG_EXT_CLK */ -+ -+ /* only cmd52 can be used before power on(card enable) */ -+ ret = CardEnable(padapter); -+ if (ret == false) { -+ RT_TRACE( -+ _module_hci_hal_init_c_, -+ _drv_emerg_, -+ ("%s: run power on flow fail\n", __func__) -+ ); -+ return _FAIL; -+ } -+ -+ /* Radio-Off Pin Trigger */ -+ value8 = rtw_read8(padapter, REG_GPIO_INTM+1); -+ value8 |= BIT(1); /* Enable falling edge triggering interrupt */ -+ rtw_write8(padapter, REG_GPIO_INTM+1, value8); -+ value8 = rtw_read8(padapter, REG_GPIO_IO_SEL_2+1); -+ value8 |= BIT(1); -+ rtw_write8(padapter, REG_GPIO_IO_SEL_2+1, value8); -+ -+ /* Enable power down and GPIO interrupt */ -+ value16 = rtw_read16(padapter, REG_APS_FSMCO); -+ value16 |= EnPDN; /* Enable HW power down and RF on */ -+ rtw_write16(padapter, REG_APS_FSMCO, value16); -+ -+ /* Enable CMD53 R/W Operation */ -+/* bMacPwrCtrlOn = true; */ -+/* rtw_hal_set_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); */ -+ -+ rtw_write8(padapter, REG_CR, 0x00); -+ /* Enable MAC DMA/WMAC/SCHEDULE/SEC block */ -+ value16 = rtw_read16(padapter, REG_CR); -+ value16 |= ( -+ HCI_TXDMA_EN | -+ HCI_RXDMA_EN | -+ TXDMA_EN | -+ RXDMA_EN | -+ PROTOCOL_EN | -+ SCHEDULE_EN | -+ ENSEC | -+ CALTMR_EN -+ ); -+ rtw_write16(padapter, REG_CR, value16); -+ -+ rtw_btcoex_PowerOnSetting(padapter); -+ -+ /* external switch to S1 */ -+ /* 0x38[11] = 0x1 */ -+ /* 0x4c[23] = 0x1 */ -+ /* 0x64[0] = 0 */ -+ value16 = rtw_read16(padapter, REG_PWR_DATA); -+ /* Switch the control of EESK, EECS to RFC for DPDT or Antenna switch */ -+ value16 |= BIT(11); /* BIT_EEPRPAD_RFE_CTRL_EN */ -+ rtw_write16(padapter, REG_PWR_DATA, value16); -+/* DBG_8192C("%s: REG_PWR_DATA(0x%x) = 0x%04X\n", __func__, REG_PWR_DATA, rtw_read16(padapter, REG_PWR_DATA)); */ -+ -+ value32 = rtw_read32(padapter, REG_LEDCFG0); -+ value32 |= BIT(23); /* DPDT_SEL_EN, 1 for SW control */ -+ rtw_write32(padapter, REG_LEDCFG0, value32); -+/* DBG_8192C("%s: REG_LEDCFG0(0x%x) = 0x%08X\n", __func__, REG_LEDCFG0, rtw_read32(padapter, REG_LEDCFG0)); */ -+ -+ value8 = rtw_read8(padapter, REG_PAD_CTRL1_8723B); -+ value8 &= ~BIT(0); /* BIT_SW_DPDT_SEL_DATA, DPDT_SEL default configuration */ -+ rtw_write8(padapter, REG_PAD_CTRL1_8723B, value8); -+/* DBG_8192C("%s: REG_PAD_CTRL1(0x%x) = 0x%02X\n", __func__, REG_PAD_CTRL1_8723B, rtw_read8(padapter, REG_PAD_CTRL1_8723B)); */ -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ HostWakeUpGpioClear(padapter); -+#endif -+ -+ return _SUCCESS; -+} -+ -+/* Tx Page FIFO threshold */ -+static void _init_available_page_threshold(struct adapter *padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ) -+{ -+ u16 HQ_threshold, NQ_threshold, LQ_threshold; -+ -+ HQ_threshold = (numPubQ + numHQ + 1) >> 1; -+ HQ_threshold |= (HQ_threshold<<8); -+ -+ NQ_threshold = (numPubQ + numNQ + 1) >> 1; -+ NQ_threshold |= (NQ_threshold<<8); -+ -+ LQ_threshold = (numPubQ + numLQ + 1) >> 1; -+ LQ_threshold |= (LQ_threshold<<8); -+ -+ rtw_write16(padapter, 0x218, HQ_threshold); -+ rtw_write16(padapter, 0x21A, NQ_threshold); -+ rtw_write16(padapter, 0x21C, LQ_threshold); -+ DBG_8192C("%s(): Enable Tx FIFO Page Threshold H:0x%x, N:0x%x, L:0x%x\n", __func__, HQ_threshold, NQ_threshold, LQ_threshold); -+} -+ -+static void _InitQueueReservedPage(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ u32 numHQ = 0; -+ u32 numLQ = 0; -+ u32 numNQ = 0; -+ u32 numPubQ; -+ u32 value32; -+ u8 value8; -+ bool bWiFiConfig = pregistrypriv->wifi_spec; -+ -+ if (pHalData->OutEpQueueSel & TX_SELE_HQ) -+ numHQ = bWiFiConfig ? WMM_NORMAL_PAGE_NUM_HPQ_8723B : NORMAL_PAGE_NUM_HPQ_8723B; -+ -+ if (pHalData->OutEpQueueSel & TX_SELE_LQ) -+ numLQ = bWiFiConfig ? WMM_NORMAL_PAGE_NUM_LPQ_8723B : NORMAL_PAGE_NUM_LPQ_8723B; -+ -+ /* NOTE: This step shall be proceed before writting REG_RQPN. */ -+ if (pHalData->OutEpQueueSel & TX_SELE_NQ) -+ numNQ = bWiFiConfig ? WMM_NORMAL_PAGE_NUM_NPQ_8723B : NORMAL_PAGE_NUM_NPQ_8723B; -+ -+ numPubQ = TX_TOTAL_PAGE_NUMBER_8723B - numHQ - numLQ - numNQ; -+ -+ value8 = (u8)_NPQ(numNQ); -+ rtw_write8(padapter, REG_RQPN_NPQ, value8); -+ -+ /* TX DMA */ -+ value32 = _HPQ(numHQ) | _LPQ(numLQ) | _PUBQ(numPubQ) | LD_RQPN; -+ rtw_write32(padapter, REG_RQPN, value32); -+ -+ rtw_hal_set_sdio_tx_max_length(padapter, numHQ, numNQ, numLQ, numPubQ); -+ -+ _init_available_page_threshold(padapter, numHQ, numNQ, numLQ, numPubQ); -+} -+ -+static void _InitTxBufferBoundary(struct adapter *padapter) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ /* u16 txdmactrl; */ -+ u8 txpktbuf_bndy; -+ -+ if (!pregistrypriv->wifi_spec) { -+ txpktbuf_bndy = TX_PAGE_BOUNDARY_8723B; -+ } else { -+ /* for WMM */ -+ txpktbuf_bndy = WMM_NORMAL_TX_PAGE_BOUNDARY_8723B; -+ } -+ -+ rtw_write8(padapter, REG_TXPKTBUF_BCNQ_BDNY_8723B, txpktbuf_bndy); -+ rtw_write8(padapter, REG_TXPKTBUF_MGQ_BDNY_8723B, txpktbuf_bndy); -+ rtw_write8(padapter, REG_TXPKTBUF_WMAC_LBK_BF_HD_8723B, txpktbuf_bndy); -+ rtw_write8(padapter, REG_TRXFF_BNDY, txpktbuf_bndy); -+ rtw_write8(padapter, REG_TDECTRL+1, txpktbuf_bndy); -+} -+ -+static void _InitNormalChipRegPriority( -+ struct adapter *Adapter, -+ u16 beQ, -+ u16 bkQ, -+ u16 viQ, -+ u16 voQ, -+ u16 mgtQ, -+ u16 hiQ -+) -+{ -+ u16 value16 = (rtw_read16(Adapter, REG_TRXDMA_CTRL) & 0x7); -+ -+ value16 |= -+ _TXDMA_BEQ_MAP(beQ) | -+ _TXDMA_BKQ_MAP(bkQ) | -+ _TXDMA_VIQ_MAP(viQ) | -+ _TXDMA_VOQ_MAP(voQ) | -+ _TXDMA_MGQ_MAP(mgtQ) | -+ _TXDMA_HIQ_MAP(hiQ); -+ -+ rtw_write16(Adapter, REG_TRXDMA_CTRL, value16); -+} -+ -+static void _InitNormalChipOneOutEpPriority(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ u16 value = 0; -+ switch (pHalData->OutEpQueueSel) { -+ case TX_SELE_HQ: -+ value = QUEUE_HIGH; -+ break; -+ case TX_SELE_LQ: -+ value = QUEUE_LOW; -+ break; -+ case TX_SELE_NQ: -+ value = QUEUE_NORMAL; -+ break; -+ default: -+ /* RT_ASSERT(false, ("Shall not reach here!\n")); */ -+ break; -+ } -+ -+ _InitNormalChipRegPriority( -+ Adapter, value, value, value, value, value, value -+ ); -+ -+} -+ -+static void _InitNormalChipTwoOutEpPriority(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ struct registry_priv *pregistrypriv = &Adapter->registrypriv; -+ u16 beQ, bkQ, viQ, voQ, mgtQ, hiQ; -+ -+ -+ u16 valueHi = 0; -+ u16 valueLow = 0; -+ -+ switch (pHalData->OutEpQueueSel) { -+ case (TX_SELE_HQ | TX_SELE_LQ): -+ valueHi = QUEUE_HIGH; -+ valueLow = QUEUE_LOW; -+ break; -+ case (TX_SELE_NQ | TX_SELE_LQ): -+ valueHi = QUEUE_NORMAL; -+ valueLow = QUEUE_LOW; -+ break; -+ case (TX_SELE_HQ | TX_SELE_NQ): -+ valueHi = QUEUE_HIGH; -+ valueLow = QUEUE_NORMAL; -+ break; -+ default: -+ /* RT_ASSERT(false, ("Shall not reach here!\n")); */ -+ break; -+ } -+ -+ if (!pregistrypriv->wifi_spec) { -+ beQ = valueLow; -+ bkQ = valueLow; -+ viQ = valueHi; -+ voQ = valueHi; -+ mgtQ = valueHi; -+ hiQ = valueHi; -+ } else { -+ /* for WMM , CONFIG_OUT_EP_WIFI_MODE */ -+ beQ = valueLow; -+ bkQ = valueHi; -+ viQ = valueHi; -+ voQ = valueLow; -+ mgtQ = valueHi; -+ hiQ = valueHi; -+ } -+ -+ _InitNormalChipRegPriority(Adapter, beQ, bkQ, viQ, voQ, mgtQ, hiQ); -+ -+} -+ -+static void _InitNormalChipThreeOutEpPriority(struct adapter *padapter) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ u16 beQ, bkQ, viQ, voQ, mgtQ, hiQ; -+ -+ if (!pregistrypriv->wifi_spec) { -+ /* typical setting */ -+ beQ = QUEUE_LOW; -+ bkQ = QUEUE_LOW; -+ viQ = QUEUE_NORMAL; -+ voQ = QUEUE_HIGH; -+ mgtQ = QUEUE_HIGH; -+ hiQ = QUEUE_HIGH; -+ } else { -+ /* for WMM */ -+ beQ = QUEUE_LOW; -+ bkQ = QUEUE_NORMAL; -+ viQ = QUEUE_NORMAL; -+ voQ = QUEUE_HIGH; -+ mgtQ = QUEUE_HIGH; -+ hiQ = QUEUE_HIGH; -+ } -+ _InitNormalChipRegPriority(padapter, beQ, bkQ, viQ, voQ, mgtQ, hiQ); -+} -+ -+static void _InitNormalChipQueuePriority(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+ switch (pHalData->OutEpNumber) { -+ case 1: -+ _InitNormalChipOneOutEpPriority(Adapter); -+ break; -+ case 2: -+ _InitNormalChipTwoOutEpPriority(Adapter); -+ break; -+ case 3: -+ _InitNormalChipThreeOutEpPriority(Adapter); -+ break; -+ default: -+ /* RT_ASSERT(false, ("Shall not reach here!\n")); */ -+ break; -+ } -+ -+ -+} -+ -+static void _InitQueuePriority(struct adapter *padapter) -+{ -+ _InitNormalChipQueuePriority(padapter); -+} -+ -+static void _InitPageBoundary(struct adapter *padapter) -+{ -+ /* RX Page Boundary */ -+ u16 rxff_bndy = RX_DMA_BOUNDARY_8723B; -+ -+ rtw_write16(padapter, (REG_TRXFF_BNDY + 2), rxff_bndy); -+} -+ -+static void _InitTransferPageSize(struct adapter *padapter) -+{ -+ /* Tx page size is always 128. */ -+ -+ u8 value8; -+ value8 = _PSRX(PBP_128) | _PSTX(PBP_128); -+ rtw_write8(padapter, REG_PBP, value8); -+} -+ -+static void _InitDriverInfoSize(struct adapter *padapter, u8 drvInfoSize) -+{ -+ rtw_write8(padapter, REG_RX_DRVINFO_SZ, drvInfoSize); -+} -+ -+static void _InitNetworkType(struct adapter *padapter) -+{ -+ u32 value32; -+ -+ value32 = rtw_read32(padapter, REG_CR); -+ -+ /* TODO: use the other function to set network type */ -+/* value32 = (value32 & ~MASK_NETTYPE) | _NETTYPE(NT_LINK_AD_HOC); */ -+ value32 = (value32 & ~MASK_NETTYPE) | _NETTYPE(NT_LINK_AP); -+ -+ rtw_write32(padapter, REG_CR, value32); -+} -+ -+static void _InitWMACSetting(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ u16 value16; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ pHalData->ReceiveConfig = 0; -+ pHalData->ReceiveConfig |= RCR_APM | RCR_AM | RCR_AB; -+ pHalData->ReceiveConfig |= RCR_CBSSID_DATA | RCR_CBSSID_BCN | RCR_AMF; -+ pHalData->ReceiveConfig |= RCR_HTC_LOC_CTRL; -+ pHalData->ReceiveConfig |= RCR_APP_PHYST_RXFF | RCR_APP_ICV | RCR_APP_MIC; -+ rtw_write32(padapter, REG_RCR, pHalData->ReceiveConfig); -+ -+ /* Accept all multicast address */ -+ rtw_write32(padapter, REG_MAR, 0xFFFFFFFF); -+ rtw_write32(padapter, REG_MAR + 4, 0xFFFFFFFF); -+ -+ /* Accept all data frames */ -+ value16 = 0xFFFF; -+ rtw_write16(padapter, REG_RXFLTMAP2, value16); -+ -+ /* 2010.09.08 hpfan */ -+ /* Since ADF is removed from RCR, ps-poll will not be indicate to driver, */ -+ /* RxFilterMap should mask ps-poll to gurantee AP mode can rx ps-poll. */ -+ value16 = 0x400; -+ rtw_write16(padapter, REG_RXFLTMAP1, value16); -+ -+ /* Accept all management frames */ -+ value16 = 0xFFFF; -+ rtw_write16(padapter, REG_RXFLTMAP0, value16); -+} -+ -+static void _InitAdaptiveCtrl(struct adapter *padapter) -+{ -+ u16 value16; -+ u32 value32; -+ -+ /* Response Rate Set */ -+ value32 = rtw_read32(padapter, REG_RRSR); -+ value32 &= ~RATE_BITMAP_ALL; -+ value32 |= RATE_RRSR_CCK_ONLY_1M; -+ rtw_write32(padapter, REG_RRSR, value32); -+ -+ /* CF-END Threshold */ -+ /* m_spIoBase->rtw_write8(REG_CFEND_TH, 0x1); */ -+ -+ /* SIFS (used in NAV) */ -+ value16 = _SPEC_SIFS_CCK(0x10) | _SPEC_SIFS_OFDM(0x10); -+ rtw_write16(padapter, REG_SPEC_SIFS, value16); -+ -+ /* Retry Limit */ -+ value16 = _LRL(0x30) | _SRL(0x30); -+ rtw_write16(padapter, REG_RL, value16); -+} -+ -+static void _InitEDCA(struct adapter *padapter) -+{ -+ /* Set Spec SIFS (used in NAV) */ -+ rtw_write16(padapter, REG_SPEC_SIFS, 0x100a); -+ rtw_write16(padapter, REG_MAC_SPEC_SIFS, 0x100a); -+ -+ /* Set SIFS for CCK */ -+ rtw_write16(padapter, REG_SIFS_CTX, 0x100a); -+ -+ /* Set SIFS for OFDM */ -+ rtw_write16(padapter, REG_SIFS_TRX, 0x100a); -+ -+ /* TXOP */ -+ rtw_write32(padapter, REG_EDCA_BE_PARAM, 0x005EA42B); -+ rtw_write32(padapter, REG_EDCA_BK_PARAM, 0x0000A44F); -+ rtw_write32(padapter, REG_EDCA_VI_PARAM, 0x005EA324); -+ rtw_write32(padapter, REG_EDCA_VO_PARAM, 0x002FA226); -+} -+ -+static void _InitRetryFunction(struct adapter *padapter) -+{ -+ u8 value8; -+ -+ value8 = rtw_read8(padapter, REG_FWHW_TXQ_CTRL); -+ value8 |= EN_AMPDU_RTY_NEW; -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL, value8); -+ -+ /* Set ACK timeout */ -+ rtw_write8(padapter, REG_ACKTO, 0x40); -+} -+ -+static void HalRxAggr8723BSdio(struct adapter *padapter) -+{ -+ struct registry_priv *pregistrypriv; -+ u8 valueDMATimeout; -+ u8 valueDMAPageCount; -+ -+ -+ pregistrypriv = &padapter->registrypriv; -+ -+ if (pregistrypriv->wifi_spec) { -+ /* 2010.04.27 hpfan */ -+ /* Adjust RxAggrTimeout to close to zero disable RxAggr, suggested by designer */ -+ /* Timeout value is calculated by 34 / (2^n) */ -+ valueDMATimeout = 0x06; -+ valueDMAPageCount = 0x06; -+ } else { -+ /* 20130530, Isaac@SD1 suggest 3 kinds of parameter */ -+ /* TX/RX Balance */ -+ valueDMATimeout = 0x06; -+ valueDMAPageCount = 0x06; -+ } -+ -+ rtw_write8(padapter, REG_RXDMA_AGG_PG_TH+1, valueDMATimeout); -+ rtw_write8(padapter, REG_RXDMA_AGG_PG_TH, valueDMAPageCount); -+} -+ -+static void sdio_AggSettingRxUpdate(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ u8 valueDMA; -+ u8 valueRxAggCtrl = 0; -+ u8 aggBurstNum = 3; /* 0:1, 1:2, 2:3, 3:4 */ -+ u8 aggBurstSize = 0; /* 0:1K, 1:512Byte, 2:256Byte... */ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ valueDMA = rtw_read8(padapter, REG_TRXDMA_CTRL); -+ valueDMA |= RXDMA_AGG_EN; -+ rtw_write8(padapter, REG_TRXDMA_CTRL, valueDMA); -+ -+ valueRxAggCtrl |= RXDMA_AGG_MODE_EN; -+ valueRxAggCtrl |= ((aggBurstNum<<2) & 0x0C); -+ valueRxAggCtrl |= ((aggBurstSize<<4) & 0x30); -+ rtw_write8(padapter, REG_RXDMA_MODE_CTRL_8723B, valueRxAggCtrl);/* RxAggLowThresh = 4*1K */ -+} -+ -+static void _initSdioAggregationSetting(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+ /* Tx aggregation setting */ -+/* sdio_AggSettingTxUpdate(padapter); */ -+ -+ /* Rx aggregation setting */ -+ HalRxAggr8723BSdio(padapter); -+ -+ sdio_AggSettingRxUpdate(padapter); -+ -+ /* 201/12/10 MH Add for USB agg mode dynamic switch. */ -+ pHalData->UsbRxHighSpeedMode = false; -+} -+ -+static void _InitOperationMode(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ struct mlme_ext_priv *pmlmeext; -+ u8 regBwOpMode = 0; -+ u32 regRATR = 0, regRRSR = 0; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pmlmeext = &padapter->mlmeextpriv; -+ -+ /* 1 This part need to modified according to the rate set we filtered!! */ -+ /* */ -+ /* Set RRSR, RATR, and REG_BWOPMODE registers */ -+ /* */ -+ switch (pmlmeext->cur_wireless_mode) { -+ case WIRELESS_MODE_B: -+ regBwOpMode = BW_OPMODE_20MHZ; -+ regRATR = RATE_ALL_CCK; -+ regRRSR = RATE_ALL_CCK; -+ break; -+ case WIRELESS_MODE_A: -+/* RT_ASSERT(false, ("Error wireless a mode\n")); */ -+ break; -+ case WIRELESS_MODE_G: -+ regBwOpMode = BW_OPMODE_20MHZ; -+ regRATR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; -+ regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; -+ break; -+ case WIRELESS_MODE_AUTO: -+ regBwOpMode = BW_OPMODE_20MHZ; -+ regRATR = RATE_ALL_CCK | RATE_ALL_OFDM_AG | RATE_ALL_OFDM_1SS | RATE_ALL_OFDM_2SS; -+ regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; -+ break; -+ case WIRELESS_MODE_N_24G: -+ /* It support CCK rate by default. */ -+ /* CCK rate will be filtered out only when associated AP does not support it. */ -+ regBwOpMode = BW_OPMODE_20MHZ; -+ regRATR = RATE_ALL_CCK | RATE_ALL_OFDM_AG | RATE_ALL_OFDM_1SS | RATE_ALL_OFDM_2SS; -+ regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; -+ break; -+ case WIRELESS_MODE_N_5G: -+/* RT_ASSERT(false, ("Error wireless mode")); */ -+ regBwOpMode = BW_OPMODE_5G; -+ regRATR = RATE_ALL_OFDM_AG | RATE_ALL_OFDM_1SS | RATE_ALL_OFDM_2SS; -+ regRRSR = RATE_ALL_OFDM_AG; -+ break; -+ -+ default: /* for MacOSX compiler warning. */ -+ break; -+ } -+ -+ rtw_write8(padapter, REG_BWOPMODE, regBwOpMode); -+ -+} -+ -+static void _InitInterrupt(struct adapter *padapter) -+{ -+ /* HISR - turn all off */ -+ rtw_write32(padapter, REG_HISR, 0); -+ -+ /* HIMR - turn all off */ -+ rtw_write32(padapter, REG_HIMR, 0); -+ -+ /* */ -+ /* Initialize and enable SDIO Host Interrupt. */ -+ /* */ -+ InitInterrupt8723BSdio(padapter); -+ -+ /* */ -+ /* Initialize system Host Interrupt. */ -+ /* */ -+ InitSysInterrupt8723BSdio(padapter); -+} -+ -+static void _InitRFType(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+#if DISABLE_BB_RF -+ pHalData->rf_chip = RF_PSEUDO_11N; -+ return; -+#endif -+ -+ pHalData->rf_chip = RF_6052; -+ -+ pHalData->rf_type = RF_1T1R; -+ DBG_8192C("Set RF Chip ID to RF_6052 and RF type to 1T1R.\n"); -+} -+ -+static void _RfPowerSave(struct adapter *padapter) -+{ -+/* YJ, TODO */ -+} -+ -+/* */ -+/* 2010/08/09 MH Add for power down check. */ -+/* */ -+static bool HalDetectPwrDownMode(struct adapter *Adapter) -+{ -+ u8 tmpvalue; -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(Adapter); -+ -+ -+ EFUSE_ShadowRead(Adapter, 1, 0x7B/*EEPROM_RF_OPT3_92C*/, (u32 *)&tmpvalue); -+ -+ /* 2010/08/25 MH INF priority > PDN Efuse value. */ -+ if (tmpvalue & BIT4 && pwrctrlpriv->reg_pdnmode) -+ pHalData->pwrdown = true; -+ else -+ pHalData->pwrdown = false; -+ -+ DBG_8192C("HalDetectPwrDownMode(): PDN =%d\n", pHalData->pwrdown); -+ -+ return pHalData->pwrdown; -+} /* HalDetectPwrDownMode */ -+ -+static u32 rtl8723bs_hal_init(struct adapter *padapter) -+{ -+ s32 ret; -+ struct hal_com_data *pHalData; -+ struct pwrctrl_priv *pwrctrlpriv; -+ struct registry_priv *pregistrypriv; -+ u32 NavUpper = WiFiNavUpperUs; -+ u8 u1bTmp; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pwrctrlpriv = adapter_to_pwrctl(padapter); -+ pregistrypriv = &padapter->registrypriv; -+ -+ if ( -+ adapter_to_pwrctl(padapter)->bips_processing == true && -+ adapter_to_pwrctl(padapter)->pre_ips_type == 0 -+ ) { -+ unsigned long start_time; -+ u8 cpwm_orig, cpwm_now; -+ u8 val8, bMacPwrCtrlOn = true; -+ -+ DBG_871X("%s: Leaving IPS in FWLPS state\n", __func__); -+ -+ /* for polling cpwm */ -+ cpwm_orig = 0; -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig); -+ -+ /* ser rpwm */ -+ val8 = rtw_read8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HRPWM1); -+ val8 &= 0x80; -+ val8 += 0x80; -+ val8 |= BIT(6); -+ rtw_write8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HRPWM1, val8); -+ DBG_871X("%s: write rpwm =%02x\n", __func__, val8); -+ adapter_to_pwrctl(padapter)->tog = (val8 + 0x80) & 0x80; -+ -+ /* do polling cpwm */ -+ start_time = jiffies; -+ do { -+ -+ mdelay(1); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_now); -+ if ((cpwm_orig ^ cpwm_now) & 0x80) -+ break; -+ -+ if (jiffies_to_msecs(jiffies - start_time) > 100) { -+ DBG_871X("%s: polling cpwm timeout when leaving IPS in FWLPS state\n", __func__); -+ break; -+ } -+ } while (1); -+ -+ rtl8723b_set_FwPwrModeInIPS_cmd(padapter, 0); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ -+ rtw_btcoex_HAL_Initialize(padapter, false); -+ -+ return _SUCCESS; -+ } -+ -+#ifdef CONFIG_WOWLAN -+ if (rtw_read8(padapter, REG_MCUFWDL)&BIT7) { -+ u8 reg_val = 0; -+ DBG_871X("+Reset Entry+\n"); -+ rtw_write8(padapter, REG_MCUFWDL, 0x00); -+ _8051Reset8723(padapter); -+ /* reset BB */ -+ reg_val = rtw_read8(padapter, REG_SYS_FUNC_EN); -+ reg_val &= ~(BIT(0) | BIT(1)); -+ rtw_write8(padapter, REG_SYS_FUNC_EN, reg_val); -+ /* reset RF */ -+ rtw_write8(padapter, REG_RF_CTRL, 0); -+ /* reset TRX path */ -+ rtw_write16(padapter, REG_CR, 0); -+ /* reset MAC, Digital Core */ -+ reg_val = rtw_read8(padapter, REG_SYS_FUNC_EN+1); -+ reg_val &= ~(BIT(4) | BIT(7)); -+ rtw_write8(padapter, REG_SYS_FUNC_EN+1, reg_val); -+ reg_val = rtw_read8(padapter, REG_SYS_FUNC_EN+1); -+ reg_val |= BIT(4) | BIT(7); -+ rtw_write8(padapter, REG_SYS_FUNC_EN+1, reg_val); -+ DBG_871X("-Reset Entry-\n"); -+ } -+#endif /* CONFIG_WOWLAN */ -+ /* Disable Interrupt first. */ -+/* rtw_hal_disable_interrupt(padapter); */ -+ -+ ret = _InitPowerOn_8723BS(padapter); -+ if (_FAIL == ret) { -+ RT_TRACE(_module_hci_hal_init_c_, _drv_err_, ("Failed to init Power On!\n")); -+ return _FAIL; -+ } -+ -+ rtw_write8(padapter, REG_EARLY_MODE_CONTROL, 0); -+ -+ ret = rtl8723b_FirmwareDownload(padapter, false); -+ if (ret != _SUCCESS) { -+ RT_TRACE(_module_hci_hal_init_c_, _drv_err_, ("%s: Download Firmware failed!!\n", __func__)); -+ padapter->bFWReady = false; -+ pHalData->fw_ractrl = false; -+ return ret; -+ } else { -+ RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("rtl8723bs_hal_init(): Download Firmware Success!!\n")); -+ padapter->bFWReady = true; -+ pHalData->fw_ractrl = true; -+ } -+ -+ rtl8723b_InitializeFirmwareVars(padapter); -+ -+/* SIC_Init(padapter); */ -+ -+ if (pwrctrlpriv->reg_rfoff == true) -+ pwrctrlpriv->rf_pwrstate = rf_off; -+ -+ /* 2010/08/09 MH We need to check if we need to turnon or off RF after detecting */ -+ /* HW GPIO pin. Before PHY_RFConfig8192C. */ -+ HalDetectPwrDownMode(padapter); -+ -+ /* Set RF type for BB/RF configuration */ -+ _InitRFType(padapter); -+ -+ /* Save target channel */ -+ /* Current Channel will be updated again later. */ -+ pHalData->CurrentChannel = 6; -+ -+#if (HAL_MAC_ENABLE == 1) -+ ret = PHY_MACConfig8723B(padapter); -+ if (ret != _SUCCESS) { -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("Initializepadapter8192CSdio(): Fail to configure MAC!!\n")); -+ return ret; -+ } -+#endif -+ /* */ -+ /* d. Initialize BB related configurations. */ -+ /* */ -+#if (HAL_BB_ENABLE == 1) -+ ret = PHY_BBConfig8723B(padapter); -+ if (ret != _SUCCESS) { -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("Initializepadapter8192CSdio(): Fail to configure BB!!\n")); -+ return ret; -+ } -+#endif -+ -+ /* If RF is on, we need to init RF. Otherwise, skip the procedure. */ -+ /* We need to follow SU method to change the RF cfg.txt. Default disable RF TX/RX mode. */ -+ /* if (pHalData->eRFPowerState == eRfOn) */ -+ { -+#if (HAL_RF_ENABLE == 1) -+ ret = PHY_RFConfig8723B(padapter); -+ if (ret != _SUCCESS) { -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("Initializepadapter8192CSdio(): Fail to configure RF!!\n")); -+ return ret; -+ } -+#endif -+ } -+ -+ /* */ -+ /* Joseph Note: Keep RfRegChnlVal for later use. */ -+ /* */ -+ pHalData->RfRegChnlVal[0] = -+ PHY_QueryRFReg(padapter, (enum RF_PATH)0, RF_CHNLBW, bRFRegOffsetMask); -+ pHalData->RfRegChnlVal[1] = -+ PHY_QueryRFReg(padapter, (enum RF_PATH)1, RF_CHNLBW, bRFRegOffsetMask); -+ -+ -+ /* if (!pHalData->bMACFuncEnable) { */ -+ _InitQueueReservedPage(padapter); -+ _InitTxBufferBoundary(padapter); -+ -+ /* init LLT after tx buffer boundary is defined */ -+ ret = rtl8723b_InitLLTTable(padapter); -+ if (_SUCCESS != ret) { -+ DBG_8192C("%s: Failed to init LLT Table!\n", __func__); -+ return _FAIL; -+ } -+ /* */ -+ _InitQueuePriority(padapter); -+ _InitPageBoundary(padapter); -+ _InitTransferPageSize(padapter); -+ -+ /* Get Rx PHY status in order to report RSSI and others. */ -+ _InitDriverInfoSize(padapter, DRVINFO_SZ); -+ hal_init_macaddr(padapter); -+ _InitNetworkType(padapter); -+ _InitWMACSetting(padapter); -+ _InitAdaptiveCtrl(padapter); -+ _InitEDCA(padapter); -+ _InitRetryFunction(padapter); -+ _initSdioAggregationSetting(padapter); -+ _InitOperationMode(padapter); -+ rtl8723b_InitBeaconParameters(padapter); -+ _InitInterrupt(padapter); -+ _InitBurstPktLen_8723BS(padapter); -+ -+ /* YJ, TODO */ -+ rtw_write8(padapter, REG_SECONDARY_CCA_CTRL_8723B, 0x3); /* CCA */ -+ rtw_write8(padapter, 0x976, 0); /* hpfan_todo: 2nd CCA related */ -+ -+ rtw_write16(padapter, REG_PKT_VO_VI_LIFE_TIME, 0x0400); /* unit: 256us. 256ms */ -+ rtw_write16(padapter, REG_PKT_BE_BK_LIFE_TIME, 0x0400); /* unit: 256us. 256ms */ -+ -+ invalidate_cam_all(padapter); -+ -+ rtw_hal_set_chnl_bw(padapter, padapter->registrypriv.channel, -+ CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE, HAL_PRIME_CHNL_OFFSET_DONT_CARE); -+ -+ /* Record original value for template. This is arough data, we can only use the data */ -+ /* for power adjust. The value can not be adjustde according to different power!!! */ -+/* pHalData->OriginalCckTxPwrIdx = pHalData->CurrentCckTxPwrIdx; */ -+/* pHalData->OriginalOfdm24GTxPwrIdx = pHalData->CurrentOfdm24GTxPwrIdx; */ -+ -+ rtl8723b_InitAntenna_Selection(padapter); -+ -+ /* */ -+ /* Disable BAR, suggested by Scott */ -+ /* 2010.04.09 add by hpfan */ -+ /* */ -+ rtw_write32(padapter, REG_BAR_MODE_CTRL, 0x0201ffff); -+ -+ /* HW SEQ CTRL */ -+ /* set 0x0 to 0xFF by tynli. Default enable HW SEQ NUM. */ -+ rtw_write8(padapter, REG_HWSEQ_CTRL, 0xFF); -+ -+ -+ /* */ -+ /* Configure SDIO TxRx Control to enable Rx DMA timer masking. */ -+ /* 2010.02.24. */ -+ /* */ -+ rtw_write32(padapter, SDIO_LOCAL_BASE|SDIO_REG_TX_CTRL, 0); -+ -+ _RfPowerSave(padapter); -+ -+ -+ rtl8723b_InitHalDm(padapter); -+ -+ /* DbgPrint("pHalData->DefaultTxPwrDbm = %d\n", pHalData->DefaultTxPwrDbm); */ -+ -+ /* */ -+ /* Update current Tx FIFO page status. */ -+ /* */ -+ HalQueryTxBufferStatus8723BSdio(padapter); -+ HalQueryTxOQTBufferStatus8723BSdio(padapter); -+ pHalData->SdioTxOQTMaxFreeSpace = pHalData->SdioTxOQTFreeSpace; -+ -+ /* Enable MACTXEN/MACRXEN block */ -+ u1bTmp = rtw_read8(padapter, REG_CR); -+ u1bTmp |= (MACTXEN | MACRXEN); -+ rtw_write8(padapter, REG_CR, u1bTmp); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_NAV_UPPER, (u8 *)&NavUpper); -+ -+ /* ack for xmit mgmt frames. */ -+ rtw_write32(padapter, REG_FWHW_TXQ_CTRL, rtw_read32(padapter, REG_FWHW_TXQ_CTRL)|BIT(12)); -+ -+/* pHalData->PreRpwmVal = SdioLocalCmd52Read1Byte(padapter, SDIO_REG_HRPWM1) & 0x80; */ -+ -+ { -+ pwrctrlpriv->rf_pwrstate = rf_on; -+ -+ if (pwrctrlpriv->rf_pwrstate == rf_on) { -+ struct pwrctrl_priv *pwrpriv; -+ unsigned long start_time; -+ u8 restore_iqk_rst; -+ u8 b2Ant; -+ u8 h2cCmdBuf; -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ PHY_LCCalibrate_8723B(&pHalData->odmpriv); -+ -+ /* Inform WiFi FW that it is the beginning of IQK */ -+ h2cCmdBuf = 1; -+ FillH2CCmd8723B(padapter, H2C_8723B_BT_WLAN_CALIBRATION, 1, &h2cCmdBuf); -+ -+ start_time = jiffies; -+ do { -+ if (rtw_read8(padapter, 0x1e7) & 0x01) -+ break; -+ -+ msleep(50); -+ } while (jiffies_to_msecs(jiffies - start_time) <= 400); -+ -+ rtw_btcoex_IQKNotify(padapter, true); -+ -+ restore_iqk_rst = (pwrpriv->bips_processing == true) ? true : false; -+ b2Ant = pHalData->EEPROMBluetoothAntNum == Ant_x2 ? true : false; -+ PHY_IQCalibrate_8723B(padapter, false, restore_iqk_rst, b2Ant, pHalData->ant_path); -+ pHalData->odmpriv.RFCalibrateInfo.bIQKInitialized = true; -+ -+ rtw_btcoex_IQKNotify(padapter, false); -+ -+ /* Inform WiFi FW that it is the finish of IQK */ -+ h2cCmdBuf = 0; -+ FillH2CCmd8723B(padapter, H2C_8723B_BT_WLAN_CALIBRATION, 1, &h2cCmdBuf); -+ -+ ODM_TXPowerTrackingCheck(&pHalData->odmpriv); -+ } -+ } -+ -+ /* Init BT hw config. */ -+ rtw_btcoex_HAL_Initialize(padapter, false); -+ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("-%s\n", __func__)); -+ -+ return _SUCCESS; -+} -+ -+/* */ -+/* Description: */ -+/* RTL8723e card disable power sequence v003 which suggested by Scott. */ -+/* */ -+/* First created by tynli. 2011.01.28. */ -+/* */ -+static void CardDisableRTL8723BSdio(struct adapter *padapter) -+{ -+ u8 u1bTmp; -+ u8 bMacPwrCtrlOn; -+ u8 ret = _FAIL; -+ -+ /* Run LPS WL RFOFF flow */ -+ ret = HalPwrSeqCmdParsing(padapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, rtl8723B_enter_lps_flow); -+ if (ret == _FAIL) { -+ DBG_8192C(KERN_ERR "%s: run RF OFF flow fail!\n", __func__); -+ } -+ -+ /* ==== Reset digital sequence ====== */ -+ -+ u1bTmp = rtw_read8(padapter, REG_MCUFWDL); -+ if ((u1bTmp & RAM_DL_SEL) && padapter->bFWReady) /* 8051 RAM code */ -+ rtl8723b_FirmwareSelfReset(padapter); -+ -+ /* Reset MCU 0x2[10]= 0. Suggested by Filen. 2011.01.26. by tynli. */ -+ u1bTmp = rtw_read8(padapter, REG_SYS_FUNC_EN+1); -+ u1bTmp &= ~BIT(2); /* 0x2[10], FEN_CPUEN */ -+ rtw_write8(padapter, REG_SYS_FUNC_EN+1, u1bTmp); -+ -+ /* MCUFWDL 0x80[1:0]= 0 */ -+ /* reset MCU ready status */ -+ rtw_write8(padapter, REG_MCUFWDL, 0); -+ -+ /* Reset MCU IO Wrapper, added by Roger, 2011.08.30 */ -+ u1bTmp = rtw_read8(padapter, REG_RSV_CTRL+1); -+ u1bTmp &= ~BIT(0); -+ rtw_write8(padapter, REG_RSV_CTRL+1, u1bTmp); -+ u1bTmp = rtw_read8(padapter, REG_RSV_CTRL+1); -+ u1bTmp |= BIT(0); -+ rtw_write8(padapter, REG_RSV_CTRL+1, u1bTmp); -+ -+ /* ==== Reset digital sequence end ====== */ -+ -+ bMacPwrCtrlOn = false; /* Disable CMD53 R/W */ -+ ret = false; -+ rtw_hal_set_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ ret = HalPwrSeqCmdParsing(padapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, rtl8723B_card_disable_flow); -+ if (ret == false) { -+ DBG_8192C(KERN_ERR "%s: run CARD DISABLE flow fail!\n", __func__); -+ } -+} -+ -+static u32 rtl8723bs_hal_deinit(struct adapter *padapter) -+{ -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ if (padapter->hw_init_completed == true) { -+ if (adapter_to_pwrctl(padapter)->bips_processing == true) { -+ if (padapter->netif_up == true) { -+ int cnt = 0; -+ u8 val8 = 0; -+ -+ DBG_871X("%s: issue H2C to FW when entering IPS\n", __func__); -+ -+ rtl8723b_set_FwPwrModeInIPS_cmd(padapter, 0x3); -+ /* poll 0x1cc to make sure H2C command already finished by FW; MAC_0x1cc = 0 means H2C done by FW. */ -+ do { -+ val8 = rtw_read8(padapter, REG_HMETFR); -+ cnt++; -+ DBG_871X("%s polling REG_HMETFR = 0x%x, cnt =%d\n", __func__, val8, cnt); -+ mdelay(10); -+ } while (cnt < 100 && (val8 != 0)); -+ /* H2C done, enter 32k */ -+ if (val8 == 0) { -+ /* ser rpwm to enter 32k */ -+ val8 = rtw_read8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HRPWM1); -+ val8 += 0x80; -+ val8 |= BIT(0); -+ rtw_write8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HRPWM1, val8); -+ DBG_871X("%s: write rpwm =%02x\n", __func__, val8); -+ adapter_to_pwrctl(padapter)->tog = (val8 + 0x80) & 0x80; -+ cnt = val8 = 0; -+ do { -+ val8 = rtw_read8(padapter, REG_CR); -+ cnt++; -+ DBG_871X("%s polling 0x100 = 0x%x, cnt =%d\n", __func__, val8, cnt); -+ mdelay(10); -+ } while (cnt < 100 && (val8 != 0xEA)); -+ } else { -+ DBG_871X( -+ "MAC_1C0 =%08x, MAC_1C4 =%08x, MAC_1C8 =%08x, MAC_1CC =%08x\n", -+ rtw_read32(padapter, 0x1c0), -+ rtw_read32(padapter, 0x1c4), -+ rtw_read32(padapter, 0x1c8), -+ rtw_read32(padapter, 0x1cc) -+ ); -+ } -+ -+ DBG_871X( -+ "polling done when entering IPS, check result : 0x100 = 0x%x, cnt =%d, MAC_1cc = 0x%02x\n", -+ rtw_read8(padapter, REG_CR), -+ cnt, -+ rtw_read8(padapter, REG_HMETFR) -+ ); -+ -+ adapter_to_pwrctl(padapter)->pre_ips_type = 0; -+ -+ } else { -+ pdbgpriv->dbg_carddisable_cnt++; -+ CardDisableRTL8723BSdio(padapter); -+ -+ adapter_to_pwrctl(padapter)->pre_ips_type = 1; -+ } -+ -+ } else { -+ pdbgpriv->dbg_carddisable_cnt++; -+ CardDisableRTL8723BSdio(padapter); -+ } -+ } else -+ pdbgpriv->dbg_deinit_fail_cnt++; -+ -+ return _SUCCESS; -+} -+ -+static u32 rtl8723bs_inirp_init(struct adapter *padapter) -+{ -+ return _SUCCESS; -+} -+ -+static u32 rtl8723bs_inirp_deinit(struct adapter *padapter) -+{ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("+rtl8723bs_inirp_deinit\n")); -+ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("-rtl8723bs_inirp_deinit\n")); -+ -+ return _SUCCESS; -+} -+ -+static void rtl8723bs_init_default_value(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ rtl8723b_init_default_value(padapter); -+ -+ /* interface related variable */ -+ pHalData->SdioRxFIFOCnt = 0; -+} -+ -+static void rtl8723bs_interface_configure(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ bool bWiFiConfig = pregistrypriv->wifi_spec; -+ -+ -+ pdvobjpriv->RtOutPipe[0] = WLAN_TX_HIQ_DEVICE_ID; -+ pdvobjpriv->RtOutPipe[1] = WLAN_TX_MIQ_DEVICE_ID; -+ pdvobjpriv->RtOutPipe[2] = WLAN_TX_LOQ_DEVICE_ID; -+ -+ if (bWiFiConfig) -+ pHalData->OutEpNumber = 2; -+ else -+ pHalData->OutEpNumber = SDIO_MAX_TX_QUEUE; -+ -+ switch (pHalData->OutEpNumber) { -+ case 3: -+ pHalData->OutEpQueueSel = TX_SELE_HQ | TX_SELE_LQ|TX_SELE_NQ; -+ break; -+ case 2: -+ pHalData->OutEpQueueSel = TX_SELE_HQ | TX_SELE_NQ; -+ break; -+ case 1: -+ pHalData->OutEpQueueSel = TX_SELE_HQ; -+ break; -+ default: -+ break; -+ } -+ -+ Hal_MappingOutPipe(padapter, pHalData->OutEpNumber); -+} -+ -+/* */ -+/* Description: */ -+/* We should set Efuse cell selection to WiFi cell in default. */ -+/* */ -+/* Assumption: */ -+/* PASSIVE_LEVEL */ -+/* */ -+/* Added by Roger, 2010.11.23. */ -+/* */ -+static void _EfuseCellSel(struct adapter *padapter) -+{ -+ u32 value32; -+ -+ value32 = rtw_read32(padapter, EFUSE_TEST); -+ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_WIFI_SEL_0); -+ rtw_write32(padapter, EFUSE_TEST, value32); -+} -+ -+static void _ReadRFType(struct adapter *Adapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); -+ -+#if DISABLE_BB_RF -+ pHalData->rf_chip = RF_PSEUDO_11N; -+#else -+ pHalData->rf_chip = RF_6052; -+#endif -+} -+ -+ -+static void Hal_EfuseParseMACAddr_8723BS( -+ struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail -+) -+{ -+ u16 i; -+ u8 sMacAddr[6] = {0x00, 0xE0, 0x4C, 0xb7, 0x23, 0x00}; -+ struct eeprom_priv *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ -+ if (AutoLoadFail) { -+/* sMacAddr[5] = (u8)GetRandomNumber(1, 254); */ -+ for (i = 0; i < 6; i++) -+ pEEPROM->mac_addr[i] = sMacAddr[i]; -+ } else { -+ /* Read Permanent MAC address */ -+ memcpy(pEEPROM->mac_addr, &hwinfo[EEPROM_MAC_ADDR_8723BS], ETH_ALEN); -+ } -+/* NicIFSetMacAddress(padapter, padapter->PermanentAddress); */ -+ -+ RT_TRACE( -+ _module_hci_hal_init_c_, -+ _drv_notice_, -+ ( -+ "Hal_EfuseParseMACAddr_8723BS: Permanent Address = %02x-%02x-%02x-%02x-%02x-%02x\n", -+ pEEPROM->mac_addr[0], -+ pEEPROM->mac_addr[1], -+ pEEPROM->mac_addr[2], -+ pEEPROM->mac_addr[3], -+ pEEPROM->mac_addr[4], -+ pEEPROM->mac_addr[5] -+ ) -+ ); -+} -+ -+static void Hal_EfuseParseBoardType_8723BS( -+ struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail -+) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+ if (!AutoLoadFail) { -+ pHalData->BoardType = (hwinfo[EEPROM_RF_BOARD_OPTION_8723B] & 0xE0) >> 5; -+ if (pHalData->BoardType == 0xFF) -+ pHalData->BoardType = (EEPROM_DEFAULT_BOARD_OPTION&0xE0)>>5; -+ } else -+ pHalData->BoardType = 0; -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("Board Type: 0x%2x\n", pHalData->BoardType)); -+} -+ -+static void _ReadEfuseInfo8723BS(struct adapter *padapter) -+{ -+ struct eeprom_priv *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ u8 *hwinfo = NULL; -+ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("====>_ReadEfuseInfo8723BS()\n")); -+ -+ /* */ -+ /* This part read and parse the eeprom/efuse content */ -+ /* */ -+ -+ if (sizeof(pEEPROM->efuse_eeprom_data) < HWSET_MAX_SIZE_8723B) -+ DBG_871X("[WARNING] size of efuse_eeprom_data is less than HWSET_MAX_SIZE_8723B!\n"); -+ -+ hwinfo = pEEPROM->efuse_eeprom_data; -+ -+ Hal_InitPGData(padapter, hwinfo); -+ -+ Hal_EfuseParseIDCode(padapter, hwinfo); -+ Hal_EfuseParseEEPROMVer_8723B(padapter, hwinfo, pEEPROM->bautoload_fail_flag); -+ -+ Hal_EfuseParseMACAddr_8723BS(padapter, hwinfo, pEEPROM->bautoload_fail_flag); -+ -+ Hal_EfuseParseTxPowerInfo_8723B(padapter, hwinfo, pEEPROM->bautoload_fail_flag); -+ Hal_EfuseParseBoardType_8723BS(padapter, hwinfo, pEEPROM->bautoload_fail_flag); -+ -+ /* */ -+ /* Read Bluetooth co-exist and initialize */ -+ /* */ -+ Hal_EfuseParsePackageType_8723B(padapter, hwinfo, pEEPROM->bautoload_fail_flag); -+ Hal_EfuseParseBTCoexistInfo_8723B(padapter, hwinfo, pEEPROM->bautoload_fail_flag); -+ Hal_EfuseParseChnlPlan_8723B(padapter, hwinfo, pEEPROM->bautoload_fail_flag); -+ Hal_EfuseParseXtal_8723B(padapter, hwinfo, pEEPROM->bautoload_fail_flag); -+ Hal_EfuseParseThermalMeter_8723B(padapter, hwinfo, pEEPROM->bautoload_fail_flag); -+ Hal_EfuseParseAntennaDiversity_8723B(padapter, hwinfo, pEEPROM->bautoload_fail_flag); -+ Hal_EfuseParseCustomerID_8723B(padapter, hwinfo, pEEPROM->bautoload_fail_flag); -+ -+ Hal_EfuseParseVoltage_8723B(padapter, hwinfo, pEEPROM->bautoload_fail_flag); -+ -+#ifdef CONFIG_WOWLAN -+ Hal_DetectWoWMode(padapter); -+#endif -+ -+ Hal_ReadRFGainOffset(padapter, hwinfo, pEEPROM->bautoload_fail_flag); -+ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("<==== _ReadEfuseInfo8723BS()\n")); -+} -+ -+static void _ReadPROMContent(struct adapter *padapter) -+{ -+ struct eeprom_priv *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ u8 eeValue; -+ -+ eeValue = rtw_read8(padapter, REG_9346CR); -+ /* To check system boot selection. */ -+ pEEPROM->EepromOrEfuse = (eeValue & BOOT_FROM_EEPROM) ? true : false; -+ pEEPROM->bautoload_fail_flag = (eeValue & EEPROM_EN) ? false : true; -+ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, -+ ("%s: 9346CR = 0x%02X, Boot from %s, Autoload %s\n", -+ __func__, eeValue, -+ (pEEPROM->EepromOrEfuse ? "EEPROM" : "EFUSE"), -+ (pEEPROM->bautoload_fail_flag ? "Fail" : "OK"))); -+ -+/* pHalData->EEType = IS_BOOT_FROM_EEPROM(Adapter) ? EEPROM_93C46 : EEPROM_BOOT_EFUSE; */ -+ -+ _ReadEfuseInfo8723BS(padapter); -+} -+ -+static void _InitOtherVariable(struct adapter *Adapter) -+{ -+} -+ -+/* */ -+/* Description: */ -+/* Read HW adapter information by E-Fuse or EEPROM according CR9346 reported. */ -+/* */ -+/* Assumption: */ -+/* PASSIVE_LEVEL (SDIO interface) */ -+/* */ -+/* */ -+static s32 _ReadAdapterInfo8723BS(struct adapter *padapter) -+{ -+ u8 val8; -+ unsigned long start; -+ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("+_ReadAdapterInfo8723BS\n")); -+ -+ /* before access eFuse, make sure card enable has been called */ -+ if (padapter->hw_init_completed == false) -+ _InitPowerOn_8723BS(padapter); -+ -+ -+ val8 = rtw_read8(padapter, 0x4e); -+ MSG_8192C("%s, 0x4e = 0x%x\n", __func__, val8); -+ val8 |= BIT(6); -+ rtw_write8(padapter, 0x4e, val8); -+ -+ -+ start = jiffies; -+ -+ _EfuseCellSel(padapter); -+ _ReadRFType(padapter); -+ _ReadPROMContent(padapter); -+ _InitOtherVariable(padapter); -+ -+ if (padapter->hw_init_completed == false) { -+ rtw_write8(padapter, 0x67, 0x00); /* for BT, Switch Ant control to BT */ -+ CardDisableRTL8723BSdio(padapter);/* for the power consumption issue, wifi ko module is loaded during booting, but wifi GUI is off */ -+ } -+ -+ -+ MSG_8192C("<==== _ReadAdapterInfo8723BS in %d ms\n", jiffies_to_msecs(jiffies - start)); -+ -+ return _SUCCESS; -+} -+ -+static void ReadAdapterInfo8723BS(struct adapter *padapter) -+{ -+ /* Read EEPROM size before call any EEPROM function */ -+ padapter->EepromAddressSize = GetEEPROMSize8723B(padapter); -+ -+ _ReadAdapterInfo8723BS(padapter); -+} -+ -+/* -+ * If variable not handled here, -+ * some variables will be processed in SetHwReg8723B() -+ */ -+static void SetHwReg8723BS(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ struct hal_com_data *pHalData; -+ u8 val8; -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ struct wowlan_ioctl_param *poidparam; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ int res; -+ u32 tmp; -+ u16 len = 0; -+ u8 trycnt = 100; -+ u32 himr = 0; -+#if defined(CONFIG_WOWLAN) -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_info *psta = NULL; -+ u64 iv_low = 0, iv_high = 0; -+ u8 mstatus = (*(u8 *)val); -+#endif -+#endif -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ switch (variable) { -+ case HW_VAR_SET_RPWM: -+ /* rpwm value only use BIT0(clock bit) , BIT6(Ack bit), and BIT7(Toggle bit) */ -+ /* BIT0 value - 1: 32k, 0:40MHz. */ -+ /* BIT6 value - 1: report cpwm value after success set, 0:do not report. */ -+ /* BIT7 value - Toggle bit change. */ -+ { -+ val8 = *val; -+ val8 &= 0xC1; -+ rtw_write8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HRPWM1, val8); -+ } -+ break; -+ case HW_VAR_SET_REQ_FW_PS: -+ { -+ u8 req_fw_ps = 0; -+ req_fw_ps = rtw_read8(padapter, 0x8f); -+ req_fw_ps |= 0x10; -+ rtw_write8(padapter, 0x8f, req_fw_ps); -+ } -+ break; -+ case HW_VAR_RXDMA_AGG_PG_TH: -+ val8 = *val; -+ break; -+ -+#ifdef CONFIG_WOWLAN -+ case HW_VAR_WOWLAN: -+ { -+ poidparam = (struct wowlan_ioctl_param *)val; -+ switch (poidparam->subcode) { -+ case WOWLAN_ENABLE: -+ DBG_871X_LEVEL(_drv_always_, "WOWLAN_ENABLE\n"); -+ -+ /* backup data rate to register 0x8b for wowlan FW */ -+ rtw_write8(padapter, 0x8d, 1); -+ rtw_write8(padapter, 0x8c, 0); -+ rtw_write8(padapter, 0x8f, 0x40); -+ rtw_write8(padapter, 0x8b, -+ rtw_read8(padapter, 0x2f0)); -+ -+ /* 1. Download WOWLAN FW */ -+ DBG_871X_LEVEL(_drv_always_, "Re-download WoWlan FW!\n"); -+ SetFwRelatedForWoWLAN8723b(padapter, true); -+ -+ /* 2. RX DMA stop */ -+ DBG_871X_LEVEL(_drv_always_, "Pause DMA\n"); -+ rtw_write32(padapter, REG_RXPKT_NUM, (rtw_read32(padapter, REG_RXPKT_NUM)|RW_RELEASE_EN)); -+ do { -+ if ((rtw_read32(padapter, REG_RXPKT_NUM)&RXDMA_IDLE)) { -+ DBG_871X_LEVEL(_drv_always_, "RX_DMA_IDLE is true\n"); -+ break; -+ } else { -+ /* If RX_DMA is not idle, receive one pkt from DMA */ -+ res = sdio_local_read(padapter, SDIO_REG_RX0_REQ_LEN, 4, (u8 *)&tmp); -+ len = le16_to_cpu(tmp); -+ DBG_871X_LEVEL(_drv_always_, "RX len:%d\n", len); -+ if (len > 0) -+ res = RecvOnePkt(padapter, len); -+ else -+ DBG_871X_LEVEL(_drv_always_, "read length fail %d\n", len); -+ -+ DBG_871X_LEVEL(_drv_always_, "RecvOnePkt Result: %d\n", res); -+ } -+ } while (trycnt--); -+ if (trycnt == 0) -+ DBG_871X_LEVEL(_drv_always_, "Stop RX DMA failed......\n"); -+ -+ /* 3. Clear IMR and ISR */ -+ DBG_871X_LEVEL(_drv_always_, "Clear IMR and ISR\n"); -+ tmp = 0; -+ sdio_local_write(padapter, SDIO_REG_HIMR_ON, 4, (u8 *)&tmp); -+ sdio_local_write(padapter, SDIO_REG_HIMR, 4, (u8 *)&tmp); -+ sdio_local_read(padapter, SDIO_REG_HISR, 4, (u8 *)&tmp); -+ sdio_local_write(padapter, SDIO_REG_HISR, 4, (u8 *)&tmp); -+ -+ /* 4. Enable CPWM2 only */ -+ DBG_871X_LEVEL(_drv_always_, "Enable only CPWM2\n"); -+ sdio_local_read(padapter, SDIO_REG_HIMR, 4, (u8 *)&tmp); -+ DBG_871X("DisableInterruptButCpwm28723BSdio(): Read SDIO_REG_HIMR: 0x%08x\n", tmp); -+ -+ himr = cpu_to_le32(SDIO_HIMR_DISABLED)|SDIO_HIMR_CPWM2_MSK; -+ sdio_local_write(padapter, SDIO_REG_HIMR, 4, (u8 *)&himr); -+ -+ sdio_local_read(padapter, SDIO_REG_HIMR, 4, (u8 *)&tmp); -+ DBG_871X("DisableInterruptButCpwm28723BSdio(): Read again SDIO_REG_HIMR: 0x%08x\n", tmp); -+ -+ /* 5. Set Enable WOWLAN H2C command. */ -+ DBG_871X_LEVEL(_drv_always_, "Set Enable WOWLan cmd\n"); -+ rtl8723b_set_wowlan_cmd(padapter, 1); -+ -+ /* 6. Check EnableWoWlan CMD is ready */ -+ if (!pwrctl->wowlan_pno_enable) { -+ DBG_871X_LEVEL(_drv_always_, "Check EnableWoWlan CMD is ready\n"); -+ mstatus = rtw_read8(padapter, REG_WOW_CTRL); -+ trycnt = 10; -+ while (!(mstatus&BIT1) && trycnt > 1) { -+ mstatus = rtw_read8(padapter, REG_WOW_CTRL); -+ DBG_871X("Loop index: %d :0x%02x\n", trycnt, mstatus); -+ trycnt--; -+ msleep(2); -+ } -+ } -+ break; -+ -+ case WOWLAN_DISABLE: -+ DBG_871X_LEVEL(_drv_always_, "WOWLAN_DISABLE\n"); -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(pmlmepriv)); -+ if (psta != NULL) -+ rtl8723b_set_FwMediaStatusRpt_cmd(padapter, RT_MEDIA_DISCONNECT, psta->mac_id); -+ else -+ DBG_871X("psta is null\n"); -+ -+ /* 1. Read wakeup reason */ -+ pwrctl->wowlan_wake_reason = rtw_read8(padapter, REG_WOWLAN_WAKE_REASON); -+ DBG_871X_LEVEL( -+ _drv_always_, -+ "wakeup_reason: 0x%02x, mac_630 = 0x%08x, mac_634 = 0x%08x, mac_1c0 = 0x%08x, mac_1c4 = 0x%08x" -+ ", mac_494 = 0x%08x, , mac_498 = 0x%08x, mac_49c = 0x%08x, mac_608 = 0x%08x, mac_4a0 = 0x%08x, mac_4a4 = 0x%08x\n" -+ ", mac_1cc = 0x%08x, mac_2f0 = 0x%08x, mac_2f4 = 0x%08x, mac_2f8 = 0x%08x, mac_2fc = 0x%08x, mac_8c = 0x%08x", -+ pwrctl->wowlan_wake_reason, -+ rtw_read32(padapter, REG_WOWLAN_GTK_DBG1), -+ rtw_read32(padapter, REG_WOWLAN_GTK_DBG2), -+ rtw_read32(padapter, 0x1c0), -+ rtw_read32(padapter, 0x1c4), -+ rtw_read32(padapter, 0x494), -+ rtw_read32(padapter, 0x498), -+ rtw_read32(padapter, 0x49c), -+ rtw_read32(padapter, 0x608), -+ rtw_read32(padapter, 0x4a0), -+ rtw_read32(padapter, 0x4a4), -+ rtw_read32(padapter, 0x1cc), -+ rtw_read32(padapter, 0x2f0), -+ rtw_read32(padapter, 0x2f4), -+ rtw_read32(padapter, 0x2f8), -+ rtw_read32(padapter, 0x2fc), -+ rtw_read32(padapter, 0x8c) -+ ); -+#ifdef CONFIG_PNO_SET_DEBUG -+ DBG_871X("0x1b9: 0x%02x, 0x632: 0x%02x\n", rtw_read8(padapter, 0x1b9), rtw_read8(padapter, 0x632)); -+ DBG_871X("0x4fc: 0x%02x, 0x4fd: 0x%02x\n", rtw_read8(padapter, 0x4fc), rtw_read8(padapter, 0x4fd)); -+ DBG_871X("TXDMA STATUS: 0x%08x\n", rtw_read32(padapter, REG_TXDMA_STATUS)); -+#endif -+ -+ { -+ /* 2. Set Disable WOWLAN H2C command. */ -+ DBG_871X_LEVEL(_drv_always_, "Set Disable WOWLan cmd\n"); -+ rtl8723b_set_wowlan_cmd(padapter, 0); -+ -+ /* 3. Check Disable WoWlan CMD ready. */ -+ DBG_871X_LEVEL(_drv_always_, "Check DisableWoWlan CMD is ready\n"); -+ mstatus = rtw_read8(padapter, REG_WOW_CTRL); -+ trycnt = 50; -+ while (mstatus&BIT1 && trycnt > 1) { -+ mstatus = rtw_read8(padapter, REG_WOW_CTRL); -+ DBG_871X_LEVEL(_drv_always_, "Loop index: %d :0x%02x\n", trycnt, mstatus); -+ trycnt--; -+ msleep(10); -+ } -+ -+ if (mstatus & BIT1) { -+ DBG_871X_LEVEL(_drv_always_, "Disable WOW mode fail!!\n"); -+ DBG_871X("Set 0x690 = 0x00\n"); -+ rtw_write8(padapter, REG_WOW_CTRL, (rtw_read8(padapter, REG_WOW_CTRL)&0xf0)); -+ DBG_871X_LEVEL(_drv_always_, "Release RXDMA\n"); -+ rtw_write32(padapter, REG_RXPKT_NUM, (rtw_read32(padapter, REG_RXPKT_NUM)&(~RW_RELEASE_EN))); -+ } -+ -+ /* 3.1 read fw iv */ -+ iv_low = rtw_read32(padapter, REG_TXPKTBUF_IV_LOW); -+ /* only low two bytes is PN, check AES_IV macro for detail */ -+ iv_low &= 0xffff; -+ iv_high = rtw_read32(padapter, REG_TXPKTBUF_IV_HIGH); -+ /* get the real packet number */ -+ pwrctl->wowlan_fw_iv = iv_high << 16 | iv_low; -+ DBG_871X_LEVEL(_drv_always_, "fw_iv: 0x%016llx\n", pwrctl->wowlan_fw_iv); -+ /* Update TX iv data. */ -+ rtw_set_sec_pn(padapter); -+ -+ /* 3.2 read GTK index and key */ -+ if ( -+ psecuritypriv->binstallKCK_KEK == true && -+ psecuritypriv->dot11PrivacyAlgrthm == _AES_ -+ ) { -+ u8 gtk_keyindex = 0; -+ u8 get_key[16]; -+ /* read gtk key index */ -+ gtk_keyindex = rtw_read8(padapter, 0x48c); -+ -+ if (gtk_keyindex < 4) { -+ psecuritypriv->dot118021XGrpKeyid = gtk_keyindex; -+ read_cam(padapter, gtk_keyindex, get_key); -+ memcpy(psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey, get_key, 16); -+ DBG_871X_LEVEL( -+ _drv_always_, -+ "GTK (%d) = 0x%08x, 0x%08x, 0x%08x, 0x%08x\n", -+ gtk_keyindex, -+ psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].lkey[0], -+ psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].lkey[1], -+ psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].lkey[2], -+ psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].lkey[3] -+ ); -+ } else -+ DBG_871X_LEVEL(_drv_always_, "GTK index =%d\n", gtk_keyindex); -+ } -+ -+ /* 4. Re-download Normal FW. */ -+ DBG_871X_LEVEL(_drv_always_, "Re-download Normal FW!\n"); -+ SetFwRelatedForWoWLAN8723b(padapter, false); -+ } -+#ifdef CONFIG_GPIO_WAKEUP -+ DBG_871X_LEVEL(_drv_always_, "Set Wake GPIO to high for default.\n"); -+ HalSetOutPutGPIO(padapter, WAKEUP_GPIO_IDX, 1); -+#endif -+ -+ /* 5. Download reserved pages and report media status if needed. */ -+ if ( -+ (pwrctl->wowlan_wake_reason != FWDecisionDisconnect) && -+ (pwrctl->wowlan_wake_reason != Rx_Pairwisekey) && -+ (pwrctl->wowlan_wake_reason != Rx_DisAssoc) && -+ (pwrctl->wowlan_wake_reason != Rx_DeAuth) -+ ) { -+ rtl8723b_set_FwJoinBssRpt_cmd(padapter, RT_MEDIA_CONNECT); -+ if (psta != NULL) -+ rtl8723b_set_FwMediaStatusRpt_cmd(padapter, RT_MEDIA_CONNECT, psta->mac_id); -+ } -+#ifdef CONFIG_PNO_SUPPORT -+ rtw_write8(padapter, 0x1b8, 0); -+ DBG_871X("reset 0x1b8: %d\n", rtw_read8(padapter, 0x1b8)); -+ rtw_write8(padapter, 0x1b9, 0); -+ DBG_871X("reset 0x1b9: %d\n", rtw_read8(padapter, 0x1b9)); -+ rtw_write8(padapter, REG_PNO_STATUS, 0); -+ DBG_871X("reset REG_PNO_STATUS: %d\n", rtw_read8(padapter, REG_PNO_STATUS)); -+#endif -+ break; -+ -+ default: -+ break; -+ } -+ } -+ break; -+#endif /* CONFIG_WOWLAN */ -+#ifdef CONFIG_AP_WOWLAN -+ case HW_VAR_AP_WOWLAN: -+ { -+ poidparam = (struct wowlan_ioctl_param *)val; -+ switch (poidparam->subcode) { -+ case WOWLAN_AP_ENABLE: -+ DBG_871X("%s, WOWLAN_AP_ENABLE\n", __func__); -+ /* 1. Download WOWLAN FW */ -+ DBG_871X_LEVEL(_drv_always_, "Re-download WoWlan FW!\n"); -+ SetFwRelatedForWoWLAN8723b(padapter, true); -+ -+ /* 2. RX DMA stop */ -+ DBG_871X_LEVEL(_drv_always_, "Pause DMA\n"); -+ rtw_write32(padapter, REG_RXPKT_NUM, -+ (rtw_read32(padapter, REG_RXPKT_NUM)|RW_RELEASE_EN)); -+ do { -+ if ((rtw_read32(padapter, REG_RXPKT_NUM)&RXDMA_IDLE)) { -+ DBG_871X_LEVEL(_drv_always_, "RX_DMA_IDLE is true\n"); -+ break; -+ } else { -+ /* If RX_DMA is not idle, receive one pkt from DMA */ -+ res = sdio_local_read(padapter, SDIO_REG_RX0_REQ_LEN, 4, (u8 *)&tmp); -+ len = le16_to_cpu(tmp); -+ -+ DBG_871X_LEVEL(_drv_always_, "RX len:%d\n", len); -+ if (len > 0) -+ res = RecvOnePkt(padapter, len); -+ else -+ DBG_871X_LEVEL(_drv_always_, "read length fail %d\n", len); -+ -+ DBG_871X_LEVEL(_drv_always_, "RecvOnePkt Result: %d\n", res); -+ } -+ } while (trycnt--); -+ -+ if (trycnt == 0) -+ DBG_871X_LEVEL(_drv_always_, "Stop RX DMA failed......\n"); -+ -+ /* 3. Clear IMR and ISR */ -+ DBG_871X_LEVEL(_drv_always_, "Clear IMR and ISR\n"); -+ tmp = 0; -+ sdio_local_write(padapter, SDIO_REG_HIMR_ON, 4, (u8 *)&tmp); -+ sdio_local_write(padapter, SDIO_REG_HIMR, 4, (u8 *)&tmp); -+ sdio_local_read(padapter, SDIO_REG_HISR, 4, (u8 *)&tmp); -+ sdio_local_write(padapter, SDIO_REG_HISR, 4, (u8 *)&tmp); -+ -+ /* 4. Enable CPWM2 only */ -+ DBG_871X_LEVEL(_drv_always_, "Enable only CPWM2\n"); -+ sdio_local_read(padapter, SDIO_REG_HIMR, 4, (u8 *)&tmp); -+ DBG_871X("DisableInterruptButCpwm28723BSdio(): Read SDIO_REG_HIMR: 0x%08x\n", tmp); -+ -+ himr = cpu_to_le32(SDIO_HIMR_DISABLED)|SDIO_HIMR_CPWM2_MSK; -+ sdio_local_write(padapter, SDIO_REG_HIMR, 4, (u8 *)&himr); -+ -+ sdio_local_read(padapter, SDIO_REG_HIMR, 4, (u8 *)&tmp); -+ DBG_871X("DisableInterruptButCpwm28723BSdio(): Read again SDIO_REG_HIMR: 0x%08x\n", tmp); -+ -+ /* 5. Set Enable WOWLAN H2C command. */ -+ DBG_871X_LEVEL(_drv_always_, "Set Enable AP WOWLan cmd\n"); -+ rtl8723b_set_ap_wowlan_cmd(padapter, 1); -+ /* 6. add some delay for H2C cmd ready */ -+ msleep(10); -+ -+ rtw_write8(padapter, REG_WOWLAN_WAKE_REASON, 0); -+ break; -+ case WOWLAN_AP_DISABLE: -+ DBG_871X("%s, WOWLAN_AP_DISABLE\n", __func__); -+ /* 1. Read wakeup reason */ -+ pwrctl->wowlan_wake_reason = -+ rtw_read8(padapter, REG_WOWLAN_WAKE_REASON); -+ -+ DBG_871X_LEVEL(_drv_always_, "wakeup_reason: 0x%02x\n", -+ pwrctl->wowlan_wake_reason); -+ -+ /* 2. Set Disable WOWLAN H2C command. */ -+ DBG_871X_LEVEL(_drv_always_, "Set Disable WOWLan cmd\n"); -+ rtl8723b_set_ap_wowlan_cmd(padapter, 0); -+ /* 6. add some delay for H2C cmd ready */ -+ msleep(2); -+ -+ DBG_871X_LEVEL(_drv_always_, "Release RXDMA\n"); -+ -+ rtw_write32(padapter, REG_RXPKT_NUM, -+ (rtw_read32(padapter, REG_RXPKT_NUM) & (~RW_RELEASE_EN))); -+ -+ SetFwRelatedForWoWLAN8723b(padapter, false); -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ DBG_871X_LEVEL(_drv_always_, "Set Wake GPIO to high for default.\n"); -+ HalSetOutPutGPIO(padapter, WAKEUP_GPIO_IDX, 1); -+#endif /* CONFIG_GPIO_WAKEUP */ -+ rtl8723b_set_FwJoinBssRpt_cmd(padapter, RT_MEDIA_CONNECT); -+ issue_beacon(padapter, 0); -+ break; -+ default: -+ break; -+ } -+} -+ break; -+#endif /* CONFIG_AP_WOWLAN */ -+ case HW_VAR_DM_IN_LPS: -+ rtl8723b_hal_dm_in_lps(padapter); -+ break; -+ default: -+ SetHwReg8723B(padapter, variable, val); -+ break; -+ } -+} -+ -+/* -+ * If variable not handled here, -+ * some variables will be processed in GetHwReg8723B() -+ */ -+static void GetHwReg8723BS(struct adapter *padapter, u8 variable, u8 *val) -+{ -+ switch (variable) { -+ case HW_VAR_CPWM: -+ *val = rtw_read8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HCPWM1_8723B); -+ break; -+ -+ case HW_VAR_FW_PS_STATE: -+ { -+ /* 3. read dword 0x88 driver read fw ps state */ -+ *((u16 *)val) = rtw_read16(padapter, 0x88); -+ } -+ break; -+ default: -+ GetHwReg8723B(padapter, variable, val); -+ break; -+ } -+} -+ -+static void SetHwRegWithBuf8723B(struct adapter *padapter, u8 variable, u8 *pbuf, int len) -+{ -+ switch (variable) { -+ case HW_VAR_C2H_HANDLE: -+ /* DBG_8192C("%s len =%d\n", __func__, len); */ -+ C2HPacketHandler_8723B(padapter, pbuf, len); -+ break; -+ default: -+ break; -+ } -+} -+ -+/* */ -+/* Description: */ -+/* Query setting of specified variable. */ -+/* */ -+static u8 GetHalDefVar8723BSDIO( -+ struct adapter *Adapter, enum HAL_DEF_VARIABLE eVariable, void *pValue -+) -+{ -+ u8 bResult = _SUCCESS; -+ -+ switch (eVariable) { -+ case HAL_DEF_IS_SUPPORT_ANT_DIV: -+ break; -+ case HAL_DEF_CURRENT_ANTENNA: -+ break; -+ case HW_VAR_MAX_RX_AMPDU_FACTOR: -+ /* Stanley@BB.SD3 suggests 16K can get stable performance */ -+ /* coding by Lucas@20130730 */ -+ *(u32 *)pValue = MAX_AMPDU_FACTOR_16K; -+ break; -+ default: -+ bResult = GetHalDefVar8723B(Adapter, eVariable, pValue); -+ break; -+ } -+ -+ return bResult; -+} -+ -+/* */ -+/* Description: */ -+/* Change default setting of specified variable. */ -+/* */ -+static u8 SetHalDefVar8723BSDIO(struct adapter *Adapter, -+ enum HAL_DEF_VARIABLE eVariable, void *pValue) -+{ -+ return SetHalDefVar8723B(Adapter, eVariable, pValue); -+} -+ -+void rtl8723bs_set_hal_ops(struct adapter *padapter) -+{ -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ -+ rtl8723b_set_hal_ops(pHalFunc); -+ -+ pHalFunc->hal_init = &rtl8723bs_hal_init; -+ pHalFunc->hal_deinit = &rtl8723bs_hal_deinit; -+ -+ pHalFunc->inirp_init = &rtl8723bs_inirp_init; -+ pHalFunc->inirp_deinit = &rtl8723bs_inirp_deinit; -+ -+ pHalFunc->init_xmit_priv = &rtl8723bs_init_xmit_priv; -+ pHalFunc->free_xmit_priv = &rtl8723bs_free_xmit_priv; -+ -+ pHalFunc->init_recv_priv = &rtl8723bs_init_recv_priv; -+ pHalFunc->free_recv_priv = &rtl8723bs_free_recv_priv; -+ -+ pHalFunc->init_default_value = &rtl8723bs_init_default_value; -+ pHalFunc->intf_chip_configure = &rtl8723bs_interface_configure; -+ pHalFunc->read_adapter_info = &ReadAdapterInfo8723BS; -+ -+ pHalFunc->enable_interrupt = &EnableInterrupt8723BSdio; -+ pHalFunc->disable_interrupt = &DisableInterrupt8723BSdio; -+ pHalFunc->check_ips_status = &CheckIPSStatus; -+#ifdef CONFIG_WOWLAN -+ pHalFunc->clear_interrupt = &ClearInterrupt8723BSdio; -+#endif -+ pHalFunc->SetHwRegHandler = &SetHwReg8723BS; -+ pHalFunc->GetHwRegHandler = &GetHwReg8723BS; -+ pHalFunc->SetHwRegHandlerWithBuf = &SetHwRegWithBuf8723B; -+ pHalFunc->GetHalDefVarHandler = &GetHalDefVar8723BSDIO; -+ pHalFunc->SetHalDefVarHandler = &SetHalDefVar8723BSDIO; -+ -+ pHalFunc->hal_xmit = &rtl8723bs_hal_xmit; -+ pHalFunc->mgnt_xmit = &rtl8723bs_mgnt_xmit; -+ pHalFunc->hal_xmitframe_enqueue = &rtl8723bs_hal_xmitframe_enqueue; -+ -+#if defined(CONFIG_CHECK_BT_HANG) -+ pHalFunc->hal_init_checkbthang_workqueue = &rtl8723bs_init_checkbthang_workqueue; -+ pHalFunc->hal_free_checkbthang_workqueue = &rtl8723bs_free_checkbthang_workqueue; -+ pHalFunc->hal_cancle_checkbthang_workqueue = &rtl8723bs_cancle_checkbthang_workqueue; -+ pHalFunc->hal_checke_bt_hang = &rtl8723bs_hal_check_bt_hang; -+#endif -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/hal/sdio_ops.c linux/3rdparty/rtl8723bs/hal/sdio_ops.c ---- linux.old/3rdparty/rtl8723bs/hal/sdio_ops.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/hal/sdio_ops.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1296 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *******************************************************************************/ -+#define _SDIO_OPS_C_ -+ -+#include -+#include -+#include -+ -+/* define SDIO_DEBUG_IO 1 */ -+ -+ -+/* */ -+/* Description: */ -+/* The following mapping is for SDIO host local register space. */ -+/* */ -+/* Creadted by Roger, 2011.01.31. */ -+/* */ -+static void HalSdioGetCmdAddr8723BSdio( -+ struct adapter *padapter, -+ u8 DeviceID, -+ u32 Addr, -+ u32 *pCmdAddr -+) -+{ -+ switch (DeviceID) { -+ case SDIO_LOCAL_DEVICE_ID: -+ *pCmdAddr = ((SDIO_LOCAL_DEVICE_ID << 13) | (Addr & SDIO_LOCAL_MSK)); -+ break; -+ -+ case WLAN_IOREG_DEVICE_ID: -+ *pCmdAddr = ((WLAN_IOREG_DEVICE_ID << 13) | (Addr & WLAN_IOREG_MSK)); -+ break; -+ -+ case WLAN_TX_HIQ_DEVICE_ID: -+ *pCmdAddr = ((WLAN_TX_HIQ_DEVICE_ID << 13) | (Addr & WLAN_FIFO_MSK)); -+ break; -+ -+ case WLAN_TX_MIQ_DEVICE_ID: -+ *pCmdAddr = ((WLAN_TX_MIQ_DEVICE_ID << 13) | (Addr & WLAN_FIFO_MSK)); -+ break; -+ -+ case WLAN_TX_LOQ_DEVICE_ID: -+ *pCmdAddr = ((WLAN_TX_LOQ_DEVICE_ID << 13) | (Addr & WLAN_FIFO_MSK)); -+ break; -+ -+ case WLAN_RX0FF_DEVICE_ID: -+ *pCmdAddr = ((WLAN_RX0FF_DEVICE_ID << 13) | (Addr & WLAN_RX0FF_MSK)); -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+static u8 get_deviceid(u32 addr) -+{ -+ u8 devideId; -+ u16 pseudoId; -+ -+ -+ pseudoId = (u16)(addr >> 16); -+ switch (pseudoId) { -+ case 0x1025: -+ devideId = SDIO_LOCAL_DEVICE_ID; -+ break; -+ -+ case 0x1026: -+ devideId = WLAN_IOREG_DEVICE_ID; -+ break; -+ -+/* case 0x1027: */ -+/* devideId = SDIO_FIRMWARE_FIFO; */ -+/* break; */ -+ -+ case 0x1031: -+ devideId = WLAN_TX_HIQ_DEVICE_ID; -+ break; -+ -+ case 0x1032: -+ devideId = WLAN_TX_MIQ_DEVICE_ID; -+ break; -+ -+ case 0x1033: -+ devideId = WLAN_TX_LOQ_DEVICE_ID; -+ break; -+ -+ case 0x1034: -+ devideId = WLAN_RX0FF_DEVICE_ID; -+ break; -+ -+ default: -+/* devideId = (u8)((addr >> 13) & 0xF); */ -+ devideId = WLAN_IOREG_DEVICE_ID; -+ break; -+ } -+ -+ return devideId; -+} -+ -+/* -+ * Ref: -+ *HalSdioGetCmdAddr8723BSdio() -+ */ -+static u32 _cvrt2ftaddr(const u32 addr, u8 *pdeviceId, u16 *poffset) -+{ -+ u8 deviceId; -+ u16 offset; -+ u32 ftaddr; -+ -+ -+ deviceId = get_deviceid(addr); -+ offset = 0; -+ -+ switch (deviceId) { -+ case SDIO_LOCAL_DEVICE_ID: -+ offset = addr & SDIO_LOCAL_MSK; -+ break; -+ -+ case WLAN_TX_HIQ_DEVICE_ID: -+ case WLAN_TX_MIQ_DEVICE_ID: -+ case WLAN_TX_LOQ_DEVICE_ID: -+ offset = addr & WLAN_FIFO_MSK; -+ break; -+ -+ case WLAN_RX0FF_DEVICE_ID: -+ offset = addr & WLAN_RX0FF_MSK; -+ break; -+ -+ case WLAN_IOREG_DEVICE_ID: -+ default: -+ deviceId = WLAN_IOREG_DEVICE_ID; -+ offset = addr & WLAN_IOREG_MSK; -+ break; -+ } -+ ftaddr = (deviceId << 13) | offset; -+ -+ if (pdeviceId) -+ *pdeviceId = deviceId; -+ if (poffset) -+ *poffset = offset; -+ -+ return ftaddr; -+} -+ -+static u8 sdio_read8(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ u32 ftaddr; -+ u8 val; -+ -+ ftaddr = _cvrt2ftaddr(addr, NULL, NULL); -+ val = sd_read8(pintfhdl, ftaddr, NULL); -+ return val; -+} -+ -+static u16 sdio_read16(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ u32 ftaddr; -+ u16 val; -+ __le16 le_tmp; -+ -+ ftaddr = _cvrt2ftaddr(addr, NULL, NULL); -+ sd_cmd52_read(pintfhdl, ftaddr, 2, (u8 *)&le_tmp); -+ val = le16_to_cpu(le_tmp); -+ return val; -+} -+ -+static u32 sdio_read32(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ struct adapter *padapter; -+ u8 bMacPwrCtrlOn; -+ u8 deviceId; -+ u16 offset; -+ u32 ftaddr; -+ u8 shift; -+ u32 val; -+ s32 err; -+ __le32 le_tmp; -+ -+ padapter = pintfhdl->padapter; -+ ftaddr = _cvrt2ftaddr(addr, &deviceId, &offset); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if ( -+ ((deviceId == WLAN_IOREG_DEVICE_ID) && (offset < 0x100)) || -+ (false == bMacPwrCtrlOn) || -+ (true == adapter_to_pwrctl(padapter)->bFwCurrentInPSMode) -+ ) { -+ err = sd_cmd52_read(pintfhdl, ftaddr, 4, (u8 *)&le_tmp); -+#ifdef SDIO_DEBUG_IO -+ if (!err) { -+#endif -+ val = le32_to_cpu(le_tmp); -+ return val; -+#ifdef SDIO_DEBUG_IO -+ } -+ -+ DBG_8192C(KERN_ERR "%s: Mac Power off, Read FAIL(%d)! addr = 0x%x\n", __func__, err, addr); -+ return SDIO_ERR_VAL32; -+#endif -+ } -+ -+ /* 4 bytes alignment */ -+ shift = ftaddr & 0x3; -+ if (shift == 0) { -+ val = sd_read32(pintfhdl, ftaddr, NULL); -+ } else { -+ u8 *ptmpbuf; -+ -+ ptmpbuf = (u8 *)rtw_malloc(8); -+ if (NULL == ptmpbuf) { -+ DBG_8192C(KERN_ERR "%s: Allocate memory FAIL!(size =8) addr = 0x%x\n", __func__, addr); -+ return SDIO_ERR_VAL32; -+ } -+ -+ ftaddr &= ~(u16)0x3; -+ sd_read(pintfhdl, ftaddr, 8, ptmpbuf); -+ memcpy(&le_tmp, ptmpbuf+shift, 4); -+ val = le32_to_cpu(le_tmp); -+ -+ kfree(ptmpbuf); -+ } -+ return val; -+} -+ -+static s32 sdio_readN(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pbuf) -+{ -+ struct adapter *padapter; -+ u8 bMacPwrCtrlOn; -+ u8 deviceId; -+ u16 offset; -+ u32 ftaddr; -+ u8 shift; -+ s32 err; -+ -+ padapter = pintfhdl->padapter; -+ err = 0; -+ -+ ftaddr = _cvrt2ftaddr(addr, &deviceId, &offset); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if ( -+ ((deviceId == WLAN_IOREG_DEVICE_ID) && (offset < 0x100)) || -+ (false == bMacPwrCtrlOn) || -+ (true == adapter_to_pwrctl(padapter)->bFwCurrentInPSMode) -+ ) { -+ err = sd_cmd52_read(pintfhdl, ftaddr, cnt, pbuf); -+ return err; -+ } -+ -+ /* 4 bytes alignment */ -+ shift = ftaddr & 0x3; -+ if (shift == 0) { -+ err = sd_read(pintfhdl, ftaddr, cnt, pbuf); -+ } else { -+ u8 *ptmpbuf; -+ u32 n; -+ -+ ftaddr &= ~(u16)0x3; -+ n = cnt + shift; -+ ptmpbuf = rtw_malloc(n); -+ if (NULL == ptmpbuf) -+ return -1; -+ -+ err = sd_read(pintfhdl, ftaddr, n, ptmpbuf); -+ if (!err) -+ memcpy(pbuf, ptmpbuf+shift, cnt); -+ kfree(ptmpbuf); -+ } -+ return err; -+} -+ -+static s32 sdio_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val) -+{ -+ u32 ftaddr; -+ s32 err; -+ -+ ftaddr = _cvrt2ftaddr(addr, NULL, NULL); -+ sd_write8(pintfhdl, ftaddr, val, &err); -+ -+ return err; -+} -+ -+static s32 sdio_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val) -+{ -+ u32 ftaddr; -+ s32 err; -+ __le16 le_tmp; -+ -+ ftaddr = _cvrt2ftaddr(addr, NULL, NULL); -+ le_tmp = cpu_to_le16(val); -+ err = sd_cmd52_write(pintfhdl, ftaddr, 2, (u8 *)&le_tmp); -+ -+ return err; -+} -+ -+static s32 sdio_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val) -+{ -+ struct adapter *padapter; -+ u8 bMacPwrCtrlOn; -+ u8 deviceId; -+ u16 offset; -+ u32 ftaddr; -+ u8 shift; -+ s32 err; -+ __le32 le_tmp; -+ -+ padapter = pintfhdl->padapter; -+ err = 0; -+ -+ ftaddr = _cvrt2ftaddr(addr, &deviceId, &offset); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if ( -+ ((deviceId == WLAN_IOREG_DEVICE_ID) && (offset < 0x100)) || -+ (!bMacPwrCtrlOn) || -+ (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode) -+ ) { -+ le_tmp = cpu_to_le32(val); -+ err = sd_cmd52_write(pintfhdl, ftaddr, 4, (u8 *)&le_tmp); -+ return err; -+ } -+ -+ /* 4 bytes alignment */ -+ shift = ftaddr & 0x3; -+ if (shift == 0) { -+ sd_write32(pintfhdl, ftaddr, val, &err); -+ } else { -+ le_tmp = cpu_to_le32(val); -+ err = sd_cmd52_write(pintfhdl, ftaddr, 4, (u8 *)&le_tmp); -+ } -+ return err; -+} -+ -+static s32 sdio_writeN(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pbuf) -+{ -+ struct adapter *padapter; -+ u8 bMacPwrCtrlOn; -+ u8 deviceId; -+ u16 offset; -+ u32 ftaddr; -+ u8 shift; -+ s32 err; -+ -+ padapter = pintfhdl->padapter; -+ err = 0; -+ -+ ftaddr = _cvrt2ftaddr(addr, &deviceId, &offset); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if ( -+ ((deviceId == WLAN_IOREG_DEVICE_ID) && (offset < 0x100)) || -+ (false == bMacPwrCtrlOn) || -+ (true == adapter_to_pwrctl(padapter)->bFwCurrentInPSMode) -+ ) { -+ err = sd_cmd52_write(pintfhdl, ftaddr, cnt, pbuf); -+ return err; -+ } -+ -+ shift = ftaddr & 0x3; -+ if (shift == 0) { -+ err = sd_write(pintfhdl, ftaddr, cnt, pbuf); -+ } else { -+ u8 *ptmpbuf; -+ u32 n; -+ -+ ftaddr &= ~(u16)0x3; -+ n = cnt + shift; -+ ptmpbuf = rtw_malloc(n); -+ if (NULL == ptmpbuf) -+ return -1; -+ err = sd_read(pintfhdl, ftaddr, 4, ptmpbuf); -+ if (err) { -+ kfree(ptmpbuf); -+ return err; -+ } -+ memcpy(ptmpbuf+shift, pbuf, cnt); -+ err = sd_write(pintfhdl, ftaddr, n, ptmpbuf); -+ kfree(ptmpbuf); -+ } -+ return err; -+} -+ -+static u8 sdio_f0_read8(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ return sd_f0_read8(pintfhdl, addr, NULL); -+} -+ -+static void sdio_read_mem( -+ struct intf_hdl *pintfhdl, -+ u32 addr, -+ u32 cnt, -+ u8 *rmem -+) -+{ -+ s32 err; -+ -+ err = sdio_readN(pintfhdl, addr, cnt, rmem); -+ /* TODO: Report error is err not zero */ -+} -+ -+static void sdio_write_mem( -+ struct intf_hdl *pintfhdl, -+ u32 addr, -+ u32 cnt, -+ u8 *wmem -+) -+{ -+ sdio_writeN(pintfhdl, addr, cnt, wmem); -+} -+ -+/* -+ * Description: -+ *Read from RX FIFO -+ *Round read size to block size, -+ *and make sure data transfer will be done in one command. -+ * -+ * Parameters: -+ *pintfhdl a pointer of intf_hdl -+ *addr port ID -+ *cnt size to read -+ *rmem address to put data -+ * -+ * Return: -+ *_SUCCESS(1) Success -+ *_FAIL(0) Fail -+ */ -+static u32 sdio_read_port( -+ struct intf_hdl *pintfhdl, -+ u32 addr, -+ u32 cnt, -+ u8 *mem -+) -+{ -+ struct adapter *padapter; -+ PSDIO_DATA psdio; -+ struct hal_com_data *phal; -+ u32 oldcnt; -+#ifdef SDIO_DYNAMIC_ALLOC_MEM -+ u8 *oldmem; -+#endif -+ s32 err; -+ -+ -+ padapter = pintfhdl->padapter; -+ psdio = &adapter_to_dvobj(padapter)->intf_data; -+ phal = GET_HAL_DATA(padapter); -+ -+ HalSdioGetCmdAddr8723BSdio(padapter, addr, phal->SdioRxFIFOCnt++, &addr); -+ -+ oldcnt = cnt; -+ if (cnt > psdio->block_transfer_len) -+ cnt = _RND(cnt, psdio->block_transfer_len); -+/* cnt = sdio_align_size(cnt); */ -+ -+ if (oldcnt != cnt) { -+#ifdef SDIO_DYNAMIC_ALLOC_MEM -+ oldmem = mem; -+ mem = rtw_malloc(cnt); -+ if (mem == NULL) { -+ DBG_8192C(KERN_WARNING "%s: allocate memory %d bytes fail!\n", __func__, cnt); -+ mem = oldmem; -+ oldmem == NULL; -+ } -+#else -+ /* in this case, caller should gurante the buffer is big enough */ -+ /* to receive data after alignment */ -+#endif -+ } -+ -+ err = _sd_read(pintfhdl, addr, cnt, mem); -+ -+#ifdef SDIO_DYNAMIC_ALLOC_MEM -+ if ((oldcnt != cnt) && (oldmem)) { -+ memcpy(oldmem, mem, oldcnt); -+ kfree(mem); -+ } -+#endif -+ -+ if (err) -+ return _FAIL; -+ return _SUCCESS; -+} -+ -+/* -+ * Description: -+ *Write to TX FIFO -+ *Align write size block size, -+ *and make sure data could be written in one command. -+ * -+ * Parameters: -+ *pintfhdl a pointer of intf_hdl -+ *addr port ID -+ *cnt size to write -+ *wmem data pointer to write -+ * -+ * Return: -+ *_SUCCESS(1) Success -+ *_FAIL(0) Fail -+ */ -+static u32 sdio_write_port( -+ struct intf_hdl *pintfhdl, -+ u32 addr, -+ u32 cnt, -+ u8 *mem -+) -+{ -+ struct adapter *padapter; -+ PSDIO_DATA psdio; -+ s32 err; -+ struct xmit_buf *xmitbuf = (struct xmit_buf *)mem; -+ -+ padapter = pintfhdl->padapter; -+ psdio = &adapter_to_dvobj(padapter)->intf_data; -+ -+ if (padapter->hw_init_completed == false) { -+ DBG_871X("%s [addr = 0x%x cnt =%d] padapter->hw_init_completed == false\n", __func__, addr, cnt); -+ return _FAIL; -+ } -+ -+ cnt = _RND4(cnt); -+ HalSdioGetCmdAddr8723BSdio(padapter, addr, cnt >> 2, &addr); -+ -+ if (cnt > psdio->block_transfer_len) -+ cnt = _RND(cnt, psdio->block_transfer_len); -+/* cnt = sdio_align_size(cnt); */ -+ -+ err = sd_write(pintfhdl, addr, cnt, xmitbuf->pdata); -+ -+ rtw_sctx_done_err( -+ &xmitbuf->sctx, -+ err ? RTW_SCTX_DONE_WRITE_PORT_ERR : RTW_SCTX_DONE_SUCCESS -+ ); -+ -+ if (err) -+ return _FAIL; -+ return _SUCCESS; -+} -+ -+void sdio_set_intf_ops(struct adapter *padapter, struct _io_ops *pops) -+{ -+ pops->_read8 = &sdio_read8; -+ pops->_read16 = &sdio_read16; -+ pops->_read32 = &sdio_read32; -+ pops->_read_mem = &sdio_read_mem; -+ pops->_read_port = &sdio_read_port; -+ -+ pops->_write8 = &sdio_write8; -+ pops->_write16 = &sdio_write16; -+ pops->_write32 = &sdio_write32; -+ pops->_writeN = &sdio_writeN; -+ pops->_write_mem = &sdio_write_mem; -+ pops->_write_port = &sdio_write_port; -+ -+ pops->_sd_f0_read8 = sdio_f0_read8; -+} -+ -+/* -+ * Todo: align address to 4 bytes. -+ */ -+static s32 _sdio_local_read( -+ struct adapter *padapter, -+ u32 addr, -+ u32 cnt, -+ u8 *pbuf -+) -+{ -+ struct intf_hdl *pintfhdl; -+ u8 bMacPwrCtrlOn; -+ s32 err; -+ u8 *ptmpbuf; -+ u32 n; -+ -+ -+ pintfhdl = &padapter->iopriv.intf; -+ -+ HalSdioGetCmdAddr8723BSdio(padapter, SDIO_LOCAL_DEVICE_ID, addr, &addr); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if (false == bMacPwrCtrlOn) { -+ err = _sd_cmd52_read(pintfhdl, addr, cnt, pbuf); -+ return err; -+ } -+ -+ n = RND4(cnt); -+ ptmpbuf = (u8 *)rtw_malloc(n); -+ if (!ptmpbuf) -+ return (-1); -+ -+ err = _sd_read(pintfhdl, addr, n, ptmpbuf); -+ if (!err) -+ memcpy(pbuf, ptmpbuf, cnt); -+ -+ if (ptmpbuf) -+ kfree(ptmpbuf); -+ -+ return err; -+} -+ -+/* -+ * Todo: align address to 4 bytes. -+ */ -+s32 sdio_local_read( -+ struct adapter *padapter, -+ u32 addr, -+ u32 cnt, -+ u8 *pbuf -+) -+{ -+ struct intf_hdl *pintfhdl; -+ u8 bMacPwrCtrlOn; -+ s32 err; -+ u8 *ptmpbuf; -+ u32 n; -+ -+ pintfhdl = &padapter->iopriv.intf; -+ -+ HalSdioGetCmdAddr8723BSdio(padapter, SDIO_LOCAL_DEVICE_ID, addr, &addr); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if ( -+ (false == bMacPwrCtrlOn) || -+ (true == adapter_to_pwrctl(padapter)->bFwCurrentInPSMode) -+ ) { -+ err = sd_cmd52_read(pintfhdl, addr, cnt, pbuf); -+ return err; -+ } -+ -+ n = RND4(cnt); -+ ptmpbuf = (u8 *)rtw_malloc(n); -+ if (!ptmpbuf) -+ return (-1); -+ -+ err = sd_read(pintfhdl, addr, n, ptmpbuf); -+ if (!err) -+ memcpy(pbuf, ptmpbuf, cnt); -+ -+ if (ptmpbuf) -+ kfree(ptmpbuf); -+ -+ return err; -+} -+ -+/* -+ * Todo: align address to 4 bytes. -+ */ -+s32 sdio_local_write( -+ struct adapter *padapter, -+ u32 addr, -+ u32 cnt, -+ u8 *pbuf -+) -+{ -+ struct intf_hdl *pintfhdl; -+ u8 bMacPwrCtrlOn; -+ s32 err; -+ u8 *ptmpbuf; -+ -+ if (addr & 0x3) -+ DBG_8192C("%s, address must be 4 bytes alignment\n", __func__); -+ -+ if (cnt & 0x3) -+ DBG_8192C("%s, size must be the multiple of 4\n", __func__); -+ -+ pintfhdl = &padapter->iopriv.intf; -+ -+ HalSdioGetCmdAddr8723BSdio(padapter, SDIO_LOCAL_DEVICE_ID, addr, &addr); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if ( -+ (false == bMacPwrCtrlOn) || -+ (true == adapter_to_pwrctl(padapter)->bFwCurrentInPSMode) -+ ) { -+ err = sd_cmd52_write(pintfhdl, addr, cnt, pbuf); -+ return err; -+ } -+ -+ ptmpbuf = (u8 *)rtw_malloc(cnt); -+ if (!ptmpbuf) -+ return (-1); -+ -+ memcpy(ptmpbuf, pbuf, cnt); -+ -+ err = sd_write(pintfhdl, addr, cnt, ptmpbuf); -+ -+ kfree(ptmpbuf); -+ -+ return err; -+} -+ -+u8 SdioLocalCmd52Read1Byte(struct adapter *padapter, u32 addr) -+{ -+ u8 val = 0; -+ struct intf_hdl *pintfhdl = &padapter->iopriv.intf; -+ -+ HalSdioGetCmdAddr8723BSdio(padapter, SDIO_LOCAL_DEVICE_ID, addr, &addr); -+ sd_cmd52_read(pintfhdl, addr, 1, &val); -+ -+ return val; -+} -+ -+static u16 SdioLocalCmd52Read2Byte(struct adapter *padapter, u32 addr) -+{ -+ __le16 val = 0; -+ struct intf_hdl *pintfhdl = &padapter->iopriv.intf; -+ -+ HalSdioGetCmdAddr8723BSdio(padapter, SDIO_LOCAL_DEVICE_ID, addr, &addr); -+ sd_cmd52_read(pintfhdl, addr, 2, (u8 *)&val); -+ -+ return le16_to_cpu(val); -+} -+ -+static u32 SdioLocalCmd53Read4Byte(struct adapter *padapter, u32 addr) -+{ -+ -+ u8 bMacPwrCtrlOn; -+ u32 val = 0; -+ struct intf_hdl *pintfhdl = &padapter->iopriv.intf; -+ __le32 le_tmp; -+ -+ HalSdioGetCmdAddr8723BSdio(padapter, SDIO_LOCAL_DEVICE_ID, addr, &addr); -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if (!bMacPwrCtrlOn || adapter_to_pwrctl(padapter)->bFwCurrentInPSMode) { -+ sd_cmd52_read(pintfhdl, addr, 4, (u8 *)&le_tmp); -+ val = le32_to_cpu(le_tmp); -+ } else { -+ val = sd_read32(pintfhdl, addr, NULL); -+ } -+ return val; -+} -+ -+void SdioLocalCmd52Write1Byte(struct adapter *padapter, u32 addr, u8 v) -+{ -+ struct intf_hdl *pintfhdl = &padapter->iopriv.intf; -+ -+ HalSdioGetCmdAddr8723BSdio(padapter, SDIO_LOCAL_DEVICE_ID, addr, &addr); -+ sd_cmd52_write(pintfhdl, addr, 1, &v); -+} -+ -+static void SdioLocalCmd52Write4Byte(struct adapter *padapter, u32 addr, u32 v) -+{ -+ struct intf_hdl *pintfhdl = &padapter->iopriv.intf; -+ __le32 le_tmp; -+ -+ HalSdioGetCmdAddr8723BSdio(padapter, SDIO_LOCAL_DEVICE_ID, addr, &addr); -+ le_tmp = cpu_to_le32(v); -+ sd_cmd52_write(pintfhdl, addr, 4, (u8 *)&le_tmp); -+} -+ -+static s32 ReadInterrupt8723BSdio(struct adapter *padapter, u32 *phisr) -+{ -+ u32 hisr, himr; -+ u8 val8, hisr_len; -+ -+ -+ if (phisr == NULL) -+ return false; -+ -+ himr = GET_HAL_DATA(padapter)->sdio_himr; -+ -+ /* decide how many bytes need to be read */ -+ hisr_len = 0; -+ while (himr) { -+ hisr_len++; -+ himr >>= 8; -+ } -+ -+ hisr = 0; -+ while (hisr_len != 0) { -+ hisr_len--; -+ val8 = SdioLocalCmd52Read1Byte(padapter, SDIO_REG_HISR+hisr_len); -+ hisr |= (val8 << (8*hisr_len)); -+ } -+ -+ *phisr = hisr; -+ -+ return true; -+} -+ -+/* */ -+/* Description: */ -+/* Initialize SDIO Host Interrupt Mask configuration variables for future use. */ -+/* */ -+/* Assumption: */ -+/* Using SDIO Local register ONLY for configuration. */ -+/* */ -+/* Created by Roger, 2011.02.11. */ -+/* */ -+void InitInterrupt8723BSdio(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pHalData->sdio_himr = (u32)( \ -+ SDIO_HIMR_RX_REQUEST_MSK | -+ SDIO_HIMR_AVAL_MSK | -+/* SDIO_HIMR_TXERR_MSK | */ -+/* SDIO_HIMR_RXERR_MSK | */ -+/* SDIO_HIMR_TXFOVW_MSK | */ -+/* SDIO_HIMR_RXFOVW_MSK | */ -+/* SDIO_HIMR_TXBCNOK_MSK | */ -+/* SDIO_HIMR_TXBCNERR_MSK | */ -+/* SDIO_HIMR_BCNERLY_INT_MSK | */ -+/* SDIO_HIMR_C2HCMD_MSK | */ -+/* SDIO_HIMR_HSISR_IND_MSK | */ -+/* SDIO_HIMR_GTINT3_IND_MSK | */ -+/* SDIO_HIMR_GTINT4_IND_MSK | */ -+/* SDIO_HIMR_PSTIMEOUT_MSK | */ -+/* SDIO_HIMR_OCPINT_MSK | */ -+/* SDIO_HIMR_ATIMEND_MSK | */ -+/* SDIO_HIMR_ATIMEND_E_MSK | */ -+/* SDIO_HIMR_CTWEND_MSK | */ -+ 0); -+} -+ -+/* */ -+/* Description: */ -+/* Initialize System Host Interrupt Mask configuration variables for future use. */ -+/* */ -+/* Created by Roger, 2011.08.03. */ -+/* */ -+void InitSysInterrupt8723BSdio(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ pHalData->SysIntrMask = ( \ -+/* HSIMR_GPIO12_0_INT_EN | */ -+/* HSIMR_SPS_OCP_INT_EN | */ -+/* HSIMR_RON_INT_EN | */ -+/* HSIMR_PDNINT_EN | */ -+/* HSIMR_GPIO9_INT_EN | */ -+ 0); -+} -+ -+#ifdef CONFIG_WOWLAN -+/* */ -+/* Description: */ -+/* Clear corresponding SDIO Host ISR interrupt service. */ -+/* */ -+/* Assumption: */ -+/* Using SDIO Local register ONLY for configuration. */ -+/* */ -+/* Created by Roger, 2011.02.11. */ -+/* */ -+void ClearInterrupt8723BSdio(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ u8 *clear; -+ -+ -+ if (true == padapter->bSurpriseRemoved) -+ return; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ clear = rtw_zmalloc(4); -+ -+ /* Clear corresponding HISR Content if needed */ -+ *(__le32 *)clear = cpu_to_le32(pHalData->sdio_hisr & MASK_SDIO_HISR_CLEAR); -+ if (*(__le32 *)clear) { -+ /* Perform write one clear operation */ -+ sdio_local_write(padapter, SDIO_REG_HISR, 4, clear); -+ } -+ -+ kfree(clear); -+} -+#endif -+ -+/* */ -+/* Description: */ -+/* Enalbe SDIO Host Interrupt Mask configuration on SDIO local domain. */ -+/* */ -+/* Assumption: */ -+/* 1. Using SDIO Local register ONLY for configuration. */ -+/* 2. PASSIVE LEVEL */ -+/* */ -+/* Created by Roger, 2011.02.11. */ -+/* */ -+void EnableInterrupt8723BSdio(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData; -+ __le32 himr; -+ u32 tmp; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ himr = cpu_to_le32(pHalData->sdio_himr); -+ sdio_local_write(padapter, SDIO_REG_HIMR, 4, (u8 *)&himr); -+ -+ RT_TRACE( -+ _module_hci_ops_c_, -+ _drv_notice_, -+ ( -+ "%s: enable SDIO HIMR = 0x%08X\n", -+ __func__, -+ pHalData->sdio_himr -+ ) -+ ); -+ -+ /* Update current system IMR settings */ -+ tmp = rtw_read32(padapter, REG_HSIMR); -+ rtw_write32(padapter, REG_HSIMR, tmp | pHalData->SysIntrMask); -+ -+ RT_TRACE( -+ _module_hci_ops_c_, -+ _drv_notice_, -+ ( -+ "%s: enable HSIMR = 0x%08X\n", -+ __func__, -+ pHalData->SysIntrMask -+ ) -+ ); -+ -+ /* */ -+ /* There are some C2H CMDs have been sent before system interrupt is enabled, e.g., C2H, CPWM. */ -+ /* So we need to clear all C2H events that FW has notified, otherwise FW won't schedule any commands anymore. */ -+ /* 2011.10.19. */ -+ /* */ -+ rtw_write8(padapter, REG_C2HEVT_CLEAR, C2H_EVT_HOST_CLOSE); -+} -+ -+/* */ -+/* Description: */ -+/* Disable SDIO Host IMR configuration to mask unnecessary interrupt service. */ -+/* */ -+/* Assumption: */ -+/* Using SDIO Local register ONLY for configuration. */ -+/* */ -+/* Created by Roger, 2011.02.11. */ -+/* */ -+void DisableInterrupt8723BSdio(struct adapter *padapter) -+{ -+ __le32 himr; -+ -+ himr = cpu_to_le32(SDIO_HIMR_DISABLED); -+ sdio_local_write(padapter, SDIO_REG_HIMR, 4, (u8 *)&himr); -+} -+ -+/* */ -+/* Description: */ -+/* Using 0x100 to check the power status of FW. */ -+/* */ -+/* Assumption: */ -+/* Using SDIO Local register ONLY for configuration. */ -+/* */ -+/* Created by Isaac, 2013.09.10. */ -+/* */ -+u8 CheckIPSStatus(struct adapter *padapter) -+{ -+ DBG_871X( -+ "%s(): Read 0x100 = 0x%02x 0x86 = 0x%02x\n", -+ __func__, -+ rtw_read8(padapter, 0x100), -+ rtw_read8(padapter, 0x86) -+ ); -+ -+ if (rtw_read8(padapter, 0x100) == 0xEA) -+ return true; -+ else -+ return false; -+} -+ -+static struct recv_buf *sd_recv_rxfifo(struct adapter *padapter, u32 size) -+{ -+ u32 readsize, ret; -+ u8 *preadbuf; -+ struct recv_priv *precvpriv; -+ struct recv_buf *precvbuf; -+ -+ -+ /* Patch for some SDIO Host 4 bytes issue */ -+ /* ex. RK3188 */ -+ readsize = RND4(size); -+ -+ /* 3 1. alloc recvbuf */ -+ precvpriv = &padapter->recvpriv; -+ precvbuf = rtw_dequeue_recvbuf(&precvpriv->free_recv_buf_queue); -+ if (precvbuf == NULL) { -+ DBG_871X_LEVEL(_drv_err_, "%s: alloc recvbuf FAIL!\n", __func__); -+ return NULL; -+ } -+ -+ /* 3 2. alloc skb */ -+ if (precvbuf->pskb == NULL) { -+ SIZE_PTR tmpaddr = 0; -+ SIZE_PTR alignment = 0; -+ -+ precvbuf->pskb = rtw_skb_alloc(MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ); -+ -+ if (precvbuf->pskb) { -+ precvbuf->pskb->dev = padapter->pnetdev; -+ -+ tmpaddr = (SIZE_PTR)precvbuf->pskb->data; -+ alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1); -+ skb_reserve(precvbuf->pskb, (RECVBUFF_ALIGN_SZ - alignment)); -+ } -+ -+ if (precvbuf->pskb == NULL) { -+ DBG_871X("%s: alloc_skb fail! read =%d\n", __func__, readsize); -+ return NULL; -+ } -+ } -+ -+ /* 3 3. read data from rxfifo */ -+ preadbuf = precvbuf->pskb->data; -+ ret = sdio_read_port(&padapter->iopriv.intf, WLAN_RX0FF_DEVICE_ID, readsize, preadbuf); -+ if (ret == _FAIL) { -+ RT_TRACE(_module_hci_ops_os_c_, _drv_err_, ("%s: read port FAIL!\n", __func__)); -+ return NULL; -+ } -+ -+ -+ /* 3 4. init recvbuf */ -+ precvbuf->len = size; -+ precvbuf->phead = precvbuf->pskb->head; -+ precvbuf->pdata = precvbuf->pskb->data; -+ skb_set_tail_pointer(precvbuf->pskb, size); -+ precvbuf->ptail = skb_tail_pointer(precvbuf->pskb); -+ precvbuf->pend = skb_end_pointer(precvbuf->pskb); -+ -+ return precvbuf; -+} -+ -+static void sd_rxhandler(struct adapter *padapter, struct recv_buf *precvbuf) -+{ -+ struct recv_priv *precvpriv; -+ struct __queue *ppending_queue; -+ -+ precvpriv = &padapter->recvpriv; -+ ppending_queue = &precvpriv->recv_buf_pending_queue; -+ -+ /* 3 1. enqueue recvbuf */ -+ rtw_enqueue_recvbuf(precvbuf, ppending_queue); -+ -+ /* 3 2. schedule tasklet */ -+ tasklet_schedule(&precvpriv->recv_tasklet); -+} -+ -+void sd_int_dpc(struct adapter *padapter) -+{ -+ struct hal_com_data *phal; -+ struct dvobj_priv *dvobj; -+ struct intf_hdl *pintfhdl = &padapter->iopriv.intf; -+ struct pwrctrl_priv *pwrctl; -+ -+ -+ phal = GET_HAL_DATA(padapter); -+ dvobj = adapter_to_dvobj(padapter); -+ pwrctl = dvobj_to_pwrctl(dvobj); -+ -+ if (phal->sdio_hisr & SDIO_HISR_AVAL) { -+ u8 freepage[4]; -+ -+ _sdio_local_read(padapter, SDIO_REG_FREE_TXPG, 4, freepage); -+ up(&(padapter->xmitpriv.xmit_sema)); -+ } -+ -+ if (phal->sdio_hisr & SDIO_HISR_CPWM1) { -+ struct reportpwrstate_parm report; -+ -+ u8 bcancelled; -+ _cancel_timer(&(pwrctl->pwr_rpwm_timer), &bcancelled); -+ -+ report.state = SdioLocalCmd52Read1Byte(padapter, SDIO_REG_HCPWM1_8723B); -+ -+ /* cpwm_int_hdl(padapter, &report); */ -+ _set_workitem(&(pwrctl->cpwm_event)); -+ } -+ -+ if (phal->sdio_hisr & SDIO_HISR_TXERR) { -+ u8 *status; -+ u32 addr; -+ -+ status = rtw_malloc(4); -+ if (status) { -+ addr = REG_TXDMA_STATUS; -+ HalSdioGetCmdAddr8723BSdio(padapter, WLAN_IOREG_DEVICE_ID, addr, &addr); -+ _sd_read(pintfhdl, addr, 4, status); -+ _sd_write(pintfhdl, addr, 4, status); -+ DBG_8192C("%s: SDIO_HISR_TXERR (0x%08x)\n", __func__, le32_to_cpu(*(u32 *)status)); -+ kfree(status); -+ } else { -+ DBG_8192C("%s: SDIO_HISR_TXERR, but can't allocate memory to read status!\n", __func__); -+ } -+ } -+ -+ if (phal->sdio_hisr & SDIO_HISR_TXBCNOK) { -+ DBG_8192C("%s: SDIO_HISR_TXBCNOK\n", __func__); -+ } -+ -+ if (phal->sdio_hisr & SDIO_HISR_TXBCNERR) { -+ DBG_8192C("%s: SDIO_HISR_TXBCNERR\n", __func__); -+ } -+#ifndef CONFIG_C2H_PACKET_EN -+ if (phal->sdio_hisr & SDIO_HISR_C2HCMD) { -+ struct c2h_evt_hdr_88xx *c2h_evt; -+ -+ DBG_8192C("%s: C2H Command\n", __func__); -+ c2h_evt = (struct c2h_evt_hdr_88xx *)rtw_zmalloc(16); -+ if (c2h_evt != NULL) { -+ if (rtw_hal_c2h_evt_read(padapter, (u8 *)c2h_evt) == _SUCCESS) { -+ if (c2h_id_filter_ccx_8723b((u8 *)c2h_evt)) { -+ /* Handle CCX report here */ -+ rtw_hal_c2h_handler(padapter, (u8 *)c2h_evt); -+ kfree((u8 *)c2h_evt); -+ } else { -+ rtw_c2h_wk_cmd(padapter, (u8 *)c2h_evt); -+ } -+ } -+ } else { -+ /* Error handling for malloc fail */ -+ if (rtw_cbuf_push(padapter->evtpriv.c2h_queue, (void *)NULL) != _SUCCESS) -+ DBG_871X("%s rtw_cbuf_push fail\n", __func__); -+ _set_workitem(&padapter->evtpriv.c2h_wk); -+ } -+ } -+#endif -+ -+ if (phal->sdio_hisr & SDIO_HISR_RXFOVW) { -+ DBG_8192C("%s: Rx Overflow\n", __func__); -+ } -+ -+ if (phal->sdio_hisr & SDIO_HISR_RXERR) { -+ DBG_8192C("%s: Rx Error\n", __func__); -+ } -+ -+ if (phal->sdio_hisr & SDIO_HISR_RX_REQUEST) { -+ struct recv_buf *precvbuf; -+ int alloc_fail_time = 0; -+ u32 hisr; -+ -+/* DBG_8192C("%s: RX Request, size =%d\n", __func__, phal->SdioRxFIFOSize); */ -+ phal->sdio_hisr ^= SDIO_HISR_RX_REQUEST; -+ do { -+ phal->SdioRxFIFOSize = SdioLocalCmd52Read2Byte(padapter, SDIO_REG_RX0_REQ_LEN); -+ if (phal->SdioRxFIFOSize != 0) { -+ precvbuf = sd_recv_rxfifo(padapter, phal->SdioRxFIFOSize); -+ if (precvbuf) -+ sd_rxhandler(padapter, precvbuf); -+ else { -+ alloc_fail_time++; -+ DBG_871X("precvbuf is Null for %d times because alloc memory failed\n", alloc_fail_time); -+ if (alloc_fail_time >= 10) -+ break; -+ } -+ phal->SdioRxFIFOSize = 0; -+ } else -+ break; -+ -+ hisr = 0; -+ ReadInterrupt8723BSdio(padapter, &hisr); -+ hisr &= SDIO_HISR_RX_REQUEST; -+ if (!hisr) -+ break; -+ } while (1); -+ -+ if (alloc_fail_time == 10) -+ DBG_871X("exit because alloc memory failed more than 10 times\n"); -+ -+ } -+} -+ -+void sd_int_hdl(struct adapter *padapter) -+{ -+ struct hal_com_data *phal; -+ -+ -+ if ( -+ (padapter->bDriverStopped == true) || -+ (padapter->bSurpriseRemoved == true) -+ ) -+ return; -+ -+ phal = GET_HAL_DATA(padapter); -+ -+ phal->sdio_hisr = 0; -+ ReadInterrupt8723BSdio(padapter, &phal->sdio_hisr); -+ -+ if (phal->sdio_hisr & phal->sdio_himr) { -+ u32 v32; -+ -+ phal->sdio_hisr &= phal->sdio_himr; -+ -+ /* clear HISR */ -+ v32 = phal->sdio_hisr & MASK_SDIO_HISR_CLEAR; -+ if (v32) { -+ SdioLocalCmd52Write4Byte(padapter, SDIO_REG_HISR, v32); -+ } -+ -+ sd_int_dpc(padapter); -+ } else { -+ RT_TRACE(_module_hci_ops_c_, _drv_err_, -+ ("%s: HISR(0x%08x) and HIMR(0x%08x) not match!\n", -+ __func__, phal->sdio_hisr, phal->sdio_himr)); -+ } -+} -+ -+/* */ -+/* Description: */ -+/* Query SDIO Local register to query current the number of Free TxPacketBuffer page. */ -+/* */ -+/* Assumption: */ -+/* 1. Running at PASSIVE_LEVEL */ -+/* 2. RT_TX_SPINLOCK is NOT acquired. */ -+/* */ -+/* Created by Roger, 2011.01.28. */ -+/* */ -+u8 HalQueryTxBufferStatus8723BSdio(struct adapter *padapter) -+{ -+ struct hal_com_data *phal; -+ u32 NumOfFreePage; -+ /* _irqL irql; */ -+ -+ -+ phal = GET_HAL_DATA(padapter); -+ -+ NumOfFreePage = SdioLocalCmd53Read4Byte(padapter, SDIO_REG_FREE_TXPG); -+ -+ /* spin_lock_bh(&phal->SdioTxFIFOFreePageLock); */ -+ memcpy(phal->SdioTxFIFOFreePage, &NumOfFreePage, 4); -+ RT_TRACE(_module_hci_ops_c_, _drv_notice_, -+ ("%s: Free page for HIQ(%#x), MIDQ(%#x), LOWQ(%#x), PUBQ(%#x)\n", -+ __func__, -+ phal->SdioTxFIFOFreePage[HI_QUEUE_IDX], -+ phal->SdioTxFIFOFreePage[MID_QUEUE_IDX], -+ phal->SdioTxFIFOFreePage[LOW_QUEUE_IDX], -+ phal->SdioTxFIFOFreePage[PUBLIC_QUEUE_IDX])); -+ /* spin_unlock_bh(&phal->SdioTxFIFOFreePageLock); */ -+ -+ return true; -+} -+ -+/* */ -+/* Description: */ -+/* Query SDIO Local register to get the current number of TX OQT Free Space. */ -+/* */ -+u8 HalQueryTxOQTBufferStatus8723BSdio(struct adapter *padapter) -+{ -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ -+ pHalData->SdioTxOQTFreeSpace = SdioLocalCmd52Read1Byte(padapter, SDIO_REG_OQT_FREE_PG); -+ return true; -+} -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+u8 RecvOnePkt(struct adapter *padapter, u32 size) -+{ -+ struct recv_buf *precvbuf; -+ struct dvobj_priv *psddev; -+ PSDIO_DATA psdio_data; -+ struct sdio_func *func; -+ -+ u8 res = false; -+ -+ DBG_871X("+%s: size: %d+\n", __func__, size); -+ -+ if (padapter == NULL) { -+ DBG_871X(KERN_ERR "%s: padapter is NULL!\n", __func__); -+ return false; -+ } -+ -+ psddev = adapter_to_dvobj(padapter); -+ psdio_data = &psddev->intf_data; -+ func = psdio_data->func; -+ -+ if (size) { -+ sdio_claim_host(func); -+ precvbuf = sd_recv_rxfifo(padapter, size); -+ -+ if (precvbuf) { -+ /* printk("Completed Recv One Pkt.\n"); */ -+ sd_rxhandler(padapter, precvbuf); -+ res = true; -+ } else { -+ res = false; -+ } -+ sdio_release_host(func); -+ } -+ DBG_871X("-%s-\n", __func__); -+ return res; -+} -+#endif /* CONFIG_WOWLAN */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/autoconf.h linux/3rdparty/rtl8723bs/include/autoconf.h ---- linux.old/3rdparty/rtl8723bs/include/autoconf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/autoconf.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,71 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+/* -+ * Automatically generated C config: don't edit -+ */ -+ -+/* -+ * Functions Config -+ */ -+/* define CONFIG_DEBUG_CFG80211 */ -+ -+#ifndef CONFIG_WIRELESS_EXT -+#error CONFIG_WIRELESS_EXT needs to be enabled for this driver to work -+#endif -+ -+/* -+ * Auto Config Section -+ */ -+#define LPS_RPWM_WAIT_MS 300 -+#ifndef DISABLE_BB_RF -+#define DISABLE_BB_RF 0 -+#endif -+ -+#if DISABLE_BB_RF -+ #define HAL_MAC_ENABLE 0 -+ #define HAL_BB_ENABLE 0 -+ #define HAL_RF_ENABLE 0 -+#else -+ #define HAL_MAC_ENABLE 1 -+ #define HAL_BB_ENABLE 1 -+ #define HAL_RF_ENABLE 1 -+#endif -+ -+/* -+ * Platform dependent -+ */ -+#define WAKEUP_GPIO_IDX 12 /* WIFI Chip Side */ -+#ifdef CONFIG_WOWLAN -+#define CONFIG_GTK_OL -+#endif /* CONFIG_WOWLAN */ -+ -+/* -+ * Debug Related Config -+ */ -+#undef CONFIG_DEBUG -+ -+#ifdef CONFIG_DEBUG -+#define DBG 1 /* for ODM & BTCOEX debug */ -+/*#define CONFIG_DEBUG_RTL871X */ -+#else /* !CONFIG_DEBUG */ -+#define DBG 0 /* for ODM & BTCOEX debug */ -+#endif /* !CONFIG_DEBUG */ -+ -+#define CONFIG_PROC_DEBUG -+ -+/* define DBG_XMIT_BUF */ -+/* define DBG_XMIT_BUF_EXT */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/basic_types.h linux/3rdparty/rtl8723bs/include/basic_types.h ---- linux.old/3rdparty/rtl8723bs/include/basic_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/basic_types.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,209 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __BASIC_TYPES_H__ -+#define __BASIC_TYPES_H__ -+ -+ -+#define SUCCESS 0 -+#define FAIL (-1) -+ -+#include -+ -+typedef signed int sint; -+ -+#define FIELD_OFFSET(s, field) ((__kernel_ssize_t)&((s*)(0))->field) -+ -+#define SIZE_PTR __kernel_size_t -+#define SSIZE_PTR __kernel_ssize_t -+ -+/* port from fw by thomas */ -+/* TODO: Belows are Sync from SD7-Driver. It is necessary to check correctness */ -+ -+/* -+ *Call endian free function when -+ * 1. Read/write packet content. -+ * 2. Before write integer to IO. -+ * 3. After read integer from IO. -+*/ -+ -+/* */ -+/* Byte Swapping routine. */ -+/* */ -+#define EF1Byte (u8) -+#define EF2Byte le16_to_cpu -+#define EF4Byte le32_to_cpu -+ -+/* Convert little data endian to host ordering */ -+#define EF1BYTE(_val) \ -+ ((u8)(_val)) -+#define EF2BYTE(_val) \ -+ (le16_to_cpu(_val)) -+#define EF4BYTE(_val) \ -+ (le32_to_cpu(_val)) -+ -+/* Read data from memory */ -+#define READEF1BYTE(_ptr) \ -+ EF1BYTE(*((u8 *)(_ptr))) -+/* Read le16 data from memory and convert to host ordering */ -+#define READEF2BYTE(_ptr) \ -+ EF2BYTE(*(_ptr)) -+#define READEF4BYTE(_ptr) \ -+ EF4BYTE(*(_ptr)) -+ -+/* Write data to memory */ -+#define WRITEEF1BYTE(_ptr, _val) \ -+ do { \ -+ (*((u8 *)(_ptr))) = EF1BYTE(_val); \ -+ } while (0) -+/* Write le data to memory in host ordering */ -+#define WRITEEF2BYTE(_ptr, _val) \ -+ do { \ -+ (*((u16 *)(_ptr))) = EF2BYTE(_val); \ -+ } while (0) -+ -+#define WRITEEF4BYTE(_ptr, _val) \ -+ do { \ -+ (*((u32 *)(_ptr))) = EF2BYTE(_val); \ -+ } while (0) -+ -+/* Create a bit mask -+ * Examples: -+ * BIT_LEN_MASK_32(0) => 0x00000000 -+ * BIT_LEN_MASK_32(1) => 0x00000001 -+ * BIT_LEN_MASK_32(2) => 0x00000003 -+ * BIT_LEN_MASK_32(32) => 0xFFFFFFFF -+ */ -+#define BIT_LEN_MASK_32(__bitlen) \ -+ (0xFFFFFFFF >> (32 - (__bitlen))) -+#define BIT_LEN_MASK_16(__bitlen) \ -+ (0xFFFF >> (16 - (__bitlen))) -+#define BIT_LEN_MASK_8(__bitlen) \ -+ (0xFF >> (8 - (__bitlen))) -+ -+/* Create an offset bit mask -+ * Examples: -+ * BIT_OFFSET_LEN_MASK_32(0, 2) => 0x00000003 -+ * BIT_OFFSET_LEN_MASK_32(16, 2) => 0x00030000 -+ */ -+#define BIT_OFFSET_LEN_MASK_32(__bitoffset, __bitlen) \ -+ (BIT_LEN_MASK_32(__bitlen) << (__bitoffset)) -+#define BIT_OFFSET_LEN_MASK_16(__bitoffset, __bitlen) \ -+ (BIT_LEN_MASK_16(__bitlen) << (__bitoffset)) -+#define BIT_OFFSET_LEN_MASK_8(__bitoffset, __bitlen) \ -+ (BIT_LEN_MASK_8(__bitlen) << (__bitoffset)) -+ -+/*Description: -+ * Return 4-byte value in host byte ordering from -+ * 4-byte pointer in little-endian system. -+ */ -+#define LE_P4BYTE_TO_HOST_4BYTE(__pstart) \ -+ (EF4BYTE(*((__le32 *)(__pstart)))) -+#define LE_P2BYTE_TO_HOST_2BYTE(__pstart) \ -+ (EF2BYTE(*((__le16 *)(__pstart)))) -+#define LE_P1BYTE_TO_HOST_1BYTE(__pstart) \ -+ (EF1BYTE(*((u8 *)(__pstart)))) -+ -+/* */ -+/* Description: */ -+/* Translate subfield (continuous bits in little-endian) of 4-byte value in litten byte to */ -+/* 4-byte value in host byte ordering. */ -+/* */ -+#define LE_BITS_TO_4BYTE(__pstart, __bitoffset, __bitlen) \ -+ (\ -+ (LE_P4BYTE_TO_HOST_4BYTE(__pstart) >> (__bitoffset)) & \ -+ BIT_LEN_MASK_32(__bitlen) \ -+ ) -+#define LE_BITS_TO_2BYTE(__pstart, __bitoffset, __bitlen) \ -+ (\ -+ (LE_P2BYTE_TO_HOST_2BYTE(__pstart) >> (__bitoffset)) & \ -+ BIT_LEN_MASK_16(__bitlen) \ -+ ) -+#define LE_BITS_TO_1BYTE(__pstart, __bitoffset, __bitlen) \ -+ (\ -+ (LE_P1BYTE_TO_HOST_1BYTE(__pstart) >> (__bitoffset)) & \ -+ BIT_LEN_MASK_8(__bitlen) \ -+ ) -+ -+/* */ -+/* Description: */ -+/* Mask subfield (continuous bits in little-endian) of 4-byte value in litten byte oredering */ -+/* and return the result in 4-byte value in host byte ordering. */ -+/* */ -+#define LE_BITS_CLEARED_TO_4BYTE(__pstart, __bitoffset, __bitlen) \ -+ (\ -+ LE_P4BYTE_TO_HOST_4BYTE(__pstart) & \ -+ (~BIT_OFFSET_LEN_MASK_32(__bitoffset, __bitlen)) \ -+ ) -+#define LE_BITS_CLEARED_TO_2BYTE(__pstart, __bitoffset, __bitlen) \ -+ (\ -+ LE_P2BYTE_TO_HOST_2BYTE(__pstart) & \ -+ (~BIT_OFFSET_LEN_MASK_16(__bitoffset, __bitlen)) \ -+ ) -+#define LE_BITS_CLEARED_TO_1BYTE(__pstart, __bitoffset, __bitlen) \ -+ (\ -+ LE_P1BYTE_TO_HOST_1BYTE(__pstart) & \ -+ (~BIT_OFFSET_LEN_MASK_8(__bitoffset, __bitlen)) \ -+ ) -+ -+/* */ -+/* Description: */ -+/* Set subfield of little-endian 4-byte value to specified value. */ -+/* */ -+#define SET_BITS_TO_LE_4BYTE(__pstart, __bitoffset, __bitlen, __val) \ -+ *((u32 *)(__pstart)) = \ -+ ( \ -+ LE_BITS_CLEARED_TO_4BYTE(__pstart, __bitoffset, __bitlen) | \ -+ ((((u32)__val) & BIT_LEN_MASK_32(__bitlen)) << (__bitoffset)) \ -+ ) -+ -+#define SET_BITS_TO_LE_2BYTE(__pstart, __bitoffset, __bitlen, __val) \ -+ *((u16 *)(__pstart)) = \ -+ ( \ -+ LE_BITS_CLEARED_TO_2BYTE(__pstart, __bitoffset, __bitlen) | \ -+ ((((u16)__val) & BIT_LEN_MASK_16(__bitlen)) << (__bitoffset)) \ -+ ); -+ -+#define SET_BITS_TO_LE_1BYTE(__pstart, __bitoffset, __bitlen, __val) \ -+ *((u8 *)(__pstart)) = EF1BYTE \ -+ ( \ -+ LE_BITS_CLEARED_TO_1BYTE(__pstart, __bitoffset, __bitlen) | \ -+ ((((u8)__val) & BIT_LEN_MASK_8(__bitlen)) << (__bitoffset)) \ -+ ) -+ -+#define LE_BITS_CLEARED_TO_1BYTE_8BIT(__pStart, __BitOffset, __BitLen) \ -+ (\ -+ LE_P1BYTE_TO_HOST_1BYTE(__pStart) \ -+ ) -+ -+#define SET_BITS_TO_LE_1BYTE_8BIT(__pStart, __BitOffset, __BitLen, __Value) \ -+{ \ -+ *((u8 *)(__pStart)) = \ -+ EF1Byte(\ -+ LE_BITS_CLEARED_TO_1BYTE_8BIT(__pStart, __BitOffset, __BitLen) \ -+ | \ -+ ((u8)__Value) \ -+ ); \ -+} -+ -+/* Get the N-bytes aligment offset from the current length */ -+#define N_BYTE_ALIGMENT(__Value, __Aligment) ((__Aligment == 1) ? (__Value) : (((__Value + __Aligment - 1) / __Aligment) * __Aligment)) -+ -+#define TEST_FLAG(__Flag, __testFlag) (((__Flag) & (__testFlag)) != 0) -+#define SET_FLAG(__Flag, __setFlag) ((__Flag) |= __setFlag) -+#define CLEAR_FLAG(__Flag, __clearFlag) ((__Flag) &= ~(__clearFlag)) -+#define CLEAR_FLAGS(__Flag) ((__Flag) = 0) -+#define TEST_FLAGS(__Flag, __testFlags) (((__Flag) & (__testFlags)) == (__testFlags)) -+ -+#endif /* __BASIC_TYPES_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/cmd_osdep.h linux/3rdparty/rtl8723bs/include/cmd_osdep.h ---- linux.old/3rdparty/rtl8723bs/include/cmd_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/cmd_osdep.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __CMD_OSDEP_H_ -+#define __CMD_OSDEP_H_ -+ -+ -+extern sint _rtw_init_cmd_priv (struct cmd_priv *pcmdpriv); -+extern sint _rtw_init_evt_priv(struct evt_priv *pevtpriv); -+extern void _rtw_free_evt_priv (struct evt_priv *pevtpriv); -+extern void _rtw_free_cmd_priv (struct cmd_priv *pcmdpriv); -+extern sint _rtw_enqueue_cmd(struct __queue *queue, struct cmd_obj *obj); -+extern struct cmd_obj *_rtw_dequeue_cmd(struct __queue *queue); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/drv_conf.h linux/3rdparty/rtl8723bs/include/drv_conf.h ---- linux.old/3rdparty/rtl8723bs/include/drv_conf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/drv_conf.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,37 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __DRV_CONF_H__ -+#define __DRV_CONF_H__ -+#include "autoconf.h" -+ -+//About USB VENDOR REQ -+#if defined(CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC) && !defined(CONFIG_USB_VENDOR_REQ_MUTEX) -+ #warning "define CONFIG_USB_VENDOR_REQ_MUTEX for CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC automatically" -+ #define CONFIG_USB_VENDOR_REQ_MUTEX -+#endif -+#if defined(CONFIG_VENDOR_REQ_RETRY) && !defined(CONFIG_USB_VENDOR_REQ_MUTEX) -+ #warning "define CONFIG_USB_VENDOR_REQ_MUTEX for CONFIG_VENDOR_REQ_RETRY automatically" -+ #define CONFIG_USB_VENDOR_REQ_MUTEX -+#endif -+ -+#define DYNAMIC_CAMID_ALLOC -+ -+#ifndef CONFIG_RTW_HIQ_FILTER -+ #define CONFIG_RTW_HIQ_FILTER 1 -+#endif -+ -+//#include -+ -+#endif // __DRV_CONF_H__ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/drv_types.h linux/3rdparty/rtl8723bs/include/drv_types.h ---- linux.old/3rdparty/rtl8723bs/include/drv_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/drv_types.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,720 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/*------------------------------------------------------------------------------- -+ -+ For type defines and data structure defines -+ -+--------------------------------------------------------------------------------*/ -+ -+ -+#ifndef __DRV_TYPES_H__ -+#define __DRV_TYPES_H__ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+enum _NIC_VERSION { -+ -+ RTL8711_NIC, -+ RTL8712_NIC, -+ RTL8713_NIC, -+ RTL8716_NIC -+ -+}; -+ -+#include -+ -+#include -+ -+#ifdef CONFIG_INTEL_WIDI -+#include -+#endif -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "ioctl_cfg80211.h" -+ -+#include -+#include -+#include -+ -+#define SPEC_DEV_ID_NONE BIT(0) -+#define SPEC_DEV_ID_DISABLE_HT BIT(1) -+#define SPEC_DEV_ID_ENABLE_PS BIT(2) -+#define SPEC_DEV_ID_RF_CONFIG_1T1R BIT(3) -+#define SPEC_DEV_ID_RF_CONFIG_2T2R BIT(4) -+#define SPEC_DEV_ID_ASSIGN_IFNAME BIT(5) -+ -+struct specific_device_id{ -+ -+ u32 flags; -+ -+ u16 idVendor; -+ u16 idProduct; -+ -+}; -+ -+struct registry_priv -+{ -+ u8 chip_version; -+ u8 rfintfs; -+ u8 lbkmode; -+ u8 hci; -+ struct ndis_802_11_ssid ssid; -+ u8 network_mode; /* infra, ad-hoc, auto */ -+ u8 channel;/* ad-hoc support requirement */ -+ u8 wireless_mode;/* A, B, G, auto */ -+ u8 scan_mode;/* active, passive */ -+ u8 radio_enable; -+ u8 preamble;/* long, short, auto */ -+ u8 vrtl_carrier_sense;/* Enable, Disable, Auto */ -+ u8 vcs_type;/* RTS/CTS, CTS-to-self */ -+ u16 rts_thresh; -+ u16 frag_thresh; -+ u8 adhoc_tx_pwr; -+ u8 soft_ap; -+ u8 power_mgnt; -+ u8 ips_mode; -+ u8 smart_ps; -+ u8 usb_rxagg_mode; -+ u8 long_retry_lmt; -+ u8 short_retry_lmt; -+ u16 busy_thresh; -+ u8 ack_policy; -+ u8 mp_dm; -+ u8 software_encrypt; -+ u8 software_decrypt; -+ u8 acm_method; -+ /* UAPSD */ -+ u8 wmm_enable; -+ u8 uapsd_enable; -+ u8 uapsd_max_sp; -+ u8 uapsd_acbk_en; -+ u8 uapsd_acbe_en; -+ u8 uapsd_acvi_en; -+ u8 uapsd_acvo_en; -+ -+ struct wlan_bssid_ex dev_network; -+ -+ u8 ht_enable; -+ /* 0: 20 MHz, 1: 40 MHz, 2: 80 MHz, 3: 160MHz */ -+ /* 2.4G use bit 0 ~ 3, 5G use bit 4 ~ 7 */ -+ /* 0x21 means enable 2.4G 40MHz & 5G 80MHz */ -+ u8 bw_mode; -+ u8 ampdu_enable;/* for tx */ -+ u8 rx_stbc; -+ u8 ampdu_amsdu;/* A-MPDU Supports A-MSDU is permitted */ -+ /* Short GI support Bit Map */ -+ /* BIT0 - 20MHz, 1: support, 0: non-support */ -+ /* BIT1 - 40MHz, 1: support, 0: non-support */ -+ /* BIT2 - 80MHz, 1: support, 0: non-support */ -+ /* BIT3 - 160MHz, 1: support, 0: non-support */ -+ u8 short_gi; -+ /* BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx */ -+ u8 ldpc_cap; -+ /* BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx */ -+ u8 stbc_cap; -+ /* BIT0: Enable VHT Beamformer, BIT1: Enable VHT Beamformee, BIT4: Enable HT Beamformer, BIT5: Enable HT Beamformee */ -+ u8 beamform_cap; -+ -+ u8 lowrate_two_xmit; -+ -+ u8 rf_config ; -+ u8 low_power ; -+ -+ u8 wifi_spec;/* !turbo_mode */ -+ -+ u8 channel_plan; -+ -+ u8 btcoex; -+ u8 bt_iso; -+ u8 bt_sco; -+ u8 bt_ampdu; -+ s8 ant_num; -+ -+ bool bAcceptAddbaReq; -+ -+ u8 antdiv_cfg; -+ u8 antdiv_type; -+ -+ u8 usbss_enable;/* 0:disable, 1:enable */ -+ u8 hwpdn_mode;/* 0:disable, 1:enable, 2:decide by EFUSE config */ -+ u8 hwpwrp_detect;/* 0:disable, 1:enable */ -+ -+ u8 hw_wps_pbc;/* 0:disable, 1:enable */ -+ -+ u8 max_roaming_times; /* the max number driver will try to roaming */ -+ -+ u8 enable80211d; -+ -+ u8 ifname[16]; -+ -+ u8 notch_filter; -+ -+ /* define for tx power adjust */ -+ u8 RegEnableTxPowerLimit; -+ u8 RegEnableTxPowerByRate; -+ u8 RegPowerBase; -+ u8 RegPwrTblSel; -+ s8 TxBBSwing_2G; -+ s8 TxBBSwing_5G; -+ u8 AmplifierType_2G; -+ u8 AmplifierType_5G; -+ u8 bEn_RFE; -+ u8 RFE_Type; -+ u8 check_fw_ps; -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ u8 load_phy_file; -+ u8 RegDecryptCustomFile; -+#endif -+ -+#ifdef CONFIG_MULTI_VIR_IFACES -+ u8 ext_iface_num;/* primary/secondary iface is excluded */ -+#endif -+ u8 qos_opt_enable; -+ -+ u8 hiq_filter; -+}; -+ -+ -+/* For registry parameters */ -+#define RGTRY_OFT(field) ((u32)FIELD_OFFSET(struct registry_priv, field)) -+#define RGTRY_SZ(field) sizeof(((struct registry_priv*) 0)->field) -+#define BSSID_OFT(field) ((u32)FIELD_OFFSET(struct wlan_bssid_ex, field)) -+#define BSSID_SZ(field) sizeof(((struct wlan_bssid_ex *) 0)->field) -+ -+#include -+#define INTF_DATA SDIO_DATA -+ -+#define is_primary_adapter(adapter) (1) -+#define get_iface_type(adapter) (IFACE_PORT0) -+#define GET_PRIMARY_ADAPTER(padapter) (((struct adapter *)padapter)->dvobj->if1) -+#define GET_IFACE_NUMS(padapter) (((struct adapter *)padapter)->dvobj->iface_nums) -+#define GET_ADAPTER(padapter, iface_id) (((struct adapter *)padapter)->dvobj->padapters[iface_id]) -+ -+#ifdef CONFIG_DBG_COUNTER -+ -+struct rx_logs { -+ u32 intf_rx; -+ u32 intf_rx_err_recvframe; -+ u32 intf_rx_err_skb; -+ u32 intf_rx_report; -+ u32 core_rx; -+ u32 core_rx_pre; -+ u32 core_rx_pre_ver_err; -+ u32 core_rx_pre_mgmt; -+ u32 core_rx_pre_mgmt_err_80211w; -+ u32 core_rx_pre_mgmt_err; -+ u32 core_rx_pre_ctrl; -+ u32 core_rx_pre_ctrl_err; -+ u32 core_rx_pre_data; -+ u32 core_rx_pre_data_wapi_seq_err; -+ u32 core_rx_pre_data_wapi_key_err; -+ u32 core_rx_pre_data_handled; -+ u32 core_rx_pre_data_err; -+ u32 core_rx_pre_data_unknown; -+ u32 core_rx_pre_unknown; -+ u32 core_rx_enqueue; -+ u32 core_rx_dequeue; -+ u32 core_rx_post; -+ u32 core_rx_post_decrypt; -+ u32 core_rx_post_decrypt_wep; -+ u32 core_rx_post_decrypt_tkip; -+ u32 core_rx_post_decrypt_aes; -+ u32 core_rx_post_decrypt_wapi; -+ u32 core_rx_post_decrypt_hw; -+ u32 core_rx_post_decrypt_unknown; -+ u32 core_rx_post_decrypt_err; -+ u32 core_rx_post_defrag_err; -+ u32 core_rx_post_portctrl_err; -+ u32 core_rx_post_indicate; -+ u32 core_rx_post_indicate_in_oder; -+ u32 core_rx_post_indicate_reoder; -+ u32 core_rx_post_indicate_err; -+ u32 os_indicate; -+ u32 os_indicate_ap_mcast; -+ u32 os_indicate_ap_forward; -+ u32 os_indicate_ap_self; -+ u32 os_indicate_err; -+ u32 os_netif_ok; -+ u32 os_netif_err; -+}; -+ -+struct tx_logs { -+ u32 os_tx; -+ u32 os_tx_err_up; -+ u32 os_tx_err_xmit; -+ u32 os_tx_m2u; -+ u32 os_tx_m2u_ignore_fw_linked; -+ u32 os_tx_m2u_ignore_self; -+ u32 os_tx_m2u_entry; -+ u32 os_tx_m2u_entry_err_xmit; -+ u32 os_tx_m2u_entry_err_skb; -+ u32 os_tx_m2u_stop; -+ u32 core_tx; -+ u32 core_tx_err_pxmitframe; -+ u32 core_tx_err_brtx; -+ u32 core_tx_upd_attrib; -+ u32 core_tx_upd_attrib_adhoc; -+ u32 core_tx_upd_attrib_sta; -+ u32 core_tx_upd_attrib_ap; -+ u32 core_tx_upd_attrib_unknown; -+ u32 core_tx_upd_attrib_dhcp; -+ u32 core_tx_upd_attrib_icmp; -+ u32 core_tx_upd_attrib_active; -+ u32 core_tx_upd_attrib_err_ucast_sta; -+ u32 core_tx_upd_attrib_err_ucast_ap_link; -+ u32 core_tx_upd_attrib_err_sta; -+ u32 core_tx_upd_attrib_err_link; -+ u32 core_tx_upd_attrib_err_sec; -+ u32 core_tx_ap_enqueue_warn_fwstate; -+ u32 core_tx_ap_enqueue_warn_sta; -+ u32 core_tx_ap_enqueue_warn_nosta; -+ u32 core_tx_ap_enqueue_warn_link; -+ u32 core_tx_ap_enqueue_warn_trigger; -+ u32 core_tx_ap_enqueue_mcast; -+ u32 core_tx_ap_enqueue_ucast; -+ u32 core_tx_ap_enqueue; -+ u32 intf_tx; -+ u32 intf_tx_pending_ac; -+ u32 intf_tx_pending_fw_under_survey; -+ u32 intf_tx_pending_fw_under_linking; -+ u32 intf_tx_pending_xmitbuf; -+ u32 intf_tx_enqueue; -+ u32 core_tx_enqueue; -+ u32 core_tx_enqueue_class; -+ u32 core_tx_enqueue_class_err_sta; -+ u32 core_tx_enqueue_class_err_nosta; -+ u32 core_tx_enqueue_class_err_fwlink; -+ u32 intf_tx_direct; -+ u32 intf_tx_direct_err_coalesce; -+ u32 intf_tx_dequeue; -+ u32 intf_tx_dequeue_err_coalesce; -+ u32 intf_tx_dump_xframe; -+ u32 intf_tx_dump_xframe_err_txdesc; -+ u32 intf_tx_dump_xframe_err_port; -+}; -+ -+struct int_logs { -+ u32 all; -+ u32 err; -+ u32 tbdok; -+ u32 tbder; -+ u32 bcnderr; -+ u32 bcndma; -+ u32 bcndma_e; -+ u32 rx; -+ u32 rx_rdu; -+ u32 rx_fovw; -+ u32 txfovw; -+ u32 mgntok; -+ u32 highdok; -+ u32 bkdok; -+ u32 bedok; -+ u32 vidok; -+ u32 vodok; -+}; -+ -+#endif /* CONFIG_DBG_COUNTER */ -+ -+struct debug_priv { -+ u32 dbg_sdio_free_irq_error_cnt; -+ u32 dbg_sdio_alloc_irq_error_cnt; -+ u32 dbg_sdio_free_irq_cnt; -+ u32 dbg_sdio_alloc_irq_cnt; -+ u32 dbg_sdio_deinit_error_cnt; -+ u32 dbg_sdio_init_error_cnt; -+ u32 dbg_suspend_error_cnt; -+ u32 dbg_suspend_cnt; -+ u32 dbg_resume_cnt; -+ u32 dbg_resume_error_cnt; -+ u32 dbg_deinit_fail_cnt; -+ u32 dbg_carddisable_cnt; -+ u32 dbg_carddisable_error_cnt; -+ u32 dbg_ps_insuspend_cnt; -+ u32 dbg_dev_unload_inIPS_cnt; -+ u32 dbg_wow_leave_ps_fail_cnt; -+ u32 dbg_scan_pwr_state_cnt; -+ u32 dbg_downloadfw_pwr_state_cnt; -+ u32 dbg_fw_read_ps_state_fail_cnt; -+ u32 dbg_leave_ips_fail_cnt; -+ u32 dbg_leave_lps_fail_cnt; -+ u32 dbg_h2c_leave32k_fail_cnt; -+ u32 dbg_diswow_dload_fw_fail_cnt; -+ u32 dbg_enwow_dload_fw_fail_cnt; -+ u32 dbg_ips_drvopen_fail_cnt; -+ u32 dbg_poll_fail_cnt; -+ u32 dbg_rpwm_toogle_cnt; -+ u32 dbg_rpwm_timeout_fail_cnt; -+ u64 dbg_rx_fifo_last_overflow; -+ u64 dbg_rx_fifo_curr_overflow; -+ u64 dbg_rx_fifo_diff_overflow; -+ u64 dbg_rx_ampdu_drop_count; -+ u64 dbg_rx_ampdu_forced_indicate_count; -+ u64 dbg_rx_ampdu_loss_count; -+ u64 dbg_rx_dup_mgt_frame_drop_count; -+ u64 dbg_rx_ampdu_window_shift_cnt; -+}; -+ -+struct rtw_traffic_statistics { -+ /* tx statistics */ -+ u64 tx_bytes; -+ u64 tx_pkts; -+ u64 tx_drop; -+ u64 cur_tx_bytes; -+ u64 last_tx_bytes; -+ u32 cur_tx_tp; /* Tx throughput in MBps. */ -+ -+ /* rx statistics */ -+ u64 rx_bytes; -+ u64 rx_pkts; -+ u64 rx_drop; -+ u64 cur_rx_bytes; -+ u64 last_rx_bytes; -+ u32 cur_rx_tp; /* Rx throughput in MBps. */ -+}; -+ -+struct cam_ctl_t { -+ _lock lock; -+ u64 bitmap; -+}; -+ -+struct cam_entry_cache { -+ u16 ctrl; -+ u8 mac[ETH_ALEN]; -+ u8 key[16]; -+}; -+ -+#define KEY_FMT "%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" -+#define KEY_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5], \ -+ ((u8 *)(x))[6], ((u8 *)(x))[7], ((u8 *)(x))[8], ((u8 *)(x))[9], ((u8 *)(x))[10], ((u8 *)(x))[11], \ -+ ((u8 *)(x))[12], ((u8 *)(x))[13], ((u8 *)(x))[14], ((u8 *)(x))[15] -+ -+struct dvobj_priv -+{ -+ /*-------- below is common data --------*/ -+ struct adapter *if1; /* PRIMARY_ADAPTER */ -+ struct adapter *if2; /* SECONDARY_ADAPTER */ -+ -+ s32 processing_dev_remove; -+ -+ struct debug_priv drv_dbg; -+ -+ /* for local/global synchronization */ -+ /* */ -+ _lock lock; -+ int macid[NUM_STA]; -+ -+ _mutex hw_init_mutex; -+ _mutex h2c_fwcmd_mutex; -+ _mutex setch_mutex; -+ _mutex setbw_mutex; -+ -+ unsigned char oper_channel; /* saved channel info when call set_channel_bw */ -+ unsigned char oper_bwmode; -+ unsigned char oper_ch_offset;/* PRIME_CHNL_OFFSET */ -+ unsigned long on_oper_ch_time; -+ -+ struct adapter *padapters; -+ -+ struct cam_ctl_t cam_ctl; -+ struct cam_entry_cache cam_cache[TOTAL_CAM_ENTRY]; -+ -+ /* For 92D, DMDP have 2 interface. */ -+ u8 InterfaceNumber; -+ u8 NumInterfaces; -+ -+ /* In /Out Pipe information */ -+ int RtInPipe[2]; -+ int RtOutPipe[4]; -+ u8 Queue2Pipe[HW_QUEUE_ENTRY];/* for out pipe mapping */ -+ -+ u8 irq_alloc; -+ atomic_t continual_io_error; -+ -+ atomic_t disable_func; -+ -+ struct pwrctrl_priv pwrctl_priv; -+ -+ struct rtw_traffic_statistics traffic_stat; -+ -+/*-------- below is for SDIO INTERFACE --------*/ -+ -+#ifdef INTF_DATA -+ INTF_DATA intf_data; -+#endif -+}; -+ -+#define dvobj_to_pwrctl(dvobj) (&(dvobj->pwrctl_priv)) -+#define pwrctl_to_dvobj(pwrctl) container_of(pwrctl, struct dvobj_priv, pwrctl_priv) -+ -+__inline static struct device *dvobj_to_dev(struct dvobj_priv *dvobj) -+{ -+ /* todo: get interface type from dvobj and the return the dev accordingly */ -+#ifdef RTW_DVOBJ_CHIP_HW_TYPE -+#endif -+ -+ return &dvobj->intf_data.func->dev; -+} -+ -+struct adapter *dvobj_get_port0_adapter(struct dvobj_priv *dvobj); -+ -+enum _IFACE_TYPE { -+ IFACE_PORT0, /* mapping to port0 for C/D series chips */ -+ IFACE_PORT1, /* mapping to port1 for C/D series chip */ -+ MAX_IFACE_PORT, -+}; -+ -+enum ADAPTER_TYPE { -+ PRIMARY_ADAPTER, -+ SECONDARY_ADAPTER, -+ MAX_ADAPTER = 0xFF, -+}; -+ -+typedef enum _DRIVER_STATE{ -+ DRIVER_NORMAL = 0, -+ DRIVER_DISAPPEAR = 1, -+ DRIVER_REPLACE_DONGLE = 2, -+}DRIVER_STATE; -+ -+struct adapter { -+ int DriverState;/* for disable driver using module, use dongle to replace module. */ -+ int pid[3];/* process id from UI, 0:wps, 1:hostapd, 2:dhcpcd */ -+ int bDongle;/* build-in module or external dongle */ -+ -+ struct dvobj_priv *dvobj; -+ struct mlme_priv mlmepriv; -+ struct mlme_ext_priv mlmeextpriv; -+ struct cmd_priv cmdpriv; -+ struct evt_priv evtpriv; -+ /* struct io_queue *pio_queue; */ -+ struct io_priv iopriv; -+ struct xmit_priv xmitpriv; -+ struct recv_priv recvpriv; -+ struct sta_priv stapriv; -+ struct security_priv securitypriv; -+ _lock security_key_mutex; /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ struct registry_priv registrypriv; -+ struct eeprom_priv eeprompriv; -+ -+ struct hostapd_priv *phostapdpriv; -+ -+ u32 setband; -+ -+ void * HalData; -+ u32 hal_data_sz; -+ struct hal_ops HalFunc; -+ -+ s32 bDriverStopped; -+ s32 bSurpriseRemoved; -+ s32 bCardDisableWOHSM; -+ -+ u32 IsrContent; -+ u32 ImrContent; -+ -+ u8 EepromAddressSize; -+ u8 hw_init_completed; -+ u8 bDriverIsGoingToUnload; -+ u8 init_adpt_in_progress; -+ u8 bHaltInProgress; -+ -+ void *cmdThread; -+ void *evtThread; -+ void *xmitThread; -+ void *recvThread; -+ -+ u32 (*intf_init)(struct dvobj_priv *dvobj); -+ void (*intf_deinit)(struct dvobj_priv *dvobj); -+ int (*intf_alloc_irq)(struct dvobj_priv *dvobj); -+ void (*intf_free_irq)(struct dvobj_priv *dvobj); -+ -+ -+ void (*intf_start)(struct adapter * adapter); -+ void (*intf_stop)(struct adapter * adapter); -+ -+ _nic_hdl pnetdev; -+ char old_ifname[IFNAMSIZ]; -+ -+ /* used by rtw_rereg_nd_name related function */ -+ struct rereg_nd_name_data { -+ _nic_hdl old_pnetdev; -+ char old_ifname[IFNAMSIZ]; -+ u8 old_ips_mode; -+ u8 old_bRegUseLed; -+ } rereg_nd_name_priv; -+ -+ int bup; -+ struct net_device_stats stats; -+ struct iw_statistics iwstats; -+ struct proc_dir_entry *dir_dev;/* for proc directory */ -+ struct proc_dir_entry *dir_odm; -+ -+ struct wireless_dev *rtw_wdev; -+ struct rtw_wdev_priv wdev_data; -+ -+ int net_closed; -+ -+ u8 netif_up; -+ -+ u8 bFWReady; -+ u8 bBTFWReady; -+ u8 bLinkInfoDump; -+ u8 bRxRSSIDisplay; -+ /* Added by Albert 2012/10/26 */ -+ /* The driver will show up the desired channel number when this flag is 1. */ -+ u8 bNotifyChannelChange; -+ -+ /* pbuddystruct adapter is used only in two inteface case, (iface_nums =2 in struct dvobj_priv) */ -+ /* PRIMARY ADAPTER's buddy is SECONDARY_ADAPTER */ -+ /* SECONDARY_ADAPTER's buddy is PRIMARY_ADAPTER */ -+ /* for iface_id > SECONDARY_ADAPTER(IFACE_ID1), refer to padapters[iface_id] in struct dvobj_priv */ -+ /* and their pbuddystruct adapter is PRIMARY_ADAPTER. */ -+ /* for PRIMARY_ADAPTER(IFACE_ID0) can directly refer to if1 in struct dvobj_priv */ -+ struct adapter *pbuddy_adapter; -+ -+ /* extend to support multi interface */ -+ /* IFACE_ID0 is equals to PRIMARY_ADAPTER */ -+ /* IFACE_ID1 is equals to SECONDARY_ADAPTER */ -+ u8 iface_id; -+ -+ /* for debug purpose */ -+ u8 fix_rate; -+ u8 driver_vcs_en; /* Enable = 1, Disable = 0 driver control vrtl_carrier_sense for tx */ -+ u8 driver_vcs_type;/* force 0:disable VCS, 1:RTS-CTS, 2:CTS-to-self when vcs_en = 1. */ -+ u8 driver_ampdu_spacing;/* driver control AMPDU Density for peer sta's rx */ -+ u8 driver_rx_ampdu_factor;/* 0xff: disable drv ctrl, 0:8k, 1:16k, 2:32k, 3:64k; */ -+ -+ unsigned char in_cta_test; -+ -+#ifdef CONFIG_DBG_COUNTER -+ struct rx_logs rx_logs; -+ struct tx_logs tx_logs; -+ struct int_logs int_logs; -+#endif -+}; -+ -+#define adapter_to_dvobj(adapter) (adapter->dvobj) -+#define adapter_to_pwrctl(adapter) (dvobj_to_pwrctl(adapter->dvobj)) -+#define adapter_wdev_data(adapter) (&((adapter)->wdev_data)) -+ -+/* */ -+/* Function disabled. */ -+/* */ -+#define DF_TX_BIT BIT0 -+#define DF_RX_BIT BIT1 -+#define DF_IO_BIT BIT2 -+ -+/* define RTW_DISABLE_FUNC(padapter, func) (atomic_add(&adapter_to_dvobj(padapter)->disable_func, (func))) */ -+/* define RTW_ENABLE_FUNC(padapter, func) (atomic_sub(&adapter_to_dvobj(padapter)->disable_func, (func))) */ -+__inline static void RTW_DISABLE_FUNC(struct adapter *padapter, int func_bit) -+{ -+ int df = atomic_read(&adapter_to_dvobj(padapter)->disable_func); -+ df |= func_bit; -+ atomic_set(&adapter_to_dvobj(padapter)->disable_func, df); -+} -+ -+__inline static void RTW_ENABLE_FUNC(struct adapter *padapter, int func_bit) -+{ -+ int df = atomic_read(&adapter_to_dvobj(padapter)->disable_func); -+ df &= ~(func_bit); -+ atomic_set(&adapter_to_dvobj(padapter)->disable_func, df); -+} -+ -+#define RTW_IS_FUNC_DISABLED(padapter, func_bit) (atomic_read(&adapter_to_dvobj(padapter)->disable_func) & (func_bit)) -+ -+#define RTW_CANNOT_IO(padapter) \ -+ ((padapter)->bSurpriseRemoved || \ -+ RTW_IS_FUNC_DISABLED((padapter), DF_IO_BIT)) -+ -+#define RTW_CANNOT_RX(padapter) \ -+ ((padapter)->bDriverStopped || \ -+ (padapter)->bSurpriseRemoved || \ -+ RTW_IS_FUNC_DISABLED((padapter), DF_RX_BIT)) -+ -+#define RTW_CANNOT_TX(padapter) \ -+ ((padapter)->bDriverStopped || \ -+ (padapter)->bSurpriseRemoved || \ -+ RTW_IS_FUNC_DISABLED((padapter), DF_TX_BIT)) -+ -+#ifdef CONFIG_GPIO_API -+int rtw_get_gpio(struct net_device *netdev, int gpio_num); -+int rtw_set_gpio_output_value(struct net_device *netdev, int gpio_num, bool isHigh); -+int rtw_config_gpio(struct net_device *netdev, int gpio_num, bool isOutput); -+#endif -+ -+#ifdef CONFIG_WOWLAN -+int rtw_suspend_wow(struct adapter *padapter); -+int rtw_resume_process_wow(struct adapter *padapter); -+#endif -+ -+__inline static u8 *myid(struct eeprom_priv *peepriv) -+{ -+ return (peepriv->mac_addr); -+} -+ -+/* HCI Related header file */ -+#include -+#include -+#include -+ -+#include -+ -+void rtw_indicate_wx_disassoc_event(struct adapter *padapter); -+void rtw_indicate_wx_assoc_event(struct adapter *padapter); -+void rtw_indicate_wx_disassoc_event(struct adapter *padapter); -+void indicate_wx_scan_complete_event(struct adapter *padapter); -+int rtw_change_ifname(struct adapter *padapter, const char *ifname); -+ -+extern char *rtw_phy_file_path; -+extern char *rtw_initmac; -+extern int rtw_mc2u_disable; -+extern int rtw_ht_enable; -+extern u32 g_wait_hiq_empty; -+extern u8 g_fwdl_wintint_rdy_fail; -+extern u8 g_fwdl_chksum_fail; -+ -+#endif /* __DRV_TYPES_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/drv_types_sdio.h linux/3rdparty/rtl8723bs/include/drv_types_sdio.h ---- linux.old/3rdparty/rtl8723bs/include/drv_types_sdio.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/drv_types_sdio.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,39 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __DRV_TYPES_SDIO_H__ -+#define __DRV_TYPES_SDIO_H__ -+ -+/* SDIO Header Files */ -+ #include -+ #include -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ #include -+ #include -+#endif -+ -+typedef struct sdio_data -+{ -+ u8 func_number; -+ -+ u8 tx_block_mode; -+ u8 rx_block_mode; -+ u32 block_transfer_len; -+ -+ struct sdio_func *func; -+ void *sys_sdio_irq_thd; -+} SDIO_DATA, *PSDIO_DATA; -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/ethernet.h linux/3rdparty/rtl8723bs/include/ethernet.h ---- linux.old/3rdparty/rtl8723bs/include/ethernet.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/ethernet.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,22 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/*! \file */ -+#ifndef __INC_ETHERNET_H -+#define __INC_ETHERNET_H -+ -+#define ETHERNET_HEADER_SIZE 14 /* Ethernet Header Length */ -+#define LLC_HEADER_SIZE 6 /* LLC Header Length */ -+ -+#endif /* #ifndef __INC_ETHERNET_H */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/Hal8192CPhyReg.h linux/3rdparty/rtl8723bs/include/Hal8192CPhyReg.h ---- linux.old/3rdparty/rtl8723bs/include/Hal8192CPhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/Hal8192CPhyReg.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1126 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/***************************************************************************** -+ * -+ * Module: __INC_HAL8192CPHYREG_H -+ * -+ * -+ * Note: 1. Define PMAC/BB register map -+ * 2. Define RF register map -+ * 3. PMAC/BB register bit mask. -+ * 4. RF reg bit mask. -+ * 5. Other BB/RF relative definition. -+ * -+ * -+ * Export: Constants, macro, functions(API), global variables(None). -+ * -+ * Abbrev: -+ * -+ * History: -+ * Data Who Remark -+ * 08/07/2007 MHC 1. Porting from 9x series PHYCFG.h. -+ * 2. Reorganize code architecture. -+ *09/25/2008 MH 1. Add RL6052 register definition -+ * -+ *****************************************************************************/ -+#ifndef __INC_HAL8192CPHYREG_H -+#define __INC_HAL8192CPHYREG_H -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+/* */ -+/* 8192S Regsiter offset definition */ -+/* */ -+ -+/* */ -+/* BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF */ -+/* 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF */ -+/* 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 */ -+/* 3. RF register 0x00-2E */ -+/* 4. Bit Mask for BB/RF register */ -+/* 5. Other defintion for BB/RF R/W */ -+/* */ -+ -+ -+/* */ -+/* 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF */ -+/* 1. Page1(0x100) */ -+/* */ -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+/* */ -+/* 2. Page2(0x200) */ -+/* */ -+/* The following two definition are only used for USB interface. */ -+#define RF_BB_CMD_ADDR 0x02c0 /* RF/BB read/write command address. */ -+#define RF_BB_CMD_DATA 0x02c4 /* RF/BB read/write command data. */ -+ -+/* */ -+/* 3. Page8(0x800) */ -+/* */ -+#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC RF BW Setting?? */ -+ -+#define rFPGA0_TxInfo 0x804 /* Status report?? */ -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ -+ -+#define rFPGA0_RFTiming1 0x810 /* Useless now */ -+#define rFPGA0_RFTiming2 0x814 -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+ -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 /* Useless now */ -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 /* Useless now */ -+#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ -+#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now RF Interface Readback Value */ -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ -+ -+/* */ -+/* 4. Page9(0x900) */ -+/* */ -+#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC RF BW Setting?? */ -+ -+#define rFPGA1_TxBlock 0x904 /* Useless now */ -+#define rFPGA1_DebugSelect 0x908 /* Useless now */ -+#define rFPGA1_TxInfo 0x90c /* Useless now Status report?? */ -+#define rS0S1_PathSwitch 0x948 -+ -+/* */ -+/* 5. PageA(0xA00) */ -+/* */ -+/* Set Control channel to upper or lower. These settings are required only for 40MHz */ -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 /* Disable init gain now Select RX path by RSSI */ -+#define rCCK0_CCA 0xa08 /* Disable init gain now Init gain */ -+ -+#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ -+#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ -+#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ -+#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 /* 0xa57 */ -+#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ -+#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ -+/* */ -+/* PageB(0xB00) */ -+/* */ -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rConfig_Pmpd_AntB 0xb98 -+#define rAPK 0xbd8 -+ -+/* */ -+/* 6. PageC(0xC00) */ -+/* */ -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ -+#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD DM tune init gain */ -+#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ -+#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ -+#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ -+ -+#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ -+#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ -+#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ -+#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ -+ -+#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+/* */ -+/* 7. PageD(0xD00) */ -+/* */ -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 /* No setting now */ -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ -+#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ -+#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ -+ -+#define rOFDM_ShortCFOAB 0xdac /* No setting now */ -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+/* */ -+/* 8. PageE(0xE00) */ -+/* */ -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+/* */ -+/* 7. RF Register 0x00-0x2E (RF 8256) */ -+/* RF-0222D 0x00-3F */ -+/* */ -+/* Zebra1 */ -+#define rZebra1_HSSIEnable 0x0 /* Useless now */ -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+#define rZebra1_Channel 0x7 /* RF channel switch */ -+ -+/* endif */ -+#define rZebra1_TxGain 0x8 /* Useless now */ -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+/* Zebra4 */ -+#define rGlobalCtrl 0 /* Useless now */ -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+/* RTL8258 */ -+#define rRTL8258_TxLPF 0x11 /* Useless now */ -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa -+ -+/* */ -+/* RL6052 Register definition */ -+/* */ -+#define RF_AC 0x00 /* */ -+ -+#define RF_IQADJ_G1 0x01 /* */ -+#define RF_IQADJ_G2 0x02 /* */ -+#define RF_BS_PA_APSET_G1_G4 0x03 -+#define RF_BS_PA_APSET_G5_G8 0x04 -+#define RF_POW_TRSW 0x05 /* */ -+ -+#define RF_GAIN_RX 0x06 /* */ -+#define RF_GAIN_TX 0x07 /* */ -+ -+#define RF_TXM_IDAC 0x08 /* */ -+#define RF_IPA_G 0x09 /* */ -+#define RF_TXBIAS_G 0x0A -+#define RF_TXPA_AG 0x0B -+#define RF_IPA_A 0x0C /* */ -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_BS_IQGEN 0x0F /* */ -+ -+#define RF_MODE1 0x10 /* */ -+#define RF_MODE2 0x11 /* */ -+ -+#define RF_RX_AGC_HP 0x12 /* */ -+#define RF_TX_AGC 0x13 /* */ -+#define RF_BIAS 0x14 /* */ -+#define RF_IPA 0x15 /* */ -+#define RF_TXBIAS 0x16 /* */ -+#define RF_POW_ABILITY 0x17 /* */ -+#define RF_MODE_AG 0x18 /* */ -+#define rRfChannel 0x18 /* RF channel and BW switch */ -+#define RF_CHNLBW 0x18 /* RF channel and BW switch */ -+#define RF_TOP 0x19 /* */ -+ -+#define RF_RX_G1 0x1A /* */ -+#define RF_RX_G2 0x1B /* */ -+ -+#define RF_RX_BB2 0x1C /* */ -+#define RF_RX_BB1 0x1D /* */ -+ -+#define RF_RCK1 0x1E /* */ -+#define RF_RCK2 0x1F /* */ -+ -+#define RF_TX_G1 0x20 /* */ -+#define RF_TX_G2 0x21 /* */ -+#define RF_TX_G3 0x22 /* */ -+ -+#define RF_TX_BB1 0x23 /* */ -+ -+#define RF_T_METER 0x24 /* */ -+ -+#define RF_SYN_G1 0x25 /* RF TX Power control */ -+#define RF_SYN_G2 0x26 /* RF TX Power control */ -+#define RF_SYN_G3 0x27 /* RF TX Power control */ -+#define RF_SYN_G4 0x28 /* RF TX Power control */ -+#define RF_SYN_G5 0x29 /* RF TX Power control */ -+#define RF_SYN_G6 0x2A /* RF TX Power control */ -+#define RF_SYN_G7 0x2B /* RF TX Power control */ -+#define RF_SYN_G8 0x2C /* RF TX Power control */ -+ -+#define RF_RCK_OS 0x30 /* RF TX PA control */ -+ -+#define RF_TXPA_G1 0x31 /* RF TX PA control */ -+#define RF_TXPA_G2 0x32 /* RF TX PA control */ -+#define RF_TXPA_G3 0x33 /* RF TX PA control */ -+#define RF_TX_BIAS_A 0x35 -+#define RF_TX_BIAS_D 0x36 -+#define RF_LOBF_9 0x38 -+#define RF_RXRF_A3 0x3C /* */ -+#define RF_TRSW 0x3F -+ -+#define RF_TXRF_A2 0x41 -+#define RF_TXPA_G4 0x46 -+#define RF_TXPA_A4 0x4B -+#define RF_0x52 0x52 -+#define RF_WE_LUT 0xEF -+#define RF_S0S1 0xB0 -+ -+/* */ -+/* Bit Mask */ -+/* */ -+/* 1. Page1(0x100) */ -+#define bBBResetB 0x100 /* Useless now? */ -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) -+ -+/* 2. Page8(0x800) */ -+#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 /* Useless now */ -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bAntennaSelect 0x0300 -+ -+#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 /* Useless now */ -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf /* Reg0x814 */ -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 /* T2R */ -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 /* chane gain at continue Tx */ -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 /* Useless now */ -+/* define bHWSISelect 0x8 */ -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ -+ -+#define bRFSI_TRSW 0x20 /* Useless now */ -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+ -+#define bLSSIReadAddress 0x7f800000 /* T65 RF */ -+ -+#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ -+ -+#define bLSSIReadBackData 0xfffff /* T65 RF */ -+ -+#define bLSSIReadOKFlag 0x1000 /* Useless now */ -+#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ -+ -+#define b80MClkDelay 0x18000000 /* Useless */ -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 /* Useless */ -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+/* 3. Page9(0x900) */ -+#define bOFDMTxSC 0x30000000 /* Useless */ -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ -+#define bDebugItem 0xff /* reset debug page and LWord */ -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 -+ -+/* 4. PageA(0xA00) */ -+#define bCCKBBMode 0x3 /* Useless */ -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ -+ -+#define bCCKScramble 0x8 /* Useless */ -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ -+#define bCCKFixedRxAGC 0x8000 -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+/* 5. PageC(0xC00) */ -+#define bNumOfSTF 0x3 /* Useless */ -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 /* the threshold for high power */ -+#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+/* define bRxMF_Hold 0x3800 */ -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 -+ -+/* 6. PageE(0xE00) */ -+#define bSTBCEn 0x4 /* Useless */ -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+/* define bRxPath1 0x01 */ -+/* define bRxPath2 0x02 */ -+/* define bRxPath3 0x04 */ -+/* define bRxPath4 0x08 */ -+/* define bTxPath1 0x10 */ -+/* define bTxPath2 0x20 */ -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 /* total */ -+#define bShortCFOFLength 11 /* fraction */ -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf /* Useless */ -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 /* Useless */ -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 /* Useless */ -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+/* Rx Pseduo noise */ -+#define bRxPesudoNoiseOn 0x20000000 /* Useless */ -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+/* 7. RF Register */ -+/* Zebra1 */ -+#define bZebra1_HSSIEnable 0x8 /* Useless */ -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+/* Zebra4 */ -+#define bRTL8256RegModeCtrl1 0x100 /* Useless */ -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+/* RTL8258 */ -+#define bRTL8258_TxLPFBW 0xc /* Useless */ -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 -+ -+ -+/* */ -+/* Other Definition */ -+/* */ -+ -+/* byte endable for sb_write */ -+#define bByte0 0x1 /* Useless */ -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+/* for PutRegsetting & GetRegSetting BitMask */ -+#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+ -+#define bEnable 0x1 /* Useless */ -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 /* Useless */ -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 /* 500ms Useless */ -+#define tUpdateRxCounter 100 /* 100ms */ -+ -+#define rateCCK 0 /* Useless */ -+#define rateOFDM 1 -+#define rateHT 2 -+ -+/* define Register-End */ -+#define bPMAC_End 0x1ff /* Useless */ -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+/* define max debug item in each debug page */ -+/* define bMaxItem_FPGA_PHY0 0x9 */ -+/* define bMaxItem_FPGA_PHY1 0x3 */ -+/* define bMaxItem_PHY_11B 0x16 */ -+/* define bMaxItem_OFDM_PHY0 0x29 */ -+/* define bMaxItem_OFDM_PHY1 0x0 */ -+ -+#define bPMACControl 0x0 /* Useless */ -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#define PathA 0x0 /* Useless */ -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+#endif /* __INC_HAL8192SPHYREG_H */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/Hal8723BPhyCfg.h linux/3rdparty/rtl8723bs/include/Hal8723BPhyCfg.h ---- linux.old/3rdparty/rtl8723bs/include/Hal8723BPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/Hal8723BPhyCfg.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,128 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8723BPHYCFG_H__ -+#define __INC_HAL8723BPHYCFG_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 /* us */ -+#define AntennaDiversityValue 0x80 /* Adapter->bSoftwareAntennaDiversity ? 0x00:0x80) */ -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+#define MAX_AGGR_NUM 0x07 -+ -+ -+/*--------------------------Define Parameters End-------------------------------*/ -+ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+/*------------------------------Define structure End----------------------------*/ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+u32 -+PHY_QueryBBReg_8723B( -+struct adapter *Adapter, -+u32 RegAddr, -+u32 BitMask -+ ); -+ -+void -+PHY_SetBBReg_8723B( -+struct adapter *Adapter, -+u32 RegAddr, -+u32 BitMask, -+u32 Data -+ ); -+ -+u32 -+PHY_QueryRFReg_8723B( -+struct adapter * Adapter, -+u8 eRFPath, -+u32 RegAddr, -+u32 BitMask -+ ); -+ -+void -+PHY_SetRFReg_8723B( -+struct adapter * Adapter, -+u8 eRFPath, -+u32 RegAddr, -+u32 BitMask, -+u32 Data -+ ); -+ -+/* MAC/BB/RF HAL config */ -+int PHY_BBConfig8723B(struct adapter *Adapter ); -+ -+int PHY_RFConfig8723B(struct adapter *Adapter ); -+ -+s32 PHY_MACConfig8723B(struct adapter *padapter); -+ -+void -+PHY_SetTxPowerIndex_8723B( -+struct adapter * Adapter, -+u32 PowerIndex, -+u8 RFPath, -+u8 Rate -+ ); -+ -+u8 -+PHY_GetTxPowerIndex_8723B( -+struct adapter * padapter, -+u8 RFPath, -+u8 Rate, -+enum CHANNEL_WIDTH BandWidth, -+u8 Channel -+ ); -+ -+void -+PHY_GetTxPowerLevel8723B( -+struct adapter * Adapter, -+ s32* powerlevel -+ ); -+ -+void -+PHY_SetTxPowerLevel8723B( -+struct adapter * Adapter, -+u8 channel -+ ); -+ -+void -+PHY_SetBWMode8723B( -+struct adapter * Adapter, -+enum CHANNEL_WIDTH Bandwidth, /* 20M or 40M */ -+unsigned char Offset /* Upper, Lower, or Don't care */ -+); -+ -+void -+PHY_SwChnl8723B(/* Call after initialization */ -+struct adapter *Adapter, -+u8 channel -+ ); -+ -+void -+PHY_SetSwChnlBWMode8723B( -+struct adapter * Adapter, -+u8 channel, -+enum CHANNEL_WIDTH Bandwidth, -+u8 Offset40, -+u8 Offset80 -+); -+ -+/*--------------------------Exported Function prototype End---------------------*/ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/Hal8723BPhyReg.h linux/3rdparty/rtl8723bs/include/Hal8723BPhyReg.h ---- linux.old/3rdparty/rtl8723bs/include/Hal8723BPhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/Hal8723BPhyReg.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,77 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8723BPHYREG_H__ -+#define __INC_HAL8723BPHYREG_H__ -+ -+#include -+ -+/* BB Register Definition */ -+/* */ -+/* 4. Page9(0x900) */ -+/* */ -+#define rDPDT_control 0x92c -+#define rfe_ctrl_anta_src 0x930 -+#define rS0S1_PathSwitch 0x948 -+#define AGC_table_select 0xb2c -+ -+/* */ -+/* PageB(0xB00) */ -+/* */ -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rPdp_AntA_8 0xb08 -+#define rPdp_AntA_C 0xb0c -+#define rPdp_AntA_10 0xb10 -+#define rPdp_AntA_14 0xb14 -+#define rPdp_AntA_18 0xb18 -+#define rPdp_AntA_1C 0xb1c -+#define rPdp_AntA_20 0xb20 -+#define rPdp_AntA_24 0xb24 -+ -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_ram64x16 0xb2c -+ -+#define rBndA 0xb30 -+#define rHssiPar 0xb34 -+ -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+ -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rPdp_AntB_8 0xb78 -+#define rPdp_AntB_C 0xb7c -+#define rPdp_AntB_10 0xb80 -+#define rPdp_AntB_14 0xb84 -+#define rPdp_AntB_18 0xb88 -+#define rPdp_AntB_1C 0xb8c -+#define rPdp_AntB_20 0xb90 -+#define rPdp_AntB_24 0xb94 -+ -+#define rConfig_Pmpd_AntB 0xb98 -+ -+#define rBndB 0xba0 -+ -+#define rAPK 0xbd8 -+#define rPm_Rx0_AntA 0xbdc -+#define rPm_Rx1_AntA 0xbe0 -+#define rPm_Rx2_AntA 0xbe4 -+#define rPm_Rx3_AntA 0xbe8 -+#define rPm_Rx0_AntB 0xbec -+#define rPm_Rx1_AntB 0xbf0 -+#define rPm_Rx2_AntB 0xbf4 -+#define rPm_Rx3_AntB 0xbf8 -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/Hal8723BPwrSeq.h linux/3rdparty/rtl8723bs/include/Hal8723BPwrSeq.h ---- linux.old/3rdparty/rtl8723bs/include/Hal8723BPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/Hal8723BPwrSeq.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,232 @@ -+#ifndef REALTEK_POWER_SEQUENCE_8723B -+#define REALTEK_POWER_SEQUENCE_8723B -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WM-20130815-JackieLau-RTL8723B_Power_Architecture v08.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8723B_TRANS_CARDEMU_TO_ACT_STEPS 26 -+#define RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS 15 -+#define RTL8723B_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8723B_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8723B_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8723B_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8723B_TRANS_ACT_TO_SWLPS_STEPS 22 -+#define RTL8723B_TRANS_SWLPS_TO_ACT_STEPS 15 -+#define RTL8723B_TRANS_END_STEPS 1 -+ -+ -+#define RTL8723B_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, comments here*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ -+ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital , 1:isolation*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4|BIT3|BIT2), 0},/* disable SW LPS 0x04[10]= 0 and WLSUS_EN 0x04[11]= 0*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , BIT0},/* Disable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , 0},/* Enable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]= 1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]= 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4|BIT3), 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/* Enable WL control XTAL setting*/ \ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable falling edge triggering interrupt*/\ -+ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable GPIO9 interrupt mode*/\ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 input mode*/\ -+ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Enable HSISR GPIO[C:0] interrupt*/\ -+ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable HSISR GPIO9 interrupt*/\ -+ {0x0068, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3},/*For GPIO9 internal pull high setting by test chip*/\ -+ {0x0069, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/*For GPIO9 internal pull high setting*/\ -+ -+ -+#define RTL8723B_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable rising edge triggering interrupt*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]= 1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, 0},/* Enable BT control XTAL setting*/\ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital , 1:isolation*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/\ -+ -+ -+#define RTL8723B_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4|BIT3, (BIT4|BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3|BIT4, BIT3|BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8723B_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8723B_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, omments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8723B_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8723B_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, comments here*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK|PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8723B_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8723B_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8723B_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]= 0 TSF in 40M*/\ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6|BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+ -+ #define RTL8723B_TRANS_ACT_TO_SWLPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, comments here*/ \ -+ {0x0194, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*enable 32 K source*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1},/*CCK and OFDM are enable*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1},/*CCK and OFDM are enable*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x3F},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*disable security engine*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x40},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*reset dual TSF*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/*Reset CPU*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*Reset MCUFWDL register*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*Reset CPU IO Wrapper*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1},/*Reset CPU IO Wrapper*/ \ -+ {0x0287, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*polling RXFF packet number = 0 */ \ -+ {0x0286, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/*polling RXDMA idle */ \ -+ {0x013D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Clear FW RPWM interrupt */\ -+ {0x0139, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Set FW RPWM interrupt source*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4},/*switch TSF to 32K*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/*polling TSF stable*/\ -+ {0x0090, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Set FW LPS*/ \ -+ {0x0090, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/*polling FW LPS ready */ -+ -+ -+#define RTL8723B_TRANS_SWLPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, comments here*/ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0},/*switch TSF to 32K*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/*polling TSF stable*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1, enable security engine*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x06B7, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x09}, /*. reset MAC rx state machine*/\ -+ {0x06B4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x86}, /*. reset MAC rx state machine*/\ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/* set CPU RAM code ready*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*Reset CPU IO Wrapper*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* Enable CPU*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*enable CPU IO Wrapper*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2},/* Enable CPU*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, BIT7},/*polling FW init ready */ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT6, BIT6},/*polling FW init ready */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8723B_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, -+ -+ -+extern WLAN_PWR_CFG rtl8723B_power_on_flow[RTL8723B_TRANS_CARDEMU_TO_ACT_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_radio_off_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_card_disable_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_card_enable_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_suspend_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_resume_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_hwpdn_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_enter_lps_flow[RTL8723B_TRANS_ACT_TO_LPS_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_leave_lps_flow[RTL8723B_TRANS_LPS_TO_ACT_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_enter_swlps_flow[RTL8723B_TRANS_ACT_TO_SWLPS_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_leave_swlps_flow[RTL8723B_TRANS_SWLPS_TO_ACT_STEPS+RTL8723B_TRANS_END_STEPS]; -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/hal_btcoex.h linux/3rdparty/rtl8723bs/include/hal_btcoex.h ---- linux.old/3rdparty/rtl8723bs/include/hal_btcoex.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/hal_btcoex.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,68 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_BTCOEX_H__ -+#define __HAL_BTCOEX_H__ -+ -+#include -+ -+/* Some variables can't get from outsrc BT-Coex, */ -+/* so we need to save here */ -+typedef struct _BT_COEXIST -+{ -+ u8 bBtExist; -+ u8 btTotalAntNum; -+ u8 btChipType; -+ u8 bInitlized; -+} BT_COEXIST, *PBT_COEXIST; -+ -+void DBG_BT_INFO(u8 *dbgmsg); -+ -+void hal_btcoex_SetBTCoexist(struct adapter *padapter, u8 bBtExist); -+u8 hal_btcoex_IsBtExist(struct adapter *padapter); -+u8 hal_btcoex_IsBtDisabled(struct adapter *); -+void hal_btcoex_SetChipType(struct adapter *padapter, u8 chipType); -+void hal_btcoex_SetPgAntNum(struct adapter *padapter, u8 antNum); -+void hal_btcoex_SetSingleAntPath(struct adapter *padapter, u8 singleAntPath); -+ -+u8 hal_btcoex_Initialize(struct adapter *padapter); -+void hal_btcoex_PowerOnSetting(struct adapter *padapter); -+void hal_btcoex_InitHwConfig(struct adapter *padapter, u8 bWifiOnly); -+ -+void hal_btcoex_IpsNotify(struct adapter *padapter, u8 type); -+void hal_btcoex_LpsNotify(struct adapter *padapter, u8 type); -+void hal_btcoex_ScanNotify(struct adapter *padapter, u8 type); -+void hal_btcoex_ConnectNotify(struct adapter *padapter, u8 action); -+void hal_btcoex_MediaStatusNotify(struct adapter *padapter, u8 mediaStatus); -+void hal_btcoex_SpecialPacketNotify(struct adapter *padapter, u8 pktType); -+void hal_btcoex_IQKNotify(struct adapter *padapter, u8 state); -+void hal_btcoex_BtInfoNotify(struct adapter *padapter, u8 length, u8 *tmpBuf); -+void hal_btcoex_SuspendNotify(struct adapter *padapter, u8 state); -+void hal_btcoex_HaltNotify(struct adapter *padapter); -+ -+void hal_btcoex_Hanlder(struct adapter *padapter); -+ -+s32 hal_btcoex_IsBTCoexCtrlAMPDUSize(struct adapter *padapter); -+void hal_btcoex_SetManualControl(struct adapter *padapter, u8 bmanual); -+u8 hal_btcoex_IsBtControlLps(struct adapter *); -+u8 hal_btcoex_IsLpsOn(struct adapter *); -+u8 hal_btcoex_RpwmVal(struct adapter *); -+u8 hal_btcoex_LpsVal(struct adapter *); -+u32 hal_btcoex_GetRaMask(struct adapter *); -+void hal_btcoex_RecordPwrMode(struct adapter *padapter, u8 *pCmdBuf, u8 cmdLen); -+void hal_btcoex_DisplayBtCoexInfo(struct adapter *, u8 *pbuf, u32 bufsize); -+void hal_btcoex_SetDBG(struct adapter *, u32 *pDbgModule); -+u32 hal_btcoex_GetDBG(struct adapter *, u8 *pStrBuf, u32 bufSize); -+ -+#endif /* !__HAL_BTCOEX_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/hal_com.h linux/3rdparty/rtl8723bs/include/hal_com.h ---- linux.old/3rdparty/rtl8723bs/include/hal_com.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/hal_com.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,309 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_COMMON_H__ -+#define __HAL_COMMON_H__ -+ -+#include "HalVerDef.h" -+#include "hal_pg.h" -+#include "hal_phy.h" -+#include "hal_phy_reg.h" -+#include "hal_com_reg.h" -+#include "hal_com_phycfg.h" -+ -+/*------------------------------ Tx Desc definition Macro ------------------------*/ -+/* pragma mark -- Tx Desc related definition. -- */ -+/* */ -+/* */ -+/* Rate */ -+/* */ -+/* CCK Rates, TxHT = 0 */ -+#define DESC_RATE1M 0x00 -+#define DESC_RATE2M 0x01 -+#define DESC_RATE5_5M 0x02 -+#define DESC_RATE11M 0x03 -+ -+/* OFDM Rates, TxHT = 0 */ -+#define DESC_RATE6M 0x04 -+#define DESC_RATE9M 0x05 -+#define DESC_RATE12M 0x06 -+#define DESC_RATE18M 0x07 -+#define DESC_RATE24M 0x08 -+#define DESC_RATE36M 0x09 -+#define DESC_RATE48M 0x0a -+#define DESC_RATE54M 0x0b -+ -+/* MCS Rates, TxHT = 1 */ -+#define DESC_RATEMCS0 0x0c -+#define DESC_RATEMCS1 0x0d -+#define DESC_RATEMCS2 0x0e -+#define DESC_RATEMCS3 0x0f -+#define DESC_RATEMCS4 0x10 -+#define DESC_RATEMCS5 0x11 -+#define DESC_RATEMCS6 0x12 -+#define DESC_RATEMCS7 0x13 -+#define DESC_RATEMCS8 0x14 -+#define DESC_RATEMCS9 0x15 -+#define DESC_RATEMCS10 0x16 -+#define DESC_RATEMCS11 0x17 -+#define DESC_RATEMCS12 0x18 -+#define DESC_RATEMCS13 0x19 -+#define DESC_RATEMCS14 0x1a -+#define DESC_RATEMCS15 0x1b -+#define DESC_RATEMCS16 0x1C -+#define DESC_RATEMCS17 0x1D -+#define DESC_RATEMCS18 0x1E -+#define DESC_RATEMCS19 0x1F -+#define DESC_RATEMCS20 0x20 -+#define DESC_RATEMCS21 0x21 -+#define DESC_RATEMCS22 0x22 -+#define DESC_RATEMCS23 0x23 -+#define DESC_RATEMCS24 0x24 -+#define DESC_RATEMCS25 0x25 -+#define DESC_RATEMCS26 0x26 -+#define DESC_RATEMCS27 0x27 -+#define DESC_RATEMCS28 0x28 -+#define DESC_RATEMCS29 0x29 -+#define DESC_RATEMCS30 0x2A -+#define DESC_RATEMCS31 0x2B -+#define DESC_RATEVHTSS1MCS0 0x2C -+#define DESC_RATEVHTSS1MCS1 0x2D -+#define DESC_RATEVHTSS1MCS2 0x2E -+#define DESC_RATEVHTSS1MCS3 0x2F -+#define DESC_RATEVHTSS1MCS4 0x30 -+#define DESC_RATEVHTSS1MCS5 0x31 -+#define DESC_RATEVHTSS1MCS6 0x32 -+#define DESC_RATEVHTSS1MCS7 0x33 -+#define DESC_RATEVHTSS1MCS8 0x34 -+#define DESC_RATEVHTSS1MCS9 0x35 -+#define DESC_RATEVHTSS2MCS0 0x36 -+#define DESC_RATEVHTSS2MCS1 0x37 -+#define DESC_RATEVHTSS2MCS2 0x38 -+#define DESC_RATEVHTSS2MCS3 0x39 -+#define DESC_RATEVHTSS2MCS4 0x3A -+#define DESC_RATEVHTSS2MCS5 0x3B -+#define DESC_RATEVHTSS2MCS6 0x3C -+#define DESC_RATEVHTSS2MCS7 0x3D -+#define DESC_RATEVHTSS2MCS8 0x3E -+#define DESC_RATEVHTSS2MCS9 0x3F -+#define DESC_RATEVHTSS3MCS0 0x40 -+#define DESC_RATEVHTSS3MCS1 0x41 -+#define DESC_RATEVHTSS3MCS2 0x42 -+#define DESC_RATEVHTSS3MCS3 0x43 -+#define DESC_RATEVHTSS3MCS4 0x44 -+#define DESC_RATEVHTSS3MCS5 0x45 -+#define DESC_RATEVHTSS3MCS6 0x46 -+#define DESC_RATEVHTSS3MCS7 0x47 -+#define DESC_RATEVHTSS3MCS8 0x48 -+#define DESC_RATEVHTSS3MCS9 0x49 -+#define DESC_RATEVHTSS4MCS0 0x4A -+#define DESC_RATEVHTSS4MCS1 0x4B -+#define DESC_RATEVHTSS4MCS2 0x4C -+#define DESC_RATEVHTSS4MCS3 0x4D -+#define DESC_RATEVHTSS4MCS4 0x4E -+#define DESC_RATEVHTSS4MCS5 0x4F -+#define DESC_RATEVHTSS4MCS6 0x50 -+#define DESC_RATEVHTSS4MCS7 0x51 -+#define DESC_RATEVHTSS4MCS8 0x52 -+#define DESC_RATEVHTSS4MCS9 0x53 -+ -+#define HDATA_RATE(rate)\ -+(rate ==DESC_RATE1M)?"CCK_1M":\ -+(rate ==DESC_RATE2M)?"CCK_2M":\ -+(rate ==DESC_RATE5_5M)?"CCK5_5M":\ -+(rate ==DESC_RATE11M)?"CCK_11M":\ -+(rate ==DESC_RATE6M)?"OFDM_6M":\ -+(rate ==DESC_RATE9M)?"OFDM_9M":\ -+(rate ==DESC_RATE12M)?"OFDM_12M":\ -+(rate ==DESC_RATE18M)?"OFDM_18M":\ -+(rate ==DESC_RATE24M)?"OFDM_24M":\ -+(rate ==DESC_RATE36M)?"OFDM_36M":\ -+(rate ==DESC_RATE48M)?"OFDM_48M":\ -+(rate ==DESC_RATE54M)?"OFDM_54M":\ -+(rate ==DESC_RATEMCS0)?"MCS0":\ -+(rate ==DESC_RATEMCS1)?"MCS1":\ -+(rate ==DESC_RATEMCS2)?"MCS2":\ -+(rate ==DESC_RATEMCS3)?"MCS3":\ -+(rate ==DESC_RATEMCS4)?"MCS4":\ -+(rate ==DESC_RATEMCS5)?"MCS5":\ -+(rate ==DESC_RATEMCS6)?"MCS6":\ -+(rate ==DESC_RATEMCS7)?"MCS7":\ -+(rate ==DESC_RATEMCS8)?"MCS8":\ -+(rate ==DESC_RATEMCS9)?"MCS9":\ -+(rate ==DESC_RATEMCS10)?"MCS10":\ -+(rate ==DESC_RATEMCS11)?"MCS11":\ -+(rate ==DESC_RATEMCS12)?"MCS12":\ -+(rate ==DESC_RATEMCS13)?"MCS13":\ -+(rate ==DESC_RATEMCS14)?"MCS14":\ -+(rate ==DESC_RATEMCS15)?"MCS15":\ -+(rate ==DESC_RATEVHTSS1MCS0)?"VHTSS1MCS0":\ -+(rate ==DESC_RATEVHTSS1MCS1)?"VHTSS1MCS1":\ -+(rate ==DESC_RATEVHTSS1MCS2)?"VHTSS1MCS2":\ -+(rate ==DESC_RATEVHTSS1MCS3)?"VHTSS1MCS3":\ -+(rate ==DESC_RATEVHTSS1MCS4)?"VHTSS1MCS4":\ -+(rate ==DESC_RATEVHTSS1MCS5)?"VHTSS1MCS5":\ -+(rate ==DESC_RATEVHTSS1MCS6)?"VHTSS1MCS6":\ -+(rate ==DESC_RATEVHTSS1MCS7)?"VHTSS1MCS7":\ -+(rate ==DESC_RATEVHTSS1MCS8)?"VHTSS1MCS8":\ -+(rate ==DESC_RATEVHTSS1MCS9)?"VHTSS1MCS9":\ -+(rate ==DESC_RATEVHTSS2MCS0)?"VHTSS2MCS0":\ -+(rate ==DESC_RATEVHTSS2MCS1)?"VHTSS2MCS1":\ -+(rate ==DESC_RATEVHTSS2MCS2)?"VHTSS2MCS2":\ -+(rate ==DESC_RATEVHTSS2MCS3)?"VHTSS2MCS3":\ -+(rate ==DESC_RATEVHTSS2MCS4)?"VHTSS2MCS4":\ -+(rate ==DESC_RATEVHTSS2MCS5)?"VHTSS2MCS5":\ -+(rate ==DESC_RATEVHTSS2MCS6)?"VHTSS2MCS6":\ -+(rate ==DESC_RATEVHTSS2MCS7)?"VHTSS2MCS7":\ -+(rate ==DESC_RATEVHTSS2MCS8)?"VHTSS2MCS8":\ -+(rate ==DESC_RATEVHTSS2MCS9)?"VHTSS2MCS9":"UNKNOW" -+ -+ -+enum{ -+ UP_LINK, -+ DOWN_LINK, -+}; -+typedef enum _RT_MEDIA_STATUS { -+ RT_MEDIA_DISCONNECT = 0, -+ RT_MEDIA_CONNECT = 1 -+} RT_MEDIA_STATUS; -+ -+#define MAX_DLFW_PAGE_SIZE 4096 /* @ page : 4k bytes */ -+enum FIRMWARE_SOURCE { -+ FW_SOURCE_IMG_FILE = 0, -+ FW_SOURCE_HEADER_FILE = 1, /* from header file */ -+}; -+ -+/* BK, BE, VI, VO, HCCA, MANAGEMENT, COMMAND, HIGH, BEACON. */ -+/* define MAX_TX_QUEUE 9 */ -+ -+#define TX_SELE_HQ BIT(0) /* High Queue */ -+#define TX_SELE_LQ BIT(1) /* Low Queue */ -+#define TX_SELE_NQ BIT(2) /* Normal Queue */ -+#define TX_SELE_EQ BIT(3) /* Extern Queue */ -+ -+#define PageNum_128(_Len) (u32)(((_Len)>>7) + ((_Len)&0x7F ? 1:0)) -+#define PageNum_256(_Len) (u32)(((_Len)>>8) + ((_Len)&0xFF ? 1:0)) -+#define PageNum_512(_Len) (u32)(((_Len)>>9) + ((_Len)&0x1FF ? 1:0)) -+#define PageNum(_Len, _Size) (u32)(((_Len)/(_Size)) + ((_Len)&((_Size) - 1) ? 1:0)) -+ -+ -+u8 rtw_hal_data_init(struct adapter *padapter); -+void rtw_hal_data_deinit(struct adapter *padapter); -+ -+void dump_chip_info(HAL_VERSION ChipVersion); -+ -+u8 /* return the final channel plan decision */ -+hal_com_config_channel_plan( -+struct adapter *padapter, -+u8 hw_channel_plan, /* channel plan from HW (efuse/eeprom) */ -+u8 sw_channel_plan, /* channel plan from SW (registry/module param) */ -+u8 def_channel_plan, /* channel plan used when the former two is invalid */ -+bool AutoLoadFail -+ ); -+ -+bool -+HAL_IsLegalChannel( -+struct adapter *Adapter, -+u32 Channel -+ ); -+ -+u8 MRateToHwRate(u8 rate); -+ -+u8 HwRateToMRate(u8 rate); -+ -+void HalSetBrateCfg( -+ struct adapter * Adapter, -+ u8 *mBratesOS, -+ u16 *pBrateCfg); -+ -+bool -+Hal_MappingOutPipe( -+struct adapter *padapter, -+u8 NumOutPipe -+ ); -+ -+void hal_init_macaddr(struct adapter *adapter); -+ -+void rtw_init_hal_com_default_value(struct adapter * Adapter); -+ -+void c2h_evt_clear(struct adapter *adapter); -+s32 c2h_evt_read_88xx(struct adapter *adapter, u8 *buf); -+ -+u8 rtw_hal_networktype_to_raid(struct adapter *adapter, struct sta_info *psta); -+u8 rtw_get_mgntframe_raid(struct adapter *adapter, unsigned char network_type); -+void rtw_hal_update_sta_rate_mask(struct adapter *padapter, struct sta_info *psta); -+ -+void hw_var_port_switch (struct adapter *adapter); -+ -+void SetHwReg(struct adapter *padapter, u8 variable, u8 *val); -+void GetHwReg(struct adapter *padapter, u8 variable, u8 *val); -+void rtw_hal_check_rxfifo_full(struct adapter *adapter); -+ -+u8 SetHalDefVar(struct adapter *adapter, enum HAL_DEF_VARIABLE variable, -+ void *value); -+u8 GetHalDefVar(struct adapter *adapter, enum HAL_DEF_VARIABLE variable, -+ void *value); -+ -+bool eqNByte(u8 *str1, u8 *str2, u32 num); -+ -+bool IsHexDigit(char chTmp); -+ -+u32 MapCharToHexDigit(char chTmp); -+ -+bool GetHexValueFromString(char *szStr, u32 *pu4bVal, u32 *pu4bMove); -+ -+bool GetFractionValueFromString(char *szStr, u8 *pInteger, u8 *pFraction, -+ u32 *pu4bMove); -+ -+bool IsCommentString(char *szStr); -+ -+bool ParseQualifiedString(char *In, u32 *Start, char *Out, char LeftQualifier, -+ char RightQualifier); -+ -+bool GetU1ByteIntegerFromStringInDecimal(char *str, u8 *in); -+ -+bool isAllSpaceOrTab(u8 *data, u8 size); -+ -+void linked_info_dump(struct adapter *padapter, u8 benable); -+#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+void rtw_get_raw_rssi_info(void *sel, struct adapter *padapter); -+void rtw_store_phy_info(struct adapter *padapter, union recv_frame *prframe); -+void rtw_dump_raw_rssi_info(struct adapter *padapter); -+#endif -+ -+#define HWSET_MAX_SIZE 512 -+ -+void rtw_bb_rf_gain_offset(struct adapter *padapter); -+ -+void GetHalODMVar(struct adapter *Adapter, -+ enum HAL_ODM_VARIABLE eVariable, -+ void * pValue1, -+ void * pValue2); -+void SetHalODMVar( -+ struct adapter * Adapter, -+ enum HAL_ODM_VARIABLE eVariable, -+ void * pValue1, -+ bool bSet); -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+struct noise_info -+{ -+ u8 bPauseDIG; -+ u8 IGIValue; -+ u32 max_time;/* ms */ -+ u8 chan; -+}; -+#endif -+ -+#endif /* __HAL_COMMON_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/hal_com_h2c.h linux/3rdparty/rtl8723bs/include/hal_com_h2c.h ---- linux.old/3rdparty/rtl8723bs/include/hal_com_h2c.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/hal_com_h2c.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,293 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __COMMON_H2C_H__ -+#define __COMMON_H2C_H__ -+ -+/* */ -+/* H2C CMD DEFINITION ------------------------------------------------ */ -+/* */ -+/* 88e, 8723b, 8812, 8821, 92e use the same FW code base */ -+enum h2c_cmd{ -+ /* Common Class: 000 */ -+ H2C_RSVD_PAGE = 0x00, -+ H2C_MEDIA_STATUS_RPT = 0x01, -+ H2C_SCAN_ENABLE = 0x02, -+ H2C_KEEP_ALIVE = 0x03, -+ H2C_DISCON_DECISION = 0x04, -+ H2C_PSD_OFFLOAD = 0x05, -+ H2C_AP_OFFLOAD = 0x08, -+ H2C_BCN_RSVDPAGE = 0x09, -+ H2C_PROBERSP_RSVDPAGE = 0x0A, -+ H2C_FCS_RSVDPAGE = 0x10, -+ H2C_FCS_INFO = 0x11, -+ H2C_AP_WOW_GPIO_CTRL = 0x13, -+ -+ /* PoweSave Class: 001 */ -+ H2C_SET_PWR_MODE = 0x20, -+ H2C_PS_TUNING_PARA = 0x21, -+ H2C_PS_TUNING_PARA2 = 0x22, -+ H2C_P2P_LPS_PARAM = 0x23, -+ H2C_P2P_PS_OFFLOAD = 0x24, -+ H2C_PS_SCAN_ENABLE = 0x25, -+ H2C_SAP_PS_ = 0x26, -+ H2C_INACTIVE_PS_ = 0x27, /* Inactive_PS */ -+ H2C_FWLPS_IN_IPS_ = 0x28, -+ -+ /* Dynamic Mechanism Class: 010 */ -+ H2C_MACID_CFG = 0x40, -+ H2C_TXBF = 0x41, -+ H2C_RSSI_SETTING = 0x42, -+ H2C_AP_REQ_TXRPT = 0x43, -+ H2C_INIT_RATE_COLLECT = 0x44, -+ -+ /* BT Class: 011 */ -+ H2C_B_TYPE_TDMA = 0x60, -+ H2C_BT_INFO = 0x61, -+ H2C_FORCE_BT_TXPWR = 0x62, -+ H2C_BT_IGNORE_WLANACT = 0x63, -+ H2C_DAC_SWING_VALUE = 0x64, -+ H2C_ANT_SEL_RSV = 0x65, -+ H2C_WL_OPMODE = 0x66, -+ H2C_BT_MP_OPER = 0x67, -+ H2C_BT_CONTROL = 0x68, -+ H2C_BT_WIFI_CTRL = 0x69, -+ H2C_BT_FW_PATCH = 0x6A, -+ -+ /* WOWLAN Class: 100 */ -+ H2C_WOWLAN = 0x80, -+ H2C_REMOTE_WAKE_CTRL = 0x81, -+ H2C_AOAC_GLOBAL_INFO = 0x82, -+ H2C_AOAC_RSVD_PAGE = 0x83, -+ H2C_AOAC_RSVD_PAGE2 = 0x84, -+ H2C_D0_SCAN_OFFLOAD_CTRL = 0x85, -+ H2C_D0_SCAN_OFFLOAD_INFO = 0x86, -+ H2C_CHNL_SWITCH_OFFLOAD = 0x87, -+ H2C_AOAC_RSVDPAGE3 = 0x88, -+ -+ H2C_RESET_TSF = 0xC0, -+ H2C_MAXID, -+}; -+ -+#define H2C_RSVDPAGE_LOC_LEN 5 -+#define H2C_MEDIA_STATUS_RPT_LEN 3 -+#define H2C_KEEP_ALIVE_CTRL_LEN 2 -+#define H2C_DISCON_DECISION_LEN 3 -+#define H2C_AP_OFFLOAD_LEN 3 -+#define H2C_AP_WOW_GPIO_CTRL_LEN 4 -+#define H2C_AP_PS_LEN 2 -+#define H2C_PWRMODE_LEN 7 -+#define H2C_PSTUNEPARAM_LEN 4 -+#define H2C_MACID_CFG_LEN 7 -+#define H2C_BTMP_OPER_LEN 4 -+#define H2C_WOWLAN_LEN 4 -+#define H2C_REMOTE_WAKE_CTRL_LEN 3 -+#define H2C_AOAC_GLOBAL_INFO_LEN 2 -+#define H2C_AOAC_RSVDPAGE_LOC_LEN 7 -+#define H2C_SCAN_OFFLOAD_CTRL_LEN 4 -+#define H2C_BT_FW_PATCH_LEN 6 -+#define H2C_RSSI_SETTING_LEN 4 -+#define H2C_AP_REQ_TXRPT_LEN 2 -+#define H2C_FORCE_BT_TXPWR_LEN 3 -+#define H2C_BCN_RSVDPAGE_LEN 5 -+#define H2C_PROBERSP_RSVDPAGE_LEN 5 -+ -+#ifdef CONFIG_WOWLAN -+#define eqMacAddr(a, b) (((a)[0]==(b)[0] && (a)[1]==(b)[1] && (a)[2]==(b)[2] && (a)[3]==(b)[3] && (a)[4]==(b)[4] && (a)[5]==(b)[5]) ? 1:0) -+#define cpMacAddr(des, src) ((des)[0]=(src)[0], (des)[1]=(src)[1], (des)[2]=(src)[2], (des)[3]=(src)[3], (des)[4]=(src)[4], (des)[5]=(src)[5]) -+#define cpIpAddr(des, src) ((des)[0]=(src)[0], (des)[1]=(src)[1], (des)[2]=(src)[2], (des)[3]=(src)[3]) -+ -+/* */ -+/* ARP packet */ -+/* */ -+/* LLC Header */ -+#define GET_ARP_PKT_LLC_TYPE(__pHeader) ReadEF2Byte(((u8 *)(__pHeader)) + 6) -+ -+/* ARP element */ -+#define GET_ARP_PKT_OPERATION(__pHeader) ReadEF2Byte(((u8 *)(__pHeader)) + 6) -+#define GET_ARP_PKT_SENDER_MAC_ADDR(__pHeader, _val) cpMacAddr((u8 *)(_val), ((u8 *)(__pHeader))+8) -+#define GET_ARP_PKT_SENDER_IP_ADDR(__pHeader, _val) cpIpAddr((u8 *)(_val), ((u8 *)(__pHeader))+14) -+#define GET_ARP_PKT_TARGET_MAC_ADDR(__pHeader, _val) cpMacAddr((u8 *)(_val), ((u8 *)(__pHeader))+18) -+#define GET_ARP_PKT_TARGET_IP_ADDR(__pHeader, _val) cpIpAddr((u8 *)(_val), ((u8 *)(__pHeader))+24) -+ -+#define SET_ARP_PKT_HW(__pHeader, __Value) WRITEEF2BYTE(((u8 *)(__pHeader)) + 0, __Value) -+#define SET_ARP_PKT_PROTOCOL(__pHeader, __Value) WRITEEF2BYTE(((u8 *)(__pHeader)) + 2, __Value) -+#define SET_ARP_PKT_HW_ADDR_LEN(__pHeader, __Value) WRITEEF1BYTE(((u8 *)(__pHeader)) + 4, __Value) -+#define SET_ARP_PKT_PROTOCOL_ADDR_LEN(__pHeader, __Value) WRITEEF1BYTE(((u8 *)(__pHeader)) + 5, __Value) -+#define SET_ARP_PKT_OPERATION(__pHeader, __Value) WRITEEF2BYTE(((u8 *)(__pHeader)) + 6, __Value) -+#define SET_ARP_PKT_SENDER_MAC_ADDR(__pHeader, _val) cpMacAddr(((u8 *)(__pHeader))+8, (u8 *)(_val)) -+#define SET_ARP_PKT_SENDER_IP_ADDR(__pHeader, _val) cpIpAddr(((u8 *)(__pHeader))+14, (u8 *)(_val)) -+#define SET_ARP_PKT_TARGET_MAC_ADDR(__pHeader, _val) cpMacAddr(((u8 *)(__pHeader))+18, (u8 *)(_val)) -+#define SET_ARP_PKT_TARGET_IP_ADDR(__pHeader, _val) cpIpAddr(((u8 *)(__pHeader))+24, (u8 *)(_val)) -+ -+#define FW_WOWLAN_FUN_EN BIT(0) -+#define FW_WOWLAN_PATTERN_MATCH BIT(1) -+#define FW_WOWLAN_MAGIC_PKT BIT(2) -+#define FW_WOWLAN_UNICAST BIT(3) -+#define FW_WOWLAN_ALL_PKT_DROP BIT(4) -+#define FW_WOWLAN_GPIO_ACTIVE BIT(5) -+#define FW_WOWLAN_REKEY_WAKEUP BIT(6) -+#define FW_WOWLAN_DEAUTH_WAKEUP BIT(7) -+ -+#define FW_WOWLAN_GPIO_WAKEUP_EN BIT(0) -+#define FW_FW_PARSE_MAGIC_PKT BIT(1) -+ -+#define FW_REMOTE_WAKE_CTRL_EN BIT(0) -+#define FW_REALWOWLAN_EN BIT(5) -+ -+#define FW_WOWLAN_KEEP_ALIVE_EN BIT(0) -+#define FW_ADOPT_USER BIT(1) -+#define FW_WOWLAN_KEEP_ALIVE_PKT_TYPE BIT(2) -+ -+#define FW_REMOTE_WAKE_CTRL_EN BIT(0) -+#define FW_ARP_EN BIT(1) -+#define FW_REALWOWLAN_EN BIT(5) -+#define FW_WOW_FW_UNICAST_EN BIT(7) -+ -+#endif /* CONFIG_WOWLAN */ -+ -+/* _RSVDPAGE_LOC_CMD_0x00 */ -+#define SET_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value)SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+ -+/* _MEDIA_STATUS_RPT_PARM_CMD_0x01 */ -+#define SET_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+#define SET_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+2, 0, 8, __Value) -+ -+/* _KEEP_ALIVE_CMD_0x03 */ -+#define SET_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _DISCONNECT_DECISION_CMD_0x04 */ -+#define SET_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+#define SET_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+2, 0, 8, __Value) -+ -+#ifdef CONFIG_AP_WOWLAN -+/* _AP_Offload 0x08 */ -+#define SET_H2CCMD_AP_WOWLAN_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+/* _BCN_RsvdPage 0x09 */ -+#define SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_BCN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+/* _Probersp_RsvdPage 0x0a */ -+#define SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_ProbeRsp(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+/* _Probersp_RsvdPage 0x13 */ -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_INDEX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_C2H_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_PLUS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_HIGH_ACTIVE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_C2H_DURATION(__pH2CCmd, __Value)SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+/* _AP_PS 0x26 */ -+#define SET_H2CCMD_AP_WOW_PS_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_AP_WOW_PS_32K_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_AP_WOW_PS_RF(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_AP_WOW_PS_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#endif -+ -+/* _WoWLAN PARAM_CMD_0x80 */ -+#define SET_H2CCMD_WOWLAN_FUNC_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_WOWLAN_MAGIC_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_WOWLAN_UNICAST_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_H2CCMD_WOWLAN_ALL_PKT_DROP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_H2CCMD_WOWLAN_GPIO_ACTIVE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+#define SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) -+#define SET_H2CCMD_WOWLAN_DISCONNECT_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) -+#define SET_H2CCMD_WOWLAN_GPIONUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 7, __Value) -+#define SET_H2CCMD_WOWLAN_DATAPIN_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 7, 1, __Value) -+#define SET_H2CCMD_WOWLAN_GPIO_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+/* define SET_H2CCMD_WOWLAN_GPIO_PULSE_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 1, __Value) */ -+#define SET_H2CCMD_WOWLAN_GPIO_PULSE_COUNT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+ -+/* _REMOTE_WAKEUP_CMD_0x81 */ -+#define SET_H2CCMD_REMOTE_WAKECTRL_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_NDP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_NLO_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_FW_UNICAST_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 1, __Value) -+ -+/* AOAC_GLOBAL_INFO_0x82 */ -+#define SET_H2CCMD_AOAC_GLOBAL_INFO_PAIRWISE_ENC_ALG(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_GLOBAL_INFO_GROUP_ENC_ALG(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+ -+/* AOAC_RSVDPAGE_LOC_0x83 */ -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd), 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_NEIGHBOR_ADV(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+#ifdef CONFIG_GTK_OL -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_EXT_MEM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+5, 0, 8, __Value) -+#endif /* CONFIG_GTK_OL */ -+#ifdef CONFIG_PNO_SUPPORT -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_NLO_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd), 0, 8, __Value) -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+/* D0_Scan_Offload_Info_0x86 */ -+#define SET_H2CCMD_AOAC_NLO_FUN_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 3, 1, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_PROBE_PACKET(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_SCAN_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_SSID_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+/* */ -+/* Structure -------------------------------------------------- */ -+/* */ -+typedef struct _RSVDPAGE_LOC { -+ u8 LocProbeRsp; -+ u8 LocPsPoll; -+ u8 LocNullData; -+ u8 LocQosNull; -+ u8 LocBTQosNull; -+#ifdef CONFIG_WOWLAN -+ u8 LocRemoteCtrlInfo; -+ u8 LocArpRsp; -+ u8 LocNbrAdv; -+ u8 LocGTKRsp; -+ u8 LocGTKInfo; -+ u8 LocProbeReq; -+ u8 LocNetList; -+#ifdef CONFIG_GTK_OL -+ u8 LocGTKEXTMEM; -+#endif /* CONFIG_GTK_OL */ -+#ifdef CONFIG_PNO_SUPPORT -+ u8 LocPNOInfo; -+ u8 LocScanInfo; -+ u8 LocSSIDInfo; -+ u8 LocProbePacket; -+#endif /* CONFIG_PNO_SUPPORT */ -+#endif /* CONFIG_WOWLAN */ -+#ifdef CONFIG_AP_WOWLAN -+ u8 LocApOffloadBCN; -+#endif /* CONFIG_AP_WOWLAN */ -+} RSVDPAGE_LOC, *PRSVDPAGE_LOC; -+ -+#endif -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void rtw_get_current_ip_address(struct adapter *padapter, u8 *pcurrentip); -+void rtw_get_sec_iv(struct adapter *padapter, u8*pcur_dot11txpn, u8 *StaAddr); -+void rtw_set_sec_pn(struct adapter *padapter); -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/hal_com_phycfg.h linux/3rdparty/rtl8723bs/include/hal_com_phycfg.h ---- linux.old/3rdparty/rtl8723bs/include/hal_com_phycfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/hal_com_phycfg.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,275 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_COM_PHYCFG_H__ -+#define __HAL_COM_PHYCFG_H__ -+ -+#define PathA 0x0 /* Useless */ -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 -+ -+enum RATE_SECTION { -+ CCK = 0, -+ OFDM, -+ HT_MCS0_MCS7, -+ HT_MCS8_MCS15, -+ HT_MCS16_MCS23, -+ HT_MCS24_MCS31, -+ VHT_1SSMCS0_1SSMCS9, -+ VHT_2SSMCS0_2SSMCS9, -+ VHT_3SSMCS0_3SSMCS9, -+ VHT_4SSMCS0_4SSMCS9, -+}; -+ -+enum RF_TX_NUM { -+ RF_1TX = 0, -+ RF_2TX, -+ RF_3TX, -+ RF_4TX, -+ RF_MAX_TX_NUM, -+ RF_TX_NUM_NONIMPLEMENT, -+}; -+ -+#define MAX_POWER_INDEX 0x3F -+ -+enum _REGULATION_TXPWR_LMT { -+ TXPWR_LMT_FCC = 0, -+ TXPWR_LMT_MKK, -+ TXPWR_LMT_ETSI, -+ TXPWR_LMT_WW, -+ TXPWR_LMT_MAX_REGULATION_NUM, -+}; -+ -+/*------------------------------Define structure----------------------------*/ -+struct bb_register_def { -+ u32 rfintfs; /* set software control: */ -+ /* 0x870~0x877[8 bytes] */ -+ -+ u32 rfintfo; /* output data: */ -+ /* 0x860~0x86f [16 bytes] */ -+ -+ u32 rfintfe; /* output enable: */ -+ /* 0x860~0x86f [16 bytes] */ -+ -+ u32 rf3wireOffset; /* LSSI data: */ -+ /* 0x840~0x84f [16 bytes] */ -+ -+ u32 rfHSSIPara2; /* wire parameter control2 : */ -+ /* 0x824~0x827, 0x82c~0x82f, -+ * 0x834~0x837, 0x83c~0x83f -+ */ -+ u32 rfLSSIReadBack; /* LSSI RF readback data SI mode */ -+ /* 0x8a0~0x8af [16 bytes] */ -+ -+ u32 rfLSSIReadBackPi; /* LSSI RF readback data PI mode -+ * 0x8b8-8bc for Path A and B */ -+ -+}; -+ -+u8 -+PHY_GetTxPowerByRateBase( -+struct adapter * Adapter, -+u8 Band, -+u8 RfPath, -+u8 TxNum, -+enum RATE_SECTION RateSection -+ ); -+ -+u8 -+PHY_GetRateSectionIndexOfTxPowerByRate( -+struct adapter *padapter, -+u32 RegAddr, -+u32 BitMask -+ ); -+ -+void -+PHY_GetRateValuesOfTxPowerByRate( -+struct adapter *padapter, -+u32 RegAddr, -+u32 BitMask, -+u32 Value, -+ u8* RateIndex, -+ s8* PwrByRateVal, -+ u8* RateNum -+ ); -+ -+u8 -+PHY_GetRateIndexOfTxPowerByRate( -+u8 Rate -+ ); -+ -+void -+PHY_SetTxPowerIndexByRateSection( -+struct adapter * padapter, -+u8 RFPath, -+u8 Channel, -+u8 RateSection -+ ); -+ -+s8 -+PHY_GetTxPowerByRate( -+struct adapter *padapter, -+u8 Band, -+u8 RFPath, -+u8 TxNum, -+u8 RateIndex -+ ); -+ -+void -+PHY_SetTxPowerByRate( -+struct adapter *padapter, -+u8 Band, -+u8 RFPath, -+u8 TxNum, -+u8 Rate, -+s8 Value -+ ); -+ -+void -+PHY_SetTxPowerLevelByPath( -+struct adapter *Adapter, -+u8 channel, -+u8 path -+ ); -+ -+void -+PHY_SetTxPowerIndexByRateArray( -+struct adapter * padapter, -+u8 RFPath, -+enum CHANNEL_WIDTH BandWidth, -+u8 Channel, -+u8* Rates, -+u8 RateArraySize -+ ); -+ -+void -+PHY_InitTxPowerByRate( -+struct adapter *padapter -+ ); -+ -+void -+PHY_StoreTxPowerByRate( -+struct adapter *padapter, -+u32 Band, -+u32 RfPath, -+u32 TxNum, -+u32 RegAddr, -+u32 BitMask, -+u32 Data -+ ); -+ -+void -+PHY_TxPowerByRateConfiguration( -+ struct adapter * padapter -+ ); -+ -+u8 -+PHY_GetTxPowerIndexBase( -+struct adapter * padapter, -+u8 RFPath, -+u8 Rate, -+enum CHANNEL_WIDTH BandWidth, -+u8 Channel, -+ bool *bIn24G -+ ); -+ -+s8 PHY_GetTxPowerLimit (struct adapter *adapter, u32 RegPwrTblSel, -+ enum BAND_TYPE Band, enum CHANNEL_WIDTH Bandwidth, -+u8 RfPath, -+u8 DataRate, -+u8 Channel -+ ); -+ -+void -+PHY_SetTxPowerLimit( -+struct adapter * Adapter, -+u8 *Regulation, -+u8 *Band, -+u8 *Bandwidth, -+u8 *RateSection, -+u8 *RfPath, -+u8 *Channel, -+u8 *PowerLimit -+ ); -+ -+void -+PHY_ConvertTxPowerLimitToPowerIndex( -+struct adapter * Adapter -+ ); -+ -+void -+PHY_InitTxPowerLimit( -+struct adapter * Adapter -+ ); -+ -+s8 -+PHY_GetTxPowerTrackingOffset( -+ struct adapter *padapter, -+ u8 Rate, -+ u8 RFPath -+ ); -+ -+u8 -+PHY_GetTxPowerIndex( -+struct adapter * padapter, -+u8 RFPath, -+u8 Rate, -+enum CHANNEL_WIDTH BandWidth, -+u8 Channel -+ ); -+ -+void -+PHY_SetTxPowerIndex( -+struct adapter * padapter, -+u32 PowerIndex, -+u8 RFPath, -+u8 Rate -+ ); -+ -+void -+Hal_ChannelPlanToRegulation( -+struct adapter * Adapter, -+u16 ChannelPlan -+ ); -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+#define MAX_PARA_FILE_BUF_LEN 25600 -+ -+#define LOAD_MAC_PARA_FILE BIT0 -+#define LOAD_BB_PARA_FILE BIT1 -+#define LOAD_BB_PG_PARA_FILE BIT2 -+#define LOAD_BB_MP_PARA_FILE BIT3 -+#define LOAD_RF_PARA_FILE BIT4 -+#define LOAD_RF_TXPWR_TRACK_PARA_FILE BIT5 -+#define LOAD_RF_TXPWR_LMT_PARA_FILE BIT6 -+ -+int phy_ConfigMACWithParaFile(struct adapter *Adapter, char*pFileName); -+ -+int phy_ConfigBBWithParaFile(struct adapter *Adapter, char*pFileName, u32 ConfigType); -+ -+int phy_ConfigBBWithPgParaFile(struct adapter *Adapter, char*pFileName); -+ -+int phy_ConfigBBWithMpParaFile(struct adapter *Adapter, char*pFileName); -+ -+int PHY_ConfigRFWithParaFile(struct adapter *Adapter, char*pFileName, u8 eRFPath); -+ -+int PHY_ConfigRFWithTxPwrTrackParaFile(struct adapter *Adapter, char*pFileName); -+ -+int PHY_ConfigRFWithPowerLimitTableParaFile(struct adapter *Adapter, char*pFileName); -+ -+void phy_free_filebuf(struct adapter *padapter); -+#endif /* CONFIG_LOAD_PHY_PARA_FROM_FILE */ -+ -+#endif /* __HAL_COMMON_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/hal_com_reg.h linux/3rdparty/rtl8723bs/include/hal_com_reg.h ---- linux.old/3rdparty/rtl8723bs/include/hal_com_reg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/hal_com_reg.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1725 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_COMMON_REG_H__ -+#define __HAL_COMMON_REG_H__ -+ -+ -+#define MAC_ADDR_LEN 6 -+ -+#define HAL_NAV_UPPER_UNIT 128 /* micro-second */ -+ -+/* 8188E PKT_BUFF_ACCESS_CTRL value */ -+#define TXPKT_BUF_SELECT 0x69 -+#define RXPKT_BUF_SELECT 0xA5 -+#define DISABLE_TRXPKT_BUF_ACCESS 0x0 -+ -+/* */ -+/* */ -+/* */ -+ -+/* */ -+/* */ -+/* 0x0000h ~ 0x00FFh System Configuration */ -+/* */ -+/* */ -+#define REG_SYS_ISO_CTRL 0x0000 -+#define REG_SYS_FUNC_EN 0x0002 -+#define REG_APS_FSMCO 0x0004 -+#define REG_SYS_CLKR 0x0008 -+#define REG_9346CR 0x000A -+#define REG_SYS_EEPROM_CTRL 0x000A -+#define REG_EE_VPD 0x000C -+#define REG_AFE_MISC 0x0010 -+#define REG_SPS0_CTRL 0x0011 -+#define REG_SPS0_CTRL_6 0x0016 -+#define REG_POWER_OFF_IN_PROCESS 0x0017 -+#define REG_SPS_OCP_CFG 0x0018 -+#define REG_RSV_CTRL 0x001C -+#define REG_RF_CTRL 0x001F -+#define REG_LDOA15_CTRL 0x0020 -+#define REG_LDOV12D_CTRL 0x0021 -+#define REG_LDOHCI12_CTRL 0x0022 -+#define REG_LPLDO_CTRL 0x0023 -+#define REG_AFE_XTAL_CTRL 0x0024 -+#define REG_AFE_LDO_CTRL 0x0027 /* 1.5v for 8188EE test chip, 1.4v for MP chip */ -+#define REG_AFE_PLL_CTRL 0x0028 -+#define REG_MAC_PHY_CTRL 0x002c /* for 92d, DMDP, SMSP, DMSP contrl */ -+#define REG_APE_PLL_CTRL_EXT 0x002c -+#define REG_EFUSE_CTRL 0x0030 -+#define REG_EFUSE_TEST 0x0034 -+#define REG_PWR_DATA 0x0038 -+#define REG_CAL_TIMER 0x003C -+#define REG_ACLK_MON 0x003E -+#define REG_GPIO_MUXCFG 0x0040 -+#define REG_GPIO_IO_SEL 0x0042 -+#define REG_MAC_PINMUX_CFG 0x0043 -+#define REG_GPIO_PIN_CTRL 0x0044 -+#define REG_GPIO_INTM 0x0048 -+#define REG_LEDCFG0 0x004C -+#define REG_LEDCFG1 0x004D -+#define REG_LEDCFG2 0x004E -+#define REG_LEDCFG3 0x004F -+#define REG_FSIMR 0x0050 -+#define REG_FSISR 0x0054 -+#define REG_HSIMR 0x0058 -+#define REG_HSISR 0x005c -+#define REG_GPIO_PIN_CTRL_2 0x0060 /* RTL8723 WIFI/BT/GPS Multi-Function GPIO Pin Control. */ -+#define REG_GPIO_IO_SEL_2 0x0062 /* RTL8723 WIFI/BT/GPS Multi-Function GPIO Select. */ -+#define REG_MULTI_FUNC_CTRL 0x0068 /* RTL8723 WIFI/BT/GPS Multi-Function control source. */ -+#define REG_GSSR 0x006c -+#define REG_AFE_XTAL_CTRL_EXT 0x0078 /* RTL8188E */ -+#define REG_XCK_OUT_CTRL 0x007c /* RTL8188E */ -+#define REG_MCUFWDL 0x0080 -+#define REG_WOL_EVENT 0x0081 /* RTL8188E */ -+#define REG_MCUTSTCFG 0x0084 -+#define REG_FDHM0 0x0088 -+#define REG_HOST_SUSP_CNT 0x00BC /* RTL8192C Host suspend counter on FPGA platform */ -+#define REG_SYSTEM_ON_CTRL 0x00CC /* For 8723AE Reset after S3 */ -+#define REG_EFUSE_ACCESS 0x00CF /* Efuse access protection for RTL8723 */ -+#define REG_BIST_SCAN 0x00D0 -+#define REG_BIST_RPT 0x00D4 -+#define REG_BIST_ROM_RPT 0x00D8 -+#define REG_USB_SIE_INTF 0x00E0 -+#define REG_PCIE_MIO_INTF 0x00E4 -+#define REG_PCIE_MIO_INTD 0x00E8 -+#define REG_HPON_FSM 0x00EC -+#define REG_SYS_CFG 0x00F0 -+#define REG_GPIO_OUTSTS 0x00F4 /* For RTL8723 only. */ -+#define REG_TYPE_ID 0x00FC -+ -+/* */ -+/* 2010/12/29 MH Add for 92D */ -+/* */ -+#define REG_MAC_PHY_CTRL_NORMAL 0x00f8 -+ -+ -+/* */ -+/* */ -+/* 0x0100h ~ 0x01FFh MACTOP General Configuration */ -+/* */ -+/* */ -+#define REG_CR 0x0100 -+#define REG_PBP 0x0104 -+#define REG_PKT_BUFF_ACCESS_CTRL 0x0106 -+#define REG_TRXDMA_CTRL 0x010C -+#define REG_TRXFF_BNDY 0x0114 -+#define REG_TRXFF_STATUS 0x0118 -+#define REG_RXFF_PTR 0x011C -+#define REG_HIMR 0x0120 -+#define REG_HISR 0x0124 -+#define REG_HIMRE 0x0128 -+#define REG_HISRE 0x012C -+#define REG_CPWM 0x012F -+#define REG_FWIMR 0x0130 -+#define REG_FWISR 0x0134 -+#define REG_FTIMR 0x0138 -+#define REG_FTISR 0x013C /* RTL8192C */ -+#define REG_PKTBUF_DBG_CTRL 0x0140 -+#define REG_RXPKTBUF_CTRL (REG_PKTBUF_DBG_CTRL+2) -+#define REG_PKTBUF_DBG_DATA_L 0x0144 -+#define REG_PKTBUF_DBG_DATA_H 0x0148 -+ -+#define REG_TC0_CTRL 0x0150 -+#define REG_TC1_CTRL 0x0154 -+#define REG_TC2_CTRL 0x0158 -+#define REG_TC3_CTRL 0x015C -+#define REG_TC4_CTRL 0x0160 -+#define REG_TCUNIT_BASE 0x0164 -+#define REG_MBIST_START 0x0174 -+#define REG_MBIST_DONE 0x0178 -+#define REG_MBIST_FAIL 0x017C -+#define REG_32K_CTRL 0x0194 /* RTL8188E */ -+#define REG_C2HEVT_MSG_NORMAL 0x01A0 -+#define REG_C2HEVT_CLEAR 0x01AF -+#define REG_MCUTST_1 0x01c0 -+#define REG_MCUTST_WOWLAN 0x01C7 /* Defined after 8188E series. */ -+#define REG_FMETHR 0x01C8 -+#define REG_HMETFR 0x01CC -+#define REG_HMEBOX_0 0x01D0 -+#define REG_HMEBOX_1 0x01D4 -+#define REG_HMEBOX_2 0x01D8 -+#define REG_HMEBOX_3 0x01DC -+#define REG_LLT_INIT 0x01E0 -+ -+ -+/* */ -+/* */ -+/* 0x0200h ~ 0x027Fh TXDMA Configuration */ -+/* */ -+/* */ -+#define REG_RQPN 0x0200 -+#define REG_FIFOPAGE 0x0204 -+#define REG_TDECTRL 0x0208 -+#define REG_TXDMA_OFFSET_CHK 0x020C -+#define REG_TXDMA_STATUS 0x0210 -+#define REG_RQPN_NPQ 0x0214 -+#define REG_AUTO_LLT 0x0224 -+ -+ -+/* */ -+/* */ -+/* 0x0280h ~ 0x02FFh RXDMA Configuration */ -+/* */ -+/* */ -+#define REG_RXDMA_AGG_PG_TH 0x0280 -+#define REG_RXPKT_NUM 0x0284 -+#define REG_RXDMA_STATUS 0x0288 -+ -+/* */ -+/* */ -+/* 0x0300h ~ 0x03FFh PCIe */ -+/* */ -+/* */ -+#define REG_PCIE_CTRL_REG 0x0300 -+#define REG_INT_MIG 0x0304 /* Interrupt Migration */ -+#define REG_BCNQ_DESA 0x0308 /* TX Beacon Descriptor Address */ -+#define REG_HQ_DESA 0x0310 /* TX High Queue Descriptor Address */ -+#define REG_MGQ_DESA 0x0318 /* TX Manage Queue Descriptor Address */ -+#define REG_VOQ_DESA 0x0320 /* TX VO Queue Descriptor Address */ -+#define REG_VIQ_DESA 0x0328 /* TX VI Queue Descriptor Address */ -+#define REG_BEQ_DESA 0x0330 /* TX BE Queue Descriptor Address */ -+#define REG_BKQ_DESA 0x0338 /* TX BK Queue Descriptor Address */ -+#define REG_RX_DESA 0x0340 /* RX Queue Descriptor Address */ -+/* sherry added for DBI Read/Write 20091126 */ -+#define REG_DBI_WDATA 0x0348 /* Backdoor REG for Access Configuration */ -+#define REG_DBI_RDATA 0x034C /* Backdoor REG for Access Configuration */ -+#define REG_DBI_CTRL 0x0350 /* Backdoor REG for Access Configuration */ -+#define REG_DBI_FLAG 0x0352 /* Backdoor REG for Access Configuration */ -+#define REG_MDIO 0x0354 /* MDIO for Access PCIE PHY */ -+#define REG_DBG_SEL 0x0360 /* Debug Selection Register */ -+#define REG_PCIE_HRPWM 0x0361 /* PCIe RPWM */ -+#define REG_PCIE_HCPWM 0x0363 /* PCIe CPWM */ -+#define REG_WATCH_DOG 0x0368 -+ -+/* RTL8723 series ------------------------------- */ -+#define REG_PCIE_HISR_EN 0x0394 /* PCIE Local Interrupt Enable Register */ -+#define REG_PCIE_HISR 0x03A0 -+#define REG_PCIE_HISRE 0x03A4 -+#define REG_PCIE_HIMR 0x03A8 -+#define REG_PCIE_HIMRE 0x03AC -+ -+#define REG_USB_HIMR 0xFE38 -+#define REG_USB_HIMRE 0xFE3C -+#define REG_USB_HISR 0xFE78 -+#define REG_USB_HISRE 0xFE7C -+ -+ -+/* */ -+/* */ -+/* 0x0400h ~ 0x047Fh Protocol Configuration */ -+/* */ -+/* */ -+#define REG_VOQ_INFORMATION 0x0400 -+#define REG_VIQ_INFORMATION 0x0404 -+#define REG_BEQ_INFORMATION 0x0408 -+#define REG_BKQ_INFORMATION 0x040C -+#define REG_MGQ_INFORMATION 0x0410 -+#define REG_HGQ_INFORMATION 0x0414 -+#define REG_BCNQ_INFORMATION 0x0418 -+#define REG_TXPKT_EMPTY 0x041A -+#define REG_CPU_MGQ_INFORMATION 0x041C -+#define REG_FWHW_TXQ_CTRL 0x0420 -+#define REG_HWSEQ_CTRL 0x0423 -+#define REG_BCNQ_BDNY 0x0424 -+#define REG_MGQ_BDNY 0x0425 -+#define REG_LIFETIME_CTRL 0x0426 -+#define REG_MULTI_BCNQ_OFFSET 0x0427 -+#define REG_SPEC_SIFS 0x0428 -+#define REG_RL 0x042A -+#define REG_DARFRC 0x0430 -+#define REG_RARFRC 0x0438 -+#define REG_RRSR 0x0440 -+#define REG_ARFR0 0x0444 -+#define REG_ARFR1 0x0448 -+#define REG_ARFR2 0x044C -+#define REG_ARFR3 0x0450 -+#define REG_BCNQ1_BDNY 0x0457 -+ -+#define REG_AGGLEN_LMT 0x0458 -+#define REG_AMPDU_MIN_SPACE 0x045C -+#define REG_WMAC_LBK_BF_HD 0x045D -+#define REG_FAST_EDCA_CTRL 0x0460 -+#define REG_RD_RESP_PKT_TH 0x0463 -+ -+#define REG_INIRTS_RATE_SEL 0x0480 -+#define REG_INIDATA_RATE_SEL 0x0484 -+ -+#define REG_POWER_STAGE1 0x04B4 -+#define REG_POWER_STAGE2 0x04B8 -+#define REG_PKT_VO_VI_LIFE_TIME 0x04C0 -+#define REG_PKT_BE_BK_LIFE_TIME 0x04C2 -+#define REG_STBC_SETTING 0x04C4 -+#define REG_QUEUE_CTRL 0x04C6 -+#define REG_SINGLE_AMPDU_CTRL 0x04c7 -+#define REG_PROT_MODE_CTRL 0x04C8 -+#define REG_MAX_AGGR_NUM 0x04CA -+#define REG_RTS_MAX_AGGR_NUM 0x04CB -+#define REG_BAR_MODE_CTRL 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT 0x04CF -+#define REG_EARLY_MODE_CONTROL 0x04D0 -+#define REG_MACID_SLEEP 0x04D4 -+#define REG_NQOS_SEQ 0x04DC -+#define REG_QOS_SEQ 0x04DE -+#define REG_NEED_CPU_HANDLE 0x04E0 -+#define REG_PKT_LOSE_RPT 0x04E1 -+#define REG_PTCL_ERR_STATUS 0x04E2 -+#define REG_TX_RPT_CTRL 0x04EC -+#define REG_TX_RPT_TIME 0x04F0 /* 2 byte */ -+#define REG_DUMMY 0x04FC -+ -+/* */ -+/* */ -+/* 0x0500h ~ 0x05FFh EDCA Configuration */ -+/* */ -+/* */ -+#define REG_EDCA_VO_PARAM 0x0500 -+#define REG_EDCA_VI_PARAM 0x0504 -+#define REG_EDCA_BE_PARAM 0x0508 -+#define REG_EDCA_BK_PARAM 0x050C -+#define REG_BCNTCFG 0x0510 -+#define REG_PIFS 0x0512 -+#define REG_RDG_PIFS 0x0513 -+#define REG_SIFS_CTX 0x0514 -+#define REG_SIFS_TRX 0x0516 -+#define REG_TSFTR_SYN_OFFSET 0x0518 -+#define REG_AGGR_BREAK_TIME 0x051A -+#define REG_SLOT 0x051B -+#define REG_TX_PTCL_CTRL 0x0520 -+#define REG_TXPAUSE 0x0522 -+#define REG_DIS_TXREQ_CLR 0x0523 -+#define REG_RD_CTRL 0x0524 -+/* */ -+/* Format for offset 540h-542h: */ -+/* [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. */ -+/* [7:4]: Reserved. */ -+/* [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. */ -+/* [23:20]: Reserved */ -+/* Description: */ -+/* | */ -+/* |<--Setup--|--Hold------------>| */ -+/* --------------|---------------------- */ -+/* | */ -+/* TBTT */ -+/* Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. */ -+/* Described by Designer Tim and Bruce, 2011-01-14. */ -+/* */ -+#define REG_TBTT_PROHIBIT 0x0540 -+#define REG_RD_NAV_NXT 0x0544 -+#define REG_NAV_PROT_LEN 0x0546 -+#define REG_BCN_CTRL 0x0550 -+#define REG_BCN_CTRL_1 0x0551 -+#define REG_MBID_NUM 0x0552 -+#define REG_DUAL_TSF_RST 0x0553 -+#define REG_BCN_INTERVAL 0x0554 /* The same as REG_MBSSID_BCN_SPACE */ -+#define REG_DRVERLYINT 0x0558 -+#define REG_BCNDMATIM 0x0559 -+#define REG_ATIMWND 0x055A -+#define REG_USTIME_TSF 0x055C -+#define REG_BCN_MAX_ERR 0x055D -+#define REG_RXTSF_OFFSET_CCK 0x055E -+#define REG_RXTSF_OFFSET_OFDM 0x055F -+#define REG_TSFTR 0x0560 -+#define REG_TSFTR1 0x0568 /* HW Port 1 TSF Register */ -+#define REG_ATIMWND_1 0x0570 -+#define REG_P2P_CTWIN 0x0572 /* 1 Byte long (in unit of TU) */ -+#define REG_PSTIMER 0x0580 -+#define REG_TIMER0 0x0584 -+#define REG_TIMER1 0x0588 -+#define REG_ACMHWCTRL 0x05C0 -+#define REG_NOA_DESC_SEL 0x05CF -+#define REG_NOA_DESC_DURATION 0x05E0 -+#define REG_NOA_DESC_INTERVAL 0x05E4 -+#define REG_NOA_DESC_START 0x05E8 -+#define REG_NOA_DESC_COUNT 0x05EC -+ -+#define REG_DMC 0x05F0 /* Dual MAC Co-Existence Register */ -+#define REG_SCH_TX_CMD 0x05F8 -+ -+#define REG_FW_RESET_TSF_CNT_1 0x05FC -+#define REG_FW_RESET_TSF_CNT_0 0x05FD -+#define REG_FW_BCN_DIS_CNT 0x05FE -+ -+/* */ -+/* */ -+/* 0x0600h ~ 0x07FFh WMAC Configuration */ -+/* */ -+/* */ -+#define REG_APSD_CTRL 0x0600 -+#define REG_BWOPMODE 0x0603 -+#define REG_TCR 0x0604 -+#define REG_RCR 0x0608 -+#define REG_RX_PKT_LIMIT 0x060C -+#define REG_RX_DLK_TIME 0x060D -+#define REG_RX_DRVINFO_SZ 0x060F -+ -+#define REG_MACID 0x0610 -+#define REG_BSSID 0x0618 -+#define REG_MAR 0x0620 -+#define REG_MBIDCAMCFG 0x0628 -+ -+#define REG_PNO_STATUS 0x0631 -+#define REG_USTIME_EDCA 0x0638 -+#define REG_MAC_SPEC_SIFS 0x063A -+/* 20100719 Joseph: Hardware register definition change. (HW datasheet v54) */ -+#define REG_RESP_SIFS_CCK 0x063C /* [15:8]SIFS_R2T_OFDM, [7:0]SIFS_R2T_CCK */ -+#define REG_RESP_SIFS_OFDM 0x063E /* [15:8]SIFS_T2T_OFDM, [7:0]SIFS_T2T_CCK */ -+ -+#define REG_ACKTO 0x0640 -+#define REG_CTS2TO 0x0641 -+#define REG_EIFS 0x0642 -+ -+ -+/* RXERR_RPT */ -+#define RXERR_TYPE_OFDM_PPDU 0 -+#define RXERR_TYPE_OFDMfalse_ALARM 1 -+#define RXERR_TYPE_OFDM_MPDU_OK 2 -+#define RXERR_TYPE_OFDM_MPDU_FAIL 3 -+#define RXERR_TYPE_CCK_PPDU 4 -+#define RXERR_TYPE_CCKfalse_ALARM 5 -+#define RXERR_TYPE_CCK_MPDU_OK 6 -+#define RXERR_TYPE_CCK_MPDU_FAIL 7 -+#define RXERR_TYPE_HT_PPDU 8 -+#define RXERR_TYPE_HTfalse_ALARM 9 -+#define RXERR_TYPE_HT_MPDU_TOTAL 10 -+#define RXERR_TYPE_HT_MPDU_OK 11 -+#define RXERR_TYPE_HT_MPDU_FAIL 12 -+#define RXERR_TYPE_RX_FULL_DROP 15 -+ -+#define RXERR_COUNTER_MASK 0xFFFFF -+#define RXERR_RPT_RST BIT(27) -+#define _RXERR_RPT_SEL(type) ((type) << 28) -+ -+/* */ -+/* Note: */ -+/* The NAV upper value is very important to WiFi 11n 5.2.3 NAV test. The default value is */ -+/* always too small, but the WiFi TestPlan test by 25, 000 microseconds of NAV through sending */ -+/* CTS in the air. We must update this value greater than 25, 000 microseconds to pass the item. */ -+/* The offset of NAV_UPPER in 8192C Spec is incorrect, and the offset should be 0x0652. Commented */ -+/* by SD1 Scott. */ -+/* By Bruce, 2011-07-18. */ -+/* */ -+#define REG_NAV_UPPER 0x0652 /* unit of 128 */ -+ -+/* WMA, BA, CCX */ -+#define REG_NAV_CTRL 0x0650 -+#define REG_BACAMCMD 0x0654 -+#define REG_BACAMCONTENT 0x0658 -+#define REG_LBDLY 0x0660 -+#define REG_FWDLY 0x0661 -+#define REG_RXERR_RPT 0x0664 -+#define REG_WMAC_TRXPTCL_CTL 0x0668 -+ -+/* Security */ -+#define REG_CAMCMD 0x0670 -+#define REG_CAMWRITE 0x0674 -+#define REG_CAMREAD 0x0678 -+#define REG_CAMDBG 0x067C -+#define REG_SECCFG 0x0680 -+ -+/* Power */ -+#define REG_WOW_CTRL 0x0690 -+#define REG_PS_RX_INFO 0x0692 -+#define REG_UAPSD_TID 0x0693 -+#define REG_WKFMCAM_CMD 0x0698 -+#define REG_WKFMCAM_NUM REG_WKFMCAM_CMD -+#define REG_WKFMCAM_RWD 0x069C -+#define REG_RXFLTMAP0 0x06A0 -+#define REG_RXFLTMAP1 0x06A2 -+#define REG_RXFLTMAP2 0x06A4 -+#define REG_BCN_PSR_RPT 0x06A8 -+#define REG_BT_COEX_TABLE 0x06C0 -+ -+/* Hardware Port 2 */ -+#define REG_MACID1 0x0700 -+#define REG_BSSID1 0x0708 -+ -+ -+/* */ -+/* */ -+/* 0xFE00h ~ 0xFE55h USB Configuration */ -+/* */ -+/* */ -+#define REG_USB_INFO 0xFE17 -+#define REG_USB_SPECIAL_OPTION 0xFE55 -+#define REG_USB_DMA_AGG_TO 0xFE5B -+#define REG_USB_AGG_TO 0xFE5C -+#define REG_USB_AGG_TH 0xFE5D -+ -+#define REG_USB_HRPWM 0xFE58 -+#define REG_USB_HCPWM 0xFE57 -+ -+/* for 92DU high_Queue low_Queue Normal_Queue select */ -+#define REG_USB_High_NORMAL_Queue_Select_MAC0 0xFE44 -+/* define REG_USB_LOW_Queue_Select_MAC0 0xFE45 */ -+#define REG_USB_High_NORMAL_Queue_Select_MAC1 0xFE47 -+/* define REG_USB_LOW_Queue_Select_MAC1 0xFE48 */ -+ -+/* For test chip */ -+#define REG_TEST_USB_TXQS 0xFE48 -+#define REG_TEST_SIE_VID 0xFE60 /* 0xFE60~0xFE61 */ -+#define REG_TEST_SIE_PID 0xFE62 /* 0xFE62~0xFE63 */ -+#define REG_TEST_SIE_OPTIONAL 0xFE64 -+#define REG_TEST_SIE_CHIRP_K 0xFE65 -+#define REG_TEST_SIE_PHY 0xFE66 /* 0xFE66~0xFE6B */ -+#define REG_TEST_SIE_MAC_ADDR 0xFE70 /* 0xFE70~0xFE75 */ -+#define REG_TEST_SIE_STRING 0xFE80 /* 0xFE80~0xFEB9 */ -+ -+ -+/* For normal chip */ -+#define REG_NORMAL_SIE_VID 0xFE60 /* 0xFE60~0xFE61 */ -+#define REG_NORMAL_SIE_PID 0xFE62 /* 0xFE62~0xFE63 */ -+#define REG_NORMAL_SIE_OPTIONAL 0xFE64 -+#define REG_NORMAL_SIE_EP 0xFE65 /* 0xFE65~0xFE67 */ -+#define REG_NORMAL_SIE_PHY 0xFE68 /* 0xFE68~0xFE6B */ -+#define REG_NORMAL_SIE_OPTIONAL2 0xFE6C -+#define REG_NORMAL_SIE_GPS_EP 0xFE6D /* 0xFE6D, for RTL8723 only. */ -+#define REG_NORMAL_SIE_MAC_ADDR 0xFE70 /* 0xFE70~0xFE75 */ -+#define REG_NORMAL_SIE_STRING 0xFE80 /* 0xFE80~0xFEDF */ -+ -+ -+/* */ -+/* */ -+/* Redifine 8192C register definition for compatibility */ -+/* */ -+/* */ -+ -+/* TODO: use these definition when using REG_xxx naming rule. */ -+/* NOTE: DO NOT Remove these definition. Use later. */ -+ -+#define EFUSE_CTRL REG_EFUSE_CTRL /* E-Fuse Control. */ -+#define EFUSE_TEST REG_EFUSE_TEST /* E-Fuse Test. */ -+#define MSR (REG_CR + 2) /* Media Status register */ -+/* define ISR REG_HISR */ -+ -+#define TSFR REG_TSFTR /* Timing Sync Function Timer Register. */ -+#define TSFR1 REG_TSFTR1 /* HW Port 1 TSF Register */ -+ -+#define PBP REG_PBP -+ -+/* Redifine MACID register, to compatible prior ICs. */ -+#define IDR0 REG_MACID /* MAC ID Register, Offset 0x0050-0x0053 */ -+#define IDR4 (REG_MACID + 4) /* MAC ID Register, Offset 0x0054-0x0055 */ -+ -+ -+/* */ -+/* 9. Security Control Registers (Offset:) */ -+/* */ -+#define RWCAM REG_CAMCMD /* IN 8190 Data Sheet is called CAMcmd */ -+#define WCAMI REG_CAMWRITE /* Software write CAM input content */ -+#define RCAMO REG_CAMREAD /* Software read/write CAM config */ -+#define CAMDBG REG_CAMDBG -+#define SECR REG_SECCFG /* Security Configuration Register */ -+ -+/* Unused register */ -+#define UnusedRegister 0x1BF -+#define DCAM UnusedRegister -+#define PSR UnusedRegister -+#define BBAddr UnusedRegister -+#define PhyDataR UnusedRegister -+ -+/* Min Spacing related settings. */ -+#define MAX_MSS_DENSITY_2T 0x13 -+#define MAX_MSS_DENSITY_1T 0x0A -+ -+/* */ -+/* 8192C Cmd9346CR bits (Offset 0xA, 16bit) */ -+/* */ -+#define CmdEEPROM_En BIT5 /* EEPROM enable when set 1 */ -+#define CmdEERPOMSEL BIT4 /* System EEPROM select, 0: boot from E-FUSE, 1: The EEPROM used is 9346 */ -+#define Cmd9346CR_9356SEL BIT4 -+ -+/* */ -+/* 8192C GPIO MUX Configuration Register (offset 0x40, 4 byte) */ -+/* */ -+#define GPIOSEL_GPIO 0 -+#define GPIOSEL_ENBT BIT5 -+ -+/* */ -+/* 8192C GPIO PIN Control Register (offset 0x44, 4 byte) */ -+/* */ -+#define GPIO_IN REG_GPIO_PIN_CTRL /* GPIO pins input value */ -+#define GPIO_OUT (REG_GPIO_PIN_CTRL+1) /* GPIO pins output value */ -+#define GPIO_IO_SEL (REG_GPIO_PIN_CTRL+2) /* GPIO pins output enable when a bit is set to "1"; otherwise, input is configured. */ -+#define GPIO_MOD (REG_GPIO_PIN_CTRL+3) -+ -+/* */ -+/* 8811A GPIO PIN Control Register (offset 0x60, 4 byte) */ -+/* */ -+#define GPIO_IN_8811A REG_GPIO_PIN_CTRL_2 /* GPIO pins input value */ -+#define GPIO_OUT_8811A (REG_GPIO_PIN_CTRL_2+1) /* GPIO pins output value */ -+#define GPIO_IO_SEL_8811A (REG_GPIO_PIN_CTRL_2+2) /* GPIO pins output enable when a bit is set to "1"; otherwise, input is configured. */ -+#define GPIO_MOD_8811A (REG_GPIO_PIN_CTRL_2+3) -+ -+/* */ -+/* 8723/8188E Host System Interrupt Mask Register (offset 0x58, 32 byte) */ -+/* */ -+#define HSIMR_GPIO12_0_INT_EN BIT0 -+#define HSIMR_SPS_OCP_INT_EN BIT5 -+#define HSIMR_RON_INT_EN BIT6 -+#define HSIMR_PDN_INT_EN BIT7 -+#define HSIMR_GPIO9_INT_EN BIT25 -+ -+/* */ -+/* 8723/8188E Host System Interrupt Status Register (offset 0x5C, 32 byte) */ -+/* */ -+#define HSISR_GPIO12_0_INT BIT0 -+#define HSISR_SPS_OCP_INT BIT5 -+#define HSISR_RON_INT BIT6 -+#define HSISR_PDNINT BIT7 -+#define HSISR_GPIO9_INT BIT25 -+ -+/* */ -+/* 8192C (MSR) Media Status Register (Offset 0x4C, 8 bits) */ -+/* */ -+/* -+Network Type -+00: No link -+01: Link in ad hoc network -+10: Link in infrastructure network -+11: AP mode -+Default: 00b. -+*/ -+#define MSR_NOLINK 0x00 -+#define MSR_ADHOC 0x01 -+#define MSR_INFRA 0x02 -+#define MSR_AP 0x03 -+ -+/* */ -+/* USB INTR CONTENT */ -+/* */ -+#define USB_C2H_CMDID_OFFSET 0 -+#define USB_C2H_SEQ_OFFSET 1 -+#define USB_C2H_EVENT_OFFSET 2 -+#define USB_INTR_CPWM_OFFSET 16 -+#define USB_INTR_CONTENT_C2H_OFFSET 0 -+#define USB_INTR_CONTENT_CPWM1_OFFSET 16 -+#define USB_INTR_CONTENT_CPWM2_OFFSET 20 -+#define USB_INTR_CONTENT_HISR_OFFSET 48 -+#define USB_INTR_CONTENT_HISRE_OFFSET 52 -+#define USB_INTR_CONTENT_LENGTH 56 -+ -+/* */ -+/* Response Rate Set Register (offset 0x440, 24bits) */ -+/* */ -+#define RRSR_1M BIT0 -+#define RRSR_2M BIT1 -+#define RRSR_5_5M BIT2 -+#define RRSR_11M BIT3 -+#define RRSR_6M BIT4 -+#define RRSR_9M BIT5 -+#define RRSR_12M BIT6 -+#define RRSR_18M BIT7 -+#define RRSR_24M BIT8 -+#define RRSR_36M BIT9 -+#define RRSR_48M BIT10 -+#define RRSR_54M BIT11 -+#define RRSR_MCS0 BIT12 -+#define RRSR_MCS1 BIT13 -+#define RRSR_MCS2 BIT14 -+#define RRSR_MCS3 BIT15 -+#define RRSR_MCS4 BIT16 -+#define RRSR_MCS5 BIT17 -+#define RRSR_MCS6 BIT18 -+#define RRSR_MCS7 BIT19 -+ -+#define RRSR_CCK_RATES (RRSR_11M|RRSR_5_5M|RRSR_2M|RRSR_1M) -+#define RRSR_OFDM_RATES (RRSR_54M|RRSR_48M|RRSR_36M|RRSR_24M|RRSR_18M|RRSR_12M|RRSR_9M|RRSR_6M) -+ -+/* WOL bit information */ -+#define HAL92C_WOL_PTK_UPDATE_EVENT BIT0 -+#define HAL92C_WOL_GTK_UPDATE_EVENT BIT1 -+#define HAL92C_WOL_DISASSOC_EVENT BIT2 -+#define HAL92C_WOL_DEAUTH_EVENT BIT3 -+#define HAL92C_WOL_FW_DISCONNECT_EVENT BIT4 -+ -+/* */ -+/* Rate Definition */ -+/* */ -+/* CCK */ -+#define RATR_1M 0x00000001 -+#define RATR_2M 0x00000002 -+#define RATR_55M 0x00000004 -+#define RATR_11M 0x00000008 -+/* OFDM */ -+#define RATR_6M 0x00000010 -+#define RATR_9M 0x00000020 -+#define RATR_12M 0x00000040 -+#define RATR_18M 0x00000080 -+#define RATR_24M 0x00000100 -+#define RATR_36M 0x00000200 -+#define RATR_48M 0x00000400 -+#define RATR_54M 0x00000800 -+/* MCS 1 Spatial Stream */ -+#define RATR_MCS0 0x00001000 -+#define RATR_MCS1 0x00002000 -+#define RATR_MCS2 0x00004000 -+#define RATR_MCS3 0x00008000 -+#define RATR_MCS4 0x00010000 -+#define RATR_MCS5 0x00020000 -+#define RATR_MCS6 0x00040000 -+#define RATR_MCS7 0x00080000 -+/* MCS 2 Spatial Stream */ -+#define RATR_MCS8 0x00100000 -+#define RATR_MCS9 0x00200000 -+#define RATR_MCS10 0x00400000 -+#define RATR_MCS11 0x00800000 -+#define RATR_MCS12 0x01000000 -+#define RATR_MCS13 0x02000000 -+#define RATR_MCS14 0x04000000 -+#define RATR_MCS15 0x08000000 -+ -+/* CCK */ -+#define RATE_1M BIT(0) -+#define RATE_2M BIT(1) -+#define RATE_5_5M BIT(2) -+#define RATE_11M BIT(3) -+/* OFDM */ -+#define RATE_6M BIT(4) -+#define RATE_9M BIT(5) -+#define RATE_12M BIT(6) -+#define RATE_18M BIT(7) -+#define RATE_24M BIT(8) -+#define RATE_36M BIT(9) -+#define RATE_48M BIT(10) -+#define RATE_54M BIT(11) -+/* MCS 1 Spatial Stream */ -+#define RATE_MCS0 BIT(12) -+#define RATE_MCS1 BIT(13) -+#define RATE_MCS2 BIT(14) -+#define RATE_MCS3 BIT(15) -+#define RATE_MCS4 BIT(16) -+#define RATE_MCS5 BIT(17) -+#define RATE_MCS6 BIT(18) -+#define RATE_MCS7 BIT(19) -+/* MCS 2 Spatial Stream */ -+#define RATE_MCS8 BIT(20) -+#define RATE_MCS9 BIT(21) -+#define RATE_MCS10 BIT(22) -+#define RATE_MCS11 BIT(23) -+#define RATE_MCS12 BIT(24) -+#define RATE_MCS13 BIT(25) -+#define RATE_MCS14 BIT(26) -+#define RATE_MCS15 BIT(27) -+ -+ -+/* ALL CCK Rate */ -+#define RATE_ALL_CCK RATR_1M|RATR_2M|RATR_55M|RATR_11M -+#define RATE_ALL_OFDM_AG RATR_6M|RATR_9M|RATR_12M|RATR_18M|RATR_24M|\ -+ RATR_36M|RATR_48M|RATR_54M -+#define RATE_ALL_OFDM_1SS RATR_MCS0|RATR_MCS1|RATR_MCS2|RATR_MCS3 |\ -+ RATR_MCS4|RATR_MCS5|RATR_MCS6 |RATR_MCS7 -+#define RATE_ALL_OFDM_2SS RATR_MCS8|RATR_MCS9 |RATR_MCS10|RATR_MCS11|\ -+ RATR_MCS12|RATR_MCS13|RATR_MCS14|RATR_MCS15 -+ -+#define RATE_BITMAP_ALL 0xFFFFF -+ -+/* Only use CCK 1M rate for ACK */ -+#define RATE_RRSR_CCK_ONLY_1M 0xFFFF1 -+#define RATE_RRSR_WITHOUT_CCK 0xFFFF0 -+ -+/* */ -+/* BW_OPMODE bits (Offset 0x603, 8bit) */ -+/* */ -+#define BW_OPMODE_20MHZ BIT2 -+#define BW_OPMODE_5G BIT1 -+ -+/* */ -+/* CAM Config Setting (offset 0x680, 1 byte) */ -+/* */ -+#define CAM_VALID BIT15 -+#define CAM_NOTVALID 0x0000 -+#define CAM_USEDK BIT5 -+ -+#define CAM_CONTENT_COUNT 8 -+ -+#define CAM_NONE 0x0 -+#define CAM_WEP40 0x01 -+#define CAM_TKIP 0x02 -+#define CAM_AES 0x04 -+#define CAM_WEP104 0x05 -+#define CAM_SMS4 0x6 -+ -+#define TOTAL_CAM_ENTRY 32 -+#define HALF_CAM_ENTRY 16 -+ -+#define CAM_CONFIG_USEDK true -+#define CAM_CONFIG_NO_USEDK false -+ -+#define CAM_WRITE BIT16 -+#define CAM_READ 0x00000000 -+#define CAM_POLLINIG BIT31 -+ -+/* */ -+/* 10. Power Save Control Registers */ -+/* */ -+#define WOW_PMEN BIT0 /* Power management Enable. */ -+#define WOW_WOMEN BIT1 /* WoW function on or off. */ -+#define WOW_MAGIC BIT2 /* Magic packet */ -+#define WOW_UWF BIT3 /* Unicast Wakeup frame. */ -+ -+/* */ -+/* 12. Host Interrupt Status Registers */ -+/* */ -+/* */ -+/* 8190 IMR/ISR bits */ -+/* */ -+#define IMR8190_DISABLED 0x0 -+#define IMR_DISABLED 0x0 -+/* IMR DW0 Bit 0-31 */ -+#define IMR_BCNDMAINT6 BIT31 /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5 BIT30 /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4 BIT29 /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3 BIT28 /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2 BIT27 /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1 BIT26 /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK8 BIT25 /* Beacon Queue DMA OK Interrup 8 */ -+#define IMR_BCNDOK7 BIT24 /* Beacon Queue DMA OK Interrup 7 */ -+#define IMR_BCNDOK6 BIT23 /* Beacon Queue DMA OK Interrup 6 */ -+#define IMR_BCNDOK5 BIT22 /* Beacon Queue DMA OK Interrup 5 */ -+#define IMR_BCNDOK4 BIT21 /* Beacon Queue DMA OK Interrup 4 */ -+#define IMR_BCNDOK3 BIT20 /* Beacon Queue DMA OK Interrup 3 */ -+#define IMR_BCNDOK2 BIT19 /* Beacon Queue DMA OK Interrup 2 */ -+#define IMR_BCNDOK1 BIT18 /* Beacon Queue DMA OK Interrup 1 */ -+#define IMR_TIMEOUT2 BIT17 /* Timeout interrupt 2 */ -+#define IMR_TIMEOUT1 BIT16 /* Timeout interrupt 1 */ -+#define IMR_TXFOVW BIT15 /* Transmit FIFO Overflow */ -+#define IMR_PSTIMEOUT BIT14 /* Power save time out interrupt */ -+#define IMR_BcnInt BIT13 /* Beacon DMA Interrupt 0 */ -+#define IMR_RXFOVW BIT12 /* Receive FIFO Overflow */ -+#define IMR_RDU BIT11 /* Receive Descriptor Unavailable */ -+#define IMR_ATIMEND BIT10 /* For 92C, ATIM Window End Interrupt. For 8723 and later ICs, it also means P2P CTWin End interrupt. */ -+#define IMR_BDOK BIT9 /* Beacon Queue DMA OK Interrup */ -+#define IMR_HIGHDOK BIT8 /* High Queue DMA OK Interrupt */ -+#define IMR_TBDOK BIT7 /* Transmit Beacon OK interrup */ -+#define IMR_MGNTDOK BIT6 /* Management Queue DMA OK Interrupt */ -+#define IMR_TBDER BIT5 /* For 92C, Transmit Beacon Error Interrupt */ -+#define IMR_BKDOK BIT4 /* AC_BK DMA OK Interrupt */ -+#define IMR_BEDOK BIT3 /* AC_BE DMA OK Interrupt */ -+#define IMR_VIDOK BIT2 /* AC_VI DMA OK Interrupt */ -+#define IMR_VODOK BIT1 /* AC_VO DMA Interrupt */ -+#define IMR_ROK BIT0 /* Receive DMA OK Interrupt */ -+ -+/* 13. Host Interrupt Status Extension Register (Offset: 0x012C-012Eh) */ -+#define IMR_TSF_BIT32_TOGGLE BIT15 -+#define IMR_BcnInt_E BIT12 -+#define IMR_TXERR BIT11 -+#define IMR_RXERR BIT10 -+#define IMR_C2HCMD BIT9 -+#define IMR_CPWM BIT8 -+/* RSVD [2-7] */ -+#define IMR_OCPINT BIT1 -+#define IMR_WLANOFF BIT0 -+ -+/* */ -+/* 8723E series PCIE Host IMR/ISR bit */ -+/* */ -+/* IMR DW0 Bit 0-31 */ -+#define PHIMR_TIMEOUT2 BIT31 -+#define PHIMR_TIMEOUT1 BIT30 -+#define PHIMR_PSTIMEOUT BIT29 -+#define PHIMR_GTINT4 BIT28 -+#define PHIMR_GTINT3 BIT27 -+#define PHIMR_TXBCNERR BIT26 -+#define PHIMR_TXBCNOK BIT25 -+#define PHIMR_TSF_BIT32_TOGGLE BIT24 -+#define PHIMR_BCNDMAINT3 BIT23 -+#define PHIMR_BCNDMAINT2 BIT22 -+#define PHIMR_BCNDMAINT1 BIT21 -+#define PHIMR_BCNDMAINT0 BIT20 -+#define PHIMR_BCNDOK3 BIT19 -+#define PHIMR_BCNDOK2 BIT18 -+#define PHIMR_BCNDOK1 BIT17 -+#define PHIMR_BCNDOK0 BIT16 -+#define PHIMR_HSISR_IND_ON BIT15 -+#define PHIMR_BCNDMAINT_E BIT14 -+#define PHIMR_ATIMEND_E BIT13 -+#define PHIMR_ATIM_CTW_END BIT12 -+#define PHIMR_HISRE_IND BIT11 /* RO. HISRE Indicator (HISRE & HIMRE is true, this bit is set to 1) */ -+#define PHIMR_C2HCMD BIT10 -+#define PHIMR_CPWM2 BIT9 -+#define PHIMR_CPWM BIT8 -+#define PHIMR_HIGHDOK BIT7 /* High Queue DMA OK Interrupt */ -+#define PHIMR_MGNTDOK BIT6 /* Management Queue DMA OK Interrupt */ -+#define PHIMR_BKDOK BIT5 /* AC_BK DMA OK Interrupt */ -+#define PHIMR_BEDOK BIT4 /* AC_BE DMA OK Interrupt */ -+#define PHIMR_VIDOK BIT3 /* AC_VI DMA OK Interrupt */ -+#define PHIMR_VODOK BIT2 /* AC_VO DMA Interrupt */ -+#define PHIMR_RDU BIT1 /* Receive Descriptor Unavailable */ -+#define PHIMR_ROK BIT0 /* Receive DMA OK Interrupt */ -+ -+/* PCIE Host Interrupt Status Extension bit */ -+#define PHIMR_BCNDMAINT7 BIT23 -+#define PHIMR_BCNDMAINT6 BIT22 -+#define PHIMR_BCNDMAINT5 BIT21 -+#define PHIMR_BCNDMAINT4 BIT20 -+#define PHIMR_BCNDOK7 BIT19 -+#define PHIMR_BCNDOK6 BIT18 -+#define PHIMR_BCNDOK5 BIT17 -+#define PHIMR_BCNDOK4 BIT16 -+/* bit12 15: RSVD */ -+#define PHIMR_TXERR BIT11 -+#define PHIMR_RXERR BIT10 -+#define PHIMR_TXFOVW BIT9 -+#define PHIMR_RXFOVW BIT8 -+/* bit2-7: RSVD */ -+#define PHIMR_OCPINT BIT1 -+/* bit0: RSVD */ -+ -+#define UHIMR_TIMEOUT2 BIT31 -+#define UHIMR_TIMEOUT1 BIT30 -+#define UHIMR_PSTIMEOUT BIT29 -+#define UHIMR_GTINT4 BIT28 -+#define UHIMR_GTINT3 BIT27 -+#define UHIMR_TXBCNERR BIT26 -+#define UHIMR_TXBCNOK BIT25 -+#define UHIMR_TSF_BIT32_TOGGLE BIT24 -+#define UHIMR_BCNDMAINT3 BIT23 -+#define UHIMR_BCNDMAINT2 BIT22 -+#define UHIMR_BCNDMAINT1 BIT21 -+#define UHIMR_BCNDMAINT0 BIT20 -+#define UHIMR_BCNDOK3 BIT19 -+#define UHIMR_BCNDOK2 BIT18 -+#define UHIMR_BCNDOK1 BIT17 -+#define UHIMR_BCNDOK0 BIT16 -+#define UHIMR_HSISR_IND BIT15 -+#define UHIMR_BCNDMAINT_E BIT14 -+/* RSVD BIT13 */ -+#define UHIMR_CTW_END BIT12 -+/* RSVD BIT11 */ -+#define UHIMR_C2HCMD BIT10 -+#define UHIMR_CPWM2 BIT9 -+#define UHIMR_CPWM BIT8 -+#define UHIMR_HIGHDOK BIT7 /* High Queue DMA OK Interrupt */ -+#define UHIMR_MGNTDOK BIT6 /* Management Queue DMA OK Interrupt */ -+#define UHIMR_BKDOK BIT5 /* AC_BK DMA OK Interrupt */ -+#define UHIMR_BEDOK BIT4 /* AC_BE DMA OK Interrupt */ -+#define UHIMR_VIDOK BIT3 /* AC_VI DMA OK Interrupt */ -+#define UHIMR_VODOK BIT2 /* AC_VO DMA Interrupt */ -+#define UHIMR_RDU BIT1 /* Receive Descriptor Unavailable */ -+#define UHIMR_ROK BIT0 /* Receive DMA OK Interrupt */ -+ -+/* USB Host Interrupt Status Extension bit */ -+#define UHIMR_BCNDMAINT7 BIT23 -+#define UHIMR_BCNDMAINT6 BIT22 -+#define UHIMR_BCNDMAINT5 BIT21 -+#define UHIMR_BCNDMAINT4 BIT20 -+#define UHIMR_BCNDOK7 BIT19 -+#define UHIMR_BCNDOK6 BIT18 -+#define UHIMR_BCNDOK5 BIT17 -+#define UHIMR_BCNDOK4 BIT16 -+/* bit14-15: RSVD */ -+#define UHIMR_ATIMEND_E BIT13 -+#define UHIMR_ATIMEND BIT12 -+#define UHIMR_TXERR BIT11 -+#define UHIMR_RXERR BIT10 -+#define UHIMR_TXFOVW BIT9 -+#define UHIMR_RXFOVW BIT8 -+/* bit2-7: RSVD */ -+#define UHIMR_OCPINT BIT1 -+/* bit0: RSVD */ -+ -+ -+#define HAL_NIC_UNPLUG_ISR 0xFFFFFFFF /* The value when the NIC is unplugged for PCI. */ -+#define HAL_NIC_UNPLUG_PCI_ISR 0xEAEAEAEA /* The value when the NIC is unplugged for PCI in PCI interrupt (page 3). */ -+ -+/* */ -+/* 8188 IMR/ISR bits */ -+/* */ -+#define IMR_DISABLED_88E 0x0 -+/* IMR DW0(0x0060-0063) Bit 0-31 */ -+#define IMR_TXCCK_88E BIT30 /* TXRPT interrupt when CCX bit of the packet is set */ -+#define IMR_PSTIMEOUT_88E BIT29 /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_88E BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_88E BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TBDER_88E BIT26 /* Transmit Beacon0 Error */ -+#define IMR_TBDOK_88E BIT25 /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_88E BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -+#define IMR_BCNDMAINT0_88E BIT20 /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_88E BIT16 /* Beacon Queue DMA Error 0 */ -+#define IMR_HSISR_IND_ON_INT_88E BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_88E BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_88E BIT12 /* CTWidnow End or ATIM Window End */ -+#define IMR_HISR1_IND_INT_88E BIT11 /* HISR1 Indicator (HISR1 & HIMR1 is true, this bit is set to 1) */ -+#define IMR_C2HCMD_88E BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_88E BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_88E BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_88E BIT7 /* High Queue DMA OK */ -+#define IMR_MGNTDOK_88E BIT6 /* Management Queue DMA OK */ -+#define IMR_BKDOK_88E BIT5 /* AC_BK DMA OK */ -+#define IMR_BEDOK_88E BIT4 /* AC_BE DMA OK */ -+#define IMR_VIDOK_88E BIT3 /* AC_VI DMA OK */ -+#define IMR_VODOK_88E BIT2 /* AC_VO DMA OK */ -+#define IMR_RDU_88E BIT1 /* Rx Descriptor Unavailable */ -+#define IMR_ROK_88E BIT0 /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_88E BIT27 /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_88E BIT26 /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_88E BIT25 /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_88E BIT24 /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_88E BIT23 /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_88E BIT22 /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_88E BIT21 /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_88E BIT20 /* Beacon Queue DMA OK Interrup 7 */ -+#define IMR_BCNDOK6_88E BIT19 /* Beacon Queue DMA OK Interrup 6 */ -+#define IMR_BCNDOK5_88E BIT18 /* Beacon Queue DMA OK Interrup 5 */ -+#define IMR_BCNDOK4_88E BIT17 /* Beacon Queue DMA OK Interrup 4 */ -+#define IMR_BCNDOK3_88E BIT16 /* Beacon Queue DMA OK Interrup 3 */ -+#define IMR_BCNDOK2_88E BIT15 /* Beacon Queue DMA OK Interrup 2 */ -+#define IMR_BCNDOK1_88E BIT14 /* Beacon Queue DMA OK Interrup 1 */ -+#define IMR_ATIMEND_E_88E BIT13 /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_88E BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_88E BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_88E BIT9 /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_88E BIT8 /* Receive FIFO Overflow */ -+ -+/*=================================================================== -+===================================================================== -+Here the register defines are for 92C. When the define is as same with 92C, -+we will use the 92C's define for the consistency -+So the following defines for 92C is not entire!!!!!! -+===================================================================== -+=====================================================================*/ -+/* -+Based on Datasheet V33---090401 -+Register Summary -+Current IOREG MAP -+0x0000h ~ 0x00FFh System Configuration (256 Bytes) -+0x0100h ~ 0x01FFh MACTOP General Configuration (256 Bytes) -+0x0200h ~ 0x027Fh TXDMA Configuration (128 Bytes) -+0x0280h ~ 0x02FFh RXDMA Configuration (128 Bytes) -+0x0300h ~ 0x03FFh PCIE EMAC Reserved Region (256 Bytes) -+0x0400h ~ 0x04FFh Protocol Configuration (256 Bytes) -+0x0500h ~ 0x05FFh EDCA Configuration (256 Bytes) -+0x0600h ~ 0x07FFh WMAC Configuration (512 Bytes) -+0x2000h ~ 0x3FFFh 8051 FW Download Region (8196 Bytes) -+*/ -+ /* */ -+ /* 8192C (TXPAUSE) transmission pause (Offset 0x522, 8 bits) */ -+ /* */ -+/* Note: */ -+/* The the bits of stoping AC(VO/VI/BE/BK) queue in datasheet RTL8192S/RTL8192C are wrong, */ -+/* the correct arragement is VO - Bit0, VI - Bit1, BE - Bit2, and BK - Bit3. */ -+/* 8723 and 88E may be not correct either in the eralier version. Confirmed with DD Tim. */ -+/* By Bruce, 2011-09-22. */ -+#define StopBecon BIT6 -+#define StopHigh BIT5 -+#define StopMgt BIT4 -+#define StopBK BIT3 -+#define StopBE BIT2 -+#define StopVI BIT1 -+#define StopVO BIT0 -+ -+/* */ -+/* 8192C (RCR) Receive Configuration Register (Offset 0x608, 32 bits) */ -+/* */ -+#define RCR_APPFCS BIT31 /* WMAC append FCS after pauload */ -+#define RCR_APP_MIC BIT30 /* MACRX will retain the MIC at the bottom of the packet. */ -+#define RCR_APP_ICV BIT29 /* MACRX will retain the ICV at the bottom of the packet. */ -+#define RCR_APP_PHYST_RXFF BIT28 /* PHY Status is appended before RX packet in RXFF */ -+#define RCR_APP_BA_SSN BIT27 /* SSN of previous TXBA is appended as after original RXDESC as the 4-th DW of RXDESC. */ -+#define RCR_NONQOS_VHT BIT26 /* Reserved */ -+#define RCR_RSVD_BIT25 BIT25 /* Reserved */ -+#define RCR_ENMBID BIT24 /* Enable Multiple BssId. Only response ACK to the packets whose DID(A1) matching to the addresses in the MBSSID CAM Entries. */ -+#define RCR_LSIGEN BIT23 /* Enable LSIG TXOP Protection function. Search KEYCAM for each rx packet to check if LSIGEN bit is set. */ -+#define RCR_MFBEN BIT22 /* Enable immediate MCS Feedback function. When Rx packet with MRQ = 1'b1, then search KEYCAM to find sender's MCS Feedback function and send response. */ -+#define RCR_RSVD_BIT21 BIT21 /* Reserved */ -+#define RCR_RSVD_BIT20 BIT20 /* Reserved */ -+#define RCR_RSVD_BIT19 BIT19 /* Reserved */ -+#define RCR_TIM_PARSER_EN BIT18 /* RX Beacon TIM Parser. */ -+#define RCR_BM_DATA_EN BIT17 /* Broadcast data packet interrupt enable. */ -+#define RCR_UC_DATA_EN BIT16 /* Unicast data packet interrupt enable. */ -+#define RCR_RSVD_BIT15 BIT15 /* Reserved */ -+#define RCR_HTC_LOC_CTRL BIT14 /* MFC<--HTC = 1 MFC-->HTC = 0 */ -+#define RCR_AMF BIT13 /* Accept management type frame */ -+#define RCR_ACF BIT12 /* Accept control type frame. Control frames BA, BAR, and PS-Poll (when in AP mode) are not controlled by this bit. They are controlled by ADF. */ -+#define RCR_ADF BIT11 /* Accept data type frame. This bit also regulates BA, BAR, and PS-Poll (AP mode only). */ -+#define RCR_RSVD_BIT10 BIT10 /* Reserved */ -+#define RCR_AICV BIT9 /* Accept ICV error packet */ -+#define RCR_ACRC32 BIT8 /* Accept CRC32 error packet */ -+#define RCR_CBSSID_BCN BIT7 /* Accept BSSID match packet (Rx beacon, probe rsp) */ -+#define RCR_CBSSID_DATA BIT6 /* Accept BSSID match packet (Data) */ -+#define RCR_CBSSID RCR_CBSSID_DATA /* Accept BSSID match packet */ -+#define RCR_APWRMGT BIT5 /* Accept power management packet */ -+#define RCR_ADD3 BIT4 /* Accept address 3 match packet */ -+#define RCR_AB BIT3 /* Accept broadcast packet */ -+#define RCR_AM BIT2 /* Accept multicast packet */ -+#define RCR_APM BIT1 /* Accept physical match packet */ -+#define RCR_AAP BIT0 /* Accept all unicast packet */ -+ -+ -+/* */ -+/* */ -+/* 0x0000h ~ 0x00FFh System Configuration */ -+/* */ -+/* */ -+ -+/* 2 SYS_ISO_CTRL */ -+#define ISO_MD2PP BIT(0) -+#define ISO_UA2USB BIT(1) -+#define ISO_UD2CORE BIT(2) -+#define ISO_PA2PCIE BIT(3) -+#define ISO_PD2CORE BIT(4) -+#define ISO_IP2MAC BIT(5) -+#define ISO_DIOP BIT(6) -+#define ISO_DIOE BIT(7) -+#define ISO_EB2CORE BIT(8) -+#define ISO_DIOR BIT(9) -+#define PWC_EV12V BIT(15) -+ -+ -+/* 2 SYS_FUNC_EN */ -+#define FEN_BBRSTB BIT(0) -+#define FEN_BB_GLB_RSTn BIT(1) -+#define FEN_USBA BIT(2) -+#define FEN_UPLL BIT(3) -+#define FEN_USBD BIT(4) -+#define FEN_DIO_PCIE BIT(5) -+#define FEN_PCIEA BIT(6) -+#define FEN_PPLL BIT(7) -+#define FEN_PCIED BIT(8) -+#define FEN_DIOE BIT(9) -+#define FEN_CPUEN BIT(10) -+#define FEN_DCORE BIT(11) -+#define FEN_ELDR BIT(12) -+#define FEN_EN_25_1 BIT(13) -+#define FEN_HWPDN BIT(14) -+#define FEN_MREGEN BIT(15) -+ -+/* 2 APS_FSMCO */ -+#define PFM_LDALL BIT(0) -+#define PFM_ALDN BIT(1) -+#define PFM_LDKP BIT(2) -+#define PFM_WOWL BIT(3) -+#define EnPDN BIT(4) -+#define PDN_PL BIT(5) -+#define APFM_ONMAC BIT(8) -+#define APFM_OFF BIT(9) -+#define APFM_RSM BIT(10) -+#define AFSM_HSUS BIT(11) -+#define AFSM_PCIE BIT(12) -+#define APDM_MAC BIT(13) -+#define APDM_HOST BIT(14) -+#define APDM_HPDN BIT(15) -+#define RDY_MACON BIT(16) -+#define SUS_HOST BIT(17) -+#define ROP_ALD BIT(20) -+#define ROP_PWR BIT(21) -+#define ROP_SPS BIT(22) -+#define SOP_MRST BIT(25) -+#define SOP_FUSE BIT(26) -+#define SOP_ABG BIT(27) -+#define SOP_AMB BIT(28) -+#define SOP_RCK BIT(29) -+#define SOP_A8M BIT(30) -+#define XOP_BTCK BIT(31) -+ -+/* 2 SYS_CLKR */ -+#define ANAD16V_EN BIT(0) -+#define ANA8M BIT(1) -+#define MACSLP BIT(4) -+#define LOADER_CLK_EN BIT(5) -+ -+ -+/* 2 9346CR /REG_SYS_EEPROM_CTRL */ -+#define BOOT_FROM_EEPROM BIT(4) -+#define EEPROMSEL BIT(4) -+#define EEPROM_EN BIT(5) -+ -+ -+/* 2 RF_CTRL */ -+#define RF_EN BIT(0) -+#define RF_RSTB BIT(1) -+#define RF_SDMRSTB BIT(2) -+ -+ -+/* 2 LDOV12D_CTRL */ -+#define LDV12_EN BIT(0) -+#define LDV12_SDBY BIT(1) -+#define LPLDO_HSM BIT(2) -+#define LPLDO_LSM_DIS BIT(3) -+#define _LDV12_VADJ(x) (((x) & 0xF) << 4) -+ -+ -+ -+/* 2 EFUSE_TEST (For RTL8723 partially) */ -+#define EF_TRPT BIT(7) -+#define EF_CELL_SEL (BIT(8)|BIT(9)) /* 00: Wifi Efuse, 01: BT Efuse0, 10: BT Efuse1, 11: BT Efuse2 */ -+#define LDOE25_EN BIT(31) -+#define EFUSE_SEL(x) (((x) & 0x3) << 8) -+#define EFUSE_SEL_MASK 0x300 -+#define EFUSE_WIFI_SEL_0 0x0 -+#define EFUSE_BT_SEL_0 0x1 -+#define EFUSE_BT_SEL_1 0x2 -+#define EFUSE_BT_SEL_2 0x3 -+ -+ -+/* 2 8051FWDL */ -+/* 2 MCUFWDL */ -+#define MCUFWDL_EN BIT(0) -+#define MCUFWDL_RDY BIT(1) -+#define FWDL_ChkSum_rpt BIT(2) -+#define MACINI_RDY BIT(3) -+#define BBINI_RDY BIT(4) -+#define RFINI_RDY BIT(5) -+#define WINTINI_RDY BIT(6) -+#define RAM_DL_SEL BIT(7) -+#define ROM_DLEN BIT(19) -+#define CPRST BIT(23) -+ -+ -+/* 2 REG_SYS_CFG */ -+#define XCLK_VLD BIT(0) -+#define ACLK_VLD BIT(1) -+#define UCLK_VLD BIT(2) -+#define PCLK_VLD BIT(3) -+#define PCIRSTB BIT(4) -+#define V15_VLD BIT(5) -+#define SW_OFFLOAD_EN BIT(7) -+#define SIC_IDLE BIT(8) -+#define BD_MAC2 BIT(9) -+#define BD_MAC1 BIT(10) -+#define IC_MACPHY_MODE BIT(11) -+#define CHIP_VER (BIT(12)|BIT(13)|BIT(14)|BIT(15)) -+#define BT_FUNC BIT(16) -+#define VENDOR_ID BIT(19) -+#define EXT_VENDOR_ID (BIT(18)|BIT(19)) /* Currently only for RTL8723B */ -+#define PAD_HWPD_IDN BIT(22) -+#define TRP_VAUX_EN BIT(23) /* RTL ID */ -+#define TRP_BT_EN BIT(24) -+#define BD_PKG_SEL BIT(25) -+#define BD_HCI_SEL BIT(26) -+#define TYPE_ID BIT(27) -+#define RF_TYPE_ID BIT(27) -+ -+#define RTL_ID BIT(23) /* TestChip ID, 1:Test(RLE); 0:MP(RL) */ -+#define SPS_SEL BIT(24) /* 1:LDO regulator mode; 0:Switching regulator mode */ -+ -+ -+#define CHIP_VER_RTL_MASK 0xF000 /* Bit 12 ~ 15 */ -+#define CHIP_VER_RTL_SHIFT 12 -+#define EXT_VENDOR_ID_SHIFT 18 -+ -+/* 2 REG_GPIO_OUTSTS (For RTL8723 only) */ -+#define EFS_HCI_SEL (BIT(0)|BIT(1)) -+#define PAD_HCI_SEL (BIT(2)|BIT(3)) -+#define HCI_SEL (BIT(4)|BIT(5)) -+#define PKG_SEL_HCI BIT(6) -+#define FEN_GPS BIT(7) -+#define FEN_BT BIT(8) -+#define FEN_WL BIT(9) -+#define FEN_PCI BIT(10) -+#define FEN_USB BIT(11) -+#define BTRF_HWPDN_N BIT(12) -+#define WLRF_HWPDN_N BIT(13) -+#define PDN_BT_N BIT(14) -+#define PDN_GPS_N BIT(15) -+#define BT_CTL_HWPDN BIT(16) -+#define GPS_CTL_HWPDN BIT(17) -+#define PPHY_SUSB BIT(20) -+#define UPHY_SUSB BIT(21) -+#define PCI_SUSEN BIT(22) -+#define USB_SUSEN BIT(23) -+#define RF_RL_ID (BIT(31)|BIT(30)|BIT(29)|BIT(28)) -+ -+ -+/* */ -+/* */ -+/* 0x0100h ~ 0x01FFh MACTOP General Configuration */ -+/* */ -+/* */ -+ -+/* 2 Function Enable Registers */ -+/* 2 CR */ -+#define HCI_TXDMA_EN BIT(0) -+#define HCI_RXDMA_EN BIT(1) -+#define TXDMA_EN BIT(2) -+#define RXDMA_EN BIT(3) -+#define PROTOCOL_EN BIT(4) -+#define SCHEDULE_EN BIT(5) -+#define MACTXEN BIT(6) -+#define MACRXEN BIT(7) -+#define ENSWBCN BIT(8) -+#define ENSEC BIT(9) -+#define CALTMR_EN BIT(10) /* 32k CAL TMR enable */ -+ -+/* Network type */ -+#define _NETTYPE(x) (((x) & 0x3) << 16) -+#define MASK_NETTYPE 0x30000 -+#define NT_NO_LINK 0x0 -+#define NT_LINK_AD_HOC 0x1 -+#define NT_LINK_AP 0x2 -+#define NT_AS_AP 0x3 -+ -+/* 2 PBP - Page Size Register */ -+#define GET_RX_PAGE_SIZE(value) ((value) & 0xF) -+#define GET_TX_PAGE_SIZE(value) (((value) & 0xF0) >> 4) -+#define _PSRX_MASK 0xF -+#define _PSTX_MASK 0xF0 -+#define _PSRX(x) (x) -+#define _PSTX(x) ((x) << 4) -+ -+#define PBP_64 0x0 -+#define PBP_128 0x1 -+#define PBP_256 0x2 -+#define PBP_512 0x3 -+#define PBP_1024 0x4 -+ -+ -+/* 2 TX/RXDMA */ -+#define RXDMA_ARBBW_EN BIT(0) -+#define RXSHFT_EN BIT(1) -+#define RXDMA_AGG_EN BIT(2) -+#define QS_VO_QUEUE BIT(8) -+#define QS_VI_QUEUE BIT(9) -+#define QS_BE_QUEUE BIT(10) -+#define QS_BK_QUEUE BIT(11) -+#define QS_MANAGER_QUEUE BIT(12) -+#define QS_HIGH_QUEUE BIT(13) -+ -+#define HQSEL_VOQ BIT(0) -+#define HQSEL_VIQ BIT(1) -+#define HQSEL_BEQ BIT(2) -+#define HQSEL_BKQ BIT(3) -+#define HQSEL_MGTQ BIT(4) -+#define HQSEL_HIQ BIT(5) -+ -+/* For normal driver, 0x10C */ -+#define _TXDMA_CMQ_MAP(x) (((x)&0x3) << 16) -+#define _TXDMA_HIQ_MAP(x) (((x)&0x3) << 14) -+#define _TXDMA_MGQ_MAP(x) (((x)&0x3) << 12) -+#define _TXDMA_BKQ_MAP(x) (((x)&0x3) << 10) -+#define _TXDMA_BEQ_MAP(x) (((x)&0x3) << 8) -+#define _TXDMA_VIQ_MAP(x) (((x)&0x3) << 6) -+#define _TXDMA_VOQ_MAP(x) (((x)&0x3) << 4) -+ -+#define QUEUE_EXTRA 0 -+#define QUEUE_LOW 1 -+#define QUEUE_NORMAL 2 -+#define QUEUE_HIGH 3 -+ -+ -+/* 2 TRXFF_BNDY */ -+ -+ -+/* 2 LLT_INIT */ -+#define _LLT_NO_ACTIVE 0x0 -+#define _LLT_WRITE_ACCESS 0x1 -+#define _LLT_READ_ACCESS 0x2 -+ -+#define _LLT_INIT_DATA(x) ((x) & 0xFF) -+#define _LLT_INIT_ADDR(x) (((x) & 0xFF) << 8) -+#define _LLT_OP(x) (((x) & 0x3) << 30) -+#define _LLT_OP_VALUE(x) (((x) >> 30) & 0x3) -+ -+ -+/* */ -+/* */ -+/* 0x0200h ~ 0x027Fh TXDMA Configuration */ -+/* */ -+/* */ -+/* 2 RQPN */ -+#define _HPQ(x) ((x) & 0xFF) -+#define _LPQ(x) (((x) & 0xFF) << 8) -+#define _PUBQ(x) (((x) & 0xFF) << 16) -+#define _NPQ(x) ((x) & 0xFF) /* NOTE: in RQPN_NPQ register */ -+#define _EPQ(x) (((x) & 0xFF) << 16) /* NOTE: in RQPN_EPQ register */ -+ -+ -+#define HPQ_PUBLIC_DIS BIT(24) -+#define LPQ_PUBLIC_DIS BIT(25) -+#define LD_RQPN BIT(31) -+ -+ -+/* 2 TDECTL */ -+#define BLK_DESC_NUM_SHIFT 4 -+#define BLK_DESC_NUM_MASK 0xF -+ -+ -+/* 2 TXDMA_OFFSET_CHK */ -+#define DROP_DATA_EN BIT(9) -+ -+/* 2 AUTO_LLT */ -+#define BIT_SHIFT_TXPKTNUM 24 -+#define BIT_MASK_TXPKTNUM 0xff -+#define BIT_TXPKTNUM(x) (((x) & BIT_MASK_TXPKTNUM) << BIT_SHIFT_TXPKTNUM) -+ -+#define BIT_TDE_DBG_SEL BIT(23) -+#define BIT_AUTO_INIT_LLT BIT(16) -+ -+#define BIT_SHIFT_Tx_OQT_free_space 8 -+#define BIT_MASK_Tx_OQT_free_space 0xff -+#define BIT_Tx_OQT_free_space(x) (((x) & BIT_MASK_Tx_OQT_free_space) << BIT_SHIFT_Tx_OQT_free_space) -+ -+ -+/* */ -+/* */ -+/* 0x0280h ~ 0x028Bh RX DMA Configuration */ -+/* */ -+/* */ -+ -+/* 2 REG_RXDMA_CONTROL, 0x0286h */ -+/* Write only. When this bit is set, RXDMA will decrease RX PKT counter by one. Before */ -+/* this bit is polled, FW shall update RXFF_RD_PTR first. This register is write pulse and auto clear. */ -+/* define RXPKT_RELEASE_POLL BIT(0) */ -+/* Read only. When RXMA finishes on-going DMA operation, RXMDA will report idle state in */ -+/* this bit. FW can start releasing packets after RXDMA entering idle mode. */ -+/* define RXDMA_IDLE BIT(1) */ -+/* When this bit is set, RXDMA will enter this mode after on-going RXDMA packet to host */ -+/* completed, and stop DMA packet to host. RXDMA will then report Default: 0; */ -+/* define RW_RELEASE_EN BIT(2) */ -+ -+/* 2 REG_RXPKT_NUM, 0x0284 */ -+#define RXPKT_RELEASE_POLL BIT(16) -+#define RXDMA_IDLE BIT(17) -+#define RW_RELEASE_EN BIT(18) -+ -+/* */ -+/* */ -+/* 0x0400h ~ 0x047Fh Protocol Configuration */ -+/* */ -+/* */ -+/* 2 FWHW_TXQ_CTRL */ -+#define EN_AMPDU_RTY_NEW BIT(7) -+ -+ -+/* 2 SPEC SIFS */ -+#define _SPEC_SIFS_CCK(x) ((x) & 0xFF) -+#define _SPEC_SIFS_OFDM(x) (((x) & 0xFF) << 8) -+ -+/* 2 RL */ -+#define RETRY_LIMIT_SHORT_SHIFT 8 -+#define RETRY_LIMIT_LONG_SHIFT 0 -+ -+/* */ -+/* */ -+/* 0x0500h ~ 0x05FFh EDCA Configuration */ -+/* */ -+/* */ -+ -+/* 2 EDCA setting */ -+#define AC_PARAM_TXOP_LIMIT_OFFSET 16 -+#define AC_PARAM_ECW_MAX_OFFSET 12 -+#define AC_PARAM_ECW_MIN_OFFSET 8 -+#define AC_PARAM_AIFS_OFFSET 0 -+ -+ -+#define _LRL(x) ((x) & 0x3F) -+#define _SRL(x) (((x) & 0x3F) << 8) -+ -+ -+/* 2 BCN_CTRL */ -+#define EN_TXBCN_RPT BIT(2) -+#define EN_BCN_FUNCTION BIT(3) -+#define STOP_BCNQ BIT(6) -+#define DIS_RX_BSSID_FIT BIT(6) -+ -+#define DIS_ATIM BIT(0) -+#define DIS_BCNQ_SUB BIT(1) -+#define DIS_TSF_UDT BIT(4) -+ -+/* The same function but different bit field. */ -+#define DIS_TSF_UDT0_NORMAL_CHIP BIT(4) -+#define DIS_TSF_UDT0_TEST_CHIP BIT(5) -+ -+ -+/* 2 ACMHWCTRL */ -+#define AcmHw_HwEn BIT(0) -+#define AcmHw_BeqEn BIT(1) -+#define AcmHw_ViqEn BIT(2) -+#define AcmHw_VoqEn BIT(3) -+#define AcmHw_BeqStatus BIT(4) -+#define AcmHw_ViqStatus BIT(5) -+#define AcmHw_VoqStatus BIT(6) -+ -+/* 2 REG_DUAL_TSF_RST (0x553) */ -+#define DUAL_TSF_RST_P2P BIT(4) -+ -+/* 2 REG_NOA_DESC_SEL (0x5CF) */ -+#define NOA_DESC_SEL_0 0 -+#define NOA_DESC_SEL_1 BIT(4) -+ -+/* */ -+/* */ -+/* 0x0600h ~ 0x07FFh WMAC Configuration */ -+/* */ -+/* */ -+ -+/* 2 APSD_CTRL */ -+#define APSDOFF BIT(6) -+ -+/* 2 TCR */ -+#define TSFRST BIT(0) -+#define DIS_GCLK BIT(1) -+#define PAD_SEL BIT(2) -+#define PWR_ST BIT(6) -+#define PWRBIT_OW_EN BIT(7) -+#define ACRC BIT(8) -+#define CFENDFORM BIT(9) -+#define ICV BIT(10) -+ -+ -+/* 2 RCR */ -+#define AAP BIT(0) -+#define APM BIT(1) -+#define AM BIT(2) -+#define AB BIT(3) -+#define ADD3 BIT(4) -+#define APWRMGT BIT(5) -+#define CBSSID BIT(6) -+#define CBSSID_DATA BIT(6) -+#define CBSSID_BCN BIT(7) -+#define ACRC32 BIT(8) -+#define AICV BIT(9) -+#define ADF BIT(11) -+#define ACF BIT(12) -+#define AMF BIT(13) -+#define HTC_LOC_CTRL BIT(14) -+#define UC_DATA_EN BIT(16) -+#define BM_DATA_EN BIT(17) -+#define MFBEN BIT(22) -+#define LSIGEN BIT(23) -+#define EnMBID BIT(24) -+#define FORCEACK BIT(26) -+#define APP_BASSN BIT(27) -+#define APP_PHYSTS BIT(28) -+#define APP_ICV BIT(29) -+#define APP_MIC BIT(30) -+#define APP_FCS BIT(31) -+ -+ -+/* 2 SECCFG */ -+#define SCR_TxUseDK BIT(0) /* Force Tx Use Default Key */ -+#define SCR_RxUseDK BIT(1) /* Force Rx Use Default Key */ -+#define SCR_TxEncEnable BIT(2) /* Enable Tx Encryption */ -+#define SCR_RxDecEnable BIT(3) /* Enable Rx Decryption */ -+#define SCR_SKByA2 BIT(4) /* Search kEY BY A2 */ -+#define SCR_NoSKMC BIT(5) /* No Key Search Multicast */ -+#define SCR_TXBCUSEDK BIT(6) /* Force Tx Broadcast packets Use Default Key */ -+#define SCR_RXBCUSEDK BIT(7) /* Force Rx Broadcast packets Use Default Key */ -+#define SCR_CHK_KEYID BIT(8) -+ -+/* */ -+/* */ -+/* SDIO Bus Specification */ -+/* */ -+/* */ -+ -+/* I/O bus domain address mapping */ -+#define SDIO_LOCAL_BASE 0x10250000 -+#define WLAN_IOREG_BASE 0x10260000 -+#define FIRMWARE_FIFO_BASE 0x10270000 -+#define TX_HIQ_BASE 0x10310000 -+#define TX_MIQ_BASE 0x10320000 -+#define TX_LOQ_BASE 0x10330000 -+#define TX_EPQ_BASE 0x10350000 -+#define RX_RX0FF_BASE 0x10340000 -+ -+/* SDIO host local register space mapping. */ -+#define SDIO_LOCAL_MSK 0x0FFF -+#define WLAN_IOREG_MSK 0x7FFF -+#define WLAN_FIFO_MSK 0x1FFF /* Aggregation Length[12:0] */ -+#define WLAN_RX0FF_MSK 0x0003 -+ -+#define SDIO_WITHOUT_REF_DEVICE_ID 0 /* Without reference to the SDIO Device ID */ -+#define SDIO_LOCAL_DEVICE_ID 0 /* 0b[16], 000b[15:13] */ -+#define WLAN_TX_HIQ_DEVICE_ID 4 /* 0b[16], 100b[15:13] */ -+#define WLAN_TX_MIQ_DEVICE_ID 5 /* 0b[16], 101b[15:13] */ -+#define WLAN_TX_LOQ_DEVICE_ID 6 /* 0b[16], 110b[15:13] */ -+#define WLAN_TX_EXQ_DEVICE_ID 3 /* 0b[16], 011b[15:13] */ -+#define WLAN_RX0FF_DEVICE_ID 7 /* 0b[16], 111b[15:13] */ -+#define WLAN_IOREG_DEVICE_ID 8 /* 1b[16] */ -+ -+/* SDIO Tx Free Page Index */ -+#define HI_QUEUE_IDX 0 -+#define MID_QUEUE_IDX 1 -+#define LOW_QUEUE_IDX 2 -+#define PUBLIC_QUEUE_IDX 3 -+ -+#define SDIO_MAX_TX_QUEUE 3 /* HIQ, MIQ and LOQ */ -+#define SDIO_MAX_RX_QUEUE 1 -+ -+#define SDIO_REG_TX_CTRL 0x0000 /* SDIO Tx Control */ -+#define SDIO_REG_HIMR 0x0014 /* SDIO Host Interrupt Mask */ -+#define SDIO_REG_HISR 0x0018 /* SDIO Host Interrupt Service Routine */ -+#define SDIO_REG_HCPWM 0x0019 /* HCI Current Power Mode */ -+#define SDIO_REG_RX0_REQ_LEN 0x001C /* RXDMA Request Length */ -+#define SDIO_REG_OQT_FREE_PG 0x001E /* OQT Free Page */ -+#define SDIO_REG_FREE_TXPG 0x0020 /* Free Tx Buffer Page */ -+#define SDIO_REG_HCPWM1 0x0024 /* HCI Current Power Mode 1 */ -+#define SDIO_REG_HCPWM2 0x0026 /* HCI Current Power Mode 2 */ -+#define SDIO_REG_FREE_TXPG_SEQ 0x0028 /* Free Tx Page Sequence */ -+#define SDIO_REG_HTSFR_INFO 0x0030 /* HTSF Informaion */ -+#define SDIO_REG_HRPWM1 0x0080 /* HCI Request Power Mode 1 */ -+#define SDIO_REG_HRPWM2 0x0082 /* HCI Request Power Mode 2 */ -+#define SDIO_REG_HPS_CLKR 0x0084 /* HCI Power Save Clock */ -+#define SDIO_REG_HSUS_CTRL 0x0086 /* SDIO HCI Suspend Control */ -+#define SDIO_REG_HIMR_ON 0x0090 /* SDIO Host Extension Interrupt Mask Always */ -+#define SDIO_REG_HISR_ON 0x0091 /* SDIO Host Extension Interrupt Status Always */ -+ -+#define SDIO_HIMR_DISABLED 0 -+ -+/* RTL8723/RTL8188E SDIO Host Interrupt Mask Register */ -+#define SDIO_HIMR_RX_REQUEST_MSK BIT0 -+#define SDIO_HIMR_AVAL_MSK BIT1 -+#define SDIO_HIMR_TXERR_MSK BIT2 -+#define SDIO_HIMR_RXERR_MSK BIT3 -+#define SDIO_HIMR_TXFOVW_MSK BIT4 -+#define SDIO_HIMR_RXFOVW_MSK BIT5 -+#define SDIO_HIMR_TXBCNOK_MSK BIT6 -+#define SDIO_HIMR_TXBCNERR_MSK BIT7 -+#define SDIO_HIMR_BCNERLY_INT_MSK BIT16 -+#define SDIO_HIMR_C2HCMD_MSK BIT17 -+#define SDIO_HIMR_CPWM1_MSK BIT18 -+#define SDIO_HIMR_CPWM2_MSK BIT19 -+#define SDIO_HIMR_HSISR_IND_MSK BIT20 -+#define SDIO_HIMR_GTINT3_IND_MSK BIT21 -+#define SDIO_HIMR_GTINT4_IND_MSK BIT22 -+#define SDIO_HIMR_PSTIMEOUT_MSK BIT23 -+#define SDIO_HIMR_OCPINT_MSK BIT24 -+#define SDIO_HIMR_ATIMEND_MSK BIT25 -+#define SDIO_HIMR_ATIMEND_E_MSK BIT26 -+#define SDIO_HIMR_CTWEND_MSK BIT27 -+ -+/* RTL8188E SDIO Specific */ -+#define SDIO_HIMR_MCU_ERR_MSK BIT28 -+#define SDIO_HIMR_TSF_BIT32_TOGGLE_MSK BIT29 -+ -+/* SDIO Host Interrupt Service Routine */ -+#define SDIO_HISR_RX_REQUEST BIT0 -+#define SDIO_HISR_AVAL BIT1 -+#define SDIO_HISR_TXERR BIT2 -+#define SDIO_HISR_RXERR BIT3 -+#define SDIO_HISR_TXFOVW BIT4 -+#define SDIO_HISR_RXFOVW BIT5 -+#define SDIO_HISR_TXBCNOK BIT6 -+#define SDIO_HISR_TXBCNERR BIT7 -+#define SDIO_HISR_BCNERLY_INT BIT16 -+#define SDIO_HISR_C2HCMD BIT17 -+#define SDIO_HISR_CPWM1 BIT18 -+#define SDIO_HISR_CPWM2 BIT19 -+#define SDIO_HISR_HSISR_IND BIT20 -+#define SDIO_HISR_GTINT3_IND BIT21 -+#define SDIO_HISR_GTINT4_IND BIT22 -+#define SDIO_HISR_PSTIMEOUT BIT23 -+#define SDIO_HISR_OCPINT BIT24 -+#define SDIO_HISR_ATIMEND BIT25 -+#define SDIO_HISR_ATIMEND_E BIT26 -+#define SDIO_HISR_CTWEND BIT27 -+ -+/* RTL8188E SDIO Specific */ -+#define SDIO_HISR_MCU_ERR BIT28 -+#define SDIO_HISR_TSF_BIT32_TOGGLE BIT29 -+ -+#define MASK_SDIO_HISR_CLEAR (SDIO_HISR_TXERR |\ -+ SDIO_HISR_RXERR |\ -+ SDIO_HISR_TXFOVW |\ -+ SDIO_HISR_RXFOVW |\ -+ SDIO_HISR_TXBCNOK |\ -+ SDIO_HISR_TXBCNERR |\ -+ SDIO_HISR_C2HCMD |\ -+ SDIO_HISR_CPWM1 |\ -+ SDIO_HISR_CPWM2 |\ -+ SDIO_HISR_HSISR_IND |\ -+ SDIO_HISR_GTINT3_IND |\ -+ SDIO_HISR_GTINT4_IND |\ -+ SDIO_HISR_PSTIMEOUT |\ -+ SDIO_HISR_OCPINT) -+ -+/* SDIO HCI Suspend Control Register */ -+#define HCI_RESUME_PWR_RDY BIT1 -+#define HCI_SUS_CTRL BIT0 -+ -+/* SDIO Tx FIFO related */ -+#define SDIO_TX_FREE_PG_QUEUE 4 /* The number of Tx FIFO free page */ -+#define SDIO_TX_FIFO_PAGE_SZ 128 -+ -+#define MAX_TX_AGG_PACKET_NUMBER 0x8 -+ -+/* */ -+/* */ -+/* 0xFE00h ~ 0xFE55h USB Configuration */ -+/* */ -+/* */ -+ -+/* 2 USB Information (0xFE17) */ -+#define USB_IS_HIGH_SPEED 0 -+#define USB_IS_FULL_SPEED 1 -+#define USB_SPEED_MASK BIT(5) -+ -+#define USB_NORMAL_SIE_EP_MASK 0xF -+#define USB_NORMAL_SIE_EP_SHIFT 4 -+ -+/* 2 Special Option */ -+#define USB_AGG_EN BIT(3) -+ -+/* 0; Use interrupt endpoint to upload interrupt pkt */ -+/* 1; Use bulk endpoint to upload interrupt pkt, */ -+#define INT_BULK_SEL BIT(4) -+ -+/* 2REG_C2HEVT_CLEAR */ -+#define C2H_EVT_HOST_CLOSE 0x00 /* Set by driver and notify FW that the driver has read the C2H command message */ -+#define C2H_EVT_FW_CLOSE 0xFF /* Set by FW indicating that FW had set the C2H command message and it's not yet read by driver. */ -+ -+ -+/* 2REG_MULTI_FUNC_CTRL(For RTL8723 Only) */ -+#define WL_HWPDN_EN BIT0 /* Enable GPIO[9] as WiFi HW PDn source */ -+#define WL_HWPDN_SL BIT1 /* WiFi HW PDn polarity control */ -+#define WL_FUNC_EN BIT2 /* WiFi function enable */ -+#define WL_HWROF_EN BIT3 /* Enable GPIO[9] as WiFi RF HW PDn source */ -+#define BT_HWPDN_EN BIT16 /* Enable GPIO[11] as BT HW PDn source */ -+#define BT_HWPDN_SL BIT17 /* BT HW PDn polarity control */ -+#define BT_FUNC_EN BIT18 /* BT function enable */ -+#define BT_HWROF_EN BIT19 /* Enable GPIO[11] as BT/GPS RF HW PDn source */ -+#define GPS_HWPDN_EN BIT20 /* Enable GPIO[10] as GPS HW PDn source */ -+#define GPS_HWPDN_SL BIT21 /* GPS HW PDn polarity control */ -+#define GPS_FUNC_EN BIT22 /* GPS function enable */ -+ -+/* 3 REG_LIFECTRL_CTRL */ -+#define HAL92C_EN_PKT_LIFE_TIME_BK BIT3 -+#define HAL92C_EN_PKT_LIFE_TIME_BE BIT2 -+#define HAL92C_EN_PKT_LIFE_TIME_VI BIT1 -+#define HAL92C_EN_PKT_LIFE_TIME_VO BIT0 -+ -+#define HAL92C_MSDU_LIFE_TIME_UNIT 128 /* in us, said by Tim. */ -+ -+/* 2 8192D PartNo. */ -+#define PARTNO_92D_NIC (BIT7|BIT6) -+#define PARTNO_92D_NIC_REMARK (BIT5|BIT4) -+#define PARTNO_SINGLE_BAND_VS BIT3 -+#define PARTNO_SINGLE_BAND_VS_REMARK BIT1 -+#define PARTNO_CONCURRENT_BAND_VC (BIT3|BIT2) -+#define PARTNO_CONCURRENT_BAND_VC_REMARK (BIT1|BIT0) -+ -+/* */ -+/* General definitions */ -+/* */ -+ -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8188E 176 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8812 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8723B 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8192C 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_DUAL_MAC 127 -+ -+#define POLLING_LLT_THRESHOLD 20 -+#define POLLING_READY_TIMEOUT_COUNT 1000 -+ -+ -+/* GPIO BIT */ -+#define HAL_8192C_HW_GPIO_WPS_BIT BIT2 -+#define HAL_8192EU_HW_GPIO_WPS_BIT BIT7 -+#define HAL_8188E_HW_GPIO_WPS_BIT BIT7 -+ -+#endif /* __HAL_COMMON_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/hal_data.h linux/3rdparty/rtl8723bs/include/hal_data.h ---- linux.old/3rdparty/rtl8723bs/include/hal_data.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/hal_data.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,485 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_DATA_H__ -+#define __HAL_DATA_H__ -+ -+#include "odm_precomp.h" -+#include -+ -+#include -+ -+/* */ -+/* For RTL8723 WiFi/BT/GPS multi-function configuration. 2010.10.06. */ -+/* */ -+enum RT_MULTI_FUNC { -+ RT_MULTI_FUNC_NONE = 0x00, -+ RT_MULTI_FUNC_WIFI = 0x01, -+ RT_MULTI_FUNC_BT = 0x02, -+ RT_MULTI_FUNC_GPS = 0x04, -+}; -+/* */ -+/* For RTL8723 WiFi PDn/GPIO polarity control configuration. 2010.10.08. */ -+/* */ -+enum RT_POLARITY_CTL { -+ RT_POLARITY_LOW_ACT = 0, -+ RT_POLARITY_HIGH_ACT = 1, -+}; -+ -+/* For RTL8723 regulator mode. by tynli. 2011.01.14. */ -+enum RT_REGULATOR_MODE { -+ RT_SWITCHING_REGULATOR = 0, -+ RT_LDO_REGULATOR = 1, -+}; -+ -+enum RT_AMPDU_BURST { -+ RT_AMPDU_BURST_NONE = 0, -+ RT_AMPDU_BURST_92D = 1, -+ RT_AMPDU_BURST_88E = 2, -+ RT_AMPDU_BURST_8812_4 = 3, -+ RT_AMPDU_BURST_8812_8 = 4, -+ RT_AMPDU_BURST_8812_12 = 5, -+ RT_AMPDU_BURST_8812_15 = 6, -+ RT_AMPDU_BURST_8723B = 7, -+}; -+ -+#define CHANNEL_MAX_NUMBER 14+24+21 /* 14 is the max channel number */ -+#define CHANNEL_MAX_NUMBER_2G 14 -+#define CHANNEL_MAX_NUMBER_5G 54 /* Please refer to "phy_GetChnlGroup8812A" and "Hal_ReadTxPowerInfo8812A" */ -+#define CHANNEL_MAX_NUMBER_5G_80M 7 -+#define CHANNEL_GROUP_MAX 3+9 /* ch1~3, ch4~9, ch10~14 total three groups */ -+#define MAX_PG_GROUP 13 -+ -+/* Tx Power Limit Table Size */ -+#define MAX_REGULATION_NUM 4 -+#define MAX_RF_PATH_NUM_IN_POWER_LIMIT_TABLE 4 -+#define MAX_2_4G_BANDWITH_NUM 4 -+#define MAX_RATE_SECTION_NUM 10 -+#define MAX_5G_BANDWITH_NUM 4 -+ -+#define MAX_BASE_NUM_IN_PHY_REG_PG_2_4G 10 /* CCK:1, OFDM:1, HT:4, VHT:4 */ -+#define MAX_BASE_NUM_IN_PHY_REG_PG_5G 9 /* OFDM:1, HT:4, VHT:4 */ -+ -+ -+/* duplicate code, will move to ODM ######### */ -+/* define IQK_MAC_REG_NUM 4 */ -+/* define IQK_ADDA_REG_NUM 16 */ -+ -+/* define IQK_BB_REG_NUM 10 */ -+#define IQK_BB_REG_NUM_92C 9 -+#define IQK_BB_REG_NUM_92D 10 -+#define IQK_BB_REG_NUM_test 6 -+ -+#define IQK_Matrix_Settings_NUM_92D 1+24+21 -+ -+/* define HP_THERMAL_NUM 8 */ -+/* duplicate code, will move to ODM ######### */ -+ -+enum { -+ SINGLEMAC_SINGLEPHY, /* SMSP */ -+ DUALMAC_DUALPHY, /* DMDP */ -+ DUALMAC_SINGLEPHY, /* DMSP */ -+}; -+ -+#define PAGE_SIZE_128 128 -+#define PAGE_SIZE_256 256 -+#define PAGE_SIZE_512 512 -+ -+struct dm_priv { -+ u8 DM_Type; -+ -+#define DYNAMIC_FUNC_BT BIT0 -+ -+ u8 DMFlag; -+ u8 InitDMFlag; -+ /* u8 RSVD_1; */ -+ -+ u32 InitODMFlag; -+ /* Upper and Lower Signal threshold for Rate Adaptive */ -+ int UndecoratedSmoothedPWDB; -+ int UndecoratedSmoothedCCK; -+ int EntryMinUndecoratedSmoothedPWDB; -+ int EntryMaxUndecoratedSmoothedPWDB; -+ int MinUndecoratedPWDBForDM; -+ int LastMinUndecoratedPWDBForDM; -+ -+ s32 UndecoratedSmoothedBeacon; -+ -+/* duplicate code, will move to ODM ######### */ -+ /* for High Power */ -+ u8 bDynamicTxPowerEnable; -+ u8 LastDTPLvl; -+ u8 DynamicTxHighPowerLvl;/* Add by Jacken Tx Power Control for Near/Far Range 2008/03/06 */ -+ -+ /* for tx power tracking */ -+ u8 bTXPowerTracking; -+ u8 TXPowercount; -+ u8 bTXPowerTrackingInit; -+ u8 TxPowerTrackControl; /* for mp mode, turn off txpwrtracking as default */ -+ u8 TM_Trigger; -+ -+ u8 ThermalMeter[2]; /* ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 */ -+ u8 ThermalValue; -+ u8 ThermalValue_LCK; -+ u8 ThermalValue_IQK; -+ u8 ThermalValue_DPK; -+ u8 bRfPiEnable; -+ /* u8 RSVD_2; */ -+ -+ /* for APK */ -+ u32 APKoutput[2][2]; /* path A/B; output1_1a/output1_2a */ -+ u8 bAPKdone; -+ u8 bAPKThermalMeterIgnore; -+ u8 bDPdone; -+ u8 bDPPathAOK; -+ u8 bDPPathBOK; -+ /* u8 RSVD_3; */ -+ /* u8 RSVD_4; */ -+ /* u8 RSVD_5; */ -+ -+ /* for IQK */ -+ u32 ADDA_backup[IQK_ADDA_REG_NUM]; -+ u32 IQK_MAC_backup[IQK_MAC_REG_NUM]; -+ u32 IQK_BB_backup_recover[9]; -+ u32 IQK_BB_backup[IQK_BB_REG_NUM]; -+ -+ u8 PowerIndex_backup[6]; -+ u8 OFDM_index[2]; -+ -+ u8 bCCKinCH14; -+ u8 CCK_index; -+ u8 bDoneTxpower; -+ u8 CCK_index_HP; -+ -+ u8 OFDM_index_HP[2]; -+ u8 ThermalValue_HP[HP_THERMAL_NUM]; -+ u8 ThermalValue_HP_index; -+ /* u8 RSVD_6; */ -+ -+ /* for TxPwrTracking2 */ -+ s32 RegE94; -+ s32 RegE9C; -+ s32 RegEB4; -+ s32 RegEBC; -+ -+ u32 TXPowerTrackingCallbackCnt; /* cosa add for debug */ -+ -+ u32 prv_traffic_idx; /* edca turbo */ -+/* duplicate code, will move to ODM ######### */ -+ -+ /* Add for Reading Initial Data Rate SEL Register 0x484 during watchdog. Using for fill tx desc. 2011.3.21 by Thomas */ -+ u8 INIDATA_RATE[32]; -+}; -+ -+ -+struct hal_com_data { -+ HAL_VERSION VersionID; -+ enum RT_MULTI_FUNC MultiFunc; /* For multi-function consideration. */ -+ enum RT_POLARITY_CTL PolarityCtl; /* For Wifi PDn Polarity control. */ -+ enum RT_REGULATOR_MODE RegulatorMode; /* switching regulator or LDO */ -+ -+ u16 FirmwareVersion; -+ u16 FirmwareVersionRev; -+ u16 FirmwareSubVersion; -+ u16 FirmwareSignature; -+ -+ /* current WIFI_PHY values */ -+ enum WIRELESS_MODE CurrentWirelessMode; -+ enum CHANNEL_WIDTH CurrentChannelBW; -+ enum BAND_TYPE CurrentBandType; /* 0:2.4G, 1:5G */ -+ enum BAND_TYPE BandSet; -+ u8 CurrentChannel; -+ u8 CurrentCenterFrequencyIndex1; -+ u8 nCur40MhzPrimeSC;/* Control channel sub-carrier */ -+ u8 nCur80MhzPrimeSC; /* used for primary 40MHz of 80MHz mode */ -+ -+ u16 CustomerID; -+ u16 BasicRateSet; -+ u16 ForcedDataRate;/* Force Data Rate. 0: Auto, 0x02: 1M ~ 0x6C: 54M. */ -+ u32 ReceiveConfig; -+ -+ /* rf_ctrl */ -+ u8 rf_chip; -+ u8 rf_type; -+ u8 PackageType; -+ u8 NumTotalRFPath; -+ -+ u8 InterfaceSel; -+ u8 framesync; -+ u32 framesyncC34; -+ u8 framesyncMonitor; -+ u8 DefaultInitialGain[4]; -+ /* EEPROM setting. */ -+ u16 EEPROMVID; -+ u16 EEPROMSVID; -+ -+ u8 EEPROMCustomerID; -+ u8 EEPROMSubCustomerID; -+ u8 EEPROMVersion; -+ u8 EEPROMRegulatory; -+ u8 EEPROMThermalMeter; -+ u8 EEPROMBluetoothCoexist; -+ u8 EEPROMBluetoothType; -+ u8 EEPROMBluetoothAntNum; -+ u8 EEPROMBluetoothAntIsolation; -+ u8 EEPROMBluetoothRadioShared; -+ u8 bTXPowerDataReadFromEEPORM; -+ u8 bAPKThermalMeterIgnore; -+ u8 bDisableSWChannelPlan; /* flag of disable software change channel plan */ -+ -+ bool EepromOrEfuse; -+ u8 EfuseUsedPercentage; -+ u16 EfuseUsedBytes; -+ EFUSE_HAL EfuseHal; -+ -+ /* 3 [2.4G] */ -+ u8 Index24G_CCK_Base[MAX_RF_PATH][CHANNEL_MAX_NUMBER]; -+ u8 Index24G_BW40_Base[MAX_RF_PATH][CHANNEL_MAX_NUMBER]; -+ /* If only one tx, only BW20 and OFDM are used. */ -+ s8 CCK_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 OFDM_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW20_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW40_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ /* 3 [5G] */ -+ u8 Index5G_BW40_Base[MAX_RF_PATH][CHANNEL_MAX_NUMBER]; -+ u8 Index5G_BW80_Base[MAX_RF_PATH][CHANNEL_MAX_NUMBER_5G_80M]; -+ s8 OFDM_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW20_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW40_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW80_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ -+ u8 Regulation2_4G; -+ u8 Regulation5G; -+ -+ u8 TxPwrInPercentage; -+ -+ u8 TxPwrCalibrateRate; -+ /* TX power by rate table at most 4RF path. */ -+ /* The register is */ -+ /* VHT TX power by rate off setArray = */ -+ /* Band:-2G&5G = 0 / 1 */ -+ /* RF: at most 4*4 = ABCD = 0/1/2/3 */ -+ /* CCK = 0 OFDM = 1/2 HT-MCS 0-15 =3/4/56 VHT =7/8/9/10/11 */ -+ u8 TxPwrByRateTable; -+ u8 TxPwrByRateBand; -+ s8 TxPwrByRateOffset[TX_PWR_BY_RATE_NUM_BAND] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RATE]; -+ /* */ -+ -+ /* 2 Power Limit Table */ -+ u8 TxPwrLevelCck[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; -+ u8 TxPwrLevelHT40_1S[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; /* For HT 40MHZ pwr */ -+ u8 TxPwrLevelHT40_2S[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; /* For HT 40MHZ pwr */ -+ s8 TxPwrHt20Diff[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER];/* HT 20<->40 Pwr diff */ -+ u8 TxPwrLegacyHtDiff[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER];/* For HT<->legacy pwr diff */ -+ -+ /* Power Limit Table for 2.4G */ -+ s8 TxPwrLimit_2_4G[MAX_REGULATION_NUM] -+ [MAX_2_4G_BANDWITH_NUM] -+ [MAX_RATE_SECTION_NUM] -+ [CHANNEL_MAX_NUMBER_2G] -+ [MAX_RF_PATH_NUM]; -+ -+ /* Power Limit Table for 5G */ -+ s8 TxPwrLimit_5G[MAX_REGULATION_NUM] -+ [MAX_5G_BANDWITH_NUM] -+ [MAX_RATE_SECTION_NUM] -+ [CHANNEL_MAX_NUMBER_5G] -+ [MAX_RF_PATH_NUM]; -+ -+ -+ /* Store the original power by rate value of the base of each rate section of rf path A & B */ -+ u8 TxPwrByRateBase2_4G[TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [MAX_BASE_NUM_IN_PHY_REG_PG_2_4G]; -+ u8 TxPwrByRateBase5G[TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [MAX_BASE_NUM_IN_PHY_REG_PG_5G]; -+ -+ /* For power group */ -+ u8 PwrGroupHT20[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; -+ u8 PwrGroupHT40[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; -+ -+ -+ -+ -+ u8 PGMaxGroup; -+ u8 LegacyHTTxPowerDiff;/* Legacy to HT rate power diff */ -+ /* The current Tx Power Level */ -+ u8 CurrentCckTxPwrIdx; -+ u8 CurrentOfdm24GTxPwrIdx; -+ u8 CurrentBW2024GTxPwrIdx; -+ u8 CurrentBW4024GTxPwrIdx; -+ -+ /* Read/write are allow for following hardware information variables */ -+ u8 pwrGroupCnt; -+ u32 MCSTxPowerLevelOriginalOffset[MAX_PG_GROUP][16]; -+ u32 CCKTxPowerLevelOriginalOffset; -+ -+ u8 CrystalCap; -+ u32 AntennaTxPath; /* Antenna path Tx */ -+ u32 AntennaRxPath; /* Antenna path Rx */ -+ -+ u8 PAType_2G; -+ u8 PAType_5G; -+ u8 LNAType_2G; -+ u8 LNAType_5G; -+ u8 ExternalPA_2G; -+ u8 ExternalLNA_2G; -+ u8 ExternalPA_5G; -+ u8 ExternalLNA_5G; -+ u8 TypeGLNA; -+ u8 TypeGPA; -+ u8 TypeALNA; -+ u8 TypeAPA; -+ u8 RFEType; -+ u8 BoardType; -+ u8 ExternalPA; -+ u8 bIQKInitialized; -+ bool bLCKInProgress; -+ -+ bool bSwChnl; -+ bool bSetChnlBW; -+ bool bChnlBWInitialized; -+ bool bNeedIQK; -+ -+ u8 bLedOpenDrain; /* Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. */ -+ u8 TxPowerTrackControl; /* for mp mode, turn off txpwrtracking as default */ -+ u8 b1x1RecvCombine; /* for 1T1R receive combining */ -+ -+ u32 AcParam_BE; /* Original parameter for BE, use for EDCA turbo. */ -+ -+ struct bb_register_def PHYRegDef[4]; /* Radio A/B/C/D */ -+ -+ u32 RfRegChnlVal[2]; -+ -+ /* RDG enable */ -+ bool bRDGEnable; -+ -+ /* for host message to fw */ -+ u8 LastHMEBoxNum; -+ -+ u8 fw_ractrl; -+ u8 RegTxPause; -+ /* Beacon function related global variable. */ -+ u8 RegBcnCtrlVal; -+ u8 RegFwHwTxQCtrl; -+ u8 RegReg542; -+ u8 RegCR_1; -+ u8 Reg837; -+ u8 RegRFPathS1; -+ u16 RegRRSR; -+ -+ u8 CurAntenna; -+ u8 AntDivCfg; -+ u8 AntDetection; -+ u8 TRxAntDivType; -+ u8 ant_path; /* for 8723B s0/s1 selection */ -+ -+ u8 u1ForcedIgiLb; /* forced IGI lower bound */ -+ -+ u8 bDumpRxPkt;/* for debug */ -+ u8 bDumpTxPkt;/* for debug */ -+ u8 FwRsvdPageStartOffset; /* 2010.06.23. Added by tynli. Reserve page start offset except beacon in TxQ. */ -+ -+ /* 2010/08/09 MH Add CU power down mode. */ -+ bool pwrdown; -+ -+ /* Add for dual MAC 0--Mac0 1--Mac1 */ -+ u32 interfaceIndex; -+ -+ u8 OutEpQueueSel; -+ u8 OutEpNumber; -+ -+ /* 2010/12/10 MH Add for USB aggreation mode dynamic shceme. */ -+ bool UsbRxHighSpeedMode; -+ -+ /* 2010/11/22 MH Add for slim combo debug mode selective. */ -+ /* This is used for fix the drawback of CU TSMC-A/UMC-A cut. HW auto suspend ability. Close BT clock. */ -+ bool SlimComboDbg; -+ -+ /* u8 AMPDUDensity; */ -+ -+ /* Auto FSM to Turn On, include clock, isolation, power control for MAC only */ -+ u8 bMacPwrCtrlOn; -+ -+ u8 RegIQKFWOffload; -+ struct submit_ctx iqk_sctx; -+ -+ enum RT_AMPDU_BURST AMPDUBurstMode; /* 92C maybe not use, but for compile successfully */ -+ -+ u32 sdio_himr; -+ u32 sdio_hisr; -+ -+ /* SDIO Tx FIFO related. */ -+ /* HIQ, MID, LOW, PUB free pages; padapter->xmitpriv.free_txpg */ -+ u8 SdioTxFIFOFreePage[SDIO_TX_FREE_PG_QUEUE]; -+ _lock SdioTxFIFOFreePageLock; -+ u8 SdioTxOQTMaxFreeSpace; -+ u8 SdioTxOQTFreeSpace; -+ -+ -+ /* SDIO Rx FIFO related. */ -+ u8 SdioRxFIFOCnt; -+ u16 SdioRxFIFOSize; -+ -+ u32 sdio_tx_max_len[SDIO_MAX_TX_QUEUE];/* H, N, L, used for sdio tx aggregation max length per queue */ -+ -+ struct dm_priv dmpriv; -+ DM_ODM_T odmpriv; -+ -+ /* For bluetooth co-existance */ -+ BT_COEXIST bt_coexist; -+ -+ /* Interrupt related register information. */ -+ u32 SysIntrStatus; -+ u32 SysIntrMask; -+ -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ char para_file_buf[MAX_PARA_FILE_BUF_LEN]; -+ char *mac_reg; -+ u32 mac_reg_len; -+ char *bb_phy_reg; -+ u32 bb_phy_reg_len; -+ char *bb_agc_tab; -+ u32 bb_agc_tab_len; -+ char *bb_phy_reg_pg; -+ u32 bb_phy_reg_pg_len; -+ char *bb_phy_reg_mp; -+ u32 bb_phy_reg_mp_len; -+ char *rf_radio_a; -+ u32 rf_radio_a_len; -+ char *rf_radio_b; -+ u32 rf_radio_b_len; -+ char *rf_tx_pwr_track; -+ u32 rf_tx_pwr_track_len; -+ char *rf_tx_pwr_lmt; -+ u32 rf_tx_pwr_lmt_len; -+#endif -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ s16 noise[ODM_MAX_CHANNEL_NUM]; -+#endif -+ -+}; -+ -+#define GET_HAL_DATA(__padapter) ((struct hal_com_data *)((__padapter)->HalData)) -+#define GET_HAL_RFPATH_NUM(__padapter) (((struct hal_com_data *)((__padapter)->HalData))->NumTotalRFPath) -+#define RT_GetInterfaceSelection(_Adapter) (GET_HAL_DATA(_Adapter)->InterfaceSel) -+#define GET_RF_TYPE(__padapter) (GET_HAL_DATA(__padapter)->rf_type) -+ -+#endif /* __HAL_DATA_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/hal_intf.h linux/3rdparty/rtl8723bs/include/hal_intf.h ---- linux.old/3rdparty/rtl8723bs/include/hal_intf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/hal_intf.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,410 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_INTF_H__ -+#define __HAL_INTF_H__ -+ -+ -+enum RTL871X_HCI_TYPE { -+ RTW_PCIE = BIT0, -+ RTW_USB = BIT1, -+ RTW_SDIO = BIT2, -+ RTW_GSPI = BIT3, -+}; -+ -+enum HW_VARIABLES { -+ HW_VAR_MEDIA_STATUS, -+ HW_VAR_MEDIA_STATUS1, -+ HW_VAR_SET_OPMODE, -+ HW_VAR_MAC_ADDR, -+ HW_VAR_BSSID, -+ HW_VAR_INIT_RTS_RATE, -+ HW_VAR_BASIC_RATE, -+ HW_VAR_TXPAUSE, -+ HW_VAR_BCN_FUNC, -+ HW_VAR_CORRECT_TSF, -+ HW_VAR_CHECK_BSSID, -+ HW_VAR_MLME_DISCONNECT, -+ HW_VAR_MLME_SITESURVEY, -+ HW_VAR_MLME_JOIN, -+ HW_VAR_ON_RCR_AM, -+ HW_VAR_OFF_RCR_AM, -+ HW_VAR_BEACON_INTERVAL, -+ HW_VAR_SLOT_TIME, -+ HW_VAR_RESP_SIFS, -+ HW_VAR_ACK_PREAMBLE, -+ HW_VAR_SEC_CFG, -+ HW_VAR_SEC_DK_CFG, -+ HW_VAR_BCN_VALID, -+ HW_VAR_RF_TYPE, -+ HW_VAR_DM_FLAG, -+ HW_VAR_DM_FUNC_OP, -+ HW_VAR_DM_FUNC_SET, -+ HW_VAR_DM_FUNC_CLR, -+ HW_VAR_CAM_EMPTY_ENTRY, -+ HW_VAR_CAM_INVALID_ALL, -+ HW_VAR_CAM_WRITE, -+ HW_VAR_CAM_READ, -+ HW_VAR_AC_PARAM_VO, -+ HW_VAR_AC_PARAM_VI, -+ HW_VAR_AC_PARAM_BE, -+ HW_VAR_AC_PARAM_BK, -+ HW_VAR_ACM_CTRL, -+ HW_VAR_AMPDU_MIN_SPACE, -+ HW_VAR_AMPDU_FACTOR, -+ HW_VAR_RXDMA_AGG_PG_TH, -+ HW_VAR_SET_RPWM, -+ HW_VAR_CPWM, -+ HW_VAR_H2C_FW_PWRMODE, -+ HW_VAR_H2C_PS_TUNE_PARAM, -+ HW_VAR_H2C_FW_JOINBSSRPT, -+ HW_VAR_FWLPS_RF_ON, -+ HW_VAR_H2C_FW_P2P_PS_OFFLOAD, -+ HW_VAR_TDLS_WRCR, -+ HW_VAR_TDLS_INIT_CH_SEN, -+ HW_VAR_TDLS_RS_RCR, -+ HW_VAR_TDLS_DONE_CH_SEN, -+ HW_VAR_INITIAL_GAIN, -+ HW_VAR_TRIGGER_GPIO_0, -+ HW_VAR_BT_SET_COEXIST, -+ HW_VAR_BT_ISSUE_DELBA, -+ HW_VAR_CURRENT_ANTENNA, -+ HW_VAR_ANTENNA_DIVERSITY_LINK, -+ HW_VAR_ANTENNA_DIVERSITY_SELECT, -+ HW_VAR_SWITCH_EPHY_WoWLAN, -+ HW_VAR_EFUSE_USAGE, -+ HW_VAR_EFUSE_BYTES, -+ HW_VAR_EFUSE_BT_USAGE, -+ HW_VAR_EFUSE_BT_BYTES, -+ HW_VAR_FIFO_CLEARN_UP, -+ HW_VAR_CHECK_TXBUF, -+ HW_VAR_PCIE_STOP_TX_DMA, -+ HW_VAR_APFM_ON_MAC, /* Auto FSM to Turn On, include clock, isolation, power control for MAC only */ -+ /* The valid upper nav range for the HW updating, if the true value is larger than the upper range, the HW won't update it. */ -+ /* Unit in microsecond. 0 means disable this function. */ -+#ifdef CONFIG_WOWLAN -+ HW_VAR_WOWLAN, -+ HW_VAR_WAKEUP_REASON, -+ HW_VAR_RPWM_TOG, -+#endif -+#ifdef CONFIG_AP_WOWLAN -+ HW_VAR_AP_WOWLAN, -+#endif -+ HW_VAR_SYS_CLKR, -+ HW_VAR_NAV_UPPER, -+ HW_VAR_C2H_HANDLE, -+ HW_VAR_RPT_TIMER_SETTING, -+ HW_VAR_TX_RPT_MAX_MACID, -+ HW_VAR_H2C_MEDIA_STATUS_RPT, -+ HW_VAR_CHK_HI_QUEUE_EMPTY, -+ HW_VAR_DL_BCN_SEL, -+ HW_VAR_AMPDU_MAX_TIME, -+ HW_VAR_WIRELESS_MODE, -+ HW_VAR_USB_MODE, -+ HW_VAR_PORT_SWITCH, -+ HW_VAR_DO_IQK, -+ HW_VAR_DM_IN_LPS, -+ HW_VAR_SET_REQ_FW_PS, -+ HW_VAR_FW_PS_STATE, -+ HW_VAR_SOUNDING_ENTER, -+ HW_VAR_SOUNDING_LEAVE, -+ HW_VAR_SOUNDING_RATE, -+ HW_VAR_SOUNDING_STATUS, -+ HW_VAR_SOUNDING_FW_NDPA, -+ HW_VAR_SOUNDING_CLK, -+ HW_VAR_DL_RSVD_PAGE, -+ HW_VAR_MACID_SLEEP, -+ HW_VAR_MACID_WAKEUP, -+}; -+ -+enum HAL_DEF_VARIABLE { -+ HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, -+ HAL_DEF_IS_SUPPORT_ANT_DIV, -+ HAL_DEF_CURRENT_ANTENNA, -+ HAL_DEF_DRVINFO_SZ, -+ HAL_DEF_MAX_RECVBUF_SZ, -+ HAL_DEF_RX_PACKET_OFFSET, -+ HAL_DEF_DBG_DUMP_RXPKT,/* for dbg */ -+ HAL_DEF_DBG_DM_FUNC,/* for dbg */ -+ HAL_DEF_RA_DECISION_RATE, -+ HAL_DEF_RA_SGI, -+ HAL_DEF_PT_PWR_STATUS, -+ HAL_DEF_TX_LDPC, /* LDPC support */ -+ HAL_DEF_RX_LDPC, /* LDPC support */ -+ HAL_DEF_TX_STBC, /* TX STBC support */ -+ HAL_DEF_RX_STBC, /* RX STBC support */ -+ HAL_DEF_EXPLICIT_BEAMFORMER,/* Explicit Compressed Steering Capable */ -+ HAL_DEF_EXPLICIT_BEAMFORMEE,/* Explicit Compressed Beamforming Feedback Capable */ -+ HW_VAR_MAX_RX_AMPDU_FACTOR, -+ HW_DEF_RA_INFO_DUMP, -+ HAL_DEF_DBG_DUMP_TXPKT, -+ HW_DEF_FA_CNT_DUMP, -+ HW_DEF_ODM_DBG_FLAG, -+ HW_DEF_ODM_DBG_LEVEL, -+ HAL_DEF_TX_PAGE_SIZE, -+ HAL_DEF_TX_PAGE_BOUNDARY, -+ HAL_DEF_TX_PAGE_BOUNDARY_WOWLAN, -+ HAL_DEF_ANT_DETECT,/* to do for 8723a */ -+ HAL_DEF_PCI_SUUPORT_L1_BACKDOOR, /* Determine if the L1 Backdoor setting is turned on. */ -+ HAL_DEF_PCI_AMD_L1_SUPPORT, -+ HAL_DEF_PCI_ASPM_OSC, /* Support for ASPM OSC, added by Roger, 2013.03.27. */ -+ HAL_DEF_MACID_SLEEP, /* Support for MACID sleep */ -+ HAL_DEF_DBG_RX_INFO_DUMP, -+}; -+ -+enum HAL_ODM_VARIABLE { -+ HAL_ODM_STA_INFO, -+ HAL_ODM_P2P_STATE, -+ HAL_ODM_WIFI_DISPLAY_STATE, -+ HAL_ODM_NOISE_MONITOR, -+}; -+ -+enum HAL_INTF_PS_FUNC { -+ HAL_USB_SELECT_SUSPEND, -+ HAL_MAX_ID, -+}; -+ -+typedef s32 (*c2h_id_filter)(u8 *c2h_evt); -+ -+struct hal_ops { -+ u32 (*hal_power_on)(struct adapter *padapter); -+ void (*hal_power_off)(struct adapter *padapter); -+ u32 (*hal_init)(struct adapter *padapter); -+ u32 (*hal_deinit)(struct adapter *padapter); -+ -+ void (*free_hal_data)(struct adapter *padapter); -+ -+ u32 (*inirp_init)(struct adapter *padapter); -+ u32 (*inirp_deinit)(struct adapter *padapter); -+ void (*irp_reset)(struct adapter *padapter); -+ -+ s32 (*init_xmit_priv)(struct adapter *padapter); -+ void (*free_xmit_priv)(struct adapter *padapter); -+ -+ s32 (*init_recv_priv)(struct adapter *padapter); -+ void (*free_recv_priv)(struct adapter *padapter); -+ -+ void (*dm_init)(struct adapter *padapter); -+ void (*dm_deinit)(struct adapter *padapter); -+ void (*read_chip_version)(struct adapter *padapter); -+ -+ void (*init_default_value)(struct adapter *padapter); -+ -+ void (*intf_chip_configure)(struct adapter *padapter); -+ -+ void (*read_adapter_info)(struct adapter *padapter); -+ -+ void (*enable_interrupt)(struct adapter *padapter); -+ void (*disable_interrupt)(struct adapter *padapter); -+ u8 (*check_ips_status)(struct adapter *padapter); -+ s32 (*interrupt_handler)(struct adapter *padapter); -+ void (*clear_interrupt)(struct adapter *padapter); -+ void (*set_bwmode_handler)(struct adapter *padapter, enum CHANNEL_WIDTH Bandwidth, u8 Offset); -+ void (*set_channel_handler)(struct adapter *padapter, u8 channel); -+ void (*set_chnl_bw_handler)(struct adapter *padapter, u8 channel, enum CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80); -+ -+ void (*set_tx_power_level_handler)(struct adapter *padapter, u8 channel); -+ void (*get_tx_power_level_handler)(struct adapter *padapter, s32 *powerlevel); -+ -+ void (*hal_dm_watchdog)(struct adapter *padapter); -+ void (*hal_dm_watchdog_in_lps)(struct adapter *padapter); -+ -+ -+ void (*SetHwRegHandler)(struct adapter *padapter, u8 variable, u8 *val); -+ void (*GetHwRegHandler)(struct adapter *padapter, u8 variable, u8 *val); -+ -+ void (*SetHwRegHandlerWithBuf)(struct adapter *padapter, u8 variable, u8 *pbuf, int len); -+ -+ u8 (*GetHalDefVarHandler)(struct adapter *padapter, enum HAL_DEF_VARIABLE eVariable, void *pValue); -+ u8 (*SetHalDefVarHandler)(struct adapter *padapter, enum HAL_DEF_VARIABLE eVariable, void *pValue); -+ -+ void (*GetHalODMVarHandler)(struct adapter *padapter, enum HAL_ODM_VARIABLE eVariable, void *pValue1, void *pValue2); -+ void (*SetHalODMVarHandler)(struct adapter *padapter, enum HAL_ODM_VARIABLE eVariable, void *pValue1, bool bSet); -+ -+ void (*UpdateRAMaskHandler)(struct adapter *padapter, u32 mac_id, u8 rssi_level); -+ void (*SetBeaconRelatedRegistersHandler)(struct adapter *padapter); -+ -+ void (*Add_RateATid)(struct adapter *padapter, u32 bitmap, u8 *arg, u8 rssi_level); -+ -+ void (*run_thread)(struct adapter *padapter); -+ void (*cancel_thread)(struct adapter *padapter); -+ -+ u8 (*interface_ps_func)(struct adapter *padapter, enum HAL_INTF_PS_FUNC efunc_id, u8 *val); -+ -+ s32 (*hal_xmit)(struct adapter *padapter, struct xmit_frame *pxmitframe); -+ /* -+ * mgnt_xmit should be implemented to run in interrupt context -+ */ -+ s32 (*mgnt_xmit)(struct adapter *padapter, struct xmit_frame *pmgntframe); -+ s32 (*hal_xmitframe_enqueue)(struct adapter *padapter, struct xmit_frame *pxmitframe); -+ -+ u32 (*read_bbreg)(struct adapter *padapter, u32 RegAddr, u32 BitMask); -+ void (*write_bbreg)(struct adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); -+ u32 (*read_rfreg)(struct adapter *padapter, u8 eRFPath, u32 RegAddr, u32 BitMask); -+ void (*write_rfreg)(struct adapter *padapter, u8 eRFPath, u32 RegAddr, u32 BitMask, u32 Data); -+ -+ void (*EfusePowerSwitch)(struct adapter *padapter, u8 bWrite, u8 PwrState); -+ void (*BTEfusePowerSwitch)(struct adapter *padapter, u8 bWrite, u8 PwrState); -+ void (*ReadEFuse)(struct adapter *padapter, u8 efuseType, u16 _offset, u16 _size_byte, u8 *pbuf, bool bPseudoTest); -+ void (*EFUSEGetEfuseDefinition)(struct adapter *padapter, u8 efuseType, u8 type, void *pOut, bool bPseudoTest); -+ u16 (*EfuseGetCurrentSize)(struct adapter *padapter, u8 efuseType, bool bPseudoTest); -+ int (*Efuse_PgPacketRead)(struct adapter *padapter, u8 offset, u8 *data, bool bPseudoTest); -+ int (*Efuse_PgPacketWrite)(struct adapter *padapter, u8 offset, u8 word_en, u8 *data, bool bPseudoTest); -+ u8 (*Efuse_WordEnableDataWrite)(struct adapter *padapter, u16 efuse_addr, u8 word_en, u8 *data, bool bPseudoTest); -+ bool (*Efuse_PgPacketWrite_BT)(struct adapter *padapter, u8 offset, u8 word_en, u8 *data, bool bPseudoTest); -+ -+ s32 (*xmit_thread_handler)(struct adapter *padapter); -+ void (*hal_notch_filter)(struct adapter * adapter, bool enable); -+ void (*hal_reset_security_engine)(struct adapter * adapter); -+ s32 (*c2h_handler)(struct adapter *padapter, u8 *c2h_evt); -+ c2h_id_filter c2h_id_filter_ccx; -+ -+ s32 (*fill_h2c_cmd)(struct adapter *, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+}; -+ -+enum RT_EEPROM_TYPE { -+ EEPROM_93C46, -+ EEPROM_93C56, -+ EEPROM_BOOT_EFUSE, -+}; -+ -+#define RF_CHANGE_BY_INIT 0 -+#define RF_CHANGE_BY_IPS BIT28 -+#define RF_CHANGE_BY_PS BIT29 -+#define RF_CHANGE_BY_HW BIT30 -+#define RF_CHANGE_BY_SW BIT31 -+ -+#define GET_EEPROM_EFUSE_PRIV(adapter) (&adapter->eeprompriv) -+#define is_boot_from_eeprom(adapter) (adapter->eeprompriv.EepromOrEfuse) -+ -+enum wowlan_subcode { -+ WOWLAN_PATTERN_MATCH = 1, -+ WOWLAN_MAGIC_PACKET = 2, -+ WOWLAN_UNICAST = 3, -+ WOWLAN_SET_PATTERN = 4, -+ WOWLAN_DUMP_REG = 5, -+ WOWLAN_ENABLE = 6, -+ WOWLAN_DISABLE = 7, -+ WOWLAN_STATUS = 8, -+ WOWLAN_DEBUG_RELOAD_FW = 9, -+ WOWLAN_DEBUG_1 = 10, -+ WOWLAN_DEBUG_2 = 11, -+ WOWLAN_AP_ENABLE = 12, -+ WOWLAN_AP_DISABLE = 13 -+}; -+ -+struct wowlan_ioctl_param{ -+ unsigned int subcode; -+ unsigned int subcode_value; -+ unsigned int wakeup_reason; -+ unsigned int len; -+ unsigned char pattern[0]; -+}; -+ -+#define Rx_Pairwisekey 0x01 -+#define Rx_GTK 0x02 -+#define Rx_DisAssoc 0x04 -+#define Rx_DeAuth 0x08 -+#define Rx_ARPReq 0x09 -+#define FWDecisionDisconnect 0x10 -+#define Rx_MagicPkt 0x21 -+#define Rx_UnicastPkt 0x22 -+#define Rx_PatternPkt 0x23 -+#define RX_PNOWakeUp 0x55 -+#define AP_WakeUp 0x66 -+ -+void rtw_hal_def_value_init(struct adapter *padapter); -+ -+void rtw_hal_free_data(struct adapter *padapter); -+ -+void rtw_hal_dm_init(struct adapter *padapter); -+void rtw_hal_dm_deinit(struct adapter *padapter); -+ -+uint rtw_hal_init(struct adapter *padapter); -+uint rtw_hal_deinit(struct adapter *padapter); -+void rtw_hal_stop(struct adapter *padapter); -+void rtw_hal_set_hwreg(struct adapter *padapter, u8 variable, u8 *val); -+void rtw_hal_get_hwreg(struct adapter *padapter, u8 variable, u8 *val); -+ -+void rtw_hal_set_hwreg_with_buf(struct adapter *padapter, u8 variable, u8 *pbuf, int len); -+ -+void rtw_hal_chip_configure(struct adapter *padapter); -+void rtw_hal_read_chip_info(struct adapter *padapter); -+void rtw_hal_read_chip_version(struct adapter *padapter); -+ -+u8 rtw_hal_set_def_var(struct adapter *padapter, enum HAL_DEF_VARIABLE eVariable, void *pValue); -+u8 rtw_hal_get_def_var(struct adapter *padapter, enum HAL_DEF_VARIABLE eVariable, void *pValue); -+ -+void rtw_hal_set_odm_var(struct adapter *padapter, enum HAL_ODM_VARIABLE eVariable, void *pValue1, bool bSet); -+void rtw_hal_get_odm_var(struct adapter *padapter, enum HAL_ODM_VARIABLE eVariable, void *pValue1, void *pValue2); -+ -+void rtw_hal_enable_interrupt(struct adapter *padapter); -+void rtw_hal_disable_interrupt(struct adapter *padapter); -+ -+u8 rtw_hal_check_ips_status(struct adapter *padapter); -+ -+s32 rtw_hal_xmitframe_enqueue(struct adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtw_hal_xmit(struct adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtw_hal_mgnt_xmit(struct adapter *padapter, struct xmit_frame *pmgntframe); -+ -+s32 rtw_hal_init_xmit_priv(struct adapter *padapter); -+void rtw_hal_free_xmit_priv(struct adapter *padapter); -+ -+s32 rtw_hal_init_recv_priv(struct adapter *padapter); -+void rtw_hal_free_recv_priv(struct adapter *padapter); -+ -+void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level); -+void rtw_hal_add_ra_tid(struct adapter *padapter, u32 bitmap, u8 *arg, u8 rssi_level); -+ -+void rtw_hal_start_thread(struct adapter *padapter); -+void rtw_hal_stop_thread(struct adapter *padapter); -+ -+void rtw_hal_bcn_related_reg_setting(struct adapter *padapter); -+ -+u32 rtw_hal_read_bbreg(struct adapter *padapter, u32 RegAddr, u32 BitMask); -+void rtw_hal_write_bbreg(struct adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); -+u32 rtw_hal_read_rfreg(struct adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask); -+void rtw_hal_write_rfreg(struct adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask, u32 Data); -+ -+#define PHY_QueryBBReg(Adapter, RegAddr, BitMask) rtw_hal_read_bbreg((Adapter), (RegAddr), (BitMask)) -+#define PHY_SetBBReg(Adapter, RegAddr, BitMask, Data) rtw_hal_write_bbreg((Adapter), (RegAddr), (BitMask), (Data)) -+#define PHY_QueryRFReg(Adapter, eRFPath, RegAddr, BitMask) rtw_hal_read_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask)) -+#define PHY_SetRFReg(Adapter, eRFPath, RegAddr, BitMask, Data) rtw_hal_write_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask), (Data)) -+ -+#define PHY_SetMacReg PHY_SetBBReg -+#define PHY_QueryMacReg PHY_QueryBBReg -+ -+void rtw_hal_set_chan(struct adapter *padapter, u8 channel); -+void rtw_hal_set_chnl_bw(struct adapter *padapter, u8 channel, enum CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80); -+void rtw_hal_dm_watchdog(struct adapter *padapter); -+void rtw_hal_dm_watchdog_in_lps(struct adapter *padapter); -+ -+s32 rtw_hal_xmit_thread_handler(struct adapter *padapter); -+ -+void rtw_hal_notch_filter(struct adapter * adapter, bool enable); -+void rtw_hal_reset_security_engine(struct adapter * adapter); -+ -+bool rtw_hal_c2h_valid(struct adapter *adapter, u8 *buf); -+s32 rtw_hal_c2h_evt_read(struct adapter *adapter, u8 *buf); -+s32 rtw_hal_c2h_handler(struct adapter *adapter, u8 *c2h_evt); -+c2h_id_filter rtw_hal_c2h_id_filter_ccx(struct adapter *adapter); -+ -+s32 rtw_hal_is_disable_sw_channel_plan(struct adapter *padapter); -+ -+s32 rtw_hal_macid_sleep(struct adapter *padapter, u32 macid); -+s32 rtw_hal_macid_wakeup(struct adapter *padapter, u32 macid); -+ -+s32 rtw_hal_fill_h2c_cmd(struct adapter *, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+ -+#endif /* __HAL_INTF_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/hal_pg.h linux/3rdparty/rtl8723bs/include/hal_pg.h ---- linux.old/3rdparty/rtl8723bs/include/hal_pg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/hal_pg.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,81 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL_PG_H__ -+#define __HAL_PG_H__ -+ -+#define MAX_RF_PATH 4 -+/* MAX_TX_COUNT must always be set to 4, otherwise the read efuse table -+ * sequence will be wrong. -+ */ -+#define MAX_TX_COUNT 4 -+ -+/* For VHT series TX power by rate table. */ -+/* VHT TX power by rate off setArray = */ -+/* Band:-2G&5G = 0 / 1 */ -+/* RF: at most 4*4 = ABCD = 0/1/2/3 */ -+/* CCK = 0 OFDM = 1/2 HT-MCS 0-15 =3/4/56 VHT =7/8/9/10/11 */ -+#define TX_PWR_BY_RATE_NUM_BAND 2 -+#define TX_PWR_BY_RATE_NUM_RF 4 -+#define TX_PWR_BY_RATE_NUM_RATE 84 -+#define MAX_RF_PATH_NUM 2 -+#define MAX_CHNL_GROUP_24G 6 -+#define EEPROM_DEFAULT_BOARD_OPTION 0x00 -+ -+/* EEPROM/Efuse PG Offset for 8723BE/8723BU/8723BS */ -+/* 0x10 ~ 0x63 = TX power area. */ -+#define EEPROM_TX_PWR_INX_8723B 0x10 -+/* New EFUSE default value */ -+#define EEPROM_DEFAULT_24G_INDEX 0x2D -+#define EEPROM_DEFAULT_24G_HT20_DIFF 0X02 -+#define EEPROM_DEFAULT_24G_OFDM_DIFF 0X04 -+#define EEPROM_Default_ThermalMeter_8723B 0x18 -+#define EEPROM_Default_CrystalCap_8723B 0x20 -+ -+#define EEPROM_ChannelPlan_8723B 0xB8 -+#define EEPROM_XTAL_8723B 0xB9 -+#define EEPROM_THERMAL_METER_8723B 0xBA -+ -+#define EEPROM_RF_BOARD_OPTION_8723B 0xC1 -+#define EEPROM_RF_BT_SETTING_8723B 0xC3 -+#define EEPROM_VERSION_8723B 0xC4 -+#define EEPROM_CustomID_8723B 0xC5 -+#define EEPROM_DEFAULT_DIFF 0XFE -+ -+/* RTL8723BS */ -+#define EEPROM_MAC_ADDR_8723BS 0x11A -+#define EEPROM_Voltage_ADDR_8723B 0x8 -+#define RTL_EEPROM_ID 0x8129 -+ -+struct TxPowerInfo24G { -+ u8 IndexCCK_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G]; -+ u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G]; -+ /* If only one tx, only BW20 and OFDM are used. */ -+ s8 CCK_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+}; -+ -+enum { -+ Ant_x2 = 0, -+ Ant_x1 = 1 -+}; -+ -+enum { -+ BT_RTL8723B = 8, -+}; -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/hal_phy.h linux/3rdparty/rtl8723bs/include/hal_phy.h ---- linux.old/3rdparty/rtl8723bs/include/hal_phy.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/hal_phy.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,183 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_PHY_H__ -+#define __HAL_PHY_H__ -+ -+ -+#if DISABLE_BB_RF -+#define HAL_FW_ENABLE 0 -+#define HAL_MAC_ENABLE 0 -+#define HAL_BB_ENABLE 0 -+#define HAL_RF_ENABLE 0 -+#else /* FPGA_PHY and ASIC */ -+#define HAL_FW_ENABLE 1 -+#define HAL_MAC_ENABLE 1 -+#define HAL_BB_ENABLE 1 -+#define HAL_RF_ENABLE 1 -+#endif -+ -+#define RF6052_MAX_TX_PWR 0x3F -+#define RF6052_MAX_REG_88E 0xFF -+#define RF6052_MAX_REG_92C 0x7F -+ -+#define RF6052_MAX_REG \ -+ (RF6052_MAX_REG_88E > RF6052_MAX_REG_92C) ? RF6052_MAX_REG_88E: RF6052_MAX_REG_92C -+ -+#define GET_RF6052_REAL_MAX_REG(_Adapter) RF6052_MAX_REG_92C -+ -+#define RF6052_MAX_PATH 2 -+ -+/* */ -+/* Antenna detection method, i.e., using single tone detection or RSSI reported from each antenna detected. */ -+/* Added by Roger, 2013.05.22. */ -+/* */ -+#define ANT_DETECT_BY_SINGLE_TONE BIT0 -+#define ANT_DETECT_BY_RSSI BIT1 -+#define IS_ANT_DETECT_SUPPORT_SINGLE_TONE(__Adapter) ((GET_HAL_DATA(__Adapter)->AntDetection) & ANT_DETECT_BY_SINGLE_TONE) -+#define IS_ANT_DETECT_SUPPORT_RSSI(__Adapter) ((GET_HAL_DATA(__Adapter)->AntDetection) & ANT_DETECT_BY_RSSI) -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+enum BAND_TYPE { -+ BAND_ON_2_4G = 0, -+ BAND_ON_5G, -+ BAND_ON_BOTH, -+ BANDMAX -+}; -+ -+enum RF_TYPE { -+ RF_TYPE_MIN = 0, /* 0 */ -+ RF_8225 = 1, /* 1 11b/g RF for verification only */ -+ RF_8256 = 2, /* 2 11b/g/n */ -+ RF_8258 = 3, /* 3 11a/b/g/n RF */ -+ RF_6052 = 4, /* 4 11b/g/n RF */ -+ RF_PSEUDO_11N = 5, /* 5, It is a temporality RF. */ -+ RF_TYPE_MAX -+}; -+ -+enum RF_PATH { -+ RF_PATH_A = 0, -+ RF_PATH_B, -+ RF_PATH_C, -+ RF_PATH_D -+}; -+ -+#define TX_1S 0 -+#define TX_2S 1 -+#define TX_3S 2 -+#define TX_4S 3 -+ -+#define RF_PATH_MAX_92C_88E 2 -+#define RF_PATH_MAX_90_8812 4 /* Max RF number 90 support */ -+ -+enum ANTENNA_PATH { -+ ANTENNA_NONE = 0, -+ ANTENNA_D = 1, -+ ANTENNA_C = 2, -+ ANTENNA_CD = 3, -+ ANTENNA_B = 4, -+ ANTENNA_BD = 5, -+ ANTENNA_BC = 6, -+ ANTENNA_BCD = 7, -+ ANTENNA_A = 8, -+ ANTENNA_AD = 9, -+ ANTENNA_AC = 10, -+ ANTENNA_ACD = 11, -+ ANTENNA_AB = 12, -+ ANTENNA_ABD = 13, -+ ANTENNA_ABC = 14, -+ ANTENNA_ABCD = 15 -+}; -+ -+enum RF_CONTENT { -+ radioa_txt = 0x1000, -+ radiob_txt = 0x1001, -+ radioc_txt = 0x1002, -+ radiod_txt = 0x1003 -+}; -+ -+enum BaseBand_Config_Type { -+ BaseBand_Config_PHY_REG = 0, /* Radio Path A */ -+ BaseBand_Config_AGC_TAB = 1, /* Radio Path B */ -+ BaseBand_Config_AGC_TAB_2G = 2, -+ BaseBand_Config_AGC_TAB_5G = 3, -+ BaseBand_Config_PHY_REG_PG -+}; -+ -+enum HW_BLOCK { -+ HW_BLOCK_MAC = 0, -+ HW_BLOCK_PHY0 = 1, -+ HW_BLOCK_PHY1 = 2, -+ HW_BLOCK_RF = 3, -+ HW_BLOCK_MAXIMUM = 4, /* Never use this */ -+}; -+ -+enum WIRELESS_MODE { -+ WIRELESS_MODE_UNKNOWN = 0x00, -+ WIRELESS_MODE_A = 0x01, -+ WIRELESS_MODE_B = 0x02, -+ WIRELESS_MODE_G = 0x04, -+ WIRELESS_MODE_AUTO = 0x08, -+ WIRELESS_MODE_N_24G = 0x10, -+ WIRELESS_MODE_N_5G = 0x20, -+ WIRELESS_MODE_AC_5G = 0x40, -+ WIRELESS_MODE_AC_24G = 0x80, -+ WIRELESS_MODE_AC_ONLY = 0x100, -+}; -+ -+enum SwChnlCmdID { -+ CmdID_End, -+ CmdID_SetTxPowerLevel, -+ CmdID_BBRegWrite10, -+ CmdID_WritePortUlong, -+ CmdID_WritePortUshort, -+ CmdID_WritePortUchar, -+ CmdID_RF_WriteReg, -+}; -+ -+struct SwChnlCmd { -+ enum SwChnlCmdID CmdID; -+ u32 Para1; -+ u32 Para2; -+ u32 msDelay; -+}; -+ -+struct R_ANTENNA_SELECT_OFDM { -+#ifdef __LITTLE_ENDIAN -+ u32 r_tx_antenna:4; -+ u32 r_ant_l:4; -+ u32 r_ant_non_ht:4; -+ u32 r_ant_ht1:4; -+ u32 r_ant_ht2:4; -+ u32 r_ant_ht_s1:4; -+ u32 r_ant_non_ht_s1:4; -+ u32 OFDM_TXSC:2; -+ u32 Reserved:2; -+#else -+ u32 Reserved:2; -+ u32 OFDM_TXSC:2; -+ u32 r_ant_non_ht_s1:4; -+ u32 r_ant_ht_s1:4; -+ u32 r_ant_ht2:4; -+ u32 r_ant_ht1:4; -+ u32 r_ant_non_ht:4; -+ u32 r_ant_l:4; -+ u32 r_tx_antenna:4; -+#endif -+}; -+ -+/*--------------------------Exported Function prototype---------------------*/ -+ -+#endif /* __HAL_COMMON_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/hal_phy_reg.h linux/3rdparty/rtl8723bs/include/hal_phy_reg.h ---- linux.old/3rdparty/rtl8723bs/include/hal_phy_reg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/hal_phy_reg.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,25 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_PHY_REG_H__ -+#define __HAL_PHY_REG_H__ -+ -+/* for PutRFRegsetting & GetRFRegSetting BitMask */ -+/* if (RTL92SE_FPGA_VERIFY == 1) */ -+/* define bRFRegOffsetMask 0xfff */ -+/* else */ -+#define bRFRegOffsetMask 0xfffff -+/* endif */ -+ -+#endif /* __HAL_PHY_REG_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/HalPwrSeqCmd.h linux/3rdparty/rtl8723bs/include/HalPwrSeqCmd.h ---- linux.old/3rdparty/rtl8723bs/include/HalPwrSeqCmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/HalPwrSeqCmd.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,132 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HALPWRSEQCMD_H__ -+#define __HALPWRSEQCMD_H__ -+ -+#include -+ -+/*---------------------------------------------*/ -+/* 3 The value of cmd: 4 bits */ -+/*---------------------------------------------*/ -+#define PWR_CMD_READ 0x00 -+ /* offset: the read register offset */ -+ /* msk: the mask of the read value */ -+ /* value: N/A, left by 0 */ -+ /* note: dirver shall implement this function by read & msk */ -+ -+#define PWR_CMD_WRITE 0x01 -+ /* offset: the read register offset */ -+ /* msk: the mask of the write bits */ -+ /* value: write value */ -+ /* note: driver shall implement this cmd by read & msk after write */ -+ -+#define PWR_CMD_POLLING 0x02 -+ /* offset: the read register offset */ -+ /* msk: the mask of the polled value */ -+ /* value: the value to be polled, masked by the msd field. */ -+ /* note: driver shall implement this cmd by */ -+ /* do{ */ -+ /* if ((Read(offset) & msk) == (value & msk)) */ -+ /* break; */ -+ /* } while (not timeout); */ -+ -+#define PWR_CMD_DELAY 0x03 -+ /* offset: the value to delay */ -+ /* msk: N/A */ -+ /* value: the unit of delay, 0: us, 1: ms */ -+ -+#define PWR_CMD_END 0x04 -+ /* offset: N/A */ -+ /* msk: N/A */ -+ /* value: N/A */ -+ -+/*---------------------------------------------*/ -+/* 3 The value of base: 4 bits */ -+/*---------------------------------------------*/ -+ /* define the base address of each block */ -+#define PWR_BASEADDR_MAC 0x00 -+#define PWR_BASEADDR_USB 0x01 -+#define PWR_BASEADDR_PCIE 0x02 -+#define PWR_BASEADDR_SDIO 0x03 -+ -+/*---------------------------------------------*/ -+/* 3 The value of interface_msk: 4 bits */ -+/*---------------------------------------------*/ -+#define PWR_INTF_SDIO_MSK BIT(0) -+#define PWR_INTF_USB_MSK BIT(1) -+#define PWR_INTF_PCI_MSK BIT(2) -+#define PWR_INTF_ALL_MSK (BIT(0)|BIT(1)|BIT(2)|BIT(3)) -+ -+/*---------------------------------------------*/ -+/* 3 The value of fab_msk: 4 bits */ -+/*---------------------------------------------*/ -+#define PWR_FAB_TSMC_MSK BIT(0) -+#define PWR_FAB_UMC_MSK BIT(1) -+#define PWR_FAB_ALL_MSK (BIT(0)|BIT(1)|BIT(2)|BIT(3)) -+ -+/*---------------------------------------------*/ -+/* 3 The value of cut_msk: 8 bits */ -+/*---------------------------------------------*/ -+#define PWR_CUT_TESTCHIP_MSK BIT(0) -+#define PWR_CUT_A_MSK BIT(1) -+#define PWR_CUT_B_MSK BIT(2) -+#define PWR_CUT_C_MSK BIT(3) -+#define PWR_CUT_D_MSK BIT(4) -+#define PWR_CUT_E_MSK BIT(5) -+#define PWR_CUT_F_MSK BIT(6) -+#define PWR_CUT_G_MSK BIT(7) -+#define PWR_CUT_ALL_MSK 0xFF -+ -+ -+typedef enum _PWRSEQ_CMD_DELAY_UNIT_ -+{ -+ PWRSEQ_DELAY_US, -+ PWRSEQ_DELAY_MS, -+} PWRSEQ_DELAY_UNIT; -+ -+typedef struct _WL_PWR_CFG_ -+{ -+ u16 offset; -+ u8 cut_msk; -+ u8 fab_msk:4; -+ u8 interface_msk:4; -+ u8 base:4; -+ u8 cmd:4; -+ u8 msk; -+ u8 value; -+} WLAN_PWR_CFG, *PWLAN_PWR_CFG; -+ -+ -+#define GET_PWR_CFG_OFFSET(__PWR_CMD) __PWR_CMD.offset -+#define GET_PWR_CFG_CUT_MASK(__PWR_CMD) __PWR_CMD.cut_msk -+#define GET_PWR_CFG_FAB_MASK(__PWR_CMD) __PWR_CMD.fab_msk -+#define GET_PWR_CFG_INTF_MASK(__PWR_CMD) __PWR_CMD.interface_msk -+#define GET_PWR_CFG_BASE(__PWR_CMD) __PWR_CMD.base -+#define GET_PWR_CFG_CMD(__PWR_CMD) __PWR_CMD.cmd -+#define GET_PWR_CFG_MASK(__PWR_CMD) __PWR_CMD.msk -+#define GET_PWR_CFG_VALUE(__PWR_CMD) __PWR_CMD.value -+ -+ -+/* */ -+/* Prototype of protected function. */ -+/* */ -+u8 HalPwrSeqCmdParsing( -+ struct adapter * padapter, -+ u8 CutVersion, -+ u8 FabVersion, -+ u8 InterfaceType, -+ WLAN_PWR_CFG PwrCfgCmd[]); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/hal_sdio.h linux/3rdparty/rtl8723bs/include/hal_sdio.h ---- linux.old/3rdparty/rtl8723bs/include/hal_sdio.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/hal_sdio.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_SDIO_H_ -+#define __HAL_SDIO_H_ -+ -+#define ffaddr2deviceId(pdvobj, addr) (pdvobj->Queue2Pipe[addr]) -+ -+u8 rtw_hal_sdio_max_txoqt_free_space(struct adapter *padapter); -+u8 rtw_hal_sdio_query_tx_freepage(struct adapter *padapter, u8 PageIdx, u8 RequiredPageNum); -+void rtw_hal_sdio_update_tx_freepage(struct adapter *padapter, u8 PageIdx, u8 RequiredPageNum); -+void rtw_hal_set_sdio_tx_max_length(struct adapter *padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ); -+u32 rtw_hal_get_sdio_tx_max_length(struct adapter *padapter, u8 queue_idx); -+ -+#endif /* __RTW_LED_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/HalVerDef.h linux/3rdparty/rtl8723bs/include/HalVerDef.h ---- linux.old/3rdparty/rtl8723bs/include/HalVerDef.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/HalVerDef.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,127 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_VERSION_DEF_H__ -+#define __HAL_VERSION_DEF_H__ -+ -+/* HAL_IC_TYPE_E */ -+typedef enum tag_HAL_IC_Type_Definition -+{ -+ CHIP_8192S = 0, -+ CHIP_8188C = 1, -+ CHIP_8192C = 2, -+ CHIP_8192D = 3, -+ CHIP_8723A = 4, -+ CHIP_8188E = 5, -+ CHIP_8812 = 6, -+ CHIP_8821 = 7, -+ CHIP_8723B = 8, -+ CHIP_8192E = 9, -+}HAL_IC_TYPE_E; -+ -+/* HAL_CHIP_TYPE_E */ -+typedef enum tag_HAL_CHIP_Type_Definition -+{ -+ TEST_CHIP = 0, -+ NORMAL_CHIP = 1, -+ FPGA = 2, -+}HAL_CHIP_TYPE_E; -+ -+/* HAL_CUT_VERSION_E */ -+typedef enum tag_HAL_Cut_Version_Definition -+{ -+ A_CUT_VERSION = 0, -+ B_CUT_VERSION = 1, -+ C_CUT_VERSION = 2, -+ D_CUT_VERSION = 3, -+ E_CUT_VERSION = 4, -+ F_CUT_VERSION = 5, -+ G_CUT_VERSION = 6, -+ H_CUT_VERSION = 7, -+ I_CUT_VERSION = 8, -+ J_CUT_VERSION = 9, -+ K_CUT_VERSION = 10, -+}HAL_CUT_VERSION_E; -+ -+/* HAL_Manufacturer */ -+typedef enum tag_HAL_Manufacturer_Version_Definition -+{ -+ CHIP_VENDOR_TSMC = 0, -+ CHIP_VENDOR_UMC = 1, -+ CHIP_VENDOR_SMIC = 2, -+}HAL_VENDOR_E; -+ -+typedef enum tag_HAL_RF_Type_Definition -+{ -+ RF_TYPE_1T1R = 0, -+ RF_TYPE_1T2R = 1, -+ RF_TYPE_2T2R = 2, -+ RF_TYPE_2T3R = 3, -+ RF_TYPE_2T4R = 4, -+ RF_TYPE_3T3R = 5, -+ RF_TYPE_3T4R = 6, -+ RF_TYPE_4T4R = 7, -+}HAL_RF_TYPE_E; -+ -+typedef struct tag_HAL_VERSION -+{ -+ HAL_IC_TYPE_E ICType; -+ HAL_CHIP_TYPE_E ChipType; -+ HAL_CUT_VERSION_E CUTVersion; -+ HAL_VENDOR_E VendorType; -+ HAL_RF_TYPE_E RFType; -+ u8 ROMVer; -+}HAL_VERSION,*PHAL_VERSION; -+ -+/* VERSION_8192C VersionID; */ -+/* HAL_VERSION VersionID; */ -+ -+/* Get element */ -+#define GET_CVID_IC_TYPE(version) ((HAL_IC_TYPE_E)((version).ICType) ) -+#define GET_CVID_CHIP_TYPE(version) ((HAL_CHIP_TYPE_E)((version).ChipType) ) -+#define GET_CVID_RF_TYPE(version) ((HAL_RF_TYPE_E)((version).RFType)) -+#define GET_CVID_MANUFACTUER(version) ((HAL_VENDOR_E)((version).VendorType)) -+#define GET_CVID_CUT_VERSION(version) ((HAL_CUT_VERSION_E)((version).CUTVersion)) -+#define GET_CVID_ROM_VERSION(version) (((version).ROMVer) & ROM_VERSION_MASK) -+ -+/* */ -+/* Common Macro. -- */ -+/* */ -+/* HAL_VERSION VersionID */ -+ -+/* HAL_CHIP_TYPE_E */ -+#define IS_TEST_CHIP(version) ((GET_CVID_CHIP_TYPE(version) ==TEST_CHIP)? true: false) -+#define IS_NORMAL_CHIP(version) ((GET_CVID_CHIP_TYPE(version) ==NORMAL_CHIP)? true: false) -+ -+/* HAL_CUT_VERSION_E */ -+#define IS_A_CUT(version) ((GET_CVID_CUT_VERSION(version) == A_CUT_VERSION) ? true : false) -+#define IS_B_CUT(version) ((GET_CVID_CUT_VERSION(version) == B_CUT_VERSION) ? true : false) -+#define IS_C_CUT(version) ((GET_CVID_CUT_VERSION(version) == C_CUT_VERSION) ? true : false) -+#define IS_D_CUT(version) ((GET_CVID_CUT_VERSION(version) == D_CUT_VERSION) ? true : false) -+#define IS_E_CUT(version) ((GET_CVID_CUT_VERSION(version) == E_CUT_VERSION) ? true : false) -+#define IS_I_CUT(version) ((GET_CVID_CUT_VERSION(version) == I_CUT_VERSION) ? true : false) -+#define IS_J_CUT(version) ((GET_CVID_CUT_VERSION(version) == J_CUT_VERSION) ? true : false) -+#define IS_K_CUT(version) ((GET_CVID_CUT_VERSION(version) == K_CUT_VERSION) ? true : false) -+ -+/* HAL_VENDOR_E */ -+#define IS_CHIP_VENDOR_TSMC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_TSMC)? true: false) -+#define IS_CHIP_VENDOR_UMC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_UMC)? true: false) -+#define IS_CHIP_VENDOR_SMIC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_SMIC)? true: false) -+ -+/* HAL_RF_TYPE_E */ -+#define IS_1T1R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_1T1R)? true : false) -+#define IS_1T2R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_1T2R)? true : false) -+#define IS_2T2R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_2T2R)? true : false) -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/ieee80211.h linux/3rdparty/rtl8723bs/include/ieee80211.h ---- linux.old/3rdparty/rtl8723bs/include/ieee80211.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/ieee80211.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1345 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __IEEE80211_H -+#define __IEEE80211_H -+ -+#include -+ -+#define MGMT_QUEUE_NUM 5 -+ -+#define ETH_ALEN 6 -+#define ETH_TYPE_LEN 2 -+#define PAYLOAD_TYPE_LEN 1 -+ -+#define RTL_IOCTL_HOSTAPD (SIOCIWFIRSTPRIV + 28) -+ -+/* RTL871X_IOCTL_HOSTAPD ioctl() cmd: */ -+enum { -+ RTL871X_HOSTAPD_FLUSH = 1, -+ RTL871X_HOSTAPD_ADD_STA = 2, -+ RTL871X_HOSTAPD_REMOVE_STA = 3, -+ RTL871X_HOSTAPD_GET_INFO_STA = 4, -+ /* REMOVED: PRISM2_HOSTAPD_RESET_TXEXC_STA = 5, */ -+ RTL871X_HOSTAPD_GET_WPAIE_STA = 5, -+ RTL871X_SET_ENCRYPTION = 6, -+ RTL871X_GET_ENCRYPTION = 7, -+ RTL871X_HOSTAPD_SET_FLAGS_STA = 8, -+ RTL871X_HOSTAPD_GET_RID = 9, -+ RTL871X_HOSTAPD_SET_RID = 10, -+ RTL871X_HOSTAPD_SET_ASSOC_AP_ADDR = 11, -+ RTL871X_HOSTAPD_SET_GENERIC_ELEMENT = 12, -+ RTL871X_HOSTAPD_MLME = 13, -+ RTL871X_HOSTAPD_SCAN_REQ = 14, -+ RTL871X_HOSTAPD_STA_CLEAR_STATS = 15, -+ RTL871X_HOSTAPD_SET_BEACON = 16, -+ RTL871X_HOSTAPD_SET_WPS_BEACON = 17, -+ RTL871X_HOSTAPD_SET_WPS_PROBE_RESP = 18, -+ RTL871X_HOSTAPD_SET_WPS_ASSOC_RESP = 19, -+ RTL871X_HOSTAPD_SET_HIDDEN_SSID = 20, -+ RTL871X_HOSTAPD_SET_MACADDR_ACL = 21, -+ RTL871X_HOSTAPD_ACL_ADD_STA = 22, -+ RTL871X_HOSTAPD_ACL_REMOVE_STA = 23, -+}; -+ -+/* STA flags */ -+#define WLAN_STA_AUTH BIT(0) -+#define WLAN_STA_ASSOC BIT(1) -+#define WLAN_STA_PS BIT(2) -+#define WLAN_STA_TIM BIT(3) -+#define WLAN_STA_PERM BIT(4) -+#define WLAN_STA_AUTHORIZED BIT(5) -+#define WLAN_STA_PENDING_POLL BIT(6) /* pending activity poll not ACKed */ -+#define WLAN_STA_SHORT_PREAMBLE BIT(7) -+#define WLAN_STA_PREAUTH BIT(8) -+#define WLAN_STA_WME BIT(9) -+#define WLAN_STA_MFP BIT(10) -+#define WLAN_STA_HT BIT(11) -+#define WLAN_STA_WPS BIT(12) -+#define WLAN_STA_MAYBE_WPS BIT(13) -+#define WLAN_STA_VHT BIT(14) -+#define WLAN_STA_NONERP BIT(31) -+ -+#define IEEE_CMD_SET_WPA_PARAM 1 -+#define IEEE_CMD_SET_WPA_IE 2 -+#define IEEE_CMD_SET_ENCRYPTION 3 -+#define IEEE_CMD_MLME 4 -+ -+#define IEEE_PARAM_WPA_ENABLED 1 -+#define IEEE_PARAM_TKIP_COUNTERMEASURES 2 -+#define IEEE_PARAM_DROP_UNENCRYPTED 3 -+#define IEEE_PARAM_PRIVACY_INVOKED 4 -+#define IEEE_PARAM_AUTH_ALGS 5 -+#define IEEE_PARAM_IEEE_802_1X 6 -+#define IEEE_PARAM_WPAX_SELECT 7 -+ -+#define AUTH_ALG_OPEN_SYSTEM 0x1 -+#define AUTH_ALG_SHARED_KEY 0x2 -+#define AUTH_ALG_LEAP 0x00000004 -+ -+#define IEEE_MLME_STA_DEAUTH 1 -+#define IEEE_MLME_STA_DISASSOC 2 -+ -+#define IEEE_CRYPT_ERR_UNKNOWN_ALG 2 -+#define IEEE_CRYPT_ERR_UNKNOWN_ADDR 3 -+#define IEEE_CRYPT_ERR_CRYPT_INIT_FAILED 4 -+#define IEEE_CRYPT_ERR_KEY_SET_FAILED 5 -+#define IEEE_CRYPT_ERR_TX_KEY_SET_FAILED 6 -+#define IEEE_CRYPT_ERR_CARD_CONF_FAILED 7 -+ -+ -+#define IEEE_CRYPT_ALG_NAME_LEN 16 -+ -+#define WPA_CIPHER_NONE BIT(0) -+#define WPA_CIPHER_WEP40 BIT(1) -+#define WPA_CIPHER_WEP104 BIT(2) -+#define WPA_CIPHER_TKIP BIT(3) -+#define WPA_CIPHER_CCMP BIT(4) -+ -+ -+ -+#define WPA_SELECTOR_LEN 4 -+extern u8 RTW_WPA_OUI_TYPE[] ; -+extern u16 RTW_WPA_VERSION ; -+extern u8 WPA_AUTH_KEY_MGMT_NONE[]; -+extern u8 WPA_AUTH_KEY_MGMT_UNSPEC_802_1X[]; -+extern u8 WPA_AUTH_KEY_MGMT_PSK_OVER_802_1X[]; -+extern u8 WPA_CIPHER_SUITE_NONE[]; -+extern u8 WPA_CIPHER_SUITE_WEP40[]; -+extern u8 WPA_CIPHER_SUITE_TKIP[]; -+extern u8 WPA_CIPHER_SUITE_WRAP[]; -+extern u8 WPA_CIPHER_SUITE_CCMP[]; -+extern u8 WPA_CIPHER_SUITE_WEP104[]; -+ -+ -+#define RSN_HEADER_LEN 4 -+#define RSN_SELECTOR_LEN 4 -+ -+extern u16 RSN_VERSION_BSD; -+extern u8 RSN_AUTH_KEY_MGMT_UNSPEC_802_1X[]; -+extern u8 RSN_AUTH_KEY_MGMT_PSK_OVER_802_1X[]; -+extern u8 RSN_CIPHER_SUITE_NONE[]; -+extern u8 RSN_CIPHER_SUITE_WEP40[]; -+extern u8 RSN_CIPHER_SUITE_TKIP[]; -+extern u8 RSN_CIPHER_SUITE_WRAP[]; -+extern u8 RSN_CIPHER_SUITE_CCMP[]; -+extern u8 RSN_CIPHER_SUITE_WEP104[]; -+ -+ -+typedef enum _RATEID_IDX_ { -+ RATEID_IDX_BGN_40M_2SS = 0, -+ RATEID_IDX_BGN_40M_1SS = 1, -+ RATEID_IDX_BGN_20M_2SS_BN = 2, -+ RATEID_IDX_BGN_20M_1SS_BN = 3, -+ RATEID_IDX_GN_N2SS = 4, -+ RATEID_IDX_GN_N1SS = 5, -+ RATEID_IDX_BG = 6, -+ RATEID_IDX_G = 7, -+ RATEID_IDX_B = 8, -+ RATEID_IDX_VHT_2SS = 9, -+ RATEID_IDX_VHT_1SS = 10, -+} RATEID_IDX, *PRATEID_IDX; -+ -+typedef enum _RATR_TABLE_MODE{ -+ RATR_INX_WIRELESS_NGB = 0, /* BGN 40 Mhz 2SS 1SS */ -+ RATR_INX_WIRELESS_NG = 1, /* GN or N */ -+ RATR_INX_WIRELESS_NB = 2, /* BGN 20 Mhz 2SS 1SS or BN */ -+ RATR_INX_WIRELESS_N = 3, -+ RATR_INX_WIRELESS_GB = 4, -+ RATR_INX_WIRELESS_G = 5, -+ RATR_INX_WIRELESS_B = 6, -+ RATR_INX_WIRELESS_MC = 7, -+ RATR_INX_WIRELESS_AC_N = 8, -+}RATR_TABLE_MODE, *PRATR_TABLE_MODE; -+ -+ -+enum NETWORK_TYPE -+{ -+ WIRELESS_INVALID = 0, -+ /* Sub-Element */ -+ WIRELESS_11B = BIT(0), /* tx: cck only , rx: cck only, hw: cck */ -+ WIRELESS_11G = BIT(1), /* tx: ofdm only, rx: ofdm & cck, hw: cck & ofdm */ -+ WIRELESS_11A = BIT(2), /* tx: ofdm only, rx: ofdm only, hw: ofdm only */ -+ WIRELESS_11_24N = BIT(3), /* tx: MCS only, rx: MCS & cck, hw: MCS & cck */ -+ WIRELESS_11_5N = BIT(4), /* tx: MCS only, rx: MCS & ofdm, hw: ofdm only */ -+ WIRELESS_AUTO = BIT(5), -+ WIRELESS_11AC = BIT(6), -+ -+ /* Combination */ -+ /* Type for current wireless mode */ -+ WIRELESS_11BG = (WIRELESS_11B|WIRELESS_11G), /* tx: cck & ofdm, rx: cck & ofdm & MCS, hw: cck & ofdm */ -+ WIRELESS_11G_24N = (WIRELESS_11G|WIRELESS_11_24N), /* tx: ofdm & MCS, rx: ofdm & cck & MCS, hw: cck & ofdm */ -+ WIRELESS_11A_5N = (WIRELESS_11A|WIRELESS_11_5N), /* tx: ofdm & MCS, rx: ofdm & MCS, hw: ofdm only */ -+ WIRELESS_11B_24N = (WIRELESS_11B|WIRELESS_11_24N), /* tx: ofdm & cck & MCS, rx: ofdm & cck & MCS, hw: ofdm & cck */ -+ WIRELESS_11BG_24N = (WIRELESS_11B|WIRELESS_11G|WIRELESS_11_24N), /* tx: ofdm & cck & MCS, rx: ofdm & cck & MCS, hw: ofdm & cck */ -+ WIRELESS_11_24AC = (WIRELESS_11G|WIRELESS_11AC), -+ WIRELESS_11_5AC = (WIRELESS_11A|WIRELESS_11AC), -+ -+ -+ /* Type for registry default wireless mode */ -+ WIRELESS_11AGN = (WIRELESS_11A|WIRELESS_11G|WIRELESS_11_24N|WIRELESS_11_5N), /* tx: ofdm & MCS, rx: ofdm & MCS, hw: ofdm only */ -+ WIRELESS_11ABGN = (WIRELESS_11A|WIRELESS_11B|WIRELESS_11G|WIRELESS_11_24N|WIRELESS_11_5N), -+ WIRELESS_MODE_24G = (WIRELESS_11B|WIRELESS_11G|WIRELESS_11_24N|WIRELESS_11AC), -+ WIRELESS_MODE_MAX = (WIRELESS_11A|WIRELESS_11B|WIRELESS_11G|WIRELESS_11_24N|WIRELESS_11_5N|WIRELESS_11AC), -+}; -+ -+#define SUPPORTED_24G_NETTYPE_MSK (WIRELESS_11B | WIRELESS_11G | WIRELESS_11_24N) -+ -+#define IsLegacyOnly(NetType) ((NetType) == ((NetType) & (WIRELESS_11BG|WIRELESS_11A))) -+ -+#define IsSupported24G(NetType) ((NetType) & SUPPORTED_24G_NETTYPE_MSK ? true : false) -+ -+#define IsEnableHWCCK(NetType) IsSupported24G(NetType) -+#define IsEnableHWOFDM(NetType) (((NetType) & (WIRELESS_11G|WIRELESS_11_24N)) ? true : false) -+ -+#define IsSupportedRxCCK(NetType) IsEnableHWCCK(NetType) -+#define IsSupportedRxOFDM(NetType) IsEnableHWOFDM(NetType) -+#define IsSupportedRxHT(NetType) IsEnableHWOFDM(NetType) -+ -+#define IsSupportedTxCCK(NetType) (((NetType) & (WIRELESS_11B)) ? true : false) -+#define IsSupportedTxOFDM(NetType) (((NetType) & (WIRELESS_11G|WIRELESS_11A)) ? true : false) -+#define IsSupportedHT(NetType) (((NetType) & (WIRELESS_11_24N|WIRELESS_11_5N)) ? true : false) -+ -+#define IsSupportedVHT(NetType) (((NetType) & (WIRELESS_11AC)) ? true : false) -+ -+ -+typedef struct ieee_param { -+ u32 cmd; -+ u8 sta_addr[ETH_ALEN]; -+ union { -+ struct { -+ u8 name; -+ u32 value; -+ } wpa_param; -+ struct { -+ u32 len; -+ u8 reserved[32]; -+ u8 data[0]; -+ } wpa_ie; -+ struct{ -+ int command; -+ int reason_code; -+ } mlme; -+ struct { -+ u8 alg[IEEE_CRYPT_ALG_NAME_LEN]; -+ u8 set_tx; -+ u32 err; -+ u8 idx; -+ u8 seq[8]; /* sequence counter (set: RX, get: TX) */ -+ u16 key_len; -+ u8 key[0]; -+ } crypt; -+ struct { -+ u16 aid; -+ u16 capability; -+ int flags; -+ u8 tx_supp_rates[16]; -+ struct rtw_ieee80211_ht_cap ht_cap; -+ } add_sta; -+ struct { -+ u8 reserved[2];/* for set max_num_sta */ -+ u8 buf[0]; -+ } bcn_ie; -+ } u; -+}ieee_param; -+ -+typedef struct ieee_param_ex { -+ u32 cmd; -+ u8 sta_addr[ETH_ALEN]; -+ u8 data[0]; -+}ieee_param_ex; -+ -+struct sta_data{ -+ u16 aid; -+ u16 capability; -+ int flags; -+ u32 sta_set; -+ u8 tx_supp_rates[16]; -+ u32 tx_supp_rates_len; -+ struct rtw_ieee80211_ht_cap ht_cap; -+ u64 rx_pkts; -+ u64 rx_bytes; -+ u64 rx_drops; -+ u64 tx_pkts; -+ u64 tx_bytes; -+ u64 tx_drops; -+}; -+ -+#define IEEE80211_DATA_LEN 2304 -+/* Maximum size for the MA-UNITDATA primitive, 802.11 standard section -+ 6.2.1.1.2. -+ -+ The figure in section 7.1.2 suggests a body size of up to 2312 -+ bytes is allowed, which is a bit confusing, I suspect this -+ represents the 2304 bytes of real data, plus a possible 8 bytes of -+ WEP IV and ICV. (this interpretation suggested by Ramiro Barreiro) */ -+ -+ -+#define IEEE80211_HLEN 30 -+#define IEEE80211_FRAME_LEN (IEEE80211_DATA_LEN + IEEE80211_HLEN) -+ -+ -+/* this is stolen from ipw2200 driver */ -+#define IEEE_IBSS_MAC_HASH_SIZE 31 -+ -+struct ieee_ibss_seq { -+ u8 mac[ETH_ALEN]; -+ u16 seq_num; -+ u16 frag_num; -+ unsigned long packet_time; -+ struct list_head list; -+}; -+ -+struct eapol { -+ u8 snap[6]; -+ u16 ethertype; -+ u8 version; -+ u8 type; -+ u16 length; -+} __attribute__ ((packed)); -+ -+enum eap_type { -+ EAP_PACKET = 0, -+ EAPOL_START, -+ EAPOL_LOGOFF, -+ EAPOL_KEY, -+ EAPOL_ENCAP_ASF_ALERT -+}; -+ -+#define IEEE80211_3ADDR_LEN 24 -+#define IEEE80211_4ADDR_LEN 30 -+#define IEEE80211_FCS_LEN 4 -+ -+#define MIN_FRAG_THRESHOLD 256U -+#define MAX_FRAG_THRESHOLD 2346U -+ -+/* Frame control field constants */ -+#define RTW_IEEE80211_FCTL_VERS 0x0003 -+#define RTW_IEEE80211_FCTL_FTYPE 0x000c -+#define RTW_IEEE80211_FCTL_STYPE 0x00f0 -+#define RTW_IEEE80211_FCTL_TODS 0x0100 -+#define RTW_IEEE80211_FCTL_FROMDS 0x0200 -+#define RTW_IEEE80211_FCTL_MOREFRAGS 0x0400 -+#define RTW_IEEE80211_FCTL_RETRY 0x0800 -+#define RTW_IEEE80211_FCTL_PM 0x1000 -+#define RTW_IEEE80211_FCTL_MOREDATA 0x2000 -+#define RTW_IEEE80211_FCTL_PROTECTED 0x4000 -+#define RTW_IEEE80211_FCTL_ORDER 0x8000 -+#define RTW_IEEE80211_FCTL_CTL_EXT 0x0f00 -+ -+#define RTW_IEEE80211_FTYPE_MGMT 0x0000 -+#define RTW_IEEE80211_FTYPE_CTL 0x0004 -+#define RTW_IEEE80211_FTYPE_DATA 0x0008 -+#define RTW_IEEE80211_FTYPE_EXT 0x000c -+ -+/* management */ -+#define RTW_IEEE80211_STYPE_ASSOC_REQ 0x0000 -+#define RTW_IEEE80211_STYPE_ASSOC_RESP 0x0010 -+#define RTW_IEEE80211_STYPE_REASSOC_REQ 0x0020 -+#define RTW_IEEE80211_STYPE_REASSOC_RESP 0x0030 -+#define RTW_IEEE80211_STYPE_PROBE_REQ 0x0040 -+#define RTW_IEEE80211_STYPE_PROBE_RESP 0x0050 -+#define RTW_IEEE80211_STYPE_BEACON 0x0080 -+#define RTW_IEEE80211_STYPE_ATIM 0x0090 -+#define RTW_IEEE80211_STYPE_DISASSOC 0x00A0 -+#define RTW_IEEE80211_STYPE_AUTH 0x00B0 -+#define RTW_IEEE80211_STYPE_DEAUTH 0x00C0 -+#define RTW_IEEE80211_STYPE_ACTION 0x00D0 -+ -+/* control */ -+#define RTW_IEEE80211_STYPE_CTL_EXT 0x0060 -+#define RTW_IEEE80211_STYPE_BACK_REQ 0x0080 -+#define RTW_IEEE80211_STYPE_BACK 0x0090 -+#define RTW_IEEE80211_STYPE_PSPOLL 0x00A0 -+#define RTW_IEEE80211_STYPE_RTS 0x00B0 -+#define RTW_IEEE80211_STYPE_CTS 0x00C0 -+#define RTW_IEEE80211_STYPE_ACK 0x00D0 -+#define RTW_IEEE80211_STYPE_CFEND 0x00E0 -+#define RTW_IEEE80211_STYPE_CFENDACK 0x00F0 -+ -+/* data */ -+#define RTW_IEEE80211_STYPE_DATA 0x0000 -+#define RTW_IEEE80211_STYPE_DATA_CFACK 0x0010 -+#define RTW_IEEE80211_STYPE_DATA_CFPOLL 0x0020 -+#define RTW_IEEE80211_STYPE_DATA_CFACKPOLL 0x0030 -+#define RTW_IEEE80211_STYPE_NULLFUNC 0x0040 -+#define RTW_IEEE80211_STYPE_CFACK 0x0050 -+#define RTW_IEEE80211_STYPE_CFPOLL 0x0060 -+#define RTW_IEEE80211_STYPE_CFACKPOLL 0x0070 -+#define RTW_IEEE80211_STYPE_QOS_DATA 0x0080 -+#define RTW_IEEE80211_STYPE_QOS_DATA_CFACK 0x0090 -+#define RTW_IEEE80211_STYPE_QOS_DATA_CFPOLL 0x00A0 -+#define RTW_IEEE80211_STYPE_QOS_DATA_CFACKPOLL 0x00B0 -+#define RTW_IEEE80211_STYPE_QOS_NULLFUNC 0x00C0 -+#define RTW_IEEE80211_STYPE_QOS_CFACK 0x00D0 -+#define RTW_IEEE80211_STYPE_QOS_CFPOLL 0x00E0 -+#define RTW_IEEE80211_STYPE_QOS_CFACKPOLL 0x00F0 -+ -+/* sequence control field */ -+#define RTW_IEEE80211_SCTL_FRAG 0x000F -+#define RTW_IEEE80211_SCTL_SEQ 0xFFF0 -+ -+ -+#define RTW_ERP_INFO_NON_ERP_PRESENT BIT(0) -+#define RTW_ERP_INFO_USE_PROTECTION BIT(1) -+#define RTW_ERP_INFO_BARKER_PREAMBLE_MODE BIT(2) -+ -+/* QoS, QOS */ -+#define NORMAL_ACK 0 -+#define NO_ACK 1 -+#define NON_EXPLICIT_ACK 2 -+#define BLOCK_ACK 3 -+ -+#ifndef ETH_P_PAE -+#define ETH_P_PAE 0x888E /* Port Access Entity (IEEE 802.1X) */ -+#endif /* ETH_P_PAE */ -+ -+#define ETH_P_PREAUTH 0x88C7 /* IEEE 802.11i pre-authentication */ -+ -+#define ETH_P_ECONET 0x0018 -+ -+#ifndef ETH_P_80211_RAW -+#define ETH_P_80211_RAW (ETH_P_ECONET + 1) -+#endif -+ -+/* IEEE 802.11 defines */ -+ -+#define P80211_OUI_LEN 3 -+ -+struct ieee80211_snap_hdr { -+ u8 dsap; /* always 0xAA */ -+ u8 ssap; /* always 0xAA */ -+ u8 ctrl; /* always 0x03 */ -+ u8 oui[P80211_OUI_LEN]; /* organizational universal id */ -+} __attribute__ ((packed)); -+ -+#define SNAP_SIZE sizeof(struct ieee80211_snap_hdr) -+ -+#define WLAN_FC_GET_TYPE(fc) ((fc) & RTW_IEEE80211_FCTL_FTYPE) -+#define WLAN_FC_GET_STYPE(fc) ((fc) & RTW_IEEE80211_FCTL_STYPE) -+ -+#define WLAN_QC_GET_TID(qc) ((qc) & 0x0f) -+ -+#define WLAN_GET_SEQ_FRAG(seq) ((seq) & RTW_IEEE80211_SCTL_FRAG) -+#define WLAN_GET_SEQ_SEQ(seq) ((seq) & RTW_IEEE80211_SCTL_SEQ) -+ -+/* Authentication algorithms */ -+#define WLAN_AUTH_OPEN 0 -+#define WLAN_AUTH_SHARED_KEY 1 -+ -+#define WLAN_AUTH_CHALLENGE_LEN 128 -+ -+#define WLAN_CAPABILITY_BSS (1<<0) -+#define WLAN_CAPABILITY_IBSS (1<<1) -+#define WLAN_CAPABILITY_CF_POLLABLE (1<<2) -+#define WLAN_CAPABILITY_CF_POLL_REQUEST (1<<3) -+#define WLAN_CAPABILITY_PRIVACY (1<<4) -+#define WLAN_CAPABILITY_SHORT_PREAMBLE (1<<5) -+#define WLAN_CAPABILITY_PBCC (1<<6) -+#define WLAN_CAPABILITY_CHANNEL_AGILITY (1<<7) -+#define WLAN_CAPABILITY_SHORT_SLOT (1<<10) -+ -+/* Status codes */ -+#define WLAN_STATUS_SUCCESS 0 -+#define WLAN_STATUS_UNSPECIFIED_FAILURE 1 -+#define WLAN_STATUS_CAPS_UNSUPPORTED 10 -+#define WLAN_STATUS_REASSOC_NO_ASSOC 11 -+#define WLAN_STATUS_ASSOC_DENIED_UNSPEC 12 -+#define WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG 13 -+#define WLAN_STATUS_UNKNOWN_AUTH_TRANSACTION 14 -+#define WLAN_STATUS_CHALLENGE_FAIL 15 -+#define WLAN_STATUS_AUTH_TIMEOUT 16 -+#define WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA 17 -+#define WLAN_STATUS_ASSOC_DENIED_RATES 18 -+/* 802.11b */ -+#define WLAN_STATUS_ASSOC_DENIED_NOSHORT 19 -+#define WLAN_STATUS_ASSOC_DENIED_NOPBCC 20 -+#define WLAN_STATUS_ASSOC_DENIED_NOAGILITY 21 -+ -+/* Reason codes */ -+#define WLAN_REASON_UNSPECIFIED 1 -+#define WLAN_REASON_PREV_AUTH_NOT_VALID 2 -+#define WLAN_REASON_DEAUTH_LEAVING 3 -+#define WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY 4 -+#define WLAN_REASON_DISASSOC_AP_BUSY 5 -+#define WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA 6 -+#define WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA 7 -+#define WLAN_REASON_DISASSOC_STA_HAS_LEFT 8 -+#define WLAN_REASON_STA_REQ_ASSOC_WITHOUT_AUTH 9 -+#define WLAN_REASON_ACTIVE_ROAM 65533 -+#define WLAN_REASON_JOIN_WRONG_CHANNEL 65534 -+#define WLAN_REASON_EXPIRATION_CHK 65535 -+ -+/* Information Element IDs */ -+#define WLAN_EID_SSID 0 -+#define WLAN_EID_SUPP_RATES 1 -+#define WLAN_EID_FH_PARAMS 2 -+#define WLAN_EID_DS_PARAMS 3 -+#define WLAN_EID_CF_PARAMS 4 -+#define WLAN_EID_TIM 5 -+#define WLAN_EID_IBSS_PARAMS 6 -+#define WLAN_EID_CHALLENGE 16 -+/* EIDs defined by IEEE 802.11h - START */ -+#define WLAN_EID_PWR_CONSTRAINT 32 -+#define WLAN_EID_PWR_CAPABILITY 33 -+#define WLAN_EID_TPC_REQUEST 34 -+#define WLAN_EID_TPC_REPORT 35 -+#define WLAN_EID_SUPPORTED_CHANNELS 36 -+#define WLAN_EID_CHANNEL_SWITCH 37 -+#define WLAN_EID_MEASURE_REQUEST 38 -+#define WLAN_EID_MEASURE_REPORT 39 -+#define WLAN_EID_QUITE 40 -+#define WLAN_EID_IBSS_DFS 41 -+/* EIDs defined by IEEE 802.11h - END */ -+#define WLAN_EID_ERP_INFO 42 -+#define WLAN_EID_HT_CAP 45 -+#define WLAN_EID_RSN 48 -+#define WLAN_EID_EXT_SUPP_RATES 50 -+#define WLAN_EID_MOBILITY_DOMAIN 54 -+#define WLAN_EID_FAST_BSS_TRANSITION 55 -+#define WLAN_EID_TIMEOUT_INTERVAL 56 -+#define WLAN_EID_RIC_DATA 57 -+#define WLAN_EID_HT_OPERATION 61 -+#define WLAN_EID_SECONDARY_CHANNEL_OFFSET 62 -+#define WLAN_EID_20_40_BSS_COEXISTENCE 72 -+#define WLAN_EID_20_40_BSS_INTOLERANT 73 -+#define WLAN_EID_OVERLAPPING_BSS_SCAN_PARAMS 74 -+#define WLAN_EID_MMIE 76 -+#define WLAN_EID_VENDOR_SPECIFIC 221 -+#define WLAN_EID_GENERIC (WLAN_EID_VENDOR_SPECIFIC) -+#define WLAN_EID_VHT_CAPABILITY 191 -+#define WLAN_EID_VHT_OPERATION 192 -+#define WLAN_EID_VHT_OP_MODE_NOTIFY 199 -+ -+#define IEEE80211_MGMT_HDR_LEN 24 -+#define IEEE80211_DATA_HDR3_LEN 24 -+#define IEEE80211_DATA_HDR4_LEN 30 -+ -+ -+#define IEEE80211_STATMASK_SIGNAL (1<<0) -+#define IEEE80211_STATMASK_RSSI (1<<1) -+#define IEEE80211_STATMASK_NOISE (1<<2) -+#define IEEE80211_STATMASK_RATE (1<<3) -+#define IEEE80211_STATMASK_WEMASK 0x7 -+ -+ -+#define IEEE80211_CCK_MODULATION (1<<0) -+#define IEEE80211_OFDM_MODULATION (1<<1) -+ -+#define IEEE80211_24GHZ_BAND (1<<0) -+#define IEEE80211_52GHZ_BAND (1<<1) -+ -+#define IEEE80211_CCK_RATE_LEN 4 -+#define IEEE80211_NUM_OFDM_RATESLEN 8 -+ -+ -+#define IEEE80211_CCK_RATE_1MB 0x02 -+#define IEEE80211_CCK_RATE_2MB 0x04 -+#define IEEE80211_CCK_RATE_5MB 0x0B -+#define IEEE80211_CCK_RATE_11MB 0x16 -+#define IEEE80211_OFDM_RATE_LEN 8 -+#define IEEE80211_OFDM_RATE_6MB 0x0C -+#define IEEE80211_OFDM_RATE_9MB 0x12 -+#define IEEE80211_OFDM_RATE_12MB 0x18 -+#define IEEE80211_OFDM_RATE_18MB 0x24 -+#define IEEE80211_OFDM_RATE_24MB 0x30 -+#define IEEE80211_OFDM_RATE_36MB 0x48 -+#define IEEE80211_OFDM_RATE_48MB 0x60 -+#define IEEE80211_OFDM_RATE_54MB 0x6C -+#define IEEE80211_BASIC_RATE_MASK 0x80 -+ -+#define IEEE80211_CCK_RATE_1MB_MASK (1<<0) -+#define IEEE80211_CCK_RATE_2MB_MASK (1<<1) -+#define IEEE80211_CCK_RATE_5MB_MASK (1<<2) -+#define IEEE80211_CCK_RATE_11MB_MASK (1<<3) -+#define IEEE80211_OFDM_RATE_6MB_MASK (1<<4) -+#define IEEE80211_OFDM_RATE_9MB_MASK (1<<5) -+#define IEEE80211_OFDM_RATE_12MB_MASK (1<<6) -+#define IEEE80211_OFDM_RATE_18MB_MASK (1<<7) -+#define IEEE80211_OFDM_RATE_24MB_MASK (1<<8) -+#define IEEE80211_OFDM_RATE_36MB_MASK (1<<9) -+#define IEEE80211_OFDM_RATE_48MB_MASK (1<<10) -+#define IEEE80211_OFDM_RATE_54MB_MASK (1<<11) -+ -+#define IEEE80211_CCK_RATES_MASK 0x0000000F -+#define IEEE80211_CCK_BASIC_RATES_MASK (IEEE80211_CCK_RATE_1MB_MASK | \ -+ IEEE80211_CCK_RATE_2MB_MASK) -+#define IEEE80211_CCK_DEFAULT_RATES_MASK (IEEE80211_CCK_BASIC_RATES_MASK | \ -+ IEEE80211_CCK_RATE_5MB_MASK | \ -+ IEEE80211_CCK_RATE_11MB_MASK) -+ -+#define IEEE80211_OFDM_RATES_MASK 0x00000FF0 -+#define IEEE80211_OFDM_BASIC_RATES_MASK (IEEE80211_OFDM_RATE_6MB_MASK | \ -+ IEEE80211_OFDM_RATE_12MB_MASK | \ -+ IEEE80211_OFDM_RATE_24MB_MASK) -+#define IEEE80211_OFDM_DEFAULT_RATES_MASK (IEEE80211_OFDM_BASIC_RATES_MASK | \ -+ IEEE80211_OFDM_RATE_9MB_MASK | \ -+ IEEE80211_OFDM_RATE_18MB_MASK | \ -+ IEEE80211_OFDM_RATE_36MB_MASK | \ -+ IEEE80211_OFDM_RATE_48MB_MASK | \ -+ IEEE80211_OFDM_RATE_54MB_MASK) -+#define IEEE80211_DEFAULT_RATES_MASK (IEEE80211_OFDM_DEFAULT_RATES_MASK | \ -+ IEEE80211_CCK_DEFAULT_RATES_MASK) -+ -+#define IEEE80211_NUM_OFDM_RATES 8 -+#define IEEE80211_NUM_CCK_RATES 4 -+#define IEEE80211_OFDM_SHIFT_MASK_A 4 -+ -+ -+enum MGN_RATE{ -+ MGN_1M = 0x02, -+ MGN_2M = 0x04, -+ MGN_5_5M = 0x0B, -+ MGN_6M = 0x0C, -+ MGN_9M = 0x12, -+ MGN_11M = 0x16, -+ MGN_12M = 0x18, -+ MGN_18M = 0x24, -+ MGN_24M = 0x30, -+ MGN_36M = 0x48, -+ MGN_48M = 0x60, -+ MGN_54M = 0x6C, -+ MGN_MCS32 = 0x7F, -+ MGN_MCS0, -+ MGN_MCS1, -+ MGN_MCS2, -+ MGN_MCS3, -+ MGN_MCS4, -+ MGN_MCS5, -+ MGN_MCS6, -+ MGN_MCS7, -+ MGN_MCS8, -+ MGN_MCS9, -+ MGN_MCS10, -+ MGN_MCS11, -+ MGN_MCS12, -+ MGN_MCS13, -+ MGN_MCS14, -+ MGN_MCS15, -+ MGN_MCS16, -+ MGN_MCS17, -+ MGN_MCS18, -+ MGN_MCS19, -+ MGN_MCS20, -+ MGN_MCS21, -+ MGN_MCS22, -+ MGN_MCS23, -+ MGN_MCS24, -+ MGN_MCS25, -+ MGN_MCS26, -+ MGN_MCS27, -+ MGN_MCS28, -+ MGN_MCS29, -+ MGN_MCS30, -+ MGN_MCS31, -+ MGN_VHT1SS_MCS0, -+ MGN_VHT1SS_MCS1, -+ MGN_VHT1SS_MCS2, -+ MGN_VHT1SS_MCS3, -+ MGN_VHT1SS_MCS4, -+ MGN_VHT1SS_MCS5, -+ MGN_VHT1SS_MCS6, -+ MGN_VHT1SS_MCS7, -+ MGN_VHT1SS_MCS8, -+ MGN_VHT1SS_MCS9, -+ MGN_VHT2SS_MCS0, -+ MGN_VHT2SS_MCS1, -+ MGN_VHT2SS_MCS2, -+ MGN_VHT2SS_MCS3, -+ MGN_VHT2SS_MCS4, -+ MGN_VHT2SS_MCS5, -+ MGN_VHT2SS_MCS6, -+ MGN_VHT2SS_MCS7, -+ MGN_VHT2SS_MCS8, -+ MGN_VHT2SS_MCS9, -+ MGN_VHT3SS_MCS0, -+ MGN_VHT3SS_MCS1, -+ MGN_VHT3SS_MCS2, -+ MGN_VHT3SS_MCS3, -+ MGN_VHT3SS_MCS4, -+ MGN_VHT3SS_MCS5, -+ MGN_VHT3SS_MCS6, -+ MGN_VHT3SS_MCS7, -+ MGN_VHT3SS_MCS8, -+ MGN_VHT3SS_MCS9, -+ MGN_VHT4SS_MCS0, -+ MGN_VHT4SS_MCS1, -+ MGN_VHT4SS_MCS2, -+ MGN_VHT4SS_MCS3, -+ MGN_VHT4SS_MCS4, -+ MGN_VHT4SS_MCS5, -+ MGN_VHT4SS_MCS6, -+ MGN_VHT4SS_MCS7, -+ MGN_VHT4SS_MCS8, -+ MGN_VHT4SS_MCS9, -+ MGN_UNKNOWN -+}; -+ -+#define IS_HT_RATE(_rate) (_rate >= MGN_MCS0 && _rate <= MGN_MCS31) -+#define IS_VHT_RATE(_rate) (_rate >= MGN_VHT1SS_MCS0 && _rate <= MGN_VHT4SS_MCS9) -+#define IS_CCK_RATE(_rate) (MGN_1M == _rate || _rate == MGN_2M || _rate == MGN_5_5M || _rate == MGN_11M) -+#define IS_OFDM_RATE(_rate) (MGN_6M <= _rate && _rate <= MGN_54M && _rate != MGN_11M) -+ -+ -+/* NOTE: This data is for statistical purposes; not all hardware provides this -+ * information for frames received. Not setting these will not cause -+ * any adverse affects. */ -+struct ieee80211_rx_stats { -+ s8 rssi; -+ u8 signal; -+ u8 noise; -+ u8 received_channel; -+ u16 rate; /* in 100 kbps */ -+ u8 mask; -+ u8 freq; -+ u16 len; -+}; -+ -+/* IEEE 802.11 requires that STA supports concurrent reception of at least -+ * three fragmented frames. This define can be increased to support more -+ * concurrent frames, but it should be noted that each entry can consume about -+ * 2 kB of RAM and increasing cache size will slow down frame reassembly. */ -+#define IEEE80211_FRAG_CACHE_LEN 4 -+ -+struct ieee80211_frag_entry { -+ u32 first_frag_time; -+ uint seq; -+ uint last_frag; -+ uint qos; /* jackson */ -+ uint tid; /* jackson */ -+ struct sk_buff *skb; -+ u8 src_addr[ETH_ALEN]; -+ u8 dst_addr[ETH_ALEN]; -+}; -+ -+struct ieee80211_stats { -+ uint tx_unicast_frames; -+ uint tx_multicast_frames; -+ uint tx_fragments; -+ uint tx_unicast_octets; -+ uint tx_multicast_octets; -+ uint tx_deferred_transmissions; -+ uint tx_single_retry_frames; -+ uint tx_multiple_retry_frames; -+ uint tx_retry_limit_exceeded; -+ uint tx_discards; -+ uint rx_unicast_frames; -+ uint rx_multicast_frames; -+ uint rx_fragments; -+ uint rx_unicast_octets; -+ uint rx_multicast_octets; -+ uint rx_fcs_errors; -+ uint rx_discards_no_buffer; -+ uint tx_discards_wrong_sa; -+ uint rx_discards_undecryptable; -+ uint rx_message_in_msg_fragments; -+ uint rx_message_in_bad_msg_fragments; -+}; -+ -+struct ieee80211_softmac_stats { -+ uint rx_ass_ok; -+ uint rx_ass_err; -+ uint rx_probe_rq; -+ uint tx_probe_rs; -+ uint tx_beacons; -+ uint rx_auth_rq; -+ uint rx_auth_rs_ok; -+ uint rx_auth_rs_err; -+ uint tx_auth_rq; -+ uint no_auth_rs; -+ uint no_ass_rs; -+ uint tx_ass_rq; -+ uint rx_ass_rq; -+ uint tx_probe_rq; -+ uint reassoc; -+ uint swtxstop; -+ uint swtxawake; -+}; -+ -+#define SEC_KEY_1 (1<<0) -+#define SEC_KEY_2 (1<<1) -+#define SEC_KEY_3 (1<<2) -+#define SEC_KEY_4 (1<<3) -+#define SEC_ACTIVE_KEY (1<<4) -+#define SEC_AUTH_MODE (1<<5) -+#define SEC_UNICAST_GROUP (1<<6) -+#define SEC_LEVEL (1<<7) -+#define SEC_ENABLED (1<<8) -+ -+#define SEC_LEVEL_0 0 /* None */ -+#define SEC_LEVEL_1 1 /* WEP 40 and 104 bit */ -+#define SEC_LEVEL_2 2 /* Level 1 + TKIP */ -+#define SEC_LEVEL_2_CKIP 3 /* Level 1 + CKIP */ -+#define SEC_LEVEL_3 4 /* Level 2 + CCMP */ -+ -+#define WEP_KEYS 4 -+#define WEP_KEY_LEN 13 -+ -+#define BIP_MAX_KEYID 5 -+#define BIP_AAD_SIZE 20 -+ -+struct ieee80211_security { -+ u16 active_key:2, -+ enabled:1, -+ auth_mode:2, -+ auth_algo:4, -+ unicast_uses_group:1; -+ u8 key_sizes[WEP_KEYS]; -+ u8 keys[WEP_KEYS][WEP_KEY_LEN]; -+ u8 level; -+ u16 flags; -+} __attribute__ ((packed)); -+ -+/* -+ -+ 802.11 data frame from AP -+ -+ ,-------------------------------------------------------------------. -+Bytes | 2 | 2 | 6 | 6 | 6 | 2 | 0..2312 | 4 | -+ |------|------|---------|---------|---------|------|---------|------| -+Desc. | ctrl | dura | DA/RA | TA | SA | Sequ | frame | fcs | -+ | | tion | (BSSID) | | | ence | data | | -+ `-------------------------------------------------------------------' -+ -+Total: 28-2340 bytes -+ -+*/ -+ -+struct ieee80211_header_data { -+ u16 frame_ctl; -+ u16 duration_id; -+ u8 addr1[6]; -+ u8 addr2[6]; -+ u8 addr3[6]; -+ u16 seq_ctrl; -+}; -+ -+#define BEACON_PROBE_SSID_ID_POSITION 12 -+ -+/* Management Frame Information Element Types */ -+#define MFIE_TYPE_SSID 0 -+#define MFIE_TYPE_RATES 1 -+#define MFIE_TYPE_FH_SET 2 -+#define MFIE_TYPE_DS_SET 3 -+#define MFIE_TYPE_CF_SET 4 -+#define MFIE_TYPE_TIM 5 -+#define MFIE_TYPE_IBSS_SET 6 -+#define MFIE_TYPE_CHALLENGE 16 -+#define MFIE_TYPE_ERP 42 -+#define MFIE_TYPE_RSN 48 -+#define MFIE_TYPE_RATES_EX 50 -+#define MFIE_TYPE_GENERIC 221 -+ -+struct ieee80211_info_element_hdr { -+ u8 id; -+ u8 len; -+} __attribute__ ((packed)); -+ -+struct ieee80211_info_element { -+ u8 id; -+ u8 len; -+ u8 data[0]; -+} __attribute__ ((packed)); -+ -+/* -+ * These are the data types that can make up management packets -+ * -+ u16 auth_algorithm; -+ u16 auth_sequence; -+ u16 beacon_interval; -+ u16 capability; -+ u8 current_ap[ETH_ALEN]; -+ u16 listen_interval; -+ struct { -+ u16 association_id:14, reserved:2; -+ } __attribute__ ((packed)); -+ u32 time_stamp[2]; -+ u16 reason; -+ u16 status; -+*/ -+ -+#define IEEE80211_DEFAULT_TX_ESSID "Penguin" -+#define IEEE80211_DEFAULT_BASIC_RATE 10 -+ -+ -+struct ieee80211_authentication { -+ struct ieee80211_header_data header; -+ u16 algorithm; -+ u16 transaction; -+ u16 status; -+ /* struct ieee80211_info_element_hdr info_element; */ -+} __attribute__ ((packed)); -+ -+ -+struct ieee80211_probe_response { -+ struct ieee80211_header_data header; -+ u32 time_stamp[2]; -+ u16 beacon_interval; -+ u16 capability; -+ struct ieee80211_info_element info_element; -+} __attribute__ ((packed)); -+ -+struct ieee80211_probe_request { -+ struct ieee80211_header_data header; -+ /*struct ieee80211_info_element info_element;*/ -+} __attribute__ ((packed)); -+ -+struct ieee80211_assoc_request_frame { -+ struct ieee80211_hdr_3addr header; -+ u16 capability; -+ u16 listen_interval; -+ /* u8 current_ap[ETH_ALEN]; */ -+ struct ieee80211_info_element_hdr info_element; -+} __attribute__ ((packed)); -+ -+struct ieee80211_assoc_response_frame { -+ struct ieee80211_hdr_3addr header; -+ u16 capability; -+ u16 status; -+ u16 aid; -+} __attribute__ ((packed)); -+ -+struct ieee80211_txb { -+ u8 nr_frags; -+ u8 encrypted; -+ u16 reserved; -+ u16 frag_size; -+ u16 payload_size; -+ struct sk_buff *fragments[0]; -+}; -+ -+ -+/* SWEEP TABLE ENTRIES NUMBER*/ -+#define MAX_SWEEP_TAB_ENTRIES 42 -+#define MAX_SWEEP_TAB_ENTRIES_PER_PACKET 7 -+/* MAX_RATES_LENGTH needs to be 12. The spec says 8, and many APs -+ * only use 8, and then use extended rates for the remaining supported -+ * rates. Other APs, however, stick all of their supported rates on the -+ * main rates information element... */ -+#define MAX_RATES_LENGTH ((u8)12) -+#define MAX_RATES_EX_LENGTH ((u8)16) -+#define MAX_NETWORK_COUNT 128 -+#define MAX_CHANNEL_NUMBER 161 -+#define IEEE80211_SOFTMAC_SCAN_TIME 400 -+/* HZ / 2) */ -+#define IEEE80211_SOFTMAC_ASSOC_RETRY_TIME (HZ * 2) -+ -+#define CRC_LENGTH 4U -+ -+#define MAX_WPA_IE_LEN (256) -+#define MAX_WPS_IE_LEN (512) -+#define MAX_P2P_IE_LEN (256) -+#define MAX_WFD_IE_LEN (128) -+ -+#define NETWORK_EMPTY_ESSID (1<<0) -+#define NETWORK_HAS_OFDM (1<<1) -+#define NETWORK_HAS_CCK (1<<2) -+ -+#define IEEE80211_DTIM_MBCAST 4 -+#define IEEE80211_DTIM_UCAST 2 -+#define IEEE80211_DTIM_VALID 1 -+#define IEEE80211_DTIM_INVALID 0 -+ -+#define IEEE80211_PS_DISABLED 0 -+#define IEEE80211_PS_UNICAST IEEE80211_DTIM_UCAST -+#define IEEE80211_PS_MBCAST IEEE80211_DTIM_MBCAST -+#define IW_ESSID_MAX_SIZE 32 -+/* -+join_res: -+-1: authentication fail -+-2: association fail -+> 0: TID -+*/ -+ -+enum ieee80211_state { -+ -+ /* the card is not linked at all */ -+ IEEE80211_NOLINK = 0, -+ -+ /* IEEE80211_ASSOCIATING* are for BSS client mode -+ * the driver shall not perform RX filtering unless -+ * the state is LINKED. -+ * The driver shall just check for the state LINKED and -+ * defaults to NOLINK for ALL the other states (including -+ * LINKED_SCANNING) -+ */ -+ -+ /* the association procedure will start (wq scheduling)*/ -+ IEEE80211_ASSOCIATING, -+ IEEE80211_ASSOCIATING_RETRY, -+ -+ /* the association procedure is sending AUTH request*/ -+ IEEE80211_ASSOCIATING_AUTHENTICATING, -+ -+ /* the association procedure has successfully authentcated -+ * and is sending association request -+ */ -+ IEEE80211_ASSOCIATING_AUTHENTICATED, -+ -+ /* the link is ok. the card associated to a BSS or linked -+ * to a ibss cell or acting as an AP and creating the bss -+ */ -+ IEEE80211_LINKED, -+ -+ /* same as LINKED, but the driver shall apply RX filter -+ * rules as we are in NO_LINK mode. As the card is still -+ * logically linked, but it is doing a syncro site survey -+ * then it will be back to LINKED state. -+ */ -+ IEEE80211_LINKED_SCANNING, -+ -+}; -+ -+#define DEFAULT_MAX_SCAN_AGE (15 * HZ) -+#define DEFAULT_FTS 2346 -+#define MAC_FMT "%02x:%02x:%02x:%02x:%02x:%02x" -+#define MAC_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5] -+#define IP_FMT "%d.%d.%d.%d" -+#define IP_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3] -+ -+extern __inline int is_multicast_mac_addr(const u8 *addr) -+{ -+ return ((addr[0] != 0xff) && (0x01 & addr[0])); -+} -+ -+extern __inline int is_broadcast_mac_addr(const u8 *addr) -+{ -+ return ((addr[0] == 0xff) && (addr[1] == 0xff) && (addr[2] == 0xff) && \ -+ (addr[3] == 0xff) && (addr[4] == 0xff) && (addr[5] == 0xff)); -+} -+ -+extern __inline int is_zero_mac_addr(const u8 *addr) -+{ -+ return ((addr[0] == 0x00) && (addr[1] == 0x00) && (addr[2] == 0x00) && \ -+ (addr[3] == 0x00) && (addr[4] == 0x00) && (addr[5] == 0x00)); -+} -+ -+#define CFG_IEEE80211_RESERVE_FCS (1<<0) -+#define CFG_IEEE80211_COMPUTE_FCS (1<<1) -+ -+typedef struct tx_pending_t{ -+ int frag; -+ struct ieee80211_txb *txb; -+}tx_pending_t; -+ -+ -+ -+#define MAXTID 16 -+ -+#define IEEE_A (1<<0) -+#define IEEE_B (1<<1) -+#define IEEE_G (1<<2) -+#define IEEE_MODE_MASK (IEEE_A|IEEE_B|IEEE_G) -+ -+/* Action category code */ -+enum rtw_ieee80211_category { -+ RTW_WLAN_CATEGORY_SPECTRUM_MGMT = 0, -+ RTW_WLAN_CATEGORY_QOS = 1, -+ RTW_WLAN_CATEGORY_DLS = 2, -+ RTW_WLAN_CATEGORY_BACK = 3, -+ RTW_WLAN_CATEGORY_PUBLIC = 4, /* IEEE 802.11 public action frames */ -+ RTW_WLAN_CATEGORY_RADIO_MEASUREMENT = 5, -+ RTW_WLAN_CATEGORY_FT = 6, -+ RTW_WLAN_CATEGORY_HT = 7, -+ RTW_WLAN_CATEGORY_SA_QUERY = 8, -+ RTW_WLAN_CATEGORY_UNPROTECTED_WNM = 11, /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ RTW_WLAN_CATEGORY_TDLS = 12, -+ RTW_WLAN_CATEGORY_SELF_PROTECTED = 15, /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ RTW_WLAN_CATEGORY_WMM = 17, -+ RTW_WLAN_CATEGORY_VHT = 21, -+ RTW_WLAN_CATEGORY_P2P = 0x7f,/* P2P action frames */ -+}; -+ -+/* SPECTRUM_MGMT action code */ -+enum rtw_ieee80211_spectrum_mgmt_actioncode { -+ RTW_WLAN_ACTION_SPCT_MSR_REQ = 0, -+ RTW_WLAN_ACTION_SPCT_MSR_RPRT = 1, -+ RTW_WLAN_ACTION_SPCT_TPC_REQ = 2, -+ RTW_WLAN_ACTION_SPCT_TPC_RPRT = 3, -+ RTW_WLAN_ACTION_SPCT_CHL_SWITCH = 4, -+ RTW_WLAN_ACTION_SPCT_EXT_CHL_SWITCH = 5, -+}; -+ -+enum _PUBLIC_ACTION{ -+ ACT_PUBLIC_BSSCOEXIST = 0, /* 20/40 BSS Coexistence */ -+ ACT_PUBLIC_DSE_ENABLE = 1, -+ ACT_PUBLIC_DSE_DEENABLE = 2, -+ ACT_PUBLIC_DSE_REG_LOCATION = 3, -+ ACT_PUBLIC_EXT_CHL_SWITCH = 4, -+ ACT_PUBLIC_DSE_MSR_REQ = 5, -+ ACT_PUBLIC_DSE_MSR_RPRT = 6, -+ ACT_PUBLIC_MP = 7, /* Measurement Pilot */ -+ ACT_PUBLIC_DSE_PWR_CONSTRAINT = 8, -+ ACT_PUBLIC_VENDOR = 9, /* for WIFI_DIRECT */ -+ ACT_PUBLIC_GAS_INITIAL_REQ = 10, -+ ACT_PUBLIC_GAS_INITIAL_RSP = 11, -+ ACT_PUBLIC_GAS_COMEBACK_REQ = 12, -+ ACT_PUBLIC_GAS_COMEBACK_RSP = 13, -+ ACT_PUBLIC_TDLS_DISCOVERY_RSP = 14, -+ ACT_PUBLIC_LOCATION_TRACK = 15, -+ ACT_PUBLIC_MAX -+}; -+ -+/* BACK action code */ -+enum rtw_ieee80211_back_actioncode { -+ RTW_WLAN_ACTION_ADDBA_REQ = 0, -+ RTW_WLAN_ACTION_ADDBA_RESP = 1, -+ RTW_WLAN_ACTION_DELBA = 2, -+}; -+ -+/* HT features action code */ -+enum rtw_ieee80211_ht_actioncode { -+ RTW_WLAN_ACTION_HT_NOTI_CHNL_WIDTH = 0, -+ RTW_WLAN_ACTION_HT_SM_PS = 1, -+ RTW_WLAN_ACTION_HT_PSMP = 2, -+ RTW_WLAN_ACTION_HT_SET_PCO_PHASE = 3, -+ RTW_WLAN_ACTION_HT_CSI = 4, -+ RTW_WLAN_ACTION_HT_NON_COMPRESS_BEAMFORMING = 5, -+ RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING = 6, -+ RTW_WLAN_ACTION_HT_ASEL_FEEDBACK = 7, -+}; -+ -+/* BACK (block-ack) parties */ -+enum rtw_ieee80211_back_parties { -+ RTW_WLAN_BACK_RECIPIENT = 0, -+ RTW_WLAN_BACK_INITIATOR = 1, -+ RTW_WLAN_BACK_TIMER = 2, -+}; -+ -+/* VHT features action code */ -+enum rtw_ieee80211_vht_actioncode{ -+ RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING = 0, -+ RTW_WLAN_ACTION_VHT_GROUPID_MANAGEMENT = 1, -+ RTW_WLAN_ACTION_VHT_OPMODE_NOTIFICATION = 2, -+}; -+ -+ -+#define OUI_MICROSOFT 0x0050f2 /* Microsoft (also used in Wi-Fi specs) -+ * 00:50:F2 */ -+#define WME_OUI_TYPE 2 -+#define WME_OUI_SUBTYPE_INFORMATION_ELEMENT 0 -+#define WME_OUI_SUBTYPE_PARAMETER_ELEMENT 1 -+#define WME_OUI_SUBTYPE_TSPEC_ELEMENT 2 -+#define WME_VERSION 1 -+ -+#define WME_ACTION_CODE_SETUP_REQUEST 0 -+#define WME_ACTION_CODE_SETUP_RESPONSE 1 -+#define WME_ACTION_CODE_TEARDOWN 2 -+ -+#define WME_SETUP_RESPONSE_STATUS_ADMISSION_ACCEPTED 0 -+#define WME_SETUP_RESPONSE_STATUS_INVALID_PARAMETERS 1 -+#define WME_SETUP_RESPONSE_STATUS_REFUSED 3 -+ -+#define WME_TSPEC_DIRECTION_UPLINK 0 -+#define WME_TSPEC_DIRECTION_DOWNLINK 1 -+#define WME_TSPEC_DIRECTION_BI_DIRECTIONAL 3 -+ -+ -+#define OUI_BROADCOM 0x00904c /* Broadcom (Epigram) */ -+ -+#define VENDOR_HT_CAPAB_OUI_TYPE 0x33 /* 00-90-4c:0x33 */ -+ -+/** -+ * enum rtw_ieee80211_channel_flags - channel flags -+ * -+ * Channel flags set by the regulatory control code. -+ * -+ * @RTW_IEEE80211_CHAN_DISABLED: This channel is disabled. -+ * @RTW_IEEE80211_CHAN_PASSIVE_SCAN: Only passive scanning is permitted -+ * on this channel. -+ * @RTW_IEEE80211_CHAN_NO_IBSS: IBSS is not allowed on this channel. -+ * @RTW_IEEE80211_CHAN_RADAR: Radar detection is required on this channel. -+ * @RTW_IEEE80211_CHAN_NO_HT40PLUS: extension channel above this channel -+ * is not permitted. -+ * @RTW_IEEE80211_CHAN_NO_HT40MINUS: extension channel below this channel -+ * is not permitted. -+ */ -+ enum rtw_ieee80211_channel_flags { -+ RTW_IEEE80211_CHAN_DISABLED = 1<<0, -+ RTW_IEEE80211_CHAN_PASSIVE_SCAN = 1<<1, -+ RTW_IEEE80211_CHAN_NO_IBSS = 1<<2, -+ RTW_IEEE80211_CHAN_RADAR = 1<<3, -+ RTW_IEEE80211_CHAN_NO_HT40PLUS = 1<<4, -+ RTW_IEEE80211_CHAN_NO_HT40MINUS = 1<<5, -+ }; -+ -+ #define RTW_IEEE80211_CHAN_NO_HT40 \ -+ (RTW_IEEE80211_CHAN_NO_HT40PLUS | RTW_IEEE80211_CHAN_NO_HT40MINUS) -+ -+/* Represent channel details, subset of ieee80211_channel */ -+struct rtw_ieee80211_channel { -+ /* enum ieee80211_band band; */ -+ /* u16 center_freq; */ -+ u16 hw_value; -+ u32 flags; -+ /* int max_antenna_gain; */ -+ /* int max_power; */ -+ /* int max_reg_power; */ -+ /* bool beacon_found; */ -+ /* u32 orig_flags; */ -+ /* int orig_mag; */ -+ /* int orig_mpwr; */ -+}; -+ -+#define CHAN_FMT \ -+ /*"band:%d, "*/ \ -+ /*"center_freq:%u, "*/ \ -+ "hw_value:%u, " \ -+ "flags:0x%08x" \ -+ /*"max_antenna_gain:%d\n"*/ \ -+ /*"max_power:%d\n"*/ \ -+ /*"max_reg_power:%d\n"*/ \ -+ /*"beacon_found:%u\n"*/ \ -+ /*"orig_flags:0x%08x\n"*/ \ -+ /*"orig_mag:%d\n"*/ \ -+ /*"orig_mpwr:%d\n"*/ -+ -+#define CHAN_ARG(channel) \ -+ /*(channel)->band*/ \ -+ /*, (channel)->center_freq*/ \ -+ (channel)->hw_value \ -+ , (channel)->flags \ -+ /*, (channel)->max_antenna_gain*/ \ -+ /*, (channel)->max_power*/ \ -+ /*, (channel)->max_reg_power*/ \ -+ /*, (channel)->beacon_found*/ \ -+ /*, (channel)->orig_flags*/ \ -+ /*, (channel)->orig_mag*/ \ -+ /*, (channel)->orig_mpwr*/ \ -+ -+/* Parsed Information Elements */ -+struct rtw_ieee802_11_elems { -+ u8 *ssid; -+ u8 ssid_len; -+ u8 *supp_rates; -+ u8 supp_rates_len; -+ u8 *fh_params; -+ u8 fh_params_len; -+ u8 *ds_params; -+ u8 ds_params_len; -+ u8 *cf_params; -+ u8 cf_params_len; -+ u8 *tim; -+ u8 tim_len; -+ u8 *ibss_params; -+ u8 ibss_params_len; -+ u8 *challenge; -+ u8 challenge_len; -+ u8 *erp_info; -+ u8 erp_info_len; -+ u8 *ext_supp_rates; -+ u8 ext_supp_rates_len; -+ u8 *wpa_ie; -+ u8 wpa_ie_len; -+ u8 *rsn_ie; -+ u8 rsn_ie_len; -+ u8 *wme; -+ u8 wme_len; -+ u8 *wme_tspec; -+ u8 wme_tspec_len; -+ u8 *wps_ie; -+ u8 wps_ie_len; -+ u8 *power_cap; -+ u8 power_cap_len; -+ u8 *supp_channels; -+ u8 supp_channels_len; -+ u8 *mdie; -+ u8 mdie_len; -+ u8 *ftie; -+ u8 ftie_len; -+ u8 *timeout_int; -+ u8 timeout_int_len; -+ u8 *ht_capabilities; -+ u8 ht_capabilities_len; -+ u8 *ht_operation; -+ u8 ht_operation_len; -+ u8 *vendor_ht_cap; -+ u8 vendor_ht_cap_len; -+ u8 *vht_capabilities; -+ u8 vht_capabilities_len; -+ u8 *vht_operation; -+ u8 vht_operation_len; -+ u8 *vht_op_mode_notify; -+ u8 vht_op_mode_notify_len; -+}; -+ -+typedef enum { ParseOK = 0, ParseUnknown = 1, ParseFailed = -1 } ParseRes; -+ -+ParseRes rtw_ieee802_11_parse_elems(u8 *start, uint len, -+ struct rtw_ieee802_11_elems *elems, -+ int show_errors); -+ -+u8 *rtw_set_fixed_ie(unsigned char *pbuf, unsigned int len, unsigned char *source, unsigned int *frlen); -+u8 *rtw_set_ie(u8 *pbuf, sint index, uint len, u8 *source, uint *frlen); -+ -+enum secondary_ch_offset { -+ SCN = 0, /* no secondary channel */ -+ SCA = 1, /* secondary channel above */ -+ SCB = 3, /* secondary channel below */ -+}; -+ -+u8 *rtw_get_ie(u8*pbuf, sint index, sint *len, sint limit); -+u8 *rtw_get_ie_ex(u8 *in_ie, uint in_len, u8 eid, u8 *oui, u8 oui_len, u8 *ie, uint *ielen); -+int rtw_ies_remove_ie(u8 *ies, uint *ies_len, uint offset, u8 eid, u8 *oui, u8 oui_len); -+ -+void rtw_set_supported_rate(u8 *SupportedRates, uint mode) ; -+ -+unsigned char *rtw_get_wpa_ie(unsigned char *pie, int *wpa_ie_len, int limit); -+unsigned char *rtw_get_wpa2_ie(unsigned char *pie, int *rsn_ie_len, int limit); -+int rtw_get_wpa_cipher_suite(u8 *s); -+int rtw_get_wpa2_cipher_suite(u8 *s); -+int rtw_get_wapi_ie(u8 *in_ie, uint in_len, u8 *wapi_ie, u16 *wapi_len); -+int rtw_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x); -+int rtw_parse_wpa2_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x); -+ -+int rtw_get_sec_ie(u8 *in_ie, uint in_len, u8 *rsn_ie, u16 *rsn_len, u8 *wpa_ie, u16 *wpa_len); -+ -+u8 rtw_is_wps_ie(u8 *ie_ptr, uint *wps_ielen); -+u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen); -+u8 *rtw_get_wps_attr(u8 *wps_ie, uint wps_ielen, u16 target_attr_id , u8 *buf_attr, u32 *len_attr); -+u8 *rtw_get_wps_attr_content(u8 *wps_ie, uint wps_ielen, u16 target_attr_id , u8 *buf_content, uint *len_content); -+ -+/** -+ * for_each_ie - iterate over continuous IEs -+ * @ie: -+ * @buf: -+ * @buf_len: -+ */ -+#define for_each_ie(ie, buf, buf_len) \ -+ for (ie = (void*)buf; (((u8 *)ie) - ((u8 *)buf) + 1) < buf_len; ie = (void*)(((u8 *)ie) + *(((u8 *)ie)+1) + 2)) -+ -+uint rtw_get_rateset_len(u8 *rateset); -+ -+struct registry_priv; -+int rtw_generate_ie(struct registry_priv *pregistrypriv); -+ -+ -+int rtw_get_bit_value_from_ieee_value(u8 val); -+ -+uint rtw_is_cckrates_included(u8 *rate); -+ -+uint rtw_is_cckratesonly_included(u8 *rate); -+ -+int rtw_check_network_type(unsigned char *rate, int ratelen, int channel); -+ -+void rtw_get_bcn_info(struct wlan_network *pnetwork); -+ -+void rtw_macaddr_cfg(struct device *dev, u8 *mac_addr); -+ -+u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI, unsigned char * MCS_rate); -+ -+int rtw_action_frame_parse(const u8 *frame, u32 frame_len, u8 *category, u8 *action); -+const char *action_public_str(u8 action); -+ -+#endif /* IEEE80211_H */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/ioctl_cfg80211.h linux/3rdparty/rtl8723bs/include/ioctl_cfg80211.h ---- linux.old/3rdparty/rtl8723bs/include/ioctl_cfg80211.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/ioctl_cfg80211.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,132 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __IOCTL_CFG80211_H__ -+#define __IOCTL_CFG80211_H__ -+ -+#include -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 0)) -+#error This driver only works with kernel 3.19 and later -+#endif -+ -+struct rtw_wdev_invit_info { -+ u8 state; /* 0: req, 1:rep */ -+ u8 peer_mac[ETH_ALEN]; -+ u8 active; -+ u8 token; -+ u8 flags; -+ u8 status; -+ u8 req_op_ch; -+ u8 rsp_op_ch; -+}; -+ -+#define rtw_wdev_invit_info_init(invit_info) \ -+ do { \ -+ (invit_info)->state = 0xff; \ -+ memset((invit_info)->peer_mac, 0, ETH_ALEN); \ -+ (invit_info)->active = 0xff; \ -+ (invit_info)->token = 0; \ -+ (invit_info)->flags = 0x00; \ -+ (invit_info)->status = 0xff; \ -+ (invit_info)->req_op_ch = 0; \ -+ (invit_info)->rsp_op_ch = 0; \ -+ } while (0) -+ -+struct rtw_wdev_nego_info { -+ u8 state; /* 0: req, 1:rep, 2:conf */ -+ u8 peer_mac[ETH_ALEN]; -+ u8 active; -+ u8 token; -+ u8 status; -+ u8 req_intent; -+ u8 req_op_ch; -+ u8 req_listen_ch; -+ u8 rsp_intent; -+ u8 rsp_op_ch; -+ u8 conf_op_ch; -+}; -+ -+#define rtw_wdev_nego_info_init(nego_info) \ -+ do { \ -+ (nego_info)->state = 0xff; \ -+ memset((nego_info)->peer_mac, 0, ETH_ALEN); \ -+ (nego_info)->active = 0xff; \ -+ (nego_info)->token = 0; \ -+ (nego_info)->status = 0xff; \ -+ (nego_info)->req_intent = 0xff; \ -+ (nego_info)->req_op_ch = 0; \ -+ (nego_info)->req_listen_ch = 0; \ -+ (nego_info)->rsp_intent = 0xff; \ -+ (nego_info)->rsp_op_ch = 0; \ -+ (nego_info)->conf_op_ch = 0; \ -+ } while (0) -+ -+struct rtw_wdev_priv -+{ -+ struct wireless_dev *rtw_wdev; -+ -+ struct adapter *padapter; -+ -+ struct cfg80211_scan_request *scan_request; -+ _lock scan_req_lock; -+ -+ struct net_device *pmon_ndev;/* for monitor interface */ -+ char ifname_mon[IFNAMSIZ + 1]; /* interface name for monitor interface */ -+ -+ u8 p2p_enabled; -+ -+ u8 provdisc_req_issued; -+ -+ struct rtw_wdev_invit_info invit_info; -+ struct rtw_wdev_nego_info nego_info; -+ -+ u8 bandroid_scan; -+ bool block; -+ bool power_mgmt; -+}; -+ -+#define wiphy_to_adapter(x) (*((struct adapter **)wiphy_priv(x))) -+ -+#define wdev_to_ndev(w) ((w)->netdev) -+ -+int rtw_wdev_alloc(struct adapter *padapter, struct device *dev); -+void rtw_wdev_free(struct wireless_dev *wdev); -+void rtw_wdev_unregister(struct wireless_dev *wdev); -+ -+void rtw_cfg80211_init_wiphy(struct adapter *padapter); -+ -+void rtw_cfg80211_unlink_bss(struct adapter *padapter, struct wlan_network *pnetwork); -+void rtw_cfg80211_surveydone_event_callback(struct adapter *padapter); -+struct cfg80211_bss *rtw_cfg80211_inform_bss(struct adapter *padapter, struct wlan_network *pnetwork); -+int rtw_cfg80211_check_bss(struct adapter *padapter); -+void rtw_cfg80211_ibss_indicate_connect(struct adapter *padapter); -+void rtw_cfg80211_indicate_connect(struct adapter *padapter); -+void rtw_cfg80211_indicate_disconnect(struct adapter *padapter); -+void rtw_cfg80211_indicate_scan_done(struct adapter *adapter, bool aborted); -+ -+void rtw_cfg80211_indicate_sta_assoc(struct adapter *padapter, u8 *pmgmt_frame, uint frame_len); -+void rtw_cfg80211_indicate_sta_disassoc(struct adapter *padapter, unsigned char *da, unsigned short reason); -+ -+void rtw_cfg80211_rx_action(struct adapter *adapter, u8 *frame, uint frame_len, const char*msg); -+ -+bool rtw_cfg80211_pwr_mgmt(struct adapter *adapter); -+ -+#define rtw_cfg80211_rx_mgmt(adapter, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt((adapter)->rtw_wdev, freq, sig_dbm, buf, len, 0) -+#define rtw_cfg80211_send_rx_assoc(adapter, bss, buf, len) cfg80211_send_rx_assoc((adapter)->pnetdev, bss, buf, len) -+#define rtw_cfg80211_mgmt_tx_status(adapter, cookie, buf, len, ack, gfp) cfg80211_mgmt_tx_status((adapter)->rtw_wdev, cookie, buf, len, ack, gfp) -+#define rtw_cfg80211_ready_on_channel(adapter, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel((adapter)->rtw_wdev, cookie, chan, duration, gfp) -+#define rtw_cfg80211_remain_on_channel_expired(adapter, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired((adapter)->rtw_wdev, cookie, chan, gfp) -+ -+#endif /* __IOCTL_CFG80211_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/mlme_osdep.h linux/3rdparty/rtl8723bs/include/mlme_osdep.h ---- linux.old/3rdparty/rtl8723bs/include/mlme_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/mlme_osdep.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,27 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __MLME_OSDEP_H_ -+#define __MLME_OSDEP_H_ -+ -+ -+extern void rtw_init_mlme_timer(struct adapter *padapter); -+extern void rtw_os_indicate_disconnect(struct adapter *adapter); -+extern void rtw_os_indicate_connect(struct adapter *adapter); -+void rtw_os_indicate_scan_done(struct adapter *padapter, bool aborted); -+extern void rtw_report_sec_ie(struct adapter *adapter, u8 authmode, u8 *sec_ie); -+ -+void rtw_reset_securitypriv(struct adapter *adapter); -+ -+#endif /* _MLME_OSDEP_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/osdep_intf.h linux/3rdparty/rtl8723bs/include/osdep_intf.h ---- linux.old/3rdparty/rtl8723bs/include/osdep_intf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/osdep_intf.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,88 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __OSDEP_INTF_H_ -+#define __OSDEP_INTF_H_ -+ -+ -+struct intf_priv { -+ -+ u8 *intf_dev; -+ u32 max_iosz; /* USB2.0: 128, USB1.1: 64, SDIO:64 */ -+ u32 max_xmitsz; /* USB2.0: unlimited, SDIO:512 */ -+ u32 max_recvsz; /* USB2.0: unlimited, SDIO:512 */ -+ -+ volatile u8 *io_rwmem; -+ volatile u8 *allocated_io_rwmem; -+ u32 io_wsz; /* unit: 4bytes */ -+ u32 io_rsz;/* unit: 4bytes */ -+ u8 intf_status; -+ -+ void (*_bus_io)(u8 *priv); -+ -+/* -+Under Sync. IRP (SDIO/USB) -+A protection mechanism is necessary for the io_rwmem(read/write protocol) -+ -+Under Async. IRP (SDIO/USB) -+The protection mechanism is through the pending queue. -+*/ -+ -+ _mutex ioctl_mutex; -+}; -+ -+ -+#ifdef CONFIG_R871X_TEST -+int rtw_start_pseudo_adhoc(struct adapter *padapter); -+int rtw_stop_pseudo_adhoc(struct adapter *padapter); -+#endif -+ -+struct dvobj_priv *devobj_init(void); -+void devobj_deinit(struct dvobj_priv *pdvobj); -+ -+u8 rtw_init_drv_sw(struct adapter *padapter); -+u8 rtw_free_drv_sw(struct adapter *padapter); -+u8 rtw_reset_drv_sw(struct adapter *padapter); -+void rtw_dev_unload(struct adapter *padapter); -+ -+u32 rtw_start_drv_threads(struct adapter *padapter); -+void rtw_stop_drv_threads (struct adapter *padapter); -+void rtw_cancel_all_timer(struct adapter *padapter); -+ -+int rtw_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); -+ -+int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname); -+struct net_device *rtw_init_netdev(struct adapter *padapter); -+void rtw_unregister_netdevs(struct dvobj_priv *dvobj); -+ -+u16 rtw_recv_select_queue(struct sk_buff *skb); -+ -+int rtw_ndev_notifier_register(void); -+void rtw_ndev_notifier_unregister(void); -+ -+#include "../os_dep/rtw_proc.h" -+ -+void rtw_ips_dev_unload(struct adapter *padapter); -+ -+int rtw_ips_pwr_up(struct adapter *padapter); -+void rtw_ips_pwr_down(struct adapter *padapter); -+ -+int rtw_drv_register_netdev(struct adapter *padapter); -+void rtw_ndev_destructor(_nic_hdl ndev); -+ -+int rtw_suspend_common(struct adapter *padapter); -+int rtw_resume_common(struct adapter *padapter); -+ -+#endif /* _OSDEP_INTF_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/osdep_service.h linux/3rdparty/rtl8723bs/include/osdep_service.h ---- linux.old/3rdparty/rtl8723bs/include/osdep_service.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/osdep_service.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,281 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __OSDEP_SERVICE_H_ -+#define __OSDEP_SERVICE_H_ -+ -+ -+#define _FAIL 0 -+#define _SUCCESS 1 -+#define RTW_RX_HANDLED 2 -+ -+#include -+ -+#ifndef BIT -+ #define BIT(x) (1 << (x)) -+#endif -+ -+#define BIT0 0x00000001 -+#define BIT1 0x00000002 -+#define BIT2 0x00000004 -+#define BIT3 0x00000008 -+#define BIT4 0x00000010 -+#define BIT5 0x00000020 -+#define BIT6 0x00000040 -+#define BIT7 0x00000080 -+#define BIT8 0x00000100 -+#define BIT9 0x00000200 -+#define BIT10 0x00000400 -+#define BIT11 0x00000800 -+#define BIT12 0x00001000 -+#define BIT13 0x00002000 -+#define BIT14 0x00004000 -+#define BIT15 0x00008000 -+#define BIT16 0x00010000 -+#define BIT17 0x00020000 -+#define BIT18 0x00040000 -+#define BIT19 0x00080000 -+#define BIT20 0x00100000 -+#define BIT21 0x00200000 -+#define BIT22 0x00400000 -+#define BIT23 0x00800000 -+#define BIT24 0x01000000 -+#define BIT25 0x02000000 -+#define BIT26 0x04000000 -+#define BIT27 0x08000000 -+#define BIT28 0x10000000 -+#define BIT29 0x20000000 -+#define BIT30 0x40000000 -+#define BIT31 0x80000000 -+#define BIT32 0x0100000000 -+#define BIT33 0x0200000000 -+#define BIT34 0x0400000000 -+#define BIT35 0x0800000000 -+#define BIT36 0x1000000000 -+ -+extern int RTW_STATUS_CODE(int error_code); -+ -+/* flags used for rtw_mstat_update() */ -+enum mstat_f { -+ /* type: 0x00ff */ -+ MSTAT_TYPE_VIR = 0x00, -+ MSTAT_TYPE_PHY = 0x01, -+ MSTAT_TYPE_SKB = 0x02, -+ MSTAT_TYPE_USB = 0x03, -+ MSTAT_TYPE_MAX = 0x04, -+ -+ /* func: 0xff00 */ -+ MSTAT_FUNC_UNSPECIFIED = 0x00<<8, -+ MSTAT_FUNC_IO = 0x01<<8, -+ MSTAT_FUNC_TX_IO = 0x02<<8, -+ MSTAT_FUNC_RX_IO = 0x03<<8, -+ MSTAT_FUNC_TX = 0x04<<8, -+ MSTAT_FUNC_RX = 0x05<<8, -+ MSTAT_FUNC_MAX = 0x06<<8, -+}; -+ -+#define mstat_tf_idx(flags) ((flags)&0xff) -+#define mstat_ff_idx(flags) (((flags)&0xff00) >> 8) -+ -+typedef enum mstat_status{ -+ MSTAT_ALLOC_SUCCESS = 0, -+ MSTAT_ALLOC_FAIL, -+ MSTAT_FREE -+} MSTAT_STATUS; -+ -+#define rtw_mstat_update(flag, status, sz) do {} while (0) -+#define rtw_mstat_dump(sel) do {} while (0) -+u8*_rtw_zmalloc(u32 sz); -+u8*_rtw_malloc(u32 sz); -+void _kfree(u8 *pbuf, u32 sz); -+ -+struct sk_buff *_rtw_skb_alloc(u32 sz); -+struct sk_buff *_rtw_skb_copy(const struct sk_buff *skb); -+struct sk_buff *_rtw_skb_clone(struct sk_buff *skb); -+int _rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb); -+ -+#define rtw_malloc(sz) _rtw_malloc((sz)) -+#define rtw_zmalloc(sz) _rtw_zmalloc((sz)) -+ -+#define rtw_skb_alloc(size) _rtw_skb_alloc((size)) -+#define rtw_skb_alloc_f(size, mstat_f) _rtw_skb_alloc((size)) -+#define rtw_skb_copy(skb) _rtw_skb_copy((skb)) -+#define rtw_skb_clone(skb) _rtw_skb_clone((skb)) -+#define rtw_skb_copy_f(skb, mstat_f) _rtw_skb_copy((skb)) -+#define rtw_skb_clone_f(skb, mstat_f) _rtw_skb_clone((skb)) -+#define rtw_netif_rx(ndev, skb) _rtw_netif_rx(ndev, skb) -+ -+extern void _rtw_init_queue(struct __queue *pqueue); -+ -+extern void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc); -+ -+static __inline void thread_enter(char *name) -+{ -+ allow_signal(SIGTERM); -+} -+ -+__inline static void flush_signals_thread(void) -+{ -+ if (signal_pending (current)) -+ { -+ flush_signals(current); -+ } -+} -+ -+#define rtw_warn_on(condition) WARN_ON(condition) -+ -+__inline static int rtw_bug_check(void *parg1, void *parg2, void *parg3, void *parg4) -+{ -+ int ret = true; -+ -+ return ret; -+ -+} -+ -+#define _RND(sz, r) ((((sz)+((r)-1))/(r))*(r)) -+#define RND4(x) (((x >> 2) + (((x & 3) == 0) ? 0: 1)) << 2) -+ -+__inline static u32 _RND4(u32 sz) -+{ -+ -+ u32 val; -+ -+ val = ((sz >> 2) + ((sz & 3) ? 1: 0)) << 2; -+ -+ return val; -+ -+} -+ -+__inline static u32 _RND8(u32 sz) -+{ -+ -+ u32 val; -+ -+ val = ((sz >> 3) + ((sz & 7) ? 1: 0)) << 3; -+ -+ return val; -+ -+} -+ -+#ifndef MAC_FMT -+#define MAC_FMT "%02x:%02x:%02x:%02x:%02x:%02x" -+#endif -+#ifndef MAC_ARG -+#define MAC_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5] -+#endif -+ -+ -+#ifdef CONFIG_AP_WOWLAN -+extern void rtw_softap_lock_suspend(void); -+extern void rtw_softap_unlock_suspend(void); -+#endif -+ -+/* File operation APIs, just for linux now */ -+extern int rtw_is_file_readable(char *path); -+extern int rtw_retrive_from_file(char *path, u8 *buf, u32 sz); -+ -+extern void rtw_free_netdev(struct net_device * netdev); -+ -+ -+extern u64 rtw_modular64(u64 x, u64 y); -+ -+/* Macros for handling unaligned memory accesses */ -+ -+#define RTW_GET_BE16(a) ((u16) (((a)[0] << 8) | (a)[1])) -+#define RTW_PUT_BE16(a, val) \ -+ do { \ -+ (a)[0] = ((u16) (val)) >> 8; \ -+ (a)[1] = ((u16) (val)) & 0xff; \ -+ } while (0) -+ -+#define RTW_GET_LE16(a) ((u16) (((a)[1] << 8) | (a)[0])) -+#define RTW_PUT_LE16(a, val) \ -+ do { \ -+ (a)[1] = ((u16) (val)) >> 8; \ -+ (a)[0] = ((u16) (val)) & 0xff; \ -+ } while (0) -+ -+#define RTW_GET_BE24(a) ((((u32) (a)[0]) << 16) | (((u32) (a)[1]) << 8) | \ -+ ((u32) (a)[2])) -+#define RTW_PUT_BE24(a, val) \ -+ do { \ -+ (a)[0] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[2] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define RTW_GET_BE32(a) ((((u32) (a)[0]) << 24) | (((u32) (a)[1]) << 16) | \ -+ (((u32) (a)[2]) << 8) | ((u32) (a)[3])) -+#define RTW_PUT_BE32(a, val) \ -+ do { \ -+ (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[3] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define RTW_GET_LE32(a) ((((u32) (a)[3]) << 24) | (((u32) (a)[2]) << 16) | \ -+ (((u32) (a)[1]) << 8) | ((u32) (a)[0])) -+#define RTW_PUT_LE32(a, val) \ -+ do { \ -+ (a)[3] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[0] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define RTW_GET_BE64(a) ((((u64) (a)[0]) << 56) | (((u64) (a)[1]) << 48) | \ -+ (((u64) (a)[2]) << 40) | (((u64) (a)[3]) << 32) | \ -+ (((u64) (a)[4]) << 24) | (((u64) (a)[5]) << 16) | \ -+ (((u64) (a)[6]) << 8) | ((u64) (a)[7])) -+#define RTW_PUT_BE64(a, val) \ -+ do { \ -+ (a)[0] = (u8) (((u64) (val)) >> 56); \ -+ (a)[1] = (u8) (((u64) (val)) >> 48); \ -+ (a)[2] = (u8) (((u64) (val)) >> 40); \ -+ (a)[3] = (u8) (((u64) (val)) >> 32); \ -+ (a)[4] = (u8) (((u64) (val)) >> 24); \ -+ (a)[5] = (u8) (((u64) (val)) >> 16); \ -+ (a)[6] = (u8) (((u64) (val)) >> 8); \ -+ (a)[7] = (u8) (((u64) (val)) & 0xff); \ -+ } while (0) -+ -+#define RTW_GET_LE64(a) ((((u64) (a)[7]) << 56) | (((u64) (a)[6]) << 48) | \ -+ (((u64) (a)[5]) << 40) | (((u64) (a)[4]) << 32) | \ -+ (((u64) (a)[3]) << 24) | (((u64) (a)[2]) << 16) | \ -+ (((u64) (a)[1]) << 8) | ((u64) (a)[0])) -+ -+void rtw_buf_free(u8 **buf, u32 *buf_len); -+void rtw_buf_update(u8 **buf, u32 *buf_len, u8 *src, u32 src_len); -+ -+struct rtw_cbuf { -+ u32 write; -+ u32 read; -+ u32 size; -+ void *bufs[0]; -+}; -+ -+bool rtw_cbuf_full(struct rtw_cbuf *cbuf); -+bool rtw_cbuf_empty(struct rtw_cbuf *cbuf); -+bool rtw_cbuf_push(struct rtw_cbuf *cbuf, void *buf); -+void *rtw_cbuf_pop(struct rtw_cbuf *cbuf); -+struct rtw_cbuf *rtw_cbuf_alloc(u32 size); -+ -+/* String handler */ -+/* -+ * Write formatted output to sized buffer -+ */ -+#define rtw_sprintf(buf, size, format, arg...) snprintf(buf, size, format, ##arg) -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/osdep_service_linux.h linux/3rdparty/rtl8723bs/include/osdep_service_linux.h ---- linux.old/3rdparty/rtl8723bs/include/osdep_service_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/osdep_service_linux.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,178 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __OSDEP_LINUX_SERVICE_H_ -+#define __OSDEP_LINUX_SERVICE_H_ -+ -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ /* include */ -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include /* for struct tasklet_struct */ -+ #include -+ #include -+ #include -+ #include -+ -+/* #include */ -+ #include -+ #include -+ -+ typedef struct semaphore _sema; -+ typedef spinlock_t _lock; -+ typedef struct mutex _mutex; -+ typedef struct timer_list _timer; -+ -+ struct __queue { -+ struct list_head queue; -+ _lock lock; -+ }; -+ -+ typedef struct sk_buff _pkt; -+ typedef unsigned char _buffer; -+ -+ typedef int _OS_STATUS; -+ /* typedef u32 _irqL; */ -+ typedef unsigned long _irqL; -+ typedef struct net_device * _nic_hdl; -+ -+ #define thread_exit() complete_and_exit(NULL, 0) -+ -+ typedef void timer_hdl_return; -+ typedef void* timer_hdl_context; -+ -+ typedef struct work_struct _workitem; -+ -+__inline static struct list_head *get_next(struct list_head *list) -+{ -+ return list->next; -+} -+ -+__inline static struct list_head *get_list_head(struct __queue *queue) -+{ -+ return (&(queue->queue)); -+} -+ -+ -+#define LIST_CONTAINOR(ptr, type, member) \ -+ ((type *)((char *)(ptr)-(__kernel_size_t)(&((type *)0)->member))) -+ -+#define RTW_TIMER_HDL_ARGS void *FunctionContext -+ -+__inline static void _init_timer(_timer *ptimer, _nic_hdl nic_hdl, void *pfunc, void* cntx) -+{ -+ /* setup_timer(ptimer, pfunc, (u32)cntx); */ -+ ptimer->function = pfunc; -+ ptimer->data = (unsigned long)cntx; -+ init_timer(ptimer); -+} -+ -+__inline static void _set_timer(_timer *ptimer, u32 delay_time) -+{ -+ mod_timer(ptimer , (jiffies+(delay_time*HZ/1000))); -+} -+ -+__inline static void _cancel_timer(_timer *ptimer, u8 *bcancelled) -+{ -+ del_timer_sync(ptimer); -+ *bcancelled = true;/* true == 1; false == 0 */ -+} -+ -+ -+__inline static void _init_workitem(_workitem *pwork, void *pfunc, void *cntx) -+{ -+ INIT_WORK(pwork, pfunc); -+} -+ -+__inline static void _set_workitem(_workitem *pwork) -+{ -+ schedule_work(pwork); -+} -+ -+__inline static void _cancel_workitem_sync(_workitem *pwork) -+{ -+ cancel_work_sync(pwork); -+} -+ -+static inline int rtw_netif_queue_stopped(struct net_device *pnetdev) -+{ -+ return (netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 0)) && -+ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 1)) && -+ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 2)) && -+ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 3))); -+} -+ -+static inline void rtw_netif_wake_queue(struct net_device *pnetdev) -+{ -+ netif_tx_wake_all_queues(pnetdev); -+} -+ -+static inline void rtw_netif_start_queue(struct net_device *pnetdev) -+{ -+ netif_tx_start_all_queues(pnetdev); -+} -+ -+static inline void rtw_netif_stop_queue(struct net_device *pnetdev) -+{ -+ netif_tx_stop_all_queues(pnetdev); -+} -+ -+static inline void rtw_merge_string(char *dst, int dst_len, char *src1, char *src2) -+{ -+ int len = 0; -+ len += snprintf(dst+len, dst_len - len, "%s", src1); -+ len += snprintf(dst+len, dst_len - len, "%s", src2); -+} -+ -+#define rtw_signal_process(pid, sig) kill_pid(find_vpid((pid)), (sig), 1) -+ -+#define rtw_netdev_priv(netdev) (((struct rtw_netdev_priv_indicator *)netdev_priv(netdev))->priv) -+ -+#define NDEV_FMT "%s" -+#define NDEV_ARG(ndev) ndev->name -+#define ADPT_FMT "%s" -+#define ADPT_ARG(adapter) adapter->pnetdev->name -+#define FUNC_NDEV_FMT "%s(%s)" -+#define FUNC_NDEV_ARG(ndev) __func__, ndev->name -+#define FUNC_ADPT_FMT "%s(%s)" -+#define FUNC_ADPT_ARG(adapter) __func__, adapter->pnetdev->name -+ -+struct rtw_netdev_priv_indicator { -+ void *priv; -+ u32 sizeof_priv; -+}; -+struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv); -+extern struct net_device * rtw_alloc_etherdev(int sizeof_priv); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/recv_osdep.h linux/3rdparty/rtl8723bs/include/recv_osdep.h ---- linux.old/3rdparty/rtl8723bs/include/recv_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/recv_osdep.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RECV_OSDEP_H_ -+#define __RECV_OSDEP_H_ -+ -+ -+extern sint _rtw_init_recv_priv(struct recv_priv *precvpriv, struct adapter *padapter); -+extern void _rtw_free_recv_priv (struct recv_priv *precvpriv); -+ -+ -+extern s32 rtw_recv_entry(union recv_frame *precv_frame); -+extern int rtw_recv_indicatepkt(struct adapter *adapter, union recv_frame *precv_frame); -+extern void rtw_recv_returnpacket(_nic_hdl cnxt, _pkt *preturnedpkt); -+ -+extern void rtw_handle_tkip_mic_err(struct adapter *padapter, u8 bgroup); -+ -+int rtw_init_recv_priv(struct recv_priv *precvpriv, struct adapter *padapter); -+void rtw_free_recv_priv (struct recv_priv *precvpriv); -+ -+ -+int rtw_os_recv_resource_alloc(struct adapter *padapter, union recv_frame *precvframe); -+void rtw_os_recv_resource_free(struct recv_priv *precvpriv); -+ -+ -+void rtw_os_free_recvframe(union recv_frame *precvframe); -+ -+ -+int rtw_os_recvbuf_resource_free(struct adapter *padapter, struct recv_buf *precvbuf); -+ -+_pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, u16 nSubframe_Length, u8 *pdata); -+void rtw_os_recv_indicate_pkt(struct adapter *padapter, _pkt *pkt, struct rx_pkt_attrib *pattrib); -+ -+void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl); -+ -+ -+#endif /* */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtl8192c_recv.h linux/3rdparty/rtl8723bs/include/rtl8192c_recv.h ---- linux.old/3rdparty/rtl8723bs/include/rtl8192c_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtl8192c_recv.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,50 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTL8192C_RECV_H_ -+#define _RTL8192C_RECV_H_ -+ -+#define RECV_BLK_SZ 512 -+#define RECV_BLK_CNT 16 -+#define RECV_BLK_TH RECV_BLK_CNT -+ -+#define MAX_RECVBUF_SZ (10240) -+ -+struct phy_stat -+{ -+ unsigned int phydw0; -+ -+ unsigned int phydw1; -+ -+ unsigned int phydw2; -+ -+ unsigned int phydw3; -+ -+ unsigned int phydw4; -+ -+ unsigned int phydw5; -+ -+ unsigned int phydw6; -+ -+ unsigned int phydw7; -+}; -+ -+/* Rx smooth factor */ -+#define Rx_Smooth_Factor (20) -+ -+ -+void rtl8192c_translate_rx_signal_stuff(union recv_frame *precvframe, struct phy_stat *pphy_status); -+void rtl8192c_query_rx_desc_status(union recv_frame *precvframe, struct recv_stat *pdesc); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtl8192c_rf.h linux/3rdparty/rtl8723bs/include/rtl8192c_rf.h ---- linux.old/3rdparty/rtl8723bs/include/rtl8192c_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtl8192c_rf.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,39 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTL8192C_RF_H_ -+#define _RTL8192C_RF_H_ -+ -+ -+/* */ -+/* RF RL6052 Series API */ -+/* */ -+void rtl8192c_RF_ChangeTxPath(struct adapter *Adapter, -+ u16 DataRate); -+void rtl8192c_PHY_RF6052SetBandwidth( -+ struct adapter * Adapter, -+ enum CHANNEL_WIDTH Bandwidth); -+void rtl8192c_PHY_RF6052SetCckTxPower( -+ struct adapter *Adapter, -+ u8* pPowerlevel); -+void rtl8192c_PHY_RF6052SetOFDMTxPower( -+ struct adapter *Adapter, -+ u8* pPowerLevel, -+ u8 Channel); -+int PHY_RF6052_Config8192C(struct adapter * Adapter ); -+ -+/*--------------------------Exported Function prototype---------------------*/ -+ -+ -+#endif/* End of HalRf.h */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtl8723b_cmd.h linux/3rdparty/rtl8723bs/include/rtl8723b_cmd.h ---- linux.old/3rdparty/rtl8723bs/include/rtl8723b_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtl8723b_cmd.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,199 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_CMD_H__ -+#define __RTL8723B_CMD_H__ -+ -+/* */ -+/* H2C CMD DEFINITION ------------------------------------------------ */ -+/* */ -+ -+enum h2c_cmd_8723B{ -+ /* Common Class: 000 */ -+ H2C_8723B_RSVD_PAGE = 0x00, -+ H2C_8723B_MEDIA_STATUS_RPT = 0x01, -+ H2C_8723B_SCAN_ENABLE = 0x02, -+ H2C_8723B_KEEP_ALIVE = 0x03, -+ H2C_8723B_DISCON_DECISION = 0x04, -+ H2C_8723B_PSD_OFFLOAD = 0x05, -+ H2C_8723B_AP_OFFLOAD = 0x08, -+ H2C_8723B_BCN_RSVDPAGE = 0x09, -+ H2C_8723B_PROBERSP_RSVDPAGE = 0x0A, -+ H2C_8723B_FCS_RSVDPAGE = 0x10, -+ H2C_8723B_FCS_INFO = 0x11, -+ H2C_8723B_AP_WOW_GPIO_CTRL = 0x13, -+ -+ /* PoweSave Class: 001 */ -+ H2C_8723B_SET_PWR_MODE = 0x20, -+ H2C_8723B_PS_TUNING_PARA = 0x21, -+ H2C_8723B_PS_TUNING_PARA2 = 0x22, -+ H2C_8723B_P2P_LPS_PARAM = 0x23, -+ H2C_8723B_P2P_PS_OFFLOAD = 0x24, -+ H2C_8723B_PS_SCAN_ENABLE = 0x25, -+ H2C_8723B_SAP_PS_ = 0x26, -+ H2C_8723B_INACTIVE_PS_ = 0x27, /* Inactive_PS */ -+ H2C_8723B_FWLPS_IN_IPS_ = 0x28, -+ -+ /* Dynamic Mechanism Class: 010 */ -+ H2C_8723B_MACID_CFG = 0x40, -+ H2C_8723B_TXBF = 0x41, -+ H2C_8723B_RSSI_SETTING = 0x42, -+ H2C_8723B_AP_REQ_TXRPT = 0x43, -+ H2C_8723B_INIT_RATE_COLLECT = 0x44, -+ -+ /* BT Class: 011 */ -+ H2C_8723B_B_TYPE_TDMA = 0x60, -+ H2C_8723B_BT_INFO = 0x61, -+ H2C_8723B_FORCE_BT_TXPWR = 0x62, -+ H2C_8723B_BT_IGNORE_WLANACT = 0x63, -+ H2C_8723B_DAC_SWING_VALUE = 0x64, -+ H2C_8723B_ANT_SEL_RSV = 0x65, -+ H2C_8723B_WL_OPMODE = 0x66, -+ H2C_8723B_BT_MP_OPER = 0x67, -+ H2C_8723B_BT_CONTROL = 0x68, -+ H2C_8723B_BT_WIFI_CTRL = 0x69, -+ H2C_8723B_BT_FW_PATCH = 0x6A, -+ H2C_8723B_BT_WLAN_CALIBRATION = 0x6D, -+ -+ /* WOWLAN Class: 100 */ -+ H2C_8723B_WOWLAN = 0x80, -+ H2C_8723B_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8723B_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8723B_AOAC_RSVD_PAGE = 0x83, -+ H2C_8723B_AOAC_RSVD_PAGE2 = 0x84, -+ H2C_8723B_D0_SCAN_OFFLOAD_CTRL = 0x85, -+ H2C_8723B_D0_SCAN_OFFLOAD_INFO = 0x86, -+ H2C_8723B_CHNL_SWITCH_OFFLOAD = 0x87, -+ -+ H2C_8723B_RESET_TSF = 0xC0, -+ H2C_8723B_MAXID, -+}; -+/* */ -+/* H2C CMD CONTENT -------------------------------------------------- */ -+/* */ -+/* _RSVDPAGE_LOC_CMD_0x00 */ -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+ -+/* _MEDIA_STATUS_RPT_PARM_CMD_0x01 */ -+#define SET_8723B_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8723B_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8723B_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+2, 0, 8, __Value) -+ -+/* _KEEP_ALIVE_CMD_0x03 */ -+#define SET_8723B_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8723B_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8723B_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8723B_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _DISCONNECT_DECISION_CMD_0x04 */ -+#define SET_8723B_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8723B_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8723B_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+2, 0, 8, __Value) -+ -+/* _PWR_MOD_CMD_0x20 */ -+#define SET_8723B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+5, 0, 8, __Value) -+ -+#define GET_8723B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+/* _PS_TUNE_PARAM_CMD_0x21 */ -+#define SET_8723B_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) -+#define SET_8723B_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) -+#define SET_8723B_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _MACID_CFG_CMD_0x40 */ -+#define SET_8723B_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) -+ -+/* _RSSI_SETTING_CMD_0x42 */ -+#define SET_8723B_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) -+#define SET_8723B_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _AP_REQ_TXRPT_CMD_0x43 */ -+#define SET_8723B_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _FORCE_BT_TXPWR_CMD_0x62 */ -+#define SET_8723B_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+ -+/* _FORCE_BT_MP_OPER_CMD_0x67 */ -+#define SET_8723B_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+ -+/* _BT_FW_PATCH_0x6A */ -+#define SET_8723B_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((u8 *)(__pH2CCmd), 0, 16, __Value) -+#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+/* */ -+/* Function Statement -------------------------------------------------- */ -+/* */ -+ -+/* host message to firmware cmd */ -+void rtl8723b_set_FwPwrMode_cmd(struct adapter *padapter, u8 Mode); -+void rtl8723b_set_FwJoinBssRpt_cmd(struct adapter *padapter, u8 mstatus); -+void rtl8723b_set_rssi_cmd(struct adapter *padapter, u8 *param); -+void rtl8723b_Add_RateATid(struct adapter *padapter, u32 bitmap, u8 *arg, u8 rssi_level); -+void rtl8723b_fw_try_ap_cmd(struct adapter *padapter, u32 need_ack); -+/* s32 rtl8723b_set_lowpwr_lps_cmd(struct adapter *padapter, u8 enable); */ -+void rtl8723b_set_FwPsTuneParam_cmd(struct adapter *padapter); -+void rtl8723b_set_FwMacIdConfig_cmd(struct adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); -+void rtl8723b_set_FwMediaStatusRpt_cmd(struct adapter *padapter, u8 mstatus, u8 macid); -+void rtl8723b_download_rsvd_page(struct adapter *padapter, u8 mstatus); -+void rtl8723b_download_BTCoex_AP_mode_rsvd_page(struct adapter *padapter); -+ -+void CheckFwRsvdPageContent(struct adapter *padapter); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void rtl8723b_set_wowlan_cmd(struct adapter *padapter, u8 enable); -+void rtl8723b_set_ap_wowlan_cmd(struct adapter *padapter, u8 enable); -+void SetFwRelatedForWoWLAN8723b(struct adapter *padapter, u8 bHostIsGoingtoSleep); -+#endif/* CONFIG_WOWLAN */ -+ -+void rtl8723b_set_FwPwrModeInIPS_cmd(struct adapter *padapter, u8 cmd_param); -+ -+s32 FillH2CCmd8723B(struct adapter *padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+ -+#define FillH2CCmd FillH2CCmd8723B -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtl8723b_dm.h linux/3rdparty/rtl8723bs/include/rtl8723b_dm.h ---- linux.old/3rdparty/rtl8723bs/include/rtl8723b_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtl8723b_dm.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_DM_H__ -+#define __RTL8723B_DM_H__ -+/* */ -+/* Description: */ -+/* */ -+/* This file is for 8723B dynamic mechanism only */ -+/* */ -+/* */ -+/* */ -+ -+/* */ -+/* structure and define */ -+/* */ -+ -+/* */ -+/* function prototype */ -+/* */ -+ -+void rtl8723b_init_dm_priv(struct adapter *padapter); -+ -+void rtl8723b_InitHalDm(struct adapter *padapter); -+void rtl8723b_HalDmWatchDog(struct adapter *padapter); -+void rtl8723b_HalDmWatchDog_in_LPS(struct adapter *padapter); -+void rtl8723b_hal_dm_in_lps(struct adapter *padapter); -+ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtl8723b_hal.h linux/3rdparty/rtl8723bs/include/rtl8723b_hal.h ---- linux.old/3rdparty/rtl8723bs/include/rtl8723b_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtl8723b_hal.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,279 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_HAL_H__ -+#define __RTL8723B_HAL_H__ -+ -+#include "hal_data.h" -+ -+#include "rtl8723b_spec.h" -+#include "rtl8723b_rf.h" -+#include "rtl8723b_dm.h" -+#include "rtl8723b_recv.h" -+#include "rtl8723b_xmit.h" -+#include "rtl8723b_cmd.h" -+#include "rtw_mp.h" -+#include "Hal8723BPwrSeq.h" -+#include "Hal8723BPhyReg.h" -+#include "Hal8723BPhyCfg.h" -+ -+/* */ -+/* RTL8723B From file */ -+/* */ -+ #define RTL8723B_FW_IMG "rtl8723b/FW_NIC.bin" -+ #define RTL8723B_FW_WW_IMG "rtl8723b/FW_WoWLAN.bin" -+ #define RTL8723B_PHY_REG "rtl8723b/PHY_REG.txt" -+ #define RTL8723B_PHY_RADIO_A "rtl8723b/RadioA.txt" -+ #define RTL8723B_PHY_RADIO_B "rtl8723b/RadioB.txt" -+ #define RTL8723B_TXPWR_TRACK "rtl8723b/TxPowerTrack.txt" -+ #define RTL8723B_AGC_TAB "rtl8723b/AGC_TAB.txt" -+ #define RTL8723B_PHY_MACREG "rtl8723b/MAC_REG.txt" -+ #define RTL8723B_PHY_REG_PG "rtl8723b/PHY_REG_PG.txt" -+ #define RTL8723B_PHY_REG_MP "rtl8723b/PHY_REG_MP.txt" -+ #define RTL8723B_TXPWR_LMT "rtl8723b/TXPWR_LMT.txt" -+ -+/* */ -+/* RTL8723B From header */ -+/* */ -+ -+#define FW_8723B_SIZE 0x8000 -+#define FW_8723B_START_ADDRESS 0x1000 -+#define FW_8723B_END_ADDRESS 0x1FFF /* 0x5FFF */ -+ -+#define IS_FW_HEADER_EXIST_8723B(_pFwHdr) ((le16_to_cpu(_pFwHdr->Signature)&0xFFF0) == 0x5300) -+ -+struct rt_firmware { -+ u32 ulFwLength; -+ u8 *szFwBuffer; -+}; -+ -+/* This structure must be cared byte-ordering */ -+struct rt_firmware_hdr { -+ /* 8-byte alinment required */ -+ -+ /* LONG WORD 0 ---- */ -+ __le16 Signature; /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ -+ u8 Category; /* AP/NIC and USB/PCI */ -+ u8 Function; /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ -+ __le16 Version; /* FW Version */ -+ __le16 Subversion; /* FW Subversion, default 0x00 */ -+ -+ /* LONG WORD 1 ---- */ -+ u8 Month; /* Release time Month field */ -+ u8 Date; /* Release time Date field */ -+ u8 Hour; /* Release time Hour field */ -+ u8 Minute; /* Release time Minute field */ -+ __le16 RamCodeSize; /* The size of RAM code */ -+ __le16 Rsvd2; -+ -+ /* LONG WORD 2 ---- */ -+ __le32 SvnIdx; /* The SVN entry index */ -+ __le32 Rsvd3; -+ -+ /* LONG WORD 3 ---- */ -+ __le32 Rsvd4; -+ __le32 Rsvd5; -+}; -+ -+#define DRIVER_EARLY_INT_TIME_8723B 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8723B 0x02 -+ -+/* for 8723B */ -+/* TX 32K, RX 16K, Page size 128B for TX, 8B for RX */ -+#define PAGE_SIZE_TX_8723B 128 -+#define PAGE_SIZE_RX_8723B 8 -+ -+#define RX_DMA_SIZE_8723B 0x4000 /* 16K */ -+#define RX_DMA_RESERVED_SIZE_8723B 0x80 /* 128B, reserved for tx report */ -+#define RX_DMA_BOUNDARY_8723B (RX_DMA_SIZE_8723B - RX_DMA_RESERVED_SIZE_8723B - 1) -+ -+ -+/* Note: We will divide number of page equally for each queue other than public queue! */ -+ -+/* For General Reserved Page Number(Beacon Queue is reserved page) */ -+/* Beacon:2, PS-Poll:1, Null Data:1, Qos Null Data:1, BT Qos Null Data:1 */ -+#define BCNQ_PAGE_NUM_8723B 0x08 -+#define BCNQ1_PAGE_NUM_8723B 0x00 -+ -+#ifdef CONFIG_PNO_SUPPORT -+#undef BCNQ1_PAGE_NUM_8723B -+#define BCNQ1_PAGE_NUM_8723B 0x00 /* 0x04 */ -+#endif -+#define MAX_RX_DMA_BUFFER_SIZE_8723B 0x2800 /* RX 10K */ -+ -+/* For WoWLan , more reserved page */ -+/* ARP Rsp:1, RWC:1, GTK Info:1, GTK RSP:2, GTK EXT MEM:2, PNO: 6 */ -+#ifdef CONFIG_WOWLAN -+#define WOWLAN_PAGE_NUM_8723B 0x07 -+#else -+#define WOWLAN_PAGE_NUM_8723B 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+#undef WOWLAN_PAGE_NUM_8723B -+#define WOWLAN_PAGE_NUM_8723B 0x0d -+#endif -+ -+#ifdef CONFIG_AP_WOWLAN -+#define AP_WOWLAN_PAGE_NUM_8723B 0x02 -+#endif -+ -+#define TX_TOTAL_PAGE_NUMBER_8723B (0xFF - BCNQ_PAGE_NUM_8723B - BCNQ1_PAGE_NUM_8723B - WOWLAN_PAGE_NUM_8723B) -+#define TX_PAGE_BOUNDARY_8723B (TX_TOTAL_PAGE_NUMBER_8723B + 1) -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723B TX_TOTAL_PAGE_NUMBER_8723B -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8723B (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723B + 1) -+ -+/* For Normal Chip Setting */ -+/* (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8723B */ -+#define NORMAL_PAGE_NUM_HPQ_8723B 0x0C -+#define NORMAL_PAGE_NUM_LPQ_8723B 0x02 -+#define NORMAL_PAGE_NUM_NPQ_8723B 0x02 -+ -+/* Note: For Normal Chip Setting, modify later */ -+#define WMM_NORMAL_PAGE_NUM_HPQ_8723B 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8723B 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8723B 0x20 -+ -+ -+#include "HalVerDef.h" -+#include "hal_com.h" -+ -+#define EFUSE_OOB_PROTECT_BYTES 15 -+ -+#define HAL_EFUSE_MEMORY -+ -+#define HWSET_MAX_SIZE_8723B 512 -+#define EFUSE_REAL_CONTENT_LEN_8723B 512 -+#define EFUSE_MAP_LEN_8723B 512 -+#define EFUSE_MAX_SECTION_8723B 64 -+ -+#define EFUSE_IC_ID_OFFSET 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ -+#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8723B) -+ -+#define EFUSE_ACCESS_ON 0x69 /* For RTL8723 only. */ -+#define EFUSE_ACCESS_OFF 0x00 /* For RTL8723 only. */ -+ -+/* */ -+/* EFUSE for BT definition */ -+/* */ -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN 512 -+#define EFUSE_BT_REAL_CONTENT_LEN 1536 /* 512*3 */ -+#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ -+#define EFUSE_BT_MAX_SECTION 128 /* 1024/8 */ -+ -+#define EFUSE_PROTECT_BYTES_BANK 16 -+ -+/* Description: Determine the types of C2H events that are the same in driver and Fw. */ -+/* Fisrt constructed by tynli. 2009.10.09. */ -+typedef enum _C2H_EVT -+{ -+ C2H_DBG = 0, -+ C2H_TSF = 1, -+ C2H_AP_RPT_RSP = 2, -+ C2H_CCX_TX_RPT = 3, /* The FW notify the report of the specific tx packet. */ -+ C2H_BT_RSSI = 4, -+ C2H_BT_OP_MODE = 5, -+ C2H_EXT_RA_RPT = 6, -+ C2H_8723B_BT_INFO = 9, -+ C2H_HW_INFO_EXCH = 10, -+ C2H_8723B_BT_MP_INFO = 11, -+ MAX_C2HEVENT -+} C2H_EVT; -+ -+typedef struct _C2H_EVT_HDR -+{ -+ u8 CmdID; -+ u8 CmdLen; -+ u8 CmdSeq; -+} __attribute__((__packed__)) C2H_EVT_HDR, *PC2H_EVT_HDR; -+ -+typedef enum tag_Package_Definition -+{ -+ PACKAGE_DEFAULT, -+ PACKAGE_QFN68, -+ PACKAGE_TFBGA90, -+ PACKAGE_TFBGA80, -+ PACKAGE_TFBGA79 -+}PACKAGE_TYPE_E; -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+/* rtl8723a_hal_init.c */ -+s32 rtl8723b_FirmwareDownload(struct adapter *padapter, bool bUsedWoWLANFw); -+void rtl8723b_FirmwareSelfReset(struct adapter *padapter); -+void rtl8723b_InitializeFirmwareVars(struct adapter *padapter); -+ -+void rtl8723b_InitAntenna_Selection(struct adapter *padapter); -+void rtl8723b_init_default_value(struct adapter *padapter); -+ -+s32 rtl8723b_InitLLTTable(struct adapter *padapter); -+ -+/* EFuse */ -+u8 GetEEPROMSize8723B(struct adapter *padapter); -+void Hal_InitPGData(struct adapter *padapter, u8 *PROMContent); -+void Hal_EfuseParseIDCode(struct adapter *padapter, u8 *hwinfo); -+void Hal_EfuseParseTxPowerInfo_8723B(struct adapter *padapter, u8 *PROMContent, bool AutoLoadFail); -+void Hal_EfuseParseBTCoexistInfo_8723B(struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail); -+void Hal_EfuseParseEEPROMVer_8723B(struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail); -+void Hal_EfuseParseChnlPlan_8723B(struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail); -+void Hal_EfuseParseCustomerID_8723B(struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail); -+void Hal_EfuseParseAntennaDiversity_8723B(struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail); -+void Hal_EfuseParseXtal_8723B(struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail); -+void Hal_EfuseParseThermalMeter_8723B(struct adapter *padapter, u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParsePackageType_8723B(struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail); -+void Hal_EfuseParseVoltage_8723B(struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail); -+ -+void C2HPacketHandler_8723B(struct adapter *padapter, u8 *pbuffer, u16 length); -+ -+void rtl8723b_set_hal_ops(struct hal_ops *pHalFunc); -+void SetHwReg8723B(struct adapter *padapter, u8 variable, u8 *val); -+void GetHwReg8723B(struct adapter *padapter, u8 variable, u8 *val); -+u8 SetHalDefVar8723B(struct adapter *padapter, enum HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8723B(struct adapter *padapter, enum HAL_DEF_VARIABLE variable, void *pval); -+ -+/* register */ -+void rtl8723b_InitBeaconParameters(struct adapter *padapter); -+void _InitBurstPktLen_8723BS(struct adapter * Adapter); -+void _8051Reset8723(struct adapter *padapter); -+#ifdef CONFIG_WOWLAN -+void Hal_DetectWoWMode(struct adapter *padapter); -+#endif /* CONFIG_WOWLAN */ -+ -+void rtl8723b_start_thread(struct adapter *padapter); -+void rtl8723b_stop_thread(struct adapter *padapter); -+ -+#if defined(CONFIG_CHECK_BT_HANG) -+void rtl8723bs_init_checkbthang_workqueue(struct adapter * adapter); -+void rtl8723bs_free_checkbthang_workqueue(struct adapter * adapter); -+void rtl8723bs_cancle_checkbthang_workqueue(struct adapter * adapter); -+void rtl8723bs_hal_check_bt_hang(struct adapter * adapter); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+void HalSetOutPutGPIO(struct adapter *padapter, u8 index, u8 OutPutValue); -+#endif -+ -+int FirmwareDownloadBT(struct adapter * Adapter, struct rt_firmware *firmware); -+ -+void CCX_FwC2HTxRpt_8723b(struct adapter *padapter, u8 *pdata, u8 len); -+s32 c2h_id_filter_ccx_8723b(u8 *buf); -+s32 c2h_handler_8723b(struct adapter *padapter, u8 *pC2hEvent); -+u8 MRateToHwRate8723B(u8 rate); -+u8 HwRateToMRate8723B(u8 rate); -+ -+void Hal_ReadRFGainOffset(struct adapter *padapter, u8 *hwinfo, bool AutoLoadFail); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtl8723b_recv.h linux/3rdparty/rtl8723bs/include/rtl8723b_recv.h ---- linux.old/3rdparty/rtl8723bs/include/rtl8723b_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtl8723b_recv.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,144 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_RECV_H__ -+#define __RTL8723B_RECV_H__ -+ -+#include -+ -+typedef struct rxreport_8723b -+{ -+ /* DWORD 0 */ -+ u32 pktlen:14; -+ u32 crc32:1; -+ u32 icverr:1; -+ u32 drvinfosize:4; -+ u32 security:3; -+ u32 qos:1; -+ u32 shift:2; -+ u32 physt:1; -+ u32 swdec:1; -+ u32 rsvd0028:2; -+ u32 eor:1; -+ u32 rsvd0031:1; -+ -+ /* DWORD 1 */ -+ u32 macid:7; -+ u32 rsvd0407:1; -+ u32 tid:4; -+ u32 macid_vld:1; -+ u32 amsdu:1; -+ u32 rxid_match:1; -+ u32 paggr:1; -+ u32 a1fit:4; -+ u32 chkerr:1; /* 20 */ -+ u32 rx_ipv:1; -+ u32 rx_is_tcp_udp:1; -+ u32 chk_vld:1; /* 23 */ -+ u32 pam:1; -+ u32 pwr:1; -+ u32 md:1; -+ u32 mf:1; -+ u32 type:2; -+ u32 mc:1; -+ u32 bc:1; -+ -+ /* DWORD 2 */ -+ u32 seq:12; -+ u32 frag:4; -+ u32 rx_is_qos:1; -+ u32 rsvd0817:1; -+ u32 wlanhd_iv_len:6; -+ u32 hwrsvd0824:4; -+ u32 c2h_ind:1; -+ u32 rsvd0829:2; -+ u32 fcs_ok:1; -+ -+ /* DWORD 3 */ -+ u32 rx_rate:7; -+ u32 rsvd1207:3; -+ u32 htc:1; -+ u32 esop:1; -+ u32 bssid_fit:2; -+ u32 rsvd1214:2; -+ u32 dma_agg_num:8; -+ u32 rsvd1224:5; -+ u32 patternmatch:1; -+ u32 unicastwake:1; -+ u32 magicwake:1; -+ -+ /* DWORD 4 */ -+ u32 splcp:1; /* Ofdm sgi or cck_splcp */ -+ u32 ldpc:1; -+ u32 stbc:1; -+ u32 not_sounding:1; -+ u32 bw:2; -+ u32 rsvd1606:26; -+ -+ /* DWORD 5 */ -+ u32 tsfl; -+} RXREPORT, *PRXREPORT; -+ -+typedef struct phystatus_8723b -+{ -+ u32 rxgain_a:7; -+ u32 trsw_a:1; -+ u32 rxgain_b:7; -+ u32 trsw_b:1; -+ u32 chcorr_l:16; -+ -+ u32 sigqualcck:8; -+ u32 cfo_a:8; -+ u32 cfo_b:8; -+ u32 chcorr_h:8; -+ -+ u32 noisepwrdb_h:8; -+ u32 cfo_tail_a:8; -+ u32 cfo_tail_b:8; -+ u32 rsvd0824:8; -+ -+ u32 rsvd1200:8; -+ u32 rxevm_a:8; -+ u32 rxevm_b:8; -+ u32 rxsnr_a:8; -+ -+ u32 rxsnr_b:8; -+ u32 noisepwrdb_l:8; -+ u32 rsvd1616:8; -+ u32 postsnr_a:8; -+ -+ u32 postsnr_b:8; -+ u32 csi_a:8; -+ u32 csi_b:8; -+ u32 targetcsi_a:8; -+ -+ u32 targetcsi_b:8; -+ u32 sigevm:8; -+ u32 maxexpwr:8; -+ u32 exintflag:1; -+ u32 sgien:1; -+ u32 rxsc:2; -+ u32 idlelong:1; -+ u32 anttrainen:1; -+ u32 antselb:1; -+ u32 antsel:1; -+} PHYSTATUS, *PPHYSTATUS; -+ -+s32 rtl8723bs_init_recv_priv(struct adapter *padapter); -+void rtl8723bs_free_recv_priv(struct adapter *padapter); -+ -+void rtl8723b_query_rx_phy_status(union recv_frame *prframe, struct phy_stat *pphy_stat); -+void rtl8723b_process_phy_info(struct adapter *padapter, void *prframe); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtl8723b_rf.h linux/3rdparty/rtl8723bs/include/rtl8723b_rf.h ---- linux.old/3rdparty/rtl8723bs/include/rtl8723b_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtl8723b_rf.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_RF_H__ -+#define __RTL8723B_RF_H__ -+ -+#include "rtl8192c_rf.h" -+ -+int PHY_RF6052_Config8723B(struct adapter *Adapter ); -+ -+void -+PHY_RF6052SetBandwidth8723B(struct adapter *Adapter, -+ enum CHANNEL_WIDTH Bandwidth); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtl8723b_spec.h linux/3rdparty/rtl8723bs/include/rtl8723b_spec.h ---- linux.old/3rdparty/rtl8723bs/include/rtl8723b_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtl8723b_spec.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,262 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *******************************************************************************/ -+#ifndef __RTL8723B_SPEC_H__ -+#define __RTL8723B_SPEC_H__ -+ -+#include -+ -+ -+#define HAL_NAV_UPPER_UNIT_8723B 128 /* micro-second */ -+ -+/* */ -+/* */ -+/* 0x0000h ~ 0x00FFh System Configuration */ -+/* */ -+/* */ -+#define REG_RSV_CTRL_8723B 0x001C /* 3 Byte */ -+#define REG_BT_WIFI_ANTENNA_SWITCH_8723B 0x0038 -+#define REG_HSISR_8723B 0x005c -+#define REG_PAD_CTRL1_8723B 0x0064 -+#define REG_AFE_CTRL_4_8723B 0x0078 -+#define REG_HMEBOX_DBG_0_8723B 0x0088 -+#define REG_HMEBOX_DBG_1_8723B 0x008A -+#define REG_HMEBOX_DBG_2_8723B 0x008C -+#define REG_HMEBOX_DBG_3_8723B 0x008E -+#define REG_HIMR0_8723B 0x00B0 -+#define REG_HISR0_8723B 0x00B4 -+#define REG_HIMR1_8723B 0x00B8 -+#define REG_HISR1_8723B 0x00BC -+#define REG_PMC_DBG_CTRL2_8723B 0x00CC -+ -+/* */ -+/* */ -+/* 0x0100h ~ 0x01FFh MACTOP General Configuration */ -+/* */ -+/* */ -+#define REG_C2HEVT_CMD_ID_8723B 0x01A0 -+#define REG_C2HEVT_CMD_LEN_8723B 0x01AE -+#define REG_WOWLAN_WAKE_REASON 0x01C7 -+#define REG_WOWLAN_GTK_DBG1 0x630 -+#define REG_WOWLAN_GTK_DBG2 0x634 -+ -+#define REG_HMEBOX_EXT0_8723B 0x01F0 -+#define REG_HMEBOX_EXT1_8723B 0x01F4 -+#define REG_HMEBOX_EXT2_8723B 0x01F8 -+#define REG_HMEBOX_EXT3_8723B 0x01FC -+ -+/* */ -+/* */ -+/* 0x0200h ~ 0x027Fh TXDMA Configuration */ -+/* */ -+/* */ -+ -+/* */ -+/* */ -+/* 0x0280h ~ 0x02FFh RXDMA Configuration */ -+/* */ -+/* */ -+#define REG_RXDMA_CONTROL_8723B 0x0286 /* Control the RX DMA. */ -+#define REG_RXDMA_MODE_CTRL_8723B 0x0290 -+ -+/* */ -+/* */ -+/* 0x0300h ~ 0x03FFh PCIe */ -+/* */ -+/* */ -+#define REG_PCIE_CTRL_REG_8723B 0x0300 -+#define REG_INT_MIG_8723B 0x0304 /* Interrupt Migration */ -+#define REG_BCNQ_DESA_8723B 0x0308 /* TX Beacon Descriptor Address */ -+#define REG_HQ_DESA_8723B 0x0310 /* TX High Queue Descriptor Address */ -+#define REG_MGQ_DESA_8723B 0x0318 /* TX Manage Queue Descriptor Address */ -+#define REG_VOQ_DESA_8723B 0x0320 /* TX VO Queue Descriptor Address */ -+#define REG_VIQ_DESA_8723B 0x0328 /* TX VI Queue Descriptor Address */ -+#define REG_BEQ_DESA_8723B 0x0330 /* TX BE Queue Descriptor Address */ -+#define REG_BKQ_DESA_8723B 0x0338 /* TX BK Queue Descriptor Address */ -+#define REG_RX_DESA_8723B 0x0340 /* RX Queue Descriptor Address */ -+#define REG_DBI_WDATA_8723B 0x0348 /* DBI Write Data */ -+#define REG_DBI_RDATA_8723B 0x034C /* DBI Read Data */ -+#define REG_DBI_ADDR_8723B 0x0350 /* DBI Address */ -+#define REG_DBI_FLAG_8723B 0x0352 /* DBI Read/Write Flag */ -+#define REG_MDIO_WDATA_8723B 0x0354 /* MDIO for Write PCIE PHY */ -+#define REG_MDIO_RDATA_8723B 0x0356 /* MDIO for Reads PCIE PHY */ -+#define REG_MDIO_CTL_8723B 0x0358 /* MDIO for Control */ -+#define REG_DBG_SEL_8723B 0x0360 /* Debug Selection Register */ -+#define REG_PCIE_HRPWM_8723B 0x0361 /* PCIe RPWM */ -+#define REG_PCIE_HCPWM_8723B 0x0363 /* PCIe CPWM */ -+#define REG_PCIE_MULTIFET_CTRL_8723B 0x036A /* PCIE Multi-Fethc Control */ -+ -+/* */ -+/* */ -+/* 0x0400h ~ 0x047Fh Protocol Configuration */ -+/* */ -+/* */ -+#define REG_TXPKTBUF_BCNQ_BDNY_8723B 0x0424 -+#define REG_TXPKTBUF_MGQ_BDNY_8723B 0x0425 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8723B 0x045D -+#ifdef CONFIG_WOWLAN -+#define REG_TXPKTBUF_IV_LOW 0x0484 -+#define REG_TXPKTBUF_IV_HIGH 0x0488 -+#endif -+#define REG_AMPDU_BURST_MODE_8723B 0x04BC -+ -+/* */ -+/* */ -+/* 0x0500h ~ 0x05FFh EDCA Configuration */ -+/* */ -+/* */ -+#define REG_SECONDARY_CCA_CTRL_8723B 0x0577 -+ -+/* */ -+/* */ -+/* 0x0600h ~ 0x07FFh WMAC Configuration */ -+/* */ -+/* */ -+ -+ -+/* */ -+/* SDIO Bus Specification */ -+/* */ -+ -+/* */ -+/* SDIO CMD Address Mapping */ -+/* */ -+ -+/* */ -+/* I/O bus domain (Host) */ -+/* */ -+ -+/* */ -+/* SDIO register */ -+/* */ -+#define SDIO_REG_HCPWM1_8723B 0x025 /* HCI Current Power Mode 1 */ -+ -+ -+/* */ -+/* 8723 Regsiter Bit and Content definition */ -+/* */ -+ -+/* 2 HSISR */ -+/* interrupt mask which needs to clear */ -+#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ -+ HSISR_SPS_OCP_INT |\ -+ HSISR_RON_INT |\ -+ HSISR_PDNINT |\ -+ HSISR_GPIO9_INT) -+ -+/* */ -+/* */ -+/* 0x0100h ~ 0x01FFh MACTOP General Configuration */ -+/* */ -+/* */ -+ -+ -+/* */ -+/* */ -+/* 0x0200h ~ 0x027Fh TXDMA Configuration */ -+/* */ -+/* */ -+ -+/* */ -+/* */ -+/* 0x0280h ~ 0x02FFh RXDMA Configuration */ -+/* */ -+/* */ -+#define BIT_USB_RXDMA_AGG_EN BIT(31) -+#define RXDMA_AGG_MODE_EN BIT(1) -+ -+#ifdef CONFIG_WOWLAN -+#define RXPKT_RELEASE_POLL BIT(16) -+#define RXDMA_IDLE BIT(17) -+#define RW_RELEASE_EN BIT(18) -+#endif -+ -+/* */ -+/* */ -+/* 0x0400h ~ 0x047Fh Protocol Configuration */ -+/* */ -+/* */ -+ -+/* */ -+/* 8723B REG_CCK_CHECK (offset 0x454) */ -+/* */ -+#define BIT_BCN_PORT_SEL BIT5 -+ -+/* */ -+/* */ -+/* 0x0500h ~ 0x05FFh EDCA Configuration */ -+/* */ -+/* */ -+ -+/* */ -+/* */ -+/* 0x0600h ~ 0x07FFh WMAC Configuration */ -+/* */ -+/* */ -+#define EEPROM_RF_GAIN_OFFSET 0xC1 -+#define EEPROM_RF_GAIN_VAL 0x1F6 -+ -+ -+/* */ -+/* 8195 IMR/ISR bits (offset 0xB0, 8bits) */ -+/* */ -+#define IMR_DISABLED_8723B 0 -+/* IMR DW0(0x00B0-00B3) Bit 0-31 */ -+#define IMR_TIMER2_8723B BIT31 /* Timeout interrupt 2 */ -+#define IMR_TIMER1_8723B BIT30 /* Timeout interrupt 1 */ -+#define IMR_PSTIMEOUT_8723B BIT29 /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_8723B BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_8723B BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TXBCN0ERR_8723B BIT26 /* Transmit Beacon0 Error */ -+#define IMR_TXBCN0OK_8723B BIT25 /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_8723B BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -+#define IMR_BCNDMAINT0_8723B BIT20 /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_8723B BIT16 /* Beacon Queue DMA OK0 */ -+#define IMR_HSISR_IND_ON_INT_8723B BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_8723B BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_8723B BIT12 /* CTWidnow End or ATIM Window End */ -+#define IMR_C2HCMD_8723B BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_8723B BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_8723B BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_8723B BIT7 /* High Queue DMA OK */ -+#define IMR_MGNTDOK_8723B BIT6 /* Management Queue DMA OK */ -+#define IMR_BKDOK_8723B BIT5 /* AC_BK DMA OK */ -+#define IMR_BEDOK_8723B BIT4 /* AC_BE DMA OK */ -+#define IMR_VIDOK_8723B BIT3 /* AC_VI DMA OK */ -+#define IMR_VODOK_8723B BIT2 /* AC_VO DMA OK */ -+#define IMR_RDU_8723B BIT1 /* Rx Descriptor Unavailable */ -+#define IMR_ROK_8723B BIT0 /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_8723B BIT27 /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_8723B BIT26 /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_8723B BIT25 /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_8723B BIT24 /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_8723B BIT23 /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_8723B BIT22 /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_8723B BIT21 /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_8723B BIT20 /* Beacon Queue DMA OK Interrup 7 */ -+#define IMR_BCNDOK6_8723B BIT19 /* Beacon Queue DMA OK Interrup 6 */ -+#define IMR_BCNDOK5_8723B BIT18 /* Beacon Queue DMA OK Interrup 5 */ -+#define IMR_BCNDOK4_8723B BIT17 /* Beacon Queue DMA OK Interrup 4 */ -+#define IMR_BCNDOK3_8723B BIT16 /* Beacon Queue DMA OK Interrup 3 */ -+#define IMR_BCNDOK2_8723B BIT15 /* Beacon Queue DMA OK Interrup 2 */ -+#define IMR_BCNDOK1_8723B BIT14 /* Beacon Queue DMA OK Interrup 1 */ -+#define IMR_ATIMEND_E_8723B BIT13 /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_8723B BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_8723B BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_8723B BIT9 /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_8723B BIT8 /* Receive FIFO Overflow */ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtl8723b_xmit.h linux/3rdparty/rtl8723bs/include/rtl8723b_xmit.h ---- linux.old/3rdparty/rtl8723bs/include/rtl8723b_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtl8723b_xmit.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,458 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_XMIT_H__ -+#define __RTL8723B_XMIT_H__ -+ -+/* */ -+/* Queue Select Value in TxDesc */ -+/* */ -+#define QSLT_BK 0x2/* 0x01 */ -+#define QSLT_BE 0x0 -+#define QSLT_VI 0x5/* 0x4 */ -+#define QSLT_VO 0x7/* 0x6 */ -+#define QSLT_BEACON 0x10 -+#define QSLT_HIGH 0x11 -+#define QSLT_MGNT 0x12 -+#define QSLT_CMD 0x13 -+ -+#define MAX_TID (15) -+ -+/* OFFSET 0 */ -+#define OFFSET_SZ 0 -+#define OFFSET_SHT 16 -+#define BMC BIT(24) -+#define LSG BIT(26) -+#define FSG BIT(27) -+#define OWN BIT(31) -+ -+ -+/* OFFSET 4 */ -+#define PKT_OFFSET_SZ 0 -+#define BK BIT(6) -+#define QSEL_SHT 8 -+#define Rate_ID_SHT 16 -+#define NAVUSEHDR BIT(20) -+#define PKT_OFFSET_SHT 26 -+#define HWPC BIT(31) -+ -+/* OFFSET 8 */ -+#define AGG_EN BIT(29) -+ -+/* OFFSET 12 */ -+#define SEQ_SHT 16 -+ -+/* OFFSET 16 */ -+#define QoS BIT(6) -+#define HW_SEQ_EN BIT(7) -+#define USERATE BIT(8) -+#define DISDATAFB BIT(10) -+#define DATA_SHORT BIT(24) -+#define DATA_BW BIT(25) -+ -+/* OFFSET 20 */ -+#define SGI BIT(6) -+ -+/* */ -+/* defined for TX DESC Operation */ -+/* */ -+typedef struct txdesc_8723b -+{ -+ /* Offset 0 */ -+ u32 pktlen:16; -+ u32 offset:8; -+ u32 bmc:1; -+ u32 htc:1; -+ u32 rsvd0026:1; -+ u32 rsvd0027:1; -+ u32 linip:1; -+ u32 noacm:1; -+ u32 gf:1; -+ u32 rsvd0031:1; -+ -+ /* Offset 4 */ -+ u32 macid:7; -+ u32 rsvd0407:1; -+ u32 qsel:5; -+ u32 rdg_nav_ext:1; -+ u32 lsig_txop_en:1; -+ u32 pifs:1; -+ u32 rate_id:5; -+ u32 en_desc_id:1; -+ u32 sectype:2; -+ u32 pkt_offset:5; /* unit: 8 bytes */ -+ u32 moredata:1; -+ u32 txop_ps_cap:1; -+ u32 txop_ps_mode:1; -+ -+ /* Offset 8 */ -+ u32 p_aid:9; -+ u32 rsvd0809:1; -+ u32 cca_rts:2; -+ u32 agg_en:1; -+ u32 rdg_en:1; -+ u32 null_0:1; -+ u32 null_1:1; -+ u32 bk:1; -+ u32 morefrag:1; -+ u32 raw:1; -+ u32 spe_rpt:1; -+ u32 ampdu_density:3; -+ u32 bt_null:1; -+ u32 g_id:6; -+ u32 rsvd0830:2; -+ -+ /* Offset 12 */ -+ u32 wheader_len:4; -+ u32 chk_en:1; -+ u32 early_rate:1; -+ u32 hw_ssn_sel:2; -+ u32 userate:1; -+ u32 disrtsfb:1; -+ u32 disdatafb:1; -+ u32 cts2self:1; -+ u32 rtsen:1; -+ u32 hw_rts_en:1; -+ u32 port_id:1; -+ u32 navusehdr:1; -+ u32 use_max_len:1; -+ u32 max_agg_num:5; -+ u32 ndpa:2; -+ u32 ampdu_max_time:8; -+ -+ /* Offset 16 */ -+ u32 datarate:7; -+ u32 try_rate:1; -+ u32 data_ratefb_lmt:5; -+ u32 rts_ratefb_lmt:4; -+ u32 rty_lmt_en:1; -+ u32 data_rt_lmt:6; -+ u32 rtsrate:5; -+ u32 pcts_en:1; -+ u32 pcts_mask_idx:2; -+ -+ /* Offset 20 */ -+ u32 data_sc:4; -+ u32 data_short:1; -+ u32 data_bw:2; -+ u32 data_ldpc:1; -+ u32 data_stbc:2; -+ u32 vcs_stbc:2; -+ u32 rts_short:1; -+ u32 rts_sc:4; -+ u32 rsvd2016:7; -+ u32 tx_ant:4; -+ u32 txpwr_offset:3; -+ u32 rsvd2031:1; -+ -+ /* Offset 24 */ -+ u32 sw_define:12; -+ u32 mbssid:4; -+ u32 antsel_A:3; -+ u32 antsel_B:3; -+ u32 antsel_C:3; -+ u32 antsel_D:3; -+ u32 rsvd2428:4; -+ -+ /* Offset 28 */ -+ u32 checksum:16; -+ u32 rsvd2816:8; -+ u32 usb_txagg_num:8; -+ -+ /* Offset 32 */ -+ u32 rts_rc:6; -+ u32 bar_rty_th:2; -+ u32 data_rc:6; -+ u32 rsvd3214:1; -+ u32 en_hwseq:1; -+ u32 nextneadpage:8; -+ u32 tailpage:8; -+ -+ /* Offset 36 */ -+ u32 padding_len:11; -+ u32 txbf_path:1; -+ u32 seq:12; -+ u32 final_data_rate:8; -+}TXDESC_8723B, *PTXDESC_8723B; -+ -+#ifndef __INC_HAL8723BDESC_H -+#define __INC_HAL8723BDESC_H -+ -+#define RX_STATUS_DESC_SIZE_8723B 24 -+#define RX_DRV_INFO_SIZE_UNIT_8723B 8 -+ -+ -+/* DWORD 0 */ -+#define SET_RX_STATUS_DESC_PKT_LEN_8723B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_8723B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_8723B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) -+ -+#define GET_RX_STATUS_DESC_PKT_LEN_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICV_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_LAST_SEG_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 28, 1) -+#define GET_RX_STATUS_DESC_FIRST_SEG_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 29, 1) -+#define GET_RX_STATUS_DESC_EOR_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_OWN_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+ -+/* DWORD 1 */ -+#define GET_RX_STATUS_DESC_MACID_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_TID_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_AMSDU_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_A1_FIT_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) -+#define GET_RX_STATUS_DESC_CHKERR_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_IPVER_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_IS_TCPUDP__8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_CHK_VLD_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_MC_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) -+ -+/* DWORD 2 */ -+#define GET_RX_STATUS_DESC_SEQ_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) -+#define GET_RX_STATUS_DESC_RX_IS_QOS_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_RPT_SEL_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) -+ -+/* DWORD 3 */ -+#define GET_RX_STATUS_DESC_RX_RATE_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_HTC_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) -+ -+/* DWORD 6 */ -+#define GET_RX_STATUS_DESC_SPLCP_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 1) -+#define GET_RX_STATUS_DESC_LDPC_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 1, 1) -+#define GET_RX_STATUS_DESC_STBC_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 2, 1) -+#define GET_RX_STATUS_DESC_BW_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 4, 2) -+ -+/* DWORD 5 */ -+#define GET_RX_STATUS_DESC_TSFL_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) -+ -+#define GET_RX_STATUS_DESC_BUFF_ADDR_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+#define GET_RX_STATUS_DESC_BUFF_ADDR64_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+#define SET_RX_STATUS_DESC_BUFF_ADDR_8723B(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) -+ -+ -+/* Dword 0 */ -+#define GET_TX_DESC_OWN_8723B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+#define SET_TX_DESC_PKT_SIZE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define SET_TX_DESC_OFFSET_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define SET_TX_DESC_BMC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_LAST_SEG_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+#define SET_TX_DESC_FIRST_SEG_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_LINIP_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+#define SET_TX_DESC_NO_ACM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+#define SET_TX_DESC_OWN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+/* Dword 1 */ -+#define SET_TX_DESC_MACID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+ -+ -+/* Dword 2 */ -+#define SET_TX_DESC_PAID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+#define SET_TX_DESC_CCA_RTS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_AGG_BREAK_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define SET_TX_DESC_RAW_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define SET_TX_DESC_SPE_RPT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_INT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_GID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+ -+ -+/* Dword 3 */ -+#define SET_TX_DESC_WHEADER_LEN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) -+#define SET_TX_DESC_CHK_EN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) -+#define SET_TX_DESC_EARLY_MODE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HWSEQ_SEL_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_NAV_USE_HDR_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_NDPA_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+/* Dword 4 */ -+#define SET_TX_DESC_TX_RATE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+ -+ -+/* Dword 5 */ -+#define SET_TX_DESC_DATA_SC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_LDPC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+#define SET_TX_DESC_DATA_STBC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_CTROL_STBC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+ -+ -+/* Dword 6 */ -+#define SET_TX_DESC_SW_DEFINE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_ANTSEL_A_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+#define SET_TX_DESC_ANTSEL_B_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) -+#define SET_TX_DESC_ANTSEL_C_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) -+#define SET_TX_DESC_ANTSEL_D_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) -+ -+/* Dword 7 */ -+#define SET_TX_DESC_TX_DESC_CHECKSUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#define SET_TX_DESC_USB_TXAGG_NUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+#define SET_TX_DESC_SDIO_TXSEQ_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) -+ -+/* Dword 8 */ -+#define SET_TX_DESC_HWSEQ_EN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+ -+/* Dword 9 */ -+#define SET_TX_DESC_SEQ_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+ -+/* Dword 10 */ -+#define SET_TX_DESC_TX_BUFFER_ADDRESS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) -+#define GET_TX_DESC_TX_BUFFER_ADDRESS_8723B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+40, 0, 32) -+ -+/* Dword 11 */ -+#define SET_TX_DESC_NEXT_DESC_ADDRESS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) -+ -+ -+#define SET_EARLYMODE_PKTNUM_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+#endif -+/* */ -+/* */ -+/* Rate */ -+/* */ -+/* */ -+/* CCK Rates, TxHT = 0 */ -+#define DESC8723B_RATE1M 0x00 -+#define DESC8723B_RATE2M 0x01 -+#define DESC8723B_RATE5_5M 0x02 -+#define DESC8723B_RATE11M 0x03 -+ -+/* OFDM Rates, TxHT = 0 */ -+#define DESC8723B_RATE6M 0x04 -+#define DESC8723B_RATE9M 0x05 -+#define DESC8723B_RATE12M 0x06 -+#define DESC8723B_RATE18M 0x07 -+#define DESC8723B_RATE24M 0x08 -+#define DESC8723B_RATE36M 0x09 -+#define DESC8723B_RATE48M 0x0a -+#define DESC8723B_RATE54M 0x0b -+ -+/* MCS Rates, TxHT = 1 */ -+#define DESC8723B_RATEMCS0 0x0c -+#define DESC8723B_RATEMCS1 0x0d -+#define DESC8723B_RATEMCS2 0x0e -+#define DESC8723B_RATEMCS3 0x0f -+#define DESC8723B_RATEMCS4 0x10 -+#define DESC8723B_RATEMCS5 0x11 -+#define DESC8723B_RATEMCS6 0x12 -+#define DESC8723B_RATEMCS7 0x13 -+#define DESC8723B_RATEMCS8 0x14 -+#define DESC8723B_RATEMCS9 0x15 -+#define DESC8723B_RATEMCS10 0x16 -+#define DESC8723B_RATEMCS11 0x17 -+#define DESC8723B_RATEMCS12 0x18 -+#define DESC8723B_RATEMCS13 0x19 -+#define DESC8723B_RATEMCS14 0x1a -+#define DESC8723B_RATEMCS15 0x1b -+#define DESC8723B_RATEVHTSS1MCS0 0x2c -+#define DESC8723B_RATEVHTSS1MCS1 0x2d -+#define DESC8723B_RATEVHTSS1MCS2 0x2e -+#define DESC8723B_RATEVHTSS1MCS3 0x2f -+#define DESC8723B_RATEVHTSS1MCS4 0x30 -+#define DESC8723B_RATEVHTSS1MCS5 0x31 -+#define DESC8723B_RATEVHTSS1MCS6 0x32 -+#define DESC8723B_RATEVHTSS1MCS7 0x33 -+#define DESC8723B_RATEVHTSS1MCS8 0x34 -+#define DESC8723B_RATEVHTSS1MCS9 0x35 -+#define DESC8723B_RATEVHTSS2MCS0 0x36 -+#define DESC8723B_RATEVHTSS2MCS1 0x37 -+#define DESC8723B_RATEVHTSS2MCS2 0x38 -+#define DESC8723B_RATEVHTSS2MCS3 0x39 -+#define DESC8723B_RATEVHTSS2MCS4 0x3a -+#define DESC8723B_RATEVHTSS2MCS5 0x3b -+#define DESC8723B_RATEVHTSS2MCS6 0x3c -+#define DESC8723B_RATEVHTSS2MCS7 0x3d -+#define DESC8723B_RATEVHTSS2MCS8 0x3e -+#define DESC8723B_RATEVHTSS2MCS9 0x3f -+ -+ -+#define RX_HAL_IS_CCK_RATE_8723B(pDesc)\ -+ (GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE1M ||\ -+ GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE2M ||\ -+ GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE5_5M ||\ -+ GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE11M) -+ -+ -+void rtl8723b_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); -+void rtl8723b_fill_fake_txdesc(struct adapter *padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+ -+s32 rtl8723bs_init_xmit_priv(struct adapter *padapter); -+void rtl8723bs_free_xmit_priv(struct adapter *padapter); -+s32 rtl8723bs_hal_xmit(struct adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtl8723bs_mgnt_xmit(struct adapter *padapter, struct xmit_frame *pmgntframe); -+s32 rtl8723bs_hal_xmitframe_enqueue(struct adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtl8723bs_xmit_buf_handler(struct adapter *padapter); -+int rtl8723bs_xmit_thread(void *context); -+#define hal_xmit_handler rtl8723bs_xmit_buf_handler -+ -+u8 BWMapping_8723B(struct adapter * Adapter, struct pkt_attrib *pattrib); -+u8 SCMapping_8723B(struct adapter * Adapter, struct pkt_attrib *pattrib); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_ap.h linux/3rdparty/rtl8723bs/include/rtw_ap.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_ap.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_ap.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,47 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_AP_H_ -+#define __RTW_AP_H_ -+ -+void init_mlme_ap_info(struct adapter *padapter); -+void free_mlme_ap_info(struct adapter *padapter); -+/* void update_BCNTIM(struct adapter *padapter); */ -+void update_beacon(struct adapter *padapter, u8 ie_id, u8 *oui, u8 tx); -+void add_RATid(struct adapter *padapter, struct sta_info *psta, u8 rssi_level); -+void expire_timeout_chk(struct adapter *padapter); -+void update_sta_info_apmode(struct adapter *padapter, struct sta_info *psta); -+void start_bss_network(struct adapter *padapter, u8 *pbuf); -+int rtw_check_beacon_data(struct adapter *padapter, u8 *pbuf, int len); -+void rtw_ap_restore_network(struct adapter *padapter); -+void rtw_set_macaddr_acl(struct adapter *padapter, int mode); -+int rtw_acl_add_sta(struct adapter *padapter, u8 *addr); -+int rtw_acl_remove_sta(struct adapter *padapter, u8 *addr); -+ -+u8 rtw_ap_set_pairwise_key(struct adapter *padapter, struct sta_info *psta); -+int rtw_ap_set_group_key(struct adapter *padapter, u8 *key, u8 alg, int keyid); -+int rtw_ap_set_wep_key(struct adapter *padapter, u8 *key, u8 keylen, int keyid, u8 set_tx); -+ -+void associated_clients_update(struct adapter *padapter, u8 updated); -+void bss_cap_update_on_sta_join(struct adapter *padapter, struct sta_info *psta); -+u8 bss_cap_update_on_sta_leave(struct adapter *padapter, struct sta_info *psta); -+void sta_info_update(struct adapter *padapter, struct sta_info *psta); -+void ap_sta_info_defer_update(struct adapter *padapter, struct sta_info *psta); -+u8 ap_free_sta(struct adapter *padapter, struct sta_info *psta, bool active, u16 reason); -+int rtw_sta_flush(struct adapter *padapter); -+void start_ap_mode(struct adapter *padapter); -+void stop_ap_mode(struct adapter *padapter); -+ -+#endif -+void update_bmc_sta(struct adapter *padapter); -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_beamforming.h linux/3rdparty/rtl8723bs/include/rtw_beamforming.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_beamforming.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_beamforming.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,135 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_BEAMFORMING_H_ -+#define __RTW_BEAMFORMING_H_ -+ -+#define BEAMFORMING_ENTRY_NUM 2 -+#define GET_BEAMFORM_INFO(_pmlmepriv) ((struct beamforming_info *)(&(_pmlmepriv)->beamforming_info)) -+ -+typedef enum _BEAMFORMING_ENTRY_STATE -+{ -+ BEAMFORMING_ENTRY_STATE_UNINITIALIZE, -+ BEAMFORMING_ENTRY_STATE_INITIALIZEING, -+ BEAMFORMING_ENTRY_STATE_INITIALIZED, -+ BEAMFORMING_ENTRY_STATE_PROGRESSING, -+ BEAMFORMING_ENTRY_STATE_PROGRESSED, -+}BEAMFORMING_ENTRY_STATE, *PBEAMFORMING_ENTRY_STATE; -+ -+ -+typedef enum _BEAMFORMING_STATE -+{ -+ BEAMFORMING_STATE_IDLE, -+ BEAMFORMING_STATE_START, -+ BEAMFORMING_STATE_END, -+}BEAMFORMING_STATE, *PBEAMFORMING_STATE; -+ -+ -+typedef enum _BEAMFORMING_CAP -+{ -+ BEAMFORMING_CAP_NONE = 0x0, -+ BEAMFORMER_CAP_HT_EXPLICIT = 0x1, -+ BEAMFORMEE_CAP_HT_EXPLICIT = 0x2, -+ BEAMFORMER_CAP_VHT_SU = 0x4, /* Self has er Cap, because Reg er & peer ee */ -+ BEAMFORMEE_CAP_VHT_SU = 0x8, /* Self has ee Cap, because Reg ee & peer er */ -+ BEAMFORMER_CAP = 0x10, -+ BEAMFORMEE_CAP = 0x20, -+}BEAMFORMING_CAP, *PBEAMFORMING_CAP; -+ -+ -+typedef enum _SOUNDING_MODE -+{ -+ SOUNDING_SW_VHT_TIMER = 0x0, -+ SOUNDING_SW_HT_TIMER = 0x1, -+ SOUNDING_STOP_All_TIMER = 0x2, -+ SOUNDING_HW_VHT_TIMER = 0x3, -+ SOUNDING_HW_HT_TIMER = 0x4, -+ SOUNDING_STOP_OID_TIMER = 0x5, -+ SOUNDING_AUTO_VHT_TIMER = 0x6, -+ SOUNDING_AUTO_HT_TIMER = 0x7, -+ SOUNDING_FW_VHT_TIMER = 0x8, -+ SOUNDING_FW_HT_TIMER = 0x9, -+}SOUNDING_MODE, *PSOUNDING_MODE; -+ -+ -+enum BEAMFORMING_CTRL_TYPE -+{ -+ BEAMFORMING_CTRL_ENTER = 0, -+ BEAMFORMING_CTRL_LEAVE = 1, -+ BEAMFORMING_CTRL_START_PERIOD = 2, -+ BEAMFORMING_CTRL_END_PERIOD = 3, -+ BEAMFORMING_CTRL_SOUNDING_FAIL =4, -+ BEAMFORMING_CTRL_SOUNDING_CLK =5, -+}; -+ -+struct beamforming_entry { -+ bool bUsed; -+ bool bSound; -+ u16 aid; /* Used to construct AID field of NDPA packet. */ -+ u16 mac_id; /* Used to Set Reg42C in IBSS mode. */ -+ u16 p_aid; /* Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ -+ u8 mac_addr[6];/* Used to fill Reg6E4 to fill Mac address of CSI report frame. */ -+ enum CHANNEL_WIDTH sound_bw; /* Sounding BandWidth */ -+ u16 sound_period; -+ BEAMFORMING_CAP beamforming_entry_cap; -+ BEAMFORMING_ENTRY_STATE beamforming_entry_state; -+ u8 LogSeq; -+ u8 LogRetryCnt; -+ u8 LogSuccessCnt; -+ u8 LogStatusFailCnt; -+ u8 PreCsiReport[327]; -+ u8 DefaultCsiCnt; -+ bool bDefaultCSI; -+}; -+ -+struct sounding_info { -+ u8 sound_idx; -+ enum CHANNEL_WIDTH sound_bw; -+ SOUNDING_MODE sound_mode; -+ u16 sound_period; -+}; -+ -+struct beamforming_info { -+ BEAMFORMING_CAP beamforming_cap; -+ BEAMFORMING_STATE beamforming_state; -+ struct beamforming_entry beamforming_entry[BEAMFORMING_ENTRY_NUM]; -+ u8 beamforming_cur_idx; -+ u8 beamforming_in_progress; -+ u8 sounding_sequence; -+ struct sounding_info sounding_info; -+}; -+ -+struct rtw_ndpa_sta_info { -+ u16 aid:12; -+ u16 feedback_type:1; -+ u16 nc_index:3; -+}; -+ -+BEAMFORMING_CAP beamforming_get_entry_beam_cap_by_mac_id(void *pmlmepriv , u8 mac_id); -+void beamforming_notify(struct adapter * adapter); -+BEAMFORMING_CAP beamforming_get_beamform_cap(struct beamforming_info *pBeamInfo); -+ -+u32 beamforming_get_report_frame(struct adapter * Adapter, union recv_frame *precv_frame); -+ -+bool beamforming_send_ht_ndpa_packet(struct adapter * Adapter, u8 *ra, enum CHANNEL_WIDTH bw, u8 qidx); -+bool beamforming_send_vht_ndpa_packet(struct adapter * Adapter, u8 *ra, u16 aid, enum CHANNEL_WIDTH bw, u8 qidx); -+ -+void beamforming_check_sounding_success(struct adapter * Adapter, bool status); -+ -+void beamforming_watchdog(struct adapter * Adapter); -+ -+void beamforming_wk_hdl(struct adapter *padapter, u8 type, u8 *pbuf); -+u8 beamforming_wk_cmd(struct adapter *padapter, s32 type, u8 *pbuf, s32 size, u8 enqueue); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_br_ext.h linux/3rdparty/rtl8723bs/include/rtw_br_ext.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_br_ext.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_br_ext.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,63 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_BR_EXT_H_ -+#define _RTW_BR_EXT_H_ -+ -+#define MACADDRLEN 6 -+#define _DEBUG_ERR DBG_8192C -+#define _DEBUG_INFO /* DBG_8192C */ -+#define DEBUG_WARN DBG_8192C -+#define DEBUG_INFO /* DBG_8192C */ -+#define DEBUG_ERR DBG_8192C -+/* define GET_MY_HWADDR ((GET_MIB(priv))->dot11OperationEntry.hwaddr) */ -+#define GET_MY_HWADDR(padapter) ((padapter)->eeprompriv.mac_addr) -+ -+#define NAT25_HASH_BITS 4 -+#define NAT25_HASH_SIZE (1 << NAT25_HASH_BITS) -+#define NAT25_AGEING_TIME 300 -+ -+#define MAX_NETWORK_ADDR_LEN 17 -+ -+struct nat25_network_db_entry -+{ -+ struct nat25_network_db_entry *next_hash; -+ struct nat25_network_db_entry **pprev_hash; -+ atomic_t use_count; -+ unsigned char macAddr[6]; -+ unsigned long ageing_timer; -+ unsigned char networkAddr[MAX_NETWORK_ADDR_LEN]; -+}; -+ -+enum NAT25_METHOD { -+ NAT25_MIN, -+ NAT25_CHECK, -+ NAT25_INSERT, -+ NAT25_LOOKUP, -+ NAT25_PARSE, -+ NAT25_MAX -+}; -+ -+struct br_ext_info { -+ unsigned int nat25_disable; -+ unsigned int macclone_enable; -+ unsigned int dhcp_bcst_disable; -+ int addPPPoETag; /* 1: Add PPPoE relay-SID, 0: disable */ -+ unsigned char nat25_dmzMac[MACADDRLEN]; -+ unsigned int nat25sc_disable; -+}; -+ -+void nat25_db_cleanup(struct adapter *priv); -+ -+#endif /* _RTW_BR_EXT_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_btcoex.h linux/3rdparty/rtl8723bs/include/rtw_btcoex.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_btcoex.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_btcoex.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,64 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_BTCOEX_H__ -+#define __RTW_BTCOEX_H__ -+ -+#include -+ -+ -+#define PACKET_NORMAL 0 -+#define PACKET_DHCP 1 -+#define PACKET_ARP 2 -+#define PACKET_EAPOL 3 -+ -+void rtw_btcoex_Initialize(struct adapter *); -+void rtw_btcoex_PowerOnSetting(struct adapter *padapter); -+void rtw_btcoex_HAL_Initialize(struct adapter *padapter, u8 bWifiOnly); -+void rtw_btcoex_IpsNotify(struct adapter *, u8 type); -+void rtw_btcoex_LpsNotify(struct adapter *, u8 type); -+void rtw_btcoex_ScanNotify(struct adapter *, u8 type); -+void rtw_btcoex_ConnectNotify(struct adapter *, u8 action); -+void rtw_btcoex_MediaStatusNotify(struct adapter *, u8 mediaStatus); -+void rtw_btcoex_SpecialPacketNotify(struct adapter *, u8 pktType); -+void rtw_btcoex_IQKNotify(struct adapter *padapter, u8 state); -+void rtw_btcoex_BtInfoNotify(struct adapter *, u8 length, u8 *tmpBuf); -+void rtw_btcoex_SuspendNotify(struct adapter *, u8 state); -+void rtw_btcoex_HaltNotify(struct adapter *); -+u8 rtw_btcoex_IsBtDisabled(struct adapter *); -+void rtw_btcoex_Handler(struct adapter *); -+s32 rtw_btcoex_IsBTCoexCtrlAMPDUSize(struct adapter *); -+void rtw_btcoex_SetManualControl(struct adapter *, u8 bmanual); -+u8 rtw_btcoex_IsBtControlLps(struct adapter *); -+u8 rtw_btcoex_IsLpsOn(struct adapter *); -+u8 rtw_btcoex_RpwmVal(struct adapter *); -+u8 rtw_btcoex_LpsVal(struct adapter *); -+void rtw_btcoex_SetBTCoexist(struct adapter *, u8 bBtExist); -+void rtw_btcoex_SetChipType(struct adapter *, u8 chipType); -+void rtw_btcoex_SetPGAntNum(struct adapter *, u8 antNum); -+void rtw_btcoex_SetSingleAntPath(struct adapter *padapter, u8 singleAntPath); -+u32 rtw_btcoex_GetRaMask(struct adapter *); -+void rtw_btcoex_RecordPwrMode(struct adapter *, u8 *pCmdBuf, u8 cmdLen); -+void rtw_btcoex_DisplayBtCoexInfo(struct adapter *, u8 *pbuf, u32 bufsize); -+void rtw_btcoex_SetDBG(struct adapter *, u32 *pDbgModule); -+u32 rtw_btcoex_GetDBG(struct adapter *, u8 *pStrBuf, u32 bufSize); -+ -+/* ================================================== */ -+/* Below Functions are called by BT-Coex */ -+/* ================================================== */ -+void rtw_btcoex_RejectApAggregatedPacket(struct adapter *, u8 enable); -+void rtw_btcoex_LPS_Enter(struct adapter *); -+void rtw_btcoex_LPS_Leave(struct adapter *); -+ -+#endif /* __RTW_BTCOEX_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_byteorder.h linux/3rdparty/rtl8723bs/include/rtw_byteorder.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_byteorder.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_byteorder.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTL871X_BYTEORDER_H_ -+#define _RTL871X_BYTEORDER_H_ -+ -+#if defined (__LITTLE_ENDIAN) -+#include -+#else -+# include -+#endif -+ -+#endif /* _RTL871X_BYTEORDER_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_cmd.h linux/3rdparty/rtl8723bs/include/rtw_cmd.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_cmd.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,980 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_CMD_H_ -+#define __RTW_CMD_H_ -+ -+ -+#define C2H_MEM_SZ (16*1024) -+ -+ #define FREE_CMDOBJ_SZ 128 -+ -+ #define MAX_CMDSZ 1024 -+ #define MAX_RSPSZ 512 -+ #define MAX_EVTSZ 1024 -+ -+ #define CMDBUFF_ALIGN_SZ 512 -+ -+ struct cmd_obj { -+ struct adapter *padapter; -+ u16 cmdcode; -+ u8 res; -+ u8 *parmbuf; -+ u32 cmdsz; -+ u8 *rsp; -+ u32 rspsz; -+ struct submit_ctx *sctx; -+ /* _sema cmd_sem; */ -+ struct list_head list; -+ }; -+ -+ /* cmd flags */ -+ enum { -+ RTW_CMDF_DIRECTLY = BIT0, -+ RTW_CMDF_WAIT_ACK = BIT1, -+ }; -+ -+ struct cmd_priv { -+ _sema cmd_queue_sema; -+ /* _sema cmd_done_sema; */ -+ _sema terminate_cmdthread_sema; -+ struct __queue cmd_queue; -+ u8 cmd_seq; -+ u8 *cmd_buf; /* shall be non-paged, and 4 bytes aligned */ -+ u8 *cmd_allocated_buf; -+ u8 *rsp_buf; /* shall be non-paged, and 4 bytes aligned */ -+ u8 *rsp_allocated_buf; -+ u32 cmd_issued_cnt; -+ u32 cmd_done_cnt; -+ u32 rsp_cnt; -+ atomic_t cmdthd_running; -+ /* u8 cmdthd_running; */ -+ u8 stop_req; -+ struct adapter *padapter; -+ _mutex sctx_mutex; -+ }; -+ -+ struct evt_priv { -+ _workitem c2h_wk; -+ bool c2h_wk_alive; -+ struct rtw_cbuf *c2h_queue; -+ #define C2H_QUEUE_MAX_LEN 10 -+ -+ atomic_t event_seq; -+ u8 *evt_buf; /* shall be non-paged, and 4 bytes aligned */ -+ u8 *evt_allocated_buf; -+ u32 evt_done_cnt; -+ u8 *c2h_mem; -+ u8 *allocated_c2h_mem; -+ }; -+ -+#define init_h2fwcmd_w_parm_no_rsp(pcmd, pparm, code) \ -+do {\ -+ INIT_LIST_HEAD(&pcmd->list);\ -+ pcmd->cmdcode = code;\ -+ pcmd->parmbuf = (u8 *)(pparm);\ -+ pcmd->cmdsz = sizeof (*pparm);\ -+ pcmd->rsp = NULL;\ -+ pcmd->rspsz = 0;\ -+} while (0) -+ -+#define init_h2fwcmd_w_parm_no_parm_rsp(pcmd, code) \ -+do {\ -+ INIT_LIST_HEAD(&pcmd->list);\ -+ pcmd->cmdcode = code;\ -+ pcmd->parmbuf = NULL;\ -+ pcmd->cmdsz = 0;\ -+ pcmd->rsp = NULL;\ -+ pcmd->rspsz = 0;\ -+} while (0) -+ -+struct c2h_evt_hdr { -+ u8 id:4; -+ u8 plen:4; -+ u8 seq; -+ u8 payload[0]; -+}; -+ -+struct c2h_evt_hdr_88xx { -+ u8 id; -+ u8 seq; -+ u8 payload[12]; -+ u8 plen; -+ u8 trigger; -+}; -+ -+#define c2h_evt_valid(c2h_evt) ((c2h_evt)->id || (c2h_evt)->plen) -+ -+struct P2P_PS_Offload_t { -+ u8 Offload_En:1; -+ u8 role:1; /* 1: Owner, 0: Client */ -+ u8 CTWindow_En:1; -+ u8 NoA0_En:1; -+ u8 NoA1_En:1; -+ u8 AllStaSleep:1; /* Only valid in Owner */ -+ u8 discovery:1; -+ u8 rsvd:1; -+}; -+ -+struct P2P_PS_CTWPeriod_t { -+ u8 CTWPeriod; /* TU */ -+}; -+ -+extern u32 rtw_enqueue_cmd(struct cmd_priv *pcmdpriv, struct cmd_obj *obj); -+extern struct cmd_obj *rtw_dequeue_cmd(struct cmd_priv *pcmdpriv); -+extern void rtw_free_cmd_obj(struct cmd_obj *pcmd); -+ -+void rtw_stop_cmd_thread(struct adapter *adapter); -+int rtw_cmd_thread(void *context); -+ -+extern u32 rtw_init_cmd_priv (struct cmd_priv *pcmdpriv); -+extern void rtw_free_cmd_priv (struct cmd_priv *pcmdpriv); -+ -+extern u32 rtw_init_evt_priv (struct evt_priv *pevtpriv); -+extern void rtw_free_evt_priv (struct evt_priv *pevtpriv); -+extern void rtw_evt_notify_isr(struct evt_priv *pevtpriv); -+ -+enum rtw_drvextra_cmd_id -+{ -+ NONE_WK_CID, -+ DYNAMIC_CHK_WK_CID, -+ DM_CTRL_WK_CID, -+ PBC_POLLING_WK_CID, -+ POWER_SAVING_CTRL_WK_CID,/* IPS, AUTOSuspend */ -+ LPS_CTRL_WK_CID, -+ ANT_SELECT_WK_CID, -+ P2P_PS_WK_CID, -+ P2P_PROTO_WK_CID, -+ CHECK_HIQ_WK_CID,/* for softap mode, check hi queue if empty */ -+ INTEl_WIDI_WK_CID, -+ C2H_WK_CID, -+ RTP_TIMER_CFG_WK_CID, -+ RESET_SECURITYPRIV, /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ FREE_ASSOC_RESOURCES, /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ DM_IN_LPS_WK_CID, -+ DM_RA_MSK_WK_CID, /* add for STA update RAMask when bandwith change. */ -+ BEAMFORMING_WK_CID, -+ LPS_CHANGE_DTIM_CID, -+ BTINFO_WK_CID, -+ MAX_WK_CID -+}; -+ -+enum LPS_CTRL_TYPE -+{ -+ LPS_CTRL_SCAN = 0, -+ LPS_CTRL_JOINBSS = 1, -+ LPS_CTRL_CONNECT =2, -+ LPS_CTRL_DISCONNECT =3, -+ LPS_CTRL_SPECIAL_PACKET =4, -+ LPS_CTRL_LEAVE =5, -+ LPS_CTRL_TRAFFIC_BUSY = 6, -+}; -+ -+enum RFINTFS { -+ SWSI, -+ HWSI, -+ HWPI, -+}; -+ -+/* -+Caller Mode: Infra, Ad-HoC(C) -+ -+Notes: To enter USB suspend mode -+ -+Command Mode -+ -+*/ -+struct usb_suspend_parm { -+ u32 action;/* 1: sleep, 0:resume */ -+}; -+ -+/* -+Caller Mode: Infra, Ad-HoC -+ -+Notes: To join a known BSS. -+ -+Command-Event Mode -+ -+*/ -+ -+/* -+Caller Mode: Infra, Ad-Hoc -+ -+Notes: To join the specified bss -+ -+Command Event Mode -+ -+*/ -+struct joinbss_parm { -+ struct wlan_bssid_ex network; -+}; -+ -+/* -+Caller Mode: Infra, Ad-HoC(C) -+ -+Notes: To disconnect the current associated BSS -+ -+Command Mode -+ -+*/ -+struct disconnect_parm { -+ u32 deauth_timeout_ms; -+}; -+ -+/* -+Caller Mode: AP, Ad-HoC(M) -+ -+Notes: To create a BSS -+ -+Command Mode -+*/ -+struct createbss_parm { -+ struct wlan_bssid_ex network; -+}; -+ -+/* -+Caller Mode: AP, Ad-HoC, Infra -+ -+Notes: To set the NIC mode of RTL8711 -+ -+Command Mode -+ -+The definition of mode: -+ -+#define IW_MODE_AUTO 0 Let the driver decides which AP to join -+#define IW_MODE_ADHOC 1 Single cell network (Ad-Hoc Clients) -+#define IW_MODE_INFRA 2 Multi cell network, roaming, .. -+#define IW_MODE_MASTER 3 Synchronisation master or Access Point -+#define IW_MODE_REPEAT 4 Wireless Repeater (forwarder) -+#define IW_MODE_SECOND 5 Secondary master/repeater (backup) -+#define IW_MODE_MONITOR 6 Passive monitor (listen only) -+ -+*/ -+struct setopmode_parm { -+ u8 mode; -+ u8 rsvd[3]; -+}; -+ -+/* -+Caller Mode: AP, Ad-HoC, Infra -+ -+Notes: To ask RTL8711 performing site-survey -+ -+Command-Event Mode -+ -+*/ -+ -+#define RTW_SSID_SCAN_AMOUNT 9 /* for WEXT_CSCAN_AMOUNT 9 */ -+#define RTW_CHANNEL_SCAN_AMOUNT (14+37) -+struct sitesurvey_parm { -+ sint scan_mode; /* active: 1, passive: 0 */ -+ u8 ssid_num; -+ u8 ch_num; -+ struct ndis_802_11_ssid ssid[RTW_SSID_SCAN_AMOUNT]; -+ struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To set the auth type of RTL8711. open/shared/802.1x -+ -+Command Mode -+ -+*/ -+struct setauth_parm { -+ u8 mode; /* 0: legacy open, 1: legacy shared 2: 802.1x */ -+ u8 _1x; /* 0: PSK, 1: TLS */ -+ u8 rsvd[2]; -+}; -+ -+/* -+Caller Mode: Infra -+ -+a. algorithm: wep40, wep104, tkip & aes -+b. keytype: grp key/unicast key -+c. key contents -+ -+when shared key ==> keyid is the camid -+when 802.1x ==> keyid [0:1] ==> grp key -+when 802.1x ==> keyid > 2 ==> unicast key -+ -+*/ -+struct setkey_parm { -+ u8 algorithm; /* encryption algorithm, could be none, wep40, TKIP, CCMP, wep104 */ -+ u8 keyid; -+ u8 grpkey; /* 1: this is the grpkey for 802.1x. 0: this is the unicast key for 802.1x */ -+ u8 set_tx; /* 1: main tx key for wep. 0: other key. */ -+ u8 key[16]; /* this could be 40 or 104 */ -+}; -+ -+/* -+When in AP or Ad-Hoc mode, this is used to -+allocate an sw/hw entry for a newly associated sta. -+ -+Command -+ -+when shared key ==> algorithm/keyid -+ -+*/ -+struct set_stakey_parm { -+ u8 addr[ETH_ALEN]; -+ u8 algorithm; -+ u8 keyid; -+ u8 key[16]; -+}; -+ -+struct set_stakey_rsp { -+ u8 addr[ETH_ALEN]; -+ u8 keyid; -+ u8 rsvd; -+}; -+ -+/* -+Caller Ad-Hoc/AP -+ -+Command -Rsp(AID == CAMID) mode -+ -+This is to force fw to add an sta_data entry per driver's request. -+ -+FW will write an cam entry associated with it. -+ -+*/ -+struct set_assocsta_parm { -+ u8 addr[ETH_ALEN]; -+}; -+ -+struct set_assocsta_rsp { -+ u8 cam_id; -+ u8 rsvd[3]; -+}; -+ -+/* -+ Caller Ad-Hoc/AP -+ -+ Command mode -+ -+ This is to force fw to del an sta_data entry per driver's request -+ -+ FW will invalidate the cam entry associated with it. -+ -+*/ -+struct del_assocsta_parm { -+ u8 addr[ETH_ALEN]; -+}; -+ -+/* -+Caller Mode: AP/Ad-HoC(M) -+ -+Notes: To notify fw that given staid has changed its power state -+ -+Command Mode -+ -+*/ -+struct setstapwrstate_parm { -+ u8 staid; -+ u8 status; -+ u8 hwaddr[6]; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To setup the basic rate of RTL8711 -+ -+Command Mode -+ -+*/ -+struct setbasicrate_parm { -+ u8 basicrates[NumRates]; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To read the current basic rate -+ -+Command-Rsp Mode -+ -+*/ -+struct getbasicrate_parm { -+ u32 rsvd; -+}; -+ -+struct getbasicrate_rsp { -+ u8 basicrates[NumRates]; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To setup the data rate of RTL8711 -+ -+Command Mode -+ -+*/ -+struct setdatarate_parm { -+ u8 mac_id; -+ u8 datarates[NumRates]; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To read the current data rate -+ -+Command-Rsp Mode -+ -+*/ -+struct getdatarate_parm { -+ u32 rsvd; -+ -+}; -+struct getdatarate_rsp { -+ u8 datarates[NumRates]; -+}; -+ -+ -+/* -+Caller Mode: Any -+AP: AP can use the info for the contents of beacon frame -+Infra: STA can use the info when sitesurveying -+Ad-HoC(M): Like AP -+Ad-HoC(C): Like STA -+ -+ -+Notes: To set the phy capability of the NIC -+ -+Command Mode -+ -+*/ -+ -+struct setphyinfo_parm { -+ struct regulatory_class class_sets[NUM_REGULATORYS]; -+ u8 status; -+}; -+ -+struct getphyinfo_parm { -+ u32 rsvd; -+}; -+ -+struct getphyinfo_rsp { -+ struct regulatory_class class_sets[NUM_REGULATORYS]; -+ u8 status; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To set the channel/modem/band -+This command will be used when channel/modem/band is changed. -+ -+Command Mode -+ -+*/ -+struct setphy_parm { -+ u8 rfchannel; -+ u8 modem; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To get the current setting of channel/modem/band -+ -+Command-Rsp Mode -+ -+*/ -+struct getphy_parm { -+ u32 rsvd; -+ -+}; -+struct getphy_rsp { -+ u8 rfchannel; -+ u8 modem; -+}; -+ -+struct readBB_parm { -+ u8 offset; -+}; -+struct readBB_rsp { -+ u8 value; -+}; -+ -+struct readTSSI_parm { -+ u8 offset; -+}; -+struct readTSSI_rsp { -+ u8 value; -+}; -+ -+struct writeBB_parm { -+ u8 offset; -+ u8 value; -+}; -+ -+struct readRF_parm { -+ u8 offset; -+}; -+struct readRF_rsp { -+ u32 value; -+}; -+ -+struct writeRF_parm { -+ u32 offset; -+ u32 value; -+}; -+ -+struct getrfintfs_parm { -+ u8 rfintfs; -+}; -+ -+ -+struct Tx_Beacon_param -+{ -+ struct wlan_bssid_ex network; -+}; -+ -+/* -+ Notes: This command is used for H2C/C2H loopback testing -+ -+ mac[0] == 0 -+ ==> CMD mode, return H2C_SUCCESS. -+ The following condition must be ture under CMD mode -+ mac[1] == mac[4], mac[2] == mac[3], mac[0]=mac[5]= 0; -+ s0 == 0x1234, s1 == 0xabcd, w0 == 0x78563412, w1 == 0x5aa5def7; -+ s2 == (b1 << 8 | b0); -+ -+ mac[0] == 1 -+ ==> CMD_RSP mode, return H2C_SUCCESS_RSP -+ -+ The rsp layout shall be: -+ rsp: parm: -+ mac[0] = mac[5]; -+ mac[1] = mac[4]; -+ mac[2] = mac[3]; -+ mac[3] = mac[2]; -+ mac[4] = mac[1]; -+ mac[5] = mac[0]; -+ s0 = s1; -+ s1 = swap16(s0); -+ w0 = swap32(w1); -+ b0 = b1 -+ s2 = s0 + s1 -+ b1 = b0 -+ w1 = w0 -+ -+ mac[0] == 2 -+ ==> CMD_EVENT mode, return H2C_SUCCESS -+ The event layout shall be: -+ event: parm: -+ mac[0] = mac[5]; -+ mac[1] = mac[4]; -+ mac[2] = event's sequence number, starting from 1 to parm's marc[3] -+ mac[3] = mac[2]; -+ mac[4] = mac[1]; -+ mac[5] = mac[0]; -+ s0 = swap16(s0) - event.mac[2]; -+ s1 = s1 + event.mac[2]; -+ w0 = swap32(w0); -+ b0 = b1 -+ s2 = s0 + event.mac[2] -+ b1 = b0 -+ w1 = swap32(w1) - event.mac[2]; -+ -+ parm->mac[3] is the total event counts that host requested. -+ -+ -+ event will be the same with the cmd's param. -+ -+*/ -+ -+/* CMD param Formart for driver extra cmd handler */ -+struct drvextra_cmd_parm { -+ int ec_id; /* extra cmd id */ -+ int type; /* Can use this field as the type id or command size */ -+ int size; /* buffer size */ -+ unsigned char *pbuf; -+}; -+ -+/*------------------- Below are used for RF/BB tunning ---------------------*/ -+ -+struct setantenna_parm { -+ u8 tx_antset; -+ u8 rx_antset; -+ u8 tx_antenna; -+ u8 rx_antenna; -+}; -+ -+struct enrateadaptive_parm { -+ u32 en; -+}; -+ -+struct settxagctbl_parm { -+ u32 txagc[MAX_RATES_LENGTH]; -+}; -+ -+struct gettxagctbl_parm { -+ u32 rsvd; -+}; -+struct gettxagctbl_rsp { -+ u32 txagc[MAX_RATES_LENGTH]; -+}; -+ -+struct setagcctrl_parm { -+ u32 agcctrl; /* 0: pure hw, 1: fw */ -+}; -+ -+ -+struct setssup_parm { -+ u32 ss_ForceUp[MAX_RATES_LENGTH]; -+}; -+ -+struct getssup_parm { -+ u32 rsvd; -+}; -+struct getssup_rsp { -+ u8 ss_ForceUp[MAX_RATES_LENGTH]; -+}; -+ -+ -+struct setssdlevel_parm { -+ u8 ss_DLevel[MAX_RATES_LENGTH]; -+}; -+ -+struct getssdlevel_parm { -+ u32 rsvd; -+}; -+struct getssdlevel_rsp { -+ u8 ss_DLevel[MAX_RATES_LENGTH]; -+}; -+ -+struct setssulevel_parm { -+ u8 ss_ULevel[MAX_RATES_LENGTH]; -+}; -+ -+struct getssulevel_parm { -+ u32 rsvd; -+}; -+struct getssulevel_rsp { -+ u8 ss_ULevel[MAX_RATES_LENGTH]; -+}; -+ -+ -+struct setcountjudge_parm { -+ u8 count_judge[MAX_RATES_LENGTH]; -+}; -+ -+struct getcountjudge_parm { -+ u32 rsvd; -+}; -+struct getcountjudge_rsp { -+ u8 count_judge[MAX_RATES_LENGTH]; -+}; -+ -+ -+struct setratable_parm { -+ u8 ss_ForceUp[NumRates]; -+ u8 ss_ULevel[NumRates]; -+ u8 ss_DLevel[NumRates]; -+ u8 count_judge[NumRates]; -+}; -+ -+struct getratable_parm { -+ uint rsvd; -+}; -+struct getratable_rsp { -+ u8 ss_ForceUp[NumRates]; -+ u8 ss_ULevel[NumRates]; -+ u8 ss_DLevel[NumRates]; -+ u8 count_judge[NumRates]; -+}; -+ -+ -+/* to get TX, RX retry count */ -+struct gettxretrycnt_parm{ -+ unsigned int rsvd; -+}; -+struct gettxretrycnt_rsp{ -+ unsigned long tx_retrycnt; -+}; -+ -+struct getrxretrycnt_parm{ -+ unsigned int rsvd; -+}; -+struct getrxretrycnt_rsp{ -+ unsigned long rx_retrycnt; -+}; -+ -+/* to get BCNOK, BCNERR count */ -+struct getbcnokcnt_parm{ -+ unsigned int rsvd; -+}; -+struct getbcnokcnt_rsp{ -+ unsigned long bcnokcnt; -+}; -+ -+struct getbcnerrcnt_parm{ -+ unsigned int rsvd; -+}; -+struct getbcnerrcnt_rsp{ -+ unsigned long bcnerrcnt; -+}; -+ -+/* to get current TX power level */ -+struct getcurtxpwrlevel_parm{ -+ unsigned int rsvd; -+}; -+struct getcurtxpwrlevel_rsp{ -+ unsigned short tx_power; -+}; -+ -+struct setprobereqextraie_parm { -+ unsigned char e_id; -+ unsigned char ie_len; -+ unsigned char ie[0]; -+}; -+ -+struct setassocreqextraie_parm { -+ unsigned char e_id; -+ unsigned char ie_len; -+ unsigned char ie[0]; -+}; -+ -+struct setproberspextraie_parm { -+ unsigned char e_id; -+ unsigned char ie_len; -+ unsigned char ie[0]; -+}; -+ -+struct setassocrspextraie_parm { -+ unsigned char e_id; -+ unsigned char ie_len; -+ unsigned char ie[0]; -+}; -+ -+ -+struct addBaReq_parm -+{ -+ unsigned int tid; -+ u8 addr[ETH_ALEN]; -+}; -+ -+/*H2C Handler index: 46 */ -+struct set_ch_parm { -+ u8 ch; -+ u8 bw; -+ u8 ch_offset; -+}; -+ -+/*H2C Handler index: 59 */ -+struct SetChannelPlan_param -+{ -+ u8 channel_plan; -+}; -+ -+/*H2C Handler index: 60 */ -+struct LedBlink_param -+{ -+ void *pLed; -+}; -+ -+/*H2C Handler index: 61 */ -+struct SetChannelSwitch_param -+{ -+ u8 new_ch_no; -+}; -+ -+/*H2C Handler index: 62 */ -+struct TDLSoption_param -+{ -+ u8 addr[ETH_ALEN]; -+ u8 option; -+}; -+ -+/*H2C Handler index: 64 */ -+struct RunInThread_param -+{ -+ void (*func)(void*); -+ void *context; -+}; -+ -+ -+#define GEN_CMD_CODE(cmd) cmd ## _CMD_ -+ -+ -+/* -+ -+Result: -+0x00: success -+0x01: sucess, and check Response. -+0x02: cmd ignored due to duplicated sequcne number -+0x03: cmd dropped due to invalid cmd code -+0x04: reserved. -+ -+*/ -+ -+#define H2C_RSP_OFFSET 512 -+ -+#define H2C_SUCCESS 0x00 -+#define H2C_SUCCESS_RSP 0x01 -+#define H2C_DUPLICATED 0x02 -+#define H2C_DROPPED 0x03 -+#define H2C_PARAMETERS_ERROR 0x04 -+#define H2C_REJECTED 0x05 -+#define H2C_CMD_OVERFLOW 0x06 -+#define H2C_RESERVED 0x07 -+ -+u8 rtw_sitesurvey_cmd(struct adapter *padapter, struct ndis_802_11_ssid *ssid, int ssid_num, struct rtw_ieee80211_channel *ch, int ch_num); -+extern u8 rtw_createbss_cmd(struct adapter *padapter); -+u8 rtw_startbss_cmd(struct adapter *padapter, int flags); -+ -+struct sta_info; -+extern u8 rtw_setstakey_cmd(struct adapter *padapter, struct sta_info *sta, u8 unicast_key, bool enqueue); -+extern u8 rtw_clearstakey_cmd(struct adapter *padapter, struct sta_info *sta, u8 enqueue); -+ -+extern u8 rtw_joinbss_cmd(struct adapter *padapter, struct wlan_network* pnetwork); -+u8 rtw_disassoc_cmd(struct adapter *padapter, u32 deauth_timeout_ms, bool enqueue); -+extern u8 rtw_setopmode_cmd(struct adapter *padapter, enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, bool enqueue); -+extern u8 rtw_setdatarate_cmd(struct adapter *padapter, u8 *rateset); -+extern u8 rtw_setrfintfs_cmd(struct adapter *padapter, u8 mode); -+ -+extern u8 rtw_gettssi_cmd(struct adapter *padapter, u8 offset, u8 *pval); -+extern u8 rtw_setfwdig_cmd(struct adapter *padapter, u8 type); -+extern u8 rtw_setfwra_cmd(struct adapter *padapter, u8 type); -+ -+extern u8 rtw_addbareq_cmd(struct adapter *padapter, u8 tid, u8 *addr); -+/* add for CONFIG_IEEE80211W, none 11w also can use */ -+extern u8 rtw_reset_securitypriv_cmd(struct adapter *padapter); -+extern u8 rtw_free_assoc_resources_cmd(struct adapter *padapter); -+extern u8 rtw_dynamic_chk_wk_cmd(struct adapter *adapter); -+ -+u8 rtw_lps_ctrl_wk_cmd(struct adapter *padapter, u8 lps_ctrl_type, u8 enqueue); -+u8 rtw_dm_in_lps_wk_cmd(struct adapter *padapter); -+ -+u8 rtw_dm_ra_mask_wk_cmd(struct adapter *padapter, u8 *psta); -+ -+extern u8 rtw_ps_cmd(struct adapter *padapter); -+ -+u8 rtw_chk_hi_queue_cmd(struct adapter *padapter); -+ -+extern u8 rtw_set_chplan_cmd(struct adapter *padapter, u8 chplan, u8 enqueue, u8 swconfig); -+ -+extern u8 rtw_c2h_packet_wk_cmd(struct adapter *padapter, u8 *pbuf, u16 length); -+extern u8 rtw_c2h_wk_cmd(struct adapter *padapter, u8 *c2h_evt); -+ -+u8 rtw_drvextra_cmd_hdl(struct adapter *padapter, unsigned char *pbuf); -+ -+extern void rtw_survey_cmd_callback(struct adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_disassoc_cmd_callback(struct adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_joinbss_cmd_callback(struct adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_createbss_cmd_callback(struct adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_getbbrfreg_cmdrsp_callback(struct adapter *padapter, struct cmd_obj *pcmd); -+ -+extern void rtw_setstaKey_cmdrsp_callback(struct adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_setassocsta_cmdrsp_callback(struct adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_getrttbl_cmdrsp_callback(struct adapter *padapter, struct cmd_obj *pcmd); -+ -+ -+struct _cmd_callback { -+ u32 cmd_code; -+ void (*callback)(struct adapter *padapter, struct cmd_obj *cmd); -+}; -+ -+enum rtw_h2c_cmd -+{ -+ GEN_CMD_CODE(_Read_MACREG) , /*0*/ -+ GEN_CMD_CODE(_Write_MACREG) , -+ GEN_CMD_CODE(_Read_BBREG) , -+ GEN_CMD_CODE(_Write_BBREG) , -+ GEN_CMD_CODE(_Read_RFREG) , -+ GEN_CMD_CODE(_Write_RFREG) , /*5*/ -+ GEN_CMD_CODE(_Read_EEPROM) , -+ GEN_CMD_CODE(_Write_EEPROM) , -+ GEN_CMD_CODE(_Read_EFUSE) , -+ GEN_CMD_CODE(_Write_EFUSE) , -+ -+ GEN_CMD_CODE(_Read_CAM) , /*10*/ -+ GEN_CMD_CODE(_Write_CAM) , -+ GEN_CMD_CODE(_setBCNITV), -+ GEN_CMD_CODE(_setMBIDCFG), -+ GEN_CMD_CODE(_JoinBss), /*14*/ -+ GEN_CMD_CODE(_DisConnect) , /*15*/ -+ GEN_CMD_CODE(_CreateBss) , -+ GEN_CMD_CODE(_SetOpMode) , -+ GEN_CMD_CODE(_SiteSurvey), /*18*/ -+ GEN_CMD_CODE(_SetAuth) , -+ -+ GEN_CMD_CODE(_SetKey) , /*20*/ -+ GEN_CMD_CODE(_SetStaKey) , -+ GEN_CMD_CODE(_SetAssocSta) , -+ GEN_CMD_CODE(_DelAssocSta) , -+ GEN_CMD_CODE(_SetStaPwrState) , -+ GEN_CMD_CODE(_SetBasicRate) , /*25*/ -+ GEN_CMD_CODE(_GetBasicRate) , -+ GEN_CMD_CODE(_SetDataRate) , -+ GEN_CMD_CODE(_GetDataRate) , -+ GEN_CMD_CODE(_SetPhyInfo) , -+ -+ GEN_CMD_CODE(_GetPhyInfo) , /*30*/ -+ GEN_CMD_CODE(_SetPhy) , -+ GEN_CMD_CODE(_GetPhy) , -+ GEN_CMD_CODE(_readRssi) , -+ GEN_CMD_CODE(_readGain) , -+ GEN_CMD_CODE(_SetAtim) , /*35*/ -+ GEN_CMD_CODE(_SetPwrMode) , -+ GEN_CMD_CODE(_JoinbssRpt), -+ GEN_CMD_CODE(_SetRaTable) , -+ GEN_CMD_CODE(_GetRaTable) , -+ -+ GEN_CMD_CODE(_GetCCXReport), /*40*/ -+ GEN_CMD_CODE(_GetDTMReport), -+ GEN_CMD_CODE(_GetTXRateStatistics), -+ GEN_CMD_CODE(_SetUsbSuspend), -+ GEN_CMD_CODE(_SetH2cLbk), -+ GEN_CMD_CODE(_AddBAReq) , /*45*/ -+ GEN_CMD_CODE(_SetChannel), /*46*/ -+ GEN_CMD_CODE(_SetTxPower), -+ GEN_CMD_CODE(_SwitchAntenna), -+ GEN_CMD_CODE(_SetCrystalCap), -+ GEN_CMD_CODE(_SetSingleCarrierTx), /*50*/ -+ -+ GEN_CMD_CODE(_SetSingleToneTx),/*51*/ -+ GEN_CMD_CODE(_SetCarrierSuppressionTx), -+ GEN_CMD_CODE(_SetContinuousTx), -+ GEN_CMD_CODE(_SwitchBandwidth), /*54*/ -+ GEN_CMD_CODE(_TX_Beacon), /*55*/ -+ -+ GEN_CMD_CODE(_Set_MLME_EVT), /*56*/ -+ GEN_CMD_CODE(_Set_Drv_Extra), /*57*/ -+ GEN_CMD_CODE(_Set_H2C_MSG), /*58*/ -+ -+ GEN_CMD_CODE(_SetChannelPlan), /*59*/ -+ GEN_CMD_CODE(_LedBlink), /*60*/ -+ -+ GEN_CMD_CODE(_SetChannelSwitch), /*61*/ -+ GEN_CMD_CODE(_TDLS), /*62*/ -+ GEN_CMD_CODE(_ChkBMCSleepq), /*63*/ -+ -+ GEN_CMD_CODE(_RunInThreadCMD), /*64*/ -+ -+ MAX_H2CCMD -+}; -+ -+#define _GetBBReg_CMD_ _Read_BBREG_CMD_ -+#define _SetBBReg_CMD_ _Write_BBREG_CMD_ -+#define _GetRFReg_CMD_ _Read_RFREG_CMD_ -+#define _SetRFReg_CMD_ _Write_RFREG_CMD_ -+ -+#endif /* _CMD_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_debug.h linux/3rdparty/rtl8723bs/include/rtw_debug.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_debug.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_debug.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,355 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_DEBUG_H__ -+#define __RTW_DEBUG_H__ -+ -+#include -+ -+#define _drv_always_ 1 -+#define _drv_emerg_ 2 -+#define _drv_alert_ 3 -+#define _drv_crit_ 4 -+#define _drv_err_ 5 -+#define _drv_warning_ 6 -+#define _drv_notice_ 7 -+#define _drv_info_ 8 -+#define _drv_dump_ 9 -+#define _drv_debug_ 10 -+ -+ -+#define _module_rtl871x_xmit_c_ BIT(0) -+#define _module_xmit_osdep_c_ BIT(1) -+#define _module_rtl871x_recv_c_ BIT(2) -+#define _module_recv_osdep_c_ BIT(3) -+#define _module_rtl871x_mlme_c_ BIT(4) -+#define _module_mlme_osdep_c_ BIT(5) -+#define _module_rtl871x_sta_mgt_c_ BIT(6) -+#define _module_rtl871x_cmd_c_ BIT(7) -+#define _module_cmd_osdep_c_ BIT(8) -+#define _module_rtl871x_io_c_ BIT(9) -+#define _module_io_osdep_c_ BIT(10) -+#define _module_os_intfs_c_ BIT(11) -+#define _module_rtl871x_security_c_ BIT(12) -+#define _module_rtl871x_eeprom_c_ BIT(13) -+#define _module_hal_init_c_ BIT(14) -+#define _module_hci_hal_init_c_ BIT(15) -+#define _module_rtl871x_ioctl_c_ BIT(16) -+#define _module_rtl871x_ioctl_set_c_ BIT(17) -+#define _module_rtl871x_ioctl_query_c_ BIT(18) -+#define _module_rtl871x_pwrctrl_c_ BIT(19) -+#define _module_hci_intfs_c_ BIT(20) -+#define _module_hci_ops_c_ BIT(21) -+#define _module_osdep_service_c_ BIT(22) -+#define _module_mp_ BIT(23) -+#define _module_hci_ops_os_c_ BIT(24) -+#define _module_rtl871x_ioctl_os_c BIT(25) -+#define _module_rtl8712_cmd_c_ BIT(26) -+/* define _module_efuse_ BIT(27) */ -+#define _module_rtl8192c_xmit_c_ BIT(28) -+#define _module_hal_xmit_c_ BIT(28) -+#define _module_efuse_ BIT(29) -+#define _module_rtl8712_recv_c_ BIT(30) -+#define _module_rtl8712_led_c_ BIT(31) -+ -+#undef _MODULE_DEFINE_ -+ -+#if defined _RTW_XMIT_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_xmit_c_ -+#elif defined _XMIT_OSDEP_C_ -+ #define _MODULE_DEFINE_ _module_xmit_osdep_c_ -+#elif defined _RTW_RECV_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_recv_c_ -+#elif defined _RECV_OSDEP_C_ -+ #define _MODULE_DEFINE_ _module_recv_osdep_c_ -+#elif defined _RTW_MLME_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_mlme_c_ -+#elif defined _MLME_OSDEP_C_ -+ #define _MODULE_DEFINE_ _module_mlme_osdep_c_ -+#elif defined _RTW_MLME_EXT_C_ -+ #define _MODULE_DEFINE_ 1 -+#elif defined _RTW_STA_MGT_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_sta_mgt_c_ -+#elif defined _RTW_CMD_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_cmd_c_ -+#elif defined _CMD_OSDEP_C_ -+ #define _MODULE_DEFINE_ _module_cmd_osdep_c_ -+#elif defined _RTW_IO_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_io_c_ -+#elif defined _IO_OSDEP_C_ -+ #define _MODULE_DEFINE_ _module_io_osdep_c_ -+#elif defined _OS_INTFS_C_ -+ #define _MODULE_DEFINE_ _module_os_intfs_c_ -+#elif defined _RTW_SECURITY_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_security_c_ -+#elif defined _RTW_EEPROM_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_eeprom_c_ -+#elif defined _HAL_INTF_C_ -+ #define _MODULE_DEFINE_ _module_hal_init_c_ -+#elif (defined _HCI_HAL_INIT_C_) || (defined _SDIO_HALINIT_C_) -+ #define _MODULE_DEFINE_ _module_hci_hal_init_c_ -+#elif defined _RTL871X_IOCTL_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_ioctl_c_ -+#elif defined _RTL871X_IOCTL_SET_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_ioctl_set_c_ -+#elif defined _RTL871X_IOCTL_QUERY_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_ioctl_query_c_ -+#elif defined _RTL871X_PWRCTRL_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_pwrctrl_c_ -+#elif defined _RTW_PWRCTRL_C_ -+ #define _MODULE_DEFINE_ 1 -+#elif defined _HCI_INTF_C_ -+ #define _MODULE_DEFINE_ _module_hci_intfs_c_ -+#elif defined _HCI_OPS_C_ -+ #define _MODULE_DEFINE_ _module_hci_ops_c_ -+#elif defined _SDIO_OPS_C_ -+ #define _MODULE_DEFINE_ 1 -+#elif defined _OSDEP_HCI_INTF_C_ -+ #define _MODULE_DEFINE_ _module_hci_intfs_c_ -+#elif defined _OSDEP_SERVICE_C_ -+ #define _MODULE_DEFINE_ _module_osdep_service_c_ -+#elif defined _HCI_OPS_OS_C_ -+ #define _MODULE_DEFINE_ _module_hci_ops_os_c_ -+#elif defined _RTL871X_IOCTL_LINUX_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_ioctl_os_c -+#elif defined _RTL8712_CMD_C_ -+ #define _MODULE_DEFINE_ _module_rtl8712_cmd_c_ -+#elif defined _RTL8192C_XMIT_C_ -+ #define _MODULE_DEFINE_ 1 -+#elif defined _RTL8723AS_XMIT_C_ -+ #define _MODULE_DEFINE_ 1 -+#elif defined _RTL8712_RECV_C_ -+ #define _MODULE_DEFINE_ _module_rtl8712_recv_c_ -+#elif defined _RTL8192CU_RECV_C_ -+ #define _MODULE_DEFINE_ _module_rtl8712_recv_c_ -+#elif defined _RTL871X_MLME_EXT_C_ -+ #define _MODULE_DEFINE_ _module_mlme_osdep_c_ -+#elif defined _RTW_EFUSE_C_ -+ #define _MODULE_DEFINE_ _module_efuse_ -+#endif -+ -+#define RT_TRACE(_Comp, _Level, Fmt) do{}while (0) -+#define RT_PRINT_DATA(_Comp, _Level, _TitleString, _HexData, _HexDataLen) do{}while (0) -+ -+#define DBG_871X(x, ...) do {} while (0) -+#define MSG_8192C(x, ...) do {} while (0) -+#define DBG_8192C(x,...) do {} while (0) -+#define DBG_871X_LEVEL(x,...) do {} while (0) -+ -+#undef _dbgdump -+ -+#ifndef _RTL871X_DEBUG_C_ -+ extern u32 GlobalDebugLevel; -+ extern u64 GlobalDebugComponents; -+#endif -+ -+#define _dbgdump printk -+ -+#define DRIVER_PREFIX "RTL8723BS: " -+ -+#if defined(_dbgdump) -+ -+/* with driver-defined prefix */ -+#undef DBG_871X_LEVEL -+#define DBG_871X_LEVEL(level, fmt, arg...) \ -+ do {\ -+ if (level <= GlobalDebugLevel) {\ -+ if (level <= _drv_err_ && level > _drv_always_) \ -+ _dbgdump(DRIVER_PREFIX"ERROR " fmt, ##arg);\ -+ else \ -+ _dbgdump(DRIVER_PREFIX fmt, ##arg);\ -+ }\ -+ }while (0) -+ -+/* without driver-defined prefix */ -+#undef _DBG_871X_LEVEL -+#define _DBG_871X_LEVEL(level, fmt, arg...) \ -+ do {\ -+ if (level <= GlobalDebugLevel) {\ -+ if (level <= _drv_err_ && level > _drv_always_) \ -+ _dbgdump("ERROR " fmt, ##arg);\ -+ else \ -+ _dbgdump(fmt, ##arg);\ -+ }\ -+ }while (0) -+ -+#define RTW_DBGDUMP NULL /* 'stream' for _dbgdump */ -+ -+/* dump message to selected 'stream' */ -+#define DBG_871X_SEL(sel, fmt, arg...) \ -+ do { \ -+ if (sel == RTW_DBGDUMP) \ -+ _DBG_871X_LEVEL(_drv_always_, fmt, ##arg); \ -+ else \ -+ seq_printf(sel, fmt, ##arg); \ -+ } while (0) -+ -+/* dump message to selected 'stream' with driver-defined prefix */ -+#define DBG_871X_SEL_NL(sel, fmt, arg...) \ -+ do { \ -+ if (sel == RTW_DBGDUMP) \ -+ DBG_871X_LEVEL(_drv_always_, fmt, ##arg); \ -+ else \ -+ seq_printf(sel, fmt, ##arg); \ -+ } while (0) -+ -+#endif /* defined(_dbgdump) */ -+ -+#ifdef CONFIG_DEBUG -+#if defined(_dbgdump) -+ #undef DBG_871X -+ #define DBG_871X(...) do {\ -+ _dbgdump(DRIVER_PREFIX __VA_ARGS__);\ -+ }while (0) -+ -+ #undef MSG_8192C -+ #define MSG_8192C(...) do {\ -+ _dbgdump(DRIVER_PREFIX __VA_ARGS__);\ -+ }while (0) -+ -+ #undef DBG_8192C -+ #define DBG_8192C(...) do {\ -+ _dbgdump(DRIVER_PREFIX __VA_ARGS__);\ -+ }while (0) -+#endif /* defined(_dbgdump) */ -+#endif /* CONFIG_DEBUG */ -+ -+#ifdef CONFIG_DEBUG_RTL871X -+ -+#if defined(_dbgdump) && defined(_MODULE_DEFINE_) -+ -+ #undef RT_TRACE -+ #define RT_TRACE(_Comp, _Level, Fmt)\ -+ do {\ -+ if ((_Comp & GlobalDebugComponents) && (_Level <= GlobalDebugLevel)) {\ -+ _dbgdump("%s [0x%08x,%d]", DRIVER_PREFIX, (unsigned int)_Comp, _Level);\ -+ _dbgdump Fmt;\ -+ }\ -+ }while (0) -+ -+#endif /* defined(_dbgdump) && defined(_MODULE_DEFINE_) */ -+ -+ -+#if defined(_dbgdump) -+ #undef RT_PRINT_DATA -+ #define RT_PRINT_DATA(_Comp, _Level, _TitleString, _HexData, _HexDataLen) \ -+ if (((_Comp) & GlobalDebugComponents) && (_Level <= GlobalDebugLevel)) \ -+ { \ -+ int __i; \ -+ u8 *ptr = (u8 *)_HexData; \ -+ _dbgdump("%s", DRIVER_PREFIX); \ -+ _dbgdump(_TitleString); \ -+ for (__i = 0; __i<(int)_HexDataLen; __i++) \ -+ { \ -+ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0)?" ":" "); \ -+ if (((__i + 1) % 16) == 0) _dbgdump("\n"); \ -+ } \ -+ _dbgdump("\n"); \ -+ } -+#endif /* defined(_dbgdump) */ -+#endif /* CONFIG_DEBUG_RTL871X */ -+ -+#ifdef CONFIG_DBG_COUNTER -+#define DBG_COUNTER(counter) counter++ -+#else -+#define DBG_COUNTER(counter) -+#endif -+ -+void dump_drv_version(void *sel); -+void dump_log_level(void *sel); -+ -+void sd_f0_reg_dump(void *sel, struct adapter *adapter); -+ -+void mac_reg_dump(void *sel, struct adapter *adapter); -+void bb_reg_dump(void *sel, struct adapter *adapter); -+void rf_reg_dump(void *sel, struct adapter *adapter); -+ -+#ifdef CONFIG_PROC_DEBUG -+ssize_t proc_set_write_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_read_reg(struct seq_file *m, void *v); -+ssize_t proc_set_read_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_fwstate(struct seq_file *m, void *v); -+int proc_get_sec_info(struct seq_file *m, void *v); -+int proc_get_mlmext_state(struct seq_file *m, void *v); -+ -+int proc_get_roam_flags(struct seq_file *m, void *v); -+ssize_t proc_set_roam_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_roam_param(struct seq_file *m, void *v); -+ssize_t proc_set_roam_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_roam_tgt_addr(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_qos_option(struct seq_file *m, void *v); -+int proc_get_ht_option(struct seq_file *m, void *v); -+int proc_get_rf_info(struct seq_file *m, void *v); -+int proc_get_survey_info(struct seq_file *m, void *v); -+int proc_get_ap_info(struct seq_file *m, void *v); -+int proc_get_adapter_state(struct seq_file *m, void *v); -+int proc_get_trx_info(struct seq_file *m, void *v); -+int proc_get_rate_ctl(struct seq_file *m, void *v); -+ssize_t proc_set_rate_ctl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_suspend_resume_info(struct seq_file *m, void *v); -+ -+ssize_t proc_set_fwdl_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_all_sta_info(struct seq_file *m, void *v); -+ -+int proc_get_rx_signal(struct seq_file *m, void *v); -+ssize_t proc_set_rx_signal(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_hw_status(struct seq_file *m, void *v); -+ -+int proc_get_ht_enable(struct seq_file *m, void *v); -+ssize_t proc_set_ht_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_bw_mode(struct seq_file *m, void *v); -+ssize_t proc_set_bw_mode(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_ampdu_enable(struct seq_file *m, void *v); -+ssize_t proc_set_ampdu_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_rx_ampdu(struct seq_file *m, void *v); -+ssize_t proc_set_rx_ampdu(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_rx_stbc(struct seq_file *m, void *v); -+ssize_t proc_set_rx_stbc(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_en_fwps(struct seq_file *m, void *v); -+ssize_t proc_set_en_fwps(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+/* int proc_get_two_path_rssi(struct seq_file *m, void *v); */ -+int proc_get_rssi_disp(struct seq_file *m, void *v); -+ssize_t proc_set_rssi_disp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_btcoex_dbg(struct seq_file *m, void *v); -+ssize_t proc_set_btcoex_dbg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_btcoex_info(struct seq_file *m, void *v); -+ -+int proc_get_odm_dbg_comp(struct seq_file *m, void *v); -+ssize_t proc_set_odm_dbg_comp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_odm_dbg_level(struct seq_file *m, void *v); -+ssize_t proc_set_odm_dbg_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_odm_adaptivity(struct seq_file *m, void *v); -+ssize_t proc_set_odm_adaptivity(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+#ifdef CONFIG_DBG_COUNTER -+int proc_get_rx_logs(struct seq_file *m, void *v); -+int proc_get_tx_logs(struct seq_file *m, void *v); -+int proc_get_int_logs(struct seq_file *m, void *v); -+#endif -+ -+#endif /* CONFIG_PROC_DEBUG */ -+ -+#endif /* __RTW_DEBUG_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_eeprom.h linux/3rdparty/rtl8723bs/include/rtw_eeprom.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_eeprom.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_eeprom.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,128 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_EEPROM_H__ -+#define __RTW_EEPROM_H__ -+ -+ -+#define RTL8712_EEPROM_ID 0x8712 -+/* define EEPROM_MAX_SIZE 256 */ -+ -+#define HWSET_MAX_SIZE_128 128 -+#define HWSET_MAX_SIZE_256 256 -+#define HWSET_MAX_SIZE_512 512 -+ -+#define EEPROM_MAX_SIZE HWSET_MAX_SIZE_512 -+ -+#define CLOCK_RATE 50 /* 100us */ -+ -+/* EEPROM opcodes */ -+#define EEPROM_READ_OPCODE 06 -+#define EEPROM_WRITE_OPCODE 05 -+#define EEPROM_ERASE_OPCODE 07 -+#define EEPROM_EWEN_OPCODE 19 /* Erase/write enable */ -+#define EEPROM_EWDS_OPCODE 16 /* Erase/write disable */ -+ -+/* Country codes */ -+#define USA 0x555320 -+#define EUROPE 0x1 /* temp, should be provided later */ -+#define JAPAN 0x2 /* temp, should be provided later */ -+ -+#define eeprom_cis0_sz 17 -+#define eeprom_cis1_sz 50 -+ -+/* */ -+/* Customer ID, note that: */ -+/* This variable is initiailzed through EEPROM or registry, */ -+/* however, its definition may be different with that in EEPROM for */ -+/* EEPROM size consideration. So, we have to perform proper translation between them. */ -+/* Besides, CustomerID of registry has precedence of that of EEPROM. */ -+/* defined below. 060703, by rcnjko. */ -+/* */ -+typedef enum _RT_CUSTOMER_ID -+{ -+ RT_CID_DEFAULT = 0, -+ RT_CID_8187_ALPHA0 = 1, -+ RT_CID_8187_SERCOMM_PS = 2, -+ RT_CID_8187_HW_LED = 3, -+ RT_CID_8187_NETGEAR = 4, -+ RT_CID_WHQL = 5, -+ RT_CID_819x_CAMEO = 6, -+ RT_CID_819x_RUNTOP = 7, -+ RT_CID_819x_Senao = 8, -+ RT_CID_TOSHIBA = 9, /* Merge by Jacken, 2008/01/31. */ -+ RT_CID_819x_Netcore = 10, -+ RT_CID_Nettronix = 11, -+ RT_CID_DLINK = 12, -+ RT_CID_PRONET = 13, -+ RT_CID_COREGA = 14, -+ RT_CID_CHINA_MOBILE = 15, -+ RT_CID_819x_ALPHA = 16, -+ RT_CID_819x_Sitecom = 17, -+ RT_CID_CCX = 18, /* It's set under CCX logo test and isn't demanded for CCX functions, but for test behavior like retry limit and tx report. By Bruce, 2009-02-17. */ -+ RT_CID_819x_Lenovo = 19, -+ RT_CID_819x_QMI = 20, -+ RT_CID_819x_Edimax_Belkin = 21, -+ RT_CID_819x_Sercomm_Belkin = 22, -+ RT_CID_819x_CAMEO1 = 23, -+ RT_CID_819x_MSI = 24, -+ RT_CID_819x_Acer = 25, -+ RT_CID_819x_AzWave_ASUS = 26, -+ RT_CID_819x_AzWave = 27, /* For AzWave in PCIe, The ID is AzWave use and not only Asus */ -+ RT_CID_819x_HP = 28, -+ RT_CID_819x_WNC_COREGA = 29, -+ RT_CID_819x_Arcadyan_Belkin = 30, -+ RT_CID_819x_SAMSUNG = 31, -+ RT_CID_819x_CLEVO = 32, -+ RT_CID_819x_DELL = 33, -+ RT_CID_819x_PRONETS = 34, -+ RT_CID_819x_Edimax_ASUS = 35, -+ RT_CID_NETGEAR = 36, -+ RT_CID_PLANEX = 37, -+ RT_CID_CC_C = 38, -+ RT_CID_819x_Xavi = 39, -+ RT_CID_LENOVO_CHINA = 40, -+ RT_CID_INTEL_CHINA = 41, -+ RT_CID_TPLINK_HPWR = 42, -+ RT_CID_819x_Sercomm_Netgear = 43, -+ RT_CID_819x_ALPHA_Dlink = 44,/* add by ylb 20121012 for customer led for alpha */ -+ RT_CID_WNC_NEC = 45,/* add by page for NEC */ -+ RT_CID_DNI_BUFFALO = 46,/* add by page for NEC */ -+}RT_CUSTOMER_ID, *PRT_CUSTOMER_ID; -+ -+struct eeprom_priv -+{ -+ u8 bautoload_fail_flag; -+ u8 bloadfile_fail_flag; -+ u8 bloadmac_fail_flag; -+ u8 EepromOrEfuse; -+ -+ u8 mac_addr[6]; /* PermanentAddress */ -+ -+ u16 channel_plan; -+ u16 CustomerID; -+ -+ u8 efuse_eeprom_data[EEPROM_MAX_SIZE]; /* 92C:256bytes, 88E:512bytes, we use union set (512bytes) */ -+ u8 adjuseVoltageVal; -+ -+ u8 EEPROMRFGainOffset; -+ u8 EEPROMRFGainVal; -+ -+ u8 sdio_setting; -+ u32 ocr; -+ u8 cis0[eeprom_cis0_sz]; -+ u8 cis1[eeprom_cis1_sz]; -+}; -+ -+#endif /* __RTL871X_EEPROM_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_efuse.h linux/3rdparty/rtl8723bs/include/rtw_efuse.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_efuse.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_efuse.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,132 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_EFUSE_H__ -+#define __RTW_EFUSE_H__ -+ -+ -+#define EFUSE_ERROE_HANDLE 1 -+ -+#define PG_STATE_HEADER 0x01 -+#define PG_STATE_WORD_0 0x02 -+#define PG_STATE_WORD_1 0x04 -+#define PG_STATE_WORD_2 0x08 -+#define PG_STATE_WORD_3 0x10 -+#define PG_STATE_DATA 0x20 -+ -+#define PG_SWBYTE_H 0x01 -+#define PG_SWBYTE_L 0x02 -+ -+#define PGPKT_DATA_SIZE 8 -+ -+#define EFUSE_WIFI 0 -+#define EFUSE_BT 1 -+ -+enum _EFUSE_DEF_TYPE { -+ TYPE_EFUSE_MAX_SECTION = 0, -+ TYPE_EFUSE_REAL_CONTENT_LEN = 1, -+ TYPE_AVAILABLE_EFUSE_BYTES_BANK = 2, -+ TYPE_AVAILABLE_EFUSE_BYTES_TOTAL = 3, -+ TYPE_EFUSE_MAP_LEN = 4, -+ TYPE_EFUSE_PROTECT_BYTES_BANK = 5, -+ TYPE_EFUSE_CONTENT_LEN_BANK = 6, -+}; -+ -+#define EFUSE_MAX_MAP_LEN 512 -+ -+#define EFUSE_MAX_HW_SIZE 512 -+#define EFUSE_MAX_SECTION_BASE 16 -+ -+#define EXT_HEADER(header) ((header & 0x1F) == 0x0F) -+#define ALL_WORDS_DISABLED(wde) ((wde & 0x0F) == 0x0F) -+#define GET_HDR_OFFSET_2_0(header) ((header & 0xE0) >> 5) -+ -+#define EFUSE_REPEAT_THRESHOLD_ 3 -+ -+/* */ -+/* The following is for BT Efuse definition */ -+/* */ -+#define EFUSE_BT_MAX_MAP_LEN 1024 -+#define EFUSE_MAX_BANK 4 -+#define EFUSE_MAX_BT_BANK (EFUSE_MAX_BANK-1) -+/* */ -+/*--------------------------Define Parameters-------------------------------*/ -+#define EFUSE_MAX_WORD_UNIT 4 -+ -+/*------------------------------Define structure----------------------------*/ -+typedef struct PG_PKT_STRUCT_A{ -+ u8 offset; -+ u8 word_en; -+ u8 data[8]; -+ u8 word_cnts; -+}PGPKT_STRUCT,*PPGPKT_STRUCT; -+ -+/*------------------------------Define structure----------------------------*/ -+typedef struct _EFUSE_HAL{ -+ u8 fakeEfuseBank; -+ u32 fakeEfuseUsedBytes; -+ u8 fakeEfuseContent[EFUSE_MAX_HW_SIZE]; -+ u8 fakeEfuseInitMap[EFUSE_MAX_MAP_LEN]; -+ u8 fakeEfuseModifiedMap[EFUSE_MAX_MAP_LEN]; -+ -+ u16 BTEfuseUsedBytes; -+ u8 BTEfuseUsedPercentage; -+ u8 BTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+ u8 BTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN]; -+ u8 BTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN]; -+ -+ u16 fakeBTEfuseUsedBytes; -+ u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+ u8 fakeBTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN]; -+ u8 fakeBTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN]; -+}EFUSE_HAL, *PEFUSE_HAL; -+ -+ -+/*------------------------Export global variable----------------------------*/ -+extern u8 fakeEfuseBank; -+extern u32 fakeEfuseUsedBytes; -+extern u8 fakeEfuseContent[]; -+extern u8 fakeEfuseInitMap[]; -+extern u8 fakeEfuseModifiedMap[]; -+ -+extern u32 BTEfuseUsedBytes; -+extern u8 BTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+extern u8 BTEfuseInitMap[]; -+extern u8 BTEfuseModifiedMap[]; -+ -+extern u32 fakeBTEfuseUsedBytes; -+extern u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+extern u8 fakeBTEfuseInitMap[]; -+extern u8 fakeBTEfuseModifiedMap[]; -+/*------------------------Export global variable----------------------------*/ -+ -+u16 Efuse_GetCurrentSize(struct adapter *padapter, u8 efuseType, bool bPseudoTest); -+u8 Efuse_CalculateWordCnts(u8 word_en); -+void EFUSE_GetEfuseDefinition(struct adapter *padapter, u8 efuseType, u8 type, void *pOut, bool bPseudoTest); -+u8 efuse_OneByteRead(struct adapter *padapter, u16 addr, u8 *data, bool bPseudoTest); -+u8 efuse_OneByteWrite(struct adapter *padapter, u16 addr, u8 data, bool bPseudoTest); -+ -+void Efuse_PowerSwitch(struct adapter *padapter, u8 bWrite, u8 PwrState); -+int Efuse_PgPacketRead(struct adapter *padapter, u8 offset, u8 *data, bool bPseudoTest); -+int Efuse_PgPacketWrite(struct adapter *padapter, u8 offset, u8 word_en, u8 *data, bool bPseudoTest); -+void efuse_WordEnableDataRead(u8 word_en, u8 *sourdata, u8 *targetdata); -+u8 Efuse_WordEnableDataWrite(struct adapter *padapter, u16 efuse_addr, u8 word_en, u8 *data, bool bPseudoTest); -+ -+u8 EFUSE_Read1Byte(struct adapter *padapter, u16 Address); -+void EFUSE_ShadowMapUpdate(struct adapter *padapter, u8 efuseType, bool bPseudoTest); -+void EFUSE_ShadowRead(struct adapter *padapter, u8 Type, u16 Offset, u32 *Value); -+void Rtw_Hal_ReadMACAddrFromFile(struct adapter *padapter); -+u32 Rtw_Hal_readPGDataFromConfigFile(struct adapter *padapter); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_event.h linux/3rdparty/rtl8723bs/include/rtw_event.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_event.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_event.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,117 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_EVENT_H_ -+#define _RTW_EVENT_H_ -+ -+/* -+Used to report a bss has been scanned -+ -+*/ -+struct survey_event { -+ struct wlan_bssid_ex bss; -+}; -+ -+/* -+Used to report that the requested site survey has been done. -+ -+bss_cnt indicates the number of bss that has been reported. -+ -+ -+*/ -+struct surveydone_event { -+ unsigned int bss_cnt; -+ -+}; -+ -+/* -+Used to report the link result of joinning the given bss -+ -+ -+join_res: -+-1: authentication fail -+-2: association fail -+> 0: TID -+ -+*/ -+struct joinbss_event { -+ struct wlan_network network; -+}; -+ -+/* -+Used to report a given STA has joinned the created BSS. -+It is used in AP/Ad-HoC(M) mode. -+ -+ -+*/ -+struct stassoc_event { -+ unsigned char macaddr[6]; -+ unsigned char rsvd[2]; -+ int cam_id; -+ -+}; -+ -+struct stadel_event { -+ unsigned char macaddr[6]; -+ unsigned char rsvd[2]; /* for reason */ -+ int mac_id; -+}; -+ -+struct addba_event -+{ -+ unsigned int tid; -+}; -+ -+struct wmm_event -+{ -+ unsigned char wmm; -+}; -+ -+#define GEN_EVT_CODE(event) event ## _EVT_ -+ -+ -+ -+struct fwevent { -+ u32 parmsize; -+ void (*event_callback)(struct adapter *dev, u8 *pbuf); -+}; -+ -+ -+#define C2HEVENT_SZ 32 -+ -+struct event_node{ -+ unsigned char *node; -+ unsigned char evt_code; -+ unsigned short evt_sz; -+ volatile int *caller_ff_tail; -+ int caller_ff_sz; -+}; -+ -+struct c2hevent_queue { -+ volatile int head; -+ volatile int tail; -+ struct event_node nodes[C2HEVENT_SZ]; -+ unsigned char seq; -+}; -+ -+#define NETWORK_QUEUE_SZ 4 -+ -+struct network_queue { -+ volatile int head; -+ volatile int tail; -+ struct wlan_bssid_ex networks[NETWORK_QUEUE_SZ]; -+}; -+ -+ -+#endif /* _WLANEVENT_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_ht.h linux/3rdparty/rtl8723bs/include/rtw_ht.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_ht.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_ht.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,118 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_HT_H_ -+#define _RTW_HT_H_ -+ -+ -+struct ht_priv -+{ -+ u8 ht_option; -+ u8 ampdu_enable;/* for enable Tx A-MPDU */ -+ u8 tx_amsdu_enable;/* for enable Tx A-MSDU */ -+ u8 bss_coexist;/* for 20/40 Bss coexist */ -+ -+ /* u8 baddbareq_issued[16]; */ -+ u32 tx_amsdu_maxlen; /* 1: 8k, 0:4k ; default:8k, for tx */ -+ u32 rx_ampdu_maxlen; /* for rx reordering ctrl win_sz, updated when join_callback. */ -+ -+ u8 rx_ampdu_min_spacing; -+ -+ u8 ch_offset;/* PRIME_CHNL_OFFSET */ -+ u8 sgi_20m; -+ u8 sgi_40m; -+ -+ /* for processing Tx A-MPDU */ -+ u8 agg_enable_bitmap; -+ /* u8 ADDBA_retry_count; */ -+ u8 candidate_tid_bitmap; -+ -+ u8 ldpc_cap; -+ u8 stbc_cap; -+ u8 beamform_cap; -+ -+ struct rtw_ieee80211_ht_cap ht_cap; -+ -+}; -+ -+typedef enum AGGRE_SIZE{ -+ HT_AGG_SIZE_8K = 0, -+ HT_AGG_SIZE_16K = 1, -+ HT_AGG_SIZE_32K = 2, -+ HT_AGG_SIZE_64K = 3, -+ VHT_AGG_SIZE_128K = 4, -+ VHT_AGG_SIZE_256K = 5, -+ VHT_AGG_SIZE_512K = 6, -+ VHT_AGG_SIZE_1024K = 7, -+}AGGRE_SIZE_E, *PAGGRE_SIZE_E; -+ -+typedef enum _RT_HT_INF0_CAP{ -+ RT_HT_CAP_USE_TURBO_AGGR = 0x01, -+ RT_HT_CAP_USE_LONG_PREAMBLE = 0x02, -+ RT_HT_CAP_USE_AMPDU = 0x04, -+ RT_HT_CAP_USE_WOW = 0x8, -+ RT_HT_CAP_USE_SOFTAP = 0x10, -+ RT_HT_CAP_USE_92SE = 0x20, -+ RT_HT_CAP_USE_88C_92C = 0x40, -+ RT_HT_CAP_USE_AP_CLIENT_MODE = 0x80, /* AP team request to reserve this bit, by Emily */ -+}RT_HT_INF0_CAPBILITY, *PRT_HT_INF0_CAPBILITY; -+ -+typedef enum _RT_HT_INF1_CAP{ -+ RT_HT_CAP_USE_VIDEO_CLIENT = 0x01, -+ RT_HT_CAP_USE_JAGUAR_BCUT = 0x02, -+ RT_HT_CAP_USE_JAGUAR_CCUT = 0x04, -+}RT_HT_INF1_CAPBILITY, *PRT_HT_INF1_CAPBILITY; -+ -+#define LDPC_HT_ENABLE_RX BIT0 -+#define LDPC_HT_ENABLE_TX BIT1 -+#define LDPC_HT_TEST_TX_ENABLE BIT2 -+#define LDPC_HT_CAP_TX BIT3 -+ -+#define STBC_HT_ENABLE_RX BIT0 -+#define STBC_HT_ENABLE_TX BIT1 -+#define STBC_HT_TEST_TX_ENABLE BIT2 -+#define STBC_HT_CAP_TX BIT3 -+ -+#define BEAMFORMING_HT_BEAMFORMER_ENABLE BIT0 /* Declare our NIC supports beamformer */ -+#define BEAMFORMING_HT_BEAMFORMEE_ENABLE BIT1 /* Declare our NIC supports beamformee */ -+#define BEAMFORMING_HT_BEAMFORMER_TEST BIT2 /* Transmiting Beamforming no matter the target supports it or not */ -+ -+/* */ -+/* The HT Control field */ -+/* */ -+#define SET_HT_CTRL_CSI_STEERING(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 6, 2, _val) -+#define SET_HT_CTRL_NDP_ANNOUNCEMENT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+3, 0, 1, _val) -+#define GET_HT_CTRL_NDP_ANNOUNCEMENT(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+3, 0, 1) -+ -+/* 20/40 BSS Coexist */ -+#define SET_EXT_CAPABILITY_ELE_BSS_COEXIST(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart), 0, 1, _val) -+#define GET_EXT_CAPABILITY_ELE_BSS_COEXIST(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart), 0, 1) -+ -+ -+#define GET_HT_CAPABILITY_ELE_LDPC_CAP(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 0, 1) -+#define GET_HT_CAPABILITY_ELE_TX_STBC(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 7, 1) -+ -+#define GET_HT_CAPABILITY_ELE_RX_STBC(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 0, 2) -+ -+/* TXBF Capabilities */ -+#define SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 3, 1, ((u8)_val)) -+#define SET_HT_CAP_TXBF_TRANSMIT_NDP_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 4, 1, ((u8)_val)) -+#define SET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 10, 1, ((u8)_val)) -+#define SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 15, 2, ((u8)_val)) -+#define SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 23, 2, ((u8)_val)) -+ -+#define GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(_pEleStart) LE_BITS_TO_4BYTE((_pEleStart)+21, 10, 1) -+#define GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(_pEleStart) LE_BITS_TO_4BYTE((_pEleStart)+21, 15, 2) -+ -+#endif /* _RTL871X_HT_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_ioctl.h linux/3rdparty/rtl8723bs/include/rtw_ioctl.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_ioctl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_ioctl.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,80 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_IOCTL_H_ -+#define _RTW_IOCTL_H_ -+ -+/* 00 - Success */ -+/* 11 - Error */ -+#define STATUS_SUCCESS (0x00000000L) -+#define STATUS_PENDING (0x00000103L) -+ -+#define STATUS_UNSUCCESSFUL (0xC0000001L) -+#define STATUS_INSUFFICIENT_RESOURCES (0xC000009AL) -+#define STATUS_NOT_SUPPORTED (0xC00000BBL) -+ -+#define NDIS_STATUS_SUCCESS ((uint)STATUS_SUCCESS) -+#define NDIS_STATUS_PENDING ((uint)STATUS_PENDING) -+#define NDIS_STATUS_NOT_RECOGNIZED ((uint)0x00010001L) -+#define NDIS_STATUS_NOT_COPIED ((uint)0x00010002L) -+#define NDIS_STATUS_NOT_ACCEPTED ((uint)0x00010003L) -+#define NDIS_STATUS_CALL_ACTIVE ((uint)0x00010007L) -+ -+#define NDIS_STATUS_FAILURE ((uint)STATUS_UNSUCCESSFUL) -+#define NDIS_STATUS_RESOURCES ((uint)STATUS_INSUFFICIENT_RESOURCES) -+#define NDIS_STATUS_CLOSING ((uint)0xC0010002L) -+#define NDIS_STATUS_BAD_VERSION ((uint)0xC0010004L) -+#define NDIS_STATUS_BAD_CHARACTERISTICS ((uint)0xC0010005L) -+#define NDIS_STATUS_ADAPTER_NOT_FOUND ((uint)0xC0010006L) -+#define NDIS_STATUS_OPEN_FAILED ((uint)0xC0010007L) -+#define NDIS_STATUS_DEVICE_FAILED ((uint)0xC0010008L) -+#define NDIS_STATUS_MULTICAST_FULL ((uint)0xC0010009L) -+#define NDIS_STATUS_MULTICAST_EXISTS ((uint)0xC001000AL) -+#define NDIS_STATUS_MULTICAST_NOT_FOUND ((uint)0xC001000BL) -+#define NDIS_STATUS_REQUEST_ABORTED ((uint)0xC001000CL) -+#define NDIS_STATUS_RESET_IN_PROGRESS ((uint)0xC001000DL) -+#define NDIS_STATUS_CLOSING_INDICATING ((uint)0xC001000EL) -+#define NDIS_STATUS_NOT_SUPPORTED ((uint)STATUS_NOT_SUPPORTED) -+#define NDIS_STATUS_INVALID_PACKET ((uint)0xC001000FL) -+#define NDIS_STATUS_OPEN_LIST_FULL ((uint)0xC0010010L) -+#define NDIS_STATUS_ADAPTER_NOT_READY ((uint)0xC0010011L) -+#define NDIS_STATUS_ADAPTER_NOT_OPEN ((uint)0xC0010012L) -+#define NDIS_STATUS_NOT_INDICATING ((uint)0xC0010013L) -+#define NDIS_STATUS_INVALID_LENGTH ((uint)0xC0010014L) -+#define NDIS_STATUS_INVALID_DATA ((uint)0xC0010015L) -+#define NDIS_STATUS_BUFFER_TOO_SHORT ((uint)0xC0010016L) -+#define NDIS_STATUS_INVALID_OID ((uint)0xC0010017L) -+#define NDIS_STATUS_ADAPTER_REMOVED ((uint)0xC0010018L) -+#define NDIS_STATUS_UNSUPPORTED_MEDIA ((uint)0xC0010019L) -+#define NDIS_STATUS_GROUP_ADDRESS_IN_USE ((uint)0xC001001AL) -+#define NDIS_STATUS_FILE_NOT_FOUND ((uint)0xC001001BL) -+#define NDIS_STATUS_ERROR_READING_FILE ((uint)0xC001001CL) -+#define NDIS_STATUS_ALREADY_MAPPED ((uint)0xC001001DL) -+#define NDIS_STATUS_RESOURCE_CONFLICT ((uint)0xC001001EL) -+#define NDIS_STATUS_NO_CABLE ((uint)0xC001001FL) -+ -+#define NDIS_STATUS_INVALID_SAP ((uint)0xC0010020L) -+#define NDIS_STATUS_SAP_IN_USE ((uint)0xC0010021L) -+#define NDIS_STATUS_INVALID_ADDRESS ((uint)0xC0010022L) -+#define NDIS_STATUS_VC_NOT_ACTIVATED ((uint)0xC0010023L) -+#define NDIS_STATUS_DEST_OUT_OF_ORDER ((uint)0xC0010024L) /* cause 27 */ -+#define NDIS_STATUS_VC_NOT_AVAILABLE ((uint)0xC0010025L) /* cause 35, 45 */ -+#define NDIS_STATUS_CELLRATE_NOT_AVAILABLE ((uint)0xC0010026L) /* cause 37 */ -+#define NDIS_STATUS_INCOMPATABLE_QOS ((uint)0xC0010027L) /* cause 49 */ -+#define NDIS_STATUS_AAL_PARAMS_UNSUPPORTED ((uint)0xC0010028L) /* cause 93 */ -+#define NDIS_STATUS_NO_ROUTE_TO_DESTINATION ((uint)0xC0010029L) /* cause 3 */ -+ -+extern struct iw_handler_def rtw_handlers_def; -+ -+#endif /* #ifndef __INC_CEINFO_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_ioctl_set.h linux/3rdparty/rtl8723bs/include/rtw_ioctl_set.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_ioctl_set.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_ioctl_set.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_IOCTL_SET_H_ -+#define __RTW_IOCTL_SET_H_ -+ -+ -+typedef u8 NDIS_802_11_PMKID_VALUE[16]; -+ -+typedef struct _BSSIDInfo { -+ NDIS_802_11_MAC_ADDRESS BSSID; -+ NDIS_802_11_PMKID_VALUE PMKID; -+} BSSIDInfo, *PBSSIDInfo; -+ -+ -+u8 rtw_set_802_11_authentication_mode(struct adapter *pdapter, enum NDIS_802_11_AUTHENTICATION_MODE authmode); -+u8 rtw_set_802_11_bssid(struct adapter *padapter, u8 *bssid); -+u8 rtw_set_802_11_add_wep(struct adapter *padapter, struct ndis_802_11_wep * wep); -+u8 rtw_set_802_11_disassociate(struct adapter *padapter); -+u8 rtw_set_802_11_bssid_list_scan(struct adapter *padapter, struct ndis_802_11_ssid *pssid, int ssid_max_num); -+u8 rtw_set_802_11_infrastructure_mode(struct adapter *padapter, enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype); -+u8 rtw_set_802_11_ssid(struct adapter *padapter, struct ndis_802_11_ssid * ssid); -+u8 rtw_set_802_11_connect(struct adapter *padapter, u8 *bssid, struct ndis_802_11_ssid *ssid); -+ -+u8 rtw_validate_bssid(u8 *bssid); -+u8 rtw_validate_ssid(struct ndis_802_11_ssid *ssid); -+ -+u16 rtw_get_cur_max_rate(struct adapter *adapter); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_io.h linux/3rdparty/rtl8723bs/include/rtw_io.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_io.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_io.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,373 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef _RTW_IO_H_ -+#define _RTW_IO_H_ -+ -+#define NUM_IOREQ 8 -+ -+#define MAX_PROT_SZ (64-16) -+ -+#define _IOREADY 0 -+#define _IO_WAIT_COMPLETE 1 -+#define _IO_WAIT_RSP 2 -+ -+/* IO COMMAND TYPE */ -+#define _IOSZ_MASK_ (0x7F) -+#define _IO_WRITE_ BIT(7) -+#define _IO_FIXED_ BIT(8) -+#define _IO_BURST_ BIT(9) -+#define _IO_BYTE_ BIT(10) -+#define _IO_HW_ BIT(11) -+#define _IO_WORD_ BIT(12) -+#define _IO_SYNC_ BIT(13) -+#define _IO_CMDMASK_ (0x1F80) -+ -+ -+/* -+ For prompt mode accessing, caller shall free io_req -+ Otherwise, io_handler will free io_req -+*/ -+ -+ -+ -+/* IO STATUS TYPE */ -+#define _IO_ERR_ BIT(2) -+#define _IO_SUCCESS_ BIT(1) -+#define _IO_DONE_ BIT(0) -+ -+ -+#define IO_RD32 (_IO_SYNC_ | _IO_WORD_) -+#define IO_RD16 (_IO_SYNC_ | _IO_HW_) -+#define IO_RD8 (_IO_SYNC_ | _IO_BYTE_) -+ -+#define IO_RD32_ASYNC (_IO_WORD_) -+#define IO_RD16_ASYNC (_IO_HW_) -+#define IO_RD8_ASYNC (_IO_BYTE_) -+ -+#define IO_WR32 (_IO_WRITE_ | _IO_SYNC_ | _IO_WORD_) -+#define IO_WR16 (_IO_WRITE_ | _IO_SYNC_ | _IO_HW_) -+#define IO_WR8 (_IO_WRITE_ | _IO_SYNC_ | _IO_BYTE_) -+ -+#define IO_WR32_ASYNC (_IO_WRITE_ | _IO_WORD_) -+#define IO_WR16_ASYNC (_IO_WRITE_ | _IO_HW_) -+#define IO_WR8_ASYNC (_IO_WRITE_ | _IO_BYTE_) -+ -+/* -+ -+ Only Sync. burst accessing is provided. -+ -+*/ -+ -+#define IO_WR_BURST(x) (_IO_WRITE_ | _IO_SYNC_ | _IO_BURST_ | ((x) & _IOSZ_MASK_)) -+#define IO_RD_BURST(x) (_IO_SYNC_ | _IO_BURST_ | ((x) & _IOSZ_MASK_)) -+ -+ -+ -+/* below is for the intf_option bit defition... */ -+ -+#define _INTF_ASYNC_ BIT(0) /* support async io */ -+ -+struct intf_priv; -+struct intf_hdl; -+struct io_queue; -+ -+struct _io_ops { -+ u8 (*_read8)(struct intf_hdl *pintfhdl, u32 addr); -+ u16 (*_read16)(struct intf_hdl *pintfhdl, u32 addr); -+ u32 (*_read32)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ int (*_write8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int (*_write16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int (*_write32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ int (*_writeN)(struct intf_hdl *pintfhdl, u32 addr, u32 length, u8 *pdata); -+ -+ int (*_write8_async)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int (*_write16_async)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int (*_write32_async)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ -+ void (*_read_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ void (*_write_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ -+ void (*_sync_irp_protocol_rw)(struct io_queue *pio_q); -+ -+ u32 (*_read_interrupt)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ u32 (*_read_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ u32 (*_write_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ -+ u32 (*_write_scsi)(struct intf_hdl *pintfhdl, u32 cnt, u8 *pmem); -+ -+ void (*_read_port_cancel)(struct intf_hdl *pintfhdl); -+ void (*_write_port_cancel)(struct intf_hdl *pintfhdl); -+ -+ u8 (*_sd_f0_read8)(struct intf_hdl *pintfhdl, u32 addr); -+}; -+ -+struct io_req { -+ struct list_head list; -+ u32 addr; -+ volatile u32 val; -+ u32 command; -+ u32 status; -+ u8 *pbuf; -+ _sema sema; -+ -+ void (*_async_io_callback)(struct adapter *padater, struct io_req *pio_req, u8 *cnxt); -+ u8 *cnxt; -+}; -+ -+struct intf_hdl { -+ struct adapter *padapter; -+ struct dvobj_priv *pintf_dev;/* pointer to &(padapter->dvobjpriv); */ -+ -+ struct _io_ops io_ops; -+}; -+ -+struct reg_protocol_rd { -+ -+#ifdef __LITTLE_ENDIAN -+ -+ /* DW1 */ -+ u32 NumOfTrans:4; -+ u32 Reserved1:4; -+ u32 Reserved2:24; -+ /* DW2 */ -+ u32 ByteCount:7; -+ u32 WriteEnable:1; /* 0:read, 1:write */ -+ u32 FixOrContinuous:1; /* 0:continuous, 1: Fix */ -+ u32 BurstMode:1; -+ u32 Byte1Access:1; -+ u32 Byte2Access:1; -+ u32 Byte4Access:1; -+ u32 Reserved3:3; -+ u32 Reserved4:16; -+ /* DW3 */ -+ u32 BusAddress; -+ /* DW4 */ -+ /* u32 Value; */ -+#else -+ -+ -+/* DW1 */ -+ u32 Reserved1 :4; -+ u32 NumOfTrans :4; -+ -+ u32 Reserved2 :24; -+ -+ /* DW2 */ -+ u32 WriteEnable : 1; -+ u32 ByteCount :7; -+ -+ -+ u32 Reserved3 : 3; -+ u32 Byte4Access : 1; -+ -+ u32 Byte2Access : 1; -+ u32 Byte1Access : 1; -+ u32 BurstMode :1 ; -+ u32 FixOrContinuous : 1; -+ -+ u32 Reserved4 : 16; -+ -+ /* DW3 */ -+ u32 BusAddress; -+ -+ /* DW4 */ -+ /* u32 Value; */ -+ -+#endif -+ -+}; -+ -+ -+struct reg_protocol_wt { -+ -+ -+#ifdef __LITTLE_ENDIAN -+ -+ /* DW1 */ -+ u32 NumOfTrans:4; -+ u32 Reserved1:4; -+ u32 Reserved2:24; -+ /* DW2 */ -+ u32 ByteCount:7; -+ u32 WriteEnable:1; /* 0:read, 1:write */ -+ u32 FixOrContinuous:1; /* 0:continuous, 1: Fix */ -+ u32 BurstMode:1; -+ u32 Byte1Access:1; -+ u32 Byte2Access:1; -+ u32 Byte4Access:1; -+ u32 Reserved3:3; -+ u32 Reserved4:16; -+ /* DW3 */ -+ u32 BusAddress; -+ /* DW4 */ -+ u32 Value; -+ -+#else -+ /* DW1 */ -+ u32 Reserved1 :4; -+ u32 NumOfTrans :4; -+ -+ u32 Reserved2 :24; -+ -+ /* DW2 */ -+ u32 WriteEnable : 1; -+ u32 ByteCount :7; -+ -+ u32 Reserved3 : 3; -+ u32 Byte4Access : 1; -+ -+ u32 Byte2Access : 1; -+ u32 Byte1Access : 1; -+ u32 BurstMode :1 ; -+ u32 FixOrContinuous : 1; -+ -+ u32 Reserved4 : 16; -+ -+ /* DW3 */ -+ u32 BusAddress; -+ -+ /* DW4 */ -+ u32 Value; -+ -+#endif -+ -+}; -+#define SD_IO_TRY_CNT (8) -+#define MAX_CONTINUAL_IO_ERR SD_IO_TRY_CNT -+ -+int rtw_inc_and_chk_continual_io_error(struct dvobj_priv *dvobj); -+void rtw_reset_continual_io_error(struct dvobj_priv *dvobj); -+ -+/* -+Below is the data structure used by _io_handler -+ -+*/ -+ -+struct io_queue { -+ _lock lock; -+ struct list_head free_ioreqs; -+ struct list_head pending; /* The io_req list that will be served in the single protocol read/write. */ -+ struct list_head processing; -+ u8 *free_ioreqs_buf; /* 4-byte aligned */ -+ u8 *pallocated_free_ioreqs_buf; -+ struct intf_hdl intf; -+}; -+ -+struct io_priv{ -+ -+ struct adapter *padapter; -+ -+ struct intf_hdl intf; -+ -+}; -+ -+extern uint ioreq_flush(struct adapter *adapter, struct io_queue *ioqueue); -+extern void sync_ioreq_enqueue(struct io_req *preq, struct io_queue *ioqueue); -+extern uint sync_ioreq_flush(struct adapter *adapter, struct io_queue *ioqueue); -+ -+ -+extern uint free_ioreq(struct io_req *preq, struct io_queue *pio_queue); -+extern struct io_req *alloc_ioreq(struct io_queue *pio_q); -+ -+extern uint register_intf_hdl(u8 *dev, struct intf_hdl *pintfhdl); -+extern void unregister_intf_hdl(struct intf_hdl *pintfhdl); -+ -+extern void _rtw_attrib_read(struct adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern void _rtw_attrib_write(struct adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+ -+extern u8 _rtw_read8(struct adapter *adapter, u32 addr); -+extern u16 _rtw_read16(struct adapter *adapter, u32 addr); -+extern u32 _rtw_read32(struct adapter *adapter, u32 addr); -+ -+extern int _rtw_write8(struct adapter *adapter, u32 addr, u8 val); -+extern int _rtw_write16(struct adapter *adapter, u32 addr, u16 val); -+extern int _rtw_write32(struct adapter *adapter, u32 addr, u32 val); -+ -+extern u8 _rtw_sd_f0_read8(struct adapter *adapter, u32 addr); -+ -+extern u32 _rtw_write_port(struct adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+ -+#define rtw_read8(adapter, addr) _rtw_read8((adapter), (addr)) -+#define rtw_read16(adapter, addr) _rtw_read16((adapter), (addr)) -+#define rtw_read32(adapter, addr) _rtw_read32((adapter), (addr)) -+ -+#define rtw_write8(adapter, addr, val) _rtw_write8((adapter), (addr), (val)) -+#define rtw_write16(adapter, addr, val) _rtw_write16((adapter), (addr), (val)) -+#define rtw_write32(adapter, addr, val) _rtw_write32((adapter), (addr), (val)) -+ -+#define rtw_write_port(adapter, addr, cnt, mem) _rtw_write_port((adapter), (addr), (cnt), (mem)) -+ -+#define rtw_sd_f0_read8(adapter, addr) _rtw_sd_f0_read8((adapter), (addr)) -+ -+extern void rtw_write_scsi(struct adapter *adapter, u32 cnt, u8 *pmem); -+ -+/* ioreq */ -+extern void ioreq_read8(struct adapter *adapter, u32 addr, u8 *pval); -+extern void ioreq_read16(struct adapter *adapter, u32 addr, u16 *pval); -+extern void ioreq_read32(struct adapter *adapter, u32 addr, u32 *pval); -+extern void ioreq_write8(struct adapter *adapter, u32 addr, u8 val); -+extern void ioreq_write16(struct adapter *adapter, u32 addr, u16 val); -+extern void ioreq_write32(struct adapter *adapter, u32 addr, u32 val); -+ -+ -+extern uint async_read8(struct adapter *adapter, u32 addr, u8 *pbuff, -+ void (*_async_io_callback)(struct adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+extern uint async_read16(struct adapter *adapter, u32 addr, u8 *pbuff, -+ void (*_async_io_callback)(struct adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+extern uint async_read32(struct adapter *adapter, u32 addr, u8 *pbuff, -+ void (*_async_io_callback)(struct adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+ -+extern void async_read_mem(struct adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern void async_read_port(struct adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+ -+extern void async_write8(struct adapter *adapter, u32 addr, u8 val, -+ void (*_async_io_callback)(struct adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+extern void async_write16(struct adapter *adapter, u32 addr, u16 val, -+ void (*_async_io_callback)(struct adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+extern void async_write32(struct adapter *adapter, u32 addr, u32 val, -+ void (*_async_io_callback)(struct adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+ -+extern void async_write_mem(struct adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern void async_write_port(struct adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+ -+ -+int rtw_init_io_priv(struct adapter *padapter, void (*set_intf_ops)(struct adapter *padapter, struct _io_ops *pops)); -+ -+ -+extern uint alloc_io_queue(struct adapter *adapter); -+extern void free_io_queue(struct adapter *adapter); -+extern void async_bus_io(struct io_queue *pio_q); -+extern void bus_sync_io(struct io_queue *pio_q); -+extern u32 _ioreq2rwmem(struct io_queue *pio_q); -+extern void dev_power_down(struct adapter * Adapter, u8 bpwrup); -+ -+#define PlatformEFIOWrite1Byte(_a, _b, _c) \ -+ rtw_write8(_a, _b, _c) -+#define PlatformEFIOWrite2Byte(_a, _b, _c) \ -+ rtw_write16(_a, _b, _c) -+#define PlatformEFIOWrite4Byte(_a, _b, _c) \ -+ rtw_write32(_a, _b, _c) -+ -+#define PlatformEFIORead1Byte(_a, _b) \ -+ rtw_read8(_a, _b) -+#define PlatformEFIORead2Byte(_a, _b) \ -+ rtw_read16(_a, _b) -+#define PlatformEFIORead4Byte(_a, _b) \ -+ rtw_read32(_a, _b) -+ -+#endif /* _RTL8711_IO_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_mlme_ext.h linux/3rdparty/rtl8723bs/include/rtw_mlme_ext.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_mlme_ext.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_mlme_ext.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,888 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_MLME_EXT_H_ -+#define __RTW_MLME_EXT_H_ -+ -+ -+/* Commented by Albert 20101105 */ -+/* Increase the SURVEY_TO value from 100 to 150 (100ms to 150ms) */ -+/* The Realtek 8188CE SoftAP will spend around 100ms to send the probe response after receiving the probe request. */ -+/* So, this driver tried to extend the dwell time for each scanning channel. */ -+/* This will increase the chance to receive the probe response from SoftAP. */ -+ -+#define SURVEY_TO (100) -+#define REAUTH_TO (300) /* 50) */ -+#define REASSOC_TO (300) /* 50) */ -+/* define DISCONNECT_TO (3000) */ -+#define ADDBA_TO (2000) -+ -+#define LINKED_TO (1) /* unit:2 sec, 1x2 =2 sec */ -+ -+#define REAUTH_LIMIT (4) -+#define REASSOC_LIMIT (4) -+#define READDBA_LIMIT (2) -+ -+#define ROAMING_LIMIT 8 -+/* define IOCMD_REG0 0x10250370 */ -+/* define IOCMD_REG1 0x10250374 */ -+/* define IOCMD_REG2 0x10250378 */ -+ -+/* define FW_DYNAMIC_FUN_SWITCH 0x10250364 */ -+ -+/* define WRITE_BB_CMD 0xF0000001 */ -+/* define SET_CHANNEL_CMD 0xF3000000 */ -+/* define UPDATE_RA_CMD 0xFD0000A2 */ -+ -+#define DYNAMIC_FUNC_DISABLE (0x0) -+ -+/* ====== ODM_ABILITY_E ======== */ -+/* BB ODM section BIT 0-15 */ -+#define DYNAMIC_BB_DIG BIT0 /* ODM_BB_DIG */ -+#define DYNAMIC_BB_RA_MASK BIT1 /* ODM_BB_RA_MASK */ -+#define DYNAMIC_BB_DYNAMIC_TXPWR BIT2 /* ODM_BB_DYNAMIC_TXPWR */ -+#define DYNAMIC_BB_BB_FA_CNT BIT3 /* ODM_BB_FA_CNT */ -+#define DYNAMIC_BB_RSSI_MONITOR BIT4 /* ODM_BB_RSSI_MONITOR */ -+#define DYNAMIC_BB_CCK_PD BIT5 /* ODM_BB_CCK_PD */ -+#define DYNAMIC_BB_ANT_DIV BIT6 /* ODM_BB_ANT_DIV */ -+#define DYNAMIC_BB_PWR_SAVE BIT7 /* ODM_BB_PWR_SAVE */ -+#define DYNAMIC_BB_PWR_TRAIN BIT8 /* ODM_BB_PWR_TRAIN */ -+#define DYNAMIC_BB_RATE_ADAPTIVE BIT9 /* ODM_BB_RATE_ADAPTIVE */ -+#define DYNAMIC_BB_PATH_DIV BIT10/* ODM_BB_PATH_DIV */ -+#define DYNAMIC_BB_PSD BIT11/* ODM_BB_PSD */ -+#define DYNAMIC_BB_RXHP BIT12/* ODM_BB_RXHP */ -+#define DYNAMIC_BB_ADAPTIVITY BIT13/* ODM_BB_ADAPTIVITY */ -+#define DYNAMIC_BB_DYNAMIC_ATC BIT14/* ODM_BB_DYNAMIC_ATC */ -+ -+/* MAC DM section BIT 16-23 */ -+#define DYNAMIC_MAC_EDCA_TURBO BIT16/* ODM_MAC_EDCA_TURBO */ -+#define DYNAMIC_MAC_EARLY_MODE BIT17/* ODM_MAC_EARLY_MODE */ -+ -+/* RF ODM section BIT 24-31 */ -+#define DYNAMIC_RF_TX_PWR_TRACK BIT24/* ODM_RF_TX_PWR_TRACK */ -+#define DYNAMIC_RF_RX_GAIN_TRACK BIT25/* ODM_RF_RX_GAIN_TRACK */ -+#define DYNAMIC_RF_CALIBRATION BIT26/* ODM_RF_CALIBRATION */ -+ -+#define DYNAMIC_ALL_FUNC_ENABLE 0xFFFFFFF -+ -+#define _HW_STATE_NOLINK_ 0x00 -+#define _HW_STATE_ADHOC_ 0x01 -+#define _HW_STATE_STATION_ 0x02 -+#define _HW_STATE_AP_ 0x03 -+ -+ -+#define _1M_RATE_ 0 -+#define _2M_RATE_ 1 -+#define _5M_RATE_ 2 -+#define _11M_RATE_ 3 -+#define _6M_RATE_ 4 -+#define _9M_RATE_ 5 -+#define _12M_RATE_ 6 -+#define _18M_RATE_ 7 -+#define _24M_RATE_ 8 -+#define _36M_RATE_ 9 -+#define _48M_RATE_ 10 -+#define _54M_RATE_ 11 -+ -+/******************************************************** -+MCS rate definitions -+*********************************************************/ -+#define MCS_RATE_1R (0x000000ff) -+#define MCS_RATE_2R (0x0000ffff) -+#define MCS_RATE_3R (0x00ffffff) -+#define MCS_RATE_4R (0xffffffff) -+#define MCS_RATE_2R_13TO15_OFF (0x00001fff) -+ -+ -+extern unsigned char RTW_WPA_OUI[]; -+extern unsigned char WMM_OUI[]; -+extern unsigned char WPS_OUI[]; -+extern unsigned char WFD_OUI[]; -+extern unsigned char P2P_OUI[]; -+ -+extern unsigned char WMM_INFO_OUI[]; -+extern unsigned char WMM_PARA_OUI[]; -+ -+ -+/* */ -+/* Channel Plan Type. */ -+/* Note: */ -+/* We just add new channel plan when the new channel plan is different from any of the following */ -+/* channel plan. */ -+/* If you just wnat to customize the acitions(scan period or join actions) about one of the channel plan, */ -+/* customize them in RT_CHANNEL_INFO in the RT_CHANNEL_LIST. */ -+/* */ -+typedef enum _RT_CHANNEL_DOMAIN -+{ -+ /* old channel plan mapping ===== */ -+ RT_CHANNEL_DOMAIN_FCC = 0x00, -+ RT_CHANNEL_DOMAIN_IC = 0x01, -+ RT_CHANNEL_DOMAIN_ETSI = 0x02, -+ RT_CHANNEL_DOMAIN_SPAIN = 0x03, -+ RT_CHANNEL_DOMAIN_FRANCE = 0x04, -+ RT_CHANNEL_DOMAIN_MKK = 0x05, -+ RT_CHANNEL_DOMAIN_MKK1 = 0x06, -+ RT_CHANNEL_DOMAIN_ISRAEL = 0x07, -+ RT_CHANNEL_DOMAIN_TELEC = 0x08, -+ RT_CHANNEL_DOMAIN_GLOBAL_DOAMIN = 0x09, -+ RT_CHANNEL_DOMAIN_WORLD_WIDE_13 = 0x0A, -+ RT_CHANNEL_DOMAIN_TAIWAN = 0x0B, -+ RT_CHANNEL_DOMAIN_CHINA = 0x0C, -+ RT_CHANNEL_DOMAIN_SINGAPORE_INDIA_MEXICO = 0x0D, -+ RT_CHANNEL_DOMAIN_KOREA = 0x0E, -+ RT_CHANNEL_DOMAIN_TURKEY = 0x0F, -+ RT_CHANNEL_DOMAIN_JAPAN = 0x10, -+ RT_CHANNEL_DOMAIN_FCC_NO_DFS = 0x11, -+ RT_CHANNEL_DOMAIN_JAPAN_NO_DFS = 0x12, -+ RT_CHANNEL_DOMAIN_WORLD_WIDE_5G = 0x13, -+ RT_CHANNEL_DOMAIN_TAIWAN_NO_DFS = 0x14, -+ -+ /* new channel plan mapping, (2GDOMAIN_5GDOMAIN) ===== */ -+ RT_CHANNEL_DOMAIN_WORLD_NULL = 0x20, -+ RT_CHANNEL_DOMAIN_ETSI1_NULL = 0x21, -+ RT_CHANNEL_DOMAIN_FCC1_NULL = 0x22, -+ RT_CHANNEL_DOMAIN_MKK1_NULL = 0x23, -+ RT_CHANNEL_DOMAIN_ETSI2_NULL = 0x24, -+ RT_CHANNEL_DOMAIN_FCC1_FCC1 = 0x25, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI1 = 0x26, -+ RT_CHANNEL_DOMAIN_MKK1_MKK1 = 0x27, -+ RT_CHANNEL_DOMAIN_WORLD_KCC1 = 0x28, -+ RT_CHANNEL_DOMAIN_WORLD_FCC2 = 0x29, -+ RT_CHANNEL_DOMAIN_WORLD_FCC3 = 0x30, -+ RT_CHANNEL_DOMAIN_WORLD_FCC4 = 0x31, -+ RT_CHANNEL_DOMAIN_WORLD_FCC5 = 0x32, -+ RT_CHANNEL_DOMAIN_WORLD_FCC6 = 0x33, -+ RT_CHANNEL_DOMAIN_FCC1_FCC7 = 0x34, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI2 = 0x35, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI3 = 0x36, -+ RT_CHANNEL_DOMAIN_MKK1_MKK2 = 0x37, -+ RT_CHANNEL_DOMAIN_MKK1_MKK3 = 0x38, -+ RT_CHANNEL_DOMAIN_FCC1_NCC1 = 0x39, -+ RT_CHANNEL_DOMAIN_FCC1_NCC2 = 0x40, -+ RT_CHANNEL_DOMAIN_GLOBAL_NULL = 0x41, -+ RT_CHANNEL_DOMAIN_ETSI1_ETSI4 = 0x42, -+ RT_CHANNEL_DOMAIN_FCC1_FCC2 = 0x43, -+ RT_CHANNEL_DOMAIN_FCC1_NCC3 = 0x44, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI5 = 0x45, -+ RT_CHANNEL_DOMAIN_FCC1_FCC8 = 0x46, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI6 = 0x47, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI7 = 0x48, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI8 = 0x49, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI9 = 0x50, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI10 = 0x51, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI11 = 0x52, -+ RT_CHANNEL_DOMAIN_FCC1_NCC4 = 0x53, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI12 = 0x54, -+ RT_CHANNEL_DOMAIN_FCC1_FCC9 = 0x55, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI13 = 0x56, -+ RT_CHANNEL_DOMAIN_FCC1_FCC10 = 0x57, -+ /* Add new channel plan above this line =============== */ -+ RT_CHANNEL_DOMAIN_MAX, -+ RT_CHANNEL_DOMAIN_REALTEK_DEFINE = 0x7F, -+}RT_CHANNEL_DOMAIN, *PRT_CHANNEL_DOMAIN; -+ -+typedef enum _RT_CHANNEL_DOMAIN_2G -+{ -+ RT_CHANNEL_DOMAIN_2G_WORLD = 0x00, /* Worldwird 13 */ -+ RT_CHANNEL_DOMAIN_2G_ETSI1 = 0x01, /* Europe */ -+ RT_CHANNEL_DOMAIN_2G_FCC1 = 0x02, /* US */ -+ RT_CHANNEL_DOMAIN_2G_MKK1 = 0x03, /* Japan */ -+ RT_CHANNEL_DOMAIN_2G_ETSI2 = 0x04, /* France */ -+ RT_CHANNEL_DOMAIN_2G_GLOBAL = 0x05, /* Global domain */ -+ RT_CHANNEL_DOMAIN_2G_NULL = 0x06, -+ /* Add new channel plan above this line =============== */ -+ RT_CHANNEL_DOMAIN_2G_MAX, -+}RT_CHANNEL_DOMAIN_2G, *PRT_CHANNEL_DOMAIN_2G; -+ -+typedef enum _RT_CHANNEL_DOMAIN_5G -+{ -+ RT_CHANNEL_DOMAIN_5G_NULL = 0x00, -+ RT_CHANNEL_DOMAIN_5G_ETSI1 = 0x01, /* Europe */ -+ RT_CHANNEL_DOMAIN_5G_ETSI2 = 0x02, /* Australia, New Zealand */ -+ RT_CHANNEL_DOMAIN_5G_ETSI3 = 0x03, /* Russia */ -+ RT_CHANNEL_DOMAIN_5G_FCC1 = 0x04, /* US */ -+ RT_CHANNEL_DOMAIN_5G_FCC2 = 0x05, /* FCC o/w DFS Channels */ -+ RT_CHANNEL_DOMAIN_5G_FCC3 = 0x06, /* India, Mexico */ -+ RT_CHANNEL_DOMAIN_5G_FCC4 = 0x07, /* Venezuela */ -+ RT_CHANNEL_DOMAIN_5G_FCC5 = 0x08, /* China */ -+ RT_CHANNEL_DOMAIN_5G_FCC6 = 0x09, /* Israel */ -+ RT_CHANNEL_DOMAIN_5G_FCC7_IC1 = 0x0A, /* US, Canada */ -+ RT_CHANNEL_DOMAIN_5G_KCC1 = 0x0B, /* Korea */ -+ RT_CHANNEL_DOMAIN_5G_MKK1 = 0x0C, /* Japan */ -+ RT_CHANNEL_DOMAIN_5G_MKK2 = 0x0D, /* Japan (W52, W53) */ -+ RT_CHANNEL_DOMAIN_5G_MKK3 = 0x0E, /* Japan (W56) */ -+ RT_CHANNEL_DOMAIN_5G_NCC1 = 0x0F, /* Taiwan */ -+ RT_CHANNEL_DOMAIN_5G_NCC2 = 0x10, /* Taiwan o/w DFS */ -+ RT_CHANNEL_DOMAIN_5G_NCC3 = 0x11, /* Taiwan w/o DFS, Band4 only */ -+ RT_CHANNEL_DOMAIN_5G_ETSI4 = 0x12, /* Europe w/o DFS, Band1 only */ -+ RT_CHANNEL_DOMAIN_5G_ETSI5 = 0x13, /* Australia, New Zealand(w/o Weather radar) */ -+ RT_CHANNEL_DOMAIN_5G_FCC8 = 0x14, /* Latin America */ -+ RT_CHANNEL_DOMAIN_5G_ETSI6 = 0x15, /* Israel, Bahrain, Egypt, India, China, Malaysia */ -+ RT_CHANNEL_DOMAIN_5G_ETSI7 = 0x16, /* China */ -+ RT_CHANNEL_DOMAIN_5G_ETSI8 = 0x17, /* Jordan */ -+ RT_CHANNEL_DOMAIN_5G_ETSI9 = 0x18, /* Lebanon */ -+ RT_CHANNEL_DOMAIN_5G_ETSI10 = 0x19, /* Qatar */ -+ RT_CHANNEL_DOMAIN_5G_ETSI11 = 0x1A, /* Russia */ -+ RT_CHANNEL_DOMAIN_5G_NCC4 = 0x1B, /* Taiwan, (w/o Weather radar) */ -+ RT_CHANNEL_DOMAIN_5G_ETSI12 = 0x1C, /* Indonesia */ -+ RT_CHANNEL_DOMAIN_5G_FCC9 = 0x1D, /* w/o Weather radar) */ -+ RT_CHANNEL_DOMAIN_5G_ETSI13 = 0x1E, /* w/o Weather radar) */ -+ RT_CHANNEL_DOMAIN_5G_FCC10 = 0x1F, /* Argentina (w/o Weather radar) */ -+ /* Add new channel plan above this line =============== */ -+ /* Driver Self Defined ===== */ -+ RT_CHANNEL_DOMAIN_5G_FCC = 0x20, -+ RT_CHANNEL_DOMAIN_5G_JAPAN_NO_DFS = 0x21, -+ RT_CHANNEL_DOMAIN_5G_FCC4_NO_DFS = 0x22, -+ RT_CHANNEL_DOMAIN_5G_MAX, -+}RT_CHANNEL_DOMAIN_5G, *PRT_CHANNEL_DOMAIN_5G; -+ -+#define rtw_is_channel_plan_valid(chplan) (chplansurvey_timer, (ms)); \ -+ } while (0) -+ -+#define set_link_timer(mlmeext, ms) \ -+ do { \ -+ /*DBG_871X("%s set_link_timer(%p, %d)\n", __func__, (mlmeext), (ms));*/ \ -+ _set_timer(&(mlmeext)->link_timer, (ms)); \ -+ } while (0) -+#define set_sa_query_timer(mlmeext, ms) \ -+ do { \ -+ DBG_871X("%s set_sa_query_timer(%p, %d)\n", __func__, (mlmeext), (ms)); \ -+ _set_timer(&(mlmeext)->sa_query_timer, (ms)); \ -+ } while (0) -+extern int cckrates_included(unsigned char *rate, int ratelen); -+extern int cckratesonly_included(unsigned char *rate, int ratelen); -+ -+extern void process_addba_req(struct adapter *padapter, u8 *paddba_req, u8 *addr); -+ -+extern void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len); -+extern void correct_TSF(struct adapter *padapter, struct mlme_ext_priv *pmlmeext); -+extern void adaptive_early_32k(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len); -+extern u8 traffic_status_watchdog(struct adapter *padapter, u8 from_timer); -+ -+int rtw_chk_start_clnt_join(struct adapter *padapter, u8 *ch, u8 *bw, u8 *offset); -+int rtw_get_ch_setting_union(struct adapter *adapter, u8 *ch, u8 *bw, u8 *offset); -+ -+struct cmd_hdl { -+ uint parmsize; -+ u8 (*h2cfuns)(struct adapter *padapter, u8 *pbuf); -+}; -+ -+ -+u8 read_macreg_hdl(struct adapter *padapter, u8 *pbuf); -+u8 write_macreg_hdl(struct adapter *padapter, u8 *pbuf); -+u8 read_bbreg_hdl(struct adapter *padapter, u8 *pbuf); -+u8 write_bbreg_hdl(struct adapter *padapter, u8 *pbuf); -+u8 read_rfreg_hdl(struct adapter *padapter, u8 *pbuf); -+u8 write_rfreg_hdl(struct adapter *padapter, u8 *pbuf); -+ -+ -+u8 NULL_hdl(struct adapter *padapter, u8 *pbuf); -+u8 join_cmd_hdl(struct adapter *padapter, u8 *pbuf); -+u8 disconnect_hdl(struct adapter *padapter, u8 *pbuf); -+u8 createbss_hdl(struct adapter *padapter, u8 *pbuf); -+u8 setopmode_hdl(struct adapter *padapter, u8 *pbuf); -+u8 sitesurvey_cmd_hdl(struct adapter *padapter, u8 *pbuf); -+u8 setauth_hdl(struct adapter *padapter, u8 *pbuf); -+u8 setkey_hdl(struct adapter *padapter, u8 *pbuf); -+u8 set_stakey_hdl(struct adapter *padapter, u8 *pbuf); -+u8 set_assocsta_hdl(struct adapter *padapter, u8 *pbuf); -+u8 del_assocsta_hdl(struct adapter *padapter, u8 *pbuf); -+u8 add_ba_hdl(struct adapter *padapter, unsigned char *pbuf); -+ -+u8 mlme_evt_hdl(struct adapter *padapter, unsigned char *pbuf); -+u8 h2c_msg_hdl(struct adapter *padapter, unsigned char *pbuf); -+u8 chk_bmc_sleepq_hdl(struct adapter *padapter, unsigned char *pbuf); -+u8 tx_beacon_hdl(struct adapter *padapter, unsigned char *pbuf); -+u8 set_ch_hdl(struct adapter *padapter, u8 *pbuf); -+u8 set_chplan_hdl(struct adapter *padapter, unsigned char *pbuf); -+u8 led_blink_hdl(struct adapter *padapter, unsigned char *pbuf); -+u8 set_csa_hdl(struct adapter *padapter, unsigned char *pbuf); /* Kurt: Handling DFS channel switch announcement ie. */ -+u8 tdls_hdl(struct adapter *padapter, unsigned char *pbuf); -+u8 run_in_thread_hdl(struct adapter *padapter, u8 *pbuf); -+ -+ -+#define GEN_DRV_CMD_HANDLER(size, cmd) {size, &cmd ## _hdl}, -+#define GEN_MLME_EXT_HANDLER(size, cmd) {size, cmd}, -+ -+struct C2HEvent_Header -+{ -+ -+#ifdef __LITTLE_ENDIAN -+ -+ unsigned int len:16; -+ unsigned int ID:8; -+ unsigned int seq:8; -+#else -+ unsigned int seq:8; -+ unsigned int ID:8; -+ unsigned int len:16; -+#endif -+ unsigned int rsvd; -+}; -+ -+void rtw_dummy_event_callback(struct adapter *adapter , u8 *pbuf); -+void rtw_fwdbg_event_callback(struct adapter *adapter , u8 *pbuf); -+ -+enum rtw_c2h_event -+{ -+ GEN_EVT_CODE(_Read_MACREG) = 0, /*0*/ -+ GEN_EVT_CODE(_Read_BBREG), -+ GEN_EVT_CODE(_Read_RFREG), -+ GEN_EVT_CODE(_Read_EEPROM), -+ GEN_EVT_CODE(_Read_EFUSE), -+ GEN_EVT_CODE(_Read_CAM), /*5*/ -+ GEN_EVT_CODE(_Get_BasicRate), -+ GEN_EVT_CODE(_Get_DataRate), -+ GEN_EVT_CODE(_Survey), /*8*/ -+ GEN_EVT_CODE(_SurveyDone), /*9*/ -+ -+ GEN_EVT_CODE(_JoinBss) , /*10*/ -+ GEN_EVT_CODE(_AddSTA), -+ GEN_EVT_CODE(_DelSTA), -+ GEN_EVT_CODE(_AtimDone) , -+ GEN_EVT_CODE(_TX_Report), -+ GEN_EVT_CODE(_CCX_Report), /*15*/ -+ GEN_EVT_CODE(_DTM_Report), -+ GEN_EVT_CODE(_TX_Rate_Statistics), -+ GEN_EVT_CODE(_C2HLBK), -+ GEN_EVT_CODE(_FWDBG), -+ GEN_EVT_CODE(_C2HFEEDBACK), /*20*/ -+ GEN_EVT_CODE(_ADDBA), -+ GEN_EVT_CODE(_C2HBCN), -+ GEN_EVT_CODE(_ReportPwrState), /* filen: only for PCIE, USB */ -+ GEN_EVT_CODE(_CloseRF), /* filen: only for PCIE, work around ASPM */ -+ GEN_EVT_CODE(_WMM), /*25*/ -+ MAX_C2HEVT -+}; -+ -+ -+#ifdef _RTW_MLME_EXT_C_ -+ -+static struct fwevent wlanevents[] = -+{ -+ {0, rtw_dummy_event_callback}, /*0*/ -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, &rtw_survey_event_callback}, /*8*/ -+ {sizeof (struct surveydone_event), &rtw_surveydone_event_callback}, /*9*/ -+ -+ {0, &rtw_joinbss_event_callback}, /*10*/ -+ {sizeof(struct stassoc_event), &rtw_stassoc_event_callback}, -+ {sizeof(struct stadel_event), &rtw_stadel_event_callback}, -+ {0, &rtw_atimdone_event_callback}, -+ {0, rtw_dummy_event_callback}, -+ {0, NULL}, /*15*/ -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, rtw_fwdbg_event_callback}, -+ {0, NULL}, /*20*/ -+ {0, NULL}, -+ {0, NULL}, -+ {0, &rtw_cpwm_event_callback}, -+ {0, NULL}, -+ {0, &rtw_wmm_event_callback}, -+ -+}; -+ -+#endif/* _RTL8192C_CMD_C_ */ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_mlme.h linux/3rdparty/rtl8723bs/include/rtw_mlme.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_mlme.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_mlme.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,695 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_MLME_H_ -+#define __RTW_MLME_H_ -+ -+ -+#define MAX_BSS_CNT 128 -+/* define MAX_JOIN_TIMEOUT 2000 */ -+/* define MAX_JOIN_TIMEOUT 2500 */ -+#define MAX_JOIN_TIMEOUT 6500 -+ -+/* Commented by Albert 20101105 */ -+/* Increase the scanning timeout because of increasing the SURVEY_TO value. */ -+ -+#define SCANNING_TIMEOUT 8000 -+ -+#ifdef PALTFORM_OS_WINCE -+#define SCANQUEUE_LIFETIME 12000000 /* unit:us */ -+#else -+#define SCANQUEUE_LIFETIME 20000 /* 20sec, unit:msec */ -+#endif -+ -+#define WIFI_NULL_STATE 0x00000000 -+#define WIFI_ASOC_STATE 0x00000001 /* Under Linked state... */ -+#define WIFI_REASOC_STATE 0x00000002 -+#define WIFI_SLEEP_STATE 0x00000004 -+#define WIFI_STATION_STATE 0x00000008 -+#define WIFI_AP_STATE 0x00000010 -+#define WIFI_ADHOC_STATE 0x00000020 -+#define WIFI_ADHOC_MASTER_STATE 0x00000040 -+#define WIFI_UNDER_LINKING 0x00000080 -+ -+#define WIFI_UNDER_WPS 0x00000100 -+/* define WIFI_UNDER_CMD 0x00000200 */ -+/* define WIFI_UNDER_P2P 0x00000400 */ -+#define WIFI_STA_ALIVE_CHK_STATE 0x00000400 -+#define WIFI_SITE_MONITOR 0x00000800 /* to indicate the station is under site surveying */ -+#ifdef WDS -+#define WIFI_WDS 0x00001000 -+#define WIFI_WDS_RX_BEACON 0x00002000 /* already rx WDS AP beacon */ -+#endif -+#ifdef AUTO_CONFIG -+#define WIFI_AUTOCONF 0x00004000 -+#define WIFI_AUTOCONF_IND 0x00008000 -+#endif -+ -+/** -+* ========== P2P Section Start =============== -+#define WIFI_P2P_LISTEN_STATE 0x00010000 -+#define WIFI_P2P_GROUP_FORMATION_STATE 0x00020000 -+ ========== P2P Section End =============== -+*/ -+ -+/* ifdef UNDER_MPTEST */ -+#define WIFI_MP_STATE 0x00010000 -+#define WIFI_MP_CTX_BACKGROUND 0x00020000 /* in continous tx background */ -+#define WIFI_MP_CTX_ST 0x00040000 /* in continous tx with single-tone */ -+#define WIFI_MP_CTX_BACKGROUND_PENDING 0x00080000 /* pending in continous tx background due to out of skb */ -+#define WIFI_MP_CTX_CCK_HW 0x00100000 /* in continous tx */ -+#define WIFI_MP_CTX_CCK_CS 0x00200000 /* in continous tx with carrier suppression */ -+#define WIFI_MP_LPBK_STATE 0x00400000 -+/* endif */ -+ -+/* define _FW_UNDER_CMD WIFI_UNDER_CMD */ -+#define _FW_UNDER_LINKING WIFI_UNDER_LINKING -+#define _FW_LINKED WIFI_ASOC_STATE -+#define _FW_UNDER_SURVEY WIFI_SITE_MONITOR -+ -+ -+enum dot11AuthAlgrthmNum { -+ dot11AuthAlgrthm_Open = 0, -+ dot11AuthAlgrthm_Shared, -+ dot11AuthAlgrthm_8021X, -+ dot11AuthAlgrthm_Auto, -+ dot11AuthAlgrthm_WAPI, -+ dot11AuthAlgrthm_MaxNum -+}; -+ -+/* Scan type including active and passive scan. */ -+typedef enum _RT_SCAN_TYPE -+{ -+ SCAN_PASSIVE, -+ SCAN_ACTIVE, -+ SCAN_MIX, -+}RT_SCAN_TYPE, *PRT_SCAN_TYPE; -+ -+enum _BAND -+{ -+ GHZ24_50 = 0, -+ GHZ_50, -+ GHZ_24, -+ GHZ_MAX, -+}; -+ -+#define rtw_band_valid(band) ((band) >= GHZ24_50 && (band) < GHZ_MAX) -+ -+enum DriverInterface { -+ DRIVER_WEXT = 1, -+ DRIVER_CFG80211 = 2 -+}; -+ -+enum SCAN_RESULT_TYPE -+{ -+ SCAN_RESULT_P2P_ONLY = 0, /* Will return all the P2P devices. */ -+ SCAN_RESULT_ALL = 1, /* Will return all the scanned device, include AP. */ -+ SCAN_RESULT_WFD_TYPE = 2 /* Will just return the correct WFD device. */ -+ /* If this device is Miracast sink device, it will just return all the Miracast source devices. */ -+}; -+ -+/* -+ -+there are several "locks" in mlme_priv, -+since mlme_priv is a shared resource between many threads, -+like ISR/Call-Back functions, the OID handlers, and even timer functions. -+ -+ -+Each struct __queue has its own locks, already. -+Other items are protected by mlme_priv.lock. -+ -+To avoid possible dead lock, any thread trying to modifiying mlme_priv -+SHALL not lock up more than one locks at a time! -+ -+*/ -+ -+ -+#define traffic_threshold 10 -+#define traffic_scan_period 500 -+ -+struct sitesurvey_ctrl { -+ u64 last_tx_pkts; -+ uint last_rx_pkts; -+ sint traffic_busy; -+ _timer sitesurvey_ctrl_timer; -+}; -+ -+typedef struct _RT_LINK_DETECT_T{ -+ u32 NumTxOkInPeriod; -+ u32 NumRxOkInPeriod; -+ u32 NumRxUnicastOkInPeriod; -+ bool bBusyTraffic; -+ bool bTxBusyTraffic; -+ bool bRxBusyTraffic; -+ bool bHigherBusyTraffic; /* For interrupt migration purpose. */ -+ bool bHigherBusyRxTraffic; /* We may disable Tx interrupt according as Rx traffic. */ -+ bool bHigherBusyTxTraffic; /* We may disable Tx interrupt according as Tx traffic. */ -+ /* u8 TrafficBusyState; */ -+ u8 TrafficTransitionCount; -+ u32 LowPowerTransitionCount; -+}RT_LINK_DETECT_T, *PRT_LINK_DETECT_T; -+ -+struct profile_info { -+ u8 ssidlen; -+ u8 ssid[ WLAN_SSID_MAXLEN ]; -+ u8 peermac[ ETH_ALEN ]; -+}; -+ -+struct tx_invite_req_info{ -+ u8 token; -+ u8 benable; -+ u8 go_ssid[ WLAN_SSID_MAXLEN ]; -+ u8 ssidlen; -+ u8 go_bssid[ ETH_ALEN ]; -+ u8 peer_macaddr[ ETH_ALEN ]; -+ u8 operating_ch; /* This information will be set by using the p2p_set op_ch =x */ -+ u8 peer_ch; /* The listen channel for peer P2P device */ -+ -+}; -+ -+struct tx_invite_resp_info{ -+ u8 token; /* Used to record the dialog token of p2p invitation request frame. */ -+}; -+ -+struct tx_provdisc_req_info{ -+ u16 wps_config_method_request; /* Used when sending the provisioning request frame */ -+ u16 peer_channel_num[2]; /* The channel number which the receiver stands. */ -+ struct ndis_802_11_ssid ssid; -+ u8 peerDevAddr[ ETH_ALEN ]; /* Peer device address */ -+ u8 peerIFAddr[ ETH_ALEN ]; /* Peer interface address */ -+ u8 benable; /* This provision discovery request frame is trigger to send or not */ -+}; -+ -+struct rx_provdisc_req_info{ /* When peer device issue prov_disc_req first, we should store the following informations */ -+ u8 peerDevAddr[ ETH_ALEN ]; /* Peer device address */ -+ u8 strconfig_method_desc_of_prov_disc_req[4]; /* description for the config method located in the provisioning discovery request frame. */ -+ /* The UI must know this information to know which config method the remote p2p device is requiring. */ -+}; -+ -+struct tx_nego_req_info{ -+ u16 peer_channel_num[2]; /* The channel number which the receiver stands. */ -+ u8 peerDevAddr[ ETH_ALEN ]; /* Peer device address */ -+ u8 benable; /* This negoitation request frame is trigger to send or not */ -+}; -+ -+struct group_id_info{ -+ u8 go_device_addr[ ETH_ALEN ]; /* The GO's device address of this P2P group */ -+ u8 ssid[ WLAN_SSID_MAXLEN ]; /* The SSID of this P2P group */ -+}; -+ -+struct scan_limit_info{ -+ u8 scan_op_ch_only; /* When this flag is set, the driver should just scan the operation channel */ -+ u8 operation_ch[2]; /* Store the operation channel of invitation request frame */ -+}; -+ -+struct cfg80211_wifidirect_info{ -+ _timer remain_on_ch_timer; -+ u8 restore_channel; -+ struct ieee80211_channel remain_on_ch_channel; -+ enum nl80211_channel_type remain_on_ch_type; -+ u64 remain_on_ch_cookie; -+ bool is_ro_ch; -+ unsigned long last_ro_ch_time; /* this will be updated at the beginning and end of ro_ch */ -+}; -+ -+struct wifidirect_info{ -+ struct adapter * padapter; -+ _timer find_phase_timer; -+ _timer restore_p2p_state_timer; -+ -+ /* Used to do the scanning. After confirming the peer is availalble, the driver transmits the P2P frame to peer. */ -+ _timer pre_tx_scan_timer; -+ _timer reset_ch_sitesurvey; -+ _timer reset_ch_sitesurvey2; /* Just for resetting the scan limit function by using p2p nego */ -+ struct tx_provdisc_req_info tx_prov_disc_info; -+ struct rx_provdisc_req_info rx_prov_disc_info; -+ struct tx_invite_req_info invitereq_info; -+ struct profile_info profileinfo[ P2P_MAX_PERSISTENT_GROUP_NUM ]; /* Store the profile information of persistent group */ -+ struct tx_invite_resp_info inviteresp_info; -+ struct tx_nego_req_info nego_req_info; -+ struct group_id_info groupid_info; /* Store the group id information when doing the group negotiation handshake. */ -+ struct scan_limit_info rx_invitereq_info; /* Used for get the limit scan channel from the Invitation procedure */ -+ struct scan_limit_info p2p_info; /* Used for get the limit scan channel from the P2P negotiation handshake */ -+ enum P2P_ROLE role; -+ enum P2P_STATE pre_p2p_state; -+ enum P2P_STATE p2p_state; -+ u8 device_addr[ETH_ALEN]; /* The device address should be the mac address of this device. */ -+ u8 interface_addr[ETH_ALEN]; -+ u8 social_chan[4]; -+ u8 listen_channel; -+ u8 operating_channel; -+ u8 listen_dwell; /* This value should be between 1 and 3 */ -+ u8 support_rate[8]; -+ u8 p2p_wildcard_ssid[P2P_WILDCARD_SSID_LEN]; -+ u8 intent; /* should only include the intent value. */ -+ u8 p2p_peer_interface_addr[ ETH_ALEN ]; -+ u8 p2p_peer_device_addr[ ETH_ALEN ]; -+ u8 peer_intent; /* Included the intent value and tie breaker value. */ -+ u8 device_name[ WPS_MAX_DEVICE_NAME_LEN ]; /* Device name for displaying on searching device screen */ -+ u8 device_name_len; -+ u8 profileindex; /* Used to point to the index of profileinfo array */ -+ u8 peer_operating_ch; -+ u8 find_phase_state_exchange_cnt; -+ u16 device_password_id_for_nego; /* The device password ID for group negotation */ -+ u8 negotiation_dialog_token; -+ u8 nego_ssid[ WLAN_SSID_MAXLEN ]; /* SSID information for group negotitation */ -+ u8 nego_ssidlen; -+ u8 p2p_group_ssid[WLAN_SSID_MAXLEN]; -+ u8 p2p_group_ssid_len; -+ u8 persistent_supported; /* Flag to know the persistent function should be supported or not. */ -+ /* In the Sigma test, the Sigma will provide this enable from the sta_set_p2p CAPI. */ -+ /* 0: disable */ -+ /* 1: enable */ -+ u8 session_available; /* Flag to set the WFD session available to enable or disable "by Sigma" */ -+ /* In the Sigma test, the Sigma will disable the session available by using the sta_preset CAPI. */ -+ /* 0: disable */ -+ /* 1: enable */ -+ -+ u8 wfd_tdls_enable; /* Flag to enable or disable the TDLS by WFD Sigma */ -+ /* 0: disable */ -+ /* 1: enable */ -+ u8 wfd_tdls_weaksec; /* Flag to enable or disable the weak security function for TDLS by WFD Sigma */ -+ /* 0: disable */ -+ /* In this case, the driver can't issue the tdsl setup request frame. */ -+ /* 1: enable */ -+ /* In this case, the driver can issue the tdls setup request frame */ -+ /* even the current security is weak security. */ -+ -+ enum P2P_WPSINFO ui_got_wps_info; /* This field will store the WPS value (PIN value or PBC) that UI had got from the user. */ -+ u16 supported_wps_cm; /* This field describes the WPS config method which this driver supported. */ -+ /* The value should be the combination of config method defined in page104 of WPS v2.0 spec. */ -+ u8 external_uuid; /* UUID flag */ -+ u8 uuid[16]; /* UUID */ -+ uint channel_list_attr_len; /* This field will contain the length of body of P2P Channel List attribute of group negotitation response frame. */ -+ u8 channel_list_attr[100]; /* This field will contain the body of P2P Channel List attribute of group negotitation response frame. */ -+ /* We will use the channel_cnt and channel_list fields when constructing the group negotitation confirm frame. */ -+ u8 driver_interface; /* Indicate DRIVER_WEXT or DRIVER_CFG80211 */ -+}; -+ -+struct tdls_ss_record{ /* signal strength record */ -+ u8 macaddr[ETH_ALEN]; -+ u8 RxPWDBAll; -+ u8 is_tdls_sta; /* true: direct link sta, false: else */ -+}; -+ -+struct tdls_info{ -+ u8 ap_prohibited; -+ u8 link_established; -+ u8 sta_cnt; -+ u8 sta_maximum; /* 1:tdls sta is equal (NUM_STA-1), reach max direct link number; 0: else; */ -+ struct tdls_ss_record ss_record; -+ u8 ch_sensing; -+ u8 cur_channel; -+ u8 candidate_ch; -+ u8 collect_pkt_num[MAX_CHANNEL_NUM]; -+ _lock cmd_lock; -+ _lock hdl_lock; -+ u8 watchdog_count; -+ u8 dev_discovered; /* WFD_TDLS: for sigma test */ -+ u8 tdls_enable; -+ u8 external_setup; /* true: setup is handled by wpa_supplicant */ -+}; -+ -+struct tdls_txmgmt { -+ u8 peer[ETH_ALEN]; -+ u8 action_code; -+ u8 dialog_token; -+ u16 status_code; -+ u8 *buf; -+ size_t len; -+ u8 external_support; -+}; -+ -+/* used for mlme_priv.roam_flags */ -+enum { -+ RTW_ROAM_ON_EXPIRED = BIT0, -+ RTW_ROAM_ON_RESUME = BIT1, -+ RTW_ROAM_ACTIVE = BIT2, -+}; -+ -+struct mlme_priv { -+ -+ _lock lock; -+ sint fw_state; /* shall we protect this variable? maybe not necessarily... */ -+ u8 bScanInProcess; -+ u8 to_join; /* flag */ -+ -+ u8 to_roam; /* roaming trying times */ -+ struct wlan_network *roam_network; /* the target of active roam */ -+ u8 roam_flags; -+ u8 roam_rssi_diff_th; /* rssi difference threshold for active scan candidate selection */ -+ u32 roam_scan_int_ms; /* scan interval for active roam */ -+ u32 roam_scanr_exp_ms; /* scan result expire time in ms for roam */ -+ u8 roam_tgt_addr[ETH_ALEN]; /* request to roam to speicific target without other consideration */ -+ -+ u8 *nic_hdl; -+ -+ u8 not_indic_disco; -+ struct list_head *pscanned; -+ struct __queue free_bss_pool; -+ struct __queue scanned_queue; -+ u8 *free_bss_buf; -+ u32 num_of_scanned; -+ -+ struct ndis_802_11_ssid assoc_ssid; -+ u8 assoc_bssid[6]; -+ -+ struct wlan_network cur_network; -+ struct wlan_network *cur_network_scanned; -+ -+ /* uint wireless_mode; no used, remove it */ -+ -+ u32 auto_scan_int_ms; -+ -+ _timer assoc_timer; -+ -+ uint assoc_by_bssid; -+ uint assoc_by_rssi; -+ -+ _timer scan_to_timer; /* driver itself handles scan_timeout status. */ -+ unsigned long scan_start_time; /* used to evaluate the time spent in scanning */ -+ -+ _timer set_scan_deny_timer; -+ atomic_t set_scan_deny; /* 0: allowed, 1: deny */ -+ -+ struct qos_priv qospriv; -+ -+ /* Number of non-HT AP/stations */ -+ int num_sta_no_ht; -+ -+ /* Number of HT AP/stations 20 MHz */ -+ /* int num_sta_ht_20mhz; */ -+ -+ -+ int num_FortyMHzIntolerant; -+ -+ struct ht_priv htpriv; -+ -+ RT_LINK_DETECT_T LinkDetectInfo; -+ _timer dynamic_chk_timer; /* dynamic/periodic check timer */ -+ -+ u8 acm_mask; /* for wmm acm mask */ -+ u8 ChannelPlan; -+ RT_SCAN_TYPE scan_mode; /* active: 1, passive: 0 */ -+ -+ u8 *wps_probe_req_ie; -+ u32 wps_probe_req_ie_len; -+ -+ /* Number of associated Non-ERP stations (i.e., stations using 802.11b -+ * in 802.11g BSS) */ -+ int num_sta_non_erp; -+ -+ /* Number of associated stations that do not support Short Slot Time */ -+ int num_sta_no_short_slot_time; -+ -+ /* Number of associated stations that do not support Short Preamble */ -+ int num_sta_no_short_preamble; -+ -+ int olbc; /* Overlapping Legacy BSS Condition */ -+ -+ /* Number of HT associated stations that do not support greenfield */ -+ int num_sta_ht_no_gf; -+ -+ /* Number of associated non-HT stations */ -+ /* int num_sta_no_ht; */ -+ -+ /* Number of HT associated stations 20 MHz */ -+ int num_sta_ht_20mhz; -+ -+ /* Overlapping BSS information */ -+ int olbc_ht; -+ -+ u16 ht_op_mode; -+ -+ u8 *assoc_req; -+ u32 assoc_req_len; -+ u8 *assoc_rsp; -+ u32 assoc_rsp_len; -+ -+ u8 *wps_beacon_ie; -+ /* u8 *wps_probe_req_ie; */ -+ u8 *wps_probe_resp_ie; -+ u8 *wps_assoc_resp_ie; /* for CONFIG_IOCTL_CFG80211, this IE could include p2p ie / wfd ie */ -+ -+ u32 wps_beacon_ie_len; -+ /* u32 wps_probe_req_ie_len; */ -+ u32 wps_probe_resp_ie_len; -+ u32 wps_assoc_resp_ie_len; /* for CONFIG_IOCTL_CFG80211, this IE len could include p2p ie / wfd ie */ -+ -+ u8 *p2p_beacon_ie; -+ u8 *p2p_probe_req_ie; -+ u8 *p2p_probe_resp_ie; -+ u8 *p2p_go_probe_resp_ie; /* for GO */ -+ u8 *p2p_assoc_req_ie; -+ -+ u32 p2p_beacon_ie_len; -+ u32 p2p_probe_req_ie_len; -+ u32 p2p_probe_resp_ie_len; -+ u32 p2p_go_probe_resp_ie_len; /* for GO */ -+ u32 p2p_assoc_req_ie_len; -+ -+ _lock bcn_update_lock; -+ u8 update_bcn; -+ -+#ifdef CONFIG_INTEL_WIDI -+ int widi_state; -+ int listen_state; -+ _timer listen_timer; -+ atomic_t rx_probe_rsp; /* 1:receive probe respone from RDS source. */ -+ u8 *l2sdTaBuffer; -+ u8 channel_idx; -+ u8 group_cnt; /* In WiDi 3.5, they specified another scan algo. for WFD/RDS co-existed */ -+ u8 sa_ext[L2SDTA_SERVICE_VE_LEN]; -+ -+ u8 widi_enable; -+ /** -+ * For WiDi 4; upper layer would set -+ * p2p_primary_device_type_category_id -+ * p2p_primary_device_type_sub_category_id -+ * p2p_secondary_device_type_category_id -+ * p2p_secondary_device_type_sub_category_id -+ */ -+ u16 p2p_pdt_cid; -+ u16 p2p_pdt_scid; -+ u8 num_p2p_sdt; -+ u16 p2p_sdt_cid[MAX_NUM_P2P_SDT]; -+ u16 p2p_sdt_scid[MAX_NUM_P2P_SDT]; -+ u8 p2p_reject_disable; /* When starting NL80211 wpa_supplicant/hostapd, it will call netdev_close */ -+ /* such that it will cause p2p disabled. Use this flag to reject. */ -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ u8 NumOfBcnInfoChkFail; -+ unsigned long timeBcnInfoChkStart; -+}; -+ -+#define rtw_mlme_set_auto_scan_int(adapter, ms) \ -+ do { \ -+ adapter->mlmepriv.auto_scan_int_ms = ms; \ -+ while (0) -+ -+void rtw_mlme_reset_auto_scan_int(struct adapter *adapter); -+ -+struct hostapd_priv -+{ -+ struct adapter *padapter; -+}; -+ -+extern int hostapd_mode_init(struct adapter *padapter); -+extern void hostapd_mode_unload(struct adapter *padapter); -+ -+extern void rtw_joinbss_event_prehandle(struct adapter *adapter, u8 *pbuf); -+extern void rtw_survey_event_callback(struct adapter *adapter, u8 *pbuf); -+extern void rtw_surveydone_event_callback(struct adapter *adapter, u8 *pbuf); -+extern void rtw_joinbss_event_callback(struct adapter *adapter, u8 *pbuf); -+extern void rtw_stassoc_event_callback(struct adapter *adapter, u8 *pbuf); -+extern void rtw_stadel_event_callback(struct adapter *adapter, u8 *pbuf); -+extern void rtw_atimdone_event_callback(struct adapter *adapter, u8 *pbuf); -+extern void rtw_cpwm_event_callback(struct adapter *adapter, u8 *pbuf); -+extern void rtw_wmm_event_callback(struct adapter *padapter, u8 *pbuf); -+ -+extern void rtw_join_timeout_handler(RTW_TIMER_HDL_ARGS); -+extern void _rtw_scan_timeout_handler(RTW_TIMER_HDL_ARGS); -+ -+int event_thread(void *context); -+ -+extern void rtw_free_network_queue(struct adapter *adapter, u8 isfreeall); -+extern int rtw_init_mlme_priv(struct adapter *adapter);/* (struct mlme_priv *pmlmepriv); */ -+ -+extern void rtw_free_mlme_priv (struct mlme_priv *pmlmepriv); -+ -+ -+extern sint rtw_select_and_join_from_scanned_queue(struct mlme_priv *pmlmepriv); -+extern sint rtw_set_key(struct adapter *adapter, struct security_priv *psecuritypriv, sint keyid, u8 set_tx, bool enqueue); -+extern sint rtw_set_auth(struct adapter *adapter, struct security_priv *psecuritypriv); -+ -+__inline static u8 *get_bssid(struct mlme_priv *pmlmepriv) -+{ /* if sta_mode:pmlmepriv->cur_network.network.MacAddress => bssid */ -+ /* if adhoc_mode:pmlmepriv->cur_network.network.MacAddress => ibss mac address */ -+ return pmlmepriv->cur_network.network.MacAddress; -+} -+ -+__inline static sint check_fwstate(struct mlme_priv *pmlmepriv, sint state) -+{ -+ if (pmlmepriv->fw_state & state) -+ return true; -+ -+ return false; -+} -+ -+__inline static sint get_fwstate(struct mlme_priv *pmlmepriv) -+{ -+ return pmlmepriv->fw_state; -+} -+ -+/* -+ * No Limit on the calling context, -+ * therefore set it to be the critical section... -+ * -+ * ### NOTE:#### (!!!!) -+ * MUST TAKE CARE THAT BEFORE CALLING THIS FUNC, YOU SHOULD HAVE LOCKED pmlmepriv->lock -+ */ -+__inline static void set_fwstate(struct mlme_priv *pmlmepriv, sint state) -+{ -+ pmlmepriv->fw_state |= state; -+ /* FOR HW integration */ -+ if (_FW_UNDER_SURVEY ==state) { -+ pmlmepriv->bScanInProcess = true; -+ } -+} -+ -+__inline static void _clr_fwstate_(struct mlme_priv *pmlmepriv, sint state) -+{ -+ pmlmepriv->fw_state &= ~state; -+ /* FOR HW integration */ -+ if (_FW_UNDER_SURVEY ==state) { -+ pmlmepriv->bScanInProcess = false; -+ } -+} -+ -+/* -+ * No Limit on the calling context, -+ * therefore set it to be the critical section... -+ */ -+__inline static void clr_fwstate(struct mlme_priv *pmlmepriv, sint state) -+{ -+ spin_lock_bh(&pmlmepriv->lock); -+ if (check_fwstate(pmlmepriv, state) == true) -+ pmlmepriv->fw_state ^= state; -+ spin_unlock_bh(&pmlmepriv->lock); -+} -+ -+__inline static void set_scanned_network_val(struct mlme_priv *pmlmepriv, sint val) -+{ -+ spin_lock_bh(&pmlmepriv->lock); -+ pmlmepriv->num_of_scanned = val; -+ spin_unlock_bh(&pmlmepriv->lock); -+} -+ -+extern u16 rtw_get_capability(struct wlan_bssid_ex *bss); -+extern void rtw_update_scanned_network(struct adapter *adapter, struct wlan_bssid_ex *target); -+extern void rtw_disconnect_hdl_under_linked(struct adapter * adapter, struct sta_info *psta, u8 free_assoc); -+extern void rtw_generate_random_ibss(u8 *pibss); -+extern struct wlan_network* rtw_find_network(struct __queue *scanned_queue, u8 *addr); -+extern struct wlan_network* rtw_get_oldest_wlan_network(struct __queue *scanned_queue); -+struct wlan_network *_rtw_find_same_network(struct __queue *scanned_queue, struct wlan_network *network); -+ -+extern void rtw_free_assoc_resources(struct adapter * adapter, int lock_scanned_queue); -+extern void rtw_indicate_disconnect(struct adapter * adapter); -+extern void rtw_indicate_connect(struct adapter * adapter); -+void rtw_indicate_scan_done(struct adapter *padapter, bool aborted); -+void rtw_scan_abort(struct adapter *adapter); -+ -+extern int rtw_restruct_sec_ie(struct adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len); -+extern int rtw_restruct_wmm_ie(struct adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len, uint initial_out_len); -+extern void rtw_init_registrypriv_dev_network(struct adapter *adapter); -+ -+extern void rtw_update_registrypriv_dev_network(struct adapter *adapter); -+ -+extern void rtw_get_encrypt_decrypt_from_registrypriv(struct adapter *adapter); -+ -+extern void _rtw_join_timeout_handler(struct adapter *adapter); -+extern void rtw_scan_timeout_handler(struct adapter *adapter); -+ -+extern void rtw_dynamic_check_timer_handlder(struct adapter *adapter); -+bool rtw_is_scan_deny(struct adapter *adapter); -+void rtw_clear_scan_deny(struct adapter *adapter); -+void rtw_set_scan_deny_timer_hdl(struct adapter *adapter); -+void rtw_set_scan_deny(struct adapter *adapter, u32 ms); -+ -+extern int _rtw_init_mlme_priv(struct adapter *padapter); -+ -+void rtw_free_mlme_priv_ie_data(struct mlme_priv *pmlmepriv); -+ -+extern void _rtw_free_mlme_priv(struct mlme_priv *pmlmepriv); -+ -+/* extern struct wlan_network* _rtw_dequeue_network(struct __queue *queue); */ -+ -+extern struct wlan_network* _rtw_alloc_network(struct mlme_priv *pmlmepriv); -+ -+ -+extern void _rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 isfreeall); -+extern void _rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork); -+ -+ -+extern struct wlan_network* _rtw_find_network(struct __queue *scanned_queue, u8 *addr); -+ -+extern void _rtw_free_network_queue(struct adapter *padapter, u8 isfreeall); -+ -+extern sint rtw_if_up(struct adapter *padapter); -+ -+sint rtw_linked_check(struct adapter *padapter); -+ -+u8 *rtw_get_capability_from_ie(u8 *ie); -+u8 *rtw_get_beacon_interval_from_ie(u8 *ie); -+ -+ -+void rtw_joinbss_reset(struct adapter *padapter); -+ -+void rtw_ht_use_default_setting(struct adapter *padapter); -+void rtw_build_wmm_ie_ht(struct adapter *padapter, u8 *out_ie, uint *pout_len); -+unsigned int rtw_restructure_ht_ie(struct adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len, u8 channel); -+void rtw_update_ht_cap(struct adapter *padapter, u8 *pie, uint ie_len, u8 channel); -+void rtw_issue_addbareq_cmd(struct adapter *padapter, struct xmit_frame *pxmitframe); -+void rtw_append_exented_cap(struct adapter *padapter, u8 *out_ie, uint *pout_len); -+ -+int rtw_is_same_ibss(struct adapter *adapter, struct wlan_network *pnetwork); -+int is_same_network(struct wlan_bssid_ex *src, struct wlan_bssid_ex *dst, u8 feature); -+ -+#define rtw_roam_flags(adapter) ((adapter)->mlmepriv.roam_flags) -+#define rtw_chk_roam_flags(adapter, flags) ((adapter)->mlmepriv.roam_flags & flags) -+#define rtw_clr_roam_flags(adapter, flags) \ -+ do { \ -+ ((adapter)->mlmepriv.roam_flags &= ~flags); \ -+ } while (0) -+ -+#define rtw_set_roam_flags(adapter, flags) \ -+ do { \ -+ ((adapter)->mlmepriv.roam_flags |= flags); \ -+ } while (0) -+ -+#define rtw_assign_roam_flags(adapter, flags) \ -+ do { \ -+ ((adapter)->mlmepriv.roam_flags = flags); \ -+ } while (0) -+ -+void _rtw_roaming(struct adapter *adapter, struct wlan_network *tgt_network); -+void rtw_roaming(struct adapter *adapter, struct wlan_network *tgt_network); -+void rtw_set_to_roam(struct adapter *adapter, u8 to_roam); -+u8 rtw_dec_to_roam(struct adapter *adapter); -+u8 rtw_to_roam(struct adapter *adapter); -+int rtw_select_roaming_candidate(struct mlme_priv *pmlmepriv); -+ -+void rtw_sta_media_status_rpt(struct adapter *adapter, struct sta_info *psta, u32 mstatus); -+ -+#endif /* __RTL871X_MLME_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_mp.h linux/3rdparty/rtl8723bs/include/rtw_mp.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_mp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_mp.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,512 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_MP_H_ -+#define _RTW_MP_H_ -+ -+#define MAX_MP_XMITBUF_SZ 2048 -+#define NR_MP_XMITFRAME 8 -+ -+struct mp_xmit_frame -+{ -+ struct list_head list; -+ -+ struct pkt_attrib attrib; -+ -+ _pkt *pkt; -+ -+ int frame_tag; -+ -+ struct adapter *padapter; -+ -+ uint mem[(MAX_MP_XMITBUF_SZ >> 2)]; -+}; -+ -+struct mp_wiparam -+{ -+ u32 bcompleted; -+ u32 act_type; -+ u32 io_offset; -+ u32 io_value; -+}; -+ -+typedef void(*wi_act_func)(void* padapter); -+ -+struct mp_tx -+{ -+ u8 stop; -+ u32 count, sended; -+ u8 payload; -+ struct pkt_attrib attrib; -+ /* struct tx_desc desc; */ -+ /* u8 resvdtx[7]; */ -+ u8 desc[TXDESC_SIZE]; -+ u8 *pallocated_buf; -+ u8 *buf; -+ u32 buf_size, write_size; -+ void *PktTxThread; -+}; -+ -+#define MP_MAX_LINES 1000 -+#define MP_MAX_LINES_BYTES 256 -+ -+typedef void (*MPT_WORK_ITEM_HANDLER)(void *Adapter); -+typedef struct _MPT_CONTEXT -+{ -+ /* Indicate if we have started Mass Production Test. */ -+ bool bMassProdTest; -+ -+ /* Indicate if the driver is unloading or unloaded. */ -+ bool bMptDrvUnload; -+ -+ _sema MPh2c_Sema; -+ _timer MPh2c_timeout_timer; -+/* Event used to sync H2c for BT control */ -+ -+ bool MptH2cRspEvent; -+ bool MptBtC2hEvent; -+ bool bMPh2c_timeout; -+ -+ /* 8190 PCI does not support NDIS_WORK_ITEM. */ -+ /* Work Item for Mass Production Test. */ -+ /* NDIS_WORK_ITEM MptWorkItem; */ -+/* RT_WORK_ITEM MptWorkItem; */ -+ /* Event used to sync the case unloading driver and MptWorkItem is still in progress. */ -+/* NDIS_EVENT MptWorkItemEvent; */ -+ /* To protect the following variables. */ -+/* NDIS_SPIN_LOCK MptWorkItemSpinLock; */ -+ /* Indicate a MptWorkItem is scheduled and not yet finished. */ -+ bool bMptWorkItemInProgress; -+ /* An instance which implements function and context of MptWorkItem. */ -+ MPT_WORK_ITEM_HANDLER CurrMptAct; -+ -+ /* 1 =Start, 0 =Stop from UI. */ -+ u32 MptTestStart; -+ /* _TEST_MODE, defined in MPT_Req2.h */ -+ u32 MptTestItem; -+ /* Variable needed in each implementation of CurrMptAct. */ -+ u32 MptActType; /* Type of action performed in CurrMptAct. */ -+ /* The Offset of IO operation is depend of MptActType. */ -+ u32 MptIoOffset; -+ /* The Value of IO operation is depend of MptActType. */ -+ u32 MptIoValue; -+ /* The RfPath of IO operation is depend of MptActType. */ -+ u32 MptRfPath; -+ -+ enum WIRELESS_MODE MptWirelessModeToSw; /* Wireless mode to switch. */ -+ u8 MptChannelToSw; /* Channel to switch. */ -+ u8 MptInitGainToSet; /* Initial gain to set. */ -+ u32 MptBandWidth; /* bandwidth to switch. */ -+ u32 MptRateIndex; /* rate index. */ -+ /* Register value kept for Single Carrier Tx test. */ -+ u8 btMpCckTxPower; -+ /* Register value kept for Single Carrier Tx test. */ -+ u8 btMpOfdmTxPower; -+ /* For MP Tx Power index */ -+ u8 TxPwrLevel[2]; /* rf-A, rf-B */ -+ u32 RegTxPwrLimit; -+ /* Content of RCR Regsiter for Mass Production Test. */ -+ u32 MptRCR; -+ /* true if we only receive packets with specific pattern. */ -+ bool bMptFilterPattern; -+ /* Rx OK count, statistics used in Mass Production Test. */ -+ u32 MptRxOkCnt; -+ /* Rx CRC32 error count, statistics used in Mass Production Test. */ -+ u32 MptRxCrcErrCnt; -+ -+ bool bCckContTx; /* true if we are in CCK Continuous Tx test. */ -+ bool bOfdmContTx; /* true if we are in OFDM Continuous Tx test. */ -+ bool bStartContTx; /* true if we have start Continuous Tx test. */ -+ /* true if we are in Single Carrier Tx test. */ -+ bool bSingleCarrier; -+ /* true if we are in Carrier Suppression Tx Test. */ -+ bool bCarrierSuppression; -+ /* true if we are in Single Tone Tx test. */ -+ bool bSingleTone; -+ -+ /* ACK counter asked by K.Y.. */ -+ bool bMptEnableAckCounter; -+ u32 MptAckCounter; -+ -+ /* SD3 Willis For 8192S to save 1T/2T RF table for ACUT Only fro ACUT delete later ~~~! */ -+ /* s8 BufOfLines[2][MAX_LINES_HWCONFIG_TXT][MAX_BYTES_LINE_HWCONFIG_TXT]; */ -+ /* s8 BufOfLines[2][MP_MAX_LINES][MP_MAX_LINES_BYTES]; */ -+ /* s32 RfReadLine[2]; */ -+ -+ u8 APK_bound[2]; /* for APK path A/path B */ -+ bool bMptIndexEven; -+ -+ u8 backup0xc50; -+ u8 backup0xc58; -+ u8 backup0xc30; -+ u8 backup0x52_RF_A; -+ u8 backup0x52_RF_B; -+ -+ u32 backup0x58_RF_A; -+ u32 backup0x58_RF_B; -+ -+ u8 h2cReqNum; -+ u8 c2hBuf[32]; -+ -+ u8 btInBuf[100]; -+ u32 mptOutLen; -+ u8 mptOutBuf[100]; -+ -+}MPT_CONTEXT, *PMPT_CONTEXT; -+/* endif */ -+ -+/* E-Fuse */ -+#define EFUSE_MAP_SIZE 512 -+ -+#define EFUSE_MAX_SIZE 512 -+/* end of E-Fuse */ -+ -+/* define RTPRIV_IOCTL_MP (SIOCIWFIRSTPRIV + 0x17) */ -+enum { -+ WRITE_REG = 1, -+ READ_REG, -+ WRITE_RF, -+ READ_RF, -+ MP_START, -+ MP_STOP, -+ MP_RATE, -+ MP_CHANNEL, -+ MP_BANDWIDTH, -+ MP_TXPOWER, -+ MP_ANT_TX, -+ MP_ANT_RX, -+ MP_CTX, -+ MP_QUERY, -+ MP_ARX, -+ MP_PSD, -+ MP_PWRTRK, -+ MP_THER, -+ MP_IOCTL, -+ EFUSE_GET, -+ EFUSE_SET, -+ MP_RESET_STATS, -+ MP_DUMP, -+ MP_PHYPARA, -+ MP_SetRFPathSwh, -+ MP_QueryDrvStats, -+ MP_SetBT, -+ CTA_TEST, -+ MP_DISABLE_BT_COEXIST, -+ MP_PwrCtlDM, -+#ifdef CONFIG_WOWLAN -+ MP_WOW_ENABLE, -+#endif -+#ifdef CONFIG_AP_WOWLAN -+ MP_AP_WOW_ENABLE, -+#endif -+ MP_NULL, -+ MP_GET_TXPOWER_INX, -+}; -+ -+struct mp_priv -+{ -+ struct adapter *papdater; -+ -+ /* Testing Flag */ -+ u32 mode;/* 0 for normal type packet, 1 for loopback packet (16bytes TXCMD) */ -+ -+ u32 prev_fw_state; -+ -+ /* OID cmd handler */ -+ struct mp_wiparam workparam; -+/* u8 act_in_progress; */ -+ -+ /* Tx Section */ -+ u8 TID; -+ u32 tx_pktcount; -+ u32 pktInterval; -+ struct mp_tx tx; -+ -+ /* Rx Section */ -+ u32 rx_bssidpktcount; -+ u32 rx_pktcount; -+ u32 rx_pktcount_filter_out; -+ u32 rx_crcerrpktcount; -+ u32 rx_pktloss; -+ bool rx_bindicatePkt; -+ struct recv_stat rxstat; -+ -+ /* RF/BB relative */ -+ u8 channel; -+ u8 bandwidth; -+ u8 prime_channel_offset; -+ u8 txpoweridx; -+ u8 txpoweridx_b; -+ u8 rateidx; -+ u32 preamble; -+/* u8 modem; */ -+ u32 CrystalCap; -+/* u32 curr_crystalcap; */ -+ -+ u16 antenna_tx; -+ u16 antenna_rx; -+/* u8 curr_rfpath; */ -+ -+ u8 check_mp_pkt; -+ -+ u8 bSetTxPower; -+/* uint ForcedDataRate; */ -+ u8 mp_dm; -+ u8 mac_filter[ETH_ALEN]; -+ u8 bmac_filter; -+ -+ struct wlan_network mp_network; -+ NDIS_802_11_MAC_ADDRESS network_macaddr; -+ -+ u8 *pallocated_mp_xmitframe_buf; -+ u8 *pmp_xmtframe_buf; -+ struct __queue free_mp_xmitqueue; -+ u32 free_mp_xmitframe_cnt; -+ bool bSetRxBssid; -+ bool bTxBufCkFail; -+ -+ MPT_CONTEXT MptCtx; -+ -+ u8 *TXradomBuffer; -+}; -+ -+typedef struct _IOCMD_STRUCT_ { -+ u8 cmdclass; -+ u16 value; -+ u8 index; -+}IOCMD_STRUCT; -+ -+struct rf_reg_param { -+ u32 path; -+ u32 offset; -+ u32 value; -+}; -+ -+struct bb_reg_param { -+ u32 offset; -+ u32 value; -+}; -+ -+#define LOWER true -+#define RAISE false -+ -+/* Hardware Registers */ -+#define BB_REG_BASE_ADDR 0x800 -+ -+/* MP variables */ -+enum MP_MODE { -+ MP_OFF, -+ MP_ON, -+ MP_ERR, -+ MP_CONTINUOUS_TX, -+ MP_SINGLE_CARRIER_TX, -+ MP_CARRIER_SUPPRISSION_TX, -+ MP_SINGLE_TONE_TX, -+ MP_PACKET_TX, -+ MP_PACKET_RX -+}; -+ -+#define MAX_RF_PATH_NUMS RF_PATH_MAX -+ -+extern u8 mpdatarate[NumRates]; -+ -+/* MP set force data rate base on the definition. */ -+enum MPT_RATE_INDEX { -+ /* CCK rate. */ -+ MPT_RATE_1M = 0 , /* 0 */ -+ MPT_RATE_2M, -+ MPT_RATE_55M, -+ MPT_RATE_11M, /* 3 */ -+ -+ /* OFDM rate. */ -+ MPT_RATE_6M, /* 4 */ -+ MPT_RATE_9M, -+ MPT_RATE_12M, -+ MPT_RATE_18M, -+ MPT_RATE_24M, -+ MPT_RATE_36M, -+ MPT_RATE_48M, -+ MPT_RATE_54M, /* 11 */ -+ -+ /* HT rate. */ -+ MPT_RATE_MCS0, /* 12 */ -+ MPT_RATE_MCS1, -+ MPT_RATE_MCS2, -+ MPT_RATE_MCS3, -+ MPT_RATE_MCS4, -+ MPT_RATE_MCS5, -+ MPT_RATE_MCS6, -+ MPT_RATE_MCS7, /* 19 */ -+ MPT_RATE_MCS8, -+ MPT_RATE_MCS9, -+ MPT_RATE_MCS10, -+ MPT_RATE_MCS11, -+ MPT_RATE_MCS12, -+ MPT_RATE_MCS13, -+ MPT_RATE_MCS14, -+ MPT_RATE_MCS15, /* 27 */ -+ /* VHT rate. Total: 20*/ -+ MPT_RATE_VHT1SS_MCS0 = 100,/* To reserve MCS16~MCS31, the index starts from #100. */ -+ MPT_RATE_VHT1SS_MCS1, /* #101 */ -+ MPT_RATE_VHT1SS_MCS2, -+ MPT_RATE_VHT1SS_MCS3, -+ MPT_RATE_VHT1SS_MCS4, -+ MPT_RATE_VHT1SS_MCS5, -+ MPT_RATE_VHT1SS_MCS6, /* #106 */ -+ MPT_RATE_VHT1SS_MCS7, -+ MPT_RATE_VHT1SS_MCS8, -+ MPT_RATE_VHT1SS_MCS9, -+ MPT_RATE_VHT2SS_MCS0, -+ MPT_RATE_VHT2SS_MCS1, /* #111 */ -+ MPT_RATE_VHT2SS_MCS2, -+ MPT_RATE_VHT2SS_MCS3, -+ MPT_RATE_VHT2SS_MCS4, -+ MPT_RATE_VHT2SS_MCS5, -+ MPT_RATE_VHT2SS_MCS6, /* #116 */ -+ MPT_RATE_VHT2SS_MCS7, -+ MPT_RATE_VHT2SS_MCS8, -+ MPT_RATE_VHT2SS_MCS9, -+ MPT_RATE_LAST -+}; -+ -+#define MAX_TX_PWR_INDEX_N_MODE 64 /* 0x3F */ -+ -+enum POWER_MODE { -+ POWER_LOW = 0, -+ POWER_NORMAL -+}; -+ -+/* The following enumeration is used to define the value of Reg0xD00[30:28] or JaguarReg0x914[18:16]. */ -+enum OFDM_TX_MODE { -+ OFDM_ALL_OFF = 0, -+ OFDM_ContinuousTx = 1, -+ OFDM_SingleCarrier = 2, -+ OFDM_SingleTone = 4, -+}; -+ -+#define RX_PKT_BROADCAST 1 -+#define RX_PKT_DEST_ADDR 2 -+#define RX_PKT_PHY_MATCH 3 -+ -+#define Mac_OFDM_OK 0x00000000 -+#define Mac_OFDM_Fail 0x10000000 -+#define Mac_OFDM_FasleAlarm 0x20000000 -+#define Mac_CCK_OK 0x30000000 -+#define Mac_CCK_Fail 0x40000000 -+#define Mac_CCK_FasleAlarm 0x50000000 -+#define Mac_HT_OK 0x60000000 -+#define Mac_HT_Fail 0x70000000 -+#define Mac_HT_FasleAlarm 0x90000000 -+#define Mac_DropPacket 0xA0000000 -+ -+enum ENCRY_CTRL_STATE { -+ HW_CONTROL, /* hw encryption& decryption */ -+ SW_CONTROL, /* sw encryption& decryption */ -+ HW_ENCRY_SW_DECRY, /* hw encryption & sw decryption */ -+ SW_ENCRY_HW_DECRY /* sw encryption & hw decryption */ -+}; -+ -+enum MPT_TXPWR_DEF { -+ MPT_CCK, -+ MPT_OFDM, /* L and HT OFDM */ -+ MPT_VHT_OFDM -+}; -+ -+#define REG_RF_BB_GAIN_OFFSET 0x7f -+#define RF_GAIN_OFFSET_MASK 0xfffff -+ -+/* */ -+/* struct mp_xmit_frame *alloc_mp_xmitframe(struct mp_priv *pmp_priv); */ -+/* int free_mp_xmitframe(struct xmit_priv *pxmitpriv, struct mp_xmit_frame *pmp_xmitframe); */ -+ -+s32 init_mp_priv(struct adapter *padapter); -+void free_mp_priv(struct mp_priv *pmp_priv); -+s32 MPT_InitializeAdapter(struct adapter *padapter, u8 Channel); -+void MPT_DeInitAdapter(struct adapter *padapter); -+s32 mp_start_test(struct adapter *padapter); -+void mp_stop_test(struct adapter *padapter); -+ -+u32 _read_rfreg(struct adapter *padapter, u8 rfpath, u32 addr, u32 bitmask); -+void _write_rfreg(struct adapter *padapter, u8 rfpath, u32 addr, u32 bitmask, u32 val); -+ -+u32 read_macreg(struct adapter *padapter, u32 addr, u32 sz); -+void write_macreg(struct adapter *padapter, u32 addr, u32 val, u32 sz); -+u32 read_bbreg(struct adapter *padapter, u32 addr, u32 bitmask); -+void write_bbreg(struct adapter *padapter, u32 addr, u32 bitmask, u32 val); -+u32 read_rfreg(struct adapter *padapter, u8 rfpath, u32 addr); -+void write_rfreg(struct adapter *padapter, u8 rfpath, u32 addr, u32 val); -+ -+void SetChannel(struct adapter *padapter); -+void SetBandwidth(struct adapter *padapter); -+int SetTxPower(struct adapter *padapter); -+void SetAntennaPathPower(struct adapter *padapter); -+void SetDataRate(struct adapter *padapter); -+ -+void SetAntenna(struct adapter *padapter); -+ -+s32 SetThermalMeter(struct adapter *padapter, u8 target_ther); -+void GetThermalMeter(struct adapter *padapter, u8 *value); -+ -+void SetContinuousTx(struct adapter *padapter, u8 bStart); -+void SetSingleCarrierTx(struct adapter *padapter, u8 bStart); -+void SetSingleToneTx(struct adapter *padapter, u8 bStart); -+void SetCarrierSuppressionTx(struct adapter *padapter, u8 bStart); -+void PhySetTxPowerLevel(struct adapter *padapter); -+ -+void fill_txdesc_for_mp(struct adapter *padapter, u8 *ptxdesc); -+void SetPacketTx(struct adapter *padapter); -+void SetPacketRx(struct adapter *padapter, u8 bStartRx); -+ -+void ResetPhyRxPktCount(struct adapter *padapter); -+u32 GetPhyRxPktReceived(struct adapter *padapter); -+u32 GetPhyRxPktCRC32Error(struct adapter *padapter); -+ -+s32 SetPowerTracking(struct adapter *padapter, u8 enable); -+void GetPowerTracking(struct adapter *padapter, u8 *enable); -+ -+u32 mp_query_psd(struct adapter *padapter, u8 *data); -+ -+void Hal_SetAntenna(struct adapter *padapter); -+void Hal_SetBandwidth(struct adapter *padapter); -+ -+void Hal_SetTxPower(struct adapter *padapter); -+void Hal_SetCarrierSuppressionTx(struct adapter *padapter, u8 bStart); -+void Hal_SetSingleToneTx (struct adapter *padapter , u8 bStart); -+void Hal_SetSingleCarrierTx (struct adapter *padapter, u8 bStart); -+void Hal_SetContinuousTx (struct adapter *padapter, u8 bStart); -+void Hal_SetBandwidth(struct adapter *padapter); -+ -+void Hal_SetDataRate(struct adapter *padapter); -+void Hal_SetChannel(struct adapter *padapter); -+void Hal_SetAntennaPathPower(struct adapter *padapter); -+s32 Hal_SetThermalMeter(struct adapter *padapter, u8 target_ther); -+s32 Hal_SetPowerTracking(struct adapter *padapter, u8 enable); -+void Hal_GetPowerTracking(struct adapter *padapter, u8 * enable); -+void Hal_GetThermalMeter(struct adapter *padapter, u8 *value); -+void Hal_mpt_SwitchRfSetting(struct adapter *padapter); -+void Hal_MPT_CCKTxPowerAdjust(struct adapter * Adapter, bool bInCH14); -+void Hal_MPT_CCKTxPowerAdjustbyIndex(struct adapter *padapter, bool beven); -+void Hal_SetCCKTxPower(struct adapter *padapter, u8 * TxPower); -+void Hal_SetOFDMTxPower(struct adapter *padapter, u8 * TxPower); -+void Hal_TriggerRFThermalMeter(struct adapter *padapter); -+u8 Hal_ReadRFThermalMeter(struct adapter *padapter); -+void Hal_SetCCKContinuousTx(struct adapter *padapter, u8 bStart); -+void Hal_SetOFDMContinuousTx(struct adapter *padapter, u8 bStart); -+void Hal_ProSetCrystalCap (struct adapter *padapter , u32 CrystalCapVal); -+void MP_PHY_SetRFPathSwitch(struct adapter *padapter , bool bMain); -+u32 mpt_ProQueryCalTxPower(struct adapter *padapter, u8 RfPath); -+void MPT_PwrCtlDM(struct adapter *padapter, u32 bstart); -+u8 MptToMgntRate(u32 MptRateIdx); -+ -+#endif /* _RTW_MP_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_odm.h linux/3rdparty/rtl8723bs/include/rtw_odm.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_odm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_odm.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,36 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_ODM_H__ -+#define __RTW_ODM_H__ -+ -+#include -+ -+/* -+* This file provides utilities/wrappers for rtw driver to use ODM -+*/ -+ -+void rtw_odm_dbg_comp_msg(void *sel, struct adapter *adapter); -+void rtw_odm_dbg_comp_set(struct adapter *adapter, u64 comps); -+void rtw_odm_dbg_level_msg(void *sel, struct adapter *adapter); -+void rtw_odm_dbg_level_set(struct adapter *adapter, u32 level); -+ -+void rtw_odm_ability_msg(void *sel, struct adapter *adapter); -+void rtw_odm_ability_set(struct adapter *adapter, u32 ability); -+ -+void rtw_odm_adaptivity_parm_msg(void *sel, struct adapter *adapter); -+void rtw_odm_adaptivity_parm_set(struct adapter *adapter, s8 TH_L2H_ini, s8 TH_EDCCA_HL_diff, -+ s8 IGI_Base, bool ForceEDCCA, u8 AdapEn_RSSI, u8 IGI_LowerBound); -+void rtw_odm_get_perpkt_rssi(void *sel, struct adapter *adapter); -+#endif /* __RTW_ODM_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_pwrctrl.h linux/3rdparty/rtl8723bs/include/rtw_pwrctrl.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_pwrctrl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_pwrctrl.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,375 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_PWRCTRL_H_ -+#define __RTW_PWRCTRL_H_ -+ -+ -+#define FW_PWR0 0 -+#define FW_PWR1 1 -+#define FW_PWR2 2 -+#define FW_PWR3 3 -+ -+ -+#define HW_PWR0 7 -+#define HW_PWR1 6 -+#define HW_PWR2 2 -+#define HW_PWR3 0 -+#define HW_PWR4 8 -+ -+#define FW_PWRMSK 0x7 -+ -+ -+#define XMIT_ALIVE BIT(0) -+#define RECV_ALIVE BIT(1) -+#define CMD_ALIVE BIT(2) -+#define EVT_ALIVE BIT(3) -+#define BTCOEX_ALIVE BIT(4) -+ -+ -+enum Power_Mgnt -+{ -+ PS_MODE_ACTIVE = 0 , -+ PS_MODE_MIN , -+ PS_MODE_MAX , -+ PS_MODE_DTIM , /* PS_MODE_SELF_DEFINED */ -+ PS_MODE_VOIP , -+ PS_MODE_UAPSD_WMM , -+ PS_MODE_UAPSD , -+ PS_MODE_IBSS , -+ PS_MODE_WWLAN , -+ PM_Radio_Off , -+ PM_Card_Disable , -+ PS_MODE_NUM, -+}; -+ -+#ifdef CONFIG_PNO_SUPPORT -+#define MAX_PNO_LIST_COUNT 16 -+#define MAX_SCAN_LIST_COUNT 14 /* 2.4G only */ -+#endif -+ -+/* -+ BIT[2:0] = HW state -+ BIT[3] = Protocol PS state, 0: register active state , 1: register sleep state -+ BIT[4] = sub-state -+*/ -+ -+#define PS_DPS BIT(0) -+#define PS_LCLK (PS_DPS) -+#define PS_RF_OFF BIT(1) -+#define PS_ALL_ON BIT(2) -+#define PS_ST_ACTIVE BIT(3) -+ -+#define PS_ISR_ENABLE BIT(4) -+#define PS_IMR_ENABLE BIT(5) -+#define PS_ACK BIT(6) -+#define PS_TOGGLE BIT(7) -+ -+#define PS_STATE_MASK (0x0F) -+#define PS_STATE_HW_MASK (0x07) -+#define PS_SEQ_MASK (0xc0) -+ -+#define PS_STATE(x) (PS_STATE_MASK & (x)) -+#define PS_STATE_HW(x) (PS_STATE_HW_MASK & (x)) -+#define PS_SEQ(x) (PS_SEQ_MASK & (x)) -+ -+#define PS_STATE_S0 (PS_DPS) -+#define PS_STATE_S1 (PS_LCLK) -+#define PS_STATE_S2 (PS_RF_OFF) -+#define PS_STATE_S3 (PS_ALL_ON) -+#define PS_STATE_S4 ((PS_ST_ACTIVE) | (PS_ALL_ON)) -+ -+ -+#define PS_IS_RF_ON(x) ((x) & (PS_ALL_ON)) -+#define PS_IS_ACTIVE(x) ((x) & (PS_ST_ACTIVE)) -+#define CLR_PS_STATE(x) ((x) = ((x) & (0xF0))) -+ -+ -+struct reportpwrstate_parm { -+ unsigned char mode; -+ unsigned char state; /* the CPWM value */ -+ unsigned short rsvd; -+}; -+ -+ -+typedef _sema _pwrlock; -+ -+ -+#define LPS_DELAY_TIME 1*HZ /* 1 sec */ -+ -+#define EXE_PWR_NONE 0x01 -+#define EXE_PWR_IPS 0x02 -+#define EXE_PWR_LPS 0x04 -+ -+/* RF state. */ -+enum rt_rf_power_state { -+ rf_on, /* RF is on after RFSleep or RFOff */ -+ rf_sleep, /* 802.11 Power Save mode */ -+ rf_off, /* HW/SW Radio OFF or Inactive Power Save */ -+ /* Add the new RF state above this line ===== */ -+ rf_max -+}; -+ -+/* RF Off Level for IPS or HW/SW radio off */ -+#define RT_RF_OFF_LEVL_ASPM BIT(0) /* PCI ASPM */ -+#define RT_RF_OFF_LEVL_CLK_REQ BIT(1) /* PCI clock request */ -+#define RT_RF_OFF_LEVL_PCI_D3 BIT(2) /* PCI D3 mode */ -+#define RT_RF_OFF_LEVL_HALT_NIC BIT(3) /* NIC halt, re-initialize hw parameters */ -+#define RT_RF_OFF_LEVL_FREE_FW BIT(4) /* FW free, re-download the FW */ -+#define RT_RF_OFF_LEVL_FW_32K BIT(5) /* FW in 32k */ -+#define RT_RF_PS_LEVEL_ALWAYS_ASPM BIT(6) /* Always enable ASPM and Clock Req in initialization. */ -+#define RT_RF_LPS_DISALBE_2R BIT(30) /* When LPS is on, disable 2R if no packet is received or transmittd. */ -+#define RT_RF_LPS_LEVEL_ASPM BIT(31) /* LPS with ASPM */ -+ -+#define RT_IN_PS_LEVEL(ppsc, _PS_FLAG) ((ppsc->cur_ps_level & _PS_FLAG) ? true : false) -+#define RT_CLEAR_PS_LEVEL(ppsc, _PS_FLAG) (ppsc->cur_ps_level &= (~(_PS_FLAG))) -+#define RT_SET_PS_LEVEL(ppsc, _PS_FLAG) (ppsc->cur_ps_level |= _PS_FLAG) -+ -+/* ASPM OSC Control bit, added by Roger, 2013.03.29. */ -+#define RT_PCI_ASPM_OSC_IGNORE 0 /* PCI ASPM ignore OSC control in default */ -+#define RT_PCI_ASPM_OSC_ENABLE BIT0 /* PCI ASPM controlled by OS according to ACPI Spec 5.0 */ -+#define RT_PCI_ASPM_OSC_DISABLE BIT1 /* PCI ASPM controlled by driver or BIOS, i.e., force enable ASPM */ -+ -+ -+enum _PS_BBRegBackup_ { -+ PSBBREG_RF0 = 0, -+ PSBBREG_RF1, -+ PSBBREG_RF2, -+ PSBBREG_AFE0, -+ PSBBREG_TOTALCNT -+}; -+ -+enum { /* for ips_mode */ -+ IPS_NONE = 0, -+ IPS_NORMAL, -+ IPS_LEVEL_2, -+ IPS_NUM -+}; -+ -+/* Design for pwrctrl_priv.ips_deny, 32 bits for 32 reasons at most */ -+enum PS_DENY_REASON { -+ PS_DENY_DRV_INITIAL = 0, -+ PS_DENY_SCAN, -+ PS_DENY_JOIN, -+ PS_DENY_DISCONNECT, -+ PS_DENY_SUSPEND, -+ PS_DENY_IOCTL, -+ PS_DENY_MGNT_TX, -+ PS_DENY_DRV_REMOVE = 30, -+ PS_DENY_OTHERS = 31 -+}; -+ -+#ifdef CONFIG_PNO_SUPPORT -+typedef struct pno_nlo_info -+{ -+ u32 fast_scan_period; /* Fast scan period */ -+ u32 ssid_num; /* number of entry */ -+ u32 slow_scan_period; /* slow scan period */ -+ u32 fast_scan_iterations; /* Fast scan iterations */ -+ u8 ssid_length[MAX_PNO_LIST_COUNT]; /* SSID Length Array */ -+ u8 ssid_cipher_info[MAX_PNO_LIST_COUNT]; /* Cipher information for security */ -+ u8 ssid_channel_info[MAX_PNO_LIST_COUNT]; /* channel information */ -+}pno_nlo_info_t; -+ -+typedef struct pno_ssid { -+ u32 SSID_len; -+ u8 SSID[32]; -+} pno_ssid_t; -+ -+typedef struct pno_ssid_list { -+ pno_ssid_t node[MAX_PNO_LIST_COUNT]; -+}pno_ssid_list_t; -+ -+typedef struct pno_scan_channel_info -+{ -+ u8 channel; -+ u8 tx_power; -+ u8 timeout; -+ u8 active; /* set 1 means active scan, or pasivite scan. */ -+}pno_scan_channel_info_t; -+ -+typedef struct pno_scan_info -+{ -+ u8 enableRFE; /* Enable RFE */ -+ u8 period_scan_time; /* exclusive with fast_scan_period and slow_scan_period */ -+ u8 periodScan; /* exclusive with fast_scan_period and slow_scan_period */ -+ u8 orig_80_offset; /* original channel 80 offset */ -+ u8 orig_40_offset; /* original channel 40 offset */ -+ u8 orig_bw; /* original bandwidth */ -+ u8 orig_ch; /* original channel */ -+ u8 channel_num; /* number of channel */ -+ u64 rfe_type; /* rfe_type && 0x00000000000000ff */ -+ pno_scan_channel_info_t ssid_channel_info[MAX_SCAN_LIST_COUNT]; -+}pno_scan_info_t; -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+struct pwrctrl_priv -+{ -+ _pwrlock lock; -+ _pwrlock check_32k_lock; -+ volatile u8 rpwm; /* requested power state for fw */ -+ volatile u8 cpwm; /* fw current power state. updated when 1. read from HCPWM 2. driver lowers power level */ -+ volatile u8 tog; /* toggling */ -+ volatile u8 cpwm_tog; /* toggling */ -+ -+ u8 pwr_mode; -+ u8 smart_ps; -+ u8 bcn_ant_mode; -+ u8 dtim; -+ -+ u32 alives; -+ _workitem cpwm_event; -+ u8 brpwmtimeout; -+ _workitem rpwmtimeoutwi; -+ _timer pwr_rpwm_timer; -+ u8 bpower_saving; /* for LPS/IPS */ -+ -+ u8 b_hw_radio_off; -+ u8 reg_rfoff; -+ u8 reg_pdnmode; /* powerdown mode */ -+ u32 rfoff_reason; -+ -+ /* RF OFF Level */ -+ u32 cur_ps_level; -+ u32 reg_rfps_level; -+ -+ uint ips_enter_cnts; -+ uint ips_leave_cnts; -+ -+ u8 ips_mode; -+ u8 ips_org_mode; -+ u8 ips_mode_req; /* used to accept the mode setting request, will update to ipsmode later */ -+ uint bips_processing; -+ unsigned long ips_deny_time; /* will deny IPS when system time is smaller than this */ -+ u8 pre_ips_type;/* 0: default flow, 1: carddisbale flow */ -+ -+ /* ps_deny: if 0, power save is free to go; otherwise deny all kinds of power save. */ -+ /* Use PS_DENY_REASON to decide reason. */ -+ /* Don't access this variable directly without control function, */ -+ /* and this variable should be protected by lock. */ -+ u32 ps_deny; -+ -+ u8 ps_processing; /* temporarily used to mark whether in rtw_ps_processor */ -+ -+ u8 fw_psmode_iface_id; -+ u8 bLeisurePs; -+ u8 LpsIdleCount; -+ u8 power_mgnt; -+ u8 org_power_mgnt; -+ u8 bFwCurrentInPSMode; -+ unsigned long DelayLPSLastTimeStamp; -+ s32 pnp_current_pwr_state; -+ u8 pnp_bstop_trx; -+ -+ -+ u8 bInternalAutoSuspend; -+ u8 bInSuspend; -+ -+ u8 bAutoResume; -+ u8 autopm_cnt; -+ -+ u8 bSupportRemoteWakeup; -+ u8 wowlan_wake_reason; -+ u8 wowlan_ap_mode; -+ u8 wowlan_mode; -+#ifdef CONFIG_WOWLAN -+ u8 wowlan_pattern; -+ u8 wowlan_magic; -+ u8 wowlan_unicast; -+ u8 wowlan_pattern_idx; -+ u8 wowlan_pno_enable; -+#ifdef CONFIG_PNO_SUPPORT -+ u8 pno_in_resume; -+ u8 pno_inited; -+ pno_nlo_info_t *pnlo_info; -+ pno_scan_info_t *pscan_info; -+ pno_ssid_list_t *pno_ssid_list; -+#endif -+ u32 wowlan_pattern_context[8][5]; -+ u64 wowlan_fw_iv; -+#endif /* CONFIG_WOWLAN */ -+ _timer pwr_state_check_timer; -+ int pwr_state_check_interval; -+ u8 pwr_state_check_cnts; -+ -+ int ps_flag; /* used by autosuspend */ -+ -+ enum rt_rf_power_state rf_pwrstate;/* cur power state, only for IPS */ -+ /* rt_rf_power_state current_rfpwrstate; */ -+ enum rt_rf_power_state change_rfpwrstate; -+ -+ u8 bHWPowerdown; /* power down mode selection. 0:radio off, 1:power down */ -+ u8 bHWPwrPindetect; /* come from registrypriv.hwpwrp_detect. enable power down function. 0:disable, 1:enable */ -+ u8 bkeepfwalive; -+ u8 brfoffbyhw; -+ unsigned long PS_BBRegBackup[PSBBREG_TOTALCNT]; -+}; -+ -+#define rtw_get_ips_mode_req(pwrctl) \ -+ (pwrctl)->ips_mode_req -+ -+#define rtw_ips_mode_req(pwrctl, ips_mode) \ -+ (pwrctl)->ips_mode_req = (ips_mode) -+ -+#define RTW_PWR_STATE_CHK_INTERVAL 2000 -+ -+#define _rtw_set_pwr_state_check_timer(pwrctl, ms) \ -+ do { \ -+ /*DBG_871X("%s _rtw_set_pwr_state_check_timer(%p, %d)\n", __func__, (pwrctl), (ms));*/ \ -+ _set_timer(&(pwrctl)->pwr_state_check_timer, (ms)); \ -+ } while (0) -+ -+#define rtw_set_pwr_state_check_timer(pwrctl) \ -+ _rtw_set_pwr_state_check_timer((pwrctl), (pwrctl)->pwr_state_check_interval) -+ -+extern void rtw_init_pwrctrl_priv(struct adapter *adapter); -+extern void rtw_free_pwrctrl_priv(struct adapter * adapter); -+ -+s32 rtw_register_task_alive(struct adapter *, u32 task); -+void rtw_unregister_task_alive(struct adapter *, u32 task); -+extern s32 rtw_register_tx_alive(struct adapter *padapter); -+extern void rtw_unregister_tx_alive(struct adapter *padapter); -+extern s32 rtw_register_cmd_alive(struct adapter *padapter); -+extern void rtw_unregister_cmd_alive(struct adapter *padapter); -+extern void cpwm_int_hdl(struct adapter *padapter, struct reportpwrstate_parm *preportpwrstate); -+extern void LPS_Leave_check(struct adapter *padapter); -+ -+extern void LeaveAllPowerSaveMode(struct adapter * Adapter); -+extern void LeaveAllPowerSaveModeDirect(struct adapter * Adapter); -+void _ips_enter(struct adapter *padapter); -+void ips_enter(struct adapter *padapter); -+int _ips_leave(struct adapter *padapter); -+int ips_leave(struct adapter *padapter); -+ -+void rtw_ps_processor(struct adapter *padapter); -+ -+s32 LPS_RF_ON_check(struct adapter *padapter, u32 delay_ms); -+void LPS_Enter(struct adapter *padapter, const char *msg); -+void LPS_Leave(struct adapter *padapter, const char *msg); -+void traffic_check_for_leave_lps(struct adapter *padapter, u8 tx, u32 tx_packets); -+void rtw_set_ps_mode(struct adapter *padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode, const char *msg); -+void rtw_set_rpwm(struct adapter *padapter, u8 val8); -+ -+void rtw_set_ips_deny(struct adapter *padapter, u32 ms); -+int _rtw_pwr_wakeup(struct adapter *padapter, u32 ips_deffer_ms, const char *caller); -+#define rtw_pwr_wakeup(adapter) _rtw_pwr_wakeup(adapter, RTW_PWR_STATE_CHK_INTERVAL, __func__) -+#define rtw_pwr_wakeup_ex(adapter, ips_deffer_ms) _rtw_pwr_wakeup(adapter, ips_deffer_ms, __func__) -+int rtw_pm_set_ips(struct adapter *padapter, u8 mode); -+int rtw_pm_set_lps(struct adapter *padapter, u8 mode); -+ -+void rtw_ps_deny(struct adapter *padapter, enum PS_DENY_REASON reason); -+void rtw_ps_deny_cancel(struct adapter *padapter, enum PS_DENY_REASON reason); -+u32 rtw_ps_deny_get(struct adapter *padapter); -+ -+#endif /* __RTL871X_PWRCTRL_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_qos.h linux/3rdparty/rtl8723bs/include/rtw_qos.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_qos.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_qos.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,27 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef _RTW_QOS_H_ -+#define _RTW_QOS_H_ -+ -+ -+ -+struct qos_priv { -+ unsigned int qos_option; /* bit mask option: u-apsd, s-apsd, ts, block ack... */ -+}; -+ -+ -+#endif /* _RTL871X_QOS_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_recv.h linux/3rdparty/rtl8723bs/include/rtw_recv.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_recv.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,553 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_RECV_H_ -+#define _RTW_RECV_H_ -+ -+ #ifdef CONFIG_SINGLE_RECV_BUF -+ #define NR_RECVBUFF (1) -+ #else -+ #define NR_RECVBUFF (8) -+ #endif /* CONFIG_SINGLE_RECV_BUF */ -+ -+ #define NR_PREALLOC_RECV_SKB (8) -+ -+#define NR_RECVFRAME 256 -+ -+#define RXFRAME_ALIGN 8 -+#define RXFRAME_ALIGN_SZ (1<network.PhyInfo.SignalStrength); */ -+ #ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ struct rx_raw_rssi raw_rssi_info; -+ #endif -+ /* s8 rxpwdb; */ -+ s16 noise; -+ /* int RxSNRdB[2]; */ -+ /* s8 RxRssi[2]; */ -+ /* int FalseAlmCnt_all; */ -+ -+ -+ _timer signal_stat_timer; -+ u32 signal_stat_sampling_interval; -+ /* u32 signal_stat_converging_constant; */ -+ struct signal_stat signal_qual_data; -+ struct signal_stat signal_strength_data; -+}; -+ -+#define rtw_set_signal_stat_timer(recvpriv) _set_timer(&(recvpriv)->signal_stat_timer, (recvpriv)->signal_stat_sampling_interval) -+ -+struct sta_recv_priv { -+ -+ _lock lock; -+ sint option; -+ -+ /* struct __queue blk_strms[MAX_RX_NUMBLKS]; */ -+ struct __queue defrag_q; /* keeping the fragment frame until defrag */ -+ -+ struct stainfo_rxcache rxcache; -+ -+ /* uint sta_rx_bytes; */ -+ /* uint sta_rx_pkts; */ -+ /* uint sta_rx_fail; */ -+ -+}; -+ -+ -+struct recv_buf -+{ -+ struct list_head list; -+ -+ _lock recvbuf_lock; -+ -+ u32 ref_cnt; -+ -+ struct adapter * adapter; -+ -+ u8 *pbuf; -+ u8 *pallocated_buf; -+ -+ u32 len; -+ u8 *phead; -+ u8 *pdata; -+ u8 *ptail; -+ u8 *pend; -+ -+ _pkt *pskb; -+ u8 reuse; -+}; -+ -+ -+/* -+ head -----> -+ -+ data -----> -+ -+ payload -+ -+ tail -----> -+ -+ -+ end -----> -+ -+ len = (unsigned int)(tail - data); -+ -+*/ -+struct recv_frame_hdr -+{ -+ struct list_head list; -+#ifndef CONFIG_BSD_RX_USE_MBUF -+ struct sk_buff *pkt; -+ struct sk_buff *pkt_newalloc; -+#else /* CONFIG_BSD_RX_USE_MBUF */ -+ _pkt *pkt; -+ _pkt *pkt_newalloc; -+#endif /* CONFIG_BSD_RX_USE_MBUF */ -+ -+ struct adapter *adapter; -+ -+ u8 fragcnt; -+ -+ int frame_tag; -+ -+ struct rx_pkt_attrib attrib; -+ -+ uint len; -+ u8 *rx_head; -+ u8 *rx_data; -+ u8 *rx_tail; -+ u8 *rx_end; -+ -+ void *precvbuf; -+ -+ -+ /* */ -+ struct sta_info *psta; -+ -+ /* for A-MPDU Rx reordering buffer control */ -+ struct recv_reorder_ctrl *preorder_ctrl; -+}; -+ -+ -+union recv_frame{ -+ union{ -+ struct list_head list; -+ struct recv_frame_hdr hdr; -+ uint mem[RECVFRAME_HDR_ALIGN>>2]; -+ }u; -+ -+ /* uint mem[MAX_RXSZ>>2]; */ -+ -+}; -+ -+enum RX_PACKET_TYPE { -+ NORMAL_RX,/* Normal rx packet */ -+ TX_REPORT1,/* CCX */ -+ TX_REPORT2,/* TX RPT */ -+ HIS_REPORT,/* USB HISR RPT */ -+ C2H_PACKET -+}; -+ -+extern union recv_frame *_rtw_alloc_recvframe (struct __queue *pfree_recv_queue); /* get a free recv_frame from pfree_recv_queue */ -+extern union recv_frame *rtw_alloc_recvframe (struct __queue *pfree_recv_queue); /* get a free recv_frame from pfree_recv_queue */ -+extern int rtw_free_recvframe(union recv_frame *precvframe, struct __queue *pfree_recv_queue); -+ -+#define rtw_dequeue_recvframe(queue) rtw_alloc_recvframe(queue) -+extern int _rtw_enqueue_recvframe(union recv_frame *precvframe, struct __queue *queue); -+extern int rtw_enqueue_recvframe(union recv_frame *precvframe, struct __queue *queue); -+ -+extern void rtw_free_recvframe_queue(struct __queue *pframequeue, struct __queue *pfree_recv_queue); -+u32 rtw_free_uc_swdec_pending_queue(struct adapter *adapter); -+ -+sint rtw_enqueue_recvbuf_to_head(struct recv_buf *precvbuf, struct __queue *queue); -+sint rtw_enqueue_recvbuf(struct recv_buf *precvbuf, struct __queue *queue); -+struct recv_buf *rtw_dequeue_recvbuf (struct __queue *queue); -+ -+void rtw_reordering_ctrl_timeout_handler(void *pcontext); -+ -+__inline static u8 *get_rxmem(union recv_frame *precvframe) -+{ -+ /* always return rx_head... */ -+ if (precvframe == NULL) -+ return NULL; -+ -+ return precvframe->u.hdr.rx_head; -+} -+ -+__inline static u8 *get_recvframe_data(union recv_frame *precvframe) -+{ -+ -+ /* alwasy return rx_data */ -+ if (precvframe == NULL) -+ return NULL; -+ -+ return precvframe->u.hdr.rx_data; -+ -+} -+ -+__inline static u8 *recvframe_pull(union recv_frame *precvframe, sint sz) -+{ -+ /* rx_data += sz; move rx_data sz bytes hereafter */ -+ -+ /* used for extract sz bytes from rx_data, update rx_data and return the updated rx_data to the caller */ -+ -+ -+ if (precvframe == NULL) -+ return NULL; -+ -+ -+ precvframe->u.hdr.rx_data += sz; -+ -+ if (precvframe->u.hdr.rx_data > precvframe->u.hdr.rx_tail) -+ { -+ precvframe->u.hdr.rx_data -= sz; -+ return NULL; -+ } -+ -+ precvframe->u.hdr.len -=sz; -+ -+ return precvframe->u.hdr.rx_data; -+ -+} -+ -+__inline static u8 *recvframe_put(union recv_frame *precvframe, sint sz) -+{ -+ /* rx_tai += sz; move rx_tail sz bytes hereafter */ -+ -+ /* used for append sz bytes from ptr to rx_tail, update rx_tail and return the updated rx_tail to the caller */ -+ /* after putting, rx_tail must be still larger than rx_end. */ -+ unsigned char * prev_rx_tail; -+ -+ if (precvframe == NULL) -+ return NULL; -+ -+ prev_rx_tail = precvframe->u.hdr.rx_tail; -+ -+ precvframe->u.hdr.rx_tail += sz; -+ -+ if (precvframe->u.hdr.rx_tail > precvframe->u.hdr.rx_end) -+ { -+ precvframe->u.hdr.rx_tail = prev_rx_tail; -+ return NULL; -+ } -+ -+ precvframe->u.hdr.len +=sz; -+ -+ return precvframe->u.hdr.rx_tail; -+ -+} -+ -+ -+ -+__inline static u8 *recvframe_pull_tail(union recv_frame *precvframe, sint sz) -+{ -+ /* rmv data from rx_tail (by yitsen) */ -+ -+ /* used for extract sz bytes from rx_end, update rx_end and return the updated rx_end to the caller */ -+ /* after pulling, rx_end must be still larger than rx_data. */ -+ -+ if (precvframe == NULL) -+ return NULL; -+ -+ precvframe->u.hdr.rx_tail -= sz; -+ -+ if (precvframe->u.hdr.rx_tail < precvframe->u.hdr.rx_data) -+ { -+ precvframe->u.hdr.rx_tail += sz; -+ return NULL; -+ } -+ -+ precvframe->u.hdr.len -=sz; -+ -+ return precvframe->u.hdr.rx_tail; -+ -+} -+ -+__inline static union recv_frame *rxmem_to_recvframe(u8 *rxmem) -+{ -+ /* due to the design of 2048 bytes alignment of recv_frame, we can reference the union recv_frame */ -+ /* from any given member of recv_frame. */ -+ /* rxmem indicates the any member/address in recv_frame */ -+ -+ return (union recv_frame*)(((SIZE_PTR)rxmem >> RXFRAME_ALIGN) << RXFRAME_ALIGN); -+ -+} -+ -+__inline static sint get_recvframe_len(union recv_frame *precvframe) -+{ -+ return precvframe->u.hdr.len; -+} -+ -+ -+__inline static s32 translate_percentage_to_dbm(u32 SignalStrengthIndex) -+{ -+ s32 SignalPower; /* in dBm. */ -+ -+#ifdef CONFIG_SKIP_SIGNAL_SCALE_MAPPING -+ /* Translate to dBm (x =y-100) */ -+ SignalPower = SignalStrengthIndex - 100; -+#else -+ /* Translate to dBm (x = 0.5y-95). */ -+ SignalPower = (s32)((SignalStrengthIndex + 1) >> 1); -+ SignalPower -= 95; -+#endif -+ -+ return SignalPower; -+} -+ -+ -+struct sta_info; -+ -+extern void _rtw_init_sta_recv_priv(struct sta_recv_priv *psta_recvpriv); -+ -+extern void mgt_dispatcher(struct adapter *padapter, union recv_frame *precv_frame); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_rf.h linux/3rdparty/rtl8723bs/include/rtw_rf.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_rf.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,159 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_RF_H_ -+#define __RTW_RF_H_ -+ -+ -+#define OFDM_PHY 1 -+#define MIXED_PHY 2 -+#define CCK_PHY 3 -+ -+#define NumRates 13 -+ -+/* slot time for 11g */ -+#define SHORT_SLOT_TIME 9 -+#define NON_SHORT_SLOT_TIME 20 -+ -+#define RTL8711_RF_MAX_SENS 6 -+#define RTL8711_RF_DEF_SENS 4 -+ -+/* */ -+/* We now define the following channels as the max channels in each channel plan. */ -+/* 2G, total 14 chnls */ -+/* {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14} */ -+/* 5G, total 24 chnls */ -+/* {36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, -+ * 124, 128, 132, 136, 140, 149, 153, 157, 161, 165} */ -+#define MAX_CHANNEL_NUM_2G 14 -+#define MAX_CHANNEL_NUM_5G 24 -+#define MAX_CHANNEL_NUM 38/* 14+24 */ -+ -+#define NUM_REGULATORYS 1 -+ -+/* Country codes */ -+#define USA 0x555320 -+#define EUROPE 0x1 /* temp, should be provided later */ -+#define JAPAN 0x2 /* temp, should be provided later */ -+ -+struct regulatory_class { -+ u32 starting_freq; /* MHz, */ -+ u8 channel_set[MAX_CHANNEL_NUM]; -+ u8 channel_cck_power[MAX_CHANNEL_NUM];/* dbm */ -+ u8 channel_ofdm_power[MAX_CHANNEL_NUM];/* dbm */ -+ u8 txpower_limit; /* dbm */ -+ u8 channel_spacing; /* MHz */ -+ u8 modem; -+}; -+ -+enum CAPABILITY { -+ cESS = 0x0001, -+ cIBSS = 0x0002, -+ cPollable = 0x0004, -+ cPollReq = 0x0008, -+ cPrivacy = 0x0010, -+ cShortPreamble = 0x0020, -+ cPBCC = 0x0040, -+ cChannelAgility = 0x0080, -+ cSpectrumMgnt = 0x0100, -+ cQos = 0x0200, /* For HCCA, use with CF-Pollable and CF-PollReq */ -+ cShortSlotTime = 0x0400, -+ cAPSD = 0x0800, -+ cRM = 0x1000, /* RRM (Radio Request Measurement) */ -+ cDSSS_OFDM = 0x2000, -+ cDelayedBA = 0x4000, -+ cImmediateBA = 0x8000, -+}; -+ -+enum _REG_PREAMBLE_MODE { -+ PREAMBLE_LONG = 1, -+ PREAMBLE_AUTO = 2, -+ PREAMBLE_SHORT = 3, -+}; -+ -+enum _RTL8712_RF_MIMO_CONFIG_ { -+ RTL8712_RFCONFIG_1T = 0x10, -+ RTL8712_RFCONFIG_2T = 0x20, -+ RTL8712_RFCONFIG_1R = 0x01, -+ RTL8712_RFCONFIG_2R = 0x02, -+ RTL8712_RFCONFIG_1T1R = 0x11, -+ RTL8712_RFCONFIG_1T2R = 0x12, -+ RTL8712_RFCONFIG_TURBO = 0x92, -+ RTL8712_RFCONFIG_2T2R = 0x22 -+}; -+ -+enum RF90_RADIO_PATH { -+ RF90_PATH_A = 0, /* Radio Path A */ -+ RF90_PATH_B = 1, /* Radio Path B */ -+ RF90_PATH_C = 2, /* Radio Path C */ -+ RF90_PATH_D = 3 /* Radio Path D */ -+}; -+ -+/* Bandwidth Offset */ -+#define HAL_PRIME_CHNL_OFFSET_DONT_CARE 0 -+#define HAL_PRIME_CHNL_OFFSET_LOWER 1 -+#define HAL_PRIME_CHNL_OFFSET_UPPER 2 -+ -+/* Represent Channel Width in HT Capabilities */ -+enum CHANNEL_WIDTH { -+ CHANNEL_WIDTH_20 = 0, -+ CHANNEL_WIDTH_40 = 1, -+ CHANNEL_WIDTH_80 = 2, -+ CHANNEL_WIDTH_160 = 3, -+ CHANNEL_WIDTH_80_80 = 4, -+ CHANNEL_WIDTH_MAX = 5, -+}; -+ -+/* Represent Extension Channel Offset in HT Capabilities */ -+/* This is available only in 40Mhz mode. */ -+enum EXTCHNL_OFFSET { -+ EXTCHNL_OFFSET_NO_EXT = 0, -+ EXTCHNL_OFFSET_UPPER = 1, -+ EXTCHNL_OFFSET_NO_DEF = 2, -+ EXTCHNL_OFFSET_LOWER = 3, -+}; -+ -+enum VHT_DATA_SC { -+ VHT_DATA_SC_DONOT_CARE = 0, -+ VHT_DATA_SC_20_UPPER_OF_80MHZ = 1, -+ VHT_DATA_SC_20_LOWER_OF_80MHZ = 2, -+ VHT_DATA_SC_20_UPPERST_OF_80MHZ = 3, -+ VHT_DATA_SC_20_LOWEST_OF_80MHZ = 4, -+ VHT_DATA_SC_20_RECV1 = 5, -+ VHT_DATA_SC_20_RECV2 = 6, -+ VHT_DATA_SC_20_RECV3 = 7, -+ VHT_DATA_SC_20_RECV4 = 8, -+ VHT_DATA_SC_40_UPPER_OF_80MHZ = 9, -+ VHT_DATA_SC_40_LOWER_OF_80MHZ = 10, -+}; -+ -+enum PROTECTION_MODE { -+ PROTECTION_MODE_AUTO = 0, -+ PROTECTION_MODE_FORCE_ENABLE = 1, -+ PROTECTION_MODE_FORCE_DISABLE = 2, -+}; -+ -+/* 2007/11/15 MH Define different RF type. */ -+enum RT_RF_TYPE_DEFINITION { -+ RF_1T2R = 0, -+ RF_2T4R = 1, -+ RF_2T2R = 2, -+ RF_1T1R = 3, -+ RF_2T2R_GREEN = 4, -+ RF_MAX_TYPE = 5, -+}; -+ -+u32 rtw_ch2freq(u32 ch); -+ -+#endif /* _RTL8711_RF_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_security.h linux/3rdparty/rtl8723bs/include/rtw_security.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_security.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_security.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,440 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_SECURITY_H_ -+#define __RTW_SECURITY_H_ -+ -+ -+#define _NO_PRIVACY_ 0x0 -+#define _WEP40_ 0x1 -+#define _TKIP_ 0x2 -+#define _TKIP_WTMIC_ 0x3 -+#define _AES_ 0x4 -+#define _WEP104_ 0x5 -+#define _WEP_WPA_MIXED_ 0x07 /* WEP + WPA */ -+#define _SMS4_ 0x06 -+#define _BIP_ 0x8 -+#define is_wep_enc(alg) (((alg) == _WEP40_) || ((alg) == _WEP104_)) -+ -+const char *security_type_str(u8 value); -+ -+#define _WPA_IE_ID_ 0xdd -+#define _WPA2_IE_ID_ 0x30 -+ -+#define SHA256_MAC_LEN 32 -+#define AES_BLOCK_SIZE 16 -+#define AES_PRIV_SIZE (4 * 44) -+ -+#define RTW_KEK_LEN 16 -+#define RTW_KCK_LEN 16 -+#define RTW_REPLAY_CTR_LEN 8 -+ -+enum { -+ ENCRYP_PROTOCOL_OPENSYS, /* open system */ -+ ENCRYP_PROTOCOL_WEP, /* WEP */ -+ ENCRYP_PROTOCOL_WPA, /* WPA */ -+ ENCRYP_PROTOCOL_WPA2, /* WPA2 */ -+ ENCRYP_PROTOCOL_WAPI, /* WAPI: Not support in this version */ -+ ENCRYP_PROTOCOL_MAX -+}; -+ -+ -+#ifndef Ndis802_11AuthModeWPA2 -+#define Ndis802_11AuthModeWPA2 (Ndis802_11AuthModeWPANone + 1) -+#endif -+ -+#ifndef Ndis802_11AuthModeWPA2PSK -+#define Ndis802_11AuthModeWPA2PSK (Ndis802_11AuthModeWPANone + 2) -+#endif -+ -+union pn48 { -+ -+ u64 val; -+ -+#ifdef __LITTLE_ENDIAN -+ -+struct { -+ u8 TSC0; -+ u8 TSC1; -+ u8 TSC2; -+ u8 TSC3; -+ u8 TSC4; -+ u8 TSC5; -+ u8 TSC6; -+ u8 TSC7; -+} _byte_; -+#else -+struct { -+ u8 TSC7; -+ u8 TSC6; -+ u8 TSC5; -+ u8 TSC4; -+ u8 TSC3; -+ u8 TSC2; -+ u8 TSC1; -+ u8 TSC0; -+} _byte_; -+#endif -+ -+}; -+ -+union Keytype { -+ u8 skey[16]; -+ u32 lkey[4]; -+}; -+ -+ -+typedef struct _RT_PMKID_LIST -+{ -+ u8 bUsed; -+ u8 Bssid[6]; -+ u8 PMKID[16]; -+ u8 SsidBuf[33]; -+ u8* ssid_octet; -+ u16 ssid_length; -+} RT_PMKID_LIST, *PRT_PMKID_LIST; -+ -+ -+struct security_priv -+{ -+ u32 dot11AuthAlgrthm; /* 802.11 auth, could be open, shared, 8021x and authswitch */ -+ u32 dot11PrivacyAlgrthm; /* This specify the privacy for shared auth. algorithm. */ -+ -+ /* WEP */ -+ u32 dot11PrivacyKeyIndex; /* this is only valid for legendary wep, 0~3 for key id. (tx key index) */ -+ union Keytype dot11DefKey[4]; /* this is only valid for def. key */ -+ u32 dot11DefKeylen[4]; -+ u8 key_mask; /* use to restore wep key after hal_init */ -+ -+ u32 dot118021XGrpPrivacy; /* This specify the privacy algthm. used for Grp key */ -+ u32 dot118021XGrpKeyid; /* key id used for Grp Key (tx key index) */ -+ union Keytype dot118021XGrpKey[BIP_MAX_KEYID]; /* 802.1x Group Key, for inx0 and inx1 */ -+ union Keytype dot118021XGrptxmickey[BIP_MAX_KEYID]; -+ union Keytype dot118021XGrprxmickey[BIP_MAX_KEYID]; -+ union pn48 dot11Grptxpn; /* PN48 used for Grp Key xmit. */ -+ union pn48 dot11Grprxpn; /* PN48 used for Grp Key recv. */ -+ u32 dot11wBIPKeyid; /* key id used for BIP Key (tx key index) */ -+ union Keytype dot11wBIPKey[6]; /* BIP Key, for index4 and index5 */ -+ union pn48 dot11wBIPtxpn; /* PN48 used for Grp Key xmit. */ -+ union pn48 dot11wBIPrxpn; /* PN48 used for Grp Key recv. */ -+ -+ /* extend security capabilities for AP_MODE */ -+ unsigned int dot8021xalg;/* 0:disable, 1:psk, 2:802.1x */ -+ unsigned int wpa_psk;/* 0:disable, bit(0): WPA, bit(1):WPA2 */ -+ unsigned int wpa_group_cipher; -+ unsigned int wpa2_group_cipher; -+ unsigned int wpa_pairwise_cipher; -+ unsigned int wpa2_pairwise_cipher; -+ -+ u8 wps_ie[MAX_WPS_IE_LEN];/* added in assoc req */ -+ int wps_ie_len; -+ -+ -+ u8 binstallGrpkey; -+#ifdef CONFIG_GTK_OL -+ u8 binstallKCK_KEK; -+#endif /* CONFIG_GTK_OL */ -+ u8 binstallBIPkey; -+ u8 busetkipkey; -+ /* _timer tkip_timer; */ -+ u8 bcheck_grpkey; -+ u8 bgrpkey_handshake; -+ -+ s32 sw_encrypt;/* from registry_priv */ -+ s32 sw_decrypt;/* from registry_priv */ -+ -+ s32 hw_decrypted;/* if the rx packets is hw_decrypted ==false, it means the hw has not been ready. */ -+ -+ -+ /* keeps the auth_type & enc_status from upper layer ioctl(wpa_supplicant or wzc) */ -+ u32 ndisauthtype; /* enum NDIS_802_11_AUTHENTICATION_MODE */ -+ u32 ndisencryptstatus; /* NDIS_802_11_ENCRYPTION_STATUS */ -+ -+ struct wlan_bssid_ex sec_bss; /* for joinbss (h2c buffer) usage */ -+ -+ struct ndis_802_11_wep ndiswep; -+ -+ u8 assoc_info[600]; -+ u8 szofcapability[256]; /* for wpa2 usage */ -+ u8 oidassociation[512]; /* for wpa/wpa2 usage */ -+ u8 authenticator_ie[256]; /* store ap security information element */ -+ u8 supplicant_ie[256]; /* store sta security information element */ -+ -+ -+ /* for tkip countermeasure */ -+ unsigned long last_mic_err_time; -+ u8 btkip_countermeasure; -+ u8 btkip_wait_report; -+ u32 btkip_countermeasure_time; -+ -+ /* For WPA2 Pre-Authentication. */ -+ RT_PMKID_LIST PMKIDList[NUM_PMKID_CACHE]; /* Renamed from PreAuthKey[NUM_PRE_AUTH_KEY]. Annie, 2006-10-13. */ -+ u8 PMKIDIndex; -+ -+ u8 bWepDefaultKeyIdxSet; -+ -+#define DBG_SW_SEC_CNT -+#ifdef DBG_SW_SEC_CNT -+ u64 wep_sw_enc_cnt_bc; -+ u64 wep_sw_enc_cnt_mc; -+ u64 wep_sw_enc_cnt_uc; -+ u64 wep_sw_dec_cnt_bc; -+ u64 wep_sw_dec_cnt_mc; -+ u64 wep_sw_dec_cnt_uc; -+ -+ u64 tkip_sw_enc_cnt_bc; -+ u64 tkip_sw_enc_cnt_mc; -+ u64 tkip_sw_enc_cnt_uc; -+ u64 tkip_sw_dec_cnt_bc; -+ u64 tkip_sw_dec_cnt_mc; -+ u64 tkip_sw_dec_cnt_uc; -+ -+ u64 aes_sw_enc_cnt_bc; -+ u64 aes_sw_enc_cnt_mc; -+ u64 aes_sw_enc_cnt_uc; -+ u64 aes_sw_dec_cnt_bc; -+ u64 aes_sw_dec_cnt_mc; -+ u64 aes_sw_dec_cnt_uc; -+#endif /* DBG_SW_SEC_CNT */ -+}; -+ -+struct sha256_state { -+ u64 length; -+ u32 state[8], curlen; -+ u8 buf[64]; -+}; -+ -+#define GET_ENCRY_ALGO(psecuritypriv, psta, encry_algo, bmcst)\ -+do{\ -+ switch (psecuritypriv->dot11AuthAlgrthm)\ -+ {\ -+ case dot11AuthAlgrthm_Open:\ -+ case dot11AuthAlgrthm_Shared:\ -+ case dot11AuthAlgrthm_Auto:\ -+ encry_algo = (u8)psecuritypriv->dot11PrivacyAlgrthm;\ -+ break;\ -+ case dot11AuthAlgrthm_8021X:\ -+ if (bmcst)\ -+ encry_algo = (u8)psecuritypriv->dot118021XGrpPrivacy;\ -+ else\ -+ encry_algo =(u8) psta->dot118021XPrivacy;\ -+ break;\ -+ case dot11AuthAlgrthm_WAPI:\ -+ encry_algo = (u8)psecuritypriv->dot11PrivacyAlgrthm;\ -+ break;\ -+ }\ -+}while (0) -+ -+#define _AES_IV_LEN_ 8 -+ -+#define SET_ICE_IV_LEN(iv_len, icv_len, encrypt)\ -+do{\ -+ switch (encrypt)\ -+ {\ -+ case _WEP40_:\ -+ case _WEP104_:\ -+ iv_len = 4;\ -+ icv_len = 4;\ -+ break;\ -+ case _TKIP_:\ -+ iv_len = 8;\ -+ icv_len = 4;\ -+ break;\ -+ case _AES_:\ -+ iv_len = 8;\ -+ icv_len = 8;\ -+ break;\ -+ case _SMS4_:\ -+ iv_len = 18;\ -+ icv_len = 16;\ -+ break;\ -+ default:\ -+ iv_len = 0;\ -+ icv_len = 0;\ -+ break;\ -+ }\ -+}while (0) -+ -+ -+#define GET_TKIP_PN(iv, dot11txpn)\ -+do{\ -+ dot11txpn._byte_.TSC0 =iv[2];\ -+ dot11txpn._byte_.TSC1 =iv[0];\ -+ dot11txpn._byte_.TSC2 =iv[4];\ -+ dot11txpn._byte_.TSC3 =iv[5];\ -+ dot11txpn._byte_.TSC4 =iv[6];\ -+ dot11txpn._byte_.TSC5 =iv[7];\ -+}while (0) -+ -+ -+#define ROL32(A, n) (((A) << (n)) | (((A)>>(32-(n))) & ((1UL << (n)) - 1))) -+#define ROR32(A, n) ROL32((A), 32-(n)) -+ -+struct mic_data -+{ -+ u32 K0, K1; /* Key */ -+ u32 L, R; /* Current state */ -+ u32 M; /* Message accumulator (single word) */ -+ u32 nBytesInM; /* # bytes in M */ -+}; -+ -+extern const u32 Te0[256]; -+extern const u32 Te1[256]; -+extern const u32 Te2[256]; -+extern const u32 Te3[256]; -+extern const u32 Te4[256]; -+extern const u32 Td0[256]; -+extern const u32 Td1[256]; -+extern const u32 Td2[256]; -+extern const u32 Td3[256]; -+extern const u32 Td4[256]; -+extern const u32 rcon[10]; -+extern const u8 Td4s[256]; -+extern const u8 rcons[10]; -+ -+#define RCON(i) (rcons[(i)] << 24) -+ -+static inline u32 rotr(u32 val, int bits) -+{ -+ return (val >> bits) | (val << (32 - bits)); -+} -+ -+#define TE0(i) Te0[((i) >> 24) & 0xff] -+#define TE1(i) rotr(Te0[((i) >> 16) & 0xff], 8) -+#define TE2(i) rotr(Te0[((i) >> 8) & 0xff], 16) -+#define TE3(i) rotr(Te0[(i) & 0xff], 24) -+#define TE41(i) ((Te0[((i) >> 24) & 0xff] << 8) & 0xff000000) -+#define TE42(i) (Te0[((i) >> 16) & 0xff] & 0x00ff0000) -+#define TE43(i) (Te0[((i) >> 8) & 0xff] & 0x0000ff00) -+#define TE44(i) ((Te0[(i) & 0xff] >> 8) & 0x000000ff) -+#define TE421(i) ((Te0[((i) >> 16) & 0xff] << 8) & 0xff000000) -+#define TE432(i) (Te0[((i) >> 8) & 0xff] & 0x00ff0000) -+#define TE443(i) (Te0[(i) & 0xff] & 0x0000ff00) -+#define TE414(i) ((Te0[((i) >> 24) & 0xff] >> 8) & 0x000000ff) -+#define TE4(i) ((Te0[(i)] >> 8) & 0x000000ff) -+ -+#define TD0(i) Td0[((i) >> 24) & 0xff] -+#define TD1(i) rotr(Td0[((i) >> 16) & 0xff], 8) -+#define TD2(i) rotr(Td0[((i) >> 8) & 0xff], 16) -+#define TD3(i) rotr(Td0[(i) & 0xff], 24) -+#define TD41(i) (Td4s[((i) >> 24) & 0xff] << 24) -+#define TD42(i) (Td4s[((i) >> 16) & 0xff] << 16) -+#define TD43(i) (Td4s[((i) >> 8) & 0xff] << 8) -+#define TD44(i) (Td4s[(i) & 0xff]) -+#define TD0_(i) Td0[(i) & 0xff] -+#define TD1_(i) rotr(Td0[(i) & 0xff], 8) -+#define TD2_(i) rotr(Td0[(i) & 0xff], 16) -+#define TD3_(i) rotr(Td0[(i) & 0xff], 24) -+ -+#define GETU32(pt) (((u32)(pt)[0] << 24) ^ ((u32)(pt)[1] << 16) ^ \ -+ ((u32)(pt)[2] << 8) ^ ((u32)(pt)[3])) -+ -+#define PUTU32(ct, st) { \ -+(ct)[0] = (u8)((st) >> 24); (ct)[1] = (u8)((st) >> 16); \ -+(ct)[2] = (u8)((st) >> 8); (ct)[3] = (u8)(st); } -+ -+#define WPA_GET_BE32(a) ((((u32) (a)[0]) << 24) | (((u32) (a)[1]) << 16) | \ -+ (((u32) (a)[2]) << 8) | ((u32) (a)[3])) -+ -+#define WPA_PUT_LE16(a, val) \ -+ do { \ -+ (a)[1] = ((u16) (val)) >> 8; \ -+ (a)[0] = ((u16) (val)) & 0xff; \ -+ } while (0) -+ -+#define WPA_PUT_BE32(a, val) \ -+ do { \ -+ (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[3] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define WPA_PUT_BE64(a, val) \ -+ do { \ -+ (a)[0] = (u8) (((u64) (val)) >> 56); \ -+ (a)[1] = (u8) (((u64) (val)) >> 48); \ -+ (a)[2] = (u8) (((u64) (val)) >> 40); \ -+ (a)[3] = (u8) (((u64) (val)) >> 32); \ -+ (a)[4] = (u8) (((u64) (val)) >> 24); \ -+ (a)[5] = (u8) (((u64) (val)) >> 16); \ -+ (a)[6] = (u8) (((u64) (val)) >> 8); \ -+ (a)[7] = (u8) (((u64) (val)) & 0xff); \ -+ } while (0) -+ -+/* ===== start - public domain SHA256 implementation ===== */ -+ -+/* This is based on SHA256 implementation in LibTomCrypt that was released into -+ * public domain by Tom St Denis. */ -+ -+/* the K array */ -+static const unsigned long K[64] = { -+ 0x428a2f98UL, 0x71374491UL, 0xb5c0fbcfUL, 0xe9b5dba5UL, 0x3956c25bUL, -+ 0x59f111f1UL, 0x923f82a4UL, 0xab1c5ed5UL, 0xd807aa98UL, 0x12835b01UL, -+ 0x243185beUL, 0x550c7dc3UL, 0x72be5d74UL, 0x80deb1feUL, 0x9bdc06a7UL, -+ 0xc19bf174UL, 0xe49b69c1UL, 0xefbe4786UL, 0x0fc19dc6UL, 0x240ca1ccUL, -+ 0x2de92c6fUL, 0x4a7484aaUL, 0x5cb0a9dcUL, 0x76f988daUL, 0x983e5152UL, -+ 0xa831c66dUL, 0xb00327c8UL, 0xbf597fc7UL, 0xc6e00bf3UL, 0xd5a79147UL, -+ 0x06ca6351UL, 0x14292967UL, 0x27b70a85UL, 0x2e1b2138UL, 0x4d2c6dfcUL, -+ 0x53380d13UL, 0x650a7354UL, 0x766a0abbUL, 0x81c2c92eUL, 0x92722c85UL, -+ 0xa2bfe8a1UL, 0xa81a664bUL, 0xc24b8b70UL, 0xc76c51a3UL, 0xd192e819UL, -+ 0xd6990624UL, 0xf40e3585UL, 0x106aa070UL, 0x19a4c116UL, 0x1e376c08UL, -+ 0x2748774cUL, 0x34b0bcb5UL, 0x391c0cb3UL, 0x4ed8aa4aUL, 0x5b9cca4fUL, -+ 0x682e6ff3UL, 0x748f82eeUL, 0x78a5636fUL, 0x84c87814UL, 0x8cc70208UL, -+ 0x90befffaUL, 0xa4506cebUL, 0xbef9a3f7UL, 0xc67178f2UL -+}; -+ -+ -+/* Various logical functions */ -+#define RORc(x, y) \ -+(((((unsigned long) (x) & 0xFFFFFFFFUL) >> (unsigned long) ((y) & 31)) | \ -+ ((unsigned long) (x) << (unsigned long) (32 - ((y) & 31)))) & 0xFFFFFFFFUL) -+#define Ch(x, y, z) (z ^ (x & (y ^ z))) -+#define Maj(x, y, z) (((x | y) & z) | (x & y)) -+#define S(x, n) RORc((x), (n)) -+#define R(x, n) (((x)&0xFFFFFFFFUL)>>(n)) -+#define Sigma0(x) (S(x, 2) ^ S(x, 13) ^ S(x, 22)) -+#define Sigma1(x) (S(x, 6) ^ S(x, 11) ^ S(x, 25)) -+#define Gamma0(x) (S(x, 7) ^ S(x, 18) ^ R(x, 3)) -+#define Gamma1(x) (S(x, 17) ^ S(x, 19) ^ R(x, 10)) -+#ifndef MIN -+#define MIN(x, y) (((x) < (y)) ? (x) : (y)) -+#endif -+int omac1_aes_128(u8 *key, u8 *data, size_t data_len, u8 *mac); -+void rtw_secmicsetkey(struct mic_data *pmicdata, u8 * key); -+void rtw_secmicappendbyte(struct mic_data *pmicdata, u8 b); -+void rtw_secmicappend(struct mic_data *pmicdata, u8 * src, u32 nBytes); -+void rtw_secgetmic(struct mic_data *pmicdata, u8 * dst); -+ -+void rtw_seccalctkipmic( -+ u8 * key, -+ u8 *header, -+ u8 *data, -+ u32 data_len, -+ u8 *Miccode, -+ u8 priority); -+ -+u32 rtw_aes_encrypt(struct adapter *padapter, u8 *pxmitframe); -+u32 rtw_tkip_encrypt(struct adapter *padapter, u8 *pxmitframe); -+void rtw_wep_encrypt(struct adapter *padapter, u8 *pxmitframe); -+ -+u32 rtw_aes_decrypt(struct adapter *padapter, u8 *precvframe); -+u32 rtw_tkip_decrypt(struct adapter *padapter, u8 *precvframe); -+void rtw_wep_decrypt(struct adapter *padapter, u8 *precvframe); -+u32 rtw_BIP_verify(struct adapter *padapter, u8 *precvframe); -+ -+void rtw_sec_restore_wep_key(struct adapter *adapter); -+u8 rtw_handle_tkip_countermeasure(struct adapter * adapter, const char *caller); -+ -+#endif /* __RTL871X_SECURITY_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_version.h linux/3rdparty/rtl8723bs/include/rtw_version.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_version.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_version.h 2016-04-29 18:14:02.000000000 +0300 -@@ -0,0 +1,2 @@ -+#define DRIVERVERSION "v4.3.5.5_12290.20140916_BTCOEX20140507-4E40" -+#define BTCOEXVERSION "BTCOEX20140507-4E40" -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_wifi_regd.h linux/3rdparty/rtl8723bs/include/rtw_wifi_regd.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_wifi_regd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_wifi_regd.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,35 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2009-2010 Realtek Corporation. -+ * -+ *****************************************************************************/ -+ -+#ifndef __RTW_WIFI_REGD_H__ -+#define __RTW_WIFI_REGD_H__ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 7, 0)) -+#define ieee80211_band nl80211_band -+#define IEEE80211_BAND_2GHZ NL80211_BAND_2GHZ -+#define IEEE80211_BAND_5GHZ NL80211_BAND_5GHZ -+#define IEEE80211_NUM_BANDS NUM_NL80211_BANDS -+#endif -+ -+struct country_code_to_enum_rd { -+ u16 countrycode; -+ const char *iso_name; -+}; -+ -+enum country_code_type_t { -+ COUNTRY_CODE_USER = 0, -+ -+ /*add new channel plan above this line */ -+ COUNTRY_CODE_MAX -+}; -+ -+int rtw_regd_init(struct adapter *padapter, -+ void (*reg_notifier)(struct wiphy *wiphy, -+ struct regulatory_request *request)); -+void rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request); -+ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/rtw_xmit.h linux/3rdparty/rtl8723bs/include/rtw_xmit.h ---- linux.old/3rdparty/rtl8723bs/include/rtw_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/rtw_xmit.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,528 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_XMIT_H_ -+#define _RTW_XMIT_H_ -+ -+ -+#define MAX_XMITBUF_SZ (20480) /* 20k */ -+ -+#define NR_XMITBUFF (16) -+ -+#define XMITBUF_ALIGN_SZ 512 -+ -+/* xmit extension buff defination */ -+#define MAX_XMIT_EXTBUF_SZ (1536) -+#define NR_XMIT_EXTBUFF (32) -+ -+#define MAX_CMDBUF_SZ (5120) /* 4096) */ -+ -+#define MAX_NUMBLKS (1) -+ -+#define XMIT_VO_QUEUE (0) -+#define XMIT_VI_QUEUE (1) -+#define XMIT_BE_QUEUE (2) -+#define XMIT_BK_QUEUE (3) -+ -+#define VO_QUEUE_INX 0 -+#define VI_QUEUE_INX 1 -+#define BE_QUEUE_INX 2 -+#define BK_QUEUE_INX 3 -+#define BCN_QUEUE_INX 4 -+#define MGT_QUEUE_INX 5 -+#define HIGH_QUEUE_INX 6 -+#define TXCMD_QUEUE_INX 7 -+ -+#define HW_QUEUE_ENTRY 8 -+ -+#define WEP_IV(pattrib_iv, dot11txpn, keyidx)\ -+do{\ -+ pattrib_iv[0] = dot11txpn._byte_.TSC0;\ -+ pattrib_iv[1] = dot11txpn._byte_.TSC1;\ -+ pattrib_iv[2] = dot11txpn._byte_.TSC2;\ -+ pattrib_iv[3] = ((keyidx & 0x3)<<6);\ -+ dot11txpn.val = (dot11txpn.val == 0xffffff) ? 0: (dot11txpn.val+1);\ -+}while (0) -+ -+ -+#define TKIP_IV(pattrib_iv, dot11txpn, keyidx)\ -+do{\ -+ pattrib_iv[0] = dot11txpn._byte_.TSC1;\ -+ pattrib_iv[1] = (dot11txpn._byte_.TSC1 | 0x20) & 0x7f;\ -+ pattrib_iv[2] = dot11txpn._byte_.TSC0;\ -+ pattrib_iv[3] = BIT(5) | ((keyidx & 0x3)<<6);\ -+ pattrib_iv[4] = dot11txpn._byte_.TSC2;\ -+ pattrib_iv[5] = dot11txpn._byte_.TSC3;\ -+ pattrib_iv[6] = dot11txpn._byte_.TSC4;\ -+ pattrib_iv[7] = dot11txpn._byte_.TSC5;\ -+ dot11txpn.val = dot11txpn.val == 0xffffffffffffULL ? 0: (dot11txpn.val+1);\ -+}while (0) -+ -+#define AES_IV(pattrib_iv, dot11txpn, keyidx)\ -+do{\ -+ pattrib_iv[0] = dot11txpn._byte_.TSC0;\ -+ pattrib_iv[1] = dot11txpn._byte_.TSC1;\ -+ pattrib_iv[2] = 0;\ -+ pattrib_iv[3] = BIT(5) | ((keyidx & 0x3)<<6);\ -+ pattrib_iv[4] = dot11txpn._byte_.TSC2;\ -+ pattrib_iv[5] = dot11txpn._byte_.TSC3;\ -+ pattrib_iv[6] = dot11txpn._byte_.TSC4;\ -+ pattrib_iv[7] = dot11txpn._byte_.TSC5;\ -+ dot11txpn.val = dot11txpn.val == 0xffffffffffffULL ? 0: (dot11txpn.val+1);\ -+}while (0) -+ -+ -+#define HWXMIT_ENTRY 4 -+ -+/* For Buffer Descriptor ring architecture */ -+#define TXDESC_SIZE 40 -+ -+#define TXDESC_OFFSET TXDESC_SIZE -+ -+enum TXDESC_SC{ -+ SC_DONT_CARE = 0x00, -+ SC_UPPER = 0x01, -+ SC_LOWER = 0x02, -+ SC_DUPLICATE = 0x03 -+}; -+ -+#define TXDESC_40_BYTES -+ -+struct tx_desc { -+ __le32 txdw0; -+ __le32 txdw1; -+ __le32 txdw2; -+ __le32 txdw3; -+ __le32 txdw4; -+ __le32 txdw5; -+ __le32 txdw6; -+ __le32 txdw7; -+ -+#if defined(TXDESC_40_BYTES) || defined(TXDESC_64_BYTES) -+ __le32 txdw8; -+ __le32 txdw9; -+#endif /* TXDESC_40_BYTES */ -+ -+#ifdef TXDESC_64_BYTES -+ __le32 txdw10; -+ __le32 txdw11; -+ -+ /* 2008/05/15 MH Because PCIE HW memory R/W 4K limit. And now, our descriptor */ -+ /* size is 40 bytes. If you use more than 102 descriptor(103*40>4096), HW will execute */ -+ /* memoryR/W CRC error. And then all DMA fetch will fail. We must decrease descriptor */ -+ /* number or enlarge descriptor size as 64 bytes. */ -+ __le32 txdw12; -+ __le32 txdw13; -+ __le32 txdw14; -+ __le32 txdw15; -+#endif -+}; -+ -+union txdesc { -+ struct tx_desc txdesc; -+ unsigned int value[TXDESC_SIZE>>2]; -+}; -+ -+struct hw_xmit { -+ /* _lock xmit_lock; */ -+ /* struct list_head pending; */ -+ struct __queue *sta_queue; -+ /* struct hw_txqueue *phwtxqueue; */ -+ /* sint txcmdcnt; */ -+ int accnt; -+}; -+ -+/* reduce size */ -+struct pkt_attrib -+{ -+ u8 type; -+ u8 subtype; -+ u8 bswenc; -+ u8 dhcp_pkt; -+ u16 ether_type; -+ u16 seqnum; -+ u16 pkt_hdrlen; /* the original 802.3 pkt header len */ -+ u16 hdrlen; /* the WLAN Header Len */ -+ u32 pktlen; /* the original 802.3 pkt raw_data len (not include ether_hdr data) */ -+ u32 last_txcmdsz; -+ u8 nr_frags; -+ u8 encrypt; /* when 0 indicate no encrypt. when non-zero, indicate the encrypt algorith */ -+ u8 iv_len; -+ u8 icv_len; -+ u8 iv[18]; -+ u8 icv[16]; -+ u8 priority; -+ u8 ack_policy; -+ u8 mac_id; -+ u8 vcs_mode; /* virtual carrier sense method */ -+ u8 dst[ETH_ALEN]; -+ u8 src[ETH_ALEN]; -+ u8 ta[ETH_ALEN]; -+ u8 ra[ETH_ALEN]; -+ u8 key_idx; -+ u8 qos_en; -+ u8 ht_en; -+ u8 raid;/* rate adpative id */ -+ u8 bwmode; -+ u8 ch_offset;/* PRIME_CHNL_OFFSET */ -+ u8 sgi;/* short GI */ -+ u8 ampdu_en;/* tx ampdu enable */ -+ u8 ampdu_spacing; /* ampdu_min_spacing for peer sta's rx */ -+ u8 mdata;/* more data bit */ -+ u8 pctrl;/* per packet txdesc control enable */ -+ u8 triggered;/* for ap mode handling Power Saving sta */ -+ u8 qsel; -+ u8 order;/* order bit */ -+ u8 eosp; -+ u8 rate; -+ u8 intel_proxim; -+ u8 retry_ctrl; -+ u8 mbssid; -+ u8 ldpc; -+ u8 stbc; -+ struct sta_info * psta; -+ -+ u8 rtsen; -+ u8 cts2self; -+ union Keytype dot11tkiptxmickey; -+ /* union Keytype dot11tkiprxmickey; */ -+ union Keytype dot118021x_UncstKey; -+ -+ u8 icmp_pkt; -+ -+}; -+ -+#define WLANHDR_OFFSET 64 -+ -+#define NULL_FRAMETAG (0x0) -+#define DATA_FRAMETAG 0x01 -+#define L2_FRAMETAG 0x02 -+#define MGNT_FRAMETAG 0x03 -+#define AMSDU_FRAMETAG 0x04 -+ -+#define EII_FRAMETAG 0x05 -+#define IEEE8023_FRAMETAG 0x06 -+ -+#define MP_FRAMETAG 0x07 -+ -+#define TXAGG_FRAMETAG 0x08 -+ -+enum { -+ XMITBUF_DATA = 0, -+ XMITBUF_MGNT = 1, -+ XMITBUF_CMD = 2, -+}; -+ -+struct submit_ctx{ -+ unsigned long submit_time; /* */ -+ u32 timeout_ms; /* <0: not synchronous, 0: wait forever, >0: up to ms waiting */ -+ int status; /* status for operation */ -+ struct completion done; -+}; -+ -+enum { -+ RTW_SCTX_SUBMITTED = -1, -+ RTW_SCTX_DONE_SUCCESS = 0, -+ RTW_SCTX_DONE_UNKNOWN, -+ RTW_SCTX_DONE_TIMEOUT, -+ RTW_SCTX_DONE_BUF_ALLOC, -+ RTW_SCTX_DONE_BUF_FREE, -+ RTW_SCTX_DONE_WRITE_PORT_ERR, -+ RTW_SCTX_DONE_TX_DESC_NA, -+ RTW_SCTX_DONE_TX_DENY, -+ RTW_SCTX_DONE_CCX_PKT_FAIL, -+ RTW_SCTX_DONE_DRV_STOP, -+ RTW_SCTX_DONE_DEV_REMOVE, -+ RTW_SCTX_DONE_CMD_ERROR, -+}; -+ -+ -+void rtw_sctx_init(struct submit_ctx *sctx, int timeout_ms); -+int rtw_sctx_wait(struct submit_ctx *sctx, const char *msg); -+void rtw_sctx_done_err(struct submit_ctx **sctx, int status); -+void rtw_sctx_done(struct submit_ctx **sctx); -+ -+struct xmit_buf -+{ -+ struct list_head list; -+ -+ struct adapter *padapter; -+ -+ u8 *pallocated_buf; -+ -+ u8 *pbuf; -+ -+ void *priv_data; -+ -+ u16 buf_tag; /* 0: Normal xmitbuf, 1: extension xmitbuf, 2:cmd xmitbuf */ -+ u16 flags; -+ u32 alloc_sz; -+ -+ u32 len; -+ -+ struct submit_ctx *sctx; -+ -+ u8 *phead; -+ u8 *pdata; -+ u8 *ptail; -+ u8 *pend; -+ u32 ff_hwaddr; -+ u8 pg_num; -+ u8 agg_num; -+ -+#if defined(DBG_XMIT_BUF)|| defined(DBG_XMIT_BUF_EXT) -+ u8 no; -+#endif -+ -+}; -+ -+ -+struct xmit_frame -+{ -+ struct list_head list; -+ -+ struct pkt_attrib attrib; -+ -+ _pkt *pkt; -+ -+ int frame_tag; -+ -+ struct adapter *padapter; -+ -+ u8 *buf_addr; -+ -+ struct xmit_buf *pxmitbuf; -+ -+ u8 pg_num; -+ u8 agg_num; -+ -+ u8 ack_report; -+ -+ u8 *alloc_addr; /* the actual address this xmitframe allocated */ -+ u8 ext_tag; /* 0:data, 1:mgmt */ -+ -+}; -+ -+struct tx_servq { -+ struct list_head tx_pending; -+ struct __queue sta_pending; -+ int qcnt; -+}; -+ -+ -+struct sta_xmit_priv -+{ -+ _lock lock; -+ sint option; -+ sint apsd_setting; /* When bit mask is on, the associated edca queue supports APSD. */ -+ -+ -+ /* struct tx_servq blk_q[MAX_NUMBLKS]; */ -+ struct tx_servq be_q; /* priority == 0, 3 */ -+ struct tx_servq bk_q; /* priority == 1, 2 */ -+ struct tx_servq vi_q; /* priority == 4, 5 */ -+ struct tx_servq vo_q; /* priority == 6, 7 */ -+ struct list_head legacy_dz; -+ struct list_head apsd; -+ -+ u16 txseq_tid[16]; -+ -+ /* uint sta_tx_bytes; */ -+ /* u64 sta_tx_pkts; */ -+ /* uint sta_tx_fail; */ -+ -+ -+}; -+ -+ -+struct hw_txqueue { -+ volatile sint head; -+ volatile sint tail; -+ volatile sint free_sz; /* in units of 64 bytes */ -+ volatile sint free_cmdsz; -+ volatile sint txsz[8]; -+ uint ff_hwaddr; -+ uint cmd_hwaddr; -+ sint ac_tag; -+}; -+ -+struct agg_pkt_info{ -+ u16 offset; -+ u16 pkt_len; -+}; -+ -+enum cmdbuf_type { -+ CMDBUF_BEACON = 0x00, -+ CMDBUF_RSVD, -+ CMDBUF_MAX -+}; -+ -+struct xmit_priv { -+ -+ _lock lock; -+ -+ _sema xmit_sema; -+ _sema terminate_xmitthread_sema; -+ -+ /* struct __queue blk_strms[MAX_NUMBLKS]; */ -+ struct __queue be_pending; -+ struct __queue bk_pending; -+ struct __queue vi_pending; -+ struct __queue vo_pending; -+ struct __queue bm_pending; -+ -+ /* struct __queue legacy_dz_queue; */ -+ /* struct __queue apsd_queue; */ -+ -+ u8 *pallocated_frame_buf; -+ u8 *pxmit_frame_buf; -+ uint free_xmitframe_cnt; -+ struct __queue free_xmit_queue; -+ -+ /* uint mapping_addr; */ -+ /* uint pkt_sz; */ -+ -+ u8 *xframe_ext_alloc_addr; -+ u8 *xframe_ext; -+ uint free_xframe_ext_cnt; -+ struct __queue free_xframe_ext_queue; -+ -+ /* struct hw_txqueue be_txqueue; */ -+ /* struct hw_txqueue bk_txqueue; */ -+ /* struct hw_txqueue vi_txqueue; */ -+ /* struct hw_txqueue vo_txqueue; */ -+ /* struct hw_txqueue bmc_txqueue; */ -+ -+ uint frag_len; -+ -+ struct adapter *adapter; -+ -+ u8 vcs_setting; -+ u8 vcs; -+ u8 vcs_type; -+ /* u16 rts_thresh; */ -+ -+ u64 tx_bytes; -+ u64 tx_pkts; -+ u64 tx_drop; -+ u64 last_tx_pkts; -+ -+ struct hw_xmit *hwxmits; -+ u8 hwxmit_entry; -+ -+ u8 wmm_para_seq[4];/* sequence for wmm ac parameter strength from large to small. it's value is 0->vo, 1->vi, 2->be, 3->bk. */ -+ -+#ifdef CONFIG_SDIO_TX_TASKLET -+ struct tasklet_struct xmit_tasklet; -+#else -+ void *SdioXmitThread; -+ _sema SdioXmitSema; -+ _sema SdioXmitTerminateSema; -+#endif /* CONFIG_SDIO_TX_TASKLET */ -+ -+ struct __queue free_xmitbuf_queue; -+ struct __queue pending_xmitbuf_queue; -+ u8 *pallocated_xmitbuf; -+ u8 *pxmitbuf; -+ uint free_xmitbuf_cnt; -+ -+ struct __queue free_xmit_extbuf_queue; -+ u8 *pallocated_xmit_extbuf; -+ u8 *pxmit_extbuf; -+ uint free_xmit_extbuf_cnt; -+ -+ struct xmit_buf pcmd_xmitbuf[CMDBUF_MAX]; -+ -+ u16 nqos_ssn; -+ -+ int ack_tx; -+ _mutex ack_tx_mutex; -+ struct submit_ctx ack_tx_ops; -+ u8 seq_no; -+ _lock lock_sctx; -+}; -+ -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_cmdxmitframe(p) __rtw_alloc_cmdxmitframe(p, CMDBUF_RSVD) -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe(p, CMDBUF_BEACON) -+ -+extern struct xmit_buf *rtw_alloc_xmitbuf_ext(struct xmit_priv *pxmitpriv); -+extern s32 rtw_free_xmitbuf_ext(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+ -+extern struct xmit_buf *rtw_alloc_xmitbuf(struct xmit_priv *pxmitpriv); -+extern s32 rtw_free_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+ -+void rtw_count_tx_stats(struct adapter *padapter, struct xmit_frame *pxmitframe, int sz); -+extern void rtw_update_protection(struct adapter *padapter, u8 *ie, uint ie_len); -+extern s32 rtw_make_wlanhdr(struct adapter *padapter, u8 *hdr, struct pkt_attrib *pattrib); -+extern s32 rtw_put_snap(u8 *data, u16 h_proto); -+ -+extern struct xmit_frame *rtw_alloc_xmitframe(struct xmit_priv *pxmitpriv); -+struct xmit_frame *rtw_alloc_xmitframe_ext(struct xmit_priv *pxmitpriv); -+struct xmit_frame *rtw_alloc_xmitframe_once(struct xmit_priv *pxmitpriv); -+extern s32 rtw_free_xmitframe(struct xmit_priv *pxmitpriv, struct xmit_frame *pxmitframe); -+extern void rtw_free_xmitframe_queue(struct xmit_priv *pxmitpriv, struct __queue *pframequeue); -+struct tx_servq *rtw_get_sta_pending(struct adapter *padapter, struct sta_info *psta, sint up, u8 *ac); -+extern s32 rtw_xmitframe_enqueue(struct adapter *padapter, struct xmit_frame *pxmitframe); -+ -+extern s32 rtw_xmit_classifier(struct adapter *padapter, struct xmit_frame *pxmitframe); -+extern u32 rtw_calculate_wlan_pkt_size_by_attribue(struct pkt_attrib *pattrib); -+#define rtw_wlan_pkt_size(f) rtw_calculate_wlan_pkt_size_by_attribue(&f->attrib) -+extern s32 rtw_xmitframe_coalesce(struct adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe); -+extern s32 rtw_mgmt_xmitframe_coalesce(struct adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe); -+s32 _rtw_init_hw_txqueue(struct hw_txqueue* phw_txqueue, u8 ac_tag); -+void _rtw_init_sta_xmit_priv(struct sta_xmit_priv *psta_xmitpriv); -+ -+ -+s32 rtw_txframes_pending(struct adapter *padapter); -+void rtw_init_hwxmits(struct hw_xmit *phwxmit, sint entry); -+ -+ -+s32 _rtw_init_xmit_priv(struct xmit_priv *pxmitpriv, struct adapter *padapter); -+void _rtw_free_xmit_priv (struct xmit_priv *pxmitpriv); -+ -+ -+void rtw_alloc_hwxmits(struct adapter *padapter); -+void rtw_free_hwxmits(struct adapter *padapter); -+ -+ -+s32 rtw_xmit(struct adapter *padapter, _pkt **pkt); -+bool xmitframe_hiq_filter(struct xmit_frame *xmitframe); -+ -+sint xmitframe_enqueue_for_sleeping_sta(struct adapter *padapter, struct xmit_frame *pxmitframe); -+void stop_sta_xmit(struct adapter *padapter, struct sta_info *psta); -+void wakeup_sta_to_xmit(struct adapter *padapter, struct sta_info *psta); -+void xmit_delivery_enabled_frames(struct adapter *padapter, struct sta_info *psta); -+ -+u8 query_ra_short_GI(struct sta_info *psta); -+ -+u8 qos_acm(u8 acm_mask, u8 priority); -+ -+void enqueue_pending_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+void enqueue_pending_xmitbuf_to_head(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+struct xmit_buf*dequeue_pending_xmitbuf(struct xmit_priv *pxmitpriv); -+struct xmit_buf*dequeue_pending_xmitbuf_under_survey(struct xmit_priv *pxmitpriv); -+sint check_pending_xmitbuf(struct xmit_priv *pxmitpriv); -+int rtw_xmit_thread(void *context); -+ -+u32 rtw_get_ff_hwaddr(struct xmit_frame *pxmitframe); -+ -+int rtw_ack_tx_wait(struct xmit_priv *pxmitpriv, u32 timeout_ms); -+void rtw_ack_tx_done(struct xmit_priv *pxmitpriv, int status); -+ -+/* include after declaring struct xmit_buf, in order to avoid warning */ -+#include -+ -+#endif /* _RTL871X_XMIT_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/sdio_hal.h linux/3rdparty/rtl8723bs/include/sdio_hal.h ---- linux.old/3rdparty/rtl8723bs/include/sdio_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/sdio_hal.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_HAL_H__ -+#define __SDIO_HAL_H__ -+ -+ -+extern u8 sd_hal_bus_init(struct adapter *padapter); -+extern u8 sd_hal_bus_deinit(struct adapter *padapter); -+ -+u8 sd_int_isr(struct adapter *padapter); -+void sd_int_dpc(struct adapter *padapter); -+void rtw_set_hal_ops(struct adapter *padapter); -+ -+void rtl8723bs_set_hal_ops(struct adapter *padapter); -+ -+#endif /* __SDIO_HAL_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/sdio_ops.h linux/3rdparty/rtl8723bs/include/sdio_ops.h ---- linux.old/3rdparty/rtl8723bs/include/sdio_ops.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/sdio_ops.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_OPS_H__ -+#define __SDIO_OPS_H__ -+ -+ -+#include -+ -+extern void sdio_set_intf_ops(struct adapter *padapter, struct _io_ops *pops); -+ -+/* extern void sdio_func1cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem); */ -+/* extern void sdio_func1cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem); */ -+extern u8 SdioLocalCmd52Read1Byte(struct adapter *padapter, u32 addr); -+extern void SdioLocalCmd52Write1Byte(struct adapter *padapter, u32 addr, u8 v); -+extern s32 sdio_local_read(struct adapter *padapter, u32 addr, u32 cnt, u8 *pbuf); -+extern s32 sdio_local_write(struct adapter *padapter, u32 addr, u32 cnt, u8 *pbuf); -+ -+u32 _sdio_read32(struct adapter *padapter, u32 addr); -+s32 _sdio_write32(struct adapter *padapter, u32 addr, u32 val); -+ -+extern void sd_int_hdl(struct adapter *padapter); -+extern u8 CheckIPSStatus(struct adapter *padapter); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+extern u8 RecvOnePkt(struct adapter *padapter, u32 size); -+#endif /* CONFIG_WOWLAN */ -+extern void InitInterrupt8723BSdio(struct adapter *padapter); -+extern void InitSysInterrupt8723BSdio(struct adapter *padapter); -+extern void EnableInterrupt8723BSdio(struct adapter *padapter); -+extern void DisableInterrupt8723BSdio(struct adapter *padapter); -+extern u8 HalQueryTxBufferStatus8723BSdio(struct adapter *padapter); -+extern u8 HalQueryTxOQTBufferStatus8723BSdio(struct adapter *padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+extern void ClearInterrupt8723BSdio(struct adapter *padapter); -+#endif /* CONFIG_WOWLAN */ -+ -+#endif /* !__SDIO_OPS_H__ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/sdio_ops_linux.h linux/3rdparty/rtl8723bs/include/sdio_ops_linux.h ---- linux.old/3rdparty/rtl8723bs/include/sdio_ops_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/sdio_ops_linux.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,40 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_OPS_LINUX_H__ -+#define __SDIO_OPS_LINUX_H__ -+ -+#define SDIO_ERR_VAL8 0xEA -+#define SDIO_ERR_VAL16 0xEAEA -+#define SDIO_ERR_VAL32 0xEAEAEAEA -+ -+u8 sd_f0_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+ -+s32 _sd_cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); -+s32 _sd_cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); -+s32 sd_cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); -+s32 sd_cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); -+ -+u8 sd_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+u32 sd_read32(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+s32 _sd_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); -+s32 sd_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); -+void sd_write8(struct intf_hdl *pintfhdl, u32 addr, u8 v, s32 *err); -+void sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err); -+s32 _sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); -+s32 sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); -+ -+ -+void rtw_sdio_set_irq_thd(struct dvobj_priv *dvobj, void *thd_hdl); -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/sdio_osintf.h linux/3rdparty/rtl8723bs/include/sdio_osintf.h ---- linux.old/3rdparty/rtl8723bs/include/sdio_osintf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/sdio_osintf.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_OSINTF_H__ -+#define __SDIO_OSINTF_H__ -+ -+ -+ -+u8 sd_hal_bus_init(struct adapter *padapter); -+u8 sd_hal_bus_deinit(struct adapter *padapter); -+void sd_c2h_hdl(struct adapter *padapter); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8723bs/include/sta_info.h linux/3rdparty/rtl8723bs/include/sta_info.h ---- linux.old/3rdparty/rtl8723bs/include/sta_info.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/sta_info.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,392 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __STA_INFO_H_ -+#define __STA_INFO_H_ -+ -+ -+#define IBSS_START_MAC_ID 2 -+#define NUM_STA 32 -+#define NUM_ACL 16 -+ -+ -+/* if mode == 0, then the sta is allowed once the addr is hit. */ -+/* if mode == 1, then the sta is rejected once the addr is non-hit. */ -+struct rtw_wlan_acl_node { -+ struct list_head list; -+ u8 addr[ETH_ALEN]; -+ u8 valid; -+}; -+ -+/* mode = 0, disable */ -+/* mode = 1, accept unless in deny list */ -+/* mode =2, deny unless in accept list */ -+struct wlan_acl_pool { -+ int mode; -+ int num; -+ struct rtw_wlan_acl_node aclnode[NUM_ACL]; -+ struct __queue acl_node_q; -+}; -+ -+typedef struct _RSSI_STA{ -+ s32 UndecoratedSmoothedPWDB; -+ s32 UndecoratedSmoothedCCK; -+ s32 UndecoratedSmoothedOFDM; -+ u64 PacketMap; -+ u8 ValidBit; -+}RSSI_STA, *PRSSI_STA; -+ -+struct stainfo_stats { -+ -+ u64 rx_mgnt_pkts; -+ u64 rx_beacon_pkts; -+ u64 rx_probereq_pkts; -+ u64 rx_probersp_pkts; -+ u64 rx_probersp_bm_pkts; -+ u64 rx_probersp_uo_pkts; -+ u64 rx_ctrl_pkts; -+ u64 rx_data_pkts; -+ -+ u64 last_rx_mgnt_pkts; -+ u64 last_rx_beacon_pkts; -+ u64 last_rx_probereq_pkts; -+ u64 last_rx_probersp_pkts; -+ u64 last_rx_probersp_bm_pkts; -+ u64 last_rx_probersp_uo_pkts; -+ u64 last_rx_ctrl_pkts; -+ u64 last_rx_data_pkts; -+ -+ u64 rx_bytes; -+ u64 rx_drops; -+ -+ u64 tx_pkts; -+ u64 tx_bytes; -+ u64 tx_drops; -+}; -+ -+struct sta_info { -+ -+ _lock lock; -+ struct list_head list; /* free_sta_queue */ -+ struct list_head hash_list; /* sta_hash */ -+ struct adapter *padapter; -+ -+ struct sta_xmit_priv sta_xmitpriv; -+ struct sta_recv_priv sta_recvpriv; -+ -+ struct __queue sleep_q; -+ unsigned int sleepq_len; -+ -+ uint state; -+ uint aid; -+ uint mac_id; -+ uint qos_option; -+ u8 hwaddr[ETH_ALEN]; -+ -+ uint ieee8021x_blocked; /* 0: allowed, 1:blocked */ -+ uint dot118021XPrivacy; /* aes, tkip... */ -+ union Keytype dot11tkiptxmickey; -+ union Keytype dot11tkiprxmickey; -+ union Keytype dot118021x_UncstKey; -+ union pn48 dot11txpn; /* PN48 used for Unicast xmit */ -+#ifdef CONFIG_GTK_OL -+ u8 kek[RTW_KEK_LEN]; -+ u8 kck[RTW_KCK_LEN]; -+ u8 replay_ctr[RTW_REPLAY_CTR_LEN]; -+#endif /* CONFIG_GTK_OL */ -+ union pn48 dot11wtxpn; /* PN48 used for Unicast mgmt xmit. */ -+ union pn48 dot11rxpn; /* PN48 used for Unicast recv. */ -+ -+ -+ u8 bssrateset[16]; -+ u32 bssratelen; -+ s32 rssi; -+ s32 signal_quality; -+ -+ u8 cts2self; -+ u8 rtsen; -+ -+ u8 raid; -+ u8 init_rate; -+ u32 ra_mask; -+ u8 wireless_mode; /* NETWORK_TYPE */ -+ u8 bw_mode; -+ -+ u8 ldpc; -+ u8 stbc; -+ -+ struct stainfo_stats sta_stats; -+ -+ /* for A-MPDU TX, ADDBA timeout check */ -+ _timer addba_retry_timer; -+ -+ /* for A-MPDU Rx reordering buffer control */ -+ struct recv_reorder_ctrl recvreorder_ctrl[16]; -+ -+ /* for A-MPDU Tx */ -+ /* unsigned char ampdu_txen_bitmap; */ -+ u16 BA_starting_seqctrl[16]; -+ -+ -+ struct ht_priv htpriv; -+ -+ /* Notes: */ -+ /* STA_Mode: */ -+ /* curr_network(mlme_priv/security_priv/qos/ht) + sta_info: (STA & AP) CAP/INFO */ -+ /* scan_q: AP CAP/INFO */ -+ -+ /* AP_Mode: */ -+ /* curr_network(mlme_priv/security_priv/qos/ht) : AP CAP/INFO */ -+ /* sta_info: (AP & STA) CAP/INFO */ -+ -+ struct list_head asoc_list; -+ struct list_head auth_list; -+ -+ unsigned int expire_to; -+ unsigned int auth_seq; -+ unsigned int authalg; -+ unsigned char chg_txt[128]; -+ -+ u16 capability; -+ int flags; -+ -+ int dot8021xalg;/* 0:disable, 1:psk, 2:802.1x */ -+ int wpa_psk;/* 0:disable, bit(0): WPA, bit(1):WPA2 */ -+ int wpa_group_cipher; -+ int wpa2_group_cipher; -+ int wpa_pairwise_cipher; -+ int wpa2_pairwise_cipher; -+ -+ u8 bpairwise_key_installed; -+ -+ u8 wpa_ie[32]; -+ -+ u8 nonerp_set; -+ u8 no_short_slot_time_set; -+ u8 no_short_preamble_set; -+ u8 no_ht_gf_set; -+ u8 no_ht_set; -+ u8 ht_20mhz_set; -+ -+ unsigned int tx_ra_bitmap; -+ u8 qos_info; -+ -+ u8 max_sp_len; -+ u8 uapsd_bk;/* BIT(0): Delivery enabled, BIT(1): Trigger enabled */ -+ u8 uapsd_be; -+ u8 uapsd_vi; -+ u8 uapsd_vo; -+ -+ u8 has_legacy_ac; -+ unsigned int sleepq_ac_len; -+ -+ u8 under_exist_checking; -+ -+ u8 keep_alive_trycnt; -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ u8 isrc; /* this device is rc */ -+ u16 pid; /* pairing id */ -+#endif -+ -+ u8 *passoc_req; -+ u32 assoc_req_len; -+ -+ /* for DM */ -+ RSSI_STA rssi_stat; -+ -+ /* ODM_STA_INFO_T */ -+ /* ================ODM Relative Info ======================= */ -+ /* Please be care, dont declare too much structure here. It will cost memory * STA support num. */ -+ /* */ -+ /* */ -+ /* 2011/10/20 MH Add for ODM STA info. */ -+ /* */ -+ /* Driver Write */ -+ u8 bValid; /* record the sta status link or not? */ -+ u8 IOTPeer; /* Enum value. HT_IOT_PEER_E */ -+ /* ODM Write */ -+ /* 1 PHY_STATUS_INFO */ -+ u8 RSSI_Path[4]; /* */ -+ u8 RSSI_Ave; -+ u8 RXEVM[4]; -+ u8 RXSNR[4]; -+ -+ u8 rssi_level; /* for Refresh RA mask */ -+ /* ODM Write */ -+ /* 1 TX_INFO (may changed by IC) */ -+ /* TX_INFO_T pTxInfo; Define in IC folder. Move lower layer. */ -+ /* */ -+ /* ================ODM Relative Info ======================= */ -+ /* */ -+ -+ /* To store the sequence number of received management frame */ -+ u16 RxMgmtFrameSeqNum; -+}; -+ -+#define sta_rx_pkts(sta) \ -+ (sta->sta_stats.rx_mgnt_pkts \ -+ + sta->sta_stats.rx_ctrl_pkts \ -+ + sta->sta_stats.rx_data_pkts) -+ -+#define sta_last_rx_pkts(sta) \ -+ (sta->sta_stats.last_rx_mgnt_pkts \ -+ + sta->sta_stats.last_rx_ctrl_pkts \ -+ + sta->sta_stats.last_rx_data_pkts) -+ -+#define sta_rx_data_pkts(sta) \ -+ (sta->sta_stats.rx_data_pkts) -+ -+#define sta_last_rx_data_pkts(sta) \ -+ (sta->sta_stats.last_rx_data_pkts) -+ -+#define sta_rx_mgnt_pkts(sta) \ -+ (sta->sta_stats.rx_mgnt_pkts) -+ -+#define sta_last_rx_mgnt_pkts(sta) \ -+ (sta->sta_stats.last_rx_mgnt_pkts) -+ -+#define sta_rx_beacon_pkts(sta) \ -+ (sta->sta_stats.rx_beacon_pkts) -+ -+#define sta_last_rx_beacon_pkts(sta) \ -+ (sta->sta_stats.last_rx_beacon_pkts) -+ -+#define sta_rx_probereq_pkts(sta) \ -+ (sta->sta_stats.rx_probereq_pkts) -+ -+#define sta_last_rx_probereq_pkts(sta) \ -+ (sta->sta_stats.last_rx_probereq_pkts) -+ -+#define sta_rx_probersp_pkts(sta) \ -+ (sta->sta_stats.rx_probersp_pkts) -+ -+#define sta_last_rx_probersp_pkts(sta) \ -+ (sta->sta_stats.last_rx_probersp_pkts) -+ -+#define sta_rx_probersp_bm_pkts(sta) \ -+ (sta->sta_stats.rx_probersp_bm_pkts) -+ -+#define sta_last_rx_probersp_bm_pkts(sta) \ -+ (sta->sta_stats.last_rx_probersp_bm_pkts) -+ -+#define sta_rx_probersp_uo_pkts(sta) \ -+ (sta->sta_stats.rx_probersp_uo_pkts) -+ -+#define sta_last_rx_probersp_uo_pkts(sta) \ -+ (sta->sta_stats.last_rx_probersp_uo_pkts) -+ -+#define sta_update_last_rx_pkts(sta) \ -+ do { \ -+ sta->sta_stats.last_rx_mgnt_pkts = sta->sta_stats.rx_mgnt_pkts; \ -+ sta->sta_stats.last_rx_beacon_pkts = sta->sta_stats.rx_beacon_pkts; \ -+ sta->sta_stats.last_rx_probereq_pkts = sta->sta_stats.rx_probereq_pkts; \ -+ sta->sta_stats.last_rx_probersp_pkts = sta->sta_stats.rx_probersp_pkts; \ -+ sta->sta_stats.last_rx_probersp_bm_pkts = sta->sta_stats.rx_probersp_bm_pkts; \ -+ sta->sta_stats.last_rx_probersp_uo_pkts = sta->sta_stats.rx_probersp_uo_pkts; \ -+ sta->sta_stats.last_rx_ctrl_pkts = sta->sta_stats.rx_ctrl_pkts; \ -+ sta->sta_stats.last_rx_data_pkts = sta->sta_stats.rx_data_pkts; \ -+ } while (0) -+ -+#define STA_RX_PKTS_ARG(sta) \ -+ sta->sta_stats.rx_mgnt_pkts \ -+ , sta->sta_stats.rx_ctrl_pkts \ -+ , sta->sta_stats.rx_data_pkts -+ -+#define STA_LAST_RX_PKTS_ARG(sta) \ -+ sta->sta_stats.last_rx_mgnt_pkts \ -+ , sta->sta_stats.last_rx_ctrl_pkts \ -+ , sta->sta_stats.last_rx_data_pkts -+ -+#define STA_RX_PKTS_DIFF_ARG(sta) \ -+ sta->sta_stats.rx_mgnt_pkts - sta->sta_stats.last_rx_mgnt_pkts \ -+ , sta->sta_stats.rx_ctrl_pkts - sta->sta_stats.last_rx_ctrl_pkts \ -+ , sta->sta_stats.rx_data_pkts -sta->sta_stats.last_rx_data_pkts -+ -+#define STA_PKTS_FMT "(m:%llu, c:%llu, d:%llu)" -+ -+struct sta_priv { -+ -+ u8 *pallocated_stainfo_buf; -+ u8 *pstainfo_buf; -+ struct __queue free_sta_queue; -+ -+ _lock sta_hash_lock; -+ struct list_head sta_hash[NUM_STA]; -+ int asoc_sta_count; -+ struct __queue sleep_q; -+ struct __queue wakeup_q; -+ -+ struct adapter *padapter; -+ -+ struct list_head asoc_list; -+ struct list_head auth_list; -+ _lock asoc_list_lock; -+ _lock auth_list_lock; -+ u8 asoc_list_cnt; -+ u8 auth_list_cnt; -+ -+ unsigned int auth_to; /* sec, time to expire in authenticating. */ -+ unsigned int assoc_to; /* sec, time to expire before associating. */ -+ unsigned int expire_to; /* sec , time to expire after associated. */ -+ -+ /* pointers to STA info; based on allocated AID or NULL if AID free -+ * AID is in the range 1-2007, so sta_aid[0] corresponders to AID 1 -+ * and so on -+ */ -+ struct sta_info *sta_aid[NUM_STA]; -+ -+ u16 sta_dz_bitmap;/* only support 15 stations, staion aid bitmap for sleeping sta. */ -+ u16 tim_bitmap;/* only support 15 stations, aid = 0~15 mapping bit0~bit15 */ -+ -+ u16 max_num_sta; -+ -+ struct wlan_acl_pool acl_list; -+}; -+ -+ -+__inline static u32 wifi_mac_hash(u8 *mac) -+{ -+ u32 x; -+ -+ x = mac[0]; -+ x = (x << 2) ^ mac[1]; -+ x = (x << 2) ^ mac[2]; -+ x = (x << 2) ^ mac[3]; -+ x = (x << 2) ^ mac[4]; -+ x = (x << 2) ^ mac[5]; -+ -+ x ^= x >> 8; -+ x = x & (NUM_STA - 1); -+ -+ return x; -+} -+ -+ -+extern u32 _rtw_init_sta_priv(struct sta_priv *pstapriv); -+extern u32 _rtw_free_sta_priv(struct sta_priv *pstapriv); -+ -+#define stainfo_offset_valid(offset) (offset < NUM_STA && offset >= 0) -+int rtw_stainfo_offset(struct sta_priv *stapriv, struct sta_info *sta); -+struct sta_info *rtw_get_stainfo_by_offset(struct sta_priv *stapriv, int offset); -+ -+extern struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr); -+extern u32 rtw_free_stainfo(struct adapter *padapter , struct sta_info *psta); -+extern void rtw_free_all_stainfo(struct adapter *padapter); -+extern struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr); -+extern u32 rtw_init_bcmc_stainfo(struct adapter *padapter); -+extern struct sta_info* rtw_get_bcmc_stainfo(struct adapter *padapter); -+extern u8 rtw_access_ctrl(struct adapter *padapter, u8 *mac_addr); -+ -+#endif /* _STA_INFO_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/wifi.h linux/3rdparty/rtl8723bs/include/wifi.h ---- linux.old/3rdparty/rtl8723bs/include/wifi.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/wifi.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1158 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _WIFI_H_ -+#define _WIFI_H_ -+ -+ -+#ifdef BIT -+/* error "BIT define occurred earlier elsewhere!\n" */ -+#undef BIT -+#endif -+#define BIT(x) (1 << (x)) -+ -+ -+#define WLAN_ETHHDR_LEN 14 -+#define WLAN_ETHADDR_LEN 6 -+#define WLAN_IEEE_OUI_LEN 3 -+#define WLAN_ADDR_LEN 6 -+#define WLAN_CRC_LEN 4 -+#define WLAN_BSSID_LEN 6 -+#define WLAN_BSS_TS_LEN 8 -+#define WLAN_HDR_A3_LEN 24 -+#define WLAN_HDR_A4_LEN 30 -+#define WLAN_HDR_A3_QOS_LEN 26 -+#define WLAN_HDR_A4_QOS_LEN 32 -+#define WLAN_SSID_MAXLEN 32 -+#define WLAN_DATA_MAXLEN 2312 -+ -+#define WLAN_A3_PN_OFFSET 24 -+#define WLAN_A4_PN_OFFSET 30 -+ -+#define WLAN_MIN_ETHFRM_LEN 60 -+#define WLAN_MAX_ETHFRM_LEN 1514 -+#define WLAN_ETHHDR_LEN 14 -+#define WLAN_WMM_LEN 24 -+ -+#define P80211CAPTURE_VERSION 0x80211001 -+ -+/* This value is tested by WiFi 11n Test Plan 5.2.3. */ -+/* This test verifies the WLAN NIC can update the NAV through sending the CTS with large duration. */ -+#define WiFiNavUpperUs 30000 /* 30 ms */ -+ -+enum WIFI_FRAME_TYPE { -+ WIFI_MGT_TYPE = (0), -+ WIFI_CTRL_TYPE = (BIT(2)), -+ WIFI_DATA_TYPE = (BIT(3)), -+ WIFI_QOS_DATA_TYPE = (BIT(7)|BIT(3)), /* QoS Data */ -+}; -+ -+enum WIFI_FRAME_SUBTYPE { -+ -+ /* below is for mgt frame */ -+ WIFI_ASSOCREQ = (0 | WIFI_MGT_TYPE), -+ WIFI_ASSOCRSP = (BIT(4) | WIFI_MGT_TYPE), -+ WIFI_REASSOCREQ = (BIT(5) | WIFI_MGT_TYPE), -+ WIFI_REASSOCRSP = (BIT(5) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_PROBEREQ = (BIT(6) | WIFI_MGT_TYPE), -+ WIFI_PROBERSP = (BIT(6) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_BEACON = (BIT(7) | WIFI_MGT_TYPE), -+ WIFI_ATIM = (BIT(7) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_DISASSOC = (BIT(7) | BIT(5) | WIFI_MGT_TYPE), -+ WIFI_AUTH = (BIT(7) | BIT(5) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_DEAUTH = (BIT(7) | BIT(6) | WIFI_MGT_TYPE), -+ WIFI_ACTION = (BIT(7) | BIT(6) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_ACTION_NOACK = (BIT(7) | BIT(6) | BIT(5) | WIFI_MGT_TYPE), -+ -+ /* below is for control frame */ -+ WIFI_NDPA = (BIT(6) | BIT(4) | WIFI_CTRL_TYPE), -+ WIFI_PSPOLL = (BIT(7) | BIT(5) | WIFI_CTRL_TYPE), -+ WIFI_RTS = (BIT(7) | BIT(5) | BIT(4) | WIFI_CTRL_TYPE), -+ WIFI_CTS = (BIT(7) | BIT(6) | WIFI_CTRL_TYPE), -+ WIFI_ACK = (BIT(7) | BIT(6) | BIT(4) | WIFI_CTRL_TYPE), -+ WIFI_CFEND = (BIT(7) | BIT(6) | BIT(5) | WIFI_CTRL_TYPE), -+ WIFI_CFEND_CFACK = (BIT(7) | BIT(6) | BIT(5) | BIT(4) | WIFI_CTRL_TYPE), -+ -+ /* below is for data frame */ -+ WIFI_DATA = (0 | WIFI_DATA_TYPE), -+ WIFI_DATA_CFACK = (BIT(4) | WIFI_DATA_TYPE), -+ WIFI_DATA_CFPOLL = (BIT(5) | WIFI_DATA_TYPE), -+ WIFI_DATA_CFACKPOLL = (BIT(5) | BIT(4) | WIFI_DATA_TYPE), -+ WIFI_DATA_NULL = (BIT(6) | WIFI_DATA_TYPE), -+ WIFI_CF_ACK = (BIT(6) | BIT(4) | WIFI_DATA_TYPE), -+ WIFI_CF_POLL = (BIT(6) | BIT(5) | WIFI_DATA_TYPE), -+ WIFI_CF_ACKPOLL = (BIT(6) | BIT(5) | BIT(4) | WIFI_DATA_TYPE), -+ WIFI_QOS_DATA_NULL = (BIT(6) | WIFI_QOS_DATA_TYPE), -+}; -+ -+enum WIFI_REASON_CODE { -+ _RSON_RESERVED_ = 0, -+ _RSON_UNSPECIFIED_ = 1, -+ _RSON_AUTH_NO_LONGER_VALID_ = 2, -+ _RSON_DEAUTH_STA_LEAVING_ = 3, -+ _RSON_INACTIVITY_ = 4, -+ _RSON_UNABLE_HANDLE_ = 5, -+ _RSON_CLS2_ = 6, -+ _RSON_CLS3_ = 7, -+ _RSON_DISAOC_STA_LEAVING_ = 8, -+ _RSON_ASOC_NOT_AUTH_ = 9, -+ -+ /* WPA reason */ -+ _RSON_INVALID_IE_ = 13, -+ _RSON_MIC_FAILURE_ = 14, -+ _RSON_4WAY_HNDSHK_TIMEOUT_ = 15, -+ _RSON_GROUP_KEY_UPDATE_TIMEOUT_ = 16, -+ _RSON_DIFF_IE_ = 17, -+ _RSON_MLTCST_CIPHER_NOT_VALID_ = 18, -+ _RSON_UNICST_CIPHER_NOT_VALID_ = 19, -+ _RSON_AKMP_NOT_VALID_ = 20, -+ _RSON_UNSUPPORT_RSNE_VER_ = 21, -+ _RSON_INVALID_RSNE_CAP_ = 22, -+ _RSON_IEEE_802DOT1X_AUTH_FAIL_ = 23, -+ -+ /* belowing are Realtek definition */ -+ _RSON_PMK_NOT_AVAILABLE_ = 24, -+ _RSON_TDLS_TEAR_TOOFAR_ = 25, -+ _RSON_TDLS_TEAR_UN_RSN_ = 26, -+}; -+ -+/* Reason codes (IEEE 802.11-2007, 7.3.1.7, Table 7-22) */ -+/* IEEE 802.11h */ -+#define WLAN_REASON_PWR_CAPABILITY_NOT_VALID 10 -+#define WLAN_REASON_SUPPORTED_CHANNEL_NOT_VALID 11 -+ -+enum WIFI_STATUS_CODE { -+ _STATS_SUCCESSFUL_ = 0, -+ _STATS_FAILURE_ = 1, -+ _STATS_CAP_FAIL_ = 10, -+ _STATS_NO_ASOC_ = 11, -+ _STATS_OTHER_ = 12, -+ _STATS_NO_SUPP_ALG_ = 13, -+ _STATS_OUT_OF_AUTH_SEQ_ = 14, -+ _STATS_CHALLENGE_FAIL_ = 15, -+ _STATS_AUTH_TIMEOUT_ = 16, -+ _STATS_UNABLE_HANDLE_STA_ = 17, -+ _STATS_RATE_FAIL_ = 18, -+}; -+ -+/* Status codes (IEEE 802.11-2007, 7.3.1.9, Table 7-23) */ -+/* entended */ -+/* IEEE 802.11b */ -+#define WLAN_STATUS_ASSOC_DENIED_NOSHORT 19 -+#define WLAN_STATUS_ASSOC_DENIED_NOPBCC 20 -+#define WLAN_STATUS_ASSOC_DENIED_NOAGILITY 21 -+/* IEEE 802.11h */ -+#define WLAN_STATUS_SPEC_MGMT_REQUIRED 22 -+#define WLAN_STATUS_PWR_CAPABILITY_NOT_VALID 23 -+#define WLAN_STATUS_SUPPORTED_CHANNEL_NOT_VALID 24 -+/* IEEE 802.11g */ -+#define WLAN_STATUS_ASSOC_DENIED_NO_SHORT_SLOT_TIME 25 -+#define WLAN_STATUS_ASSOC_DENIED_NO_ER_PBCC 26 -+#define WLAN_STATUS_ASSOC_DENIED_NO_DSSS_OFDM 27 -+/* IEEE 802.11w */ -+#define WLAN_STATUS_ASSOC_REJECTED_TEMPORARILY 30 -+#define WLAN_STATUS_ROBUST_MGMT_FRAME_POLICY_VIOLATION 31 -+/* IEEE 802.11i */ -+#define WLAN_STATUS_INVALID_IE 40 -+#define WLAN_STATUS_GROUP_CIPHER_NOT_VALID 41 -+#define WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID 42 -+#define WLAN_STATUS_AKMP_NOT_VALID 43 -+#define WLAN_STATUS_UNSUPPORTED_RSN_IE_VERSION 44 -+#define WLAN_STATUS_INVALID_RSN_IE_CAPAB 45 -+#define WLAN_STATUS_CIPHER_REJECTED_PER_POLICY 46 -+#define WLAN_STATUS_TS_NOT_CREATED 47 -+#define WLAN_STATUS_DIRECT_LINK_NOT_ALLOWED 48 -+#define WLAN_STATUS_DEST_STA_NOT_PRESENT 49 -+#define WLAN_STATUS_DEST_STA_NOT_QOS_STA 50 -+#define WLAN_STATUS_ASSOC_DENIED_LISTEN_INT_TOO_LARGE 51 -+/* IEEE 802.11r */ -+#define WLAN_STATUS_INVALID_FT_ACTION_FRAME_COUNT 52 -+#define WLAN_STATUS_INVALID_PMKID 53 -+#define WLAN_STATUS_INVALID_MDIE 54 -+#define WLAN_STATUS_INVALID_FTIE 55 -+ -+ -+enum WIFI_REG_DOMAIN { -+ DOMAIN_FCC = 1, -+ DOMAIN_IC = 2, -+ DOMAIN_ETSI = 3, -+ DOMAIN_SPAIN = 4, -+ DOMAIN_FRANCE = 5, -+ DOMAIN_MKK = 6, -+ DOMAIN_ISRAEL = 7, -+ DOMAIN_MKK1 = 8, -+ DOMAIN_MKK2 = 9, -+ DOMAIN_MKK3 = 10, -+ DOMAIN_MAX -+}; -+ -+#define _TO_DS_ BIT(8) -+#define _FROM_DS_ BIT(9) -+#define _MORE_FRAG_ BIT(10) -+#define _RETRY_ BIT(11) -+#define _PWRMGT_ BIT(12) -+#define _MORE_DATA_ BIT(13) -+#define _PRIVACY_ BIT(14) -+#define _ORDER_ BIT(15) -+ -+#define SetToDs(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_TO_DS_) -+ -+#define GetToDs(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_TO_DS_)) != 0) -+ -+#define ClearToDs(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_TO_DS_)) -+ -+#define SetFrDs(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_FROM_DS_) -+ -+#define GetFrDs(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_FROM_DS_)) != 0) -+ -+#define ClearFrDs(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_FROM_DS_)) -+ -+#define get_tofr_ds(pframe) ((GetToDs(pframe) << 1) | GetFrDs(pframe)) -+ -+#define SetMFrag(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_MORE_FRAG_) -+ -+#define GetMFrag(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_MORE_FRAG_)) != 0) -+ -+#define ClearMFrag(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_MORE_FRAG_)) -+ -+#define SetRetry(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_RETRY_) -+ -+#define GetRetry(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_RETRY_)) != 0) -+ -+#define ClearRetry(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_RETRY_)) -+ -+#define SetPwrMgt(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_PWRMGT_) -+ -+#define GetPwrMgt(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_PWRMGT_)) != 0) -+ -+#define ClearPwrMgt(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_PWRMGT_)) -+ -+#define SetMData(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_MORE_DATA_) -+ -+#define GetMData(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_MORE_DATA_)) != 0) -+ -+#define ClearMData(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_MORE_DATA_)) -+ -+#define SetPrivacy(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_PRIVACY_) -+ -+#define GetPrivacy(pbuf) \ -+ (((*(__le16 *)(pbuf)) & cpu_to_le16(_PRIVACY_)) != 0) -+ -+#define ClearPrivacy(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_PRIVACY_)) -+ -+ -+#define GetOrder(pbuf) \ -+ (((*(__le16 *)(pbuf)) & cpu_to_le16(_ORDER_)) != 0) -+ -+#define GetFrameType(pbuf) \ -+ (le16_to_cpu(*(__le16 *)(pbuf)) & (BIT(3) | BIT(2))) -+ -+#define SetFrameType(pbuf, type) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= __constant_cpu_to_le16(~(BIT(3) | BIT(2))); \ -+ *(unsigned short *)(pbuf) |= __constant_cpu_to_le16(type); \ -+ } while (0) -+ -+#define GetFrameSubType(pbuf) (le16_to_cpu(*(__le16 *)(pbuf)) & (BIT(7) |\ -+ BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2))) -+ -+#define SetFrameSubType(pbuf, type) \ -+ do { \ -+ *(__le16 *)(pbuf) &= cpu_to_le16(~(BIT(7) | BIT(6) | \ -+ BIT(5) | BIT(4) | BIT(3) | BIT(2))); \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(type); \ -+ } while (0) -+ -+#define GetSequence(pbuf) \ -+ (le16_to_cpu(*(__le16 *)((size_t)(pbuf) + 22)) >> 4) -+ -+#define GetFragNum(pbuf) \ -+ (le16_to_cpu(*(__le16 *)((size_t)(pbuf) + 22)) & 0x0f) -+ -+#define GetTupleCache(pbuf) \ -+ (cpu_to_le16(*(unsigned short *)((size_t)(pbuf) + 22))) -+ -+#define SetFragNum(pbuf, num) \ -+ do { \ -+ *(unsigned short *)((size_t)(pbuf) + 22) = \ -+ ((*(unsigned short *)((size_t)(pbuf) + 22)) & \ -+ le16_to_cpu(~(0x000f))) | \ -+ cpu_to_le16(0x0f & (num)); \ -+ } while (0) -+ -+#define SetSeqNum(pbuf, num) \ -+ do { \ -+ *(__le16 *)((size_t)(pbuf) + 22) = \ -+ ((*(__le16 *)((size_t)(pbuf) + 22)) & cpu_to_le16((unsigned short)0x000f)) | \ -+ cpu_to_le16((unsigned short)(0xfff0 & (num << 4))); \ -+ } while (0) -+ -+#define SetDuration(pbuf, dur) \ -+ *(__le16 *)((size_t)(pbuf) + 2) = cpu_to_le16(0xffff & (dur)) -+ -+ -+#define SetPriority(pbuf, tid) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(tid & 0xf) -+ -+#define GetPriority(pbuf) ((le16_to_cpu(*(__le16 *)(pbuf))) & 0xf) -+ -+#define SetEOSP(pbuf, eosp) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16((eosp & 1) << 4) -+ -+#define SetAckpolicy(pbuf, ack) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16((ack & 3) << 5) -+ -+#define GetAckpolicy(pbuf) (((le16_to_cpu(*(__le16 *)pbuf)) >> 5) & 0x3) -+ -+#define GetAMsdu(pbuf) (((le16_to_cpu(*(__le16 *)pbuf)) >> 7) & 0x1) -+ -+#define SetAMsdu(pbuf, amsdu) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16((amsdu & 1) << 7) -+ -+#define GetAid(pbuf) (le16_to_cpu(*(__le16 *)((size_t)(pbuf) + 2)) & 0x3fff) -+ -+#define GetTid(pbuf) (le16_to_cpu(*(__le16 *)((size_t)(pbuf) + \ -+ (((GetToDs(pbuf)<<1) | GetFrDs(pbuf)) == 3 ? \ -+ 30 : 24))) & 0x000f) -+ -+#define GetAddr1Ptr(pbuf) ((unsigned char *)((size_t)(pbuf) + 4)) -+ -+#define GetAddr2Ptr(pbuf) ((unsigned char *)((size_t)(pbuf) + 10)) -+ -+#define GetAddr3Ptr(pbuf) ((unsigned char *)((size_t)(pbuf) + 16)) -+ -+#define GetAddr4Ptr(pbuf) ((unsigned char *)((size_t)(pbuf) + 24)) -+ -+#define MacAddr_isBcst(addr) \ -+ (\ -+ ((addr[0] == 0xff) && (addr[1] == 0xff) && \ -+ (addr[2] == 0xff) && (addr[3] == 0xff) && \ -+ (addr[4] == 0xff) && (addr[5] == 0xff)) ? true : false \ -+) -+ -+__inline static int IS_MCAST(unsigned char *da) -+{ -+ if ((*da) & 0x01) -+ return true; -+ else -+ return false; -+} -+ -+__inline static unsigned char * get_ra(unsigned char *pframe) -+{ -+ unsigned char *ra; -+ ra = GetAddr1Ptr(pframe); -+ return ra; -+} -+__inline static unsigned char * get_ta(unsigned char *pframe) -+{ -+ unsigned char *ta; -+ ta = GetAddr2Ptr(pframe); -+ return ta; -+} -+ -+__inline static unsigned char * get_da(unsigned char *pframe) -+{ -+ unsigned char *da; -+ unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); -+ -+ switch (to_fr_ds) { -+ case 0x00: /* ToDs = 0, FromDs = 0 */ -+ da = GetAddr1Ptr(pframe); -+ break; -+ case 0x01: /* ToDs = 0, FromDs = 1 */ -+ da = GetAddr1Ptr(pframe); -+ break; -+ case 0x02: /* ToDs = 1, FromDs = 0 */ -+ da = GetAddr3Ptr(pframe); -+ break; -+ default: /* ToDs = 1, FromDs = 1 */ -+ da = GetAddr3Ptr(pframe); -+ break; -+ } -+ -+ return da; -+} -+ -+ -+__inline static unsigned char * get_sa(unsigned char *pframe) -+{ -+ unsigned char *sa; -+ unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); -+ -+ switch (to_fr_ds) { -+ case 0x00: /* ToDs = 0, FromDs = 0 */ -+ sa = GetAddr2Ptr(pframe); -+ break; -+ case 0x01: /* ToDs = 0, FromDs = 1 */ -+ sa = GetAddr3Ptr(pframe); -+ break; -+ case 0x02: /* ToDs = 1, FromDs = 0 */ -+ sa = GetAddr2Ptr(pframe); -+ break; -+ default: /* ToDs = 1, FromDs = 1 */ -+ sa = GetAddr4Ptr(pframe); -+ break; -+ } -+ -+ return sa; -+} -+ -+__inline static unsigned char * get_hdr_bssid(unsigned char *pframe) -+{ -+ unsigned char *sa = NULL; -+ unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); -+ -+ switch (to_fr_ds) { -+ case 0x00: /* ToDs = 0, FromDs = 0 */ -+ sa = GetAddr3Ptr(pframe); -+ break; -+ case 0x01: /* ToDs = 0, FromDs = 1 */ -+ sa = GetAddr2Ptr(pframe); -+ break; -+ case 0x02: /* ToDs = 1, FromDs = 0 */ -+ sa = GetAddr1Ptr(pframe); -+ break; -+ case 0x03: /* ToDs = 1, FromDs = 1 */ -+ sa = GetAddr1Ptr(pframe); -+ break; -+ } -+ -+ return sa; -+} -+ -+ -+__inline static int IsFrameTypeCtrl(unsigned char *pframe) -+{ -+ if (WIFI_CTRL_TYPE == GetFrameType(pframe)) -+ return true; -+ else -+ return false; -+} -+/*----------------------------------------------------------------------------- -+ Below is for the security related definition -+------------------------------------------------------------------------------*/ -+#define _RESERVED_FRAME_TYPE_ 0 -+#define _SKB_FRAME_TYPE_ 2 -+#define _PRE_ALLOCMEM_ 1 -+#define _PRE_ALLOCHDR_ 3 -+#define _PRE_ALLOCLLCHDR_ 4 -+#define _PRE_ALLOCICVHDR_ 5 -+#define _PRE_ALLOCMICHDR_ 6 -+ -+#define _SIFSTIME_ ((priv->pmib->dot11BssType.net_work_type&WIRELESS_11A)?16:10) -+#define _ACKCTSLNG_ 14 /* 14 bytes long, including crclng */ -+#define _CRCLNG_ 4 -+ -+#define _ASOCREQ_IE_OFFSET_ 4 /* excluding wlan_hdr */ -+#define _ASOCRSP_IE_OFFSET_ 6 -+#define _REASOCREQ_IE_OFFSET_ 10 -+#define _REASOCRSP_IE_OFFSET_ 6 -+#define _PROBEREQ_IE_OFFSET_ 0 -+#define _PROBERSP_IE_OFFSET_ 12 -+#define _AUTH_IE_OFFSET_ 6 -+#define _DEAUTH_IE_OFFSET_ 0 -+#define _BEACON_IE_OFFSET_ 12 -+#define _PUBLIC_ACTION_IE_OFFSET_ 8 -+ -+#define _FIXED_IE_LENGTH_ _BEACON_IE_OFFSET_ -+ -+#define _SSID_IE_ 0 -+#define _SUPPORTEDRATES_IE_ 1 -+#define _DSSET_IE_ 3 -+#define _TIM_IE_ 5 -+#define _IBSS_PARA_IE_ 6 -+#define _COUNTRY_IE_ 7 -+#define _CHLGETXT_IE_ 16 -+#define _SUPPORTED_CH_IE_ 36 -+#define _CH_SWTICH_ANNOUNCE_ 37 /* Secondary Channel Offset */ -+#define _RSN_IE_2_ 48 -+#define _SSN_IE_1_ 221 -+#define _ERPINFO_IE_ 42 -+#define _EXT_SUPPORTEDRATES_IE_ 50 -+ -+#define _HT_CAPABILITY_IE_ 45 -+#define _FTIE_ 55 -+#define _TIMEOUT_ITVL_IE_ 56 -+#define _SRC_IE_ 59 -+#define _HT_EXTRA_INFO_IE_ 61 -+#define _HT_ADD_INFO_IE_ 61 /* _HT_EXTRA_INFO_IE_ */ -+#define _WAPI_IE_ 68 -+ -+#define _RIC_Descriptor_IE_ 75 -+#define _MME_IE_ 76 /* 802.11w Management MIC element */ -+#define _LINK_ID_IE_ 101 -+#define _CH_SWITCH_TIMING_ 104 -+#define _PTI_BUFFER_STATUS_ 106 -+#define _EXT_CAP_IE_ 127 -+#define _VENDOR_SPECIFIC_IE_ 221 -+ -+#define _RESERVED47_ 47 -+ -+enum ELEMENT_ID { -+ EID_SsId = 0, /* service set identifier (0:32) */ -+ EID_SupRates = 1, /* supported rates (1:8) */ -+ EID_FHParms = 2, /* FH parameter set (5) */ -+ EID_DSParms = 3, /* DS parameter set (1) */ -+ EID_CFParms = 4, /* CF parameter set (6) */ -+ EID_Tim = 5, /* Traffic Information Map (4:254) */ -+ EID_IbssParms = 6, /* IBSS parameter set (2) */ -+ EID_Country = 7, /* */ -+ -+ /* Form 7.3.2: Information elements in 802.11E/D13.0, page 46. */ -+ EID_QBSSLoad = 11, -+ EID_EDCAParms = 12, -+ EID_TSpec = 13, -+ EID_TClass = 14, -+ EID_Schedule = 15, -+ /* */ -+ -+ EID_Ctext = 16, /* challenge text*/ -+ EID_POWER_CONSTRAINT = 32, /* Power Constraint*/ -+ -+ /* vivi for WIFITest, 802.11h AP, 20100427 */ -+ /* 2010/12/26 MH The definition we can declare always!! */ -+ EID_PowerCap = 33, -+ EID_SupportedChannels = 36, -+ EID_ChlSwitchAnnounce = 37, -+ -+ EID_MeasureRequest = 38, /* Measurement Request */ -+ EID_MeasureReport = 39, /* Measurement Report */ -+ -+ EID_ERPInfo = 42, -+ -+ /* Form 7.3.2: Information elements in 802.11E/D13.0, page 46. */ -+ EID_TSDelay = 43, -+ EID_TCLASProc = 44, -+ EID_HTCapability = 45, -+ EID_QoSCap = 46, -+ /* */ -+ -+ EID_WPA2 = 48, -+ EID_ExtSupRates = 50, -+ -+ EID_FTIE = 55, /* Defined in 802.11r */ -+ EID_Timeout = 56, /* Defined in 802.11r */ -+ -+ EID_SupRegulatory = 59, /* Supported Requlatory Classes 802.11y */ -+ EID_HTInfo = 61, -+ EID_SecondaryChnlOffset = 62, -+ -+ EID_BSSCoexistence = 72, /* 20/40 BSS Coexistence */ -+ EID_BSSIntolerantChlReport = 73, -+ EID_OBSS = 74, /* Overlapping BSS Scan Parameters */ -+ -+ EID_LinkIdentifier = 101, /* Defined in 802.11z */ -+ EID_WakeupSchedule = 102, /* Defined in 802.11z */ -+ EID_ChnlSwitchTimeing = 104, /* Defined in 802.11z */ -+ EID_PTIControl = 105, /* Defined in 802.11z */ -+ EID_PUBufferStatus = 106, /* Defined in 802.11z */ -+ -+ EID_EXTCapability = 127, /* Extended Capabilities */ -+ /* From S19:Aironet IE and S21:AP IP address IE in CCX v1.13, p16 and p18. */ -+ EID_Aironet = 133, /* 0x85: Aironet Element for Cisco CCX */ -+ EID_CiscoIP = 149, /* 0x95: IP Address IE for Cisco CCX */ -+ -+ EID_CellPwr = 150, /* 0x96: Cell Power Limit IE. Ref. 0x96. */ -+ -+ EID_CCKM = 156, -+ -+ EID_Vendor = 221, /* 0xDD: Vendor Specific */ -+ -+ EID_WAPI = 68, -+ EID_VHTCapability = 191, /* Based on 802.11ac D2.0 */ -+ EID_VHTOperation = 192, /* Based on 802.11ac D2.0 */ -+ EID_OpModeNotification = 199, /* Based on 802.11ac D3.0 */ -+}; -+ -+/* --------------------------------------------------------------------------- -+ Below is the fixed elements... -+-----------------------------------------------------------------------------*/ -+#define _AUTH_ALGM_NUM_ 2 -+#define _AUTH_SEQ_NUM_ 2 -+#define _BEACON_ITERVAL_ 2 -+#define _CAPABILITY_ 2 -+#define _CURRENT_APADDR_ 6 -+#define _LISTEN_INTERVAL_ 2 -+#define _RSON_CODE_ 2 -+#define _ASOC_ID_ 2 -+#define _STATUS_CODE_ 2 -+#define _TIMESTAMP_ 8 -+ -+#define AUTH_ODD_TO 0 -+#define AUTH_EVEN_TO 1 -+ -+#define WLAN_ETHCONV_ENCAP 1 -+#define WLAN_ETHCONV_RFC1042 2 -+#define WLAN_ETHCONV_8021h 3 -+ -+#define cap_ESS BIT(0) -+#define cap_IBSS BIT(1) -+#define cap_CFPollable BIT(2) -+#define cap_CFRequest BIT(3) -+#define cap_Privacy BIT(4) -+#define cap_ShortPremble BIT(5) -+#define cap_PBCC BIT(6) -+#define cap_ChAgility BIT(7) -+#define cap_SpecMgmt BIT(8) -+#define cap_QoS BIT(9) -+#define cap_ShortSlot BIT(10) -+ -+/*----------------------------------------------------------------------------- -+ Below is the definition for 802.11i / 802.1x -+------------------------------------------------------------------------------*/ -+#define _IEEE8021X_MGT_ 1 /* WPA */ -+#define _IEEE8021X_PSK_ 2 /* WPA with pre-shared key */ -+ -+#define _MME_IE_LENGTH_ 18 -+/*----------------------------------------------------------------------------- -+ Below is the definition for WMM -+------------------------------------------------------------------------------*/ -+#define _WMM_IE_Length_ 7 /* for WMM STA */ -+#define _WMM_Para_Element_Length_ 24 -+ -+ -+/*----------------------------------------------------------------------------- -+ Below is the definition for 802.11n -+------------------------------------------------------------------------------*/ -+ -+#define SetOrderBit(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_ORDER_); \ -+ } while (0) -+ -+#define GetOrderBit(pbuf) (((*(unsigned short *)(pbuf)) & cpu_to_le16(_ORDER_)) != 0) -+ -+#define ACT_CAT_VENDOR 0x7F/* 127 */ -+ -+/** -+ * struct rtw_ieee80211_bar - HT Block Ack Request -+ * -+ * This structure refers to "HT BlockAckReq" as -+ * described in 802.11n draft section 7.2.1.7.1 -+ */ -+struct rtw_ieee80211_bar { -+ __le16 frame_control; -+ __le16 duration; -+ unsigned char ra[6]; -+ unsigned char ta[6]; -+ __le16 control; -+ __le16 start_seq_num; -+} __attribute__((packed)); -+ -+/* 802.11 BAR control masks */ -+#define IEEE80211_BAR_CTRL_ACK_POLICY_NORMAL 0x0000 -+#define IEEE80211_BAR_CTRL_CBMTID_COMPRESSED_BA 0x0004 -+ -+ -+ /** -+ * struct rtw_ieee80211_ht_cap - HT capabilities -+ * -+ * This structure refers to "HT capabilities element" as -+ * described in 802.11n draft section 7.3.2.52 -+ */ -+ -+struct rtw_ieee80211_ht_cap { -+ __le16 cap_info; -+ unsigned char ampdu_params_info; -+ unsigned char supp_mcs_set[16]; -+ __le16 extended_ht_cap_info; -+ __le16 tx_BF_cap_info; -+ unsigned char antenna_selection_info; -+} __attribute__ ((packed)); -+ -+/** -+ * struct rtw_ieee80211_ht_cap - HT additional information -+ * -+ * This structure refers to "HT information element" as -+ * described in 802.11n draft section 7.3.2.53 -+ */ -+struct ieee80211_ht_addt_info { -+ unsigned char control_chan; -+ unsigned char ht_param; -+ __le16 operation_mode; -+ __le16 stbc_param; -+ unsigned char basic_set[16]; -+} __attribute__ ((packed)); -+ -+ -+struct HT_caps_element -+{ -+ union -+ { -+ struct -+ { -+ __le16 HT_caps_info; -+ unsigned char AMPDU_para; -+ unsigned char MCS_rate[16]; -+ __le16 HT_ext_caps; -+ __le16 Beamforming_caps; -+ unsigned char ASEL_caps; -+ } HT_cap_element; -+ unsigned char HT_cap[26]; -+ }u; -+} __attribute__ ((packed)); -+ -+struct HT_info_element -+{ -+ unsigned char primary_channel; -+ unsigned char infos[5]; -+ unsigned char MCS_rate[16]; -+} __attribute__ ((packed)); -+ -+struct AC_param -+{ -+ unsigned char ACI_AIFSN; -+ unsigned char CW; -+ __le16 TXOP_limit; -+} __attribute__ ((packed)); -+ -+struct WMM_para_element -+{ -+ unsigned char QoS_info; -+ unsigned char reserved; -+ struct AC_param ac_param[4]; -+} __attribute__ ((packed)); -+ -+struct ADDBA_request -+{ -+ unsigned char dialog_token; -+ __le16 BA_para_set; -+ __le16 BA_timeout_value; -+ __le16 BA_starting_seqctrl; -+} __attribute__ ((packed)); -+ -+enum HT_CAP_AMPDU_FACTOR { -+ MAX_AMPDU_FACTOR_8K = 0, -+ MAX_AMPDU_FACTOR_16K = 1, -+ MAX_AMPDU_FACTOR_32K = 2, -+ MAX_AMPDU_FACTOR_64K = 3, -+}; -+ -+/* 802.11n HT capabilities masks */ -+#define IEEE80211_HT_CAP_LDPC_CODING 0x0001 -+#define IEEE80211_HT_CAP_SUP_WIDTH 0x0002 -+#define IEEE80211_HT_CAP_SM_PS 0x000C -+#define IEEE80211_HT_CAP_GRN_FLD 0x0010 -+#define IEEE80211_HT_CAP_SGI_20 0x0020 -+#define IEEE80211_HT_CAP_SGI_40 0x0040 -+#define IEEE80211_HT_CAP_TX_STBC 0x0080 -+#define IEEE80211_HT_CAP_RX_STBC_1R 0x0100 -+#define IEEE80211_HT_CAP_RX_STBC_2R 0x0200 -+#define IEEE80211_HT_CAP_RX_STBC_3R 0x0300 -+#define IEEE80211_HT_CAP_DELAY_BA 0x0400 -+#define IEEE80211_HT_CAP_MAX_AMSDU 0x0800 -+#define IEEE80211_HT_CAP_DSSSCCK40 0x1000 -+/* 802.11n HT capability AMPDU settings */ -+#define IEEE80211_HT_CAP_AMPDU_FACTOR 0x03 -+#define IEEE80211_HT_CAP_AMPDU_DENSITY 0x1C -+/* 802.11n HT capability MSC set */ -+#define IEEE80211_SUPP_MCS_SET_UEQM 4 -+#define IEEE80211_HT_CAP_MAX_STREAMS 4 -+#define IEEE80211_SUPP_MCS_SET_LEN 10 -+/* maximum streams the spec allows */ -+#define IEEE80211_HT_CAP_MCS_TX_DEFINED 0x01 -+#define IEEE80211_HT_CAP_MCS_TX_RX_DIFF 0x02 -+#define IEEE80211_HT_CAP_MCS_TX_STREAMS 0x0C -+#define IEEE80211_HT_CAP_MCS_TX_UEQM 0x10 -+/* 802.11n HT capability TXBF capability */ -+#define IEEE80211_HT_CAP_TXBF_RX_NDP 0x00000008 -+#define IEEE80211_HT_CAP_TXBF_TX_NDP 0x00000010 -+#define IEEE80211_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP 0x00000400 -+ -+/* 802.11n HT IE masks */ -+#define IEEE80211_HT_IE_CHA_SEC_OFFSET 0x03 -+#define IEEE80211_HT_IE_CHA_SEC_NONE 0x00 -+#define IEEE80211_HT_IE_CHA_SEC_ABOVE 0x01 -+#define IEEE80211_HT_IE_CHA_SEC_BELOW 0x03 -+#define IEEE80211_HT_IE_CHA_WIDTH 0x04 -+#define IEEE80211_HT_IE_HT_PROTECTION 0x0003 -+#define IEEE80211_HT_IE_NON_GF_STA_PRSNT 0x0004 -+#define IEEE80211_HT_IE_NON_HT_STA_PRSNT 0x0010 -+ -+/* block-ack parameters */ -+#define IEEE80211_ADDBA_PARAM_POLICY_MASK 0x0002 -+#define IEEE80211_ADDBA_PARAM_TID_MASK 0x003C -+#define RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK 0xFFC0 -+#define IEEE80211_DELBA_PARAM_TID_MASK 0xF000 -+#define IEEE80211_DELBA_PARAM_INITIATOR_MASK 0x0800 -+ -+/* -+ * A-PMDU buffer sizes -+ * According to IEEE802.11n spec size varies from 8K to 64K (in powers of 2) -+ */ -+#define IEEE80211_MIN_AMPDU_BUF 0x8 -+#define IEEE80211_MAX_AMPDU_BUF 0x40 -+ -+ -+/* Spatial Multiplexing Power Save Modes */ -+#define WLAN_HT_CAP_SM_PS_STATIC 0 -+#define WLAN_HT_CAP_SM_PS_DYNAMIC 1 -+#define WLAN_HT_CAP_SM_PS_INVALID 2 -+#define WLAN_HT_CAP_SM_PS_DISABLED 3 -+ -+ -+#define OP_MODE_PURE 0 -+#define OP_MODE_MAY_BE_LEGACY_STAS 1 -+#define OP_MODE_20MHZ_HT_STA_ASSOCED 2 -+#define OP_MODE_MIXED 3 -+ -+#define HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK ((u8) BIT(0) | BIT(1)) -+#define HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE ((u8) BIT(0)) -+#define HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW ((u8) BIT(0) | BIT(1)) -+#define HT_INFO_HT_PARAM_REC_TRANS_CHNL_WIDTH ((u8) BIT(2)) -+#define HT_INFO_HT_PARAM_RIFS_MODE ((u8) BIT(3)) -+#define HT_INFO_HT_PARAM_CTRL_ACCESS_ONLY ((u8) BIT(4)) -+#define HT_INFO_HT_PARAM_SRV_INTERVAL_GRANULARITY ((u8) BIT(5)) -+ -+#define HT_INFO_OPERATION_MODE_OP_MODE_MASK \ -+ ((u16) (0x0001 | 0x0002)) -+#define HT_INFO_OPERATION_MODE_OP_MODE_OFFSET 0 -+#define HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT ((u8) BIT(2)) -+#define HT_INFO_OPERATION_MODE_TRANSMIT_BURST_LIMIT ((u8) BIT(3)) -+#define HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT ((u8) BIT(4)) -+ -+#define HT_INFO_STBC_PARAM_DUAL_BEACON ((u16) BIT(6)) -+#define HT_INFO_STBC_PARAM_DUAL_STBC_PROTECT ((u16) BIT(7)) -+#define HT_INFO_STBC_PARAM_SECONDARY_BCN ((u16) BIT(8)) -+#define HT_INFO_STBC_PARAM_LSIG_TXOP_PROTECT_ALLOWED ((u16) BIT(9)) -+#define HT_INFO_STBC_PARAM_PCO_ACTIVE ((u16) BIT(10)) -+#define HT_INFO_STBC_PARAM_PCO_PHASE ((u16) BIT(11)) -+ -+ -+ -+/* endif */ -+ -+/* ===============WPS Section =============== */ -+/* For WPSv1.0 */ -+#define WPSOUI 0x0050f204 -+/* WPS attribute ID */ -+#define WPS_ATTR_VER1 0x104A -+#define WPS_ATTR_SIMPLE_CONF_STATE 0x1044 -+#define WPS_ATTR_RESP_TYPE 0x103B -+#define WPS_ATTR_UUID_E 0x1047 -+#define WPS_ATTR_MANUFACTURER 0x1021 -+#define WPS_ATTR_MODEL_NAME 0x1023 -+#define WPS_ATTR_MODEL_NUMBER 0x1024 -+#define WPS_ATTR_SERIAL_NUMBER 0x1042 -+#define WPS_ATTR_PRIMARY_DEV_TYPE 0x1054 -+#define WPS_ATTR_SEC_DEV_TYPE_LIST 0x1055 -+#define WPS_ATTR_DEVICE_NAME 0x1011 -+#define WPS_ATTR_CONF_METHOD 0x1008 -+#define WPS_ATTR_RF_BANDS 0x103C -+#define WPS_ATTR_DEVICE_PWID 0x1012 -+#define WPS_ATTR_REQUEST_TYPE 0x103A -+#define WPS_ATTR_ASSOCIATION_STATE 0x1002 -+#define WPS_ATTR_CONFIG_ERROR 0x1009 -+#define WPS_ATTR_VENDOR_EXT 0x1049 -+#define WPS_ATTR_SELECTED_REGISTRAR 0x1041 -+ -+/* Value of WPS attribute "WPS_ATTR_DEVICE_NAME */ -+#define WPS_MAX_DEVICE_NAME_LEN 32 -+ -+/* Value of WPS Request Type Attribute */ -+#define WPS_REQ_TYPE_ENROLLEE_INFO_ONLY 0x00 -+#define WPS_REQ_TYPE_ENROLLEE_OPEN_8021X 0x01 -+#define WPS_REQ_TYPE_REGISTRAR 0x02 -+#define WPS_REQ_TYPE_WLAN_MANAGER_REGISTRAR 0x03 -+ -+/* Value of WPS Response Type Attribute */ -+#define WPS_RESPONSE_TYPE_INFO_ONLY 0x00 -+#define WPS_RESPONSE_TYPE_8021X 0x01 -+#define WPS_RESPONSE_TYPE_REGISTRAR 0x02 -+#define WPS_RESPONSE_TYPE_AP 0x03 -+ -+/* Value of WPS WiFi Simple Configuration State Attribute */ -+#define WPS_WSC_STATE_NOT_CONFIG 0x01 -+#define WPS_WSC_STATE_CONFIG 0x02 -+ -+/* Value of WPS Version Attribute */ -+#define WPS_VERSION_1 0x10 -+ -+/* Value of WPS Configuration Method Attribute */ -+#define WPS_CONFIG_METHOD_FLASH 0x0001 -+#define WPS_CONFIG_METHOD_ETHERNET 0x0002 -+#define WPS_CONFIG_METHOD_LABEL 0x0004 -+#define WPS_CONFIG_METHOD_DISPLAY 0x0008 -+#define WPS_CONFIG_METHOD_E_NFC 0x0010 -+#define WPS_CONFIG_METHOD_I_NFC 0x0020 -+#define WPS_CONFIG_METHOD_NFC 0x0040 -+#define WPS_CONFIG_METHOD_PBC 0x0080 -+#define WPS_CONFIG_METHOD_KEYPAD 0x0100 -+#define WPS_CONFIG_METHOD_VPBC 0x0280 -+#define WPS_CONFIG_METHOD_PPBC 0x0480 -+#define WPS_CONFIG_METHOD_VDISPLAY 0x2008 -+#define WPS_CONFIG_METHOD_PDISPLAY 0x4008 -+ -+/* Value of Category ID of WPS Primary Device Type Attribute */ -+#define WPS_PDT_CID_DISPLAYS 0x0007 -+#define WPS_PDT_CID_MULIT_MEDIA 0x0008 -+#define WPS_PDT_CID_RTK_WIDI WPS_PDT_CID_MULIT_MEDIA -+ -+/* Value of Sub Category ID of WPS Primary Device Type Attribute */ -+#define WPS_PDT_SCID_MEDIA_SERVER 0x0005 -+#define WPS_PDT_SCID_RTK_DMP WPS_PDT_SCID_MEDIA_SERVER -+ -+/* Value of Device Password ID */ -+#define WPS_DPID_PIN 0x0000 -+#define WPS_DPID_USER_SPEC 0x0001 -+#define WPS_DPID_MACHINE_SPEC 0x0002 -+#define WPS_DPID_REKEY 0x0003 -+#define WPS_DPID_PBC 0x0004 -+#define WPS_DPID_REGISTRAR_SPEC 0x0005 -+ -+/* Value of WPS RF Bands Attribute */ -+#define WPS_RF_BANDS_2_4_GHZ 0x01 -+#define WPS_RF_BANDS_5_GHZ 0x02 -+ -+/* Value of WPS Association State Attribute */ -+#define WPS_ASSOC_STATE_NOT_ASSOCIATED 0x00 -+#define WPS_ASSOC_STATE_CONNECTION_SUCCESS 0x01 -+#define WPS_ASSOC_STATE_CONFIGURATION_FAILURE 0x02 -+#define WPS_ASSOC_STATE_ASSOCIATION_FAILURE 0x03 -+#define WPS_ASSOC_STATE_IP_FAILURE 0x04 -+ -+/* =====================P2P Section ===================== */ -+/* For P2P */ -+#define P2POUI 0x506F9A09 -+ -+/* P2P Attribute ID */ -+#define P2P_ATTR_STATUS 0x00 -+#define P2P_ATTR_MINOR_REASON_CODE 0x01 -+#define P2P_ATTR_CAPABILITY 0x02 -+#define P2P_ATTR_DEVICE_ID 0x03 -+#define P2P_ATTR_GO_INTENT 0x04 -+#define P2P_ATTR_CONF_TIMEOUT 0x05 -+#define P2P_ATTR_LISTEN_CH 0x06 -+#define P2P_ATTR_GROUP_BSSID 0x07 -+#define P2P_ATTR_EX_LISTEN_TIMING 0x08 -+#define P2P_ATTR_INTENTED_IF_ADDR 0x09 -+#define P2P_ATTR_MANAGEABILITY 0x0A -+#define P2P_ATTR_CH_LIST 0x0B -+#define P2P_ATTR_NOA 0x0C -+#define P2P_ATTR_DEVICE_INFO 0x0D -+#define P2P_ATTR_GROUP_INFO 0x0E -+#define P2P_ATTR_GROUP_ID 0x0F -+#define P2P_ATTR_INTERFACE 0x10 -+#define P2P_ATTR_OPERATING_CH 0x11 -+#define P2P_ATTR_INVITATION_FLAGS 0x12 -+ -+/* Value of Status Attribute */ -+#define P2P_STATUS_SUCCESS 0x00 -+#define P2P_STATUS_FAIL_INFO_UNAVAILABLE 0x01 -+#define P2P_STATUS_FAIL_INCOMPATIBLE_PARAM 0x02 -+#define P2P_STATUS_FAIL_LIMIT_REACHED 0x03 -+#define P2P_STATUS_FAIL_INVALID_PARAM 0x04 -+#define P2P_STATUS_FAIL_REQUEST_UNABLE 0x05 -+#define P2P_STATUS_FAIL_PREVOUS_PROTO_ERR 0x06 -+#define P2P_STATUS_FAIL_NO_COMMON_CH 0x07 -+#define P2P_STATUS_FAIL_UNKNOWN_P2PGROUP 0x08 -+#define P2P_STATUS_FAIL_BOTH_GOINTENT_15 0x09 -+#define P2P_STATUS_FAIL_INCOMPATIBLE_PROVSION 0x0A -+#define P2P_STATUS_FAIL_USER_REJECT 0x0B -+ -+/* Value of Inviation Flags Attribute */ -+#define P2P_INVITATION_FLAGS_PERSISTENT BIT(0) -+ -+#define DMP_P2P_DEVCAP_SUPPORT (P2P_DEVCAP_SERVICE_DISCOVERY | \ -+ P2P_DEVCAP_CLIENT_DISCOVERABILITY | \ -+ P2P_DEVCAP_CONCURRENT_OPERATION | \ -+ P2P_DEVCAP_INVITATION_PROC) -+ -+#define DMP_P2P_GRPCAP_SUPPORT (P2P_GRPCAP_INTRABSS) -+ -+/* Value of Device Capability Bitmap */ -+#define P2P_DEVCAP_SERVICE_DISCOVERY BIT(0) -+#define P2P_DEVCAP_CLIENT_DISCOVERABILITY BIT(1) -+#define P2P_DEVCAP_CONCURRENT_OPERATION BIT(2) -+#define P2P_DEVCAP_INFRA_MANAGED BIT(3) -+#define P2P_DEVCAP_DEVICE_LIMIT BIT(4) -+#define P2P_DEVCAP_INVITATION_PROC BIT(5) -+ -+/* Value of Group Capability Bitmap */ -+#define P2P_GRPCAP_GO BIT(0) -+#define P2P_GRPCAP_PERSISTENT_GROUP BIT(1) -+#define P2P_GRPCAP_GROUP_LIMIT BIT(2) -+#define P2P_GRPCAP_INTRABSS BIT(3) -+#define P2P_GRPCAP_CROSS_CONN BIT(4) -+#define P2P_GRPCAP_PERSISTENT_RECONN BIT(5) -+#define P2P_GRPCAP_GROUP_FORMATION BIT(6) -+ -+/* P2P Public Action Frame (Management Frame) */ -+#define P2P_PUB_ACTION_ACTION 0x09 -+ -+/* P2P Public Action Frame Type */ -+#define P2P_GO_NEGO_REQ 0 -+#define P2P_GO_NEGO_RESP 1 -+#define P2P_GO_NEGO_CONF 2 -+#define P2P_INVIT_REQ 3 -+#define P2P_INVIT_RESP 4 -+#define P2P_DEVDISC_REQ 5 -+#define P2P_DEVDISC_RESP 6 -+#define P2P_PROVISION_DISC_REQ 7 -+#define P2P_PROVISION_DISC_RESP 8 -+ -+/* P2P Action Frame Type */ -+#define P2P_NOTICE_OF_ABSENCE 0 -+#define P2P_PRESENCE_REQUEST 1 -+#define P2P_PRESENCE_RESPONSE 2 -+#define P2P_GO_DISC_REQUEST 3 -+ -+ -+#define P2P_MAX_PERSISTENT_GROUP_NUM 10 -+ -+#define P2P_PROVISIONING_SCAN_CNT 3 -+ -+#define P2P_WILDCARD_SSID_LEN 7 -+ -+#define P2P_FINDPHASE_EX_NONE 0 /* default value, used when: (1)p2p disabed or (2)p2p enabled but only do 1 scan phase */ -+#define P2P_FINDPHASE_EX_FULL 1 /* used when p2p enabled and want to do 1 scan phase and P2P_FINDPHASE_EX_MAX-1 find phase */ -+#define P2P_FINDPHASE_EX_SOCIAL_FIRST (P2P_FINDPHASE_EX_FULL+1) -+#define P2P_FINDPHASE_EX_MAX 4 -+#define P2P_FINDPHASE_EX_SOCIAL_LAST P2P_FINDPHASE_EX_MAX -+ -+#define P2P_PROVISION_TIMEOUT 5000 /* 5 seconds timeout for sending the provision discovery request */ -+#define P2P_CONCURRENT_PROVISION_TIMEOUT 3000 /* 3 seconds timeout for sending the provision discovery request under concurrent mode */ -+#define P2P_GO_NEGO_TIMEOUT 5000 /* 5 seconds timeout for receiving the group negotation response */ -+#define P2P_CONCURRENT_GO_NEGO_TIMEOUT 3000 /* 3 seconds timeout for sending the negotiation request under concurrent mode */ -+#define P2P_TX_PRESCAN_TIMEOUT 100 /* 100ms */ -+#define P2P_INVITE_TIMEOUT 5000 /* 5 seconds timeout for sending the invitation request */ -+#define P2P_CONCURRENT_INVITE_TIMEOUT 3000 /* 3 seconds timeout for sending the invitation request under concurrent mode */ -+#define P2P_RESET_SCAN_CH 25000 /* 25 seconds timeout to reset the scan channel (based on channel plan) */ -+#define P2P_MAX_INTENT 15 -+ -+#define P2P_MAX_NOA_NUM 2 -+ -+/* WPS Configuration Method */ -+#define WPS_CM_NONE 0x0000 -+#define WPS_CM_LABEL 0x0004 -+#define WPS_CM_DISPLYA 0x0008 -+#define WPS_CM_EXTERNAL_NFC_TOKEN 0x0010 -+#define WPS_CM_INTEGRATED_NFC_TOKEN 0x0020 -+#define WPS_CM_NFC_INTERFACE 0x0040 -+#define WPS_CM_PUSH_BUTTON 0x0080 -+#define WPS_CM_KEYPAD 0x0100 -+#define WPS_CM_SW_PUHS_BUTTON 0x0280 -+#define WPS_CM_HW_PUHS_BUTTON 0x0480 -+#define WPS_CM_SW_DISPLAY_PIN 0x2008 -+#define WPS_CM_LCD_DISPLAY_PIN 0x4008 -+ -+enum P2P_ROLE { -+ P2P_ROLE_DISABLE = 0, -+ P2P_ROLE_DEVICE = 1, -+ P2P_ROLE_CLIENT = 2, -+ P2P_ROLE_GO = 3 -+}; -+ -+enum P2P_STATE { -+ P2P_STATE_NONE = 0, /* P2P disable */ -+ P2P_STATE_IDLE = 1, /* P2P had enabled and do nothing */ -+ P2P_STATE_LISTEN = 2, /* In pure listen state */ -+ P2P_STATE_SCAN = 3, /* In scan phase */ -+ P2P_STATE_FIND_PHASE_LISTEN = 4, /* In the listen state of find phase */ -+ P2P_STATE_FIND_PHASE_SEARCH = 5, /* In the search state of find phase */ -+ P2P_STATE_TX_PROVISION_DIS_REQ = 6, /* In P2P provisioning discovery */ -+ P2P_STATE_RX_PROVISION_DIS_RSP = 7, -+ P2P_STATE_RX_PROVISION_DIS_REQ = 8, -+ P2P_STATE_GONEGO_ING = 9, /* Doing the group owner negoitation handshake */ -+ P2P_STATE_GONEGO_OK = 10, /* finish the group negoitation handshake with success */ -+ P2P_STATE_GONEGO_FAIL = 11, /* finish the group negoitation handshake with failure */ -+ P2P_STATE_RECV_INVITE_REQ_MATCH = 12, /* receiving the P2P Inviation request and match with the profile. */ -+ P2P_STATE_PROVISIONING_ING = 13, /* Doing the P2P WPS */ -+ P2P_STATE_PROVISIONING_DONE = 14, /* Finish the P2P WPS */ -+ P2P_STATE_TX_INVITE_REQ = 15, /* Transmit the P2P Invitation request */ -+ P2P_STATE_RX_INVITE_RESP_OK = 16, /* Receiving the P2P Invitation response */ -+ P2P_STATE_RECV_INVITE_REQ_DISMATCH = 17, /* receiving the P2P Inviation request and dismatch with the profile. */ -+ P2P_STATE_RECV_INVITE_REQ_GO = 18, /* receiving the P2P Inviation request and this wifi is GO. */ -+ P2P_STATE_RECV_INVITE_REQ_JOIN = 19, /* receiving the P2P Inviation request to join an existing P2P Group. */ -+ P2P_STATE_RX_INVITE_RESP_FAIL = 20, /* recveing the P2P Inviation response with failure */ -+ P2P_STATE_RX_INFOR_NOREADY = 21, /* receiving p2p negoitation response with information is not available */ -+ P2P_STATE_TX_INFOR_NOREADY = 22, /* sending p2p negoitation response with information is not available */ -+}; -+ -+enum P2P_WPSINFO { -+ P2P_NO_WPSINFO = 0, -+ P2P_GOT_WPSINFO_PEER_DISPLAY_PIN = 1, -+ P2P_GOT_WPSINFO_SELF_DISPLAY_PIN = 2, -+ P2P_GOT_WPSINFO_PBC = 3, -+}; -+ -+#define P2P_PRIVATE_IOCTL_SET_LEN 64 -+ -+enum P2P_PROTO_WK_ID -+{ -+ P2P_FIND_PHASE_WK = 0, -+ P2P_RESTORE_STATE_WK = 1, -+ P2P_PRE_TX_PROVDISC_PROCESS_WK = 2, -+ P2P_PRE_TX_NEGOREQ_PROCESS_WK = 3, -+ P2P_PRE_TX_INVITEREQ_PROCESS_WK = 4, -+ P2P_AP_P2P_CH_SWITCH_PROCESS_WK =5, -+ P2P_RO_CH_WK = 6, -+}; -+ -+/* =====================WFD Section ===================== */ -+/* For Wi-Fi Display */ -+#define WFD_ATTR_DEVICE_INFO 0x00 -+#define WFD_ATTR_ASSOC_BSSID 0x01 -+#define WFD_ATTR_COUPLED_SINK_INFO 0x06 -+#define WFD_ATTR_LOCAL_IP_ADDR 0x08 -+#define WFD_ATTR_SESSION_INFO 0x09 -+#define WFD_ATTR_ALTER_MAC 0x0a -+ -+/* For WFD Device Information Attribute */ -+#define WFD_DEVINFO_SOURCE 0x0000 -+#define WFD_DEVINFO_PSINK 0x0001 -+#define WFD_DEVINFO_SSINK 0x0002 -+#define WFD_DEVINFO_DUAL 0x0003 -+ -+#define WFD_DEVINFO_SESSION_AVAIL 0x0010 -+#define WFD_DEVINFO_WSD 0x0040 -+#define WFD_DEVINFO_PC_TDLS 0x0080 -+#define WFD_DEVINFO_HDCP_SUPPORT 0x0100 -+ -+#define IP_MCAST_MAC(mac) ((mac[0]== 0x01) && (mac[1]== 0x00) && (mac[2]== 0x5e)) -+#define ICMPV6_MCAST_MAC(mac) ((mac[0]== 0x33) && (mac[1]== 0x33) && (mac[2]!= 0xff)) -+ -+/* Regulatroy Domain */ -+struct regd_pair_mapping { -+ u16 reg_dmnenum; -+ u16 reg_2ghz_ctl; -+}; -+ -+struct rtw_regulatory { -+ char alpha2[2]; -+ u16 country_code; -+ u16 max_power_level; -+ u32 tp_scale; -+ u16 current_rd; -+ u16 current_rd_ext; -+ int16_t power_limit; -+ struct regd_pair_mapping *regpair; -+}; -+ -+#endif /* _WIFI_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/wlan_bssdef.h linux/3rdparty/rtl8723bs/include/wlan_bssdef.h ---- linux.old/3rdparty/rtl8723bs/include/wlan_bssdef.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/wlan_bssdef.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,278 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __WLAN_BSSDEF_H__ -+#define __WLAN_BSSDEF_H__ -+ -+ -+#define MAX_IE_SZ 768 -+ -+ -+#define NDIS_802_11_LENGTH_SSID 32 -+#define NDIS_802_11_LENGTH_RATES 8 -+#define NDIS_802_11_LENGTH_RATES_EX 16 -+ -+typedef unsigned char NDIS_802_11_MAC_ADDRESS[6]; -+typedef unsigned char NDIS_802_11_RATES[NDIS_802_11_LENGTH_RATES]; /* Set of 8 data rates */ -+typedef unsigned char NDIS_802_11_RATES_EX[NDIS_802_11_LENGTH_RATES_EX]; /* Set of 16 data rates */ -+ -+struct ndis_802_11_ssid { -+ u32 SsidLength; -+ u8 Ssid[32]; -+}; -+ -+enum NDIS_802_11_NETWORK_TYPE { -+ Ndis802_11FH, -+ Ndis802_11DS, -+ Ndis802_11OFDM5, -+ Ndis802_11OFDM24, -+ Ndis802_11NetworkTypeMax /* not a real type, defined as an upper bound */ -+}; -+ -+struct ndis_802_11_conf_fh { -+ u32 Length; /* Length of structure */ -+ u32 HopPattern; /* As defined by 802.11, MSB set */ -+ u32 HopSet; /* to one if non-802.11 */ -+ u32 DwellTime; /* units are Kusec */ -+}; -+ -+/* -+ FW will only save the channel number in DSConfig. -+ ODI Handler will convert the channel number to freq. number. -+*/ -+struct ndis_802_11_conf { -+ u32 Length; /* Length of structure */ -+ u32 BeaconPeriod; /* units are Kusec */ -+ u32 ATIMWindow; /* units are Kusec */ -+ u32 DSConfig; /* Frequency, units are kHz */ -+ struct ndis_802_11_conf_fh FHConfig; -+}; -+ -+enum NDIS_802_11_NETWORK_INFRASTRUCTURE { -+ Ndis802_11IBSS, -+ Ndis802_11Infrastructure, -+ Ndis802_11AutoUnknown, -+ Ndis802_11InfrastructureMax, /* Not a real value, defined as upper bound */ -+ Ndis802_11APMode, -+}; -+ -+struct ndis_802_11_fix_ie { -+ u8 Timestamp[8]; -+ u16 BeaconInterval; -+ u16 Capabilities; -+}; -+ -+struct ndis_80211_var_ie { -+ u8 ElementID; -+ u8 Length; -+ u8 data[1]; -+}; -+ -+/* Length is the 4 bytes multiples of the sum of -+ * sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + -+ * sizeof (struct ndis_802_11_ssid) + sizeof (u32) + -+ * sizeof (long) + sizeof (enum NDIS_802_11_NETWORK_TYPE) + -+ * sizeof (struct ndis_802_11_conf) + sizeof (NDIS_802_11_RATES_EX) + IELength -+ * -+ * Except for IELength, all other fields are fixed length. Therefore, we can -+ * define a macro to present the partial sum. -+ */ -+enum NDIS_802_11_AUTHENTICATION_MODE { -+ Ndis802_11AuthModeOpen, -+ Ndis802_11AuthModeShared, -+ Ndis802_11AuthModeAutoSwitch, -+ Ndis802_11AuthModeWPA, -+ Ndis802_11AuthModeWPAPSK, -+ Ndis802_11AuthModeWPANone, -+ Ndis802_11AuthModeWAPI, -+ Ndis802_11AuthModeMax /* Not a real mode, defined as upper bound */ -+}; -+ -+enum NDIS_802_11_WEP_STATUS { -+ Ndis802_11WEPEnabled, -+ Ndis802_11Encryption1Enabled = Ndis802_11WEPEnabled, -+ Ndis802_11WEPDisabled, -+ Ndis802_11EncryptionDisabled = Ndis802_11WEPDisabled, -+ Ndis802_11WEPKeyAbsent, -+ Ndis802_11Encryption1KeyAbsent = Ndis802_11WEPKeyAbsent, -+ Ndis802_11WEPNotSupported, -+ Ndis802_11EncryptionNotSupported = Ndis802_11WEPNotSupported, -+ Ndis802_11Encryption2Enabled, -+ Ndis802_11Encryption2KeyAbsent, -+ Ndis802_11Encryption3Enabled, -+ Ndis802_11Encryption3KeyAbsent, -+ Ndis802_11_EncrypteionWAPI -+}; -+ -+#define NDIS_802_11_AI_REQFI_CAPABILITIES 1 -+#define NDIS_802_11_AI_REQFI_LISTENINTERVAL 2 -+#define NDIS_802_11_AI_REQFI_CURRENTAPADDRESS 4 -+ -+#define NDIS_802_11_AI_RESFI_CAPABILITIES 1 -+#define NDIS_802_11_AI_RESFI_STATUSCODE 2 -+#define NDIS_802_11_AI_RESFI_ASSOCIATIONID 4 -+ -+struct ndis_802_11_ai_reqfi { -+ u16 Capabilities; -+ u16 ListenInterval; -+ NDIS_802_11_MAC_ADDRESS CurrentAPAddress; -+}; -+ -+struct ndis_801_11_ai_resfi { -+ u16 Capabilities; -+ u16 StatusCode; -+ u16 AssociationId; -+}; -+ -+typedef struct _NDIS_802_11_ASSOCIATION_INFORMATION -+{ -+ u32 Length; -+ u16 AvailableRequestFixedIEs; -+ struct ndis_802_11_ai_reqfi RequestFixedIEs; -+ u32 RequestIELength; -+ u32 OffsetRequestIEs; -+ u16 AvailableResponseFixedIEs; -+ struct ndis_801_11_ai_resfi ResponseFixedIEs; -+ u32 ResponseIELength; -+ u32 OffsetResponseIEs; -+} NDIS_802_11_ASSOCIATION_INFORMATION, *PNDIS_802_11_ASSOCIATION_INFORMATION; -+ -+enum NDIS_802_11_RELOAD_DEFAULTS { -+ Ndis802_11ReloadWEPKeys -+}; -+ -+ -+/* Key mapping keys require a BSSID */ -+typedef struct _NDIS_802_11_KEY -+{ -+ u32 Length; /* Length of this structure */ -+ u32 KeyIndex; -+ u32 KeyLength; /* length of key in bytes */ -+ NDIS_802_11_MAC_ADDRESS BSSID; -+ unsigned long long KeyRSC; -+ u8 KeyMaterial[32]; /* variable length depending on above field */ -+} NDIS_802_11_KEY, *PNDIS_802_11_KEY; -+ -+typedef struct _NDIS_802_11_REMOVE_KEY -+{ -+ u32 Length; /* Length of this structure */ -+ u32 KeyIndex; -+ NDIS_802_11_MAC_ADDRESS BSSID; -+} NDIS_802_11_REMOVE_KEY, *PNDIS_802_11_REMOVE_KEY; -+ -+struct ndis_802_11_wep { -+ u32 Length; /* Length of this structure */ -+ u32 KeyIndex; /* 0 is the per-client key, 1-N are the global keys */ -+ u32 KeyLength; /* length of key in bytes */ -+ u8 KeyMaterial[16];/* variable length depending on above field */ -+}; -+ -+/* mask for authentication/integrity fields */ -+#define NDIS_802_11_AUTH_REQUEST_AUTH_FIELDS 0x0f -+#define NDIS_802_11_AUTH_REQUEST_REAUTH 0x01 -+#define NDIS_802_11_AUTH_REQUEST_KEYUPDATE 0x02 -+#define NDIS_802_11_AUTH_REQUEST_PAIRWISE_ERROR 0x06 -+#define NDIS_802_11_AUTH_REQUEST_GROUP_ERROR 0x0E -+ -+/* MIC check time, 60 seconds. */ -+#define MIC_CHECK_TIME 60000000 -+ -+#ifndef Ndis802_11APMode -+#define Ndis802_11APMode (Ndis802_11InfrastructureMax+1) -+#endif -+ -+struct wlan_phy_info { -+ u8 SignalStrength;/* in percentage) */ -+ u8 SignalQuality;/* in percentage) */ -+ u8 Optimum_antenna; /* for Antenna diversity */ -+ u8 Reserved_0; -+}; -+ -+struct wlan_bcn_info { -+ /* these infor get from rtw_get_encrypt_info when -+ * * translate scan to UI */ -+ u8 encryp_protocol;/* ENCRYP_PROTOCOL_E: OPEN/WEP/WPA/WPA2/WAPI */ -+ int group_cipher; /* WPA/WPA2 group cipher */ -+ int pairwise_cipher;/* WPA/WPA2/WEP pairwise cipher */ -+ int is_8021x; -+ -+ /* bwmode 20/40 and ch_offset UP/LOW */ -+ unsigned short ht_cap_info; -+ unsigned char ht_info_infos_0; -+}; -+ -+/* temporally add #pragma pack for structure alignment issue of -+* struct wlan_bssid_ex and get_wlan_bssid_ex_sz() -+*/ -+struct wlan_bssid_ex { -+ u32 Length; -+ NDIS_802_11_MAC_ADDRESS MacAddress; -+ u8 Reserved[2];/* 0]: IS beacon frame */ -+ struct ndis_802_11_ssid Ssid; -+ u32 Privacy; -+ long Rssi;/* in dBM, raw data , get from PHY) */ -+ enum NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; -+ struct ndis_802_11_conf Configuration; -+ enum NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; -+ NDIS_802_11_RATES_EX SupportedRates; -+ struct wlan_phy_info PhyInfo; -+ u32 IELength; -+ u8 IEs[MAX_IE_SZ]; /* timestamp, beacon interval, and capability information) */ -+} __packed; -+ -+__inline static uint get_wlan_bssid_ex_sz(struct wlan_bssid_ex *bss) -+{ -+ return (sizeof(struct wlan_bssid_ex) - MAX_IE_SZ + bss->IELength); -+} -+ -+struct wlan_network { -+ struct list_head list; -+ int network_type; /* refer to ieee80211.h for WIRELESS_11A/B/G */ -+ int fixed; /* set to fixed when not to be removed as site-surveying */ -+ unsigned long last_scanned; /* timestamp for the network */ -+ int aid; /* will only be valid when a BSS is joinned. */ -+ int join_res; -+ struct wlan_bssid_ex network; /* must be the last item */ -+ struct wlan_bcn_info BcnInfo; -+}; -+ -+enum VRTL_CARRIER_SENSE { -+ DISABLE_VCS, -+ ENABLE_VCS, -+ AUTO_VCS -+}; -+ -+enum VCS_TYPE { -+ NONE_VCS, -+ RTS_CTS, -+ CTS_TO_SELF -+}; -+ -+#define PWR_CAM 0 -+#define PWR_MINPS 1 -+#define PWR_MAXPS 2 -+#define PWR_UAPSD 3 -+#define PWR_VOIP 4 -+ -+enum UAPSD_MAX_SP { -+ NO_LIMIT, -+ TWO_MSDU, -+ FOUR_MSDU, -+ SIX_MSDU -+}; -+ -+#define NUM_PRE_AUTH_KEY 16 -+#define NUM_PMKID_CACHE NUM_PRE_AUTH_KEY -+ -+#endif /* ifndef WLAN_BSSDEF_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/include/xmit_osdep.h linux/3rdparty/rtl8723bs/include/xmit_osdep.h ---- linux.old/3rdparty/rtl8723bs/include/xmit_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/include/xmit_osdep.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,54 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __XMIT_OSDEP_H_ -+#define __XMIT_OSDEP_H_ -+ -+ -+struct pkt_file { -+ _pkt *pkt; -+ __kernel_size_t pkt_len; /* the remainder length of the open_file */ -+ _buffer *cur_buffer; -+ u8 *buf_start; -+ u8 *cur_addr; -+ __kernel_size_t buf_len; -+}; -+ -+#define NR_XMITFRAME 256 -+ -+struct xmit_priv; -+struct pkt_attrib; -+struct sta_xmit_priv; -+struct xmit_frame; -+struct xmit_buf; -+ -+extern int _rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); -+extern int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); -+ -+void rtw_os_xmit_schedule(struct adapter *padapter); -+ -+int rtw_os_xmit_resource_alloc(struct adapter *padapter, struct xmit_buf *pxmitbuf, u32 alloc_sz, u8 flag); -+void rtw_os_xmit_resource_free(struct adapter *padapter, struct xmit_buf *pxmitbuf, u32 free_sz, u8 flag); -+ -+extern void rtw_set_tx_chksum_offload(_pkt *pkt, struct pkt_attrib *pattrib); -+ -+extern uint rtw_remainder_len(struct pkt_file *pfile); -+extern void _rtw_open_pktfile(_pkt *pkt, struct pkt_file *pfile); -+extern uint _rtw_pktfile_read (struct pkt_file *pfile, u8 *rmem, uint rlen); -+extern sint rtw_endofpktfile (struct pkt_file *pfile); -+ -+extern void rtw_os_pkt_complete(struct adapter *padapter, _pkt *pkt); -+extern void rtw_os_xmit_complete(struct adapter *padapter, struct xmit_frame *pxframe); -+ -+#endif /* __XMIT_OSDEP_H_ */ -diff -Nurp linux.old/3rdparty/rtl8723bs/Kconfig linux/3rdparty/rtl8723bs/Kconfig ---- linux.old/3rdparty/rtl8723bs/Kconfig 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/Kconfig 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,11 @@ -+config RTL8723BS -+ tristate "Realtek 8723B SDIO or SPI WiFi" -+ ---help--- -+ Help message of RTL8723BS -+ -+config WLAN_SDIO -+ bool "Enable SDIO interface for Realtek" -+ depends on RTL8723AS || RTL8723BS -+ default n -+ ---help--- -+ Use memory preallocated in platform -diff -Nurp linux.old/3rdparty/rtl8723bs/Makefile linux/3rdparty/rtl8723bs/Makefile ---- linux.old/3rdparty/rtl8723bs/Makefile 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/Makefile 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,251 @@ -+EXTRA_CFLAGS += $(USER_EXTRA_CFLAGS) -+EXTRA_CFLAGS += -O1 -+#EXTRA_CFLAGS += -O3 -+EXTRA_CFLAGS += -Wall -+#EXTRA_CFLAGS += -Wextra -+#EXTRA_CFLAGS += -Werror -+#EXTRA_CFLAGS += -pedantic -+#EXTRA_CFLAGS += -Wshadow -Wpointer-arith -Wcast-qual -Wstrict-prototypes -Wmissing-prototypes -+ -+EXTRA_CFLAGS += -I$(src)/include -I$(src)/hal -g -+ -+ccflags-y += -D__CHECK_ENDIAN__ -+ -+#EXTRA_LDFLAGS += --strip-debug -+ -+########################## Features ########################### -+CONFIG_HW_PWRP_DETECTION = n -+CONFIG_INTEL_WIDI = n -+CONFIG_EXT_CLK = n -+CONFIG_TRAFFIC_PROTECT = y -+CONFIG_LOAD_PHY_PARA_FROM_FILE = y -+CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY = n -+CONFIG_CALIBRATE_TX_POWER_TO_MAX = n -+CONFIG_ODM_ADAPTIVITY = n -+CONFIG_SKIP_SIGNAL_SCALE_MAPPING = n -+######################## Wake On Lan ########################## -+CONFIG_WOWLAN = n -+CONFIG_GPIO_WAKEUP = n -+CONFIG_PNO_SUPPORT = n -+CONFIG_PNO_SET_DEBUG = n -+CONFIG_AP_WOWLAN = n -+######### Notify SDIO Host Keep Power During Syspend ########## -+CONFIG_RTW_SDIO_PM_KEEP_POWER = y -+###################### Platform Related ####################### -+CONFIG_PLATFORM_I386_PC = y -+############################################################### -+ -+########### COMMON ################################# -+ -+_OS_INTFS_FILES := os_dep/osdep_service.o \ -+ os_dep/os_intfs.o \ -+ os_dep/sdio_intf.o \ -+ os_dep/sdio_ops_linux.o \ -+ os_dep/ioctl_linux.o \ -+ os_dep/xmit_linux.o \ -+ os_dep/mlme_linux.o \ -+ os_dep/recv_linux.o \ -+ os_dep/ioctl_cfg80211.o \ -+ os_dep/wifi_regd.o \ -+ os_dep/rtw_proc.o \ -+ os_dep/sdio_ops_linux.o -+ -+_HAL_INTFS_FILES := hal/hal_intf.o \ -+ hal/hal_com.o \ -+ hal/hal_com_phycfg.o \ -+ hal/hal_btcoex.o \ -+ hal/hal_sdio.o -+ -+_OUTSRC_FILES := hal/odm_debug.o \ -+ hal/odm_HWConfig.o\ -+ hal/odm.o\ -+ hal/HalPhyRf.o\ -+ hal/odm_EdcaTurboCheck.o\ -+ hal/odm_DIG.o\ -+ hal/odm_PathDiv.o\ -+ hal/odm_DynamicBBPowerSaving.o\ -+ hal/odm_DynamicTxPower.o\ -+ hal/odm_CfoTracking.o\ -+ hal/odm_NoiseMonitor.o -+ -+EXTRA_CFLAGS += -I$(src)/hal/OUTSRC-BTCoexist -+_OUTSRC_FILES += \ -+ hal/HalBtc8723b1Ant.o \ -+ hal/HalBtc8723b2Ant.o -+ -+########### HAL_RTL8723B ################################# -+MODULE_NAME = r8723bs -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/Hal8723BPwrSeq.o -+ -+_HAL_INTFS_FILES += hal/rtl8723b_hal_init.o \ -+ hal/rtl8723b_phycfg.o \ -+ hal/rtl8723b_rf6052.o \ -+ hal/rtl8723b_dm.o \ -+ hal/rtl8723b_rxdesc.o \ -+ hal/rtl8723b_cmd.o \ -+ -+_HAL_INTFS_FILES += \ -+ hal/sdio_halinit.o \ -+ hal/rtl8723bs_xmit.o \ -+ hal/rtl8723bs_recv.o -+ -+_HAL_INTFS_FILES += hal/sdio_ops.o -+ -+_OUTSRC_FILES += hal/HalHWImg8723B_BB.o\ -+ hal/HalHWImg8723B_MAC.o\ -+ hal/HalHWImg8723B_RF.o\ -+ hal/odm_RegConfig8723B.o\ -+ hal/HalPhyRf_8723B.o\ -+ hal/odm_RTL8723B.o -+ -+########### END OF PATH ################################# -+ -+ -+ifeq ($(CONFIG_HW_PWRP_DETECTION), y) -+EXTRA_CFLAGS += -DCONFIG_HW_PWRP_DETECTION -+endif -+ -+ifeq ($(CONFIG_INTEL_WIDI), y) -+EXTRA_CFLAGS += -DCONFIG_INTEL_WIDI -+endif -+ -+ifeq ($(CONFIG_EXT_CLK), y) -+EXTRA_CFLAGS += -DCONFIG_EXT_CLK -+endif -+ -+ifeq ($(CONFIG_TRAFFIC_PROTECT), y) -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+endif -+ -+ifeq ($(CONFIG_LOAD_PHY_PARA_FROM_FILE), y) -+EXTRA_CFLAGS += -DCONFIG_LOAD_PHY_PARA_FROM_FILE -+endif -+ -+ifeq ($(CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY), y) -+EXTRA_CFLAGS += -DCONFIG_CALIBRATE_TX_POWER_BY_REGULATORY -+endif -+ -+ifeq ($(CONFIG_CALIBRATE_TX_POWER_TO_MAX), y) -+EXTRA_CFLAGS += -DCONFIG_CALIBRATE_TX_POWER_TO_MAX -+endif -+ -+ifeq ($(CONFIG_ODM_ADAPTIVITY), y) -+EXTRA_CFLAGS += -DCONFIG_ODM_ADAPTIVITY -+endif -+ -+ifeq ($(CONFIG_SKIP_SIGNAL_SCALE_MAPPING), y) -+EXTRA_CFLAGS += -DCONFIG_SKIP_SIGNAL_SCALE_MAPPING -+endif -+ -+ifeq ($(CONFIG_WOWLAN), y) -+EXTRA_CFLAGS += -DCONFIG_WOWLAN -+EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER -+endif -+ -+ifeq ($(CONFIG_AP_WOWLAN), y) -+EXTRA_CFLAGS += -DCONFIG_AP_WOWLAN -+EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER -+endif -+ -+ifeq ($(CONFIG_PNO_SUPPORT), y) -+EXTRA_CFLAGS += -DCONFIG_PNO_SUPPORT -+ifeq ($(CONFIG_PNO_SET_DEBUG), y) -+EXTRA_CFLAGS += -DCONFIG_PNO_SET_DEBUG -+endif -+endif -+ -+ifeq ($(CONFIG_GPIO_WAKEUP), y) -+EXTRA_CFLAGS += -DCONFIG_GPIO_WAKEUP -+endif -+ -+ifeq ($(CONFIG_RTW_SDIO_PM_KEEP_POWER), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER -+endif -+ -+ifeq ($(CONFIG_PLATFORM_I386_PC), y) -+SUBARCH := $(shell uname -m | sed -e s/i.86/i386/ | sed -e s/armv7l/arm/) -+ARCH ?= $(SUBARCH) -+CROSS_COMPILE ?= -+KVER := $(shell uname -r) -+KSRC := /lib/modules/$(KVER)/build -+MODDESTDIR := /lib/modules/$(KVER)/kernel/drivers/net/wireless/ -+INSTALL_PREFIX := -+endif -+ -+ifneq ($(KERNELRELEASE),) -+ -+rtk_core := core/rtw_cmd.o \ -+ core/rtw_security.o \ -+ core/rtw_debug.o \ -+ core/rtw_io.o \ -+ core/rtw_ioctl_set.o \ -+ core/rtw_ieee80211.o \ -+ core/rtw_mlme.o \ -+ core/rtw_mlme_ext.o \ -+ core/rtw_wlan_util.o \ -+ core/rtw_pwrctrl.o \ -+ core/rtw_rf.o \ -+ core/rtw_recv.o \ -+ core/rtw_sta_mgt.o \ -+ core/rtw_ap.o \ -+ core/rtw_xmit.o \ -+ core/rtw_btcoex.o \ -+ core/rtw_odm.o \ -+ core/rtw_efuse.o -+ -+$(MODULE_NAME)-y += $(rtk_core) -+ -+$(MODULE_NAME)-$(CONFIG_INTEL_WIDI) += core/rtw_intel_widi.o -+ -+$(MODULE_NAME)-y += $(_OS_INTFS_FILES) -+$(MODULE_NAME)-y += $(_HAL_INTFS_FILES) -+$(MODULE_NAME)-y += $(_OUTSRC_FILES) -+$(MODULE_NAME)-y += $(_PLATFORM_FILES) -+ -+obj-$(CONFIG_RTL8723BS) := $(MODULE_NAME).o -+ -+endif -+ -+export CONFIG_RTL8723BS = m -+ -+all: modules -+ -+modules: -+ $(MAKE) ARCH=$(ARCH) CROSS_COMPILE=$(CROSS_COMPILE) -C $(KSRC) M=$(shell pwd) modules -+ -+strip: -+ $(CROSS_COMPILE)strip $(MODULE_NAME).ko --strip-unneeded -+ -+install: -+ install -p -m 644 $(MODULE_NAME).ko $(MODDESTDIR) -+ @mkdir -p /lib/firmware/rtlwifi/ -+ @cp -n rtl8723bs_nic.bin /lib/firmware/rtlwifi/rtl8723bs_nic.bin -+ @cp -n rtl8723bs_wowlan.bin /lib/firmware/rtlwifi/rtl8723bs_wowlan.bin -+ /sbin/depmod -a ${KVER} -+ -+uninstall: -+ rm -f $(MODDESTDIR)/$(MODULE_NAME).ko -+ /sbin/depmod -a ${KVER} -+ -+config_r: -+ @echo "make config" -+ /bin/bash script/Configure script/config.in -+ -+cppcheck: cppcheck.log -+ -+cppcheck.log: -+ @echo "Creating cppcheck.log" -+ cppcheck -f --enable=all -Iinclude -Ihal -Ios_dep . 2> cppcheck.log -+ -+.PHONY: modules clean -+ -+clean: -+ @rm -fr hal/*/*.mod.c hal/*/*.mod hal/*/*.o hal/*/.*.cmd hal/*/*.ko \ -+ hal/*.mod.c hal/*.mod hal/*.o hal/.*.cmd hal/*.ko \ -+ core/*.mod.c core/*.mod core/*.o core/.*.cmd core/*.ko \ -+ os_dep/*.mod.c os_dep/*.mod os_dep/*.o os_dep/.*.cmd *.ko \ -+ platform/*.mod.c platform/*.mod platform/*.o platform/.*.cmd platform/*.ko \ -+ Module.symvers Module.markers modules.order *.mod.c *.mod *.o .*.cmd *.ko *~ .tmp_versions \ -+ cppcheck.log -diff -Nurp linux.old/3rdparty/rtl8723bs/os_dep/ioctl_cfg80211.c linux/3rdparty/rtl8723bs/os_dep/ioctl_cfg80211.c ---- linux.old/3rdparty/rtl8723bs/os_dep/ioctl_cfg80211.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/os_dep/ioctl_cfg80211.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,3608 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _IOCTL_CFG80211_C_ -+ -+#include -+#include -+#include -+ -+#include -+ -+#define RTW_MAX_MGMT_TX_CNT (8) -+ -+#define RTW_SCAN_IE_LEN_MAX 2304 -+#define RTW_MAX_REMAIN_ON_CHANNEL_DURATION 5000 /* ms */ -+#define RTW_MAX_NUM_PMKIDS 4 -+ -+#define RTW_CH_MAX_2G_CHANNEL 14 /* Max channel in 2G band */ -+ -+static const u32 rtw_cipher_suites[] = { -+ WLAN_CIPHER_SUITE_WEP40, -+ WLAN_CIPHER_SUITE_WEP104, -+ WLAN_CIPHER_SUITE_TKIP, -+ WLAN_CIPHER_SUITE_CCMP, -+ WLAN_CIPHER_SUITE_AES_CMAC, -+}; -+ -+#define RATETAB_ENT(_rate, _rateid, _flags) \ -+ { \ -+ .bitrate = (_rate), \ -+ .hw_value = (_rateid), \ -+ .flags = (_flags), \ -+ } -+ -+#define CHAN2G(_channel, _freq, _flags) { \ -+ .band = IEEE80211_BAND_2GHZ, \ -+ .center_freq = (_freq), \ -+ .hw_value = (_channel), \ -+ .flags = (_flags), \ -+ .max_antenna_gain = 0, \ -+ .max_power = 30, \ -+} -+ -+/* if wowlan is not supported, kernel generate a disconnect at each suspend -+ * cf: /net/wireless/sysfs.c, so register a stub wowlan. -+ * Moreover wowlan has to be enabled via a the nl80211_set_wowlan callback. -+ * (from user space, e.g. iw phy0 wowlan enable) -+ */ -+static const struct wiphy_wowlan_support wowlan_stub = { -+ .flags = WIPHY_WOWLAN_ANY, -+ .n_patterns = 0, -+ .pattern_max_len = 0, -+ .pattern_min_len = 0, -+ .max_pkt_offset = 0, -+}; -+ -+static struct ieee80211_rate rtw_rates[] = { -+ RATETAB_ENT(10, 0x1, 0), -+ RATETAB_ENT(20, 0x2, 0), -+ RATETAB_ENT(55, 0x4, 0), -+ RATETAB_ENT(110, 0x8, 0), -+ RATETAB_ENT(60, 0x10, 0), -+ RATETAB_ENT(90, 0x20, 0), -+ RATETAB_ENT(120, 0x40, 0), -+ RATETAB_ENT(180, 0x80, 0), -+ RATETAB_ENT(240, 0x100, 0), -+ RATETAB_ENT(360, 0x200, 0), -+ RATETAB_ENT(480, 0x400, 0), -+ RATETAB_ENT(540, 0x800, 0), -+}; -+ -+#define rtw_a_rates (rtw_rates + 4) -+#define RTW_A_RATES_NUM 8 -+#define rtw_g_rates (rtw_rates + 0) -+#define RTW_G_RATES_NUM 12 -+ -+#define RTW_2G_CHANNELS_NUM 14 -+#define RTW_5G_CHANNELS_NUM 37 -+ -+static struct ieee80211_channel rtw_2ghz_channels[] = { -+ CHAN2G(1, 2412, 0), -+ CHAN2G(2, 2417, 0), -+ CHAN2G(3, 2422, 0), -+ CHAN2G(4, 2427, 0), -+ CHAN2G(5, 2432, 0), -+ CHAN2G(6, 2437, 0), -+ CHAN2G(7, 2442, 0), -+ CHAN2G(8, 2447, 0), -+ CHAN2G(9, 2452, 0), -+ CHAN2G(10, 2457, 0), -+ CHAN2G(11, 2462, 0), -+ CHAN2G(12, 2467, 0), -+ CHAN2G(13, 2472, 0), -+ CHAN2G(14, 2484, 0), -+}; -+ -+static void rtw_2g_channels_init(struct ieee80211_channel *channels) -+{ -+ memcpy((void*)channels, (void*)rtw_2ghz_channels, -+ sizeof(struct ieee80211_channel)*RTW_2G_CHANNELS_NUM -+ ); -+} -+ -+static void rtw_2g_rates_init(struct ieee80211_rate *rates) -+{ -+ memcpy(rates, rtw_g_rates, -+ sizeof(struct ieee80211_rate)*RTW_G_RATES_NUM -+ ); -+} -+ -+static struct ieee80211_supported_band *rtw_spt_band_alloc( -+ enum ieee80211_band band -+ ) -+{ -+ struct ieee80211_supported_band *spt_band = NULL; -+ int n_channels, n_bitrates; -+ -+ if (band == IEEE80211_BAND_2GHZ) -+ { -+ n_channels = RTW_2G_CHANNELS_NUM; -+ n_bitrates = RTW_G_RATES_NUM; -+ } -+ else -+ { -+ goto exit; -+ } -+ -+ spt_band = (struct ieee80211_supported_band *)rtw_zmalloc( -+ sizeof(struct ieee80211_supported_band) -+ + sizeof(struct ieee80211_channel)*n_channels -+ + sizeof(struct ieee80211_rate)*n_bitrates -+ ); -+ if (!spt_band) -+ goto exit; -+ -+ spt_band->channels = (struct ieee80211_channel*)(((u8 *)spt_band)+sizeof(struct ieee80211_supported_band)); -+ spt_band->bitrates = (struct ieee80211_rate*)(((u8 *)spt_band->channels)+sizeof(struct ieee80211_channel)*n_channels); -+ spt_band->band = band; -+ spt_band->n_channels = n_channels; -+ spt_band->n_bitrates = n_bitrates; -+ -+ if (band == IEEE80211_BAND_2GHZ) -+ { -+ rtw_2g_channels_init(spt_band->channels); -+ rtw_2g_rates_init(spt_band->bitrates); -+ } -+ -+ /* spt_band.ht_cap */ -+ -+exit: -+ -+ return spt_band; -+} -+ -+static void rtw_spt_band_free(struct ieee80211_supported_band *spt_band) -+{ -+ u32 size = 0; -+ -+ if (!spt_band) -+ return; -+ -+ if (spt_band->band == IEEE80211_BAND_2GHZ) -+ { -+ size = sizeof(struct ieee80211_supported_band) -+ + sizeof(struct ieee80211_channel)*RTW_2G_CHANNELS_NUM -+ + sizeof(struct ieee80211_rate)*RTW_G_RATES_NUM; -+ } -+ kfree((u8 *)spt_band); -+} -+ -+static const struct ieee80211_txrx_stypes -+rtw_cfg80211_default_mgmt_stypes[NUM_NL80211_IFTYPES] = { -+ [NL80211_IFTYPE_ADHOC] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+ [NL80211_IFTYPE_STATION] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) -+ }, -+ [NL80211_IFTYPE_AP] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | -+ BIT(IEEE80211_STYPE_DISASSOC >> 4) | -+ BIT(IEEE80211_STYPE_AUTH >> 4) | -+ BIT(IEEE80211_STYPE_DEAUTH >> 4) | -+ BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+ [NL80211_IFTYPE_AP_VLAN] = { -+ /* copy AP */ -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | -+ BIT(IEEE80211_STYPE_DISASSOC >> 4) | -+ BIT(IEEE80211_STYPE_AUTH >> 4) | -+ BIT(IEEE80211_STYPE_DEAUTH >> 4) | -+ BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+ [NL80211_IFTYPE_P2P_CLIENT] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) -+ }, -+ [NL80211_IFTYPE_P2P_GO] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | -+ BIT(IEEE80211_STYPE_DISASSOC >> 4) | -+ BIT(IEEE80211_STYPE_AUTH >> 4) | -+ BIT(IEEE80211_STYPE_DEAUTH >> 4) | -+ BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+}; -+ -+static int rtw_ieee80211_channel_to_frequency(int chan, int band) -+{ -+ /* see 802.11 17.3.8.3.2 and Annex J -+ * there are overlapping channel numbers in 5GHz and 2GHz bands */ -+ if (band == IEEE80211_BAND_2GHZ) { -+ if (chan == 14) -+ return 2484; -+ else if (chan < 14) -+ return 2407 + chan * 5; -+ } -+ -+ return 0; /* not supported */ -+} -+ -+static u64 rtw_get_systime_us(void) -+{ -+ struct timespec ts; -+ get_monotonic_boottime(&ts); -+ return ((u64)ts.tv_sec*1000000) + ts.tv_nsec / 1000; -+} -+ -+#define MAX_BSSINFO_LEN 1000 -+struct cfg80211_bss *rtw_cfg80211_inform_bss(struct adapter *padapter, struct wlan_network *pnetwork) -+{ -+ struct ieee80211_channel *notify_channel; -+ struct cfg80211_bss *bss = NULL; -+ /* struct ieee80211_supported_band *band; */ -+ u16 channel; -+ u32 freq; -+ u64 notify_timestamp; -+ u16 notify_capability; -+ u16 notify_interval; -+ u8 *notify_ie; -+ size_t notify_ielen; -+ s32 notify_signal; -+ u8 *buf = NULL, *pbuf; -+ size_t len, bssinf_len = 0; -+ struct ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ struct wireless_dev *wdev = padapter->rtw_wdev; -+ struct wiphy *wiphy = wdev->wiphy; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ -+ /* DBG_8192C("%s\n", __func__); */ -+ -+ bssinf_len = pnetwork->network.IELength+sizeof (struct ieee80211_hdr_3addr); -+ if (bssinf_len > MAX_BSSINFO_LEN) { -+ DBG_871X("%s IE Length too long > %d byte\n", __func__, MAX_BSSINFO_LEN); -+ goto exit; -+ } -+ -+ { -+ u16 wapi_len = 0; -+ -+ if (rtw_get_wapi_ie(pnetwork->network.IEs, pnetwork->network.IELength, NULL, &wapi_len)>0) -+ { -+ if (wapi_len > 0) -+ { -+ DBG_871X("%s, no support wapi!\n", __func__); -+ goto exit; -+ } -+ } -+ } -+ -+ /* To reduce PBC Overlap rate */ -+ /* spin_lock_bh(&pwdev_priv->scan_req_lock); */ -+ if (adapter_wdev_data(padapter)->scan_request != NULL) -+ { -+ u8 *psr = NULL, sr = 0; -+ struct ndis_802_11_ssid *pssid = &pnetwork->network.Ssid; -+ struct cfg80211_scan_request *request = adapter_wdev_data(padapter)->scan_request; -+ struct cfg80211_ssid *ssids = request->ssids; -+ u32 wpsielen = 0; -+ u8 *wpsie = NULL; -+ -+ wpsie = rtw_get_wps_ie(pnetwork->network.IEs+_FIXED_IE_LENGTH_, pnetwork->network.IELength-_FIXED_IE_LENGTH_, NULL, &wpsielen); -+ -+ if (wpsie && wpsielen>0) -+ psr = rtw_get_wps_attr_content(wpsie, wpsielen, WPS_ATTR_SELECTED_REGISTRAR, (u8 *)(&sr), NULL); -+ -+ if (sr != 0) -+ { -+ if (request->n_ssids == 1 && request->n_channels == 1) /* it means under processing WPS */ -+ { -+ DBG_8192C("ssid =%s, len =%d\n", pssid->Ssid, pssid->SsidLength); -+ -+ if (ssids[0].ssid_len == 0) { -+ } -+ else if (pssid->SsidLength == ssids[0].ssid_len && -+ !memcmp(pssid->Ssid, ssids[0].ssid, ssids[0].ssid_len)) -+ { -+ DBG_871X("%s, got sr and ssid match!\n", __func__); -+ } -+ else -+ { -+ if (psr != NULL) -+ *psr = 0; /* clear sr */ -+ } -+ } -+ } -+ } -+ /* spin_unlock_bh(&pwdev_priv->scan_req_lock); */ -+ -+ -+ channel = pnetwork->network.Configuration.DSConfig; -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); -+ -+ notify_channel = ieee80211_get_channel(wiphy, freq); -+ -+ notify_timestamp = rtw_get_systime_us(); -+ -+ notify_interval = le16_to_cpu(*(__le16 *)rtw_get_beacon_interval_from_ie(pnetwork->network.IEs)); -+ notify_capability = le16_to_cpu(*(__le16 *)rtw_get_capability_from_ie(pnetwork->network.IEs)); -+ -+ notify_ie = pnetwork->network.IEs+_FIXED_IE_LENGTH_; -+ notify_ielen = pnetwork->network.IELength-_FIXED_IE_LENGTH_; -+ -+ /* We've set wiphy's signal_type as CFG80211_SIGNAL_TYPE_MBM: signal strength in mBm (100*dBm) */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true && -+ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { -+ notify_signal = 100*translate_percentage_to_dbm(padapter->recvpriv.signal_strength);/* dbm */ -+ } else { -+ notify_signal = 100*translate_percentage_to_dbm(pnetwork->network.PhyInfo.SignalStrength);/* dbm */ -+ } -+ -+ buf = kzalloc(MAX_BSSINFO_LEN, GFP_ATOMIC); -+ if (!buf) -+ goto exit; -+ pbuf = buf; -+ -+ pwlanhdr = (struct ieee80211_hdr *)pbuf; -+ fctrl = &(pwlanhdr->frame_control); -+ *(fctrl) = 0; -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ /* pmlmeext->mgnt_seq++; */ -+ -+ if (pnetwork->network.Reserved[0] == 1) { /* WIFI_BEACON */ -+ memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ SetFrameSubType(pbuf, WIFI_BEACON); -+ } else { -+ memcpy(pwlanhdr->addr1, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ SetFrameSubType(pbuf, WIFI_PROBERSP); -+ } -+ -+ memcpy(pwlanhdr->addr2, pnetwork->network.MacAddress, ETH_ALEN); -+ memcpy(pwlanhdr->addr3, pnetwork->network.MacAddress, ETH_ALEN); -+ -+ -+ pbuf += sizeof(struct ieee80211_hdr_3addr); -+ len = sizeof (struct ieee80211_hdr_3addr); -+ -+ memcpy(pbuf, pnetwork->network.IEs, pnetwork->network.IELength); -+ len += pnetwork->network.IELength; -+ -+ *((__le64*)pbuf) = cpu_to_le64(notify_timestamp); -+ -+ bss = cfg80211_inform_bss_frame(wiphy, notify_channel, (struct ieee80211_mgmt *)buf, -+ len, notify_signal, GFP_ATOMIC); -+ -+ if (unlikely(!bss)) { -+ DBG_8192C(FUNC_ADPT_FMT" bss NULL\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ -+ cfg80211_put_bss(wiphy, bss); -+ kfree(buf); -+ -+exit: -+ return bss; -+ -+} -+ -+/* -+ Check the given bss is valid by kernel API cfg80211_get_bss() -+ @padapter : the given adapter -+ -+ return true if bss is valid, false for not found. -+*/ -+int rtw_cfg80211_check_bss(struct adapter *padapter) -+{ -+ struct wlan_bssid_ex *pnetwork = &(padapter->mlmeextpriv.mlmext_info.network); -+ struct cfg80211_bss *bss = NULL; -+ struct ieee80211_channel *notify_channel = NULL; -+ u32 freq; -+ -+ if (!(pnetwork) || !(padapter->rtw_wdev)) -+ return false; -+ -+ freq = rtw_ieee80211_channel_to_frequency(pnetwork->Configuration.DSConfig, IEEE80211_BAND_2GHZ); -+ -+ notify_channel = ieee80211_get_channel(padapter->rtw_wdev->wiphy, freq); -+ bss = cfg80211_get_bss(padapter->rtw_wdev->wiphy, notify_channel, -+ pnetwork->MacAddress, pnetwork->Ssid.Ssid, -+ pnetwork->Ssid.SsidLength, -+ WLAN_CAPABILITY_ESS, WLAN_CAPABILITY_ESS); -+ -+ cfg80211_put_bss(padapter->rtw_wdev->wiphy, bss); -+ -+ return (bss!= NULL); -+} -+ -+void rtw_cfg80211_ibss_indicate_connect(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct wiphy *wiphy = pwdev->wiphy; -+ int freq = (int)cur_network->network.Configuration.DSConfig; -+ struct ieee80211_channel *chan; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ if (pwdev->iftype != NL80211_IFTYPE_ADHOC) -+ { -+ return; -+ } -+ -+ if (!rtw_cfg80211_check_bss(padapter)) { -+ struct wlan_bssid_ex *pnetwork = &(padapter->mlmeextpriv.mlmext_info.network); -+ struct wlan_network *scanned = pmlmepriv->cur_network_scanned; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) ==true) -+ { -+ -+ memcpy(&cur_network->network, pnetwork, sizeof(struct wlan_bssid_ex)); -+ if (!rtw_cfg80211_inform_bss(padapter, cur_network)) -+ DBG_871X(FUNC_ADPT_FMT" inform fail !!\n", FUNC_ADPT_ARG(padapter)); -+ else -+ DBG_871X(FUNC_ADPT_FMT" inform success !!\n", FUNC_ADPT_ARG(padapter)); -+ } -+ else -+ { -+ if (scanned == NULL) -+ rtw_warn_on(1); -+ -+ if (!memcmp(&(scanned->network.Ssid), &(pnetwork->Ssid), sizeof(struct ndis_802_11_ssid)) -+ && !memcmp(scanned->network.MacAddress, pnetwork->MacAddress, sizeof(NDIS_802_11_MAC_ADDRESS)) -+ ) { -+ if (!rtw_cfg80211_inform_bss(padapter, scanned)) { -+ DBG_871X(FUNC_ADPT_FMT" inform fail !!\n", FUNC_ADPT_ARG(padapter)); -+ } else { -+ /* DBG_871X(FUNC_ADPT_FMT" inform success !!\n", FUNC_ADPT_ARG(padapter)); */ -+ } -+ } else { -+ DBG_871X("scanned & pnetwork compare fail\n"); -+ rtw_warn_on(1); -+ } -+ } -+ -+ if (!rtw_cfg80211_check_bss(padapter)) -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" BSS not found !!\n", FUNC_ADPT_ARG(padapter)); -+ } -+ /* notify cfg80211 that device joined an IBSS */ -+ chan = ieee80211_get_channel(wiphy, freq); -+ cfg80211_ibss_joined(padapter->pnetdev, cur_network->network.MacAddress, chan, GFP_ATOMIC); -+} -+ -+void rtw_cfg80211_indicate_connect(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ if (pwdev->iftype != NL80211_IFTYPE_STATION -+ && pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT -+ ) { -+ return; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ return; -+ -+ { -+ struct wlan_bssid_ex *pnetwork = &(padapter->mlmeextpriv.mlmext_info.network); -+ struct wlan_network *scanned = pmlmepriv->cur_network_scanned; -+ -+ /* DBG_871X(FUNC_ADPT_FMT" BSS not found\n", FUNC_ADPT_ARG(padapter)); */ -+ -+ if (scanned == NULL) { -+ rtw_warn_on(1); -+ goto check_bss; -+ } -+ -+ if (!memcmp(scanned->network.MacAddress, pnetwork->MacAddress, sizeof(NDIS_802_11_MAC_ADDRESS)) -+ && !memcmp(&(scanned->network.Ssid), &(pnetwork->Ssid), sizeof(struct ndis_802_11_ssid)) -+ ) { -+ if (!rtw_cfg80211_inform_bss(padapter, scanned)) { -+ DBG_871X(FUNC_ADPT_FMT" inform fail !!\n", FUNC_ADPT_ARG(padapter)); -+ } else { -+ /* DBG_871X(FUNC_ADPT_FMT" inform success !!\n", FUNC_ADPT_ARG(padapter)); */ -+ } -+ } else { -+ DBG_871X("scanned: %s("MAC_FMT"), cur: %s("MAC_FMT")\n", -+ scanned->network.Ssid.Ssid, MAC_ARG(scanned->network.MacAddress), -+ pnetwork->Ssid.Ssid, MAC_ARG(pnetwork->MacAddress) -+ ); -+ rtw_warn_on(1); -+ } -+ } -+ -+check_bss: -+ if (!rtw_cfg80211_check_bss(padapter)) -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" BSS not found !!\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (rtw_to_roam(padapter) > 0) { -+ struct wiphy *wiphy = pwdev->wiphy; -+ struct ieee80211_channel *notify_channel; -+ u32 freq; -+ u16 channel = cur_network->network.Configuration.DSConfig; -+ -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); -+ -+ notify_channel = ieee80211_get_channel(wiphy, freq); -+ -+ DBG_871X(FUNC_ADPT_FMT" call cfg80211_roamed\n", FUNC_ADPT_ARG(padapter)); -+ cfg80211_roamed(padapter->pnetdev -+ , notify_channel -+ , cur_network->network.MacAddress -+ , pmlmepriv->assoc_req+sizeof(struct ieee80211_hdr_3addr)+2 -+ , pmlmepriv->assoc_req_len-sizeof(struct ieee80211_hdr_3addr)-2 -+ , pmlmepriv->assoc_rsp+sizeof(struct ieee80211_hdr_3addr)+6 -+ , pmlmepriv->assoc_rsp_len-sizeof(struct ieee80211_hdr_3addr)-6 -+ , GFP_ATOMIC); -+ } -+ else -+ { -+ cfg80211_connect_result(padapter->pnetdev, cur_network->network.MacAddress -+ , pmlmepriv->assoc_req+sizeof(struct ieee80211_hdr_3addr)+2 -+ , pmlmepriv->assoc_req_len-sizeof(struct ieee80211_hdr_3addr)-2 -+ , pmlmepriv->assoc_rsp+sizeof(struct ieee80211_hdr_3addr)+6 -+ , pmlmepriv->assoc_rsp_len-sizeof(struct ieee80211_hdr_3addr)-6 -+ , WLAN_STATUS_SUCCESS, GFP_ATOMIC); -+ } -+} -+ -+void rtw_cfg80211_indicate_disconnect(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (pwdev->iftype != NL80211_IFTYPE_STATION -+ && pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT -+ ) { -+ return; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ return; -+ -+ if (!padapter->mlmepriv.not_indic_disco) { -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0) -+ cfg80211_disconnected(padapter->pnetdev, 0, -+ NULL, 0, true, GFP_ATOMIC); -+#else -+ cfg80211_disconnected(padapter->pnetdev, 0, NULL, 0, GFP_ATOMIC); -+#endif -+ } else { -+ cfg80211_connect_result(padapter->pnetdev, NULL, NULL, 0, NULL, 0, -+ WLAN_STATUS_UNSPECIFIED_FAILURE, GFP_ATOMIC/*GFP_KERNEL*/); -+ } -+ } -+} -+ -+ -+static int rtw_cfg80211_ap_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len; -+ struct sta_info *psta = NULL, *pbcmc_sta = NULL; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv* psecuritypriv =&(padapter->securitypriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ if (param_len != sizeof(struct ieee_param) + param->u.crypt.key_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ if (param->u.crypt.idx >= WEP_KEYS) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ else -+ { -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if (!psta) -+ { -+ /* ret = -EINVAL; */ -+ DBG_8192C("rtw_set_encryption(), sta has already been removed or never been added\n"); -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "none") == 0 && (psta == NULL)) -+ { -+ /* todo:clear default encryption keys */ -+ -+ DBG_8192C("clear default encryption keys, keyid =%d\n", param->u.crypt.idx); -+ -+ goto exit; -+ } -+ -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0 && (psta == NULL)) -+ { -+ DBG_8192C("r871x_set_encryption, crypt.alg = WEP\n"); -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ DBG_8192C("r871x_set_encryption, wep_key_idx =%d, len =%d\n", wep_key_idx, wep_key_len); -+ -+ if ((wep_key_idx >= WEP_KEYS) || (wep_key_len<= 0)) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (wep_key_len > 0) -+ { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ } -+ -+ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) -+ { -+ /* wep default key has not been set, so use this key index as default key. */ -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ -+ if (wep_key_len == 13) -+ { -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; -+ } -+ -+ memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; -+ -+ rtw_ap_set_wep_key(padapter, param->u.crypt.key, wep_key_len, wep_key_idx, 1); -+ -+ goto exit; -+ -+ } -+ -+ -+ if (!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) /* group key */ -+ { -+ if (param->u.crypt.set_tx == 0) /* group key */ -+ { -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ DBG_8192C("%s, set group_key, WEP\n", __func__); -+ -+ memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ } -+ else if (strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ DBG_8192C("%s, set group_key, TKIP\n", __func__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ /* DEBUG_ERR("set key length :param->u.crypt.key_len =%d\n", param->u.crypt.key_len); */ -+ /* set mic key */ -+ memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = true; -+ -+ } -+ else if (strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ DBG_8192C("%s, set group_key, CCMP\n", __func__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ } -+ else -+ { -+ DBG_8192C("%s, set group_key, none\n", __func__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = true; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* */ -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta =rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta) -+ { -+ pbcmc_sta->ieee8021x_blocked = false; -+ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy;/* rx will use bmc_sta's dot118021XPrivacy */ -+ } -+ -+ } -+ -+ goto exit; -+ -+ } -+ -+ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) /* psk/802_1x */ -+ { -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ { -+ if (param->u.crypt.set_tx == 1) /* pairwise key */ -+ { -+ memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ DBG_8192C("%s, set pairwise key, WEP\n", __func__); -+ -+ psta->dot118021XPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ { -+ psta->dot118021XPrivacy = _WEP104_; -+ } -+ } -+ else if (strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ DBG_8192C("%s, set pairwise key, TKIP\n", __func__); -+ -+ psta->dot118021XPrivacy = _TKIP_; -+ -+ /* DEBUG_ERR("set key length :param->u.crypt.key_len =%d\n", param->u.crypt.key_len); */ -+ /* set mic key */ -+ memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = true; -+ -+ } -+ else if (strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ -+ DBG_8192C("%s, set pairwise key, CCMP\n", __func__); -+ -+ psta->dot118021XPrivacy = _AES_; -+ } -+ else -+ { -+ DBG_8192C("%s, set pairwise key, none\n", __func__); -+ -+ psta->dot118021XPrivacy = _NO_PRIVACY_; -+ } -+ -+ rtw_ap_set_pairwise_key(padapter, psta); -+ -+ psta->ieee8021x_blocked = false; -+ -+ psta->bpairwise_key_installed = true; -+ -+ } -+ else/* group key??? */ -+ { -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ } -+ else if (strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ /* DEBUG_ERR("set key length :param->u.crypt.key_len =%d\n", param->u.crypt.key_len); */ -+ /* set mic key */ -+ memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = true; -+ -+ } -+ else if (strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ } -+ else -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = true; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* */ -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta =rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta) -+ { -+ pbcmc_sta->ieee8021x_blocked = false; -+ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy;/* rx will use bmc_sta's dot118021XPrivacy */ -+ } -+ -+ } -+ -+ } -+ -+ } -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ if (param_len < (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ if (param->u.crypt.idx >= WEP_KEYS -+ && param->u.crypt.idx > BIP_MAX_KEYID -+ ) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } else { -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_err_, ("wpa_set_encryption, crypt.alg = WEP\n")); -+ DBG_8192C("wpa_set_encryption, crypt.alg = WEP\n"); -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ if ((wep_key_idx > WEP_KEYS) || (wep_key_len <= 0)) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) -+ { -+ /* wep default key has not been set, so use this key index as default key. */ -+ -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ -+ if (wep_key_len == 13) -+ { -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; -+ } -+ -+ memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; -+ -+ rtw_set_key(padapter, psecuritypriv, wep_key_idx, 0, true); -+ -+ goto exit; -+ } -+ -+ if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) /* 802_1x */ -+ { -+ struct sta_info * psta,*pbcmc_sta; -+ struct sta_priv * pstapriv = &padapter->stapriv; -+ -+ /* DBG_8192C("%s, : dot11AuthAlgrthm == dot11AuthAlgrthm_8021X\n", __func__); */ -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == true) /* sta mode */ -+ { -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ /* DEBUG_ERR(("Set wpa_set_encryption: Obtain Sta_info fail\n")); */ -+ DBG_8192C("%s, : Obtain Sta_info fail\n", __func__); -+ } -+ else -+ { -+ /* Jeff: don't disable ieee8021x_blocked while clearing key */ -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ psta->ieee8021x_blocked = false; -+ -+ -+ if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ { -+ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ -+ if (param->u.crypt.set_tx == 1)/* pairwise key */ -+ { -+ -+ DBG_8192C("%s, : param->u.crypt.set_tx == 1\n", __func__); -+ -+ memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ if (strcmp(param->u.crypt.alg, "TKIP") == 0)/* set mic key */ -+ { -+ /* DEBUG_ERR(("\nset key length :param->u.crypt.key_len =%d\n", param->u.crypt.key_len)); */ -+ memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ padapter->securitypriv.busetkipkey =false; -+ /* _set_timer(&padapter->securitypriv.tkip_timer, 50); */ -+ } -+ -+ /* DEBUG_ERR((" param->u.crypt.key_len =%d\n", param->u.crypt.key_len)); */ -+ DBG_871X(" ~~~~set sta key:unicastkey\n"); -+ -+ rtw_setstakey_cmd(padapter, psta, true, true); -+ } -+ else/* group key */ -+ { -+ if (strcmp(param->u.crypt.alg, "TKIP") == 0 || strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[16]), 8); -+ memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[24]), 8); -+ padapter->securitypriv.binstallGrpkey = true; -+ /* DEBUG_ERR((" param->u.crypt.key_len =%d\n", param->u.crypt.key_len)); */ -+ DBG_871X(" ~~~~set sta key:groupkey\n"); -+ -+ padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; -+ rtw_set_key(padapter,&padapter->securitypriv, param->u.crypt.idx, 1, true); -+ } -+ else if (strcmp(param->u.crypt.alg, "BIP") == 0) -+ { -+ /* DBG_871X("BIP key_len =%d , index =%d @@@@@@@@@@@@@@@@@@\n", param->u.crypt.key_len, param->u.crypt.idx); */ -+ /* save the IGTK key, length 16 bytes */ -+ memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ /*DBG_871X("IGTK key below:\n"); -+ for (no = 0;no<16;no++) -+ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); -+ DBG_871X("\n");*/ -+ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; -+ padapter->securitypriv.binstallBIPkey = true; -+ DBG_871X(" ~~~~set sta key:IGKT\n"); -+ } -+ } -+ } -+ -+ pbcmc_sta =rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta == NULL) -+ { -+ /* DEBUG_ERR(("Set OID_802_11_ADD_KEY: bcmc stainfo is null\n")); */ -+ } -+ else -+ { -+ /* Jeff: don't disable ieee8021x_blocked while clearing key */ -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ pbcmc_sta->ieee8021x_blocked = false; -+ -+ if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ { -+ pbcmc_sta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ } -+ } -+ else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) /* adhoc mode */ -+ { -+ } -+ } -+ -+exit: -+ -+ DBG_8192C("%s, ret =%d\n", __func__, ret); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_add_key(struct wiphy *wiphy, struct net_device *ndev, -+ u8 key_index, bool pairwise, const u8 *mac_addr, -+ struct key_params *params) -+{ -+ char *alg_name; -+ u32 param_len; -+ struct ieee_param *param = NULL; -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ DBG_871X(FUNC_NDEV_FMT" adding key for %pM\n", FUNC_NDEV_ARG(ndev), mac_addr); -+ DBG_871X("cipher = 0x%x\n", params->cipher); -+ DBG_871X("key_len = 0x%x\n", params->key_len); -+ DBG_871X("seq_len = 0x%x\n", params->seq_len); -+ DBG_871X("key_index =%d\n", key_index); -+ DBG_871X("pairwise =%d\n", pairwise); -+ -+ param_len = sizeof(struct ieee_param) + params->key_len; -+ param = (struct ieee_param *)rtw_malloc(param_len); -+ if (param == NULL) -+ return -1; -+ -+ memset(param, 0, param_len); -+ -+ param->cmd = IEEE_CMD_SET_ENCRYPTION; -+ memset(param->sta_addr, 0xff, ETH_ALEN); -+ -+ switch (params->cipher) { -+ case IW_AUTH_CIPHER_NONE: -+ /* todo: remove key */ -+ /* remove = 1; */ -+ alg_name = "none"; -+ break; -+ case WLAN_CIPHER_SUITE_WEP40: -+ case WLAN_CIPHER_SUITE_WEP104: -+ alg_name = "WEP"; -+ break; -+ case WLAN_CIPHER_SUITE_TKIP: -+ alg_name = "TKIP"; -+ break; -+ case WLAN_CIPHER_SUITE_CCMP: -+ alg_name = "CCMP"; -+ break; -+ case WLAN_CIPHER_SUITE_AES_CMAC: -+ alg_name = "BIP"; -+ break; -+ default: -+ ret = -ENOTSUPP; -+ goto addkey_end; -+ } -+ -+ strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN); -+ -+ -+ if (!mac_addr || is_broadcast_ether_addr(mac_addr)) -+ { -+ param->u.crypt.set_tx = 0; /* for wpa/wpa2 group key */ -+ } else { -+ param->u.crypt.set_tx = 1; /* for wpa/wpa2 pairwise key */ -+ } -+ -+ param->u.crypt.idx = key_index; -+ -+ if (params->seq_len && params->seq) -+ { -+ memcpy(param->u.crypt.seq, (u8 *)params->seq, params->seq_len); -+ } -+ -+ if (params->key_len && params->key) -+ { -+ param->u.crypt.key_len = params->key_len; -+ memcpy(param->u.crypt.key, (u8 *)params->key, params->key_len); -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) -+ { -+ ret = rtw_cfg80211_set_encryption(ndev, param, param_len); -+ } -+ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ if (mac_addr) -+ memcpy(param->sta_addr, (void*)mac_addr, ETH_ALEN); -+ -+ ret = rtw_cfg80211_ap_set_encryption(ndev, param, param_len); -+ } -+ else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true -+ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) -+ { -+ /* DBG_8192C("@@@@@@@@@@ fw_state = 0x%x, iftype =%d\n", pmlmepriv->fw_state, rtw_wdev->iftype); */ -+ ret = rtw_cfg80211_set_encryption(ndev, param, param_len); -+ } -+ else -+ { -+ DBG_8192C("error!\n"); -+ -+ } -+ -+addkey_end: -+ if (param) -+ { -+ kfree((u8 *)param); -+ } -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_get_key(struct wiphy *wiphy, struct net_device *ndev, -+ u8 key_index, bool pairwise, const u8 *mac_addr, -+ void *cookie, -+ void (*callback)(void *cookie, -+ struct key_params*)) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+static int cfg80211_rtw_del_key(struct wiphy *wiphy, struct net_device *ndev, -+ u8 key_index, bool pairwise, const u8 *mac_addr) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ DBG_871X(FUNC_NDEV_FMT" key_index =%d\n", FUNC_NDEV_ARG(ndev), key_index); -+ -+ if (key_index == psecuritypriv->dot11PrivacyKeyIndex) -+ { -+ /* clear the flag of wep default key set. */ -+ psecuritypriv->bWepDefaultKeyIdxSet = 0; -+ } -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_set_default_key(struct wiphy *wiphy, -+ struct net_device *ndev, u8 key_index -+ , bool unicast, bool multicast -+ ) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ DBG_871X(FUNC_NDEV_FMT" key_index =%d" -+ ", unicast =%d, multicast =%d" -+ ".\n", FUNC_NDEV_ARG(ndev), key_index -+ , unicast, multicast -+ ); -+ -+ if ((key_index < WEP_KEYS) && ((psecuritypriv->dot11PrivacyAlgrthm == _WEP40_) || (psecuritypriv->dot11PrivacyAlgrthm == _WEP104_))) /* set wep default key */ -+ { -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+ psecuritypriv->dot11PrivacyKeyIndex = key_index; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if (psecuritypriv->dot11DefKeylen[key_index] == 13) -+ { -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ psecuritypriv->bWepDefaultKeyIdxSet = 1; /* set the flag to represent that wep default key has been set */ -+ } -+ -+ return 0; -+ -+} -+ -+static int cfg80211_rtw_get_station(struct wiphy *wiphy, -+ struct net_device *ndev, -+ const u8 *mac, -+ struct station_info *sinfo) -+{ -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ sinfo->filled = 0; -+ -+ if (!mac) { -+ DBG_871X(FUNC_NDEV_FMT" mac ==%p\n", FUNC_NDEV_ARG(ndev), mac); -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ psta = rtw_get_stainfo(pstapriv, (u8 *)mac); -+ if (psta == NULL) { -+ DBG_8192C("%s, sta_info is null\n", __func__); -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X(FUNC_NDEV_FMT" mac ="MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(mac)); -+#endif -+ -+ /* for infra./P2PClient mode */ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, _FW_LINKED) -+ ) -+ { -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ -+ if (memcmp((u8 *)mac, cur_network->network.MacAddress, ETH_ALEN)) { -+ DBG_871X("%s, mismatch bssid ="MAC_FMT"\n", __func__, MAC_ARG(cur_network->network.MacAddress)); -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ sinfo->filled |= BIT(NL80211_STA_INFO_SIGNAL); -+ sinfo->signal = translate_percentage_to_dbm(padapter->recvpriv.signal_strength); -+ -+ sinfo->filled |= BIT(NL80211_STA_INFO_TX_BITRATE); -+ sinfo->txrate.legacy = rtw_get_cur_max_rate(padapter); -+ -+ sinfo->filled |= BIT(NL80211_STA_INFO_RX_PACKETS); -+ sinfo->rx_packets = sta_rx_data_pkts(psta); -+ -+ sinfo->filled |= BIT(NL80211_STA_INFO_TX_PACKETS); -+ sinfo->tx_packets = psta->sta_stats.tx_pkts; -+ -+ } -+ -+ /* for Ad-Hoc/AP mode */ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) -+ ||check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) -+ ||check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ && check_fwstate(pmlmepriv, _FW_LINKED) -+ ) -+ { -+ /* TODO: should acquire station info... */ -+ } -+ -+exit: -+ return ret; -+} -+ -+extern int netdev_open(struct net_device *pnetdev); -+ -+static int cfg80211_rtw_change_iface(struct wiphy *wiphy, -+ struct net_device *ndev, -+ enum nl80211_iftype type, u32 *flags, -+ struct vif_params *params) -+{ -+ enum nl80211_iftype old_type; -+ enum NDIS_802_11_NETWORK_INFRASTRUCTURE networkType; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct wireless_dev *rtw_wdev = padapter->rtw_wdev; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ int ret = 0; -+ u8 change = false; -+ -+ DBG_871X(FUNC_NDEV_FMT" type =%d\n", FUNC_NDEV_ARG(ndev), type); -+ -+ if (adapter_to_dvobj(padapter)->processing_dev_remove == true) -+ { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ { -+ DBG_871X(FUNC_NDEV_FMT" call netdev_open\n", FUNC_NDEV_ARG(ndev)); -+ if (netdev_open(ndev) != 0) { -+ DBG_871X(FUNC_NDEV_FMT" call netdev_open fail\n", FUNC_NDEV_ARG(ndev)); -+ ret = -EPERM; -+ goto exit; -+ } -+ } -+ -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ DBG_871X(FUNC_NDEV_FMT" call rtw_pwr_wakeup fail\n", FUNC_NDEV_ARG(ndev)); -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ old_type = rtw_wdev->iftype; -+ DBG_871X(FUNC_NDEV_FMT" old_iftype =%d, new_iftype =%d\n", -+ FUNC_NDEV_ARG(ndev), old_type, type); -+ -+ if (old_type != type) -+ { -+ change = true; -+ pmlmeext->action_public_rxseq = 0xffff; -+ pmlmeext->action_public_dialog_token = 0xff; -+ } -+ -+ switch (type) { -+ case NL80211_IFTYPE_ADHOC: -+ networkType = Ndis802_11IBSS; -+ break; -+ case NL80211_IFTYPE_STATION: -+ networkType = Ndis802_11Infrastructure; -+ break; -+ case NL80211_IFTYPE_AP: -+ networkType = Ndis802_11APMode; -+ break; -+ default: -+ ret = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+ rtw_wdev->iftype = type; -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, networkType) ==false) -+ { -+ rtw_wdev->iftype = old_type; -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ rtw_setopmode_cmd(padapter, networkType, true); -+ -+exit: -+ -+ DBG_871X(FUNC_NDEV_FMT" ret:%d\n", FUNC_NDEV_ARG(ndev), ret); -+ return ret; -+} -+ -+void rtw_cfg80211_indicate_scan_done(struct adapter *adapter, bool aborted) -+{ -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 8, 0)) -+ struct cfg80211_scan_info info = { -+ .aborted = aborted -+ }; -+#endif -+ -+ spin_lock_bh(&pwdev_priv->scan_req_lock); -+ if (pwdev_priv->scan_request != NULL) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("%s with scan req\n", __func__); -+ #endif -+ -+ /* avoid WARN_ON(request != wiphy_to_dev(request->wiphy)->scan_req); */ -+ if (pwdev_priv->scan_request->wiphy != pwdev_priv->rtw_wdev->wiphy) -+ { -+ DBG_8192C("error wiphy compare\n"); -+ } -+ else -+ { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 8, 0)) -+ cfg80211_scan_done(pwdev_priv->scan_request, &info); -+#else -+ cfg80211_scan_done(pwdev_priv->scan_request, aborted); -+#endif -+ } -+ -+ pwdev_priv->scan_request = NULL; -+ } else { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("%s without scan req\n", __func__); -+ #endif -+ } -+ spin_unlock_bh(&pwdev_priv->scan_req_lock); -+} -+ -+void rtw_cfg80211_unlink_bss(struct adapter *padapter, struct wlan_network *pnetwork) -+{ -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct wiphy *wiphy = pwdev->wiphy; -+ struct cfg80211_bss *bss = NULL; -+ struct wlan_bssid_ex select_network = pnetwork->network; -+ -+ bss = cfg80211_get_bss(wiphy, NULL/*notify_channel*/, -+ select_network.MacAddress, select_network.Ssid.Ssid, -+ select_network.Ssid.SsidLength, 0/*WLAN_CAPABILITY_ESS*/, -+ 0/*WLAN_CAPABILITY_ESS*/); -+ -+ if (bss) { -+ cfg80211_unlink_bss(wiphy, bss); -+ DBG_8192C("%s(): cfg80211_unlink %s!! () ", __func__, select_network.Ssid.Ssid); -+ cfg80211_put_bss(padapter->rtw_wdev->wiphy, bss); -+ } -+ return; -+} -+ -+void rtw_cfg80211_surveydone_event_callback(struct adapter *padapter) -+{ -+ struct list_head *plist, *phead; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct __queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s\n", __func__); -+#endif -+ -+ spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) -+ { -+ if (phead == plist) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ /* report network only if the current channel set contains the channel to which this network belongs */ -+ if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 -+ && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == true -+ && true == rtw_validate_ssid(&(pnetwork->network.Ssid)) -+ ) -+ { -+ /* ev =translate_scan(padapter, a, pnetwork, ev, stop); */ -+ rtw_cfg80211_inform_bss(padapter, pnetwork); -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+} -+ -+static int rtw_cfg80211_set_probe_req_wpsp2pie(struct adapter *padapter, char *buf, int len) -+{ -+ int ret = 0; -+ uint wps_ielen = 0; -+ u8 *wps_ie; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ielen =%d\n", __func__, len); -+#endif -+ -+ if (len>0) -+ { -+ if ((wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen))) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("probe_req_wps_ielen =%d\n", wps_ielen); -+ #endif -+ -+ if (pmlmepriv->wps_probe_req_ie) -+ { -+ pmlmepriv->wps_probe_req_ie_len = 0; -+ kfree(pmlmepriv->wps_probe_req_ie); -+ pmlmepriv->wps_probe_req_ie = NULL; -+ } -+ -+ pmlmepriv->wps_probe_req_ie = rtw_malloc(wps_ielen); -+ if (pmlmepriv->wps_probe_req_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __func__, __LINE__); -+ return -EINVAL; -+ -+ } -+ memcpy(pmlmepriv->wps_probe_req_ie, wps_ie, wps_ielen); -+ pmlmepriv->wps_probe_req_ie_len = wps_ielen; -+ } -+ } -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_scan(struct wiphy *wiphy -+ , struct cfg80211_scan_request *request) -+{ -+ struct net_device *ndev = wdev_to_ndev(request->wdev); -+ int i; -+ u8 _status = false; -+ int ret = 0; -+ struct ndis_802_11_ssid ssid[RTW_SSID_SCAN_AMOUNT]; -+ struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; -+ u8 survey_times =3; -+ u8 survey_times_for_one_ch =6; -+ struct cfg80211_ssid *ssids = request->ssids; -+ int j = 0; -+ bool need_indicate_scan_done = false; -+ -+ struct adapter *padapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ struct mlme_priv *pmlmepriv; -+ -+ if (ndev == NULL) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(padapter); -+ pmlmepriv = &padapter->mlmepriv; -+ -+/* ifdef CONFIG_DEBUG_CFG80211 */ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+/* endif */ -+ -+ spin_lock_bh(&pwdev_priv->scan_req_lock); -+ pwdev_priv->scan_request = request; -+ spin_unlock_bh(&pwdev_priv->scan_req_lock); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("%s under WIFI_AP_STATE\n", __func__); -+#endif -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS|_FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) -+ { -+ DBG_8192C("%s, fwstate = 0x%x\n", __func__, pmlmepriv->fw_state); -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) -+ { -+ DBG_8192C("AP mode process WPS\n"); -+ } -+ -+ need_indicate_scan_done = true; -+ goto check_need_indicate_scan_done; -+ } -+ } -+ -+ rtw_ps_deny(padapter, PS_DENY_SCAN); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ need_indicate_scan_done = true; -+ goto check_need_indicate_scan_done; -+ } -+ -+ if (request->ie && request->ie_len>0) -+ { -+ rtw_cfg80211_set_probe_req_wpsp2pie(padapter, (u8 *)request->ie, request->ie_len); -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { -+ DBG_8192C("%s, fwstate = 0x%x\n", __func__, pmlmepriv->fw_state); -+ need_indicate_scan_done = true; -+ goto check_need_indicate_scan_done; -+ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) { -+ DBG_8192C("%s, fwstate = 0x%x\n", __func__, pmlmepriv->fw_state); -+ ret = -EBUSY; -+ goto check_need_indicate_scan_done; -+ } -+ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == true) -+ { -+ static unsigned long lastscantime = 0; -+ unsigned long passtime; -+ -+ passtime = jiffies_to_msecs(jiffies - lastscantime); -+ lastscantime = jiffies; -+ if (passtime > 12000) -+ { -+ DBG_871X("%s: bBusyTraffic == true\n", __func__); -+ need_indicate_scan_done = true; -+ goto check_need_indicate_scan_done; -+ } -+ } -+ -+ if (rtw_is_scan_deny(padapter)) { -+ DBG_871X(FUNC_ADPT_FMT ": scan deny\n", FUNC_ADPT_ARG(padapter)); -+ need_indicate_scan_done = true; -+ goto check_need_indicate_scan_done; -+ } -+ -+ memset(ssid, 0, sizeof(struct ndis_802_11_ssid)*RTW_SSID_SCAN_AMOUNT); -+ /* parsing request ssids, n_ssids */ -+ for (i = 0; i < request->n_ssids && i < RTW_SSID_SCAN_AMOUNT; i++) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("ssid =%s, len =%d\n", ssids[i].ssid, ssids[i].ssid_len); -+ #endif -+ memcpy(ssid[i].Ssid, ssids[i].ssid, ssids[i].ssid_len); -+ ssid[i].SsidLength = ssids[i].ssid_len; -+ } -+ -+ /* parsing channels, n_channels */ -+ memset(ch, 0, sizeof(struct rtw_ieee80211_channel)*RTW_CHANNEL_SCAN_AMOUNT); -+ for (i = 0;in_channels && ichannels[i])); -+ #endif -+ ch[i].hw_value = request->channels[i]->hw_value; -+ ch[i].flags = request->channels[i]->flags; -+ } -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ if (request->n_channels == 1) { -+ for (i = 1;in_channels <= 4) { -+ for (j =request->n_channels-1;j>= 0;j--) -+ for (i = 0;in_channels); -+ } else { -+ _status = rtw_sitesurvey_cmd(padapter, ssid, RTW_SSID_SCAN_AMOUNT, NULL, 0); -+ } -+ spin_unlock_bh(&pmlmepriv->lock); -+ -+ -+ if (_status == false) -+ { -+ ret = -1; -+ } -+ -+check_need_indicate_scan_done: -+ if (true == need_indicate_scan_done) -+ { -+ rtw_cfg80211_surveydone_event_callback(padapter); -+ rtw_cfg80211_indicate_scan_done(padapter, false); -+ } -+ -+ rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); -+ -+exit: -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_set_wiphy_params(struct wiphy *wiphy, u32 changed) -+{ -+ DBG_8192C("%s\n", __func__); -+ return 0; -+} -+ -+ -+ -+static int rtw_cfg80211_set_wpa_version(struct security_priv *psecuritypriv, u32 wpa_version) -+{ -+ DBG_8192C("%s, wpa_version =%d\n", __func__, wpa_version); -+ -+ if (!wpa_version) { -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ return 0; -+ } -+ -+ -+ if (wpa_version & (NL80211_WPA_VERSION_1 | NL80211_WPA_VERSION_2)) -+ { -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPAPSK; -+ } -+ -+ return 0; -+ -+} -+ -+static int rtw_cfg80211_set_auth_type(struct security_priv *psecuritypriv, -+ enum nl80211_auth_type sme_auth_type) -+{ -+ DBG_8192C("%s, nl80211_auth_type =%d\n", __func__, sme_auth_type); -+ -+ -+ switch (sme_auth_type) { -+ case NL80211_AUTHTYPE_AUTOMATIC: -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ -+ break; -+ case NL80211_AUTHTYPE_OPEN_SYSTEM: -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ -+ if (psecuritypriv->ndisauthtype>Ndis802_11AuthModeWPA) -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ -+ break; -+ case NL80211_AUTHTYPE_SHARED_KEY: -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+ -+ break; -+ default: -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ /* return -ENOTSUPP; */ -+ } -+ -+ return 0; -+ -+} -+ -+static int rtw_cfg80211_set_cipher(struct security_priv *psecuritypriv, u32 cipher, bool ucast) -+{ -+ u32 ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ -+ u32 *profile_cipher = ucast ? &psecuritypriv->dot11PrivacyAlgrthm : -+ &psecuritypriv->dot118021XGrpPrivacy; -+ -+ DBG_8192C("%s, ucast =%d, cipher = 0x%x\n", __func__, ucast, cipher); -+ -+ -+ if (!cipher) { -+ *profile_cipher = _NO_PRIVACY_; -+ psecuritypriv->ndisencryptstatus = ndisencryptstatus; -+ return 0; -+ } -+ -+ switch (cipher) { -+ case IW_AUTH_CIPHER_NONE: -+ *profile_cipher = _NO_PRIVACY_; -+ ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ break; -+ case WLAN_CIPHER_SUITE_WEP40: -+ *profile_cipher = _WEP40_; -+ ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WLAN_CIPHER_SUITE_WEP104: -+ *profile_cipher = _WEP104_; -+ ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WLAN_CIPHER_SUITE_TKIP: -+ *profile_cipher = _TKIP_; -+ ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WLAN_CIPHER_SUITE_CCMP: -+ *profile_cipher = _AES_; -+ ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ default: -+ DBG_8192C("Unsupported cipher: 0x%x\n", cipher); -+ return -ENOTSUPP; -+ } -+ -+ if (ucast) -+ { -+ psecuritypriv->ndisencryptstatus = ndisencryptstatus; -+ -+ /* if (psecuritypriv->dot11PrivacyAlgrthm >= _AES_) */ -+ /* psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPA2PSK; */ -+ } -+ -+ return 0; -+} -+ -+static int rtw_cfg80211_set_key_mgt(struct security_priv *psecuritypriv, u32 key_mgt) -+{ -+ DBG_8192C("%s, key_mgt = 0x%x\n", __func__, key_mgt); -+ -+ if (key_mgt == WLAN_AKM_SUITE_8021X) -+ /* auth_type = UMAC_AUTH_TYPE_8021X; */ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ else if (key_mgt == WLAN_AKM_SUITE_PSK) { -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ } -+ else { -+ DBG_8192C("Invalid key mgt: 0x%x\n", key_mgt); -+ /* return -EINVAL; */ -+ } -+ -+ return 0; -+} -+ -+static int rtw_cfg80211_set_wpa_ie(struct adapter *padapter, u8 *pie, size_t ielen) -+{ -+ u8 *buf = NULL, *pos = NULL; -+ int group_cipher = 0, pairwise_cipher = 0; -+ int ret = 0; -+ int wpa_ielen = 0; -+ int wpa2_ielen = 0; -+ u8 *pwpa, *pwpa2; -+ u8 null_addr[]= {0, 0, 0, 0, 0, 0}; -+ -+ if (pie == NULL || !ielen) { -+ /* Treat this as normal case, but need to clear WIFI_UNDER_WPS */ -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ goto exit; -+ } -+ -+ if (ielen > MAX_WPA_IE_LEN+MAX_WPS_IE_LEN+MAX_P2P_IE_LEN) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ buf = rtw_zmalloc(ielen); -+ if (buf == NULL) { -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ memcpy(buf, pie , ielen); -+ -+ /* dump */ -+ { -+ int i; -+ DBG_8192C("set wpa_ie(length:%zu):\n", ielen); -+ for (i = 0;i0) -+ { -+ if (rtw_parse_wpa_ie(pwpa, wpa_ielen+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype =Ndis802_11AuthModeWPAPSK; -+ memcpy(padapter->securitypriv.supplicant_ie, &pwpa[0], wpa_ielen+2); -+ -+ DBG_8192C("got wpa_ie, wpa_ielen:%u\n", wpa_ielen); -+ } -+ } -+ -+ pwpa2 = rtw_get_wpa2_ie(buf, &wpa2_ielen, ielen); -+ if (pwpa2 && wpa2_ielen>0) -+ { -+ if (rtw_parse_wpa2_ie(pwpa2, wpa2_ielen+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype =Ndis802_11AuthModeWPA2PSK; -+ memcpy(padapter->securitypriv.supplicant_ie, &pwpa2[0], wpa2_ielen+2); -+ -+ DBG_8192C("got wpa2_ie, wpa2_ielen:%u\n", wpa2_ielen); -+ } -+ } -+ -+ if (group_cipher == 0) -+ { -+ group_cipher = WPA_CIPHER_NONE; -+ } -+ if (pairwise_cipher == 0) -+ { -+ pairwise_cipher = WPA_CIPHER_NONE; -+ } -+ -+ switch (group_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus =Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot118021XGrpPrivacy = _TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot118021XGrpPrivacy = _AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ switch (pairwise_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus =Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ {/* handle wps_ie */ -+ uint wps_ielen; -+ u8 *wps_ie; -+ -+ wps_ie = rtw_get_wps_ie(buf, ielen, NULL, &wps_ielen); -+ if (wps_ie && wps_ielen > 0) { -+ DBG_8192C("got wps_ie, wps_ielen:%u\n", wps_ielen); -+ padapter->securitypriv.wps_ie_len = wps_ielensecuritypriv.wps_ie, wps_ie, padapter->securitypriv.wps_ie_len); -+ set_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ } else { -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ } -+ } -+ -+ /* TKIP and AES disallow multicast packets until installing group key */ -+ if (padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) -+ /* WPS open need to enable multicast */ -+ /* check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == true) */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_OFF_RCR_AM, null_addr); -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("rtw_set_wpa_ie: pairwise_cipher = 0x%08x padapter->securitypriv.ndisencryptstatus =%d padapter->securitypriv.ndisauthtype =%d\n", -+ pairwise_cipher, padapter->securitypriv.ndisencryptstatus, padapter->securitypriv.ndisauthtype)); -+ -+exit: -+ if (buf) -+ kfree(buf); -+ if (ret) -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ return ret; -+} -+ -+static int cfg80211_rtw_join_ibss(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_ibss_params *params) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct ndis_802_11_ssid ndis_ssid; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ int ret = 0; -+ -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ if (!params->ssid || !params->ssid_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (params->ssid_len > IW_ESSID_MAX_SIZE) { -+ -+ ret = -E2BIG; -+ goto exit; -+ } -+ -+ memset(&ndis_ssid, 0, sizeof(struct ndis_802_11_ssid)); -+ ndis_ssid.SsidLength = params->ssid_len; -+ memcpy(ndis_ssid.Ssid, (u8 *)params->ssid, params->ssid_len); -+ -+ /* DBG_8192C("ssid =%s, len =%zu\n", ndis_ssid.Ssid, params->ssid_len); */ -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ -+ ret = rtw_cfg80211_set_auth_type(psecuritypriv, NL80211_AUTHTYPE_OPEN_SYSTEM); -+ rtw_set_802_11_authentication_mode(padapter, psecuritypriv->ndisauthtype); -+ -+ if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == false) -+ { -+ ret = -1; -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+static int cfg80211_rtw_leave_ibss(struct wiphy *wiphy, struct net_device *ndev) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct wireless_dev *rtw_wdev = padapter->rtw_wdev; -+ enum nl80211_iftype old_type; -+ int ret = 0; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ padapter->mlmepriv.not_indic_disco = true; -+ -+ old_type = rtw_wdev->iftype; -+ -+ rtw_set_to_roam(padapter, 0); -+ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) -+ { -+ rtw_scan_abort(padapter); -+ LeaveAllPowerSaveMode(padapter); -+ -+ rtw_wdev->iftype = NL80211_IFTYPE_STATION; -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, Ndis802_11Infrastructure) ==false) -+ { -+ rtw_wdev->iftype = old_type; -+ ret = -EPERM; -+ goto leave_ibss; -+ } -+ rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure, true); -+ } -+ -+leave_ibss: -+ padapter->mlmepriv.not_indic_disco = false; -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_connect_params *sme) -+{ -+ int ret = 0; -+ enum NDIS_802_11_AUTHENTICATION_MODE authmode; -+ struct ndis_802_11_ssid ndis_ssid; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ padapter->mlmepriv.not_indic_disco = true; -+ -+ DBG_871X("=>"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ DBG_871X("privacy =%d, key =%p, key_len =%d, key_idx =%d\n", -+ sme->privacy, sme->key, sme->key_len, sme->key_idx); -+ -+ -+ if (adapter_wdev_data(padapter)->block == true) -+ { -+ ret = -EBUSY; -+ DBG_871X("%s wdev_priv.block is set\n", __func__); -+ goto exit; -+ } -+ -+ rtw_ps_deny(padapter, PS_DENY_JOIN); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ if (!sme->ssid || !sme->ssid_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (sme->ssid_len > IW_ESSID_MAX_SIZE) { -+ -+ ret = -E2BIG; -+ goto exit; -+ } -+ -+ memset(&ndis_ssid, 0, sizeof(struct ndis_802_11_ssid)); -+ ndis_ssid.SsidLength = sme->ssid_len; -+ memcpy(ndis_ssid.Ssid, (u8 *)sme->ssid, sme->ssid_len); -+ -+ DBG_8192C("ssid =%s, len =%zu\n", ndis_ssid.Ssid, sme->ssid_len); -+ -+ -+ if (sme->bssid) -+ DBG_8192C("bssid ="MAC_FMT"\n", MAC_ARG(sme->bssid)); -+ -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) { -+ ret = -EBUSY; -+ DBG_8192C("%s, fw_state = 0x%x, goto exit\n", __func__, pmlmepriv->fw_state); -+ goto exit; -+ } -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { -+ rtw_scan_abort(padapter); -+ } -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ -+ ret = rtw_cfg80211_set_wpa_version(psecuritypriv, sme->crypto.wpa_versions); -+ if (ret < 0) -+ goto exit; -+ -+ ret = rtw_cfg80211_set_auth_type(psecuritypriv, sme->auth_type); -+ -+ if (ret < 0) -+ goto exit; -+ -+ DBG_8192C("%s, ie_len =%zu\n", __func__, sme->ie_len); -+ -+ ret = rtw_cfg80211_set_wpa_ie(padapter, (u8 *)sme->ie, sme->ie_len); -+ if (ret < 0) -+ goto exit; -+ -+ if (sme->crypto.n_ciphers_pairwise) { -+ ret = rtw_cfg80211_set_cipher(psecuritypriv, sme->crypto.ciphers_pairwise[0], true); -+ if (ret < 0) -+ goto exit; -+ } -+ -+ /* For WEP Shared auth */ -+ if ((psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_Shared -+ || psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_Auto) && sme->key -+ ) -+ { -+ u32 wep_key_idx, wep_key_len, wep_total_len; -+ struct ndis_802_11_wep *pwep = NULL; -+ DBG_871X("%s(): Shared/Auto WEP\n", __func__); -+ -+ wep_key_idx = sme->key_idx; -+ wep_key_len = sme->key_len; -+ -+ if (sme->key_idx > WEP_KEYS) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (wep_key_len > 0) -+ { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ wep_total_len = wep_key_len + FIELD_OFFSET(struct ndis_802_11_wep, KeyMaterial); -+ pwep =(struct ndis_802_11_wep *) rtw_malloc(wep_total_len); -+ if (pwep == NULL) { -+ DBG_871X(" wpa_set_encryption: pwep allocate fail !!!\n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ memset(pwep, 0, wep_total_len); -+ -+ pwep->KeyLength = wep_key_len; -+ pwep->Length = wep_total_len; -+ -+ if (wep_key_len == 13) -+ { -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP104_; -+ } -+ } -+ else { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ pwep->KeyIndex = wep_key_idx; -+ pwep->KeyIndex |= 0x80000000; -+ -+ memcpy(pwep->KeyMaterial, (void *)sme->key, pwep->KeyLength); -+ -+ if (rtw_set_802_11_add_wep(padapter, pwep) == (u8)_FAIL) -+ { -+ ret = -EOPNOTSUPP ; -+ } -+ -+ kfree((u8 *)pwep); -+ -+ if (ret < 0) -+ goto exit; -+ } -+ -+ ret = rtw_cfg80211_set_cipher(psecuritypriv, sme->crypto.cipher_group, false); -+ if (ret < 0) -+ return ret; -+ -+ if (sme->crypto.n_akm_suites) { -+ ret = rtw_cfg80211_set_key_mgt(psecuritypriv, sme->crypto.akm_suites[0]); -+ if (ret < 0) -+ goto exit; -+ } -+ -+ authmode = psecuritypriv->ndisauthtype; -+ rtw_set_802_11_authentication_mode(padapter, authmode); -+ -+ /* rtw_set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); */ -+ -+ if (rtw_set_802_11_connect(padapter, (u8 *)sme->bssid, &ndis_ssid) == false) { -+ ret = -1; -+ goto exit; -+ } -+ -+ DBG_8192C("set ssid:dot11AuthAlgrthm =%d, dot11PrivacyAlgrthm =%d, dot118021XGrpPrivacy =%d\n", psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, psecuritypriv->dot118021XGrpPrivacy); -+ -+exit: -+ -+ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); -+ -+ DBG_8192C("<=%s, ret %d\n", __func__, ret); -+ -+ padapter->mlmepriv.not_indic_disco = false; -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_disconnect(struct wiphy *wiphy, struct net_device *ndev, -+ u16 reason_code) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ padapter->mlmepriv.not_indic_disco = true; -+ -+ rtw_set_to_roam(padapter, 0); -+ -+ rtw_scan_abort(padapter); -+ LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, false); -+ -+ DBG_871X("%s...call rtw_indicate_disconnect\n", __func__); -+ -+ rtw_indicate_disconnect(padapter); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ rtw_pwr_wakeup(padapter); -+ -+ padapter->mlmepriv.not_indic_disco = false; -+ -+ DBG_871X(FUNC_NDEV_FMT" return 0\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+static int cfg80211_rtw_set_txpower(struct wiphy *wiphy, -+ struct wireless_dev *wdev, -+ enum nl80211_tx_power_setting type, int mbm) -+{ -+ DBG_8192C("%s\n", __func__); -+ return 0; -+} -+ -+static int cfg80211_rtw_get_txpower(struct wiphy *wiphy, -+ struct wireless_dev *wdev, -+ int *dbm) -+{ -+ DBG_8192C("%s\n", __func__); -+ -+ *dbm = (12); -+ -+ return 0; -+} -+ -+inline bool rtw_cfg80211_pwr_mgmt(struct adapter *adapter) -+{ -+ struct rtw_wdev_priv *rtw_wdev_priv = adapter_wdev_data(adapter); -+ return rtw_wdev_priv->power_mgmt; -+} -+ -+static int cfg80211_rtw_set_power_mgmt(struct wiphy *wiphy, -+ struct net_device *ndev, -+ bool enabled, int timeout) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct rtw_wdev_priv *rtw_wdev_priv = adapter_wdev_data(padapter); -+ -+ DBG_871X(FUNC_NDEV_FMT" enabled:%u, timeout:%d\n", FUNC_NDEV_ARG(ndev), -+ enabled, timeout); -+ -+ rtw_wdev_priv->power_mgmt = enabled; -+ -+ if (!enabled) -+ LPS_Leave(padapter, "CFG80211_PWRMGMT"); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_set_pmksa(struct wiphy *wiphy, -+ struct net_device *ndev, -+ struct cfg80211_pmksa *pmksa) -+{ -+ u8 index, blInserted = false; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ u8 strZeroMacAddress[ ETH_ALEN ] = { 0x00 }; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ if (!memcmp((u8 *)pmksa->bssid, strZeroMacAddress, ETH_ALEN)) -+ { -+ return -EINVAL; -+ } -+ -+ blInserted = false; -+ -+ /* overwrite PMKID */ -+ for (index = 0 ; indexPMKIDList[index].Bssid, (u8 *)pmksa->bssid, ETH_ALEN)) -+ { /* BSSID is matched, the same AP => rewrite with new PMKID. */ -+ DBG_871X(FUNC_NDEV_FMT" BSSID exists in the PMKList.\n", FUNC_NDEV_ARG(ndev)); -+ -+ memcpy(psecuritypriv->PMKIDList[index].PMKID, (u8 *)pmksa->pmkid, WLAN_PMKID_LEN); -+ psecuritypriv->PMKIDList[index].bUsed = true; -+ psecuritypriv->PMKIDIndex = index+1; -+ blInserted = true; -+ break; -+ } -+ } -+ -+ if (!blInserted) -+ { -+ /* Find a new entry */ -+ DBG_871X(FUNC_NDEV_FMT" Use the new entry index = %d for this PMKID.\n", -+ FUNC_NDEV_ARG(ndev), psecuritypriv->PMKIDIndex); -+ -+ memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, (u8 *)pmksa->bssid, ETH_ALEN); -+ memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, (u8 *)pmksa->pmkid, WLAN_PMKID_LEN); -+ -+ psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].bUsed = true; -+ psecuritypriv->PMKIDIndex++ ; -+ if (psecuritypriv->PMKIDIndex == 16) -+ { -+ psecuritypriv->PMKIDIndex = 0; -+ } -+ } -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_del_pmksa(struct wiphy *wiphy, -+ struct net_device *ndev, -+ struct cfg80211_pmksa *pmksa) -+{ -+ u8 index, bMatched = false; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ for (index = 0 ; indexPMKIDList[index].Bssid, (u8 *)pmksa->bssid, ETH_ALEN)) -+ { /* BSSID is matched, the same AP => Remove this PMKID information and reset it. */ -+ memset(psecuritypriv->PMKIDList[index].Bssid, 0x00, ETH_ALEN); -+ memset(psecuritypriv->PMKIDList[index].PMKID, 0x00, WLAN_PMKID_LEN); -+ psecuritypriv->PMKIDList[index].bUsed = false; -+ bMatched = true; -+ break; -+ } -+ } -+ -+ if (false == bMatched) -+ { -+ DBG_871X(FUNC_NDEV_FMT" do not have matched BSSID\n" -+ , FUNC_NDEV_ARG(ndev)); -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_flush_pmksa(struct wiphy *wiphy, -+ struct net_device *ndev) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ memset(&psecuritypriv->PMKIDList[ 0 ], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); -+ psecuritypriv->PMKIDIndex = 0; -+ -+ return 0; -+} -+ -+void rtw_cfg80211_indicate_sta_assoc(struct adapter *padapter, u8 *pmgmt_frame, uint frame_len) -+{ -+ struct net_device *ndev = padapter->pnetdev; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ { -+ struct station_info sinfo; -+ u8 ie_offset; -+ if (GetFrameSubType(pmgmt_frame) == WIFI_ASSOCREQ) -+ ie_offset = _ASOCREQ_IE_OFFSET_; -+ else /* WIFI_REASSOCREQ */ -+ ie_offset = _REASOCREQ_IE_OFFSET_; -+ -+ sinfo.filled = 0; -+ sinfo.assoc_req_ies = pmgmt_frame + WLAN_HDR_A3_LEN + ie_offset; -+ sinfo.assoc_req_ies_len = frame_len - WLAN_HDR_A3_LEN - ie_offset; -+ cfg80211_new_sta(ndev, GetAddr2Ptr(pmgmt_frame), &sinfo, GFP_ATOMIC); -+ } -+} -+ -+void rtw_cfg80211_indicate_sta_disassoc(struct adapter *padapter, unsigned char *da, unsigned short reason) -+{ -+ struct net_device *ndev = padapter->pnetdev; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ cfg80211_del_sta(ndev, da, GFP_ATOMIC); -+} -+ -+static int rtw_cfg80211_monitor_if_open(struct net_device *ndev) -+{ -+ int ret = 0; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ return ret; -+} -+ -+static int rtw_cfg80211_monitor_if_close(struct net_device *ndev) -+{ -+ int ret = 0; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ return ret; -+} -+ -+static int rtw_cfg80211_monitor_if_xmit_entry(struct sk_buff *skb, struct net_device *ndev) -+{ -+ int ret = 0; -+ int rtap_len; -+ int qos_len = 0; -+ int dot11_hdr_len = 24; -+ int snap_len = 6; -+ unsigned char *pdata; -+ u16 frame_control; -+ unsigned char src_mac_addr[6]; -+ unsigned char dst_mac_addr[6]; -+ struct ieee80211_hdr *dot11_hdr; -+ struct ieee80211_radiotap_header *rtap_hdr; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ if (skb) -+ rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, skb->truesize); -+ -+ if (unlikely(skb->len < sizeof(struct ieee80211_radiotap_header))) -+ goto fail; -+ -+ rtap_hdr = (struct ieee80211_radiotap_header *)skb->data; -+ if (unlikely(rtap_hdr->it_version)) -+ goto fail; -+ -+ rtap_len = ieee80211_get_radiotap_len(skb->data); -+ if (unlikely(skb->len < rtap_len)) -+ goto fail; -+ -+ if (rtap_len != 14) -+ { -+ DBG_8192C("radiotap len (should be 14): %d\n", rtap_len); -+ goto fail; -+ } -+ -+ /* Skip the ratio tap header */ -+ skb_pull(skb, rtap_len); -+ -+ dot11_hdr = (struct ieee80211_hdr *)skb->data; -+ frame_control = le16_to_cpu(dot11_hdr->frame_control); -+ /* Check if the QoS bit is set */ -+ if ((frame_control & RTW_IEEE80211_FCTL_FTYPE) == RTW_IEEE80211_FTYPE_DATA) { -+ /* Check if this ia a Wireless Distribution System (WDS) frame -+ * which has 4 MAC addresses -+ */ -+ if (frame_control & 0x0080) -+ qos_len = 2; -+ if ((frame_control & 0x0300) == 0x0300) -+ dot11_hdr_len += 6; -+ -+ memcpy(dst_mac_addr, dot11_hdr->addr1, sizeof(dst_mac_addr)); -+ memcpy(src_mac_addr, dot11_hdr->addr2, sizeof(src_mac_addr)); -+ -+ /* Skip the 802.11 header, QoS (if any) and SNAP, but leave spaces for -+ * for two MAC addresses -+ */ -+ skb_pull(skb, dot11_hdr_len + qos_len + snap_len - sizeof(src_mac_addr) * 2); -+ pdata = (unsigned char*)skb->data; -+ memcpy(pdata, dst_mac_addr, sizeof(dst_mac_addr)); -+ memcpy(pdata + sizeof(dst_mac_addr), src_mac_addr, sizeof(src_mac_addr)); -+ -+ DBG_8192C("should be eapol packet\n"); -+ -+ /* Use the real net device to transmit the packet */ -+ ret = _rtw_xmit_entry(skb, padapter->pnetdev); -+ -+ return ret; -+ -+ } -+ else if ((frame_control & (RTW_IEEE80211_FCTL_FTYPE|RTW_IEEE80211_FCTL_STYPE)) -+ == (RTW_IEEE80211_FTYPE_MGMT|RTW_IEEE80211_STYPE_ACTION) -+ ) -+ { -+ /* only for action frames */ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ /* u8 category, action, OUI_Subtype, dialogToken = 0; */ -+ /* unsigned char *frame_body; */ -+ struct ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ u8 *buf = skb->data; -+ u32 len = skb->len; -+ u8 category, action; -+ -+ if (rtw_action_frame_parse(buf, len, &category, &action) == false) { -+ DBG_8192C(FUNC_NDEV_FMT" frame_control:0x%x\n", FUNC_NDEV_ARG(ndev), -+ le16_to_cpu(((struct ieee80211_hdr_3addr *)buf)->frame_control)); -+ goto fail; -+ } -+ -+ DBG_8192C("RTW_Tx:da ="MAC_FMT" via "FUNC_NDEV_FMT"\n", -+ MAC_ARG(GetAddr1Ptr(buf)), FUNC_NDEV_ARG(ndev)); -+ if (category == RTW_WLAN_CATEGORY_PUBLIC) -+ DBG_871X("RTW_Tx:%s\n", action_public_str(action)); -+ else -+ DBG_871X("RTW_Tx:category(%u), action(%u)\n", category, action); -+ -+ /* starting alloc mgmt frame to dump it */ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ goto fail; -+ } -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = false; -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ memcpy(pframe, (void*)buf, len); -+ pattrib->pktlen = len; -+ -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ /* update seq number */ -+ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ pmlmeext->mgnt_seq++; -+ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ } -+ else -+ { -+ DBG_8192C("frame_control = 0x%x\n", frame_control & (RTW_IEEE80211_FCTL_FTYPE|RTW_IEEE80211_FCTL_STYPE)); -+ } -+ -+ -+fail: -+ -+ dev_kfree_skb_any(skb); -+ -+ return 0; -+ -+} -+ -+static int rtw_cfg80211_monitor_if_set_mac_address(struct net_device *ndev, void *addr) -+{ -+ int ret = 0; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ return ret; -+} -+ -+static const struct net_device_ops rtw_cfg80211_monitor_if_ops = { -+ .ndo_open = rtw_cfg80211_monitor_if_open, -+ .ndo_stop = rtw_cfg80211_monitor_if_close, -+ .ndo_start_xmit = rtw_cfg80211_monitor_if_xmit_entry, -+ .ndo_set_mac_address = rtw_cfg80211_monitor_if_set_mac_address, -+}; -+ -+static int rtw_cfg80211_add_monitor_if (struct adapter *padapter, char *name, struct net_device **ndev) -+{ -+ int ret = 0; -+ struct net_device* mon_ndev = NULL; -+ struct wireless_dev* mon_wdev = NULL; -+ struct rtw_netdev_priv_indicator *pnpi; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ -+ if (!name) { -+ DBG_871X(FUNC_ADPT_FMT" without specific name\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ if (pwdev_priv->pmon_ndev) { -+ DBG_871X(FUNC_ADPT_FMT" monitor interface exist: "NDEV_FMT"\n", -+ FUNC_ADPT_ARG(padapter), NDEV_ARG(pwdev_priv->pmon_ndev)); -+ ret = -EBUSY; -+ goto out; -+ } -+ -+ mon_ndev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); -+ if (!mon_ndev) { -+ DBG_871X(FUNC_ADPT_FMT" allocate ndev fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ mon_ndev->type = ARPHRD_IEEE80211_RADIOTAP; -+ strncpy(mon_ndev->name, name, IFNAMSIZ); -+ mon_ndev->name[IFNAMSIZ - 1] = 0; -+ mon_ndev->destructor = rtw_ndev_destructor; -+ -+ mon_ndev->netdev_ops = &rtw_cfg80211_monitor_if_ops; -+ -+ pnpi = netdev_priv(mon_ndev); -+ pnpi->priv = padapter; -+ pnpi->sizeof_priv = sizeof(struct adapter); -+ -+ /* wdev */ -+ mon_wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); -+ if (!mon_wdev) { -+ DBG_871X(FUNC_ADPT_FMT" allocate mon_wdev fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ mon_wdev->wiphy = padapter->rtw_wdev->wiphy; -+ mon_wdev->netdev = mon_ndev; -+ mon_wdev->iftype = NL80211_IFTYPE_MONITOR; -+ mon_ndev->ieee80211_ptr = mon_wdev; -+ -+ ret = register_netdevice(mon_ndev); -+ if (ret) { -+ goto out; -+ } -+ -+ *ndev = pwdev_priv->pmon_ndev = mon_ndev; -+ memcpy(pwdev_priv->ifname_mon, name, IFNAMSIZ+1); -+ -+out: -+ if (ret && mon_wdev) { -+ kfree((u8 *)mon_wdev); -+ mon_wdev = NULL; -+ } -+ -+ if (ret && mon_ndev) { -+ free_netdev(mon_ndev); -+ *ndev = mon_ndev = NULL; -+ } -+ -+ return ret; -+} -+ -+static struct wireless_dev * -+ cfg80211_rtw_add_virtual_intf( -+ struct wiphy *wiphy, -+ const char *name, -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) -+ unsigned char name_assign_type, -+ #endif -+ enum nl80211_iftype type, u32 *flags, struct vif_params *params) -+{ -+ int ret = 0; -+ struct net_device* ndev = NULL; -+ struct adapter *padapter = wiphy_to_adapter(wiphy); -+ -+ DBG_871X(FUNC_ADPT_FMT " wiphy:%s, name:%s, type:%d\n", -+ FUNC_ADPT_ARG(padapter), wiphy_name(wiphy), name, type); -+ -+ switch (type) { -+ case NL80211_IFTYPE_ADHOC: -+ case NL80211_IFTYPE_AP_VLAN: -+ case NL80211_IFTYPE_WDS: -+ case NL80211_IFTYPE_MESH_POINT: -+ ret = -ENODEV; -+ break; -+ case NL80211_IFTYPE_MONITOR: -+ ret = rtw_cfg80211_add_monitor_if(padapter, (char *)name, &ndev); -+ break; -+ case NL80211_IFTYPE_P2P_CLIENT: -+ case NL80211_IFTYPE_STATION: -+ ret = -ENODEV; -+ break; -+ case NL80211_IFTYPE_P2P_GO: -+ case NL80211_IFTYPE_AP: -+ ret = -ENODEV; -+ break; -+ default: -+ ret = -ENODEV; -+ DBG_871X("Unsupported interface type\n"); -+ break; -+ } -+ -+ DBG_871X(FUNC_ADPT_FMT" ndev:%p, ret:%d\n", FUNC_ADPT_ARG(padapter), ndev, ret); -+ -+ return ndev ? ndev->ieee80211_ptr : ERR_PTR(ret); -+} -+ -+static int cfg80211_rtw_del_virtual_intf(struct wiphy *wiphy, -+ struct wireless_dev *wdev -+) -+{ -+ struct net_device *ndev = wdev_to_ndev(wdev); -+ int ret = 0; -+ struct adapter *adapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ if (!ndev) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ adapter = (struct adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(adapter); -+ -+ unregister_netdevice(ndev); -+ -+ if (ndev == pwdev_priv->pmon_ndev) { -+ pwdev_priv->pmon_ndev = NULL; -+ pwdev_priv->ifname_mon[0] = '\0'; -+ DBG_871X(FUNC_NDEV_FMT" remove monitor interface\n", FUNC_NDEV_ARG(ndev)); -+ } -+ -+exit: -+ return ret; -+} -+ -+static int rtw_add_beacon(struct adapter *adapter, const u8 *head, size_t head_len, const u8 *tail, size_t tail_len) -+{ -+ int ret = 0; -+ u8 *pbuf = NULL; -+ uint len, wps_ielen = 0; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ DBG_8192C("%s beacon_head_len =%zu, beacon_tail_len =%zu\n", __func__, head_len, tail_len); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ if (head_len<24) -+ return -EINVAL; -+ -+ pbuf = rtw_zmalloc(head_len+tail_len); -+ if (!pbuf) -+ return -ENOMEM; -+ -+ memcpy(pbuf, (void *)head+24, head_len-24);/* 24 =beacon header len. */ -+ memcpy(pbuf+head_len-24, (void *)tail, tail_len); -+ -+ len = head_len+tail_len-24; -+ -+ /* check wps ie if inclued */ -+ if (rtw_get_wps_ie(pbuf+_FIXED_IE_LENGTH_, len-_FIXED_IE_LENGTH_, NULL, &wps_ielen)) -+ DBG_8192C("add bcn, wps_ielen =%d\n", wps_ielen); -+ -+ /* pbss_network->IEs will not include p2p_ie, wfd ie */ -+ rtw_ies_remove_ie(pbuf, &len, _BEACON_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, P2P_OUI, 4); -+ rtw_ies_remove_ie(pbuf, &len, _BEACON_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, WFD_OUI, 4); -+ -+ if (rtw_check_beacon_data(adapter, pbuf, len) == _SUCCESS) -+ { -+ ret = 0; -+ } -+ else -+ { -+ ret = -EINVAL; -+ } -+ -+ -+ kfree(pbuf); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_start_ap(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_ap_settings *settings) -+{ -+ int ret = 0; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(ndev); -+ -+ DBG_871X(FUNC_NDEV_FMT" hidden_ssid:%d, auth_type:%d\n", FUNC_NDEV_ARG(ndev), -+ settings->hidden_ssid, settings->auth_type); -+ -+ ret = rtw_add_beacon(adapter, settings->beacon.head, settings->beacon.head_len, -+ settings->beacon.tail, settings->beacon.tail_len); -+ -+ adapter->mlmeextpriv.mlmext_info.hidden_ssid_mode = settings->hidden_ssid; -+ -+ if (settings->ssid && settings->ssid_len) { -+ struct wlan_bssid_ex *pbss_network = &adapter->mlmepriv.cur_network.network; -+ struct wlan_bssid_ex *pbss_network_ext = &adapter->mlmeextpriv.mlmext_info.network; -+ -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" ssid:(%s,%zu), from ie:(%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ settings->ssid, settings->ssid_len, -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength); -+ -+ memcpy(pbss_network->Ssid.Ssid, (void *)settings->ssid, settings->ssid_len); -+ pbss_network->Ssid.SsidLength = settings->ssid_len; -+ memcpy(pbss_network_ext->Ssid.Ssid, (void *)settings->ssid, settings->ssid_len); -+ pbss_network_ext->Ssid.SsidLength = settings->ssid_len; -+ -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, -+ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); -+ } -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_change_beacon(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_beacon_data *info) -+{ -+ int ret = 0; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(ndev); -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ ret = rtw_add_beacon(adapter, info->head, info->head_len, info->tail, info->tail_len); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_stop_ap(struct wiphy *wiphy, struct net_device *ndev) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+static int cfg80211_rtw_add_station(struct wiphy *wiphy, struct net_device *ndev, -+ const u8 *mac, -+ struct station_parameters *params) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_del_station(struct wiphy *wiphy, struct net_device *ndev, -+ struct station_del_parameters *params) -+{ -+ int ret = 0; -+ struct list_head *phead, *plist; -+ u8 updated = false; -+ struct sta_info *psta = NULL; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ const u8 *mac = params->mac; -+ -+ DBG_871X("+"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ if (check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) -+ { -+ DBG_8192C("%s, fw_state != FW_LINKED|WIFI_AP_STATE\n", __func__); -+ return -EINVAL; -+ } -+ -+ -+ if (!mac) -+ { -+ DBG_8192C("flush all sta, and cam_entry\n"); -+ -+ flush_all_cam_entry(padapter); /* clear CAM */ -+ -+ ret = rtw_sta_flush(padapter); -+ -+ return ret; -+ } -+ -+ -+ DBG_8192C("free sta macaddr =" MAC_FMT "\n", MAC_ARG(mac)); -+ -+ if (mac[0] == 0xff && mac[1] == 0xff && -+ mac[2] == 0xff && mac[3] == 0xff && -+ mac[4] == 0xff && mac[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* check asoc_queue */ -+ while (phead != plist) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ if (!memcmp((u8 *)mac, psta->hwaddr, ETH_ALEN)) -+ { -+ if (psta->dot8021xalg == 1 && psta->bpairwise_key_installed == false) -+ { -+ DBG_8192C("%s, sta's dot8021xalg = 1 and key_installed = false\n", __func__); -+ } -+ else -+ { -+ DBG_8192C("free psta =%p, aid =%d\n", psta, psta->aid); -+ -+ list_del_init(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ -+ updated = ap_free_sta(padapter, psta, true, WLAN_REASON_DEAUTH_LEAVING); -+ -+ psta = NULL; -+ -+ break; -+ } -+ -+ } -+ -+ } -+ -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+ associated_clients_update(padapter, updated); -+ -+ DBG_871X("-"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_change_station(struct wiphy *wiphy, struct net_device *ndev, -+ const u8 *mac, struct station_parameters *params) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+ -+static struct sta_info *rtw_sta_info_get_by_idx(const int idx, struct sta_priv *pstapriv) -+ -+{ -+ struct list_head *phead, *plist; -+ struct sta_info *psta = NULL; -+ int i = 0; -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* check asoc_queue */ -+ while (phead != plist) -+ { -+ if (idx == i) psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ i++; -+ } -+ return psta; -+} -+ -+static int cfg80211_rtw_dump_station(struct wiphy *wiphy, struct net_device *ndev, -+ int idx, u8 *mac, struct station_info *sinfo) -+{ -+ -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ psta = rtw_sta_info_get_by_idx(idx, pstapriv); -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ if (NULL == psta) -+ { -+ DBG_871X("Station is not found\n"); -+ ret = -ENOENT; -+ goto exit; -+ } -+ memcpy(mac, psta->hwaddr, ETH_ALEN); -+ sinfo->filled = BIT(NL80211_STA_INFO_SIGNAL); -+ sinfo->signal = psta->rssi; -+ -+exit: -+ return ret; -+} -+ -+static int cfg80211_rtw_change_bss(struct wiphy *wiphy, struct net_device *ndev, -+ struct bss_parameters *params) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+void rtw_cfg80211_rx_action(struct adapter *adapter, u8 *frame, uint frame_len, const char*msg) -+{ -+ s32 freq; -+ int channel; -+ u8 category, action; -+ -+ channel = rtw_get_oper_ch(adapter); -+ -+ rtw_action_frame_parse(frame, frame_len, &category, &action); -+ -+ DBG_8192C("RTW_Rx:cur_ch =%d\n", channel); -+ if (msg) -+ DBG_871X("RTW_Rx:%s\n", msg); -+ else -+ DBG_871X("RTW_Rx:category(%u), action(%u)\n", category, action); -+ -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); -+ -+ rtw_cfg80211_rx_mgmt(adapter, freq, 0, frame, frame_len, GFP_ATOMIC); -+} -+ -+static int _cfg80211_rtw_mgmt_tx(struct adapter *padapter, u8 tx_ch, const u8 *buf, size_t len) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ int ret = _FAIL; -+ bool ack = true; -+ struct ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ rtw_set_scan_deny(padapter, 1000); -+ -+ rtw_scan_abort(padapter); -+ if (tx_ch != rtw_get_oper_ch(padapter)) { -+ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) -+ pmlmeext->cur_channel = tx_ch; -+ set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ -+ /* starting alloc mgmt frame to dump it */ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ /* ret = -ENOMEM; */ -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = false; -+ -+ memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ memcpy(pframe, (void*)buf, len); -+ pattrib->pktlen = len; -+ -+ pwlanhdr = (struct ieee80211_hdr *)pframe; -+ /* update seq number */ -+ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ pmlmeext->mgnt_seq++; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if (dump_mgntframe_and_wait_ack(padapter, pmgntframe) != _SUCCESS) -+ { -+ ack = false; -+ ret = _FAIL; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ack == _FAIL\n", __func__); -+ #endif -+ } -+ else -+ { -+ -+ msleep(50); -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ack =%d, ok!\n", __func__, ack); -+ #endif -+ ret = _SUCCESS; -+ } -+ -+exit: -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ret =%d\n", __func__, ret); -+ #endif -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, -+ struct wireless_dev *wdev, -+ struct cfg80211_mgmt_tx_params *params, -+ u64 *cookie) -+{ -+ struct net_device *ndev = wdev_to_ndev(wdev); -+ struct ieee80211_channel *chan = params->chan; -+ const u8 *buf = params->buf; -+ size_t len = params->len; -+ int ret = 0; -+ int tx_ret; -+ u32 dump_limit = RTW_MAX_MGMT_TX_CNT; -+ u32 dump_cnt = 0; -+ bool ack = true; -+ u8 tx_ch = (u8)ieee80211_frequency_to_channel(chan->center_freq); -+ u8 category, action; -+ int type = (-1); -+ struct adapter *padapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ if (ndev == NULL) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ padapter = (struct adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(padapter); -+ -+ /* cookie generation */ -+ *cookie = (unsigned long) buf; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X(FUNC_ADPT_FMT" len =%zu, ch =%d" -+ "\n", FUNC_ADPT_ARG(padapter), -+ len, tx_ch -+ ); -+#endif /* CONFIG_DEBUG_CFG80211 */ -+ -+ /* indicate ack before issue frame to avoid racing with rsp frame */ -+ rtw_cfg80211_mgmt_tx_status(padapter, *cookie, buf, len, ack, GFP_KERNEL); -+ -+ if (rtw_action_frame_parse(buf, len, &category, &action) == false) { -+ DBG_8192C(FUNC_ADPT_FMT" frame_control:0x%x\n", FUNC_ADPT_ARG(padapter), -+ le16_to_cpu(((struct ieee80211_hdr_3addr *)buf)->frame_control)); -+ goto exit; -+ } -+ -+ DBG_8192C("RTW_Tx:tx_ch =%d, da ="MAC_FMT"\n", tx_ch, MAC_ARG(GetAddr1Ptr(buf))); -+ if (category == RTW_WLAN_CATEGORY_PUBLIC) -+ DBG_871X("RTW_Tx:%s\n", action_public_str(action)); -+ else -+ DBG_871X("RTW_Tx:category(%u), action(%u)\n", category, action); -+ -+ rtw_ps_deny(padapter, PS_DENY_MGNT_TX); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = -EFAULT; -+ goto cancel_ps_deny; -+ } -+ -+ do { -+ dump_cnt++; -+ tx_ret = _cfg80211_rtw_mgmt_tx(padapter, tx_ch, buf, len); -+ } while (dump_cnt < dump_limit && tx_ret != _SUCCESS); -+ -+ if (tx_ret != _SUCCESS || dump_cnt > 1) { -+ DBG_871X(FUNC_ADPT_FMT" %s (%d/%d)\n", FUNC_ADPT_ARG(padapter), -+ tx_ret == _SUCCESS?"OK":"FAIL", dump_cnt, dump_limit); -+ } -+ -+ switch (type) { -+ case P2P_GO_NEGO_CONF: -+ rtw_clear_scan_deny(padapter); -+ break; -+ case P2P_INVIT_RESP: -+ if (pwdev_priv->invit_info.flags & BIT(0) -+ && pwdev_priv->invit_info.status == 0) -+ { -+ DBG_871X(FUNC_ADPT_FMT" agree with invitation of persistent group\n", -+ FUNC_ADPT_ARG(padapter)); -+ rtw_set_scan_deny(padapter, 5000); -+ rtw_pwr_wakeup_ex(padapter, 5000); -+ rtw_clear_scan_deny(padapter); -+ } -+ break; -+ } -+ -+cancel_ps_deny: -+ rtw_ps_deny_cancel(padapter, PS_DENY_MGNT_TX); -+exit: -+ return ret; -+} -+ -+static void cfg80211_rtw_mgmt_frame_register(struct wiphy *wiphy, -+ struct wireless_dev *wdev, -+ u16 frame_type, bool reg) -+{ -+ struct net_device *ndev = wdev_to_ndev(wdev); -+ struct adapter *adapter; -+ -+ if (ndev == NULL) -+ goto exit; -+ -+ adapter = (struct adapter *)rtw_netdev_priv(ndev); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X(FUNC_ADPT_FMT" frame_type:%x, reg:%d\n", FUNC_ADPT_ARG(adapter), -+ frame_type, reg); -+#endif -+ -+ if (frame_type != (IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_PROBE_REQ)) -+ return; -+exit: -+ return; -+} -+ -+#if defined(CONFIG_PNO_SUPPORT) -+static int cfg80211_rtw_sched_scan_start(struct wiphy *wiphy, -+ struct net_device *dev, -+ struct cfg80211_sched_scan_request *request) { -+ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 ret; -+ -+ if (padapter->bup == false) { -+ DBG_871X("%s: net device is down.\n", __func__); -+ return -EIO; -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true || -+ check_fwstate(pmlmepriv, _FW_LINKED) == true || -+ check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) { -+ DBG_871X("%s: device is busy.\n", __func__); -+ rtw_scan_abort(padapter); -+ } -+ -+ if (request == NULL) { -+ DBG_871X("%s: invalid cfg80211_requests parameters.\n", __func__); -+ return -EINVAL; -+ } -+ -+ ret = rtw_android_cfg80211_pno_setup(dev, request->ssids, -+ request->n_ssids, request->interval); -+ -+ if (ret < 0) { -+ DBG_871X("%s ret: %d\n", __func__, ret); -+ goto exit; -+ } -+ -+ ret = rtw_android_pno_enable(dev, true); -+ if (ret < 0) { -+ DBG_871X("%s ret: %d\n", __func__, ret); -+ goto exit; -+ } -+exit: -+ return ret; -+} -+ -+static int cfg80211_rtw_sched_scan_stop(struct wiphy *wiphy, -+ struct net_device *dev) { -+ return rtw_android_pno_enable(dev, false); -+} -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+static void rtw_cfg80211_init_ht_capab(struct ieee80211_sta_ht_cap *ht_cap, enum ieee80211_band band, u8 rf_type) -+{ -+ -+#define MAX_BIT_RATE_40MHZ_MCS15 300 /* Mbps */ -+#define MAX_BIT_RATE_40MHZ_MCS7 150 /* Mbps */ -+ -+ ht_cap->ht_supported = true; -+ -+ ht_cap->cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 | -+ IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_SGI_20 | -+ IEEE80211_HT_CAP_DSSSCCK40 | IEEE80211_HT_CAP_MAX_AMSDU; -+ -+ /* -+ *Maximum length of AMPDU that the STA can receive. -+ *Length = 2 ^ (13 + max_ampdu_length_exp) - 1 (octets) -+ */ -+ ht_cap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K; -+ -+ /*Minimum MPDU start spacing , */ -+ ht_cap->ampdu_density = IEEE80211_HT_MPDU_DENSITY_16; -+ -+ ht_cap->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED; -+ -+ /* -+ *hw->wiphy->bands[IEEE80211_BAND_2GHZ] -+ *base on ant_num -+ *rx_mask: RX mask -+ *if rx_ant = 1 rx_mask[0]= 0xff;==>MCS0-MCS7 -+ *if rx_ant =2 rx_mask[1]= 0xff;==>MCS8-MCS15 -+ *if rx_ant >=3 rx_mask[2]= 0xff; -+ *if BW_40 rx_mask[4]= 0x01; -+ *highest supported RX rate -+ */ -+ if (rf_type == RF_1T1R) -+ { -+ ht_cap->mcs.rx_mask[0] = 0xFF; -+ ht_cap->mcs.rx_mask[1] = 0x00; -+ ht_cap->mcs.rx_mask[4] = 0x01; -+ -+ ht_cap->mcs.rx_highest = cpu_to_le16(MAX_BIT_RATE_40MHZ_MCS7); -+ } -+ else if ((rf_type == RF_1T2R) || (rf_type ==RF_2T2R)) -+ { -+ ht_cap->mcs.rx_mask[0] = 0xFF; -+ ht_cap->mcs.rx_mask[1] = 0xFF; -+ ht_cap->mcs.rx_mask[4] = 0x01; -+ -+ ht_cap->mcs.rx_highest = cpu_to_le16(MAX_BIT_RATE_40MHZ_MCS15); -+ } -+ else -+ { -+ DBG_8192C("%s, error rf_type =%d\n", __func__, rf_type); -+ } -+ -+} -+ -+void rtw_cfg80211_init_wiphy(struct adapter *padapter) -+{ -+ u8 rf_type; -+ struct ieee80211_supported_band *bands; -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct wiphy *wiphy = pwdev->wiphy; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ DBG_8192C("%s:rf_type =%d\n", __func__, rf_type); -+ -+ { -+ bands = wiphy->bands[IEEE80211_BAND_2GHZ]; -+ if (bands) -+ rtw_cfg80211_init_ht_capab(&bands->ht_cap, IEEE80211_BAND_2GHZ, rf_type); -+ } -+ -+ /* init regulary domain */ -+ rtw_regd_init(padapter, rtw_reg_notifier); -+ -+ /* copy mac_addr to wiphy */ -+ memcpy(wiphy->perm_addr, padapter->eeprompriv.mac_addr, ETH_ALEN); -+ -+} -+ -+static void rtw_cfg80211_preinit_wiphy(struct adapter *padapter, struct wiphy *wiphy) -+{ -+ -+ wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; -+ -+ wiphy->max_scan_ssids = RTW_SSID_SCAN_AMOUNT; -+ wiphy->max_scan_ie_len = RTW_SCAN_IE_LEN_MAX; -+ wiphy->max_num_pmkids = RTW_MAX_NUM_PMKIDS; -+ -+ wiphy->max_remain_on_channel_duration = RTW_MAX_REMAIN_ON_CHANNEL_DURATION; -+ -+ wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) -+ | BIT(NL80211_IFTYPE_ADHOC) -+ | BIT(NL80211_IFTYPE_AP) -+ | BIT(NL80211_IFTYPE_MONITOR) -+ ; -+ -+ wiphy->mgmt_stypes = rtw_cfg80211_default_mgmt_stypes; -+ -+ wiphy->software_iftypes |= BIT(NL80211_IFTYPE_MONITOR); -+ -+ wiphy->cipher_suites = rtw_cipher_suites; -+ wiphy->n_cipher_suites = ARRAY_SIZE(rtw_cipher_suites); -+ -+ /* if (padapter->registrypriv.wireless_mode & WIRELESS_11G) */ -+ wiphy->bands[IEEE80211_BAND_2GHZ] = rtw_spt_band_alloc(IEEE80211_BAND_2GHZ); -+ -+ wiphy->flags |= WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL; -+ wiphy->flags |= WIPHY_FLAG_OFFCHAN_TX | WIPHY_FLAG_HAVE_AP_SME; -+ -+#if defined(CONFIG_PM) -+ wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; -+#ifdef CONFIG_PNO_SUPPORT -+ wiphy->max_sched_scan_ssids = MAX_PNO_LIST_COUNT; -+#endif -+#endif -+ -+#if defined(CONFIG_PM) -+ wiphy->wowlan = &wowlan_stub; -+#endif -+ -+ if (padapter->registrypriv.power_mgnt != PS_MODE_ACTIVE) -+ wiphy->flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT; -+ else -+ wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT; -+} -+ -+static struct cfg80211_ops rtw_cfg80211_ops = { -+ .change_virtual_intf = cfg80211_rtw_change_iface, -+ .add_key = cfg80211_rtw_add_key, -+ .get_key = cfg80211_rtw_get_key, -+ .del_key = cfg80211_rtw_del_key, -+ .set_default_key = cfg80211_rtw_set_default_key, -+ .get_station = cfg80211_rtw_get_station, -+ .scan = cfg80211_rtw_scan, -+ .set_wiphy_params = cfg80211_rtw_set_wiphy_params, -+ .connect = cfg80211_rtw_connect, -+ .disconnect = cfg80211_rtw_disconnect, -+ .join_ibss = cfg80211_rtw_join_ibss, -+ .leave_ibss = cfg80211_rtw_leave_ibss, -+ .set_tx_power = cfg80211_rtw_set_txpower, -+ .get_tx_power = cfg80211_rtw_get_txpower, -+ .set_power_mgmt = cfg80211_rtw_set_power_mgmt, -+ .set_pmksa = cfg80211_rtw_set_pmksa, -+ .del_pmksa = cfg80211_rtw_del_pmksa, -+ .flush_pmksa = cfg80211_rtw_flush_pmksa, -+ -+ .add_virtual_intf = cfg80211_rtw_add_virtual_intf, -+ .del_virtual_intf = cfg80211_rtw_del_virtual_intf, -+ -+ .start_ap = cfg80211_rtw_start_ap, -+ .change_beacon = cfg80211_rtw_change_beacon, -+ .stop_ap = cfg80211_rtw_stop_ap, -+ -+ .add_station = cfg80211_rtw_add_station, -+ .del_station = cfg80211_rtw_del_station, -+ .change_station = cfg80211_rtw_change_station, -+ .dump_station = cfg80211_rtw_dump_station, -+ .change_bss = cfg80211_rtw_change_bss, -+ -+ .mgmt_tx = cfg80211_rtw_mgmt_tx, -+ .mgmt_frame_register = cfg80211_rtw_mgmt_frame_register, -+ -+#if defined(CONFIG_PNO_SUPPORT) -+ .sched_scan_start = cfg80211_rtw_sched_scan_start, -+ .sched_scan_stop = cfg80211_rtw_sched_scan_stop, -+#endif /* CONFIG_PNO_SUPPORT */ -+}; -+ -+int rtw_wdev_alloc(struct adapter *padapter, struct device *dev) -+{ -+ int ret = 0; -+ struct wiphy *wiphy; -+ struct wireless_dev *wdev; -+ struct rtw_wdev_priv *pwdev_priv; -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ DBG_8192C("%s(padapter =%p)\n", __func__, padapter); -+ -+ /* wiphy */ -+ wiphy = wiphy_new(&rtw_cfg80211_ops, sizeof(struct adapter *)); -+ if (!wiphy) { -+ DBG_8192C("Couldn't allocate wiphy device\n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ set_wiphy_dev(wiphy, dev); -+ *((struct adapter **)wiphy_priv(wiphy)) = padapter; -+ rtw_cfg80211_preinit_wiphy(padapter, wiphy); -+ -+ ret = wiphy_register(wiphy); -+ if (ret < 0) { -+ DBG_8192C("Couldn't register wiphy device\n"); -+ goto free_wiphy; -+ } -+ -+ /* wdev */ -+ wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); -+ if (!wdev) { -+ DBG_8192C("Couldn't allocate wireless device\n"); -+ ret = -ENOMEM; -+ goto unregister_wiphy; -+ } -+ wdev->wiphy = wiphy; -+ wdev->netdev = pnetdev; -+ -+ wdev->iftype = NL80211_IFTYPE_STATION; /* will be init in rtw_hal_init() */ -+ /* Must sync with _rtw_init_mlme_priv() */ -+ /* pmlmepriv->fw_state = WIFI_STATION_STATE */ -+ padapter->rtw_wdev = wdev; -+ pnetdev->ieee80211_ptr = wdev; -+ -+ /* init pwdev_priv */ -+ pwdev_priv = adapter_wdev_data(padapter); -+ pwdev_priv->rtw_wdev = wdev; -+ pwdev_priv->pmon_ndev = NULL; -+ pwdev_priv->ifname_mon[0] = '\0'; -+ pwdev_priv->padapter = padapter; -+ pwdev_priv->scan_request = NULL; -+ spin_lock_init(&pwdev_priv->scan_req_lock); -+ -+ pwdev_priv->p2p_enabled = false; -+ pwdev_priv->provdisc_req_issued = false; -+ rtw_wdev_invit_info_init(&pwdev_priv->invit_info); -+ rtw_wdev_nego_info_init(&pwdev_priv->nego_info); -+ -+ pwdev_priv->bandroid_scan = false; -+ -+ if (padapter->registrypriv.power_mgnt != PS_MODE_ACTIVE) -+ pwdev_priv->power_mgmt = true; -+ else -+ pwdev_priv->power_mgmt = false; -+ -+ return ret; -+ -+ kfree((u8 *)wdev); -+unregister_wiphy: -+ wiphy_unregister(wiphy); -+ free_wiphy: -+ wiphy_free(wiphy); -+exit: -+ return ret; -+ -+} -+ -+void rtw_wdev_free(struct wireless_dev *wdev) -+{ -+ DBG_8192C("%s(wdev =%p)\n", __func__, wdev); -+ -+ if (!wdev) -+ return; -+ -+ rtw_spt_band_free(wdev->wiphy->bands[IEEE80211_BAND_2GHZ]); -+ -+ wiphy_free(wdev->wiphy); -+ -+ kfree((u8 *)wdev); -+} -+ -+void rtw_wdev_unregister(struct wireless_dev *wdev) -+{ -+ struct net_device *ndev; -+ struct adapter *adapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ DBG_8192C("%s(wdev =%p)\n", __func__, wdev); -+ -+ if (!wdev) -+ return; -+ -+ if (!(ndev = wdev_to_ndev(wdev))) -+ return; -+ -+ adapter = (struct adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(adapter); -+ -+ rtw_cfg80211_indicate_scan_done(adapter, true); -+ -+ if (pwdev_priv->pmon_ndev) { -+ DBG_8192C("%s, unregister monitor interface\n", __func__); -+ unregister_netdev(pwdev_priv->pmon_ndev); -+ } -+ -+ wiphy_unregister(wdev->wiphy); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/os_dep/ioctl_linux.c linux/3rdparty/rtl8723bs/os_dep/ioctl_linux.c ---- linux.old/3rdparty/rtl8723bs/os_dep/ioctl_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/os_dep/ioctl_linux.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,5820 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _IOCTL_LINUX_C_ -+ -+#include -+#include -+#include -+#include -+ -+#define RTL_IOCTL_WPA_SUPPLICANT SIOCIWFIRSTPRIV+30 -+ -+#define SCAN_ITEM_SIZE 768 -+#define MAX_CUSTOM_LEN 64 -+#define RATE_COUNT 4 -+ -+/* combo scan */ -+#define WEXT_CSCAN_AMOUNT 9 -+#define WEXT_CSCAN_BUF_LEN 360 -+#define WEXT_CSCAN_HEADER "CSCAN S\x01\x00\x00S\x00" -+#define WEXT_CSCAN_HEADER_SIZE 12 -+#define WEXT_CSCAN_SSID_SECTION 'S' -+#define WEXT_CSCAN_CHANNEL_SECTION 'C' -+#define WEXT_CSCAN_NPROBE_SECTION 'N' -+#define WEXT_CSCAN_ACTV_DWELL_SECTION 'A' -+#define WEXT_CSCAN_PASV_DWELL_SECTION 'P' -+#define WEXT_CSCAN_HOME_DWELL_SECTION 'H' -+#define WEXT_CSCAN_TYPE_SECTION 'T' -+ -+ -+extern u8 key_2char2num(u8 hch, u8 lch); -+ -+static u32 rtw_rates[] = {1000000, 2000000, 5500000, 11000000, -+ 6000000, 9000000, 12000000, 18000000, 24000000, 36000000, 48000000, 54000000}; -+ -+static const char * const iw_operation_mode[] = -+{ -+ "Auto", "Ad-Hoc", "Managed", "Master", "Repeater", "Secondary", "Monitor" -+}; -+ -+static int hex2num_i(char c) -+{ -+ if (c >= '0' && c <= '9') -+ return c - '0'; -+ if (c >= 'a' && c <= 'f') -+ return c - 'a' + 10; -+ if (c >= 'A' && c <= 'F') -+ return c - 'A' + 10; -+ return -1; -+} -+ -+/** -+ * hwaddr_aton - Convert ASCII string to MAC address -+ * @txt: MAC address as a string (e.g., "00:11:22:33:44:55") -+ * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes) -+ * Returns: 0 on success, -1 on failure (e.g., string not a MAC address) -+ */ -+static int hwaddr_aton_i(const char *txt, u8 *addr) -+{ -+ int i; -+ -+ for (i = 0; i < 6; i++) { -+ int a, b; -+ -+ a = hex2num_i(*txt++); -+ if (a < 0) -+ return -1; -+ b = hex2num_i(*txt++); -+ if (b < 0) -+ return -1; -+ *addr++ = (a << 4) | b; -+ if (i < 5 && *txt++ != ':') -+ return -1; -+ } -+ -+ return 0; -+} -+ -+void indicate_wx_scan_complete_event(struct adapter *padapter) -+{ -+ union iwreq_data wrqu; -+ -+ memset(&wrqu, 0, sizeof(union iwreq_data)); -+ -+ /* DBG_871X("+rtw_indicate_wx_scan_complete_event\n"); */ -+} -+ -+ -+void rtw_indicate_wx_assoc_event(struct adapter *padapter) -+{ -+ union iwreq_data wrqu; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_bssid_ex *pnetwork = (struct wlan_bssid_ex*)(&(pmlmeinfo->network)); -+ -+ memset(&wrqu, 0, sizeof(union iwreq_data)); -+ -+ wrqu.ap_addr.sa_family = ARPHRD_ETHER; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) ==true) -+ memcpy(wrqu.ap_addr.sa_data, pnetwork->MacAddress, ETH_ALEN); -+ else -+ memcpy(wrqu.ap_addr.sa_data, pmlmepriv->cur_network.network.MacAddress, ETH_ALEN); -+ -+ DBG_871X_LEVEL(_drv_always_, "assoc success\n"); -+} -+ -+void rtw_indicate_wx_disassoc_event(struct adapter *padapter) -+{ -+ union iwreq_data wrqu; -+ -+ memset(&wrqu, 0, sizeof(union iwreq_data)); -+ -+ wrqu.ap_addr.sa_family = ARPHRD_ETHER; -+ memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN); -+} -+ -+/* -+uint rtw_is_cckrates_included(u8 *rate) -+{ -+ u32 i = 0; -+ -+ while (rate[i]!= 0) -+ { -+ if ((((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || -+ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22)) -+ return true; -+ i++; -+ } -+ -+ return false; -+} -+ -+uint rtw_is_cckratesonly_included(u8 *rate) -+{ -+ u32 i = 0; -+ -+ while (rate[i]!= 0) -+ { -+ if ((((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && -+ (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22)) -+ return false; -+ i++; -+ } -+ -+ return true; -+} -+*/ -+ -+static char *translate_scan(struct adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop) -+{ -+ struct iw_event iwe; -+ u16 cap; -+ u32 ht_ielen = 0; -+ char *custom = NULL; -+ char *p; -+ u16 max_rate = 0, rate, ht_cap =false, vht_cap = false; -+ u32 i = 0; -+ u8 bw_40MHz = 0, short_GI = 0; -+ u16 mcs_rate = 0, vht_data_rate = 0; -+ u8 ie_offset = (pnetwork->network.Reserved[0] == 2? 0:12); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 ss, sq; -+ -+ /* AP MAC address */ -+ iwe.cmd = SIOCGIWAP; -+ iwe.u.ap_addr.sa_family = ARPHRD_ETHER; -+ -+ memcpy(iwe.u.ap_addr.sa_data, pnetwork->network.MacAddress, ETH_ALEN); -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_ADDR_LEN); -+ -+ /* Add the ESSID */ -+ iwe.cmd = SIOCGIWESSID; -+ iwe.u.data.flags = 1; -+ iwe.u.data.length = min((u16)pnetwork->network.Ssid.SsidLength, (u16)32); -+ start = iwe_stream_add_point(info, start, stop, &iwe, pnetwork->network.Ssid.Ssid); -+ -+ /* parsing HT_CAP_IE */ -+ if (pnetwork->network.Reserved[0] == 2) /* Probe Request */ -+ { -+ p = rtw_get_ie(&pnetwork->network.IEs[0], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength); -+ } -+ else -+ { -+ p = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength-12); -+ } -+ if (p && ht_ielen>0) -+ { -+ struct rtw_ieee80211_ht_cap *pht_capie; -+ ht_cap = true; -+ pht_capie = (struct rtw_ieee80211_ht_cap *)(p+2); -+ memcpy(&mcs_rate , pht_capie->supp_mcs_set, 2); -+ bw_40MHz = (le16_to_cpu(pht_capie->cap_info) & IEEE80211_HT_CAP_SUP_WIDTH) ? 1 : 0; -+ short_GI = (le16_to_cpu(pht_capie->cap_info) & (IEEE80211_HT_CAP_SGI_20 | IEEE80211_HT_CAP_SGI_40)) ? 1 : 0; -+ } -+ -+ /* Add the protocol name */ -+ iwe.cmd = SIOCGIWNAME; -+ if ((rtw_is_cckratesonly_included((u8 *)&pnetwork->network.SupportedRates)) == true) -+ { -+ if (ht_cap == true) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bn"); -+ else -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11b"); -+ } -+ else if ((rtw_is_cckrates_included((u8 *)&pnetwork->network.SupportedRates)) == true) -+ { -+ if (ht_cap == true) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bgn"); -+ else -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bg"); -+ } -+ else -+ { -+ if (pnetwork->network.Configuration.DSConfig > 14) -+ { -+ if (vht_cap == true) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11AC"); -+ else if (ht_cap == true) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11an"); -+ else -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11a"); -+ } -+ else -+ { -+ if (ht_cap == true) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11gn"); -+ else -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11g"); -+ } -+ } -+ -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_CHAR_LEN); -+ -+ /* Add mode */ -+ if (pnetwork->network.Reserved[0] == 2) /* Probe Request */ -+ { -+ cap = 0; -+ } -+ else -+ { -+ __le16 le_tmp; -+ -+ iwe.cmd = SIOCGIWMODE; -+ memcpy((u8 *)&le_tmp, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); -+ cap = le16_to_cpu(le_tmp); -+ } -+ -+ if (cap & (WLAN_CAPABILITY_IBSS |WLAN_CAPABILITY_BSS)) { -+ if (cap & WLAN_CAPABILITY_BSS) -+ iwe.u.mode = IW_MODE_MASTER; -+ else -+ iwe.u.mode = IW_MODE_ADHOC; -+ -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_UINT_LEN); -+ } -+ -+ if (pnetwork->network.Configuration.DSConfig<1 /*|| pnetwork->network.Configuration.DSConfig>14*/) -+ pnetwork->network.Configuration.DSConfig = 1; -+ -+ /* Add frequency/channel */ -+ iwe.cmd = SIOCGIWFREQ; -+ iwe.u.freq.m = rtw_ch2freq(pnetwork->network.Configuration.DSConfig) * 100000; -+ iwe.u.freq.e = 1; -+ iwe.u.freq.i = pnetwork->network.Configuration.DSConfig; -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_FREQ_LEN); -+ -+ /* Add encryption capability */ -+ iwe.cmd = SIOCGIWENCODE; -+ if (cap & WLAN_CAPABILITY_PRIVACY) -+ iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; -+ else -+ iwe.u.data.flags = IW_ENCODE_DISABLED; -+ iwe.u.data.length = 0; -+ start = iwe_stream_add_point(info, start, stop, &iwe, pnetwork->network.Ssid.Ssid); -+ -+ /*Add basic and extended rates */ -+ max_rate = 0; -+ custom = kzalloc(MAX_CUSTOM_LEN, GFP_ATOMIC); -+ if (!custom) -+ return start; -+ p = custom; -+ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): "); -+ while (pnetwork->network.SupportedRates[i]!= 0) -+ { -+ rate = pnetwork->network.SupportedRates[i]&0x7F; -+ if (rate > max_rate) -+ max_rate = rate; -+ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), -+ "%d%s ", rate >> 1, (rate & 1) ? ".5" : ""); -+ i++; -+ } -+ -+ if (vht_cap == true) { -+ max_rate = vht_data_rate; -+ } -+ else if (ht_cap == true) -+ { -+ if (mcs_rate&0x8000)/* MCS15 */ -+ { -+ max_rate = (bw_40MHz) ? ((short_GI)?300:270):((short_GI)?144:130); -+ -+ } -+ else if (mcs_rate&0x0080)/* MCS7 */ -+ { -+ max_rate = (bw_40MHz) ? ((short_GI)?150:135):((short_GI)?72:65); -+ } -+ else/* default MCS7 */ -+ { -+ /* DBG_871X("wx_get_scan, mcs_rate_bitmap = 0x%x\n", mcs_rate); */ -+ max_rate = (bw_40MHz) ? ((short_GI)?150:135):((short_GI)?72:65); -+ } -+ -+ max_rate = max_rate*2;/* Mbps/2; */ -+ } -+ -+ iwe.cmd = SIOCGIWRATE; -+ iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0; -+ iwe.u.bitrate.value = max_rate * 500000; -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_PARAM_LEN); -+ -+ /* parsing WPA/WPA2 IE */ -+ if (pnetwork->network.Reserved[0] != 2) /* Probe Request */ -+ { -+ u8 *buf; -+ u8 wpa_ie[255], rsn_ie[255]; -+ u16 wpa_len = 0, rsn_len = 0; -+ u8 *p; -+ sint out_len = 0; -+ out_len =rtw_get_sec_ie(pnetwork->network.IEs , pnetwork->network.IELength, rsn_ie,&rsn_len, wpa_ie,&wpa_len); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_wx_get_scan: ssid =%s\n", pnetwork->network.Ssid.Ssid)); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_wx_get_scan: wpa_len =%d rsn_len =%d\n", wpa_len, rsn_len)); -+ -+ buf = kzalloc(MAX_WPA_IE_LEN*2, GFP_KERNEL); -+ if (!buf) -+ return start; -+ if (wpa_len > 0) { -+ p =buf; -+ p += sprintf(p, "wpa_ie ="); -+ for (i = 0; i < wpa_len; i++) { -+ p += sprintf(p, "%02x", wpa_ie[i]); -+ } -+ -+ if (wpa_len > 100) { -+ printk("-----------------Len %d----------------\n", wpa_len); -+ for (i = 0; i < wpa_len; i++) { -+ printk("%02x ", wpa_ie[i]); -+ } -+ printk("\n"); -+ printk("-----------------Len %d----------------\n", wpa_len); -+ } -+ -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVCUSTOM; -+ iwe.u.data.length = strlen(buf); -+ start = iwe_stream_add_point(info, start, stop, &iwe, buf); -+ -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd =IWEVGENIE; -+ iwe.u.data.length = wpa_len; -+ start = iwe_stream_add_point(info, start, stop, &iwe, wpa_ie); -+ } -+ if (rsn_len > 0) { -+ p = buf; -+ memset(buf, 0, MAX_WPA_IE_LEN*2); -+ p += sprintf(p, "rsn_ie ="); -+ for (i = 0; i < rsn_len; i++) -+ p += sprintf(p, "%02x", rsn_ie[i]); -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVCUSTOM; -+ iwe.u.data.length = strlen(buf); -+ start = iwe_stream_add_point(info, start, stop, &iwe, buf); -+ -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd =IWEVGENIE; -+ iwe.u.data.length = rsn_len; -+ start = iwe_stream_add_point(info, start, stop, &iwe, rsn_ie); -+ } -+ kfree(buf); -+ } -+ -+ { /* parsing WPS IE */ -+ uint cnt = 0, total_ielen; -+ u8 *wpsie_ptr = NULL; -+ uint wps_ielen = 0; -+ -+ u8 *ie_ptr = pnetwork->network.IEs + ie_offset; -+ total_ielen = pnetwork->network.IELength - ie_offset; -+ -+ if (pnetwork->network.Reserved[0] == 2) /* Probe Request */ -+ { -+ ie_ptr = pnetwork->network.IEs; -+ total_ielen = pnetwork->network.IELength; -+ } -+ else /* Beacon or Probe Respones */ -+ { -+ ie_ptr = pnetwork->network.IEs + _FIXED_IE_LENGTH_; -+ total_ielen = pnetwork->network.IELength - _FIXED_IE_LENGTH_; -+ } -+ -+ while (cnt < total_ielen) -+ { -+ if (rtw_is_wps_ie(&ie_ptr[cnt], &wps_ielen) && (wps_ielen>2)) -+ { -+ wpsie_ptr = &ie_ptr[cnt]; -+ iwe.cmd =IWEVGENIE; -+ iwe.u.data.length = (u16)wps_ielen; -+ start = iwe_stream_add_point(info, start, stop, &iwe, wpsie_ptr); -+ } -+ cnt+=ie_ptr[cnt+1]+2; /* goto next */ -+ } -+ } -+ -+ /* Add quality statistics */ -+ iwe.cmd = IWEVQUAL; -+ iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED -+ #if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ | IW_QUAL_NOISE_UPDATED -+ #else -+ | IW_QUAL_NOISE_INVALID -+ #endif -+ #ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ | IW_QUAL_DBM -+ #endif -+ ; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true && -+ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { -+ ss = padapter->recvpriv.signal_strength; -+ sq = padapter->recvpriv.signal_qual; -+ } else { -+ ss = pnetwork->network.PhyInfo.SignalStrength; -+ sq = pnetwork->network.PhyInfo.SignalQuality; -+ } -+ -+ -+ #ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ iwe.u.qual.level = (u8) translate_percentage_to_dbm(ss);/* dbm */ -+ #else -+ #ifdef CONFIG_SKIP_SIGNAL_SCALE_MAPPING -+ { -+ /* Do signal scale mapping when using percentage as the unit of signal strength, since the scale mapping is skipped in odm */ -+ -+ struct hal_com_data *pHal = GET_HAL_DATA(padapter); -+ -+ iwe.u.qual.level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, ss); -+ } -+ #else -+ iwe.u.qual.level = (u8)ss;/* */ -+ #endif -+ #endif -+ -+ iwe.u.qual.qual = (u8)sq; /* signal quality */ -+ -+ #if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ { -+ s16 tmp_noise = 0; -+ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR,&(pnetwork->network.Configuration.DSConfig), &(tmp_noise)); -+ iwe.u.qual.noise = tmp_noise ; -+ } -+ #else -+ iwe.u.qual.noise = 0; /* noise level */ -+ #endif -+ -+ /* DBG_871X("iqual =%d, ilevel =%d, inoise =%d, iupdated =%d\n", iwe.u.qual.qual, iwe.u.qual.level , iwe.u.qual.noise, iwe.u.qual.updated); */ -+ -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_QUAL_LEN); -+ -+ { -+ u8 *buf; -+ u8 *p, *pos; -+ -+ buf = kzalloc(MAX_WPA_IE_LEN, GFP_KERNEL); -+ if (!buf) -+ goto exit; -+ p = buf; -+ pos = pnetwork->network.Reserved; -+ p += sprintf(p, "fm =%02X%02X", pos[1], pos[0]); -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVCUSTOM; -+ iwe.u.data.length = strlen(buf); -+ start = iwe_stream_add_point(info, start, stop, &iwe, buf); -+ kfree(buf); -+ } -+exit: -+ kfree(custom); -+ -+ return start; -+} -+ -+static int wpa_set_auth_algs(struct net_device *dev, u32 value) -+{ -+ struct adapter *padapter = (struct adapter *) rtw_netdev_priv(dev); -+ int ret = 0; -+ -+ if ((value & AUTH_ALG_SHARED_KEY) && (value & AUTH_ALG_OPEN_SYSTEM)) -+ { -+ DBG_871X("wpa_set_auth_algs, AUTH_ALG_SHARED_KEY and AUTH_ALG_OPEN_SYSTEM [value:0x%x]\n", value); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ } -+ else if (value & AUTH_ALG_SHARED_KEY) -+ { -+ DBG_871X("wpa_set_auth_algs, AUTH_ALG_SHARED_KEY [value:0x%x]\n", value); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeShared; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; -+ } -+ else if (value & AUTH_ALG_OPEN_SYSTEM) -+ { -+ DBG_871X("wpa_set_auth_algs, AUTH_ALG_OPEN_SYSTEM\n"); -+ /* padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; */ -+ if (padapter->securitypriv.ndisauthtype < Ndis802_11AuthModeWPAPSK) -+ { -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ } -+ -+ } -+ else if (value & AUTH_ALG_LEAP) -+ { -+ DBG_871X("wpa_set_auth_algs, AUTH_ALG_LEAP\n"); -+ } -+ else -+ { -+ DBG_871X("wpa_set_auth_algs, error!\n"); -+ ret = -EINVAL; -+ } -+ -+ return ret; -+ -+} -+ -+static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len, wep_total_len; -+ struct ndis_802_11_wep *pwep = NULL; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ if (param_len < (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ -+ if (param->u.crypt.idx >= WEP_KEYS && -+ param->u.crypt.idx >= BIP_MAX_KEYID) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ else -+ { -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_err_, ("wpa_set_encryption, crypt.alg = WEP\n")); -+ DBG_871X("wpa_set_encryption, crypt.alg = WEP\n"); -+ -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP40_; -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, ("(1)wep_key_idx =%d\n", wep_key_idx)); -+ DBG_871X("(1)wep_key_idx =%d\n", wep_key_idx); -+ -+ if (wep_key_idx > WEP_KEYS) -+ return -EINVAL; -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, ("(2)wep_key_idx =%d\n", wep_key_idx)); -+ -+ if (wep_key_len > 0) -+ { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ wep_total_len = wep_key_len + FIELD_OFFSET(struct ndis_802_11_wep, KeyMaterial); -+ pwep =(struct ndis_802_11_wep *) rtw_malloc(wep_total_len); -+ if (pwep == NULL) { -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_err_, (" wpa_set_encryption: pwep allocate fail !!!\n")); -+ goto exit; -+ } -+ -+ memset(pwep, 0, wep_total_len); -+ -+ pwep->KeyLength = wep_key_len; -+ pwep->Length = wep_total_len; -+ -+ if (wep_key_len == 13) -+ { -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP104_; -+ } -+ } -+ else { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ pwep->KeyIndex = wep_key_idx; -+ pwep->KeyIndex |= 0x80000000; -+ -+ memcpy(pwep->KeyMaterial, param->u.crypt.key, pwep->KeyLength); -+ -+ if (param->u.crypt.set_tx) -+ { -+ DBG_871X("wep, set_tx = 1\n"); -+ -+ if (rtw_set_802_11_add_wep(padapter, pwep) == (u8)_FAIL) -+ { -+ ret = -EOPNOTSUPP ; -+ } -+ } -+ else -+ { -+ DBG_871X("wep, set_tx = 0\n"); -+ -+ /* don't update "psecuritypriv->dot11PrivacyAlgrthm" and */ -+ /* psecuritypriv->dot11PrivacyKeyIndex =keyid", but can rtw_set_key to fw/cam */ -+ -+ if (wep_key_idx >= WEP_KEYS) { -+ ret = -EOPNOTSUPP ; -+ goto exit; -+ } -+ -+ memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength); -+ psecuritypriv->dot11DefKeylen[wep_key_idx]=pwep->KeyLength; -+ rtw_set_key(padapter, psecuritypriv, wep_key_idx, 0, true); -+ } -+ -+ goto exit; -+ } -+ -+ if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) /* 802_1x */ -+ { -+ struct sta_info * psta,*pbcmc_sta; -+ struct sta_priv * pstapriv = &padapter->stapriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == true) /* sta mode */ -+ { -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ /* DEBUG_ERR(("Set wpa_set_encryption: Obtain Sta_info fail\n")); */ -+ } -+ else -+ { -+ /* Jeff: don't disable ieee8021x_blocked while clearing key */ -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ psta->ieee8021x_blocked = false; -+ -+ if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ { -+ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ -+ if (param->u.crypt.set_tx == 1)/* pairwise key */ -+ { -+ memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ if (strcmp(param->u.crypt.alg, "TKIP") == 0)/* set mic key */ -+ { -+ /* DEBUG_ERR(("\nset key length :param->u.crypt.key_len =%d\n", param->u.crypt.key_len)); */ -+ memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ padapter->securitypriv.busetkipkey =false; -+ /* _set_timer(&padapter->securitypriv.tkip_timer, 50); */ -+ } -+ -+ /* DEBUG_ERR((" param->u.crypt.key_len =%d\n", param->u.crypt.key_len)); */ -+ DBG_871X(" ~~~~set sta key:unicastkey\n"); -+ -+ rtw_setstakey_cmd(padapter, psta, true, true); -+ } -+ else/* group key */ -+ { -+ if (strcmp(param->u.crypt.alg, "TKIP") == 0 || strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ /* only TKIP group key need to install this */ -+ if (param->u.crypt.key_len > 16) -+ { -+ memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[16]), 8); -+ memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[24]), 8); -+ } -+ padapter->securitypriv.binstallGrpkey = true; -+ /* DEBUG_ERR((" param->u.crypt.key_len =%d\n", param->u.crypt.key_len)); */ -+ DBG_871X(" ~~~~set sta key:groupkey\n"); -+ -+ padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ rtw_set_key(padapter,&padapter->securitypriv, param->u.crypt.idx, 1, true); -+ } -+ else if (strcmp(param->u.crypt.alg, "BIP") == 0) -+ { -+ /* printk("BIP key_len =%d , index =%d @@@@@@@@@@@@@@@@@@\n", param->u.crypt.key_len, param->u.crypt.idx); */ -+ /* save the IGTK key, length 16 bytes */ -+ memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ /*printk("IGTK key below:\n"); -+ for (no = 0;no<16;no++) -+ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); -+ printk("\n");*/ -+ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; -+ padapter->securitypriv.binstallBIPkey = true; -+ DBG_871X(" ~~~~set sta key:IGKT\n"); -+ } -+ } -+ } -+ -+ pbcmc_sta =rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta == NULL) -+ { -+ /* DEBUG_ERR(("Set OID_802_11_ADD_KEY: bcmc stainfo is null\n")); */ -+ } -+ else -+ { -+ /* Jeff: don't disable ieee8021x_blocked while clearing key */ -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ pbcmc_sta->ieee8021x_blocked = false; -+ -+ if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ { -+ pbcmc_sta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ } -+ } -+ else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) /* adhoc mode */ -+ { -+ } -+ } -+ -+exit: -+ -+ if (pwep) { -+ kfree((u8 *)pwep); -+ } -+ return ret; -+} -+ -+static int rtw_set_wpa_ie(struct adapter *padapter, char *pie, unsigned short ielen) -+{ -+ u8 *buf = NULL, *pos = NULL; -+ int group_cipher = 0, pairwise_cipher = 0; -+ int ret = 0; -+ u8 null_addr[]= {0, 0, 0, 0, 0, 0}; -+ -+ if ((ielen > MAX_WPA_IE_LEN) || (pie == NULL)) { -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ if (pie == NULL) -+ return ret; -+ else -+ return -EINVAL; -+ } -+ -+ if (ielen) -+ { -+ buf = rtw_zmalloc(ielen); -+ if (buf == NULL) { -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ memcpy(buf, pie , ielen); -+ -+ /* dump */ -+ { -+ int i; -+ DBG_871X("\n wpa_ie(length:%d):\n", ielen); -+ for (i = 0;isecuritypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype =Ndis802_11AuthModeWPAPSK; -+ memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); -+ } -+ -+ if (rtw_parse_wpa2_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype =Ndis802_11AuthModeWPA2PSK; -+ memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); -+ } -+ -+ if (group_cipher == 0) -+ { -+ group_cipher = WPA_CIPHER_NONE; -+ } -+ if (pairwise_cipher == 0) -+ { -+ pairwise_cipher = WPA_CIPHER_NONE; -+ } -+ -+ switch (group_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus =Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot118021XGrpPrivacy = _TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot118021XGrpPrivacy = _AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ switch (pairwise_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus =Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ {/* set wps_ie */ -+ u16 cnt = 0; -+ u8 eid, wps_oui[4]={0x0, 0x50, 0xf2, 0x04}; -+ -+ while (cnt < ielen) -+ { -+ eid = buf[cnt]; -+ -+ if ((eid == _VENDOR_SPECIFIC_IE_) && (!memcmp(&buf[cnt+2], wps_oui, 4))) -+ { -+ DBG_871X("SET WPS_IE\n"); -+ -+ padapter->securitypriv.wps_ie_len = ((buf[cnt+1]+2) < MAX_WPS_IE_LEN) ? (buf[cnt+1]+2):MAX_WPS_IE_LEN; -+ -+ memcpy(padapter->securitypriv.wps_ie, &buf[cnt], padapter->securitypriv.wps_ie_len); -+ -+ set_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ -+ cnt += buf[cnt+1]+2; -+ -+ break; -+ } else { -+ cnt += buf[cnt+1]+2; /* goto next */ -+ } -+ } -+ } -+ } -+ -+ /* TKIP and AES disallow multicast packets until installing group key */ -+ if (padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) -+ /* WPS open need to enable multicast */ -+ /* check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == true) */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_OFF_RCR_AM, null_addr); -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("rtw_set_wpa_ie: pairwise_cipher = 0x%08x padapter->securitypriv.ndisencryptstatus =%d padapter->securitypriv.ndisauthtype =%d\n", -+ pairwise_cipher, padapter->securitypriv.ndisencryptstatus, padapter->securitypriv.ndisauthtype)); -+ -+exit: -+ -+ if (buf) kfree(buf); -+ -+ return ret; -+} -+ -+static int rtw_wx_get_name(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ u32 ht_ielen = 0; -+ char *p; -+ u8 ht_cap =false, vht_cap =false; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_bssid_ex *pcur_bss = &pmlmepriv->cur_network.network; -+ NDIS_802_11_RATES_EX* prates = NULL; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("cmd_code =%x\n", info->cmd)); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) { -+ /* parsing HT_CAP_IE */ -+ p = rtw_get_ie(&pcur_bss->IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pcur_bss->IELength-12); -+ if (p && ht_ielen>0) -+ { -+ ht_cap = true; -+ } -+ -+ prates = &pcur_bss->SupportedRates; -+ -+ if (rtw_is_cckratesonly_included((u8 *)prates) == true) -+ { -+ if (ht_cap == true) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bn"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11b"); -+ } -+ else if ((rtw_is_cckrates_included((u8 *)prates)) == true) -+ { -+ if (ht_cap == true) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bgn"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bg"); -+ } -+ else -+ { -+ if (pcur_bss->Configuration.DSConfig > 14) -+ { -+ if (vht_cap == true) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11AC"); -+ else if (ht_cap == true) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11an"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11a"); -+ } -+ else -+ { -+ if (ht_cap == true) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11gn"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11g"); -+ } -+ } -+ } -+ else -+ { -+ /* prates = &padapter->registrypriv.dev_network.SupportedRates; */ -+ /* snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11g"); */ -+ snprintf(wrqu->name, IFNAMSIZ, "unassociated"); -+ } -+ return 0; -+} -+ -+static int rtw_wx_set_freq(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, ("+rtw_wx_set_freq\n")); -+ -+ return 0; -+} -+ -+static int rtw_wx_get_freq(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_bssid_ex *pcur_bss = &pmlmepriv->cur_network.network; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ { -+ /* wrqu->freq.m = ieee80211_wlan_frequencies[pcur_bss->Configuration.DSConfig-1] * 100000; */ -+ wrqu->freq.m = rtw_ch2freq(pcur_bss->Configuration.DSConfig) * 100000; -+ wrqu->freq.e = 1; -+ wrqu->freq.i = pcur_bss->Configuration.DSConfig; -+ -+ } -+ else { -+ wrqu->freq.m = rtw_ch2freq(padapter->mlmeextpriv.cur_channel) * 100000; -+ wrqu->freq.e = 1; -+ wrqu->freq.i = padapter->mlmeextpriv.cur_channel; -+ } -+ -+ return 0; -+} -+ -+static int rtw_wx_set_mode(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ enum NDIS_802_11_NETWORK_INFRASTRUCTURE networkType ; -+ int ret = 0; -+ -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ if (padapter->hw_init_completed ==false) { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ switch (wrqu->mode) -+ { -+ case IW_MODE_AUTO: -+ networkType = Ndis802_11AutoUnknown; -+ DBG_871X("set_mode = IW_MODE_AUTO\n"); -+ break; -+ case IW_MODE_ADHOC: -+ networkType = Ndis802_11IBSS; -+ DBG_871X("set_mode = IW_MODE_ADHOC\n"); -+ break; -+ case IW_MODE_MASTER: -+ networkType = Ndis802_11APMode; -+ DBG_871X("set_mode = IW_MODE_MASTER\n"); -+ /* rtw_setopmode_cmd(padapter, networkType, true); */ -+ break; -+ case IW_MODE_INFRA: -+ networkType = Ndis802_11Infrastructure; -+ DBG_871X("set_mode = IW_MODE_INFRA\n"); -+ break; -+ -+ default : -+ ret = -EINVAL;; -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_err_, ("\n Mode: %s is not supported \n", iw_operation_mode[wrqu->mode])); -+ goto exit; -+ } -+ -+/* -+ if (Ndis802_11APMode == networkType) -+ { -+ rtw_setopmode_cmd(padapter, networkType, true); -+ } -+ else -+ { -+ rtw_setopmode_cmd(padapter, Ndis802_11AutoUnknown, true); -+ } -+*/ -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, networkType) ==false) { -+ -+ ret = -EPERM; -+ goto exit; -+ -+ } -+ -+ rtw_setopmode_cmd(padapter, networkType, true); -+ -+exit: -+ return ret; -+} -+ -+static int rtw_wx_get_mode(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, (" rtw_wx_get_mode\n")); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) -+ { -+ wrqu->mode = IW_MODE_INFRA; -+ } -+ else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true)) -+ -+ { -+ wrqu->mode = IW_MODE_ADHOC; -+ } -+ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ wrqu->mode = IW_MODE_MASTER; -+ } -+ else -+ { -+ wrqu->mode = IW_MODE_AUTO; -+ } -+ return 0; -+} -+ -+ -+static int rtw_wx_set_pmkid(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ u8 j, blInserted = false; -+ int intReturn = false; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct iw_pmksa* pPMK = (struct iw_pmksa*) extra; -+ u8 strZeroMacAddress[ ETH_ALEN ] = { 0x00 }; -+ u8 strIssueBssid[ ETH_ALEN ] = { 0x00 }; -+ -+ /* -+ There are the BSSID information in the bssid.sa_data array. -+ If cmd is IW_PMKSA_FLUSH, it means the wpa_suppplicant wants to clear all the PMKID information. -+ If cmd is IW_PMKSA_ADD, it means the wpa_supplicant wants to add a PMKID/BSSID to driver. -+ If cmd is IW_PMKSA_REMOVE, it means the wpa_supplicant wants to remove a PMKID/BSSID from driver. -+ */ -+ -+ memcpy(strIssueBssid, pPMK->bssid.sa_data, ETH_ALEN); -+ if (pPMK->cmd == IW_PMKSA_ADD) -+ { -+ DBG_871X("[rtw_wx_set_pmkid] IW_PMKSA_ADD!\n"); -+ if (!memcmp(strIssueBssid, strZeroMacAddress, ETH_ALEN)) -+ { -+ return(intReturn); -+ } -+ else -+ { -+ intReturn = true; -+ } -+ blInserted = false; -+ -+ /* overwrite PMKID */ -+ for (j = 0 ; jPMKIDList[j].Bssid, strIssueBssid, ETH_ALEN)) -+ { /* BSSID is matched, the same AP => rewrite with new PMKID. */ -+ -+ DBG_871X("[rtw_wx_set_pmkid] BSSID exists in the PMKList.\n"); -+ -+ memcpy(psecuritypriv->PMKIDList[j].PMKID, pPMK->pmkid, IW_PMKID_LEN); -+ psecuritypriv->PMKIDList[ j ].bUsed = true; -+ psecuritypriv->PMKIDIndex = j+1; -+ blInserted = true; -+ break; -+ } -+ } -+ -+ if (!blInserted) -+ { -+ /* Find a new entry */ -+ DBG_871X("[rtw_wx_set_pmkid] Use the new entry index = %d for this PMKID.\n", -+ psecuritypriv->PMKIDIndex); -+ -+ memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, strIssueBssid, ETH_ALEN); -+ memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, pPMK->pmkid, IW_PMKID_LEN); -+ -+ psecuritypriv->PMKIDList[ psecuritypriv->PMKIDIndex ].bUsed = true; -+ psecuritypriv->PMKIDIndex++ ; -+ if (psecuritypriv->PMKIDIndex == 16) -+ { -+ psecuritypriv->PMKIDIndex = 0; -+ } -+ } -+ } -+ else if (pPMK->cmd == IW_PMKSA_REMOVE) -+ { -+ DBG_871X("[rtw_wx_set_pmkid] IW_PMKSA_REMOVE!\n"); -+ intReturn = true; -+ for (j = 0 ; jPMKIDList[j].Bssid, strIssueBssid, ETH_ALEN)) -+ { /* BSSID is matched, the same AP => Remove this PMKID information and reset it. */ -+ memset(psecuritypriv->PMKIDList[ j ].Bssid, 0x00, ETH_ALEN); -+ psecuritypriv->PMKIDList[ j ].bUsed = false; -+ break; -+ } -+ } -+ } -+ else if (pPMK->cmd == IW_PMKSA_FLUSH) -+ { -+ DBG_871X("[rtw_wx_set_pmkid] IW_PMKSA_FLUSH!\n"); -+ memset(&psecuritypriv->PMKIDList[ 0 ], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); -+ psecuritypriv->PMKIDIndex = 0; -+ intReturn = true; -+ } -+ return intReturn; -+} -+ -+static int rtw_wx_get_sens(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ { -+ wrqu->sens.value = 0; -+ wrqu->sens.fixed = 0; /* no auto select */ -+ wrqu->sens.disabled = 1; -+ } -+ return 0; -+} -+ -+static int rtw_wx_get_range(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct iw_range *range = (struct iw_range *)extra; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ u16 val; -+ int i; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_wx_get_range. cmd_code =%x\n", info->cmd)); -+ -+ wrqu->data.length = sizeof(*range); -+ memset(range, 0, sizeof(*range)); -+ -+ /* Let's try to keep this struct in the same order as in -+ * linux/include/wireless.h -+ */ -+ -+ /* TODO: See what values we can set, and remove the ones we can't -+ * set, or fill them with some default data. -+ */ -+ -+ /* ~5 Mb/s real (802.11b) */ -+ range->throughput = 5 * 1000 * 1000; -+ -+ /* signal level threshold range */ -+ -+ /* percent values between 0 and 100. */ -+ range->max_qual.qual = 100; -+ range->max_qual.level = 100; -+ range->max_qual.noise = 100; -+ range->max_qual.updated = 7; /* Updated all three */ -+ -+ -+ range->avg_qual.qual = 92; /* > 8% missed beacons is 'bad' */ -+ /* TODO: Find real 'good' to 'bad' threshol value for RSSI */ -+ range->avg_qual.level = 256 - 78; -+ range->avg_qual.noise = 0; -+ range->avg_qual.updated = 7; /* Updated all three */ -+ -+ range->num_bitrates = RATE_COUNT; -+ -+ for (i = 0; i < RATE_COUNT && i < IW_MAX_BITRATES; i++) { -+ range->bitrate[i] = rtw_rates[i]; -+ } -+ -+ range->min_frag = MIN_FRAG_THRESHOLD; -+ range->max_frag = MAX_FRAG_THRESHOLD; -+ -+ range->pm_capa = 0; -+ -+ range->we_version_compiled = WIRELESS_EXT; -+ range->we_version_source = 16; -+ -+ for (i = 0, val = 0; i < MAX_CHANNEL_NUM; i++) { -+ -+ /* Include only legal frequencies for some countries */ -+ if (pmlmeext->channel_set[i].ChannelNum != 0) -+ { -+ range->freq[val].i = pmlmeext->channel_set[i].ChannelNum; -+ range->freq[val].m = rtw_ch2freq(pmlmeext->channel_set[i].ChannelNum) * 100000; -+ range->freq[val].e = 1; -+ val++; -+ } -+ -+ if (val == IW_MAX_FREQUENCIES) -+ break; -+ } -+ -+ range->num_channels = val; -+ range->num_frequency = val; -+ -+/* Commented by Albert 2009/10/13 */ -+/* The following code will proivde the security capability to network manager. */ -+/* If the driver doesn't provide this capability to network manager, */ -+/* the WPA/WPA2 routers can't be choosen in the network manager. */ -+ -+/* -+#define IW_SCAN_CAPA_NONE 0x00 -+#define IW_SCAN_CAPA_ESSID 0x01 -+#define IW_SCAN_CAPA_BSSID 0x02 -+#define IW_SCAN_CAPA_CHANNEL 0x04 -+#define IW_SCAN_CAPA_MODE 0x08 -+#define IW_SCAN_CAPA_RATE 0x10 -+#define IW_SCAN_CAPA_TYPE 0x20 -+#define IW_SCAN_CAPA_TIME 0x40 -+*/ -+ -+ range->enc_capa = IW_ENC_CAPA_WPA|IW_ENC_CAPA_WPA2| -+ IW_ENC_CAPA_CIPHER_TKIP|IW_ENC_CAPA_CIPHER_CCMP; -+ -+ range->scan_capa = IW_SCAN_CAPA_ESSID | IW_SCAN_CAPA_TYPE |IW_SCAN_CAPA_BSSID| -+ IW_SCAN_CAPA_CHANNEL|IW_SCAN_CAPA_MODE|IW_SCAN_CAPA_RATE; -+ -+ return 0; -+} -+ -+/* set bssid flow */ -+/* s1. rtw_set_802_11_infrastructure_mode() */ -+/* s2. rtw_set_802_11_authentication_mode() */ -+/* s3. set_802_11_encryption_mode() */ -+/* s4. rtw_set_802_11_bssid() */ -+static int rtw_wx_set_wap(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *awrq, -+ char *extra) -+{ -+ uint ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct sockaddr *temp = (struct sockaddr *)awrq; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct list_head *phead; -+ u8 *dst_bssid, *src_bssid; -+ struct __queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ enum NDIS_802_11_AUTHENTICATION_MODE authmode; -+ -+ rtw_ps_deny(padapter, PS_DENY_JOIN); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) -+ { -+ ret = -1; -+ goto exit; -+ } -+ -+ if (!padapter->bup) { -+ ret = -1; -+ goto exit; -+ } -+ -+ -+ if (temp->sa_family != ARPHRD_ETHER) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ authmode = padapter->securitypriv.ndisauthtype; -+ spin_lock_bh(&queue->lock); -+ phead = get_list_head(queue); -+ pmlmepriv->pscanned = get_next(phead); -+ -+ while (1) { -+ if (phead == pmlmepriv->pscanned) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); -+ -+ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); -+ -+ dst_bssid = pnetwork->network.MacAddress; -+ -+ src_bssid = temp->sa_data; -+ -+ if ((!memcmp(dst_bssid, src_bssid, ETH_ALEN))) -+ { -+ if (!rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode)) -+ { -+ ret = -1; -+ spin_unlock_bh(&queue->lock); -+ goto exit; -+ } -+ -+ break; -+ } -+ -+ } -+ spin_unlock_bh(&queue->lock); -+ -+ rtw_set_802_11_authentication_mode(padapter, authmode); -+ /* set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); */ -+ if (rtw_set_802_11_bssid(padapter, temp->sa_data) == false) { -+ ret = -1; -+ goto exit; -+ } -+ -+exit: -+ -+ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); -+ -+ return ret; -+} -+ -+static int rtw_wx_get_wap(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_bssid_ex *pcur_bss = &pmlmepriv->cur_network.network; -+ -+ wrqu->ap_addr.sa_family = ARPHRD_ETHER; -+ -+ memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_wx_get_wap\n")); -+ -+ if (((check_fwstate(pmlmepriv, _FW_LINKED)) == true) || -+ ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == true) || -+ ((check_fwstate(pmlmepriv, WIFI_AP_STATE)) == true)) -+ { -+ -+ memcpy(wrqu->ap_addr.sa_data, pcur_bss->MacAddress, ETH_ALEN); -+ } -+ else -+ { -+ memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN); -+ } -+ -+ return 0; -+} -+ -+static int rtw_wx_set_mlme(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ u16 reason; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct iw_mlme *mlme = (struct iw_mlme *) extra; -+ -+ -+ if (mlme == NULL) -+ return -1; -+ -+ DBG_871X("%s\n", __func__); -+ -+ reason = mlme->reason_code; -+ -+ DBG_871X("%s, cmd =%d, reason =%d\n", __func__, mlme->cmd, reason); -+ -+ switch (mlme->cmd) -+ { -+ case IW_MLME_DEAUTH: -+ if (!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ break; -+ case IW_MLME_DISASSOC: -+ if (!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ break; -+ default: -+ return -EOPNOTSUPP; -+ } -+ -+ return ret; -+} -+ -+static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ u8 _status = false; -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ndis_802_11_ssid ssid[RTW_SSID_SCAN_AMOUNT]; -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_wx_set_scan\n")); -+ -+ #ifdef DBG_IOCTL -+ DBG_871X("DBG_IOCTL %s:%d\n", __func__, __LINE__); -+ #endif -+ -+ rtw_ps_deny(padapter, PS_DENY_SCAN); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) -+ { -+ ret = -1; -+ goto exit; -+ } -+ -+ if (padapter->bDriverStopped) { -+ DBG_871X("bDriverStopped =%d\n", padapter->bDriverStopped); -+ ret = -1; -+ goto exit; -+ } -+ -+ if (!padapter->bup) { -+ ret = -1; -+ goto exit; -+ } -+ -+ if (padapter->hw_init_completed ==false) { -+ ret = -1; -+ goto exit; -+ } -+ -+ /* When Busy Traffic, driver do not site survey. So driver return success. */ -+ /* wpa_supplicant will not issue SIOCSIWSCAN cmd again after scan timeout. */ -+ /* modify by thomas 2011-02-22. */ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == true) -+ { -+ indicate_wx_scan_complete_event(padapter); -+ goto exit; -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) -+ { -+ indicate_wx_scan_complete_event(padapter); -+ goto exit; -+ } -+ -+ memset(ssid, 0, sizeof(struct ndis_802_11_ssid)*RTW_SSID_SCAN_AMOUNT); -+ -+ if (wrqu->data.length == sizeof(struct iw_scan_req)) -+ { -+ struct iw_scan_req *req = (struct iw_scan_req *)extra; -+ -+ if (wrqu->data.flags & IW_SCAN_THIS_ESSID) -+ { -+ int len = min((int)req->essid_len, IW_ESSID_MAX_SIZE); -+ -+ memcpy(ssid[0].Ssid, req->essid, len); -+ ssid[0].SsidLength = len; -+ -+ DBG_871X("IW_SCAN_THIS_ESSID, ssid =%s, len =%d\n", req->essid, req->essid_len); -+ -+ spin_lock_bh(&pmlmepriv->lock); -+ -+ _status = rtw_sitesurvey_cmd(padapter, ssid, 1, NULL, 0); -+ -+ spin_unlock_bh(&pmlmepriv->lock); -+ -+ } -+ else if (req->scan_type == IW_SCAN_TYPE_PASSIVE) -+ { -+ DBG_871X("rtw_wx_set_scan, req->scan_type == IW_SCAN_TYPE_PASSIVE\n"); -+ } -+ -+ } -+ else if (wrqu->data.length >= WEXT_CSCAN_HEADER_SIZE -+ && !memcmp(extra, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) -+ ) -+ { -+ int len = wrqu->data.length -WEXT_CSCAN_HEADER_SIZE; -+ char *pos = extra+WEXT_CSCAN_HEADER_SIZE; -+ char section; -+ char sec_len; -+ int ssid_index = 0; -+ -+ /* DBG_871X("%s COMBO_SCAN header is recognized\n", __func__); */ -+ -+ while (len >= 1) { -+ section = *(pos++); len-= 1; -+ -+ switch (section) { -+ case WEXT_CSCAN_SSID_SECTION: -+ /* DBG_871X("WEXT_CSCAN_SSID_SECTION\n"); */ -+ if (len < 1) { -+ len = 0; -+ break; -+ } -+ -+ sec_len = *(pos++); len-= 1; -+ -+ if (sec_len>0 && sec_len<=len) { -+ ssid[ssid_index].SsidLength = sec_len; -+ memcpy(ssid[ssid_index].Ssid, pos, ssid[ssid_index].SsidLength); -+ /* DBG_871X("%s COMBO_SCAN with specific ssid:%s, %d\n", __func__ */ -+ /* , ssid[ssid_index].Ssid, ssid[ssid_index].SsidLength); */ -+ ssid_index++; -+ } -+ -+ pos+=sec_len; len-=sec_len; -+ break; -+ -+ -+ case WEXT_CSCAN_CHANNEL_SECTION: -+ /* DBG_871X("WEXT_CSCAN_CHANNEL_SECTION\n"); */ -+ pos+= 1; len-= 1; -+ break; -+ case WEXT_CSCAN_ACTV_DWELL_SECTION: -+ /* DBG_871X("WEXT_CSCAN_ACTV_DWELL_SECTION\n"); */ -+ pos+=2; len-=2; -+ break; -+ case WEXT_CSCAN_PASV_DWELL_SECTION: -+ /* DBG_871X("WEXT_CSCAN_PASV_DWELL_SECTION\n"); */ -+ pos+=2; len-=2; -+ break; -+ case WEXT_CSCAN_HOME_DWELL_SECTION: -+ /* DBG_871X("WEXT_CSCAN_HOME_DWELL_SECTION\n"); */ -+ pos+=2; len-=2; -+ break; -+ case WEXT_CSCAN_TYPE_SECTION: -+ /* DBG_871X("WEXT_CSCAN_TYPE_SECTION\n"); */ -+ pos+= 1; len-= 1; -+ break; -+ default: -+ /* DBG_871X("Unknown CSCAN section %c\n", section); */ -+ len = 0; /* stop parsing */ -+ } -+ /* DBG_871X("len:%d\n", len); */ -+ -+ } -+ -+ /* jeff: it has still some scan paramater to parse, we only do this now... */ -+ _status = rtw_set_802_11_bssid_list_scan(padapter, ssid, RTW_SSID_SCAN_AMOUNT); -+ -+ } else -+ -+ { -+ _status = rtw_set_802_11_bssid_list_scan(padapter, NULL, 0); -+ } -+ -+ if (_status == false) -+ ret = -1; -+ -+exit: -+ -+ rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); -+ -+ #ifdef DBG_IOCTL -+ DBG_871X("DBG_IOCTL %s:%d return %d\n", __func__, __LINE__, ret); -+ #endif -+ -+ return ret; -+} -+ -+static int rtw_wx_get_scan(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct list_head *plist, *phead; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct __queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ char *ev = extra; -+ char *stop = ev + wrqu->data.length; -+ u32 ret = 0; -+ sint wait_status; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_wx_get_scan\n")); -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, (" Start of Query SIOCGIWSCAN .\n")); -+ -+ #ifdef DBG_IOCTL -+ DBG_871X("DBG_IOCTL %s:%d\n", __func__, __LINE__); -+ #endif -+ -+ if (adapter_to_pwrctl(padapter)->brfoffbyhw && padapter->bDriverStopped) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ wait_status = _FW_UNDER_SURVEY | _FW_UNDER_LINKING; -+ -+ if (check_fwstate(pmlmepriv, wait_status)) -+ return -EAGAIN; -+ -+ spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) -+ { -+ if (phead == plist) -+ break; -+ -+ if ((stop - ev) < SCAN_ITEM_SIZE) { -+ ret = -E2BIG; -+ break; -+ } -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ /* report network only if the current channel set contains the channel to which this network belongs */ -+ if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 -+ && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == true -+ && true == rtw_validate_ssid(&(pnetwork->network.Ssid)) -+ ) -+ { -+ ev =translate_scan(padapter, a, pnetwork, ev, stop); -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ -+ wrqu->data.length = ev-extra; -+ wrqu->data.flags = 0; -+ -+exit: -+ -+ #ifdef DBG_IOCTL -+ DBG_871X("DBG_IOCTL %s:%d return %d\n", __func__, __LINE__, ret); -+ #endif -+ -+ return ret ; -+ -+} -+ -+/* set ssid flow */ -+/* s1. rtw_set_802_11_infrastructure_mode() */ -+/* s2. set_802_11_authenticaion_mode() */ -+/* s3. set_802_11_encryption_mode() */ -+/* s4. rtw_set_802_11_ssid() */ -+static int rtw_wx_set_essid(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct __queue *queue = &pmlmepriv->scanned_queue; -+ struct list_head *phead; -+ struct wlan_network *pnetwork = NULL; -+ enum NDIS_802_11_AUTHENTICATION_MODE authmode; -+ struct ndis_802_11_ssid ndis_ssid; -+ u8 *dst_ssid, *src_ssid; -+ -+ uint ret = 0, len; -+ -+ #ifdef DBG_IOCTL -+ DBG_871X("DBG_IOCTL %s:%d\n", __func__, __LINE__); -+ #endif -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("+rtw_wx_set_essid: fw_state = 0x%08x\n", get_fwstate(pmlmepriv))); -+ -+ rtw_ps_deny(padapter, PS_DENY_JOIN); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) -+ { -+ ret = -1; -+ goto exit; -+ } -+ -+ if (!padapter->bup) { -+ ret = -1; -+ goto exit; -+ } -+ -+ if (wrqu->essid.length > IW_ESSID_MAX_SIZE) { -+ ret = -E2BIG; -+ goto exit; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ ret = -1; -+ goto exit; -+ } -+ -+ authmode = padapter->securitypriv.ndisauthtype; -+ DBG_871X("=>%s\n", __func__); -+ if (wrqu->essid.flags && wrqu->essid.length) -+ { -+ len = (wrqu->essid.length < IW_ESSID_MAX_SIZE) ? wrqu->essid.length : IW_ESSID_MAX_SIZE; -+ -+ if (wrqu->essid.length != 33) -+ DBG_871X("ssid =%s, len =%d\n", extra, wrqu->essid.length); -+ -+ memset(&ndis_ssid, 0, sizeof(struct ndis_802_11_ssid)); -+ ndis_ssid.SsidLength = len; -+ memcpy(ndis_ssid.Ssid, extra, len); -+ src_ssid = ndis_ssid.Ssid; -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, ("rtw_wx_set_essid: ssid =[%s]\n", src_ssid)); -+ spin_lock_bh(&queue->lock); -+ phead = get_list_head(queue); -+ pmlmepriv->pscanned = get_next(phead); -+ -+ while (1) { -+ if (phead == pmlmepriv->pscanned) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_warning_, -+ ("rtw_wx_set_essid: scan_q is empty, set ssid to check if scanning again!\n")); -+ -+ break; -+ } -+ -+ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); -+ -+ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); -+ -+ dst_ssid = pnetwork->network.Ssid.Ssid; -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("rtw_wx_set_essid: dst_ssid =%s\n", -+ pnetwork->network.Ssid.Ssid)); -+ -+ if ((!memcmp(dst_ssid, src_ssid, ndis_ssid.SsidLength)) && -+ (pnetwork->network.Ssid.SsidLength ==ndis_ssid.SsidLength)) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("rtw_wx_set_essid: find match, set infra mode\n")); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) -+ { -+ if (pnetwork->network.InfrastructureMode != pmlmepriv->cur_network.network.InfrastructureMode) -+ continue; -+ } -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode) == false) -+ { -+ ret = -1; -+ spin_unlock_bh(&queue->lock); -+ goto exit; -+ } -+ -+ break; -+ } -+ } -+ spin_unlock_bh(&queue->lock); -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("set ssid: set_802_11_auth. mode =%d\n", authmode)); -+ rtw_set_802_11_authentication_mode(padapter, authmode); -+ /* set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); */ -+ if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == false) { -+ ret = -1; -+ goto exit; -+ } -+ } -+ -+exit: -+ -+ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); -+ -+ DBG_871X("<=%s, ret %d\n", __func__, ret); -+ -+ #ifdef DBG_IOCTL -+ DBG_871X("DBG_IOCTL %s:%d return %d\n", __func__, __LINE__, ret); -+ #endif -+ -+ return ret; -+} -+ -+static int rtw_wx_get_essid(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ u32 len, ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_bssid_ex *pcur_bss = &pmlmepriv->cur_network.network; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_wx_get_essid\n")); -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) -+ { -+ len = pcur_bss->Ssid.SsidLength; -+ -+ wrqu->essid.length = len; -+ -+ memcpy(extra, pcur_bss->Ssid.Ssid, len); -+ -+ wrqu->essid.flags = 1; -+ } -+ else -+ { -+ ret = -1; -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+static int rtw_wx_set_rate(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int i, ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ u8 datarates[NumRates]; -+ u32 target_rate = wrqu->bitrate.value; -+ u32 fixed = wrqu->bitrate.fixed; -+ u32 ratevalue = 0; -+ u8 mpdatarate[NumRates]={11, 10, 9, 8, 7, 6, 5, 4, 3, 2, 1, 0, 0xff}; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, (" rtw_wx_set_rate\n")); -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, ("target_rate = %d, fixed = %d\n", target_rate, fixed)); -+ -+ if (target_rate == -1) { -+ ratevalue = 11; -+ goto set_rate; -+ } -+ target_rate = target_rate/100000; -+ -+ switch (target_rate) { -+ case 10: -+ ratevalue = 0; -+ break; -+ case 20: -+ ratevalue = 1; -+ break; -+ case 55: -+ ratevalue = 2; -+ break; -+ case 60: -+ ratevalue = 3; -+ break; -+ case 90: -+ ratevalue = 4; -+ break; -+ case 110: -+ ratevalue = 5; -+ break; -+ case 120: -+ ratevalue = 6; -+ break; -+ case 180: -+ ratevalue = 7; -+ break; -+ case 240: -+ ratevalue = 8; -+ break; -+ case 360: -+ ratevalue = 9; -+ break; -+ case 480: -+ ratevalue = 10; -+ break; -+ case 540: -+ ratevalue = 11; -+ break; -+ default: -+ ratevalue = 11; -+ break; -+ } -+ -+set_rate: -+ -+ for (i = 0; ibitrate.fixed = 0; /* no auto select */ -+ wrqu->bitrate.value = max_rate * 100000; -+ -+ return 0; -+} -+ -+static int rtw_wx_set_rts(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ if (wrqu->rts.disabled) -+ padapter->registrypriv.rts_thresh = 2347; -+ else { -+ if (wrqu->rts.value < 0 || -+ wrqu->rts.value > 2347) -+ return -EINVAL; -+ -+ padapter->registrypriv.rts_thresh = wrqu->rts.value; -+ } -+ -+ DBG_871X("%s, rts_thresh =%d\n", __func__, padapter->registrypriv.rts_thresh); -+ -+ return 0; -+} -+ -+static int rtw_wx_get_rts(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X("%s, rts_thresh =%d\n", __func__, padapter->registrypriv.rts_thresh); -+ -+ wrqu->rts.value = padapter->registrypriv.rts_thresh; -+ wrqu->rts.fixed = 0; /* no auto select */ -+ /* wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD); */ -+ -+ return 0; -+} -+ -+static int rtw_wx_set_frag(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ if (wrqu->frag.disabled) -+ padapter->xmitpriv.frag_len = MAX_FRAG_THRESHOLD; -+ else { -+ if (wrqu->frag.value < MIN_FRAG_THRESHOLD || -+ wrqu->frag.value > MAX_FRAG_THRESHOLD) -+ return -EINVAL; -+ -+ padapter->xmitpriv.frag_len = wrqu->frag.value & ~0x1; -+ } -+ -+ DBG_871X("%s, frag_len =%d\n", __func__, padapter->xmitpriv.frag_len); -+ -+ return 0; -+ -+} -+ -+static int rtw_wx_get_frag(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X("%s, frag_len =%d\n", __func__, padapter->xmitpriv.frag_len); -+ -+ wrqu->frag.value = padapter->xmitpriv.frag_len; -+ wrqu->frag.fixed = 0; /* no auto select */ -+ /* wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FRAG_THRESHOLD); */ -+ -+ return 0; -+} -+ -+static int rtw_wx_get_retry(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ /* struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); */ -+ -+ -+ wrqu->retry.value = 7; -+ wrqu->retry.fixed = 0; /* no auto select */ -+ wrqu->retry.disabled = 1; -+ -+ return 0; -+ -+} -+ -+static int rtw_wx_set_enc(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *keybuf) -+{ -+ u32 key, ret = 0; -+ u32 keyindex_provided; -+ struct ndis_802_11_wep wep; -+ enum NDIS_802_11_AUTHENTICATION_MODE authmode; -+ -+ struct iw_point *erq = &(wrqu->encoding); -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ DBG_871X("+rtw_wx_set_enc, flags = 0x%x\n", erq->flags); -+ -+ memset(&wep, 0, sizeof(struct ndis_802_11_wep)); -+ -+ key = erq->flags & IW_ENCODE_INDEX; -+ -+ if (erq->flags & IW_ENCODE_DISABLED) -+ { -+ DBG_871X("EncryptionDisabled\n"); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ -+ authmode = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.ndisauthtype =authmode; -+ -+ goto exit; -+ } -+ -+ if (key) { -+ if (key > WEP_KEYS) -+ return -EINVAL; -+ key--; -+ keyindex_provided = 1; -+ } -+ else -+ { -+ keyindex_provided = 0; -+ key = padapter->securitypriv.dot11PrivacyKeyIndex; -+ DBG_871X("rtw_wx_set_enc, key =%d\n", key); -+ } -+ -+ /* set authentication mode */ -+ if (erq->flags & IW_ENCODE_OPEN) -+ { -+ DBG_871X("rtw_wx_set_enc():IW_ENCODE_OPEN\n"); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;/* Ndis802_11EncryptionDisabled; */ -+ -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; -+ authmode = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.ndisauthtype =authmode; -+ } -+ else if (erq->flags & IW_ENCODE_RESTRICTED) -+ { -+ DBG_871X("rtw_wx_set_enc():IW_ENCODE_RESTRICTED\n"); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; -+ -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP40_; -+ authmode = Ndis802_11AuthModeShared; -+ padapter->securitypriv.ndisauthtype =authmode; -+ } -+ else -+ { -+ DBG_871X("rtw_wx_set_enc():erq->flags = 0x%x\n", erq->flags); -+ -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;/* Ndis802_11EncryptionDisabled; */ -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; -+ authmode = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.ndisauthtype =authmode; -+ } -+ -+ wep.KeyIndex = key; -+ if (erq->length > 0) -+ { -+ wep.KeyLength = erq->length <= 5 ? 5 : 13; -+ -+ wep.Length = wep.KeyLength + FIELD_OFFSET(struct ndis_802_11_wep, KeyMaterial); -+ } -+ else -+ { -+ wep.KeyLength = 0 ; -+ -+ if (keyindex_provided == 1)/* set key_id only, no given KeyMaterial(erq->length == 0). */ -+ { -+ padapter->securitypriv.dot11PrivacyKeyIndex = key; -+ -+ DBG_871X("(keyindex_provided == 1), keyid =%d, key_len =%d\n", key, padapter->securitypriv.dot11DefKeylen[key]); -+ -+ switch (padapter->securitypriv.dot11DefKeylen[key]) -+ { -+ case 5: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; -+ break; -+ case 13: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; -+ break; -+ default: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ break; -+ } -+ -+ goto exit; -+ -+ } -+ -+ } -+ -+ wep.KeyIndex |= 0x80000000; -+ -+ memcpy(wep.KeyMaterial, keybuf, wep.KeyLength); -+ -+ if (rtw_set_802_11_add_wep(padapter, &wep) == false) { -+ if (rf_on == pwrpriv->rf_pwrstate) -+ ret = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+static int rtw_wx_get_enc(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *keybuf) -+{ -+ uint key, ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct iw_point *erq = &(wrqu->encoding); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) != true) -+ { -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != true) -+ { -+ erq->length = 0; -+ erq->flags |= IW_ENCODE_DISABLED; -+ return 0; -+ } -+ } -+ -+ -+ key = erq->flags & IW_ENCODE_INDEX; -+ -+ if (key) { -+ if (key > WEP_KEYS) -+ return -EINVAL; -+ key--; -+ } else -+ { -+ key = padapter->securitypriv.dot11PrivacyKeyIndex; -+ } -+ -+ erq->flags = key + 1; -+ -+ /* if (padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen) */ -+ /* */ -+ /* erq->flags |= IW_ENCODE_OPEN; */ -+ /* */ -+ -+ switch (padapter->securitypriv.ndisencryptstatus) -+ { -+ case Ndis802_11EncryptionNotSupported: -+ case Ndis802_11EncryptionDisabled: -+ erq->length = 0; -+ erq->flags |= IW_ENCODE_DISABLED; -+ break; -+ case Ndis802_11Encryption1Enabled: -+ erq->length = padapter->securitypriv.dot11DefKeylen[key]; -+ -+ if (erq->length) -+ { -+ memcpy(keybuf, padapter->securitypriv.dot11DefKey[key].skey, padapter->securitypriv.dot11DefKeylen[key]); -+ -+ erq->flags |= IW_ENCODE_ENABLED; -+ -+ if (padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen) -+ { -+ erq->flags |= IW_ENCODE_OPEN; -+ } -+ else if (padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeShared) -+ { -+ erq->flags |= IW_ENCODE_RESTRICTED; -+ } -+ } -+ else -+ { -+ erq->length = 0; -+ erq->flags |= IW_ENCODE_DISABLED; -+ } -+ break; -+ case Ndis802_11Encryption2Enabled: -+ case Ndis802_11Encryption3Enabled: -+ erq->length = 16; -+ erq->flags |= (IW_ENCODE_ENABLED | IW_ENCODE_OPEN | IW_ENCODE_NOKEY); -+ break; -+ default: -+ erq->length = 0; -+ erq->flags |= IW_ENCODE_DISABLED; -+ break; -+ } -+ return ret; -+} -+ -+static int rtw_wx_get_power(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ /* struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); */ -+ -+ wrqu->power.value = 0; -+ wrqu->power.fixed = 0; /* no auto select */ -+ wrqu->power.disabled = 1; -+ -+ return 0; -+} -+ -+static int rtw_wx_set_gen_ie(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ ret = rtw_set_wpa_ie(padapter, extra, wrqu->data.length); -+ -+ return ret; -+} -+ -+static int rtw_wx_set_auth(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct iw_param *param = (struct iw_param*)&(wrqu->param); -+ int ret = 0; -+ -+ switch (param->flags & IW_AUTH_INDEX) { -+ -+ case IW_AUTH_WPA_VERSION: -+ break; -+ case IW_AUTH_CIPHER_PAIRWISE: -+ -+ break; -+ case IW_AUTH_CIPHER_GROUP: -+ -+ break; -+ case IW_AUTH_KEY_MGMT: -+ /* -+ * ??? does not use these parameters -+ */ -+ break; -+ -+ case IW_AUTH_TKIP_COUNTERMEASURES: -+ { -+ if (param->value) -+ { /* wpa_supplicant is enabling the tkip countermeasure. */ -+ padapter->securitypriv.btkip_countermeasure = true; -+ } -+ else -+ { /* wpa_supplicant is disabling the tkip countermeasure. */ -+ padapter->securitypriv.btkip_countermeasure = false; -+ } -+ break; -+ } -+ case IW_AUTH_DROP_UNENCRYPTED: -+ { -+ /* HACK: -+ * -+ * wpa_supplicant calls set_wpa_enabled when the driver -+ * is loaded and unloaded, regardless of if WPA is being -+ * used. No other calls are made which can be used to -+ * determine if encryption will be used or not prior to -+ * association being expected. If encryption is not being -+ * used, drop_unencrypted is set to false, else true -- we -+ * can use this to determine if the CAP_PRIVACY_ON bit should -+ * be set. -+ */ -+ -+ if (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption1Enabled) -+ { -+ break;/* it means init value, or using wep, ndisencryptstatus = Ndis802_11Encryption1Enabled, */ -+ /* then it needn't reset it; */ -+ } -+ -+ if (param->value) { -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ -+ padapter->securitypriv.ndisauthtype =Ndis802_11AuthModeOpen; -+ } -+ -+ break; -+ } -+ -+ case IW_AUTH_80211_AUTH_ALG: -+ -+ /* -+ * It's the starting point of a link layer connection using wpa_supplicant -+ */ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { -+ LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, false); -+ DBG_871X("%s...call rtw_indicate_disconnect\n ", __func__); -+ rtw_indicate_disconnect(padapter); -+ rtw_free_assoc_resources(padapter, 1); -+ } -+ -+ -+ ret = wpa_set_auth_algs(dev, (u32)param->value); -+ -+ break; -+ -+ case IW_AUTH_WPA_ENABLED: -+ break; -+ case IW_AUTH_RX_UNENCRYPTED_EAPOL: -+ break; -+ case IW_AUTH_PRIVACY_INVOKED: -+ break; -+ default: -+ return -EOPNOTSUPP; -+ } -+ return ret; -+} -+ -+static int rtw_wx_set_enc_ext(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ char *alg_name; -+ u32 param_len; -+ struct ieee_param *param = NULL; -+ struct iw_point *pencoding = &wrqu->encoding; -+ struct iw_encode_ext *pext = (struct iw_encode_ext *)extra; -+ int ret = 0; -+ -+ param_len = sizeof(struct ieee_param) + pext->key_len; -+ param = (struct ieee_param *)rtw_malloc(param_len); -+ if (param == NULL) -+ return -1; -+ -+ memset(param, 0, param_len); -+ -+ param->cmd = IEEE_CMD_SET_ENCRYPTION; -+ memset(param->sta_addr, 0xff, ETH_ALEN); -+ -+ -+ switch (pext->alg) { -+ case IW_ENCODE_ALG_NONE: -+ /* todo: remove key */ -+ /* remove = 1; */ -+ alg_name = "none"; -+ break; -+ case IW_ENCODE_ALG_WEP: -+ alg_name = "WEP"; -+ break; -+ case IW_ENCODE_ALG_TKIP: -+ alg_name = "TKIP"; -+ break; -+ case IW_ENCODE_ALG_CCMP: -+ alg_name = "CCMP"; -+ break; -+ case IW_ENCODE_ALG_AES_CMAC: -+ alg_name = "BIP"; -+ break; -+ default: -+ ret = -1; -+ goto exit; -+ } -+ -+ strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN); -+ -+ if (pext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) -+ { -+ param->u.crypt.set_tx = 1; -+ } -+ -+ /* cliW: WEP does not have group key -+ * just not checking GROUP key setting -+ */ -+ if ((pext->alg != IW_ENCODE_ALG_WEP) && -+ ((pext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) -+ || (pext->ext_flags & IW_ENCODE_ALG_AES_CMAC) -+ )) -+ { -+ param->u.crypt.set_tx = 0; -+ } -+ -+ param->u.crypt.idx = (pencoding->flags&0x00FF) -1 ; -+ -+ if (pext->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) -+ { -+ memcpy(param->u.crypt.seq, pext->rx_seq, 8); -+ } -+ -+ if (pext->key_len) -+ { -+ param->u.crypt.key_len = pext->key_len; -+ /* memcpy(param + 1, pext + 1, pext->key_len); */ -+ memcpy(param->u.crypt.key, pext + 1, pext->key_len); -+ } -+ -+ if (pencoding->flags & IW_ENCODE_DISABLED) -+ { -+ /* todo: remove key */ -+ /* remove = 1; */ -+ } -+ -+ ret = wpa_set_encryption(dev, param, param_len); -+ -+exit: -+ if (param) -+ { -+ kfree((u8 *)param); -+ } -+ -+ return ret; -+} -+ -+ -+static int rtw_wx_get_nick(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ /* struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); */ -+ /* struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); */ -+ /* struct security_priv *psecuritypriv = &padapter->securitypriv; */ -+ -+ if (extra) -+ { -+ wrqu->data.length = 14; -+ wrqu->data.flags = 1; -+ memcpy(extra, "", 14); -+ } -+ return 0; -+} -+ -+static int rtw_wx_read32(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter; -+ struct iw_point *p; -+ u16 len; -+ u32 addr; -+ u32 data32; -+ u32 bytes; -+ u8 *ptmp; -+ int ret; -+ -+ -+ ret = 0; -+ padapter = (struct adapter *)rtw_netdev_priv(dev); -+ p = &wrqu->data; -+ len = p->length; -+ if (0 == len) -+ return -EINVAL; -+ -+ ptmp = (u8 *)rtw_malloc(len); -+ if (NULL == ptmp) -+ return -ENOMEM; -+ -+ if (copy_from_user(ptmp, p->pointer, len)) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ -+ bytes = 0; -+ addr = 0; -+ sscanf(ptmp, "%d,%x", &bytes, &addr); -+ -+ switch (bytes) { -+ case 1: -+ data32 = rtw_read8(padapter, addr); -+ sprintf(extra, "0x%02X", data32); -+ break; -+ case 2: -+ data32 = rtw_read16(padapter, addr); -+ sprintf(extra, "0x%04X", data32); -+ break; -+ case 4: -+ data32 = rtw_read32(padapter, addr); -+ sprintf(extra, "0x%08X", data32); -+ break; -+ default: -+ DBG_871X(KERN_INFO "%s: usage> read [bytes],[address(hex)]\n", __func__); -+ ret = -EINVAL; -+ goto exit; -+ } -+ DBG_871X(KERN_INFO "%s: addr = 0x%08X data =%s\n", __func__, addr, extra); -+ -+exit: -+ kfree(ptmp); -+ -+ return 0; -+} -+ -+static int rtw_wx_write32(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ u32 addr; -+ u32 data32; -+ u32 bytes; -+ -+ -+ bytes = 0; -+ addr = 0; -+ data32 = 0; -+ sscanf(extra, "%d,%x,%x", &bytes, &addr, &data32); -+ -+ switch (bytes) { -+ case 1: -+ rtw_write8(padapter, addr, (u8)data32); -+ DBG_871X(KERN_INFO "%s: addr = 0x%08X data = 0x%02X\n", __func__, addr, (u8)data32); -+ break; -+ case 2: -+ rtw_write16(padapter, addr, (u16)data32); -+ DBG_871X(KERN_INFO "%s: addr = 0x%08X data = 0x%04X\n", __func__, addr, (u16)data32); -+ break; -+ case 4: -+ rtw_write32(padapter, addr, data32); -+ DBG_871X(KERN_INFO "%s: addr = 0x%08X data = 0x%08X\n", __func__, addr, data32); -+ break; -+ default: -+ DBG_871X(KERN_INFO "%s: usage> write [bytes],[address(hex)],[data(hex)]\n", __func__); -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int rtw_wx_read_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ u32 path, addr, data32; -+ -+ -+ path = *(u32*)extra; -+ addr = *((u32*)extra + 1); -+ data32 = rtw_hal_read_rfreg(padapter, path, addr, 0xFFFFF); -+ /* -+ * IMPORTANT!! -+ * Only when wireless private ioctl is at odd order, -+ * "extra" would be copied to user space. -+ */ -+ sprintf(extra, "0x%05x", data32); -+ -+ return 0; -+} -+ -+static int rtw_wx_write_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ u32 path, addr, data32; -+ -+ -+ path = *(u32*)extra; -+ addr = *((u32*)extra + 1); -+ data32 = *((u32*)extra + 2); -+/* DBG_871X("%s: path =%d addr = 0x%02x data = 0x%05x\n", __func__, path, addr, data32); */ -+ rtw_hal_write_rfreg(padapter, path, addr, 0xFFFFF, data32); -+ -+ return 0; -+} -+ -+static int rtw_wx_priv_null(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ return -1; -+} -+ -+static int dummy(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ /* struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); */ -+ /* struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); */ -+ -+ /* DBG_871X("cmd_code =%x, fwstate = 0x%x\n", a->cmd, get_fwstate(pmlmepriv)); */ -+ -+ return -1; -+ -+} -+ -+static int rtw_wx_set_channel_plan(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ u8 channel_plan_req = (u8) (*((int *)wrqu)); -+ -+ if (_SUCCESS == rtw_set_chplan_cmd(padapter, channel_plan_req, 1, 1)) { -+ DBG_871X("%s set channel_plan = 0x%02X\n", __func__, channel_plan_req); -+ } else -+ return -EPERM; -+ -+ return 0; -+} -+ -+static int rtw_wx_set_mtk_wps_probe_ie(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ return 0; -+} -+ -+static int rtw_wx_get_sensitivity(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *buf) -+{ -+ return 0; -+} -+ -+static int rtw_wx_set_mtk_wps_ie(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ return 0; -+} -+ -+/* -+typedef int (*iw_handler)(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+*/ -+/* -+ *For all data larger than 16 octets, we need to use a -+ *pointer to memory allocated in user space. -+ */ -+static int rtw_drvext_hdl(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ return 0; -+} -+ -+static int rtw_mp_ioctl_hdl(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ return ret; -+} -+ -+static int rtw_get_ap_info(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ u32 cnt = 0, wpa_ielen; -+ struct list_head *plist, *phead; -+ unsigned char *pbuf; -+ u8 bssid[ETH_ALEN]; -+ char data[32]; -+ struct wlan_network *pnetwork = NULL; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct __queue *queue = &(pmlmepriv->scanned_queue); -+ struct iw_point *pdata = &wrqu->data; -+ -+ DBG_871X("+rtw_get_aplist_info\n"); -+ -+ if ((padapter->bDriverStopped) || (pdata == NULL)) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ while ((check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING))) == true) -+ { -+ msleep(30); -+ cnt++; -+ if (cnt > 100) -+ break; -+ } -+ -+ -+ /* pdata->length = 0;? */ -+ pdata->flags = 0; -+ if (pdata->length>=32) -+ { -+ if (copy_from_user(data, pdata->pointer, 32)) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ else -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) -+ { -+ if (phead == plist) -+ break; -+ -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ /* if (hwaddr_aton_i(pdata->pointer, bssid)) */ -+ if (hwaddr_aton_i(data, bssid)) -+ { -+ DBG_871X("Invalid BSSID '%s'.\n", (u8 *)data); -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ return -EINVAL; -+ } -+ -+ -+ if (!memcmp(bssid, pnetwork->network.MacAddress, ETH_ALEN))/* BSSID match, then check if supporting wpa/wpa2 */ -+ { -+ DBG_871X("BSSID:" MAC_FMT "\n", MAC_ARG(bssid)); -+ -+ pbuf = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength-12); -+ if (pbuf && (wpa_ielen>0)) -+ { -+ pdata->flags = 1; -+ break; -+ } -+ -+ pbuf = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength-12); -+ if (pbuf && (wpa_ielen>0)) -+ { -+ pdata->flags = 2; -+ break; -+ } -+ -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); -+ -+ if (pdata->length>=34) -+ { -+ if (copy_to_user((u8 __force __user *)pdata->pointer+32, (u8 *)&pdata->flags, 1)) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_set_pid(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ struct adapter *padapter = rtw_netdev_priv(dev); -+ int *pdata = (int *)wrqu; -+ int selector; -+ -+ if ((padapter->bDriverStopped) || (pdata == NULL)) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ selector = *pdata; -+ if (selector < 3 && selector >= 0) { -+ padapter->pid[selector] = *(pdata+1); -+ DBG_871X("%s set pid[%d]=%d\n", __func__, selector , padapter->pid[selector]); -+ } -+ else -+ DBG_871X("%s selector %d error\n", __func__, selector); -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_wps_start(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ u32 u32wps_start = 0; -+ unsigned int uintRet = 0; -+ -+ if ((true == padapter->bDriverStopped) ||(true ==padapter->bSurpriseRemoved) || (NULL == pdata)) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ uintRet = copy_from_user((void*) &u32wps_start, pdata->pointer, 4); -+ if (u32wps_start == 0) -+ { -+ u32wps_start = *extra; -+ } -+ -+ DBG_871X("[%s] wps_start = %d\n", __func__, u32wps_start); -+ -+#ifdef CONFIG_INTEL_WIDI -+ process_intel_widi_wps_status(padapter, u32wps_start); -+#endif /* CONFIG_INTEL_WIDI */ -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_get(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_get2(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ -+ return ret; -+ -+} -+ -+static int rtw_rereg_nd_name(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ struct adapter *padapter = rtw_netdev_priv(dev); -+ struct rereg_nd_name_data *rereg_priv = &padapter->rereg_nd_name_priv; -+ char new_ifname[IFNAMSIZ]; -+ -+ if (rereg_priv->old_ifname[0] == 0) { -+ char *reg_ifname; -+ reg_ifname = padapter->registrypriv.ifname; -+ -+ strncpy(rereg_priv->old_ifname, reg_ifname, IFNAMSIZ); -+ rereg_priv->old_ifname[IFNAMSIZ-1] = 0; -+ } -+ -+ /* DBG_871X("%s wrqu->data.length:%d\n", __func__, wrqu->data.length); */ -+ if (wrqu->data.length > IFNAMSIZ) -+ return -EFAULT; -+ -+ if (copy_from_user(new_ifname, wrqu->data.pointer, IFNAMSIZ)) { -+ return -EFAULT; -+ } -+ -+ if (0 == strcmp(rereg_priv->old_ifname, new_ifname)) { -+ return ret; -+ } -+ -+ DBG_871X("%s new_ifname:%s\n", __func__, new_ifname); -+ if (0 != (ret = rtw_change_ifname(padapter, new_ifname))) { -+ goto exit; -+ } -+ -+ strncpy(rereg_priv->old_ifname, new_ifname, IFNAMSIZ); -+ rereg_priv->old_ifname[IFNAMSIZ-1] = 0; -+ -+ if (!memcmp(new_ifname, "disable%d", 9)) { -+ -+ DBG_871X("%s disable\n", __func__); -+ /* free network queue for Android's timming issue */ -+ rtw_free_network_queue(padapter, true); -+ -+ /* the interface is being "disabled", we can do deeper IPS */ -+ /* rereg_priv->old_ips_mode = rtw_get_ips_mode_req(&padapter->pwrctrlpriv); */ -+ /* rtw_ips_mode_req(&padapter->pwrctrlpriv, IPS_NORMAL); */ -+ } -+exit: -+ return ret; -+ -+} -+ -+static int rtw_dbg_port(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ u8 major_cmd, minor_cmd; -+ u16 arg; -+ u32 extra_arg, *pdata, val32; -+ struct sta_info *psta; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ -+ pdata = (u32*)&wrqu->data; -+ -+ val32 = *pdata; -+ arg = (u16)(val32&0x0000ffff); -+ major_cmd = (u8)(val32>>24); -+ minor_cmd = (u8)((val32>>16)&0x00ff); -+ -+ extra_arg = *(pdata+1); -+ -+ switch (major_cmd) -+ { -+ case 0x70:/* read_reg */ -+ switch (minor_cmd) -+ { -+ case 1: -+ DBG_871X("rtw_read8(0x%x) = 0x%02x\n", arg, rtw_read8(padapter, arg)); -+ break; -+ case 2: -+ DBG_871X("rtw_read16(0x%x) = 0x%04x\n", arg, rtw_read16(padapter, arg)); -+ break; -+ case 4: -+ DBG_871X("rtw_read32(0x%x) = 0x%08x\n", arg, rtw_read32(padapter, arg)); -+ break; -+ } -+ break; -+ case 0x71:/* write_reg */ -+ switch (minor_cmd) -+ { -+ case 1: -+ rtw_write8(padapter, arg, extra_arg); -+ DBG_871X("rtw_write8(0x%x) = 0x%02x\n", arg, rtw_read8(padapter, arg)); -+ break; -+ case 2: -+ rtw_write16(padapter, arg, extra_arg); -+ DBG_871X("rtw_write16(0x%x) = 0x%04x\n", arg, rtw_read16(padapter, arg)); -+ break; -+ case 4: -+ rtw_write32(padapter, arg, extra_arg); -+ DBG_871X("rtw_write32(0x%x) = 0x%08x\n", arg, rtw_read32(padapter, arg)); -+ break; -+ } -+ break; -+ case 0x72:/* read_bb */ -+ DBG_871X("read_bbreg(0x%x) = 0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff)); -+ break; -+ case 0x73:/* write_bb */ -+ rtw_hal_write_bbreg(padapter, arg, 0xffffffff, extra_arg); -+ DBG_871X("write_bbreg(0x%x) = 0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff)); -+ break; -+ case 0x74:/* read_rf */ -+ DBG_871X("read RF_reg path(0x%02x), offset(0x%x), value(0x%08x)\n", minor_cmd, arg, rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff)); -+ break; -+ case 0x75:/* write_rf */ -+ rtw_hal_write_rfreg(padapter, minor_cmd, arg, 0xffffffff, extra_arg); -+ DBG_871X("write RF_reg path(0x%02x), offset(0x%x), value(0x%08x)\n", minor_cmd, arg, rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff)); -+ break; -+ -+ case 0x76: -+ switch (minor_cmd) -+ { -+ case 0x00: /* normal mode, */ -+ padapter->recvpriv.is_signal_dbg = 0; -+ break; -+ case 0x01: /* dbg mode */ -+ padapter->recvpriv.is_signal_dbg = 1; -+ extra_arg = extra_arg>100?100:extra_arg; -+ padapter->recvpriv.signal_strength_dbg =extra_arg; -+ break; -+ } -+ break; -+ case 0x78: /* IOL test */ -+ break; -+ case 0x79: -+ { -+ /* -+ * dbg 0x79000000 [value], set RESP_TXAGC to + value, value:0~15 -+ * dbg 0x79010000 [value], set RESP_TXAGC to - value, value:0~15 -+ */ -+ u8 value = extra_arg & 0x0f; -+ u8 sign = minor_cmd; -+ u16 write_value = 0; -+ -+ DBG_871X("%s set RESP_TXAGC to %s %u\n", __func__, sign?"minus":"plus", value); -+ -+ if (sign) -+ value = value | 0x10; -+ -+ write_value = value | (value << 5); -+ rtw_write16(padapter, 0x6d9, write_value); -+ } -+ break; -+ case 0x7a: -+ receive_disconnect(padapter, pmlmeinfo->network.MacAddress -+ , WLAN_REASON_EXPIRATION_CHK); -+ break; -+ case 0x7F: -+ switch (minor_cmd) -+ { -+ case 0x0: -+ DBG_871X("fwstate = 0x%x\n", get_fwstate(pmlmepriv)); -+ break; -+ case 0x01: -+ DBG_871X("minor_cmd 0x%x\n", minor_cmd); -+ break; -+ case 0x02: -+ DBG_871X("pmlmeinfo->state = 0x%x\n", pmlmeinfo->state); -+ DBG_871X("DrvBcnEarly =%d\n", pmlmeext->DrvBcnEarly); -+ DBG_871X("DrvBcnTimeOut =%d\n", pmlmeext->DrvBcnTimeOut); -+ break; -+ case 0x03: -+ DBG_871X("qos_option =%d\n", pmlmepriv->qospriv.qos_option); -+ DBG_871X("ht_option =%d\n", pmlmepriv->htpriv.ht_option); -+ break; -+ case 0x04: -+ DBG_871X("cur_ch =%d\n", pmlmeext->cur_channel); -+ DBG_871X("cur_bw =%d\n", pmlmeext->cur_bwmode); -+ DBG_871X("cur_ch_off =%d\n", pmlmeext->cur_ch_offset); -+ -+ DBG_871X("oper_ch =%d\n", rtw_get_oper_ch(padapter)); -+ DBG_871X("oper_bw =%d\n", rtw_get_oper_bw(padapter)); -+ DBG_871X("oper_ch_offet =%d\n", rtw_get_oper_choffset(padapter)); -+ -+ break; -+ case 0x05: -+ psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); -+ if (psta) -+ { -+ int i; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ -+ DBG_871X("SSID =%s\n", cur_network->network.Ssid.Ssid); -+ DBG_871X("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ DBG_871X("cur_channel =%d, cur_bwmode =%d, cur_ch_offset =%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ DBG_871X("rtsen =%d, cts2slef =%d\n", psta->rtsen, psta->cts2self); -+ DBG_871X("state = 0x%x, aid =%d, macid =%d, raid =%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); -+ DBG_871X("qos_en =%d, ht_en =%d, init_rate =%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ DBG_871X("bwmode =%d, ch_offset =%d, sgi_20m =%d, sgi_40m =%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); -+ DBG_871X("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); -+ DBG_871X("agg_enable_bitmap =%x, candidate_tid_bitmap =%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); -+ -+ for (i = 0;i<16;i++) -+ { -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ if (preorder_ctrl->enable) -+ { -+ DBG_871X("tid =%d, indicate_seq =%d\n", i, preorder_ctrl->indicate_seq); -+ } -+ } -+ -+ } -+ else -+ { -+ DBG_871X("can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); -+ } -+ break; -+ case 0x06: -+ { -+ u32 ODMFlag; -+ rtw_hal_get_hwreg(padapter, HW_VAR_DM_FLAG, (u8 *)(&ODMFlag)); -+ DBG_871X("(B)DMFlag = 0x%x, arg = 0x%x\n", ODMFlag, arg); -+ ODMFlag = (u32)(0x0f&arg); -+ DBG_871X("(A)DMFlag = 0x%x\n", ODMFlag); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FLAG, (u8 *)(&ODMFlag)); -+ } -+ break; -+ case 0x07: -+ DBG_871X("bSurpriseRemoved =%d, bDriverStopped =%d\n", -+ padapter->bSurpriseRemoved, padapter->bDriverStopped); -+ break; -+ case 0x08: -+ { -+ DBG_871X("minor_cmd 0x%x\n", minor_cmd); -+ } -+ break; -+ case 0x09: -+ { -+ int i, j; -+ struct list_head *plist, *phead; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ -+ DBG_871X("sta_dz_bitmap = 0x%x, tim_bitmap = 0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap); -+ -+ spin_lock_bh(&pstapriv->sta_hash_lock); -+ -+ for (i = 0; i< NUM_STA; i++) -+ { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while (phead != plist) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ plist = get_next(plist); -+ -+ if (extra_arg == psta->aid) -+ { -+ DBG_871X("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ DBG_871X("rtsen =%d, cts2slef =%d\n", psta->rtsen, psta->cts2self); -+ DBG_871X("state = 0x%x, aid =%d, macid =%d, raid =%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); -+ DBG_871X("qos_en =%d, ht_en =%d, init_rate =%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ DBG_871X("bwmode =%d, ch_offset =%d, sgi_20m =%d, sgi_40m =%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); -+ DBG_871X("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); -+ DBG_871X("agg_enable_bitmap =%x, candidate_tid_bitmap =%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); -+ DBG_871X("capability = 0x%x\n", psta->capability); -+ DBG_871X("flags = 0x%x\n", psta->flags); -+ DBG_871X("wpa_psk = 0x%x\n", psta->wpa_psk); -+ DBG_871X("wpa2_group_cipher = 0x%x\n", psta->wpa2_group_cipher); -+ DBG_871X("wpa2_pairwise_cipher = 0x%x\n", psta->wpa2_pairwise_cipher); -+ DBG_871X("qos_info = 0x%x\n", psta->qos_info); -+ DBG_871X("dot118021XPrivacy = 0x%x\n", psta->dot118021XPrivacy); -+ -+ -+ -+ for (j = 0;j<16;j++) -+ { -+ preorder_ctrl = &psta->recvreorder_ctrl[j]; -+ if (preorder_ctrl->enable) -+ { -+ DBG_871X("tid =%d, indicate_seq =%d\n", j, preorder_ctrl->indicate_seq); -+ } -+ } -+ -+ } -+ -+ } -+ } -+ -+ spin_unlock_bh(&pstapriv->sta_hash_lock); -+ -+ } -+ break; -+ case 0x0a: -+ { -+ int max_mac_id = 0; -+ max_mac_id = rtw_search_max_mac_id(padapter); -+ printk("%s ==> max_mac_id = %d\n", __func__, max_mac_id); -+ } -+ break; -+ case 0x0b: /* Enable = 1, Disable = 0 driver control vrtl_carrier_sense. */ -+ if (arg == 0) { -+ DBG_871X("disable driver ctrl vcs\n"); -+ padapter->driver_vcs_en = 0; -+ } -+ else if (arg == 1) { -+ DBG_871X("enable driver ctrl vcs = %d\n", extra_arg); -+ padapter->driver_vcs_en = 1; -+ -+ if (extra_arg>2) -+ padapter->driver_vcs_type = 1; -+ else -+ padapter->driver_vcs_type = extra_arg; -+ } -+ break; -+ case 0x0c:/* dump rx/tx packet */ -+ { -+ if (arg == 0) { -+ DBG_871X("dump rx packet (%d)\n", extra_arg); -+ /* pHalData->bDumpRxPkt =extra_arg; */ -+ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DUMP_RXPKT, &(extra_arg)); -+ } -+ else if (arg == 1) { -+ DBG_871X("dump tx packet (%d)\n", extra_arg); -+ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DUMP_TXPKT, &(extra_arg)); -+ } -+ } -+ break; -+ case 0x0e: -+ { -+ if (arg == 0) { -+ DBG_871X("disable driver ctrl rx_ampdu_factor\n"); -+ padapter->driver_rx_ampdu_factor = 0xFF; -+ } -+ else if (arg == 1) { -+ -+ DBG_871X("enable driver ctrl rx_ampdu_factor = %d\n", extra_arg); -+ -+ if ((extra_arg & 0x03) > 0x03) -+ padapter->driver_rx_ampdu_factor = 0xFF; -+ else -+ padapter->driver_rx_ampdu_factor = extra_arg; -+ } -+ } -+ break; -+ -+ case 0x10:/* driver version display */ -+ dump_drv_version(RTW_DBGDUMP); -+ break; -+ case 0x11:/* dump linked status */ -+ { -+ linked_info_dump(padapter, extra_arg); -+ } -+ break; -+ case 0x12: /* set rx_stbc */ -+ { -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ /* 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, 0x3: enable both 2.4g and 5g */ -+ /* default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ */ -+ if (pregpriv && (extra_arg == 0 || extra_arg == 1|| extra_arg == 2 || extra_arg == 3)) -+ { -+ pregpriv->rx_stbc = extra_arg; -+ DBG_871X("set rx_stbc =%d\n", pregpriv->rx_stbc); -+ } -+ else -+ DBG_871X("get rx_stbc =%d\n", pregpriv->rx_stbc); -+ -+ } -+ break; -+ case 0x13: /* set ampdu_enable */ -+ { -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ /* 0: disable, 0x1:enable (but wifi_spec should be 0), 0x2: force enable (don't care wifi_spec) */ -+ if (pregpriv && extra_arg < 3) -+ { -+ pregpriv->ampdu_enable = extra_arg; -+ DBG_871X("set ampdu_enable =%d\n", pregpriv->ampdu_enable); -+ } -+ else -+ DBG_871X("get ampdu_enable =%d\n", pregpriv->ampdu_enable); -+ -+ } -+ break; -+ case 0x14: -+ { -+ DBG_871X("minor_cmd 0x%x\n", minor_cmd); -+ } -+ break; -+ case 0x16: -+ { -+ if (arg == 0xff) { -+ rtw_odm_dbg_comp_msg(RTW_DBGDUMP, padapter); -+ } -+ else { -+ u64 dbg_comp = (u64)extra_arg; -+ rtw_odm_dbg_comp_set(padapter, dbg_comp); -+ } -+ } -+ break; -+#ifdef DBG_FIXED_CHAN -+ case 0x17: -+ { -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ printk("===> Fixed channel to %d\n", extra_arg); -+ pmlmeext->fixed_chan = extra_arg; -+ -+ } -+ break; -+#endif -+ case 0x18: -+ { -+ printk("===> Switch USB Mode %d\n", extra_arg); -+ rtw_hal_set_hwreg(padapter, HW_VAR_USB_MODE, (u8 *)&extra_arg); -+ } -+ break; -+ case 0x19: -+ { -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ /* extra_arg : */ -+ /* BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, */ -+ /* BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx */ -+ if (arg == 0) { -+ DBG_871X("driver disable LDPC\n"); -+ pregistrypriv->ldpc_cap = 0x00; -+ } -+ else if (arg == 1) { -+ DBG_871X("driver set LDPC cap = 0x%x\n", extra_arg); -+ pregistrypriv->ldpc_cap = (u8)(extra_arg&0x33); -+ } -+ } -+ break; -+ case 0x1a: -+ { -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ /* extra_arg : */ -+ /* BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, */ -+ /* BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx */ -+ if (arg == 0) { -+ DBG_871X("driver disable STBC\n"); -+ pregistrypriv->stbc_cap = 0x00; -+ } -+ else if (arg == 1) { -+ DBG_871X("driver set STBC cap = 0x%x\n", extra_arg); -+ pregistrypriv->stbc_cap = (u8)(extra_arg&0x33); -+ } -+ } -+ break; -+ case 0x1b: -+ { -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ if (arg == 0) { -+ DBG_871X("disable driver ctrl max_rx_rate, reset to default_rate_set\n"); -+ init_mlme_default_rate_set(padapter); -+ pregistrypriv->ht_enable = (u8)rtw_ht_enable; -+ } -+ else if (arg == 1) { -+ -+ int i; -+ u8 max_rx_rate; -+ -+ DBG_871X("enable driver ctrl max_rx_rate = 0x%x\n", extra_arg); -+ -+ max_rx_rate = (u8)extra_arg; -+ -+ if (max_rx_rate < 0xc) /* max_rx_rate < MSC0 -> B or G -> disable HT */ -+ { -+ pregistrypriv->ht_enable = 0; -+ for (i = 0; idatarate[i] > max_rx_rate) -+ pmlmeext->datarate[i] = 0xff; -+ } -+ -+ } -+ else if (max_rx_rate < 0x1c) /* mcs0~mcs15 */ -+ { -+ u32 mcs_bitmap = 0x0; -+ -+ for (i = 0; i<((max_rx_rate+1)-0xc); i++) -+ mcs_bitmap |= BIT(i); -+ -+ set_mcs_rate_by_mask(pmlmeext->default_supported_mcs_set, mcs_bitmap); -+ } -+ } -+ } -+ break; -+ case 0x1c: /* enable/disable driver control AMPDU Density for peer sta's rx */ -+ { -+ if (arg == 0) { -+ DBG_871X("disable driver ctrl ampdu density\n"); -+ padapter->driver_ampdu_spacing = 0xFF; -+ } -+ else if (arg == 1) { -+ -+ DBG_871X("enable driver ctrl ampdu density = %d\n", extra_arg); -+ -+ if ((extra_arg & 0x07) > 0x07) -+ padapter->driver_ampdu_spacing = 0xFF; -+ else -+ padapter->driver_ampdu_spacing = extra_arg; -+ } -+ } -+ break; -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ case 0x1e: -+ { -+ struct hal_com_data *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ u8 chan = rtw_get_oper_ch(padapter); -+ DBG_871X("===========================================\n"); -+ ODM_InbandNoise_Monitor(pDM_Odm, true, 0x1e, 100); -+ DBG_871X("channel(%d), noise_a = %d, noise_b = %d , noise_all:%d\n", -+ chan, pDM_Odm->noise_level.noise[ODM_RF_PATH_A], -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_B], -+ pDM_Odm->noise_level.noise_all); -+ DBG_871X("===========================================\n"); -+ -+ } -+ break; -+#endif -+ case 0x23: -+ { -+ DBG_871X("turn %s the bNotifyChannelChange Variable\n", (extra_arg == 1)?"on":"off"); -+ padapter->bNotifyChannelChange = extra_arg; -+ break; -+ } -+ case 0x24: -+ { -+ break; -+ } -+#ifdef CONFIG_GPIO_API -+ case 0x25: /* Get GPIO register */ -+ { -+ /* -+ * dbg 0x7f250000 [gpio_num], Get gpio value, gpio_num:0~7 -+ */ -+ -+ int value; -+ DBG_871X("Read GPIO Value extra_arg = %d\n", extra_arg); -+ value = rtw_get_gpio(dev, extra_arg); -+ DBG_871X("Read GPIO Value = %d\n", value); -+ break; -+ } -+ case 0x26: /* Set GPIO direction */ -+ { -+ -+ /* dbg 0x7f26000x [y], Set gpio direction, -+ * x: gpio_num, 4~7 y: indicate direction, 0~1 -+ */ -+ -+ int value; -+ DBG_871X("Set GPIO Direction! arg = %d , extra_arg =%d\n", arg , extra_arg); -+ value = rtw_config_gpio(dev, arg, extra_arg); -+ DBG_871X("Set GPIO Direction %s\n", (value ==-1)?"Fail!!!":"Success"); -+ break; -+ } -+ case 0x27: /* Set GPIO output direction value */ -+ { -+ /* -+ * dbg 0x7f27000x [y], Set gpio output direction value, -+ * x: gpio_num, 4~7 y: indicate direction, 0~1 -+ */ -+ -+ int value; -+ DBG_871X("Set GPIO Value! arg = %d , extra_arg =%d\n", arg , extra_arg); -+ value = rtw_set_gpio_output_value(dev, arg, extra_arg); -+ DBG_871X("Set GPIO Value %s\n", (value ==-1)?"Fail!!!":"Success"); -+ break; -+ } -+#endif -+ case 0xaa: -+ { -+ if ((extra_arg & 0x7F)> 0x3F) extra_arg = 0xFF; -+ DBG_871X("chang data rate to :0x%02x\n", extra_arg); -+ padapter->fix_rate = extra_arg; -+ } -+ break; -+ case 0xdd:/* registers dump , 0 for mac reg, 1 for bb reg, 2 for rf reg */ -+ { -+ if (extra_arg == 0) { -+ mac_reg_dump(RTW_DBGDUMP, padapter); -+ } -+ else if (extra_arg == 1) { -+ bb_reg_dump(RTW_DBGDUMP, padapter); -+ } -+ else if (extra_arg ==2) { -+ rf_reg_dump(RTW_DBGDUMP, padapter); -+ } -+ } -+ break; -+ -+ case 0xee:/* turn on/off dynamic funcs */ -+ { -+ u32 odm_flag; -+ -+ if (0xf ==extra_arg) { -+ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DM_FUNC,&odm_flag); -+ DBG_871X(" === DMFlag(0x%08x) ===\n", odm_flag); -+ DBG_871X("extra_arg = 0 - disable all dynamic func\n"); -+ DBG_871X("extra_arg = 1 - disable DIG- BIT(0)\n"); -+ DBG_871X("extra_arg = 2 - disable High power - BIT(1)\n"); -+ DBG_871X("extra_arg = 3 - disable tx power tracking - BIT(2)\n"); -+ DBG_871X("extra_arg = 4 - disable BT coexistence - BIT(3)\n"); -+ DBG_871X("extra_arg = 5 - disable antenna diversity - BIT(4)\n"); -+ DBG_871X("extra_arg = 6 - enable all dynamic func\n"); -+ } -+ else { -+ /*extra_arg = 0 - disable all dynamic func -+ extra_arg = 1 - disable DIG -+ extra_arg = 2 - disable tx power tracking -+ extra_arg = 3 - turn on all dynamic func -+ */ -+ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DM_FUNC, &(extra_arg)); -+ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DM_FUNC,&odm_flag); -+ DBG_871X(" === DMFlag(0x%08x) ===\n", odm_flag); -+ } -+ } -+ break; -+ -+ case 0xfd: -+ rtw_write8(padapter, 0xc50, arg); -+ DBG_871X("wr(0xc50) = 0x%x\n", rtw_read8(padapter, 0xc50)); -+ rtw_write8(padapter, 0xc58, arg); -+ DBG_871X("wr(0xc58) = 0x%x\n", rtw_read8(padapter, 0xc58)); -+ break; -+ case 0xfe: -+ DBG_871X("rd(0xc50) = 0x%x\n", rtw_read8(padapter, 0xc50)); -+ DBG_871X("rd(0xc58) = 0x%x\n", rtw_read8(padapter, 0xc58)); -+ break; -+ case 0xff: -+ { -+ DBG_871X("dbg(0x210) = 0x%x\n", rtw_read32(padapter, 0x210)); -+ DBG_871X("dbg(0x608) = 0x%x\n", rtw_read32(padapter, 0x608)); -+ DBG_871X("dbg(0x280) = 0x%x\n", rtw_read32(padapter, 0x280)); -+ DBG_871X("dbg(0x284) = 0x%x\n", rtw_read32(padapter, 0x284)); -+ DBG_871X("dbg(0x288) = 0x%x\n", rtw_read32(padapter, 0x288)); -+ -+ DBG_871X("dbg(0x664) = 0x%x\n", rtw_read32(padapter, 0x664)); -+ -+ -+ DBG_871X("\n"); -+ -+ DBG_871X("dbg(0x430) = 0x%x\n", rtw_read32(padapter, 0x430)); -+ DBG_871X("dbg(0x438) = 0x%x\n", rtw_read32(padapter, 0x438)); -+ -+ DBG_871X("dbg(0x440) = 0x%x\n", rtw_read32(padapter, 0x440)); -+ -+ DBG_871X("dbg(0x458) = 0x%x\n", rtw_read32(padapter, 0x458)); -+ -+ DBG_871X("dbg(0x484) = 0x%x\n", rtw_read32(padapter, 0x484)); -+ DBG_871X("dbg(0x488) = 0x%x\n", rtw_read32(padapter, 0x488)); -+ -+ DBG_871X("dbg(0x444) = 0x%x\n", rtw_read32(padapter, 0x444)); -+ DBG_871X("dbg(0x448) = 0x%x\n", rtw_read32(padapter, 0x448)); -+ DBG_871X("dbg(0x44c) = 0x%x\n", rtw_read32(padapter, 0x44c)); -+ DBG_871X("dbg(0x450) = 0x%x\n", rtw_read32(padapter, 0x450)); -+ } -+ break; -+ } -+ break; -+ default: -+ DBG_871X("error dbg cmd!\n"); -+ break; -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int wpa_set_param(struct net_device *dev, u8 name, u32 value) -+{ -+ uint ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ switch (name) { -+ case IEEE_PARAM_WPA_ENABLED: -+ -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; /* 802.1x */ -+ -+ /* ret = ieee80211_wpa_enable(ieee, value); */ -+ -+ switch ((value)&0xff) -+ { -+ case 1 : /* WPA */ -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPAPSK; /* WPA_PSK */ -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case 2: /* WPA2 */ -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPA2PSK; /* WPA2_PSK */ -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ } -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, ("wpa_set_param:padapter->securitypriv.ndisauthtype =%d\n", padapter->securitypriv.ndisauthtype)); -+ -+ break; -+ -+ case IEEE_PARAM_TKIP_COUNTERMEASURES: -+ /* ieee->tkip_countermeasures =value; */ -+ break; -+ -+ case IEEE_PARAM_DROP_UNENCRYPTED: -+ { -+ /* HACK: -+ * -+ * wpa_supplicant calls set_wpa_enabled when the driver -+ * is loaded and unloaded, regardless of if WPA is being -+ * used. No other calls are made which can be used to -+ * determine if encryption will be used or not prior to -+ * association being expected. If encryption is not being -+ * used, drop_unencrypted is set to false, else true -- we -+ * can use this to determine if the CAP_PRIVACY_ON bit should -+ * be set. -+ */ -+ break; -+ -+ } -+ case IEEE_PARAM_PRIVACY_INVOKED: -+ -+ /* ieee->privacy_invoked =value; */ -+ -+ break; -+ -+ case IEEE_PARAM_AUTH_ALGS: -+ -+ ret = wpa_set_auth_algs(dev, value); -+ -+ break; -+ -+ case IEEE_PARAM_IEEE_802_1X: -+ -+ /* ieee->ieee802_1x =value; */ -+ -+ break; -+ -+ case IEEE_PARAM_WPAX_SELECT: -+ -+ /* added for WPA2 mixed mode */ -+ /* DBG_871X(KERN_WARNING "------------------------>wpax value = %x\n", value); */ -+ /* -+ spin_lock_irqsave(&ieee->wpax_suitlist_lock, flags); -+ ieee->wpax_type_set = 1; -+ ieee->wpax_type_notify = value; -+ spin_unlock_irqrestore(&ieee->wpax_suitlist_lock, flags); -+ */ -+ -+ break; -+ -+ default: -+ -+ -+ -+ ret = -EOPNOTSUPP; -+ -+ -+ break; -+ -+ } -+ -+ return ret; -+ -+} -+ -+static int wpa_mlme(struct net_device *dev, u32 command, u32 reason) -+{ -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ switch (command) -+ { -+ case IEEE_MLME_STA_DEAUTH: -+ -+ if (!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ -+ break; -+ -+ case IEEE_MLME_STA_DISASSOC: -+ -+ if (!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ -+ break; -+ -+ default: -+ ret = -EOPNOTSUPP; -+ break; -+ } -+ -+ return ret; -+ -+} -+ -+static int wpa_supplicant_ioctl(struct net_device *dev, struct iw_point *p) -+{ -+ struct ieee_param *param; -+ uint ret = 0; -+ -+ /* down(&ieee->wx_sem); */ -+ -+ if (p->length < sizeof(struct ieee_param) || !p->pointer) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ param = (struct ieee_param *)rtw_malloc(p->length); -+ if (param == NULL) -+ { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ if (copy_from_user(param, p->pointer, p->length)) -+ { -+ kfree((u8 *)param); -+ ret = -EFAULT; -+ goto out; -+ } -+ -+ switch (param->cmd) { -+ -+ case IEEE_CMD_SET_WPA_PARAM: -+ ret = wpa_set_param(dev, param->u.wpa_param.name, param->u.wpa_param.value); -+ break; -+ -+ case IEEE_CMD_SET_WPA_IE: -+ /* ret = wpa_set_wpa_ie(dev, param, p->length); */ -+ ret = rtw_set_wpa_ie((struct adapter *)rtw_netdev_priv(dev), (char*)param->u.wpa_ie.data, (u16)param->u.wpa_ie.len); -+ break; -+ -+ case IEEE_CMD_SET_ENCRYPTION: -+ ret = wpa_set_encryption(dev, param, p->length); -+ break; -+ -+ case IEEE_CMD_MLME: -+ ret = wpa_mlme(dev, param->u.mlme.command, param->u.mlme.reason_code); -+ break; -+ -+ default: -+ DBG_871X("Unknown WPA supplicant request: %d\n", param->cmd); -+ ret = -EOPNOTSUPP; -+ break; -+ -+ } -+ -+ if (ret == 0 && copy_to_user(p->pointer, param, p->length)) -+ ret = -EFAULT; -+ -+ kfree((u8 *)param); -+ -+out: -+ -+ /* up(&ieee->wx_sem); */ -+ -+ return ret; -+ -+} -+ -+static int rtw_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len, wep_total_len; -+ struct ndis_802_11_wep *pwep = NULL; -+ struct sta_info *psta = NULL, *pbcmc_sta = NULL; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv* psecuritypriv =&(padapter->securitypriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("%s\n", __func__); -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ /* sizeof(struct ieee_param) = 64 bytes; */ -+ /* if (param_len != (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) */ -+ if (param_len != sizeof(struct ieee_param) + param->u.crypt.key_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ if (param->u.crypt.idx >= WEP_KEYS) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ else -+ { -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if (!psta) -+ { -+ /* ret = -EINVAL; */ -+ DBG_871X("rtw_set_encryption(), sta has already been removed or never been added\n"); -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "none") == 0 && (psta == NULL)) -+ { -+ /* todo:clear default encryption keys */ -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ -+ DBG_871X("clear default encryption keys, keyid =%d\n", param->u.crypt.idx); -+ -+ goto exit; -+ } -+ -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0 && (psta == NULL)) -+ { -+ DBG_871X("r871x_set_encryption, crypt.alg = WEP\n"); -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ DBG_871X("r871x_set_encryption, wep_key_idx =%d, len =%d\n", wep_key_idx, wep_key_len); -+ -+ if ((wep_key_idx >= WEP_KEYS) || (wep_key_len<= 0)) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ -+ if (wep_key_len > 0) -+ { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ wep_total_len = wep_key_len + FIELD_OFFSET(struct ndis_802_11_wep, KeyMaterial); -+ pwep =(struct ndis_802_11_wep *)rtw_malloc(wep_total_len); -+ if (pwep == NULL) { -+ DBG_871X(" r871x_set_encryption: pwep allocate fail !!!\n"); -+ goto exit; -+ } -+ -+ memset(pwep, 0, wep_total_len); -+ -+ pwep->KeyLength = wep_key_len; -+ pwep->Length = wep_total_len; -+ -+ } -+ -+ pwep->KeyIndex = wep_key_idx; -+ -+ memcpy(pwep->KeyMaterial, param->u.crypt.key, pwep->KeyLength); -+ -+ if (param->u.crypt.set_tx) -+ { -+ DBG_871X("wep, set_tx = 1\n"); -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ -+ if (pwep->KeyLength == 13) -+ { -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ -+ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; -+ -+ memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx]=pwep->KeyLength; -+ -+ rtw_ap_set_wep_key(padapter, pwep->KeyMaterial, pwep->KeyLength, wep_key_idx, 1); -+ } -+ else -+ { -+ DBG_871X("wep, set_tx = 0\n"); -+ -+ /* don't update "psecuritypriv->dot11PrivacyAlgrthm" and */ -+ /* psecuritypriv->dot11PrivacyKeyIndex =keyid", but can rtw_set_key to cam */ -+ -+ memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = pwep->KeyLength; -+ -+ rtw_ap_set_wep_key(padapter, pwep->KeyMaterial, pwep->KeyLength, wep_key_idx, 0); -+ } -+ -+ goto exit; -+ -+ } -+ -+ -+ if (!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) /* group key */ -+ { -+ if (param->u.crypt.set_tx == 1) -+ { -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ DBG_871X("%s, set group_key, WEP\n", __func__); -+ -+ memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ } -+ else if (strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ DBG_871X("%s, set group_key, TKIP\n", __func__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ /* DEBUG_ERR("set key length :param->u.crypt.key_len =%d\n", param->u.crypt.key_len); */ -+ /* set mic key */ -+ memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = true; -+ -+ } -+ else if (strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ DBG_871X("%s, set group_key, CCMP\n", __func__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ } -+ else -+ { -+ DBG_871X("%s, set group_key, none\n", __func__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = true; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* */ -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta =rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta) -+ { -+ pbcmc_sta->ieee8021x_blocked = false; -+ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy;/* rx will use bmc_sta's dot118021XPrivacy */ -+ } -+ -+ } -+ -+ goto exit; -+ -+ } -+ -+ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) /* psk/802_1x */ -+ { -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ { -+ if (param->u.crypt.set_tx == 1) -+ { -+ memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ DBG_871X("%s, set pairwise key, WEP\n", __func__); -+ -+ psta->dot118021XPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ { -+ psta->dot118021XPrivacy = _WEP104_; -+ } -+ } -+ else if (strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ DBG_871X("%s, set pairwise key, TKIP\n", __func__); -+ -+ psta->dot118021XPrivacy = _TKIP_; -+ -+ /* DEBUG_ERR("set key length :param->u.crypt.key_len =%d\n", param->u.crypt.key_len); */ -+ /* set mic key */ -+ memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = true; -+ -+ } -+ else if (strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ -+ DBG_871X("%s, set pairwise key, CCMP\n", __func__); -+ -+ psta->dot118021XPrivacy = _AES_; -+ } -+ else -+ { -+ DBG_871X("%s, set pairwise key, none\n", __func__); -+ -+ psta->dot118021XPrivacy = _NO_PRIVACY_; -+ } -+ -+ rtw_ap_set_pairwise_key(padapter, psta); -+ -+ psta->ieee8021x_blocked = false; -+ -+ } -+ else/* group key??? */ -+ { -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ } -+ else if (strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ /* DEBUG_ERR("set key length :param->u.crypt.key_len =%d\n", param->u.crypt.key_len); */ -+ /* set mic key */ -+ memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = true; -+ -+ } -+ else if (strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ } -+ else -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = true; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* */ -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta =rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta) -+ { -+ pbcmc_sta->ieee8021x_blocked = false; -+ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy;/* rx will use bmc_sta's dot118021XPrivacy */ -+ } -+ -+ } -+ -+ } -+ -+ } -+ -+exit: -+ -+ if (pwep) -+ { -+ kfree((u8 *)pwep); -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_set_beacon(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ unsigned char *pbuf = param->u.bcn_ie.buf; -+ -+ -+ DBG_871X("%s, len =%d\n", __func__, len); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ memcpy(&pstapriv->max_num_sta, param->u.bcn_ie.reserved, 2); -+ -+ if ((pstapriv->max_num_sta>NUM_STA) || (pstapriv->max_num_sta<= 0)) -+ pstapriv->max_num_sta = NUM_STA; -+ -+ -+ if (rtw_check_beacon_data(padapter, pbuf, (len-12-2)) == _SUCCESS)/* 12 = param header, 2:no packed */ -+ ret = 0; -+ else -+ ret = -EINVAL; -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_hostapd_sta_flush(struct net_device *dev) -+{ -+ /* _irqL irqL; */ -+ /* struct list_head *phead, *plist; */ -+ int ret = 0; -+ /* struct sta_info *psta = NULL; */ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ /* struct sta_priv *pstapriv = &padapter->stapriv; */ -+ -+ DBG_871X("%s\n", __func__); -+ -+ flush_all_cam_entry(padapter); /* clear CAM */ -+ -+ ret = rtw_sta_flush(padapter); -+ -+ return ret; -+ -+} -+ -+static int rtw_add_sta(struct net_device *dev, struct ieee_param *param) -+{ -+ int ret = 0; -+ struct sta_info *psta = NULL; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("rtw_add_sta(aid =%d) =" MAC_FMT "\n", param->u.add_sta.aid, MAC_ARG(param->sta_addr)); -+ -+ if (check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) -+ { -+ return -EINVAL; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+/* -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if (psta) -+ { -+ DBG_871X("rtw_add_sta(), free has been added psta =%p\n", psta); -+ spin_lock_bh(&(pstapriv->sta_hash_lock)); -+ rtw_free_stainfo(padapter, psta); -+ spin_unlock_bh(&(pstapriv->sta_hash_lock)); -+ -+ psta = NULL; -+ } -+*/ -+ /* psta = rtw_alloc_stainfo(pstapriv, param->sta_addr); */ -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if (psta) -+ { -+ int flags = param->u.add_sta.flags; -+ -+ /* DBG_871X("rtw_add_sta(), init sta's variables, psta =%p\n", psta); */ -+ -+ psta->aid = param->u.add_sta.aid;/* aid = 1~2007 */ -+ -+ memcpy(psta->bssrateset, param->u.add_sta.tx_supp_rates, 16); -+ -+ -+ /* check wmm cap. */ -+ if (WLAN_STA_WME&flags) -+ psta->qos_option = 1; -+ else -+ psta->qos_option = 0; -+ -+ if (pmlmepriv->qospriv.qos_option == 0) -+ psta->qos_option = 0; -+ -+ /* chec 802.11n ht cap. */ -+ if (WLAN_STA_HT&flags) -+ { -+ psta->htpriv.ht_option = true; -+ psta->qos_option = 1; -+ memcpy((void*)&psta->htpriv.ht_cap, (void*)¶m->u.add_sta.ht_cap, sizeof(struct rtw_ieee80211_ht_cap)); -+ } -+ else -+ { -+ psta->htpriv.ht_option = false; -+ } -+ -+ if (pmlmepriv->htpriv.ht_option == false) -+ psta->htpriv.ht_option = false; -+ -+ update_sta_info_apmode(padapter, psta); -+ -+ -+ } -+ else -+ { -+ ret = -ENOMEM; -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_del_sta(struct net_device *dev, struct ieee_param *param) -+{ -+ int ret = 0; -+ struct sta_info *psta = NULL; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("rtw_del_sta =" MAC_FMT "\n", MAC_ARG(param->sta_addr)); -+ -+ if (check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) -+ { -+ return -EINVAL; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if (psta) -+ { -+ u8 updated =false; -+ -+ /* DBG_871X("free psta =%p, aid =%d\n", psta, psta->aid); */ -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ if (list_empty(&psta->asoc_list) ==false) -+ { -+ list_del_init(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, true, WLAN_REASON_DEAUTH_LEAVING); -+ -+ } -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+ associated_clients_update(padapter, updated); -+ -+ psta = NULL; -+ -+ } -+ else -+ { -+ DBG_871X("rtw_del_sta(), sta has already been removed or never been added\n"); -+ -+ /* ret = -1; */ -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_ioctl_get_sta_data(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ struct sta_info *psta = NULL; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct ieee_param_ex *param_ex = (struct ieee_param_ex *)param; -+ struct sta_data *psta_data = (struct sta_data *)param_ex->data; -+ -+ DBG_871X("rtw_ioctl_get_sta_info, sta_addr: " MAC_FMT "\n", MAC_ARG(param_ex->sta_addr)); -+ -+ if (check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) -+ { -+ return -EINVAL; -+ } -+ -+ if (param_ex->sta_addr[0] == 0xff && param_ex->sta_addr[1] == 0xff && -+ param_ex->sta_addr[2] == 0xff && param_ex->sta_addr[3] == 0xff && -+ param_ex->sta_addr[4] == 0xff && param_ex->sta_addr[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+ psta = rtw_get_stainfo(pstapriv, param_ex->sta_addr); -+ if (psta) -+ { -+ psta_data->aid = (u16)psta->aid; -+ psta_data->capability = psta->capability; -+ psta_data->flags = psta->flags; -+ -+/* -+ nonerp_set : BIT(0) -+ no_short_slot_time_set : BIT(1) -+ no_short_preamble_set : BIT(2) -+ no_ht_gf_set : BIT(3) -+ no_ht_set : BIT(4) -+ ht_20mhz_set : BIT(5) -+*/ -+ -+ psta_data->sta_set =((psta->nonerp_set) | -+ (psta->no_short_slot_time_set <<1) | -+ (psta->no_short_preamble_set <<2) | -+ (psta->no_ht_gf_set <<3) | -+ (psta->no_ht_set <<4) | -+ (psta->ht_20mhz_set <<5)); -+ -+ psta_data->tx_supp_rates_len = psta->bssratelen; -+ memcpy(psta_data->tx_supp_rates, psta->bssrateset, psta->bssratelen); -+ memcpy(&psta_data->ht_cap, &psta->htpriv.ht_cap, sizeof(struct rtw_ieee80211_ht_cap)); -+ psta_data->rx_pkts = psta->sta_stats.rx_data_pkts; -+ psta_data->rx_bytes = psta->sta_stats.rx_bytes; -+ psta_data->rx_drops = psta->sta_stats.rx_drops; -+ -+ psta_data->tx_pkts = psta->sta_stats.tx_pkts; -+ psta_data->tx_bytes = psta->sta_stats.tx_bytes; -+ psta_data->tx_drops = psta->sta_stats.tx_drops; -+ -+ -+ } -+ else -+ { -+ ret = -1; -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_get_sta_wpaie(struct net_device *dev, struct ieee_param *param) -+{ -+ int ret = 0; -+ struct sta_info *psta = NULL; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("rtw_get_sta_wpaie, sta_addr: " MAC_FMT "\n", MAC_ARG(param->sta_addr)); -+ -+ if (check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) -+ { -+ return -EINVAL; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if (psta) -+ { -+ if ((psta->wpa_ie[0] == WLAN_EID_RSN) || (psta->wpa_ie[0] == WLAN_EID_GENERIC)) -+ { -+ int wpa_ie_len; -+ int copy_len; -+ -+ wpa_ie_len = psta->wpa_ie[1]; -+ -+ copy_len = ((wpa_ie_len+2) > sizeof(psta->wpa_ie)) ? (sizeof(psta->wpa_ie)):(wpa_ie_len+2); -+ -+ param->u.wpa_ie.len = copy_len; -+ -+ memcpy(param->u.wpa_ie.reserved, psta->wpa_ie, copy_len); -+ } -+ else -+ { -+ /* ret = -1; */ -+ DBG_871X("sta's wpa_ie is NONE\n"); -+ } -+ } -+ else -+ { -+ ret = -1; -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_set_wps_beacon(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ unsigned char wps_oui[4]={0x0, 0x50, 0xf2, 0x04}; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ int ie_len; -+ -+ DBG_871X("%s, len =%d\n", __func__, len); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ ie_len = len-12-2;/* 12 = param header, 2:no packed */ -+ -+ -+ if (pmlmepriv->wps_beacon_ie) -+ { -+ kfree(pmlmepriv->wps_beacon_ie); -+ pmlmepriv->wps_beacon_ie = NULL; -+ } -+ -+ if (ie_len>0) -+ { -+ pmlmepriv->wps_beacon_ie = rtw_malloc(ie_len); -+ pmlmepriv->wps_beacon_ie_len = ie_len; -+ if (pmlmepriv->wps_beacon_ie == NULL) { -+ DBG_871X("%s()-%d: rtw_malloc() ERROR!\n", __func__, __LINE__); -+ return -EINVAL; -+ } -+ -+ memcpy(pmlmepriv->wps_beacon_ie, param->u.bcn_ie.buf, ie_len); -+ -+ update_beacon(padapter, _VENDOR_SPECIFIC_IE_, wps_oui, true); -+ -+ pmlmeext->bstart_bss = true; -+ -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_set_wps_probe_resp(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ int ie_len; -+ -+ DBG_871X("%s, len =%d\n", __func__, len); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ ie_len = len-12-2;/* 12 = param header, 2:no packed */ -+ -+ -+ if (pmlmepriv->wps_probe_resp_ie) -+ { -+ kfree(pmlmepriv->wps_probe_resp_ie); -+ pmlmepriv->wps_probe_resp_ie = NULL; -+ } -+ -+ if (ie_len>0) -+ { -+ pmlmepriv->wps_probe_resp_ie = rtw_malloc(ie_len); -+ pmlmepriv->wps_probe_resp_ie_len = ie_len; -+ if (pmlmepriv->wps_probe_resp_ie == NULL) { -+ DBG_871X("%s()-%d: rtw_malloc() ERROR!\n", __func__, __LINE__); -+ return -EINVAL; -+ } -+ memcpy(pmlmepriv->wps_probe_resp_ie, param->u.bcn_ie.buf, ie_len); -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_set_wps_assoc_resp(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ int ie_len; -+ -+ DBG_871X("%s, len =%d\n", __func__, len); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ ie_len = len-12-2;/* 12 = param header, 2:no packed */ -+ -+ -+ if (pmlmepriv->wps_assoc_resp_ie) -+ { -+ kfree(pmlmepriv->wps_assoc_resp_ie); -+ pmlmepriv->wps_assoc_resp_ie = NULL; -+ } -+ -+ if (ie_len>0) -+ { -+ pmlmepriv->wps_assoc_resp_ie = rtw_malloc(ie_len); -+ pmlmepriv->wps_assoc_resp_ie_len = ie_len; -+ if (pmlmepriv->wps_assoc_resp_ie == NULL) { -+ DBG_871X("%s()-%d: rtw_malloc() ERROR!\n", __func__, __LINE__); -+ return -EINVAL; -+ } -+ -+ memcpy(pmlmepriv->wps_assoc_resp_ie, param->u.bcn_ie.buf, ie_len); -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_set_hidden_ssid(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlmepriv = &(adapter->mlmepriv); -+ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); -+ struct mlme_ext_info *mlmeinfo = &(mlmeext->mlmext_info); -+ int ie_len; -+ u8 *ssid_ie; -+ char ssid[NDIS_802_11_LENGTH_SSID + 1]; -+ sint ssid_len; -+ u8 ignore_broadcast_ssid; -+ -+ if (check_fwstate(mlmepriv, WIFI_AP_STATE) != true) -+ return -EPERM; -+ -+ if (param->u.bcn_ie.reserved[0] != 0xea) -+ return -EINVAL; -+ -+ mlmeinfo->hidden_ssid_mode = ignore_broadcast_ssid = param->u.bcn_ie.reserved[1]; -+ -+ ie_len = len-12-2;/* 12 = param header, 2:no packed */ -+ ssid_ie = rtw_get_ie(param->u.bcn_ie.buf, WLAN_EID_SSID, &ssid_len, ie_len); -+ -+ if (ssid_ie && ssid_len > 0 && ssid_len <= NDIS_802_11_LENGTH_SSID) { -+ struct wlan_bssid_ex *pbss_network = &mlmepriv->cur_network.network; -+ struct wlan_bssid_ex *pbss_network_ext = &mlmeinfo->network; -+ -+ memcpy(ssid, ssid_ie+2, ssid_len); -+ ssid[ssid_len] = 0x0; -+ -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" ssid:(%s,%d), from ie:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ ssid, ssid_len, -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, -+ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); -+ -+ memcpy(pbss_network->Ssid.Ssid, (void *)ssid, ssid_len); -+ pbss_network->Ssid.SsidLength = ssid_len; -+ memcpy(pbss_network_ext->Ssid.Ssid, (void *)ssid, ssid_len); -+ pbss_network_ext->Ssid.SsidLength = ssid_len; -+ -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, -+ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); -+ } -+ -+ DBG_871X(FUNC_ADPT_FMT" ignore_broadcast_ssid:%d, %s,%d\n", FUNC_ADPT_ARG(adapter), -+ ignore_broadcast_ssid, ssid, ssid_len); -+ -+ return ret; -+} -+ -+static int rtw_ioctl_acl_remove_sta(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+ ret = rtw_acl_remove_sta(padapter, param->sta_addr); -+ -+ return ret; -+ -+} -+ -+static int rtw_ioctl_acl_add_sta(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+ ret = rtw_acl_add_sta(padapter, param->sta_addr); -+ -+ return ret; -+ -+} -+ -+static int rtw_ioctl_set_macaddr_acl(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ rtw_set_macaddr_acl(padapter, param->u.mlme.command); -+ -+ return ret; -+} -+ -+static int rtw_hostapd_ioctl(struct net_device *dev, struct iw_point *p) -+{ -+ struct ieee_param *param; -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ /* DBG_871X("%s\n", __func__); */ -+ -+ /* -+ * this function is expect to call in master mode, which allows no power saving -+ * so, we just check hw_init_completed -+ */ -+ -+ if (padapter->hw_init_completed ==false) { -+ ret = -EPERM; -+ goto out; -+ } -+ -+ -+ /* if (p->length < sizeof(struct ieee_param) || !p->pointer) { */ -+ if (!p->pointer) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ param = (struct ieee_param *)rtw_malloc(p->length); -+ if (param == NULL) -+ { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ if (copy_from_user(param, p->pointer, p->length)) -+ { -+ kfree((u8 *)param); -+ ret = -EFAULT; -+ goto out; -+ } -+ -+ /* DBG_871X("%s, cmd =%d\n", __func__, param->cmd); */ -+ -+ switch (param->cmd) -+ { -+ case RTL871X_HOSTAPD_FLUSH: -+ -+ ret = rtw_hostapd_sta_flush(dev); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_ADD_STA: -+ -+ ret = rtw_add_sta(dev, param); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_REMOVE_STA: -+ -+ ret = rtw_del_sta(dev, param); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_BEACON: -+ -+ ret = rtw_set_beacon(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_SET_ENCRYPTION: -+ -+ ret = rtw_set_encryption(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_GET_WPAIE_STA: -+ -+ ret = rtw_get_sta_wpaie(dev, param); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_WPS_BEACON: -+ -+ ret = rtw_set_wps_beacon(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_WPS_PROBE_RESP: -+ -+ ret = rtw_set_wps_probe_resp(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_WPS_ASSOC_RESP: -+ -+ ret = rtw_set_wps_assoc_resp(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_HIDDEN_SSID: -+ -+ ret = rtw_set_hidden_ssid(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_GET_INFO_STA: -+ -+ ret = rtw_ioctl_get_sta_data(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_MACADDR_ACL: -+ -+ ret = rtw_ioctl_set_macaddr_acl(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_ACL_ADD_STA: -+ -+ ret = rtw_ioctl_acl_add_sta(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_ACL_REMOVE_STA: -+ -+ ret = rtw_ioctl_acl_remove_sta(dev, param, p->length); -+ -+ break; -+ -+ default: -+ DBG_871X("Unknown hostapd request: %d\n", param->cmd); -+ ret = -EOPNOTSUPP; -+ break; -+ -+ } -+ -+ if (ret == 0 && copy_to_user(p->pointer, param, p->length)) -+ ret = -EFAULT; -+ -+ -+ kfree((u8 *)param); -+ -+out: -+ -+ return ret; -+ -+} -+ -+static int rtw_wx_set_priv(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *awrq, -+ char *extra) -+{ -+ -+#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV -+ char *ext_dbg; -+#endif -+ -+ int ret = 0; -+ int len = 0; -+ char *ext; -+ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct iw_point *dwrq = (struct iw_point*)awrq; -+ -+ /* RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_notice_, ("+rtw_wx_set_priv\n")); */ -+ if (dwrq->length == 0) -+ return -EFAULT; -+ -+ len = dwrq->length; -+ if (!(ext = vmalloc(len))) -+ return -ENOMEM; -+ -+ if (copy_from_user(ext, dwrq->pointer, len)) { -+ vfree(ext); -+ return -EFAULT; -+ } -+ -+ -+ /* RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_notice_, */ -+ /* ("rtw_wx_set_priv: %s req =%s\n", */ -+ /* dev->name, ext)); */ -+ -+ #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV -+ if (!(ext_dbg = vmalloc(len))) -+ { -+ vfree(ext, len); -+ return -ENOMEM; -+ } -+ -+ memcpy(ext_dbg, ext, len); -+ #endif -+ -+ /* added for wps2.0 @20110524 */ -+ if (dwrq->flags == 0x8766 && len > 8) -+ { -+ u32 cp_sz; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 *probereq_wpsie = ext; -+ int probereq_wpsie_len = len; -+ u8 wps_oui[4]={0x0, 0x50, 0xf2, 0x04}; -+ -+ if ((_VENDOR_SPECIFIC_IE_ == probereq_wpsie[0]) && -+ (!memcmp(&probereq_wpsie[2], wps_oui, 4))) -+ { -+ cp_sz = probereq_wpsie_len>MAX_WPS_IE_LEN ? MAX_WPS_IE_LEN:probereq_wpsie_len; -+ -+ if (pmlmepriv->wps_probe_req_ie) -+ { -+ pmlmepriv->wps_probe_req_ie_len = 0; -+ kfree(pmlmepriv->wps_probe_req_ie); -+ pmlmepriv->wps_probe_req_ie = NULL; -+ } -+ -+ pmlmepriv->wps_probe_req_ie = rtw_malloc(cp_sz); -+ if (pmlmepriv->wps_probe_req_ie == NULL) { -+ printk("%s()-%d: rtw_malloc() ERROR!\n", __func__, __LINE__); -+ ret = -EINVAL; -+ goto FREE_EXT; -+ -+ } -+ -+ memcpy(pmlmepriv->wps_probe_req_ie, probereq_wpsie, cp_sz); -+ pmlmepriv->wps_probe_req_ie_len = cp_sz; -+ -+ } -+ -+ goto FREE_EXT; -+ -+ } -+ -+ if (len >= WEXT_CSCAN_HEADER_SIZE -+ && !memcmp(ext, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) -+ ) { -+ ret = rtw_wx_set_scan(dev, info, awrq, ext); -+ goto FREE_EXT; -+ } -+ -+FREE_EXT: -+ -+ vfree(ext); -+ #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV -+ vfree(ext_dbg); -+ #endif -+ -+ /* DBG_871X("rtw_wx_set_priv: (SIOCSIWPRIV) %s ret =%d\n", */ -+ /* dev->name, ret); */ -+ -+ return ret; -+ -+} -+ -+static int rtw_pm_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ unsigned mode = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X("[%s] extra = %s\n", __func__, extra); -+ -+ if (!memcmp(extra, "lps =", 4)) -+ { -+ sscanf(extra+4, "%u", &mode); -+ ret = rtw_pm_set_lps(padapter, mode); -+ } -+ else if (!memcmp(extra, "ips =", 4)) -+ { -+ sscanf(extra+4, "%u", &mode); -+ ret = rtw_pm_set_ips(padapter, mode); -+ } -+ else { -+ ret = -EINVAL; -+ } -+ -+ return ret; -+} -+ -+static int rtw_mp_efuse_get(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wdata, char *extra) -+{ -+ int err = 0; -+ return err; -+} -+ -+static int rtw_mp_efuse_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wdata, char *extra) -+{ -+ int err = 0; -+ return err; -+} -+ -+static int rtw_tdls(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ return ret; -+} -+ -+ -+static int rtw_tdls_get(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ return ret; -+} -+ -+ -+ -+ -+ -+#ifdef CONFIG_INTEL_WIDI -+static int rtw_widi_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ process_intel_widi_cmd(padapter, extra); -+ -+ return ret; -+} -+ -+static int rtw_widi_set_probe_request(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ u8 *pbuf = NULL; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ pbuf = rtw_malloc(sizeof(l2_msg_t)); -+ if (pbuf) -+ { -+ if (copy_from_user(pbuf, wrqu->data.pointer, wrqu->data.length)) -+ ret = -EFAULT; -+ /* memcpy(pbuf, wrqu->data.pointer, wrqu->data.length); */ -+ -+ if (wrqu->data.flags == 0) -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_ISSUE_PROB_WK, pbuf, sizeof(l2_msg_t)); -+ else if (wrqu->data.flags == 1) -+ rtw_set_wfd_rds_sink_info(padapter, (l2_msg_t *)pbuf); -+ } -+ return ret; -+} -+#endif /* CONFIG_INTEL_WIDI */ -+ -+static int rtw_test( -+ struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ u32 len; -+ u8 *pbuf, *pch; -+ char *ptmp; -+ u8 *delim = ","; -+ struct adapter *padapter = rtw_netdev_priv(dev); -+ -+ -+ DBG_871X("+%s\n", __func__); -+ len = wrqu->data.length; -+ -+ pbuf = (u8 *)rtw_zmalloc(len); -+ if (pbuf == NULL) { -+ DBG_871X("%s: no memory!\n", __func__); -+ return -ENOMEM; -+ } -+ -+ if (copy_from_user(pbuf, wrqu->data.pointer, len)) { -+ kfree(pbuf); -+ DBG_871X("%s: copy from user fail!\n", __func__); -+ return -EFAULT; -+ } -+ DBG_871X("%s: string =\"%s\"\n", __func__, pbuf); -+ -+ ptmp = (char*)pbuf; -+ pch = strsep(&ptmp, delim); -+ if ((pch == NULL) || (strlen(pch) == 0)) { -+ kfree(pbuf); -+ DBG_871X("%s: parameter error(level 1)!\n", __func__); -+ return -EFAULT; -+ } -+ -+ if (strcmp(pch, "bton") == 0) -+ { -+ rtw_btcoex_SetManualControl(padapter, false); -+ } -+ -+ if (strcmp(pch, "btoff") == 0) -+ { -+ rtw_btcoex_SetManualControl(padapter, true); -+ } -+ -+ if (strcmp(pch, "h2c") == 0) -+ { -+ u8 param[8]; -+ u8 count = 0; -+ u32 tmp; -+ u8 i; -+ u32 pos; -+ s32 ret; -+ -+ -+ do { -+ pch = strsep(&ptmp, delim); -+ if ((pch == NULL) || (strlen(pch) == 0)) -+ break; -+ -+ sscanf(pch, "%x", &tmp); -+ param[count++] = (u8)tmp; -+ } while (count < 8); -+ -+ if (count == 0) { -+ kfree(pbuf); -+ DBG_871X("%s: parameter error(level 2)!\n", __func__); -+ return -EFAULT; -+ } -+ -+ ret = rtw_hal_fill_h2c_cmd(padapter, param[0], count-1, ¶m[1]); -+ -+ pos = sprintf(extra, "H2C ID = 0x%02x content =", param[0]); -+ for (i = 1; idata.length = strlen(extra) + 1; -+ } -+ -+ kfree(pbuf); -+ return 0; -+} -+ -+static iw_handler rtw_handlers[] = -+{ -+ NULL, /* SIOCSIWCOMMIT */ -+ rtw_wx_get_name, /* SIOCGIWNAME */ -+ dummy, /* SIOCSIWNWID */ -+ dummy, /* SIOCGIWNWID */ -+ rtw_wx_set_freq, /* SIOCSIWFREQ */ -+ rtw_wx_get_freq, /* SIOCGIWFREQ */ -+ rtw_wx_set_mode, /* SIOCSIWMODE */ -+ rtw_wx_get_mode, /* SIOCGIWMODE */ -+ dummy, /* SIOCSIWSENS */ -+ rtw_wx_get_sens, /* SIOCGIWSENS */ -+ NULL, /* SIOCSIWRANGE */ -+ rtw_wx_get_range, /* SIOCGIWRANGE */ -+ rtw_wx_set_priv, /* SIOCSIWPRIV */ -+ NULL, /* SIOCGIWPRIV */ -+ NULL, /* SIOCSIWSTATS */ -+ NULL, /* SIOCGIWSTATS */ -+ dummy, /* SIOCSIWSPY */ -+ dummy, /* SIOCGIWSPY */ -+ NULL, /* SIOCGIWTHRSPY */ -+ NULL, /* SIOCWIWTHRSPY */ -+ rtw_wx_set_wap, /* SIOCSIWAP */ -+ rtw_wx_get_wap, /* SIOCGIWAP */ -+ rtw_wx_set_mlme, /* request MLME operation; uses struct iw_mlme */ -+ dummy, /* SIOCGIWAPLIST -- depricated */ -+ rtw_wx_set_scan, /* SIOCSIWSCAN */ -+ rtw_wx_get_scan, /* SIOCGIWSCAN */ -+ rtw_wx_set_essid, /* SIOCSIWESSID */ -+ rtw_wx_get_essid, /* SIOCGIWESSID */ -+ dummy, /* SIOCSIWNICKN */ -+ rtw_wx_get_nick, /* SIOCGIWNICKN */ -+ NULL, /* -- hole -- */ -+ NULL, /* -- hole -- */ -+ rtw_wx_set_rate, /* SIOCSIWRATE */ -+ rtw_wx_get_rate, /* SIOCGIWRATE */ -+ rtw_wx_set_rts, /* SIOCSIWRTS */ -+ rtw_wx_get_rts, /* SIOCGIWRTS */ -+ rtw_wx_set_frag, /* SIOCSIWFRAG */ -+ rtw_wx_get_frag, /* SIOCGIWFRAG */ -+ dummy, /* SIOCSIWTXPOW */ -+ dummy, /* SIOCGIWTXPOW */ -+ dummy, /* SIOCSIWRETRY */ -+ rtw_wx_get_retry, /* SIOCGIWRETRY */ -+ rtw_wx_set_enc, /* SIOCSIWENCODE */ -+ rtw_wx_get_enc, /* SIOCGIWENCODE */ -+ dummy, /* SIOCSIWPOWER */ -+ rtw_wx_get_power, /* SIOCGIWPOWER */ -+ NULL, /*---hole---*/ -+ NULL, /*---hole---*/ -+ rtw_wx_set_gen_ie, /* SIOCSIWGENIE */ -+ NULL, /* SIOCGWGENIE */ -+ rtw_wx_set_auth, /* SIOCSIWAUTH */ -+ NULL, /* SIOCGIWAUTH */ -+ rtw_wx_set_enc_ext, /* SIOCSIWENCODEEXT */ -+ NULL, /* SIOCGIWENCODEEXT */ -+ rtw_wx_set_pmkid, /* SIOCSIWPMKSA */ -+ NULL, /*---hole---*/ -+}; -+ -+static const struct iw_priv_args rtw_private_args[] = { -+ { -+ SIOCIWFIRSTPRIV + 0x0, -+ IW_PRIV_TYPE_CHAR | 0x7FF, 0, "write" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x1, -+ IW_PRIV_TYPE_CHAR | 0x7FF, -+ IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ, "read" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x2, 0, 0, "driver_ext" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x3, 0, 0, "mp_ioctl" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x4, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "apinfo" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x5, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "setpid" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x6, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_start" -+ }, -+/* for PLATFORM_MT53XX */ -+ { -+ SIOCIWFIRSTPRIV + 0x7, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "get_sensitivity" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x8, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_prob_req_ie" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x9, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_assoc_req_ie" -+ }, -+ -+/* for RTK_DMP_PLATFORM */ -+ { -+ SIOCIWFIRSTPRIV + 0xA, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "channel_plan" -+ }, -+ -+ { -+ SIOCIWFIRSTPRIV + 0xB, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "dbg" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0xC, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 3, 0, "rfw" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0xD, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ, "rfr" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x10, -+ IW_PRIV_TYPE_CHAR | 1024, 0, "p2p_set" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x11, -+ IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , "p2p_get" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x12, 0, 0, "NULL" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x13, -+ IW_PRIV_TYPE_CHAR | 64, IW_PRIV_TYPE_CHAR | 64 , "p2p_get2" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x14, -+ IW_PRIV_TYPE_CHAR | 64, 0, "tdls" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x15, -+ IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | 1024 , "tdls_get" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x16, -+ IW_PRIV_TYPE_CHAR | 64, 0, "pm_set" -+ }, -+ -+ {SIOCIWFIRSTPRIV + 0x18, IW_PRIV_TYPE_CHAR | IFNAMSIZ , 0 , "rereg_nd_name"}, -+ {SIOCIWFIRSTPRIV + 0x1A, IW_PRIV_TYPE_CHAR | 1024, 0, "efuse_set"}, -+ {SIOCIWFIRSTPRIV + 0x1B, IW_PRIV_TYPE_CHAR | 128, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_get"}, -+ { -+ SIOCIWFIRSTPRIV + 0x1D, -+ IW_PRIV_TYPE_CHAR | 40, IW_PRIV_TYPE_CHAR | 0x7FF, "test" -+ }, -+ -+#ifdef CONFIG_INTEL_WIDI -+ { -+ SIOCIWFIRSTPRIV + 0x1E, -+ IW_PRIV_TYPE_CHAR | 1024, 0, "widi_set" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x1F, -+ IW_PRIV_TYPE_CHAR | 128, 0, "widi_prob_req" -+ }, -+#endif /* CONFIG_INTEL_WIDI */ -+ -+#ifdef CONFIG_WOWLAN -+ { MP_WOW_ENABLE , IW_PRIV_TYPE_CHAR | 1024, 0, "wow_mode" }, /* set */ -+#endif -+#ifdef CONFIG_AP_WOWLAN -+ { MP_AP_WOW_ENABLE , IW_PRIV_TYPE_CHAR | 1024, 0, "ap_wow_mode" }, /* set */ -+#endif -+}; -+ -+static iw_handler rtw_private_handler[] = -+{ -+ rtw_wx_write32, /* 0x00 */ -+ rtw_wx_read32, /* 0x01 */ -+ rtw_drvext_hdl, /* 0x02 */ -+ rtw_mp_ioctl_hdl, /* 0x03 */ -+ -+/* for MM DTV platform */ -+ rtw_get_ap_info, /* 0x04 */ -+ -+ rtw_set_pid, /* 0x05 */ -+ rtw_wps_start, /* 0x06 */ -+ -+/* for PLATFORM_MT53XX */ -+ rtw_wx_get_sensitivity, /* 0x07 */ -+ rtw_wx_set_mtk_wps_probe_ie, /* 0x08 */ -+ rtw_wx_set_mtk_wps_ie, /* 0x09 */ -+ -+/* for RTK_DMP_PLATFORM */ -+/* Set Channel depend on the country code */ -+ rtw_wx_set_channel_plan, /* 0x0A */ -+ -+ rtw_dbg_port, /* 0x0B */ -+ rtw_wx_write_rf, /* 0x0C */ -+ rtw_wx_read_rf, /* 0x0D */ -+ rtw_wx_priv_null, /* 0x0E */ -+ rtw_wx_priv_null, /* 0x0F */ -+ rtw_p2p_set, /* 0x10 */ -+ rtw_p2p_get, /* 0x11 */ -+ NULL, /* 0x12 */ -+ rtw_p2p_get2, /* 0x13 */ -+ -+ rtw_tdls, /* 0x14 */ -+ rtw_tdls_get, /* 0x15 */ -+ -+ rtw_pm_set, /* 0x16 */ -+ rtw_wx_priv_null, /* 0x17 */ -+ rtw_rereg_nd_name, /* 0x18 */ -+ rtw_wx_priv_null, /* 0x19 */ -+ rtw_mp_efuse_set, /* 0x1A */ -+ rtw_mp_efuse_get, /* 0x1B */ -+ NULL, /* 0x1C is reserved for hostapd */ -+ rtw_test, /* 0x1D */ -+#ifdef CONFIG_INTEL_WIDI -+ rtw_widi_set, /* 0x1E */ -+ rtw_widi_set_probe_request, /* 0x1F */ -+#endif /* CONFIG_INTEL_WIDI */ -+}; -+ -+static struct iw_statistics *rtw_get_wireless_stats(struct net_device *dev) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct iw_statistics *piwstats =&padapter->iwstats; -+ int tmp_level = 0; -+ int tmp_qual = 0; -+ int tmp_noise = 0; -+ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) != true) -+ { -+ piwstats->qual.qual = 0; -+ piwstats->qual.level = 0; -+ piwstats->qual.noise = 0; -+ /* DBG_871X("No link level:%d, qual:%d, noise:%d\n", tmp_level, tmp_qual, tmp_noise); */ -+ } -+ else { -+ #ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ tmp_level = translate_percentage_to_dbm(padapter->recvpriv.signal_strength); -+ #else -+ #ifdef CONFIG_SKIP_SIGNAL_SCALE_MAPPING -+ { -+ /* Do signal scale mapping when using percentage as the unit of signal strength, since the scale mapping is skipped in odm */ -+ -+ struct hal_com_data *pHal = GET_HAL_DATA(padapter); -+ -+ tmp_level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, padapter->recvpriv.signal_strength); -+ } -+ #else -+ tmp_level = padapter->recvpriv.signal_strength; -+ #endif -+ #endif -+ -+ tmp_qual = padapter->recvpriv.signal_qual; -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ if (rtw_linked_check(padapter)) { -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct noise_info info; -+ info.bPauseDIG = true; -+ info.IGIValue = 0x1e; -+ info.max_time = 100;/* ms */ -+ info.chan = pmlmeext->cur_channel ;/* rtw_get_oper_ch(padapter); */ -+ rtw_ps_deny(padapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(padapter); -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_NOISE_MONITOR,&info, false); -+ /* ODM_InbandNoise_Monitor(podmpriv, true, 0x20, 100); */ -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR,&(info.chan), &(padapter->recvpriv.noise)); -+ DBG_871X("chan:%d, noise_level:%d\n", info.chan, padapter->recvpriv.noise); -+ } -+#endif -+ tmp_noise = padapter->recvpriv.noise; -+ DBG_871X("level:%d, qual:%d, noise:%d, rssi (%d)\n", tmp_level, tmp_qual, tmp_noise, padapter->recvpriv.rssi); -+ -+ piwstats->qual.level = tmp_level; -+ piwstats->qual.qual = tmp_qual; -+ piwstats->qual.noise = tmp_noise; -+ } -+ piwstats->qual.updated = IW_QUAL_ALL_UPDATED ;/* IW_QUAL_DBM; */ -+ -+ #ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ piwstats->qual.updated = piwstats->qual.updated | IW_QUAL_DBM; -+ #endif -+ -+ return &padapter->iwstats; -+} -+ -+struct iw_handler_def rtw_handlers_def = -+{ -+ .standard = rtw_handlers, -+ .num_standard = sizeof(rtw_handlers) / sizeof(iw_handler), -+#if defined(CONFIG_WEXT_PRIV) -+ .private = rtw_private_handler, -+ .private_args = (struct iw_priv_args *)rtw_private_args, -+ .num_private = sizeof(rtw_private_handler) / sizeof(iw_handler), -+ .num_private_args = sizeof(rtw_private_args) / sizeof(struct iw_priv_args), -+#endif -+ .get_wireless_stats = rtw_get_wireless_stats, -+}; -+ -+/* copy from net/wireless/wext.c start */ -+/* ---------------------------------------------------------------- */ -+/* -+ * Calculate size of private arguments -+ */ -+static const char iw_priv_type_size[] = { -+ 0, /* IW_PRIV_TYPE_NONE */ -+ 1, /* IW_PRIV_TYPE_BYTE */ -+ 1, /* IW_PRIV_TYPE_CHAR */ -+ 0, /* Not defined */ -+ sizeof(__u32), /* IW_PRIV_TYPE_INT */ -+ sizeof(struct iw_freq), /* IW_PRIV_TYPE_FLOAT */ -+ sizeof(struct sockaddr), /* IW_PRIV_TYPE_ADDR */ -+ 0, /* Not defined */ -+}; -+ -+static int get_priv_size(__u16 args) -+{ -+ int num = args & IW_PRIV_SIZE_MASK; -+ int type = (args & IW_PRIV_TYPE_MASK) >> 12; -+ -+ return num * iw_priv_type_size[type]; -+} -+/* copy from net/wireless/wext.c end */ -+ -+static int rtw_ioctl_wext_private(struct net_device *dev, union iwreq_data *wrq_data) -+{ -+ int err = 0; -+ u8 *input = NULL; -+ u32 input_len = 0; -+ const char delim[] = " "; -+ u8 *output = NULL; -+ u32 output_len = 0; -+ u32 count = 0; -+ u8 *buffer = NULL; -+ u32 buffer_len = 0; -+ char *ptr = NULL; -+ u8 cmdname[17] = {0}; /* IFNAMSIZ+1 */ -+ u32 cmdlen; -+ s32 len; -+ u8 *extra = NULL; -+ u32 extra_size = 0; -+ -+ s32 k; -+ const iw_handler *priv; /* Private ioctl */ -+ const struct iw_priv_args *priv_args; /* Private ioctl description */ -+ u32 num_priv; /* Number of ioctl */ -+ u32 num_priv_args; /* Number of descriptions */ -+ iw_handler handler; -+ int temp; -+ int subcmd = 0; /* sub-ioctl index */ -+ int offset = 0; /* Space for sub-ioctl index */ -+ -+ union iwreq_data wdata; -+ -+ -+ memcpy(&wdata, wrq_data, sizeof(wdata)); -+ -+ input_len = 2048; -+ input = rtw_zmalloc(input_len); -+ if (NULL == input) -+ return -ENOMEM; -+ if (copy_from_user(input, wdata.data.pointer, input_len)) { -+ err = -EFAULT; -+ goto exit; -+ } -+ ptr = input; -+ len = strlen(input); -+ -+ sscanf(ptr, "%16s", cmdname); -+ cmdlen = strlen(cmdname); -+ DBG_8192C("%s: cmd =%s\n", __func__, cmdname); -+ -+ /* skip command string */ -+ if (cmdlen > 0) -+ cmdlen += 1; /* skip one space */ -+ ptr += cmdlen; -+ len -= cmdlen; -+ DBG_8192C("%s: parameters =%s\n", __func__, ptr); -+ -+ priv = rtw_private_handler; -+ priv_args = rtw_private_args; -+ num_priv = sizeof(rtw_private_handler) / sizeof(iw_handler); -+ num_priv_args = sizeof(rtw_private_args) / sizeof(struct iw_priv_args); -+ -+ if (num_priv_args == 0) { -+ err = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+ /* Search the correct ioctl */ -+ k = -1; -+ while ((++k < num_priv_args) && strcmp(priv_args[k].name, cmdname)); -+ -+ /* If not found... */ -+ if (k == num_priv_args) { -+ err = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+ /* Watch out for sub-ioctls ! */ -+ if (priv_args[k].cmd < SIOCDEVPRIVATE) -+ { -+ int j = -1; -+ -+ /* Find the matching *real* ioctl */ -+ while ((++j < num_priv_args) && ((priv_args[j].name[0] != '\0') || -+ (priv_args[j].set_args != priv_args[k].set_args) || -+ (priv_args[j].get_args != priv_args[k].get_args))); -+ -+ /* If not found... */ -+ if (j == num_priv_args) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ /* Save sub-ioctl number */ -+ subcmd = priv_args[k].cmd; -+ /* Reserve one int (simplify alignment issues) */ -+ offset = sizeof(__u32); -+ /* Use real ioctl definition from now on */ -+ k = j; -+ } -+ -+ buffer = rtw_zmalloc(4096); -+ if (NULL == buffer) { -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ /* If we have to set some data */ -+ if ((priv_args[k].set_args & IW_PRIV_TYPE_MASK) && -+ (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) -+ { -+ u8 *str; -+ -+ switch (priv_args[k].set_args & IW_PRIV_TYPE_MASK) -+ { -+ case IW_PRIV_TYPE_BYTE: -+ /* Fetch args */ -+ count = 0; -+ do { -+ str = strsep(&ptr, delim); -+ if (NULL == str) break; -+ sscanf(str, "%i", &temp); -+ buffer[count++] = (u8)temp; -+ } while (1); -+ buffer_len = count; -+ -+ /* Number of args to fetch */ -+ wdata.data.length = count; -+ if (wdata.data.length > (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) -+ wdata.data.length = priv_args[k].set_args & IW_PRIV_SIZE_MASK; -+ -+ break; -+ -+ case IW_PRIV_TYPE_INT: -+ /* Fetch args */ -+ count = 0; -+ do { -+ str = strsep(&ptr, delim); -+ if (NULL == str) break; -+ sscanf(str, "%i", &temp); -+ ((s32*)buffer)[count++] = (s32)temp; -+ } while (1); -+ buffer_len = count * sizeof(s32); -+ -+ /* Number of args to fetch */ -+ wdata.data.length = count; -+ if (wdata.data.length > (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) -+ wdata.data.length = priv_args[k].set_args & IW_PRIV_SIZE_MASK; -+ -+ break; -+ -+ case IW_PRIV_TYPE_CHAR: -+ if (len > 0) -+ { -+ /* Size of the string to fetch */ -+ wdata.data.length = len; -+ if (wdata.data.length > (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) -+ wdata.data.length = priv_args[k].set_args & IW_PRIV_SIZE_MASK; -+ -+ /* Fetch string */ -+ memcpy(buffer, ptr, wdata.data.length); -+ } -+ else -+ { -+ wdata.data.length = 1; -+ buffer[0] = '\0'; -+ } -+ buffer_len = wdata.data.length; -+ break; -+ -+ default: -+ DBG_8192C("%s: Not yet implemented...\n", __func__); -+ err = -1; -+ goto exit; -+ } -+ -+ if ((priv_args[k].set_args & IW_PRIV_SIZE_FIXED) && -+ (wdata.data.length != (priv_args[k].set_args & IW_PRIV_SIZE_MASK))) -+ { -+ DBG_8192C("%s: The command %s needs exactly %d argument(s)...\n", -+ __func__, cmdname, priv_args[k].set_args & IW_PRIV_SIZE_MASK); -+ err = -EINVAL; -+ goto exit; -+ } -+ } /* if args to set */ -+ else -+ { -+ wdata.data.length = 0L; -+ } -+ -+ /* Those two tests are important. They define how the driver -+ * will have to handle the data */ -+ if ((priv_args[k].set_args & IW_PRIV_SIZE_FIXED) && -+ ((get_priv_size(priv_args[k].set_args) + offset) <= IFNAMSIZ)) -+ { -+ /* First case : all SET args fit within wrq */ -+ if (offset) -+ wdata.mode = subcmd; -+ memcpy(wdata.name + offset, buffer, IFNAMSIZ - offset); -+ } -+ else -+ { -+ if ((priv_args[k].set_args == 0) && -+ (priv_args[k].get_args & IW_PRIV_SIZE_FIXED) && -+ (get_priv_size(priv_args[k].get_args) <= IFNAMSIZ)) -+ { -+ /* Second case : no SET args, GET args fit within wrq */ -+ if (offset) -+ wdata.mode = subcmd; -+ } -+ else -+ { -+ /* Third case : args won't fit in wrq, or variable number of args */ -+ if (copy_to_user(wdata.data.pointer, buffer, buffer_len)) { -+ err = -EFAULT; -+ goto exit; -+ } -+ wdata.data.flags = subcmd; -+ } -+ } -+ -+ kfree(input); -+ input = NULL; -+ -+ extra_size = 0; -+ if (IW_IS_SET(priv_args[k].cmd)) -+ { -+ /* Size of set arguments */ -+ extra_size = get_priv_size(priv_args[k].set_args); -+ -+ /* Does it fits in iwr ? */ -+ if ((priv_args[k].set_args & IW_PRIV_SIZE_FIXED) && -+ ((extra_size + offset) <= IFNAMSIZ)) -+ extra_size = 0; -+ } else { -+ /* Size of get arguments */ -+ extra_size = get_priv_size(priv_args[k].get_args); -+ -+ /* Does it fits in iwr ? */ -+ if ((priv_args[k].get_args & IW_PRIV_SIZE_FIXED) && -+ (extra_size <= IFNAMSIZ)) -+ extra_size = 0; -+ } -+ -+ if (extra_size == 0) { -+ extra = (u8 *)&wdata; -+ kfree(buffer); -+ buffer = NULL; -+ } else -+ extra = buffer; -+ -+ handler = priv[priv_args[k].cmd - SIOCIWFIRSTPRIV]; -+ err = handler(dev, NULL, &wdata, extra); -+ -+ /* If we have to get some data */ -+ if ((priv_args[k].get_args & IW_PRIV_TYPE_MASK) && -+ (priv_args[k].get_args & IW_PRIV_SIZE_MASK)) -+ { -+ int j; -+ int n = 0; /* number of args */ -+ u8 str[20] = {0}; -+ -+ /* Check where is the returned data */ -+ if ((priv_args[k].get_args & IW_PRIV_SIZE_FIXED) && -+ (get_priv_size(priv_args[k].get_args) <= IFNAMSIZ)) -+ n = priv_args[k].get_args & IW_PRIV_SIZE_MASK; -+ else -+ n = wdata.data.length; -+ -+ output = rtw_zmalloc(4096); -+ if (NULL == output) { -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ switch (priv_args[k].get_args & IW_PRIV_TYPE_MASK) -+ { -+ case IW_PRIV_TYPE_BYTE: -+ /* Display args */ -+ for (j = 0; j < n; j++) -+ { -+ sprintf(str, "%d ", extra[j]); -+ len = strlen(str); -+ output_len = strlen(output); -+ if ((output_len + len + 1) > 4096) { -+ err = -E2BIG; -+ goto exit; -+ } -+ memcpy(output+output_len, str, len); -+ } -+ break; -+ -+ case IW_PRIV_TYPE_INT: -+ /* Display args */ -+ for (j = 0; j < n; j++) -+ { -+ sprintf(str, "%d ", ((__s32*)extra)[j]); -+ len = strlen(str); -+ output_len = strlen(output); -+ if ((output_len + len + 1) > 4096) { -+ err = -E2BIG; -+ goto exit; -+ } -+ memcpy(output+output_len, str, len); -+ } -+ break; -+ -+ case IW_PRIV_TYPE_CHAR: -+ /* Display args */ -+ memcpy(output, extra, n); -+ break; -+ -+ default: -+ DBG_8192C("%s: Not yet implemented...\n", __func__); -+ err = -1; -+ goto exit; -+ } -+ -+ output_len = strlen(output) + 1; -+ wrq_data->data.length = output_len; -+ if (copy_to_user(wrq_data->data.pointer, output, output_len)) { -+ err = -EFAULT; -+ goto exit; -+ } -+ } /* if args to set */ -+ else -+ { -+ wrq_data->data.length = 0; -+ } -+ -+exit: -+ if (input) -+ kfree(input); -+ if (buffer) -+ kfree(buffer); -+ if (output) -+ kfree(output); -+ -+ return err; -+} -+ -+int rtw_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) -+{ -+ struct iwreq *wrq = (struct iwreq *)rq; -+ int ret = 0; -+ -+ switch (cmd) -+ { -+ case RTL_IOCTL_WPA_SUPPLICANT: -+ ret = wpa_supplicant_ioctl(dev, &wrq->u.data); -+ break; -+ case RTL_IOCTL_HOSTAPD: -+ ret = rtw_hostapd_ioctl(dev, &wrq->u.data); -+ break; -+ case SIOCDEVPRIVATE: -+ ret = rtw_ioctl_wext_private(dev, &wrq->u); -+ break; -+ default: -+ ret = -EOPNOTSUPP; -+ break; -+ } -+ -+ return ret; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/os_dep/mlme_linux.c linux/3rdparty/rtl8723bs/os_dep/mlme_linux.c ---- linux.old/3rdparty/rtl8723bs/os_dep/mlme_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/os_dep/mlme_linux.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,206 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#define _MLME_OSDEP_C_ -+ -+#include -+#include -+ -+static void _dynamic_check_timer_handlder (void *FunctionContext) -+{ -+ struct adapter *adapter = (struct adapter *)FunctionContext; -+ -+ rtw_dynamic_check_timer_handlder(adapter); -+ -+ _set_timer(&adapter->mlmepriv.dynamic_chk_timer, 2000); -+} -+ -+static void _rtw_set_scan_deny_timer_hdl(void *FunctionContext) -+{ -+ struct adapter *adapter = (struct adapter *)FunctionContext; -+ rtw_set_scan_deny_timer_hdl(adapter); -+} -+ -+void rtw_init_mlme_timer(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ _init_timer(&(pmlmepriv->assoc_timer), padapter->pnetdev, _rtw_join_timeout_handler, padapter); -+ /* _init_timer(&(pmlmepriv->sitesurveyctrl.sitesurvey_ctrl_timer), padapter->pnetdev, sitesurvey_ctrl_handler, padapter); */ -+ _init_timer(&(pmlmepriv->scan_to_timer), padapter->pnetdev, rtw_scan_timeout_handler, padapter); -+ -+ _init_timer(&(pmlmepriv->dynamic_chk_timer), padapter->pnetdev, _dynamic_check_timer_handlder, padapter); -+ -+ _init_timer(&(pmlmepriv->set_scan_deny_timer), padapter->pnetdev, _rtw_set_scan_deny_timer_hdl, padapter); -+} -+ -+void rtw_os_indicate_connect(struct adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) ==true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) ==true)) -+ { -+ rtw_cfg80211_ibss_indicate_connect(adapter); -+ } -+ else -+ rtw_cfg80211_indicate_connect(adapter); -+ -+ rtw_indicate_wx_assoc_event(adapter); -+ netif_carrier_on(adapter->pnetdev); -+ -+ if (adapter->pid[2] != 0) -+ rtw_signal_process(adapter->pid[2], SIGALRM); -+} -+ -+void rtw_os_indicate_scan_done(struct adapter *padapter, bool aborted) -+{ -+ rtw_cfg80211_indicate_scan_done(padapter, aborted); -+ indicate_wx_scan_complete_event(padapter); -+} -+ -+static RT_PMKID_LIST backupPMKIDList[ NUM_PMKID_CACHE ]; -+void rtw_reset_securitypriv(struct adapter *adapter) -+{ -+ u8 backupPMKIDIndex = 0; -+ u8 backupTKIPCountermeasure = 0x00; -+ u32 backupTKIPcountermeasure_time = 0; -+ /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ -+ spin_lock_bh(&adapter->security_key_mutex); -+ -+ if (adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X)/* 802.1x */ -+ { -+ /* Added by Albert 2009/02/18 */ -+ /* We have to backup the PMK information for WiFi PMK Caching test item. */ -+ /* */ -+ /* Backup the btkip_countermeasure information. */ -+ /* When the countermeasure is trigger, the driver have to disconnect with AP for 60 seconds. */ -+ -+ memset(&backupPMKIDList[ 0 ], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); -+ -+ memcpy(&backupPMKIDList[ 0 ], &adapter->securitypriv.PMKIDList[ 0 ], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); -+ backupPMKIDIndex = adapter->securitypriv.PMKIDIndex; -+ backupTKIPCountermeasure = adapter->securitypriv.btkip_countermeasure; -+ backupTKIPcountermeasure_time = adapter->securitypriv.btkip_countermeasure_time; -+ -+ /* reset RX BIP packet number */ -+ pmlmeext->mgnt_80211w_IPN_rx = 0; -+ -+ memset((unsigned char *)&adapter->securitypriv, 0, sizeof (struct security_priv)); -+ -+ /* Added by Albert 2009/02/18 */ -+ /* Restore the PMK information to securitypriv structure for the following connection. */ -+ memcpy(&adapter->securitypriv.PMKIDList[ 0 ], &backupPMKIDList[ 0 ], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); -+ adapter->securitypriv.PMKIDIndex = backupPMKIDIndex; -+ adapter->securitypriv.btkip_countermeasure = backupTKIPCountermeasure; -+ adapter->securitypriv.btkip_countermeasure_time = backupTKIPcountermeasure_time; -+ -+ adapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; -+ adapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled; -+ -+ } -+ else /* reset values in securitypriv */ -+ { -+ /* if (adapter->mlmepriv.fw_state & WIFI_STATION_STATE) */ -+ /* */ -+ struct security_priv *psec_priv =&adapter->securitypriv; -+ -+ psec_priv->dot11AuthAlgrthm =dot11AuthAlgrthm_Open; /* open system */ -+ psec_priv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ psec_priv->dot11PrivacyKeyIndex = 0; -+ -+ psec_priv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ psec_priv->dot118021XGrpKeyid = 1; -+ -+ psec_priv->ndisauthtype = Ndis802_11AuthModeOpen; -+ psec_priv->ndisencryptstatus = Ndis802_11WEPDisabled; -+ /* */ -+ } -+ /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ spin_unlock_bh(&adapter->security_key_mutex); -+} -+ -+void rtw_os_indicate_disconnect(struct adapter *adapter) -+{ -+ /* RT_PMKID_LIST backupPMKIDList[ NUM_PMKID_CACHE ]; */ -+ -+ netif_carrier_off(adapter->pnetdev); /* Do it first for tx broadcast pkt after disconnection issue! */ -+ -+ rtw_cfg80211_indicate_disconnect(adapter); -+ -+ rtw_indicate_wx_disassoc_event(adapter); -+ -+ /* modify for CONFIG_IEEE80211W, none 11w also can use the same command */ -+ rtw_reset_securitypriv_cmd(adapter); -+} -+ -+void rtw_report_sec_ie(struct adapter *adapter, u8 authmode, u8 *sec_ie) -+{ -+ uint len; -+ u8 *buff,*p, i; -+ union iwreq_data wrqu; -+ -+ RT_TRACE(_module_mlme_osdep_c_, _drv_info_, ("+rtw_report_sec_ie, authmode =%d\n", authmode)); -+ -+ buff = NULL; -+ if (authmode == _WPA_IE_ID_) -+ { -+ RT_TRACE(_module_mlme_osdep_c_, _drv_info_, ("rtw_report_sec_ie, authmode =%d\n", authmode)); -+ -+ buff = rtw_zmalloc(IW_CUSTOM_MAX); -+ if (NULL == buff) { -+ DBG_871X(FUNC_ADPT_FMT ": alloc memory FAIL!!\n", -+ FUNC_ADPT_ARG(adapter)); -+ return; -+ } -+ p = buff; -+ -+ p+=sprintf(p,"ASSOCINFO(ReqIEs ="); -+ -+ len = sec_ie[1]+2; -+ len = (len < IW_CUSTOM_MAX) ? len:IW_CUSTOM_MAX; -+ -+ for (i = 0;iaddba_retry_timer, padapter->pnetdev, addba_timer_hdl, psta); -+} -+ -+void init_mlme_ext_timer(struct adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ _init_timer(&pmlmeext->survey_timer, padapter->pnetdev, survey_timer_hdl, padapter); -+ _init_timer(&pmlmeext->link_timer, padapter->pnetdev, link_timer_hdl, padapter); -+ _init_timer(&pmlmeext->sa_query_timer, padapter->pnetdev, sa_query_timer_hdl, padapter); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/os_dep/osdep_service.c linux/3rdparty/rtl8723bs/os_dep/osdep_service.c ---- linux.old/3rdparty/rtl8723bs/os_dep/osdep_service.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/os_dep/osdep_service.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,481 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#define _OSDEP_SERVICE_C_ -+ -+#include -+#include -+ -+/* -+* Translate the OS dependent @param error_code to OS independent RTW_STATUS_CODE -+* @return: one of RTW_STATUS_CODE -+*/ -+inline int RTW_STATUS_CODE(int error_code) -+{ -+ if (error_code >= 0) -+ return _SUCCESS; -+ return _FAIL; -+} -+ -+u8 *_rtw_malloc(u32 sz) -+{ -+ u8 *pbuf = NULL; -+ -+ pbuf = kmalloc(sz, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+ -+ return pbuf; -+} -+ -+u8 *_rtw_zmalloc(u32 sz) -+{ -+ u8 *pbuf = _rtw_malloc(sz); -+ -+ if (pbuf != NULL) { -+ memset(pbuf, 0, sz); -+ } -+ -+ return pbuf; -+} -+ -+inline struct sk_buff *_rtw_skb_alloc(u32 sz) -+{ -+ return __dev_alloc_skb(sz, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+} -+ -+inline struct sk_buff *_rtw_skb_copy(const struct sk_buff *skb) -+{ -+ return skb_copy(skb, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+} -+ -+inline struct sk_buff *_rtw_skb_clone(struct sk_buff *skb) -+{ -+ return skb_clone(skb, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+} -+ -+inline int _rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb) -+{ -+ skb->dev = ndev; -+ return netif_rx(skb); -+} -+ -+void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc) -+{ -+ struct adapter *adapter = (struct adapter *)padapter; -+ -+ _init_timer(ptimer, adapter->pnetdev, pfunc, adapter); -+} -+ -+void _rtw_init_queue(struct __queue *pqueue) -+{ -+ INIT_LIST_HEAD(&(pqueue->queue)); -+ -+ spin_lock_init(&(pqueue->lock)); -+} -+ -+/* -+* Open a file with the specific @param path, @param flag, @param mode -+* @param fpp the pointer of struct file pointer to get struct file pointer while file opening is success -+* @param path the path of the file to open -+* @param flag file operation flags, please refer to linux document -+* @param mode please refer to linux document -+* @return Linux specific error code -+*/ -+static int openFile(struct file **fpp, char *path, int flag, int mode) -+{ -+ struct file *fp; -+ -+ fp =filp_open(path, flag, mode); -+ if (IS_ERR(fp)) { -+ *fpp = NULL; -+ return PTR_ERR(fp); -+ } -+ else { -+ *fpp =fp; -+ return 0; -+ } -+} -+ -+/* -+* Close the file with the specific @param fp -+* @param fp the pointer of struct file to close -+* @return always 0 -+*/ -+static int closeFile(struct file *fp) -+{ -+ filp_close(fp, NULL); -+ return 0; -+} -+ -+static int readFile(struct file *fp, char *buf, int len) -+{ -+ int rlen = 0, sum = 0; -+ -+ if (!fp->f_op || !fp->f_op->read) -+ return -EPERM; -+ -+ while (sumf_op->read(fp, (char __force __user *)buf+sum, len-sum, &fp->f_pos); -+ if (rlen>0) -+ sum+=rlen; -+ else if (0 != rlen) -+ return rlen; -+ else -+ break; -+ } -+ -+ return sum; -+ -+} -+ -+/* -+* Test if the specifi @param path is a file and readable -+* @param path the path of the file to test -+* @return Linux specific error code -+*/ -+static int isFileReadable(char *path) -+{ -+ struct file *fp; -+ int ret = 0; -+ mm_segment_t oldfs; -+ char buf; -+ -+ fp =filp_open(path, O_RDONLY, 0); -+ if (IS_ERR(fp)) { -+ ret = PTR_ERR(fp); -+ } -+ else { -+ oldfs = get_fs(); set_fs(get_ds()); -+ -+ if (1!=readFile(fp, &buf, 1)) -+ ret = PTR_ERR(fp); -+ -+ set_fs(oldfs); -+ filp_close(fp, NULL); -+ } -+ return ret; -+} -+ -+/* -+* Open the file with @param path and retrive the file content into memory starting from @param buf for @param sz at most -+* @param path the path of the file to open and read -+* @param buf the starting address of the buffer to store file content -+* @param sz how many bytes to read at most -+* @return the byte we've read, or Linux specific error code -+*/ -+static int retriveFromFile(char *path, u8 *buf, u32 sz) -+{ -+ int ret =-1; -+ mm_segment_t oldfs; -+ struct file *fp; -+ -+ if (path && buf) { -+ if (0 == (ret =openFile(&fp, path, O_RDONLY, 0))) { -+ DBG_871X("%s openFile path:%s fp =%p\n", __func__, path , fp); -+ -+ oldfs = get_fs(); set_fs(get_ds()); -+ ret =readFile(fp, buf, sz); -+ set_fs(oldfs); -+ closeFile(fp); -+ -+ DBG_871X("%s readFile, ret:%d\n", __func__, ret); -+ -+ } else { -+ DBG_871X("%s openFile path:%s Fail, ret:%d\n", __func__, path, ret); -+ } -+ } else { -+ DBG_871X("%s NULL pointer\n", __func__); -+ ret = -EINVAL; -+ } -+ return ret; -+} -+ -+/* -+* Test if the specifi @param path is a file and readable -+* @param path the path of the file to test -+* @return true or false -+*/ -+int rtw_is_file_readable(char *path) -+{ -+ if (isFileReadable(path) == 0) -+ return true; -+ else -+ return false; -+} -+ -+/* -+* Open the file with @param path and retrive the file content into memory starting from @param buf for @param sz at most -+* @param path the path of the file to open and read -+* @param buf the starting address of the buffer to store file content -+* @param sz how many bytes to read at most -+* @return the byte we've read -+*/ -+int rtw_retrive_from_file(char *path, u8 *buf, u32 sz) -+{ -+ int ret =retriveFromFile(path, buf, sz); -+ return ret>= 0?ret:0; -+} -+ -+struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv) -+{ -+ struct net_device *pnetdev; -+ struct rtw_netdev_priv_indicator *pnpi; -+ -+ pnetdev = alloc_etherdev_mq(sizeof(struct rtw_netdev_priv_indicator), 4); -+ if (!pnetdev) -+ goto RETURN; -+ -+ pnpi = netdev_priv(pnetdev); -+ pnpi->priv =old_priv; -+ pnpi->sizeof_priv =sizeof_priv; -+ -+RETURN: -+ return pnetdev; -+} -+ -+struct net_device *rtw_alloc_etherdev(int sizeof_priv) -+{ -+ struct net_device *pnetdev; -+ struct rtw_netdev_priv_indicator *pnpi; -+ -+ pnetdev = alloc_etherdev_mq(sizeof(struct rtw_netdev_priv_indicator), 4); -+ if (!pnetdev) -+ goto RETURN; -+ -+ pnpi = netdev_priv(pnetdev); -+ -+ pnpi->priv = vzalloc(sizeof_priv); -+ if (!pnpi->priv) { -+ free_netdev(pnetdev); -+ pnetdev = NULL; -+ goto RETURN; -+ } -+ -+ pnpi->sizeof_priv =sizeof_priv; -+RETURN: -+ return pnetdev; -+} -+ -+void rtw_free_netdev(struct net_device * netdev) -+{ -+ struct rtw_netdev_priv_indicator *pnpi; -+ -+ if (!netdev) -+ goto RETURN; -+ -+ pnpi = netdev_priv(netdev); -+ -+ if (!pnpi->priv) -+ goto RETURN; -+ -+ vfree(pnpi->priv); -+ free_netdev(netdev); -+ -+RETURN: -+ return; -+} -+ -+int rtw_change_ifname(struct adapter *padapter, const char *ifname) -+{ -+ struct net_device *pnetdev; -+ struct net_device *cur_pnetdev; -+ struct rereg_nd_name_data *rereg_priv; -+ int ret; -+ -+ if (!padapter) -+ goto error; -+ -+ cur_pnetdev = padapter->pnetdev; -+ rereg_priv = &padapter->rereg_nd_name_priv; -+ -+ /* free the old_pnetdev */ -+ if (rereg_priv->old_pnetdev) { -+ free_netdev(rereg_priv->old_pnetdev); -+ rereg_priv->old_pnetdev = NULL; -+ } -+ -+ if (!rtnl_is_locked()) -+ unregister_netdev(cur_pnetdev); -+ else -+ unregister_netdevice(cur_pnetdev); -+ -+ rereg_priv->old_pnetdev =cur_pnetdev; -+ -+ pnetdev = rtw_init_netdev(padapter); -+ if (!pnetdev) { -+ ret = -1; -+ goto error; -+ } -+ -+ SET_NETDEV_DEV(pnetdev, dvobj_to_dev(adapter_to_dvobj(padapter))); -+ -+ rtw_init_netdev_name(pnetdev, ifname); -+ -+ memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN); -+ -+ if (!rtnl_is_locked()) -+ ret = register_netdev(pnetdev); -+ else -+ ret = register_netdevice(pnetdev); -+ -+ if (ret != 0) { -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("register_netdev() failed\n")); -+ goto error; -+ } -+ -+ return 0; -+ -+error: -+ -+ return -1; -+ -+} -+ -+u64 rtw_modular64(u64 x, u64 y) -+{ -+ return do_div(x, y); -+} -+ -+void rtw_buf_free(u8 **buf, u32 *buf_len) -+{ -+ u32 ori_len; -+ -+ if (!buf || !buf_len) -+ return; -+ -+ ori_len = *buf_len; -+ -+ if (*buf) { -+ *buf_len = 0; -+ kfree(*buf); -+ *buf = NULL; -+ } -+} -+ -+void rtw_buf_update(u8 **buf, u32 *buf_len, u8 *src, u32 src_len) -+{ -+ u32 ori_len = 0, dup_len = 0; -+ u8 *ori = NULL; -+ u8 *dup = NULL; -+ -+ if (!buf || !buf_len) -+ return; -+ -+ if (!src || !src_len) -+ goto keep_ori; -+ -+ /* duplicate src */ -+ dup = rtw_malloc(src_len); -+ if (dup) { -+ dup_len = src_len; -+ memcpy(dup, src, dup_len); -+ } -+ -+keep_ori: -+ ori = *buf; -+ ori_len = *buf_len; -+ -+ /* replace buf with dup */ -+ *buf_len = 0; -+ *buf = dup; -+ *buf_len = dup_len; -+ -+ /* free ori */ -+ if (ori && ori_len > 0) -+ kfree(ori); -+} -+ -+ -+/** -+ * rtw_cbuf_full - test if cbuf is full -+ * @cbuf: pointer of struct rtw_cbuf -+ * -+ * Returns: true if cbuf is full -+ */ -+inline bool rtw_cbuf_full(struct rtw_cbuf *cbuf) -+{ -+ return (cbuf->write == cbuf->read-1)? true : false; -+} -+ -+/** -+ * rtw_cbuf_empty - test if cbuf is empty -+ * @cbuf: pointer of struct rtw_cbuf -+ * -+ * Returns: true if cbuf is empty -+ */ -+inline bool rtw_cbuf_empty(struct rtw_cbuf *cbuf) -+{ -+ return (cbuf->write == cbuf->read)? true : false; -+} -+ -+/** -+ * rtw_cbuf_push - push a pointer into cbuf -+ * @cbuf: pointer of struct rtw_cbuf -+ * @buf: pointer to push in -+ * -+ * Lock free operation, be careful of the use scheme -+ * Returns: true push success -+ */ -+bool rtw_cbuf_push(struct rtw_cbuf *cbuf, void *buf) -+{ -+ if (rtw_cbuf_full(cbuf)) -+ return _FAIL; -+ -+ DBG_871X("%s on %u\n", __func__, cbuf->write); -+ cbuf->bufs[cbuf->write] = buf; -+ cbuf->write = (cbuf->write+1)%cbuf->size; -+ -+ return _SUCCESS; -+} -+ -+/** -+ * rtw_cbuf_pop - pop a pointer from cbuf -+ * @cbuf: pointer of struct rtw_cbuf -+ * -+ * Lock free operation, be careful of the use scheme -+ * Returns: pointer popped out -+ */ -+void *rtw_cbuf_pop(struct rtw_cbuf *cbuf) -+{ -+ void *buf; -+ if (rtw_cbuf_empty(cbuf)) -+ return NULL; -+ -+ DBG_871X("%s on %u\n", __func__, cbuf->read); -+ buf = cbuf->bufs[cbuf->read]; -+ cbuf->read = (cbuf->read+1)%cbuf->size; -+ -+ return buf; -+} -+ -+/** -+ * rtw_cbuf_alloc - allocte a rtw_cbuf with given size and do initialization -+ * @size: size of pointer -+ * -+ * Returns: pointer of srtuct rtw_cbuf, NULL for allocation failure -+ */ -+struct rtw_cbuf *rtw_cbuf_alloc(u32 size) -+{ -+ struct rtw_cbuf *cbuf; -+ -+ cbuf = (struct rtw_cbuf *)rtw_malloc(sizeof(*cbuf) + sizeof(void*)*size); -+ -+ if (cbuf) { -+ cbuf->write = cbuf->read = 0; -+ cbuf->size = size; -+ } -+ -+ return cbuf; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/os_dep/os_intfs.c linux/3rdparty/rtl8723bs/os_dep/os_intfs.c ---- linux.old/3rdparty/rtl8723bs/os_dep/os_intfs.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/os_dep/os_intfs.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,1916 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _OS_INTFS_C_ -+ -+#include -+#include -+#include -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Realtek Wireless Lan Driver"); -+MODULE_AUTHOR("Realtek Semiconductor Corp."); -+MODULE_VERSION(DRIVERVERSION); -+ -+/* module param defaults */ -+static int rtw_chip_version = 0x00; -+static int rtw_rfintfs = HWPI; -+static int rtw_lbkmode = 0;/* RTL8712_AIR_TRX; */ -+ -+ -+static int rtw_network_mode = Ndis802_11IBSS;/* Ndis802_11Infrastructure;infra, ad-hoc, auto */ -+/* struct ndis_802_11_ssid ssid; */ -+static int rtw_channel = 1;/* ad-hoc support requirement */ -+static int rtw_wireless_mode = WIRELESS_MODE_MAX; -+static int rtw_vrtl_carrier_sense = AUTO_VCS; -+static int rtw_vcs_type = RTS_CTS;/* */ -+static int rtw_rts_thresh = 2347;/* */ -+static int rtw_frag_thresh = 2346;/* */ -+static int rtw_preamble = PREAMBLE_LONG;/* long, short, auto */ -+static int rtw_scan_mode = 1;/* active, passive */ -+static int rtw_adhoc_tx_pwr = 1; -+static int rtw_soft_ap = 0; -+/* int smart_ps = 1; */ -+static int rtw_power_mgnt = 1; -+static int rtw_ips_mode = IPS_NORMAL; -+module_param(rtw_ips_mode, int, 0644); -+MODULE_PARM_DESC(rtw_ips_mode,"The default IPS mode"); -+ -+static int rtw_smart_ps = 2; -+ -+static int rtw_check_fw_ps = 1; -+ -+static int rtw_usb_rxagg_mode = 2;/* USB_RX_AGG_DMA = 1, USB_RX_AGG_USB =2 */ -+module_param(rtw_usb_rxagg_mode, int, 0644); -+ -+static int rtw_radio_enable = 1; -+static int rtw_long_retry_lmt = 7; -+static int rtw_short_retry_lmt = 7; -+static int rtw_busy_thresh = 40; -+/* int qos_enable = 0; */ -+static int rtw_ack_policy = NORMAL_ACK; -+ -+static int rtw_software_encrypt = 0; -+static int rtw_software_decrypt = 0; -+ -+static int rtw_acm_method = 0;/* 0:By SW 1:By HW. */ -+ -+static int rtw_wmm_enable = 1;/* default is set to enable the wmm. */ -+static int rtw_uapsd_enable = 0; -+static int rtw_uapsd_max_sp = NO_LIMIT; -+static int rtw_uapsd_acbk_en = 0; -+static int rtw_uapsd_acbe_en = 0; -+static int rtw_uapsd_acvi_en = 0; -+static int rtw_uapsd_acvo_en = 0; -+ -+int rtw_ht_enable = 1; -+/* 0: 20 MHz, 1: 40 MHz, 2: 80 MHz, 3: 160MHz, 4: 80+80MHz */ -+/* 2.4G use bit 0 ~ 3, 5G use bit 4 ~ 7 */ -+/* 0x21 means enable 2.4G 40MHz & 5G 80MHz */ -+static int rtw_bw_mode = 0x21; -+static int rtw_ampdu_enable = 1;/* for enable tx_ampdu ,0: disable, 0x1:enable (but wifi_spec should be 0), 0x2: force enable (don't care wifi_spec) */ -+static int rtw_rx_stbc = 1;/* 0: disable, 1:enable 2.4g */ -+static int rtw_ampdu_amsdu = 0;/* 0: disabled, 1:enabled, 2:auto . There is an IOT issu with DLINK DIR-629 when the flag turn on */ -+/* Short GI support Bit Map */ -+/* BIT0 - 20MHz, 0: non-support, 1: support */ -+/* BIT1 - 40MHz, 0: non-support, 1: support */ -+/* BIT2 - 80MHz, 0: non-support, 1: support */ -+/* BIT3 - 160MHz, 0: non-support, 1: support */ -+static int rtw_short_gi = 0xf; -+/* BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx */ -+static int rtw_ldpc_cap = 0x33; -+/* BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx */ -+static int rtw_stbc_cap = 0x13; -+/* BIT0: Enable VHT Beamformer, BIT1: Enable VHT Beamformee, BIT4: Enable HT Beamformer, BIT5: Enable HT Beamformee */ -+static int rtw_beamform_cap = 0x2; -+ -+static int rtw_lowrate_two_xmit = 1;/* Use 2 path Tx to transmit MCS0~7 and legacy mode */ -+ -+/* int rf_config = RF_1T2R; 1T2R */ -+static int rtw_rf_config = RF_MAX_TYPE; /* auto */ -+static int rtw_low_power = 0; -+static int rtw_wifi_spec = 0; -+static int rtw_channel_plan = RT_CHANNEL_DOMAIN_MAX; -+ -+static int rtw_btcoex_enable = 1; -+module_param(rtw_btcoex_enable, int, 0644); -+MODULE_PARM_DESC(rtw_btcoex_enable, "Enable BT co-existence mechanism"); -+static int rtw_bt_iso = 2;/* 0:Low, 1:High, 2:From Efuse */ -+static int rtw_bt_sco = 3;/* 0:Idle, 1:None-SCO, 2:SCO, 3:From Counter, 4.Busy, 5.OtherBusy */ -+static int rtw_bt_ampdu = 1 ;/* 0:Disable BT control A-MPDU, 1:Enable BT control A-MPDU. */ -+static int rtw_ant_num = -1; /* <0: undefined, >0: Antenna number */ -+module_param(rtw_ant_num, int, 0644); -+MODULE_PARM_DESC(rtw_ant_num, "Antenna number setting"); -+ -+static int rtw_AcceptAddbaReq = true;/* 0:Reject AP's Add BA req, 1:Accept AP's Add BA req. */ -+ -+static int rtw_antdiv_cfg = 1; /* 0:OFF , 1:ON, 2:decide by Efuse config */ -+static int rtw_antdiv_type = 0 ; /* 0:decide by efuse 1: for 88EE, 1Tx and 1RxCG are diversity.(2 Ant with SPDT), 2: for 88EE, 1Tx and 2Rx are diversity.(2 Ant, Tx and RxCG are both on aux port, RxCS is on main port), 3: for 88EE, 1Tx and 1RxCG are fixed.(1Ant, Tx and RxCG are both on aux port) */ -+ -+ -+static int rtw_enusbss = 0;/* 0:disable, 1:enable */ -+ -+static int rtw_hwpdn_mode =2;/* 0:disable, 1:enable, 2: by EFUSE config */ -+ -+#ifdef CONFIG_HW_PWRP_DETECTION -+static int rtw_hwpwrp_detect = 1; -+#else -+static int rtw_hwpwrp_detect = 0; /* HW power ping detect 0:disable , 1:enable */ -+#endif -+ -+static int rtw_hw_wps_pbc = 0; -+ -+int rtw_mc2u_disable = 0; -+ -+static int rtw_80211d = 0; -+ -+#ifdef CONFIG_QOS_OPTIMIZATION -+static int rtw_qos_opt_enable = 1;/* 0: disable, 1:enable */ -+#else -+static int rtw_qos_opt_enable = 0;/* 0: disable, 1:enable */ -+#endif -+module_param(rtw_qos_opt_enable, int, 0644); -+ -+static char* ifname = "wlan%d"; -+module_param(ifname, charp, 0644); -+MODULE_PARM_DESC(ifname, "The default name to allocate for first interface"); -+ -+char* rtw_initmac = NULL; /* temp mac address if users want to use instead of the mac address in Efuse */ -+ -+module_param(rtw_initmac, charp, 0644); -+module_param(rtw_channel_plan, int, 0644); -+module_param(rtw_chip_version, int, 0644); -+module_param(rtw_rfintfs, int, 0644); -+module_param(rtw_lbkmode, int, 0644); -+module_param(rtw_network_mode, int, 0644); -+module_param(rtw_channel, int, 0644); -+module_param(rtw_wmm_enable, int, 0644); -+module_param(rtw_vrtl_carrier_sense, int, 0644); -+module_param(rtw_vcs_type, int, 0644); -+module_param(rtw_busy_thresh, int, 0644); -+ -+module_param(rtw_ht_enable, int, 0644); -+module_param(rtw_bw_mode, int, 0644); -+module_param(rtw_ampdu_enable, int, 0644); -+module_param(rtw_rx_stbc, int, 0644); -+module_param(rtw_ampdu_amsdu, int, 0644); -+ -+module_param(rtw_lowrate_two_xmit, int, 0644); -+ -+module_param(rtw_rf_config, int, 0644); -+module_param(rtw_power_mgnt, int, 0644); -+module_param(rtw_smart_ps, int, 0644); -+module_param(rtw_low_power, int, 0644); -+module_param(rtw_wifi_spec, int, 0644); -+ -+module_param(rtw_antdiv_cfg, int, 0644); -+module_param(rtw_antdiv_type, int, 0644); -+ -+module_param(rtw_enusbss, int, 0644); -+module_param(rtw_hwpdn_mode, int, 0644); -+module_param(rtw_hwpwrp_detect, int, 0644); -+ -+module_param(rtw_hw_wps_pbc, int, 0644); -+ -+static uint rtw_max_roaming_times =2; -+module_param(rtw_max_roaming_times, uint, 0644); -+MODULE_PARM_DESC(rtw_max_roaming_times,"The max roaming times to try"); -+ -+module_param(rtw_mc2u_disable, int, 0644); -+ -+module_param(rtw_80211d, int, 0644); -+MODULE_PARM_DESC(rtw_80211d, "Enable 802.11d mechanism"); -+ -+static uint rtw_notch_filter = 0; -+module_param(rtw_notch_filter, uint, 0644); -+MODULE_PARM_DESC(rtw_notch_filter, "0:Disable, 1:Enable, 2:Enable only for P2P"); -+ -+#define CONFIG_RTW_HIQ_FILTER 1 -+ -+static uint rtw_hiq_filter = CONFIG_RTW_HIQ_FILTER; -+module_param(rtw_hiq_filter, uint, 0644); -+MODULE_PARM_DESC(rtw_hiq_filter, "0:allow all, 1:allow special, 2:deny all"); -+ -+static int rtw_tx_pwr_lmt_enable = 0; -+static int rtw_tx_pwr_by_rate = 0; -+ -+module_param(rtw_tx_pwr_lmt_enable, int, 0644); -+MODULE_PARM_DESC(rtw_tx_pwr_lmt_enable,"0:Disable, 1:Enable, 2: Depend on efuse"); -+ -+module_param(rtw_tx_pwr_by_rate, int, 0644); -+MODULE_PARM_DESC(rtw_tx_pwr_by_rate,"0:Disable, 1:Enable, 2: Depend on efuse"); -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+char *rtw_phy_file_path = ""; -+module_param(rtw_phy_file_path, charp, 0644); -+MODULE_PARM_DESC(rtw_phy_file_path, "The path of phy parameter"); -+/* PHY FILE Bit Map */ -+/* BIT0 - MAC, 0: non-support, 1: support */ -+/* BIT1 - BB, 0: non-support, 1: support */ -+/* BIT2 - BB_PG, 0: non-support, 1: support */ -+/* BIT3 - BB_MP, 0: non-support, 1: support */ -+/* BIT4 - RF, 0: non-support, 1: support */ -+/* BIT5 - RF_TXPWR_TRACK, 0: non-support, 1: support */ -+/* BIT6 - RF_TXPWR_LMT, 0: non-support, 1: support */ -+static int rtw_load_phy_file = (BIT2|BIT6); -+module_param(rtw_load_phy_file, int, 0644); -+MODULE_PARM_DESC(rtw_load_phy_file,"PHY File Bit Map"); -+static int rtw_decrypt_phy_file = 0; -+module_param(rtw_decrypt_phy_file, int, 0644); -+MODULE_PARM_DESC(rtw_decrypt_phy_file,"Enable Decrypt PHY File"); -+#endif -+ -+int _netdev_open(struct net_device *pnetdev); -+int netdev_open (struct net_device *pnetdev); -+static int netdev_close (struct net_device *pnetdev); -+ -+static uint loadparam(struct adapter *padapter, _nic_hdl pnetdev) -+{ -+ uint status = _SUCCESS; -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ -+ registry_par->chip_version = (u8)rtw_chip_version; -+ registry_par->rfintfs = (u8)rtw_rfintfs; -+ registry_par->lbkmode = (u8)rtw_lbkmode; -+ /* registry_par->hci = (u8)hci; */ -+ registry_par->network_mode = (u8)rtw_network_mode; -+ -+ memcpy(registry_par->ssid.Ssid, "ANY", 3); -+ registry_par->ssid.SsidLength = 3; -+ -+ registry_par->channel = (u8)rtw_channel; -+ registry_par->wireless_mode = (u8)rtw_wireless_mode; -+ -+ if (registry_par->channel > 14) -+ registry_par->channel = 1; -+ -+ registry_par->vrtl_carrier_sense = (u8)rtw_vrtl_carrier_sense ; -+ registry_par->vcs_type = (u8)rtw_vcs_type; -+ registry_par->rts_thresh =(u16)rtw_rts_thresh; -+ registry_par->frag_thresh =(u16)rtw_frag_thresh; -+ registry_par->preamble = (u8)rtw_preamble; -+ registry_par->scan_mode = (u8)rtw_scan_mode; -+ registry_par->adhoc_tx_pwr = (u8)rtw_adhoc_tx_pwr; -+ registry_par->soft_ap = (u8)rtw_soft_ap; -+ registry_par->smart_ps = (u8)rtw_smart_ps; -+ registry_par->check_fw_ps = (u8)rtw_check_fw_ps; -+ registry_par->power_mgnt = (u8)rtw_power_mgnt; -+ registry_par->ips_mode = (u8)rtw_ips_mode; -+ registry_par->radio_enable = (u8)rtw_radio_enable; -+ registry_par->long_retry_lmt = (u8)rtw_long_retry_lmt; -+ registry_par->short_retry_lmt = (u8)rtw_short_retry_lmt; -+ registry_par->busy_thresh = (u16)rtw_busy_thresh; -+ /* registry_par->qos_enable = (u8)rtw_qos_enable; */ -+ registry_par->ack_policy = (u8)rtw_ack_policy; -+ registry_par->software_encrypt = (u8)rtw_software_encrypt; -+ registry_par->software_decrypt = (u8)rtw_software_decrypt; -+ -+ registry_par->acm_method = (u8)rtw_acm_method; -+ registry_par->usb_rxagg_mode = (u8)rtw_usb_rxagg_mode; -+ -+ /* UAPSD */ -+ registry_par->wmm_enable = (u8)rtw_wmm_enable; -+ registry_par->uapsd_enable = (u8)rtw_uapsd_enable; -+ registry_par->uapsd_max_sp = (u8)rtw_uapsd_max_sp; -+ registry_par->uapsd_acbk_en = (u8)rtw_uapsd_acbk_en; -+ registry_par->uapsd_acbe_en = (u8)rtw_uapsd_acbe_en; -+ registry_par->uapsd_acvi_en = (u8)rtw_uapsd_acvi_en; -+ registry_par->uapsd_acvo_en = (u8)rtw_uapsd_acvo_en; -+ -+ registry_par->ht_enable = (u8)rtw_ht_enable; -+ registry_par->bw_mode = (u8)rtw_bw_mode; -+ registry_par->ampdu_enable = (u8)rtw_ampdu_enable; -+ registry_par->rx_stbc = (u8)rtw_rx_stbc; -+ registry_par->ampdu_amsdu = (u8)rtw_ampdu_amsdu; -+ registry_par->short_gi = (u8)rtw_short_gi; -+ registry_par->ldpc_cap = (u8)rtw_ldpc_cap; -+ registry_par->stbc_cap = (u8)rtw_stbc_cap; -+ registry_par->beamform_cap = (u8)rtw_beamform_cap; -+ -+ registry_par->lowrate_two_xmit = (u8)rtw_lowrate_two_xmit; -+ registry_par->rf_config = (u8)rtw_rf_config; -+ registry_par->low_power = (u8)rtw_low_power; -+ -+ -+ registry_par->wifi_spec = (u8)rtw_wifi_spec; -+ -+ registry_par->channel_plan = (u8)rtw_channel_plan; -+ -+ registry_par->btcoex = (u8)rtw_btcoex_enable; -+ registry_par->bt_iso = (u8)rtw_bt_iso; -+ registry_par->bt_sco = (u8)rtw_bt_sco; -+ registry_par->bt_ampdu = (u8)rtw_bt_ampdu; -+ registry_par->ant_num = (s8)rtw_ant_num; -+ -+ registry_par->bAcceptAddbaReq = (u8)rtw_AcceptAddbaReq; -+ -+ registry_par->antdiv_cfg = (u8)rtw_antdiv_cfg; -+ registry_par->antdiv_type = (u8)rtw_antdiv_type; -+ -+ registry_par->hw_wps_pbc = (u8)rtw_hw_wps_pbc; -+ -+ registry_par->max_roaming_times = (u8)rtw_max_roaming_times; -+#ifdef CONFIG_INTEL_WIDI -+ registry_par->max_roaming_times = (u8)rtw_max_roaming_times + 2; -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ registry_par->enable80211d = (u8)rtw_80211d; -+ -+ snprintf(registry_par->ifname, 16, "%s", ifname); -+ -+ registry_par->notch_filter = (u8)rtw_notch_filter; -+ -+ registry_par->RegEnableTxPowerLimit = (u8)rtw_tx_pwr_lmt_enable; -+ registry_par->RegEnableTxPowerByRate = (u8)rtw_tx_pwr_by_rate; -+ -+ registry_par->RegPowerBase = 14; -+ registry_par->TxBBSwing_2G = 0xFF; -+ registry_par->TxBBSwing_5G = 0xFF; -+ registry_par->bEn_RFE = 1; -+ registry_par->RFE_Type = 64; -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ registry_par->load_phy_file = (u8)rtw_load_phy_file; -+ registry_par->RegDecryptCustomFile = (u8)rtw_decrypt_phy_file; -+#endif -+ registry_par->qos_opt_enable = (u8)rtw_qos_opt_enable; -+ -+ registry_par->hiq_filter = (u8)rtw_hiq_filter; -+ return status; -+} -+ -+static int rtw_net_set_mac_address(struct net_device *pnetdev, void *p) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev); -+ struct sockaddr *addr = p; -+ -+ if (padapter->bup == false) -+ { -+ /* DBG_871X("r8711_net_set_mac_address(), MAC =%x:%x:%x:%x:%x:%x\n", addr->sa_data[0], addr->sa_data[1], addr->sa_data[2], addr->sa_data[3], */ -+ /* addr->sa_data[4], addr->sa_data[5]); */ -+ memcpy(padapter->eeprompriv.mac_addr, addr->sa_data, ETH_ALEN); -+ /* memcpy(pnetdev->dev_addr, addr->sa_data, ETH_ALEN); */ -+ /* padapter->bset_hwaddr = true; */ -+ } -+ -+ return 0; -+} -+ -+static struct net_device_stats *rtw_net_get_stats(struct net_device *pnetdev) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev); -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ -+ padapter->stats.tx_packets = pxmitpriv->tx_pkts;/* pxmitpriv->tx_pkts++; */ -+ padapter->stats.rx_packets = precvpriv->rx_pkts;/* precvpriv->rx_pkts++; */ -+ padapter->stats.tx_dropped = pxmitpriv->tx_drop; -+ padapter->stats.rx_dropped = precvpriv->rx_drop; -+ padapter->stats.tx_bytes = pxmitpriv->tx_bytes; -+ padapter->stats.rx_bytes = precvpriv->rx_bytes; -+ -+ return &padapter->stats; -+} -+ -+/* -+ * AC to queue mapping -+ * -+ * AC_VO -> queue 0 -+ * AC_VI -> queue 1 -+ * AC_BE -> queue 2 -+ * AC_BK -> queue 3 -+ */ -+static const u16 rtw_1d_to_queue[8] = { 2, 3, 3, 2, 1, 1, 0, 0 }; -+ -+/* Given a data frame determine the 802.1p/1d tag to use. */ -+static unsigned int rtw_classify8021d(struct sk_buff *skb) -+{ -+ unsigned int dscp; -+ -+ /* skb->priority values from 256->263 are magic values to -+ * directly indicate a specific 802.1d priority. This is used -+ * to allow 802.1d priority to be passed directly in from VLAN -+ * tags, etc. -+ */ -+ if (skb->priority >= 256 && skb->priority <= 263) -+ return skb->priority - 256; -+ -+ switch (skb->protocol) { -+ case htons(ETH_P_IP): -+ dscp = ip_hdr(skb)->tos & 0xfc; -+ break; -+ default: -+ return 0; -+ } -+ -+ return dscp >> 5; -+} -+ -+ -+static u16 rtw_select_queue(struct net_device *dev, struct sk_buff *skb -+ , void *accel_priv -+ , select_queue_fallback_t fallback -+) -+{ -+ struct adapter *padapter = rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ skb->priority = rtw_classify8021d(skb); -+ -+ if (pmlmepriv->acm_mask != 0) -+ { -+ skb->priority = qos_acm(pmlmepriv->acm_mask, skb->priority); -+ } -+ -+ return rtw_1d_to_queue[skb->priority]; -+} -+ -+u16 rtw_recv_select_queue(struct sk_buff *skb) -+{ -+ struct iphdr *piphdr; -+ unsigned int dscp; -+ __be16 eth_type; -+ u32 priority; -+ u8 *pdata = skb->data; -+ -+ memcpy(ð_type, pdata+(ETH_ALEN<<1), 2); -+ -+ switch (be16_to_cpu(eth_type)) { -+ case ETH_P_IP: -+ -+ piphdr = (struct iphdr *)(pdata+ETH_HLEN); -+ -+ dscp = piphdr->tos & 0xfc; -+ -+ priority = dscp >> 5; -+ -+ break; -+ default: -+ priority = 0; -+ } -+ -+ return rtw_1d_to_queue[priority]; -+ -+} -+ -+static int rtw_ndev_notifier_call(struct notifier_block * nb, unsigned long state, void *ptr) -+{ -+ struct net_device *dev = netdev_notifier_info_to_dev(ptr); -+ -+ if (dev->netdev_ops->ndo_do_ioctl != rtw_ioctl) -+ return NOTIFY_DONE; -+ -+ DBG_871X_LEVEL(_drv_info_, FUNC_NDEV_FMT" state:%lu\n", FUNC_NDEV_ARG(dev), state); -+ -+ switch (state) { -+ case NETDEV_CHANGENAME: -+ rtw_adapter_proc_replace(dev); -+ break; -+ } -+ -+ return NOTIFY_DONE; -+} -+ -+static struct notifier_block rtw_ndev_notifier = { -+ .notifier_call = rtw_ndev_notifier_call, -+}; -+ -+int rtw_ndev_notifier_register(void) -+{ -+ return register_netdevice_notifier(&rtw_ndev_notifier); -+} -+ -+void rtw_ndev_notifier_unregister(void) -+{ -+ unregister_netdevice_notifier(&rtw_ndev_notifier); -+} -+ -+ -+static int rtw_ndev_init(struct net_device *dev) -+{ -+ struct adapter *adapter = rtw_netdev_priv(dev); -+ -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+ strncpy(adapter->old_ifname, dev->name, IFNAMSIZ); -+ rtw_adapter_proc_init(dev); -+ -+ return 0; -+} -+ -+static void rtw_ndev_uninit(struct net_device *dev) -+{ -+ struct adapter *adapter = rtw_netdev_priv(dev); -+ -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+ rtw_adapter_proc_deinit(dev); -+} -+ -+static const struct net_device_ops rtw_netdev_ops = { -+ .ndo_init = rtw_ndev_init, -+ .ndo_uninit = rtw_ndev_uninit, -+ .ndo_open = netdev_open, -+ .ndo_stop = netdev_close, -+ .ndo_start_xmit = rtw_xmit_entry, -+ .ndo_select_queue = rtw_select_queue, -+ .ndo_set_mac_address = rtw_net_set_mac_address, -+ .ndo_get_stats = rtw_net_get_stats, -+ .ndo_do_ioctl = rtw_ioctl, -+}; -+ -+int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname) -+{ -+ if (dev_alloc_name(pnetdev, ifname) < 0) -+ RT_TRACE(_module_os_intfs_c_, _drv_err_, ("dev_alloc_name, fail!\n")); -+ -+ netif_carrier_off(pnetdev); -+ /* rtw_netif_stop_queue(pnetdev); */ -+ -+ return 0; -+} -+ -+struct net_device *rtw_init_netdev(struct adapter *old_padapter) -+{ -+ struct adapter *padapter; -+ struct net_device *pnetdev; -+ -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+init_net_dev\n")); -+ -+ if (old_padapter != NULL) -+ pnetdev = rtw_alloc_etherdev_with_old_priv(sizeof(struct adapter), (void *)old_padapter); -+ else -+ pnetdev = rtw_alloc_etherdev(sizeof(struct adapter)); -+ -+ if (!pnetdev) -+ return NULL; -+ -+ padapter = rtw_netdev_priv(pnetdev); -+ padapter->pnetdev = pnetdev; -+ -+ /* pnetdev->init = NULL; */ -+ -+ DBG_871X("register rtw_netdev_ops to netdev_ops\n"); -+ pnetdev->netdev_ops = &rtw_netdev_ops; -+ -+ /* pnetdev->tx_timeout = NULL; */ -+ pnetdev->watchdog_timeo = HZ*3; /* 3 second timeout */ -+ pnetdev->wireless_handlers = (struct iw_handler_def *)&rtw_handlers_def; -+ -+ /* step 2. */ -+ loadparam(padapter, pnetdev); -+ -+ return pnetdev; -+} -+ -+void rtw_unregister_netdevs(struct dvobj_priv *dvobj) -+{ -+ struct adapter *padapter = NULL; -+ struct net_device *pnetdev = NULL; -+ -+ padapter = dvobj->padapters; -+ -+ if (padapter == NULL) -+ return; -+ -+ pnetdev = padapter->pnetdev; -+ -+ if ((padapter->DriverState != DRIVER_DISAPPEAR) && pnetdev) -+ unregister_netdev(pnetdev); /* will call netdev_close() */ -+ rtw_wdev_unregister(padapter->rtw_wdev); -+} -+ -+u32 rtw_start_drv_threads(struct adapter *padapter) -+{ -+ u32 _status = _SUCCESS; -+ -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_start_drv_threads\n")); -+ padapter->xmitThread = kthread_run(rtw_xmit_thread, padapter, "RTW_XMIT_THREAD"); -+ if (IS_ERR(padapter->xmitThread)) -+ _status = _FAIL; -+ -+ padapter->cmdThread = kthread_run(rtw_cmd_thread, padapter, "RTW_CMD_THREAD"); -+ if (IS_ERR(padapter->cmdThread)) -+ _status = _FAIL; -+ else -+ down(&padapter->cmdpriv.terminate_cmdthread_sema); /* wait for cmd_thread to run */ -+ -+ rtw_hal_start_thread(padapter); -+ return _status; -+} -+ -+void rtw_stop_drv_threads (struct adapter *padapter) -+{ -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_stop_drv_threads\n")); -+ -+ rtw_stop_cmd_thread(padapter); -+ -+ /* Below is to termindate tx_thread... */ -+ up(&padapter->xmitpriv.xmit_sema); -+ down(&padapter->xmitpriv.terminate_xmitthread_sema); -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("\n drv_halt: rtw_xmit_thread can be terminated !\n")); -+ -+ rtw_hal_stop_thread(padapter); -+} -+ -+static u8 rtw_init_default_value(struct adapter *padapter) -+{ -+ u8 ret = _SUCCESS; -+ struct registry_priv* pregistrypriv = &padapter->registrypriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ /* xmit_priv */ -+ pxmitpriv->vcs_setting = pregistrypriv->vrtl_carrier_sense; -+ pxmitpriv->vcs = pregistrypriv->vcs_type; -+ pxmitpriv->vcs_type = pregistrypriv->vcs_type; -+ /* pxmitpriv->rts_thresh = pregistrypriv->rts_thresh; */ -+ pxmitpriv->frag_len = pregistrypriv->frag_thresh; -+ -+ /* recv_priv */ -+ -+ /* mlme_priv */ -+ pmlmepriv->scan_mode = SCAN_ACTIVE; -+ -+ /* qos_priv */ -+ /* pmlmepriv->qospriv.qos_option = pregistrypriv->wmm_enable; */ -+ -+ /* ht_priv */ -+ pmlmepriv->htpriv.ampdu_enable = false;/* set to disabled */ -+ -+ /* security_priv */ -+ /* rtw_get_encrypt_decrypt_from_registrypriv(padapter); */ -+ psecuritypriv->binstallGrpkey = _FAIL; -+#ifdef CONFIG_GTK_OL -+ psecuritypriv->binstallKCK_KEK = _FAIL; -+#endif /* CONFIG_GTK_OL */ -+ psecuritypriv->sw_encrypt =pregistrypriv->software_encrypt; -+ psecuritypriv->sw_decrypt =pregistrypriv->software_decrypt; -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ -+ psecuritypriv->dot11PrivacyKeyIndex = 0; -+ -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ psecuritypriv->dot118021XGrpKeyid = 1; -+ -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ psecuritypriv->ndisencryptstatus = Ndis802_11WEPDisabled; -+ -+ /* registry_priv */ -+ rtw_init_registrypriv_dev_network(padapter); -+ rtw_update_registrypriv_dev_network(padapter); -+ -+ /* hal_priv */ -+ rtw_hal_def_value_init(padapter); -+ -+ /* misc. */ -+ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); -+ padapter->bLinkInfoDump = 0; -+ padapter->bNotifyChannelChange = 0; -+ -+ /* for debug purpose */ -+ padapter->fix_rate = 0xFF; -+ padapter->driver_ampdu_spacing = 0xFF; -+ padapter->driver_rx_ampdu_factor = 0xFF; -+ -+ return ret; -+} -+ -+struct dvobj_priv *devobj_init(void) -+{ -+ struct dvobj_priv *pdvobj = NULL; -+ -+ if ((pdvobj = (struct dvobj_priv*)rtw_zmalloc(sizeof(*pdvobj))) == NULL) -+ return NULL; -+ -+ mutex_init(&pdvobj->hw_init_mutex); -+ mutex_init(&pdvobj->h2c_fwcmd_mutex); -+ mutex_init(&pdvobj->setch_mutex); -+ mutex_init(&pdvobj->setbw_mutex); -+ -+ spin_lock_init(&pdvobj->lock); -+ -+ pdvobj->macid[1] = true; /* macid = 1 for bc/mc stainfo */ -+ -+ pdvobj->processing_dev_remove = false; -+ -+ atomic_set(&pdvobj->disable_func, 0); -+ -+ spin_lock_init(&pdvobj->cam_ctl.lock); -+ -+ return pdvobj; -+} -+ -+void devobj_deinit(struct dvobj_priv *pdvobj) -+{ -+ if (!pdvobj) -+ return; -+ -+ mutex_destroy(&pdvobj->hw_init_mutex); -+ mutex_destroy(&pdvobj->h2c_fwcmd_mutex); -+ mutex_destroy(&pdvobj->setch_mutex); -+ mutex_destroy(&pdvobj->setbw_mutex); -+ -+ kfree((u8 *)pdvobj); -+} -+ -+u8 rtw_reset_drv_sw(struct adapter *padapter) -+{ -+ u8 ret8 = _SUCCESS; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ /* hal_priv */ -+ if (is_primary_adapter(padapter)) -+ rtw_hal_def_value_init(padapter); -+ -+ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); -+ padapter->bLinkInfoDump = 0; -+ -+ padapter->xmitpriv.tx_pkts = 0; -+ padapter->recvpriv.rx_pkts = 0; -+ -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = false; -+ -+ /* pmlmepriv->LinkDetectInfo.TrafficBusyState = false; */ -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY |_FW_UNDER_LINKING); -+ -+ pwrctrlpriv->pwr_state_check_cnts = 0; -+ -+ /* mlmeextpriv */ -+ padapter->mlmeextpriv.sitesurvey_res.state = SCAN_DISABLE; -+ -+ rtw_set_signal_stat_timer(&padapter->recvpriv); -+ -+ return ret8; -+} -+ -+ -+u8 rtw_init_drv_sw(struct adapter *padapter) -+{ -+ u8 ret8 = _SUCCESS; -+ -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_init_drv_sw\n")); -+ -+ ret8 = rtw_init_default_value(padapter); -+ -+ rtw_init_hal_com_default_value(padapter); -+ -+ if ((rtw_init_cmd_priv(&padapter->cmdpriv)) == _FAIL) { -+ RT_TRACE(_module_os_intfs_c_, _drv_err_, ("\n Can't init cmd_priv\n")); -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+ padapter->cmdpriv.padapter =padapter; -+ -+ if ((rtw_init_evt_priv(&padapter->evtpriv)) == _FAIL) { -+ RT_TRACE(_module_os_intfs_c_, _drv_err_, ("\n Can't init evt_priv\n")); -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+ -+ if (rtw_init_mlme_priv(padapter) == _FAIL) { -+ RT_TRACE(_module_os_intfs_c_, _drv_err_, ("\n Can't init mlme_priv\n")); -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+ if (init_mlme_ext_priv(padapter) == _FAIL) { -+ RT_TRACE(_module_os_intfs_c_, _drv_err_, ("\n Can't init mlme_ext_priv\n")); -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+ if (_rtw_init_xmit_priv(&padapter->xmitpriv, padapter) == _FAIL) { -+ DBG_871X("Can't _rtw_init_xmit_priv\n"); -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+ if (_rtw_init_recv_priv(&padapter->recvpriv, padapter) == _FAIL) { -+ DBG_871X("Can't _rtw_init_recv_priv\n"); -+ ret8 = _FAIL; -+ goto exit; -+ } -+ /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ spin_lock_init(&padapter->security_key_mutex); -+ -+ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by vzalloc(). */ -+ /* memset((unsigned char *)&padapter->securitypriv, 0, sizeof (struct security_priv)); */ -+ -+ if (_rtw_init_sta_priv(&padapter->stapriv) == _FAIL) { -+ DBG_871X("Can't _rtw_init_sta_priv\n"); -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+ padapter->stapriv.padapter = padapter; -+ padapter->setband = GHZ24_50; -+ padapter->fix_rate = 0xFF; -+ rtw_init_bcmc_stainfo(padapter); -+ -+ rtw_init_pwrctrl_priv(padapter); -+ -+ rtw_hal_dm_init(padapter); -+ -+#ifdef CONFIG_INTEL_WIDI -+ if (rtw_init_intel_widi(padapter) == _FAIL) { -+ DBG_871X("Can't rtw_init_intel_widi\n"); -+ ret8 = _FAIL; -+ goto exit; -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ -+exit: -+ -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-rtw_init_drv_sw\n")); -+ -+ return ret8; -+} -+ -+void rtw_cancel_all_timer(struct adapter *padapter) -+{ -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_cancel_all_timer\n")); -+ -+ del_timer_sync(&padapter->mlmepriv.assoc_timer); -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel association timer complete!\n")); -+ -+ del_timer_sync(&padapter->mlmepriv.scan_to_timer); -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel scan_to_timer!\n")); -+ -+ del_timer_sync(&padapter->mlmepriv.dynamic_chk_timer); -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel dynamic_chk_timer!\n")); -+ -+ del_timer_sync(&(adapter_to_pwrctl(padapter)->pwr_state_check_timer)); -+ -+ del_timer_sync(&padapter->mlmepriv.set_scan_deny_timer); -+ rtw_clear_scan_deny(padapter); -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel set_scan_deny_timer!\n")); -+ -+ del_timer_sync(&padapter->recvpriv.signal_stat_timer); -+ -+ /* cancel dm timer */ -+ rtw_hal_dm_deinit(padapter); -+} -+ -+u8 rtw_free_drv_sw(struct adapter *padapter) -+{ -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("==>rtw_free_drv_sw")); -+ -+#ifdef CONFIG_INTEL_WIDI -+ rtw_free_intel_widi(padapter); -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ free_mlme_ext_priv(&padapter->mlmeextpriv); -+ -+ rtw_free_cmd_priv(&padapter->cmdpriv); -+ -+ rtw_free_evt_priv(&padapter->evtpriv); -+ -+ rtw_free_mlme_priv(&padapter->mlmepriv); -+ -+ /* free_io_queue(padapter); */ -+ -+ _rtw_free_xmit_priv(&padapter->xmitpriv); -+ -+ _rtw_free_sta_priv(&padapter->stapriv); /* will free bcmc_stainfo here */ -+ -+ _rtw_free_recv_priv(&padapter->recvpriv); -+ -+ rtw_free_pwrctrl_priv(padapter); -+ -+ /* kfree((void *)padapter); */ -+ -+ rtw_hal_free_data(padapter); -+ -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("<==rtw_free_drv_sw\n")); -+ -+ /* free the old_pnetdev */ -+ if (padapter->rereg_nd_name_priv.old_pnetdev) { -+ free_netdev(padapter->rereg_nd_name_priv.old_pnetdev); -+ padapter->rereg_nd_name_priv.old_pnetdev = NULL; -+ } -+ -+ /* clear pbuddystruct adapter to avoid access wrong pointer. */ -+ if (padapter->pbuddy_adapter != NULL) -+ padapter->pbuddy_adapter->pbuddy_adapter = NULL; -+ -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-rtw_free_drv_sw\n")); -+ -+ return _SUCCESS; -+} -+ -+static int _rtw_drv_register_netdev(struct adapter *padapter, char *name) -+{ -+ int ret = _SUCCESS; -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ /* alloc netdev name */ -+ rtw_init_netdev_name(pnetdev, name); -+ -+ memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN); -+ -+ /* Tell the network stack we exist */ -+ if (register_netdev(pnetdev) != 0) { -+ DBG_871X(FUNC_NDEV_FMT "Failed!\n", FUNC_NDEV_ARG(pnetdev)); -+ ret = _FAIL; -+ goto error_register_netdev; -+ } -+ -+ DBG_871X("%s, MAC Address (if%d) = " MAC_FMT "\n", __func__, (padapter->iface_id+1), MAC_ARG(pnetdev->dev_addr)); -+ -+ return ret; -+ -+error_register_netdev: -+ -+ rtw_free_drv_sw(padapter); -+ -+ rtw_free_netdev(pnetdev); -+ -+ return ret; -+} -+ -+int rtw_drv_register_netdev(struct adapter *if1) -+{ -+ struct dvobj_priv *dvobj = if1->dvobj; -+ struct adapter *padapter = dvobj->padapters; -+ char *name = if1->registrypriv.ifname; -+ -+ return _rtw_drv_register_netdev(padapter, name); -+} -+ -+int _netdev_open(struct net_device *pnetdev) -+{ -+ uint status; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+871x_drv - dev_open\n")); -+ DBG_871X("+871x_drv - drv_open, bup =%d\n", padapter->bup); -+ -+ padapter->netif_up = true; -+ -+ if (pwrctrlpriv->ps_flag == true) { -+ padapter->net_closed = false; -+ goto netdev_open_normal_process; -+ } -+ -+ if (padapter->bup == false) { -+ padapter->bDriverStopped = false; -+ padapter->bSurpriseRemoved = false; -+ padapter->bCardDisableWOHSM = false; -+ -+ status = rtw_hal_init(padapter); -+ if (status == _FAIL) { -+ RT_TRACE(_module_os_intfs_c_, _drv_err_, ("rtl871x_hal_init(): Can't init h/w!\n")); -+ goto netdev_open_error; -+ } -+ -+ DBG_871X("MAC Address = "MAC_FMT"\n", MAC_ARG(pnetdev->dev_addr)); -+ -+ status =rtw_start_drv_threads(padapter); -+ if (status == _FAIL) { -+ DBG_871X("Initialize driver software resource Failed!\n"); -+ goto netdev_open_error; -+ } -+ -+ if (padapter->intf_start) -+ padapter->intf_start(padapter); -+ -+ rtw_cfg80211_init_wiphy(padapter); -+ -+ padapter->bup = true; -+ pwrctrlpriv->bips_processing = false; -+ } -+ padapter->net_closed = false; -+ -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); -+ -+ if (!rtw_netif_queue_stopped(pnetdev)) -+ rtw_netif_start_queue(pnetdev); -+ else -+ rtw_netif_wake_queue(pnetdev); -+ -+netdev_open_normal_process: -+ -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-871x_drv - dev_open\n")); -+ DBG_871X("-871x_drv - drv_open, bup =%d\n", padapter->bup); -+ -+ return 0; -+ -+netdev_open_error: -+ -+ padapter->bup = false; -+ -+ netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ -+ RT_TRACE(_module_os_intfs_c_, _drv_err_, ("-871x_drv - dev_open, fail!\n")); -+ DBG_871X("-871x_drv - drv_open fail, bup =%d\n", padapter->bup); -+ -+ return (-1); -+ -+} -+ -+int netdev_open(struct net_device *pnetdev) -+{ -+ int ret; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if (pwrctrlpriv->bInSuspend == true) -+ { -+ DBG_871X("+871x_drv - drv_open, bInSuspend =%d\n", pwrctrlpriv->bInSuspend); -+ return 0; -+ } -+ -+ if (mutex_lock_interruptible(&(adapter_to_dvobj(padapter)->hw_init_mutex))) -+ return -1; -+ -+ ret = _netdev_open(pnetdev); -+ mutex_unlock(&(adapter_to_dvobj(padapter)->hw_init_mutex)); -+ -+ return ret; -+} -+ -+static int ips_netdrv_open(struct adapter *padapter) -+{ -+ int status = _SUCCESS; -+ /* struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); */ -+ -+ padapter->net_closed = false; -+ -+ DBG_871X("===> %s.........\n", __func__); -+ -+ -+ padapter->bDriverStopped = false; -+ padapter->bCardDisableWOHSM = false; -+ /* padapter->bup = true; */ -+ -+ status = rtw_hal_init(padapter); -+ if (status == _FAIL) -+ { -+ RT_TRACE(_module_os_intfs_c_, _drv_err_, ("ips_netdrv_open(): Can't init h/w!\n")); -+ goto netdev_open_error; -+ } -+ -+ if (padapter->intf_start) -+ { -+ padapter->intf_start(padapter); -+ } -+ -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); -+ -+ return _SUCCESS; -+ -+netdev_open_error: -+ /* padapter->bup = false; */ -+ DBG_871X("-ips_netdrv_open - drv_open failure, bup =%d\n", padapter->bup); -+ -+ return _FAIL; -+} -+ -+ -+int rtw_ips_pwr_up(struct adapter *padapter) -+{ -+ int result; -+ DBG_871X("===> rtw_ips_pwr_up..............\n"); -+ -+ result = ips_netdrv_open(padapter); -+ -+ DBG_871X("<=== rtw_ips_pwr_up..............\n"); -+ return result; -+ -+} -+ -+void rtw_ips_pwr_down(struct adapter *padapter) -+{ -+ DBG_871X("===> rtw_ips_pwr_down...................\n"); -+ -+ padapter->bCardDisableWOHSM = true; -+ padapter->net_closed = true; -+ -+ rtw_ips_dev_unload(padapter); -+ padapter->bCardDisableWOHSM = false; -+ DBG_871X("<=== rtw_ips_pwr_down.....................\n"); -+} -+ -+void rtw_ips_dev_unload(struct adapter *padapter) -+{ -+ DBG_871X("====> %s...\n", __func__); -+ -+ -+ if (padapter->bSurpriseRemoved == false) -+ { -+ rtw_hal_deinit(padapter); -+ } -+ -+} -+ -+ -+static int pm_netdev_open(struct net_device *pnetdev, u8 bnormal) -+{ -+ int status = -1; -+ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev); -+ -+ if (true == bnormal) -+ { -+ if (mutex_lock_interruptible(&(adapter_to_dvobj(padapter)->hw_init_mutex)) == 0) { -+ status = _netdev_open(pnetdev); -+ mutex_unlock(&(adapter_to_dvobj(padapter)->hw_init_mutex)); -+ } -+ } -+ else -+ status = (_SUCCESS == ips_netdrv_open(padapter))?(0):(-1); -+ -+ return status; -+} -+ -+static int netdev_close(struct net_device *pnetdev) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+871x_drv - drv_close\n")); -+ -+ if (pwrctl->bInternalAutoSuspend == true) -+ { -+ /* rtw_pwr_wakeup(padapter); */ -+ if (pwrctl->rf_pwrstate == rf_off) -+ pwrctl->ps_flag = true; -+ } -+ padapter->net_closed = true; -+ padapter->netif_up = false; -+ -+/*if (!padapter->hw_init_completed) -+ { -+ DBG_871X("(1)871x_drv - drv_close, bup =%d, hw_init_completed =%d\n", padapter->bup, padapter->hw_init_completed); -+ -+ padapter->bDriverStopped = true; -+ -+ rtw_dev_unload(padapter); -+ } -+ else*/ -+ if (pwrctl->rf_pwrstate == rf_on) { -+ DBG_871X("(2)871x_drv - drv_close, bup =%d, hw_init_completed =%d\n", padapter->bup, padapter->hw_init_completed); -+ -+ /* s1. */ -+ if (pnetdev) -+ { -+ if (!rtw_netif_queue_stopped(pnetdev)) -+ rtw_netif_stop_queue(pnetdev); -+ } -+ -+ /* s2. */ -+ LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, false); -+ /* s2-2. indicate disconnect to os */ -+ rtw_indicate_disconnect(padapter); -+ /* s2-3. */ -+ rtw_free_assoc_resources(padapter, 1); -+ /* s2-4. */ -+ rtw_free_network_queue(padapter, true); -+ } -+ -+ rtw_scan_abort(padapter); -+ adapter_wdev_data(padapter)->bandroid_scan = false; -+ -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-871x_drv - drv_close\n")); -+ DBG_871X("-871x_drv - drv_close, bup =%d\n", padapter->bup); -+ -+ return 0; -+ -+} -+ -+void rtw_ndev_destructor(struct net_device *ndev) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ if (ndev->ieee80211_ptr) -+ kfree((u8 *)ndev->ieee80211_ptr); -+ -+ free_netdev(ndev); -+} -+ -+void rtw_dev_unload(struct adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *pobjpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &pobjpriv->drv_dbg; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 cnt = 0; -+ -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("+%s\n", __func__)); -+ -+ if (padapter->bup == true) -+ { -+ DBG_871X("===> %s\n", __func__); -+ -+ padapter->bDriverStopped = true; -+ if (padapter->xmitpriv.ack_tx) -+ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP); -+ -+ if (padapter->intf_stop) -+ padapter->intf_stop(padapter); -+ -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("@ rtw_dev_unload: stop intf complete!\n")); -+ -+ if (!pwrctl->bInternalAutoSuspend) -+ rtw_stop_drv_threads(padapter); -+ -+ while (atomic_read(&(pcmdpriv->cmdthd_running)) == true) { -+ if (cnt > 5) { -+ DBG_871X("stop cmdthd timeout\n"); -+ break; -+ } else { -+ cnt ++; -+ DBG_871X("cmdthd is running(%d)\n", cnt); -+ msleep(10); -+ } -+ } -+ -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("@ %s: stop thread complete!\n", __func__)); -+ -+ /* check the status of IPS */ -+ if (rtw_hal_check_ips_status(padapter) == true || pwrctl->rf_pwrstate == rf_off) { /* check HW status and SW state */ -+ DBG_871X_LEVEL(_drv_always_, "%s: driver in IPS-FWLPS\n", __func__); -+ pdbgpriv->dbg_dev_unload_inIPS_cnt++; -+ LeaveAllPowerSaveMode(padapter); -+ } else { -+ DBG_871X_LEVEL(_drv_always_, "%s: driver not in IPS\n", __func__); -+ } -+ -+ if (padapter->bSurpriseRemoved == false) -+ { -+ rtw_btcoex_IpsNotify(padapter, pwrctl->ips_mode_req); -+#ifdef CONFIG_WOWLAN -+ if (pwrctl->bSupportRemoteWakeup == true && -+ pwrctl->wowlan_mode ==true) { -+ DBG_871X_LEVEL(_drv_always_, "%s bSupportRemoteWakeup ==true do not run rtw_hal_deinit()\n", __func__); -+ } -+ else -+#endif -+ { -+ /* amy modify 20120221 for power seq is different between driver open and ips */ -+ rtw_hal_deinit(padapter); -+ } -+ padapter->bSurpriseRemoved = true; -+ } -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("@ %s: deinit hal complelt!\n", __func__)); -+ -+ padapter->bup = false; -+ -+ DBG_871X("<=== %s\n", __func__); -+ } -+ else { -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("%s: bup ==false\n", __func__)); -+ DBG_871X("%s: bup ==false\n", __func__); -+ } -+ -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("-%s\n", __func__)); -+} -+ -+static int rtw_suspend_free_assoc_resource(struct adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, _FW_LINKED)) -+ { -+ DBG_871X("%s %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n", __func__, -+ pmlmepriv->cur_network.network.Ssid.Ssid, -+ MAC_ARG(pmlmepriv->cur_network.network.MacAddress), -+ pmlmepriv->cur_network.network.Ssid.SsidLength, -+ pmlmepriv->assoc_ssid.SsidLength); -+ rtw_set_to_roam(padapter, 1); -+ } -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && check_fwstate(pmlmepriv, _FW_LINKED)) -+ { -+ rtw_disassoc_cmd(padapter, 0, false); -+ /* s2-2. indicate disconnect to os */ -+ rtw_indicate_disconnect(padapter); -+ } -+ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ { -+ rtw_sta_flush(padapter); -+ } -+ -+ /* s2-3. */ -+ rtw_free_assoc_resources(padapter, 1); -+ -+ /* s2-4. */ -+ rtw_free_network_queue(padapter, true); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) -+ rtw_indicate_scan_done(padapter, 1); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) -+ { -+ DBG_871X_LEVEL(_drv_always_, "%s: fw_under_linking\n", __func__); -+ rtw_indicate_disconnect(padapter); -+ } -+ -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_WOWLAN -+int rtw_suspend_wow(struct adapter *padapter) -+{ -+ u8 ch, bw, offset; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct net_device *pnetdev = padapter->pnetdev; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct wowlan_ioctl_param poidparam; -+ int ret = _SUCCESS; -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ -+ DBG_871X("wowlan_mode: %d\n", pwrpriv->wowlan_mode); -+ DBG_871X("wowlan_pno_enable: %d\n", pwrpriv->wowlan_pno_enable); -+ -+ if (pwrpriv->wowlan_mode == true) { -+ if (pnetdev) -+ rtw_netif_stop_queue(pnetdev); -+ /* 1. stop thread */ -+ padapter->bDriverStopped = true; /* for stop thread */ -+ rtw_stop_drv_threads(padapter); -+ padapter->bDriverStopped = false; /* for 32k command */ -+ -+ /* 2. disable interrupt */ -+ if (padapter->intf_stop) { -+ padapter->intf_stop(padapter); -+ } -+ -+ /* 2.1 clean interupt */ -+ if (padapter->HalFunc.clear_interrupt) -+ padapter->HalFunc.clear_interrupt(padapter); -+ -+ /* 2.2 free irq */ -+ /* sdio_free_irq(adapter_to_dvobj(padapter)); */ -+ if (padapter->intf_free_irq) -+ padapter->intf_free_irq(adapter_to_dvobj(padapter)); -+ -+ poidparam.subcode = WOWLAN_ENABLE; -+ padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, _FW_LINKED)) -+ { -+ DBG_871X("%s %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n", __func__, -+ pmlmepriv->cur_network.network.Ssid.Ssid, -+ MAC_ARG(pmlmepriv->cur_network.network.MacAddress), -+ pmlmepriv->cur_network.network.Ssid.SsidLength, -+ pmlmepriv->assoc_ssid.SsidLength); -+ -+ rtw_set_to_roam(padapter, 0); -+ } -+ } -+ -+ DBG_871X_LEVEL(_drv_always_, "%s: wowmode suspending\n", __func__); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) -+ { -+ DBG_871X_LEVEL(_drv_always_, "%s: fw_under_survey\n", __func__); -+ rtw_indicate_scan_done(padapter, 1); -+ clr_fwstate(pmlmepriv, _FW_UNDER_SURVEY); -+ } -+ -+ if (rtw_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { -+ DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ set_channel_bwmode(padapter, ch, offset, bw); -+ } -+ -+ if (pwrpriv->wowlan_pno_enable) -+ DBG_871X_LEVEL(_drv_always_, "%s: pno: %d\n", __func__, pwrpriv->wowlan_pno_enable); -+ else -+ rtw_set_ps_mode(padapter, PS_MODE_DTIM, 0, 0, "WOWLAN"); -+ -+ } -+ else -+ { -+ DBG_871X_LEVEL(_drv_always_, "%s: ### ERROR ### wowlan_mode =%d\n", __func__, pwrpriv->wowlan_mode); -+ } -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+#endif /* ifdef CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_AP_WOWLAN -+int rtw_suspend_ap_wow(struct adapter *padapter) -+{ -+ u8 ch, bw, offset; -+ struct net_device *pnetdev = padapter->pnetdev; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct wowlan_ioctl_param poidparam; -+ int ret = _SUCCESS; -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ pwrpriv->wowlan_ap_mode = true; -+ -+ DBG_871X("wowlan_ap_mode: %d\n", pwrpriv->wowlan_ap_mode); -+ -+ if (pnetdev) -+ rtw_netif_stop_queue(pnetdev); -+ /* 1. stop thread */ -+ padapter->bDriverStopped = true; /* for stop thread */ -+ rtw_stop_drv_threads(padapter); -+ padapter->bDriverStopped = false; /* for 32k command */ -+ -+ /* 2. disable interrupt */ -+ rtw_hal_disable_interrupt(padapter); /* It need wait for leaving 32K. */ -+ -+ /* 2.1 clean interupt */ -+ if (padapter->HalFunc.clear_interrupt) -+ padapter->HalFunc.clear_interrupt(padapter); -+ -+ /* 2.2 free irq */ -+ /* sdio_free_irq(adapter_to_dvobj(padapter)); */ -+ if (padapter->intf_free_irq) -+ padapter->intf_free_irq(adapter_to_dvobj(padapter)); -+ -+ poidparam.subcode = WOWLAN_AP_ENABLE; -+ padapter->HalFunc.SetHwRegHandler(padapter, -+ HW_VAR_AP_WOWLAN, (u8 *)&poidparam); -+ -+ DBG_871X_LEVEL(_drv_always_, "%s: wowmode suspending\n", __func__); -+ -+ if (rtw_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { -+ DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ set_channel_bwmode(padapter, ch, offset, bw); -+ } -+ -+ rtw_set_ps_mode(padapter, PS_MODE_MIN, 0, 0, "AP-WOWLAN"); -+ -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+#endif /* ifdef CONFIG_AP_WOWLAN */ -+ -+ -+static int rtw_suspend_normal(struct adapter *padapter) -+{ -+ struct net_device *pnetdev = padapter->pnetdev; -+ int ret = _SUCCESS; -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ if (pnetdev) { -+ netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ } -+ -+ rtw_suspend_free_assoc_resource(padapter); -+ -+ if ((rtw_hal_check_ips_status(padapter) == true) -+ || (adapter_to_pwrctl(padapter)->rf_pwrstate == rf_off)) -+ { -+ DBG_871X_LEVEL(_drv_always_, "%s: ### ERROR #### driver in IPS ####ERROR###!!!\n", __func__); -+ -+ } -+ -+ rtw_dev_unload(padapter); -+ -+ /* sdio_deinit(adapter_to_dvobj(padapter)); */ -+ if (padapter->intf_deinit) -+ padapter->intf_deinit(adapter_to_dvobj(padapter)); -+ -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+ -+int rtw_suspend_common(struct adapter *padapter) -+{ -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(psdpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ int ret = 0; -+ unsigned long start_time = jiffies; -+ -+ DBG_871X_LEVEL(_drv_always_, " suspend start\n"); -+ DBG_871X("==> %s (%s:%d)\n", __func__, current->comm, current->pid); -+ pdbgpriv->dbg_suspend_cnt++; -+ -+ pwrpriv->bInSuspend = true; -+ -+ while (pwrpriv->bips_processing == true) -+ msleep(1); -+ -+ if ((!padapter->bup) || (padapter->bDriverStopped)||(padapter->bSurpriseRemoved)) -+ { -+ DBG_871X("%s bup =%d bDriverStopped =%d bSurpriseRemoved = %d\n", __func__ -+ , padapter->bup, padapter->bDriverStopped, padapter->bSurpriseRemoved); -+ pdbgpriv->dbg_suspend_error_cnt++; -+ goto exit; -+ } -+ rtw_ps_deny(padapter, PS_DENY_SUSPEND); -+ -+ rtw_cancel_all_timer(padapter); -+ -+ LeaveAllPowerSaveModeDirect(padapter); -+ -+ rtw_stop_cmd_thread(padapter); -+ -+ /* wait for the latest FW to remove this condition. */ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) { -+ rtw_btcoex_SuspendNotify(padapter, 0); -+ DBG_871X("WIFI_AP_STATE\n"); -+ } else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) { -+ rtw_btcoex_SuspendNotify(padapter, 1); -+ DBG_871X("STATION\n"); -+ } -+ -+ rtw_ps_deny_cancel(padapter, PS_DENY_SUSPEND); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) { -+ #ifdef CONFIG_WOWLAN -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) { -+ pwrpriv->wowlan_mode = true; -+ } else if (pwrpriv->wowlan_pno_enable == true) { -+ pwrpriv->wowlan_mode |= pwrpriv->wowlan_pno_enable; -+ } -+ -+ if (pwrpriv->wowlan_mode == true) -+ rtw_suspend_wow(padapter); -+ else -+ rtw_suspend_normal(padapter); -+ -+ #else /* CONFIG_WOWLAN */ -+ rtw_suspend_normal(padapter); -+ #endif /* CONFIG_WOWLAN */ -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) { -+ #ifdef CONFIG_AP_WOWLAN -+ rtw_suspend_ap_wow(padapter); -+ #else -+ rtw_suspend_normal(padapter); -+ #endif /* CONFIG_AP_WOWLAN */ -+ } else { -+ rtw_suspend_normal(padapter); -+ } -+ -+ DBG_871X_LEVEL(_drv_always_, "rtw suspend success in %d ms\n", -+ jiffies_to_msecs(jiffies - start_time)); -+ -+exit: -+ DBG_871X("<=== %s return %d.............. in %dms\n", __func__ -+ , ret, jiffies_to_msecs(jiffies - start_time)); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_WOWLAN -+int rtw_resume_process_wow(struct adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct net_device *pnetdev = padapter->pnetdev; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct wowlan_ioctl_param poidparam; -+ struct sta_info *psta = NULL; -+ int ret = _SUCCESS; -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (padapter) { -+ pnetdev = padapter->pnetdev; -+ pwrpriv = adapter_to_pwrctl(padapter); -+ } else { -+ pdbgpriv->dbg_resume_error_cnt++; -+ ret = -1; -+ goto exit; -+ } -+ -+ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) { -+ DBG_871X("%s pdapter %p bDriverStopped %d bSurpriseRemoved %d\n", -+ __func__, padapter, padapter->bDriverStopped, -+ padapter->bSurpriseRemoved); -+ goto exit; -+ } -+ -+#ifdef CONFIG_PNO_SUPPORT -+ pwrpriv->pno_in_resume = true; -+#endif -+ -+ if (pwrpriv->wowlan_mode == true) { -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "WOWLAN"); -+ -+ pwrpriv->bFwCurrentInPSMode = false; -+ -+ if (padapter->intf_stop) { -+ padapter->intf_stop(padapter); -+ } -+ -+ if (padapter->HalFunc.clear_interrupt) -+ padapter->HalFunc.clear_interrupt(padapter); -+ -+ /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { */ -+ if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) { -+ ret = -1; -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: sdio_alloc_irq Failed!!\n", __func__)); -+ goto exit; -+ } -+ -+ /* Disable WOW, set H2C command */ -+ poidparam.subcode =WOWLAN_DISABLE; -+ padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); -+ if (psta) { -+ set_sta_rate(padapter, psta); -+ } -+ -+ -+ padapter->bDriverStopped = false; -+ DBG_871X("%s: wowmode resuming, DriverStopped:%d\n", __func__, padapter->bDriverStopped); -+ rtw_start_drv_threads(padapter); -+ -+ if (padapter->intf_start) { -+ padapter->intf_start(padapter); -+ } -+ -+ /* start netif queue */ -+ if (pnetdev) { -+ if (!rtw_netif_queue_stopped(pnetdev)) -+ rtw_netif_start_queue(pnetdev); -+ else -+ rtw_netif_wake_queue(pnetdev); -+ } -+ } -+ else { -+ -+ DBG_871X_LEVEL(_drv_always_, "%s: ### ERROR ### wowlan_mode =%d\n", __func__, pwrpriv->wowlan_mode); -+ } -+ -+ if (padapter->pid[1]!= 0) { -+ DBG_871X("pid[1]:%d\n", padapter->pid[1]); -+ rtw_signal_process(padapter->pid[1], SIGUSR2); -+ } -+ -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { -+ if (pwrpriv->wowlan_wake_reason == FWDecisionDisconnect || -+ pwrpriv->wowlan_wake_reason == Rx_DisAssoc || -+ pwrpriv->wowlan_wake_reason == Rx_DeAuth) { -+ -+ DBG_871X("%s: disconnect reason: %02x\n", __func__, -+ pwrpriv->wowlan_wake_reason); -+ rtw_indicate_disconnect(padapter); -+ -+ rtw_sta_media_status_rpt(padapter, -+ rtw_get_stainfo(&padapter->stapriv, -+ get_bssid(&padapter->mlmepriv)), 0); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+ } else { -+ DBG_871X("%s: do roaming\n", __func__); -+ rtw_roaming(padapter, NULL); -+ } -+ } -+ -+ if (pwrpriv->wowlan_mode == true) { -+ pwrpriv->bips_processing = false; -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); -+ } else { -+ DBG_871X_LEVEL(_drv_always_, "do not reset timer\n"); -+ } -+ -+ pwrpriv->wowlan_mode =false; -+ -+ /* clean driver side wake up reason. */ -+ pwrpriv->wowlan_wake_reason = 0; -+exit: -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+#endif /* ifdef CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_AP_WOWLAN -+int rtw_resume_process_ap_wow(struct adapter *padapter) -+{ -+ struct net_device *pnetdev = padapter->pnetdev; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct wowlan_ioctl_param poidparam; -+ int ret = _SUCCESS; -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (padapter) { -+ pnetdev = padapter->pnetdev; -+ pwrpriv = adapter_to_pwrctl(padapter); -+ } else { -+ pdbgpriv->dbg_resume_error_cnt++; -+ ret = -1; -+ goto exit; -+ } -+ -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "AP-WOWLAN"); -+ -+ pwrpriv->bFwCurrentInPSMode = false; -+ -+ rtw_hal_disable_interrupt(padapter); -+ -+ if (padapter->HalFunc.clear_interrupt) -+ padapter->HalFunc.clear_interrupt(padapter); -+ -+ /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { */ -+ if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) { -+ ret = -1; -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: sdio_alloc_irq Failed!!\n", __func__)); -+ goto exit; -+ } -+ -+ /* Disable WOW, set H2C command */ -+ poidparam.subcode = WOWLAN_AP_DISABLE; -+ padapter->HalFunc.SetHwRegHandler(padapter, -+ HW_VAR_AP_WOWLAN, (u8 *)&poidparam); -+ pwrpriv->wowlan_ap_mode = false; -+ -+ padapter->bDriverStopped = false; -+ DBG_871X("%s: wowmode resuming, DriverStopped:%d\n", __func__, padapter->bDriverStopped); -+ rtw_start_drv_threads(padapter); -+ -+ if (padapter->intf_start) { -+ padapter->intf_start(padapter); -+ } -+ -+ /* start netif queue */ -+ if (pnetdev) { -+ if (!rtw_netif_queue_stopped(pnetdev)) -+ rtw_netif_start_queue(pnetdev); -+ else -+ rtw_netif_wake_queue(pnetdev); -+ } -+ -+ if (padapter->pid[1]!= 0) { -+ DBG_871X("pid[1]:%d\n", padapter->pid[1]); -+ rtw_signal_process(padapter->pid[1], SIGUSR2); -+ } -+ -+ pwrpriv->bips_processing = false; -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); -+ -+ /* clean driver side wake up reason. */ -+ pwrpriv->wowlan_wake_reason = 0; -+exit: -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+#endif /* ifdef CONFIG_APWOWLAN */ -+ -+static int rtw_resume_process_normal(struct adapter *padapter) -+{ -+ struct net_device *pnetdev; -+ struct pwrctrl_priv *pwrpriv; -+ struct mlme_priv *pmlmepriv; -+ struct dvobj_priv *psdpriv; -+ struct debug_priv *pdbgpriv; -+ -+ int ret = _SUCCESS; -+ -+ if (!padapter) { -+ ret = -1; -+ goto exit; -+ } -+ -+ pnetdev = padapter->pnetdev; -+ pwrpriv = adapter_to_pwrctl(padapter); -+ pmlmepriv = &padapter->mlmepriv; -+ psdpriv = padapter->dvobj; -+ pdbgpriv = &psdpriv->drv_dbg; -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ /* interface init */ -+ /* if (sdio_init(adapter_to_dvobj(padapter)) != _SUCCESS) */ -+ if ((padapter->intf_init) && (padapter->intf_init(adapter_to_dvobj(padapter)) != _SUCCESS)) -+ { -+ ret = -1; -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: initialize SDIO Failed!!\n", __func__)); -+ goto exit; -+ } -+ rtw_hal_disable_interrupt(padapter); -+ /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) */ -+ if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) -+ { -+ ret = -1; -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: sdio_alloc_irq Failed!!\n", __func__)); -+ goto exit; -+ } -+ -+ rtw_reset_drv_sw(padapter); -+ pwrpriv->bkeepfwalive = false; -+ -+ DBG_871X("bkeepfwalive(%x)\n", pwrpriv->bkeepfwalive); -+ if (pm_netdev_open(pnetdev, true) != 0) { -+ ret = -1; -+ pdbgpriv->dbg_resume_error_cnt++; -+ goto exit; -+ } -+ -+ netif_device_attach(pnetdev); -+ netif_carrier_on(pnetdev); -+ -+ if (padapter->pid[1]!= 0) { -+ DBG_871X("pid[1]:%d\n", padapter->pid[1]); -+ rtw_signal_process(padapter->pid[1], SIGUSR2); -+ } -+ -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) -+ rtw_roaming(padapter, NULL); -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ rtw_ap_restore_network(padapter); -+ } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ } else { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ } -+ -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ -+exit: -+ return ret; -+} -+ -+int rtw_resume_common(struct adapter *padapter) -+{ -+ int ret = 0; -+ unsigned long start_time = jiffies; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ DBG_871X_LEVEL(_drv_always_, "resume start\n"); -+ DBG_871X("==> %s (%s:%d)\n", __func__, current->comm, current->pid); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) { -+ #ifdef CONFIG_WOWLAN -+ if (pwrpriv->wowlan_mode == true) -+ rtw_resume_process_wow(padapter); -+ else -+ rtw_resume_process_normal(padapter); -+ #else -+ rtw_resume_process_normal(padapter); -+ #endif -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) { -+ #ifdef CONFIG_AP_WOWLAN -+ rtw_resume_process_ap_wow(padapter); -+ #else -+ rtw_resume_process_normal(padapter); -+ #endif /* CONFIG_AP_WOWLAN */ -+ } else { -+ rtw_resume_process_normal(padapter); -+ } -+ -+ rtw_btcoex_SuspendNotify(padapter, 0); -+ -+ if (pwrpriv) { -+ pwrpriv->bInSuspend = false; -+ #ifdef CONFIG_PNO_SUPPORT -+ pwrpriv->pno_in_resume = false; -+ #endif -+ } -+ DBG_871X_LEVEL(_drv_always_, "%s:%d in %d ms\n", __func__ , ret, -+ jiffies_to_msecs(jiffies - start_time)); -+ -+ return ret; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/os_dep/recv_linux.c linux/3rdparty/rtl8723bs/os_dep/recv_linux.c ---- linux.old/3rdparty/rtl8723bs/os_dep/recv_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/os_dep/recv_linux.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,366 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RECV_OSDEP_C_ -+ -+#include -+#include -+#include -+ -+void rtw_os_free_recvframe(union recv_frame *precvframe) -+{ -+ if (precvframe->u.hdr.pkt) -+ { -+ dev_kfree_skb_any(precvframe->u.hdr.pkt);/* free skb by driver */ -+ -+ precvframe->u.hdr.pkt = NULL; -+ } -+} -+ -+/* alloc os related resource in union recv_frame */ -+int rtw_os_recv_resource_alloc(struct adapter *padapter, union recv_frame *precvframe) -+{ -+ int res = _SUCCESS; -+ -+ precvframe->u.hdr.pkt_newalloc = precvframe->u.hdr.pkt = NULL; -+ -+ return res; -+} -+ -+/* free os related resource in union recv_frame */ -+void rtw_os_recv_resource_free(struct recv_priv *precvpriv) -+{ -+ sint i; -+ union recv_frame *precvframe; -+ precvframe = (union recv_frame*) precvpriv->precv_frame_buf; -+ -+ for (i = 0; i < NR_RECVFRAME; i++) -+ { -+ if (precvframe->u.hdr.pkt) -+ { -+ dev_kfree_skb_any(precvframe->u.hdr.pkt);/* free skb by driver */ -+ precvframe->u.hdr.pkt = NULL; -+ } -+ precvframe++; -+ } -+} -+ -+/* free os related resource in struct recv_buf */ -+int rtw_os_recvbuf_resource_free(struct adapter *padapter, struct recv_buf *precvbuf) -+{ -+ int ret = _SUCCESS; -+ -+ if (precvbuf->pskb) -+ { -+ dev_kfree_skb_any(precvbuf->pskb); -+ } -+ return ret; -+ -+} -+ -+_pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, u16 nSubframe_Length, u8 *pdata) -+{ -+ u16 eth_type; -+ u8 *data_ptr; -+ _pkt *sub_skb; -+ struct rx_pkt_attrib *pattrib; -+ -+ pattrib = &prframe->u.hdr.attrib; -+ -+ sub_skb = rtw_skb_alloc(nSubframe_Length + 12); -+ if (sub_skb) -+ { -+ skb_reserve(sub_skb, 12); -+ data_ptr = (u8 *)skb_put(sub_skb, nSubframe_Length); -+ memcpy(data_ptr, (pdata + ETH_HLEN), nSubframe_Length); -+ } -+ else -+ { -+ sub_skb = rtw_skb_clone(prframe->u.hdr.pkt); -+ if (sub_skb) -+ { -+ sub_skb->data = pdata + ETH_HLEN; -+ sub_skb->len = nSubframe_Length; -+ skb_set_tail_pointer(sub_skb, nSubframe_Length); -+ } -+ else -+ { -+ DBG_871X("%s(): rtw_skb_clone() Fail!!!\n", __func__); -+ return NULL; -+ } -+ } -+ -+ eth_type = RTW_GET_BE16(&sub_skb->data[6]); -+ -+ if (sub_skb->len >= 8 && -+ ((!memcmp(sub_skb->data, rtw_rfc1042_header, SNAP_SIZE) && -+ eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) || -+ !memcmp(sub_skb->data, rtw_bridge_tunnel_header, SNAP_SIZE))) { -+ /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ -+ skb_pull(sub_skb, SNAP_SIZE); -+ memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->src, ETH_ALEN); -+ memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->dst, ETH_ALEN); -+ } else { -+ __be16 len; -+ /* Leave Ethernet header part of hdr and full payload */ -+ len = htons(sub_skb->len); -+ memcpy(skb_push(sub_skb, 2), &len, 2); -+ memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->src, ETH_ALEN); -+ memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->dst, ETH_ALEN); -+ } -+ -+ return sub_skb; -+} -+ -+void rtw_os_recv_indicate_pkt(struct adapter *padapter, _pkt *pkt, struct rx_pkt_attrib *pattrib) -+{ -+ struct mlme_priv*pmlmepriv = &padapter->mlmepriv; -+ int ret; -+ -+ /* Indicat the packets to upper layer */ -+ if (pkt) { -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ _pkt *pskb2 = NULL; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ int bmcast = IS_MCAST(pattrib->dst); -+ -+ /* DBG_871X("bmcast =%d\n", bmcast); */ -+ -+ if (memcmp(pattrib->dst, myid(&padapter->eeprompriv), ETH_ALEN)) -+ { -+ /* DBG_871X("not ap psta =%p, addr =%pM\n", psta, pattrib->dst); */ -+ -+ if (bmcast) -+ { -+ psta = rtw_get_bcmc_stainfo(padapter); -+ pskb2 = rtw_skb_clone(pkt); -+ } else { -+ psta = rtw_get_stainfo(pstapriv, pattrib->dst); -+ } -+ -+ if (psta) -+ { -+ struct net_device *pnetdev = (struct net_device*)padapter->pnetdev; -+ -+ /* DBG_871X("directly forwarding to the rtw_xmit_entry\n"); */ -+ -+ /* skb->ip_summed = CHECKSUM_NONE; */ -+ pkt->dev = pnetdev; -+ skb_set_queue_mapping(pkt, rtw_recv_select_queue(pkt)); -+ -+ _rtw_xmit_entry(pkt, pnetdev); -+ -+ if (bmcast && (pskb2 != NULL)) { -+ pkt = pskb2; -+ DBG_COUNTER(padapter->rx_logs.os_indicate_ap_mcast); -+ } else { -+ DBG_COUNTER(padapter->rx_logs.os_indicate_ap_forward); -+ return; -+ } -+ } -+ } -+ else/* to APself */ -+ { -+ /* DBG_871X("to APSelf\n"); */ -+ DBG_COUNTER(padapter->rx_logs.os_indicate_ap_self); -+ } -+ } -+ -+ pkt->protocol = eth_type_trans(pkt, padapter->pnetdev); -+ pkt->dev = padapter->pnetdev; -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_RX -+ if ((pattrib->tcpchk_valid == 1) && (pattrib->tcp_chkrpt == 1)) { -+ pkt->ip_summed = CHECKSUM_UNNECESSARY; -+ } else { -+ pkt->ip_summed = CHECKSUM_NONE; -+ } -+#else /* !CONFIG_TCP_CSUM_OFFLOAD_RX */ -+ pkt->ip_summed = CHECKSUM_NONE; -+#endif /* CONFIG_TCP_CSUM_OFFLOAD_RX */ -+ -+ ret = rtw_netif_rx(padapter->pnetdev, pkt); -+ if (ret == NET_RX_SUCCESS) -+ DBG_COUNTER(padapter->rx_logs.os_netif_ok); -+ else -+ DBG_COUNTER(padapter->rx_logs.os_netif_err); -+ } -+} -+ -+void rtw_handle_tkip_mic_err(struct adapter *padapter, u8 bgroup) -+{ -+ enum nl80211_key_type key_type = 0; -+ union iwreq_data wrqu; -+ struct iw_michaelmicfailure ev; -+ struct mlme_priv* pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ unsigned long cur_time = 0; -+ -+ if (psecuritypriv->last_mic_err_time == 0) -+ { -+ psecuritypriv->last_mic_err_time = jiffies; -+ } -+ else -+ { -+ cur_time = jiffies; -+ -+ if (cur_time - psecuritypriv->last_mic_err_time < 60*HZ) -+ { -+ psecuritypriv->btkip_countermeasure = true; -+ psecuritypriv->last_mic_err_time = 0; -+ psecuritypriv->btkip_countermeasure_time = cur_time; -+ } -+ else -+ { -+ psecuritypriv->last_mic_err_time = jiffies; -+ } -+ } -+ -+ if (bgroup) -+ { -+ key_type |= NL80211_KEYTYPE_GROUP; -+ } -+ else -+ { -+ key_type |= NL80211_KEYTYPE_PAIRWISE; -+ } -+ -+ cfg80211_michael_mic_failure(padapter->pnetdev, (u8 *)&pmlmepriv->assoc_bssid[ 0 ], key_type, -1, -+ NULL, GFP_ATOMIC); -+ -+ memset(&ev, 0x00, sizeof(ev)); -+ if (bgroup) -+ { -+ ev.flags |= IW_MICFAILURE_GROUP; -+ } -+ else -+ { -+ ev.flags |= IW_MICFAILURE_PAIRWISE; -+ } -+ -+ ev.src_addr.sa_family = ARPHRD_ETHER; -+ memcpy(ev.src_addr.sa_data, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN); -+ -+ memset(&wrqu, 0x00, sizeof(wrqu)); -+ wrqu.data.length = sizeof(ev); -+} -+ -+#ifdef CONFIG_AUTO_AP_MODE -+static void rtw_os_ksocket_send(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ _pkt *skb = precv_frame->u.hdr.pkt; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_info *psta = precv_frame->u.hdr.psta; -+ -+ DBG_871X("eth rx: got eth_type = 0x%x\n", pattrib->eth_type); -+ -+ if (psta && psta->isrc && psta->pid>0) -+ { -+ u16 rx_pid; -+ -+ rx_pid = *(u16*)(skb->data+ETH_HLEN); -+ -+ DBG_871X("eth rx(pid = 0x%x): sta("MAC_FMT") pid = 0x%x\n", -+ rx_pid, MAC_ARG(psta->hwaddr), psta->pid); -+ -+ if (rx_pid == psta->pid) -+ { -+ int i; -+ u16 len = *(u16*)(skb->data+ETH_HLEN+2); -+ /* u16 ctrl_type = *(u16*)(skb->data+ETH_HLEN+4); */ -+ -+ /* DBG_871X("eth, RC: len = 0x%x, ctrl_type = 0x%x\n", len, ctrl_type); */ -+ DBG_871X("eth, RC: len = 0x%x\n", len); -+ -+ for (i = 0;idata+ETH_HLEN+4+i)); -+ /* DBG_871X("0x%x\n", *(skb->data+ETH_HLEN+6+i)); */ -+ -+ DBG_871X("eth, RC-end\n"); -+ } -+ -+ } -+ -+} -+#endif /* CONFIG_AUTO_AP_MODE */ -+ -+int rtw_recv_indicatepkt(struct adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct recv_priv *precvpriv; -+ struct __queue *pfree_recv_queue; -+ _pkt *skb; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ -+ DBG_COUNTER(padapter->rx_logs.os_indicate); -+ -+ precvpriv = &(padapter->recvpriv); -+ pfree_recv_queue = &(precvpriv->free_recv_queue); -+ -+ skb = precv_frame->u.hdr.pkt; -+ if (skb == NULL) -+ { -+ RT_TRACE(_module_recv_osdep_c_, _drv_err_, ("rtw_recv_indicatepkt():skb == NULL something wrong!!!!\n")); -+ goto _recv_indicatepkt_drop; -+ } -+ -+ RT_TRACE(_module_recv_osdep_c_, _drv_info_, ("rtw_recv_indicatepkt():skb != NULL !!!\n")); -+ RT_TRACE(_module_recv_osdep_c_, _drv_info_, ("rtw_recv_indicatepkt():precv_frame->u.hdr.rx_head =%p precv_frame->hdr.rx_data =%p\n", precv_frame->u.hdr.rx_head, precv_frame->u.hdr.rx_data)); -+ RT_TRACE(_module_recv_osdep_c_, _drv_info_, ("precv_frame->hdr.rx_tail =%p precv_frame->u.hdr.rx_end =%p precv_frame->hdr.len =%d\n", precv_frame->u.hdr.rx_tail, precv_frame->u.hdr.rx_end, precv_frame->u.hdr.len)); -+ -+ skb->data = precv_frame->u.hdr.rx_data; -+ -+ skb_set_tail_pointer(skb, precv_frame->u.hdr.len); -+ -+ skb->len = precv_frame->u.hdr.len; -+ -+ RT_TRACE(_module_recv_osdep_c_, _drv_info_, ("\n skb->head =%p skb->data =%p skb->tail =%p skb->end =%p skb->len =%d\n", skb->head, skb->data, skb_tail_pointer(skb), skb_end_pointer(skb), skb->len)); -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if (0x8899 == pattrib->eth_type) -+ { -+ rtw_os_ksocket_send(padapter, precv_frame); -+ -+ /* goto _recv_indicatepkt_drop; */ -+ } -+#endif /* CONFIG_AUTO_AP_MODE */ -+ -+ rtw_os_recv_indicate_pkt(padapter, skb, pattrib); -+ -+ precv_frame->u.hdr.pkt = NULL; /* pointers to NULL before rtw_free_recvframe() */ -+ -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ -+ RT_TRACE(_module_recv_osdep_c_, _drv_info_, ("\n rtw_recv_indicatepkt :after rtw_os_recv_indicate_pkt!!!!\n")); -+ -+ return _SUCCESS; -+ -+_recv_indicatepkt_drop: -+ -+ /* enqueue back to free_recv_queue */ -+ if (precv_frame) -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ -+ DBG_COUNTER(padapter->rx_logs.os_indicate_err); -+ return _FAIL; -+} -+ -+void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl) -+{ -+ struct adapter *padapter = preorder_ctrl->padapter; -+ -+ _init_timer(&(preorder_ctrl->reordering_ctrl_timer), padapter->pnetdev, rtw_reordering_ctrl_timeout_handler, preorder_ctrl); -+ -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/os_dep/rtw_proc.c linux/3rdparty/rtl8723bs/os_dep/rtw_proc.c ---- linux.old/3rdparty/rtl8723bs/os_dep/rtw_proc.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/os_dep/rtw_proc.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,786 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+#include "rtw_proc.h" -+ -+#ifdef CONFIG_PROC_DEBUG -+ -+static struct proc_dir_entry *rtw_proc = NULL; -+ -+#define RTW_PROC_NAME "rtl8723bs" -+ -+#define get_proc_net init_net.proc_net -+ -+inline struct proc_dir_entry *rtw_proc_create_dir(const char *name, struct proc_dir_entry *parent, void *data) -+{ -+ struct proc_dir_entry *entry; -+ -+ entry = proc_mkdir_data(name, S_IRUGO|S_IXUGO, parent, data); -+ -+ return entry; -+} -+ -+inline struct proc_dir_entry *rtw_proc_create_entry(const char *name, struct proc_dir_entry *parent, -+ const struct file_operations *fops, void *data) -+{ -+ struct proc_dir_entry *entry; -+ -+ entry = proc_create_data(name, S_IFREG|S_IRUGO, parent, fops, data); -+ -+ return entry; -+} -+ -+static int proc_get_dummy(struct seq_file *m, void *v) -+{ -+ return 0; -+} -+ -+static int proc_get_drv_version(struct seq_file *m, void *v) -+{ -+ dump_drv_version(m); -+ return 0; -+} -+ -+static int proc_get_log_level(struct seq_file *m, void *v) -+{ -+ dump_log_level(m); -+ return 0; -+} -+ -+static ssize_t proc_set_log_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ char tmp[32]; -+ int log_level; -+ -+ if (count < 1) -+ return -EINVAL; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ sscanf(tmp, "%d ", &log_level); -+ if (log_level >= _drv_always_ && log_level <= _drv_debug_) -+ { -+ GlobalDebugLevel = log_level; -+ printk("%d\n", GlobalDebugLevel); -+ } -+ } else { -+ return -EFAULT; -+ } -+ -+ return count; -+} -+ -+/* -+* rtw_drv_proc: -+* init/deinit when register/unregister driver -+*/ -+static const struct rtw_proc_hdl drv_proc_hdls [] = { -+ {"ver_info", proc_get_drv_version, NULL}, -+ {"log_level", proc_get_log_level, proc_set_log_level}, -+}; -+ -+static const int drv_proc_hdls_num = sizeof(drv_proc_hdls) / sizeof(struct rtw_proc_hdl); -+ -+static int rtw_drv_proc_open(struct inode *inode, struct file *file) -+{ -+ /* struct net_device *dev = proc_get_parent_data(inode); */ -+ ssize_t index = (ssize_t)PDE_DATA(inode); -+ const struct rtw_proc_hdl *hdl = drv_proc_hdls+index; -+ return single_open(file, hdl->show, NULL); -+} -+ -+static ssize_t rtw_drv_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); -+ const struct rtw_proc_hdl *hdl = drv_proc_hdls+index; -+ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; -+ -+ if (write) -+ return write(file, buffer, count, pos, NULL); -+ -+ return -EROFS; -+} -+ -+static const struct file_operations rtw_drv_proc_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_drv_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_drv_proc_write, -+}; -+ -+int rtw_drv_proc_init(void) -+{ -+ int ret = _FAIL; -+ ssize_t i; -+ struct proc_dir_entry *entry = NULL; -+ -+ if (rtw_proc != NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ rtw_proc = rtw_proc_create_dir(RTW_PROC_NAME, get_proc_net, NULL); -+ -+ if (rtw_proc == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ for (i = 0;iprivate; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ sd_f0_reg_dump(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_mac_reg_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ mac_reg_dump(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_bb_reg_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ bb_reg_dump(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_rf_reg_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ rf_reg_dump(m, adapter); -+ -+ return 0; -+} -+static int proc_get_linked_info_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ if (padapter) -+ DBG_871X_SEL_NL(m, "linked_info_dump :%s\n", (padapter->bLinkInfoDump)?"enable":"disable"); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_linked_info_dump(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ char tmp[2]; -+ int mode = 0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ if (padapter) -+ { -+ /* padapter->bLinkInfoDump = mode; */ -+ /* DBG_871X("linked_info_dump =%s\n", (padapter->bLinkInfoDump)?"enable":"disable"); */ -+ linked_info_dump(padapter, mode); -+ } -+ -+ } -+ -+ return count; -+ -+} -+ -+static int proc_get_rx_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ /* Counts of packets whose seq_num is less than preorder_ctrl->indicate_seq, Ex delay, retransmission, redundant packets and so on */ -+ DBG_871X_SEL_NL(m,"Counts of Packets Whose Seq_Num Less Than Reorder Control Seq_Num: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_drop_count); -+ /* How many times the Rx Reorder Timer is triggered. */ -+ DBG_871X_SEL_NL(m,"Rx Reorder Time-out Trigger Counts: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_forced_indicate_count); -+ /* Total counts of packets loss */ -+ DBG_871X_SEL_NL(m,"Rx Packet Loss Counts: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_loss_count); -+ DBG_871X_SEL_NL(m,"Duplicate Management Frame Drop Count: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_dup_mgt_frame_drop_count); -+ DBG_871X_SEL_NL(m,"AMPDU BA window shift Count: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_window_shift_cnt); -+ return 0; -+} -+ -+ -+static ssize_t proc_reset_rx_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ char cmd[32]; -+ if (buffer && !copy_from_user(cmd, buffer, sizeof(cmd))) { -+ if ('0' == cmd[0]) { -+ pdbgpriv->dbg_rx_ampdu_drop_count = 0; -+ pdbgpriv->dbg_rx_ampdu_forced_indicate_count = 0; -+ pdbgpriv->dbg_rx_ampdu_loss_count = 0; -+ pdbgpriv->dbg_rx_dup_mgt_frame_drop_count = 0; -+ pdbgpriv->dbg_rx_ampdu_window_shift_cnt = 0; -+ } -+ } -+ -+ return count; -+} -+ -+static int proc_get_cam(struct seq_file *m, void *v) -+{ -+ return 0; -+} -+ -+static ssize_t proc_set_cam(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *adapter; -+ -+ char tmp[32]; -+ char cmd[4]; -+ u8 id; -+ -+ adapter = (struct adapter *)rtw_netdev_priv(dev); -+ if (!adapter) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ /* c : clear specific cam entry */ -+ /* wfc : write specific cam entry from cam cache */ -+ -+ int num = sscanf(tmp, "%4s %hhu", cmd, &id); -+ -+ if (num < 2) -+ return count; -+ -+ if (strcmp("c", cmd) == 0) { -+ _clear_cam_entry(adapter, id); -+ adapter->securitypriv.hw_decrypted = false; /* temporarily set this for TX path to use SW enc */ -+ } else if (strcmp("wfc", cmd) == 0) { -+ write_cam_from_cache(adapter, id); -+ } -+ } -+ -+ return count; -+} -+ -+static int proc_get_cam_cache(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 i; -+ -+ DBG_871X_SEL_NL(m, "cam bitmap:0x%016llx\n", dvobj->cam_ctl.bitmap); -+ -+ DBG_871X_SEL_NL(m, "%-2s %-6s %-17s %-32s %-3s %-7s" -+ /* %-2s %-2s %-4s %-5s" */ -+ "\n" -+ , "id", "ctrl", "addr", "key", "kid", "type" -+ /* "MK", "GK", "MFB", "valid" */ -+ ); -+ -+ for (i = 0;i<32;i++) { -+ if (dvobj->cam_cache[i].ctrl != 0) -+ DBG_871X_SEL_NL(m, "%2u 0x%04x "MAC_FMT" "KEY_FMT" %3u %-7s" -+ /* %2u %2u 0x%02x %5u" */ -+ "\n", i -+ , dvobj->cam_cache[i].ctrl -+ , MAC_ARG(dvobj->cam_cache[i].mac) -+ , KEY_ARG(dvobj->cam_cache[i].key) -+ , (dvobj->cam_cache[i].ctrl)&0x03 -+ , security_type_str(((dvobj->cam_cache[i].ctrl)>>2)&0x07) -+ /* ((dvobj->cam_cache[i].ctrl)>>5)&0x01 */ -+ /* ((dvobj->cam_cache[i].ctrl)>>6)&0x01 */ -+ /* ((dvobj->cam_cache[i].ctrl)>>8)&0x7f */ -+ /* ((dvobj->cam_cache[i].ctrl)>>15)&0x01 */ -+ ); -+ } -+ -+ return 0; -+} -+ -+/* -+* rtw_adapter_proc: -+* init/deinit when register/unregister net_device -+*/ -+static const struct rtw_proc_hdl adapter_proc_hdls [] = { -+ {"write_reg", proc_get_dummy, proc_set_write_reg}, -+ {"read_reg", proc_get_read_reg, proc_set_read_reg}, -+ {"fwstate", proc_get_fwstate, NULL}, -+ {"sec_info", proc_get_sec_info, NULL}, -+ {"mlmext_state", proc_get_mlmext_state, NULL}, -+ {"qos_option", proc_get_qos_option, NULL}, -+ {"ht_option", proc_get_ht_option, NULL}, -+ {"rf_info", proc_get_rf_info, NULL}, -+ {"survey_info", proc_get_survey_info, NULL}, -+ {"ap_info", proc_get_ap_info, NULL}, -+ {"adapter_state", proc_get_adapter_state, NULL}, -+ {"trx_info", proc_get_trx_info, NULL}, -+ {"rate_ctl", proc_get_rate_ctl, proc_set_rate_ctl}, -+ {"cam", proc_get_cam, proc_set_cam}, -+ {"cam_cache", proc_get_cam_cache, NULL}, -+ {"suspend_info", proc_get_suspend_resume_info, NULL}, -+ {"rx_info", proc_get_rx_info, proc_reset_rx_info}, -+ -+ {"roam_flags", proc_get_roam_flags, proc_set_roam_flags}, -+ {"roam_param", proc_get_roam_param, proc_set_roam_param}, -+ {"roam_tgt_addr", proc_get_dummy, proc_set_roam_tgt_addr}, -+ -+ {"sd_f0_reg_dump", proc_get_sd_f0_reg_dump, NULL}, -+ -+ {"fwdl_test_case", proc_get_dummy, proc_set_fwdl_test_case}, -+ {"wait_hiq_empty", proc_get_dummy, proc_set_wait_hiq_empty}, -+ -+ {"mac_reg_dump", proc_get_mac_reg_dump, NULL}, -+ {"bb_reg_dump", proc_get_bb_reg_dump, NULL}, -+ {"rf_reg_dump", proc_get_rf_reg_dump, NULL}, -+ -+ {"all_sta_info", proc_get_all_sta_info, NULL}, -+ -+ {"rx_signal", proc_get_rx_signal, proc_set_rx_signal}, -+ {"hw_info", proc_get_hw_status, NULL}, -+ -+ {"ht_enable", proc_get_ht_enable, proc_set_ht_enable}, -+ {"bw_mode", proc_get_bw_mode, proc_set_bw_mode}, -+ {"ampdu_enable", proc_get_ampdu_enable, proc_set_ampdu_enable}, -+ {"rx_stbc", proc_get_rx_stbc, proc_set_rx_stbc}, -+ {"rx_ampdu", proc_get_rx_ampdu, proc_set_rx_ampdu}, -+ -+ {"en_fwps", proc_get_en_fwps, proc_set_en_fwps}, -+ -+ /* path_rssi", proc_get_two_path_rssi, NULL}, */ -+ {"rssi_disp", proc_get_rssi_disp, proc_set_rssi_disp}, -+ -+ {"btcoex_dbg", proc_get_btcoex_dbg, proc_set_btcoex_dbg}, -+ {"btcoex", proc_get_btcoex_info, NULL}, -+ -+ {"linked_info_dump", proc_get_linked_info_dump, proc_set_linked_info_dump}, -+#ifdef CONFIG_DBG_COUNTER -+ {"rx_logs", proc_get_rx_logs, NULL}, -+ {"tx_logs", proc_get_tx_logs, NULL}, -+ {"int_logs", proc_get_int_logs, NULL}, -+#endif -+}; -+ -+static const int adapter_proc_hdls_num = sizeof(adapter_proc_hdls) / sizeof(struct rtw_proc_hdl); -+ -+static int rtw_adapter_proc_open(struct inode *inode, struct file *file) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(inode); -+ const struct rtw_proc_hdl *hdl = adapter_proc_hdls+index; -+ -+ return single_open(file, hdl->show, proc_get_parent_data(inode)); -+} -+ -+static ssize_t rtw_adapter_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); -+ const struct rtw_proc_hdl *hdl = adapter_proc_hdls+index; -+ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; -+ -+ if (write) -+ return write(file, buffer, count, pos, ((struct seq_file *)file->private_data)->private); -+ -+ return -EROFS; -+} -+ -+static const struct file_operations rtw_adapter_proc_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_adapter_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_adapter_proc_write, -+}; -+ -+int proc_get_odm_dbg_comp(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ rtw_odm_dbg_comp_msg(m, adapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_odm_dbg_comp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ -+ u64 dbg_comp; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%llx", &dbg_comp); -+ -+ if (num != 1) -+ return count; -+ -+ rtw_odm_dbg_comp_set(adapter, dbg_comp); -+ } -+ -+ return count; -+} -+ -+int proc_get_odm_dbg_level(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ rtw_odm_dbg_level_msg(m, adapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_odm_dbg_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ -+ u32 dbg_level; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%u", &dbg_level); -+ -+ if (num != 1) -+ return count; -+ -+ rtw_odm_dbg_level_set(adapter, dbg_level); -+ } -+ -+ return count; -+} -+ -+static int proc_get_odm_ability(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ rtw_odm_ability_msg(m, adapter); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_odm_ability(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *adapter = (struct adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ -+ u32 ability; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%x", &ability); -+ -+ if (num != 1) -+ return count; -+ -+ rtw_odm_ability_set(adapter, ability); -+ } -+ -+ return count; -+} -+ -+int proc_get_odm_adaptivity(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ -+ rtw_odm_adaptivity_parm_msg(m, padapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_odm_adaptivity(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 TH_L2H_ini; -+ s8 TH_EDCCA_HL_diff; -+ u32 IGI_Base; -+ int ForceEDCCA; -+ u8 AdapEn_RSSI; -+ u8 IGI_LowerBound; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%x %hhd %x %d %hhu %hhu", -+ &TH_L2H_ini, &TH_EDCCA_HL_diff, &IGI_Base, &ForceEDCCA, &AdapEn_RSSI, &IGI_LowerBound); -+ -+ if (num != 6) -+ return count; -+ -+ rtw_odm_adaptivity_parm_set(padapter, (s8)TH_L2H_ini, TH_EDCCA_HL_diff, (s8)IGI_Base, (bool)ForceEDCCA, AdapEn_RSSI, IGI_LowerBound); -+ } -+ -+ return count; -+} -+ -+/* -+* rtw_odm_proc: -+* init/deinit when register/unregister net_device, along with rtw_adapter_proc -+*/ -+static const struct rtw_proc_hdl odm_proc_hdls [] = { -+ {"dbg_comp", proc_get_odm_dbg_comp, proc_set_odm_dbg_comp}, -+ {"dbg_level", proc_get_odm_dbg_level, proc_set_odm_dbg_level}, -+ {"ability", proc_get_odm_ability, proc_set_odm_ability}, -+ {"adaptivity", proc_get_odm_adaptivity, proc_set_odm_adaptivity}, -+}; -+ -+static const int odm_proc_hdls_num = sizeof(odm_proc_hdls) / sizeof(struct rtw_proc_hdl); -+ -+static int rtw_odm_proc_open(struct inode *inode, struct file *file) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(inode); -+ const struct rtw_proc_hdl *hdl = odm_proc_hdls+index; -+ -+ return single_open(file, hdl->show, proc_get_parent_data(inode)); -+} -+ -+static ssize_t rtw_odm_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); -+ const struct rtw_proc_hdl *hdl = odm_proc_hdls+index; -+ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; -+ -+ if (write) -+ return write(file, buffer, count, pos, ((struct seq_file *)file->private_data)->private); -+ -+ return -EROFS; -+} -+ -+static const struct file_operations rtw_odm_proc_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_odm_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_odm_proc_write, -+}; -+ -+static struct proc_dir_entry *rtw_odm_proc_init(struct net_device *dev) -+{ -+ struct proc_dir_entry *dir_odm = NULL; -+ struct proc_dir_entry *entry = NULL; -+ struct adapter *adapter = rtw_netdev_priv(dev); -+ ssize_t i; -+ -+ if (adapter->dir_dev == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (adapter->dir_odm != NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ dir_odm = rtw_proc_create_dir("odm", adapter->dir_dev, dev); -+ if (dir_odm == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ adapter->dir_odm = dir_odm; -+ -+ for (i = 0;idir_odm; -+ -+ if (dir_odm == NULL) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ for (i = 0;idir_dev); -+ -+ adapter->dir_odm = NULL; -+} -+ -+struct proc_dir_entry *rtw_adapter_proc_init(struct net_device *dev) -+{ -+ struct proc_dir_entry *drv_proc = rtw_proc; -+ struct proc_dir_entry *dir_dev = NULL; -+ struct proc_dir_entry *entry = NULL; -+ struct adapter *adapter = rtw_netdev_priv(dev); -+ ssize_t i; -+ -+ if (drv_proc == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (adapter->dir_dev != NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ dir_dev = rtw_proc_create_dir(dev->name, drv_proc, dev); -+ if (dir_dev == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ adapter->dir_dev = dir_dev; -+ -+ for (i = 0;idir_dev; -+ -+ if (dir_dev == NULL) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ for (i = 0;iname, drv_proc); -+ -+ adapter->dir_dev = NULL; -+} -+ -+void rtw_adapter_proc_replace(struct net_device *dev) -+{ -+ struct proc_dir_entry *drv_proc = rtw_proc; -+ struct proc_dir_entry *dir_dev = NULL; -+ struct adapter *adapter = rtw_netdev_priv(dev); -+ int i; -+ -+ dir_dev = adapter->dir_dev; -+ -+ if (dir_dev == NULL) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ for (i = 0;iold_ifname, drv_proc); -+ -+ adapter->dir_dev = NULL; -+ -+ rtw_adapter_proc_init(dev); -+ -+} -+ -+#endif /* CONFIG_PROC_DEBUG */ -diff -Nurp linux.old/3rdparty/rtl8723bs/os_dep/rtw_proc.h linux/3rdparty/rtl8723bs/os_dep/rtw_proc.h ---- linux.old/3rdparty/rtl8723bs/os_dep/rtw_proc.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/os_dep/rtw_proc.h 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,45 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_PROC_H__ -+#define __RTW_PROC_H__ -+ -+#include -+#include -+ -+struct rtw_proc_hdl { -+ char *name; -+ int (*show)(struct seq_file *, void *); -+ ssize_t (*write)(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+}; -+ -+#ifdef CONFIG_PROC_DEBUG -+ -+int rtw_drv_proc_init(void); -+void rtw_drv_proc_deinit(void); -+struct proc_dir_entry *rtw_adapter_proc_init(struct net_device *dev); -+void rtw_adapter_proc_deinit(struct net_device *dev); -+void rtw_adapter_proc_replace(struct net_device *dev); -+ -+#else //!CONFIG_PROC_DEBUG -+ -+int rtw_drv_proc_init(void) {return 0;} -+void rtw_drv_proc_deinit(void) {} -+struct proc_dir_entry *rtw_adapter_proc_init(struct net_device *dev){return NULL;} -+void rtw_adapter_proc_deinit(struct net_device *dev){} -+void rtw_adapter_proc_replace(struct net_device *dev){} -+ -+#endif //!CONFIG_PROC_DEBUG -+ -+#endif //__RTW_PROC_H__ -diff -Nurp linux.old/3rdparty/rtl8723bs/os_dep/sdio_intf.c linux/3rdparty/rtl8723bs/os_dep/sdio_intf.c ---- linux.old/3rdparty/rtl8723bs/os_dep/sdio_intf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/os_dep/sdio_intf.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,727 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _HCI_INTF_C_ -+ -+#include -+#include -+#include -+ -+#ifndef dev_to_sdio_func -+#define dev_to_sdio_func(d) container_of(d, struct sdio_func, dev) -+#endif -+ -+static const struct sdio_device_id sdio_ids[] = -+{ -+// { SDIO_DEVICE(0x024c, 0xB723), }, -+// { SDIO_DEVICE(0x024c, 0x0523), }, -+// { SDIO_DEVICE(0x024c, 0x0623), }, -+ { SDIO_DEVICE_CLASS(SDIO_CLASS_WLAN) }, -+ { /* end: all zeroes */ }, -+}; -+ -+MODULE_DEVICE_TABLE(sdio, sdio_ids); -+ -+static int rtw_drv_init(struct sdio_func *func, const struct sdio_device_id *id); -+static void rtw_dev_remove(struct sdio_func *func); -+static int rtw_sdio_resume(struct device *dev); -+static int rtw_sdio_suspend(struct device *dev); -+ -+static const struct dev_pm_ops rtw_sdio_pm_ops = { -+ .suspend = rtw_sdio_suspend, -+ .resume = rtw_sdio_resume, -+}; -+ -+struct sdio_drv_priv { -+ struct sdio_driver r871xs_drv; -+ int drv_registered; -+}; -+ -+static struct sdio_drv_priv sdio_drvpriv = { -+ .r871xs_drv.probe = rtw_drv_init, -+ .r871xs_drv.remove = rtw_dev_remove, -+ .r871xs_drv.name = "rtl8723bs", -+ .r871xs_drv.id_table = sdio_ids, -+ .r871xs_drv.drv = { -+ .pm = &rtw_sdio_pm_ops, -+ } -+}; -+ -+static void sd_sync_int_hdl(struct sdio_func *func) -+{ -+ struct dvobj_priv *psdpriv; -+ -+ -+ psdpriv = sdio_get_drvdata(func); -+ -+ if (!psdpriv->if1) { -+ DBG_871X("%s if1 == NULL\n", __func__); -+ return; -+ } -+ -+ rtw_sdio_set_irq_thd(psdpriv, current); -+ sd_int_hdl(psdpriv->if1); -+ rtw_sdio_set_irq_thd(psdpriv, NULL); -+} -+ -+static int sdio_alloc_irq(struct dvobj_priv *dvobj) -+{ -+ PSDIO_DATA psdio_data; -+ struct sdio_func *func; -+ int err; -+ -+ psdio_data = &dvobj->intf_data; -+ func = psdio_data->func; -+ -+ sdio_claim_host(func); -+ -+ err = sdio_claim_irq(func, &sd_sync_int_hdl); -+ if (err) -+ { -+ dvobj->drv_dbg.dbg_sdio_alloc_irq_error_cnt++; -+ printk(KERN_CRIT "%s: sdio_claim_irq FAIL(%d)!\n", __func__, err); -+ } -+ else -+ { -+ dvobj->drv_dbg.dbg_sdio_alloc_irq_cnt++; -+ dvobj->irq_alloc = 1; -+ } -+ -+ sdio_release_host(func); -+ -+ return err?_FAIL:_SUCCESS; -+} -+ -+static void sdio_free_irq(struct dvobj_priv *dvobj) -+{ -+ PSDIO_DATA psdio_data; -+ struct sdio_func *func; -+ int err; -+ -+ if (dvobj->irq_alloc) { -+ psdio_data = &dvobj->intf_data; -+ func = psdio_data->func; -+ -+ if (func) { -+ sdio_claim_host(func); -+ err = sdio_release_irq(func); -+ if (err) -+ { -+ dvobj->drv_dbg.dbg_sdio_free_irq_error_cnt++; -+ DBG_871X_LEVEL(_drv_err_,"%s: sdio_release_irq FAIL(%d)!\n", __func__, err); -+ } -+ else -+ dvobj->drv_dbg.dbg_sdio_free_irq_cnt++; -+ sdio_release_host(func); -+ } -+ dvobj->irq_alloc = 0; -+ } -+} -+ -+#ifdef CONFIG_GPIO_WAKEUP -+extern unsigned int oob_irq; -+static irqreturn_t gpio_hostwakeup_irq_thread(int irq, void *data) -+{ -+ struct adapter *padapter = (struct adapter *)data; -+ DBG_871X_LEVEL(_drv_always_, "gpio_hostwakeup_irq_thread\n"); -+ /* Disable interrupt before calling handler */ -+ /* disable_irq_nosync(oob_irq); */ -+ rtw_lock_suspend_timeout(HZ/2); -+ return IRQ_HANDLED; -+} -+ -+static u8 gpio_hostwakeup_alloc_irq(struct adapter *padapter) -+{ -+ int err; -+ if (oob_irq == 0) { -+ DBG_871X("oob_irq ZERO!\n"); -+ return _FAIL; -+ } -+ /* dont set it IRQF_TRIGGER_LOW, or wowlan */ -+ /* power is high after suspend */ -+ /* and failing can prevent can not sleep issue if */ -+ /* wifi gpio12 pin is not linked with CPU */ -+ err = request_threaded_irq(oob_irq, gpio_hostwakeup_irq_thread, NULL, -+ /* IRQF_TRIGGER_LOW | IRQF_ONESHOT, */ -+ IRQF_TRIGGER_FALLING, -+ "rtw_wifi_gpio_wakeup", padapter); -+ if (err < 0) { -+ DBG_871X("Oops: can't allocate gpio irq %d err:%d\n", oob_irq, err); -+ return false; -+ } else { -+ DBG_871X("allocate gpio irq %d ok\n", oob_irq); -+ } -+ -+ enable_irq_wake(oob_irq); -+ return _SUCCESS; -+} -+ -+static void gpio_hostwakeup_free_irq(struct adapter *padapter) -+{ -+ if (oob_irq == 0) -+ return; -+ -+ disable_irq_wake(oob_irq); -+ free_irq(oob_irq, padapter); -+} -+#endif -+ -+static u32 sdio_init(struct dvobj_priv *dvobj) -+{ -+ PSDIO_DATA psdio_data; -+ struct sdio_func *func; -+ int err; -+ -+ psdio_data = &dvobj->intf_data; -+ func = psdio_data->func; -+ -+ /* 3 1. init SDIO bus */ -+ sdio_claim_host(func); -+ -+ err = sdio_enable_func(func); -+ if (err) { -+ dvobj->drv_dbg.dbg_sdio_init_error_cnt++; -+ DBG_8192C(KERN_CRIT "%s: sdio_enable_func FAIL(%d)!\n", __func__, err); -+ goto release; -+ } -+ -+ err = sdio_set_block_size(func, 512); -+ if (err) { -+ dvobj->drv_dbg.dbg_sdio_init_error_cnt++; -+ DBG_8192C(KERN_CRIT "%s: sdio_set_block_size FAIL(%d)!\n", __func__, err); -+ goto release; -+ } -+ psdio_data->block_transfer_len = 512; -+ psdio_data->tx_block_mode = 1; -+ psdio_data->rx_block_mode = 1; -+ -+release: -+ sdio_release_host(func); -+ -+ if (err) -+ return _FAIL; -+ return _SUCCESS; -+} -+ -+static void sdio_deinit(struct dvobj_priv *dvobj) -+{ -+ struct sdio_func *func; -+ int err; -+ -+ -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("+sdio_deinit\n")); -+ -+ func = dvobj->intf_data.func; -+ -+ if (func) { -+ sdio_claim_host(func); -+ err = sdio_disable_func(func); -+ if (err) -+ { -+ dvobj->drv_dbg.dbg_sdio_deinit_error_cnt++; -+ DBG_8192C(KERN_ERR "%s: sdio_disable_func(%d)\n", __func__, err); -+ } -+ -+ if (dvobj->irq_alloc) { -+ err = sdio_release_irq(func); -+ if (err) -+ { -+ dvobj->drv_dbg.dbg_sdio_free_irq_error_cnt++; -+ DBG_8192C(KERN_ERR "%s: sdio_release_irq(%d)\n", __func__, err); -+ } -+ else -+ dvobj->drv_dbg.dbg_sdio_free_irq_cnt++; -+ } -+ -+ sdio_release_host(func); -+ } -+} -+static struct dvobj_priv *sdio_dvobj_init(struct sdio_func *func) -+{ -+ int status = _FAIL; -+ struct dvobj_priv *dvobj = NULL; -+ PSDIO_DATA psdio; -+ -+ if ((dvobj = devobj_init()) == NULL) { -+ goto exit; -+ } -+ -+ sdio_set_drvdata(func, dvobj); -+ -+ psdio = &dvobj->intf_data; -+ psdio->func = func; -+ -+ if (sdio_init(dvobj) != _SUCCESS) { -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: initialize SDIO Failed!\n", __func__)); -+ goto free_dvobj; -+ } -+ rtw_reset_continual_io_error(dvobj); -+ status = _SUCCESS; -+ -+free_dvobj: -+ if (status != _SUCCESS && dvobj) { -+ sdio_set_drvdata(func, NULL); -+ -+ devobj_deinit(dvobj); -+ -+ dvobj = NULL; -+ } -+exit: -+ return dvobj; -+} -+ -+static void sdio_dvobj_deinit(struct sdio_func *func) -+{ -+ struct dvobj_priv *dvobj = sdio_get_drvdata(func); -+ -+ sdio_set_drvdata(func, NULL); -+ if (dvobj) { -+ sdio_deinit(dvobj); -+ devobj_deinit(dvobj); -+ } -+ return; -+} -+ -+void rtw_set_hal_ops(struct adapter *padapter) -+{ -+ /* alloc memory for HAL DATA */ -+ rtw_hal_data_init(padapter); -+ -+ rtl8723bs_set_hal_ops(padapter); -+} -+ -+static void sd_intf_start(struct adapter *padapter) -+{ -+ if (padapter == NULL) { -+ DBG_8192C(KERN_ERR "%s: padapter is NULL!\n", __func__); -+ return; -+ } -+ -+ /* hal dep */ -+ rtw_hal_enable_interrupt(padapter); -+} -+ -+static void sd_intf_stop(struct adapter *padapter) -+{ -+ if (padapter == NULL) { -+ DBG_8192C(KERN_ERR "%s: padapter is NULL!\n", __func__); -+ return; -+ } -+ -+ /* hal dep */ -+ rtw_hal_disable_interrupt(padapter); -+} -+ -+ -+static struct adapter *rtw_sdio_if1_init(struct dvobj_priv *dvobj, const struct sdio_device_id *pdid) -+{ -+ int status = _FAIL; -+ struct net_device *pnetdev; -+ struct adapter *padapter = NULL; -+ PSDIO_DATA psdio = &dvobj->intf_data; -+ -+ if ((padapter = (struct adapter *)vzalloc(sizeof(*padapter))) == NULL) { -+ goto exit; -+ } -+ -+ padapter->dvobj = dvobj; -+ dvobj->if1 = padapter; -+ -+ padapter->bDriverStopped =true; -+ -+ dvobj->padapters = padapter; -+ padapter->iface_id = 0; -+ -+ /* 3 1. init network device data */ -+ pnetdev = rtw_init_netdev(padapter); -+ if (!pnetdev) -+ goto free_adapter; -+ -+ SET_NETDEV_DEV(pnetdev, dvobj_to_dev(dvobj)); -+ -+ padapter = rtw_netdev_priv(pnetdev); -+ -+ rtw_wdev_alloc(padapter, dvobj_to_dev(dvobj)); -+ -+ /* 3 3. init driver special setting, interface, OS and hardware relative */ -+ -+ /* 4 3.1 set hardware operation functions */ -+ rtw_set_hal_ops(padapter); -+ -+ -+ /* 3 5. initialize Chip version */ -+ padapter->intf_start = &sd_intf_start; -+ padapter->intf_stop = &sd_intf_stop; -+ -+ padapter->intf_init = &sdio_init; -+ padapter->intf_deinit = &sdio_deinit; -+ padapter->intf_alloc_irq = &sdio_alloc_irq; -+ padapter->intf_free_irq = &sdio_free_irq; -+ -+ if (rtw_init_io_priv(padapter, sdio_set_intf_ops) == _FAIL) -+ { -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, -+ ("rtw_drv_init: Can't init io_priv\n")); -+ goto free_hal_data; -+ } -+ -+ rtw_hal_read_chip_version(padapter); -+ -+ rtw_hal_chip_configure(padapter); -+ -+ rtw_btcoex_Initialize(padapter); -+ -+ /* 3 6. read efuse/eeprom data */ -+ rtw_hal_read_chip_info(padapter); -+ -+ /* 3 7. init driver common data */ -+ if (rtw_init_drv_sw(padapter) == _FAIL) { -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, -+ ("rtw_drv_init: Initialize driver software resource Failed!\n")); -+ goto free_hal_data; -+ } -+ -+ /* 3 8. get WLan MAC address */ -+ /* set mac addr */ -+ rtw_macaddr_cfg(&psdio->func->dev, padapter->eeprompriv.mac_addr); -+ -+ rtw_hal_disable_interrupt(padapter); -+ -+ DBG_871X("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n" -+ , padapter->bDriverStopped -+ , padapter->bSurpriseRemoved -+ , padapter->bup -+ , padapter->hw_init_completed -+ ); -+ -+ status = _SUCCESS; -+ -+free_hal_data: -+ if (status != _SUCCESS && padapter->HalData) -+ kfree(padapter->HalData); -+ -+ if (status != _SUCCESS) { -+ rtw_wdev_unregister(padapter->rtw_wdev); -+ rtw_wdev_free(padapter->rtw_wdev); -+ } -+ -+free_adapter: -+ if (status != _SUCCESS) { -+ if (pnetdev) -+ rtw_free_netdev(pnetdev); -+ else -+ vfree((u8 *)padapter); -+ padapter = NULL; -+ } -+exit: -+ return padapter; -+} -+ -+static void rtw_sdio_if1_deinit(struct adapter *if1) -+{ -+ struct net_device *pnetdev = if1->pnetdev; -+ struct mlme_priv *pmlmepriv = &if1->mlmepriv; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) -+ rtw_disassoc_cmd(if1, 0, false); -+ -+ free_mlme_ap_info(if1); -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ gpio_hostwakeup_free_irq(if1); -+#endif -+ -+ rtw_cancel_all_timer(if1); -+ -+#ifdef CONFIG_WOWLAN -+ adapter_to_pwrctl(if1)->wowlan_mode =false; -+ DBG_871X_LEVEL(_drv_always_, "%s wowlan_mode:%d\n", __func__, adapter_to_pwrctl(if1)->wowlan_mode); -+#endif /* CONFIG_WOWLAN */ -+ -+ rtw_dev_unload(if1); -+ DBG_871X("+r871xu_dev_remove, hw_init_completed =%d\n", if1->hw_init_completed); -+ -+ if (if1->rtw_wdev) { -+ rtw_wdev_free(if1->rtw_wdev); -+ } -+ -+ rtw_free_drv_sw(if1); -+ -+ if (pnetdev) -+ rtw_free_netdev(pnetdev); -+} -+ -+/* -+ * drv_init() - a device potentially for us -+ * -+ * notes: drv_init() is called when the bus driver has located a card for us to support. -+ * We accept the new device by returning 0. -+ */ -+static int rtw_drv_init( -+ struct sdio_func *func, -+ const struct sdio_device_id *id) -+{ -+ int status = _FAIL; -+ struct adapter *if1 = NULL, *if2 = NULL; -+ struct dvobj_priv *dvobj; -+ -+ switch (func->vendor) { -+ case 0x024c: -+ switch (func->device) { -+ case 0x0523: -+ case 0x0623: -+ case 0x0626: -+ case 0xb723: -+ break; -+ default: -+ pr_info("RTL8723BS: Found unrecognized device 0x%x for vendor 0x%x\n", -+ func->device, func->vendor); -+ goto exit; -+ } -+ break; -+ default: -+ pr_info("RTL8723BS: Found unrecognized vendor 0x%x, device 0x%x\n", -+ func->vendor, func->device); -+ goto exit; -+ } -+ if ((dvobj = sdio_dvobj_init(func)) == NULL) { -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("initialize device object priv Failed!\n")); -+ goto exit; -+ } -+ -+ if ((if1 = rtw_sdio_if1_init(dvobj, id)) == NULL) { -+ DBG_871X("rtw_init_primarystruct adapter Failed!\n"); -+ goto free_dvobj; -+ } -+ -+ /* dev_alloc_name && register_netdev */ -+ if ((status = rtw_drv_register_netdev(if1)) != _SUCCESS) { -+ goto free_if2; -+ } -+ -+ if (sdio_alloc_irq(dvobj) != _SUCCESS) -+ goto free_if2; -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ gpio_hostwakeup_alloc_irq(if1); -+#endif -+ -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("-871x_drv - drv_init, success!\n")); -+ -+ rtw_ndev_notifier_register(); -+ status = _SUCCESS; -+ -+free_if2: -+ if (status != _SUCCESS && if2) { -+ } -+ if (status != _SUCCESS && if1) { -+ rtw_sdio_if1_deinit(if1); -+ } -+free_dvobj: -+ if (status != _SUCCESS) -+ sdio_dvobj_deinit(func); -+exit: -+ return status == _SUCCESS?0:-ENODEV; -+} -+ -+static void rtw_dev_remove(struct sdio_func *func) -+{ -+ struct dvobj_priv *dvobj = sdio_get_drvdata(func); -+ struct adapter *padapter = dvobj->if1; -+ -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("+rtw_dev_remove\n")); -+ -+ dvobj->processing_dev_remove = true; -+ -+ rtw_unregister_netdevs(dvobj); -+ -+ if (padapter->bSurpriseRemoved == false) { -+ int err; -+ -+ /* test surprise remove */ -+ sdio_claim_host(func); -+ sdio_readb(func, 0, &err); -+ sdio_release_host(func); -+ if (err == -ENOMEDIUM) { -+ padapter->bSurpriseRemoved = true; -+ DBG_871X(KERN_NOTICE "%s: device had been removed!\n", __func__); -+ } -+ } -+ -+ rtw_ps_deny(padapter, PS_DENY_DRV_REMOVE); -+ -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); -+ -+ LeaveAllPowerSaveMode(padapter); -+ -+ rtw_btcoex_HaltNotify(padapter); -+ -+ rtw_sdio_if1_deinit(padapter); -+ -+ sdio_dvobj_deinit(func); -+ -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("-rtw_dev_remove\n")); -+} -+ -+extern int pm_netdev_open(struct net_device *pnetdev, u8 bnormal); -+extern int pm_netdev_close(struct net_device *pnetdev, u8 bnormal); -+ -+static int rtw_sdio_suspend(struct device *dev) -+{ -+ struct sdio_func *func =dev_to_sdio_func(dev); -+ struct dvobj_priv *psdpriv = sdio_get_drvdata(func); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(psdpriv); -+ struct adapter *padapter = psdpriv->if1; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ int ret = 0; -+ -+ if (padapter->bDriverStopped == true) -+ { -+ DBG_871X("%s bDriverStopped = %d\n", __func__, padapter->bDriverStopped); -+ goto exit; -+ } -+ -+ if (pwrpriv->bInSuspend == true) -+ { -+ DBG_871X("%s bInSuspend = %d\n", __func__, pwrpriv->bInSuspend); -+ pdbgpriv->dbg_suspend_error_cnt++; -+ goto exit; -+ } -+ -+ ret = rtw_suspend_common(padapter); -+ -+exit: -+#ifdef CONFIG_RTW_SDIO_PM_KEEP_POWER -+ /* Android 4.0 don't support WIFI close power */ -+ /* or power down or clock will close after wifi resume, */ -+ /* this is sprd's bug in Android 4.0, but sprd don't */ -+ /* want to fix it. */ -+ /* we have test power under 8723as, power consumption is ok */ -+ if (func) { -+ mmc_pm_flag_t pm_flag = 0; -+ pm_flag = sdio_get_host_pm_caps(func); -+ DBG_871X("cmd: %s: suspend: PM flag = 0x%x\n", sdio_func_id(func), pm_flag); -+ if (!(pm_flag & MMC_PM_KEEP_POWER)) { -+ DBG_871X("%s: cannot remain alive while host is suspended\n", sdio_func_id(func)); -+ pdbgpriv->dbg_suspend_error_cnt++; -+ return -ENOSYS; -+ } else { -+ DBG_871X("cmd: suspend with MMC_PM_KEEP_POWER\n"); -+ sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER); -+ } -+ } -+#endif -+ return ret; -+} -+static int rtw_resume_process(struct adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ if (pwrpriv->bInSuspend == false) -+ { -+ pdbgpriv->dbg_resume_error_cnt++; -+ DBG_871X("%s bInSuspend = %d\n", __func__, pwrpriv->bInSuspend); -+ return -1; -+ } -+ -+ return rtw_resume_common(padapter); -+} -+ -+static int rtw_sdio_resume(struct device *dev) -+{ -+ struct sdio_func *func =dev_to_sdio_func(dev); -+ struct dvobj_priv *psdpriv = sdio_get_drvdata(func); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(psdpriv); -+ struct adapter *padapter = psdpriv->if1; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ int ret = 0; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ DBG_871X("==> %s (%s:%d)\n", __func__, current->comm, current->pid); -+ -+ pdbgpriv->dbg_resume_cnt++; -+ -+ if (pwrpriv->bInternalAutoSuspend) -+ { -+ ret = rtw_resume_process(padapter); -+ } -+ else -+ { -+ if (pwrpriv->wowlan_mode || pwrpriv->wowlan_ap_mode) -+ { -+ ret = rtw_resume_process(padapter); -+ } -+ else -+ { -+ ret = rtw_resume_process(padapter); -+ } -+ } -+ pmlmeext->last_scan_time = jiffies; -+ DBG_871X("<======== %s return %d\n", __func__, ret); -+ return ret; -+ -+} -+ -+static int __init rtw_drv_entry(void) -+{ -+ int ret = 0; -+ -+ DBG_871X_LEVEL(_drv_always_, "module init start\n"); -+ dump_drv_version(RTW_DBGDUMP); -+#ifdef BTCOEXVERSION -+ DBG_871X_LEVEL(_drv_always_, "rtl8723bs BT-Coex version = %s\n", BTCOEXVERSION); -+#endif /* BTCOEXVERSION */ -+ -+ sdio_drvpriv.drv_registered = true; -+ rtw_drv_proc_init(); -+ -+ ret = sdio_register_driver(&sdio_drvpriv.r871xs_drv); -+ if (ret != 0) -+ { -+ sdio_drvpriv.drv_registered = false; -+ rtw_drv_proc_deinit(); -+ rtw_ndev_notifier_unregister(); -+ DBG_871X("%s: register driver failed!!(%d)\n", __func__, ret); -+ goto exit; -+ } -+ -+ goto exit; -+ -+exit: -+ DBG_871X_LEVEL(_drv_always_, "module init ret =%d\n", ret); -+ return ret; -+} -+ -+static void __exit rtw_drv_halt(void) -+{ -+ DBG_871X_LEVEL(_drv_always_, "module exit start\n"); -+ -+ sdio_drvpriv.drv_registered = false; -+ -+ sdio_unregister_driver(&sdio_drvpriv.r871xs_drv); -+ -+ rtw_drv_proc_deinit(); -+ rtw_ndev_notifier_unregister(); -+ -+ DBG_871X_LEVEL(_drv_always_, "module exit success\n"); -+ -+ rtw_mstat_dump(RTW_DBGDUMP); -+} -+ -+ -+module_init(rtw_drv_entry); -+module_exit(rtw_drv_halt); -diff -Nurp linux.old/3rdparty/rtl8723bs/os_dep/sdio_ops_linux.c linux/3rdparty/rtl8723bs/os_dep/sdio_ops_linux.c ---- linux.old/3rdparty/rtl8723bs/os_dep/sdio_ops_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/os_dep/sdio_ops_linux.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,599 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *******************************************************************************/ -+#define _SDIO_OPS_LINUX_C_ -+ -+#include -+#include -+ -+static bool rtw_sdio_claim_host_needed(struct sdio_func *func) -+{ -+ struct dvobj_priv *dvobj = sdio_get_drvdata(func); -+ PSDIO_DATA sdio_data = &dvobj->intf_data; -+ -+ if (sdio_data->sys_sdio_irq_thd && sdio_data->sys_sdio_irq_thd == current) -+ return false; -+ return true; -+} -+ -+inline void rtw_sdio_set_irq_thd(struct dvobj_priv *dvobj, void *thd_hdl) -+{ -+ PSDIO_DATA sdio_data = &dvobj->intf_data; -+ -+ sdio_data->sys_sdio_irq_thd = thd_hdl; -+} -+ -+u8 sd_f0_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ u8 v = 0; -+ struct sdio_func *func; -+ bool claim_needed; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (padapter->bSurpriseRemoved) { -+ /* DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__); */ -+ return v; -+ } -+ -+ func = psdio->func; -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ v = sdio_f0_readb(func, addr, err); -+ if (claim_needed) -+ sdio_release_host(func); -+ if (err && *err) -+ DBG_871X(KERN_ERR "%s: FAIL!(%d) addr = 0x%05x\n", __func__, *err, addr); -+ return v; -+} -+ -+/* -+ * Return: -+ *0 Success -+ *others Fail -+ */ -+s32 _sd_cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ int err = 0, i; -+ struct sdio_func *func; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (padapter->bSurpriseRemoved) { -+ /* DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__); */ -+ return err; -+ } -+ -+ func = psdio->func; -+ -+ for (i = 0; i < cnt; i++) { -+ pdata[i] = sdio_readb(func, addr+i, &err); -+ if (err) { -+ DBG_871X(KERN_ERR "%s: FAIL!(%d) addr = 0x%05x\n", __func__, err, addr+i); -+ break; -+ } -+ } -+ return err; -+} -+ -+/* -+ * Return: -+ *0 Success -+ *others Fail -+ */ -+s32 sd_cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ int err = 0; -+ struct sdio_func *func; -+ bool claim_needed; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (padapter->bSurpriseRemoved) { -+ /* DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__); */ -+ return err; -+ } -+ -+ func = psdio->func; -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ err = _sd_cmd52_read(pintfhdl, addr, cnt, pdata); -+ if (claim_needed) -+ sdio_release_host(func); -+ return err; -+} -+ -+/* -+ * Return: -+ *0 Success -+ *others Fail -+ */ -+s32 _sd_cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ int err = 0, i; -+ struct sdio_func *func; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (padapter->bSurpriseRemoved) { -+ /* DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__); */ -+ return err; -+ } -+ -+ func = psdio->func; -+ -+ for (i = 0; i < cnt; i++) { -+ sdio_writeb(func, pdata[i], addr+i, &err); -+ if (err) { -+ DBG_871X(KERN_ERR "%s: FAIL!(%d) addr = 0x%05x val = 0x%02x\n", __func__, err, addr+i, pdata[i]); -+ break; -+ } -+ } -+ return err; -+} -+ -+/* -+ * Return: -+ *0 Success -+ *others Fail -+ */ -+s32 sd_cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ int err = 0; -+ struct sdio_func *func; -+ bool claim_needed; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (padapter->bSurpriseRemoved) { -+ /* DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__); */ -+ return err; -+ } -+ -+ func = psdio->func; -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ err = _sd_cmd52_write(pintfhdl, addr, cnt, pdata); -+ if (claim_needed) -+ sdio_release_host(func); -+ return err; -+} -+ -+u8 sd_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ u8 v = 0; -+ struct sdio_func *func; -+ bool claim_needed; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (padapter->bSurpriseRemoved) { -+ /* DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__); */ -+ return v; -+ } -+ -+ func = psdio->func; -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ v = sdio_readb(func, addr, err); -+ if (claim_needed) -+ sdio_release_host(func); -+ if (err && *err) -+ DBG_871X(KERN_ERR "%s: FAIL!(%d) addr = 0x%05x\n", __func__, *err, addr); -+ return v; -+} -+ -+u32 sd_read32(struct intf_hdl *pintfhdl, u32 addr, s32 *err) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ u32 v = 0; -+ struct sdio_func *func; -+ bool claim_needed; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (padapter->bSurpriseRemoved) { -+ /* DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__); */ -+ return v; -+ } -+ -+ func = psdio->func; -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ v = sdio_readl(func, addr, err); -+ if (claim_needed) -+ sdio_release_host(func); -+ -+ if (err && *err) -+ { -+ int i; -+ -+ DBG_871X(KERN_ERR "%s: (%d) addr = 0x%05x, val = 0x%x\n", __func__, *err, addr, v); -+ -+ *err = 0; -+ for (i = 0; ibSurpriseRemoved = true; -+ } -+ -+ if (rtw_inc_and_chk_continual_io_error(psdiodev) == true) { -+ padapter->bSurpriseRemoved = true; -+ break; -+ } -+ } -+ } -+ -+ if (i ==SD_IO_TRY_CNT) -+ DBG_871X(KERN_ERR "%s: FAIL!(%d) addr = 0x%05x, val = 0x%x, try_cnt =%d\n", __func__, *err, addr, v, i); -+ else -+ DBG_871X(KERN_ERR "%s: (%d) addr = 0x%05x, val = 0x%x, try_cnt =%d\n", __func__, *err, addr, v, i); -+ -+ } -+ return v; -+} -+ -+void sd_write8(struct intf_hdl *pintfhdl, u32 addr, u8 v, s32 *err) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ struct sdio_func *func; -+ bool claim_needed; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (padapter->bSurpriseRemoved) { -+ /* DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__); */ -+ return ; -+ } -+ -+ func = psdio->func; -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ sdio_writeb(func, v, addr, err); -+ if (claim_needed) -+ sdio_release_host(func); -+ if (err && *err) -+ DBG_871X(KERN_ERR "%s: FAIL!(%d) addr = 0x%05x val = 0x%02x\n", __func__, *err, addr, v); -+} -+ -+void sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ struct sdio_func *func; -+ bool claim_needed; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (padapter->bSurpriseRemoved) { -+ /* DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__); */ -+ return ; -+ } -+ -+ func = psdio->func; -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ sdio_writel(func, v, addr, err); -+ if (claim_needed) -+ sdio_release_host(func); -+ -+ if (err && *err) -+ { -+ int i; -+ -+ DBG_871X(KERN_ERR "%s: (%d) addr = 0x%05x val = 0x%08x\n", __func__, *err, addr, v); -+ -+ *err = 0; -+ for (i = 0; ibSurpriseRemoved = true; -+ } -+ -+ if (rtw_inc_and_chk_continual_io_error(psdiodev) == true) { -+ padapter->bSurpriseRemoved = true; -+ break; -+ } -+ } -+ } -+ -+ if (i ==SD_IO_TRY_CNT) -+ DBG_871X(KERN_ERR "%s: FAIL!(%d) addr = 0x%05x val = 0x%08x, try_cnt =%d\n", __func__, *err, addr, v, i); -+ else -+ DBG_871X(KERN_ERR "%s: (%d) addr = 0x%05x val = 0x%08x, try_cnt =%d\n", __func__, *err, addr, v, i); -+ } -+} -+ -+/* -+ * Use CMD53 to read data from SDIO device. -+ * This function MUST be called after sdio_claim_host() or -+ * in SDIO ISR(host had been claimed). -+ * -+ * Parameters: -+ *psdio pointer of SDIO_DATA -+ *addr address to read -+ *cnt amount to read -+ *pdata pointer to put data, this should be a "DMA:able scratch buffer"! -+ * -+ * Return: -+ *0 Success -+ *others Fail -+ */ -+s32 _sd_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ int err = -EPERM; -+ struct sdio_func *func; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (padapter->bSurpriseRemoved) { -+ /* DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__); */ -+ return err; -+ } -+ -+ func = psdio->func; -+ -+ if (unlikely((cnt == 1) || (cnt ==2))) -+ { -+ int i; -+ u8 *pbuf = (u8 *)pdata; -+ -+ for (i = 0; i < cnt; i++) -+ { -+ *(pbuf+i) = sdio_readb(func, addr+i, &err); -+ -+ if (err) { -+ DBG_871X(KERN_ERR "%s: FAIL!(%d) addr = 0x%05x\n", __func__, err, addr); -+ break; -+ } -+ } -+ return err; -+ } -+ -+ err = sdio_memcpy_fromio(func, pdata, addr, cnt); -+ if (err) { -+ DBG_871X(KERN_ERR "%s: FAIL(%d)! ADDR =%#x Size =%d\n", __func__, err, addr, cnt); -+ } -+ return err; -+} -+ -+/* -+ * Use CMD53 to read data from SDIO device. -+ * -+ * Parameters: -+ *psdio pointer of SDIO_DATA -+ *addr address to read -+ *cnt amount to read -+ *pdata pointer to put data, this should be a "DMA:able scratch buffer"! -+ * -+ * Return: -+ *0 Success -+ *others Fail -+ */ -+s32 sd_read(struct intf_hdl * pintfhdl, u32 addr, u32 cnt, void *pdata) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ struct sdio_func *func; -+ bool claim_needed; -+ s32 err = -EPERM; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (padapter->bSurpriseRemoved) { -+ /* DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__); */ -+ return err; -+ } -+ func = psdio->func; -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ err = _sd_read(pintfhdl, addr, cnt, pdata); -+ if (claim_needed) -+ sdio_release_host(func); -+ return err; -+} -+ -+/* -+ * Use CMD53 to write data to SDIO device. -+ * This function MUST be called after sdio_claim_host() or -+ * in SDIO ISR(host had been claimed). -+ * -+ * Parameters: -+ *psdio pointer of SDIO_DATA -+ *addr address to write -+ *cnt amount to write -+ *pdata data pointer, this should be a "DMA:able scratch buffer"! -+ * -+ * Return: -+ *0 Success -+ *others Fail -+ */ -+s32 _sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ struct sdio_func *func; -+ u32 size; -+ s32 err =-EPERM; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (padapter->bSurpriseRemoved) { -+ /* DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__); */ -+ return err; -+ } -+ -+ func = psdio->func; -+/* size = sdio_align_size(func, cnt); */ -+ -+ if (unlikely((cnt == 1) || (cnt ==2))) -+ { -+ int i; -+ u8 *pbuf = (u8 *)pdata; -+ -+ for (i = 0; i < cnt; i++) -+ { -+ sdio_writeb(func, *(pbuf+i), addr+i, &err); -+ if (err) { -+ DBG_871X(KERN_ERR "%s: FAIL!(%d) addr = 0x%05x val = 0x%02x\n", __func__, err, addr, *(pbuf+i)); -+ break; -+ } -+ } -+ -+ return err; -+ } -+ -+ size = cnt; -+ err = sdio_memcpy_toio(func, addr, pdata, size); -+ if (err) { -+ DBG_871X(KERN_ERR "%s: FAIL(%d)! ADDR =%#x Size =%d(%d)\n", __func__, err, addr, cnt, size); -+ } -+ return err; -+} -+ -+/* -+ * Use CMD53 to write data to SDIO device. -+ * -+ * Parameters: -+ * psdio pointer of SDIO_DATA -+ * addr address to write -+ * cnt amount to write -+ * pdata data pointer, this should be a "DMA:able scratch buffer"! -+ * -+ * Return: -+ * 0 Success -+ * others Fail -+ */ -+s32 sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata) -+{ -+ struct adapter *padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ struct sdio_func *func; -+ bool claim_needed; -+ s32 err =-EPERM; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (padapter->bSurpriseRemoved) { -+ /* DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__); */ -+ return err; -+ } -+ -+ func = psdio->func; -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ err = _sd_write(pintfhdl, addr, cnt, pdata); -+ if (claim_needed) -+ sdio_release_host(func); -+ return err; -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/os_dep/wifi_regd.c linux/3rdparty/rtl8723bs/os_dep/wifi_regd.c ---- linux.old/3rdparty/rtl8723bs/os_dep/wifi_regd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/os_dep/wifi_regd.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,164 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2009-2010 Realtek Corporation. -+ * -+ *****************************************************************************/ -+ -+#include -+#include -+ -+#include -+ -+/* -+ * REG_RULE(freq start, freq end, bandwidth, max gain, eirp, reg_flags) -+ */ -+ -+/* -+ *Only these channels all allow active -+ *scan on all world regulatory domains -+ */ -+ -+/* 2G chan 01 - chan 11 */ -+#define RTW_2GHZ_CH01_11 \ -+ REG_RULE(2412-10, 2462+10, 40, 0, 20, 0) -+ -+/* -+ *We enable active scan on these a case -+ *by case basis by regulatory domain -+ */ -+ -+/* 2G chan 12 - chan 13, PASSIV SCAN */ -+#define RTW_2GHZ_CH12_13 \ -+ REG_RULE(2467-10, 2472+10, 40, 0, 20, \ -+ NL80211_RRF_PASSIVE_SCAN) -+ -+/* 2G chan 14, PASSIVS SCAN, NO OFDM (B only) */ -+#define RTW_2GHZ_CH14 \ -+ REG_RULE(2484-10, 2484+10, 40, 0, 20, \ -+ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_OFDM) -+ -+static const struct ieee80211_regdomain rtw_regdom_rd = { -+ .n_reg_rules = 3, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ RTW_2GHZ_CH12_13, -+ } -+}; -+ -+static int rtw_ieee80211_channel_to_frequency(int chan, int band) -+{ -+ /* see 802.11 17.3.8.3.2 and Annex J -+ * there are overlapping channel numbers in 5GHz and 2GHz bands */ -+ -+ /* IEEE80211_BAND_2GHZ */ -+ if (chan == 14) -+ return 2484; -+ else if (chan < 14) -+ return 2407 + chan * 5; -+ else -+ return 0; /* not supported */ -+} -+ -+static void _rtw_reg_apply_flags(struct wiphy *wiphy) -+{ -+ struct adapter *padapter = wiphy_to_adapter(wiphy); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ RT_CHANNEL_INFO *channel_set = pmlmeext->channel_set; -+ u8 max_chan_nums = pmlmeext->max_chan_nums; -+ -+ struct ieee80211_supported_band *sband; -+ struct ieee80211_channel *ch; -+ unsigned int i, j; -+ u16 channel; -+ u32 freq; -+ -+ /* all channels disable */ -+ for (i = 0; i < IEEE80211_NUM_BANDS; i++) { -+ sband = wiphy->bands[i]; -+ -+ if (sband) { -+ for (j = 0; j < sband->n_channels; j++) { -+ ch = &sband->channels[j]; -+ -+ if (ch) -+ ch->flags = IEEE80211_CHAN_DISABLED; -+ } -+ } -+ } -+ -+ /* channels apply by channel plans. */ -+ for (i = 0; i < max_chan_nums; i++) { -+ channel = channel_set[i].ChannelNum; -+ freq = -+ rtw_ieee80211_channel_to_frequency(channel, -+ IEEE80211_BAND_2GHZ); -+ -+ ch = ieee80211_get_channel(wiphy, freq); -+ if (ch) { -+ if (channel_set[i].ScanType == SCAN_PASSIVE) { -+ ch->flags = IEEE80211_CHAN_NO_IR; -+ } -+ else { -+ ch->flags = 0; -+ } -+ } -+ } -+} -+ -+static int _rtw_reg_notifier_apply(struct wiphy *wiphy, -+ struct regulatory_request *request, -+ struct rtw_regulatory *reg) -+{ -+ /* Hard code flags */ -+ _rtw_reg_apply_flags(wiphy); -+ return 0; -+} -+ -+static const struct ieee80211_regdomain *_rtw_regdomain_select(struct -+ rtw_regulatory -+ *reg) -+{ -+ return &rtw_regdom_rd; -+} -+ -+static void _rtw_regd_init_wiphy(struct rtw_regulatory *reg, -+ struct wiphy *wiphy, -+ void (*reg_notifier) (struct wiphy * wiphy, -+ struct regulatory_request * -+ request)) -+{ -+ const struct ieee80211_regdomain *regd; -+ -+ wiphy->reg_notifier = reg_notifier; -+ -+ wiphy->regulatory_flags |= REGULATORY_CUSTOM_REG; -+ wiphy->regulatory_flags &= ~REGULATORY_STRICT_REG; -+ wiphy->regulatory_flags &= ~REGULATORY_DISABLE_BEACON_HINTS; -+ -+ regd = _rtw_regdomain_select(reg); -+ wiphy_apply_custom_regulatory(wiphy, regd); -+ -+ /* Hard code flags */ -+ _rtw_reg_apply_flags(wiphy); -+} -+ -+int rtw_regd_init(struct adapter *padapter, -+ void (*reg_notifier) (struct wiphy * wiphy, -+ struct regulatory_request *request)) -+{ -+ /* struct registry_priv *registrypriv = &padapter->registrypriv; */ -+ struct wiphy *wiphy = padapter->rtw_wdev->wiphy; -+ _rtw_regd_init_wiphy(NULL, wiphy, reg_notifier); -+ -+ return 0; -+} -+ -+void rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) -+{ -+ struct rtw_regulatory *reg = NULL; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ _rtw_reg_notifier_apply(wiphy, request, reg); -+} -diff -Nurp linux.old/3rdparty/rtl8723bs/os_dep/xmit_linux.c linux/3rdparty/rtl8723bs/os_dep/xmit_linux.c ---- linux.old/3rdparty/rtl8723bs/os_dep/xmit_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8723bs/os_dep/xmit_linux.c 2017-01-20 22:14:45.000000000 +0200 -@@ -0,0 +1,298 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _XMIT_OSDEP_C_ -+ -+#include -+#include -+ -+ -+uint rtw_remainder_len(struct pkt_file *pfile) -+{ -+ return (pfile->buf_len - ((SIZE_PTR)(pfile->cur_addr) - (SIZE_PTR)(pfile->buf_start))); -+} -+ -+void _rtw_open_pktfile (_pkt *pktptr, struct pkt_file *pfile) -+{ -+ pfile->pkt = pktptr; -+ pfile->cur_addr = pfile->buf_start = pktptr->data; -+ pfile->pkt_len = pfile->buf_len = pktptr->len; -+ -+ pfile->cur_buffer = pfile->buf_start ; -+} -+ -+uint _rtw_pktfile_read (struct pkt_file *pfile, u8 *rmem, uint rlen) -+{ -+ uint len = 0; -+ -+ len = rtw_remainder_len(pfile); -+ len = (rlen > len)? len: rlen; -+ -+ if (rmem) -+ skb_copy_bits(pfile->pkt, pfile->buf_len-pfile->pkt_len, rmem, len); -+ -+ pfile->cur_addr += len; -+ pfile->pkt_len -= len; -+ return len; -+} -+ -+sint rtw_endofpktfile(struct pkt_file *pfile) -+{ -+ if (pfile->pkt_len == 0) -+ return true; -+ return false; -+} -+ -+void rtw_set_tx_chksum_offload(_pkt *pkt, struct pkt_attrib *pattrib) -+{ -+ -+} -+ -+int rtw_os_xmit_resource_alloc(struct adapter *padapter, struct xmit_buf *pxmitbuf, u32 alloc_sz, u8 flag) -+{ -+ if (alloc_sz > 0) { -+ pxmitbuf->pallocated_buf = rtw_zmalloc(alloc_sz); -+ if (pxmitbuf->pallocated_buf == NULL) -+ { -+ return _FAIL; -+ } -+ -+ pxmitbuf->pbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitbuf->pallocated_buf), XMITBUF_ALIGN_SZ); -+ } -+ -+ return _SUCCESS; -+} -+ -+void rtw_os_xmit_resource_free(struct adapter *padapter, struct xmit_buf *pxmitbuf, u32 free_sz, u8 flag) -+{ -+ if (free_sz > 0) { -+ if (pxmitbuf->pallocated_buf) -+ kfree(pxmitbuf->pallocated_buf); -+ } -+} -+ -+#define WMM_XMIT_THRESHOLD (NR_XMITFRAME*2/5) -+ -+void rtw_os_pkt_complete(struct adapter *padapter, _pkt *pkt) -+{ -+ u16 queue; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ queue = skb_get_queue_mapping(pkt); -+ if (padapter->registrypriv.wifi_spec) { -+ if (__netif_subqueue_stopped(padapter->pnetdev, queue) && -+ (pxmitpriv->hwxmits[queue].accnt < WMM_XMIT_THRESHOLD)) -+ { -+ netif_wake_subqueue(padapter->pnetdev, queue); -+ } -+ } else { -+ if (__netif_subqueue_stopped(padapter->pnetdev, queue)) -+ netif_wake_subqueue(padapter->pnetdev, queue); -+ } -+ -+ dev_kfree_skb_any(pkt); -+} -+ -+void rtw_os_xmit_complete(struct adapter *padapter, struct xmit_frame *pxframe) -+{ -+ if (pxframe->pkt) -+ rtw_os_pkt_complete(padapter, pxframe->pkt); -+ -+ pxframe->pkt = NULL; -+} -+ -+void rtw_os_xmit_schedule(struct adapter *padapter) -+{ -+ struct adapter *pri_adapter = padapter; -+ -+ if (!padapter) -+ return; -+ -+ if (!list_empty(&padapter->xmitpriv.pending_xmitbuf_queue.queue)) -+ up(&pri_adapter->xmitpriv.xmit_sema); -+} -+ -+static void rtw_check_xmit_resource(struct adapter *padapter, _pkt *pkt) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ u16 queue; -+ -+ queue = skb_get_queue_mapping(pkt); -+ if (padapter->registrypriv.wifi_spec) { -+ /* No free space for Tx, tx_worker is too slow */ -+ if (pxmitpriv->hwxmits[queue].accnt > WMM_XMIT_THRESHOLD) { -+ /* DBG_871X("%s(): stop netif_subqueue[%d]\n", __func__, queue); */ -+ netif_stop_subqueue(padapter->pnetdev, queue); -+ } -+ } else { -+ if (pxmitpriv->free_xmitframe_cnt<=4) { -+ if (!netif_tx_queue_stopped(netdev_get_tx_queue(padapter->pnetdev, queue))) -+ netif_stop_subqueue(padapter->pnetdev, queue); -+ } -+ } -+} -+ -+static int rtw_mlcst2unicst(struct adapter *padapter, struct sk_buff *skb) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct list_head *phead, *plist; -+ struct sk_buff *newskb; -+ struct sta_info *psta = NULL; -+ u8 chk_alive_num = 0; -+ char chk_alive_list[NUM_STA]; -+ u8 bc_addr[6]={0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 null_addr[6]={0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ -+ int i; -+ s32 res; -+ -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u); -+ -+ spin_lock_bh(&pstapriv->asoc_list_lock); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* free sta asoc_queue */ -+ while (phead != plist) { -+ int stainfo_offset; -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) { -+ chk_alive_list[chk_alive_num++] = stainfo_offset; -+ } -+ } -+ spin_unlock_bh(&pstapriv->asoc_list_lock); -+ -+ for (i = 0; i < chk_alive_num; i++) { -+ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); -+ if (!(psta->state &_FW_LINKED)) -+ { -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_ignore_fw_linked); -+ continue; -+ } -+ -+ /* avoid come from STA1 and send back STA1 */ -+ if (!memcmp(psta->hwaddr, &skb->data[6], 6) -+ || !memcmp(psta->hwaddr, null_addr, 6) -+ || !memcmp(psta->hwaddr, bc_addr, 6) -+ ) -+ { -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_ignore_self); -+ continue; -+ } -+ -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry); -+ -+ newskb = rtw_skb_copy(skb); -+ -+ if (newskb) { -+ memcpy(newskb->data, psta->hwaddr, 6); -+ res = rtw_xmit(padapter, &newskb); -+ if (res < 0) { -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry_err_xmit); -+ DBG_871X("%s()-%d: rtw_xmit() return error!\n", __func__, __LINE__); -+ pxmitpriv->tx_drop++; -+ dev_kfree_skb_any(newskb); -+ } -+ } else { -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry_err_skb); -+ DBG_871X("%s-%d: rtw_skb_copy() failed!\n", __func__, __LINE__); -+ pxmitpriv->tx_drop++; -+ /* dev_kfree_skb_any(skb); */ -+ return false; /* Caller shall tx this multicast frame via normal way. */ -+ } -+ } -+ -+ dev_kfree_skb_any(skb); -+ return true; -+} -+ -+int _rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) -+{ -+ struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ s32 res = 0; -+ -+ DBG_COUNTER(padapter->tx_logs.os_tx); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("+xmit_enry\n")); -+ -+ if (rtw_if_up(padapter) == false) { -+ DBG_COUNTER(padapter->tx_logs.os_tx_err_up); -+ RT_TRACE(_module_xmit_osdep_c_, _drv_err_, ("rtw_xmit_entry: rtw_if_up fail\n")); -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s if_up fail\n", __func__); -+ #endif -+ goto drop_packet; -+ } -+ -+ rtw_check_xmit_resource(padapter, pkt); -+ -+ if (!rtw_mc2u_disable -+ && check_fwstate(pmlmepriv, WIFI_AP_STATE) == true -+ && (IP_MCAST_MAC(pkt->data) -+ || ICMPV6_MCAST_MAC(pkt->data) -+ #ifdef CONFIG_TX_BCAST2UNI -+ || is_broadcast_mac_addr(pkt->data) -+ #endif -+ ) -+ && (padapter->registrypriv.wifi_spec == 0) -+ ) -+ { -+ if (pxmitpriv->free_xmitframe_cnt > (NR_XMITFRAME/4)) { -+ res = rtw_mlcst2unicst(padapter, pkt); -+ if (res == true) { -+ goto exit; -+ } -+ } else { -+ /* DBG_871X("Stop M2U(%d, %d)! ", pxmitpriv->free_xmitframe_cnt, pxmitpriv->free_xmitbuf_cnt); */ -+ /* DBG_871X("!m2u); */ -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_stop); -+ } -+ } -+ -+ res = rtw_xmit(padapter, &pkt); -+ if (res < 0) { -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s rtw_xmit fail\n", __func__); -+ #endif -+ goto drop_packet; -+ } -+ -+ RT_TRACE(_module_xmit_osdep_c_, _drv_info_, ("rtw_xmit_entry: tx_pkts =%d\n", (u32)pxmitpriv->tx_pkts)); -+ goto exit; -+ -+drop_packet: -+ pxmitpriv->tx_drop++; -+ dev_kfree_skb_any(pkt); -+ RT_TRACE(_module_xmit_osdep_c_, _drv_notice_, ("rtw_xmit_entry: drop, tx_drop =%d\n", (u32)pxmitpriv->tx_drop)); -+ -+exit: -+ return 0; -+} -+ -+int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) -+{ -+ int ret = 0; -+ -+ if (pkt) { -+ rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, pkt->truesize); -+ ret = _rtw_xmit_entry(pkt, pnetdev); -+ } -+ -+ return ret; -+} diff --git a/kernel/tools/cpupowertools/files/patches/mageia/3rd-rtl8723de.patch b/kernel/tools/cpupowertools/files/patches/mageia/3rd-rtl8723de.patch new file mode 100644 index 00000000..ac35efe4 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/3rd-rtl8723de.patch @@ -0,0 +1,411237 @@ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/efuse/rtw_efuse.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/efuse/rtw_efuse.c +--- linux-4.14.18/3rdparty/rtl8723de/core/efuse/rtw_efuse.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/efuse/rtw_efuse.c 2018-02-11 21:44:27.134145888 +0200 +@@ -0,0 +1,2612 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_EFUSE_C_ ++ ++#include ++#include ++ ++#include "../hal/efuse/efuse_mask.h" ++ ++/*------------------------Define local variable------------------------------*/ ++u8 fakeEfuseBank = {0}; ++u32 fakeEfuseUsedBytes = {0}; ++u8 fakeEfuseContent[EFUSE_MAX_HW_SIZE] = {0}; ++u8 fakeEfuseInitMap[EFUSE_MAX_MAP_LEN] = {0}; ++u8 fakeEfuseModifiedMap[EFUSE_MAX_MAP_LEN] = {0}; ++ ++u32 BTEfuseUsedBytes = {0}; ++u8 BTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; ++u8 BTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN] = {0}; ++u8 BTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN] = {0}; ++ ++u32 fakeBTEfuseUsedBytes = {0}; ++u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; ++u8 fakeBTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN] = {0}; ++u8 fakeBTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN] = {0}; ++ ++u8 maskfileBuffer[64]; ++/*------------------------Define local variable------------------------------*/ ++BOOLEAN rtw_file_efuse_IsMasked(PADAPTER pAdapter, u16 Offset) ++{ ++ int r = Offset / 16; ++ int c = (Offset % 16) / 2; ++ int result = 0; ++ ++ if (pAdapter->registrypriv.boffefusemask) ++ return FALSE; ++ ++ if (c < 4) /* Upper double word */ ++ result = (maskfileBuffer[r] & (0x10 << c)); ++ else ++ result = (maskfileBuffer[r] & (0x01 << (c - 4))); ++ ++ return (result > 0) ? 0 : 1; ++} ++ ++BOOLEAN efuse_IsMasked(PADAPTER pAdapter, u16 Offset) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ ++ if (pAdapter->registrypriv.boffefusemask) ++ return FALSE; ++ ++#if DEV_BUS_TYPE == RT_USB_INTERFACE ++#if defined(CONFIG_RTL8188E) ++ if (IS_HARDWARE_TYPE_8188E(pAdapter)) ++ return (IS_MASKED(8188E, _MUSB, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8812A) ++ if (IS_HARDWARE_TYPE_8812(pAdapter)) ++ return (IS_MASKED(8812A, _MUSB, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8821A) ++#if 0 ++ if (IS_HARDWARE_TYPE_8811AU(pAdapter)) ++ return (IS_MASKED(8811A, _MUSB, Offset)) ? TRUE : FALSE; ++#endif ++ if (IS_HARDWARE_TYPE_8821(pAdapter)) ++ return (IS_MASKED(8821A, _MUSB, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8192E) ++ if (IS_HARDWARE_TYPE_8192E(pAdapter)) ++ return (IS_MASKED(8192E, _MUSB, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8723B) ++ if (IS_HARDWARE_TYPE_8723B(pAdapter)) ++ return (IS_MASKED(8723B, _MUSB, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8703B) ++ if (IS_HARDWARE_TYPE_8703B(pAdapter)) ++ return (IS_MASKED(8703B, _MUSB, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8814A) ++ if (IS_HARDWARE_TYPE_8814A(pAdapter)) ++ return (IS_MASKED(8814A, _MUSB, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8188F) ++ if (IS_HARDWARE_TYPE_8188F(pAdapter)) ++ return (IS_MASKED(8188F, _MUSB, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8822B) ++ if (IS_HARDWARE_TYPE_8822B(pAdapter)) ++ return (IS_MASKED(8822B, _MUSB, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8723D) ++ if (IS_HARDWARE_TYPE_8723D(pAdapter)) ++ return (IS_MASKED(8723D, _MUSB, Offset)) ? TRUE : FALSE; ++#endif ++ ++ /*#if defined(CONFIG_RTL8821C) ++ if (IS_HARDWARE_TYPE_8821C(pAdapter)) ++ return (IS_MASKED(8821C,_MUSB,Offset)) ? TRUE : FALSE; ++ #endif*/ ++ ++#elif DEV_BUS_TYPE == RT_PCI_INTERFACE ++#if defined(CONFIG_RTL8188E) ++ if (IS_HARDWARE_TYPE_8188E(pAdapter)) ++ return (IS_MASKED(8188E, _MPCIE, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8192E) ++ if (IS_HARDWARE_TYPE_8192E(pAdapter)) ++ return (IS_MASKED(8192E, _MPCIE, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8812A) ++ if (IS_HARDWARE_TYPE_8812(pAdapter)) ++ return (IS_MASKED(8812A, _MPCIE, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8821A) ++ if (IS_HARDWARE_TYPE_8821(pAdapter)) ++ return (IS_MASKED(8821A, _MPCIE, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8723B) ++ if (IS_HARDWARE_TYPE_8723B(pAdapter)) ++ return (IS_MASKED(8723B, _MPCIE, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8814A) ++ if (IS_HARDWARE_TYPE_8814A(pAdapter)) ++ return (IS_MASKED(8814A, _MPCIE, Offset)) ? TRUE : FALSE; ++#endif ++#if defined(CONFIG_RTL8822B) ++ if (IS_HARDWARE_TYPE_8822B(pAdapter)) ++ return (IS_MASKED(8822B, _MPCIE, Offset)) ? TRUE : FALSE; ++#endif ++ ++#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE ++#ifdef CONFIG_RTL8188E_SDIO ++ if (IS_HARDWARE_TYPE_8188E(pAdapter)) ++ return (IS_MASKED(8188E, _MSDIO, Offset)) ? TRUE : FALSE; ++#endif ++#ifdef CONFIG_RTL8188F_SDIO ++ if (IS_HARDWARE_TYPE_8188F(pAdapter)) ++ return (IS_MASKED(8188F, _MSDIO, Offset)) ? TRUE : FALSE; ++#endif ++#endif ++ ++ return FALSE; ++} ++ ++void rtw_efuse_mask_array(PADAPTER pAdapter, u8 *pArray) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ ++#if DEV_BUS_TYPE == RT_USB_INTERFACE ++#if defined(CONFIG_RTL8188E) ++ if (IS_HARDWARE_TYPE_8188E(pAdapter)) ++ GET_MASK_ARRAY(8188E, _MUSB, pArray); ++#endif ++#if defined(CONFIG_RTL8812A) ++ if (IS_HARDWARE_TYPE_8812(pAdapter)) ++ GET_MASK_ARRAY(8812A, _MUSB, pArray); ++#endif ++#if defined(CONFIG_RTL8821A) ++ if (IS_HARDWARE_TYPE_8821(pAdapter)) ++ GET_MASK_ARRAY(8821A, _MUSB, pArray); ++#endif ++#if defined(CONFIG_RTL8192E) ++ if (IS_HARDWARE_TYPE_8192E(pAdapter)) ++ GET_MASK_ARRAY(8192E, _MUSB, pArray); ++#endif ++#if defined(CONFIG_RTL8723B) ++ if (IS_HARDWARE_TYPE_8723B(pAdapter)) ++ GET_MASK_ARRAY(8723B, _MUSB, pArray); ++#endif ++#if defined(CONFIG_RTL8703B) ++ if (IS_HARDWARE_TYPE_8703B(pAdapter)) ++ GET_MASK_ARRAY(8703B, _MUSB, pArray); ++#endif ++#if defined(CONFIG_RTL8188F) ++ if (IS_HARDWARE_TYPE_8188F(pAdapter)) ++ GET_MASK_ARRAY(8188F, _MUSB, pArray); ++#endif ++#if defined(CONFIG_RTL8814A) ++ if (IS_HARDWARE_TYPE_8814A(pAdapter)) ++ GET_MASK_ARRAY(8814A, _MUSB, pArray); ++#endif ++#if defined(CONFIG_RTL8822B) ++ if (IS_HARDWARE_TYPE_8822B(pAdapter)) ++ GET_MASK_ARRAY(8822B, _MUSB, pArray); ++#endif ++ /*#if defined(CONFIG_RTL8821C) ++ if (IS_HARDWARE_TYPE_8821C(pAdapter)) ++ GET_MASK_ARRAY(8821C,_MUSB,pArray); ++ #endif*/ ++#elif DEV_BUS_TYPE == RT_PCI_INTERFACE ++#if defined(CONFIG_RTL8188E) ++ if (IS_HARDWARE_TYPE_8188E(pAdapter)) ++ GET_MASK_ARRAY(8188E, _MPCIE, pArray); ++#endif ++#if defined(CONFIG_RTL8192E) ++ if (IS_HARDWARE_TYPE_8192E(pAdapter)) ++ GET_MASK_ARRAY(8192E, _MPCIE, pArray); ++#endif ++#if defined(CONFIG_RTL8812A) ++ if (IS_HARDWARE_TYPE_8812(pAdapter)) ++ GET_MASK_ARRAY(8812A, _MPCIE, pArray); ++#endif ++#if defined(CONFIG_RTL8821A) ++ if (IS_HARDWARE_TYPE_8821(pAdapter)) ++ GET_MASK_ARRAY(8821A, _MPCIE, pArray); ++#endif ++#if defined(CONFIG_RTL8723B) ++ if (IS_HARDWARE_TYPE_8723B(pAdapter)) ++ GET_MASK_ARRAY(8723B, _MPCIE, pArray); ++#endif ++#if defined(CONFIG_RTL8814A) ++ if (IS_HARDWARE_TYPE_8814A(pAdapter)) ++ GET_MASK_ARRAY(8814A, _MPCIE, pArray); ++#endif ++#if defined(CONFIG_RTL8822B) ++ if (IS_HARDWARE_TYPE_8822B(pAdapter)) ++ GET_MASK_ARRAY(8822B, _MPCIE, pArray); ++#endif ++#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE ++#if defined(CONFIG_RTL8188E) ++ if (IS_HARDWARE_TYPE_8188E(pAdapter)) ++ GET_MASK_ARRAY(8188E, _MSDIO, pArray); ++#endif ++#if defined(CONFIG_RTL8188F) ++ if (IS_HARDWARE_TYPE_8188F(pAdapter)) ++ GET_MASK_ARRAY(8188F, _MSDIO, pArray); ++#endif ++#endif /*#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE*/ ++} ++ ++u16 rtw_get_efuse_mask_arraylen(PADAPTER pAdapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++#if DEV_BUS_TYPE == RT_USB_INTERFACE ++#if defined(CONFIG_RTL8188E) ++ if (IS_HARDWARE_TYPE_8188E(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8188E, _MUSB); ++#endif ++#if defined(CONFIG_RTL8812A) ++ if (IS_HARDWARE_TYPE_8812(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8812A, _MUSB); ++#endif ++#if defined(CONFIG_RTL8821A) ++ if (IS_HARDWARE_TYPE_8821(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8821A, _MUSB); ++#endif ++#if defined(CONFIG_RTL8192E) ++ if (IS_HARDWARE_TYPE_8192E(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8192E, _MUSB); ++#endif ++#if defined(CONFIG_RTL8723B) ++ if (IS_HARDWARE_TYPE_8723B(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8723B, _MUSB); ++#endif ++#if defined(CONFIG_RTL8703B) ++ if (IS_HARDWARE_TYPE_8703B(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8703B, _MUSB); ++#endif ++#if defined(CONFIG_RTL8188F) ++ if (IS_HARDWARE_TYPE_8188F(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8188F, _MUSB); ++#endif ++#if defined(CONFIG_RTL8814A) ++ if (IS_HARDWARE_TYPE_8814A(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8814A, _MUSB); ++#endif ++#if defined(CONFIG_RTL8822B) ++ if (IS_HARDWARE_TYPE_8822B(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8822B, _MUSB); ++#endif ++ /*#if defined(CONFIG_RTL8821C) ++ if (IS_HARDWARE_TYPE_8821C(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8821C,_MUSB); ++ #endif*/ ++#elif DEV_BUS_TYPE == RT_PCI_INTERFACE ++#if defined(CONFIG_RTL8188E) ++ if (IS_HARDWARE_TYPE_8188E(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8188E, _MPCIE); ++#endif ++#if defined(CONFIG_RTL8192E) ++ if (IS_HARDWARE_TYPE_8192E(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8192E, _MPCIE); ++#endif ++#if defined(CONFIG_RTL8812A) ++ if (IS_HARDWARE_TYPE_8812(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8812A, _MPCIE); ++#endif ++#if defined(CONFIG_RTL8821A) ++ if (IS_HARDWARE_TYPE_8821(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8821A, _MPCIE); ++#endif ++#if defined(CONFIG_RTL8723B) ++ if (IS_HARDWARE_TYPE_8723B(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8723B, _MPCIE); ++#endif ++#if defined(CONFIG_RTL8814A) ++ if (IS_HARDWARE_TYPE_8814A(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8814A, _MPCIE); ++#endif ++#if defined(CONFIG_RTL8822B) ++ if (IS_HARDWARE_TYPE_8822B(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8822B, _MPCIE); ++#endif ++#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE ++#if defined(CONFIG_RTL8188E) ++ if (IS_HARDWARE_TYPE_8188E(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8188E, _MSDIO); ++#endif ++#if defined(CONFIG_RTL8188F) ++ if (IS_HARDWARE_TYPE_8188F(pAdapter)) ++ return GET_MASK_ARRAY_LEN(8188F, _MSDIO); ++#endif ++ ++#endif ++ return 0; ++} ++ ++ ++#ifdef RTW_HALMAC ++#include "../../hal/hal_halmac.h" ++ ++void Efuse_PowerSwitch(PADAPTER adapter, u8 write, u8 pwrstate) ++{ ++} ++ ++void BTEfuse_PowerSwitch(PADAPTER adapter, u8 write, u8 pwrstate) ++{ ++} ++ ++u8 efuse_GetCurrentSize(PADAPTER adapter, u16 *size) ++{ ++ *size = 0; ++ ++ return _FAIL; ++} ++ ++u16 efuse_GetMaxSize(PADAPTER adapter) ++{ ++ struct dvobj_priv *d; ++ u32 size = 0; ++ int err; ++ ++ d = adapter_to_dvobj(adapter); ++ err = rtw_halmac_get_physical_efuse_size(d, &size); ++ if (err) ++ return 0; ++ ++ return size; ++} ++ ++u8 efuse_bt_GetCurrentSize(PADAPTER adapter, u16 *size) ++{ ++ *size = 0; ++ ++ return _FAIL; ++} ++ ++u16 efuse_bt_GetMaxSize(PADAPTER adapter) ++{ ++ return 0; ++} ++ ++void EFUSE_GetEfuseDefinition(PADAPTER adapter, u8 efusetype, u8 type, void *out, BOOLEAN test) ++{ ++ struct dvobj_priv *d; ++ u32 v32 = 0; ++ ++ ++ d = adapter_to_dvobj(adapter); ++ ++ if (adapter->HalFunc.EFUSEGetEfuseDefinition) { ++ adapter->HalFunc.EFUSEGetEfuseDefinition(adapter, efusetype, type, out, test); ++ return; ++ } ++ ++ if (EFUSE_WIFI == efusetype) { ++ switch (type) { ++ case TYPE_EFUSE_MAP_LEN: ++ rtw_halmac_get_logical_efuse_size(d, &v32); ++ *(u16 *)out = (u16)v32; ++ return; ++ } ++ } ++} ++ ++/* ++ * read/write raw efuse data ++ */ ++u8 rtw_efuse_access(PADAPTER adapter, u8 write, u16 addr, u16 cnts, u8 *data) ++{ ++ struct dvobj_priv *d; ++ u8 *efuse = NULL; ++ u32 size, i; ++ int err; ++ ++ ++ d = adapter_to_dvobj(adapter); ++ err = rtw_halmac_get_physical_efuse_size(d, &size); ++ if (err) ++ size = EFUSE_MAX_SIZE; ++ ++ if ((addr + cnts) > size) ++ return _FAIL; ++ ++ if (_TRUE == write) { ++ err = rtw_halmac_write_physical_efuse(d, addr, cnts, data); ++ if (err) ++ return _FAIL; ++ } else { ++ if (cnts > 16) ++ efuse = rtw_zmalloc(size); ++ ++ if (efuse) { ++ err = rtw_halmac_read_physical_efuse_map(d, efuse, size); ++ if (err) { ++ rtw_mfree(efuse, size); ++ return _FAIL; ++ } ++ ++ _rtw_memcpy(data, efuse + addr, cnts); ++ rtw_mfree(efuse, size); ++ } else { ++ err = rtw_halmac_read_physical_efuse(d, addr, cnts, data); ++ if (err) ++ return _FAIL; ++ } ++ } ++ ++ return _SUCCESS; ++} ++ ++static inline void dump_buf(u8 *buf, u32 len) ++{ ++ u32 i; ++ ++ RTW_INFO("-----------------Len %d----------------\n", len); ++ for (i = 0; i < len; i++) ++ printk("%2.2x-", *(buf + i)); ++ printk("\n"); ++} ++ ++/* ++ * read/write raw efuse data ++ */ ++u8 rtw_efuse_bt_access(PADAPTER adapter, u8 write, u16 addr, u16 cnts, u8 *data) ++{ ++ struct dvobj_priv *d; ++ u8 *efuse = NULL; ++ u32 size, i; ++ int err = _FAIL; ++ ++ ++ d = adapter_to_dvobj(adapter); ++ ++ size = EFUSE_BT_REAL_BANK_CONTENT_LEN; ++ ++ if ((addr + cnts) > size) ++ return _FAIL; ++ ++ if (_TRUE == write) { ++ err = rtw_halmac_write_bt_physical_efuse(d, addr, cnts, data); ++ if (err == -1) { ++ RTW_ERR("%s: rtw_halmac_write_bt_physical_efuse fail!\n", __FUNCTION__); ++ return _FAIL; ++ } ++ RTW_INFO("%s: rtw_halmac_write_bt_physical_efuse OK! data 0x%x\n", __FUNCTION__, *data); ++ } else { ++ efuse = rtw_zmalloc(size); ++ ++ if (efuse) { ++ err = rtw_halmac_read_bt_physical_efuse_map(d, efuse, size); ++ ++ if (err == -1) { ++ RTW_ERR("%s: rtw_halmac_read_bt_physical_efuse_map fail!\n", __FUNCTION__); ++ rtw_mfree(efuse, size); ++ return _FAIL; ++ } ++ dump_buf(efuse + addr, cnts); ++ ++ RTW_INFO("%s: rtw_halmac_read_bt_physical_efuse_map ok!\n", __FUNCTION__); ++ _rtw_memcpy(data, efuse + addr, cnts); ++ rtw_mfree(efuse, size); ++ } ++ } ++ ++ return _SUCCESS; ++} ++ ++u8 rtw_efuse_map_read(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) ++{ ++ struct dvobj_priv *d; ++ u8 *efuse = NULL; ++ u32 size, i; ++ int err; ++ ++ ++ d = adapter_to_dvobj(adapter); ++ err = rtw_halmac_get_logical_efuse_size(d, &size); ++ if (err) ++ return _FAIL; ++ ++ /* size error handle */ ++ if ((addr + cnts) > size) { ++ if (addr < size) ++ cnts = size - addr; ++ else ++ return _FAIL; ++ } ++ ++ if (cnts > 16) ++ efuse = rtw_zmalloc(size); ++ ++ if (efuse) { ++ err = rtw_halmac_read_logical_efuse_map(d, efuse, size); ++ if (err) { ++ rtw_mfree(efuse, size); ++ return _FAIL; ++ } ++ ++ _rtw_memcpy(data, efuse + addr, cnts); ++ rtw_mfree(efuse, size); ++ } else { ++ err = rtw_halmac_read_logical_efuse(d, addr, cnts, data); ++ if (err) ++ return _FAIL; ++ } ++ ++ return _SUCCESS; ++} ++ ++u8 rtw_efuse_mask_map_read(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) ++{ ++ return rtw_efuse_map_read(adapter, addr, cnts, data); ++} ++ ++u8 rtw_efuse_map_write(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) ++{ ++ struct dvobj_priv *d; ++ u8 *efuse = NULL; ++ u32 size, i; ++ int err; ++ u8 mask_buf[64] = ""; ++ u16 mask_len = sizeof(u8) * rtw_get_efuse_mask_arraylen(adapter); ++ ++ d = adapter_to_dvobj(adapter); ++ err = rtw_halmac_get_logical_efuse_size(d, &size); ++ if (err) ++ return _FAIL; ++ ++ if ((addr + cnts) > size) ++ return _FAIL; ++ ++ efuse = rtw_zmalloc(size); ++ if (!efuse) ++ return _FAIL; ++ ++ err = rtw_halmac_read_logical_efuse_map(d, efuse, size); ++ if (err) { ++ rtw_mfree(efuse, size); ++ return _FAIL; ++ } ++ ++ _rtw_memcpy(efuse + addr, data, cnts); ++ ++ if (adapter->registrypriv.boffefusemask == 0) { ++ RTW_INFO("Use mask Array Len: %d\n", mask_len); ++ ++ if (mask_len != 0) { ++ if (adapter->registrypriv.bFileMaskEfuse == _TRUE) ++ _rtw_memcpy(mask_buf, maskfileBuffer, mask_len); ++ else ++ rtw_efuse_mask_array(adapter, mask_buf); ++ ++ err = rtw_halmac_write_logical_efuse_map(d, efuse, size, mask_buf, mask_len); ++ } else ++ err = rtw_halmac_write_logical_efuse_map(d, efuse, size, NULL, 0); ++ } else { ++ _rtw_memset(mask_buf, 0xFF, sizeof(mask_buf)); ++ RTW_INFO("Efuse mask off\n"); ++ err = rtw_halmac_write_logical_efuse_map(d, efuse, size, mask_buf, size/16); ++ } ++ ++ if (err) { ++ rtw_mfree(efuse, size); ++ return _FAIL; ++ } ++ ++ rtw_mfree(efuse, size); ++ ++ return _SUCCESS; ++} ++ ++int Efuse_PgPacketRead(PADAPTER adapter, u8 offset, u8 *data, BOOLEAN test) ++{ ++ return _FALSE; ++} ++ ++int Efuse_PgPacketWrite(PADAPTER adapter, u8 offset, u8 word_en, u8 *data, BOOLEAN test) ++{ ++ return _FALSE; ++} ++ ++u8 rtw_BT_efuse_map_read(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) ++{ ++ hal_ReadEFuse_BT_logic_map(adapter,addr, cnts, data); ++ ++ return _SUCCESS; ++} ++ ++u8 rtw_BT_efuse_map_write(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) ++{ ++#define RT_ASSERT_RET(expr) \ ++ if (!(expr)) { \ ++ printk("Assertion failed! %s at ......\n", #expr); \ ++ printk(" ......%s,%s, line=%d\n",__FILE__, __FUNCTION__, __LINE__); \ ++ return _FAIL; \ ++ } ++ ++ u8 offset, word_en; ++ u8 *map; ++ u8 newdata[PGPKT_DATA_SIZE]; ++ s32 i = 0, j = 0, idx; ++ u8 ret = _SUCCESS; ++ u16 mapLen = 1024; ++ ++ if ((addr + cnts) > mapLen) ++ return _FAIL; ++ ++ RT_ASSERT_RET(PGPKT_DATA_SIZE == 8); /* have to be 8 byte alignment */ ++ RT_ASSERT_RET((mapLen & 0x7) == 0); /* have to be PGPKT_DATA_SIZE alignment for memcpy */ ++ ++ map = rtw_zmalloc(mapLen); ++ if (map == NULL) ++ return _FAIL; ++ ++ ret = rtw_BT_efuse_map_read(adapter, 0, mapLen, map); ++ if (ret == _FAIL) ++ goto exit; ++ RTW_INFO("OFFSET\tVALUE(hex)\n"); ++ for (i = 0; i < 1024; i += 16) { /* set 512 because the iwpriv's extra size have limit 0x7FF */ ++ RTW_INFO("0x%03x\t", i); ++ for (j = 0; j < 8; j++) ++ RTW_INFO("%02X ", map[i + j]); ++ RTW_INFO("\t"); ++ for (; j < 16; j++) ++ RTW_INFO("%02X ", map[i + j]); ++ RTW_INFO("\n"); ++ } ++ RTW_INFO("\n"); ++ ++ idx = 0; ++ offset = (addr >> 3); ++ while (idx < cnts) { ++ word_en = 0xF; ++ j = (addr + idx) & 0x7; ++ _rtw_memcpy(newdata, &map[offset << 3], PGPKT_DATA_SIZE); ++ for (i = j; i < PGPKT_DATA_SIZE && idx < cnts; i++, idx++) { ++ if (data[idx] != map[addr + idx]) { ++ word_en &= ~BIT(i >> 1); ++ newdata[i] = data[idx]; ++ } ++ } ++ ++ if (word_en != 0xF) { ++ RTW_INFO("offset=%x\n", offset); ++ RTW_INFO("word_en=%x\n", word_en); ++ RTW_INFO("%s: data=", __FUNCTION__); ++ for (i = 0; i < PGPKT_DATA_SIZE; i++) ++ RTW_INFO("0x%02X ", newdata[i]); ++ RTW_INFO("\n"); ++ ret = EfusePgPacketWrite_BT(adapter, offset, word_en, newdata, _FALSE); ++ if (ret == _FAIL) ++ break; ++ } ++ offset++; ++ } ++exit: ++ rtw_mfree(map, mapLen); ++ return _SUCCESS; ++} ++ ++VOID hal_ReadEFuse_BT_logic_map( ++ PADAPTER padapter, ++ u16 _offset, ++ u16 _size_byte, ++ u8 *pbuf ++) ++{ ++ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; ++ ++ u8 *efuseTbl, *phyefuse; ++ u8 bank; ++ u16 eFuse_Addr = 0; ++ u8 efuseHeader, efuseExtHdr, efuseData; ++ u8 offset, wden; ++ u16 i, total, used; ++ u8 efuse_usage; ++ ++ ++ /* */ ++ /* Do NOT excess total size of EFuse table. Added by Roger, 2008.11.10. */ ++ /* */ ++ if ((_offset + _size_byte) > EFUSE_BT_MAP_LEN) { ++ RTW_INFO("%s: Invalid offset(%#x) with read bytes(%#x)!!\n", __FUNCTION__, _offset, _size_byte); ++ return; ++ } ++ ++ efuseTbl = rtw_malloc(EFUSE_BT_MAP_LEN); ++ phyefuse = rtw_malloc(EFUSE_BT_REAL_BANK_CONTENT_LEN); ++ if (efuseTbl == NULL || phyefuse == NULL) { ++ RTW_INFO("%s: efuseTbl or phyefuse malloc fail!\n", __FUNCTION__); ++ goto exit; ++ } ++ ++ /* 0xff will be efuse default value instead of 0x00. */ ++ _rtw_memset(efuseTbl, 0xFF, EFUSE_BT_MAP_LEN); ++ _rtw_memset(phyefuse, 0xFF, EFUSE_BT_REAL_BANK_CONTENT_LEN); ++ ++ if(rtw_efuse_bt_access(padapter, _FALSE, 0, EFUSE_BT_REAL_BANK_CONTENT_LEN, phyefuse)) ++ dump_buf(phyefuse, EFUSE_BT_REAL_BANK_CONTENT_LEN); ++ ++ total = BANK_NUM; ++ for (bank = 1; bank <= total; bank++) { /* 8723d Max bake 0~2 */ ++ eFuse_Addr = 0; ++ ++ while (AVAILABLE_EFUSE_ADDR(eFuse_Addr)) { ++ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); */ ++ efuseHeader = phyefuse[eFuse_Addr++]; ++ ++ if (efuseHeader == 0xFF) ++ break; ++ RTW_INFO("%s: efuse[%#X]=0x%02x (header)\n", __FUNCTION__, (((bank - 1) * EFUSE_BT_REAL_CONTENT_LEN) + eFuse_Addr - 1), efuseHeader); ++ ++ /* Check PG header for section num. */ ++ if (EXT_HEADER(efuseHeader)) { /* extended header */ ++ offset = GET_HDR_OFFSET_2_0(efuseHeader); ++ RTW_INFO("%s: extended header offset_2_0=0x%X\n", __FUNCTION__, offset); ++ ++ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); */ ++ efuseExtHdr = phyefuse[eFuse_Addr++]; ++ ++ RTW_INFO("%s: efuse[%#X]=0x%02x (ext header)\n", __FUNCTION__, (((bank - 1) * EFUSE_BT_REAL_CONTENT_LEN) + eFuse_Addr - 1), efuseExtHdr); ++ if (ALL_WORDS_DISABLED(efuseExtHdr)) ++ continue; ++ ++ offset |= ((efuseExtHdr & 0xF0) >> 1); ++ wden = (efuseExtHdr & 0x0F); ++ } else { ++ offset = ((efuseHeader >> 4) & 0x0f); ++ wden = (efuseHeader & 0x0f); ++ } ++ ++ if (offset < EFUSE_BT_MAX_SECTION) { ++ u16 addr; ++ ++ /* Get word enable value from PG header */ ++ RTW_INFO("%s: Offset=%d Worden=%#X\n", __FUNCTION__, offset, wden); ++ ++ addr = offset * PGPKT_DATA_SIZE; ++ for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { ++ /* Check word enable condition in the section */ ++ if (!(wden & (0x01 << i))) { ++ efuseData = 0; ++ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseData, bPseudoTest); */ ++ efuseData = phyefuse[eFuse_Addr++]; ++ ++ RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, eFuse_Addr - 1, efuseData); ++ efuseTbl[addr] = efuseData; ++ ++ efuseData = 0; ++ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseData, bPseudoTest); */ ++ efuseData = phyefuse[eFuse_Addr++]; ++ ++ RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, eFuse_Addr - 1, efuseData); ++ efuseTbl[addr + 1] = efuseData; ++ } ++ addr += 2; ++ } ++ } else { ++ RTW_INFO("%s: offset(%d) is illegal!!\n", __FUNCTION__, offset); ++ eFuse_Addr += Efuse_CalculateWordCnts(wden) * 2; ++ } ++ } ++ ++ if ((eFuse_Addr - 1) < total) { ++ RTW_INFO("%s: bank(%d) data end at %#x\n", __FUNCTION__, bank, eFuse_Addr - 1); ++ break; ++ } ++ } ++ ++ /* switch bank back to bank 0 for later BT and wifi use. */ ++ //hal_EfuseSwitchToBank(padapter, 0, bPseudoTest); ++ ++ /* Copy from Efuse map to output pointer memory!!! */ ++ for (i = 0; i < _size_byte; i++) ++ pbuf[i] = efuseTbl[_offset + i]; ++ /* Calculate Efuse utilization */ ++ total = EFUSE_BT_REAL_BANK_CONTENT_LEN; ++ ++ used = eFuse_Addr - 1; ++ ++ if (total) ++ efuse_usage = (u8)((used * 100) / total); ++ else ++ efuse_usage = 100; ++ ++ fakeBTEfuseUsedBytes = used; ++ ++exit: ++ if (efuseTbl) ++ rtw_mfree(efuseTbl, EFUSE_BT_MAP_LEN); ++ if (phyefuse) ++ rtw_mfree(phyefuse, EFUSE_BT_REAL_BANK_CONTENT_LEN); ++} ++ ++ ++static u8 hal_EfusePartialWriteCheck( ++ PADAPTER padapter, ++ u8 efuseType, ++ u16 *pAddr, ++ PPGPKT_STRUCT pTargetPkt, ++ u8 bPseudoTest) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; ++ u8 bRet = _FALSE; ++ u16 startAddr = 0, efuse_max_available_len = EFUSE_BT_REAL_BANK_CONTENT_LEN, efuse_max = EFUSE_BT_REAL_BANK_CONTENT_LEN; ++ u8 efuse_data = 0; ++ ++ startAddr = (u16)fakeBTEfuseUsedBytes; ++ ++ startAddr %= efuse_max; ++ RTW_INFO("%s: startAddr=%#X\n", __FUNCTION__, startAddr); ++ ++ while (1) { ++ if (startAddr >= efuse_max_available_len) { ++ bRet = _FALSE; ++ RTW_INFO("%s: startAddr(%d) >= efuse_max_available_len(%d)\n", ++ __FUNCTION__, startAddr, efuse_max_available_len); ++ break; ++ } ++ if (rtw_efuse_bt_access(padapter, _FALSE, startAddr, 1, &efuse_data)&& (efuse_data != 0xFF)) { ++ bRet = _FALSE; ++ RTW_INFO("%s: Something Wrong! last bytes(%#X=0x%02X) is not 0xFF\n", ++ __FUNCTION__, startAddr, efuse_data); ++ break; ++ } else { ++ /* not used header, 0xff */ ++ *pAddr = startAddr; ++ /* RTW_INFO("%s: Started from unused header offset=%d\n", __FUNCTION__, startAddr)); */ ++ bRet = _TRUE; ++ break; ++ } ++ } ++ ++ return bRet; ++} ++ ++ ++static u8 hal_EfusePgPacketWrite2ByteHeader( ++ PADAPTER padapter, ++ u8 efuseType, ++ u16 *pAddr, ++ PPGPKT_STRUCT pTargetPkt, ++ u8 bPseudoTest) ++{ ++ u16 efuse_addr, efuse_max_available_len = EFUSE_BT_REAL_BANK_CONTENT_LEN; ++ u8 pg_header = 0, tmp_header = 0; ++ u8 repeatcnt = 0; ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ efuse_addr = *pAddr; ++ if (efuse_addr >= efuse_max_available_len) { ++ RTW_INFO("%s: addr(%d) over avaliable(%d)!!\n", __FUNCTION__, efuse_addr, efuse_max_available_len); ++ return _FALSE; ++ } ++ ++ pg_header = ((pTargetPkt->offset & 0x07) << 5) | 0x0F; ++ /* RTW_INFO("%s: pg_header=0x%x\n", __FUNCTION__, pg_header); */ ++ ++ do { ++ ++ rtw_efuse_bt_access(padapter, _TRUE, efuse_addr, 1, &pg_header); ++ rtw_efuse_bt_access(padapter, _FALSE, efuse_addr, 1, &tmp_header); ++ ++ if (tmp_header != 0xFF) ++ break; ++ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { ++ RTW_INFO("%s: Repeat over limit for pg_header!!\n", __FUNCTION__); ++ return _FALSE; ++ } ++ } while (1); ++ ++ if (tmp_header != pg_header) { ++ RTW_ERR("%s: PG Header Fail!!(pg=0x%02X read=0x%02X)\n", __FUNCTION__, pg_header, tmp_header); ++ return _FALSE; ++ } ++ ++ /* to write ext_header */ ++ efuse_addr++; ++ pg_header = ((pTargetPkt->offset & 0x78) << 1) | pTargetPkt->word_en; ++ ++ do { ++ rtw_efuse_bt_access(padapter, _TRUE, efuse_addr, 1, &pg_header); ++ rtw_efuse_bt_access(padapter, _FALSE, efuse_addr, 1, &tmp_header); ++ ++ if (tmp_header != 0xFF) ++ break; ++ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { ++ RTW_INFO("%s: Repeat over limit for ext_header!!\n", __FUNCTION__); ++ return _FALSE; ++ } ++ } while (1); ++ ++ if (tmp_header != pg_header) { /* offset PG fail */ ++ RTW_ERR("%s: PG EXT Header Fail!!(pg=0x%02X read=0x%02X)\n", __FUNCTION__, pg_header, tmp_header); ++ return _FALSE; ++ } ++ ++ *pAddr = efuse_addr; ++ ++ return _TRUE; ++} ++ ++ ++static u8 hal_EfusePgPacketWrite1ByteHeader( ++ PADAPTER pAdapter, ++ u8 efuseType, ++ u16 *pAddr, ++ PPGPKT_STRUCT pTargetPkt, ++ u8 bPseudoTest) ++{ ++ u8 bRet = _FALSE; ++ u8 pg_header = 0, tmp_header = 0; ++ u16 efuse_addr = *pAddr; ++ u8 repeatcnt = 0; ++ ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ pg_header = ((pTargetPkt->offset << 4) & 0xf0) | pTargetPkt->word_en; ++ ++ do { ++ rtw_efuse_bt_access(pAdapter, _TRUE, efuse_addr, 1, &pg_header); ++ rtw_efuse_bt_access(pAdapter, _FALSE, efuse_addr, 1, &tmp_header); ++ ++ if (tmp_header != 0xFF) ++ break; ++ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { ++ RTW_INFO("%s: Repeat over limit for pg_header!!\n", __FUNCTION__); ++ return _FALSE; ++ } ++ } while (1); ++ ++ if (tmp_header != pg_header) { ++ RTW_ERR("%s: PG Header Fail!!(pg=0x%02X read=0x%02X)\n", __FUNCTION__, pg_header, tmp_header); ++ return _FALSE; ++ } ++ ++ *pAddr = efuse_addr; ++ ++ return _TRUE; ++} ++ ++static u8 hal_EfusePgPacketWriteHeader( ++ PADAPTER padapter, ++ u8 efuseType, ++ u16 *pAddr, ++ PPGPKT_STRUCT pTargetPkt, ++ u8 bPseudoTest) ++{ ++ u8 bRet = _FALSE; ++ ++ if (pTargetPkt->offset >= EFUSE_MAX_SECTION_BASE) ++ bRet = hal_EfusePgPacketWrite2ByteHeader(padapter, efuseType, pAddr, pTargetPkt, bPseudoTest); ++ else ++ bRet = hal_EfusePgPacketWrite1ByteHeader(padapter, efuseType, pAddr, pTargetPkt, bPseudoTest); ++ ++ return bRet; ++} ++ ++ ++static u8 ++Hal_EfuseWordEnableDataWrite( ++ PADAPTER padapter, ++ u16 efuse_addr, ++ u8 word_en, ++ u8 *data, ++ u8 bPseudoTest) ++{ ++ u16 tmpaddr = 0; ++ u16 start_addr = efuse_addr; ++ u8 badworden = 0x0F; ++ u8 tmpdata[PGPKT_DATA_SIZE]; ++ ++ ++ /* RTW_INFO("%s: efuse_addr=%#x word_en=%#x\n", __FUNCTION__, efuse_addr, word_en); */ ++ _rtw_memset(tmpdata, 0xFF, PGPKT_DATA_SIZE); ++ ++ if (!(word_en & BIT(0))) { ++ tmpaddr = start_addr; ++ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[0]); ++ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[1]); ++ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr, 1, &tmpdata[0]); ++ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr + 1, 1, &tmpdata[1]); ++ if ((data[0] != tmpdata[0]) || (data[1] != tmpdata[1])) ++ badworden &= (~BIT(0)); ++ } ++ if (!(word_en & BIT(1))) { ++ tmpaddr = start_addr; ++ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[2]); ++ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[3]); ++ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr, 1, &tmpdata[2]); ++ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr + 1, 1, &tmpdata[3]); ++ if ((data[2] != tmpdata[2]) || (data[3] != tmpdata[3])) ++ badworden &= (~BIT(1)); ++ } ++ if (!(word_en & BIT(2))) { ++ tmpaddr = start_addr; ++ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[4]); ++ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[5]); ++ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr, 1, &tmpdata[4]); ++ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr + 1, 1, &tmpdata[5]); ++ if ((data[4] != tmpdata[4]) || (data[5] != tmpdata[5])) ++ badworden &= (~BIT(2)); ++ } ++ if (!(word_en & BIT(3))) { ++ tmpaddr = start_addr; ++ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[6]); ++ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[7]); ++ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr, 1, &tmpdata[6]); ++ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr + 1, 1, &tmpdata[7]); ++ ++ if ((data[6] != tmpdata[6]) || (data[7] != tmpdata[7])) ++ badworden &= (~BIT(3)); ++ } ++ ++ return badworden; ++} ++ ++static void ++hal_EfuseConstructPGPkt( ++ u8 offset, ++ u8 word_en, ++ u8 *pData, ++ PPGPKT_STRUCT pTargetPkt) ++{ ++ _rtw_memset(pTargetPkt->data, 0xFF, PGPKT_DATA_SIZE); ++ pTargetPkt->offset = offset; ++ pTargetPkt->word_en = word_en; ++ efuse_WordEnableDataRead(word_en, pData, pTargetPkt->data); ++ pTargetPkt->word_cnts = Efuse_CalculateWordCnts(pTargetPkt->word_en); ++} ++ ++static u8 ++hal_EfusePgPacketWriteData( ++ PADAPTER pAdapter, ++ u8 efuseType, ++ u16 *pAddr, ++ PPGPKT_STRUCT pTargetPkt, ++ u8 bPseudoTest) ++{ ++ u16 efuse_addr; ++ u8 badworden; ++ ++ efuse_addr = *pAddr; ++ badworden = Hal_EfuseWordEnableDataWrite(pAdapter, efuse_addr + 1, pTargetPkt->word_en, pTargetPkt->data, bPseudoTest); ++ if (badworden != 0x0F) { ++ RTW_INFO("%s: Fail!!\n", __FUNCTION__); ++ return _FALSE; ++ } ++ ++ /* RTW_INFO("%s: ok\n", __FUNCTION__); */ ++ return _TRUE; ++} ++ ++u8 EfusePgPacketWrite_BT( ++ PADAPTER pAdapter, ++ u8 offset, ++ u8 word_en, ++ u8 *pData, ++ u8 bPseudoTest) ++{ ++ PGPKT_STRUCT targetPkt; ++ u16 startAddr = 0; ++ u8 efuseType = EFUSE_BT; ++ ++ hal_EfuseConstructPGPkt(offset, word_en, pData, &targetPkt); ++ ++ if (!hal_EfusePartialWriteCheck(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) ++ return _FALSE; ++ ++ if (!hal_EfusePgPacketWriteHeader(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) ++ return _FALSE; ++ ++ if (!hal_EfusePgPacketWriteData(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) ++ return _FALSE; ++ ++ return _TRUE; ++} ++ ++ ++#else /* !RTW_HALMAC */ ++/* ------------------------------------------------------------------------------ */ ++#define REG_EFUSE_CTRL 0x0030 ++#define EFUSE_CTRL REG_EFUSE_CTRL /* E-Fuse Control. */ ++/* ------------------------------------------------------------------------------ */ ++ ++BOOLEAN ++Efuse_Read1ByteFromFakeContent( ++ IN PADAPTER pAdapter, ++ IN u16 Offset, ++ IN OUT u8 *Value); ++BOOLEAN ++Efuse_Read1ByteFromFakeContent( ++ IN PADAPTER pAdapter, ++ IN u16 Offset, ++ IN OUT u8 *Value) ++{ ++ if (Offset >= EFUSE_MAX_HW_SIZE) ++ return _FALSE; ++ /* DbgPrint("Read fake content, offset = %d\n", Offset); */ ++ if (fakeEfuseBank == 0) ++ *Value = fakeEfuseContent[Offset]; ++ else ++ *Value = fakeBTEfuseContent[fakeEfuseBank - 1][Offset]; ++ return _TRUE; ++} ++ ++BOOLEAN ++Efuse_Write1ByteToFakeContent( ++ IN PADAPTER pAdapter, ++ IN u16 Offset, ++ IN u8 Value); ++BOOLEAN ++Efuse_Write1ByteToFakeContent( ++ IN PADAPTER pAdapter, ++ IN u16 Offset, ++ IN u8 Value) ++{ ++ if (Offset >= EFUSE_MAX_HW_SIZE) ++ return _FALSE; ++ if (fakeEfuseBank == 0) ++ fakeEfuseContent[Offset] = Value; ++ else ++ fakeBTEfuseContent[fakeEfuseBank - 1][Offset] = Value; ++ return _TRUE; ++} ++ ++/*----------------------------------------------------------------------------- ++ * Function: Efuse_PowerSwitch ++ * ++ * Overview: When we want to enable write operation, we should change to ++ * pwr on state. When we stop write, we should switch to 500k mode ++ * and disable LDO 2.5V. ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 11/17/2008 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++VOID ++Efuse_PowerSwitch( ++ IN PADAPTER pAdapter, ++ IN u8 bWrite, ++ IN u8 PwrState) ++{ ++ pAdapter->HalFunc.EfusePowerSwitch(pAdapter, bWrite, PwrState); ++} ++ ++VOID ++BTEfuse_PowerSwitch( ++ IN PADAPTER pAdapter, ++ IN u8 bWrite, ++ IN u8 PwrState) ++{ ++ if (pAdapter->HalFunc.BTEfusePowerSwitch) ++ pAdapter->HalFunc.BTEfusePowerSwitch(pAdapter, bWrite, PwrState); ++} ++ ++/*----------------------------------------------------------------------------- ++ * Function: efuse_GetCurrentSize ++ * ++ * Overview: Get current efuse size!!! ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 11/16/2008 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++u16 ++Efuse_GetCurrentSize( ++ IN PADAPTER pAdapter, ++ IN u8 efuseType, ++ IN BOOLEAN bPseudoTest) ++{ ++ u16 ret = 0; ++ ++ ret = pAdapter->HalFunc.EfuseGetCurrentSize(pAdapter, efuseType, bPseudoTest); ++ ++ return ret; ++} ++ ++/* ++ * Description: ++ * Execute E-Fuse read byte operation. ++ * Refered from SD1 Richard. ++ * ++ * Assumption: ++ * 1. Boot from E-Fuse and successfully auto-load. ++ * 2. PASSIVE_LEVEL (USB interface) ++ * ++ * Created by Roger, 2008.10.21. ++ * */ ++VOID ++ReadEFuseByte( ++ PADAPTER Adapter, ++ u16 _offset, ++ u8 *pbuf, ++ IN BOOLEAN bPseudoTest) ++{ ++ u32 value32; ++ u8 readbyte; ++ u16 retry; ++ /* u32 start=rtw_get_current_time(); */ ++ ++ if (bPseudoTest) { ++ Efuse_Read1ByteFromFakeContent(Adapter, _offset, pbuf); ++ return; ++ } ++ if (IS_HARDWARE_TYPE_8723B(Adapter)) { ++ /* <20130121, Kordan> For SMIC S55 EFUSE specificatoin. */ ++ /* 0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) */ ++ PHY_SetMacReg(Adapter, EFUSE_TEST, BIT11, 0); ++ } ++ /* Write Address */ ++ rtw_write8(Adapter, EFUSE_CTRL + 1, (_offset & 0xff)); ++ readbyte = rtw_read8(Adapter, EFUSE_CTRL + 2); ++ rtw_write8(Adapter, EFUSE_CTRL + 2, ((_offset >> 8) & 0x03) | (readbyte & 0xfc)); ++ ++ /* Write bit 32 0 */ ++ readbyte = rtw_read8(Adapter, EFUSE_CTRL + 3); ++ rtw_write8(Adapter, EFUSE_CTRL + 3, (readbyte & 0x7f)); ++ ++ /* Check bit 32 read-ready */ ++ retry = 0; ++ value32 = rtw_read32(Adapter, EFUSE_CTRL); ++ /* while(!(((value32 >> 24) & 0xff) & 0x80) && (retry<10)) */ ++ while (!(((value32 >> 24) & 0xff) & 0x80) && (retry < 10000)) { ++ value32 = rtw_read32(Adapter, EFUSE_CTRL); ++ retry++; ++ } ++ ++ /* 20100205 Joseph: Add delay suggested by SD1 Victor. */ ++ /* This fix the problem that Efuse read error in high temperature condition. */ ++ /* Designer says that there shall be some delay after ready bit is set, or the */ ++ /* result will always stay on last data we read. */ ++ rtw_udelay_os(50); ++ value32 = rtw_read32(Adapter, EFUSE_CTRL); ++ ++ *pbuf = (u8)(value32 & 0xff); ++ /* RTW_INFO("ReadEFuseByte _offset:%08u, in %d ms\n",_offset ,rtw_get_passing_time_ms(start)); */ ++ ++} ++ ++/* ++ * Description: ++ * 1. Execute E-Fuse read byte operation according as map offset and ++ * save to E-Fuse table. ++ * 2. Refered from SD1 Richard. ++ * ++ * Assumption: ++ * 1. Boot from E-Fuse and successfully auto-load. ++ * 2. PASSIVE_LEVEL (USB interface) ++ * ++ * Created by Roger, 2008.10.21. ++ * ++ * 2008/12/12 MH 1. Reorganize code flow and reserve bytes. and add description. ++ * 2. Add efuse utilization collect. ++ * 2008/12/22 MH Read Efuse must check if we write section 1 data again!!! Sec1 ++ * write addr must be after sec5. ++ * */ ++ ++VOID ++efuse_ReadEFuse( ++ PADAPTER Adapter, ++ u8 efuseType, ++ u16 _offset, ++ u16 _size_byte, ++ u8 *pbuf, ++ IN BOOLEAN bPseudoTest ++); ++VOID ++efuse_ReadEFuse( ++ PADAPTER Adapter, ++ u8 efuseType, ++ u16 _offset, ++ u16 _size_byte, ++ u8 *pbuf, ++ IN BOOLEAN bPseudoTest ++) ++{ ++ Adapter->HalFunc.ReadEFuse(Adapter, efuseType, _offset, _size_byte, pbuf, bPseudoTest); ++} ++ ++VOID ++EFUSE_GetEfuseDefinition( ++ IN PADAPTER pAdapter, ++ IN u8 efuseType, ++ IN u8 type, ++ OUT void *pOut, ++ IN BOOLEAN bPseudoTest ++) ++{ ++ pAdapter->HalFunc.EFUSEGetEfuseDefinition(pAdapter, efuseType, type, pOut, bPseudoTest); ++} ++ ++ ++/* 11/16/2008 MH Read one byte from real Efuse. */ ++u8 ++efuse_OneByteRead( ++ IN PADAPTER pAdapter, ++ IN u16 addr, ++ IN u8 *data, ++ IN BOOLEAN bPseudoTest) ++{ ++ u32 tmpidx = 0; ++ u8 bResult; ++ u8 readbyte; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ /* RTW_INFO("===> EFUSE_OneByteRead(), addr = %x\n", addr); */ ++ /* RTW_INFO("===> EFUSE_OneByteRead() start, 0x34 = 0x%X\n", rtw_read32(pAdapter, EFUSE_TEST)); */ ++ ++ if (bPseudoTest) { ++ bResult = Efuse_Read1ByteFromFakeContent(pAdapter, addr, data); ++ return bResult; ++ } ++ ++ if (IS_HARDWARE_TYPE_8723B(pAdapter) || ++ (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->VersionID))) || ++ (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->VersionID)) ++ ) { ++ /* <20130121, Kordan> For SMIC EFUSE specificatoin. */ ++ /* 0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) */ ++ /* PHY_SetMacReg(pAdapter, 0x34, BIT11, 0); */ ++ rtw_write16(pAdapter, 0x34, rtw_read16(pAdapter, 0x34) & (~BIT11)); ++ } ++ ++ /* -----------------e-fuse reg ctrl --------------------------------- */ ++ /* address */ ++ rtw_write8(pAdapter, EFUSE_CTRL + 1, (u8)(addr & 0xff)); ++ rtw_write8(pAdapter, EFUSE_CTRL + 2, ((u8)((addr >> 8) & 0x03)) | ++ (rtw_read8(pAdapter, EFUSE_CTRL + 2) & 0xFC)); ++ ++ /* rtw_write8(pAdapter, EFUSE_CTRL+3, 0x72); */ /* read cmd */ ++ /* Write bit 32 0 */ ++ readbyte = rtw_read8(pAdapter, EFUSE_CTRL + 3); ++ rtw_write8(pAdapter, EFUSE_CTRL + 3, (readbyte & 0x7f)); ++ ++ while (!(0x80 & rtw_read8(pAdapter, EFUSE_CTRL + 3)) && (tmpidx < 1000)) { ++ rtw_mdelay_os(1); ++ tmpidx++; ++ } ++ if (tmpidx < 100) { ++ *data = rtw_read8(pAdapter, EFUSE_CTRL); ++ bResult = _TRUE; ++ } else { ++ *data = 0xff; ++ bResult = _FALSE; ++ RTW_INFO("%s: [ERROR] addr=0x%x bResult=%d time out 1s !!!\n", __FUNCTION__, addr, bResult); ++ RTW_INFO("%s: [ERROR] EFUSE_CTRL =0x%08x !!!\n", __FUNCTION__, rtw_read32(pAdapter, EFUSE_CTRL)); ++ } ++ ++ return bResult; ++} ++ ++/* 11/16/2008 MH Write one byte to reald Efuse. */ ++u8 ++efuse_OneByteWrite( ++ IN PADAPTER pAdapter, ++ IN u16 addr, ++ IN u8 data, ++ IN BOOLEAN bPseudoTest) ++{ ++ u8 tmpidx = 0; ++ u8 bResult = _FALSE; ++ u32 efuseValue = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ /* RTW_INFO("===> EFUSE_OneByteWrite(), addr = %x data=%x\n", addr, data); */ ++ /* RTW_INFO("===> EFUSE_OneByteWrite() start, 0x34 = 0x%X\n", rtw_read32(pAdapter, EFUSE_TEST)); */ ++ ++ if (bPseudoTest) { ++ bResult = Efuse_Write1ByteToFakeContent(pAdapter, addr, data); ++ return bResult; ++ } ++ ++ ++ /* -----------------e-fuse reg ctrl --------------------------------- */ ++ /* address */ ++ ++ ++ efuseValue = rtw_read32(pAdapter, EFUSE_CTRL); ++ efuseValue |= (BIT21 | BIT31); ++ efuseValue &= ~(0x3FFFF); ++ efuseValue |= ((addr << 8 | data) & 0x3FFFF); ++ ++ /* <20130227, Kordan> 8192E MP chip A-cut had better not set 0x34[11] until B-Cut. */ ++ if (IS_HARDWARE_TYPE_8723B(pAdapter) || ++ (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->VersionID))) || ++ (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->VersionID)) ++ ) { ++ /* <20130121, Kordan> For SMIC EFUSE specificatoin. */ ++ /* 0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) */ ++ /* PHY_SetMacReg(pAdapter, 0x34, BIT11, 1); */ ++ rtw_write16(pAdapter, 0x34, rtw_read16(pAdapter, 0x34) | (BIT11)); ++ rtw_write32(pAdapter, EFUSE_CTRL, 0x90600000 | ((addr << 8 | data))); ++ } else ++ rtw_write32(pAdapter, EFUSE_CTRL, efuseValue); ++ ++ while ((0x80 & rtw_read8(pAdapter, EFUSE_CTRL + 3)) && (tmpidx < 100)) { ++ rtw_mdelay_os(1); ++ tmpidx++; ++ } ++ ++ if (tmpidx < 100) ++ bResult = _TRUE; ++ else { ++ bResult = _FALSE; ++ RTW_INFO("%s: [ERROR] addr=0x%x ,efuseValue=0x%x ,bResult=%d time out 1s !!!\n", ++ __FUNCTION__, addr, efuseValue, bResult); ++ RTW_INFO("%s: [ERROR] EFUSE_CTRL =0x%08x !!!\n", __FUNCTION__, rtw_read32(pAdapter, EFUSE_CTRL)); ++ } ++ ++ /* disable Efuse program enable */ ++ if (IS_HARDWARE_TYPE_8723B(pAdapter) || ++ (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->VersionID))) || ++ (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->VersionID)) ++ ) ++ PHY_SetMacReg(pAdapter, EFUSE_TEST, BIT(11), 0); ++ ++ return bResult; ++} ++ ++int ++Efuse_PgPacketRead(IN PADAPTER pAdapter, ++ IN u8 offset, ++ IN u8 *data, ++ IN BOOLEAN bPseudoTest) ++{ ++ int ret = 0; ++ ++ ret = pAdapter->HalFunc.Efuse_PgPacketRead(pAdapter, offset, data, bPseudoTest); ++ ++ return ret; ++} ++ ++int ++Efuse_PgPacketWrite(IN PADAPTER pAdapter, ++ IN u8 offset, ++ IN u8 word_en, ++ IN u8 *data, ++ IN BOOLEAN bPseudoTest) ++{ ++ int ret; ++ ++ ret = pAdapter->HalFunc.Efuse_PgPacketWrite(pAdapter, offset, word_en, data, bPseudoTest); ++ ++ return ret; ++} ++ ++ ++int ++Efuse_PgPacketWrite_BT(IN PADAPTER pAdapter, ++ IN u8 offset, ++ IN u8 word_en, ++ IN u8 *data, ++ IN BOOLEAN bPseudoTest) ++{ ++ int ret; ++ ++ ret = pAdapter->HalFunc.Efuse_PgPacketWrite_BT(pAdapter, offset, word_en, data, bPseudoTest); ++ ++ return ret; ++} ++ ++ ++u8 ++Efuse_WordEnableDataWrite(IN PADAPTER pAdapter, ++ IN u16 efuse_addr, ++ IN u8 word_en, ++ IN u8 *data, ++ IN BOOLEAN bPseudoTest) ++{ ++ u8 ret = 0; ++ ++ ret = pAdapter->HalFunc.Efuse_WordEnableDataWrite(pAdapter, efuse_addr, word_en, data, bPseudoTest); ++ ++ return ret; ++} ++ ++static u8 efuse_read8(PADAPTER padapter, u16 address, u8 *value) ++{ ++ return efuse_OneByteRead(padapter, address, value, _FALSE); ++} ++ ++static u8 efuse_write8(PADAPTER padapter, u16 address, u8 *value) ++{ ++ return efuse_OneByteWrite(padapter, address, *value, _FALSE); ++} ++ ++/* ++ * read/wirte raw efuse data ++ */ ++u8 rtw_efuse_access(PADAPTER padapter, u8 bWrite, u16 start_addr, u16 cnts, u8 *data) ++{ ++ int i = 0; ++ u16 real_content_len = 0, max_available_size = 0; ++ u8 res = _FAIL ; ++ u8(*rw8)(PADAPTER, u16, u8 *); ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN, (PVOID)&real_content_len, _FALSE); ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); ++ ++ if (start_addr > real_content_len) ++ return _FAIL; ++ ++ if (_TRUE == bWrite) { ++ if ((start_addr + cnts) > max_available_size) ++ return _FAIL; ++ rw8 = &efuse_write8; ++ } else ++ rw8 = &efuse_read8; ++ ++ Efuse_PowerSwitch(padapter, bWrite, _TRUE); ++ ++ /* e-fuse one byte read / write */ ++ for (i = 0; i < cnts; i++) { ++ if (start_addr >= real_content_len) { ++ res = _FAIL; ++ break; ++ } ++ ++ res = rw8(padapter, start_addr++, data++); ++ if (_FAIL == res) ++ break; ++ } ++ ++ Efuse_PowerSwitch(padapter, bWrite, _FALSE); ++ ++ return res; ++} ++/* ------------------------------------------------------------------------------ */ ++u16 efuse_GetMaxSize(PADAPTER padapter) ++{ ++ u16 max_size; ++ ++ max_size = 0; ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI , TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_size, _FALSE); ++ return max_size; ++} ++/* ------------------------------------------------------------------------------ */ ++u8 efuse_GetCurrentSize(PADAPTER padapter, u16 *size) ++{ ++ Efuse_PowerSwitch(padapter, _FALSE, _TRUE); ++ *size = Efuse_GetCurrentSize(padapter, EFUSE_WIFI, _FALSE); ++ Efuse_PowerSwitch(padapter, _FALSE, _FALSE); ++ ++ return _SUCCESS; ++} ++/* ------------------------------------------------------------------------------ */ ++u16 efuse_bt_GetMaxSize(PADAPTER padapter) ++{ ++ u16 max_size; ++ ++ max_size = 0; ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT , TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_size, _FALSE); ++ return max_size; ++} ++ ++u8 efuse_bt_GetCurrentSize(PADAPTER padapter, u16 *size) ++{ ++ Efuse_PowerSwitch(padapter, _FALSE, _TRUE); ++ *size = Efuse_GetCurrentSize(padapter, EFUSE_BT, _FALSE); ++ Efuse_PowerSwitch(padapter, _FALSE, _FALSE); ++ ++ return _SUCCESS; ++} ++ ++u8 rtw_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) ++{ ++ u16 mapLen = 0; ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); ++ ++ if ((addr + cnts) > mapLen) ++ return _FAIL; ++ ++ Efuse_PowerSwitch(padapter, _FALSE, _TRUE); ++ ++ efuse_ReadEFuse(padapter, EFUSE_WIFI, addr, cnts, data, _FALSE); ++ ++ Efuse_PowerSwitch(padapter, _FALSE, _FALSE); ++ ++ return _SUCCESS; ++} ++ ++u8 rtw_BT_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) ++{ ++ u16 mapLen = 0; ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); ++ ++ if ((addr + cnts) > mapLen) ++ return _FAIL; ++ ++ Efuse_PowerSwitch(padapter, _FALSE, _TRUE); ++ ++ efuse_ReadEFuse(padapter, EFUSE_BT, addr, cnts, data, _FALSE); ++ ++ Efuse_PowerSwitch(padapter, _FALSE, _FALSE); ++ ++ return _SUCCESS; ++} ++ ++/* ------------------------------------------------------------------------------ */ ++u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) ++{ ++#define RT_ASSERT_RET(expr) \ ++ if (!(expr)) { \ ++ printk("Assertion failed! %s at ......\n", #expr); \ ++ printk(" ......%s,%s, line=%d\n",__FILE__, __FUNCTION__, __LINE__); \ ++ return _FAIL; \ ++ } ++ ++ u8 offset, word_en; ++ u8 *map; ++ u8 newdata[PGPKT_DATA_SIZE]; ++ s32 i, j, idx, chk_total_byte; ++ u8 ret = _SUCCESS; ++ u16 mapLen = 0, startAddr = 0, efuse_max_available_len = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &efuse_max_available_len, _FALSE); ++ ++ if ((addr + cnts) > mapLen) ++ return _FAIL; ++ ++ RT_ASSERT_RET(PGPKT_DATA_SIZE == 8); /* have to be 8 byte alignment */ ++ RT_ASSERT_RET((mapLen & 0x7) == 0); /* have to be PGPKT_DATA_SIZE alignment for memcpy */ ++ ++ map = rtw_zmalloc(mapLen); ++ if (map == NULL) ++ return _FAIL; ++ ++ _rtw_memset(map, 0xFF, mapLen); ++ ++ ret = rtw_efuse_map_read(padapter, 0, mapLen, map); ++ if (ret == _FAIL) ++ goto exit; ++ ++ if (padapter->registrypriv.boffefusemask == 0) { ++ for (i = 0; i < cnts; i++) { ++ if (padapter->registrypriv.bFileMaskEfuse == _TRUE) { ++ if (rtw_file_efuse_IsMasked(padapter, addr + i)) /*use file efuse mask. */ ++ data[i] = map[addr + i]; ++ } else { ++ if (efuse_IsMasked(padapter, addr + i)) ++ data[i] = map[addr + i]; ++ } ++ RTW_INFO("%s , data[%d] = %x, map[addr+i]= %x\n", __func__, i, data[i], map[addr + i]); ++ } ++ } ++ Efuse_PowerSwitch(padapter, _TRUE, _TRUE); ++ ++ chk_total_byte = 0; ++ idx = 0; ++ offset = (addr >> 3); ++ ++ while (idx < cnts) { ++ word_en = 0xF; ++ j = (addr + idx) & 0x7; ++ for (i = j; i < PGPKT_DATA_SIZE && idx < cnts; i++, idx++) { ++ if (data[idx] != map[addr + idx]) ++ word_en &= ~BIT(i >> 1); ++ } ++ ++ if (word_en != 0xF) { ++ chk_total_byte += Efuse_CalculateWordCnts(word_en) * 2; ++ ++ if (offset >= EFUSE_MAX_SECTION_BASE) /* Over EFUSE_MAX_SECTION 16 for 2 ByteHeader */ ++ chk_total_byte += 2; ++ else ++ chk_total_byte += 1; ++ } ++ ++ offset++; ++ } ++ ++ RTW_INFO("Total PG bytes Count = %d\n", chk_total_byte); ++ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&startAddr); ++ ++ if (startAddr == 0) { ++ startAddr = Efuse_GetCurrentSize(padapter, EFUSE_WIFI, _FALSE); ++ RTW_INFO("%s: Efuse_GetCurrentSize startAddr=%#X\n", __func__, startAddr); ++ } ++ RTW_DBG("%s: startAddr=%#X\n", __func__, startAddr); ++ ++ if ((startAddr + chk_total_byte) >= efuse_max_available_len) { ++ RTW_INFO("%s: startAddr(0x%X) + PG data len %d >= efuse_max_available_len(0x%X)\n", ++ __func__, startAddr, chk_total_byte, efuse_max_available_len); ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ ++ idx = 0; ++ offset = (addr >> 3); ++ while (idx < cnts) { ++ word_en = 0xF; ++ j = (addr + idx) & 0x7; ++ _rtw_memcpy(newdata, &map[offset << 3], PGPKT_DATA_SIZE); ++ for (i = j; i < PGPKT_DATA_SIZE && idx < cnts; i++, idx++) { ++ if (data[idx] != map[addr + idx]) { ++ word_en &= ~BIT(i >> 1); ++ newdata[i] = data[idx]; ++#ifdef CONFIG_RTL8723B ++ if (addr + idx == 0x8) { ++ if (IS_C_CUT(pHalData->VersionID) || IS_B_CUT(pHalData->VersionID)) { ++ if (pHalData->adjuseVoltageVal == 6) { ++ newdata[i] = map[addr + idx]; ++ RTW_INFO(" %s ,\n adjuseVoltageVal = %d ,newdata[%d] = %x\n", __func__, pHalData->adjuseVoltageVal, i, newdata[i]); ++ } ++ } ++ } ++#endif ++ } ++ } ++ ++ if (word_en != 0xF) { ++ ret = Efuse_PgPacketWrite(padapter, offset, word_en, newdata, _FALSE); ++ RTW_INFO("offset=%x\n", offset); ++ RTW_INFO("word_en=%x\n", word_en); ++ ++ for (i = 0; i < PGPKT_DATA_SIZE; i++) ++ RTW_INFO("data=%x \t", newdata[i]); ++ if (ret == _FAIL) ++ break; ++ } ++ ++ offset++; ++ } ++ ++ Efuse_PowerSwitch(padapter, _TRUE, _FALSE); ++ ++exit: ++ ++ rtw_mfree(map, mapLen); ++ ++ return ret; ++} ++ ++u8 rtw_efuse_mask_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) ++{ ++ u8 ret = _SUCCESS; ++ u16 mapLen = 0, i = 0; ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); ++ ++ ret = rtw_efuse_map_read(padapter, addr, cnts , data); ++ ++ if (padapter->registrypriv.boffefusemask == 0) { ++ ++ for (i = 0; i < cnts; i++) { ++ if (padapter->registrypriv.bFileMaskEfuse == _TRUE) { ++ if (rtw_file_efuse_IsMasked(padapter, addr + i)) /*use file efuse mask.*/ ++ data[i] = 0xff; ++ } else { ++ /*RTW_INFO(" %s , data[%d] = %x\n", __func__, i, data[i]);*/ ++ if (efuse_IsMasked(padapter, addr + i)) { ++ data[i] = 0xff; ++ /*RTW_INFO(" %s ,mask data[%d] = %x\n", __func__, i, data[i]);*/ ++ } ++ } ++ } ++ ++ } ++ return ret; ++ ++} ++ ++u8 rtw_BT_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) ++{ ++#define RT_ASSERT_RET(expr) \ ++ if (!(expr)) { \ ++ printk("Assertion failed! %s at ......\n", #expr); \ ++ printk(" ......%s,%s, line=%d\n",__FILE__, __FUNCTION__, __LINE__); \ ++ return _FAIL; \ ++ } ++ ++ u8 offset, word_en; ++ u8 *map; ++ u8 newdata[PGPKT_DATA_SIZE]; ++ s32 i = 0, j = 0, idx; ++ u8 ret = _SUCCESS; ++ u16 mapLen = 0; ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); ++ ++ if ((addr + cnts) > mapLen) ++ return _FAIL; ++ ++ RT_ASSERT_RET(PGPKT_DATA_SIZE == 8); /* have to be 8 byte alignment */ ++ RT_ASSERT_RET((mapLen & 0x7) == 0); /* have to be PGPKT_DATA_SIZE alignment for memcpy */ ++ ++ map = rtw_zmalloc(mapLen); ++ if (map == NULL) ++ return _FAIL; ++ ++ ret = rtw_BT_efuse_map_read(padapter, 0, mapLen, map); ++ if (ret == _FAIL) ++ goto exit; ++ RTW_INFO("OFFSET\tVALUE(hex)\n"); ++ for (i = 0; i < 1024; i += 16) { /* set 512 because the iwpriv's extra size have limit 0x7FF */ ++ RTW_INFO("0x%03x\t", i); ++ for (j = 0; j < 8; j++) ++ RTW_INFO("%02X ", map[i + j]); ++ RTW_INFO("\t"); ++ for (; j < 16; j++) ++ RTW_INFO("%02X ", map[i + j]); ++ RTW_INFO("\n"); ++ } ++ RTW_INFO("\n"); ++ Efuse_PowerSwitch(padapter, _TRUE, _TRUE); ++ ++ idx = 0; ++ offset = (addr >> 3); ++ while (idx < cnts) { ++ word_en = 0xF; ++ j = (addr + idx) & 0x7; ++ _rtw_memcpy(newdata, &map[offset << 3], PGPKT_DATA_SIZE); ++ for (i = j; i < PGPKT_DATA_SIZE && idx < cnts; i++, idx++) { ++ if (data[idx] != map[addr + idx]) { ++ word_en &= ~BIT(i >> 1); ++ newdata[i] = data[idx]; ++ } ++ } ++ ++ if (word_en != 0xF) { ++ RTW_INFO("offset=%x\n", offset); ++ RTW_INFO("word_en=%x\n", word_en); ++ RTW_INFO("%s: data=", __FUNCTION__); ++ for (i = 0; i < PGPKT_DATA_SIZE; i++) ++ RTW_INFO("0x%02X ", newdata[i]); ++ RTW_INFO("\n"); ++ ret = Efuse_PgPacketWrite_BT(padapter, offset, word_en, newdata, _FALSE); ++ if (ret == _FAIL) ++ break; ++ } ++ ++ offset++; ++ } ++ ++ Efuse_PowerSwitch(padapter, _TRUE, _FALSE); ++ ++exit: ++ ++ rtw_mfree(map, mapLen); ++ ++ return ret; ++} ++ ++/*----------------------------------------------------------------------------- ++ * Function: Efuse_ReadAllMap ++ * ++ * Overview: Read All Efuse content ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 11/11/2008 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++VOID ++Efuse_ReadAllMap( ++ IN PADAPTER pAdapter, ++ IN u8 efuseType, ++ IN OUT u8 *Efuse, ++ IN BOOLEAN bPseudoTest); ++VOID ++Efuse_ReadAllMap( ++ IN PADAPTER pAdapter, ++ IN u8 efuseType, ++ IN OUT u8 *Efuse, ++ IN BOOLEAN bPseudoTest) ++{ ++ u16 mapLen = 0; ++ ++ Efuse_PowerSwitch(pAdapter, _FALSE, _TRUE); ++ ++ EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, bPseudoTest); ++ ++ efuse_ReadEFuse(pAdapter, efuseType, 0, mapLen, Efuse, bPseudoTest); ++ ++ Efuse_PowerSwitch(pAdapter, _FALSE, _FALSE); ++} ++ ++/*----------------------------------------------------------------------------- ++ * Function: efuse_ShadowRead1Byte ++ * efuse_ShadowRead2Byte ++ * efuse_ShadowRead4Byte ++ * ++ * Overview: Read from efuse init map by one/two/four bytes !!!!! ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 11/12/2008 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++static VOID ++efuse_ShadowRead1Byte( ++ IN PADAPTER pAdapter, ++ IN u16 Offset, ++ IN OUT u8 *Value) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ ++ *Value = pHalData->efuse_eeprom_data[Offset]; ++ ++} /* EFUSE_ShadowRead1Byte */ ++ ++/* ---------------Read Two Bytes */ ++static VOID ++efuse_ShadowRead2Byte( ++ IN PADAPTER pAdapter, ++ IN u16 Offset, ++ IN OUT u16 *Value) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ ++ *Value = pHalData->efuse_eeprom_data[Offset]; ++ *Value |= pHalData->efuse_eeprom_data[Offset + 1] << 8; ++ ++} /* EFUSE_ShadowRead2Byte */ ++ ++/* ---------------Read Four Bytes */ ++static VOID ++efuse_ShadowRead4Byte( ++ IN PADAPTER pAdapter, ++ IN u16 Offset, ++ IN OUT u32 *Value) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ ++ *Value = pHalData->efuse_eeprom_data[Offset]; ++ *Value |= pHalData->efuse_eeprom_data[Offset + 1] << 8; ++ *Value |= pHalData->efuse_eeprom_data[Offset + 2] << 16; ++ *Value |= pHalData->efuse_eeprom_data[Offset + 3] << 24; ++ ++} /* efuse_ShadowRead4Byte */ ++ ++ ++/*----------------------------------------------------------------------------- ++ * Function: efuse_ShadowWrite1Byte ++ * efuse_ShadowWrite2Byte ++ * efuse_ShadowWrite4Byte ++ * ++ * Overview: Write efuse modify map by one/two/four byte. ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 11/12/2008 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++#ifdef PLATFORM ++static VOID ++efuse_ShadowWrite1Byte( ++ IN PADAPTER pAdapter, ++ IN u16 Offset, ++ IN u8 Value); ++#endif /* PLATFORM */ ++static VOID ++efuse_ShadowWrite1Byte( ++ IN PADAPTER pAdapter, ++ IN u16 Offset, ++ IN u8 Value) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ ++ pHalData->efuse_eeprom_data[Offset] = Value; ++ ++} /* efuse_ShadowWrite1Byte */ ++ ++/* ---------------Write Two Bytes */ ++static VOID ++efuse_ShadowWrite2Byte( ++ IN PADAPTER pAdapter, ++ IN u16 Offset, ++ IN u16 Value) ++{ ++ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ ++ ++ pHalData->efuse_eeprom_data[Offset] = Value & 0x00FF; ++ pHalData->efuse_eeprom_data[Offset + 1] = Value >> 8; ++ ++} /* efuse_ShadowWrite1Byte */ ++ ++/* ---------------Write Four Bytes */ ++static VOID ++efuse_ShadowWrite4Byte( ++ IN PADAPTER pAdapter, ++ IN u16 Offset, ++ IN u32 Value) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ ++ pHalData->efuse_eeprom_data[Offset] = (u8)(Value & 0x000000FF); ++ pHalData->efuse_eeprom_data[Offset + 1] = (u8)((Value >> 8) & 0x0000FF); ++ pHalData->efuse_eeprom_data[Offset + 2] = (u8)((Value >> 16) & 0x00FF); ++ pHalData->efuse_eeprom_data[Offset + 3] = (u8)((Value >> 24) & 0xFF); ++ ++} /* efuse_ShadowWrite1Byte */ ++ ++ ++/*----------------------------------------------------------------------------- ++ * Function: EFUSE_ShadowRead ++ * ++ * Overview: Read from efuse init map !!!!! ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 11/12/2008 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++void ++EFUSE_ShadowRead( ++ IN PADAPTER pAdapter, ++ IN u8 Type, ++ IN u16 Offset, ++ IN OUT u32 *Value) ++{ ++ if (Type == 1) ++ efuse_ShadowRead1Byte(pAdapter, Offset, (u8 *)Value); ++ else if (Type == 2) ++ efuse_ShadowRead2Byte(pAdapter, Offset, (u16 *)Value); ++ else if (Type == 4) ++ efuse_ShadowRead4Byte(pAdapter, Offset, (u32 *)Value); ++ ++} /* EFUSE_ShadowRead */ ++ ++/*----------------------------------------------------------------------------- ++ * Function: EFUSE_ShadowWrite ++ * ++ * Overview: Write efuse modify map for later update operation to use!!!!! ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 11/12/2008 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++VOID ++EFUSE_ShadowWrite( ++ IN PADAPTER pAdapter, ++ IN u8 Type, ++ IN u16 Offset, ++ IN OUT u32 Value); ++VOID ++EFUSE_ShadowWrite( ++ IN PADAPTER pAdapter, ++ IN u8 Type, ++ IN u16 Offset, ++ IN OUT u32 Value) ++{ ++#if (MP_DRIVER == 0) ++ return; ++#endif ++ if (pAdapter->registrypriv.mp_mode == 0) ++ return; ++ ++ ++ if (Type == 1) ++ efuse_ShadowWrite1Byte(pAdapter, Offset, (u8)Value); ++ else if (Type == 2) ++ efuse_ShadowWrite2Byte(pAdapter, Offset, (u16)Value); ++ else if (Type == 4) ++ efuse_ShadowWrite4Byte(pAdapter, Offset, (u32)Value); ++ ++} /* EFUSE_ShadowWrite */ ++ ++VOID ++Efuse_InitSomeVar( ++ IN PADAPTER pAdapter ++); ++VOID ++Efuse_InitSomeVar( ++ IN PADAPTER pAdapter ++) ++{ ++ u8 i; ++ ++ _rtw_memset((PVOID)&fakeEfuseContent[0], 0xff, EFUSE_MAX_HW_SIZE); ++ _rtw_memset((PVOID)&fakeEfuseInitMap[0], 0xff, EFUSE_MAX_MAP_LEN); ++ _rtw_memset((PVOID)&fakeEfuseModifiedMap[0], 0xff, EFUSE_MAX_MAP_LEN); ++ ++ for (i = 0; i < EFUSE_MAX_BT_BANK; i++) ++ _rtw_memset((PVOID)&BTEfuseContent[i][0], EFUSE_MAX_HW_SIZE, 0xff); ++ _rtw_memset((PVOID)&BTEfuseInitMap[0], 0xff, EFUSE_BT_MAX_MAP_LEN); ++ _rtw_memset((PVOID)&BTEfuseModifiedMap[0], 0xff, EFUSE_BT_MAX_MAP_LEN); ++ ++ for (i = 0; i < EFUSE_MAX_BT_BANK; i++) ++ _rtw_memset((PVOID)&fakeBTEfuseContent[i][0], 0xff, EFUSE_MAX_HW_SIZE); ++ _rtw_memset((PVOID)&fakeBTEfuseInitMap[0], 0xff, EFUSE_BT_MAX_MAP_LEN); ++ _rtw_memset((PVOID)&fakeBTEfuseModifiedMap[0], 0xff, EFUSE_BT_MAX_MAP_LEN); ++} ++#endif /* !RTW_HALMAC */ ++/* 11/16/2008 MH Add description. Get current efuse area enabled word!!. */ ++u8 ++Efuse_CalculateWordCnts(IN u8 word_en) ++{ ++ u8 word_cnts = 0; ++ if (!(word_en & BIT(0))) ++ word_cnts++; /* 0 : write enable */ ++ if (!(word_en & BIT(1))) ++ word_cnts++; ++ if (!(word_en & BIT(2))) ++ word_cnts++; ++ if (!(word_en & BIT(3))) ++ word_cnts++; ++ return word_cnts; ++} ++ ++/*----------------------------------------------------------------------------- ++ * Function: efuse_WordEnableDataRead ++ * ++ * Overview: Read allowed word in current efuse section data. ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 11/16/2008 MHC Create Version 0. ++ * 11/21/2008 MHC Fix Write bug when we only enable late word. ++ * ++ *---------------------------------------------------------------------------*/ ++void ++efuse_WordEnableDataRead(IN u8 word_en, ++ IN u8 *sourdata, ++ IN u8 *targetdata) ++{ ++ if (!(word_en & BIT(0))) { ++ targetdata[0] = sourdata[0]; ++ targetdata[1] = sourdata[1]; ++ } ++ if (!(word_en & BIT(1))) { ++ targetdata[2] = sourdata[2]; ++ targetdata[3] = sourdata[3]; ++ } ++ if (!(word_en & BIT(2))) { ++ targetdata[4] = sourdata[4]; ++ targetdata[5] = sourdata[5]; ++ } ++ if (!(word_en & BIT(3))) { ++ targetdata[6] = sourdata[6]; ++ targetdata[7] = sourdata[7]; ++ } ++} ++ ++/*----------------------------------------------------------------------------- ++ * Function: EFUSE_ShadowMapUpdate ++ * ++ * Overview: Transfer current EFUSE content to shadow init and modify map. ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 11/13/2008 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++void EFUSE_ShadowMapUpdate( ++ IN PADAPTER pAdapter, ++ IN u8 efuseType, ++ IN BOOLEAN bPseudoTest) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ u16 mapLen = 0; ++#ifdef RTW_HALMAC ++ u8 *efuse_map = NULL; ++ int err; ++ ++ ++ mapLen = EEPROM_MAX_SIZE; ++ efuse_map = pHalData->efuse_eeprom_data; ++ /* efuse default content is 0xFF */ ++ _rtw_memset(efuse_map, 0xFF, EEPROM_MAX_SIZE); ++ ++ EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, bPseudoTest); ++ if (!mapLen) { ++ RTW_WARN("%s: fail to get efuse size!\n", __FUNCTION__); ++ mapLen = EEPROM_MAX_SIZE; ++ } ++ if (mapLen > EEPROM_MAX_SIZE) { ++ RTW_WARN("%s: size of efuse data(%d) is large than expected(%d)!\n", ++ __FUNCTION__, mapLen, EEPROM_MAX_SIZE); ++ mapLen = EEPROM_MAX_SIZE; ++ } ++ ++ if (pHalData->bautoload_fail_flag == _FALSE) { ++ err = rtw_halmac_read_logical_efuse_map(adapter_to_dvobj(pAdapter), efuse_map, mapLen); ++ if (err) ++ RTW_ERR("%s: fail to get efuse map!\n", __FUNCTION__); ++ } ++#else /* !RTW_HALMAC */ ++ EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, bPseudoTest); ++ ++ if (pHalData->bautoload_fail_flag == _TRUE) ++ _rtw_memset(pHalData->efuse_eeprom_data, 0xFF, mapLen); ++ else { ++#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE ++ if (_SUCCESS != retriveAdaptorInfoFile(pAdapter->registrypriv.adaptor_info_caching_file_path, pHalData->efuse_eeprom_data)) { ++#endif ++ ++ Efuse_ReadAllMap(pAdapter, efuseType, pHalData->efuse_eeprom_data, bPseudoTest); ++ ++#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE ++ storeAdaptorInfoFile(pAdapter->registrypriv.adaptor_info_caching_file_path, pHalData->efuse_eeprom_data); ++ } ++#endif ++ } ++ ++ /* PlatformMoveMemory((PVOID)&pHalData->EfuseMap[EFUSE_MODIFY_MAP][0], */ ++ /* (PVOID)&pHalData->EfuseMap[EFUSE_INIT_MAP][0], mapLen); */ ++#endif /* !RTW_HALMAC */ ++ ++ rtw_dump_cur_efuse(pAdapter); ++} /* EFUSE_ShadowMapUpdate */ ++ ++const u8 _mac_hidden_max_bw_to_hal_bw_cap[MAC_HIDDEN_MAX_BW_NUM] = { ++ 0, ++ 0, ++ (BW_CAP_160M | BW_CAP_80M | BW_CAP_40M | BW_CAP_20M | BW_CAP_10M | BW_CAP_5M), ++ (BW_CAP_5M), ++ (BW_CAP_10M | BW_CAP_5M), ++ (BW_CAP_20M | BW_CAP_10M | BW_CAP_5M), ++ (BW_CAP_40M | BW_CAP_20M | BW_CAP_10M | BW_CAP_5M), ++ (BW_CAP_80M | BW_CAP_40M | BW_CAP_20M | BW_CAP_10M | BW_CAP_5M), ++}; ++ ++const u8 _mac_hidden_proto_to_hal_proto_cap[MAC_HIDDEN_PROTOCOL_NUM] = { ++ 0, ++ 0, ++ (PROTO_CAP_11N | PROTO_CAP_11G | PROTO_CAP_11B), ++ (PROTO_CAP_11AC | PROTO_CAP_11N | PROTO_CAP_11G | PROTO_CAP_11B), ++}; ++ ++u8 mac_hidden_wl_func_to_hal_wl_func(u8 func) ++{ ++ u8 wl_func = 0; ++ ++ if (func & BIT0) ++ wl_func |= WL_FUNC_MIRACAST; ++ if (func & BIT1) ++ wl_func |= WL_FUNC_P2P; ++ if (func & BIT2) ++ wl_func |= WL_FUNC_TDLS; ++ if (func & BIT3) ++ wl_func |= WL_FUNC_FTM; ++ ++ return wl_func; ++} ++ ++#ifdef PLATFORM_LINUX ++#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE ++/* #include */ ++ ++int isAdaptorInfoFileValid(void) ++{ ++ return _TRUE; ++} ++ ++int storeAdaptorInfoFile(char *path, u8 *efuse_data) ++{ ++ int ret = _SUCCESS; ++ ++ if (path && efuse_data) { ++ ret = rtw_store_to_file(path, efuse_data, EEPROM_MAX_SIZE_512); ++ if (ret == EEPROM_MAX_SIZE) ++ ret = _SUCCESS; ++ else ++ ret = _FAIL; ++ } else { ++ RTW_INFO("%s NULL pointer\n", __FUNCTION__); ++ ret = _FAIL; ++ } ++ return ret; ++} ++ ++int retriveAdaptorInfoFile(char *path, u8 *efuse_data) ++{ ++ int ret = _SUCCESS; ++ mm_segment_t oldfs; ++ struct file *fp; ++ ++ if (path && efuse_data) { ++ ++ ret = rtw_retrieve_from_file(path, efuse_data, EEPROM_MAX_SIZE); ++ ++ if (ret == EEPROM_MAX_SIZE) ++ ret = _SUCCESS; ++ else ++ ret = _FAIL; ++ ++#if 0 ++ if (isAdaptorInfoFileValid()) ++ return 0; ++ else ++ return _FAIL; ++#endif ++ ++ } else { ++ RTW_INFO("%s NULL pointer\n", __FUNCTION__); ++ ret = _FAIL; ++ } ++ return ret; ++} ++#endif /* CONFIG_ADAPTOR_INFO_CACHING_FILE */ ++ ++u8 rtw_efuse_file_read(PADAPTER padapter, u8 *filepatch, u8 *buf, u32 len) ++{ ++ char *ptmpbuf = NULL, *ptr; ++ u8 val8; ++ u32 count, i, j; ++ int err; ++ u32 bufsize = 4096; ++ ++ ptmpbuf = rtw_zmalloc(bufsize); ++ if (ptmpbuf == NULL) ++ return _FALSE; ++ ++ count = rtw_retrieve_from_file(filepatch, ptmpbuf, bufsize); ++ if (count <= 100) { ++ rtw_mfree(ptmpbuf, bufsize); ++ RTW_ERR("%s, filepatch %s, size=%d, FAIL!!\n", __FUNCTION__, filepatch, count); ++ return _FALSE; ++ } ++ ++ i = 0; ++ j = 0; ++ ptr = ptmpbuf; ++ while ((j < len) && (i < count)) { ++ if (ptmpbuf[i] == '\0') ++ break; ++ ++ ptr = strpbrk(&ptmpbuf[i], " \t\n\r"); ++ if (ptr) { ++ if (ptr == &ptmpbuf[i]) { ++ i++; ++ continue; ++ } ++ ++ /* Add string terminating null */ ++ *ptr = 0; ++ } else { ++ ptr = &ptmpbuf[count-1]; ++ } ++ ++ err = sscanf(&ptmpbuf[i], "%hhx", &val8); ++ if (err != 1) { ++ RTW_WARN("Something wrong to parse efuse file, string=%s\n", &ptmpbuf[i]); ++ } else { ++ buf[j] = val8; ++ RTW_DBG("i=%d, j=%d, 0x%02x\n", i, j, buf[j]); ++ j++; ++ } ++ ++ i = ptr - ptmpbuf + 1; ++ } ++ ++ rtw_mfree(ptmpbuf, bufsize); ++ RTW_INFO("%s, filepatch %s, size=%d, done\n", __FUNCTION__, filepatch, count); ++ return _TRUE; ++} ++ ++#ifdef CONFIG_EFUSE_CONFIG_FILE ++u32 rtw_read_efuse_from_file(const char *path, u8 *buf, int map_size) ++{ ++ u32 i; ++ u8 c; ++ u8 temp[3]; ++ u8 temp_i; ++ u8 end = _FALSE; ++ u32 ret = _FAIL; ++ ++ u8 *file_data = NULL; ++ u32 file_size, read_size, pos = 0; ++ u8 *map = NULL; ++ ++ if (rtw_is_file_readable_with_size(path, &file_size) != _TRUE) { ++ RTW_PRINT("%s %s is not readable\n", __func__, path); ++ goto exit; ++ } ++ ++ file_data = rtw_vmalloc(file_size); ++ if (!file_data) { ++ RTW_ERR("%s rtw_vmalloc(%d) fail\n", __func__, file_size); ++ goto exit; ++ } ++ ++ read_size = rtw_retrieve_from_file(path, file_data, file_size); ++ if (read_size == 0) { ++ RTW_ERR("%s read from %s fail\n", __func__, path); ++ goto exit; ++ } ++ ++ map = rtw_vmalloc(map_size); ++ if (!map) { ++ RTW_ERR("%s rtw_vmalloc(%d) fail\n", __func__, map_size); ++ goto exit; ++ } ++ _rtw_memset(map, 0xff, map_size); ++ ++ temp[2] = 0; /* end of string '\0' */ ++ ++ for (i = 0 ; i < map_size ; i++) { ++ temp_i = 0; ++ ++ while (1) { ++ if (pos >= read_size) { ++ end = _TRUE; ++ break; ++ } ++ c = file_data[pos++]; ++ ++ /* bypass spece or eol or null before first hex digit */ ++ if (temp_i == 0 && (is_eol(c) == _TRUE || is_space(c) == _TRUE || is_null(c) == _TRUE)) ++ continue; ++ ++ if (IsHexDigit(c) == _FALSE) { ++ RTW_ERR("%s invalid 8-bit hex format for offset:0x%03x\n", __func__, i); ++ goto exit; ++ } ++ ++ temp[temp_i++] = c; ++ ++ if (temp_i == 2) { ++ /* parse value */ ++ if (sscanf(temp, "%hhx", &map[i]) != 1) { ++ RTW_ERR("%s sscanf fail for offset:0x%03x\n", __func__, i); ++ goto exit; ++ } ++ break; ++ } ++ } ++ ++ if (end == _TRUE) { ++ if (temp_i != 0) { ++ RTW_ERR("%s incomplete 8-bit hex format for offset:0x%03x\n", __func__, i); ++ goto exit; ++ } ++ break; ++ } ++ } ++ ++ RTW_PRINT("efuse file:%s, 0x%03x byte content read\n", path, i); ++ ++ _rtw_memcpy(buf, map, map_size); ++ ++ ret = _SUCCESS; ++ ++exit: ++ if (file_data) ++ rtw_vmfree(file_data, file_size); ++ if (map) ++ rtw_vmfree(map, map_size); ++ ++ return ret; ++} ++ ++u32 rtw_read_macaddr_from_file(const char *path, u8 *buf) ++{ ++ u32 i; ++ u8 temp[3]; ++ u32 ret = _FAIL; ++ ++ u8 file_data[17]; ++ u32 read_size, pos = 0; ++ u8 addr[ETH_ALEN]; ++ ++ if (rtw_is_file_readable(path) != _TRUE) { ++ RTW_PRINT("%s %s is not readable\n", __func__, path); ++ goto exit; ++ } ++ ++ read_size = rtw_retrieve_from_file(path, file_data, 17); ++ if (read_size != 17) { ++ RTW_ERR("%s read from %s fail\n", __func__, path); ++ goto exit; ++ } ++ ++ temp[2] = 0; /* end of string '\0' */ ++ ++ for (i = 0 ; i < ETH_ALEN ; i++) { ++ if (IsHexDigit(file_data[i * 3]) == _FALSE || IsHexDigit(file_data[i * 3 + 1]) == _FALSE) { ++ RTW_ERR("%s invalid 8-bit hex format for address offset:%u\n", __func__, i); ++ goto exit; ++ } ++ ++ if (i < ETH_ALEN - 1 && file_data[i * 3 + 2] != ':') { ++ RTW_ERR("%s invalid separator after address offset:%u\n", __func__, i); ++ goto exit; ++ } ++ ++ temp[0] = file_data[i * 3]; ++ temp[1] = file_data[i * 3 + 1]; ++ if (sscanf(temp, "%hhx", &addr[i]) != 1) { ++ RTW_ERR("%s sscanf fail for address offset:0x%03x\n", __func__, i); ++ goto exit; ++ } ++ } ++ ++ _rtw_memcpy(buf, addr, ETH_ALEN); ++ ++ RTW_PRINT("wifi_mac file: %s\n", path); ++#ifdef CONFIG_RTW_DEBUG ++ RTW_INFO(MAC_FMT"\n", MAC_ARG(buf)); ++#endif ++ ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++#endif /* CONFIG_EFUSE_CONFIG_FILE */ ++ ++#endif /* PLATFORM_LINUX */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_ap.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ap.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_ap.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ap.c 2018-02-11 21:44:27.135145903 +0200 +@@ -0,0 +1,4119 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_AP_C_ ++ ++#include ++ ++ ++#ifdef CONFIG_AP_MODE ++ ++extern unsigned char RTW_WPA_OUI[]; ++extern unsigned char WMM_OUI[]; ++extern unsigned char WPS_OUI[]; ++extern unsigned char P2P_OUI[]; ++extern unsigned char WFD_OUI[]; ++ ++void init_mlme_ap_info(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ _rtw_spinlock_init(&pmlmepriv->bcn_update_lock); ++ ++ /* pmlmeext->bstart_bss = _FALSE; */ ++ ++} ++ ++void free_mlme_ap_info(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ stop_ap_mode(padapter); ++ _rtw_spinlock_free(&pmlmepriv->bcn_update_lock); ++ ++} ++ ++static void update_BCNTIM(_adapter *padapter) ++{ ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork_mlmeext = &(pmlmeinfo->network); ++ unsigned char *pie = pnetwork_mlmeext->IEs; ++ ++#if 0 ++ ++ ++ /* update TIM IE */ ++ /* if(pstapriv->tim_bitmap) */ ++#endif ++ if (_TRUE) { ++ u8 *p, *dst_ie, *premainder_ie = NULL, *pbackup_remainder_ie = NULL; ++ u16 tim_bitmap_le; ++ uint offset, tmp_len, tim_ielen, tim_ie_offset, remainder_ielen; ++ ++ tim_bitmap_le = cpu_to_le16(pstapriv->tim_bitmap); ++ ++ p = rtw_get_ie(pie + _FIXED_IE_LENGTH_, _TIM_IE_, &tim_ielen, pnetwork_mlmeext->IELength - _FIXED_IE_LENGTH_); ++ if (p != NULL && tim_ielen > 0) { ++ tim_ielen += 2; ++ ++ premainder_ie = p + tim_ielen; ++ ++ tim_ie_offset = (sint)(p - pie); ++ ++ remainder_ielen = pnetwork_mlmeext->IELength - tim_ie_offset - tim_ielen; ++ ++ /*append TIM IE from dst_ie offset*/ ++ dst_ie = p; ++ } else { ++ tim_ielen = 0; ++ ++ /*calculate head_len*/ ++ offset = _FIXED_IE_LENGTH_; ++ ++ /* get ssid_ie len */ ++ p = rtw_get_ie(pie + _BEACON_IE_OFFSET_, _SSID_IE_, &tmp_len, (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_)); ++ if (p != NULL) ++ offset += tmp_len + 2; ++ ++ /*get supported rates len*/ ++ p = rtw_get_ie(pie + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &tmp_len, (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_)); ++ if (p != NULL) ++ offset += tmp_len + 2; ++ ++ /*DS Parameter Set IE, len=3*/ ++ offset += 3; ++ ++ premainder_ie = pie + offset; ++ ++ remainder_ielen = pnetwork_mlmeext->IELength - offset - tim_ielen; ++ ++ /*append TIM IE from offset*/ ++ dst_ie = pie + offset; ++ ++ } ++ ++ if (remainder_ielen > 0) { ++ pbackup_remainder_ie = rtw_malloc(remainder_ielen); ++ if (pbackup_remainder_ie && premainder_ie) ++ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); ++ } ++ ++ *dst_ie++ = _TIM_IE_; ++ ++ if ((pstapriv->tim_bitmap & 0xff00) && (pstapriv->tim_bitmap & 0x00fe)) ++ tim_ielen = 5; ++ else ++ tim_ielen = 4; ++ ++ *dst_ie++ = tim_ielen; ++ ++ *dst_ie++ = 0;/*DTIM count*/ ++ *dst_ie++ = 1;/*DTIM period*/ ++ ++ if (pstapriv->tim_bitmap & BIT(0))/*for bc/mc frames*/ ++ *dst_ie++ = BIT(0);/*bitmap ctrl */ ++ else ++ *dst_ie++ = 0; ++ ++ if (tim_ielen == 4) { ++ u8 pvb = 0; ++ ++ if (pstapriv->tim_bitmap & 0x00fe) ++ pvb = (u8)tim_bitmap_le; ++ else if (pstapriv->tim_bitmap & 0xff00) ++ pvb = (u8)(tim_bitmap_le >> 8); ++ else ++ pvb = (u8)tim_bitmap_le; ++ ++ *dst_ie++ = pvb; ++ ++ } else if (tim_ielen == 5) { ++ _rtw_memcpy(dst_ie, &tim_bitmap_le, 2); ++ dst_ie += 2; ++ } ++ ++ /*copy remainder IE*/ ++ if (pbackup_remainder_ie) { ++ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); ++ ++ rtw_mfree(pbackup_remainder_ie, remainder_ielen); ++ } ++ ++ offset = (uint)(dst_ie - pie); ++ pnetwork_mlmeext->IELength = offset + remainder_ielen; ++ ++ } ++} ++ ++void rtw_add_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index, u8 *data, u8 len) ++{ ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 bmatch = _FALSE; ++ u8 *pie = pnetwork->IEs; ++ u8 *p = NULL, *dst_ie = NULL, *premainder_ie = NULL, *pbackup_remainder_ie = NULL; ++ u32 i, offset, ielen, ie_offset, remainder_ielen = 0; ++ ++ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pnetwork->IELength;) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(pnetwork->IEs + i); ++ ++ if (pIE->ElementID > index) ++ break; ++ else if (pIE->ElementID == index) { /* already exist the same IE */ ++ p = (u8 *)pIE; ++ ielen = pIE->Length; ++ bmatch = _TRUE; ++ break; ++ } ++ ++ p = (u8 *)pIE; ++ ielen = pIE->Length; ++ i += (pIE->Length + 2); ++ } ++ ++ if (p != NULL && ielen > 0) { ++ ielen += 2; ++ ++ premainder_ie = p + ielen; ++ ++ ie_offset = (sint)(p - pie); ++ ++ remainder_ielen = pnetwork->IELength - ie_offset - ielen; ++ ++ if (bmatch) ++ dst_ie = p; ++ else ++ dst_ie = (p + ielen); ++ } ++ ++ if (dst_ie == NULL) ++ return; ++ ++ if (remainder_ielen > 0) { ++ pbackup_remainder_ie = rtw_malloc(remainder_ielen); ++ if (pbackup_remainder_ie && premainder_ie) ++ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); ++ } ++ ++ *dst_ie++ = index; ++ *dst_ie++ = len; ++ ++ _rtw_memcpy(dst_ie, data, len); ++ dst_ie += len; ++ ++ /* copy remainder IE */ ++ if (pbackup_remainder_ie) { ++ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); ++ ++ rtw_mfree(pbackup_remainder_ie, remainder_ielen); ++ } ++ ++ offset = (uint)(dst_ie - pie); ++ pnetwork->IELength = offset + remainder_ielen; ++} ++ ++void rtw_remove_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index) ++{ ++ u8 *p, *dst_ie = NULL, *premainder_ie = NULL, *pbackup_remainder_ie = NULL; ++ uint offset, ielen, ie_offset, remainder_ielen = 0; ++ u8 *pie = pnetwork->IEs; ++ ++ p = rtw_get_ie(pie + _FIXED_IE_LENGTH_, index, &ielen, pnetwork->IELength - _FIXED_IE_LENGTH_); ++ if (p != NULL && ielen > 0) { ++ ielen += 2; ++ ++ premainder_ie = p + ielen; ++ ++ ie_offset = (sint)(p - pie); ++ ++ remainder_ielen = pnetwork->IELength - ie_offset - ielen; ++ ++ dst_ie = p; ++ } else ++ return; ++ ++ if (remainder_ielen > 0) { ++ pbackup_remainder_ie = rtw_malloc(remainder_ielen); ++ if (pbackup_remainder_ie && premainder_ie) ++ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); ++ } ++ ++ /* copy remainder IE */ ++ if (pbackup_remainder_ie) { ++ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); ++ ++ rtw_mfree(pbackup_remainder_ie, remainder_ielen); ++ } ++ ++ offset = (uint)(dst_ie - pie); ++ pnetwork->IELength = offset + remainder_ielen; ++} ++ ++ ++u8 chk_sta_is_alive(struct sta_info *psta); ++u8 chk_sta_is_alive(struct sta_info *psta) ++{ ++ u8 ret = _FALSE; ++#ifdef DBG_EXPIRATION_CHK ++ RTW_INFO("sta:"MAC_FMT", rssi:%d, rx:"STA_PKTS_FMT", expire_to:%u, %s%ssq_len:%u\n" ++ , MAC_ARG(psta->hwaddr) ++ , psta->rssi_stat.UndecoratedSmoothedPWDB ++ /* , STA_RX_PKTS_ARG(psta) */ ++ , STA_RX_PKTS_DIFF_ARG(psta) ++ , psta->expire_to ++ , psta->state & WIFI_SLEEP_STATE ? "PS, " : "" ++ , psta->state & WIFI_STA_ALIVE_CHK_STATE ? "SAC, " : "" ++ , psta->sleepq_len ++ ); ++#endif ++ ++ /* if(sta_last_rx_pkts(psta) == sta_rx_pkts(psta)) */ ++ if ((psta->sta_stats.last_rx_data_pkts + psta->sta_stats.last_rx_ctrl_pkts) == (psta->sta_stats.rx_data_pkts + psta->sta_stats.rx_ctrl_pkts)) { ++#if 0 ++ if (psta->state & WIFI_SLEEP_STATE) ++ ret = _TRUE; ++#endif ++ } else ++ ret = _TRUE; ++ ++ sta_update_last_rx_pkts(psta); ++ ++ return ret; ++} ++ ++void expire_timeout_chk(_adapter *padapter) ++{ ++ _irqL irqL; ++ _list *phead, *plist; ++ u8 updated = _FALSE; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 chk_alive_num = 0; ++ char chk_alive_list[NUM_STA]; ++ int i; ++ ++ ++#ifdef CONFIG_MCC_MODE ++ /* then driver may check fail due to not recv client's frame under sitesurvey, ++ * don't expire timeout chk under MCC under sitesurvey */ ++ ++ if (rtw_hal_mcc_link_status_chk(padapter, __func__) == _FALSE) ++ return; ++#endif ++ ++ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ ++ phead = &pstapriv->auth_list; ++ plist = get_next(phead); ++ ++ /* check auth_queue */ ++#ifdef DBG_EXPIRATION_CHK ++ if (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ RTW_INFO(FUNC_NDEV_FMT" auth_list, cnt:%u\n" ++ , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->auth_list_cnt); ++ } ++#endif ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, auth_list); ++ ++ plist = get_next(plist); ++ ++ ++#ifdef CONFIG_ATMEL_RC_PATCH ++ if (_TRUE == _rtw_memcmp((void *)(pstapriv->atmel_rc_pattern), (void *)(psta->hwaddr), ETH_ALEN)) ++ continue; ++ if (psta->flag_atmel_rc) ++ continue; ++#endif ++ if (psta->expire_to > 0) { ++ psta->expire_to--; ++ if (psta->expire_to == 0) { ++ rtw_list_delete(&psta->auth_list); ++ pstapriv->auth_list_cnt--; ++ ++ RTW_INFO("auth expire %02X%02X%02X%02X%02X%02X\n", ++ psta->hwaddr[0], psta->hwaddr[1], psta->hwaddr[2], psta->hwaddr[3], psta->hwaddr[4], psta->hwaddr[5]); ++ ++ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ ++ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ rtw_free_stainfo(padapter, psta); ++ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ ++ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ } ++ } ++ ++ } ++ ++ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ psta = NULL; ++ ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ /* check asoc_queue */ ++#ifdef DBG_EXPIRATION_CHK ++ if (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ RTW_INFO(FUNC_NDEV_FMT" asoc_list, cnt:%u\n" ++ , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->asoc_list_cnt); ++ } ++#endif ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ plist = get_next(plist); ++#ifdef CONFIG_ATMEL_RC_PATCH ++ RTW_INFO("%s:%d psta=%p, %02x,%02x||%02x,%02x \n\n", __func__, __LINE__, ++ psta, pstapriv->atmel_rc_pattern[0], pstapriv->atmel_rc_pattern[5], psta->hwaddr[0], psta->hwaddr[5]); ++ if (_TRUE == _rtw_memcmp((void *)pstapriv->atmel_rc_pattern, (void *)(psta->hwaddr), ETH_ALEN)) ++ continue; ++ if (psta->flag_atmel_rc) ++ continue; ++ RTW_INFO("%s: debug line:%d\n", __func__, __LINE__); ++#endif ++#ifdef CONFIG_AUTO_AP_MODE ++ if (psta->isrc) ++ continue; ++#endif ++ if (chk_sta_is_alive(psta) || !psta->expire_to) { ++ psta->expire_to = pstapriv->expire_to; ++ psta->keep_alive_trycnt = 0; ++#ifdef CONFIG_TX_MCAST2UNI ++ psta->under_exist_checking = 0; ++#endif /* CONFIG_TX_MCAST2UNI */ ++ } else ++ psta->expire_to--; ++ ++#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++#ifdef CONFIG_80211N_HT ++#ifdef CONFIG_TX_MCAST2UNI ++ if ((psta->flags & WLAN_STA_HT) && (psta->htpriv.agg_enable_bitmap || psta->under_exist_checking)) { ++ /* check sta by delba(addba) for 11n STA */ ++ /* ToDo: use CCX report to check for all STAs */ ++ /* RTW_INFO("asoc check by DELBA/ADDBA! (pstapriv->expire_to=%d s)(psta->expire_to=%d s), [%02x, %d]\n", pstapriv->expire_to*2, psta->expire_to*2, psta->htpriv.agg_enable_bitmap, psta->under_exist_checking); */ ++ ++ if (psta->expire_to <= (pstapriv->expire_to - 50)) { ++ RTW_INFO("asoc expire by DELBA/ADDBA! (%d s)\n", (pstapriv->expire_to - psta->expire_to) * 2); ++ psta->under_exist_checking = 0; ++ psta->expire_to = 0; ++ } else if (psta->expire_to <= (pstapriv->expire_to - 3) && (psta->under_exist_checking == 0)) { ++ RTW_INFO("asoc check by DELBA/ADDBA! (%d s)\n", (pstapriv->expire_to - psta->expire_to) * 2); ++ psta->under_exist_checking = 1; ++ /* tear down TX AMPDU */ ++ send_delba(padapter, 1, psta->hwaddr);/* */ /* originator */ ++ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ ++ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ ++ } ++ } ++#endif /* CONFIG_TX_MCAST2UNI */ ++#endif /* CONFIG_80211N_HT */ ++#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ ++ ++ if (psta->expire_to <= 0) { ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ if (padapter->registrypriv.wifi_spec == 1) { ++ psta->expire_to = pstapriv->expire_to; ++ continue; ++ } ++ ++#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++#ifdef CONFIG_80211N_HT ++ ++#define KEEP_ALIVE_TRYCNT (3) ++ ++ if (psta->keep_alive_trycnt > 0 && psta->keep_alive_trycnt <= KEEP_ALIVE_TRYCNT) { ++ if (psta->state & WIFI_STA_ALIVE_CHK_STATE) ++ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; ++ else ++ psta->keep_alive_trycnt = 0; ++ ++ } else if ((psta->keep_alive_trycnt > KEEP_ALIVE_TRYCNT) && !(psta->state & WIFI_STA_ALIVE_CHK_STATE)) ++ psta->keep_alive_trycnt = 0; ++ if ((psta->htpriv.ht_option == _TRUE) && (psta->htpriv.ampdu_enable == _TRUE)) { ++ uint priority = 1; /* test using BK */ ++ u8 issued = 0; ++ ++ /* issued = (psta->htpriv.agg_enable_bitmap>>priority)&0x1; */ ++ issued |= (psta->htpriv.candidate_tid_bitmap >> priority) & 0x1; ++ ++ if (0 == issued) { ++ if (!(psta->state & WIFI_STA_ALIVE_CHK_STATE)) { ++ psta->htpriv.candidate_tid_bitmap |= BIT((u8)priority); ++ ++ if (psta->state & WIFI_SLEEP_STATE) ++ psta->expire_to = 2; /* 2x2=4 sec */ ++ else ++ psta->expire_to = 1; /* 2 sec */ ++ ++ psta->state |= WIFI_STA_ALIVE_CHK_STATE; ++ ++ /* add_ba_hdl(padapter, (u8*)paddbareq_parm); */ ++ ++ RTW_INFO("issue addba_req to check if sta alive, keep_alive_trycnt=%d\n", psta->keep_alive_trycnt); ++ ++ issue_addba_req(padapter, psta->hwaddr, (u8)priority); ++ ++ _set_timer(&psta->addba_retry_timer, ADDBA_TO); ++ ++ psta->keep_alive_trycnt++; ++ ++ continue; ++ } ++ } ++ } ++ if (psta->keep_alive_trycnt > 0 && psta->state & WIFI_STA_ALIVE_CHK_STATE) { ++ psta->keep_alive_trycnt = 0; ++ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; ++ RTW_INFO("change to another methods to check alive if staion is at ps mode\n"); ++ } ++ ++#endif /* CONFIG_80211N_HT */ ++#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ ++ if (psta->state & WIFI_SLEEP_STATE) { ++ if (!(psta->state & WIFI_STA_ALIVE_CHK_STATE)) { ++ /* to check if alive by another methods if staion is at ps mode. */ ++ psta->expire_to = pstapriv->expire_to; ++ psta->state |= WIFI_STA_ALIVE_CHK_STATE; ++ ++ /* RTW_INFO("alive chk, sta:" MAC_FMT " is at ps mode!\n", MAC_ARG(psta->hwaddr)); */ ++ ++ /* to update bcn with tim_bitmap for this station */ ++ pstapriv->tim_bitmap |= BIT(psta->aid); ++ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); ++ ++ if (!pmlmeext->active_keep_alive_check) ++ continue; ++ } ++ } ++#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++ if (pmlmeext->active_keep_alive_check) { ++ int stainfo_offset; ++ ++ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); ++ if (stainfo_offset_valid(stainfo_offset)) ++ chk_alive_list[chk_alive_num++] = stainfo_offset; ++ ++ continue; ++ } ++#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ ++ rtw_list_delete(&psta->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ RTW_INFO("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state); ++ updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); ++ } else { ++ /* TODO: Aging mechanism to digest frames in sleep_q to avoid running out of xmitframe */ ++ if (psta->sleepq_len > (NR_XMITFRAME / pstapriv->asoc_list_cnt) ++ && padapter->xmitpriv.free_xmitframe_cnt < ((NR_XMITFRAME / pstapriv->asoc_list_cnt) / 2) ++ ) { ++ RTW_INFO("%s sta:"MAC_FMT", sleepq_len:%u, free_xmitframe_cnt:%u, asoc_list_cnt:%u, clear sleep_q\n", __func__ ++ , MAC_ARG(psta->hwaddr) ++ , psta->sleepq_len, padapter->xmitpriv.free_xmitframe_cnt, pstapriv->asoc_list_cnt); ++ wakeup_sta_to_xmit(padapter, psta); ++ } ++ } ++ } ++ ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++ if (chk_alive_num) { ++ ++ u8 backup_ch = 0, backup_bw, backup_offset; ++ u8 union_ch = 0, union_bw, union_offset; ++ u8 switch_channel = _TRUE; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ if (!rtw_mi_get_ch_setting_union(padapter, &union_ch, &union_bw, &union_offset) ++ || pmlmeext->cur_channel != union_ch) ++ goto bypass_active_keep_alive; ++ ++#ifdef CONFIG_MCC_MODE ++ if (MCC_EN(padapter)) { ++ /* driver doesn't switch channel under MCC */ ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) ++ switch_channel = _FALSE; ++ } ++#endif ++ /* switch to correct channel of current network before issue keep-alive frames */ ++ if (switch_channel == _TRUE && rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) { ++ backup_ch = rtw_get_oper_ch(padapter); ++ backup_bw = rtw_get_oper_bw(padapter); ++ backup_offset = rtw_get_oper_choffset(padapter); ++ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); ++ } ++ ++ /* issue null data to check sta alive*/ ++ for (i = 0; i < chk_alive_num; i++) { ++ int ret = _FAIL; ++ ++ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); ++#ifdef CONFIG_ATMEL_RC_PATCH ++ if (_TRUE == _rtw_memcmp(pstapriv->atmel_rc_pattern, psta->hwaddr, ETH_ALEN)) ++ continue; ++ if (psta->flag_atmel_rc) ++ continue; ++#endif ++ if (!(psta->state & _FW_LINKED)) ++ continue; ++ ++ if (psta->state & WIFI_SLEEP_STATE) ++ ret = issue_nulldata(padapter, psta->hwaddr, 0, 1, 50); ++ else ++ ret = issue_nulldata(padapter, psta->hwaddr, 0, 3, 50); ++ ++ psta->keep_alive_trycnt++; ++ if (ret == _SUCCESS) { ++ RTW_INFO("asoc check, sta(" MAC_FMT ") is alive\n", MAC_ARG(psta->hwaddr)); ++ psta->expire_to = pstapriv->expire_to; ++ psta->keep_alive_trycnt = 0; ++ continue; ++ } else if (psta->keep_alive_trycnt <= 3) { ++ RTW_INFO("ack check for asoc expire, keep_alive_trycnt=%d\n", psta->keep_alive_trycnt); ++ psta->expire_to = 1; ++ continue; ++ } ++ ++ psta->keep_alive_trycnt = 0; ++ RTW_INFO("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state); ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { ++ rtw_list_delete(&psta->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ } ++ ++ /* back to the original operation channel */ ++ if (switch_channel && backup_ch > 0) ++ set_channel_bwmode(padapter, backup_ch, backup_offset, backup_bw); ++ ++bypass_active_keep_alive: ++ ; ++ } ++#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ ++ ++ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); ++} ++ ++void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level) ++{ ++ int i; ++ u8 rf_type; ++ unsigned char sta_band = 0; ++ u64 tx_ra_bitmap = 0; ++ struct ht_priv *psta_ht = NULL; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; ++ ++#ifdef CONFIG_80211N_HT ++ if (psta) ++ psta_ht = &psta->htpriv; ++ else ++ return; ++#endif /* CONFIG_80211N_HT */ ++ ++ if (!(psta->state & _FW_LINKED)) ++ return; ++ ++ rtw_hal_update_sta_rate_mask(padapter, psta); ++ tx_ra_bitmap = psta->ra_mask; ++ ++ if (pcur_network->Configuration.DSConfig > 14) { ++ ++ if (tx_ra_bitmap & 0xffff000) ++ sta_band |= WIRELESS_11_5N ; ++ ++ if (tx_ra_bitmap & 0xff0) ++ sta_band |= WIRELESS_11A; ++ ++ /* 5G band */ ++#ifdef CONFIG_80211AC_VHT ++ if (psta->vhtpriv.vht_option) ++ sta_band = WIRELESS_11_5AC; ++#endif ++ ++ } else { ++ if (tx_ra_bitmap & 0xffff000) ++ sta_band |= WIRELESS_11_24N; ++ ++ if (tx_ra_bitmap & 0xff0) ++ sta_band |= WIRELESS_11G; ++ ++ if (tx_ra_bitmap & 0x0f) ++ sta_band |= WIRELESS_11B; ++ } ++ ++ psta->wireless_mode = sta_band; ++ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); ++ ++ if (psta->aid < NUM_STA) { ++ RTW_INFO("%s=> mac_id:%d , raid:%d, tx_ra_bitmap:0x%016llx, networkType:0x%02x\n", ++ __FUNCTION__, psta->mac_id, psta->raid, tx_ra_bitmap, psta->wireless_mode); ++ ++ rtw_update_ramask(padapter, psta, psta->mac_id, rssi_level); ++ } else ++ RTW_INFO("station aid %d exceed the max number\n", psta->aid); ++ ++} ++ ++void update_bmc_sta(_adapter *padapter) ++{ ++ _irqL irqL; ++ unsigned char network_type; ++ int supportRateNum = 0; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; ++ struct sta_info *psta = rtw_get_bcmc_stainfo(padapter); ++ ++ if (psta) { ++ psta->aid = 0;/* default set to 0 */ ++ psta->qos_option = 0; ++#ifdef CONFIG_80211N_HT ++ psta->htpriv.ht_option = _FALSE; ++#endif /* CONFIG_80211N_HT */ ++ ++ psta->ieee8021x_blocked = 0; ++ ++ _rtw_memset((void *)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); ++ ++ /* psta->dot118021XPrivacy = _NO_PRIVACY_; */ /* !!! remove it, because it has been set before this. */ ++ ++ /* prepare for add_RATid */ ++ supportRateNum = rtw_get_rateset_len((u8 *)&pcur_network->SupportedRates); ++ network_type = rtw_check_network_type((u8 *)&pcur_network->SupportedRates, supportRateNum, pcur_network->Configuration.DSConfig); ++ if (IsSupportedTxCCK(network_type)) ++ network_type = WIRELESS_11B; ++ else if (network_type == WIRELESS_INVALID) { /* error handling */ ++ if (pcur_network->Configuration.DSConfig > 14) ++ network_type = WIRELESS_11A; ++ else ++ network_type = WIRELESS_11B; ++ } ++ update_sta_basic_rate(psta, network_type); ++ psta->wireless_mode = network_type; ++ ++ rtw_hal_update_sta_rate_mask(padapter, psta); ++ ++ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); ++ ++ _enter_critical_bh(&psta->lock, &irqL); ++ psta->state = _FW_LINKED; ++ _exit_critical_bh(&psta->lock, &irqL); ++ ++ rtw_sta_media_status_rpt(padapter, psta, 1); ++ rtw_hal_update_ra_mask(psta, 0); ++ } else ++ RTW_INFO("add_RATid_bmc_sta error!\n"); ++ ++} ++ ++/* notes: ++ * AID: 1~MAX for sta and 0 for bc/mc in ap/adhoc mode */ ++void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++#ifdef CONFIG_80211N_HT ++ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; ++ struct ht_priv *phtpriv_sta = &psta->htpriv; ++#endif /* CONFIG_80211N_HT */ ++ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0; ++ /* set intf_tag to if1 */ ++ /* psta->intf_tag = 0; */ ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ /*alloc macid when call rtw_alloc_stainfo(),release macid when call rtw_free_stainfo()*/ ++ ++ /* ap mode */ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); ++ ++ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) ++ psta->ieee8021x_blocked = _TRUE; ++ else ++ psta->ieee8021x_blocked = _FALSE; ++ ++ ++ /* update sta's cap */ ++ ++ /* ERP */ ++ VCS_update(padapter, psta); ++#ifdef CONFIG_80211N_HT ++ /* HT related cap */ ++ if (phtpriv_sta->ht_option) { ++ /* check if sta supports rx ampdu */ ++ phtpriv_sta->ampdu_enable = phtpriv_ap->ampdu_enable; ++ ++ phtpriv_sta->rx_ampdu_min_spacing = (phtpriv_sta->ht_cap.ampdu_params_info & IEEE80211_HT_CAP_AMPDU_DENSITY) >> 2; ++ ++ /* bwmode */ ++ if ((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) ++ psta->bw_mode = CHANNEL_WIDTH_40; ++ else ++ psta->bw_mode = CHANNEL_WIDTH_20; ++ ++ if (psta->ht_40mhz_intolerant) ++ psta->bw_mode = CHANNEL_WIDTH_20; ++ ++ if (pmlmeext->cur_bwmode < psta->bw_mode) ++ psta->bw_mode = pmlmeext->cur_bwmode; ++ ++ phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; ++ ++ ++ /* check if sta support s Short GI 20M */ ++ if ((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_20)) ++ phtpriv_sta->sgi_20m = _TRUE; ++ ++ /* check if sta support s Short GI 40M */ ++ if ((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_40)) { ++ if (psta->bw_mode == CHANNEL_WIDTH_40) /* according to psta->bw_mode */ ++ phtpriv_sta->sgi_40m = _TRUE; ++ else ++ phtpriv_sta->sgi_40m = _FALSE; ++ } ++ ++ psta->qos_option = _TRUE; ++ ++ /* B0 Config LDPC Coding Capability */ ++ if (TEST_FLAG(phtpriv_ap->ldpc_cap, LDPC_HT_ENABLE_TX) && ++ GET_HT_CAP_ELE_LDPC_CAP((u8 *)(&phtpriv_sta->ht_cap))) { ++ SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX)); ++ RTW_INFO("Enable HT Tx LDPC for STA(%d)\n", psta->aid); ++ } ++ ++ /* B7 B8 B9 Config STBC setting */ ++ if (TEST_FLAG(phtpriv_ap->stbc_cap, STBC_HT_ENABLE_TX) && ++ GET_HT_CAP_ELE_RX_STBC((u8 *)(&phtpriv_sta->ht_cap))) { ++ SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX)); ++ RTW_INFO("Enable HT Tx STBC for STA(%d)\n", psta->aid); ++ } ++ ++#ifdef CONFIG_BEAMFORMING ++ /*Config Tx beamforming setting*/ ++ if (TEST_FLAG(phtpriv_ap->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && ++ GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP((u8 *)(&phtpriv_sta->ht_cap))) { ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); ++ /*Shift to BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP*/ ++ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS((u8 *)(&phtpriv_sta->ht_cap)) << 6); ++ } ++ ++ if (TEST_FLAG(phtpriv_ap->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && ++ GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP((u8 *)(&phtpriv_sta->ht_cap))) { ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); ++ /*Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ ++ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS((u8 *)(&phtpriv_sta->ht_cap)) << 4); ++ } ++ if (cur_beamform_cap) ++ RTW_INFO("Client STA(%d) HT Beamforming Cap = 0x%02X\n", psta->aid, cur_beamform_cap); ++#endif /*CONFIG_BEAMFORMING*/ ++ } else { ++ phtpriv_sta->ampdu_enable = _FALSE; ++ ++ phtpriv_sta->sgi_20m = _FALSE; ++ phtpriv_sta->sgi_40m = _FALSE; ++ psta->bw_mode = CHANNEL_WIDTH_20; ++ phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ } ++ ++ phtpriv_sta->ldpc_cap = cur_ldpc_cap; ++ phtpriv_sta->stbc_cap = cur_stbc_cap; ++ phtpriv_sta->beamform_cap = cur_beamform_cap; ++ ++ /* Rx AMPDU */ ++ send_delba(padapter, 0, psta->hwaddr);/* recipient */ ++ ++ /* TX AMPDU */ ++ send_delba(padapter, 1, psta->hwaddr);/* */ /* originator */ ++ phtpriv_sta->agg_enable_bitmap = 0x0;/* reset */ ++ phtpriv_sta->candidate_tid_bitmap = 0x0;/* reset */ ++#endif /* CONFIG_80211N_HT */ ++ ++#ifdef CONFIG_80211AC_VHT ++ update_sta_vht_info_apmode(padapter, psta); ++#endif ++ ++ update_ldpc_stbc_cap(psta); ++ ++ /* todo: init other variables */ ++ ++ _rtw_memset((void *)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); ++ ++ ++ /* add ratid */ ++ /* add_RATid(padapter, psta); */ /* move to ap_sta_info_defer_update() */ ++ ++ ++ _enter_critical_bh(&psta->lock, &irqL); ++ psta->state |= _FW_LINKED; ++ _exit_critical_bh(&psta->lock, &irqL); ++ ++ ++} ++ ++static void update_ap_info(_adapter *padapter, struct sta_info *psta) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++#ifdef CONFIG_80211N_HT ++ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; ++#endif /* CONFIG_80211N_HT */ ++ ++ psta->wireless_mode = pmlmeext->cur_wireless_mode; ++ ++ psta->bssratelen = rtw_get_rateset_len(pnetwork->SupportedRates); ++ _rtw_memcpy(psta->bssrateset, pnetwork->SupportedRates, psta->bssratelen); ++ ++#ifdef CONFIG_80211N_HT ++ /* HT related cap */ ++ if (phtpriv_ap->ht_option) { ++ /* check if sta supports rx ampdu */ ++ /* phtpriv_ap->ampdu_enable = phtpriv_ap->ampdu_enable; */ ++ ++ /* check if sta support s Short GI 20M */ ++ if ((phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_20)) ++ phtpriv_ap->sgi_20m = _TRUE; ++ /* check if sta support s Short GI 40M */ ++ if ((phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_40)) ++ phtpriv_ap->sgi_40m = _TRUE; ++ ++ psta->qos_option = _TRUE; ++ } else { ++ phtpriv_ap->ampdu_enable = _FALSE; ++ ++ phtpriv_ap->sgi_20m = _FALSE; ++ phtpriv_ap->sgi_40m = _FALSE; ++ } ++ ++ psta->bw_mode = pmlmeext->cur_bwmode; ++ phtpriv_ap->ch_offset = pmlmeext->cur_ch_offset; ++ ++ phtpriv_ap->agg_enable_bitmap = 0x0;/* reset */ ++ phtpriv_ap->candidate_tid_bitmap = 0x0;/* reset */ ++ ++ _rtw_memcpy(&psta->htpriv, &pmlmepriv->htpriv, sizeof(struct ht_priv)); ++ ++#ifdef CONFIG_80211AC_VHT ++ _rtw_memcpy(&psta->vhtpriv, &pmlmepriv->vhtpriv, sizeof(struct vht_priv)); ++#endif /* CONFIG_80211AC_VHT */ ++ ++#endif /* CONFIG_80211N_HT */ ++ ++ psta->state |= WIFI_AP_STATE; /* Aries, add,fix bug of flush_cam_entry at STOP AP mode , 0724 */ ++} ++ ++static void rtw_set_hw_wmm_param(_adapter *padapter) ++{ ++ u8 ACI, ACM, AIFS, ECWMin, ECWMax, aSifsTime; ++ u8 acm_mask; ++ u16 TXOP; ++ u32 acParm, i; ++ u32 edca[4], inx[4]; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ ++ acm_mask = 0; ++ ++ if (IsSupported5G(pmlmeext->cur_wireless_mode) || ++ (pmlmeext->cur_wireless_mode & WIRELESS_11_24N)) ++ aSifsTime = 16; ++ else ++ aSifsTime = 10; ++ ++ if (pmlmeinfo->WMM_enable == 0) { ++ padapter->mlmepriv.acm_mask = 0; ++ ++ AIFS = aSifsTime + (2 * pmlmeinfo->slotTime); ++ ++ if (pmlmeext->cur_wireless_mode & (WIRELESS_11G | WIRELESS_11A)) { ++ ECWMin = 4; ++ ECWMax = 10; ++ } else if (pmlmeext->cur_wireless_mode & WIRELESS_11B) { ++ ECWMin = 5; ++ ECWMax = 10; ++ } else { ++ ECWMin = 4; ++ ECWMax = 10; ++ } ++ ++ TXOP = 0; ++ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); ++ ++ ECWMin = 2; ++ ECWMax = 3; ++ TXOP = 0x2f; ++ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); ++ ++ } else { ++ edca[0] = edca[1] = edca[2] = edca[3] = 0; ++ ++ /*TODO:*/ ++ acm_mask = 0; ++ padapter->mlmepriv.acm_mask = acm_mask; ++ ++#if 0 ++ /* BK */ ++ /* AIFS = AIFSN * slot time + SIFS - r2t phy delay */ ++#endif ++ AIFS = (7 * pmlmeinfo->slotTime) + aSifsTime; ++ ECWMin = 4; ++ ECWMax = 10; ++ TXOP = 0; ++ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); ++ edca[XMIT_BK_QUEUE] = acParm; ++ RTW_INFO("WMM(BK): %x\n", acParm); ++ ++ /* BE */ ++ AIFS = (3 * pmlmeinfo->slotTime) + aSifsTime; ++ ECWMin = 4; ++ ECWMax = 6; ++ TXOP = 0; ++ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); ++ edca[XMIT_BE_QUEUE] = acParm; ++ RTW_INFO("WMM(BE): %x\n", acParm); ++ ++ /* VI */ ++ AIFS = (1 * pmlmeinfo->slotTime) + aSifsTime; ++ ECWMin = 3; ++ ECWMax = 4; ++ TXOP = 94; ++ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); ++ edca[XMIT_VI_QUEUE] = acParm; ++ RTW_INFO("WMM(VI): %x\n", acParm); ++ ++ /* VO */ ++ AIFS = (1 * pmlmeinfo->slotTime) + aSifsTime; ++ ECWMin = 2; ++ ECWMax = 3; ++ TXOP = 47; ++ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); ++ edca[XMIT_VO_QUEUE] = acParm; ++ RTW_INFO("WMM(VO): %x\n", acParm); ++ ++ ++ if (padapter->registrypriv.acm_method == 1) ++ rtw_hal_set_hwreg(padapter, HW_VAR_ACM_CTRL, (u8 *)(&acm_mask)); ++ else ++ padapter->mlmepriv.acm_mask = acm_mask; ++ ++ inx[0] = 0; ++ inx[1] = 1; ++ inx[2] = 2; ++ inx[3] = 3; ++ ++ if (pregpriv->wifi_spec == 1) { ++ u32 j, tmp, change_inx = _FALSE; ++ ++ /* entry indx: 0->vo, 1->vi, 2->be, 3->bk. */ ++ for (i = 0 ; i < 4 ; i++) { ++ for (j = i + 1 ; j < 4 ; j++) { ++ /* compare CW and AIFS */ ++ if ((edca[j] & 0xFFFF) < (edca[i] & 0xFFFF)) ++ change_inx = _TRUE; ++ else if ((edca[j] & 0xFFFF) == (edca[i] & 0xFFFF)) { ++ /* compare TXOP */ ++ if ((edca[j] >> 16) > (edca[i] >> 16)) ++ change_inx = _TRUE; ++ } ++ ++ if (change_inx) { ++ tmp = edca[i]; ++ edca[i] = edca[j]; ++ edca[j] = tmp; ++ ++ tmp = inx[i]; ++ inx[i] = inx[j]; ++ inx[j] = tmp; ++ ++ change_inx = _FALSE; ++ } ++ } ++ } ++ } ++ ++ for (i = 0 ; i < 4 ; i++) { ++ pxmitpriv->wmm_para_seq[i] = inx[i]; ++ RTW_INFO("wmm_para_seq(%d): %d\n", i, pxmitpriv->wmm_para_seq[i]); ++ } ++ ++ } ++ ++} ++ ++static void update_hw_ht_param(_adapter *padapter) ++{ ++ unsigned char max_AMPDU_len; ++ unsigned char min_MPDU_spacing; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ ++ /* handle A-MPDU parameter field */ ++ /* ++ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k ++ AMPDU_para [4:2]:Min MPDU Start Spacing ++ */ ++ max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; ++ ++ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2; ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MIN_SPACE, (u8 *)(&min_MPDU_spacing)); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len)); ++ ++ /* */ ++ /* Config SM Power Save setting */ ++ /* */ ++ pmlmeinfo->SM_PS = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & 0x0C) >> 2; ++ if (pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC) { ++#if 0 ++ u8 i; ++ /* update the MCS rates */ ++ for (i = 0; i < 16; i++) ++ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; ++#endif ++ RTW_INFO("%s(): WLAN_HT_CAP_SM_PS_STATIC\n", __FUNCTION__); ++ } ++ ++ /* */ ++ /* Config current HT Protection mode. */ ++ /* */ ++ /* pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; */ ++ ++} ++ ++static void rtw_ap_check_scan(_adapter *padapter) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ u32 delta_time, lifetime; ++ struct wlan_network *pnetwork = NULL; ++ WLAN_BSSID_EX *pbss = NULL; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ u8 do_scan = _FALSE; ++ u8 reason = RTW_AUTO_SCAN_REASON_UNSPECIFIED; ++ ++ lifetime = SCANQUEUE_LIFETIME; /* 20 sec */ ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ phead = get_list_head(queue); ++ if (rtw_end_of_queue_search(phead, get_next(phead)) == _TRUE) ++ if (padapter->registrypriv.wifi_spec) { ++ do_scan = _TRUE; ++ reason |= RTW_AUTO_SCAN_REASON_2040_BSS; ++ } ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++ if (padapter->registrypriv.acs_auto_scan) { ++ do_scan = _TRUE; ++ reason |= RTW_AUTO_SCAN_REASON_ACS; ++ rtw_acs_start(padapter, _TRUE); ++ } ++#endif ++ ++ if (_TRUE == do_scan) { ++ RTW_INFO("%s : drv scans by itself and wait_completed\n", __func__); ++ rtw_drv_scan_by_self(padapter, reason); ++ rtw_scan_wait_completed(padapter); ++ } ++ ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++ if (padapter->registrypriv.acs_auto_scan) ++ rtw_acs_start(padapter, _FALSE); ++#endif ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ ++ if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 ++ && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE ++ && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid))) { ++ delta_time = (u32) rtw_get_passing_time_ms(pnetwork->last_scanned); ++ ++ if (delta_time < lifetime) { ++ ++ uint ie_len = 0; ++ u8 *pbuf = NULL; ++ u8 *ie = NULL; ++ ++ pbss = &pnetwork->network; ++ ie = pbss->IEs; ++ ++ /*check if HT CAP INFO IE exists or not*/ ++ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pbss->IELength - _BEACON_IE_OFFSET_)); ++ if (pbuf == NULL) { ++ /* HT CAP INFO IE don't exist, it is b/g mode bss.*/ ++ ++ if (_FALSE == ATOMIC_READ(&pmlmepriv->olbc)) ++ ATOMIC_SET(&pmlmepriv->olbc, _TRUE); ++ ++ if (_FALSE == ATOMIC_READ(&pmlmepriv->olbc_ht)) ++ ATOMIC_SET(&pmlmepriv->olbc_ht, _TRUE); ++ ++ if (padapter->registrypriv.wifi_spec) ++ RTW_INFO("%s: %s is a/b/g ap\n", __func__, pnetwork->network.Ssid.Ssid); ++ } ++ } ++ } ++ ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++#ifdef CONFIG_80211N_HT ++ pmlmepriv->num_sta_no_ht = 0; /* reset to 0 after ap do scanning*/ ++#endif ++ ++} ++ ++void rtw_start_bss_hdl_after_chbw_decided(_adapter *adapter) ++{ ++ WLAN_BSSID_EX *pnetwork = &(adapter->mlmepriv.cur_network.network); ++ struct sta_info *sta = NULL; ++ ++ /* update cur_wireless_mode */ ++ update_wireless_mode(adapter); ++ ++ /* update RRSR and RTS_INIT_RATE register after set channel and bandwidth */ ++ UpdateBrateTbl(adapter, pnetwork->SupportedRates); ++ rtw_hal_set_hwreg(adapter, HW_VAR_BASIC_RATE, pnetwork->SupportedRates); ++ ++ /* update capability after cur_wireless_mode updated */ ++ update_capinfo(adapter, rtw_get_capability(pnetwork)); ++ ++ /* update bc/mc sta_info */ ++ update_bmc_sta(adapter); ++ ++ /* update AP's sta info */ ++ sta = rtw_get_stainfo(&adapter->stapriv, pnetwork->MacAddress); ++ if (!sta) { ++ RTW_INFO(FUNC_ADPT_FMT" !sta for macaddr="MAC_FMT"\n", FUNC_ADPT_ARG(adapter), MAC_ARG(pnetwork->MacAddress)); ++ rtw_warn_on(1); ++ return; ++ } ++ ++ update_ap_info(adapter, sta); ++} ++ ++void start_bss_network(_adapter *padapter, struct createbss_parm *parm) ++{ ++#define DUMP_ADAPTERS_STATUS 0 ++ ++ u8 val8; ++ u16 bcn_interval; ++ u32 acparm; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct security_priv *psecuritypriv = &(padapter->securitypriv); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; /* used as input */ ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork_mlmeext = &(pmlmeinfo->network); ++ struct dvobj_priv *pdvobj = padapter->dvobj; ++ s16 req_ch = -1, req_bw = -1, req_offset = -1; ++ bool ch_setting_changed = _FALSE; ++ u8 ch_to_set = 0, bw_to_set, offset_to_set; ++ u8 doiqk = _FALSE; ++ /* use for check ch bw offset can be allowed or not */ ++ u8 chbw_allow = _TRUE; ++ ++ if (parm->req_ch != 0) { ++ /* bypass other setting, go checking ch, bw, offset */ ++ req_ch = parm->req_ch; ++ req_bw = parm->req_bw; ++ req_offset = parm->req_offset; ++ goto chbw_decision; ++ } ++ ++ bcn_interval = (u16)pnetwork->Configuration.BeaconPeriod; ++ ++ /* check if there is wps ie, */ ++ /* if there is wpsie in beacon, the hostapd will update beacon twice when stating hostapd, */ ++ /* and at first time the security ie ( RSN/WPA IE) will not include in beacon. */ ++ if (NULL == rtw_get_wps_ie(pnetwork->IEs + _FIXED_IE_LENGTH_, pnetwork->IELength - _FIXED_IE_LENGTH_, NULL, NULL)) ++ pmlmeext->bstart_bss = _TRUE; ++ ++ /* todo: update wmm, ht cap */ ++ /* pmlmeinfo->WMM_enable; */ ++ /* pmlmeinfo->HT_enable; */ ++ if (pmlmepriv->qospriv.qos_option) ++ pmlmeinfo->WMM_enable = _TRUE; ++#ifdef CONFIG_80211N_HT ++ if (pmlmepriv->htpriv.ht_option) { ++ pmlmeinfo->WMM_enable = _TRUE; ++ pmlmeinfo->HT_enable = _TRUE; ++ /* pmlmeinfo->HT_info_enable = _TRUE; */ ++ /* pmlmeinfo->HT_caps_enable = _TRUE; */ ++ ++ update_hw_ht_param(padapter); ++ } ++#endif /* #CONFIG_80211N_HT */ ++ ++#ifdef CONFIG_80211AC_VHT ++ if (pmlmepriv->vhtpriv.vht_option) { ++ pmlmeinfo->VHT_enable = _TRUE; ++ update_hw_vht_param(padapter); ++ } ++#endif /* CONFIG_80211AC_VHT */ ++ ++ if (pmlmepriv->cur_network.join_res != _TRUE) { /* setting only at first time */ ++ /* WEP Key will be set before this function, do not clear CAM. */ ++ if ((psecuritypriv->dot11PrivacyAlgrthm != _WEP40_) && (psecuritypriv->dot11PrivacyAlgrthm != _WEP104_)) ++ flush_all_cam_entry(padapter); /* clear CAM */ ++ } ++ ++ /* set MSR to AP_Mode */ ++ Set_MSR(padapter, _HW_STATE_AP_); ++ ++ /* Set BSSID REG */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pnetwork->MacAddress); ++ ++ /* Set EDCA param reg */ ++#ifdef CONFIG_CONCURRENT_MODE ++ acparm = 0x005ea42b; ++#else ++ acparm = 0x002F3217; /* VO */ ++#endif ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm)); ++ acparm = 0x005E4317; /* VI */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm)); ++ /* acparm = 0x00105320; */ /* BE */ ++ acparm = 0x005ea42b; ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); ++ acparm = 0x0000A444; /* BK */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); ++ ++ /* Set Security */ ++ val8 = (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) ? 0xcc : 0xcf; ++ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); ++ ++ /* Beacon Control related register */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&bcn_interval)); ++ ++chbw_decision: ++ ch_setting_changed = rtw_ap_chbw_decision(padapter, req_ch, req_bw, req_offset ++ , &ch_to_set, &bw_to_set, &offset_to_set, &chbw_allow); ++ ++ /* let pnetwork_mlmeext == pnetwork_mlme. */ ++ _rtw_memcpy(pnetwork_mlmeext, pnetwork, pnetwork->Length); ++ ++ rtw_start_bss_hdl_after_chbw_decided(padapter); ++ ++#if defined(CONFIG_DFS_MASTER) ++ rtw_dfs_master_status_apply(padapter, MLME_AP_STARTED); ++#endif ++ ++#ifdef CONFIG_MCC_MODE ++ /* issue null data to AP for all interface connecting to AP before switch channel setting for softap */ ++ rtw_hal_mcc_issue_null_data(padapter, chbw_allow, 1); ++#endif /* CONFIG_MCC_MODE */ ++ ++ doiqk = _TRUE; ++ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); ++ ++ if (ch_to_set != 0) { ++ set_channel_bwmode(padapter, ch_to_set, offset_to_set, bw_to_set); ++ rtw_mi_update_union_chan_inf(padapter, ch_to_set, offset_to_set, bw_to_set); ++ } ++ ++ doiqk = _FALSE; ++ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); ++ ++#ifdef CONFIG_MCC_MODE ++ /* after set_channel_bwmode for backup IQK */ ++ rtw_hal_set_mcc_setting_start_bss_network(padapter, chbw_allow); ++#endif ++ ++ if (DUMP_ADAPTERS_STATUS) { ++ RTW_INFO(FUNC_ADPT_FMT" done\n", FUNC_ADPT_ARG(padapter)); ++ dump_adapters_status(RTW_DBGDUMP , adapter_to_dvobj(padapter)); ++ } ++ ++ /* update beacon content only if bstart_bss is _TRUE */ ++ if (_TRUE == pmlmeext->bstart_bss) { ++ ++ _irqL irqL; ++ ++#ifdef CONFIG_80211N_HT ++ if ((ATOMIC_READ(&pmlmepriv->olbc) == _TRUE) || ++ (ATOMIC_READ(&pmlmepriv->olbc_ht) == _TRUE)) { ++ /* AP is not starting a 40 MHz BSS in presence of an 802.11g BSS. */ ++ ++ pmlmepriv->ht_op_mode &= (~HT_INFO_OPERATION_MODE_OP_MODE_MASK); ++ pmlmepriv->ht_op_mode |= OP_MODE_MAY_BE_LEGACY_STAS; ++ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _FALSE); ++ } ++#endif /* CONFIG_80211N_HT */ ++ ++ update_beacon(padapter, _TIM_IE_, NULL, _FALSE); ++ ++#ifdef CONFIG_SWTIMER_BASED_TXBCN ++ _enter_critical_bh(&pdvobj->ap_if_q.lock, &irqL); ++ if (rtw_is_list_empty(&padapter->list)) { ++ rtw_list_insert_tail(&padapter->list, get_list_head(&pdvobj->ap_if_q)); ++ pdvobj->nr_ap_if++; ++ pdvobj->inter_bcn_space = DEFAULT_BCN_INTERVAL / pdvobj->nr_ap_if; ++ } ++ _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&pdvobj->inter_bcn_space)); ++ ++#endif /*CONFIG_SWTIMER_BASED_TXBCN*/ ++ ++ } ++ ++ rtw_scan_wait_completed(padapter); ++ ++ /* send beacon */ ++ if ((0 == rtw_mi_check_fwstate(padapter, _FW_UNDER_SURVEY)) ++ && (0 == rtw_mi_check_fwstate(padapter, WIFI_OP_CH_SWITCHING)) ++ ) { ++ ++ /*update_beacon(padapter, _TIM_IE_, NULL, _TRUE);*/ ++ ++#if !defined(CONFIG_INTERRUPT_BASED_TXBCN) ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++#ifdef CONFIG_SWTIMER_BASED_TXBCN ++ if (pdvobj->nr_ap_if == 1) { ++ RTW_INFO("start SW BCN TIMER!\n"); ++ _set_timer(&pdvobj->txbcn_timer, bcn_interval); ++ } ++#else ++ /* other case will tx beacon when bcn interrupt coming in. */ ++ if (send_beacon(padapter) == _FAIL) ++ RTW_INFO("issue_beacon, fail!\n"); ++#endif ++#endif ++#endif /* !defined(CONFIG_INTERRUPT_BASED_TXBCN) */ ++ } ++ ++ /*Set EDCA param reg after update cur_wireless_mode & update_capinfo*/ ++ if (pregpriv->wifi_spec == 1) ++ rtw_set_hw_wmm_param(padapter); ++ ++ /*pmlmeext->bstart_bss = _TRUE;*/ ++} ++ ++int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) ++{ ++ int ret = _SUCCESS; ++ u8 *p; ++ u8 *pHT_caps_ie = NULL; ++ u8 *pHT_info_ie = NULL; ++ u16 cap, ht_cap = _FALSE; ++ uint ie_len = 0; ++ int group_cipher, pairwise_cipher; ++ u8 channel, network_type, supportRate[NDIS_802_11_LENGTH_RATES_EX]; ++ int supportRateNum = 0; ++ u8 OUI1[] = {0x00, 0x50, 0xf2, 0x01}; ++ u8 wps_oui[4] = {0x0, 0x50, 0xf2, 0x04}; ++ u8 WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ WLAN_BSSID_EX *pbss_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *ie = pbss_network->IEs; ++ u8 vht_cap = _FALSE; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 rf_num = 0; ++ ++ /* SSID */ ++ /* Supported rates */ ++ /* DS Params */ ++ /* WLAN_EID_COUNTRY */ ++ /* ERP Information element */ ++ /* Extended supported rates */ ++ /* WPA/WPA2 */ ++ /* Wi-Fi Wireless Multimedia Extensions */ ++ /* ht_capab, ht_oper */ ++ /* WPS IE */ ++ ++ RTW_INFO("%s, len=%d\n", __FUNCTION__, len); ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ return _FAIL; ++ ++ ++ if (len > MAX_IE_SZ) ++ return _FAIL; ++ ++ pbss_network->IELength = len; ++ ++ _rtw_memset(ie, 0, MAX_IE_SZ); ++ ++ _rtw_memcpy(ie, pbuf, pbss_network->IELength); ++ ++ ++ if (pbss_network->InfrastructureMode != Ndis802_11APMode) ++ return _FAIL; ++ ++ ++ rtw_ap_check_scan(padapter); ++ ++ ++ pbss_network->Rssi = 0; ++ ++ _rtw_memcpy(pbss_network->MacAddress, adapter_mac_addr(padapter), ETH_ALEN); ++ ++ /* beacon interval */ ++ p = rtw_get_beacon_interval_from_ie(ie);/* ie + 8; */ /* 8: TimeStamp, 2: Beacon Interval 2:Capability */ ++ /* pbss_network->Configuration.BeaconPeriod = le16_to_cpu(*(unsigned short*)p); */ ++ pbss_network->Configuration.BeaconPeriod = RTW_GET_LE16(p); ++ ++ /* capability */ ++ /* cap = *(unsigned short *)rtw_get_capability_from_ie(ie); */ ++ /* cap = le16_to_cpu(cap); */ ++ cap = RTW_GET_LE16(ie); ++ ++ /* SSID */ ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _SSID_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if (p && ie_len > 0) { ++ _rtw_memset(&pbss_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); ++ _rtw_memcpy(pbss_network->Ssid.Ssid, (p + 2), ie_len); ++ pbss_network->Ssid.SsidLength = ie_len; ++#ifdef CONFIG_P2P ++ _rtw_memcpy(padapter->wdinfo.p2p_group_ssid, pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength); ++ padapter->wdinfo.p2p_group_ssid_len = pbss_network->Ssid.SsidLength; ++#endif ++ } ++ ++ /* chnnel */ ++ channel = 0; ++ pbss_network->Configuration.Length = 0; ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _DSSET_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if (p && ie_len > 0) ++ channel = *(p + 2); ++ ++ pbss_network->Configuration.DSConfig = channel; ++ ++ ++ _rtw_memset(supportRate, 0, NDIS_802_11_LENGTH_RATES_EX); ++ /* get supported rates */ ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if (p != NULL) { ++ _rtw_memcpy(supportRate, p + 2, ie_len); ++ supportRateNum = ie_len; ++ } ++ ++ /* get ext_supported rates */ ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ie_len, pbss_network->IELength - _BEACON_IE_OFFSET_); ++ if (p != NULL) { ++ _rtw_memcpy(supportRate + supportRateNum, p + 2, ie_len); ++ supportRateNum += ie_len; ++ ++ } ++ ++ network_type = rtw_check_network_type(supportRate, supportRateNum, channel); ++ ++ rtw_set_supported_rate(pbss_network->SupportedRates, network_type); ++ ++ ++ /* parsing ERP_IE */ ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _ERPINFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if (p && ie_len > 0) ++ ERP_IE_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)p); ++ ++ /* update privacy/security */ ++ if (cap & BIT(4)) ++ pbss_network->Privacy = 1; ++ else ++ pbss_network->Privacy = 0; ++ ++ psecuritypriv->wpa_psk = 0; ++ ++ /* wpa2 */ ++ group_cipher = 0; ++ pairwise_cipher = 0; ++ psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_; ++ psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_; ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if (p && ie_len > 0) { ++ if (rtw_parse_wpa2_ie(p, ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ ++ psecuritypriv->dot8021xalg = 1;/* psk, todo:802.1x */ ++ psecuritypriv->wpa_psk |= BIT(1); ++ ++ psecuritypriv->wpa2_group_cipher = group_cipher; ++ psecuritypriv->wpa2_pairwise_cipher = pairwise_cipher; ++#if 0 ++ switch (group_cipher) { ++ case WPA_CIPHER_NONE: ++ psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_; ++ break; ++ case WPA_CIPHER_WEP40: ++ psecuritypriv->wpa2_group_cipher = _WEP40_; ++ break; ++ case WPA_CIPHER_TKIP: ++ psecuritypriv->wpa2_group_cipher = _TKIP_; ++ break; ++ case WPA_CIPHER_CCMP: ++ psecuritypriv->wpa2_group_cipher = _AES_; ++ break; ++ case WPA_CIPHER_WEP104: ++ psecuritypriv->wpa2_group_cipher = _WEP104_; ++ break; ++ } ++ ++ switch (pairwise_cipher) { ++ case WPA_CIPHER_NONE: ++ psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_; ++ break; ++ case WPA_CIPHER_WEP40: ++ psecuritypriv->wpa2_pairwise_cipher = _WEP40_; ++ break; ++ case WPA_CIPHER_TKIP: ++ psecuritypriv->wpa2_pairwise_cipher = _TKIP_; ++ break; ++ case WPA_CIPHER_CCMP: ++ psecuritypriv->wpa2_pairwise_cipher = _AES_; ++ break; ++ case WPA_CIPHER_WEP104: ++ psecuritypriv->wpa2_pairwise_cipher = _WEP104_; ++ break; ++ } ++#endif ++ } ++ ++ } ++ ++ /* wpa */ ++ ie_len = 0; ++ group_cipher = 0; ++ pairwise_cipher = 0; ++ psecuritypriv->wpa_group_cipher = _NO_PRIVACY_; ++ psecuritypriv->wpa_pairwise_cipher = _NO_PRIVACY_; ++ for (p = ie + _BEACON_IE_OFFSET_; ; p += (ie_len + 2)) { ++ p = rtw_get_ie(p, _SSN_IE_1_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); ++ if ((p) && (_rtw_memcmp(p + 2, OUI1, 4))) { ++ if (rtw_parse_wpa_ie(p, ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ ++ psecuritypriv->dot8021xalg = 1;/* psk, todo:802.1x */ ++ ++ psecuritypriv->wpa_psk |= BIT(0); ++ ++ psecuritypriv->wpa_group_cipher = group_cipher; ++ psecuritypriv->wpa_pairwise_cipher = pairwise_cipher; ++ ++#if 0 ++ switch (group_cipher) { ++ case WPA_CIPHER_NONE: ++ psecuritypriv->wpa_group_cipher = _NO_PRIVACY_; ++ break; ++ case WPA_CIPHER_WEP40: ++ psecuritypriv->wpa_group_cipher = _WEP40_; ++ break; ++ case WPA_CIPHER_TKIP: ++ psecuritypriv->wpa_group_cipher = _TKIP_; ++ break; ++ case WPA_CIPHER_CCMP: ++ psecuritypriv->wpa_group_cipher = _AES_; ++ break; ++ case WPA_CIPHER_WEP104: ++ psecuritypriv->wpa_group_cipher = _WEP104_; ++ break; ++ } ++ ++ switch (pairwise_cipher) { ++ case WPA_CIPHER_NONE: ++ psecuritypriv->wpa_pairwise_cipher = _NO_PRIVACY_; ++ break; ++ case WPA_CIPHER_WEP40: ++ psecuritypriv->wpa_pairwise_cipher = _WEP40_; ++ break; ++ case WPA_CIPHER_TKIP: ++ psecuritypriv->wpa_pairwise_cipher = _TKIP_; ++ break; ++ case WPA_CIPHER_CCMP: ++ psecuritypriv->wpa_pairwise_cipher = _AES_; ++ break; ++ case WPA_CIPHER_WEP104: ++ psecuritypriv->wpa_pairwise_cipher = _WEP104_; ++ break; ++ } ++#endif ++ } ++ ++ break; ++ ++ } ++ ++ if ((p == NULL) || (ie_len == 0)) ++ break; ++ ++ } ++ ++ /* wmm */ ++ ie_len = 0; ++ pmlmepriv->qospriv.qos_option = 0; ++ if (pregistrypriv->wmm_enable) { ++ for (p = ie + _BEACON_IE_OFFSET_; ; p += (ie_len + 2)) { ++ p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); ++ if ((p) && _rtw_memcmp(p + 2, WMM_PARA_IE, 6)) { ++ pmlmepriv->qospriv.qos_option = 1; ++ ++ *(p + 8) |= BIT(7); /* QoS Info, support U-APSD */ ++ ++ /* disable all ACM bits since the WMM admission control is not supported */ ++ *(p + 10) &= ~BIT(4); /* BE */ ++ *(p + 14) &= ~BIT(4); /* BK */ ++ *(p + 18) &= ~BIT(4); /* VI */ ++ *(p + 22) &= ~BIT(4); /* VO */ ++ ++ break; ++ } ++ ++ if ((p == NULL) || (ie_len == 0)) ++ break; ++ } ++ } ++#ifdef CONFIG_80211N_HT ++ /* parsing HT_CAP_IE */ ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if (p && ie_len > 0) { ++ u8 rf_type = 0; ++ HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor = MAX_AMPDU_FACTOR_64K; ++ struct rtw_ieee80211_ht_cap *pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); ++ ++ if (0) { ++ RTW_INFO(FUNC_ADPT_FMT" HT_CAP_IE from upper layer:\n", FUNC_ADPT_ARG(padapter)); ++ dump_ht_cap_ie_content(RTW_DBGDUMP, p + 2, ie_len); ++ } ++ ++ pHT_caps_ie = p; ++ ++ ht_cap = _TRUE; ++ network_type |= WIRELESS_11_24N; ++ ++ rtw_ht_use_default_setting(padapter); ++ ++ /* Update HT Capabilities Info field */ ++ if (pmlmepriv->htpriv.sgi_20m == _FALSE) ++ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_SGI_20); ++ ++ if (pmlmepriv->htpriv.sgi_40m == _FALSE) ++ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_SGI_40); ++ ++ if (!TEST_FLAG(pmlmepriv->htpriv.ldpc_cap, LDPC_HT_ENABLE_RX)) ++ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_LDPC_CODING); ++ ++ if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_TX)) ++ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_TX_STBC); ++ ++ if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_RX)) ++ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_RX_STBC_3R); ++ ++ /* Update A-MPDU Parameters field */ ++ pht_cap->ampdu_params_info &= ~(IEEE80211_HT_CAP_AMPDU_FACTOR | IEEE80211_HT_CAP_AMPDU_DENSITY); ++ ++ if ((psecuritypriv->wpa_pairwise_cipher & WPA_CIPHER_CCMP) || ++ (psecuritypriv->wpa2_pairwise_cipher & WPA_CIPHER_CCMP)) ++ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & (0x07 << 2)); ++ else ++ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & 0x00); ++ ++ rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); ++ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_FACTOR & max_rx_ampdu_factor); /* set Max Rx AMPDU size to 64K */ ++ ++ _rtw_memcpy(&(pmlmeinfo->HT_caps), pht_cap, sizeof(struct HT_caps_element)); ++ ++ /* Update Supported MCS Set field */ ++ { ++ int i; ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ /* RX MCS Bitmask */ ++ switch (rf_type) { ++ case RF_1T1R: ++ case RF_1T2R: /* ? */ ++ set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_1R); ++ break; ++ case RF_2T2R: ++ set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_2R); ++ break; ++ case RF_3T3R: ++ set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_3R); ++ break; ++ default: ++ RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); ++ } ++ for (i = 0; i < 10; i++) ++ *(HT_CAP_ELE_RX_MCS_MAP(pht_cap) + i) &= padapter->mlmeextpriv.default_supported_mcs_set[i]; ++ } ++ ++#ifdef CONFIG_BEAMFORMING ++ /* Use registry value to enable HT Beamforming. */ ++ /* ToDo: use configure file to set these capability. */ ++ pht_cap->tx_BF_cap_info = 0; ++ ++ /* HT Beamformer */ ++ if (TEST_FLAG(pmlmepriv->htpriv.beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { ++ /* Transmit NDP Capable */ ++ SET_HT_CAP_TXBF_TRANSMIT_NDP_CAP(pht_cap, 1); ++ /* Explicit Compressed Steering Capable */ ++ SET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pht_cap, 1); ++ /* Compressed Steering Number Antennas */ ++ SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pht_cap, 1); ++ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMER_CAP, (u8 *)&rf_num); ++ SET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(pht_cap, rf_num); ++ } ++ ++ /* HT Beamformee */ ++ if (TEST_FLAG(pmlmepriv->htpriv.beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) { ++ /* Receive NDP Capable */ ++ SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(pht_cap, 1); ++ /* Explicit Compressed Beamforming Feedback Capable */ ++ SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(pht_cap, 2); ++ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); ++ SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pht_cap, rf_num); ++ } ++#endif /* CONFIG_BEAMFORMING */ ++ ++ _rtw_memcpy(&pmlmepriv->htpriv.ht_cap, p + 2, ie_len); ++ ++ if (0) { ++ RTW_INFO(FUNC_ADPT_FMT" HT_CAP_IE driver masked:\n", FUNC_ADPT_ARG(padapter)); ++ dump_ht_cap_ie_content(RTW_DBGDUMP, p + 2, ie_len); ++ } ++ } ++ ++ /* parsing HT_INFO_IE */ ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if (p && ie_len > 0) ++ pHT_info_ie = p; ++#endif /* CONFIG_80211N_HT */ ++ switch (network_type) { ++ case WIRELESS_11B: ++ pbss_network->NetworkTypeInUse = Ndis802_11DS; ++ break; ++ case WIRELESS_11G: ++ case WIRELESS_11BG: ++ case WIRELESS_11G_24N: ++ case WIRELESS_11BG_24N: ++ pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; ++ break; ++ case WIRELESS_11A: ++ pbss_network->NetworkTypeInUse = Ndis802_11OFDM5; ++ break; ++ default: ++ pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; ++ break; ++ } ++ ++ pmlmepriv->cur_network.network_type = network_type; ++ ++#ifdef CONFIG_80211N_HT ++ pmlmepriv->htpriv.ht_option = _FALSE; ++ ++ if ((psecuritypriv->wpa2_pairwise_cipher & WPA_CIPHER_TKIP) || ++ (psecuritypriv->wpa_pairwise_cipher & WPA_CIPHER_TKIP)) { ++ /* todo: */ ++ /* ht_cap = _FALSE; */ ++ } ++ ++ /* ht_cap */ ++ if (pregistrypriv->ht_enable && ht_cap == _TRUE) { ++ pmlmepriv->htpriv.ht_option = _TRUE; ++ pmlmepriv->qospriv.qos_option = 1; ++ ++ pmlmepriv->htpriv.ampdu_enable = pregistrypriv->ampdu_enable ? _TRUE : _FALSE; ++ ++ HT_caps_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)pHT_caps_ie); ++ ++ HT_info_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)pHT_info_ie); ++ } ++#endif ++ ++#ifdef CONFIG_80211AC_VHT ++ ++ /* Parsing VHT CAP IE */ ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, EID_VHTCapability, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if (p && ie_len > 0) ++ vht_cap = _TRUE; ++ /* Parsing VHT OPERATION IE */ ++ ++ ++ pmlmepriv->vhtpriv.vht_option = _FALSE; ++ /* if channel in 5G band, then add vht ie . */ ++ if ((pbss_network->Configuration.DSConfig > 14) ++ && (pmlmepriv->htpriv.ht_option == _TRUE) ++ && REGSTY_IS_11AC_ENABLE(pregistrypriv) ++ && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) ++ && (!pmlmepriv->country_ent || COUNTRY_CHPLAN_EN_11AC(pmlmepriv->country_ent)) ++ ) { ++ if (vht_cap == _TRUE) ++ pmlmepriv->vhtpriv.vht_option = _TRUE; ++ else if (REGSTY_IS_11AC_AUTO(pregistrypriv)) { ++ u8 cap_len, operation_len; ++ ++ rtw_vht_use_default_setting(padapter); ++ ++ { ++ /* VHT Operation mode notifiy bit in Extended IE (127) */ ++ uint len = 0; ++ ++ SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(pmlmepriv->ext_capab_ie_data, 1); ++ pmlmepriv->ext_capab_ie_len = 10; ++ rtw_set_ie(pbss_network->IEs + pbss_network->IELength, EID_EXTCapability, 8, pmlmepriv->ext_capab_ie_data, &len); ++ pbss_network->IELength += pmlmepriv->ext_capab_ie_len; ++ } ++ ++ /* VHT Capabilities element */ ++ cap_len = rtw_build_vht_cap_ie(padapter, pbss_network->IEs + pbss_network->IELength); ++ pbss_network->IELength += cap_len; ++ ++ /* VHT Operation element */ ++ operation_len = rtw_build_vht_operation_ie(padapter, pbss_network->IEs + pbss_network->IELength, pbss_network->Configuration.DSConfig); ++ pbss_network->IELength += operation_len; ++ ++ pmlmepriv->vhtpriv.vht_option = _TRUE; ++ } ++ } ++#endif /* CONFIG_80211AC_VHT */ ++ ++ if(pbss_network->Configuration.DSConfig <= 14 && padapter->registrypriv.wifi_spec == 1) { ++ uint len = 0; ++#ifdef CONFIG_80211N_HT ++ SET_EXT_CAPABILITY_ELE_BSS_COEXIST(pmlmepriv->ext_capab_ie_data, 1); ++#endif /* CONFIG_80211N_HT */ ++ pmlmepriv->ext_capab_ie_len = 10; ++ rtw_set_ie(pbss_network->IEs + pbss_network->IELength, EID_EXTCapability, 8, pmlmepriv->ext_capab_ie_data, &len); ++ pbss_network->IELength += pmlmepriv->ext_capab_ie_len; ++ } ++ ++ pbss_network->Length = get_WLAN_BSSID_EX_sz((WLAN_BSSID_EX *)pbss_network); ++ ++ rtw_ies_get_chbw(pbss_network->IEs + _BEACON_IE_OFFSET_, pbss_network->IELength - _BEACON_IE_OFFSET_ ++ , &pmlmepriv->ori_ch, &pmlmepriv->ori_bw, &pmlmepriv->ori_offset); ++ rtw_warn_on(pmlmepriv->ori_ch == 0); ++ ++ { ++ /* alloc sta_info for ap itself */ ++ ++ struct sta_info *sta; ++ ++ sta = rtw_get_stainfo(&padapter->stapriv, pbss_network->MacAddress); ++ if (!sta) { ++ sta = rtw_alloc_stainfo(&padapter->stapriv, pbss_network->MacAddress); ++ if (sta == NULL) ++ return _FAIL; ++ } ++ } ++ ++ rtw_startbss_cmd(padapter, RTW_CMDF_WAIT_ACK); ++ { ++ int sk_band = RTW_GET_SCAN_BAND_SKIP(padapter); ++ ++ if (sk_band) ++ RTW_CLR_SCAN_BAND_SKIP(padapter, sk_band); ++ } ++ ++ rtw_indicate_connect(padapter); ++ ++ pmlmepriv->cur_network.join_res = _TRUE;/* for check if already set beacon */ ++ ++ /* update bc/mc sta_info */ ++ /* update_bmc_sta(padapter); */ ++ ++ return ret; ++ ++} ++ ++#if CONFIG_RTW_MACADDR_ACL ++void rtw_macaddr_acl_init(_adapter *adapter) ++{ ++ struct sta_priv *stapriv = &adapter->stapriv; ++ struct wlan_acl_pool *acl = &stapriv->acl_list; ++ _queue *acl_node_q = &acl->acl_node_q; ++ int i; ++ _irqL irqL; ++ ++ _enter_critical_bh(&(acl_node_q->lock), &irqL); ++ _rtw_init_listhead(&(acl_node_q->queue)); ++ acl->num = 0; ++ acl->mode = RTW_ACL_MODE_DISABLED; ++ for (i = 0; i < NUM_ACL; i++) { ++ _rtw_init_listhead(&acl->aclnode[i].list); ++ acl->aclnode[i].valid = _FALSE; ++ } ++ _exit_critical_bh(&(acl_node_q->lock), &irqL); ++} ++ ++void rtw_macaddr_acl_deinit(_adapter *adapter) ++{ ++ struct sta_priv *stapriv = &adapter->stapriv; ++ struct wlan_acl_pool *acl = &stapriv->acl_list; ++ _queue *acl_node_q = &acl->acl_node_q; ++ _irqL irqL; ++ _list *head, *list; ++ struct rtw_wlan_acl_node *acl_node; ++ ++ _enter_critical_bh(&(acl_node_q->lock), &irqL); ++ head = get_list_head(acl_node_q); ++ list = get_next(head); ++ while (rtw_end_of_queue_search(head, list) == _FALSE) { ++ acl_node = LIST_CONTAINOR(list, struct rtw_wlan_acl_node, list); ++ list = get_next(list); ++ ++ if (acl_node->valid == _TRUE) { ++ acl_node->valid = _FALSE; ++ rtw_list_delete(&acl_node->list); ++ acl->num--; ++ } ++ } ++ _exit_critical_bh(&(acl_node_q->lock), &irqL); ++ ++ rtw_warn_on(acl->num); ++ acl->mode = RTW_ACL_MODE_DISABLED; ++} ++ ++void rtw_set_macaddr_acl(_adapter *adapter, int mode) ++{ ++ struct sta_priv *stapriv = &adapter->stapriv; ++ struct wlan_acl_pool *acl = &stapriv->acl_list; ++ ++ RTW_INFO(FUNC_ADPT_FMT" mode=%d\n", FUNC_ADPT_ARG(adapter), mode); ++ ++ acl->mode = mode; ++ ++ if (mode == RTW_ACL_MODE_DISABLED) ++ rtw_macaddr_acl_deinit(adapter); ++} ++ ++int rtw_acl_add_sta(_adapter *adapter, const u8 *addr) ++{ ++ _irqL irqL; ++ _list *list, *head; ++ u8 existed = 0; ++ int i = -1, ret = 0; ++ struct rtw_wlan_acl_node *acl_node; ++ struct sta_priv *stapriv = &adapter->stapriv; ++ struct wlan_acl_pool *acl = &stapriv->acl_list; ++ _queue *acl_node_q = &acl->acl_node_q; ++ ++ _enter_critical_bh(&(acl_node_q->lock), &irqL); ++ ++ head = get_list_head(acl_node_q); ++ list = get_next(head); ++ ++ /* search for existed entry */ ++ while (rtw_end_of_queue_search(head, list) == _FALSE) { ++ acl_node = LIST_CONTAINOR(list, struct rtw_wlan_acl_node, list); ++ list = get_next(list); ++ ++ if (_rtw_memcmp(acl_node->addr, addr, ETH_ALEN)) { ++ if (acl_node->valid == _TRUE) { ++ existed = 1; ++ break; ++ } ++ } ++ } ++ if (existed) ++ goto release_lock; ++ ++ if (acl->num >= NUM_ACL) ++ goto release_lock; ++ ++ /* find empty one and use */ ++ for (i = 0; i < NUM_ACL; i++) { ++ ++ acl_node = &acl->aclnode[i]; ++ if (acl_node->valid == _FALSE) { ++ ++ _rtw_init_listhead(&acl_node->list); ++ _rtw_memcpy(acl_node->addr, addr, ETH_ALEN); ++ acl_node->valid = _TRUE; ++ ++ rtw_list_insert_tail(&acl_node->list, get_list_head(acl_node_q)); ++ acl->num++; ++ break; ++ } ++ } ++ ++release_lock: ++ _exit_critical_bh(&(acl_node_q->lock), &irqL); ++ ++ if (!existed && (i < 0 || i >= NUM_ACL)) ++ ret = -1; ++ ++ RTW_INFO(FUNC_ADPT_FMT" "MAC_FMT" %s (acl_num=%d)\n" ++ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr) ++ , (existed ? "existed" : ((i < 0 || i >= NUM_ACL) ? "no room" : "added")) ++ , acl->num); ++ ++ return ret; ++} ++ ++int rtw_acl_remove_sta(_adapter *adapter, const u8 *addr) ++{ ++ _irqL irqL; ++ _list *list, *head; ++ int ret = 0; ++ struct rtw_wlan_acl_node *acl_node; ++ struct sta_priv *stapriv = &adapter->stapriv; ++ struct wlan_acl_pool *acl = &stapriv->acl_list; ++ _queue *acl_node_q = &acl->acl_node_q; ++ u8 is_baddr = is_broadcast_mac_addr(addr); ++ u8 match = 0; ++ ++ _enter_critical_bh(&(acl_node_q->lock), &irqL); ++ ++ head = get_list_head(acl_node_q); ++ list = get_next(head); ++ ++ while (rtw_end_of_queue_search(head, list) == _FALSE) { ++ acl_node = LIST_CONTAINOR(list, struct rtw_wlan_acl_node, list); ++ list = get_next(list); ++ ++ if (is_baddr || _rtw_memcmp(acl_node->addr, addr, ETH_ALEN)) { ++ if (acl_node->valid == _TRUE) { ++ acl_node->valid = _FALSE; ++ rtw_list_delete(&acl_node->list); ++ acl->num--; ++ match = 1; ++ } ++ } ++ } ++ ++ _exit_critical_bh(&(acl_node_q->lock), &irqL); ++ ++ RTW_INFO(FUNC_ADPT_FMT" "MAC_FMT" %s (acl_num=%d)\n" ++ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr) ++ , is_baddr ? "clear all" : (match ? "match" : "no found") ++ , acl->num); ++ ++ return ret; ++} ++#endif /* CONFIG_RTW_MACADDR_ACL */ ++ ++u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta) ++{ ++ struct cmd_obj *ph2c; ++ struct set_stakey_parm *psetstakey_para; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ psetstakey_para = (struct set_stakey_parm *)rtw_zmalloc(sizeof(struct set_stakey_parm)); ++ if (psetstakey_para == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); ++ ++ ++ psetstakey_para->algorithm = (u8)psta->dot118021XPrivacy; ++ ++ _rtw_memcpy(psetstakey_para->addr, psta->hwaddr, ETH_ALEN); ++ ++ _rtw_memcpy(psetstakey_para->key, &psta->dot118021x_UncstKey, 16); ++ ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ return res; ++ ++} ++ ++static int rtw_ap_set_key(_adapter *padapter, u8 *key, u8 alg, int keyid, u8 set_tx) ++{ ++ u8 keylen; ++ struct cmd_obj *pcmd; ++ struct setkey_parm *psetkeyparm; ++ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); ++ int res = _SUCCESS; ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmd == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ psetkeyparm = (struct setkey_parm *)rtw_zmalloc(sizeof(struct setkey_parm)); ++ if (psetkeyparm == NULL) { ++ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ _rtw_memset(psetkeyparm, 0, sizeof(struct setkey_parm)); ++ ++ psetkeyparm->keyid = (u8)keyid; ++ if (is_wep_enc(alg)) ++ padapter->securitypriv.key_mask |= BIT(psetkeyparm->keyid); ++ ++ psetkeyparm->algorithm = alg; ++ ++ psetkeyparm->set_tx = set_tx; ++ ++ switch (alg) { ++ case _WEP40_: ++ keylen = 5; ++ break; ++ case _WEP104_: ++ keylen = 13; ++ break; ++ case _TKIP_: ++ case _TKIP_WTMIC_: ++ case _AES_: ++ default: ++ keylen = 16; ++ } ++ ++ _rtw_memcpy(&(psetkeyparm->key[0]), key, keylen); ++ ++ pcmd->cmdcode = _SetKey_CMD_; ++ pcmd->parmbuf = (u8 *)psetkeyparm; ++ pcmd->cmdsz = (sizeof(struct setkey_parm)); ++ pcmd->rsp = NULL; ++ pcmd->rspsz = 0; ++ ++ ++ _rtw_init_listhead(&pcmd->list); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, pcmd); ++ ++exit: ++ ++ return res; ++} ++ ++int rtw_ap_set_group_key(_adapter *padapter, u8 *key, u8 alg, int keyid) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ return rtw_ap_set_key(padapter, key, alg, keyid, 1); ++} ++ ++int rtw_ap_set_wep_key(_adapter *padapter, u8 *key, u8 keylen, int keyid, u8 set_tx) ++{ ++ u8 alg; ++ ++ switch (keylen) { ++ case 5: ++ alg = _WEP40_; ++ break; ++ case 13: ++ alg = _WEP104_; ++ break; ++ default: ++ alg = _NO_PRIVACY_; ++ } ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ return rtw_ap_set_key(padapter, key, alg, keyid, set_tx); ++} ++ ++u8 rtw_ap_bmc_frames_hdl(_adapter *padapter) ++{ ++#define HIQ_XMIT_COUNTS (6) ++ _irqL irqL; ++ struct sta_info *psta_bmc; ++ _list *xmitframe_plist, *xmitframe_phead; ++ struct xmit_frame *pxmitframe = NULL; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ bool update_tim = _FALSE; ++ ++ ++ if (padapter->registrypriv.wifi_spec != 1) ++ return H2C_SUCCESS; ++ ++ ++ psta_bmc = rtw_get_bcmc_stainfo(padapter); ++ if (!psta_bmc) ++ return H2C_SUCCESS; ++ ++ ++ _enter_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ if ((pstapriv->tim_bitmap & BIT(0)) && (psta_bmc->sleepq_len > 0)) { ++ int tx_counts = 0; ++ ++ _update_beacon(padapter, _TIM_IE_, NULL, _FALSE, "update TIM with TIB=1"); ++ ++ RTW_INFO("sleepq_len of bmc_sta = %d\n", psta_bmc->sleepq_len); ++ ++ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); ++ xmitframe_plist = get_next(xmitframe_phead); ++ ++ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { ++ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); ++ ++ xmitframe_plist = get_next(xmitframe_plist); ++ ++ rtw_list_delete(&pxmitframe->list); ++ ++ psta_bmc->sleepq_len--; ++ tx_counts++; ++ ++ if (psta_bmc->sleepq_len > 0) ++ pxmitframe->attrib.mdata = 1; ++ else ++ pxmitframe->attrib.mdata = 0; ++ ++ if (tx_counts == HIQ_XMIT_COUNTS) ++ pxmitframe->attrib.mdata = 0; ++ ++ pxmitframe->attrib.triggered = 1; ++ ++ if (xmitframe_hiq_filter(pxmitframe) == _TRUE) ++ pxmitframe->attrib.qsel = QSLT_HIGH;/*HIQ*/ ++ ++ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); ++ ++ if (tx_counts == HIQ_XMIT_COUNTS) ++ break; ++ ++ } ++ ++ } else { ++ if (psta_bmc->sleepq_len == 0) { ++ ++ /*RTW_INFO("sleepq_len of bmc_sta = %d\n", psta_bmc->sleepq_len);*/ ++ ++ if (pstapriv->tim_bitmap & BIT(0)) ++ update_tim = _TRUE; ++ ++ pstapriv->tim_bitmap &= ~BIT(0); ++ pstapriv->sta_dz_bitmap &= ~BIT(0); ++ ++ if (update_tim == _TRUE) { ++ RTW_INFO("clear TIB\n"); ++ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "bmc sleepq and HIQ empty"); ++ } ++ } ++ } ++ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ ++#if 0 ++ /* HIQ Check */ ++ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); ++ ++ while (_FALSE == empty && rtw_get_passing_time_ms(start) < 3000) { ++ rtw_msleep_os(100); ++ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); ++ } ++ ++ ++ printk("check if hiq empty=%d\n", empty); ++#endif ++ ++ return H2C_SUCCESS; ++} ++ ++#ifdef CONFIG_NATIVEAP_MLME ++ ++static void associated_stainfo_update(_adapter *padapter, struct sta_info *psta, u32 sta_info_type) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ RTW_INFO("%s: "MAC_FMT", updated_type=0x%x\n", __func__, MAC_ARG(psta->hwaddr), sta_info_type); ++ ++ if (sta_info_type & STA_INFO_UPDATE_BW) { ++#ifdef CONFIG_80211N_HT ++ if ((psta->flags & WLAN_STA_HT) && !psta->ht_20mhz_set) { ++ if (pmlmepriv->sw_to_20mhz) { ++ psta->bw_mode = CHANNEL_WIDTH_20; ++ /*psta->htpriv.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;*/ ++ psta->htpriv.sgi_40m = _FALSE; ++ } else { ++ /*TODO: Switch back to 40MHZ?80MHZ*/ ++ } ++ } ++#endif /* CONFIG_80211N_HT */ ++ } ++ ++ /* ++ if (sta_info_type & STA_INFO_UPDATE_RATE) { ++ ++ } ++ */ ++ ++ if (sta_info_type & STA_INFO_UPDATE_PROTECTION_MODE) ++ VCS_update(padapter, psta); ++ ++ /* ++ if (sta_info_type & STA_INFO_UPDATE_CAP) { ++ ++ } ++ ++ if (sta_info_type & STA_INFO_UPDATE_HT_CAP) { ++ ++ } ++ ++ if (sta_info_type & STA_INFO_UPDATE_VHT_CAP) { ++ ++ } ++ */ ++ ++} ++ ++static void update_bcn_ext_capab_ie(_adapter *padapter) ++{ ++ sint ie_len = 0; ++ unsigned char *pbuf; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); ++ u8 *ie = pnetwork->IEs; ++ u8 null_extcap_data[8] = {0}; ++ ++ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_CAP_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); ++ if (pbuf && ie_len > 0) ++ rtw_remove_bcn_ie(padapter, pnetwork, _EXT_CAP_IE_); ++ ++ if ((pmlmepriv->ext_capab_ie_len > 0) && ++ (_rtw_memcmp(pmlmepriv->ext_capab_ie_data, null_extcap_data, sizeof(null_extcap_data)) == _FALSE)) ++ rtw_add_bcn_ie(padapter, pnetwork, _EXT_CAP_IE_, pmlmepriv->ext_capab_ie_data, pmlmepriv->ext_capab_ie_len); ++ ++} ++ ++static void update_bcn_fixed_ie(_adapter *padapter) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++} ++ ++static void update_bcn_erpinfo_ie(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); ++ unsigned char *p, *ie = pnetwork->IEs; ++ u32 len = 0; ++ ++ RTW_INFO("%s, ERP_enable=%d\n", __FUNCTION__, pmlmeinfo->ERP_enable); ++ ++ if (!pmlmeinfo->ERP_enable) ++ return; ++ ++ /* parsing ERP_IE */ ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _ERPINFO_IE_, &len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); ++ if (p && len > 0) { ++ PNDIS_802_11_VARIABLE_IEs pIE = (PNDIS_802_11_VARIABLE_IEs)p; ++ ++ if (pmlmepriv->num_sta_non_erp == 1) ++ pIE->data[0] |= RTW_ERP_INFO_NON_ERP_PRESENT | RTW_ERP_INFO_USE_PROTECTION; ++ else ++ pIE->data[0] &= ~(RTW_ERP_INFO_NON_ERP_PRESENT | RTW_ERP_INFO_USE_PROTECTION); ++ ++ if (pmlmepriv->num_sta_no_short_preamble > 0) ++ pIE->data[0] |= RTW_ERP_INFO_BARKER_PREAMBLE_MODE; ++ else ++ pIE->data[0] &= ~(RTW_ERP_INFO_BARKER_PREAMBLE_MODE); ++ ++ ERP_IE_handler(padapter, pIE); ++ } ++ ++} ++ ++#ifdef CONFIG_80211N_HT ++static void update_bcn_htcap_ie(_adapter *padapter) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++} ++ ++static void update_bcn_htinfo_ie(_adapter *padapter) ++{ ++ /* ++ u8 beacon_updated = _FALSE; ++ u32 sta_info_update_type = STA_INFO_UPDATE_NONE; ++ */ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); ++ unsigned char *p, *ie = pnetwork->IEs; ++ u32 len = 0; ++ ++ if (pmlmepriv->htpriv.ht_option == _FALSE) ++ return; ++ ++ if (pmlmeinfo->HT_info_enable != 1) ++ return; ++ ++ ++ RTW_INFO("%s current operation mode=0x%X\n", ++ __FUNCTION__, pmlmepriv->ht_op_mode); ++ ++ RTW_INFO("num_sta_40mhz_intolerant(%d), 20mhz_width_req(%d), intolerant_ch_rpt(%d), olbc(%d)\n", ++ pmlmepriv->num_sta_40mhz_intolerant, pmlmepriv->ht_20mhz_width_req, pmlmepriv->ht_intolerant_ch_reported, ATOMIC_READ(&pmlmepriv->olbc)); ++ ++ /*parsing HT_INFO_IE, currently only update ht_op_mode - pht_info->infos[1] & pht_info->infos[2] for wifi logo test*/ ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); ++ if (p && len > 0) { ++ struct HT_info_element *pht_info = NULL; ++ ++ pht_info = (struct HT_info_element *)(p + 2); ++ ++ /* for STA Channel Width/Secondary Channel Offset*/ ++ if ((pmlmepriv->sw_to_20mhz == 0) && (pmlmeext->cur_channel <= 14)) { ++ if ((pmlmepriv->num_sta_40mhz_intolerant > 0) || (pmlmepriv->ht_20mhz_width_req == _TRUE) ++ || (pmlmepriv->ht_intolerant_ch_reported == _TRUE) || (ATOMIC_READ(&pmlmepriv->olbc) == _TRUE)) { ++ SET_HT_OP_ELE_2ND_CHL_OFFSET(pht_info, 0); ++ SET_HT_OP_ELE_STA_CHL_WIDTH(pht_info, 0); ++ ++ pmlmepriv->sw_to_20mhz = 1; ++ /* ++ sta_info_update_type |= STA_INFO_UPDATE_BW; ++ beacon_updated = _TRUE; ++ */ ++ ++ RTW_INFO("%s:switching to 20Mhz\n", __FUNCTION__); ++ ++ /*TODO : cur_bwmode/cur_ch_offset switches to 20Mhz*/ ++ } ++ } else { ++ ++ if ((pmlmepriv->num_sta_40mhz_intolerant == 0) && (pmlmepriv->ht_20mhz_width_req == _FALSE) ++ && (pmlmepriv->ht_intolerant_ch_reported == _FALSE) && (ATOMIC_READ(&pmlmepriv->olbc) == _FALSE)) { ++ ++ if (pmlmeext->cur_bwmode >= CHANNEL_WIDTH_40) { ++ ++ SET_HT_OP_ELE_STA_CHL_WIDTH(pht_info, 1); ++ ++ SET_HT_OP_ELE_2ND_CHL_OFFSET(pht_info, ++ (pmlmeext->cur_ch_offset == HAL_PRIME_CHNL_OFFSET_LOWER) ? ++ HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE : HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW); ++ ++ pmlmepriv->sw_to_20mhz = 0; ++ /* ++ sta_info_update_type |= STA_INFO_UPDATE_BW; ++ beacon_updated = _TRUE; ++ */ ++ ++ RTW_INFO("%s:switching back to 40Mhz\n", __FUNCTION__); ++ } ++ } ++ } ++ ++ /* to update ht_op_mode*/ ++ *(u16 *)(pht_info->infos + 1) = cpu_to_le16(pmlmepriv->ht_op_mode); ++ ++ } ++ ++ /*associated_clients_update(padapter, beacon_updated, sta_info_update_type);*/ ++ ++} ++#endif /* CONFIG_80211N_HT */ ++ ++static void update_bcn_rsn_ie(_adapter *padapter) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++} ++ ++static void update_bcn_wpa_ie(_adapter *padapter) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++} ++ ++static void update_bcn_wmm_ie(_adapter *padapter) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++} ++ ++static void update_bcn_wps_ie(_adapter *padapter) ++{ ++ u8 *pwps_ie = NULL, *pwps_ie_src, *premainder_ie, *pbackup_remainder_ie = NULL; ++ uint wps_ielen = 0, wps_offset, remainder_ielen; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); ++ unsigned char *ie = pnetwork->IEs; ++ u32 ielen = pnetwork->IELength; ++ ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ pwps_ie = rtw_get_wps_ie(ie + _FIXED_IE_LENGTH_, ielen - _FIXED_IE_LENGTH_, NULL, &wps_ielen); ++ ++ if (pwps_ie == NULL || wps_ielen == 0) ++ return; ++ ++ pwps_ie_src = pmlmepriv->wps_beacon_ie; ++ if (pwps_ie_src == NULL) ++ return; ++ ++ wps_offset = (uint)(pwps_ie - ie); ++ ++ premainder_ie = pwps_ie + wps_ielen; ++ ++ remainder_ielen = ielen - wps_offset - wps_ielen; ++ ++ if (remainder_ielen > 0) { ++ pbackup_remainder_ie = rtw_malloc(remainder_ielen); ++ if (pbackup_remainder_ie) ++ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); ++ } ++ ++ wps_ielen = (uint)pwps_ie_src[1];/* to get ie data len */ ++ if ((wps_offset + wps_ielen + 2 + remainder_ielen) <= MAX_IE_SZ) { ++ _rtw_memcpy(pwps_ie, pwps_ie_src, wps_ielen + 2); ++ pwps_ie += (wps_ielen + 2); ++ ++ if (pbackup_remainder_ie) ++ _rtw_memcpy(pwps_ie, pbackup_remainder_ie, remainder_ielen); ++ ++ /* update IELength */ ++ pnetwork->IELength = wps_offset + (wps_ielen + 2) + remainder_ielen; ++ } ++ ++ if (pbackup_remainder_ie) ++ rtw_mfree(pbackup_remainder_ie, remainder_ielen); ++ ++ /* deal with the case without set_tx_beacon_cmd() in update_beacon() */ ++#if defined(CONFIG_INTERRUPT_BASED_TXBCN) || defined(CONFIG_PCI_HCI) ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { ++ u8 sr = 0; ++ rtw_get_wps_attr_content(pwps_ie_src, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8 *)(&sr), NULL); ++ ++ if (sr) { ++ set_fwstate(pmlmepriv, WIFI_UNDER_WPS); ++ RTW_INFO("%s, set WIFI_UNDER_WPS\n", __func__); ++ } ++ } ++#endif ++} ++ ++static void update_bcn_p2p_ie(_adapter *padapter) ++{ ++ ++} ++ ++static void update_bcn_vendor_spec_ie(_adapter *padapter, u8 *oui) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ if (_rtw_memcmp(RTW_WPA_OUI, oui, 4)) ++ update_bcn_wpa_ie(padapter); ++ else if (_rtw_memcmp(WMM_OUI, oui, 4)) ++ update_bcn_wmm_ie(padapter); ++ else if (_rtw_memcmp(WPS_OUI, oui, 4)) ++ update_bcn_wps_ie(padapter); ++ else if (_rtw_memcmp(P2P_OUI, oui, 4)) ++ update_bcn_p2p_ie(padapter); ++ else ++ RTW_INFO("unknown OUI type!\n"); ++ ++ ++} ++ ++void _update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx, const char *tag) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv; ++ struct mlme_ext_priv *pmlmeext; ++ /* struct mlme_ext_info *pmlmeinfo; */ ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ if (!padapter) ++ return; ++ ++ pmlmepriv = &(padapter->mlmepriv); ++ pmlmeext = &(padapter->mlmeextpriv); ++ /* pmlmeinfo = &(pmlmeext->mlmext_info); */ ++ ++ if (_FALSE == pmlmeext->bstart_bss) ++ return; ++ ++ _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); ++ ++ switch (ie_id) { ++ case 0xFF: ++ ++ update_bcn_fixed_ie(padapter);/* 8: TimeStamp, 2: Beacon Interval 2:Capability */ ++ ++ break; ++ ++ case _TIM_IE_: ++ ++ update_BCNTIM(padapter); ++ ++ break; ++ ++ case _ERPINFO_IE_: ++ ++ update_bcn_erpinfo_ie(padapter); ++ ++ break; ++ ++ case _HT_CAPABILITY_IE_: ++#ifdef CONFIG_80211N_HT ++ update_bcn_htcap_ie(padapter); ++#endif /*CONFIG_80211N_HT */ ++ break; ++ case _RSN_IE_2_: ++ ++ update_bcn_rsn_ie(padapter); ++ ++ break; ++ ++ case _HT_ADD_INFO_IE_: ++#ifdef CONFIG_80211N_HT ++ update_bcn_htinfo_ie(padapter); ++#endif /*CONFIG_80211N_HT */ ++ break; ++ ++ case _EXT_CAP_IE_: ++ ++ update_bcn_ext_capab_ie(padapter); ++ ++ break; ++ ++ case _VENDOR_SPECIFIC_IE_: ++ ++ update_bcn_vendor_spec_ie(padapter, oui); ++ ++ break; ++ ++ default: ++ break; ++ } ++ ++ pmlmepriv->update_bcn = _TRUE; ++ ++ _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); ++ ++#ifndef CONFIG_INTERRUPT_BASED_TXBCN ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ if (tx) { ++ /* send_beacon(padapter); */ /* send_beacon must execute on TSR level */ ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" ie_id:%u - %s\n", FUNC_ADPT_ARG(padapter), ie_id, tag); ++ set_tx_beacon_cmd(padapter); ++ } ++#else ++ { ++ /* PCI will issue beacon when BCN interrupt occurs. */ ++ } ++#endif ++#endif /* !CONFIG_INTERRUPT_BASED_TXBCN */ ++ ++} ++ ++#ifdef CONFIG_80211N_HT ++ ++void rtw_process_public_act_bsscoex(_adapter *padapter, u8 *pframe, uint frame_len) ++{ ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 beacon_updated = _FALSE; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); ++ uint frame_body_len = frame_len - sizeof(struct rtw_ieee80211_hdr_3addr); ++ u8 category, action; ++ ++ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ if (psta == NULL) ++ return; ++ ++ ++ category = frame_body[0]; ++ action = frame_body[1]; ++ ++ if (frame_body_len > 0) { ++ if ((frame_body[2] == EID_BSSCoexistence) && (frame_body[3] > 0)) { ++ u8 ie_data = frame_body[4]; ++ ++ if (ie_data & RTW_WLAN_20_40_BSS_COEX_40MHZ_INTOL) { ++ if (psta->ht_40mhz_intolerant == 0) { ++ psta->ht_40mhz_intolerant = 1; ++ pmlmepriv->num_sta_40mhz_intolerant++; ++ beacon_updated = _TRUE; ++ } ++ } else if (ie_data & RTW_WLAN_20_40_BSS_COEX_20MHZ_WIDTH_REQ) { ++ if (pmlmepriv->ht_20mhz_width_req == _FALSE) { ++ pmlmepriv->ht_20mhz_width_req = _TRUE; ++ beacon_updated = _TRUE; ++ } ++ } else ++ beacon_updated = _FALSE; ++ } ++ } ++ ++ if (frame_body_len > 8) { ++ /* if EID_BSSIntolerantChlReport ie exists */ ++ if ((frame_body[5] == EID_BSSIntolerantChlReport) && (frame_body[6] > 0)) { ++ /*todo:*/ ++ if (pmlmepriv->ht_intolerant_ch_reported == _FALSE) { ++ pmlmepriv->ht_intolerant_ch_reported = _TRUE; ++ beacon_updated = _TRUE; ++ } ++ } ++ } ++ ++ if (beacon_updated) { ++ ++ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); ++ ++ associated_stainfo_update(padapter, psta, STA_INFO_UPDATE_BW); ++ } ++ ++ ++ ++} ++ ++void rtw_process_ht_action_smps(_adapter *padapter, u8 *ta, u8 ctrl_field) ++{ ++ u8 e_field, m_field; ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ psta = rtw_get_stainfo(pstapriv, ta); ++ if (psta == NULL) ++ return; ++ ++ e_field = (ctrl_field & BIT(0)) ? 1 : 0; ++ m_field = (ctrl_field & BIT(1)) ? 1 : 0; ++ ++ if (e_field) { ++ ++ /* enable */ ++ /* 0:static SMPS, 1:dynamic SMPS, 3:SMPS disabled, 2:reserved*/ ++ ++ if (m_field) /*mode*/ ++ psta->htpriv.smps_cap = 1; ++ else ++ psta->htpriv.smps_cap = 0; ++ } else { ++ /*disable*/ ++ psta->htpriv.smps_cap = 3; ++ } ++ ++ rtw_dm_ra_mask_wk_cmd(padapter, (u8 *)psta); ++ ++} ++ ++/* ++op_mode ++Set to 0 (HT pure) under the followign conditions ++ - all STAs in the BSS are 20/40 MHz HT in 20/40 MHz BSS or ++ - all STAs in the BSS are 20 MHz HT in 20 MHz BSS ++Set to 1 (HT non-member protection) if there may be non-HT STAs ++ in both the primary and the secondary channel ++Set to 2 if only HT STAs are associated in BSS, ++ however and at least one 20 MHz HT STA is associated ++Set to 3 (HT mixed mode) when one or more non-HT STAs are associated ++ (currently non-GF HT station is considered as non-HT STA also) ++*/ ++int rtw_ht_operation_update(_adapter *padapter) ++{ ++ u16 cur_op_mode, new_op_mode; ++ int op_mode_changes = 0; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; ++ ++ if (pmlmepriv->htpriv.ht_option == _FALSE) ++ return 0; ++ ++ /*if (!iface->conf->ieee80211n || iface->conf->ht_op_mode_fixed) ++ return 0;*/ ++ ++ RTW_INFO("%s current operation mode=0x%X\n", ++ __FUNCTION__, pmlmepriv->ht_op_mode); ++ ++ if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT) ++ && pmlmepriv->num_sta_ht_no_gf) { ++ pmlmepriv->ht_op_mode |= ++ HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT; ++ op_mode_changes++; ++ } else if ((pmlmepriv->ht_op_mode & ++ HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT) && ++ pmlmepriv->num_sta_ht_no_gf == 0) { ++ pmlmepriv->ht_op_mode &= ++ ~HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT; ++ op_mode_changes++; ++ } ++ ++ if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) && ++ (pmlmepriv->num_sta_no_ht || ATOMIC_READ(&pmlmepriv->olbc_ht))) { ++ pmlmepriv->ht_op_mode |= HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT; ++ op_mode_changes++; ++ } else if ((pmlmepriv->ht_op_mode & ++ HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) && ++ (pmlmepriv->num_sta_no_ht == 0 && !ATOMIC_READ(&pmlmepriv->olbc_ht))) { ++ pmlmepriv->ht_op_mode &= ++ ~HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT; ++ op_mode_changes++; ++ } ++ ++ /* Note: currently we switch to the MIXED op mode if HT non-greenfield ++ * station is associated. Probably it's a theoretical case, since ++ * it looks like all known HT STAs support greenfield. ++ */ ++ new_op_mode = 0; ++ if (pmlmepriv->num_sta_no_ht /*|| ++ (pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT)*/) ++ new_op_mode = OP_MODE_MIXED; ++ else if ((phtpriv_ap->ht_cap.cap_info & IEEE80211_HT_CAP_SUP_WIDTH) ++ && pmlmepriv->num_sta_ht_20mhz) ++ new_op_mode = OP_MODE_20MHZ_HT_STA_ASSOCED; ++ else if (ATOMIC_READ(&pmlmepriv->olbc_ht)) ++ new_op_mode = OP_MODE_MAY_BE_LEGACY_STAS; ++ else ++ new_op_mode = OP_MODE_PURE; ++ ++ cur_op_mode = pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_OP_MODE_MASK; ++ if (cur_op_mode != new_op_mode) { ++ pmlmepriv->ht_op_mode &= ~HT_INFO_OPERATION_MODE_OP_MODE_MASK; ++ pmlmepriv->ht_op_mode |= new_op_mode; ++ op_mode_changes++; ++ } ++ ++ RTW_INFO("%s new operation mode=0x%X changes=%d\n", ++ __FUNCTION__, pmlmepriv->ht_op_mode, op_mode_changes); ++ ++ return op_mode_changes; ++ ++} ++ ++#endif /* CONFIG_80211N_HT */ ++ ++void associated_clients_update(_adapter *padapter, u8 updated, u32 sta_info_type) ++{ ++ /* update associcated stations cap. */ ++ if (updated == _TRUE) { ++ _irqL irqL; ++ _list *phead, *plist; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ /* check asoc_queue */ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ ++ plist = get_next(plist); ++ ++ associated_stainfo_update(padapter, psta, sta_info_type); ++ } ++ ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ } ++ ++} ++ ++/* called > TSR LEVEL for USB or SDIO Interface*/ ++void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) ++{ ++ u8 beacon_updated = _FALSE; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ ++ ++#if 0 ++ if (!(psta->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) && ++ !psta->no_short_preamble_set) { ++ psta->no_short_preamble_set = 1; ++ pmlmepriv->num_sta_no_short_preamble++; ++ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && ++ (pmlmepriv->num_sta_no_short_preamble == 1)) ++ ieee802_11_set_beacons(hapd->iface); ++ } ++#endif ++ ++ ++ if (!(psta->flags & WLAN_STA_SHORT_PREAMBLE)) { ++ if (!psta->no_short_preamble_set) { ++ psta->no_short_preamble_set = 1; ++ ++ pmlmepriv->num_sta_no_short_preamble++; ++ ++ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && ++ (pmlmepriv->num_sta_no_short_preamble == 1)) { ++ beacon_updated = _TRUE; ++ update_beacon(padapter, 0xFF, NULL, _TRUE); ++ } ++ ++ } ++ } else { ++ if (psta->no_short_preamble_set) { ++ psta->no_short_preamble_set = 0; ++ ++ pmlmepriv->num_sta_no_short_preamble--; ++ ++ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && ++ (pmlmepriv->num_sta_no_short_preamble == 0)) { ++ beacon_updated = _TRUE; ++ update_beacon(padapter, 0xFF, NULL, _TRUE); ++ } ++ ++ } ++ } ++ ++#if 0 ++ if (psta->flags & WLAN_STA_NONERP && !psta->nonerp_set) { ++ psta->nonerp_set = 1; ++ pmlmepriv->num_sta_non_erp++; ++ if (pmlmepriv->num_sta_non_erp == 1) ++ ieee802_11_set_beacons(hapd->iface); ++ } ++#endif ++ ++ if (psta->flags & WLAN_STA_NONERP) { ++ if (!psta->nonerp_set) { ++ psta->nonerp_set = 1; ++ ++ pmlmepriv->num_sta_non_erp++; ++ ++ if (pmlmepriv->num_sta_non_erp == 1) { ++ beacon_updated = _TRUE; ++ update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE); ++ } ++ } ++ ++ } else { ++ if (psta->nonerp_set) { ++ psta->nonerp_set = 0; ++ ++ pmlmepriv->num_sta_non_erp--; ++ ++ if (pmlmepriv->num_sta_non_erp == 0) { ++ beacon_updated = _TRUE; ++ update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE); ++ } ++ } ++ ++ } ++ ++ ++#if 0 ++ if (!(psta->capability & WLAN_CAPABILITY_SHORT_SLOT) && ++ !psta->no_short_slot_time_set) { ++ psta->no_short_slot_time_set = 1; ++ pmlmepriv->num_sta_no_short_slot_time++; ++ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && ++ (pmlmepriv->num_sta_no_short_slot_time == 1)) ++ ieee802_11_set_beacons(hapd->iface); ++ } ++#endif ++ ++ if (!(psta->capability & WLAN_CAPABILITY_SHORT_SLOT)) { ++ if (!psta->no_short_slot_time_set) { ++ psta->no_short_slot_time_set = 1; ++ ++ pmlmepriv->num_sta_no_short_slot_time++; ++ ++ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && ++ (pmlmepriv->num_sta_no_short_slot_time == 1)) { ++ beacon_updated = _TRUE; ++ update_beacon(padapter, 0xFF, NULL, _TRUE); ++ } ++ ++ } ++ } else { ++ if (psta->no_short_slot_time_set) { ++ psta->no_short_slot_time_set = 0; ++ ++ pmlmepriv->num_sta_no_short_slot_time--; ++ ++ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && ++ (pmlmepriv->num_sta_no_short_slot_time == 0)) { ++ beacon_updated = _TRUE; ++ update_beacon(padapter, 0xFF, NULL, _TRUE); ++ } ++ } ++ } ++ ++#ifdef CONFIG_80211N_HT ++ ++ if (psta->flags & WLAN_STA_HT) { ++ u16 ht_capab = le16_to_cpu(psta->htpriv.ht_cap.cap_info); ++ ++ RTW_INFO("HT: STA " MAC_FMT " HT Capabilities " ++ "Info: 0x%04x\n", MAC_ARG(psta->hwaddr), ht_capab); ++ ++ if (psta->no_ht_set) { ++ psta->no_ht_set = 0; ++ pmlmepriv->num_sta_no_ht--; ++ } ++ ++ if ((ht_capab & IEEE80211_HT_CAP_GRN_FLD) == 0) { ++ if (!psta->no_ht_gf_set) { ++ psta->no_ht_gf_set = 1; ++ pmlmepriv->num_sta_ht_no_gf++; ++ } ++ RTW_INFO("%s STA " MAC_FMT " - no " ++ "greenfield, num of non-gf stations %d\n", ++ __FUNCTION__, MAC_ARG(psta->hwaddr), ++ pmlmepriv->num_sta_ht_no_gf); ++ } ++ ++ if ((ht_capab & IEEE80211_HT_CAP_SUP_WIDTH) == 0) { ++ if (!psta->ht_20mhz_set) { ++ psta->ht_20mhz_set = 1; ++ pmlmepriv->num_sta_ht_20mhz++; ++ } ++ RTW_INFO("%s STA " MAC_FMT " - 20 MHz HT, " ++ "num of 20MHz HT STAs %d\n", ++ __FUNCTION__, MAC_ARG(psta->hwaddr), ++ pmlmepriv->num_sta_ht_20mhz); ++ } ++ ++ } else { ++ if (!psta->no_ht_set) { ++ psta->no_ht_set = 1; ++ pmlmepriv->num_sta_no_ht++; ++ } ++ if (pmlmepriv->htpriv.ht_option == _TRUE) { ++ RTW_INFO("%s STA " MAC_FMT ++ " - no HT, num of non-HT stations %d\n", ++ __FUNCTION__, MAC_ARG(psta->hwaddr), ++ pmlmepriv->num_sta_no_ht); ++ } ++ } ++ ++ if (rtw_ht_operation_update(padapter) > 0) { ++ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE); ++ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); ++ /*beacon_updated = _TRUE;*/ ++ } ++ ++#endif /* CONFIG_80211N_HT */ ++ ++ /* update associcated stations cap. */ ++ associated_clients_update(padapter, beacon_updated, STA_INFO_UPDATE_ALL); ++ ++ RTW_INFO("%s, updated=%d\n", __func__, beacon_updated); ++ ++} ++ ++u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta) ++{ ++ u8 beacon_updated = _FALSE; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ ++ if (!psta) ++ return beacon_updated; ++ ++ if (psta->no_short_preamble_set) { ++ psta->no_short_preamble_set = 0; ++ pmlmepriv->num_sta_no_short_preamble--; ++ if (pmlmeext->cur_wireless_mode > WIRELESS_11B ++ && pmlmepriv->num_sta_no_short_preamble == 0) { ++ beacon_updated = _TRUE; ++ update_beacon(padapter, 0xFF, NULL, _TRUE); ++ } ++ } ++ ++ if (psta->nonerp_set) { ++ psta->nonerp_set = 0; ++ pmlmepriv->num_sta_non_erp--; ++ if (pmlmepriv->num_sta_non_erp == 0) { ++ beacon_updated = _TRUE; ++ update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE); ++ } ++ } ++ ++ if (psta->no_short_slot_time_set) { ++ psta->no_short_slot_time_set = 0; ++ pmlmepriv->num_sta_no_short_slot_time--; ++ if (pmlmeext->cur_wireless_mode > WIRELESS_11B ++ && pmlmepriv->num_sta_no_short_slot_time == 0) { ++ beacon_updated = _TRUE; ++ update_beacon(padapter, 0xFF, NULL, _TRUE); ++ } ++ } ++ ++#ifdef CONFIG_80211N_HT ++ ++ if (psta->no_ht_gf_set) { ++ psta->no_ht_gf_set = 0; ++ pmlmepriv->num_sta_ht_no_gf--; ++ } ++ ++ if (psta->no_ht_set) { ++ psta->no_ht_set = 0; ++ pmlmepriv->num_sta_no_ht--; ++ } ++ ++ if (psta->ht_20mhz_set) { ++ psta->ht_20mhz_set = 0; ++ pmlmepriv->num_sta_ht_20mhz--; ++ } ++ ++ ++ ++ if (rtw_ht_operation_update(padapter) > 0) { ++ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE); ++ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); ++ } ++ ++#endif /* CONFIG_80211N_HT */ ++ ++#if 0 ++ /* update associated stations cap. */ ++ associated_clients_update(padapter, beacon_updated, STA_INFO_UPDATE_ALL); /* move it to avoid deadlock */ ++#endif ++ ++ RTW_INFO("%s, updated=%d\n", __func__, beacon_updated); ++ ++ return beacon_updated; ++ ++} ++ ++u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reason, bool enqueue) ++{ ++ _irqL irqL; ++ u8 beacon_updated = _FALSE; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ if (!psta) ++ return beacon_updated; ++ ++ if (active == _TRUE) { ++#ifdef CONFIG_80211N_HT ++ /* tear down Rx AMPDU */ ++ send_delba(padapter, 0, psta->hwaddr);/* recipient */ ++ ++ /* tear down TX AMPDU */ ++ send_delba(padapter, 1, psta->hwaddr);/* */ /* originator */ ++ ++#endif /* CONFIG_80211N_HT */ ++ ++ issue_deauth(padapter, psta->hwaddr, reason); ++ } ++ ++#ifdef CONFIG_BEAMFORMING ++ beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_LEAVE, psta->hwaddr, ETH_ALEN, 1); ++#endif ++ ++#ifdef CONFIG_80211N_HT ++ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ ++ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ ++#endif /* CONFIG_80211N_HT */ ++ ++ /* clear cam entry / key */ ++ rtw_clearstakey_cmd(padapter, psta, enqueue); ++ ++ ++ _enter_critical_bh(&psta->lock, &irqL); ++ psta->state &= ~_FW_LINKED; ++ _exit_critical_bh(&psta->lock, &irqL); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (1) { ++#ifdef COMPAT_KERNEL_RELEASE ++ rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason); ++#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) ++ rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason); ++#else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) */ ++ /* will call rtw_cfg80211_indicate_sta_disassoc() in cmd_thread for old API context */ ++#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) */ ++ } else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ { ++ rtw_indicate_sta_disassoc_event(padapter, psta); ++ } ++ ++ report_del_sta_event(padapter, psta->hwaddr, reason, enqueue, _FALSE); ++ ++ beacon_updated = bss_cap_update_on_sta_leave(padapter, psta); ++ ++ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ rtw_free_stainfo(padapter, psta); ++ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ ++ ++ return beacon_updated; ++ ++} ++ ++int rtw_ap_inform_ch_switch(_adapter *padapter, u8 new_ch, u8 ch_offset) ++{ ++ _irqL irqL; ++ _list *phead, *plist; ++ int ret = 0; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) ++ return ret; ++ ++ RTW_INFO(FUNC_NDEV_FMT" with ch:%u, offset:%u\n", ++ FUNC_NDEV_ARG(padapter->pnetdev), new_ch, ch_offset); ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ /* for each sta in asoc_queue */ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ plist = get_next(plist); ++ ++ issue_action_spct_ch_switch(padapter, psta->hwaddr, new_ch, ch_offset); ++ psta->expire_to = ((pstapriv->expire_to * 2) > 5) ? 5 : (pstapriv->expire_to * 2); ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ issue_action_spct_ch_switch(padapter, bc_addr, new_ch, ch_offset); ++ ++ return ret; ++} ++ ++int rtw_sta_flush(_adapter *padapter, bool enqueue) ++{ ++ _irqL irqL; ++ _list *phead, *plist; ++ int ret = 0; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ u8 flush_num = 0; ++ char flush_list[NUM_STA]; ++ int i; ++ ++ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) ++ return ret; ++ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev)); ++ ++ /* pick sta from sta asoc_queue */ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ int stainfo_offset; ++ ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ plist = get_next(plist); ++ ++ rtw_list_delete(&psta->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ ++ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); ++ if (stainfo_offset_valid(stainfo_offset)) ++ flush_list[flush_num++] = stainfo_offset; ++ else ++ rtw_warn_on(1); ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ /* call ap_free_sta() for each sta picked */ ++ for (i = 0; i < flush_num; i++) { ++ psta = rtw_get_stainfo_by_offset(pstapriv, flush_list[i]); ++ ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, enqueue); ++ } ++ ++ issue_deauth(padapter, bc_addr, WLAN_REASON_DEAUTH_LEAVING); ++ ++ associated_clients_update(padapter, _TRUE, STA_INFO_UPDATE_ALL); ++ ++ return ret; ++} ++ ++/* called > TSR LEVEL for USB or SDIO Interface*/ ++void sta_info_update(_adapter *padapter, struct sta_info *psta) ++{ ++ int flags = psta->flags; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ ++ /* update wmm cap. */ ++ if (WLAN_STA_WME & flags) ++ psta->qos_option = 1; ++ else ++ psta->qos_option = 0; ++ ++ if (pmlmepriv->qospriv.qos_option == 0) ++ psta->qos_option = 0; ++ ++ ++#ifdef CONFIG_80211N_HT ++ /* update 802.11n ht cap. */ ++ if (WLAN_STA_HT & flags) { ++ psta->htpriv.ht_option = _TRUE; ++ psta->qos_option = 1; ++ ++ psta->htpriv.smps_cap = (psta->htpriv.ht_cap.cap_info & IEEE80211_HT_CAP_SM_PS) >> 2; ++ } else ++ psta->htpriv.ht_option = _FALSE; ++ ++ if (pmlmepriv->htpriv.ht_option == _FALSE) ++ psta->htpriv.ht_option = _FALSE; ++#endif ++ ++#ifdef CONFIG_80211AC_VHT ++ /* update 802.11AC vht cap. */ ++ if (WLAN_STA_VHT & flags) ++ psta->vhtpriv.vht_option = _TRUE; ++ else ++ psta->vhtpriv.vht_option = _FALSE; ++ ++ if (pmlmepriv->vhtpriv.vht_option == _FALSE) ++ psta->vhtpriv.vht_option = _FALSE; ++#endif ++ ++ update_sta_info_apmode(padapter, psta); ++} ++ ++/* called >= TSR LEVEL for USB or SDIO Interface*/ ++void ap_sta_info_defer_update(_adapter *padapter, struct sta_info *psta) ++{ ++ if (psta->state & _FW_LINKED) ++ rtw_hal_update_ra_mask(psta, 0); /* DM_RATR_STA_INIT */ ++} ++/* restore hw setting from sw data structures */ ++void rtw_ap_restore_network(_adapter *padapter) ++{ ++ struct mlme_priv *mlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta; ++ struct security_priv *psecuritypriv = &(padapter->securitypriv); ++ _irqL irqL; ++ _list *phead, *plist; ++ u8 chk_alive_num = 0; ++ char chk_alive_list[NUM_STA]; ++ int i; ++ ++ rtw_setopmode_cmd(padapter, Ndis802_11APMode, _FALSE); ++ ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ ++ rtw_startbss_cmd(padapter, RTW_CMDF_DIRECTLY); ++ ++ if ((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || ++ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) { ++ /* restore group key, WEP keys is restored in ips_leave() */ ++ rtw_set_key(padapter, psecuritypriv, psecuritypriv->dot118021XGrpKeyid, 0, _FALSE); ++ } ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ int stainfo_offset; ++ ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ plist = get_next(plist); ++ ++ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); ++ if (stainfo_offset_valid(stainfo_offset)) ++ chk_alive_list[chk_alive_num++] = stainfo_offset; ++ } ++ ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ for (i = 0; i < chk_alive_num; i++) { ++ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); ++ ++ if (psta == NULL) ++ RTW_INFO(FUNC_ADPT_FMT" sta_info is null\n", FUNC_ADPT_ARG(padapter)); ++ else if (psta->state & _FW_LINKED) { ++ rtw_sta_media_status_rpt(padapter, psta, 1); ++ Update_RA_Entry(padapter, psta); ++ /* pairwise key */ ++ /* per sta pairwise key and settings */ ++ if ((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || ++ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) ++ rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _FALSE); ++ } ++ } ++ ++} ++ ++void start_ap_mode(_adapter *padapter) ++{ ++ int i; ++ struct sta_info *psta = NULL; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++ pmlmepriv->update_bcn = _FALSE; ++ ++ /*init_mlme_ap_info(padapter);*/ ++ ++ pmlmeext->bstart_bss = _FALSE; ++ ++ pmlmepriv->num_sta_non_erp = 0; ++ ++ pmlmepriv->num_sta_no_short_slot_time = 0; ++ ++ pmlmepriv->num_sta_no_short_preamble = 0; ++ ++ pmlmepriv->num_sta_ht_no_gf = 0; ++#ifdef CONFIG_80211N_HT ++ pmlmepriv->num_sta_no_ht = 0; ++#endif /* CONFIG_80211N_HT */ ++ pmlmeinfo->HT_info_enable = 0; ++ pmlmeinfo->HT_caps_enable = 0; ++ pmlmeinfo->HT_enable = 0; ++ ++ pmlmepriv->num_sta_ht_20mhz = 0; ++ pmlmepriv->num_sta_40mhz_intolerant = 0; ++ ATOMIC_SET(&pmlmepriv->olbc, _FALSE); ++ ATOMIC_SET(&pmlmepriv->olbc_ht, _FALSE); ++ ++#ifdef CONFIG_80211N_HT ++ pmlmepriv->ht_20mhz_width_req = _FALSE; ++ pmlmepriv->ht_intolerant_ch_reported = _FALSE; ++ pmlmepriv->ht_op_mode = 0; ++ pmlmepriv->sw_to_20mhz = 0; ++#endif ++ ++ _rtw_memset(pmlmepriv->ext_capab_ie_data, 0, sizeof(pmlmepriv->ext_capab_ie_data)); ++ pmlmepriv->ext_capab_ie_len = 0; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ psecuritypriv->dot118021x_bmc_cam_id = INVALID_SEC_MAC_CAM_ID; ++#endif ++ ++ for (i = 0 ; i < NUM_STA ; i++) ++ pstapriv->sta_aid[i] = NULL; ++ ++#if CONFIG_RTW_MACADDR_ACL ++ rtw_macaddr_acl_init(padapter); ++#endif ++ ++ psta = rtw_get_bcmc_stainfo(padapter); ++ /*_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL);*/ ++ if (psta) ++ rtw_free_stainfo(padapter, psta); ++ /*_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL);*/ ++ ++ rtw_init_bcmc_stainfo(padapter); ++ ++ if (rtw_mi_get_ap_num(padapter)) ++ RTW_SET_SCAN_BAND_SKIP(padapter, BAND_5G); ++ ++} ++ ++void stop_ap_mode(_adapter *padapter) ++{ ++ _irqL irqL; ++ struct sta_info *psta = NULL; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct dvobj_priv *pdvobj = padapter->dvobj; ++ ++ RTW_INFO("%s -"ADPT_FMT"\n", __func__, ADPT_ARG(padapter)); ++ ++ pmlmepriv->update_bcn = _FALSE; ++ /*pmlmeext->bstart_bss = _FALSE;*/ ++ padapter->netif_up = _FALSE; ++ /* _rtw_spinlock_free(&pmlmepriv->bcn_update_lock); */ ++ ++ /* reset and init security priv , this can refine with rtw_reset_securitypriv */ ++ _rtw_memset((unsigned char *)&padapter->securitypriv, 0, sizeof(struct security_priv)); ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled; ++ ++#ifdef CONFIG_DFS_MASTER ++ rtw_dfs_master_status_apply(padapter, MLME_AP_STOPPED); ++#endif ++ ++ /* free scan queue */ ++ rtw_free_network_queue(padapter, _TRUE); ++ ++#if CONFIG_RTW_MACADDR_ACL ++ rtw_macaddr_acl_deinit(padapter); ++#endif ++ ++ rtw_sta_flush(padapter, _TRUE); ++ ++ /* free_assoc_sta_resources */ ++ rtw_free_all_stainfo(padapter); ++ ++ psta = rtw_get_bcmc_stainfo(padapter); ++ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ rtw_free_stainfo(padapter, psta); ++ /*_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL);*/ ++ ++ rtw_free_mlme_priv_ie_data(pmlmepriv); ++ ++#ifdef CONFIG_SWTIMER_BASED_TXBCN ++ if (pmlmeext->bstart_bss == _TRUE) { ++ _enter_critical_bh(&pdvobj->ap_if_q.lock, &irqL); ++ pdvobj->nr_ap_if--; ++ if (pdvobj->nr_ap_if > 0) ++ pdvobj->inter_bcn_space = DEFAULT_BCN_INTERVAL / pdvobj->nr_ap_if; ++ else ++ pdvobj->inter_bcn_space = DEFAULT_BCN_INTERVAL; ++ ++ rtw_list_delete(&padapter->list); ++ _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&pdvobj->inter_bcn_space)); ++ ++ if (pdvobj->nr_ap_if == 0) ++ _cancel_timer_ex(&pdvobj->txbcn_timer); ++ } ++#endif ++ ++ pmlmeext->bstart_bss = _FALSE; ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_MediaStatusNotify(padapter, 0); /* disconnect */ ++#endif ++ ++} ++ ++#endif /* CONFIG_NATIVEAP_MLME */ ++ ++void rtw_ap_update_bss_chbw(_adapter *adapter, WLAN_BSSID_EX *bss, u8 ch, u8 bw, u8 offset) ++{ ++#define UPDATE_VHT_CAP 1 ++#define UPDATE_HT_CAP 1 ++ ++#ifdef CONFIG_80211AC_VHT ++ { ++ struct vht_priv *vhtpriv = &adapter->mlmepriv.vhtpriv; ++ u8 *vht_cap_ie, *vht_op_ie; ++ int vht_cap_ielen, vht_op_ielen; ++ u8 center_freq; ++ ++ vht_cap_ie = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_VHTCapability, &vht_cap_ielen, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ vht_op_ie = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_VHTOperation, &vht_op_ielen, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ center_freq = rtw_get_center_ch(ch, bw, offset); ++ ++ /* update vht cap ie */ ++ if (vht_cap_ie && vht_cap_ielen) { ++ #if UPDATE_VHT_CAP ++ /* if ((bw == CHANNEL_WIDTH_160 || bw == CHANNEL_WIDTH_80_80) && pvhtpriv->sgi_160m) ++ SET_VHT_CAPABILITY_ELE_SHORT_GI160M(pvht_cap_ie + 2, 1); ++ else */ ++ SET_VHT_CAPABILITY_ELE_SHORT_GI160M(vht_cap_ie + 2, 0); ++ ++ if (bw >= CHANNEL_WIDTH_80 && vhtpriv->sgi_80m) ++ SET_VHT_CAPABILITY_ELE_SHORT_GI80M(vht_cap_ie + 2, 1); ++ else ++ SET_VHT_CAPABILITY_ELE_SHORT_GI80M(vht_cap_ie + 2, 0); ++ #endif ++ } ++ ++ /* update vht op ie */ ++ if (vht_op_ie && vht_op_ielen) { ++ if (bw < CHANNEL_WIDTH_80) { ++ SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2, 0); ++ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op_ie + 2, 0); ++ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op_ie + 2, 0); ++ } else if (bw == CHANNEL_WIDTH_80) { ++ SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2, 1); ++ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op_ie + 2, center_freq); ++ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op_ie + 2, 0); ++ } else { ++ RTW_ERR(FUNC_ADPT_FMT" unsupported BW:%u\n", FUNC_ADPT_ARG(adapter), bw); ++ rtw_warn_on(1); ++ } ++ } ++ } ++#endif /* CONFIG_80211AC_VHT */ ++#ifdef CONFIG_80211N_HT ++ { ++ struct ht_priv *htpriv = &adapter->mlmepriv.htpriv; ++ u8 *ht_cap_ie, *ht_op_ie; ++ int ht_cap_ielen, ht_op_ielen; ++ ++ ht_cap_ie = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_HTCapability, &ht_cap_ielen, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ ht_op_ie = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_HTInfo, &ht_op_ielen, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ ++ /* update ht cap ie */ ++ if (ht_cap_ie && ht_cap_ielen) { ++ #if UPDATE_HT_CAP ++ if (bw >= CHANNEL_WIDTH_40) ++ SET_HT_CAP_ELE_CHL_WIDTH(ht_cap_ie + 2, 1); ++ else ++ SET_HT_CAP_ELE_CHL_WIDTH(ht_cap_ie + 2, 0); ++ ++ if (bw >= CHANNEL_WIDTH_40 && htpriv->sgi_40m) ++ SET_HT_CAP_ELE_SHORT_GI40M(ht_cap_ie + 2, 1); ++ else ++ SET_HT_CAP_ELE_SHORT_GI40M(ht_cap_ie + 2, 0); ++ ++ if (htpriv->sgi_20m) ++ SET_HT_CAP_ELE_SHORT_GI20M(ht_cap_ie + 2, 1); ++ else ++ SET_HT_CAP_ELE_SHORT_GI20M(ht_cap_ie + 2, 0); ++ #endif ++ } ++ ++ /* update ht op ie */ ++ if (ht_op_ie && ht_op_ielen) { ++ SET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2, ch); ++ switch (offset) { ++ case HAL_PRIME_CHNL_OFFSET_LOWER: ++ SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2, SCA); ++ break; ++ case HAL_PRIME_CHNL_OFFSET_UPPER: ++ SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2, SCB); ++ break; ++ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: ++ default: ++ SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2, SCN); ++ break; ++ } ++ ++ if (bw >= CHANNEL_WIDTH_40) ++ SET_HT_OP_ELE_STA_CHL_WIDTH(ht_op_ie + 2, 1); ++ else ++ SET_HT_OP_ELE_STA_CHL_WIDTH(ht_op_ie + 2, 0); ++ } ++ } ++#endif /* CONFIG_80211N_HT */ ++ ++ { ++ u8 *p; ++ int ie_len; ++ u8 old_ch = bss->Configuration.DSConfig; ++ bool change_band = _FALSE; ++ ++ if ((ch <= 14 && old_ch >= 36) || (ch >= 36 && old_ch <= 14)) ++ change_band = _TRUE; ++ ++ /* update channel in IE */ ++ p = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if (p && ie_len > 0) ++ *(p + 2) = ch; ++ ++ bss->Configuration.DSConfig = ch; ++ ++ /* band is changed, update ERP, support rate, ext support rate IE */ ++ if (change_band == _TRUE) ++ change_band_update_ie(adapter, bss, ch); ++ } ++ ++} ++ ++bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offset ++ , u8 *ch, u8 *bw, u8 *offset, u8 *chbw_allow) ++{ ++ u8 cur_ie_ch, cur_ie_bw, cur_ie_offset; ++ u8 dec_ch, dec_bw, dec_offset; ++ u8 u_ch = 0, u_offset, u_bw; ++ bool changed = _FALSE; ++ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); ++ WLAN_BSSID_EX *network = &(adapter->mlmepriv.cur_network.network); ++ struct mi_state mstate; ++ bool set_u_ch = _FALSE, set_dec_ch = _FALSE; ++ ++ rtw_ies_get_chbw(network->IEs + sizeof(NDIS_802_11_FIXED_IEs) ++ , network->IELength - sizeof(NDIS_802_11_FIXED_IEs) ++ , &cur_ie_ch, &cur_ie_bw, &cur_ie_offset); ++ ++ /* use chbw of cur_ie updated with specifying req as temporary decision */ ++ dec_ch = (req_ch <= 0) ? cur_ie_ch : req_ch; ++ dec_bw = (req_bw < 0) ? cur_ie_bw : req_bw; ++ dec_offset = (req_offset < 0) ? cur_ie_offset : req_offset; ++ ++ rtw_mi_status_no_self(adapter, &mstate); ++ RTW_INFO(FUNC_ADPT_FMT" ld_sta_num:%u, lg_sta_num%u, ap_num:%u\n" ++ , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate), MSTATE_STA_LG_NUM(&mstate), MSTATE_AP_NUM(&mstate)); ++ ++ if (MSTATE_STA_LD_NUM(&mstate) || MSTATE_AP_NUM(&mstate)) { ++ /* has linked STA or AP mode, follow */ ++ ++ rtw_warn_on(!rtw_mi_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset)); ++ ++ RTW_INFO(FUNC_ADPT_FMT" union no self: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); ++ RTW_INFO(FUNC_ADPT_FMT" req: %d,%d,%d\n", FUNC_ADPT_ARG(adapter), req_ch, req_bw, req_offset); ++ ++#ifdef CONFIG_80211N_HT ++ rtw_adjust_chbw(adapter, u_ch, &dec_bw, &dec_offset); ++#endif /* CONFIG_80211N_HT */ ++#ifdef CONFIG_MCC_MODE ++ if (MCC_EN(adapter)) { ++ if (!rtw_is_chbw_grouped(u_ch, u_bw, u_offset, dec_ch, dec_bw, dec_offset)) { ++ mlmeext->cur_channel = *ch = dec_ch; ++ mlmeext->cur_bwmode = *bw = dec_bw; ++ mlmeext->cur_ch_offset = *offset = dec_offset; ++ /* channel bw offset can not be allowed, need MCC */ ++ *chbw_allow = _FALSE; ++ RTW_INFO(FUNC_ADPT_FMT" enable mcc: %u,%u,%u\n", FUNC_ADPT_ARG(adapter) ++ , *ch, *bw, *offset); ++ goto exit; ++ } else ++ /* channel bw offset can be allowed, not need MCC */ ++ *chbw_allow = _TRUE; ++ } ++#endif /* CONFIG_MCC_MODE */ ++ rtw_sync_chbw(&dec_ch, &dec_bw, &dec_offset ++ , &u_ch, &u_bw, &u_offset); ++ ++ rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) ++ , dec_ch, dec_bw, dec_offset); ++ ++ set_u_ch = _TRUE; ++ } else if (MSTATE_STA_LG_NUM(&mstate)) { ++ /* has linking STA */ ++ ++ rtw_warn_on(!rtw_mi_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset)); ++ ++ RTW_INFO(FUNC_ADPT_FMT" union no self: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); ++ RTW_INFO(FUNC_ADPT_FMT" req: %d,%d,%d\n", FUNC_ADPT_ARG(adapter), req_ch, req_bw, req_offset); ++ ++#ifdef CONFIG_80211N_HT ++ rtw_adjust_chbw(adapter, dec_ch, &dec_bw, &dec_offset); ++#endif ++ if (rtw_is_chbw_grouped(u_ch, u_bw, u_offset, dec_ch, dec_bw, dec_offset)) { ++ ++ rtw_sync_chbw(&dec_ch, &dec_bw, &dec_offset ++ , &u_ch, &u_bw, &u_offset); ++ ++ rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) ++ , dec_ch, dec_bw, dec_offset); ++ ++ set_u_ch = _TRUE; ++ ++ /* channel bw offset can be allowed, not need MCC */ ++ *chbw_allow = _TRUE; ++ } else { ++#ifdef CONFIG_MCC_MODE ++ if (MCC_EN(adapter)) { ++ mlmeext->cur_channel = *ch = dec_ch; ++ mlmeext->cur_bwmode = *bw = dec_bw; ++ mlmeext->cur_ch_offset = *offset = dec_offset; ++ ++ /* channel bw offset can not be allowed, need MCC */ ++ *chbw_allow = _FALSE; ++ RTW_INFO(FUNC_ADPT_FMT" enable mcc: %u,%u,%u\n", FUNC_ADPT_ARG(adapter) ++ , *ch, *bw, *offset); ++ goto exit; ++ } ++#endif /* CONFIG_MCC_MODE */ ++ /* set this for possible ch change when join down*/ ++ set_fwstate(&adapter->mlmepriv, WIFI_OP_CH_SWITCHING); ++ } ++ } else { ++ /* single AP mode */ ++ ++ RTW_INFO(FUNC_ADPT_FMT" req: %d,%d,%d\n", FUNC_ADPT_ARG(adapter), req_ch, req_bw, req_offset); ++ ++ /* check temporary decision first */ ++#ifdef CONFIG_80211N_HT ++ rtw_adjust_chbw(adapter, dec_ch, &dec_bw, &dec_offset); ++#endif ++ if (!rtw_get_offset_by_chbw(dec_ch, dec_bw, &dec_offset)) { ++#if defined(CONFIG_DFS_MASTER) ++ if (req_ch == -1 || req_bw == -1) ++ goto choose_chbw; ++#endif ++ RTW_WARN(FUNC_ADPT_FMT" req: %u,%u has no valid offset\n", FUNC_ADPT_ARG(adapter), dec_ch, dec_bw); ++ *chbw_allow = _FALSE; ++ goto exit; ++ } ++ ++ if (!rtw_chset_is_chbw_valid(mlmeext->channel_set, dec_ch, dec_bw, dec_offset)) { ++#if defined(CONFIG_DFS_MASTER) ++ if (req_ch == -1 || req_bw == -1) ++ goto choose_chbw; ++#endif ++ RTW_WARN(FUNC_ADPT_FMT" req: %u,%u,%u doesn't fit in chplan\n", FUNC_ADPT_ARG(adapter), dec_ch, dec_bw, dec_offset); ++ *chbw_allow = _FALSE; ++ goto exit; ++ } ++ ++ if (rtw_chset_is_ch_non_ocp(mlmeext->channel_set, dec_ch, dec_bw, dec_offset) == _FALSE) ++ goto update_bss_chbw; ++ ++choose_chbw: ++ if (req_bw < 0) ++ req_bw = cur_ie_bw; ++ ++#if defined(CONFIG_DFS_MASTER) ++ /* choose 5G DFS channel for debug */ ++ if (adapter_to_rfctl(adapter)->dbg_dfs_master_choose_dfs_ch_first ++ && rtw_choose_shortest_waiting_ch(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, RTW_CHF_2G | RTW_CHF_NON_DFS) == _TRUE) ++ RTW_INFO(FUNC_ADPT_FMT" choose 5G DFS channel for debug\n", FUNC_ADPT_ARG(adapter)); ++ else if (adapter_to_rfctl(adapter)->dfs_ch_sel_d_flags ++ && rtw_choose_shortest_waiting_ch(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, adapter_to_rfctl(adapter)->dfs_ch_sel_d_flags) == _TRUE) ++ RTW_INFO(FUNC_ADPT_FMT" choose with dfs_ch_sel_d_flags:0x%02x for debug\n", FUNC_ADPT_ARG(adapter), adapter_to_rfctl(adapter)->dfs_ch_sel_d_flags); ++ else if (rtw_choose_shortest_waiting_ch(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, 0) == _FALSE) { ++ RTW_WARN(FUNC_ADPT_FMT" no available channel\n", FUNC_ADPT_ARG(adapter)); ++ *chbw_allow = _FALSE; ++ goto exit; ++ } ++#endif /* defined(CONFIG_DFS_MASTER) */ ++ ++update_bss_chbw: ++ rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) ++ , dec_ch, dec_bw, dec_offset); ++ ++ /* channel bw offset can be allowed for single AP, not need MCC */ ++ *chbw_allow = _TRUE; ++ set_dec_ch = _TRUE; ++ } ++ ++ if (rtw_mi_check_fwstate(adapter, _FW_UNDER_SURVEY)) { ++ /* scanning, leave ch setting to scan state machine */ ++ set_u_ch = set_dec_ch = _FALSE; ++ } ++ ++ if (mlmeext->cur_channel != dec_ch ++ || mlmeext->cur_bwmode != dec_bw ++ || mlmeext->cur_ch_offset != dec_offset) ++ changed = _TRUE; ++ ++ if (changed == _TRUE && rtw_linked_check(adapter) == _TRUE) { ++#ifdef CONFIG_SPCT_CH_SWITCH ++ if (1) ++ rtw_ap_inform_ch_switch(adapter, dec_ch, dec_offset); ++ else ++#endif ++ rtw_sta_flush(adapter, _FALSE); ++ } ++ ++ mlmeext->cur_channel = dec_ch; ++ mlmeext->cur_bwmode = dec_bw; ++ mlmeext->cur_ch_offset = dec_offset; ++ ++ if (u_ch != 0) ++ RTW_INFO(FUNC_ADPT_FMT" union: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); ++ ++ RTW_INFO(FUNC_ADPT_FMT" dec: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), dec_ch, dec_bw, dec_offset); ++ ++ if (set_u_ch == _TRUE) { ++ *ch = u_ch; ++ *bw = u_bw; ++ *offset = u_offset; ++ } else if (set_dec_ch == _TRUE) { ++ *ch = dec_ch; ++ *bw = dec_bw; ++ *offset = dec_offset; ++ } ++exit: ++ return changed; ++} ++ ++/*#define DBG_SWTIMER_BASED_TXBCN*/ ++ ++#ifdef CONFIG_SWTIMER_BASED_TXBCN ++void tx_beacon_handlder(struct dvobj_priv *pdvobj) ++{ ++#define BEACON_EARLY_TIME 20 /* unit:TU*/ ++ _irqL irqL; ++ _list *plist, *phead; ++ u32 timestamp[2]; ++ u32 bcn_interval_us; /* unit : usec */ ++ u64 time; ++ u32 cur_tick, time_offset; /* unit : usec */ ++ u32 inter_bcn_space_us; /* unit : usec */ ++ int nr_vap, idx, bcn_idx; ++ int i; ++ u8 val8, late = 0; ++ _adapter *padapter = NULL; ++ ++ i = 0; ++ ++ /* get first ap mode interface */ ++ _enter_critical_bh(&pdvobj->ap_if_q.lock, &irqL); ++ if (rtw_is_list_empty(&pdvobj->ap_if_q.queue) || (pdvobj->nr_ap_if == 0)) { ++ RTW_INFO("[%s] ERROR: ap_if_q is empty!or nr_ap = %d\n", __func__, pdvobj->nr_ap_if); ++ _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); ++ return; ++ } else ++ padapter = LIST_CONTAINOR(get_next(&(pdvobj->ap_if_q.queue)), struct _ADAPTER, list); ++ _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); ++ ++ if (NULL == padapter) { ++ RTW_INFO("[%s] ERROR: no any ap interface!\n", __func__); ++ return; ++ } ++ ++ ++ bcn_interval_us = DEFAULT_BCN_INTERVAL * NET80211_TU_TO_US; ++ if (0 == bcn_interval_us) { ++ RTW_INFO("[%s] ERROR: beacon interval = 0\n", __func__); ++ return; ++ } ++ ++ /* read TSF */ ++ timestamp[1] = rtw_read32(padapter, 0x560 + 4); ++ timestamp[0] = rtw_read32(padapter, 0x560); ++ while (timestamp[1]) { ++ time = (0xFFFFFFFF % bcn_interval_us + 1) * timestamp[1] + timestamp[0]; ++ timestamp[0] = (u32)time; ++ timestamp[1] = (u32)(time >> 32); ++ } ++ cur_tick = timestamp[0] % bcn_interval_us; ++ ++ ++ _enter_critical_bh(&pdvobj->ap_if_q.lock, &irqL); ++ ++ nr_vap = (pdvobj->nr_ap_if - 1); ++ if (nr_vap > 0) { ++ inter_bcn_space_us = pdvobj->inter_bcn_space * NET80211_TU_TO_US; /* beacon_interval / (nr_vap+1); */ ++ idx = cur_tick / inter_bcn_space_us; ++ if (idx < nr_vap) /* if (idx < (nr_vap+1))*/ ++ bcn_idx = idx + 1; /* bcn_idx = (idx + 1) % (nr_vap+1);*/ ++ else ++ bcn_idx = 0; ++ ++ /* to get padapter based on bcn_idx */ ++ padapter = NULL; ++ phead = get_list_head(&pdvobj->ap_if_q); ++ plist = get_next(phead); ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ padapter = LIST_CONTAINOR(plist, struct _ADAPTER, list); ++ ++ plist = get_next(plist); ++ ++ if (i == bcn_idx) ++ break; ++ ++ i++; ++ } ++ if ((NULL == padapter) || (i > pdvobj->nr_ap_if)) { ++ RTW_INFO("[%s] ERROR: nr_ap_if = %d, padapter=%p, bcn_idx=%d, index=%d\n", ++ __func__, pdvobj->nr_ap_if, padapter, bcn_idx, i); ++ _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); ++ return; ++ } ++#ifdef DBG_SWTIMER_BASED_TXBCN ++ RTW_INFO("BCN_IDX=%d, cur_tick=%d, padapter=%p\n", bcn_idx, cur_tick, padapter); ++#endif ++ if (((idx + 2 == nr_vap + 1) && (idx < nr_vap + 1)) || (0 == bcn_idx)) { ++ time_offset = bcn_interval_us - cur_tick - BEACON_EARLY_TIME * NET80211_TU_TO_US; ++ if ((s32)time_offset < 0) ++ time_offset += inter_bcn_space_us; ++ ++ } else { ++ time_offset = (idx + 2) * inter_bcn_space_us - cur_tick - BEACON_EARLY_TIME * NET80211_TU_TO_US; ++ if (time_offset > (inter_bcn_space_us + (inter_bcn_space_us >> 1))) { ++ time_offset -= inter_bcn_space_us; ++ late = 1; ++ } ++ } ++ } else ++ /*#endif*/ { /* MBSSID */ ++ time_offset = 2 * bcn_interval_us - cur_tick - BEACON_EARLY_TIME * NET80211_TU_TO_US; ++ if (time_offset > (bcn_interval_us + (bcn_interval_us >> 1))) { ++ time_offset -= bcn_interval_us; ++ late = 1; ++ } ++ } ++ _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); ++ ++#ifdef DBG_SWTIMER_BASED_TXBCN ++ RTW_INFO("set sw bcn timer %d us\n", time_offset); ++#endif ++ _set_timer(&pdvobj->txbcn_timer, time_offset / NET80211_TU_TO_US); ++ ++ if (padapter) { ++#ifdef DBG_SWTIMER_BASED_TXBCN ++ RTW_INFO("padapter=%p, PORT=%d\n", padapter, padapter->hw_port); ++#endif ++ /*update_beacon(padapter, _TIM_IE_, NULL, _FALSE);*/ ++ issue_beacon(padapter, 0); ++ } ++ ++#if 0 ++ /* handle any buffered BC/MC frames*/ ++ /* Don't dynamically change DIS_ATIM due to HW will auto send ACQ after HIQ empty.*/ ++ val8 = *((unsigned char *)priv->beaconbuf + priv->timoffset + 4); ++ if (val8 & 0x01) { ++ process_mcast_dzqueue(priv); ++ priv->pkt_in_dtimQ = 0; ++ } ++#endif ++ ++} ++ ++void tx_beacon_timer_handlder(struct dvobj_priv *pdvobj) ++{ ++ _adapter *padapter = pdvobj->padapters[0]; ++ ++ if (padapter) ++ set_tx_beacon_cmd(padapter); ++} ++#endif ++ ++#endif /* CONFIG_AP_MODE */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_beamforming.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_beamforming.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_beamforming.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_beamforming.c 2018-02-11 21:44:27.135145903 +0200 +@@ -0,0 +1,1942 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2016 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_BEAMFORMING_C_ ++ ++#include ++#include ++ ++#ifdef CONFIG_BEAMFORMING ++ ++#if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ ++#ifdef RTW_BEAMFORMING_VERSION_2 ++/* ++ * For phydm ++ */ ++BEAMFORMING_CAP beamforming_get_entry_beam_cap_by_mac_id(void *mlme, u8 mac_id) ++{ ++ PADAPTER adapter; ++ struct beamforming_info *pBeamInfo; ++ struct beamformee_entry *bfee; ++ BEAMFORMING_CAP cap = BEAMFORMING_CAP_NONE; ++ u8 i = 0; ++ ++ ++ adapter = mlme_to_adapter((struct mlme_priv *)mlme); ++ pBeamInfo = GET_BEAMFORM_INFO(adapter); ++ ++ for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { ++ bfee = &pBeamInfo->bfee_entry[i]; ++ if ((bfee->used == _TRUE) ++ && (bfee->mac_id == mac_id)) { ++ cap = bfee->cap; ++ break; ++ } ++ } ++ ++ return cap; ++} ++ ++struct beamformer_entry *beamforming_get_bfer_entry_by_addr(PADAPTER adapter, u8 *ra) ++{ ++ u8 i = 0; ++ struct beamforming_info *bf_info; ++ struct beamformer_entry *entry; ++ ++ ++ bf_info = GET_BEAMFORM_INFO(adapter); ++ ++ for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { ++ entry = &bf_info->bfer_entry[i]; ++ if (entry->used == _FALSE) ++ continue; ++ if (_rtw_memcmp(ra, entry->mac_addr, ETH_ALEN) == _TRUE) { ++ return entry; ++ } ++ } ++ ++ return NULL; ++} ++ ++struct beamformee_entry *beamforming_get_bfee_entry_by_addr(PADAPTER adapter, u8 *ra) ++{ ++ u8 i = 0; ++ struct beamforming_info *bf_info; ++ struct beamformee_entry *entry; ++ ++ ++ bf_info = GET_BEAMFORM_INFO(adapter); ++ ++ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { ++ entry = &bf_info->bfee_entry[i]; ++ if (entry->used == _FALSE) ++ continue; ++ if (_rtw_memcmp(ra, entry->mac_addr, ETH_ALEN) == _TRUE) ++ return entry; ++ } ++ ++ return NULL; ++} ++ ++static struct beamformer_entry *_get_bfer_free_entry(PADAPTER adapter) ++{ ++ u8 i = 0; ++ struct beamforming_info *bf_info; ++ struct beamformer_entry *entry; ++ ++ ++ bf_info = GET_BEAMFORM_INFO(adapter); ++ ++ for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { ++ entry = &bf_info->bfer_entry[i]; ++ if (entry->used == _FALSE) ++ return entry; ++ } ++ ++ return NULL; ++} ++ ++static struct beamformee_entry *_get_bfee_free_entry(PADAPTER adapter) ++{ ++ u8 i = 0; ++ struct beamforming_info *bf_info; ++ struct beamformee_entry *entry; ++ ++ ++ bf_info = GET_BEAMFORM_INFO(adapter); ++ ++ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { ++ entry = &bf_info->bfee_entry[i]; ++ if (entry->used == _FALSE) ++ return entry; ++ } ++ ++ return NULL; ++} ++ ++/* ++ * Description: ++ * Get the first entry index of MU Beamformee. ++ * ++ * Return Value: ++ * Index of the first MU sta. ++ * ++ * 2015.05.25. Created by tynli. ++ * ++ */ ++static u8 _get_first_mu_bfee_entry_idx(PADAPTER adapter, struct beamformee_entry *ignore) ++{ ++ struct beamforming_info *bf_info; ++ struct beamformee_entry *entry; ++ u8 idx = 0xFF; ++ u8 bFound = _FALSE; ++ ++ ++ bf_info = GET_BEAMFORM_INFO(adapter); ++ ++ for (idx = 0; idx < MAX_BEAMFORMEE_ENTRY_NUM; idx++) { ++ entry = &bf_info->bfee_entry[idx]; ++ if (ignore && (entry == ignore)) ++ continue; ++ if ((entry->used == _TRUE) && ++ TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_MU)) { ++ bFound = _TRUE; ++ break; ++ } ++ } ++ ++ if (bFound == _FALSE) ++ idx = 0xFF; ++ ++ return idx; ++} ++ ++static void _update_min_sounding_period(PADAPTER adapter, u16 period, u8 leave) ++{ ++ struct beamforming_info *bf_info; ++ struct beamformee_entry *entry; ++ u8 i = 0; ++ u16 min_val = 0xFFFF; ++ ++ ++ bf_info = GET_BEAMFORM_INFO(adapter); ++ ++ if (_TRUE == leave) { ++ /* ++ * When a BFee left, ++ * we need to find the latest min sounding period ++ * from the remaining BFees ++ */ ++ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { ++ entry = &bf_info->bfee_entry[i]; ++ if ((entry->used == _TRUE) ++ && (entry->sound_period < min_val)) ++ min_val = entry->sound_period; ++ } ++ ++ if (min_val == 0xFFFF) ++ bf_info->sounding_info.min_sounding_period = 0; ++ else ++ bf_info->sounding_info.min_sounding_period = min_val; ++ } else { ++ if ((bf_info->sounding_info.min_sounding_period == 0) ++ || (period < bf_info->sounding_info.min_sounding_period)) ++ bf_info->sounding_info.min_sounding_period = period; ++ } ++} ++ ++static struct beamformer_entry *_add_bfer_entry(PADAPTER adapter, ++ struct sta_info *sta, u8 bf_cap, u8 sounding_dim, u8 comp_steering) ++{ ++ struct mlme_priv *mlme; ++ struct beamforming_info *bf_info; ++ struct beamformer_entry *entry; ++ u8 *bssid; ++ u16 val16; ++ u8 i; ++ ++ ++ mlme = &adapter->mlmepriv; ++ bf_info = GET_BEAMFORM_INFO(adapter); ++ ++ entry = beamforming_get_bfer_entry_by_addr(adapter, sta->hwaddr); ++ if (!entry) { ++ entry = _get_bfer_free_entry(adapter); ++ if (!entry) ++ return NULL; ++ } ++ ++ entry->used = _TRUE; ++ ++ if (check_fwstate(mlme, WIFI_AP_STATE)) { ++ bssid = adapter_mac_addr(adapter); ++ /* BSSID[44:47] xor BSSID[40:43] */ ++ val16 = ((bssid[5] & 0xF0) >> 4) ^ (bssid[5] & 0xF); ++ /* (dec(A) + dec(B)*32) mod 512 */ ++ entry->p_aid = (sta->aid + val16 * 32) & 0x1FF; ++ entry->g_id = 63; ++ } else if ((check_fwstate(mlme, WIFI_ADHOC_STATE) == _TRUE) ++ || (check_fwstate(mlme, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { ++ entry->p_aid = 0; ++ entry->g_id = 63; ++ } else { ++ bssid = sta->hwaddr; ++ /* BSSID[39:47] */ ++ entry->p_aid = (bssid[5] << 1) | (bssid[4] >> 7); ++ entry->g_id = 0; ++ } ++ RTW_INFO("%s: p_aid=0x%04x g_id=0x%04x aid=0x%x\n", ++ __FUNCTION__, entry->p_aid, entry->g_id, sta->aid); ++ ++ _rtw_memcpy(entry->mac_addr, sta->hwaddr, ETH_ALEN); ++ entry->cap = bf_cap; ++ entry->state = BEAMFORM_ENTRY_HW_STATE_ADD_INIT; ++ entry->NumofSoundingDim = sounding_dim; ++ ++ if (TEST_FLAG(bf_cap, BEAMFORMER_CAP_VHT_MU)) { ++ bf_info->beamformer_mu_cnt += 1; ++ entry->aid = sta->aid; ++ } else if (TEST_FLAG(bf_cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) { ++ bf_info->beamformer_su_cnt += 1; ++ ++ /* Record HW idx info */ ++ for (i = 0; i < MAX_NUM_BEAMFORMER_SU; i++) { ++ if ((bf_info->beamformer_su_reg_maping & BIT(i)) == 0) { ++ bf_info->beamformer_su_reg_maping |= BIT(i); ++ entry->su_reg_index = i; ++ break; ++ } ++ } ++ RTW_INFO("%s: Add BFer entry beamformer_su_reg_maping=%#X, su_reg_index=%d\n", ++ __FUNCTION__, bf_info->beamformer_su_reg_maping, entry->su_reg_index); ++ } ++ ++ return entry; ++} ++ ++static struct beamformee_entry *_add_bfee_entry(PADAPTER adapter, ++ struct sta_info *sta, u8 bf_cap, u8 sounding_dim, u8 comp_steering) ++{ ++ struct mlme_priv *mlme; ++ struct beamforming_info *bf_info; ++ struct beamformee_entry *entry; ++ u8 *bssid; ++ u16 val16; ++ u8 i; ++ ++ ++ mlme = &adapter->mlmepriv; ++ bf_info = GET_BEAMFORM_INFO(adapter); ++ ++ entry = beamforming_get_bfee_entry_by_addr(adapter, sta->hwaddr); ++ if (!entry) { ++ entry = _get_bfee_free_entry(adapter); ++ if (!entry) ++ return NULL; ++ } ++ ++ entry->used = _TRUE; ++ entry->aid = sta->aid; ++ entry->mac_id = sta->mac_id; ++ entry->sound_bw = sta->bw_mode; ++ ++ if (check_fwstate(mlme, WIFI_AP_STATE)) { ++ bssid = adapter_mac_addr(adapter); ++ /* BSSID[44:47] xor BSSID[40:43] */ ++ val16 = ((bssid[5] & 0xF0) >> 4) ^ (bssid[5] & 0xF); ++ /* (dec(A) + dec(B)*32) mod 512 */ ++ entry->p_aid = (sta->aid + val16 * 32) & 0x1FF; ++ entry->g_id = 63; ++ } else if (check_fwstate(mlme, WIFI_ADHOC_STATE) || check_fwstate(mlme, WIFI_ADHOC_MASTER_STATE)) { ++ entry->p_aid = 0; ++ entry->g_id = 63; ++ } else { ++ bssid = sta->hwaddr; ++ /* BSSID[39:47] */ ++ entry->p_aid = (bssid[5] << 1) | (bssid[4] >> 7); ++ entry->g_id = 0; ++ } ++ ++ _rtw_memcpy(entry->mac_addr, sta->hwaddr, ETH_ALEN); ++ entry->txbf = _FALSE; ++ entry->sounding = _FALSE; ++ entry->sound_period = 40; ++ entry->cap = bf_cap; ++ ++ _update_min_sounding_period(adapter, entry->sound_period, _FALSE); ++ entry->SoundCnt = GetInitSoundCnt(entry->sound_period, bf_info->sounding_info.min_sounding_period); ++ ++ entry->LogStatusFailCnt = 0; ++ ++ entry->NumofSoundingDim = sounding_dim; ++ entry->CompSteeringNumofBFer = comp_steering; ++ entry->state = BEAMFORM_ENTRY_HW_STATE_ADD_INIT; ++ ++ if (TEST_FLAG(bf_cap, BEAMFORMEE_CAP_VHT_MU)) { ++ bf_info->beamformee_mu_cnt += 1; ++ bf_info->first_mu_bfee_index = _get_first_mu_bfee_entry_idx(adapter, NULL); ++ ++ /* Record HW idx info */ ++ for (i = 0; i < MAX_NUM_BEAMFORMEE_MU; i++) { ++ if ((bf_info->beamformee_mu_reg_maping & BIT(i)) == 0) { ++ bf_info->beamformee_mu_reg_maping |= BIT(i); ++ entry->mu_reg_index = i; ++ break; ++ } ++ } ++ RTW_INFO("%s: Add BFee entry beamformee_mu_reg_maping=%#X, mu_reg_index=%d\n", ++ __FUNCTION__, bf_info->beamformee_mu_reg_maping, entry->mu_reg_index); ++ ++ } else if (TEST_FLAG(bf_cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { ++ bf_info->beamformee_su_cnt += 1; ++ ++ /* Record HW idx info */ ++ for (i = 0; i < MAX_NUM_BEAMFORMEE_SU; i++) { ++ if ((bf_info->beamformee_su_reg_maping & BIT(i)) == 0) { ++ bf_info->beamformee_su_reg_maping |= BIT(i); ++ entry->su_reg_index = i; ++ break; ++ } ++ } ++ RTW_INFO("%s: Add BFee entry beamformee_su_reg_maping=%#X, su_reg_index=%d\n", ++ __FUNCTION__, bf_info->beamformee_su_reg_maping, entry->su_reg_index); ++ } ++ ++ return entry; ++} ++ ++static void _remove_bfer_entry(PADAPTER adapter, struct beamformer_entry *entry) ++{ ++ struct beamforming_info *bf_info; ++ ++ ++ bf_info = GET_BEAMFORM_INFO(adapter); ++ ++ entry->state = BEAMFORM_ENTRY_HW_STATE_DELETE_INIT; ++ ++ if (TEST_FLAG(entry->cap, BEAMFORMER_CAP_VHT_MU)) { ++ bf_info->beamformer_mu_cnt -= 1; ++ _rtw_memset(entry->gid_valid, 0, 8); ++ _rtw_memset(entry->user_position, 0, 16); ++ } else if (TEST_FLAG(entry->cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) { ++ bf_info->beamformer_su_cnt -= 1; ++ } ++ ++ if (bf_info->beamformer_mu_cnt == 0) ++ bf_info->beamforming_cap &= ~BEAMFORMEE_CAP_VHT_MU; ++ if (bf_info->beamformer_su_cnt == 0) ++ bf_info->beamforming_cap &= ~(BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT); ++} ++ ++static void _remove_bfee_entry(PADAPTER adapter, struct beamformee_entry *entry) ++{ ++ struct beamforming_info *bf_info; ++ ++ ++ bf_info = GET_BEAMFORM_INFO(adapter); ++ ++ entry->state = BEAMFORM_ENTRY_HW_STATE_DELETE_INIT; ++ ++ if (TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_MU)) { ++ bf_info->beamformee_mu_cnt -= 1; ++ bf_info->first_mu_bfee_index = _get_first_mu_bfee_entry_idx(adapter, entry); ++ } else if (TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { ++ bf_info->beamformee_su_cnt -= 1; ++ } ++ ++ if (bf_info->beamformee_mu_cnt == 0) ++ bf_info->beamforming_cap &= ~BEAMFORMER_CAP_VHT_MU; ++ if (bf_info->beamformee_su_cnt == 0) ++ bf_info->beamforming_cap &= ~(BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT); ++ ++ _update_min_sounding_period(adapter, 0, _TRUE); ++} ++ ++/* ++ * Parameters ++ * adapter struct _adapter* ++ * sta struct sta_info* ++ * sta_bf_cap beamforming capabe of sta ++ * sounding_dim Number of Sounding Dimensions ++ * comp_steering Compressed Steering Number of Beamformer Antennas Supported ++ */ ++static void _get_sta_beamform_cap(PADAPTER adapter, struct sta_info *sta, ++ u8 *sta_bf_cap, u8 *sounding_dim, u8 *comp_steering) ++{ ++ struct ht_priv *ht; ++#ifdef CONFIG_80211AC_VHT ++ struct vht_priv *vht; ++#endif /* CONFIG_80211AC_VHT */ ++ u16 bf_cap; ++ ++ ++ *sta_bf_cap = 0; ++ *sounding_dim = 0; ++ *comp_steering = 0; ++ ++ ht = &adapter->mlmepriv.htpriv; ++#ifdef CONFIG_80211AC_VHT ++ vht = &adapter->mlmepriv.vhtpriv; ++#endif /* CONFIG_80211AC_VHT */ ++ ++ if (IsSupportedHT(sta->wireless_mode) == _TRUE) { ++ /* HT */ ++ bf_cap = ht->beamform_cap; ++ ++ if (TEST_FLAG(bf_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) { ++ *sta_bf_cap |= BEAMFORMER_CAP_HT_EXPLICIT; ++ *sounding_dim = (bf_cap & BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP) >> 6; ++ } ++ if (TEST_FLAG(bf_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { ++ *sta_bf_cap |= BEAMFORMEE_CAP_HT_EXPLICIT; ++ *comp_steering = (bf_cap & BEAMFORMING_HT_BEAMFORMER_STEER_NUM) >> 4; ++ } ++ } ++ ++#ifdef CONFIG_80211AC_VHT ++ if (IsSupportedVHT(sta->wireless_mode) == _TRUE) { ++ /* VHT */ ++ bf_cap = vht->beamform_cap; ++ ++ /* We are SU Beamformee because the STA is SU Beamformer */ ++ if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) { ++ *sta_bf_cap |= BEAMFORMER_CAP_VHT_SU; ++ ++ /* We are MU Beamformee because the STA is MU Beamformer */ ++ if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) ++ *sta_bf_cap |= BEAMFORMER_CAP_VHT_MU; ++ ++ *sounding_dim = (bf_cap & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM) >> 12; ++ } ++ /* We are SU Beamformer because the STA is SU Beamformee */ ++ if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { ++ *sta_bf_cap |= BEAMFORMEE_CAP_VHT_SU; ++ ++ /* We are MU Beamformer because the STA is MU Beamformee */ ++ if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) ++ *sta_bf_cap |= BEAMFORMEE_CAP_VHT_MU; ++ ++ *comp_steering = (bf_cap & BEAMFORMING_VHT_BEAMFORMER_STS_CAP) >> 8; ++ } ++ } ++#endif /* CONFIG_80211AC_VHT */ ++} ++/* ++ * Return: ++ * _TRUE success ++ * _FALSE fail ++ */ ++static u8 _init_entry(PADAPTER adapter, struct sta_info *sta) ++{ ++ struct mlme_priv *mlme; ++ struct ht_priv *htpriv; ++#ifdef CONFIG_80211AC_VHT ++ struct vht_priv *vhtpriv; ++#endif ++ struct mlme_ext_priv *mlme_ext; ++ struct sta_info *sta_real; ++ struct beamformer_entry *bfer = NULL; ++ struct beamformee_entry *bfee = NULL; ++ u8 *ra; ++ u8 wireless_mode; ++ u8 sta_bf_cap; ++ u8 sounding_dim = 0; /* number of sounding dimensions */ ++ u8 comp_steering_num = 0; /* compressed steering number */ ++ ++ ++ mlme = &adapter->mlmepriv; ++ htpriv = &mlme->htpriv; ++#ifdef CONFIG_80211AC_VHT ++ vhtpriv = &mlme->vhtpriv; ++#endif ++ mlme_ext = &adapter->mlmeextpriv; ++ ra = sta->hwaddr; ++ wireless_mode = sta->wireless_mode; ++ sta_real = rtw_get_stainfo(&adapter->stapriv, ra); ++ ++ /* The current setting does not support Beaforming */ ++ if ((IsSupportedHT(wireless_mode) == _FALSE) ++ && (IsSupportedVHT(wireless_mode) == _FALSE)) ++ return _FALSE; ++ ++ if ((0 == htpriv->beamform_cap) ++#ifdef CONFIG_80211AC_VHT ++ && (0 == vhtpriv->beamform_cap) ++#endif ++ ) { ++ RTW_INFO("The configuration disabled Beamforming! Skip...\n"); ++ return _FALSE; ++ } ++ ++ _get_sta_beamform_cap(adapter, sta, ++ &sta_bf_cap, &sounding_dim, &comp_steering_num); ++ RTW_INFO("STA Beamforming Capability=0x%02X\n", sta_bf_cap); ++ ++ if (sta_bf_cap == BEAMFORMING_CAP_NONE) ++ return _FALSE; ++ ++ if ((sta_bf_cap & BEAMFORMEE_CAP_HT_EXPLICIT) ++ || (sta_bf_cap & BEAMFORMEE_CAP_VHT_SU) ++ || (sta_bf_cap & BEAMFORMEE_CAP_VHT_MU)) ++ sta_bf_cap |= BEAMFORMEE_CAP; ++ else ++ sta_bf_cap |= BEAMFORMER_CAP; ++ ++ if (sta_bf_cap & BEAMFORMER_CAP) { ++ /* The other side is beamformer */ ++ bfer = _add_bfer_entry(adapter, sta, sta_bf_cap, sounding_dim, comp_steering_num); ++ if (bfer == NULL) { ++ RTW_ERR("%s: Fail to allocate bfer entry!\n", __FUNCTION__); ++ return _FALSE; ++ } ++ ++ sta_real->txbf_paid = bfer->p_aid; ++ sta_real->txbf_gid = bfer->g_id; ++ } else { ++ /* The other side is beamformee */ ++ bfee = _add_bfee_entry(adapter, sta, sta_bf_cap, sounding_dim, comp_steering_num); ++ if (bfee == NULL) { ++ RTW_ERR("%s: Fail to allocate bfee entry!\n", __FUNCTION__); ++ return _FALSE; ++ } ++ ++ sta_real->txbf_paid = bfee->p_aid; ++ sta_real->txbf_gid = bfee->g_id; ++ } ++ ++ return _TRUE; ++} ++ ++static void _deinit_entry(PADAPTER adapter, u8 *ra) ++{ ++ struct beamforming_info *bf_info; ++ struct beamformer_entry *bfer = NULL; ++ struct beamformee_entry *bfee = NULL; ++ u8 bHwStateAddInit = _FALSE; ++ ++ ++ RTW_INFO("+%s\n", __FUNCTION__); ++ ++ bf_info = GET_BEAMFORM_INFO(adapter); ++ bfer = beamforming_get_bfer_entry_by_addr(adapter, ra); ++ bfee = beamforming_get_bfee_entry_by_addr(adapter, ra); ++ ++ if (!bfer && !bfee) { ++ RTW_WARN("%s: " MAC_FMT " is neither beamforming ee or er!!\n", ++ __FUNCTION__, MAC_ARG(ra)); ++ return; ++ } ++ ++ if (bfer && bfee) ++ RTW_ERR("%s: " MAC_FMT " is both beamforming ee & er!!\n", ++ __FUNCTION__, MAC_ARG(ra)); ++ ++ if (bfer) ++ _remove_bfer_entry(adapter, bfer); ++ ++ if (bfee) ++ _remove_bfee_entry(adapter, bfee); ++ ++ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_LEAVE, ra); ++ ++ RTW_DBG("-%s\n", __FUNCTION__); ++} ++ ++void _beamforming_reset(PADAPTER adapter) ++{ ++ RTW_ERR("%s: Not ready!!\n", __FUNCTION__); ++} ++ ++void beamforming_enter(PADAPTER adapter, void *sta) ++{ ++ u8 ret; ++ ++ ret = _init_entry(adapter, (struct sta_info *)sta); ++ if (ret == _FALSE) ++ return; ++ ++ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_ENTER, sta); ++} ++ ++void beamforming_leave(PADAPTER adapter, u8 *ra) ++{ ++ if (ra == NULL) ++ _beamforming_reset(adapter); ++ else ++ _deinit_entry(adapter, ra); ++} ++ ++void beamforming_sounding_fail(PADAPTER adapter) ++{ ++ RTW_ERR("+%s: not implemented yet!\n", __FUNCTION__); ++} ++ ++u8 beamforming_send_vht_gid_mgnt_packet(PADAPTER adapter, struct beamformee_entry *entry) ++{ ++ struct xmit_priv *xmitpriv; ++ struct mlme_priv *mlmepriv; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *attrib; ++ struct rtw_ieee80211_hdr *wlanhdr; ++ u8 *pframe; ++ ++ ++ xmitpriv = &adapter->xmitpriv; ++ mlmepriv = &adapter->mlmepriv; ++ ++ pmgntframe = alloc_mgtxmitframe(xmitpriv); ++ if (!pmgntframe) ++ return _FALSE; ++ ++ /* update attribute */ ++ attrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(adapter, attrib); ++ attrib->rate = MGN_6M; ++ attrib->bwmode = CHANNEL_WIDTH_20; ++ attrib->subtype = WIFI_ACTION; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)pmgntframe->buf_addr + TXDESC_OFFSET; ++ wlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ wlanhdr->frame_ctl = 0; ++ SetFrameSubType(pframe, attrib->subtype); ++ SetDuration(pframe, 0); ++ SetFragNum(pframe, 0); ++ SetSeqNum(pframe, 0); ++ ++ _rtw_memcpy(wlanhdr->addr1, entry->mac_addr, ETH_ALEN); ++ _rtw_memcpy(wlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); ++ _rtw_memcpy(wlanhdr->addr3, get_bssid(mlmepriv), ETH_ALEN); ++ ++ pframe[24] = RTW_WLAN_CATEGORY_VHT; ++ pframe[25] = RTW_WLAN_ACTION_VHT_GROUPID_MANAGEMENT; ++ _rtw_memcpy(&pframe[26], entry->gid_valid, 8); ++ _rtw_memcpy(&pframe[34], entry->user_position, 16); ++ ++ attrib->pktlen = 54; ++ attrib->last_txcmdsz = attrib->pktlen; ++ ++ dump_mgntframe(adapter, pmgntframe); ++ ++ return _TRUE; ++} ++ ++void beamforming_watchdog(PADAPTER adapter) ++{ ++} ++#else /* !RTW_BEAMFORMING_VERSION_2 */ ++ ++struct beamforming_entry *beamforming_get_entry_by_addr(struct mlme_priv *pmlmepriv, u8 *ra, u8 *idx) ++{ ++ u8 i = 0; ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); ++ ++ for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { ++ if (pBeamInfo->beamforming_entry[i].bUsed && ++ (_rtw_memcmp(ra, pBeamInfo->beamforming_entry[i].mac_addr, ETH_ALEN))) { ++ *idx = i; ++ return &(pBeamInfo->beamforming_entry[i]); ++ } ++ } ++ ++ return NULL; ++} ++ ++BEAMFORMING_CAP beamforming_get_entry_beam_cap_by_mac_id(PVOID pmlmepriv , u8 mac_id) ++{ ++ u8 i = 0; ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO((struct mlme_priv *)pmlmepriv); ++ BEAMFORMING_CAP BeamformEntryCap = BEAMFORMING_CAP_NONE; ++ ++ for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { ++ if (pBeamInfo->beamforming_entry[i].bUsed && ++ (mac_id == pBeamInfo->beamforming_entry[i].mac_id)) { ++ BeamformEntryCap = pBeamInfo->beamforming_entry[i].beamforming_entry_cap; ++ i = BEAMFORMING_ENTRY_NUM; ++ } ++ } ++ ++ return BeamformEntryCap; ++} ++ ++struct beamforming_entry *beamforming_get_free_entry(struct mlme_priv *pmlmepriv, u8 *idx) ++{ ++ u8 i = 0; ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); ++ ++ for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { ++ if (pBeamInfo->beamforming_entry[i].bUsed == _FALSE) { ++ *idx = i; ++ return &(pBeamInfo->beamforming_entry[i]); ++ } ++ } ++ return NULL; ++} ++ ++ ++struct beamforming_entry *beamforming_add_entry(PADAPTER adapter, u8 *ra, u16 aid, ++ u16 mac_id, CHANNEL_WIDTH bw, BEAMFORMING_CAP beamfrom_cap, u8 *idx) ++{ ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct beamforming_entry *pEntry = beamforming_get_free_entry(pmlmepriv, idx); ++ ++ if (pEntry != NULL) { ++ pEntry->bUsed = _TRUE; ++ pEntry->aid = aid; ++ pEntry->mac_id = mac_id; ++ pEntry->sound_bw = bw; ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ u16 BSSID = ((*(adapter_mac_addr(adapter) + 5) & 0xf0) >> 4) ^ ++ (*(adapter_mac_addr(adapter) + 5) & 0xf); /* BSSID[44:47] xor BSSID[40:43] */ ++ pEntry->p_aid = (aid + BSSID * 32) & 0x1ff; /* (dec(A) + dec(B)*32) mod 512 */ ++ pEntry->g_id = 63; ++ } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) { ++ pEntry->p_aid = 0; ++ pEntry->g_id = 63; ++ } else { ++ pEntry->p_aid = ra[5]; /* BSSID[39:47] */ ++ pEntry->p_aid = (pEntry->p_aid << 1) | (ra[4] >> 7); ++ pEntry->g_id = 0; ++ } ++ _rtw_memcpy(pEntry->mac_addr, ra, ETH_ALEN); ++ pEntry->bSound = _FALSE; ++ ++ /* 3 TODO SW/FW sound period */ ++ pEntry->sound_period = 200; ++ pEntry->beamforming_entry_cap = beamfrom_cap; ++ pEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; ++ ++ ++ pEntry->PreLogSeq = 0; /*Modified by Jeffery @2015-04-13*/ ++ pEntry->LogSeq = 0; /*Modified by Jeffery @2014-10-29*/ ++ pEntry->LogRetryCnt = 0; /*Modified by Jeffery @2014-10-29*/ ++ pEntry->LogSuccess = 0; /*LogSuccess is NOT needed to be accumulated, so LogSuccessCnt->LogSuccess, 2015-04-13, Jeffery*/ ++ pEntry->ClockResetTimes = 0; /*Modified by Jeffery @2015-04-13*/ ++ pEntry->LogStatusFailCnt = 0; ++ ++ return pEntry; ++ } else ++ return NULL; ++} ++ ++BOOLEAN beamforming_remove_entry(struct mlme_priv *pmlmepriv, u8 *ra, u8 *idx) ++{ ++ struct beamforming_entry *pEntry = beamforming_get_entry_by_addr(pmlmepriv, ra, idx); ++ ++ if (pEntry != NULL) { ++ pEntry->bUsed = _FALSE; ++ pEntry->beamforming_entry_cap = BEAMFORMING_CAP_NONE; ++ pEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; ++ return _TRUE; ++ } else ++ return _FALSE; ++} ++ ++/* Used for BeamformingStart_V1 */ ++void beamforming_dym_ndpa_rate(PADAPTER adapter) ++{ ++ u16 NDPARate = MGN_6M; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); ++ ++ if (pHalData->MinUndecoratedPWDBForDM > 30) /* link RSSI > 30% */ ++ NDPARate = MGN_24M; ++ else ++ NDPARate = MGN_6M; ++ ++ /* BW = CHANNEL_WIDTH_20; */ ++ NDPARate = NDPARate << 8; ++ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_RATE, (u8 *)&NDPARate); ++} ++ ++void beamforming_dym_period(PADAPTER Adapter) ++{ ++ u8 Idx; ++ BOOLEAN bChangePeriod = _FALSE; ++ u16 SoundPeriod_SW, SoundPeriod_FW; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); ++ struct beamforming_entry *pBeamformEntry; ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO((&Adapter->mlmepriv)); ++ struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); ++ ++ /* 3 TODO per-client throughput caculation. */ ++ ++ if (pdvobjpriv->traffic_stat.cur_tx_tp + pdvobjpriv->traffic_stat.cur_rx_tp > 2) { ++ SoundPeriod_SW = 32 * 20; ++ SoundPeriod_FW = 2; ++ } else { ++ SoundPeriod_SW = 32 * 2000; ++ SoundPeriod_FW = 200; ++ } ++ ++ for (Idx = 0; Idx < BEAMFORMING_ENTRY_NUM; Idx++) { ++ pBeamformEntry = pBeamInfo->beamforming_entry + Idx; ++ if (pBeamformEntry->bDefaultCSI) { ++ SoundPeriod_SW = 32 * 2000; ++ SoundPeriod_FW = 200; ++ } ++ ++ if (pBeamformEntry->beamforming_entry_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { ++ if (pSoundInfo->sound_mode == SOUNDING_FW_VHT_TIMER || pSoundInfo->sound_mode == SOUNDING_FW_HT_TIMER) { ++ if (pBeamformEntry->sound_period != SoundPeriod_FW) { ++ pBeamformEntry->sound_period = SoundPeriod_FW; ++ bChangePeriod = _TRUE; /* Only FW sounding need to send H2C packet to change sound period. */ ++ } ++ } else if (pBeamformEntry->sound_period != SoundPeriod_SW) ++ pBeamformEntry->sound_period = SoundPeriod_SW; ++ } ++ } ++ ++ if (bChangePeriod) ++ rtw_hal_set_hwreg(Adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&Idx); ++} ++ ++BOOLEAN issue_ht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; ++ u8 *pframe; ++ u16 *fctrl; ++ u16 duration = 0; ++ u8 aSifsTime = 0; ++ u8 NDPTxRate = 0; ++ ++ RTW_INFO("%s: issue_ht_sw_ndpa_packet!\n", __func__); ++ ++ NDPTxRate = MGN_MCS8; ++ RTW_INFO("%s: NDPTxRate =%d\n", __func__, NDPTxRate); ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ ++ if (pmgntframe == NULL) ++ return _FALSE; ++ ++ /*update attribute*/ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(Adapter, pattrib); ++ pattrib->qsel = QSLT_MGNT; ++ pattrib->rate = NDPTxRate; ++ pattrib->bwmode = bw; ++ pattrib->order = 1; ++ pattrib->subtype = WIFI_ACTION_NOACK; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &pwlanhdr->frame_ctl; ++ *(fctrl) = 0; ++ ++ SetOrderBit(pframe); ++ SetFrameSubType(pframe, WIFI_ACTION_NOACK); ++ ++ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ if (pmlmeext->cur_wireless_mode == WIRELESS_11B) ++ aSifsTime = 10; ++ else ++ aSifsTime = 16; ++ ++ duration = 2 * aSifsTime + 40; ++ ++ if (bw == CHANNEL_WIDTH_40) ++ duration += 87; ++ else ++ duration += 180; ++ ++ SetDuration(pframe, duration); ++ ++ /*HT control field*/ ++ SET_HT_CTRL_CSI_STEERING(pframe + 24, 3); ++ SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe + 24, 1); ++ ++ _rtw_memcpy(pframe + 28, ActionHdr, 4); ++ ++ pattrib->pktlen = 32; ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(Adapter, pmgntframe); ++ ++ return _TRUE; ++ ++ ++} ++BOOLEAN issue_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; ++ u8 *pframe; ++ u16 *fctrl; ++ u16 duration = 0; ++ u8 aSifsTime = 0; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ ++ if (pmgntframe == NULL) ++ return _FALSE; ++ ++ /*update attribute*/ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(Adapter, pattrib); ++ ++ if (qidx == BCN_QUEUE_INX) ++ pattrib->qsel = QSLT_BEACON; ++ pattrib->rate = MGN_MCS8; ++ pattrib->bwmode = bw; ++ pattrib->order = 1; ++ pattrib->subtype = WIFI_ACTION_NOACK; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &pwlanhdr->frame_ctl; ++ *(fctrl) = 0; ++ ++ SetOrderBit(pframe); ++ SetFrameSubType(pframe, WIFI_ACTION_NOACK); ++ ++ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ if (pmlmeext->cur_wireless_mode == WIRELESS_11B) ++ aSifsTime = 10; ++ else ++ aSifsTime = 16; ++ ++ duration = 2 * aSifsTime + 40; ++ ++ if (bw == CHANNEL_WIDTH_40) ++ duration += 87; ++ else ++ duration += 180; ++ ++ SetDuration(pframe, duration); ++ ++ /* HT control field */ ++ SET_HT_CTRL_CSI_STEERING(pframe + 24, 3); ++ SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe + 24, 1); ++ ++ _rtw_memcpy(pframe + 28, ActionHdr, 4); ++ ++ pattrib->pktlen = 32; ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(Adapter, pmgntframe); ++ ++ return _TRUE; ++} ++ ++BOOLEAN beamforming_send_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx) ++{ ++ return issue_ht_ndpa_packet(Adapter, ra, bw, qidx); ++} ++BOOLEAN issue_vht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); ++ struct rtw_ndpa_sta_info sta_info; ++ u8 NDPTxRate = 0; ++ ++ u8 *pframe; ++ u16 *fctrl; ++ u16 duration = 0; ++ u8 sequence = 0, aSifsTime = 0; ++ ++ RTW_INFO("%s: issue_vht_sw_ndpa_packet!\n", __func__); ++ ++ ++ NDPTxRate = MGN_VHT2SS_MCS0; ++ RTW_INFO("%s: NDPTxRate =%d\n", __func__, NDPTxRate); ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ ++ if (pmgntframe == NULL) { ++ RTW_INFO("%s, alloc mgnt frame fail\n", __func__); ++ return _FALSE; ++ } ++ ++ /*update attribute*/ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(Adapter, pattrib); ++ pattrib->qsel = QSLT_MGNT; ++ pattrib->rate = NDPTxRate; ++ pattrib->bwmode = bw; ++ pattrib->subtype = WIFI_NDPA; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &pwlanhdr->frame_ctl; ++ *(fctrl) = 0; ++ ++ SetFrameSubType(pframe, WIFI_NDPA); ++ ++ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); ++ ++ if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) ++ aSifsTime = 16; ++ else ++ aSifsTime = 10; ++ ++ duration = 2 * aSifsTime + 44; ++ ++ if (bw == CHANNEL_WIDTH_80) ++ duration += 40; ++ else if (bw == CHANNEL_WIDTH_40) ++ duration += 87; ++ else ++ duration += 180; ++ ++ SetDuration(pframe, duration); ++ ++ sequence = pBeamInfo->sounding_sequence << 2; ++ if (pBeamInfo->sounding_sequence >= 0x3f) ++ pBeamInfo->sounding_sequence = 0; ++ else ++ pBeamInfo->sounding_sequence++; ++ ++ _rtw_memcpy(pframe + 16, &sequence, 1); ++ if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) ++ aid = 0; ++ ++ sta_info.aid = aid; ++ sta_info.feedback_type = 0; ++ sta_info.nc_index = 0; ++ ++ _rtw_memcpy(pframe + 17, (u8 *)&sta_info, 2); ++ ++ pattrib->pktlen = 19; ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(Adapter, pmgntframe); ++ ++ ++ return _TRUE; ++ ++} ++BOOLEAN issue_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); ++ struct rtw_ndpa_sta_info sta_info; ++ u8 *pframe; ++ u16 *fctrl; ++ u16 duration = 0; ++ u8 sequence = 0, aSifsTime = 0; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return _FALSE; ++ ++ /*update attribute*/ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(Adapter, pattrib); ++ ++ if (qidx == BCN_QUEUE_INX) ++ pattrib->qsel = QSLT_BEACON; ++ pattrib->rate = MGN_VHT2SS_MCS0; ++ pattrib->bwmode = bw; ++ pattrib->subtype = WIFI_NDPA; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &pwlanhdr->frame_ctl; ++ *(fctrl) = 0; ++ ++ SetFrameSubType(pframe, WIFI_NDPA); ++ ++ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); ++ ++ if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) ++ aSifsTime = 16; ++ else ++ aSifsTime = 10; ++ ++ duration = 2 * aSifsTime + 44; ++ ++ if (bw == CHANNEL_WIDTH_80) ++ duration += 40; ++ else if (bw == CHANNEL_WIDTH_40) ++ duration += 87; ++ else ++ duration += 180; ++ ++ SetDuration(pframe, duration); ++ ++ sequence = pBeamInfo->sounding_sequence << 2; ++ if (pBeamInfo->sounding_sequence >= 0x3f) ++ pBeamInfo->sounding_sequence = 0; ++ else ++ pBeamInfo->sounding_sequence++; ++ ++ _rtw_memcpy(pframe + 16, &sequence, 1); ++ ++ if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) ++ aid = 0; ++ ++ sta_info.aid = aid; ++ sta_info.feedback_type = 0; ++ sta_info.nc_index = 0; ++ ++ _rtw_memcpy(pframe + 17, (u8 *)&sta_info, 2); ++ ++ pattrib->pktlen = 19; ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(Adapter, pmgntframe); ++ ++ return _TRUE; ++} ++ ++BOOLEAN beamforming_send_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) ++{ ++ return issue_vht_ndpa_packet(Adapter, ra, aid, bw, qidx); ++} ++ ++BOOLEAN beamfomring_bSounding(struct beamforming_info *pBeamInfo) ++{ ++ BOOLEAN bSounding = _FALSE; ++ ++ if ((beamforming_get_beamform_cap(pBeamInfo) & BEAMFORMER_CAP) == 0) ++ bSounding = _FALSE; ++ else ++ bSounding = _TRUE; ++ ++ return bSounding; ++} ++ ++u8 beamforming_sounding_idx(struct beamforming_info *pBeamInfo) ++{ ++ u8 idx = 0; ++ u8 i; ++ ++ for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { ++ if (pBeamInfo->beamforming_entry[i].bUsed && ++ (_FALSE == pBeamInfo->beamforming_entry[i].bSound)) { ++ idx = i; ++ break; ++ } ++ } ++ ++ return idx; ++} ++ ++SOUNDING_MODE beamforming_sounding_mode(struct beamforming_info *pBeamInfo, u8 idx) ++{ ++ struct beamforming_entry BeamEntry = pBeamInfo->beamforming_entry[idx]; ++ SOUNDING_MODE mode; ++ ++ if (BeamEntry.beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) ++ mode = SOUNDING_FW_VHT_TIMER; ++ else if (BeamEntry.beamforming_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT) ++ mode = SOUNDING_FW_HT_TIMER; ++ else ++ mode = SOUNDING_STOP_All_TIMER; ++ ++ return mode; ++} ++ ++u16 beamforming_sounding_time(struct beamforming_info *pBeamInfo, SOUNDING_MODE mode, u8 idx) ++{ ++ u16 sounding_time = 0xffff; ++ struct beamforming_entry BeamEntry = pBeamInfo->beamforming_entry[idx]; ++ ++ sounding_time = BeamEntry.sound_period; ++ ++ return sounding_time; ++} ++ ++CHANNEL_WIDTH beamforming_sounding_bw(struct beamforming_info *pBeamInfo, SOUNDING_MODE mode, u8 idx) ++{ ++ CHANNEL_WIDTH sounding_bw = CHANNEL_WIDTH_20; ++ struct beamforming_entry BeamEntry = pBeamInfo->beamforming_entry[idx]; ++ ++ sounding_bw = BeamEntry.sound_bw; ++ ++ return sounding_bw; ++} ++ ++BOOLEAN beamforming_select_beam_entry(struct beamforming_info *pBeamInfo) ++{ ++ struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); ++ ++ pSoundInfo->sound_idx = beamforming_sounding_idx(pBeamInfo); ++ ++ if (pSoundInfo->sound_idx < BEAMFORMING_ENTRY_NUM) ++ pSoundInfo->sound_mode = beamforming_sounding_mode(pBeamInfo, pSoundInfo->sound_idx); ++ else ++ pSoundInfo->sound_mode = SOUNDING_STOP_All_TIMER; ++ ++ if (SOUNDING_STOP_All_TIMER == pSoundInfo->sound_mode) ++ return _FALSE; ++ else { ++ pSoundInfo->sound_bw = beamforming_sounding_bw(pBeamInfo, pSoundInfo->sound_mode, pSoundInfo->sound_idx); ++ pSoundInfo->sound_period = beamforming_sounding_time(pBeamInfo, pSoundInfo->sound_mode, pSoundInfo->sound_idx); ++ return _TRUE; ++ } ++} ++ ++BOOLEAN beamforming_start_fw(PADAPTER adapter, u8 idx) ++{ ++ u8 *RA = NULL; ++ struct beamforming_entry *pEntry; ++ BOOLEAN ret = _TRUE; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); ++ ++ pEntry = &(pBeamInfo->beamforming_entry[idx]); ++ if (pEntry->bUsed == _FALSE) { ++ RTW_INFO("Skip Beamforming, no entry for Idx =%d\n", idx); ++ return _FALSE; ++ } ++ ++ pEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; ++ pEntry->bSound = _TRUE; ++ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&idx); ++ ++ return _TRUE; ++} ++ ++void beamforming_end_fw(PADAPTER adapter) ++{ ++ u8 idx = 0; ++ ++ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&idx); ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++} ++ ++BOOLEAN beamforming_start_period(PADAPTER adapter) ++{ ++ BOOLEAN ret = _TRUE; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); ++ struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); ++ ++ beamforming_dym_ndpa_rate(adapter); ++ ++ beamforming_select_beam_entry(pBeamInfo); ++ ++ if (pSoundInfo->sound_mode == SOUNDING_FW_VHT_TIMER || pSoundInfo->sound_mode == SOUNDING_FW_HT_TIMER) ++ ret = beamforming_start_fw(adapter, pSoundInfo->sound_idx); ++ else ++ ret = _FALSE; ++ ++ RTW_INFO("%s Idx %d Mode %d BW %d Period %d\n", __FUNCTION__, ++ pSoundInfo->sound_idx, pSoundInfo->sound_mode, pSoundInfo->sound_bw, pSoundInfo->sound_period); ++ ++ return ret; ++} ++ ++void beamforming_end_period(PADAPTER adapter) ++{ ++ u8 idx = 0; ++ struct beamforming_entry *pBeamformEntry; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); ++ struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); ++ ++ ++ if (pSoundInfo->sound_mode == SOUNDING_FW_VHT_TIMER || pSoundInfo->sound_mode == SOUNDING_FW_HT_TIMER) ++ beamforming_end_fw(adapter); ++} ++ ++void beamforming_notify(PADAPTER adapter) ++{ ++ BOOLEAN bSounding = _FALSE; ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(&(adapter->mlmepriv)); ++ ++ bSounding = beamfomring_bSounding(pBeamInfo); ++ ++ if (pBeamInfo->beamforming_state == BEAMFORMING_STATE_IDLE) { ++ if (bSounding) { ++ if (beamforming_start_period(adapter) == _TRUE) ++ pBeamInfo->beamforming_state = BEAMFORMING_STATE_START; ++ } ++ } else if (pBeamInfo->beamforming_state == BEAMFORMING_STATE_START) { ++ if (bSounding) { ++ if (beamforming_start_period(adapter) == _FALSE) ++ pBeamInfo->beamforming_state = BEAMFORMING_STATE_END; ++ } else { ++ beamforming_end_period(adapter); ++ pBeamInfo->beamforming_state = BEAMFORMING_STATE_END; ++ } ++ } else if (pBeamInfo->beamforming_state == BEAMFORMING_STATE_END) { ++ if (bSounding) { ++ if (beamforming_start_period(adapter) == _TRUE) ++ pBeamInfo->beamforming_state = BEAMFORMING_STATE_START; ++ } ++ } else ++ RTW_INFO("%s BeamformState %d\n", __FUNCTION__, pBeamInfo->beamforming_state); ++ ++ RTW_INFO("%s BeamformState %d bSounding %d\n", __FUNCTION__, pBeamInfo->beamforming_state, bSounding); ++} ++ ++BOOLEAN beamforming_init_entry(PADAPTER adapter, struct sta_info *psta, u8 *idx) ++{ ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct ht_priv *phtpriv = &(pmlmepriv->htpriv); ++#ifdef CONFIG_80211AC_VHT ++ struct vht_priv *pvhtpriv = &(pmlmepriv->vhtpriv); ++#endif ++ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct beamforming_entry *pBeamformEntry = NULL; ++ u8 *ra; ++ u16 aid, mac_id; ++ u8 wireless_mode; ++ CHANNEL_WIDTH bw = CHANNEL_WIDTH_20; ++ BEAMFORMING_CAP beamform_cap = BEAMFORMING_CAP_NONE; ++ ++ /* The current setting does not support Beaforming */ ++ if (0 == phtpriv->beamform_cap ++#ifdef CONFIG_80211AC_VHT ++ && 0 == pvhtpriv->beamform_cap ++#endif ++ ) { ++ RTW_INFO("The configuration disabled Beamforming! Skip...\n"); ++ return _FALSE; ++ } ++ ++ aid = psta->aid; ++ ra = psta->hwaddr; ++ mac_id = psta->mac_id; ++ wireless_mode = psta->wireless_mode; ++ bw = psta->bw_mode; ++ ++ if (IsSupportedHT(wireless_mode) || IsSupportedVHT(wireless_mode)) { ++ /* 3 */ /* HT */ ++ u8 cur_beamform; ++ ++ cur_beamform = psta->htpriv.beamform_cap; ++ ++ /* We are Beamformee because the STA is Beamformer */ ++ if (TEST_FLAG(cur_beamform, BEAMFORMING_HT_BEAMFORMER_ENABLE)) ++ beamform_cap = (BEAMFORMING_CAP)(beamform_cap | BEAMFORMEE_CAP_HT_EXPLICIT); ++ ++ /* We are Beamformer because the STA is Beamformee */ ++ if (TEST_FLAG(cur_beamform, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) ++ beamform_cap = (BEAMFORMING_CAP)(beamform_cap | BEAMFORMER_CAP_HT_EXPLICIT); ++#ifdef CONFIG_80211AC_VHT ++ if (IsSupportedVHT(wireless_mode)) { ++ /* 3 */ /* VHT */ ++ cur_beamform = psta->vhtpriv.beamform_cap; ++ ++ /* We are Beamformee because the STA is Beamformer */ ++ if (TEST_FLAG(cur_beamform, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) ++ beamform_cap = (BEAMFORMING_CAP)(beamform_cap | BEAMFORMEE_CAP_VHT_SU); ++ /* We are Beamformer because the STA is Beamformee */ ++ if (TEST_FLAG(cur_beamform, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) ++ beamform_cap = (BEAMFORMING_CAP)(beamform_cap | BEAMFORMER_CAP_VHT_SU); ++ } ++#endif /* CONFIG_80211AC_VHT */ ++ ++ if (beamform_cap == BEAMFORMING_CAP_NONE) ++ return _FALSE; ++ ++ RTW_INFO("Beamforming Config Capability = 0x%02X\n", beamform_cap); ++ ++ pBeamformEntry = beamforming_get_entry_by_addr(pmlmepriv, ra, idx); ++ if (pBeamformEntry == NULL) { ++ pBeamformEntry = beamforming_add_entry(adapter, ra, aid, mac_id, bw, beamform_cap, idx); ++ if (pBeamformEntry == NULL) ++ return _FALSE; ++ else ++ pBeamformEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; ++ } else { ++ /* Entry has been created. If entry is initialing or progressing then errors occur. */ ++ if (pBeamformEntry->beamforming_entry_state != BEAMFORMING_ENTRY_STATE_INITIALIZED && ++ pBeamformEntry->beamforming_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSED) { ++ RTW_INFO("Error State of Beamforming"); ++ return _FALSE; ++ } else ++ pBeamformEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; ++ } ++ ++ pBeamformEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; ++ psta->txbf_paid = pBeamformEntry->p_aid; ++ psta->txbf_gid = pBeamformEntry->g_id; ++ ++ RTW_INFO("%s Idx %d\n", __FUNCTION__, *idx); ++ } else ++ return _FALSE; ++ ++ return _SUCCESS; ++} ++ ++void beamforming_deinit_entry(PADAPTER adapter, u8 *ra) ++{ ++ u8 idx = 0; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ ++ if (beamforming_remove_entry(pmlmepriv, ra, &idx) == _TRUE) ++ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_LEAVE, (u8 *)&idx); ++ ++ RTW_INFO("%s Idx %d\n", __FUNCTION__, idx); ++} ++ ++void beamforming_reset(PADAPTER adapter) ++{ ++ u8 idx = 0; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); ++ ++ for (idx = 0; idx < BEAMFORMING_ENTRY_NUM; idx++) { ++ if (pBeamInfo->beamforming_entry[idx].bUsed == _TRUE) { ++ pBeamInfo->beamforming_entry[idx].bUsed = _FALSE; ++ pBeamInfo->beamforming_entry[idx].beamforming_entry_cap = BEAMFORMING_CAP_NONE; ++ pBeamInfo->beamforming_entry[idx].beamforming_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; ++ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_LEAVE, (u8 *)&idx); ++ } ++ } ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++} ++ ++void beamforming_sounding_fail(PADAPTER Adapter) ++{ ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); ++ struct beamforming_entry *pEntry = &(pBeamInfo->beamforming_entry[pBeamInfo->beamforming_cur_idx]); ++ ++ pEntry->bSound = _FALSE; ++ rtw_hal_set_hwreg(Adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&pBeamInfo->beamforming_cur_idx); ++ beamforming_deinit_entry(Adapter, pEntry->mac_addr); ++} ++ ++void beamforming_check_sounding_success(PADAPTER Adapter, BOOLEAN status) ++{ ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); ++ struct beamforming_entry *pEntry = &(pBeamInfo->beamforming_entry[pBeamInfo->beamforming_cur_idx]); ++ ++ if (status == 1) ++ pEntry->LogStatusFailCnt = 0; ++ else { ++ pEntry->LogStatusFailCnt++; ++ RTW_INFO("%s LogStatusFailCnt %d\n", __FUNCTION__, pEntry->LogStatusFailCnt); ++ } ++ if (pEntry->LogStatusFailCnt > 20) { ++ RTW_INFO("%s LogStatusFailCnt > 20, Stop SOUNDING\n", __FUNCTION__); ++ /* pEntry->bSound = _FALSE; */ ++ /* rtw_hal_set_hwreg(Adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&pBeamInfo->beamforming_cur_idx); */ ++ /* beamforming_deinit_entry(Adapter, pEntry->mac_addr); */ ++ beamforming_wk_cmd(Adapter, BEAMFORMING_CTRL_SOUNDING_FAIL, NULL, 0, 1); ++ } ++} ++ ++void beamforming_enter(PADAPTER adapter, PVOID psta) ++{ ++ u8 idx = 0xff; ++ ++ if (beamforming_init_entry(adapter, (struct sta_info *)psta, &idx)) ++ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_ENTER, (u8 *)&idx); ++ ++ /* RTW_INFO("%s Idx %d\n", __FUNCTION__, idx); */ ++} ++ ++void beamforming_leave(PADAPTER adapter, u8 *ra) ++{ ++ if (ra == NULL) ++ beamforming_reset(adapter); ++ else ++ beamforming_deinit_entry(adapter, ra); ++ ++ beamforming_notify(adapter); ++} ++ ++BEAMFORMING_CAP beamforming_get_beamform_cap(struct beamforming_info *pBeamInfo) ++{ ++ u8 i; ++ BOOLEAN bSelfBeamformer = _FALSE; ++ BOOLEAN bSelfBeamformee = _FALSE; ++ struct beamforming_entry beamforming_entry; ++ BEAMFORMING_CAP beamform_cap = BEAMFORMING_CAP_NONE; ++ ++ for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { ++ beamforming_entry = pBeamInfo->beamforming_entry[i]; ++ ++ if (beamforming_entry.bUsed) { ++ if ((beamforming_entry.beamforming_entry_cap & BEAMFORMEE_CAP_VHT_SU) || ++ (beamforming_entry.beamforming_entry_cap & BEAMFORMEE_CAP_HT_EXPLICIT)) ++ bSelfBeamformee = _TRUE; ++ if ((beamforming_entry.beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) || ++ (beamforming_entry.beamforming_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT)) ++ bSelfBeamformer = _TRUE; ++ } ++ ++ if (bSelfBeamformer && bSelfBeamformee) ++ i = BEAMFORMING_ENTRY_NUM; ++ } ++ ++ if (bSelfBeamformer) ++ beamform_cap |= BEAMFORMER_CAP; ++ if (bSelfBeamformee) ++ beamform_cap |= BEAMFORMEE_CAP; ++ ++ return beamform_cap; ++} ++ ++void beamforming_watchdog(PADAPTER Adapter) ++{ ++ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO((&(Adapter->mlmepriv))); ++ ++ if (pBeamInfo->beamforming_state != BEAMFORMING_STATE_START) ++ return; ++ ++ beamforming_dym_period(Adapter); ++ beamforming_dym_ndpa_rate(Adapter); ++} ++#endif /* !RTW_BEAMFORMING_VERSION_2 */ ++#endif/* #if (BEAMFORMING_SUPPORT ==0) - for diver defined beamforming*/ ++ ++u32 beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_frame) ++{ ++ u32 ret = _SUCCESS; ++#if (BEAMFORMING_SUPPORT == 1) ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ ++ ret = Beamforming_GetReportFrame(pDM_Odm, precv_frame); ++ ++#else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ ++#ifdef RTW_BEAMFORMING_VERSION_2 ++ struct beamformee_entry *pBeamformEntry = NULL; ++ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ u32 frame_len = precv_frame->u.hdr.len; ++ u8 *ta; ++ u8 *frame_body; ++ u8 category, action; ++ u8 *pMIMOCtrlField, *pCSIMatrix; ++ u8 Nc = 0, Nr = 0, CH_W = 0; ++ u16 CSIMatrixLen = 0; ++ ++ ++ RTW_DBG("+%s\n", __FUNCTION__); ++ ++ /* Memory comparison to see if CSI report is the same with previous one */ ++ ta = GetAddr2Ptr(pframe); ++ pBeamformEntry = beamforming_get_bfee_entry_by_addr(Adapter, ta); ++ if (!pBeamformEntry) ++ return _FAIL; ++ ++ frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); ++ category = frame_body[0]; ++ action = frame_body[1]; ++ ++ if ((category == RTW_WLAN_CATEGORY_VHT) ++ && (action == RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING)) { ++ pMIMOCtrlField = pframe + 26; ++ Nc = ((*pMIMOCtrlField) & 0x7) + 1; ++ Nr = (((*pMIMOCtrlField) & 0x38) >> 3) + 1; ++ CH_W = (((*pMIMOCtrlField) & 0xC0) >> 6); ++ /* ++ * 24+(1+1+3)+2 ++ * ==> MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2) ++ */ ++ pCSIMatrix = pMIMOCtrlField + 3 + Nc; ++ CSIMatrixLen = frame_len - 26 - 3 - Nc; ++ } else if ((category == RTW_WLAN_CATEGORY_HT) ++ && (action == RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING)) { ++ pMIMOCtrlField = pframe + 26; ++ Nc = ((*pMIMOCtrlField) & 0x3) + 1; ++ Nr = (((*pMIMOCtrlField) & 0xC) >> 2) + 1; ++ CH_W = ((*pMIMOCtrlField) & 0x10) >> 4; ++ /* ++ * 24+(1+1+6)+2 ++ * ==> MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2) ++ */ ++ pCSIMatrix = pMIMOCtrlField + 6 + Nr; ++ CSIMatrixLen = frame_len - 26 - 6 - Nr; ++ } ++ ++ RTW_INFO("%s: pkt type=%d-%d, Nc=%d, Nr=%d, CH_W=%d\n", ++ __FUNCTION__, category, action, Nc, Nr, CH_W); ++#else /* !RTW_BEAMFORMING_VERSION_2 */ ++ struct beamforming_entry *pBeamformEntry = NULL; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ u32 frame_len = precv_frame->u.hdr.len; ++ u8 *ta; ++ u8 idx, offset; ++ ++ /*RTW_INFO("beamforming_get_report_frame\n");*/ ++ ++ /*Memory comparison to see if CSI report is the same with previous one*/ ++ ta = GetAddr2Ptr(pframe); ++ pBeamformEntry = beamforming_get_entry_by_addr(pmlmepriv, ta, &idx); ++ if (pBeamformEntry->beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) ++ offset = 31; /*24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ ++ else if (pBeamformEntry->beamforming_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT) ++ offset = 34; /*24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ ++ else ++ return ret; ++ ++ /*RTW_INFO("%s MacId %d offset=%d\n", __FUNCTION__, pBeamformEntry->mac_id, offset);*/ ++ ++ if (_rtw_memcmp(pBeamformEntry->PreCsiReport + offset, pframe + offset, frame_len - offset) == _FALSE) ++ pBeamformEntry->DefaultCsiCnt = 0; ++ else ++ pBeamformEntry->DefaultCsiCnt++; ++ ++ _rtw_memcpy(&pBeamformEntry->PreCsiReport, pframe, frame_len); ++ ++ pBeamformEntry->bDefaultCSI = _FALSE; ++ ++ if (pBeamformEntry->DefaultCsiCnt > 20) ++ pBeamformEntry->bDefaultCSI = _TRUE; ++ else ++ pBeamformEntry->bDefaultCSI = _FALSE; ++#endif /* !RTW_BEAMFORMING_VERSION_2 */ ++#endif ++ return ret; ++} ++ ++void beamforming_get_ndpa_frame(PADAPTER Adapter, union recv_frame *precv_frame) ++{ ++#if (BEAMFORMING_SUPPORT == 1) ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ ++ Beamforming_GetNDPAFrame(pDM_Odm, precv_frame); ++ ++#else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ ++#ifdef RTW_BEAMFORMING_VERSION_2 ++ RTW_DBG("+%s\n", __FUNCTION__); ++#else /* !RTW_BEAMFORMING_VERSION_2 */ ++ u8 *ta; ++ u8 idx, Sequence; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ struct beamforming_entry *pBeamformEntry = NULL; ++ ++ /*RTW_INFO("beamforming_get_ndpa_frame\n");*/ ++ ++ if (IS_HARDWARE_TYPE_8812(Adapter) == _FALSE) ++ return; ++ else if (GetFrameSubType(pframe) != WIFI_NDPA) ++ return; ++ ++ ta = GetAddr2Ptr(pframe); ++ /*Remove signaling TA. */ ++ ta[0] = ta[0] & 0xFE; ++ ++ pBeamformEntry = beamforming_get_entry_by_addr(pmlmepriv, ta, &idx); ++ ++ if (pBeamformEntry == NULL) ++ return; ++ else if (!(pBeamformEntry->beamforming_entry_cap & BEAMFORMEE_CAP_VHT_SU)) ++ return; ++ /*LogSuccess: As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is NO LONGER needed !2015-04-10, Jeffery*/ ++ /*ClockResetTimes: While BFer entry always doesn't receive our CSI, clock will reset again and again.So ClockResetTimes is limited to 5 times.2015-04-13, Jeffery*/ ++ else if ((pBeamformEntry->LogSuccess == 1) || (pBeamformEntry->ClockResetTimes == 5)) { ++ RTW_INFO("[%s] LogSeq=%d, PreLogSeq=%d\n", __func__, pBeamformEntry->LogSeq, pBeamformEntry->PreLogSeq); ++ return; ++ } ++ ++ Sequence = (pframe[16]) >> 2; ++ RTW_INFO("[%s] Start, Sequence=%d, LogSeq=%d, PreLogSeq=%d, LogRetryCnt=%d, ClockResetTimes=%d, LogSuccess=%d\n", ++ __func__, Sequence, pBeamformEntry->LogSeq, pBeamformEntry->PreLogSeq, pBeamformEntry->LogRetryCnt, pBeamformEntry->ClockResetTimes, pBeamformEntry->LogSuccess); ++ ++ if ((pBeamformEntry->LogSeq != 0) && (pBeamformEntry->PreLogSeq != 0)) { ++ /*Success condition*/ ++ if ((pBeamformEntry->LogSeq != Sequence) && (pBeamformEntry->PreLogSeq != pBeamformEntry->LogSeq)) { ++ /* break option for clcok reset, 2015-03-30, Jeffery */ ++ pBeamformEntry->LogRetryCnt = 0; ++ /*As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is no longer needed.*/ ++ /*That is, LogSuccess is NOT needed to be reset to zero, 2015-04-13, Jeffery*/ ++ pBeamformEntry->LogSuccess = 1; ++ ++ } else {/*Fail condition*/ ++ ++ if (pBeamformEntry->LogRetryCnt == 5) { ++ pBeamformEntry->ClockResetTimes++; ++ pBeamformEntry->LogRetryCnt = 0; ++ ++ RTW_INFO("[%s] Clock Reset!!! ClockResetTimes=%d\n", __func__, pBeamformEntry->ClockResetTimes); ++ beamforming_wk_cmd(Adapter, BEAMFORMING_CTRL_SOUNDING_CLK, NULL, 0, 1); ++ ++ } else ++ pBeamformEntry->LogRetryCnt++; ++ } ++ } ++ ++ /*Update LogSeq & PreLogSeq*/ ++ pBeamformEntry->PreLogSeq = pBeamformEntry->LogSeq; ++ pBeamformEntry->LogSeq = Sequence; ++#endif /* !RTW_BEAMFORMING_VERSION_2 */ ++#endif ++ ++} ++ ++/* octets in data header, no WEP */ ++#define sMacHdrLng 24 ++/* VHT Group ID (GID) Management Frame */ ++#define FRAME_OFFSET_VHT_GID_MGNT_MEMBERSHIP_STATUS_ARRAY (sMacHdrLng + 2) ++#define FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY (sMacHdrLng + 10) ++/* VHT GID Management Frame Info */ ++#define GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(_pStart) LE_BITS_TO_1BYTE((_pStart), 0, 8) ++#define GET_VHT_GID_MGNT_INFO_USER_POSITION(_pStart) LE_BITS_TO_1BYTE((_pStart), 0, 8) ++/* ++ * Description: ++ * On VHT GID management frame by an MU beamformee. ++ * ++ * 2015.05.20. Created by tynli. ++ */ ++u32 beamforming_get_vht_gid_mgnt_frame(PADAPTER adapter, union recv_frame *precv_frame) ++{ ++#ifdef RTW_BEAMFORMING_VERSION_2 ++ u8 *ta; ++ u8 idx; ++ u8 *pframe; ++ u8 *pBuffer = NULL; ++ struct beamformer_entry *bfer = NULL; ++ ++ ++ RTW_DBG("+%s\n", __FUNCTION__); ++ ++ pframe = precv_frame->u.hdr.rx_data; ++ /* Get BFer entry by Addr2 */ ++ ta = GetAddr2Ptr(pframe); ++ /* Remove signaling TA */ ++ ta[0] &= 0xFE; ++ ++ bfer = beamforming_get_bfer_entry_by_addr(adapter, ta); ++ if (!bfer) { ++ RTW_INFO("%s: Cannot find BFer entry!!\n", __FUNCTION__); ++ return _FAIL; ++ } ++ ++ /* Parsing Membership Status Array */ ++ pBuffer = pframe + FRAME_OFFSET_VHT_GID_MGNT_MEMBERSHIP_STATUS_ARRAY; ++ for (idx = 0; idx < 8; idx++) ++ bfer->gid_valid[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(pBuffer+idx); ++ ++ /* Parsing User Position Array */ ++ pBuffer = pframe + FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY; ++ for (idx = 0; idx < 16; idx++) ++ bfer->user_position[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(pBuffer+idx); ++ ++ /* Config HW GID table */ ++ beamforming_wk_cmd(adapter, BEAMFORMING_CTRL_SET_GID_TABLE, (u8*)&bfer, sizeof(struct beamformer_entry *), 1); ++ ++ return _SUCCESS; ++#else /* !RTW_BEAMFORMING_VERSION_2 */ ++ return _FAIL; ++#endif /* !RTW_BEAMFORMING_VERSION_2 */ ++} ++ ++void beamforming_wk_hdl(_adapter *padapter, u8 type, u8 *pbuf) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ ++#if (BEAMFORMING_SUPPORT == 1) /*(BEAMFORMING_SUPPORT == 1)- for PHYDM beamfoming*/ ++ switch (type) { ++ case BEAMFORMING_CTRL_ENTER: { ++ struct sta_info *psta = (PVOID)pbuf; ++ u16 staIdx = psta->mac_id; ++ ++ Beamforming_Enter(pDM_Odm, staIdx); ++ break; ++ } ++ case BEAMFORMING_CTRL_LEAVE: ++ Beamforming_Leave(pDM_Odm, pbuf); ++ break; ++ default: ++ break; ++ ++ } ++#else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ ++ switch (type) { ++ case BEAMFORMING_CTRL_ENTER: ++ beamforming_enter(padapter, (PVOID)pbuf); ++ break; ++ ++ case BEAMFORMING_CTRL_LEAVE: ++ beamforming_leave(padapter, pbuf); ++ break; ++ ++ case BEAMFORMING_CTRL_SOUNDING_FAIL: ++ beamforming_sounding_fail(padapter); ++ break; ++ ++ case BEAMFORMING_CTRL_SOUNDING_CLK: ++ rtw_hal_set_hwreg(padapter, HW_VAR_SOUNDING_CLK, NULL); ++ break; ++ ++ case BEAMFORMING_CTRL_SET_GID_TABLE: ++ rtw_hal_set_hwreg(padapter, HW_VAR_SOUNDING_SET_GID_TABLE, *(void**)pbuf); ++ break; ++ ++ default: ++ break; ++ } ++#endif ++} ++ ++u8 beamforming_wk_cmd(_adapter *padapter, s32 type, u8 *pbuf, s32 size, u8 enqueue) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ++ if (enqueue) { ++ u8 *wk_buf; ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ if (pbuf != NULL) { ++ wk_buf = rtw_zmalloc(size); ++ if (wk_buf == NULL) { ++ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); ++ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ _rtw_memcpy(wk_buf, pbuf, size); ++ } else { ++ wk_buf = NULL; ++ size = 0; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = BEAMFORMING_WK_CID; ++ pdrvextra_cmd_parm->type = type; ++ pdrvextra_cmd_parm->size = size; ++ pdrvextra_cmd_parm->pbuf = wk_buf; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ } else ++ beamforming_wk_hdl(padapter, type, pbuf); ++ ++exit: ++ ++ ++ return res; ++} ++ ++void update_attrib_txbf_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) ++{ ++ if (psta) { ++ pattrib->txbf_g_id = psta->txbf_gid; ++ pattrib->txbf_p_aid = psta->txbf_paid; ++ } ++} ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_br_ext.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_br_ext.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_br_ext.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_br_ext.c 2018-02-11 21:44:27.135145903 +0200 +@@ -0,0 +1,1585 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_BR_EXT_C_ ++ ++#ifdef __KERNEL__ ++ #include ++ #include ++ #include ++ #include ++ #include ++ #include ++#endif ++ ++#if 1 /* rtw_wifi_driver */ ++ #include ++#else /* rtw_wifi_driver */ ++ #include "./8192cd_cfg.h" ++ ++ #ifndef __KERNEL__ ++ #include "./sys-support.h" ++ #endif ++ ++ #include "./8192cd.h" ++ #include "./8192cd_headers.h" ++ #include "./8192cd_br_ext.h" ++ #include "./8192cd_debug.h" ++#endif /* rtw_wifi_driver */ ++ ++#ifdef CL_IPV6_PASS ++ #ifdef __KERNEL__ ++ #include ++ #include ++ #include ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) ++ #include ++ #else ++ #include ++ #endif ++ #endif ++#endif ++ ++#ifdef CONFIG_BR_EXT ++ ++/* #define BR_EXT_DEBUG */ ++ ++#define NAT25_IPV4 01 ++#define NAT25_IPV6 02 ++#define NAT25_IPX 03 ++#define NAT25_APPLE 04 ++#define NAT25_PPPOE 05 ++ ++#define RTL_RELAY_TAG_LEN (ETH_ALEN) ++#define TAG_HDR_LEN 4 ++ ++#define MAGIC_CODE 0x8186 ++#define MAGIC_CODE_LEN 2 ++#define WAIT_TIME_PPPOE 5 /* waiting time for pppoe server in sec */ ++ ++/*----------------------------------------------------------------- ++ How database records network address: ++ 0 1 2 3 4 5 6 7 8 9 10 ++ |----|----|----|----|----|----|----|----|----|----|----| ++ IPv4 |type| | IP addr | ++ IPX |type| Net addr | Node addr | ++ IPX |type| Net addr |Sckt addr| ++ Apple |type| Network |node| ++ PPPoE |type| SID | AC MAC | ++-----------------------------------------------------------------*/ ++ ++ ++/* Find a tag in pppoe frame and return the pointer */ ++static __inline__ unsigned char *__nat25_find_pppoe_tag(struct pppoe_hdr *ph, unsigned short type) ++{ ++ unsigned char *cur_ptr, *start_ptr; ++ unsigned short tagLen, tagType; ++ ++ start_ptr = cur_ptr = (unsigned char *)ph->tag; ++ while ((cur_ptr - start_ptr) < ntohs(ph->length)) { ++ /* prevent un-alignment access */ ++ tagType = (unsigned short)((cur_ptr[0] << 8) + cur_ptr[1]); ++ tagLen = (unsigned short)((cur_ptr[2] << 8) + cur_ptr[3]); ++ if (tagType == type) ++ return cur_ptr; ++ cur_ptr = cur_ptr + TAG_HDR_LEN + tagLen; ++ } ++ return 0; ++} ++ ++ ++static __inline__ int __nat25_add_pppoe_tag(struct sk_buff *skb, struct pppoe_tag *tag) ++{ ++ struct pppoe_hdr *ph = (struct pppoe_hdr *)(skb->data + ETH_HLEN); ++ int data_len; ++ ++ data_len = tag->tag_len + TAG_HDR_LEN; ++ if (skb_tailroom(skb) < data_len) { ++ _DEBUG_ERR("skb_tailroom() failed in add SID tag!\n"); ++ return -1; ++ } ++ ++ skb_put(skb, data_len); ++ /* have a room for new tag */ ++ memmove(((unsigned char *)ph->tag + data_len), (unsigned char *)ph->tag, ntohs(ph->length)); ++ ph->length = htons(ntohs(ph->length) + data_len); ++ memcpy((unsigned char *)ph->tag, tag, data_len); ++ return data_len; ++} ++ ++static int skb_pull_and_merge(struct sk_buff *skb, unsigned char *src, int len) ++{ ++ int tail_len; ++ unsigned long end, tail; ++ ++ if ((src + len) > skb_tail_pointer(skb) || skb->len < len) ++ return -1; ++ ++ tail = (unsigned long)skb_tail_pointer(skb); ++ end = (unsigned long)src + len; ++ if (tail < end) ++ return -1; ++ ++ tail_len = (int)(tail - end); ++ if (tail_len > 0) ++ memmove(src, src + len, tail_len); ++ ++ skb_trim(skb, skb->len - len); ++ return 0; ++} ++ ++static __inline__ unsigned long __nat25_timeout(_adapter *priv) ++{ ++ unsigned long timeout; ++ ++ timeout = jiffies - NAT25_AGEING_TIME * HZ; ++ ++ return timeout; ++} ++ ++ ++static __inline__ int __nat25_has_expired(_adapter *priv, ++ struct nat25_network_db_entry *fdb) ++{ ++ if (time_before_eq(fdb->ageing_timer, __nat25_timeout(priv))) ++ return 1; ++ ++ return 0; ++} ++ ++ ++static __inline__ void __nat25_generate_ipv4_network_addr(unsigned char *networkAddr, ++ unsigned int *ipAddr) ++{ ++ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); ++ ++ networkAddr[0] = NAT25_IPV4; ++ memcpy(networkAddr + 7, (unsigned char *)ipAddr, 4); ++} ++ ++ ++static __inline__ void __nat25_generate_ipx_network_addr_with_node(unsigned char *networkAddr, ++ unsigned int *ipxNetAddr, unsigned char *ipxNodeAddr) ++{ ++ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); ++ ++ networkAddr[0] = NAT25_IPX; ++ memcpy(networkAddr + 1, (unsigned char *)ipxNetAddr, 4); ++ memcpy(networkAddr + 5, ipxNodeAddr, 6); ++} ++ ++ ++static __inline__ void __nat25_generate_ipx_network_addr_with_socket(unsigned char *networkAddr, ++ unsigned int *ipxNetAddr, unsigned short *ipxSocketAddr) ++{ ++ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); ++ ++ networkAddr[0] = NAT25_IPX; ++ memcpy(networkAddr + 1, (unsigned char *)ipxNetAddr, 4); ++ memcpy(networkAddr + 5, (unsigned char *)ipxSocketAddr, 2); ++} ++ ++ ++static __inline__ void __nat25_generate_apple_network_addr(unsigned char *networkAddr, ++ unsigned short *network, unsigned char *node) ++{ ++ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); ++ ++ networkAddr[0] = NAT25_APPLE; ++ memcpy(networkAddr + 1, (unsigned char *)network, 2); ++ networkAddr[3] = *node; ++} ++ ++ ++static __inline__ void __nat25_generate_pppoe_network_addr(unsigned char *networkAddr, ++ unsigned char *ac_mac, unsigned short *sid) ++{ ++ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); ++ ++ networkAddr[0] = NAT25_PPPOE; ++ memcpy(networkAddr + 1, (unsigned char *)sid, 2); ++ memcpy(networkAddr + 3, (unsigned char *)ac_mac, 6); ++} ++ ++ ++#ifdef CL_IPV6_PASS ++static void __nat25_generate_ipv6_network_addr(unsigned char *networkAddr, ++ unsigned int *ipAddr) ++{ ++ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); ++ ++ networkAddr[0] = NAT25_IPV6; ++ memcpy(networkAddr + 1, (unsigned char *)ipAddr, 16); ++} ++ ++ ++static unsigned char *scan_tlv(unsigned char *data, int len, unsigned char tag, unsigned char len8b) ++{ ++ while (len > 0) { ++ if (*data == tag && *(data + 1) == len8b && len >= len8b * 8) ++ return data + 2; ++ ++ len -= (*(data + 1)) * 8; ++ data += (*(data + 1)) * 8; ++ } ++ return NULL; ++} ++ ++ ++static int update_nd_link_layer_addr(unsigned char *data, int len, unsigned char *replace_mac) ++{ ++ struct icmp6hdr *icmphdr = (struct icmp6hdr *)data; ++ unsigned char *mac; ++ ++ if (icmphdr->icmp6_type == NDISC_ROUTER_SOLICITATION) { ++ if (len >= 8) { ++ mac = scan_tlv(&data[8], len - 8, 1, 1); ++ if (mac) { ++ RTW_INFO("Router Solicitation, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", ++ mac[0], mac[1], mac[2], mac[3], mac[4], mac[5], ++ replace_mac[0], replace_mac[1], replace_mac[2], replace_mac[3], replace_mac[4], replace_mac[5]); ++ memcpy(mac, replace_mac, 6); ++ return 1; ++ } ++ } ++ } else if (icmphdr->icmp6_type == NDISC_ROUTER_ADVERTISEMENT) { ++ if (len >= 16) { ++ mac = scan_tlv(&data[16], len - 16, 1, 1); ++ if (mac) { ++ RTW_INFO("Router Advertisement, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", ++ mac[0], mac[1], mac[2], mac[3], mac[4], mac[5], ++ replace_mac[0], replace_mac[1], replace_mac[2], replace_mac[3], replace_mac[4], replace_mac[5]); ++ memcpy(mac, replace_mac, 6); ++ return 1; ++ } ++ } ++ } else if (icmphdr->icmp6_type == NDISC_NEIGHBOUR_SOLICITATION) { ++ if (len >= 24) { ++ mac = scan_tlv(&data[24], len - 24, 1, 1); ++ if (mac) { ++ RTW_INFO("Neighbor Solicitation, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", ++ mac[0], mac[1], mac[2], mac[3], mac[4], mac[5], ++ replace_mac[0], replace_mac[1], replace_mac[2], replace_mac[3], replace_mac[4], replace_mac[5]); ++ memcpy(mac, replace_mac, 6); ++ return 1; ++ } ++ } ++ } else if (icmphdr->icmp6_type == NDISC_NEIGHBOUR_ADVERTISEMENT) { ++ if (len >= 24) { ++ mac = scan_tlv(&data[24], len - 24, 2, 1); ++ if (mac) { ++ RTW_INFO("Neighbor Advertisement, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", ++ mac[0], mac[1], mac[2], mac[3], mac[4], mac[5], ++ replace_mac[0], replace_mac[1], replace_mac[2], replace_mac[3], replace_mac[4], replace_mac[5]); ++ memcpy(mac, replace_mac, 6); ++ return 1; ++ } ++ } ++ } else if (icmphdr->icmp6_type == NDISC_REDIRECT) { ++ if (len >= 40) { ++ mac = scan_tlv(&data[40], len - 40, 2, 1); ++ if (mac) { ++ RTW_INFO("Redirect, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", ++ mac[0], mac[1], mac[2], mac[3], mac[4], mac[5], ++ replace_mac[0], replace_mac[1], replace_mac[2], replace_mac[3], replace_mac[4], replace_mac[5]); ++ memcpy(mac, replace_mac, 6); ++ return 1; ++ } ++ } ++ } ++ return 0; ++} ++ ++ ++static void convert_ipv6_mac_to_mc(struct sk_buff *skb) ++{ ++ struct ipv6hdr *iph = (struct ipv6hdr *)(skb->data + ETH_HLEN); ++ unsigned char *dst_mac = skb->data; ++ ++ /* dst_mac[0] = 0xff; */ ++ /* dst_mac[1] = 0xff; */ ++ /*modified by qinjunjie,ipv6 multicast address ix 0x33-33-xx-xx-xx-xx*/ ++ dst_mac[0] = 0x33; ++ dst_mac[1] = 0x33; ++ memcpy(&dst_mac[2], &iph->daddr.s6_addr32[3], 4); ++#if defined(__LINUX_2_6__) ++ /*modified by qinjunjie,warning:should not remove next line*/ ++ skb->pkt_type = PACKET_MULTICAST; ++#endif ++} ++#endif /* CL_IPV6_PASS */ ++ ++ ++static __inline__ int __nat25_network_hash(unsigned char *networkAddr) ++{ ++ if (networkAddr[0] == NAT25_IPV4) { ++ unsigned long x; ++ ++ x = networkAddr[7] ^ networkAddr[8] ^ networkAddr[9] ^ networkAddr[10]; ++ ++ return x & (NAT25_HASH_SIZE - 1); ++ } else if (networkAddr[0] == NAT25_IPX) { ++ unsigned long x; ++ ++ x = networkAddr[1] ^ networkAddr[2] ^ networkAddr[3] ^ networkAddr[4] ^ networkAddr[5] ^ ++ networkAddr[6] ^ networkAddr[7] ^ networkAddr[8] ^ networkAddr[9] ^ networkAddr[10]; ++ ++ return x & (NAT25_HASH_SIZE - 1); ++ } else if (networkAddr[0] == NAT25_APPLE) { ++ unsigned long x; ++ ++ x = networkAddr[1] ^ networkAddr[2] ^ networkAddr[3]; ++ ++ return x & (NAT25_HASH_SIZE - 1); ++ } else if (networkAddr[0] == NAT25_PPPOE) { ++ unsigned long x; ++ ++ x = networkAddr[0] ^ networkAddr[1] ^ networkAddr[2] ^ networkAddr[3] ^ networkAddr[4] ^ networkAddr[5] ^ networkAddr[6] ^ networkAddr[7] ^ networkAddr[8]; ++ ++ return x & (NAT25_HASH_SIZE - 1); ++ } ++#ifdef CL_IPV6_PASS ++ else if (networkAddr[0] == NAT25_IPV6) { ++ unsigned long x; ++ ++ x = networkAddr[1] ^ networkAddr[2] ^ networkAddr[3] ^ networkAddr[4] ^ networkAddr[5] ^ ++ networkAddr[6] ^ networkAddr[7] ^ networkAddr[8] ^ networkAddr[9] ^ networkAddr[10] ^ ++ networkAddr[11] ^ networkAddr[12] ^ networkAddr[13] ^ networkAddr[14] ^ networkAddr[15] ^ ++ networkAddr[16]; ++ ++ return x & (NAT25_HASH_SIZE - 1); ++ } ++#endif ++ else { ++ unsigned long x = 0; ++ int i; ++ ++ for (i = 0; i < MAX_NETWORK_ADDR_LEN; i++) ++ x ^= networkAddr[i]; ++ ++ return x & (NAT25_HASH_SIZE - 1); ++ } ++} ++ ++ ++static __inline__ void __network_hash_link(_adapter *priv, ++ struct nat25_network_db_entry *ent, int hash) ++{ ++ /* Caller must _enter_critical_bh already! */ ++ /* _irqL irqL; */ ++ /* _enter_critical_bh(&priv->br_ext_lock, &irqL); */ ++ ++ ent->next_hash = priv->nethash[hash]; ++ if (ent->next_hash != NULL) ++ ent->next_hash->pprev_hash = &ent->next_hash; ++ priv->nethash[hash] = ent; ++ ent->pprev_hash = &priv->nethash[hash]; ++ ++ /* _exit_critical_bh(&priv->br_ext_lock, &irqL); */ ++} ++ ++ ++static __inline__ void __network_hash_unlink(struct nat25_network_db_entry *ent) ++{ ++ /* Caller must _enter_critical_bh already! */ ++ /* _irqL irqL; */ ++ /* _enter_critical_bh(&priv->br_ext_lock, &irqL); */ ++ ++ *(ent->pprev_hash) = ent->next_hash; ++ if (ent->next_hash != NULL) ++ ent->next_hash->pprev_hash = ent->pprev_hash; ++ ent->next_hash = NULL; ++ ent->pprev_hash = NULL; ++ ++ /* _exit_critical_bh(&priv->br_ext_lock, &irqL); */ ++} ++ ++ ++static int __nat25_db_network_lookup_and_replace(_adapter *priv, ++ struct sk_buff *skb, unsigned char *networkAddr) ++{ ++ struct nat25_network_db_entry *db; ++ _irqL irqL; ++ _enter_critical_bh(&priv->br_ext_lock, &irqL); ++ ++ db = priv->nethash[__nat25_network_hash(networkAddr)]; ++ while (db != NULL) { ++ if (!memcmp(db->networkAddr, networkAddr, MAX_NETWORK_ADDR_LEN)) { ++ if (!__nat25_has_expired(priv, db)) { ++ /* replace the destination mac address */ ++ memcpy(skb->data, db->macAddr, ETH_ALEN); ++ atomic_inc(&db->use_count); ++ ++#ifdef CL_IPV6_PASS ++ RTW_INFO("NAT25: Lookup M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" ++ "%02x%02x%02x%02x%02x%02x\n", ++ db->macAddr[0], ++ db->macAddr[1], ++ db->macAddr[2], ++ db->macAddr[3], ++ db->macAddr[4], ++ db->macAddr[5], ++ db->networkAddr[0], ++ db->networkAddr[1], ++ db->networkAddr[2], ++ db->networkAddr[3], ++ db->networkAddr[4], ++ db->networkAddr[5], ++ db->networkAddr[6], ++ db->networkAddr[7], ++ db->networkAddr[8], ++ db->networkAddr[9], ++ db->networkAddr[10], ++ db->networkAddr[11], ++ db->networkAddr[12], ++ db->networkAddr[13], ++ db->networkAddr[14], ++ db->networkAddr[15], ++ db->networkAddr[16]); ++#else ++ RTW_INFO("NAT25: Lookup M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n", ++ db->macAddr[0], ++ db->macAddr[1], ++ db->macAddr[2], ++ db->macAddr[3], ++ db->macAddr[4], ++ db->macAddr[5], ++ db->networkAddr[0], ++ db->networkAddr[1], ++ db->networkAddr[2], ++ db->networkAddr[3], ++ db->networkAddr[4], ++ db->networkAddr[5], ++ db->networkAddr[6], ++ db->networkAddr[7], ++ db->networkAddr[8], ++ db->networkAddr[9], ++ db->networkAddr[10]); ++#endif ++ } ++ _exit_critical_bh(&priv->br_ext_lock, &irqL); ++ return 1; ++ } ++ ++ db = db->next_hash; ++ } ++ ++ _exit_critical_bh(&priv->br_ext_lock, &irqL); ++ return 0; ++} ++ ++ ++static void __nat25_db_network_insert(_adapter *priv, ++ unsigned char *macAddr, unsigned char *networkAddr) ++{ ++ struct nat25_network_db_entry *db; ++ int hash; ++ _irqL irqL; ++ _enter_critical_bh(&priv->br_ext_lock, &irqL); ++ ++ hash = __nat25_network_hash(networkAddr); ++ db = priv->nethash[hash]; ++ while (db != NULL) { ++ if (!memcmp(db->networkAddr, networkAddr, MAX_NETWORK_ADDR_LEN)) { ++ memcpy(db->macAddr, macAddr, ETH_ALEN); ++ db->ageing_timer = jiffies; ++ _exit_critical_bh(&priv->br_ext_lock, &irqL); ++ return; ++ } ++ ++ db = db->next_hash; ++ } ++ ++ db = (struct nat25_network_db_entry *) rtw_malloc(sizeof(*db)); ++ if (db == NULL) { ++ _exit_critical_bh(&priv->br_ext_lock, &irqL); ++ return; ++ } ++ ++ memcpy(db->networkAddr, networkAddr, MAX_NETWORK_ADDR_LEN); ++ memcpy(db->macAddr, macAddr, ETH_ALEN); ++ atomic_set(&db->use_count, 1); ++ db->ageing_timer = jiffies; ++ ++ __network_hash_link(priv, db, hash); ++ ++ _exit_critical_bh(&priv->br_ext_lock, &irqL); ++} ++ ++ ++static void __nat25_db_print(_adapter *priv) ++{ ++ _irqL irqL; ++ _enter_critical_bh(&priv->br_ext_lock, &irqL); ++ ++#ifdef BR_EXT_DEBUG ++ static int counter = 0; ++ int i, j; ++ struct nat25_network_db_entry *db; ++ ++ counter++; ++ if ((counter % 16) != 0) ++ return; ++ ++ for (i = 0, j = 0; i < NAT25_HASH_SIZE; i++) { ++ db = priv->nethash[i]; ++ ++ while (db != NULL) { ++#ifdef CL_IPV6_PASS ++ panic_printk("NAT25: DB(%d) H(%02d) C(%d) M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" ++ "%02x%02x%02x%02x%02x%02x\n", ++ j, ++ i, ++ atomic_read(&db->use_count), ++ db->macAddr[0], ++ db->macAddr[1], ++ db->macAddr[2], ++ db->macAddr[3], ++ db->macAddr[4], ++ db->macAddr[5], ++ db->networkAddr[0], ++ db->networkAddr[1], ++ db->networkAddr[2], ++ db->networkAddr[3], ++ db->networkAddr[4], ++ db->networkAddr[5], ++ db->networkAddr[6], ++ db->networkAddr[7], ++ db->networkAddr[8], ++ db->networkAddr[9], ++ db->networkAddr[10], ++ db->networkAddr[11], ++ db->networkAddr[12], ++ db->networkAddr[13], ++ db->networkAddr[14], ++ db->networkAddr[15], ++ db->networkAddr[16]); ++#else ++ panic_printk("NAT25: DB(%d) H(%02d) C(%d) M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n", ++ j, ++ i, ++ atomic_read(&db->use_count), ++ db->macAddr[0], ++ db->macAddr[1], ++ db->macAddr[2], ++ db->macAddr[3], ++ db->macAddr[4], ++ db->macAddr[5], ++ db->networkAddr[0], ++ db->networkAddr[1], ++ db->networkAddr[2], ++ db->networkAddr[3], ++ db->networkAddr[4], ++ db->networkAddr[5], ++ db->networkAddr[6], ++ db->networkAddr[7], ++ db->networkAddr[8], ++ db->networkAddr[9], ++ db->networkAddr[10]); ++#endif ++ j++; ++ ++ db = db->next_hash; ++ } ++ } ++#endif ++ ++ _exit_critical_bh(&priv->br_ext_lock, &irqL); ++} ++ ++ ++ ++ ++/* ++ * NAT2.5 interface ++ */ ++ ++void nat25_db_cleanup(_adapter *priv) ++{ ++ int i; ++ _irqL irqL; ++ _enter_critical_bh(&priv->br_ext_lock, &irqL); ++ ++ for (i = 0; i < NAT25_HASH_SIZE; i++) { ++ struct nat25_network_db_entry *f; ++ f = priv->nethash[i]; ++ while (f != NULL) { ++ struct nat25_network_db_entry *g; ++ ++ g = f->next_hash; ++ if (priv->scdb_entry == f) { ++ memset(priv->scdb_mac, 0, ETH_ALEN); ++ memset(priv->scdb_ip, 0, 4); ++ priv->scdb_entry = NULL; ++ } ++ __network_hash_unlink(f); ++ rtw_mfree((u8 *) f, sizeof(struct nat25_network_db_entry)); ++ ++ f = g; ++ } ++ } ++ ++ _exit_critical_bh(&priv->br_ext_lock, &irqL); ++} ++ ++ ++void nat25_db_expire(_adapter *priv) ++{ ++ int i; ++ _irqL irqL; ++ _enter_critical_bh(&priv->br_ext_lock, &irqL); ++ ++ /* if(!priv->ethBrExtInfo.nat25_disable) */ ++ { ++ for (i = 0; i < NAT25_HASH_SIZE; i++) { ++ struct nat25_network_db_entry *f; ++ f = priv->nethash[i]; ++ ++ while (f != NULL) { ++ struct nat25_network_db_entry *g; ++ g = f->next_hash; ++ ++ if (__nat25_has_expired(priv, f)) { ++ if (atomic_dec_and_test(&f->use_count)) { ++#ifdef BR_EXT_DEBUG ++#ifdef CL_IPV6_PASS ++ panic_printk("NAT25 Expire H(%02d) M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" ++ "%02x%02x%02x%02x%02x%02x\n", ++ i, ++ f->macAddr[0], ++ f->macAddr[1], ++ f->macAddr[2], ++ f->macAddr[3], ++ f->macAddr[4], ++ f->macAddr[5], ++ f->networkAddr[0], ++ f->networkAddr[1], ++ f->networkAddr[2], ++ f->networkAddr[3], ++ f->networkAddr[4], ++ f->networkAddr[5], ++ f->networkAddr[6], ++ f->networkAddr[7], ++ f->networkAddr[8], ++ f->networkAddr[9], ++ f->networkAddr[10], ++ f->networkAddr[11], ++ f->networkAddr[12], ++ f->networkAddr[13], ++ f->networkAddr[14], ++ f->networkAddr[15], ++ f->networkAddr[16]); ++#else ++ ++ panic_printk("NAT25 Expire H(%02d) M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n", ++ i, ++ f->macAddr[0], ++ f->macAddr[1], ++ f->macAddr[2], ++ f->macAddr[3], ++ f->macAddr[4], ++ f->macAddr[5], ++ f->networkAddr[0], ++ f->networkAddr[1], ++ f->networkAddr[2], ++ f->networkAddr[3], ++ f->networkAddr[4], ++ f->networkAddr[5], ++ f->networkAddr[6], ++ f->networkAddr[7], ++ f->networkAddr[8], ++ f->networkAddr[9], ++ f->networkAddr[10]); ++#endif ++#endif ++ if (priv->scdb_entry == f) { ++ memset(priv->scdb_mac, 0, ETH_ALEN); ++ memset(priv->scdb_ip, 0, 4); ++ priv->scdb_entry = NULL; ++ } ++ __network_hash_unlink(f); ++ rtw_mfree((u8 *) f, sizeof(struct nat25_network_db_entry)); ++ } ++ } ++ ++ f = g; ++ } ++ } ++ } ++ ++ _exit_critical_bh(&priv->br_ext_lock, &irqL); ++} ++ ++ ++#ifdef SUPPORT_TX_MCAST2UNI ++static int checkIPMcAndReplace(_adapter *priv, struct sk_buff *skb, unsigned int *dst_ip) ++{ ++ struct stat_info *pstat; ++ struct list_head *phead, *plist; ++ int i; ++ ++ phead = &priv->asoc_list; ++ plist = phead->next; ++ ++ while (plist != phead) { ++ pstat = list_entry(plist, struct stat_info, asoc_list); ++ plist = plist->next; ++ ++ if (pstat->ipmc_num == 0) ++ continue; ++ ++ for (i = 0; i < MAX_IP_MC_ENTRY; i++) { ++ if (pstat->ipmc[i].used && !memcmp(&pstat->ipmc[i].mcmac[3], ((unsigned char *)dst_ip) + 1, 3)) { ++ memcpy(skb->data, pstat->ipmc[i].mcmac, ETH_ALEN); ++ return 1; ++ } ++ } ++ } ++ return 0; ++} ++#endif ++ ++int nat25_db_handle(_adapter *priv, struct sk_buff *skb, int method) ++{ ++ unsigned short protocol; ++ unsigned char networkAddr[MAX_NETWORK_ADDR_LEN]; ++ ++ if (skb == NULL) ++ return -1; ++ ++ if ((method <= NAT25_MIN) || (method >= NAT25_MAX)) ++ return -1; ++ ++ protocol = *((unsigned short *)(skb->data + 2 * ETH_ALEN)); ++ ++ /*---------------------------------------------------*/ ++ /* Handle IP frame */ ++ /*---------------------------------------------------*/ ++ if (protocol == __constant_htons(ETH_P_IP)) { ++ struct iphdr *iph = (struct iphdr *)(skb->data + ETH_HLEN); ++ ++ if (((unsigned char *)(iph) + (iph->ihl << 2)) >= (skb->data + ETH_HLEN + skb->len)) { ++ DEBUG_WARN("NAT25: malformed IP packet !\n"); ++ return -1; ++ } ++ ++ switch (method) { ++ case NAT25_CHECK: ++ return -1; ++ ++ case NAT25_INSERT: { ++ /* some muticast with source IP is all zero, maybe other case is illegal */ ++ /* in class A, B, C, host address is all zero or all one is illegal */ ++ if (iph->saddr == 0) ++ return 0; ++ RTW_INFO("NAT25: Insert IP, SA=%08x, DA=%08x\n", iph->saddr, iph->daddr); ++ __nat25_generate_ipv4_network_addr(networkAddr, &iph->saddr); ++ /* record source IP address and , source mac address into db */ ++ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); ++ ++ __nat25_db_print(priv); ++ } ++ return 0; ++ ++ case NAT25_LOOKUP: { ++ RTW_INFO("NAT25: Lookup IP, SA=%08x, DA=%08x\n", iph->saddr, iph->daddr); ++#ifdef SUPPORT_TX_MCAST2UNI ++ if (priv->pshare->rf_ft_var.mc2u_disable || ++ ((((OPMODE & (WIFI_STATION_STATE | WIFI_ASOC_STATE)) ++ == (WIFI_STATION_STATE | WIFI_ASOC_STATE)) && ++ !checkIPMcAndReplace(priv, skb, &iph->daddr)) || ++ (OPMODE & WIFI_ADHOC_STATE))) ++#endif ++ { ++ __nat25_generate_ipv4_network_addr(networkAddr, &iph->daddr); ++ ++ if (!__nat25_db_network_lookup_and_replace(priv, skb, networkAddr)) { ++ if (*((unsigned char *)&iph->daddr + 3) == 0xff) { ++ /* L2 is unicast but L3 is broadcast, make L2 bacome broadcast */ ++ RTW_INFO("NAT25: Set DA as boardcast\n"); ++ memset(skb->data, 0xff, ETH_ALEN); ++ } else { ++ /* forward unknow IP packet to upper TCP/IP */ ++ RTW_INFO("NAT25: Replace DA with BR's MAC\n"); ++ if ((*(u32 *)priv->br_mac) == 0 && (*(u16 *)(priv->br_mac + 4)) == 0) { ++ void netdev_br_init(struct net_device *netdev); ++ printk("Re-init netdev_br_init() due to br_mac==0!\n"); ++ netdev_br_init(priv->pnetdev); ++ } ++ memcpy(skb->data, priv->br_mac, ETH_ALEN); ++ } ++ } ++ } ++ } ++ return 0; ++ ++ default: ++ return -1; ++ } ++ } ++ ++ /*---------------------------------------------------*/ ++ /* Handle ARP frame */ ++ /*---------------------------------------------------*/ ++ else if (protocol == __constant_htons(ETH_P_ARP)) { ++ struct arphdr *arp = (struct arphdr *)(skb->data + ETH_HLEN); ++ unsigned char *arp_ptr = (unsigned char *)(arp + 1); ++ unsigned int *sender, *target; ++ ++ if (arp->ar_pro != __constant_htons(ETH_P_IP)) { ++ DEBUG_WARN("NAT25: arp protocol unknown (%4x)!\n", htons(arp->ar_pro)); ++ return -1; ++ } ++ ++ switch (method) { ++ case NAT25_CHECK: ++ return 0; /* skb_copy for all ARP frame */ ++ ++ case NAT25_INSERT: { ++ RTW_INFO("NAT25: Insert ARP, MAC=%02x%02x%02x%02x%02x%02x\n", arp_ptr[0], ++ arp_ptr[1], arp_ptr[2], arp_ptr[3], arp_ptr[4], arp_ptr[5]); ++ ++ /* change to ARP sender mac address to wlan STA address */ ++ memcpy(arp_ptr, GET_MY_HWADDR(priv), ETH_ALEN); ++ ++ arp_ptr += arp->ar_hln; ++ sender = (unsigned int *)arp_ptr; ++ ++ __nat25_generate_ipv4_network_addr(networkAddr, sender); ++ ++ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); ++ ++ __nat25_db_print(priv); ++ } ++ return 0; ++ ++ case NAT25_LOOKUP: { ++ RTW_INFO("NAT25: Lookup ARP\n"); ++ ++ arp_ptr += arp->ar_hln; ++ sender = (unsigned int *)arp_ptr; ++ arp_ptr += (arp->ar_hln + arp->ar_pln); ++ target = (unsigned int *)arp_ptr; ++ ++ __nat25_generate_ipv4_network_addr(networkAddr, target); ++ ++ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); ++ ++ /* change to ARP target mac address to Lookup result */ ++ arp_ptr = (unsigned char *)(arp + 1); ++ arp_ptr += (arp->ar_hln + arp->ar_pln); ++ memcpy(arp_ptr, skb->data, ETH_ALEN); ++ } ++ return 0; ++ ++ default: ++ return -1; ++ } ++ } ++ ++ /*---------------------------------------------------*/ ++ /* Handle IPX and Apple Talk frame */ ++ /*---------------------------------------------------*/ ++ else if ((protocol == __constant_htons(ETH_P_IPX)) || ++ (protocol == __constant_htons(ETH_P_ATALK)) || ++ (protocol == __constant_htons(ETH_P_AARP))) { ++ unsigned char ipx_header[2] = {0xFF, 0xFF}; ++ struct ipxhdr *ipx = NULL; ++ struct elapaarp *ea = NULL; ++ struct ddpehdr *ddp = NULL; ++ unsigned char *framePtr = skb->data + ETH_HLEN; ++ ++ if (protocol == __constant_htons(ETH_P_IPX)) { ++ RTW_INFO("NAT25: Protocol=IPX (Ethernet II)\n"); ++ ipx = (struct ipxhdr *)framePtr; ++ } else { /* if(protocol <= __constant_htons(ETH_FRAME_LEN)) */ ++ if (!memcmp(ipx_header, framePtr, 2)) { ++ RTW_INFO("NAT25: Protocol=IPX (Ethernet 802.3)\n"); ++ ipx = (struct ipxhdr *)framePtr; ++ } else { ++ unsigned char ipx_8022_type = 0xE0; ++ unsigned char snap_8022_type = 0xAA; ++ ++ if (*framePtr == snap_8022_type) { ++ unsigned char ipx_snap_id[5] = {0x0, 0x0, 0x0, 0x81, 0x37}; /* IPX SNAP ID */ ++ unsigned char aarp_snap_id[5] = {0x00, 0x00, 0x00, 0x80, 0xF3}; /* Apple Talk AARP SNAP ID */ ++ unsigned char ddp_snap_id[5] = {0x08, 0x00, 0x07, 0x80, 0x9B}; /* Apple Talk DDP SNAP ID */ ++ ++ framePtr += 3; /* eliminate the 802.2 header */ ++ ++ if (!memcmp(ipx_snap_id, framePtr, 5)) { ++ framePtr += 5; /* eliminate the SNAP header */ ++ ++ RTW_INFO("NAT25: Protocol=IPX (Ethernet SNAP)\n"); ++ ipx = (struct ipxhdr *)framePtr; ++ } else if (!memcmp(aarp_snap_id, framePtr, 5)) { ++ framePtr += 5; /* eliminate the SNAP header */ ++ ++ ea = (struct elapaarp *)framePtr; ++ } else if (!memcmp(ddp_snap_id, framePtr, 5)) { ++ framePtr += 5; /* eliminate the SNAP header */ ++ ++ ddp = (struct ddpehdr *)framePtr; ++ } else { ++ DEBUG_WARN("NAT25: Protocol=Ethernet SNAP %02x%02x%02x%02x%02x\n", framePtr[0], ++ framePtr[1], framePtr[2], framePtr[3], framePtr[4]); ++ return -1; ++ } ++ } else if (*framePtr == ipx_8022_type) { ++ framePtr += 3; /* eliminate the 802.2 header */ ++ ++ if (!memcmp(ipx_header, framePtr, 2)) { ++ RTW_INFO("NAT25: Protocol=IPX (Ethernet 802.2)\n"); ++ ipx = (struct ipxhdr *)framePtr; ++ } else ++ return -1; ++ } ++ } ++ } ++ ++ /* IPX */ ++ if (ipx != NULL) { ++ switch (method) { ++ case NAT25_CHECK: ++ if (!memcmp(skb->data + ETH_ALEN, ipx->ipx_source.node, ETH_ALEN)) { ++ RTW_INFO("NAT25: Check IPX skb_copy\n"); ++ return 0; ++ } ++ return -1; ++ ++ case NAT25_INSERT: { ++ RTW_INFO("NAT25: Insert IPX, Dest=%08x,%02x%02x%02x%02x%02x%02x,%04x Source=%08x,%02x%02x%02x%02x%02x%02x,%04x\n", ++ ipx->ipx_dest.net, ++ ipx->ipx_dest.node[0], ++ ipx->ipx_dest.node[1], ++ ipx->ipx_dest.node[2], ++ ipx->ipx_dest.node[3], ++ ipx->ipx_dest.node[4], ++ ipx->ipx_dest.node[5], ++ ipx->ipx_dest.sock, ++ ipx->ipx_source.net, ++ ipx->ipx_source.node[0], ++ ipx->ipx_source.node[1], ++ ipx->ipx_source.node[2], ++ ipx->ipx_source.node[3], ++ ipx->ipx_source.node[4], ++ ipx->ipx_source.node[5], ++ ipx->ipx_source.sock); ++ ++ if (!memcmp(skb->data + ETH_ALEN, ipx->ipx_source.node, ETH_ALEN)) { ++ RTW_INFO("NAT25: Use IPX Net, and Socket as network addr\n"); ++ ++ __nat25_generate_ipx_network_addr_with_socket(networkAddr, &ipx->ipx_source.net, &ipx->ipx_source.sock); ++ ++ /* change IPX source node addr to wlan STA address */ ++ memcpy(ipx->ipx_source.node, GET_MY_HWADDR(priv), ETH_ALEN); ++ } else ++ __nat25_generate_ipx_network_addr_with_node(networkAddr, &ipx->ipx_source.net, ipx->ipx_source.node); ++ ++ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); ++ ++ __nat25_db_print(priv); ++ } ++ return 0; ++ ++ case NAT25_LOOKUP: { ++ if (!memcmp(GET_MY_HWADDR(priv), ipx->ipx_dest.node, ETH_ALEN)) { ++ RTW_INFO("NAT25: Lookup IPX, Modify Destination IPX Node addr\n"); ++ ++ __nat25_generate_ipx_network_addr_with_socket(networkAddr, &ipx->ipx_dest.net, &ipx->ipx_dest.sock); ++ ++ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); ++ ++ /* replace IPX destination node addr with Lookup destination MAC addr */ ++ memcpy(ipx->ipx_dest.node, skb->data, ETH_ALEN); ++ } else { ++ __nat25_generate_ipx_network_addr_with_node(networkAddr, &ipx->ipx_dest.net, ipx->ipx_dest.node); ++ ++ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); ++ } ++ } ++ return 0; ++ ++ default: ++ return -1; ++ } ++ } ++ ++ /* AARP */ ++ else if (ea != NULL) { ++ /* Sanity check fields. */ ++ if (ea->hw_len != ETH_ALEN || ea->pa_len != AARP_PA_ALEN) { ++ DEBUG_WARN("NAT25: Appletalk AARP Sanity check fail!\n"); ++ return -1; ++ } ++ ++ switch (method) { ++ case NAT25_CHECK: ++ return 0; ++ ++ case NAT25_INSERT: { ++ /* change to AARP source mac address to wlan STA address */ ++ memcpy(ea->hw_src, GET_MY_HWADDR(priv), ETH_ALEN); ++ ++ RTW_INFO("NAT25: Insert AARP, Source=%d,%d Destination=%d,%d\n", ++ ea->pa_src_net, ++ ea->pa_src_node, ++ ea->pa_dst_net, ++ ea->pa_dst_node); ++ ++ __nat25_generate_apple_network_addr(networkAddr, &ea->pa_src_net, &ea->pa_src_node); ++ ++ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); ++ ++ __nat25_db_print(priv); ++ } ++ return 0; ++ ++ case NAT25_LOOKUP: { ++ RTW_INFO("NAT25: Lookup AARP, Source=%d,%d Destination=%d,%d\n", ++ ea->pa_src_net, ++ ea->pa_src_node, ++ ea->pa_dst_net, ++ ea->pa_dst_node); ++ ++ __nat25_generate_apple_network_addr(networkAddr, &ea->pa_dst_net, &ea->pa_dst_node); ++ ++ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); ++ ++ /* change to AARP destination mac address to Lookup result */ ++ memcpy(ea->hw_dst, skb->data, ETH_ALEN); ++ } ++ return 0; ++ ++ default: ++ return -1; ++ } ++ } ++ ++ /* DDP */ ++ else if (ddp != NULL) { ++ switch (method) { ++ case NAT25_CHECK: ++ return -1; ++ ++ case NAT25_INSERT: { ++ RTW_INFO("NAT25: Insert DDP, Source=%d,%d Destination=%d,%d\n", ++ ddp->deh_snet, ++ ddp->deh_snode, ++ ddp->deh_dnet, ++ ddp->deh_dnode); ++ ++ __nat25_generate_apple_network_addr(networkAddr, &ddp->deh_snet, &ddp->deh_snode); ++ ++ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); ++ ++ __nat25_db_print(priv); ++ } ++ return 0; ++ ++ case NAT25_LOOKUP: { ++ RTW_INFO("NAT25: Lookup DDP, Source=%d,%d Destination=%d,%d\n", ++ ddp->deh_snet, ++ ddp->deh_snode, ++ ddp->deh_dnet, ++ ddp->deh_dnode); ++ ++ __nat25_generate_apple_network_addr(networkAddr, &ddp->deh_dnet, &ddp->deh_dnode); ++ ++ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); ++ } ++ return 0; ++ ++ default: ++ return -1; ++ } ++ } ++ ++ return -1; ++ } ++ ++ /*---------------------------------------------------*/ ++ /* Handle PPPoE frame */ ++ /*---------------------------------------------------*/ ++ else if ((protocol == __constant_htons(ETH_P_PPP_DISC)) || ++ (protocol == __constant_htons(ETH_P_PPP_SES))) { ++ struct pppoe_hdr *ph = (struct pppoe_hdr *)(skb->data + ETH_HLEN); ++ unsigned short *pMagic; ++ ++ switch (method) { ++ case NAT25_CHECK: ++ if (ph->sid == 0) ++ return 0; ++ return 1; ++ ++ case NAT25_INSERT: ++ if (ph->sid == 0) { /* Discovery phase according to tag */ ++ if (ph->code == PADI_CODE || ph->code == PADR_CODE) { ++ if (priv->ethBrExtInfo.addPPPoETag) { ++ struct pppoe_tag *tag, *pOldTag; ++ unsigned char tag_buf[40]; ++ int old_tag_len = 0; ++ ++ tag = (struct pppoe_tag *)tag_buf; ++ pOldTag = (struct pppoe_tag *)__nat25_find_pppoe_tag(ph, ntohs(PTT_RELAY_SID)); ++ if (pOldTag) { /* if SID existed, copy old value and delete it */ ++ old_tag_len = ntohs(pOldTag->tag_len); ++ if (old_tag_len + TAG_HDR_LEN + MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN > sizeof(tag_buf)) { ++ DEBUG_ERR("SID tag length too long!\n"); ++ return -1; ++ } ++ ++ memcpy(tag->tag_data + MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN, ++ pOldTag->tag_data, old_tag_len); ++ ++ if (skb_pull_and_merge(skb, (unsigned char *)pOldTag, TAG_HDR_LEN + old_tag_len) < 0) { ++ DEBUG_ERR("call skb_pull_and_merge() failed in PADI/R packet!\n"); ++ return -1; ++ } ++ ph->length = htons(ntohs(ph->length) - TAG_HDR_LEN - old_tag_len); ++ } ++ ++ tag->tag_type = PTT_RELAY_SID; ++ tag->tag_len = htons(MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN + old_tag_len); ++ ++ /* insert the magic_code+client mac in relay tag */ ++ pMagic = (unsigned short *)tag->tag_data; ++ *pMagic = htons(MAGIC_CODE); ++ memcpy(tag->tag_data + MAGIC_CODE_LEN, skb->data + ETH_ALEN, ETH_ALEN); ++ ++ /* Add relay tag */ ++ if (__nat25_add_pppoe_tag(skb, tag) < 0) ++ return -1; ++ ++ RTW_INFO("NAT25: Insert PPPoE, forward %s packet\n", ++ (ph->code == PADI_CODE ? "PADI" : "PADR")); ++ } else { /* not add relay tag */ ++ if (priv->pppoe_connection_in_progress && ++ memcmp(skb->data + ETH_ALEN, priv->pppoe_addr, ETH_ALEN)) { ++ DEBUG_ERR("Discard PPPoE packet due to another PPPoE connection is in progress!\n"); ++ return -2; ++ } ++ ++ if (priv->pppoe_connection_in_progress == 0) ++ memcpy(priv->pppoe_addr, skb->data + ETH_ALEN, ETH_ALEN); ++ ++ priv->pppoe_connection_in_progress = WAIT_TIME_PPPOE; ++ } ++ } else ++ return -1; ++ } else { /* session phase */ ++ RTW_INFO("NAT25: Insert PPPoE, insert session packet to %s\n", skb->dev->name); ++ ++ __nat25_generate_pppoe_network_addr(networkAddr, skb->data, &(ph->sid)); ++ ++ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); ++ ++ __nat25_db_print(priv); ++ ++ if (!priv->ethBrExtInfo.addPPPoETag && ++ priv->pppoe_connection_in_progress && ++ !memcmp(skb->data + ETH_ALEN, priv->pppoe_addr, ETH_ALEN)) ++ priv->pppoe_connection_in_progress = 0; ++ } ++ return 0; ++ ++ case NAT25_LOOKUP: ++ if (ph->code == PADO_CODE || ph->code == PADS_CODE) { ++ if (priv->ethBrExtInfo.addPPPoETag) { ++ struct pppoe_tag *tag; ++ unsigned char *ptr; ++ unsigned short tagType, tagLen; ++ int offset = 0; ++ ++ ptr = __nat25_find_pppoe_tag(ph, ntohs(PTT_RELAY_SID)); ++ if (ptr == 0) { ++ DEBUG_ERR("Fail to find PTT_RELAY_SID in FADO!\n"); ++ return -1; ++ } ++ ++ tag = (struct pppoe_tag *)ptr; ++ tagType = (unsigned short)((ptr[0] << 8) + ptr[1]); ++ tagLen = (unsigned short)((ptr[2] << 8) + ptr[3]); ++ ++ if ((tagType != ntohs(PTT_RELAY_SID)) || (tagLen < (MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN))) { ++ DEBUG_ERR("Invalid PTT_RELAY_SID tag length [%d]!\n", tagLen); ++ return -1; ++ } ++ ++ pMagic = (unsigned short *)tag->tag_data; ++ if (ntohs(*pMagic) != MAGIC_CODE) { ++ DEBUG_ERR("Can't find MAGIC_CODE in %s packet!\n", ++ (ph->code == PADO_CODE ? "PADO" : "PADS")); ++ return -1; ++ } ++ ++ memcpy(skb->data, tag->tag_data + MAGIC_CODE_LEN, ETH_ALEN); ++ ++ if (tagLen > MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN) ++ offset = TAG_HDR_LEN; ++ ++ if (skb_pull_and_merge(skb, ptr + offset, TAG_HDR_LEN + MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN - offset) < 0) { ++ DEBUG_ERR("call skb_pull_and_merge() failed in PADO packet!\n"); ++ return -1; ++ } ++ ph->length = htons(ntohs(ph->length) - (TAG_HDR_LEN + MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN - offset)); ++ if (offset > 0) ++ tag->tag_len = htons(tagLen - MAGIC_CODE_LEN - RTL_RELAY_TAG_LEN); ++ ++ RTW_INFO("NAT25: Lookup PPPoE, forward %s Packet from %s\n", ++ (ph->code == PADO_CODE ? "PADO" : "PADS"), skb->dev->name); ++ } else { /* not add relay tag */ ++ if (!priv->pppoe_connection_in_progress) { ++ DEBUG_ERR("Discard PPPoE packet due to no connection in progresss!\n"); ++ return -1; ++ } ++ memcpy(skb->data, priv->pppoe_addr, ETH_ALEN); ++ priv->pppoe_connection_in_progress = WAIT_TIME_PPPOE; ++ } ++ } else { ++ if (ph->sid != 0) { ++ RTW_INFO("NAT25: Lookup PPPoE, lookup session packet from %s\n", skb->dev->name); ++ __nat25_generate_pppoe_network_addr(networkAddr, skb->data + ETH_ALEN, &(ph->sid)); ++ ++ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); ++ ++ __nat25_db_print(priv); ++ } else ++ return -1; ++ ++ } ++ return 0; ++ ++ default: ++ return -1; ++ } ++ } ++ ++ /*---------------------------------------------------*/ ++ /* Handle EAP frame */ ++ /*---------------------------------------------------*/ ++ else if (protocol == __constant_htons(0x888e)) { ++ switch (method) { ++ case NAT25_CHECK: ++ return -1; ++ ++ case NAT25_INSERT: ++ return 0; ++ ++ case NAT25_LOOKUP: ++ return 0; ++ ++ default: ++ return -1; ++ } ++ } ++ ++ /*---------------------------------------------------*/ ++ /* Handle C-Media proprietary frame */ ++ /*---------------------------------------------------*/ ++ else if ((protocol == __constant_htons(0xe2ae)) || ++ (protocol == __constant_htons(0xe2af))) { ++ switch (method) { ++ case NAT25_CHECK: ++ return -1; ++ ++ case NAT25_INSERT: ++ return 0; ++ ++ case NAT25_LOOKUP: ++ return 0; ++ ++ default: ++ return -1; ++ } ++ } ++ ++ /*---------------------------------------------------*/ ++ /* Handle IPV6 frame */ ++ /*---------------------------------------------------*/ ++#ifdef CL_IPV6_PASS ++ else if (protocol == __constant_htons(ETH_P_IPV6)) { ++ struct ipv6hdr *iph = (struct ipv6hdr *)(skb->data + ETH_HLEN); ++ ++ if (sizeof(*iph) >= (skb->len - ETH_HLEN)) { ++ DEBUG_WARN("NAT25: malformed IPv6 packet !\n"); ++ return -1; ++ } ++ ++ switch (method) { ++ case NAT25_CHECK: ++ if (skb->data[0] & 1) ++ return 0; ++ return -1; ++ ++ case NAT25_INSERT: { ++ RTW_INFO("NAT25: Insert IP, SA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x," ++ " DA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x\n", ++ iph->saddr.s6_addr16[0], iph->saddr.s6_addr16[1], iph->saddr.s6_addr16[2], iph->saddr.s6_addr16[3], ++ iph->saddr.s6_addr16[4], iph->saddr.s6_addr16[5], iph->saddr.s6_addr16[6], iph->saddr.s6_addr16[7], ++ iph->daddr.s6_addr16[0], iph->daddr.s6_addr16[1], iph->daddr.s6_addr16[2], iph->daddr.s6_addr16[3], ++ iph->daddr.s6_addr16[4], iph->daddr.s6_addr16[5], iph->daddr.s6_addr16[6], iph->daddr.s6_addr16[7]); ++ ++ if (memcmp(&iph->saddr, "\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0", 16)) { ++ __nat25_generate_ipv6_network_addr(networkAddr, (unsigned int *)&iph->saddr); ++ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); ++ __nat25_db_print(priv); ++ ++ if (iph->nexthdr == IPPROTO_ICMPV6 && ++ skb->len > (ETH_HLEN + sizeof(*iph) + 4)) { ++ if (update_nd_link_layer_addr(skb->data + ETH_HLEN + sizeof(*iph), ++ skb->len - ETH_HLEN - sizeof(*iph), GET_MY_HWADDR(priv))) { ++ struct icmp6hdr *hdr = (struct icmp6hdr *)(skb->data + ETH_HLEN + sizeof(*iph)); ++ hdr->icmp6_cksum = 0; ++ hdr->icmp6_cksum = csum_ipv6_magic(&iph->saddr, &iph->daddr, ++ iph->payload_len, ++ IPPROTO_ICMPV6, ++ csum_partial((__u8 *)hdr, iph->payload_len, 0)); ++ } ++ } ++ } ++ } ++ return 0; ++ ++ case NAT25_LOOKUP: ++ RTW_INFO("NAT25: Lookup IP, SA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x," ++ " DA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x\n", ++ iph->saddr.s6_addr16[0], iph->saddr.s6_addr16[1], iph->saddr.s6_addr16[2], iph->saddr.s6_addr16[3], ++ iph->saddr.s6_addr16[4], iph->saddr.s6_addr16[5], iph->saddr.s6_addr16[6], iph->saddr.s6_addr16[7], ++ iph->daddr.s6_addr16[0], iph->daddr.s6_addr16[1], iph->daddr.s6_addr16[2], iph->daddr.s6_addr16[3], ++ iph->daddr.s6_addr16[4], iph->daddr.s6_addr16[5], iph->daddr.s6_addr16[6], iph->daddr.s6_addr16[7]); ++ ++ ++ __nat25_generate_ipv6_network_addr(networkAddr, (unsigned int *)&iph->daddr); ++ if (!__nat25_db_network_lookup_and_replace(priv, skb, networkAddr)) { ++#ifdef SUPPORT_RX_UNI2MCAST ++ if (iph->daddr.s6_addr[0] == 0xff) ++ convert_ipv6_mac_to_mc(skb); ++#endif ++ } ++ return 0; ++ ++ default: ++ return -1; ++ } ++ } ++#endif /* CL_IPV6_PASS */ ++ ++ return -1; ++} ++ ++ ++int nat25_handle_frame(_adapter *priv, struct sk_buff *skb) ++{ ++#ifdef BR_EXT_DEBUG ++ if ((!priv->ethBrExtInfo.nat25_disable) && (!(skb->data[0] & 1))) { ++ panic_printk("NAT25: Input Frame: DA=%02x%02x%02x%02x%02x%02x SA=%02x%02x%02x%02x%02x%02x\n", ++ skb->data[0], ++ skb->data[1], ++ skb->data[2], ++ skb->data[3], ++ skb->data[4], ++ skb->data[5], ++ skb->data[6], ++ skb->data[7], ++ skb->data[8], ++ skb->data[9], ++ skb->data[10], ++ skb->data[11]); ++ } ++#endif ++ ++ if (!(skb->data[0] & 1)) { ++ int is_vlan_tag = 0, i, retval = 0; ++ unsigned short vlan_hdr = 0; ++ ++ if (*((unsigned short *)(skb->data + ETH_ALEN * 2)) == __constant_htons(ETH_P_8021Q)) { ++ is_vlan_tag = 1; ++ vlan_hdr = *((unsigned short *)(skb->data + ETH_ALEN * 2 + 2)); ++ for (i = 0; i < 6; i++) ++ *((unsigned short *)(skb->data + ETH_ALEN * 2 + 2 - i * 2)) = *((unsigned short *)(skb->data + ETH_ALEN * 2 - 2 - i * 2)); ++ skb_pull(skb, 4); ++ } ++ ++ if (!priv->ethBrExtInfo.nat25_disable) { ++ _irqL irqL; ++ _enter_critical_bh(&priv->br_ext_lock, &irqL); ++ /* ++ * This function look up the destination network address from ++ * the NAT2.5 database. Return value = -1 means that the ++ * corresponding network protocol is NOT support. ++ */ ++ if (!priv->ethBrExtInfo.nat25sc_disable && ++ (*((unsigned short *)(skb->data + ETH_ALEN * 2)) == __constant_htons(ETH_P_IP)) && ++ !memcmp(priv->scdb_ip, skb->data + ETH_HLEN + 16, 4)) { ++ memcpy(skb->data, priv->scdb_mac, ETH_ALEN); ++ ++ _exit_critical_bh(&priv->br_ext_lock, &irqL); ++ } else { ++ _exit_critical_bh(&priv->br_ext_lock, &irqL); ++ ++ retval = nat25_db_handle(priv, skb, NAT25_LOOKUP); ++ } ++ } else { ++ if (((*((unsigned short *)(skb->data + ETH_ALEN * 2)) == __constant_htons(ETH_P_IP)) && ++ !memcmp(priv->br_ip, skb->data + ETH_HLEN + 16, 4)) || ++ ((*((unsigned short *)(skb->data + ETH_ALEN * 2)) == __constant_htons(ETH_P_ARP)) && ++ !memcmp(priv->br_ip, skb->data + ETH_HLEN + 24, 4))) { ++ /* for traffic to upper TCP/IP */ ++ retval = nat25_db_handle(priv, skb, NAT25_LOOKUP); ++ } ++ } ++ ++ if (is_vlan_tag) { ++ skb_push(skb, 4); ++ for (i = 0; i < 6; i++) ++ *((unsigned short *)(skb->data + i * 2)) = *((unsigned short *)(skb->data + 4 + i * 2)); ++ *((unsigned short *)(skb->data + ETH_ALEN * 2)) = __constant_htons(ETH_P_8021Q); ++ *((unsigned short *)(skb->data + ETH_ALEN * 2 + 2)) = vlan_hdr; ++ } ++ ++ if (retval == -1) { ++ /* DEBUG_ERR("NAT25: Lookup fail!\n"); */ ++ return -1; ++ } ++ } ++ ++ return 0; ++} ++ ++#if 0 ++void mac_clone(_adapter *priv, unsigned char *addr) ++{ ++ struct sockaddr sa; ++ ++ memcpy(sa.sa_data, addr, ETH_ALEN); ++ RTW_INFO("MAC Clone: Addr=%02x%02x%02x%02x%02x%02x\n", ++ addr[0], addr[1], addr[2], addr[3], addr[4], addr[5]); ++ rtl8192cd_set_hwaddr(priv->dev, &sa); ++} ++ ++ ++int mac_clone_handle_frame(_adapter *priv, struct sk_buff *skb) ++{ ++ if (priv->ethBrExtInfo.macclone_enable && !priv->macclone_completed) { ++ if (!(skb->data[ETH_ALEN] & 1)) { /* check any other particular MAC add */ ++ if (memcmp(skb->data + ETH_ALEN, GET_MY_HWADDR(priv), ETH_ALEN) && ++ ((priv->dev->br_port) && ++ memcmp(skb->data + ETH_ALEN, priv->br_mac, ETH_ALEN))) { ++ mac_clone(priv, skb->data + ETH_ALEN); ++ priv->macclone_completed = 1; ++ } ++ } ++ } ++ ++ return 0; ++} ++#endif /* 0 */ ++ ++#define SERVER_PORT 67 ++#define CLIENT_PORT 68 ++#define DHCP_MAGIC 0x63825363 ++#define BROADCAST_FLAG 0x8000 ++ ++struct dhcpMessage { ++ u_int8_t op; ++ u_int8_t htype; ++ u_int8_t hlen; ++ u_int8_t hops; ++ u_int32_t xid; ++ u_int16_t secs; ++ u_int16_t flags; ++ u_int32_t ciaddr; ++ u_int32_t yiaddr; ++ u_int32_t siaddr; ++ u_int32_t giaddr; ++ u_int8_t chaddr[16]; ++ u_int8_t sname[64]; ++ u_int8_t file[128]; ++ u_int32_t cookie; ++ u_int8_t options[308]; /* 312 - cookie */ ++}; ++ ++void dhcp_flag_bcast(_adapter *priv, struct sk_buff *skb) ++{ ++ if (skb == NULL) ++ return; ++ ++ if (!priv->ethBrExtInfo.dhcp_bcst_disable) { ++ unsigned short protocol = *((unsigned short *)(skb->data + 2 * ETH_ALEN)); ++ ++ if (protocol == __constant_htons(ETH_P_IP)) { /* IP */ ++ struct iphdr *iph = (struct iphdr *)(skb->data + ETH_HLEN); ++ ++ if (iph->protocol == IPPROTO_UDP) { /* UDP */ ++ struct udphdr *udph = (struct udphdr *)((SIZE_PTR)iph + (iph->ihl << 2)); ++ ++ if ((udph->source == __constant_htons(CLIENT_PORT)) ++ && (udph->dest == __constant_htons(SERVER_PORT))) { /* DHCP request */ ++ struct dhcpMessage *dhcph = ++ (struct dhcpMessage *)((SIZE_PTR)udph + sizeof(struct udphdr)); ++ ++ if (dhcph->cookie == __constant_htonl(DHCP_MAGIC)) { /* match magic word */ ++ if (!(dhcph->flags & htons(BROADCAST_FLAG))) { /* if not broadcast */ ++ register int sum = 0; ++ ++ RTW_INFO("DHCP: change flag of DHCP request to broadcast.\n"); ++ /* or BROADCAST flag */ ++ dhcph->flags |= htons(BROADCAST_FLAG); ++ /* recalculate checksum */ ++ sum = ~(udph->check) & 0xffff; ++ sum += dhcph->flags; ++ while (sum >> 16) ++ sum = (sum & 0xffff) + (sum >> 16); ++ udph->check = ~sum; ++ } ++ } ++ } ++ } ++ } ++ } ++} ++ ++ ++void *scdb_findEntry(_adapter *priv, unsigned char *macAddr, ++ unsigned char *ipAddr) ++{ ++ unsigned char networkAddr[MAX_NETWORK_ADDR_LEN]; ++ struct nat25_network_db_entry *db; ++ int hash; ++ /* _irqL irqL; */ ++ /* _enter_critical_bh(&priv->br_ext_lock, &irqL); */ ++ ++ __nat25_generate_ipv4_network_addr(networkAddr, (unsigned int *)ipAddr); ++ hash = __nat25_network_hash(networkAddr); ++ db = priv->nethash[hash]; ++ while (db != NULL) { ++ if (!memcmp(db->networkAddr, networkAddr, MAX_NETWORK_ADDR_LEN)) { ++ /* _exit_critical_bh(&priv->br_ext_lock, &irqL); */ ++ return (void *)db; ++ } ++ ++ db = db->next_hash; ++ } ++ ++ /* _exit_critical_bh(&priv->br_ext_lock, &irqL); */ ++ return NULL; ++} ++ ++#endif /* CONFIG_BR_EXT */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_btcoex.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_btcoex.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_btcoex.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_btcoex.c 2018-02-11 21:44:27.135145903 +0200 +@@ -0,0 +1,1722 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifdef CONFIG_BT_COEXIST ++ ++#include ++#include ++#include ++ ++ ++void rtw_btcoex_Initialize(PADAPTER padapter) ++{ ++ hal_btcoex_Initialize(padapter); ++} ++ ++void rtw_btcoex_PowerOnSetting(PADAPTER padapter) ++{ ++ hal_btcoex_PowerOnSetting(padapter); ++} ++ ++void rtw_btcoex_PowerOffSetting(PADAPTER padapter) ++{ ++ hal_btcoex_PowerOffSetting(padapter); ++} ++ ++void rtw_btcoex_PreLoadFirmware(PADAPTER padapter) ++{ ++ hal_btcoex_PreLoadFirmware(padapter); ++} ++ ++void rtw_btcoex_HAL_Initialize(PADAPTER padapter, u8 bWifiOnly) ++{ ++ hal_btcoex_InitHwConfig(padapter, bWifiOnly); ++} ++ ++void rtw_btcoex_IpsNotify(PADAPTER padapter, u8 type) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ if (_FALSE == pHalData->EEPROMBluetoothCoexist) ++ return; ++ ++ hal_btcoex_IpsNotify(padapter, type); ++} ++ ++void rtw_btcoex_LpsNotify(PADAPTER padapter, u8 type) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ if (_FALSE == pHalData->EEPROMBluetoothCoexist) ++ return; ++ ++ hal_btcoex_LpsNotify(padapter, type); ++} ++ ++void rtw_btcoex_ScanNotify(PADAPTER padapter, u8 type) ++{ ++ PHAL_DATA_TYPE pHalData; ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ struct bt_coex_info *pcoex_info = &padapter->coex_info; ++ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++ ++ pHalData = GET_HAL_DATA(padapter); ++ if (_FALSE == pHalData->EEPROMBluetoothCoexist) ++ return; ++ ++ if (_FALSE == type) { ++ #ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_buddy_check_fwstate(padapter, WIFI_SITE_MONITOR)) ++ return; ++ #endif ++ ++ if (DEV_MGMT_TX_NUM(adapter_to_dvobj(padapter)) ++ || DEV_ROCH_NUM(adapter_to_dvobj(padapter))) ++ return; ++ } ++ ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ if (pBtMgnt->ExtConfig.bEnableWifiScanNotify) ++ rtw_btcoex_SendScanNotify(padapter, type); ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++ ++ hal_btcoex_ScanNotify(padapter, type); ++} ++ ++void rtw_btcoex_ConnectNotify(PADAPTER padapter, u8 action) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ if (_FALSE == pHalData->EEPROMBluetoothCoexist) ++ return; ++ ++#ifdef DBG_CONFIG_ERROR_RESET ++ if (_TRUE == rtw_hal_sreset_inprogress(padapter)) { ++ RTW_INFO(FUNC_ADPT_FMT ": [BTCoex] under reset, skip notify!\n", ++ FUNC_ADPT_ARG(padapter)); ++ return; ++ } ++#endif /* DBG_CONFIG_ERROR_RESET */ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (_FALSE == action) { ++ if (rtw_mi_buddy_check_fwstate(padapter, WIFI_UNDER_LINKING)) ++ return; ++ } ++#endif ++ ++ hal_btcoex_ConnectNotify(padapter, action); ++} ++ ++void rtw_btcoex_MediaStatusNotify(PADAPTER padapter, u8 mediaStatus) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ if (_FALSE == pHalData->EEPROMBluetoothCoexist) ++ return; ++ ++#ifdef DBG_CONFIG_ERROR_RESET ++ if (_TRUE == rtw_hal_sreset_inprogress(padapter)) { ++ RTW_INFO(FUNC_ADPT_FMT ": [BTCoex] under reset, skip notify!\n", ++ FUNC_ADPT_ARG(padapter)); ++ return; ++ } ++#endif /* DBG_CONFIG_ERROR_RESET */ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (RT_MEDIA_DISCONNECT == mediaStatus) { ++ if (rtw_mi_buddy_check_fwstate(padapter, WIFI_ASOC_STATE)) ++ return; ++ } ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ if ((RT_MEDIA_CONNECT == mediaStatus) ++ && (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE)) ++ rtw_hal_set_hwreg(padapter, HW_VAR_DL_RSVD_PAGE, NULL); ++ ++ hal_btcoex_MediaStatusNotify(padapter, mediaStatus); ++} ++ ++void rtw_btcoex_SpecialPacketNotify(PADAPTER padapter, u8 pktType) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ if (_FALSE == pHalData->EEPROMBluetoothCoexist) ++ return; ++ ++ hal_btcoex_SpecialPacketNotify(padapter, pktType); ++} ++ ++void rtw_btcoex_IQKNotify(PADAPTER padapter, u8 state) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ if (_FALSE == pHalData->EEPROMBluetoothCoexist) ++ return; ++ ++ hal_btcoex_IQKNotify(padapter, state); ++} ++ ++void rtw_btcoex_BtInfoNotify(PADAPTER padapter, u8 length, u8 *tmpBuf) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ if (_FALSE == pHalData->EEPROMBluetoothCoexist) ++ return; ++ ++ hal_btcoex_BtInfoNotify(padapter, length, tmpBuf); ++} ++ ++void rtw_btcoex_BtMpRptNotify(PADAPTER padapter, u8 length, u8 *tmpBuf) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ if (_FALSE == pHalData->EEPROMBluetoothCoexist) ++ return; ++ ++ if (padapter->registrypriv.mp_mode == 1) ++ return; ++ ++ hal_btcoex_BtMpRptNotify(padapter, length, tmpBuf); ++} ++ ++void rtw_btcoex_SuspendNotify(PADAPTER padapter, u8 state) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ if (_FALSE == pHalData->EEPROMBluetoothCoexist) ++ return; ++ ++ hal_btcoex_SuspendNotify(padapter, state); ++} ++ ++void rtw_btcoex_HaltNotify(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData; ++ u8 do_halt = 1; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ if (_FALSE == pHalData->EEPROMBluetoothCoexist) ++ do_halt = 0; ++ ++ if (_FALSE == padapter->bup) { ++ RTW_INFO(FUNC_ADPT_FMT ": bup=%d Skip!\n", ++ FUNC_ADPT_ARG(padapter), padapter->bup); ++ do_halt = 0; ++ } ++ ++ if (rtw_is_surprise_removed(padapter)) { ++ RTW_INFO(FUNC_ADPT_FMT ": bSurpriseRemoved=%s Skip!\n", ++ FUNC_ADPT_ARG(padapter), rtw_is_surprise_removed(padapter) ? "True" : "False"); ++ do_halt = 0; ++ } ++ ++ hal_btcoex_HaltNotify(padapter, do_halt); ++} ++ ++void rtw_btcoex_switchband_notify(u8 under_scan, u8 band_type) ++{ ++ hal_btcoex_switchband_notify(under_scan, band_type); ++} ++ ++void rtw_btcoex_SwitchBtTRxMask(PADAPTER padapter) ++{ ++ hal_btcoex_SwitchBtTRxMask(padapter); ++} ++ ++void rtw_btcoex_Switch(PADAPTER padapter, u8 enable) ++{ ++ hal_btcoex_SetBTCoexist(padapter, enable); ++} ++ ++u8 rtw_btcoex_IsBtDisabled(PADAPTER padapter) ++{ ++ return hal_btcoex_IsBtDisabled(padapter); ++} ++ ++void rtw_btcoex_Handler(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ ++ if (_FALSE == pHalData->EEPROMBluetoothCoexist) ++ return; ++ ++ hal_btcoex_Hanlder(padapter); ++} ++ ++s32 rtw_btcoex_IsBTCoexRejectAMPDU(PADAPTER padapter) ++{ ++ s32 coexctrl; ++ ++ coexctrl = hal_btcoex_IsBTCoexRejectAMPDU(padapter); ++ ++ return coexctrl; ++} ++ ++s32 rtw_btcoex_IsBTCoexCtrlAMPDUSize(PADAPTER padapter) ++{ ++ s32 coexctrl; ++ ++ coexctrl = hal_btcoex_IsBTCoexCtrlAMPDUSize(padapter); ++ ++ return coexctrl; ++} ++ ++u32 rtw_btcoex_GetAMPDUSize(PADAPTER padapter) ++{ ++ u32 size; ++ ++ size = hal_btcoex_GetAMPDUSize(padapter); ++ ++ return size; ++} ++ ++void rtw_btcoex_SetManualControl(PADAPTER padapter, u8 manual) ++{ ++ if (_TRUE == manual) ++ hal_btcoex_SetManualControl(padapter, _TRUE); ++ else ++ hal_btcoex_SetManualControl(padapter, _FALSE); ++} ++ ++u8 rtw_btcoex_1Ant(PADAPTER padapter) ++{ ++ return hal_btcoex_1Ant(padapter); ++} ++ ++u8 rtw_btcoex_IsBtControlLps(PADAPTER padapter) ++{ ++ return hal_btcoex_IsBtControlLps(padapter); ++} ++ ++u8 rtw_btcoex_IsLpsOn(PADAPTER padapter) ++{ ++ return hal_btcoex_IsLpsOn(padapter); ++} ++ ++u8 rtw_btcoex_RpwmVal(PADAPTER padapter) ++{ ++ return hal_btcoex_RpwmVal(padapter); ++} ++ ++u8 rtw_btcoex_LpsVal(PADAPTER padapter) ++{ ++ return hal_btcoex_LpsVal(padapter); ++} ++ ++u32 rtw_btcoex_GetRaMask(PADAPTER padapter) ++{ ++ return hal_btcoex_GetRaMask(padapter); ++} ++ ++void rtw_btcoex_RecordPwrMode(PADAPTER padapter, u8 *pCmdBuf, u8 cmdLen) ++{ ++ hal_btcoex_RecordPwrMode(padapter, pCmdBuf, cmdLen); ++} ++ ++void rtw_btcoex_DisplayBtCoexInfo(PADAPTER padapter, u8 *pbuf, u32 bufsize) ++{ ++ hal_btcoex_DisplayBtCoexInfo(padapter, pbuf, bufsize); ++} ++ ++void rtw_btcoex_SetDBG(PADAPTER padapter, u32 *pDbgModule) ++{ ++ hal_btcoex_SetDBG(padapter, pDbgModule); ++} ++ ++u32 rtw_btcoex_GetDBG(PADAPTER padapter, u8 *pStrBuf, u32 bufSize) ++{ ++ return hal_btcoex_GetDBG(padapter, pStrBuf, bufSize); ++} ++ ++u8 rtw_btcoex_IncreaseScanDeviceNum(PADAPTER padapter) ++{ ++ return hal_btcoex_IncreaseScanDeviceNum(padapter); ++} ++ ++u8 rtw_btcoex_IsBtLinkExist(PADAPTER padapter) ++{ ++ return hal_btcoex_IsBtLinkExist(padapter); ++} ++ ++void rtw_btcoex_SetBtPatchVersion(PADAPTER padapter, u16 btHciVer, u16 btPatchVer) ++{ ++ hal_btcoex_SetBtPatchVersion(padapter, btHciVer, btPatchVer); ++} ++ ++void rtw_btcoex_SetHciVersion(PADAPTER padapter, u16 hciVersion) ++{ ++ hal_btcoex_SetHciVersion(padapter, hciVersion); ++} ++ ++void rtw_btcoex_StackUpdateProfileInfo(void) ++{ ++ hal_btcoex_StackUpdateProfileInfo(); ++} ++ ++void rtw_btcoex_BTOffOnNotify(PADAPTER padapter, u8 bBTON) ++{ ++ hal_btcoex_BTOffOnNotify(padapter, bBTON); ++} ++ ++/* ================================================== ++ * Below Functions are called by BT-Coex ++ * ================================================== */ ++void rtw_btcoex_rx_ampdu_apply(PADAPTER padapter) ++{ ++ rtw_rx_ampdu_apply(padapter); ++} ++ ++void rtw_btcoex_LPS_Enter(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrpriv; ++ u8 lpsVal; ++ ++ ++ pwrpriv = adapter_to_pwrctl(padapter); ++ ++ pwrpriv->bpower_saving = _TRUE; ++ lpsVal = rtw_btcoex_LpsVal(padapter); ++ rtw_set_ps_mode(padapter, PS_MODE_MIN, 0, lpsVal, "BTCOEX"); ++} ++ ++void rtw_btcoex_LPS_Leave(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrpriv; ++ ++ ++ pwrpriv = adapter_to_pwrctl(padapter); ++ ++ if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) { ++ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "BTCOEX"); ++ LPS_RF_ON_check(padapter, 100); ++ pwrpriv->bpower_saving = _FALSE; ++ } ++} ++ ++u16 rtw_btcoex_btreg_read(PADAPTER padapter, u8 type, u16 addr, u32 *data) ++{ ++ return hal_btcoex_btreg_read(padapter, type, addr, data); ++} ++ ++u16 rtw_btcoex_btreg_write(PADAPTER padapter, u8 type, u16 addr, u16 val) ++{ ++ return hal_btcoex_btreg_write(padapter, type, addr, val); ++} ++ ++u8 rtw_btcoex_get_bt_coexist(PADAPTER padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ return pHalData->EEPROMBluetoothCoexist; ++} ++ ++u8 rtw_btcoex_get_chip_type(PADAPTER padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ return pHalData->EEPROMBluetoothType; ++} ++ ++u8 rtw_btcoex_get_pg_ant_num(PADAPTER padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ return pHalData->EEPROMBluetoothAntNum == Ant_x2 ? 2 : 1; ++} ++ ++u8 rtw_btcoex_get_pg_single_ant_path(PADAPTER padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ return pHalData->ant_path; ++} ++ ++u8 rtw_btcoex_get_pg_rfe_type(PADAPTER padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ return pHalData->RFEType; ++} ++ ++u8 rtw_btcoex_is_tfbga_package_type(PADAPTER padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++#ifdef CONFIG_RTL8723B ++ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA80) ++ || (pHalData->PackageType == PACKAGE_TFBGA90)) ++ return _TRUE; ++#endif ++ ++ return _FALSE; ++} ++ ++u8 rtw_btcoex_get_ant_div_cfg(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ ++ return (pHalData->AntDivCfg == 0) ? _FALSE : _TRUE; ++} ++ ++/* ================================================== ++ * Below Functions are BT-Coex socket related function ++ * ================================================== */ ++ ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++_adapter *pbtcoexadapter; /* = NULL; */ /* do not initialise globals to 0 or NULL */ ++u8 rtw_btcoex_btinfo_cmd(_adapter *adapter, u8 *buf, u16 len) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ u8 *btinfo; ++ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ btinfo = rtw_zmalloc(len); ++ if (btinfo == NULL) { ++ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); ++ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = BTINFO_WK_CID; ++ pdrvextra_cmd_parm->type = 0; ++ pdrvextra_cmd_parm->size = len; ++ pdrvextra_cmd_parm->pbuf = btinfo; ++ ++ _rtw_memcpy(btinfo, buf, len); ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ return res; ++} ++ ++u8 rtw_btcoex_send_event_to_BT(_adapter *padapter, u8 status, u8 event_code, u8 opcode_low, u8 opcode_high, u8 *dbg_msg) ++{ ++ u8 localBuf[6] = ""; ++ u8 *pRetPar; ++ u8 len = 0, tx_event_length = 0; ++ rtw_HCI_event *pEvent; ++ ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ pEvent->EventCode = event_code; ++ pEvent->Data[0] = 0x1; /* packet # */ ++ pEvent->Data[1] = opcode_low; ++ pEvent->Data[2] = opcode_high; ++ len = len + 3; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ pRetPar[0] = status; /* status */ ++ ++ len++; ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++#if 0 ++ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, dbg_msg); ++#endif ++ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ ++ return status; ++} ++ ++/* ++Ref: ++Realtek Wi-Fi Driver ++Host Controller Interface for ++Bluetooth 3.0 + HS V1.4 2013/02/07 ++ ++Window team code & BT team code ++ */ ++ ++ ++u8 rtw_btcoex_parse_BT_info_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) ++{ ++#define BT_INFO_LENGTH 8 ++ ++ u8 curPollEnable = pcmd[0]; ++ u8 curPollTime = pcmd[1]; ++ u8 btInfoReason = pcmd[2]; ++ u8 btInfoLen = pcmd[3]; ++ u8 btinfo[BT_INFO_LENGTH]; ++ ++ u8 localBuf[6] = ""; ++ u8 *pRetPar; ++ u8 len = 0, tx_event_length = 0; ++ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; ++ rtw_HCI_event *pEvent; ++ ++ /* RTW_INFO("%s\n",__func__); ++ RTW_INFO("current Poll Enable: %d, currrent Poll Time: %d\n",curPollEnable,curPollTime); ++ RTW_INFO("BT Info reason: %d, BT Info length: %d\n",btInfoReason,btInfoLen); ++ RTW_INFO("%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x\n" ++ ,pcmd[4],pcmd[5],pcmd[6],pcmd[7],pcmd[8],pcmd[9],pcmd[10],pcmd[11]);*/ ++ ++ _rtw_memset(btinfo, 0, BT_INFO_LENGTH); ++ ++#if 1 ++ if (BT_INFO_LENGTH != btInfoLen) { ++ status = HCI_STATUS_INVALID_HCI_CMD_PARA_VALUE; ++ RTW_INFO("Error BT Info Length: %d\n", btInfoLen); ++ /* return _FAIL; */ ++ } else ++#endif ++ { ++ if (0x1 == btInfoReason || 0x2 == btInfoReason) { ++ _rtw_memcpy(btinfo, &pcmd[4], btInfoLen); ++ btinfo[0] = btInfoReason; ++ rtw_btcoex_btinfo_cmd(padapter, btinfo, btInfoLen); ++ } else ++ RTW_INFO("Other BT info reason\n"); ++ } ++ ++ /* send complete event to BT */ ++ { ++ ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; ++ pEvent->Data[0] = 0x1; /* packet # */ ++ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_INFO_NOTIFY, OGF_EXTENSION); ++ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_INFO_NOTIFY, OGF_EXTENSION); ++ len = len + 3; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ pRetPar[0] = status; /* status */ ++ ++ len++; ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++#if 0 ++ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, "BT_info_event"); ++#endif ++ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ ++ return status; ++ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ ++ } ++} ++ ++u8 rtw_btcoex_parse_BT_patch_ver_info_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) ++{ ++ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; ++ u16 btPatchVer = 0x0, btHciVer = 0x0; ++ /* u16 *pU2tmp; */ ++ ++ u8 localBuf[6] = ""; ++ u8 *pRetPar; ++ u8 len = 0, tx_event_length = 0; ++ rtw_HCI_event *pEvent; ++ ++ btHciVer = pcmd[0] | pcmd[1] << 8; ++ btPatchVer = pcmd[2] | pcmd[3] << 8; ++ ++ ++ RTW_INFO("%s, cmd:%02x %02x %02x %02x\n", __func__, pcmd[0] , pcmd[1] , pcmd[2] , pcmd[3]); ++ RTW_INFO("%s, HCI Ver:%d, Patch Ver:%d\n", __func__, btHciVer, btPatchVer); ++ ++ rtw_btcoex_SetBtPatchVersion(padapter, btHciVer, btPatchVer); ++ ++ ++ /* send complete event to BT */ ++ { ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ ++ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; ++ pEvent->Data[0] = 0x1; /* packet # */ ++ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_PATCH_VERSION_NOTIFY, OGF_EXTENSION); ++ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_PATCH_VERSION_NOTIFY, OGF_EXTENSION); ++ len = len + 3; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ pRetPar[0] = status; /* status */ ++ ++ len++; ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++#if 0 ++ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, "BT_patch_event"); ++#endif ++ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ return status; ++ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ ++ } ++} ++ ++u8 rtw_btcoex_parse_HCI_Ver_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) ++{ ++ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; ++ u16 hciver = pcmd[0] | pcmd[1] << 8; ++ ++ u8 localBuf[6] = ""; ++ u8 *pRetPar; ++ u8 len = 0, tx_event_length = 0; ++ rtw_HCI_event *pEvent; ++ ++ struct bt_coex_info *pcoex_info = &padapter->coex_info; ++ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; ++ pBtMgnt->ExtConfig.HCIExtensionVer = hciver; ++ RTW_INFO("%s, HCI Version: %d\n", __func__, pBtMgnt->ExtConfig.HCIExtensionVer); ++ if (pBtMgnt->ExtConfig.HCIExtensionVer < 4) { ++ status = HCI_STATUS_INVALID_HCI_CMD_PARA_VALUE; ++ RTW_INFO("%s, Version = %d, HCI Version < 4\n", __func__, pBtMgnt->ExtConfig.HCIExtensionVer); ++ } else ++ rtw_btcoex_SetHciVersion(padapter, hciver); ++ /* send complete event to BT */ ++ { ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ ++ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; ++ pEvent->Data[0] = 0x1; /* packet # */ ++ pEvent->Data[1] = HCIOPCODELOW(HCI_EXTENSION_VERSION_NOTIFY, OGF_EXTENSION); ++ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_EXTENSION_VERSION_NOTIFY, OGF_EXTENSION); ++ len = len + 3; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ pRetPar[0] = status; /* status */ ++ ++ len++; ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++ ++ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ return status; ++ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ ++ } ++ ++} ++ ++u8 rtw_btcoex_parse_WIFI_scan_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) ++{ ++ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; ++ ++ u8 localBuf[6] = ""; ++ u8 *pRetPar; ++ u8 len = 0, tx_event_length = 0; ++ rtw_HCI_event *pEvent; ++ ++ struct bt_coex_info *pcoex_info = &padapter->coex_info; ++ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; ++ pBtMgnt->ExtConfig.bEnableWifiScanNotify = pcmd[0]; ++ RTW_INFO("%s, bEnableWifiScanNotify: %d\n", __func__, pBtMgnt->ExtConfig.bEnableWifiScanNotify); ++ ++ /* send complete event to BT */ ++ { ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ ++ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; ++ pEvent->Data[0] = 0x1; /* packet # */ ++ pEvent->Data[1] = HCIOPCODELOW(HCI_ENABLE_WIFI_SCAN_NOTIFY, OGF_EXTENSION); ++ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_ENABLE_WIFI_SCAN_NOTIFY, OGF_EXTENSION); ++ len = len + 3; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ pRetPar[0] = status; /* status */ ++ ++ len++; ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++ ++ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ return status; ++ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ ++ } ++} ++ ++u8 rtw_btcoex_parse_HCI_link_status_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) ++{ ++ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; ++ struct bt_coex_info *pcoex_info = &padapter->coex_info; ++ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; ++ /* PBT_DBG pBtDbg=&padapter->MgntInfo.BtInfo.BtDbg; */ ++ u8 i, numOfHandle = 0, numOfAcl = 0; ++ u16 conHandle; ++ u8 btProfile, btCoreSpec, linkRole; ++ u8 *pTriple; ++ ++ u8 localBuf[6] = ""; ++ u8 *pRetPar; ++ u8 len = 0, tx_event_length = 0; ++ rtw_HCI_event *pEvent; ++ ++ /* pBtDbg->dbgHciInfo.hciCmdCntLinkStatusNotify++; */ ++ /* RT_DISP_DATA(FIOCTL, IOCTL_BT_HCICMD_EXT, "LinkStatusNotify, Hex Data :\n", */ ++ /* &pHciCmd->Data[0], pHciCmd->Length); */ ++ ++ RTW_INFO("BTLinkStatusNotify\n"); ++ ++ /* Current only RTL8723 support this command. */ ++ /* pBtMgnt->bSupportProfile = TRUE; */ ++ pBtMgnt->bSupportProfile = _FALSE; ++ ++ pBtMgnt->ExtConfig.NumberOfACL = 0; ++ pBtMgnt->ExtConfig.NumberOfSCO = 0; ++ ++ numOfHandle = pcmd[0]; ++ /* RT_DISP(FIOCTL, IOCTL_BT_HCICMD_EXT, ("numOfHandle = 0x%x\n", numOfHandle)); */ ++ /* RT_DISP(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCIExtensionVer = %d\n", pBtMgnt->ExtConfig.HCIExtensionVer)); */ ++ RTW_INFO("numOfHandle = 0x%x\n", numOfHandle); ++ RTW_INFO("HCIExtensionVer = %d\n", pBtMgnt->ExtConfig.HCIExtensionVer); ++ ++ pTriple = &pcmd[1]; ++ for (i = 0; i < numOfHandle; i++) { ++ if (pBtMgnt->ExtConfig.HCIExtensionVer < 1) { ++ conHandle = *((u8 *)&pTriple[0]); ++ btProfile = pTriple[2]; ++ btCoreSpec = pTriple[3]; ++ if (BT_PROFILE_SCO == btProfile) ++ pBtMgnt->ExtConfig.NumberOfSCO++; ++ else { ++ pBtMgnt->ExtConfig.NumberOfACL++; ++ pBtMgnt->ExtConfig.aclLink[i].ConnectHandle = conHandle; ++ pBtMgnt->ExtConfig.aclLink[i].BTProfile = btProfile; ++ pBtMgnt->ExtConfig.aclLink[i].BTCoreSpec = btCoreSpec; ++ } ++ /* RT_DISP(FIOCTL, IOCTL_BT_HCICMD_EXT, */ ++ /* ("Connection_Handle=0x%x, BTProfile=%d, BTSpec=%d\n", */ ++ /* conHandle, btProfile, btCoreSpec)); */ ++ RTW_INFO("Connection_Handle=0x%x, BTProfile=%d, BTSpec=%d\n", conHandle, btProfile, btCoreSpec); ++ pTriple += 4; ++ } else if (pBtMgnt->ExtConfig.HCIExtensionVer >= 1) { ++ conHandle = *((pu2Byte)&pTriple[0]); ++ btProfile = pTriple[2]; ++ btCoreSpec = pTriple[3]; ++ linkRole = pTriple[4]; ++ if (BT_PROFILE_SCO == btProfile) ++ pBtMgnt->ExtConfig.NumberOfSCO++; ++ else { ++ pBtMgnt->ExtConfig.NumberOfACL++; ++ pBtMgnt->ExtConfig.aclLink[i].ConnectHandle = conHandle; ++ pBtMgnt->ExtConfig.aclLink[i].BTProfile = btProfile; ++ pBtMgnt->ExtConfig.aclLink[i].BTCoreSpec = btCoreSpec; ++ pBtMgnt->ExtConfig.aclLink[i].linkRole = linkRole; ++ } ++ /* RT_DISP(FIOCTL, IOCTL_BT_HCICMD_EXT, */ ++ RTW_INFO("Connection_Handle=0x%x, BTProfile=%d, BTSpec=%d, LinkRole=%d\n", ++ conHandle, btProfile, btCoreSpec, linkRole); ++ pTriple += 5; ++ } ++ } ++ rtw_btcoex_StackUpdateProfileInfo(); ++ ++ /* send complete event to BT */ ++ { ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ ++ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; ++ pEvent->Data[0] = 0x1; /* packet # */ ++ pEvent->Data[1] = HCIOPCODELOW(HCI_LINK_STATUS_NOTIFY, OGF_EXTENSION); ++ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_LINK_STATUS_NOTIFY, OGF_EXTENSION); ++ len = len + 3; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ pRetPar[0] = status; /* status */ ++ ++ len++; ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++ ++ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ return status; ++ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ ++ } ++ ++ ++} ++ ++u8 rtw_btcoex_parse_HCI_BT_coex_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) ++{ ++ u8 localBuf[6] = ""; ++ u8 *pRetPar; ++ u8 len = 0, tx_event_length = 0; ++ rtw_HCI_event *pEvent; ++ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; ++ ++ { ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ ++ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; ++ pEvent->Data[0] = 0x1; /* packet # */ ++ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_COEX_NOTIFY, OGF_EXTENSION); ++ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_COEX_NOTIFY, OGF_EXTENSION); ++ len = len + 3; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ pRetPar[0] = status; /* status */ ++ ++ len++; ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++ ++ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ return status; ++ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ ++ } ++} ++ ++u8 rtw_btcoex_parse_HCI_BT_operation_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) ++{ ++ u8 localBuf[6] = ""; ++ u8 *pRetPar; ++ u8 len = 0, tx_event_length = 0; ++ rtw_HCI_event *pEvent; ++ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; ++ ++ RTW_INFO("%s, OP code: %d\n", __func__, pcmd[0]); ++ ++ switch (pcmd[0]) { ++ case HCI_BT_OP_NONE: ++ RTW_INFO("[bt operation] : Operation None!!\n"); ++ break; ++ case HCI_BT_OP_INQUIRY_START: ++ RTW_INFO("[bt operation] : Inquiry start!!\n"); ++ break; ++ case HCI_BT_OP_INQUIRY_FINISH: ++ RTW_INFO("[bt operation] : Inquiry finished!!\n"); ++ break; ++ case HCI_BT_OP_PAGING_START: ++ RTW_INFO("[bt operation] : Paging is started!!\n"); ++ break; ++ case HCI_BT_OP_PAGING_SUCCESS: ++ RTW_INFO("[bt operation] : Paging complete successfully!!\n"); ++ break; ++ case HCI_BT_OP_PAGING_UNSUCCESS: ++ RTW_INFO("[bt operation] : Paging complete unsuccessfully!!\n"); ++ break; ++ case HCI_BT_OP_PAIRING_START: ++ RTW_INFO("[bt operation] : Pairing start!!\n"); ++ break; ++ case HCI_BT_OP_PAIRING_FINISH: ++ RTW_INFO("[bt operation] : Pairing finished!!\n"); ++ break; ++ case HCI_BT_OP_BT_DEV_ENABLE: ++ RTW_INFO("[bt operation] : BT Device is enabled!!\n"); ++ break; ++ case HCI_BT_OP_BT_DEV_DISABLE: ++ RTW_INFO("[bt operation] : BT Device is disabled!!\n"); ++ break; ++ default: ++ RTW_INFO("[bt operation] : Unknown, error!!\n"); ++ break; ++ } ++ ++ /* send complete event to BT */ ++ { ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ ++ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; ++ pEvent->Data[0] = 0x1; /* packet # */ ++ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_OPERATION_NOTIFY, OGF_EXTENSION); ++ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_OPERATION_NOTIFY, OGF_EXTENSION); ++ len = len + 3; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ pRetPar[0] = status; /* status */ ++ ++ len++; ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++ ++ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ return status; ++ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ ++ } ++} ++ ++u8 rtw_btcoex_parse_BT_AFH_MAP_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) ++{ ++ u8 localBuf[6] = ""; ++ u8 *pRetPar; ++ u8 len = 0, tx_event_length = 0; ++ rtw_HCI_event *pEvent; ++ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; ++ ++ { ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ ++ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; ++ pEvent->Data[0] = 0x1; /* packet # */ ++ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_AFH_MAP_NOTIFY, OGF_EXTENSION); ++ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_AFH_MAP_NOTIFY, OGF_EXTENSION); ++ len = len + 3; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ pRetPar[0] = status; /* status */ ++ ++ len++; ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++ ++ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ return status; ++ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ ++ } ++} ++ ++u8 rtw_btcoex_parse_BT_register_val_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) ++{ ++ ++ u8 localBuf[6] = ""; ++ u8 *pRetPar; ++ u8 len = 0, tx_event_length = 0; ++ rtw_HCI_event *pEvent; ++ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; ++ ++ { ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ ++ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; ++ pEvent->Data[0] = 0x1; /* packet # */ ++ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_REGISTER_VALUE_NOTIFY, OGF_EXTENSION); ++ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_REGISTER_VALUE_NOTIFY, OGF_EXTENSION); ++ len = len + 3; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ pRetPar[0] = status; /* status */ ++ ++ len++; ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++ ++ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ return status; ++ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ ++ } ++} ++ ++u8 rtw_btcoex_parse_HCI_BT_abnormal_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) ++{ ++ u8 localBuf[6] = ""; ++ u8 *pRetPar; ++ u8 len = 0, tx_event_length = 0; ++ rtw_HCI_event *pEvent; ++ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; ++ ++ { ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ ++ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; ++ pEvent->Data[0] = 0x1; /* packet # */ ++ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_ABNORMAL_NOTIFY, OGF_EXTENSION); ++ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_ABNORMAL_NOTIFY, OGF_EXTENSION); ++ len = len + 3; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ pRetPar[0] = status; /* status */ ++ ++ len++; ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++ ++ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ return status; ++ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ ++ } ++} ++ ++u8 rtw_btcoex_parse_HCI_query_RF_status_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) ++{ ++ u8 localBuf[6] = ""; ++ u8 *pRetPar; ++ u8 len = 0, tx_event_length = 0; ++ rtw_HCI_event *pEvent; ++ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; ++ ++ { ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ ++ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; ++ pEvent->Data[0] = 0x1; /* packet # */ ++ pEvent->Data[1] = HCIOPCODELOW(HCI_QUERY_RF_STATUS, OGF_EXTENSION); ++ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_QUERY_RF_STATUS, OGF_EXTENSION); ++ len = len + 3; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ pRetPar[0] = status; /* status */ ++ ++ len++; ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++ ++ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ return status; ++ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ ++ } ++} ++ ++/***************************************** ++* HCI cmd format : ++*| 15 - 0 | ++*| OPcode (OCF|OGF<<10) | ++*| 15 - 8 |7 - 0 | ++*|Cmd para |Cmd para Length | ++*|Cmd para...... | ++******************************************/ ++ ++/* bit 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 ++ * | OCF | OGF | */ ++void rtw_btcoex_parse_hci_extend_cmd(_adapter *padapter, u8 *pcmd, u16 len, const u16 hci_OCF) ++{ ++ ++ RTW_INFO("%s: OCF: %x\n", __func__, hci_OCF); ++ switch (hci_OCF) { ++ case HCI_EXTENSION_VERSION_NOTIFY: ++ RTW_INFO("HCI_EXTENSION_VERSION_NOTIFY\n"); ++ rtw_btcoex_parse_HCI_Ver_notify_cmd(padapter, pcmd, len); ++ break; ++ case HCI_LINK_STATUS_NOTIFY: ++ RTW_INFO("HCI_LINK_STATUS_NOTIFY\n"); ++ rtw_btcoex_parse_HCI_link_status_notify_cmd(padapter, pcmd, len); ++ break; ++ case HCI_BT_OPERATION_NOTIFY: ++ /* only for 8723a 2ant */ ++ RTW_INFO("HCI_BT_OPERATION_NOTIFY\n"); ++ rtw_btcoex_parse_HCI_BT_operation_notify_cmd(padapter, pcmd, len); ++ /* */ ++ break; ++ case HCI_ENABLE_WIFI_SCAN_NOTIFY: ++ RTW_INFO("HCI_ENABLE_WIFI_SCAN_NOTIFY\n"); ++ rtw_btcoex_parse_WIFI_scan_notify_cmd(padapter, pcmd, len); ++ break; ++ case HCI_QUERY_RF_STATUS: ++ /* only for 8723b 2ant */ ++ RTW_INFO("HCI_QUERY_RF_STATUS\n"); ++ rtw_btcoex_parse_HCI_query_RF_status_cmd(padapter, pcmd, len); ++ break; ++ case HCI_BT_ABNORMAL_NOTIFY: ++ RTW_INFO("HCI_BT_ABNORMAL_NOTIFY\n"); ++ rtw_btcoex_parse_HCI_BT_abnormal_notify_cmd(padapter, pcmd, len); ++ break; ++ case HCI_BT_INFO_NOTIFY: ++ RTW_INFO("HCI_BT_INFO_NOTIFY\n"); ++ rtw_btcoex_parse_BT_info_notify_cmd(padapter, pcmd, len); ++ break; ++ case HCI_BT_COEX_NOTIFY: ++ RTW_INFO("HCI_BT_COEX_NOTIFY\n"); ++ rtw_btcoex_parse_HCI_BT_coex_notify_cmd(padapter, pcmd, len); ++ break; ++ case HCI_BT_PATCH_VERSION_NOTIFY: ++ RTW_INFO("HCI_BT_PATCH_VERSION_NOTIFY\n"); ++ rtw_btcoex_parse_BT_patch_ver_info_cmd(padapter, pcmd, len); ++ break; ++ case HCI_BT_AFH_MAP_NOTIFY: ++ RTW_INFO("HCI_BT_AFH_MAP_NOTIFY\n"); ++ rtw_btcoex_parse_BT_AFH_MAP_notify_cmd(padapter, pcmd, len); ++ break; ++ case HCI_BT_REGISTER_VALUE_NOTIFY: ++ RTW_INFO("HCI_BT_REGISTER_VALUE_NOTIFY\n"); ++ rtw_btcoex_parse_BT_register_val_notify_cmd(padapter, pcmd, len); ++ break; ++ default: ++ RTW_INFO("ERROR!!! Unknown OCF: %x\n", hci_OCF); ++ break; ++ ++ } ++} ++ ++void rtw_btcoex_parse_hci_cmd(_adapter *padapter, u8 *pcmd, u16 len) ++{ ++ u16 opcode = pcmd[0] | pcmd[1] << 8; ++ u16 hci_OGF = HCI_OGF(opcode); ++ u16 hci_OCF = HCI_OCF(opcode); ++ u8 cmdlen = len - 3; ++ u8 pare_len = pcmd[2]; ++ ++ RTW_INFO("%s OGF: %x,OCF: %x\n", __func__, hci_OGF, hci_OCF); ++ switch (hci_OGF) { ++ case OGF_EXTENSION: ++ RTW_INFO("HCI_EXTENSION_CMD_OGF\n"); ++ rtw_btcoex_parse_hci_extend_cmd(padapter, &pcmd[3], cmdlen, hci_OCF); ++ break; ++ default: ++ RTW_INFO("Other OGF: %x\n", hci_OGF); ++ break; ++ } ++} ++ ++u16 rtw_btcoex_parse_recv_data(u8 *msg, u8 msg_size) ++{ ++ u8 cmp_msg1[32] = attend_ack; ++ u8 cmp_msg2[32] = leave_ack; ++ u8 cmp_msg3[32] = bt_leave; ++ u8 cmp_msg4[32] = invite_req; ++ u8 cmp_msg5[32] = attend_req; ++ u8 cmp_msg6[32] = invite_rsp; ++ u8 res = OTHER; ++ ++ if (_rtw_memcmp(cmp_msg1, msg, msg_size) == _TRUE) { ++ /*RTW_INFO("%s, msg:%s\n",__func__,msg);*/ ++ res = RX_ATTEND_ACK; ++ } else if (_rtw_memcmp(cmp_msg2, msg, msg_size) == _TRUE) { ++ /*RTW_INFO("%s, msg:%s\n",__func__,msg);*/ ++ res = RX_LEAVE_ACK; ++ } else if (_rtw_memcmp(cmp_msg3, msg, msg_size) == _TRUE) { ++ /*RTW_INFO("%s, msg:%s\n",__func__,msg);*/ ++ res = RX_BT_LEAVE; ++ } else if (_rtw_memcmp(cmp_msg4, msg, msg_size) == _TRUE) { ++ /*RTW_INFO("%s, msg:%s\n",__func__,msg);*/ ++ res = RX_INVITE_REQ; ++ } else if (_rtw_memcmp(cmp_msg5, msg, msg_size) == _TRUE) ++ res = RX_ATTEND_REQ; ++ else if (_rtw_memcmp(cmp_msg6, msg, msg_size) == _TRUE) ++ res = RX_INVITE_RSP; ++ else { ++ /*RTW_INFO("%s, %s\n", __func__, msg);*/ ++ res = OTHER; ++ } ++ ++ /*RTW_INFO("%s, res:%d\n", __func__, res);*/ ++ ++ return res; ++} ++ ++void rtw_btcoex_recvmsgbysocket(void *data) ++{ ++ u8 recv_data[255]; ++ u8 tx_msg[255] = leave_ack; ++ u32 len = 0; ++ u16 recv_length = 0; ++ u16 parse_res = 0; ++#if 0 ++ u8 para_len = 0, polling_enable = 0, poling_interval = 0, reason = 0, btinfo_len = 0; ++ u8 btinfo[BT_INFO_LEN] = {0}; ++#endif ++ ++ struct bt_coex_info *pcoex_info = NULL; ++ struct sock *sk = NULL; ++ struct sk_buff *skb = NULL; ++ ++ /*RTW_INFO("%s\n",__func__);*/ ++ ++ if (pbtcoexadapter == NULL) { ++ RTW_INFO("%s: btcoexadapter NULL!\n", __func__); ++ return; ++ } ++ ++ pcoex_info = &pbtcoexadapter->coex_info; ++ sk = pcoex_info->sk_store; ++ ++ if (sk == NULL) { ++ RTW_INFO("%s: critical error when receive socket data!\n", __func__); ++ return; ++ } ++ ++ len = skb_queue_len(&sk->sk_receive_queue); ++ while (len > 0) { ++ skb = skb_dequeue(&sk->sk_receive_queue); ++ ++ /*important: cut the udp header from skb->data! header length is 8 byte*/ ++ recv_length = skb->len - 8; ++ _rtw_memset(recv_data, 0, sizeof(recv_data)); ++ _rtw_memcpy(recv_data, skb->data + 8, recv_length); ++ ++ parse_res = rtw_btcoex_parse_recv_data(recv_data, recv_length); ++#if 0 ++ if (RX_ATTEND_ACK == parse_res) { ++ /* attend ack */ ++ pcoex_info->BT_attend = _TRUE; ++ RTW_INFO("RX_ATTEND_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); ++ } else if (RX_ATTEND_REQ == parse_res) { ++ /* attend req from BT */ ++ pcoex_info->BT_attend = _TRUE; ++ RTW_INFO("RX_BT_ATTEND_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); ++ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, attend_ack, sizeof(attend_ack), _FALSE); ++ } else if (RX_INVITE_REQ == parse_res) { ++ /* invite req from BT */ ++ pcoex_info->BT_attend = _TRUE; ++ RTW_INFO("RX_INVITE_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); ++ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, invite_rsp, sizeof(invite_rsp), _FALSE); ++ } else if (RX_INVITE_RSP == parse_res) { ++ /* invite rsp */ ++ pcoex_info->BT_attend = _TRUE; ++ RTW_INFO("RX_INVITE_RSP!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); ++ } else if (RX_LEAVE_ACK == parse_res) { ++ /* mean BT know wifi will leave */ ++ pcoex_info->BT_attend = _FALSE; ++ RTW_INFO("RX_LEAVE_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); ++ } else if (RX_BT_LEAVE == parse_res) { ++ /* BT leave */ ++ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, leave_ack, sizeof(leave_ack), _FALSE); /* no ack */ ++ pcoex_info->BT_attend = _FALSE; ++ RTW_INFO("RX_BT_LEAVE!sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); ++ } else { ++ /* todo: check if recv data are really hci cmds */ ++ if (_TRUE == pcoex_info->BT_attend) ++ rtw_btcoex_parse_hci_cmd(pbtcoexadapter, recv_data, recv_length); ++ } ++#endif ++ switch (parse_res) { ++ case RX_ATTEND_ACK: ++ /* attend ack */ ++ pcoex_info->BT_attend = _TRUE; ++ RTW_INFO("RX_ATTEND_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); ++ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); ++ break; ++ ++ case RX_ATTEND_REQ: ++ pcoex_info->BT_attend = _TRUE; ++ RTW_INFO("RX_BT_ATTEND_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); ++ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, attend_ack, sizeof(attend_ack), _FALSE); ++ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); ++ break; ++ ++ case RX_INVITE_REQ: ++ /* invite req from BT */ ++ pcoex_info->BT_attend = _TRUE; ++ RTW_INFO("RX_INVITE_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); ++ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, invite_rsp, sizeof(invite_rsp), _FALSE); ++ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); ++ break; ++ ++ case RX_INVITE_RSP: ++ /*invite rsp*/ ++ pcoex_info->BT_attend = _TRUE; ++ RTW_INFO("RX_INVITE_RSP!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); ++ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); ++ break; ++ ++ case RX_LEAVE_ACK: ++ /* mean BT know wifi will leave */ ++ pcoex_info->BT_attend = _FALSE; ++ RTW_INFO("RX_LEAVE_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); ++ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); ++ break; ++ ++ case RX_BT_LEAVE: ++ /* BT leave */ ++ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, leave_ack, sizeof(leave_ack), _FALSE); /* no ack */ ++ pcoex_info->BT_attend = _FALSE; ++ RTW_INFO("RX_BT_LEAVE!sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); ++ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); ++ break; ++ ++ default: ++ if (_TRUE == pcoex_info->BT_attend) ++ rtw_btcoex_parse_hci_cmd(pbtcoexadapter, recv_data, recv_length); ++ else ++ RTW_INFO("ERROR!! BT is UP\n"); ++ break; ++ ++ } ++ ++ len--; ++ kfree_skb(skb); ++ } ++} ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0)) ++ void rtw_btcoex_recvmsg_init(struct sock *sk_in, s32 bytes) ++#else ++ void rtw_btcoex_recvmsg_init(struct sock *sk_in) ++#endif ++{ ++ struct bt_coex_info *pcoex_info = NULL; ++ ++ if (pbtcoexadapter == NULL) { ++ RTW_INFO("%s: btcoexadapter NULL\n", __func__); ++ return; ++ } ++ pcoex_info = &pbtcoexadapter->coex_info; ++ pcoex_info->sk_store = sk_in; ++ if (pcoex_info->btcoex_wq != NULL) ++ queue_delayed_work(pcoex_info->btcoex_wq, &pcoex_info->recvmsg_work, 0); ++ else ++ RTW_INFO("%s: BTCOEX workqueue NULL\n", __func__); ++} ++ ++u8 rtw_btcoex_sendmsgbysocket(_adapter *padapter, u8 *msg, u8 msg_size, bool force) ++{ ++ u8 error; ++ struct msghdr udpmsg; ++ mm_segment_t oldfs; ++ struct iovec iov; ++ struct bt_coex_info *pcoex_info = &padapter->coex_info; ++ ++ /* RTW_INFO("%s: msg:%s, force:%s\n", __func__, msg, force == _TRUE?"TRUE":"FALSE"); */ ++ if (_FALSE == force) { ++ if (_FALSE == pcoex_info->BT_attend) { ++ RTW_INFO("TX Blocked: WiFi-BT disconnected\n"); ++ return _FAIL; ++ } ++ } ++ ++ iov.iov_base = (void *)msg; ++ iov.iov_len = msg_size; ++ udpmsg.msg_name = &pcoex_info->bt_sockaddr; ++ udpmsg.msg_namelen = sizeof(struct sockaddr_in); ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) ++ /* referece:sock_xmit in kernel code ++ * WRITE for sock_sendmsg, READ for sock_recvmsg ++ * third parameter for msg_iovlen ++ * last parameter for iov_len ++ */ ++ iov_iter_init(&udpmsg.msg_iter, WRITE, &iov, 1, msg_size); ++#else ++ udpmsg.msg_iov = &iov; ++ udpmsg.msg_iovlen = 1; ++#endif ++ udpmsg.msg_control = NULL; ++ udpmsg.msg_controllen = 0; ++ udpmsg.msg_flags = MSG_DONTWAIT | MSG_NOSIGNAL; ++ oldfs = get_fs(); ++ set_fs(KERNEL_DS); ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) ++ error = sock_sendmsg(pcoex_info->udpsock, &udpmsg); ++#else ++ error = sock_sendmsg(pcoex_info->udpsock, &udpmsg, msg_size); ++#endif ++ set_fs(oldfs); ++ if (error < 0) { ++ RTW_INFO("Error when sendimg msg, error:%d\n", error); ++ return _FAIL; ++ } else ++ return _SUCCESS; ++} ++ ++u8 rtw_btcoex_create_kernel_socket(_adapter *padapter) ++{ ++ s8 kernel_socket_err; ++ u8 tx_msg[255] = attend_req; ++ struct bt_coex_info *pcoex_info = &padapter->coex_info; ++ s32 sock_reuse = 1; ++ u8 status = _FAIL; ++ ++ RTW_INFO("%s CONNECT_PORT %d\n", __func__, CONNECT_PORT); ++ ++ if (NULL == pcoex_info) { ++ RTW_INFO("coex_info: NULL\n"); ++ status = _FAIL; ++ } ++ ++ kernel_socket_err = sock_create(PF_INET, SOCK_DGRAM, 0, &pcoex_info->udpsock); ++ ++ if (kernel_socket_err < 0) { ++ RTW_INFO("Error during creation of socket error:%d\n", kernel_socket_err); ++ status = _FAIL; ++ } else { ++ _rtw_memset(&(pcoex_info->wifi_sockaddr), 0, sizeof(pcoex_info->wifi_sockaddr)); ++ pcoex_info->wifi_sockaddr.sin_family = AF_INET; ++ pcoex_info->wifi_sockaddr.sin_port = htons(CONNECT_PORT); ++ pcoex_info->wifi_sockaddr.sin_addr.s_addr = htonl(INADDR_LOOPBACK); ++ ++ _rtw_memset(&(pcoex_info->bt_sockaddr), 0, sizeof(pcoex_info->bt_sockaddr)); ++ pcoex_info->bt_sockaddr.sin_family = AF_INET; ++ pcoex_info->bt_sockaddr.sin_port = htons(CONNECT_PORT_BT); ++ pcoex_info->bt_sockaddr.sin_addr.s_addr = htonl(INADDR_LOOPBACK); ++ ++ pcoex_info->sk_store = NULL; ++ kernel_socket_err = pcoex_info->udpsock->ops->bind(pcoex_info->udpsock, (struct sockaddr *)&pcoex_info->wifi_sockaddr, ++ sizeof(pcoex_info->wifi_sockaddr)); ++ if (kernel_socket_err == 0) { ++ RTW_INFO("binding socket success\n"); ++ pcoex_info->udpsock->sk->sk_data_ready = rtw_btcoex_recvmsg_init; ++ pcoex_info->sock_open |= KERNEL_SOCKET_OK; ++ pcoex_info->BT_attend = _FALSE; ++ RTW_INFO("WIFI sending attend_req\n"); ++ rtw_btcoex_sendmsgbysocket(padapter, attend_req, sizeof(attend_req), _TRUE); ++ status = _SUCCESS; ++ } else { ++ pcoex_info->BT_attend = _FALSE; ++ sock_release(pcoex_info->udpsock); /* bind fail release socket */ ++ RTW_INFO("Error binding socket: %d\n", kernel_socket_err); ++ status = _FAIL; ++ } ++ ++ } ++ ++ return status; ++} ++ ++void rtw_btcoex_close_kernel_socket(_adapter *padapter) ++{ ++ struct bt_coex_info *pcoex_info = &padapter->coex_info; ++ if (pcoex_info->sock_open & KERNEL_SOCKET_OK) { ++ RTW_INFO("release kernel socket\n"); ++ sock_release(pcoex_info->udpsock); ++ pcoex_info->sock_open &= ~(KERNEL_SOCKET_OK); ++ if (_TRUE == pcoex_info->BT_attend) ++ pcoex_info->BT_attend = _FALSE; ++ ++ RTW_INFO("sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); ++ } ++} ++ ++void rtw_btcoex_init_socket(_adapter *padapter) ++{ ++ ++ u8 is_invite = _FALSE; ++ struct bt_coex_info *pcoex_info = &padapter->coex_info; ++ RTW_INFO("%s\n", __func__); ++ if (_FALSE == pcoex_info->is_exist) { ++ _rtw_memset(pcoex_info, 0, sizeof(struct bt_coex_info)); ++ pcoex_info->btcoex_wq = create_workqueue("BTCOEX"); ++ INIT_DELAYED_WORK(&pcoex_info->recvmsg_work, ++ (void *)rtw_btcoex_recvmsgbysocket); ++ pbtcoexadapter = padapter; ++ /* We expect BT is off if BT don't send ack to wifi */ ++ RTW_INFO("We expect BT is off if BT send ack to wifi\n"); ++ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, _FALSE); ++ if (rtw_btcoex_create_kernel_socket(padapter) == _SUCCESS) ++ pcoex_info->is_exist = _TRUE; ++ else { ++ pcoex_info->is_exist = _FALSE; ++ pbtcoexadapter = NULL; ++ } ++ ++ RTW_INFO("%s: pbtcoexadapter:%p, coex_info->is_exist: %s\n" ++ , __func__, pbtcoexadapter, pcoex_info->is_exist == _TRUE ? "TRUE" : "FALSE"); ++ } ++} ++ ++void rtw_btcoex_close_socket(_adapter *padapter) ++{ ++ struct bt_coex_info *pcoex_info = &padapter->coex_info; ++ ++ RTW_INFO("%s--coex_info->is_exist: %s, pcoex_info->BT_attend:%s\n" ++ , __func__, pcoex_info->is_exist == _TRUE ? "TRUE" : "FALSE", pcoex_info->BT_attend == _TRUE ? "TRUE" : "FALSE"); ++ ++ if (_TRUE == pcoex_info->is_exist) { ++ if (_TRUE == pcoex_info->BT_attend) { ++ /*inform BT wifi leave*/ ++ rtw_btcoex_sendmsgbysocket(padapter, wifi_leave, sizeof(wifi_leave), _FALSE); ++ msleep(50); ++ } ++ ++ if (pcoex_info->btcoex_wq != NULL) { ++ flush_workqueue(pcoex_info->btcoex_wq); ++ destroy_workqueue(pcoex_info->btcoex_wq); ++ } ++ ++ rtw_btcoex_close_kernel_socket(padapter); ++ pbtcoexadapter = NULL; ++ pcoex_info->is_exist = _FALSE; ++ } ++} ++ ++void rtw_btcoex_dump_tx_msg(u8 *tx_msg, u8 len, u8 *msg_name) ++{ ++ u8 i = 0; ++ RTW_INFO("======> Msg name: %s\n", msg_name); ++ for (i = 0; i < len; i++) ++ printk("%02x ", tx_msg[i]); ++ printk("\n"); ++ RTW_INFO("Msg name: %s <======\n", msg_name); ++} ++ ++/* Porting from Windows team */ ++void rtw_btcoex_SendEventExtBtCoexControl(PADAPTER padapter, u8 bNeedDbgRsp, u8 dataLen, void *pData) ++{ ++ u8 len = 0, tx_event_length = 0; ++ u8 localBuf[32] = ""; ++ u8 *pRetPar; ++ u8 opCode = 0; ++ u8 *pInBuf = (pu1Byte)pData; ++ u8 *pOpCodeContent; ++ rtw_HCI_event *pEvent; ++ ++ opCode = pInBuf[0]; ++ ++ RTW_INFO("%s, OPCode:%02x\n", __func__, opCode); ++ ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ /* len += bthci_ExtensionEventHeaderRtk(&localBuf[0], */ ++ /* HCI_EVENT_EXT_BT_COEX_CONTROL); */ ++ pEvent->EventCode = HCI_EVENT_EXTENSION_RTK; ++ pEvent->Data[0] = HCI_EVENT_EXT_BT_COEX_CONTROL; /* extension event code */ ++ len++; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ _rtw_memcpy(&pRetPar[0], pData, dataLen); ++ ++ len += dataLen; ++ ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++#if 0 ++ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, "BT COEX CONTROL", _FALSE); ++#endif ++ rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ ++} ++ ++/* Porting from Windows team */ ++void rtw_btcoex_SendEventExtBtInfoControl(PADAPTER padapter, u8 dataLen, void *pData) ++{ ++ rtw_HCI_event *pEvent; ++ u8 *pRetPar; ++ u8 len = 0, tx_event_length = 0; ++ u8 localBuf[32] = ""; ++ ++ struct bt_coex_info *pcoex_info = &padapter->coex_info; ++ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; ++ ++ /* RTW_INFO("%s\n",__func__);*/ ++ if (pBtMgnt->ExtConfig.HCIExtensionVer < 4) { /* not support */ ++ RTW_INFO("ERROR: HCIExtensionVer = %d, HCIExtensionVer<4 !!!!\n", pBtMgnt->ExtConfig.HCIExtensionVer); ++ return; ++ } ++ ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ /* len += bthci_ExtensionEventHeaderRtk(&localBuf[0], */ ++ /* HCI_EVENT_EXT_BT_INFO_CONTROL); */ ++ pEvent->EventCode = HCI_EVENT_EXTENSION_RTK; ++ pEvent->Data[0] = HCI_EVENT_EXT_BT_INFO_CONTROL; /* extension event code */ ++ len++; ++ ++ /* Return parameters starts from here */ ++ pRetPar = &pEvent->Data[len]; ++ _rtw_memcpy(&pRetPar[0], pData, dataLen); ++ ++ len += dataLen; ++ ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++#if 0 ++ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, "BT INFO CONTROL"); ++#endif ++ rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++ ++} ++ ++void rtw_btcoex_SendScanNotify(PADAPTER padapter, u8 scanType) ++{ ++ u8 len = 0, tx_event_length = 0; ++ u8 localBuf[7] = ""; ++ u8 *pRetPar; ++ u8 *pu1Temp; ++ rtw_HCI_event *pEvent; ++ struct bt_coex_info *pcoex_info = &padapter->coex_info; ++ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; ++ ++ /* if(!pBtMgnt->BtOperationOn) ++ * return; */ ++ ++ pEvent = (rtw_HCI_event *)(&localBuf[0]); ++ ++ /* len += bthci_ExtensionEventHeaderRtk(&localBuf[0], ++ * HCI_EVENT_EXT_WIFI_SCAN_NOTIFY); */ ++ ++ pEvent->EventCode = HCI_EVENT_EXTENSION_RTK; ++ pEvent->Data[0] = HCI_EVENT_EXT_WIFI_SCAN_NOTIFY; /* extension event code */ ++ len++; ++ ++ /* Return parameters starts from here */ ++ /* pRetPar = &PPacketIrpEvent->Data[len]; */ ++ /* pu1Temp = (u8 *)&pRetPar[0]; */ ++ /* *pu1Temp = scanType; */ ++ pEvent->Data[len] = scanType; ++ len += 1; ++ ++ pEvent->Length = len; ++ ++ /* total tx event length + EventCode length + sizeof(length) */ ++ tx_event_length = pEvent->Length + 2; ++#if 0 ++ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, "WIFI SCAN OPERATION"); ++#endif ++ rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); ++} ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++#endif /* CONFIG_BT_COEXIST */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_bt_mp.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_bt_mp.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_bt_mp.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_bt_mp.c 2018-02-11 21:44:27.135145903 +0200 +@@ -0,0 +1,1580 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ ++#include ++#include ++ ++#if defined(CONFIG_RTL8723B) ++ #include ++#endif ++ ++#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8821A) ++void MPh2c_timeout_handle(void *FunctionContext) ++{ ++ PADAPTER pAdapter; ++ PMPT_CONTEXT pMptCtx; ++ ++ ++ RTW_INFO("[MPT], MPh2c_timeout_handle\n"); ++ ++ pAdapter = (PADAPTER)FunctionContext; ++ pMptCtx = &pAdapter->mppriv.MptCtx; ++ ++ pMptCtx->bMPh2c_timeout = _TRUE; ++ ++ if ((_FALSE == pMptCtx->MptH2cRspEvent) ++ || ((_TRUE == pMptCtx->MptH2cRspEvent) ++ && (_FALSE == pMptCtx->MptBtC2hEvent))) ++ _rtw_up_sema(&pMptCtx->MPh2c_Sema); ++} ++ ++u32 WaitC2Hevent(PADAPTER pAdapter, u8 *C2H_event, u32 delay_time) ++{ ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ pMptCtx->bMPh2c_timeout = _FALSE; ++ ++ if (pAdapter->registrypriv.mp_mode == 0) { ++ RTW_INFO("[MPT], Error!! WaitC2Hevent mp_mode == 0!!\n"); ++ return _FALSE; ++ } ++ ++ _set_timer(&pMptCtx->MPh2c_timeout_timer, delay_time); ++ ++ _rtw_down_sema(&pMptCtx->MPh2c_Sema); ++ ++ if (pMptCtx->bMPh2c_timeout == _TRUE) { ++ *C2H_event = _FALSE; ++ ++ return _FALSE; ++ } ++ ++ /* for safty, cancel timer here again */ ++ _cancel_timer_ex(&pMptCtx->MPh2c_timeout_timer); ++ ++ return _TRUE; ++} ++ ++BT_CTRL_STATUS ++mptbt_CheckC2hFrame( ++ PADAPTER Adapter, ++ PBT_H2C pH2c, ++ PBT_EXT_C2H pExtC2h ++) ++{ ++ BT_CTRL_STATUS c2hStatus = BT_STATUS_C2H_SUCCESS; ++ ++ /* RTW_INFO("[MPT], MPT rsp C2H hex: %x %x %x %x %x %x\n"), pExtC2h , pExtC2h+1 ,pExtC2h+2 ,pExtC2h+3 ,pExtC2h+4 ,pExtC2h+5); */ ++ ++ RTW_INFO("[MPT], statusCode = 0x%x\n", pExtC2h->statusCode); ++ RTW_INFO("[MPT], retLen = %d\n", pExtC2h->retLen); ++ RTW_INFO("[MPT], opCodeVer : req/rsp=%d/%d\n", pH2c->opCodeVer, pExtC2h->opCodeVer); ++ RTW_INFO("[MPT], reqNum : req/rsp=%d/%d\n", pH2c->reqNum, pExtC2h->reqNum); ++ if (pExtC2h->reqNum != pH2c->reqNum) { ++ c2hStatus = BT_STATUS_C2H_REQNUM_MISMATCH; ++ RTW_INFO("[MPT], Error!! C2H reqNum Mismatch!!\n"); ++ } else if (pExtC2h->opCodeVer != pH2c->opCodeVer) { ++ c2hStatus = BT_STATUS_OPCODE_L_VERSION_MISMATCH; ++ RTW_INFO("[MPT], Error!! OPCode version L mismatch!!\n"); ++ } ++ ++ return c2hStatus; ++} ++ ++BT_CTRL_STATUS ++mptbt_SendH2c( ++ PADAPTER Adapter, ++ PBT_H2C pH2c, ++ u2Byte h2cCmdLen ++) ++{ ++ /* KIRQL OldIrql = KeGetCurrentIrql(); */ ++ BT_CTRL_STATUS h2cStatus = BT_STATUS_H2C_SUCCESS; ++ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); ++ u1Byte i; ++ ++ RTW_INFO("[MPT], mptbt_SendH2c()=========>\n"); ++ ++ /* PlatformResetEvent(&pMptCtx->MptH2cRspEvent); */ ++ /* PlatformResetEvent(&pMptCtx->MptBtC2hEvent); */ ++ ++ /* if(OldIrql == PASSIVE_LEVEL) ++ * { */ ++ /* RTPRINT_DATA(FMPBT, FMPBT_H2C_CONTENT, ("[MPT], MPT H2C hex:\n"), pH2c, h2cCmdLen); */ ++ ++ for (i = 0; i < BT_H2C_MAX_RETRY; i++) { ++ RTW_INFO("[MPT], Send H2C command to wifi!!!\n"); ++ ++ pMptCtx->MptH2cRspEvent = _FALSE; ++ pMptCtx->MptBtC2hEvent = _FALSE; ++ ++#if defined(CONFIG_RTL8723B) ++ rtl8723b_set_FwBtMpOper_cmd(Adapter, pH2c->opCode, pH2c->opCodeVer, pH2c->reqNum, pH2c->buf); ++#endif ++ pMptCtx->h2cReqNum++; ++ pMptCtx->h2cReqNum %= 16; ++ ++ if (WaitC2Hevent(Adapter, &pMptCtx->MptH2cRspEvent, 100)) { ++ RTW_INFO("[MPT], Received WiFi MptH2cRspEvent!!!\n"); ++ if (WaitC2Hevent(Adapter, &pMptCtx->MptBtC2hEvent, 400)) { ++ RTW_INFO("[MPT], Received MptBtC2hEvent!!!\n"); ++ break; ++ } else { ++ RTW_INFO("[MPT], Error!!BT MptBtC2hEvent timeout!!\n"); ++ h2cStatus = BT_STATUS_H2C_BT_NO_RSP; ++ } ++ } else { ++ RTW_INFO("[MPT], Error!!WiFi MptH2cRspEvent timeout!!\n"); ++ h2cStatus = BT_STATUS_H2C_TIMTOUT; ++ } ++ } ++ /* } ++ * else ++ * { ++ * RT_ASSERT(FALSE, ("[MPT], mptbt_SendH2c() can only run under PASSIVE_LEVEL!!\n")); ++ * h2cStatus = BT_STATUS_WRONG_LEVEL; ++ * } */ ++ ++ RTW_INFO("[MPT], mptbt_SendH2c()<=========\n"); ++ return h2cStatus; ++} ++ ++ ++ ++BT_CTRL_STATUS ++mptbt_CheckBtRspStatus( ++ PADAPTER Adapter, ++ PBT_EXT_C2H pExtC2h ++) ++{ ++ BT_CTRL_STATUS retStatus = BT_OP_STATUS_SUCCESS; ++ ++ switch (pExtC2h->statusCode) { ++ case BT_OP_STATUS_SUCCESS: ++ retStatus = BT_STATUS_BT_OP_SUCCESS; ++ RTW_INFO("[MPT], BT status : BT_STATUS_SUCCESS\n"); ++ break; ++ case BT_OP_STATUS_VERSION_MISMATCH: ++ retStatus = BT_STATUS_OPCODE_L_VERSION_MISMATCH; ++ RTW_INFO("[MPT], BT status : BT_STATUS_OPCODE_L_VERSION_MISMATCH\n"); ++ break; ++ case BT_OP_STATUS_UNKNOWN_OPCODE: ++ retStatus = BT_STATUS_UNKNOWN_OPCODE_L; ++ RTW_INFO("[MPT], BT status : BT_STATUS_UNKNOWN_OPCODE_L\n"); ++ break; ++ case BT_OP_STATUS_ERROR_PARAMETER: ++ retStatus = BT_STATUS_PARAMETER_FORMAT_ERROR_L; ++ RTW_INFO("[MPT], BT status : BT_STATUS_PARAMETER_FORMAT_ERROR_L\n"); ++ break; ++ default: ++ retStatus = BT_STATUS_UNKNOWN_STATUS_L; ++ RTW_INFO("[MPT], BT status : BT_STATUS_UNKNOWN_STATUS_L\n"); ++ break; ++ } ++ ++ return retStatus; ++} ++ ++ ++ ++BT_CTRL_STATUS ++mptbt_BtFwOpCodeProcess( ++ PADAPTER Adapter, ++ u1Byte btFwOpCode, ++ u1Byte opCodeVer, ++ pu1Byte pH2cPar, ++ u1Byte h2cParaLen ++) ++{ ++ u1Byte H2C_Parameter[6] = {0}; ++ PBT_H2C pH2c = (PBT_H2C)&H2C_Parameter[0]; ++ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); ++ PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; ++ u2Byte paraLen = 0, i; ++ BT_CTRL_STATUS h2cStatus = BT_STATUS_H2C_SUCCESS, c2hStatus = BT_STATUS_C2H_SUCCESS; ++ BT_CTRL_STATUS retStatus = BT_STATUS_H2C_BT_NO_RSP; ++ ++ if (Adapter->registrypriv.mp_mode == 0) { ++ RTW_INFO("[MPT], Error!! mptbt_BtFwOpCodeProces mp_mode == 0!!\n"); ++ return _FALSE; ++ } ++ ++ pH2c->opCode = btFwOpCode; ++ pH2c->opCodeVer = opCodeVer; ++ pH2c->reqNum = pMptCtx->h2cReqNum; ++ /* PlatformMoveMemory(&pH2c->buf[0], pH2cPar, h2cParaLen); */ ++ /* _rtw_memcpy(&pH2c->buf[0], pH2cPar, h2cParaLen); */ ++ _rtw_memcpy(pH2c->buf, pH2cPar, h2cParaLen); ++ ++ RTW_INFO("[MPT], pH2c->opCode=%d\n", pH2c->opCode); ++ RTW_INFO("[MPT], pH2c->opCodeVer=%d\n", pH2c->opCodeVer); ++ RTW_INFO("[MPT], pH2c->reqNum=%d\n", pH2c->reqNum); ++ RTW_INFO("[MPT], h2c parameter length=%d\n", h2cParaLen); ++ for (i = 0; i < h2cParaLen; i++) ++ RTW_INFO("[MPT], parameter[%d]=0x%02x\n", i, pH2c->buf[i]); ++ ++ h2cStatus = mptbt_SendH2c(Adapter, pH2c, h2cParaLen + 2); ++ if (BT_STATUS_H2C_SUCCESS == h2cStatus) { ++ /* if reach here, it means H2C get the correct c2h response, */ ++ c2hStatus = mptbt_CheckC2hFrame(Adapter, pH2c, pExtC2h); ++ if (BT_STATUS_C2H_SUCCESS == c2hStatus) ++ retStatus = mptbt_CheckBtRspStatus(Adapter, pExtC2h); ++ else { ++ RTW_INFO("[MPT], Error!! C2H failed for pH2c->opCode=%d\n", pH2c->opCode); ++ /* check c2h status error, return error status code to upper layer. */ ++ retStatus = c2hStatus; ++ } ++ } else { ++ RTW_INFO("[MPT], Error!! H2C failed for pH2c->opCode=%d\n", pH2c->opCode); ++ /* check h2c status error, return error status code to upper layer. */ ++ retStatus = h2cStatus; ++ } ++ ++ return retStatus; ++} ++ ++ ++ ++ ++u2Byte ++mptbt_BtReady( ++ PADAPTER Adapter, ++ PBT_REQ_CMD pBtReq, ++ PBT_RSP_CMD pBtRsp ++) ++{ ++ u1Byte h2cParaBuf[6] = {0}; ++ u1Byte h2cParaLen = 0; ++ u2Byte paraLen = 0; ++ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; ++ u1Byte btOpcode; ++ u1Byte btOpcodeVer = 0; ++ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); ++ PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; ++ u1Byte i; ++ u1Byte btFwVer = 0, bdAddr[6] = {0}; ++ u2Byte btRealFwVer = 0; ++ pu2Byte pu2Tmp = NULL; ++ ++ /* */ ++ /* check upper layer parameters */ ++ /* */ ++ ++ /* 1. check upper layer opcode version */ ++ if (pBtReq->opCodeVer != 1) { ++ RTW_INFO("[MPT], Error!! Upper OP code version not match!!!\n"); ++ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; ++ return paraLen; ++ } ++ ++ pBtRsp->pParamStart[0] = MP_BT_NOT_READY; ++ paraLen = 10; ++ /* */ ++ /* execute lower layer opcodes */ ++ /* */ ++ ++ /* Get BT FW version */ ++ /* fill h2c parameters */ ++ btOpcode = BT_LO_OP_GET_BT_VERSION; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } else { ++ pu2Tmp = (pu2Byte)&pExtC2h->buf[0]; ++ btRealFwVer = *pu2Tmp; ++ btFwVer = pExtC2h->buf[1]; ++ RTW_INFO("[MPT], btRealFwVer=0x%x, btFwVer=0x%x\n", btRealFwVer, btFwVer); ++ } ++ ++ /* Get BD Address */ ++ /* fill h2c parameters */ ++ btOpcode = BT_LO_OP_GET_BD_ADDR_L; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } else { ++ bdAddr[5] = pExtC2h->buf[0]; ++ bdAddr[4] = pExtC2h->buf[1]; ++ bdAddr[3] = pExtC2h->buf[2]; ++ } ++ ++ /* fill h2c parameters */ ++ btOpcode = BT_LO_OP_GET_BD_ADDR_H; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } else { ++ bdAddr[2] = pExtC2h->buf[0]; ++ bdAddr[1] = pExtC2h->buf[1]; ++ bdAddr[0] = pExtC2h->buf[2]; ++ } ++ RTW_INFO("[MPT], Local BDAddr:"); ++ for (i = 0; i < 6; i++) ++ RTW_INFO(" 0x%x ", bdAddr[i]); ++ pBtRsp->status = BT_STATUS_SUCCESS; ++ pBtRsp->pParamStart[0] = MP_BT_READY; ++ pu2Tmp = (pu2Byte)&pBtRsp->pParamStart[1]; ++ *pu2Tmp = btRealFwVer; ++ pBtRsp->pParamStart[3] = btFwVer; ++ for (i = 0; i < 6; i++) ++ pBtRsp->pParamStart[4 + i] = bdAddr[5 - i]; ++ ++ return paraLen; ++} ++ ++void mptbt_close_WiFiRF(PADAPTER Adapter) ++{ ++ PHY_SetBBReg(Adapter, 0x824, 0xF, 0x0); ++ PHY_SetBBReg(Adapter, 0x824, 0x700000, 0x0); ++ PHY_SetRFReg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x0); ++} ++ ++void mptbt_open_WiFiRF(PADAPTER Adapter) ++{ ++ PHY_SetBBReg(Adapter, 0x824, 0x700000, 0x3); ++ PHY_SetBBReg(Adapter, 0x824, 0xF, 0x2); ++ PHY_SetRFReg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x3); ++} ++ ++u4Byte mptbt_switch_RF(PADAPTER Adapter, u1Byte Enter) ++{ ++ u2Byte tmp_2byte = 0; ++ ++ /* Enter test mode */ ++ if (Enter) { ++ /* 1>. close WiFi RF */ ++ mptbt_close_WiFiRF(Adapter); ++ ++ /* 2>. change ant switch to BT */ ++ tmp_2byte = rtw_read16(Adapter, 0x860); ++ tmp_2byte = tmp_2byte | BIT(9); ++ tmp_2byte = tmp_2byte & (~BIT(8)); ++ rtw_write16(Adapter, 0x860, tmp_2byte); ++ rtw_write16(Adapter, 0x870, 0x300); ++ } else { ++ /* 1>. Open WiFi RF */ ++ mptbt_open_WiFiRF(Adapter); ++ ++ /* 2>. change ant switch back */ ++ tmp_2byte = rtw_read16(Adapter, 0x860); ++ tmp_2byte = tmp_2byte | BIT(8); ++ tmp_2byte = tmp_2byte & (~BIT(9)); ++ rtw_write16(Adapter, 0x860, tmp_2byte); ++ rtw_write16(Adapter, 0x870, 0x300); ++ } ++ ++ return 0; ++} ++ ++u2Byte ++mptbt_BtSetMode( ++ PADAPTER Adapter, ++ PBT_REQ_CMD pBtReq, ++ PBT_RSP_CMD pBtRsp ++) ++{ ++ u1Byte h2cParaBuf[6] = {0}; ++ u1Byte h2cParaLen = 0; ++ u2Byte paraLen = 0; ++ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; ++ u1Byte btOpcode; ++ u1Byte btOpcodeVer = 0; ++ u1Byte btModeToSet = 0; ++ ++ /* */ ++ /* check upper layer parameters */ ++ /* */ ++ /* 1. check upper layer opcode version */ ++ if (pBtReq->opCodeVer != 1) { ++ RTW_INFO("[MPT], Error!! Upper OP code version not match!!!\n"); ++ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; ++ return paraLen; ++ } ++ /* 2. check upper layer parameter length */ ++ if (1 == pBtReq->paraLength) { ++ btModeToSet = pBtReq->pParamStart[0]; ++ RTW_INFO("[MPT], BtTestMode=%d\n", btModeToSet); ++ } else { ++ RTW_INFO("[MPT], Error!! wrong parameter length=%d (should be 1)\n", pBtReq->paraLength); ++ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; ++ return paraLen; ++ } ++ ++ /* */ ++ /* execute lower layer opcodes */ ++ /* */ ++ ++ /* 1. fill h2c parameters */ ++ /* check bt mode */ ++ btOpcode = BT_LO_OP_SET_BT_MODE; ++ if (btModeToSet >= MP_BT_MODE_MAX) { ++ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } else { ++ mptbt_switch_RF(Adapter, 1); ++ ++ h2cParaBuf[0] = btModeToSet; ++ h2cParaLen = 1; ++ /* 2. execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ } ++ ++ /* 3. construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS == retStatus) ++ pBtRsp->status = BT_STATUS_SUCCESS; ++ else { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ } ++ ++ return paraLen; ++} ++ ++ ++VOID ++MPTBT_FwC2hBtMpCtrl( ++ PADAPTER Adapter, ++ pu1Byte tmpBuf, ++ u1Byte length ++) ++{ ++ u32 i; ++ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); ++ PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)tmpBuf; ++ ++ if (Adapter->bBTFWReady == _FALSE || Adapter->registrypriv.mp_mode == 0) { ++ /* RTW_INFO("Ignore C2H BT MP Info since not in MP mode\n"); */ ++ return; ++ } ++ if (length > 32 || length < 3) { ++ RTW_INFO("\n [MPT], pExtC2h->buf hex: length=%d > 32 || < 3\n", length); ++ return; ++ } ++ ++ /* cancel_timeout for h2c handle */ ++ _cancel_timer_ex(&pMptCtx->MPh2c_timeout_timer); ++ ++ for (i = 0; i < length; i++) ++ RTW_INFO("[MPT], %s, buf[%d]=0x%02x ", __FUNCTION__, i, tmpBuf[i]); ++ RTW_INFO("[MPT], pExtC2h->extendId=0x%x\n", pExtC2h->extendId); ++ ++ switch (pExtC2h->extendId) { ++ case EXT_C2H_WIFI_FW_ACTIVE_RSP: ++ RTW_INFO("[MPT], EXT_C2H_WIFI_FW_ACTIVE_RSP\n"); ++#if 0 ++ RTW_INFO("[MPT], pExtC2h->buf hex:\n"); ++ for (i = 0; i < (length - 3); i++) ++ RTW_INFO(" 0x%x ", pExtC2h->buf[i]); ++#endif ++ if ((_FALSE == pMptCtx->bMPh2c_timeout) ++ && (_FALSE == pMptCtx->MptH2cRspEvent)) { ++ pMptCtx->MptH2cRspEvent = _TRUE; ++ _rtw_up_sema(&pMptCtx->MPh2c_Sema); ++ } ++ break; ++ ++ case EXT_C2H_TRIG_BY_BT_FW: ++ RTW_INFO("[MPT], EXT_C2H_TRIG_BY_BT_FW\n"); ++ _rtw_memcpy(&pMptCtx->c2hBuf[0], tmpBuf, length); ++ RTW_INFO("[MPT], pExtC2h->statusCode=0x%x\n", pExtC2h->statusCode); ++ RTW_INFO("[MPT], pExtC2h->retLen=0x%x\n", pExtC2h->retLen); ++ RTW_INFO("[MPT], pExtC2h->opCodeVer=0x%x\n", pExtC2h->opCodeVer); ++ RTW_INFO("[MPT], pExtC2h->reqNum=0x%x\n", pExtC2h->reqNum); ++ for (i = 0; i < (length - 3); i++) ++ RTW_INFO("[MPT], pExtC2h->buf[%d]=0x%02x\n", i, pExtC2h->buf[i]); ++ ++ if ((_FALSE == pMptCtx->bMPh2c_timeout) ++ && (_TRUE == pMptCtx->MptH2cRspEvent) ++ && (_FALSE == pMptCtx->MptBtC2hEvent)) { ++ pMptCtx->MptBtC2hEvent = _TRUE; ++ _rtw_up_sema(&pMptCtx->MPh2c_Sema); ++ } ++ break; ++ ++ default: ++ RTW_INFO("[MPT], EXT_C2H Target not found,pExtC2h->extendId =%d ,pExtC2h->reqNum=%d\n", pExtC2h->extendId, pExtC2h->reqNum); ++ break; ++ } ++ ++ ++ ++} ++ ++ ++u2Byte ++mptbt_BtGetGeneral( ++ IN PADAPTER Adapter, ++ IN PBT_REQ_CMD pBtReq, ++ IN PBT_RSP_CMD pBtRsp ++) ++{ ++ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); ++ PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; ++ u1Byte h2cParaBuf[6] = {0}; ++ u1Byte h2cParaLen = 0; ++ u2Byte paraLen = 0; ++ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; ++ u1Byte btOpcode, bdAddr[6] = {0}; ++ u1Byte btOpcodeVer = 0; ++ u1Byte getType = 0, i; ++ u2Byte getParaLen = 0, validParaLen = 0; ++ u1Byte regType = 0, reportType = 0; ++ u4Byte regAddr = 0, regValue = 0; ++ pu4Byte pu4Tmp; ++ pu2Byte pu2Tmp; ++ pu1Byte pu1Tmp; ++ ++ /* */ ++ /* check upper layer parameters */ ++ /* */ ++ ++ /* check upper layer opcode version */ ++ if (pBtReq->opCodeVer != 1) { ++ RTW_INFO("[MPT], Error!! Upper OP code version not match!!!\n"); ++ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; ++ return paraLen; ++ } ++ /* check upper layer parameter length */ ++ if (pBtReq->paraLength < 1) { ++ RTW_INFO("[MPT], Error!! wrong parameter length=%d (should larger than 1)\n", pBtReq->paraLength); ++ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; ++ return paraLen; ++ } ++ getParaLen = pBtReq->paraLength - 1; ++ getType = pBtReq->pParamStart[0]; ++ ++ RTW_INFO("[MPT], getType=%d, getParaLen=%d\n", getType, getParaLen); ++ ++ /* check parameter first */ ++ switch (getType) { ++ case BT_GGET_REG: ++ RTW_INFO("[MPT], [BT_GGET_REG]\n"); ++ validParaLen = 5; ++ if (getParaLen == validParaLen) { ++ btOpcode = BT_LO_OP_READ_REG; ++ regType = pBtReq->pParamStart[1]; ++ pu4Tmp = (pu4Byte)&pBtReq->pParamStart[2]; ++ regAddr = *pu4Tmp; ++ RTW_INFO("[MPT], BT_GGET_REG regType=0x%02x, regAddr=0x%08x!!\n", ++ regType, regAddr); ++ if (regType >= BT_REG_MAX) { ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } else { ++ if (((BT_REG_RF == regType) && (regAddr > 0x7f)) || ++ ((BT_REG_MODEM == regType) && (regAddr > 0x1ff)) || ++ ((BT_REG_BLUEWIZE == regType) && (regAddr > 0xfff)) || ++ ((BT_REG_VENDOR == regType) && (regAddr > 0xfff)) || ++ ((BT_REG_LE == regType) && (regAddr > 0xfff))) { ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } ++ } ++ } ++ break; ++ case BT_GGET_STATUS: ++ RTW_INFO("[MPT], [BT_GGET_STATUS]\n"); ++ validParaLen = 0; ++ break; ++ case BT_GGET_REPORT: ++ RTW_INFO("[MPT], [BT_GGET_REPORT]\n"); ++ validParaLen = 1; ++ if (getParaLen == validParaLen) { ++ reportType = pBtReq->pParamStart[1]; ++ RTW_INFO("[MPT], BT_GGET_REPORT reportType=0x%x!!\n", reportType); ++ if (reportType >= BT_REPORT_MAX) { ++ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } ++ } ++ break; ++ default: { ++ RTW_INFO("[MPT], Error!! getType=%d, out of range\n", getType); ++ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } ++ break; ++ } ++ if (getParaLen != validParaLen) { ++ RTW_INFO("[MPT], Error!! wrong parameter length=%d for BT_GET_GEN_CMD cmd id=0x%x, paraLen should=0x%x\n", ++ getParaLen, getType, validParaLen); ++ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; ++ return paraLen; ++ } ++ ++ /* */ ++ /* execute lower layer opcodes */ ++ /* */ ++ if (BT_GGET_REG == getType) { ++ /* fill h2c parameters */ ++ /* here we should write reg value first then write the address, adviced by Austin */ ++ btOpcode = BT_LO_OP_READ_REG; ++ h2cParaBuf[0] = regType; ++ h2cParaBuf[1] = pBtReq->pParamStart[2]; ++ h2cParaBuf[2] = pBtReq->pParamStart[3]; ++ h2cParaLen = 3; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ pu2Tmp = (pu2Byte)&pExtC2h->buf[0]; ++ regValue = *pu2Tmp; ++ RTW_INFO("[MPT], read reg regType=0x%02x, regAddr=0x%08x, regValue=0x%04x\n", ++ regType, regAddr, regValue); ++ ++ pu4Tmp = (pu4Byte)&pBtRsp->pParamStart[0]; ++ *pu4Tmp = regValue; ++ paraLen = 4; ++ } else if (BT_GGET_STATUS == getType) { ++ btOpcode = BT_LO_OP_GET_BT_STATUS; ++ h2cParaLen = 0; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; ++ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; ++ RTW_INFO("[MPT], read bt status, testMode=0x%x, testStatus=0x%x\n", ++ pBtRsp->pParamStart[0], pBtRsp->pParamStart[1]); ++ paraLen = 2; ++ } else if (BT_GGET_REPORT == getType) { ++ switch (reportType) { ++ case BT_REPORT_RX_PACKET_CNT: { ++ RTW_INFO("[MPT], [Rx Packet Counts]\n"); ++ btOpcode = BT_LO_OP_GET_RX_PKT_CNT_L; ++ h2cParaLen = 0; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; ++ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; ++ ++ btOpcode = BT_LO_OP_GET_RX_PKT_CNT_H; ++ h2cParaLen = 0; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ pBtRsp->pParamStart[2] = pExtC2h->buf[0]; ++ pBtRsp->pParamStart[3] = pExtC2h->buf[1]; ++ paraLen = 4; ++ } ++ break; ++ case BT_REPORT_RX_ERROR_BITS: { ++ RTW_INFO("[MPT], [Rx Error Bits]\n"); ++ btOpcode = BT_LO_OP_GET_RX_ERROR_BITS_L; ++ h2cParaLen = 0; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; ++ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; ++ ++ btOpcode = BT_LO_OP_GET_RX_ERROR_BITS_H; ++ h2cParaLen = 0; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ pBtRsp->pParamStart[2] = pExtC2h->buf[0]; ++ pBtRsp->pParamStart[3] = pExtC2h->buf[1]; ++ paraLen = 4; ++ } ++ break; ++ case BT_REPORT_RSSI: { ++ RTW_INFO("[MPT], [RSSI]\n"); ++ btOpcode = BT_LO_OP_GET_RSSI; ++ h2cParaLen = 0; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; ++ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; ++ paraLen = 2; ++ } ++ break; ++ case BT_REPORT_CFO_HDR_QUALITY: { ++ RTW_INFO("[MPT], [CFO & Header Quality]\n"); ++ btOpcode = BT_LO_OP_GET_CFO_HDR_QUALITY_L; ++ h2cParaLen = 0; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; ++ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; ++ ++ btOpcode = BT_LO_OP_GET_CFO_HDR_QUALITY_H; ++ h2cParaLen = 0; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ pBtRsp->pParamStart[2] = pExtC2h->buf[0]; ++ pBtRsp->pParamStart[3] = pExtC2h->buf[1]; ++ paraLen = 4; ++ } ++ break; ++ case BT_REPORT_CONNECT_TARGET_BD_ADDR: { ++ RTW_INFO("[MPT], [Connected Target BD ADDR]\n"); ++ btOpcode = BT_LO_OP_GET_TARGET_BD_ADDR_L; ++ h2cParaLen = 0; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ bdAddr[5] = pExtC2h->buf[0]; ++ bdAddr[4] = pExtC2h->buf[1]; ++ bdAddr[3] = pExtC2h->buf[2]; ++ ++ btOpcode = BT_LO_OP_GET_TARGET_BD_ADDR_H; ++ h2cParaLen = 0; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ bdAddr[2] = pExtC2h->buf[0]; ++ bdAddr[1] = pExtC2h->buf[1]; ++ bdAddr[0] = pExtC2h->buf[2]; ++ ++ RTW_INFO("[MPT], Connected Target BDAddr:%s", bdAddr); ++ for (i = 0; i < 6; i++) ++ pBtRsp->pParamStart[i] = bdAddr[5 - i]; ++ paraLen = 6; ++ } ++ break; ++ default: ++ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ break; ++ } ++ } ++ ++ pBtRsp->status = BT_STATUS_SUCCESS; ++ return paraLen; ++} ++ ++ ++ ++u2Byte ++mptbt_BtSetGeneral( ++ IN PADAPTER Adapter, ++ IN PBT_REQ_CMD pBtReq, ++ IN PBT_RSP_CMD pBtRsp ++) ++{ ++ u1Byte h2cParaBuf[6] = {0}; ++ u1Byte h2cParaLen = 0; ++ u2Byte paraLen = 0; ++ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; ++ u1Byte btOpcode; ++ u1Byte btOpcodeVer = 0; ++ u1Byte setType = 0; ++ u2Byte setParaLen = 0, validParaLen = 0; ++ u1Byte regType = 0, bdAddr[6] = {0}, calVal = 0; ++ u4Byte regAddr = 0, regValue = 0; ++ pu4Byte pu4Tmp; ++ pu2Byte pu2Tmp; ++ pu1Byte pu1Tmp; ++ ++ /* */ ++ /* check upper layer parameters */ ++ /* */ ++ ++ /* check upper layer opcode version */ ++ if (pBtReq->opCodeVer != 1) { ++ RTW_INFO("[MPT], Error!! Upper OP code version not match!!!\n"); ++ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; ++ return paraLen; ++ } ++ /* check upper layer parameter length */ ++ if (pBtReq->paraLength < 1) { ++ RTW_INFO("[MPT], Error!! wrong parameter length=%d (should larger than 1)\n", pBtReq->paraLength); ++ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; ++ return paraLen; ++ } ++ setParaLen = pBtReq->paraLength - 1; ++ setType = pBtReq->pParamStart[0]; ++ ++ RTW_INFO("[MPT], setType=%d, setParaLen=%d\n", setType, setParaLen); ++ ++ /* check parameter first */ ++ switch (setType) { ++ case BT_GSET_REG: ++ RTW_INFO("[MPT], [BT_GSET_REG]\n"); ++ validParaLen = 9; ++ if (setParaLen == validParaLen) { ++ btOpcode = BT_LO_OP_WRITE_REG_VALUE; ++ regType = pBtReq->pParamStart[1]; ++ pu4Tmp = (pu4Byte)&pBtReq->pParamStart[2]; ++ regAddr = *pu4Tmp; ++ pu4Tmp = (pu4Byte)&pBtReq->pParamStart[6]; ++ regValue = *pu4Tmp; ++ RTW_INFO("[MPT], BT_GSET_REG regType=0x%x, regAddr=0x%x, regValue=0x%x!!\n", ++ regType, regAddr, regValue); ++ if (regType >= BT_REG_MAX) { ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } else { ++ if (((BT_REG_RF == regType) && (regAddr > 0x7f)) || ++ ((BT_REG_MODEM == regType) && (regAddr > 0x1ff)) || ++ ((BT_REG_BLUEWIZE == regType) && (regAddr > 0xfff)) || ++ ((BT_REG_VENDOR == regType) && (regAddr > 0xfff)) || ++ ((BT_REG_LE == regType) && (regAddr > 0xfff))) { ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } ++ } ++ } ++ break; ++ case BT_GSET_RESET: ++ RTW_INFO("[MPT], [BT_GSET_RESET]\n"); ++ validParaLen = 0; ++ break; ++ case BT_GSET_TARGET_BD_ADDR: ++ RTW_INFO("[MPT], [BT_GSET_TARGET_BD_ADDR]\n"); ++ validParaLen = 6; ++ if (setParaLen == validParaLen) { ++ btOpcode = BT_LO_OP_SET_TARGET_BD_ADDR_H; ++ if ((pBtReq->pParamStart[1] == 0) && ++ (pBtReq->pParamStart[2] == 0) && ++ (pBtReq->pParamStart[3] == 0) && ++ (pBtReq->pParamStart[4] == 0) && ++ (pBtReq->pParamStart[5] == 0) && ++ (pBtReq->pParamStart[6] == 0)) { ++ RTW_INFO("[MPT], Error!! targetBDAddr=all zero\n"); ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } ++ if ((pBtReq->pParamStart[1] == 0xff) && ++ (pBtReq->pParamStart[2] == 0xff) && ++ (pBtReq->pParamStart[3] == 0xff) && ++ (pBtReq->pParamStart[4] == 0xff) && ++ (pBtReq->pParamStart[5] == 0xff) && ++ (pBtReq->pParamStart[6] == 0xff)) { ++ RTW_INFO("[MPT], Error!! targetBDAddr=all 0xf\n"); ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } ++ bdAddr[0] = pBtReq->pParamStart[6]; ++ bdAddr[1] = pBtReq->pParamStart[5]; ++ bdAddr[2] = pBtReq->pParamStart[4]; ++ bdAddr[3] = pBtReq->pParamStart[3]; ++ bdAddr[4] = pBtReq->pParamStart[2]; ++ bdAddr[5] = pBtReq->pParamStart[1]; ++ RTW_INFO("[MPT], target BDAddr:%x,%x,%x,%x,%x,%x\n", ++ bdAddr[0], bdAddr[1], bdAddr[2], bdAddr[3], bdAddr[4], bdAddr[5]); ++ } ++ break; ++ case BT_GSET_TX_PWR_FINETUNE: ++ RTW_INFO("[MPT], [BT_GSET_TX_PWR_FINETUNE]\n"); ++ validParaLen = 1; ++ if (setParaLen == validParaLen) { ++ btOpcode = BT_LO_OP_SET_TX_POWER_CALIBRATION; ++ calVal = pBtReq->pParamStart[1]; ++ if ((calVal < 1) || (calVal > 9)) { ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } ++ RTW_INFO("[MPT], calVal=%d\n", calVal); ++ } ++ break; ++ case BT_SET_TRACKING_INTERVAL: ++ RTW_INFO("[MPT], [BT_SET_TRACKING_INTERVAL] setParaLen =%d\n", setParaLen); ++ ++ validParaLen = 1; ++ if (setParaLen == validParaLen) ++ calVal = pBtReq->pParamStart[1]; ++ break; ++ case BT_SET_THERMAL_METER: ++ RTW_INFO("[MPT], [BT_SET_THERMAL_METER] setParaLen =%d\n", setParaLen); ++ validParaLen = 1; ++ if (setParaLen == validParaLen) ++ calVal = pBtReq->pParamStart[1]; ++ break; ++ case BT_ENABLE_CFO_TRACKING: ++ RTW_INFO("[MPT], [BT_ENABLE_CFO_TRACKING] setParaLen =%d\n", setParaLen); ++ validParaLen = 1; ++ if (setParaLen == validParaLen) ++ calVal = pBtReq->pParamStart[1]; ++ break; ++ case BT_GSET_UPDATE_BT_PATCH: ++ ++ break; ++ default: { ++ RTW_INFO("[MPT], Error!! setType=%d, out of range\n", setType); ++ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } ++ break; ++ } ++ if (setParaLen != validParaLen) { ++ RTW_INFO("[MPT], Error!! wrong parameter length=%d for BT_SET_GEN_CMD cmd id=0x%x, paraLen should=0x%x\n", ++ setParaLen, setType, validParaLen); ++ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; ++ return paraLen; ++ } ++ ++ /* */ ++ /* execute lower layer opcodes */ ++ /* */ ++ if (BT_GSET_REG == setType) { ++ /* fill h2c parameters */ ++ /* here we should write reg value first then write the address, adviced by Austin */ ++ btOpcode = BT_LO_OP_WRITE_REG_VALUE; ++ h2cParaBuf[0] = pBtReq->pParamStart[6]; ++ h2cParaBuf[1] = pBtReq->pParamStart[7]; ++ h2cParaBuf[2] = pBtReq->pParamStart[8]; ++ h2cParaLen = 3; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ /* write reg address */ ++ btOpcode = BT_LO_OP_WRITE_REG_ADDR; ++ h2cParaBuf[0] = regType; ++ h2cParaBuf[1] = pBtReq->pParamStart[2]; ++ h2cParaBuf[2] = pBtReq->pParamStart[3]; ++ h2cParaLen = 3; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ } else if (BT_GSET_RESET == setType) { ++ btOpcode = BT_LO_OP_RESET; ++ h2cParaLen = 0; ++ /* execute h2c and check respond c2h from bt fw is correct or not */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ } else if (BT_GSET_TARGET_BD_ADDR == setType) { ++ /* fill h2c parameters */ ++ btOpcode = BT_LO_OP_SET_TARGET_BD_ADDR_L; ++ h2cParaBuf[0] = pBtReq->pParamStart[1]; ++ h2cParaBuf[1] = pBtReq->pParamStart[2]; ++ h2cParaBuf[2] = pBtReq->pParamStart[3]; ++ h2cParaLen = 3; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ btOpcode = BT_LO_OP_SET_TARGET_BD_ADDR_H; ++ h2cParaBuf[0] = pBtReq->pParamStart[4]; ++ h2cParaBuf[1] = pBtReq->pParamStart[5]; ++ h2cParaBuf[2] = pBtReq->pParamStart[6]; ++ h2cParaLen = 3; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ } else if (BT_GSET_TX_PWR_FINETUNE == setType) { ++ /* fill h2c parameters */ ++ btOpcode = BT_LO_OP_SET_TX_POWER_CALIBRATION; ++ h2cParaBuf[0] = calVal; ++ h2cParaLen = 1; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ } else if (BT_SET_TRACKING_INTERVAL == setType) { ++ /* BT_LO_OP_SET_TRACKING_INTERVAL = 0x22, */ ++ /* BT_LO_OP_SET_THERMAL_METER = 0x23, */ ++ /* BT_LO_OP_ENABLE_CFO_TRACKING = 0x24, */ ++ btOpcode = BT_LO_OP_SET_TRACKING_INTERVAL; ++ h2cParaBuf[0] = calVal; ++ h2cParaLen = 1; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ } else if (BT_SET_THERMAL_METER == setType) { ++ btOpcode = BT_LO_OP_SET_THERMAL_METER; ++ h2cParaBuf[0] = calVal; ++ h2cParaLen = 1; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ } else if (BT_ENABLE_CFO_TRACKING == setType) { ++ btOpcode = BT_LO_OP_ENABLE_CFO_TRACKING; ++ h2cParaBuf[0] = calVal; ++ h2cParaLen = 1; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ } ++ ++ pBtRsp->status = BT_STATUS_SUCCESS; ++ return paraLen; ++} ++ ++ ++ ++u2Byte ++mptbt_BtSetTxRxPars( ++ IN PADAPTER Adapter, ++ IN PBT_REQ_CMD pBtReq, ++ IN PBT_RSP_CMD pBtRsp ++) ++{ ++ u1Byte h2cParaBuf[6] = {0}; ++ u1Byte h2cParaLen = 0; ++ u2Byte paraLen = 0; ++ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; ++ u1Byte btOpcode; ++ u1Byte btOpcodeVer = 0; ++ PBT_TXRX_PARAMETERS pTxRxPars = (PBT_TXRX_PARAMETERS)&pBtReq->pParamStart[0]; ++ u2Byte lenTxRx = sizeof(BT_TXRX_PARAMETERS); ++ u1Byte i; ++ u1Byte bdAddr[6] = {0}; ++ ++ /* */ ++ /* check upper layer parameters */ ++ /* */ ++ ++ /* 1. check upper layer opcode version */ ++ if (pBtReq->opCodeVer != 1) { ++ RTW_INFO("[MPT], Error!! Upper OP code version not match!!!\n"); ++ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; ++ return paraLen; ++ } ++ /* 2. check upper layer parameter length */ ++ if (pBtReq->paraLength == sizeof(BT_TXRX_PARAMETERS)) { ++ RTW_INFO("[MPT], pTxRxPars->txrxChannel=0x%x\n", pTxRxPars->txrxChannel); ++ RTW_INFO("[MPT], pTxRxPars->txrxTxPktCnt=0x%8x\n", pTxRxPars->txrxTxPktCnt); ++ RTW_INFO("[MPT], pTxRxPars->txrxTxPktInterval=0x%x\n", pTxRxPars->txrxTxPktInterval); ++ RTW_INFO("[MPT], pTxRxPars->txrxPayloadType=0x%x\n", pTxRxPars->txrxPayloadType); ++ RTW_INFO("[MPT], pTxRxPars->txrxPktType=0x%x\n", pTxRxPars->txrxPktType); ++ RTW_INFO("[MPT], pTxRxPars->txrxPayloadLen=0x%x\n", pTxRxPars->txrxPayloadLen); ++ RTW_INFO("[MPT], pTxRxPars->txrxPktHeader=0x%x\n", pTxRxPars->txrxPktHeader); ++ RTW_INFO("[MPT], pTxRxPars->txrxWhitenCoeff=0x%x\n", pTxRxPars->txrxWhitenCoeff); ++ bdAddr[0] = pTxRxPars->txrxBdaddr[5]; ++ bdAddr[1] = pTxRxPars->txrxBdaddr[4]; ++ bdAddr[2] = pTxRxPars->txrxBdaddr[3]; ++ bdAddr[3] = pTxRxPars->txrxBdaddr[2]; ++ bdAddr[4] = pTxRxPars->txrxBdaddr[1]; ++ bdAddr[5] = pTxRxPars->txrxBdaddr[0]; ++ RTW_INFO("[MPT], pTxRxPars->txrxBdaddr: %s", &bdAddr[0]); ++ RTW_INFO("[MPT], pTxRxPars->txrxTxGainIndex=0x%x\n", pTxRxPars->txrxTxGainIndex); ++ } else { ++ RTW_INFO("[MPT], Error!! pBtReq->paraLength=%d, correct Len=%d\n", pBtReq->paraLength, lenTxRx); ++ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; ++ return paraLen; ++ } ++ ++ /* */ ++ /* execute lower layer opcodes */ ++ /* */ ++ ++ /* fill h2c parameters */ ++ btOpcode = BT_LO_OP_SET_PKT_HEADER; ++ if (pTxRxPars->txrxPktHeader > 0x3ffff) { ++ RTW_INFO("[MPT], Error!! pTxRxPars->txrxPktHeader=0x%x is out of range, (should be between 0x0~0x3ffff)\n", pTxRxPars->txrxPktHeader); ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } else { ++ h2cParaBuf[0] = (u1Byte)(pTxRxPars->txrxPktHeader & 0xff); ++ h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxPktHeader & 0xff00) >> 8); ++ h2cParaBuf[2] = (u1Byte)((pTxRxPars->txrxPktHeader & 0xff0000) >> 16); ++ h2cParaLen = 3; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ } ++ ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ /* fill h2c parameters */ ++ btOpcode = BT_LO_OP_SET_PKT_TYPE_LEN; ++ { ++ u2Byte payloadLenLimit = 0; ++ switch (pTxRxPars->txrxPktType) { ++ case MP_BT_PKT_DH1: ++ payloadLenLimit = 27 * 8; ++ break; ++ case MP_BT_PKT_DH3: ++ payloadLenLimit = 183 * 8; ++ break; ++ case MP_BT_PKT_DH5: ++ payloadLenLimit = 339 * 8; ++ break; ++ case MP_BT_PKT_2DH1: ++ payloadLenLimit = 54 * 8; ++ break; ++ case MP_BT_PKT_2DH3: ++ payloadLenLimit = 367 * 8; ++ break; ++ case MP_BT_PKT_2DH5: ++ payloadLenLimit = 679 * 8; ++ break; ++ case MP_BT_PKT_3DH1: ++ payloadLenLimit = 83 * 8; ++ break; ++ case MP_BT_PKT_3DH3: ++ payloadLenLimit = 552 * 8; ++ break; ++ case MP_BT_PKT_3DH5: ++ payloadLenLimit = 1021 * 8; ++ break; ++ case MP_BT_PKT_LE: ++ payloadLenLimit = 39 * 8; ++ break; ++ default: { ++ RTW_INFO("[MPT], Error!! Unknown pTxRxPars->txrxPktType=0x%x\n", pTxRxPars->txrxPktType); ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } ++ break; ++ } ++ ++ if (pTxRxPars->txrxPayloadLen > payloadLenLimit) { ++ RTW_INFO("[MPT], Error!! pTxRxPars->txrxPayloadLen=0x%x, (should smaller than %d)\n", ++ pTxRxPars->txrxPayloadLen, payloadLenLimit); ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } ++ ++ h2cParaBuf[0] = pTxRxPars->txrxPktType; ++ h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxPayloadLen & 0xff)); ++ h2cParaBuf[2] = (u1Byte)((pTxRxPars->txrxPayloadLen & 0xff00) >> 8); ++ h2cParaLen = 3; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ } ++ ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ /* fill h2c parameters */ ++ btOpcode = BT_LO_OP_SET_PKT_CNT_L_PL_TYPE; ++ if (pTxRxPars->txrxPayloadType > MP_BT_PAYLOAD_MAX) { ++ RTW_INFO("[MPT], Error!! pTxRxPars->txrxPayloadType=0x%x, (should be between 0~4)\n", pTxRxPars->txrxPayloadType); ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } else { ++ h2cParaBuf[0] = (u1Byte)((pTxRxPars->txrxTxPktCnt & 0xff)); ++ h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxTxPktCnt & 0xff00) >> 8); ++ h2cParaBuf[2] = pTxRxPars->txrxPayloadType; ++ h2cParaLen = 3; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ } ++ ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ /* fill h2c parameters */ ++ btOpcode = BT_LO_OP_SET_PKT_CNT_H_PKT_INTV; ++ if (pTxRxPars->txrxTxPktInterval > 15) { ++ RTW_INFO("[MPT], Error!! pTxRxPars->txrxTxPktInterval=0x%x, (should be between 0~15)\n", pTxRxPars->txrxTxPktInterval); ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } else { ++ h2cParaBuf[0] = (u1Byte)((pTxRxPars->txrxTxPktCnt & 0xff0000) >> 16); ++ h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxTxPktCnt & 0xff000000) >> 24); ++ h2cParaBuf[2] = pTxRxPars->txrxTxPktInterval; ++ h2cParaLen = 3; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ } ++ ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ /* fill h2c parameters */ ++ btOpcode = BT_LO_OP_SET_WHITENCOEFF; ++ { ++ h2cParaBuf[0] = pTxRxPars->txrxWhitenCoeff; ++ h2cParaLen = 1; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ } ++ ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ ++ /* fill h2c parameters */ ++ btOpcode = BT_LO_OP_SET_CHNL_TX_GAIN; ++ if ((pTxRxPars->txrxChannel > 78) || ++ (pTxRxPars->txrxTxGainIndex > 7)) { ++ RTW_INFO("[MPT], Error!! pTxRxPars->txrxChannel=0x%x, (should be between 0~78)\n", pTxRxPars->txrxChannel); ++ RTW_INFO("[MPT], Error!! pTxRxPars->txrxTxGainIndex=0x%x, (should be between 0~7)\n", pTxRxPars->txrxTxGainIndex); ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } else { ++ h2cParaBuf[0] = pTxRxPars->txrxChannel; ++ h2cParaBuf[1] = pTxRxPars->txrxTxGainIndex; ++ h2cParaLen = 2; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ } ++ ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ /* fill h2c parameters */ ++ btOpcode = BT_LO_OP_SET_BD_ADDR_L; ++ if ((pTxRxPars->txrxBdaddr[0] == 0) && ++ (pTxRxPars->txrxBdaddr[1] == 0) && ++ (pTxRxPars->txrxBdaddr[2] == 0) && ++ (pTxRxPars->txrxBdaddr[3] == 0) && ++ (pTxRxPars->txrxBdaddr[4] == 0) && ++ (pTxRxPars->txrxBdaddr[5] == 0)) { ++ RTW_INFO("[MPT], Error!! pTxRxPars->txrxBdaddr=all zero\n"); ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } ++ if ((pTxRxPars->txrxBdaddr[0] == 0xff) && ++ (pTxRxPars->txrxBdaddr[1] == 0xff) && ++ (pTxRxPars->txrxBdaddr[2] == 0xff) && ++ (pTxRxPars->txrxBdaddr[3] == 0xff) && ++ (pTxRxPars->txrxBdaddr[4] == 0xff) && ++ (pTxRxPars->txrxBdaddr[5] == 0xff)) { ++ RTW_INFO("[MPT], Error!! pTxRxPars->txrxBdaddr=all 0xf\n"); ++ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } ++ ++ { ++ h2cParaBuf[0] = pTxRxPars->txrxBdaddr[0]; ++ h2cParaBuf[1] = pTxRxPars->txrxBdaddr[1]; ++ h2cParaBuf[2] = pTxRxPars->txrxBdaddr[2]; ++ h2cParaLen = 3; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ } ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ btOpcode = BT_LO_OP_SET_BD_ADDR_H; ++ { ++ h2cParaBuf[0] = pTxRxPars->txrxBdaddr[3]; ++ h2cParaBuf[1] = pTxRxPars->txrxBdaddr[4]; ++ h2cParaBuf[2] = pTxRxPars->txrxBdaddr[5]; ++ h2cParaLen = 3; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ } ++ /* ckeck bt return status. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ pBtRsp->status = BT_STATUS_SUCCESS; ++ return paraLen; ++} ++ ++ ++ ++u2Byte ++mptbt_BtTestCtrl( ++ IN PADAPTER Adapter, ++ IN PBT_REQ_CMD pBtReq, ++ IN PBT_RSP_CMD pBtRsp ++) ++{ ++ u1Byte h2cParaBuf[6] = {0}; ++ u1Byte h2cParaLen = 0; ++ u2Byte paraLen = 0; ++ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; ++ u1Byte btOpcode; ++ u1Byte btOpcodeVer = 0; ++ u1Byte testCtrl = 0; ++ ++ /* */ ++ /* check upper layer parameters */ ++ /* */ ++ ++ /* 1. check upper layer opcode version */ ++ if (pBtReq->opCodeVer != 1) { ++ RTW_INFO("[MPT], Error!! Upper OP code version not match!!!\n"); ++ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; ++ return paraLen; ++ } ++ /* 2. check upper layer parameter length */ ++ if (1 == pBtReq->paraLength) { ++ testCtrl = pBtReq->pParamStart[0]; ++ RTW_INFO("[MPT], testCtrl=%d\n", testCtrl); ++ } else { ++ RTW_INFO("[MPT], Error!! wrong parameter length=%d (should be 1)\n", pBtReq->paraLength); ++ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; ++ return paraLen; ++ } ++ ++ /* */ ++ /* execute lower layer opcodes */ ++ /* */ ++ ++ /* 1. fill h2c parameters */ ++ /* check bt mode */ ++ btOpcode = BT_LO_OP_TEST_CTRL; ++ if (testCtrl >= MP_BT_TEST_MAX) { ++ RTW_INFO("[MPT], Error!! testCtrl=0x%x, (should be between smaller or equal to 0x%x)\n", ++ testCtrl, MP_BT_TEST_MAX - 1); ++ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; ++ return paraLen; ++ } else { ++ h2cParaBuf[0] = testCtrl; ++ h2cParaLen = 1; ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); ++ } ++ ++ /* 3. construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ pBtRsp->status = BT_STATUS_SUCCESS; ++ return paraLen; ++} ++ ++ ++u2Byte ++mptbt_TestBT( ++ IN PADAPTER Adapter, ++ IN PBT_REQ_CMD pBtReq, ++ IN PBT_RSP_CMD pBtRsp ++) ++{ ++ ++ u1Byte h2cParaBuf[6] = {0}; ++ u1Byte h2cParaLen = 0; ++ u2Byte paraLen = 0; ++ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; ++ u1Byte btOpcode; ++ u1Byte btOpcodeVer = 0; ++ u1Byte testCtrl = 0; ++ ++ /* 1. fill h2c parameters */ ++ btOpcode = 0x11; ++ h2cParaBuf[0] = 0x11; ++ h2cParaBuf[1] = 0x0; ++ h2cParaBuf[2] = 0x0; ++ h2cParaBuf[3] = 0x0; ++ h2cParaBuf[4] = 0x0; ++ h2cParaLen = 1; ++ /* retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); */ ++ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, h2cParaBuf, h2cParaLen); ++ ++ ++ /* 3. construct respond status code and data. */ ++ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { ++ pBtRsp->status = ((btOpcode << 8) | retStatus); ++ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); ++ return paraLen; ++ } ++ ++ pBtRsp->status = BT_STATUS_SUCCESS; ++ return paraLen; ++} ++ ++VOID ++mptbt_BtControlProcess( ++ PADAPTER Adapter, ++ PVOID pInBuf ++) ++{ ++ u1Byte H2C_Parameter[6] = {0}; ++ PBT_H2C pH2c = (PBT_H2C)&H2C_Parameter[0]; ++ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); ++ PBT_REQ_CMD pBtReq = (PBT_REQ_CMD)pInBuf; ++ PBT_RSP_CMD pBtRsp; ++ u1Byte i; ++ ++ ++ RTW_INFO("[MPT], mptbt_BtControlProcess()=========>\n"); ++ ++ RTW_INFO("[MPT], input opCodeVer=%d\n", pBtReq->opCodeVer); ++ RTW_INFO("[MPT], input OpCode=%d\n", pBtReq->OpCode); ++ RTW_INFO("[MPT], paraLength=%d\n", pBtReq->paraLength); ++ if (pBtReq->paraLength) { ++ /* RTW_INFO("[MPT], parameters(hex):0x%x %d\n",&pBtReq->pParamStart[0], pBtReq->paraLength); */ ++ } ++ ++ _rtw_memset((void *)pMptCtx->mptOutBuf, 0, 100); ++ pMptCtx->mptOutLen = 4; /* length of (BT_RSP_CMD.status+BT_RSP_CMD.paraLength) */ ++ ++ pBtRsp = (PBT_RSP_CMD)pMptCtx->mptOutBuf; ++ pBtRsp->status = BT_STATUS_SUCCESS; ++ pBtRsp->paraLength = 0x0; ++ ++ /* The following we should maintain the User OP codes sent by upper layer */ ++ switch (pBtReq->OpCode) { ++ case BT_UP_OP_BT_READY: ++ RTW_INFO("[MPT], OPcode : [BT_READY]\n"); ++ pBtRsp->paraLength = mptbt_BtReady(Adapter, pBtReq, pBtRsp); ++ break; ++ case BT_UP_OP_BT_SET_MODE: ++ RTW_INFO("[MPT], OPcode : [BT_SET_MODE]\n"); ++ pBtRsp->paraLength = mptbt_BtSetMode(Adapter, pBtReq, pBtRsp); ++ break; ++ case BT_UP_OP_BT_SET_TX_RX_PARAMETER: ++ RTW_INFO("[MPT], OPcode : [BT_SET_TXRX_PARAMETER]\n"); ++ pBtRsp->paraLength = mptbt_BtSetTxRxPars(Adapter, pBtReq, pBtRsp); ++ break; ++ case BT_UP_OP_BT_SET_GENERAL: ++ RTW_INFO("[MPT], OPcode : [BT_SET_GENERAL]\n"); ++ pBtRsp->paraLength = mptbt_BtSetGeneral(Adapter, pBtReq, pBtRsp); ++ break; ++ case BT_UP_OP_BT_GET_GENERAL: ++ RTW_INFO("[MPT], OPcode : [BT_GET_GENERAL]\n"); ++ pBtRsp->paraLength = mptbt_BtGetGeneral(Adapter, pBtReq, pBtRsp); ++ break; ++ case BT_UP_OP_BT_TEST_CTRL: ++ RTW_INFO("[MPT], OPcode : [BT_TEST_CTRL]\n"); ++ pBtRsp->paraLength = mptbt_BtTestCtrl(Adapter, pBtReq, pBtRsp); ++ break; ++ case BT_UP_OP_TEST_BT: ++ RTW_INFO("[MPT], OPcode : [TEST_BT]\n"); ++ pBtRsp->paraLength = mptbt_TestBT(Adapter, pBtReq, pBtRsp); ++ break; ++ default: ++ RTW_INFO("[MPT], Error!! OPcode : UNDEFINED!!!!\n"); ++ pBtRsp->status = BT_STATUS_UNKNOWN_OPCODE_U; ++ pBtRsp->paraLength = 0x0; ++ break; ++ } ++ ++ pMptCtx->mptOutLen += pBtRsp->paraLength; ++ ++ RTW_INFO("[MPT], pMptCtx->mptOutLen=%d, pBtRsp->paraLength=%d\n", pMptCtx->mptOutLen, pBtRsp->paraLength); ++ RTW_INFO("[MPT], mptbt_BtControlProcess()<=========\n"); ++} ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_cmd.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_cmd.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_cmd.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_cmd.c 2018-02-11 21:44:27.136145918 +0200 +@@ -0,0 +1,4652 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_CMD_C_ ++ ++#include ++#include ++ ++#ifndef DBG_CMD_EXECUTE ++ #define DBG_CMD_EXECUTE 0 ++#endif ++ ++/* ++Caller and the rtw_cmd_thread can protect cmd_q by spin_lock. ++No irqsave is necessary. ++*/ ++ ++sint _rtw_init_cmd_priv(struct cmd_priv *pcmdpriv) ++{ ++ sint res = _SUCCESS; ++ ++ ++ _rtw_init_sema(&(pcmdpriv->cmd_queue_sema), 0); ++ /* _rtw_init_sema(&(pcmdpriv->cmd_done_sema), 0); */ ++ /*_rtw_init_sema(&(pcmdpriv->terminate_cmdthread_sema), 0);*/ ++ _rtw_init_sema(&(pcmdpriv->start_cmdthread_sema), 0); ++ _rtw_init_completion(&pcmdpriv->cmdthread_comp); ++ ++ _rtw_init_queue(&(pcmdpriv->cmd_queue)); ++ ++ /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */ ++ ++ pcmdpriv->cmd_seq = 1; ++ ++ pcmdpriv->cmd_allocated_buf = rtw_zmalloc(MAX_CMDSZ + CMDBUFF_ALIGN_SZ); ++ ++ if (pcmdpriv->cmd_allocated_buf == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pcmdpriv->cmd_buf = pcmdpriv->cmd_allocated_buf + CMDBUFF_ALIGN_SZ - ((SIZE_PTR)(pcmdpriv->cmd_allocated_buf) & (CMDBUFF_ALIGN_SZ - 1)); ++ ++ pcmdpriv->rsp_allocated_buf = rtw_zmalloc(MAX_RSPSZ + 4); ++ ++ if (pcmdpriv->rsp_allocated_buf == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pcmdpriv->rsp_buf = pcmdpriv->rsp_allocated_buf + 4 - ((SIZE_PTR)(pcmdpriv->rsp_allocated_buf) & 3); ++ ++ pcmdpriv->cmd_issued_cnt = pcmdpriv->cmd_done_cnt = pcmdpriv->rsp_cnt = 0; ++ ++ _rtw_mutex_init(&pcmdpriv->sctx_mutex); ++exit: ++ ++ ++ return res; ++ ++} ++ ++#ifdef CONFIG_C2H_WK ++static void c2h_wk_callback(_workitem *work) ++{ ++ struct evt_priv *evtpriv = container_of(work, struct evt_priv, c2h_wk); ++ _adapter *adapter = container_of(evtpriv, _adapter, evtpriv); ++ u8 *c2h_evt; ++ c2h_id_filter direct_hdl_filter = rtw_hal_c2h_id_handle_directly; ++ u8 id, seq, plen; ++ u8 *payload; ++ ++ evtpriv->c2h_wk_alive = _TRUE; ++ ++ while (!rtw_cbuf_empty(evtpriv->c2h_queue)) { ++ c2h_evt = (u8 *)rtw_cbuf_pop(evtpriv->c2h_queue); ++ if (c2h_evt != NULL) { ++ /* This C2H event is read, clear it */ ++ c2h_evt_clear(adapter); ++ } else { ++ c2h_evt = (u8 *)rtw_malloc(C2H_REG_LEN); ++ if (c2h_evt == NULL) { ++ rtw_warn_on(1); ++ continue; ++ } ++ ++ /* This C2H event is not read, read & clear now */ ++ if (rtw_hal_c2h_evt_read(adapter, c2h_evt) != _SUCCESS) { ++ rtw_mfree(c2h_evt, C2H_REG_LEN); ++ continue; ++ } ++ } ++ ++ /* Special pointer to trigger c2h_evt_clear only */ ++ if ((void *)c2h_evt == (void *)evtpriv) ++ continue; ++ ++ if (!rtw_hal_c2h_valid(adapter, c2h_evt) ++ || rtw_hal_c2h_reg_hdr_parse(adapter, c2h_evt, &id, &seq, &plen, &payload) != _SUCCESS ++ ) { ++ rtw_mfree(c2h_evt, C2H_REG_LEN); ++ continue; ++ } ++ ++ if (direct_hdl_filter(adapter, id, seq, plen, payload) == _TRUE) { ++ /* Handle directly */ ++ rtw_hal_c2h_handler(adapter, id, seq, plen, payload); ++ rtw_mfree(c2h_evt, C2H_REG_LEN); ++ } else { ++ /* Enqueue into cmd_thread for others */ ++ rtw_c2h_reg_wk_cmd(adapter, c2h_evt); ++ rtw_mfree(c2h_evt, C2H_REG_LEN); ++ } ++ } ++ ++ evtpriv->c2h_wk_alive = _FALSE; ++} ++#endif /* CONFIG_C2H_WK */ ++ ++sint _rtw_init_evt_priv(struct evt_priv *pevtpriv) ++{ ++ sint res = _SUCCESS; ++ ++ ++#ifdef CONFIG_H2CLBK ++ _rtw_init_sema(&(pevtpriv->lbkevt_done), 0); ++ pevtpriv->lbkevt_limit = 0; ++ pevtpriv->lbkevt_num = 0; ++ pevtpriv->cmdevt_parm = NULL; ++#endif ++ ++ /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */ ++ ATOMIC_SET(&pevtpriv->event_seq, 0); ++ pevtpriv->evt_done_cnt = 0; ++ ++#ifdef CONFIG_EVENT_THREAD_MODE ++ ++ _rtw_init_sema(&(pevtpriv->evt_notify), 0); ++ _rtw_init_sema(&(pevtpriv->terminate_evtthread_sema), 0); ++ ++ pevtpriv->evt_allocated_buf = rtw_zmalloc(MAX_EVTSZ + 4); ++ if (pevtpriv->evt_allocated_buf == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ pevtpriv->evt_buf = pevtpriv->evt_allocated_buf + 4 - ((unsigned int)(pevtpriv->evt_allocated_buf) & 3); ++ ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ pevtpriv->allocated_c2h_mem = rtw_zmalloc(C2H_MEM_SZ + 4); ++ ++ if (pevtpriv->allocated_c2h_mem == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pevtpriv->c2h_mem = pevtpriv->allocated_c2h_mem + 4\ ++ - ((u32)(pevtpriv->allocated_c2h_mem) & 3); ++#ifdef PLATFORM_OS_XP ++ pevtpriv->pc2h_mdl = IoAllocateMdl((u8 *)pevtpriv->c2h_mem, C2H_MEM_SZ , FALSE, FALSE, NULL); ++ ++ if (pevtpriv->pc2h_mdl == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ MmBuildMdlForNonPagedPool(pevtpriv->pc2h_mdl); ++#endif ++#endif /* end of CONFIG_SDIO_HCI */ ++ ++ _rtw_init_queue(&(pevtpriv->evt_queue)); ++ ++exit: ++ ++#endif /* end of CONFIG_EVENT_THREAD_MODE */ ++ ++#ifdef CONFIG_C2H_WK ++ _init_workitem(&pevtpriv->c2h_wk, c2h_wk_callback, NULL); ++ pevtpriv->c2h_wk_alive = _FALSE; ++ pevtpriv->c2h_queue = rtw_cbuf_alloc(C2H_QUEUE_MAX_LEN + 1); ++#endif ++ ++ ++ return res; ++} ++ ++void _rtw_free_evt_priv(struct evt_priv *pevtpriv) ++{ ++ ++ ++#ifdef CONFIG_EVENT_THREAD_MODE ++ _rtw_free_sema(&(pevtpriv->evt_notify)); ++ _rtw_free_sema(&(pevtpriv->terminate_evtthread_sema)); ++ ++ ++ if (pevtpriv->evt_allocated_buf) ++ rtw_mfree(pevtpriv->evt_allocated_buf, MAX_EVTSZ + 4); ++#endif ++ ++#ifdef CONFIG_C2H_WK ++ _cancel_workitem_sync(&pevtpriv->c2h_wk); ++ while (pevtpriv->c2h_wk_alive) ++ rtw_msleep_os(10); ++ ++ while (!rtw_cbuf_empty(pevtpriv->c2h_queue)) { ++ void *c2h; ++ c2h = rtw_cbuf_pop(pevtpriv->c2h_queue); ++ if (c2h != NULL && c2h != (void *)pevtpriv) ++ rtw_mfree(c2h, 16); ++ } ++ rtw_cbuf_free(pevtpriv->c2h_queue); ++#endif ++ ++ ++ ++} ++ ++void _rtw_free_cmd_priv(struct cmd_priv *pcmdpriv) ++{ ++ ++ if (pcmdpriv) { ++ _rtw_spinlock_free(&(pcmdpriv->cmd_queue.lock)); ++ _rtw_free_sema(&(pcmdpriv->cmd_queue_sema)); ++ /* _rtw_free_sema(&(pcmdpriv->cmd_done_sema)); */ ++ /*_rtw_free_sema(&(pcmdpriv->terminate_cmdthread_sema));*/ ++ _rtw_free_sema(&(pcmdpriv->start_cmdthread_sema)); ++ ++ if (pcmdpriv->cmd_allocated_buf) ++ rtw_mfree(pcmdpriv->cmd_allocated_buf, MAX_CMDSZ + CMDBUFF_ALIGN_SZ); ++ ++ if (pcmdpriv->rsp_allocated_buf) ++ rtw_mfree(pcmdpriv->rsp_allocated_buf, MAX_RSPSZ + 4); ++ ++ _rtw_mutex_free(&pcmdpriv->sctx_mutex); ++ } ++} ++ ++/* ++Calling Context: ++ ++rtw_enqueue_cmd can only be called between kernel thread, ++since only spin_lock is used. ++ ++ISR/Call-Back functions can't call this sub-function. ++ ++*/ ++#ifdef DBG_CMD_QUEUE ++extern u8 dump_cmd_id; ++#endif ++ ++sint _rtw_enqueue_cmd(_queue *queue, struct cmd_obj *obj, bool to_head) ++{ ++ _irqL irqL; ++ ++ ++ if (obj == NULL) ++ goto exit; ++ ++ /* _enter_critical_bh(&queue->lock, &irqL); */ ++ _enter_critical(&queue->lock, &irqL); ++ ++ if (to_head) ++ rtw_list_insert_head(&obj->list, &queue->queue); ++ else ++ rtw_list_insert_tail(&obj->list, &queue->queue); ++ ++#ifdef DBG_CMD_QUEUE ++ if (dump_cmd_id) { ++ printk("%s===> cmdcode:0x%02x\n", __FUNCTION__, obj->cmdcode); ++ if (obj->cmdcode == GEN_CMD_CODE(_Set_MLME_EVT)) { ++ if (obj->parmbuf) { ++ struct C2HEvent_Header *pc2h_evt_hdr = (struct C2HEvent_Header *)(obj->parmbuf); ++ printk("pc2h_evt_hdr->ID:0x%02x(%d)\n", pc2h_evt_hdr->ID, pc2h_evt_hdr->ID); ++ } ++ } ++ if (obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { ++ if (obj->parmbuf) { ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)(obj->parmbuf); ++ printk("pdrvextra_cmd_parm->ec_id:0x%02x\n", pdrvextra_cmd_parm->ec_id); ++ } ++ } ++ } ++ ++ if (queue->queue.prev->next != &queue->queue) { ++ RTW_INFO("[%d] head %p, tail %p, tail->prev->next %p[tail], tail->next %p[head]\n", __LINE__, ++ &queue->queue, queue->queue.prev, queue->queue.prev->prev->next, queue->queue.prev->next); ++ ++ RTW_INFO("==========%s============\n", __FUNCTION__); ++ RTW_INFO("head:%p,obj_addr:%p\n", &queue->queue, obj); ++ RTW_INFO("padapter: %p\n", obj->padapter); ++ RTW_INFO("cmdcode: 0x%02x\n", obj->cmdcode); ++ RTW_INFO("res: %d\n", obj->res); ++ RTW_INFO("parmbuf: %p\n", obj->parmbuf); ++ RTW_INFO("cmdsz: %d\n", obj->cmdsz); ++ RTW_INFO("rsp: %p\n", obj->rsp); ++ RTW_INFO("rspsz: %d\n", obj->rspsz); ++ RTW_INFO("sctx: %p\n", obj->sctx); ++ RTW_INFO("list->next: %p\n", obj->list.next); ++ RTW_INFO("list->prev: %p\n", obj->list.prev); ++ } ++#endif /* DBG_CMD_QUEUE */ ++ ++ /* _exit_critical_bh(&queue->lock, &irqL); */ ++ _exit_critical(&queue->lock, &irqL); ++ ++exit: ++ ++ ++ return _SUCCESS; ++} ++ ++struct cmd_obj *_rtw_dequeue_cmd(_queue *queue) ++{ ++ _irqL irqL; ++ struct cmd_obj *obj; ++ ++ ++ /* _enter_critical_bh(&(queue->lock), &irqL); */ ++ _enter_critical(&queue->lock, &irqL); ++ ++#ifdef DBG_CMD_QUEUE ++ if (queue->queue.prev->next != &queue->queue) { ++ RTW_INFO("[%d] head %p, tail %p, tail->prev->next %p[tail], tail->next %p[head]\n", __LINE__, ++ &queue->queue, queue->queue.prev, queue->queue.prev->prev->next, queue->queue.prev->next); ++ } ++#endif /* DBG_CMD_QUEUE */ ++ ++ ++ if (rtw_is_list_empty(&(queue->queue))) ++ obj = NULL; ++ else { ++ obj = LIST_CONTAINOR(get_next(&(queue->queue)), struct cmd_obj, list); ++ ++#ifdef DBG_CMD_QUEUE ++ if (queue->queue.prev->next != &queue->queue) { ++ RTW_INFO("==========%s============\n", __FUNCTION__); ++ RTW_INFO("head:%p,obj_addr:%p\n", &queue->queue, obj); ++ RTW_INFO("padapter: %p\n", obj->padapter); ++ RTW_INFO("cmdcode: 0x%02x\n", obj->cmdcode); ++ RTW_INFO("res: %d\n", obj->res); ++ RTW_INFO("parmbuf: %p\n", obj->parmbuf); ++ RTW_INFO("cmdsz: %d\n", obj->cmdsz); ++ RTW_INFO("rsp: %p\n", obj->rsp); ++ RTW_INFO("rspsz: %d\n", obj->rspsz); ++ RTW_INFO("sctx: %p\n", obj->sctx); ++ RTW_INFO("list->next: %p\n", obj->list.next); ++ RTW_INFO("list->prev: %p\n", obj->list.prev); ++ } ++ ++ if (dump_cmd_id) { ++ RTW_INFO("%s===> cmdcode:0x%02x\n", __FUNCTION__, obj->cmdcode); ++ if (obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { ++ if (obj->parmbuf) { ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)(obj->parmbuf); ++ printk("pdrvextra_cmd_parm->ec_id:0x%02x\n", pdrvextra_cmd_parm->ec_id); ++ } ++ } ++ ++ } ++#endif /* DBG_CMD_QUEUE */ ++ ++ rtw_list_delete(&obj->list); ++ } ++ ++ /* _exit_critical_bh(&(queue->lock), &irqL); */ ++ _exit_critical(&queue->lock, &irqL); ++ ++ ++ return obj; ++} ++ ++u32 rtw_init_cmd_priv(struct cmd_priv *pcmdpriv) ++{ ++ u32 res; ++ res = _rtw_init_cmd_priv(pcmdpriv); ++ return res; ++} ++ ++u32 rtw_init_evt_priv(struct evt_priv *pevtpriv) ++{ ++ int res; ++ res = _rtw_init_evt_priv(pevtpriv); ++ return res; ++} ++ ++void rtw_free_evt_priv(struct evt_priv *pevtpriv) ++{ ++ _rtw_free_evt_priv(pevtpriv); ++} ++ ++void rtw_free_cmd_priv(struct cmd_priv *pcmdpriv) ++{ ++ _rtw_free_cmd_priv(pcmdpriv); ++} ++ ++int rtw_cmd_filter(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj); ++int rtw_cmd_filter(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj) ++{ ++ u8 bAllow = _FALSE; /* set to _TRUE to allow enqueuing cmd when hw_init_completed is _FALSE */ ++ ++#ifdef SUPPORT_HW_RFOFF_DETECTED ++ /* To decide allow or not */ ++ if ((adapter_to_pwrctl(pcmdpriv->padapter)->bHWPwrPindetect) ++ && (!pcmdpriv->padapter->registrypriv.usbss_enable) ++ ) { ++ if (cmd_obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)cmd_obj->parmbuf; ++ if (pdrvextra_cmd_parm->ec_id == POWER_SAVING_CTRL_WK_CID) { ++ /* RTW_INFO("==>enqueue POWER_SAVING_CTRL_WK_CID\n"); */ ++ bAllow = _TRUE; ++ } ++ } ++ } ++#endif ++ ++ if (cmd_obj->cmdcode == GEN_CMD_CODE(_SetChannelPlan)) ++ bAllow = _TRUE; ++ ++ if (cmd_obj->no_io) ++ bAllow = _TRUE; ++ ++ if ((!rtw_is_hw_init_completed(pcmdpriv->padapter) && (bAllow == _FALSE)) ++ || ATOMIC_READ(&(pcmdpriv->cmdthd_running)) == _FALSE /* com_thread not running */ ++ ) { ++ if (DBG_CMD_EXECUTE) ++ RTW_INFO(ADPT_FMT" drop "CMD_FMT" hw_init_completed:%u, cmdthd_running:%u\n", ADPT_ARG(cmd_obj->padapter) ++ , CMD_ARG(cmd_obj), rtw_get_hw_init_completed(cmd_obj->padapter), ATOMIC_READ(&pcmdpriv->cmdthd_running)); ++ if (0) ++ rtw_warn_on(1); ++ ++ return _FAIL; ++ } ++ return _SUCCESS; ++} ++ ++ ++ ++u32 rtw_enqueue_cmd(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj) ++{ ++ int res = _FAIL; ++ PADAPTER padapter = pcmdpriv->padapter; ++ ++ ++ if (cmd_obj == NULL) ++ goto exit; ++ ++ cmd_obj->padapter = padapter; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ /* change pcmdpriv to primary's pcmdpriv */ ++ if (padapter->adapter_type != PRIMARY_ADAPTER) ++ pcmdpriv = &(GET_PRIMARY_ADAPTER(padapter)->cmdpriv); ++#endif ++ ++ res = rtw_cmd_filter(pcmdpriv, cmd_obj); ++ if ((_FAIL == res) || (cmd_obj->cmdsz > MAX_CMDSZ)) { ++ if (cmd_obj->cmdsz > MAX_CMDSZ) { ++ RTW_INFO("%s failed due to obj->cmdsz(%d) > MAX_CMDSZ(%d)\n", __func__, cmd_obj->cmdsz, MAX_CMDSZ); ++ rtw_warn_on(1); ++ } ++ ++ if (cmd_obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { ++ struct drvextra_cmd_parm *extra_parm = (struct drvextra_cmd_parm *)cmd_obj->parmbuf; ++ ++ if (extra_parm->pbuf && extra_parm->size > 0) ++ rtw_mfree(extra_parm->pbuf, extra_parm->size); ++ } ++ rtw_free_cmd_obj(cmd_obj); ++ goto exit; ++ } ++ ++ res = _rtw_enqueue_cmd(&pcmdpriv->cmd_queue, cmd_obj, 0); ++ ++ if (res == _SUCCESS) ++ _rtw_up_sema(&pcmdpriv->cmd_queue_sema); ++ ++exit: ++ ++ ++ return res; ++} ++ ++struct cmd_obj *rtw_dequeue_cmd(struct cmd_priv *pcmdpriv) ++{ ++ struct cmd_obj *cmd_obj; ++ ++ ++ cmd_obj = _rtw_dequeue_cmd(&pcmdpriv->cmd_queue); ++ ++ return cmd_obj; ++} ++ ++void rtw_cmd_clr_isr(struct cmd_priv *pcmdpriv) ++{ ++ pcmdpriv->cmd_done_cnt++; ++ /* _rtw_up_sema(&(pcmdpriv->cmd_done_sema)); */ ++} ++ ++void rtw_free_cmd_obj(struct cmd_obj *pcmd) ++{ ++ struct drvextra_cmd_parm *extra_parm = NULL; ++ ++ if (pcmd->parmbuf != NULL) { ++ /* free parmbuf in cmd_obj */ ++ rtw_mfree((unsigned char *)pcmd->parmbuf, pcmd->cmdsz); ++ } ++ if (pcmd->rsp != NULL) { ++ if (pcmd->rspsz != 0) { ++ /* free rsp in cmd_obj */ ++ rtw_mfree((unsigned char *)pcmd->rsp, pcmd->rspsz); ++ } ++ } ++ ++ /* free cmd_obj */ ++ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); ++ ++} ++ ++ ++void rtw_stop_cmd_thread(_adapter *adapter) ++{ ++ if (adapter->cmdThread && ++ ATOMIC_READ(&(adapter->cmdpriv.cmdthd_running)) == _TRUE && ++ adapter->cmdpriv.stop_req == 0) { ++ adapter->cmdpriv.stop_req = 1; ++ _rtw_up_sema(&adapter->cmdpriv.cmd_queue_sema); ++ /*_rtw_down_sema(&adapter->cmdpriv.terminate_cmdthread_sema);*/ ++ rtw_wait_for_thread_stop(&adapter->cmdpriv.cmdthread_comp); ++ } ++} ++ ++thread_return rtw_cmd_thread(thread_context context) ++{ ++ u8 ret; ++ struct cmd_obj *pcmd; ++ u8 *pcmdbuf, *prspbuf; ++ u32 cmd_start_time; ++ u32 cmd_process_time; ++ u8(*cmd_hdl)(_adapter *padapter, u8 *pbuf); ++ void (*pcmd_callback)(_adapter *dev, struct cmd_obj *pcmd); ++ PADAPTER padapter = (PADAPTER)context; ++ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); ++ struct drvextra_cmd_parm *extra_parm = NULL; ++ _irqL irqL; ++ ++ thread_enter("RTW_CMD_THREAD"); ++ ++ pcmdbuf = pcmdpriv->cmd_buf; ++ prspbuf = pcmdpriv->rsp_buf; ++ ++ pcmdpriv->stop_req = 0; ++ ATOMIC_SET(&(pcmdpriv->cmdthd_running), _TRUE); ++ /*_rtw_up_sema(&pcmdpriv->terminate_cmdthread_sema);*/ ++ _rtw_up_sema(&pcmdpriv->start_cmdthread_sema); ++ ++ ++ while (1) { ++ if (_rtw_down_sema(&pcmdpriv->cmd_queue_sema) == _FAIL) { ++ RTW_PRINT(FUNC_ADPT_FMT" _rtw_down_sema(&pcmdpriv->cmd_queue_sema) return _FAIL, break\n", FUNC_ADPT_ARG(padapter)); ++ break; ++ } ++ ++ if (RTW_CANNOT_RUN(padapter)) { ++ RTW_PRINT("%s: DriverStopped(%s) SurpriseRemoved(%s) break at line %d\n", ++ __func__ ++ , rtw_is_drv_stopped(padapter) ? "True" : "False" ++ , rtw_is_surprise_removed(padapter) ? "True" : "False" ++ , __LINE__); ++ break; ++ } ++ ++ if (pcmdpriv->stop_req) { ++ RTW_PRINT(FUNC_ADPT_FMT" stop_req:%u, break\n", FUNC_ADPT_ARG(padapter), pcmdpriv->stop_req); ++ break; ++ } ++ ++ _enter_critical(&pcmdpriv->cmd_queue.lock, &irqL); ++ if (rtw_is_list_empty(&(pcmdpriv->cmd_queue.queue))) { ++ /* RTW_INFO("%s: cmd queue is empty!\n", __func__); */ ++ _exit_critical(&pcmdpriv->cmd_queue.lock, &irqL); ++ continue; ++ } ++ _exit_critical(&pcmdpriv->cmd_queue.lock, &irqL); ++ ++_next: ++ if (RTW_CANNOT_RUN(padapter)) { ++ RTW_PRINT("%s: DriverStopped(%s) SurpriseRemoved(%s) break at line %d\n", ++ __func__ ++ , rtw_is_drv_stopped(padapter) ? "True" : "False" ++ , rtw_is_surprise_removed(padapter) ? "True" : "False" ++ , __LINE__); ++ break; ++ } ++ ++ pcmd = rtw_dequeue_cmd(pcmdpriv); ++ if (!pcmd) { ++#ifdef CONFIG_LPS_LCLK ++ rtw_unregister_cmd_alive(padapter); ++#endif ++ continue; ++ } ++ ++ cmd_start_time = rtw_get_current_time(); ++ pcmdpriv->cmd_issued_cnt++; ++ ++ if (pcmd->cmdsz > MAX_CMDSZ) { ++ RTW_ERR("%s cmdsz:%d > MAX_CMDSZ:%d\n", __func__, pcmd->cmdsz, MAX_CMDSZ); ++ pcmd->res = H2C_PARAMETERS_ERROR; ++ goto post_process; ++ } ++ ++ if (pcmd->cmdcode >= (sizeof(wlancmds) / sizeof(struct cmd_hdl))) { ++ RTW_ERR("%s undefined cmdcode:%d\n", __func__, pcmd->cmdcode); ++ pcmd->res = H2C_PARAMETERS_ERROR; ++ goto post_process; ++ } ++ ++ cmd_hdl = wlancmds[pcmd->cmdcode].h2cfuns; ++ if (!cmd_hdl) { ++ RTW_ERR("%s no cmd_hdl for cmdcode:%d\n", __func__, pcmd->cmdcode); ++ pcmd->res = H2C_PARAMETERS_ERROR; ++ goto post_process; ++ } ++ ++ if (_FAIL == rtw_cmd_filter(pcmdpriv, pcmd)) { ++ pcmd->res = H2C_DROPPED; ++ if (pcmd->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { ++ extra_parm = (struct drvextra_cmd_parm *)pcmd->parmbuf; ++ if (extra_parm && extra_parm->pbuf && extra_parm->size > 0) ++ rtw_mfree(extra_parm->pbuf, extra_parm->size); ++ } ++ goto post_process; ++ } ++ ++#ifdef CONFIG_LPS_LCLK ++ if (pcmd->no_io) ++ rtw_unregister_cmd_alive(padapter); ++ else { ++ if (rtw_register_cmd_alive(padapter) != _SUCCESS) { ++ if (DBG_CMD_EXECUTE) ++ RTW_PRINT("%s: wait to leave LPS_LCLK\n", __func__); ++ ++ pcmd->res = H2C_ENQ_HEAD; ++ ret = _rtw_enqueue_cmd(&pcmdpriv->cmd_queue, pcmd, 1); ++ if (ret == _SUCCESS) { ++ if (DBG_CMD_EXECUTE) ++ RTW_INFO(ADPT_FMT" "CMD_FMT" ENQ_HEAD\n", ADPT_ARG(pcmd->padapter), CMD_ARG(pcmd)); ++ continue; ++ } ++ ++ RTW_INFO(ADPT_FMT" "CMD_FMT" ENQ_HEAD_FAIL\n", ADPT_ARG(pcmd->padapter), CMD_ARG(pcmd)); ++ pcmd->res = H2C_ENQ_HEAD_FAIL; ++ rtw_warn_on(1); ++ } ++ } ++#endif /* CONFIG_LPS_LCLK */ ++ ++ if (DBG_CMD_EXECUTE) ++ RTW_INFO(ADPT_FMT" "CMD_FMT" %sexecute\n", ADPT_ARG(pcmd->padapter), CMD_ARG(pcmd) ++ , pcmd->res == H2C_ENQ_HEAD ? "ENQ_HEAD " : (pcmd->res == H2C_ENQ_HEAD_FAIL ? "ENQ_HEAD_FAIL " : "")); ++ ++ _rtw_memcpy(pcmdbuf, pcmd->parmbuf, pcmd->cmdsz); ++ ret = cmd_hdl(pcmd->padapter, pcmdbuf); ++ pcmd->res = ret; ++ ++ pcmdpriv->cmd_seq++; ++ ++post_process: ++ ++ _enter_critical_mutex(&(pcmd->padapter->cmdpriv.sctx_mutex), NULL); ++ if (pcmd->sctx) { ++ if (0) ++ RTW_PRINT(FUNC_ADPT_FMT" pcmd->sctx\n", FUNC_ADPT_ARG(pcmd->padapter)); ++ if (pcmd->res == H2C_SUCCESS) ++ rtw_sctx_done(&pcmd->sctx); ++ else ++ rtw_sctx_done_err(&pcmd->sctx, RTW_SCTX_DONE_CMD_ERROR); ++ } ++ _exit_critical_mutex(&(pcmd->padapter->cmdpriv.sctx_mutex), NULL); ++ ++ cmd_process_time = rtw_get_passing_time_ms(cmd_start_time); ++ if (cmd_process_time > 1000) { ++ RTW_INFO(ADPT_FMT" "CMD_FMT" process_time=%d\n", ADPT_ARG(pcmd->padapter), CMD_ARG(pcmd), cmd_process_time); ++ if (0) ++ rtw_warn_on(1); ++ } ++ ++ /* call callback function for post-processed */ ++ if (pcmd->cmdcode < (sizeof(rtw_cmd_callback) / sizeof(struct _cmd_callback))) { ++ pcmd_callback = rtw_cmd_callback[pcmd->cmdcode].callback; ++ if (pcmd_callback == NULL) { ++ rtw_free_cmd_obj(pcmd); ++ } else { ++ /* todo: !!! fill rsp_buf to pcmd->rsp if (pcmd->rsp!=NULL) */ ++ pcmd_callback(pcmd->padapter, pcmd);/* need conider that free cmd_obj in rtw_cmd_callback */ ++ } ++ } else { ++ rtw_free_cmd_obj(pcmd); ++ } ++ ++ flush_signals_thread(); ++ ++ goto _next; ++ ++ } ++ ++#ifdef CONFIG_LPS_LCLK ++ rtw_unregister_cmd_alive(padapter); ++#endif ++ ++ /* to avoid enqueue cmd after free all cmd_obj */ ++ ATOMIC_SET(&(pcmdpriv->cmdthd_running), _FALSE); ++ ++ /* free all cmd_obj resources */ ++ do { ++ pcmd = rtw_dequeue_cmd(pcmdpriv); ++ if (pcmd == NULL) ++ break; ++ ++ if (0) ++ RTW_INFO("%s: leaving... drop "CMD_FMT"\n", __func__, CMD_ARG(pcmd)); ++ ++ if (pcmd->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { ++ extra_parm = (struct drvextra_cmd_parm *)pcmd->parmbuf; ++ if (extra_parm->pbuf && extra_parm->size > 0) ++ rtw_mfree(extra_parm->pbuf, extra_parm->size); ++ } ++ ++ _enter_critical_mutex(&(pcmd->padapter->cmdpriv.sctx_mutex), NULL); ++ if (pcmd->sctx) { ++ if (0) ++ RTW_PRINT(FUNC_ADPT_FMT" pcmd->sctx\n", FUNC_ADPT_ARG(pcmd->padapter)); ++ rtw_sctx_done_err(&pcmd->sctx, RTW_SCTX_DONE_CMD_DROP); ++ } ++ _exit_critical_mutex(&(pcmd->padapter->cmdpriv.sctx_mutex), NULL); ++ ++ rtw_free_cmd_obj(pcmd); ++ } while (1); ++ ++ /*_rtw_up_sema(&pcmdpriv->terminate_cmdthread_sema);*/ ++ thread_exit(&pcmdpriv->cmdthread_comp); ++ return 0; ++} ++ ++ ++#ifdef CONFIG_EVENT_THREAD_MODE ++u32 rtw_enqueue_evt(struct evt_priv *pevtpriv, struct evt_obj *obj) ++{ ++ _irqL irqL; ++ int res; ++ _queue *queue = &pevtpriv->evt_queue; ++ ++ ++ res = _SUCCESS; ++ ++ if (obj == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ _enter_critical_bh(&queue->lock, &irqL); ++ ++ rtw_list_insert_tail(&obj->list, &queue->queue); ++ ++ _exit_critical_bh(&queue->lock, &irqL); ++ ++ /* rtw_evt_notify_isr(pevtpriv); */ ++ ++exit: ++ ++ ++ return res; ++} ++ ++struct evt_obj *rtw_dequeue_evt(_queue *queue) ++{ ++ _irqL irqL; ++ struct evt_obj *pevtobj; ++ ++ ++ _enter_critical_bh(&queue->lock, &irqL); ++ ++ if (rtw_is_list_empty(&(queue->queue))) ++ pevtobj = NULL; ++ else { ++ pevtobj = LIST_CONTAINOR(get_next(&(queue->queue)), struct evt_obj, list); ++ rtw_list_delete(&pevtobj->list); ++ } ++ ++ _exit_critical_bh(&queue->lock, &irqL); ++ ++ ++ return pevtobj; ++} ++ ++void rtw_free_evt_obj(struct evt_obj *pevtobj) ++{ ++ ++ if (pevtobj->parmbuf) ++ rtw_mfree((unsigned char *)pevtobj->parmbuf, pevtobj->evtsz); ++ ++ rtw_mfree((unsigned char *)pevtobj, sizeof(struct evt_obj)); ++ ++} ++ ++void rtw_evt_notify_isr(struct evt_priv *pevtpriv) ++{ ++ pevtpriv->evt_done_cnt++; ++ _rtw_up_sema(&(pevtpriv->evt_notify)); ++} ++#endif ++ ++ ++/* ++u8 rtw_setstandby_cmd(unsigned char *adapter) ++*/ ++u8 rtw_setstandby_cmd(_adapter *padapter, uint action) ++{ ++ struct cmd_obj *ph2c; ++ struct usb_suspend_parm *psetusbsuspend; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ ++ u8 ret = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ psetusbsuspend = (struct usb_suspend_parm *)rtw_zmalloc(sizeof(struct usb_suspend_parm)); ++ if (psetusbsuspend == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ psetusbsuspend->action = action; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, psetusbsuspend, GEN_CMD_CODE(_SetUsbSuspend)); ++ ++ ret = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ ++ return ret; ++} ++ ++/* ++rtw_sitesurvey_cmd(~) ++ ### NOTE:#### (!!!!) ++ MUST TAKE CARE THAT BEFORE CALLING THIS FUNC, YOU SHOULD HAVE LOCKED pmlmepriv->lock ++*/ ++u8 rtw_sitesurvey_cmd(_adapter *padapter, NDIS_802_11_SSID *ssid, int ssid_num, ++ struct rtw_ieee80211_channel *ch, int ch_num) ++{ ++ u8 res = _FAIL; ++ struct cmd_obj *ph2c; ++ struct sitesurvey_parm *psurveyPara; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif /* CONFIG_P2P */ ++ ++ ++#ifdef CONFIG_LPS ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SCAN, 1); ++#endif ++ ++#ifdef CONFIG_P2P_PS ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ p2p_ps_wk_cmd(padapter, P2P_PS_SCAN, 1); ++#endif /* CONFIG_P2P_PS */ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) ++ return _FAIL; ++ ++ psurveyPara = (struct sitesurvey_parm *)rtw_zmalloc(sizeof(struct sitesurvey_parm)); ++ if (psurveyPara == NULL) { ++ rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); ++ return _FAIL; ++ } ++ ++ rtw_free_network_queue(padapter, _FALSE); ++ ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, psurveyPara, GEN_CMD_CODE(_SiteSurvey)); ++ ++ /* psurveyPara->bsslimit = 48; */ ++ psurveyPara->scan_mode = pmlmepriv->scan_mode; ++ ++ /* prepare ssid list */ ++ if (ssid) { ++ int i; ++ for (i = 0; i < ssid_num && i < RTW_SSID_SCAN_AMOUNT; i++) { ++ if (ssid[i].SsidLength) { ++ _rtw_memcpy(&psurveyPara->ssid[i], &ssid[i], sizeof(NDIS_802_11_SSID)); ++ psurveyPara->ssid_num++; ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" ssid:(%s, %d)\n", FUNC_ADPT_ARG(padapter), ++ psurveyPara->ssid[i].Ssid, psurveyPara->ssid[i].SsidLength); ++ } ++ } ++ } ++ ++ /* prepare channel list */ ++ if (ch) { ++ int i; ++ for (i = 0; i < ch_num && i < RTW_CHANNEL_SCAN_AMOUNT; i++) { ++ if (ch[i].hw_value && !(ch[i].flags & RTW_IEEE80211_CHAN_DISABLED)) { ++ _rtw_memcpy(&psurveyPara->ch[i], &ch[i], sizeof(struct rtw_ieee80211_channel)); ++ psurveyPara->ch_num++; ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" ch:%u\n", FUNC_ADPT_ARG(padapter), ++ psurveyPara->ch[i].hw_value); ++ } ++ } ++ } ++ ++ set_fwstate(pmlmepriv, _FW_UNDER_SURVEY); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++ if (res == _SUCCESS) { ++ ++ pmlmepriv->scan_start_time = rtw_get_current_time(); ++ ++#ifdef CONFIG_SCAN_BACKOP ++ if (rtw_mi_buddy_check_mlmeinfo_state(padapter, WIFI_FW_AP_STATE)) { ++ if (IsSupported5G(padapter->registrypriv.wireless_mode) ++ && IsSupported24G(padapter->registrypriv.wireless_mode)) /* dual band */ ++ mlme_set_scan_to_timer(pmlmepriv, CONC_SCANNING_TIMEOUT_DUAL_BAND); ++ else /* single band */ ++ mlme_set_scan_to_timer(pmlmepriv, CONC_SCANNING_TIMEOUT_SINGLE_BAND); ++ } else ++#endif /* CONFIG_SCAN_BACKOP */ ++ mlme_set_scan_to_timer(pmlmepriv, SCANNING_TIMEOUT); ++ ++ rtw_led_control(padapter, LED_CTL_SITE_SURVEY); ++ } else ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); ++ ++ ++ return res; ++} ++ ++u8 rtw_setdatarate_cmd(_adapter *padapter, u8 *rateset) ++{ ++ struct cmd_obj *ph2c; ++ struct setdatarate_parm *pbsetdataratepara; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pbsetdataratepara = (struct setdatarate_parm *)rtw_zmalloc(sizeof(struct setdatarate_parm)); ++ if (pbsetdataratepara == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pbsetdataratepara, GEN_CMD_CODE(_SetDataRate)); ++#ifdef MP_FIRMWARE_OFFLOAD ++ pbsetdataratepara->curr_rateidx = *(u32 *)rateset; ++ /* _rtw_memcpy(pbsetdataratepara, rateset, sizeof(u32)); */ ++#else ++ pbsetdataratepara->mac_id = 5; ++ _rtw_memcpy(pbsetdataratepara->datarates, rateset, NumRates); ++#endif ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++exit: ++ ++ ++ return res; ++} ++ ++u8 rtw_setbasicrate_cmd(_adapter *padapter, u8 *rateset) ++{ ++ struct cmd_obj *ph2c; ++ struct setbasicrate_parm *pssetbasicratepara; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ pssetbasicratepara = (struct setbasicrate_parm *)rtw_zmalloc(sizeof(struct setbasicrate_parm)); ++ ++ if (pssetbasicratepara == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pssetbasicratepara, _SetBasicRate_CMD_); ++ ++ _rtw_memcpy(pssetbasicratepara->basicrates, rateset, NumRates); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++exit: ++ ++ ++ return res; ++} ++ ++ ++/* ++unsigned char rtw_setphy_cmd(unsigned char *adapter) ++ ++1. be called only after rtw_update_registrypriv_dev_network( ~) or mp testing program ++2. for AdHoc/Ap mode or mp mode? ++ ++*/ ++u8 rtw_setphy_cmd(_adapter *padapter, u8 modem, u8 ch) ++{ ++ struct cmd_obj *ph2c; ++ struct setphy_parm *psetphypara; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ /* struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ * struct registry_priv* pregistry_priv = &padapter->registrypriv; */ ++ u8 res = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ psetphypara = (struct setphy_parm *)rtw_zmalloc(sizeof(struct setphy_parm)); ++ ++ if (psetphypara == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, psetphypara, _SetPhy_CMD_); ++ ++ ++ psetphypara->modem = modem; ++ psetphypara->rfchannel = ch; ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++exit: ++ return res; ++} ++ ++u8 rtw_getmacreg_cmd(_adapter *padapter, u8 len, u32 addr) ++{ ++ struct cmd_obj *ph2c; ++ struct readMAC_parm *preadmacparm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ preadmacparm = (struct readMAC_parm *)rtw_zmalloc(sizeof(struct readMAC_parm)); ++ ++ if (preadmacparm == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, preadmacparm, GEN_CMD_CODE(_GetMACReg)); ++ ++ preadmacparm->len = len; ++ preadmacparm->addr = addr; ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ return res; ++} ++ ++void rtw_usb_catc_trigger_cmd(_adapter *padapter, const char *caller) ++{ ++ RTW_INFO("%s caller:%s\n", __func__, caller); ++ rtw_getmacreg_cmd(padapter, 1, 0x1c4); ++} ++ ++u8 rtw_setbbreg_cmd(_adapter *padapter, u8 offset, u8 val) ++{ ++ struct cmd_obj *ph2c; ++ struct writeBB_parm *pwritebbparm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ pwritebbparm = (struct writeBB_parm *)rtw_zmalloc(sizeof(struct writeBB_parm)); ++ ++ if (pwritebbparm == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pwritebbparm, GEN_CMD_CODE(_SetBBReg)); ++ ++ pwritebbparm->offset = offset; ++ pwritebbparm->value = val; ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++exit: ++ return res; ++} ++ ++u8 rtw_getbbreg_cmd(_adapter *padapter, u8 offset, u8 *pval) ++{ ++ struct cmd_obj *ph2c; ++ struct readBB_parm *prdbbparm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ prdbbparm = (struct readBB_parm *)rtw_zmalloc(sizeof(struct readBB_parm)); ++ ++ if (prdbbparm == NULL) { ++ rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); ++ return _FAIL; ++ } ++ ++ _rtw_init_listhead(&ph2c->list); ++ ph2c->cmdcode = GEN_CMD_CODE(_GetBBReg); ++ ph2c->parmbuf = (unsigned char *)prdbbparm; ++ ph2c->cmdsz = sizeof(struct readBB_parm); ++ ph2c->rsp = pval; ++ ph2c->rspsz = sizeof(struct readBB_rsp); ++ ++ prdbbparm->offset = offset; ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++exit: ++ return res; ++} ++ ++u8 rtw_setrfreg_cmd(_adapter *padapter, u8 offset, u32 val) ++{ ++ struct cmd_obj *ph2c; ++ struct writeRF_parm *pwriterfparm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ pwriterfparm = (struct writeRF_parm *)rtw_zmalloc(sizeof(struct writeRF_parm)); ++ ++ if (pwriterfparm == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pwriterfparm, GEN_CMD_CODE(_SetRFReg)); ++ ++ pwriterfparm->offset = offset; ++ pwriterfparm->value = val; ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++exit: ++ return res; ++} ++ ++u8 rtw_getrfreg_cmd(_adapter *padapter, u8 offset, u8 *pval) ++{ ++ struct cmd_obj *ph2c; ++ struct readRF_parm *prdrfparm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ prdrfparm = (struct readRF_parm *)rtw_zmalloc(sizeof(struct readRF_parm)); ++ if (prdrfparm == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ _rtw_init_listhead(&ph2c->list); ++ ph2c->cmdcode = GEN_CMD_CODE(_GetRFReg); ++ ph2c->parmbuf = (unsigned char *)prdrfparm; ++ ph2c->cmdsz = sizeof(struct readRF_parm); ++ ph2c->rsp = pval; ++ ph2c->rspsz = sizeof(struct readRF_rsp); ++ ++ prdrfparm->offset = offset; ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ ++ return res; ++} ++ ++void rtw_getbbrfreg_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd) ++{ ++ ++ /* rtw_free_cmd_obj(pcmd); */ ++ rtw_mfree((unsigned char *) pcmd->parmbuf, pcmd->cmdsz); ++ rtw_mfree((unsigned char *) pcmd, sizeof(struct cmd_obj)); ++ ++#ifdef CONFIG_MP_INCLUDED ++ if (padapter->registrypriv.mp_mode == 1) ++ padapter->mppriv.workparam.bcompleted = _TRUE; ++#endif ++} ++ ++void rtw_readtssi_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd) ++{ ++ ++ rtw_mfree((unsigned char *) pcmd->parmbuf, pcmd->cmdsz); ++ rtw_mfree((unsigned char *) pcmd, sizeof(struct cmd_obj)); ++ ++#ifdef CONFIG_MP_INCLUDED ++ if (padapter->registrypriv.mp_mode == 1) ++ padapter->mppriv.workparam.bcompleted = _TRUE; ++#endif ++ ++} ++ ++static u8 rtw_createbss_cmd(_adapter *adapter, int flags, bool adhoc ++ , s16 req_ch, s8 req_bw, s8 req_offset) ++{ ++ struct cmd_obj *cmdobj; ++ struct createbss_parm *parm; ++ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct submit_ctx sctx; ++ u8 res = _SUCCESS; ++ ++ if (req_ch > 0 && req_bw >= 0 && req_offset >= 0) { ++ if (!rtw_chset_is_chbw_valid(adapter->mlmeextpriv.channel_set, req_ch, req_bw, req_offset)) { ++ res = _FAIL; ++ goto exit; ++ } ++ } ++ ++ /* prepare cmd parameter */ ++ parm = (struct createbss_parm *)rtw_zmalloc(sizeof(*parm)); ++ if (parm == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ if (adhoc) { ++ /* for now, adhoc doesn't support ch,bw,offset request */ ++ parm->adhoc = 1; ++ } else { ++ parm->adhoc = 0; ++ parm->req_ch = req_ch; ++ parm->req_bw = req_bw; ++ parm->req_offset = req_offset; ++ } ++ ++ if (flags & RTW_CMDF_DIRECTLY) { ++ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ ++ if (H2C_SUCCESS != createbss_hdl(adapter, (u8 *)parm)) ++ res = _FAIL; ++ rtw_mfree((u8 *)parm, sizeof(*parm)); ++ } else { ++ /* need enqueue, prepare cmd_obj and enqueue */ ++ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); ++ if (cmdobj == NULL) { ++ res = _FAIL; ++ rtw_mfree((u8 *)parm, sizeof(*parm)); ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_CreateBss)); ++ ++ if (flags & RTW_CMDF_WAIT_ACK) { ++ cmdobj->sctx = &sctx; ++ rtw_sctx_init(&sctx, 2000); ++ } ++ ++ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); ++ ++ if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { ++ rtw_sctx_wait(&sctx, __func__); ++ _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); ++ if (sctx.status == RTW_SCTX_SUBMITTED) ++ cmdobj->sctx = NULL; ++ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); ++ } ++ } ++ ++exit: ++ return res; ++} ++ ++inline u8 rtw_create_ibss_cmd(_adapter *adapter, int flags) ++{ ++ return rtw_createbss_cmd(adapter, flags ++ , 1 ++ , 0, -1, -1 /* for now, adhoc doesn't support ch,bw,offset request */ ++ ); ++} ++ ++inline u8 rtw_startbss_cmd(_adapter *adapter, int flags) ++{ ++ return rtw_createbss_cmd(adapter, flags ++ , 0 ++ , 0, -1, -1 /* excute entire AP setup cmd */ ++ ); ++} ++ ++inline u8 rtw_change_bss_chbw_cmd(_adapter *adapter, int flags, s16 req_ch, s8 req_bw, s8 req_offset) ++{ ++ return rtw_createbss_cmd(adapter, flags ++ , 0 ++ , req_ch, req_bw, req_offset ++ ); ++} ++ ++u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork) ++{ ++ u8 *auth, res = _SUCCESS; ++ uint t_len = 0; ++ WLAN_BSSID_EX *psecnetwork; ++ struct cmd_obj *pcmd; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct qos_priv *pqospriv = &pmlmepriv->qospriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++#ifdef CONFIG_80211N_HT ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++#endif /* CONFIG_80211N_HT */ ++#ifdef CONFIG_80211AC_VHT ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++#endif /* CONFIG_80211AC_VHT */ ++ NDIS_802_11_NETWORK_INFRASTRUCTURE ndis_network_mode = pnetwork->network.InfrastructureMode; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u32 tmp_len; ++ u8 *ptmp = NULL; ++#ifdef CONFIG_RTW_80211R ++ struct _ft_priv *pftpriv = &pmlmepriv->ftpriv; ++#endif ++ ++ rtw_led_control(padapter, LED_CTL_START_TO_LINK); ++ ++ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmd == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++#if 0 ++ /* for IEs is pointer */ ++ t_len = sizeof(ULONG) + sizeof(NDIS_802_11_MAC_ADDRESS) + 2 + ++ sizeof(NDIS_802_11_SSID) + sizeof(ULONG) + ++ sizeof(NDIS_802_11_RSSI) + sizeof(NDIS_802_11_NETWORK_TYPE) + ++ sizeof(NDIS_802_11_CONFIGURATION) + ++ sizeof(NDIS_802_11_NETWORK_INFRASTRUCTURE) + ++ sizeof(NDIS_802_11_RATES_EX) + sizeof(WLAN_PHY_INFO) + sizeof(ULONG) + MAX_IE_SZ; ++#endif ++ /* for IEs is fix buf size */ ++ t_len = sizeof(WLAN_BSSID_EX); ++ ++ ++ /* for hidden ap to set fw_state here */ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) != _TRUE) { ++ switch (ndis_network_mode) { ++ case Ndis802_11IBSS: ++ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); ++ break; ++ ++ case Ndis802_11Infrastructure: ++ set_fwstate(pmlmepriv, WIFI_STATION_STATE); ++ break; ++ ++ case Ndis802_11APMode: ++ case Ndis802_11AutoUnknown: ++ case Ndis802_11InfrastructureMax: ++ case Ndis802_11Monitor: ++ break; ++ ++ } ++ } ++ ++ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->network.IEs, pnetwork->network.IELength); ++ ++ /* ++ Modified by Arvin 2015/05/13 ++ Solution for allocating a new WLAN_BSSID_EX to avoid race condition issue between disconnect and joinbss ++ */ ++ psecnetwork = (WLAN_BSSID_EX *)rtw_zmalloc(sizeof(WLAN_BSSID_EX)); ++ if (psecnetwork == NULL) { ++ if (pcmd != NULL) ++ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); ++ ++ res = _FAIL; ++ ++ ++ goto exit; ++ } ++ ++ _rtw_memset(psecnetwork, 0, t_len); ++ ++ _rtw_memcpy(psecnetwork, &pnetwork->network, get_WLAN_BSSID_EX_sz(&pnetwork->network)); ++ ++ auth = &psecuritypriv->authenticator_ie[0]; ++ psecuritypriv->authenticator_ie[0] = (unsigned char)psecnetwork->IELength; ++ ++ if ((psecnetwork->IELength - 12) < (256 - 1)) ++ _rtw_memcpy(&psecuritypriv->authenticator_ie[1], &psecnetwork->IEs[12], psecnetwork->IELength - 12); ++ else ++ _rtw_memcpy(&psecuritypriv->authenticator_ie[1], &psecnetwork->IEs[12], (256 - 1)); ++ ++ psecnetwork->IELength = 0; ++ /* Added by Albert 2009/02/18 */ ++ /* If the the driver wants to use the bssid to create the connection. */ ++ /* If not, we have to copy the connecting AP's MAC address to it so that */ ++ /* the driver just has the bssid information for PMKIDList searching. */ ++ ++ if (pmlmepriv->assoc_by_bssid == _FALSE) ++ _rtw_memcpy(&pmlmepriv->assoc_bssid[0], &pnetwork->network.MacAddress[0], ETH_ALEN); ++ ++ psecnetwork->IELength = rtw_restruct_sec_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], pnetwork->network.IELength); ++ ++ ++ pqospriv->qos_option = 0; ++ ++ if (pregistrypriv->wmm_enable) { ++ tmp_len = rtw_restruct_wmm_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], pnetwork->network.IELength, psecnetwork->IELength); ++ ++ if (psecnetwork->IELength != tmp_len) { ++ psecnetwork->IELength = tmp_len; ++ pqospriv->qos_option = 1; /* There is WMM IE in this corresp. beacon */ ++ } else { ++ pqospriv->qos_option = 0;/* There is no WMM IE in this corresp. beacon */ ++ } ++ } ++ ++#ifdef CONFIG_80211N_HT ++ phtpriv->ht_option = _FALSE; ++ ptmp = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &tmp_len, pnetwork->network.IELength - 12); ++ if (pregistrypriv->ht_enable && ptmp && tmp_len > 0) { ++ /* Added by Albert 2010/06/23 */ ++ /* For the WEP mode, we will use the bg mode to do the connection to avoid some IOT issue. */ ++ /* Especially for Realtek 8192u SoftAP. */ ++ if ((padapter->securitypriv.dot11PrivacyAlgrthm != _WEP40_) && ++ (padapter->securitypriv.dot11PrivacyAlgrthm != _WEP104_) && ++ (padapter->securitypriv.dot11PrivacyAlgrthm != _TKIP_)) { ++ rtw_ht_use_default_setting(padapter); ++ ++ rtw_build_wmm_ie_ht(padapter, &psecnetwork->IEs[0], &psecnetwork->IELength); ++ ++ /* rtw_restructure_ht_ie */ ++ rtw_restructure_ht_ie(padapter, &pnetwork->network.IEs[12], &psecnetwork->IEs[0], ++ pnetwork->network.IELength - 12, &psecnetwork->IELength, ++ pnetwork->network.Configuration.DSConfig); ++ } ++ } ++ ++#ifdef CONFIG_80211AC_VHT ++ pvhtpriv->vht_option = _FALSE; ++ if (phtpriv->ht_option ++ && REGSTY_IS_11AC_ENABLE(pregistrypriv) ++ && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) ++ && (!pmlmepriv->country_ent || COUNTRY_CHPLAN_EN_11AC(pmlmepriv->country_ent)) ++ ) { ++ rtw_restructure_vht_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], ++ pnetwork->network.IELength, &psecnetwork->IELength); ++ } ++#endif ++ ++ rtw_append_exented_cap(padapter, &psecnetwork->IEs[0], &psecnetwork->IELength); ++ ++#endif /* CONFIG_80211N_HT */ ++ ++#ifdef CONFIG_RTW_80211R ++ /*IEEE802.11-2012 Std. Table 8-101XAKM suite selectors*/ ++ if ((rtw_chk_ft_flags(padapter, RTW_FT_STA_SUPPORTED)) && ++ ((psecuritypriv->rsn_akm_suite_type == 3) || (psecuritypriv->rsn_akm_suite_type == 4)) ++ ) { ++ ptmp = rtw_get_ie(&pnetwork->network.IEs[12], _MDIE_, &tmp_len, pnetwork->network.IELength-12); ++ if (ptmp) { ++ _rtw_memcpy(&pftpriv->mdid, ptmp+2, 2); ++ pftpriv->ft_cap = *(ptmp+4); ++ ++ RTW_INFO("FT: Target AP "MAC_FMT" MDID=(0x%2x), capacity=(0x%2x)\n", MAC_ARG(pnetwork->network.MacAddress), pftpriv->mdid, pftpriv->ft_cap); ++ rtw_set_ft_flags(padapter, RTW_FT_SUPPORTED); ++ if ((rtw_chk_ft_flags(padapter, RTW_FT_STA_OVER_DS_SUPPORTED)) && (pftpriv->ft_roam_on_expired == _FALSE) && (pftpriv->ft_cap & 0x01)) ++ rtw_set_ft_flags(padapter, RTW_FT_OVER_DS_SUPPORTED); ++ } else { ++ /*Don't use FT roaming if Target AP cannot support FT*/ ++ RTW_INFO("FT: Target AP "MAC_FMT" could not support FT\n", MAC_ARG(pnetwork->network.MacAddress)); ++ rtw_clr_ft_flags(padapter, RTW_FT_SUPPORTED|RTW_FT_OVER_DS_SUPPORTED); ++ rtw_reset_ft_status(padapter); ++ } ++ } else { ++ /*It could be a non-FT connection*/ ++ RTW_INFO("FT: non-FT rtw_joinbss_cmd\n"); ++ rtw_clr_ft_flags(padapter, RTW_FT_SUPPORTED|RTW_FT_OVER_DS_SUPPORTED); ++ rtw_reset_ft_status(padapter); ++ } ++#endif ++ ++#if 0 ++ psecuritypriv->supplicant_ie[0] = (u8)psecnetwork->IELength; ++ ++ if (psecnetwork->IELength < (256 - 1)) ++ _rtw_memcpy(&psecuritypriv->supplicant_ie[1], &psecnetwork->IEs[0], psecnetwork->IELength); ++ else ++ _rtw_memcpy(&psecuritypriv->supplicant_ie[1], &psecnetwork->IEs[0], (256 - 1)); ++#endif ++ ++ pcmd->cmdsz = sizeof(WLAN_BSSID_EX); ++ ++#ifdef CONFIG_RTL8712 ++ /* wlan_network endian conversion */ ++ psecnetwork->Length = cpu_to_le32(psecnetwork->Length); ++ psecnetwork->Ssid.SsidLength = cpu_to_le32(psecnetwork->Ssid.SsidLength); ++ psecnetwork->Privacy = cpu_to_le32(psecnetwork->Privacy); ++ psecnetwork->Rssi = cpu_to_le32(psecnetwork->Rssi); ++ psecnetwork->NetworkTypeInUse = cpu_to_le32(psecnetwork->NetworkTypeInUse); ++ psecnetwork->Configuration.ATIMWindow = cpu_to_le32(psecnetwork->Configuration.ATIMWindow); ++ psecnetwork->Configuration.BeaconPeriod = cpu_to_le32(psecnetwork->Configuration.BeaconPeriod); ++ psecnetwork->Configuration.DSConfig = cpu_to_le32(psecnetwork->Configuration.DSConfig); ++ psecnetwork->Configuration.FHConfig.DwellTime = cpu_to_le32(psecnetwork->Configuration.FHConfig.DwellTime); ++ psecnetwork->Configuration.FHConfig.HopPattern = cpu_to_le32(psecnetwork->Configuration.FHConfig.HopPattern); ++ psecnetwork->Configuration.FHConfig.HopSet = cpu_to_le32(psecnetwork->Configuration.FHConfig.HopSet); ++ psecnetwork->Configuration.FHConfig.Length = cpu_to_le32(psecnetwork->Configuration.FHConfig.Length); ++ psecnetwork->Configuration.Length = cpu_to_le32(psecnetwork->Configuration.Length); ++ psecnetwork->InfrastructureMode = cpu_to_le32(psecnetwork->InfrastructureMode); ++ psecnetwork->IELength = cpu_to_le32(psecnetwork->IELength); ++#endif ++ ++ _rtw_init_listhead(&pcmd->list); ++ pcmd->cmdcode = _JoinBss_CMD_;/* GEN_CMD_CODE(_JoinBss) */ ++ pcmd->parmbuf = (unsigned char *)psecnetwork; ++ pcmd->rsp = NULL; ++ pcmd->rspsz = 0; ++ ++ res = rtw_enqueue_cmd(pcmdpriv, pcmd); ++ ++exit: ++ ++ ++ return res; ++} ++ ++u8 rtw_disassoc_cmd(_adapter *padapter, u32 deauth_timeout_ms, bool enqueue) /* for sta_mode */ ++{ ++ struct cmd_obj *cmdobj = NULL; ++ struct disconnect_parm *param = NULL; ++ struct cmd_priv *cmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ++ ++ /* prepare cmd parameter */ ++ param = (struct disconnect_parm *)rtw_zmalloc(sizeof(*param)); ++ if (param == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ param->deauth_timeout_ms = deauth_timeout_ms; ++ ++ if (enqueue) { ++ /* need enqueue, prepare cmd_obj and enqueue */ ++ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); ++ if (cmdobj == NULL) { ++ res = _FAIL; ++ rtw_mfree((u8 *)param, sizeof(*param)); ++ goto exit; ++ } ++ init_h2fwcmd_w_parm_no_rsp(cmdobj, param, _DisConnect_CMD_); ++ res = rtw_enqueue_cmd(cmdpriv, cmdobj); ++ } else { ++ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ ++ if (H2C_SUCCESS != disconnect_hdl(padapter, (u8 *)param)) ++ res = _FAIL; ++ rtw_mfree((u8 *)param, sizeof(*param)); ++ } ++ ++exit: ++ ++ ++ return res; ++} ++ ++u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, bool enqueue) ++{ ++ struct cmd_obj *ph2c; ++ struct setopmode_parm *psetop; ++ ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ psetop = (struct setopmode_parm *)rtw_zmalloc(sizeof(struct setopmode_parm)); ++ ++ if (psetop == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ psetop->mode = (u8)networktype; ++ ++ if (enqueue) { ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ rtw_mfree((u8 *)psetop, sizeof(*psetop)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, psetop, _SetOpMode_CMD_); ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ } else { ++ setopmode_hdl(padapter, (u8 *)psetop); ++ rtw_mfree((u8 *)psetop, sizeof(*psetop)); ++ } ++exit: ++ ++ ++ return res; ++} ++ ++u8 rtw_setstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 key_type, bool enqueue) ++{ ++ struct cmd_obj *ph2c; ++ struct set_stakey_parm *psetstakey_para; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ struct set_stakey_rsp *psetstakey_rsp = NULL; ++ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ u8 res = _SUCCESS; ++ ++ ++ psetstakey_para = (struct set_stakey_parm *)rtw_zmalloc(sizeof(struct set_stakey_parm)); ++ if (psetstakey_para == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ _rtw_memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN); ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) ++ psetstakey_para->algorithm = (unsigned char) psecuritypriv->dot11PrivacyAlgrthm; ++ else ++ GET_ENCRY_ALGO(psecuritypriv, sta, psetstakey_para->algorithm, _FALSE); ++ ++ if (key_type == GROUP_KEY) ++ _rtw_memcpy(&psetstakey_para->key, &psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey, 16); ++ else if (key_type == UNICAST_KEY) ++ _rtw_memcpy(&psetstakey_para->key, &sta->dot118021x_UncstKey, 16); ++#ifdef CONFIG_TDLS ++ else if (key_type == TDLS_KEY) { ++ _rtw_memcpy(&psetstakey_para->key, sta->tpk.tk, 16); ++ psetstakey_para->algorithm = (u8)sta->dot118021XPrivacy; ++ } ++#endif /* CONFIG_TDLS */ ++ ++ /* jeff: set this becasue at least sw key is ready */ ++ padapter->securitypriv.busetkipkey = _TRUE; ++ ++ if (enqueue) { ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ psetstakey_rsp = (struct set_stakey_rsp *)rtw_zmalloc(sizeof(struct set_stakey_rsp)); ++ if (psetstakey_rsp == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); ++ ph2c->rsp = (u8 *) psetstakey_rsp; ++ ph2c->rspsz = sizeof(struct set_stakey_rsp); ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ } else { ++ set_stakey_hdl(padapter, (u8 *)psetstakey_para); ++ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); ++ } ++exit: ++ ++ ++ return res; ++} ++ ++u8 rtw_clearstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 enqueue) ++{ ++ struct cmd_obj *ph2c; ++ struct set_stakey_parm *psetstakey_para; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ struct set_stakey_rsp *psetstakey_rsp = NULL; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ s16 cam_id = 0; ++ u8 res = _SUCCESS; ++ ++ ++ if (!enqueue) { ++ while ((cam_id = rtw_camid_search(padapter, sta->hwaddr, -1, -1)) >= 0) { ++ RTW_PRINT("clear key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(sta->hwaddr), cam_id); ++ clear_cam_entry(padapter, cam_id); ++ rtw_camid_free(padapter, cam_id); ++ } ++ } else { ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ psetstakey_para = (struct set_stakey_parm *)rtw_zmalloc(sizeof(struct set_stakey_parm)); ++ if (psetstakey_para == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ psetstakey_rsp = (struct set_stakey_rsp *)rtw_zmalloc(sizeof(struct set_stakey_rsp)); ++ if (psetstakey_rsp == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); ++ ph2c->rsp = (u8 *) psetstakey_rsp; ++ ph2c->rspsz = sizeof(struct set_stakey_rsp); ++ ++ _rtw_memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN); ++ ++ psetstakey_para->algorithm = _NO_PRIVACY_; ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++ } ++ ++exit: ++ ++ ++ return res; ++} ++ ++u8 rtw_setrttbl_cmd(_adapter *padapter, struct setratable_parm *prate_table) ++{ ++ struct cmd_obj *ph2c; ++ struct setratable_parm *psetrttblparm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ psetrttblparm = (struct setratable_parm *)rtw_zmalloc(sizeof(struct setratable_parm)); ++ ++ if (psetrttblparm == NULL) { ++ rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, psetrttblparm, GEN_CMD_CODE(_SetRaTable)); ++ ++ _rtw_memcpy(psetrttblparm, prate_table, sizeof(struct setratable_parm)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++exit: ++ return res; ++ ++} ++ ++u8 rtw_getrttbl_cmd(_adapter *padapter, struct getratable_rsp *pval) ++{ ++ struct cmd_obj *ph2c; ++ struct getratable_parm *pgetrttblparm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ pgetrttblparm = (struct getratable_parm *)rtw_zmalloc(sizeof(struct getratable_parm)); ++ ++ if (pgetrttblparm == NULL) { ++ rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ /* init_h2fwcmd_w_parm_no_rsp(ph2c, psetrttblparm, GEN_CMD_CODE(_SetRaTable)); */ ++ ++ _rtw_init_listhead(&ph2c->list); ++ ph2c->cmdcode = GEN_CMD_CODE(_GetRaTable); ++ ph2c->parmbuf = (unsigned char *)pgetrttblparm; ++ ph2c->cmdsz = sizeof(struct getratable_parm); ++ ph2c->rsp = (u8 *)pval; ++ ph2c->rspsz = sizeof(struct getratable_rsp); ++ ++ pgetrttblparm->rsvd = 0x0; ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++exit: ++ return res; ++ ++} ++ ++u8 rtw_setassocsta_cmd(_adapter *padapter, u8 *mac_addr) ++{ ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ struct cmd_obj *ph2c; ++ struct set_assocsta_parm *psetassocsta_para; ++ struct set_stakey_rsp *psetassocsta_rsp = NULL; ++ ++ u8 res = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ psetassocsta_para = (struct set_assocsta_parm *)rtw_zmalloc(sizeof(struct set_assocsta_parm)); ++ if (psetassocsta_para == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ psetassocsta_rsp = (struct set_stakey_rsp *)rtw_zmalloc(sizeof(struct set_assocsta_rsp)); ++ if (psetassocsta_rsp == NULL) { ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ rtw_mfree((u8 *) psetassocsta_para, sizeof(struct set_assocsta_parm)); ++ return _FAIL; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, psetassocsta_para, _SetAssocSta_CMD_); ++ ph2c->rsp = (u8 *) psetassocsta_rsp; ++ ph2c->rspsz = sizeof(struct set_assocsta_rsp); ++ ++ _rtw_memcpy(psetassocsta_para->addr, mac_addr, ETH_ALEN); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ ++ return res; ++} ++ ++u8 rtw_addbareq_cmd(_adapter *padapter, u8 tid, u8 *addr) ++{ ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ struct cmd_obj *ph2c; ++ struct addBaReq_parm *paddbareq_parm; ++ ++ u8 res = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ paddbareq_parm = (struct addBaReq_parm *)rtw_zmalloc(sizeof(struct addBaReq_parm)); ++ if (paddbareq_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ paddbareq_parm->tid = tid; ++ _rtw_memcpy(paddbareq_parm->addr, addr, ETH_ALEN); ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, paddbareq_parm, GEN_CMD_CODE(_AddBAReq)); ++ ++ /* RTW_INFO("rtw_addbareq_cmd, tid=%d\n", tid); */ ++ ++ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ ++ return res; ++} ++ ++u8 rtw_addbarsp_cmd(_adapter *padapter, u8 *addr, u16 tid, u8 status, u8 size, u16 start_seq) ++{ ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ struct cmd_obj *ph2c; ++ struct addBaRsp_parm *paddBaRsp_parm; ++ u8 res = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ paddBaRsp_parm = (struct addBaRsp_parm *)rtw_zmalloc(sizeof(struct addBaRsp_parm)); ++ ++ if (paddBaRsp_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ _rtw_memcpy(paddBaRsp_parm->addr, addr, ETH_ALEN); ++ paddBaRsp_parm->tid = tid; ++ paddBaRsp_parm->status = status; ++ paddBaRsp_parm->size = size; ++ paddBaRsp_parm->start_seq = start_seq; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, paddBaRsp_parm, GEN_CMD_CODE(_AddBARsp)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ ++ return res; ++} ++/* add for CONFIG_IEEE80211W, none 11w can use it */ ++u8 rtw_reset_securitypriv_cmd(_adapter *padapter) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = RESET_SECURITYPRIV; ++ pdrvextra_cmd_parm->type = 0; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ ++ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ ++ return res; ++ ++} ++ ++u8 rtw_free_assoc_resources_cmd(_adapter *padapter) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = FREE_ASSOC_RESOURCES; ++ pdrvextra_cmd_parm->type = 0; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ ++ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ ++ return res; ++ ++} ++ ++u8 rtw_dynamic_chk_wk_cmd(_adapter *padapter) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ++ /* only primary padapter does this cmd */ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = DYNAMIC_CHK_WK_CID; ++ pdrvextra_cmd_parm->type = 0; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ ++ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ ++ return res; ++ ++} ++ ++u8 rtw_set_ch_cmd(_adapter *padapter, u8 ch, u8 bw, u8 ch_offset, u8 enqueue) ++{ ++ struct cmd_obj *pcmdobj; ++ struct set_ch_parm *set_ch_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ ++ u8 res = _SUCCESS; ++ ++ ++ RTW_INFO(FUNC_NDEV_FMT" ch:%u, bw:%u, ch_offset:%u\n", ++ FUNC_NDEV_ARG(padapter->pnetdev), ch, bw, ch_offset); ++ ++ /* check input parameter */ ++ ++ /* prepare cmd parameter */ ++ set_ch_parm = (struct set_ch_parm *)rtw_zmalloc(sizeof(*set_ch_parm)); ++ if (set_ch_parm == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ set_ch_parm->ch = ch; ++ set_ch_parm->bw = bw; ++ set_ch_parm->ch_offset = ch_offset; ++ ++ if (enqueue) { ++ /* need enqueue, prepare cmd_obj and enqueue */ ++ pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmdobj == NULL) { ++ rtw_mfree((u8 *)set_ch_parm, sizeof(*set_ch_parm)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(pcmdobj, set_ch_parm, GEN_CMD_CODE(_SetChannel)); ++ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); ++ } else { ++ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ ++ if (H2C_SUCCESS != set_ch_hdl(padapter, (u8 *)set_ch_parm)) ++ res = _FAIL; ++ ++ rtw_mfree((u8 *)set_ch_parm, sizeof(*set_ch_parm)); ++ } ++ ++ /* do something based on res... */ ++ ++exit: ++ ++ RTW_INFO(FUNC_NDEV_FMT" res:%u\n", FUNC_NDEV_ARG(padapter->pnetdev), res); ++ ++ ++ return res; ++} ++ ++u8 _rtw_set_chplan_cmd(_adapter *adapter, int flags, u8 chplan, const struct country_chplan *country_ent, u8 swconfig) ++{ ++ struct cmd_obj *cmdobj; ++ struct SetChannelPlan_param *parm; ++ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct submit_ctx sctx; ++ u8 res = _SUCCESS; ++ ++ ++ /* check if allow software config */ ++ if (swconfig && rtw_hal_is_disable_sw_channel_plan(adapter) == _TRUE) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ /* if country_entry is provided, replace chplan */ ++ if (country_ent) ++ chplan = country_ent->chplan; ++ ++ /* check input parameter */ ++ if (!rtw_is_channel_plan_valid(chplan)) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ /* prepare cmd parameter */ ++ parm = (struct SetChannelPlan_param *)rtw_zmalloc(sizeof(*parm)); ++ if (parm == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ parm->country_ent = country_ent; ++ parm->channel_plan = chplan; ++ ++ if (flags & RTW_CMDF_DIRECTLY) { ++ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ ++ if (H2C_SUCCESS != set_chplan_hdl(adapter, (u8 *)parm)) ++ res = _FAIL; ++ rtw_mfree((u8 *)parm, sizeof(*parm)); ++ } else { ++ /* need enqueue, prepare cmd_obj and enqueue */ ++ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); ++ if (cmdobj == NULL) { ++ res = _FAIL; ++ rtw_mfree((u8 *)parm, sizeof(*parm)); ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_SetChannelPlan)); ++ ++ if (flags & RTW_CMDF_WAIT_ACK) { ++ cmdobj->sctx = &sctx; ++ rtw_sctx_init(&sctx, 2000); ++ } ++ ++ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); ++ ++ if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { ++ rtw_sctx_wait(&sctx, __func__); ++ _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); ++ if (sctx.status == RTW_SCTX_SUBMITTED) ++ cmdobj->sctx = NULL; ++ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); ++ } ++ } ++ ++exit: ++ ++ ++ return res; ++} ++ ++inline u8 rtw_set_chplan_cmd(_adapter *adapter, int flags, u8 chplan, u8 swconfig) ++{ ++ return _rtw_set_chplan_cmd(adapter, flags, chplan, NULL, swconfig); ++} ++ ++inline u8 rtw_set_country_cmd(_adapter *adapter, int flags, const char *country_code, u8 swconfig) ++{ ++ const struct country_chplan *ent; ++ ++ if (is_alpha(country_code[0]) == _FALSE ++ || is_alpha(country_code[1]) == _FALSE ++ ) { ++ RTW_PRINT("%s input country_code is not alpha2\n", __func__); ++ return _FAIL; ++ } ++ ++ ent = rtw_get_chplan_from_country(country_code); ++ ++ if (ent == NULL) { ++ RTW_PRINT("%s unsupported country_code:\"%c%c\"\n", __func__, country_code[0], country_code[1]); ++ return _FAIL; ++ } ++ ++ RTW_PRINT("%s country_code:\"%c%c\" mapping to chplan:0x%02x\n", __func__, country_code[0], country_code[1], ent->chplan); ++ ++ return _rtw_set_chplan_cmd(adapter, flags, RTW_CHPLAN_MAX, ent, swconfig); ++} ++ ++u8 rtw_led_blink_cmd(_adapter *padapter, PVOID pLed) ++{ ++ struct cmd_obj *pcmdobj; ++ struct LedBlink_param *ledBlink_param; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ ++ u8 res = _SUCCESS; ++ ++ ++ ++ pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmdobj == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ ledBlink_param = (struct LedBlink_param *)rtw_zmalloc(sizeof(struct LedBlink_param)); ++ if (ledBlink_param == NULL) { ++ rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ ledBlink_param->pLed = pLed; ++ ++ init_h2fwcmd_w_parm_no_rsp(pcmdobj, ledBlink_param, GEN_CMD_CODE(_LedBlink)); ++ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); ++ ++exit: ++ ++ ++ return res; ++} ++ ++u8 rtw_set_csa_cmd(_adapter *padapter, u8 new_ch_no) ++{ ++ struct cmd_obj *pcmdobj; ++ struct SetChannelSwitch_param *setChannelSwitch_param; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ ++ u8 res = _SUCCESS; ++ ++ ++ ++ pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmdobj == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ setChannelSwitch_param = (struct SetChannelSwitch_param *)rtw_zmalloc(sizeof(struct SetChannelSwitch_param)); ++ if (setChannelSwitch_param == NULL) { ++ rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ setChannelSwitch_param->new_ch_no = new_ch_no; ++ ++ init_h2fwcmd_w_parm_no_rsp(pcmdobj, setChannelSwitch_param, GEN_CMD_CODE(_SetChannelSwitch)); ++ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); ++ ++exit: ++ ++ ++ return res; ++} ++ ++u8 rtw_tdls_cmd(_adapter *padapter, u8 *addr, u8 option) ++{ ++ struct cmd_obj *pcmdobj; ++ struct TDLSoption_param *TDLSoption; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ ++ u8 res = _SUCCESS; ++ ++ ++#ifdef CONFIG_TDLS ++ ++ ++ pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmdobj == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ TDLSoption = (struct TDLSoption_param *)rtw_zmalloc(sizeof(struct TDLSoption_param)); ++ if (TDLSoption == NULL) { ++ rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ _rtw_spinlock(&(padapter->tdlsinfo.cmd_lock)); ++ if (addr != NULL) ++ _rtw_memcpy(TDLSoption->addr, addr, 6); ++ TDLSoption->option = option; ++ _rtw_spinunlock(&(padapter->tdlsinfo.cmd_lock)); ++ init_h2fwcmd_w_parm_no_rsp(pcmdobj, TDLSoption, GEN_CMD_CODE(_TDLS)); ++ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); ++ ++#endif /* CONFIG_TDLS */ ++ ++exit: ++ ++ ++ ++ return res; ++} ++ ++u8 rtw_enable_hw_update_tsf_cmd(_adapter *padapter) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = EN_HW_UPDATE_TSF_WK_CID; ++ pdrvextra_cmd_parm->type = 0; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ return res; ++} ++ ++/* from_timer == 1 means driver is in LPS */ ++u8 traffic_status_watchdog(_adapter *padapter, u8 from_timer) ++{ ++ u8 bEnterPS = _FALSE; ++ u16 BusyThresholdHigh; ++ u16 BusyThresholdLow; ++ u16 BusyThreshold; ++ u8 bBusyTraffic = _FALSE, bTxBusyTraffic = _FALSE, bRxBusyTraffic = _FALSE; ++ u8 bHigherBusyTraffic = _FALSE, bHigherBusyRxTraffic = _FALSE, bHigherBusyTxTraffic = _FALSE; ++ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++#ifdef CONFIG_TDLS ++ struct tdls_info *ptdlsinfo = &(padapter->tdlsinfo); ++ struct tdls_txmgmt txmgmt; ++ u8 baddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; ++#endif /* CONFIG_TDLS */ ++ ++ RT_LINK_DETECT_T *link_detect = &pmlmepriv->LinkDetectInfo; ++ ++#ifdef CONFIG_BT_COEXIST ++ if (padapter->registrypriv.wifi_spec != 1) { ++ BusyThresholdHigh = 25; ++ BusyThresholdLow = 10; ++ } else ++#endif /* CONFIG_BT_COEXIST */ ++ { ++ BusyThresholdHigh = 100; ++ BusyThresholdLow = 75; ++ } ++ BusyThreshold = BusyThresholdHigh; ++ ++ ++ /* */ ++ /* Determine if our traffic is busy now */ ++ /* */ ++ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ /*&& !MgntInitAdapterInProgress(pMgntInfo)*/) { ++ /* if we raise bBusyTraffic in last watchdog, using lower threshold. */ ++ if (pmlmepriv->LinkDetectInfo.bBusyTraffic) ++ BusyThreshold = BusyThresholdLow; ++ ++ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > BusyThreshold || ++ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > BusyThreshold) { ++ bBusyTraffic = _TRUE; ++ ++ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) ++ bRxBusyTraffic = _TRUE; ++ else ++ bTxBusyTraffic = _TRUE; ++ } ++ ++ /* Higher Tx/Rx data. */ ++ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > 4000 || ++ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > 4000) { ++ bHigherBusyTraffic = _TRUE; ++ ++ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) ++ bHigherBusyRxTraffic = _TRUE; ++ else ++ bHigherBusyTxTraffic = _TRUE; ++ } ++ ++#ifdef CONFIG_TRAFFIC_PROTECT ++#define TX_ACTIVE_TH 10 ++#define RX_ACTIVE_TH 20 ++#define TRAFFIC_PROTECT_PERIOD_MS 4500 ++ ++ if (link_detect->NumTxOkInPeriod > TX_ACTIVE_TH ++ || link_detect->NumRxUnicastOkInPeriod > RX_ACTIVE_TH) { ++ ++ RTW_INFO(FUNC_ADPT_FMT" acqiure wake_lock for %u ms(tx:%d,rx_unicast:%d)\n", ++ FUNC_ADPT_ARG(padapter), ++ TRAFFIC_PROTECT_PERIOD_MS, ++ link_detect->NumTxOkInPeriod, ++ link_detect->NumRxUnicastOkInPeriod); ++ ++ rtw_lock_traffic_suspend_timeout(TRAFFIC_PROTECT_PERIOD_MS); ++ } ++#endif ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_TDLS_AUTOSETUP ++ /* TDLS_WATCHDOG_PERIOD * 2sec, periodically send */ ++ if (hal_chk_wl_func(padapter, WL_FUNC_TDLS) == _TRUE) { ++ if ((ptdlsinfo->watchdog_count % TDLS_WATCHDOG_PERIOD) == 0) { ++ _rtw_memcpy(txmgmt.peer, baddr, ETH_ALEN); ++ issue_tdls_dis_req(padapter, &txmgmt); ++ } ++ ptdlsinfo->watchdog_count++; ++ } ++#endif /* CONFIG_TDLS_AUTOSETUP */ ++#endif /* CONFIG_TDLS */ ++ ++#ifdef CONFIG_LPS ++ /* check traffic for powersaving. */ ++ if (((pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod + pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) > 8) || ++#ifdef CONFIG_LPS_SLOW_TRANSITION ++ (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 2) ++#else /* CONFIG_LPS_SLOW_TRANSITION */ ++ (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 4) ++#endif /* CONFIG_LPS_SLOW_TRANSITION */ ++ ) { ++#ifdef DBG_RX_COUNTER_DUMP ++ if (padapter->dump_rx_cnt_mode & DUMP_DRV_TRX_COUNTER_DATA) ++ RTW_INFO("(-)Tx = %d, Rx = %d\n", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); ++#endif ++ bEnterPS = _FALSE; ++#ifdef CONFIG_LPS_SLOW_TRANSITION ++ if (bBusyTraffic == _TRUE) { ++ if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount <= 4) ++ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 4; ++ ++ pmlmepriv->LinkDetectInfo.TrafficTransitionCount++; ++ ++ /* RTW_INFO("Set TrafficTransitionCount to %d\n", pmlmepriv->LinkDetectInfo.TrafficTransitionCount); */ ++ ++ if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount > 30/*TrafficTransitionLevel*/) ++ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 30; ++ } ++#endif /* CONFIG_LPS_SLOW_TRANSITION */ ++ ++ } else { ++#ifdef DBG_RX_COUNTER_DUMP ++ if (padapter->dump_rx_cnt_mode & DUMP_DRV_TRX_COUNTER_DATA) ++ RTW_INFO("(+)Tx = %d, Rx = %d\n", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); ++#endif ++#ifdef CONFIG_LPS_SLOW_TRANSITION ++ if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount >= 2) ++ pmlmepriv->LinkDetectInfo.TrafficTransitionCount -= 2; ++ else ++ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; ++ ++ if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount == 0) ++ bEnterPS = _TRUE; ++#else /* CONFIG_LPS_SLOW_TRANSITION */ ++ bEnterPS = _TRUE; ++#endif /* CONFIG_LPS_SLOW_TRANSITION */ ++ } ++ ++#ifdef CONFIG_DYNAMIC_DTIM ++ if (pmlmepriv->LinkDetectInfo.LowPowerTransitionCount == 8) ++ bEnterPS = _FALSE; ++ ++ RTW_INFO("LowPowerTransitionCount=%d\n", pmlmepriv->LinkDetectInfo.LowPowerTransitionCount); ++#endif /* CONFIG_DYNAMIC_DTIM */ ++ ++ /* LeisurePS only work in infra mode. */ ++ if (bEnterPS) { ++ if (!from_timer) { ++#ifdef CONFIG_DYNAMIC_DTIM ++ if (pmlmepriv->LinkDetectInfo.LowPowerTransitionCount < 8) ++ adapter_to_pwrctl(padapter)->dtim = 1; ++ else ++ adapter_to_pwrctl(padapter)->dtim = 3; ++#endif /* CONFIG_DYNAMIC_DTIM */ ++ LPS_Enter(padapter, "TRAFFIC_IDLE"); ++ } else { ++ /* do this at caller */ ++ /* rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_ENTER, 1); */ ++ /* rtw_hal_dm_watchdog_in_lps(padapter); */ ++ } ++#ifdef CONFIG_DYNAMIC_DTIM ++ if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) ++ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount++; ++#endif /* CONFIG_DYNAMIC_DTIM */ ++ } else { ++#ifdef CONFIG_DYNAMIC_DTIM ++ if (pmlmepriv->LinkDetectInfo.LowPowerTransitionCount != 8) ++ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; ++ else ++ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount++; ++#endif /* CONFIG_DYNAMIC_DTIM */ ++ if (!from_timer) ++ LPS_Leave(padapter, "TRAFFIC_BUSY"); ++ else { ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->hw_port == HW_PORT0) ++#endif ++ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_TRAFFIC_BUSY, 1); ++ } ++ } ++ ++#endif /* CONFIG_LPS */ ++ } else { ++#ifdef CONFIG_LPS ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ int n_assoc_iface = 0; ++ int i; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) ++ n_assoc_iface++; ++ } ++ ++ if (!from_timer && n_assoc_iface == 0) ++ LPS_Leave(padapter, "NON_LINKED"); ++#endif ++ } ++ ++ session_tracker_chk_cmd(padapter, NULL); ++ ++ pmlmepriv->LinkDetectInfo.NumRxOkInPeriod = 0; ++ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod = 0; ++ pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod = 0; ++ pmlmepriv->LinkDetectInfo.bBusyTraffic = bBusyTraffic; ++ pmlmepriv->LinkDetectInfo.bTxBusyTraffic = bTxBusyTraffic; ++ pmlmepriv->LinkDetectInfo.bRxBusyTraffic = bRxBusyTraffic; ++ pmlmepriv->LinkDetectInfo.bHigherBusyTraffic = bHigherBusyTraffic; ++ pmlmepriv->LinkDetectInfo.bHigherBusyRxTraffic = bHigherBusyRxTraffic; ++ pmlmepriv->LinkDetectInfo.bHigherBusyTxTraffic = bHigherBusyTxTraffic; ++ ++ return bEnterPS; ++ ++} ++ ++ ++/* for 11n Logo 4.2.31/4.2.32 */ ++static void dynamic_update_bcn_check(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ if (!padapter->registrypriv.wifi_spec) ++ return; ++ ++ if (!MLME_IS_AP(padapter)) ++ return; ++ ++#if defined(CONFIG_80211N_HT) && defined(CONFIG_AP_MODE) ++ if (pmlmeext->bstart_bss) { ++ /* In 10 * 2 = 20s, there are no legacy AP, update HT info */ ++ static u8 count = 1; ++ if (count % 10 == 0) { ++ count = 1; ++ if (_FALSE == ATOMIC_READ(&pmlmepriv->olbc) ++ && _FALSE == ATOMIC_READ(&pmlmepriv->olbc_ht)) { ++ if (rtw_ht_operation_update(padapter) > 0) { ++ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE); ++ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); ++ } ++ } ++ } ++ /* In 2s, there are any legacy AP, update HT info, and then reset count */ ++ ++ if (_FALSE != ATOMIC_READ(&pmlmepriv->olbc) ++ && _FALSE != ATOMIC_READ(&pmlmepriv->olbc_ht)) { ++ ++ if (rtw_ht_operation_update(padapter) > 0) { ++ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE); ++ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); ++ ++ } ++ ATOMIC_SET(&pmlmepriv->olbc, _FALSE); ++ ATOMIC_SET(&pmlmepriv->olbc_ht, _FALSE); ++ count = 0; ++ } ++ count ++; ++ } ++#endif /* CONFIG_80211N_HT */ ++} ++void rtw_iface_dynamic_chk_wk_hdl(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++ #ifdef CONFIG_AP_MODE ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ expire_timeout_chk(padapter); ++ #endif ++ #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ ++ dynamic_update_bcn_check(padapter); ++ ++ linked_status_chk(padapter, 0); ++ traffic_status_watchdog(padapter, 0); ++ ++ /* for debug purpose */ ++ _linked_info_dump(padapter); ++ ++ #ifdef CONFIG_BEAMFORMING ++ #ifndef RTW_BEAMFORMING_VERSION_2 ++ #if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ ++ beamforming_watchdog(padapter); ++ #endif ++ #endif /* !RTW_BEAMFORMING_VERSION_2 */ ++ #endif ++ ++} ++void rtw_dynamic_chk_wk_hdl(_adapter *padapter) ++{ ++ rtw_mi_dynamic_chk_wk_hdl(padapter); ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ rtw_hal_sreset_xmit_status_check(padapter); ++ rtw_hal_sreset_linked_status_check(padapter); ++#endif ++ ++ /* if(check_fwstate(pmlmepriv, _FW_UNDER_LINKING|_FW_UNDER_SURVEY)==_FALSE) */ ++ { ++#ifdef DBG_RX_COUNTER_DUMP ++ rtw_dump_rx_counters(padapter); ++#endif ++ dm_DynamicUsbTxAgg(padapter, 0); ++ } ++ rtw_hal_dm_watchdog(padapter); ++ ++ /* check_hw_pbc(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->type); */ ++ ++#ifdef CONFIG_BT_COEXIST ++ /* BT-Coexist */ ++ rtw_btcoex_Handler(padapter); ++#endif ++ ++#ifdef CONFIG_IPS_CHECK_IN_WD ++ /* always call rtw_ps_processor() at last one. */ ++ rtw_ps_processor(padapter); ++#endif ++ ++#ifdef CONFIG_MCC_MODE ++ rtw_hal_mcc_sw_status_check(padapter); ++#endif /* CONFIG_MCC_MODE */ ++ ++} ++ ++#ifdef CONFIG_LPS ++ ++void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type); ++void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u8 mstatus; ++ ++ ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) ++ || (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) ++ return; ++ ++ switch (lps_ctrl_type) { ++ case LPS_CTRL_SCAN: ++ /* RTW_INFO("LPS_CTRL_SCAN\n"); */ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_ScanNotify(padapter, _TRUE); ++#endif /* CONFIG_BT_COEXIST */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ /* connect */ ++ LPS_Leave(padapter, "LPS_CTRL_SCAN"); ++ } ++ break; ++ case LPS_CTRL_JOINBSS: ++ /* RTW_INFO("LPS_CTRL_JOINBSS\n"); */ ++ LPS_Leave(padapter, "LPS_CTRL_JOINBSS"); ++ break; ++ case LPS_CTRL_CONNECT: ++ /* RTW_INFO("LPS_CTRL_CONNECT\n"); */ ++ mstatus = 1;/* connect */ ++ /* Reset LPS Setting */ ++ pwrpriv->LpsIdleCount = 0; ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus)); ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_MediaStatusNotify(padapter, mstatus); ++#endif /* CONFIG_BT_COEXIST */ ++ break; ++ case LPS_CTRL_DISCONNECT: ++ /* RTW_INFO("LPS_CTRL_DISCONNECT\n"); */ ++ mstatus = 0;/* disconnect */ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_MediaStatusNotify(padapter, mstatus); ++#endif /* CONFIG_BT_COEXIST */ ++ LPS_Leave(padapter, "LPS_CTRL_DISCONNECT"); ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus)); ++ break; ++ case LPS_CTRL_SPECIAL_PACKET: ++ /* RTW_INFO("LPS_CTRL_SPECIAL_PACKET\n"); */ ++ pwrpriv->DelayLPSLastTimeStamp = rtw_get_current_time(); ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_SpecialPacketNotify(padapter, PACKET_DHCP); ++#endif /* CONFIG_BT_COEXIST */ ++ LPS_Leave(padapter, "LPS_CTRL_SPECIAL_PACKET"); ++ break; ++ case LPS_CTRL_LEAVE: ++ LPS_Leave(padapter, "LPS_CTRL_LEAVE"); ++ break; ++ case LPS_CTRL_LEAVE_CFG80211_PWRMGMT: ++ LPS_Leave(padapter, "CFG80211_PWRMGMT"); ++ break; ++ case LPS_CTRL_TRAFFIC_BUSY: ++ LPS_Leave(padapter, "LPS_CTRL_TRAFFIC_BUSY"); ++ break; ++ case LPS_CTRL_TX_TRAFFIC_LEAVE: ++ LPS_Leave(padapter, "LPS_CTRL_TX_TRAFFIC_LEAVE"); ++ break; ++ case LPS_CTRL_RX_TRAFFIC_LEAVE: ++ LPS_Leave(padapter, "LPS_CTRL_RX_TRAFFIC_LEAVE"); ++ break; ++ case LPS_CTRL_ENTER: ++ LPS_Enter(padapter, "TRAFFIC_IDLE_1"); ++ break; ++ default: ++ break; ++ } ++ ++} ++ ++u8 rtw_lps_ctrl_wk_cmd(_adapter *padapter, u8 lps_ctrl_type, u8 enqueue) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ /* struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); */ ++ u8 res = _SUCCESS; ++ ++ ++ /* if(!pwrctrlpriv->bLeisurePs) */ ++ /* return res; */ ++ ++ if (enqueue) { ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = LPS_CTRL_WK_CID; ++ pdrvextra_cmd_parm->type = lps_ctrl_type; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ } else ++ lps_ctrl_wk_hdl(padapter, lps_ctrl_type); ++ ++exit: ++ ++ ++ return res; ++ ++} ++ ++void rtw_dm_in_lps_hdl(_adapter *padapter) ++{ ++ rtw_hal_set_hwreg(padapter, HW_VAR_DM_IN_LPS, NULL); ++} ++ ++u8 rtw_dm_in_lps_wk_cmd(_adapter *padapter) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = DM_IN_LPS_WK_CID; ++ pdrvextra_cmd_parm->type = 0; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ return res; ++ ++} ++ ++void rtw_lps_change_dtim_hdl(_adapter *padapter, u8 dtim) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ ++ if (dtim <= 0 || dtim > 16) ++ return; ++ ++#ifdef CONFIG_BT_COEXIST ++ if (rtw_btcoex_IsBtControlLps(padapter) == _TRUE) ++ return; ++#endif ++ ++#ifdef CONFIG_LPS_LCLK ++ _enter_pwrlock(&pwrpriv->lock); ++#endif ++ ++ if (pwrpriv->dtim != dtim) { ++ RTW_INFO("change DTIM from %d to %d, bFwCurrentInPSMode=%d, ps_mode=%d\n", pwrpriv->dtim, dtim, ++ pwrpriv->bFwCurrentInPSMode, pwrpriv->pwr_mode); ++ ++ pwrpriv->dtim = dtim; ++ } ++ ++ if ((pwrpriv->bFwCurrentInPSMode == _TRUE) && (pwrpriv->pwr_mode > PS_MODE_ACTIVE)) { ++ u8 ps_mode = pwrpriv->pwr_mode; ++ ++ /* RTW_INFO("change DTIM from %d to %d, ps_mode=%d\n", pwrpriv->dtim, dtim, ps_mode); */ ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); ++ } ++ ++#ifdef CONFIG_LPS_LCLK ++ _exit_pwrlock(&pwrpriv->lock); ++#endif ++ ++} ++ ++#endif ++ ++u8 rtw_lps_change_dtim_cmd(_adapter *padapter, u8 dtim) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ /* ++ #ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->hw_port != HW_PORT0) ++ return res; ++ #endif ++ */ ++ { ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = LPS_CHANGE_DTIM_CID; ++ pdrvextra_cmd_parm->type = dtim; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ } ++ ++exit: ++ ++ return res; ++ ++} ++ ++#if (RATE_ADAPTIVE_SUPPORT == 1) ++void rpt_timer_setting_wk_hdl(_adapter *padapter, u16 minRptTime) ++{ ++ rtw_hal_set_hwreg(padapter, HW_VAR_RPT_TIMER_SETTING, (u8 *)(&minRptTime)); ++} ++ ++u8 rtw_rpt_timer_cfg_cmd(_adapter *padapter, u16 minRptTime) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ ++ u8 res = _SUCCESS; ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = RTP_TIMER_CFG_WK_CID; ++ pdrvextra_cmd_parm->type = minRptTime; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++exit: ++ ++ ++ return res; ++ ++} ++ ++#endif ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++void antenna_select_wk_hdl(_adapter *padapter, u8 antenna) ++{ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_ANTDIV_SELECT, &antenna, _TRUE); ++} ++ ++u8 rtw_antenna_select_cmd(_adapter *padapter, u8 antenna, u8 enqueue) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ u8 bSupportAntDiv = _FALSE; ++ u8 res = _SUCCESS; ++ int i; ++ ++ rtw_hal_get_def_var(padapter, HAL_DEF_IS_SUPPORT_ANT_DIV, &(bSupportAntDiv)); ++ if (_FALSE == bSupportAntDiv) ++ return _FAIL; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (rtw_linked_check(dvobj->padapters[i])) ++ return _FAIL; ++ } ++ ++ if (_TRUE == enqueue) { ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = ANT_SELECT_WK_CID; ++ pdrvextra_cmd_parm->type = antenna; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ } else ++ antenna_select_wk_hdl(padapter, antenna); ++exit: ++ ++ ++ return res; ++ ++} ++#endif ++ ++void rtw_dm_ra_mask_hdl(_adapter *padapter, struct sta_info *psta) ++{ ++ if (psta) ++ set_sta_rate(padapter, psta); ++} ++ ++u8 rtw_dm_ra_mask_wk_cmd(_adapter *padapter, u8 *psta) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = DM_RA_MSK_WK_CID; ++ pdrvextra_cmd_parm->type = 0; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = psta; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ return res; ++ ++} ++ ++void power_saving_wk_hdl(_adapter *padapter) ++{ ++ rtw_ps_processor(padapter); ++} ++ ++/* add for CONFIG_IEEE80211W, none 11w can use it */ ++void reset_securitypriv_hdl(_adapter *padapter) ++{ ++ rtw_reset_securitypriv(padapter); ++} ++ ++void free_assoc_resources_hdl(_adapter *padapter) ++{ ++ rtw_free_assoc_resources(padapter, 1); ++} ++ ++#ifdef CONFIG_P2P ++u8 p2p_protocol_wk_cmd(_adapter *padapter, int intCmdType) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ return res; ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = P2P_PROTO_WK_CID; ++ pdrvextra_cmd_parm->type = intCmdType; /* As the command tppe. */ ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; /* Must be NULL here */ ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ ++ return res; ++ ++} ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++static u8 _p2p_roch_cmd(_adapter *adapter ++ , u64 cookie, struct wireless_dev *wdev ++ , struct ieee80211_channel *ch, enum nl80211_channel_type ch_type ++ , unsigned int duration ++ , u8 flags ++) ++{ ++ struct cmd_obj *cmdobj; ++ struct drvextra_cmd_parm *parm; ++ struct p2p_roch_parm *roch_parm; ++ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; ++ struct submit_ctx sctx; ++ u8 cancel = duration ? 0 : 1; ++ u8 res = _SUCCESS; ++ ++ roch_parm = (struct p2p_roch_parm *)rtw_zmalloc(sizeof(struct p2p_roch_parm)); ++ if (roch_parm == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ roch_parm->cookie = cookie; ++ roch_parm->wdev = wdev; ++ if (!cancel) { ++ _rtw_memcpy(&roch_parm->ch, ch, sizeof(struct ieee80211_channel)); ++ roch_parm->ch_type = ch_type; ++ roch_parm->duration = duration; ++ } ++ ++ if (flags & RTW_CMDF_DIRECTLY) { ++ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ ++ if (H2C_SUCCESS != p2p_protocol_wk_hdl(adapter, cancel ? P2P_CANCEL_RO_CH_WK : P2P_RO_CH_WK, (u8 *)roch_parm)) ++ res = _FAIL; ++ rtw_mfree((u8 *)roch_parm, sizeof(*roch_parm)); ++ } else { ++ /* need enqueue, prepare cmd_obj and enqueue */ ++ parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (parm == NULL) { ++ rtw_mfree((u8 *)roch_parm, sizeof(*roch_parm)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ parm->ec_id = P2P_PROTO_WK_CID; ++ parm->type = cancel ? P2P_CANCEL_RO_CH_WK : P2P_RO_CH_WK; ++ parm->size = sizeof(*roch_parm); ++ parm->pbuf = (u8 *)roch_parm; ++ ++ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); ++ if (cmdobj == NULL) { ++ res = _FAIL; ++ rtw_mfree((u8 *)roch_parm, sizeof(*roch_parm)); ++ rtw_mfree((u8 *)parm, sizeof(*parm)); ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ if (flags & RTW_CMDF_WAIT_ACK) { ++ cmdobj->sctx = &sctx; ++ rtw_sctx_init(&sctx, 10 * 1000); ++ } ++ ++ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); ++ ++ if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { ++ rtw_sctx_wait(&sctx, __func__); ++ _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); ++ if (sctx.status == RTW_SCTX_SUBMITTED) ++ cmdobj->sctx = NULL; ++ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); ++ if (sctx.status != RTW_SCTX_DONE_SUCCESS) ++ res = _FAIL; ++ } ++ } ++ ++exit: ++ return res; ++} ++ ++inline u8 p2p_roch_cmd(_adapter *adapter ++ , u64 cookie, struct wireless_dev *wdev ++ , struct ieee80211_channel *ch, enum nl80211_channel_type ch_type ++ , unsigned int duration ++ , u8 flags ++) ++{ ++ return _p2p_roch_cmd(adapter, cookie, wdev, ch, ch_type, duration, flags); ++} ++ ++inline u8 p2p_cancel_roch_cmd(_adapter *adapter, u64 cookie, struct wireless_dev *wdev, u8 flags) ++{ ++ return _p2p_roch_cmd(adapter, cookie, wdev, NULL, 0, 0, flags); ++} ++#endif /* CONFIG_IOCTL_CFG80211 */ ++#endif /* CONFIG_P2P */ ++ ++u8 rtw_ps_cmd(_adapter *padapter) ++{ ++ struct cmd_obj *ppscmd; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ ++ u8 res = _SUCCESS; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->adapter_type != PRIMARY_ADAPTER) ++ goto exit; ++#endif ++ ++ ppscmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ppscmd == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ppscmd, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = POWER_SAVING_CTRL_WK_CID; ++ pdrvextra_cmd_parm->type = 0; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; ++ init_h2fwcmd_w_parm_no_rsp(ppscmd, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ppscmd); ++ ++exit: ++ ++ ++ return res; ++ ++} ++ ++#ifdef CONFIG_AP_MODE ++ ++static void rtw_chk_hi_queue_hdl(_adapter *padapter) ++{ ++ struct sta_info *psta_bmc; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u32 start = rtw_get_current_time(); ++ u8 empty = _FALSE; ++ ++ psta_bmc = rtw_get_bcmc_stainfo(padapter); ++ if (!psta_bmc) ++ return; ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); ++ ++ while (_FALSE == empty && rtw_get_passing_time_ms(start) < rtw_get_wait_hiq_empty_ms()) { ++ rtw_msleep_os(100); ++ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); ++ } ++ ++ if (psta_bmc->sleepq_len == 0) { ++ if (empty == _SUCCESS) { ++ bool update_tim = _FALSE; ++ ++ if (pstapriv->tim_bitmap & BIT(0)) ++ update_tim = _TRUE; ++ ++ pstapriv->tim_bitmap &= ~BIT(0); ++ pstapriv->sta_dz_bitmap &= ~BIT(0); ++ ++ if (update_tim == _TRUE) ++ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "bmc sleepq and HIQ empty"); ++ } else /* re check again */ ++ rtw_chk_hi_queue_cmd(padapter); ++ ++ } ++ ++} ++ ++u8 rtw_chk_hi_queue_cmd(_adapter *padapter) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = CHECK_HIQ_WK_CID; ++ pdrvextra_cmd_parm->type = 0; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ return res; ++ ++} ++ ++#ifdef CONFIG_DFS_MASTER ++u8 rtw_dfs_master_hdl(_adapter *adapter) ++{ ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ ++ if (!rfctl->dfs_master_enabled) ++ goto exit; ++ ++ if (rtw_get_on_cur_ch_time(adapter) == 0 ++ || rtw_get_passing_time_ms(rtw_get_on_cur_ch_time(adapter)) < 300 ++ ) { ++ /* offchannel , bypass radar detect */ ++ goto cac_status_chk; ++ } ++ ++ if (IS_CH_WAITING(rfctl) && !IS_UNDER_CAC(rfctl)) { ++ /* non_ocp, bypass radar detect */ ++ goto cac_status_chk; ++ } ++ ++ if (!rfctl->dbg_dfs_master_fake_radar_detect_cnt ++ && rtw_odm_radar_detect(adapter) != _TRUE) ++ goto cac_status_chk; ++ ++ if (rfctl->dbg_dfs_master_fake_radar_detect_cnt != 0) { ++ RTW_INFO(FUNC_ADPT_FMT" fake radar detect, cnt:%d\n", FUNC_ADPT_ARG(adapter) ++ , rfctl->dbg_dfs_master_fake_radar_detect_cnt); ++ rfctl->dbg_dfs_master_fake_radar_detect_cnt--; ++ } ++ ++ if (rfctl->dbg_dfs_master_radar_detect_trigger_non) { ++ /* radar detect debug mode, trigger no mlme flow */ ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" radar detected, trigger no mlme flow for debug\n", FUNC_ADPT_ARG(adapter)); ++ } else { ++ /* TODO: move timer to rfctl */ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ int i; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (!dvobj->padapters[i]) ++ continue; ++ if (check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_AP_STATE) ++ && check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_ASOC_STATE)) ++ break; ++ } ++ ++ if (i >= dvobj->iface_nums) { ++ /* what? */ ++ rtw_warn_on(1); ++ } else { ++ rtw_chset_update_non_ocp(dvobj->padapters[i]->mlmeextpriv.channel_set ++ , rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset); ++ rfctl->radar_detected = 1; ++ ++ /* trigger channel selection */ ++ rtw_change_bss_chbw_cmd(dvobj->padapters[i], RTW_CMDF_DIRECTLY, -1, dvobj->padapters[i]->mlmepriv.ori_bw, -1); ++ } ++ ++ if (rfctl->dfs_master_enabled) ++ goto set_timer; ++ goto exit; ++ } ++ ++cac_status_chk: ++ ++ if (!IS_CH_WAITING(rfctl) && !IS_CAC_STOPPED(rfctl)) { ++ u8 pause = 0x00; ++ ++ rtw_hal_set_hwreg(adapter, HW_VAR_TXPAUSE, &pause); ++ rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; ++ } ++ ++set_timer: ++ _set_timer(&mlme->dfs_master_timer, DFS_MASTER_TIMER_MS); ++ ++exit: ++ return H2C_SUCCESS; ++} ++ ++u8 rtw_dfs_master_cmd(_adapter *adapter, bool enqueue) ++{ ++ struct cmd_obj *cmdobj; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; ++ u8 res = _FAIL; ++ ++ if (enqueue) { ++ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (cmdobj == NULL) ++ goto exit; ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = DFS_MASTER_WK_CID; ++ pdrvextra_cmd_parm->type = 0; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; ++ ++ init_h2fwcmd_w_parm_no_rsp(cmdobj, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); ++ } else { ++ rtw_dfs_master_hdl(adapter); ++ res = _SUCCESS; ++ } ++ ++exit: ++ return res; ++} ++ ++void rtw_dfs_master_timer_hdl(RTW_TIMER_HDL_ARGS) ++{ ++ _adapter *adapter = (_adapter *)FunctionContext; ++ ++ rtw_dfs_master_cmd(adapter, _TRUE); ++} ++ ++void rtw_dfs_master_enable(_adapter *adapter, u8 ch, u8 bw, u8 offset) ++{ ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ ++ /* TODO: move timer to rfctl */ ++ adapter = GET_PRIMARY_ADAPTER(adapter); ++ ++ RTW_INFO(FUNC_ADPT_FMT" on %u,%u,%u\n", FUNC_ADPT_ARG(adapter), ch, bw, offset); ++ ++ if (rtw_is_cac_reset_needed(adapter, ch, bw, offset) == _TRUE) ++ rtw_reset_cac(adapter, ch, bw, offset); ++ ++ rfctl->radar_detect_by_others = _FALSE; ++ rfctl->radar_detect_ch = ch; ++ rfctl->radar_detect_bw = bw; ++ rfctl->radar_detect_offset = offset; ++ ++ rfctl->radar_detected = 0; ++ ++ if (!rfctl->dfs_master_enabled) { ++ RTW_INFO(FUNC_ADPT_FMT" set dfs_master_enabled\n", FUNC_ADPT_ARG(adapter)); ++ rfctl->dfs_master_enabled = 1; ++ _set_timer(&adapter->mlmepriv.dfs_master_timer, DFS_MASTER_TIMER_MS); ++ ++ if (rtw_rfctl_overlap_radar_detect_ch(rfctl)) { ++ if (IS_CH_WAITING(rfctl)) { ++ u8 pause = 0xFF; ++ ++ rtw_hal_set_hwreg(adapter, HW_VAR_TXPAUSE, &pause); ++ } ++ rtw_odm_radar_detect_enable(adapter); ++ } ++ } ++} ++ ++void rtw_dfs_master_disable(_adapter *adapter, u8 ch, u8 bw, u8 offset, bool by_others) ++{ ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ ++ /* TODO: move timer to rfctl */ ++ adapter = GET_PRIMARY_ADAPTER(adapter); ++ ++ rfctl->radar_detect_by_others = by_others; ++ ++ if (rfctl->dfs_master_enabled) { ++ bool overlap_radar_detect_ch = rtw_rfctl_overlap_radar_detect_ch(rfctl); ++ ++ RTW_INFO(FUNC_ADPT_FMT" clear dfs_master_enabled\n", FUNC_ADPT_ARG(adapter)); ++ ++ rfctl->dfs_master_enabled = 0; ++ rfctl->radar_detected = 0; ++ rfctl->radar_detect_ch = 0; ++ rfctl->radar_detect_bw = 0; ++ rfctl->radar_detect_offset = 0; ++ rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; ++ _cancel_timer_ex(&adapter->mlmepriv.dfs_master_timer); ++ ++ if (overlap_radar_detect_ch) { ++ u8 pause = 0x00; ++ ++ rtw_hal_set_hwreg(adapter, HW_VAR_TXPAUSE, &pause); ++ rtw_odm_radar_detect_disable(adapter); ++ } ++ } ++ ++ if (by_others) { ++ rfctl->radar_detect_ch = ch; ++ rfctl->radar_detect_bw = bw; ++ rfctl->radar_detect_offset = offset; ++ } ++} ++ ++void rtw_dfs_master_status_apply(_adapter *adapter, u8 self_action) ++{ ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ struct mi_state mstate; ++ u8 u_ch, u_bw, u_offset; ++ bool ld_sta_in_dfs = _FALSE; ++ bool sync_ch = _FALSE; /* _FALSE: asign channel directly */ ++ bool needed = _FALSE; ++ ++ rtw_mi_status_no_self(adapter, &mstate); ++ rtw_mi_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset); ++ if (u_ch != 0) ++ sync_ch = _TRUE; ++ ++ switch (self_action) { ++ case MLME_STA_CONNECTING: ++ MSTATE_STA_LG_NUM(&mstate)++; ++ break; ++ case MLME_STA_CONNECTED: ++ MSTATE_STA_LD_NUM(&mstate)++; ++ break; ++ case MLME_AP_STARTED: ++ MSTATE_AP_NUM(&mstate)++; ++ break; ++ case MLME_AP_STOPPED: ++ case MLME_STA_DISCONNECTED: ++ default: ++ break; ++ } ++ ++ if (sync_ch == _TRUE) { ++ if (!rtw_is_chbw_grouped(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset, u_ch, u_bw, u_offset)) { ++ RTW_INFO(FUNC_ADPT_FMT" can't sync %u,%u,%u with %u,%u,%u\n", FUNC_ADPT_ARG(adapter) ++ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset, u_ch, u_bw, u_offset); ++ goto apply; ++ } ++ ++ rtw_sync_chbw(&mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset ++ , &u_ch, &u_bw, &u_offset); ++ } else { ++ u_ch = mlmeext->cur_channel; ++ u_bw = mlmeext->cur_bwmode; ++ u_offset = mlmeext->cur_ch_offset; ++ } ++ ++ if (MSTATE_STA_LD_NUM(&mstate) > 0) { ++ /* rely on AP on which STA mode connects */ ++ if (rtw_is_dfs_ch(u_ch, u_bw, u_offset)) ++ ld_sta_in_dfs = _TRUE; ++ goto apply; ++ } ++ ++ if (MSTATE_STA_LG_NUM(&mstate) > 0) { ++ /* STA mode is linking */ ++ goto apply; ++ } ++ ++ if (MSTATE_AP_NUM(&mstate) == 0) { ++ /* No working AP mode */ ++ goto apply; ++ } ++ ++ if (rtw_is_dfs_ch(u_ch, u_bw, u_offset)) ++ needed = _TRUE; ++ ++apply: ++ ++ RTW_INFO(FUNC_ADPT_FMT" needed:%d, self_action:%u\n" ++ , FUNC_ADPT_ARG(adapter), needed, self_action); ++ RTW_INFO(FUNC_ADPT_FMT" ld_sta_num:%u, lg_sta_num:%u, ap_num:%u, %u,%u,%u\n" ++ , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate), MSTATE_STA_LG_NUM(&mstate), MSTATE_AP_NUM(&mstate) ++ , u_ch, u_bw, u_offset); ++ ++ if (needed == _TRUE) ++ rtw_dfs_master_enable(adapter, u_ch, u_bw, u_offset); ++ else ++ rtw_dfs_master_disable(adapter, u_ch, u_bw, u_offset, ld_sta_in_dfs); ++} ++#endif /* CONFIG_DFS_MASTER */ ++ ++#endif /* CONFIG_AP_MODE */ ++ ++#ifdef CONFIG_BT_COEXIST ++struct btinfo { ++ u8 cid; ++ u8 len; ++ ++ u8 bConnection:1; ++ u8 bSCOeSCO:1; ++ u8 bInQPage:1; ++ u8 bACLBusy:1; ++ u8 bSCOBusy:1; ++ u8 bHID:1; ++ u8 bA2DP:1; ++ u8 bFTP:1; ++ ++ u8 retry_cnt:4; ++ u8 rsvd_34:1; ++ u8 rsvd_35:1; ++ u8 rsvd_36:1; ++ u8 rsvd_37:1; ++ ++ u8 rssi; ++ ++ u8 rsvd_50:1; ++ u8 rsvd_51:1; ++ u8 rsvd_52:1; ++ u8 rsvd_53:1; ++ u8 rsvd_54:1; ++ u8 rsvd_55:1; ++ u8 eSCO_SCO:1; ++ u8 Master_Slave:1; ++ ++ u8 rsvd_6; ++ u8 rsvd_7; ++}; ++ ++void btinfo_evt_dump(void *sel, void *buf) ++{ ++ struct btinfo *info = (struct btinfo *)buf; ++ ++ RTW_PRINT_SEL(sel, "cid:0x%02x, len:%u\n", info->cid, info->len); ++ ++ if (info->len > 2) ++ RTW_PRINT_SEL(sel, "byte2:%s%s%s%s%s%s%s%s\n" ++ , info->bConnection ? "bConnection " : "" ++ , info->bSCOeSCO ? "bSCOeSCO " : "" ++ , info->bInQPage ? "bInQPage " : "" ++ , info->bACLBusy ? "bACLBusy " : "" ++ , info->bSCOBusy ? "bSCOBusy " : "" ++ , info->bHID ? "bHID " : "" ++ , info->bA2DP ? "bA2DP " : "" ++ , info->bFTP ? "bFTP" : "" ++ ); ++ ++ if (info->len > 3) ++ RTW_PRINT_SEL(sel, "retry_cnt:%u\n", info->retry_cnt); ++ ++ if (info->len > 4) ++ RTW_PRINT_SEL(sel, "rssi:%u\n", info->rssi); ++ ++ if (info->len > 5) ++ RTW_PRINT_SEL(sel, "byte5:%s%s\n" ++ , info->eSCO_SCO ? "eSCO_SCO " : "" ++ , info->Master_Slave ? "Master_Slave " : "" ++ ); ++} ++ ++static void rtw_btinfo_hdl(_adapter *adapter, u8 *buf, u16 buf_len) ++{ ++#define BTINFO_WIFI_FETCH 0x23 ++#define BTINFO_BT_AUTO_RPT 0x27 ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ struct btinfo_8761ATV *info = (struct btinfo_8761ATV *)buf; ++#else /* !CONFIG_BT_COEXIST_SOCKET_TRX */ ++ struct btinfo *info = (struct btinfo *)buf; ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++ u8 cmd_idx; ++ u8 len; ++ ++ cmd_idx = info->cid; ++ ++ if (info->len > buf_len - 2) { ++ rtw_warn_on(1); ++ len = buf_len - 2; ++ } else ++ len = info->len; ++ ++ /* #define DBG_PROC_SET_BTINFO_EVT */ ++#ifdef DBG_PROC_SET_BTINFO_EVT ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ RTW_INFO("%s: btinfo[0]=%x,btinfo[1]=%x,btinfo[2]=%x,btinfo[3]=%x btinfo[4]=%x,btinfo[5]=%x,btinfo[6]=%x,btinfo[7]=%x\n" ++ , __func__, buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6], buf[7]); ++#else/* !CONFIG_BT_COEXIST_SOCKET_TRX */ ++ btinfo_evt_dump(RTW_DBGDUMP, info); ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++#endif /* DBG_PROC_SET_BTINFO_EVT */ ++ ++ /* transform BT-FW btinfo to WiFI-FW C2H format and notify */ ++ if (cmd_idx == BTINFO_WIFI_FETCH) ++ buf[1] = 0; ++ else if (cmd_idx == BTINFO_BT_AUTO_RPT) ++ buf[1] = 2; ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ else if (0x01 == cmd_idx || 0x02 == cmd_idx) ++ buf[1] = buf[0]; ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++ rtw_btcoex_BtInfoNotify(adapter , len + 1, &buf[1]); ++} ++ ++u8 rtw_btinfo_cmd(_adapter *adapter, u8 *buf, u16 len) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ u8 *btinfo; ++ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ btinfo = rtw_zmalloc(len); ++ if (btinfo == NULL) { ++ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); ++ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = BTINFO_WK_CID; ++ pdrvextra_cmd_parm->type = 0; ++ pdrvextra_cmd_parm->size = len; ++ pdrvextra_cmd_parm->pbuf = btinfo; ++ ++ _rtw_memcpy(btinfo, buf, len); ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ return res; ++} ++#endif /* CONFIG_BT_COEXIST */ ++ ++u8 rtw_test_h2c_cmd(_adapter *adapter, u8 *buf, u8 len) ++{ ++ struct cmd_obj *pcmdobj; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ u8 *ph2c_content; ++ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmdobj == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ ph2c_content = rtw_zmalloc(len); ++ if (ph2c_content == NULL) { ++ rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); ++ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = TEST_H2C_CID; ++ pdrvextra_cmd_parm->type = 0; ++ pdrvextra_cmd_parm->size = len; ++ pdrvextra_cmd_parm->pbuf = ph2c_content; ++ ++ _rtw_memcpy(ph2c_content, buf, len); ++ ++ init_h2fwcmd_w_parm_no_rsp(pcmdobj, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); ++ ++exit: ++ return res; ++} ++ ++#ifdef CONFIG_RTW_CUSTOMER_STR ++static s32 rtw_customer_str_cmd_hdl(_adapter *adapter, u8 write, const u8 *cstr) ++{ ++ int ret = H2C_SUCCESS; ++ ++ if (write) ++ ret = rtw_hal_h2c_customer_str_write(adapter, cstr); ++ else ++ ret = rtw_hal_h2c_customer_str_req(adapter); ++ ++ return ret == _SUCCESS ? H2C_SUCCESS : H2C_REJECTED; ++} ++ ++static u8 rtw_customer_str_cmd(_adapter *adapter, u8 write, const u8 *cstr) ++{ ++ struct cmd_obj *cmdobj; ++ struct drvextra_cmd_parm *parm; ++ u8 *str = NULL; ++ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; ++ struct submit_ctx sctx; ++ u8 res = _SUCCESS; ++ ++ parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (parm == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ if (write) { ++ str = rtw_zmalloc(RTW_CUSTOMER_STR_LEN); ++ if (str == NULL) { ++ rtw_mfree((u8 *)parm, sizeof(struct drvextra_cmd_parm)); ++ res = _FAIL; ++ goto exit; ++ } ++ } ++ ++ parm->ec_id = CUSTOMER_STR_WK_CID; ++ parm->type = write; ++ parm->size = write ? RTW_CUSTOMER_STR_LEN : 0; ++ parm->pbuf = write ? str : NULL; ++ ++ if (write) ++ _rtw_memcpy(str, cstr, RTW_CUSTOMER_STR_LEN); ++ ++ /* need enqueue, prepare cmd_obj and enqueue */ ++ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); ++ if (cmdobj == NULL) { ++ res = _FAIL; ++ rtw_mfree((u8 *)parm, sizeof(*parm)); ++ if (write) ++ rtw_mfree(str, RTW_CUSTOMER_STR_LEN); ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ cmdobj->sctx = &sctx; ++ rtw_sctx_init(&sctx, 2 * 1000); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); ++ ++ if (res == _SUCCESS) { ++ rtw_sctx_wait(&sctx, __func__); ++ _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); ++ if (sctx.status == RTW_SCTX_SUBMITTED) ++ cmdobj->sctx = NULL; ++ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); ++ if (sctx.status != RTW_SCTX_DONE_SUCCESS) ++ res = _FAIL; ++ } ++ ++exit: ++ return res; ++} ++ ++inline u8 rtw_customer_str_req_cmd(_adapter *adapter) ++{ ++ return rtw_customer_str_cmd(adapter, 0, NULL); ++} ++ ++inline u8 rtw_customer_str_write_cmd(_adapter *adapter, const u8 *cstr) ++{ ++ return rtw_customer_str_cmd(adapter, 1, cstr); ++} ++#endif /* CONFIG_RTW_CUSTOMER_STR */ ++ ++u8 rtw_c2h_wk_cmd(PADAPTER padapter, u8 *pbuf, u16 length, u8 type) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 *extra_cmd_buf; ++ u8 res = _SUCCESS; ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ extra_cmd_buf = rtw_zmalloc(length); ++ if (extra_cmd_buf == NULL) { ++ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); ++ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ _rtw_memcpy(extra_cmd_buf, pbuf, length); ++ pdrvextra_cmd_parm->ec_id = C2H_WK_CID; ++ pdrvextra_cmd_parm->type = type; ++ pdrvextra_cmd_parm->size = length; ++ pdrvextra_cmd_parm->pbuf = extra_cmd_buf; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ return res; ++} ++ ++#ifdef CONFIG_FW_C2H_REG ++inline u8 rtw_c2h_reg_wk_cmd(_adapter *adapter, u8 *c2h_evt) ++{ ++ return rtw_c2h_wk_cmd(adapter, c2h_evt, c2h_evt ? C2H_REG_LEN : 0, C2H_TYPE_REG); ++} ++#endif ++ ++#ifdef CONFIG_FW_C2H_PKT ++inline u8 rtw_c2h_packet_wk_cmd(_adapter *adapter, u8 *c2h_evt, u16 length) ++{ ++ return rtw_c2h_wk_cmd(adapter, c2h_evt, length, C2H_TYPE_PKT); ++} ++#endif ++ ++u8 rtw_run_in_thread_cmd(PADAPTER padapter, void (*func)(void *), void *context) ++{ ++ struct cmd_priv *pcmdpriv; ++ struct cmd_obj *ph2c; ++ struct RunInThread_param *parm; ++ s32 res = _SUCCESS; ++ ++ ++ pcmdpriv = &padapter->cmdpriv; ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (NULL == ph2c) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ parm = (struct RunInThread_param *)rtw_zmalloc(sizeof(struct RunInThread_param)); ++ if (NULL == parm) { ++ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ parm->func = func; ++ parm->context = context; ++ init_h2fwcmd_w_parm_no_rsp(ph2c, parm, GEN_CMD_CODE(_RunInThreadCMD)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++exit: ++ ++ ++ return res; ++} ++ ++#ifdef CONFIG_FW_C2H_REG ++s32 c2h_evt_hdl(_adapter *adapter, u8 *c2h_evt, c2h_id_filter filter) ++{ ++ s32 ret = _FAIL; ++ u8 buf[C2H_REG_LEN] = {0}; ++ u8 id, seq, plen; ++ u8 *payload; ++ ++ if (!c2h_evt) { ++ /* No c2h event in cmd_obj, read c2h event before handling*/ ++ if (rtw_hal_c2h_evt_read(adapter, buf) != _SUCCESS) ++ goto exit; ++ c2h_evt = buf; ++ } ++ ++ rtw_hal_c2h_reg_hdr_parse(adapter, c2h_evt, &id, &seq, &plen, &payload); ++ ++ if (filter && filter(adapter, id, seq, plen, payload) == _FALSE) ++ goto exit; ++ ++ ret = rtw_hal_c2h_handler(adapter, id, seq, plen, payload); ++ ++exit: ++ return ret; ++} ++#endif /* CONFIG_FW_C2H_REG */ ++ ++u8 session_tracker_cmd(_adapter *adapter, u8 cmd, struct sta_info *sta, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port) ++{ ++ struct cmd_priv *cmdpriv = &adapter->cmdpriv; ++ struct cmd_obj *cmdobj; ++ struct drvextra_cmd_parm *cmd_parm; ++ struct st_cmd_parm *st_parm; ++ u8 res = _SUCCESS; ++ ++ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (cmdobj == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (cmd_parm == NULL) { ++ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ st_parm = (struct st_cmd_parm *)rtw_zmalloc(sizeof(struct st_cmd_parm)); ++ if (st_parm == NULL) { ++ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); ++ rtw_mfree((u8 *)cmd_parm, sizeof(struct drvextra_cmd_parm)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ st_parm->cmd = cmd; ++ st_parm->sta = sta; ++ if (cmd != ST_CMD_CHK) { ++ _rtw_memcpy(&st_parm->local_naddr, local_naddr, 4); ++ _rtw_memcpy(&st_parm->local_port, local_port, 2); ++ _rtw_memcpy(&st_parm->remote_naddr, remote_naddr, 4); ++ _rtw_memcpy(&st_parm->remote_port, remote_port, 2); ++ } ++ ++ cmd_parm->ec_id = SESSION_TRACKER_WK_CID; ++ cmd_parm->type = 0; ++ cmd_parm->size = sizeof(struct st_cmd_parm); ++ cmd_parm->pbuf = (u8 *)st_parm; ++ init_h2fwcmd_w_parm_no_rsp(cmdobj, cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ cmdobj->no_io = 1; ++ ++ res = rtw_enqueue_cmd(cmdpriv, cmdobj); ++ ++exit: ++ return res; ++} ++ ++inline u8 session_tracker_chk_cmd(_adapter *adapter, struct sta_info *sta) ++{ ++ return session_tracker_cmd(adapter, ST_CMD_CHK, sta, NULL, NULL, NULL, NULL); ++} ++ ++inline u8 session_tracker_add_cmd(_adapter *adapter, struct sta_info *sta, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port) ++{ ++ return session_tracker_cmd(adapter, ST_CMD_ADD, sta, local_naddr, local_port, remote_naddr, remote_port); ++} ++ ++inline u8 session_tracker_del_cmd(_adapter *adapter, struct sta_info *sta, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port) ++{ ++ return session_tracker_cmd(adapter, ST_CMD_DEL, sta, local_naddr, local_port, remote_naddr, remote_port); ++} ++ ++void session_tracker_chk_for_sta(_adapter *adapter, struct sta_info *sta) ++{ ++ struct st_ctl_t *st_ctl = &sta->st_ctl; ++ int i; ++ _irqL irqL; ++ _list *plist, *phead, *pnext; ++ _list dlist; ++ struct session_tracker *st = NULL; ++ u8 op_wfd_mode = MIRACAST_DISABLED; ++ ++ if (DBG_SESSION_TRACKER) ++ RTW_INFO(FUNC_ADPT_FMT" sta:%p\n", FUNC_ADPT_ARG(adapter), sta); ++ ++ if (!(sta->state & _FW_LINKED)) ++ goto exit; ++ ++ for (i = 0; i < SESSION_TRACKER_REG_ID_NUM; i++) { ++ if (st_ctl->reg[i].s_proto != 0) ++ break; ++ } ++ if (i >= SESSION_TRACKER_REG_ID_NUM) ++ goto chk_sta; ++ ++ _rtw_init_listhead(&dlist); ++ ++ _enter_critical_bh(&st_ctl->tracker_q.lock, &irqL); ++ ++ phead = &st_ctl->tracker_q.queue; ++ plist = get_next(phead); ++ pnext = get_next(plist); ++ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ st = LIST_CONTAINOR(plist, struct session_tracker, list); ++ plist = pnext; ++ pnext = get_next(pnext); ++ ++ if (st->status != ST_STATUS_ESTABLISH ++ && rtw_get_passing_time_ms(st->set_time) > ST_EXPIRE_MS ++ ) { ++ rtw_list_delete(&st->list); ++ rtw_list_insert_tail(&st->list, &dlist); ++ } ++ ++ /* TODO: check OS for status update */ ++ if (st->status == ST_STATUS_CHECK) ++ st->status = ST_STATUS_ESTABLISH; ++ ++ if (st->status != ST_STATUS_ESTABLISH) ++ continue; ++ ++ #ifdef CONFIG_WFD ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" local:%u, remote:%u, rtsp:%u, %u, %u\n", FUNC_ADPT_ARG(adapter) ++ , ntohs(st->local_port), ntohs(st->remote_port), adapter->wfd_info.rtsp_ctrlport, adapter->wfd_info.tdls_rtsp_ctrlport ++ , adapter->wfd_info.peer_rtsp_ctrlport); ++ if (ntohs(st->local_port) == adapter->wfd_info.rtsp_ctrlport) ++ op_wfd_mode |= MIRACAST_SINK; ++ if (ntohs(st->local_port) == adapter->wfd_info.tdls_rtsp_ctrlport) ++ op_wfd_mode |= MIRACAST_SINK; ++ if (ntohs(st->remote_port) == adapter->wfd_info.peer_rtsp_ctrlport) ++ op_wfd_mode |= MIRACAST_SOURCE; ++ #endif ++ } ++ ++ _exit_critical_bh(&st_ctl->tracker_q.lock, &irqL); ++ ++ plist = get_next(&dlist); ++ while (rtw_end_of_queue_search(&dlist, plist) == _FALSE) { ++ st = LIST_CONTAINOR(plist, struct session_tracker, list); ++ plist = get_next(plist); ++ rtw_mfree((u8 *)st, sizeof(struct session_tracker)); ++ } ++ ++chk_sta: ++ if (STA_OP_WFD_MODE(sta) != op_wfd_mode) { ++ STA_SET_OP_WFD_MODE(sta, op_wfd_mode); ++ rtw_sta_media_status_rpt_cmd(adapter, sta, 1); ++ } ++ ++exit: ++ return; ++} ++ ++void session_tracker_chk_for_adapter(_adapter *adapter) ++{ ++ struct sta_priv *stapriv = &adapter->stapriv; ++ struct sta_info *sta; ++ int i; ++ _irqL irqL; ++ _list *plist, *phead; ++ u8 op_wfd_mode = MIRACAST_DISABLED; ++ ++ _enter_critical_bh(&stapriv->sta_hash_lock, &irqL); ++ ++ for (i = 0; i < NUM_STA; i++) { ++ phead = &(stapriv->sta_hash[i]); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); ++ plist = get_next(plist); ++ ++ session_tracker_chk_for_sta(adapter, sta); ++ ++ op_wfd_mode |= STA_OP_WFD_MODE(sta); ++ } ++ } ++ ++ _exit_critical_bh(&stapriv->sta_hash_lock, &irqL); ++ ++#ifdef CONFIG_WFD ++ adapter->wfd_info.op_wfd_mode = MIRACAST_MODE_REVERSE(op_wfd_mode); ++#endif ++} ++ ++void session_tracker_cmd_hdl(_adapter *adapter, struct st_cmd_parm *parm) ++{ ++ u8 cmd = parm->cmd; ++ struct sta_info *sta = parm->sta; ++ ++ if (cmd == ST_CMD_CHK) { ++ if (sta) ++ session_tracker_chk_for_sta(adapter, sta); ++ else ++ session_tracker_chk_for_adapter(adapter); ++ ++ goto exit; ++ ++ } else if (cmd == ST_CMD_ADD || cmd == ST_CMD_DEL) { ++ struct st_ctl_t *st_ctl; ++ u32 local_naddr = parm->local_naddr; ++ u16 local_port = parm->local_port; ++ u32 remote_naddr = parm->remote_naddr; ++ u16 remote_port = parm->remote_port; ++ struct session_tracker *st = NULL; ++ _irqL irqL; ++ _list *plist, *phead; ++ u8 free_st = 0; ++ u8 alloc_st = 0; ++ ++ if (DBG_SESSION_TRACKER) ++ RTW_INFO(FUNC_ADPT_FMT" cmd:%u, sta:%p, local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT"\n" ++ , FUNC_ADPT_ARG(adapter), cmd, sta ++ , IP_ARG(&local_naddr), PORT_ARG(&local_port) ++ , IP_ARG(&remote_naddr), PORT_ARG(&remote_port) ++ ); ++ ++ if (!(sta->state & _FW_LINKED)) ++ goto exit; ++ ++ st_ctl = &sta->st_ctl; ++ ++ _enter_critical_bh(&st_ctl->tracker_q.lock, &irqL); ++ ++ phead = &st_ctl->tracker_q.queue; ++ plist = get_next(phead); ++ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ st = LIST_CONTAINOR(plist, struct session_tracker, list); ++ ++ if (st->local_naddr == local_naddr ++ && st->local_port == local_port ++ && st->remote_naddr == remote_naddr ++ && st->remote_port == remote_port) ++ break; ++ ++ plist = get_next(plist); ++ } ++ ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ st = NULL; ++ ++ switch (cmd) { ++ case ST_CMD_DEL: ++ if (st) { ++ rtw_list_delete(plist); ++ free_st = 1; ++ } ++ goto unlock; ++ case ST_CMD_ADD: ++ if (!st) ++ alloc_st = 1; ++ } ++ ++unlock: ++ _exit_critical_bh(&st_ctl->tracker_q.lock, &irqL); ++ ++ if (free_st) { ++ rtw_mfree((u8 *)st, sizeof(struct session_tracker)); ++ goto exit; ++ } ++ ++ if (alloc_st) { ++ st = (struct session_tracker *)rtw_zmalloc(sizeof(struct session_tracker)); ++ if (!st) ++ goto exit; ++ ++ st->local_naddr = local_naddr; ++ st->local_port = local_port; ++ st->remote_naddr = remote_naddr; ++ st->remote_port = remote_port; ++ st->set_time = rtw_get_current_time(); ++ st->status = ST_STATUS_CHECK; ++ ++ _enter_critical_bh(&st_ctl->tracker_q.lock, &irqL); ++ rtw_list_insert_tail(&st->list, phead); ++ _exit_critical_bh(&st_ctl->tracker_q.lock, &irqL); ++ } ++ } ++ ++exit: ++ return; ++} ++ ++u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++ int ret = H2C_SUCCESS; ++ struct drvextra_cmd_parm *pdrvextra_cmd; ++ ++ if (!pbuf) ++ return H2C_PARAMETERS_ERROR; ++ ++ pdrvextra_cmd = (struct drvextra_cmd_parm *)pbuf; ++ ++ switch (pdrvextra_cmd->ec_id) { ++ case STA_MSTATUS_RPT_WK_CID: ++ rtw_sta_media_status_rpt_cmd_hdl(padapter, (struct sta_media_status_rpt_cmd_parm *)pdrvextra_cmd->pbuf); ++ break; ++ ++ case DYNAMIC_CHK_WK_CID:/*only primary padapter go to this cmd, but execute dynamic_chk_wk_hdl() for two interfaces */ ++ rtw_dynamic_chk_wk_hdl(padapter); ++ break; ++ case POWER_SAVING_CTRL_WK_CID: ++ power_saving_wk_hdl(padapter); ++ break; ++#ifdef CONFIG_LPS ++ case LPS_CTRL_WK_CID: ++ lps_ctrl_wk_hdl(padapter, (u8)pdrvextra_cmd->type); ++ break; ++ case DM_IN_LPS_WK_CID: ++ rtw_dm_in_lps_hdl(padapter); ++ break; ++ case LPS_CHANGE_DTIM_CID: ++ rtw_lps_change_dtim_hdl(padapter, (u8)pdrvextra_cmd->type); ++ break; ++#endif ++#if (RATE_ADAPTIVE_SUPPORT == 1) ++ case RTP_TIMER_CFG_WK_CID: ++ rpt_timer_setting_wk_hdl(padapter, pdrvextra_cmd->type); ++ break; ++#endif ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ case ANT_SELECT_WK_CID: ++ antenna_select_wk_hdl(padapter, pdrvextra_cmd->type); ++ break; ++#endif ++#ifdef CONFIG_P2P_PS ++ case P2P_PS_WK_CID: ++ p2p_ps_wk_hdl(padapter, pdrvextra_cmd->type); ++ break; ++#endif ++#ifdef CONFIG_P2P ++ case P2P_PROTO_WK_CID: ++ /* ++ * Commented by Albert 2011/07/01 ++ * I used the type_size as the type command ++ */ ++ ret = p2p_protocol_wk_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); ++ break; ++#endif ++#ifdef CONFIG_AP_MODE ++ case CHECK_HIQ_WK_CID: ++ rtw_chk_hi_queue_hdl(padapter); ++ break; ++#endif ++#ifdef CONFIG_INTEL_WIDI ++ case INTEl_WIDI_WK_CID: ++ intel_widi_wk_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); ++ break; ++#endif ++ /* add for CONFIG_IEEE80211W, none 11w can use it */ ++ case RESET_SECURITYPRIV: ++ reset_securitypriv_hdl(padapter); ++ break; ++ case FREE_ASSOC_RESOURCES: ++ free_assoc_resources_hdl(padapter); ++ break; ++ case C2H_WK_CID: ++ switch (pdrvextra_cmd->type) { ++ #ifdef CONFIG_FW_C2H_REG ++ case C2H_TYPE_REG: ++ c2h_evt_hdl(padapter, pdrvextra_cmd->pbuf, NULL); ++ break; ++ #endif ++ #ifdef CONFIG_FW_C2H_PKT ++ case C2H_TYPE_PKT: ++ rtw_hal_c2h_pkt_hdl(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->size); ++ break; ++ #endif ++ default: ++ RTW_ERR("unknown C2H type:%d\n", pdrvextra_cmd->type); ++ rtw_warn_on(1); ++ break; ++ } ++ break; ++#ifdef CONFIG_BEAMFORMING ++ case BEAMFORMING_WK_CID: ++ beamforming_wk_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); ++ break; ++#endif ++ case DM_RA_MSK_WK_CID: ++ rtw_dm_ra_mask_hdl(padapter, (struct sta_info *)pdrvextra_cmd->pbuf); ++ break; ++#ifdef CONFIG_BT_COEXIST ++ case BTINFO_WK_CID: ++ rtw_btinfo_hdl(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->size); ++ break; ++#endif ++#ifdef CONFIG_DFS_MASTER ++ case DFS_MASTER_WK_CID: ++ rtw_dfs_master_hdl(padapter); ++ break; ++#endif ++ case SESSION_TRACKER_WK_CID: ++ session_tracker_cmd_hdl(padapter, (struct st_cmd_parm *)pdrvextra_cmd->pbuf); ++ break; ++ case EN_HW_UPDATE_TSF_WK_CID: ++ rtw_hal_set_hwreg(padapter, HW_VAR_EN_HW_UPDATE_TSF, NULL); ++ break; ++ case TEST_H2C_CID: ++ rtw_hal_fill_h2c_cmd(padapter, pdrvextra_cmd->pbuf[0], pdrvextra_cmd->size - 1, &pdrvextra_cmd->pbuf[1]); ++ break; ++#ifdef CONFIG_RTW_CUSTOMER_STR ++ case CUSTOMER_STR_WK_CID: ++ ret = rtw_customer_str_cmd_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); ++ break; ++#endif ++ default: ++ break; ++ } ++ ++ if (pdrvextra_cmd->pbuf && pdrvextra_cmd->size > 0) ++ rtw_mfree(pdrvextra_cmd->pbuf, pdrvextra_cmd->size); ++ ++ return ret; ++} ++ ++void rtw_survey_cmd_callback(_adapter *padapter , struct cmd_obj *pcmd) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ ++ if (pcmd->res == H2C_DROPPED) { ++ /* TODO: cancel timer and do timeout handler directly... */ ++ /* need to make timeout handlerOS independent */ ++ mlme_set_scan_to_timer(pmlmepriv, 1); ++ } else if (pcmd->res != H2C_SUCCESS) { ++ mlme_set_scan_to_timer(pmlmepriv, 1); ++ } ++ ++ /* free cmd */ ++ rtw_free_cmd_obj(pcmd); ++ ++} ++void rtw_disassoc_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ ++ if (pcmd->res != H2C_SUCCESS) { ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ set_fwstate(pmlmepriv, _FW_LINKED); ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ goto exit; ++ } ++#ifdef CONFIG_BR_EXT ++ else /* clear bridge database */ ++ nat25_db_cleanup(padapter); ++#endif /* CONFIG_BR_EXT */ ++ ++ /* free cmd */ ++ rtw_free_cmd_obj(pcmd); ++ ++exit: ++ return; ++} ++ ++ ++void rtw_getmacreg_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd) ++{ ++ ++ ++ rtw_free_cmd_obj(pcmd); ++ ++} ++ ++void rtw_joinbss_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ ++ if (pcmd->res == H2C_DROPPED) { ++ /* TODO: cancel timer and do timeout handler directly... */ ++ /* need to make timeout handlerOS independent */ ++ _set_timer(&pmlmepriv->assoc_timer, 1); ++ } else if (pcmd->res != H2C_SUCCESS) ++ _set_timer(&pmlmepriv->assoc_timer, 1); ++ ++ rtw_free_cmd_obj(pcmd); ++ ++} ++ ++void rtw_create_ibss_post_hdl(_adapter *padapter, int status) ++{ ++ _irqL irqL; ++ u8 timer_cancelled; ++ struct sta_info *psta = NULL; ++ struct wlan_network *pwlan = NULL; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ WLAN_BSSID_EX *pdev_network = &padapter->registrypriv.dev_network; ++ struct wlan_network *mlme_cur_network = &(pmlmepriv->cur_network); ++ ++ if (status != H2C_SUCCESS) ++ _set_timer(&pmlmepriv->assoc_timer, 1); ++ ++ _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled); ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ { ++ _irqL irqL; ++ ++ pwlan = _rtw_alloc_network(pmlmepriv); ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ if (pwlan == NULL) { ++ pwlan = rtw_get_oldest_wlan_network(&pmlmepriv->scanned_queue); ++ if (pwlan == NULL) { ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ goto createbss_cmd_fail; ++ } ++ pwlan->last_scanned = rtw_get_current_time(); ++ } else ++ rtw_list_insert_tail(&(pwlan->list), &pmlmepriv->scanned_queue.queue); ++ ++ pdev_network->Length = get_WLAN_BSSID_EX_sz(pdev_network); ++ _rtw_memcpy(&(pwlan->network), pdev_network, pdev_network->Length); ++ /* pwlan->fixed = _TRUE; */ ++ ++ /* copy pdev_network information to pmlmepriv->cur_network */ ++ _rtw_memcpy(&mlme_cur_network->network, pdev_network, (get_WLAN_BSSID_EX_sz(pdev_network))); ++ ++#if 0 ++ /* reset DSConfig */ ++ mlme_cur_network->network.Configuration.DSConfig = (u32)rtw_ch2freq(pdev_network->Configuration.DSConfig); ++#endif ++ ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ /* we will set _FW_LINKED when there is one more sat to join us (rtw_stassoc_event_callback) */ ++ } ++ ++createbss_cmd_fail: ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++exit: ++ return; ++} ++ ++ ++ ++void rtw_setstaKey_cmdrsp_callback(_adapter *padapter , struct cmd_obj *pcmd) ++{ ++ ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct set_stakey_rsp *psetstakey_rsp = (struct set_stakey_rsp *)(pcmd->rsp); ++ struct sta_info *psta = rtw_get_stainfo(pstapriv, psetstakey_rsp->addr); ++ ++ ++ if (psta == NULL) { ++ goto exit; ++ } ++ ++ /* psta->aid = psta->mac_id = psetstakey_rsp->keyid; */ /* CAM_ID(CAM_ENTRY) */ ++ ++exit: ++ ++ rtw_free_cmd_obj(pcmd); ++ ++ ++} ++void rtw_setassocsta_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd) ++{ ++ _irqL irqL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct set_assocsta_parm *passocsta_parm = (struct set_assocsta_parm *)(pcmd->parmbuf); ++ struct set_assocsta_rsp *passocsta_rsp = (struct set_assocsta_rsp *)(pcmd->rsp); ++ struct sta_info *psta = rtw_get_stainfo(pstapriv, passocsta_parm->addr); ++ ++ ++ if (psta == NULL) { ++ goto exit; ++ } ++ ++ psta->aid = psta->mac_id = passocsta_rsp->cam_id; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) && (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE)) ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); ++ ++ set_fwstate(pmlmepriv, _FW_LINKED); ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++exit: ++ rtw_free_cmd_obj(pcmd); ++ ++} ++ ++void rtw_getrttbl_cmd_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); ++void rtw_getrttbl_cmd_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd) ++{ ++ ++ rtw_free_cmd_obj(pcmd); ++#ifdef CONFIG_MP_INCLUDED ++ if (padapter->registrypriv.mp_mode == 1) ++ padapter->mppriv.workparam.bcompleted = _TRUE; ++#endif ++ ++ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_debug.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_debug.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_debug.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_debug.c 2018-02-11 21:44:27.136145918 +0200 +@@ -0,0 +1,4583 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_DEBUG_C_ ++ ++#include ++#include ++ ++#ifdef CONFIG_RTW_DEBUG ++const char *rtw_log_level_str[] = { ++ "_DRV_NONE_ = 0", ++ "_DRV_ALWAYS_ = 1", ++ "_DRV_ERR_ = 2", ++ "_DRV_WARNING_ = 3", ++ "_DRV_INFO_ = 4", ++ "_DRV_DEBUG_ = 5", ++ "_DRV_MAX_ = 6", ++}; ++#endif ++ ++#ifdef CONFIG_DEBUG_RTL871X ++ u64 GlobalDebugComponents = 0; ++#endif /* CONFIG_DEBUG_RTL871X */ ++ ++#include ++ ++#ifdef CONFIG_TDLS ++ #define TDLS_DBG_INFO_SPACE_BTWN_ITEM_AND_VALUE 41 ++#endif ++ ++void dump_drv_version(void *sel) ++{ ++ RTW_PRINT_SEL(sel, "%s %s\n", DRV_NAME, DRIVERVERSION); ++ RTW_PRINT_SEL(sel, "build time: %s %s\n", __DATE__, __TIME__); ++} ++ ++void dump_drv_cfg(void *sel) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) ++ char *kernel_version = utsname()->release; ++ ++ RTW_PRINT_SEL(sel, "\nKernel Version: %s\n", kernel_version); ++#endif ++ ++ RTW_PRINT_SEL(sel, "Driver Version: %s\n", DRIVERVERSION); ++ RTW_PRINT_SEL(sel, "------------------------------------------------\n"); ++#ifdef CONFIG_IOCTL_CFG80211 ++ RTW_PRINT_SEL(sel, "CFG80211\n"); ++#ifdef RTW_USE_CFG80211_STA_EVENT ++ RTW_PRINT_SEL(sel, "RTW_USE_CFG80211_STA_EVENT\n"); ++#endif ++#else ++ RTW_PRINT_SEL(sel, "WEXT\n"); ++#endif ++ ++ RTW_PRINT_SEL(sel, "DBG:%d\n", DBG); ++#ifdef CONFIG_RTW_DEBUG ++ RTW_PRINT_SEL(sel, "CONFIG_RTW_DEBUG\n"); ++#endif ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ RTW_PRINT_SEL(sel, "CONFIG_CONCURRENT_MODE\n"); ++#endif ++ ++#ifdef CONFIG_POWER_SAVING ++ RTW_PRINT_SEL(sel, "CONFIG_POWER_SAVING\n"); ++#endif ++ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ RTW_PRINT_SEL(sel, "LOAD_PHY_PARA_FROM_FILE - REALTEK_CONFIG_PATH=%s\n", REALTEK_CONFIG_PATH); ++ #if defined(CONFIG_MULTIDRV) || defined(REALTEK_CONFIG_PATH_WITH_IC_NAME_FOLDER) ++ RTW_PRINT_SEL(sel, "LOAD_PHY_PARA_FROM_FILE - REALTEK_CONFIG_PATH_WITH_IC_NAME_FOLDER\n"); ++ #endif ++ ++/* configurations about TX power */ ++#ifdef CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY ++ RTW_PRINT_SEL(sel, "CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY\n"); ++#endif ++#ifdef CONFIG_CALIBRATE_TX_POWER_TO_MAX ++ RTW_PRINT_SEL(sel, "CONFIG_CALIBRATE_TX_POWER_TO_MAX\n"); ++#endif ++#endif ++ RTW_PRINT_SEL(sel, "RTW_DEF_MODULE_REGULATORY_CERT=0x%02x\n", RTW_DEF_MODULE_REGULATORY_CERT); ++ ++ RTW_PRINT_SEL(sel, "CONFIG_TXPWR_BY_RATE_EN=%d\n", CONFIG_TXPWR_BY_RATE_EN); ++ RTW_PRINT_SEL(sel, "CONFIG_TXPWR_LIMIT_EN=%d\n", CONFIG_TXPWR_LIMIT_EN); ++ ++ ++#ifdef CONFIG_DISABLE_ODM ++ RTW_PRINT_SEL(sel, "CONFIG_DISABLE_ODM\n"); ++#endif ++ ++#ifdef CONFIG_MINIMAL_MEMORY_USAGE ++ RTW_PRINT_SEL(sel, "CONFIG_MINIMAL_MEMORY_USAGE\n"); ++#endif ++ ++ RTW_PRINT_SEL(sel, "CONFIG_RTW_ADAPTIVITY_EN = %d\n", CONFIG_RTW_ADAPTIVITY_EN); ++#if (CONFIG_RTW_ADAPTIVITY_EN) ++ RTW_PRINT_SEL(sel, "ADAPTIVITY_MODE = %s\n", (CONFIG_RTW_ADAPTIVITY_MODE) ? "carrier_sense" : "normal"); ++#endif ++ ++#ifdef CONFIG_WOWLAN ++ RTW_PRINT_SEL(sel, "CONFIG_WOWLAN - "); ++ ++#ifdef CONFIG_GPIO_WAKEUP ++ RTW_PRINT_SEL(sel, "CONFIG_GPIO_WAKEUP - WAKEUP_GPIO_IDX:%d\n", WAKEUP_GPIO_IDX); ++#endif ++#endif ++ ++#ifdef CONFIG_TDLS ++ RTW_PRINT_SEL(sel, "CONFIG_TDLS\n"); ++#endif ++ ++#ifdef CONFIG_RTW_80211R ++ RTW_PRINT_SEL(sel, "CONFIG_RTW_80211R\n"); ++#endif ++ ++#ifdef CONFIG_USB_HCI ++#ifdef CONFIG_SUPPORT_USB_INT ++ RTW_PRINT_SEL(sel, "CONFIG_SUPPORT_USB_INT\n"); ++#endif ++#ifdef CONFIG_USB_INTERRUPT_IN_PIPE ++ RTW_PRINT_SEL(sel, "CONFIG_USB_INTERRUPT_IN_PIPE\n"); ++#endif ++#ifdef CONFIG_USB_TX_AGGREGATION ++ RTW_PRINT_SEL(sel, "CONFIG_USB_TX_AGGREGATION\n"); ++#endif ++#ifdef CONFIG_USB_RX_AGGREGATION ++ RTW_PRINT_SEL(sel, "CONFIG_USB_RX_AGGREGATION\n"); ++#endif ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_TX ++ RTW_PRINT_SEL(sel, "CONFIG_USE_USB_BUFFER_ALLOC_TX\n"); ++#endif ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX ++ RTW_PRINT_SEL(sel, "CONFIG_USE_USB_BUFFER_ALLOC_RX\n"); ++#endif ++#ifdef CONFIG_PREALLOC_RECV_SKB ++ RTW_PRINT_SEL(sel, "CONFIG_PREALLOC_RECV_SKB\n"); ++#endif ++#ifdef CONFIG_FIX_NR_BULKIN_BUFFER ++ RTW_PRINT_SEL(sel, "CONFIG_FIX_NR_BULKIN_BUFFER\n"); ++#endif ++#endif /*CONFIG_USB_HCI*/ ++ ++#ifdef CONFIG_SDIO_HCI ++#ifdef CONFIG_TX_AGGREGATION ++ RTW_PRINT_SEL(sel, "CONFIG_TX_AGGREGATION\n"); ++#endif ++#ifdef CONFIG_RX_AGGREGATION ++ RTW_PRINT_SEL(sel, "CONFIG_RX_AGGREGATION\n"); ++#endif ++#endif /*CONFIG_SDIO_HCI*/ ++ ++#ifdef CONFIG_PCI_HCI ++#endif ++ ++ RTW_PRINT_SEL(sel, "MAX_XMITBUF_SZ = %d\n", MAX_XMITBUF_SZ); ++ RTW_PRINT_SEL(sel, "MAX_RECVBUF_SZ = %d\n", MAX_RECVBUF_SZ); ++ ++} ++ ++void dump_log_level(void *sel) ++{ ++#ifdef CONFIG_RTW_DEBUG ++ int i; ++ ++ RTW_PRINT_SEL(sel, "drv_log_level:%d\n", rtw_drv_log_level); ++ for (i = 0; i <= _DRV_MAX_; i++) { ++ if (rtw_log_level_str[i]) ++ RTW_PRINT_SEL(sel, "%c %s = %d\n", ++ (rtw_drv_log_level == i) ? '+' : ' ', rtw_log_level_str[i], i); ++ } ++#else ++ RTW_PRINT_SEL(sel, "CONFIG_RTW_DEBUG is disabled\n"); ++#endif ++} ++ ++#ifdef CONFIG_SDIO_HCI ++void sd_f0_reg_dump(void *sel, _adapter *adapter) ++{ ++ int i; ++ ++ for (i = 0x0; i <= 0xff; i++) { ++ if (i % 16 == 0) ++ RTW_PRINT_SEL(sel, "0x%02x ", i); ++ ++ _RTW_PRINT_SEL(sel, "%02x ", rtw_sd_f0_read8(adapter, i)); ++ ++ if (i % 16 == 15) ++ _RTW_PRINT_SEL(sel, "\n"); ++ else if (i % 8 == 7) ++ _RTW_PRINT_SEL(sel, "\t"); ++ } ++} ++ ++void sdio_local_reg_dump(void *sel, _adapter *adapter) ++{ ++ int i, j = 1; ++ ++ for (i = 0x0; i < 0x100; i += 4) { ++ if (j % 4 == 1) ++ RTW_PRINT_SEL(sel, "0x%02x", i); ++ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, (0x1025 << 16) | i)); ++ if ((j++) % 4 == 0) ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++} ++#endif /* CONFIG_SDIO_HCI */ ++ ++void mac_reg_dump(void *sel, _adapter *adapter) ++{ ++ int i, j = 1; ++ ++ RTW_PRINT_SEL(sel, "======= MAC REG =======\n"); ++ ++ for (i = 0x0; i < 0x800; i += 4) { ++ if (j % 4 == 1) ++ RTW_PRINT_SEL(sel, "0x%03x", i); ++ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); ++ if ((j++) % 4 == 0) ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ ++#ifdef CONFIG_RTL8814A ++ { ++ for (i = 0x1000; i < 0x1650; i += 4) { ++ if (j % 4 == 1) ++ RTW_PRINT_SEL(sel, "0x%03x", i); ++ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); ++ if ((j++) % 4 == 0) ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ } ++#endif /* CONFIG_RTL8814A */ ++ ++#ifdef CONFIG_RTL8822B ++ for (i = 0x1000; i < 0x1800; i += 4) { ++ if (j % 4 == 1) ++ RTW_PRINT_SEL(sel, "0x%03x", i); ++ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); ++ if ((j++) % 4 == 0) ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++#endif /* CONFIG_RTL8822B */ ++} ++ ++void bb_reg_dump(void *sel, _adapter *adapter) ++{ ++ int i, j = 1; ++ ++ RTW_PRINT_SEL(sel, "======= BB REG =======\n"); ++ for (i = 0x800; i < 0x1000; i += 4) { ++ if (j % 4 == 1) ++ RTW_PRINT_SEL(sel, "0x%03x", i); ++ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); ++ if ((j++) % 4 == 0) ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ ++#ifdef CONFIG_RTL8822B ++ for (i = 0x1800; i < 0x2000; i += 4) { ++ if (j % 4 == 1) ++ RTW_PRINT_SEL(sel, "0x%03x", i); ++ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); ++ if ((j++) % 4 == 0) ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++#endif /* CONFIG_RTL8822B */ ++} ++ ++void rf_reg_dump(void *sel, _adapter *adapter) ++{ ++ int i, j = 1, path; ++ u32 value; ++ u8 rf_type = 0; ++ u8 path_nums = 0; ++ ++ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ if ((RF_1T2R == rf_type) || (RF_1T1R == rf_type)) ++ path_nums = 1; ++ else ++ path_nums = 2; ++ ++ RTW_PRINT_SEL(sel, "======= RF REG =======\n"); ++ ++ for (path = 0; path < path_nums; path++) { ++ RTW_PRINT_SEL(sel, "RF_Path(%x)\n", path); ++ for (i = 0; i < 0x100; i++) { ++ value = rtw_hal_read_rfreg(adapter, path, i, 0xffffffff); ++ if (j % 4 == 1) ++ RTW_PRINT_SEL(sel, "0x%02x ", i); ++ _RTW_PRINT_SEL(sel, " 0x%08x ", value); ++ if ((j++) % 4 == 0) ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ } ++} ++ ++static u8 fwdl_test_chksum_fail = 0; ++static u8 fwdl_test_wintint_rdy_fail = 0; ++ ++bool rtw_fwdl_test_trigger_chksum_fail(void) ++{ ++ if (fwdl_test_chksum_fail) { ++ RTW_PRINT("fwdl test case: trigger chksum_fail\n"); ++ fwdl_test_chksum_fail--; ++ return _TRUE; ++ } ++ return _FALSE; ++} ++ ++bool rtw_fwdl_test_trigger_wintint_rdy_fail(void) ++{ ++ if (fwdl_test_wintint_rdy_fail) { ++ RTW_PRINT("fwdl test case: trigger wintint_rdy_fail\n"); ++ fwdl_test_wintint_rdy_fail--; ++ return _TRUE; ++ } ++ return _FALSE; ++} ++ ++static u32 g_wait_hiq_empty_ms = 0; ++ ++u32 rtw_get_wait_hiq_empty_ms(void) ++{ ++ return g_wait_hiq_empty_ms; ++} ++ ++static u8 del_rx_ampdu_test_no_tx_fail = 0; ++ ++bool rtw_del_rx_ampdu_test_trigger_no_tx_fail(void) ++{ ++ if (del_rx_ampdu_test_no_tx_fail) { ++ RTW_PRINT("del_rx_ampdu test case: trigger no_tx_fail\n"); ++ del_rx_ampdu_test_no_tx_fail--; ++ return _TRUE; ++ } ++ return _FALSE; ++} ++ ++void rtw_sink_rtp_seq_dbg(_adapter *adapter, _pkt *pkt) ++{ ++ struct recv_priv *precvpriv = &(adapter->recvpriv); ++ if (precvpriv->sink_udpport > 0) { ++ if (*((u16 *)((pkt->data) + 0x24)) == cpu_to_be16(precvpriv->sink_udpport)) { ++ precvpriv->pre_rtp_rxseq = precvpriv->cur_rtp_rxseq; ++ precvpriv->cur_rtp_rxseq = be16_to_cpu(*((u16 *)((pkt->data) + 0x2C))); ++ if (precvpriv->pre_rtp_rxseq + 1 != precvpriv->cur_rtp_rxseq) ++ RTW_INFO("%s : RTP Seq num from %d to %d\n", __FUNCTION__, precvpriv->pre_rtp_rxseq, precvpriv->cur_rtp_rxseq); ++ } ++ } ++} ++ ++void sta_rx_reorder_ctl_dump(void *sel, struct sta_info *sta) ++{ ++ struct recv_reorder_ctrl *reorder_ctl; ++ int i; ++ ++ for (i = 0; i < 16; i++) { ++ reorder_ctl = &sta->recvreorder_ctrl[i]; ++ if (reorder_ctl->ampdu_size != RX_AMPDU_SIZE_INVALID || reorder_ctl->indicate_seq != 0xFFFF) { ++ RTW_PRINT_SEL(sel, "tid=%d, enable=%d, ampdu_size=%u, indicate_seq=%u\n" ++ , i, reorder_ctl->enable, reorder_ctl->ampdu_size, reorder_ctl->indicate_seq ++ ); ++ } ++ } ++} ++ ++void dump_tx_rate_bmp(void *sel, struct dvobj_priv *dvobj) ++{ ++ _adapter *adapter = dvobj_get_primary_adapter(dvobj); ++ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); ++ u8 bw; ++ ++ RTW_PRINT_SEL(sel, "%-6s", "bw"); ++ if (hal_chk_proto_cap(adapter, PROTO_CAP_11AC)) ++ _RTW_PRINT_SEL(sel, " %-11s", "vht"); ++ ++ _RTW_PRINT_SEL(sel, " %-11s %-4s %-3s\n", "ht", "ofdm", "cck"); ++ ++ for (bw = CHANNEL_WIDTH_20; bw <= CHANNEL_WIDTH_160; bw++) { ++ if (!hal_is_bw_support(adapter, bw)) ++ continue; ++ ++ RTW_PRINT_SEL(sel, "%6s", ch_width_str(bw)); ++ if (hal_chk_proto_cap(adapter, PROTO_CAP_11AC)) { ++ _RTW_PRINT_SEL(sel, " %03x %03x %03x" ++ , RATE_BMP_GET_VHT_3SS(rfctl->rate_bmp_vht_by_bw[bw]) ++ , RATE_BMP_GET_VHT_2SS(rfctl->rate_bmp_vht_by_bw[bw]) ++ , RATE_BMP_GET_VHT_1SS(rfctl->rate_bmp_vht_by_bw[bw]) ++ ); ++ } ++ ++ _RTW_PRINT_SEL(sel, " %02x %02x %02x %02x" ++ , bw <= CHANNEL_WIDTH_40 ? RATE_BMP_GET_HT_4SS(rfctl->rate_bmp_ht_by_bw[bw]) : 0 ++ , bw <= CHANNEL_WIDTH_40 ? RATE_BMP_GET_HT_3SS(rfctl->rate_bmp_ht_by_bw[bw]) : 0 ++ , bw <= CHANNEL_WIDTH_40 ? RATE_BMP_GET_HT_2SS(rfctl->rate_bmp_ht_by_bw[bw]) : 0 ++ , bw <= CHANNEL_WIDTH_40 ? RATE_BMP_GET_HT_1SS(rfctl->rate_bmp_ht_by_bw[bw]) : 0 ++ ); ++ ++ _RTW_PRINT_SEL(sel, " %03x %01x\n" ++ , bw <= CHANNEL_WIDTH_20 ? RATE_BMP_GET_OFDM(rfctl->rate_bmp_cck_ofdm) : 0 ++ , bw <= CHANNEL_WIDTH_20 ? RATE_BMP_GET_CCK(rfctl->rate_bmp_cck_ofdm) : 0 ++ ); ++ } ++} ++ ++void dump_adapters_status(void *sel, struct dvobj_priv *dvobj) ++{ ++ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); ++ int i; ++ _adapter *iface; ++ u8 u_ch, u_bw, u_offset; ++ ++ dump_mi_status(sel, dvobj); ++ ++ RTW_PRINT_SEL(sel, "dev status:%s%s\n\n" ++ , dev_is_surprise_removed(dvobj) ? " SR" : "" ++ , dev_is_drv_stopped(dvobj) ? " DS" : "" ++ ); ++ ++#ifdef CONFIG_P2P ++#define P2P_INFO_TITLE_FMT " %-3s %-4s" ++#define P2P_INFO_TITLE_ARG , "lch", "p2ps" ++#ifdef CONFIG_IOCTL_CFG80211 ++#define P2P_INFO_VALUE_FMT " %3u %c%3u" ++#define P2P_INFO_VALUE_ARG , iface->wdinfo.listen_channel, iface->wdev_data.p2p_enabled ? 'e' : ' ', rtw_p2p_state(&iface->wdinfo) ++#else ++#define P2P_INFO_VALUE_FMT " %3u %4u" ++#define P2P_INFO_VALUE_ARG , iface->wdinfo.listen_channel, rtw_p2p_state(&iface->wdinfo) ++#endif ++#define P2P_INFO_DASH "---------" ++#else ++#define P2P_INFO_TITLE_FMT "" ++#define P2P_INFO_TITLE_ARG ++#define P2P_INFO_VALUE_FMT "" ++#define P2P_INFO_VALUE_ARG ++#define P2P_INFO_DASH ++#endif ++ ++ RTW_PRINT_SEL(sel, "%-2s %-15s %c %-3s %-3s %-3s %-17s %-4s %-7s" ++ P2P_INFO_TITLE_FMT ++ " %s\n" ++ , "id", "ifname", ' ', "bup", "nup", "ncd", "macaddr", "port", "ch" ++ P2P_INFO_TITLE_ARG ++ , "status"); ++ ++ RTW_PRINT_SEL(sel, "---------------------------------------------------------------" ++ P2P_INFO_DASH ++ "-------\n"); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (iface) { ++ RTW_PRINT_SEL(sel, "%2d %-15s %c %3u %3u %3u "MAC_FMT" %4hhu %3u,%u,%u" ++ P2P_INFO_VALUE_FMT ++ " "MLME_STATE_FMT"\n" ++ , i, iface->registered ? ADPT_ARG(iface) : NULL ++ , iface->registered ? 'R' : ' ' ++ , iface->bup ++ , iface->netif_up ++ , iface->net_closed ++ , MAC_ARG(adapter_mac_addr(iface)) ++ , get_hw_port(iface) ++ , iface->mlmeextpriv.cur_channel ++ , iface->mlmeextpriv.cur_bwmode ++ , iface->mlmeextpriv.cur_ch_offset ++ P2P_INFO_VALUE_ARG ++ , MLME_STATE_ARG(iface) ++ ); ++ } ++ } ++ ++ RTW_PRINT_SEL(sel, "---------------------------------------------------------------" ++ P2P_INFO_DASH ++ "-------\n"); ++ ++ rtw_mi_get_ch_setting_union(dvobj->padapters[IFACE_ID0], &u_ch, &u_bw, &u_offset); ++ RTW_PRINT_SEL(sel, "%55s %3u,%u,%u\n" ++ , "union:" ++ , u_ch, u_bw, u_offset ++ ); ++ ++ RTW_PRINT_SEL(sel, "%55s %3u,%u,%u\n" ++ , "oper:" ++ , dvobj->oper_channel ++ , dvobj->oper_bwmode ++ , dvobj->oper_ch_offset ++ ); ++ ++#ifdef CONFIG_DFS_MASTER ++ if (rfctl->radar_detect_ch != 0) { ++ u32 non_ocp_ms; ++ u32 cac_ms; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (!dvobj->padapters[i]) ++ continue; ++ if (check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_AP_STATE) ++ && check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_ASOC_STATE)) ++ break; ++ } ++ ++ if (i >= dvobj->iface_nums) { ++ RTW_PRINT_SEL(sel, "DFS master enable without AP mode???"); ++ goto end_dfs_master; ++ } ++ ++ RTW_PRINT_SEL(sel, "%55s %3u,%u,%u" ++ , "radar_detect:" ++ , rfctl->radar_detect_ch ++ , rfctl->radar_detect_bw ++ , rfctl->radar_detect_offset ++ ); ++ ++ _RTW_PRINT_SEL(sel, ", domain:%u", rtw_odm_get_dfs_domain(dvobj->padapters[IFACE_ID0])); ++ ++ rtw_get_ch_waiting_ms(dvobj->padapters[i] ++ , rfctl->radar_detect_ch ++ , rfctl->radar_detect_bw ++ , rfctl->radar_detect_offset ++ , &non_ocp_ms ++ , &cac_ms ++ ); ++ ++ if (non_ocp_ms) ++ _RTW_PRINT_SEL(sel, ", non_ocp:%d", non_ocp_ms); ++ if (cac_ms) ++ _RTW_PRINT_SEL(sel, ", cac:%d", cac_ms); ++end_dfs_master: ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++#endif /* CONFIG_DFS_MASTER */ ++} ++ ++#define SEC_CAM_ENT_ID_TITLE_FMT "%-2s" ++#define SEC_CAM_ENT_ID_TITLE_ARG "id" ++#define SEC_CAM_ENT_ID_VALUE_FMT "%2u" ++#define SEC_CAM_ENT_ID_VALUE_ARG(id) (id) ++ ++#define SEC_CAM_ENT_TITLE_FMT "%-6s %-17s %-32s %-3s %-7s %-2s %-2s %-5s" ++#define SEC_CAM_ENT_TITLE_ARG "ctrl", "addr", "key", "kid", "type", "MK", "GK", "valid" ++#define SEC_CAM_ENT_VALUE_FMT "0x%04x "MAC_FMT" "KEY_FMT" %3u %-7s %2u %2u %5u" ++#define SEC_CAM_ENT_VALUE_ARG(ent) \ ++ (ent)->ctrl \ ++ , MAC_ARG((ent)->mac) \ ++ , KEY_ARG((ent)->key) \ ++ , ((ent)->ctrl) & 0x03 \ ++ , security_type_str((((ent)->ctrl) >> 2) & 0x07) \ ++ , (((ent)->ctrl) >> 5) & 0x01 \ ++ , (((ent)->ctrl) >> 6) & 0x01 \ ++ , (((ent)->ctrl) >> 15) & 0x01 ++ ++void dump_sec_cam_ent(void *sel, struct sec_cam_ent *ent, int id) ++{ ++ if (id >= 0) { ++ RTW_PRINT_SEL(sel, SEC_CAM_ENT_ID_VALUE_FMT " " SEC_CAM_ENT_VALUE_FMT"\n" ++ , SEC_CAM_ENT_ID_VALUE_ARG(id), SEC_CAM_ENT_VALUE_ARG(ent)); ++ } else ++ RTW_PRINT_SEL(sel, SEC_CAM_ENT_VALUE_FMT"\n", SEC_CAM_ENT_VALUE_ARG(ent)); ++} ++ ++void dump_sec_cam_ent_title(void *sel, u8 has_id) ++{ ++ if (has_id) { ++ RTW_PRINT_SEL(sel, SEC_CAM_ENT_ID_TITLE_FMT " " SEC_CAM_ENT_TITLE_FMT"\n" ++ , SEC_CAM_ENT_ID_TITLE_ARG, SEC_CAM_ENT_TITLE_ARG); ++ } else ++ RTW_PRINT_SEL(sel, SEC_CAM_ENT_TITLE_FMT"\n", SEC_CAM_ENT_TITLE_ARG); ++} ++ ++void dump_sec_cam(void *sel, _adapter *adapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ struct sec_cam_ent ent; ++ int i; ++ ++ RTW_PRINT_SEL(sel, "HW sec cam:\n"); ++ dump_sec_cam_ent_title(sel, 1); ++ for (i = 0; i < cam_ctl->num; i++) { ++ rtw_sec_read_cam_ent(adapter, i, (u8 *)(&ent.ctrl), ent.mac, ent.key); ++ dump_sec_cam_ent(sel , &ent, i); ++ } ++} ++ ++void dump_sec_cam_cache(void *sel, _adapter *adapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ int i; ++ ++ RTW_PRINT_SEL(sel, "SW sec cam cache:\n"); ++ dump_sec_cam_ent_title(sel, 1); ++ for (i = 0; i < cam_ctl->num; i++) { ++ if (dvobj->cam_cache[i].ctrl != 0) ++ dump_sec_cam_ent(sel, &dvobj->cam_cache[i], i); ++ } ++ ++} ++ ++#ifdef CONFIG_PROC_DEBUG ++ssize_t proc_set_write_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u32 addr, val, len; ++ ++ if (count < 3) { ++ RTW_INFO("argument size is less than 3\n"); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%x %x %x", &addr, &val, &len); ++ ++ if (num != 3) { ++ RTW_INFO("invalid write_reg parameter!\n"); ++ return count; ++ } ++ ++ switch (len) { ++ case 1: ++ rtw_write8(padapter, addr, (u8)val); ++ break; ++ case 2: ++ rtw_write16(padapter, addr, (u16)val); ++ break; ++ case 4: ++ rtw_write32(padapter, addr, val); ++ break; ++ default: ++ RTW_INFO("error write length=%d", len); ++ break; ++ } ++ ++ } ++ ++ return count; ++ ++} ++ ++static u32 proc_get_read_addr = 0xeeeeeeee; ++static u32 proc_get_read_len = 0x4; ++ ++int proc_get_read_reg(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ if (proc_get_read_addr == 0xeeeeeeee) { ++ RTW_PRINT_SEL(m, "address not initialized\n"); ++ return 0; ++ } ++ ++ switch (proc_get_read_len) { ++ case 1: ++ RTW_PRINT_SEL(m, "rtw_read8(0x%x)=0x%x\n", proc_get_read_addr, rtw_read8(padapter, proc_get_read_addr)); ++ break; ++ case 2: ++ RTW_PRINT_SEL(m, "rtw_read16(0x%x)=0x%x\n", proc_get_read_addr, rtw_read16(padapter, proc_get_read_addr)); ++ break; ++ case 4: ++ RTW_PRINT_SEL(m, "rtw_read32(0x%x)=0x%x\n", proc_get_read_addr, rtw_read32(padapter, proc_get_read_addr)); ++ break; ++ default: ++ RTW_PRINT_SEL(m, "error read length=%d\n", proc_get_read_len); ++ break; ++ } ++ ++ return 0; ++} ++ ++ssize_t proc_set_read_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ char tmp[16]; ++ u32 addr, len; ++ ++ if (count < 2) { ++ RTW_INFO("argument size is less than 2\n"); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%x %x", &addr, &len); ++ ++ if (num != 2) { ++ RTW_INFO("invalid read_reg parameter!\n"); ++ return count; ++ } ++ ++ proc_get_read_addr = addr; ++ ++ proc_get_read_len = len; ++ } ++ ++ return count; ++ ++} ++ ++int proc_get_fwstate(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ RTW_PRINT_SEL(m, "fwstate=0x%x\n", get_fwstate(pmlmepriv)); ++ ++ return 0; ++} ++ ++int proc_get_sec_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct security_priv *sec = &padapter->securitypriv; ++ ++ RTW_PRINT_SEL(m, "auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", ++ sec->dot11AuthAlgrthm, sec->dot11PrivacyAlgrthm, ++ sec->ndisauthtype, sec->ndisencryptstatus); ++ ++ RTW_PRINT_SEL(m, "hw_decrypted=%d\n", sec->hw_decrypted); ++ ++#ifdef DBG_SW_SEC_CNT ++ RTW_PRINT_SEL(m, "wep_sw_enc_cnt=%llu, %llu, %llu\n" ++ , sec->wep_sw_enc_cnt_bc , sec->wep_sw_enc_cnt_mc, sec->wep_sw_enc_cnt_uc); ++ RTW_PRINT_SEL(m, "wep_sw_dec_cnt=%llu, %llu, %llu\n" ++ , sec->wep_sw_dec_cnt_bc , sec->wep_sw_dec_cnt_mc, sec->wep_sw_dec_cnt_uc); ++ ++ RTW_PRINT_SEL(m, "tkip_sw_enc_cnt=%llu, %llu, %llu\n" ++ , sec->tkip_sw_enc_cnt_bc , sec->tkip_sw_enc_cnt_mc, sec->tkip_sw_enc_cnt_uc); ++ RTW_PRINT_SEL(m, "tkip_sw_dec_cnt=%llu, %llu, %llu\n" ++ , sec->tkip_sw_dec_cnt_bc , sec->tkip_sw_dec_cnt_mc, sec->tkip_sw_dec_cnt_uc); ++ ++ RTW_PRINT_SEL(m, "aes_sw_enc_cnt=%llu, %llu, %llu\n" ++ , sec->aes_sw_enc_cnt_bc , sec->aes_sw_enc_cnt_mc, sec->aes_sw_enc_cnt_uc); ++ RTW_PRINT_SEL(m, "aes_sw_dec_cnt=%llu, %llu, %llu\n" ++ , sec->aes_sw_dec_cnt_bc , sec->aes_sw_dec_cnt_mc, sec->aes_sw_dec_cnt_uc); ++#endif /* DBG_SW_SEC_CNT */ ++ ++ return 0; ++} ++ ++int proc_get_mlmext_state(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ RTW_PRINT_SEL(m, "pmlmeinfo->state=0x%x\n", pmlmeinfo->state); ++ ++ return 0; ++} ++ ++#ifdef CONFIG_LAYER2_ROAMING ++int proc_get_roam_flags(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_PRINT_SEL(m, "0x%02x\n", rtw_roam_flags(adapter)); ++ ++ return 0; ++} ++ ++ssize_t proc_set_roam_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ char tmp[32]; ++ u8 flags; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhx", &flags); ++ ++ if (num == 1) ++ rtw_assign_roam_flags(adapter, flags); ++ } ++ ++ return count; ++ ++} ++ ++int proc_get_roam_param(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ ++ RTW_PRINT_SEL(m, "%12s %12s %11s %14s\n", "rssi_diff_th", "scanr_exp_ms", "scan_int_ms", "rssi_threshold"); ++ RTW_PRINT_SEL(m, "%-12u %-12u %-11u %-14u\n" ++ , mlme->roam_rssi_diff_th ++ , mlme->roam_scanr_exp_ms ++ , mlme->roam_scan_int_ms ++ , mlme->roam_rssi_threshold ++ ); ++ ++ return 0; ++} ++ ++ssize_t proc_set_roam_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ ++ char tmp[32]; ++ u8 rssi_diff_th; ++ u32 scanr_exp_ms; ++ u32 scan_int_ms; ++ u8 rssi_threshold; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhu %u %u %hhu", &rssi_diff_th, &scanr_exp_ms, &scan_int_ms, &rssi_threshold); ++ ++ if (num >= 1) ++ mlme->roam_rssi_diff_th = rssi_diff_th; ++ if (num >= 2) ++ mlme->roam_scanr_exp_ms = scanr_exp_ms; ++ if (num >= 3) ++ mlme->roam_scan_int_ms = scan_int_ms; ++ if (num >= 4) ++ mlme->roam_rssi_threshold = rssi_threshold; ++ } ++ ++ return count; ++ ++} ++ ++ssize_t proc_set_roam_tgt_addr(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ char tmp[32]; ++ u8 addr[ETH_ALEN]; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhx:%hhx:%hhx:%hhx:%hhx:%hhx", addr, addr + 1, addr + 2, addr + 3, addr + 4, addr + 5); ++ if (num == 6) ++ _rtw_memcpy(adapter->mlmepriv.roam_tgt_addr, addr, ETH_ALEN); ++ ++ RTW_INFO("set roam_tgt_addr to "MAC_FMT"\n", MAC_ARG(adapter->mlmepriv.roam_tgt_addr)); ++ } ++ ++ return count; ++} ++#endif /* CONFIG_LAYER2_ROAMING */ ++ ++#ifdef CONFIG_RTW_80211R ++ssize_t proc_set_ft_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ char tmp[32]; ++ u8 flags; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int num = sscanf(tmp, "%hhx", &flags); ++ ++ if (num == 1) ++ adapter->mlmepriv.ftpriv.ft_flags = flags; ++ } ++ ++ return count; ++ ++} ++ ++int proc_get_ft_flags(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_PRINT_SEL(m, "0x%02x\n", adapter->mlmepriv.ftpriv.ft_flags); ++ ++ return 0; ++} ++#endif ++ ++int proc_get_qos_option(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ RTW_PRINT_SEL(m, "qos_option=%d\n", pmlmepriv->qospriv.qos_option); ++ ++ return 0; ++} ++ ++int proc_get_ht_option(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++#ifdef CONFIG_80211N_HT ++ RTW_PRINT_SEL(m, "ht_option=%d\n", pmlmepriv->htpriv.ht_option); ++#endif /* CONFIG_80211N_HT */ ++ ++ return 0; ++} ++ ++int proc_get_rf_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ RTW_PRINT_SEL(m, "cur_ch=%d, cur_bw=%d, cur_ch_offet=%d\n", ++ pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); ++ ++ RTW_PRINT_SEL(m, "oper_ch=%d, oper_bw=%d, oper_ch_offet=%d\n", ++ rtw_get_oper_ch(padapter), rtw_get_oper_bw(padapter), rtw_get_oper_choffset(padapter)); ++ ++ return 0; ++} ++ ++int proc_get_scan_param(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ struct ss_res *ss = &mlmeext->sitesurvey_res; ++ ++#define SCAN_PARAM_TITLE_FMT "%10s" ++#define SCAN_PARAM_VALUE_FMT "%-10u" ++#define SCAN_PARAM_TITLE_ARG , "scan_ch_ms" ++#define SCAN_PARAM_VALUE_ARG , ss->scan_ch_ms ++#ifdef CONFIG_80211N_HT ++#define SCAN_PARAM_TITLE_FMT_HT " %15s %13s" ++#define SCAN_PARAM_VALUE_FMT_HT " %-15u %-13u" ++#define SCAN_PARAM_TITLE_ARG_HT , "rx_ampdu_accept", "rx_ampdu_size" ++#define SCAN_PARAM_VALUE_ARG_HT , ss->rx_ampdu_accept, ss->rx_ampdu_size ++#else ++#define SCAN_PARAM_TITLE_FMT_HT "" ++#define SCAN_PARAM_VALUE_FMT_HT "" ++#define SCAN_PARAM_TITLE_ARG_HT ++#define SCAN_PARAM_VALUE_ARG_HT ++#endif ++#ifdef CONFIG_SCAN_BACKOP ++#define SCAN_PARAM_TITLE_FMT_BACKOP " %9s %12s" ++#define SCAN_PARAM_VALUE_FMT_BACKOP " %-9u %-12u" ++#define SCAN_PARAM_TITLE_ARG_BACKOP , "backop_ms", "scan_cnt_max" ++#define SCAN_PARAM_VALUE_ARG_BACKOP , ss->backop_ms, ss->scan_cnt_max ++#else ++#define SCAN_PARAM_TITLE_FMT_BACKOP "" ++#define SCAN_PARAM_VALUE_FMT_BACKOP "" ++#define SCAN_PARAM_TITLE_ARG_BACKOP ++#define SCAN_PARAM_VALUE_ARG_BACKOP ++#endif ++ ++ RTW_PRINT_SEL(m, ++ SCAN_PARAM_TITLE_FMT ++ SCAN_PARAM_TITLE_FMT_HT ++ SCAN_PARAM_TITLE_FMT_BACKOP ++ "\n" ++ SCAN_PARAM_TITLE_ARG ++ SCAN_PARAM_TITLE_ARG_HT ++ SCAN_PARAM_TITLE_ARG_BACKOP ++ ); ++ ++ RTW_PRINT_SEL(m, ++ SCAN_PARAM_VALUE_FMT ++ SCAN_PARAM_VALUE_FMT_HT ++ SCAN_PARAM_VALUE_FMT_BACKOP ++ "\n" ++ SCAN_PARAM_VALUE_ARG ++ SCAN_PARAM_VALUE_ARG_HT ++ SCAN_PARAM_VALUE_ARG_BACKOP ++ ); ++ ++ return 0; ++} ++ ++ssize_t proc_set_scan_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ struct ss_res *ss = &mlmeext->sitesurvey_res; ++ ++ char tmp[32] = {0}; ++ ++ u16 scan_ch_ms; ++#define SCAN_PARAM_INPUT_FMT "%hu" ++#define SCAN_PARAM_INPUT_ARG , &scan_ch_ms ++#ifdef CONFIG_80211N_HT ++ u8 rx_ampdu_accept; ++ u8 rx_ampdu_size; ++#define SCAN_PARAM_INPUT_FMT_HT " %hhu %hhu" ++#define SCAN_PARAM_INPUT_ARG_HT , &rx_ampdu_accept, &rx_ampdu_size ++#else ++#define SCAN_PARAM_INPUT_FMT_HT "" ++#define SCAN_PARAM_INPUT_ARG_HT ++#endif ++#ifdef CONFIG_SCAN_BACKOP ++ u16 backop_ms; ++ u8 scan_cnt_max; ++#define SCAN_PARAM_INPUT_FMT_BACKOP " %hu %hhu" ++#define SCAN_PARAM_INPUT_ARG_BACKOP , &backop_ms, &scan_cnt_max ++#else ++#define SCAN_PARAM_INPUT_FMT_BACKOP "" ++#define SCAN_PARAM_INPUT_ARG_BACKOP ++#endif ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, ++ SCAN_PARAM_INPUT_FMT ++ SCAN_PARAM_INPUT_FMT_HT ++ SCAN_PARAM_INPUT_FMT_BACKOP ++ SCAN_PARAM_INPUT_ARG ++ SCAN_PARAM_INPUT_ARG_HT ++ SCAN_PARAM_INPUT_ARG_BACKOP ++ ); ++ ++ if (num-- > 0) ++ ss->scan_ch_ms = scan_ch_ms; ++#ifdef CONFIG_80211N_HT ++ if (num-- > 0) ++ ss->rx_ampdu_accept = rx_ampdu_accept; ++ if (num-- > 0) ++ ss->rx_ampdu_size = rx_ampdu_size; ++#endif ++#ifdef CONFIG_SCAN_BACKOP ++ if (num-- > 0) ++ ss->backop_ms = backop_ms; ++ if (num-- > 0) ++ ss->scan_cnt_max = scan_cnt_max; ++#endif ++ } ++ ++ return count; ++} ++ ++int proc_get_scan_abort(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ u32 pass_ms; ++ ++ pass_ms = rtw_scan_abort_timeout(adapter, 10000); ++ ++ RTW_PRINT_SEL(m, "%u\n", pass_ms); ++ ++ return 0; ++} ++ ++#ifdef CONFIG_SCAN_BACKOP ++int proc_get_backop_flags_sta(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ ++ RTW_PRINT_SEL(m, "0x%02x\n", mlmeext_scan_backop_flags_sta(mlmeext)); ++ ++ return 0; ++} ++ ++ssize_t proc_set_backop_flags_sta(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ ++ char tmp[32]; ++ u8 flags; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhx", &flags); ++ ++ if (num == 1) ++ mlmeext_assign_scan_backop_flags_sta(mlmeext, flags); ++ } ++ ++ return count; ++} ++ ++int proc_get_backop_flags_ap(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ ++ RTW_PRINT_SEL(m, "0x%02x\n", mlmeext_scan_backop_flags_ap(mlmeext)); ++ ++ return 0; ++} ++ ++ssize_t proc_set_backop_flags_ap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ ++ char tmp[32]; ++ u8 flags; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhx", &flags); ++ ++ if (num == 1) ++ mlmeext_assign_scan_backop_flags_ap(mlmeext, flags); ++ } ++ ++ return count; ++} ++ ++#endif /* CONFIG_SCAN_BACKOP */ ++ ++int proc_get_survey_info(struct seq_file *m, void *v) ++{ ++ _irqL irqL; ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ _list *plist, *phead; ++ s32 notify_signal; ++ s16 notify_noise = 0; ++ u16 index = 0, ie_cap = 0; ++ unsigned char *ie_wpa = NULL, *ie_wpa2 = NULL, *ie_wps = NULL; ++ unsigned char *ie_p2p = NULL, *ssid = NULL; ++ char flag_str[64]; ++ int ielen = 0; ++ u32 wpsielen = 0; ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ phead = get_list_head(queue); ++ if (!phead) ++ return 0; ++ plist = get_next(phead); ++ if (!plist) ++ return 0; ++ ++ RTW_PRINT_SEL(m, "%5s %-17s %3s %-3s %-4s %-4s %5s %32s %32s\n", "index", "bssid", "ch", "RSSI", "SdBm", "Noise", "age", "flag", "ssid"); ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ if (!pnetwork) ++ break; ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && ++ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { ++ notify_signal = translate_percentage_to_dbm(padapter->recvpriv.signal_strength);/* dbm */ ++ } else { ++ notify_signal = translate_percentage_to_dbm(pnetwork->network.PhyInfo.SignalStrength);/* dbm */ ++ } ++ ++#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) ++ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &(pnetwork->network.Configuration.DSConfig), &(notify_noise)); ++#endif ++ ++ ie_wpa = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &ielen, pnetwork->network.IELength - 12); ++ ie_wpa2 = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &ielen, pnetwork->network.IELength - 12); ++ ie_cap = rtw_get_capability(&pnetwork->network); ++ ie_wps = rtw_get_wps_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &wpsielen); ++ ie_p2p = rtw_get_p2p_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &ielen); ++ ssid = pnetwork->network.Ssid.Ssid; ++ sprintf(flag_str, "%s%s%s%s%s%s%s", ++ (ie_wpa) ? "[WPA]" : "", ++ (ie_wpa2) ? "[WPA2]" : "", ++ (!ie_wpa && !ie_wpa && ie_cap & BIT(4)) ? "[WEP]" : "", ++ (ie_wps) ? "[WPS]" : "", ++ (pnetwork->network.InfrastructureMode == Ndis802_11IBSS) ? "[IBSS]" : "", ++ (ie_cap & BIT(0)) ? "[ESS]" : "", ++ (ie_p2p) ? "[P2P]" : ""); ++ RTW_PRINT_SEL(m, "%5d "MAC_FMT" %3d %3d %4d %4d %5d %32s %32s\n", ++ ++index, ++ MAC_ARG(pnetwork->network.MacAddress), ++ pnetwork->network.Configuration.DSConfig, ++ (int)pnetwork->network.Rssi, ++ notify_signal, ++ notify_noise, ++ rtw_get_passing_time_ms((u32)pnetwork->last_scanned), ++ flag_str, ++ pnetwork->network.Ssid.Ssid); ++ plist = get_next(plist); ++ } ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ return 0; ++} ++ ++ssize_t proc_set_survey_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ _irqL irqL; ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ bool need_indicate_scan_done = _FALSE; ++ u8 _status = _FALSE; ++ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++#ifdef CONFIG_MP_INCLUDED ++ if (rtw_mi_mp_mode_check(padapter)) { ++ RTW_INFO("MP mode block Scan request\n"); ++ goto exit; ++ } ++#endif ++ if (rtw_is_scan_deny(padapter)) { ++ RTW_INFO(FUNC_ADPT_FMT ": scan deny\n", FUNC_ADPT_ARG(padapter)); ++ goto exit; ++ } ++ ++ rtw_ps_deny(padapter, PS_DENY_SCAN); ++ if (_FAIL == rtw_pwr_wakeup(padapter)) ++ goto cancel_ps_deny; ++ ++ if (!rtw_is_adapter_up(padapter)) { ++ RTW_INFO("scan abort!! adapter cannot use\n"); ++ goto cancel_ps_deny; ++ } ++ ++ if (rtw_mi_busy_traffic_check(padapter, _FALSE)) { ++ RTW_INFO("scan abort!! BusyTraffic == _TRUE\n"); ++ goto cancel_ps_deny; ++ } ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) && check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { ++ RTW_INFO("scan abort!! AP mode process WPS\n"); ++ goto cancel_ps_deny; ++ } ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) == _TRUE) { ++ RTW_INFO("scan abort!! fwstate=0x%x\n", pmlmepriv->fw_state); ++ goto cancel_ps_deny; ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_buddy_check_fwstate(padapter, ++ _FW_UNDER_SURVEY | _FW_UNDER_LINKING | WIFI_UNDER_WPS)) { ++ RTW_INFO("scan abort!! buddy_fwstate check failed\n"); ++ goto cancel_ps_deny; ++ } ++#endif ++ _status = rtw_set_802_11_bssid_list_scan(padapter, NULL, 0, NULL, 0); ++ ++cancel_ps_deny: ++ rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); ++exit: ++ return count; ++} ++ ++int proc_get_ap_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ struct sta_info *psta; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); ++ if (psta) { ++ int i; ++ struct recv_reorder_ctrl *preorder_ctrl; ++ ++ RTW_PRINT_SEL(m, "SSID=%s\n", cur_network->network.Ssid.Ssid); ++ RTW_PRINT_SEL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); ++ RTW_PRINT_SEL(m, "cur_channel=%d, cur_bwmode=%d, cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); ++ RTW_PRINT_SEL(m, "wireless_mode=0x%x, rtsen=%d, cts2slef=%d\n", psta->wireless_mode, psta->rtsen, psta->cts2self); ++ RTW_PRINT_SEL(m, "state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); ++#ifdef CONFIG_80211N_HT ++ RTW_PRINT_SEL(m, "qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); ++ RTW_PRINT_SEL(m, "bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); ++ RTW_PRINT_SEL(m, "ampdu_enable = %d\n", psta->htpriv.ampdu_enable); ++ RTW_PRINT_SEL(m, "agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); ++ RTW_PRINT_SEL(m, "ldpc_cap=0x%x, stbc_cap=0x%x, beamform_cap=0x%x\n", psta->htpriv.ldpc_cap, psta->htpriv.stbc_cap, psta->htpriv.beamform_cap); ++#endif /* CONFIG_80211N_HT */ ++#ifdef CONFIG_80211AC_VHT ++ RTW_PRINT_SEL(m, "vht_en=%d, vht_sgi_80m=%d\n", psta->vhtpriv.vht_option, psta->vhtpriv.sgi_80m); ++ RTW_PRINT_SEL(m, "vht_ldpc_cap=0x%x, vht_stbc_cap=0x%x, vht_beamform_cap=0x%x\n", psta->vhtpriv.ldpc_cap, psta->vhtpriv.stbc_cap, psta->vhtpriv.beamform_cap); ++ RTW_PRINT_SEL(m, "vht_mcs_map=0x%x, vht_highest_rate=0x%x, vht_ampdu_len=%d\n", *(u16 *)psta->vhtpriv.vht_mcs_map, psta->vhtpriv.vht_highest_rate, psta->vhtpriv.ampdu_len); ++#endif ++ ++ sta_rx_reorder_ctl_dump(m, psta); ++ } else ++ RTW_PRINT_SEL(m, "can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); ++ ++ return 0; ++} ++ ++ssize_t proc_reset_trx_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ char cmd[32] = {0}; ++ u8 cnt = 0; ++ ++ if (count > sizeof(cmd)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(cmd, buffer, count)) { ++ int num = sscanf(cmd, "%hhx", &cnt); ++ ++ if (0 == cnt) { ++ pdbgpriv->dbg_rx_ampdu_drop_count = 0; ++ pdbgpriv->dbg_rx_ampdu_forced_indicate_count = 0; ++ pdbgpriv->dbg_rx_ampdu_loss_count = 0; ++ pdbgpriv->dbg_rx_dup_mgt_frame_drop_count = 0; ++ pdbgpriv->dbg_rx_ampdu_window_shift_cnt = 0; ++ pdbgpriv->dbg_rx_conflic_mac_addr_cnt = 0; ++ } ++ } ++ ++ return count; ++} ++ ++int proc_get_trx_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ int i; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ struct hw_xmit *phwxmit; ++ ++ dump_os_queue(m, padapter); ++ ++ RTW_PRINT_SEL(m, "free_xmitbuf_cnt=%d, free_xmitframe_cnt=%d\n" ++ , pxmitpriv->free_xmitbuf_cnt, pxmitpriv->free_xmitframe_cnt); ++ RTW_PRINT_SEL(m, "free_ext_xmitbuf_cnt=%d, free_xframe_ext_cnt=%d\n" ++ , pxmitpriv->free_xmit_extbuf_cnt, pxmitpriv->free_xframe_ext_cnt); ++ RTW_PRINT_SEL(m, "free_recvframe_cnt=%d\n" ++ , precvpriv->free_recvframe_cnt); ++ ++ for (i = 0; i < 4; i++) { ++ phwxmit = pxmitpriv->hwxmits + i; ++ RTW_PRINT_SEL(m, "%d, hwq.accnt=%d\n", i, phwxmit->accnt); ++ } ++ ++#ifdef CONFIG_USB_HCI ++ RTW_PRINT_SEL(m, "rx_urb_pending_cn=%d\n", ATOMIC_READ(&(precvpriv->rx_pending_cnt))); ++#endif ++ ++ /* Folowing are RX info */ ++ /* Counts of packets whose seq_num is less than preorder_ctrl->indicate_seq, Ex delay, retransmission, redundant packets and so on */ ++ RTW_PRINT_SEL(m, "Rx: Counts of Packets Whose Seq_Num Less Than Reorder Control Seq_Num: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_drop_count); ++ /* How many times the Rx Reorder Timer is triggered. */ ++ RTW_PRINT_SEL(m, "Rx: Reorder Time-out Trigger Counts: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_forced_indicate_count); ++ /* Total counts of packets loss */ ++ RTW_PRINT_SEL(m, "Rx: Packet Loss Counts: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_loss_count); ++ RTW_PRINT_SEL(m, "Rx: Duplicate Management Frame Drop Count: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_dup_mgt_frame_drop_count); ++ RTW_PRINT_SEL(m, "Rx: AMPDU BA window shift Count: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_window_shift_cnt); ++ /*The same mac addr counts*/ ++ RTW_PRINT_SEL(m, "Rx: Conflict MAC Address Frames Count: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_conflic_mac_addr_cnt); ++ return 0; ++} ++ ++int proc_get_dis_pwt(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 dis_pwt = 0; ++ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DIS_PWT, &(dis_pwt)); ++ RTW_PRINT_SEL(m, " Tx Power training mode:%s\n", (dis_pwt == _TRUE) ? "Disable" : "Enable"); ++ return 0; ++} ++ssize_t proc_set_dis_pwt(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[4] = {0}; ++ u8 dis_pwt = 0; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhx", &dis_pwt); ++ RTW_INFO("Set Tx Power training mode:%s\n", (dis_pwt == _TRUE) ? "Disable" : "Enable"); ++ ++ if (num >= 1) ++ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DIS_PWT, &(dis_pwt)); ++ } ++ ++ return count; ++ ++} ++ ++int proc_get_rate_ctl(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ int i; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 data_rate = 0, sgi = 0, data_fb = 0; ++ ++ if (adapter->fix_rate != 0xff) { ++ data_rate = adapter->fix_rate & 0x7F; ++ sgi = adapter->fix_rate >> 7; ++ data_fb = adapter->data_fb ? 1 : 0; ++ RTW_PRINT_SEL(m, "FIXED %s%s%s\n" ++ , HDATA_RATE(data_rate) ++ , data_rate > DESC_RATE54M ? (sgi ? " SGI" : " LGI") : "" ++ , data_fb ? " FB" : "" ++ ); ++ RTW_PRINT_SEL(m, "0x%02x %u\n", adapter->fix_rate, adapter->data_fb); ++ } else ++ RTW_PRINT_SEL(m, "RA\n"); ++ ++ return 0; ++} ++ ++ssize_t proc_set_rate_ctl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u8 fix_rate; ++ u8 data_fb; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhx %hhu", &fix_rate, &data_fb); ++ ++ if (num >= 1) { ++ u8 fix_rate_ori = adapter->fix_rate; ++ ++ adapter->fix_rate = fix_rate; ++ if (adapter->fix_bw != 0xFF && fix_rate_ori != fix_rate) ++ rtw_update_tx_rate_bmp(adapter_to_dvobj(adapter)); ++ } ++ if (num >= 2) ++ adapter->data_fb = data_fb ? 1 : 0; ++ } ++ ++ return count; ++} ++int proc_get_bw_ctl(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 data_bw = 0; ++ ++ if (adapter->fix_bw != 0xff) { ++ data_bw = adapter->fix_bw; ++ RTW_PRINT_SEL(m, "FIXED %s\n", ch_width_str(data_bw)); ++ } else ++ RTW_PRINT_SEL(m, "Auto\n"); ++ ++ return 0; ++} ++ ++ssize_t proc_set_bw_ctl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u8 fix_bw; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int num = sscanf(tmp, "%hhu", &fix_bw); ++ ++ if (num >= 1) { ++ u8 fix_bw_ori = adapter->fix_bw; ++ ++ adapter->fix_bw = fix_bw; ++ ++ if (adapter->fix_rate != 0xFF && fix_bw_ori != fix_bw) ++ rtw_update_tx_rate_bmp(adapter_to_dvobj(adapter)); ++ } ++ } ++ ++ return count; ++} ++ ++#ifdef DBG_RX_COUNTER_DUMP ++int proc_get_rx_cnt_dump(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ int i; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_PRINT_SEL(m, "BIT0- Dump RX counters of DRV\n"); ++ RTW_PRINT_SEL(m, "BIT1- Dump RX counters of MAC\n"); ++ RTW_PRINT_SEL(m, "BIT2- Dump RX counters of PHY\n"); ++ RTW_PRINT_SEL(m, "BIT3- Dump TRX data frame of DRV\n"); ++ RTW_PRINT_SEL(m, "dump_rx_cnt_mode = 0x%02x\n", adapter->dump_rx_cnt_mode); ++ ++ return 0; ++} ++ssize_t proc_set_rx_cnt_dump(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u8 dump_rx_cnt_mode; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhx", &dump_rx_cnt_mode); ++ ++ rtw_dump_phy_rxcnts_preprocess(adapter, dump_rx_cnt_mode); ++ adapter->dump_rx_cnt_mode = dump_rx_cnt_mode; ++ ++ } ++ ++ return count; ++} ++#endif ++ssize_t proc_set_fwdl_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ int num; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) ++ num = sscanf(tmp, "%hhu %hhu", &fwdl_test_chksum_fail, &fwdl_test_wintint_rdy_fail); ++ ++ return count; ++} ++ ++ssize_t proc_set_del_rx_ampdu_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ int num; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) ++ num = sscanf(tmp, "%hhu", &del_rx_ampdu_test_no_tx_fail); ++ ++ return count; ++} ++ ++#ifdef CONFIG_DFS_MASTER ++int proc_get_dfs_master_test_case(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ ++ RTW_PRINT_SEL(m, "%-24s %-19s\n", "radar_detect_trigger_non", "choose_dfs_ch_first"); ++ RTW_PRINT_SEL(m, "%24hhu %19hhu\n" ++ , rfctl->dbg_dfs_master_radar_detect_trigger_non ++ , rfctl->dbg_dfs_master_choose_dfs_ch_first ++ ); ++ ++ return 0; ++} ++ ++ssize_t proc_set_dfs_master_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ char tmp[32]; ++ u8 radar_detect_trigger_non; ++ u8 choose_dfs_ch_first; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int num = sscanf(tmp, "%hhu %hhu", &radar_detect_trigger_non, &choose_dfs_ch_first); ++ ++ if (num >= 1) ++ rfctl->dbg_dfs_master_radar_detect_trigger_non = radar_detect_trigger_non; ++ if (num >= 2) ++ rfctl->dbg_dfs_master_choose_dfs_ch_first = choose_dfs_ch_first; ++ } ++ ++ return count; ++} ++#endif /* CONFIG_DFS_MASTER */ ++ ++ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ int num; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) ++ num = sscanf(tmp, "%u", &g_wait_hiq_empty_ms); ++ ++ return count; ++} ++ ++int proc_get_suspend_resume_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct dvobj_priv *dvobj = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; ++ ++ RTW_PRINT_SEL(m, "dbg_sdio_alloc_irq_cnt=%d\n", pdbgpriv->dbg_sdio_alloc_irq_cnt); ++ RTW_PRINT_SEL(m, "dbg_sdio_free_irq_cnt=%d\n", pdbgpriv->dbg_sdio_free_irq_cnt); ++ RTW_PRINT_SEL(m, "dbg_sdio_alloc_irq_error_cnt=%d\n", pdbgpriv->dbg_sdio_alloc_irq_error_cnt); ++ RTW_PRINT_SEL(m, "dbg_sdio_free_irq_error_cnt=%d\n", pdbgpriv->dbg_sdio_free_irq_error_cnt); ++ RTW_PRINT_SEL(m, "dbg_sdio_init_error_cnt=%d\n", pdbgpriv->dbg_sdio_init_error_cnt); ++ RTW_PRINT_SEL(m, "dbg_sdio_deinit_error_cnt=%d\n", pdbgpriv->dbg_sdio_deinit_error_cnt); ++ RTW_PRINT_SEL(m, "dbg_suspend_error_cnt=%d\n", pdbgpriv->dbg_suspend_error_cnt); ++ RTW_PRINT_SEL(m, "dbg_suspend_cnt=%d\n", pdbgpriv->dbg_suspend_cnt); ++ RTW_PRINT_SEL(m, "dbg_resume_cnt=%d\n", pdbgpriv->dbg_resume_cnt); ++ RTW_PRINT_SEL(m, "dbg_resume_error_cnt=%d\n", pdbgpriv->dbg_resume_error_cnt); ++ RTW_PRINT_SEL(m, "dbg_deinit_fail_cnt=%d\n", pdbgpriv->dbg_deinit_fail_cnt); ++ RTW_PRINT_SEL(m, "dbg_carddisable_cnt=%d\n", pdbgpriv->dbg_carddisable_cnt); ++ RTW_PRINT_SEL(m, "dbg_ps_insuspend_cnt=%d\n", pdbgpriv->dbg_ps_insuspend_cnt); ++ RTW_PRINT_SEL(m, "dbg_dev_unload_inIPS_cnt=%d\n", pdbgpriv->dbg_dev_unload_inIPS_cnt); ++ RTW_PRINT_SEL(m, "dbg_scan_pwr_state_cnt=%d\n", pdbgpriv->dbg_scan_pwr_state_cnt); ++ RTW_PRINT_SEL(m, "dbg_downloadfw_pwr_state_cnt=%d\n", pdbgpriv->dbg_downloadfw_pwr_state_cnt); ++ RTW_PRINT_SEL(m, "dbg_carddisable_error_cnt=%d\n", pdbgpriv->dbg_carddisable_error_cnt); ++ RTW_PRINT_SEL(m, "dbg_fw_read_ps_state_fail_cnt=%d\n", pdbgpriv->dbg_fw_read_ps_state_fail_cnt); ++ RTW_PRINT_SEL(m, "dbg_leave_ips_fail_cnt=%d\n", pdbgpriv->dbg_leave_ips_fail_cnt); ++ RTW_PRINT_SEL(m, "dbg_leave_lps_fail_cnt=%d\n", pdbgpriv->dbg_leave_lps_fail_cnt); ++ RTW_PRINT_SEL(m, "dbg_h2c_leave32k_fail_cnt=%d\n", pdbgpriv->dbg_h2c_leave32k_fail_cnt); ++ RTW_PRINT_SEL(m, "dbg_diswow_dload_fw_fail_cnt=%d\n", pdbgpriv->dbg_diswow_dload_fw_fail_cnt); ++ RTW_PRINT_SEL(m, "dbg_enwow_dload_fw_fail_cnt=%d\n", pdbgpriv->dbg_enwow_dload_fw_fail_cnt); ++ RTW_PRINT_SEL(m, "dbg_ips_drvopen_fail_cnt=%d\n", pdbgpriv->dbg_ips_drvopen_fail_cnt); ++ RTW_PRINT_SEL(m, "dbg_poll_fail_cnt=%d\n", pdbgpriv->dbg_poll_fail_cnt); ++ RTW_PRINT_SEL(m, "dbg_rpwm_toogle_cnt=%d\n", pdbgpriv->dbg_rpwm_toogle_cnt); ++ RTW_PRINT_SEL(m, "dbg_rpwm_timeout_fail_cnt=%d\n", pdbgpriv->dbg_rpwm_timeout_fail_cnt); ++ RTW_PRINT_SEL(m, "dbg_sreset_cnt=%d\n", pdbgpriv->dbg_sreset_cnt); ++ ++ return 0; ++} ++ ++#ifdef CONFIG_DBG_COUNTER ++ ++int proc_get_rx_logs(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct rx_logs *rx_logs = &padapter->rx_logs; ++ ++ RTW_PRINT_SEL(m, ++ "intf_rx=%d\n" ++ "intf_rx_err_recvframe=%d\n" ++ "intf_rx_err_skb=%d\n" ++ "intf_rx_report=%d\n" ++ "core_rx=%d\n" ++ "core_rx_pre=%d\n" ++ "core_rx_pre_ver_err=%d\n" ++ "core_rx_pre_mgmt=%d\n" ++ "core_rx_pre_mgmt_err_80211w=%d\n" ++ "core_rx_pre_mgmt_err=%d\n" ++ "core_rx_pre_ctrl=%d\n" ++ "core_rx_pre_ctrl_err=%d\n" ++ "core_rx_pre_data=%d\n" ++ "core_rx_pre_data_wapi_seq_err=%d\n" ++ "core_rx_pre_data_wapi_key_err=%d\n" ++ "core_rx_pre_data_handled=%d\n" ++ "core_rx_pre_data_err=%d\n" ++ "core_rx_pre_data_unknown=%d\n" ++ "core_rx_pre_unknown=%d\n" ++ "core_rx_enqueue=%d\n" ++ "core_rx_dequeue=%d\n" ++ "core_rx_post=%d\n" ++ "core_rx_post_decrypt=%d\n" ++ "core_rx_post_decrypt_wep=%d\n" ++ "core_rx_post_decrypt_tkip=%d\n" ++ "core_rx_post_decrypt_aes=%d\n" ++ "core_rx_post_decrypt_wapi=%d\n" ++ "core_rx_post_decrypt_hw=%d\n" ++ "core_rx_post_decrypt_unknown=%d\n" ++ "core_rx_post_decrypt_err=%d\n" ++ "core_rx_post_defrag_err=%d\n" ++ "core_rx_post_portctrl_err=%d\n" ++ "core_rx_post_indicate=%d\n" ++ "core_rx_post_indicate_in_oder=%d\n" ++ "core_rx_post_indicate_reoder=%d\n" ++ "core_rx_post_indicate_err=%d\n" ++ "os_indicate=%d\n" ++ "os_indicate_ap_mcast=%d\n" ++ "os_indicate_ap_forward=%d\n" ++ "os_indicate_ap_self=%d\n" ++ "os_indicate_err=%d\n" ++ "os_netif_ok=%d\n" ++ "os_netif_err=%d\n", ++ rx_logs->intf_rx, ++ rx_logs->intf_rx_err_recvframe, ++ rx_logs->intf_rx_err_skb, ++ rx_logs->intf_rx_report, ++ rx_logs->core_rx, ++ rx_logs->core_rx_pre, ++ rx_logs->core_rx_pre_ver_err, ++ rx_logs->core_rx_pre_mgmt, ++ rx_logs->core_rx_pre_mgmt_err_80211w, ++ rx_logs->core_rx_pre_mgmt_err, ++ rx_logs->core_rx_pre_ctrl, ++ rx_logs->core_rx_pre_ctrl_err, ++ rx_logs->core_rx_pre_data, ++ rx_logs->core_rx_pre_data_wapi_seq_err, ++ rx_logs->core_rx_pre_data_wapi_key_err, ++ rx_logs->core_rx_pre_data_handled, ++ rx_logs->core_rx_pre_data_err, ++ rx_logs->core_rx_pre_data_unknown, ++ rx_logs->core_rx_pre_unknown, ++ rx_logs->core_rx_enqueue, ++ rx_logs->core_rx_dequeue, ++ rx_logs->core_rx_post, ++ rx_logs->core_rx_post_decrypt, ++ rx_logs->core_rx_post_decrypt_wep, ++ rx_logs->core_rx_post_decrypt_tkip, ++ rx_logs->core_rx_post_decrypt_aes, ++ rx_logs->core_rx_post_decrypt_wapi, ++ rx_logs->core_rx_post_decrypt_hw, ++ rx_logs->core_rx_post_decrypt_unknown, ++ rx_logs->core_rx_post_decrypt_err, ++ rx_logs->core_rx_post_defrag_err, ++ rx_logs->core_rx_post_portctrl_err, ++ rx_logs->core_rx_post_indicate, ++ rx_logs->core_rx_post_indicate_in_oder, ++ rx_logs->core_rx_post_indicate_reoder, ++ rx_logs->core_rx_post_indicate_err, ++ rx_logs->os_indicate, ++ rx_logs->os_indicate_ap_mcast, ++ rx_logs->os_indicate_ap_forward, ++ rx_logs->os_indicate_ap_self, ++ rx_logs->os_indicate_err, ++ rx_logs->os_netif_ok, ++ rx_logs->os_netif_err ++ ); ++ ++ return 0; ++} ++ ++int proc_get_tx_logs(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tx_logs *tx_logs = &padapter->tx_logs; ++ ++ RTW_PRINT_SEL(m, ++ "os_tx=%d\n" ++ "os_tx_err_up=%d\n" ++ "os_tx_err_xmit=%d\n" ++ "os_tx_m2u=%d\n" ++ "os_tx_m2u_ignore_fw_linked=%d\n" ++ "os_tx_m2u_ignore_self=%d\n" ++ "os_tx_m2u_entry=%d\n" ++ "os_tx_m2u_entry_err_xmit=%d\n" ++ "os_tx_m2u_entry_err_skb=%d\n" ++ "os_tx_m2u_stop=%d\n" ++ "core_tx=%d\n" ++ "core_tx_err_pxmitframe=%d\n" ++ "core_tx_err_brtx=%d\n" ++ "core_tx_upd_attrib=%d\n" ++ "core_tx_upd_attrib_adhoc=%d\n" ++ "core_tx_upd_attrib_sta=%d\n" ++ "core_tx_upd_attrib_ap=%d\n" ++ "core_tx_upd_attrib_unknown=%d\n" ++ "core_tx_upd_attrib_dhcp=%d\n" ++ "core_tx_upd_attrib_icmp=%d\n" ++ "core_tx_upd_attrib_active=%d\n" ++ "core_tx_upd_attrib_err_ucast_sta=%d\n" ++ "core_tx_upd_attrib_err_ucast_ap_link=%d\n" ++ "core_tx_upd_attrib_err_sta=%d\n" ++ "core_tx_upd_attrib_err_link=%d\n" ++ "core_tx_upd_attrib_err_sec=%d\n" ++ "core_tx_ap_enqueue_warn_fwstate=%d\n" ++ "core_tx_ap_enqueue_warn_sta=%d\n" ++ "core_tx_ap_enqueue_warn_nosta=%d\n" ++ "core_tx_ap_enqueue_warn_link=%d\n" ++ "core_tx_ap_enqueue_warn_trigger=%d\n" ++ "core_tx_ap_enqueue_mcast=%d\n" ++ "core_tx_ap_enqueue_ucast=%d\n" ++ "core_tx_ap_enqueue=%d\n" ++ "intf_tx=%d\n" ++ "intf_tx_pending_ac=%d\n" ++ "intf_tx_pending_fw_under_survey=%d\n" ++ "intf_tx_pending_fw_under_linking=%d\n" ++ "intf_tx_pending_xmitbuf=%d\n" ++ "intf_tx_enqueue=%d\n" ++ "core_tx_enqueue=%d\n" ++ "core_tx_enqueue_class=%d\n" ++ "core_tx_enqueue_class_err_sta=%d\n" ++ "core_tx_enqueue_class_err_nosta=%d\n" ++ "core_tx_enqueue_class_err_fwlink=%d\n" ++ "intf_tx_direct=%d\n" ++ "intf_tx_direct_err_coalesce=%d\n" ++ "intf_tx_dequeue=%d\n" ++ "intf_tx_dequeue_err_coalesce=%d\n" ++ "intf_tx_dump_xframe=%d\n" ++ "intf_tx_dump_xframe_err_txdesc=%d\n" ++ "intf_tx_dump_xframe_err_port=%d\n", ++ tx_logs->os_tx, ++ tx_logs->os_tx_err_up, ++ tx_logs->os_tx_err_xmit, ++ tx_logs->os_tx_m2u, ++ tx_logs->os_tx_m2u_ignore_fw_linked, ++ tx_logs->os_tx_m2u_ignore_self, ++ tx_logs->os_tx_m2u_entry, ++ tx_logs->os_tx_m2u_entry_err_xmit, ++ tx_logs->os_tx_m2u_entry_err_skb, ++ tx_logs->os_tx_m2u_stop, ++ tx_logs->core_tx, ++ tx_logs->core_tx_err_pxmitframe, ++ tx_logs->core_tx_err_brtx, ++ tx_logs->core_tx_upd_attrib, ++ tx_logs->core_tx_upd_attrib_adhoc, ++ tx_logs->core_tx_upd_attrib_sta, ++ tx_logs->core_tx_upd_attrib_ap, ++ tx_logs->core_tx_upd_attrib_unknown, ++ tx_logs->core_tx_upd_attrib_dhcp, ++ tx_logs->core_tx_upd_attrib_icmp, ++ tx_logs->core_tx_upd_attrib_active, ++ tx_logs->core_tx_upd_attrib_err_ucast_sta, ++ tx_logs->core_tx_upd_attrib_err_ucast_ap_link, ++ tx_logs->core_tx_upd_attrib_err_sta, ++ tx_logs->core_tx_upd_attrib_err_link, ++ tx_logs->core_tx_upd_attrib_err_sec, ++ tx_logs->core_tx_ap_enqueue_warn_fwstate, ++ tx_logs->core_tx_ap_enqueue_warn_sta, ++ tx_logs->core_tx_ap_enqueue_warn_nosta, ++ tx_logs->core_tx_ap_enqueue_warn_link, ++ tx_logs->core_tx_ap_enqueue_warn_trigger, ++ tx_logs->core_tx_ap_enqueue_mcast, ++ tx_logs->core_tx_ap_enqueue_ucast, ++ tx_logs->core_tx_ap_enqueue, ++ tx_logs->intf_tx, ++ tx_logs->intf_tx_pending_ac, ++ tx_logs->intf_tx_pending_fw_under_survey, ++ tx_logs->intf_tx_pending_fw_under_linking, ++ tx_logs->intf_tx_pending_xmitbuf, ++ tx_logs->intf_tx_enqueue, ++ tx_logs->core_tx_enqueue, ++ tx_logs->core_tx_enqueue_class, ++ tx_logs->core_tx_enqueue_class_err_sta, ++ tx_logs->core_tx_enqueue_class_err_nosta, ++ tx_logs->core_tx_enqueue_class_err_fwlink, ++ tx_logs->intf_tx_direct, ++ tx_logs->intf_tx_direct_err_coalesce, ++ tx_logs->intf_tx_dequeue, ++ tx_logs->intf_tx_dequeue_err_coalesce, ++ tx_logs->intf_tx_dump_xframe, ++ tx_logs->intf_tx_dump_xframe_err_txdesc, ++ tx_logs->intf_tx_dump_xframe_err_port ++ ); ++ ++ return 0; ++} ++ ++int proc_get_int_logs(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_PRINT_SEL(m, ++ "all=%d\n" ++ "err=%d\n" ++ "tbdok=%d\n" ++ "tbder=%d\n" ++ "bcnderr=%d\n" ++ "bcndma=%d\n" ++ "bcndma_e=%d\n" ++ "rx=%d\n" ++ "rx_rdu=%d\n" ++ "rx_fovw=%d\n" ++ "txfovw=%d\n" ++ "mgntok=%d\n" ++ "highdok=%d\n" ++ "bkdok=%d\n" ++ "bedok=%d\n" ++ "vidok=%d\n" ++ "vodok=%d\n", ++ padapter->int_logs.all, ++ padapter->int_logs.err, ++ padapter->int_logs.tbdok, ++ padapter->int_logs.tbder, ++ padapter->int_logs.bcnderr, ++ padapter->int_logs.bcndma, ++ padapter->int_logs.bcndma_e, ++ padapter->int_logs.rx, ++ padapter->int_logs.rx_rdu, ++ padapter->int_logs.rx_fovw, ++ padapter->int_logs.txfovw, ++ padapter->int_logs.mgntok, ++ padapter->int_logs.highdok, ++ padapter->int_logs.bkdok, ++ padapter->int_logs.bedok, ++ padapter->int_logs.vidok, ++ padapter->int_logs.vodok ++ ); ++ ++ return 0; ++} ++ ++#endif /* CONFIG_DBG_COUNTER */ ++ ++int proc_get_hw_status(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct dvobj_priv *dvobj = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; ++ struct registry_priv *regsty = dvobj_to_regsty(dvobj); ++ ++ if (regsty->check_hw_status == 0) ++ RTW_PRINT_SEL(m, "RX FIFO full count: not check in watch dog\n"); ++ else if (pdbgpriv->dbg_rx_fifo_last_overflow == 1 ++ && pdbgpriv->dbg_rx_fifo_curr_overflow == 1 ++ && pdbgpriv->dbg_rx_fifo_diff_overflow == 1 ++ ) ++ RTW_PRINT_SEL(m, "RX FIFO full count: no implementation\n"); ++ else { ++ RTW_PRINT_SEL(m, "RX FIFO full count: last_time=%llu, current_time=%llu, differential=%llu\n" ++ , pdbgpriv->dbg_rx_fifo_last_overflow, pdbgpriv->dbg_rx_fifo_curr_overflow, pdbgpriv->dbg_rx_fifo_diff_overflow); ++ } ++ ++ return 0; ++} ++ ++ssize_t proc_set_hw_status(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct dvobj_priv *dvobj = padapter->dvobj; ++ struct registry_priv *regsty = dvobj_to_regsty(dvobj); ++ char tmp[32]; ++ u32 enable; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%d ", &enable); ++ ++ if (regsty && enable <= 1) { ++ regsty->check_hw_status = enable; ++ RTW_INFO("check_hw_status=%d\n", regsty->check_hw_status); ++ } ++ } ++ ++ return count; ++} ++ ++int proc_get_trx_info_debug(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ int i; ++ ++ ++ /*============ tx info ============ */ ++ rtw_hal_get_def_var(padapter, HW_DEF_RA_INFO_DUMP, m); ++ ++ /*============ rx info ============ */ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_RX_INFO_DUMP, m, _FALSE); ++ ++ ++ return 0; ++} ++ ++int proc_get_rx_signal(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ RTW_PRINT_SEL(m, "rssi:%d\n", padapter->recvpriv.rssi); ++ /* RTW_PRINT_SEL(m, "rxpwdb:%d\n", padapter->recvpriv.rxpwdb); */ ++ RTW_PRINT_SEL(m, "signal_strength:%u\n", padapter->recvpriv.signal_strength); ++ RTW_PRINT_SEL(m, "signal_qual:%u\n", padapter->recvpriv.signal_qual); ++ if (padapter->registrypriv.mp_mode == 1) { ++ if (padapter->mppriv.antenna_rx == ANTENNA_A) ++ RTW_PRINT_SEL(m, "Antenna: A\n"); ++ else if (padapter->mppriv.antenna_rx == ANTENNA_B) ++ RTW_PRINT_SEL(m, "Antenna: B\n"); ++ else if (padapter->mppriv.antenna_rx == ANTENNA_C) ++ RTW_PRINT_SEL(m, "Antenna: C\n"); ++ else if (padapter->mppriv.antenna_rx == ANTENNA_D) ++ RTW_PRINT_SEL(m, "Antenna: D\n"); ++ else if (padapter->mppriv.antenna_rx == ANTENNA_AB) ++ RTW_PRINT_SEL(m, "Antenna: AB\n"); ++ else if (padapter->mppriv.antenna_rx == ANTENNA_BC) ++ RTW_PRINT_SEL(m, "Antenna: BC\n"); ++ else if (padapter->mppriv.antenna_rx == ANTENNA_CD) ++ RTW_PRINT_SEL(m, "Antenna: CD\n"); ++ else ++ RTW_PRINT_SEL(m, "Antenna: __\n"); ++ return 0; ++ } ++ ++ rtw_get_noise(padapter); ++ RTW_PRINT_SEL(m, "noise:%d\n", padapter->recvpriv.noise); ++#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA ++ rtw_odm_get_perpkt_rssi(m, padapter); ++ rtw_get_raw_rssi_info(m, padapter); ++#endif ++ return 0; ++} ++ ++ssize_t proc_set_rx_signal(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u32 is_signal_dbg, signal_strength; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%u %u", &is_signal_dbg, &signal_strength); ++ ++ is_signal_dbg = is_signal_dbg == 0 ? 0 : 1; ++ ++ if (is_signal_dbg && num != 2) ++ return count; ++ ++ signal_strength = signal_strength > 100 ? 100 : signal_strength; ++ ++ padapter->recvpriv.is_signal_dbg = is_signal_dbg; ++ padapter->recvpriv.signal_strength_dbg = signal_strength; ++ ++ if (is_signal_dbg) ++ RTW_INFO("set %s %u\n", "DBG_SIGNAL_STRENGTH", signal_strength); ++ else ++ RTW_INFO("set %s\n", "HW_SIGNAL_STRENGTH"); ++ ++ } ++ ++ return count; ++ ++} ++#ifdef CONFIG_80211N_HT ++int proc_get_ht_enable(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ ++ if (pregpriv) ++ RTW_PRINT_SEL(m, "%d\n", pregpriv->ht_enable); ++ ++ return 0; ++} ++ ++ssize_t proc_set_ht_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ char tmp[32]; ++ u32 mode; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%d ", &mode); ++ ++ if (pregpriv && mode < 2) { ++ pregpriv->ht_enable = mode; ++ RTW_INFO("ht_enable=%d\n", pregpriv->ht_enable); ++ } ++ } ++ ++ return count; ++ ++} ++ ++int proc_get_bw_mode(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ ++ if (pregpriv) ++ RTW_PRINT_SEL(m, "0x%02x\n", pregpriv->bw_mode); ++ ++ return 0; ++} ++ ++ssize_t proc_set_bw_mode(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ char tmp[32]; ++ u32 mode; ++ u8 bw_2g; ++ u8 bw_5g; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%x ", &mode); ++ bw_5g = mode >> 4; ++ bw_2g = mode & 0x0f; ++ ++ if (pregpriv && bw_2g <= 4 && bw_5g <= 4) { ++ ++ pregpriv->bw_mode = mode; ++ printk("bw_mode=0x%x\n", mode); ++ ++ } ++ } ++ ++ return count; ++ ++} ++ ++int proc_get_ampdu_enable(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ ++ if (pregpriv) ++ RTW_PRINT_SEL(m, "%d\n", pregpriv->ampdu_enable); ++ ++ return 0; ++} ++ ++ssize_t proc_set_ampdu_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ char tmp[32]; ++ u32 mode; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%d ", &mode); ++ ++ if (pregpriv && mode < 2) { ++ pregpriv->ampdu_enable = mode; ++ printk("ampdu_enable=%d\n", mode); ++ } ++ ++ } ++ ++ return count; ++ ++} ++ ++int proc_get_rx_ampdu(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ _RTW_PRINT_SEL(m, "accept: "); ++ if (padapter->fix_rx_ampdu_accept == RX_AMPDU_ACCEPT_INVALID) ++ RTW_PRINT_SEL(m, "%u%s\n", rtw_rx_ampdu_is_accept(padapter), "(auto)"); ++ else ++ RTW_PRINT_SEL(m, "%u%s\n", padapter->fix_rx_ampdu_accept, "(fixed)"); ++ ++ _RTW_PRINT_SEL(m, "size: "); ++ if (padapter->fix_rx_ampdu_size == RX_AMPDU_SIZE_INVALID) ++ RTW_PRINT_SEL(m, "%u%s\n", rtw_rx_ampdu_size(padapter), "(auto)"); ++ else ++ RTW_PRINT_SEL(m, "%u%s\n", padapter->fix_rx_ampdu_size, "(fixed)"); ++ ++ RTW_PRINT_SEL(m, "%19s %17s\n", "fix_rx_ampdu_accept", "fix_rx_ampdu_size"); ++ ++ _RTW_PRINT_SEL(m, "%-19d %-17u\n" ++ , padapter->fix_rx_ampdu_accept ++ , padapter->fix_rx_ampdu_size); ++ ++ return 0; ++} ++ ++ssize_t proc_set_rx_ampdu(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ char tmp[32]; ++ u8 accept; ++ u8 size; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhu %hhu", &accept, &size); ++ ++ if (num >= 1) ++ rtw_rx_ampdu_set_accept(padapter, accept, RX_AMPDU_DRV_FIXED); ++ if (num >= 2) ++ rtw_rx_ampdu_set_size(padapter, size, RX_AMPDU_DRV_FIXED); ++ ++ rtw_rx_ampdu_apply(padapter); ++ } ++ ++exit: ++ return count; ++} ++int proc_get_rx_ampdu_factor(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ ++ if (padapter) ++ RTW_PRINT_SEL(m, "rx ampdu factor = %x\n", padapter->driver_rx_ampdu_factor); ++ ++ return 0; ++} ++ ++ssize_t proc_set_rx_ampdu_factor(struct file *file, const char __user *buffer ++ , size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u32 factor; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%d ", &factor); ++ ++ if (padapter && (num == 1)) { ++ RTW_INFO("padapter->driver_rx_ampdu_factor = %x\n", factor); ++ ++ if (factor > 0x03) ++ padapter->driver_rx_ampdu_factor = 0xFF; ++ else ++ padapter->driver_rx_ampdu_factor = factor; ++ } ++ } ++ ++ return count; ++} ++ ++int proc_get_rx_ampdu_density(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ ++ if (padapter) ++ RTW_PRINT_SEL(m, "rx ampdu densityg = %x\n", padapter->driver_rx_ampdu_spacing); ++ ++ return 0; ++} ++ ++ssize_t proc_set_rx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u32 density; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%d ", &density); ++ ++ if (padapter && (num == 1)) { ++ RTW_INFO("padapter->driver_rx_ampdu_spacing = %x\n", density); ++ ++ if (density > 0x07) ++ padapter->driver_rx_ampdu_spacing = 0xFF; ++ else ++ padapter->driver_rx_ampdu_spacing = density; ++ } ++ } ++ ++ return count; ++} ++ ++int proc_get_tx_ampdu_density(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ ++ if (padapter) ++ RTW_PRINT_SEL(m, "tx ampdu density = %x\n", padapter->driver_ampdu_spacing); ++ ++ return 0; ++} ++ ++ssize_t proc_set_tx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u32 density; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%d ", &density); ++ ++ if (padapter && (num == 1)) { ++ RTW_INFO("padapter->driver_ampdu_spacing = %x\n", density); ++ ++ if (density > 0x07) ++ padapter->driver_ampdu_spacing = 0xFF; ++ else ++ padapter->driver_ampdu_spacing = density; ++ } ++ } ++ ++ return count; ++} ++#endif /* CONFIG_80211N_HT */ ++ ++int proc_get_mac_rptbuf(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u16 i; ++ u16 mac_id; ++ u32 shcut_addr = 0; ++ u32 read_addr = 0; ++#ifdef CONFIG_RTL8814A ++ RTW_PRINT_SEL(m, "TX ShortCut:\n"); ++ for (mac_id = 0; mac_id < 64; mac_id++) { ++ rtw_write16(padapter, 0x140, 0x662 | ((mac_id & BIT5) >> 5)); ++ shcut_addr = 0x8000; ++ shcut_addr = shcut_addr | ((mac_id & 0x1f) << 7); ++ RTW_PRINT_SEL(m, "mac_id=%d, 0x140=%x =>\n", mac_id, 0x662 | ((mac_id & BIT5) >> 5)); ++ for (i = 0; i < 30; i++) { ++ read_addr = 0; ++ read_addr = shcut_addr | (i << 2); ++ RTW_PRINT_SEL(m, "i=%02d: MAC_%04x= %08x ", i, read_addr, rtw_read32(padapter, read_addr)); ++ if (!((i + 1) % 4)) ++ RTW_PRINT_SEL(m, "\n"); ++ if (i == 29) ++ RTW_PRINT_SEL(m, "\n"); ++ } ++ } ++#endif /* CONFIG_RTL8814A */ ++ return 0; ++} ++ ++int proc_get_en_fwps(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if (pregpriv) ++ RTW_PRINT_SEL(m, "check_fw_ps = %d , 1:enable get FW PS state , 0: disable get FW PS state\n" ++ , pregpriv->check_fw_ps); ++ ++ return 0; ++} ++ ++ssize_t proc_set_en_fwps(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ char tmp[32]; ++ u32 mode; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%d ", &mode); ++ ++ if (pregpriv && mode < 2) { ++ pregpriv->check_fw_ps = mode; ++ RTW_INFO("pregpriv->check_fw_ps=%d\n", pregpriv->check_fw_ps); ++ } ++ ++ } ++ ++ return count; ++} ++ ++/* ++int proc_get_two_path_rssi(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ if(padapter) ++ RTW_PRINT_SEL(m, "%d %d\n", ++ padapter->recvpriv.RxRssi[0], padapter->recvpriv.RxRssi[1]); ++ ++ return 0; ++} ++*/ ++#ifdef CONFIG_80211N_HT ++int proc_get_rx_stbc(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ ++ if (pregpriv) ++ RTW_PRINT_SEL(m, "%d\n", pregpriv->rx_stbc); ++ ++ return 0; ++} ++ ++ssize_t proc_set_rx_stbc(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ char tmp[32]; ++ u32 mode; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%d ", &mode); ++ ++ if (pregpriv && (mode == 0 || mode == 1 || mode == 2 || mode == 3)) { ++ pregpriv->rx_stbc = mode; ++ printk("rx_stbc=%d\n", mode); ++ } ++ } ++ ++ return count; ++ ++} ++#endif /* CONFIG_80211N_HT */ ++ ++/*int proc_get_rssi_disp(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ return 0; ++} ++*/ ++ ++/*ssize_t proc_set_rssi_disp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u32 enable=0; ++ ++ if (count < 1) ++ { ++ RTW_INFO("argument size is less than 1\n"); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%x", &enable); ++ ++ if (num != 1) { ++ RTW_INFO("invalid set_rssi_disp parameter!\n"); ++ return count; ++ } ++ ++ if(enable) ++ { ++ RTW_INFO("Linked info Function Enable\n"); ++ padapter->bLinkInfoDump = enable ; ++ } ++ else ++ { ++ RTW_INFO("Linked info Function Disable\n"); ++ padapter->bLinkInfoDump = 0 ; ++ } ++ ++ } ++ ++ return count; ++ ++} ++ ++*/ ++#ifdef CONFIG_AP_MODE ++ ++int proc_get_all_sta_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _irqL irqL; ++ struct sta_info *psta; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ int i; ++ _list *plist, *phead; ++ ++ RTW_PRINT_SEL(m, "sta_dz_bitmap=0x%x, tim_bitmap=0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap); ++ ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ for (i = 0; i < NUM_STA; i++) { ++ phead = &(pstapriv->sta_hash[i]); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); ++ ++ plist = get_next(plist); ++ ++ /* if(extra_arg == psta->aid) */ ++ { ++ RTW_PRINT_SEL(m, "==============================\n"); ++ RTW_PRINT_SEL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); ++ RTW_PRINT_SEL(m, "rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); ++ RTW_PRINT_SEL(m, "state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); ++#ifdef CONFIG_80211N_HT ++ RTW_PRINT_SEL(m, "qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); ++ RTW_PRINT_SEL(m, "bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); ++ RTW_PRINT_SEL(m, "ampdu_enable = %d\n", psta->htpriv.ampdu_enable); ++ RTW_PRINT_SEL(m, "agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); ++#endif /* CONFIG_80211N_HT */ ++ RTW_PRINT_SEL(m, "sleepq_len=%d\n", psta->sleepq_len); ++ RTW_PRINT_SEL(m, "sta_xmitpriv.vo_q_qcnt=%d\n", psta->sta_xmitpriv.vo_q.qcnt); ++ RTW_PRINT_SEL(m, "sta_xmitpriv.vi_q_qcnt=%d\n", psta->sta_xmitpriv.vi_q.qcnt); ++ RTW_PRINT_SEL(m, "sta_xmitpriv.be_q_qcnt=%d\n", psta->sta_xmitpriv.be_q.qcnt); ++ RTW_PRINT_SEL(m, "sta_xmitpriv.bk_q_qcnt=%d\n", psta->sta_xmitpriv.bk_q.qcnt); ++ ++ RTW_PRINT_SEL(m, "capability=0x%x\n", psta->capability); ++ RTW_PRINT_SEL(m, "flags=0x%x\n", psta->flags); ++ RTW_PRINT_SEL(m, "wpa_psk=0x%x\n", psta->wpa_psk); ++ RTW_PRINT_SEL(m, "wpa2_group_cipher=0x%x\n", psta->wpa2_group_cipher); ++ RTW_PRINT_SEL(m, "wpa2_pairwise_cipher=0x%x\n", psta->wpa2_pairwise_cipher); ++ RTW_PRINT_SEL(m, "qos_info=0x%x\n", psta->qos_info); ++ RTW_PRINT_SEL(m, "dot118021XPrivacy=0x%x\n", psta->dot118021XPrivacy); ++ ++ sta_rx_reorder_ctl_dump(m, psta); ++ ++#ifdef CONFIG_TDLS ++ RTW_PRINT_SEL(m, "tdls_sta_state=0x%08x\n", psta->tdls_sta_state); ++ RTW_PRINT_SEL(m, "PeerKey_Lifetime=%d\n", psta->TDLS_PeerKey_Lifetime); ++ RTW_PRINT_SEL(m, "rx_data_pkts=%llu\n", psta->sta_stats.rx_data_pkts); ++ RTW_PRINT_SEL(m, "rx_bytes=%llu\n", psta->sta_stats.rx_bytes); ++ RTW_PRINT_SEL(m, "tx_data_pkts=%llu\n", psta->sta_stats.tx_pkts); ++ RTW_PRINT_SEL(m, "tx_bytes=%llu\n", psta->sta_stats.tx_bytes); ++#endif /* CONFIG_TDLS */ ++ ++ dump_st_ctl(m, &psta->st_ctl); ++ ++ if (STA_OP_WFD_MODE(psta)) ++ RTW_PRINT_SEL(m, "op_wfd_mode:0x%02x\n", STA_OP_WFD_MODE(psta)); ++ ++ RTW_PRINT_SEL(m, "==============================\n"); ++ } ++ ++ } ++ ++ } ++ ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ return 0; ++} ++ ++#endif ++ ++#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER ++int proc_get_rtkm_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ struct recv_buf *precvbuf; ++ ++ precvbuf = (struct recv_buf *)precvpriv->precv_buf; ++ ++ RTW_PRINT_SEL(m, "============[RTKM Info]============\n"); ++ RTW_PRINT_SEL(m, "MAX_RTKM_NR_PREALLOC_RECV_SKB: %d\n", rtw_rtkm_get_nr_recv_skb()); ++ RTW_PRINT_SEL(m, "MAX_RTKM_RECVBUF_SZ: %d\n", rtw_rtkm_get_buff_size()); ++ ++ RTW_PRINT_SEL(m, "============[Driver Info]============\n"); ++ RTW_PRINT_SEL(m, "NR_PREALLOC_RECV_SKB: %d\n", NR_PREALLOC_RECV_SKB); ++ RTW_PRINT_SEL(m, "MAX_RECVBUF_SZ: %d\n", precvbuf->alloc_sz); ++ ++ return 0; ++} ++#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ ++ ++#ifdef DBG_MEMORY_LEAK ++#include ++extern atomic_t _malloc_cnt;; ++extern atomic_t _malloc_size;; ++ ++int proc_get_malloc_cnt(struct seq_file *m, void *v) ++{ ++ RTW_PRINT_SEL(m, "_malloc_cnt=%d\n", atomic_read(&_malloc_cnt)); ++ RTW_PRINT_SEL(m, "_malloc_size=%d\n", atomic_read(&_malloc_size)); ++ ++ return 0; ++} ++#endif /* DBG_MEMORY_LEAK */ ++ ++#ifdef CONFIG_FIND_BEST_CHANNEL ++int proc_get_best_channel(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ u32 i, best_channel_24G = 1, best_channel_5G = 36, index_24G = 0, index_5G = 0; ++ ++ for (i = 0; pmlmeext->channel_set[i].ChannelNum != 0; i++) { ++ if (pmlmeext->channel_set[i].ChannelNum == 1) ++ index_24G = i; ++ if (pmlmeext->channel_set[i].ChannelNum == 36) ++ index_5G = i; ++ } ++ ++ for (i = 0; (i < MAX_CHANNEL_NUM) && (pmlmeext->channel_set[i].ChannelNum != 0) ; i++) { ++ /* 2.4G */ ++ if (pmlmeext->channel_set[i].ChannelNum == 6) { ++ if (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_24G].rx_count) { ++ index_24G = i; ++ best_channel_24G = pmlmeext->channel_set[i].ChannelNum; ++ } ++ } ++ ++ /* 5G */ ++ if (pmlmeext->channel_set[i].ChannelNum >= 36 ++ && pmlmeext->channel_set[i].ChannelNum < 140) { ++ /* Find primary channel */ ++ if (((pmlmeext->channel_set[i].ChannelNum - 36) % 8 == 0) ++ && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { ++ index_5G = i; ++ best_channel_5G = pmlmeext->channel_set[i].ChannelNum; ++ } ++ } ++ ++ if (pmlmeext->channel_set[i].ChannelNum >= 149 ++ && pmlmeext->channel_set[i].ChannelNum < 165) { ++ /* find primary channel */ ++ if (((pmlmeext->channel_set[i].ChannelNum - 149) % 8 == 0) ++ && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { ++ index_5G = i; ++ best_channel_5G = pmlmeext->channel_set[i].ChannelNum; ++ } ++ } ++#if 1 /* debug */ ++ RTW_PRINT_SEL(m, "The rx cnt of channel %3d = %d\n", ++ pmlmeext->channel_set[i].ChannelNum, pmlmeext->channel_set[i].rx_count); ++#endif ++ } ++ ++ RTW_PRINT_SEL(m, "best_channel_5G = %d\n", best_channel_5G); ++ RTW_PRINT_SEL(m, "best_channel_24G = %d\n", best_channel_24G); ++ ++ return 0; ++} ++ ++ssize_t proc_set_best_channel(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ char tmp[32]; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int i; ++ for (i = 0; pmlmeext->channel_set[i].ChannelNum != 0; i++) ++ pmlmeext->channel_set[i].rx_count = 0; ++ ++ RTW_INFO("set %s\n", "Clean Best Channel Count"); ++ } ++ ++ return count; ++} ++#endif /* CONFIG_FIND_BEST_CHANNEL */ ++ ++#ifdef CONFIG_BT_COEXIST ++int proc_get_btcoex_dbg(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ PADAPTER padapter; ++ char buf[512] = {0}; ++ padapter = (PADAPTER)rtw_netdev_priv(dev); ++ ++ rtw_btcoex_GetDBG(padapter, buf, 512); ++ ++ _RTW_PRINT_SEL(m, "%s", buf); ++ ++ return 0; ++} ++ ++ssize_t proc_set_btcoex_dbg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ PADAPTER padapter; ++ u8 tmp[80] = {0}; ++ u32 module[2] = {0}; ++ u32 num; ++ ++ padapter = (PADAPTER)rtw_netdev_priv(dev); ++ ++ /* RTW_INFO("+" FUNC_ADPT_FMT "\n", FUNC_ADPT_ARG(padapter)); */ ++ ++ if (NULL == buffer) { ++ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", ++ FUNC_ADPT_ARG(padapter)); ++ ++ return -EFAULT; ++ } ++ ++ if (count < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", ++ FUNC_ADPT_ARG(padapter)); ++ ++ return -EFAULT; ++ } ++ ++ num = count; ++ if (num > (sizeof(tmp) - 1)) ++ num = (sizeof(tmp) - 1); ++ ++ if (copy_from_user(tmp, buffer, num)) { ++ RTW_INFO(FUNC_ADPT_FMT ": copy buffer from user space FAIL!\n", ++ FUNC_ADPT_ARG(padapter)); ++ ++ return -EFAULT; ++ } ++ ++ num = sscanf(tmp, "%x %x", module, module + 1); ++ if (1 == num) { ++ if (0 == module[0]) ++ _rtw_memset(module, 0, sizeof(module)); ++ else ++ _rtw_memset(module, 0xFF, sizeof(module)); ++ } else if (2 != num) { ++ RTW_INFO(FUNC_ADPT_FMT ": input(\"%s\") format incorrect!\n", ++ FUNC_ADPT_ARG(padapter), tmp); ++ ++ if (0 == num) ++ return -EFAULT; ++ } ++ ++ RTW_INFO(FUNC_ADPT_FMT ": input 0x%08X 0x%08X\n", ++ FUNC_ADPT_ARG(padapter), module[0], module[1]); ++ rtw_btcoex_SetDBG(padapter, module); ++ ++ return count; ++} ++ ++int proc_get_btcoex_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ PADAPTER padapter; ++ const u32 bufsize = 30 * 100; ++ u8 *pbuf = NULL; ++ ++ padapter = (PADAPTER)rtw_netdev_priv(dev); ++ ++ pbuf = rtw_zmalloc(bufsize); ++ if (NULL == pbuf) ++ return -ENOMEM; ++ ++ rtw_btcoex_DisplayBtCoexInfo(padapter, pbuf, bufsize); ++ ++ _RTW_PRINT_SEL(m, "%s\n", pbuf); ++ ++ rtw_mfree(pbuf, bufsize); ++ ++ return 0; ++} ++#endif /* CONFIG_BT_COEXIST */ ++ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++int proc_get_sreset(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ return 0; ++} ++ ++ssize_t proc_set_sreset(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ s32 trigger_point; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%d", &trigger_point); ++ ++ if (trigger_point == SRESET_TGP_NULL) ++ rtw_hal_sreset_reset(padapter); ++ else ++ sreset_set_trigger_point(padapter, trigger_point); ++ } ++ ++ return count; ++ ++} ++#endif /* DBG_CONFIG_ERROR_DETECT */ ++ ++#ifdef CONFIG_PCI_HCI ++ ++int proc_get_rx_ring(struct seq_file *m, void *v) ++{ ++ _irqL irqL; ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ struct rtw_rx_ring *rx_ring = &precvpriv->rx_ring[RX_MPDU_QUEUE]; ++ int i, j; ++ ++ RTW_PRINT_SEL(m, "rx ring (%p)\n", rx_ring); ++ RTW_PRINT_SEL(m, " dma: 0x%08x\n", (int) rx_ring->dma); ++ RTW_PRINT_SEL(m, " idx: %d\n", rx_ring->idx); ++ ++ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); ++ for (i = 0; i < precvpriv->rxringcount; i++) { ++#ifdef CONFIG_TRX_BD_ARCH ++ struct rx_buf_desc *entry = &rx_ring->buf_desc[i]; ++#else ++ struct recv_stat *entry = &rx_ring->desc[i]; ++#endif ++ struct sk_buff *skb = rx_ring->rx_buf[i]; ++ ++ RTW_PRINT_SEL(m, " desc[%03d]: %p, rx_buf[%03d]: 0x%08x\n", ++ i, entry, i, cpu_to_le32(*((dma_addr_t *)skb->cb))); ++ ++ for (j = 0; j < sizeof(*entry) / 4; j++) { ++ if ((j % 4) == 0) ++ RTW_PRINT_SEL(m, " 0x%03x", j); ++ ++ RTW_PRINT_SEL(m, " 0x%08x ", ((int *) entry)[j]); ++ ++ if ((j % 4) == 3) ++ RTW_PRINT_SEL(m, "\n"); ++ } ++ } ++ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); ++ ++ return 0; ++} ++ ++int proc_get_tx_ring(struct seq_file *m, void *v) ++{ ++ _irqL irqL; ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ int i, j, k; ++ ++ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); ++ for (i = 0; i < PCI_MAX_TX_QUEUE_COUNT; i++) { ++ struct rtw_tx_ring *tx_ring = &pxmitpriv->tx_ring[i]; ++ ++ RTW_PRINT_SEL(m, "tx ring[%d] (%p)\n", i, tx_ring); ++ RTW_PRINT_SEL(m, " dma: 0x%08x\n", (int) tx_ring->dma); ++ RTW_PRINT_SEL(m, " idx: %d\n", tx_ring->idx); ++ RTW_PRINT_SEL(m, " entries: %d\n", tx_ring->entries); ++ /* RTW_PRINT_SEL(m, " queue: %d\n", tx_ring->queue); */ ++ RTW_PRINT_SEL(m, " qlen: %d\n", tx_ring->qlen); ++ ++ for (j = 0; j < pxmitpriv->txringcount[i]; j++) { ++#ifdef CONFIG_TRX_BD_ARCH ++ struct tx_buf_desc *entry = &tx_ring->buf_desc[j]; ++#else ++ struct tx_desc *entry = &tx_ring->desc[j]; ++#endif ++ ++ RTW_PRINT_SEL(m, " desc[%03d]: %p\n", j, entry); ++ for (k = 0; k < sizeof(*entry) / 4; k++) { ++ if ((k % 4) == 0) ++ RTW_PRINT_SEL(m, " 0x%03x", k); ++ ++ RTW_PRINT_SEL(m, " 0x%08x ", ((int *) entry)[k]); ++ ++ if ((k % 4) == 3) ++ RTW_PRINT_SEL(m, "\n"); ++ } ++ } ++ } ++ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); ++ ++ return 0; ++} ++#endif ++ ++#ifdef CONFIG_WOWLAN ++int proc_get_pattern_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ u8 pattern_num = 0, val8; ++ char str_1[128]; ++ char *p_str; ++ int i = 0 , j = 0, k = 0; ++ int len = 0, max_len = 0, total = 0; ++ ++ p_str = str_1; ++ max_len = sizeof(str_1); ++ ++ total = pwrpriv->wowlan_pattern_idx; ++ ++ rtw_set_default_pattern(padapter); ++ ++ /*show pattern*/ ++ RTW_PRINT_SEL(m, "\n======[Pattern Info.]======\n"); ++ RTW_PRINT_SEL(m, "pattern number: %d\n", total); ++ RTW_PRINT_SEL(m, "support default patterns: %c\n", ++ (pregistrypriv->default_patterns_en) ? 'Y' : 'N'); ++ ++ for (k = 0; k < total ; k++) { ++ RTW_PRINT_SEL(m, "\npattern idx: %d\n", k); ++ RTW_PRINT_SEL(m, "pattern content:\n"); ++ ++ p_str = str_1; ++ max_len = sizeof(str_1); ++ for (i = 0 ; i < MAX_WKFM_PATTERN_SIZE / 8 ; i++) { ++ _rtw_memset(p_str, 0, max_len); ++ len = 0; ++ for (j = 0 ; j < 8 ; j++) { ++ val8 = pwrpriv->patterns[k].content[i * 8 + j]; ++ len += snprintf(p_str + len, max_len - len, ++ "%02x ", val8); ++ } ++ RTW_PRINT_SEL(m, "%s\n", p_str); ++ } ++ RTW_PRINT_SEL(m, "\npattern mask:\n"); ++ for (i = 0 ; i < MAX_WKFM_SIZE / 8 ; i++) { ++ _rtw_memset(p_str, 0, max_len); ++ len = 0; ++ for (j = 0 ; j < 8 ; j++) { ++ val8 = pwrpriv->patterns[k].mask[i * 8 + j]; ++ len += snprintf(p_str + len, max_len - len, ++ "%02x ", val8); ++ } ++ RTW_PRINT_SEL(m, "%s\n", p_str); ++ } ++ ++ RTW_PRINT_SEL(m, "\npriv_pattern_len:\n"); ++ RTW_PRINT_SEL(m, "pattern_len: %d\n", pwrpriv->patterns[k].len); ++ RTW_PRINT_SEL(m, "*****************\n"); ++ } ++ ++ return 0; ++} ++ssize_t proc_set_pattern_info(struct file *file, const char __user *buffer, ++ size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct wowlan_ioctl_param poidparam; ++ u8 tmp[MAX_WKFM_PATTERN_SIZE] = {0}; ++ int ret = 0, num = 0; ++ u8 index = 0; ++ ++ poidparam.subcode = 0; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (pwrpriv->wowlan_pattern_idx >= MAX_WKFM_NUM) { ++ RTW_INFO("WARNING: priv-pattern is full(idx: %d)\n", ++ pwrpriv->wowlan_pattern_idx); ++ RTW_INFO("WARNING: please clean priv-pattern first\n"); ++ return -ENOMEM; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ if (strncmp(tmp, "clean", 5) == 0) { ++ poidparam.subcode = WOWLAN_PATTERN_CLEAN; ++ rtw_hal_set_hwreg(padapter, ++ HW_VAR_WOWLAN, (u8 *)&poidparam); ++ } else { ++ index = pwrpriv->wowlan_pattern_idx; ++ ret = rtw_wowlan_parser_pattern_cmd(tmp, ++ pwrpriv->patterns[index].content, ++ &pwrpriv->patterns[index].len, ++ pwrpriv->patterns[index].mask); ++ if (ret == _TRUE) ++ pwrpriv->wowlan_pattern_idx++; ++ } ++ } ++ ++ return count; ++} ++ ++int proc_get_wakeup_reason(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ u8 val = pwrpriv->wowlan_last_wake_reason; ++ ++ RTW_PRINT_SEL(m, "last wake reason: %#02x\n", val); ++ return 0; ++} ++#endif ++ ++#ifdef CONFIG_GPIO_WAKEUP ++int proc_get_wowlan_gpio_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ u8 val = pwrpriv->is_high_active; ++ ++ RTW_PRINT_SEL(m, "wakeup_gpio_idx: %d\n", WAKEUP_GPIO_IDX); ++ RTW_PRINT_SEL(m, "high_active: %d\n", val); ++ ++ return 0; ++} ++ ++ssize_t proc_set_wowlan_gpio_info(struct file *file, const char __user *buffer, ++ size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ char tmp[32] = {0}; ++ int num = 0; ++ u32 is_high_active = 0; ++ u8 val8 = 0; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ num = sscanf(tmp, "%u", &is_high_active); ++ ++ is_high_active = is_high_active == 0 ? 0 : 1; ++ ++ pwrpriv->is_high_active = is_high_active; ++ ++ rtw_ps_deny(padapter, PS_DENY_IOCTL); ++ LeaveAllPowerSaveModeDirect(padapter); ++ val8 = (pwrpriv->is_high_active == 0) ? 1 : 0; ++ rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, val8); ++ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); ++ ++ RTW_INFO("set %s %d\n", "gpio_high_active", ++ pwrpriv->is_high_active); ++ RTW_INFO("%s: set GPIO_%d %d as default.\n", ++ __func__, WAKEUP_GPIO_IDX, val8); ++ } ++ ++ return count; ++} ++#endif /* CONFIG_GPIO_WAKEUP */ ++ ++#ifdef CONFIG_P2P_WOWLAN ++int proc_get_p2p_wowlan_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ struct p2p_wowlan_info peerinfo = pwdinfo->p2p_wow_info; ++ if (_TRUE == peerinfo.is_trigger) { ++ RTW_PRINT_SEL(m, "is_trigger: TRUE\n"); ++ switch (peerinfo.wowlan_recv_frame_type) { ++ case P2P_WOWLAN_RECV_NEGO_REQ: ++ RTW_PRINT_SEL(m, "Frame Type: Nego Request\n"); ++ break; ++ case P2P_WOWLAN_RECV_INVITE_REQ: ++ RTW_PRINT_SEL(m, "Frame Type: Invitation Request\n"); ++ break; ++ case P2P_WOWLAN_RECV_PROVISION_REQ: ++ RTW_PRINT_SEL(m, "Frame Type: Provision Request\n"); ++ break; ++ default: ++ break; ++ } ++ RTW_PRINT_SEL(m, "Peer Addr: "MAC_FMT"\n", MAC_ARG(peerinfo.wowlan_peer_addr)); ++ RTW_PRINT_SEL(m, "Peer WPS Config: %x\n", peerinfo.wowlan_peer_wpsconfig); ++ RTW_PRINT_SEL(m, "Persistent Group: %d\n", peerinfo.wowlan_peer_is_persistent); ++ RTW_PRINT_SEL(m, "Intivation Type: %d\n", peerinfo.wowlan_peer_invitation_type); ++ } else ++ RTW_PRINT_SEL(m, "is_trigger: False\n"); ++ return 0; ++} ++#endif /* CONFIG_P2P_WOWLAN */ ++ ++int proc_get_new_bcn_max(struct seq_file *m, void *v) ++{ ++ extern int new_bcn_max; ++ ++ RTW_PRINT_SEL(m, "%d", new_bcn_max); ++ return 0; ++} ++ ++ssize_t proc_set_new_bcn_max(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ char tmp[32]; ++ extern int new_bcn_max; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) ++ sscanf(tmp, "%d ", &new_bcn_max); ++ ++ return count; ++} ++ ++#ifdef CONFIG_POWER_SAVING ++int proc_get_ps_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ u8 ips_mode = pwrpriv->ips_mode; ++ u8 lps_mode = pwrpriv->power_mgnt; ++ char *str = ""; ++ ++ RTW_PRINT_SEL(m, "======Power Saving Info:======\n"); ++ RTW_PRINT_SEL(m, "*IPS:\n"); ++ ++ if (ips_mode == IPS_NORMAL) { ++#ifdef CONFIG_FWLPS_IN_IPS ++ str = "FW_LPS_IN_IPS"; ++#else ++ str = "Card Disable"; ++#endif ++ } else if (ips_mode == IPS_NONE) ++ str = "NO IPS"; ++ else if (ips_mode == IPS_LEVEL_2) ++ str = "IPS_LEVEL_2"; ++ else ++ str = "invalid ips_mode"; ++ ++ RTW_PRINT_SEL(m, " IPS mode: %s\n", str); ++ RTW_PRINT_SEL(m, " IPS enter count:%d, IPS leave count:%d\n", ++ pwrpriv->ips_enter_cnts, pwrpriv->ips_leave_cnts); ++ RTW_PRINT_SEL(m, "------------------------------\n"); ++ RTW_PRINT_SEL(m, "*LPS:\n"); ++ ++ if (lps_mode == PS_MODE_ACTIVE) ++ str = "NO LPS"; ++ else if (lps_mode == PS_MODE_MIN) ++ str = "MIN"; ++ else if (lps_mode == PS_MODE_MAX) ++ str = "MAX"; ++ else if (lps_mode == PS_MODE_DTIM) ++ str = "DTIM"; ++ else ++ sprintf(str, "%d", lps_mode); ++ ++ RTW_PRINT_SEL(m, " LPS mode: %s\n", str); ++ ++ if (pwrpriv->dtim != 0) ++ RTW_PRINT_SEL(m, " DTIM: %d\n", pwrpriv->dtim); ++ RTW_PRINT_SEL(m, " LPS enter count:%d, LPS leave count:%d\n", ++ pwrpriv->lps_enter_cnts, pwrpriv->lps_leave_cnts); ++ RTW_PRINT_SEL(m, "=============================\n"); ++ return 0; ++} ++#endif /* CONFIG_POWER_SAVING */ ++ ++#ifdef CONFIG_TDLS ++static int proc_tdls_display_tdls_function_info(struct seq_file *m) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ u8 SpaceBtwnItemAndValue = TDLS_DBG_INFO_SPACE_BTWN_ITEM_AND_VALUE; ++ u8 SpaceBtwnItemAndValueTmp = 0; ++ BOOLEAN FirstMatchFound = _FALSE; ++ int j = 0; ++ ++ RTW_PRINT_SEL(m, "============[TDLS Function Info]============\n"); ++ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Prohibited", (ptdlsinfo->ap_prohibited == _TRUE) ? "_TRUE" : "_FALSE"); ++ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Channel Switch Prohibited", (ptdlsinfo->ch_switch_prohibited == _TRUE) ? "_TRUE" : "_FALSE"); ++ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Link Established", (ptdlsinfo->link_established == _TRUE) ? "_TRUE" : "_FALSE"); ++ RTW_PRINT_SEL(m, "%-*s = %d/%d\n", SpaceBtwnItemAndValue, "TDLS STA Num (Linked/Allowed)", ptdlsinfo->sta_cnt, MAX_ALLOWED_TDLS_STA_NUM); ++ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Allowed STA Num Reached", (ptdlsinfo->sta_maximum == _TRUE) ? "_TRUE" : "_FALSE"); ++ ++#ifdef CONFIG_TDLS_CH_SW ++ RTW_PRINT_SEL(m, "%-*s =", SpaceBtwnItemAndValue, "TDLS CH SW State"); ++ if (ptdlsinfo->chsw_info.ch_sw_state == TDLS_STATE_NONE) ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_STATE_NONE"); ++ else { ++ for (j = 0; j < 32; j++) { ++ if (ptdlsinfo->chsw_info.ch_sw_state & BIT(j)) { ++ if (FirstMatchFound == _FALSE) { ++ SpaceBtwnItemAndValueTmp = 1; ++ FirstMatchFound = _TRUE; ++ } else ++ SpaceBtwnItemAndValueTmp = SpaceBtwnItemAndValue + 3; ++ switch (BIT(j)) { ++ case TDLS_INITIATOR_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_INITIATOR_STATE"); ++ break; ++ case TDLS_RESPONDER_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_RESPONDER_STATE"); ++ break; ++ case TDLS_LINKED_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_LINKED_STATE"); ++ break; ++ case TDLS_WAIT_PTR_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_WAIT_PTR_STATE"); ++ break; ++ case TDLS_ALIVE_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_ALIVE_STATE"); ++ break; ++ case TDLS_CH_SWITCH_ON_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_CH_SWITCH_ON_STATE"); ++ break; ++ case TDLS_PEER_AT_OFF_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_PEER_AT_OFF_STATE"); ++ break; ++ case TDLS_CH_SW_INITIATOR_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_CH_SW_INITIATOR_STATE"); ++ break; ++ case TDLS_WAIT_CH_RSP_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValue, " ", "TDLS_WAIT_CH_RSP_STATE"); ++ break; ++ default: ++ RTW_PRINT_SEL(m, "%-*sBIT(%d)\n", SpaceBtwnItemAndValueTmp, " ", j); ++ break; ++ } ++ } ++ } ++ } ++ ++ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS CH SW On", (ATOMIC_READ(&ptdlsinfo->chsw_info.chsw_on) == _TRUE) ? "_TRUE" : "_FALSE"); ++ RTW_PRINT_SEL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "TDLS CH SW Off-Channel Num", ptdlsinfo->chsw_info.off_ch_num); ++ RTW_PRINT_SEL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "TDLS CH SW Channel Offset", ptdlsinfo->chsw_info.ch_offset); ++ RTW_PRINT_SEL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "TDLS CH SW Current Time", ptdlsinfo->chsw_info.cur_time); ++ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS CH SW Delay Switch Back", (ptdlsinfo->chsw_info.delay_switch_back == _TRUE) ? "_TRUE" : "_FALSE"); ++ RTW_PRINT_SEL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "TDLS CH SW Dump Back", ptdlsinfo->chsw_info.dump_stack); ++#endif ++ ++ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Device Discovered", (ptdlsinfo->dev_discovered == _TRUE) ? "_TRUE" : "_FALSE"); ++ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Enable", (ptdlsinfo->tdls_enable == _TRUE) ? "_TRUE" : "_FALSE"); ++ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Driver Setup", (ptdlsinfo->driver_setup == _TRUE) ? "_TRUE" : "_FALSE"); ++ ++ return 0; ++} ++ ++static int proc_tdls_display_network_info(struct seq_file *m) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ int i = 0; ++ u8 SpaceBtwnItemAndValue = TDLS_DBG_INFO_SPACE_BTWN_ITEM_AND_VALUE; ++ ++ /* Display the linked AP/GO info */ ++ RTW_PRINT_SEL(m, "============[Associated AP/GO Info]============\n"); ++ ++ if ((pmlmepriv->fw_state & WIFI_STATION_STATE) && (pmlmepriv->fw_state & _FW_LINKED)) { ++ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "BSSID", cur_network->network.Ssid.Ssid); ++ RTW_PRINT_SEL(m, "%-*s = "MAC_FMT"\n", SpaceBtwnItemAndValue, "Mac Address", MAC_ARG(cur_network->network.MacAddress)); ++ ++ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Wireless Mode"); ++ for (i = 0; i < 8; i++) { ++ if (pmlmeext->cur_wireless_mode & BIT(i)) { ++ switch (BIT(i)) { ++ case WIRELESS_11B: ++ RTW_PRINT_SEL(m, "%4s", "11B "); ++ break; ++ case WIRELESS_11G: ++ RTW_PRINT_SEL(m, "%4s", "11G "); ++ break; ++ case WIRELESS_11A: ++ RTW_PRINT_SEL(m, "%4s", "11A "); ++ break; ++ case WIRELESS_11_24N: ++ RTW_PRINT_SEL(m, "%7s", "11_24N "); ++ break; ++ case WIRELESS_11_5N: ++ RTW_PRINT_SEL(m, "%6s", "11_5N "); ++ break; ++ case WIRELESS_AUTO: ++ RTW_PRINT_SEL(m, "%5s", "AUTO "); ++ break; ++ case WIRELESS_11AC: ++ RTW_PRINT_SEL(m, "%5s", "11AC "); ++ break; ++ } ++ } ++ } ++ RTW_PRINT_SEL(m, "\n"); ++ ++ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Privacy"); ++ switch (padapter->securitypriv.dot11PrivacyAlgrthm) { ++ case _NO_PRIVACY_: ++ RTW_PRINT_SEL(m, "%s\n", "NO PRIVACY"); ++ break; ++ case _WEP40_: ++ RTW_PRINT_SEL(m, "%s\n", "WEP 40"); ++ break; ++ case _TKIP_: ++ RTW_PRINT_SEL(m, "%s\n", "TKIP"); ++ break; ++ case _TKIP_WTMIC_: ++ RTW_PRINT_SEL(m, "%s\n", "TKIP WTMIC"); ++ break; ++ case _AES_: ++ RTW_PRINT_SEL(m, "%s\n", "AES"); ++ break; ++ case _WEP104_: ++ RTW_PRINT_SEL(m, "%s\n", "WEP 104"); ++ break; ++ case _WEP_WPA_MIXED_: ++ RTW_PRINT_SEL(m, "%s\n", "WEP/WPA Mixed"); ++ break; ++ case _SMS4_: ++ RTW_PRINT_SEL(m, "%s\n", "SMS4"); ++ break; ++#ifdef CONFIG_IEEE80211W ++ case _BIP_: ++ RTW_PRINT_SEL(m, "%s\n", "BIP"); ++ break; ++#endif /* CONFIG_IEEE80211W */ ++ } ++ ++ RTW_PRINT_SEL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "Channel", pmlmeext->cur_channel); ++ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Channel Offset"); ++ switch (pmlmeext->cur_ch_offset) { ++ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: ++ RTW_PRINT_SEL(m, "%s\n", "N/A"); ++ break; ++ case HAL_PRIME_CHNL_OFFSET_LOWER: ++ RTW_PRINT_SEL(m, "%s\n", "Lower"); ++ break; ++ case HAL_PRIME_CHNL_OFFSET_UPPER: ++ RTW_PRINT_SEL(m, "%s\n", "Upper"); ++ break; ++ } ++ ++ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Bandwidth Mode"); ++ switch (pmlmeext->cur_bwmode) { ++ case CHANNEL_WIDTH_20: ++ RTW_PRINT_SEL(m, "%s\n", "20MHz"); ++ break; ++ case CHANNEL_WIDTH_40: ++ RTW_PRINT_SEL(m, "%s\n", "40MHz"); ++ break; ++ case CHANNEL_WIDTH_80: ++ RTW_PRINT_SEL(m, "%s\n", "80MHz"); ++ break; ++ case CHANNEL_WIDTH_160: ++ RTW_PRINT_SEL(m, "%s\n", "160MHz"); ++ break; ++ case CHANNEL_WIDTH_80_80: ++ RTW_PRINT_SEL(m, "%s\n", "80MHz + 80MHz"); ++ break; ++ } ++ } else ++ RTW_PRINT_SEL(m, "No association with AP/GO exists!\n"); ++ ++ return 0; ++} ++ ++static int proc_tdls_display_tdls_sta_info(struct seq_file *m) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct sta_info *psta; ++ int i = 0, j = 0; ++ _irqL irqL; ++ _list *plist, *phead; ++ u8 SpaceBtwnItemAndValue = TDLS_DBG_INFO_SPACE_BTWN_ITEM_AND_VALUE; ++ u8 SpaceBtwnItemAndValueTmp = 0; ++ u8 NumOfTdlsStaToShow = 0; ++ BOOLEAN FirstMatchFound = _FALSE; ++ ++ /* Search for TDLS sta info to display */ ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ for (i = 0; i < NUM_STA; i++) { ++ phead = &(pstapriv->sta_hash[i]); ++ plist = get_next(phead); ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); ++ plist = get_next(plist); ++ if (psta->tdls_sta_state != TDLS_STATE_NONE) { ++ /* We got one TDLS sta info to show */ ++ RTW_PRINT_SEL(m, "============[TDLS Peer STA Info: STA %d]============\n", ++NumOfTdlsStaToShow); ++ RTW_PRINT_SEL(m, "%-*s = "MAC_FMT"\n", SpaceBtwnItemAndValue, "Mac Address", MAC_ARG(psta->hwaddr)); ++ RTW_PRINT_SEL(m, "%-*s =", SpaceBtwnItemAndValue, "TDLS STA State"); ++ SpaceBtwnItemAndValueTmp = 0; ++ FirstMatchFound = _FALSE; ++ for (j = 0; j < 32; j++) { ++ if (psta->tdls_sta_state & BIT(j)) { ++ if (FirstMatchFound == _FALSE) { ++ SpaceBtwnItemAndValueTmp = 1; ++ FirstMatchFound = _TRUE; ++ } else ++ SpaceBtwnItemAndValueTmp = SpaceBtwnItemAndValue + 3; ++ switch (BIT(j)) { ++ case TDLS_INITIATOR_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_INITIATOR_STATE"); ++ break; ++ case TDLS_RESPONDER_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_RESPONDER_STATE"); ++ break; ++ case TDLS_LINKED_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_LINKED_STATE"); ++ break; ++ case TDLS_WAIT_PTR_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_WAIT_PTR_STATE"); ++ break; ++ case TDLS_ALIVE_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_ALIVE_STATE"); ++ break; ++ case TDLS_CH_SWITCH_ON_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_CH_SWITCH_ON_STATE"); ++ break; ++ case TDLS_PEER_AT_OFF_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_PEER_AT_OFF_STATE"); ++ break; ++ case TDLS_CH_SW_INITIATOR_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_CH_SW_INITIATOR_STATE"); ++ break; ++ case TDLS_WAIT_CH_RSP_STATE: ++ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValue, " ", "TDLS_WAIT_CH_RSP_STATE"); ++ break; ++ default: ++ RTW_PRINT_SEL(m, "%-*sBIT(%d)\n", SpaceBtwnItemAndValueTmp, " ", j); ++ break; ++ } ++ } ++ } ++ ++ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Wireless Mode"); ++ for (j = 0; j < 8; j++) { ++ if (psta->wireless_mode & BIT(j)) { ++ switch (BIT(j)) { ++ case WIRELESS_11B: ++ RTW_PRINT_SEL(m, "%4s", "11B "); ++ break; ++ case WIRELESS_11G: ++ RTW_PRINT_SEL(m, "%4s", "11G "); ++ break; ++ case WIRELESS_11A: ++ RTW_PRINT_SEL(m, "%4s", "11A "); ++ break; ++ case WIRELESS_11_24N: ++ RTW_PRINT_SEL(m, "%7s", "11_24N "); ++ break; ++ case WIRELESS_11_5N: ++ RTW_PRINT_SEL(m, "%6s", "11_5N "); ++ break; ++ case WIRELESS_AUTO: ++ RTW_PRINT_SEL(m, "%5s", "AUTO "); ++ break; ++ case WIRELESS_11AC: ++ RTW_PRINT_SEL(m, "%5s", "11AC "); ++ break; ++ } ++ } ++ } ++ RTW_PRINT_SEL(m, "\n"); ++ ++ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Bandwidth Mode"); ++ switch (psta->bw_mode) { ++ case CHANNEL_WIDTH_20: ++ RTW_PRINT_SEL(m, "%s\n", "20MHz"); ++ break; ++ case CHANNEL_WIDTH_40: ++ RTW_PRINT_SEL(m, "%s\n", "40MHz"); ++ break; ++ case CHANNEL_WIDTH_80: ++ RTW_PRINT_SEL(m, "%s\n", "80MHz"); ++ break; ++ case CHANNEL_WIDTH_160: ++ RTW_PRINT_SEL(m, "%s\n", "160MHz"); ++ break; ++ case CHANNEL_WIDTH_80_80: ++ RTW_PRINT_SEL(m, "%s\n", "80MHz + 80MHz"); ++ break; ++ } ++ ++ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Privacy"); ++ switch (psta->dot118021XPrivacy) { ++ case _NO_PRIVACY_: ++ RTW_PRINT_SEL(m, "%s\n", "NO PRIVACY"); ++ break; ++ case _WEP40_: ++ RTW_PRINT_SEL(m, "%s\n", "WEP 40"); ++ break; ++ case _TKIP_: ++ RTW_PRINT_SEL(m, "%s\n", "TKIP"); ++ break; ++ case _TKIP_WTMIC_: ++ RTW_PRINT_SEL(m, "%s\n", "TKIP WTMIC"); ++ break; ++ case _AES_: ++ RTW_PRINT_SEL(m, "%s\n", "AES"); ++ break; ++ case _WEP104_: ++ RTW_PRINT_SEL(m, "%s\n", "WEP 104"); ++ break; ++ case _WEP_WPA_MIXED_: ++ RTW_PRINT_SEL(m, "%s\n", "WEP/WPA Mixed"); ++ break; ++ case _SMS4_: ++ RTW_PRINT_SEL(m, "%s\n", "SMS4"); ++ break; ++#ifdef CONFIG_IEEE80211W ++ case _BIP_: ++ RTW_PRINT_SEL(m, "%s\n", "BIP"); ++ break; ++#endif /* CONFIG_IEEE80211W */ ++ } ++ ++ RTW_PRINT_SEL(m, "%-*s = %d sec/%d sec\n", SpaceBtwnItemAndValue, "TPK Lifetime (Current/Expire)", psta->TPK_count, psta->TDLS_PeerKey_Lifetime); ++ RTW_PRINT_SEL(m, "%-*s = %llu\n", SpaceBtwnItemAndValue, "Tx Packets Over Direct Link", psta->sta_stats.tx_pkts); ++ RTW_PRINT_SEL(m, "%-*s = %llu\n", SpaceBtwnItemAndValue, "Rx Packets Over Direct Link", psta->sta_stats.rx_data_pkts); ++ } ++ } ++ } ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ if (NumOfTdlsStaToShow == 0) { ++ RTW_PRINT_SEL(m, "============[TDLS Peer STA Info]============\n"); ++ RTW_PRINT_SEL(m, "No TDLS direct link exists!\n"); ++ } ++ ++ return 0; ++} ++ ++int proc_get_tdls_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct sta_info *psta; ++ int i = 0, j = 0; ++ _irqL irqL; ++ _list *plist, *phead; ++ u8 SpaceBtwnItemAndValue = 41; ++ u8 SpaceBtwnItemAndValueTmp = 0; ++ u8 NumOfTdlsStaToShow = 0; ++ BOOLEAN FirstMatchFound = _FALSE; ++ ++ if (hal_chk_wl_func(padapter, WL_FUNC_TDLS) == _FALSE) { ++ RTW_PRINT_SEL(m, "No tdls info can be shown since hal doesn't support tdls\n"); ++ return 0; ++ } ++ ++ proc_tdls_display_tdls_function_info(m); ++ proc_tdls_display_network_info(m); ++ proc_tdls_display_tdls_sta_info(m); ++ ++ return 0; ++} ++#endif ++ ++int proc_get_monitor(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ if (WIFI_MONITOR_STATE == get_fwstate(pmlmepriv)) { ++ RTW_PRINT_SEL(m, "Monitor mode : Enable\n"); ++ ++ RTW_PRINT_SEL(m, "ch=%d, ch_offset=%d, bw=%d\n", ++ rtw_get_oper_ch(padapter), rtw_get_oper_choffset(padapter), rtw_get_oper_bw(padapter)); ++ } else ++ RTW_PRINT_SEL(m, "Monitor mode : Disable\n"); ++ ++ return 0; ++} ++ ++ssize_t proc_set_monitor(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ char tmp[32]; ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 target_chan, target_offset, target_bw; ++ ++ if (count < 3) { ++ RTW_INFO("argument size is less than 3\n"); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int num = sscanf(tmp, "%hhu %hhu %hhu", &target_chan, &target_offset, &target_bw); ++ ++ if (num != 3) { ++ RTW_INFO("invalid write_reg parameter!\n"); ++ return count; ++ } ++ ++ padapter->mlmeextpriv.cur_channel = target_chan; ++ set_channel_bwmode(padapter, target_chan, target_offset, target_bw); ++ } ++ ++ return count; ++} ++ ++#include ++int proc_get_efuse_map(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; ++ int i, j; ++ u8 ips_mode = IPS_NUM; ++ u16 mapLen; ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, _FALSE); ++ if (mapLen > EFUSE_MAX_MAP_LEN) ++ mapLen = EFUSE_MAX_MAP_LEN; ++ ++ ips_mode = pwrctrlpriv->ips_mode; ++ rtw_pm_set_ips(padapter, IPS_NONE); ++ ++ if (pHalData->efuse_file_status == EFUSE_FILE_LOADED) { ++ RTW_PRINT_SEL(m, "File eFuse Map loaded! file path:%s\nDriver eFuse Map From File\n", EFUSE_MAP_PATH); ++ if (pHalData->bautoload_fail_flag) ++ RTW_PRINT_SEL(m, "File Autoload fail!!!\n"); ++ } else if (pHalData->efuse_file_status == EFUSE_FILE_FAILED) { ++ RTW_PRINT_SEL(m, "Open File eFuse Map Fail ! file path:%s\nDriver eFuse Map From Default\n", EFUSE_MAP_PATH); ++ if (pHalData->bautoload_fail_flag) ++ RTW_PRINT_SEL(m, "HW Autoload fail!!!\n"); ++ } else { ++ RTW_PRINT_SEL(m, "Driver eFuse Map From HW\n"); ++ if (pHalData->bautoload_fail_flag) ++ RTW_PRINT_SEL(m, "HW Autoload fail!!!\n"); ++ } ++ for (i = 0; i < mapLen; i += 16) { ++ RTW_PRINT_SEL(m, "0x%02x\t", i); ++ for (j = 0; j < 8; j++) ++ RTW_PRINT_SEL(m, "%02X ", pHalData->efuse_eeprom_data[i + j]); ++ RTW_PRINT_SEL(m, "\t"); ++ for (; j < 16; j++) ++ RTW_PRINT_SEL(m, "%02X ", pHalData->efuse_eeprom_data[i + j]); ++ RTW_PRINT_SEL(m, "\n"); ++ } ++ ++ if (rtw_efuse_map_read(padapter, 0, mapLen, pEfuseHal->fakeEfuseInitMap) == _FAIL) { ++ RTW_PRINT_SEL(m, "WARN - Read Realmap Failed\n"); ++ return 0; ++ } ++ ++ RTW_PRINT_SEL(m, "\n"); ++ RTW_PRINT_SEL(m, "HW eFuse Map\n"); ++ for (i = 0; i < mapLen; i += 16) { ++ RTW_PRINT_SEL(m, "0x%02x\t", i); ++ for (j = 0; j < 8; j++) ++ RTW_PRINT_SEL(m, "%02X ", pEfuseHal->fakeEfuseInitMap[i + j]); ++ RTW_PRINT_SEL(m, "\t"); ++ for (; j < 16; j++) ++ RTW_PRINT_SEL(m, "%02X ", pEfuseHal->fakeEfuseInitMap[i + j]); ++ RTW_PRINT_SEL(m, "\n"); ++ } ++ ++ rtw_pm_set_ips(padapter, ips_mode); ++ ++ return 0; ++} ++ ++ssize_t proc_set_efuse_map(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++#if 0 ++ char tmp[256] = {0}; ++ u32 addr, cnts; ++ u8 efuse_data; ++ ++ int jj, kk; ++ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++ u8 ips_mode = IPS_NUM; ++ ++ if (count < 3) { ++ RTW_INFO("argument size is less than 3\n"); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%x %d %x", &addr, &cnts, &efuse_data); ++ ++ if (num != 3) { ++ RTW_INFO("invalid write_reg parameter!\n"); ++ return count; ++ } ++ } ++ ips_mode = pwrctrlpriv->ips_mode; ++ rtw_pm_set_ips(padapter, IPS_NONE); ++ if (rtw_efuse_map_write(padapter, addr, cnts, &efuse_data) == _FAIL) ++ RTW_INFO("WARN - rtw_efuse_map_write error!!\n"); ++ rtw_pm_set_ips(padapter, ips_mode); ++#endif ++ return count; ++} ++ ++#ifdef CONFIG_IEEE80211W ++ssize_t proc_set_tx_sa_query(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ struct sta_info *psta; ++ _list *plist, *phead; ++ _irqL irqL; ++ char tmp[16]; ++ u8 mac_addr[NUM_STA][ETH_ALEN]; ++ u32 key_type; ++ u8 index; ++ ++ if (count > 2) { ++ RTW_INFO("argument size is more than 2\n"); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { ++ ++ int num = sscanf(tmp, "%x", &key_type); ++ ++ if (num != 1) { ++ RTW_INFO("invalid read_reg parameter!\n"); ++ return count; ++ } ++ RTW_INFO("0: set sa query request , key_type=%d\n", key_type); ++ } ++ ++ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) ++ && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) && padapter->securitypriv.binstallBIPkey == _TRUE) { ++ RTW_INFO("STA:"MAC_FMT"\n", MAC_ARG(get_my_bssid(&(pmlmeinfo->network)))); ++ /* TX unicast sa_query to AP */ ++ issue_action_SA_Query(padapter, get_my_bssid(&(pmlmeinfo->network)), 0, 0, (u8)key_type); ++ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE && padapter->securitypriv.binstallBIPkey == _TRUE) { ++ /* TX unicast sa_query to every client STA */ ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ for (index = 0; index < NUM_STA; index++) { ++ psta = NULL; ++ ++ phead = &(pstapriv->sta_hash[index]); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); ++ plist = get_next(plist); ++ _rtw_memcpy(&mac_addr[psta->mac_id][0], psta->hwaddr, ETH_ALEN); ++ } ++ } ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ for (index = 0; index < macid_ctl->num && index < NUM_STA; index++) { ++ if (rtw_macid_is_used(macid_ctl, index) && !rtw_macid_is_bmc(macid_ctl, index)) { ++ if (!_rtw_memcmp(get_my_bssid(&(pmlmeinfo->network)), &mac_addr[index][0], ETH_ALEN) ++ && !IS_MCAST(&mac_addr[index][0])) { ++ issue_action_SA_Query(padapter, &mac_addr[index][0], 0, 0, (u8)key_type); ++ RTW_INFO("STA[%u]:"MAC_FMT"\n", index , MAC_ARG(&mac_addr[index][0])); ++ } ++ } ++ } ++ } ++ ++ return count; ++} ++ ++int proc_get_tx_sa_query(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_PRINT_SEL(m, "%s\n", __func__); ++ return 0; ++} ++ ++ssize_t proc_set_tx_deauth(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ struct sta_info *psta; ++ _list *plist, *phead; ++ _irqL irqL; ++ char tmp[16]; ++ u8 mac_addr[NUM_STA][ETH_ALEN]; ++ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ u32 key_type; ++ u8 index; ++ ++ ++ if (count > 2) { ++ RTW_INFO("argument size is more than 2\n"); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { ++ ++ int num = sscanf(tmp, "%x", &key_type); ++ ++ if (num != 1) { ++ RTW_INFO("invalid read_reg parameter!\n"); ++ return count; ++ } ++ RTW_INFO("key_type=%d\n", key_type); ++ } ++ if (key_type < 0 || key_type > 4) ++ return count; ++ ++ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) ++ && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { ++ if (key_type == 3) /* key_type 3 only for AP mode */ ++ return count; ++ /* TX unicast deauth to AP */ ++ issue_deauth_11w(padapter, get_my_bssid(&(pmlmeinfo->network)), 0, (u8)key_type); ++ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { ++ ++ if (key_type == 3) ++ issue_deauth_11w(padapter, bc_addr, 0, IEEE80211W_RIGHT_KEY); ++ ++ /* TX unicast deauth to every client STA */ ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ for (index = 0; index < NUM_STA; index++) { ++ psta = NULL; ++ ++ phead = &(pstapriv->sta_hash[index]); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); ++ plist = get_next(plist); ++ _rtw_memcpy(&mac_addr[psta->mac_id][0], psta->hwaddr, ETH_ALEN); ++ } ++ } ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ for (index = 0; index < macid_ctl->num && index < NUM_STA; index++) { ++ if (rtw_macid_is_used(macid_ctl, index) && !rtw_macid_is_bmc(macid_ctl, index)) { ++ if (!_rtw_memcmp(get_my_bssid(&(pmlmeinfo->network)), &mac_addr[index][0], ETH_ALEN)) { ++ if (key_type != 3) ++ issue_deauth_11w(padapter, &mac_addr[index][0], 0, (u8)key_type); ++ ++ psta = rtw_get_stainfo(pstapriv, &mac_addr[index][0]); ++ if (psta && key_type != IEEE80211W_WRONG_KEY && key_type != IEEE80211W_NO_KEY) { ++ u8 updated = _FALSE; ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { ++ rtw_list_delete(&psta->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_PREV_AUTH_NOT_VALID, _TRUE); ++ ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); ++ } ++ ++ RTW_INFO("STA[%u]:"MAC_FMT"\n", index , MAC_ARG(&mac_addr[index][0])); ++ } ++ } ++ } ++ } ++ ++ return count; ++} ++ ++int proc_get_tx_deauth(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_PRINT_SEL(m, "%s\n", __func__); ++ return 0; ++} ++ ++ssize_t proc_set_tx_auth(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ struct sta_info *psta; ++ _list *plist, *phead; ++ _irqL irqL; ++ char tmp[16]; ++ u8 mac_addr[NUM_STA][ETH_ALEN]; ++ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ u32 tx_auth; ++ u8 index; ++ ++ ++ if (count > 2) { ++ RTW_INFO("argument size is more than 2\n"); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { ++ ++ int num = sscanf(tmp, "%x", &tx_auth); ++ ++ if (num != 1) { ++ RTW_INFO("invalid read_reg parameter!\n"); ++ return count; ++ } ++ RTW_INFO("1: setnd auth, 2: send assoc request. tx_auth=%d\n", tx_auth); ++ } ++ ++ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) ++ && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { ++ if (tx_auth == 1) { ++ /* TX unicast auth to AP */ ++ issue_auth(padapter, NULL, 0); ++ } else if (tx_auth == 2) { ++ /* TX unicast auth to AP */ ++ issue_assocreq(padapter); ++ } ++ } ++ ++ return count; ++} ++ ++int proc_get_tx_auth(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_PRINT_SEL(m, "%s\n", __func__); ++ return 0; ++} ++#endif /* CONFIG_IEEE80211W */ ++ ++#ifdef CONFIG_MCC_MODE ++int proc_get_mcc_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ dump_adapters_status(m, adapter_to_dvobj(adapter)); ++ rtw_hal_dump_mcc_info(m, adapter_to_dvobj(adapter)); ++ return 0; ++} ++ ++ssize_t proc_set_mcc_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[255]; ++ u32 en_mcc = 0; ++ ++ if (NULL == buffer) { ++ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ _adapter *iface = NULL; ++ u8 i = 0; ++ int num = sscanf(tmp, "%u", &en_mcc); ++ ++ if (num < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); ++ return -EINVAL; ++ } ++ ++ RTW_INFO("%s: en_mcc = %d\n", __func__, en_mcc); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (!iface) ++ continue; ++ iface->registrypriv.en_mcc = en_mcc; ++ } ++ } ++ ++ return count; ++} ++ ++ssize_t proc_set_mcc_single_tx_criteria(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[255]; ++ u32 mcc_single_tx_criteria = 0; ++ ++ if (NULL == buffer) { ++ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ _adapter *iface = NULL; ++ u8 i = 0; ++ int num = sscanf(tmp, "%u", &mcc_single_tx_criteria); ++ ++ if (num < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); ++ return -EINVAL; ++ } ++ ++ RTW_INFO("%s: mcc_single_tx_criteria = %d\n", __func__, mcc_single_tx_criteria); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (!iface) ++ continue; ++ iface->registrypriv.rtw_mcc_single_tx_cri = mcc_single_tx_criteria; ++ } ++ ++ ++ } ++ ++ return count; ++} ++ ++ ++ssize_t proc_set_mcc_ap_bw20_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[255]; ++ u32 mcc_ap_bw20_target_tp = 0; ++ ++ if (NULL == buffer) { ++ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int num = sscanf(tmp, "%u", &mcc_ap_bw20_target_tp); ++ ++ if (num < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); ++ return -EINVAL; ++ } ++ ++ RTW_INFO("%s: mcc_ap_bw20_target_tp = %d\n", __func__, mcc_ap_bw20_target_tp); ++ ++ padapter->registrypriv.rtw_mcc_ap_bw20_target_tx_tp = mcc_ap_bw20_target_tp; ++ ++ ++ } ++ ++ return count; ++} ++ ++ssize_t proc_set_mcc_ap_bw40_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[255]; ++ u32 mcc_ap_bw40_target_tp = 0; ++ ++ if (NULL == buffer) { ++ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int num = sscanf(tmp, "%u", &mcc_ap_bw40_target_tp); ++ ++ if (num < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); ++ return -EINVAL; ++ } ++ ++ RTW_INFO("%s: mcc_ap_bw40_target_tp = %d\n", __func__, mcc_ap_bw40_target_tp); ++ ++ padapter->registrypriv.rtw_mcc_ap_bw40_target_tx_tp = mcc_ap_bw40_target_tp; ++ ++ ++ } ++ ++ return count; ++} ++ ++ssize_t proc_set_mcc_ap_bw80_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[255]; ++ u32 mcc_ap_bw80_target_tp = 0; ++ ++ if (NULL == buffer) { ++ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int num = sscanf(tmp, "%u", &mcc_ap_bw80_target_tp); ++ ++ if (num < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); ++ return -EINVAL; ++ } ++ ++ RTW_INFO("%s: mcc_ap_bw80_target_tp = %d\n", __func__, mcc_ap_bw80_target_tp); ++ ++ padapter->registrypriv.rtw_mcc_ap_bw80_target_tx_tp = mcc_ap_bw80_target_tp; ++ ++ ++ } ++ ++ return count; ++} ++ ++ssize_t proc_set_mcc_sta_bw20_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[255]; ++ u32 mcc_sta_bw20_target_tp = 0; ++ ++ if (NULL == buffer) { ++ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int num = sscanf(tmp, "%u", &mcc_sta_bw20_target_tp); ++ ++ if (num < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); ++ return -EINVAL; ++ } ++ ++ RTW_INFO("%s: mcc_sta_bw20_target_tp = %d\n", __func__, mcc_sta_bw20_target_tp); ++ ++ padapter->registrypriv.rtw_mcc_sta_bw20_target_tx_tp = mcc_sta_bw20_target_tp; ++ ++ ++ } ++ ++ return count; ++} ++ ++ssize_t proc_set_mcc_sta_bw40_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[255]; ++ u32 mcc_sta_bw40_target_tp = 0; ++ ++ if (NULL == buffer) { ++ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int num = sscanf(tmp, "%u", &mcc_sta_bw40_target_tp); ++ ++ if (num < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); ++ return -EINVAL; ++ } ++ ++ RTW_INFO("%s: mcc_sta_bw40_target_tp = %d\n", __func__, mcc_sta_bw40_target_tp); ++ ++ padapter->registrypriv.rtw_mcc_sta_bw40_target_tx_tp = mcc_sta_bw40_target_tp; ++ ++ ++ } ++ ++ return count; ++} ++ ++ssize_t proc_set_mcc_sta_bw80_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[255]; ++ u32 mcc_sta_bw80_target_tp = 0; ++ ++ if (NULL == buffer) { ++ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int num = sscanf(tmp, "%u", &mcc_sta_bw80_target_tp); ++ ++ if (num < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); ++ return -EINVAL; ++ } ++ ++ RTW_INFO("%s: mcc_sta_bw80_target_tp = %d\n", __func__, mcc_sta_bw80_target_tp); ++ ++ padapter->registrypriv.rtw_mcc_sta_bw80_target_tx_tp = mcc_sta_bw80_target_tp; ++ ++ ++ } ++ ++ return count; ++} ++#endif /* CONFIG_MCC_MODE */ ++ ++#endif /* CONFIG_PROC_DEBUG */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_eeprom.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_eeprom.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_eeprom.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_eeprom.c 2018-02-11 21:44:27.136145918 +0200 +@@ -0,0 +1,374 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_EEPROM_C_ ++ ++#include ++#include ++#include ++ ++void up_clk(_adapter *padapter, u16 *x) ++{ ++ *x = *x | _EESK; ++ rtw_write8(padapter, EE_9346CR, (u8)*x); ++ rtw_udelay_os(CLOCK_RATE); ++ ++ ++} ++ ++void down_clk(_adapter *padapter, u16 *x) ++{ ++ *x = *x & ~_EESK; ++ rtw_write8(padapter, EE_9346CR, (u8)*x); ++ rtw_udelay_os(CLOCK_RATE); ++} ++ ++void shift_out_bits(_adapter *padapter, u16 data, u16 count) ++{ ++ u16 x, mask; ++ ++ if (rtw_is_surprise_removed(padapter)) { ++ goto out; ++ } ++ mask = 0x01 << (count - 1); ++ x = rtw_read8(padapter, EE_9346CR); ++ ++ x &= ~(_EEDO | _EEDI); ++ ++ do { ++ x &= ~_EEDI; ++ if (data & mask) ++ x |= _EEDI; ++ if (rtw_is_surprise_removed(padapter)) { ++ goto out; ++ } ++ rtw_write8(padapter, EE_9346CR, (u8)x); ++ rtw_udelay_os(CLOCK_RATE); ++ up_clk(padapter, &x); ++ down_clk(padapter, &x); ++ mask = mask >> 1; ++ } while (mask); ++ if (rtw_is_surprise_removed(padapter)) { ++ goto out; ++ } ++ x &= ~_EEDI; ++ rtw_write8(padapter, EE_9346CR, (u8)x); ++out: ++ return; ++} ++ ++u16 shift_in_bits(_adapter *padapter) ++{ ++ u16 x, d = 0, i; ++ if (rtw_is_surprise_removed(padapter)) { ++ goto out; ++ } ++ x = rtw_read8(padapter, EE_9346CR); ++ ++ x &= ~(_EEDO | _EEDI); ++ d = 0; ++ ++ for (i = 0; i < 16; i++) { ++ d = d << 1; ++ up_clk(padapter, &x); ++ if (rtw_is_surprise_removed(padapter)) { ++ goto out; ++ } ++ x = rtw_read8(padapter, EE_9346CR); ++ ++ x &= ~(_EEDI); ++ if (x & _EEDO) ++ d |= 1; ++ ++ down_clk(padapter, &x); ++ } ++out: ++ ++ return d; ++} ++ ++void standby(_adapter *padapter) ++{ ++ u8 x; ++ x = rtw_read8(padapter, EE_9346CR); ++ ++ x &= ~(_EECS | _EESK); ++ rtw_write8(padapter, EE_9346CR, x); ++ ++ rtw_udelay_os(CLOCK_RATE); ++ x |= _EECS; ++ rtw_write8(padapter, EE_9346CR, x); ++ rtw_udelay_os(CLOCK_RATE); ++} ++ ++u16 wait_eeprom_cmd_done(_adapter *padapter) ++{ ++ u8 x; ++ u16 i, res = _FALSE; ++ standby(padapter); ++ for (i = 0; i < 200; i++) { ++ x = rtw_read8(padapter, EE_9346CR); ++ if (x & _EEDO) { ++ res = _TRUE; ++ goto exit; ++ } ++ rtw_udelay_os(CLOCK_RATE); ++ } ++exit: ++ return res; ++} ++ ++void eeprom_clean(_adapter *padapter) ++{ ++ u16 x; ++ if (rtw_is_surprise_removed(padapter)) { ++ goto out; ++ } ++ x = rtw_read8(padapter, EE_9346CR); ++ if (rtw_is_surprise_removed(padapter)) { ++ goto out; ++ } ++ x &= ~(_EECS | _EEDI); ++ rtw_write8(padapter, EE_9346CR, (u8)x); ++ if (rtw_is_surprise_removed(padapter)) { ++ goto out; ++ } ++ up_clk(padapter, &x); ++ if (rtw_is_surprise_removed(padapter)) { ++ goto out; ++ } ++ down_clk(padapter, &x); ++out: ++ return; ++} ++ ++void eeprom_write16(_adapter *padapter, u16 reg, u16 data) ++{ ++ u8 x; ++#ifdef CONFIG_RTL8712 ++ u8 tmp8_ori, tmp8_new, tmp8_clk_ori, tmp8_clk_new; ++ tmp8_ori = rtw_read8(padapter, 0x102502f1); ++ tmp8_new = tmp8_ori & 0xf7; ++ if (tmp8_ori != tmp8_new) { ++ rtw_write8(padapter, 0x102502f1, tmp8_new); ++ } ++ tmp8_clk_ori = rtw_read8(padapter, 0x10250003); ++ tmp8_clk_new = tmp8_clk_ori | 0x20; ++ if (tmp8_clk_new != tmp8_clk_ori) { ++ rtw_write8(padapter, 0x10250003, tmp8_clk_new); ++ } ++#endif ++ ++ x = rtw_read8(padapter, EE_9346CR); ++ ++ x &= ~(_EEDI | _EEDO | _EESK | _EEM0); ++ x |= _EEM1 | _EECS; ++ rtw_write8(padapter, EE_9346CR, x); ++ ++ shift_out_bits(padapter, EEPROM_EWEN_OPCODE, 5); ++ ++ if (padapter->EepromAddressSize == 8) /* CF+ and SDIO */ ++ shift_out_bits(padapter, 0, 6); ++ else /* USB */ ++ shift_out_bits(padapter, 0, 4); ++ ++ standby(padapter); ++ ++ /* Commented out by rcnjko, 2004.0 ++ * Erase this particular word. Write the erase opcode and register ++ * number in that order. The opcode is 3bits in length; reg is 6 bits long. */ ++/* shift_out_bits(Adapter, EEPROM_ERASE_OPCODE, 3); ++ * shift_out_bits(Adapter, reg, Adapter->EepromAddressSize); ++ * ++ * if (wait_eeprom_cmd_done(Adapter ) == FALSE) ++ * { ++ * return; ++ * } */ ++ ++ ++ standby(padapter); ++ ++ /* write the new word to the EEPROM */ ++ ++ /* send the write opcode the EEPORM */ ++ shift_out_bits(padapter, EEPROM_WRITE_OPCODE, 3); ++ ++ /* select which word in the EEPROM that we are writing to. */ ++ shift_out_bits(padapter, reg, padapter->EepromAddressSize); ++ ++ /* write the data to the selected EEPROM word. */ ++ shift_out_bits(padapter, data, 16); ++ ++ if (wait_eeprom_cmd_done(padapter) == _FALSE) ++ ++ goto exit; ++ ++ standby(padapter); ++ ++ shift_out_bits(padapter, EEPROM_EWDS_OPCODE, 5); ++ shift_out_bits(padapter, reg, 4); ++ ++ eeprom_clean(padapter); ++exit: ++#ifdef CONFIG_RTL8712 ++ if (tmp8_clk_new != tmp8_clk_ori) ++ rtw_write8(padapter, 0x10250003, tmp8_clk_ori); ++ if (tmp8_new != tmp8_ori) ++ rtw_write8(padapter, 0x102502f1, tmp8_ori); ++ ++#endif ++ return; ++} ++ ++u16 eeprom_read16(_adapter *padapter, u16 reg) /* ReadEEprom */ ++{ ++ ++ u16 x; ++ u16 data = 0; ++#ifdef CONFIG_RTL8712 ++ u8 tmp8_ori, tmp8_new, tmp8_clk_ori, tmp8_clk_new; ++ tmp8_ori = rtw_read8(padapter, 0x102502f1); ++ tmp8_new = tmp8_ori & 0xf7; ++ if (tmp8_ori != tmp8_new) { ++ rtw_write8(padapter, 0x102502f1, tmp8_new); ++ } ++ tmp8_clk_ori = rtw_read8(padapter, 0x10250003); ++ tmp8_clk_new = tmp8_clk_ori | 0x20; ++ if (tmp8_clk_new != tmp8_clk_ori) { ++ rtw_write8(padapter, 0x10250003, tmp8_clk_new); ++ } ++#endif ++ ++ if (rtw_is_surprise_removed(padapter)) { ++ goto out; ++ } ++ /* select EEPROM, reset bits, set _EECS */ ++ x = rtw_read8(padapter, EE_9346CR); ++ ++ if (rtw_is_surprise_removed(padapter)) { ++ goto out; ++ } ++ ++ x &= ~(_EEDI | _EEDO | _EESK | _EEM0); ++ x |= _EEM1 | _EECS; ++ rtw_write8(padapter, EE_9346CR, (unsigned char)x); ++ ++ /* write the read opcode and register number in that order */ ++ /* The opcode is 3bits in length, reg is 6 bits long */ ++ shift_out_bits(padapter, EEPROM_READ_OPCODE, 3); ++ shift_out_bits(padapter, reg, padapter->EepromAddressSize); ++ ++ /* Now read the data (16 bits) in from the selected EEPROM word */ ++ data = shift_in_bits(padapter); ++ ++ eeprom_clean(padapter); ++out: ++#ifdef CONFIG_RTL8712 ++ if (tmp8_clk_new != tmp8_clk_ori) ++ rtw_write8(padapter, 0x10250003, tmp8_clk_ori); ++ if (tmp8_new != tmp8_ori) ++ rtw_write8(padapter, 0x102502f1, tmp8_ori); ++ ++#endif ++ return data; ++ ++ ++} ++ ++ ++ ++ ++/* From even offset */ ++void eeprom_read_sz(_adapter *padapter, u16 reg, u8 *data, u32 sz) ++{ ++ ++ u16 x, data16; ++ u32 i; ++ if (rtw_is_surprise_removed(padapter)) { ++ goto out; ++ } ++ /* select EEPROM, reset bits, set _EECS */ ++ x = rtw_read8(padapter, EE_9346CR); ++ ++ if (rtw_is_surprise_removed(padapter)) { ++ goto out; ++ } ++ ++ x &= ~(_EEDI | _EEDO | _EESK | _EEM0); ++ x |= _EEM1 | _EECS; ++ rtw_write8(padapter, EE_9346CR, (unsigned char)x); ++ ++ /* write the read opcode and register number in that order */ ++ /* The opcode is 3bits in length, reg is 6 bits long */ ++ shift_out_bits(padapter, EEPROM_READ_OPCODE, 3); ++ shift_out_bits(padapter, reg, padapter->EepromAddressSize); ++ ++ ++ for (i = 0; i < sz; i += 2) { ++ data16 = shift_in_bits(padapter); ++ data[i] = data16 & 0xff; ++ data[i + 1] = data16 >> 8; ++ } ++ ++ eeprom_clean(padapter); ++out: ++ return; ++} ++ ++ ++/* addr_off : address offset of the entry in eeprom (not the tuple number of eeprom (reg); that is addr_off !=reg) */ ++u8 eeprom_read(_adapter *padapter, u32 addr_off, u8 sz, u8 *rbuf) ++{ ++ u8 quotient, remainder, addr_2align_odd; ++ u16 reg, stmp , i = 0, idx = 0; ++ reg = (u16)(addr_off >> 1); ++ addr_2align_odd = (u8)(addr_off & 0x1); ++ ++ if (addr_2align_odd) { /* read that start at high part: e.g 1,3,5,7,9,... */ ++ stmp = eeprom_read16(padapter, reg); ++ rbuf[idx++] = (u8)((stmp >> 8) & 0xff); /* return hogh-part of the short */ ++ reg++; ++ sz--; ++ } ++ ++ quotient = sz >> 1; ++ remainder = sz & 0x1; ++ ++ for (i = 0 ; i < quotient; i++) { ++ stmp = eeprom_read16(padapter, reg + i); ++ rbuf[idx++] = (u8)(stmp & 0xff); ++ rbuf[idx++] = (u8)((stmp >> 8) & 0xff); ++ } ++ ++ reg = reg + i; ++ if (remainder) { /* end of read at lower part of short : 0,2,4,6,... */ ++ stmp = eeprom_read16(padapter, reg); ++ rbuf[idx] = (u8)(stmp & 0xff); ++ } ++ return _TRUE; ++} ++ ++ ++ ++VOID read_eeprom_content(_adapter *padapter) ++{ ++ ++ ++ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_ieee80211.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ieee80211.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_ieee80211.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ieee80211.c 2018-02-11 21:44:27.136145918 +0200 +@@ -0,0 +1,2706 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _IEEE80211_C ++ ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++ #include ++#endif ++#include ++ ++ ++u8 RTW_WPA_OUI_TYPE[] = { 0x00, 0x50, 0xf2, 1 }; ++u16 RTW_WPA_VERSION = 1; ++u8 WPA_AUTH_KEY_MGMT_NONE[] = { 0x00, 0x50, 0xf2, 0 }; ++u8 WPA_AUTH_KEY_MGMT_UNSPEC_802_1X[] = { 0x00, 0x50, 0xf2, 1 }; ++u8 WPA_AUTH_KEY_MGMT_PSK_OVER_802_1X[] = { 0x00, 0x50, 0xf2, 2 }; ++u8 WPA_CIPHER_SUITE_NONE[] = { 0x00, 0x50, 0xf2, 0 }; ++u8 WPA_CIPHER_SUITE_WEP40[] = { 0x00, 0x50, 0xf2, 1 }; ++u8 WPA_CIPHER_SUITE_TKIP[] = { 0x00, 0x50, 0xf2, 2 }; ++u8 WPA_CIPHER_SUITE_WRAP[] = { 0x00, 0x50, 0xf2, 3 }; ++u8 WPA_CIPHER_SUITE_CCMP[] = { 0x00, 0x50, 0xf2, 4 }; ++u8 WPA_CIPHER_SUITE_WEP104[] = { 0x00, 0x50, 0xf2, 5 }; ++ ++u16 RSN_VERSION_BSD = 1; ++u8 RSN_AUTH_KEY_MGMT_UNSPEC_802_1X[] = { 0x00, 0x0f, 0xac, 1 }; ++u8 RSN_AUTH_KEY_MGMT_PSK_OVER_802_1X[] = { 0x00, 0x0f, 0xac, 2 }; ++u8 RSN_CIPHER_SUITE_NONE[] = { 0x00, 0x0f, 0xac, 0 }; ++u8 RSN_CIPHER_SUITE_WEP40[] = { 0x00, 0x0f, 0xac, 1 }; ++u8 RSN_CIPHER_SUITE_TKIP[] = { 0x00, 0x0f, 0xac, 2 }; ++u8 RSN_CIPHER_SUITE_WRAP[] = { 0x00, 0x0f, 0xac, 3 }; ++u8 RSN_CIPHER_SUITE_CCMP[] = { 0x00, 0x0f, 0xac, 4 }; ++u8 RSN_CIPHER_SUITE_WEP104[] = { 0x00, 0x0f, 0xac, 5 }; ++/* ----------------------------------------------------------- ++ * for adhoc-master to generate ie and provide supported-rate to fw ++ * ----------------------------------------------------------- */ ++ ++static u8 WIFI_CCKRATES[] = { ++ (IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK), ++ (IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK), ++ (IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK), ++ (IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK) ++}; ++ ++static u8 WIFI_OFDMRATES[] = { ++ (IEEE80211_OFDM_RATE_6MB), ++ (IEEE80211_OFDM_RATE_9MB), ++ (IEEE80211_OFDM_RATE_12MB), ++ (IEEE80211_OFDM_RATE_18MB), ++ (IEEE80211_OFDM_RATE_24MB), ++ IEEE80211_OFDM_RATE_36MB, ++ IEEE80211_OFDM_RATE_48MB, ++ IEEE80211_OFDM_RATE_54MB ++}; ++ ++u8 mgn_rates_cck[4] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}; ++u8 mgn_rates_ofdm[8] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M}; ++u8 mgn_rates_mcs0_7[8] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}; ++u8 mgn_rates_mcs8_15[8] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}; ++u8 mgn_rates_mcs16_23[8] = {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23}; ++u8 mgn_rates_mcs24_31[8] = {MGN_MCS24, MGN_MCS25, MGN_MCS26, MGN_MCS27, MGN_MCS28, MGN_MCS29, MGN_MCS30, MGN_MCS31}; ++u8 mgn_rates_vht1ss[10] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4 ++ , MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9 ++ }; ++u8 mgn_rates_vht2ss[10] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4 ++ , MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9 ++ }; ++u8 mgn_rates_vht3ss[10] = {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4 ++ , MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9 ++ }; ++u8 mgn_rates_vht4ss[10] = {MGN_VHT4SS_MCS0, MGN_VHT4SS_MCS1, MGN_VHT4SS_MCS2, MGN_VHT4SS_MCS3, MGN_VHT4SS_MCS4 ++ , MGN_VHT4SS_MCS5, MGN_VHT4SS_MCS6, MGN_VHT4SS_MCS7, MGN_VHT4SS_MCS8, MGN_VHT4SS_MCS9 ++ }; ++ ++static const char *const _rate_section_str[] = { ++ "CCK", ++ "OFDM", ++ "HT_1SS", ++ "HT_2SS", ++ "HT_3SS", ++ "HT_4SS", ++ "VHT_1SS", ++ "VHT_2SS", ++ "VHT_3SS", ++ "VHT_4SS", ++ "RATE_SECTION_UNKNOWN", ++}; ++ ++const char *rate_section_str(u8 section) ++{ ++ section = (section >= RATE_SECTION_NUM) ? RATE_SECTION_NUM : section; ++ return _rate_section_str[section]; ++} ++ ++struct rate_section_ent rates_by_sections[RATE_SECTION_NUM] = { ++ {RF_1TX, 4, mgn_rates_cck}, ++ {RF_1TX, 8, mgn_rates_ofdm}, ++ {RF_1TX, 8, mgn_rates_mcs0_7}, ++ {RF_2TX, 8, mgn_rates_mcs8_15}, ++ {RF_3TX, 8, mgn_rates_mcs16_23}, ++ {RF_4TX, 8, mgn_rates_mcs24_31}, ++ {RF_1TX, 10, mgn_rates_vht1ss}, ++ {RF_2TX, 10, mgn_rates_vht2ss}, ++ {RF_3TX, 10, mgn_rates_vht3ss}, ++ {RF_4TX, 10, mgn_rates_vht4ss}, ++}; ++ ++int rtw_get_bit_value_from_ieee_value(u8 val) ++{ ++ unsigned char dot11_rate_table[] = {2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108, 0}; /* last element must be zero!! */ ++ ++ int i = 0; ++ while (dot11_rate_table[i] != 0) { ++ if (dot11_rate_table[i] == val) ++ return BIT(i); ++ i++; ++ } ++ return 0; ++} ++ ++uint rtw_is_cckrates_included(u8 *rate) ++{ ++ u32 i = 0; ++ ++ while (rate[i] != 0) { ++ if ((((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || ++ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22)) ++ return _TRUE; ++ i++; ++ } ++ ++ return _FALSE; ++} ++ ++uint rtw_is_cckratesonly_included(u8 *rate) ++{ ++ u32 i = 0; ++ ++ ++ while (rate[i] != 0) { ++ if ((((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && ++ (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22)) ++ return _FALSE; ++ ++ i++; ++ } ++ ++ return _TRUE; ++ ++} ++ ++int rtw_check_network_type(unsigned char *rate, int ratelen, int channel) ++{ ++ if (channel > 14) { ++ if ((rtw_is_cckrates_included(rate)) == _TRUE) ++ return WIRELESS_INVALID; ++ else ++ return WIRELESS_11A; ++ } else { /* could be pure B, pure G, or B/G */ ++ if ((rtw_is_cckratesonly_included(rate)) == _TRUE) ++ return WIRELESS_11B; ++ else if ((rtw_is_cckrates_included(rate)) == _TRUE) ++ return WIRELESS_11BG; ++ else ++ return WIRELESS_11G; ++ } ++ ++} ++ ++u8 *rtw_set_fixed_ie(unsigned char *pbuf, unsigned int len, unsigned char *source, ++ unsigned int *frlen) ++{ ++ _rtw_memcpy((void *)pbuf, (void *)source, len); ++ *frlen = *frlen + len; ++ return pbuf + len; ++} ++ ++/* rtw_set_ie will update frame length */ ++u8 *rtw_set_ie ++( ++ u8 *pbuf, ++ sint index, ++ uint len, ++ u8 *source, ++ uint *frlen /* frame length */ ++) ++{ ++ *pbuf = (u8)index; ++ ++ *(pbuf + 1) = (u8)len; ++ ++ if (len > 0) ++ _rtw_memcpy((void *)(pbuf + 2), (void *)source, len); ++ ++ *frlen = *frlen + (len + 2); ++ ++ return pbuf + len + 2; ++} ++ ++inline u8 *rtw_set_ie_ch_switch(u8 *buf, u32 *buf_len, u8 ch_switch_mode, ++ u8 new_ch, u8 ch_switch_cnt) ++{ ++ u8 ie_data[3]; ++ ++ ie_data[0] = ch_switch_mode; ++ ie_data[1] = new_ch; ++ ie_data[2] = ch_switch_cnt; ++ return rtw_set_ie(buf, WLAN_EID_CHANNEL_SWITCH, 3, ie_data, buf_len); ++} ++ ++inline u8 secondary_ch_offset_to_hal_ch_offset(u8 ch_offset) ++{ ++ if (ch_offset == SCN) ++ return HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ else if (ch_offset == SCA) ++ return HAL_PRIME_CHNL_OFFSET_UPPER; ++ else if (ch_offset == SCB) ++ return HAL_PRIME_CHNL_OFFSET_LOWER; ++ ++ return HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++} ++ ++inline u8 hal_ch_offset_to_secondary_ch_offset(u8 ch_offset) ++{ ++ if (ch_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) ++ return SCN; ++ else if (ch_offset == HAL_PRIME_CHNL_OFFSET_LOWER) ++ return SCB; ++ else if (ch_offset == HAL_PRIME_CHNL_OFFSET_UPPER) ++ return SCA; ++ ++ return SCN; ++} ++ ++inline u8 *rtw_set_ie_secondary_ch_offset(u8 *buf, u32 *buf_len, u8 secondary_ch_offset) ++{ ++ return rtw_set_ie(buf, WLAN_EID_SECONDARY_CHANNEL_OFFSET, 1, &secondary_ch_offset, buf_len); ++} ++ ++inline u8 *rtw_set_ie_mesh_ch_switch_parm(u8 *buf, u32 *buf_len, u8 ttl, ++ u8 flags, u16 reason, u16 precedence) ++{ ++ u8 ie_data[6]; ++ ++ ie_data[0] = ttl; ++ ie_data[1] = flags; ++ RTW_PUT_LE16((u8 *)&ie_data[2], reason); ++ RTW_PUT_LE16((u8 *)&ie_data[4], precedence); ++ ++ return rtw_set_ie(buf, 0x118, 6, ie_data, buf_len); ++} ++ ++/*---------------------------------------------------------------------------- ++index: the information element id index, limit is the limit for search ++-----------------------------------------------------------------------------*/ ++u8 *rtw_get_ie(u8 *pbuf, sint index, sint *len, sint limit) ++{ ++ sint tmp, i; ++ u8 *p; ++ if (limit < 1) { ++ return NULL; ++ } ++ ++ p = pbuf; ++ i = 0; ++ *len = 0; ++ while (1) { ++ if (*p == index) { ++ *len = *(p + 1); ++ return p; ++ } else { ++ tmp = *(p + 1); ++ p += (tmp + 2); ++ i += (tmp + 2); ++ } ++ if (i >= limit) ++ break; ++ } ++ return NULL; ++} ++ ++/** ++ * rtw_get_ie_ex - Search specific IE from a series of IEs ++ * @in_ie: Address of IEs to search ++ * @in_len: Length limit from in_ie ++ * @eid: Element ID to match ++ * @oui: OUI to match ++ * @oui_len: OUI length ++ * @ie: If not NULL and the specific IE is found, the IE will be copied to the buf starting from the specific IE ++ * @ielen: If not NULL and the specific IE is found, will set to the length of the entire IE ++ * ++ * Returns: The address of the specific IE found, or NULL ++ */ ++u8 *rtw_get_ie_ex(u8 *in_ie, uint in_len, u8 eid, u8 *oui, u8 oui_len, u8 *ie, uint *ielen) ++{ ++ uint cnt; ++ u8 *target_ie = NULL; ++ ++ ++ if (ielen) ++ *ielen = 0; ++ ++ if (!in_ie || in_len <= 0) ++ return target_ie; ++ ++ cnt = 0; ++ ++ while (cnt < in_len) { ++ if (eid == in_ie[cnt] ++ && (!oui || _rtw_memcmp(&in_ie[cnt + 2], oui, oui_len) == _TRUE)) { ++ target_ie = &in_ie[cnt]; ++ ++ if (ie) ++ _rtw_memcpy(ie, &in_ie[cnt], in_ie[cnt + 1] + 2); ++ ++ if (ielen) ++ *ielen = in_ie[cnt + 1] + 2; ++ ++ break; ++ } else { ++ cnt += in_ie[cnt + 1] + 2; /* goto next */ ++ } ++ ++ } ++ ++ return target_ie; ++} ++ ++/** ++ * rtw_ies_remove_ie - Find matching IEs and remove ++ * @ies: Address of IEs to search ++ * @ies_len: Pointer of length of ies, will update to new length ++ * @offset: The offset to start scarch ++ * @eid: Element ID to match ++ * @oui: OUI to match ++ * @oui_len: OUI length ++ * ++ * Returns: _SUCCESS: ies is updated, _FAIL: not updated ++ */ ++int rtw_ies_remove_ie(u8 *ies, uint *ies_len, uint offset, u8 eid, u8 *oui, u8 oui_len) ++{ ++ int ret = _FAIL; ++ u8 *target_ie; ++ u32 target_ielen; ++ u8 *start; ++ uint search_len; ++ ++ if (!ies || !ies_len || *ies_len <= offset) ++ goto exit; ++ ++ start = ies + offset; ++ search_len = *ies_len - offset; ++ ++ while (1) { ++ target_ie = rtw_get_ie_ex(start, search_len, eid, oui, oui_len, NULL, &target_ielen); ++ if (target_ie && target_ielen) { ++ u8 *remain_ies = target_ie + target_ielen; ++ uint remain_len = search_len - (remain_ies - start); ++ ++ _rtw_memmove(target_ie, remain_ies, remain_len); ++ *ies_len = *ies_len - target_ielen; ++ ret = _SUCCESS; ++ ++ start = target_ie; ++ search_len = remain_len; ++ } else ++ break; ++ } ++exit: ++ return ret; ++} ++ ++void rtw_set_supported_rate(u8 *SupportedRates, uint mode) ++{ ++ ++ _rtw_memset(SupportedRates, 0, NDIS_802_11_LENGTH_RATES_EX); ++ ++ switch (mode) { ++ case WIRELESS_11B: ++ _rtw_memcpy(SupportedRates, WIFI_CCKRATES, IEEE80211_CCK_RATE_LEN); ++ break; ++ ++ case WIRELESS_11G: ++ case WIRELESS_11A: ++ case WIRELESS_11_5N: ++ case WIRELESS_11A_5N: /* Todo: no basic rate for ofdm ? */ ++ case WIRELESS_11_5AC: ++ _rtw_memcpy(SupportedRates, WIFI_OFDMRATES, IEEE80211_NUM_OFDM_RATESLEN); ++ break; ++ ++ case WIRELESS_11BG: ++ case WIRELESS_11G_24N: ++ case WIRELESS_11_24N: ++ case WIRELESS_11BG_24N: ++ _rtw_memcpy(SupportedRates, WIFI_CCKRATES, IEEE80211_CCK_RATE_LEN); ++ _rtw_memcpy(SupportedRates + IEEE80211_CCK_RATE_LEN, WIFI_OFDMRATES, IEEE80211_NUM_OFDM_RATESLEN); ++ break; ++ ++ } ++} ++ ++uint rtw_get_rateset_len(u8 *rateset) ++{ ++ uint i = 0; ++ while (1) { ++ if ((rateset[i]) == 0) ++ break; ++ ++ if (i > 12) ++ break; ++ ++ i++; ++ } ++ return i; ++} ++ ++int rtw_generate_ie(struct registry_priv *pregistrypriv) ++{ ++ u8 wireless_mode; ++ int sz = 0, rateLen; ++ WLAN_BSSID_EX *pdev_network = &pregistrypriv->dev_network; ++ u8 *ie = pdev_network->IEs; ++ ++ ++ /* timestamp will be inserted by hardware */ ++ sz += 8; ++ ie += sz; ++ ++ /* beacon interval : 2bytes */ ++ *(u16 *)ie = cpu_to_le16((u16)pdev_network->Configuration.BeaconPeriod); /* BCN_INTERVAL; */ ++ sz += 2; ++ ie += 2; ++ ++ /* capability info */ ++ *(u16 *)ie = 0; ++ ++ *(u16 *)ie |= cpu_to_le16(cap_IBSS); ++ ++ if (pregistrypriv->preamble == PREAMBLE_SHORT) ++ *(u16 *)ie |= cpu_to_le16(cap_ShortPremble); ++ ++ if (pdev_network->Privacy) ++ *(u16 *)ie |= cpu_to_le16(cap_Privacy); ++ ++ sz += 2; ++ ie += 2; ++ ++ /* SSID */ ++ ie = rtw_set_ie(ie, _SSID_IE_, pdev_network->Ssid.SsidLength, pdev_network->Ssid.Ssid, &sz); ++ ++ /* supported rates */ ++ if (pregistrypriv->wireless_mode == WIRELESS_11ABGN) { ++ if (pdev_network->Configuration.DSConfig > 14) ++ wireless_mode = WIRELESS_11A_5N; ++ else ++ wireless_mode = WIRELESS_11BG_24N; ++ } else if (pregistrypriv->wireless_mode == WIRELESS_MODE_MAX) { /* WIRELESS_11ABGN | WIRELESS_11AC */ ++ if (pdev_network->Configuration.DSConfig > 14) ++ wireless_mode = WIRELESS_11_5AC; ++ else ++ wireless_mode = WIRELESS_11BG_24N; ++ } else ++ wireless_mode = pregistrypriv->wireless_mode; ++ ++ rtw_set_supported_rate(pdev_network->SupportedRates, wireless_mode) ; ++ ++ rateLen = rtw_get_rateset_len(pdev_network->SupportedRates); ++ ++ if (rateLen > 8) { ++ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, 8, pdev_network->SupportedRates, &sz); ++ /* ie = rtw_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rateLen - 8), (pdev_network->SupportedRates + 8), &sz); */ ++ } else ++ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, rateLen, pdev_network->SupportedRates, &sz); ++ ++ /* DS parameter set */ ++ ie = rtw_set_ie(ie, _DSSET_IE_, 1, (u8 *)&(pdev_network->Configuration.DSConfig), &sz); ++ ++ ++ /* IBSS Parameter Set */ ++ ++ ie = rtw_set_ie(ie, _IBSS_PARA_IE_, 2, (u8 *)&(pdev_network->Configuration.ATIMWindow), &sz); ++ ++ if (rateLen > 8) ++ ie = rtw_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rateLen - 8), (pdev_network->SupportedRates + 8), &sz); ++ ++#ifdef CONFIG_80211N_HT ++ /* HT Cap. */ ++ if (((pregistrypriv->wireless_mode & WIRELESS_11_5N) || (pregistrypriv->wireless_mode & WIRELESS_11_24N)) ++ && (pregistrypriv->ht_enable == _TRUE)) { ++ /* todo: */ ++ } ++#endif /* CONFIG_80211N_HT */ ++ ++ /* pdev_network->IELength = sz; */ /* update IELength */ ++ ++ ++ /* return _SUCCESS; */ ++ ++ return sz; ++ ++} ++ ++unsigned char *rtw_get_wpa_ie(unsigned char *pie, int *wpa_ie_len, int limit) ++{ ++ int len; ++ u16 val16; ++ unsigned char wpa_oui_type[] = {0x00, 0x50, 0xf2, 0x01}; ++ u8 *pbuf = pie; ++ int limit_new = limit; ++ ++ while (1) { ++ pbuf = rtw_get_ie(pbuf, _WPA_IE_ID_, &len, limit_new); ++ ++ if (pbuf) { ++ ++ /* check if oui matches... */ ++ if (_rtw_memcmp((pbuf + 2), wpa_oui_type, sizeof(wpa_oui_type)) == _FALSE) ++ ++ goto check_next_ie; ++ ++ /* check version... */ ++ _rtw_memcpy((u8 *)&val16, (pbuf + 6), sizeof(val16)); ++ ++ val16 = le16_to_cpu(val16); ++ if (val16 != 0x0001) ++ goto check_next_ie; ++ ++ *wpa_ie_len = *(pbuf + 1); ++ ++ return pbuf; ++ ++ } else { ++ ++ *wpa_ie_len = 0; ++ return NULL; ++ } ++ ++check_next_ie: ++ ++ limit_new = limit - (pbuf - pie) - 2 - len; ++ ++ if (limit_new <= 0) ++ break; ++ ++ pbuf += (2 + len); ++ ++ } ++ ++ *wpa_ie_len = 0; ++ ++ return NULL; ++ ++} ++ ++unsigned char *rtw_get_wpa2_ie(unsigned char *pie, int *rsn_ie_len, int limit) ++{ ++ ++ return rtw_get_ie(pie, _WPA2_IE_ID_, rsn_ie_len, limit); ++ ++} ++ ++int rtw_get_wpa_cipher_suite(u8 *s) ++{ ++ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_NONE, WPA_SELECTOR_LEN) == _TRUE) ++ return WPA_CIPHER_NONE; ++ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_WEP40, WPA_SELECTOR_LEN) == _TRUE) ++ return WPA_CIPHER_WEP40; ++ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_TKIP, WPA_SELECTOR_LEN) == _TRUE) ++ return WPA_CIPHER_TKIP; ++ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_CCMP, WPA_SELECTOR_LEN) == _TRUE) ++ return WPA_CIPHER_CCMP; ++ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_WEP104, WPA_SELECTOR_LEN) == _TRUE) ++ return WPA_CIPHER_WEP104; ++ ++ return 0; ++} ++ ++int rtw_get_wpa2_cipher_suite(u8 *s) ++{ ++ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_NONE, RSN_SELECTOR_LEN) == _TRUE) ++ return WPA_CIPHER_NONE; ++ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_WEP40, RSN_SELECTOR_LEN) == _TRUE) ++ return WPA_CIPHER_WEP40; ++ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_TKIP, RSN_SELECTOR_LEN) == _TRUE) ++ return WPA_CIPHER_TKIP; ++ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_CCMP, RSN_SELECTOR_LEN) == _TRUE) ++ return WPA_CIPHER_CCMP; ++ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_WEP104, RSN_SELECTOR_LEN) == _TRUE) ++ return WPA_CIPHER_WEP104; ++ ++ return 0; ++} ++ ++ ++int rtw_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x) ++{ ++ int i, ret = _SUCCESS; ++ int left, count; ++ u8 *pos; ++ u8 SUITE_1X[4] = {0x00, 0x50, 0xf2, 1}; ++ ++ if (wpa_ie_len <= 0) { ++ /* No WPA IE - fail silently */ ++ return _FAIL; ++ } ++ ++ ++ if ((*wpa_ie != _WPA_IE_ID_) || (*(wpa_ie + 1) != (u8)(wpa_ie_len - 2)) || ++ (_rtw_memcmp(wpa_ie + 2, RTW_WPA_OUI_TYPE, WPA_SELECTOR_LEN) != _TRUE)) ++ return _FAIL; ++ ++ pos = wpa_ie; ++ ++ pos += 8; ++ left = wpa_ie_len - 8; ++ ++ ++ /* group_cipher */ ++ if (left >= WPA_SELECTOR_LEN) { ++ ++ *group_cipher = rtw_get_wpa_cipher_suite(pos); ++ ++ pos += WPA_SELECTOR_LEN; ++ left -= WPA_SELECTOR_LEN; ++ ++ } else if (left > 0) { ++ ++ return _FAIL; ++ } ++ ++ ++ /* pairwise_cipher */ ++ if (left >= 2) { ++ /* count = le16_to_cpu(*(u16*)pos); */ ++ count = RTW_GET_LE16(pos); ++ pos += 2; ++ left -= 2; ++ ++ if (count == 0 || left < count * WPA_SELECTOR_LEN) { ++ return _FAIL; ++ } ++ ++ for (i = 0; i < count; i++) { ++ *pairwise_cipher |= rtw_get_wpa_cipher_suite(pos); ++ ++ pos += WPA_SELECTOR_LEN; ++ left -= WPA_SELECTOR_LEN; ++ } ++ ++ } else if (left == 1) { ++ return _FAIL; ++ } ++ ++ if (is_8021x) { ++ if (left >= 6) { ++ pos += 2; ++ if (_rtw_memcmp(pos, SUITE_1X, 4) == 1) { ++ *is_8021x = 1; ++ } ++ } ++ } ++ ++ return ret; ++ ++} ++ ++int rtw_parse_wpa2_ie(u8 *rsn_ie, int rsn_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x) ++{ ++ int i, ret = _SUCCESS; ++ int left, count; ++ u8 *pos; ++ u8 SUITE_1X[4] = {0x00, 0x0f, 0xac, 0x01}; ++ ++ if (rsn_ie_len <= 0) { ++ /* No RSN IE - fail silently */ ++ return _FAIL; ++ } ++ ++ ++ if ((*rsn_ie != _WPA2_IE_ID_) || (*(rsn_ie + 1) != (u8)(rsn_ie_len - 2))) ++ return _FAIL; ++ ++ pos = rsn_ie; ++ pos += 4; ++ left = rsn_ie_len - 4; ++ ++ /* group_cipher */ ++ if (left >= RSN_SELECTOR_LEN) { ++ ++ *group_cipher = rtw_get_wpa2_cipher_suite(pos); ++ ++ pos += RSN_SELECTOR_LEN; ++ left -= RSN_SELECTOR_LEN; ++ ++ } else if (left > 0) { ++ return _FAIL; ++ } ++ ++ /* pairwise_cipher */ ++ if (left >= 2) { ++ /* count = le16_to_cpu(*(u16*)pos); */ ++ count = RTW_GET_LE16(pos); ++ pos += 2; ++ left -= 2; ++ ++ if (count == 0 || left < count * RSN_SELECTOR_LEN) { ++ return _FAIL; ++ } ++ ++ for (i = 0; i < count; i++) { ++ *pairwise_cipher |= rtw_get_wpa2_cipher_suite(pos); ++ ++ pos += RSN_SELECTOR_LEN; ++ left -= RSN_SELECTOR_LEN; ++ } ++ ++ } else if (left == 1) { ++ ++ return _FAIL; ++ } ++ ++ if (is_8021x) { ++ if (left >= 6) { ++ pos += 2; ++ if (_rtw_memcmp(pos, SUITE_1X, 4) == 1) { ++ *is_8021x = 1; ++ } ++ } ++ } ++ ++ return ret; ++ ++} ++ ++/* #ifdef CONFIG_WAPI_SUPPORT */ ++int rtw_get_wapi_ie(u8 *in_ie, uint in_len, u8 *wapi_ie, u16 *wapi_len) ++{ ++ int len = 0; ++ u8 authmode, i; ++ uint cnt; ++ u8 wapi_oui1[4] = {0x0, 0x14, 0x72, 0x01}; ++ u8 wapi_oui2[4] = {0x0, 0x14, 0x72, 0x02}; ++ ++ ++ if (wapi_len) ++ *wapi_len = 0; ++ ++ if (!in_ie || in_len <= 0) ++ return len; ++ ++ cnt = (_TIMESTAMP_ + _BEACON_ITERVAL_ + _CAPABILITY_); ++ ++ while (cnt < in_len) { ++ authmode = in_ie[cnt]; ++ ++ /* if(authmode==_WAPI_IE_) */ ++ if (authmode == _WAPI_IE_ && (_rtw_memcmp(&in_ie[cnt + 6], wapi_oui1, 4) == _TRUE || ++ _rtw_memcmp(&in_ie[cnt + 6], wapi_oui2, 4) == _TRUE)) { ++ if (wapi_ie) ++ _rtw_memcpy(wapi_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); ++ ++ if (wapi_len) ++ *wapi_len = in_ie[cnt + 1] + 2; ++ ++ cnt += in_ie[cnt + 1] + 2; /* get next */ ++ } else { ++ cnt += in_ie[cnt + 1] + 2; /* get next */ ++ } ++ } ++ ++ if (wapi_len) ++ len = *wapi_len; ++ ++ ++ return len; ++ ++} ++/* #endif */ ++ ++int rtw_get_sec_ie(u8 *in_ie, uint in_len, u8 *rsn_ie, u16 *rsn_len, u8 *wpa_ie, u16 *wpa_len) ++{ ++ u8 authmode, sec_idx, i; ++ u8 wpa_oui[4] = {0x0, 0x50, 0xf2, 0x01}; ++ uint cnt; ++ ++ ++ /* Search required WPA or WPA2 IE and copy to sec_ie[ ] */ ++ ++ cnt = (_TIMESTAMP_ + _BEACON_ITERVAL_ + _CAPABILITY_); ++ ++ sec_idx = 0; ++ ++ while (cnt < in_len) { ++ authmode = in_ie[cnt]; ++ ++ if ((authmode == _WPA_IE_ID_) && (_rtw_memcmp(&in_ie[cnt + 2], &wpa_oui[0], 4) == _TRUE)) { ++ ++ if (wpa_ie) ++ _rtw_memcpy(wpa_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); ++ ++ *wpa_len = in_ie[cnt + 1] + 2; ++ cnt += in_ie[cnt + 1] + 2; /* get next */ ++ } else { ++ if (authmode == _WPA2_IE_ID_) { ++ ++ if (rsn_ie) ++ _rtw_memcpy(rsn_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); ++ ++ *rsn_len = in_ie[cnt + 1] + 2; ++ cnt += in_ie[cnt + 1] + 2; /* get next */ ++ } else { ++ cnt += in_ie[cnt + 1] + 2; /* get next */ ++ } ++ } ++ ++ } ++ ++ ++ return *rsn_len + *wpa_len; ++ ++} ++ ++u8 rtw_is_wps_ie(u8 *ie_ptr, uint *wps_ielen) ++{ ++ u8 match = _FALSE; ++ u8 eid, wps_oui[4] = {0x0, 0x50, 0xf2, 0x04}; ++ ++ if (ie_ptr == NULL) ++ return match; ++ ++ eid = ie_ptr[0]; ++ ++ if ((eid == _WPA_IE_ID_) && (_rtw_memcmp(&ie_ptr[2], wps_oui, 4) == _TRUE)) { ++ /* RTW_INFO("==> found WPS_IE.....\n"); */ ++ *wps_ielen = ie_ptr[1] + 2; ++ match = _TRUE; ++ } ++ return match; ++} ++ ++u8 *rtw_get_wps_ie_from_scan_queue(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen, u8 frame_type) ++{ ++ u8 *wps = NULL; ++ ++ RTW_INFO("[%s] frame_type = %d\n", __FUNCTION__, frame_type); ++ switch (frame_type) { ++ case 1: ++ case 3: { ++ /* Beacon or Probe Response */ ++ wps = rtw_get_wps_ie(in_ie + _PROBERSP_IE_OFFSET_, in_len - _PROBERSP_IE_OFFSET_, wps_ie, wps_ielen); ++ break; ++ } ++ case 2: { ++ /* Probe Request */ ++ wps = rtw_get_wps_ie(in_ie + _PROBEREQ_IE_OFFSET_ , in_len - _PROBEREQ_IE_OFFSET_ , wps_ie, wps_ielen); ++ break; ++ } ++ } ++ return wps; ++} ++ ++/** ++ * rtw_get_wps_ie - Search WPS IE from a series of IEs ++ * @in_ie: Address of IEs to search ++ * @in_len: Length limit from in_ie ++ * @wps_ie: If not NULL and WPS IE is found, WPS IE will be copied to the buf starting from wps_ie ++ * @wps_ielen: If not NULL and WPS IE is found, will set to the length of the entire WPS IE ++ * ++ * Returns: The address of the WPS IE found, or NULL ++ */ ++u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen) ++{ ++ uint cnt; ++ u8 *wpsie_ptr = NULL; ++ u8 eid, wps_oui[4] = {0x00, 0x50, 0xf2, 0x04}; ++ ++ if (wps_ielen) ++ *wps_ielen = 0; ++ ++ if (!in_ie) { ++ rtw_warn_on(1); ++ return wpsie_ptr; ++ } ++ ++ if (in_len <= 0) ++ return wpsie_ptr; ++ ++ cnt = 0; ++ ++ while (cnt + 1 + 4 < in_len) { ++ eid = in_ie[cnt]; ++ ++ if (cnt + 1 + 4 >= MAX_IE_SZ) { ++ rtw_warn_on(1); ++ return NULL; ++ } ++ ++ if (eid == WLAN_EID_VENDOR_SPECIFIC && _rtw_memcmp(&in_ie[cnt + 2], wps_oui, 4) == _TRUE) { ++ wpsie_ptr = in_ie + cnt; ++ ++ if (wps_ie) ++ _rtw_memcpy(wps_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); ++ ++ if (wps_ielen) ++ *wps_ielen = in_ie[cnt + 1] + 2; ++ ++ break; ++ } else ++ cnt += in_ie[cnt + 1] + 2; ++ ++ } ++ ++ return wpsie_ptr; ++} ++ ++/** ++ * rtw_get_wps_attr - Search a specific WPS attribute from a given WPS IE ++ * @wps_ie: Address of WPS IE to search ++ * @wps_ielen: Length limit from wps_ie ++ * @target_attr_id: The attribute ID of WPS attribute to search ++ * @buf_attr: If not NULL and the WPS attribute is found, WPS attribute will be copied to the buf starting from buf_attr ++ * @len_attr: If not NULL and the WPS attribute is found, will set to the length of the entire WPS attribute ++ * ++ * Returns: the address of the specific WPS attribute found, or NULL ++ */ ++u8 *rtw_get_wps_attr(u8 *wps_ie, uint wps_ielen, u16 target_attr_id , u8 *buf_attr, u32 *len_attr) ++{ ++ u8 *attr_ptr = NULL; ++ u8 *target_attr_ptr = NULL; ++ u8 wps_oui[4] = {0x00, 0x50, 0xF2, 0x04}; ++ ++ if (len_attr) ++ *len_attr = 0; ++ ++ if ((wps_ie[0] != _VENDOR_SPECIFIC_IE_) || ++ (_rtw_memcmp(wps_ie + 2, wps_oui , 4) != _TRUE)) ++ return attr_ptr; ++ ++ /* 6 = 1(Element ID) + 1(Length) + 4(WPS OUI) */ ++ attr_ptr = wps_ie + 6; /* goto first attr */ ++ ++ while (attr_ptr - wps_ie < wps_ielen) { ++ /* 4 = 2(Attribute ID) + 2(Length) */ ++ u16 attr_id = RTW_GET_BE16(attr_ptr); ++ u16 attr_data_len = RTW_GET_BE16(attr_ptr + 2); ++ u16 attr_len = attr_data_len + 4; ++ ++ /* RTW_INFO("%s attr_ptr:%p, id:%u, length:%u\n", __FUNCTION__, attr_ptr, attr_id, attr_data_len); */ ++ if (attr_id == target_attr_id) { ++ target_attr_ptr = attr_ptr; ++ ++ if (buf_attr) ++ _rtw_memcpy(buf_attr, attr_ptr, attr_len); ++ ++ if (len_attr) ++ *len_attr = attr_len; ++ ++ break; ++ } else { ++ attr_ptr += attr_len; /* goto next */ ++ } ++ ++ } ++ ++ return target_attr_ptr; ++} ++ ++/** ++ * rtw_get_wps_attr_content - Search a specific WPS attribute content from a given WPS IE ++ * @wps_ie: Address of WPS IE to search ++ * @wps_ielen: Length limit from wps_ie ++ * @target_attr_id: The attribute ID of WPS attribute to search ++ * @buf_content: If not NULL and the WPS attribute is found, WPS attribute content will be copied to the buf starting from buf_content ++ * @len_content: If not NULL and the WPS attribute is found, will set to the length of the WPS attribute content ++ * ++ * Returns: the address of the specific WPS attribute content found, or NULL ++ */ ++u8 *rtw_get_wps_attr_content(u8 *wps_ie, uint wps_ielen, u16 target_attr_id , u8 *buf_content, uint *len_content) ++{ ++ u8 *attr_ptr; ++ u32 attr_len; ++ ++ if (len_content) ++ *len_content = 0; ++ ++ attr_ptr = rtw_get_wps_attr(wps_ie, wps_ielen, target_attr_id, NULL, &attr_len); ++ ++ if (attr_ptr && attr_len) { ++ if (buf_content) ++ _rtw_memcpy(buf_content, attr_ptr + 4, attr_len - 4); ++ ++ if (len_content) ++ *len_content = attr_len - 4; ++ ++ return attr_ptr + 4; ++ } ++ ++ return NULL; ++} ++ ++static int rtw_ieee802_11_parse_vendor_specific(u8 *pos, uint elen, ++ struct rtw_ieee802_11_elems *elems, ++ int show_errors) ++{ ++ unsigned int oui; ++ ++ /* first 3 bytes in vendor specific information element are the IEEE ++ * OUI of the vendor. The following byte is used a vendor specific ++ * sub-type. */ ++ if (elen < 4) { ++ if (show_errors) { ++ RTW_INFO("short vendor specific " ++ "information element ignored (len=%lu)\n", ++ (unsigned long) elen); ++ } ++ return -1; ++ } ++ ++ oui = RTW_GET_BE24(pos); ++ switch (oui) { ++ case OUI_MICROSOFT: ++ /* Microsoft/Wi-Fi information elements are further typed and ++ * subtyped */ ++ switch (pos[3]) { ++ case 1: ++ /* Microsoft OUI (00:50:F2) with OUI Type 1: ++ * real WPA information element */ ++ elems->wpa_ie = pos; ++ elems->wpa_ie_len = elen; ++ break; ++ case WME_OUI_TYPE: /* this is a Wi-Fi WME info. element */ ++ if (elen < 5) { ++ RTW_DBG("short WME " ++ "information element ignored " ++ "(len=%lu)\n", ++ (unsigned long) elen); ++ return -1; ++ } ++ switch (pos[4]) { ++ case WME_OUI_SUBTYPE_INFORMATION_ELEMENT: ++ case WME_OUI_SUBTYPE_PARAMETER_ELEMENT: ++ elems->wme = pos; ++ elems->wme_len = elen; ++ break; ++ case WME_OUI_SUBTYPE_TSPEC_ELEMENT: ++ elems->wme_tspec = pos; ++ elems->wme_tspec_len = elen; ++ break; ++ default: ++ RTW_DBG("unknown WME " ++ "information element ignored " ++ "(subtype=%d len=%lu)\n", ++ pos[4], (unsigned long) elen); ++ return -1; ++ } ++ break; ++ case 4: ++ /* Wi-Fi Protected Setup (WPS) IE */ ++ elems->wps_ie = pos; ++ elems->wps_ie_len = elen; ++ break; ++ default: ++ RTW_DBG("Unknown Microsoft " ++ "information element ignored " ++ "(type=%d len=%lu)\n", ++ pos[3], (unsigned long) elen); ++ return -1; ++ } ++ break; ++ ++ case OUI_BROADCOM: ++ switch (pos[3]) { ++ case VENDOR_HT_CAPAB_OUI_TYPE: ++ elems->vendor_ht_cap = pos; ++ elems->vendor_ht_cap_len = elen; ++ break; ++ default: ++ RTW_DBG("Unknown Broadcom " ++ "information element ignored " ++ "(type=%d len=%lu)\n", ++ pos[3], (unsigned long) elen); ++ return -1; ++ } ++ break; ++ ++ default: ++ RTW_DBG("unknown vendor specific information " ++ "element ignored (vendor OUI %02x:%02x:%02x " ++ "len=%lu)\n", ++ pos[0], pos[1], pos[2], (unsigned long) elen); ++ return -1; ++ } ++ ++ return 0; ++ ++} ++ ++/** ++ * ieee802_11_parse_elems - Parse information elements in management frames ++ * @start: Pointer to the start of IEs ++ * @len: Length of IE buffer in octets ++ * @elems: Data structure for parsed elements ++ * @show_errors: Whether to show parsing errors in debug log ++ * Returns: Parsing result ++ */ ++ParseRes rtw_ieee802_11_parse_elems(u8 *start, uint len, ++ struct rtw_ieee802_11_elems *elems, ++ int show_errors) ++{ ++ uint left = len; ++ u8 *pos = start; ++ int unknown = 0; ++ ++ _rtw_memset(elems, 0, sizeof(*elems)); ++ ++ while (left >= 2) { ++ u8 id, elen; ++ ++ id = *pos++; ++ elen = *pos++; ++ left -= 2; ++ ++ if (elen > left) { ++ if (show_errors) { ++ RTW_INFO("IEEE 802.11 element " ++ "parse failed (id=%d elen=%d " ++ "left=%lu)\n", ++ id, elen, (unsigned long) left); ++ } ++ return ParseFailed; ++ } ++ ++ switch (id) { ++ case WLAN_EID_SSID: ++ elems->ssid = pos; ++ elems->ssid_len = elen; ++ break; ++ case WLAN_EID_SUPP_RATES: ++ elems->supp_rates = pos; ++ elems->supp_rates_len = elen; ++ break; ++ case WLAN_EID_FH_PARAMS: ++ elems->fh_params = pos; ++ elems->fh_params_len = elen; ++ break; ++ case WLAN_EID_DS_PARAMS: ++ elems->ds_params = pos; ++ elems->ds_params_len = elen; ++ break; ++ case WLAN_EID_CF_PARAMS: ++ elems->cf_params = pos; ++ elems->cf_params_len = elen; ++ break; ++ case WLAN_EID_TIM: ++ elems->tim = pos; ++ elems->tim_len = elen; ++ break; ++ case WLAN_EID_IBSS_PARAMS: ++ elems->ibss_params = pos; ++ elems->ibss_params_len = elen; ++ break; ++ case WLAN_EID_CHALLENGE: ++ elems->challenge = pos; ++ elems->challenge_len = elen; ++ break; ++ case WLAN_EID_ERP_INFO: ++ elems->erp_info = pos; ++ elems->erp_info_len = elen; ++ break; ++ case WLAN_EID_EXT_SUPP_RATES: ++ elems->ext_supp_rates = pos; ++ elems->ext_supp_rates_len = elen; ++ break; ++ case WLAN_EID_VENDOR_SPECIFIC: ++ if (rtw_ieee802_11_parse_vendor_specific(pos, elen, ++ elems, ++ show_errors)) ++ unknown++; ++ break; ++ case WLAN_EID_RSN: ++ elems->rsn_ie = pos; ++ elems->rsn_ie_len = elen; ++ break; ++ case WLAN_EID_PWR_CAPABILITY: ++ elems->power_cap = pos; ++ elems->power_cap_len = elen; ++ break; ++ case WLAN_EID_SUPPORTED_CHANNELS: ++ elems->supp_channels = pos; ++ elems->supp_channels_len = elen; ++ break; ++ case WLAN_EID_MOBILITY_DOMAIN: ++ elems->mdie = pos; ++ elems->mdie_len = elen; ++ break; ++ case WLAN_EID_FAST_BSS_TRANSITION: ++ elems->ftie = pos; ++ elems->ftie_len = elen; ++ break; ++ case WLAN_EID_TIMEOUT_INTERVAL: ++ elems->timeout_int = pos; ++ elems->timeout_int_len = elen; ++ break; ++ case WLAN_EID_HT_CAP: ++ elems->ht_capabilities = pos; ++ elems->ht_capabilities_len = elen; ++ break; ++ case WLAN_EID_HT_OPERATION: ++ elems->ht_operation = pos; ++ elems->ht_operation_len = elen; ++ break; ++ case WLAN_EID_VHT_CAPABILITY: ++ elems->vht_capabilities = pos; ++ elems->vht_capabilities_len = elen; ++ break; ++ case WLAN_EID_VHT_OPERATION: ++ elems->vht_operation = pos; ++ elems->vht_operation_len = elen; ++ break; ++ case WLAN_EID_VHT_OP_MODE_NOTIFY: ++ elems->vht_op_mode_notify = pos; ++ elems->vht_op_mode_notify_len = elen; ++ break; ++ default: ++ unknown++; ++ if (!show_errors) ++ break; ++ RTW_DBG("IEEE 802.11 element parse " ++ "ignored unknown element (id=%d elen=%d)\n", ++ id, elen); ++ break; ++ } ++ ++ left -= elen; ++ pos += elen; ++ } ++ ++ if (left) ++ return ParseFailed; ++ ++ return unknown ? ParseUnknown : ParseOK; ++ ++} ++ ++static u8 key_char2num(u8 ch); ++static u8 key_char2num(u8 ch) ++{ ++ if ((ch >= '0') && (ch <= '9')) ++ return ch - '0'; ++ else if ((ch >= 'a') && (ch <= 'f')) ++ return ch - 'a' + 10; ++ else if ((ch >= 'A') && (ch <= 'F')) ++ return ch - 'A' + 10; ++ else ++ return 0xff; ++} ++ ++u8 str_2char2num(u8 hch, u8 lch); ++u8 str_2char2num(u8 hch, u8 lch) ++{ ++ return (key_char2num(hch) * 10) + key_char2num(lch); ++} ++ ++u8 key_2char2num(u8 hch, u8 lch); ++u8 key_2char2num(u8 hch, u8 lch) ++{ ++ return (key_char2num(hch) << 4) | key_char2num(lch); ++} ++ ++void macstr2num(u8 *dst, u8 *src); ++void macstr2num(u8 *dst, u8 *src) ++{ ++ int jj, kk; ++ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) ++ dst[jj] = key_2char2num(src[kk], src[kk + 1]); ++} ++ ++u8 convert_ip_addr(u8 hch, u8 mch, u8 lch) ++{ ++ return (key_char2num(hch) * 100) + (key_char2num(mch) * 10) + key_char2num(lch); ++} ++ ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++#define MAC_ADDRESS_LEN 12 ++ ++int rtw_get_mac_addr_intel(unsigned char *buf) ++{ ++ int ret = 0; ++ int i; ++ struct file *fp = NULL; ++ mm_segment_t oldfs; ++ unsigned char c_mac[MAC_ADDRESS_LEN]; ++ char fname[] = "/config/wifi/mac.txt"; ++ int jj, kk; ++ ++ RTW_INFO("%s Enter\n", __FUNCTION__); ++ ++ ret = rtw_retrieve_from_file(fname, c_mac, MAC_ADDRESS_LEN); ++ if (ret < MAC_ADDRESS_LEN) ++ return -1; ++ ++ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 2) ++ buf[jj] = key_2char2num(c_mac[kk], c_mac[kk + 1]); ++ ++ RTW_INFO("%s: read from file mac address: "MAC_FMT"\n", ++ __FUNCTION__, MAC_ARG(buf)); ++ ++ return 0; ++} ++#endif /* CONFIG_PLATFORM_INTEL_BYT */ ++ ++/* ++ * Description: ++ * rtw_check_invalid_mac_address: ++ * This is only used for checking mac address valid or not. ++ * ++ * Input: ++ * adapter: mac_address pointer. ++ * check_local_bit: check locally bit or not. ++ * ++ * Output: ++ * _TRUE: The mac address is invalid. ++ * _FALSE: The mac address is valid. ++ * ++ * Auther: Isaac.Li ++ */ ++u8 rtw_check_invalid_mac_address(u8 *mac_addr, u8 check_local_bit) ++{ ++ u8 null_mac_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; ++ u8 multi_mac_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ u8 res = _FALSE; ++ ++ if (_rtw_memcmp(mac_addr, null_mac_addr, ETH_ALEN)) { ++ res = _TRUE; ++ goto func_exit; ++ } ++ ++ if (_rtw_memcmp(mac_addr, multi_mac_addr, ETH_ALEN)) { ++ res = _TRUE; ++ goto func_exit; ++ } ++ ++ if (mac_addr[0] & BIT0) { ++ res = _TRUE; ++ goto func_exit; ++ } ++ ++ if (check_local_bit == _TRUE) { ++ if (mac_addr[0] & BIT1) { ++ res = _TRUE; ++ goto func_exit; ++ } ++ } ++ ++func_exit: ++ return res; ++} ++ ++extern char *rtw_initmac; ++/** ++ * rtw_macaddr_cfg - Decide the mac address used ++ * @out: buf to store mac address decided ++ * @hw_mac_addr: mac address from efuse/epprom ++ */ ++void rtw_macaddr_cfg(u8 *out, const u8 *hw_mac_addr) ++{ ++#define DEFAULT_RANDOM_MACADDR 1 ++ u8 mac[ETH_ALEN]; ++ ++ if (out == NULL) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ /* Users specify the mac address */ ++ if (rtw_initmac) { ++ int jj, kk; ++ ++ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) ++ mac[jj] = key_2char2num(rtw_initmac[kk], rtw_initmac[kk + 1]); ++ ++ goto err_chk; ++ } ++ ++ /* platform specified */ ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++ if (rtw_get_mac_addr_intel(mac) == 0) ++ goto err_chk; ++#endif ++ ++ /* Use the mac address stored in the Efuse */ ++ if (hw_mac_addr) { ++ _rtw_memcpy(mac, hw_mac_addr, ETH_ALEN); ++ goto err_chk; ++ } ++ ++err_chk: ++ if (rtw_check_invalid_mac_address(mac, _TRUE) == _TRUE) { ++#if DEFAULT_RANDOM_MACADDR ++ RTW_ERR("invalid mac addr:"MAC_FMT", assign random MAC\n", MAC_ARG(mac)); ++ *((u32 *)(&mac[2])) = rtw_random32(); ++ mac[0] = 0x00; ++ mac[1] = 0xe0; ++ mac[2] = 0x4c; ++#else ++ RTW_ERR("invalid mac addr:"MAC_FMT", assign default one\n", MAC_ARG(mac)); ++ mac[0] = 0x00; ++ mac[1] = 0xe0; ++ mac[2] = 0x4c; ++ mac[3] = 0x87; ++ mac[4] = 0x00; ++ mac[5] = 0x00; ++#endif ++ } ++ ++ _rtw_memcpy(out, mac, ETH_ALEN); ++ RTW_INFO("%s mac addr:"MAC_FMT"\n", __func__, MAC_ARG(out)); ++} ++ ++#ifdef CONFIG_80211N_HT ++void dump_ht_cap_ie_content(void *sel, u8 *buf, u32 buf_len) ++{ ++ if (buf_len != 26) { ++ RTW_PRINT_SEL(sel, "Invalid HT capability IE len:%d != %d\n", buf_len, 26); ++ return; ++ } ++ ++ RTW_PRINT_SEL(sel, "HT Capabilities Info:%02x%02x\n", *(buf), *(buf + 1)); ++ RTW_PRINT_SEL(sel, "A-MPDU Parameters:"HT_AMPDU_PARA_FMT"\n" ++ , HT_AMPDU_PARA_ARG(HT_CAP_ELE_AMPDU_PARA(buf))); ++ RTW_PRINT_SEL(sel, "Supported MCS Set:"HT_SUP_MCS_SET_FMT"\n" ++ , HT_SUP_MCS_SET_ARG(HT_CAP_ELE_SUP_MCS_SET(buf))); ++} ++ ++void dump_ht_cap_ie(void *sel, u8 *ie, u32 ie_len) ++{ ++ u8 *pos = (u8 *)ie; ++ u16 id; ++ u16 len; ++ ++ u8 *ht_cap_ie; ++ sint ht_cap_ielen; ++ ++ ht_cap_ie = rtw_get_ie(ie, _HT_CAPABILITY_IE_, &ht_cap_ielen, ie_len); ++ if (!ie || ht_cap_ie != ie) ++ return; ++ ++ dump_ht_cap_ie_content(sel, ht_cap_ie + 2, ht_cap_ielen); ++} ++#endif /* CONFIG_80211N_HT */ ++ ++void dump_ies(void *sel, u8 *buf, u32 buf_len) ++{ ++ u8 *pos = (u8 *)buf; ++ u8 id, len; ++ ++ while (pos - buf + 1 < buf_len) { ++ id = *pos; ++ len = *(pos + 1); ++ ++ RTW_PRINT_SEL(sel, "%s ID:%u, LEN:%u\n", __FUNCTION__, id, len); ++#ifdef CONFIG_80211N_HT ++ dump_ht_cap_ie(sel, pos, len + 2); ++#endif ++ dump_wps_ie(sel, pos, len + 2); ++#ifdef CONFIG_P2P ++ dump_p2p_ie(sel, pos, len + 2); ++#ifdef CONFIG_WFD ++ dump_wfd_ie(sel, pos, len + 2); ++#endif ++#endif ++ ++ pos += (2 + len); ++ } ++} ++ ++void dump_wps_ie(void *sel, u8 *ie, u32 ie_len) ++{ ++ u8 *pos = (u8 *)ie; ++ u16 id; ++ u16 len; ++ ++ u8 *wps_ie; ++ uint wps_ielen; ++ ++ wps_ie = rtw_get_wps_ie(ie, ie_len, NULL, &wps_ielen); ++ if (wps_ie != ie || wps_ielen == 0) ++ return; ++ ++ pos += 6; ++ while (pos - ie + 4 <= ie_len) { ++ id = RTW_GET_BE16(pos); ++ len = RTW_GET_BE16(pos + 2); ++ ++ RTW_PRINT_SEL(sel, "%s ID:0x%04x, LEN:%u%s\n", __func__, id, len ++ , ((pos - ie + 4 + len) <= ie_len) ? "" : "(exceed ie_len)"); ++ ++ pos += (4 + len); ++ } ++} ++ ++/** ++ * rtw_ies_get_chbw - get operation ch, bw, offset from IEs of BSS. ++ * @ies: pointer of the first tlv IE ++ * @ies_len: length of @ies ++ * @ch: pointer of ch, used as output ++ * @bw: pointer of bw, used as output ++ * @offset: pointer of offset, used as output ++ */ ++void rtw_ies_get_chbw(u8 *ies, int ies_len, u8 *ch, u8 *bw, u8 *offset) ++{ ++ u8 *p; ++ int ie_len; ++ ++ *ch = 0; ++ *bw = CHANNEL_WIDTH_20; ++ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ p = rtw_get_ie(ies, _DSSET_IE_, &ie_len, ies_len); ++ if (p && ie_len > 0) ++ *ch = *(p + 2); ++ ++#ifdef CONFIG_80211N_HT ++ { ++ u8 *ht_cap_ie, *ht_op_ie; ++ int ht_cap_ielen, ht_op_ielen; ++ ++ ht_cap_ie = rtw_get_ie(ies, EID_HTCapability, &ht_cap_ielen, ies_len); ++ if (ht_cap_ie && ht_cap_ielen) { ++ if (GET_HT_CAP_ELE_CHL_WIDTH(ht_cap_ie + 2)) ++ *bw = CHANNEL_WIDTH_40; ++ } ++ ++ ht_op_ie = rtw_get_ie(ies, EID_HTInfo, &ht_op_ielen, ies_len); ++ if (ht_op_ie && ht_op_ielen) { ++ if (*ch == 0) ++ *ch = GET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2); ++ else if (*ch != 0 && *ch != GET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2)) { ++ RTW_INFO("%s ch inconsistent, DSSS:%u, HT primary:%u\n" ++ , __func__, *ch, GET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2)); ++ } ++ ++ if (!GET_HT_OP_ELE_STA_CHL_WIDTH(ht_op_ie + 2)) ++ *bw = CHANNEL_WIDTH_20; ++ ++ if (*bw == CHANNEL_WIDTH_40) { ++ switch (GET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2)) { ++ case SCA: ++ *offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ break; ++ case SCB: ++ *offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ } ++ } ++ } ++ } ++#endif /* CONFIG_80211N_HT */ ++#ifdef CONFIG_80211AC_VHT ++ { ++ u8 *vht_op_ie; ++ int vht_op_ielen; ++ ++ vht_op_ie = rtw_get_ie(ies, EID_VHTOperation, &vht_op_ielen, ies_len); ++ if (vht_op_ie && vht_op_ielen) { ++ /* enable VHT 80 before check enable HT40 or not */ ++ if (GET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2) >= 1) { ++ /* for HT40, enable VHT80 */ ++ if (*bw == CHANNEL_WIDTH_40) ++ *bw = CHANNEL_WIDTH_80; ++ /* for HT20, enable VHT20 */ ++ else if (*bw == CHANNEL_WIDTH_20) { ++ /* modify VHT OP IE */ ++ SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2, 0); ++ /* reset to 0 for VHT20 */ ++ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op_ie + 2, 0); ++ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op_ie + 2, 0); ++ } ++ } else { ++ /* ++ VHT OP WIDTH = 0 under HT20/HT40 ++ if REGSTY_BW_5G(pregistrypriv) < CHANNEL_WIDTH_80 in rtw_build_vht_operation_ie ++ */ ++ } ++ } ++ } ++#endif ++} ++ ++void rtw_bss_get_chbw(WLAN_BSSID_EX *bss, u8 *ch, u8 *bw, u8 *offset) ++{ ++ rtw_ies_get_chbw(bss->IEs + sizeof(NDIS_802_11_FIXED_IEs) ++ , bss->IELength - sizeof(NDIS_802_11_FIXED_IEs) ++ , ch, bw, offset); ++ ++ if (*ch == 0) ++ *ch = bss->Configuration.DSConfig; ++ else if (*ch != bss->Configuration.DSConfig) { ++ RTW_INFO("inconsistent ch - ies:%u bss->Configuration.DSConfig:%u\n" ++ , *ch, bss->Configuration.DSConfig); ++ *ch = bss->Configuration.DSConfig; ++ rtw_warn_on(1); ++ } ++} ++ ++/** ++ * rtw_is_chbw_grouped - test if the two ch settings can be grouped together ++ * @ch_a: ch of set a ++ * @bw_a: bw of set a ++ * @offset_a: offset of set a ++ * @ch_b: ch of set b ++ * @bw_b: bw of set b ++ * @offset_b: offset of set b ++ */ ++bool rtw_is_chbw_grouped(u8 ch_a, u8 bw_a, u8 offset_a ++ , u8 ch_b, u8 bw_b, u8 offset_b) ++{ ++ bool is_grouped = _FALSE; ++ ++ if (ch_a != ch_b) { ++ /* ch is different */ ++ goto exit; ++ } else if ((bw_a == CHANNEL_WIDTH_40 || bw_a == CHANNEL_WIDTH_80) ++ && (bw_b == CHANNEL_WIDTH_40 || bw_b == CHANNEL_WIDTH_80) ++ ) { ++ if (offset_a != offset_b) ++ goto exit; ++ } ++ ++ is_grouped = _TRUE; ++ ++exit: ++ return is_grouped; ++} ++ ++/** ++ * rtw_sync_chbw - obey g_ch, adjust g_bw, g_offset, bw, offset ++ * @req_ch: pointer of the request ch, may be modified further ++ * @req_bw: pointer of the request bw, may be modified further ++ * @req_offset: pointer of the request offset, may be modified further ++ * @g_ch: pointer of the ongoing group ch ++ * @g_bw: pointer of the ongoing group bw, may be modified further ++ * @g_offset: pointer of the ongoing group offset, may be modified further ++ */ ++void rtw_sync_chbw(u8 *req_ch, u8 *req_bw, u8 *req_offset ++ , u8 *g_ch, u8 *g_bw, u8 *g_offset) ++{ ++ ++ *req_ch = *g_ch; ++ ++ if (*req_bw == CHANNEL_WIDTH_80 && *g_ch <= 14) { ++ /*2.4G ch, downgrade to 40Mhz */ ++ *req_bw = CHANNEL_WIDTH_40; ++ } ++ ++ switch (*req_bw) { ++ case CHANNEL_WIDTH_80: ++ if (*g_bw == CHANNEL_WIDTH_40 || *g_bw == CHANNEL_WIDTH_80) ++ *req_offset = *g_offset; ++ else if (*g_bw == CHANNEL_WIDTH_20) ++ *req_offset = rtw_get_offset_by_ch(*req_ch); ++ ++ if (*req_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) { ++ RTW_ERR("%s req 80MHz BW without offset, down to 20MHz\n", __func__); ++ rtw_warn_on(1); ++ *req_bw = CHANNEL_WIDTH_20; ++ } ++ break; ++ case CHANNEL_WIDTH_40: ++ if (*g_bw == CHANNEL_WIDTH_40 || *g_bw == CHANNEL_WIDTH_80) ++ *req_offset = *g_offset; ++ else if (*g_bw == CHANNEL_WIDTH_20) ++ *req_offset = rtw_get_offset_by_ch(*req_ch); ++ ++ if (*req_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) { ++ RTW_ERR("%s req 40MHz BW without offset, down to 20MHz\n", __func__); ++ rtw_warn_on(1); ++ *req_bw = CHANNEL_WIDTH_20; ++ } ++ break; ++ case CHANNEL_WIDTH_20: ++ *req_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ default: ++ RTW_ERR("%s req unsupported BW:%u\n", __func__, *req_bw); ++ rtw_warn_on(1); ++ } ++ ++ if (*req_bw > *g_bw) { ++ *g_bw = *req_bw; ++ *g_offset = *req_offset; ++ } ++} ++ ++/** ++ * rtw_get_p2p_merged_len - Get merged ie length from muitiple p2p ies. ++ * @in_ie: Pointer of the first p2p ie ++ * @in_len: Total len of muiltiple p2p ies ++ * Returns: Length of merged p2p ie length ++ */ ++u32 rtw_get_p2p_merged_ies_len(u8 *in_ie, u32 in_len) ++{ ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 OUI[4] = { 0x50, 0x6f, 0x9a, 0x09 }; ++ int i = 0; ++ int j = 0, len = 0; ++ ++ while (i < in_len) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(in_ie + i); ++ ++ if (pIE->ElementID == _VENDOR_SPECIFIC_IE_ && _rtw_memcmp(pIE->data, OUI, 4)) { ++ len += pIE->Length - 4; /* 4 is P2P OUI length, don't count it in this loop */ ++ } ++ ++ i += (pIE->Length + 2); ++ } ++ ++ return len + 4; /* Append P2P OUI length at last. */ ++} ++ ++/** ++ * rtw_p2p_merge_ies - Merge muitiple p2p ies into one ++ * @in_ie: Pointer of the first p2p ie ++ * @in_len: Total len of muiltiple p2p ies ++ * @merge_ie: Pointer of merged ie ++ * Returns: Length of merged p2p ie ++ */ ++int rtw_p2p_merge_ies(u8 *in_ie, u32 in_len, u8 *merge_ie) ++{ ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 len = 0; ++ u8 OUI[4] = { 0x50, 0x6f, 0x9a, 0x09 }; ++ u8 ELOUI[6] = { 0xDD, 0x00, 0x50, 0x6f, 0x9a, 0x09 }; /* EID;Len;OUI, Len would copy at the end of function */ ++ int i = 0; ++ ++ if (merge_ie != NULL) { ++ /* Set first P2P OUI */ ++ _rtw_memcpy(merge_ie, ELOUI, 6); ++ merge_ie += 6; ++ ++ while (i < in_len) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(in_ie + i); ++ ++ /* Take out the rest of P2P OUIs */ ++ if (pIE->ElementID == _VENDOR_SPECIFIC_IE_ && _rtw_memcmp(pIE->data, OUI, 4)) { ++ _rtw_memcpy(merge_ie, pIE->data + 4, pIE->Length - 4); ++ len += pIE->Length - 4; ++ merge_ie += pIE->Length - 4; ++ } ++ ++ i += (pIE->Length + 2); ++ } ++ ++ return len + 4; /* 4 is for P2P OUI */ ++ ++ } ++ ++ return 0; ++} ++ ++void dump_p2p_ie(void *sel, u8 *ie, u32 ie_len) ++{ ++ u8 *pos = (u8 *)ie; ++ u8 id; ++ u16 len; ++ ++ u8 *p2p_ie; ++ uint p2p_ielen; ++ ++ p2p_ie = rtw_get_p2p_ie(ie, ie_len, NULL, &p2p_ielen); ++ if (p2p_ie != ie || p2p_ielen == 0) ++ return; ++ ++ pos += 6; ++ while (pos - ie + 3 <= ie_len) { ++ id = *pos; ++ len = RTW_GET_LE16(pos + 1); ++ ++ RTW_PRINT_SEL(sel, "%s ID:%u, LEN:%u%s\n", __func__, id, len ++ , ((pos - ie + 3 + len) <= ie_len) ? "" : "(exceed ie_len)"); ++ ++ pos += (3 + len); ++ } ++} ++ ++/** ++ * rtw_get_p2p_ie - Search P2P IE from a series of IEs ++ * @in_ie: Address of IEs to search ++ * @in_len: Length limit from in_ie ++ * @p2p_ie: If not NULL and P2P IE is found, P2P IE will be copied to the buf starting from p2p_ie ++ * @p2p_ielen: If not NULL and P2P IE is found, will set to the length of the entire P2P IE ++ * ++ * Returns: The address of the P2P IE found, or NULL ++ */ ++u8 *rtw_get_p2p_ie(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen) ++{ ++ uint cnt; ++ u8 *p2p_ie_ptr = NULL; ++ u8 eid, p2p_oui[4] = {0x50, 0x6F, 0x9A, 0x09}; ++ ++ if (p2p_ielen) ++ *p2p_ielen = 0; ++ ++ if (!in_ie || in_len < 0) { ++ rtw_warn_on(1); ++ return p2p_ie_ptr; ++ } ++ ++ if (in_len <= 0) ++ return p2p_ie_ptr; ++ ++ cnt = 0; ++ ++ while (cnt + 1 + 4 < in_len) { ++ eid = in_ie[cnt]; ++ ++ if (cnt + 1 + 4 >= MAX_IE_SZ) { ++ rtw_warn_on(1); ++ return NULL; ++ } ++ ++ if (eid == WLAN_EID_VENDOR_SPECIFIC && _rtw_memcmp(&in_ie[cnt + 2], p2p_oui, 4) == _TRUE) { ++ p2p_ie_ptr = in_ie + cnt; ++ ++ if (p2p_ie) ++ _rtw_memcpy(p2p_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); ++ ++ if (p2p_ielen) ++ *p2p_ielen = in_ie[cnt + 1] + 2; ++ ++ break; ++ } else ++ cnt += in_ie[cnt + 1] + 2; ++ ++ } ++ ++ return p2p_ie_ptr; ++} ++ ++/** ++ * rtw_get_p2p_attr - Search a specific P2P attribute from a given P2P IE ++ * @p2p_ie: Address of P2P IE to search ++ * @p2p_ielen: Length limit from p2p_ie ++ * @target_attr_id: The attribute ID of P2P attribute to search ++ * @buf_attr: If not NULL and the P2P attribute is found, P2P attribute will be copied to the buf starting from buf_attr ++ * @len_attr: If not NULL and the P2P attribute is found, will set to the length of the entire P2P attribute ++ * ++ * Returns: the address of the specific WPS attribute found, or NULL ++ */ ++u8 *rtw_get_p2p_attr(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id , u8 *buf_attr, u32 *len_attr) ++{ ++ u8 *attr_ptr = NULL; ++ u8 *target_attr_ptr = NULL; ++ u8 p2p_oui[4] = {0x50, 0x6F, 0x9A, 0x09}; ++ ++ if (len_attr) ++ *len_attr = 0; ++ ++ if (!p2p_ie ++ || p2p_ielen <= 6 ++ || (p2p_ie[0] != WLAN_EID_VENDOR_SPECIFIC) ++ || (_rtw_memcmp(p2p_ie + 2, p2p_oui, 4) != _TRUE)) ++ return attr_ptr; ++ ++ /* 6 = 1(Element ID) + 1(Length) + 3 (OUI) + 1(OUI Type) */ ++ attr_ptr = p2p_ie + 6; /* goto first attr */ ++ ++ while ((attr_ptr - p2p_ie + 3) <= p2p_ielen) { ++ /* 3 = 1(Attribute ID) + 2(Length) */ ++ u8 attr_id = *attr_ptr; ++ u16 attr_data_len = RTW_GET_LE16(attr_ptr + 1); ++ u16 attr_len = attr_data_len + 3; ++ ++ if (0) ++ RTW_INFO("%s attr_ptr:%p, id:%u, length:%u\n", __func__, attr_ptr, attr_id, attr_data_len); ++ ++ if ((attr_ptr - p2p_ie + attr_len) > p2p_ielen) ++ break; ++ ++ if (attr_id == target_attr_id) { ++ target_attr_ptr = attr_ptr; ++ ++ if (buf_attr) ++ _rtw_memcpy(buf_attr, attr_ptr, attr_len); ++ ++ if (len_attr) ++ *len_attr = attr_len; ++ ++ break; ++ } else ++ attr_ptr += attr_len; ++ } ++ ++ return target_attr_ptr; ++} ++ ++/** ++ * rtw_get_p2p_attr_content - Search a specific P2P attribute content from a given P2P IE ++ * @p2p_ie: Address of P2P IE to search ++ * @p2p_ielen: Length limit from p2p_ie ++ * @target_attr_id: The attribute ID of P2P attribute to search ++ * @buf_content: If not NULL and the P2P attribute is found, P2P attribute content will be copied to the buf starting from buf_content ++ * @len_content: If not NULL and the P2P attribute is found, will set to the length of the P2P attribute content ++ * ++ * Returns: the address of the specific P2P attribute content found, or NULL ++ */ ++u8 *rtw_get_p2p_attr_content(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id , u8 *buf_content, uint *len_content) ++{ ++ u8 *attr_ptr; ++ u32 attr_len; ++ ++ if (len_content) ++ *len_content = 0; ++ ++ attr_ptr = rtw_get_p2p_attr(p2p_ie, p2p_ielen, target_attr_id, NULL, &attr_len); ++ ++ if (attr_ptr && attr_len) { ++ if (buf_content) ++ _rtw_memcpy(buf_content, attr_ptr + 3, attr_len - 3); ++ ++ if (len_content) ++ *len_content = attr_len - 3; ++ ++ return attr_ptr + 3; ++ } ++ ++ return NULL; ++} ++ ++u32 rtw_set_p2p_attr_content(u8 *pbuf, u8 attr_id, u16 attr_len, u8 *pdata_attr) ++{ ++ u32 a_len; ++ ++ *pbuf = attr_id; ++ ++ /* *(u16*)(pbuf + 1) = cpu_to_le16(attr_len); */ ++ RTW_PUT_LE16(pbuf + 1, attr_len); ++ ++ if (pdata_attr) ++ _rtw_memcpy(pbuf + 3, pdata_attr, attr_len); ++ ++ a_len = attr_len + 3; ++ ++ return a_len; ++} ++ ++uint rtw_del_p2p_ie(u8 *ies, uint ies_len_ori, const char *msg) ++{ ++#define DBG_DEL_P2P_IE 0 ++ ++ u8 *target_ie; ++ u32 target_ie_len; ++ uint ies_len = ies_len_ori; ++ int index = 0; ++ ++ while (1) { ++ target_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &target_ie_len); ++ if (target_ie && target_ie_len) { ++ u8 *next_ie = target_ie + target_ie_len; ++ uint remain_len = ies_len - (next_ie - ies); ++ ++ if (DBG_DEL_P2P_IE && msg) { ++ RTW_INFO("%s %d before\n", __func__, index); ++ dump_ies(RTW_DBGDUMP, ies, ies_len); ++ ++ RTW_INFO("ies:%p, ies_len:%u\n", ies, ies_len); ++ RTW_INFO("target_ie:%p, target_ie_len:%u\n", target_ie, target_ie_len); ++ RTW_INFO("next_ie:%p, remain_len:%u\n", next_ie, remain_len); ++ } ++ ++ _rtw_memmove(target_ie, next_ie, remain_len); ++ _rtw_memset(target_ie + remain_len, 0, target_ie_len); ++ ies_len -= target_ie_len; ++ ++ if (DBG_DEL_P2P_IE && msg) { ++ RTW_INFO("%s %d after\n", __func__, index); ++ dump_ies(RTW_DBGDUMP, ies, ies_len); ++ } ++ ++ index++; ++ } else ++ break; ++ } ++ ++ return ies_len; ++} ++ ++uint rtw_del_p2p_attr(u8 *ie, uint ielen_ori, u8 attr_id) ++{ ++#define DBG_DEL_P2P_ATTR 0 ++ ++ u8 *target_attr; ++ u32 target_attr_len; ++ uint ielen = ielen_ori; ++ int index = 0; ++ ++ while (1) { ++ target_attr = rtw_get_p2p_attr(ie, ielen, attr_id, NULL, &target_attr_len); ++ if (target_attr && target_attr_len) { ++ u8 *next_attr = target_attr + target_attr_len; ++ uint remain_len = ielen - (next_attr - ie); ++ ++ if (DBG_DEL_P2P_ATTR) { ++ RTW_INFO("%s %d before\n", __func__, index); ++ dump_ies(RTW_DBGDUMP, ie, ielen); ++ ++ RTW_INFO("ie:%p, ielen:%u\n", ie, ielen); ++ RTW_INFO("target_attr:%p, target_attr_len:%u\n", target_attr, target_attr_len); ++ RTW_INFO("next_attr:%p, remain_len:%u\n", next_attr, remain_len); ++ } ++ ++ _rtw_memmove(target_attr, next_attr, remain_len); ++ _rtw_memset(target_attr + remain_len, 0, target_attr_len); ++ *(ie + 1) -= target_attr_len; ++ ielen -= target_attr_len; ++ ++ if (DBG_DEL_P2P_ATTR) { ++ RTW_INFO("%s %d after\n", __func__, index); ++ dump_ies(RTW_DBGDUMP, ie, ielen); ++ } ++ ++ index++; ++ } else ++ break; ++ } ++ ++ return ielen; ++} ++ ++inline u8 *rtw_bss_ex_get_p2p_ie(WLAN_BSSID_EX *bss_ex, u8 *p2p_ie, uint *p2p_ielen) ++{ ++ return rtw_get_p2p_ie(BSS_EX_TLV_IES(bss_ex), BSS_EX_TLV_IES_LEN(bss_ex), p2p_ie, p2p_ielen); ++} ++ ++void rtw_bss_ex_del_p2p_ie(WLAN_BSSID_EX *bss_ex) ++{ ++#define DBG_BSS_EX_DEL_P2P_IE 0 ++ ++ u8 *ies = BSS_EX_TLV_IES(bss_ex); ++ uint ies_len_ori = BSS_EX_TLV_IES_LEN(bss_ex); ++ uint ies_len; ++ ++ ies_len = rtw_del_p2p_ie(ies, ies_len_ori, DBG_BSS_EX_DEL_P2P_IE ? __func__ : NULL); ++ bss_ex->IELength -= ies_len_ori - ies_len; ++} ++ ++void rtw_bss_ex_del_p2p_attr(WLAN_BSSID_EX *bss_ex, u8 attr_id) ++{ ++#define DBG_BSS_EX_DEL_P2P_ATTR 0 ++ ++ u8 *ies = BSS_EX_TLV_IES(bss_ex); ++ uint ies_len = BSS_EX_TLV_IES_LEN(bss_ex); ++ ++ u8 *ie; ++ uint ie_len, ie_len_ori; ++ ++ int index = 0; ++ ++ while (1) { ++ ie = rtw_get_p2p_ie(ies, ies_len, NULL, &ie_len_ori); ++ if (ie) { ++ u8 *next_ie_ori = ie + ie_len_ori; ++ uint remain_len = bss_ex->IELength - (next_ie_ori - bss_ex->IEs); ++ u8 has_target_attr = 0; ++ ++ if (DBG_BSS_EX_DEL_P2P_ATTR) { ++ if (rtw_get_p2p_attr(ie, ie_len_ori, attr_id, NULL, NULL)) { ++ RTW_INFO("%s %d before\n", __func__, index); ++ dump_ies(RTW_DBGDUMP, BSS_EX_TLV_IES(bss_ex), BSS_EX_TLV_IES_LEN(bss_ex)); ++ ++ RTW_INFO("ies:%p, ies_len:%u\n", ies, ies_len); ++ RTW_INFO("ie:%p, ie_len_ori:%u\n", ie, ie_len_ori); ++ RTW_INFO("next_ie_ori:%p, remain_len:%u\n", next_ie_ori, remain_len); ++ has_target_attr = 1; ++ } ++ } ++ ++ ie_len = rtw_del_p2p_attr(ie, ie_len_ori, attr_id); ++ if (ie_len != ie_len_ori) { ++ u8 *next_ie = ie + ie_len; ++ ++ _rtw_memmove(next_ie, next_ie_ori, remain_len); ++ _rtw_memset(next_ie + remain_len, 0, ie_len_ori - ie_len); ++ bss_ex->IELength -= ie_len_ori - ie_len; ++ ++ ies = next_ie; ++ } else ++ ies = next_ie_ori; ++ ++ if (DBG_BSS_EX_DEL_P2P_ATTR) { ++ if (has_target_attr) { ++ RTW_INFO("%s %d after\n", __func__, index); ++ dump_ies(RTW_DBGDUMP, BSS_EX_TLV_IES(bss_ex), BSS_EX_TLV_IES_LEN(bss_ex)); ++ } ++ } ++ ++ ies_len = remain_len; ++ ++ index++; ++ } else ++ break; ++ } ++} ++ ++void dump_wfd_ie(void *sel, u8 *ie, u32 ie_len) ++{ ++ u8 *pos = (u8 *)ie; ++ u8 id; ++ u16 len; ++ ++ u8 *wfd_ie; ++ uint wfd_ielen; ++ ++ wfd_ie = rtw_get_wfd_ie(ie, ie_len, NULL, &wfd_ielen); ++ if (wfd_ie != ie || wfd_ielen == 0) ++ return; ++ ++ pos += 6; ++ while (pos - ie + 3 <= ie_len) { ++ id = *pos; ++ len = RTW_GET_BE16(pos + 1); ++ ++ RTW_PRINT_SEL(sel, "%s ID:%u, LEN:%u%s\n", __func__, id, len ++ , ((pos - ie + 3 + len) <= ie_len) ? "" : "(exceed ie_len)"); ++ ++ pos += (3 + len); ++ } ++} ++ ++/** ++ * rtw_get_wfd_ie - Search WFD IE from a series of IEs ++ * @in_ie: Address of IEs to search ++ * @in_len: Length limit from in_ie ++ * @wfd_ie: If not NULL and WFD IE is found, WFD IE will be copied to the buf starting from wfd_ie ++ * @wfd_ielen: If not NULL and WFD IE is found, will set to the length of the entire WFD IE ++ * ++ * Returns: The address of the P2P IE found, or NULL ++ */ ++u8 *rtw_get_wfd_ie(u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen) ++{ ++ uint cnt; ++ u8 *wfd_ie_ptr = NULL; ++ u8 eid, wfd_oui[4] = {0x50, 0x6F, 0x9A, 0x0A}; ++ ++ if (wfd_ielen) ++ *wfd_ielen = 0; ++ ++ if (!in_ie || in_len < 0) { ++ rtw_warn_on(1); ++ return wfd_ie_ptr; ++ } ++ ++ if (in_len <= 0) ++ return wfd_ie_ptr; ++ ++ cnt = 0; ++ ++ while (cnt + 1 + 4 < in_len) { ++ eid = in_ie[cnt]; ++ ++ if (cnt + 1 + 4 >= MAX_IE_SZ) { ++ rtw_warn_on(1); ++ return NULL; ++ } ++ ++ if (eid == WLAN_EID_VENDOR_SPECIFIC && _rtw_memcmp(&in_ie[cnt + 2], wfd_oui, 4) == _TRUE) { ++ wfd_ie_ptr = in_ie + cnt; ++ ++ if (wfd_ie) ++ _rtw_memcpy(wfd_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); ++ ++ if (wfd_ielen) ++ *wfd_ielen = in_ie[cnt + 1] + 2; ++ ++ break; ++ } else ++ cnt += in_ie[cnt + 1] + 2; ++ ++ } ++ ++ return wfd_ie_ptr; ++} ++ ++/** ++ * rtw_get_wfd_attr - Search a specific WFD attribute from a given WFD IE ++ * @wfd_ie: Address of WFD IE to search ++ * @wfd_ielen: Length limit from wfd_ie ++ * @target_attr_id: The attribute ID of WFD attribute to search ++ * @buf_attr: If not NULL and the WFD attribute is found, WFD attribute will be copied to the buf starting from buf_attr ++ * @len_attr: If not NULL and the WFD attribute is found, will set to the length of the entire WFD attribute ++ * ++ * Returns: the address of the specific WPS attribute found, or NULL ++ */ ++u8 *rtw_get_wfd_attr(u8 *wfd_ie, uint wfd_ielen, u8 target_attr_id, u8 *buf_attr, u32 *len_attr) ++{ ++ u8 *attr_ptr = NULL; ++ u8 *target_attr_ptr = NULL; ++ u8 wfd_oui[4] = {0x50, 0x6F, 0x9A, 0x0A}; ++ ++ if (len_attr) ++ *len_attr = 0; ++ ++ if (!wfd_ie ++ || wfd_ielen <= 6 ++ || (wfd_ie[0] != WLAN_EID_VENDOR_SPECIFIC) ++ || (_rtw_memcmp(wfd_ie + 2, wfd_oui, 4) != _TRUE)) ++ return attr_ptr; ++ ++ /* 6 = 1(Element ID) + 1(Length) + 3 (OUI) + 1(OUI Type) */ ++ attr_ptr = wfd_ie + 6; /* goto first attr */ ++ ++ while ((attr_ptr - wfd_ie + 3) <= wfd_ielen) { ++ /* 3 = 1(Attribute ID) + 2(Length) */ ++ u8 attr_id = *attr_ptr; ++ u16 attr_data_len = RTW_GET_BE16(attr_ptr + 1); ++ u16 attr_len = attr_data_len + 3; ++ ++ if (0) ++ RTW_INFO("%s attr_ptr:%p, id:%u, length:%u\n", __func__, attr_ptr, attr_id, attr_data_len); ++ ++ if ((attr_ptr - wfd_ie + attr_len) > wfd_ielen) ++ break; ++ ++ if (attr_id == target_attr_id) { ++ target_attr_ptr = attr_ptr; ++ ++ if (buf_attr) ++ _rtw_memcpy(buf_attr, attr_ptr, attr_len); ++ ++ if (len_attr) ++ *len_attr = attr_len; ++ ++ break; ++ } else ++ attr_ptr += attr_len; ++ } ++ ++ return target_attr_ptr; ++} ++ ++/** ++ * rtw_get_wfd_attr_content - Search a specific WFD attribute content from a given WFD IE ++ * @wfd_ie: Address of WFD IE to search ++ * @wfd_ielen: Length limit from wfd_ie ++ * @target_attr_id: The attribute ID of WFD attribute to search ++ * @buf_content: If not NULL and the WFD attribute is found, WFD attribute content will be copied to the buf starting from buf_content ++ * @len_content: If not NULL and the WFD attribute is found, will set to the length of the WFD attribute content ++ * ++ * Returns: the address of the specific WFD attribute content found, or NULL ++ */ ++u8 *rtw_get_wfd_attr_content(u8 *wfd_ie, uint wfd_ielen, u8 target_attr_id, u8 *buf_content, uint *len_content) ++{ ++ u8 *attr_ptr; ++ u32 attr_len; ++ ++ if (len_content) ++ *len_content = 0; ++ ++ attr_ptr = rtw_get_wfd_attr(wfd_ie, wfd_ielen, target_attr_id, NULL, &attr_len); ++ ++ if (attr_ptr && attr_len) { ++ if (buf_content) ++ _rtw_memcpy(buf_content, attr_ptr + 3, attr_len - 3); ++ ++ if (len_content) ++ *len_content = attr_len - 3; ++ ++ return attr_ptr + 3; ++ } ++ ++ return NULL; ++} ++ ++uint rtw_del_wfd_ie(u8 *ies, uint ies_len_ori, const char *msg) ++{ ++#define DBG_DEL_WFD_IE 0 ++ ++ u8 *target_ie; ++ u32 target_ie_len; ++ uint ies_len = ies_len_ori; ++ int index = 0; ++ ++ while (1) { ++ target_ie = rtw_get_wfd_ie(ies, ies_len, NULL, &target_ie_len); ++ if (target_ie && target_ie_len) { ++ u8 *next_ie = target_ie + target_ie_len; ++ uint remain_len = ies_len - (next_ie - ies); ++ ++ if (DBG_DEL_WFD_IE && msg) { ++ RTW_INFO("%s %d before\n", __func__, index); ++ dump_ies(RTW_DBGDUMP, ies, ies_len); ++ ++ RTW_INFO("ies:%p, ies_len:%u\n", ies, ies_len); ++ RTW_INFO("target_ie:%p, target_ie_len:%u\n", target_ie, target_ie_len); ++ RTW_INFO("next_ie:%p, remain_len:%u\n", next_ie, remain_len); ++ } ++ ++ _rtw_memmove(target_ie, next_ie, remain_len); ++ _rtw_memset(target_ie + remain_len, 0, target_ie_len); ++ ies_len -= target_ie_len; ++ ++ if (DBG_DEL_WFD_IE && msg) { ++ RTW_INFO("%s %d after\n", __func__, index); ++ dump_ies(RTW_DBGDUMP, ies, ies_len); ++ } ++ ++ index++; ++ } else ++ break; ++ } ++ ++ return ies_len; ++} ++ ++uint rtw_del_wfd_attr(u8 *ie, uint ielen_ori, u8 attr_id) ++{ ++#define DBG_DEL_WFD_ATTR 0 ++ ++ u8 *target_attr; ++ u32 target_attr_len; ++ uint ielen = ielen_ori; ++ int index = 0; ++ ++ while (1) { ++ target_attr = rtw_get_wfd_attr(ie, ielen, attr_id, NULL, &target_attr_len); ++ if (target_attr && target_attr_len) { ++ u8 *next_attr = target_attr + target_attr_len; ++ uint remain_len = ielen - (next_attr - ie); ++ ++ if (DBG_DEL_WFD_ATTR) { ++ RTW_INFO("%s %d before\n", __func__, index); ++ dump_ies(RTW_DBGDUMP, ie, ielen); ++ ++ RTW_INFO("ie:%p, ielen:%u\n", ie, ielen); ++ RTW_INFO("target_attr:%p, target_attr_len:%u\n", target_attr, target_attr_len); ++ RTW_INFO("next_attr:%p, remain_len:%u\n", next_attr, remain_len); ++ } ++ ++ _rtw_memmove(target_attr, next_attr, remain_len); ++ _rtw_memset(target_attr + remain_len, 0, target_attr_len); ++ *(ie + 1) -= target_attr_len; ++ ielen -= target_attr_len; ++ ++ if (DBG_DEL_WFD_ATTR) { ++ RTW_INFO("%s %d after\n", __func__, index); ++ dump_ies(RTW_DBGDUMP, ie, ielen); ++ } ++ ++ index++; ++ } else ++ break; ++ } ++ ++ return ielen; ++} ++ ++inline u8 *rtw_bss_ex_get_wfd_ie(WLAN_BSSID_EX *bss_ex, u8 *wfd_ie, uint *wfd_ielen) ++{ ++ return rtw_get_wfd_ie(BSS_EX_TLV_IES(bss_ex), BSS_EX_TLV_IES_LEN(bss_ex), wfd_ie, wfd_ielen); ++} ++ ++void rtw_bss_ex_del_wfd_ie(WLAN_BSSID_EX *bss_ex) ++{ ++#define DBG_BSS_EX_DEL_WFD_IE 0 ++ u8 *ies = BSS_EX_TLV_IES(bss_ex); ++ uint ies_len_ori = BSS_EX_TLV_IES_LEN(bss_ex); ++ uint ies_len; ++ ++ ies_len = rtw_del_wfd_ie(ies, ies_len_ori, DBG_BSS_EX_DEL_WFD_IE ? __func__ : NULL); ++ bss_ex->IELength -= ies_len_ori - ies_len; ++} ++ ++void rtw_bss_ex_del_wfd_attr(WLAN_BSSID_EX *bss_ex, u8 attr_id) ++{ ++#define DBG_BSS_EX_DEL_WFD_ATTR 0 ++ ++ u8 *ies = BSS_EX_TLV_IES(bss_ex); ++ uint ies_len = BSS_EX_TLV_IES_LEN(bss_ex); ++ ++ u8 *ie; ++ uint ie_len, ie_len_ori; ++ ++ int index = 0; ++ ++ while (1) { ++ ie = rtw_get_wfd_ie(ies, ies_len, NULL, &ie_len_ori); ++ if (ie) { ++ u8 *next_ie_ori = ie + ie_len_ori; ++ uint remain_len = bss_ex->IELength - (next_ie_ori - bss_ex->IEs); ++ u8 has_target_attr = 0; ++ ++ if (DBG_BSS_EX_DEL_WFD_ATTR) { ++ if (rtw_get_wfd_attr(ie, ie_len_ori, attr_id, NULL, NULL)) { ++ RTW_INFO("%s %d before\n", __func__, index); ++ dump_ies(RTW_DBGDUMP, BSS_EX_TLV_IES(bss_ex), BSS_EX_TLV_IES_LEN(bss_ex)); ++ ++ RTW_INFO("ies:%p, ies_len:%u\n", ies, ies_len); ++ RTW_INFO("ie:%p, ie_len_ori:%u\n", ie, ie_len_ori); ++ RTW_INFO("next_ie_ori:%p, remain_len:%u\n", next_ie_ori, remain_len); ++ has_target_attr = 1; ++ } ++ } ++ ++ ie_len = rtw_del_wfd_attr(ie, ie_len_ori, attr_id); ++ if (ie_len != ie_len_ori) { ++ u8 *next_ie = ie + ie_len; ++ ++ _rtw_memmove(next_ie, next_ie_ori, remain_len); ++ _rtw_memset(next_ie + remain_len, 0, ie_len_ori - ie_len); ++ bss_ex->IELength -= ie_len_ori - ie_len; ++ ++ ies = next_ie; ++ } else ++ ies = next_ie_ori; ++ ++ if (DBG_BSS_EX_DEL_WFD_ATTR) { ++ if (has_target_attr) { ++ RTW_INFO("%s %d after\n", __func__, index); ++ dump_ies(RTW_DBGDUMP, BSS_EX_TLV_IES(bss_ex), BSS_EX_TLV_IES_LEN(bss_ex)); ++ } ++ } ++ ++ ies_len = remain_len; ++ ++ index++; ++ } else ++ break; ++ } ++} ++ ++/* Baron adds to avoid FreeBSD warning */ ++int ieee80211_is_empty_essid(const char *essid, int essid_len) ++{ ++ /* Single white space is for Linksys APs */ ++ if (essid_len == 1 && essid[0] == ' ') ++ return 1; ++ ++ /* Otherwise, if the entire essid is 0, we assume it is hidden */ ++ while (essid_len) { ++ essid_len--; ++ if (essid[essid_len] != '\0') ++ return 0; ++ } ++ ++ return 1; ++} ++ ++int ieee80211_get_hdrlen(u16 fc) ++{ ++ int hdrlen = 24; ++ ++ switch (WLAN_FC_GET_TYPE(fc)) { ++ case RTW_IEEE80211_FTYPE_DATA: ++ if (fc & RTW_IEEE80211_STYPE_QOS_DATA) ++ hdrlen += 2; ++ if ((fc & RTW_IEEE80211_FCTL_FROMDS) && (fc & RTW_IEEE80211_FCTL_TODS)) ++ hdrlen += 6; /* Addr4 */ ++ break; ++ case RTW_IEEE80211_FTYPE_CTL: ++ switch (WLAN_FC_GET_STYPE(fc)) { ++ case RTW_IEEE80211_STYPE_CTS: ++ case RTW_IEEE80211_STYPE_ACK: ++ hdrlen = 10; ++ break; ++ default: ++ hdrlen = 16; ++ break; ++ } ++ break; ++ } ++ ++ return hdrlen; ++} ++ ++int rtw_get_cipher_info(struct wlan_network *pnetwork) ++{ ++ u32 wpa_ielen; ++ unsigned char *pbuf; ++ int group_cipher = 0, pairwise_cipher = 0, is8021x = 0; ++ int ret = _FAIL; ++ pbuf = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength - 12); ++ ++ if (pbuf && (wpa_ielen > 0)) { ++ if (_SUCCESS == rtw_parse_wpa_ie(pbuf, wpa_ielen + 2, &group_cipher, &pairwise_cipher, &is8021x)) { ++ ++ pnetwork->BcnInfo.pairwise_cipher = pairwise_cipher; ++ pnetwork->BcnInfo.group_cipher = group_cipher; ++ pnetwork->BcnInfo.is_8021x = is8021x; ++ ret = _SUCCESS; ++ } ++ } else { ++ ++ pbuf = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength - 12); ++ ++ if (pbuf && (wpa_ielen > 0)) { ++ if (_SUCCESS == rtw_parse_wpa2_ie(pbuf, wpa_ielen + 2, &group_cipher, &pairwise_cipher, &is8021x)) { ++ pnetwork->BcnInfo.pairwise_cipher = pairwise_cipher; ++ pnetwork->BcnInfo.group_cipher = group_cipher; ++ pnetwork->BcnInfo.is_8021x = is8021x; ++ ret = _SUCCESS; ++ } ++ } ++ } ++ ++ return ret; ++} ++ ++void rtw_get_bcn_info(struct wlan_network *pnetwork) ++{ ++ unsigned short cap = 0; ++ u8 bencrypt = 0; ++ /* u8 wpa_ie[255],rsn_ie[255]; */ ++ u16 wpa_len = 0, rsn_len = 0; ++ struct HT_info_element *pht_info = NULL; ++ struct rtw_ieee80211_ht_cap *pht_cap = NULL; ++ unsigned int len; ++ unsigned char *p; ++ ++ _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); ++ cap = le16_to_cpu(cap); ++ if (cap & WLAN_CAPABILITY_PRIVACY) { ++ bencrypt = 1; ++ pnetwork->network.Privacy = 1; ++ } else ++ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_OPENSYS; ++ rtw_get_sec_ie(pnetwork->network.IEs , pnetwork->network.IELength, NULL, &rsn_len, NULL, &wpa_len); ++ ++ if (rsn_len > 0) ++ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_WPA2; ++ else if (wpa_len > 0) ++ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_WPA; ++ else { ++ if (bencrypt) ++ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_WEP; ++ } ++ rtw_get_cipher_info(pnetwork); ++ ++ /* get bwmode and ch_offset */ ++ /* parsing HT_CAP_IE */ ++ p = rtw_get_ie(pnetwork->network.IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, pnetwork->network.IELength - _FIXED_IE_LENGTH_); ++ if (p && len > 0) { ++ pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); ++ pnetwork->BcnInfo.ht_cap_info = pht_cap->cap_info; ++ } else ++ pnetwork->BcnInfo.ht_cap_info = 0; ++ /* parsing HT_INFO_IE */ ++ p = rtw_get_ie(pnetwork->network.IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, pnetwork->network.IELength - _FIXED_IE_LENGTH_); ++ if (p && len > 0) { ++ pht_info = (struct HT_info_element *)(p + 2); ++ pnetwork->BcnInfo.ht_info_infos_0 = pht_info->infos[0]; ++ } else ++ pnetwork->BcnInfo.ht_info_infos_0 = 0; ++} ++ ++u8 rtw_ht_mcsset_to_nss(u8 *supp_mcs_set) ++{ ++ u8 nss = 1; ++ ++ if (supp_mcs_set[3]) ++ nss = 4; ++ else if (supp_mcs_set[2]) ++ nss = 3; ++ else if (supp_mcs_set[1]) ++ nss = 2; ++ else if (supp_mcs_set[0]) ++ nss = 1; ++ else ++ RTW_INFO("%s,%d, warning! supp_mcs_set is zero\n", __func__, __LINE__); ++ /* RTW_INFO("%s HT: %dSS\n", __FUNCTION__, nss); */ ++ return nss; ++} ++ ++/* show MCS rate, unit: 100Kbps */ ++u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI, unsigned char *MCS_rate) ++{ ++ u16 max_rate = 0; ++ ++ /*MCS_rate[2] = 3T3R , MCS_rate[1] = 2T2R , MCS_rate[0] = 1T1R*/ ++ if (MCS_rate[2]) { ++ if (MCS_rate[2] & BIT(7)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 4500 : 4050) : ((short_GI) ? 2167 : 1950); ++ else if (MCS_rate[2] & BIT(6)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 4050 : 3645) : ((short_GI) ? 1950 : 1750); ++ else if (MCS_rate[2] & BIT(5)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 3600 : 3240) : ((short_GI) ? 1733 : 1560); ++ else if (MCS_rate[2] & BIT(4)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 2700 : 2430) : ((short_GI) ? 1300 : 1170); ++ else if (MCS_rate[2] & BIT(3)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 1800 : 1620) : ((short_GI) ? 867 : 780); ++ else if (MCS_rate[2] & BIT(2)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 1350 : 1215) : ((short_GI) ? 650 : 585); ++ else if (MCS_rate[2] & BIT(1)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 900 : 810) : ((short_GI) ? 433 : 390); ++ else if (MCS_rate[2] & BIT(0)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 450 : 405) : ((short_GI) ? 217 : 195); ++ } else if (MCS_rate[1]) { ++ if (MCS_rate[1] & BIT(7)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 3000 : 2700) : ((short_GI) ? 1444 : 1300); ++ else if (MCS_rate[1] & BIT(6)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 2700 : 2430) : ((short_GI) ? 1300 : 1170); ++ else if (MCS_rate[1] & BIT(5)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 2400 : 2160) : ((short_GI) ? 1156 : 1040); ++ else if (MCS_rate[1] & BIT(4)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 1800 : 1620) : ((short_GI) ? 867 : 780); ++ else if (MCS_rate[1] & BIT(3)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 1200 : 1080) : ((short_GI) ? 578 : 520); ++ else if (MCS_rate[1] & BIT(2)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 900 : 810) : ((short_GI) ? 433 : 390); ++ else if (MCS_rate[1] & BIT(1)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 600 : 540) : ((short_GI) ? 289 : 260); ++ else if (MCS_rate[1] & BIT(0)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 300 : 270) : ((short_GI) ? 144 : 130); ++ } else { ++ if (MCS_rate[0] & BIT(7)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 1500 : 1350) : ((short_GI) ? 722 : 650); ++ else if (MCS_rate[0] & BIT(6)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 1350 : 1215) : ((short_GI) ? 650 : 585); ++ else if (MCS_rate[0] & BIT(5)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 1200 : 1080) : ((short_GI) ? 578 : 520); ++ else if (MCS_rate[0] & BIT(4)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 900 : 810) : ((short_GI) ? 433 : 390); ++ else if (MCS_rate[0] & BIT(3)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 600 : 540) : ((short_GI) ? 289 : 260); ++ else if (MCS_rate[0] & BIT(2)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 450 : 405) : ((short_GI) ? 217 : 195); ++ else if (MCS_rate[0] & BIT(1)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 300 : 270) : ((short_GI) ? 144 : 130); ++ else if (MCS_rate[0] & BIT(0)) ++ max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65); ++ } ++ ++ return max_rate; ++} ++ ++int rtw_action_frame_parse(const u8 *frame, u32 frame_len, u8 *category, u8 *action) ++{ ++ const u8 *frame_body = frame + sizeof(struct rtw_ieee80211_hdr_3addr); ++ u16 fc; ++ u8 c; ++ u8 a = ACT_PUBLIC_MAX; ++ ++ fc = le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)frame)->frame_ctl); ++ ++ if ((fc & (RTW_IEEE80211_FCTL_FTYPE | RTW_IEEE80211_FCTL_STYPE)) ++ != (RTW_IEEE80211_FTYPE_MGMT | RTW_IEEE80211_STYPE_ACTION) ++ ) ++ return _FALSE; ++ ++ c = frame_body[0]; ++ ++ switch (c) { ++ case RTW_WLAN_CATEGORY_P2P: /* vendor-specific */ ++ break; ++ default: ++ a = frame_body[1]; ++ } ++ ++ if (category) ++ *category = c; ++ if (action) ++ *action = a; ++ ++ return _TRUE; ++} ++ ++static const char *_action_public_str[] = { ++ "ACT_PUB_BSSCOEXIST", ++ "ACT_PUB_DSE_ENABLE", ++ "ACT_PUB_DSE_DEENABLE", ++ "ACT_PUB_DSE_REG_LOCATION", ++ "ACT_PUB_EXT_CHL_SWITCH", ++ "ACT_PUB_DSE_MSR_REQ", ++ "ACT_PUB_DSE_MSR_RPRT", ++ "ACT_PUB_MP", ++ "ACT_PUB_DSE_PWR_CONSTRAINT", ++ "ACT_PUB_VENDOR", ++ "ACT_PUB_GAS_INITIAL_REQ", ++ "ACT_PUB_GAS_INITIAL_RSP", ++ "ACT_PUB_GAS_COMEBACK_REQ", ++ "ACT_PUB_GAS_COMEBACK_RSP", ++ "ACT_PUB_TDLS_DISCOVERY_RSP", ++ "ACT_PUB_LOCATION_TRACK", ++ "ACT_PUB_RSVD", ++}; ++ ++const char *action_public_str(u8 action) ++{ ++ action = (action >= ACT_PUBLIC_MAX) ? ACT_PUBLIC_MAX : action; ++ return _action_public_str[action]; ++} ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_io.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_io.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_io.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_io.c 2018-02-11 21:44:27.136145918 +0200 +@@ -0,0 +1,701 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++/* ++ ++The purpose of rtw_io.c ++ ++a. provides the API ++ ++b. provides the protocol engine ++ ++c. provides the software interface between caller and the hardware interface ++ ++ ++Compiler Flag Option: ++ ++1. CONFIG_SDIO_HCI: ++ a. USE_SYNC_IRP: Only sync operations are provided. ++ b. USE_ASYNC_IRP:Both sync/async operations are provided. ++ ++2. CONFIG_USB_HCI: ++ a. USE_ASYNC_IRP: Both sync/async operations are provided. ++ ++3. CONFIG_CFIO_HCI: ++ b. USE_SYNC_IRP: Only sync operations are provided. ++ ++ ++Only sync read/rtw_write_mem operations are provided. ++ ++jackson@realtek.com.tw ++ ++*/ ++ ++#define _RTW_IO_C_ ++ ++#include ++#include ++ ++#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) ++ #error "Shall be Linux or Windows, but not both!\n" ++#endif ++ ++#ifdef CONFIG_SDIO_HCI ++ #define rtw_le16_to_cpu(val) val ++ #define rtw_le32_to_cpu(val) val ++ #define rtw_cpu_to_le16(val) val ++ #define rtw_cpu_to_le32(val) val ++#else ++ #define rtw_le16_to_cpu(val) le16_to_cpu(val) ++ #define rtw_le32_to_cpu(val) le32_to_cpu(val) ++ #define rtw_cpu_to_le16(val) cpu_to_le16(val) ++ #define rtw_cpu_to_le32(val) cpu_to_le32(val) ++#endif ++ ++ ++u8 _rtw_read8(_adapter *adapter, u32 addr) ++{ ++ u8 r_val; ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ u8(*_read8)(struct intf_hdl *pintfhdl, u32 addr); ++ _read8 = pintfhdl->io_ops._read8; ++ ++ r_val = _read8(pintfhdl, addr); ++ return r_val; ++} ++ ++u16 _rtw_read16(_adapter *adapter, u32 addr) ++{ ++ u16 r_val; ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ u16(*_read16)(struct intf_hdl *pintfhdl, u32 addr); ++ _read16 = pintfhdl->io_ops._read16; ++ ++ r_val = _read16(pintfhdl, addr); ++ return rtw_le16_to_cpu(r_val); ++} ++ ++u32 _rtw_read32(_adapter *adapter, u32 addr) ++{ ++ u32 r_val; ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ u32(*_read32)(struct intf_hdl *pintfhdl, u32 addr); ++ _read32 = pintfhdl->io_ops._read32; ++ ++ r_val = _read32(pintfhdl, addr); ++ return rtw_le32_to_cpu(r_val); ++ ++} ++ ++int _rtw_write8(_adapter *adapter, u32 addr, u8 val) ++{ ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ int (*_write8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); ++ int ret; ++ _write8 = pintfhdl->io_ops._write8; ++ ++ ret = _write8(pintfhdl, addr, val); ++ ++ return RTW_STATUS_CODE(ret); ++} ++int _rtw_write16(_adapter *adapter, u32 addr, u16 val) ++{ ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ int (*_write16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); ++ int ret; ++ _write16 = pintfhdl->io_ops._write16; ++ ++ val = rtw_cpu_to_le16(val); ++ ret = _write16(pintfhdl, addr, val); ++ ++ return RTW_STATUS_CODE(ret); ++} ++int _rtw_write32(_adapter *adapter, u32 addr, u32 val) ++{ ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ int (*_write32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); ++ int ret; ++ _write32 = pintfhdl->io_ops._write32; ++ ++ val = rtw_cpu_to_le32(val); ++ ret = _write32(pintfhdl, addr, val); ++ ++ return RTW_STATUS_CODE(ret); ++} ++ ++int _rtw_writeN(_adapter *adapter, u32 addr , u32 length , u8 *pdata) ++{ ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = (struct intf_hdl *)(&(pio_priv->intf)); ++ int (*_writeN)(struct intf_hdl *pintfhdl, u32 addr, u32 length, u8 *pdata); ++ int ret; ++ _writeN = pintfhdl->io_ops._writeN; ++ ++ ret = _writeN(pintfhdl, addr, length, pdata); ++ ++ return RTW_STATUS_CODE(ret); ++} ++ ++#ifdef CONFIG_SDIO_HCI ++u8 _rtw_sd_f0_read8(_adapter *adapter, u32 addr) ++{ ++ u8 r_val = 0x00; ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ u8(*_sd_f0_read8)(struct intf_hdl *pintfhdl, u32 addr); ++ ++ _sd_f0_read8 = pintfhdl->io_ops._sd_f0_read8; ++ ++ if (_sd_f0_read8) ++ r_val = _sd_f0_read8(pintfhdl, addr); ++ else ++ RTW_WARN(FUNC_ADPT_FMT" _sd_f0_read8 callback is NULL\n", FUNC_ADPT_ARG(adapter)); ++ ++ return r_val; ++} ++ ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++u8 _rtw_sd_iread8(_adapter *adapter, u32 addr) ++{ ++ u8 r_val = 0x00; ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ u8(*_sd_iread8)(struct intf_hdl *pintfhdl, u32 addr); ++ ++ _sd_iread8 = pintfhdl->io_ops._sd_iread8; ++ ++ if (_sd_iread8) ++ r_val = _sd_iread8(pintfhdl, addr); ++ else ++ RTW_ERR(FUNC_ADPT_FMT" _sd_iread8 callback is NULL\n", FUNC_ADPT_ARG(adapter)); ++ ++ return r_val; ++} ++ ++u16 _rtw_sd_iread16(_adapter *adapter, u32 addr) ++{ ++ u16 r_val = 0x00; ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ u16(*_sd_iread16)(struct intf_hdl *pintfhdl, u32 addr); ++ ++ _sd_iread16 = pintfhdl->io_ops._sd_iread16; ++ ++ if (_sd_iread16) ++ r_val = _sd_iread16(pintfhdl, addr); ++ else ++ RTW_ERR(FUNC_ADPT_FMT" _sd_iread16 callback is NULL\n", FUNC_ADPT_ARG(adapter)); ++ ++ return r_val; ++} ++ ++u32 _rtw_sd_iread32(_adapter *adapter, u32 addr) ++{ ++ u32 r_val = 0x00; ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ u32(*_sd_iread32)(struct intf_hdl *pintfhdl, u32 addr); ++ ++ _sd_iread32 = pintfhdl->io_ops._sd_iread32; ++ ++ if (_sd_iread32) ++ r_val = _sd_iread32(pintfhdl, addr); ++ else ++ RTW_ERR(FUNC_ADPT_FMT" _sd_iread32 callback is NULL\n", FUNC_ADPT_ARG(adapter)); ++ ++ return r_val; ++} ++ ++int _rtw_sd_iwrite8(_adapter *adapter, u32 addr, u8 val) ++{ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ int (*_sd_iwrite8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); ++ int ret = -1; ++ ++ _sd_iwrite8 = pintfhdl->io_ops._sd_iwrite8; ++ ++ if (_sd_iwrite8) ++ ret = _sd_iwrite8(pintfhdl, addr, val); ++ else ++ RTW_ERR(FUNC_ADPT_FMT" _sd_iwrite8 callback is NULL\n", FUNC_ADPT_ARG(adapter)); ++ ++ return RTW_STATUS_CODE(ret); ++} ++ ++int _rtw_sd_iwrite16(_adapter *adapter, u32 addr, u16 val) ++{ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ int (*_sd_iwrite16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); ++ int ret = -1; ++ ++ _sd_iwrite16 = pintfhdl->io_ops._sd_iwrite16; ++ ++ if (_sd_iwrite16) ++ ret = _sd_iwrite16(pintfhdl, addr, val); ++ else ++ RTW_ERR(FUNC_ADPT_FMT" _sd_iwrite16 callback is NULL\n", FUNC_ADPT_ARG(adapter)); ++ ++ return RTW_STATUS_CODE(ret); ++} ++int _rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val) ++{ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ int (*_sd_iwrite32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); ++ int ret = -1; ++ ++ _sd_iwrite32 = pintfhdl->io_ops._sd_iwrite32; ++ ++ if (_sd_iwrite32) ++ ret = _sd_iwrite32(pintfhdl, addr, val); ++ else ++ RTW_ERR(FUNC_ADPT_FMT" _sd_iwrite32 callback is NULL\n", FUNC_ADPT_ARG(adapter)); ++ ++ return RTW_STATUS_CODE(ret); ++} ++ ++#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ ++ ++#endif /* CONFIG_SDIO_HCI */ ++ ++int _rtw_write8_async(_adapter *adapter, u32 addr, u8 val) ++{ ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ int (*_write8_async)(struct intf_hdl *pintfhdl, u32 addr, u8 val); ++ int ret; ++ _write8_async = pintfhdl->io_ops._write8_async; ++ ++ ret = _write8_async(pintfhdl, addr, val); ++ ++ return RTW_STATUS_CODE(ret); ++} ++int _rtw_write16_async(_adapter *adapter, u32 addr, u16 val) ++{ ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ int (*_write16_async)(struct intf_hdl *pintfhdl, u32 addr, u16 val); ++ int ret; ++ _write16_async = pintfhdl->io_ops._write16_async; ++ val = rtw_cpu_to_le16(val); ++ ret = _write16_async(pintfhdl, addr, val); ++ ++ return RTW_STATUS_CODE(ret); ++} ++int _rtw_write32_async(_adapter *adapter, u32 addr, u32 val) ++{ ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ int (*_write32_async)(struct intf_hdl *pintfhdl, u32 addr, u32 val); ++ int ret; ++ _write32_async = pintfhdl->io_ops._write32_async; ++ val = rtw_cpu_to_le32(val); ++ ret = _write32_async(pintfhdl, addr, val); ++ ++ return RTW_STATUS_CODE(ret); ++} ++ ++void _rtw_read_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) ++{ ++ void (*_read_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ ++ ++ if (RTW_CANNOT_RUN(adapter)) { ++ return; ++ } ++ ++ _read_mem = pintfhdl->io_ops._read_mem; ++ ++ _read_mem(pintfhdl, addr, cnt, pmem); ++ ++ ++} ++ ++void _rtw_write_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) ++{ ++ void (*_write_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ ++ ++ _write_mem = pintfhdl->io_ops._write_mem; ++ ++ _write_mem(pintfhdl, addr, cnt, pmem); ++ ++ ++} ++ ++void _rtw_read_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) ++{ ++ u32(*_read_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ ++ ++ if (RTW_CANNOT_RUN(adapter)) { ++ return; ++ } ++ ++ _read_port = pintfhdl->io_ops._read_port; ++ ++ _read_port(pintfhdl, addr, cnt, pmem); ++ ++ ++} ++ ++void _rtw_read_port_cancel(_adapter *adapter) ++{ ++ void (*_read_port_cancel)(struct intf_hdl *pintfhdl); ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ ++ _read_port_cancel = pintfhdl->io_ops._read_port_cancel; ++ ++ RTW_DISABLE_FUNC(adapter, DF_RX_BIT); ++ ++ if (_read_port_cancel) ++ _read_port_cancel(pintfhdl); ++} ++ ++u32 _rtw_write_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) ++{ ++ u32(*_write_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); ++ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ u32 ret = _SUCCESS; ++ ++ ++ _write_port = pintfhdl->io_ops._write_port; ++ ++ ret = _write_port(pintfhdl, addr, cnt, pmem); ++ ++ ++ return ret; ++} ++ ++u32 _rtw_write_port_and_wait(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem, int timeout_ms) ++{ ++ int ret = _SUCCESS; ++ struct xmit_buf *pxmitbuf = (struct xmit_buf *)pmem; ++ struct submit_ctx sctx; ++ ++ rtw_sctx_init(&sctx, timeout_ms); ++ pxmitbuf->sctx = &sctx; ++ ++ ret = _rtw_write_port(adapter, addr, cnt, pmem); ++ ++ if (ret == _SUCCESS) ++ ret = rtw_sctx_wait(&sctx, __func__); ++ ++ return ret; ++} ++ ++void _rtw_write_port_cancel(_adapter *adapter) ++{ ++ void (*_write_port_cancel)(struct intf_hdl *pintfhdl); ++ struct io_priv *pio_priv = &adapter->iopriv; ++ struct intf_hdl *pintfhdl = &(pio_priv->intf); ++ ++ _write_port_cancel = pintfhdl->io_ops._write_port_cancel; ++ ++ RTW_DISABLE_FUNC(adapter, DF_TX_BIT); ++ ++ if (_write_port_cancel) ++ _write_port_cancel(pintfhdl); ++} ++int rtw_init_io_priv(_adapter *padapter, void (*set_intf_ops)(_adapter *padapter, struct _io_ops *pops)) ++{ ++ struct io_priv *piopriv = &padapter->iopriv; ++ struct intf_hdl *pintf = &piopriv->intf; ++ ++ if (set_intf_ops == NULL) ++ return _FAIL; ++ ++ piopriv->padapter = padapter; ++ pintf->padapter = padapter; ++ pintf->pintf_dev = adapter_to_dvobj(padapter); ++ ++ set_intf_ops(padapter, &pintf->io_ops); ++ ++ return _SUCCESS; ++} ++ ++/* ++* Increase and check if the continual_io_error of this @param dvobjprive is larger than MAX_CONTINUAL_IO_ERR ++* @return _TRUE: ++* @return _FALSE: ++*/ ++int rtw_inc_and_chk_continual_io_error(struct dvobj_priv *dvobj) ++{ ++ int ret = _FALSE; ++ int value; ++ ++ value = ATOMIC_INC_RETURN(&dvobj->continual_io_error); ++ if (value > MAX_CONTINUAL_IO_ERR) { ++ RTW_INFO("[dvobj:%p][ERROR] continual_io_error:%d > %d\n", dvobj, value, MAX_CONTINUAL_IO_ERR); ++ ret = _TRUE; ++ } else { ++ /* RTW_INFO("[dvobj:%p] continual_io_error:%d\n", dvobj, value); */ ++ } ++ return ret; ++} ++ ++/* ++* Set the continual_io_error of this @param dvobjprive to 0 ++*/ ++void rtw_reset_continual_io_error(struct dvobj_priv *dvobj) ++{ ++ ATOMIC_SET(&dvobj->continual_io_error, 0); ++} ++ ++#ifdef DBG_IO ++ ++u32 read_sniff_ranges[][2] = { ++ /* {0x520, 0x523}, */ ++}; ++ ++u32 write_sniff_ranges[][2] = { ++ /* {0x520, 0x523}, */ ++ /* {0x4c, 0x4c}, */ ++}; ++ ++int read_sniff_num = sizeof(read_sniff_ranges) / sizeof(u32) / 2; ++int write_sniff_num = sizeof(write_sniff_ranges) / sizeof(u32) / 2; ++ ++bool match_read_sniff_ranges(u32 addr, u16 len) ++{ ++ int i; ++ for (i = 0; i < read_sniff_num; i++) { ++ if (addr + len > read_sniff_ranges[i][0] && addr <= read_sniff_ranges[i][1]) ++ return _TRUE; ++ } ++ ++ return _FALSE; ++} ++ ++bool match_write_sniff_ranges(u32 addr, u16 len) ++{ ++ int i; ++ for (i = 0; i < write_sniff_num; i++) { ++ if (addr + len > write_sniff_ranges[i][0] && addr <= write_sniff_ranges[i][1]) ++ return _TRUE; ++ } ++ ++ return _FALSE; ++} ++ ++struct rf_sniff_ent { ++ u8 path; ++ u16 reg; ++ u32 mask; ++}; ++ ++struct rf_sniff_ent rf_read_sniff_ranges[] = { ++ /* example for all path addr 0x55 with all RF Reg mask */ ++ /* {MAX_RF_PATH, 0x55, bRFRegOffsetMask}, */ ++}; ++ ++struct rf_sniff_ent rf_write_sniff_ranges[] = { ++ /* example for all path addr 0x55 with all RF Reg mask */ ++ /* {MAX_RF_PATH, 0x55, bRFRegOffsetMask}, */ ++}; ++ ++int rf_read_sniff_num = sizeof(rf_read_sniff_ranges) / sizeof(struct rf_sniff_ent); ++int rf_write_sniff_num = sizeof(rf_write_sniff_ranges) / sizeof(struct rf_sniff_ent); ++ ++bool match_rf_read_sniff_ranges(u8 path, u32 addr, u32 mask) ++{ ++ int i; ++ ++ for (i = 0; i < rf_read_sniff_num; i++) { ++ if (rf_read_sniff_ranges[i].path == MAX_RF_PATH || rf_read_sniff_ranges[i].path == path) ++ if (addr == rf_read_sniff_ranges[i].reg && (mask & rf_read_sniff_ranges[i].mask)) ++ return _TRUE; ++ } ++ ++ return _FALSE; ++} ++ ++bool match_rf_write_sniff_ranges(u8 path, u32 addr, u32 mask) ++{ ++ int i; ++ ++ for (i = 0; i < rf_write_sniff_num; i++) { ++ if (rf_write_sniff_ranges[i].path == MAX_RF_PATH || rf_write_sniff_ranges[i].path == path) ++ if (addr == rf_write_sniff_ranges[i].reg && (mask & rf_write_sniff_ranges[i].mask)) ++ return _TRUE; ++ } ++ ++ return _FALSE; ++} ++ ++u8 dbg_rtw_read8(_adapter *adapter, u32 addr, const char *caller, const int line) ++{ ++ u8 val = _rtw_read8(adapter, addr); ++ ++ if (match_read_sniff_ranges(addr, 1)) ++ RTW_INFO("DBG_IO %s:%d rtw_read8(0x%04x) return 0x%02x\n", caller, line, addr, val); ++ ++ return val; ++} ++ ++u16 dbg_rtw_read16(_adapter *adapter, u32 addr, const char *caller, const int line) ++{ ++ u16 val = _rtw_read16(adapter, addr); ++ ++ if (match_read_sniff_ranges(addr, 2)) ++ RTW_INFO("DBG_IO %s:%d rtw_read16(0x%04x) return 0x%04x\n", caller, line, addr, val); ++ ++ return val; ++} ++ ++u32 dbg_rtw_read32(_adapter *adapter, u32 addr, const char *caller, const int line) ++{ ++ u32 val = _rtw_read32(adapter, addr); ++ ++ if (match_read_sniff_ranges(addr, 4)) ++ RTW_INFO("DBG_IO %s:%d rtw_read32(0x%04x) return 0x%08x\n", caller, line, addr, val); ++ ++ return val; ++} ++ ++int dbg_rtw_write8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line) ++{ ++ if (match_write_sniff_ranges(addr, 1)) ++ RTW_INFO("DBG_IO %s:%d rtw_write8(0x%04x, 0x%02x)\n", caller, line, addr, val); ++ ++ return _rtw_write8(adapter, addr, val); ++} ++int dbg_rtw_write16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line) ++{ ++ if (match_write_sniff_ranges(addr, 2)) ++ RTW_INFO("DBG_IO %s:%d rtw_write16(0x%04x, 0x%04x)\n", caller, line, addr, val); ++ ++ return _rtw_write16(adapter, addr, val); ++} ++int dbg_rtw_write32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line) ++{ ++ if (match_write_sniff_ranges(addr, 4)) ++ RTW_INFO("DBG_IO %s:%d rtw_write32(0x%04x, 0x%08x)\n", caller, line, addr, val); ++ ++ return _rtw_write32(adapter, addr, val); ++} ++int dbg_rtw_writeN(_adapter *adapter, u32 addr , u32 length , u8 *data, const char *caller, const int line) ++{ ++ if (match_write_sniff_ranges(addr, length)) ++ RTW_INFO("DBG_IO %s:%d rtw_writeN(0x%04x, %u)\n", caller, line, addr, length); ++ ++ return _rtw_writeN(adapter, addr, length, data); ++} ++ ++#ifdef CONFIG_SDIO_HCI ++u8 dbg_rtw_sd_f0_read8(_adapter *adapter, u32 addr, const char *caller, const int line) ++{ ++ u8 val = _rtw_sd_f0_read8(adapter, addr); ++ ++#if 0 ++ if (match_read_sniff_ranges(addr, 1)) ++ RTW_INFO("DBG_IO %s:%d rtw_sd_f0_read8(0x%04x) return 0x%02x\n", caller, line, addr, val); ++#endif ++ ++ return val; ++} ++ ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++u8 dbg_rtw_sd_iread8(_adapter *adapter, u32 addr, const char *caller, const int line) ++{ ++ u8 val = rtw_sd_iread8(adapter, addr); ++ ++ if (match_read_sniff_ranges(addr, 1)) ++ RTW_INFO("DBG_IO %s:%d rtw_sd_iread8(0x%04x) return 0x%02x\n", caller, line, addr, val); ++ ++ return val; ++} ++ ++u16 dbg_rtw_sd_iread16(_adapter *adapter, u32 addr, const char *caller, const int line) ++{ ++ u16 val = _rtw_sd_iread16(adapter, addr); ++ ++ if (match_read_sniff_ranges(addr, 2)) ++ RTW_INFO("DBG_IO %s:%d rtw_sd_iread16(0x%04x) return 0x%04x\n", caller, line, addr, val); ++ ++ return val; ++} ++ ++u32 dbg_rtw_sd_iread32(_adapter *adapter, u32 addr, const char *caller, const int line) ++{ ++ u32 val = _rtw_sd_iread32(adapter, addr); ++ ++ if (match_read_sniff_ranges(addr, 4)) ++ RTW_INFO("DBG_IO %s:%d rtw_sd_iread32(0x%04x) return 0x%08x\n", caller, line, addr, val); ++ ++ return val; ++} ++ ++int dbg_rtw_sd_iwrite8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line) ++{ ++ if (match_write_sniff_ranges(addr, 1)) ++ RTW_INFO("DBG_IO %s:%d rtw_sd_iwrite8(0x%04x, 0x%02x)\n", caller, line, addr, val); ++ ++ return _rtw_sd_iwrite8(adapter, addr, val); ++} ++int dbg_rtw_sd_iwrite16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line) ++{ ++ if (match_write_sniff_ranges(addr, 2)) ++ RTW_INFO("DBG_IO %s:%d rtw_sd_iwrite16(0x%04x, 0x%04x)\n", caller, line, addr, val); ++ ++ return _rtw_sd_iwrite16(adapter, addr, val); ++} ++int dbg_rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line) ++{ ++ if (match_write_sniff_ranges(addr, 4)) ++ RTW_INFO("DBG_IO %s:%d rtw_sd_iwrite32(0x%04x, 0x%08x)\n", caller, line, addr, val); ++ ++ return _rtw_sd_iwrite32(adapter, addr, val); ++} ++ ++#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ ++ ++#endif /* CONFIG_SDIO_HCI */ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_ioctl_query.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ioctl_query.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_ioctl_query.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ioctl_query.c 2018-02-11 21:44:27.136145918 +0200 +@@ -0,0 +1,171 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_IOCTL_QUERY_C_ ++ ++#include ++ ++ ++#ifdef PLATFORM_WINDOWS ++/* ++ * Added for WPA2-PSK, by Annie, 2005-09-20. ++ * */ ++u8 ++query_802_11_capability( ++ _adapter *Adapter, ++ u8 *pucBuf, ++ u32 *pulOutLen ++) ++{ ++ static NDIS_802_11_AUTHENTICATION_ENCRYPTION szAuthEnc[] = { ++ {Ndis802_11AuthModeOpen, Ndis802_11EncryptionDisabled}, ++ {Ndis802_11AuthModeOpen, Ndis802_11Encryption1Enabled}, ++ {Ndis802_11AuthModeShared, Ndis802_11EncryptionDisabled}, ++ {Ndis802_11AuthModeShared, Ndis802_11Encryption1Enabled}, ++ {Ndis802_11AuthModeWPA, Ndis802_11Encryption2Enabled}, ++ {Ndis802_11AuthModeWPA, Ndis802_11Encryption3Enabled}, ++ {Ndis802_11AuthModeWPAPSK, Ndis802_11Encryption2Enabled}, ++ {Ndis802_11AuthModeWPAPSK, Ndis802_11Encryption3Enabled}, ++ {Ndis802_11AuthModeWPANone, Ndis802_11Encryption2Enabled}, ++ {Ndis802_11AuthModeWPANone, Ndis802_11Encryption3Enabled}, ++ {Ndis802_11AuthModeWPA2, Ndis802_11Encryption2Enabled}, ++ {Ndis802_11AuthModeWPA2, Ndis802_11Encryption3Enabled}, ++ {Ndis802_11AuthModeWPA2PSK, Ndis802_11Encryption2Enabled}, ++ {Ndis802_11AuthModeWPA2PSK, Ndis802_11Encryption3Enabled} ++ }; ++ static ULONG ulNumOfPairSupported = sizeof(szAuthEnc) / sizeof(NDIS_802_11_AUTHENTICATION_ENCRYPTION); ++ NDIS_802_11_CAPABILITY *pCap = (NDIS_802_11_CAPABILITY *)pucBuf; ++ u8 *pucAuthEncryptionSupported = (u8 *) pCap->AuthenticationEncryptionSupported; ++ ++ ++ pCap->Length = sizeof(NDIS_802_11_CAPABILITY); ++ if (ulNumOfPairSupported > 1) ++ pCap->Length += (ulNumOfPairSupported - 1) * sizeof(NDIS_802_11_AUTHENTICATION_ENCRYPTION); ++ ++ pCap->Version = 2; ++ pCap->NoOfPMKIDs = NUM_PMKID_CACHE; ++ pCap->NoOfAuthEncryptPairsSupported = ulNumOfPairSupported; ++ ++ if (sizeof(szAuthEnc) <= 240) /* 240 = 256 - 4*4 */ { /* SecurityInfo.szCapability: only 256 bytes in size. */ ++ _rtw_memcpy(pucAuthEncryptionSupported, (u8 *)szAuthEnc, sizeof(szAuthEnc)); ++ *pulOutLen = pCap->Length; ++ return _TRUE; ++ } else { ++ *pulOutLen = 0; ++ return _FALSE; ++ } ++} ++ ++u8 query_802_11_association_information(_adapter *padapter, PNDIS_802_11_ASSOCIATION_INFORMATION pAssocInfo) ++{ ++ struct wlan_network *tgt_network; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct security_priv *psecuritypriv = &(padapter->securitypriv); ++ WLAN_BSSID_EX *psecnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; ++ u8 *pDest = (u8 *)pAssocInfo + sizeof(NDIS_802_11_ASSOCIATION_INFORMATION); ++ unsigned char i, *auth_ie, *supp_ie; ++ ++ /* NdisZeroMemory(pAssocInfo, sizeof(NDIS_802_11_ASSOCIATION_INFORMATION)); */ ++ _rtw_memset(pAssocInfo, 0, sizeof(NDIS_802_11_ASSOCIATION_INFORMATION)); ++ /* pAssocInfo->Length = sizeof(NDIS_802_11_ASSOCIATION_INFORMATION); */ ++ ++ /* ------------------------------------------------------ */ ++ /* Association Request related information */ ++ /* ------------------------------------------------------ */ ++ /* Req_1. AvailableRequestFixedIEs */ ++ if (psecnetwork != NULL) { ++ ++ pAssocInfo->AvailableRequestFixedIEs |= NDIS_802_11_AI_REQFI_CAPABILITIES | NDIS_802_11_AI_REQFI_CURRENTAPADDRESS; ++ pAssocInfo->RequestFixedIEs.Capabilities = (unsigned short) *&psecnetwork->IEs[10]; ++ _rtw_memcpy(pAssocInfo->RequestFixedIEs.CurrentAPAddress, ++ &psecnetwork->MacAddress, 6); ++ ++ pAssocInfo->OffsetRequestIEs = sizeof(NDIS_802_11_ASSOCIATION_INFORMATION); ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING | _FW_LINKED) == _TRUE) { ++ ++ if (psecuritypriv->ndisauthtype >= Ndis802_11AuthModeWPA2) ++ pDest[0] = 48; /* RSN Information Element */ ++ else ++ pDest[0] = 221; /* WPA(SSN) Information Element */ ++ ++ supp_ie = &psecuritypriv->supplicant_ie[0]; ++ ++ i = 13; /* 0~11 is fixed information element */ ++ while ((i < supp_ie[0]) && (i < 256)) { ++ if ((unsigned char)supp_ie[i] == pDest[0]) { ++ _rtw_memcpy((u8 *)(pDest), ++ &supp_ie[i], ++ supp_ie[1 + i] + 2); ++ ++ break; ++ } ++ ++ i = i + supp_ie[i + 1] + 2; ++ if (supp_ie[1 + i] == 0) ++ i = i + 1; ++ ++ } ++ ++ ++ pAssocInfo->RequestIELength += (2 + supp_ie[1 + i]); /* (2 + psecnetwork->IEs[1+i]+4); */ ++ ++ } ++ ++ ++ ++ } ++ ++ ++ /* ------------------------------------------------------ */ ++ /* Association Response related information */ ++ /* ------------------------------------------------------ */ ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ tgt_network = &(pmlmepriv->cur_network); ++ if (tgt_network != NULL) { ++ pAssocInfo->AvailableResponseFixedIEs = ++ NDIS_802_11_AI_RESFI_CAPABILITIES ++ | NDIS_802_11_AI_RESFI_ASSOCIATIONID ++ ; ++ ++ pAssocInfo->ResponseFixedIEs.Capabilities = (unsigned short) *&tgt_network->network.IEs[10]; ++ pAssocInfo->ResponseFixedIEs.StatusCode = 0; ++ pAssocInfo->ResponseFixedIEs.AssociationId = (unsigned short) tgt_network->aid; ++ ++ pDest = (u8 *)pAssocInfo + sizeof(NDIS_802_11_ASSOCIATION_INFORMATION) + pAssocInfo->RequestIELength; ++ auth_ie = &psecuritypriv->authenticator_ie[0]; ++ ++ ++ i = auth_ie[0] - 12; ++ if (i > 0) { ++ _rtw_memcpy((u8 *)&pDest[0], &auth_ie[1], i); ++ pAssocInfo->ResponseIELength = i; ++ } ++ ++ ++ pAssocInfo->OffsetResponseIEs = sizeof(NDIS_802_11_ASSOCIATION_INFORMATION) + pAssocInfo->RequestIELength; ++ ++ ++ } ++ } ++ ++ return _TRUE; ++} ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_ioctl_rtl.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ioctl_rtl.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_ioctl_rtl.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ioctl_rtl.c 2018-02-11 21:44:27.137145933 +0200 +@@ -0,0 +1,904 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_IOCTL_RTL_C_ ++ ++#include ++ ++#ifdef CONFIG_MP_INCLUDED ++ #include ++#endif ++ ++struct oid_obj_priv oid_rtl_seg_01_01[] = { ++ {1, &oid_null_function}, /* 0x80 */ ++ {1, &oid_null_function}, /* 0x81 */ ++ {1, &oid_null_function}, /* 0x82 */ ++ {1, &oid_null_function}, /* 0x83 */ /* OID_RT_SET_SNIFFER_MODE */ ++ {1, &oid_rt_get_signal_quality_hdl}, /* 0x84 */ ++ {1, &oid_rt_get_small_packet_crc_hdl}, /* 0x85 */ ++ {1, &oid_rt_get_middle_packet_crc_hdl}, /* 0x86 */ ++ {1, &oid_rt_get_large_packet_crc_hdl}, /* 0x87 */ ++ {1, &oid_rt_get_tx_retry_hdl}, /* 0x88 */ ++ {1, &oid_rt_get_rx_retry_hdl}, /* 0x89 */ ++ {1, &oid_rt_pro_set_fw_dig_state_hdl}, /* 0x8A */ ++ {1, &oid_rt_pro_set_fw_ra_state_hdl} , /* 0x8B */ ++ {1, &oid_null_function}, /* 0x8C */ ++ {1, &oid_null_function}, /* 0x8D */ ++ {1, &oid_null_function}, /* 0x8E */ ++ {1, &oid_null_function}, /* 0x8F */ ++ {1, &oid_rt_get_rx_total_packet_hdl}, /* 0x90 */ ++ {1, &oid_rt_get_tx_beacon_ok_hdl}, /* 0x91 */ ++ {1, &oid_rt_get_tx_beacon_err_hdl}, /* 0x92 */ ++ {1, &oid_rt_get_rx_icv_err_hdl}, /* 0x93 */ ++ {1, &oid_rt_set_encryption_algorithm_hdl}, /* 0x94 */ ++ {1, &oid_null_function}, /* 0x95 */ ++ {1, &oid_rt_get_preamble_mode_hdl}, /* 0x96 */ ++ {1, &oid_null_function}, /* 0x97 */ ++ {1, &oid_rt_get_ap_ip_hdl}, /* 0x98 */ ++ {1, &oid_rt_get_channelplan_hdl}, /* 0x99 */ ++ {1, &oid_rt_set_preamble_mode_hdl}, /* 0x9A */ ++ {1, &oid_rt_set_bcn_intvl_hdl}, /* 0x9B */ ++ {1, &oid_null_function}, /* 0x9C */ ++ {1, &oid_rt_dedicate_probe_hdl}, /* 0x9D */ ++ {1, &oid_null_function}, /* 0x9E */ ++ {1, &oid_null_function}, /* 0x9F */ ++ {1, &oid_null_function}, /* 0xA0 */ ++ {1, &oid_null_function}, /* 0xA1 */ ++ {1, &oid_null_function}, /* 0xA2 */ ++ {1, &oid_null_function}, /* 0xA3 */ ++ {1, &oid_null_function}, /* 0xA4 */ ++ {1, &oid_null_function}, /* 0xA5 */ ++ {1, &oid_null_function}, /* 0xA6 */ ++ {1, &oid_rt_get_total_tx_bytes_hdl}, /* 0xA7 */ ++ {1, &oid_rt_get_total_rx_bytes_hdl}, /* 0xA8 */ ++ {1, &oid_rt_current_tx_power_level_hdl}, /* 0xA9 */ ++ {1, &oid_rt_get_enc_key_mismatch_count_hdl}, /* 0xAA */ ++ {1, &oid_rt_get_enc_key_match_count_hdl}, /* 0xAB */ ++ {1, &oid_rt_get_channel_hdl}, /* 0xAC */ ++ {1, &oid_rt_set_channelplan_hdl}, /* 0xAD */ ++ {1, &oid_rt_get_hardware_radio_off_hdl}, /* 0xAE */ ++ {1, &oid_null_function}, /* 0xAF */ ++ {1, &oid_null_function}, /* 0xB0 */ ++ {1, &oid_null_function}, /* 0xB1 */ ++ {1, &oid_null_function}, /* 0xB2 */ ++ {1, &oid_null_function}, /* 0xB3 */ ++ {1, &oid_rt_get_key_mismatch_hdl}, /* 0xB4 */ ++ {1, &oid_null_function}, /* 0xB5 */ ++ {1, &oid_null_function}, /* 0xB6 */ ++ {1, &oid_null_function}, /* 0xB7 */ ++ {1, &oid_null_function}, /* 0xB8 */ ++ {1, &oid_null_function}, /* 0xB9 */ ++ {1, &oid_null_function}, /* 0xBA */ ++ {1, &oid_rt_supported_wireless_mode_hdl}, /* 0xBB */ ++ {1, &oid_rt_get_channel_list_hdl}, /* 0xBC */ ++ {1, &oid_rt_get_scan_in_progress_hdl}, /* 0xBD */ ++ {1, &oid_null_function}, /* 0xBE */ ++ {1, &oid_null_function}, /* 0xBF */ ++ {1, &oid_null_function}, /* 0xC0 */ ++ {1, &oid_rt_forced_data_rate_hdl}, /* 0xC1 */ ++ {1, &oid_rt_wireless_mode_for_scan_list_hdl}, /* 0xC2 */ ++ {1, &oid_rt_get_bss_wireless_mode_hdl}, /* 0xC3 */ ++ {1, &oid_rt_scan_with_magic_packet_hdl}, /* 0xC4 */ ++ {1, &oid_null_function}, /* 0xC5 */ ++ {1, &oid_null_function}, /* 0xC6 */ ++ {1, &oid_null_function}, /* 0xC7 */ ++ {1, &oid_null_function}, /* 0xC8 */ ++ {1, &oid_null_function}, /* 0xC9 */ ++ {1, &oid_null_function}, /* 0xCA */ ++ {1, &oid_null_function}, /* 0xCB */ ++ {1, &oid_null_function}, /* 0xCC */ ++ {1, &oid_null_function}, /* 0xCD */ ++ {1, &oid_null_function}, /* 0xCE */ ++ {1, &oid_null_function}, /* 0xCF */ ++ ++}; ++ ++struct oid_obj_priv oid_rtl_seg_01_03[] = { ++ {1, &oid_rt_ap_get_associated_station_list_hdl}, /* 0x00 */ ++ {1, &oid_null_function}, /* 0x01 */ ++ {1, &oid_rt_ap_switch_into_ap_mode_hdl}, /* 0x02 */ ++ {1, &oid_null_function}, /* 0x03 */ ++ {1, &oid_rt_ap_supported_hdl}, /* 0x04 */ ++ {1, &oid_rt_ap_set_passphrase_hdl}, /* 0x05 */ ++ ++}; ++ ++struct oid_obj_priv oid_rtl_seg_01_11[] = { ++ {1, &oid_null_function}, /* 0xC0 OID_RT_PRO_RX_FILTER */ ++ {1, &oid_null_function}, /* 0xC1 OID_CE_USB_WRITE_REGISTRY */ ++ {1, &oid_null_function}, /* 0xC2 OID_CE_USB_READ_REGISTRY */ ++ {1, &oid_null_function}, /* 0xC3 OID_RT_PRO_SET_INITIAL_GAIN */ ++ {1, &oid_null_function}, /* 0xC4 OID_RT_PRO_SET_BB_RF_STANDBY_MODE */ ++ {1, &oid_null_function}, /* 0xC5 OID_RT_PRO_SET_BB_RF_SHUTDOWN_MODE */ ++ {1, &oid_null_function}, /* 0xC6 OID_RT_PRO_SET_TX_CHARGE_PUMP */ ++ {1, &oid_null_function}, /* 0xC7 OID_RT_PRO_SET_RX_CHARGE_PUMP */ ++ {1, &oid_rt_pro_rf_write_registry_hdl}, /* 0xC8 */ ++ {1, &oid_rt_pro_rf_read_registry_hdl}, /* 0xC9 */ ++ {1, &oid_null_function} /* 0xCA OID_RT_PRO_QUERY_RF_TYPE */ ++ ++}; ++ ++struct oid_obj_priv oid_rtl_seg_03_00[] = { ++ {1, &oid_null_function}, /* 0x00 */ ++ {1, &oid_rt_get_connect_state_hdl}, /* 0x01 */ ++ {1, &oid_null_function}, /* 0x02 */ ++ {1, &oid_null_function}, /* 0x03 */ ++ {1, &oid_rt_set_default_key_id_hdl}, /* 0x04 */ ++ ++ ++}; ++ ++ ++/* ************** oid_rtl_seg_01_01 section start ************** */ ++ ++NDIS_STATUS oid_rt_pro_set_fw_dig_state_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ _irqL oldirql; ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ if (poid_par_priv->information_buf_len >= sizeof(struct setdig_parm)) { ++ /* DEBUG_ERR(("===> oid_rt_pro_set_fw_dig_state_hdl. type:0x%02x.\n",*((unsigned char*)poid_par_priv->information_buf ))); */ ++ if (!rtw_setfwdig_cmd(Adapter, *((unsigned char *)poid_par_priv->information_buf))) ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ ++ } else ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ _irqlevel_changed_(&oldirql, RAISE); ++#endif ++ return status; ++} ++/* ----------------------------------------------------------------------------- */ ++NDIS_STATUS oid_rt_pro_set_fw_ra_state_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ _irqL oldirql; ++ ++ if (poid_par_priv->type_of_oid != SET_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ if (poid_par_priv->information_buf_len >= sizeof(struct setra_parm)) { ++ /* DEBUG_ERR(("===> oid_rt_pro_set_fw_ra_state_hdl. type:0x%02x.\n",*((unsigned char*)poid_par_priv->information_buf ))); */ ++ if (!rtw_setfwra_cmd(Adapter, *((unsigned char *)poid_par_priv->information_buf))) ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ ++ } else ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ _irqlevel_changed_(&oldirql, RAISE); ++#endif ++ return status; ++} ++/* ----------------------------------------------------------------------------- */ ++NDIS_STATUS oid_rt_get_signal_quality_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ /* DEBUG_ERR(("<**********************oid_rt_get_signal_quality_hdl\n")); */ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++#if 0 ++ if (pMgntInfo->mAssoc || pMgntInfo->mIbss) { ++ ulInfo = pAdapter->RxStats.SignalQuality; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else { ++ ulInfo = 0xffffffff; /* It stands for -1 in 4-byte integer. */ ++ } ++ break; ++#endif ++ ++ return status; ++} ++ ++/* ------------------------------------------------------------------------------ */ ++ ++NDIS_STATUS oid_rt_get_small_packet_crc_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { ++ *(ULONG *)poid_par_priv->information_buf = padapter->recvpriv.rx_smallpacket_crcerr; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH; ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_middle_packet_crc_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { ++ *(ULONG *)poid_par_priv->information_buf = padapter->recvpriv.rx_middlepacket_crcerr; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH; ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_large_packet_crc_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { ++ *(ULONG *)poid_par_priv->information_buf = padapter->recvpriv.rx_largepacket_crcerr; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH; ++ ++ ++ return status; ++} ++ ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_tx_retry_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++NDIS_STATUS oid_rt_get_rx_retry_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_rx_total_packet_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { ++ *(u64 *)poid_par_priv->information_buf = padapter->recvpriv.rx_pkts + padapter->recvpriv.rx_drop; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH; ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_tx_beacon_ok_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++NDIS_STATUS oid_rt_get_tx_beacon_err_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_rx_icv_err_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ if (poid_par_priv->information_buf_len >= sizeof(u32)) { ++ /* _rtw_memcpy(*(uint *)poid_par_priv->information_buf,padapter->recvpriv.rx_icv_err,sizeof(u32)); */ ++ *(uint *)poid_par_priv->information_buf = padapter->recvpriv.rx_icv_err; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH ; ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_set_encryption_algorithm_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != SET_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_preamble_mode_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ULONG preamblemode = 0 ; ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { ++ if (padapter->registrypriv.preamble == PREAMBLE_LONG) ++ preamblemode = 0; ++ else if (padapter->registrypriv.preamble == PREAMBLE_AUTO) ++ preamblemode = 1; ++ else if (padapter->registrypriv.preamble == PREAMBLE_SHORT) ++ preamblemode = 2; ++ ++ ++ *(ULONG *)poid_par_priv->information_buf = preamblemode ; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH ; ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_ap_ip_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++ ++NDIS_STATUS oid_rt_get_channelplan_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ *(u16 *)poid_par_priv->information_buf = padapter->mlmepriv.ChannelPlan ; ++ ++ return status; ++} ++NDIS_STATUS oid_rt_set_channelplan_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != SET_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ padapter->mlmepriv.ChannelPlan = *(u16 *)poid_par_priv->information_buf ; ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_set_preamble_mode_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ULONG preamblemode = 0; ++ if (poid_par_priv->type_of_oid != SET_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { ++ preamblemode = *(ULONG *)poid_par_priv->information_buf ; ++ if (preamblemode == 0) ++ padapter->registrypriv.preamble = PREAMBLE_LONG; ++ else if (preamblemode == 1) ++ padapter->registrypriv.preamble = PREAMBLE_AUTO; ++ else if (preamblemode == 2) ++ padapter->registrypriv.preamble = PREAMBLE_SHORT; ++ ++ *(ULONG *)poid_par_priv->information_buf = preamblemode ; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH ; ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_set_bcn_intvl_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != SET_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++NDIS_STATUS oid_rt_dedicate_probe_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_total_tx_bytes_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { ++ *(u64 *)poid_par_priv->information_buf = padapter->xmitpriv.tx_bytes; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH ; ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_total_rx_bytes_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { ++ /* _rtw_memcpy(*(uint *)poid_par_priv->information_buf,padapter->recvpriv.rx_icv_err,sizeof(u32)); */ ++ *(u64 *)poid_par_priv->information_buf = padapter->recvpriv.rx_bytes; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH ; ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_current_tx_power_level_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ return status; ++} ++NDIS_STATUS oid_rt_get_enc_key_mismatch_count_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++NDIS_STATUS oid_rt_get_enc_key_match_count_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++NDIS_STATUS oid_rt_get_channel_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ NDIS_802_11_CONFIGURATION *pnic_Config; ++ ++ ULONG channelnum; ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) ++ pnic_Config = &pmlmepriv->cur_network.network.Configuration; ++ else ++ pnic_Config = &padapter->registrypriv.dev_network.Configuration; ++ ++ channelnum = pnic_Config->DSConfig; ++ *(ULONG *)poid_par_priv->information_buf = channelnum; ++ ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ ++ ++ return status; ++} ++NDIS_STATUS oid_rt_get_hardware_radio_off_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++NDIS_STATUS oid_rt_get_key_mismatch_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++NDIS_STATUS oid_rt_supported_wireless_mode_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ULONG ulInfo = 0 ; ++ /* DEBUG_ERR(("<**********************oid_rt_supported_wireless_mode_hdl\n")); */ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { ++ ulInfo |= 0x0100; /* WIRELESS_MODE_B */ ++ ulInfo |= 0x0200; /* WIRELESS_MODE_G */ ++ ulInfo |= 0x0400; /* WIRELESS_MODE_A */ ++ ++ *(ULONG *) poid_par_priv->information_buf = ulInfo; ++ /* DEBUG_ERR(("<===oid_rt_supported_wireless_mode %x\n",ulInfo)); */ ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH; ++ ++ return status; ++} ++NDIS_STATUS oid_rt_get_channel_list_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++NDIS_STATUS oid_rt_get_scan_in_progress_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++ ++ ++NDIS_STATUS oid_rt_forced_data_rate_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ return status; ++} ++NDIS_STATUS oid_rt_wireless_mode_for_scan_list_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ return status; ++} ++NDIS_STATUS oid_rt_get_bss_wireless_mode_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++ ++NDIS_STATUS oid_rt_scan_with_magic_packet_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ return status; ++} ++/* ************** oid_rtl_seg_01_01 section end ************** */ ++ ++/* ************** oid_rtl_seg_01_03 section start ************** */ ++NDIS_STATUS oid_rt_ap_get_associated_station_list_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++NDIS_STATUS oid_rt_ap_switch_into_ap_mode_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ return status; ++} ++NDIS_STATUS oid_rt_ap_supported_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ return status; ++} ++NDIS_STATUS oid_rt_ap_set_passphrase_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != SET_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++ ++/* ************** oid_rtl_seg_01_03 section end ************** */ ++ ++/* **************** oid_rtl_seg_01_11 section start **************** */ ++NDIS_STATUS oid_rt_pro_rf_write_registry_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ _irqL oldirql; ++ /* DEBUG_ERR(("<**********************oid_rt_pro_rf_write_registry_hdl\n")); */ ++ if (poid_par_priv->type_of_oid != SET_OID) { /* QUERY_OID */ ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ if (poid_par_priv->information_buf_len == (sizeof(unsigned long) * 3)) { ++ /* RegOffsetValue - The offset of RF register to write. */ ++ /* RegDataWidth - The data width of RF register to write. */ ++ /* RegDataValue - The value to write. */ ++ /* RegOffsetValue = *((unsigned long*)InformationBuffer); */ ++ /* RegDataWidth = *((unsigned long*)InformationBuffer+1); */ ++ /* RegDataValue = *((unsigned long*)InformationBuffer+2); */ ++ if (!rtw_setrfreg_cmd(Adapter, ++ *(unsigned char *)poid_par_priv->information_buf, ++ (unsigned long)(*((unsigned long *)poid_par_priv->information_buf + 2)))) ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH; ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ return status; ++} ++ ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_rf_read_registry_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ _irqL oldirql; ++ ++ /* DEBUG_ERR(("<**********************oid_rt_pro_rf_read_registry_hdl\n")); */ ++ if (poid_par_priv->type_of_oid != SET_OID) { /* QUERY_OID */ ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ if (poid_par_priv->information_buf_len == (sizeof(unsigned long) * 3)) { ++ if (Adapter->mppriv.act_in_progress == _TRUE) ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ else { ++ /* init workparam */ ++ Adapter->mppriv.act_in_progress = _TRUE; ++ Adapter->mppriv.workparam.bcompleted = _FALSE; ++ Adapter->mppriv.workparam.act_type = MPT_READ_RF; ++ Adapter->mppriv.workparam.io_offset = *(unsigned long *)poid_par_priv->information_buf; ++ Adapter->mppriv.workparam.io_value = 0xcccccccc; ++ ++ /* RegOffsetValue - The offset of RF register to read. */ ++ /* RegDataWidth - The data width of RF register to read. */ ++ /* RegDataValue - The value to read. */ ++ /* RegOffsetValue = *((unsigned long*)InformationBuffer); */ ++ /* RegDataWidth = *((unsigned long*)InformationBuffer+1); */ ++ /* RegDataValue = *((unsigned long*)InformationBuffer+2); */ ++ if (!rtw_getrfreg_cmd(Adapter, ++ *(unsigned char *)poid_par_priv->information_buf, ++ (unsigned char *)&Adapter->mppriv.workparam.io_value)) ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ } ++ ++ ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH; ++ _irqlevel_changed_(&oldirql, RAISE); ++#endif ++ return status; ++} ++ ++/* **************** oid_rtl_seg_01_11 section end**************** */ ++ ++ ++/* ************** oid_rtl_seg_03_00 section start ************** */ ++enum _CONNECT_STATE_ { ++ CHECKINGSTATUS, ++ ASSOCIATED, ++ ADHOCMODE, ++ NOTASSOCIATED ++}; ++ ++NDIS_STATUS oid_rt_get_connect_state_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ ULONG ulInfo; ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ /* nStatus==0 CheckingStatus */ ++ /* nStatus==1 Associated */ ++ /* nStatus==2 AdHocMode */ ++ /* nStatus==3 NotAssociated */ ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) ++ ulInfo = CHECKINGSTATUS; ++ else if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ ulInfo = ASSOCIATED; ++ else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) ++ ulInfo = ADHOCMODE; ++ else ++ ulInfo = NOTASSOCIATED ; ++ ++ *(ULONG *)poid_par_priv->information_buf = ulInfo; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++#if 0 ++ /* Rearrange the order to let the UI still shows connection when scan is in progress */ ++ if (pMgntInfo->mAssoc) ++ ulInfo = 1; ++ else if (pMgntInfo->mIbss) ++ ulInfo = 2; ++ else if (pMgntInfo->bScanInProgress) ++ ulInfo = 0; ++ else ++ ulInfo = 3; ++ ulInfoLen = sizeof(ULONG); ++#endif ++ ++ return status; ++} ++ ++NDIS_STATUS oid_rt_set_default_key_id_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ if (poid_par_priv->type_of_oid != SET_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ return status; ++} ++/* ************** oid_rtl_seg_03_00 section end ************** */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_ioctl_set.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ioctl_set.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_ioctl_set.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ioctl_set.c 2018-02-11 21:44:27.137145933 +0200 +@@ -0,0 +1,1252 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_IOCTL_SET_C_ ++ ++#include ++#include ++ ++ ++extern void indicate_wx_scan_complete_event(_adapter *padapter); ++ ++#define IS_MAC_ADDRESS_BROADCAST(addr) \ ++ (\ ++ ((addr[0] == 0xff) && (addr[1] == 0xff) && \ ++ (addr[2] == 0xff) && (addr[3] == 0xff) && \ ++ (addr[4] == 0xff) && (addr[5] == 0xff)) ? _TRUE : _FALSE \ ++ ) ++ ++u8 rtw_validate_bssid(u8 *bssid) ++{ ++ u8 ret = _TRUE; ++ ++ if (is_zero_mac_addr(bssid) ++ || is_broadcast_mac_addr(bssid) ++ || is_multicast_mac_addr(bssid) ++ ) ++ ret = _FALSE; ++ ++ return ret; ++} ++ ++u8 rtw_validate_ssid(NDIS_802_11_SSID *ssid) ++{ ++ u8 i; ++ u8 ret = _TRUE; ++ ++ ++ if (ssid->SsidLength > 32) { ++ ret = _FALSE; ++ goto exit; ++ } ++ ++#ifdef CONFIG_VALIDATE_SSID ++ for (i = 0; i < ssid->SsidLength; i++) { ++ /* wifi, printable ascii code must be supported */ ++ if (!((ssid->Ssid[i] >= 0x20) && (ssid->Ssid[i] <= 0x7e))) { ++ ret = _FALSE; ++ break; ++ } ++ } ++#endif /* CONFIG_VALIDATE_SSID */ ++ ++exit: ++ ++ ++ return ret; ++} ++ ++u8 rtw_do_join(_adapter *padapter); ++u8 rtw_do_join(_adapter *padapter) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ u8 *pibss = NULL; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ u8 ret = _SUCCESS; ++ ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ ++ pmlmepriv->cur_network.join_res = -2; ++ ++ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); ++ ++ pmlmepriv->pscanned = plist; ++ ++ pmlmepriv->to_join = _TRUE; ++ ++ if (_rtw_queue_empty(queue) == _TRUE) { ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); ++ ++ /* when set_ssid/set_bssid for rtw_do_join(), but scanning queue is empty */ ++ /* we try to issue sitesurvey firstly */ ++ ++ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == _FALSE ++ || rtw_to_roam(padapter) > 0 ++ ) { ++ /* submit site_survey_cmd */ ++ ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); ++ if (_SUCCESS != ret) { ++ pmlmepriv->to_join = _FALSE; ++ } ++ } else { ++ pmlmepriv->to_join = _FALSE; ++ ret = _FAIL; ++ } ++ ++ goto exit; ++ } else { ++ int select_ret; ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ select_ret = rtw_select_and_join_from_scanned_queue(pmlmepriv); ++ if (select_ret == _SUCCESS) { ++ pmlmepriv->to_join = _FALSE; ++ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); ++ } else { ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) { ++ /* submit createbss_cmd to change to a ADHOC_MASTER */ ++ ++ /* pmlmepriv->lock has been acquired by caller... */ ++ WLAN_BSSID_EX *pdev_network = &(padapter->registrypriv.dev_network); ++ ++ /*pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;*/ ++ init_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); ++ ++ pibss = padapter->registrypriv.dev_network.MacAddress; ++ ++ _rtw_memset(&pdev_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); ++ _rtw_memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); ++ ++ rtw_update_registrypriv_dev_network(padapter); ++ ++ rtw_generate_random_ibss(pibss); ++ ++ if (rtw_create_ibss_cmd(padapter, 0) != _SUCCESS) { ++ ret = _FALSE; ++ goto exit; ++ } ++ ++ pmlmepriv->to_join = _FALSE; ++ ++ ++ } else { ++ /* can't associate ; reset under-linking */ ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); ++ ++#if 0 ++ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)) { ++ if (_rtw_memcmp(pmlmepriv->cur_network.network.Ssid.Ssid, pmlmepriv->assoc_ssid.Ssid, pmlmepriv->assoc_ssid.SsidLength)) { ++ /* for funk to do roaming */ ++ /* funk will reconnect, but funk will not sitesurvey before reconnect */ ++ if (pmlmepriv->sitesurveyctrl.traffic_busy == _FALSE) ++ rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); ++ } ++ ++ } ++#endif ++ ++ /* when set_ssid/set_bssid for rtw_do_join(), but there are no desired bss in scanning queue */ ++ /* we try to issue sitesurvey firstly */ ++ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == _FALSE ++ || rtw_to_roam(padapter) > 0 ++ ) { ++ /* RTW_INFO("rtw_do_join() when no desired bss in scanning queue\n"); */ ++ ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); ++ if (_SUCCESS != ret) { ++ pmlmepriv->to_join = _FALSE; ++ } ++ } else { ++ ret = _FAIL; ++ pmlmepriv->to_join = _FALSE; ++ } ++ } ++ ++ } ++ ++ } ++ ++exit: ++ ++ return ret; ++} ++ ++#ifdef PLATFORM_WINDOWS ++u8 rtw_pnp_set_power_wakeup(_adapter *padapter) ++{ ++ u8 res = _SUCCESS; ++ ++ ++ ++ res = rtw_setstandby_cmd(padapter, 0); ++ ++ ++ ++ return res; ++} ++ ++u8 rtw_pnp_set_power_sleep(_adapter *padapter) ++{ ++ u8 res = _SUCCESS; ++ ++ ++ /* DbgPrint("+rtw_pnp_set_power_sleep\n"); */ ++ ++ res = rtw_setstandby_cmd(padapter, 1); ++ ++ ++ ++ return res; ++} ++ ++u8 rtw_set_802_11_reload_defaults(_adapter *padapter, NDIS_802_11_RELOAD_DEFAULTS reloadDefaults) ++{ ++ ++ ++ ++ /* SecClearAllKeys(Adapter); */ ++ /* 8711 CAM was not for En/Decrypt only */ ++ /* so, we can't clear all keys. */ ++ /* should we disable WPAcfg (ox0088) bit 1-2, instead of clear all CAM */ ++ ++ /* TO DO... */ ++ ++ ++ return _TRUE; ++} ++ ++u8 set_802_11_test(_adapter *padapter, NDIS_802_11_TEST *test) ++{ ++ u8 ret = _TRUE; ++ ++ ++ switch (test->Type) { ++ case 1: ++ NdisMIndicateStatus(padapter->hndis_adapter, NDIS_STATUS_MEDIA_SPECIFIC_INDICATION, (PVOID)&test->AuthenticationEvent, test->Length - 8); ++ NdisMIndicateStatusComplete(padapter->hndis_adapter); ++ break; ++ ++ case 2: ++ NdisMIndicateStatus(padapter->hndis_adapter, NDIS_STATUS_MEDIA_SPECIFIC_INDICATION, (PVOID)&test->RssiTrigger, sizeof(NDIS_802_11_RSSI)); ++ NdisMIndicateStatusComplete(padapter->hndis_adapter); ++ break; ++ ++ default: ++ ret = _FALSE; ++ break; ++ } ++ ++ ++ return ret; ++} ++ ++u8 rtw_set_802_11_pmkid(_adapter *padapter, NDIS_802_11_PMKID *pmkid) ++{ ++ u8 ret = _SUCCESS; ++ ++ return ret; ++} ++ ++#endif ++ ++u8 rtw_set_802_11_bssid(_adapter *padapter, u8 *bssid) ++{ ++ _irqL irqL; ++ u8 status = _SUCCESS; ++ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ ++ RTW_PRINT("set bssid:%pM\n", bssid); ++ ++ if ((bssid[0] == 0x00 && bssid[1] == 0x00 && bssid[2] == 0x00 && bssid[3] == 0x00 && bssid[4] == 0x00 && bssid[5] == 0x00) || ++ (bssid[0] == 0xFF && bssid[1] == 0xFF && bssid[2] == 0xFF && bssid[3] == 0xFF && bssid[4] == 0xFF && bssid[5] == 0xFF)) { ++ status = _FAIL; ++ goto exit; ++ } ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ ++ RTW_INFO("Set BSSID under fw_state=0x%08x\n", get_fwstate(pmlmepriv)); ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) ++ goto handle_tkip_countermeasure; ++ else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) ++ goto release_mlme_lock; ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED | WIFI_ADHOC_MASTER_STATE) == _TRUE) { ++ ++ if (_rtw_memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid, ETH_ALEN) == _TRUE) { ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _FALSE) ++ goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */ ++ } else { ++ ++ rtw_disassoc_cmd(padapter, 0, _TRUE); ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ ++ rtw_free_assoc_resources(padapter, 1); ++ ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { ++ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); ++ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); ++ } ++ } ++ } ++ ++handle_tkip_countermeasure: ++ if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { ++ status = _FAIL; ++ goto release_mlme_lock; ++ } ++ ++ _rtw_memset(&pmlmepriv->assoc_ssid, 0, sizeof(NDIS_802_11_SSID)); ++ _rtw_memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN); ++ pmlmepriv->assoc_by_bssid = _TRUE; ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) ++ pmlmepriv->to_join = _TRUE; ++ else ++ status = rtw_do_join(padapter); ++ ++release_mlme_lock: ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++exit: ++ ++ ++ return status; ++} ++ ++u8 rtw_set_802_11_ssid(_adapter *padapter, NDIS_802_11_SSID *ssid) ++{ ++ _irqL irqL; ++ u8 status = _SUCCESS; ++ u32 cur_time = 0; ++ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wlan_network *pnetwork = &pmlmepriv->cur_network; ++ ++ ++ RTW_PRINT("set ssid [%s] fw_state=0x%08x\n", ++ ssid->Ssid, get_fwstate(pmlmepriv)); ++ ++ if (!rtw_is_hw_init_completed(padapter)) { ++ status = _FAIL; ++ goto exit; ++ } ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ RTW_INFO("Set SSID under fw_state=0x%08x\n", get_fwstate(pmlmepriv)); ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) ++ goto handle_tkip_countermeasure; ++ else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) ++ goto release_mlme_lock; ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED | WIFI_ADHOC_MASTER_STATE) == _TRUE) { ++ ++ if ((pmlmepriv->assoc_ssid.SsidLength == ssid->SsidLength) && ++ (_rtw_memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid, ssid->SsidLength) == _TRUE)) { ++ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _FALSE)) { ++ ++ if (rtw_is_same_ibss(padapter, pnetwork) == _FALSE) { ++ /* if in WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE, create bss or rejoin again */ ++ rtw_disassoc_cmd(padapter, 0, _TRUE); ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ ++ rtw_free_assoc_resources(padapter, 1); ++ ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) { ++ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); ++ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); ++ } ++ } else { ++ goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */ ++ } ++ } ++#ifdef CONFIG_LPS ++ else ++ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_JOINBSS, 1); ++#endif ++ } else { ++ ++ rtw_disassoc_cmd(padapter, 0, _TRUE); ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ ++ rtw_free_assoc_resources(padapter, 1); ++ ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) { ++ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); ++ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); ++ } ++ } ++ } ++ ++handle_tkip_countermeasure: ++ if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { ++ status = _FAIL; ++ goto release_mlme_lock; ++ } ++ ++ if (rtw_validate_ssid(ssid) == _FALSE) { ++ status = _FAIL; ++ goto release_mlme_lock; ++ } ++ ++ _rtw_memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(NDIS_802_11_SSID)); ++ pmlmepriv->assoc_by_bssid = _FALSE; ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) ++ pmlmepriv->to_join = _TRUE; ++ else ++ status = rtw_do_join(padapter); ++ ++release_mlme_lock: ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++exit: ++ ++ ++ return status; ++ ++} ++ ++u8 rtw_set_802_11_connect(_adapter *padapter, u8 *bssid, NDIS_802_11_SSID *ssid) ++{ ++ _irqL irqL; ++ u8 status = _SUCCESS; ++ u32 cur_time = 0; ++ bool bssid_valid = _TRUE; ++ bool ssid_valid = _TRUE; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ ++ if (!ssid || rtw_validate_ssid(ssid) == _FALSE) ++ ssid_valid = _FALSE; ++ ++ if (!bssid || rtw_validate_bssid(bssid) == _FALSE) ++ bssid_valid = _FALSE; ++ ++ if (ssid_valid == _FALSE && bssid_valid == _FALSE) { ++ RTW_INFO(FUNC_ADPT_FMT" ssid:%p, ssid_valid:%d, bssid:%p, bssid_valid:%d\n", ++ FUNC_ADPT_ARG(padapter), ssid, ssid_valid, bssid, bssid_valid); ++ status = _FAIL; ++ goto exit; ++ } ++ ++ if (!rtw_is_hw_init_completed(padapter)) { ++ status = _FAIL; ++ goto exit; ++ } ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ RTW_PRINT(FUNC_ADPT_FMT" fw_state=0x%08x\n", ++ FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) ++ goto handle_tkip_countermeasure; ++ else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) ++ goto release_mlme_lock; ++ ++handle_tkip_countermeasure: ++ if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { ++ status = _FAIL; ++ goto release_mlme_lock; ++ } ++ ++ if (ssid && ssid_valid) ++ _rtw_memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(NDIS_802_11_SSID)); ++ else ++ _rtw_memset(&pmlmepriv->assoc_ssid, 0, sizeof(NDIS_802_11_SSID)); ++ ++ if (bssid && bssid_valid) { ++ _rtw_memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN); ++ pmlmepriv->assoc_by_bssid = _TRUE; ++ } else ++ pmlmepriv->assoc_by_bssid = _FALSE; ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) ++ pmlmepriv->to_join = _TRUE; ++ else ++ status = rtw_do_join(padapter); ++ ++release_mlme_lock: ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++exit: ++ ++ ++ return status; ++} ++ ++u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, ++ NDIS_802_11_NETWORK_INFRASTRUCTURE networktype) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wlan_network *cur_network = &pmlmepriv->cur_network; ++ NDIS_802_11_NETWORK_INFRASTRUCTURE *pold_state = &(cur_network->network.InfrastructureMode); ++ ++ ++ ++ if (*pold_state != networktype) { ++ /* RTW_INFO("change mode, old_mode=%d, new_mode=%d, fw_state=0x%x\n", *pold_state, networktype, get_fwstate(pmlmepriv)); */ ++ ++ if (*pold_state == Ndis802_11APMode) { ++ /* change to other mode from Ndis802_11APMode */ ++ cur_network->join_res = -1; ++ ++#ifdef CONFIG_NATIVEAP_MLME ++ stop_ap_mode(padapter); ++#endif ++ } ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) || (*pold_state == Ndis802_11IBSS)) ++ rtw_disassoc_cmd(padapter, 0, _TRUE); ++ ++ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) ++ rtw_free_assoc_resources(padapter, 1); ++ ++ if ((*pold_state == Ndis802_11Infrastructure) || (*pold_state == Ndis802_11IBSS)) { ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ rtw_indicate_disconnect(padapter, 0, _FALSE); /*will clr Linked_state; before this function, we must have checked whether issue dis-assoc_cmd or not*/ ++ } ++ } ++ ++ *pold_state = networktype; ++ ++ _clr_fwstate_(pmlmepriv, ~WIFI_NULL_STATE); ++ ++ switch (networktype) { ++ case Ndis802_11IBSS: ++ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); ++ break; ++ ++ case Ndis802_11Infrastructure: ++ set_fwstate(pmlmepriv, WIFI_STATION_STATE); ++ break; ++ ++ case Ndis802_11APMode: ++ set_fwstate(pmlmepriv, WIFI_AP_STATE); ++#ifdef CONFIG_NATIVEAP_MLME ++ start_ap_mode(padapter); ++ /* rtw_indicate_connect(padapter); */ ++#endif ++ ++ break; ++ ++ case Ndis802_11AutoUnknown: ++ case Ndis802_11InfrastructureMax: ++ break; ++ case Ndis802_11Monitor: ++ set_fwstate(pmlmepriv, WIFI_MONITOR_STATE); ++ break; ++ } ++ ++ /* SecClearAllKeys(adapter); */ ++ ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ } ++ ++ ++ return _TRUE; ++} ++ ++ ++u8 rtw_set_802_11_disassociate(_adapter *padapter) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ ++ rtw_disassoc_cmd(padapter, 0, _TRUE); ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ /* modify for CONFIG_IEEE80211W, none 11w can use it */ ++ rtw_free_assoc_resources_cmd(padapter); ++ if (_FAIL == rtw_pwr_wakeup(padapter)) ++ RTW_INFO("%s(): rtw_pwr_wakeup fail !!!\n", __FUNCTION__); ++ } ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ ++ return _TRUE; ++} ++ ++#if 1 ++u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, NDIS_802_11_SSID *pssid, int ssid_max_num, struct rtw_ieee80211_channel *ch, int ch_num) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ u8 res = _TRUE; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, ch, ch_num); ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ return res; ++} ++ ++#else ++u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, NDIS_802_11_SSID *pssid, int ssid_max_num, struct rtw_ieee80211_channel *ch, int ch_num) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ u8 res = _TRUE; ++ ++ ++ ++ if (padapter == NULL) { ++ res = _FALSE; ++ goto exit; ++ } ++ if (!rtw_is_hw_init_completed(padapter)) { ++ res = _FALSE; ++ goto exit; ++ } ++ ++ if ((check_fwstate(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) == _TRUE) || ++ (pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE)) { ++ /* Scan or linking is in progress, do nothing. */ ++ res = _TRUE; ++ ++ ++ } else { ++ if (rtw_is_scan_deny(padapter)) { ++ RTW_INFO(FUNC_ADPT_FMT": scan deny\n", FUNC_ADPT_ARG(padapter)); ++ indicate_wx_scan_complete_event(padapter); ++ return _SUCCESS; ++ } ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, NULL, 0, ch, ch_num); ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ } ++exit: ++ ++ ++ return res; ++} ++#endif ++u8 rtw_set_802_11_authentication_mode(_adapter *padapter, NDIS_802_11_AUTHENTICATION_MODE authmode) ++{ ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ int res; ++ u8 ret; ++ ++ ++ ++ psecuritypriv->ndisauthtype = authmode; ++ ++ ++ if (psecuritypriv->ndisauthtype > 3) ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (psecuritypriv->ndisauthtype == 6) ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; ++#endif ++ ++ res = rtw_set_auth(padapter, psecuritypriv); ++ ++ if (res == _SUCCESS) ++ ret = _TRUE; ++ else ++ ret = _FALSE; ++ ++ ++ return ret; ++} ++ ++u8 rtw_set_802_11_add_wep(_adapter *padapter, NDIS_802_11_WEP *wep) ++{ ++ ++ u8 bdefaultkey; ++ u8 btransmitkey; ++ sint keyid, res; ++ struct security_priv *psecuritypriv = &(padapter->securitypriv); ++ u8 ret = _SUCCESS; ++ ++ ++ bdefaultkey = (wep->KeyIndex & 0x40000000) > 0 ? _FALSE : _TRUE; /* for ??? */ ++ btransmitkey = (wep->KeyIndex & 0x80000000) > 0 ? _TRUE : _FALSE; /* for ??? */ ++ keyid = wep->KeyIndex & 0x3fffffff; ++ ++ if (keyid >= 4) { ++ ret = _FALSE; ++ goto exit; ++ } ++ ++ switch (wep->KeyLength) { ++ case 5: ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; ++ break; ++ case 13: ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; ++ break; ++ default: ++ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ break; ++ } ++ ++ ++ _rtw_memcpy(&(psecuritypriv->dot11DefKey[keyid].skey[0]), &(wep->KeyMaterial), wep->KeyLength); ++ ++ psecuritypriv->dot11DefKeylen[keyid] = wep->KeyLength; ++ ++ psecuritypriv->dot11PrivacyKeyIndex = keyid; ++ ++ ++ res = rtw_set_key(padapter, psecuritypriv, keyid, 1, _TRUE); ++ ++ if (res == _FAIL) ++ ret = _FALSE; ++exit: ++ ++ ++ return ret; ++ ++} ++ ++u8 rtw_set_802_11_remove_wep(_adapter *padapter, u32 keyindex) ++{ ++ ++ u8 ret = _SUCCESS; ++ ++ ++ if (keyindex >= 0x80000000 || padapter == NULL) { ++ ++ ret = _FALSE; ++ goto exit; ++ ++ } else { ++ int res; ++ struct security_priv *psecuritypriv = &(padapter->securitypriv); ++ if (keyindex < 4) { ++ ++ _rtw_memset(&psecuritypriv->dot11DefKey[keyindex], 0, 16); ++ ++ res = rtw_set_key(padapter, psecuritypriv, keyindex, 0, _TRUE); ++ ++ psecuritypriv->dot11DefKeylen[keyindex] = 0; ++ ++ if (res == _FAIL) ++ ret = _FAIL; ++ ++ } else ++ ret = _FAIL; ++ ++ } ++ ++exit: ++ ++ ++ return ret; ++ ++} ++ ++u8 rtw_set_802_11_add_key(_adapter *padapter, NDIS_802_11_KEY *key) ++{ ++ ++ uint encryptionalgo; ++ u8 *pbssid; ++ struct sta_info *stainfo; ++ u8 bgroup = _FALSE; ++ u8 bgrouptkey = _FALSE;/* can be remove later */ ++ u8 ret = _SUCCESS; ++ ++ ++ if (((key->KeyIndex & 0x80000000) == 0) && ((key->KeyIndex & 0x40000000) > 0)) { ++ ++ /* It is invalid to clear bit 31 and set bit 30. If the miniport driver encounters this combination, */ ++ /* it must fail the request and return NDIS_STATUS_INVALID_DATA. */ ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ if (key->KeyIndex & 0x40000000) { ++ /* Pairwise key */ ++ ++ ++ pbssid = get_bssid(&padapter->mlmepriv); ++ stainfo = rtw_get_stainfo(&padapter->stapriv, pbssid); ++ ++ if ((stainfo != NULL) && (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X)) { ++ encryptionalgo = stainfo->dot118021XPrivacy; ++ } else { ++ encryptionalgo = padapter->securitypriv.dot11PrivacyAlgrthm; ++ } ++ ++ ++ ++ ++ if (key->KeyIndex & 0x000000FF) { ++ /* The key index is specified in the lower 8 bits by values of zero to 255. */ ++ /* The key index should be set to zero for a Pairwise key, and the driver should fail with */ ++ /* NDIS_STATUS_INVALID_DATA if the lower 8 bits is not zero */ ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* check BSSID */ ++ if (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == _TRUE) { ++ ++ ret = _FALSE; ++ goto exit; ++ } ++ ++ /* Check key length for TKIP. */ ++ /* if(encryptionAlgorithm == RT_ENC_TKIP_ENCRYPTION && key->KeyLength != 32) */ ++ if ((encryptionalgo == _TKIP_) && (key->KeyLength != 32)) { ++ ret = _FAIL; ++ goto exit; ++ ++ } ++ ++ /* Check key length for AES. */ ++ if ((encryptionalgo == _AES_) && (key->KeyLength != 16)) { ++ /* For our supplicant, EAPPkt9x.vxd, cannot differentiate TKIP and AES case. */ ++ if (key->KeyLength == 32) ++ key->KeyLength = 16; ++ else { ++ ret = _FAIL; ++ goto exit; ++ } ++ } ++ ++ /* Check key length for WEP. For NDTEST, 2005.01.27, by rcnjko. -> modify checking condition*/ ++ if (((encryptionalgo == _WEP40_) && (key->KeyLength != 5)) || ((encryptionalgo == _WEP104_) && (key->KeyLength != 13))) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ bgroup = _FALSE; ++ ++ /* Check the pairwise key. Added by Annie, 2005-07-06. */ ++ ++ } else { ++ /* Group key - KeyIndex(BIT30==0) */ ++ ++ ++ /* when add wep key through add key and didn't assigned encryption type before */ ++ if ((padapter->securitypriv.ndisauthtype <= 3) && (padapter->securitypriv.dot118021XGrpPrivacy == 0)) { ++ ++ switch (key->KeyLength) { ++ case 5: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; ++ break; ++ case 13: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; ++ break; ++ default: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ break; ++ } ++ ++ encryptionalgo = padapter->securitypriv.dot11PrivacyAlgrthm; ++ ++ ++ } else { ++ encryptionalgo = padapter->securitypriv.dot118021XGrpPrivacy; ++ ++ } ++ ++ if ((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE) == _TRUE) && (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == _FALSE)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* Check key length for TKIP */ ++ if ((encryptionalgo == _TKIP_) && (key->KeyLength != 32)) { ++ ++ ret = _FAIL; ++ goto exit; ++ ++ } else if (encryptionalgo == _AES_ && (key->KeyLength != 16 && key->KeyLength != 32)) { ++ ++ /* Check key length for AES */ ++ /* For NDTEST, we allow keylen=32 in this case. 2005.01.27, by rcnjko. */ ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* Change the key length for EAPPkt9x.vxd. Added by Annie, 2005-11-03. */ ++ if ((encryptionalgo == _AES_) && (key->KeyLength == 32)) { ++ key->KeyLength = 16; ++ } ++ ++ if (key->KeyIndex & 0x8000000) /* error ??? 0x8000_0000 */ ++ bgrouptkey = _TRUE; ++ ++ if ((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE) == _TRUE) && (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _TRUE)) ++ bgrouptkey = _TRUE; ++ ++ bgroup = _TRUE; ++ ++ ++ } ++ ++ /* If WEP encryption algorithm, just call rtw_set_802_11_add_wep(). */ ++ if ((padapter->securitypriv.dot11AuthAlgrthm != dot11AuthAlgrthm_8021X) && (encryptionalgo == _WEP40_ || encryptionalgo == _WEP104_)) { ++ u8 ret; ++ u32 keyindex; ++ u32 len = FIELD_OFFSET(NDIS_802_11_KEY, KeyMaterial) + key->KeyLength; ++ NDIS_802_11_WEP *wep = &padapter->securitypriv.ndiswep; ++ ++ ++ wep->Length = len; ++ keyindex = key->KeyIndex & 0x7fffffff; ++ wep->KeyIndex = keyindex ; ++ wep->KeyLength = key->KeyLength; ++ ++ ++ _rtw_memcpy(wep->KeyMaterial, key->KeyMaterial, key->KeyLength); ++ _rtw_memcpy(&(padapter->securitypriv.dot11DefKey[keyindex].skey[0]), key->KeyMaterial, key->KeyLength); ++ ++ padapter->securitypriv.dot11DefKeylen[keyindex] = key->KeyLength; ++ padapter->securitypriv.dot11PrivacyKeyIndex = keyindex; ++ ++ ret = rtw_set_802_11_add_wep(padapter, wep); ++ ++ goto exit; ++ ++ } ++ ++ if (key->KeyIndex & 0x20000000) { ++ /* SetRSC */ ++ if (bgroup == _TRUE) { ++ NDIS_802_11_KEY_RSC keysrc = key->KeyRSC & 0x00FFFFFFFFFFFFULL; ++ _rtw_memcpy(&padapter->securitypriv.dot11Grprxpn, &keysrc, 8); ++ } else { ++ NDIS_802_11_KEY_RSC keysrc = key->KeyRSC & 0x00FFFFFFFFFFFFULL; ++ _rtw_memcpy(&padapter->securitypriv.dot11Grptxpn, &keysrc, 8); ++ } ++ ++ } ++ ++ /* Indicate this key idx is used for TX */ ++ /* Save the key in KeyMaterial */ ++ if (bgroup == _TRUE) { /* Group transmit key */ ++ int res; ++ ++ if (bgrouptkey == _TRUE) ++ padapter->securitypriv.dot118021XGrpKeyid = (u8)key->KeyIndex; ++ ++ if ((key->KeyIndex & 0x3) == 0) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ _rtw_memset(&padapter->securitypriv.dot118021XGrpKey[(u8)((key->KeyIndex) & 0x03)], 0, 16); ++ _rtw_memset(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], 0, 16); ++ _rtw_memset(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], 0, 16); ++ ++ if ((key->KeyIndex & 0x10000000)) { ++ _rtw_memcpy(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 16, 8); ++ _rtw_memcpy(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 24, 8); ++ ++ ++ } else { ++ _rtw_memcpy(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 24, 8); ++ _rtw_memcpy(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 16, 8); ++ ++ ++ } ++ ++ /* set group key by index */ ++ _rtw_memcpy(&padapter->securitypriv.dot118021XGrpKey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial, key->KeyLength); ++ ++ key->KeyIndex = key->KeyIndex & 0x03; ++ ++ padapter->securitypriv.binstallGrpkey = _TRUE; ++ ++ padapter->securitypriv.bcheck_grpkey = _FALSE; ++ ++ ++ res = rtw_set_key(padapter, &padapter->securitypriv, key->KeyIndex, 1, _TRUE); ++ ++ if (res == _FAIL) ++ ret = _FAIL; ++ ++ goto exit; ++ ++ } else { /* Pairwise Key */ ++ u8 res; ++ ++ pbssid = get_bssid(&padapter->mlmepriv); ++ stainfo = rtw_get_stainfo(&padapter->stapriv , pbssid); ++ ++ if (stainfo != NULL) { ++ _rtw_memset(&stainfo->dot118021x_UncstKey, 0, 16); /* clear keybuffer */ ++ ++ _rtw_memcpy(&stainfo->dot118021x_UncstKey, key->KeyMaterial, 16); ++ ++ if (encryptionalgo == _TKIP_) { ++ padapter->securitypriv.busetkipkey = _FALSE; ++ ++ /* _set_timer(&padapter->securitypriv.tkip_timer, 50); */ ++ ++ ++ /* if TKIP, save the Receive/Transmit MIC key in KeyMaterial[128-255] */ ++ if ((key->KeyIndex & 0x10000000)) { ++ _rtw_memcpy(&stainfo->dot11tkiptxmickey, key->KeyMaterial + 16, 8); ++ _rtw_memcpy(&stainfo->dot11tkiprxmickey, key->KeyMaterial + 24, 8); ++ ++ } else { ++ _rtw_memcpy(&stainfo->dot11tkiptxmickey, key->KeyMaterial + 24, 8); ++ _rtw_memcpy(&stainfo->dot11tkiprxmickey, key->KeyMaterial + 16, 8); ++ ++ } ++ ++ } else if (encryptionalgo == _AES_) { ++ ++ } ++ ++ ++ /* Set key to CAM through H2C command */ ++#if 0 ++ if (bgrouptkey) { /* never go to here */ ++ res = rtw_setstakey_cmd(padapter, stainfo, GROUP_KEY, _TRUE); ++ } else { ++ res = rtw_setstakey_cmd(padapter, stainfo, UNICAST_KEY, _TRUE); ++ } ++#else ++ ++ res = rtw_setstakey_cmd(padapter, stainfo, UNICAST_KEY, _TRUE); ++#endif ++ ++ if (res == _FALSE) ++ ret = _FAIL; ++ ++ } ++ ++ } ++ ++exit: ++ ++ ++ return ret; ++} ++ ++u8 rtw_set_802_11_remove_key(_adapter *padapter, NDIS_802_11_REMOVE_KEY *key) ++{ ++ ++ uint encryptionalgo; ++ u8 *pbssid; ++ struct sta_info *stainfo; ++ u8 bgroup = (key->KeyIndex & 0x4000000) > 0 ? _FALSE : _TRUE; ++ u8 keyIndex = (u8)key->KeyIndex & 0x03; ++ u8 ret = _SUCCESS; ++ ++ ++ if ((key->KeyIndex & 0xbffffffc) > 0) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ if (bgroup == _TRUE) { ++ encryptionalgo = padapter->securitypriv.dot118021XGrpPrivacy; ++ /* clear group key by index */ ++ /* NdisZeroMemory(Adapter->MgntInfo.SecurityInfo.KeyBuf[keyIndex], MAX_WEP_KEY_LEN); */ ++ /* Adapter->MgntInfo.SecurityInfo.KeyLen[keyIndex] = 0; */ ++ ++ _rtw_memset(&padapter->securitypriv.dot118021XGrpKey[keyIndex], 0, 16); ++ ++ /* ! \todo Send a H2C Command to Firmware for removing this Key in CAM Entry. */ ++ ++ } else { ++ ++ pbssid = get_bssid(&padapter->mlmepriv); ++ stainfo = rtw_get_stainfo(&padapter->stapriv , pbssid); ++ if (stainfo != NULL) { ++ encryptionalgo = stainfo->dot118021XPrivacy; ++ ++ /* clear key by BSSID */ ++ _rtw_memset(&stainfo->dot118021x_UncstKey, 0, 16); ++ ++ /* ! \todo Send a H2C Command to Firmware for disable this Key in CAM Entry. */ ++ ++ } else { ++ ret = _FAIL; ++ goto exit; ++ } ++ } ++ ++exit: ++ ++ ++ return _TRUE; ++ ++} ++ ++/* ++* rtw_get_cur_max_rate - ++* @adapter: pointer to _adapter structure ++* ++* Return 0 or 100Kbps ++*/ ++u16 rtw_get_cur_max_rate(_adapter *adapter) ++{ ++ int i = 0; ++ u16 rate = 0, max_rate = 0; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; ++ struct sta_info *psta = NULL; ++ u8 short_GI = 0; ++#ifdef CONFIG_80211N_HT ++ u8 rf_type = 0; ++#endif ++ ++#ifdef CONFIG_MP_INCLUDED ++ if (adapter->registrypriv.mp_mode == 1) { ++ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) ++ return 0; ++ } ++#endif ++ ++ if ((check_fwstate(pmlmepriv, _FW_LINKED) != _TRUE) ++ && (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != _TRUE)) ++ return 0; ++ ++ psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); ++ if (psta == NULL) ++ return 0; ++ ++ short_GI = query_ra_short_GI(psta, psta->bw_mode); ++ ++#ifdef CONFIG_80211N_HT ++ if (IsSupportedHT(psta->wireless_mode)) { ++ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ max_rate = rtw_mcs_rate( ++ rf_type, ++ ((psta->bw_mode == CHANNEL_WIDTH_40) ? 1 : 0), ++ short_GI, ++ psta->htpriv.ht_cap.supp_mcs_set ++ ); ++ } ++#ifdef CONFIG_80211AC_VHT ++ else if (IsSupportedVHT(psta->wireless_mode)) ++ max_rate = ((rtw_vht_mcs_to_data_rate(psta->bw_mode, short_GI, pmlmepriv->vhtpriv.vht_highest_rate) + 1) >> 1) * 10; ++#endif /* CONFIG_80211AC_VHT */ ++ else ++#endif /* CONFIG_80211N_HT */ ++ { ++ while ((pcur_bss->SupportedRates[i] != 0) && (pcur_bss->SupportedRates[i] != 0xFF)) { ++ rate = pcur_bss->SupportedRates[i] & 0x7F; ++ if (rate > max_rate) ++ max_rate = rate; ++ i++; ++ } ++ ++ max_rate = max_rate * 10 / 2; ++ } ++ ++ return max_rate; ++} ++ ++/* ++* rtw_set_scan_mode - ++* @adapter: pointer to _adapter structure ++* @scan_mode: ++* ++* Return _SUCCESS or _FAIL ++*/ ++int rtw_set_scan_mode(_adapter *adapter, RT_SCAN_TYPE scan_mode) ++{ ++ if (scan_mode != SCAN_ACTIVE && scan_mode != SCAN_PASSIVE) ++ return _FAIL; ++ ++ adapter->mlmepriv.scan_mode = scan_mode; ++ ++ return _SUCCESS; ++} ++ ++/* ++* rtw_set_channel_plan - ++* @adapter: pointer to _adapter structure ++* @channel_plan: ++* ++* Return _SUCCESS or _FAIL ++*/ ++int rtw_set_channel_plan(_adapter *adapter, u8 channel_plan) ++{ ++ struct registry_priv *pregistrypriv = &adapter->registrypriv; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ ++ /* handle by cmd_thread to sync with scan operation */ ++ return rtw_set_chplan_cmd(adapter, RTW_CMDF_WAIT_ACK, channel_plan, 1); ++} ++ ++/* ++* rtw_set_country - ++* @adapter: pointer to _adapter structure ++* @country_code: string of country code ++* ++* Return _SUCCESS or _FAIL ++*/ ++int rtw_set_country(_adapter *adapter, const char *country_code) ++{ ++#ifdef CONFIG_RTW_IOCTL_SET_COUNTRY ++ return rtw_set_country_cmd(adapter, RTW_CMDF_WAIT_ACK, country_code, 1); ++#else ++ return _FAIL; ++#endif ++} ++ ++/* ++* rtw_set_band - ++* @adapter: pointer to _adapter structure ++* @band: band to set ++* ++* Return _SUCCESS or _FAIL ++*/ ++int rtw_set_band(_adapter *adapter, u8 band) ++{ ++ if (rtw_band_valid(band)) { ++ RTW_INFO(FUNC_ADPT_FMT" band:%d\n", FUNC_ADPT_ARG(adapter), band); ++ adapter->setband = band; ++ return _SUCCESS; ++ } ++ ++ RTW_PRINT(FUNC_ADPT_FMT" band:%d fail\n", FUNC_ADPT_ARG(adapter), band); ++ return _FAIL; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_iol.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_iol.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_iol.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_iol.c 2018-02-11 21:44:27.137145933 +0200 +@@ -0,0 +1,387 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#include ++ ++#ifdef CONFIG_IOL ++struct xmit_frame *rtw_IOL_accquire_xmit_frame(ADAPTER *adapter) ++{ ++ struct xmit_frame *xmit_frame; ++ struct xmit_buf *xmitbuf; ++ struct pkt_attrib *pattrib; ++ struct xmit_priv *pxmitpriv = &(adapter->xmitpriv); ++ ++#if 1 ++ xmit_frame = rtw_alloc_xmitframe(pxmitpriv); ++ if (xmit_frame == NULL) { ++ RTW_INFO("%s rtw_alloc_xmitframe return null\n", __FUNCTION__); ++ goto exit; ++ } ++ ++ xmitbuf = rtw_alloc_xmitbuf(pxmitpriv); ++ if (xmitbuf == NULL) { ++ RTW_INFO("%s rtw_alloc_xmitbuf return null\n", __FUNCTION__); ++ rtw_free_xmitframe(pxmitpriv, xmit_frame); ++ xmit_frame = NULL; ++ goto exit; ++ } ++ ++ xmit_frame->frame_tag = MGNT_FRAMETAG; ++ xmit_frame->pxmitbuf = xmitbuf; ++ xmit_frame->buf_addr = xmitbuf->pbuf; ++ xmitbuf->priv_data = xmit_frame; ++ ++ pattrib = &xmit_frame->attrib; ++ update_mgntframe_attrib(adapter, pattrib); ++ pattrib->qsel = QSLT_BEACON;/* Beacon */ ++ pattrib->subtype = WIFI_BEACON; ++ pattrib->pktlen = pattrib->last_txcmdsz = 0; ++ ++#else ++ xmit_frame = alloc_mgtxmitframe(pxmitpriv); ++ if (xmit_frame == NULL) ++ RTW_INFO("%s alloc_mgtxmitframe return null\n", __FUNCTION__); ++ else { ++ pattrib = &xmit_frame->attrib; ++ update_mgntframe_attrib(adapter, pattrib); ++ pattrib->qsel = QSLT_BEACON; ++ pattrib->pktlen = pattrib->last_txcmdsz = 0; ++ } ++#endif ++ ++exit: ++ return xmit_frame; ++} ++ ++ ++int rtw_IOL_append_cmds(struct xmit_frame *xmit_frame, u8 *IOL_cmds, u32 cmd_len) ++{ ++ struct pkt_attrib *pattrib = &xmit_frame->attrib; ++ u16 buf_offset; ++ u32 ori_len; ++ ++ buf_offset = TXDESC_OFFSET; ++ ori_len = buf_offset + pattrib->pktlen; ++ ++ /* check if the io_buf can accommodate new cmds */ ++ if (ori_len + cmd_len + 8 > MAX_XMITBUF_SZ) { ++ RTW_INFO("%s %u is large than MAX_XMITBUF_SZ:%u, can't accommodate new cmds\n", __FUNCTION__ ++ , ori_len + cmd_len + 8, MAX_XMITBUF_SZ); ++ return _FAIL; ++ } ++ ++ _rtw_memcpy(xmit_frame->buf_addr + buf_offset + pattrib->pktlen, IOL_cmds, cmd_len); ++ pattrib->pktlen += cmd_len; ++ pattrib->last_txcmdsz += cmd_len; ++ ++ /* RTW_INFO("%s ori:%u + cmd_len:%u = %u\n", __FUNCTION__, ori_len, cmd_len, buf_offset+pattrib->pktlen); */ ++ ++ return _SUCCESS; ++} ++ ++bool rtw_IOL_applied(ADAPTER *adapter) ++{ ++ if (1 == adapter->registrypriv.fw_iol) ++ return _TRUE; ++ ++#ifdef CONFIG_USB_HCI ++ if ((2 == adapter->registrypriv.fw_iol) && (IS_FULL_SPEED_USB(adapter))) ++ return _TRUE; ++#endif ++ ++ return _FALSE; ++} ++ ++int rtw_IOL_exec_cmds_sync(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt) ++{ ++ return rtw_hal_iol_cmd(adapter, xmit_frame, max_wating_ms, bndy_cnt); ++} ++ ++#ifdef CONFIG_IOL_NEW_GENERATION ++int rtw_IOL_append_LLT_cmd(struct xmit_frame *xmit_frame, u8 page_boundary) ++{ ++ return _SUCCESS; ++} ++int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, u8 mask) ++{ ++ struct ioreg_cfg cmd = {8, IOREG_CMD_WB_REG, 0x0, 0x0, 0x0}; ++ ++ /* RTW_PUT_LE16((u8*)&cmd.address, addr); */ ++ /* RTW_PUT_LE32((u8*)&cmd.value, (u32)value); */ ++ cmd.address = cpu_to_le16(addr); ++ cmd.data = cpu_to_le32(value); ++ ++ if (mask != 0xFF) { ++ cmd.length = 12; ++ /* RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); */ ++ cmd.mask = cpu_to_le32(mask); ++ } ++ ++ /* RTW_INFO("%s addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FUNCTION__, addr,value,mask); */ ++ ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, cmd.length); ++ ++} ++int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, u16 mask) ++{ ++ struct ioreg_cfg cmd = {8, IOREG_CMD_WW_REG, 0x0, 0x0, 0x0}; ++ ++ /* RTW_PUT_LE16((u8*)&cmd.address, addr); */ ++ /* RTW_PUT_LE32((u8*)&cmd.value, (u32)value); */ ++ cmd.address = cpu_to_le16(addr); ++ cmd.data = cpu_to_le32(value); ++ ++ if (mask != 0xFFFF) { ++ cmd.length = 12; ++ /* RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); */ ++ cmd.mask = cpu_to_le32(mask); ++ } ++ ++ /* RTW_INFO("%s addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FUNCTION__, addr,value,mask); */ ++ ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, cmd.length); ++ ++} ++int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, u32 mask) ++{ ++ struct ioreg_cfg cmd = {8, IOREG_CMD_WD_REG, 0x0, 0x0, 0x0}; ++ ++ /* RTW_PUT_LE16((u8*)&cmd.address, addr); */ ++ /* RTW_PUT_LE32((u8*)&cmd.value, (u32)value); */ ++ cmd.address = cpu_to_le16(addr); ++ cmd.data = cpu_to_le32(value); ++ ++ if (mask != 0xFFFFFFFF) { ++ cmd.length = 12; ++ /* RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); */ ++ cmd.mask = cpu_to_le32(mask); ++ } ++ ++ /* RTW_INFO("%s addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FU2NCTION__, addr,value,mask); */ ++ ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, cmd.length); ++ ++} ++ ++int _rtw_IOL_append_WRF_cmd(struct xmit_frame *xmit_frame, u8 rf_path, u16 addr, u32 value, u32 mask) ++{ ++ struct ioreg_cfg cmd = {8, IOREG_CMD_W_RF, 0x0, 0x0, 0x0}; ++ ++ /* RTW_PUT_LE16((u8*)&cmd.address, addr); */ ++ /* RTW_PUT_LE32((u8*)&cmd.value, (u32)value); */ ++ cmd.address = (rf_path << 8) | ((addr) & 0xFF); ++ cmd.data = cpu_to_le32(value); ++ ++ if (mask != 0x000FFFFF) { ++ cmd.length = 12; ++ /* RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); */ ++ cmd.mask = cpu_to_le32(mask); ++ } ++ ++ /* RTW_INFO("%s rf_path:0x%02x addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FU2NCTION__,rf_path, addr,value,mask); */ ++ ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, cmd.length); ++ ++} ++ ++ ++ ++int rtw_IOL_append_DELAY_US_cmd(struct xmit_frame *xmit_frame, u16 us) ++{ ++ struct ioreg_cfg cmd = {4, IOREG_CMD_DELAY_US, 0x0, 0x0, 0x0}; ++ /* RTW_PUT_LE16((u8*)&cmd.address, us); */ ++ cmd.address = cpu_to_le16(us); ++ ++ /* RTW_INFO("%s %u\n", __FUNCTION__, us); */ ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 4); ++} ++ ++int rtw_IOL_append_DELAY_MS_cmd(struct xmit_frame *xmit_frame, u16 ms) ++{ ++ struct ioreg_cfg cmd = {4, IOREG_CMD_DELAY_US, 0x0, 0x0, 0x0}; ++ ++ /* RTW_PUT_LE16((u8*)&cmd.address, ms); */ ++ cmd.address = cpu_to_le16(ms); ++ ++ /* RTW_INFO("%s %u\n", __FUNCTION__, ms); */ ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 4); ++} ++int rtw_IOL_append_END_cmd(struct xmit_frame *xmit_frame) ++{ ++ struct ioreg_cfg cmd = {4, IOREG_CMD_END, 0xFFFF, 0xFF, 0x0}; ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 4); ++ ++} ++ ++u8 rtw_IOL_cmd_boundary_handle(struct xmit_frame *pxmit_frame) ++{ ++ u8 is_cmd_bndy = _FALSE; ++ if (((pxmit_frame->attrib.pktlen + 32) % 256) + 8 >= 256) { ++ rtw_IOL_append_END_cmd(pxmit_frame); ++ pxmit_frame->attrib.pktlen = ((((pxmit_frame->attrib.pktlen + 32) / 256) + 1) * 256); ++ ++ /* printk("==> %s, pktlen(%d)\n",__FUNCTION__,pxmit_frame->attrib.pktlen); */ ++ pxmit_frame->attrib.last_txcmdsz = pxmit_frame->attrib.pktlen; ++ is_cmd_bndy = _TRUE; ++ } ++ return is_cmd_bndy; ++} ++ ++void rtw_IOL_cmd_buf_dump(ADAPTER *Adapter, int buf_len, u8 *pbuf) ++{ ++ int i; ++ int j = 1; ++ ++ printk("###### %s ######\n", __FUNCTION__); ++ for (i = 0; i < buf_len; i++) { ++ printk("%02x-", *(pbuf + i)); ++ ++ if (j % 32 == 0) ++ printk("\n"); ++ j++; ++ } ++ printk("\n"); ++ printk("============= ioreg_cmd len = %d ===============\n", buf_len); ++} ++ ++ ++#else /* CONFIG_IOL_NEW_GENERATION */ ++int rtw_IOL_append_LLT_cmd(struct xmit_frame *xmit_frame, u8 page_boundary) ++{ ++ IOL_CMD cmd = {0x0, IOL_CMD_LLT, 0x0, 0x0}; ++ ++ RTW_PUT_BE32((u8 *)&cmd.value, (u32)page_boundary); ++ ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 8); ++} ++ ++int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value) ++{ ++ IOL_CMD cmd = {0x0, IOL_CMD_WB_REG, 0x0, 0x0}; ++ ++ RTW_PUT_BE16((u8 *)&cmd.address, (u16)addr); ++ RTW_PUT_BE32((u8 *)&cmd.value, (u32)value); ++ ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 8); ++} ++ ++int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value) ++{ ++ IOL_CMD cmd = {0x0, IOL_CMD_WW_REG, 0x0, 0x0}; ++ ++ RTW_PUT_BE16((u8 *)&cmd.address, (u16)addr); ++ RTW_PUT_BE32((u8 *)&cmd.value, (u32)value); ++ ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 8); ++} ++ ++int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value) ++{ ++ IOL_CMD cmd = {0x0, IOL_CMD_WD_REG, 0x0, 0x0}; ++ u8 *pos = (u8 *)&cmd; ++ ++ RTW_PUT_BE16((u8 *)&cmd.address, (u16)addr); ++ RTW_PUT_BE32((u8 *)&cmd.value, (u32)value); ++ ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 8); ++} ++ ++#ifdef DBG_IO ++int dbg_rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, const char *caller, const int line) ++{ ++ if (match_write_sniff_ranges(addr, 1)) ++ RTW_INFO("DBG_IO %s:%d IOL_WB(0x%04x, 0x%02x)\n", caller, line, addr, value); ++ ++ return _rtw_IOL_append_WB_cmd(xmit_frame, addr, value); ++} ++ ++int dbg_rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, const char *caller, const int line) ++{ ++ if (match_write_sniff_ranges(addr, 2)) ++ RTW_INFO("DBG_IO %s:%d IOL_WW(0x%04x, 0x%04x)\n", caller, line, addr, value); ++ ++ return _rtw_IOL_append_WW_cmd(xmit_frame, addr, value); ++} ++ ++int dbg_rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, const char *caller, const int line) ++{ ++ if (match_write_sniff_ranges(addr, 4)) ++ RTW_INFO("DBG_IO %s:%d IOL_WD(0x%04x, 0x%08x)\n", caller, line, addr, value); ++ ++ return _rtw_IOL_append_WD_cmd(xmit_frame, addr, value); ++} ++#endif ++ ++int rtw_IOL_append_DELAY_US_cmd(struct xmit_frame *xmit_frame, u16 us) ++{ ++ IOL_CMD cmd = {0x0, IOL_CMD_DELAY_US, 0x0, 0x0}; ++ ++ RTW_PUT_BE32((u8 *)&cmd.value, (u32)us); ++ ++ /* RTW_INFO("%s %u\n", __FUNCTION__, us); */ ++ ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 8); ++} ++ ++int rtw_IOL_append_DELAY_MS_cmd(struct xmit_frame *xmit_frame, u16 ms) ++{ ++ IOL_CMD cmd = {0x0, IOL_CMD_DELAY_MS, 0x0, 0x0}; ++ ++ RTW_PUT_BE32((u8 *)&cmd.value, (u32)ms); ++ ++ /* RTW_INFO("%s %u\n", __FUNCTION__, ms); */ ++ ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 8); ++} ++ ++int rtw_IOL_append_END_cmd(struct xmit_frame *xmit_frame) ++{ ++ IOL_CMD end_cmd = {0x0, IOL_CMD_END, 0x0, 0x0}; ++ ++ ++ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&end_cmd, 8); ++ ++} ++ ++int rtw_IOL_exec_cmd_array_sync(PADAPTER adapter, u8 *IOL_cmds, u32 cmd_num, u32 max_wating_ms) ++{ ++ struct xmit_frame *xmit_frame; ++ ++ xmit_frame = rtw_IOL_accquire_xmit_frame(adapter); ++ if (xmit_frame == NULL) ++ return _FAIL; ++ ++ if (rtw_IOL_append_cmds(xmit_frame, IOL_cmds, cmd_num << 3) == _FAIL) ++ return _FAIL; ++ ++ return rtw_IOL_exec_cmds_sync(adapter, xmit_frame, max_wating_ms, 0); ++} ++ ++int rtw_IOL_exec_empty_cmds_sync(ADAPTER *adapter, u32 max_wating_ms) ++{ ++ IOL_CMD end_cmd = {0x0, IOL_CMD_END, 0x0, 0x0}; ++ return rtw_IOL_exec_cmd_array_sync(adapter, (u8 *)&end_cmd, 1, max_wating_ms); ++} ++#endif /* CONFIG_IOL_NEW_GENERATION */ ++ ++ ++ ++ ++#endif /* CONFIG_IOL */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_mem.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mem.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_mem.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mem.c 2018-02-11 21:44:27.137145933 +0200 +@@ -0,0 +1,114 @@ ++ ++#include ++#include ++ ++MODULE_LICENSE("GPL"); ++MODULE_DESCRIPTION("Realtek Wireless Lan Driver"); ++MODULE_AUTHOR("Realtek Semiconductor Corp."); ++MODULE_VERSION("DRIVERVERSION"); ++ ++struct sk_buff_head rtk_skb_mem_q; ++struct u8 *rtk_buf_mem[NR_RECVBUFF]; ++ ++struct u8 *rtw_get_buf_premem(int index) ++{ ++ printk("%s, rtk_buf_mem index : %d\n", __func__, index); ++ return rtk_buf_mem[index]; ++} ++ ++u16 rtw_rtkm_get_buff_size(void) ++{ ++ return MAX_RTKM_RECVBUF_SZ; ++} ++EXPORT_SYMBOL(rtw_rtkm_get_buff_size); ++ ++u8 rtw_rtkm_get_nr_recv_skb(void) ++{ ++ return MAX_RTKM_NR_PREALLOC_RECV_SKB; ++} ++EXPORT_SYMBOL(rtw_rtkm_get_nr_recv_skb); ++ ++struct sk_buff *rtw_alloc_skb_premem(u16 in_size) ++{ ++ struct sk_buff *skb = NULL; ++ ++ if (in_size > MAX_RTKM_RECVBUF_SZ) { ++ pr_info("warning %s: driver buffer size(%d) > rtkm buffer size(%d)\n", __func__, in_size, MAX_RTKM_RECVBUF_SZ); ++ WARN_ON(1); ++ return skb; ++ } ++ ++ skb = skb_dequeue(&rtk_skb_mem_q); ++ ++ printk("%s, rtk_skb_mem_q len : %d\n", __func__, skb_queue_len(&rtk_skb_mem_q)); ++ ++ return skb; ++} ++EXPORT_SYMBOL(rtw_alloc_skb_premem); ++ ++int rtw_free_skb_premem(struct sk_buff *pskb) ++{ ++ if (!pskb) ++ return -1; ++ ++ if (skb_queue_len(&rtk_skb_mem_q) >= MAX_RTKM_NR_PREALLOC_RECV_SKB) ++ return -1; ++ ++ skb_queue_tail(&rtk_skb_mem_q, pskb); ++ ++ printk("%s, rtk_skb_mem_q len : %d\n", __func__, skb_queue_len(&rtk_skb_mem_q)); ++ ++ return 0; ++} ++EXPORT_SYMBOL(rtw_free_skb_premem); ++ ++static int __init rtw_mem_init(void) ++{ ++ int i; ++ SIZE_PTR tmpaddr = 0; ++ SIZE_PTR alignment = 0; ++ struct sk_buff *pskb = NULL; ++ ++ printk("%s\n", __func__); ++ pr_info("MAX_RTKM_NR_PREALLOC_RECV_SKB: %d\n", MAX_RTKM_NR_PREALLOC_RECV_SKB); ++ pr_info("MAX_RTKM_RECVBUF_SZ: %d\n", MAX_RTKM_RECVBUF_SZ); ++ ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX ++ for (i = 0; i < NR_RECVBUFF; i++) ++ rtk_buf_mem[i] = usb_buffer_alloc(dev, size, (in_interrupt() ? GFP_ATOMIC : GFP_KERNEL), dma); ++#endif /* CONFIG_USE_USB_BUFFER_ALLOC_RX */ ++ ++ skb_queue_head_init(&rtk_skb_mem_q); ++ ++ for (i = 0; i < MAX_RTKM_NR_PREALLOC_RECV_SKB; i++) { ++ pskb = __dev_alloc_skb(MAX_RTKM_RECVBUF_SZ + RECVBUFF_ALIGN_SZ, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); ++ if (pskb) { ++ tmpaddr = (SIZE_PTR)pskb->data; ++ alignment = tmpaddr & (RECVBUFF_ALIGN_SZ - 1); ++ skb_reserve(pskb, (RECVBUFF_ALIGN_SZ - alignment)); ++ ++ skb_queue_tail(&rtk_skb_mem_q, pskb); ++ } else ++ printk("%s, alloc skb memory fail!\n", __func__); ++ ++ pskb = NULL; ++ } ++ ++ printk("%s, rtk_skb_mem_q len : %d\n", __func__, skb_queue_len(&rtk_skb_mem_q)); ++ ++ return 0; ++ ++} ++ ++static void __exit rtw_mem_exit(void) ++{ ++ if (skb_queue_len(&rtk_skb_mem_q)) ++ printk("%s, rtk_skb_mem_q len : %d\n", __func__, skb_queue_len(&rtk_skb_mem_q)); ++ ++ skb_queue_purge(&rtk_skb_mem_q); ++ ++ printk("%s\n", __func__); ++} ++ ++module_init(rtw_mem_init); ++module_exit(rtw_mem_exit); +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_mi.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mi.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_mi.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mi.c 2018-02-11 21:44:27.137145933 +0200 +@@ -0,0 +1,1289 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2015 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_MI_C_ ++ ++#include ++#include ++ ++void rtw_mi_update_union_chan_inf(_adapter *adapter, u8 ch, u8 offset , u8 bw) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mi_state *iface_state = &dvobj->iface_state; ++ ++ iface_state->union_ch = ch; ++ iface_state->union_bw = bw; ++ iface_state->union_offset = offset; ++} ++ ++/* Find union about ch, bw, ch_offset of all linked/linking interfaces */ ++int _rtw_mi_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset, bool include_self) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ _adapter *iface; ++ struct mlme_ext_priv *mlmeext; ++ int i; ++ u8 ch_ret = 0; ++ u8 bw_ret = CHANNEL_WIDTH_20; ++ u8 offset_ret = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ int num = 0; ++ ++ if (ch) ++ *ch = 0; ++ if (bw) ++ *bw = CHANNEL_WIDTH_20; ++ if (offset) ++ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ mlmeext = &iface->mlmeextpriv; ++ ++ if (!check_fwstate(&iface->mlmepriv, _FW_LINKED | _FW_UNDER_LINKING)) ++ continue; ++ ++ if (check_fwstate(&iface->mlmepriv, WIFI_OP_CH_SWITCHING)) ++ continue; ++ ++ if (include_self == _FALSE && adapter == iface) ++ continue; ++ ++ if (num == 0) { ++ ch_ret = mlmeext->cur_channel; ++ bw_ret = mlmeext->cur_bwmode; ++ offset_ret = mlmeext->cur_ch_offset; ++ num++; ++ continue; ++ } ++ ++ if (ch_ret != mlmeext->cur_channel) { ++ num = 0; ++ break; ++ } ++ ++ if (bw_ret < mlmeext->cur_bwmode) { ++ bw_ret = mlmeext->cur_bwmode; ++ offset_ret = mlmeext->cur_ch_offset; ++ } else if (bw_ret == mlmeext->cur_bwmode && offset_ret != mlmeext->cur_ch_offset) { ++ num = 0; ++ break; ++ } ++ ++ num++; ++ } ++ ++ if (num) { ++ if (ch) ++ *ch = ch_ret; ++ if (bw) ++ *bw = bw_ret; ++ if (offset) ++ *offset = offset_ret; ++ } ++ ++ return num; ++} ++ ++inline int rtw_mi_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) ++{ ++ return _rtw_mi_get_ch_setting_union(adapter, ch, bw, offset, 1); ++} ++ ++inline int rtw_mi_get_ch_setting_union_no_self(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) ++{ ++ return _rtw_mi_get_ch_setting_union(adapter, ch, bw, offset, 0); ++} ++ ++/* For now, not return union_ch/bw/offset */ ++void _rtw_mi_status(_adapter *adapter, struct mi_state *mstate, bool include_self) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ _adapter *iface; ++ int i; ++ ++ _rtw_memset(mstate, 0, sizeof(struct mi_state)); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ ++ if (include_self == _FALSE && iface == adapter) ++ continue; ++ ++ if (check_fwstate(&iface->mlmepriv, WIFI_STATION_STATE) == _TRUE) { ++ MSTATE_STA_NUM(mstate)++; ++ if (check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE) ++ MSTATE_STA_LD_NUM(mstate)++; ++ ++ if (check_fwstate(&iface->mlmepriv, _FW_UNDER_LINKING) == _TRUE) ++ MSTATE_STA_LG_NUM(mstate)++; ++ ++ } else if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE ++ && check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE ++ ) { ++ MSTATE_AP_NUM(mstate)++; ++ if (iface->stapriv.asoc_sta_count > 2) ++ MSTATE_AP_LD_NUM(mstate)++; ++ ++ } else if (check_fwstate(&iface->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) == _TRUE ++ && check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE ++ ) { ++ MSTATE_ADHOC_NUM(mstate)++; ++ if (iface->stapriv.asoc_sta_count > 2) ++ MSTATE_ADHOC_LD_NUM(mstate)++; ++ } ++ ++ if (check_fwstate(&iface->mlmepriv, WIFI_UNDER_WPS) == _TRUE) ++ MSTATE_WPS_NUM(mstate)++; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (rtw_cfg80211_get_is_mgmt_tx(iface)) ++ MSTATE_MGMT_TX_NUM(mstate)++; ++ #ifdef CONFIG_P2P ++ if (rtw_cfg80211_get_is_roch(iface) == _TRUE) ++ MSTATE_ROCH_NUM(mstate)++; ++ #endif ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++ } ++} ++ ++inline void rtw_mi_status(_adapter *adapter, struct mi_state *mstate) ++{ ++ return _rtw_mi_status(adapter, mstate, 1); ++} ++inline void rtw_mi_status_no_self(_adapter *adapter, struct mi_state *mstate) ++{ ++ return _rtw_mi_status(adapter, mstate, 0); ++} ++void dump_mi_status(void *sel, struct dvobj_priv *dvobj) ++{ ++ RTW_PRINT_SEL(sel, "== dvobj-iface_state ==\n"); ++ RTW_PRINT_SEL(sel, "sta_num:%d\n", DEV_STA_NUM(dvobj)); ++ RTW_PRINT_SEL(sel, "linking_sta_num:%d\n", DEV_STA_LG_NUM(dvobj)); ++ RTW_PRINT_SEL(sel, "linked_sta_num:%d\n", DEV_STA_LD_NUM(dvobj)); ++ RTW_PRINT_SEL(sel, "ap_num:%d\n", DEV_AP_NUM(dvobj)); ++ RTW_PRINT_SEL(sel, "linked_ap_num:%d\n", DEV_AP_LD_NUM(dvobj)); ++ RTW_PRINT_SEL(sel, "adhoc_num:%d\n", DEV_ADHOC_NUM(dvobj)); ++ RTW_PRINT_SEL(sel, "linked_adhoc_num:%d\n", DEV_ADHOC_LD_NUM(dvobj)); ++#ifdef CONFIG_P2P ++ RTW_PRINT_SEL(sel, "p2p_device_num:%d\n", rtw_mi_stay_in_p2p_mode(dvobj->padapters[IFACE_ID0])); ++#endif ++#if defined(CONFIG_IOCTL_CFG80211) ++ #if defined(CONFIG_P2P) ++ RTW_PRINT_SEL(sel, "roch_num:%d\n", DEV_ROCH_NUM(dvobj)); ++ #endif ++ RTW_PRINT_SEL(sel, "mgmt_tx_num:%d\n", DEV_MGMT_TX_NUM(dvobj)); ++#endif ++ RTW_PRINT_SEL(sel, "under_wps_num:%d\n", DEV_WPS_NUM(dvobj)); ++ RTW_PRINT_SEL(sel, "union_ch:%d\n", DEV_U_CH(dvobj)); ++ RTW_PRINT_SEL(sel, "union_bw:%d\n", DEV_U_BW(dvobj)); ++ RTW_PRINT_SEL(sel, "union_offset:%d\n", DEV_U_OFFSET(dvobj)); ++ RTW_PRINT_SEL(sel, "================\n\n"); ++} ++ ++void dump_dvobj_mi_status(void *sel, const char *fun_name, _adapter *adapter) ++{ ++ RTW_INFO("\n[ %s ] call %s\n", fun_name, __func__); ++ dump_mi_status(sel, adapter_to_dvobj(adapter)); ++} ++ ++inline void rtw_mi_update_iface_status(struct mlme_priv *pmlmepriv, sint state) ++{ ++ _adapter *adapter = container_of(pmlmepriv, _adapter, mlmepriv); ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mi_state *iface_state = &dvobj->iface_state; ++ struct mi_state tmp_mstate; ++ u8 i; ++ u8 u_ch, u_offset, u_bw; ++ _adapter *iface; ++ ++ if (state == WIFI_MONITOR_STATE ++ || state == WIFI_SITE_MONITOR ++ || state == 0xFFFFFFFF ++ ) ++ return; ++ ++ if (0) ++ RTW_INFO("%s => will change or clean state to 0x%08x\n", __func__, state); ++ ++ rtw_mi_status(adapter, &tmp_mstate); ++ _rtw_memcpy(iface_state, &tmp_mstate, sizeof(struct mi_state)); ++ ++ if (rtw_mi_get_ch_setting_union(adapter, &u_ch, &u_bw, &u_offset)) ++ rtw_mi_update_union_chan_inf(adapter , u_ch, u_offset , u_bw); ++ else { ++ if (0) { ++ dump_adapters_status(RTW_DBGDUMP , dvobj); ++ RTW_INFO("%s-[ERROR] cannot get union channel\n", __func__); ++ rtw_warn_on(1); ++ } ++ } ++ ++#ifdef DBG_IFACE_STATUS ++ DBG_IFACE_STATUS_DUMP(adapter); ++#endif ++} ++u8 rtw_mi_check_status(_adapter *adapter, u8 type) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mi_state *iface_state = &dvobj->iface_state; ++ u8 ret = _FALSE; ++ ++#ifdef DBG_IFACE_STATUS ++ DBG_IFACE_STATUS_DUMP(adapter); ++ RTW_INFO("%s-"ADPT_FMT" check type:%d\n", __func__, ADPT_ARG(adapter), type); ++#endif ++ ++ switch (type) { ++ case MI_LINKED: ++ if (MSTATE_STA_LD_NUM(iface_state) || MSTATE_AP_NUM(iface_state) || MSTATE_ADHOC_NUM(iface_state)) /*check_fwstate(&iface->mlmepriv, _FW_LINKED)*/ ++ ret = _TRUE; ++ break; ++ case MI_ASSOC: ++ if (MSTATE_STA_LD_NUM(iface_state) || MSTATE_AP_LD_NUM(iface_state) || MSTATE_ADHOC_LD_NUM(iface_state)) ++ ret = _TRUE; ++ break; ++ case MI_UNDER_WPS: ++ if (MSTATE_WPS_NUM(iface_state)) ++ ret = _TRUE; ++ break; ++ ++ case MI_AP_MODE: ++ if (MSTATE_AP_NUM(iface_state)) ++ ret = _TRUE; ++ break; ++ case MI_AP_ASSOC: ++ if (MSTATE_AP_LD_NUM(iface_state)) ++ ret = _TRUE; ++ break; ++ ++ case MI_ADHOC: ++ if (MSTATE_ADHOC_NUM(iface_state)) ++ ret = _TRUE; ++ break; ++ case MI_ADHOC_ASSOC: ++ if (MSTATE_ADHOC_LD_NUM(iface_state)) ++ ret = _TRUE; ++ break; ++ ++ case MI_STA_NOLINK: /* this is misleading, but not used now */ ++ if (MSTATE_STA_NUM(iface_state) && (!(MSTATE_STA_LD_NUM(iface_state) || MSTATE_STA_LG_NUM(iface_state)))) ++ ret = _TRUE; ++ break; ++ case MI_STA_LINKED: ++ if (MSTATE_STA_LD_NUM(iface_state)) ++ ret = _TRUE; ++ break; ++ case MI_STA_LINKING: ++ if (MSTATE_STA_LG_NUM(iface_state)) ++ ret = _TRUE; ++ break; ++ ++ default: ++ break; ++ } ++ return ret; ++} ++ ++u8 rtw_mi_mp_mode_check(_adapter *padapter) ++{ ++#ifdef CONFIG_MP_INCLUDED ++#ifdef CONFIG_CONCURRENT_MODE ++ int i; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ _adapter *iface = NULL; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ ++ if ((iface) && (iface->registrypriv.mp_mode == 1)) ++ return _TRUE; ++ } ++#else ++ if (padapter->registrypriv.mp_mode == 1) ++ return _TRUE; ++#endif ++#endif /* CONFIG_MP_INCLUDED */ ++ return _FALSE; ++} ++ ++/* ++* return value : 0 is failed or have not interface meet condition ++* return value : !0 is success or interface numbers which meet condition ++* return value of ops_func must be _TRUE or _FALSE ++*/ ++static u8 _rtw_mi_process(_adapter *padapter, bool exclude_self, ++ void *data, u8(*ops_func)(_adapter *padapter, void *data)) ++{ ++ int i; ++ _adapter *iface; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ ++ u8 ret = 0; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ ++ if ((exclude_self) && (iface == padapter)) ++ continue; ++ ++ if (ops_func) ++ if (_TRUE == ops_func(iface, data)) ++ ret++; ++ } ++ } ++ return ret; ++} ++static u8 _rtw_mi_netif_stop_queue(_adapter *padapter, void *data) ++{ ++ bool carrier_off = *(bool *)data; ++ struct net_device *pnetdev = padapter->pnetdev; ++ ++ if (carrier_off) ++ netif_carrier_off(pnetdev); ++ rtw_netif_stop_queue(pnetdev); ++ return _TRUE; ++} ++u8 rtw_mi_netif_stop_queue(_adapter *padapter, bool carrier_off) ++{ ++ bool in_data = carrier_off; ++ ++ return _rtw_mi_process(padapter, _FALSE, &in_data, _rtw_mi_netif_stop_queue); ++} ++u8 rtw_mi_buddy_netif_stop_queue(_adapter *padapter, bool carrier_off) ++{ ++ bool in_data = carrier_off; ++ ++ return _rtw_mi_process(padapter, _TRUE, &in_data, _rtw_mi_netif_stop_queue); ++} ++ ++static u8 _rtw_mi_netif_wake_queue(_adapter *padapter, void *data) ++{ ++ struct net_device *pnetdev = padapter->pnetdev; ++ ++ if (pnetdev) ++ rtw_netif_wake_queue(pnetdev); ++ return _TRUE; ++} ++u8 rtw_mi_netif_wake_queue(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_netif_wake_queue); ++} ++u8 rtw_mi_buddy_netif_wake_queue(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_netif_wake_queue); ++} ++ ++static u8 _rtw_mi_netif_carrier_on(_adapter *padapter, void *data) ++{ ++ struct net_device *pnetdev = padapter->pnetdev; ++ ++ if (pnetdev) ++ rtw_netif_carrier_on(pnetdev); ++ return _TRUE; ++} ++u8 rtw_mi_netif_carrier_on(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_netif_carrier_on); ++} ++u8 rtw_mi_buddy_netif_carrier_on(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_netif_carrier_on); ++} ++ ++static u8 _rtw_mi_scan_abort(_adapter *adapter, void *data) ++{ ++ bool bwait = *(bool *)data; ++ ++ if (bwait) ++ rtw_scan_abort(adapter); ++ else ++ rtw_scan_abort_no_wait(adapter); ++ ++ return _TRUE; ++} ++void rtw_mi_scan_abort(_adapter *adapter, bool bwait) ++{ ++ bool in_data = bwait; ++ ++ _rtw_mi_process(adapter, _FALSE, &in_data, _rtw_mi_scan_abort); ++ ++} ++void rtw_mi_buddy_scan_abort(_adapter *adapter, bool bwait) ++{ ++ bool in_data = bwait; ++ ++ _rtw_mi_process(adapter, _TRUE, &in_data, _rtw_mi_scan_abort); ++} ++ ++static u8 _rtw_mi_start_drv_threads(_adapter *adapter, void *data) ++{ ++ rtw_start_drv_threads(adapter); ++ return _TRUE; ++} ++void rtw_mi_start_drv_threads(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_start_drv_threads); ++} ++void rtw_mi_buddy_start_drv_threads(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_start_drv_threads); ++} ++ ++static u8 _rtw_mi_stop_drv_threads(_adapter *adapter, void *data) ++{ ++ rtw_stop_drv_threads(adapter); ++ return _TRUE; ++} ++void rtw_mi_stop_drv_threads(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_stop_drv_threads); ++} ++void rtw_mi_buddy_stop_drv_threads(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_stop_drv_threads); ++} ++ ++static u8 _rtw_mi_cancel_all_timer(_adapter *adapter, void *data) ++{ ++ rtw_cancel_all_timer(adapter); ++ return _TRUE; ++} ++void rtw_mi_cancel_all_timer(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_cancel_all_timer); ++} ++void rtw_mi_buddy_cancel_all_timer(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_cancel_all_timer); ++} ++ ++static u8 _rtw_mi_reset_drv_sw(_adapter *adapter, void *data) ++{ ++ rtw_reset_drv_sw(adapter); ++ return _TRUE; ++} ++void rtw_mi_reset_drv_sw(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_reset_drv_sw); ++} ++void rtw_mi_buddy_reset_drv_sw(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_reset_drv_sw); ++} ++ ++static u8 _rtw_mi_intf_start(_adapter *adapter, void *data) ++{ ++ rtw_intf_start(adapter); ++ return _TRUE; ++} ++void rtw_mi_intf_start(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_intf_start); ++} ++void rtw_mi_buddy_intf_start(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_intf_start); ++} ++ ++static u8 _rtw_mi_intf_stop(_adapter *adapter, void *data) ++{ ++ rtw_intf_stop(adapter); ++ return _TRUE; ++} ++void rtw_mi_intf_stop(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_intf_stop); ++} ++void rtw_mi_buddy_intf_stop(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_intf_stop); ++} ++ ++static u8 _rtw_mi_suspend_free_assoc_resource(_adapter *padapter, void *data) ++{ ++ return rtw_suspend_free_assoc_resource(padapter); ++} ++void rtw_mi_suspend_free_assoc_resource(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_suspend_free_assoc_resource); ++} ++void rtw_mi_buddy_suspend_free_assoc_resource(_adapter *adapter) ++{ ++ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_suspend_free_assoc_resource); ++} ++ ++static u8 _rtw_mi_is_scan_deny(_adapter *adapter, void *data) ++{ ++ return rtw_is_scan_deny(adapter); ++} ++ ++u8 rtw_mi_is_scan_deny(_adapter *adapter) ++{ ++ return _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_is_scan_deny); ++ ++} ++u8 rtw_mi_buddy_is_scan_deny(_adapter *adapter) ++{ ++ return _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_is_scan_deny); ++} ++ ++#ifdef CONFIG_SET_SCAN_DENY_TIMER ++static u8 _rtw_mi_set_scan_deny(_adapter *adapter, void *data) ++{ ++ u32 ms = *(u32 *)data; ++ ++ rtw_set_scan_deny(adapter, ms); ++ return _TRUE; ++} ++void rtw_mi_set_scan_deny(_adapter *adapter, u32 ms) ++{ ++ u32 in_data = ms; ++ ++ _rtw_mi_process(adapter, _FALSE, &in_data, _rtw_mi_set_scan_deny); ++} ++void rtw_mi_buddy_set_scan_deny(_adapter *adapter, u32 ms) ++{ ++ u32 in_data = ms; ++ ++ _rtw_mi_process(adapter, _TRUE, &in_data, _rtw_mi_set_scan_deny); ++} ++#endif ++ ++struct nulldata_param { ++ unsigned char *da; ++ unsigned int power_mode; ++ int try_cnt; ++ int wait_ms; ++}; ++ ++static u8 _rtw_mi_issue_nulldata(_adapter *padapter, void *data) ++{ ++ struct nulldata_param *pnulldata_param = (struct nulldata_param *)data; ++ ++ if (is_client_associated_to_ap(padapter) == _TRUE) { ++ /* TODO: TDLS peers */ ++ issue_nulldata(padapter, pnulldata_param->da, pnulldata_param->power_mode, pnulldata_param->try_cnt, pnulldata_param->wait_ms); ++ return _TRUE; ++ } ++ return _FALSE; ++} ++ ++u8 rtw_mi_issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) ++{ ++ struct nulldata_param nparam; ++ ++ nparam.da = da; ++ nparam.power_mode = power_mode;/*0 or 1*/ ++ nparam.try_cnt = try_cnt; ++ nparam.wait_ms = wait_ms; ++ ++ return _rtw_mi_process(padapter, _FALSE, &nparam, _rtw_mi_issue_nulldata); ++} ++u8 rtw_mi_buddy_issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) ++{ ++ struct nulldata_param nparam; ++ ++ nparam.da = da; ++ nparam.power_mode = power_mode; ++ nparam.try_cnt = try_cnt; ++ nparam.wait_ms = wait_ms; ++ ++ return _rtw_mi_process(padapter, _TRUE, &nparam, _rtw_mi_issue_nulldata); ++} ++ ++static u8 _rtw_mi_beacon_update(_adapter *padapter, void *data) ++{ ++ struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; ++ #ifdef CONFIG_AP_MODE ++ if (mlmeext_msr(mlmeext) == WIFI_FW_AP_STATE ++ && check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _TRUE) { ++ RTW_INFO(ADPT_FMT"-WIFI_FW_AP_STATE - update_beacon\n", ADPT_ARG(padapter)); ++ update_beacon(padapter, 0, NULL, _TRUE); ++ } ++#endif ++ return _TRUE; ++} ++ ++void rtw_mi_beacon_update(_adapter *padapter) ++{ ++ _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_beacon_update); ++} ++ ++void rtw_mi_buddy_beacon_update(_adapter *padapter) ++{ ++ _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_beacon_update); ++} ++ ++static u8 _rtw_mi_hal_dump_macaddr(_adapter *padapter, void *data) ++{ ++ u8 mac_addr[ETH_ALEN] = {0}; ++ ++ rtw_hal_get_macaddr_port(padapter, mac_addr); ++ RTW_INFO(ADPT_FMT"MAC Address ="MAC_FMT"\n", ADPT_ARG(padapter), MAC_ARG(mac_addr)); ++ return _TRUE; ++} ++void rtw_mi_hal_dump_macaddr(_adapter *padapter) ++{ ++ _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_hal_dump_macaddr); ++} ++void rtw_mi_buddy_hal_dump_macaddr(_adapter *padapter) ++{ ++ _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_hal_dump_macaddr); ++} ++ ++#ifdef CONFIG_PCI_HCI ++static u8 _rtw_mi_xmit_tasklet_schedule(_adapter *padapter, void *data) ++{ ++ if (rtw_txframes_pending(padapter)) { ++ /* try to deal with the pending packets */ ++ tasklet_hi_schedule(&(padapter->xmitpriv.xmit_tasklet)); ++ } ++ return _TRUE; ++} ++void rtw_mi_xmit_tasklet_schedule(_adapter *padapter) ++{ ++ _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_xmit_tasklet_schedule); ++} ++void rtw_mi_buddy_xmit_tasklet_schedule(_adapter *padapter) ++{ ++ _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_xmit_tasklet_schedule); ++} ++#endif ++ ++u8 _rtw_mi_busy_traffic_check(_adapter *padapter, void *data) ++{ ++ u32 passtime; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ bool check_sc_interval = *(bool *)data; ++ ++ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE) { ++ if (check_sc_interval) { ++ /* Miracast can't do AP scan*/ ++ passtime = rtw_get_passing_time_ms(pmlmepriv->lastscantime); ++ pmlmepriv->lastscantime = rtw_get_current_time(); ++ if (passtime > BUSY_TRAFFIC_SCAN_DENY_PERIOD) { ++ RTW_INFO(ADPT_FMT" bBusyTraffic == _TRUE\n", ADPT_ARG(padapter)); ++ return _TRUE; ++ } ++ } else ++ return _TRUE; ++ } ++ ++ return _FALSE; ++} ++ ++u8 rtw_mi_busy_traffic_check(_adapter *padapter, bool check_sc_interval) ++{ ++ bool in_data = check_sc_interval; ++ ++ return _rtw_mi_process(padapter, _FALSE, &in_data, _rtw_mi_busy_traffic_check); ++} ++u8 rtw_mi_buddy_busy_traffic_check(_adapter *padapter, bool check_sc_interval) ++{ ++ bool in_data = check_sc_interval; ++ ++ return _rtw_mi_process(padapter, _TRUE, &in_data, _rtw_mi_busy_traffic_check); ++} ++static u8 _rtw_mi_check_mlmeinfo_state(_adapter *padapter, void *data) ++{ ++ u32 state = *(u32 *)data; ++ struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; ++ ++ /*if (mlmeext_msr(mlmeext) == state)*/ ++ if (check_mlmeinfo_state(mlmeext, state)) ++ return _TRUE; ++ else ++ return _FALSE; ++} ++ ++u8 rtw_mi_check_mlmeinfo_state(_adapter *padapter, u32 state) ++{ ++ u32 in_data = state; ++ ++ return _rtw_mi_process(padapter, _FALSE, &in_data, _rtw_mi_check_mlmeinfo_state); ++} ++ ++u8 rtw_mi_buddy_check_mlmeinfo_state(_adapter *padapter, u32 state) ++{ ++ u32 in_data = state; ++ ++ return _rtw_mi_process(padapter, _TRUE, &in_data, _rtw_mi_check_mlmeinfo_state); ++} ++ ++/*#define DBG_DUMP_FW_STATE*/ ++#ifdef DBG_DUMP_FW_STATE ++static void rtw_dbg_dump_fwstate(_adapter *padapter, sint state) ++{ ++ u8 buf[32] = {0}; ++ ++ if (state & WIFI_FW_NULL_STATE) { ++ _rtw_memset(buf, 0, 32); ++ sprintf(buf, "WIFI_FW_NULL_STATE"); ++ RTW_INFO(FUNC_ADPT_FMT"fwstate-%s\n", FUNC_ADPT_ARG(padapter), buf); ++ } ++ ++ if (state & _FW_LINKED) { ++ _rtw_memset(buf, 0, 32); ++ sprintf(buf, "_FW_LINKED"); ++ RTW_INFO(FUNC_ADPT_FMT"fwstate-%s\n", FUNC_ADPT_ARG(padapter), buf); ++ } ++ ++ if (state & _FW_UNDER_LINKING) { ++ _rtw_memset(buf, 0, 32); ++ sprintf(buf, "_FW_UNDER_LINKING"); ++ RTW_INFO(FUNC_ADPT_FMT"fwstate-%s\n", FUNC_ADPT_ARG(padapter), buf); ++ } ++ ++ if (state & _FW_UNDER_SURVEY) { ++ _rtw_memset(buf, 0, 32); ++ sprintf(buf, "_FW_UNDER_SURVEY"); ++ RTW_INFO(FUNC_ADPT_FMT"fwstate-%s\n", FUNC_ADPT_ARG(padapter), buf); ++ } ++} ++#endif ++ ++static u8 _rtw_mi_check_fwstate(_adapter *padapter, void *data) ++{ ++ u8 ret = _FALSE; ++ ++ sint state = *(sint *)data; ++ ++ if ((state == WIFI_FW_NULL_STATE) && ++ (padapter->mlmepriv.fw_state == WIFI_FW_NULL_STATE)) ++ ret = _TRUE; ++ else if (_TRUE == check_fwstate(&padapter->mlmepriv, state)) ++ ret = _TRUE; ++#ifdef DBG_DUMP_FW_STATE ++ if (ret) ++ rtw_dbg_dump_fwstate(padapter, state); ++#endif ++ return ret; ++} ++u8 rtw_mi_check_fwstate(_adapter *padapter, sint state) ++{ ++ sint in_data = state; ++ ++ return _rtw_mi_process(padapter, _FALSE, &in_data, _rtw_mi_check_fwstate); ++} ++u8 rtw_mi_buddy_check_fwstate(_adapter *padapter, sint state) ++{ ++ sint in_data = state; ++ ++ return _rtw_mi_process(padapter, _TRUE, &in_data, _rtw_mi_check_fwstate); ++} ++ ++static u8 _rtw_mi_traffic_statistics(_adapter *padapter , void *data) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ ++ /* Tx */ ++ pdvobjpriv->traffic_stat.tx_bytes += padapter->xmitpriv.tx_bytes; ++ pdvobjpriv->traffic_stat.tx_pkts += padapter->xmitpriv.tx_pkts; ++ pdvobjpriv->traffic_stat.tx_drop += padapter->xmitpriv.tx_drop; ++ ++ /* Rx */ ++ pdvobjpriv->traffic_stat.rx_bytes += padapter->recvpriv.rx_bytes; ++ pdvobjpriv->traffic_stat.rx_pkts += padapter->recvpriv.rx_pkts; ++ pdvobjpriv->traffic_stat.rx_drop += padapter->recvpriv.rx_drop; ++ return _TRUE; ++} ++u8 rtw_mi_traffic_statistics(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_traffic_statistics); ++} ++ ++static u8 _rtw_mi_check_miracast_enabled(_adapter *padapter , void *data) ++{ ++ return is_miracast_enabled(padapter); ++} ++u8 rtw_mi_check_miracast_enabled(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_check_miracast_enabled); ++} ++ ++#ifdef CONFIG_XMIT_THREAD_MODE ++static u8 _rtw_mi_check_pending_xmitbuf(_adapter *padapter , void *data) ++{ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ return check_pending_xmitbuf(pxmitpriv); ++} ++u8 rtw_mi_check_pending_xmitbuf(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_check_pending_xmitbuf); ++} ++u8 rtw_mi_buddy_check_pending_xmitbuf(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_check_pending_xmitbuf); ++} ++#endif ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++static u8 _rtw_mi_dequeue_writeport(_adapter *padapter , bool exclude_self) ++{ ++ int i; ++ u8 queue_empty = _TRUE; ++ _adapter *iface; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ ++ if ((exclude_self) && (iface == padapter)) ++ continue; ++ ++ queue_empty &= _dequeue_writeport(iface); ++ } ++ } ++ return queue_empty; ++} ++u8 rtw_mi_dequeue_writeport(_adapter *padapter) ++{ ++ return _rtw_mi_dequeue_writeport(padapter, _FALSE); ++} ++u8 rtw_mi_buddy_dequeue_writeport(_adapter *padapter) ++{ ++ return _rtw_mi_dequeue_writeport(padapter, _TRUE); ++} ++#endif ++static void _rtw_mi_adapter_reset(_adapter *padapter , u8 exclude_self) ++{ ++ int i; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (dvobj->padapters[i]) { ++ if ((exclude_self) && (dvobj->padapters[i] == padapter)) ++ continue; ++ dvobj->padapters[i] = NULL; ++ } ++ } ++} ++ ++void rtw_mi_adapter_reset(_adapter *padapter) ++{ ++ _rtw_mi_adapter_reset(padapter, _FALSE); ++} ++ ++void rtw_mi_buddy_adapter_reset(_adapter *padapter) ++{ ++ _rtw_mi_adapter_reset(padapter, _TRUE); ++} ++ ++static u8 _rtw_mi_dynamic_check_timer_handlder(_adapter *adapter, void *data) ++{ ++ rtw_iface_dynamic_check_timer_handlder(adapter); ++ return _TRUE; ++} ++u8 rtw_mi_dynamic_check_timer_handlder(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_dynamic_check_timer_handlder); ++} ++u8 rtw_mi_buddy_dynamic_check_timer_handlder(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_dynamic_check_timer_handlder); ++} ++ ++static u8 _rtw_mi_dev_unload(_adapter *adapter, void *data) ++{ ++ rtw_dev_unload(adapter); ++ return _TRUE; ++} ++u8 rtw_mi_dev_unload(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_dev_unload); ++} ++u8 rtw_mi_buddy_dev_unload(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_dev_unload); ++} ++ ++static u8 _rtw_mi_dynamic_chk_wk_hdl(_adapter *adapter, void *data) ++{ ++ rtw_iface_dynamic_chk_wk_hdl(adapter); ++ return _TRUE; ++} ++u8 rtw_mi_dynamic_chk_wk_hdl(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_dynamic_chk_wk_hdl); ++} ++u8 rtw_mi_buddy_dynamic_chk_wk_hdl(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_dynamic_chk_wk_hdl); ++} ++ ++static u8 _rtw_mi_os_xmit_schedule(_adapter *adapter, void *data) ++{ ++ rtw_os_xmit_schedule(adapter); ++ return _TRUE; ++} ++u8 rtw_mi_os_xmit_schedule(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_os_xmit_schedule); ++} ++u8 rtw_mi_buddy_os_xmit_schedule(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_os_xmit_schedule); ++} ++ ++static u8 _rtw_mi_report_survey_event(_adapter *adapter, void *data) ++{ ++ union recv_frame *precv_frame = (union recv_frame *)data; ++ ++ report_survey_event(adapter, precv_frame); ++ return _TRUE; ++} ++u8 rtw_mi_report_survey_event(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ return _rtw_mi_process(padapter, _FALSE, precv_frame, _rtw_mi_report_survey_event); ++} ++u8 rtw_mi_buddy_report_survey_event(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ return _rtw_mi_process(padapter, _TRUE, precv_frame, _rtw_mi_report_survey_event); ++} ++ ++static u8 _rtw_mi_sreset_adapter_hdl(_adapter *adapter, void *data) ++{ ++ u8 bstart = *(u8 *)data; ++ ++ if (bstart) ++ sreset_start_adapter(adapter); ++ else ++ sreset_stop_adapter(adapter); ++ return _TRUE; ++} ++u8 rtw_mi_sreset_adapter_hdl(_adapter *padapter, u8 bstart) ++{ ++ u8 in_data = bstart; ++ ++ return _rtw_mi_process(padapter, _FALSE, &in_data, _rtw_mi_sreset_adapter_hdl); ++} ++u8 rtw_mi_buddy_sreset_adapter_hdl(_adapter *padapter, u8 bstart) ++{ ++ u8 in_data = bstart; ++ ++ return _rtw_mi_process(padapter, _TRUE, &in_data, _rtw_mi_sreset_adapter_hdl); ++} ++#ifdef CONFIG_AP_MODE ++static u8 _rtw_mi_tx_beacon_hdl(_adapter *adapter, void *data) ++{ ++ if (check_fwstate(&adapter->mlmepriv, WIFI_AP_STATE) == _TRUE ++ && check_fwstate(&adapter->mlmepriv, WIFI_ASOC_STATE) == _TRUE ++ ) { ++ adapter->mlmepriv.update_bcn = _TRUE; ++#ifndef CONFIG_INTERRUPT_BASED_TXBCN ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ tx_beacon_hdl(adapter, NULL); ++#endif ++#endif ++ } ++ return _TRUE; ++} ++u8 rtw_mi_tx_beacon_hdl(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_tx_beacon_hdl); ++} ++u8 rtw_mi_buddy_tx_beacon_hdl(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_sreset_adapter_hdl); ++} ++ ++static u8 _rtw_mi_set_tx_beacon_cmd(_adapter *adapter, void *data) ++{ ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ if (pmlmepriv->update_bcn == _TRUE) ++ set_tx_beacon_cmd(adapter); ++ } ++ return _TRUE; ++} ++u8 rtw_mi_set_tx_beacon_cmd(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_set_tx_beacon_cmd); ++} ++u8 rtw_mi_buddy_set_tx_beacon_cmd(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_set_tx_beacon_cmd); ++} ++#endif /* CONFIG_AP MODE */ ++ ++#ifdef CONFIG_P2P ++static u8 _rtw_mi_p2p_chk_state(_adapter *adapter, void *data) ++{ ++ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); ++ enum P2P_STATE state = *(enum P2P_STATE *)data; ++ ++ return rtw_p2p_chk_state(pwdinfo, state); ++} ++u8 rtw_mi_p2p_chk_state(_adapter *padapter, enum P2P_STATE p2p_state) ++{ ++ u8 in_data = p2p_state; ++ ++ return _rtw_mi_process(padapter, _FALSE, &in_data, _rtw_mi_p2p_chk_state); ++} ++u8 rtw_mi_buddy_p2p_chk_state(_adapter *padapter, enum P2P_STATE p2p_state) ++{ ++ u8 in_data = p2p_state; ++ ++ return _rtw_mi_process(padapter, _TRUE, &in_data, _rtw_mi_p2p_chk_state); ++} ++static u8 _rtw_mi_stay_in_p2p_mode(_adapter *adapter, void *data) ++{ ++ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); ++ ++ if (rtw_p2p_role(pwdinfo) != P2P_ROLE_DISABLE) ++ return _TRUE; ++ return _FALSE; ++} ++u8 rtw_mi_stay_in_p2p_mode(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_stay_in_p2p_mode); ++} ++u8 rtw_mi_buddy_stay_in_p2p_mode(_adapter *padapter) ++{ ++ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_stay_in_p2p_mode); ++} ++#endif /*CONFIG_P2P*/ ++ ++_adapter *rtw_get_iface_by_id(_adapter *padapter, u8 iface_id) ++{ ++ _adapter *iface = NULL; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ ++ if ((padapter == NULL) || (iface_id >= CONFIG_IFACE_NUMBER)) { ++ rtw_warn_on(1); ++ return iface; ++ } ++ ++ return dvobj->padapters[iface_id]; ++} ++ ++_adapter *rtw_get_iface_by_macddr(_adapter *padapter, u8 *mac_addr) ++{ ++ int i; ++ _adapter *iface = NULL; ++ u8 bmatch = _FALSE; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && (_rtw_memcmp(mac_addr, adapter_mac_addr(iface), ETH_ALEN))) { ++ bmatch = _TRUE; ++ break; ++ } ++ } ++ if (bmatch) ++ return iface; ++ else ++ return NULL; ++} ++ ++_adapter *rtw_get_iface_by_hwport(_adapter *padapter, u8 hw_port) ++{ ++ int i; ++ _adapter *iface = NULL; ++ u8 bmatch = _FALSE; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && (hw_port == iface->hw_port)) { ++ bmatch = _TRUE; ++ break; ++ } ++ } ++ if (bmatch) ++ return iface; ++ else ++ return NULL; ++} ++ ++/*#define CONFIG_SKB_ALLOCATED*/ ++#define DBG_SKB_PROCESS ++#ifdef DBG_SKB_PROCESS ++void rtw_dbg_skb_process(_adapter *padapter, union recv_frame *precvframe, union recv_frame *pcloneframe) ++{ ++ _pkt *pkt_copy, *pkt_org; ++ ++ pkt_org = precvframe->u.hdr.pkt; ++ pkt_copy = pcloneframe->u.hdr.pkt; ++ /* ++ RTW_INFO("%s ===== ORG SKB =====\n", __func__); ++ RTW_INFO(" SKB head(%p)\n", pkt_org->head); ++ RTW_INFO(" SKB data(%p)\n", pkt_org->data); ++ RTW_INFO(" SKB tail(%p)\n", pkt_org->tail); ++ RTW_INFO(" SKB end(%p)\n", pkt_org->end); ++ ++ RTW_INFO(" recv frame head(%p)\n", precvframe->u.hdr.rx_head); ++ RTW_INFO(" recv frame data(%p)\n", precvframe->u.hdr.rx_data); ++ RTW_INFO(" recv frame tail(%p)\n", precvframe->u.hdr.rx_tail); ++ RTW_INFO(" recv frame end(%p)\n", precvframe->u.hdr.rx_end); ++ ++ RTW_INFO("%s ===== COPY SKB =====\n", __func__); ++ RTW_INFO(" SKB head(%p)\n", pkt_copy->head); ++ RTW_INFO(" SKB data(%p)\n", pkt_copy->data); ++ RTW_INFO(" SKB tail(%p)\n", pkt_copy->tail); ++ RTW_INFO(" SKB end(%p)\n", pkt_copy->end); ++ ++ RTW_INFO(" recv frame head(%p)\n", pcloneframe->u.hdr.rx_head); ++ RTW_INFO(" recv frame data(%p)\n", pcloneframe->u.hdr.rx_data); ++ RTW_INFO(" recv frame tail(%p)\n", pcloneframe->u.hdr.rx_tail); ++ RTW_INFO(" recv frame end(%p)\n", pcloneframe->u.hdr.rx_end); ++ */ ++ /* ++ RTW_INFO("%s => recv_frame adapter(%p,%p)\n", __func__, precvframe->u.hdr.adapter, pcloneframe->u.hdr.adapter); ++ RTW_INFO("%s => recv_frame dev(%p,%p)\n", __func__, pkt_org->dev , pkt_copy->dev); ++ RTW_INFO("%s => recv_frame len(%d,%d)\n", __func__, precvframe->u.hdr.len, pcloneframe->u.hdr.len); ++ */ ++ if (precvframe->u.hdr.len != pcloneframe->u.hdr.len) ++ RTW_INFO("%s [WARN] recv_frame length(%d:%d) compare failed\n", __func__, precvframe->u.hdr.len, pcloneframe->u.hdr.len); ++ ++ if (_rtw_memcmp(&precvframe->u.hdr.attrib, &pcloneframe->u.hdr.attrib, sizeof(struct rx_pkt_attrib)) == _FALSE) ++ RTW_INFO("%s [WARN] recv_frame attrib compare failed\n", __func__); ++ ++ if (_rtw_memcmp(precvframe->u.hdr.rx_data, pcloneframe->u.hdr.rx_data, precvframe->u.hdr.len) == _FALSE) ++ RTW_INFO("%s [WARN] recv_frame rx_data compare failed\n", __func__); ++ ++} ++#endif ++ ++static s32 _rtw_mi_buddy_clone_bcmc_packet(_adapter *adapter, union recv_frame *precvframe, u8 *pphy_status, union recv_frame *pcloneframe) ++{ ++ s32 ret = _SUCCESS; ++ u8 *pbuf = precvframe->u.hdr.rx_data; ++ struct rx_pkt_attrib *pattrib = NULL; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); ++ ++ if (pcloneframe) { ++ pcloneframe->u.hdr.adapter = adapter; ++ ++ _rtw_init_listhead(&pcloneframe->u.hdr.list); ++ pcloneframe->u.hdr.precvbuf = NULL; /*can't access the precvbuf for new arch.*/ ++ pcloneframe->u.hdr.len = 0; ++ ++ _rtw_memcpy(&pcloneframe->u.hdr.attrib, &precvframe->u.hdr.attrib, sizeof(struct rx_pkt_attrib)); ++ ++ pattrib = &pcloneframe->u.hdr.attrib; ++#ifdef CONFIG_SKB_ALLOCATED ++ if (rtw_os_alloc_recvframe(adapter, pcloneframe, pbuf, NULL) == _SUCCESS) ++#else ++ if (rtw_os_recvframe_duplicate_skb(adapter, pcloneframe, precvframe->u.hdr.pkt) == _SUCCESS) ++#endif ++ { ++#ifdef CONFIG_SKB_ALLOCATED ++ recvframe_put(pcloneframe, pattrib->pkt_len); ++#endif ++ ++#ifdef DBG_SKB_PROCESS ++ rtw_dbg_skb_process(adapter, precvframe, pcloneframe); ++#endif ++ ++ if (pattrib->physt && pphy_status) ++ rx_query_phy_status(pcloneframe, pphy_status); ++ ++ ret = rtw_recv_entry(pcloneframe); ++ } else { ++ ret = -1; ++ RTW_INFO("%s()-%d: rtw_os_alloc_recvframe() failed!\n", __func__, __LINE__); ++ } ++ ++ } ++ return ret; ++} ++ ++void rtw_mi_buddy_clone_bcmc_packet(_adapter *padapter, union recv_frame *precvframe, u8 *pphy_status) ++{ ++ int i; ++ s32 ret = _SUCCESS; ++ _adapter *iface = NULL; ++ union recv_frame *pcloneframe = NULL; ++ struct recv_priv *precvpriv = &padapter->recvpriv;/*primary_padapter*/ ++ _queue *pfree_recv_queue = &precvpriv->free_recv_queue; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (!iface || iface == padapter) ++ continue; ++ if (rtw_is_adapter_up(iface) == _FALSE || iface->registered == 0) ++ continue; ++ ++ pcloneframe = rtw_alloc_recvframe(pfree_recv_queue); ++ if (pcloneframe) { ++ ret = _rtw_mi_buddy_clone_bcmc_packet(iface, precvframe, pphy_status, pcloneframe); ++ if (_SUCCESS != ret) { ++ if (ret == -1) ++ rtw_free_recvframe(pcloneframe, pfree_recv_queue); ++ /*RTW_INFO(ADPT_FMT"-clone BC/MC frame failed\n", ADPT_ARG(iface));*/ ++ } ++ } ++ } ++ ++} ++ ++#ifdef CONFIG_PCI_HCI ++/*API be created temporary for MI, caller is interrupt-handler, PCIE's interrupt handler cannot apply to multi-AP*/ ++_adapter *rtw_mi_get_ap_adapter(_adapter *padapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ int i; ++ _adapter *iface = NULL; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (!iface) ++ continue; ++ ++ if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE ++ && check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE) ++ break; ++ ++ } ++ return iface; ++} ++#endif ++ ++void rtw_mi_update_ap_bmc_camid(_adapter *padapter, u8 camid_a, u8 camid_b) ++{ ++#ifdef CONFIG_CONCURRENT_MODE ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ ++ int i; ++ _adapter *iface = NULL; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (!iface) ++ continue; ++ ++ if (macid_ctl->iface_bmc[iface->iface_id] != INVALID_SEC_MAC_CAM_ID) { ++ if (macid_ctl->iface_bmc[iface->iface_id] == camid_a) ++ macid_ctl->iface_bmc[iface->iface_id] = camid_b; ++ else if (macid_ctl->iface_bmc[iface->iface_id] == camid_b) ++ macid_ctl->iface_bmc[iface->iface_id] = camid_a; ++ iface->securitypriv.dot118021x_bmc_cam_id = macid_ctl->iface_bmc[iface->iface_id]; ++ } ++ } ++#endif ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_mlme.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mlme.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_mlme.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mlme.c 2018-02-11 21:44:27.137145933 +0200 +@@ -0,0 +1,4668 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_MLME_C_ ++ ++#include ++ ++extern void indicate_wx_scan_complete_event(_adapter *padapter); ++extern u8 rtw_do_join(_adapter *padapter); ++ ++ ++sint _rtw_init_mlme_priv(_adapter *padapter) ++{ ++ sint i; ++ u8 *pbuf; ++ struct wlan_network *pnetwork; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ sint res = _SUCCESS; ++ ++ ++ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). */ ++ /* _rtw_memset((u8 *)pmlmepriv, 0, sizeof(struct mlme_priv)); */ ++ ++ ++ /*qos_priv*/ ++ /*pmlmepriv->qospriv.qos_option = pregistrypriv->wmm_enable;*/ ++ ++ /*ht_priv*/ ++#ifdef CONFIG_80211N_HT ++ pmlmepriv->htpriv.ampdu_enable = _FALSE;/*set to disabled*/ ++#endif ++ ++ pmlmepriv->nic_hdl = (u8 *)padapter; ++ ++ pmlmepriv->pscanned = NULL; ++ /*pmlmepriv->fw_state = WIFI_STATION_STATE; */ /*Must sync with rtw_wdev_alloc()*/ ++ /*init_fwstate(pmlmepriv, WIFI_STATION_STATE);*/ ++ init_fwstate(pmlmepriv, WIFI_NULL_STATE);/*assigned interface role(STA/AP) must after execute set_opmode*/ ++ ++ /* wdev->iftype = NL80211_IFTYPE_STATION*/ ++ pmlmepriv->cur_network.network.InfrastructureMode = Ndis802_11AutoUnknown; ++ pmlmepriv->scan_mode = SCAN_ACTIVE; /* 1: active, 0: pasive. Maybe someday we should rename this varable to "active_mode" (Jeff) */ ++ ++ _rtw_spinlock_init(&(pmlmepriv->lock)); ++ _rtw_init_queue(&(pmlmepriv->free_bss_pool)); ++ _rtw_init_queue(&(pmlmepriv->scanned_queue)); ++ ++ set_scanned_network_val(pmlmepriv, 0); ++ ++ _rtw_memset(&pmlmepriv->assoc_ssid, 0, sizeof(NDIS_802_11_SSID)); ++ ++ pbuf = rtw_zvmalloc(MAX_BSS_CNT * (sizeof(struct wlan_network))); ++ ++ if (pbuf == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ pmlmepriv->free_bss_buf = pbuf; ++ ++ pnetwork = (struct wlan_network *)pbuf; ++ ++ for (i = 0; i < MAX_BSS_CNT; i++) { ++ _rtw_init_listhead(&(pnetwork->list)); ++ ++ rtw_list_insert_tail(&(pnetwork->list), &(pmlmepriv->free_bss_pool.queue)); ++ ++ pnetwork++; ++ } ++ ++ /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */ ++ ++ rtw_clear_scan_deny(padapter); ++#ifdef CONFIG_ARP_KEEP_ALIVE ++ pmlmepriv->bGetGateway = 0; ++ pmlmepriv->GetGatewayTryCnt = 0; ++#endif ++ ++#ifdef CONFIG_LAYER2_ROAMING ++#define RTW_ROAM_SCAN_RESULT_EXP_MS (5*1000) ++#define RTW_ROAM_RSSI_DIFF_TH 10 ++#define RTW_ROAM_SCAN_INTERVAL_MS (10*1000) ++#define RTW_ROAM_RSSI_THRESHOLD 70 ++ ++ pmlmepriv->roam_flags = 0 ++ | RTW_ROAM_ON_EXPIRED ++#ifdef CONFIG_LAYER2_ROAMING_RESUME ++ | RTW_ROAM_ON_RESUME ++#endif ++#ifdef CONFIG_LAYER2_ROAMING_ACTIVE ++ | RTW_ROAM_ACTIVE ++#endif ++ ; ++ ++ pmlmepriv->roam_scanr_exp_ms = RTW_ROAM_SCAN_RESULT_EXP_MS; ++ pmlmepriv->roam_rssi_diff_th = RTW_ROAM_RSSI_DIFF_TH; ++ pmlmepriv->roam_scan_int_ms = RTW_ROAM_SCAN_INTERVAL_MS; ++ pmlmepriv->roam_rssi_threshold = RTW_ROAM_RSSI_THRESHOLD; ++#endif /* CONFIG_LAYER2_ROAMING */ ++ ++#ifdef CONFIG_RTW_80211R ++ memset(&pmlmepriv->ftpriv, 0, sizeof(ft_priv)); ++ pmlmepriv->ftpriv.ft_flags = 0 ++ | RTW_FT_STA_SUPPORTED ++ | RTW_FT_STA_OVER_DS_SUPPORTED ++ ; ++#endif ++ rtw_init_mlme_timer(padapter); ++ ++exit: ++ ++ ++ return res; ++} ++ ++void rtw_mfree_mlme_priv_lock(struct mlme_priv *pmlmepriv); ++void rtw_mfree_mlme_priv_lock(struct mlme_priv *pmlmepriv) ++{ ++ _rtw_spinlock_free(&pmlmepriv->lock); ++ _rtw_spinlock_free(&(pmlmepriv->free_bss_pool.lock)); ++ _rtw_spinlock_free(&(pmlmepriv->scanned_queue.lock)); ++} ++ ++static void rtw_free_mlme_ie_data(u8 **ppie, u32 *plen) ++{ ++ if (*ppie) { ++ rtw_mfree(*ppie, *plen); ++ *plen = 0; ++ *ppie = NULL; ++ } ++} ++ ++void rtw_free_mlme_priv_ie_data(struct mlme_priv *pmlmepriv) ++{ ++#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) ++ rtw_buf_free(&pmlmepriv->assoc_req, &pmlmepriv->assoc_req_len); ++ rtw_buf_free(&pmlmepriv->assoc_rsp, &pmlmepriv->assoc_rsp_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->wps_beacon_ie, &pmlmepriv->wps_beacon_ie_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->wps_probe_req_ie, &pmlmepriv->wps_probe_req_ie_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->wps_probe_resp_ie, &pmlmepriv->wps_probe_resp_ie_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->wps_assoc_resp_ie, &pmlmepriv->wps_assoc_resp_ie_len); ++ ++ rtw_free_mlme_ie_data(&pmlmepriv->p2p_beacon_ie, &pmlmepriv->p2p_beacon_ie_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->p2p_probe_req_ie, &pmlmepriv->p2p_probe_req_ie_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->p2p_probe_resp_ie, &pmlmepriv->p2p_probe_resp_ie_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->p2p_go_probe_resp_ie, &pmlmepriv->p2p_go_probe_resp_ie_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->p2p_assoc_req_ie, &pmlmepriv->p2p_assoc_req_ie_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->p2p_assoc_resp_ie, &pmlmepriv->p2p_assoc_resp_ie_len); ++#endif ++ ++#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) ++ rtw_free_mlme_ie_data(&pmlmepriv->wfd_beacon_ie, &pmlmepriv->wfd_beacon_ie_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->wfd_probe_req_ie, &pmlmepriv->wfd_probe_req_ie_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->wfd_probe_resp_ie, &pmlmepriv->wfd_probe_resp_ie_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->wfd_go_probe_resp_ie, &pmlmepriv->wfd_go_probe_resp_ie_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->wfd_assoc_req_ie, &pmlmepriv->wfd_assoc_req_ie_len); ++ rtw_free_mlme_ie_data(&pmlmepriv->wfd_assoc_resp_ie, &pmlmepriv->wfd_assoc_resp_ie_len); ++#endif ++ ++#ifdef CONFIG_RTW_80211R ++ rtw_free_mlme_ie_data(&pmlmepriv->auth_rsp, &pmlmepriv->auth_rsp_len); ++#endif ++} ++ ++#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) ++int rtw_mlme_update_wfd_ie_data(struct mlme_priv *mlme, u8 type, u8 *ie, u32 ie_len) ++{ ++ _adapter *adapter = mlme_to_adapter(mlme); ++ struct wifi_display_info *wfd_info = &adapter->wfd_info; ++ u8 clear = 0; ++ u8 **t_ie = NULL; ++ u32 *t_ie_len = NULL; ++ int ret = _FAIL; ++ ++ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) ++ goto success; ++ ++ if (wfd_info->wfd_enable == _TRUE) ++ goto success; /* WFD IE is build by self */ ++ ++ if (!ie && !ie_len) ++ clear = 1; ++ else if (!ie || !ie_len) { ++ RTW_PRINT(FUNC_ADPT_FMT" type:%u, ie:%p, ie_len:%u" ++ , FUNC_ADPT_ARG(adapter), type, ie, ie_len); ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ switch (type) { ++ case MLME_BEACON_IE: ++ t_ie = &mlme->wfd_beacon_ie; ++ t_ie_len = &mlme->wfd_beacon_ie_len; ++ break; ++ case MLME_PROBE_REQ_IE: ++ t_ie = &mlme->wfd_probe_req_ie; ++ t_ie_len = &mlme->wfd_probe_req_ie_len; ++ break; ++ case MLME_PROBE_RESP_IE: ++ t_ie = &mlme->wfd_probe_resp_ie; ++ t_ie_len = &mlme->wfd_probe_resp_ie_len; ++ break; ++ case MLME_GO_PROBE_RESP_IE: ++ t_ie = &mlme->wfd_go_probe_resp_ie; ++ t_ie_len = &mlme->wfd_go_probe_resp_ie_len; ++ break; ++ case MLME_ASSOC_REQ_IE: ++ t_ie = &mlme->wfd_assoc_req_ie; ++ t_ie_len = &mlme->wfd_assoc_req_ie_len; ++ break; ++ case MLME_ASSOC_RESP_IE: ++ t_ie = &mlme->wfd_assoc_resp_ie; ++ t_ie_len = &mlme->wfd_assoc_resp_ie_len; ++ break; ++ default: ++ RTW_PRINT(FUNC_ADPT_FMT" unsupported type:%u" ++ , FUNC_ADPT_ARG(adapter), type); ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (*t_ie) { ++ u32 free_len = *t_ie_len; ++ *t_ie_len = 0; ++ rtw_mfree(*t_ie, free_len); ++ *t_ie = NULL; ++ } ++ ++ if (!clear) { ++ *t_ie = rtw_malloc(ie_len); ++ if (*t_ie == NULL) { ++ RTW_ERR(FUNC_ADPT_FMT" type:%u, rtw_malloc() fail\n" ++ , FUNC_ADPT_ARG(adapter), type); ++ goto exit; ++ } ++ _rtw_memcpy(*t_ie, ie, ie_len); ++ *t_ie_len = ie_len; ++ } ++ ++ if (*t_ie && *t_ie_len) { ++ u8 *attr_content; ++ u32 attr_contentlen = 0; ++ ++ attr_content = rtw_get_wfd_attr_content(*t_ie, *t_ie_len, WFD_ATTR_DEVICE_INFO, NULL, &attr_contentlen); ++ if (attr_content && attr_contentlen) { ++ if (RTW_GET_BE16(attr_content + 2) != wfd_info->rtsp_ctrlport) { ++ wfd_info->rtsp_ctrlport = RTW_GET_BE16(attr_content + 2); ++ RTW_INFO(FUNC_ADPT_FMT" type:%u, RTSP CTRL port = %u\n" ++ , FUNC_ADPT_ARG(adapter), type, wfd_info->rtsp_ctrlport); ++ } ++ } ++ } ++ ++success: ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++#endif /* defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) */ ++ ++void _rtw_free_mlme_priv(struct mlme_priv *pmlmepriv) ++{ ++ if (NULL == pmlmepriv) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ rtw_free_mlme_priv_ie_data(pmlmepriv); ++ ++ if (pmlmepriv) { ++ rtw_mfree_mlme_priv_lock(pmlmepriv); ++ ++ if (pmlmepriv->free_bss_buf) ++ rtw_vmfree(pmlmepriv->free_bss_buf, MAX_BSS_CNT * sizeof(struct wlan_network)); ++ } ++exit: ++ return; ++} ++ ++sint _rtw_enqueue_network(_queue *queue, struct wlan_network *pnetwork) ++{ ++ _irqL irqL; ++ ++ ++ if (pnetwork == NULL) ++ goto exit; ++ ++ _enter_critical_bh(&queue->lock, &irqL); ++ ++ rtw_list_insert_tail(&pnetwork->list, &queue->queue); ++ ++ _exit_critical_bh(&queue->lock, &irqL); ++ ++exit: ++ ++ ++ return _SUCCESS; ++} ++ ++/* ++struct wlan_network *_rtw_dequeue_network(_queue *queue) ++{ ++ _irqL irqL; ++ ++ struct wlan_network *pnetwork; ++ ++ ++ _enter_critical_bh(&queue->lock, &irqL); ++ ++ if (_rtw_queue_empty(queue) == _TRUE) ++ ++ pnetwork = NULL; ++ ++ else ++ { ++ pnetwork = LIST_CONTAINOR(get_next(&queue->queue), struct wlan_network, list); ++ ++ rtw_list_delete(&(pnetwork->list)); ++ } ++ ++ _exit_critical_bh(&queue->lock, &irqL); ++ ++ ++ return pnetwork; ++} ++*/ ++ ++struct wlan_network *_rtw_alloc_network(struct mlme_priv *pmlmepriv) /* (_queue *free_queue) */ ++{ ++ _irqL irqL; ++ struct wlan_network *pnetwork; ++ _queue *free_queue = &pmlmepriv->free_bss_pool; ++ _list *plist = NULL; ++ ++ ++ _enter_critical_bh(&free_queue->lock, &irqL); ++ ++ if (_rtw_queue_empty(free_queue) == _TRUE) { ++ pnetwork = NULL; ++ goto exit; ++ } ++ plist = get_next(&(free_queue->queue)); ++ ++ pnetwork = LIST_CONTAINOR(plist , struct wlan_network, list); ++ ++ rtw_list_delete(&pnetwork->list); ++ ++ pnetwork->network_type = 0; ++ pnetwork->fixed = _FALSE; ++ pnetwork->last_scanned = rtw_get_current_time(); ++ pnetwork->aid = 0; ++ pnetwork->join_res = 0; ++ ++ pmlmepriv->num_of_scanned++; ++ ++exit: ++ _exit_critical_bh(&free_queue->lock, &irqL); ++ ++ ++ return pnetwork; ++} ++ ++void _rtw_free_network(struct mlme_priv *pmlmepriv , struct wlan_network *pnetwork, u8 isfreeall) ++{ ++ u32 delta_time; ++ u32 lifetime = SCANQUEUE_LIFETIME; ++ _irqL irqL; ++ _queue *free_queue = &(pmlmepriv->free_bss_pool); ++ ++ ++ if (pnetwork == NULL) ++ goto exit; ++ ++ if (pnetwork->fixed == _TRUE) ++ goto exit; ++ ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) ++ lifetime = 1; ++ ++ if (!isfreeall) { ++ delta_time = (u32) rtw_get_passing_time_ms(pnetwork->last_scanned); ++ if (delta_time < lifetime) /* unit:msec */ ++ goto exit; ++ } ++ ++ _enter_critical_bh(&free_queue->lock, &irqL); ++ ++ rtw_list_delete(&(pnetwork->list)); ++ ++ rtw_list_insert_tail(&(pnetwork->list), &(free_queue->queue)); ++ ++ pmlmepriv->num_of_scanned--; ++ ++ ++ /* RTW_INFO("_rtw_free_network:SSID=%s\n", pnetwork->network.Ssid.Ssid); */ ++ ++ _exit_critical_bh(&free_queue->lock, &irqL); ++ ++exit: ++ return; ++} ++ ++void _rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork) ++{ ++ ++ _queue *free_queue = &(pmlmepriv->free_bss_pool); ++ ++ ++ if (pnetwork == NULL) ++ goto exit; ++ ++ if (pnetwork->fixed == _TRUE) ++ goto exit; ++ ++ /* _enter_critical(&free_queue->lock, &irqL); */ ++ ++ rtw_list_delete(&(pnetwork->list)); ++ ++ rtw_list_insert_tail(&(pnetwork->list), get_list_head(free_queue)); ++ ++ pmlmepriv->num_of_scanned--; ++ ++ /* _exit_critical(&free_queue->lock, &irqL); */ ++ ++exit: ++ return; ++} ++ ++ ++/* ++ return the wlan_network with the matching addr ++ ++ Shall be calle under atomic context... to avoid possible racing condition... ++*/ ++struct wlan_network *_rtw_find_network(_queue *scanned_queue, u8 *addr) ++{ ++ ++ /* _irqL irqL; */ ++ _list *phead, *plist; ++ struct wlan_network *pnetwork = NULL; ++ u8 zero_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; ++ ++ ++ if (_rtw_memcmp(zero_addr, addr, ETH_ALEN)) { ++ pnetwork = NULL; ++ goto exit; ++ } ++ ++ /* _enter_critical_bh(&scanned_queue->lock, &irqL); */ ++ ++ phead = get_list_head(scanned_queue); ++ plist = get_next(phead); ++ ++ while (plist != phead) { ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network , list); ++ ++ if (_rtw_memcmp(addr, pnetwork->network.MacAddress, ETH_ALEN) == _TRUE) ++ break; ++ ++ plist = get_next(plist); ++ } ++ ++ if (plist == phead) ++ pnetwork = NULL; ++ ++ /* _exit_critical_bh(&scanned_queue->lock, &irqL); */ ++ ++exit: ++ ++ ++ return pnetwork; ++ ++} ++ ++ ++void _rtw_free_network_queue(_adapter *padapter, u8 isfreeall) ++{ ++ _irqL irqL; ++ _list *phead, *plist; ++ struct wlan_network *pnetwork; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ _queue *scanned_queue = &pmlmepriv->scanned_queue; ++ ++ ++ ++ _enter_critical_bh(&scanned_queue->lock, &irqL); ++ ++ phead = get_list_head(scanned_queue); ++ plist = get_next(phead); ++ ++ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ ++ plist = get_next(plist); ++ ++ _rtw_free_network(pmlmepriv, pnetwork, isfreeall); ++ ++ } ++ ++ _exit_critical_bh(&scanned_queue->lock, &irqL); ++ ++ ++} ++ ++ ++ ++ ++sint rtw_if_up(_adapter *padapter) ++{ ++ ++ sint res; ++ ++ if (RTW_CANNOT_RUN(padapter) || ++ (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _FALSE)) { ++ res = _FALSE; ++ } else ++ res = _TRUE; ++ ++ return res; ++} ++ ++ ++void rtw_generate_random_ibss(u8 *pibss) ++{ ++ *((u32 *)(&pibss[2])) = rtw_random32(); ++ pibss[0] = 0x02; /* in ad-hoc mode local bit must set to 1 */ ++ pibss[1] = 0x11; ++ pibss[2] = 0x87; ++} ++ ++u8 *rtw_get_capability_from_ie(u8 *ie) ++{ ++ return ie + 8 + 2; ++} ++ ++ ++u16 rtw_get_capability(WLAN_BSSID_EX *bss) ++{ ++ u16 val; ++ ++ _rtw_memcpy((u8 *)&val, rtw_get_capability_from_ie(bss->IEs), 2); ++ ++ return le16_to_cpu(val); ++} ++ ++u8 *rtw_get_timestampe_from_ie(u8 *ie) ++{ ++ return ie + 0; ++} ++ ++u8 *rtw_get_beacon_interval_from_ie(u8 *ie) ++{ ++ return ie + 8; ++} ++ ++ ++int rtw_init_mlme_priv(_adapter *padapter) /* (struct mlme_priv *pmlmepriv) */ ++{ ++ int res; ++ res = _rtw_init_mlme_priv(padapter);/* (pmlmepriv); */ ++ return res; ++} ++ ++void rtw_free_mlme_priv(struct mlme_priv *pmlmepriv) ++{ ++ _rtw_free_mlme_priv(pmlmepriv); ++} ++ ++int rtw_enqueue_network(_queue *queue, struct wlan_network *pnetwork); ++int rtw_enqueue_network(_queue *queue, struct wlan_network *pnetwork) ++{ ++ int res; ++ res = _rtw_enqueue_network(queue, pnetwork); ++ return res; ++} ++ ++/* ++static struct wlan_network *rtw_dequeue_network(_queue *queue) ++{ ++ struct wlan_network *pnetwork; ++ pnetwork = _rtw_dequeue_network(queue); ++ return pnetwork; ++} ++*/ ++ ++struct wlan_network *rtw_alloc_network(struct mlme_priv *pmlmepriv); ++struct wlan_network *rtw_alloc_network(struct mlme_priv *pmlmepriv) /* (_queue *free_queue) */ ++{ ++ struct wlan_network *pnetwork; ++ pnetwork = _rtw_alloc_network(pmlmepriv); ++ return pnetwork; ++} ++ ++void rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 is_freeall); ++void rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 is_freeall)/* (struct wlan_network *pnetwork, _queue *free_queue) */ ++{ ++ _rtw_free_network(pmlmepriv, pnetwork, is_freeall); ++} ++ ++void rtw_free_network_nolock(_adapter *padapter, struct wlan_network *pnetwork); ++void rtw_free_network_nolock(_adapter *padapter, struct wlan_network *pnetwork) ++{ ++ _rtw_free_network_nolock(&(padapter->mlmepriv), pnetwork); ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_cfg80211_unlink_bss(padapter, pnetwork); ++#endif /* CONFIG_IOCTL_CFG80211 */ ++} ++ ++ ++void rtw_free_network_queue(_adapter *dev, u8 isfreeall) ++{ ++ _rtw_free_network_queue(dev, isfreeall); ++} ++ ++/* ++ return the wlan_network with the matching addr ++ ++ Shall be calle under atomic context... to avoid possible racing condition... ++*/ ++struct wlan_network *rtw_find_network(_queue *scanned_queue, u8 *addr) ++{ ++ struct wlan_network *pnetwork = _rtw_find_network(scanned_queue, addr); ++ ++ return pnetwork; ++} ++ ++int rtw_is_same_ibss(_adapter *adapter, struct wlan_network *pnetwork) ++{ ++ int ret = _TRUE; ++ struct security_priv *psecuritypriv = &adapter->securitypriv; ++ ++ if ((psecuritypriv->dot11PrivacyAlgrthm != _NO_PRIVACY_) && ++ (pnetwork->network.Privacy == 0)) ++ ret = _FALSE; ++ else if ((psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_) && ++ (pnetwork->network.Privacy == 1)) ++ ret = _FALSE; ++ else ++ ret = _TRUE; ++ ++ return ret; ++ ++} ++ ++inline int is_same_ess(WLAN_BSSID_EX *a, WLAN_BSSID_EX *b) ++{ ++ return (a->Ssid.SsidLength == b->Ssid.SsidLength) ++ && _rtw_memcmp(a->Ssid.Ssid, b->Ssid.Ssid, a->Ssid.SsidLength) == _TRUE; ++} ++ ++int is_same_network(WLAN_BSSID_EX *src, WLAN_BSSID_EX *dst, u8 feature) ++{ ++ u16 s_cap, d_cap; ++ ++ ++ if (rtw_bug_check(dst, src, &s_cap, &d_cap) == _FALSE) ++ return _FALSE; ++ ++ _rtw_memcpy((u8 *)&s_cap, rtw_get_capability_from_ie(src->IEs), 2); ++ _rtw_memcpy((u8 *)&d_cap, rtw_get_capability_from_ie(dst->IEs), 2); ++ ++ ++ s_cap = le16_to_cpu(s_cap); ++ d_cap = le16_to_cpu(d_cap); ++ ++ ++#ifdef CONFIG_P2P ++ if ((feature == 1) && /* 1: P2P supported */ ++ (_rtw_memcmp(src->MacAddress, dst->MacAddress, ETH_ALEN) == _TRUE) ++ ) ++ return _TRUE; ++#endif ++ ++ return ((src->Ssid.SsidLength == dst->Ssid.SsidLength) && ++ /* (src->Configuration.DSConfig == dst->Configuration.DSConfig) && */ ++ ((_rtw_memcmp(src->MacAddress, dst->MacAddress, ETH_ALEN)) == _TRUE) && ++ ((_rtw_memcmp(src->Ssid.Ssid, dst->Ssid.Ssid, src->Ssid.SsidLength)) == _TRUE) && ++ ((s_cap & WLAN_CAPABILITY_IBSS) == ++ (d_cap & WLAN_CAPABILITY_IBSS)) && ++ ((s_cap & WLAN_CAPABILITY_BSS) == ++ (d_cap & WLAN_CAPABILITY_BSS))); ++ ++} ++ ++struct wlan_network *_rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network) ++{ ++ _list *phead, *plist; ++ struct wlan_network *found = NULL; ++ ++ phead = get_list_head(scanned_queue); ++ plist = get_next(phead); ++ ++ while (plist != phead) { ++ found = LIST_CONTAINOR(plist, struct wlan_network , list); ++ ++ if (is_same_network(&network->network, &found->network, 0)) ++ break; ++ ++ plist = get_next(plist); ++ } ++ ++ if (plist == phead) ++ found = NULL; ++exit: ++ return found; ++} ++ ++struct wlan_network *rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network) ++{ ++ _irqL irqL; ++ struct wlan_network *found = NULL; ++ ++ if (scanned_queue == NULL || network == NULL) ++ goto exit; ++ ++ _enter_critical_bh(&scanned_queue->lock, &irqL); ++ found = _rtw_find_same_network(scanned_queue, network); ++ _exit_critical_bh(&scanned_queue->lock, &irqL); ++ ++exit: ++ return found; ++} ++ ++struct wlan_network *rtw_get_oldest_wlan_network(_queue *scanned_queue) ++{ ++ _list *plist, *phead; ++ ++ ++ struct wlan_network *pwlan = NULL; ++ struct wlan_network *oldest = NULL; ++ phead = get_list_head(scanned_queue); ++ ++ plist = get_next(phead); ++ ++ while (1) { ++ ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pwlan = LIST_CONTAINOR(plist, struct wlan_network, list); ++ ++ if (pwlan->fixed != _TRUE) { ++ if (oldest == NULL || time_after(oldest->last_scanned, pwlan->last_scanned)) ++ oldest = pwlan; ++ } ++ ++ plist = get_next(plist); ++ } ++ return oldest; ++ ++} ++ ++void update_network(WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src, ++ _adapter *padapter, bool update_ie) ++{ ++ u8 ss_ori = dst->PhyInfo.SignalStrength; ++ u8 sq_ori = dst->PhyInfo.SignalQuality; ++ long rssi_ori = dst->Rssi; ++ ++ u8 ss_smp = src->PhyInfo.SignalStrength; ++ u8 sq_smp = src->PhyInfo.SignalQuality; ++ long rssi_smp = src->Rssi; ++ ++ u8 ss_final; ++ u8 sq_final; ++ long rssi_final; ++ ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ rtw_hal_antdiv_rssi_compared(padapter, dst, src); /* this will update src.Rssi, need consider again */ ++#endif ++ ++#if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) && 1 ++ if (strcmp(dst->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { ++ RTW_INFO(FUNC_ADPT_FMT" %s("MAC_FMT", ch%u) ss_ori:%3u, sq_ori:%3u, rssi_ori:%3ld, ss_smp:%3u, sq_smp:%3u, rssi_smp:%3ld\n" ++ , FUNC_ADPT_ARG(padapter) ++ , src->Ssid.Ssid, MAC_ARG(src->MacAddress), src->Configuration.DSConfig ++ , ss_ori, sq_ori, rssi_ori ++ , ss_smp, sq_smp, rssi_smp ++ ); ++ } ++#endif ++ ++ /* The rule below is 1/5 for sample value, 4/5 for history value */ ++ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) && is_same_network(&(padapter->mlmepriv.cur_network.network), src, 0)) { ++ /* Take the recvpriv's value for the connected AP*/ ++ ss_final = padapter->recvpriv.signal_strength; ++ sq_final = padapter->recvpriv.signal_qual; ++ /* the rssi value here is undecorated, and will be used for antenna diversity */ ++ if (sq_smp != 101) /* from the right channel */ ++ rssi_final = (src->Rssi + dst->Rssi * 4) / 5; ++ else ++ rssi_final = rssi_ori; ++ } else { ++ if (sq_smp != 101) { /* from the right channel */ ++ ss_final = ((u32)(src->PhyInfo.SignalStrength) + (u32)(dst->PhyInfo.SignalStrength) * 4) / 5; ++ sq_final = ((u32)(src->PhyInfo.SignalQuality) + (u32)(dst->PhyInfo.SignalQuality) * 4) / 5; ++ rssi_final = (src->Rssi + dst->Rssi * 4) / 5; ++ } else { ++ /* bss info not receving from the right channel, use the original RX signal infos */ ++ ss_final = dst->PhyInfo.SignalStrength; ++ sq_final = dst->PhyInfo.SignalQuality; ++ rssi_final = dst->Rssi; ++ } ++ ++ } ++ ++ if (update_ie) { ++ dst->Reserved[0] = src->Reserved[0]; ++ dst->Reserved[1] = src->Reserved[1]; ++ _rtw_memcpy((u8 *)dst, (u8 *)src, get_WLAN_BSSID_EX_sz(src)); ++ } ++ ++ dst->PhyInfo.SignalStrength = ss_final; ++ dst->PhyInfo.SignalQuality = sq_final; ++ dst->Rssi = rssi_final; ++ ++#if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) && 1 ++ if (strcmp(dst->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { ++ RTW_INFO(FUNC_ADPT_FMT" %s("MAC_FMT"), SignalStrength:%u, SignalQuality:%u, RawRSSI:%ld\n" ++ , FUNC_ADPT_ARG(padapter) ++ , dst->Ssid.Ssid, MAC_ARG(dst->MacAddress), dst->PhyInfo.SignalStrength, dst->PhyInfo.SignalQuality, dst->Rssi); ++ } ++#endif ++ ++#if 0 /* old codes, may be useful one day... ++ * RTW_INFO("update_network: rssi=0x%lx dst->Rssi=%d ,dst->Rssi=0x%lx , src->Rssi=0x%lx",(dst->Rssi+src->Rssi)/2,dst->Rssi,dst->Rssi,src->Rssi); */ ++ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) && is_same_network(&(padapter->mlmepriv.cur_network.network), src)) { ++ ++ /* RTW_INFO("b:ssid=%s update_network: src->rssi=0x%d padapter->recvpriv.ui_rssi=%d\n",src->Ssid.Ssid,src->Rssi,padapter->recvpriv.signal); */ ++ if (padapter->recvpriv.signal_qual_data.total_num++ >= PHY_LINKQUALITY_SLID_WIN_MAX) { ++ padapter->recvpriv.signal_qual_data.total_num = PHY_LINKQUALITY_SLID_WIN_MAX; ++ last_evm = padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index]; ++ padapter->recvpriv.signal_qual_data.total_val -= last_evm; ++ } ++ padapter->recvpriv.signal_qual_data.total_val += query_rx_pwr_percentage(src->Rssi); ++ ++ padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = query_rx_pwr_percentage(src->Rssi); ++ if (padapter->recvpriv.signal_qual_data.index >= PHY_LINKQUALITY_SLID_WIN_MAX) ++ padapter->recvpriv.signal_qual_data.index = 0; ++ ++ /* RTW_INFO("Total SQ=%d pattrib->signal_qual= %d\n", padapter->recvpriv.signal_qual_data.total_val, src->Rssi); */ ++ ++ /* <1> Showed on UI for user,in percentage. */ ++ tmpVal = padapter->recvpriv.signal_qual_data.total_val / padapter->recvpriv.signal_qual_data.total_num; ++ padapter->recvpriv.signal = (u8)tmpVal; /* Link quality */ ++ ++ src->Rssi = translate_percentage_to_dbm(padapter->recvpriv.signal) ; ++ } else { ++ /* RTW_INFO("ELSE:ssid=%s update_network: src->rssi=0x%d dst->rssi=%d\n",src->Ssid.Ssid,src->Rssi,dst->Rssi); */ ++ src->Rssi = (src->Rssi + dst->Rssi) / 2; /* dBM */ ++ } ++ ++ /* RTW_INFO("a:update_network: src->rssi=0x%d padapter->recvpriv.ui_rssi=%d\n",src->Rssi,padapter->recvpriv.signal); */ ++ ++#endif ++ ++} ++ ++static void update_current_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork) ++{ ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ ++ ++ rtw_bug_check(&(pmlmepriv->cur_network.network), ++ &(pmlmepriv->cur_network.network), ++ &(pmlmepriv->cur_network.network), ++ &(pmlmepriv->cur_network.network)); ++ ++ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) && (is_same_network(&(pmlmepriv->cur_network.network), pnetwork, 0))) { ++ ++ /* if(pmlmepriv->cur_network.network.IELength<= pnetwork->IELength) */ ++ { ++ update_network(&(pmlmepriv->cur_network.network), pnetwork, adapter, _TRUE); ++ rtw_update_protection(adapter, (pmlmepriv->cur_network.network.IEs) + sizeof(NDIS_802_11_FIXED_IEs), ++ pmlmepriv->cur_network.network.IELength); ++ } ++ } ++ ++ ++} ++ ++ ++/* ++ ++Caller must hold pmlmepriv->lock first. ++ ++ ++*/ ++void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ ULONG bssid_ex_sz; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); ++#endif /* CONFIG_P2P */ ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ struct wlan_network *oldest = NULL; ++ int target_find = 0; ++ u8 feature = 0; ++ ++ ++ _enter_critical_bh(&queue->lock, &irqL); ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++#ifdef CONFIG_P2P ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ feature = 1; /* p2p enable */ ++#endif ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ ++ rtw_bug_check(pnetwork, pnetwork, pnetwork, pnetwork); ++ ++#ifdef CONFIG_P2P ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && ++ (_rtw_memcmp(pnetwork->network.MacAddress, target->MacAddress, ETH_ALEN) == _TRUE)) { ++ target_find = 1; ++ break; ++ } ++#endif ++ ++ if (is_same_network(&(pnetwork->network), target, feature)) { ++ target_find = 1; ++ break; ++ } ++ ++ if (rtw_roam_flags(adapter)) { ++ /* TODO: don't select netowrk in the same ess as oldest if it's new enough*/ ++ } ++ ++ if (oldest == NULL || time_after(oldest->last_scanned, pnetwork->last_scanned)) ++ oldest = pnetwork; ++ ++ plist = get_next(plist); ++ ++ } ++ ++ ++ /* If we didn't find a match, then get a new network slot to initialize ++ * with this beacon's information */ ++ /* if (rtw_end_of_queue_search(phead,plist)== _TRUE) { */ ++ if (!target_find) { ++ if (_rtw_queue_empty(&(pmlmepriv->free_bss_pool)) == _TRUE) { ++ /* If there are no more slots, expire the oldest */ ++ /* list_del_init(&oldest->list); */ ++ pnetwork = oldest; ++ if (pnetwork == NULL) { ++ goto exit; ++ } ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ rtw_hal_get_odm_var(adapter, HAL_ODM_ANTDIV_SELECT, &(target->PhyInfo.Optimum_antenna), NULL); ++#endif ++ _rtw_memcpy(&(pnetwork->network), target, get_WLAN_BSSID_EX_sz(target)); ++ /* pnetwork->last_scanned = rtw_get_current_time(); */ ++ /* variable initialize */ ++ pnetwork->fixed = _FALSE; ++ pnetwork->last_scanned = rtw_get_current_time(); ++ ++ pnetwork->network_type = 0; ++ pnetwork->aid = 0; ++ pnetwork->join_res = 0; ++ ++ /* bss info not receving from the right channel */ ++ if (pnetwork->network.PhyInfo.SignalQuality == 101) ++ pnetwork->network.PhyInfo.SignalQuality = 0; ++ } else { ++ /* Otherwise just pull from the free list */ ++ ++ pnetwork = rtw_alloc_network(pmlmepriv); /* will update scan_time */ ++ ++ if (pnetwork == NULL) { ++ goto exit; ++ } ++ ++ bssid_ex_sz = get_WLAN_BSSID_EX_sz(target); ++ target->Length = bssid_ex_sz; ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ rtw_hal_get_odm_var(adapter, HAL_ODM_ANTDIV_SELECT, &(target->PhyInfo.Optimum_antenna), NULL); ++#endif ++ _rtw_memcpy(&(pnetwork->network), target, bssid_ex_sz); ++ ++ pnetwork->last_scanned = rtw_get_current_time(); ++ ++ /* bss info not receving from the right channel */ ++ if (pnetwork->network.PhyInfo.SignalQuality == 101) ++ pnetwork->network.PhyInfo.SignalQuality = 0; ++ ++ rtw_list_insert_tail(&(pnetwork->list), &(queue->queue)); ++ ++ } ++ } else { ++ /* we have an entry and we are going to update it. But this entry may ++ * be already expired. In this case we do the same as we found a new ++ * net and call the new_net handler ++ */ ++ bool update_ie = _TRUE; ++ ++ pnetwork->last_scanned = rtw_get_current_time(); ++ ++ /* target.Reserved[0]==1, means that scaned network is a bcn frame. */ ++ if ((pnetwork->network.IELength > target->IELength) && (target->Reserved[0] == 1)) ++ update_ie = _FALSE; ++ ++ /* probe resp(3) > beacon(1) > probe req(2) */ ++ if ((target->Reserved[0] != 2) && ++ (target->Reserved[0] >= pnetwork->network.Reserved[0]) ++ ) ++ update_ie = _TRUE; ++ else ++ update_ie = _FALSE; ++ ++ update_network(&(pnetwork->network), target, adapter, update_ie); ++ } ++ ++exit: ++ _exit_critical_bh(&queue->lock, &irqL); ++ ++} ++ ++void rtw_add_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork); ++void rtw_add_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &(((_adapter *)adapter)->mlmepriv); ++ /* _queue *queue = &(pmlmepriv->scanned_queue); */ ++ ++ ++ /* _enter_critical_bh(&queue->lock, &irqL); */ ++ ++#if defined(CONFIG_P2P) && defined(CONFIG_P2P_REMOVE_GROUP_INFO) ++ if (adapter->registrypriv.wifi_spec == 0) ++ rtw_bss_ex_del_p2p_attr(pnetwork, P2P_ATTR_GROUP_INFO); ++#endif ++ ++ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) ++ rtw_bss_ex_del_wfd_ie(pnetwork); ++ ++ update_current_network(adapter, pnetwork); ++ ++ rtw_update_scanned_network(adapter, pnetwork); ++ ++ /* _exit_critical_bh(&queue->lock, &irqL); */ ++ ++} ++ ++/* select the desired network based on the capability of the (i)bss. ++ * check items: (1) security ++ * (2) network_type ++ * (3) WMM ++ * (4) HT ++ * (5) others */ ++int rtw_is_desired_network(_adapter *adapter, struct wlan_network *pnetwork); ++int rtw_is_desired_network(_adapter *adapter, struct wlan_network *pnetwork) ++{ ++ struct security_priv *psecuritypriv = &adapter->securitypriv; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ u32 desired_encmode; ++ u32 privacy; ++ ++ /* u8 wps_ie[512]; */ ++ uint wps_ielen; ++ ++ int bselected = _TRUE; ++ ++ desired_encmode = psecuritypriv->ndisencryptstatus; ++ privacy = pnetwork->network.Privacy; ++ ++ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { ++ if (rtw_get_wps_ie(pnetwork->network.IEs + _FIXED_IE_LENGTH_, pnetwork->network.IELength - _FIXED_IE_LENGTH_, NULL, &wps_ielen) != NULL) ++ return _TRUE; ++ else ++ return _FALSE; ++ } ++ if (adapter->registrypriv.wifi_spec == 1) { /* for correct flow of 8021X to do.... */ ++ u8 *p = NULL; ++ uint ie_len = 0; ++ ++ if ((desired_encmode == Ndis802_11EncryptionDisabled) && (privacy != 0)) ++ bselected = _FALSE; ++ ++ if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) { ++ p = rtw_get_ie(pnetwork->network.IEs + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pnetwork->network.IELength - _BEACON_IE_OFFSET_)); ++ if (p && ie_len > 0) ++ bselected = _TRUE; ++ else ++ bselected = _FALSE; ++ } ++ } ++ ++ ++ if ((desired_encmode != Ndis802_11EncryptionDisabled) && (privacy == 0)) { ++ RTW_INFO("desired_encmode: %d, privacy: %d\n", desired_encmode, privacy); ++ bselected = _FALSE; ++ } ++ ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) { ++ if (pnetwork->network.InfrastructureMode != pmlmepriv->cur_network.network.InfrastructureMode) ++ bselected = _FALSE; ++ } ++ ++ ++ return bselected; ++} ++ ++/* TODO: Perry : For Power Management */ ++void rtw_atimdone_event_callback(_adapter *adapter , u8 *pbuf) ++{ ++ ++ return; ++} ++ ++ ++void rtw_survey_event_callback(_adapter *adapter, u8 *pbuf) ++{ ++ _irqL irqL; ++ u32 len; ++ WLAN_BSSID_EX *pnetwork; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ ++ ++ pnetwork = (WLAN_BSSID_EX *)pbuf; ++ ++ ++#ifdef CONFIG_RTL8712 ++ /* endian_convert */ ++ pnetwork->Length = le32_to_cpu(pnetwork->Length); ++ pnetwork->Ssid.SsidLength = le32_to_cpu(pnetwork->Ssid.SsidLength); ++ pnetwork->Privacy = le32_to_cpu(pnetwork->Privacy); ++ pnetwork->Rssi = le32_to_cpu(pnetwork->Rssi); ++ pnetwork->NetworkTypeInUse = le32_to_cpu(pnetwork->NetworkTypeInUse); ++ pnetwork->Configuration.ATIMWindow = le32_to_cpu(pnetwork->Configuration.ATIMWindow); ++ pnetwork->Configuration.BeaconPeriod = le32_to_cpu(pnetwork->Configuration.BeaconPeriod); ++ pnetwork->Configuration.DSConfig = le32_to_cpu(pnetwork->Configuration.DSConfig); ++ pnetwork->Configuration.FHConfig.DwellTime = le32_to_cpu(pnetwork->Configuration.FHConfig.DwellTime); ++ pnetwork->Configuration.FHConfig.HopPattern = le32_to_cpu(pnetwork->Configuration.FHConfig.HopPattern); ++ pnetwork->Configuration.FHConfig.HopSet = le32_to_cpu(pnetwork->Configuration.FHConfig.HopSet); ++ pnetwork->Configuration.FHConfig.Length = le32_to_cpu(pnetwork->Configuration.FHConfig.Length); ++ pnetwork->Configuration.Length = le32_to_cpu(pnetwork->Configuration.Length); ++ pnetwork->InfrastructureMode = le32_to_cpu(pnetwork->InfrastructureMode); ++ pnetwork->IELength = le32_to_cpu(pnetwork->IELength); ++#endif ++ ++ len = get_WLAN_BSSID_EX_sz(pnetwork); ++ if (len > (sizeof(WLAN_BSSID_EX))) { ++ return; ++ } ++ ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ /* update IBSS_network 's timestamp */ ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == _TRUE) { ++ if (_rtw_memcmp(&(pmlmepriv->cur_network.network.MacAddress), pnetwork->MacAddress, ETH_ALEN)) { ++ struct wlan_network *ibss_wlan = NULL; ++ _irqL irqL; ++ ++ _rtw_memcpy(pmlmepriv->cur_network.network.IEs, pnetwork->IEs, 8); ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ibss_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->MacAddress); ++ if (ibss_wlan) { ++ _rtw_memcpy(ibss_wlan->network.IEs , pnetwork->IEs, 8); ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ goto exit; ++ } ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ } ++ } ++ ++ /* lock pmlmepriv->lock when you accessing network_q */ ++ if ((check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) == _FALSE) { ++ if (pnetwork->Ssid.Ssid[0] == 0) ++ pnetwork->Ssid.SsidLength = 0; ++ rtw_add_network(adapter, pnetwork); ++ } ++ ++exit: ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ ++ return; ++} ++ ++void rtw_surveydone_event_callback(_adapter *adapter, u8 *pbuf) ++{ ++ _irqL irqL; ++ u8 timer_cancelled; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++#ifdef CONFIG_RTW_80211R ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++#endif ++ ++#ifdef CONFIG_MLME_EXT ++ mlmeext_surveydone_event_callback(adapter); ++#endif ++ ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ if (pmlmepriv->wps_probe_req_ie) { ++ u32 free_len = pmlmepriv->wps_probe_req_ie_len; ++ pmlmepriv->wps_probe_req_ie_len = 0; ++ rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len); ++ pmlmepriv->wps_probe_req_ie = NULL; ++ } ++ ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _FALSE) { ++ RTW_INFO(FUNC_ADPT_FMT" fw_state:0x%x\n", FUNC_ADPT_ARG(adapter), get_fwstate(pmlmepriv)); ++ /* rtw_warn_on(1); */ ++ } ++ ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ _cancel_timer(&pmlmepriv->scan_to_timer, &timer_cancelled); ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ rtw_set_signal_stat_timer(&adapter->recvpriv); ++#endif ++ ++ if (pmlmepriv->to_join == _TRUE) { ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) { ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _FALSE) { ++ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); ++ ++ if (rtw_select_and_join_from_scanned_queue(pmlmepriv) == _SUCCESS) ++ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); ++ else { ++ WLAN_BSSID_EX *pdev_network = &(adapter->registrypriv.dev_network); ++ u8 *pibss = adapter->registrypriv.dev_network.MacAddress; ++ ++ /* pmlmepriv->fw_state ^= _FW_UNDER_SURVEY; */ /* because don't set assoc_timer */ ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); ++ ++ ++ _rtw_memset(&pdev_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); ++ _rtw_memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); ++ ++ rtw_update_registrypriv_dev_network(adapter); ++ rtw_generate_random_ibss(pibss); ++ ++ /*pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;*/ ++ init_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); ++ ++ if (rtw_create_ibss_cmd(adapter, 0) != _SUCCESS) ++ RTW_ERR("rtw_create_ibss_cmd FAIL\n"); ++ ++ pmlmepriv->to_join = _FALSE; ++ } ++ } ++ } else { ++ int s_ret; ++ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); ++ pmlmepriv->to_join = _FALSE; ++ s_ret = rtw_select_and_join_from_scanned_queue(pmlmepriv); ++ if (_SUCCESS == s_ret) ++ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); ++ else if (s_ret == 2) { /* there is no need to wait for join */ ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); ++ rtw_indicate_connect(adapter); ++ } else { ++ RTW_INFO("try_to_join, but select scanning queue fail, to_roam:%d\n", rtw_to_roam(adapter)); ++ ++ if (rtw_to_roam(adapter) != 0) { ++ if (rtw_dec_to_roam(adapter) == 0 ++ || _SUCCESS != rtw_sitesurvey_cmd(adapter, &pmlmepriv->assoc_ssid, 1, NULL, 0) ++ ) { ++ rtw_set_to_roam(adapter, 0); ++#ifdef CONFIG_INTEL_WIDI ++ if (adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) { ++ _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); ++ intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL, 0); ++ RTW_INFO("change to widi listen\n"); ++ } ++#endif /* CONFIG_INTEL_WIDI */ ++ rtw_free_assoc_resources(adapter, 1); ++ rtw_indicate_disconnect(adapter, 0, _FALSE); ++ } else ++ pmlmepriv->to_join = _TRUE; ++ } else ++ rtw_indicate_disconnect(adapter, 0, _FALSE); ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); ++ } ++ } ++ } else { ++ if (rtw_chk_roam_flags(adapter, RTW_ROAM_ACTIVE)) { ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) ++ && check_fwstate(pmlmepriv, _FW_LINKED)) { ++ if (rtw_select_roaming_candidate(pmlmepriv) == _SUCCESS) { ++#ifdef CONFIG_RTW_80211R ++ if (rtw_chk_ft_flags(adapter, RTW_FT_OVER_DS_SUPPORTED)) { ++ start_clnt_ft_action(adapter, (u8 *)pmlmepriv->roam_network->network.MacAddress); ++ } else { ++ /*wait a little time to retrieve packets buffered in the current ap while scan*/ ++ _set_timer(&pmlmeext->ft_roam_timer, 30); ++ } ++#else ++ receive_disconnect(adapter, pmlmepriv->cur_network.network.MacAddress ++ , WLAN_REASON_ACTIVE_ROAM, _FALSE); ++#endif ++ } ++ } ++ } ++ } ++ ++ /* RTW_INFO("scan complete in %dms\n",rtw_get_passing_time_ms(pmlmepriv->scan_start_time)); */ ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++#ifdef CONFIG_P2P_PS ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ p2p_ps_wk_cmd(adapter, P2P_PS_SCAN_DONE, 0); ++#endif /* CONFIG_P2P_PS */ ++ ++ rtw_mi_os_xmit_schedule(adapter); ++ ++#ifdef CONFIG_DRVEXT_MODULE_WSC ++ drvext_surveydone_callback(&adapter->drvextpriv); ++#endif ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ { ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ if (pmlmeext->sitesurvey_res.bss_cnt == 0) { ++ /* rtw_hal_sreset_reset(adapter); */ ++ } ++ } ++#endif ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_cfg80211_surveydone_event_callback(adapter); ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++ rtw_indicate_scan_done(adapter, _FALSE); ++ ++#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_IOCTL_CFG80211) ++ rtw_cfg80211_indicate_scan_done_for_buddy(adapter, _FALSE); ++#endif ++ ++} ++ ++void rtw_dummy_event_callback(_adapter *adapter , u8 *pbuf) ++{ ++ ++} ++ ++void rtw_fwdbg_event_callback(_adapter *adapter , u8 *pbuf) ++{ ++ ++} ++ ++static void free_scanqueue(struct mlme_priv *pmlmepriv) ++{ ++ _irqL irqL, irqL0; ++ _queue *free_queue = &pmlmepriv->free_bss_pool; ++ _queue *scan_queue = &pmlmepriv->scanned_queue; ++ _list *plist, *phead, *ptemp; ++ ++ ++ _enter_critical_bh(&scan_queue->lock, &irqL0); ++ _enter_critical_bh(&free_queue->lock, &irqL); ++ ++ phead = get_list_head(scan_queue); ++ plist = get_next(phead); ++ ++ while (plist != phead) { ++ ptemp = get_next(plist); ++ rtw_list_delete(plist); ++ rtw_list_insert_tail(plist, &free_queue->queue); ++ plist = ptemp; ++ pmlmepriv->num_of_scanned--; ++ } ++ ++ _exit_critical_bh(&free_queue->lock, &irqL); ++ _exit_critical_bh(&scan_queue->lock, &irqL0); ++ ++} ++ ++void rtw_reset_rx_info(struct debug_priv *pdbgpriv) ++{ ++ pdbgpriv->dbg_rx_ampdu_drop_count = 0; ++ pdbgpriv->dbg_rx_ampdu_forced_indicate_count = 0; ++ pdbgpriv->dbg_rx_ampdu_loss_count = 0; ++ pdbgpriv->dbg_rx_dup_mgt_frame_drop_count = 0; ++ pdbgpriv->dbg_rx_ampdu_window_shift_cnt = 0; ++} ++ ++/* ++*rtw_free_assoc_resources: the caller has to lock pmlmepriv->lock ++*/ ++void rtw_free_assoc_resources(_adapter *adapter, int lock_scanned_queue) ++{ ++ _irqL irqL; ++ struct wlan_network *pwlan = NULL; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct wlan_network *tgt_network = &pmlmepriv->cur_network; ++ struct dvobj_priv *psdpriv = adapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ ++ ++#ifdef CONFIG_TDLS ++ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; ++#endif /* CONFIG_TDLS */ ++ ++ ++ RTW_INFO("%s-"ADPT_FMT" tgt_network MacAddress=" MAC_FMT"ssid=%s\n", ++ __func__, ADPT_ARG(adapter), MAC_ARG(tgt_network->network.MacAddress), tgt_network->network.Ssid.Ssid); ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { ++ struct sta_info *psta; ++ ++ psta = rtw_get_stainfo(&adapter->stapriv, tgt_network->network.MacAddress); ++ ++#ifdef CONFIG_TDLS ++ if (ptdlsinfo->link_established == _TRUE) { ++ rtw_tdls_cmd(adapter, NULL, TDLS_RS_RCR); ++ rtw_reset_tdls_info(adapter); ++ rtw_free_all_stainfo(adapter); ++ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ } else ++#endif /* CONFIG_TDLS */ ++ { ++ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ rtw_free_stainfo(adapter, psta); ++ } ++ ++ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ ++ } ++ ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { ++ struct sta_info *psta; ++ ++ rtw_free_all_stainfo(adapter); ++ ++ psta = rtw_get_bcmc_stainfo(adapter); ++ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ rtw_free_stainfo(adapter, psta); ++ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ ++ rtw_init_bcmc_stainfo(adapter); ++ } ++ ++ if (lock_scanned_queue) ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ pwlan = _rtw_find_same_network(&pmlmepriv->scanned_queue, tgt_network); ++ if ((pwlan) && (!check_fwstate(pmlmepriv, WIFI_UNDER_WPS))) { ++ pwlan->fixed = _FALSE; ++ ++ RTW_INFO("free disconnecting network of scanned_queue\n"); ++ rtw_free_network_nolock(adapter, pwlan); ++#ifdef CONFIG_P2P ++ if (!rtw_p2p_chk_state(&adapter->wdinfo, P2P_STATE_NONE)) { ++ rtw_mi_set_scan_deny(adapter, 2000); ++ /* rtw_clear_scan_deny(adapter); */ ++ } ++#endif /* CONFIG_P2P */ ++ } else { ++ if (pwlan == NULL) ++ RTW_INFO("free disconnecting network of scanned_queue failed due to pwlan== NULL\n\n"); ++ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) ++ RTW_INFO("donot free disconnecting network of scanned_queue when WIFI_UNDER_WPS\n\n"); ++ } ++ ++ ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) && (adapter->stapriv.asoc_sta_count == 1)) ++ /*||check_fwstate(pmlmepriv, WIFI_STATION_STATE)*/) { ++ if (pwlan) ++ rtw_free_network_nolock(adapter, pwlan); ++ } ++ ++ if (lock_scanned_queue) ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ adapter->securitypriv.key_mask = 0; ++ ++ rtw_reset_rx_info(pdbgpriv); ++ ++ ++} ++ ++/* ++*rtw_indicate_connect: the caller has to lock pmlmepriv->lock ++*/ ++void rtw_indicate_connect(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ ++ ++ pmlmepriv->to_join = _FALSE; ++ ++ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { ++ ++ set_fwstate(pmlmepriv, _FW_LINKED); ++ ++ rtw_led_control(padapter, LED_CTL_LINK); ++ ++ ++#ifdef CONFIG_DRVEXT_MODULE ++ if (padapter->drvextpriv.enable_wpa) ++ indicate_l2_connect(padapter); ++ else ++#endif ++ { ++ rtw_os_indicate_connect(padapter); ++ } ++ ++ } ++ ++ rtw_set_to_roam(padapter, 0); ++#ifdef CONFIG_INTEL_WIDI ++ if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) { ++ _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); ++ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_WK, NULL, 0); ++ RTW_INFO("change to widi listen\n"); ++ } ++#endif /* CONFIG_INTEL_WIDI */ ++ if (!check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE)) ++ rtw_mi_set_scan_deny(padapter, 3000); ++ ++ ++} ++ ++ ++/* ++*rtw_indicate_disconnect: the caller has to lock pmlmepriv->lock ++*/ ++void rtw_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally_generated) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *wps_ie = NULL; ++ uint wpsie_len = 0; ++ ++ ++ ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING | WIFI_UNDER_WPS); ++ ++ /* force to clear cur_network_scanned's SELECTED REGISTRAR */ ++ if (pmlmepriv->cur_network_scanned) { ++ WLAN_BSSID_EX *current_joined_bss = &(pmlmepriv->cur_network_scanned->network); ++ if (current_joined_bss) { ++ wps_ie = rtw_get_wps_ie(current_joined_bss->IEs + _FIXED_IE_LENGTH_, ++ current_joined_bss->IELength - _FIXED_IE_LENGTH_, NULL, &wpsie_len); ++ if (wps_ie && wpsie_len > 0) { ++ u8 *attr = NULL; ++ u32 attr_len; ++ attr = rtw_get_wps_attr(wps_ie, wpsie_len, WPS_ATTR_SELECTED_REGISTRAR, ++ NULL, &attr_len); ++ if (attr) ++ *(attr + 4) = 0; ++ } ++ } ++ } ++ /* RTW_INFO("clear wps when %s\n", __func__); */ ++ ++ if (rtw_to_roam(padapter) > 0) ++ _clr_fwstate_(pmlmepriv, _FW_LINKED); ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) ++ rtw_wapi_return_one_sta_info(padapter, psta->hwaddr); ++ else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || ++ check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) ++ rtw_wapi_return_all_sta_info(padapter); ++#endif ++ ++ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) ++ || (rtw_to_roam(padapter) <= 0) ++ ) { ++ ++ rtw_os_indicate_disconnect(padapter, reason, locally_generated); ++ ++ /* set ips_deny_time to avoid enter IPS before LPS leave */ ++ rtw_set_ips_deny(padapter, 3000); ++ ++ _clr_fwstate_(pmlmepriv, _FW_LINKED); ++ ++ rtw_led_control(padapter, LED_CTL_NO_LINK); ++ ++ rtw_clear_scan_deny(padapter); ++ } ++ ++#ifdef CONFIG_P2P_PS ++ p2p_ps_wk_cmd(padapter, P2P_PS_DISABLE, 1); ++#endif /* CONFIG_P2P_PS */ ++ ++#ifdef CONFIG_LPS ++ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_DISCONNECT, 1); ++#endif ++ ++#ifdef CONFIG_BEAMFORMING ++ beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_LEAVE, cur_network->MacAddress, ETH_ALEN, 1); ++#endif /*CONFIG_BEAMFORMING*/ ++ ++} ++ ++inline void rtw_indicate_scan_done(_adapter *padapter, bool aborted) ++{ ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ ++ rtw_os_indicate_scan_done(padapter, aborted); ++ ++#ifdef CONFIG_IPS ++ if (is_primary_adapter(padapter) ++ && (_FALSE == adapter_to_pwrctl(padapter)->bInSuspend) ++ && (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE | WIFI_UNDER_LINKING) == _FALSE)) { ++ struct pwrctrl_priv *pwrpriv; ++ ++ pwrpriv = adapter_to_pwrctl(padapter); ++ rtw_set_ips_deny(padapter, 0); ++#ifdef CONFIG_IPS_CHECK_IN_WD ++ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 1); ++#else /* !CONFIG_IPS_CHECK_IN_WD */ ++ _rtw_set_pwr_state_check_timer(pwrpriv, 1); ++#endif /* !CONFIG_IPS_CHECK_IN_WD */ ++ } ++#endif /* CONFIG_IPS */ ++} ++ ++static u32 _rtw_wait_scan_done(_adapter *adapter, u8 abort, u32 timeout_ms) ++{ ++ u32 start; ++ u32 pass_ms; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); ++ ++ start = rtw_get_current_time(); ++ ++ pmlmeext->scan_abort = abort; ++ ++ while (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) ++ && rtw_get_passing_time_ms(start) <= timeout_ms) { ++ ++ if (RTW_CANNOT_RUN(adapter)) ++ break; ++ ++ RTW_INFO(FUNC_NDEV_FMT"fw_state=_FW_UNDER_SURVEY!\n", FUNC_NDEV_ARG(adapter->pnetdev)); ++ rtw_msleep_os(20); ++ } ++ ++ if (_TRUE == abort) { ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { ++ if (!RTW_CANNOT_RUN(adapter)) ++ RTW_INFO(FUNC_NDEV_FMT"waiting for scan_abort time out!\n", FUNC_NDEV_ARG(adapter->pnetdev)); ++#ifdef CONFIG_PLATFORM_MSTAR ++ /*_clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY);*/ ++ set_survey_timer(pmlmeext, 0); ++ mlme_set_scan_to_timer(pmlmepriv, 50); ++#endif ++ rtw_indicate_scan_done(adapter, _TRUE); ++ } ++ } ++ ++ pmlmeext->scan_abort = _FALSE; ++ pass_ms = rtw_get_passing_time_ms(start); ++ ++ return pass_ms; ++ ++} ++ ++void rtw_scan_wait_completed(_adapter *adapter) ++{ ++ u32 scan_to = SCANNING_TIMEOUT; ++ ++#ifdef CONFIG_SCAN_BACKOP ++ if (IsSupported5G(adapter->registrypriv.wireless_mode) ++ && IsSupported24G(adapter->registrypriv.wireless_mode)) /*dual band*/ ++ scan_to = CONC_SCANNING_TIMEOUT_DUAL_BAND; ++ else /*single band*/ ++ scan_to = CONC_SCANNING_TIMEOUT_SINGLE_BAND; ++#endif /* CONFIG_SCAN_BACKOP */ ++ ++ _rtw_wait_scan_done(adapter, _FALSE, scan_to); ++} ++ ++u32 rtw_scan_abort_timeout(_adapter *adapter, u32 timeout_ms) ++{ ++ return _rtw_wait_scan_done(adapter, _TRUE, timeout_ms); ++} ++ ++void rtw_scan_abort_no_wait(_adapter *adapter) ++{ ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) ++ pmlmeext->scan_abort = _TRUE; ++} ++ ++void rtw_scan_abort(_adapter *adapter) ++{ ++ rtw_scan_abort_timeout(adapter, 200); ++} ++ ++static struct sta_info *rtw_joinbss_update_stainfo(_adapter *padapter, struct wlan_network *pnetwork) ++{ ++ int i; ++ struct sta_info *bmc_sta, *psta = NULL; ++ struct recv_reorder_ctrl *preorder_ctrl; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ psta = rtw_get_stainfo(pstapriv, pnetwork->network.MacAddress); ++ if (psta == NULL) ++ psta = rtw_alloc_stainfo(pstapriv, pnetwork->network.MacAddress); ++ ++ if (psta) { /* update ptarget_sta */ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ psta->aid = pnetwork->join_res; ++ ++#if 0 /* alloc macid when call rtw_alloc_stainfo(), and release macid when call rtw_free_stainfo() */ ++#ifdef CONFIG_CONCURRENT_MODE ++ ++ if (PRIMARY_ADAPTER == padapter->adapter_type) ++ psta->mac_id = 0; ++ else ++ psta->mac_id = 2; ++#else ++ psta->mac_id = 0; ++#endif ++#endif /* removed */ ++ ++ update_sta_info(padapter, psta); ++ ++ /* update station supportRate */ ++ psta->bssratelen = rtw_get_rateset_len(pnetwork->network.SupportedRates); ++ _rtw_memcpy(psta->bssrateset, pnetwork->network.SupportedRates, psta->bssratelen); ++ rtw_hal_update_sta_rate_mask(padapter, psta); ++ ++ psta->wireless_mode = pmlmeext->cur_wireless_mode; ++ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); ++ ++ ++ /* sta mode */ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); ++ ++ /* security related */ ++#ifdef CONFIG_RTW_80211R ++ if ((padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) && (psta->ft_pairwise_key_installed == _FALSE)) { ++#else ++ if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { ++#endif ++ padapter->securitypriv.binstallGrpkey = _FALSE; ++ padapter->securitypriv.busetkipkey = _FALSE; ++ padapter->securitypriv.bgrpkey_handshake = _FALSE; ++ ++ psta->ieee8021x_blocked = _TRUE; ++ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; ++ ++ _rtw_memset((u8 *)&psta->dot118021x_UncstKey, 0, sizeof(union Keytype)); ++ ++ _rtw_memset((u8 *)&psta->dot11tkiprxmickey, 0, sizeof(union Keytype)); ++ _rtw_memset((u8 *)&psta->dot11tkiptxmickey, 0, sizeof(union Keytype)); ++ ++ _rtw_memset((u8 *)&psta->dot11txpn, 0, sizeof(union pn48)); ++ psta->dot11txpn.val = psta->dot11txpn.val + 1; ++#ifdef CONFIG_IEEE80211W ++ _rtw_memset((u8 *)&psta->dot11wtxpn, 0, sizeof(union pn48)); ++#endif /* CONFIG_IEEE80211W */ ++ _rtw_memset((u8 *)&psta->dot11rxpn, 0, sizeof(union pn48)); ++ } ++ ++ /* Commented by Albert 2012/07/21 */ ++ /* When doing the WPS, the wps_ie_len won't equal to 0 */ ++ /* And the Wi-Fi driver shouldn't allow the data packet to be tramsmitted. */ ++ if (padapter->securitypriv.wps_ie_len != 0) { ++ psta->ieee8021x_blocked = _TRUE; ++ padapter->securitypriv.wps_ie_len = 0; ++ } ++ ++ ++ /* for A-MPDU Rx reordering buffer control for bmc_sta & sta_info */ ++ /* if A-MPDU Rx is enabled, reseting rx_ordering_ctrl wstart_b(indicate_seq) to default value=0xffff */ ++ /* todo: check if AP can send A-MPDU packets */ ++ for (i = 0; i < 16 ; i++) { ++ /* preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; */ ++ preorder_ctrl = &psta->recvreorder_ctrl[i]; ++ preorder_ctrl->enable = _FALSE; ++ preorder_ctrl->indicate_seq = 0xffff; ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq); ++#endif ++ preorder_ctrl->wend_b = 0xffff; ++ preorder_ctrl->wsize_b = 64;/* max_ampdu_sz; */ /* ex. 32(kbytes) -> wsize_b=32 */ ++ preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; ++ } ++ ++ ++ bmc_sta = rtw_get_bcmc_stainfo(padapter); ++ if (bmc_sta) { ++ for (i = 0; i < 16 ; i++) { ++ /* preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; */ ++ preorder_ctrl = &bmc_sta->recvreorder_ctrl[i]; ++ preorder_ctrl->enable = _FALSE; ++ preorder_ctrl->indicate_seq = 0xffff; ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq); ++#endif ++ preorder_ctrl->wend_b = 0xffff; ++ preorder_ctrl->wsize_b = 64;/* max_ampdu_sz; */ /* ex. 32(kbytes) -> wsize_b=32 */ ++ preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; ++ } ++ } ++ } ++ ++ return psta; ++ ++} ++ ++/* pnetwork : returns from rtw_joinbss_event_callback ++ * ptarget_wlan: found from scanned_queue */ ++static void rtw_joinbss_update_network(_adapter *padapter, struct wlan_network *ptarget_wlan, struct wlan_network *pnetwork) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ ++ ++ /* why not use ptarget_wlan?? */ ++ _rtw_memcpy(&cur_network->network, &pnetwork->network, pnetwork->network.Length); ++ /* some IEs in pnetwork is wrong, so we should use ptarget_wlan IEs */ ++ cur_network->network.IELength = ptarget_wlan->network.IELength; ++ _rtw_memcpy(&cur_network->network.IEs[0], &ptarget_wlan->network.IEs[0], MAX_IE_SZ); ++ ++ cur_network->aid = pnetwork->join_res; ++ ++ ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ rtw_set_signal_stat_timer(&padapter->recvpriv); ++#endif ++ padapter->recvpriv.signal_strength = ptarget_wlan->network.PhyInfo.SignalStrength; ++ padapter->recvpriv.signal_qual = ptarget_wlan->network.PhyInfo.SignalQuality; ++ /* the ptarget_wlan->network.Rssi is raw data, we use ptarget_wlan->network.PhyInfo.SignalStrength instead (has scaled) */ ++ padapter->recvpriv.rssi = translate_percentage_to_dbm(ptarget_wlan->network.PhyInfo.SignalStrength); ++#if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 ++ RTW_INFO(FUNC_ADPT_FMT" signal_strength:%3u, rssi:%3d, signal_qual:%3u" ++ "\n" ++ , FUNC_ADPT_ARG(padapter) ++ , padapter->recvpriv.signal_strength ++ , padapter->recvpriv.rssi ++ , padapter->recvpriv.signal_qual ++ ); ++#endif ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ rtw_set_signal_stat_timer(&padapter->recvpriv); ++#endif ++ ++ /* update fw_state */ /* will clr _FW_UNDER_LINKING here indirectly */ ++ ++ switch (pnetwork->network.InfrastructureMode) { ++ case Ndis802_11Infrastructure: ++ ++ if (pmlmepriv->fw_state & WIFI_UNDER_WPS) ++ /*pmlmepriv->fw_state = WIFI_STATION_STATE|WIFI_UNDER_WPS;*/ ++ init_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_UNDER_WPS); ++ else ++ /*pmlmepriv->fw_state = WIFI_STATION_STATE;*/ ++ init_fwstate(pmlmepriv, WIFI_STATION_STATE); ++ break; ++ case Ndis802_11IBSS: ++ /*pmlmepriv->fw_state = WIFI_ADHOC_STATE;*/ ++ init_fwstate(pmlmepriv, WIFI_ADHOC_STATE); ++ break; ++ default: ++ /*pmlmepriv->fw_state = WIFI_NULL_STATE;*/ ++ init_fwstate(pmlmepriv, WIFI_NULL_STATE); ++ break; ++ } ++ ++ rtw_update_protection(padapter, (cur_network->network.IEs) + sizeof(NDIS_802_11_FIXED_IEs), ++ (cur_network->network.IELength)); ++ ++#ifdef CONFIG_80211N_HT ++ rtw_update_ht_cap(padapter, cur_network->network.IEs, cur_network->network.IELength, (u8) cur_network->network.Configuration.DSConfig); ++#endif ++} ++ ++/* Notes: the fucntion could be > passive_level (the same context as Rx tasklet) ++ * pnetwork : returns from rtw_joinbss_event_callback ++ * ptarget_wlan: found from scanned_queue ++ * if join_res > 0, for (fw_state==WIFI_STATION_STATE), we check if "ptarget_sta" & "ptarget_wlan" exist. ++ * if join_res > 0, for (fw_state==WIFI_ADHOC_STATE), we only check if "ptarget_wlan" exist. ++ * if join_res > 0, update "cur_network->network" from "pnetwork->network" if (ptarget_wlan !=NULL). ++ */ ++/* #define REJOIN */ ++void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf) ++{ ++ _irqL irqL, irqL2; ++ static u8 retry = 0; ++ u8 timer_cancelled; ++ struct sta_info *ptarget_sta = NULL, *pcur_sta = NULL; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct wlan_network *pnetwork = (struct wlan_network *)pbuf; ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ struct wlan_network *pcur_wlan = NULL, *ptarget_wlan = NULL; ++ unsigned int the_same_macaddr = _FALSE; ++ ++ ++#ifdef CONFIG_RTL8712 ++ /* endian_convert */ ++ pnetwork->join_res = le32_to_cpu(pnetwork->join_res); ++ pnetwork->network_type = le32_to_cpu(pnetwork->network_type); ++ pnetwork->network.Length = le32_to_cpu(pnetwork->network.Length); ++ pnetwork->network.Ssid.SsidLength = le32_to_cpu(pnetwork->network.Ssid.SsidLength); ++ pnetwork->network.Privacy = le32_to_cpu(pnetwork->network.Privacy); ++ pnetwork->network.Rssi = le32_to_cpu(pnetwork->network.Rssi); ++ pnetwork->network.NetworkTypeInUse = le32_to_cpu(pnetwork->network.NetworkTypeInUse) ; ++ pnetwork->network.Configuration.ATIMWindow = le32_to_cpu(pnetwork->network.Configuration.ATIMWindow); ++ pnetwork->network.Configuration.BeaconPeriod = le32_to_cpu(pnetwork->network.Configuration.BeaconPeriod); ++ pnetwork->network.Configuration.DSConfig = le32_to_cpu(pnetwork->network.Configuration.DSConfig); ++ pnetwork->network.Configuration.FHConfig.DwellTime = le32_to_cpu(pnetwork->network.Configuration.FHConfig.DwellTime); ++ pnetwork->network.Configuration.FHConfig.HopPattern = le32_to_cpu(pnetwork->network.Configuration.FHConfig.HopPattern); ++ pnetwork->network.Configuration.FHConfig.HopSet = le32_to_cpu(pnetwork->network.Configuration.FHConfig.HopSet); ++ pnetwork->network.Configuration.FHConfig.Length = le32_to_cpu(pnetwork->network.Configuration.FHConfig.Length); ++ pnetwork->network.Configuration.Length = le32_to_cpu(pnetwork->network.Configuration.Length); ++ pnetwork->network.InfrastructureMode = le32_to_cpu(pnetwork->network.InfrastructureMode); ++ pnetwork->network.IELength = le32_to_cpu(pnetwork->network.IELength); ++#endif ++ ++ ++ rtw_get_encrypt_decrypt_from_registrypriv(adapter); ++ ++ ++ ++ the_same_macaddr = _rtw_memcmp(pnetwork->network.MacAddress, cur_network->network.MacAddress, ETH_ALEN); ++ ++ pnetwork->network.Length = get_WLAN_BSSID_EX_sz(&pnetwork->network); ++ if (pnetwork->network.Length > sizeof(WLAN_BSSID_EX)) { ++ goto ignore_joinbss_callback; ++ } ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; ++ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; ++ ++ ++ if (pnetwork->join_res > 0) { ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ retry = 0; ++ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) { ++ /* s1. find ptarget_wlan */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED)) { ++ if (the_same_macaddr == _TRUE) ++ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); ++ else { ++ pcur_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); ++ if (pcur_wlan) ++ pcur_wlan->fixed = _FALSE; ++ ++ pcur_sta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); ++ if (pcur_sta) { ++ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); */ ++ rtw_free_stainfo(adapter, pcur_sta); ++ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); */ ++ } ++ ++ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->network.MacAddress); ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { ++ if (ptarget_wlan) ++ ptarget_wlan->fixed = _TRUE; ++ } ++ } ++ ++ } else { ++ ptarget_wlan = _rtw_find_same_network(&pmlmepriv->scanned_queue, pnetwork); ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { ++ if (ptarget_wlan) ++ ptarget_wlan->fixed = _TRUE; ++ } ++ } ++ ++ /* s2. update cur_network */ ++ if (ptarget_wlan) ++ rtw_joinbss_update_network(adapter, ptarget_wlan, pnetwork); ++ else { ++ RTW_PRINT("Can't find ptarget_wlan when joinbss_event callback\n"); ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ goto ignore_joinbss_callback; ++ } ++ ++ ++ /* s3. find ptarget_sta & update ptarget_sta after update cur_network only for station mode */ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { ++ ptarget_sta = rtw_joinbss_update_stainfo(adapter, pnetwork); ++ if (ptarget_sta == NULL) { ++ RTW_ERR("Can't update stainfo when joinbss_event callback\n"); ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ goto ignore_joinbss_callback; ++ } ++ } ++ ++ /* s4. indicate connect */ ++ if (MLME_IS_STA(adapter) || MLME_IS_ADHOC(adapter)) { ++ pmlmepriv->cur_network_scanned = ptarget_wlan; ++ rtw_indicate_connect(adapter); ++ } ++ ++ /* s5. Cancle assoc_timer */ ++ _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled); ++ ++ ++ } else { ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ goto ignore_joinbss_callback; ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ } else if (pnetwork->join_res == -4) { ++ rtw_reset_securitypriv(adapter); ++ _set_timer(&pmlmepriv->assoc_timer, 1); ++ ++ /* rtw_free_assoc_resources(adapter, 1); */ ++ ++ if ((check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) == _TRUE) { ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); ++ } ++ ++ } else { /* if join_res < 0 (join fails), then try again */ ++ ++#ifdef REJOIN ++ res = _FAIL; ++ if (retry < 2) { ++ res = rtw_select_and_join_from_scanned_queue(pmlmepriv); ++ } ++ ++ if (res == _SUCCESS) { ++ /* extend time of assoc_timer */ ++ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); ++ retry++; ++ } else if (res == 2) { /* there is no need to wait for join */ ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); ++ rtw_indicate_connect(adapter); ++ } else { ++#endif ++ ++ _set_timer(&pmlmepriv->assoc_timer, 1); ++ /* rtw_free_assoc_resources(adapter, 1); */ ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); ++ ++#ifdef REJOIN ++ retry = 0; ++ } ++#endif ++ } ++ ++ignore_joinbss_callback: ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++} ++ ++void rtw_joinbss_event_callback(_adapter *adapter, u8 *pbuf) ++{ ++ struct wlan_network *pnetwork = (struct wlan_network *)pbuf; ++ ++ ++ mlmeext_joinbss_event_callback(adapter, pnetwork->join_res); ++ ++ rtw_mi_os_xmit_schedule(adapter); ++ ++} ++ ++void rtw_sta_media_status_rpt(_adapter *adapter, struct sta_info *sta, bool connected) ++{ ++ struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; ++ bool miracast_enabled = 0; ++ bool miracast_sink = 0; ++ u8 role = H2C_MSR_ROLE_RSVD; ++ ++ if (sta == NULL) { ++ RTW_PRINT(FUNC_ADPT_FMT" sta is NULL\n" ++ , FUNC_ADPT_ARG(adapter)); ++ rtw_warn_on(1); ++ return; ++ } ++ ++ if (sta->mac_id >= macid_ctl->num) { ++ RTW_PRINT(FUNC_ADPT_FMT" invalid macid:%u\n" ++ , FUNC_ADPT_ARG(adapter), sta->mac_id); ++ rtw_warn_on(1); ++ return; ++ } ++ ++ if (!rtw_macid_is_used(macid_ctl, sta->mac_id)) { ++ RTW_PRINT(FUNC_ADPT_FMT" macid:%u not is used, set connected to 0\n" ++ , FUNC_ADPT_ARG(adapter), sta->mac_id); ++ connected = 0; ++ rtw_warn_on(1); ++ } ++ ++ if (connected && !rtw_macid_is_bmc(macid_ctl, sta->mac_id)) { ++ miracast_enabled = STA_OP_WFD_MODE(sta) != 0 && is_miracast_enabled(adapter); ++ miracast_sink = miracast_enabled && (STA_OP_WFD_MODE(sta) & MIRACAST_SINK); ++ ++#ifdef CONFIG_TDLS ++ if (sta->tdls_sta_state & TDLS_LINKED_STATE) ++ role = H2C_MSR_ROLE_TDLS; ++ else ++#endif ++ if (MLME_IS_STA(adapter)) { ++ if (MLME_IS_GC(adapter)) ++ role = H2C_MSR_ROLE_GO; ++ else ++ role = H2C_MSR_ROLE_AP; ++ } else if (MLME_IS_AP(adapter)) { ++ if (MLME_IS_GO(adapter)) ++ role = H2C_MSR_ROLE_GC; ++ else ++ role = H2C_MSR_ROLE_STA; ++ } else if (MLME_IS_ADHOC(adapter) || MLME_IS_ADHOC_MASTER(adapter)) ++ role = H2C_MSR_ROLE_ADHOC; ++ ++#ifdef CONFIG_WFD ++ if (role == H2C_MSR_ROLE_GC ++ || role == H2C_MSR_ROLE_GO ++ || role == H2C_MSR_ROLE_TDLS ++ ) { ++ if (adapter->wfd_info.rtsp_ctrlport ++ || adapter->wfd_info.tdls_rtsp_ctrlport ++ || adapter->wfd_info.peer_rtsp_ctrlport) ++ rtw_wfd_st_switch(sta, 1); ++ } ++#endif ++ } ++ ++ rtw_hal_set_FwMediaStatusRpt_single_cmd(adapter ++ , connected ++ , miracast_enabled ++ , miracast_sink ++ , role ++ , sta->mac_id ++ ); ++} ++ ++u8 rtw_sta_media_status_rpt_cmd(_adapter *adapter, struct sta_info *sta, bool connected) ++{ ++ struct cmd_priv *cmdpriv = &adapter->cmdpriv; ++ struct cmd_obj *cmdobj; ++ struct drvextra_cmd_parm *cmd_parm; ++ struct sta_media_status_rpt_cmd_parm *rpt_parm; ++ u8 res = _SUCCESS; ++ ++ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (cmdobj == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (cmd_parm == NULL) { ++ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ rpt_parm = (struct sta_media_status_rpt_cmd_parm *)rtw_zmalloc(sizeof(struct sta_media_status_rpt_cmd_parm)); ++ if (rpt_parm == NULL) { ++ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); ++ rtw_mfree((u8 *)cmd_parm, sizeof(struct drvextra_cmd_parm)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ rpt_parm->sta = sta; ++ rpt_parm->connected = connected; ++ ++ cmd_parm->ec_id = STA_MSTATUS_RPT_WK_CID; ++ cmd_parm->type = 0; ++ cmd_parm->size = sizeof(struct sta_media_status_rpt_cmd_parm); ++ cmd_parm->pbuf = (u8 *)rpt_parm; ++ init_h2fwcmd_w_parm_no_rsp(cmdobj, cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(cmdpriv, cmdobj); ++ ++exit: ++ return res; ++} ++ ++inline void rtw_sta_media_status_rpt_cmd_hdl(_adapter *adapter, struct sta_media_status_rpt_cmd_parm *parm) ++{ ++ rtw_sta_media_status_rpt(adapter, parm->sta, parm->connected); ++} ++ ++void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf) ++{ ++ _irqL irqL; ++ struct sta_info *psta; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct stassoc_event *pstassoc = (struct stassoc_event *)pbuf; ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ struct wlan_network *ptarget_wlan = NULL; ++ ++ ++#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) ++ if (rtw_access_ctrl(adapter, pstassoc->macaddr) == _FALSE) ++ return; ++#endif ++ ++#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ psta = rtw_get_stainfo(&adapter->stapriv, pstassoc->macaddr); ++ if (psta) { ++ u8 *passoc_req = NULL; ++ u32 assoc_req_len = 0; ++ ++ rtw_sta_media_status_rpt(adapter, psta, 1); ++ ++#ifndef CONFIG_AUTO_AP_MODE ++ ++ ap_sta_info_defer_update(adapter, psta); ++ ++ /* report to upper layer */ ++ RTW_INFO("indicate_sta_assoc_event to upper layer - hostapd\n"); ++#ifdef CONFIG_IOCTL_CFG80211 ++ _enter_critical_bh(&psta->lock, &irqL); ++ if (psta->passoc_req && psta->assoc_req_len > 0) { ++ passoc_req = rtw_zmalloc(psta->assoc_req_len); ++ if (passoc_req) { ++ assoc_req_len = psta->assoc_req_len; ++ _rtw_memcpy(passoc_req, psta->passoc_req, assoc_req_len); ++ ++ rtw_mfree(psta->passoc_req , psta->assoc_req_len); ++ psta->passoc_req = NULL; ++ psta->assoc_req_len = 0; ++ } ++ } ++ _exit_critical_bh(&psta->lock, &irqL); ++ ++ if (passoc_req && assoc_req_len > 0) { ++ rtw_cfg80211_indicate_sta_assoc(adapter, passoc_req, assoc_req_len); ++ ++ rtw_mfree(passoc_req, assoc_req_len); ++ } ++#else /* !CONFIG_IOCTL_CFG80211 */ ++ rtw_indicate_sta_assoc_event(adapter, psta); ++#endif /* !CONFIG_IOCTL_CFG80211 */ ++#endif /* !CONFIG_AUTO_AP_MODE */ ++ ++#ifdef CONFIG_BEAMFORMING ++ beamforming_wk_cmd(adapter, BEAMFORMING_CTRL_ENTER, (u8 *)psta, sizeof(struct sta_info), 0); ++#endif/*CONFIG_BEAMFORMING*/ ++ if (is_wep_enc(adapter->securitypriv.dot11PrivacyAlgrthm)) ++ rtw_ap_wep_pk_setting(adapter, psta); ++ } ++ goto exit; ++ } ++#endif /* defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ ++ ++ /* for AD-HOC mode */ ++ psta = rtw_get_stainfo(&adapter->stapriv, pstassoc->macaddr); ++ if (psta == NULL) { ++ RTW_ERR(FUNC_ADPT_FMT" get no sta_info with "MAC_FMT"\n" ++ , FUNC_ADPT_ARG(adapter), MAC_ARG(pstassoc->macaddr)); ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ rtw_hal_set_odm_var(adapter, HAL_ODM_STA_INFO, psta, _TRUE); ++ ++ rtw_sta_media_status_rpt(adapter, psta, 1); ++ ++ if (adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) ++ psta->dot118021XPrivacy = adapter->securitypriv.dot11PrivacyAlgrthm; ++ ++ ++ psta->ieee8021x_blocked = _FALSE; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) { ++ if (adapter->stapriv.asoc_sta_count == 2) { ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); ++ pmlmepriv->cur_network_scanned = ptarget_wlan; ++ if (ptarget_wlan) ++ ptarget_wlan->fixed = _TRUE; ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ /* a sta + bc/mc_stainfo (not Ibss_stainfo) */ ++ rtw_indicate_connect(adapter); ++ } ++ } ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ ++ mlmeext_sta_add_event_callback(adapter, psta); ++ ++#ifdef CONFIG_RTL8711 ++ /* submit SetStaKey_cmd to tell fw, fw will allocate an CAM entry for this sta */ ++ rtw_setstakey_cmd(adapter, psta, GROUP_KEY, _TRUE); ++#endif ++ ++exit: ++ return; ++} ++ ++#ifdef CONFIG_IEEE80211W ++void rtw_sta_timeout_event_callback(_adapter *adapter, u8 *pbuf) ++{ ++ _irqL irqL; ++ struct sta_info *psta; ++ struct stadel_event *pstadel = (struct stadel_event *)pbuf; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ ++ ++ psta = rtw_get_stainfo(&adapter->stapriv, pstadel->macaddr); ++ ++ if (psta) { ++ u8 updated = _FALSE; ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { ++ rtw_list_delete(&psta->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ updated = ap_free_sta(adapter, psta, _TRUE, WLAN_REASON_PREV_AUTH_NOT_VALID, _TRUE); ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ associated_clients_update(adapter, updated, STA_INFO_UPDATE_ALL); ++ } ++ ++ ++ ++} ++#endif /* CONFIG_IEEE80211W */ ++ ++#ifdef CONFIG_RTW_80211R ++void rtw_update_ft_stainfo(_adapter *padapter, WLAN_BSSID_EX *pnetwork) ++{ ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta = NULL; ++ ++ psta = rtw_get_stainfo(pstapriv, pnetwork->MacAddress); ++ if (psta == NULL) ++ psta = rtw_alloc_stainfo(pstapriv, pnetwork->MacAddress); ++ ++ if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { ++ ++ padapter->securitypriv.binstallGrpkey = _FALSE; ++ padapter->securitypriv.busetkipkey = _FALSE; ++ padapter->securitypriv.bgrpkey_handshake = _FALSE; ++ ++ psta->ieee8021x_blocked = _TRUE; ++ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; ++ psta->dot11txpn.val = psta->dot11txpn.val + 1; ++ ++ _rtw_memset((u8 *)&psta->dot118021x_UncstKey, 0, sizeof(union Keytype)); ++ _rtw_memset((u8 *)&psta->dot11tkiprxmickey, 0, sizeof(union Keytype)); ++ _rtw_memset((u8 *)&psta->dot11tkiptxmickey, 0, sizeof(union Keytype)); ++ _rtw_memset((u8 *)&psta->dot11txpn, 0, sizeof(union pn48)); ++#ifdef CONFIG_IEEE80211W ++ _rtw_memset((u8 *)&psta->dot11wtxpn, 0, sizeof(union pn48)); ++#endif ++ _rtw_memset((u8 *)&psta->dot11rxpn, 0, sizeof(union pn48)); ++ } ++ ++} ++ ++void rtw_ft_reassoc_event_callback(_adapter *padapter, u8 *pbuf) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct stassoc_event *pstassoc = (struct stassoc_event *)pbuf; ++ ft_priv *pftpriv = &pmlmepriv->ftpriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); ++ struct cfg80211_ft_event_params ft_evt_parms; ++ _irqL irqL; ++ ++ _rtw_memset(&ft_evt_parms, 0, sizeof(ft_evt_parms)); ++ rtw_update_ft_stainfo(padapter, pnetwork); ++ ft_evt_parms.ies_len = pftpriv->ft_event.ies_len; ++ ft_evt_parms.ies = rtw_zmalloc(ft_evt_parms.ies_len); ++ if (ft_evt_parms.ies) ++ _rtw_memcpy((void *)ft_evt_parms.ies, pftpriv->ft_event.ies, ft_evt_parms.ies_len); ++ else ++ goto err_2; ++ ++ ft_evt_parms.target_ap = rtw_zmalloc(ETH_ALEN); ++ if (ft_evt_parms.target_ap) ++ _rtw_memcpy((void *)ft_evt_parms.target_ap, pstassoc->macaddr, ETH_ALEN); ++ else ++ goto err_1; ++ ++ ft_evt_parms.ric_ies = pftpriv->ft_event.ric_ies; ++ ft_evt_parms.ric_ies_len = pftpriv->ft_event.ric_ies_len; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ rtw_set_ft_status(padapter, RTW_FT_AUTHENTICATED_STA); ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ rtw_cfg80211_ft_event(padapter, &ft_evt_parms); ++ RTW_INFO("%s: to "MAC_FMT"\n", __func__, MAC_ARG(ft_evt_parms.target_ap)); ++ ++ rtw_mfree((u8 *)pftpriv->ft_event.target_ap, ETH_ALEN); ++err_1: ++ rtw_mfree((u8 *)ft_evt_parms.ies, ft_evt_parms.ies_len); ++err_2: ++ return; ++} ++#endif ++ ++void rtw_sta_mstatus_disc_rpt(_adapter *adapter, u8 mac_id) ++{ ++ struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; ++ ++ RTW_INFO("%s "ADPT_FMT" - mac_id=%d\n", __func__, ADPT_ARG(adapter), mac_id); ++ ++ if (mac_id >= 0 && mac_id < macid_ctl->num) { ++ rtw_hal_set_FwMediaStatusRpt_single_cmd(adapter, 0, 0, 0, 0, mac_id); ++ /* ++ * For safety, prevent from keeping macid sleep. ++ * If we can sure all power mode enter/leave are paired, ++ * this check can be removed. ++ * Lucas@20131113 ++ */ ++ /* wakeup macid after disconnect. */ ++ /*if (MLME_IS_STA(adapter))*/ ++ rtw_hal_macid_wakeup(adapter, mac_id); ++ } else { ++ RTW_PRINT(FUNC_ADPT_FMT" invalid macid:%u\n" ++ , FUNC_ADPT_ARG(adapter), mac_id); ++ rtw_warn_on(1); ++ } ++} ++void rtw_sta_mstatus_report(_adapter *adapter) ++{ ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct wlan_network *tgt_network = &pmlmepriv->cur_network; ++ struct sta_info *psta = NULL; ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && ++ check_fwstate(pmlmepriv, _FW_LINKED)) { ++ psta = rtw_get_stainfo(&adapter->stapriv, tgt_network->network.MacAddress); ++ if (psta) ++ rtw_sta_mstatus_disc_rpt(adapter, psta->mac_id); ++ else { ++ RTW_INFO("%s "ADPT_FMT" - mac_addr: "MAC_FMT" psta == NULL\n", __func__, ADPT_ARG(adapter), MAC_ARG(tgt_network->network.MacAddress)); ++ rtw_warn_on(1); ++ } ++ } else { ++ RTW_DBG("%s: fwstate: %08x\n", __func__, pmlmepriv->fw_state); ++ } ++} ++ ++void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf) ++{ ++ _irqL irqL, irqL2; ++ ++ struct sta_info *psta; ++ struct wlan_network *pwlan = NULL; ++ WLAN_BSSID_EX *pdev_network = NULL; ++ u8 *pibss = NULL; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct stadel_event *pstadel = (struct stadel_event *)pbuf; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct wlan_network *tgt_network = &(pmlmepriv->cur_network); ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ ++ RTW_INFO("%s(mac_id=%d)=" MAC_FMT "\n", __func__, pstadel->mac_id, MAC_ARG(pstadel->macaddr)); ++ rtw_sta_mstatus_disc_rpt(adapter, pstadel->mac_id); ++ ++ psta = rtw_get_stainfo(&adapter->stapriv, pstadel->macaddr); ++ ++ if (psta == NULL) { ++ RTW_INFO("%s(mac_id=%d)=" MAC_FMT " psta == NULL\n", __func__, pstadel->mac_id, MAC_ARG(pstadel->macaddr)); ++ /*rtw_warn_on(1);*/ ++ } ++ ++ if (psta) ++ rtw_wfd_st_switch(psta, 0); ++ ++ /* if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) */ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { ++#ifdef CONFIG_IOCTL_CFG80211 ++#ifdef COMPAT_KERNEL_RELEASE ++ ++#elif (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 37)) || defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) ++ rtw_cfg80211_indicate_sta_disassoc(adapter, pstadel->macaddr, *(u16 *)pstadel->rsvd); ++#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 37)) || defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) */ ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++ return; ++ } ++ ++ mlmeext_sta_del_event_callback(adapter); ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL2); ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { ++ u16 reason = *((unsigned short *)(pstadel->rsvd)); ++ bool roam = _FALSE; ++ struct wlan_network *roam_target = NULL; ++ ++#ifdef CONFIG_LAYER2_ROAMING ++#ifdef CONFIG_RTW_80211R ++ if (reason == WLAN_REASON_EXPIRATION_CHK && rtw_chk_roam_flags(adapter, RTW_ROAM_ON_EXPIRED)) ++ pmlmepriv->ftpriv.ft_roam_on_expired = _TRUE; ++ else ++ pmlmepriv->ftpriv.ft_roam_on_expired = _FALSE; ++#endif ++ if (adapter->registrypriv.wifi_spec == 1) ++ roam = _FALSE; ++ else if (reason == WLAN_REASON_EXPIRATION_CHK && rtw_chk_roam_flags(adapter, RTW_ROAM_ON_EXPIRED)) ++ roam = _TRUE; ++ else if (reason == WLAN_REASON_ACTIVE_ROAM && rtw_chk_roam_flags(adapter, RTW_ROAM_ACTIVE)) { ++ roam = _TRUE; ++ roam_target = pmlmepriv->roam_network; ++ } ++#ifdef CONFIG_INTEL_WIDI ++ else if (adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_CONNECTED) ++ roam = _TRUE; ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ if (roam == _TRUE) { ++ if (rtw_to_roam(adapter) > 0) ++ rtw_dec_to_roam(adapter); /* this stadel_event is caused by roaming, decrease to_roam */ ++ else if (rtw_to_roam(adapter) == 0) ++ rtw_set_to_roam(adapter, adapter->registrypriv.max_roaming_times); ++ } else ++ rtw_set_to_roam(adapter, 0); ++#endif /* CONFIG_LAYER2_ROAMING */ ++ ++ rtw_free_uc_swdec_pending_queue(adapter); ++ ++ rtw_free_assoc_resources(adapter, 1); ++ rtw_free_mlme_priv_ie_data(pmlmepriv); ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ /* remove the network entry in scanned_queue */ ++ pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); ++ if ((pwlan) && (!check_fwstate(pmlmepriv, WIFI_UNDER_WPS))) { ++ pwlan->fixed = _FALSE; ++ rtw_free_network_nolock(adapter, pwlan); ++ } ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ rtw_indicate_disconnect(adapter, *(u16 *)pstadel->rsvd, pstadel->locally_generated); ++#ifdef CONFIG_INTEL_WIDI ++ if (!rtw_to_roam(adapter)) ++ process_intel_widi_disconnect(adapter, 1); ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ _rtw_roaming(adapter, roam_target); ++ } ++ ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) || ++ check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { ++ ++ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ rtw_free_stainfo(adapter, psta); ++ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ ++ if (adapter->stapriv.asoc_sta_count == 1) { /* a sta + bc/mc_stainfo (not Ibss_stainfo) */ ++ /* rtw_indicate_disconnect(adapter); */ /* removed@20091105 */ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ /* free old ibss network */ ++ /* pwlan = rtw_find_network(&pmlmepriv->scanned_queue, pstadel->macaddr); */ ++ pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); ++ if (pwlan) { ++ pwlan->fixed = _FALSE; ++ rtw_free_network_nolock(adapter, pwlan); ++ } ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ /* re-create ibss */ ++ pdev_network = &(adapter->registrypriv.dev_network); ++ pibss = adapter->registrypriv.dev_network.MacAddress; ++ ++ _rtw_memcpy(pdev_network, &tgt_network->network, get_WLAN_BSSID_EX_sz(&tgt_network->network)); ++ ++ _rtw_memset(&pdev_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); ++ _rtw_memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); ++ ++ rtw_update_registrypriv_dev_network(adapter); ++ ++ rtw_generate_random_ibss(pibss); ++ ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { ++ set_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); ++ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_STATE); ++ } ++ ++ if (rtw_create_ibss_cmd(adapter, 0) != _SUCCESS) ++ RTW_ERR("rtw_create_ibss_cmd FAIL\n"); ++ ++ } ++ ++ } ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL2); ++ ++ ++} ++ ++ ++void rtw_cpwm_event_callback(PADAPTER padapter, u8 *pbuf) ++{ ++#ifdef CONFIG_LPS_LCLK ++ struct reportpwrstate_parm *preportpwrstate; ++#endif ++ ++ ++#ifdef CONFIG_LPS_LCLK ++ preportpwrstate = (struct reportpwrstate_parm *)pbuf; ++ preportpwrstate->state |= (u8)(adapter_to_pwrctl(padapter)->cpwm_tog + 0x80); ++ cpwm_int_hdl(padapter, preportpwrstate); ++#endif ++ ++ ++} ++ ++ ++void rtw_wmm_event_callback(PADAPTER padapter, u8 *pbuf) ++{ ++ ++ WMMOnAssocRsp(padapter); ++ ++ ++} ++ ++/* ++* _rtw_join_timeout_handler - Timeout/faliure handler for CMD JoinBss ++* @adapter: pointer to _adapter structure ++*/ ++void _rtw_join_timeout_handler(_adapter *adapter) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ ++#if 0 ++ if (rtw_is_drv_stopped(adapter)) { ++ _rtw_up_sema(&pmlmepriv->assoc_terminate); ++ return; ++ } ++#endif ++ ++ ++ ++ RTW_INFO("%s, fw_state=%x\n", __FUNCTION__, get_fwstate(pmlmepriv)); ++ ++ if (RTW_CANNOT_RUN(adapter)) ++ return; ++ ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++#ifdef CONFIG_LAYER2_ROAMING ++ if (rtw_to_roam(adapter) > 0) { /* join timeout caused by roaming */ ++ while (1) { ++ rtw_dec_to_roam(adapter); ++ if (rtw_to_roam(adapter) != 0) { /* try another */ ++ int do_join_r; ++ RTW_INFO("%s try another roaming\n", __FUNCTION__); ++ do_join_r = rtw_do_join(adapter); ++ if (_SUCCESS != do_join_r) { ++ RTW_INFO("%s roaming do_join return %d\n", __FUNCTION__ , do_join_r); ++ continue; ++ } ++ break; ++ } else { ++#ifdef CONFIG_INTEL_WIDI ++ if (adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) { ++ _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); ++ intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL, 0); ++ RTW_INFO("change to widi listen\n"); ++ } ++#endif /* CONFIG_INTEL_WIDI */ ++ RTW_INFO("%s We've try roaming but fail\n", __FUNCTION__); ++#ifdef CONFIG_RTW_80211R ++ rtw_clr_ft_flags(adapter, RTW_FT_SUPPORTED|RTW_FT_OVER_DS_SUPPORTED); ++ rtw_reset_ft_status(adapter); ++#endif ++ rtw_indicate_disconnect(adapter, 0, _FALSE); ++ break; ++ } ++ } ++ ++ } else ++#endif ++ { ++ rtw_indicate_disconnect(adapter, 0, _FALSE); ++ free_scanqueue(pmlmepriv);/* ??? */ ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ /* indicate disconnect for the case that join_timeout and check_fwstate != FW_LINKED */ ++ rtw_cfg80211_indicate_disconnect(adapter, 0, _FALSE); ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++ } ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ ++#ifdef CONFIG_DRVEXT_MODULE_WSC ++ drvext_assoc_fail_indicate(&adapter->drvextpriv); ++#endif ++ ++ ++ ++} ++ ++/* ++* rtw_scan_timeout_handler - Timeout/Faliure handler for CMD SiteSurvey ++* @adapter: pointer to _adapter structure ++*/ ++void rtw_scan_timeout_handler(_adapter *adapter) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ RTW_INFO(FUNC_ADPT_FMT" fw_state=%x\n", FUNC_ADPT_ARG(adapter), get_fwstate(pmlmepriv)); ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_cfg80211_surveydone_event_callback(adapter); ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++ rtw_indicate_scan_done(adapter, _TRUE); ++ ++#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_IOCTL_CFG80211) ++ rtw_cfg80211_indicate_scan_done_for_buddy(adapter, _TRUE); ++#endif ++} ++ ++void rtw_mlme_reset_auto_scan_int(_adapter *adapter, u8 *reason) ++{ ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 u_ch; ++ u32 interval_ms = 0xffffffff; /* 0xffffffff: special value to make min() works well, also means no auto scan */ ++ ++ *reason = RTW_AUTO_SCAN_REASON_UNSPECIFIED; ++ rtw_mi_get_ch_setting_union(adapter, &u_ch, NULL, NULL); ++ ++ if (hal_chk_bw_cap(adapter, BW_CAP_40M) ++ && is_client_associated_to_ap(adapter) == _TRUE ++ && u_ch >= 1 && u_ch <= 14 ++ && adapter->registrypriv.wifi_spec ++ /* TODO: AP Connected is 40MHz capability? */ ++ ) { ++ interval_ms = rtw_min(interval_ms, 60 * 1000); ++ *reason |= RTW_AUTO_SCAN_REASON_2040_BSS; ++ } ++ ++exit: ++ if (interval_ms == 0xffffffff) ++ interval_ms = 0; ++ ++ rtw_mlme_set_auto_scan_int(adapter, interval_ms); ++ return; ++} ++ ++void rtw_drv_scan_by_self(_adapter *padapter, u8 reason) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct rtw_ieee80211_channel ch_for_2040_bss[14] = { ++ {1, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ {2, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ {3, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ {4, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ {5, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ {6, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ {7, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ {8, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ {9, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ {10, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ {11, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ {12, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ {13, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ {14, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, ++ }; ++ struct rtw_ieee80211_channel *ch_sel = NULL; ++ int ch_num = 0; ++ ++ if (rtw_is_scan_deny(padapter)) ++ goto exit; ++ ++ if (!rtw_is_adapter_up(padapter)) ++ goto exit; ++ ++ if (rtw_mi_busy_traffic_check(padapter, _FALSE)) { ++#ifdef CONFIG_LAYER2_ROAMING ++ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ACTIVE) && pmlmepriv->need_to_roam == _TRUE) { ++ RTW_INFO("need to roam, don't care BusyTraffic\n"); ++ } else ++#endif ++ { ++ RTW_INFO(FUNC_ADPT_FMT" exit BusyTraffic\n", FUNC_ADPT_ARG(padapter)); ++ goto exit; ++ } ++ } ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) && check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { ++ RTW_INFO(FUNC_ADPT_FMT" WIFI_AP_STATE && WIFI_UNDER_WPS\n", FUNC_ADPT_ARG(padapter)); ++ goto exit; ++ } ++ if (check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY | _FW_UNDER_LINKING)) == _TRUE) { ++ RTW_INFO(FUNC_ADPT_FMT" _FW_UNDER_SURVEY|_FW_UNDER_LINKING\n", FUNC_ADPT_ARG(padapter)); ++ goto exit; ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_buddy_check_fwstate(padapter, (_FW_UNDER_SURVEY | _FW_UNDER_LINKING | WIFI_UNDER_WPS))) { ++ RTW_INFO(FUNC_ADPT_FMT", but buddy_intf is under scanning or linking or wps_phase\n", FUNC_ADPT_ARG(padapter)); ++ goto exit; ++ } ++#endif ++ ++ RTW_INFO(FUNC_ADPT_FMT" reason:0x%02x\n", FUNC_ADPT_ARG(padapter), reason); ++ ++ /* only for 20/40 BSS */ ++ if (reason == RTW_AUTO_SCAN_REASON_2040_BSS) { ++ ch_sel = ch_for_2040_bss; ++ ch_num = 14; ++ } ++ ++ rtw_set_802_11_bssid_list_scan(padapter, NULL, 0, ch_sel, ch_num); ++exit: ++ return; ++} ++ ++static void rtw_auto_scan_handler(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ u8 reason = RTW_AUTO_SCAN_REASON_UNSPECIFIED; ++ ++ rtw_mlme_reset_auto_scan_int(padapter, &reason); ++ ++#ifdef CONFIG_P2P ++ if (!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE)) ++ goto exit; ++#endif ++ ++#ifdef CONFIG_TDLS ++ if (padapter->tdlsinfo.link_established == _TRUE) ++ goto exit; ++#endif ++ ++ if (pmlmepriv->auto_scan_int_ms == 0 ++ || rtw_get_passing_time_ms(pmlmepriv->scan_start_time) < pmlmepriv->auto_scan_int_ms) ++ goto exit; ++ ++ rtw_drv_scan_by_self(padapter, reason); ++ ++exit: ++ return; ++} ++static u8 is_drv_in_lps(_adapter *adapter) ++{ ++ u8 is_in_lps = _FALSE; ++ ++ #ifdef CONFIG_LPS_LCLK_WD_TIMER /* to avoid leaving lps 32k frequently*/ ++ if ((adapter_to_pwrctl(adapter)->bFwCurrentInPSMode == _TRUE) ++ #ifdef CONFIG_BT_COEXIST ++ && (rtw_btcoex_IsBtControlLps(adapter) == _FALSE) ++ #endif ++ ) ++ is_in_lps = _TRUE; ++ #endif /* CONFIG_LPS_LCLK_WD_TIMER*/ ++ return is_in_lps; ++} ++void rtw_iface_dynamic_check_timer_handlder(_adapter *adapter) ++{ ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ ++ if (adapter->net_closed == _TRUE) ++ return; ++ #ifdef CONFIG_LPS_LCLK_WD_TIMER /* to avoid leaving lps 32k frequently*/ ++ if (is_drv_in_lps(adapter)) { ++ u8 bEnterPS; ++ ++ linked_status_chk(adapter, 1); ++ ++ bEnterPS = traffic_status_watchdog(adapter, 1); ++ if (bEnterPS) { ++ /* rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_ENTER, 1); */ ++ rtw_hal_dm_watchdog_in_lps(adapter); ++ } else { ++ /* call rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1) in traffic_status_watchdog() */ ++ } ++ } ++ #endif /* CONFIG_LPS_LCLK_WD_TIMER */ ++ ++ /* auto site survey */ ++ rtw_auto_scan_handler(adapter); ++ ++#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++#ifdef CONFIG_AP_MODE ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ expire_timeout_chk(adapter); ++#endif ++#endif /* !CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ ++ ++#ifdef CONFIG_BR_EXT ++ ++#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) ++ rcu_read_lock(); ++#endif /* (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) */ ++ ++#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) ++ if (adapter->pnetdev->br_port ++#else /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ ++ if (rcu_dereference(adapter->pnetdev->rx_handler_data) ++#endif /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ ++ && (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) == _TRUE)) { ++ /* expire NAT2.5 entry */ ++ void nat25_db_expire(_adapter *priv); ++ nat25_db_expire(adapter); ++ ++ if (adapter->pppoe_connection_in_progress > 0) ++ adapter->pppoe_connection_in_progress--; ++ /* due to rtw_dynamic_check_timer_handlder() is called every 2 seconds */ ++ if (adapter->pppoe_connection_in_progress > 0) ++ adapter->pppoe_connection_in_progress--; ++ } ++ ++#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) ++ rcu_read_unlock(); ++#endif /* (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) */ ++ ++#endif /* CONFIG_BR_EXT */ ++ ++} ++ ++/*#define DBG_TRAFFIC_STATISTIC*/ ++static void collect_traffic_statistics(_adapter *padapter) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ ++ /*_rtw_memset(&pdvobjpriv->traffic_stat, 0, sizeof(struct rtw_traffic_statistics));*/ ++ ++ /* Tx bytes reset*/ ++ pdvobjpriv->traffic_stat.tx_bytes = 0; ++ pdvobjpriv->traffic_stat.tx_pkts = 0; ++ pdvobjpriv->traffic_stat.tx_drop = 0; ++ ++ /* Rx bytes reset*/ ++ pdvobjpriv->traffic_stat.rx_bytes = 0; ++ pdvobjpriv->traffic_stat.rx_pkts = 0; ++ pdvobjpriv->traffic_stat.rx_drop = 0; ++ ++ rtw_mi_traffic_statistics(padapter); ++ ++ /* Calculate throughput in last interval */ ++ pdvobjpriv->traffic_stat.cur_tx_bytes = pdvobjpriv->traffic_stat.tx_bytes - pdvobjpriv->traffic_stat.last_tx_bytes; ++ pdvobjpriv->traffic_stat.cur_rx_bytes = pdvobjpriv->traffic_stat.rx_bytes - pdvobjpriv->traffic_stat.last_rx_bytes; ++ pdvobjpriv->traffic_stat.last_tx_bytes = pdvobjpriv->traffic_stat.tx_bytes; ++ pdvobjpriv->traffic_stat.last_rx_bytes = pdvobjpriv->traffic_stat.rx_bytes; ++ ++ pdvobjpriv->traffic_stat.cur_tx_tp = (u32)(pdvobjpriv->traffic_stat.cur_tx_bytes * 8 / 2 / 1024 / 1024); ++ pdvobjpriv->traffic_stat.cur_rx_tp = (u32)(pdvobjpriv->traffic_stat.cur_rx_bytes * 8 / 2 / 1024 / 1024); ++ ++ #ifdef DBG_TRAFFIC_STATISTIC ++ RTW_INFO("\n========================\n"); ++ RTW_INFO("cur_tx_bytes:%lld\n", pdvobjpriv->traffic_stat.cur_tx_bytes); ++ RTW_INFO("cur_rx_bytes:%lld\n", pdvobjpriv->traffic_stat.cur_rx_bytes); ++ ++ RTW_INFO("last_tx_bytes:%lld\n", pdvobjpriv->traffic_stat.last_tx_bytes); ++ RTW_INFO("last_rx_bytes:%lld\n", pdvobjpriv->traffic_stat.last_rx_bytes); ++ ++ RTW_INFO("cur_tx_tp:%d\n", pdvobjpriv->traffic_stat.cur_tx_tp); ++ RTW_INFO("cur_rx_tp:%d\n", pdvobjpriv->traffic_stat.cur_rx_tp); ++ #endif ++} ++ ++void rtw_dynamic_check_timer_handlder(_adapter *adapter) ++{ ++ if (!adapter) ++ return; ++ ++ if (!rtw_is_hw_init_completed(adapter)) ++ return; ++ ++ if (RTW_CANNOT_RUN(adapter)) ++ return; ++ ++ collect_traffic_statistics(adapter); ++ ++ rtw_mi_dynamic_check_timer_handlder(adapter); ++ ++ if (!is_drv_in_lps(adapter)) ++ rtw_dynamic_chk_wk_cmd(adapter); ++} ++ ++ ++#ifdef CONFIG_SET_SCAN_DENY_TIMER ++inline bool rtw_is_scan_deny(_adapter *adapter) ++{ ++ struct mlme_priv *mlmepriv = &adapter->mlmepriv; ++ return (ATOMIC_READ(&mlmepriv->set_scan_deny) != 0) ? _TRUE : _FALSE; ++} ++ ++inline void rtw_clear_scan_deny(_adapter *adapter) ++{ ++ struct mlme_priv *mlmepriv = &adapter->mlmepriv; ++ ATOMIC_SET(&mlmepriv->set_scan_deny, 0); ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); ++} ++ ++void rtw_set_scan_deny_timer_hdl(_adapter *adapter) ++{ ++ rtw_clear_scan_deny(adapter); ++} ++void rtw_set_scan_deny(_adapter *adapter, u32 ms) ++{ ++ struct mlme_priv *mlmepriv = &adapter->mlmepriv; ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); ++ ATOMIC_SET(&mlmepriv->set_scan_deny, 1); ++ _set_timer(&mlmepriv->set_scan_deny_timer, ms); ++} ++#endif ++ ++#ifdef CONFIG_LAYER2_ROAMING ++/* ++* Select a new roaming candidate from the original @param candidate and @param competitor ++* @return _TRUE: candidate is updated ++* @return _FALSE: candidate is not updated ++*/ ++static int rtw_check_roaming_candidate(struct mlme_priv *mlme ++ , struct wlan_network **candidate, struct wlan_network *competitor) ++{ ++ int updated = _FALSE; ++ _adapter *adapter = container_of(mlme, _adapter, mlmepriv); ++#ifdef CONFIG_RTW_80211R ++ ft_priv *pftpriv = &mlme->ftpriv; ++ u32 mdie_len = 0; ++ u8 *ptmp = NULL; ++#endif ++ ++ ++ if (is_same_ess(&competitor->network, &mlme->cur_network.network) == _FALSE) ++ goto exit; ++ ++ if (rtw_is_desired_network(adapter, competitor) == _FALSE) ++ goto exit; ++ ++#ifdef CONFIG_LAYER2_ROAMING ++ if (mlme->need_to_roam == _FALSE) ++ goto exit; ++#endif ++ ++#ifdef CONFIG_RTW_80211R ++ if (rtw_chk_ft_flags(adapter, RTW_FT_SUPPORTED)) { ++ ptmp = rtw_get_ie(&competitor->network.IEs[12], _MDIE_, &mdie_len, competitor->network.IELength-12); ++ if (ptmp) { ++ if (!_rtw_memcmp(&pftpriv->mdid, ptmp+2, 2)) ++ goto exit; ++ ++ /*The candidate don't support over-the-DS*/ ++ if (rtw_chk_ft_flags(adapter, RTW_FT_STA_OVER_DS_SUPPORTED)) { ++ if ((rtw_chk_ft_flags(adapter, RTW_FT_OVER_DS_SUPPORTED) && !(*(ptmp+4) & 0x01)) || ++ (!rtw_chk_ft_flags(adapter, RTW_FT_OVER_DS_SUPPORTED) && (*(ptmp+4) & 0x01))) { ++ RTW_INFO("FT: ignore the candidate(" MAC_FMT ") for over-the-DS\n", MAC_ARG(competitor->network.MacAddress)); ++ rtw_clr_ft_flags(adapter, RTW_FT_OVER_DS_SUPPORTED); ++ goto exit; ++ } ++ } ++ } else ++ goto exit; ++ } ++#endif ++ ++ RTW_INFO("roam candidate:%s %s("MAC_FMT", ch%3u) rssi:%d, age:%5d\n", ++ (competitor == mlme->cur_network_scanned) ? "*" : " " , ++ competitor->network.Ssid.Ssid, ++ MAC_ARG(competitor->network.MacAddress), ++ competitor->network.Configuration.DSConfig, ++ (int)competitor->network.Rssi, ++ rtw_get_passing_time_ms(competitor->last_scanned) ++ ); ++ ++ /* got specific addr to roam */ ++ if (!is_zero_mac_addr(mlme->roam_tgt_addr)) { ++ if (_rtw_memcmp(mlme->roam_tgt_addr, competitor->network.MacAddress, ETH_ALEN) == _TRUE) ++ goto update; ++ else ++ goto exit; ++ } ++#if 1 ++ if (rtw_get_passing_time_ms((u32)competitor->last_scanned) >= mlme->roam_scanr_exp_ms) ++ goto exit; ++ ++ if (competitor->network.Rssi - mlme->cur_network_scanned->network.Rssi < mlme->roam_rssi_diff_th) ++ goto exit; ++ ++ if (*candidate != NULL && (*candidate)->network.Rssi >= competitor->network.Rssi) ++ goto exit; ++#else ++ goto exit; ++#endif ++ ++update: ++ *candidate = competitor; ++ updated = _TRUE; ++ ++exit: ++ return updated; ++} ++ ++int rtw_select_roaming_candidate(struct mlme_priv *mlme) ++{ ++ _irqL irqL; ++ int ret = _FAIL; ++ _list *phead; ++ _adapter *adapter; ++ _queue *queue = &(mlme->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ struct wlan_network *candidate = NULL; ++ u8 bSupportAntDiv = _FALSE; ++ ++ ++ if (mlme->cur_network_scanned == NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ _enter_critical_bh(&(mlme->scanned_queue.lock), &irqL); ++ phead = get_list_head(queue); ++ adapter = (_adapter *)mlme->nic_hdl; ++ ++ mlme->pscanned = get_next(phead); ++ ++ while (!rtw_end_of_queue_search(phead, mlme->pscanned)) { ++ ++ pnetwork = LIST_CONTAINOR(mlme->pscanned, struct wlan_network, list); ++ if (pnetwork == NULL) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ mlme->pscanned = get_next(mlme->pscanned); ++ ++ if (0) ++ RTW_INFO("%s("MAC_FMT", ch%u) rssi:%d\n" ++ , pnetwork->network.Ssid.Ssid ++ , MAC_ARG(pnetwork->network.MacAddress) ++ , pnetwork->network.Configuration.DSConfig ++ , (int)pnetwork->network.Rssi); ++ ++ rtw_check_roaming_candidate(mlme, &candidate, pnetwork); ++ ++ } ++ ++ if (candidate == NULL) { ++ RTW_INFO("%s: return _FAIL(candidate == NULL)\n", __FUNCTION__); ++ ret = _FAIL; ++ goto exit; ++ } else { ++ RTW_INFO("%s: candidate: %s("MAC_FMT", ch:%u)\n", __FUNCTION__, ++ candidate->network.Ssid.Ssid, MAC_ARG(candidate->network.MacAddress), ++ candidate->network.Configuration.DSConfig); ++ ++ mlme->roam_network = candidate; ++ ++ if (_rtw_memcmp(candidate->network.MacAddress, mlme->roam_tgt_addr, ETH_ALEN) == _TRUE) ++ _rtw_memset(mlme->roam_tgt_addr, 0, ETH_ALEN); ++ } ++ ++ ret = _SUCCESS; ++exit: ++ _exit_critical_bh(&(mlme->scanned_queue.lock), &irqL); ++ ++ return ret; ++} ++#endif /* CONFIG_LAYER2_ROAMING */ ++ ++/* ++* Select a new join candidate from the original @param candidate and @param competitor ++* @return _TRUE: candidate is updated ++* @return _FALSE: candidate is not updated ++*/ ++static int rtw_check_join_candidate(struct mlme_priv *mlme ++ , struct wlan_network **candidate, struct wlan_network *competitor) ++{ ++ int updated = _FALSE; ++ _adapter *adapter = container_of(mlme, _adapter, mlmepriv); ++ ++ ++ /* check bssid, if needed */ ++ if (mlme->assoc_by_bssid == _TRUE) { ++ if (_rtw_memcmp(competitor->network.MacAddress, mlme->assoc_bssid, ETH_ALEN) == _FALSE) ++ goto exit; ++ } ++ ++ /* check ssid, if needed */ ++ if (mlme->assoc_ssid.Ssid[0] && mlme->assoc_ssid.SsidLength) { ++ if (competitor->network.Ssid.SsidLength != mlme->assoc_ssid.SsidLength ++ || _rtw_memcmp(competitor->network.Ssid.Ssid, mlme->assoc_ssid.Ssid, mlme->assoc_ssid.SsidLength) == _FALSE ++ ) ++ goto exit; ++ } ++ ++ if (rtw_is_desired_network(adapter, competitor) == _FALSE) ++ goto exit; ++ ++#ifdef CONFIG_LAYER2_ROAMING ++ if (rtw_to_roam(adapter) > 0) { ++ if (rtw_get_passing_time_ms((u32)competitor->last_scanned) >= mlme->roam_scanr_exp_ms ++ || is_same_ess(&competitor->network, &mlme->cur_network.network) == _FALSE ++ ) ++ goto exit; ++ } ++#endif ++ ++ if (*candidate == NULL || (*candidate)->network.Rssi < competitor->network.Rssi) { ++ *candidate = competitor; ++ updated = _TRUE; ++ } ++ ++ if (updated) { ++ RTW_INFO("[by_bssid:%u][assoc_ssid:%s][to_roam:%u] " ++ "new candidate: %s("MAC_FMT", ch%u) rssi:%d\n", ++ mlme->assoc_by_bssid, ++ mlme->assoc_ssid.Ssid, ++ rtw_to_roam(adapter), ++ (*candidate)->network.Ssid.Ssid, ++ MAC_ARG((*candidate)->network.MacAddress), ++ (*candidate)->network.Configuration.DSConfig, ++ (int)(*candidate)->network.Rssi ++ ); ++ } ++ ++exit: ++ return updated; ++} ++ ++/* ++Calling context: ++The caller of the sub-routine will be in critical section... ++ ++The caller must hold the following spinlock ++ ++pmlmepriv->lock ++ ++ ++*/ ++ ++int rtw_select_and_join_from_scanned_queue(struct mlme_priv *pmlmepriv) ++{ ++ _irqL irqL; ++ int ret; ++ _list *phead; ++ _adapter *adapter; ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ struct wlan_network *candidate = NULL; ++ u8 bSupportAntDiv = _FALSE; ++ ++ ++ adapter = (_adapter *)pmlmepriv->nic_hdl; ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++#ifdef CONFIG_LAYER2_ROAMING ++ if (pmlmepriv->roam_network) { ++ candidate = pmlmepriv->roam_network; ++ pmlmepriv->roam_network = NULL; ++ goto candidate_exist; ++ } ++#endif ++ ++ phead = get_list_head(queue); ++ pmlmepriv->pscanned = get_next(phead); ++ ++ while (!rtw_end_of_queue_search(phead, pmlmepriv->pscanned)) { ++ ++ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); ++ if (pnetwork == NULL) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); ++ ++ if (0) ++ RTW_INFO("%s("MAC_FMT", ch%u) rssi:%d\n" ++ , pnetwork->network.Ssid.Ssid ++ , MAC_ARG(pnetwork->network.MacAddress) ++ , pnetwork->network.Configuration.DSConfig ++ , (int)pnetwork->network.Rssi); ++ ++ rtw_check_join_candidate(pmlmepriv, &candidate, pnetwork); ++ ++ } ++ ++ if (candidate == NULL) { ++ RTW_INFO("%s: return _FAIL(candidate == NULL)\n", __FUNCTION__); ++#ifdef CONFIG_WOWLAN ++ _clr_fwstate_(pmlmepriv, _FW_LINKED | _FW_UNDER_LINKING); ++#endif ++ ret = _FAIL; ++ goto exit; ++ } else { ++ RTW_INFO("%s: candidate: %s("MAC_FMT", ch:%u)\n", __FUNCTION__, ++ candidate->network.Ssid.Ssid, MAC_ARG(candidate->network.MacAddress), ++ candidate->network.Configuration.DSConfig); ++ goto candidate_exist; ++ } ++ ++candidate_exist: ++ ++ /* check for situation of _FW_LINKED */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ RTW_INFO("%s: _FW_LINKED while ask_for_joinbss!!!\n", __FUNCTION__); ++ ++#if 0 /* for WPA/WPA2 authentication, wpa_supplicant will expect authentication from AP, it is needed to reconnect AP... */ ++ if (is_same_network(&pmlmepriv->cur_network.network, &candidate->network)) { ++ RTW_INFO("%s: _FW_LINKED and is same network, it needn't join again\n", __FUNCTION__); ++ ++ rtw_indicate_connect(adapter);/* rtw_indicate_connect again */ ++ ++ ret = 2; ++ goto exit; ++ } else ++#endif ++ { ++ rtw_disassoc_cmd(adapter, 0, _TRUE); ++ rtw_indicate_disconnect(adapter, 0, _FALSE); ++ rtw_free_assoc_resources(adapter, 0); ++ } ++ } ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ rtw_hal_get_def_var(adapter, HAL_DEF_IS_SUPPORT_ANT_DIV, &(bSupportAntDiv)); ++ if (_TRUE == bSupportAntDiv) { ++ u8 CurrentAntenna; ++ rtw_hal_get_odm_var(adapter, HAL_ODM_ANTDIV_SELECT, &(CurrentAntenna), NULL); ++ RTW_INFO("#### Opt_Ant_(%s) , cur_Ant(%s)\n", ++ (MAIN_ANT == candidate->network.PhyInfo.Optimum_antenna) ? "MAIN_ANT" : "AUX_ANT", ++ (MAIN_ANT == CurrentAntenna) ? "MAIN_ANT" : "AUX_ANT" ++ ); ++ } ++#endif ++ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); ++ ret = rtw_joinbss_cmd(adapter, candidate); ++ ++exit: ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ ++ return ret; ++} ++ ++sint rtw_set_auth(_adapter *adapter, struct security_priv *psecuritypriv) ++{ ++ struct cmd_obj *pcmd; ++ struct setauth_parm *psetauthparm; ++ struct cmd_priv *pcmdpriv = &(adapter->cmdpriv); ++ sint res = _SUCCESS; ++ ++ ++ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmd == NULL) { ++ res = _FAIL; /* try again */ ++ goto exit; ++ } ++ ++ psetauthparm = (struct setauth_parm *)rtw_zmalloc(sizeof(struct setauth_parm)); ++ if (psetauthparm == NULL) { ++ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ _rtw_memset(psetauthparm, 0, sizeof(struct setauth_parm)); ++ psetauthparm->mode = (unsigned char)psecuritypriv->dot11AuthAlgrthm; ++ ++ pcmd->cmdcode = _SetAuth_CMD_; ++ pcmd->parmbuf = (unsigned char *)psetauthparm; ++ pcmd->cmdsz = (sizeof(struct setauth_parm)); ++ pcmd->rsp = NULL; ++ pcmd->rspsz = 0; ++ ++ ++ _rtw_init_listhead(&pcmd->list); ++ ++ ++ res = rtw_enqueue_cmd(pcmdpriv, pcmd); ++ ++exit: ++ ++ ++ return res; ++ ++} ++ ++ ++sint rtw_set_key(_adapter *adapter, struct security_priv *psecuritypriv, sint keyid, u8 set_tx, bool enqueue) ++{ ++ u8 keylen; ++ struct cmd_obj *pcmd; ++ struct setkey_parm *psetkeyparm; ++ struct cmd_priv *pcmdpriv = &(adapter->cmdpriv); ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ sint res = _SUCCESS; ++ ++ ++ psetkeyparm = (struct setkey_parm *)rtw_zmalloc(sizeof(struct setkey_parm)); ++ if (psetkeyparm == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ _rtw_memset(psetkeyparm, 0, sizeof(struct setkey_parm)); ++ ++ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { ++ psetkeyparm->algorithm = (unsigned char)psecuritypriv->dot118021XGrpPrivacy; ++ } else { ++ psetkeyparm->algorithm = (u8)psecuritypriv->dot11PrivacyAlgrthm; ++ ++ } ++ psetkeyparm->keyid = (u8)keyid;/* 0~3 */ ++ psetkeyparm->set_tx = set_tx; ++ if (is_wep_enc(psetkeyparm->algorithm)) ++ adapter->securitypriv.key_mask |= BIT(psetkeyparm->keyid); ++ ++ RTW_INFO("==> rtw_set_key algorithm(%x),keyid(%x),key_mask(%x)\n", psetkeyparm->algorithm, psetkeyparm->keyid, adapter->securitypriv.key_mask); ++ ++ switch (psetkeyparm->algorithm) { ++ ++ case _WEP40_: ++ keylen = 5; ++ _rtw_memcpy(&(psetkeyparm->key[0]), &(psecuritypriv->dot11DefKey[keyid].skey[0]), keylen); ++ break; ++ case _WEP104_: ++ keylen = 13; ++ _rtw_memcpy(&(psetkeyparm->key[0]), &(psecuritypriv->dot11DefKey[keyid].skey[0]), keylen); ++ break; ++ case _TKIP_: ++ keylen = 16; ++ _rtw_memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); ++ psetkeyparm->grpkey = 1; ++ break; ++ case _AES_: ++ keylen = 16; ++ _rtw_memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); ++ psetkeyparm->grpkey = 1; ++ break; ++ default: ++ res = _FAIL; ++ rtw_mfree((unsigned char *)psetkeyparm, sizeof(struct setkey_parm)); ++ goto exit; ++ } ++ ++ ++ if (enqueue) { ++ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmd == NULL) { ++ rtw_mfree((unsigned char *)psetkeyparm, sizeof(struct setkey_parm)); ++ res = _FAIL; /* try again */ ++ goto exit; ++ } ++ ++ pcmd->cmdcode = _SetKey_CMD_; ++ pcmd->parmbuf = (u8 *)psetkeyparm; ++ pcmd->cmdsz = (sizeof(struct setkey_parm)); ++ pcmd->rsp = NULL; ++ pcmd->rspsz = 0; ++ ++ _rtw_init_listhead(&pcmd->list); ++ ++ /* _rtw_init_sema(&(pcmd->cmd_sem), 0); */ ++ ++ res = rtw_enqueue_cmd(pcmdpriv, pcmd); ++ } else { ++ setkey_hdl(adapter, (u8 *)psetkeyparm); ++ rtw_mfree((u8 *) psetkeyparm, sizeof(struct setkey_parm)); ++ } ++exit: ++ return res; ++ ++} ++ ++ ++/* adjust IEs for rtw_joinbss_cmd in WMM */ ++int rtw_restruct_wmm_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len, uint initial_out_len) ++{ ++ unsigned int ielength = 0; ++ unsigned int i, j; ++ ++ i = 12; /* after the fixed IE */ ++ while (i < in_len) { ++ ielength = initial_out_len; ++ ++ if (in_ie[i] == 0xDD && in_ie[i + 2] == 0x00 && in_ie[i + 3] == 0x50 && in_ie[i + 4] == 0xF2 && in_ie[i + 5] == 0x02 && i + 5 < in_len) { /* WMM element ID and OUI */ ++ ++ /* Append WMM IE to the last index of out_ie */ ++#if 0 ++ for (j = i; j < i + (in_ie[i + 1] + 2); j++) { ++ out_ie[ielength] = in_ie[j]; ++ ielength++; ++ } ++ out_ie[initial_out_len + 8] = 0x00; /* force the QoS Info Field to be zero */ ++#endif ++ ++ for (j = i; j < i + 9; j++) { ++ out_ie[ielength] = in_ie[j]; ++ ielength++; ++ } ++ out_ie[initial_out_len + 1] = 0x07; ++ out_ie[initial_out_len + 6] = 0x00; ++ out_ie[initial_out_len + 8] = 0x00; ++ ++ break; ++ } ++ ++ i += (in_ie[i + 1] + 2); /* to the next IE element */ ++ } ++ ++ return ielength; ++ ++} ++ ++ ++/* ++ * Ported from 8185: IsInPreAuthKeyList(). (Renamed from SecIsInPreAuthKeyList(), 2006-10-13.) ++ * Added by Annie, 2006-05-07. ++ * ++ * Search by BSSID, ++ * Return Value: ++ * -1 :if there is no pre-auth key in the table ++ * >=0 :if there is pre-auth key, and return the entry id ++ * ++ * */ ++ ++static int SecIsInPMKIDList(_adapter *Adapter, u8 *bssid) ++{ ++ struct security_priv *psecuritypriv = &Adapter->securitypriv; ++ int i = 0; ++ ++ do { ++ if ((psecuritypriv->PMKIDList[i].bUsed) && ++ (_rtw_memcmp(psecuritypriv->PMKIDList[i].Bssid, bssid, ETH_ALEN) == _TRUE)) ++ break; ++ else { ++ i++; ++ /* continue; */ ++ } ++ ++ } while (i < NUM_PMKID_CACHE); ++ ++ if (i == NUM_PMKID_CACHE) { ++ i = -1;/* Could not find. */ ++ } else { ++ /* There is one Pre-Authentication Key for the specific BSSID. */ ++ } ++ ++ return i; ++ ++} ++ ++/* ++ * Check the RSN IE length ++ * If the RSN IE length <= 20, the RSN IE didn't include the PMKID information ++ * 0-11th element in the array are the fixed IE ++ * 12th element in the array is the IE ++ * 13th element in the array is the IE length ++ * */ ++ ++static int rtw_append_pmkid(_adapter *adapter, int iEntry, u8 *ie, uint ie_len) ++{ ++ struct security_priv *sec = &adapter->securitypriv; ++ ++ if (ie[13] > 20) { ++ int i; ++ u16 pmkid_cnt = RTW_GET_LE16(ie + 14 + 20); ++ if (pmkid_cnt == 1 && _rtw_memcmp(ie + 14 + 20 + 2, &sec->PMKIDList[iEntry].PMKID, 16)) { ++ RTW_INFO(FUNC_ADPT_FMT" has carried the same PMKID:"KEY_FMT"\n" ++ , FUNC_ADPT_ARG(adapter), KEY_ARG(&sec->PMKIDList[iEntry].PMKID)); ++ goto exit; ++ } ++ ++ RTW_INFO(FUNC_ADPT_FMT" remove original PMKID, count:%u\n" ++ , FUNC_ADPT_ARG(adapter), pmkid_cnt); ++ ++ for (i = 0; i < pmkid_cnt; i++) ++ RTW_INFO(" "KEY_FMT"\n", KEY_ARG(ie + 14 + 20 + 2 + i * 16)); ++ ++ ie_len -= 2 + pmkid_cnt * 16; ++ ie[13] = 20; ++ } ++ ++ if (ie[13] <= 20) { ++ /* The RSN IE didn't include the PMK ID, append the PMK information */ ++ ++ RTW_INFO(FUNC_ADPT_FMT" append PMKID:"KEY_FMT"\n" ++ , FUNC_ADPT_ARG(adapter), KEY_ARG(&sec->PMKIDList[iEntry].PMKID)); ++ ++ RTW_PUT_LE16(&ie[ie_len], 1); ++ ie_len += 2; ++ ++ _rtw_memcpy(&ie[ie_len], &sec->PMKIDList[iEntry].PMKID, 16); ++ ie_len += 16; ++ ++ ie[13] += 18;/* PMKID length = 2+16 */ ++ } ++ ++exit: ++ return ie_len; ++} ++ ++static int rtw_remove_pmkid(_adapter *adapter, u8 *ie, uint ie_len) ++{ ++ struct security_priv *sec = &adapter->securitypriv; ++ int i; ++ u16 pmkid_cnt = RTW_GET_LE16(ie + 14 + 20); ++ ++ if (ie[13] <= 20) ++ goto exit; ++ ++ RTW_INFO(FUNC_ADPT_FMT" remove original PMKID, count:%u\n" ++ , FUNC_ADPT_ARG(adapter), pmkid_cnt); ++ ++ for (i = 0; i < pmkid_cnt; i++) ++ RTW_INFO(" "KEY_FMT"\n", KEY_ARG(ie + 14 + 20 + 2 + i * 16)); ++ ++ ie_len -= 2 + pmkid_cnt * 16; ++ ie[13] = 20; ++ ++exit: ++ return ie_len; ++} ++ ++sint rtw_restruct_sec_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len) ++{ ++ u8 authmode = 0x0, securitytype, match; ++ u8 sec_ie[255], uncst_oui[4], bkup_ie[255]; ++ u8 wpa_oui[4] = {0x0, 0x50, 0xf2, 0x01}; ++ uint ielength, cnt, remove_cnt; ++ int iEntry; ++ ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct security_priv *psecuritypriv = &adapter->securitypriv; ++ uint ndisauthmode = psecuritypriv->ndisauthtype; ++ uint ndissecuritytype = psecuritypriv->ndisencryptstatus; ++ ++ ++ ++ /* copy fixed ie only */ ++ _rtw_memcpy(out_ie, in_ie, 12); ++ ielength = 12; ++ if ((ndisauthmode == Ndis802_11AuthModeWPA) || (ndisauthmode == Ndis802_11AuthModeWPAPSK)) ++ authmode = _WPA_IE_ID_; ++ if ((ndisauthmode == Ndis802_11AuthModeWPA2) || (ndisauthmode == Ndis802_11AuthModeWPA2PSK)) ++ authmode = _WPA2_IE_ID_; ++ ++ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { ++ _rtw_memcpy(out_ie + ielength, psecuritypriv->wps_ie, psecuritypriv->wps_ie_len); ++ ++ ielength += psecuritypriv->wps_ie_len; ++ } else if ((authmode == _WPA_IE_ID_) || (authmode == _WPA2_IE_ID_)) { ++ /* copy RSN or SSN */ ++ _rtw_memcpy(&out_ie[ielength], &psecuritypriv->supplicant_ie[0], psecuritypriv->supplicant_ie[1] + 2); ++ /* debug for CONFIG_IEEE80211W ++ { ++ int jj; ++ printk("supplicant_ie_length=%d &&&&&&&&&&&&&&&&&&&\n", psecuritypriv->supplicant_ie[1]+2); ++ for(jj=0; jj < psecuritypriv->supplicant_ie[1]+2; jj++) ++ printk(" %02x ", psecuritypriv->supplicant_ie[jj]); ++ printk("\n"); ++ }*/ ++ ielength += psecuritypriv->supplicant_ie[1] + 2; ++ rtw_report_sec_ie(adapter, authmode, psecuritypriv->supplicant_ie); ++ ++#ifdef CONFIG_DRVEXT_MODULE ++ drvext_report_sec_ie(&adapter->drvextpriv, authmode, sec_ie); ++#endif ++ } ++ ++ iEntry = SecIsInPMKIDList(adapter, pmlmepriv->assoc_bssid); ++ if (iEntry < 0) { ++ if (authmode == _WPA2_IE_ID_) ++ ielength = rtw_remove_pmkid(adapter, out_ie, ielength); ++ } else { ++ if (authmode == _WPA2_IE_ID_) ++ ielength = rtw_append_pmkid(adapter, iEntry, out_ie, ielength); ++ } ++ ++ ++ return ielength; ++} ++ ++void rtw_init_registrypriv_dev_network(_adapter *adapter) ++{ ++ struct registry_priv *pregistrypriv = &adapter->registrypriv; ++ WLAN_BSSID_EX *pdev_network = &pregistrypriv->dev_network; ++ u8 *myhwaddr = adapter_mac_addr(adapter); ++ ++ ++ _rtw_memcpy(pdev_network->MacAddress, myhwaddr, ETH_ALEN); ++ ++ _rtw_memcpy(&pdev_network->Ssid, &pregistrypriv->ssid, sizeof(NDIS_802_11_SSID)); ++ ++ pdev_network->Configuration.Length = sizeof(NDIS_802_11_CONFIGURATION); ++ pdev_network->Configuration.BeaconPeriod = 100; ++ pdev_network->Configuration.FHConfig.Length = 0; ++ pdev_network->Configuration.FHConfig.HopPattern = 0; ++ pdev_network->Configuration.FHConfig.HopSet = 0; ++ pdev_network->Configuration.FHConfig.DwellTime = 0; ++ ++ ++ ++} ++ ++void rtw_update_registrypriv_dev_network(_adapter *adapter) ++{ ++ int sz = 0; ++ struct registry_priv *pregistrypriv = &adapter->registrypriv; ++ WLAN_BSSID_EX *pdev_network = &pregistrypriv->dev_network; ++ struct security_priv *psecuritypriv = &adapter->securitypriv; ++ struct wlan_network *cur_network = &adapter->mlmepriv.cur_network; ++ /* struct xmit_priv *pxmitpriv = &adapter->xmitpriv; */ ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ ++ ++#if 0 ++ pxmitpriv->vcs_setting = pregistrypriv->vrtl_carrier_sense; ++ pxmitpriv->vcs = pregistrypriv->vcs_type; ++ pxmitpriv->vcs_type = pregistrypriv->vcs_type; ++ /* pxmitpriv->rts_thresh = pregistrypriv->rts_thresh; */ ++ pxmitpriv->frag_len = pregistrypriv->frag_thresh; ++ ++ adapter->qospriv.qos_option = pregistrypriv->wmm_enable; ++#endif ++ ++ pdev_network->Privacy = (psecuritypriv->dot11PrivacyAlgrthm > 0 ? 1 : 0) ; /* adhoc no 802.1x */ ++ ++ pdev_network->Rssi = 0; ++ ++ switch (pregistrypriv->wireless_mode) { ++ case WIRELESS_11B: ++ pdev_network->NetworkTypeInUse = (Ndis802_11DS); ++ break; ++ case WIRELESS_11G: ++ case WIRELESS_11BG: ++ case WIRELESS_11_24N: ++ case WIRELESS_11G_24N: ++ case WIRELESS_11BG_24N: ++ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM24); ++ break; ++ case WIRELESS_11A: ++ case WIRELESS_11A_5N: ++ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM5); ++ break; ++ case WIRELESS_11ABGN: ++ if (pregistrypriv->channel > 14) ++ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM5); ++ else ++ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM24); ++ break; ++ default: ++ /* TODO */ ++ break; ++ } ++ ++ pdev_network->Configuration.DSConfig = (pregistrypriv->channel); ++ ++ if (cur_network->network.InfrastructureMode == Ndis802_11IBSS) { ++ pdev_network->Configuration.ATIMWindow = (0); ++ ++ if (pmlmeext->cur_channel != 0) ++ pdev_network->Configuration.DSConfig = pmlmeext->cur_channel; ++ else ++ pdev_network->Configuration.DSConfig = 1; ++ } ++ ++ pdev_network->InfrastructureMode = (cur_network->network.InfrastructureMode); ++ ++ /* 1. Supported rates */ ++ /* 2. IE */ ++ ++ /* rtw_set_supported_rate(pdev_network->SupportedRates, pregistrypriv->wireless_mode) ; */ /* will be called in rtw_generate_ie */ ++ sz = rtw_generate_ie(pregistrypriv); ++ ++ pdev_network->IELength = sz; ++ ++ pdev_network->Length = get_WLAN_BSSID_EX_sz((WLAN_BSSID_EX *)pdev_network); ++ ++ /* notes: translate IELength & Length after assign the Length to cmdsz in createbss_cmd(); */ ++ /* pdev_network->IELength = cpu_to_le32(sz); */ ++ ++ ++} ++ ++void rtw_get_encrypt_decrypt_from_registrypriv(_adapter *adapter) ++{ ++ ++ ++ ++} ++ ++/* the fucntion is at passive_level */ ++void rtw_joinbss_reset(_adapter *padapter) ++{ ++ u8 threshold; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ /* todo: if you want to do something io/reg/hw setting before join_bss, please add code here */ ++ ++#ifdef CONFIG_80211N_HT ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++ ++ pmlmepriv->num_FortyMHzIntolerant = 0; ++ ++ pmlmepriv->num_sta_no_ht = 0; ++ ++ phtpriv->ampdu_enable = _FALSE;/* reset to disabled */ ++ ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) ++ /* TH=1 => means that invalidate usb rx aggregation */ ++ /* TH=0 => means that validate usb rx aggregation, use init value. */ ++ if (phtpriv->ht_option) { ++ if (padapter->registrypriv.wifi_spec == 1) ++ threshold = 1; ++ else ++ threshold = 0; ++ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); ++ } else { ++ threshold = 1; ++ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); ++ } ++#endif/* #if defined( CONFIG_USB_HCI) || defined (CONFIG_SDIO_HCI) */ ++ ++#endif/* #ifdef CONFIG_80211N_HT */ ++ ++} ++ ++ ++#ifdef CONFIG_80211N_HT ++void rtw_ht_use_default_setting(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ BOOLEAN bHwLDPCSupport = _FALSE, bHwSTBCSupport = _FALSE; ++#ifdef CONFIG_BEAMFORMING ++ BOOLEAN bHwSupportBeamformer = _FALSE, bHwSupportBeamformee = _FALSE; ++#endif /* CONFIG_BEAMFORMING */ ++ ++ if (pregistrypriv->wifi_spec) ++ phtpriv->bss_coexist = 1; ++ else ++ phtpriv->bss_coexist = 0; ++ ++ phtpriv->sgi_40m = TEST_FLAG(pregistrypriv->short_gi, BIT1) ? _TRUE : _FALSE; ++ phtpriv->sgi_20m = TEST_FLAG(pregistrypriv->short_gi, BIT0) ? _TRUE : _FALSE; ++ ++ /* LDPC support */ ++ rtw_hal_get_def_var(padapter, HAL_DEF_RX_LDPC, (u8 *)&bHwLDPCSupport); ++ CLEAR_FLAGS(phtpriv->ldpc_cap); ++ if (bHwLDPCSupport) { ++ if (TEST_FLAG(pregistrypriv->ldpc_cap, BIT4)) ++ SET_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_RX); ++ } ++ rtw_hal_get_def_var(padapter, HAL_DEF_TX_LDPC, (u8 *)&bHwLDPCSupport); ++ if (bHwLDPCSupport) { ++ if (TEST_FLAG(pregistrypriv->ldpc_cap, BIT5)) ++ SET_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX); ++ } ++ if (phtpriv->ldpc_cap) ++ RTW_INFO("[HT] HAL Support LDPC = 0x%02X\n", phtpriv->ldpc_cap); ++ ++ /* STBC */ ++ rtw_hal_get_def_var(padapter, HAL_DEF_TX_STBC, (u8 *)&bHwSTBCSupport); ++ CLEAR_FLAGS(phtpriv->stbc_cap); ++ if (bHwSTBCSupport) { ++ if (TEST_FLAG(pregistrypriv->stbc_cap, BIT5)) ++ SET_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX); ++ } ++ rtw_hal_get_def_var(padapter, HAL_DEF_RX_STBC, (u8 *)&bHwSTBCSupport); ++ if (bHwSTBCSupport) { ++ if (TEST_FLAG(pregistrypriv->stbc_cap, BIT4)) ++ SET_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX); ++ } ++ if (phtpriv->stbc_cap) ++ RTW_INFO("[HT] HAL Support STBC = 0x%02X\n", phtpriv->stbc_cap); ++ ++ /* Beamforming setting */ ++ CLEAR_FLAGS(phtpriv->beamform_cap); ++#ifdef CONFIG_BEAMFORMING ++ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMER, (u8 *)&bHwSupportBeamformer); ++ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMEE, (u8 *)&bHwSupportBeamformee); ++ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT4) && bHwSupportBeamformer) { ++ SET_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); ++ RTW_INFO("[HT] HAL Support Beamformer\n"); ++ } ++ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT5) && bHwSupportBeamformee) { ++ SET_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); ++ RTW_INFO("[HT] HAL Support Beamformee\n"); ++ } ++#endif /* CONFIG_BEAMFORMING */ ++} ++void rtw_build_wmm_ie_ht(_adapter *padapter, u8 *out_ie, uint *pout_len) ++{ ++ unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01, 0x00}; ++ int out_len; ++ u8 *pframe; ++ ++ if (padapter->mlmepriv.qospriv.qos_option == 0) { ++ out_len = *pout_len; ++ pframe = rtw_set_ie(out_ie + out_len, _VENDOR_SPECIFIC_IE_, ++ _WMM_IE_Length_, WMM_IE, pout_len); ++ ++ padapter->mlmepriv.qospriv.qos_option = 1; ++ } ++} ++ ++/* the fucntion is >= passive_level */ ++unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len, u8 channel) ++{ ++ u32 ielen, out_len; ++ u32 rx_packet_offset, max_recvbuf_sz; ++ HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor; ++ HT_CAP_AMPDU_DENSITY best_ampdu_density; ++ unsigned char *p, *pframe; ++ struct rtw_ieee80211_ht_cap ht_capie; ++ u8 cbw40_enable = 0, rf_type = 0, operation_bw = 0, rf_num = 0, rx_stbc_nss = 0; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ phtpriv->ht_option = _FALSE; ++ ++ out_len = *pout_len; ++ ++ _rtw_memset(&ht_capie, 0, sizeof(struct rtw_ieee80211_ht_cap)); ++ ++ ht_capie.cap_info = IEEE80211_HT_CAP_DSSSCCK40; ++ ++ if (phtpriv->sgi_20m) ++ ht_capie.cap_info |= IEEE80211_HT_CAP_SGI_20; ++ ++ /* Get HT BW */ ++ if (in_ie == NULL) { ++ /* TDLS: TODO 20/40 issue */ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { ++ operation_bw = padapter->mlmeextpriv.cur_bwmode; ++ if (operation_bw > CHANNEL_WIDTH_40) ++ operation_bw = CHANNEL_WIDTH_40; ++ } else ++ /* TDLS: TODO 40? */ ++ operation_bw = CHANNEL_WIDTH_40; ++ } else { ++ p = rtw_get_ie(in_ie, _HT_ADD_INFO_IE_, &ielen, in_len); ++ if (p && (ielen == sizeof(struct ieee80211_ht_addt_info))) { ++ struct HT_info_element *pht_info = (struct HT_info_element *)(p + 2); ++ if (pht_info->infos[0] & BIT(2)) { ++ switch (pht_info->infos[0] & 0x3) { ++ case 1: ++ case 3: ++ operation_bw = CHANNEL_WIDTH_40; ++ break; ++ default: ++ operation_bw = CHANNEL_WIDTH_20; ++ break; ++ } ++ } else ++ operation_bw = CHANNEL_WIDTH_20; ++ } ++ } ++ ++ /* to disable 40M Hz support while gd_bw_40MHz_en = 0 */ ++ if (hal_chk_bw_cap(padapter, BW_CAP_40M)) { ++ if (channel > 14) { ++ if (REGSTY_IS_BW_5G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) ++ cbw40_enable = 1; ++ } else { ++ if (REGSTY_IS_BW_2G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) ++ cbw40_enable = 1; ++ } ++ } ++ ++ if ((cbw40_enable == 1) && (operation_bw == CHANNEL_WIDTH_40)) { ++ ht_capie.cap_info |= IEEE80211_HT_CAP_SUP_WIDTH; ++ if (phtpriv->sgi_40m) ++ ht_capie.cap_info |= IEEE80211_HT_CAP_SGI_40; ++ } ++ ++ /* todo: disable SM power save mode */ ++ ht_capie.cap_info |= IEEE80211_HT_CAP_SM_PS; ++ ++ /* RX LDPC */ ++ if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_RX)) { ++ ht_capie.cap_info |= IEEE80211_HT_CAP_LDPC_CODING; ++ RTW_INFO("[HT] Declare supporting RX LDPC\n"); ++ } ++ ++ /* TX STBC */ ++ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX)) { ++ ht_capie.cap_info |= IEEE80211_HT_CAP_TX_STBC; ++ RTW_INFO("[HT] Declare supporting TX STBC\n"); ++ } ++ ++ /* RX STBC */ ++ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX)) { ++ if ((pregistrypriv->rx_stbc == 0x3) || /* enable for 2.4/5 GHz */ ++ ((channel <= 14) && (pregistrypriv->rx_stbc == 0x1)) || /* enable for 2.4GHz */ ++ ((channel > 14) && (pregistrypriv->rx_stbc == 0x2)) || /* enable for 5GHz */ ++ (pregistrypriv->wifi_spec == 1)) { ++ /* HAL_DEF_RX_STBC means STBC RX spatial stream, todo: VHT 4 streams */ ++ rtw_hal_get_def_var(padapter, HAL_DEF_RX_STBC, (u8 *)(&rx_stbc_nss)); ++ SET_HT_CAP_ELE_RX_STBC(&ht_capie, rx_stbc_nss); ++ RTW_INFO("[HT] Declare supporting RX STBC = %d\n", rx_stbc_nss); ++ } ++ } ++ ++ /* fill default supported_mcs_set */ ++ _rtw_memcpy(ht_capie.supp_mcs_set, pmlmeext->default_supported_mcs_set, 16); ++ ++ /* update default supported_mcs_set */ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ switch (rf_type) { ++ case RF_1T1R: ++ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_1R); ++ break; ++ ++ case RF_2T2R: ++ case RF_1T2R: ++#ifdef CONFIG_DISABLE_MCS13TO15 ++ if (((cbw40_enable == 1) && (operation_bw == CHANNEL_WIDTH_40)) && (pregistrypriv->wifi_spec != 1)) ++ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R_13TO15_OFF); ++ else ++ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R); ++#else /* CONFIG_DISABLE_MCS13TO15 */ ++ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R); ++#endif /* CONFIG_DISABLE_MCS13TO15 */ ++ break; ++ case RF_3T3R: ++ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_3R); ++ break; ++ default: ++ RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); ++ } ++ ++ { ++ rtw_hal_get_def_var(padapter, HAL_DEF_RX_PACKET_OFFSET, &rx_packet_offset); ++ rtw_hal_get_def_var(padapter, HAL_DEF_MAX_RECVBUF_SZ, &max_recvbuf_sz); ++ if (max_recvbuf_sz - rx_packet_offset >= (8191 - 256)) { ++ RTW_INFO("%s IEEE80211_HT_CAP_MAX_AMSDU is set\n", __FUNCTION__); ++ ht_capie.cap_info = ht_capie.cap_info | IEEE80211_HT_CAP_MAX_AMSDU; ++ } ++ } ++ /* ++ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k ++ AMPDU_para [4:2]:Min MPDU Start Spacing ++ */ ++ ++ /* ++ #if defined(CONFIG_RTL8188E) && defined(CONFIG_SDIO_HCI) ++ ht_capie.ampdu_params_info = 2; ++ #else ++ ht_capie.ampdu_params_info = (IEEE80211_HT_CAP_AMPDU_FACTOR&0x03); ++ #endif ++ */ ++ ++ if (padapter->driver_rx_ampdu_factor != 0xFF) ++ max_rx_ampdu_factor = (HT_CAP_AMPDU_FACTOR)padapter->driver_rx_ampdu_factor; ++ else ++ rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); ++ ++ /* rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); */ ++ ht_capie.ampdu_params_info = (max_rx_ampdu_factor & 0x03); ++ ++ if (padapter->driver_rx_ampdu_spacing != 0xFF) ++ ht_capie.ampdu_params_info |= ((padapter->driver_rx_ampdu_spacing & 0x07) << 2); ++ else { ++ if (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) { ++ /* ++ * Todo : Each chip must to ask DD , this chip best ampdu_density setting ++ * By yiwei.sun ++ */ ++ rtw_hal_get_def_var(padapter, HW_VAR_BEST_AMPDU_DENSITY, &best_ampdu_density); ++ ++ ht_capie.ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & (best_ampdu_density << 2)); ++ ++ } else ++ ht_capie.ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & 0x00); ++ } ++#ifdef CONFIG_BEAMFORMING ++ ht_capie.tx_BF_cap_info = 0; ++ ++ /* HT Beamformer*/ ++ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { ++ /* Transmit NDP Capable */ ++ SET_HT_CAP_TXBF_TRANSMIT_NDP_CAP(&ht_capie, 1); ++ /* Explicit Compressed Steering Capable */ ++ SET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(&ht_capie, 1); ++ /* Compressed Steering Number Antennas */ ++ SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(&ht_capie, 1); ++ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMER_CAP, (u8 *)&rf_num); ++ SET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(&ht_capie, rf_num); ++ } ++ ++ /* HT Beamformee */ ++ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) { ++ /* Receive NDP Capable */ ++ SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(&ht_capie, 1); ++ /* Explicit Compressed Beamforming Feedback Capable */ ++ SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(&ht_capie, 2); ++ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); ++ SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(&ht_capie, rf_num); ++ } ++#endif/*CONFIG_BEAMFORMING*/ ++ ++ pframe = rtw_set_ie(out_ie + out_len, _HT_CAPABILITY_IE_, ++ sizeof(struct rtw_ieee80211_ht_cap), (unsigned char *)&ht_capie, pout_len); ++ ++ phtpriv->ht_option = _TRUE; ++ ++ if (in_ie != NULL) { ++ p = rtw_get_ie(in_ie, _HT_ADD_INFO_IE_, &ielen, in_len); ++ if (p && (ielen == sizeof(struct ieee80211_ht_addt_info))) { ++ out_len = *pout_len; ++ pframe = rtw_set_ie(out_ie + out_len, _HT_ADD_INFO_IE_, ielen, p + 2 , pout_len); ++ } ++ } ++ ++ return phtpriv->ht_option; ++ ++} ++ ++/* the fucntion is > passive_level (in critical_section) */ ++void rtw_update_ht_cap(_adapter *padapter, u8 *pie, uint ie_len, u8 channel) ++{ ++ u8 *p, max_ampdu_sz; ++ int len; ++ /* struct sta_info *bmc_sta, *psta; */ ++ struct rtw_ieee80211_ht_cap *pht_capie; ++ struct ieee80211_ht_addt_info *pht_addtinfo; ++ /* struct recv_reorder_ctrl *preorder_ctrl; */ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++ /* struct recv_priv *precvpriv = &padapter->recvpriv; */ ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ /* struct wlan_network *pcur_network = &(pmlmepriv->cur_network);; */ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 cbw40_enable = 0; ++ ++ ++ if (!phtpriv->ht_option) ++ return; ++ ++ if ((!pmlmeinfo->HT_info_enable) || (!pmlmeinfo->HT_caps_enable)) ++ return; ++ ++ RTW_INFO("+rtw_update_ht_cap()\n"); ++ ++ /* maybe needs check if ap supports rx ampdu. */ ++ if ((phtpriv->ampdu_enable == _FALSE) && (pregistrypriv->ampdu_enable == 1)) { ++ if (pregistrypriv->wifi_spec == 1) { ++ /* remove this part because testbed AP should disable RX AMPDU */ ++ /* phtpriv->ampdu_enable = _FALSE; */ ++ phtpriv->ampdu_enable = _TRUE; ++ } else ++ phtpriv->ampdu_enable = _TRUE; ++ } ++ ++ ++ /* check Max Rx A-MPDU Size */ ++ len = 0; ++ p = rtw_get_ie(pie + sizeof(NDIS_802_11_FIXED_IEs), _HT_CAPABILITY_IE_, &len, ie_len - sizeof(NDIS_802_11_FIXED_IEs)); ++ if (p && len > 0) { ++ pht_capie = (struct rtw_ieee80211_ht_cap *)(p + 2); ++ max_ampdu_sz = (pht_capie->ampdu_params_info & IEEE80211_HT_CAP_AMPDU_FACTOR); ++ max_ampdu_sz = 1 << (max_ampdu_sz + 3); /* max_ampdu_sz (kbytes); */ ++ ++ /* RTW_INFO("rtw_update_ht_cap(): max_ampdu_sz=%d\n", max_ampdu_sz); */ ++ phtpriv->rx_ampdu_maxlen = max_ampdu_sz; ++ ++ } ++ ++ ++ len = 0; ++ p = rtw_get_ie(pie + sizeof(NDIS_802_11_FIXED_IEs), _HT_ADD_INFO_IE_, &len, ie_len - sizeof(NDIS_802_11_FIXED_IEs)); ++ if (p && len > 0) { ++ pht_addtinfo = (struct ieee80211_ht_addt_info *)(p + 2); ++ /* todo: */ ++ } ++ ++ if (hal_chk_bw_cap(padapter, BW_CAP_40M)) { ++ if (channel > 14) { ++ if (REGSTY_IS_BW_5G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) ++ cbw40_enable = 1; ++ } else { ++ if (REGSTY_IS_BW_2G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) ++ cbw40_enable = 1; ++ } ++ } ++ ++ /* update cur_bwmode & cur_ch_offset */ ++ if ((cbw40_enable) && ++ (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & BIT(1)) && ++ (pmlmeinfo->HT_info.infos[0] & BIT(2))) { ++ int i; ++ u8 rf_type = RF_1T1R; ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ /* update the MCS set */ ++ for (i = 0; i < 16; i++) ++ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= pmlmeext->default_supported_mcs_set[i]; ++ ++ /* update the MCS rates */ ++ switch (rf_type) { ++ case RF_1T1R: ++ case RF_1T2R: ++ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_1R); ++ break; ++ case RF_2T2R: ++#ifdef CONFIG_DISABLE_MCS13TO15 ++ if (pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && pregistrypriv->wifi_spec != 1) ++ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R_13TO15_OFF); ++ else ++ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); ++#else /* CONFIG_DISABLE_MCS13TO15 */ ++ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); ++#endif /* CONFIG_DISABLE_MCS13TO15 */ ++ break; ++ case RF_3T3R: ++ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_3R); ++ break; ++ default: ++ RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); ++ } ++ ++ /* switch to the 40M Hz mode accoring to the AP */ ++ /* pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; */ ++ switch ((pmlmeinfo->HT_info.infos[0] & 0x3)) { ++ case EXTCHNL_OFFSET_UPPER: ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ break; ++ ++ case EXTCHNL_OFFSET_LOWER: ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ ++ default: ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ } ++ } ++ ++ /* */ ++ /* Config SM Power Save setting */ ++ /* */ ++ pmlmeinfo->SM_PS = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & 0x0C) >> 2; ++ if (pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC) { ++#if 0 ++ u8 i; ++ /* update the MCS rates */ ++ for (i = 0; i < 16; i++) ++ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; ++#endif ++ RTW_INFO("%s(): WLAN_HT_CAP_SM_PS_STATIC\n", __FUNCTION__); ++ } ++ ++ /* */ ++ /* Config current HT Protection mode. */ ++ /* */ ++ pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; ++ ++ ++ ++#if 0 /* move to rtw_update_sta_info_client() */ ++ /* for A-MPDU Rx reordering buffer control for bmc_sta & sta_info */ ++ /* if A-MPDU Rx is enabled, reseting rx_ordering_ctrl wstart_b(indicate_seq) to default value=0xffff */ ++ /* todo: check if AP can send A-MPDU packets */ ++ bmc_sta = rtw_get_bcmc_stainfo(padapter); ++ if (bmc_sta) { ++ for (i = 0; i < 16 ; i++) { ++ /* preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; */ ++ preorder_ctrl = &bmc_sta->recvreorder_ctrl[i]; ++ preorder_ctrl->enable = _FALSE; ++ preorder_ctrl->indicate_seq = 0xffff; ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq); ++#endif ++ preorder_ctrl->wend_b = 0xffff; ++ preorder_ctrl->wsize_b = 64;/* max_ampdu_sz; */ /* ex. 32(kbytes) -> wsize_b=32 */ ++ } ++ } ++ ++ psta = rtw_get_stainfo(&padapter->stapriv, pcur_network->network.MacAddress); ++ if (psta) { ++ for (i = 0; i < 16 ; i++) { ++ /* preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; */ ++ preorder_ctrl = &psta->recvreorder_ctrl[i]; ++ preorder_ctrl->enable = _FALSE; ++ preorder_ctrl->indicate_seq = 0xffff; ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq); ++#endif ++ preorder_ctrl->wend_b = 0xffff; ++ preorder_ctrl->wsize_b = 64;/* max_ampdu_sz; */ /* ex. 32(kbytes) -> wsize_b=32 */ ++ } ++ } ++#endif ++ ++} ++ ++#ifdef CONFIG_TDLS ++void rtw_issue_addbareq_cmd_tdls(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct sta_info *ptdls_sta = NULL; ++ u8 issued; ++ int priority; ++ struct ht_priv *phtpriv; ++ ++ priority = pattrib->priority; ++ ++ if (pattrib->direct_link == _TRUE) { ++ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); ++ if ((ptdls_sta != NULL) && (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) { ++ phtpriv = &ptdls_sta->htpriv; ++ ++ if ((phtpriv->ht_option == _TRUE) && (phtpriv->ampdu_enable == _TRUE)) { ++ issued = (phtpriv->agg_enable_bitmap >> priority) & 0x1; ++ issued |= (phtpriv->candidate_tid_bitmap >> priority) & 0x1; ++ ++ if (0 == issued) { ++ RTW_INFO("[%s], p=%d\n", __FUNCTION__, priority); ++ ptdls_sta->htpriv.candidate_tid_bitmap |= BIT((u8)priority); ++ rtw_addbareq_cmd(padapter, (u8)priority, pattrib->dst); ++ } ++ } ++ } ++ } ++} ++#endif /* CONFIG_TDLS */ ++ ++void rtw_issue_addbareq_cmd(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ u8 issued; ++ int priority; ++ struct sta_info *psta = NULL; ++ struct ht_priv *phtpriv; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ s32 bmcst = IS_MCAST(pattrib->ra); ++ ++ /* if(bmcst || (padapter->mlmepriv.LinkDetectInfo.bTxBusyTraffic == _FALSE)) */ ++ if (bmcst || (padapter->mlmepriv.LinkDetectInfo.NumTxOkInPeriod < 100)) ++ return; ++ ++ priority = pattrib->priority; ++ ++#ifdef CONFIG_TDLS ++ rtw_issue_addbareq_cmd_tdls(padapter, pxmitframe); ++#endif /* CONFIG_TDLS */ ++ ++ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); ++ if (pattrib->psta != psta) { ++ RTW_INFO("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); ++ return; ++ } ++ ++ if (psta == NULL) { ++ RTW_INFO("%s, psta==NUL\n", __func__); ++ return; ++ } ++ ++ if (!(psta->state & _FW_LINKED)) { ++ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); ++ return; ++ } ++ ++ ++ phtpriv = &psta->htpriv; ++ ++ if ((phtpriv->ht_option == _TRUE) && (phtpriv->ampdu_enable == _TRUE)) { ++ issued = (phtpriv->agg_enable_bitmap >> priority) & 0x1; ++ issued |= (phtpriv->candidate_tid_bitmap >> priority) & 0x1; ++ ++ if (0 == issued) { ++ RTW_INFO("rtw_issue_addbareq_cmd, p=%d\n", priority); ++ psta->htpriv.candidate_tid_bitmap |= BIT((u8)priority); ++ rtw_addbareq_cmd(padapter, (u8) priority, pattrib->ra); ++ } ++ } ++ ++} ++ ++void rtw_append_exented_cap(_adapter *padapter, u8 *out_ie, uint *pout_len) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++#ifdef CONFIG_80211AC_VHT ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++#endif /* CONFIG_80211AC_VHT */ ++ u8 cap_content[8] = { 0 }; ++ u8 *pframe; ++ u8 null_content[8] = {0}; ++ ++ if (phtpriv->bss_coexist) ++ SET_EXT_CAPABILITY_ELE_BSS_COEXIST(cap_content, 1); ++ ++#ifdef CONFIG_80211AC_VHT ++ if (pvhtpriv->vht_option) ++ SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(cap_content, 1); ++#endif /* CONFIG_80211AC_VHT */ ++ /* ++ From 802.11 specification,if a STA does not support any of capabilities defined ++ in the Extended Capabilities element, then the STA is not required to ++ transmit the Extended Capabilities element. ++ */ ++ if (_FALSE == _rtw_memcmp(cap_content, null_content, 8)) ++ pframe = rtw_set_ie(out_ie + *pout_len, EID_EXTCapability, 8, cap_content , pout_len); ++} ++#endif ++ ++#ifdef CONFIG_LAYER2_ROAMING ++inline void rtw_set_to_roam(_adapter *adapter, u8 to_roam) ++{ ++ if (to_roam == 0) ++ adapter->mlmepriv.to_join = _FALSE; ++ adapter->mlmepriv.to_roam = to_roam; ++} ++ ++inline u8 rtw_dec_to_roam(_adapter *adapter) ++{ ++ adapter->mlmepriv.to_roam--; ++ return adapter->mlmepriv.to_roam; ++} ++ ++inline u8 rtw_to_roam(_adapter *adapter) ++{ ++ return adapter->mlmepriv.to_roam; ++} ++ ++void rtw_roaming(_adapter *padapter, struct wlan_network *tgt_network) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ _rtw_roaming(padapter, tgt_network); ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++} ++void _rtw_roaming(_adapter *padapter, struct wlan_network *tgt_network) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wlan_network *cur_network = &pmlmepriv->cur_network; ++ int do_join_r; ++ ++ if (0 < rtw_to_roam(padapter)) { ++ RTW_INFO("roaming from %s("MAC_FMT"), length:%d\n", ++ cur_network->network.Ssid.Ssid, MAC_ARG(cur_network->network.MacAddress), ++ cur_network->network.Ssid.SsidLength); ++ _rtw_memcpy(&pmlmepriv->assoc_ssid, &cur_network->network.Ssid, sizeof(NDIS_802_11_SSID)); ++ ++ pmlmepriv->assoc_by_bssid = _FALSE; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ rtw_wapi_return_all_sta_info(padapter); ++#endif ++ ++ while (1) { ++ do_join_r = rtw_do_join(padapter); ++ if (_SUCCESS == do_join_r) ++ break; ++ else { ++ RTW_INFO("roaming do_join return %d\n", do_join_r); ++ rtw_dec_to_roam(padapter); ++ ++ if (rtw_to_roam(padapter) > 0) ++ continue; ++ else { ++ RTW_INFO("%s(%d) -to roaming fail, indicate_disconnect\n", __FUNCTION__, __LINE__); ++#ifdef CONFIG_RTW_80211R ++ rtw_clr_ft_flags(padapter, RTW_FT_SUPPORTED|RTW_FT_OVER_DS_SUPPORTED); ++ rtw_reset_ft_status(padapter); ++#endif ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ break; ++ } ++ } ++ } ++ } ++ ++} ++#endif /* CONFIG_LAYER2_ROAMING */ ++ ++#ifdef CONFIG_80211N_HT ++bool rtw_adjust_chbw(_adapter *adapter, u8 req_ch, u8 *req_bw, u8 *req_offset) ++{ ++ struct registry_priv *regsty = adapter_to_regsty(adapter); ++ u8 allowed_bw; ++ ++ if (req_ch <= 14) ++ allowed_bw = REGSTY_BW_2G(regsty); ++ else ++ allowed_bw = REGSTY_BW_5G(regsty); ++ ++ allowed_bw = hal_largest_bw(adapter, allowed_bw); ++ ++ if (allowed_bw == CHANNEL_WIDTH_80 && *req_bw > CHANNEL_WIDTH_80) ++ *req_bw = CHANNEL_WIDTH_80; ++ else if (allowed_bw == CHANNEL_WIDTH_40 && *req_bw > CHANNEL_WIDTH_40) ++ *req_bw = CHANNEL_WIDTH_40; ++ else if (allowed_bw == CHANNEL_WIDTH_20 && *req_bw > CHANNEL_WIDTH_20) { ++ *req_bw = CHANNEL_WIDTH_20; ++ *req_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ } else ++ return _FALSE; ++ ++ return _TRUE; ++} ++#endif ++ ++sint rtw_linked_check(_adapter *padapter) ++{ ++ if ((check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) || ++ (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) == _TRUE)) { ++ if (padapter->stapriv.asoc_sta_count > 2) ++ return _TRUE; ++ } else { ++ /* Station mode */ ++ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _TRUE) ++ return _TRUE; ++ } ++ return _FALSE; ++} ++u8 rtw_is_adapter_up(_adapter *padapter) ++{ ++ if (padapter == NULL) ++ return _FALSE; ++ ++ if (RTW_CANNOT_RUN(padapter)) { ++ RTW_INFO(FUNC_ADPT_FMT "-(bSurpriseRemoved == _TRUE) || ( bDriverStopped == _TRUE)\n", FUNC_ADPT_ARG(padapter)); ++ return _FALSE; ++ } ++ ++ if (!rtw_is_hw_init_completed(padapter)) { ++ /*RTW_INFO(FUNC_ADPT_FMT "-(hw_init_completed == _FALSE)\n", FUNC_ADPT_ARG(padapter));*/ ++ return _FALSE; ++ } ++ ++ if (padapter->bup == _FALSE) { ++ /*RTW_INFO(FUNC_ADPT_FMT "-(bup == _FALSE)\n", FUNC_ADPT_ARG(padapter));*/ ++ return _FALSE; ++ } ++ ++ return _TRUE; ++} ++ ++bool is_miracast_enabled(_adapter *adapter) ++{ ++ bool enabled = 0; ++#ifdef CONFIG_WFD ++ struct wifi_display_info *wfdinfo = &adapter->wfd_info; ++ ++ enabled = (wfdinfo->stack_wfd_mode & (MIRACAST_SOURCE | MIRACAST_SINK)) ++ || (wfdinfo->op_wfd_mode & (MIRACAST_SOURCE | MIRACAST_SINK)); ++#endif ++ ++ return enabled; ++} ++ ++bool rtw_chk_miracast_mode(_adapter *adapter, u8 mode) ++{ ++ bool ret = 0; ++#ifdef CONFIG_WFD ++ struct wifi_display_info *wfdinfo = &adapter->wfd_info; ++ ++ ret = (wfdinfo->stack_wfd_mode & mode) || (wfdinfo->op_wfd_mode & mode); ++#endif ++ ++ return ret; ++} ++ ++const char *get_miracast_mode_str(int mode) ++{ ++ if (mode == MIRACAST_SOURCE) ++ return "SOURCE"; ++ else if (mode == MIRACAST_SINK) ++ return "SINK"; ++ else if (mode == (MIRACAST_SOURCE | MIRACAST_SINK)) ++ return "SOURCE&SINK"; ++ else if (mode == MIRACAST_DISABLED) ++ return "DISABLED"; ++ else ++ return "INVALID"; ++} ++ ++#ifdef CONFIG_WFD ++static bool wfd_st_match_rule(_adapter *adapter, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port) ++{ ++ struct wifi_display_info *wfdinfo = &adapter->wfd_info; ++ ++ if (ntohs(*((u16 *)local_port)) == wfdinfo->rtsp_ctrlport ++ || ntohs(*((u16 *)local_port)) == wfdinfo->tdls_rtsp_ctrlport ++ || ntohs(*((u16 *)remote_port)) == wfdinfo->peer_rtsp_ctrlport) ++ return _TRUE; ++ return _FALSE; ++} ++ ++static struct st_register wfd_st_reg = { ++ .s_proto = 0x06, ++ .rule = wfd_st_match_rule, ++}; ++#endif /* CONFIG_WFD */ ++ ++inline void rtw_wfd_st_switch(struct sta_info *sta, bool on) ++{ ++#ifdef CONFIG_WFD ++ if (on) ++ rtw_st_ctl_register(&sta->st_ctl, SESSION_TRACKER_REG_ID_WFD, &wfd_st_reg); ++ else ++ rtw_st_ctl_unregister(&sta->st_ctl, SESSION_TRACKER_REG_ID_WFD); ++#endif ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_mlme_ext.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mlme_ext.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_mlme_ext.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mlme_ext.c 2018-02-11 21:44:27.139145964 +0200 +@@ -0,0 +1,15722 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_MLME_EXT_C_ ++ ++#include ++#ifdef CONFIG_IOCTL_CFG80211 ++ #include ++#endif /* CONFIG_IOCTL_CFG80211 */ ++#include ++ ++ ++struct mlme_handler mlme_sta_tbl[] = { ++ {WIFI_ASSOCREQ, "OnAssocReq", &OnAssocReq}, ++ {WIFI_ASSOCRSP, "OnAssocRsp", &OnAssocRsp}, ++ {WIFI_REASSOCREQ, "OnReAssocReq", &OnAssocReq}, ++ {WIFI_REASSOCRSP, "OnReAssocRsp", &OnAssocRsp}, ++ {WIFI_PROBEREQ, "OnProbeReq", &OnProbeReq}, ++ {WIFI_PROBERSP, "OnProbeRsp", &OnProbeRsp}, ++ ++ /*---------------------------------------------------------- ++ below 2 are reserved ++ -----------------------------------------------------------*/ ++ {0, "DoReserved", &DoReserved}, ++ {0, "DoReserved", &DoReserved}, ++ {WIFI_BEACON, "OnBeacon", &OnBeacon}, ++ {WIFI_ATIM, "OnATIM", &OnAtim}, ++ {WIFI_DISASSOC, "OnDisassoc", &OnDisassoc}, ++ {WIFI_AUTH, "OnAuth", &OnAuthClient}, ++ {WIFI_DEAUTH, "OnDeAuth", &OnDeAuth}, ++ {WIFI_ACTION, "OnAction", &OnAction}, ++ {WIFI_ACTION_NOACK, "OnActionNoAck", &OnAction}, ++}; ++ ++#ifdef _CONFIG_NATIVEAP_MLME_ ++struct mlme_handler mlme_ap_tbl[] = { ++ {WIFI_ASSOCREQ, "OnAssocReq", &OnAssocReq}, ++ {WIFI_ASSOCRSP, "OnAssocRsp", &OnAssocRsp}, ++ {WIFI_REASSOCREQ, "OnReAssocReq", &OnAssocReq}, ++ {WIFI_REASSOCRSP, "OnReAssocRsp", &OnAssocRsp}, ++ {WIFI_PROBEREQ, "OnProbeReq", &OnProbeReq}, ++ {WIFI_PROBERSP, "OnProbeRsp", &OnProbeRsp}, ++ ++ /*---------------------------------------------------------- ++ below 2 are reserved ++ -----------------------------------------------------------*/ ++ {0, "DoReserved", &DoReserved}, ++ {0, "DoReserved", &DoReserved}, ++ {WIFI_BEACON, "OnBeacon", &OnBeacon}, ++ {WIFI_ATIM, "OnATIM", &OnAtim}, ++ {WIFI_DISASSOC, "OnDisassoc", &OnDisassoc}, ++ {WIFI_AUTH, "OnAuth", &OnAuth}, ++ {WIFI_DEAUTH, "OnDeAuth", &OnDeAuth}, ++ {WIFI_ACTION, "OnAction", &OnAction}, ++ {WIFI_ACTION_NOACK, "OnActionNoAck", &OnAction}, ++}; ++#endif ++ ++struct action_handler OnAction_tbl[] = { ++ {RTW_WLAN_CATEGORY_SPECTRUM_MGMT, "ACTION_SPECTRUM_MGMT", on_action_spct}, ++ {RTW_WLAN_CATEGORY_QOS, "ACTION_QOS", &OnAction_qos}, ++ {RTW_WLAN_CATEGORY_DLS, "ACTION_DLS", &OnAction_dls}, ++ {RTW_WLAN_CATEGORY_BACK, "ACTION_BACK", &OnAction_back}, ++ {RTW_WLAN_CATEGORY_PUBLIC, "ACTION_PUBLIC", on_action_public}, ++ {RTW_WLAN_CATEGORY_RADIO_MEASUREMENT, "ACTION_RADIO_MEASUREMENT", &DoReserved}, ++ {RTW_WLAN_CATEGORY_FT, "ACTION_FT", &OnAction_ft}, ++ {RTW_WLAN_CATEGORY_HT, "ACTION_HT", &OnAction_ht}, ++#ifdef CONFIG_IEEE80211W ++ {RTW_WLAN_CATEGORY_SA_QUERY, "ACTION_SA_QUERY", &OnAction_sa_query}, ++#else ++ {RTW_WLAN_CATEGORY_SA_QUERY, "ACTION_SA_QUERY", &DoReserved}, ++#endif /* CONFIG_IEEE80211W */ ++#ifdef CONFIG_RTW_WNM ++ {RTW_WLAN_CATEGORY_WNM, "ACTION_WNM", &on_action_wnm}, ++#endif ++ {RTW_WLAN_CATEGORY_UNPROTECTED_WNM, "ACTION_UNPROTECTED_WNM", &DoReserved}, ++ {RTW_WLAN_CATEGORY_SELF_PROTECTED, "ACTION_SELF_PROTECTED", &DoReserved}, ++ {RTW_WLAN_CATEGORY_WMM, "ACTION_WMM", &OnAction_wmm}, ++ {RTW_WLAN_CATEGORY_VHT, "ACTION_VHT", &OnAction_vht}, ++ {RTW_WLAN_CATEGORY_P2P, "ACTION_P2P", &OnAction_p2p}, ++}; ++ ++ ++u8 null_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; ++ ++/************************************************** ++OUI definitions for the vendor specific IE ++***************************************************/ ++unsigned char RTW_WPA_OUI[] = {0x00, 0x50, 0xf2, 0x01}; ++unsigned char WMM_OUI[] = {0x00, 0x50, 0xf2, 0x02}; ++unsigned char WPS_OUI[] = {0x00, 0x50, 0xf2, 0x04}; ++unsigned char P2P_OUI[] = {0x50, 0x6F, 0x9A, 0x09}; ++unsigned char WFD_OUI[] = {0x50, 0x6F, 0x9A, 0x0A}; ++ ++unsigned char WMM_INFO_OUI[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01}; ++unsigned char WMM_PARA_OUI[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; ++ ++unsigned char WPA_TKIP_CIPHER[4] = {0x00, 0x50, 0xf2, 0x02}; ++unsigned char RSN_TKIP_CIPHER[4] = {0x00, 0x0f, 0xac, 0x02}; ++ ++extern unsigned char REALTEK_96B_IE[]; ++ ++#ifdef LEGACY_CHANNEL_PLAN_REF ++/******************************************************** ++ChannelPlan definitions ++*********************************************************/ ++static RT_CHANNEL_PLAN legacy_channel_plan[] = { ++ /* 0x00, RTW_CHPLAN_FCC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165}, 32}, ++ /* 0x01, RTW_CHPLAN_IC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 31}, ++ /* 0x02, RTW_CHPLAN_ETSI */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 32}, ++ /* 0x03, RTW_CHPLAN_SPAIN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, ++ /* 0x04, RTW_CHPLAN_FRANCE */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, ++ /* 0x05, RTW_CHPLAN_MKK */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, ++ /* 0x06, RTW_CHPLAN_MKK1 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, ++ /* 0x07, RTW_CHPLAN_ISRAEL */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64}, 21}, ++ /* 0x08, RTW_CHPLAN_TELEC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52, 56, 60, 64}, 22}, ++ /* 0x09, RTW_CHPLAN_GLOBAL_DOAMIN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14}, ++ /* 0x0A, RTW_CHPLAN_WORLD_WIDE_13 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, ++ /* 0x0B, RTW_CHPLAN_TAIWAN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 26}, ++ /* 0x0C, RTW_CHPLAN_CHINA */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 149, 153, 157, 161, 165}, 18}, ++ /* 0x0D, RTW_CHPLAN_SINGAPORE_INDIA_MEXICO */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165}, 24}, ++ /* 0x0E, RTW_CHPLAN_KOREA */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161, 165}, 31}, ++ /* 0x0F, RTW_CHPLAN_TURKEY */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64}, 19}, ++ /* 0x10, RTW_CHPLAN_JAPAN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 32}, ++ /* 0x11, RTW_CHPLAN_FCC_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 149, 153, 157, 161, 165}, 20}, ++ /* 0x12, RTW_CHPLAN_JAPAN_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48}, 17}, ++ /* 0x13, RTW_CHPLAN_WORLD_WIDE_5G */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165}, 37}, ++ /* 0x14, RTW_CHPLAN_TAIWAN_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 56, 60, 64, 149, 153, 157, 161, 165}, 19}, ++}; ++#endif ++ ++static struct ch_list_t RTW_ChannelPlan2G[] = { ++ /* 0, RTW_RD_2G_NULL */ CH_LIST_ENT(0), ++ /* 1, RTW_RD_2G_WORLD */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), ++ /* 2, RTW_RD_2G_ETSI1 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), ++ /* 3, RTW_RD_2G_FCC1 */ CH_LIST_ENT(11, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11), ++ /* 4, RTW_RD_2G_MKK1 */ CH_LIST_ENT(14, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14), ++ /* 5, RTW_RD_2G_ETSI2 */ CH_LIST_ENT(4, 10, 11, 12, 13), ++ /* 6, RTW_RD_2G_GLOBAL */ CH_LIST_ENT(14, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14), ++ /* 7, RTW_RD_2G_MKK2 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), ++ /* 8, RTW_RD_2G_FCC2 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), ++}; ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++static struct ch_list_t RTW_ChannelPlan5G[] = { ++ /* 0, RTW_RD_5G_NULL */ CH_LIST_ENT(0), ++ /* 1, RTW_RD_5G_ETSI1 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), ++ /* 2, RTW_RD_5G_ETSI2 */ CH_LIST_ENT(24, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165), ++ /* 3, RTW_RD_5G_ETSI3 */ CH_LIST_ENT(22, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 149, 153, 157, 161, 165), ++ /* 4, RTW_RD_5G_FCC1 */ CH_LIST_ENT(24, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165), ++ /* 5, RTW_RD_5G_FCC2 */ CH_LIST_ENT(9, 36, 40, 44, 48, 149, 153, 157, 161, 165), ++ /* 6, RTW_RD_5G_FCC3 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165), ++ /* 7, RTW_RD_5G_FCC4 */ CH_LIST_ENT(12, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161), ++ /* 8, RTW_RD_5G_FCC5 */ CH_LIST_ENT(5, 149, 153, 157, 161, 165), ++ /* 9, RTW_RD_5G_FCC6 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64), ++ /* 10, RTW_RD_5G_FCC7 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), ++ /* 11, RTW_RD_5G_KCC1 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161), ++ /* 12, RTW_RD_5G_MKK1 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), ++ /* 13, RTW_RD_5G_MKK2 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64), ++ /* 14, RTW_RD_5G_MKK3 */ CH_LIST_ENT(11, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), ++ /* 15, RTW_RD_5G_NCC1 */ CH_LIST_ENT(16, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), ++ /* 16, RTW_RD_5G_NCC2 */ CH_LIST_ENT(8, 56, 60, 64, 149, 153, 157, 161, 165), ++ /* 17, RTW_RD_5G_NCC3 */ CH_LIST_ENT(5, 149, 153, 157, 161, 165), ++ /* 18, RTW_RD_5G_ETSI4 */ CH_LIST_ENT(4, 36, 40, 44, 48), ++ /* 19, RTW_RD_5G_ETSI5 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), ++ /* 20, RTW_RD_5G_FCC8 */ CH_LIST_ENT(4, 149, 153, 157, 161), ++ /* 21, RTW_RD_5G_ETSI6 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64), ++ /* 22, RTW_RD_5G_ETSI7 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165), ++ /* 23, RTW_RD_5G_ETSI8 */ CH_LIST_ENT(9, 36, 40, 44, 48, 149, 153, 157, 161, 165), ++ /* 24, RTW_RD_5G_ETSI9 */ CH_LIST_ENT(11, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), ++ /* 25, RTW_RD_5G_ETSI10 */ CH_LIST_ENT(5, 149, 153, 157, 161, 165), ++ /* 26, RTW_RD_5G_ETSI11 */ CH_LIST_ENT(16, 36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140, 149, 153, 157, 161, 165), ++ /* 27, RTW_RD_5G_NCC4 */ CH_LIST_ENT(17, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), ++ /* 28, RTW_RD_5G_ETSI12 */ CH_LIST_ENT(4, 149, 153, 157, 161), ++ /* 29, RTW_RD_5G_FCC9 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), ++ /* 30, RTW_RD_5G_ETSI13 */ CH_LIST_ENT(16, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140), ++ /* 31, RTW_RD_5G_FCC10 */ CH_LIST_ENT(20, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161), ++ /* 32, RTW_RD_5G_MKK4 */ CH_LIST_ENT(4, 36, 40, 44, 48), ++ /* 33, RTW_RD_5G_ETSI14 */ CH_LIST_ENT(11, 36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140), ++ /* 34, RTW_RD_5G_FCC11 */ CH_LIST_ENT(25, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144, 149, 153, 157, 161, 165), ++ ++ /* === Below are driver defined for legacy channel plan compatible, NO static index assigned ==== */ ++ /* RTW_RD_5G_OLD_FCC1 */ CH_LIST_ENT(20, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165), ++ /* RTW_RD_5G_OLD_NCC1 */ CH_LIST_ENT(15, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165), ++ /* RTW_RD_5G_OLD_KCC1 */ CH_LIST_ENT(20, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161, 165), ++}; ++#endif /* CONFIG_IEEE80211_BAND_5GHZ */ ++ ++static RT_CHANNEL_PLAN_MAP RTW_ChannelPlanMap[] = { ++ /* ===== 0x00 ~ 0x1F, legacy channel plan ===== */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_KCC1, TXPWR_LMT_FCC), /* 0x00, RTW_CHPLAN_FCC */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_OLD_FCC1, TXPWR_LMT_FCC), /* 0x01, RTW_CHPLAN_IC */ ++ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI1, TXPWR_LMT_ETSI), /* 0x02, RTW_CHPLAN_ETSI */ ++ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x03, RTW_CHPLAN_SPAIN */ ++ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x04, RTW_CHPLAN_FRANCE */ ++ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK), /* 0x05, RTW_CHPLAN_MKK */ ++ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK), /* 0x06, RTW_CHPLAN_MKK1 */ ++ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_FCC6, TXPWR_LMT_ETSI), /* 0x07, RTW_CHPLAN_ISRAEL */ ++ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_FCC6, TXPWR_LMT_MKK), /* 0x08, RTW_CHPLAN_TELEC */ ++ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x09, RTW_CHPLAN_GLOBAL_DOAMIN */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x0A, RTW_CHPLAN_WORLD_WIDE_13 */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_OLD_NCC1, TXPWR_LMT_FCC), /* 0x0B, RTW_CHPLAN_TAIWAN */ ++ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_FCC5, TXPWR_LMT_ETSI), /* 0x0C, RTW_CHPLAN_CHINA */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC3, TXPWR_LMT_WW), /* 0x0D, RTW_CHPLAN_SINGAPORE_INDIA_MEXICO */ /* ETSI:Singapore, India. FCC:Mexico => WW */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_OLD_KCC1, TXPWR_LMT_ETSI), /* 0x0E, RTW_CHPLAN_KOREA */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC6, TXPWR_LMT_ETSI), /* 0x0F, RTW_CHPLAN_TURKEY */ ++ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI1, TXPWR_LMT_MKK), /* 0x10, RTW_CHPLAN_JAPAN */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC2, TXPWR_LMT_FCC), /* 0x11, RTW_CHPLAN_FCC_NO_DFS */ ++ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_FCC7, TXPWR_LMT_MKK), /* 0x12, RTW_CHPLAN_JAPAN_NO_DFS */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC1, TXPWR_LMT_WW), /* 0x13, RTW_CHPLAN_WORLD_WIDE_5G */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC2, TXPWR_LMT_FCC), /* 0x14, RTW_CHPLAN_TAIWAN_NO_DFS */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC7, TXPWR_LMT_ETSI), /* 0x15, RTW_CHPLAN_ETSI_NO_DFS */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_NCC1, TXPWR_LMT_ETSI), /* 0x16, RTW_CHPLAN_KOREA_NO_DFS */ ++ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_FCC7, TXPWR_LMT_MKK), /* 0x17, RTW_CHPLAN_JAPAN_NO_DFS */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_FCC5, TXPWR_LMT_ETSI), /* 0x18, RTW_CHPLAN_PAKISTAN_NO_DFS */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC5, TXPWR_LMT_FCC), /* 0x19, RTW_CHPLAN_TAIWAN2_NO_DFS */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1A, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1B, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1C, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1D, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1E, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_FCC1, TXPWR_LMT_WW), /* 0x1F, RTW_CHPLAN_WORLD_WIDE_ONLY_5G */ ++ ++ /* ===== 0x20 ~ 0x7F, new channel plan ===== */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x20, RTW_CHPLAN_WORLD_NULL */ ++ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x21, RTW_CHPLAN_ETSI1_NULL */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NULL, TXPWR_LMT_FCC), /* 0x22, RTW_CHPLAN_FCC1_NULL */ ++ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK), /* 0x23, RTW_CHPLAN_MKK1_NULL */ ++ CHPLAN_ENT(RTW_RD_2G_ETSI2, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x24, RTW_CHPLAN_ETSI2_NULL */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC1, TXPWR_LMT_FCC), /* 0x25, RTW_CHPLAN_FCC1_FCC1 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI1, TXPWR_LMT_ETSI), /* 0x26, RTW_CHPLAN_WORLD_ETSI1 */ ++ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_MKK1, TXPWR_LMT_MKK), /* 0x27, RTW_CHPLAN_MKK1_MKK1 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_KCC1, TXPWR_LMT_ETSI), /* 0x28, RTW_CHPLAN_WORLD_KCC1 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC2, TXPWR_LMT_FCC), /* 0x29, RTW_CHPLAN_WORLD_FCC2 */ ++ CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_NULL, TXPWR_LMT_FCC), /* 0x2A, RTW_CHPLAN_FCC2_NULL */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2B, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2C, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2D, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2E, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2F, */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC3, TXPWR_LMT_FCC), /* 0x30, RTW_CHPLAN_WORLD_FCC3 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC4, TXPWR_LMT_FCC), /* 0x31, RTW_CHPLAN_WORLD_FCC4 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC5, TXPWR_LMT_FCC), /* 0x32, RTW_CHPLAN_WORLD_FCC5 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC6, TXPWR_LMT_FCC), /* 0x33, RTW_CHPLAN_WORLD_FCC6 */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC7, TXPWR_LMT_FCC), /* 0x34, RTW_CHPLAN_FCC1_FCC7 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI2, TXPWR_LMT_ETSI), /* 0x35, RTW_CHPLAN_WORLD_ETSI2 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI3, TXPWR_LMT_ETSI), /* 0x36, RTW_CHPLAN_WORLD_ETSI3 */ ++ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_MKK2, TXPWR_LMT_MKK), /* 0x37, RTW_CHPLAN_MKK1_MKK2 */ ++ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_MKK3, TXPWR_LMT_MKK), /* 0x38, RTW_CHPLAN_MKK1_MKK3 */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC1, TXPWR_LMT_FCC), /* 0x39, RTW_CHPLAN_FCC1_NCC1 */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3A, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3B, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3C, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3D, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3E, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3F, */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC2, TXPWR_LMT_FCC), /* 0x40, RTW_CHPLAN_FCC1_NCC2 */ ++ CHPLAN_ENT(RTW_RD_2G_GLOBAL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x41, RTW_CHPLAN_GLOBAL_NULL */ ++ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI4, TXPWR_LMT_ETSI), /* 0x42, RTW_CHPLAN_ETSI1_ETSI4 */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC2, TXPWR_LMT_FCC), /* 0x43, RTW_CHPLAN_FCC1_FCC2 */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC3, TXPWR_LMT_FCC), /* 0x44, RTW_CHPLAN_FCC1_NCC3 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI5, TXPWR_LMT_ETSI), /* 0x45, RTW_CHPLAN_WORLD_ETSI5 */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC8, TXPWR_LMT_FCC), /* 0x46, RTW_CHPLAN_FCC1_FCC8 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI6, TXPWR_LMT_ETSI), /* 0x47, RTW_CHPLAN_WORLD_ETSI6 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI7, TXPWR_LMT_ETSI), /* 0x48, RTW_CHPLAN_WORLD_ETSI7 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI8, TXPWR_LMT_ETSI), /* 0x49, RTW_CHPLAN_WORLD_ETSI8 */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4A, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4B, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4C, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4D, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4E, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4F, */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI9, TXPWR_LMT_ETSI), /* 0x50, RTW_CHPLAN_WORLD_ETSI9 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI10, TXPWR_LMT_ETSI), /* 0x51, RTW_CHPLAN_WORLD_ETSI10 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI11, TXPWR_LMT_ETSI), /* 0x52, RTW_CHPLAN_WORLD_ETSI11 */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC4, TXPWR_LMT_FCC), /* 0x53, RTW_CHPLAN_FCC1_NCC4 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI12, TXPWR_LMT_ETSI), /* 0x54, RTW_CHPLAN_WORLD_ETSI12 */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC9, TXPWR_LMT_FCC), /* 0x55, RTW_CHPLAN_FCC1_FCC9 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI13, TXPWR_LMT_ETSI), /* 0x56, RTW_CHPLAN_WORLD_ETSI13 */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC10, TXPWR_LMT_FCC), /* 0x57, RTW_CHPLAN_FCC1_FCC10 */ ++ CHPLAN_ENT(RTW_RD_2G_MKK2, RTW_RD_5G_MKK4, TXPWR_LMT_MKK), /* 0x58, RTW_CHPLAN_MKK2_MKK4 */ ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI14, TXPWR_LMT_ETSI), /* 0x59, RTW_CHPLAN_WORLD_ETSI14 */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5A, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5B, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5C, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5D, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5E, */ ++ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5F, */ ++ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC5, TXPWR_LMT_FCC), /* 0x60, RTW_CHPLAN_FCC1_FCC5 */ ++ CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_FCC7, TXPWR_LMT_FCC), /* 0x61, RTW_CHPLAN_FCC2_FCC7 */ ++ CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_FCC1, TXPWR_LMT_FCC), /* 0x62, RTW_CHPLAN_FCC2_FCC1 */ ++}; ++ ++static RT_CHANNEL_PLAN_MAP RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE = ++ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC1, TXPWR_LMT_FCC); /* 0x7F, Realtek Define */ ++ ++bool rtw_chplan_is_empty(u8 id) ++{ ++ RT_CHANNEL_PLAN_MAP *chplan_map; ++ ++ if (id == RTW_CHPLAN_REALTEK_DEFINE) ++ chplan_map = &RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE; ++ else ++ chplan_map = &RTW_ChannelPlanMap[id]; ++ ++ if (chplan_map->Index2G == RTW_RD_2G_NULL ++ #ifdef CONFIG_IEEE80211_BAND_5GHZ ++ && chplan_map->Index5G == RTW_RD_5G_NULL ++ #endif ++ ) ++ return _TRUE; ++ ++ return _FALSE; ++} ++ ++void rtw_rfctl_init(_adapter *adapter) ++{ ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ ++ _rtw_memset(rfctl, 0, sizeof(*rfctl)); ++ ++#ifdef CONFIG_DFS_MASTER ++ rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; ++ ++ /* TODO: dfs_master_timer */ ++#endif ++} ++ ++#ifdef CONFIG_DFS_MASTER ++/* ++* called in rtw_dfs_master_enable() ++* assume the request channel coverage is DFS range ++* base on the current status and the request channel coverage to check if need to reset complete CAC time ++*/ ++bool rtw_is_cac_reset_needed(_adapter *adapter, u8 ch, u8 bw, u8 offset) ++{ ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ bool needed = _FALSE; ++ u32 cur_hi, cur_lo, hi, lo; ++ ++ if (rfctl->radar_detected == 1) { ++ needed = _TRUE; ++ goto exit; ++ } ++ ++ if (rfctl->radar_detect_ch == 0) { ++ needed = _TRUE; ++ goto exit; ++ } ++ ++ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) { ++ RTW_ERR("request detection range ch:%u, bw:%u, offset:%u\n", ch, bw, offset); ++ rtw_warn_on(1); ++ } ++ ++ if (rtw_chbw_to_freq_range(rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset, &cur_hi, &cur_lo) == _FALSE) { ++ RTW_ERR("cur detection range ch:%u, bw:%u, offset:%u\n", rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset); ++ rtw_warn_on(1); ++ } ++ ++ if (hi <= lo || cur_hi <= cur_lo) { ++ RTW_ERR("hi:%u, lo:%u, cur_hi:%u, cur_lo:%u\n", hi, lo, cur_hi, cur_lo); ++ rtw_warn_on(1); ++ } ++ ++ if (rtw_is_range_a_in_b(hi, lo, cur_hi, cur_lo)) { ++ /* request is in current detect range */ ++ goto exit; ++ } ++ ++ /* check if request channel coverage has new range and the new range is in DFS range */ ++ if (!rtw_is_range_overlap(hi, lo, cur_hi, cur_lo)) { ++ /* request has no overlap with current */ ++ needed = _TRUE; ++ } else if (rtw_is_range_a_in_b(cur_hi, cur_lo, hi, lo)) { ++ /* request is supper set of current */ ++ if ((hi != cur_hi && rtw_is_dfs_range(hi, cur_hi)) || (lo != cur_lo && rtw_is_dfs_range(cur_lo, lo))) ++ needed = _TRUE; ++ } else { ++ /* request is not supper set of current, but has overlap */ ++ if ((lo < cur_lo && rtw_is_dfs_range(cur_lo, lo)) || (hi > cur_hi && rtw_is_dfs_range(hi, cur_hi))) ++ needed = _TRUE; ++ } ++ ++exit: ++ return needed; ++} ++ ++bool _rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset) ++{ ++ bool ret = _FALSE; ++ u32 hi = 0, lo = 0; ++ u32 r_hi = 0, r_lo = 0; ++ int i; ++ ++ if (rfctl->radar_detect_by_others) ++ goto exit; ++ ++ if (rfctl->radar_detect_ch == 0) ++ goto exit; ++ ++ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (rtw_chbw_to_freq_range(rfctl->radar_detect_ch ++ , rfctl->radar_detect_bw, rfctl->radar_detect_offset ++ , &r_hi, &r_lo) == _FALSE) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (rtw_is_range_overlap(hi, lo, r_hi, r_lo)) ++ ret = _TRUE; ++ ++exit: ++ return ret; ++} ++ ++bool rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl) ++{ ++ return _rtw_rfctl_overlap_radar_detect_ch(rfctl ++ , rfctl_to_dvobj(rfctl)->oper_channel ++ , rfctl_to_dvobj(rfctl)->oper_bwmode ++ , rfctl_to_dvobj(rfctl)->oper_ch_offset); ++} ++ ++bool rtw_rfctl_is_tx_blocked_by_ch_waiting(struct rf_ctl_t *rfctl) ++{ ++ return rtw_rfctl_overlap_radar_detect_ch(rfctl) && IS_CH_WAITING(rfctl); ++} ++ ++bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) ++{ ++ bool ret = _FALSE; ++ u32 hi = 0, lo = 0; ++ int i; ++ ++ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) ++ goto exit; ++ ++ for (i = 0; ch_set[i].ChannelNum != 0; i++) { ++ if (!rtw_ch2freq(ch_set[i].ChannelNum)) { ++ rtw_warn_on(1); ++ continue; ++ } ++ ++ if (!CH_IS_NON_OCP(&ch_set[i])) ++ continue; ++ ++ if (lo <= rtw_ch2freq(ch_set[i].ChannelNum) ++ && rtw_ch2freq(ch_set[i].ChannelNum) <= hi ++ ) { ++ ret = _TRUE; ++ break; ++ } ++ } ++ ++exit: ++ return ret; ++} ++ ++u32 rtw_chset_get_ch_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) ++{ ++ int ms = 0; ++ u32 current_time; ++ u32 hi = 0, lo = 0; ++ int i; ++ ++ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) ++ goto exit; ++ ++ current_time = rtw_get_current_time(); ++ ++ for (i = 0; ch_set[i].ChannelNum != 0; i++) { ++ if (!rtw_ch2freq(ch_set[i].ChannelNum)) { ++ rtw_warn_on(1); ++ continue; ++ } ++ ++ if (!CH_IS_NON_OCP(&ch_set[i])) ++ continue; ++ ++ if (lo <= rtw_ch2freq(ch_set[i].ChannelNum) ++ && rtw_ch2freq(ch_set[i].ChannelNum) <= hi ++ ) { ++ if (rtw_systime_to_ms(ch_set[i].non_ocp_end_time - current_time) > ms) ++ ms = rtw_systime_to_ms(ch_set[i].non_ocp_end_time - current_time); ++ } ++ } ++ ++exit: ++ return ms; ++} ++ ++/** ++ * rtw_chset_update_non_ocp - update non_ocp_end_time according to the given @ch, @bw, @offset into @ch_set ++ * @ch_set: the given channel set ++ * @ch: channel number on which radar is detected ++ * @bw: bandwidth on which radar is detected ++ * @offset: bandwidth offset on which radar is detected ++ * @ms: ms to add from now to update non_ocp_end_time, ms < 0 means use NON_OCP_TIME_MS ++ */ ++static void _rtw_chset_update_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset, int ms) ++{ ++ u32 hi = 0, lo = 0; ++ int i; ++ ++ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) ++ goto exit; ++ ++ for (i = 0; ch_set[i].ChannelNum != 0; i++) { ++ if (!rtw_ch2freq(ch_set[i].ChannelNum)) { ++ rtw_warn_on(1); ++ continue; ++ } ++ ++ if (lo <= rtw_ch2freq(ch_set[i].ChannelNum) ++ && rtw_ch2freq(ch_set[i].ChannelNum) <= hi ++ ) { ++ if (ms >= 0) ++ ch_set[i].non_ocp_end_time = rtw_get_current_time() + rtw_ms_to_systime(ms); ++ else ++ ch_set[i].non_ocp_end_time = rtw_get_current_time() + rtw_ms_to_systime(NON_OCP_TIME_MS); ++ } ++ } ++ ++exit: ++ return; ++} ++ ++inline void rtw_chset_update_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) ++{ ++ _rtw_chset_update_non_ocp(ch_set, ch, bw, offset, -1); ++} ++ ++inline void rtw_chset_update_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset, int ms) ++{ ++ _rtw_chset_update_non_ocp(ch_set, ch, bw, offset, ms); ++} ++ ++u32 rtw_get_ch_waiting_ms(_adapter *adapter, u8 ch, u8 bw, u8 offset, u32 *r_non_ocp_ms, u32 *r_cac_ms) ++{ ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ u32 non_ocp_ms; ++ u32 cac_ms; ++ u8 in_rd_range = 0; /* if in current radar detection range*/ ++ ++ if (rtw_chset_is_ch_non_ocp(mlmeext->channel_set, ch, bw, offset)) ++ non_ocp_ms = rtw_chset_get_ch_non_ocp_ms(mlmeext->channel_set, ch, bw, offset); ++ else ++ non_ocp_ms = 0; ++ ++ if (rfctl->dfs_master_enabled) { ++ u32 cur_hi, cur_lo, hi, lo; ++ ++ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) { ++ RTW_ERR("input range ch:%u, bw:%u, offset:%u\n", ch, bw, offset); ++ rtw_warn_on(1); ++ } ++ ++ if (rtw_chbw_to_freq_range(rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset, &cur_hi, &cur_lo) == _FALSE) { ++ RTW_ERR("cur detection range ch:%u, bw:%u, offset:%u\n", rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset); ++ rtw_warn_on(1); ++ } ++ ++ if (rtw_is_range_a_in_b(hi, lo, cur_hi, cur_lo)) ++ in_rd_range = 1; ++ } ++ ++ if (!rtw_is_dfs_ch(ch, bw, offset)) ++ cac_ms = 0; ++ else if (in_rd_range && !non_ocp_ms) { ++ if (IS_CH_WAITING(rfctl)) ++ cac_ms = rtw_systime_to_ms(rfctl->cac_end_time - rtw_get_current_time()); ++ else ++ cac_ms = 0; ++ } else if (rtw_is_long_cac_ch(ch, bw, offset, rtw_odm_get_dfs_domain(adapter))) ++ cac_ms = CAC_TIME_CE_MS; ++ else ++ cac_ms = CAC_TIME_MS; ++ ++ if (r_non_ocp_ms) ++ *r_non_ocp_ms = non_ocp_ms; ++ if (r_cac_ms) ++ *r_cac_ms = cac_ms; ++ ++ return non_ocp_ms + cac_ms; ++} ++ ++void rtw_reset_cac(_adapter *adapter, u8 ch, u8 bw, u8 offset) ++{ ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ u32 non_ocp_ms; ++ u32 cac_ms; ++ ++ rtw_get_ch_waiting_ms(adapter ++ , ch ++ , bw ++ , offset ++ , &non_ocp_ms ++ , &cac_ms ++ ); ++ ++ rfctl->cac_start_time = rtw_get_current_time() + rtw_ms_to_systime(non_ocp_ms); ++ rfctl->cac_end_time = rfctl->cac_start_time + rtw_ms_to_systime(cac_ms); ++ ++ /* skip special value */ ++ if (rfctl->cac_start_time == RTW_CAC_STOPPED) { ++ rfctl->cac_start_time++; ++ rfctl->cac_end_time++; ++ } ++ if (rfctl->cac_end_time == RTW_CAC_STOPPED) ++ rfctl->cac_end_time++; ++} ++ ++/* choose channel with shortest waiting (non ocp + cac) time */ ++bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 *dec_bw, u8 *dec_offset, u8 d_flags) ++{ ++#ifndef DBG_CHOOSE_SHORTEST_WAITING_CH ++#define DBG_CHOOSE_SHORTEST_WAITING_CH 0 ++#endif ++ ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ struct registry_priv *regsty = adapter_to_regsty(adapter); ++ u8 ch, bw, offset; ++ u8 ch_c = 0, bw_c = 0, offset_c = 0; ++ int i; ++ u32 min_waiting_ms = 0; ++ ++ if (!dec_ch || !dec_bw || !dec_offset) { ++ rtw_warn_on(1); ++ return _FALSE; ++ } ++ ++ /* full search and narrow bw judegement first to avoid potetial judegement timing issue */ ++ for (bw = CHANNEL_WIDTH_20; bw <= req_bw; bw++) { ++ if (!hal_is_bw_support(adapter, bw)) ++ continue; ++ ++ for (i = 0; i < mlmeext->max_chan_nums; i++) { ++ u32 non_ocp_ms; ++ u32 cac_ms; ++ u32 waiting_ms; ++ ++ ch = mlmeext->channel_set[i].ChannelNum; ++ ++ if ((d_flags & RTW_CHF_2G) && ch <= 14) ++ continue; ++ ++ if ((d_flags & RTW_CHF_5G) && ch > 14) ++ continue; ++ ++ if (ch > 14) { ++ if (bw > REGSTY_BW_5G(regsty)) ++ continue; ++ } else { ++ if (bw > REGSTY_BW_2G(regsty)) ++ continue; ++ } ++ ++ if (!rtw_get_offset_by_chbw(ch, bw, &offset)) ++ continue; ++ ++ if (!rtw_chset_is_chbw_valid(mlmeext->channel_set, ch, bw, offset)) ++ continue; ++ ++ if ((d_flags & RTW_CHF_NON_OCP) && rtw_chset_is_ch_non_ocp(mlmeext->channel_set, ch, bw, offset)) ++ continue; ++ ++ if ((d_flags & RTW_CHF_DFS) && rtw_is_dfs_ch(ch, bw, offset)) ++ continue; ++ ++ if ((d_flags & RTW_CHF_LONG_CAC) && rtw_is_long_cac_ch(ch, bw, offset, rtw_odm_get_dfs_domain(adapter))) ++ continue; ++ ++ if ((d_flags & RTW_CHF_NON_DFS) && !rtw_is_dfs_ch(ch, bw, offset)) ++ continue; ++ ++ if ((d_flags & RTW_CHF_NON_LONG_CAC) && !rtw_is_long_cac_ch(ch, bw, offset, rtw_odm_get_dfs_domain(adapter))) ++ continue; ++ ++ waiting_ms = rtw_get_ch_waiting_ms(adapter, ch, bw, offset, &non_ocp_ms, &cac_ms); ++ ++ if (DBG_CHOOSE_SHORTEST_WAITING_CH) ++ RTW_INFO(FUNC_ADPT_FMT":%u,%u,%u %u(non_ocp:%u, cac:%u)\n" ++ , FUNC_ADPT_ARG(adapter), ch, bw, offset, waiting_ms, non_ocp_ms, cac_ms); ++ ++ if (ch_c == 0 ++ || min_waiting_ms > waiting_ms ++ || (min_waiting_ms == waiting_ms && bw > bw_c) /* wider bw first */ ++ ) { ++ ch_c = ch; ++ bw_c = bw; ++ offset_c = offset; ++ min_waiting_ms = waiting_ms; ++ } ++ } ++ } ++ ++ if (ch_c != 0) { ++ RTW_INFO(FUNC_ADPT_FMT": d_flags:0x%02x %u,%u,%u waiting_ms:%u\n" ++ , FUNC_ADPT_ARG(adapter), d_flags, ch_c, bw_c, offset_c, min_waiting_ms); ++ ++ *dec_ch = ch_c; ++ *dec_bw = bw_c; ++ *dec_offset = offset_c; ++ return _TRUE; ++ } ++ ++ if (d_flags == 0) ++ rtw_warn_on(1); ++ ++ return _FALSE; ++} ++#endif /* CONFIG_DFS_MASTER */ ++ ++void dump_country_chplan(void *sel, const struct country_chplan *ent) ++{ ++ _RTW_PRINT_SEL(sel, "\"%c%c\", 0x%02X%s\n" ++ , ent->alpha2[0], ent->alpha2[1], ent->chplan ++ , COUNTRY_CHPLAN_EN_11AC(ent) ? " ac" : "" ++ ); ++} ++ ++void dump_country_chplan_map(void *sel) ++{ ++ const struct country_chplan *ent; ++ u8 code[2]; ++ ++#if RTW_DEF_MODULE_REGULATORY_CERT ++ _RTW_PRINT_SEL(sel, "RTW_DEF_MODULE_REGULATORY_CERT:0x%x\n", RTW_DEF_MODULE_REGULATORY_CERT); ++#endif ++#ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP ++ _RTW_PRINT_SEL(sel, "CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP\n"); ++#endif ++ ++ for (code[0] = 'A'; code[0] <= 'Z'; code[0]++) { ++ for (code[1] = 'A'; code[1] <= 'Z'; code[1]++) { ++ ent = rtw_get_chplan_from_country(code); ++ if (!ent) ++ continue; ++ ++ dump_country_chplan(sel, ent); ++ } ++ } ++} ++ ++void dump_chplan_id_list(void *sel) ++{ ++ int i; ++ ++ for (i = 0; i < RTW_CHPLAN_MAX; i++) { ++ if (!rtw_is_channel_plan_valid(i)) ++ continue; ++ ++ _RTW_PRINT_SEL(sel, "0x%02X ", i); ++ } ++ ++ RTW_PRINT_SEL(sel, "0x7F\n"); ++} ++ ++void dump_chplan_test(void *sel) ++{ ++ int i, j; ++ ++ /* check invalid channel */ ++ for (i = 0; i < RTW_RD_2G_MAX; i++) { ++ for (j = 0; j < CH_LIST_LEN(RTW_ChannelPlan2G[i]); j++) { ++ if (rtw_ch2freq(CH_LIST_CH(RTW_ChannelPlan2G[i], j)) == 0) ++ RTW_PRINT_SEL(sel, "invalid ch:%u at (%d,%d)\n", CH_LIST_CH(RTW_ChannelPlan2G[i], j), i, j); ++ } ++ } ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ for (i = 0; i < RTW_RD_5G_MAX; i++) { ++ for (j = 0; j < CH_LIST_LEN(RTW_ChannelPlan5G[i]); j++) { ++ if (rtw_ch2freq(CH_LIST_CH(RTW_ChannelPlan5G[i], j)) == 0) ++ RTW_PRINT_SEL(sel, "invalid ch:%u at (%d,%d)\n", CH_LIST_CH(RTW_ChannelPlan5G[i], j), i, j); ++ } ++ } ++#endif ++} ++ ++void dump_chset(void *sel, RT_CHANNEL_INFO *ch_set) ++{ ++ u8 i; ++ ++ for (i = 0; ch_set[i].ChannelNum != 0; i++) { ++ RTW_PRINT_SEL(sel, "ch:%3u, freq:%u, scan_type:%d" ++ , ch_set[i].ChannelNum, rtw_ch2freq(ch_set[i].ChannelNum), ch_set[i].ScanType); ++ ++#ifdef CONFIG_FIND_BEST_CHANNEL ++ _RTW_PRINT_SEL(sel, ", rx_count:%u", ch_set[i].rx_count); ++#endif ++ ++#ifdef CONFIG_DFS_MASTER ++ if (rtw_is_dfs_ch(ch_set[i].ChannelNum, CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE)) { ++ if (CH_IS_NON_OCP(&ch_set[i])) ++ _RTW_PRINT_SEL(sel, ", non_ocp:%d" ++ , rtw_systime_to_ms(ch_set[i].non_ocp_end_time - rtw_get_current_time())); ++ else ++ _RTW_PRINT_SEL(sel, ", non_ocp:N/A"); ++ } ++#endif ++ ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ ++ RTW_PRINT_SEL(sel, "total ch number:%d\n", i); ++} ++ ++void dump_cur_chset(void *sel, _adapter *adapter) ++{ ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ struct registry_priv *regsty = adapter_to_regsty(adapter); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ int i; ++ ++ if (mlme->country_ent) ++ dump_country_chplan(sel, mlme->country_ent); ++ else ++ RTW_PRINT_SEL(sel, "chplan:0x%02X\n", mlme->ChannelPlan); ++ ++ RTW_PRINT_SEL(sel, "2G_PLS:%u, 5G_PLS:%u\n" ++ , hal_data->Regulation2_4G, hal_data->Regulation5G); ++ ++ for (i = 0; i < MAX_CHANNEL_NUM; i++) ++ if (regsty->excl_chs[i] != 0) ++ break; ++ ++ if (i < MAX_CHANNEL_NUM) { ++ _RTW_PRINT_SEL(sel, "excl_chs:"); ++ for (i = 0; i < MAX_CHANNEL_NUM; i++) { ++ if (regsty->excl_chs[i] == 0) ++ break; ++ _RTW_PRINT_SEL(sel, "%u ", regsty->excl_chs[i]); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ } ++ ++ dump_chset(sel, mlmeext->channel_set); ++} ++ ++/* ++ * Search the @param ch in given @param ch_set ++ * @ch_set: the given channel set ++ * @ch: the given channel number ++ * ++ * return the index of channel_num in channel_set, -1 if not found ++ */ ++int rtw_ch_set_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch) ++{ ++ int i; ++ for (i = 0; ch_set[i].ChannelNum != 0; i++) { ++ if (ch == ch_set[i].ChannelNum) ++ break; ++ } ++ ++ if (i >= ch_set[i].ChannelNum) ++ return -1; ++ return i; ++} ++ ++/* ++ * Check if the @param ch, bw, offset is valid for the given @param ch_set ++ * @ch_set: the given channel set ++ * @ch: the given channel number ++ * @bw: the given bandwidth ++ * @offset: the given channel offset ++ * ++ * return valid (1) or not (0) ++ */ ++u8 rtw_chset_is_chbw_valid(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) ++{ ++ u8 cch; ++ u8 *op_chs; ++ u8 op_ch_num; ++ u8 valid = 0; ++ int i; ++ ++ cch = rtw_get_center_ch(ch, bw, offset); ++ ++ if (!rtw_get_op_chs_by_cch_bw(cch, bw, &op_chs, &op_ch_num)) ++ goto exit; ++ ++ for (i = 0; i < op_ch_num; i++) { ++ if (0) ++ RTW_INFO("%u,%u,%u - cch:%u, bw:%u, op_ch:%u\n", ch, bw, offset, cch, bw, *(op_chs + i)); ++ if (rtw_ch_set_search_ch(ch_set, *(op_chs + i)) == -1) ++ break; ++ } ++ ++ if (op_ch_num != 0 && i == op_ch_num) ++ valid = 1; ++ ++exit: ++ return valid; ++} ++ ++/* ++ * Check the @param ch is fit with setband setting of @param adapter ++ * @adapter: the given adapter ++ * @ch: the given channel number ++ * ++ * return _TRUE when check valid, _FALSE not valid ++ */ ++bool rtw_mlme_band_check(_adapter *adapter, const u32 ch) ++{ ++ if (adapter->setband == WIFI_FREQUENCY_BAND_AUTO /* 2.4G and 5G */ ++ || (adapter->setband == WIFI_FREQUENCY_BAND_2GHZ && ch < 35) /* 2.4G only */ ++ || (adapter->setband == WIFI_FREQUENCY_BAND_5GHZ && ch > 35) /* 5G only */ ++ ) ++ return _TRUE; ++ return _FALSE; ++} ++inline void RTW_SET_SCAN_BAND_SKIP(_adapter *padapter, int skip_band) ++{ ++ int bs = ATOMIC_READ(&padapter->bandskip); ++ ++ bs |= skip_band; ++ ATOMIC_SET(&padapter->bandskip, bs); ++} ++ ++inline void RTW_CLR_SCAN_BAND_SKIP(_adapter *padapter, int skip_band) ++{ ++ int bs = ATOMIC_READ(&padapter->bandskip); ++ ++ bs &= ~(skip_band); ++ ATOMIC_SET(&padapter->bandskip, bs); ++} ++inline int RTW_GET_SCAN_BAND_SKIP(_adapter *padapter) ++{ ++ return ATOMIC_READ(&padapter->bandskip); ++} ++ ++#define RTW_IS_SCAN_BAND_SKIP(padapter, skip_band) (ATOMIC_READ(&padapter->bandskip) & (skip_band)) ++ ++bool rtw_mlme_ignore_chan(_adapter *adapter, const u32 ch) ++{ ++ if (RTW_IS_SCAN_BAND_SKIP(adapter, BAND_24G) && ch < 35) /* SKIP 2.4G Band channel */ ++ return _TRUE; ++ if (RTW_IS_SCAN_BAND_SKIP(adapter, BAND_5G) && ch > 35) /* SKIP 5G Band channel */ ++ return _TRUE; ++ ++ return _FALSE; ++} ++ ++ ++/**************************************************************************** ++ ++Following are the initialization functions for WiFi MLME ++ ++*****************************************************************************/ ++ ++int init_hw_mlme_ext(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ /* set_opmode_cmd(padapter, infra_client_with_mlme); */ /* removed */ ++ ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ ++ return _SUCCESS; ++} ++ ++void init_mlme_default_rate_set(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ unsigned char supported_b_mode[b_mode_rate_num] = ++ {_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_}; ++ unsigned char supported_g_mode[g_mode_rate_num] = ++ {_6M_RATE_, _9M_RATE_, _12M_RATE_, _18M_RATE_,\ ++ _24M_RATE_, _36M_RATE_, _48M_RATE_, _54M_RATE_}; ++ unsigned char supported_mcs_set[16] = {0xff, 0xff, 0xff, 0x00, 0x00, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; ++ unsigned char end_set[1] = {0xff}; ++ u8 offset = 0; ++#if 1 ++ if (IsSupportedTxCCK(padapter->registrypriv.wireless_mode)) { ++ _rtw_memcpy(pmlmeext->datarate, ++ supported_b_mode, b_mode_rate_num); ++ _rtw_memcpy(pmlmeext->basicrate, ++ supported_b_mode, b_mode_rate_num); ++ offset += b_mode_rate_num; ++ RTW_INFO("%s: support CCK\n", __func__); ++ } ++ ++ if (IsSupportedTxOFDM(padapter->registrypriv.wireless_mode)) { ++ _rtw_memcpy(pmlmeext->datarate + offset, ++ supported_g_mode, g_mode_rate_num); ++ _rtw_memcpy(pmlmeext->basicrate + offset, ++ supported_g_mode, g_mode_rate_num); ++ offset += g_mode_rate_num; ++ RTW_INFO("%s: support OFDM\n", __func__); ++ } ++ ++ _rtw_memcpy(pmlmeext->datarate + offset, end_set, 1); ++ _rtw_memcpy(pmlmeext->basicrate + offset, end_set, 1); ++#else ++ _rtw_memcpy(pmlmeext->datarate, mixed_datarate, NumRates); ++ _rtw_memcpy(pmlmeext->basicrate, mixed_basicrate, NumRates); ++#endif ++#ifdef CONFIG_80211N_HT ++ _rtw_memcpy(pmlmeext->default_supported_mcs_set, supported_mcs_set, ++ sizeof(pmlmeext->default_supported_mcs_set)); ++#endif ++} ++ ++static void init_mlme_ext_priv_value(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ ATOMIC_SET(&pmlmeext->event_seq, 0); ++ pmlmeext->mgnt_seq = 0;/* reset to zero when disconnect at client mode */ ++#ifdef CONFIG_IEEE80211W ++ pmlmeext->sa_query_seq = 0; ++ pmlmeext->mgnt_80211w_IPN = 0; ++ pmlmeext->mgnt_80211w_IPN_rx = 0; ++#endif /* CONFIG_IEEE80211W */ ++ pmlmeext->cur_channel = padapter->registrypriv.channel; ++ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ pmlmeext->retry = 0; ++ ++ pmlmeext->cur_wireless_mode = padapter->registrypriv.wireless_mode; ++ ++ init_mlme_default_rate_set(padapter); ++ ++ if (pmlmeext->cur_channel > 14) ++ pmlmeext->tx_rate = IEEE80211_OFDM_RATE_6MB; ++ else ++ pmlmeext->tx_rate = IEEE80211_CCK_RATE_1MB; ++ ++ mlmeext_set_scan_state(pmlmeext, SCAN_DISABLE); ++ pmlmeext->sitesurvey_res.channel_idx = 0; ++ pmlmeext->sitesurvey_res.bss_cnt = 0; ++ pmlmeext->sitesurvey_res.scan_ch_ms = SURVEY_TO; ++ pmlmeext->sitesurvey_res.rx_ampdu_accept = RX_AMPDU_ACCEPT_INVALID; ++ pmlmeext->sitesurvey_res.rx_ampdu_size = RX_AMPDU_SIZE_INVALID; ++#ifdef CONFIG_SCAN_BACKOP ++ mlmeext_assign_scan_backop_flags_sta(pmlmeext, /*SS_BACKOP_EN|*/SS_BACKOP_PS_ANNC | SS_BACKOP_TX_RESUME); ++ mlmeext_assign_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN | SS_BACKOP_PS_ANNC | SS_BACKOP_TX_RESUME); ++ pmlmeext->sitesurvey_res.scan_cnt = 0; ++ pmlmeext->sitesurvey_res.scan_cnt_max = RTW_SCAN_NUM_OF_CH; ++ pmlmeext->sitesurvey_res.backop_ms = RTW_BACK_OP_CH_MS; ++#endif ++#if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) ++ pmlmeext->sitesurvey_res.is_sw_antdiv_bl_scan = 0; ++#endif ++ pmlmeext->scan_abort = _FALSE; ++ ++ pmlmeinfo->state = WIFI_FW_NULL_STATE; ++ pmlmeinfo->reauth_count = 0; ++ pmlmeinfo->reassoc_count = 0; ++ pmlmeinfo->link_count = 0; ++ pmlmeinfo->auth_seq = 0; ++ pmlmeinfo->auth_algo = dot11AuthAlgrthm_Open; ++ pmlmeinfo->key_index = 0; ++ pmlmeinfo->iv = 0; ++ ++ pmlmeinfo->enc_algo = _NO_PRIVACY_; ++ pmlmeinfo->authModeToggle = 0; ++ ++ _rtw_memset(pmlmeinfo->chg_txt, 0, 128); ++ ++ pmlmeinfo->slotTime = SHORT_SLOT_TIME; ++ pmlmeinfo->preamble_mode = PREAMBLE_AUTO; ++ ++ pmlmeinfo->dialogToken = 0; ++ ++ pmlmeext->action_public_rxseq = 0xffff; ++ pmlmeext->action_public_dialog_token = 0xff; ++} ++ ++static int has_channel(RT_CHANNEL_INFO *channel_set, ++ u8 chanset_size, ++ u8 chan) ++{ ++ int i; ++ ++ for (i = 0; i < chanset_size; i++) { ++ if (channel_set[i].ChannelNum == chan) ++ return 1; ++ } ++ ++ return 0; ++} ++ ++static void init_channel_list(_adapter *padapter, RT_CHANNEL_INFO *channel_set, ++ u8 chanset_size, ++ struct p2p_channels *channel_list) ++{ ++ struct registry_priv *regsty = adapter_to_regsty(padapter); ++ ++ struct p2p_oper_class_map op_class[] = { ++ { IEEE80211G, 81, 1, 13, 1, BW20 }, ++ { IEEE80211G, 82, 14, 14, 1, BW20 }, ++#if 0 /* Do not enable HT40 on 2 GHz */ ++ { IEEE80211G, 83, 1, 9, 1, BW40PLUS }, ++ { IEEE80211G, 84, 5, 13, 1, BW40MINUS }, ++#endif ++ { IEEE80211A, 115, 36, 48, 4, BW20 }, ++ { IEEE80211A, 116, 36, 44, 8, BW40PLUS }, ++ { IEEE80211A, 117, 40, 48, 8, BW40MINUS }, ++ { IEEE80211A, 124, 149, 161, 4, BW20 }, ++ { IEEE80211A, 125, 149, 169, 4, BW20 }, ++ { IEEE80211A, 126, 149, 157, 8, BW40PLUS }, ++ { IEEE80211A, 127, 153, 161, 8, BW40MINUS }, ++ { -1, 0, 0, 0, 0, BW20 } ++ }; ++ ++ int cla, op; ++ ++ cla = 0; ++ ++ for (op = 0; op_class[op].op_class; op++) { ++ u8 ch; ++ struct p2p_oper_class_map *o = &op_class[op]; ++ struct p2p_reg_class *reg = NULL; ++ ++ for (ch = o->min_chan; ch <= o->max_chan; ch += o->inc) { ++ if (!has_channel(channel_set, chanset_size, ch)) ++ continue; ++#ifdef CONFIG_80211N_HT ++ if ((0 == padapter->registrypriv.ht_enable) && (8 == o->inc)) ++ continue; ++ ++ if ((REGSTY_IS_BW_5G_SUPPORT(regsty, CHANNEL_WIDTH_40)) && ++ ((BW40MINUS == o->bw) || (BW40PLUS == o->bw))) ++ continue; ++#endif ++ if (reg == NULL) { ++ reg = &channel_list->reg_class[cla]; ++ cla++; ++ reg->reg_class = o->op_class; ++ reg->channels = 0; ++ } ++ reg->channel[reg->channels] = ch; ++ reg->channels++; ++ } ++ } ++ channel_list->reg_classes = cla; ++ ++} ++ ++bool rtw_regsty_is_excl_chs(struct registry_priv *regsty, u8 ch) ++{ ++ int i; ++ ++ for (i = 0; i < MAX_CHANNEL_NUM; i++) { ++ if (regsty->excl_chs[i] == 0) ++ break; ++ if (regsty->excl_chs[i] == ch) ++ return _TRUE; ++ } ++ return _FALSE; ++} ++ ++static u8 init_channel_set(_adapter *padapter, u8 ChannelPlan, RT_CHANNEL_INFO *channel_set) ++{ ++ struct registry_priv *regsty = adapter_to_regsty(padapter); ++ u8 index, chanset_size = 0; ++ u8 b5GBand = _FALSE, b2_4GBand = _FALSE; ++ u8 Index2G = 0, Index5G = 0; ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); ++ int i; ++ ++ if (!rtw_is_channel_plan_valid(ChannelPlan)) { ++ RTW_ERR("ChannelPlan ID 0x%02X error !!!!!\n", ChannelPlan); ++ return chanset_size; ++ } ++ ++ _rtw_memset(channel_set, 0, sizeof(RT_CHANNEL_INFO) * MAX_CHANNEL_NUM); ++ ++ if (IsSupported24G(padapter->registrypriv.wireless_mode)) ++ b2_4GBand = _TRUE; ++ ++ if (IsSupported5G(padapter->registrypriv.wireless_mode)) ++ b5GBand = _TRUE; ++ ++ if (b2_4GBand) { ++ if (RTW_CHPLAN_REALTEK_DEFINE == ChannelPlan) ++ Index2G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index2G; ++ else ++ Index2G = RTW_ChannelPlanMap[ChannelPlan].Index2G; ++ ++ for (index = 0; index < CH_LIST_LEN(RTW_ChannelPlan2G[Index2G]); index++) { ++ if (rtw_regsty_is_excl_chs(regsty, CH_LIST_CH(RTW_ChannelPlan2G[Index2G], index)) == _TRUE) ++ continue; ++ ++ channel_set[chanset_size].ChannelNum = CH_LIST_CH(RTW_ChannelPlan2G[Index2G], index); ++ ++ if (RTW_CHPLAN_GLOBAL_DOAMIN == ChannelPlan ++ || RTW_CHPLAN_GLOBAL_NULL == ChannelPlan ++ ) { ++ /* Channel 1~11 is active, and 12~14 is passive */ ++ if (channel_set[chanset_size].ChannelNum >= 1 && channel_set[chanset_size].ChannelNum <= 11) ++ channel_set[chanset_size].ScanType = SCAN_ACTIVE; ++ else if ((channel_set[chanset_size].ChannelNum >= 12 && channel_set[chanset_size].ChannelNum <= 14)) ++ channel_set[chanset_size].ScanType = SCAN_PASSIVE; ++ } else if (RTW_CHPLAN_WORLD_WIDE_13 == ChannelPlan ++ || RTW_CHPLAN_WORLD_WIDE_5G == ChannelPlan ++ || RTW_RD_2G_WORLD == Index2G ++ ) { ++ /* channel 12~13, passive scan */ ++ if (channel_set[chanset_size].ChannelNum <= 11) ++ channel_set[chanset_size].ScanType = SCAN_ACTIVE; ++ else ++ channel_set[chanset_size].ScanType = SCAN_PASSIVE; ++ } else ++ channel_set[chanset_size].ScanType = SCAN_ACTIVE; ++ ++ chanset_size++; ++ } ++ } ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ if (b5GBand) { ++ if (RTW_CHPLAN_REALTEK_DEFINE == ChannelPlan) ++ Index5G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index5G; ++ else ++ Index5G = RTW_ChannelPlanMap[ChannelPlan].Index5G; ++ ++ for (index = 0; index < CH_LIST_LEN(RTW_ChannelPlan5G[Index5G]); index++) { ++ if (rtw_regsty_is_excl_chs(regsty, CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index)) == _TRUE) ++ continue; ++#ifdef CONFIG_DFS ++ channel_set[chanset_size].ChannelNum = CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index); ++ if (channel_set[chanset_size].ChannelNum <= 48 ++ || channel_set[chanset_size].ChannelNum >= 149 ++ ) { ++ if (RTW_CHPLAN_WORLD_WIDE_5G == ChannelPlan) /* passive scan for all 5G channels */ ++ channel_set[chanset_size].ScanType = SCAN_PASSIVE; ++ else ++ channel_set[chanset_size].ScanType = SCAN_ACTIVE; ++ } else ++ channel_set[chanset_size].ScanType = SCAN_PASSIVE; ++ chanset_size++; ++#else /* CONFIG_DFS */ ++ if (CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index) <= 48 ++ || CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index) >= 149 ++ ) { ++ channel_set[chanset_size].ChannelNum = CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index); ++ if (RTW_CHPLAN_WORLD_WIDE_5G == ChannelPlan) /* passive scan for all 5G channels */ ++ channel_set[chanset_size].ScanType = SCAN_PASSIVE; ++ else ++ channel_set[chanset_size].ScanType = SCAN_ACTIVE; ++ chanset_size++; ++ } ++#endif /* CONFIG_DFS */ ++ } ++ } ++ ++ #ifdef CONFIG_DFS_MASTER ++ for (i = 0; i < chanset_size; i++) ++ channel_set[i].non_ocp_end_time = rtw_get_current_time(); ++ #endif ++#endif /* CONFIG_IEEE80211_BAND_5GHZ */ ++ ++ if (RTW_CHPLAN_REALTEK_DEFINE == ChannelPlan) { ++ hal_data->Regulation2_4G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.regd; ++ hal_data->Regulation5G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.regd; ++ } else { ++ hal_data->Regulation2_4G = RTW_ChannelPlanMap[ChannelPlan].regd; ++ hal_data->Regulation5G = RTW_ChannelPlanMap[ChannelPlan].regd; ++ } ++ ++ RTW_INFO(FUNC_ADPT_FMT" ChannelPlan ID:0x%02x, ch num:%d\n" ++ , FUNC_ADPT_ARG(padapter), ChannelPlan, chanset_size); ++ ++ return chanset_size; ++} ++ ++int init_mlme_ext_priv(_adapter *padapter) ++{ ++ int res = _SUCCESS; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). */ ++ /* _rtw_memset((u8 *)pmlmeext, 0, sizeof(struct mlme_ext_priv)); */ ++ ++ pmlmeext->padapter = padapter; ++ ++ /* fill_fwpriv(padapter, &(pmlmeext->fwpriv)); */ ++ ++ init_mlme_ext_priv_value(padapter); ++ pmlmeinfo->bAcceptAddbaReq = pregistrypriv->bAcceptAddbaReq; ++ ++ init_mlme_ext_timer(padapter); ++ ++#ifdef CONFIG_AP_MODE ++ init_mlme_ap_info(padapter); ++#endif ++ ++ pmlmeext->max_chan_nums = init_channel_set(padapter, pmlmepriv->ChannelPlan, pmlmeext->channel_set); ++ init_channel_list(padapter, pmlmeext->channel_set, pmlmeext->max_chan_nums, &pmlmeext->channel_list); ++ pmlmeext->last_scan_time = 0; ++ pmlmeext->mlmeext_init = _TRUE; ++ ++ ++#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++ pmlmeext->active_keep_alive_check = _TRUE; ++#else ++ pmlmeext->active_keep_alive_check = _FALSE; ++#endif ++ ++#ifdef DBG_FIXED_CHAN ++ pmlmeext->fixed_chan = 0xFF; ++#endif ++ ++ return res; ++ ++} ++ ++void free_mlme_ext_priv(struct mlme_ext_priv *pmlmeext) ++{ ++ _adapter *padapter = pmlmeext->padapter; ++ ++ if (!padapter) ++ return; ++ ++ if (rtw_is_drv_stopped(padapter)) { ++ _cancel_timer_ex(&pmlmeext->survey_timer); ++ _cancel_timer_ex(&pmlmeext->link_timer); ++ /* _cancel_timer_ex(&pmlmeext->ADDBA_timer); */ ++ } ++} ++ ++static u8 cmp_pkt_chnl_diff(_adapter *padapter, u8 *pframe, uint packet_len) ++{ ++ /* if the channel is same, return 0. else return channel differential */ ++ uint len; ++ u8 channel; ++ u8 *p; ++ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_, _DSSET_IE_, &len, packet_len - _BEACON_IE_OFFSET_); ++ if (p) { ++ channel = *(p + 2); ++ if (padapter->mlmeextpriv.cur_channel >= channel) ++ return padapter->mlmeextpriv.cur_channel - channel; ++ else ++ return channel - padapter->mlmeextpriv.cur_channel; ++ } else ++ return 0; ++} ++ ++static void _mgt_dispatcher(_adapter *padapter, struct mlme_handler *ptable, union recv_frame *precv_frame) ++{ ++ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ ++ if (ptable->func) { ++ /* receive the frames that ra(a1) is my address or ra(a1) is bc address. */ ++ if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_mac_addr(padapter), ETH_ALEN) && ++ !_rtw_memcmp(GetAddr1Ptr(pframe), bc_addr, ETH_ALEN)) ++ return; ++ ++ ptable->func(padapter, precv_frame); ++ } ++ ++} ++ ++void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ int index; ++ struct mlme_handler *ptable; ++#ifdef CONFIG_AP_MODE ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++#endif /* CONFIG_AP_MODE */ ++ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, GetAddr2Ptr(pframe)); ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ ++ ++#if 0 ++ { ++ u8 *pbuf; ++ pbuf = GetAddr1Ptr(pframe); ++ RTW_INFO("A1-%x:%x:%x:%x:%x:%x\n", *pbuf, *(pbuf + 1), *(pbuf + 2), *(pbuf + 3), *(pbuf + 4), *(pbuf + 5)); ++ pbuf = GetAddr2Ptr(pframe); ++ RTW_INFO("A2-%x:%x:%x:%x:%x:%x\n", *pbuf, *(pbuf + 1), *(pbuf + 2), *(pbuf + 3), *(pbuf + 4), *(pbuf + 5)); ++ pbuf = GetAddr3Ptr(pframe); ++ RTW_INFO("A3-%x:%x:%x:%x:%x:%x\n", *pbuf, *(pbuf + 1), *(pbuf + 2), *(pbuf + 3), *(pbuf + 4), *(pbuf + 5)); ++ } ++#endif ++ ++ if (GetFrameType(pframe) != WIFI_MGT_TYPE) { ++ return; ++ } ++ ++ /* receive the frames that ra(a1) is my address or ra(a1) is bc address. */ ++ if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_mac_addr(padapter), ETH_ALEN) && ++ !_rtw_memcmp(GetAddr1Ptr(pframe), bc_addr, ETH_ALEN)) ++ return; ++ ++ ptable = mlme_sta_tbl; ++ ++ index = GetFrameSubType(pframe) >> 4; ++ ++#ifdef CONFIG_TDLS ++ if ((index << 4) == WIFI_ACTION) { ++ /* category==public (4), action==TDLS_DISCOVERY_RESPONSE */ ++ if (*(pframe + 24) == RTW_WLAN_CATEGORY_PUBLIC && *(pframe + 25) == TDLS_DISCOVERY_RESPONSE) { ++ RTW_INFO("[TDLS] Recv %s from "MAC_FMT"\n", rtw_tdls_action_txt(TDLS_DISCOVERY_RESPONSE), MAC_ARG(GetAddr2Ptr(pframe))); ++ On_TDLS_Dis_Rsp(padapter, precv_frame); ++ } ++ } ++#endif /* CONFIG_TDLS */ ++ ++ if (index >= (sizeof(mlme_sta_tbl) / sizeof(struct mlme_handler))) { ++ return; ++ } ++ ptable += index; ++ ++#if 1 ++ if (psta != NULL) { ++ if (GetRetry(pframe)) { ++ if (precv_frame->u.hdr.attrib.seq_num == psta->RxMgmtFrameSeqNum) { ++ /* drop the duplicate management frame */ ++ pdbgpriv->dbg_rx_dup_mgt_frame_drop_count++; ++ RTW_INFO("Drop duplicate management frame with seq_num = %d.\n", precv_frame->u.hdr.attrib.seq_num); ++ return; ++ } ++ } ++ psta->RxMgmtFrameSeqNum = precv_frame->u.hdr.attrib.seq_num; ++ } ++#else ++ ++ if (GetRetry(pframe)) { ++ /* return; */ ++ } ++#endif ++ ++#ifdef CONFIG_AP_MODE ++ switch (GetFrameSubType(pframe)) { ++ case WIFI_AUTH: ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ ptable->func = &OnAuth; ++ else ++ ptable->func = &OnAuthClient; ++ /* pass through */ ++ case WIFI_ASSOCREQ: ++ case WIFI_REASSOCREQ: ++ _mgt_dispatcher(padapter, ptable, precv_frame); ++#ifdef CONFIG_HOSTAPD_MLME ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ rtw_hostapd_mlme_rx(padapter, precv_frame); ++#endif ++ break; ++ case WIFI_PROBEREQ: ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { ++#ifdef CONFIG_HOSTAPD_MLME ++ rtw_hostapd_mlme_rx(padapter, precv_frame); ++#else ++ _mgt_dispatcher(padapter, ptable, precv_frame); ++#endif ++ } else ++ _mgt_dispatcher(padapter, ptable, precv_frame); ++ break; ++ case WIFI_BEACON: ++ _mgt_dispatcher(padapter, ptable, precv_frame); ++ break; ++ case WIFI_ACTION: ++ /* if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) */ ++ _mgt_dispatcher(padapter, ptable, precv_frame); ++ break; ++ default: ++ _mgt_dispatcher(padapter, ptable, precv_frame); ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ rtw_hostapd_mlme_rx(padapter, precv_frame); ++ break; ++ } ++#else ++ ++ _mgt_dispatcher(padapter, ptable, precv_frame); ++ ++#endif ++ ++} ++ ++#ifdef CONFIG_P2P ++u32 p2p_listen_state_process(_adapter *padapter, unsigned char *da) ++{ ++ bool response = _TRUE; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) { ++ if (rtw_cfg80211_get_is_roch(padapter) == _FALSE ++ || rtw_get_oper_ch(padapter) != padapter->wdinfo.listen_channel ++ || adapter_wdev_data(padapter)->p2p_enabled == _FALSE ++ || padapter->mlmepriv.wps_probe_resp_ie == NULL ++ || padapter->mlmepriv.p2p_probe_resp_ie == NULL ++ ) { ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO(ADPT_FMT" DON'T issue_probersp_p2p: p2p_enabled:%d, wps_probe_resp_ie:%p, p2p_probe_resp_ie:%p\n" ++ , ADPT_ARG(padapter) ++ , adapter_wdev_data(padapter)->p2p_enabled ++ , padapter->mlmepriv.wps_probe_resp_ie ++ , padapter->mlmepriv.p2p_probe_resp_ie); ++ RTW_INFO(ADPT_FMT" DON'T issue_probersp_p2p: is_ro_ch:%d, op_ch:%d, p2p_listen_channel:%d\n" ++ , ADPT_ARG(padapter) ++ , rtw_cfg80211_get_is_roch(padapter) ++ , rtw_get_oper_ch(padapter) ++ , padapter->wdinfo.listen_channel); ++#endif ++ response = _FALSE; ++ } ++ } else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ if (padapter->wdinfo.driver_interface == DRIVER_WEXT) { ++ /* do nothing if the device name is empty */ ++ if (!padapter->wdinfo.device_name_len) ++ response = _FALSE; ++ } ++ ++ if (response == _TRUE) ++ issue_probersp_p2p(padapter, da); ++ ++ return _SUCCESS; ++} ++#endif /* CONFIG_P2P */ ++ ++ ++/**************************************************************************** ++ ++Following are the callback functions for each subtype of the management frames ++ ++*****************************************************************************/ ++ ++unsigned int OnProbeReq(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ unsigned int ielen; ++ unsigned char *p; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur = &(pmlmeinfo->network); ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint len = precv_frame->u.hdr.len; ++ u8 is_valid_p2p_probereq = _FALSE; ++ ++#ifdef CONFIG_ATMEL_RC_PATCH ++ u8 *target_ie = NULL, *wps_ie = NULL; ++ u8 *start; ++ uint search_len = 0, wps_ielen = 0, target_ielen = 0; ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++#endif ++ ++ ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ u8 wifi_test_chk_rate = 1; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if ((pwdinfo->driver_interface == DRIVER_CFG80211) ++ && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) ++ && (GET_CFG80211_REPORT_MGMT(adapter_wdev_data(padapter), IEEE80211_STYPE_PROBE_REQ) == _TRUE) ++ ) { ++ rtw_cfg80211_rx_probe_request(padapter, precv_frame); ++ return _SUCCESS; ++ } ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && ++ !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE) && ++ !rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) && ++ !rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH) && ++ !rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) ++ ) { ++ /* Commented by Albert 2011/03/17 */ ++ /* mcs_rate = 0->CCK 1M rate */ ++ /* mcs_rate = 1->CCK 2M rate */ ++ /* mcs_rate = 2->CCK 5.5M rate */ ++ /* mcs_rate = 3->CCK 11M rate */ ++ /* In the P2P mode, the driver should not support the CCK rate */ ++ ++ /* Commented by Kurt 2012/10/16 */ ++ /* IOT issue: Google Nexus7 use 1M rate to send p2p_probe_req after GO nego completed and Nexus7 is client */ ++ if (padapter->registrypriv.wifi_spec == 1) { ++ if (pattrib->data_rate <= 3) ++ wifi_test_chk_rate = 0; ++ } ++ ++ if (wifi_test_chk_rate == 1) { ++ is_valid_p2p_probereq = process_probe_req_p2p_ie(pwdinfo, pframe, len); ++ if (is_valid_p2p_probereq == _TRUE) { ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE)) { ++ /* FIXME */ ++ if (padapter->wdinfo.driver_interface == DRIVER_WEXT) ++ report_survey_event(padapter, precv_frame); ++ ++ p2p_listen_state_process(padapter, get_sa(pframe)); ++ ++ return _SUCCESS; ++ } ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) ++ goto _continue; ++ } ++ } ++ } ++ ++_continue: ++#endif /* CONFIG_P2P */ ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) ++ return _SUCCESS; ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _FALSE && ++ check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_AP_STATE) == _FALSE) ++ return _SUCCESS; ++ ++ ++ /* RTW_INFO("+OnProbeReq\n"); */ ++ ++ ++#ifdef CONFIG_ATMEL_RC_PATCH ++ wps_ie = rtw_get_wps_ie( ++ pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, ++ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_, ++ NULL, &wps_ielen); ++ if (wps_ie) ++ target_ie = rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_MANUFACTURER, NULL, &target_ielen); ++ if ((target_ie && (target_ielen == 4)) && (_TRUE == _rtw_memcmp((void *)target_ie, "Ozmo", 4))) { ++ /* psta->flag_atmel_rc = 1; */ ++ unsigned char *sa_addr = get_sa(pframe); ++ printk("%s: Find Ozmo RC -- %02x:%02x:%02x:%02x:%02x:%02x \n\n", ++ __func__, *sa_addr, *(sa_addr + 1), *(sa_addr + 2), *(sa_addr + 3), *(sa_addr + 4), *(sa_addr + 5)); ++ _rtw_memcpy(pstapriv->atmel_rc_pattern, get_sa(pframe), ETH_ALEN); ++ } ++#endif ++ ++ ++#ifdef CONFIG_AUTO_AP_MODE ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && ++ pmlmepriv->cur_network.join_res == _TRUE) { ++ _irqL irqL; ++ struct sta_info *psta; ++ u8 *mac_addr, *peer_addr; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 RC_OUI[4] = {0x00, 0xE0, 0x4C, 0x0A}; ++ /* EID[1] + EID_LEN[1] + RC_OUI[4] + MAC[6] + PairingID[2] + ChannelNum[2] */ ++ ++ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, (int *)&ielen, ++ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); ++ ++ if (!p || ielen != 14) ++ goto _non_rc_device; ++ ++ if (!_rtw_memcmp(p + 2, RC_OUI, sizeof(RC_OUI))) ++ goto _non_rc_device; ++ ++ if (!_rtw_memcmp(p + 6, get_sa(pframe), ETH_ALEN)) { ++ RTW_INFO("%s, do rc pairing ("MAC_FMT"), but mac addr mismatch!("MAC_FMT")\n", __FUNCTION__, ++ MAC_ARG(get_sa(pframe)), MAC_ARG(p + 6)); ++ ++ goto _non_rc_device; ++ } ++ ++ RTW_INFO("%s, got the pairing device("MAC_FMT")\n", __FUNCTION__, MAC_ARG(get_sa(pframe))); ++ ++ /* new a station */ ++ psta = rtw_get_stainfo(pstapriv, get_sa(pframe)); ++ if (psta == NULL) { ++ /* allocate a new one */ ++ RTW_INFO("going to alloc stainfo for rc="MAC_FMT"\n", MAC_ARG(get_sa(pframe))); ++ psta = rtw_alloc_stainfo(pstapriv, get_sa(pframe)); ++ if (psta == NULL) { ++ /* TODO: */ ++ RTW_INFO(" Exceed the upper limit of supported clients...\n"); ++ return _SUCCESS; ++ } ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ if (rtw_is_list_empty(&psta->asoc_list)) { ++ psta->expire_to = pstapriv->expire_to; ++ rtw_list_insert_tail(&psta->asoc_list, &pstapriv->asoc_list); ++ pstapriv->asoc_list_cnt++; ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ /* generate pairing ID */ ++ mac_addr = adapter_mac_addr(padapter); ++ peer_addr = psta->hwaddr; ++ psta->pid = (u16)(((mac_addr[4] << 8) + mac_addr[5]) + ((peer_addr[4] << 8) + peer_addr[5])); ++ ++ /* update peer stainfo */ ++ psta->isrc = _TRUE; ++ ++ /* get a unique AID */ ++ if (psta->aid > 0) ++ RTW_INFO("old AID %d\n", psta->aid); ++ else { ++ for (psta->aid = 1; psta->aid <= NUM_STA; psta->aid++) ++ if (pstapriv->sta_aid[psta->aid - 1] == NULL) ++ break; ++ ++ if (psta->aid > pstapriv->max_num_sta) { ++ psta->aid = 0; ++ RTW_INFO("no room for more AIDs\n"); ++ return _SUCCESS; ++ } else { ++ pstapriv->sta_aid[psta->aid - 1] = psta; ++ RTW_INFO("allocate new AID = (%d)\n", psta->aid); ++ } ++ } ++ ++ psta->qos_option = 1; ++ psta->bw_mode = CHANNEL_WIDTH_20; ++ psta->ieee8021x_blocked = _FALSE; ++#ifdef CONFIG_80211N_HT ++ psta->htpriv.ht_option = _TRUE; ++ psta->htpriv.ampdu_enable = _FALSE; ++ psta->htpriv.sgi_20m = _FALSE; ++ psta->htpriv.sgi_40m = _FALSE; ++ psta->htpriv.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ ++ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ ++#endif ++ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); ++ ++ _rtw_memset((void *)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); ++ ++ _enter_critical_bh(&psta->lock, &irqL); ++ psta->state |= _FW_LINKED; ++ _exit_critical_bh(&psta->lock, &irqL); ++ ++ report_add_sta_event(padapter, psta->hwaddr); ++ ++ } ++ ++ issue_probersp(padapter, get_sa(pframe), _FALSE); ++ ++ return _SUCCESS; ++ ++ } ++ ++_non_rc_device: ++ ++ return _SUCCESS; ++ ++#endif /* CONFIG_AUTO_AP_MODE */ ++ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) && ++ rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_LINKING | _FW_UNDER_SURVEY)) { ++ /* don't process probe req */ ++ return _SUCCESS; ++ } ++#endif ++ ++ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _SSID_IE_, (int *)&ielen, ++ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); ++ ++ ++ /* check (wildcard) SSID */ ++ if (p != NULL) { ++ if (is_valid_p2p_probereq == _TRUE) ++ goto _issue_probersp; ++ ++ if ((ielen != 0 && _FALSE == _rtw_memcmp((void *)(p + 2), (void *)cur->Ssid.Ssid, cur->Ssid.SsidLength)) ++ || (ielen == 0 && pmlmeinfo->hidden_ssid_mode) ++ ) ++ return _SUCCESS; ++ ++_issue_probersp: ++ if (((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && ++ pmlmepriv->cur_network.join_res == _TRUE)) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) { ++ /* RTW_INFO("+issue_probersp during ap mode\n"); */ ++ issue_probersp(padapter, get_sa(pframe), is_valid_p2p_probereq); ++ } ++ ++ } ++ ++ return _SUCCESS; ++ ++} ++ ++unsigned int OnProbeRsp(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct sta_info *psta; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++#endif ++ ++ ++#ifdef CONFIG_P2P ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) { ++ if (_TRUE == pwdinfo->tx_prov_disc_info.benable) { ++ if (_rtw_memcmp(pwdinfo->tx_prov_disc_info.peerIFAddr, GetAddr2Ptr(pframe), ETH_ALEN)) { ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) { ++ pwdinfo->tx_prov_disc_info.benable = _FALSE; ++ issue_p2p_provision_request(padapter, ++ pwdinfo->tx_prov_disc_info.ssid.Ssid, ++ pwdinfo->tx_prov_disc_info.ssid.SsidLength, ++ pwdinfo->tx_prov_disc_info.peerDevAddr); ++ } else if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ pwdinfo->tx_prov_disc_info.benable = _FALSE; ++ issue_p2p_provision_request(padapter, ++ NULL, ++ 0, ++ pwdinfo->tx_prov_disc_info.peerDevAddr); ++ } ++ } ++ } ++ return _SUCCESS; ++ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) { ++ if (_TRUE == pwdinfo->nego_req_info.benable) { ++ RTW_INFO("[%s] P2P State is GONEGO ING!\n", __FUNCTION__); ++ if (_rtw_memcmp(pwdinfo->nego_req_info.peerDevAddr, GetAddr2Ptr(pframe), ETH_ALEN)) { ++ pwdinfo->nego_req_info.benable = _FALSE; ++ issue_p2p_GO_request(padapter, pwdinfo->nego_req_info.peerDevAddr); ++ } ++ } ++ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ)) { ++ if (_TRUE == pwdinfo->invitereq_info.benable) { ++ RTW_INFO("[%s] P2P_STATE_TX_INVITE_REQ!\n", __FUNCTION__); ++ if (_rtw_memcmp(pwdinfo->invitereq_info.peer_macaddr, GetAddr2Ptr(pframe), ETH_ALEN)) { ++ pwdinfo->invitereq_info.benable = _FALSE; ++ issue_p2p_invitation_request(padapter, pwdinfo->invitereq_info.peer_macaddr); ++ } ++ } ++ } ++#endif ++ ++ ++ if (mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS)) { ++ rtw_mi_report_survey_event(padapter, precv_frame); ++ return _SUCCESS; ++ } ++ ++#if 0 /* move to validate_recv_mgnt_frame */ ++ if (_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN)) { ++ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) { ++ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ if (psta != NULL) ++ psta->sta_stats.rx_mgnt_pkts++; ++ } ++ } ++#endif ++ ++ return _SUCCESS; ++ ++} ++ ++/* for 11n Logo 4.2.31/4.2.32 */ ++static void rtw_check_legacy_ap(_adapter *padapter, u8 *pframe, u32 len) ++{ ++ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ if (!padapter->registrypriv.wifi_spec) ++ return; ++ ++ if(!MLME_IS_AP(padapter)) ++ return; ++ ++#ifdef CONFIG_AP_MODE ++ if (pmlmeext->bstart_bss == _TRUE) { ++ int left; ++ u16 capability; ++ unsigned char *pos; ++ struct rtw_ieee802_11_elems elems; ++ struct HT_info_element *pht_info = NULL; ++ u16 cur_op_mode; ++ ++ /* checking IEs */ ++ left = len - sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_; ++ pos = pframe + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_; ++ if (rtw_ieee802_11_parse_elems(pos, left, &elems, 1) == ParseFailed) { ++ RTW_INFO("%s: parse fail for "MAC_FMT"\n", __func__, MAC_ARG(GetAddr3Ptr(pframe))); ++ return; ++ } ++ ++#ifdef CONFIG_80211N_HT ++ cur_op_mode = pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_OP_MODE_MASK; ++#endif ++ ++ /* for legacy ap */ ++ if (elems.ht_capabilities == NULL && elems.ht_capabilities_len == 0) { ++ ++ if (0) ++ RTW_INFO("%s: "MAC_FMT" is legacy ap\n", __func__, MAC_ARG(GetAddr3Ptr(pframe))); ++ ++ ATOMIC_SET(&pmlmepriv->olbc, _TRUE); ++ ATOMIC_SET(&pmlmepriv->olbc_ht, _TRUE); ++ } ++ ++ } ++#endif ++} ++ ++unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct sta_info *psta; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint len = precv_frame->u.hdr.len; ++ WLAN_BSSID_EX *pbss; ++ int ret = _SUCCESS; ++ u8 *p = NULL; ++ u32 ielen = 0; ++#ifdef CONFIG_TDLS ++ struct sta_info *ptdls_sta; ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++#ifdef CONFIG_TDLS_CH_SW ++ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; ++#endif ++#endif /* CONFIG_TDLS */ ++ ++#ifdef CONFIG_ATTEMPT_TO_FIX_AP_BEACON_ERROR ++ p = rtw_get_ie(pframe + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ielen, ++ precv_frame->u.hdr.len - sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_); ++ if ((p != NULL) && (ielen > 0)) { ++ if ((*(p + 1 + ielen) == 0x2D) && (*(p + 2 + ielen) != 0x2D)) { ++ /* Invalid value 0x2D is detected in Extended Supported Rates (ESR) IE. Try to fix the IE length to avoid failed Beacon parsing. */ ++ RTW_INFO("[WIFIDBG] Error in ESR IE is detected in Beacon of BSSID:"MAC_FMT". Fix the length of ESR IE to avoid failed Beacon parsing.\n", MAC_ARG(GetAddr3Ptr(pframe))); ++ *(p + 1) = ielen - 1; ++ } ++ } ++#endif ++ ++ if (mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS)) { ++ rtw_mi_report_survey_event(padapter, precv_frame); ++ return _SUCCESS; ++ } ++ ++ ++ rtw_check_legacy_ap(padapter, pframe, len); ++ ++ if (_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN)) { ++ if (pmlmeinfo->state & WIFI_FW_AUTH_NULL) { ++ /* we should update current network before auth, or some IE is wrong */ ++ pbss = (WLAN_BSSID_EX *)rtw_malloc(sizeof(WLAN_BSSID_EX)); ++ if (pbss) { ++ if (collect_bss_info(padapter, precv_frame, pbss) == _SUCCESS) { ++ struct beacon_keys recv_beacon; ++ ++ update_network(&(pmlmepriv->cur_network.network), pbss, padapter, _TRUE); ++ rtw_get_bcn_info(&(pmlmepriv->cur_network)); ++ ++ /* update bcn keys */ ++ if (rtw_get_bcn_keys(padapter, pframe, len, &recv_beacon) == _TRUE) { ++ RTW_INFO("%s: beacon keys ready\n", __func__); ++ _rtw_memcpy(&pmlmepriv->cur_beacon_keys, ++ &recv_beacon, sizeof(recv_beacon)); ++ pmlmepriv->new_beacon_cnts = 0; ++ } else { ++ RTW_ERR("%s: get beacon keys failed\n", __func__); ++ _rtw_memset(&pmlmepriv->cur_beacon_keys, 0, sizeof(recv_beacon)); ++ pmlmepriv->new_beacon_cnts = 0; ++ } ++ } ++ rtw_mfree((u8 *)pbss, sizeof(WLAN_BSSID_EX)); ++ } ++ ++ /* check the vendor of the assoc AP */ ++ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pframe + sizeof(struct rtw_ieee80211_hdr_3addr), len - sizeof(struct rtw_ieee80211_hdr_3addr)); ++ ++ /* update TSF Value */ ++ update_TSF(pmlmeext, pframe, len); ++ ++ /* reset for adaptive_early_32k */ ++ pmlmeext->adaptive_tsf_done = _FALSE; ++ pmlmeext->DrvBcnEarly = 0xff; ++ pmlmeext->DrvBcnTimeOut = 0xff; ++ pmlmeext->bcn_cnt = 0; ++ _rtw_memset(pmlmeext->bcn_delay_cnt, 0, sizeof(pmlmeext->bcn_delay_cnt)); ++ _rtw_memset(pmlmeext->bcn_delay_ratio, 0, sizeof(pmlmeext->bcn_delay_ratio)); ++ ++#ifdef CONFIG_P2P_PS ++ process_p2p_ps_ie(padapter, (pframe + WLAN_HDR_A3_LEN), (len - WLAN_HDR_A3_LEN)); ++#endif /* CONFIG_P2P_PS */ ++ ++#if defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE) ++ if (padapter->registrypriv.wifi_spec) { ++ if (process_p2p_cross_connect_ie(padapter, (pframe + WLAN_HDR_A3_LEN), (len - WLAN_HDR_A3_LEN)) == _FALSE) { ++ if (rtw_mi_buddy_check_mlmeinfo_state(padapter, WIFI_FW_AP_STATE)) { ++ RTW_PRINT("no issue auth, P2P cross-connect does not permit\n "); ++ return _SUCCESS; ++ } ++ } ++ } ++#endif /* CONFIG_P2P CONFIG_P2P and CONFIG_CONCURRENT_MODE */ ++ ++ /* start auth */ ++ start_clnt_auth(padapter); ++ ++ return _SUCCESS; ++ } ++ ++ if (((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) && (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { ++ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ if (psta != NULL) { ++#ifdef CONFIG_PATCH_JOIN_WRONG_CHANNEL ++ /* Merge from 8712 FW code */ ++ if (cmp_pkt_chnl_diff(padapter, pframe, len) != 0) { ++ /* join wrong channel, deauth and reconnect */ ++ issue_deauth(padapter, (&(pmlmeinfo->network))->MacAddress, WLAN_REASON_DEAUTH_LEAVING); ++ ++ report_del_sta_event(padapter, (&(pmlmeinfo->network))->MacAddress, WLAN_REASON_JOIN_WRONG_CHANNEL, _TRUE, _FALSE); ++ pmlmeinfo->state &= (~WIFI_FW_ASSOC_SUCCESS); ++ return _SUCCESS; ++ } ++#endif /* CONFIG_PATCH_JOIN_WRONG_CHANNEL */ ++ ++ ret = rtw_check_bcn_info(padapter, pframe, len); ++ if (!ret) { ++ RTW_PRINT("ap has changed, disconnect now\n "); ++ receive_disconnect(padapter, pmlmeinfo->network.MacAddress , 0, _FALSE); ++ return _SUCCESS; ++ } ++ /* update WMM, ERP in the beacon */ ++ /* todo: the timer is used instead of the number of the beacon received */ ++ if ((sta_rx_pkts(psta) & 0xf) == 0) { ++ /* RTW_INFO("update_bcn_info\n"); */ ++ update_beacon_info(padapter, pframe, len, psta); ++ } ++ ++ pmlmepriv->cur_network_scanned->network.Rssi = precv_frame->u.hdr.attrib.phy_info.RecvSignalPower; ++ ++ adaptive_early_32k(pmlmeext, pframe, len); ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_TDLS_CH_SW ++ if (rtw_tdls_is_chsw_allowed(padapter) == _TRUE) { ++ /* Send TDLS Channel Switch Request when receiving Beacon */ ++ if ((padapter->tdlsinfo.chsw_info.ch_sw_state & TDLS_CH_SW_INITIATOR_STATE) && (ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) ++ && (pmlmeext->cur_channel == rtw_get_oper_ch(padapter))) { ++ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, padapter->tdlsinfo.chsw_info.addr); ++ if (ptdls_sta != NULL) { ++ if (ptdls_sta->tdls_sta_state | TDLS_LINKED_STATE) ++ _set_timer(&ptdls_sta->stay_on_base_chnl_timer, TDLS_CH_SW_STAY_ON_BASE_CHNL_TIMEOUT); ++ } ++ } ++ } ++#endif ++#endif /* CONFIG_TDLS */ ++ ++#ifdef CONFIG_DFS ++ process_csa_ie(padapter, pframe, len); /* channel switch announcement */ ++#endif /* CONFIG_DFS */ ++ ++#ifdef CONFIG_P2P_PS ++ process_p2p_ps_ie(padapter, (pframe + WLAN_HDR_A3_LEN), (len - WLAN_HDR_A3_LEN)); ++#endif /* CONFIG_P2P_PS */ ++ ++ if (pmlmeext->en_hw_update_tsf) ++ rtw_enable_hw_update_tsf_cmd(padapter); ++ ++#if 0 /* move to validate_recv_mgnt_frame */ ++ psta->sta_stats.rx_mgnt_pkts++; ++#endif ++ } ++ ++ } else if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { ++ _irqL irqL; ++ u8 rate_set[16]; ++ u8 rate_num = 0; ++ ++ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ if (psta != NULL) { ++ /* ++ * update WMM, ERP in the beacon ++ * todo: the timer is used instead of the number of the beacon received ++ */ ++ if ((sta_rx_pkts(psta) & 0xf) == 0) ++ update_beacon_info(padapter, pframe, len, psta); ++ ++ if (pmlmeext->en_hw_update_tsf) ++ rtw_enable_hw_update_tsf_cmd(padapter); ++ } else { ++ rtw_ies_get_supported_rate(pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_, len - WLAN_HDR_A3_LEN - _BEACON_IE_OFFSET_, rate_set, &rate_num); ++ if (rate_num == 0) { ++ RTW_INFO(FUNC_ADPT_FMT" RX beacon with no supported rate\n", FUNC_ADPT_ARG(padapter)); ++ goto _END_ONBEACON_; ++ } ++ ++ psta = rtw_alloc_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ if (psta == NULL) { ++ RTW_INFO(FUNC_ADPT_FMT" Exceed the upper limit of supported clients\n", FUNC_ADPT_ARG(padapter)); ++ goto _END_ONBEACON_; ++ } ++ ++ psta->expire_to = pstapriv->adhoc_expire_to; ++ ++ _rtw_memcpy(psta->bssrateset, rate_set, rate_num); ++ psta->bssratelen = rate_num; ++ ++ /* update TSF Value */ ++ update_TSF(pmlmeext, pframe, len); ++ ++ /* report sta add event */ ++ report_add_sta_event(padapter, GetAddr2Ptr(pframe)); ++ } ++ } ++ } ++ ++_END_ONBEACON_: ++ ++ return _SUCCESS; ++ ++} ++ ++unsigned int OnAuth(_adapter *padapter, union recv_frame *precv_frame) ++{ ++#ifdef CONFIG_AP_MODE ++ _irqL irqL; ++ unsigned int auth_mode, seq, ie_len; ++ unsigned char *sa, *p; ++ u16 algorithm; ++ int status; ++ static struct sta_info stat; ++ struct sta_info *pstat = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint len = precv_frame->u.hdr.len; ++ u8 offset = 0; ++ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) && ++ rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_LINKING | _FW_UNDER_SURVEY)) { ++ /* don't process auth request; */ ++ return _SUCCESS; ++ } ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) ++ return _FAIL; ++ ++ RTW_INFO("+OnAuth\n"); ++ ++ sa = GetAddr2Ptr(pframe); ++ ++ auth_mode = psecuritypriv->dot11AuthAlgrthm; ++ ++ if (GetPrivacy(pframe)) { ++ u8 *iv; ++ struct rx_pkt_attrib *prxattrib = &(precv_frame->u.hdr.attrib); ++ ++ prxattrib->hdrlen = WLAN_HDR_A3_LEN; ++ prxattrib->encrypt = _WEP40_; ++ ++ iv = pframe + prxattrib->hdrlen; ++ prxattrib->key_index = ((iv[3] >> 6) & 0x3); ++ ++ prxattrib->iv_len = 4; ++ prxattrib->icv_len = 4; ++ ++ rtw_wep_decrypt(padapter, (u8 *)precv_frame); ++ ++ offset = 4; ++ } ++ ++ algorithm = le16_to_cpu(*(u16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset)); ++ seq = le16_to_cpu(*(u16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 2)); ++ ++ RTW_INFO("auth alg=%x, seq=%X\n", algorithm, seq); ++ ++ if (auth_mode == 2 && ++ psecuritypriv->dot11PrivacyAlgrthm != _WEP40_ && ++ psecuritypriv->dot11PrivacyAlgrthm != _WEP104_) ++ auth_mode = 0; ++ ++ if ((algorithm > 0 && auth_mode == 0) || /* rx a shared-key auth but shared not enabled */ ++ (algorithm == 0 && auth_mode == 1)) { /* rx a open-system auth but shared-key is enabled */ ++ RTW_INFO("auth rejected due to bad alg [alg=%d, auth_mib=%d] %02X%02X%02X%02X%02X%02X\n", ++ algorithm, auth_mode, sa[0], sa[1], sa[2], sa[3], sa[4], sa[5]); ++ ++ status = _STATS_NO_SUPP_ALG_; ++ ++ goto auth_fail; ++ } ++ ++#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) ++ if (rtw_access_ctrl(padapter, sa) == _FALSE) { ++ status = _STATS_UNABLE_HANDLE_STA_; ++ goto auth_fail; ++ } ++#endif ++ ++ pstat = rtw_get_stainfo(pstapriv, sa); ++ if (pstat == NULL) { ++ ++ /* allocate a new one */ ++ RTW_INFO("going to alloc stainfo for sa="MAC_FMT"\n", MAC_ARG(sa)); ++ pstat = rtw_alloc_stainfo(pstapriv, sa); ++ if (pstat == NULL) { ++ RTW_INFO(" Exceed the upper limit of supported clients...\n"); ++ status = _STATS_UNABLE_HANDLE_STA_; ++ goto auth_fail; ++ } ++ ++ pstat->state = WIFI_FW_AUTH_NULL; ++ pstat->auth_seq = 0; ++ ++ /* pstat->flags = 0; */ ++ /* pstat->capability = 0; */ ++ } else { ++#ifdef CONFIG_IEEE80211W ++ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) ++#endif /* CONFIG_IEEE80211W */ ++ { ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ if (rtw_is_list_empty(&pstat->asoc_list) == _FALSE) { ++ rtw_list_delete(&pstat->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ if (pstat->expire_to > 0) ++ ;/* TODO: STA re_auth within expire_to */ ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ if (seq == 1) ++ ; /* TODO: STA re_auth and auth timeout */ ++ ++ } ++ } ++ ++#ifdef CONFIG_IEEE80211W ++ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) ++#endif /* CONFIG_IEEE80211W */ ++ { ++ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ if (rtw_is_list_empty(&pstat->auth_list)) { ++ ++ rtw_list_insert_tail(&pstat->auth_list, &pstapriv->auth_list); ++ pstapriv->auth_list_cnt++; ++ } ++ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ } ++ ++ if (pstat->auth_seq == 0) ++ pstat->expire_to = pstapriv->auth_to; ++ ++ ++ if ((pstat->auth_seq + 1) != seq) { ++ RTW_INFO("(1)auth rejected because out of seq [rx_seq=%d, exp_seq=%d]!\n", ++ seq, pstat->auth_seq + 1); ++ status = _STATS_OUT_OF_AUTH_SEQ_; ++ goto auth_fail; ++ } ++ ++ if (algorithm == 0 && (auth_mode == 0 || auth_mode == 2 || auth_mode == 3)) { ++ if (seq == 1) { ++#ifdef CONFIG_IEEE80211W ++ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) ++#endif /* CONFIG_IEEE80211W */ ++ { ++ pstat->state &= ~WIFI_FW_AUTH_NULL; ++ pstat->state |= WIFI_FW_AUTH_SUCCESS; ++ pstat->expire_to = pstapriv->assoc_to; ++ } ++ pstat->authalg = algorithm; ++ } else { ++ RTW_INFO("(2)auth rejected because out of seq [rx_seq=%d, exp_seq=%d]!\n", ++ seq, pstat->auth_seq + 1); ++ status = _STATS_OUT_OF_AUTH_SEQ_; ++ goto auth_fail; ++ } ++ } else { /* shared system or auto authentication */ ++ if (seq == 1) { ++ /* prepare for the challenging txt... */ ++ ++ /* get_random_bytes((void *)pstat->chg_txt, 128); */ /* TODO: */ ++ _rtw_memset((void *)pstat->chg_txt, 78, 128); ++#ifdef CONFIG_IEEE80211W ++ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) ++#endif /* CONFIG_IEEE80211W */ ++ { ++ pstat->state &= ~WIFI_FW_AUTH_NULL; ++ pstat->state |= WIFI_FW_AUTH_STATE; ++ } ++ pstat->authalg = algorithm; ++ pstat->auth_seq = 2; ++ } else if (seq == 3) { ++ /* checking for challenging txt... */ ++ RTW_INFO("checking for challenging txt...\n"); ++ ++ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + 4 + _AUTH_IE_OFFSET_ , _CHLGETXT_IE_, (int *)&ie_len, ++ len - WLAN_HDR_A3_LEN - _AUTH_IE_OFFSET_ - 4); ++ ++ if ((p == NULL) || (ie_len <= 0)) { ++ RTW_INFO("auth rejected because challenge failure!(1)\n"); ++ status = _STATS_CHALLENGE_FAIL_; ++ goto auth_fail; ++ } ++ ++ if (_rtw_memcmp((void *)(p + 2), pstat->chg_txt, 128)) { ++#ifdef CONFIG_IEEE80211W ++ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) ++#endif /* CONFIG_IEEE80211W */ ++ { ++ pstat->state &= (~WIFI_FW_AUTH_STATE); ++ pstat->state |= WIFI_FW_AUTH_SUCCESS; ++ /* challenging txt is correct... */ ++ pstat->expire_to = pstapriv->assoc_to; ++ } ++ } else { ++ RTW_INFO("auth rejected because challenge failure!\n"); ++ status = _STATS_CHALLENGE_FAIL_; ++ goto auth_fail; ++ } ++ } else { ++ RTW_INFO("(3)auth rejected because out of seq [rx_seq=%d, exp_seq=%d]!\n", ++ seq, pstat->auth_seq + 1); ++ status = _STATS_OUT_OF_AUTH_SEQ_; ++ goto auth_fail; ++ } ++ } ++ ++ ++ /* Now, we are going to issue_auth... */ ++ pstat->auth_seq = seq + 1; ++ ++#ifdef CONFIG_NATIVEAP_MLME ++ issue_auth(padapter, pstat, (unsigned short)(_STATS_SUCCESSFUL_)); ++#endif ++ ++ if ((pstat->state & WIFI_FW_AUTH_SUCCESS) || (pstat->state & WIFI_FW_ASSOC_SUCCESS)) ++ pstat->auth_seq = 0; ++ ++ ++ return _SUCCESS; ++ ++auth_fail: ++ ++ if (pstat) ++ rtw_free_stainfo(padapter , pstat); ++ ++ pstat = &stat; ++ _rtw_memset((char *)pstat, '\0', sizeof(stat)); ++ pstat->auth_seq = 2; ++ _rtw_memcpy(pstat->hwaddr, sa, 6); ++ ++#ifdef CONFIG_NATIVEAP_MLME ++ issue_auth(padapter, pstat, (unsigned short)status); ++#endif ++ ++#endif ++ return _FAIL; ++ ++} ++ ++unsigned int OnAuthClient(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ unsigned int seq, len, status, algthm, offset; ++ unsigned char *p; ++ unsigned int go2asoc = 0; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++#ifdef CONFIG_RTW_80211R ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ft_priv *pftpriv = &pmlmepriv->ftpriv; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta = NULL; ++#endif ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint pkt_len = precv_frame->u.hdr.len; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ /* check A1 matches or not */ ++ if (!_rtw_memcmp(adapter_mac_addr(padapter), get_da(pframe), ETH_ALEN)) ++ return _SUCCESS; ++ ++ if (!(pmlmeinfo->state & WIFI_FW_AUTH_STATE)) ++ return _SUCCESS; ++ ++ offset = (GetPrivacy(pframe)) ? 4 : 0; ++ ++ algthm = le16_to_cpu(*(unsigned short *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset)); ++ seq = le16_to_cpu(*(unsigned short *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 2)); ++ status = le16_to_cpu(*(unsigned short *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 4)); ++ ++ if (status != 0) { ++ RTW_INFO("clnt auth fail, status: %d\n", status); ++ if (status == 13) { /* && pmlmeinfo->auth_algo == dot11AuthAlgrthm_Auto) */ ++ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) ++ pmlmeinfo->auth_algo = dot11AuthAlgrthm_Open; ++ else ++ pmlmeinfo->auth_algo = dot11AuthAlgrthm_Shared; ++ /* pmlmeinfo->reauth_count = 0; */ ++ } ++ ++ set_link_timer(pmlmeext, 1); ++ goto authclnt_fail; ++ } ++ ++ if (seq == 2) { ++ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) { ++ /* legendary shared system */ ++ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _AUTH_IE_OFFSET_, _CHLGETXT_IE_, (int *)&len, ++ pkt_len - WLAN_HDR_A3_LEN - _AUTH_IE_OFFSET_); ++ ++ if (p == NULL) { ++ /* RTW_INFO("marc: no challenge text?\n"); */ ++ goto authclnt_fail; ++ } ++ ++ _rtw_memcpy((void *)(pmlmeinfo->chg_txt), (void *)(p + 2), len); ++ pmlmeinfo->auth_seq = 3; ++ issue_auth(padapter, NULL, 0); ++ set_link_timer(pmlmeext, REAUTH_TO); ++ ++ return _SUCCESS; ++ } else { ++ /* open, or 802.11r FTAA system */ ++ go2asoc = 1; ++ } ++ } else if (seq == 4) { ++ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) ++ go2asoc = 1; ++ else ++ goto authclnt_fail; ++ } else { ++ /* this is also illegal */ ++ /* RTW_INFO("marc: clnt auth failed due to illegal seq=%x\n", seq); */ ++ goto authclnt_fail; ++ } ++ ++ if (go2asoc) { ++#ifdef CONFIG_RTW_80211R ++ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { ++ u8 target_ap_addr[ETH_ALEN] = {0}; ++ ++ if ((rtw_chk_ft_status(padapter, RTW_FT_AUTHENTICATED_STA)) || ++ (rtw_chk_ft_status(padapter, RTW_FT_ASSOCIATING_STA)) || ++ (rtw_chk_ft_status(padapter, RTW_FT_ASSOCIATED_STA))) { ++ /*report_ft_reassoc_event already, and waiting for cfg80211_rtw_update_ft_ies*/ ++ return _SUCCESS; ++ } ++ ++ rtw_buf_update(&pmlmepriv->auth_rsp, &pmlmepriv->auth_rsp_len, pframe, pkt_len); ++ pftpriv->ft_event.ies = pmlmepriv->auth_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6; ++ pftpriv->ft_event.ies_len = pmlmepriv->auth_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6; ++ ++ /*Not support RIC*/ ++ pftpriv->ft_event.ric_ies = NULL; ++ pftpriv->ft_event.ric_ies_len = 0; ++ _rtw_memcpy(target_ap_addr, pmlmepriv->assoc_bssid, ETH_ALEN); ++ report_ft_reassoc_event(padapter, target_ap_addr); ++ return _SUCCESS; ++ } ++#endif ++ ++ RTW_PRINT("auth success, start assoc\n"); ++ start_clnt_assoc(padapter); ++ return _SUCCESS; ++ } ++ ++authclnt_fail: ++ ++ /* pmlmeinfo->state &= ~(WIFI_FW_AUTH_STATE); */ ++ ++ return _FAIL; ++ ++} ++ ++unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) ++{ ++#ifdef CONFIG_AP_MODE ++ _irqL irqL; ++ u16 capab_info, listen_interval; ++ struct rtw_ieee802_11_elems elems; ++ struct sta_info *pstat; ++ unsigned char reassoc, *p, *pos, *wpa_ie; ++ unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01}; ++ int i, ie_len, wpa_ie_len, left; ++ u8 rate_set[16]; ++ u8 rate_num; ++ unsigned short status = _STATS_SUCCESSFUL_; ++ unsigned short frame_type, ie_offset = 0; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur = &(pmlmeinfo->network); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint pkt_len = precv_frame->u.hdr.len; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 p2p_status_code = P2P_STATUS_SUCCESS; ++ u8 *p2pie; ++ u32 p2pielen = 0; ++#endif /* CONFIG_P2P */ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) && ++ rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_LINKING | _FW_UNDER_SURVEY)) { ++ /* don't process assoc request; */ ++ return _SUCCESS; ++ } ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) ++ return _FAIL; ++ ++ frame_type = GetFrameSubType(pframe); ++ if (frame_type == WIFI_ASSOCREQ) { ++ reassoc = 0; ++ ie_offset = _ASOCREQ_IE_OFFSET_; ++ } else { /* WIFI_REASSOCREQ */ ++ reassoc = 1; ++ ie_offset = _REASOCREQ_IE_OFFSET_; ++ } ++ ++ ++ if (pkt_len < IEEE80211_3ADDR_LEN + ie_offset) { ++ RTW_INFO("handle_assoc(reassoc=%d) - too short payload (len=%lu)" ++ "\n", reassoc, (unsigned long)pkt_len); ++ return _FAIL; ++ } ++ ++ pstat = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ if (pstat == (struct sta_info *)NULL) { ++ status = _RSON_CLS2_; ++ goto asoc_class2_error; ++ } ++ ++ capab_info = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN); ++ /* capab_info = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); */ ++ /* listen_interval = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN+2)); */ ++ listen_interval = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN + 2); ++ ++ left = pkt_len - (IEEE80211_3ADDR_LEN + ie_offset); ++ pos = pframe + (IEEE80211_3ADDR_LEN + ie_offset); ++ ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ /* check if this stat has been successfully authenticated/assocated */ ++ if (!((pstat->state) & WIFI_FW_AUTH_SUCCESS)) { ++ if (!((pstat->state) & WIFI_FW_ASSOC_SUCCESS)) { ++ status = _RSON_CLS2_; ++ goto asoc_class2_error; ++ } else { ++ pstat->state &= (~WIFI_FW_ASSOC_SUCCESS); ++ pstat->state |= WIFI_FW_ASSOC_STATE; ++ } ++ } else { ++ pstat->state &= (~WIFI_FW_AUTH_SUCCESS); ++ pstat->state |= WIFI_FW_ASSOC_STATE; ++ } ++ ++ ++#if 0/* todo:tkip_countermeasures */ ++ if (hapd->tkip_countermeasures) { ++ resp = WLAN_REASON_MICHAEL_MIC_FAILURE; ++ goto fail; ++ } ++#endif ++ ++ pstat->capability = capab_info; ++ ++#if 0/* todo: */ ++ /* check listen_interval */ ++ if (listen_interval > hapd->conf->max_listen_interval) { ++ hostapd_logger(hapd, mgmt->sa, HOSTAPD_MODULE_IEEE80211, ++ HOSTAPD_LEVEL_DEBUG, ++ "Too large Listen Interval (%d)", ++ listen_interval); ++ resp = WLAN_STATUS_ASSOC_DENIED_LISTEN_INT_TOO_LARGE; ++ goto fail; ++ } ++ ++ pstat->listen_interval = listen_interval; ++#endif ++ ++ /* now parse all ieee802_11 ie to point to elems */ ++ if (rtw_ieee802_11_parse_elems(pos, left, &elems, 1) == ParseFailed || ++ !elems.ssid) { ++ RTW_INFO("STA " MAC_FMT " sent invalid association request\n", ++ MAC_ARG(pstat->hwaddr)); ++ status = _STATS_FAILURE_; ++ goto OnAssocReqFail; ++ } ++ ++ ++ /* now we should check all the fields... */ ++ /* checking SSID */ ++ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + ie_offset, _SSID_IE_, &ie_len, ++ pkt_len - WLAN_HDR_A3_LEN - ie_offset); ++ if (p == NULL) ++ status = _STATS_FAILURE_; ++ ++ if (ie_len == 0) /* broadcast ssid, however it is not allowed in assocreq */ ++ status = _STATS_FAILURE_; ++ else { ++ /* check if ssid match */ ++ if (!_rtw_memcmp((void *)(p + 2), cur->Ssid.Ssid, cur->Ssid.SsidLength)) ++ status = _STATS_FAILURE_; ++ ++ if (ie_len != cur->Ssid.SsidLength) ++ status = _STATS_FAILURE_; ++ } ++ ++ if (_STATS_SUCCESSFUL_ != status) ++ goto OnAssocReqFail; ++ ++ rtw_ies_get_supported_rate(pframe + WLAN_HDR_A3_LEN + ie_offset, pkt_len - WLAN_HDR_A3_LEN - ie_offset, rate_set, &rate_num); ++ if (rate_num == 0) { ++ RTW_INFO(FUNC_ADPT_FMT" RX assoc-req with no supported rate\n", FUNC_ADPT_ARG(padapter)); ++ status = _STATS_FAILURE_; ++ goto OnAssocReqFail; ++ } ++ _rtw_memcpy(pstat->bssrateset, rate_set, rate_num); ++ pstat->bssratelen = rate_num; ++ UpdateBrateTblForSoftAP(pstat->bssrateset, pstat->bssratelen); ++ ++ /* check RSN/WPA/WPS */ ++ pstat->dot8021xalg = 0; ++ pstat->wpa_psk = 0; ++ pstat->wpa_group_cipher = 0; ++ pstat->wpa2_group_cipher = 0; ++ pstat->wpa_pairwise_cipher = 0; ++ pstat->wpa2_pairwise_cipher = 0; ++ _rtw_memset(pstat->wpa_ie, 0, sizeof(pstat->wpa_ie)); ++ if ((psecuritypriv->wpa_psk & BIT(1)) && elems.rsn_ie) { ++ ++ int group_cipher = 0, pairwise_cipher = 0; ++ ++ wpa_ie = elems.rsn_ie; ++ wpa_ie_len = elems.rsn_ie_len; ++ ++ if (rtw_parse_wpa2_ie(wpa_ie - 2, wpa_ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { ++ pstat->dot8021xalg = 1;/* psk, todo:802.1x */ ++ pstat->wpa_psk |= BIT(1); ++ ++ pstat->wpa2_group_cipher = group_cipher & psecuritypriv->wpa2_group_cipher; ++ pstat->wpa2_pairwise_cipher = pairwise_cipher & psecuritypriv->wpa2_pairwise_cipher; ++ ++ if (!pstat->wpa2_group_cipher) ++ status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; ++ ++ if (!pstat->wpa2_pairwise_cipher) ++ status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; ++ } else ++ status = WLAN_STATUS_INVALID_IE; ++ ++ } else if ((psecuritypriv->wpa_psk & BIT(0)) && elems.wpa_ie) { ++ ++ int group_cipher = 0, pairwise_cipher = 0; ++ ++ wpa_ie = elems.wpa_ie; ++ wpa_ie_len = elems.wpa_ie_len; ++ ++ if (rtw_parse_wpa_ie(wpa_ie - 2, wpa_ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { ++ pstat->dot8021xalg = 1;/* psk, todo:802.1x */ ++ pstat->wpa_psk |= BIT(0); ++ ++ pstat->wpa_group_cipher = group_cipher & psecuritypriv->wpa_group_cipher; ++ pstat->wpa_pairwise_cipher = pairwise_cipher & psecuritypriv->wpa_pairwise_cipher; ++ ++ if (!pstat->wpa_group_cipher) ++ status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; ++ ++ if (!pstat->wpa_pairwise_cipher) ++ status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; ++ ++ } else ++ status = WLAN_STATUS_INVALID_IE; ++ ++ } else { ++ wpa_ie = NULL; ++ wpa_ie_len = 0; ++ } ++ ++ if (_STATS_SUCCESSFUL_ != status) ++ goto OnAssocReqFail; ++ ++ pstat->flags &= ~(WLAN_STA_WPS | WLAN_STA_MAYBE_WPS); ++ /* if (hapd->conf->wps_state && wpa_ie == NULL) { */ /* todo: to check ap if supporting WPS */ ++ if (wpa_ie == NULL) { ++ if (elems.wps_ie) { ++ RTW_INFO("STA included WPS IE in " ++ "(Re)Association Request - assume WPS is " ++ "used\n"); ++ pstat->flags |= WLAN_STA_WPS; ++ /* wpabuf_free(sta->wps_ie); */ ++ /* sta->wps_ie = wpabuf_alloc_copy(elems.wps_ie + 4, */ ++ /* elems.wps_ie_len - 4); */ ++ } else { ++ RTW_INFO("STA did not include WPA/RSN IE " ++ "in (Re)Association Request - possible WPS " ++ "use\n"); ++ pstat->flags |= WLAN_STA_MAYBE_WPS; ++ } ++ ++ ++ /* AP support WPA/RSN, and sta is going to do WPS, but AP is not ready */ ++ /* that the selected registrar of AP is _FLASE */ ++ if ((psecuritypriv->wpa_psk > 0) ++ && (pstat->flags & (WLAN_STA_WPS | WLAN_STA_MAYBE_WPS))) { ++ if (pmlmepriv->wps_beacon_ie) { ++ u8 selected_registrar = 0; ++ ++ rtw_get_wps_attr_content(pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len, WPS_ATTR_SELECTED_REGISTRAR , &selected_registrar, NULL); ++ ++ if (!selected_registrar) { ++ RTW_INFO("selected_registrar is _FALSE , or AP is not ready to do WPS\n"); ++ ++ status = _STATS_UNABLE_HANDLE_STA_; ++ ++ goto OnAssocReqFail; ++ } ++ } ++ } ++ ++ } else { ++ int copy_len; ++ ++ if (psecuritypriv->wpa_psk == 0) { ++ RTW_INFO("STA " MAC_FMT ": WPA/RSN IE in association " ++ "request, but AP don't support WPA/RSN\n", MAC_ARG(pstat->hwaddr)); ++ ++ status = WLAN_STATUS_INVALID_IE; ++ ++ goto OnAssocReqFail; ++ ++ } ++ ++ if (elems.wps_ie) { ++ RTW_INFO("STA included WPS IE in " ++ "(Re)Association Request - WPS is " ++ "used\n"); ++ pstat->flags |= WLAN_STA_WPS; ++ copy_len = 0; ++ } else ++ copy_len = ((wpa_ie_len + 2) > sizeof(pstat->wpa_ie)) ? (sizeof(pstat->wpa_ie)) : (wpa_ie_len + 2); ++ ++ ++ if (copy_len > 0) ++ _rtw_memcpy(pstat->wpa_ie, wpa_ie - 2, copy_len); ++ ++ } ++ ++ ++ /* check if there is WMM IE & support WWM-PS */ ++ pstat->flags &= ~WLAN_STA_WME; ++ pstat->qos_option = 0; ++ pstat->qos_info = 0; ++ pstat->has_legacy_ac = _TRUE; ++ pstat->uapsd_vo = 0; ++ pstat->uapsd_vi = 0; ++ pstat->uapsd_be = 0; ++ pstat->uapsd_bk = 0; ++ if (pmlmepriv->qospriv.qos_option) { ++ p = pframe + WLAN_HDR_A3_LEN + ie_offset; ++ ie_len = 0; ++ for (;;) { ++ p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &ie_len, pkt_len - WLAN_HDR_A3_LEN - ie_offset); ++ if (p != NULL) { ++ if (_rtw_memcmp(p + 2, WMM_IE, 6)) { ++ ++ pstat->flags |= WLAN_STA_WME; ++ ++ pstat->qos_option = 1; ++ pstat->qos_info = *(p + 8); ++ ++ pstat->max_sp_len = (pstat->qos_info >> 5) & 0x3; ++ ++ if ((pstat->qos_info & 0xf) != 0xf) ++ pstat->has_legacy_ac = _TRUE; ++ else ++ pstat->has_legacy_ac = _FALSE; ++ ++ if (pstat->qos_info & 0xf) { ++ if (pstat->qos_info & BIT(0)) ++ pstat->uapsd_vo = BIT(0) | BIT(1); ++ else ++ pstat->uapsd_vo = 0; ++ ++ if (pstat->qos_info & BIT(1)) ++ pstat->uapsd_vi = BIT(0) | BIT(1); ++ else ++ pstat->uapsd_vi = 0; ++ ++ if (pstat->qos_info & BIT(2)) ++ pstat->uapsd_bk = BIT(0) | BIT(1); ++ else ++ pstat->uapsd_bk = 0; ++ ++ if (pstat->qos_info & BIT(3)) ++ pstat->uapsd_be = BIT(0) | BIT(1); ++ else ++ pstat->uapsd_be = 0; ++ ++ } ++ ++ break; ++ } ++ } else ++ break; ++ p = p + ie_len + 2; ++ } ++ } ++ ++ ++#ifdef CONFIG_80211N_HT ++ if (pmlmepriv->htpriv.ht_option == _FALSE) ++ goto bypass_ht_chk; ++ ++ /* save HT capabilities in the sta object */ ++ _rtw_memset(&pstat->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap)); ++ if (elems.ht_capabilities && elems.ht_capabilities_len >= sizeof(struct rtw_ieee80211_ht_cap)) { ++ pstat->flags |= WLAN_STA_HT; ++ ++ pstat->flags |= WLAN_STA_WME; ++ ++ _rtw_memcpy(&pstat->htpriv.ht_cap, elems.ht_capabilities, sizeof(struct rtw_ieee80211_ht_cap)); ++ ++ } else ++ pstat->flags &= ~WLAN_STA_HT; ++bypass_ht_chk: ++ ++ if ((pmlmepriv->htpriv.ht_option == _FALSE) && (pstat->flags & WLAN_STA_HT)) { ++ rtw_warn_on(1); ++ status = _STATS_FAILURE_; ++ goto OnAssocReqFail; ++ } ++#endif /* CONFIG_80211N_HT */ ++ ++#ifdef CONFIG_80211AC_VHT ++ if (pmlmepriv->vhtpriv.vht_option == _FALSE) ++ goto bypass_vht_chk; ++ ++ _rtw_memset(&pstat->vhtpriv, 0, sizeof(struct vht_priv)); ++ if (elems.vht_capabilities && elems.vht_capabilities_len == 12) { ++ pstat->flags |= WLAN_STA_VHT; ++ ++ _rtw_memcpy(pstat->vhtpriv.vht_cap, elems.vht_capabilities, 12); ++ ++ if (elems.vht_op_mode_notify && elems.vht_op_mode_notify_len == 1) ++ _rtw_memcpy(&pstat->vhtpriv.vht_op_mode_notify, elems.vht_op_mode_notify, 1); ++ else /* for Frame without Operating Mode notify ie; default: 80M */ ++ pstat->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80; ++ } else ++ pstat->flags &= ~WLAN_STA_VHT; ++bypass_vht_chk: ++ ++ if ((pmlmepriv->vhtpriv.vht_option == _FALSE) && (pstat->flags & WLAN_STA_VHT)) { ++ rtw_warn_on(1); ++ status = _STATS_FAILURE_; ++ goto OnAssocReqFail; ++ } ++#endif /* CONFIG_80211AC_VHT */ ++ ++ if (((pstat->flags & WLAN_STA_HT) || (pstat->flags & WLAN_STA_VHT)) && ++ ((pstat->wpa2_pairwise_cipher & WPA_CIPHER_TKIP) || ++ (pstat->wpa_pairwise_cipher & WPA_CIPHER_TKIP))) { ++ ++ RTW_INFO("(V)HT: " MAC_FMT " tried to use TKIP with (V)HT association\n", MAC_ARG(pstat->hwaddr)); ++ ++ pstat->flags &= ~WLAN_STA_HT; ++ pstat->flags &= ~WLAN_STA_VHT; ++ /*status = WLAN_STATUS_CIPHER_REJECTED_PER_POLICY; ++ * goto OnAssocReqFail; ++ */ ++ } ++ ++ ++ /* ++ * if (hapd->iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G) */ /* ? */ ++ pstat->flags |= WLAN_STA_NONERP; ++ for (i = 0; i < pstat->bssratelen; i++) { ++ if ((pstat->bssrateset[i] & 0x7f) > 22) { ++ pstat->flags &= ~WLAN_STA_NONERP; ++ break; ++ } ++ } ++ ++ if (pstat->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) ++ pstat->flags |= WLAN_STA_SHORT_PREAMBLE; ++ else ++ pstat->flags &= ~WLAN_STA_SHORT_PREAMBLE; ++ ++ ++ ++ if (status != _STATS_SUCCESSFUL_) ++ goto OnAssocReqFail; ++ ++#ifdef CONFIG_P2P ++ pstat->is_p2p_device = _FALSE; ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ p2pie = rtw_get_p2p_ie(pframe + WLAN_HDR_A3_LEN + ie_offset , pkt_len - WLAN_HDR_A3_LEN - ie_offset , NULL, &p2pielen); ++ if (p2pie) { ++ pstat->is_p2p_device = _TRUE; ++ p2p_status_code = (u8)process_assoc_req_p2p_ie(pwdinfo, pframe, pkt_len, pstat); ++ if (p2p_status_code > 0) { ++ pstat->p2p_status_code = p2p_status_code; ++ status = _STATS_CAP_FAIL_; ++ goto OnAssocReqFail; ++ } ++ } ++#ifdef CONFIG_WFD ++ rtw_process_wfd_ies(padapter, pframe + WLAN_HDR_A3_LEN + ie_offset, pkt_len - WLAN_HDR_A3_LEN - ie_offset, __func__); ++#endif ++ } ++ pstat->p2p_status_code = p2p_status_code; ++#endif /* CONFIG_P2P */ ++ ++ /* TODO: identify_proprietary_vendor_ie(); */ ++ /* Realtek proprietary IE */ ++ /* identify if this is Broadcom sta */ ++ /* identify if this is ralink sta */ ++ /* Customer proprietary IE */ ++ ++ ++ ++ /* get a unique AID */ ++ if (pstat->aid > 0) ++ RTW_INFO(" old AID %d\n", pstat->aid); ++ else { ++ for (pstat->aid = 1; pstat->aid <= NUM_STA; pstat->aid++) { ++ if (pstapriv->sta_aid[pstat->aid - 1] == NULL) { ++ if (pstat->aid > pstapriv->max_num_sta) { ++ pstat->aid = 0; ++ ++ RTW_INFO(" no room for more AIDs\n"); ++ ++ status = WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA; ++ ++ goto OnAssocReqFail; ++ ++ ++ } else { ++ pstapriv->sta_aid[pstat->aid - 1] = pstat; ++ RTW_INFO("allocate new AID = (%d)\n", pstat->aid); ++ break; ++ } ++ } ++ } ++ } ++ ++ ++ pstat->state &= (~WIFI_FW_ASSOC_STATE); ++ pstat->state |= WIFI_FW_ASSOC_SUCCESS; ++ /* RTW_INFO("==================%s, %d, (%x), bpairwise_key_installed=%d, MAC:"MAC_FMT"\n" ++ , __func__, __LINE__, pstat->state, pstat->bpairwise_key_installed, MAC_ARG(pstat->hwaddr)); */ ++#ifdef CONFIG_IEEE80211W ++ if (pstat->bpairwise_key_installed != _TRUE) ++#endif /* CONFIG_IEEE80211W */ ++ { ++ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ if (!rtw_is_list_empty(&pstat->auth_list)) { ++ rtw_list_delete(&pstat->auth_list); ++ pstapriv->auth_list_cnt--; ++ } ++ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ if (rtw_is_list_empty(&pstat->asoc_list)) { ++ pstat->expire_to = pstapriv->expire_to; ++ rtw_list_insert_tail(&pstat->asoc_list, &pstapriv->asoc_list); ++ pstapriv->asoc_list_cnt++; ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ } ++ ++ /* now the station is qualified to join our BSS... */ ++ if (pstat && (pstat->state & WIFI_FW_ASSOC_SUCCESS) && (_STATS_SUCCESSFUL_ == status)) { ++#ifdef CONFIG_NATIVEAP_MLME ++#ifdef CONFIG_IEEE80211W ++ if (pstat->bpairwise_key_installed != _TRUE) ++#endif /* CONFIG_IEEE80211W */ ++ { ++ /* .1 bss_cap_update & sta_info_update */ ++ bss_cap_update_on_sta_join(padapter, pstat); ++ sta_info_update(padapter, pstat); ++ } ++#ifdef CONFIG_IEEE80211W ++ if (pstat->bpairwise_key_installed == _TRUE) ++ status = _STATS_REFUSED_TEMPORARILY_; ++#endif /* CONFIG_IEEE80211W */ ++ /* .2 issue assoc rsp before notify station join event. */ ++ if (frame_type == WIFI_ASSOCREQ) ++ issue_asocrsp(padapter, status, pstat, WIFI_ASSOCRSP); ++ else ++ issue_asocrsp(padapter, status, pstat, WIFI_REASSOCRSP); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ _enter_critical_bh(&pstat->lock, &irqL); ++ if (pstat->passoc_req) { ++ rtw_mfree(pstat->passoc_req, pstat->assoc_req_len); ++ pstat->passoc_req = NULL; ++ pstat->assoc_req_len = 0; ++ } ++ ++ pstat->passoc_req = rtw_zmalloc(pkt_len); ++ if (pstat->passoc_req) { ++ _rtw_memcpy(pstat->passoc_req, pframe, pkt_len); ++ pstat->assoc_req_len = pkt_len; ++ } ++ _exit_critical_bh(&pstat->lock, &irqL); ++#endif /* CONFIG_IOCTL_CFG80211 */ ++#ifdef CONFIG_IEEE80211W ++ if (pstat->bpairwise_key_installed != _TRUE) ++#endif /* CONFIG_IEEE80211W */ ++ { ++ /* .3-(1) report sta add event */ ++ report_add_sta_event(padapter, pstat->hwaddr); ++ } ++#ifdef CONFIG_IEEE80211W ++ if (pstat->bpairwise_key_installed == _TRUE && padapter->securitypriv.binstallBIPkey == _TRUE) { ++ RTW_INFO(MAC_FMT"\n", MAC_ARG(pstat->hwaddr)); ++ issue_action_SA_Query(padapter, pstat->hwaddr, 0, 0, IEEE80211W_RIGHT_KEY); ++ } ++#endif /* CONFIG_IEEE80211W */ ++#endif /* CONFIG_NATIVEAP_MLME */ ++ } ++ ++ return _SUCCESS; ++ ++asoc_class2_error: ++ ++#ifdef CONFIG_NATIVEAP_MLME ++ issue_deauth(padapter, (void *)GetAddr2Ptr(pframe), status); ++#endif ++ ++ return _FAIL; ++ ++OnAssocReqFail: ++ ++ ++#ifdef CONFIG_NATIVEAP_MLME ++ pstat->aid = 0; ++ if (frame_type == WIFI_ASSOCREQ) ++ issue_asocrsp(padapter, status, pstat, WIFI_ASSOCRSP); ++ else ++ issue_asocrsp(padapter, status, pstat, WIFI_REASSOCRSP); ++#endif ++ ++ ++#endif /* CONFIG_AP_MODE */ ++ ++ return _FAIL; ++ ++} ++ ++unsigned int OnAssocRsp(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ uint i; ++ int res; ++ unsigned short status; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ /* WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); */ ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint pkt_len = precv_frame->u.hdr.len; ++ PNDIS_802_11_VARIABLE_IEs pWapiIE = NULL; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ /* check A1 matches or not */ ++ if (!_rtw_memcmp(adapter_mac_addr(padapter), get_da(pframe), ETH_ALEN)) ++ return _SUCCESS; ++ ++ if (!(pmlmeinfo->state & (WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE))) ++ return _SUCCESS; ++ ++ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) ++ return _SUCCESS; ++ ++ _cancel_timer_ex(&pmlmeext->link_timer); ++ ++ /* status */ ++ status = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN + 2)); ++ if (status > 0) { ++ RTW_INFO("assoc reject, status code: %d\n", status); ++ pmlmeinfo->state = WIFI_FW_NULL_STATE; ++ res = -4; ++ goto report_assoc_result; ++ } ++ ++ /* get capabilities */ ++ pmlmeinfo->capability = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); ++ ++ /* set slot time */ ++ pmlmeinfo->slotTime = (pmlmeinfo->capability & BIT(10)) ? 9 : 20; ++ ++ /* AID */ ++ res = pmlmeinfo->aid = (int)(le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN + 4)) & 0x3fff); ++ ++ /* following are moved to join event callback function */ ++ /* to handle HT, WMM, rate adaptive, update MAC reg */ ++ /* for not to handle the synchronous IO in the tasklet */ ++ for (i = (6 + WLAN_HDR_A3_LEN); i < pkt_len;) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + i); ++ ++ switch (pIE->ElementID) { ++ case _VENDOR_SPECIFIC_IE_: ++ if (_rtw_memcmp(pIE->data, WMM_PARA_OUI, 6)) /* WMM */ ++ WMM_param_handler(padapter, pIE); ++#if defined(CONFIG_P2P) && defined(CONFIG_WFD) ++ else if (_rtw_memcmp(pIE->data, WFD_OUI, 4)) /* WFD */ ++ rtw_process_wfd_ie(padapter, (u8 *)pIE, pIE->Length, __func__); ++#endif ++ break; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ case _WAPI_IE_: ++ pWapiIE = pIE; ++ break; ++#endif ++ ++ case _HT_CAPABILITY_IE_: /* HT caps */ ++ HT_caps_handler(padapter, pIE); ++ break; ++ ++ case _HT_EXTRA_INFO_IE_: /* HT info */ ++ HT_info_handler(padapter, pIE); ++ break; ++ ++#ifdef CONFIG_80211AC_VHT ++ case EID_VHTCapability: ++ VHT_caps_handler(padapter, pIE); ++ break; ++ ++ case EID_VHTOperation: ++ VHT_operation_handler(padapter, pIE); ++ break; ++#endif ++ ++ case _ERPINFO_IE_: ++ ERP_IE_handler(padapter, pIE); ++ break; ++#ifdef CONFIG_TDLS ++ case _EXT_CAP_IE_: ++ if (check_ap_tdls_prohibited(pIE->data, pIE->Length) == _TRUE) ++ padapter->tdlsinfo.ap_prohibited = _TRUE; ++ if (check_ap_tdls_ch_switching_prohibited(pIE->data, pIE->Length) == _TRUE) ++ padapter->tdlsinfo.ch_switch_prohibited = _TRUE; ++ break; ++#endif /* CONFIG_TDLS */ ++ default: ++ break; ++ } ++ ++ i += (pIE->Length + 2); ++ } ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ rtw_wapi_on_assoc_ok(padapter, pIE); ++#endif ++ ++ pmlmeinfo->state &= (~WIFI_FW_ASSOC_STATE); ++ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; ++ ++ /* Update Basic Rate Table for spec, 2010-12-28 , by thomas */ ++ UpdateBrateTbl(padapter, pmlmeinfo->network.SupportedRates); ++ ++report_assoc_result: ++ if (res > 0) ++ rtw_buf_update(&pmlmepriv->assoc_rsp, &pmlmepriv->assoc_rsp_len, pframe, pkt_len); ++ else ++ rtw_buf_free(&pmlmepriv->assoc_rsp, &pmlmepriv->assoc_rsp_len); ++ ++ report_join_res(padapter, res); ++ ++ return _SUCCESS; ++} ++ ++unsigned int OnDeAuth(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ unsigned short reason; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif /* CONFIG_P2P */ ++ ++ /* check A3 */ ++ if (!(_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) ++ return _SUCCESS; ++ ++ RTW_INFO(FUNC_ADPT_FMT" - Start to Disconnect\n", FUNC_ADPT_ARG(padapter)); ++ ++#ifdef CONFIG_P2P ++ if (pwdinfo->rx_invitereq_info.scan_op_ch_only) { ++ _cancel_timer_ex(&pwdinfo->reset_ch_sitesurvey); ++ _set_timer(&pwdinfo->reset_ch_sitesurvey, 10); ++ } ++#endif /* CONFIG_P2P */ ++ ++ reason = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); ++ ++ rtw_lock_rx_suspend_timeout(8000); ++ ++#ifdef CONFIG_AP_MODE ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { ++ _irqL irqL; ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ /* rtw_free_stainfo(padapter, psta); */ ++ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ ++ RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM\n" ++ , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe)); ++ ++ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ if (psta) { ++ u8 updated = _FALSE; ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { ++ rtw_list_delete(&psta->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ updated = ap_free_sta(padapter, psta, _FALSE, reason, _TRUE); ++ ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); ++ } ++ ++ ++ return _SUCCESS; ++ } else ++#endif ++ { ++ int ignore_received_deauth = 0; ++ ++ /* Commented by Albert 20130604 */ ++ /* Before sending the auth frame to start the STA/GC mode connection with AP/GO, */ ++ /* we will send the deauth first. */ ++ /* However, the Win8.1 with BRCM Wi-Fi will send the deauth with reason code 6 to us after receieving our deauth. */ ++ /* Added the following code to avoid this case. */ ++ if ((pmlmeinfo->state & WIFI_FW_AUTH_STATE) || ++ (pmlmeinfo->state & WIFI_FW_ASSOC_STATE)) { ++ if (reason == WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA) ++ ignore_received_deauth = 1; ++ else if (WLAN_REASON_PREV_AUTH_NOT_VALID == reason) { ++ /* TODO: 802.11r */ ++ ignore_received_deauth = 1; ++ } ++ } ++ ++ RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM, ignore=%d\n" ++ , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe), ignore_received_deauth); ++ ++ if (0 == ignore_received_deauth) ++ receive_disconnect(padapter, GetAddr2Ptr(pframe), reason, _FALSE); ++ } ++ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; ++ return _SUCCESS; ++ ++} ++ ++unsigned int OnDisassoc(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ unsigned short reason; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif /* CONFIG_P2P */ ++ ++ /* check A3 */ ++ if (!(_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) ++ return _SUCCESS; ++ ++ RTW_INFO(FUNC_ADPT_FMT" - Start to Disconnect\n", FUNC_ADPT_ARG(padapter)); ++ ++#ifdef CONFIG_P2P ++ if (pwdinfo->rx_invitereq_info.scan_op_ch_only) { ++ _cancel_timer_ex(&pwdinfo->reset_ch_sitesurvey); ++ _set_timer(&pwdinfo->reset_ch_sitesurvey, 10); ++ } ++#endif /* CONFIG_P2P */ ++ ++ reason = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); ++ ++ rtw_lock_rx_suspend_timeout(8000); ++ ++#ifdef CONFIG_AP_MODE ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { ++ _irqL irqL; ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ /* rtw_free_stainfo(padapter, psta); */ ++ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ ++ RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM\n" ++ , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe)); ++ ++ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ if (psta) { ++ u8 updated = _FALSE; ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { ++ rtw_list_delete(&psta->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ updated = ap_free_sta(padapter, psta, _FALSE, reason, _TRUE); ++ ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); ++ } ++ ++ return _SUCCESS; ++ } else ++#endif ++ { ++ RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM\n" ++ , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe)); ++ ++ receive_disconnect(padapter, GetAddr2Ptr(pframe), reason, _FALSE); ++ } ++ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; ++ return _SUCCESS; ++ ++} ++ ++unsigned int OnAtim(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ return _SUCCESS; ++} ++ ++unsigned int on_action_spct_ch_switch(_adapter *padapter, struct sta_info *psta, u8 *ies, uint ies_len) ++{ ++ unsigned int ret = _FAIL; ++ struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(mlmeext->mlmext_info); ++ ++ if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { ++ ret = _SUCCESS; ++ goto exit; ++ } ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) { ++ ++ int ch_switch_mode = -1, ch = -1, ch_switch_cnt = -1; ++ int ch_offset = -1; ++ u8 bwmode; ++ struct ieee80211_info_element *ie; ++ ++ RTW_INFO(FUNC_NDEV_FMT" from "MAC_FMT"\n", ++ FUNC_NDEV_ARG(padapter->pnetdev), MAC_ARG(psta->hwaddr)); ++ ++ for_each_ie(ie, ies, ies_len) { ++ if (ie->id == WLAN_EID_CHANNEL_SWITCH) { ++ ch_switch_mode = ie->data[0]; ++ ch = ie->data[1]; ++ ch_switch_cnt = ie->data[2]; ++ RTW_INFO("ch_switch_mode:%d, ch:%d, ch_switch_cnt:%d\n", ++ ch_switch_mode, ch, ch_switch_cnt); ++ } else if (ie->id == WLAN_EID_SECONDARY_CHANNEL_OFFSET) { ++ ch_offset = secondary_ch_offset_to_hal_ch_offset(ie->data[0]); ++ RTW_INFO("ch_offset:%d\n", ch_offset); ++ } ++ } ++ ++ if (ch == -1) ++ return _SUCCESS; ++ ++ if (ch_offset == -1) ++ bwmode = mlmeext->cur_bwmode; ++ else ++ bwmode = (ch_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) ? ++ CHANNEL_WIDTH_20 : CHANNEL_WIDTH_40; ++ ++ ch_offset = (ch_offset == -1) ? mlmeext->cur_ch_offset : ch_offset; ++ ++ /* todo: ++ * 1. the decision of channel switching ++ * 2. things after channel switching ++ */ ++ ++ ret = rtw_set_ch_cmd(padapter, ch, bwmode, ch_offset, _TRUE); ++ } ++ ++exit: ++ return ret; ++} ++ ++unsigned int on_action_spct(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ unsigned int ret = _FAIL; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint frame_len = precv_frame->u.hdr.len; ++ u8 *frame_body = (u8 *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ u8 category; ++ u8 action; ++ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev)); ++ ++ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ ++ if (!psta) ++ goto exit; ++ ++ category = frame_body[0]; ++ if (category != RTW_WLAN_CATEGORY_SPECTRUM_MGMT) ++ goto exit; ++ ++ action = frame_body[1]; ++ switch (action) { ++ case RTW_WLAN_ACTION_SPCT_MSR_REQ: ++ case RTW_WLAN_ACTION_SPCT_MSR_RPRT: ++ case RTW_WLAN_ACTION_SPCT_TPC_REQ: ++ case RTW_WLAN_ACTION_SPCT_TPC_RPRT: ++ break; ++ case RTW_WLAN_ACTION_SPCT_CHL_SWITCH: ++#ifdef CONFIG_SPCT_CH_SWITCH ++ ret = on_action_spct_ch_switch(padapter, psta, &frame_body[2], ++ frame_len - (frame_body - pframe) - 2); ++#endif ++ break; ++ default: ++ break; ++ } ++ ++exit: ++ return ret; ++} ++ ++unsigned int OnAction_qos(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ return _SUCCESS; ++} ++ ++unsigned int OnAction_dls(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ return _SUCCESS; ++} ++ ++#ifdef CONFIG_RTW_WNM ++unsigned int on_action_wnm(_adapter *adapter, union recv_frame *rframe) ++{ ++ unsigned int ret = _FAIL; ++ struct sta_info *sta = NULL; ++ struct sta_priv *stapriv = &adapter->stapriv; ++ u8 *frame = rframe->u.hdr.rx_data; ++ uint frame_len = rframe->u.hdr.len; ++ u8 *frame_body = (u8 *)(frame + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ u8 category; ++ u8 action; ++ int cnt = 0; ++ char msg[16]; ++ ++ sta = rtw_get_stainfo(stapriv, GetAddr2Ptr(frame)); ++ if (!sta) ++ goto exit; ++ ++ category = frame_body[0]; ++ if (category != RTW_WLAN_CATEGORY_WNM) ++ goto exit; ++ ++ action = frame_body[1]; ++ ++ switch (action) { ++ default: ++ #ifdef CONFIG_IOCTL_CFG80211 ++ cnt += sprintf((msg + cnt), "ACT_WNM %u", action); ++ rtw_cfg80211_rx_action(adapter, rframe, msg); ++ #endif ++ ret = _SUCCESS; ++ break; ++ } ++ ++exit: ++ return ret; ++} ++#endif /* CONFIG_RTW_WNM */ ++ ++/** ++ * rtw_rx_ampdu_size - Get the target RX AMPDU buffer size for the specific @adapter ++ * @adapter: the adapter to get target RX AMPDU buffer size ++ * ++ * Returns: the target RX AMPDU buffer size ++ */ ++u8 rtw_rx_ampdu_size(_adapter *adapter) ++{ ++ u8 size; ++ HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor; ++ ++ if (adapter->fix_rx_ampdu_size != RX_AMPDU_SIZE_INVALID) { ++ size = adapter->fix_rx_ampdu_size; ++ goto exit; ++ } ++ ++#ifdef CONFIG_BT_COEXIST ++ if (rtw_btcoex_IsBTCoexCtrlAMPDUSize(adapter) == _TRUE) { ++ size = rtw_btcoex_GetAMPDUSize(adapter); ++ goto exit; ++ } ++#endif ++ ++ /* for scan */ ++ if (!mlmeext_chk_scan_state(&adapter->mlmeextpriv, SCAN_DISABLE) ++ && !mlmeext_chk_scan_state(&adapter->mlmeextpriv, SCAN_COMPLETE) ++ && adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_size != RX_AMPDU_SIZE_INVALID ++ ) { ++ size = adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_size; ++ goto exit; ++ } ++ ++ /* default value based on max_rx_ampdu_factor */ ++ if (adapter->driver_rx_ampdu_factor != 0xFF) ++ max_rx_ampdu_factor = (HT_CAP_AMPDU_FACTOR)adapter->driver_rx_ampdu_factor; ++ else ++ rtw_hal_get_def_var(adapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); ++ ++ if (MAX_AMPDU_FACTOR_64K == max_rx_ampdu_factor) ++ size = 64; ++ else if (MAX_AMPDU_FACTOR_32K == max_rx_ampdu_factor) ++ size = 32; ++ else if (MAX_AMPDU_FACTOR_16K == max_rx_ampdu_factor) ++ size = 16; ++ else if (MAX_AMPDU_FACTOR_8K == max_rx_ampdu_factor) ++ size = 8; ++ else ++ size = 64; ++ ++exit: ++ ++ if (size > 127) ++ size = 127; ++ ++ return size; ++} ++ ++/** ++ * rtw_rx_ampdu_is_accept - Get the permission if RX AMPDU should be set up for the specific @adapter ++ * @adapter: the adapter to get the permission if RX AMPDU should be set up ++ * ++ * Returns: accept or not ++ */ ++bool rtw_rx_ampdu_is_accept(_adapter *adapter) ++{ ++ bool accept; ++ ++ if (adapter->fix_rx_ampdu_accept != RX_AMPDU_ACCEPT_INVALID) { ++ accept = adapter->fix_rx_ampdu_accept; ++ goto exit; ++ } ++ ++#ifdef CONFIG_BT_COEXIST ++ if (rtw_btcoex_IsBTCoexRejectAMPDU(adapter) == _TRUE) { ++ accept = _FALSE; ++ goto exit; ++ } ++#endif ++ ++ /* for scan */ ++ if (!mlmeext_chk_scan_state(&adapter->mlmeextpriv, SCAN_DISABLE) ++ && !mlmeext_chk_scan_state(&adapter->mlmeextpriv, SCAN_COMPLETE) ++ && adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_accept != RX_AMPDU_ACCEPT_INVALID ++ ) { ++ accept = adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_accept; ++ goto exit; ++ } ++ ++ /* default value for other cases */ ++ accept = adapter->mlmeextpriv.mlmext_info.bAcceptAddbaReq; ++ ++exit: ++ return accept; ++} ++ ++/** ++ * rtw_rx_ampdu_set_size - Set the target RX AMPDU buffer size for the specific @adapter and specific @reason ++ * @adapter: the adapter to set target RX AMPDU buffer size ++ * @size: the target RX AMPDU buffer size to set ++ * @reason: reason for the target RX AMPDU buffer size setting ++ * ++ * Returns: whether the target RX AMPDU buffer size is changed ++ */ ++bool rtw_rx_ampdu_set_size(_adapter *adapter, u8 size, u8 reason) ++{ ++ bool is_adj = _FALSE; ++ struct mlme_ext_priv *mlmeext; ++ struct mlme_ext_info *mlmeinfo; ++ ++ mlmeext = &adapter->mlmeextpriv; ++ mlmeinfo = &mlmeext->mlmext_info; ++ ++ if (reason == RX_AMPDU_DRV_FIXED) { ++ if (adapter->fix_rx_ampdu_size != size) { ++ adapter->fix_rx_ampdu_size = size; ++ is_adj = _TRUE; ++ RTW_INFO(FUNC_ADPT_FMT" fix_rx_ampdu_size:%u\n", FUNC_ADPT_ARG(adapter), size); ++ } ++ } else if (reason == RX_AMPDU_DRV_SCAN) { ++ struct ss_res *ss = &adapter->mlmeextpriv.sitesurvey_res; ++ ++ if (ss->rx_ampdu_size != size) { ++ ss->rx_ampdu_size = size; ++ is_adj = _TRUE; ++ RTW_INFO(FUNC_ADPT_FMT" ss.rx_ampdu_size:%u\n", FUNC_ADPT_ARG(adapter), size); ++ } ++ } ++ ++ return is_adj; ++} ++ ++/** ++ * rtw_rx_ampdu_set_accept - Set the permission if RX AMPDU should be set up for the specific @adapter and specific @reason ++ * @adapter: the adapter to set if RX AMPDU should be set up ++ * @accept: if RX AMPDU should be set up ++ * @reason: reason for the permission if RX AMPDU should be set up ++ * ++ * Returns: whether the permission if RX AMPDU should be set up is changed ++ */ ++bool rtw_rx_ampdu_set_accept(_adapter *adapter, u8 accept, u8 reason) ++{ ++ bool is_adj = _FALSE; ++ struct mlme_ext_priv *mlmeext; ++ struct mlme_ext_info *mlmeinfo; ++ ++ mlmeext = &adapter->mlmeextpriv; ++ mlmeinfo = &mlmeext->mlmext_info; ++ ++ if (reason == RX_AMPDU_DRV_FIXED) { ++ if (adapter->fix_rx_ampdu_accept != accept) { ++ adapter->fix_rx_ampdu_accept = accept; ++ is_adj = _TRUE; ++ RTW_INFO(FUNC_ADPT_FMT" fix_rx_ampdu_accept:%u\n", FUNC_ADPT_ARG(adapter), accept); ++ } ++ } else if (reason == RX_AMPDU_DRV_SCAN) { ++ if (adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_accept != accept) { ++ adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_accept = accept; ++ is_adj = _TRUE; ++ RTW_INFO(FUNC_ADPT_FMT" ss.rx_ampdu_accept:%u\n", FUNC_ADPT_ARG(adapter), accept); ++ } ++ } ++ ++ return is_adj; ++} ++ ++/** ++ * rx_ampdu_apply_sta_tid - Apply RX AMPDU setting to the specific @sta and @tid ++ * @adapter: the adapter to which @sta belongs ++ * @sta: the sta to be checked ++ * @tid: the tid to be checked ++ * @accept: the target permission if RX AMPDU should be set up ++ * @size: the target RX AMPDU buffer size ++ * ++ * Returns: ++ * 0: no canceled ++ * 1: canceled by no permission ++ * 2: canceled by different buffer size ++ * 3: canceled by potential mismatched status ++ * ++ * Blocking function, may sleep ++ */ ++u8 rx_ampdu_apply_sta_tid(_adapter *adapter, struct sta_info *sta, u8 tid, u8 accept, u8 size) ++{ ++ u8 ret = 0; ++ struct recv_reorder_ctrl *reorder_ctl = &sta->recvreorder_ctrl[tid]; ++ ++ if (reorder_ctl->enable == _FALSE) { ++ if (reorder_ctl->ampdu_size != RX_AMPDU_SIZE_INVALID) { ++ send_delba_sta_tid_wait_ack(adapter, 0, sta, tid, 1); ++ ret = 3; ++ } ++ goto exit; ++ } ++ ++ if (accept == _FALSE) { ++ send_delba_sta_tid_wait_ack(adapter, 0, sta, tid, 0); ++ ret = 1; ++ } else if (reorder_ctl->ampdu_size != size) { ++ send_delba_sta_tid_wait_ack(adapter, 0, sta, tid, 0); ++ ret = 2; ++ } ++ ++exit: ++ return ret; ++} ++ ++/** ++ * rx_ampdu_apply_sta - Apply RX AMPDU setting to the specific @sta ++ * @adapter: the adapter to which @sta belongs ++ * @sta: the sta to be checked ++ * @accept: the target permission if RX AMPDU should be set up ++ * @size: the target RX AMPDU buffer size ++ * ++ * Returns: number of the RX AMPDU assciation canceled for applying current target setting ++ * ++ * Blocking function, may sleep ++ */ ++u8 rx_ampdu_apply_sta(_adapter *adapter, struct sta_info *sta, u8 accept, u8 size) ++{ ++ u8 change_cnt = 0; ++ int i; ++ ++ for (i = 0; i < TID_NUM; i++) { ++ if (rx_ampdu_apply_sta_tid(adapter, sta, i, accept, size) != 0) ++ change_cnt++; ++ } ++ ++ return change_cnt; ++} ++ ++/** ++ * rtw_rx_ampdu_apply - Apply the current target RX AMPDU setting for the specific @adapter ++ * @adapter: the adapter to be applied ++ * ++ * Returns: number of the RX AMPDU assciation canceled for applying current target setting ++ */ ++u16 rtw_rx_ampdu_apply(_adapter *adapter) ++{ ++ u16 adj_cnt = 0; ++ struct mlme_ext_priv *mlmeext; ++ struct sta_info *sta; ++ u8 accept = rtw_rx_ampdu_is_accept(adapter); ++ u8 size = rtw_rx_ampdu_size(adapter); ++ ++ mlmeext = &adapter->mlmeextpriv; ++ ++ if (mlmeext_msr(mlmeext) == WIFI_FW_STATION_STATE) { ++ sta = rtw_get_stainfo(&adapter->stapriv, get_bssid(&adapter->mlmepriv)); ++ if (sta) ++ adj_cnt += rx_ampdu_apply_sta(adapter, sta, accept, size); ++#ifdef CONFIG_AP_MODE ++ } else if (mlmeext_msr(mlmeext) == WIFI_FW_AP_STATE) { ++ _irqL irqL; ++ _list *phead, *plist; ++ u8 peer_num = 0; ++ char peers[NUM_STA]; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ int i; ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ int stainfo_offset; ++ ++ sta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ plist = get_next(plist); ++ ++ stainfo_offset = rtw_stainfo_offset(pstapriv, sta); ++ if (stainfo_offset_valid(stainfo_offset)) ++ peers[peer_num++] = stainfo_offset; ++ } ++ ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ for (i = 0; i < peer_num; i++) { ++ sta = rtw_get_stainfo_by_offset(pstapriv, peers[i]); ++ if (sta) ++ adj_cnt += rx_ampdu_apply_sta(adapter, sta, accept, size); ++ } ++#endif ++ } ++ ++ return adj_cnt; ++} ++ ++unsigned int OnAction_back(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ u8 *addr; ++ struct sta_info *psta = NULL; ++ struct recv_reorder_ctrl *preorder_ctrl; ++ unsigned char *frame_body; ++ unsigned char category, action; ++ unsigned short tid, status, reason_code = 0; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++#ifdef CONFIG_80211N_HT ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ /* check RA matches or not */ ++ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) ++ return _SUCCESS; ++ ++#if 0 ++ /* check A1 matches or not */ ++ if (!_rtw_memcmp(adapter_mac_addr(padapter), get_da(pframe), ETH_ALEN)) ++ return _SUCCESS; ++#endif ++ ++ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) ++ if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) ++ return _SUCCESS; ++ ++ addr = GetAddr2Ptr(pframe); ++ psta = rtw_get_stainfo(pstapriv, addr); ++ ++ if (psta == NULL) ++ return _SUCCESS; ++ ++ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ ++ category = frame_body[0]; ++ if (category == RTW_WLAN_CATEGORY_BACK) { /* representing Block Ack */ ++#ifdef CONFIG_TDLS ++ if ((psta->tdls_sta_state & TDLS_LINKED_STATE) && ++ (psta->htpriv.ht_option == _TRUE) && ++ (psta->htpriv.ampdu_enable == _TRUE)) ++ RTW_INFO("Recv [%s] from direc link\n", __FUNCTION__); ++ else ++#endif /* CONFIG_TDLS */ ++ if (!pmlmeinfo->HT_enable) ++ return _SUCCESS; ++ ++ action = frame_body[1]; ++ RTW_INFO("%s, action=%d\n", __FUNCTION__, action); ++ switch (action) { ++ case RTW_WLAN_ACTION_ADDBA_REQ: /* ADDBA request */ ++ ++ _rtw_memcpy(&(pmlmeinfo->ADDBA_req), &(frame_body[2]), sizeof(struct ADDBA_request)); ++ /* process_addba_req(padapter, (u8*)&(pmlmeinfo->ADDBA_req), GetAddr3Ptr(pframe)); */ ++ process_addba_req(padapter, (u8 *)&(pmlmeinfo->ADDBA_req), addr); ++ ++ break; ++#ifdef CONFIG_AP_MODE ++ case RTW_WLAN_ACTION_ADDBA_RESP: /* ADDBA response */ ++ ++ /* status = frame_body[3] | (frame_body[4] << 8); */ /* endian issue */ ++ status = RTW_GET_LE16(&frame_body[3]); ++ tid = ((frame_body[5] >> 2) & 0x7); ++ ++ if (status == 0) { ++ /* successful */ ++ RTW_INFO("agg_enable for TID=%d\n", tid); ++ psta->htpriv.agg_enable_bitmap |= 1 << tid; ++ psta->htpriv.candidate_tid_bitmap &= ~BIT(tid); ++ } else ++ psta->htpriv.agg_enable_bitmap &= ~BIT(tid); ++ ++ if (psta->state & WIFI_STA_ALIVE_CHK_STATE) { ++ RTW_INFO("%s alive check - rx ADDBA response\n", __func__); ++ psta->htpriv.agg_enable_bitmap &= ~BIT(tid); ++ psta->expire_to = pstapriv->expire_to; ++ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; ++ } ++ ++ /* RTW_INFO("marc: ADDBA RSP: %x\n", pmlmeinfo->agg_enable_bitmap); */ ++ break; ++#endif ++ case RTW_WLAN_ACTION_DELBA: /* DELBA */ ++ if ((frame_body[3] & BIT(3)) == 0) { ++ psta->htpriv.agg_enable_bitmap &= ~(1 << ((frame_body[3] >> 4) & 0xf)); ++ psta->htpriv.candidate_tid_bitmap &= ~(1 << ((frame_body[3] >> 4) & 0xf)); ++ ++ /* reason_code = frame_body[4] | (frame_body[5] << 8); */ ++ reason_code = RTW_GET_LE16(&frame_body[4]); ++ } else if ((frame_body[3] & BIT(3)) == BIT(3)) { ++ tid = (frame_body[3] >> 4) & 0x0F; ++ ++ preorder_ctrl = &psta->recvreorder_ctrl[tid]; ++ preorder_ctrl->enable = _FALSE; ++ preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; ++ } ++ ++ RTW_INFO("%s(): DELBA: %x(%x)\n", __FUNCTION__, pmlmeinfo->agg_enable_bitmap, reason_code); ++ /* todo: how to notify the host while receiving DELETE BA */ ++ break; ++ ++ default: ++ break; ++ } ++ } ++#endif /* CONFIG_80211N_HT */ ++ return _SUCCESS; ++} ++ ++#ifdef CONFIG_P2P ++ ++static int get_reg_classes_full_count(struct p2p_channels channel_list) ++{ ++ int cnt = 0; ++ int i; ++ ++ for (i = 0; i < channel_list.reg_classes; i++) ++ cnt += channel_list.reg_class[i].channels; ++ ++ return cnt; ++} ++ ++static void get_channel_cnt_24g_5gl_5gh(struct mlme_ext_priv *pmlmeext, u8 *p24g_cnt, u8 *p5gl_cnt, u8 *p5gh_cnt) ++{ ++ int i = 0; ++ ++ *p24g_cnt = 0; ++ *p5gl_cnt = 0; ++ *p5gh_cnt = 0; ++ ++ for (i = 0; i < pmlmeext->max_chan_nums; i++) { ++ if (pmlmeext->channel_set[i].ChannelNum <= 14) ++ (*p24g_cnt)++; ++ else if ((pmlmeext->channel_set[i].ChannelNum > 14) && (pmlmeext->channel_set[i].ChannelNum <= 48)) { ++ /* Just include the channel 36, 40, 44, 48 channels for 5G low */ ++ (*p5gl_cnt)++; ++ } else if ((pmlmeext->channel_set[i].ChannelNum >= 149) && (pmlmeext->channel_set[i].ChannelNum <= 161)) { ++ /* Just include the channel 149, 153, 157, 161 channels for 5G high */ ++ (*p5gh_cnt)++; ++ } ++ } ++} ++ ++void issue_p2p_GO_request(_adapter *padapter, u8 *raddr) ++{ ++ ++ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = P2P_PUB_ACTION_ACTION; ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_GO_NEGO_REQ; ++ u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; ++ u8 wpsielen = 0, p2pielen = 0, i; ++ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; ++ u16 len_channellist_attr = 0; ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ RTW_INFO("[%s] In\n", __FUNCTION__); ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pwdinfo->negotiation_dialog_token = 1; /* Initialize the dialog value */ ++ pframe = rtw_set_fixed_ie(pframe, 1, &pwdinfo->negotiation_dialog_token, &(pattrib->pktlen)); ++ ++ ++ ++ /* WPS Section */ ++ wpsielen = 0; ++ /* WPS OUI */ ++ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); ++ wpsielen += 4; ++ ++ /* WPS version */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ ++ ++ /* Device Password ID */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_PWID); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); ++ wpsielen += 2; ++ ++ /* Value: */ ++ ++ if (pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PEER_DISPLAY_PIN) ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_USER_SPEC); ++ else if (pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_SELF_DISPLAY_PIN) ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_REGISTRAR_SPEC); ++ else if (pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PBC) ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_PBC); ++ ++ wpsielen += 2; ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); ++ ++ ++ /* P2P IE Section. */ ++ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* Commented by Albert 20110306 */ ++ /* According to the P2P Specification, the group negoitation request frame should contain 9 P2P attributes */ ++ /* 1. P2P Capability */ ++ /* 2. Group Owner Intent */ ++ /* 3. Configuration Timeout */ ++ /* 4. Listen Channel */ ++ /* 5. Extended Listen Timing */ ++ /* 6. Intended P2P Interface Address */ ++ /* 7. Channel List */ ++ /* 8. P2P Device Info */ ++ /* 9. Operating Channel */ ++ ++ ++ /* P2P Capability */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Device Capability Bitmap, 1 byte */ ++ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; ++ ++ /* Group Capability Bitmap, 1 byte */ ++ if (pwdinfo->persistent_supported) ++ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN | P2P_GRPCAP_PERSISTENT_GROUP; ++ else ++ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN; ++ ++ ++ /* Group Owner Intent */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_GO_INTENT; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Todo the tie breaker bit. */ ++ p2pie[p2pielen++] = ((pwdinfo->intent << 1) & 0xFE); ++ ++ /* Configuration Timeout */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CONF_TIMEOUT; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P GO */ ++ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P Client */ ++ ++ ++ /* Listen Channel */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_LISTEN_CH; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x51; /* Copy from SD7 */ ++ ++ /* Channel Number */ ++ p2pie[p2pielen++] = pwdinfo->listen_channel; /* listening channel number */ ++ ++ ++ /* Extended Listen Timing ATTR */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_EX_LISTEN_TIMING; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0004); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Availability Period */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0xFFFF); ++ p2pielen += 2; ++ ++ /* Availability Interval */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0xFFFF); ++ p2pielen += 2; ++ ++ ++ /* Intended P2P Interface Address */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_INTENDED_IF_ADDR; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN); ++ p2pielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ ++ /* Channel List */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; ++ ++ /* Length: */ ++ /* Country String(3) */ ++ /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ ++ /* + number of channels in all classes */ ++ len_channellist_attr = 3 ++ + (1 + 1) * (u16)(pmlmeext->channel_list.reg_classes) ++ + get_reg_classes_full_count(pmlmeext->channel_list); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(5 + 1); ++ else ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); ++#else ++ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); ++ ++#endif ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Channel Entry List */ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ ++ /* Operating Class */ ++ if (union_ch > 14) { ++ if (union_ch >= 149) ++ p2pie[p2pielen++] = 0x7c; ++ else ++ p2pie[p2pielen++] = 0x73; ++ } else ++ p2pie[p2pielen++] = 0x51; ++ ++ ++ /* Number of Channels */ ++ /* Just support 1 channel and this channel is AP's channel */ ++ p2pie[p2pielen++] = 1; ++ ++ /* Channel List */ ++ p2pie[p2pielen++] = union_ch; ++ } else { ++ int i, j; ++ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; ++ ++ /* Number of Channels */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; ++ ++ /* Channel List */ ++ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; ++ } ++ } ++#else /* CONFIG_CONCURRENT_MODE */ ++ { ++ int i, j; ++ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; ++ ++ /* Number of Channels */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; ++ ++ /* Channel List */ ++ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; ++ } ++ } ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ /* Device Info */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ ++ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(21 + pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* P2P Device Address */ ++ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ /* Config Method */ ++ /* This field should be big endian. Noted by P2P specification. */ ++ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->supported_wps_cm); ++ ++ p2pielen += 2; ++ ++ /* Primary Device Type */ ++ /* Category ID */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); ++ p2pielen += 2; ++ ++ /* OUI */ ++ *(u32 *)(p2pie + p2pielen) = cpu_to_be32(WPSOUI); ++ p2pielen += 4; ++ ++ /* Sub Category ID */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); ++ p2pielen += 2; ++ ++ /* Number of Secondary Device Types */ ++ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ ++ ++ /* Device Name */ ++ /* Type: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); ++ p2pielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name , pwdinfo->device_name_len); ++ p2pielen += pwdinfo->device_name_len; ++ ++ ++ /* Operating Channel */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Operating Class */ ++ if (pwdinfo->operating_channel <= 14) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x51; ++ } else if ((pwdinfo->operating_channel >= 36) && (pwdinfo->operating_channel <= 48)) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x73; ++ } else { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x7c; ++ } ++ ++ /* Channel Number */ ++ p2pie[p2pielen++] = pwdinfo->operating_channel; /* operating channel number */ ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); ++ ++#ifdef CONFIG_WFD ++ wfdielen = build_nego_req_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++#endif ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ return; ++ ++} ++ ++ ++void issue_p2p_GO_response(_adapter *padapter, u8 *raddr, u8 *frame_body, uint len, u8 result) ++{ ++ ++ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = P2P_PUB_ACTION_ACTION; ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_GO_NEGO_RESP; ++ u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; ++ u8 p2pielen = 0, i; ++ uint wpsielen = 0; ++ u16 wps_devicepassword_id = 0x0000; ++ uint wps_devicepassword_id_len = 0; ++ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh; ++ u16 len_channellist_attr = 0; ++ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ RTW_INFO("[%s] In, result = %d\n", __FUNCTION__, result); ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pwdinfo->negotiation_dialog_token = frame_body[7]; /* The Dialog Token of provisioning discovery request frame. */ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(pwdinfo->negotiation_dialog_token), &(pattrib->pktlen)); ++ ++ /* Commented by Albert 20110328 */ ++ /* Try to get the device password ID from the WPS IE of group negotiation request frame */ ++ /* WiFi Direct test plan 5.1.15 */ ++ rtw_get_wps_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, wpsie, &wpsielen); ++ rtw_get_wps_attr_content(wpsie, wpsielen, WPS_ATTR_DEVICE_PWID, (u8 *) &wps_devicepassword_id, &wps_devicepassword_id_len); ++ wps_devicepassword_id = be16_to_cpu(wps_devicepassword_id); ++ ++ _rtw_memset(wpsie, 0x00, 255); ++ wpsielen = 0; ++ ++ /* WPS Section */ ++ wpsielen = 0; ++ /* WPS OUI */ ++ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); ++ wpsielen += 4; ++ ++ /* WPS version */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ ++ ++ /* Device Password ID */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_PWID); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); ++ wpsielen += 2; ++ ++ /* Value: */ ++ if (wps_devicepassword_id == WPS_DPID_USER_SPEC) ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_REGISTRAR_SPEC); ++ else if (wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC) ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_USER_SPEC); ++ else ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_PBC); ++ wpsielen += 2; ++ ++ /* Commented by Kurt 20120113 */ ++ /* If some device wants to do p2p handshake without sending prov_disc_req */ ++ /* We have to get peer_req_cm from here. */ ++ if (_rtw_memcmp(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "000", 3)) { ++ if (wps_devicepassword_id == WPS_DPID_USER_SPEC) ++ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "dis", 3); ++ else if (wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC) ++ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pad", 3); ++ else ++ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pbc", 3); ++ } ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); ++ ++ ++ /* P2P IE Section. */ ++ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* Commented by Albert 20100908 */ ++ /* According to the P2P Specification, the group negoitation response frame should contain 9 P2P attributes */ ++ /* 1. Status */ ++ /* 2. P2P Capability */ ++ /* 3. Group Owner Intent */ ++ /* 4. Configuration Timeout */ ++ /* 5. Operating Channel */ ++ /* 6. Intended P2P Interface Address */ ++ /* 7. Channel List */ ++ /* 8. Device Info */ ++ /* 9. Group ID ( Only GO ) */ ++ ++ ++ /* ToDo: */ ++ ++ /* P2P Status */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_STATUS; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); ++ p2pielen += 2; ++ ++ /* Value: */ ++ p2pie[p2pielen++] = result; ++ ++ /* P2P Capability */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Device Capability Bitmap, 1 byte */ ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) { ++ /* Commented by Albert 2011/03/08 */ ++ /* According to the P2P specification */ ++ /* if the sending device will be client, the P2P Capability should be reserved of group negotation response frame */ ++ p2pie[p2pielen++] = 0; ++ } else { ++ /* Be group owner or meet the error case */ ++ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; ++ } ++ ++ /* Group Capability Bitmap, 1 byte */ ++ if (pwdinfo->persistent_supported) ++ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN | P2P_GRPCAP_PERSISTENT_GROUP; ++ else ++ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN; ++ ++ /* Group Owner Intent */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_GO_INTENT; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); ++ p2pielen += 2; ++ ++ /* Value: */ ++ if (pwdinfo->peer_intent & 0x01) { ++ /* Peer's tie breaker bit is 1, our tie breaker bit should be 0 */ ++ p2pie[p2pielen++] = (pwdinfo->intent << 1); ++ } else { ++ /* Peer's tie breaker bit is 0, our tie breaker bit should be 1 */ ++ p2pie[p2pielen++] = ((pwdinfo->intent << 1) | BIT(0)); ++ } ++ ++ ++ /* Configuration Timeout */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CONF_TIMEOUT; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P GO */ ++ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P Client */ ++ ++ /* Operating Channel */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Operating Class */ ++ if (pwdinfo->operating_channel <= 14) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x51; ++ } else if ((pwdinfo->operating_channel >= 36) && (pwdinfo->operating_channel <= 48)) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x73; ++ } else { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x7c; ++ } ++ ++ /* Channel Number */ ++ p2pie[p2pielen++] = pwdinfo->operating_channel; /* operating channel number */ ++ ++ /* Intended P2P Interface Address */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_INTENDED_IF_ADDR; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN); ++ p2pielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ /* Channel List */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; ++ ++ /* Country String(3) */ ++ /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ ++ /* + number of channels in all classes */ ++ len_channellist_attr = 3 ++ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes ++ + get_reg_classes_full_count(pmlmeext->channel_list); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(5 + 1); ++ else ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); ++#else ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); ++ ++#endif ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Channel Entry List */ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { ++ ++ u8 union_chan = rtw_mi_get_union_chan(padapter); ++ ++ /*Operating Class*/ ++ if (union_chan > 14) { ++ if (union_chan >= 149) ++ p2pie[p2pielen++] = 0x7c; ++ else ++ p2pie[p2pielen++] = 0x73; ++ ++ } else ++ p2pie[p2pielen++] = 0x51; ++ ++ /* Number of Channels ++ Just support 1 channel and this channel is AP's channel*/ ++ p2pie[p2pielen++] = 1; ++ ++ /*Channel List*/ ++ p2pie[p2pielen++] = union_chan; ++ } else { ++ int i, j; ++ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; ++ ++ /* Number of Channels */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; ++ ++ /* Channel List */ ++ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; ++ } ++ } ++#else /* CONFIG_CONCURRENT_MODE */ ++ { ++ int i, j; ++ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; ++ ++ /* Number of Channels */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; ++ ++ /* Channel List */ ++ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; ++ } ++ } ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ ++ /* Device Info */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ ++ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(21 + pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* P2P Device Address */ ++ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ /* Config Method */ ++ /* This field should be big endian. Noted by P2P specification. */ ++ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->supported_wps_cm); ++ ++ p2pielen += 2; ++ ++ /* Primary Device Type */ ++ /* Category ID */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); ++ p2pielen += 2; ++ ++ /* OUI */ ++ *(u32 *)(p2pie + p2pielen) = cpu_to_be32(WPSOUI); ++ p2pielen += 4; ++ ++ /* Sub Category ID */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); ++ p2pielen += 2; ++ ++ /* Number of Secondary Device Types */ ++ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ ++ ++ /* Device Name */ ++ /* Type: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); ++ p2pielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name , pwdinfo->device_name_len); ++ p2pielen += pwdinfo->device_name_len; ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ /* Group ID Attribute */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_GROUP_ID; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN + pwdinfo->nego_ssidlen); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* p2P Device Address */ ++ _rtw_memcpy(p2pie + p2pielen , pwdinfo->device_addr, ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ /* SSID */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen); ++ p2pielen += pwdinfo->nego_ssidlen; ++ ++ } ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); ++ ++#ifdef CONFIG_WFD ++ wfdielen = build_nego_resp_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++#endif ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ return; ++ ++} ++ ++void issue_p2p_GO_confirm(_adapter *padapter, u8 *raddr, u8 result) ++{ ++ ++ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = P2P_PUB_ACTION_ACTION; ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_GO_NEGO_CONF; ++ u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; ++ u8 wpsielen = 0, p2pielen = 0; ++ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ RTW_INFO("[%s] In\n", __FUNCTION__); ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(pwdinfo->negotiation_dialog_token), &(pattrib->pktlen)); ++ ++ ++ ++ /* P2P IE Section. */ ++ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* Commented by Albert 20110306 */ ++ /* According to the P2P Specification, the group negoitation request frame should contain 5 P2P attributes */ ++ /* 1. Status */ ++ /* 2. P2P Capability */ ++ /* 3. Operating Channel */ ++ /* 4. Channel List */ ++ /* 5. Group ID ( if this WiFi is GO ) */ ++ ++ /* P2P Status */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_STATUS; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); ++ p2pielen += 2; ++ ++ /* Value: */ ++ p2pie[p2pielen++] = result; ++ ++ /* P2P Capability */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Device Capability Bitmap, 1 byte */ ++ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; ++ ++ /* Group Capability Bitmap, 1 byte */ ++ if (pwdinfo->persistent_supported) ++ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN | P2P_GRPCAP_PERSISTENT_GROUP; ++ else ++ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN; ++ ++ ++ /* Operating Channel */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) { ++ if (pwdinfo->peer_operating_ch <= 14) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x51; ++ } else if ((pwdinfo->peer_operating_ch >= 36) && (pwdinfo->peer_operating_ch <= 48)) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x73; ++ } else { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x7c; ++ } ++ ++ p2pie[p2pielen++] = pwdinfo->peer_operating_ch; ++ } else { ++ if (pwdinfo->operating_channel <= 14) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x51; ++ } else if ((pwdinfo->operating_channel >= 36) && (pwdinfo->operating_channel <= 48)) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x73; ++ } else { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x7c; ++ } ++ ++ /* Channel Number */ ++ p2pie[p2pielen++] = pwdinfo->operating_channel; /* Use the listen channel as the operating channel */ ++ } ++ ++ ++ /* Channel List */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; ++ ++ *(u16 *)(p2pie + p2pielen) = 6; ++ p2pielen += 2; ++ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Value: */ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) { ++ if (pwdinfo->peer_operating_ch <= 14) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x51; ++ } else if ((pwdinfo->peer_operating_ch >= 36) && (pwdinfo->peer_operating_ch <= 48)) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x73; ++ } else { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x7c; ++ } ++ p2pie[p2pielen++] = 1; ++ p2pie[p2pielen++] = pwdinfo->peer_operating_ch; ++ } else { ++ if (pwdinfo->operating_channel <= 14) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x51; ++ } else if ((pwdinfo->operating_channel >= 36) && (pwdinfo->operating_channel <= 48)) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x73; ++ } else { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x7c; ++ } ++ ++ /* Channel Number */ ++ p2pie[p2pielen++] = 1; ++ p2pie[p2pielen++] = pwdinfo->operating_channel; /* Use the listen channel as the operating channel */ ++ } ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ /* Group ID Attribute */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_GROUP_ID; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN + pwdinfo->nego_ssidlen); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* p2P Device Address */ ++ _rtw_memcpy(p2pie + p2pielen , pwdinfo->device_addr, ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ /* SSID */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen); ++ p2pielen += pwdinfo->nego_ssidlen; ++ } ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); ++ ++#ifdef CONFIG_WFD ++ wfdielen = build_nego_confirm_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++#endif ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ return; ++ ++} ++ ++void issue_p2p_invitation_request(_adapter *padapter, u8 *raddr) ++{ ++ ++ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = P2P_PUB_ACTION_ACTION; ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_INVIT_REQ; ++ u8 p2pie[255] = { 0x00 }; ++ u8 p2pielen = 0, i; ++ u8 dialogToken = 3; ++ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; ++ u16 len_channellist_attr = 0; ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, raddr, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ ++ /* P2P IE Section. */ ++ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* Commented by Albert 20101011 */ ++ /* According to the P2P Specification, the P2P Invitation request frame should contain 7 P2P attributes */ ++ /* 1. Configuration Timeout */ ++ /* 2. Invitation Flags */ ++ /* 3. Operating Channel ( Only GO ) */ ++ /* 4. P2P Group BSSID ( Should be included if I am the GO ) */ ++ /* 5. Channel List */ ++ /* 6. P2P Group ID */ ++ /* 7. P2P Device Info */ ++ ++ /* Configuration Timeout */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CONF_TIMEOUT; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P GO */ ++ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P Client */ ++ ++ /* Invitation Flags */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_INVITATION_FLAGS; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); ++ p2pielen += 2; ++ ++ /* Value: */ ++ p2pie[p2pielen++] = P2P_INVITATION_FLAGS_PERSISTENT; ++ ++ ++ /* Operating Channel */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Operating Class */ ++ if (pwdinfo->invitereq_info.operating_ch <= 14) ++ p2pie[p2pielen++] = 0x51; ++ else if ((pwdinfo->invitereq_info.operating_ch >= 36) && (pwdinfo->invitereq_info.operating_ch <= 48)) ++ p2pie[p2pielen++] = 0x73; ++ else ++ p2pie[p2pielen++] = 0x7c; ++ ++ /* Channel Number */ ++ p2pie[p2pielen++] = pwdinfo->invitereq_info.operating_ch; /* operating channel number */ ++ ++ if (_rtw_memcmp(adapter_mac_addr(padapter), pwdinfo->invitereq_info.go_bssid, ETH_ALEN)) { ++ /* P2P Group BSSID */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_GROUP_BSSID; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* P2P Device Address for GO */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->invitereq_info.go_bssid, ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ } ++ ++ /* Channel List */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; ++ ++ ++ /* Length: */ ++ /* Country String(3) */ ++ /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ ++ /* + number of channels in all classes */ ++ len_channellist_attr = 3 ++ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes ++ + get_reg_classes_full_count(pmlmeext->channel_list); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(5 + 1); ++ else ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); ++#else ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); ++#endif ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Channel Entry List */ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ ++ /* Operating Class */ ++ if (union_ch > 14) { ++ if (union_ch >= 149) ++ p2pie[p2pielen++] = 0x7c; ++ else ++ p2pie[p2pielen++] = 0x73; ++ } else ++ p2pie[p2pielen++] = 0x51; ++ ++ ++ /* Number of Channels */ ++ /* Just support 1 channel and this channel is AP's channel */ ++ p2pie[p2pielen++] = 1; ++ ++ /* Channel List */ ++ p2pie[p2pielen++] = union_ch; ++ } else { ++ int i, j; ++ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; ++ ++ /* Number of Channels */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; ++ ++ /* Channel List */ ++ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; ++ } ++ } ++#else /* CONFIG_CONCURRENT_MODE */ ++ { ++ int i, j; ++ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; ++ ++ /* Number of Channels */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; ++ ++ /* Channel List */ ++ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; ++ } ++ } ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ ++ /* P2P Group ID */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_GROUP_ID; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(6 + pwdinfo->invitereq_info.ssidlen); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* P2P Device Address for GO */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->invitereq_info.go_bssid, ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ /* SSID */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->invitereq_info.go_ssid, pwdinfo->invitereq_info.ssidlen); ++ p2pielen += pwdinfo->invitereq_info.ssidlen; ++ ++ ++ /* Device Info */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ ++ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(21 + pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* P2P Device Address */ ++ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ /* Config Method */ ++ /* This field should be big endian. Noted by P2P specification. */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_CONFIG_METHOD_DISPLAY); ++ p2pielen += 2; ++ ++ /* Primary Device Type */ ++ /* Category ID */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); ++ p2pielen += 2; ++ ++ /* OUI */ ++ *(u32 *)(p2pie + p2pielen) = cpu_to_be32(WPSOUI); ++ p2pielen += 4; ++ ++ /* Sub Category ID */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); ++ p2pielen += 2; ++ ++ /* Number of Secondary Device Types */ ++ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ ++ ++ /* Device Name */ ++ /* Type: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); ++ p2pielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len); ++ p2pielen += pwdinfo->device_name_len; ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); ++ ++#ifdef CONFIG_WFD ++ wfdielen = build_invitation_req_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++#endif ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ return; ++ ++} ++ ++void issue_p2p_invitation_response(_adapter *padapter, u8 *raddr, u8 dialogToken, u8 status_code) ++{ ++ ++ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = P2P_PUB_ACTION_ACTION; ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_INVIT_RESP; ++ u8 p2pie[255] = { 0x00 }; ++ u8 p2pielen = 0, i; ++ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; ++ u16 len_channellist_attr = 0; ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, raddr, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ ++ /* P2P IE Section. */ ++ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* Commented by Albert 20101005 */ ++ /* According to the P2P Specification, the P2P Invitation response frame should contain 5 P2P attributes */ ++ /* 1. Status */ ++ /* 2. Configuration Timeout */ ++ /* 3. Operating Channel ( Only GO ) */ ++ /* 4. P2P Group BSSID ( Only GO ) */ ++ /* 5. Channel List */ ++ ++ /* P2P Status */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_STATUS; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* When status code is P2P_STATUS_FAIL_INFO_UNAVAILABLE. */ ++ /* Sent the event receiving the P2P Invitation Req frame to DMP UI. */ ++ /* DMP had to compare the MAC address to find out the profile. */ ++ /* So, the WiFi driver will send the P2P_STATUS_FAIL_INFO_UNAVAILABLE to NB. */ ++ /* If the UI found the corresponding profile, the WiFi driver sends the P2P Invitation Req */ ++ /* to NB to rebuild the persistent group. */ ++ p2pie[p2pielen++] = status_code; ++ ++ /* Configuration Timeout */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CONF_TIMEOUT; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P GO */ ++ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P Client */ ++ ++ if (status_code == P2P_STATUS_SUCCESS) { ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ /* The P2P Invitation request frame asks this Wi-Fi device to be the P2P GO */ ++ /* In this case, the P2P Invitation response frame should carry the two more P2P attributes. */ ++ /* First one is operating channel attribute. */ ++ /* Second one is P2P Group BSSID attribute. */ ++ ++ /* Operating Channel */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x51; /* Copy from SD7 */ ++ ++ /* Channel Number */ ++ p2pie[p2pielen++] = pwdinfo->operating_channel; /* operating channel number */ ++ ++ ++ /* P2P Group BSSID */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_GROUP_BSSID; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* P2P Device Address for GO */ ++ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ } ++ ++ /* Channel List */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; ++ ++ /* Length: */ ++ /* Country String(3) */ ++ /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ ++ /* + number of channels in all classes */ ++ len_channellist_attr = 3 ++ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes ++ + get_reg_classes_full_count(pmlmeext->channel_list); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(5 + 1); ++ else ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); ++#else ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); ++#endif ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Channel Entry List */ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ ++ /* Operating Class */ ++ if (union_ch > 14) { ++ if (union_ch >= 149) ++ p2pie[p2pielen++] = 0x7c; ++ else ++ p2pie[p2pielen++] = 0x73; ++ } else ++ p2pie[p2pielen++] = 0x51; ++ ++ ++ /* Number of Channels */ ++ /* Just support 1 channel and this channel is AP's channel */ ++ p2pie[p2pielen++] = 1; ++ ++ /* Channel List */ ++ p2pie[p2pielen++] = union_ch; ++ } else { ++ int i, j; ++ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; ++ ++ /* Number of Channels */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; ++ ++ /* Channel List */ ++ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; ++ } ++ } ++#else /* CONFIG_CONCURRENT_MODE */ ++ { ++ int i, j; ++ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; ++ ++ /* Number of Channels */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; ++ ++ /* Channel List */ ++ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; ++ } ++ } ++#endif /* CONFIG_CONCURRENT_MODE */ ++ } ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); ++ ++#ifdef CONFIG_WFD ++ wfdielen = build_invitation_resp_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++#endif ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ return; ++ ++} ++ ++void issue_p2p_provision_request(_adapter *padapter, u8 *pssid, u8 ussidlen, u8 *pdev_raddr) ++{ ++ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = P2P_PUB_ACTION_ACTION; ++ u8 dialogToken = 1; ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_PROVISION_DISC_REQ; ++ u8 wpsie[100] = { 0x00 }; ++ u8 wpsielen = 0; ++ u32 p2pielen = 0; ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ RTW_INFO("[%s] In\n", __FUNCTION__); ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, pdev_raddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pdev_raddr, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ ++ p2pielen = build_prov_disc_request_p2p_ie(pwdinfo, pframe, pssid, ussidlen, pdev_raddr); ++ ++ pframe += p2pielen; ++ pattrib->pktlen += p2pielen; ++ ++ wpsielen = 0; ++ /* WPS OUI */ ++ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); ++ wpsielen += 4; ++ ++ /* WPS version */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ ++ ++ /* Config Method */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_CONF_METHOD); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); ++ wpsielen += 2; ++ ++ /* Value: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->tx_prov_disc_info.wps_config_method_request); ++ wpsielen += 2; ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); ++ ++ ++#ifdef CONFIG_WFD ++ wfdielen = build_provdisc_req_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++#endif ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ return; ++ ++} ++ ++ ++u8 is_matched_in_profilelist(u8 *peermacaddr, struct profile_info *profileinfo) ++{ ++ u8 i, match_result = 0; ++ ++ RTW_INFO("[%s] peermac = %.2X %.2X %.2X %.2X %.2X %.2X\n", __FUNCTION__, ++ peermacaddr[0], peermacaddr[1], peermacaddr[2], peermacaddr[3], peermacaddr[4], peermacaddr[5]); ++ ++ for (i = 0; i < P2P_MAX_PERSISTENT_GROUP_NUM; i++, profileinfo++) { ++ RTW_INFO("[%s] profileinfo_mac = %.2X %.2X %.2X %.2X %.2X %.2X\n", __FUNCTION__, ++ profileinfo->peermac[0], profileinfo->peermac[1], profileinfo->peermac[2], profileinfo->peermac[3], profileinfo->peermac[4], profileinfo->peermac[5]); ++ if (_rtw_memcmp(peermacaddr, profileinfo->peermac, ETH_ALEN)) { ++ match_result = 1; ++ RTW_INFO("[%s] Match!\n", __FUNCTION__); ++ break; ++ } ++ } ++ ++ return match_result ; ++} ++ ++void issue_probersp_p2p(_adapter *padapter, unsigned char *da) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ unsigned char *mac; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ /* WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); */ ++ u16 beacon_interval = 100; ++ u16 capInfo = 0; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 wpsie[255] = { 0x00 }; ++ u32 wpsielen = 0, p2pielen = 0; ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++#ifdef CONFIG_INTEL_WIDI ++ u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ if (IS_CCK_RATE(pattrib->rate)) { ++ /* force OFDM 6M rate */ ++ pattrib->rate = MGN_6M; ++ pattrib->raid = rtw_get_mgntframe_raid(padapter, WIRELESS_11G); ++ } ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ mac = adapter_mac_addr(padapter); ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); ++ ++ /* Use the device address for BSSID field. */ ++ _rtw_memcpy(pwlanhdr->addr3, mac, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(fctrl, WIFI_PROBERSP); ++ ++ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = pattrib->hdrlen; ++ pframe += pattrib->hdrlen; ++ ++ /* timestamp will be inserted by hardware */ ++ pframe += 8; ++ pattrib->pktlen += 8; ++ ++ /* beacon interval: 2 bytes */ ++ _rtw_memcpy(pframe, (unsigned char *) &beacon_interval, 2); ++ pframe += 2; ++ pattrib->pktlen += 2; ++ ++ /* capability info: 2 bytes */ ++ /* ESS and IBSS bits must be 0 (defined in the 3.1.2.1.1 of WiFi Direct Spec) */ ++ capInfo |= cap_ShortPremble; ++ capInfo |= cap_ShortSlot; ++ ++ _rtw_memcpy(pframe, (unsigned char *) &capInfo, 2); ++ pframe += 2; ++ pattrib->pktlen += 2; ++ ++ ++ /* SSID */ ++ pframe = rtw_set_ie(pframe, _SSID_IE_, 7, pwdinfo->p2p_wildcard_ssid, &pattrib->pktlen); ++ ++ /* supported rates... */ ++ /* Use the OFDM rate in the P2P probe response frame. ( 6(B), 9(B), 12, 18, 24, 36, 48, 54 ) */ ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pwdinfo->support_rate, &pattrib->pktlen); ++ ++ /* DS parameter set */ ++ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&pwdinfo->listen_channel, &pattrib->pktlen); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) { ++ if (pmlmepriv->wps_probe_resp_ie != NULL && pmlmepriv->p2p_probe_resp_ie != NULL) { ++ /* WPS IE */ ++ _rtw_memcpy(pframe, pmlmepriv->wps_probe_resp_ie, pmlmepriv->wps_probe_resp_ie_len); ++ pattrib->pktlen += pmlmepriv->wps_probe_resp_ie_len; ++ pframe += pmlmepriv->wps_probe_resp_ie_len; ++ ++ /* P2P IE */ ++ _rtw_memcpy(pframe, pmlmepriv->p2p_probe_resp_ie, pmlmepriv->p2p_probe_resp_ie_len); ++ pattrib->pktlen += pmlmepriv->p2p_probe_resp_ie_len; ++ pframe += pmlmepriv->p2p_probe_resp_ie_len; ++ } ++ } else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ { ++ ++ /* Todo: WPS IE */ ++ /* Noted by Albert 20100907 */ ++ /* According to the WPS specification, all the WPS attribute is presented by Big Endian. */ ++ ++ wpsielen = 0; ++ /* WPS OUI */ ++ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); ++ wpsielen += 4; ++ ++ /* WPS version */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ ++ ++#ifdef CONFIG_INTEL_WIDI ++ /* Commented by Kurt */ ++ /* Appended WiDi info. only if we did issued_probereq_widi(), and then we saved ven. ext. in pmlmepriv->sa_ext. */ ++ if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE ++ || pmlmepriv->num_p2p_sdt != 0) { ++ /* Sec dev type */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SEC_DEV_TYPE_LIST); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0008); ++ wpsielen += 2; ++ ++ /* Value: */ ++ /* Category ID */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_CID_DISPLAYS); ++ wpsielen += 2; ++ ++ /* OUI */ ++ *(u32 *)(wpsie + wpsielen) = cpu_to_be32(INTEL_DEV_TYPE_OUI); ++ wpsielen += 4; ++ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_SCID_WIDI_CONSUMER_SINK); ++ wpsielen += 2; ++ ++ if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE) { ++ /* Vendor Extension */ ++ _rtw_memcpy(wpsie + wpsielen, pmlmepriv->sa_ext, L2SDTA_SERVICE_VE_LEN); ++ wpsielen += L2SDTA_SERVICE_VE_LEN; ++ } ++ } ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ /* WiFi Simple Config State */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SIMPLE_CONF_STATE); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_WSC_STATE_NOT_CONFIG; /* Not Configured. */ ++ ++ /* Response Type */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_RESP_TYPE); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_RESPONSE_TYPE_8021X; ++ ++ /* UUID-E */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_UUID_E); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0010); ++ wpsielen += 2; ++ ++ /* Value: */ ++ if (pwdinfo->external_uuid == 0) { ++ _rtw_memset(wpsie + wpsielen, 0x0, 16); ++ _rtw_memcpy(wpsie + wpsielen, mac, ETH_ALEN); ++ } else ++ _rtw_memcpy(wpsie + wpsielen, pwdinfo->uuid, 0x10); ++ wpsielen += 0x10; ++ ++ /* Manufacturer */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_MANUFACTURER); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0007); ++ wpsielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(wpsie + wpsielen, "Realtek", 7); ++ wpsielen += 7; ++ ++ /* Model Name */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_MODEL_NAME); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0006); ++ wpsielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(wpsie + wpsielen, "8192CU", 6); ++ wpsielen += 6; ++ ++ /* Model Number */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_MODEL_NUMBER); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = 0x31; /* character 1 */ ++ ++ /* Serial Number */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SERIAL_NUMBER); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(ETH_ALEN); ++ wpsielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(wpsie + wpsielen, "123456" , ETH_ALEN); ++ wpsielen += ETH_ALEN; ++ ++ /* Primary Device Type */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_PRIMARY_DEV_TYPE); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0008); ++ wpsielen += 2; ++ ++ /* Value: */ ++ /* Category ID */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); ++ wpsielen += 2; ++ ++ /* OUI */ ++ *(u32 *)(wpsie + wpsielen) = cpu_to_be32(WPSOUI); ++ wpsielen += 4; ++ ++ /* Sub Category ID */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); ++ wpsielen += 2; ++ ++ /* Device Name */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->device_name_len); ++ wpsielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(wpsie + wpsielen, pwdinfo->device_name, pwdinfo->device_name_len); ++ wpsielen += pwdinfo->device_name_len; ++ ++ /* Config Method */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_CONF_METHOD); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); ++ wpsielen += 2; ++ ++ /* Value: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->supported_wps_cm); ++ wpsielen += 2; ++ ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); ++ ++ ++ p2pielen = build_probe_resp_p2p_ie(pwdinfo, pframe); ++ pframe += p2pielen; ++ pattrib->pktlen += p2pielen; ++ } ++ ++#ifdef CONFIG_WFD ++ wfdielen = rtw_append_probe_resp_wfd_ie(padapter, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++#endif ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ return; ++ ++} ++ ++int _issue_probereq_p2p(_adapter *padapter, u8 *da, int wait_ack) ++{ ++ int ret = _FAIL; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ unsigned char *mac; ++ unsigned char bssrate[NumRates]; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ int bssrate_len = 0; ++ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; ++ u16 wpsielen = 0, p2pielen = 0; ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ if (IS_CCK_RATE(pattrib->rate)) { ++ /* force OFDM 6M rate */ ++ pattrib->rate = MGN_6M; ++ pattrib->raid = rtw_get_mgntframe_raid(padapter, WIRELESS_11G); ++ } ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ mac = adapter_mac_addr(padapter); ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ if (da) { ++ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, da, ETH_ALEN); ++ } else { ++ if ((pwdinfo->p2p_info.scan_op_ch_only) || (pwdinfo->rx_invitereq_info.scan_op_ch_only)) { ++ /* This two flags will be set when this is only the P2P client mode. */ ++ _rtw_memcpy(pwlanhdr->addr1, pwdinfo->p2p_peer_interface_addr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->p2p_peer_interface_addr, ETH_ALEN); ++ } else { ++ /* broadcast probe request frame */ ++ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, bc_addr, ETH_ALEN); ++ } ++ } ++ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_PROBEREQ); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) ++ pframe = rtw_set_ie(pframe, _SSID_IE_, pwdinfo->tx_prov_disc_info.ssid.SsidLength, pwdinfo->tx_prov_disc_info.ssid.Ssid, &(pattrib->pktlen)); ++ else ++ pframe = rtw_set_ie(pframe, _SSID_IE_, P2P_WILDCARD_SSID_LEN, pwdinfo->p2p_wildcard_ssid, &(pattrib->pktlen)); ++ /* Use the OFDM rate in the P2P probe request frame. ( 6(B), 9(B), 12(B), 24(B), 36, 48, 54 ) */ ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pwdinfo->support_rate, &pattrib->pktlen); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) { ++ if (pmlmepriv->wps_probe_req_ie != NULL && pmlmepriv->p2p_probe_req_ie != NULL) { ++ /* WPS IE */ ++ _rtw_memcpy(pframe, pmlmepriv->wps_probe_req_ie, pmlmepriv->wps_probe_req_ie_len); ++ pattrib->pktlen += pmlmepriv->wps_probe_req_ie_len; ++ pframe += pmlmepriv->wps_probe_req_ie_len; ++ ++ /* P2P IE */ ++ _rtw_memcpy(pframe, pmlmepriv->p2p_probe_req_ie, pmlmepriv->p2p_probe_req_ie_len); ++ pattrib->pktlen += pmlmepriv->p2p_probe_req_ie_len; ++ pframe += pmlmepriv->p2p_probe_req_ie_len; ++ } ++ } else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ { ++ ++ /* WPS IE */ ++ /* Noted by Albert 20110221 */ ++ /* According to the WPS specification, all the WPS attribute is presented by Big Endian. */ ++ ++ wpsielen = 0; ++ /* WPS OUI */ ++ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); ++ wpsielen += 4; ++ ++ /* WPS version */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ ++ ++ if (pmlmepriv->wps_probe_req_ie == NULL) { ++ /* UUID-E */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_UUID_E); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0010); ++ wpsielen += 2; ++ ++ /* Value: */ ++ if (pwdinfo->external_uuid == 0) { ++ _rtw_memset(wpsie + wpsielen, 0x0, 16); ++ _rtw_memcpy(wpsie + wpsielen, mac, ETH_ALEN); ++ } else ++ _rtw_memcpy(wpsie + wpsielen, pwdinfo->uuid, 0x10); ++ wpsielen += 0x10; ++ ++ /* Config Method */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_CONF_METHOD); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); ++ wpsielen += 2; ++ ++ /* Value: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->supported_wps_cm); ++ wpsielen += 2; ++ } ++ ++ /* Device Name */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->device_name_len); ++ wpsielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(wpsie + wpsielen, pwdinfo->device_name, pwdinfo->device_name_len); ++ wpsielen += pwdinfo->device_name_len; ++ ++ /* Primary Device Type */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_PRIMARY_DEV_TYPE); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0008); ++ wpsielen += 2; ++ ++ /* Value: */ ++ /* Category ID */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_CID_RTK_WIDI); ++ wpsielen += 2; ++ ++ /* OUI */ ++ *(u32 *)(wpsie + wpsielen) = cpu_to_be32(WPSOUI); ++ wpsielen += 4; ++ ++ /* Sub Category ID */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_SCID_RTK_DMP); ++ wpsielen += 2; ++ ++ /* Device Password ID */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_PWID); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); ++ wpsielen += 2; ++ ++ /* Value: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_REGISTRAR_SPEC); /* Registrar-specified */ ++ wpsielen += 2; ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); ++ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* Commented by Albert 20110221 */ ++ /* According to the P2P Specification, the probe request frame should contain 5 P2P attributes */ ++ /* 1. P2P Capability */ ++ /* 2. P2P Device ID if this probe request wants to find the specific P2P device */ ++ /* 3. Listen Channel */ ++ /* 4. Extended Listen Timing */ ++ /* 5. Operating Channel if this WiFi is working as the group owner now */ ++ ++ /* P2P Capability */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Device Capability Bitmap, 1 byte */ ++ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; ++ ++ /* Group Capability Bitmap, 1 byte */ ++ if (pwdinfo->persistent_supported) ++ p2pie[p2pielen++] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; ++ else ++ p2pie[p2pielen++] = DMP_P2P_GRPCAP_SUPPORT; ++ ++ /* Listen Channel */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_LISTEN_CH; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x51; /* Copy from SD7 */ ++ ++ /* Channel Number */ ++ p2pie[p2pielen++] = pwdinfo->listen_channel; /* listen channel */ ++ ++ ++ /* Extended Listen Timing */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_EX_LISTEN_TIMING; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0004); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Availability Period */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0xFFFF); ++ p2pielen += 2; ++ ++ /* Availability Interval */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0xFFFF); ++ p2pielen += 2; ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ /* Operating Channel (if this WiFi is working as the group owner now) */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x51; /* Copy from SD7 */ ++ ++ /* Channel Number */ ++ p2pie[p2pielen++] = pwdinfo->operating_channel; /* operating channel number */ ++ ++ } ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); ++ ++ } ++ ++#ifdef CONFIG_WFD ++ wfdielen = rtw_append_probe_req_wfd_ie(padapter, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++#endif ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ ++ if (wait_ack) ++ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); ++ else { ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ } ++ ++exit: ++ return ret; ++} ++ ++inline void issue_probereq_p2p(_adapter *adapter, u8 *da) ++{ ++ _issue_probereq_p2p(adapter, da, _FALSE); ++} ++ ++/* ++ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT ++ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX ++ * try_cnt means the maximal TX count to try ++ */ ++int issue_probereq_p2p_ex(_adapter *adapter, u8 *da, int try_cnt, int wait_ms) ++{ ++ int ret; ++ int i = 0; ++ u32 start = rtw_get_current_time(); ++ ++ do { ++ ret = _issue_probereq_p2p(adapter, da, wait_ms > 0 ? _TRUE : _FALSE); ++ ++ i++; ++ ++ if (RTW_CANNOT_RUN(adapter)) ++ break; ++ ++ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) ++ rtw_msleep_os(wait_ms); ++ ++ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); ++ ++ if (ret != _FAIL) { ++ ret = _SUCCESS; ++#ifndef DBG_XMIT_ACK ++ goto exit; ++#endif ++ } ++ ++ if (try_cnt && wait_ms) { ++ if (da) ++ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(adapter), MAC_ARG(da), rtw_get_oper_ch(adapter), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ else ++ RTW_INFO(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(adapter), rtw_get_oper_ch(adapter), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ } ++exit: ++ return ret; ++} ++ ++#endif /* CONFIG_P2P */ ++ ++s32 rtw_action_public_decache(union recv_frame *rframe, u8 token_offset) ++{ ++ _adapter *adapter = rframe->u.hdr.adapter; ++ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); ++ u8 *frame = rframe->u.hdr.rx_data; ++ u16 seq_ctrl = ((rframe->u.hdr.attrib.seq_num & 0xffff) << 4) | (rframe->u.hdr.attrib.frag_num & 0xf); ++ u8 token = *(rframe->u.hdr.rx_data + sizeof(struct rtw_ieee80211_hdr_3addr) + token_offset); ++ ++ if (GetRetry(frame)) { ++ if ((seq_ctrl == mlmeext->action_public_rxseq) ++ && (token == mlmeext->action_public_dialog_token) ++ ) { ++ RTW_INFO(FUNC_ADPT_FMT" seq_ctrl=0x%x, rxseq=0x%x, token:%d\n", ++ FUNC_ADPT_ARG(adapter), seq_ctrl, mlmeext->action_public_rxseq, token); ++ return _FAIL; ++ } ++ } ++ ++ /* TODO: per sta seq & token */ ++ mlmeext->action_public_rxseq = seq_ctrl; ++ mlmeext->action_public_dialog_token = token; ++ ++ return _SUCCESS; ++} ++ ++unsigned int on_action_public_p2p(union recv_frame *precv_frame) ++{ ++ _adapter *padapter = precv_frame->u.hdr.adapter; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint len = precv_frame->u.hdr.len; ++ u8 *frame_body; ++#ifdef CONFIG_P2P ++ u8 *p2p_ie; ++ u32 p2p_ielen, wps_ielen; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 result = P2P_STATUS_SUCCESS; ++ u8 empty_addr[ETH_ALEN] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; ++ u8 *merged_p2pie = NULL; ++ u32 merged_p2p_ielen = 0; ++#endif /* CONFIG_P2P */ ++ ++ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ ++#ifdef CONFIG_P2P ++ _cancel_timer_ex(&pwdinfo->reset_ch_sitesurvey); ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) ++ rtw_cfg80211_rx_p2p_action_public(padapter, precv_frame); ++ else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ { ++ /* Do nothing if the driver doesn't enable the P2P function. */ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) ++ return _SUCCESS; ++ ++ len -= sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ switch (frame_body[6]) { /* OUI Subtype */ ++ case P2P_GO_NEGO_REQ: { ++ RTW_INFO("[%s] Got GO Nego Req Frame\n", __FUNCTION__); ++ _rtw_memset(&pwdinfo->groupid_info, 0x00, sizeof(struct group_id_info)); ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ)) ++ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL)) { ++ /* Commented by Albert 20110526 */ ++ /* In this case, this means the previous nego fail doesn't be reset yet. */ ++ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); ++ /* Restore the previous p2p state */ ++ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); ++ RTW_INFO("[%s] Restore the previous p2p state to %d\n", __FUNCTION__, rtw_p2p_state(pwdinfo)); ++ } ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_buddy_check_fwstate(padapter, _FW_LINKED)) ++ _cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer); ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ /* Commented by Kurt 20110902 */ ++ /* Add if statement to avoid receiving duplicate prov disc req. such that pre_p2p_state would be covered. */ ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) ++ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); ++ ++ /* Commented by Kurt 20120113 */ ++ /* Get peer_dev_addr here if peer doesn't issue prov_disc frame. */ ++ if (_rtw_memcmp(pwdinfo->rx_prov_disc_info.peerDevAddr, empty_addr, ETH_ALEN)) ++ _rtw_memcpy(pwdinfo->rx_prov_disc_info.peerDevAddr, GetAddr2Ptr(pframe), ETH_ALEN); ++ ++ result = process_p2p_group_negotation_req(pwdinfo, frame_body, len); ++ issue_p2p_GO_response(padapter, GetAddr2Ptr(pframe), frame_body, len, result); ++#ifdef CONFIG_INTEL_WIDI ++ if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) { ++ padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; ++ _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); ++ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL, 0); ++ } ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ /* Commented by Albert 20110718 */ ++ /* No matter negotiating or negotiation failure, the driver should set up the restore P2P state timer. */ ++#ifdef CONFIG_CONCURRENT_MODE ++ /* Commented by Albert 20120107 */ ++ _set_timer(&pwdinfo->restore_p2p_state_timer, 3000); ++#else /* CONFIG_CONCURRENT_MODE */ ++ _set_timer(&pwdinfo->restore_p2p_state_timer, 5000); ++#endif /* CONFIG_CONCURRENT_MODE */ ++ break; ++ } ++ case P2P_GO_NEGO_RESP: { ++ RTW_INFO("[%s] Got GO Nego Resp Frame\n", __FUNCTION__); ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) { ++ /* Commented by Albert 20110425 */ ++ /* The restore timer is enabled when issuing the nego request frame of rtw_p2p_connect function. */ ++ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); ++ pwdinfo->nego_req_info.benable = _FALSE; ++ result = process_p2p_group_negotation_resp(pwdinfo, frame_body, len); ++ issue_p2p_GO_confirm(pwdinfo->padapter, GetAddr2Ptr(pframe), result); ++ if (P2P_STATUS_SUCCESS == result) { ++ if (rtw_p2p_role(pwdinfo) == P2P_ROLE_CLIENT) { ++ pwdinfo->p2p_info.operation_ch[0] = pwdinfo->peer_operating_ch; ++#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH ++ pwdinfo->p2p_info.operation_ch[1] = 1; /* Check whether GO is operating in channel 1; */ ++ pwdinfo->p2p_info.operation_ch[2] = 6; /* Check whether GO is operating in channel 6; */ ++ pwdinfo->p2p_info.operation_ch[3] = 11; /* Check whether GO is operating in channel 11; */ ++#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ ++ pwdinfo->p2p_info.scan_op_ch_only = 1; ++ _set_timer(&pwdinfo->reset_ch_sitesurvey2, P2P_RESET_SCAN_CH); ++ } ++ } ++ ++ /* Reset the dialog token for group negotiation frames. */ ++ pwdinfo->negotiation_dialog_token = 1; ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL)) ++ _set_timer(&pwdinfo->restore_p2p_state_timer, 5000); ++ } else ++ RTW_INFO("[%s] Skipped GO Nego Resp Frame (p2p_state != P2P_STATE_GONEGO_ING)\n", __FUNCTION__); ++ ++ break; ++ } ++ case P2P_GO_NEGO_CONF: { ++ RTW_INFO("[%s] Got GO Nego Confirm Frame\n", __FUNCTION__); ++ result = process_p2p_group_negotation_confirm(pwdinfo, frame_body, len); ++ if (P2P_STATUS_SUCCESS == result) { ++ if (rtw_p2p_role(pwdinfo) == P2P_ROLE_CLIENT) { ++ pwdinfo->p2p_info.operation_ch[0] = pwdinfo->peer_operating_ch; ++#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH ++ pwdinfo->p2p_info.operation_ch[1] = 1; /* Check whether GO is operating in channel 1; */ ++ pwdinfo->p2p_info.operation_ch[2] = 6; /* Check whether GO is operating in channel 6; */ ++ pwdinfo->p2p_info.operation_ch[3] = 11; /* Check whether GO is operating in channel 11; */ ++#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ ++ pwdinfo->p2p_info.scan_op_ch_only = 1; ++ _set_timer(&pwdinfo->reset_ch_sitesurvey2, P2P_RESET_SCAN_CH); ++ } ++ } ++ break; ++ } ++ case P2P_INVIT_REQ: { ++ /* Added by Albert 2010/10/05 */ ++ /* Received the P2P Invite Request frame. */ ++ ++ RTW_INFO("[%s] Got invite request frame!\n", __FUNCTION__); ++ p2p_ie = rtw_get_p2p_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen); ++ if (p2p_ie) { ++ /* Parse the necessary information from the P2P Invitation Request frame. */ ++ /* For example: The MAC address of sending this P2P Invitation Request frame. */ ++ u32 attr_contentlen = 0; ++ u8 status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; ++ struct group_id_info group_id; ++ u8 invitation_flag = 0; ++ int j = 0; ++ ++ merged_p2p_ielen = rtw_get_p2p_merged_ies_len(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_); ++ ++ merged_p2pie = rtw_zmalloc(merged_p2p_ielen + 2); /* 2 is for EID and Length */ ++ if (merged_p2pie == NULL) { ++ RTW_INFO("[%s] Malloc p2p ie fail\n", __FUNCTION__); ++ goto exit; ++ } ++ _rtw_memset(merged_p2pie, 0x00, merged_p2p_ielen); ++ ++ merged_p2p_ielen = rtw_p2p_merge_ies(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, merged_p2pie); ++ ++ rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_INVITATION_FLAGS, &invitation_flag, &attr_contentlen); ++ if (attr_contentlen) { ++ ++ rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_GROUP_BSSID, pwdinfo->p2p_peer_interface_addr, &attr_contentlen); ++ /* Commented by Albert 20120510 */ ++ /* Copy to the pwdinfo->p2p_peer_interface_addr. */ ++ /* So that the WFD UI ( or Sigma ) can get the peer interface address by using the following command. */ ++ /* #> iwpriv wlan0 p2p_get peer_ifa */ ++ /* After having the peer interface address, the sigma can find the correct conf file for wpa_supplicant. */ ++ ++ if (attr_contentlen) { ++ RTW_INFO("[%s] GO's BSSID = %.2X %.2X %.2X %.2X %.2X %.2X\n", __FUNCTION__, ++ pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], ++ pwdinfo->p2p_peer_interface_addr[2], pwdinfo->p2p_peer_interface_addr[3], ++ pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]); ++ } ++ ++ if (invitation_flag & P2P_INVITATION_FLAGS_PERSISTENT) { ++ /* Re-invoke the persistent group. */ ++ ++ _rtw_memset(&group_id, 0x00, sizeof(struct group_id_info)); ++ rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_GROUP_ID, (u8 *) &group_id, &attr_contentlen); ++ if (attr_contentlen) { ++ if (_rtw_memcmp(group_id.go_device_addr, adapter_mac_addr(padapter), ETH_ALEN)) { ++ /* The p2p device sending this p2p invitation request wants this Wi-Fi device to be the persistent GO. */ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_GO); ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); ++ status_code = P2P_STATUS_SUCCESS; ++ } else { ++ /* The p2p device sending this p2p invitation request wants to be the persistent GO. */ ++ if (is_matched_in_profilelist(pwdinfo->p2p_peer_interface_addr, &pwdinfo->profileinfo[0])) { ++ u8 operatingch_info[5] = { 0x00 }; ++ if (rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, ++ &attr_contentlen)) { ++ if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, (u32)operatingch_info[4]) >= 0) { ++ /* The operating channel is acceptable for this device. */ ++ pwdinfo->rx_invitereq_info.operation_ch[0] = operatingch_info[4]; ++#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH ++ pwdinfo->rx_invitereq_info.operation_ch[1] = 1; /* Check whether GO is operating in channel 1; */ ++ pwdinfo->rx_invitereq_info.operation_ch[2] = 6; /* Check whether GO is operating in channel 6; */ ++ pwdinfo->rx_invitereq_info.operation_ch[3] = 11; /* Check whether GO is operating in channel 11; */ ++#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ ++ pwdinfo->rx_invitereq_info.scan_op_ch_only = 1; ++ _set_timer(&pwdinfo->reset_ch_sitesurvey, P2P_RESET_SCAN_CH); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_MATCH); ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++ status_code = P2P_STATUS_SUCCESS; ++ } else { ++ /* The operating channel isn't supported by this device. */ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_DISMATCH); ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ status_code = P2P_STATUS_FAIL_NO_COMMON_CH; ++ _set_timer(&pwdinfo->restore_p2p_state_timer, 3000); ++ } ++ } else { ++ /* Commented by Albert 20121130 */ ++ /* Intel will use the different P2P IE to store the operating channel information */ ++ /* Workaround for Intel WiDi 3.5 */ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_MATCH); ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++ status_code = P2P_STATUS_SUCCESS; ++ } ++ } else { ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_DISMATCH); ++#ifdef CONFIG_INTEL_WIDI ++ _rtw_memcpy(pwdinfo->p2p_peer_device_addr, group_id.go_device_addr , ETH_ALEN); ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ status_code = P2P_STATUS_FAIL_UNKNOWN_P2PGROUP; ++ } ++ } ++ } else { ++ RTW_INFO("[%s] P2P Group ID Attribute NOT FOUND!\n", __FUNCTION__); ++ status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; ++ } ++ } else { ++ /* Received the invitation to join a P2P group. */ ++ ++ _rtw_memset(&group_id, 0x00, sizeof(struct group_id_info)); ++ rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_GROUP_ID, (u8 *) &group_id, &attr_contentlen); ++ if (attr_contentlen) { ++ if (_rtw_memcmp(group_id.go_device_addr, adapter_mac_addr(padapter), ETH_ALEN)) { ++ /* In this case, the GO can't be myself. */ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_DISMATCH); ++ status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; ++ } else { ++ /* The p2p device sending this p2p invitation request wants to join an existing P2P group */ ++ /* Commented by Albert 2012/06/28 */ ++ /* In this case, this Wi-Fi device should use the iwpriv command to get the peer device address. */ ++ /* The peer device address should be the destination address for the provisioning discovery request. */ ++ /* Then, this Wi-Fi device should use the iwpriv command to get the peer interface address. */ ++ /* The peer interface address should be the address for WPS mac address */ ++ _rtw_memcpy(pwdinfo->p2p_peer_device_addr, group_id.go_device_addr , ETH_ALEN); ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_JOIN); ++ status_code = P2P_STATUS_SUCCESS; ++ } ++ } else { ++ RTW_INFO("[%s] P2P Group ID Attribute NOT FOUND!\n", __FUNCTION__); ++ status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; ++ } ++ } ++ } else { ++ RTW_INFO("[%s] P2P Invitation Flags Attribute NOT FOUND!\n", __FUNCTION__); ++ status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; ++ } ++ ++ RTW_INFO("[%s] status_code = %d\n", __FUNCTION__, status_code); ++ ++ pwdinfo->inviteresp_info.token = frame_body[7]; ++ issue_p2p_invitation_response(padapter, GetAddr2Ptr(pframe), pwdinfo->inviteresp_info.token, status_code); ++ _set_timer(&pwdinfo->restore_p2p_state_timer, 3000); ++ } ++#ifdef CONFIG_INTEL_WIDI ++ if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) { ++ padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; ++ _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); ++ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL, 0); ++ } ++#endif /* CONFIG_INTEL_WIDI */ ++ break; ++ } ++ case P2P_INVIT_RESP: { ++ u8 attr_content = 0x00; ++ u32 attr_contentlen = 0; ++ ++ RTW_INFO("[%s] Got invite response frame!\n", __FUNCTION__); ++ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); ++ p2p_ie = rtw_get_p2p_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen); ++ if (p2p_ie) { ++ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, &attr_content, &attr_contentlen); ++ ++ if (attr_contentlen == 1) { ++ RTW_INFO("[%s] Status = %d\n", __FUNCTION__, attr_content); ++ pwdinfo->invitereq_info.benable = _FALSE; ++ ++ if (attr_content == P2P_STATUS_SUCCESS) { ++ if (_rtw_memcmp(pwdinfo->invitereq_info.go_bssid, adapter_mac_addr(padapter), ETH_ALEN)) ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); ++ else ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_INVITE_RESP_OK); ++ } else { ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_INVITE_RESP_FAIL); ++ } ++ } else { ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_INVITE_RESP_FAIL); ++ } ++ } else { ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_INVITE_RESP_FAIL); ++ } ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_INVITE_RESP_FAIL)) ++ _set_timer(&pwdinfo->restore_p2p_state_timer, 5000); ++ break; ++ } ++ case P2P_DEVDISC_REQ: ++ ++ process_p2p_devdisc_req(pwdinfo, pframe, len); ++ ++ break; ++ ++ case P2P_DEVDISC_RESP: ++ ++ process_p2p_devdisc_resp(pwdinfo, pframe, len); ++ ++ break; ++ ++ case P2P_PROVISION_DISC_REQ: ++ RTW_INFO("[%s] Got Provisioning Discovery Request Frame\n", __FUNCTION__); ++ process_p2p_provdisc_req(pwdinfo, pframe, len); ++ _rtw_memcpy(pwdinfo->rx_prov_disc_info.peerDevAddr, GetAddr2Ptr(pframe), ETH_ALEN); ++ ++ /* 20110902 Kurt */ ++ /* Add the following statement to avoid receiving duplicate prov disc req. such that pre_p2p_state would be covered. */ ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ)) ++ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); ++ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ); ++ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT); ++#ifdef CONFIG_INTEL_WIDI ++ if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) { ++ padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; ++ _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); ++ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL, 0); ++ } ++#endif /* CONFIG_INTEL_WIDI */ ++ break; ++ ++ case P2P_PROVISION_DISC_RESP: ++ /* Commented by Albert 20110707 */ ++ /* Should we check the pwdinfo->tx_prov_disc_info.bsent flag here?? */ ++ RTW_INFO("[%s] Got Provisioning Discovery Response Frame\n", __FUNCTION__); ++ /* Commented by Albert 20110426 */ ++ /* The restore timer is enabled when issuing the provisioing request frame in rtw_p2p_prov_disc function. */ ++ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_RSP); ++ process_p2p_provdisc_resp(pwdinfo, pframe); ++ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT); ++ break; ++ ++ } ++ } ++ ++ ++exit: ++ ++ if (merged_p2pie) ++ rtw_mfree(merged_p2pie, merged_p2p_ielen + 2); ++#endif /* CONFIG_P2P */ ++ return _SUCCESS; ++} ++ ++unsigned int on_action_public_vendor(union recv_frame *precv_frame) ++{ ++ unsigned int ret = _FAIL; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint frame_len = precv_frame->u.hdr.len; ++ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ if (_rtw_memcmp(frame_body + 2, P2P_OUI, 4) == _TRUE) { ++ if (rtw_action_public_decache(precv_frame, 7) == _FAIL) ++ goto exit; ++ ++ if (!hal_chk_wl_func(precv_frame->u.hdr.adapter, WL_FUNC_MIRACAST)) ++ rtw_rframe_del_wfd_ie(precv_frame, 8); ++ ++ ret = on_action_public_p2p(precv_frame); ++ } ++ ++exit: ++ return ret; ++} ++ ++unsigned int on_action_public_default(union recv_frame *precv_frame, u8 action) ++{ ++ unsigned int ret = _FAIL; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint frame_len = precv_frame->u.hdr.len; ++ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); ++ u8 token; ++ _adapter *adapter = precv_frame->u.hdr.adapter; ++ int cnt = 0; ++ char msg[64]; ++ ++ token = frame_body[2]; ++ ++ if (rtw_action_public_decache(precv_frame, 2) == _FAIL) ++ goto exit; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ cnt += sprintf((msg + cnt), "%s(token:%u)", action_public_str(action), token); ++ rtw_cfg80211_rx_action(adapter, precv_frame, msg); ++#endif ++ ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++ ++unsigned int on_action_public(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ unsigned int ret = _FAIL; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint frame_len = precv_frame->u.hdr.len; ++ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); ++ u8 category, action; ++ ++ /* check RA matches or not */ ++ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) ++ goto exit; ++ ++ category = frame_body[0]; ++ if (category != RTW_WLAN_CATEGORY_PUBLIC) ++ goto exit; ++ ++ action = frame_body[1]; ++ switch (action) { ++ case ACT_PUBLIC_BSSCOEXIST: ++#ifdef CONFIG_80211N_HT ++#ifdef CONFIG_AP_MODE ++ /*20/40 BSS Coexistence Management frame is a Public Action frame*/ ++ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) ++ rtw_process_public_act_bsscoex(padapter, pframe, frame_len); ++#endif /*CONFIG_AP_MODE*/ ++#endif /*CONFIG_80211N_HT*/ ++ break; ++ case ACT_PUBLIC_VENDOR: ++ ret = on_action_public_vendor(precv_frame); ++ break; ++ default: ++ ret = on_action_public_default(precv_frame, action); ++ break; ++ } ++ ++exit: ++ return ret; ++} ++ ++unsigned int OnAction_ft(_adapter *padapter, union recv_frame *precv_frame) ++{ ++#ifdef CONFIG_RTW_80211R ++ u32 ret = _FAIL; ++ u32 frame_len = 0; ++ u8 action_code = 0; ++ u8 category = 0; ++ u8 *pframe = NULL; ++ u8 *pframe_body = NULL; ++ u8 sta_addr[ETH_ALEN] = {0}; ++ u8 *pie = NULL; ++ u32 ft_ie_len = 0; ++ u32 status_code = 0; ++ struct mlme_ext_priv *pmlmeext = NULL; ++ struct mlme_ext_info *pmlmeinfo = NULL; ++ struct mlme_priv *pmlmepriv = NULL; ++ struct wlan_network *proam_target = NULL; ++ ft_priv *pftpriv = NULL; ++ _irqL irqL; ++ ++ pmlmeext = &padapter->mlmeextpriv; ++ pmlmeinfo = &(pmlmeext->mlmext_info); ++ pmlmepriv = &padapter->mlmepriv; ++ pftpriv = &pmlmepriv->ftpriv; ++ pframe = precv_frame->u.hdr.rx_data; ++ frame_len = precv_frame->u.hdr.len; ++ pframe_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); ++ category = pframe_body[0]; ++ ++ if (category != RTW_WLAN_CATEGORY_FT) ++ goto exit; ++ ++ action_code = pframe_body[1]; ++ switch (action_code) { ++ case RTW_WLAN_ACTION_FT_RESPONSE: ++ RTW_INFO("FT: %s RTW_WLAN_ACTION_FT_RESPONSE\n", __func__); ++ if (!_rtw_memcmp(adapter_mac_addr(padapter), &pframe_body[2], ETH_ALEN)) { ++ RTW_ERR("FT: Unmatched STA MAC Address "MAC_FMT"\n", MAC_ARG(&pframe_body[2])); ++ goto exit; ++ } ++ ++ status_code = le16_to_cpu(*(u16 *)((SIZE_PTR)pframe + sizeof(struct rtw_ieee80211_hdr_3addr) + 14)); ++ if (status_code != 0) { ++ RTW_ERR("FT: WLAN ACTION FT RESPONSE fail, status: %d\n", status_code); ++ goto exit; ++ } ++ ++ if (is_zero_mac_addr(&pframe_body[8]) || is_broadcast_mac_addr(&pframe_body[8])) { ++ RTW_ERR("FT: Invalid Target MAC Address "MAC_FMT"\n", MAC_ARG(padapter->mlmepriv.roam_tgt_addr)); ++ goto exit; ++ } ++ ++ pie = rtw_get_ie(pframe_body, _MDIE_, &ft_ie_len, frame_len); ++ if (pie) { ++ if (!_rtw_memcmp(&pftpriv->mdid, pie+2, 2)) { ++ RTW_ERR("FT: Invalid MDID\n"); ++ goto exit; ++ } ++ } ++ ++ rtw_set_ft_status(padapter, RTW_FT_REQUESTED_STA); ++ _cancel_timer_ex(&pmlmeext->ft_link_timer); ++ ++ /*Disconnect current AP*/ ++ receive_disconnect(padapter, pmlmepriv->cur_network.network.MacAddress, WLAN_REASON_ACTIVE_ROAM, _FALSE); ++ ++ pftpriv->ft_action_len = frame_len; ++ _rtw_memcpy(pftpriv->ft_action, pframe, rtw_min(frame_len, RTW_MAX_FTIE_SZ)); ++ ret = _SUCCESS; ++ break; ++ case RTW_WLAN_ACTION_FT_REQUEST: ++ case RTW_WLAN_ACTION_FT_CONFIRM: ++ case RTW_WLAN_ACTION_FT_ACK: ++ default: ++ RTW_ERR("FT: Unsupported FT Action!\n"); ++ break; ++ } ++ ++exit: ++ return ret; ++#else ++ return _SUCCESS; ++#endif ++} ++ ++unsigned int OnAction_ht(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint frame_len = precv_frame->u.hdr.len; ++ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); ++ u8 category, action; ++ ++ /* check RA matches or not */ ++ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) ++ goto exit; ++ ++ category = frame_body[0]; ++ if (category != RTW_WLAN_CATEGORY_HT) ++ goto exit; ++ ++ action = frame_body[1]; ++ switch (action) { ++ case RTW_WLAN_ACTION_HT_SM_PS: ++#ifdef CONFIG_80211N_HT ++#ifdef CONFIG_AP_MODE ++ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) ++ rtw_process_ht_action_smps(padapter, GetAddr2Ptr(pframe), frame_body[2]); ++#endif /*CONFIG_AP_MODE*/ ++#endif /*CONFIG_80211N_HT*/ ++ break; ++ case RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING: ++#ifdef CONFIG_BEAMFORMING ++ /*RTW_INFO("RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING\n");*/ ++ beamforming_get_report_frame(padapter, precv_frame); ++#endif /*CONFIG_BEAMFORMING*/ ++ break; ++ default: ++ break; ++ } ++ ++exit: ++ ++ return _SUCCESS; ++} ++ ++#ifdef CONFIG_IEEE80211W ++unsigned int OnAction_sa_query(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u16 tid; ++ /* Baron */ ++ ++ RTW_INFO("OnAction_sa_query\n"); ++ ++ switch (pframe[WLAN_HDR_A3_LEN + 1]) { ++ case 0: /* SA Query req */ ++ _rtw_memcpy(&tid, &pframe[WLAN_HDR_A3_LEN + 2], sizeof(u16)); ++ RTW_INFO("OnAction_sa_query request,action=%d, tid=%04x, pframe=%02x-%02x\n" ++ , pframe[WLAN_HDR_A3_LEN + 1], tid, pframe[WLAN_HDR_A3_LEN + 2], pframe[WLAN_HDR_A3_LEN + 3]); ++ issue_action_SA_Query(padapter, GetAddr2Ptr(pframe), 1, tid, IEEE80211W_RIGHT_KEY); ++ break; ++ ++ case 1: /* SA Query rsp */ ++ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ if (psta != NULL) ++ _cancel_timer_ex(&psta->dot11w_expire_timer); ++ ++ _rtw_memcpy(&tid, &pframe[WLAN_HDR_A3_LEN + 2], sizeof(u16)); ++ RTW_INFO("OnAction_sa_query response,action=%d, tid=%04x, cancel timer\n", pframe[WLAN_HDR_A3_LEN + 1], tid); ++ break; ++ default: ++ break; ++ } ++ if (0) { ++ int pp; ++ printk("pattrib->pktlen = %d =>", pattrib->pkt_len); ++ for (pp = 0; pp < pattrib->pkt_len; pp++) ++ printk(" %02x ", pframe[pp]); ++ printk("\n"); ++ } ++ ++ return _SUCCESS; ++} ++#endif /* CONFIG_IEEE80211W */ ++ ++unsigned int OnAction_wmm(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ return _SUCCESS; ++} ++ ++unsigned int OnAction_vht(_adapter *padapter, union recv_frame *precv_frame) ++{ ++#ifdef CONFIG_80211AC_VHT ++ struct rx_pkt_attrib *prxattrib = &precv_frame->u.hdr.attrib; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint frame_len = precv_frame->u.hdr.len; ++ struct rtw_ieee80211_hdr_3addr *whdr = (struct rtw_ieee80211_hdr_3addr *)pframe; ++ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); ++ u8 category, action; ++ struct sta_info *psta = NULL; ++ ++ /* check RA matches or not */ ++ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) ++ goto exit; ++ ++ category = frame_body[0]; ++ if (category != RTW_WLAN_CATEGORY_VHT) ++ goto exit; ++ ++ action = frame_body[1]; ++ switch (action) { ++ case RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING: ++#ifdef CONFIG_BEAMFORMING ++ /*RTW_INFO("RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING\n");*/ ++ beamforming_get_report_frame(padapter, precv_frame); ++#endif /*CONFIG_BEAMFORMING*/ ++ break; ++ case RTW_WLAN_ACTION_VHT_OPMODE_NOTIFICATION: ++ /* CategoryCode(1) + ActionCode(1) + OpModeNotification(1) */ ++ /* RTW_INFO("RTW_WLAN_ACTION_VHT_OPMODE_NOTIFICATION\n"); */ ++ psta = rtw_get_stainfo(&padapter->stapriv, whdr->addr2); ++ if (psta) ++ rtw_process_vht_op_mode_notify(padapter, &frame_body[2], psta); ++ break; ++ case RTW_WLAN_ACTION_VHT_GROUPID_MANAGEMENT: ++#ifdef CONFIG_BEAMFORMING ++ beamforming_get_vht_gid_mgnt_frame(padapter, precv_frame); ++#endif /* CONFIG_BEAMFORMING */ ++ break; ++ default: ++ break; ++ } ++ ++exit: ++#endif /* CONFIG_80211AC_VHT */ ++ ++ return _SUCCESS; ++} ++ ++unsigned int OnAction_p2p(_adapter *padapter, union recv_frame *precv_frame) ++{ ++#ifdef CONFIG_P2P ++ u8 *frame_body; ++ u8 category, OUI_Subtype, dialogToken = 0; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ uint len = precv_frame->u.hdr.len; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ /* check RA matches or not */ ++ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) ++ return _SUCCESS; ++ ++ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ ++ category = frame_body[0]; ++ if (category != RTW_WLAN_CATEGORY_P2P) ++ return _SUCCESS; ++ ++ if (cpu_to_be32(*((u32 *)(frame_body + 1))) != P2POUI) ++ return _SUCCESS; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (adapter_wdev_data(padapter)->p2p_enabled ++ && pwdinfo->driver_interface == DRIVER_CFG80211 ++ ) { ++ rtw_cfg80211_rx_action_p2p(padapter, precv_frame); ++ return _SUCCESS; ++ } else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ { ++ len -= sizeof(struct rtw_ieee80211_hdr_3addr); ++ OUI_Subtype = frame_body[5]; ++ dialogToken = frame_body[6]; ++ ++ switch (OUI_Subtype) { ++ case P2P_NOTICE_OF_ABSENCE: ++ ++ break; ++ ++ case P2P_PRESENCE_REQUEST: ++ ++ process_p2p_presence_req(pwdinfo, pframe, len); ++ ++ break; ++ ++ case P2P_PRESENCE_RESPONSE: ++ ++ break; ++ ++ case P2P_GO_DISC_REQUEST: ++ ++ break; ++ ++ default: ++ break; ++ ++ } ++ } ++#endif /* CONFIG_P2P */ ++ ++ return _SUCCESS; ++ ++} ++ ++unsigned int OnAction(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ int i; ++ unsigned char category; ++ struct action_handler *ptable; ++ unsigned char *frame_body; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ ++ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ ++ category = frame_body[0]; ++ ++ for (i = 0; i < sizeof(OnAction_tbl) / sizeof(struct action_handler); i++) { ++ ptable = &OnAction_tbl[i]; ++ ++ if (category == ptable->num) ++ ptable->func(padapter, precv_frame); ++ ++ } ++ ++ return _SUCCESS; ++ ++} ++ ++unsigned int DoReserved(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ ++ /* RTW_INFO("rcvd mgt frame(%x, %x)\n", (GetFrameSubType(pframe) >> 4), *(unsigned int *)GetAddr1Ptr(pframe)); */ ++ return _SUCCESS; ++} ++ ++struct xmit_frame *_alloc_mgtxmitframe(struct xmit_priv *pxmitpriv, bool once) ++{ ++ struct xmit_frame *pmgntframe; ++ struct xmit_buf *pxmitbuf; ++ ++ if (once) ++ pmgntframe = rtw_alloc_xmitframe_once(pxmitpriv); ++ else ++ pmgntframe = rtw_alloc_xmitframe_ext(pxmitpriv); ++ ++ if (pmgntframe == NULL) { ++ RTW_INFO(FUNC_ADPT_FMT" alloc xmitframe fail, once:%d\n", FUNC_ADPT_ARG(pxmitpriv->adapter), once); ++ goto exit; ++ } ++ ++ pxmitbuf = rtw_alloc_xmitbuf_ext(pxmitpriv); ++ if (pxmitbuf == NULL) { ++ RTW_INFO(FUNC_ADPT_FMT" alloc xmitbuf fail\n", FUNC_ADPT_ARG(pxmitpriv->adapter)); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ pmgntframe = NULL; ++ goto exit; ++ } ++ ++ pmgntframe->frame_tag = MGNT_FRAMETAG; ++ pmgntframe->pxmitbuf = pxmitbuf; ++ pmgntframe->buf_addr = pxmitbuf->pbuf; ++ pxmitbuf->priv_data = pmgntframe; ++ ++exit: ++ return pmgntframe; ++ ++} ++ ++inline struct xmit_frame *alloc_mgtxmitframe(struct xmit_priv *pxmitpriv) ++{ ++ return _alloc_mgtxmitframe(pxmitpriv, _FALSE); ++} ++ ++inline struct xmit_frame *alloc_mgtxmitframe_once(struct xmit_priv *pxmitpriv) ++{ ++ return _alloc_mgtxmitframe(pxmitpriv, _TRUE); ++} ++ ++ ++/**************************************************************************** ++ ++Following are some TX fuctions for WiFi MLME ++ ++*****************************************************************************/ ++ ++void update_mgnt_tx_rate(_adapter *padapter, u8 rate) ++{ ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ ++ pmlmeext->tx_rate = rate; ++ /* RTW_INFO("%s(): rate = %x\n",__FUNCTION__, rate); */ ++} ++ ++ ++void update_monitor_frame_attrib(_adapter *padapter, struct pkt_attrib *pattrib) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 wireless_mode; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *pbcmc_sta = NULL; ++ ++ psta = rtw_get_stainfo(pstapriv, pattrib->ra); ++ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); ++ ++ pattrib->hdrlen = 24; ++ pattrib->nr_frags = 1; ++ pattrib->priority = 7; ++ ++ if (pbcmc_sta) ++ pattrib->mac_id = pbcmc_sta->mac_id; ++ else { ++ pattrib->mac_id = 0; ++ RTW_INFO("mgmt use mac_id 0 will affect RA\n"); ++ } ++ pattrib->qsel = QSLT_MGNT; ++ ++ pattrib->pktlen = 0; ++ ++ if (pmlmeext->tx_rate == IEEE80211_CCK_RATE_1MB) ++ wireless_mode = WIRELESS_11B; ++ else ++ wireless_mode = WIRELESS_11G; ++ ++ pattrib->raid = rtw_get_mgntframe_raid(padapter, wireless_mode); ++#ifdef CONFIG_80211AC_VHT ++ if (pHalData->rf_type == RF_1T1R) ++ pattrib->raid = RATEID_IDX_VHT_1SS; ++ else if (pHalData->rf_type == RF_2T2R || pHalData->rf_type == RF_2T4R) ++ pattrib->raid = RATEID_IDX_VHT_2SS; ++ else if (pHalData->rf_type == RF_3T3R) ++ pattrib->raid = RATEID_IDX_VHT_3SS; ++ else ++ pattrib->raid = RATEID_IDX_BGN_40M_1SS; ++#endif ++ ++#ifdef CONFIG_80211AC_VHT ++ pattrib->rate = MGN_VHT1SS_MCS9; ++#else ++ pattrib->rate = MGN_MCS7; ++#endif ++ ++ pattrib->encrypt = _NO_PRIVACY_; ++ pattrib->bswenc = _FALSE; ++ ++ pattrib->qos_en = _FALSE; ++ pattrib->ht_en = 1; ++ pattrib->bwmode = CHANNEL_WIDTH_20; ++ pattrib->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ pattrib->sgi = _FALSE; ++ ++ pattrib->seqnum = pmlmeext->mgnt_seq; ++ ++ pattrib->retry_ctrl = _TRUE; ++ ++ pattrib->mbssid = 0; ++ pattrib->hw_ssn_sel = pxmitpriv->hw_ssn_seq_no; ++ ++} ++ ++ ++void update_mgntframe_attrib(_adapter *padapter, struct pkt_attrib *pattrib) ++{ ++ u8 wireless_mode; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *pbcmc_sta = NULL; ++ /* _rtw_memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib)); */ ++ ++ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); ++ ++ pattrib->hdrlen = 24; ++ pattrib->nr_frags = 1; ++ pattrib->priority = 7; ++ ++ if (pbcmc_sta) ++ pattrib->mac_id = pbcmc_sta->mac_id; ++ else { ++ pattrib->mac_id = 1; /* use STA's BCMC sta-info macid */ ++ ++ if (MLME_IS_AP(padapter) || MLME_IS_GO(padapter)) ++ RTW_INFO("%s-"ADPT_FMT" get bcmc sta_info fail,use MACID=1\n", __func__, ADPT_ARG(padapter)); ++ } ++ pattrib->qsel = QSLT_MGNT; ++ ++#ifdef CONFIG_MCC_MODE ++ update_mcc_mgntframe_attrib(padapter, pattrib); ++#endif ++ ++ pattrib->pktlen = 0; ++ ++ if (IS_CCK_RATE(pmlmeext->tx_rate)) ++ wireless_mode = WIRELESS_11B; ++ else ++ wireless_mode = WIRELESS_11G; ++ pattrib->raid = rtw_get_mgntframe_raid(padapter, wireless_mode); ++ pattrib->rate = pmlmeext->tx_rate; ++ ++ pattrib->encrypt = _NO_PRIVACY_; ++ pattrib->bswenc = _FALSE; ++ ++ pattrib->qos_en = _FALSE; ++ pattrib->ht_en = _FALSE; ++ pattrib->bwmode = CHANNEL_WIDTH_20; ++ pattrib->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ pattrib->sgi = _FALSE; ++ ++ pattrib->seqnum = pmlmeext->mgnt_seq; ++ ++ pattrib->retry_ctrl = _TRUE; ++ ++ pattrib->mbssid = 0; ++ pattrib->hw_ssn_sel = pxmitpriv->hw_ssn_seq_no; ++ ++#ifdef CONFIG_BEAMFORMING ++ psta = rtw_get_stainfo(pstapriv, pattrib->ra); ++ if (psta) ++ update_attrib_txbf_info(padapter, pattrib, psta); ++#endif ++ ++} ++ ++void update_mgntframe_attrib_addr(_adapter *padapter, struct xmit_frame *pmgntframe) ++{ ++ u8 *pframe; ++ struct pkt_attrib *pattrib = &pmgntframe->attrib; ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(pframe), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(pframe), ETH_ALEN); ++} ++ ++void dump_mgntframe(_adapter *padapter, struct xmit_frame *pmgntframe) ++{ ++ if (RTW_CANNOT_RUN(padapter)) { ++ rtw_free_xmitbuf(&padapter->xmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(&padapter->xmitpriv, pmgntframe); ++ return; ++ } ++ ++ rtw_hal_mgnt_xmit(padapter, pmgntframe); ++} ++ ++s32 dump_mgntframe_and_wait(_adapter *padapter, struct xmit_frame *pmgntframe, int timeout_ms) ++{ ++ s32 ret = _FAIL; ++ _irqL irqL; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct xmit_buf *pxmitbuf = pmgntframe->pxmitbuf; ++ struct submit_ctx sctx; ++ ++ if (RTW_CANNOT_RUN(padapter)) { ++ rtw_free_xmitbuf(&padapter->xmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(&padapter->xmitpriv, pmgntframe); ++ return ret; ++ } ++ ++ rtw_sctx_init(&sctx, timeout_ms); ++ pxmitbuf->sctx = &sctx; ++ ++ ret = rtw_hal_mgnt_xmit(padapter, pmgntframe); ++ ++ if (ret == _SUCCESS) ++ ret = rtw_sctx_wait(&sctx, __func__); ++ ++ _enter_critical(&pxmitpriv->lock_sctx, &irqL); ++ pxmitbuf->sctx = NULL; ++ _exit_critical(&pxmitpriv->lock_sctx, &irqL); ++ ++ return ret; ++} ++ ++s32 dump_mgntframe_and_wait_ack_timeout(_adapter *padapter, struct xmit_frame *pmgntframe, int timeout_ms) ++{ ++#ifdef CONFIG_XMIT_ACK ++ static u8 seq_no = 0; ++ s32 ret = _FAIL; ++ struct xmit_priv *pxmitpriv = &(GET_PRIMARY_ADAPTER(padapter))->xmitpriv; ++ ++ if (RTW_CANNOT_RUN(padapter)) { ++ rtw_free_xmitbuf(&padapter->xmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(&padapter->xmitpriv, pmgntframe); ++ return -1; ++ } ++ ++ _enter_critical_mutex(&pxmitpriv->ack_tx_mutex, NULL); ++ pxmitpriv->ack_tx = _TRUE; ++ pxmitpriv->seq_no = seq_no++; ++ pmgntframe->ack_report = 1; ++ rtw_sctx_init(&(pxmitpriv->ack_tx_ops), timeout_ms); ++ if (rtw_hal_mgnt_xmit(padapter, pmgntframe) == _SUCCESS) ++ ret = rtw_sctx_wait(&(pxmitpriv->ack_tx_ops), __func__); ++ ++ pxmitpriv->ack_tx = _FALSE; ++ _exit_critical_mutex(&pxmitpriv->ack_tx_mutex, NULL); ++ ++ return ret; ++#else /* !CONFIG_XMIT_ACK */ ++ dump_mgntframe(padapter, pmgntframe); ++ rtw_msleep_os(50); ++ return _SUCCESS; ++#endif /* !CONFIG_XMIT_ACK */ ++} ++ ++s32 dump_mgntframe_and_wait_ack(_adapter *padapter, struct xmit_frame *pmgntframe) ++{ ++ /* In this case, use 500 ms as the default wait_ack timeout */ ++ return dump_mgntframe_and_wait_ack_timeout(padapter, pmgntframe, 500); ++} ++ ++ ++int update_hidden_ssid(u8 *ies, u32 ies_len, u8 hidden_ssid_mode) ++{ ++ u8 *ssid_ie; ++ sint ssid_len_ori; ++ int len_diff = 0; ++ ++ ssid_ie = rtw_get_ie(ies, WLAN_EID_SSID, &ssid_len_ori, ies_len); ++ ++ /* RTW_INFO("%s hidden_ssid_mode:%u, ssid_ie:%p, ssid_len_ori:%d\n", __FUNCTION__, hidden_ssid_mode, ssid_ie, ssid_len_ori); */ ++ ++ if (ssid_ie && ssid_len_ori > 0) { ++ switch (hidden_ssid_mode) { ++ case 1: { ++ u8 *next_ie = ssid_ie + 2 + ssid_len_ori; ++ u32 remain_len = 0; ++ ++ remain_len = ies_len - (next_ie - ies); ++ ++ ssid_ie[1] = 0; ++ _rtw_memcpy(ssid_ie + 2, next_ie, remain_len); ++ len_diff -= ssid_len_ori; ++ ++ break; ++ } ++ case 2: ++ _rtw_memset(&ssid_ie[2], 0, ssid_len_ori); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ return len_diff; ++} ++ ++#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE ++u32 rtw_build_vendor_ie(_adapter *padapter , unsigned char *pframe , u8 mgmt_frame_tyte) ++{ ++ int vendor_ie_num = 0; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u32 len = 0; ++ ++ for (vendor_ie_num = 0 ; vendor_ie_num < WLAN_MAX_VENDOR_IE_NUM ; vendor_ie_num++) { ++ if (pmlmepriv->vendor_ielen[vendor_ie_num] > 0 && pmlmepriv->vendor_ie_mask[vendor_ie_num] & mgmt_frame_tyte) { ++ _rtw_memcpy(pframe , pmlmepriv->vendor_ie[vendor_ie_num] , pmlmepriv->vendor_ielen[vendor_ie_num]); ++ pframe += pmlmepriv->vendor_ielen[vendor_ie_num]; ++ len += pmlmepriv->vendor_ielen[vendor_ie_num]; ++ } ++ } ++ ++ return len; ++} ++#endif ++ ++#ifdef CONFIG_AP_MODE ++void issue_beacon(_adapter *padapter, int timeout_ms) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ unsigned int rate_len; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++#endif /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif /* CONFIG_P2P */ ++ ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++#ifdef CONFIG_BCN_ICF ++ pmgntframe = rtw_alloc_bcnxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++#else ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++#endif ++ { ++ RTW_INFO("%s, alloc mgnt frame fail\n", __FUNCTION__); ++ return; ++ } ++#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) ++ _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); ++#endif /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ pattrib->qsel = QSLT_BEACON; ++ ++#if defined(CONFIG_CONCURRENT_MODE) && (!defined(CONFIG_SWTIMER_BASED_TXBCN)) ++ if (padapter->hw_port == HW_PORT1) ++ pattrib->mbssid = 1; ++#endif ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); ++ /* pmlmeext->mgnt_seq++; */ ++ SetFrameSubType(pframe, WIFI_BEACON); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { ++ /* RTW_INFO("ie len=%d\n", cur_network->IELength); */ ++#ifdef CONFIG_P2P ++ /* for P2P : Primary Device Type & Device Name */ ++ u32 wpsielen = 0, insert_len = 0; ++ u8 *wpsie = NULL; ++ wpsie = rtw_get_wps_ie(cur_network->IEs + _FIXED_IE_LENGTH_, cur_network->IELength - _FIXED_IE_LENGTH_, NULL, &wpsielen); ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && wpsie && wpsielen > 0) { ++ uint wps_offset, remainder_ielen; ++ u8 *premainder_ie, *pframe_wscie; ++ ++ wps_offset = (uint)(wpsie - cur_network->IEs); ++ ++ premainder_ie = wpsie + wpsielen; ++ ++ remainder_ielen = cur_network->IELength - wps_offset - wpsielen; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) { ++ if (pmlmepriv->wps_beacon_ie && pmlmepriv->wps_beacon_ie_len > 0) { ++ _rtw_memcpy(pframe, cur_network->IEs, wps_offset); ++ pframe += wps_offset; ++ pattrib->pktlen += wps_offset; ++ ++ _rtw_memcpy(pframe, pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len); ++ pframe += pmlmepriv->wps_beacon_ie_len; ++ pattrib->pktlen += pmlmepriv->wps_beacon_ie_len; ++ ++ /* copy remainder_ie to pframe */ ++ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); ++ pframe += remainder_ielen; ++ pattrib->pktlen += remainder_ielen; ++ } else { ++ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); ++ pframe += cur_network->IELength; ++ pattrib->pktlen += cur_network->IELength; ++ } ++ } else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ { ++ pframe_wscie = pframe + wps_offset; ++ _rtw_memcpy(pframe, cur_network->IEs, wps_offset + wpsielen); ++ pframe += (wps_offset + wpsielen); ++ pattrib->pktlen += (wps_offset + wpsielen); ++ ++ /* now pframe is end of wsc ie, insert Primary Device Type & Device Name */ ++ /* Primary Device Type */ ++ /* Type: */ ++ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_ATTR_PRIMARY_DEV_TYPE); ++ insert_len += 2; ++ ++ /* Length: */ ++ *(u16 *)(pframe + insert_len) = cpu_to_be16(0x0008); ++ insert_len += 2; ++ ++ /* Value: */ ++ /* Category ID */ ++ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); ++ insert_len += 2; ++ ++ /* OUI */ ++ *(u32 *)(pframe + insert_len) = cpu_to_be32(WPSOUI); ++ insert_len += 4; ++ ++ /* Sub Category ID */ ++ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); ++ insert_len += 2; ++ ++ ++ /* Device Name */ ++ /* Type: */ ++ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); ++ insert_len += 2; ++ ++ /* Length: */ ++ *(u16 *)(pframe + insert_len) = cpu_to_be16(pwdinfo->device_name_len); ++ insert_len += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(pframe + insert_len, pwdinfo->device_name, pwdinfo->device_name_len); ++ insert_len += pwdinfo->device_name_len; ++ ++ ++ /* update wsc ie length */ ++ *(pframe_wscie + 1) = (wpsielen - 2) + insert_len; ++ ++ /* pframe move to end */ ++ pframe += insert_len; ++ pattrib->pktlen += insert_len; ++ ++ /* copy remainder_ie to pframe */ ++ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); ++ pframe += remainder_ielen; ++ pattrib->pktlen += remainder_ielen; ++ } ++ } else ++#endif /* CONFIG_P2P */ ++ { ++ int len_diff; ++ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); ++ len_diff = update_hidden_ssid( ++ pframe + _BEACON_IE_OFFSET_ ++ , cur_network->IELength - _BEACON_IE_OFFSET_ ++ , pmlmeinfo->hidden_ssid_mode ++ ); ++ pframe += (cur_network->IELength + len_diff); ++ pattrib->pktlen += (cur_network->IELength + len_diff); ++ } ++ ++ { ++ u8 *wps_ie; ++ uint wps_ielen; ++ u8 sr = 0; ++ wps_ie = rtw_get_wps_ie(pmgntframe->buf_addr + TXDESC_OFFSET + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_, ++ pattrib->pktlen - sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_, NULL, &wps_ielen); ++ if (wps_ie && wps_ielen > 0) ++ rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8 *)(&sr), NULL); ++ if (sr != 0) ++ set_fwstate(pmlmepriv, WIFI_UNDER_WPS); ++ else ++ _clr_fwstate_(pmlmepriv, WIFI_UNDER_WPS); ++ } ++ ++#ifdef CONFIG_P2P ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ u32 len; ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) { ++ len = pmlmepriv->p2p_beacon_ie_len; ++ if (pmlmepriv->p2p_beacon_ie && len > 0) ++ _rtw_memcpy(pframe, pmlmepriv->p2p_beacon_ie, len); ++ } else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ { ++ len = build_beacon_p2p_ie(pwdinfo, pframe); ++ } ++ ++ pframe += len; ++ pattrib->pktlen += len; ++ ++#ifdef CONFIG_WFD ++ len = rtw_append_beacon_wfd_ie(padapter, pframe); ++ pframe += len; ++ pattrib->pktlen += len; ++#endif ++ } ++#endif /* CONFIG_P2P */ ++ ++#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE ++ pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_BEACON_VENDOR_IE_BIT); ++#endif ++ goto _issue_bcn; ++ ++ } ++ ++ /* below for ad-hoc mode */ ++ ++ /* timestamp will be inserted by hardware */ ++ pframe += 8; ++ pattrib->pktlen += 8; ++ ++ /* beacon interval: 2 bytes */ ++ ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); ++ ++ pframe += 2; ++ pattrib->pktlen += 2; ++ ++ /* capability info: 2 bytes */ ++ ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); ++ ++ pframe += 2; ++ pattrib->pktlen += 2; ++ ++ /* SSID */ ++ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pattrib->pktlen); ++ ++ /* supported rates... */ ++ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pattrib->pktlen); ++ ++ /* DS parameter set */ ++ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pattrib->pktlen); ++ ++ /* if( (pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) */ ++ { ++ u8 erpinfo = 0; ++ u32 ATIMWindow; ++ /* IBSS Parameter Set... */ ++ /* ATIMWindow = cur->Configuration.ATIMWindow; */ ++ ATIMWindow = 0; ++ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pattrib->pktlen); ++ ++ /* ERP IE */ ++ pframe = rtw_set_ie(pframe, _ERPINFO_IE_, 1, &erpinfo, &pattrib->pktlen); ++ } ++ ++ ++ /* EXTERNDED SUPPORTED RATE */ ++ if (rate_len > 8) ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pattrib->pktlen); ++ ++ ++ /* todo:HT for adhoc */ ++ ++_issue_bcn: ++ ++#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) ++ pmlmepriv->update_bcn = _FALSE; ++ ++ _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); ++#endif /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ ++ ++ if ((pattrib->pktlen + TXDESC_SIZE) > 512) { ++ RTW_INFO("beacon frame too large\n"); ++ return; ++ } ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ /* RTW_INFO("issue bcn_sz=%d\n", pattrib->last_txcmdsz); */ ++ if (timeout_ms > 0) ++ dump_mgntframe_and_wait(padapter, pmgntframe, timeout_ms); ++ else ++ dump_mgntframe(padapter, pmgntframe); ++ ++} ++#endif ++ ++void issue_probersp(_adapter *padapter, unsigned char *da, u8 is_valid_p2p_probereq) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ unsigned char *mac, *bssid; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) ++ u8 *pwps_ie; ++ uint wps_ielen; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++#endif /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ unsigned int rate_len; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++#endif /* CONFIG_P2P */ ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ if (da == NULL) ++ return; ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ return; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) { ++ RTW_INFO("%s, alloc mgnt frame fail\n", __FUNCTION__); ++ return; ++ } ++ ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ mac = adapter_mac_addr(padapter); ++ bssid = cur_network->MacAddress; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, bssid, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(fctrl, WIFI_PROBERSP); ++ ++ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = pattrib->hdrlen; ++ pframe += pattrib->hdrlen; ++ ++ ++ if (cur_network->IELength > MAX_IE_SZ) ++ return; ++ ++#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { ++ pwps_ie = rtw_get_wps_ie(cur_network->IEs + _FIXED_IE_LENGTH_, cur_network->IELength - _FIXED_IE_LENGTH_, NULL, &wps_ielen); ++ ++ /* inerset & update wps_probe_resp_ie */ ++ if ((pmlmepriv->wps_probe_resp_ie != NULL) && pwps_ie && (wps_ielen > 0)) { ++ uint wps_offset, remainder_ielen; ++ u8 *premainder_ie; ++ ++ wps_offset = (uint)(pwps_ie - cur_network->IEs); ++ ++ premainder_ie = pwps_ie + wps_ielen; ++ ++ remainder_ielen = cur_network->IELength - wps_offset - wps_ielen; ++ ++ _rtw_memcpy(pframe, cur_network->IEs, wps_offset); ++ pframe += wps_offset; ++ pattrib->pktlen += wps_offset; ++ ++ wps_ielen = (uint)pmlmepriv->wps_probe_resp_ie[1];/* to get ie data len */ ++ if ((wps_offset + wps_ielen + 2) <= MAX_IE_SZ) { ++ _rtw_memcpy(pframe, pmlmepriv->wps_probe_resp_ie, wps_ielen + 2); ++ pframe += wps_ielen + 2; ++ pattrib->pktlen += wps_ielen + 2; ++ } ++ ++ if ((wps_offset + wps_ielen + 2 + remainder_ielen) <= MAX_IE_SZ) { ++ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); ++ pframe += remainder_ielen; ++ pattrib->pktlen += remainder_ielen; ++ } ++ } else { ++ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); ++ pframe += cur_network->IELength; ++ pattrib->pktlen += cur_network->IELength; ++ } ++ ++ /* retrieve SSID IE from cur_network->Ssid */ ++ { ++ u8 *ssid_ie; ++ sint ssid_ielen; ++ sint ssid_ielen_diff; ++ u8 buf[MAX_IE_SZ]; ++ u8 *ies = pmgntframe->buf_addr + TXDESC_OFFSET + sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ ssid_ie = rtw_get_ie(ies + _FIXED_IE_LENGTH_, _SSID_IE_, &ssid_ielen, ++ (pframe - ies) - _FIXED_IE_LENGTH_); ++ ++ ssid_ielen_diff = cur_network->Ssid.SsidLength - ssid_ielen; ++ ++ if (ssid_ie && cur_network->Ssid.SsidLength) { ++ uint remainder_ielen; ++ u8 *remainder_ie; ++ remainder_ie = ssid_ie + 2; ++ remainder_ielen = (pframe - remainder_ie); ++ ++ if (remainder_ielen > MAX_IE_SZ) { ++ RTW_WARN(FUNC_ADPT_FMT" remainder_ielen > MAX_IE_SZ\n", FUNC_ADPT_ARG(padapter)); ++ remainder_ielen = MAX_IE_SZ; ++ } ++ ++ _rtw_memcpy(buf, remainder_ie, remainder_ielen); ++ _rtw_memcpy(remainder_ie + ssid_ielen_diff, buf, remainder_ielen); ++ *(ssid_ie + 1) = cur_network->Ssid.SsidLength; ++ _rtw_memcpy(ssid_ie + 2, cur_network->Ssid.Ssid, cur_network->Ssid.SsidLength); ++ ++ pframe += ssid_ielen_diff; ++ pattrib->pktlen += ssid_ielen_diff; ++ } ++ } ++#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE ++ pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_PROBERESP_VENDOR_IE_BIT); ++#endif ++ } else ++#endif ++ { ++ ++ /* timestamp will be inserted by hardware */ ++ pframe += 8; ++ pattrib->pktlen += 8; ++ ++ /* beacon interval: 2 bytes */ ++ ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); ++ ++ pframe += 2; ++ pattrib->pktlen += 2; ++ ++ /* capability info: 2 bytes */ ++ ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); ++ ++ pframe += 2; ++ pattrib->pktlen += 2; ++ ++ /* below for ad-hoc mode */ ++ ++ /* SSID */ ++ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pattrib->pktlen); ++ ++ /* supported rates... */ ++ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pattrib->pktlen); ++ ++ /* DS parameter set */ ++ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pattrib->pktlen); ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { ++ u8 erpinfo = 0; ++ u32 ATIMWindow; ++ /* IBSS Parameter Set... */ ++ /* ATIMWindow = cur->Configuration.ATIMWindow; */ ++ ATIMWindow = 0; ++ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pattrib->pktlen); ++ ++ /* ERP IE */ ++ pframe = rtw_set_ie(pframe, _ERPINFO_IE_, 1, &erpinfo, &pattrib->pktlen); ++ } ++ ++ ++ /* EXTERNDED SUPPORTED RATE */ ++ if (rate_len > 8) ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pattrib->pktlen); ++ ++ ++ /* todo:HT for adhoc */ ++ ++ } ++ ++#ifdef CONFIG_P2P ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) ++ /* IOT issue, When wifi_spec is not set, send probe_resp with P2P IE even if probe_req has no P2P IE */ ++ && (is_valid_p2p_probereq || !padapter->registrypriv.wifi_spec)) { ++ u32 len; ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) { ++ /* if pwdinfo->role == P2P_ROLE_DEVICE will call issue_probersp_p2p() */ ++ len = pmlmepriv->p2p_go_probe_resp_ie_len; ++ if (pmlmepriv->p2p_go_probe_resp_ie && len > 0) ++ _rtw_memcpy(pframe, pmlmepriv->p2p_go_probe_resp_ie, len); ++ } else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ { ++ len = build_probe_resp_p2p_ie(pwdinfo, pframe); ++ } ++ ++ pframe += len; ++ pattrib->pktlen += len; ++ ++#ifdef CONFIG_WFD ++ len = rtw_append_probe_resp_wfd_ie(padapter, pframe); ++ pframe += len; ++ pattrib->pktlen += len; ++#endif ++ } ++#endif /* CONFIG_P2P */ ++ ++ ++#ifdef CONFIG_AUTO_AP_MODE ++ { ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ RTW_INFO("(%s)\n", __FUNCTION__); ++ ++ /* check rc station */ ++ psta = rtw_get_stainfo(pstapriv, da); ++ if (psta && psta->isrc && psta->pid > 0) { ++ u8 RC_OUI[4] = {0x00, 0xE0, 0x4C, 0x0A}; ++ u8 RC_INFO[14] = {0}; ++ /* EID[1] + EID_LEN[1] + RC_OUI[4] + MAC[6] + PairingID[2] + ChannelNum[2] */ ++ u16 cu_ch = (u16)cur_network->Configuration.DSConfig; ++ ++ RTW_INFO("%s, reply rc(pid=0x%x) device "MAC_FMT" in ch=%d\n", __FUNCTION__, ++ psta->pid, MAC_ARG(psta->hwaddr), cu_ch); ++ ++ /* append vendor specific ie */ ++ _rtw_memcpy(RC_INFO, RC_OUI, sizeof(RC_OUI)); ++ _rtw_memcpy(&RC_INFO[4], mac, ETH_ALEN); ++ _rtw_memcpy(&RC_INFO[10], (u8 *)&psta->pid, 2); ++ _rtw_memcpy(&RC_INFO[12], (u8 *)&cu_ch, 2); ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, sizeof(RC_INFO), RC_INFO, &pattrib->pktlen); ++ } ++ } ++#endif /* CONFIG_AUTO_AP_MODE */ ++ ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ return; ++ ++} ++ ++int _issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, bool append_wps, int wait_ack) ++{ ++ int ret = _FAIL; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ unsigned char *mac; ++ unsigned char bssrate[NumRates]; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ int bssrate_len = 0; ++ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ goto exit; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ mac = adapter_mac_addr(padapter); ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ if (da) { ++ /* unicast probe request frame */ ++ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, da, ETH_ALEN); ++ } else { ++ /* broadcast probe request frame */ ++ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, bc_addr, ETH_ALEN); ++ } ++ ++ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_PROBEREQ); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ if (pssid) ++ pframe = rtw_set_ie(pframe, _SSID_IE_, pssid->SsidLength, pssid->Ssid, &(pattrib->pktlen)); ++ else ++ pframe = rtw_set_ie(pframe, _SSID_IE_, 0, NULL, &(pattrib->pktlen)); ++ ++ get_rate_set(padapter, bssrate, &bssrate_len); ++ ++ if (bssrate_len > 8) { ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); ++ } else ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); ++ ++ if (ch) ++ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, &ch, &pattrib->pktlen); ++ ++ if (append_wps) { ++ /* add wps_ie for wps2.0 */ ++ if (pmlmepriv->wps_probe_req_ie_len > 0 && pmlmepriv->wps_probe_req_ie) { ++ _rtw_memcpy(pframe, pmlmepriv->wps_probe_req_ie, pmlmepriv->wps_probe_req_ie_len); ++ pframe += pmlmepriv->wps_probe_req_ie_len; ++ pattrib->pktlen += pmlmepriv->wps_probe_req_ie_len; ++ /* pmlmepriv->wps_probe_req_ie_len = 0 ; */ /* reset to zero */ ++ } ++ } ++#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE ++ pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_PROBEREQ_VENDOR_IE_BIT); ++#endif ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ ++ if (wait_ack) ++ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); ++ else { ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ } ++ ++exit: ++ return ret; ++} ++ ++inline void issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da) ++{ ++ _issue_probereq(padapter, pssid, da, 0, 1, _FALSE); ++} ++ ++/* ++ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT ++ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX ++ * try_cnt means the maximal TX count to try ++ */ ++int issue_probereq_ex(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, bool append_wps, ++ int try_cnt, int wait_ms) ++{ ++ int ret = _FAIL; ++ int i = 0; ++ u32 start = rtw_get_current_time(); ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ goto exit; ++ ++ do { ++ ret = _issue_probereq(padapter, pssid, da, ch, append_wps, wait_ms > 0 ? _TRUE : _FALSE); ++ ++ i++; ++ ++ if (RTW_CANNOT_RUN(padapter)) ++ break; ++ ++ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) ++ rtw_msleep_os(wait_ms); ++ ++ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); ++ ++ if (ret != _FAIL) { ++ ret = _SUCCESS; ++#ifndef DBG_XMIT_ACK ++ goto exit; ++#endif ++ } ++ ++ if (try_cnt && wait_ms) { ++ if (da) ++ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ else ++ RTW_INFO(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ } ++exit: ++ return ret; ++} ++ ++/* if psta == NULL, indiate we are station(client) now... */ ++void issue_auth(_adapter *padapter, struct sta_info *psta, unsigned short status) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ unsigned int val32; ++ unsigned short val16; ++ int use_shared_key = 0; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++#ifdef CONFIG_RTW_80211R ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ft_priv *pftpriv = &pmlmepriv->ftpriv; ++ u8 is_ft_roaming = _FALSE; ++ u8 is_ft_roaming_with_rsn_ie = _TRUE; ++ u8 *pie = NULL; ++ u32 ft_ie_len = 0; ++#endif ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ return; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_AUTH); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ ++ if (psta) { /* for AP mode */ ++#ifdef CONFIG_NATIVEAP_MLME ++ ++ _rtw_memcpy(pwlanhdr->addr1, psta->hwaddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ ++ ++ /* setting auth algo number */ ++ val16 = (u16)psta->authalg; ++ ++ if (status != _STATS_SUCCESSFUL_) ++ val16 = 0; ++ ++ if (val16) { ++ val16 = cpu_to_le16(val16); ++ use_shared_key = 1; ++ } ++ ++ pframe = rtw_set_fixed_ie(pframe, _AUTH_ALGM_NUM_, (unsigned char *)&val16, &(pattrib->pktlen)); ++ ++ /* setting auth seq number */ ++ val16 = (u16)psta->auth_seq; ++ val16 = cpu_to_le16(val16); ++ pframe = rtw_set_fixed_ie(pframe, _AUTH_SEQ_NUM_, (unsigned char *)&val16, &(pattrib->pktlen)); ++ ++ /* setting status code... */ ++ val16 = status; ++ val16 = cpu_to_le16(val16); ++ pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&val16, &(pattrib->pktlen)); ++ ++ /* added challenging text... */ ++ if ((psta->auth_seq == 2) && (psta->state & WIFI_FW_AUTH_STATE) && (use_shared_key == 1)) ++ pframe = rtw_set_ie(pframe, _CHLGETXT_IE_, 128, psta->chg_txt, &(pattrib->pktlen)); ++#endif ++ } else { ++ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); ++ ++#ifdef CONFIG_RTW_80211R ++ /*For Fast BSS Transition */ ++ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { ++ is_ft_roaming = _TRUE; ++ val16 = 2; /* 2: 802.11R FTAA */ ++ val16 = cpu_to_le16(val16); ++ } else ++#endif ++ { ++ /* setting auth algo number */ ++ val16 = (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) ? 1 : 0; /* 0:OPEN System, 1:Shared key */ ++ if (val16) { ++ val16 = cpu_to_le16(val16); ++ use_shared_key = 1; ++ } ++ } ++ ++ /* RTW_INFO("%s auth_algo= %s auth_seq=%d\n",__FUNCTION__,(pmlmeinfo->auth_algo==0)?"OPEN":"SHARED",pmlmeinfo->auth_seq); */ ++ ++ /* setting IV for auth seq #3 */ ++ if ((pmlmeinfo->auth_seq == 3) && (pmlmeinfo->state & WIFI_FW_AUTH_STATE) && (use_shared_key == 1)) { ++ /* RTW_INFO("==> iv(%d),key_index(%d)\n",pmlmeinfo->iv,pmlmeinfo->key_index); */ ++ val32 = ((pmlmeinfo->iv++) | (pmlmeinfo->key_index << 30)); ++ val32 = cpu_to_le32(val32); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *)&val32, &(pattrib->pktlen)); ++ ++ pattrib->iv_len = 4; ++ } ++ ++ pframe = rtw_set_fixed_ie(pframe, _AUTH_ALGM_NUM_, (unsigned char *)&val16, &(pattrib->pktlen)); ++ ++ /* setting auth seq number */ ++ val16 = pmlmeinfo->auth_seq; ++ val16 = cpu_to_le16(val16); ++ pframe = rtw_set_fixed_ie(pframe, _AUTH_SEQ_NUM_, (unsigned char *)&val16, &(pattrib->pktlen)); ++ ++ ++ /* setting status code... */ ++ val16 = status; ++ val16 = cpu_to_le16(val16); ++ pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&val16, &(pattrib->pktlen)); ++ ++#ifdef CONFIG_RTW_80211R ++ if (is_ft_roaming == _TRUE) { ++ pie = rtw_get_ie(pftpriv->updated_ft_ies, EID_WPA2, &ft_ie_len, pftpriv->updated_ft_ies_len); ++ if (pie) ++ pframe = rtw_set_ie(pframe, EID_WPA2, ft_ie_len, pie+2, &(pattrib->pktlen)); ++ else ++ is_ft_roaming_with_rsn_ie = _FALSE; ++ ++ pie = rtw_get_ie(pftpriv->updated_ft_ies, _MDIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); ++ if (pie) ++ pframe = rtw_set_ie(pframe, _MDIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); ++ ++ pie = rtw_get_ie(pftpriv->updated_ft_ies, _FTIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); ++ if (pie && is_ft_roaming_with_rsn_ie) ++ pframe = rtw_set_ie(pframe, _FTIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); ++ } ++#endif ++ ++ /* then checking to see if sending challenging text... */ ++ if ((pmlmeinfo->auth_seq == 3) && (pmlmeinfo->state & WIFI_FW_AUTH_STATE) && (use_shared_key == 1)) { ++ pframe = rtw_set_ie(pframe, _CHLGETXT_IE_, 128, pmlmeinfo->chg_txt, &(pattrib->pktlen)); ++ ++ SetPrivacy(fctrl); ++ ++ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pattrib->encrypt = _WEP40_; ++ ++ pattrib->icv_len = 4; ++ ++ pattrib->pktlen += pattrib->icv_len; ++ ++ } ++ ++ } ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ rtw_wep_encrypt(padapter, (u8 *)pmgntframe); ++ RTW_INFO("%s\n", __FUNCTION__); ++ dump_mgntframe(padapter, pmgntframe); ++ ++ return; ++} ++ ++ ++void issue_asocrsp(_adapter *padapter, unsigned short status, struct sta_info *pstat, int pkt_type) ++{ ++#ifdef CONFIG_AP_MODE ++ struct xmit_frame *pmgntframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct pkt_attrib *pattrib; ++ unsigned char *pbuf, *pframe; ++ unsigned short val, ie_status; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); ++ u8 *ie = pnetwork->IEs; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++ ++#endif /* CONFIG_P2P */ ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ return; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy((void *)GetAddr1Ptr(pwlanhdr), pstat->hwaddr, ETH_ALEN); ++ _rtw_memcpy((void *)GetAddr2Ptr(pwlanhdr), adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy((void *)GetAddr3Ptr(pwlanhdr), get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ if ((pkt_type == WIFI_ASSOCRSP) || (pkt_type == WIFI_REASSOCRSP)) ++ SetFrameSubType(pwlanhdr, pkt_type); ++ else ++ return; ++ ++ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen += pattrib->hdrlen; ++ pframe += pattrib->hdrlen; ++ ++ /* capability */ ++ val = *(unsigned short *)rtw_get_capability_from_ie(ie); ++ ++ pframe = rtw_set_fixed_ie(pframe, _CAPABILITY_ , (unsigned char *)&val, &(pattrib->pktlen)); ++ ++ ie_status = cpu_to_le16(status); ++ pframe = rtw_set_fixed_ie(pframe , _STATUS_CODE_ , (unsigned char *)&ie_status, &(pattrib->pktlen)); ++ ++ val = cpu_to_le16(pstat->aid | BIT(14) | BIT(15)); ++ pframe = rtw_set_fixed_ie(pframe, _ASOC_ID_ , (unsigned char *)&val, &(pattrib->pktlen)); ++ ++ if (pstat->bssratelen <= 8) ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, pstat->bssratelen, pstat->bssrateset, &(pattrib->pktlen)); ++ else { ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pstat->bssrateset, &(pattrib->pktlen)); ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (pstat->bssratelen - 8), pstat->bssrateset + 8, &(pattrib->pktlen)); ++ } ++ ++#ifdef CONFIG_IEEE80211W ++ if (status == _STATS_REFUSED_TEMPORARILY_) { ++ u8 timeout_itvl[5]; ++ u32 timeout_interval = 3000; ++ /* Association Comeback time */ ++ timeout_itvl[0] = 0x03; ++ timeout_interval = cpu_to_le32(timeout_interval); ++ _rtw_memcpy(timeout_itvl + 1, &timeout_interval, 4); ++ pframe = rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); ++ } ++#endif /* CONFIG_IEEE80211W */ ++ ++#ifdef CONFIG_80211N_HT ++ if ((pstat->flags & WLAN_STA_HT) && (pmlmepriv->htpriv.ht_option)) { ++ uint ie_len = 0; ++ ++ /* FILL HT CAP INFO IE */ ++ /* p = hostapd_eid_ht_capabilities_info(hapd, p); */ ++ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); ++ if (pbuf && ie_len > 0) { ++ _rtw_memcpy(pframe, pbuf, ie_len + 2); ++ pframe += (ie_len + 2); ++ pattrib->pktlen += (ie_len + 2); ++ } ++ ++ /* FILL HT ADD INFO IE */ ++ /* p = hostapd_eid_ht_operation(hapd, p); */ ++ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); ++ if (pbuf && ie_len > 0) { ++ _rtw_memcpy(pframe, pbuf, ie_len + 2); ++ pframe += (ie_len + 2); ++ pattrib->pktlen += (ie_len + 2); ++ } ++ ++ } ++#endif ++ ++ /*adding EXT_CAPAB_IE */ ++ if (pmlmepriv->ext_capab_ie_len > 0) { ++ uint ie_len = 0; ++ ++ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_CAP_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); ++ if (pbuf && ie_len > 0) { ++ _rtw_memcpy(pframe, pbuf, ie_len + 2); ++ pframe += (ie_len + 2); ++ pattrib->pktlen += (ie_len + 2); ++ } ++ } ++ ++#ifdef CONFIG_80211AC_VHT ++ if ((pstat->flags & WLAN_STA_VHT) && (pmlmepriv->vhtpriv.vht_option) ++ && (pstat->wpa_pairwise_cipher != WPA_CIPHER_TKIP) ++ && (pstat->wpa2_pairwise_cipher != WPA_CIPHER_TKIP)) { ++ u32 ie_len = 0; ++ ++ /* FILL VHT CAP IE */ ++ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, EID_VHTCapability, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); ++ if (pbuf && ie_len > 0) { ++ _rtw_memcpy(pframe, pbuf, ie_len + 2); ++ pframe += (ie_len + 2); ++ pattrib->pktlen += (ie_len + 2); ++ } ++ ++ /* FILL VHT OPERATION IE */ ++ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, EID_VHTOperation, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); ++ if (pbuf && ie_len > 0) { ++ _rtw_memcpy(pframe, pbuf, ie_len + 2); ++ pframe += (ie_len + 2); ++ pattrib->pktlen += (ie_len + 2); ++ } ++ } ++#endif /* CONFIG_80211AC_VHT */ ++ ++ /* FILL WMM IE */ ++ if ((pstat->flags & WLAN_STA_WME) && (pmlmepriv->qospriv.qos_option)) { ++ uint ie_len = 0; ++ unsigned char WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; ++ ++ for (pbuf = ie + _BEACON_IE_OFFSET_; ; pbuf += (ie_len + 2)) { ++ pbuf = rtw_get_ie(pbuf, _VENDOR_SPECIFIC_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); ++ if (pbuf && _rtw_memcmp(pbuf + 2, WMM_PARA_IE, 6)) { ++ _rtw_memcpy(pframe, pbuf, ie_len + 2); ++ pframe += (ie_len + 2); ++ pattrib->pktlen += (ie_len + 2); ++ ++ break; ++ } ++ ++ if ((pbuf == NULL) || (ie_len == 0)) ++ break; ++ } ++ ++ } ++ ++ ++ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK) ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 6 , REALTEK_96B_IE, &(pattrib->pktlen)); ++ ++ /* add WPS IE ie for wps 2.0 */ ++ if (pmlmepriv->wps_assoc_resp_ie && pmlmepriv->wps_assoc_resp_ie_len > 0) { ++ _rtw_memcpy(pframe, pmlmepriv->wps_assoc_resp_ie, pmlmepriv->wps_assoc_resp_ie_len); ++ ++ pframe += pmlmepriv->wps_assoc_resp_ie_len; ++ pattrib->pktlen += pmlmepriv->wps_assoc_resp_ie_len; ++ } ++ ++#ifdef CONFIG_P2P ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && (pstat->is_p2p_device == _TRUE)) { ++ u32 len; ++ ++ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) { ++ len = 0; ++ if (pmlmepriv->p2p_assoc_resp_ie && pmlmepriv->p2p_assoc_resp_ie_len > 0) { ++ len = pmlmepriv->p2p_assoc_resp_ie_len; ++ _rtw_memcpy(pframe, pmlmepriv->p2p_assoc_resp_ie, len); ++ } ++ } else ++ len = build_assoc_resp_p2p_ie(pwdinfo, pframe, pstat->p2p_status_code); ++ pframe += len; ++ pattrib->pktlen += len; ++ } ++ ++#ifdef CONFIG_WFD ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ wfdielen = rtw_append_assoc_resp_wfd_ie(padapter, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++ } ++#endif ++ ++#endif /* CONFIG_P2P */ ++#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE ++ pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_ASSOCRESP_VENDOR_IE_BIT); ++#endif ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++#endif ++} ++ ++void _issue_assocreq(_adapter *padapter, u8 is_reassoc) ++{ ++ int ret = _FAIL; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe, *p; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ unsigned short val16; ++ unsigned int i, j, ie_len, index = 0; ++ unsigned char rf_type, bssrate[NumRates], sta_bssrate[NumRates]; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ int bssrate_len = 0, sta_bssrate_len = 0; ++ u8 vs_ie_length = 0; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 p2pie[255] = { 0x00 }; ++ u16 p2pielen = 0; ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++#endif /* CONFIG_P2P */ ++ ++#ifdef CONFIG_DFS ++ u16 cap; ++ ++ /* Dot H */ ++ u8 pow_cap_ele[2] = { 0x00 }; ++ u8 sup_ch[30 * 2] = {0x00 }, sup_ch_idx = 0, idx_5g = 2; /* For supported channel */ ++#endif /* CONFIG_DFS */ ++#ifdef CONFIG_RTW_80211R ++ u8 *pie = NULL; ++ u32 ft_ie_len = 0; ++ ft_priv *pftpriv = &pmlmepriv->ftpriv; ++#endif ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ goto exit; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ if (is_reassoc == _TRUE) ++ SetFrameSubType(pframe, WIFI_REASSOCREQ); ++ else ++ SetFrameSubType(pframe, WIFI_ASSOCREQ); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ /* caps */ ++ ++#ifdef CONFIG_DFS ++ _rtw_memcpy(&cap, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); ++ cap |= cap_SpecMgmt; ++ _rtw_memcpy(pframe, &cap, 2); ++#else ++ _rtw_memcpy(pframe, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); ++#endif /* CONFIG_DFS */ ++ ++ pframe += 2; ++ pattrib->pktlen += 2; ++ ++ /* listen interval */ ++ /* todo: listen interval for power saving */ ++ val16 = cpu_to_le16(3); ++ _rtw_memcpy(pframe , (unsigned char *)&val16, 2); ++ pframe += 2; ++ pattrib->pktlen += 2; ++ ++ /*Construct Current AP Field for Reassoc-Req only*/ ++ if (is_reassoc == _TRUE) { ++ _rtw_memcpy(pframe, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ pframe += ETH_ALEN; ++ pattrib->pktlen += ETH_ALEN; ++ } ++ ++ /* SSID */ ++ pframe = rtw_set_ie(pframe, _SSID_IE_, pmlmeinfo->network.Ssid.SsidLength, pmlmeinfo->network.Ssid.Ssid, &(pattrib->pktlen)); ++ ++#ifdef CONFIG_DFS ++ /* Dot H */ ++ if (pmlmeext->cur_channel > 14) { ++ pow_cap_ele[0] = 13; /* Minimum transmit power capability */ ++ pow_cap_ele[1] = 21; /* Maximum transmit power capability */ ++ pframe = rtw_set_ie(pframe, EID_PowerCap, 2, pow_cap_ele, &(pattrib->pktlen)); ++ ++ /* supported channels */ ++ do { ++ if (pmlmeext->channel_set[sup_ch_idx].ChannelNum <= 14) { ++ sup_ch[0] = 1; /* First channel number */ ++ sup_ch[1] = pmlmeext->channel_set[sup_ch_idx].ChannelNum; /* Number of channel */ ++ } else { ++ sup_ch[idx_5g++] = pmlmeext->channel_set[sup_ch_idx].ChannelNum; ++ sup_ch[idx_5g++] = 1; ++ } ++ sup_ch_idx++; ++ } while (pmlmeext->channel_set[sup_ch_idx].ChannelNum != 0); ++ pframe = rtw_set_ie(pframe, EID_SupportedChannels, idx_5g, sup_ch, &(pattrib->pktlen)); ++ } ++#endif /* CONFIG_DFS */ ++ ++ /* supported rate & extended supported rate */ ++ ++#if 1 /* Check if the AP's supported rates are also supported by STA. */ ++ get_rate_set(padapter, sta_bssrate, &sta_bssrate_len); ++ /* RTW_INFO("sta_bssrate_len=%d\n", sta_bssrate_len); */ ++ ++ if (pmlmeext->cur_channel == 14) /* for JAPAN, channel 14 can only uses B Mode(CCK) */ ++ sta_bssrate_len = 4; ++ ++ ++ /* for (i = 0; i < sta_bssrate_len; i++) { */ ++ /* RTW_INFO("sta_bssrate[%d]=%02X\n", i, sta_bssrate[i]); */ ++ /* } */ ++ ++ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { ++ if (pmlmeinfo->network.SupportedRates[i] == 0) ++ break; ++ RTW_INFO("network.SupportedRates[%d]=%02X\n", i, pmlmeinfo->network.SupportedRates[i]); ++ } ++ ++ ++ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { ++ if (pmlmeinfo->network.SupportedRates[i] == 0) ++ break; ++ ++ ++ /* Check if the AP's supported rates are also supported by STA. */ ++ for (j = 0; j < sta_bssrate_len; j++) { ++ /* Avoid the proprietary data rate (22Mbps) of Handlink WSG-4000 AP */ ++ if ((pmlmeinfo->network.SupportedRates[i] | IEEE80211_BASIC_RATE_MASK) ++ == (sta_bssrate[j] | IEEE80211_BASIC_RATE_MASK)) { ++ /* RTW_INFO("match i = %d, j=%d\n", i, j); */ ++ break; ++ } else { ++ /* RTW_INFO("not match: %02X != %02X\n", (pmlmeinfo->network.SupportedRates[i]|IEEE80211_BASIC_RATE_MASK), (sta_bssrate[j]|IEEE80211_BASIC_RATE_MASK)); */ ++ } ++ } ++ ++ if (j == sta_bssrate_len) { ++ /* the rate is not supported by STA */ ++ RTW_INFO("%s(): the rate[%d]=%02X is not supported by STA!\n", __FUNCTION__, i, pmlmeinfo->network.SupportedRates[i]); ++ } else { ++ /* the rate is supported by STA */ ++ bssrate[index++] = pmlmeinfo->network.SupportedRates[i]; ++ } ++ } ++ ++ bssrate_len = index; ++ RTW_INFO("bssrate_len = %d\n", bssrate_len); ++ ++#else /* Check if the AP's supported rates are also supported by STA. */ ++#if 0 ++ get_rate_set(padapter, bssrate, &bssrate_len); ++#else ++ for (bssrate_len = 0; bssrate_len < NumRates; bssrate_len++) { ++ if (pmlmeinfo->network.SupportedRates[bssrate_len] == 0) ++ break; ++ ++ if (pmlmeinfo->network.SupportedRates[bssrate_len] == 0x2C) /* Avoid the proprietary data rate (22Mbps) of Handlink WSG-4000 AP */ ++ break; ++ ++ bssrate[bssrate_len] = pmlmeinfo->network.SupportedRates[bssrate_len]; ++ } ++#endif ++#endif /* Check if the AP's supported rates are also supported by STA. */ ++ ++ if ((bssrate_len == 0) && (pmlmeinfo->network.SupportedRates[0] != 0)) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; /* don't connect to AP if no joint supported rate */ ++ } ++ ++ ++ if (bssrate_len > 8) { ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); ++ } else if (bssrate_len > 0) ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); ++ else ++ RTW_INFO("%s: Connect to AP without 11b and 11g data rate!\n", __FUNCTION__); ++ ++ /* vendor specific IE, such as WPA, WMM, WPS */ ++ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pmlmeinfo->network.IELength;) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(pmlmeinfo->network.IEs + i); ++ ++ switch (pIE->ElementID) { ++ case _VENDOR_SPECIFIC_IE_: ++ if ((_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4)) || ++ (_rtw_memcmp(pIE->data, WMM_OUI, 4)) || ++ (_rtw_memcmp(pIE->data, WPS_OUI, 4))) { ++ vs_ie_length = pIE->Length; ++ if ((!padapter->registrypriv.wifi_spec) && (_rtw_memcmp(pIE->data, WPS_OUI, 4))) { ++ /* Commented by Kurt 20110629 */ ++ /* In some older APs, WPS handshake */ ++ /* would be fail if we append vender extensions informations to AP */ ++ ++ vs_ie_length = 14; ++ } ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, vs_ie_length, pIE->data, &(pattrib->pktlen)); ++ } ++ break; ++ ++ case EID_WPA2: ++#ifdef CONFIG_RTW_80211R ++ if ((is_reassoc == _TRUE) && (rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { ++ pie = rtw_get_ie(pftpriv->updated_ft_ies, EID_WPA2, &ft_ie_len, pftpriv->updated_ft_ies_len); ++ if (pie) ++ pframe = rtw_set_ie(pframe, EID_WPA2, ft_ie_len, pie+2, &(pattrib->pktlen)); ++ } else ++#endif ++ pframe = rtw_set_ie(pframe, EID_WPA2, pIE->Length, pIE->data, &(pattrib->pktlen)); ++ break; ++#ifdef CONFIG_80211N_HT ++ case EID_HTCapability: ++ if (padapter->mlmepriv.htpriv.ht_option == _TRUE) { ++ if (!(is_ap_in_tkip(padapter))) { ++ _rtw_memcpy(&(pmlmeinfo->HT_caps), pIE->data, sizeof(struct HT_caps_element)); ++ ++ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info = cpu_to_le16(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info); ++ ++ pframe = rtw_set_ie(pframe, EID_HTCapability, pIE->Length , (u8 *)(&(pmlmeinfo->HT_caps)), &(pattrib->pktlen)); ++ } ++ } ++ break; ++ ++ case EID_EXTCapability: ++ if (padapter->mlmepriv.htpriv.ht_option == _TRUE) ++ pframe = rtw_set_ie(pframe, EID_EXTCapability, pIE->Length, pIE->data, &(pattrib->pktlen)); ++ break; ++#endif /* CONFIG_80211N_HT */ ++#ifdef CONFIG_80211AC_VHT ++ case EID_VHTCapability: ++ if (padapter->mlmepriv.vhtpriv.vht_option == _TRUE) ++ pframe = rtw_set_ie(pframe, EID_VHTCapability, pIE->Length, pIE->data, &(pattrib->pktlen)); ++ break; ++ ++ case EID_OpModeNotification: ++ if (padapter->mlmepriv.vhtpriv.vht_option == _TRUE) ++ pframe = rtw_set_ie(pframe, EID_OpModeNotification, pIE->Length, pIE->data, &(pattrib->pktlen)); ++ break; ++#endif /* CONFIG_80211AC_VHT */ ++ default: ++ break; ++ } ++ ++ i += (pIE->Length + 2); ++ } ++ ++ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK) ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 6 , REALTEK_96B_IE, &(pattrib->pktlen)); ++ ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ rtw_build_assoc_req_wapi_ie(padapter, pframe, pattrib); ++#endif ++ ++ ++#ifdef CONFIG_P2P ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) { ++ if (pmlmepriv->p2p_assoc_req_ie && pmlmepriv->p2p_assoc_req_ie_len > 0) { ++ _rtw_memcpy(pframe, pmlmepriv->p2p_assoc_req_ie, pmlmepriv->p2p_assoc_req_ie_len); ++ pframe += pmlmepriv->p2p_assoc_req_ie_len; ++ pattrib->pktlen += pmlmepriv->p2p_assoc_req_ie_len; ++ } ++ } else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ { ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) { ++ /* Should add the P2P IE in the association request frame. */ ++ /* P2P OUI */ ++ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* Commented by Albert 20101109 */ ++ /* According to the P2P Specification, the association request frame should contain 3 P2P attributes */ ++ /* 1. P2P Capability */ ++ /* 2. Extended Listen Timing */ ++ /* 3. Device Info */ ++ /* Commented by Albert 20110516 */ ++ /* 4. P2P Interface */ ++ ++ /* P2P Capability */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Device Capability Bitmap, 1 byte */ ++ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; ++ ++ /* Group Capability Bitmap, 1 byte */ ++ if (pwdinfo->persistent_supported) ++ p2pie[p2pielen++] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; ++ else ++ p2pie[p2pielen++] = DMP_P2P_GRPCAP_SUPPORT; ++ ++ /* Extended Listen Timing */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_EX_LISTEN_TIMING; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0004); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Availability Period */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0xFFFF); ++ p2pielen += 2; ++ ++ /* Availability Interval */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0xFFFF); ++ p2pielen += 2; ++ ++ /* Device Info */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ ++ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(21 + pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* P2P Device Address */ ++ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ /* Config Method */ ++ /* This field should be big endian. Noted by P2P specification. */ ++ if ((pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PEER_DISPLAY_PIN) || ++ (pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_SELF_DISPLAY_PIN)) ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_CONFIG_METHOD_DISPLAY); ++ else ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_CONFIG_METHOD_PBC); ++ ++ p2pielen += 2; ++ ++ /* Primary Device Type */ ++ /* Category ID */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); ++ p2pielen += 2; ++ ++ /* OUI */ ++ *(u32 *)(p2pie + p2pielen) = cpu_to_be32(WPSOUI); ++ p2pielen += 4; ++ ++ /* Sub Category ID */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); ++ p2pielen += 2; ++ ++ /* Number of Secondary Device Types */ ++ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ ++ ++ /* Device Name */ ++ /* Type: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); ++ p2pielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len); ++ p2pielen += pwdinfo->device_name_len; ++ ++ /* P2P Interface */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_INTERFACE; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x000D); ++ p2pielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN); /* P2P Device Address */ ++ p2pielen += ETH_ALEN; ++ ++ p2pie[p2pielen++] = 1; /* P2P Interface Address Count */ ++ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN); /* P2P Interface Address List */ ++ p2pielen += ETH_ALEN; ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); ++ } ++ } ++ ++#endif /* CONFIG_P2P */ ++ ++#ifdef CONFIG_WFD ++ wfdielen = rtw_append_assoc_req_wfd_ie(padapter, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++#endif ++#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE ++ pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_ASSOCREQ_VENDOR_IE_BIT); ++#endif ++#ifdef CONFIG_RTW_80211R ++ if (rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { ++ u8 mdieval[3] = {0}; ++ ++ _rtw_memcpy(mdieval, &(pftpriv->mdid), 2); ++ mdieval[2] = pftpriv->ft_cap; ++ pframe = rtw_set_ie(pframe, _MDIE_, 3, mdieval, &(pattrib->pktlen)); ++ } ++ ++ if (is_reassoc == _TRUE) { ++ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { ++ u8 is_ft_roaming_with_rsn_ie = _TRUE; ++ ++ pie = rtw_get_ie(pftpriv->updated_ft_ies, EID_WPA2, &ft_ie_len, pftpriv->updated_ft_ies_len); ++ if (!pie) ++ is_ft_roaming_with_rsn_ie = _FALSE; ++ ++ pie = rtw_get_ie(pftpriv->updated_ft_ies, _FTIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); ++ if (pie && is_ft_roaming_with_rsn_ie) ++ pframe = rtw_set_ie(pframe, _FTIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); ++ } ++ } ++#endif ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ dump_mgntframe(padapter, pmgntframe); ++ ++ ret = _SUCCESS; ++ ++exit: ++ if (ret == _SUCCESS) ++ rtw_buf_update(&pmlmepriv->assoc_req, &pmlmepriv->assoc_req_len, (u8 *)pwlanhdr, pattrib->pktlen); ++ else ++ rtw_buf_free(&pmlmepriv->assoc_req, &pmlmepriv->assoc_req_len); ++ ++ return; ++} ++ ++void issue_assocreq(_adapter *padapter) ++{ ++ _issue_assocreq(padapter, _FALSE); ++} ++ ++void issue_reassocreq(_adapter *padapter) ++{ ++ _issue_assocreq(padapter, _TRUE); ++} ++ ++/* when wait_ack is ture, this function shoule be called at process context */ ++static int _issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int wait_ack) ++{ ++ int ret = _FAIL; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv; ++ struct mlme_ext_priv *pmlmeext; ++ struct mlme_ext_info *pmlmeinfo; ++ ++ /* RTW_INFO("%s:%d\n", __FUNCTION__, power_mode); */ ++ ++ if (!padapter) ++ goto exit; ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ goto exit; ++ ++ pxmitpriv = &(padapter->xmitpriv); ++ pmlmeext = &(padapter->mlmeextpriv); ++ pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ pattrib->retry_ctrl = _FALSE; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) ++ SetFrDs(fctrl); ++ else if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) ++ SetToDs(fctrl); ++ ++ if (power_mode) ++ SetPwrMgt(fctrl); ++ ++ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_DATA_NULL); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ if (wait_ack) ++ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); ++ else { ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ } ++ ++exit: ++ return ret; ++} ++ ++/* ++ * [IMPORTANT] Don't call this function in interrupt context ++ * ++ * When wait_ms > 0, this function should be called at process context ++ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT ++ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX ++ * try_cnt means the maximal TX count to try ++ * da == NULL for station mode ++ */ ++int issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) ++{ ++ int ret = _FAIL; ++ int i = 0; ++ u32 start = rtw_get_current_time(); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct sta_info *psta; ++ u8 macid_sleep_reg_access = _TRUE; ++ ++#ifdef CONFIG_MCC_MODE ++ if (MCC_EN(padapter)) { ++ /* driver doesn't access macid sleep reg under MCC */ ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { ++ macid_sleep_reg_access = _FALSE; ++ ++ if (da == NULL) { ++ RTW_INFO("Warning: Do not tx null data to AP under MCC mode\n"); ++ rtw_warn_on(1); ++ } ++ ++ } ++ } ++#endif ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ goto exit; ++ ++ /* da == NULL, assum it's null data for sta to ap*/ ++ if (da == NULL) ++ da = get_my_bssid(&(pmlmeinfo->network)); ++ ++ psta = rtw_get_stainfo(&padapter->stapriv, da); ++ if (psta) { ++ if (macid_sleep_reg_access) { ++ if (power_mode) ++ rtw_hal_macid_sleep(padapter, psta->mac_id); ++ else ++ rtw_hal_macid_wakeup(padapter, psta->mac_id); ++ } ++ } else { ++ RTW_INFO(FUNC_ADPT_FMT ": Can't find sta info for " MAC_FMT ", skip macid %s!!\n", ++ FUNC_ADPT_ARG(padapter), MAC_ARG(da), power_mode ? "sleep" : "wakeup"); ++ rtw_warn_on(1); ++ } ++ ++ do { ++ ret = _issue_nulldata(padapter, da, power_mode, wait_ms > 0 ? _TRUE : _FALSE); ++ ++ i++; ++ ++ if (RTW_CANNOT_RUN(padapter)) ++ break; ++ ++ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) ++ rtw_msleep_os(wait_ms); ++ ++ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); ++ ++ if (ret != _FAIL) { ++ ret = _SUCCESS; ++#ifndef DBG_XMIT_ACK ++ goto exit; ++#endif ++ } ++ ++ if (try_cnt && wait_ms) { ++ if (da) ++ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ else ++ RTW_INFO(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ } ++exit: ++ return ret; ++} ++ ++/* ++ * [IMPORTANT] This function run in interrupt context ++ * ++ * The null data packet would be sent without power bit, ++ * and not guarantee success. ++ */ ++s32 issue_nulldata_in_interrupt(PADAPTER padapter, u8 *da, unsigned int power_mode) ++{ ++ int ret; ++ struct mlme_ext_priv *pmlmeext; ++ struct mlme_ext_info *pmlmeinfo; ++ ++ ++ pmlmeext = &padapter->mlmeextpriv; ++ pmlmeinfo = &pmlmeext->mlmext_info; ++ ++ /* da == NULL, assum it's null data for sta to ap*/ ++ if (da == NULL) ++ da = get_my_bssid(&(pmlmeinfo->network)); ++ ++ ret = _issue_nulldata(padapter, da, power_mode, _FALSE); ++ ++ return ret; ++} ++ ++/* when wait_ack is ture, this function shoule be called at process context */ ++static int _issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int wait_ack) ++{ ++ int ret = _FAIL; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl, *qc; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ goto exit; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ pattrib->hdrlen += 2; ++ pattrib->qos_en = _TRUE; ++ pattrib->eosp = 1; ++ pattrib->ack_policy = 0; ++ pattrib->mdata = 0; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) ++ SetFrDs(fctrl); ++ else if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) ++ SetToDs(fctrl); ++ ++ if (pattrib->mdata) ++ SetMData(fctrl); ++ ++ qc = (unsigned short *)(pframe + pattrib->hdrlen - 2); ++ ++ SetPriority(qc, tid); ++ ++ SetEOSP(qc, pattrib->eosp); ++ ++ SetAckpolicy(qc, pattrib->ack_policy); ++ ++ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr_qos); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ if (wait_ack) ++ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); ++ else { ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ } ++ ++exit: ++ return ret; ++} ++ ++/* ++ * when wait_ms >0 , this function should be called at process context ++ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT ++ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX ++ * try_cnt means the maximal TX count to try ++ * da == NULL for station mode ++ */ ++int issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int try_cnt, int wait_ms) ++{ ++ int ret = _FAIL; ++ int i = 0; ++ u32 start = rtw_get_current_time(); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ goto exit; ++ ++ /* da == NULL, assum it's null data for sta to ap*/ ++ if (da == NULL) ++ da = get_my_bssid(&(pmlmeinfo->network)); ++ ++ do { ++ ret = _issue_qos_nulldata(padapter, da, tid, wait_ms > 0 ? _TRUE : _FALSE); ++ ++ i++; ++ ++ if (RTW_CANNOT_RUN(padapter)) ++ break; ++ ++ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) ++ rtw_msleep_os(wait_ms); ++ ++ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); ++ ++ if (ret != _FAIL) { ++ ret = _SUCCESS; ++#ifndef DBG_XMIT_ACK ++ goto exit; ++#endif ++ } ++ ++ if (try_cnt && wait_ms) { ++ if (da) ++ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ else ++ RTW_INFO(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ } ++exit: ++ return ret; ++} ++ ++static int _issue_deauth(_adapter *padapter, unsigned char *da, unsigned short reason, u8 wait_ack, u8 key_type) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ int ret = _FAIL; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif /* CONFIG_P2P */ ++ ++ /* RTW_INFO("%s to "MAC_FMT"\n", __func__, MAC_ARG(da)); */ ++ ++#ifdef CONFIG_P2P ++ if (!(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) && (pwdinfo->rx_invitereq_info.scan_op_ch_only)) { ++ _cancel_timer_ex(&pwdinfo->reset_ch_sitesurvey); ++ _set_timer(&pwdinfo->reset_ch_sitesurvey, 10); ++ } ++#endif /* CONFIG_P2P */ ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ goto exit; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ pattrib->retry_ctrl = _FALSE; ++ pattrib->key_type = key_type; ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_DEAUTH); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ reason = cpu_to_le16(reason); ++ pframe = rtw_set_fixed_ie(pframe, _RSON_CODE_ , (unsigned char *)&reason, &(pattrib->pktlen)); ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ ++ if (wait_ack) ++ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); ++ else { ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ } ++ ++exit: ++ return ret; ++} ++ ++int issue_deauth(_adapter *padapter, unsigned char *da, unsigned short reason) ++{ ++ RTW_INFO("%s to "MAC_FMT"\n", __func__, MAC_ARG(da)); ++ return _issue_deauth(padapter, da, reason, _FALSE, IEEE80211W_RIGHT_KEY); ++} ++ ++#ifdef CONFIG_IEEE80211W ++int issue_deauth_11w(_adapter *padapter, unsigned char *da, unsigned short reason, u8 key_type) ++{ ++ RTW_INFO("%s to "MAC_FMT"\n", __func__, MAC_ARG(da)); ++ return _issue_deauth(padapter, da, reason, _FALSE, key_type); ++} ++#endif /* CONFIG_IEEE80211W */ ++ ++/* ++ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT ++ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX ++ * try_cnt means the maximal TX count to try ++ */ ++int issue_deauth_ex(_adapter *padapter, u8 *da, unsigned short reason, int try_cnt, ++ int wait_ms) ++{ ++ int ret = _FAIL; ++ int i = 0; ++ u32 start = rtw_get_current_time(); ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ goto exit; ++ ++ do { ++ ret = _issue_deauth(padapter, da, reason, wait_ms > 0 ? _TRUE : _FALSE, IEEE80211W_RIGHT_KEY); ++ ++ i++; ++ ++ if (RTW_CANNOT_RUN(padapter)) ++ break; ++ ++ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) ++ rtw_msleep_os(wait_ms); ++ ++ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); ++ ++ if (ret != _FAIL) { ++ ret = _SUCCESS; ++#ifndef DBG_XMIT_ACK ++ goto exit; ++#endif ++ } ++ ++ if (try_cnt && wait_ms) { ++ if (da) ++ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ else ++ RTW_INFO(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ } ++exit: ++ return ret; ++} ++ ++void issue_action_spct_ch_switch(_adapter *padapter, u8 *ra, u8 new_ch, u8 ch_offset) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ return; ++ ++ RTW_INFO(FUNC_NDEV_FMT" ra="MAC_FMT", ch:%u, offset:%u\n", ++ FUNC_NDEV_ARG(padapter->pnetdev), MAC_ARG(ra), new_ch, ch_offset); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); /* RA */ ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); /* TA */ ++ _rtw_memcpy(pwlanhdr->addr3, ra, ETH_ALEN); /* DA = RA */ ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ /* category, action */ ++ { ++ u8 category, action; ++ category = RTW_WLAN_CATEGORY_SPECTRUM_MGMT; ++ action = RTW_WLAN_ACTION_SPCT_CHL_SWITCH; ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ } ++ ++ pframe = rtw_set_ie_ch_switch(pframe, &(pattrib->pktlen), 0, new_ch, 0); ++ pframe = rtw_set_ie_secondary_ch_offset(pframe, &(pattrib->pktlen), ++ hal_ch_offset_to_secondary_ch_offset(ch_offset)); ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++} ++ ++#ifdef CONFIG_IEEE80211W ++void issue_action_SA_Query(_adapter *padapter, unsigned char *raddr, unsigned char action, unsigned short tid, u8 key_type) ++{ ++ u8 category = RTW_WLAN_CATEGORY_SA_QUERY; ++ u16 reason_code; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ u8 *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u16 *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ return; ++ ++ RTW_INFO("%s, %04x\n", __FUNCTION__, tid); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) { ++ RTW_INFO("%s: alloc_mgtxmitframe fail\n", __FUNCTION__); ++ return; ++ } ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ pattrib->key_type = key_type; ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ if (raddr) ++ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); ++ else ++ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &category, &pattrib->pktlen); ++ pframe = rtw_set_fixed_ie(pframe, 1, &action, &pattrib->pktlen); ++ ++ switch (action) { ++ case 0: /* SA Query req */ ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)&pmlmeext->sa_query_seq, &pattrib->pktlen); ++ pmlmeext->sa_query_seq++; ++ /* send sa query request to AP, AP should reply sa query response in 1 second */ ++ if (pattrib->key_type == IEEE80211W_RIGHT_KEY) { ++ psta = rtw_get_stainfo(pstapriv, raddr); ++ if (psta != NULL) { ++ /* RTW_INFO("%s, %d, set dot11w_expire_timer\n", __func__, __LINE__); */ ++ _set_timer(&psta->dot11w_expire_timer, 1000); ++ } ++ } ++ break; ++ ++ case 1: /* SA Query rsp */ ++ tid = cpu_to_le16(tid); ++ /* RTW_INFO("rtw_set_fixed_ie, %04x\n", tid); */ ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)&tid, &pattrib->pktlen); ++ break; ++ default: ++ break; ++ } ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++} ++#endif /* CONFIG_IEEE80211W */ ++ ++/** ++ * issue_action_ba - internal function to TX Block Ack action frame ++ * @padapter: the adapter to TX ++ * @raddr: receiver address ++ * @action: Block Ack Action ++ * @tid: tid ++ * @size: the announced AMPDU buffer size. used by ADDBA_RESP ++ * @status: status/reason code. used by ADDBA_RESP, DELBA ++ * @initiator: if we are the initiator of AMPDU association. used by DELBA ++ * @wait_ack: used xmit ack ++ * ++ * Returns: ++ * _SUCCESS: No xmit ack is used or acked ++ * _FAIL: not acked when using xmit ack ++ */ ++static int issue_action_ba(_adapter *padapter, unsigned char *raddr, unsigned char action ++ , u8 tid, u8 size, u16 status, u8 initiator, int wait_ack) ++{ ++ int ret = _FAIL; ++ u8 category = RTW_WLAN_CATEGORY_BACK; ++ u16 start_seq; ++ u16 BA_para_set; ++ u16 BA_timeout_value; ++ u16 BA_starting_seqctrl; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ u8 *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u16 *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ ++#ifdef CONFIG_80211N_HT ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ goto exit; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ /* _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); */ ++ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ ++ if (category == 3) { ++ switch (action) { ++ case RTW_WLAN_ACTION_ADDBA_REQ: ++ do { ++ pmlmeinfo->dialogToken++; ++ } while (pmlmeinfo->dialogToken == 0); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(pmlmeinfo->dialogToken), &(pattrib->pktlen)); ++ ++#if defined(CONFIG_RTL8188E) && defined(CONFIG_SDIO_HCI) ++ BA_para_set = (0x0802 | ((tid & 0xf) << 2)); /* immediate ack & 16 buffer size */ ++#else ++ BA_para_set = (0x1002 | ((tid & 0xf) << 2)); /* immediate ack & 64 buffer size */ ++#endif ++ ++ BA_para_set = cpu_to_le16(BA_para_set); ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_para_set)), &(pattrib->pktlen)); ++ ++ /* BA_timeout_value = 0xffff; */ /* max: 65535 TUs(~ 65 ms) */ ++ BA_timeout_value = 5000;/* ~ 5ms */ ++ BA_timeout_value = cpu_to_le16(BA_timeout_value); ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_timeout_value)), &(pattrib->pktlen)); ++ ++ /* if ((psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress)) != NULL) */ ++ psta = rtw_get_stainfo(pstapriv, raddr); ++ if (psta != NULL) { ++ start_seq = (psta->sta_xmitpriv.txseq_tid[tid & 0x07] & 0xfff) + 1; ++ ++ RTW_INFO("BA_starting_seqctrl = %d for TID=%d\n", start_seq, tid & 0x07); ++ ++ psta->BA_starting_seqctrl[tid & 0x07] = start_seq; ++ ++ BA_starting_seqctrl = start_seq << 4; ++ } ++ ++ BA_starting_seqctrl = cpu_to_le16(BA_starting_seqctrl); ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_starting_seqctrl)), &(pattrib->pktlen)); ++ break; ++ ++ case RTW_WLAN_ACTION_ADDBA_RESP: ++ pframe = rtw_set_fixed_ie(pframe, 1, &(pmlmeinfo->ADDBA_req.dialog_token), &(pattrib->pktlen)); ++ status = cpu_to_le16(status); ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&status), &(pattrib->pktlen)); ++ ++ BA_para_set = le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set); ++ ++ BA_para_set &= ~IEEE80211_ADDBA_PARAM_TID_MASK; ++ BA_para_set |= (tid << 2) & IEEE80211_ADDBA_PARAM_TID_MASK; ++ ++ BA_para_set &= ~RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; ++ BA_para_set |= (size << 6) & RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; ++ ++ if (!padapter->registrypriv.wifi_spec) { ++ if (pregpriv->ampdu_amsdu == 0) /* disabled */ ++ BA_para_set &= ~BIT(0); ++ else if (pregpriv->ampdu_amsdu == 1) /* enabled */ ++ BA_para_set |= BIT(0); ++ } ++ ++ BA_para_set = cpu_to_le16(BA_para_set); ++ ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_para_set)), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(pmlmeinfo->ADDBA_req.BA_timeout_value)), &(pattrib->pktlen)); ++ break; ++ ++ case RTW_WLAN_ACTION_DELBA: ++ BA_para_set = 0; ++ BA_para_set |= (tid << 12) & IEEE80211_DELBA_PARAM_TID_MASK; ++ BA_para_set |= (initiator << 11) & IEEE80211_DELBA_PARAM_INITIATOR_MASK; ++ ++ BA_para_set = cpu_to_le16(BA_para_set); ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_para_set)), &(pattrib->pktlen)); ++ status = cpu_to_le16(status); ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(status)), &(pattrib->pktlen)); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ if (wait_ack) ++ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); ++ else { ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ } ++ ++exit: ++#endif /* CONFIG_80211N_HT */ ++ return ret; ++} ++ ++/** ++ * issue_addba_req - TX ADDBA_REQ ++ * @adapter: the adapter to TX ++ * @ra: receiver address ++ * @tid: tid ++ */ ++inline void issue_addba_req(_adapter *adapter, unsigned char *ra, u8 tid) ++{ ++ issue_action_ba(adapter, ra, RTW_WLAN_ACTION_ADDBA_REQ ++ , tid ++ , 0 /* unused */ ++ , 0 /* unused */ ++ , 0 /* unused */ ++ , _FALSE ++ ); ++ RTW_INFO(FUNC_ADPT_FMT" ra="MAC_FMT" tid=%u\n" ++ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), tid); ++ ++} ++ ++/** ++ * issue_addba_rsp - TX ADDBA_RESP ++ * @adapter: the adapter to TX ++ * @ra: receiver address ++ * @tid: tid ++ * @status: status code ++ * @size: the announced AMPDU buffer size ++ */ ++inline void issue_addba_rsp(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u8 size) ++{ ++ issue_action_ba(adapter, ra, RTW_WLAN_ACTION_ADDBA_RESP ++ , tid ++ , size ++ , status ++ , 0 /* unused */ ++ , _FALSE ++ ); ++ RTW_INFO(FUNC_ADPT_FMT" ra="MAC_FMT" status=%u, tid=%u, size=%u\n" ++ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), status, tid, size); ++} ++ ++/** ++ * issue_addba_rsp_wait_ack - TX ADDBA_RESP and wait ack ++ * @adapter: the adapter to TX ++ * @ra: receiver address ++ * @tid: tid ++ * @status: status code ++ * @size: the announced AMPDU buffer size ++ * @try_cnt: the maximal TX count to try ++ * @wait_ms: == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT ++ * > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX ++ */ ++inline u8 issue_addba_rsp_wait_ack(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u8 size, int try_cnt, int wait_ms) ++{ ++ int ret = _FAIL; ++ int i = 0; ++ u32 start = rtw_get_current_time(); ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(adapter))) ++ goto exit; ++ ++ do { ++ ret = issue_action_ba(adapter, ra, RTW_WLAN_ACTION_ADDBA_RESP ++ , tid ++ , size ++ , status ++ , 0 /* unused */ ++ , _TRUE ++ ); ++ ++ i++; ++ ++ if (RTW_CANNOT_RUN(adapter)) ++ break; ++ ++ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) ++ rtw_msleep_os(wait_ms); ++ ++ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); ++ ++ if (ret != _FAIL) { ++ ret = _SUCCESS; ++#ifndef DBG_XMIT_ACK ++ /* goto exit; */ ++#endif ++ } ++ ++ if (try_cnt && wait_ms) { ++ RTW_INFO(FUNC_ADPT_FMT" ra="MAC_FMT" tid=%u%s, %d/%d in %u ms\n" ++ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), tid ++ , ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ } ++ ++exit: ++ return ret; ++} ++ ++/** ++ * issue_del_ba - TX DELBA ++ * @adapter: the adapter to TX ++ * @ra: receiver address ++ * @tid: tid ++ * @reason: reason code ++ * @initiator: if we are the initiator of AMPDU association. used by DELBA ++ */ ++inline void issue_del_ba(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator) ++{ ++ issue_action_ba(adapter, ra, RTW_WLAN_ACTION_DELBA ++ , tid ++ , 0 /* unused */ ++ , reason ++ , initiator ++ , _FALSE ++ ); ++ RTW_INFO(FUNC_ADPT_FMT" ra="MAC_FMT" reason=%u, tid=%u, initiator=%u\n" ++ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), reason, tid, initiator); ++} ++ ++/** ++ * issue_del_ba_ex - TX DELBA with xmit ack options ++ * @adapter: the adapter to TX ++ * @ra: receiver address ++ * @tid: tid ++ * @reason: reason code ++ * @initiator: if we are the initiator of AMPDU association. used by DELBA ++ * @try_cnt: the maximal TX count to try ++ * @wait_ms: == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT ++ * > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX ++ */ ++int issue_del_ba_ex(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator ++ , int try_cnt, int wait_ms) ++{ ++ int ret = _FAIL; ++ int i = 0; ++ u32 start = rtw_get_current_time(); ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(adapter))) ++ goto exit; ++ ++ do { ++ ret = issue_action_ba(adapter, ra, RTW_WLAN_ACTION_DELBA ++ , tid ++ , 0 /* unused */ ++ , reason ++ , initiator ++ , wait_ms > 0 ? _TRUE : _FALSE ++ ); ++ ++ i++; ++ ++ if (RTW_CANNOT_RUN(adapter)) ++ break; ++ ++ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) ++ rtw_msleep_os(wait_ms); ++ ++ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); ++ ++ if (ret != _FAIL) { ++ ret = _SUCCESS; ++#ifndef DBG_XMIT_ACK ++ /* goto exit; */ ++#endif ++ } ++ ++ if (try_cnt && wait_ms) { ++ RTW_INFO(FUNC_ADPT_FMT" ra="MAC_FMT" reason=%u, tid=%u, initiator=%u%s, %d/%d in %u ms\n" ++ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), reason, tid, initiator ++ , ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ } ++exit: ++ return ret; ++} ++ ++static void issue_action_BSSCoexistPacket(_adapter *padapter) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ unsigned char category, action; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct wlan_network *pnetwork = NULL; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ u8 InfoContent[16] = {0}; ++ u8 ICS[8][15]; ++#ifdef CONFIG_80211N_HT ++ if ((pmlmepriv->num_FortyMHzIntolerant == 0) || (pmlmepriv->num_sta_no_ht == 0)) ++ return; ++ ++ if (_TRUE == pmlmeinfo->bwmode_updated) ++ return; ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ return; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ ++ category = RTW_WLAN_CATEGORY_PUBLIC; ++ action = ACT_PUBLIC_BSSCOEXIST; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ ++ ++ /* */ ++ if (pmlmepriv->num_FortyMHzIntolerant > 0) { ++ u8 iedata = 0; ++ ++ iedata |= BIT(2);/* 20 MHz BSS Width Request */ ++ ++ pframe = rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); ++ ++ } ++ ++ ++ /* */ ++ _rtw_memset(ICS, 0, sizeof(ICS)); ++ if (pmlmepriv->num_sta_no_ht > 0) { ++ int i; ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ int len; ++ u8 *p; ++ WLAN_BSSID_EX *pbss_network; ++ ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ ++ plist = get_next(plist); ++ ++ pbss_network = (WLAN_BSSID_EX *)&pnetwork->network; ++ ++ p = rtw_get_ie(pbss_network->IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, pbss_network->IELength - _FIXED_IE_LENGTH_); ++ if ((p == NULL) || (len == 0)) { /* non-HT */ ++ if ((pbss_network->Configuration.DSConfig <= 0) || (pbss_network->Configuration.DSConfig > 14)) ++ continue; ++ ++ ICS[0][pbss_network->Configuration.DSConfig] = 1; ++ ++ if (ICS[0][0] == 0) ++ ICS[0][0] = 1; ++ } ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ ++ for (i = 0; i < 8; i++) { ++ if (ICS[i][0] == 1) { ++ int j, k = 0; ++ ++ InfoContent[k] = i; ++ /* SET_BSS_INTOLERANT_ELE_REG_CLASS(InfoContent,i); */ ++ k++; ++ ++ for (j = 1; j <= 14; j++) { ++ if (ICS[i][j] == 1) { ++ if (k < 16) { ++ InfoContent[k] = j; /* channel number */ ++ /* SET_BSS_INTOLERANT_ELE_CHANNEL(InfoContent+k, j); */ ++ k++; ++ } ++ } ++ } ++ ++ pframe = rtw_set_ie(pframe, EID_BSSIntolerantChlReport, k, InfoContent, &(pattrib->pktlen)); ++ ++ } ++ ++ } ++ ++ ++ } ++ ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++#endif /* CONFIG_80211N_HT */ ++} ++ ++/* Spatial Multiplexing Powersave (SMPS) action frame */ ++int _issue_action_SM_PS(_adapter *padapter , unsigned char *raddr , u8 NewMimoPsMode , u8 wait_ack) ++{ ++ ++ int ret = _FAIL; ++ unsigned char category = RTW_WLAN_CATEGORY_HT; ++ u8 action = RTW_WLAN_ACTION_HT_SM_PS; ++ u8 sm_power_control = 0; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ ++ if (NewMimoPsMode == WLAN_HT_CAP_SM_PS_DISABLED) { ++ sm_power_control = sm_power_control & ~(BIT(0)); /* SM Power Save Enable = 0 SM Power Save Disable */ ++ } else if (NewMimoPsMode == WLAN_HT_CAP_SM_PS_STATIC) { ++ sm_power_control = sm_power_control | BIT(0); /* SM Power Save Enable = 1 SM Power Save Enable */ ++ sm_power_control = sm_power_control & ~(BIT(1)); /* SM Mode = 0 Static Mode */ ++ } else if (NewMimoPsMode == WLAN_HT_CAP_SM_PS_DYNAMIC) { ++ sm_power_control = sm_power_control | BIT(0); /* SM Power Save Enable = 1 SM Power Save Enable */ ++ sm_power_control = sm_power_control | BIT(1); /* SM Mode = 1 Dynamic Mode */ ++ } else ++ return ret; ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ return ret; ++ ++ RTW_INFO("%s, sm_power_control=%u, NewMimoPsMode=%u\n", __FUNCTION__ , sm_power_control , NewMimoPsMode); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return ret; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); /* RA */ ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); /* TA */ ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); /* DA = RA */ ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ /* category, action */ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(sm_power_control), &(pattrib->pktlen)); ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ if (wait_ack) ++ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); ++ else { ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ } ++ ++ if (ret != _SUCCESS) ++ RTW_INFO("%s, ack to\n", __func__); ++ ++ return ret; ++} ++ ++/* ++ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT ++ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX ++ * try_cnt means the maximal TX count to try ++ */ ++int issue_action_SM_PS_wait_ack(_adapter *padapter, unsigned char *raddr, u8 NewMimoPsMode, int try_cnt, int wait_ms) ++{ ++ int ret = _FAIL; ++ int i = 0; ++ u32 start = rtw_get_current_time(); ++ ++ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) ++ goto exit; ++ ++ do { ++ ret = _issue_action_SM_PS(padapter, raddr, NewMimoPsMode , wait_ms > 0 ? _TRUE : _FALSE); ++ ++ i++; ++ ++ if (RTW_CANNOT_RUN(padapter)) ++ break; ++ ++ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) ++ rtw_msleep_os(wait_ms); ++ ++ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); ++ ++ if (ret != _FAIL) { ++ ret = _SUCCESS; ++#ifndef DBG_XMIT_ACK ++ goto exit; ++#endif ++ } ++ ++ if (try_cnt && wait_ms) { ++ if (raddr) ++ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", %s , %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(padapter), MAC_ARG(raddr), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ else ++ RTW_INFO(FUNC_ADPT_FMT", %s , %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(padapter), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ } ++exit: ++ ++ return ret; ++} ++ ++int issue_action_SM_PS(_adapter *padapter , unsigned char *raddr , u8 NewMimoPsMode) ++{ ++ RTW_INFO("%s to "MAC_FMT"\n", __func__, MAC_ARG(raddr)); ++ return _issue_action_SM_PS(padapter, raddr, NewMimoPsMode , _FALSE); ++} ++ ++/** ++ * _send_delba_sta_tid - Cancel the AMPDU association for the specific @sta, @tid ++ * @adapter: the adapter to which @sta belongs ++ * @initiator: if we are the initiator of AMPDU association ++ * @sta: the sta to be checked ++ * @tid: the tid to be checked ++ * @force: cancel and send DELBA even when no AMPDU association is setup ++ * @wait_ack: send delba with xmit ack (valid when initiator == 0) ++ * ++ * Returns: ++ * _FAIL if sta is NULL ++ * when initiator is 1, always _SUCCESS ++ * when initiator is 0, _SUCCESS if DELBA is acked ++ */ ++static unsigned int _send_delba_sta_tid(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid ++ , u8 force, int wait_ack) ++{ ++ int ret = _SUCCESS; ++ ++ if (sta == NULL) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ if (initiator == 0) { ++ /* recipient */ ++ if (force || sta->recvreorder_ctrl[tid].enable == _TRUE) { ++ u8 ampdu_size_bak = sta->recvreorder_ctrl[tid].ampdu_size; ++ ++ sta->recvreorder_ctrl[tid].enable = _FALSE; ++ sta->recvreorder_ctrl[tid].ampdu_size = RX_AMPDU_SIZE_INVALID; ++ ++ if (rtw_del_rx_ampdu_test_trigger_no_tx_fail()) ++ ret = _FAIL; ++ else if (wait_ack) ++ ret = issue_del_ba_ex(adapter, sta->hwaddr, tid, 37, initiator, 3, 1); ++ else ++ issue_del_ba(adapter, sta->hwaddr, tid, 37, initiator); ++ ++ if (ret == _FAIL && sta->recvreorder_ctrl[tid].enable == _FALSE) ++ sta->recvreorder_ctrl[tid].ampdu_size = ampdu_size_bak; ++ } ++ } else if (initiator == 1) { ++ /* originator */ ++#ifdef CONFIG_80211N_HT ++ if (force || sta->htpriv.agg_enable_bitmap & BIT(tid)) { ++ sta->htpriv.agg_enable_bitmap &= ~BIT(tid); ++ sta->htpriv.candidate_tid_bitmap &= ~BIT(tid); ++ issue_del_ba(adapter, sta->hwaddr, tid, 37, initiator); ++ } ++#endif ++ } ++ ++exit: ++ return ret; ++} ++ ++inline unsigned int send_delba_sta_tid(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid ++ , u8 force) ++{ ++ return _send_delba_sta_tid(adapter, initiator, sta, tid, force, 0); ++} ++ ++inline unsigned int send_delba_sta_tid_wait_ack(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid ++ , u8 force) ++{ ++ return _send_delba_sta_tid(adapter, initiator, sta, tid, force, 1); ++} ++ ++unsigned int send_delba(_adapter *padapter, u8 initiator, u8 *addr) ++{ ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta = NULL; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u16 tid; ++ ++ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) ++ if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) ++ return _SUCCESS; ++ ++ psta = rtw_get_stainfo(pstapriv, addr); ++ if (psta == NULL) ++ return _SUCCESS; ++ ++#if 0 ++ RTW_INFO("%s:%s\n", __func__, (initiator == 0) ? "RX_DIR" : "TX_DIR"); ++ if (initiator == 1) /* originator */ ++ RTW_INFO("tx agg_enable_bitmap(0x%08x)\n", psta->htpriv.agg_enable_bitmap); ++#endif ++ ++ for (tid = 0; tid < TID_NUM; tid++) ++ send_delba_sta_tid(padapter, initiator, psta, tid, 0); ++ ++ return _SUCCESS; ++} ++ ++unsigned int send_beacon(_adapter *padapter) ++{ ++ u8 bxmitok = _FALSE; ++ int issue = 0; ++ int poll = 0; ++#ifdef CONFIG_AP_MODE ++#if defined(CONFIG_PCI_HCI) && defined(RTL8814AE_SW_BCN) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); ++ ++ /* 8192EE Port select for Beacon DL */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); ++ ++ issue_beacon(padapter, 0); ++ ++#ifdef RTL8814AE_SW_BCN ++ if (pHalData->bCorrectBCN != 0) ++ RTW_INFO("%s, line%d, Warnning, pHalData->bCorrectBCN != 0\n", __func__, __LINE__); ++ pHalData->bCorrectBCN = 1; ++#endif ++ ++ return _SUCCESS; ++#endif ++ ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ u32 start = rtw_get_current_time(); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); ++ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); ++ do { ++ issue_beacon(padapter, 100); ++ issue++; ++ do { ++ rtw_yield_os(); ++ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8 *)(&bxmitok)); ++ poll++; ++ } while ((poll % 10) != 0 && _FALSE == bxmitok && !RTW_CANNOT_RUN(padapter)); ++ ++ } while (_FALSE == bxmitok && issue < 100 && !RTW_CANNOT_RUN(padapter)); ++ ++ if (RTW_CANNOT_RUN(padapter)) ++ return _FAIL; ++ ++ ++ if (_FALSE == bxmitok) { ++ RTW_INFO("%s fail! %u ms\n", __FUNCTION__, rtw_get_passing_time_ms(start)); ++ return _FAIL; ++ } else { ++ u32 passing_time = rtw_get_passing_time_ms(start); ++ ++ if (passing_time > 100 || issue > 3) ++ RTW_INFO("%s success, issue:%d, poll:%d, %u ms\n", __FUNCTION__, issue, poll, rtw_get_passing_time_ms(start)); ++ else if (0) ++ RTW_INFO("%s success, issue:%d, poll:%d, %u ms\n", __FUNCTION__, issue, poll, rtw_get_passing_time_ms(start)); ++ ++ rtw_hal_fw_correct_bcn(padapter); ++ ++ return _SUCCESS; ++ } ++ ++#endif ++#else /* CONFIG_AP_MODE */ ++ return _FAIL; ++#endif /* !CONFIG_AP_MODE */ ++} ++ ++/**************************************************************************** ++ ++Following are some utitity fuctions for WiFi MLME ++ ++*****************************************************************************/ ++ ++BOOLEAN IsLegal5GChannel( ++ IN PADAPTER Adapter, ++ IN u8 channel) ++{ ++ ++ int i = 0; ++ u8 Channel_5G[45] = {36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, ++ 60, 62, 64, 100, 102, 104, 106, 108, 110, 112, 114, 116, 118, 120, 122, ++ 124, 126, 128, 130, 132, 134, 136, 138, 140, 149, 151, 153, 155, 157, 159, ++ 161, 163, 165 ++ }; ++ for (i = 0; i < sizeof(Channel_5G); i++) ++ if (channel == Channel_5G[i]) ++ return _TRUE; ++ return _FALSE; ++} ++ ++/* collect bss info from Beacon and Probe request/response frames. */ ++u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSID_EX *bssid) ++{ ++ int i; ++ u32 len; ++ u8 *p; ++ u16 val16, subtype; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ u32 packet_len = precv_frame->u.hdr.len; ++ u8 ie_offset; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ len = packet_len - sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ if (len > MAX_IE_SZ) { ++ /* RTW_INFO("IE too long for survey event\n"); */ ++ return _FAIL; ++ } ++ ++ _rtw_memset(bssid, 0, sizeof(WLAN_BSSID_EX)); ++ ++ subtype = GetFrameSubType(pframe); ++ ++ if (subtype == WIFI_BEACON) { ++ bssid->Reserved[0] = 1; ++ ie_offset = _BEACON_IE_OFFSET_; ++ } else { ++ /* FIXME : more type */ ++ if (subtype == WIFI_PROBERSP) { ++ ie_offset = _PROBERSP_IE_OFFSET_; ++ bssid->Reserved[0] = 3; ++ } else if (subtype == WIFI_PROBEREQ) { ++ ie_offset = _PROBEREQ_IE_OFFSET_; ++ bssid->Reserved[0] = 2; ++ } else { ++ bssid->Reserved[0] = 0; ++ ie_offset = _FIXED_IE_LENGTH_; ++ } ++ } ++ ++ bssid->Length = sizeof(WLAN_BSSID_EX) - MAX_IE_SZ + len; ++ ++ /* below is to copy the information element */ ++ bssid->IELength = len; ++ _rtw_memcpy(bssid->IEs, (pframe + sizeof(struct rtw_ieee80211_hdr_3addr)), bssid->IELength); ++ ++ /* get the signal strength */ ++ /* bssid->Rssi = precv_frame->u.hdr.attrib.SignalStrength; */ /* 0-100 index. */ ++ bssid->Rssi = precv_frame->u.hdr.attrib.phy_info.RecvSignalPower; /* in dBM.raw data */ ++ bssid->PhyInfo.SignalQuality = precv_frame->u.hdr.attrib.phy_info.SignalQuality;/* in percentage */ ++ bssid->PhyInfo.SignalStrength = precv_frame->u.hdr.attrib.phy_info.SignalStrength;/* in percentage */ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ rtw_hal_get_odm_var(padapter, HAL_ODM_ANTDIV_SELECT, &(bssid->PhyInfo.Optimum_antenna), NULL); ++#endif ++ ++ /* checking SSID */ ++ p = rtw_get_ie(bssid->IEs + ie_offset, _SSID_IE_, &len, bssid->IELength - ie_offset); ++ if (p == NULL) { ++ RTW_INFO("marc: cannot find SSID for survey event\n"); ++ return _FAIL; ++ } ++ ++ if (*(p + 1)) { ++ if (len > NDIS_802_11_LENGTH_SSID) { ++ RTW_INFO("%s()-%d: IE too long (%d) for survey event\n", __FUNCTION__, __LINE__, len); ++ return _FAIL; ++ } ++ _rtw_memcpy(bssid->Ssid.Ssid, (p + 2), *(p + 1)); ++ bssid->Ssid.SsidLength = *(p + 1); ++ } else ++ bssid->Ssid.SsidLength = 0; ++ ++ _rtw_memset(bssid->SupportedRates, 0, NDIS_802_11_LENGTH_RATES_EX); ++ ++ /* checking rate info... */ ++ i = 0; ++ p = rtw_get_ie(bssid->IEs + ie_offset, _SUPPORTEDRATES_IE_, &len, bssid->IELength - ie_offset); ++ if (p != NULL) { ++ if (len > NDIS_802_11_LENGTH_RATES_EX) { ++ RTW_INFO("%s()-%d: IE too long (%d) for survey event\n", __FUNCTION__, __LINE__, len); ++ return _FAIL; ++ } ++ _rtw_memcpy(bssid->SupportedRates, (p + 2), len); ++ i = len; ++ } ++ ++ p = rtw_get_ie(bssid->IEs + ie_offset, _EXT_SUPPORTEDRATES_IE_, &len, bssid->IELength - ie_offset); ++ if (p != NULL) { ++ if (len > (NDIS_802_11_LENGTH_RATES_EX - i)) { ++ RTW_INFO("%s()-%d: IE too long (%d) for survey event\n", __FUNCTION__, __LINE__, len); ++ return _FAIL; ++ } ++ _rtw_memcpy(bssid->SupportedRates + i, (p + 2), len); ++ } ++ ++ /* todo: */ ++#if 0 ++ if (judge_network_type(bssid->SupportedRates, (len + i)) == WIRELESS_11B) ++ bssid->NetworkTypeInUse = Ndis802_11DS; ++ else ++#endif ++ { ++ bssid->NetworkTypeInUse = Ndis802_11OFDM24; ++ } ++ ++#ifdef CONFIG_P2P ++ if (subtype == WIFI_PROBEREQ) { ++ u8 *p2p_ie; ++ u32 p2p_ielen; ++ /* Set Listion Channel */ ++ p2p_ie = rtw_get_p2p_ie(bssid->IEs, bssid->IELength, NULL, &p2p_ielen); ++ if (p2p_ie) { ++ u32 attr_contentlen = 0; ++ u8 listen_ch[5] = { 0x00 }; ++ ++ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_LISTEN_CH, listen_ch, &attr_contentlen); ++ bssid->Configuration.DSConfig = listen_ch[4]; ++ } else { ++ /* use current channel */ ++ bssid->Configuration.DSConfig = padapter->mlmeextpriv.cur_channel; ++ RTW_INFO("%s()-%d: Cannot get p2p_ie. set DSconfig to op_ch(%d)\n", __FUNCTION__, __LINE__, bssid->Configuration.DSConfig); ++ } ++ ++ /* FIXME */ ++ bssid->InfrastructureMode = Ndis802_11Infrastructure; ++ _rtw_memcpy(bssid->MacAddress, GetAddr2Ptr(pframe), ETH_ALEN); ++ bssid->Privacy = 1; ++ return _SUCCESS; ++ } ++#endif /* CONFIG_P2P */ ++ ++ if (bssid->IELength < 12) ++ return _FAIL; ++ ++ /* Checking for DSConfig */ ++ p = rtw_get_ie(bssid->IEs + ie_offset, _DSSET_IE_, &len, bssid->IELength - ie_offset); ++ ++ bssid->Configuration.DSConfig = 0; ++ bssid->Configuration.Length = 0; ++ ++ if (p) ++ bssid->Configuration.DSConfig = *(p + 2); ++ else { ++ /* In 5G, some ap do not have DSSET IE */ ++ /* checking HT info for channel */ ++ p = rtw_get_ie(bssid->IEs + ie_offset, _HT_ADD_INFO_IE_, &len, bssid->IELength - ie_offset); ++ if (p) { ++ struct HT_info_element *HT_info = (struct HT_info_element *)(p + 2); ++ bssid->Configuration.DSConfig = HT_info->primary_channel; ++ } else { ++ /* use current channel */ ++ bssid->Configuration.DSConfig = rtw_get_oper_ch(padapter); ++ } ++ } ++ ++ _rtw_memcpy(&bssid->Configuration.BeaconPeriod, rtw_get_beacon_interval_from_ie(bssid->IEs), 2); ++ bssid->Configuration.BeaconPeriod = le32_to_cpu(bssid->Configuration.BeaconPeriod); ++ ++ val16 = rtw_get_capability((WLAN_BSSID_EX *)bssid); ++ ++ if (val16 & BIT(0)) { ++ bssid->InfrastructureMode = Ndis802_11Infrastructure; ++ _rtw_memcpy(bssid->MacAddress, GetAddr2Ptr(pframe), ETH_ALEN); ++ } else { ++ bssid->InfrastructureMode = Ndis802_11IBSS; ++ _rtw_memcpy(bssid->MacAddress, GetAddr3Ptr(pframe), ETH_ALEN); ++ } ++ ++ if (val16 & BIT(4)) ++ bssid->Privacy = 1; ++ else ++ bssid->Privacy = 0; ++ ++ bssid->Configuration.ATIMWindow = 0; ++ ++ /* 20/40 BSS Coexistence check */ ++ if ((pregistrypriv->wifi_spec == 1) && (_FALSE == pmlmeinfo->bwmode_updated)) { ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++#ifdef CONFIG_80211N_HT ++ p = rtw_get_ie(bssid->IEs + ie_offset, _HT_CAPABILITY_IE_, &len, bssid->IELength - ie_offset); ++ if (p && len > 0) { ++ struct HT_caps_element *pHT_caps; ++ pHT_caps = (struct HT_caps_element *)(p + 2); ++ ++ if (pHT_caps->u.HT_cap_element.HT_caps_info & BIT(14)) ++ pmlmepriv->num_FortyMHzIntolerant++; ++ } else ++ pmlmepriv->num_sta_no_ht++; ++#endif /* CONFIG_80211N_HT */ ++ ++ } ++ ++#ifdef CONFIG_INTEL_WIDI ++ /* process_intel_widi_query_or_tigger(padapter, bssid); */ ++ if (process_intel_widi_query_or_tigger(padapter, bssid)) ++ return _FAIL; ++#endif /* CONFIG_INTEL_WIDI */ ++ ++#if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) & 1 ++ if (strcmp(bssid->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { ++ RTW_INFO("Receiving %s("MAC_FMT", DSConfig:%u) from ch%u with ss:%3u, sq:%3u, RawRSSI:%3ld\n" ++ , bssid->Ssid.Ssid, MAC_ARG(bssid->MacAddress), bssid->Configuration.DSConfig ++ , rtw_get_oper_ch(padapter) ++ , bssid->PhyInfo.SignalStrength, bssid->PhyInfo.SignalQuality, bssid->Rssi ++ ); ++ } ++#endif ++ ++ /* mark bss info receving from nearby channel as SignalQuality 101 */ ++ if (bssid->Configuration.DSConfig != rtw_get_oper_ch(padapter)) ++ bssid->PhyInfo.SignalQuality = 101; ++ ++ return _SUCCESS; ++} ++ ++void start_create_ibss(_adapter *padapter) ++{ ++ unsigned short caps; ++ u8 val8; ++ u8 join_type; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); ++ u8 doiqk = _FALSE; ++ pmlmeext->cur_channel = (u8)pnetwork->Configuration.DSConfig; ++ pmlmeinfo->bcn_interval = get_beacon_interval(pnetwork); ++ ++ /* update wireless mode */ ++ update_wireless_mode(padapter); ++ ++ /* udpate capability */ ++ caps = rtw_get_capability((WLAN_BSSID_EX *)pnetwork); ++ update_capinfo(padapter, caps); ++ if (caps & cap_IBSS) { /* adhoc master */ ++ /* set_opmode_cmd(padapter, adhoc); */ /* removed */ ++ ++ val8 = 0xcf; ++ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); ++ ++ doiqk = _TRUE; ++ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); ++ ++ /* switch channel */ ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ ++ doiqk = _FALSE; ++ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); ++ ++ beacon_timing_control(padapter); ++ ++ /* set msr to WIFI_FW_ADHOC_STATE */ ++ pmlmeinfo->state = WIFI_FW_ADHOC_STATE; ++ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); ++ ++ /* issue beacon */ ++ if (send_beacon(padapter) == _FAIL) { ++ ++ report_join_res(padapter, -1); ++ pmlmeinfo->state = WIFI_FW_NULL_STATE; ++ } else { ++ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, padapter->registrypriv.dev_network.MacAddress); ++ join_type = 0; ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); ++ ++ report_join_res(padapter, 1); ++ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; ++ rtw_indicate_connect(padapter); ++ } ++ } else { ++ RTW_INFO("start_create_ibss, invalid cap:%x\n", caps); ++ return; ++ } ++ /* update bc/mc sta_info */ ++#ifdef CONFIG_AP_MODE ++ update_bmc_sta(padapter); ++#endif /* CONFIG_AP_MODE */ ++ ++} ++ ++void start_clnt_join(_adapter *padapter) ++{ ++ unsigned short caps; ++ u8 val8; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); ++ int beacon_timeout; ++ u8 ASIX_ID[] = {0x00, 0x0E, 0xC6}; ++ ++ /* update wireless mode */ ++ update_wireless_mode(padapter); ++ ++ /* udpate capability */ ++ caps = rtw_get_capability((WLAN_BSSID_EX *)pnetwork); ++ update_capinfo(padapter, caps); ++ ++ /* check if sta is ASIX peer and fix IOT issue if it is. */ ++ if (_rtw_memcmp(get_my_bssid(&pmlmeinfo->network) , ASIX_ID , 3)) { ++ u8 iot_flag = _TRUE; ++ rtw_hal_set_hwreg(padapter, HW_VAR_ASIX_IOT, (u8 *)(&iot_flag)); ++ } ++ ++ if (caps & cap_ESS) { ++ Set_MSR(padapter, WIFI_FW_STATION_STATE); ++ ++ val8 = (pmlmeinfo->auth_algo == dot11AuthAlgrthm_8021X) ? 0xcc : 0xcf; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (padapter->wapiInfo.bWapiEnable && pmlmeinfo->auth_algo == dot11AuthAlgrthm_WAPI) { ++ /* Disable TxUseDefaultKey, RxUseDefaultKey, RxBroadcastUseDefaultKey. */ ++ val8 = 0x4c; ++ } ++#endif ++ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); ++ ++#ifdef CONFIG_DEAUTH_BEFORE_CONNECT ++ /* Because of AP's not receiving deauth before */ ++ /* AP may: 1)not response auth or 2)deauth us after link is complete */ ++ /* issue deauth before issuing auth to deal with the situation */ ++ ++ /* Commented by Albert 2012/07/21 */ ++ /* For the Win8 P2P connection, it will be hard to have a successful connection if this Wi-Fi doesn't connect to it. */ ++ { ++#ifdef CONFIG_P2P ++ _queue *queue = &(padapter->mlmepriv.scanned_queue); ++ _list *head = get_list_head(queue); ++ _list *pos = get_next(head); ++ struct wlan_network *scanned = NULL; ++ u8 ie_offset = 0; ++ _irqL irqL; ++ bool has_p2p_ie = _FALSE; ++ ++ _enter_critical_bh(&(padapter->mlmepriv.scanned_queue.lock), &irqL); ++ ++ for (pos = get_next(head); !rtw_end_of_queue_search(head, pos); pos = get_next(pos)) { ++ ++ scanned = LIST_CONTAINOR(pos, struct wlan_network, list); ++ ++ if (_rtw_memcmp(&(scanned->network.Ssid), &(pnetwork->Ssid), sizeof(NDIS_802_11_SSID)) == _TRUE ++ && _rtw_memcmp(scanned->network.MacAddress, pnetwork->MacAddress, sizeof(NDIS_802_11_MAC_ADDRESS)) == _TRUE ++ ) { ++ ie_offset = (scanned->network.Reserved[0] == 2 ? 0 : 12); ++ if (rtw_get_p2p_ie(scanned->network.IEs + ie_offset, scanned->network.IELength - ie_offset, NULL, NULL)) ++ has_p2p_ie = _TRUE; ++ break; ++ } ++ } ++ ++ _exit_critical_bh(&(padapter->mlmepriv.scanned_queue.lock), &irqL); ++ ++ if (scanned == NULL || rtw_end_of_queue_search(head, pos) || has_p2p_ie == _FALSE) ++#endif /* CONFIG_P2P */ ++ /* To avoid connecting to AP fail during resume process, change retry count from 5 to 1 */ ++ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 1, 100); ++ } ++#endif /* CONFIG_DEAUTH_BEFORE_CONNECT */ ++ ++ /* here wait for receiving the beacon to start auth */ ++ /* and enable a timer */ ++ beacon_timeout = decide_wait_for_beacon_timeout(pmlmeinfo->bcn_interval); ++ set_link_timer(pmlmeext, beacon_timeout); ++ _set_timer(&padapter->mlmepriv.assoc_timer, ++ (REAUTH_TO * REAUTH_LIMIT) + (REASSOC_TO * REASSOC_LIMIT) + beacon_timeout); ++ ++#ifdef CONFIG_RTW_80211R ++ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { ++ if (rtw_chk_ft_flags(padapter, RTW_FT_OVER_DS_SUPPORTED)) { ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ft_priv *pftpriv = &pmlmepriv->ftpriv; ++ ++ pmlmeinfo->state = WIFI_FW_AUTH_SUCCESS | WIFI_FW_STATION_STATE; ++ pftpriv->ft_event.ies = pftpriv->ft_action + sizeof(struct rtw_ieee80211_hdr_3addr) + 16; ++ pftpriv->ft_event.ies_len = pftpriv->ft_action_len - sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ /*Not support RIC*/ ++ pftpriv->ft_event.ric_ies = NULL; ++ pftpriv->ft_event.ric_ies_len = 0; ++ report_ft_event(padapter); ++ } else { ++ pmlmeinfo->state = WIFI_FW_AUTH_NULL | WIFI_FW_STATION_STATE; ++ start_clnt_auth(padapter); ++ } ++ } else ++#endif ++ pmlmeinfo->state = WIFI_FW_AUTH_NULL | WIFI_FW_STATION_STATE; ++ } else if (caps & cap_IBSS) { /* adhoc client */ ++ Set_MSR(padapter, WIFI_FW_ADHOC_STATE); ++ ++ val8 = 0xcf; ++ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); ++ ++ beacon_timing_control(padapter); ++ ++ pmlmeinfo->state = WIFI_FW_ADHOC_STATE; ++ ++ report_join_res(padapter, 1); ++ } else { ++ /* RTW_INFO("marc: invalid cap:%x\n", caps); */ ++ return; ++ } ++ ++} ++ ++void start_clnt_auth(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ _cancel_timer_ex(&pmlmeext->link_timer); ++ ++ pmlmeinfo->state &= (~WIFI_FW_AUTH_NULL); ++ pmlmeinfo->state |= WIFI_FW_AUTH_STATE; ++ ++ pmlmeinfo->auth_seq = 1; ++ pmlmeinfo->reauth_count = 0; ++ pmlmeinfo->reassoc_count = 0; ++ pmlmeinfo->link_count = 0; ++ pmlmeext->retry = 0; ++ ++#ifdef CONFIG_RTW_80211R ++ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { ++ rtw_set_ft_status(padapter, RTW_FT_AUTHENTICATING_STA); ++ RTW_PRINT("start ft auth\n"); ++ } else ++#endif ++ RTW_PRINT("start auth\n"); ++ issue_auth(padapter, NULL, 0); ++ ++ set_link_timer(pmlmeext, REAUTH_TO); ++ ++} ++ ++ ++void start_clnt_assoc(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ _cancel_timer_ex(&pmlmeext->link_timer); ++ ++ pmlmeinfo->state &= (~(WIFI_FW_AUTH_NULL | WIFI_FW_AUTH_STATE)); ++ pmlmeinfo->state |= (WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE); ++ ++#ifdef CONFIG_RTW_80211R ++ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) ++ issue_reassocreq(padapter); ++ else ++#endif ++ issue_assocreq(padapter); ++ ++ set_link_timer(pmlmeext, REASSOC_TO); ++} ++ ++unsigned int receive_disconnect(_adapter *padapter, unsigned char *MacAddr, unsigned short reason, u8 locally_generated) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if (!(_rtw_memcmp(MacAddr, get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) ++ return _SUCCESS; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) { ++ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) { ++ if (report_del_sta_event(padapter, MacAddr, reason, _TRUE, locally_generated) != _FAIL) ++ pmlmeinfo->state = WIFI_FW_NULL_STATE; ++ } else if (pmlmeinfo->state & WIFI_FW_LINKING_STATE) { ++ if (report_join_res(padapter, -2) != _FAIL) ++ pmlmeinfo->state = WIFI_FW_NULL_STATE; ++ } else ++ RTW_INFO(FUNC_ADPT_FMT" - End to Disconnect\n", FUNC_ADPT_ARG(padapter)); ++#ifdef CONFIG_RTW_80211R ++ if ((rtw_to_roam(padapter) > 0) && !rtw_chk_ft_status(padapter, RTW_FT_REQUESTED_STA)) ++ rtw_reset_ft_status(padapter); ++#endif ++ } ++ ++ return _SUCCESS; ++} ++ ++#ifdef CONFIG_80211D ++static void process_80211d(PADAPTER padapter, WLAN_BSSID_EX *bssid) ++{ ++ struct registry_priv *pregistrypriv; ++ struct mlme_ext_priv *pmlmeext; ++ RT_CHANNEL_INFO *chplan_new; ++ u8 channel; ++ u8 i; ++ ++ ++ pregistrypriv = &padapter->registrypriv; ++ pmlmeext = &padapter->mlmeextpriv; ++ ++ /* Adjust channel plan by AP Country IE */ ++ if (pregistrypriv->enable80211d ++ && (!pmlmeext->update_channel_plan_by_ap_done)) { ++ u8 *ie, *p; ++ u32 len; ++ RT_CHANNEL_PLAN chplan_ap; ++ RT_CHANNEL_INFO chplan_sta[MAX_CHANNEL_NUM]; ++ u8 country[4]; ++ u8 fcn; /* first channel number */ ++ u8 noc; /* number of channel */ ++ u8 j, k; ++ ++ ie = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _COUNTRY_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); ++ if (!ie) ++ return; ++ if (len < 6) ++ return; ++ ++ ie += 2; ++ p = ie; ++ ie += len; ++ ++ _rtw_memset(country, 0, 4); ++ _rtw_memcpy(country, p, 3); ++ p += 3; ++ RTW_INFO("%s: 802.11d country=%s\n", __FUNCTION__, country); ++ ++ i = 0; ++ while ((ie - p) >= 3) { ++ fcn = *(p++); ++ noc = *(p++); ++ p++; ++ ++ for (j = 0; j < noc; j++) { ++ if (fcn <= 14) ++ channel = fcn + j; /* 2.4 GHz */ ++ else ++ channel = fcn + j * 4; /* 5 GHz */ ++ ++ chplan_ap.Channel[i++] = channel; ++ } ++ } ++ chplan_ap.Len = i; ++ ++#ifdef CONFIG_RTW_DEBUG ++ i = 0; ++ RTW_INFO("%s: AP[%s] channel plan {", __FUNCTION__, bssid->Ssid.Ssid); ++ while ((i < chplan_ap.Len) && (chplan_ap.Channel[i] != 0)) { ++ _RTW_INFO("%02d,", chplan_ap.Channel[i]); ++ i++; ++ } ++ _RTW_INFO("}\n"); ++#endif ++ ++ _rtw_memcpy(chplan_sta, pmlmeext->channel_set, sizeof(chplan_sta)); ++#ifdef CONFIG_RTW_DEBUG ++ i = 0; ++ RTW_INFO("%s: STA channel plan {", __FUNCTION__); ++ while ((i < MAX_CHANNEL_NUM) && (chplan_sta[i].ChannelNum != 0)) { ++ _RTW_INFO("%02d(%c),", chplan_sta[i].ChannelNum, chplan_sta[i].ScanType == SCAN_PASSIVE ? 'p' : 'a'); ++ i++; ++ } ++ _RTW_INFO("}\n"); ++#endif ++ ++ _rtw_memset(pmlmeext->channel_set, 0, sizeof(pmlmeext->channel_set)); ++ chplan_new = pmlmeext->channel_set; ++ ++ i = j = k = 0; ++ if (pregistrypriv->wireless_mode & WIRELESS_11G) { ++ do { ++ if ((i == MAX_CHANNEL_NUM) ++ || (chplan_sta[i].ChannelNum == 0) ++ || (chplan_sta[i].ChannelNum > 14)) ++ break; ++ ++ if ((j == chplan_ap.Len) || (chplan_ap.Channel[j] > 14)) ++ break; ++ ++ if (chplan_sta[i].ChannelNum == chplan_ap.Channel[j]) { ++ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; ++ chplan_new[k].ScanType = SCAN_ACTIVE; ++ i++; ++ j++; ++ k++; ++ } else if (chplan_sta[i].ChannelNum < chplan_ap.Channel[j]) { ++ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; ++#if 0 ++ chplan_new[k].ScanType = chplan_sta[i].ScanType; ++#else ++ chplan_new[k].ScanType = SCAN_PASSIVE; ++#endif ++ i++; ++ k++; ++ } else if (chplan_sta[i].ChannelNum > chplan_ap.Channel[j]) { ++ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; ++ chplan_new[k].ScanType = SCAN_ACTIVE; ++ j++; ++ k++; ++ } ++ } while (1); ++ ++ /* change AP not support channel to Passive scan */ ++ while ((i < MAX_CHANNEL_NUM) ++ && (chplan_sta[i].ChannelNum != 0) ++ && (chplan_sta[i].ChannelNum <= 14)) { ++ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; ++#if 0 ++ chplan_new[k].ScanType = chplan_sta[i].ScanType; ++#else ++ chplan_new[k].ScanType = SCAN_PASSIVE; ++#endif ++ i++; ++ k++; ++ } ++ ++ /* add channel AP supported */ ++ while ((j < chplan_ap.Len) && (chplan_ap.Channel[j] <= 14)) { ++ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; ++ chplan_new[k].ScanType = SCAN_ACTIVE; ++ j++; ++ k++; ++ } ++ } else { ++ /* keep original STA 2.4G channel plan */ ++ while ((i < MAX_CHANNEL_NUM) ++ && (chplan_sta[i].ChannelNum != 0) ++ && (chplan_sta[i].ChannelNum <= 14)) { ++ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; ++ chplan_new[k].ScanType = chplan_sta[i].ScanType; ++ i++; ++ k++; ++ } ++ ++ /* skip AP 2.4G channel plan */ ++ while ((j < chplan_ap.Len) && (chplan_ap.Channel[j] <= 14)) ++ j++; ++ } ++ ++ if (pregistrypriv->wireless_mode & WIRELESS_11A) { ++ do { ++ if ((i >= MAX_CHANNEL_NUM) ++ || (chplan_sta[i].ChannelNum == 0)) ++ break; ++ ++ if ((j == chplan_ap.Len) || (chplan_ap.Channel[j] == 0)) ++ break; ++ ++ if (chplan_sta[i].ChannelNum == chplan_ap.Channel[j]) { ++ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; ++ chplan_new[k].ScanType = SCAN_ACTIVE; ++ i++; ++ j++; ++ k++; ++ } else if (chplan_sta[i].ChannelNum < chplan_ap.Channel[j]) { ++ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; ++#if 0 ++ chplan_new[k].ScanType = chplan_sta[i].ScanType; ++#else ++ chplan_new[k].ScanType = SCAN_PASSIVE; ++#endif ++ i++; ++ k++; ++ } else if (chplan_sta[i].ChannelNum > chplan_ap.Channel[j]) { ++ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; ++ chplan_new[k].ScanType = SCAN_ACTIVE; ++ j++; ++ k++; ++ } ++ } while (1); ++ ++ /* change AP not support channel to Passive scan */ ++ while ((i < MAX_CHANNEL_NUM) && (chplan_sta[i].ChannelNum != 0)) { ++ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; ++#if 0 ++ chplan_new[k].ScanType = chplan_sta[i].ScanType; ++#else ++ chplan_new[k].ScanType = SCAN_PASSIVE; ++#endif ++ i++; ++ k++; ++ } ++ ++ /* add channel AP supported */ ++ while ((j < chplan_ap.Len) && (chplan_ap.Channel[j] != 0)) { ++ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; ++ chplan_new[k].ScanType = SCAN_ACTIVE; ++ j++; ++ k++; ++ } ++ } else { ++ /* keep original STA 5G channel plan */ ++ while ((i < MAX_CHANNEL_NUM) && (chplan_sta[i].ChannelNum != 0)) { ++ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; ++ chplan_new[k].ScanType = chplan_sta[i].ScanType; ++ i++; ++ k++; ++ } ++ } ++ ++ pmlmeext->update_channel_plan_by_ap_done = 1; ++ ++#ifdef CONFIG_RTW_DEBUG ++ k = 0; ++ RTW_INFO("%s: new STA channel plan {", __FUNCTION__); ++ while ((k < MAX_CHANNEL_NUM) && (chplan_new[k].ChannelNum != 0)) { ++ _RTW_INFO("%02d(%c),", chplan_new[k].ChannelNum, chplan_new[k].ScanType == SCAN_PASSIVE ? 'p' : 'c'); ++ k++; ++ } ++ _RTW_INFO("}\n"); ++#endif ++ ++#if 0 ++ /* recover the right channel index */ ++ channel = chplan_sta[pmlmeext->sitesurvey_res.channel_idx].ChannelNum; ++ k = 0; ++ while ((k < MAX_CHANNEL_NUM) && (chplan_new[k].ChannelNum != 0)) { ++ if (chplan_new[k].ChannelNum == channel) { ++ RTW_INFO("%s: change mlme_ext sitesurvey channel index from %d to %d\n", ++ __FUNCTION__, pmlmeext->sitesurvey_res.channel_idx, k); ++ pmlmeext->sitesurvey_res.channel_idx = k; ++ break; ++ } ++ k++; ++ } ++#endif ++ } ++ ++ /* If channel is used by AP, set channel scan type to active */ ++ channel = bssid->Configuration.DSConfig; ++ chplan_new = pmlmeext->channel_set; ++ i = 0; ++ while ((i < MAX_CHANNEL_NUM) && (chplan_new[i].ChannelNum != 0)) { ++ if (chplan_new[i].ChannelNum == channel) { ++ if (chplan_new[i].ScanType == SCAN_PASSIVE) { ++ /* 5G Bnad 2, 3 (DFS) doesn't change to active scan */ ++ if (channel >= 52 && channel <= 144) ++ break; ++ ++ chplan_new[i].ScanType = SCAN_ACTIVE; ++ RTW_INFO("%s: change channel %d scan type from passive to active\n", ++ __FUNCTION__, channel); ++ } ++ break; ++ } ++ i++; ++ } ++} ++#endif ++ ++/**************************************************************************** ++ ++Following are the functions to report events ++ ++*****************************************************************************/ ++ ++void report_survey_event(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct cmd_obj *pcmd_obj; ++ u8 *pevtcmd; ++ u32 cmdsz; ++ struct survey_event *psurvey_evt; ++ struct C2HEvent_Header *pc2h_evt_hdr; ++ struct mlme_ext_priv *pmlmeext; ++ struct cmd_priv *pcmdpriv; ++ /* u8 *pframe = precv_frame->u.hdr.rx_data; */ ++ /* uint len = precv_frame->u.hdr.len; */ ++ ++ if (!padapter) ++ return; ++ ++ pmlmeext = &padapter->mlmeextpriv; ++ pcmdpriv = &padapter->cmdpriv; ++ ++ ++ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmd_obj == NULL) ++ return; ++ ++ cmdsz = (sizeof(struct survey_event) + sizeof(struct C2HEvent_Header)); ++ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); ++ if (pevtcmd == NULL) { ++ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); ++ return; ++ } ++ ++ _rtw_init_listhead(&pcmd_obj->list); ++ ++ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); ++ pcmd_obj->cmdsz = cmdsz; ++ pcmd_obj->parmbuf = pevtcmd; ++ ++ pcmd_obj->rsp = NULL; ++ pcmd_obj->rspsz = 0; ++ ++ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); ++ pc2h_evt_hdr->len = sizeof(struct survey_event); ++ pc2h_evt_hdr->ID = GEN_EVT_CODE(_Survey); ++ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); ++ ++ psurvey_evt = (struct survey_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); ++ ++ if (collect_bss_info(padapter, precv_frame, (WLAN_BSSID_EX *)&psurvey_evt->bss) == _FAIL) { ++ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); ++ rtw_mfree((u8 *)pevtcmd, cmdsz); ++ return; ++ } ++ ++#ifdef CONFIG_80211D ++ process_80211d(padapter, &psurvey_evt->bss); ++#endif ++ ++ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); ++ ++ pmlmeext->sitesurvey_res.bss_cnt++; ++ ++ return; ++ ++} ++ ++void report_surveydone_event(_adapter *padapter) ++{ ++ struct cmd_obj *pcmd_obj; ++ u8 *pevtcmd; ++ u32 cmdsz; ++ struct surveydone_event *psurveydone_evt; ++ struct C2HEvent_Header *pc2h_evt_hdr; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ ++ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmd_obj == NULL) ++ return; ++ ++ cmdsz = (sizeof(struct surveydone_event) + sizeof(struct C2HEvent_Header)); ++ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); ++ if (pevtcmd == NULL) { ++ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); ++ return; ++ } ++ ++ _rtw_init_listhead(&pcmd_obj->list); ++ ++ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); ++ pcmd_obj->cmdsz = cmdsz; ++ pcmd_obj->parmbuf = pevtcmd; ++ ++ pcmd_obj->rsp = NULL; ++ pcmd_obj->rspsz = 0; ++ ++ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); ++ pc2h_evt_hdr->len = sizeof(struct surveydone_event); ++ pc2h_evt_hdr->ID = GEN_EVT_CODE(_SurveyDone); ++ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); ++ ++ psurveydone_evt = (struct surveydone_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); ++ psurveydone_evt->bss_cnt = pmlmeext->sitesurvey_res.bss_cnt; ++ ++ RTW_INFO("survey done event(%x) band:%d for "ADPT_FMT"\n", psurveydone_evt->bss_cnt, padapter->setband, ADPT_ARG(padapter)); ++ ++ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); ++ ++ return; ++ ++} ++ ++u32 report_join_res(_adapter *padapter, int res) ++{ ++ struct cmd_obj *pcmd_obj; ++ u8 *pevtcmd; ++ u32 cmdsz; ++ struct joinbss_event *pjoinbss_evt; ++ struct C2HEvent_Header *pc2h_evt_hdr; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u32 ret = _FAIL; ++ ++ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmd_obj == NULL) ++ goto exit; ++ ++ cmdsz = (sizeof(struct joinbss_event) + sizeof(struct C2HEvent_Header)); ++ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); ++ if (pevtcmd == NULL) { ++ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); ++ goto exit; ++ } ++ ++ _rtw_init_listhead(&pcmd_obj->list); ++ ++ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); ++ pcmd_obj->cmdsz = cmdsz; ++ pcmd_obj->parmbuf = pevtcmd; ++ ++ pcmd_obj->rsp = NULL; ++ pcmd_obj->rspsz = 0; ++ ++ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); ++ pc2h_evt_hdr->len = sizeof(struct joinbss_event); ++ pc2h_evt_hdr->ID = GEN_EVT_CODE(_JoinBss); ++ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); ++ ++ pjoinbss_evt = (struct joinbss_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); ++ _rtw_memcpy((unsigned char *)(&(pjoinbss_evt->network.network)), &(pmlmeinfo->network), sizeof(WLAN_BSSID_EX)); ++ pjoinbss_evt->network.join_res = pjoinbss_evt->network.aid = res; ++ ++ RTW_INFO("report_join_res(%d)\n", res); ++ ++ ++ rtw_joinbss_event_prehandle(padapter, (u8 *)&pjoinbss_evt->network); ++ ++ ++ ret = rtw_enqueue_cmd(pcmdpriv, pcmd_obj); ++ ++exit: ++ return ret; ++} ++ ++void report_wmm_edca_update(_adapter *padapter) ++{ ++ struct cmd_obj *pcmd_obj; ++ u8 *pevtcmd; ++ u32 cmdsz; ++ struct wmm_event *pwmm_event; ++ struct C2HEvent_Header *pc2h_evt_hdr; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ ++ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmd_obj == NULL) ++ return; ++ ++ cmdsz = (sizeof(struct wmm_event) + sizeof(struct C2HEvent_Header)); ++ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); ++ if (pevtcmd == NULL) { ++ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); ++ return; ++ } ++ ++ _rtw_init_listhead(&pcmd_obj->list); ++ ++ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); ++ pcmd_obj->cmdsz = cmdsz; ++ pcmd_obj->parmbuf = pevtcmd; ++ ++ pcmd_obj->rsp = NULL; ++ pcmd_obj->rspsz = 0; ++ ++ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); ++ pc2h_evt_hdr->len = sizeof(struct wmm_event); ++ pc2h_evt_hdr->ID = GEN_EVT_CODE(_WMM); ++ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); ++ ++ pwmm_event = (struct wmm_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); ++ pwmm_event->wmm = 0; ++ ++ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); ++ ++ return; ++ ++} ++ ++u32 report_del_sta_event(_adapter *padapter, unsigned char *MacAddr, unsigned short reason, bool enqueue, u8 locally_generated) ++{ ++ struct cmd_obj *pcmd_obj; ++ u8 *pevtcmd; ++ u32 cmdsz; ++ struct sta_info *psta; ++ int mac_id = -1; ++ struct stadel_event *pdel_sta_evt; ++ struct C2HEvent_Header *pc2h_evt_hdr; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ /* prepare cmd parameter */ ++ cmdsz = (sizeof(struct stadel_event) + sizeof(struct C2HEvent_Header)); ++ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); ++ if (pevtcmd == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); ++ pc2h_evt_hdr->len = sizeof(struct stadel_event); ++ pc2h_evt_hdr->ID = GEN_EVT_CODE(_DelSTA); ++ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); ++ ++ pdel_sta_evt = (struct stadel_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); ++ _rtw_memcpy((unsigned char *)(&(pdel_sta_evt->macaddr)), MacAddr, ETH_ALEN); ++ _rtw_memcpy((unsigned char *)(pdel_sta_evt->rsvd), (unsigned char *)(&reason), 2); ++ psta = rtw_get_stainfo(&padapter->stapriv, MacAddr); ++ if (psta) ++ mac_id = (int)psta->mac_id; ++ else ++ mac_id = (-1); ++ pdel_sta_evt->mac_id = mac_id; ++ pdel_sta_evt->locally_generated = locally_generated; ++ ++ if (!enqueue) { ++ /* do directly */ ++ rtw_stadel_event_callback(padapter, (u8 *)pdel_sta_evt); ++ rtw_mfree(pevtcmd, cmdsz); ++ } else { ++ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmd_obj == NULL) { ++ rtw_mfree(pevtcmd, cmdsz); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ _rtw_init_listhead(&pcmd_obj->list); ++ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); ++ pcmd_obj->cmdsz = cmdsz; ++ pcmd_obj->parmbuf = pevtcmd; ++ ++ pcmd_obj->rsp = NULL; ++ pcmd_obj->rspsz = 0; ++ ++ res = rtw_enqueue_cmd(pcmdpriv, pcmd_obj); ++ } ++ ++exit: ++ ++ RTW_INFO(FUNC_ADPT_FMT" "MAC_FMT" mac_id=%d, enqueue:%d, res:%u\n" ++ , FUNC_ADPT_ARG(padapter), MAC_ARG(MacAddr), mac_id, enqueue, res); ++ ++ return res; ++} ++ ++void report_add_sta_event(_adapter *padapter, unsigned char *MacAddr) ++{ ++ struct cmd_obj *pcmd_obj; ++ u8 *pevtcmd; ++ u32 cmdsz; ++ struct stassoc_event *padd_sta_evt; ++ struct C2HEvent_Header *pc2h_evt_hdr; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ ++ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmd_obj == NULL) ++ return; ++ ++ cmdsz = (sizeof(struct stassoc_event) + sizeof(struct C2HEvent_Header)); ++ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); ++ if (pevtcmd == NULL) { ++ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); ++ return; ++ } ++ ++ _rtw_init_listhead(&pcmd_obj->list); ++ ++ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); ++ pcmd_obj->cmdsz = cmdsz; ++ pcmd_obj->parmbuf = pevtcmd; ++ ++ pcmd_obj->rsp = NULL; ++ pcmd_obj->rspsz = 0; ++ ++ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); ++ pc2h_evt_hdr->len = sizeof(struct stassoc_event); ++ pc2h_evt_hdr->ID = GEN_EVT_CODE(_AddSTA); ++ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); ++ ++ padd_sta_evt = (struct stassoc_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); ++ _rtw_memcpy((unsigned char *)(&(padd_sta_evt->macaddr)), MacAddr, ETH_ALEN); ++ ++ RTW_INFO("report_add_sta_event: add STA\n"); ++ ++ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); ++ ++ return; ++} ++ ++ ++bool rtw_port_switch_chk(_adapter *adapter) ++{ ++ bool switch_needed = _FALSE; ++#ifdef CONFIG_CONCURRENT_MODE ++#ifdef CONFIG_RUNTIME_PORT_SWITCH ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(dvobj); ++ _adapter *if_port0 = NULL; ++ _adapter *if_port1 = NULL; ++ struct mlme_ext_info *if_port0_mlmeinfo = NULL; ++ struct mlme_ext_info *if_port1_mlmeinfo = NULL; ++ int i; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (get_hw_port(dvobj->padapters[i]) == HW_PORT0) { ++ if_port0 = dvobj->padapters[i]; ++ if_port0_mlmeinfo = &(if_port0->mlmeextpriv.mlmext_info); ++ } else if (get_hw_port(dvobj->padapters[i]) == HW_PORT1) { ++ if_port1 = dvobj->padapters[i]; ++ if_port1_mlmeinfo = &(if_port1->mlmeextpriv.mlmext_info); ++ } ++ } ++ ++ if (if_port0 == NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (if_port1 == NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++#ifdef DBG_RUNTIME_PORT_SWITCH ++ RTW_INFO(FUNC_ADPT_FMT" wowlan_mode:%u\n" ++ ADPT_FMT", port0, mlmeinfo->state:0x%08x, p2p_state:%d, %d\n" ++ ADPT_FMT", port1, mlmeinfo->state:0x%08x, p2p_state:%d, %d\n", ++ FUNC_ADPT_ARG(adapter), pwrctl->wowlan_mode, ++ ADPT_ARG(if_port0), if_port0_mlmeinfo->state, rtw_p2p_state(&if_port0->wdinfo), rtw_p2p_chk_state(&if_port0->wdinfo, P2P_STATE_NONE), ++ ADPT_ARG(if_port1), if_port1_mlmeinfo->state, rtw_p2p_state(&if_port1->wdinfo), rtw_p2p_chk_state(&if_port1->wdinfo, P2P_STATE_NONE)); ++#endif /* DBG_RUNTIME_PORT_SWITCH */ ++ ++#ifdef CONFIG_WOWLAN ++ /* WOWLAN interface(primary, for now) should be port0 */ ++ if (pwrctl->wowlan_mode == _TRUE) { ++ if (!is_primary_adapter(if_port0)) { ++ RTW_INFO("%s "ADPT_FMT" enable WOWLAN\n", __func__, ADPT_ARG(if_port1)); ++ switch_needed = _TRUE; ++ } ++ goto exit; ++ } ++#endif /* CONFIG_WOWLAN */ ++ ++ /* AP should use port0 for ctl frame's ack */ ++ if ((if_port1_mlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { ++ RTW_INFO("%s "ADPT_FMT" is AP/GO\n", __func__, ADPT_ARG(if_port1)); ++ switch_needed = _TRUE; ++ goto exit; ++ } ++ ++ /* GC should use port0 for p2p ps */ ++ if (((if_port1_mlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) ++ && (if_port1_mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) ++#ifdef CONFIG_P2P ++ && !rtw_p2p_chk_state(&if_port1->wdinfo, P2P_STATE_NONE) ++#endif ++ && !check_fwstate(&if_port1->mlmepriv, WIFI_UNDER_WPS) ++ ) { ++ RTW_INFO("%s "ADPT_FMT" is GC\n", __func__, ADPT_ARG(if_port1)); ++ switch_needed = _TRUE; ++ goto exit; ++ } ++ ++ /* port1 linked, but port0 not linked */ ++ if ((if_port1_mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) ++ && !(if_port0_mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) ++ && ((if_port0_mlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) ++ ) { ++ RTW_INFO("%s "ADPT_FMT" is SINGLE_LINK\n", __func__, ADPT_ARG(if_port1)); ++ switch_needed = _TRUE; ++ goto exit; ++ } ++ ++exit: ++#ifdef DBG_RUNTIME_PORT_SWITCH ++ RTW_INFO(FUNC_ADPT_FMT" ret:%d\n", FUNC_ADPT_ARG(adapter), switch_needed); ++#endif /* DBG_RUNTIME_PORT_SWITCH */ ++#endif /* CONFIG_RUNTIME_PORT_SWITCH */ ++#endif /* CONFIG_CONCURRENT_MODE */ ++ return switch_needed; ++} ++ ++/**************************************************************************** ++ ++Following are the event callback functions ++ ++*****************************************************************************/ ++ ++/* for sta/adhoc mode */ ++void update_sta_info(_adapter *padapter, struct sta_info *psta) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ /* ERP */ ++ VCS_update(padapter, psta); ++ ++#ifdef CONFIG_80211N_HT ++ /* HT */ ++ if (pmlmepriv->htpriv.ht_option) { ++ psta->htpriv.ht_option = _TRUE; ++ ++ psta->htpriv.ampdu_enable = pmlmepriv->htpriv.ampdu_enable; ++ ++ psta->htpriv.rx_ampdu_min_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & IEEE80211_HT_CAP_AMPDU_DENSITY) >> 2; ++ ++ if (support_short_GI(padapter, &(pmlmeinfo->HT_caps), CHANNEL_WIDTH_20)) ++ psta->htpriv.sgi_20m = _TRUE; ++ ++ if (support_short_GI(padapter, &(pmlmeinfo->HT_caps), CHANNEL_WIDTH_40)) ++ psta->htpriv.sgi_40m = _TRUE; ++ ++ psta->qos_option = _TRUE; ++ ++ psta->htpriv.ldpc_cap = pmlmepriv->htpriv.ldpc_cap; ++ psta->htpriv.stbc_cap = pmlmepriv->htpriv.stbc_cap; ++ psta->htpriv.beamform_cap = pmlmepriv->htpriv.beamform_cap; ++ ++ _rtw_memcpy(&psta->htpriv.ht_cap, &pmlmeinfo->HT_caps, sizeof(struct rtw_ieee80211_ht_cap)); ++ } else ++#endif /* CONFIG_80211N_HT */ ++ { ++#ifdef CONFIG_80211N_HT ++ psta->htpriv.ht_option = _FALSE; ++ ++ psta->htpriv.ampdu_enable = _FALSE; ++ ++ psta->htpriv.sgi_20m = _FALSE; ++ psta->htpriv.sgi_40m = _FALSE; ++#endif /* CONFIG_80211N_HT */ ++ psta->qos_option = _FALSE; ++ ++ } ++ ++#ifdef CONFIG_80211N_HT ++ psta->htpriv.ch_offset = pmlmeext->cur_ch_offset; ++ ++ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ ++ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ ++#endif /* CONFIG_80211N_HT */ ++ ++ psta->bw_mode = pmlmeext->cur_bwmode; ++ ++ /* QoS */ ++ if (pmlmepriv->qospriv.qos_option) ++ psta->qos_option = _TRUE; ++ ++#ifdef CONFIG_80211AC_VHT ++ _rtw_memcpy(&psta->vhtpriv, &pmlmepriv->vhtpriv, sizeof(struct vht_priv)); ++#endif /* CONFIG_80211AC_VHT */ ++ ++ update_ldpc_stbc_cap(psta); ++ ++ _enter_critical_bh(&psta->lock, &irqL); ++ psta->state = _FW_LINKED; ++ _exit_critical_bh(&psta->lock, &irqL); ++ ++} ++ ++static void rtw_mlmeext_disconnect(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); ++ u8 state_backup = (pmlmeinfo->state & 0x03); ++ u8 ASIX_ID[] = {0x00, 0x0E, 0xC6}; ++ ++ /* set_opmode_cmd(padapter, infra_client_with_mlme); */ ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, 0); ++ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); ++ ++ /* set MSR to no link state->infra. mode */ ++ Set_MSR(padapter, _HW_STATE_STATION_); ++ ++ /* check if sta is ASIX peer and fix IOT issue if it is. */ ++ if (_rtw_memcmp(get_my_bssid(&pmlmeinfo->network) , ASIX_ID , 3)) { ++ u8 iot_flag = _FALSE; ++ rtw_hal_set_hwreg(padapter, HW_VAR_ASIX_IOT, (u8 *)(&iot_flag)); ++ } ++ pmlmeinfo->state = WIFI_FW_NULL_STATE; ++ ++#ifdef CONFIG_MCC_MODE ++ /* mcc disconnect setting before download LPS rsvd page */ ++ rtw_hal_set_mcc_setting_disconnect(padapter); ++#endif /* CONFIG_MCC_MODE */ ++ ++ if (state_backup == WIFI_FW_STATION_STATE) { ++ if (rtw_port_switch_chk(padapter) == _TRUE) { ++ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); ++#ifdef CONFIG_LPS ++ { ++ _adapter *port0_iface = dvobj_get_port0_adapter(adapter_to_dvobj(padapter)); ++ if (port0_iface) ++ rtw_lps_ctrl_wk_cmd(port0_iface, LPS_CTRL_CONNECT, 0); ++ } ++#endif ++ } ++ } ++ ++ /* switch to the 20M Hz mode after disconnect */ ++ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++#ifdef CONFIG_FCS_MODE ++ if (EN_FCS(padapter)) ++ rtw_hal_set_hwreg(padapter, HW_VAR_STOP_FCS_MODE, NULL); ++#endif ++ ++#ifdef CONFIG_DFS_MASTER ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) ++ rtw_dfs_master_status_apply(padapter, MLME_AP_STOPPED); ++ else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) ++ rtw_dfs_master_status_apply(padapter, MLME_STA_DISCONNECTED); ++#endif ++ ++ { ++ u8 ch, bw, offset; ++ ++ if (rtw_mi_get_ch_setting_union_no_self(padapter, &ch, &bw, &offset) != 0) { ++ set_channel_bwmode(padapter, ch, offset, bw); ++ rtw_mi_update_union_chan_inf(padapter, ch, offset, bw); ++ } ++ } ++ ++ flush_all_cam_entry(padapter); ++ ++ _cancel_timer_ex(&pmlmeext->link_timer); ++ ++ /* pmlmepriv->LinkDetectInfo.TrafficBusyState = _FALSE; */ ++ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; ++ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; ++ ++#ifdef CONFIG_TDLS ++ padapter->tdlsinfo.ap_prohibited = _FALSE; ++ ++ /* For TDLS channel switch, currently we only allow it to work in wifi logo test mode */ ++ if (padapter->registrypriv.wifi_spec == 1) ++ padapter->tdlsinfo.ch_switch_prohibited = _FALSE; ++#endif /* CONFIG_TDLS */ ++ ++} ++ ++void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) ++{ ++ struct sta_info *psta, *psta_bmc; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 join_type; ++#ifdef CONFIG_ARP_KEEP_ALIVE ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++#endif ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++ if (join_res < 0) { ++ join_type = 1; ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); ++ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); ++ ++ goto exit_mlmeext_joinbss_event_callback; ++ } ++#ifdef CONFIG_ARP_KEEP_ALIVE ++ pmlmepriv->bGetGateway = 1; ++ pmlmepriv->GetGatewayTryCnt = 0; ++#endif ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { ++ /* update bc/mc sta_info */ ++#ifdef CONFIG_AP_MODE ++ update_bmc_sta(padapter); ++#endif ++ } ++ ++ ++ /* turn on dynamic functions */ ++ /* Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, _TRUE); */ ++ ++ /* update IOT-releated issue */ ++ update_IOT_info(padapter); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, cur_network->SupportedRates); ++ ++ /* BCN interval */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&pmlmeinfo->bcn_interval)); ++ ++ /* udpate capability */ ++ update_capinfo(padapter, pmlmeinfo->capability); ++ ++ /* WMM, Update EDCA param */ ++ WMMOnAssocRsp(padapter); ++ ++ /* HT */ ++ HTOnAssocRsp(padapter); ++ ++#ifdef CONFIG_80211AC_VHT ++ /* VHT */ ++ VHTOnAssocRsp(padapter); ++#endif ++ ++ psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); ++ if (psta) { /* only for infra. mode */ ++ /* RTW_INFO("set_sta_rate\n"); */ ++ ++ psta->wireless_mode = pmlmeext->cur_wireless_mode; ++ ++ /* set per sta rate after updating HT cap. */ ++ set_sta_rate(padapter, psta); ++ ++ rtw_sta_media_status_rpt(padapter, psta, 1); ++ ++ /* wakeup macid after join bss successfully to ensure ++ the subsequent data frames can be sent out normally */ ++ rtw_hal_macid_wakeup(padapter, psta->mac_id); ++ } ++ ++#ifndef CONFIG_IOCTL_CFG80211 ++ if (is_wep_enc(psecuritypriv->dot11PrivacyAlgrthm)) ++ rtw_sec_restore_wep_key(padapter); ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++ if (rtw_port_switch_chk(padapter) == _TRUE) ++ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); ++ ++ join_type = 2; ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) { ++ /* correcting TSF */ ++ correct_TSF(padapter, pmlmeext); ++ ++ /* set_link_timer(pmlmeext, DISCONNECT_TO); */ ++ } ++ ++#ifdef CONFIG_LPS ++ if (get_hw_port(padapter) == HW_PORT0) ++ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_CONNECT, 0); ++#endif ++ ++#ifdef CONFIG_BEAMFORMING ++ if (psta) ++ beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_ENTER, (u8 *)psta, sizeof(struct sta_info), 0); ++#endif/*CONFIG_BEAMFORMING*/ ++ ++exit_mlmeext_joinbss_event_callback: ++ ++ rtw_join_done_chk_ch(padapter, join_res); ++ ++ RTW_INFO("=>%s - End to Connection without 4-way\n", __FUNCTION__); ++} ++ ++/* currently only adhoc mode will go here */ ++void mlmeext_sta_add_event_callback(_adapter *padapter, struct sta_info *psta) ++{ ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 join_type; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { ++ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) { /* adhoc master or sta_count>1 */ ++ /* nothing to do */ ++ } else { /* adhoc client */ ++ /* update TSF Value */ ++ /* update_TSF(pmlmeext, pframe, len); */ ++ ++ /* correcting TSF */ ++ correct_TSF(padapter, pmlmeext); ++ ++ /* start beacon */ ++ if (send_beacon(padapter) == _FAIL) ++ rtw_warn_on(1); ++ ++ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; ++ } ++ ++ join_type = 2; ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); ++ } ++ ++ /* update adhoc sta_info */ ++ update_sta_info(padapter, psta); ++ ++ rtw_hal_update_sta_rate_mask(padapter, psta); ++ ++ /* ToDo: HT for Ad-hoc */ ++ psta->wireless_mode = rtw_check_network_type(psta->bssrateset, psta->bssratelen, pmlmeext->cur_channel); ++ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); ++ ++ /* rate radaptive */ ++ Update_RA_Entry(padapter, psta); ++} ++ ++void mlmeext_sta_del_event_callback(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if (is_client_associated_to_ap(padapter) || is_IBSS_empty(padapter)) ++ rtw_mlmeext_disconnect(padapter); ++ ++} ++ ++/**************************************************************************** ++ ++Following are the functions for the timer handlers ++ ++*****************************************************************************/ ++void _linked_info_dump(_adapter *padapter) ++{ ++ int i; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ HAL_DATA_TYPE *HalData = GET_HAL_DATA(padapter); ++ int UndecoratedSmoothedPWDB = 0; ++ ++ if (padapter->bLinkInfoDump) { ++ ++ RTW_INFO("\n============["ADPT_FMT"] linked status check ===================\n", ADPT_ARG(padapter)); ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) { ++ rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); ++ ++ RTW_INFO("AP[" MAC_FMT "] - UndecoratedSmoothedPWDB:%d\n", ++ MAC_ARG(padapter->mlmepriv.cur_network.network.MacAddress), UndecoratedSmoothedPWDB); ++#ifdef CONFIG_AP_MODE ++ } else if ((pmlmeinfo->state & 0x03) == _HW_STATE_AP_) { ++ _irqL irqL; ++ _list *phead, *plist; ++ ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ plist = get_next(plist); ++ ++ RTW_INFO("STA[" MAC_FMT "]:UndecoratedSmoothedPWDB:%d\n", ++ MAC_ARG(psta->hwaddr), psta->rssi_stat.UndecoratedSmoothedPWDB); ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++#endif ++ } ++ ++ /*============ tx info ============ */ ++ rtw_hal_get_def_var(padapter, HW_DEF_RA_INFO_DUMP, RTW_DBGDUMP); ++ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_RX_INFO_DUMP, RTW_DBGDUMP, _FALSE); ++ ++ } ++ ++ ++} ++void rtw_delba_check(_adapter *padapter, struct sta_info *psta, u8 from_timer) ++{ ++ int i = 0; ++ int ret = _SUCCESS; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ /* ++ IOT issue,occur Broadcom ap(Buffalo WZR-D1800H,Netgear R6300). ++ AP is originator.AP does not transmit unicast packets when STA response its BAR. ++ This case probably occur ap issue BAR after AP builds BA. ++ ++ Follow 802.11 spec, STA shall maintain an inactivity timer for every negotiated Block Ack setup. ++ The inactivity timer is not reset when MPDUs corresponding to other TIDs are received. ++ */ ++ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_BROADCOM) { ++ for (i = 0; i < TID_NUM ; i++) { ++ if ((psta->recvreorder_ctrl[i].enable) && ++ (sta_rx_data_qos_pkts(psta, i) == sta_last_rx_data_qos_pkts(psta, i)) ) { ++ if (_TRUE == rtw_inc_and_chk_continual_no_rx_packet(psta, i)) { ++ /* send a DELBA frame to the peer STA with the Reason Code field set to TIMEOUT */ ++ if (!from_timer) ++ ret = issue_del_ba_ex(padapter, psta->hwaddr, i, 39, 0, 3, 1); ++ else ++ issue_del_ba(padapter, psta->hwaddr, i, 39, 0); ++ psta->recvreorder_ctrl[i].enable = _FALSE; ++ if (ret != _FAIL) ++ psta->recvreorder_ctrl[i].ampdu_size = RX_AMPDU_SIZE_INVALID; ++ rtw_reset_continual_no_rx_packet(psta, i); ++ } ++ } else { ++ /* The inactivity timer is reset when MPDUs to the TID is received. */ ++ rtw_reset_continual_no_rx_packet(psta, i); ++ } ++ } ++ } ++} ++ ++u8 chk_ap_is_alive(_adapter *padapter, struct sta_info *psta) ++{ ++ u8 ret = _FALSE; ++ int i = 0; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++#ifdef DBG_EXPIRATION_CHK ++ RTW_INFO(FUNC_ADPT_FMT" rx:"STA_PKTS_FMT", beacon:%llu, probersp_to_self:%llu" ++ /*", probersp_bm:%llu, probersp_uo:%llu, probereq:%llu, BI:%u"*/ ++ ", retry:%u\n" ++ , FUNC_ADPT_ARG(padapter) ++ , STA_RX_PKTS_DIFF_ARG(psta) ++ , psta->sta_stats.rx_beacon_pkts - psta->sta_stats.last_rx_beacon_pkts ++ , psta->sta_stats.rx_probersp_pkts - psta->sta_stats.last_rx_probersp_pkts ++ /*, psta->sta_stats.rx_probersp_bm_pkts - psta->sta_stats.last_rx_probersp_bm_pkts ++ , psta->sta_stats.rx_probersp_uo_pkts - psta->sta_stats.last_rx_probersp_uo_pkts ++ , psta->sta_stats.rx_probereq_pkts - psta->sta_stats.last_rx_probereq_pkts ++ , pmlmeinfo->bcn_interval*/ ++ , pmlmeext->retry ++ ); ++ ++ RTW_INFO(FUNC_ADPT_FMT" tx_pkts:%llu, link_count:%u\n", FUNC_ADPT_ARG(padapter) ++ , padapter->xmitpriv.tx_pkts ++ , pmlmeinfo->link_count ++ ); ++#endif ++ ++ if ((sta_rx_data_pkts(psta) == sta_last_rx_data_pkts(psta)) ++ && sta_rx_beacon_pkts(psta) == sta_last_rx_beacon_pkts(psta) ++ && sta_rx_probersp_pkts(psta) == sta_last_rx_probersp_pkts(psta) ++ ) ++ ret = _FALSE; ++ else ++ ret = _TRUE; ++ ++ sta_update_last_rx_pkts(psta); ++ ++ /* ++ record last rx data packets for every tid. ++ */ ++ for (i = 0; i < TID_NUM; i++) ++ psta->sta_stats.last_rx_data_qos_pkts[i] = psta->sta_stats.rx_data_qos_pkts[i]; ++ ++ return ret; ++} ++ ++u8 chk_adhoc_peer_is_alive(struct sta_info *psta) ++{ ++ u8 ret = _TRUE; ++ ++#ifdef DBG_EXPIRATION_CHK ++ RTW_INFO("sta:"MAC_FMT", rssi:%d, rx:"STA_PKTS_FMT", beacon:%llu, probersp_to_self:%llu" ++ /*", probersp_bm:%llu, probersp_uo:%llu, probereq:%llu, BI:%u"*/ ++ ", expire_to:%u\n" ++ , MAC_ARG(psta->hwaddr) ++ , psta->rssi_stat.UndecoratedSmoothedPWDB ++ , STA_RX_PKTS_DIFF_ARG(psta) ++ , psta->sta_stats.rx_beacon_pkts - psta->sta_stats.last_rx_beacon_pkts ++ , psta->sta_stats.rx_probersp_pkts - psta->sta_stats.last_rx_probersp_pkts ++ /*, psta->sta_stats.rx_probersp_bm_pkts - psta->sta_stats.last_rx_probersp_bm_pkts ++ , psta->sta_stats.rx_probersp_uo_pkts - psta->sta_stats.last_rx_probersp_uo_pkts ++ , psta->sta_stats.rx_probereq_pkts - psta->sta_stats.last_rx_probereq_pkts ++ , pmlmeinfo->bcn_interval*/ ++ , psta->expire_to ++ ); ++#endif ++ ++ if (sta_rx_data_pkts(psta) == sta_last_rx_data_pkts(psta) ++ && sta_rx_beacon_pkts(psta) == sta_last_rx_beacon_pkts(psta) ++ && sta_rx_probersp_pkts(psta) == sta_last_rx_probersp_pkts(psta)) ++ ret = _FALSE; ++ ++ sta_update_last_rx_pkts(psta); ++ ++ return ret; ++} ++ ++#ifdef CONFIG_TDLS ++u8 chk_tdls_peer_sta_is_alive(_adapter *padapter, struct sta_info *psta) ++{ ++ if ((psta->sta_stats.rx_data_pkts == psta->sta_stats.last_rx_data_pkts) ++ && (psta->sta_stats.rx_tdls_disc_rsp_pkts == psta->sta_stats.last_rx_tdls_disc_rsp_pkts)) ++ return _FALSE; ++ ++ return _TRUE; ++} ++ ++void linked_status_chk_tdls(_adapter *padapter) ++{ ++ struct candidate_pool { ++ struct sta_info *psta; ++ u8 addr[ETH_ALEN]; ++ }; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ _irqL irqL; ++ u8 ack_chk; ++ struct sta_info *psta; ++ int i, num_teardown = 0, num_checkalive = 0; ++ _list *plist, *phead; ++ struct tdls_txmgmt txmgmt; ++ struct candidate_pool checkalive[MAX_ALLOWED_TDLS_STA_NUM]; ++ struct candidate_pool teardown[MAX_ALLOWED_TDLS_STA_NUM]; ++ u8 tdls_sta_max = _FALSE; ++ ++#define ALIVE_MIN 2 ++#define ALIVE_MAX 5 ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ _rtw_memset(checkalive, 0x00, sizeof(checkalive)); ++ _rtw_memset(teardown, 0x00, sizeof(teardown)); ++ ++ if ((padapter->tdlsinfo.link_established == _TRUE)) { ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ for (i = 0; i < NUM_STA; i++) { ++ phead = &(pstapriv->sta_hash[i]); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); ++ plist = get_next(plist); ++ ++ if (psta->tdls_sta_state & TDLS_LINKED_STATE) { ++ psta->alive_count++; ++ if (psta->alive_count >= ALIVE_MIN) { ++ if (chk_tdls_peer_sta_is_alive(padapter, psta) == _FALSE) { ++ if (psta->alive_count < ALIVE_MAX) { ++ _rtw_memcpy(checkalive[num_checkalive].addr, psta->hwaddr, ETH_ALEN); ++ checkalive[num_checkalive].psta = psta; ++ num_checkalive++; ++ } else { ++ _rtw_memcpy(teardown[num_teardown].addr, psta->hwaddr, ETH_ALEN); ++ teardown[num_teardown].psta = psta; ++ num_teardown++; ++ } ++ } else ++ psta->alive_count = 0; ++ } ++ psta->sta_stats.last_rx_data_pkts = psta->sta_stats.rx_data_pkts; ++ psta->sta_stats.last_rx_tdls_disc_rsp_pkts = psta->sta_stats.rx_tdls_disc_rsp_pkts; ++ ++ if ((num_checkalive >= MAX_ALLOWED_TDLS_STA_NUM) || (num_teardown >= MAX_ALLOWED_TDLS_STA_NUM)) { ++ tdls_sta_max = _TRUE; ++ break; ++ } ++ } ++ } ++ ++ if (tdls_sta_max == _TRUE) ++ break; ++ } ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ if (num_checkalive > 0) { ++ for (i = 0; i < num_checkalive; i++) { ++ _rtw_memcpy(txmgmt.peer, checkalive[i].addr, ETH_ALEN); ++ issue_tdls_dis_req(padapter, &txmgmt); ++ issue_tdls_dis_req(padapter, &txmgmt); ++ issue_tdls_dis_req(padapter, &txmgmt); ++ } ++ } ++ ++ if (num_teardown > 0) { ++ for (i = 0; i < num_teardown; i++) { ++ RTW_INFO("[%s %d] Send teardown to "MAC_FMT"\n", __FUNCTION__, __LINE__, MAC_ARG(teardown[i].addr)); ++ txmgmt.status_code = _RSON_TDLS_TEAR_TOOFAR_; ++ _rtw_memcpy(txmgmt.peer, teardown[i].addr, ETH_ALEN); ++ issue_tdls_teardown(padapter, &txmgmt, _FALSE); ++ } ++ } ++ } ++ ++} ++#endif /* CONFIG_TDLS */ ++ ++/* from_timer == 1 means driver is in LPS */ ++void linked_status_chk(_adapter *padapter, u8 from_timer) ++{ ++ u32 i; ++ struct sta_info *psta; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++#if defined(CONFIG_ARP_KEEP_ALIVE) || defined(CONFIG_LAYER2_ROAMING) ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++#endif ++#ifdef CONFIG_LAYER2_ROAMING ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++#endif ++ ++ if (padapter->registrypriv.mp_mode == _TRUE) ++ return; ++ ++ if (is_client_associated_to_ap(padapter)) { ++ /* linked infrastructure client mode */ ++ ++ int tx_chk = _SUCCESS, rx_chk = _SUCCESS; ++ int rx_chk_limit; ++ int link_count_limit; ++ ++#ifdef CONFIG_LAYER2_ROAMING ++ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ACTIVE)) { ++ RTW_INFO("signal_strength_data.avg_val = %d\n", precvpriv->signal_strength_data.avg_val); ++ if (precvpriv->signal_strength_data.avg_val < pmlmepriv->roam_rssi_threshold) { ++ pmlmepriv->need_to_roam = _TRUE; ++ rtw_drv_scan_by_self(padapter, RTW_AUTO_SCAN_REASON_ROAM); ++ } else { ++ pmlmepriv->need_to_roam = _FALSE; ++ } ++ } ++#endif ++#ifdef CONFIG_MCC_MODE ++ /* ++ * due to tx ps null date to ao, so ap doest not tx pkt to driver ++ * we may check chk_ap_is_alive fail, and may issue_probereq to wrong channel under sitesurvey ++ * don't keep alive check under MCC ++ */ ++ if (rtw_hal_mcc_link_status_chk(padapter, __func__) == _FALSE) ++ return; ++#endif ++ ++#if defined(DBG_ROAMING_TEST) ++ rx_chk_limit = 1; ++#elif defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && !defined(CONFIG_LPS_LCLK_WD_TIMER) ++ rx_chk_limit = 4; ++#else ++ rx_chk_limit = 8; ++#endif ++#ifdef CONFIG_ARP_KEEP_ALIVE ++ if (!from_timer && pmlmepriv->bGetGateway == 1 && pmlmepriv->GetGatewayTryCnt < 3) { ++ RTW_INFO("do rtw_gw_addr_query() : %d\n", pmlmepriv->GetGatewayTryCnt); ++ pmlmepriv->GetGatewayTryCnt++; ++ if (rtw_gw_addr_query(padapter) == 0) ++ pmlmepriv->bGetGateway = 0; ++ else { ++ _rtw_memset(pmlmepriv->gw_ip, 0, 4); ++ _rtw_memset(pmlmepriv->gw_mac_addr, 0, 6); ++ } ++ } ++#endif ++#ifdef CONFIG_P2P ++ if (!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE)) { ++ if (!from_timer) ++ link_count_limit = 3; /* 8 sec */ ++ else ++ link_count_limit = 15; /* 32 sec */ ++ } else ++#endif /* CONFIG_P2P */ ++ { ++ if (!from_timer) ++ link_count_limit = 7; /* 16 sec */ ++ else ++ link_count_limit = 29; /* 60 sec */ ++ } ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_TDLS_CH_SW ++ if (ATOMIC_READ(&padapter->tdlsinfo.chsw_info.chsw_on) == _TRUE) ++ return; ++#endif /* CONFIG_TDLS_CH_SW */ ++ ++#ifdef CONFIG_TDLS_AUTOCHECKALIVE ++ linked_status_chk_tdls(padapter); ++#endif /* CONFIG_TDLS_AUTOCHECKALIVE */ ++#endif /* CONFIG_TDLS */ ++ ++ psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); ++ if (psta != NULL) { ++ bool is_p2p_enable = _FALSE; ++#ifdef CONFIG_P2P ++ is_p2p_enable = !rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE); ++#endif ++ ++#ifdef CONFIG_DELBA_CHECK ++ /*issue delba when ap does not tx data packet that is Broadcom ap */ ++ rtw_delba_check(padapter, psta, from_timer); ++#endif ++ if (chk_ap_is_alive(padapter, psta) == _FALSE) ++ rx_chk = _FAIL; ++ ++ if (pxmitpriv->last_tx_pkts == pxmitpriv->tx_pkts) ++ tx_chk = _FAIL; ++ ++#if defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && !defined(CONFIG_LPS_LCLK_WD_TIMER) ++ if (pmlmeext->active_keep_alive_check && (rx_chk == _FAIL || tx_chk == _FAIL) ++ #ifdef CONFIG_MCC_MODE ++ /* Driver don't know operation channel under MCC*/ ++ /* So driver don't do KEEP_ALIVE_CHECK */ ++ && (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) ++ #endif ++ ) { ++ u8 backup_ch = 0, backup_bw, backup_offset; ++ u8 union_ch = 0, union_bw, union_offset; ++ ++ if (!rtw_mi_get_ch_setting_union(padapter, &union_ch, &union_bw, &union_offset) ++ || pmlmeext->cur_channel != union_ch) ++ goto bypass_active_keep_alive; ++ ++ /* switch to correct channel of current network before issue keep-alive frames */ ++ if (rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) { ++ backup_ch = rtw_get_oper_ch(padapter); ++ backup_bw = rtw_get_oper_bw(padapter); ++ backup_offset = rtw_get_oper_choffset(padapter); ++ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); ++ } ++ ++ if (rx_chk != _SUCCESS) ++ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, psta->hwaddr, 0, 0, 3, 1); ++ ++ if ((tx_chk != _SUCCESS && pmlmeinfo->link_count++ == link_count_limit) || rx_chk != _SUCCESS) { ++ tx_chk = issue_nulldata(padapter, psta->hwaddr, 0, 3, 1); ++ /* if tx acked and p2p disabled, set rx_chk _SUCCESS to reset retry count */ ++ if (tx_chk == _SUCCESS && !is_p2p_enable) ++ rx_chk = _SUCCESS; ++ } ++ ++ /* back to the original operation channel */ ++ if (backup_ch > 0) ++ set_channel_bwmode(padapter, backup_ch, backup_offset, backup_bw); ++ ++bypass_active_keep_alive: ++ ; ++ } else ++#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ ++ { ++ if (rx_chk != _SUCCESS) { ++ if (pmlmeext->retry == 0) { ++#ifdef DBG_EXPIRATION_CHK ++ RTW_INFO("issue_probereq to trigger probersp, retry=%d\n", pmlmeext->retry); ++#endif ++ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); ++ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); ++ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); ++ } ++ } ++ ++ if (tx_chk != _SUCCESS && pmlmeinfo->link_count++ == link_count_limit ++#ifdef CONFIG_MCC_MODE ++ /* FW tx nulldata under MCC mode, we just check ap is alive */ ++ && (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) ++#endif /* CONFIG_MCC_MODE */ ++ ) { ++#ifdef DBG_EXPIRATION_CHK ++ RTW_INFO("%s issue_nulldata(%d)\n", __FUNCTION__, from_timer ? 1 : 0); ++#endif ++ tx_chk = issue_nulldata_in_interrupt(padapter, NULL, from_timer ? 1 : 0); ++ } ++ } ++ ++ if (rx_chk == _FAIL) { ++ pmlmeext->retry++; ++ if (pmlmeext->retry > rx_chk_limit) { ++ RTW_PRINT(FUNC_ADPT_FMT" disconnect or roaming\n", ++ FUNC_ADPT_ARG(padapter)); ++ receive_disconnect(padapter, pmlmeinfo->network.MacAddress ++ , WLAN_REASON_EXPIRATION_CHK, _FALSE); ++ return; ++ } ++ } else ++ pmlmeext->retry = 0; ++ ++ if (tx_chk == _FAIL) ++ pmlmeinfo->link_count %= (link_count_limit + 1); ++ else { ++ pxmitpriv->last_tx_pkts = pxmitpriv->tx_pkts; ++ pmlmeinfo->link_count = 0; ++ } ++ ++ } /* end of if ((psta = rtw_get_stainfo(pstapriv, passoc_res->network.MacAddress)) != NULL) */ ++ ++ } else if (is_client_associated_to_ibss(padapter)) { ++ _irqL irqL; ++ _list *phead, *plist, dlist; ++ ++ _rtw_init_listhead(&dlist); ++ ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ for (i = 0; i < NUM_STA; i++) { ++ ++ phead = &(pstapriv->sta_hash[i]); ++ plist = get_next(phead); ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); ++ plist = get_next(plist); ++ ++ if (is_broadcast_mac_addr(psta->hwaddr)) ++ continue; ++ ++ if (chk_adhoc_peer_is_alive(psta) || !psta->expire_to) ++ psta->expire_to = pstapriv->adhoc_expire_to; ++ else ++ psta->expire_to--; ++ ++ if (psta->expire_to <= 0) { ++ rtw_list_delete(&psta->list); ++ rtw_list_insert_tail(&psta->list, &dlist); ++ } ++ } ++ } ++ ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ plist = get_next(&dlist); ++ while (rtw_end_of_queue_search(&dlist, plist) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, list); ++ plist = get_next(plist); ++ rtw_list_delete(&psta->list); ++ RTW_INFO(FUNC_ADPT_FMT" ibss expire "MAC_FMT"\n" ++ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->hwaddr)); ++ report_del_sta_event(padapter, psta->hwaddr, WLAN_REASON_EXPIRATION_CHK, from_timer ? _TRUE : _FALSE, _FALSE); ++ } ++ } ++ ++} ++ ++void survey_timer_hdl(_adapter *padapter) ++{ ++ struct cmd_obj *cmd; ++ struct sitesurvey_parm *psurveyPara; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif ++ ++ if (mlmeext_scan_state(pmlmeext) > SCAN_DISABLE) { ++ cmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (cmd == NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ psurveyPara = (struct sitesurvey_parm *)rtw_zmalloc(sizeof(struct sitesurvey_parm)); ++ if (psurveyPara == NULL) { ++ rtw_warn_on(1); ++ rtw_mfree((unsigned char *)cmd, sizeof(struct cmd_obj)); ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(cmd, psurveyPara, GEN_CMD_CODE(_SiteSurvey)); ++ rtw_enqueue_cmd(pcmdpriv, cmd); ++ } ++ ++exit: ++ return; ++} ++ ++void link_timer_hdl(_adapter *padapter) ++{ ++ /* static unsigned int rx_pkt = 0; */ ++ /* static u64 tx_cnt = 0; */ ++ /* struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); */ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ /* struct sta_priv *pstapriv = &padapter->stapriv; */ ++#ifdef CONFIG_RTW_80211R ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta = NULL; ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); ++#endif ++ ++ if (pmlmeinfo->state & WIFI_FW_AUTH_NULL) { ++ RTW_INFO("link_timer_hdl:no beacon while connecting\n"); ++ pmlmeinfo->state = WIFI_FW_NULL_STATE; ++ report_join_res(padapter, -3); ++ } else if (pmlmeinfo->state & WIFI_FW_AUTH_STATE) { ++ /* re-auth timer */ ++ if (++pmlmeinfo->reauth_count > REAUTH_LIMIT) { ++ /* if (pmlmeinfo->auth_algo != dot11AuthAlgrthm_Auto) */ ++ /* { */ ++ pmlmeinfo->state = 0; ++ report_join_res(padapter, -1); ++ return; ++ /* } */ ++ /* else */ ++ /* { */ ++ /* pmlmeinfo->auth_algo = dot11AuthAlgrthm_Shared; */ ++ /* pmlmeinfo->reauth_count = 0; */ ++ /* } */ ++ } ++ ++ RTW_INFO("link_timer_hdl: auth timeout and try again\n"); ++ pmlmeinfo->auth_seq = 1; ++ issue_auth(padapter, NULL, 0); ++ set_link_timer(pmlmeext, REAUTH_TO); ++ } else if (pmlmeinfo->state & WIFI_FW_ASSOC_STATE) { ++ /* re-assoc timer */ ++ if (++pmlmeinfo->reassoc_count > REASSOC_LIMIT) { ++ pmlmeinfo->state = WIFI_FW_NULL_STATE; ++#ifdef CONFIG_RTW_80211R ++ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { ++ psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); ++ if (psta) ++ rtw_free_stainfo(padapter, psta); ++ } ++#endif ++ report_join_res(padapter, -2); ++ return; ++ } ++ ++#ifdef CONFIG_RTW_80211R ++ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { ++ RTW_INFO("link_timer_hdl: reassoc timeout and try again\n"); ++ issue_reassocreq(padapter); ++ } else ++#endif ++ { ++ RTW_INFO("link_timer_hdl: assoc timeout and try again\n"); ++ issue_assocreq(padapter); ++ } ++ ++ set_link_timer(pmlmeext, REASSOC_TO); ++ } ++ ++ return; ++} ++ ++void addba_timer_hdl(struct sta_info *psta) ++{ ++#ifdef CONFIG_80211N_HT ++ struct ht_priv *phtpriv; ++ ++ if (!psta) ++ return; ++ ++ phtpriv = &psta->htpriv; ++ ++ if ((phtpriv->ht_option == _TRUE) && (phtpriv->ampdu_enable == _TRUE)) { ++ if (phtpriv->candidate_tid_bitmap) ++ phtpriv->candidate_tid_bitmap = 0x0; ++ ++ } ++#endif /* CONFIG_80211N_HT */ ++} ++ ++#ifdef CONFIG_IEEE80211W ++void report_sta_timeout_event(_adapter *padapter, u8 *MacAddr, unsigned short reason) ++{ ++ struct cmd_obj *pcmd_obj; ++ u8 *pevtcmd; ++ u32 cmdsz; ++ struct sta_info *psta; ++ int mac_id; ++ struct stadel_event *pdel_sta_evt; ++ struct C2HEvent_Header *pc2h_evt_hdr; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ ++ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmd_obj == NULL) ++ return; ++ ++ cmdsz = (sizeof(struct stadel_event) + sizeof(struct C2HEvent_Header)); ++ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); ++ if (pevtcmd == NULL) { ++ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); ++ return; ++ } ++ ++ _rtw_init_listhead(&pcmd_obj->list); ++ ++ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); ++ pcmd_obj->cmdsz = cmdsz; ++ pcmd_obj->parmbuf = pevtcmd; ++ ++ pcmd_obj->rsp = NULL; ++ pcmd_obj->rspsz = 0; ++ ++ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); ++ pc2h_evt_hdr->len = sizeof(struct stadel_event); ++ pc2h_evt_hdr->ID = GEN_EVT_CODE(_TimeoutSTA); ++ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); ++ ++ pdel_sta_evt = (struct stadel_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); ++ _rtw_memcpy((unsigned char *)(&(pdel_sta_evt->macaddr)), MacAddr, ETH_ALEN); ++ _rtw_memcpy((unsigned char *)(pdel_sta_evt->rsvd), (unsigned char *)(&reason), 2); ++ ++ ++ psta = rtw_get_stainfo(&padapter->stapriv, MacAddr); ++ if (psta) ++ mac_id = (int)psta->mac_id; ++ else ++ mac_id = (-1); ++ ++ pdel_sta_evt->mac_id = mac_id; ++ ++ RTW_INFO("report_del_sta_event: delete STA, mac_id=%d\n", mac_id); ++ ++ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); ++ ++ return; ++} ++ ++void clnt_sa_query_timeout(_adapter *padapter) ++{ ++ ++ rtw_disassoc_cmd(padapter, 0, _TRUE); ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ rtw_free_assoc_resources(padapter, 1); ++ ++ RTW_INFO("SA query timeout client disconnect\n"); ++} ++ ++void sa_query_timer_hdl(struct sta_info *psta) ++{ ++ _adapter *padapter = psta->padapter; ++ _irqL irqL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE && ++ check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ clnt_sa_query_timeout(padapter); ++ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ report_sta_timeout_event(padapter, psta->hwaddr, WLAN_REASON_PREV_AUTH_NOT_VALID); ++} ++ ++#endif /* CONFIG_IEEE80211W */ ++ ++#ifdef CONFIG_RTW_80211R ++void start_clnt_ft_action(_adapter *padapter, u8 *pTargetAddr) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ rtw_set_ft_status(padapter, RTW_FT_REQUESTING_STA); ++ issue_action_ft_request(padapter, pTargetAddr); ++ _set_timer(&pmlmeext->ft_link_timer, REASSOC_TO); ++} ++ ++void ft_link_timer_hdl(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ft_priv *pftpriv = &pmlmepriv->ftpriv; ++ ++ if (rtw_chk_ft_status(padapter, RTW_FT_REQUESTING_STA)) { ++ if (pftpriv->ft_req_retry_cnt < FT_ACTION_REQ_LIMIT) { ++ pftpriv->ft_req_retry_cnt++; ++ issue_action_ft_request(padapter, (u8 *)pmlmepriv->roam_network->network.MacAddress); ++ _set_timer(&pmlmeext->ft_link_timer, REASSOC_TO); ++ } else { ++ pftpriv->ft_req_retry_cnt = 0; ++ ++ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) ++ rtw_set_ft_status(padapter, RTW_FT_ASSOCIATED_STA); ++ else ++ rtw_reset_ft_status(padapter); ++ } ++ } ++} ++ ++void ft_roam_timer_hdl(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ receive_disconnect(padapter, pmlmepriv->cur_network.network.MacAddress ++ , WLAN_REASON_ACTIVE_ROAM, _FALSE); ++} ++ ++void issue_action_ft_request(_adapter *padapter, u8 *pTargetAddr) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct xmit_frame *pmgntframe = NULL; ++ struct rtw_ieee80211_hdr *pwlanhdr = NULL; ++ struct pkt_attrib *pattrib = NULL; ++ ft_priv *pftpriv = NULL; ++ u8 *pframe = NULL; ++ u8 category = RTW_WLAN_CATEGORY_FT; ++ u8 action = RTW_WLAN_ACTION_FT_REQUEST; ++ u8 is_ft_roaming_with_rsn_ie = _TRUE; ++ u8 *pie = NULL; ++ u16 *fctrl = NULL; ++ u32 ft_ie_len = 0; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ ++ _rtw_memcpy(pframe, adapter_mac_addr(padapter), ETH_ALEN); ++ pframe += ETH_ALEN; ++ pattrib->pktlen += ETH_ALEN; ++ ++ _rtw_memcpy(pframe, pTargetAddr, ETH_ALEN); ++ pframe += ETH_ALEN; ++ pattrib->pktlen += ETH_ALEN; ++ ++ pftpriv = &pmlmepriv->ftpriv; ++ pie = rtw_get_ie(pftpriv->updated_ft_ies, EID_WPA2, &ft_ie_len, pftpriv->updated_ft_ies_len); ++ if (pie) ++ pframe = rtw_set_ie(pframe, EID_WPA2, ft_ie_len, pie+2, &(pattrib->pktlen)); ++ else ++ is_ft_roaming_with_rsn_ie = _FALSE; ++ ++ pie = rtw_get_ie(pftpriv->updated_ft_ies, _MDIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); ++ if (pie) ++ pframe = rtw_set_ie(pframe, _MDIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); ++ ++ pie = rtw_get_ie(pftpriv->updated_ft_ies, _FTIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); ++ if (pie && is_ft_roaming_with_rsn_ie) ++ pframe = rtw_set_ie(pframe, _FTIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ dump_mgntframe(padapter, pmgntframe); ++} ++ ++void report_ft_event(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ft_priv *pftpriv = &pmlmepriv->ftpriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); ++ struct cfg80211_ft_event_params ft_evt_parms; ++ _irqL irqL; ++ ++ _rtw_memset(&ft_evt_parms, 0, sizeof(ft_evt_parms)); ++ rtw_update_ft_stainfo(padapter, pnetwork); ++ ++ if (!pnetwork) ++ goto err_2; ++ ++ ft_evt_parms.ies_len = pftpriv->ft_event.ies_len; ++ ft_evt_parms.ies = rtw_zmalloc(ft_evt_parms.ies_len); ++ if (ft_evt_parms.ies) ++ _rtw_memcpy((void *)ft_evt_parms.ies, pftpriv->ft_event.ies, ft_evt_parms.ies_len); ++ else ++ goto err_2; ++ ++ ft_evt_parms.target_ap = rtw_zmalloc(ETH_ALEN); ++ if (ft_evt_parms.target_ap) ++ _rtw_memcpy((void *)ft_evt_parms.target_ap, pnetwork->MacAddress, ETH_ALEN); ++ else ++ goto err_1; ++ ++ ft_evt_parms.ric_ies = pftpriv->ft_event.ric_ies; ++ ft_evt_parms.ric_ies_len = pftpriv->ft_event.ric_ies_len; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ rtw_set_ft_status(padapter, RTW_FT_AUTHENTICATED_STA); ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ rtw_cfg80211_ft_event(padapter, &ft_evt_parms); ++ RTW_INFO("FT: report_ft_event\n"); ++ rtw_mfree((u8 *)pftpriv->ft_event.target_ap, ETH_ALEN); ++err_1: ++ rtw_mfree((u8 *)ft_evt_parms.ies, ft_evt_parms.ies_len); ++err_2: ++ return; ++} ++ ++void report_ft_reassoc_event(_adapter *padapter, u8 *pMacAddr) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ struct cmd_obj *pcmd_obj = NULL; ++ struct stassoc_event *passoc_sta_evt = NULL; ++ struct C2HEvent_Header *pc2h_evt_hdr = NULL; ++ u8 *pevtcmd = NULL; ++ u32 cmdsz = 0; ++ ++ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (pcmd_obj == NULL) ++ return; ++ ++ cmdsz = (sizeof(struct stassoc_event) + sizeof(struct C2HEvent_Header)); ++ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); ++ if (pevtcmd == NULL) { ++ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); ++ return; ++ } ++ ++ _rtw_init_listhead(&pcmd_obj->list); ++ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); ++ pcmd_obj->cmdsz = cmdsz; ++ pcmd_obj->parmbuf = pevtcmd; ++ pcmd_obj->rsp = NULL; ++ pcmd_obj->rspsz = 0; ++ ++ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); ++ pc2h_evt_hdr->len = sizeof(struct stassoc_event); ++ pc2h_evt_hdr->ID = GEN_EVT_CODE(_FT_REASSOC); ++ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); ++ ++ passoc_sta_evt = (struct stassoc_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); ++ _rtw_memcpy((unsigned char *)(&(passoc_sta_evt->macaddr)), pMacAddr, ETH_ALEN); ++ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); ++} ++#endif ++ ++u8 NULL_hdl(_adapter *padapter, u8 *pbuf) ++{ ++ return H2C_SUCCESS; ++} ++ ++#ifdef CONFIG_AUTO_AP_MODE ++void rtw_start_auto_ap(_adapter *adapter) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ rtw_set_802_11_infrastructure_mode(adapter, Ndis802_11APMode); ++ ++ rtw_setopmode_cmd(adapter, Ndis802_11APMode, _TRUE); ++} ++ ++static int rtw_auto_ap_start_beacon(_adapter *adapter) ++{ ++ int ret = 0; ++ u8 *pbuf = NULL; ++ uint len; ++ u8 supportRate[16]; ++ int sz = 0, rateLen; ++ u8 *ie; ++ u8 wireless_mode, oper_channel; ++ u8 ssid[3] = {0}; /* hidden ssid */ ++ u32 ssid_len = sizeof(ssid); ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ return -EINVAL; ++ ++ ++ len = 128; ++ pbuf = rtw_zmalloc(len); ++ if (!pbuf) ++ return -ENOMEM; ++ ++ ++ /* generate beacon */ ++ ie = pbuf; ++ ++ /* timestamp will be inserted by hardware */ ++ sz += 8; ++ ie += sz; ++ ++ /* beacon interval : 2bytes */ ++ *(u16 *)ie = cpu_to_le16((u16)100); /* BCN_INTERVAL=100; */ ++ sz += 2; ++ ie += 2; ++ ++ /* capability info */ ++ *(u16 *)ie = 0; ++ *(u16 *)ie |= cpu_to_le16(cap_ESS); ++ *(u16 *)ie |= cpu_to_le16(cap_ShortPremble); ++ /* *(u16*)ie |= cpu_to_le16(cap_Privacy); */ ++ sz += 2; ++ ie += 2; ++ ++ /* SSID */ ++ ie = rtw_set_ie(ie, _SSID_IE_, ssid_len, ssid, &sz); ++ ++ /* supported rates */ ++ wireless_mode = WIRELESS_11BG_24N; ++ rtw_set_supported_rate(supportRate, wireless_mode) ; ++ rateLen = rtw_get_rateset_len(supportRate); ++ if (rateLen > 8) ++ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, 8, supportRate, &sz); ++ else ++ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, rateLen, supportRate, &sz); ++ ++ ++ /* DS parameter set */ ++ if (rtw_mi_check_status(adapter, MI_LINKED)) ++ oper_channel = rtw_mi_get_union_chan(adapter); ++ else ++ oper_channel = adapter_to_dvobj(adapter)->oper_channel; ++ ++ ie = rtw_set_ie(ie, _DSSET_IE_, 1, &oper_channel, &sz); ++ ++ /* ext supported rates */ ++ if (rateLen > 8) ++ ie = rtw_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rateLen - 8), (supportRate + 8), &sz); ++ ++ RTW_INFO("%s, start auto ap beacon sz=%d\n", __FUNCTION__, sz); ++ ++ /* lunch ap mode & start to issue beacon */ ++ if (rtw_check_beacon_data(adapter, pbuf, sz) == _SUCCESS) { ++ ++ } else ++ ret = -EINVAL; ++ ++ ++ rtw_mfree(pbuf, len); ++ ++ return ret; ++ ++} ++#endif/* CONFIG_AUTO_AP_MODE */ ++ ++u8 setopmode_hdl(_adapter *padapter, u8 *pbuf) ++{ ++ u8 type; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct setopmode_parm *psetop = (struct setopmode_parm *)pbuf; ++ ++ if (psetop->mode == Ndis802_11APMode) { ++ pmlmeinfo->state = WIFI_FW_AP_STATE; ++ type = _HW_STATE_AP_; ++#ifdef CONFIG_NATIVEAP_MLME ++ /* start_ap_mode(padapter); */ ++#endif ++ } else if (psetop->mode == Ndis802_11Infrastructure) { ++ pmlmeinfo->state &= ~(BIT(0) | BIT(1)); /* clear state */ ++ pmlmeinfo->state |= WIFI_FW_STATION_STATE;/* set to STATION_STATE */ ++ type = _HW_STATE_STATION_; ++ } else if (psetop->mode == Ndis802_11IBSS) ++ type = _HW_STATE_ADHOC_; ++ else if (psetop->mode == Ndis802_11Monitor) ++ type = _HW_STATE_MONITOR_; ++ else ++ type = _HW_STATE_NOLINK_; ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_SET_OPMODE, (u8 *)(&type)); ++ ++#ifdef CONFIG_AUTO_AP_MODE ++ if (psetop->mode == Ndis802_11APMode) ++ rtw_auto_ap_start_beacon(padapter); ++#endif ++ ++ if (rtw_port_switch_chk(padapter) == _TRUE) { ++ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); ++ ++ if (psetop->mode == Ndis802_11APMode) ++ adapter_to_pwrctl(padapter)->fw_psmode_iface_id = 0xff; /* ap mode won't dowload rsvd pages */ ++ else if (psetop->mode == Ndis802_11Infrastructure) { ++#ifdef CONFIG_LPS ++ _adapter *port0_iface = dvobj_get_port0_adapter(adapter_to_dvobj(padapter)); ++ if (port0_iface) ++ rtw_lps_ctrl_wk_cmd(port0_iface, LPS_CTRL_CONNECT, 0); ++#endif ++ } ++ } ++ ++#ifdef CONFIG_BT_COEXIST ++ if (psetop->mode == Ndis802_11APMode || ++ psetop->mode == Ndis802_11Monitor) { ++ /* Do this after port switch to */ ++ /* prevent from downloading rsvd page to wrong port */ ++ rtw_btcoex_MediaStatusNotify(padapter, 1); /* connect */ ++ } ++#endif /* CONFIG_BT_COEXIST */ ++ ++ return H2C_SUCCESS; ++ ++} ++ ++u8 createbss_hdl(_adapter *padapter, u8 *pbuf) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); ++ WLAN_BSSID_EX *pdev_network = &padapter->registrypriv.dev_network; ++ struct createbss_parm *parm = (struct createbss_parm *)pbuf; ++ u8 ret = H2C_SUCCESS; ++ /* u8 initialgain; */ ++ ++#ifdef CONFIG_AP_MODE ++ if (pmlmeinfo->state == WIFI_FW_AP_STATE) { ++ start_bss_network(padapter, parm); ++ goto exit; ++ } ++#endif ++ ++ /* below is for ad-hoc master */ ++ if (parm->adhoc) { ++ rtw_warn_on(pdev_network->InfrastructureMode != Ndis802_11IBSS); ++ rtw_joinbss_reset(padapter); ++ ++ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ pmlmeinfo->ERP_enable = 0; ++ pmlmeinfo->WMM_enable = 0; ++ pmlmeinfo->HT_enable = 0; ++ pmlmeinfo->HT_caps_enable = 0; ++ pmlmeinfo->HT_info_enable = 0; ++ pmlmeinfo->agg_enable_bitmap = 0; ++ pmlmeinfo->candidate_tid_bitmap = 0; ++ ++ /* config the initial gain under linking, need to write the BB registers */ ++ /* initialgain = 0x1E; */ ++ /*rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE);*/ ++ ++ /* disable dynamic functions, such as high power, DIG */ ++ rtw_phydm_ability_backup(padapter); ++ rtw_phydm_func_disable_all(padapter); ++ ++ /* cancel link timer */ ++ _cancel_timer_ex(&pmlmeext->link_timer); ++ ++ /* clear CAM */ ++ flush_all_cam_entry(padapter); ++ ++ pdev_network->Length = get_WLAN_BSSID_EX_sz(pdev_network); ++ _rtw_memcpy(pnetwork, pdev_network, FIELD_OFFSET(WLAN_BSSID_EX, IELength)); ++ pnetwork->IELength = pdev_network->IELength; ++ ++ if (pnetwork->IELength > MAX_IE_SZ) { ++ ret = H2C_PARAMETERS_ERROR; ++ goto ibss_post_hdl; ++ } ++ ++ _rtw_memcpy(pnetwork->IEs, pdev_network->IEs, pnetwork->IELength); ++ start_create_ibss(padapter); ++ } else { ++ rtw_warn_on(1); ++ ret = H2C_PARAMETERS_ERROR; ++ } ++ ++ibss_post_hdl: ++ rtw_create_ibss_post_hdl(padapter, ret); ++ ++exit: ++ return ret; ++} ++ ++u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) ++{ ++ u8 join_type; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ struct joinbss_parm *pparm = (struct joinbss_parm *)pbuf; ++#endif /* CONFIG_ANTENNA_DIVERSITY */ ++ u32 i; ++ /* u8 initialgain; */ ++ /* u32 acparm; */ ++ u8 u_ch, u_bw, u_offset; ++ u8 doiqk = _FALSE; ++ ++ /* check already connecting to AP or not */ ++ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) { ++ if (pmlmeinfo->state & WIFI_FW_STATION_STATE) ++ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 1, 100); ++ pmlmeinfo->state = WIFI_FW_NULL_STATE; ++ ++ /* clear CAM */ ++ flush_all_cam_entry(padapter); ++ ++ _cancel_timer_ex(&pmlmeext->link_timer); ++ ++ /* set MSR to nolink->infra. mode */ ++ /* Set_MSR(padapter, _HW_STATE_NOLINK_); */ ++ Set_MSR(padapter, _HW_STATE_STATION_); ++ ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, 0); ++ } ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ rtw_antenna_select_cmd(padapter, pparm->network.PhyInfo.Optimum_antenna, _FALSE); ++#endif ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ rtw_wapi_clear_all_cam_entry(padapter); ++#endif ++ ++ rtw_joinbss_reset(padapter); ++ ++ pmlmeinfo->ERP_enable = 0; ++ pmlmeinfo->WMM_enable = 0; ++ pmlmeinfo->HT_enable = 0; ++ pmlmeinfo->HT_caps_enable = 0; ++ pmlmeinfo->HT_info_enable = 0; ++ pmlmeinfo->agg_enable_bitmap = 0; ++ pmlmeinfo->candidate_tid_bitmap = 0; ++ pmlmeinfo->bwmode_updated = _FALSE; ++ /* pmlmeinfo->assoc_AP_vendor = HT_IOT_PEER_MAX; */ ++ pmlmeinfo->VHT_enable = 0; ++ ++ _rtw_memcpy(pnetwork, pbuf, FIELD_OFFSET(WLAN_BSSID_EX, IELength)); ++ pnetwork->IELength = ((WLAN_BSSID_EX *)pbuf)->IELength; ++ ++ if (pnetwork->IELength > MAX_IE_SZ) /* Check pbuf->IELength */ ++ return H2C_PARAMETERS_ERROR; ++ ++ if (pnetwork->IELength < 2) { ++ report_join_res(padapter, (-4)); ++ return H2C_SUCCESS; ++ } ++ _rtw_memcpy(pnetwork->IEs, ((WLAN_BSSID_EX *)pbuf)->IEs, pnetwork->IELength); ++ ++ pmlmeinfo->bcn_interval = get_beacon_interval(pnetwork); ++ ++ /* Check AP vendor to move rtw_joinbss_cmd() */ ++ /* pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->IEs, pnetwork->IELength); */ ++ ++ /* sizeof(NDIS_802_11_FIXED_IEs) */ ++ for (i = _FIXED_IE_LENGTH_ ; i < pnetwork->IELength - 2 ;) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(pnetwork->IEs + i); ++ ++ switch (pIE->ElementID) { ++ case _VENDOR_SPECIFIC_IE_: /* Get WMM IE. */ ++ if (_rtw_memcmp(pIE->data, WMM_OUI, 4)) ++ WMM_param_handler(padapter, pIE); ++ break; ++ ++#ifdef CONFIG_80211N_HT ++ case _HT_CAPABILITY_IE_: /* Get HT Cap IE. */ ++ pmlmeinfo->HT_caps_enable = 1; ++ break; ++ ++ case _HT_EXTRA_INFO_IE_: /* Get HT Info IE. */ ++ pmlmeinfo->HT_info_enable = 1; ++ break; ++#endif /* CONFIG_80211N_HT */ ++ ++#ifdef CONFIG_80211AC_VHT ++ case EID_VHTCapability: /* Get VHT Cap IE. */ ++ pmlmeinfo->VHT_enable = 1; ++ break; ++ ++ case EID_VHTOperation: /* Get VHT Operation IE. */ ++ break; ++#endif /* CONFIG_80211AC_VHT */ ++ default: ++ break; ++ } ++ ++ i += (pIE->Length + 2); ++ } ++ ++ rtw_bss_get_chbw(pnetwork ++ , &pmlmeext->cur_channel, &pmlmeext->cur_bwmode, &pmlmeext->cur_ch_offset); ++ ++#ifdef CONFIG_80211N_HT ++ rtw_adjust_chbw(padapter, pmlmeext->cur_channel, &pmlmeext->cur_bwmode, ++ &pmlmeext->cur_ch_offset); ++#endif ++ ++#if 0 ++ if (padapter->registrypriv.wifi_spec) { ++ /* for WiFi test, follow WMM test plan spec */ ++ acparm = 0x002F431C; /* VO */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm)); ++ acparm = 0x005E541C; /* VI */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm)); ++ acparm = 0x0000A525; /* BE */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); ++ acparm = 0x0000A549; /* BK */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); ++ ++ /* for WiFi test, mixed mode with intel STA under bg mode throughput issue */ ++ if (padapter->mlmepriv.htpriv.ht_option == _FALSE) { ++ acparm = 0x00004320; ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); ++ } ++ } else { ++ acparm = 0x002F3217; /* VO */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm)); ++ acparm = 0x005E4317; /* VI */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm)); ++ acparm = 0x00105320; /* BE */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); ++ acparm = 0x0000A444; /* BK */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); ++ } ++#endif ++ ++ /* check channel, bandwidth, offset and switch */ ++ if (rtw_chk_start_clnt_join(padapter, &u_ch, &u_bw, &u_offset) == _FAIL) { ++ report_join_res(padapter, (-4)); ++ return H2C_SUCCESS; ++ } ++ ++ /* disable dynamic functions, such as high power, DIG */ ++ /*rtw_phydm_func_disable_all(padapter);*/ ++ ++ /* config the initial gain under linking, need to write the BB registers */ ++ /* initialgain = 0x1E; */ ++ /*rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE);*/ ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress); ++ join_type = 0; ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); ++ doiqk = _TRUE; ++ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); ++ ++ set_channel_bwmode(padapter, u_ch, u_offset, u_bw); ++ rtw_mi_update_union_chan_inf(padapter, u_ch, u_offset, u_bw); ++ ++ doiqk = _FALSE; ++ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); ++ ++ /* cancel link timer */ ++ _cancel_timer_ex(&pmlmeext->link_timer); ++ ++ start_clnt_join(padapter); ++ ++ return H2C_SUCCESS; ++ ++} ++ ++u8 disconnect_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++ struct disconnect_parm *param = (struct disconnect_parm *)pbuf; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); ++ u8 val8; ++ ++ if (is_client_associated_to_ap(padapter)) { ++#ifdef CONFIG_DFS ++ if (padapter->mlmepriv.handle_dfs == _FALSE) ++#endif /* CONFIG_DFS */ ++#ifdef CONFIG_PLATFORM_ROCKCHIPS ++ /* To avoid connecting to AP fail during resume process, change retry count from 5 to 1 */ ++ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 1, 100); ++#else ++ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, param->deauth_timeout_ms / 100, 100); ++#endif /* CONFIG_PLATFORM_ROCKCHIPS */ ++ } ++ ++#ifdef CONFIG_DFS ++ if (padapter->mlmepriv.handle_dfs == _TRUE) ++ padapter->mlmepriv.handle_dfs = _FALSE; ++#endif /* CONFIG_DFS */ ++ ++ if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) { ++ /* Stop BCN */ ++ val8 = 0; ++ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_FUNC, (u8 *)(&val8)); ++ } ++ ++ rtw_mlmeext_disconnect(padapter); ++ ++ rtw_free_uc_swdec_pending_queue(padapter); ++ ++ return H2C_SUCCESS; ++} ++ ++static const char *const _scan_state_str[] = { ++ "SCAN_DISABLE", ++ "SCAN_START", ++ "SCAN_PS_ANNC_WAIT", ++ "SCAN_ENTER", ++ "SCAN_PROCESS", ++ "SCAN_BACKING_OP", ++ "SCAN_BACK_OP", ++ "SCAN_LEAVING_OP", ++ "SCAN_LEAVE_OP", ++ "SCAN_SW_ANTDIV_BL", ++ "SCAN_TO_P2P_LISTEN", ++ "SCAN_P2P_LISTEN", ++ "SCAN_COMPLETE", ++ "SCAN_STATE_MAX", ++}; ++ ++const char *scan_state_str(u8 state) ++{ ++ state = (state >= SCAN_STATE_MAX) ? SCAN_STATE_MAX : state; ++ return _scan_state_str[state]; ++} ++ ++static bool scan_abort_hdl(_adapter *adapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct ss_res *ss = &pmlmeext->sitesurvey_res; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &adapter->wdinfo; ++#endif ++ bool ret = _FALSE; ++ ++ if (pmlmeext->scan_abort == _TRUE) { ++#ifdef CONFIG_P2P ++ if (!rtw_p2p_chk_state(&adapter->wdinfo, P2P_STATE_NONE)) { ++ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_MAX); ++ ss->channel_idx = 3; ++ RTW_INFO("%s idx:%d, cnt:%u\n", __FUNCTION__ ++ , ss->channel_idx ++ , pwdinfo->find_phase_state_exchange_cnt ++ ); ++ } else ++#endif ++ { ++ ss->channel_idx = ss->ch_num; ++ RTW_INFO("%s idx:%d\n", __FUNCTION__ ++ , ss->channel_idx ++ ); ++ } ++ pmlmeext->scan_abort = _FALSE; ++ ret = _TRUE; ++ } ++ ++ return ret; ++} ++ ++u8 rtw_scan_sparse(_adapter *adapter, struct rtw_ieee80211_channel *ch, u8 ch_num) ++{ ++ /* interval larger than this is treated as backgroud scan */ ++#ifndef RTW_SCAN_SPARSE_BG_INTERVAL_MS ++#define RTW_SCAN_SPARSE_BG_INTERVAL_MS 12000 ++#endif ++ ++#ifndef RTW_SCAN_SPARSE_CH_NUM_MIRACAST ++#define RTW_SCAN_SPARSE_CH_NUM_MIRACAST 1 ++#endif ++#ifndef RTW_SCAN_SPARSE_CH_NUM_BG ++#define RTW_SCAN_SPARSE_CH_NUM_BG 4 ++#endif ++#ifdef CONFIG_LAYER2_ROAMING ++#ifndef RTW_SCAN_SPARSE_CH_NUM_ROAMING_ACTIVE ++#define RTW_SCAN_SPARSE_CH_NUM_ROAMING_ACTIVE 1 ++#endif ++#endif ++ ++#define SCAN_SPARSE_CH_NUM_INVALID 255 ++ ++ static u8 token = 255; ++ u32 interval; ++ bool busy_traffic = _FALSE; ++ bool miracast_enabled = _FALSE; ++ bool bg_scan = _FALSE; ++ u8 max_allow_ch = SCAN_SPARSE_CH_NUM_INVALID; ++ u8 scan_division_num; ++ u8 ret_num = ch_num; ++ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ ++ if (regsty->wifi_spec) ++ goto exit; ++ ++ /* assume ch_num > 6 is normal scan */ ++ if (ch_num <= 6) ++ goto exit; ++ ++ if (mlmeext->last_scan_time == 0) ++ mlmeext->last_scan_time = rtw_get_current_time(); ++ ++ interval = rtw_get_passing_time_ms(mlmeext->last_scan_time); ++ ++ ++ if (rtw_mi_busy_traffic_check(adapter, _FALSE)) ++ busy_traffic = _TRUE; ++ ++ if (rtw_mi_check_miracast_enabled(adapter)) ++ miracast_enabled = _TRUE; ++ ++ if (interval > RTW_SCAN_SPARSE_BG_INTERVAL_MS) ++ bg_scan = _TRUE; ++ ++ /* max_allow_ch by conditions*/ ++ ++#if RTW_SCAN_SPARSE_MIRACAST ++ if (miracast_enabled == _TRUE && busy_traffic == _TRUE) ++ max_allow_ch = rtw_min(max_allow_ch, RTW_SCAN_SPARSE_CH_NUM_MIRACAST); ++#endif ++ ++#if RTW_SCAN_SPARSE_BG ++ if (bg_scan == _TRUE) ++ max_allow_ch = rtw_min(max_allow_ch, RTW_SCAN_SPARSE_CH_NUM_BG); ++#endif ++ ++#if defined(CONFIG_LAYER2_ROAMING) && defined(RTW_SCAN_SPARSE_ROAMING_ACTIVE) ++ if (rtw_chk_roam_flags(adapter, RTW_ROAM_ACTIVE)) { ++ if (busy_traffic == _TRUE && adapter->mlmepriv.need_to_roam == _TRUE) ++ max_allow_ch = rtw_min(max_allow_ch, RTW_SCAN_SPARSE_CH_NUM_ROAMING_ACTIVE); ++ } ++#endif ++ ++ ++ if (max_allow_ch != SCAN_SPARSE_CH_NUM_INVALID) { ++ int i; ++ int k = 0; ++ ++ scan_division_num = (ch_num / max_allow_ch) + ((ch_num % max_allow_ch) ? 1 : 0); ++ token = (token + 1) % scan_division_num; ++ ++ if (0) ++ RTW_INFO("scan_division_num:%u, token:%u\n", scan_division_num, token); ++ ++ for (i = 0; i < ch_num; i++) { ++ if (ch[i].hw_value && (i % scan_division_num) == token ++ ) { ++ if (i != k) ++ _rtw_memcpy(&ch[k], &ch[i], sizeof(struct rtw_ieee80211_channel)); ++ k++; ++ } ++ } ++ ++ _rtw_memset(&ch[k], 0, sizeof(struct rtw_ieee80211_channel)); ++ ++ ret_num = k; ++ mlmeext->last_scan_time = rtw_get_current_time(); ++ } ++ ++exit: ++ return ret_num; ++} ++ ++static int rtw_scan_ch_decision(_adapter *padapter, struct rtw_ieee80211_channel *out, ++ u32 out_num, struct rtw_ieee80211_channel *in, u32 in_num) ++{ ++ int i, j; ++ int scan_ch_num = 0; ++ int set_idx; ++ u8 chan; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ /* clear first */ ++ _rtw_memset(out, 0, sizeof(struct rtw_ieee80211_channel) * out_num); ++ ++ /* acquire channels from in */ ++ j = 0; ++ for (i = 0; i < in_num; i++) { ++ ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" "CHAN_FMT"\n", FUNC_ADPT_ARG(padapter), CHAN_ARG(&in[i])); ++ ++ if (!in[i].hw_value || (in[i].flags & RTW_IEEE80211_CHAN_DISABLED)) ++ continue; ++ if (rtw_mlme_band_check(padapter, in[i].hw_value) == _FALSE) ++ continue; ++ ++ set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, in[i].hw_value); ++ if (set_idx >= 0) { ++ if (j >= out_num) { ++ RTW_PRINT(FUNC_ADPT_FMT" out_num:%u not enough\n", ++ FUNC_ADPT_ARG(padapter), out_num); ++ break; ++ } ++ ++ _rtw_memcpy(&out[j], &in[i], sizeof(struct rtw_ieee80211_channel)); ++ ++ if (pmlmeext->channel_set[set_idx].ScanType == SCAN_PASSIVE) ++ out[j].flags |= RTW_IEEE80211_CHAN_PASSIVE_SCAN; ++ ++ j++; ++ } ++ if (j >= out_num) ++ break; ++ } ++ ++ /* if out is empty, use channel_set as default */ ++ if (j == 0) { ++ for (i = 0; i < pmlmeext->max_chan_nums; i++) { ++ chan = pmlmeext->channel_set[i].ChannelNum; ++ if (rtw_mlme_band_check(padapter, chan) == _TRUE) { ++ if (rtw_mlme_ignore_chan(padapter, chan) == _TRUE) ++ continue; ++ ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" ch:%u\n", FUNC_ADPT_ARG(padapter), chan); ++ ++ if (j >= out_num) { ++ RTW_PRINT(FUNC_ADPT_FMT" out_num:%u not enough\n", ++ FUNC_ADPT_ARG(padapter), out_num); ++ break; ++ } ++ ++ out[j].hw_value = chan; ++ ++ if (pmlmeext->channel_set[i].ScanType == SCAN_PASSIVE) ++ out[j].flags |= RTW_IEEE80211_CHAN_PASSIVE_SCAN; ++ ++ j++; ++ } ++ } ++ } ++ ++ /* scan_sparse */ ++ j = rtw_scan_sparse(padapter, out, j); ++ ++ return j; ++} ++ ++static void sitesurvey_res_reset(_adapter *adapter, struct sitesurvey_parm *parm) ++{ ++ struct ss_res *ss = &adapter->mlmeextpriv.sitesurvey_res; ++ int i; ++ ++ ss->bss_cnt = 0; ++ ss->channel_idx = 0; ++ ss->igi_scan = 0; ++ ss->igi_before_scan = 0; ++#ifdef CONFIG_SCAN_BACKOP ++ ss->scan_cnt = 0; ++#endif ++#if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) ++ ss->is_sw_antdiv_bl_scan = 0; ++#endif ++ ++ for (i = 0; i < RTW_SSID_SCAN_AMOUNT; i++) { ++ if (parm->ssid[i].SsidLength) { ++ _rtw_memcpy(ss->ssid[i].Ssid, parm->ssid[i].Ssid, IW_ESSID_MAX_SIZE); ++ ss->ssid[i].SsidLength = parm->ssid[i].SsidLength; ++ } else ++ ss->ssid[i].SsidLength = 0; ++ } ++ ++ ss->ch_num = rtw_scan_ch_decision(adapter ++ , ss->ch, RTW_CHANNEL_SCAN_AMOUNT ++ , parm->ch, parm->ch_num ++ ); ++ ++ ss->scan_mode = parm->scan_mode; ++} ++ ++static u8 sitesurvey_pick_ch_behavior(_adapter *padapter, u8 *ch, RT_SCAN_TYPE *type) ++{ ++ u8 next_state; ++ u8 scan_ch = 0; ++ RT_SCAN_TYPE scan_type = SCAN_PASSIVE; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; ++ struct ss_res *ss = &pmlmeext->sitesurvey_res; ++ ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++#endif ++ ++ /* handle scan abort request */ ++ scan_abort_hdl(padapter); ++ ++#ifdef CONFIG_P2P ++ if (pwdinfo->rx_invitereq_info.scan_op_ch_only || pwdinfo->p2p_info.scan_op_ch_only) { ++ if (pwdinfo->rx_invitereq_info.scan_op_ch_only) ++ scan_ch = pwdinfo->rx_invitereq_info.operation_ch[ss->channel_idx]; ++ else ++ scan_ch = pwdinfo->p2p_info.operation_ch[ss->channel_idx]; ++ scan_type = SCAN_ACTIVE; ++ } else if (rtw_p2p_findphase_ex_is_social(pwdinfo)) { ++ /* ++ * Commented by Albert 2011/06/03 ++ * The driver is in the find phase, it should go through the social channel. ++ */ ++ int ch_set_idx; ++ ++ scan_ch = pwdinfo->social_chan[ss->channel_idx]; ++ ch_set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, scan_ch); ++ if (ch_set_idx >= 0) ++ scan_type = pmlmeext->channel_set[ch_set_idx].ScanType; ++ else ++ scan_type = SCAN_ACTIVE; ++ } else ++#endif /* CONFIG_P2P */ ++ { ++ struct rtw_ieee80211_channel *ch; ++ ++ if (ss->channel_idx < ss->ch_num) { ++ ch = &ss->ch[ss->channel_idx]; ++ scan_ch = ch->hw_value; ++ scan_type = (ch->flags & RTW_IEEE80211_CHAN_PASSIVE_SCAN) ? SCAN_PASSIVE : SCAN_ACTIVE; ++ } ++ } ++ ++ if (scan_ch != 0) { ++ next_state = SCAN_PROCESS; ++#ifdef CONFIG_SCAN_BACKOP ++ { ++ struct mi_state mstate; ++ u8 backop_flags = 0; ++ ++ rtw_mi_status(padapter, &mstate); ++ ++ if ((MSTATE_STA_LD_NUM(&mstate) && mlmeext_chk_scan_backop_flags_sta(pmlmeext, SS_BACKOP_EN)) ++ || (MSTATE_STA_NUM(&mstate) && mlmeext_chk_scan_backop_flags_sta(pmlmeext, SS_BACKOP_EN_NL))) ++ backop_flags |= mlmeext_scan_backop_flags_sta(pmlmeext); ++ ++ if ((MSTATE_AP_LD_NUM(&mstate) && mlmeext_chk_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN)) ++ || (MSTATE_AP_NUM(&mstate) && mlmeext_chk_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN_NL))) ++ backop_flags |= mlmeext_scan_backop_flags_ap(pmlmeext); ++ ++ if (backop_flags) { ++ if (ss->scan_cnt < ss->scan_cnt_max) ++ ss->scan_cnt++; ++ else { ++ mlmeext_assign_scan_backop_flags(pmlmeext, backop_flags); ++ next_state = SCAN_BACKING_OP; ++ } ++ } ++ } ++#endif /* CONFIG_SCAN_BACKOP */ ++ } else if (rtw_p2p_findphase_ex_is_needed(pwdinfo)) { ++ /* go p2p listen */ ++ next_state = SCAN_TO_P2P_LISTEN; ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ } else if (rtw_hal_antdiv_before_linked(padapter)) { ++ /* go sw antdiv before link */ ++ next_state = SCAN_SW_ANTDIV_BL; ++#endif ++ } else { ++ next_state = SCAN_COMPLETE; ++ ++#if defined(DBG_SCAN_SW_ANTDIV_BL) ++ { ++ /* for SCAN_SW_ANTDIV_BL state testing */ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ int i; ++ bool is_linked = _FALSE; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (rtw_linked_check(dvobj->padapters[i])) ++ is_linked = _TRUE; ++ } ++ ++ if (!is_linked) { ++ static bool fake_sw_antdiv_bl_state = 0; ++ ++ if (fake_sw_antdiv_bl_state == 0) { ++ next_state = SCAN_SW_ANTDIV_BL; ++ fake_sw_antdiv_bl_state = 1; ++ } else ++ fake_sw_antdiv_bl_state = 0; ++ } ++ } ++#endif /* defined(DBG_SCAN_SW_ANTDIV_BL) */ ++ } ++ ++#ifdef CONFIG_SCAN_BACKOP ++ if (next_state != SCAN_PROCESS) ++ ss->scan_cnt = 0; ++#endif ++ ++ ++#ifdef DBG_FIXED_CHAN ++ if (pmlmeext->fixed_chan != 0xff && next_state == SCAN_PROCESS) ++ scan_ch = pmlmeext->fixed_chan; ++#endif ++ ++ if (ch) ++ *ch = scan_ch; ++ if (type) ++ *type = scan_type; ++ ++ return next_state; ++} ++ ++void site_survey(_adapter *padapter, u8 survey_channel, RT_SCAN_TYPE ScanType) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif ++ ++ if (survey_channel != 0) { ++ set_channel_bwmode(padapter, survey_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++ if (ACS_ENABLE == GET_ACS_STATE(padapter)) { ++ ACS_OP acs_op = ACS_RESET; ++ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &acs_op, _TRUE); ++ rtw_set_acs_channel(padapter, survey_channel); ++#ifdef DBG_AUTO_CHNL_SEL_NHM ++ RTW_INFO("[ACS-"ADPT_FMT"]-set ch:%u\n", ++ ADPT_ARG(padapter), rtw_get_acs_channel(padapter)); ++#endif ++ } ++#endif ++ ++ if (ScanType == SCAN_ACTIVE) { ++#ifdef CONFIG_P2P ++ #ifdef CONFIG_IOCTL_CFG80211 ++ if (rtw_cfg80211_is_p2p_scan(padapter)) ++ #else ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) ++ || rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH)) ++ #endif ++ { ++ issue_probereq_p2p(padapter, NULL); ++ issue_probereq_p2p(padapter, NULL); ++ issue_probereq_p2p(padapter, NULL); ++ } else ++#endif /* CONFIG_P2P */ ++ { ++ int i; ++ ++ for (i = 0; i < RTW_SSID_SCAN_AMOUNT; i++) { ++ if (pmlmeext->sitesurvey_res.ssid[i].SsidLength) { ++ /* IOT issue, When wifi_spec is not set, send one probe req without WPS IE. */ ++ if (padapter->registrypriv.wifi_spec) ++ issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); ++ else ++ issue_probereq_ex(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL, 0, 0, 0, 0); ++ issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); ++ } ++ } ++ ++ if (pmlmeext->sitesurvey_res.scan_mode == SCAN_ACTIVE) { ++ /* IOT issue, When wifi_spec is not set, send one probe req without WPS IE. */ ++ if (padapter->registrypriv.wifi_spec) ++ issue_probereq(padapter, NULL, NULL); ++ else ++ issue_probereq_ex(padapter, NULL, NULL, 0, 0, 0, 0); ++ issue_probereq(padapter, NULL, NULL); ++ } ++ } ++ } ++ } else { ++ /* channel number is 0 or this channel is not valid. */ ++ rtw_warn_on(1); ++ } ++ ++ return; ++} ++ ++void survey_done_set_ch_bw(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ u8 cur_channel = 0; ++ u8 cur_bwmode; ++ u8 cur_ch_offset; ++ ++#ifdef CONFIG_MCC_MODE ++ if (!rtw_hal_mcc_change_scan_flag(padapter, &cur_channel, &cur_bwmode, &cur_ch_offset)) { ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" back to AP channel - ch:%u, bw:%u, offset:%u\n", ++ FUNC_ADPT_ARG(padapter), cur_channel, cur_bwmode, cur_ch_offset); ++ goto exit; ++ } ++#endif ++ ++ if (rtw_mi_get_ch_setting_union(padapter, &cur_channel, &cur_bwmode, &cur_ch_offset) != 0) { ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", ++ FUNC_ADPT_ARG(padapter), cur_channel, cur_bwmode, cur_ch_offset); ++ } else { ++#ifdef CONFIG_P2P ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ _adapter *iface; ++ int i; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (!iface) ++ continue; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (iface->wdinfo.driver_interface == DRIVER_CFG80211 && !adapter_wdev_data(iface)->p2p_enabled) ++ continue; ++#endif ++ ++ if (rtw_p2p_chk_state(&iface->wdinfo, P2P_STATE_LISTEN)) { ++ cur_channel = iface->wdinfo.listen_channel; ++ cur_bwmode = CHANNEL_WIDTH_20; ++ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" back to "ADPT_FMT"'s listen ch - ch:%u, bw:%u, offset:%u\n", ++ FUNC_ADPT_ARG(padapter), ADPT_ARG(iface), cur_channel, cur_bwmode, cur_ch_offset); ++ break; ++ } ++ } ++#endif /* CONFIG_P2P */ ++ ++ if (cur_channel == 0) { ++ cur_channel = pmlmeext->cur_channel; ++ cur_bwmode = pmlmeext->cur_bwmode; ++ cur_ch_offset = pmlmeext->cur_ch_offset; ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" back to ch:%u, bw:%u, offset:%u\n", ++ FUNC_ADPT_ARG(padapter), cur_channel, cur_bwmode, cur_ch_offset); ++ } ++ } ++exit: ++ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); ++} ++ ++#if 1 ++/** ++ * sitesurvey_ps_annc - check and doing ps announcement for all the adapters of given @dvobj ++ * @padapter ++ * @ps: power saving or not ++ * ++ * Returns: 0: no ps announcement is doing. 1: ps announcement is doing ++ */ ++ ++u8 sitesurvey_ps_annc(_adapter *padapter, bool ps) ++{ ++ u8 ps_anc = 0; ++ ++ if (rtw_mi_issue_nulldata(padapter, NULL, ps, 3, 500)) ++ ps_anc = 1; ++ return ps_anc; ++} ++#else ++/** ++ * sitesurvey_ps_annc - check and doing ps announcement for all the adapters of given @dvobj ++ * @dvobj: the dvobj to check ++ * @ps: power saving or not ++ * ++ * Returns: 0: no ps announcement is doing. 1: ps announcement is doing ++ */ ++ ++u8 sitesurvey_ps_annc(struct dvobj_priv *dvobj, bool ps) ++{ ++ _adapter *adapter; ++ int i; ++ u8 ps_anc = 0; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ adapter = dvobj->padapters[i]; ++ if (!adapter) ++ continue; ++ ++ if (ps) { ++ if (is_client_associated_to_ap(adapter) == _TRUE) { ++ /* TODO: TDLS peers */ ++ issue_nulldata(adapter, NULL, 1, 3, 500); ++ ps_anc = 1; ++ } ++ } else { ++ if (is_client_associated_to_ap(adapter) == _TRUE) { ++ /* TODO: TDLS peers */ ++ issue_nulldata(adapter, NULL, 0, 3, 500); ++ ps_anc = 1; ++ } ++ } ++ } ++ return ps_anc; ++} ++#endif ++ ++void sitesurvey_set_igi(_adapter *adapter) ++{ ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ struct ss_res *ss = &mlmeext->sitesurvey_res; ++ u8 igi; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &adapter->wdinfo; ++#endif ++ ++ switch (mlmeext_scan_state(mlmeext)) { ++ case SCAN_ENTER: ++ #ifdef CONFIG_P2P ++ #ifdef CONFIG_IOCTL_CFG80211 ++ if (adapter_wdev_data(adapter)->p2p_enabled == _TRUE && pwdinfo->driver_interface == DRIVER_CFG80211) ++ igi = 0x30; ++ else ++ #endif /* CONFIG_IOCTL_CFG80211 */ ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ igi = 0x28; ++ else ++ #endif /* CONFIG_P2P */ ++ igi = 0x1e; ++ ++ /* record IGI status */ ++ ss->igi_scan = igi; ++ rtw_hal_get_odm_var(adapter, HAL_ODM_INITIAL_GAIN, &ss->igi_before_scan, NULL); ++ ++ /* disable DIG and set IGI for scan */ ++ rtw_hal_set_odm_var(adapter, HAL_ODM_INITIAL_GAIN, &igi, _FALSE); ++ break; ++ case SCAN_COMPLETE: ++ case SCAN_TO_P2P_LISTEN: ++ /* enable DIG and restore IGI */ ++ igi = 0xff; ++ rtw_hal_set_odm_var(adapter, HAL_ODM_INITIAL_GAIN, &igi, _FALSE); ++ break; ++#ifdef CONFIG_SCAN_BACKOP ++ case SCAN_BACKING_OP: ++ /* write IGI for op channel when DIG is not enabled */ ++ ODM_Write_DIG(GET_ODM(adapter), ss->igi_before_scan); ++ break; ++ case SCAN_LEAVE_OP: ++ /* write IGI for scan when DIG is not enabled */ ++ ODM_Write_DIG(GET_ODM(adapter), ss->igi_scan); ++ break; ++#endif /* CONFIG_SCAN_BACKOP */ ++ default: ++ rtw_warn_on(1); ++ break; ++ } ++} ++void sitesurvey_set_msr(_adapter *adapter, bool enter) ++{ ++ u8 network_type; ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if (enter) { ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ rtw_hal_get_hwreg(adapter, HW_VAR_MEDIA_STATUS, (u8 *)(&pmlmeinfo->hw_media_state)); ++#endif ++ /* set MSR to no link state */ ++ network_type = _HW_STATE_NOLINK_; ++ } else { ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ network_type = pmlmeinfo->hw_media_state; ++#else ++ network_type = pmlmeinfo->state & 0x3; ++#endif ++ } ++ Set_MSR(adapter, network_type); ++} ++u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) ++{ ++ struct sitesurvey_parm *pparm = (struct sitesurvey_parm *)pbuf; ++ struct dvobj_priv *dvobj = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct ss_res *ss = &pmlmeext->sitesurvey_res; ++ u8 val8; ++ ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++#endif ++ ++#ifdef DBG_CHECK_FW_PS_STATE ++ if (rtw_fw_ps_state(padapter) == _FAIL) { ++ RTW_INFO("scan without leave 32k\n"); ++ pdbgpriv->dbg_scan_pwr_state_cnt++; ++ } ++#endif /* DBG_CHECK_FW_PS_STATE */ ++ ++ /* increase channel idx */ ++ if (mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS)) ++ ss->channel_idx++; ++ ++ /* update scan state to next state (assigned by previous cmd hdl) */ ++ if (mlmeext_scan_state(pmlmeext) != mlmeext_scan_next_state(pmlmeext)) ++ mlmeext_set_scan_state(pmlmeext, mlmeext_scan_next_state(pmlmeext)); ++ ++operation_by_state: ++ switch (mlmeext_scan_state(pmlmeext)) { ++ ++ case SCAN_DISABLE: ++ /* ++ * SW parameter initialization ++ */ ++ ++ sitesurvey_res_reset(padapter, pparm); ++ mlmeext_set_scan_state(pmlmeext, SCAN_START); ++ goto operation_by_state; ++ ++ case SCAN_START: ++ /* ++ * prepare to leave operating channel ++ */ ++ ++#ifdef CONFIG_MCC_MODE ++ rtw_hal_set_mcc_setting_scan_start(padapter); ++#endif /* CONFIG_MCC_MODE */ ++ ++ /* apply rx ampdu setting */ ++ if (ss->rx_ampdu_accept != RX_AMPDU_ACCEPT_INVALID ++ || ss->rx_ampdu_size != RX_AMPDU_SIZE_INVALID) ++ rtw_rx_ampdu_apply(padapter); ++ ++ /* clear HW TX queue before scan */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); ++ ++ /* power save state announcement */ ++ if (sitesurvey_ps_annc(padapter, 1)) { ++ mlmeext_set_scan_state(pmlmeext, SCAN_PS_ANNC_WAIT); ++ mlmeext_set_scan_next_state(pmlmeext, SCAN_ENTER); ++ set_survey_timer(pmlmeext, 50); /* delay 50ms to protect nulldata(1) */ ++ } else { ++ mlmeext_set_scan_state(pmlmeext, SCAN_ENTER); ++ goto operation_by_state; ++ } ++ ++ break; ++ ++ case SCAN_ENTER: ++ /* ++ * HW register and DM setting for enter scan ++ */ ++ ++ rtw_phydm_ability_backup(padapter); ++ ++ sitesurvey_set_igi(padapter); ++ ++ /* config dynamic functions for off channel */ ++ rtw_phydm_func_for_offchannel(padapter); ++ /* set MSR to no link state */ ++ sitesurvey_set_msr(padapter, _TRUE); ++ ++ val8 = 1; /* under site survey */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ ++ mlmeext_set_scan_state(pmlmeext, SCAN_PROCESS); ++ goto operation_by_state; ++ ++ case SCAN_PROCESS: { ++ u8 scan_ch; ++ RT_SCAN_TYPE scan_type; ++ u8 next_state; ++ u32 scan_ms; ++ ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++ if ((ACS_ENABLE == GET_ACS_STATE(padapter)) && (0 != rtw_get_acs_channel(padapter))) { ++ ACS_OP acs_op = ACS_SELECT; ++ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &acs_op, _TRUE); ++ } ++#endif ++ ++ next_state = sitesurvey_pick_ch_behavior(padapter, &scan_ch, &scan_type); ++ if (next_state != SCAN_PROCESS) { ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++ if (ACS_ENABLE == GET_ACS_STATE(padapter)) { ++ rtw_set_acs_channel(padapter, 0); ++#ifdef DBG_AUTO_CHNL_SEL_NHM ++ RTW_INFO("[ACS-"ADPT_FMT"]-set ch:%u\n", ADPT_ARG(padapter), rtw_get_acs_channel(padapter)); ++#endif ++ } ++#endif ++ ++ mlmeext_set_scan_state(pmlmeext, next_state); ++ goto operation_by_state; ++ } ++ ++ /* still SCAN_PROCESS state */ ++ if (0) ++#ifdef CONFIG_P2P ++ RTW_INFO(FUNC_ADPT_FMT" %s ch:%u (cnt:%u,idx:%d) at %dms, %c%c%c\n" ++ , FUNC_ADPT_ARG(padapter) ++ , mlmeext_scan_state_str(pmlmeext) ++ , scan_ch ++ , pwdinfo->find_phase_state_exchange_cnt, ss->channel_idx ++ , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) ++ , scan_type ? 'A' : 'P', ss->scan_mode ? 'A' : 'P' ++ , ss->ssid[0].SsidLength ? 'S' : ' ' ++ ); ++#else ++ RTW_INFO(FUNC_ADPT_FMT" %s ch:%u (idx:%d) at %dms, %c%c%c\n" ++ , FUNC_ADPT_ARG(padapter) ++ , mlmeext_scan_state_str(pmlmeext) ++ , scan_ch ++ , ss->channel_idx ++ , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) ++ , scan_type ? 'A' : 'P', ss->scan_mode ? 'A' : 'P' ++ , ss->ssid[0].SsidLength ? 'S' : ' ' ++ ); ++#endif /* CONFIG_P2P */ ++ ++#ifdef DBG_FIXED_CHAN ++ if (pmlmeext->fixed_chan != 0xff) ++ RTW_INFO(FUNC_ADPT_FMT" fixed_chan:%u\n", pmlmeext->fixed_chan); ++#endif ++ ++ site_survey(padapter, scan_ch, scan_type); ++ ++#if defined(CONFIG_ATMEL_RC_PATCH) ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ scan_ms = 20; ++ else ++ scan_ms = 40; ++#else ++ scan_ms = ss->scan_ch_ms; ++#endif ++ ++#if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) ++ if (ss->is_sw_antdiv_bl_scan) ++ scan_ms = scan_ms / 2; ++#endif ++ ++#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) ++ { ++ struct noise_info info; ++ ++ info.bPauseDIG = _FALSE; ++ info.IGIValue = 0; ++ info.max_time = scan_ms / 2; ++ info.chan = scan_ch; ++ rtw_hal_set_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &info, _FALSE); ++ } ++#endif ++ ++ set_survey_timer(pmlmeext, scan_ms); ++ break; ++ } ++ ++#ifdef CONFIG_SCAN_BACKOP ++ case SCAN_BACKING_OP: { ++ u8 back_ch, back_bw, back_ch_offset; ++ u8 need_ch_setting_union = _TRUE; ++ ++#ifdef CONFIG_MCC_MODE ++ need_ch_setting_union = rtw_hal_mcc_change_scan_flag(padapter, ++ &back_ch, &back_bw, &back_ch_offset); ++#endif /* CONFIG_MCC_MODE */ ++ ++ if (need_ch_setting_union) { ++ if (rtw_mi_get_ch_setting_union(padapter, &back_ch, &back_bw, &back_ch_offset) == 0) ++ rtw_warn_on(1); ++ } ++ ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" %s ch:%u, bw:%u, offset:%u at %dms\n" ++ , FUNC_ADPT_ARG(padapter) ++ , mlmeext_scan_state_str(pmlmeext) ++ , back_ch, back_bw, back_ch_offset ++ , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) ++ ); ++ ++ set_channel_bwmode(padapter, back_ch, back_ch_offset, back_bw); ++ ++ sitesurvey_set_msr(padapter, _FALSE); ++ ++ val8 = 0; /* survey done */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ ++ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC)) { ++ sitesurvey_set_igi(padapter); ++ sitesurvey_ps_annc(padapter, 0); ++ } ++ ++ mlmeext_set_scan_state(pmlmeext, SCAN_BACK_OP); ++ ss->backop_time = rtw_get_current_time(); ++ ++ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_TX_RESUME)) ++ rtw_mi_os_xmit_schedule(padapter); ++ ++ ++ goto operation_by_state; ++ } ++ ++ case SCAN_BACK_OP: ++ if (rtw_get_passing_time_ms(ss->backop_time) >= ss->backop_ms ++ || pmlmeext->scan_abort ++ ) { ++ mlmeext_set_scan_state(pmlmeext, SCAN_LEAVING_OP); ++ goto operation_by_state; ++ } ++ set_survey_timer(pmlmeext, 50); ++ break; ++ ++ case SCAN_LEAVING_OP: ++ /* ++ * prepare to leave operating channel ++ */ ++ ++ /* clear HW TX queue before scan */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); ++ ++ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC) ++ && sitesurvey_ps_annc(padapter, 1) ++ ) { ++ mlmeext_set_scan_state(pmlmeext, SCAN_PS_ANNC_WAIT); ++ mlmeext_set_scan_next_state(pmlmeext, SCAN_LEAVE_OP); ++ set_survey_timer(pmlmeext, 50); /* delay 50ms to protect nulldata(1) */ ++ } else { ++ mlmeext_set_scan_state(pmlmeext, SCAN_LEAVE_OP); ++ goto operation_by_state; ++ } ++ ++ break; ++ ++ case SCAN_LEAVE_OP: ++ /* ++ * HW register and DM setting for enter scan ++ */ ++ ++ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC)) ++ sitesurvey_set_igi(padapter); ++ ++ sitesurvey_set_msr(padapter, _TRUE); ++ ++ val8 = 1; /* under site survey */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ ++ mlmeext_set_scan_state(pmlmeext, SCAN_PROCESS); ++ goto operation_by_state; ++ ++#endif /* CONFIG_SCAN_BACKOP */ ++ ++#if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) ++ case SCAN_SW_ANTDIV_BL: ++ /* ++ * 20100721 ++ * For SW antenna diversity before link, it needs to switch to another antenna and scan again. ++ * It compares the scan result and select better one to do connection. ++ */ ++ ss->bss_cnt = 0; ++ ss->channel_idx = 0; ++ ss->is_sw_antdiv_bl_scan = 1; ++ ++ mlmeext_set_scan_next_state(pmlmeext, SCAN_PROCESS); ++ set_survey_timer(pmlmeext, ss->scan_ch_ms); ++ break; ++#endif ++ ++#ifdef CONFIG_P2P ++ case SCAN_TO_P2P_LISTEN: ++ /* ++ * Set the P2P State to the listen state of find phase ++ * and set the current channel to the listen channel ++ */ ++ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_LISTEN); ++ ++ /* turn on phy-dynamic functions */ ++ rtw_phydm_ability_restore(padapter); ++ ++ sitesurvey_set_igi(padapter); ++ ++ mlmeext_set_scan_state(pmlmeext, SCAN_P2P_LISTEN); ++ _set_timer(&pwdinfo->find_phase_timer, (u32)((u32)pwdinfo->listen_dwell * 100)); ++ break; ++ ++ case SCAN_P2P_LISTEN: ++ mlmeext_set_scan_state(pmlmeext, SCAN_PROCESS); ++ ss->channel_idx = 0; ++ goto operation_by_state; ++#endif /* CONFIG_P2P */ ++ ++ case SCAN_COMPLETE: ++#ifdef CONFIG_P2P ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) ++ || rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH) ++ ) { ++#ifdef CONFIG_CONCURRENT_MODE ++ if (pwdinfo->driver_interface == DRIVER_WEXT) { ++ if (rtw_mi_check_status(padapter, MI_LINKED)) ++ _set_timer(&pwdinfo->ap_p2p_switch_timer, 500); ++ } ++#endif ++ ++ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); ++ } ++ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); ++#endif /* CONFIG_P2P */ ++ ++ /* switch channel */ ++ survey_done_set_ch_bw(padapter); ++ ++ sitesurvey_set_msr(padapter, _FALSE); ++ ++ val8 = 0; /* survey done */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ ++ /* turn on phy-dynamic functions */ ++ rtw_phydm_ability_restore(padapter); ++ ++ sitesurvey_set_igi(padapter); ++ ++#ifdef CONFIG_MCC_MODE ++ /* start MCC fail, then tx null data */ ++ if (!rtw_hal_set_mcc_setting_scan_complete(padapter)) ++#endif /* CONFIG_MCC_MODE */ ++ sitesurvey_ps_annc(padapter, 0); ++ ++ /* apply rx ampdu setting */ ++ rtw_rx_ampdu_apply(padapter); ++ ++ mlmeext_set_scan_state(pmlmeext, SCAN_DISABLE); ++ ++ report_surveydone_event(padapter); ++ ++ issue_action_BSSCoexistPacket(padapter); ++ issue_action_BSSCoexistPacket(padapter); ++ issue_action_BSSCoexistPacket(padapter); ++ } ++ ++ return H2C_SUCCESS; ++} ++ ++u8 setauth_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++ struct setauth_parm *pparm = (struct setauth_parm *)pbuf; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if (pparm->mode < 4) ++ pmlmeinfo->auth_algo = pparm->mode; ++ ++ return H2C_SUCCESS; ++} ++ ++/* ++SEC CAM Entry format (32 bytes) ++DW0 - MAC_ADDR[15:0] | Valid[15] | MFB[14:8] | RSVD[7] | GK[6] | MIC_KEY[5] | SEC_TYPE[4:2] | KID[1:0] ++DW0 - MAC_ADDR[15:0] | Valid[15] |RSVD[14:9] | RPT_MODE[8] | SPP_MODE[7] | GK[6] | MIC_KEY[5] | SEC_TYPE[4:2] | KID[1:0] (92E/8812A/8814A) ++DW1 - MAC_ADDR[47:16] ++DW2 - KEY[31:0] ++DW3 - KEY[63:32] ++DW4 - KEY[95:64] ++DW5 - KEY[127:96] ++DW6 - RSVD ++DW7 - RSVD ++*/ ++ ++/*Set WEP key or Group Key*/ ++u8 setkey_hdl(_adapter *padapter, u8 *pbuf) ++{ ++ u16 ctrl = 0; ++ s16 cam_id = 0; ++ struct setkey_parm *pparm = (struct setkey_parm *)pbuf; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ unsigned char null_addr[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; ++ u8 *addr; ++ bool used = _FALSE; ++ ++ /* main tx key for wep. */ ++ if (pparm->set_tx) ++ pmlmeinfo->key_index = pparm->keyid; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) ++ cam_id = rtw_iface_bcmc_id_get(padapter); ++ else ++#endif ++ cam_id = rtw_camid_alloc(padapter, NULL, pparm->keyid, &used); ++ ++ if (cam_id < 0) ++ goto enable_mc; ++ ++#ifndef CONFIG_CONCURRENT_MODE ++ if (cam_id >= 0 && cam_id <= 3) ++ addr = null_addr; ++ else ++#endif ++ { ++ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) ++ /* for AP mode ,we will force sec cam entry_id so hw dont search cam when tx*/ ++ addr = adapter_mac_addr(padapter); ++ else ++ /* not default key, searched by A2 */ ++ addr = get_bssid(&padapter->mlmepriv); ++ } ++ ++ /* cam entry searched is pairwise key */ ++ if (used == _TRUE && rtw_camid_is_gk(padapter, cam_id) == _FALSE) { ++ s16 camid_clr; ++ ++ RTW_PRINT(FUNC_ADPT_FMT" group key with "MAC_FMT" id:%u the same key id as pairwise key\n" ++ , FUNC_ADPT_ARG(padapter), MAC_ARG(addr), pparm->keyid); ++ ++ /* HW has problem to distinguish this group key with existing pairwise key, stop HW enc and dec for BMC */ ++ rtw_camctl_set_flags(padapter, SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH); ++ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, NULL); ++ ++ /* clear group key */ ++ while ((camid_clr = rtw_camid_search(padapter, addr, -1, 1)) >= 0) { ++ RTW_PRINT("clear group key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(addr), camid_clr); ++ clear_cam_entry(padapter, camid_clr); ++ rtw_camid_free(padapter, camid_clr); ++ } ++ ++ goto enable_mc; ++ } ++ ++ ctrl = BIT(15) | BIT(6) | ((pparm->algorithm) << 2) | pparm->keyid; ++ ++ RTW_PRINT("set group key camid:%d, addr:"MAC_FMT", kid:%d, type:%s\n" ++ , cam_id, MAC_ARG(addr), pparm->keyid, security_type_str(pparm->algorithm)); ++ ++ write_cam(padapter, cam_id, ctrl, addr, pparm->key); ++ ++ /* if ((cam_id > 3) && (((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE)))*/ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) { ++ if (is_wep_enc(pparm->algorithm)) { ++ padapter->securitypriv.dot11Def_camid[pparm->keyid] = cam_id; ++ padapter->securitypriv.dot118021x_bmc_cam_id = ++ padapter->securitypriv.dot11Def_camid[padapter->securitypriv.dot11PrivacyKeyIndex]; ++ RTW_PRINT("wep group key - force camid:%d\n", padapter->securitypriv.dot118021x_bmc_cam_id); ++ } else { ++ /*u8 org_cam_id = padapter->securitypriv.dot118021x_bmc_cam_id;*/ ++ ++ /*force GK's cam id*/ ++ padapter->securitypriv.dot118021x_bmc_cam_id = cam_id; ++ ++ /* for GTK rekey ++ if ((org_cam_id != INVALID_SEC_MAC_CAM_ID) && ++ (org_cam_id != cam_id)) { ++ RTW_PRINT("clear group key for addr:"MAC_FMT", org_camid:%d new_camid:%d\n", MAC_ARG(addr), org_cam_id, cam_id); ++ clear_cam_entry(padapter, org_cam_id); ++ rtw_camid_free(padapter, org_cam_id); ++ }*/ ++ } ++ } ++#endif ++ ++ ++#ifndef CONFIG_CONCURRENT_MODE ++ if (cam_id >= 0 && cam_id <= 3) ++ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_DK_CFG, (u8 *)_TRUE); ++#endif ++ ++ /* 8814au should set both broadcast and unicast CAM entry for WEP key in STA mode */ ++ if (is_wep_enc(pparm->algorithm) && check_mlmeinfo_state(pmlmeext, WIFI_FW_STATION_STATE) && ++ _rtw_camctl_chk_cap(padapter, SEC_CAP_CHK_BMC)) { ++ struct set_stakey_parm sta_pparm; ++ ++ sta_pparm.algorithm = pparm->algorithm; ++ sta_pparm.keyid = pparm->keyid; ++ _rtw_memcpy(sta_pparm.key, pparm->key, 16); ++ _rtw_memcpy(sta_pparm.addr, get_bssid(&padapter->mlmepriv), ETH_ALEN); ++ set_stakey_hdl(padapter, (u8 *)&sta_pparm); ++ } ++ ++enable_mc: ++ /* allow multicast packets to driver */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_ON_RCR_AM, null_addr); ++ ++ return H2C_SUCCESS; ++} ++ ++void rtw_ap_wep_pk_setting(_adapter *adapter, struct sta_info *psta) ++{ ++ struct security_priv *psecuritypriv = &(adapter->securitypriv); ++ struct set_stakey_parm sta_pparm; ++ sint keyid; ++ ++ if (!is_wep_enc(psecuritypriv->dot11PrivacyAlgrthm)) ++ return; ++ ++ for (keyid = 0; keyid < 4; keyid++) { ++ if ((psecuritypriv->key_mask & BIT(keyid)) && (keyid == psecuritypriv->dot11PrivacyKeyIndex)) { ++ sta_pparm.algorithm = psecuritypriv->dot11PrivacyAlgrthm; ++ sta_pparm.keyid = keyid; ++ _rtw_memcpy(sta_pparm.key, &(psecuritypriv->dot11DefKey[keyid].skey[0]), 16); ++ _rtw_memcpy(sta_pparm.addr, psta->hwaddr, ETH_ALEN); ++ ++ RTW_PRINT(FUNC_ADPT_FMT"set WEP - PK with "MAC_FMT" keyid:%u\n" ++ , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->hwaddr), keyid); ++ ++ set_stakey_hdl(adapter, (u8 *)&sta_pparm); ++ } ++ } ++} ++ ++u8 set_stakey_hdl(_adapter *padapter, u8 *pbuf) ++{ ++ u16 ctrl = 0; ++ s16 cam_id = 0; ++ bool used; ++ u8 kid = 0; ++ u8 ret = H2C_SUCCESS; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct set_stakey_parm *pparm = (struct set_stakey_parm *)pbuf; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta; ++ ++ if (pparm->algorithm == _NO_PRIVACY_) ++ goto write_to_cam; ++ ++ psta = rtw_get_stainfo(pstapriv, pparm->addr); ++ if (!psta) { ++ RTW_PRINT("%s sta:"MAC_FMT" not found\n", __func__, MAC_ARG(pparm->addr)); ++ ret = H2C_REJECTED; ++ goto exit; ++ } ++ ++ pmlmeinfo->enc_algo = pparm->algorithm; ++ if (is_wep_enc(pparm->algorithm)) ++ kid = pparm->keyid; ++ cam_id = rtw_camid_alloc(padapter, psta, kid, &used); ++ if (cam_id < 0) ++ goto exit; ++ ++ /* cam entry searched is group key */ ++ if (used == _TRUE && rtw_camid_is_gk(padapter, cam_id) == _TRUE) { ++ s16 camid_clr; ++ ++ RTW_PRINT(FUNC_ADPT_FMT" pairwise key with "MAC_FMT" id:%u the same key id as group key\n" ++ , FUNC_ADPT_ARG(padapter), MAC_ARG(pparm->addr), pparm->keyid); ++ ++ /* HW has problem to distinguish this pairwise key with existing group key, stop HW enc and dec for BMC */ ++ rtw_camctl_set_flags(padapter, SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH); ++ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, NULL); ++ ++ /* clear group key */ ++ while ((camid_clr = rtw_camid_search(padapter, pparm->addr, -1, 1)) >= 0) { ++ RTW_PRINT("clear group key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(pparm->addr), camid_clr); ++ clear_cam_entry(padapter, camid_clr); ++ rtw_camid_free(padapter, camid_clr); ++ } ++ } ++ ++write_to_cam: ++ if (pparm->algorithm == _NO_PRIVACY_) { ++ while ((cam_id = rtw_camid_search(padapter, pparm->addr, -1, -1)) >= 0) { ++ RTW_PRINT("clear key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(pparm->addr), cam_id); ++ clear_cam_entry(padapter, cam_id); ++ rtw_camid_free(padapter, cam_id); ++ } ++ } else { ++ RTW_PRINT("set pairwise key camid:%d, addr:"MAC_FMT", kid:%d, type:%s\n", ++ cam_id, MAC_ARG(pparm->addr), pparm->keyid, security_type_str(pparm->algorithm)); ++ ctrl = BIT(15) | ((pparm->algorithm) << 2) | pparm->keyid; ++ write_cam(padapter, cam_id, ctrl, pparm->addr, pparm->key); ++ } ++ ret = H2C_SUCCESS_RSP; ++ ++exit: ++ return ret; ++} ++ ++u8 add_ba_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++ struct addBaReq_parm *pparm = (struct addBaReq_parm *)pbuf; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, pparm->addr); ++ ++ if (!psta) ++ return H2C_SUCCESS; ++ ++#ifdef CONFIG_80211N_HT ++ if (((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && (pmlmeinfo->HT_enable)) || ++ ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) { ++ /* pmlmeinfo->ADDBA_retry_count = 0; */ ++ /* pmlmeinfo->candidate_tid_bitmap |= (0x1 << pparm->tid); */ ++ /* psta->htpriv.candidate_tid_bitmap |= BIT(pparm->tid); */ ++ issue_addba_req(padapter, pparm->addr, (u8)pparm->tid); ++ /* _set_timer(&pmlmeext->ADDBA_timer, ADDBA_TO); */ ++ _set_timer(&psta->addba_retry_timer, ADDBA_TO); ++ } ++#ifdef CONFIG_TDLS ++ else if ((psta->tdls_sta_state & TDLS_LINKED_STATE) && ++ (psta->htpriv.ht_option == _TRUE) && ++ (psta->htpriv.ampdu_enable == _TRUE)) { ++ issue_addba_req(padapter, pparm->addr, (u8)pparm->tid); ++ _set_timer(&psta->addba_retry_timer, ADDBA_TO); ++ } ++#endif /* CONFIG */ ++ else ++ psta->htpriv.candidate_tid_bitmap &= ~BIT(pparm->tid); ++#endif /* CONFIG_80211N_HT */ ++ return H2C_SUCCESS; ++} ++ ++ ++u8 add_ba_rsp_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++ struct addBaRsp_parm *pparm = (struct addBaRsp_parm *)pbuf; ++ u8 ret = _TRUE, i = 0, try_cnt = 3, wait_ms = 50; ++ struct recv_reorder_ctrl *preorder_ctrl; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta; ++ ++ psta = rtw_get_stainfo(pstapriv, pparm->addr); ++ if (!psta) ++ goto exit; ++ ++ preorder_ctrl = &psta->recvreorder_ctrl[pparm->tid]; ++ ret = issue_addba_rsp_wait_ack(padapter, pparm->addr, pparm->tid, pparm->status, pparm->size, 3, 50); ++ ++#ifdef CONFIG_UPDATE_INDICATE_SEQ_WHILE_PROCESS_ADDBA_REQ ++ /* status = 0 means accept this addba req, so update indicate seq = start_seq under this compile flag */ ++ if (pparm->status == 0) { ++ preorder_ctrl->indicate_seq = pparm->start_seq; ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, start_seq: %d\n", __func__, __LINE__, ++ preorder_ctrl->indicate_seq, pparm->start_seq); ++#endif ++ } ++#else ++ preorder_ctrl->indicate_seq = 0xffff; ++#endif ++ ++ /* ++ * status = 0 means accept this addba req ++ * status = 37 means reject this addba req ++ */ ++ if (pparm->status == 0) { ++ preorder_ctrl->enable = _TRUE; ++ preorder_ctrl->ampdu_size = pparm->size; ++ } else if (pparm->status == 37) ++ preorder_ctrl->enable = _FALSE; ++ ++exit: ++ return H2C_SUCCESS; ++} ++ ++u8 chk_bmc_sleepq_cmd(_adapter *padapter) ++{ ++ struct cmd_obj *ph2c; ++ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); ++ u8 res = _SUCCESS; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_parm_rsp(ph2c, GEN_CMD_CODE(_ChkBMCSleepq)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ ++ return res; ++} ++ ++u8 set_tx_beacon_cmd(_adapter *padapter) ++{ ++ struct cmd_obj *ph2c; ++ struct Tx_Beacon_param *ptxBeacon_parm; ++ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 res = _SUCCESS; ++ int len_diff = 0; ++ ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ ptxBeacon_parm = (struct Tx_Beacon_param *)rtw_zmalloc(sizeof(struct Tx_Beacon_param)); ++ if (ptxBeacon_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ _rtw_memcpy(&(ptxBeacon_parm->network), &(pmlmeinfo->network), sizeof(WLAN_BSSID_EX)); ++ ++ len_diff = update_hidden_ssid( ++ ptxBeacon_parm->network.IEs + _BEACON_IE_OFFSET_ ++ , ptxBeacon_parm->network.IELength - _BEACON_IE_OFFSET_ ++ , pmlmeinfo->hidden_ssid_mode ++ ); ++ ptxBeacon_parm->network.IELength += len_diff; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, ptxBeacon_parm, GEN_CMD_CODE(_TX_Beacon)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++ ++exit: ++ ++ ++ return res; ++} ++ ++ ++u8 mlme_evt_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++ u8 evt_code, evt_seq; ++ u16 evt_sz; ++ uint *peventbuf; ++ void (*event_callback)(_adapter *dev, u8 *pbuf); ++ struct evt_priv *pevt_priv = &(padapter->evtpriv); ++ ++ if (pbuf == NULL) ++ goto _abort_event_; ++ ++ peventbuf = (uint *)pbuf; ++ evt_sz = (u16)(*peventbuf & 0xffff); ++ evt_seq = (u8)((*peventbuf >> 24) & 0x7f); ++ evt_code = (u8)((*peventbuf >> 16) & 0xff); ++ ++ ++#ifdef CHECK_EVENT_SEQ ++ /* checking event sequence... */ ++ if (evt_seq != (ATOMIC_READ(&pevt_priv->event_seq) & 0x7f)) { ++ ++ pevt_priv->event_seq = (evt_seq + 1) & 0x7f; ++ ++ goto _abort_event_; ++ } ++#endif ++ ++ /* checking if event code is valid */ ++ if (evt_code >= MAX_C2HEVT) { ++ goto _abort_event_; ++ } ++ ++ /* checking if event size match the event parm size */ ++ if ((wlanevents[evt_code].parmsize != 0) && ++ (wlanevents[evt_code].parmsize != evt_sz)) { ++ ++ goto _abort_event_; ++ ++ } ++ ++ ATOMIC_INC(&pevt_priv->event_seq); ++ ++ peventbuf += 2; ++ ++ if (peventbuf) { ++ event_callback = wlanevents[evt_code].event_callback; ++ event_callback(padapter, (u8 *)peventbuf); ++ ++ pevt_priv->evt_done_cnt++; ++ } ++ ++ ++_abort_event_: ++ ++ ++ return H2C_SUCCESS; ++ ++} ++ ++u8 h2c_msg_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++ if (!pbuf) ++ return H2C_PARAMETERS_ERROR; ++ ++ return H2C_SUCCESS; ++} ++ ++u8 chk_bmc_sleepq_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++#ifdef CONFIG_AP_MODE ++ _irqL irqL; ++ struct sta_info *psta_bmc; ++ _list *xmitframe_plist, *xmitframe_phead; ++ struct xmit_frame *pxmitframe = NULL; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ /* for BC/MC Frames */ ++ psta_bmc = rtw_get_bcmc_stainfo(padapter); ++ if (!psta_bmc) ++ return H2C_SUCCESS; ++ ++ if ((pstapriv->tim_bitmap & BIT(0)) && (psta_bmc->sleepq_len > 0)) { ++#ifndef CONFIG_PCI_HCI ++ rtw_msleep_os(10);/* 10ms, ATIM(HIQ) Windows */ ++#endif ++ /* _enter_critical_bh(&psta_bmc->sleep_q.lock, &irqL); */ ++ _enter_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); ++ xmitframe_plist = get_next(xmitframe_phead); ++ ++ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { ++ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); ++ ++ xmitframe_plist = get_next(xmitframe_plist); ++ ++ rtw_list_delete(&pxmitframe->list); ++ ++ psta_bmc->sleepq_len--; ++ if (psta_bmc->sleepq_len > 0) ++ pxmitframe->attrib.mdata = 1; ++ else ++ pxmitframe->attrib.mdata = 0; ++ ++ pxmitframe->attrib.triggered = 1; ++ ++ if (xmitframe_hiq_filter(pxmitframe) == _TRUE) ++ pxmitframe->attrib.qsel = QSLT_HIGH;/* HIQ */ ++ ++#if 0 ++ _exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); ++ if (rtw_hal_xmit(padapter, pxmitframe) == _TRUE) ++ rtw_os_xmit_complete(padapter, pxmitframe); ++ _enter_critical_bh(&psta_bmc->sleep_q.lock, &irqL); ++#endif ++ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); ++ } ++ ++ /* _exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); */ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ if (rtw_get_intf_type(padapter) != RTW_PCIE) { ++ /* check hi queue and bmc_sleepq */ ++ rtw_chk_hi_queue_cmd(padapter); ++ } ++ } ++#endif ++ ++ return H2C_SUCCESS; ++} ++ ++u8 tx_beacon_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++ ++#ifdef CONFIG_SWTIMER_BASED_TXBCN ++ ++ tx_beacon_handlder(padapter->dvobj); ++ ++#else ++ ++ if (send_beacon(padapter) == _FAIL) { ++ RTW_INFO("issue_beacon, fail!\n"); ++ return H2C_PARAMETERS_ERROR; ++ } ++ ++ /* tx bc/mc frames after update TIM */ ++ chk_bmc_sleepq_hdl(padapter, NULL); ++#endif ++ ++ return H2C_SUCCESS; ++} ++ ++#ifdef CONFIG_AP_MODE ++/* ++* according to channel ++* add/remove WLAN_BSSID_EX.IEs's ERP ie ++* set WLAN_BSSID_EX.SupportedRates ++* update WLAN_BSSID_EX.IEs's Supported Rate and Extended Supported Rate ie ++*/ ++void change_band_update_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 ch) ++{ ++ u8 network_type, rate_len, total_rate_len, remainder_rate_len; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 erpinfo = 0x4; ++ ++ if (ch >= 36) { ++ network_type = WIRELESS_11A; ++ total_rate_len = IEEE80211_NUM_OFDM_RATESLEN; ++ rtw_remove_bcn_ie(padapter, pnetwork, _ERPINFO_IE_); ++ } else { ++ network_type = WIRELESS_11BG; ++ total_rate_len = IEEE80211_CCK_RATE_LEN + IEEE80211_NUM_OFDM_RATESLEN; ++ rtw_add_bcn_ie(padapter, pnetwork, _ERPINFO_IE_, &erpinfo, 1); ++ } ++ ++ rtw_set_supported_rate(pnetwork->SupportedRates, network_type); ++ ++ UpdateBrateTbl(padapter, pnetwork->SupportedRates); ++ ++ if (total_rate_len > 8) { ++ rate_len = 8; ++ remainder_rate_len = total_rate_len - 8; ++ } else { ++ rate_len = total_rate_len; ++ remainder_rate_len = 0; ++ } ++ ++ rtw_add_bcn_ie(padapter, pnetwork, _SUPPORTEDRATES_IE_, pnetwork->SupportedRates, rate_len); ++ ++ if (remainder_rate_len) ++ rtw_add_bcn_ie(padapter, pnetwork, _EXT_SUPPORTEDRATES_IE_, (pnetwork->SupportedRates + 8), remainder_rate_len); ++ else ++ rtw_remove_bcn_ie(padapter, pnetwork, _EXT_SUPPORTEDRATES_IE_); ++ ++ pnetwork->Length = get_WLAN_BSSID_EX_sz(pnetwork); ++} ++#endif ++ ++void rtw_join_done_chk_ch(_adapter *adapter, int join_res) ++{ ++#define DUMP_ADAPTERS_STATUS 0 ++ ++ struct dvobj_priv *dvobj; ++ _adapter *iface; ++ struct mlme_priv *mlme; ++ struct mlme_ext_priv *mlmeext; ++ u8 u_ch, u_offset, u_bw; ++ int i; ++ ++ dvobj = adapter_to_dvobj(adapter); ++ ++ if (DUMP_ADAPTERS_STATUS) { ++ RTW_INFO(FUNC_ADPT_FMT" enter\n", FUNC_ADPT_ARG(adapter)); ++ dump_adapters_status(RTW_DBGDUMP , dvobj); ++ } ++ ++ if (join_res >= 0) { ++ ++#ifdef CONFIG_MCC_MODE ++ /* MCC setting success, don't go to ch union process */ ++ if (rtw_hal_set_mcc_setting_join_done_chk_ch(adapter)) ++ return; ++#endif /* CONFIG_MCC_MODE */ ++ ++ if (rtw_mi_get_ch_setting_union(adapter, &u_ch, &u_bw, &u_offset) <= 0) { ++ dump_adapters_status(RTW_DBGDUMP , dvobj); ++ rtw_warn_on(1); ++ } ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ mlme = &iface->mlmepriv; ++ mlmeext = &iface->mlmeextpriv; ++ ++ if (!iface || iface == adapter) ++ continue; ++#ifdef CONFIG_AP_MODE ++ if (check_fwstate(mlme, WIFI_AP_STATE) ++ && check_fwstate(mlme, WIFI_ASOC_STATE) ++ ) { ++ bool is_grouped = rtw_is_chbw_grouped(u_ch, u_bw, u_offset ++ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); ++ ++ if (is_grouped == _FALSE) { ++ /* handle AP which need to switch ch setting */ ++ ++ /* restore original bw, adjust bw by registry setting on target ch */ ++ mlmeext->cur_bwmode = mlme->ori_bw; ++ mlmeext->cur_channel = u_ch; ++#ifdef CONFIG_80211N_HT ++ rtw_adjust_chbw(iface ++ , mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset); ++#endif /* CONFIG_80211N_HT */ ++ ++ rtw_sync_chbw(&mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset ++ , &u_ch, &u_bw, &u_offset); ++ ++ rtw_ap_update_bss_chbw(iface, &(mlmeext->mlmext_info.network) ++ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); ++ ++ _rtw_memcpy(&(mlme->cur_network.network), &(mlmeext->mlmext_info.network), sizeof(WLAN_BSSID_EX)); ++ ++ rtw_start_bss_hdl_after_chbw_decided(iface); ++ } ++ ++ update_beacon(iface, 0, NULL, _TRUE); ++ } ++#endif ++ clr_fwstate(mlme, WIFI_OP_CH_SWITCHING); ++ } ++ ++#ifdef CONFIG_DFS_MASTER ++ rtw_dfs_master_status_apply(adapter, MLME_STA_CONNECTED); ++#endif ++ } else { ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ mlme = &iface->mlmepriv; ++ mlmeext = &iface->mlmeextpriv; ++ ++ if (!iface || iface == adapter) ++ continue; ++#ifdef CONFIG_AP_MODE ++ if (check_fwstate(mlme, WIFI_AP_STATE) ++ && check_fwstate(mlme, WIFI_ASOC_STATE)) ++ update_beacon(iface, 0, NULL, _TRUE); ++#endif /* CONFIG_AP_MODE */ ++ ++ clr_fwstate(mlme, WIFI_OP_CH_SWITCHING); ++ } ++#ifdef CONFIG_DFS_MASTER ++ rtw_dfs_master_status_apply(adapter, MLME_STA_DISCONNECTED); ++#endif ++ } ++ ++ if (rtw_mi_get_ch_setting_union(adapter, &u_ch, &u_bw, &u_offset)) { ++ set_channel_bwmode(adapter, u_ch, u_offset, u_bw); ++ rtw_mi_update_union_chan_inf(adapter, u_ch, u_offset, u_bw); ++ } ++ ++ if (DUMP_ADAPTERS_STATUS) { ++ RTW_INFO(FUNC_ADPT_FMT" exit\n", FUNC_ADPT_ARG(adapter)); ++ dump_adapters_status(RTW_DBGDUMP , dvobj); ++ } ++} ++ ++int rtw_chk_start_clnt_join(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) ++{ ++ bool chbw_allow = _TRUE; ++ bool connect_allow = _TRUE; ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ u8 cur_ch, cur_bw, cur_ch_offset; ++ u8 u_ch, u_offset, u_bw; ++ ++ u_ch = cur_ch = pmlmeext->cur_channel; ++ u_bw = cur_bw = pmlmeext->cur_bwmode; ++ u_offset = cur_ch_offset = pmlmeext->cur_ch_offset; ++ ++ if (!ch || !bw || !offset) { ++ connect_allow = _FALSE; ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (cur_ch == 0) { ++ connect_allow = _FALSE; ++ RTW_ERR(FUNC_ADPT_FMT" cur_ch:%u\n" ++ , FUNC_ADPT_ARG(adapter), cur_ch); ++ rtw_warn_on(1); ++ goto exit; ++ } ++ RTW_INFO(FUNC_ADPT_FMT" req: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ { ++ struct dvobj_priv *dvobj; ++ _adapter *iface; ++ struct mlme_priv *mlme; ++ struct mlme_ext_priv *mlmeext; ++ struct mi_state mstate; ++ int i; ++ ++ dvobj = adapter_to_dvobj(adapter); ++ ++ rtw_mi_status_no_self(adapter, &mstate); ++ RTW_INFO(FUNC_ADPT_FMT" ld_sta_num:%u, ap_num:%u\n" ++ , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate), MSTATE_AP_NUM(&mstate)); ++ ++ if (!MSTATE_STA_LD_NUM(&mstate) && !MSTATE_AP_NUM(&mstate)) { ++ /* consider linking STA? */ ++ goto connect_allow_hdl; ++ } ++ ++ if (rtw_mi_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset) <= 0) { ++ dump_adapters_status(RTW_DBGDUMP , dvobj); ++ rtw_warn_on(1); ++ } ++ RTW_INFO(FUNC_ADPT_FMT" union no self: %u,%u,%u\n" ++ , FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); ++ ++ /* chbw_allow? */ ++ chbw_allow = rtw_is_chbw_grouped(pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset ++ , u_ch, u_bw, u_offset); ++ ++ RTW_INFO(FUNC_ADPT_FMT" chbw_allow:%d\n" ++ , FUNC_ADPT_ARG(adapter), chbw_allow); ++ ++#ifdef CONFIG_MCC_MODE ++ /* check setting success, don't go to ch union process */ ++ if (rtw_hal_set_mcc_setting_chk_start_clnt_join(adapter, &u_ch, &u_bw, &u_offset, chbw_allow)) ++ goto exit; ++#endif ++ ++ if (chbw_allow == _TRUE) { ++ rtw_sync_chbw(&cur_ch, &cur_bw, &cur_ch_offset, &u_ch, &u_bw, &u_offset); ++ rtw_warn_on(cur_ch != pmlmeext->cur_channel); ++ rtw_warn_on(cur_bw != pmlmeext->cur_bwmode); ++ rtw_warn_on(cur_ch_offset != pmlmeext->cur_ch_offset); ++ goto connect_allow_hdl; ++ } ++ ++#ifdef CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT ++ /* chbw_allow is _FALSE, connect allow? */ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ mlme = &iface->mlmepriv; ++ mlmeext = &iface->mlmeextpriv; ++ ++ if (check_fwstate(mlme, WIFI_STATION_STATE) ++ && check_fwstate(mlme, WIFI_ASOC_STATE) ++#if defined(CONFIG_P2P) ++ && rtw_p2p_chk_state(&(iface->wdinfo), P2P_STATE_NONE) ++#endif ++ ) { ++ connect_allow = _FALSE; ++ break; ++ } ++ } ++#endif /* CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT */ ++ ++ if (MSTATE_STA_LD_NUM(&mstate) + MSTATE_AP_LD_NUM(&mstate) >= 2) ++ connect_allow = _FALSE; ++ ++ RTW_INFO(FUNC_ADPT_FMT" connect_allow:%d\n" ++ , FUNC_ADPT_ARG(adapter), connect_allow); ++ ++ if (connect_allow == _FALSE) ++ goto exit; ++ ++connect_allow_hdl: ++ /* connect_allow == _TRUE */ ++ ++#ifdef CONFIG_DFS_MASTER ++ rtw_dfs_master_status_apply(adapter, MLME_STA_CONNECTING); ++#endif ++ ++ if (chbw_allow == _FALSE) { ++ u_ch = cur_ch; ++ u_bw = cur_bw; ++ u_offset = cur_ch_offset; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ mlme = &iface->mlmepriv; ++ mlmeext = &iface->mlmeextpriv; ++ ++ if (!iface || iface == adapter) ++ continue; ++ ++ if (check_fwstate(mlme, WIFI_AP_STATE) ++ && check_fwstate(mlme, WIFI_ASOC_STATE) ++ ) { ++#ifdef CONFIG_SPCT_CH_SWITCH ++ if (1) ++ rtw_ap_inform_ch_switch(iface, pmlmeext->cur_channel , pmlmeext->cur_ch_offset); ++ else ++#endif ++ rtw_sta_flush(iface, _FALSE); ++ ++ rtw_hal_set_hwreg(iface, HW_VAR_CHECK_TXBUF, 0); ++ set_fwstate(mlme, WIFI_OP_CH_SWITCHING); ++ } else if (check_fwstate(mlme, WIFI_STATION_STATE) ++ && check_fwstate(mlme, WIFI_ASOC_STATE) ++ ) { ++ rtw_disassoc_cmd(iface, 500, _FALSE); ++ rtw_indicate_disconnect(iface, 0, _FALSE); ++ rtw_free_assoc_resources(iface, 1); ++ } ++ } ++ } ++ } ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++exit: ++ ++ if (connect_allow == _TRUE) { ++ RTW_INFO(FUNC_ADPT_FMT" union: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); ++ *ch = u_ch; ++ *bw = u_bw; ++ *offset = u_offset; ++ } ++ ++ return connect_allow == _TRUE ? _SUCCESS : _FAIL; ++} ++ ++ ++u8 set_ch_hdl(_adapter *padapter, u8 *pbuf) ++{ ++ struct set_ch_parm *set_ch_parm; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ if (!pbuf) ++ return H2C_PARAMETERS_ERROR; ++ ++ set_ch_parm = (struct set_ch_parm *)pbuf; ++ ++ RTW_INFO(FUNC_NDEV_FMT" ch:%u, bw:%u, ch_offset:%u\n", ++ FUNC_NDEV_ARG(padapter->pnetdev), ++ set_ch_parm->ch, set_ch_parm->bw, set_ch_parm->ch_offset); ++ ++ pmlmeext->cur_channel = set_ch_parm->ch; ++ pmlmeext->cur_ch_offset = set_ch_parm->ch_offset; ++ pmlmeext->cur_bwmode = set_ch_parm->bw; ++ ++ set_channel_bwmode(padapter, set_ch_parm->ch, set_ch_parm->ch_offset, set_ch_parm->bw); ++ ++ return H2C_SUCCESS; ++} ++ ++u8 set_chplan_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++ struct SetChannelPlan_param *setChannelPlan_param; ++ struct mlme_priv *mlme = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ if (!pbuf) ++ return H2C_PARAMETERS_ERROR; ++ ++ setChannelPlan_param = (struct SetChannelPlan_param *)pbuf; ++ ++ if (!rtw_is_channel_plan_valid(setChannelPlan_param->channel_plan)) ++ return H2C_PARAMETERS_ERROR; ++ ++ mlme->country_ent = setChannelPlan_param->country_ent; ++ mlme->ChannelPlan = setChannelPlan_param->channel_plan; ++ ++ pmlmeext->max_chan_nums = init_channel_set(padapter, setChannelPlan_param->channel_plan, pmlmeext->channel_set); ++ init_channel_list(padapter, pmlmeext->channel_set, pmlmeext->max_chan_nums, &pmlmeext->channel_list); ++ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_REGULATION, NULL, _TRUE); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_reg_notify_by_driver(padapter); ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++ return H2C_SUCCESS; ++} ++ ++u8 led_blink_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++ struct LedBlink_param *ledBlink_param; ++ ++ if (!pbuf) ++ return H2C_PARAMETERS_ERROR; ++ ++ ledBlink_param = (struct LedBlink_param *)pbuf; ++ ++#ifdef CONFIG_LED_HANDLED_BY_CMD_THREAD ++ BlinkHandler((PLED_DATA)ledBlink_param->pLed); ++#endif ++ ++ return H2C_SUCCESS; ++} ++ ++u8 set_csa_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++#ifdef CONFIG_DFS ++ struct SetChannelSwitch_param *setChannelSwitch_param; ++ u8 new_ch_no; ++ u8 gval8 = 0x00, sval8 = 0xff; ++ ++ if (!pbuf) ++ return H2C_PARAMETERS_ERROR; ++ ++ setChannelSwitch_param = (struct SetChannelSwitch_param *)pbuf; ++ new_ch_no = setChannelSwitch_param->new_ch_no; ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_TXPAUSE, &gval8); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &sval8); ++ ++ RTW_INFO("DFS detected! Swiching channel to %d!\n", new_ch_no); ++ set_channel_bwmode(padapter, new_ch_no, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &gval8); ++ ++ rtw_disassoc_cmd(padapter, 0, _FALSE); ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ rtw_free_assoc_resources(padapter, 1); ++ rtw_free_network_queue(padapter, _TRUE); ++ ++ if (((new_ch_no >= 52) && (new_ch_no <= 64)) || ((new_ch_no >= 100) && (new_ch_no <= 140))) ++ RTW_INFO("Switched to DFS band (ch %02x) again!!\n", new_ch_no); ++ ++ return H2C_SUCCESS; ++#else ++ return H2C_REJECTED; ++#endif /* CONFIG_DFS */ ++ ++} ++ ++u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++#ifdef CONFIG_TDLS ++ _irqL irqL; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++#ifdef CONFIG_TDLS_CH_SW ++ struct tdls_ch_switch *pchsw_info = &ptdlsinfo->chsw_info; ++#endif ++ struct TDLSoption_param *TDLSoption; ++ struct sta_info *ptdls_sta = NULL; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; ++ u8 survey_channel, i, min, option; ++ struct tdls_txmgmt txmgmt; ++ u32 setchtime, resp_sleep = 0, wait_time; ++ u8 zaddr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; ++ u8 ret; ++ u8 doiqk; ++ ++ if (!pbuf) ++ return H2C_PARAMETERS_ERROR; ++ ++ TDLSoption = (struct TDLSoption_param *)pbuf; ++ option = TDLSoption->option; ++ ++ if (!_rtw_memcmp(TDLSoption->addr, zaddr, ETH_ALEN)) { ++ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), TDLSoption->addr); ++ if (ptdls_sta == NULL) ++ return H2C_REJECTED; ++ } else { ++ if (!(option == TDLS_RS_RCR)) ++ return H2C_REJECTED; ++ } ++ ++ /* _enter_critical_bh(&(ptdlsinfo->hdl_lock), &irqL); */ ++ /* RTW_INFO("[%s] option:%d\n", __FUNCTION__, option); */ ++ ++ switch (option) { ++ case TDLS_ESTABLISHED: { ++ /* As long as TDLS handshake success, we should set RCR_CBSSID_DATA bit to 0 */ ++ /* So we can receive all kinds of data frames. */ ++ u8 sta_band = 0; ++ ++ /* leave ALL PS when TDLS is established */ ++ rtw_pwr_wakeup(padapter); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_WRCR, 0); ++ RTW_INFO("Created Direct Link with "MAC_FMT"\n", MAC_ARG(ptdls_sta->hwaddr)); ++ ++ /* Set TDLS sta rate. */ ++ /* Update station supportRate */ ++ rtw_hal_update_sta_rate_mask(padapter, ptdls_sta); ++ if (pmlmeext->cur_channel > 14) { ++ if (ptdls_sta->ra_mask & 0xffff000) ++ sta_band |= WIRELESS_11_5N ; ++ ++ if (ptdls_sta->ra_mask & 0xff0) ++ sta_band |= WIRELESS_11A; ++ ++ /* 5G band */ ++#ifdef CONFIG_80211AC_VHT ++ if (ptdls_sta->vhtpriv.vht_option) ++ sta_band = WIRELESS_11_5AC; ++#endif ++ ++ } else { ++ if (ptdls_sta->ra_mask & 0xffff000) ++ sta_band |= WIRELESS_11_24N; ++ ++ if (ptdls_sta->ra_mask & 0xff0) ++ sta_band |= WIRELESS_11G; ++ ++ if (ptdls_sta->ra_mask & 0x0f) ++ sta_band |= WIRELESS_11B; ++ } ++ ptdls_sta->wireless_mode = sta_band; ++ ptdls_sta->raid = rtw_hal_networktype_to_raid(padapter, ptdls_sta); ++ set_sta_rate(padapter, ptdls_sta); ++ rtw_sta_media_status_rpt(padapter, ptdls_sta, 1); ++ /* Sta mode */ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, ptdls_sta, _TRUE); ++ break; ++ } ++ case TDLS_ISSUE_PTI: ++ ptdls_sta->tdls_sta_state |= TDLS_WAIT_PTR_STATE; ++ issue_tdls_peer_traffic_indication(padapter, ptdls_sta); ++ _set_timer(&ptdls_sta->pti_timer, TDLS_PTI_TIME); ++ break; ++#ifdef CONFIG_TDLS_CH_SW ++ case TDLS_CH_SW_RESP: ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ txmgmt.status_code = 0; ++ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); ++ ++ issue_nulldata(padapter, NULL, 1, 3, 3); ++ ++ RTW_INFO("[TDLS ] issue tdls channel switch response\n"); ++ ret = issue_tdls_ch_switch_rsp(padapter, &txmgmt, _TRUE); ++ ++ /* If we receive TDLS_CH_SW_REQ at off channel which it's target is AP's channel */ ++ /* then we just switch to AP's channel*/ ++ if (padapter->mlmeextpriv.cur_channel == pchsw_info->off_ch_num) { ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END_TO_BASE_CHNL); ++ break; ++ } ++ ++ if (ret == _SUCCESS) ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_OFF_CHNL); ++ else ++ RTW_INFO("[TDLS] issue_tdls_ch_switch_rsp wait ack fail !!!!!!!!!!\n"); ++ ++ break; ++ case TDLS_CH_SW_PREPARE: ++ pchsw_info->ch_sw_state |= TDLS_CH_SWITCH_PREPARE_STATE; ++ ++ /* to collect IQK info of off-chnl */ ++ doiqk = _TRUE; ++ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, &doiqk); ++ set_channel_bwmode(padapter, pchsw_info->off_ch_num, pchsw_info->ch_offset, (pchsw_info->ch_offset) ? CHANNEL_WIDTH_40 : CHANNEL_WIDTH_20); ++ doiqk = _FALSE; ++ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, &doiqk); ++ ++ /* switch back to base-chnl */ ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_START); ++ ++ pchsw_info->ch_sw_state &= ~(TDLS_CH_SWITCH_PREPARE_STATE); ++ ++ break; ++ case TDLS_CH_SW_START: ++ rtw_tdls_set_ch_sw_oper_control(padapter, _TRUE); ++ break; ++ case TDLS_CH_SW_TO_OFF_CHNL: ++ issue_nulldata(padapter, NULL, 1, 3, 3); ++ ++ if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) ++ _set_timer(&ptdls_sta->ch_sw_timer, (u32)(ptdls_sta->ch_switch_timeout) / 1000); ++ ++ if (rtw_tdls_do_ch_sw(padapter, ptdls_sta, TDLS_CH_SW_OFF_CHNL, pchsw_info->off_ch_num, ++ pchsw_info->ch_offset, (pchsw_info->ch_offset) ? CHANNEL_WIDTH_40 : CHANNEL_WIDTH_20, ptdls_sta->ch_switch_time) == _SUCCESS) { ++ pchsw_info->ch_sw_state &= ~(TDLS_PEER_AT_OFF_STATE); ++ if (pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE) { ++ if (issue_nulldata_to_TDLS_peer_STA(ptdls_sta->padapter, ptdls_sta->hwaddr, 0, 1, 3) == _FAIL) ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_BASE_CHNL); ++ } ++ } else { ++ u8 bcancelled; ++ ++ if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) ++ _cancel_timer(&ptdls_sta->ch_sw_timer, &bcancelled); ++ } ++ ++ ++ break; ++ case TDLS_CH_SW_END: ++ case TDLS_CH_SW_END_TO_BASE_CHNL: ++ rtw_tdls_set_ch_sw_oper_control(padapter, _FALSE); ++ _cancel_timer_ex(&ptdls_sta->ch_sw_timer); ++ _cancel_timer_ex(&ptdls_sta->stay_on_base_chnl_timer); ++ _cancel_timer_ex(&ptdls_sta->ch_sw_monitor_timer); ++#if 0 ++ _rtw_memset(pHalData->tdls_ch_sw_iqk_info_base_chnl, 0x00, sizeof(pHalData->tdls_ch_sw_iqk_info_base_chnl)); ++ _rtw_memset(pHalData->tdls_ch_sw_iqk_info_off_chnl, 0x00, sizeof(pHalData->tdls_ch_sw_iqk_info_off_chnl)); ++#endif ++ ++ if (option == TDLS_CH_SW_END_TO_BASE_CHNL) ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_BASE_CHNL); ++ ++ break; ++ case TDLS_CH_SW_TO_BASE_CHNL_UNSOLICITED: ++ case TDLS_CH_SW_TO_BASE_CHNL: ++ pchsw_info->ch_sw_state &= ~(TDLS_PEER_AT_OFF_STATE | TDLS_WAIT_CH_RSP_STATE); ++ ++ if (option == TDLS_CH_SW_TO_BASE_CHNL_UNSOLICITED) { ++ if (ptdls_sta != NULL) { ++ /* Send unsolicited channel switch rsp. to peer */ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ txmgmt.status_code = 0; ++ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); ++ issue_tdls_ch_switch_rsp(padapter, &txmgmt, _FALSE); ++ } ++ } ++ ++ if (rtw_tdls_do_ch_sw(padapter, ptdls_sta, TDLS_CH_SW_BASE_CHNL, pmlmeext->cur_channel, ++ pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode, ptdls_sta->ch_switch_time) == _SUCCESS) { ++ issue_nulldata(padapter, NULL, 0, 3, 3); ++ /* set ch sw monitor timer for responder */ ++ if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) ++ _set_timer(&ptdls_sta->ch_sw_monitor_timer, TDLS_CH_SW_MONITOR_TIMEOUT); ++ } ++ ++ break; ++#endif ++ case TDLS_RS_RCR: ++ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_RS_RCR, 0); ++ RTW_INFO("[TDLS] write REG_RCR, set bit6 on\n"); ++ break; ++ case TDLS_TEARDOWN_STA: ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ txmgmt.status_code = 0; ++ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); ++ ++ issue_tdls_teardown(padapter, &txmgmt, _TRUE); ++ break; ++ case TDLS_TEARDOWN_STA_LOCALLY: ++#ifdef CONFIG_TDLS_CH_SW ++ if (_rtw_memcmp(TDLSoption->addr, pchsw_info->addr, ETH_ALEN) == _TRUE) { ++ pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE | ++ TDLS_CH_SWITCH_ON_STATE | ++ TDLS_PEER_AT_OFF_STATE); ++ rtw_tdls_set_ch_sw_oper_control(padapter, _FALSE); ++ _rtw_memset(pchsw_info->addr, 0x00, ETH_ALEN); ++ } ++#endif ++ rtw_sta_media_status_rpt(padapter, ptdls_sta, 0); ++ free_tdls_sta(padapter, ptdls_sta); ++ break; ++ } ++ ++ /* _exit_critical_bh(&(ptdlsinfo->hdl_lock), &irqL); */ ++ ++ return H2C_SUCCESS; ++#else ++ return H2C_REJECTED; ++#endif /* CONFIG_TDLS */ ++ ++} ++ ++u8 run_in_thread_hdl(_adapter *padapter, u8 *pbuf) ++{ ++ struct RunInThread_param *p; ++ ++ ++ if (NULL == pbuf) ++ return H2C_PARAMETERS_ERROR; ++ p = (struct RunInThread_param *)pbuf; ++ ++ if (p->func) ++ p->func(p->context); ++ ++ return H2C_SUCCESS; ++} ++ ++u8 rtw_getmacreg_hdl(_adapter *padapter, u8 *pbuf) ++{ ++ ++ struct readMAC_parm *preadmacparm = NULL; ++ u8 sz = 0; ++ u32 addr = 0; ++ u32 value = 0; ++ ++ if (!pbuf) ++ return H2C_PARAMETERS_ERROR; ++ ++ preadmacparm = (struct readMAC_parm *) pbuf; ++ sz = preadmacparm->len; ++ addr = preadmacparm->addr; ++ value = 0; ++ ++ switch (sz) { ++ case 1: ++ value = rtw_read8(padapter, addr); ++ break; ++ case 2: ++ value = rtw_read16(padapter, addr); ++ break; ++ case 4: ++ value = rtw_read32(padapter, addr); ++ break; ++ default: ++ RTW_INFO("%s: Unknown size\n", __func__); ++ break; ++ } ++ RTW_INFO("%s: addr:0x%02x valeu:0x%02x\n", __func__, addr, value); ++ ++ return H2C_SUCCESS; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_mp.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mp.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_mp.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mp.c 2018-02-11 21:44:27.139145964 +0200 +@@ -0,0 +1,3452 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_MP_C_ ++#include ++#ifdef PLATFORM_FREEBSD ++ #include /* for RFHIGHPID */ ++#endif ++ ++#include "../hal/phydm/phydm_precomp.h" ++#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8821A) ++ #include ++#endif ++ ++#ifdef CONFIG_MP_VHT_HW_TX_MODE ++#define CEILING_POS(X) ((X - (int)(X)) > 0 ? (int)(X + 1) : (int)(X)) ++#define CEILING_NEG(X) ((X - (int)(X)) < 0 ? (int)(X - 1) : (int)(X)) ++#define ceil(X) (((X) > 0) ? CEILING_POS(X) : CEILING_NEG(X)) ++ ++int rtfloor(float x) ++{ ++ int i = x - 2; ++ while ++ (++i <= x - 1) ++ ; ++ return i; ++} ++#endif ++ ++#ifdef CONFIG_MP_INCLUDED ++u32 read_macreg(_adapter *padapter, u32 addr, u32 sz) ++{ ++ u32 val = 0; ++ ++ switch (sz) { ++ case 1: ++ val = rtw_read8(padapter, addr); ++ break; ++ case 2: ++ val = rtw_read16(padapter, addr); ++ break; ++ case 4: ++ val = rtw_read32(padapter, addr); ++ break; ++ default: ++ val = 0xffffffff; ++ break; ++ } ++ ++ return val; ++ ++} ++ ++void write_macreg(_adapter *padapter, u32 addr, u32 val, u32 sz) ++{ ++ switch (sz) { ++ case 1: ++ rtw_write8(padapter, addr, (u8)val); ++ break; ++ case 2: ++ rtw_write16(padapter, addr, (u16)val); ++ break; ++ case 4: ++ rtw_write32(padapter, addr, val); ++ break; ++ default: ++ break; ++ } ++ ++} ++ ++u32 read_bbreg(_adapter *padapter, u32 addr, u32 bitmask) ++{ ++ return rtw_hal_read_bbreg(padapter, addr, bitmask); ++} ++ ++void write_bbreg(_adapter *padapter, u32 addr, u32 bitmask, u32 val) ++{ ++ rtw_hal_write_bbreg(padapter, addr, bitmask, val); ++} ++ ++u32 _read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask) ++{ ++ return rtw_hal_read_rfreg(padapter, rfpath, addr, bitmask); ++} ++ ++void _write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask, u32 val) ++{ ++ rtw_hal_write_rfreg(padapter, rfpath, addr, bitmask, val); ++} ++ ++u32 read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr) ++{ ++ return _read_rfreg(padapter, rfpath, addr, bRFRegOffsetMask); ++} ++ ++void write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 val) ++{ ++ _write_rfreg(padapter, rfpath, addr, bRFRegOffsetMask, val); ++} ++ ++static void _init_mp_priv_(struct mp_priv *pmp_priv) ++{ ++ WLAN_BSSID_EX *pnetwork; ++ ++ _rtw_memset(pmp_priv, 0, sizeof(struct mp_priv)); ++ ++ pmp_priv->mode = MP_OFF; ++ ++ pmp_priv->channel = 1; ++ pmp_priv->bandwidth = CHANNEL_WIDTH_20; ++ pmp_priv->prime_channel_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ pmp_priv->rateidx = RATE_1M; ++ pmp_priv->txpoweridx = 0x2A; ++ ++ pmp_priv->antenna_tx = ANTENNA_A; ++ pmp_priv->antenna_rx = ANTENNA_AB; ++ ++ pmp_priv->check_mp_pkt = 0; ++ ++ pmp_priv->tx_pktcount = 0; ++ ++ pmp_priv->rx_bssidpktcount = 0; ++ pmp_priv->rx_pktcount = 0; ++ pmp_priv->rx_crcerrpktcount = 0; ++ ++ pmp_priv->network_macaddr[0] = 0x00; ++ pmp_priv->network_macaddr[1] = 0xE0; ++ pmp_priv->network_macaddr[2] = 0x4C; ++ pmp_priv->network_macaddr[3] = 0x87; ++ pmp_priv->network_macaddr[4] = 0x66; ++ pmp_priv->network_macaddr[5] = 0x55; ++ ++ pmp_priv->bSetRxBssid = _FALSE; ++ pmp_priv->bRTWSmbCfg = _FALSE; ++ pmp_priv->bloopback = _FALSE; ++ ++ pmp_priv->bloadefusemap = _FALSE; ++ ++ pnetwork = &pmp_priv->mp_network.network; ++ _rtw_memcpy(pnetwork->MacAddress, pmp_priv->network_macaddr, ETH_ALEN); ++ ++ pnetwork->Ssid.SsidLength = 8; ++ _rtw_memcpy(pnetwork->Ssid.Ssid, "mp_871x", pnetwork->Ssid.SsidLength); ++ ++ pmp_priv->tx.payload = 2; ++#ifdef CONFIG_80211N_HT ++ pmp_priv->tx.attrib.ht_en = 1; ++#endif ++ ++} ++ ++#ifdef PLATFORM_WINDOWS ++#if 0 ++void mp_wi_callback( ++ IN NDIS_WORK_ITEM *pwk_item, ++ IN PVOID cntx ++) ++{ ++ _adapter *padapter = (_adapter *)cntx; ++ struct mp_priv *pmppriv = &padapter->mppriv; ++ struct mp_wi_cntx *pmp_wi_cntx = &pmppriv->wi_cntx; ++ ++ /* Execute specified action. */ ++ if (pmp_wi_cntx->curractfunc != NULL) { ++ LARGE_INTEGER cur_time; ++ ULONGLONG start_time, end_time; ++ NdisGetCurrentSystemTime(&cur_time); /* driver version */ ++ start_time = cur_time.QuadPart / 10; /* The return value is in microsecond */ ++ ++ pmp_wi_cntx->curractfunc(padapter); ++ ++ NdisGetCurrentSystemTime(&cur_time); /* driver version */ ++ end_time = cur_time.QuadPart / 10; /* The return value is in microsecond */ ++ ++ } ++ ++ NdisAcquireSpinLock(&(pmp_wi_cntx->mp_wi_lock)); ++ pmp_wi_cntx->bmp_wi_progress = _FALSE; ++ NdisReleaseSpinLock(&(pmp_wi_cntx->mp_wi_lock)); ++ ++ if (pmp_wi_cntx->bmpdrv_unload) ++ NdisSetEvent(&(pmp_wi_cntx->mp_wi_evt)); ++ ++} ++#endif ++ ++static int init_mp_priv_by_os(struct mp_priv *pmp_priv) ++{ ++ struct mp_wi_cntx *pmp_wi_cntx; ++ ++ if (pmp_priv == NULL) ++ return _FAIL; ++ ++ pmp_priv->rx_testcnt = 0; ++ pmp_priv->rx_testcnt1 = 0; ++ pmp_priv->rx_testcnt2 = 0; ++ ++ pmp_priv->tx_testcnt = 0; ++ pmp_priv->tx_testcnt1 = 0; ++ ++ pmp_wi_cntx = &pmp_priv->wi_cntx ++ pmp_wi_cntx->bmpdrv_unload = _FALSE; ++ pmp_wi_cntx->bmp_wi_progress = _FALSE; ++ pmp_wi_cntx->curractfunc = NULL; ++ ++ return _SUCCESS; ++} ++#endif ++ ++#ifdef PLATFORM_LINUX ++static int init_mp_priv_by_os(struct mp_priv *pmp_priv) ++{ ++ int i, res; ++ struct mp_xmit_frame *pmp_xmitframe; ++ ++ if (pmp_priv == NULL) ++ return _FAIL; ++ ++ _rtw_init_queue(&pmp_priv->free_mp_xmitqueue); ++ ++ pmp_priv->pallocated_mp_xmitframe_buf = NULL; ++ pmp_priv->pallocated_mp_xmitframe_buf = rtw_zmalloc(NR_MP_XMITFRAME * sizeof(struct mp_xmit_frame) + 4); ++ if (pmp_priv->pallocated_mp_xmitframe_buf == NULL) { ++ res = _FAIL; ++ goto _exit_init_mp_priv; ++ } ++ ++ pmp_priv->pmp_xmtframe_buf = pmp_priv->pallocated_mp_xmitframe_buf + 4 - ((SIZE_PTR)(pmp_priv->pallocated_mp_xmitframe_buf) & 3); ++ ++ pmp_xmitframe = (struct mp_xmit_frame *)pmp_priv->pmp_xmtframe_buf; ++ ++ for (i = 0; i < NR_MP_XMITFRAME; i++) { ++ _rtw_init_listhead(&pmp_xmitframe->list); ++ rtw_list_insert_tail(&pmp_xmitframe->list, &pmp_priv->free_mp_xmitqueue.queue); ++ ++ pmp_xmitframe->pkt = NULL; ++ pmp_xmitframe->frame_tag = MP_FRAMETAG; ++ pmp_xmitframe->padapter = pmp_priv->papdater; ++ ++ pmp_xmitframe++; ++ } ++ ++ pmp_priv->free_mp_xmitframe_cnt = NR_MP_XMITFRAME; ++ ++ res = _SUCCESS; ++ ++_exit_init_mp_priv: ++ ++ return res; ++} ++#endif ++ ++static void mp_init_xmit_attrib(struct mp_tx *pmptx, PADAPTER padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ struct pkt_attrib *pattrib; ++ ++ /* init xmitframe attribute */ ++ pattrib = &pmptx->attrib; ++ _rtw_memset(pattrib, 0, sizeof(struct pkt_attrib)); ++ _rtw_memset(pmptx->desc, 0, TXDESC_SIZE); ++ ++ pattrib->ether_type = 0x8712; ++#if 0 ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++#endif ++ _rtw_memset(pattrib->dst, 0xFF, ETH_ALEN); ++ ++ /* pattrib->dhcp_pkt = 0; ++ * pattrib->pktlen = 0; */ ++ pattrib->ack_policy = 0; ++ /* pattrib->pkt_hdrlen = ETH_HLEN; */ ++ pattrib->hdrlen = WLAN_HDR_A3_LEN; ++ pattrib->subtype = WIFI_DATA; ++ pattrib->priority = 0; ++ pattrib->qsel = pattrib->priority; ++ /* do_queue_select(padapter, pattrib); */ ++ pattrib->nr_frags = 1; ++ pattrib->encrypt = 0; ++ pattrib->bswenc = _FALSE; ++ pattrib->qos_en = _FALSE; ++ ++ pattrib->pktlen = 1500; ++ ++#ifdef CONFIG_80211AC_VHT ++ if (pHalData->rf_type == RF_1T1R) ++ pattrib->raid = RATEID_IDX_VHT_1SS; ++ else if (pHalData->rf_type == RF_2T2R || pHalData->rf_type == RF_2T4R) ++ pattrib->raid = RATEID_IDX_VHT_2SS; ++ else if (pHalData->rf_type == RF_3T3R) ++ pattrib->raid = RATEID_IDX_VHT_3SS; ++ else ++ pattrib->raid = RATEID_IDX_BGN_40M_1SS; ++#endif ++} ++ ++s32 init_mp_priv(PADAPTER padapter) ++{ ++ struct mp_priv *pmppriv = &padapter->mppriv; ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ ++ _init_mp_priv_(pmppriv); ++ pmppriv->papdater = padapter; ++ pmppriv->mp_dm = 0; ++ pmppriv->tx.stop = 1; ++ pmppriv->bSetTxPower = 0; /*for manually set tx power*/ ++ pmppriv->bTxBufCkFail = _FALSE; ++ pmppriv->pktInterval = 0; ++ pmppriv->pktLength = 1000; ++ ++ mp_init_xmit_attrib(&pmppriv->tx, padapter); ++ ++ switch (padapter->registrypriv.rf_config) { ++ case RF_1T1R: ++ pmppriv->antenna_tx = ANTENNA_A; ++ pmppriv->antenna_rx = ANTENNA_A; ++ break; ++ case RF_1T2R: ++ default: ++ pmppriv->antenna_tx = ANTENNA_A; ++ pmppriv->antenna_rx = ANTENNA_AB; ++ break; ++ case RF_2T2R: ++ case RF_2T2R_GREEN: ++ pmppriv->antenna_tx = ANTENNA_AB; ++ pmppriv->antenna_rx = ANTENNA_AB; ++ break; ++ case RF_2T4R: ++ pmppriv->antenna_tx = ANTENNA_BC; ++ pmppriv->antenna_rx = ANTENNA_ABCD; ++ break; ++ } ++ ++ pHalData->AntennaRxPath = pmppriv->antenna_rx; ++ pHalData->AntennaTxPath = pmppriv->antenna_tx; ++ ++ return _SUCCESS; ++} ++ ++void free_mp_priv(struct mp_priv *pmp_priv) ++{ ++ if (pmp_priv->pallocated_mp_xmitframe_buf) { ++ rtw_mfree(pmp_priv->pallocated_mp_xmitframe_buf, 0); ++ pmp_priv->pallocated_mp_xmitframe_buf = NULL; ++ } ++ pmp_priv->pmp_xmtframe_buf = NULL; ++} ++ ++ ++static VOID PHY_IQCalibrate_default( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bReCovery ++) ++{ ++ RTW_INFO("%s\n", __func__); ++} ++ ++static VOID PHY_LCCalibrate_default( ++ IN PADAPTER pAdapter ++) ++{ ++ RTW_INFO("%s\n", __func__); ++} ++ ++static VOID PHY_SetRFPathSwitch_default( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bMain ++) ++{ ++ RTW_INFO("%s\n", __func__); ++} ++ ++ ++void mpt_InitHWConfig(PADAPTER Adapter) ++{ ++ if (IS_HARDWARE_TYPE_8723B(Adapter)) { ++ /* TODO: <20130114, Kordan> The following setting is only for DPDT and Fixed board type. */ ++ /* TODO: A better solution is configure it according EFUSE during the run-time. */ ++ ++ PHY_SetMacReg(Adapter, 0x64, BIT20, 0x0); /* 0x66[4]=0 */ ++ PHY_SetMacReg(Adapter, 0x64, BIT24, 0x0); /* 0x66[8]=0 */ ++ PHY_SetMacReg(Adapter, 0x40, BIT4, 0x0); /* 0x40[4]=0 */ ++ PHY_SetMacReg(Adapter, 0x40, BIT3, 0x1); /* 0x40[3]=1 */ ++ PHY_SetMacReg(Adapter, 0x4C, BIT24, 0x1); /* 0x4C[24:23]=10 */ ++ PHY_SetMacReg(Adapter, 0x4C, BIT23, 0x0); /* 0x4C[24:23]=10 */ ++ PHY_SetBBReg(Adapter, 0x944, BIT1 | BIT0, 0x3); /* 0x944[1:0]=11 */ ++ PHY_SetBBReg(Adapter, 0x930, bMaskByte0, 0x77); /* 0x930[7:0]=77 */ ++ PHY_SetMacReg(Adapter, 0x38, BIT11, 0x1); /* 0x38[11]=1 */ ++ ++ /* TODO: <20130206, Kordan> The default setting is wrong, hard-coded here. */ ++ PHY_SetMacReg(Adapter, 0x778, 0x3, 0x3); /* Turn off hardware PTA control (Asked by Scott) */ ++ PHY_SetMacReg(Adapter, 0x64, bMaskDWord, 0x36000000); /* Fix BT S0/S1 */ ++ PHY_SetMacReg(Adapter, 0x948, bMaskDWord, 0x0); /* Fix BT can't Tx */ ++ ++ /* <20130522, Kordan> Turn off equalizer to improve Rx sensitivity. (Asked by EEChou) */ ++ PHY_SetBBReg(Adapter, 0xA00, BIT8, 0x0); /*0xA01[0] = 0*/ ++ } else if (IS_HARDWARE_TYPE_8821(Adapter)) { ++ /* <20131121, VincentL> Add for 8821AU DPDT setting and fix switching antenna issue (Asked by Rock) ++ <20131122, VincentL> Enable for all 8821A/8811AU (Asked by Alex)*/ ++ PHY_SetMacReg(Adapter, 0x4C, BIT23, 0x0); /*0x4C[23:22]=01*/ ++ PHY_SetMacReg(Adapter, 0x4C, BIT22, 0x1); /*0x4C[23:22]=01*/ ++ } else if (IS_HARDWARE_TYPE_8188ES(Adapter)) ++ PHY_SetMacReg(Adapter, 0x4C , BIT23, 0); /*select DPDT_P and DPDT_N as output pin*/ ++#ifdef CONFIG_RTL8814A ++ else if (IS_HARDWARE_TYPE_8814A(Adapter)) ++ PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8814A, 0x2000); ++#endif ++#ifdef CONFIG_RTL8822B ++ else if (IS_HARDWARE_TYPE_8822B(Adapter)) ++ PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8822B, 0x2000); ++#endif /* CONFIG_RTL8822B */ ++#ifdef CONFIG_RTL8821C ++ else if (IS_HARDWARE_TYPE_8821C(Adapter)) ++ PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8821C, 0x2000); ++#endif /* CONFIG_RTL8821C */ ++} ++ ++#ifdef CONFIG_RTL8188E ++ #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8188E(a, b) ++ #define PHY_LCCalibrate(a) PHY_LCCalibrate_8188E(&(GET_HAL_DATA(a)->odmpriv)) ++ #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8188E(a, b) ++#endif ++ ++#ifdef CONFIG_RTL8814A ++ #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8814A(&(GET_HAL_DATA(a)->odmpriv), b) ++ #define PHY_LCCalibrate(a) PHY_LCCalibrate_8814A(&(GET_HAL_DATA(a)->odmpriv)) ++ #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8814A(a, b) ++#endif /* CONFIG_RTL8814A */ ++ ++#ifdef CONFIG_RTL8812A ++ #define PHY_IQCalibrate(_Adapter, b) PHY_IQCalibrate_8812A(_Adapter, b) ++ #define PHY_LCCalibrate(_Adapter) PHY_LCCalibrate_8812A(&(GET_HAL_DATA(_Adapter)->odmpriv)) ++ #define PHY_SetRFPathSwitch(_Adapter, b) PHY_SetRFPathSwitch_8812A(_Adapter, b) ++#endif ++ ++#ifdef CONFIG_RTL8821A ++ #define PHY_IQCalibrate(_Adapter, b) PHY_IQCalibrate_8821A(&(GET_HAL_DATA(_Adapter)->odmpriv), b) ++ #define PHY_LCCalibrate(_Adapter) PHY_LCCalibrate_8821A(&(GET_HAL_DATA(_Adapter)->odmpriv)) ++ #define PHY_SetRFPathSwitch(_Adapter, b) PHY_SetRFPathSwitch_8812A(_Adapter, b) ++#endif ++ ++#ifdef CONFIG_RTL8192E ++ #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8192E(a, b) ++ #define PHY_LCCalibrate(a) PHY_LCCalibrate_8192E(&(GET_HAL_DATA(a)->odmpriv)) ++ #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8192E(a, b) ++#endif /* CONFIG_RTL8812A_8821A */ ++ ++#ifdef CONFIG_RTL8723B ++static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) ++{ ++ PHAL_DATA_TYPE pHalData; ++ u8 b2ant; /* false:1ant, true:2-ant */ ++ u8 RF_Path; /* 0:S1, 1:S0 */ ++ ++ pHalData = GET_HAL_DATA(padapter); ++ b2ant = pHalData->EEPROMBluetoothAntNum == Ant_x2 ? _TRUE : _FALSE; ++ ++ PHY_IQCalibrate_8723B(padapter, bReCovery, _FALSE, b2ant, pHalData->ant_path); ++} ++ ++ ++#define PHY_LCCalibrate(a) PHY_LCCalibrate_8723B(&(GET_HAL_DATA(a)->odmpriv)) ++#define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8723B(a, b) ++#endif ++ ++#ifdef CONFIG_RTL8703B ++static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) ++{ ++ PHY_IQCalibrate_8703B(padapter, bReCovery); ++} ++ ++ ++#define PHY_LCCalibrate(a) PHY_LCCalibrate_8703B(&(GET_HAL_DATA(a)->odmpriv)) ++#define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8703B(a, b) ++#endif ++ ++#ifdef CONFIG_RTL8188F ++static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) ++{ ++ PHY_IQCalibrate_8188F(padapter, bReCovery, _FALSE); ++} ++ ++ ++#define PHY_LCCalibrate(a) PHY_LCCalibrate_8188F(&(GET_HAL_DATA(a)->odmpriv)) ++#define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8188F(a, b) ++#endif ++ ++#ifdef CONFIG_RTL8822B ++ #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8822B(a, b) ++ #define PHY_LCCalibrate(a) ++ #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8822B(a, b) ++#endif /* CONFIG_RTL8822B */ ++ ++#ifdef CONFIG_RTL8723D ++ #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8723D(a, b) ++ #define PHY_LCCalibrate(a) PHY_LCCalibrate_8723D(&(GET_HAL_DATA(a)->odmpriv)) ++ #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8723D(a, b) ++#endif ++ ++#ifdef CONFIG_RTL8821C ++ #define PHY_IQCalibrate(a, b) ++ #define PHY_LCCalibrate(a) ++ #define PHY_SetRFPathSwitch(a, b) ++#endif /* CONFIG_RTL8821C */ ++s32 ++MPT_InitializeAdapter( ++ IN PADAPTER pAdapter, ++ IN u8 Channel ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ s32 rtStatus = _SUCCESS; ++ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; ++ u32 ledsetting; ++ struct mlme_priv *pmlmepriv = &pAdapter->mlmepriv; ++ ++ pMptCtx->bMptDrvUnload = _FALSE; ++ pMptCtx->bMassProdTest = _FALSE; ++ pMptCtx->bMptIndexEven = _TRUE; /* default gain index is -6.0db */ ++ pMptCtx->h2cReqNum = 0x0; ++ /* init for BT MP */ ++#if defined(CONFIG_RTL8723B) ++ pMptCtx->bMPh2c_timeout = _FALSE; ++ pMptCtx->MptH2cRspEvent = _FALSE; ++ pMptCtx->MptBtC2hEvent = _FALSE; ++ _rtw_init_sema(&pMptCtx->MPh2c_Sema, 0); ++ _init_timer(&pMptCtx->MPh2c_timeout_timer, pAdapter->pnetdev, MPh2c_timeout_handle, pAdapter); ++#endif ++ ++ mpt_InitHWConfig(pAdapter); ++ ++#ifdef CONFIG_RTL8723B ++ rtl8723b_InitAntenna_Selection(pAdapter); ++ if (IS_HARDWARE_TYPE_8723B(pAdapter)) { ++ ++ /* <20130522, Kordan> Turn off equalizer to improve Rx sensitivity. (Asked by EEChou)*/ ++ PHY_SetBBReg(pAdapter, 0xA00, BIT8, 0x0); ++ PHY_SetRFPathSwitch(pAdapter, 1/*pHalData->bDefaultAntenna*/); /*default use Main*/ ++ /*<20130522, Kordan> 0x51 and 0x71 should be set immediately after path switched, or they might be overwritten. */ ++ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)) ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); ++ else ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); ++ } ++ /*set ant to wifi side in mp mode*/ ++ rtw_write16(pAdapter, 0x870, 0x300); ++ rtw_write16(pAdapter, 0x860, 0x110); ++#endif ++ ++ pMptCtx->bMptWorkItemInProgress = _FALSE; ++ pMptCtx->CurrMptAct = NULL; ++ pMptCtx->MptRfPath = ODM_RF_PATH_A; ++ /* ------------------------------------------------------------------------- */ ++ /* Don't accept any packets */ ++ rtw_write32(pAdapter, REG_RCR, 0); ++ ++ /* ledsetting = rtw_read32(pAdapter, REG_LEDCFG0); */ ++ /* rtw_write32(pAdapter, REG_LEDCFG0, ledsetting & ~LED0DIS); */ ++ ++ /* rtw_write32(pAdapter, REG_LEDCFG0, 0x08080); */ ++ ledsetting = rtw_read32(pAdapter, REG_LEDCFG0); ++ ++ ++ PHY_LCCalibrate(pAdapter); ++ PHY_IQCalibrate(pAdapter, _FALSE); ++ /* dm_CheckTXPowerTracking(&pHalData->odmpriv); */ /* trigger thermal meter */ ++ ++ PHY_SetRFPathSwitch(pAdapter, 1/*pHalData->bDefaultAntenna*/); /* default use Main */ ++ ++ pMptCtx->backup0xc50 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_XAAGCCore1, bMaskByte0); ++ pMptCtx->backup0xc58 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_XBAGCCore1, bMaskByte0); ++ pMptCtx->backup0xc30 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_RxDetector1, bMaskByte0); ++ pMptCtx->backup0x52_RF_A = (u1Byte)PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0); ++ pMptCtx->backup0x52_RF_B = (u1Byte)PHY_QueryRFReg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0); ++#ifdef CONFIG_RTL8188E ++ rtw_write32(pAdapter, REG_MACID_NO_LINK_0, 0x0); ++ rtw_write32(pAdapter, REG_MACID_NO_LINK_1, 0x0); ++#endif ++#ifdef CONFIG_RTL8814A ++ if (IS_HARDWARE_TYPE_8814A(pAdapter)) { ++ pHalData->BackUp_IG_REG_4_Chnl_Section[0] = (u1Byte)PHY_QueryBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0); ++ pHalData->BackUp_IG_REG_4_Chnl_Section[1] = (u1Byte)PHY_QueryBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0); ++ pHalData->BackUp_IG_REG_4_Chnl_Section[2] = (u1Byte)PHY_QueryBBReg(pAdapter, rC_IGI_Jaguar2, bMaskByte0); ++ pHalData->BackUp_IG_REG_4_Chnl_Section[3] = (u1Byte)PHY_QueryBBReg(pAdapter, rD_IGI_Jaguar2, bMaskByte0); ++ } ++#endif ++ return rtStatus; ++} ++ ++/*----------------------------------------------------------------------------- ++ * Function: MPT_DeInitAdapter() ++ * ++ * Overview: Extra DeInitialization for Mass Production Test. ++ * ++ * Input: PADAPTER pAdapter ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 05/08/2007 MHC Create Version 0. ++ * 05/18/2007 MHC Add normal driver MPHalt code. ++ * ++ *---------------------------------------------------------------------------*/ ++VOID ++MPT_DeInitAdapter( ++ IN PADAPTER pAdapter ++) ++{ ++ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; ++ ++ pMptCtx->bMptDrvUnload = _TRUE; ++#if defined(CONFIG_RTL8723B) ++ _rtw_free_sema(&(pMptCtx->MPh2c_Sema)); ++ _cancel_timer_ex(&pMptCtx->MPh2c_timeout_timer); ++#endif ++#if defined(CONFIG_RTL8723B) ++ PHY_SetBBReg(pAdapter, 0xA01, BIT0, 1); /* /suggestion by jerry for MP Rx. */ ++#endif ++#if 0 /* for Windows */ ++ PlatformFreeWorkItem(&(pMptCtx->MptWorkItem)); ++ ++ while (pMptCtx->bMptWorkItemInProgress) { ++ if (NdisWaitEvent(&(pMptCtx->MptWorkItemEvent), 50)) ++ break; ++ } ++ NdisFreeSpinLock(&(pMptCtx->MptWorkItemSpinLock)); ++#endif ++} ++ ++static u8 mpt_ProStartTest(PADAPTER padapter) ++{ ++ PMPT_CONTEXT pMptCtx = &padapter->mppriv.MptCtx; ++ ++ pMptCtx->bMassProdTest = _TRUE; ++ pMptCtx->bStartContTx = _FALSE; ++ pMptCtx->bCckContTx = _FALSE; ++ pMptCtx->bOfdmContTx = _FALSE; ++ pMptCtx->bSingleCarrier = _FALSE; ++ pMptCtx->bCarrierSuppression = _FALSE; ++ pMptCtx->bSingleTone = _FALSE; ++ pMptCtx->HWTxmode = PACKETS_TX; ++ ++ return _SUCCESS; ++} ++ ++/* ++ * General use ++ */ ++s32 SetPowerTracking(PADAPTER padapter, u8 enable) ++{ ++ ++ hal_mpt_SetPowerTracking(padapter, enable); ++ return 0; ++} ++ ++void GetPowerTracking(PADAPTER padapter, u8 *enable) ++{ ++ hal_mpt_GetPowerTracking(padapter, enable); ++} ++ ++void rtw_mp_trigger_iqk(PADAPTER padapter) ++{ ++ PHY_IQCalibrate(padapter, _FALSE); ++} ++ ++void rtw_mp_trigger_lck(PADAPTER padapter) ++{ ++ PHY_LCCalibrate(padapter); ++} ++ ++static void disable_dm(PADAPTER padapter) ++{ ++ u8 v8; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ ++ /* 3 1. disable firmware dynamic mechanism */ ++ /* disable Power Training, Rate Adaptive */ ++ v8 = rtw_read8(padapter, REG_BCN_CTRL); ++ v8 &= ~EN_BCN_FUNCTION; ++ rtw_write8(padapter, REG_BCN_CTRL, v8); ++ ++ /* 3 2. disable driver dynamic mechanism */ ++ rtw_phydm_func_disable_all(padapter); ++ ++ /* enable APK, LCK and IQK but disable power tracking */ ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _FALSE; ++ rtw_phydm_func_set(padapter, ODM_RF_CALIBRATION); ++ ++ /* #ifdef CONFIG_BT_COEXIST */ ++ /* rtw_btcoex_Switch(padapter, 0); */ /* remove for BT MP Down. */ ++ /* #endif */ ++} ++ ++ ++void MPT_PwrCtlDM(PADAPTER padapter, u32 bstart) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ ++ if (bstart == 1) { ++ RTW_INFO("in MPT_PwrCtlDM start\n"); ++ rtw_phydm_func_set(padapter, ODM_RF_TX_PWR_TRACK | ODM_RF_CALIBRATION); ++ ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; ++ padapter->mppriv.mp_dm = 1; ++ ++ } else { ++ RTW_INFO("in MPT_PwrCtlDM stop\n"); ++ disable_dm(padapter); ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _FALSE; ++ padapter->mppriv.mp_dm = 0; ++ { ++ TXPWRTRACK_CFG c; ++ u1Byte chnl = 0 ; ++ _rtw_memset(&c, 0, sizeof(TXPWRTRACK_CFG)); ++ ConfigureTxpowerTrack(pDM_Odm, &c); ++ ODM_ClearTxPowerTrackingState(pDM_Odm); ++ if (*c.ODM_TxPwrTrackSetPwr) { ++ if (pDM_Odm->SupportICType == ODM_RTL8188F) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, chnl); ++ else if (pDM_Odm->SupportICType == ODM_RTL8723D) { ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, ODM_RF_PATH_A, chnl); ++ SetTxPower(padapter); ++ } else { ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, ODM_RF_PATH_A, chnl); ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, ODM_RF_PATH_B, chnl); ++ } ++ } ++ } ++ } ++ ++} ++ ++ ++u32 mp_join(PADAPTER padapter, u8 mode) ++{ ++ WLAN_BSSID_EX bssid; ++ struct sta_info *psta; ++ u32 length; ++ u8 val8, join_type; ++ _irqL irqL; ++ s32 res = _SUCCESS; ++ ++ struct mp_priv *pmppriv = &padapter->mppriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wlan_network *tgt_network = &pmlmepriv->cur_network; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ struct wireless_dev *pwdev = padapter->rtw_wdev; ++#endif /* #ifdef CONFIG_IOCTL_CFG80211 */ ++ /* 1. initialize a new WLAN_BSSID_EX */ ++ _rtw_memset(&bssid, 0, sizeof(WLAN_BSSID_EX)); ++ RTW_INFO("%s ,pmppriv->network_macaddr=%x %x %x %x %x %x\n", __func__, ++ pmppriv->network_macaddr[0], pmppriv->network_macaddr[1], pmppriv->network_macaddr[2], pmppriv->network_macaddr[3], pmppriv->network_macaddr[4], ++ pmppriv->network_macaddr[5]); ++ _rtw_memcpy(bssid.MacAddress, pmppriv->network_macaddr, ETH_ALEN); ++ ++ if (mode == WIFI_FW_ADHOC_STATE) { ++ bssid.Ssid.SsidLength = strlen("mp_pseudo_adhoc"); ++ _rtw_memcpy(bssid.Ssid.Ssid, (u8 *)"mp_pseudo_adhoc", bssid.Ssid.SsidLength); ++ bssid.InfrastructureMode = Ndis802_11IBSS; ++ bssid.NetworkTypeInUse = Ndis802_11DS; ++ bssid.IELength = 0; ++ bssid.Configuration.DSConfig = pmppriv->channel; ++ ++ } else if (mode == WIFI_FW_STATION_STATE) { ++ bssid.Ssid.SsidLength = strlen("mp_pseudo_STATION"); ++ _rtw_memcpy(bssid.Ssid.Ssid, (u8 *)"mp_pseudo_STATION", bssid.Ssid.SsidLength); ++ bssid.InfrastructureMode = Ndis802_11Infrastructure; ++ bssid.NetworkTypeInUse = Ndis802_11DS; ++ bssid.IELength = 0; ++ } ++ ++ length = get_WLAN_BSSID_EX_sz(&bssid); ++ if (length % 4) ++ bssid.Length = ((length >> 2) + 1) << 2; /* round up to multiple of 4 bytes. */ ++ else ++ bssid.Length = length; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) ++ goto end_of_mp_start_test; ++ ++ /* init mp_start_test status */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ rtw_disassoc_cmd(padapter, 500, _TRUE); ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ rtw_free_assoc_resources(padapter, 1); ++ } ++ pmppriv->prev_fw_state = get_fwstate(pmlmepriv); ++ /*pmlmepriv->fw_state = WIFI_MP_STATE;*/ ++ init_fwstate(pmlmepriv, WIFI_MP_STATE); ++ ++ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); ++ ++ /* 3 2. create a new psta for mp driver */ ++ /* clear psta in the cur_network, if any */ ++ psta = rtw_get_stainfo(&padapter->stapriv, tgt_network->network.MacAddress); ++ if (psta) ++ rtw_free_stainfo(padapter, psta); ++ ++ psta = rtw_alloc_stainfo(&padapter->stapriv, bssid.MacAddress); ++ if (psta == NULL) { ++ /*pmlmepriv->fw_state = pmppriv->prev_fw_state;*/ ++ init_fwstate(pmlmepriv, pmppriv->prev_fw_state); ++ res = _FAIL; ++ goto end_of_mp_start_test; ++ } ++ if (mode == WIFI_FW_ADHOC_STATE) ++ set_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); ++ else ++ set_fwstate(pmlmepriv, WIFI_STATION_STATE); ++ /* 3 3. join psudo AdHoc */ ++ tgt_network->join_res = 1; ++ tgt_network->aid = psta->aid = 1; ++ ++ _rtw_memcpy(&padapter->registrypriv.dev_network, &bssid, length); ++ rtw_update_registrypriv_dev_network(padapter); ++ _rtw_memcpy(&tgt_network->network, &padapter->registrypriv.dev_network, padapter->registrypriv.dev_network.Length); ++ _rtw_memcpy(pnetwork, &padapter->registrypriv.dev_network, padapter->registrypriv.dev_network.Length); ++ ++ rtw_indicate_connect(padapter); ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); ++ set_fwstate(pmlmepriv, _FW_LINKED); ++ ++end_of_mp_start_test: ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ if (1) { /* (res == _SUCCESS) */ ++ /* set MSR to WIFI_FW_ADHOC_STATE */ ++ if (mode == WIFI_FW_ADHOC_STATE) { ++ /* set msr to WIFI_FW_ADHOC_STATE */ ++ pmlmeinfo->state = WIFI_FW_ADHOC_STATE; ++ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, padapter->registrypriv.dev_network.MacAddress); ++ join_type = 0; ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); ++ ++ report_join_res(padapter, 1); ++ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; ++ } else { ++ Set_MSR(padapter, WIFI_FW_STATION_STATE); ++ ++ RTW_INFO("%s , pmppriv->network_macaddr =%x %x %x %x %x %x\n", __func__, ++ pmppriv->network_macaddr[0], pmppriv->network_macaddr[1], pmppriv->network_macaddr[2], pmppriv->network_macaddr[3], pmppriv->network_macaddr[4], ++ pmppriv->network_macaddr[5]); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmppriv->network_macaddr); ++ } ++ } ++ ++ return res; ++} ++/* This function initializes the DUT to the MP test mode */ ++s32 mp_start_test(PADAPTER padapter) ++{ ++ struct mp_priv *pmppriv = &padapter->mppriv; ++ s32 res = _SUCCESS; ++ ++ padapter->registrypriv.mp_mode = 1; ++ ++ /* 3 disable dynamic mechanism */ ++ disable_dm(padapter); ++#ifdef CONFIG_RTL8814A ++ rtl8814_InitHalDm(padapter); ++#endif /* CONFIG_RTL8814A */ ++#ifdef CONFIG_RTL8822B ++ rtl8822b_phy_init_haldm(padapter); ++#endif /* CONFIG_RTL8822B */ ++#ifdef CONFIG_RTL8821C ++ rtl8821c_phy_init_haldm(padapter); ++#endif /* CONFIG_RTL8821C */ ++#ifdef CONFIG_RTL8812A ++ rtl8812_InitHalDm(padapter); ++#endif /* CONFIG_RTL8812A */ ++#ifdef CONFIG_RTL8723B ++ rtl8723b_InitHalDm(padapter); ++#endif /* CONFIG_RTL8723B */ ++#ifdef CONFIG_RTL8703B ++ rtl8703b_InitHalDm(padapter); ++#endif /* CONFIG_RTL8703B */ ++#ifdef CONFIG_RTL8192E ++ rtl8192e_InitHalDm(padapter); ++#endif ++#ifdef CONFIG_RTL8188F ++ rtl8188f_InitHalDm(padapter); ++#endif ++#ifdef CONFIG_RTL8188E ++ rtl8188e_InitHalDm(padapter); ++#endif ++#ifdef CONFIG_RTL8723D ++ rtl8723d_InitHalDm(padapter); ++#endif /* CONFIG_RTL8723D */ ++ ++ /* 3 0. update mp_priv */ ++ ++ if (padapter->registrypriv.rf_config == RF_MAX_TYPE) { ++ /* switch (phal->rf_type) { */ ++ switch (GET_RF_TYPE(padapter)) { ++ case RF_1T1R: ++ pmppriv->antenna_tx = ANTENNA_A; ++ pmppriv->antenna_rx = ANTENNA_A; ++ break; ++ case RF_1T2R: ++ default: ++ pmppriv->antenna_tx = ANTENNA_A; ++ pmppriv->antenna_rx = ANTENNA_AB; ++ break; ++ case RF_2T2R: ++ case RF_2T2R_GREEN: ++ pmppriv->antenna_tx = ANTENNA_AB; ++ pmppriv->antenna_rx = ANTENNA_AB; ++ break; ++ case RF_2T4R: ++ pmppriv->antenna_tx = ANTENNA_AB; ++ pmppriv->antenna_rx = ANTENNA_ABCD; ++ break; ++ } ++ } ++ ++ mpt_ProStartTest(padapter); ++ ++ mp_join(padapter, WIFI_FW_ADHOC_STATE); ++ ++ return res; ++} ++/* ------------------------------------------------------------------------------ ++ * This function change the DUT from the MP test mode into normal mode */ ++void mp_stop_test(PADAPTER padapter) ++{ ++ struct mp_priv *pmppriv = &padapter->mppriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wlan_network *tgt_network = &pmlmepriv->cur_network; ++ struct sta_info *psta; ++ ++ _irqL irqL; ++ ++ if (pmppriv->mode == MP_ON) { ++ pmppriv->bSetTxPower = 0; ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _FALSE) ++ goto end_of_mp_stop_test; ++ ++ /* 3 1. disconnect psudo AdHoc */ ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ ++ /* 3 2. clear psta used in mp test mode. ++ * rtw_free_assoc_resources(padapter, 1); */ ++ psta = rtw_get_stainfo(&padapter->stapriv, tgt_network->network.MacAddress); ++ if (psta) ++ rtw_free_stainfo(padapter, psta); ++ ++ /* 3 3. return to normal state (default:station mode) */ ++ /*pmlmepriv->fw_state = pmppriv->prev_fw_state; */ /* WIFI_STATION_STATE;*/ ++ init_fwstate(pmlmepriv, pmppriv->prev_fw_state); ++ ++ /* flush the cur_network */ ++ _rtw_memset(tgt_network, 0, sizeof(struct wlan_network)); ++ ++ _clr_fwstate_(pmlmepriv, WIFI_MP_STATE); ++ ++end_of_mp_stop_test: ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++#ifdef CONFIG_RTL8812A ++ rtl8812_InitHalDm(padapter); ++#endif ++#ifdef CONFIG_RTL8723B ++ rtl8723b_InitHalDm(padapter); ++#endif ++#ifdef CONFIG_RTL8703B ++ rtl8703b_InitHalDm(padapter); ++#endif ++#ifdef CONFIG_RTL8192E ++ rtl8192e_InitHalDm(padapter); ++#endif ++#ifdef CONFIG_RTL8188F ++ rtl8188f_InitHalDm(padapter); ++#endif ++#ifdef CONFIG_RTL8723D ++ rtl8723d_InitHalDm(padapter); ++#endif ++ } ++} ++/*---------------------------hal\rtl8192c\MPT_Phy.c---------------------------*/ ++#if 0 ++/* #ifdef CONFIG_USB_HCI */ ++static VOID mpt_AdjustRFRegByRateByChan92CU(PADAPTER pAdapter, u8 RateIdx, u8 Channel, u8 BandWidthID) ++{ ++ u8 eRFPath; ++ u32 rfReg0x26; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ ++ if (RateIdx < MPT_RATE_6M) /* CCK rate,for 88cu */ ++ rfReg0x26 = 0xf400; ++ else if ((RateIdx >= MPT_RATE_6M) && (RateIdx <= MPT_RATE_54M)) {/* OFDM rate,for 88cu */ ++ if ((4 == Channel) || (8 == Channel) || (12 == Channel)) ++ rfReg0x26 = 0xf000; ++ else if ((5 == Channel) || (7 == Channel) || (13 == Channel) || (14 == Channel)) ++ rfReg0x26 = 0xf400; ++ else ++ rfReg0x26 = 0x4f200; ++ } else if ((RateIdx >= MPT_RATE_MCS0) && (RateIdx <= MPT_RATE_MCS15)) { ++ /* MCS 20M ,for 88cu */ /* MCS40M rate,for 88cu */ ++ ++ if (CHANNEL_WIDTH_20 == BandWidthID) { ++ if ((4 == Channel) || (8 == Channel)) ++ rfReg0x26 = 0xf000; ++ else if ((5 == Channel) || (7 == Channel) || (13 == Channel) || (14 == Channel)) ++ rfReg0x26 = 0xf400; ++ else ++ rfReg0x26 = 0x4f200; ++ } else { ++ if ((4 == Channel) || (8 == Channel)) ++ rfReg0x26 = 0xf000; ++ else if ((5 == Channel) || (7 == Channel)) ++ rfReg0x26 = 0xf400; ++ else ++ rfReg0x26 = 0x4f200; ++ } ++ } ++ ++ for (eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) ++ write_rfreg(pAdapter, eRFPath, RF_SYN_G2, rfReg0x26); ++} ++#endif ++/*----------------------------------------------------------------------------- ++ * Function: mpt_SwitchRfSetting ++ * ++ * Overview: Change RF Setting when we siwthc channel/rate/BW for MP. ++ * ++ * Input: IN PADAPTER pAdapter ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 01/08/2009 MHC Suggestion from SD3 Willis for 92S series. ++ * 01/09/2009 MHC Add CCK modification for 40MHZ. Suggestion from SD3. ++ * ++ *---------------------------------------------------------------------------*/ ++static void mpt_SwitchRfSetting(PADAPTER pAdapter) ++{ ++ hal_mpt_SwitchRfSetting(pAdapter); ++} ++ ++/*---------------------------hal\rtl8192c\MPT_Phy.c---------------------------*/ ++/*---------------------------hal\rtl8192c\MPT_HelperFunc.c---------------------------*/ ++static void MPT_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14) ++{ ++ hal_mpt_CCKTxPowerAdjust(Adapter, bInCH14); ++} ++ ++/*---------------------------hal\rtl8192c\MPT_HelperFunc.c---------------------------*/ ++ ++/* ++ * SetChannel ++ * Description ++ * Use H2C command to change channel, ++ * not only modify rf register, but also other setting need to be done. ++ */ ++void SetChannel(PADAPTER pAdapter) ++{ ++ hal_mpt_SetChannel(pAdapter); ++} ++ ++/* ++ * Notice ++ * Switch bandwitdth may change center frequency(channel) ++ */ ++void SetBandwidth(PADAPTER pAdapter) ++{ ++ hal_mpt_SetBandwidth(pAdapter); ++ ++} ++ ++void SetAntenna(PADAPTER pAdapter) ++{ ++ hal_mpt_SetAntenna(pAdapter); ++} ++ ++int SetTxPower(PADAPTER pAdapter) ++{ ++ ++ hal_mpt_SetTxPower(pAdapter); ++ return _TRUE; ++} ++ ++void SetTxAGCOffset(PADAPTER pAdapter, u32 ulTxAGCOffset) ++{ ++ u32 TxAGCOffset_B, TxAGCOffset_C, TxAGCOffset_D, tmpAGC; ++ ++ TxAGCOffset_B = (ulTxAGCOffset & 0x000000ff); ++ TxAGCOffset_C = ((ulTxAGCOffset & 0x0000ff00) >> 8); ++ TxAGCOffset_D = ((ulTxAGCOffset & 0x00ff0000) >> 16); ++ ++ tmpAGC = (TxAGCOffset_D << 8 | TxAGCOffset_C << 4 | TxAGCOffset_B); ++ write_bbreg(pAdapter, rFPGA0_TxGainStage, ++ (bXBTxAGC | bXCTxAGC | bXDTxAGC), tmpAGC); ++} ++ ++void SetDataRate(PADAPTER pAdapter) ++{ ++ hal_mpt_SetDataRate(pAdapter); ++} ++ ++void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter , BOOLEAN bMain) ++{ ++ ++ PHY_SetRFPathSwitch(pAdapter, bMain); ++ ++} ++ ++ ++s32 SetThermalMeter(PADAPTER pAdapter, u8 target_ther) ++{ ++ return hal_mpt_SetThermalMeter(pAdapter, target_ther); ++} ++ ++static void TriggerRFThermalMeter(PADAPTER pAdapter) ++{ ++ hal_mpt_TriggerRFThermalMeter(pAdapter); ++} ++ ++static u8 ReadRFThermalMeter(PADAPTER pAdapter) ++{ ++ return hal_mpt_ReadRFThermalMeter(pAdapter); ++} ++ ++void GetThermalMeter(PADAPTER pAdapter, u8 *value) ++{ ++ hal_mpt_GetThermalMeter(pAdapter, value); ++} ++ ++void SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) ++{ ++ PhySetTxPowerLevel(pAdapter); ++ hal_mpt_SetSingleCarrierTx(pAdapter, bStart); ++} ++ ++void SetSingleToneTx(PADAPTER pAdapter, u8 bStart) ++{ ++ PhySetTxPowerLevel(pAdapter); ++ hal_mpt_SetSingleToneTx(pAdapter, bStart); ++} ++ ++void SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) ++{ ++ PhySetTxPowerLevel(pAdapter); ++ hal_mpt_SetCarrierSuppressionTx(pAdapter, bStart); ++} ++ ++void SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart) ++{ ++ PhySetTxPowerLevel(pAdapter); ++ hal_mpt_SetCCKContinuousTx(pAdapter, bStart); ++} ++ ++void SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart) ++{ ++ PhySetTxPowerLevel(pAdapter); ++ hal_mpt_SetOFDMContinuousTx(pAdapter, bStart); ++} /* mpt_StartOfdmContTx */ ++ ++void SetContinuousTx(PADAPTER pAdapter, u8 bStart) ++{ ++ PhySetTxPowerLevel(pAdapter); ++ hal_mpt_SetContinuousTx(pAdapter, bStart); ++} ++ ++ ++void PhySetTxPowerLevel(PADAPTER pAdapter) ++{ ++ struct mp_priv *pmp_priv = &pAdapter->mppriv; ++ ++ ++ if (pmp_priv->bSetTxPower == 0) /* for NO manually set power index */ ++ rtw_hal_set_tx_power_level(pAdapter, pmp_priv->channel); ++} ++ ++/* ------------------------------------------------------------------------------ */ ++static void dump_mpframe(PADAPTER padapter, struct xmit_frame *pmpframe) ++{ ++ rtw_hal_mgnt_xmit(padapter, pmpframe); ++} ++ ++static struct xmit_frame *alloc_mp_xmitframe(struct xmit_priv *pxmitpriv) ++{ ++ struct xmit_frame *pmpframe; ++ struct xmit_buf *pxmitbuf; ++ ++ pmpframe = rtw_alloc_xmitframe(pxmitpriv); ++ if (pmpframe == NULL) ++ return NULL; ++ ++ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); ++ if (pxmitbuf == NULL) { ++ rtw_free_xmitframe(pxmitpriv, pmpframe); ++ return NULL; ++ } ++ ++ pmpframe->frame_tag = MP_FRAMETAG; ++ ++ pmpframe->pxmitbuf = pxmitbuf; ++ ++ pmpframe->buf_addr = pxmitbuf->pbuf; ++ ++ pxmitbuf->priv_data = pmpframe; ++ ++ return pmpframe; ++ ++} ++ ++static thread_return mp_xmit_packet_thread(thread_context context) ++{ ++ struct xmit_frame *pxmitframe; ++ struct mp_tx *pmptx; ++ struct mp_priv *pmp_priv; ++ struct xmit_priv *pxmitpriv; ++ PADAPTER padapter; ++ ++ pmp_priv = (struct mp_priv *)context; ++ pmptx = &pmp_priv->tx; ++ padapter = pmp_priv->papdater; ++ pxmitpriv = &(padapter->xmitpriv); ++ ++ thread_enter("RTW_MP_THREAD"); ++ ++ RTW_INFO("%s:pkTx Start\n", __func__); ++ while (1) { ++ pxmitframe = alloc_mp_xmitframe(pxmitpriv); ++ if (pxmitframe == NULL) { ++ if (pmptx->stop || ++ RTW_CANNOT_RUN(padapter)) ++ goto exit; ++ else { ++ rtw_usleep_os(10); ++ continue; ++ } ++ } ++ _rtw_memcpy((u8 *)(pxmitframe->buf_addr + TXDESC_OFFSET), pmptx->buf, pmptx->write_size); ++ _rtw_memcpy(&(pxmitframe->attrib), &(pmptx->attrib), sizeof(struct pkt_attrib)); ++ ++ ++ rtw_usleep_os(padapter->mppriv.pktInterval); ++ dump_mpframe(padapter, pxmitframe); ++ ++ pmptx->sended++; ++ pmp_priv->tx_pktcount++; ++ ++ if (pmptx->stop || ++ RTW_CANNOT_RUN(padapter)) ++ goto exit; ++ if ((pmptx->count != 0) && ++ (pmptx->count == pmptx->sended)) ++ goto exit; ++ ++ flush_signals_thread(); ++ } ++ ++exit: ++ /* RTW_INFO("%s:pkTx Exit\n", __func__); */ ++ rtw_mfree(pmptx->pallocated_buf, pmptx->buf_size); ++ pmptx->pallocated_buf = NULL; ++ pmptx->stop = 1; ++ ++ thread_exit(NULL); ++ return 0; ++} ++ ++void fill_txdesc_for_mp(PADAPTER padapter, u8 *ptxdesc) ++{ ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ _rtw_memcpy(ptxdesc, pmp_priv->tx.desc, TXDESC_SIZE); ++} ++ ++#if defined(CONFIG_RTL8188E) ++void fill_tx_desc_8188e(PADAPTER padapter) ++{ ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ struct tx_desc *desc = (struct tx_desc *)&(pmp_priv->tx.desc); ++ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); ++ u32 pkt_size = pattrib->last_txcmdsz; ++ s32 bmcast = IS_MCAST(pattrib->ra); ++ /* offset 0 */ ++#if !defined(CONFIG_RTL8188E_SDIO) && !defined(CONFIG_PCI_HCI) ++ desc->txdw0 |= cpu_to_le32(OWN | FSG | LSG); ++ desc->txdw0 |= cpu_to_le32(pkt_size & 0x0000FFFF); /* packet size */ ++ desc->txdw0 |= cpu_to_le32(((TXDESC_SIZE + OFFSET_SZ) << OFFSET_SHT) & 0x00FF0000); /* 32 bytes for TX Desc */ ++ if (bmcast) ++ desc->txdw0 |= cpu_to_le32(BMC); /* broadcast packet */ ++ ++ desc->txdw1 |= cpu_to_le32((0x01 << 26) & 0xff000000); ++#endif ++ ++ desc->txdw1 |= cpu_to_le32((pattrib->mac_id) & 0x3F); /* CAM_ID(MAC_ID) */ ++ desc->txdw1 |= cpu_to_le32((pattrib->qsel << QSEL_SHT) & 0x00001F00); /* Queue Select, TID */ ++ desc->txdw1 |= cpu_to_le32((pattrib->raid << RATE_ID_SHT) & 0x000F0000); /* Rate Adaptive ID */ ++ /* offset 8 */ ++ /* desc->txdw2 |= cpu_to_le32(AGG_BK); */ /* AGG BK */ ++ ++ desc->txdw3 |= cpu_to_le32((pattrib->seqnum << 16) & 0x0fff0000); ++ desc->txdw4 |= cpu_to_le32(HW_SSN); ++ ++ desc->txdw4 |= cpu_to_le32(USERATE); ++ desc->txdw4 |= cpu_to_le32(DISDATAFB); ++ ++ if (pmp_priv->preamble) { ++ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) ++ desc->txdw4 |= cpu_to_le32(DATA_SHORT); /* CCK Short Preamble */ ++ } ++ ++ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) ++ desc->txdw4 |= cpu_to_le32(DATA_BW); ++ ++ /* offset 20 */ ++ desc->txdw5 |= cpu_to_le32(pmp_priv->rateidx & 0x0000001F); ++ ++ if (pmp_priv->preamble) { ++ if (HwRateToMPTRate(pmp_priv->rateidx) > MPT_RATE_54M) ++ desc->txdw5 |= cpu_to_le32(SGI); /* MCS Short Guard Interval */ ++ } ++ ++ desc->txdw5 |= cpu_to_le32(RTY_LMT_EN); /* retry limit enable */ ++ desc->txdw5 |= cpu_to_le32(0x00180000); /* DATA/RTS Rate Fallback Limit */ ++ ++ ++} ++#endif ++ ++#if defined(CONFIG_RTL8814A) ++void fill_tx_desc_8814a(PADAPTER padapter) ++{ ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ u8 *pDesc = (u8 *)&(pmp_priv->tx.desc); ++ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); ++ ++ u32 pkt_size = pattrib->last_txcmdsz; ++ s32 bmcast = IS_MCAST(pattrib->ra); ++ u8 data_rate, pwr_status, offset; ++ ++ /* SET_TX_DESC_FIRST_SEG_8814A(pDesc, 1); */ ++ SET_TX_DESC_LAST_SEG_8814A(pDesc, 1); ++ /* SET_TX_DESC_OWN_(pDesc, 1); */ ++ ++ SET_TX_DESC_PKT_SIZE_8814A(pDesc, pkt_size); ++ ++ offset = TXDESC_SIZE + OFFSET_SZ; ++ ++ SET_TX_DESC_OFFSET_8814A(pDesc, offset); ++#if defined(CONFIG_PCI_HCI) ++ SET_TX_DESC_PKT_OFFSET_8814A(pDesc, 0); /* 8814AE pkt_offset is 0 */ ++#else ++ SET_TX_DESC_PKT_OFFSET_8814A(pDesc, 1); ++#endif ++ ++ if (bmcast) ++ SET_TX_DESC_BMC_8814A(pDesc, 1); ++ ++ SET_TX_DESC_MACID_8814A(pDesc, pattrib->mac_id); ++ SET_TX_DESC_RATE_ID_8814A(pDesc, pattrib->raid); ++ ++ /* SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_G); */ ++ SET_TX_DESC_QUEUE_SEL_8814A(pDesc, pattrib->qsel); ++ /* SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT); */ ++ ++ if (pmp_priv->preamble) ++ SET_TX_DESC_DATA_SHORT_8814A(pDesc, 1); ++ ++ if (!pattrib->qos_en) { ++ SET_TX_DESC_HWSEQ_EN_8814A(pDesc, 1); /* Hw set sequence number */ ++ } else ++ SET_TX_DESC_SEQ_8814A(pDesc, pattrib->seqnum); ++ ++ if (pmp_priv->bandwidth <= CHANNEL_WIDTH_160) ++ SET_TX_DESC_DATA_BW_8814A(pDesc, pmp_priv->bandwidth); ++ else { ++ RTW_INFO("%s:Err: unknown bandwidth %d, use 20M\n", __func__, pmp_priv->bandwidth); ++ SET_TX_DESC_DATA_BW_8814A(pDesc, CHANNEL_WIDTH_20); ++ } ++ ++ SET_TX_DESC_DISABLE_FB_8814A(pDesc, 1); ++ SET_TX_DESC_USE_RATE_8814A(pDesc, 1); ++ SET_TX_DESC_TX_RATE_8814A(pDesc, pmp_priv->rateidx); ++ ++} ++#endif ++ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ++void fill_tx_desc_8812a(PADAPTER padapter) ++{ ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ u8 *pDesc = (u8 *)&(pmp_priv->tx.desc); ++ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); ++ ++ u32 pkt_size = pattrib->last_txcmdsz; ++ s32 bmcast = IS_MCAST(pattrib->ra); ++ u8 data_rate, pwr_status, offset; ++ ++ SET_TX_DESC_FIRST_SEG_8812(pDesc, 1); ++ SET_TX_DESC_LAST_SEG_8812(pDesc, 1); ++ SET_TX_DESC_OWN_8812(pDesc, 1); ++ ++ SET_TX_DESC_PKT_SIZE_8812(pDesc, pkt_size); ++ ++ offset = TXDESC_SIZE + OFFSET_SZ; ++ ++ SET_TX_DESC_OFFSET_8812(pDesc, offset); ++ ++#if defined(CONFIG_PCI_HCI) ++ SET_TX_DESC_PKT_OFFSET_8812(pDesc, 0); ++#else ++ SET_TX_DESC_PKT_OFFSET_8812(pDesc, 1); ++#endif ++ if (bmcast) ++ SET_TX_DESC_BMC_8812(pDesc, 1); ++ ++ SET_TX_DESC_MACID_8812(pDesc, pattrib->mac_id); ++ SET_TX_DESC_RATE_ID_8812(pDesc, pattrib->raid); ++ ++ /* SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_G); */ ++ SET_TX_DESC_QUEUE_SEL_8812(pDesc, pattrib->qsel); ++ /* SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT); */ ++ ++ if (!pattrib->qos_en) { ++ SET_TX_DESC_HWSEQ_EN_8812(pDesc, 1); /* Hw set sequence number */ ++ } else ++ SET_TX_DESC_SEQ_8812(pDesc, pattrib->seqnum); ++ ++ if (pmp_priv->bandwidth <= CHANNEL_WIDTH_160) ++ SET_TX_DESC_DATA_BW_8812(pDesc, pmp_priv->bandwidth); ++ else { ++ RTW_INFO("%s:Err: unknown bandwidth %d, use 20M\n", __func__, pmp_priv->bandwidth); ++ SET_TX_DESC_DATA_BW_8812(pDesc, CHANNEL_WIDTH_20); ++ } ++ ++ SET_TX_DESC_DISABLE_FB_8812(pDesc, 1); ++ SET_TX_DESC_USE_RATE_8812(pDesc, 1); ++ SET_TX_DESC_TX_RATE_8812(pDesc, pmp_priv->rateidx); ++ ++} ++#endif ++#if defined(CONFIG_RTL8192E) ++void fill_tx_desc_8192e(PADAPTER padapter) ++{ ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ u8 *pDesc = (u8 *)&(pmp_priv->tx.desc); ++ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); ++ ++ u32 pkt_size = pattrib->last_txcmdsz; ++ s32 bmcast = IS_MCAST(pattrib->ra); ++ u8 data_rate, pwr_status, offset; ++ ++ ++ SET_TX_DESC_PKT_SIZE_92E(pDesc, pkt_size); ++ ++ offset = TXDESC_SIZE + OFFSET_SZ; ++ ++ SET_TX_DESC_OFFSET_92E(pDesc, offset); ++#if defined(CONFIG_PCI_HCI) /* 8192EE */ ++ ++ SET_TX_DESC_PKT_OFFSET_92E(pDesc, 0); /* 8192EE pkt_offset is 0 */ ++#else /* 8192EU 8192ES */ ++ SET_TX_DESC_PKT_OFFSET_92E(pDesc, 1); ++#endif ++ ++ if (bmcast) ++ SET_TX_DESC_BMC_92E(pDesc, 1); ++ ++ SET_TX_DESC_MACID_92E(pDesc, pattrib->mac_id); ++ SET_TX_DESC_RATE_ID_92E(pDesc, pattrib->raid); ++ ++ ++ SET_TX_DESC_QUEUE_SEL_92E(pDesc, pattrib->qsel); ++ /* SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT); */ ++ ++ if (!pattrib->qos_en) { ++ SET_TX_DESC_EN_HWSEQ_92E(pDesc, 1);/* Hw set sequence number */ ++ SET_TX_DESC_HWSEQ_SEL_92E(pDesc, pattrib->hw_ssn_sel); ++ } else ++ SET_TX_DESC_SEQ_92E(pDesc, pattrib->seqnum); ++ ++ if ((pmp_priv->bandwidth == CHANNEL_WIDTH_20) || (pmp_priv->bandwidth == CHANNEL_WIDTH_40)) ++ SET_TX_DESC_DATA_BW_92E(pDesc, pmp_priv->bandwidth); ++ else { ++ RTW_INFO("%s:Err: unknown bandwidth %d, use 20M\n", __func__, pmp_priv->bandwidth); ++ SET_TX_DESC_DATA_BW_92E(pDesc, CHANNEL_WIDTH_20); ++ } ++ ++ /* SET_TX_DESC_DATA_SC_92E(pDesc, SCMapping_92E(padapter,pattrib)); */ ++ ++ SET_TX_DESC_DISABLE_FB_92E(pDesc, 1); ++ SET_TX_DESC_USE_RATE_92E(pDesc, 1); ++ SET_TX_DESC_TX_RATE_92E(pDesc, pmp_priv->rateidx); ++ ++} ++#endif ++ ++#if defined(CONFIG_RTL8723B) ++void fill_tx_desc_8723b(PADAPTER padapter) ++{ ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); ++ u8 *ptxdesc = pmp_priv->tx.desc; ++ ++ SET_TX_DESC_AGG_BREAK_8723B(ptxdesc, 1); ++ SET_TX_DESC_MACID_8723B(ptxdesc, pattrib->mac_id); ++ SET_TX_DESC_QUEUE_SEL_8723B(ptxdesc, pattrib->qsel); ++ ++ SET_TX_DESC_RATE_ID_8723B(ptxdesc, pattrib->raid); ++ SET_TX_DESC_SEQ_8723B(ptxdesc, pattrib->seqnum); ++ SET_TX_DESC_HWSEQ_EN_8723B(ptxdesc, 1); ++ SET_TX_DESC_USE_RATE_8723B(ptxdesc, 1); ++ SET_TX_DESC_DISABLE_FB_8723B(ptxdesc, 1); ++ ++ if (pmp_priv->preamble) { ++ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) ++ SET_TX_DESC_DATA_SHORT_8723B(ptxdesc, 1); ++ } ++ ++ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) ++ SET_TX_DESC_DATA_BW_8723B(ptxdesc, 1); ++ ++ SET_TX_DESC_TX_RATE_8723B(ptxdesc, pmp_priv->rateidx); ++ ++ SET_TX_DESC_DATA_RATE_FB_LIMIT_8723B(ptxdesc, 0x1F); ++ SET_TX_DESC_RTS_RATE_FB_LIMIT_8723B(ptxdesc, 0xF); ++} ++#endif ++ ++#if defined(CONFIG_RTL8703B) ++void fill_tx_desc_8703b(PADAPTER padapter) ++{ ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); ++ u8 *ptxdesc = pmp_priv->tx.desc; ++ ++ SET_TX_DESC_AGG_BREAK_8703B(ptxdesc, 1); ++ SET_TX_DESC_MACID_8703B(ptxdesc, pattrib->mac_id); ++ SET_TX_DESC_QUEUE_SEL_8703B(ptxdesc, pattrib->qsel); ++ ++ SET_TX_DESC_RATE_ID_8703B(ptxdesc, pattrib->raid); ++ SET_TX_DESC_SEQ_8703B(ptxdesc, pattrib->seqnum); ++ SET_TX_DESC_HWSEQ_EN_8703B(ptxdesc, 1); ++ SET_TX_DESC_USE_RATE_8703B(ptxdesc, 1); ++ SET_TX_DESC_DISABLE_FB_8703B(ptxdesc, 1); ++ ++ if (pmp_priv->preamble) { ++ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) ++ SET_TX_DESC_DATA_SHORT_8703B(ptxdesc, 1); ++ } ++ ++ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) ++ SET_TX_DESC_DATA_BW_8703B(ptxdesc, 1); ++ ++ SET_TX_DESC_TX_RATE_8703B(ptxdesc, pmp_priv->rateidx); ++ ++ SET_TX_DESC_DATA_RATE_FB_LIMIT_8703B(ptxdesc, 0x1F); ++ SET_TX_DESC_RTS_RATE_FB_LIMIT_8703B(ptxdesc, 0xF); ++} ++#endif ++ ++#if defined(CONFIG_RTL8188F) ++void fill_tx_desc_8188f(PADAPTER padapter) ++{ ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); ++ u8 *ptxdesc = pmp_priv->tx.desc; ++ ++ SET_TX_DESC_AGG_BREAK_8188F(ptxdesc, 1); ++ SET_TX_DESC_MACID_8188F(ptxdesc, pattrib->mac_id); ++ SET_TX_DESC_QUEUE_SEL_8188F(ptxdesc, pattrib->qsel); ++ ++ SET_TX_DESC_RATE_ID_8188F(ptxdesc, pattrib->raid); ++ SET_TX_DESC_SEQ_8188F(ptxdesc, pattrib->seqnum); ++ SET_TX_DESC_HWSEQ_EN_8188F(ptxdesc, 1); ++ SET_TX_DESC_USE_RATE_8188F(ptxdesc, 1); ++ SET_TX_DESC_DISABLE_FB_8188F(ptxdesc, 1); ++ ++ if (pmp_priv->preamble) ++ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) ++ SET_TX_DESC_DATA_SHORT_8188F(ptxdesc, 1); ++ ++ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) ++ SET_TX_DESC_DATA_BW_8188F(ptxdesc, 1); ++ ++ SET_TX_DESC_TX_RATE_8188F(ptxdesc, pmp_priv->rateidx); ++ ++ SET_TX_DESC_DATA_RATE_FB_LIMIT_8188F(ptxdesc, 0x1F); ++ SET_TX_DESC_RTS_RATE_FB_LIMIT_8188F(ptxdesc, 0xF); ++} ++#endif ++ ++#if defined(CONFIG_RTL8723D) ++void fill_tx_desc_8723d(PADAPTER padapter) ++{ ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); ++ u8 *ptxdesc = pmp_priv->tx.desc; ++ ++ SET_TX_DESC_BK_8723D(ptxdesc, 1); ++ SET_TX_DESC_MACID_8723D(ptxdesc, pattrib->mac_id); ++ SET_TX_DESC_QUEUE_SEL_8723D(ptxdesc, pattrib->qsel); ++ ++ SET_TX_DESC_RATE_ID_8723D(ptxdesc, pattrib->raid); ++ SET_TX_DESC_SEQ_8723D(ptxdesc, pattrib->seqnum); ++ SET_TX_DESC_HWSEQ_EN_8723D(ptxdesc, 1); ++ SET_TX_DESC_USE_RATE_8723D(ptxdesc, 1); ++ SET_TX_DESC_DISABLE_FB_8723D(ptxdesc, 1); ++ ++ if (pmp_priv->preamble) { ++ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) ++ SET_TX_DESC_DATA_SHORT_8723D(ptxdesc, 1); ++ } ++ ++ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) ++ SET_TX_DESC_DATA_BW_8723D(ptxdesc, 1); ++ ++ SET_TX_DESC_TX_RATE_8723D(ptxdesc, pmp_priv->rateidx); ++ ++ SET_TX_DESC_DATA_RATE_FB_LIMIT_8723D(ptxdesc, 0x1F); ++ SET_TX_DESC_RTS_RATE_FB_LIMIT_8723D(ptxdesc, 0xF); ++} ++#endif ++ ++static void Rtw_MPSetMacTxEDCA(PADAPTER padapter) ++{ ++ ++ rtw_write32(padapter, 0x508 , 0x00a422); /* Disable EDCA BE Txop for MP pkt tx adjust Packet interval */ ++ /* RTW_INFO("%s:write 0x508~~~~~~ 0x%x\n", __func__,rtw_read32(padapter, 0x508)); */ ++ PHY_SetMacReg(padapter, 0x458 , bMaskDWord , 0x0); ++ /* RTW_INFO("%s()!!!!! 0x460 = 0x%x\n" ,__func__,PHY_QueryBBReg(padapter, 0x460, bMaskDWord)); */ ++ PHY_SetMacReg(padapter, 0x460 , bMaskLWord , 0x0); /* fast EDCA queue packet interval & time out vaule */ ++ /* PHY_SetMacReg(padapter, ODM_EDCA_VO_PARAM ,bMaskLWord , 0x431C); */ ++ /* PHY_SetMacReg(padapter, ODM_EDCA_BE_PARAM ,bMaskLWord , 0x431C); */ ++ /* PHY_SetMacReg(padapter, ODM_EDCA_BK_PARAM ,bMaskLWord , 0x431C); */ ++ RTW_INFO("%s()!!!!! 0x460 = 0x%x\n" , __func__, PHY_QueryBBReg(padapter, 0x460, bMaskDWord)); ++ ++} ++ ++void SetPacketTx(PADAPTER padapter) ++{ ++ u8 *ptr, *pkt_start, *pkt_end, *fctrl; ++ u32 pkt_size, offset, startPlace, i; ++ struct rtw_ieee80211_hdr *hdr; ++ u8 payload; ++ s32 bmcast; ++ struct pkt_attrib *pattrib; ++ struct mp_priv *pmp_priv; ++ ++ pmp_priv = &padapter->mppriv; ++ ++ if (pmp_priv->tx.stop) ++ return; ++ pmp_priv->tx.sended = 0; ++ pmp_priv->tx.stop = 0; ++ pmp_priv->tx_pktcount = 0; ++ ++ /* 3 1. update_attrib() */ ++ pattrib = &pmp_priv->tx.attrib; ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); ++ bmcast = IS_MCAST(pattrib->ra); ++ if (bmcast) { ++ pattrib->mac_id = 1; ++ pattrib->psta = rtw_get_bcmc_stainfo(padapter); ++ } else { ++ pattrib->mac_id = 0; ++ pattrib->psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); ++ } ++ pattrib->mbssid = 0; ++ ++ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->pktlen; ++ ++ /* 3 2. allocate xmit buffer */ ++ pkt_size = pattrib->last_txcmdsz; ++ ++ if (pmp_priv->tx.pallocated_buf) ++ rtw_mfree(pmp_priv->tx.pallocated_buf, pmp_priv->tx.buf_size); ++ pmp_priv->tx.write_size = pkt_size; ++ pmp_priv->tx.buf_size = pkt_size + XMITBUF_ALIGN_SZ; ++ pmp_priv->tx.pallocated_buf = rtw_zmalloc(pmp_priv->tx.buf_size); ++ if (pmp_priv->tx.pallocated_buf == NULL) { ++ RTW_INFO("%s: malloc(%d) fail!!\n", __func__, pmp_priv->tx.buf_size); ++ return; ++ } ++ pmp_priv->tx.buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pmp_priv->tx.pallocated_buf), XMITBUF_ALIGN_SZ); ++ ptr = pmp_priv->tx.buf; ++ ++ _rtw_memset(pmp_priv->tx.desc, 0, TXDESC_SIZE); ++ pkt_start = ptr; ++ pkt_end = pkt_start + pkt_size; ++ ++ /* 3 3. init TX descriptor */ ++#if defined(CONFIG_RTL8188E) ++ if (IS_HARDWARE_TYPE_8188E(padapter)) ++ fill_tx_desc_8188e(padapter); ++#endif ++ ++#if defined(CONFIG_RTL8814A) ++ if (IS_HARDWARE_TYPE_8814A(padapter)) ++ fill_tx_desc_8814a(padapter); ++#endif /* defined(CONFIG_RTL8814A) */ ++ ++#if defined(CONFIG_RTL8822B) ++ if (IS_HARDWARE_TYPE_8822B(padapter)) ++ rtl8822b_prepare_mp_txdesc(padapter, pmp_priv); ++#endif /* CONFIG_RTL8822B */ ++ ++#if defined(CONFIG_RTL8821C) ++ if (IS_HARDWARE_TYPE_8821C(padapter)) ++ rtl8821c_prepare_mp_txdesc(padapter, pmp_priv); ++#endif /* CONFIG_RTL8821C */ ++ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ++ if (IS_HARDWARE_TYPE_8812(padapter) || IS_HARDWARE_TYPE_8821(padapter)) ++ fill_tx_desc_8812a(padapter); ++#endif ++ ++#if defined(CONFIG_RTL8192E) ++ if (IS_HARDWARE_TYPE_8192E(padapter)) ++ fill_tx_desc_8192e(padapter); ++#endif ++#if defined(CONFIG_RTL8723B) ++ if (IS_HARDWARE_TYPE_8723B(padapter)) ++ fill_tx_desc_8723b(padapter); ++#endif ++#if defined(CONFIG_RTL8703B) ++ if (IS_HARDWARE_TYPE_8703B(padapter)) ++ fill_tx_desc_8703b(padapter); ++#endif ++ ++#if defined(CONFIG_RTL8188F) ++ if (IS_HARDWARE_TYPE_8188F(padapter)) ++ fill_tx_desc_8188f(padapter); ++#endif ++ ++#if defined(CONFIG_RTL8723D) ++ if (IS_HARDWARE_TYPE_8723D(padapter)) ++ fill_tx_desc_8723d(padapter); ++#endif ++ ++ /* 3 4. make wlan header, make_wlanhdr() */ ++ hdr = (struct rtw_ieee80211_hdr *)pkt_start; ++ SetFrameSubType(&hdr->frame_ctl, pattrib->subtype); ++ ++ _rtw_memcpy(hdr->addr1, pattrib->dst, ETH_ALEN); /* DA */ ++ _rtw_memcpy(hdr->addr2, pattrib->src, ETH_ALEN); /* SA */ ++ _rtw_memcpy(hdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN); /* RA, BSSID */ ++ ++ /* 3 5. make payload */ ++ ptr = pkt_start + pattrib->hdrlen; ++ ++ switch (pmp_priv->tx.payload) { ++ case 0: ++ payload = 0x00; ++ break; ++ case 1: ++ payload = 0x5a; ++ break; ++ case 2: ++ payload = 0xa5; ++ break; ++ case 3: ++ payload = 0xff; ++ break; ++ default: ++ payload = 0x00; ++ break; ++ } ++ pmp_priv->TXradomBuffer = rtw_zmalloc(4096); ++ if (pmp_priv->TXradomBuffer == NULL) { ++ RTW_INFO("mp create random buffer fail!\n"); ++ goto exit; ++ } ++ ++ ++ for (i = 0; i < 4096; i++) ++ pmp_priv->TXradomBuffer[i] = rtw_random32() % 0xFF; ++ ++ /* startPlace = (u32)(rtw_random32() % 3450); */ ++ _rtw_memcpy(ptr, pmp_priv->TXradomBuffer, pkt_end - ptr); ++ /* _rtw_memset(ptr, payload, pkt_end - ptr); */ ++ rtw_mfree(pmp_priv->TXradomBuffer, 4096); ++ ++ /* 3 6. start thread */ ++#ifdef PLATFORM_LINUX ++ pmp_priv->tx.PktTxThread = kthread_run(mp_xmit_packet_thread, pmp_priv, "RTW_MP_THREAD"); ++ if (IS_ERR(pmp_priv->tx.PktTxThread)) ++ RTW_INFO("Create PktTx Thread Fail !!!!!\n"); ++#endif ++#ifdef PLATFORM_FREEBSD ++ { ++ struct proc *p; ++ struct thread *td; ++ pmp_priv->tx.PktTxThread = kproc_kthread_add(mp_xmit_packet_thread, pmp_priv, ++ &p, &td, RFHIGHPID, 0, "MPXmitThread", "MPXmitThread"); ++ ++ if (pmp_priv->tx.PktTxThread < 0) ++ RTW_INFO("Create PktTx Thread Fail !!!!!\n"); ++ } ++#endif ++ ++ Rtw_MPSetMacTxEDCA(padapter); ++exit: ++ return; ++} ++ ++void SetPacketRx(PADAPTER pAdapter, u8 bStartRx, u8 bAB) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ struct mp_priv *pmppriv = &pAdapter->mppriv; ++ ++ ++ if (bStartRx) { ++#ifdef CONFIG_RTL8723B ++ PHY_SetMacReg(pAdapter, 0xe70, BIT23 | BIT22, 0x3); /* Power on adc (in RX_WAIT_CCA state) */ ++ write_bbreg(pAdapter, 0xa01, BIT0, bDisable);/* improve Rx performance by jerry */ ++#endif ++ pHalData->ReceiveConfig = RCR_AAP | RCR_APM | RCR_AM | RCR_AMF | RCR_HTC_LOC_CTRL; ++ pHalData->ReceiveConfig |= RCR_ACRC32; ++ pHalData->ReceiveConfig |= RCR_APP_PHYST_RXFF | RCR_APP_ICV | RCR_APP_MIC; ++ ++ if (pmppriv->bSetRxBssid == _TRUE) { ++ RTW_INFO("%s: pmppriv->network_macaddr=" MAC_FMT "\n", __func__, ++ MAC_ARG(pmppriv->network_macaddr)); ++ pHalData->ReceiveConfig = 0; ++ pHalData->ReceiveConfig |= RCR_CBSSID_DATA | RCR_CBSSID_BCN |RCR_APM | RCR_AM | RCR_AB |RCR_AMF; ++ ++#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++ write_bbreg(pAdapter, 0x550, BIT3, bEnable); ++#endif ++ rtw_write16(pAdapter, REG_RXFLTMAP0, 0xFFEF); /* REG_RXFLTMAP0 (RX Filter Map Group 0) */ ++ ++ } else { ++ pHalData->ReceiveConfig |= RCR_ADF; ++ /* Accept all data frames */ ++ rtw_write16(pAdapter, REG_RXFLTMAP2, 0xFFFF); ++ } ++ ++ if (bAB) ++ pHalData->ReceiveConfig |= RCR_AB; ++ } else { ++#ifdef CONFIG_RTL8723B ++ PHY_SetMacReg(pAdapter, 0xe70, BIT23 | BIT22, 0x00); /* Power off adc (in RX_WAIT_CCA state) */ ++ write_bbreg(pAdapter, 0xa01, BIT0, bEnable);/* improve Rx performance by jerry */ ++#endif ++ pHalData->ReceiveConfig = 0; ++ rtw_write16(pAdapter, REG_RXFLTMAP0, 0xFFFF); /* REG_RXFLTMAP0 (RX Filter Map Group 0) */ ++ } ++ ++ rtw_write32(pAdapter, REG_RCR, pHalData->ReceiveConfig); ++} ++ ++void ResetPhyRxPktCount(PADAPTER pAdapter) ++{ ++ u32 i, phyrx_set = 0; ++ ++ for (i = 0; i <= 0xF; i++) { ++ phyrx_set = 0; ++ phyrx_set |= _RXERR_RPT_SEL(i); /* select */ ++ phyrx_set |= RXERR_RPT_RST; /* set counter to zero */ ++ rtw_write32(pAdapter, REG_RXERR_RPT, phyrx_set); ++ } ++} ++ ++static u32 GetPhyRxPktCounts(PADAPTER pAdapter, u32 selbit) ++{ ++ /* selection */ ++ u32 phyrx_set = 0, count = 0; ++ ++ phyrx_set = _RXERR_RPT_SEL(selbit & 0xF); ++ rtw_write32(pAdapter, REG_RXERR_RPT, phyrx_set); ++ ++ /* Read packet count */ ++ count = rtw_read32(pAdapter, REG_RXERR_RPT) & RXERR_COUNTER_MASK; ++ ++ return count; ++} ++ ++u32 GetPhyRxPktReceived(PADAPTER pAdapter) ++{ ++ u32 OFDM_cnt = 0, CCK_cnt = 0, HT_cnt = 0; ++ ++ OFDM_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_OFDM_MPDU_OK); ++ CCK_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_CCK_MPDU_OK); ++ HT_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_HT_MPDU_OK); ++ ++ return OFDM_cnt + CCK_cnt + HT_cnt; ++} ++ ++u32 GetPhyRxPktCRC32Error(PADAPTER pAdapter) ++{ ++ u32 OFDM_cnt = 0, CCK_cnt = 0, HT_cnt = 0; ++ ++ OFDM_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_OFDM_MPDU_FAIL); ++ CCK_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_CCK_MPDU_FAIL); ++ HT_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_HT_MPDU_FAIL); ++ ++ return OFDM_cnt + CCK_cnt + HT_cnt; ++} ++ ++/* reg 0x808[9:0]: FFT data x ++ * reg 0x808[22]: 0 --> 1 to get 1 FFT data y ++ * reg 0x8B4[15:0]: FFT data y report */ ++static u32 rtw_GetPSDData(PADAPTER pAdapter, u32 point) ++{ ++ u32 psd_val = 0; ++ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++ u16 psd_reg = 0x910; ++ u16 psd_regL = 0xF44; ++#else ++ u16 psd_reg = 0x808; ++ u16 psd_regL = 0x8B4; ++#endif ++ ++ psd_val = rtw_read32(pAdapter, psd_reg); ++ ++ psd_val &= 0xFFBFFC00; ++ psd_val |= point; ++ ++ rtw_write32(pAdapter, psd_reg, psd_val); ++ rtw_mdelay_os(1); ++ psd_val |= 0x00400000; ++ ++ rtw_write32(pAdapter, psd_reg, psd_val); ++ rtw_mdelay_os(1); ++ ++ psd_val = rtw_read32(pAdapter, psd_regL); ++ psd_val &= 0x0000FFFF; ++ ++ return psd_val; ++} ++ ++/* ++ * pts start_point_min stop_point_max ++ * 128 64 64 + 128 = 192 ++ * 256 128 128 + 256 = 384 ++ * 512 256 256 + 512 = 768 ++ * 1024 512 512 + 1024 = 1536 ++ * ++ */ ++u32 mp_query_psd(PADAPTER pAdapter, u8 *data) ++{ ++ u32 i, psd_pts = 0, psd_start = 0, psd_stop = 0; ++ u32 psd_data = 0; ++ ++ ++#ifdef PLATFORM_LINUX ++ if (!netif_running(pAdapter->pnetdev)) { ++ return 0; ++ } ++#endif ++ ++ if (check_fwstate(&pAdapter->mlmepriv, WIFI_MP_STATE) == _FALSE) { ++ return 0; ++ } ++ ++ if (strlen(data) == 0) { /* default value */ ++ psd_pts = 128; ++ psd_start = 64; ++ psd_stop = 128; ++ } else ++ sscanf(data, "pts=%d,start=%d,stop=%d", &psd_pts, &psd_start, &psd_stop); ++ ++ data[0] = '\0'; ++ ++ i = psd_start; ++ while (i < psd_stop) { ++ if (i >= psd_pts) ++ psd_data = rtw_GetPSDData(pAdapter, i - psd_pts); ++ else ++ psd_data = rtw_GetPSDData(pAdapter, i); ++ sprintf(data, "%s%x ", data, psd_data); ++ i++; ++ } ++ ++#ifdef CONFIG_LONG_DELAY_ISSUE ++ rtw_msleep_os(100); ++#else ++ rtw_mdelay_os(100); ++#endif ++ ++ return strlen(data) + 1; ++} ++ ++ ++#if 0 ++void _rtw_mp_xmit_priv(struct xmit_priv *pxmitpriv) ++{ ++ int i, res; ++ _adapter *padapter = pxmitpriv->adapter; ++ struct xmit_frame *pxmitframe = (struct xmit_frame *) pxmitpriv->pxmit_frame_buf; ++ struct xmit_buf *pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf; ++ ++ u32 max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; ++ u32 num_xmit_extbuf = NR_XMIT_EXTBUFF; ++ if (padapter->registrypriv.mp_mode == 0) { ++ max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; ++ num_xmit_extbuf = NR_XMIT_EXTBUFF; ++ } else { ++ max_xmit_extbuf_size = 6000; ++ num_xmit_extbuf = 8; ++ } ++ ++ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; ++ for (i = 0; i < num_xmit_extbuf; i++) { ++ rtw_os_xmit_resource_free(padapter, pxmitbuf, (max_xmit_extbuf_size + XMITBUF_ALIGN_SZ), _FALSE); ++ ++ pxmitbuf++; ++ } ++ ++ if (pxmitpriv->pallocated_xmit_extbuf) ++ rtw_vmfree(pxmitpriv->pallocated_xmit_extbuf, num_xmit_extbuf * sizeof(struct xmit_buf) + 4); ++ ++ if (padapter->registrypriv.mp_mode == 0) { ++ max_xmit_extbuf_size = 6000; ++ num_xmit_extbuf = 8; ++ } else { ++ max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; ++ num_xmit_extbuf = NR_XMIT_EXTBUFF; ++ } ++ ++ /* Init xmit extension buff */ ++ _rtw_init_queue(&pxmitpriv->free_xmit_extbuf_queue); ++ ++ pxmitpriv->pallocated_xmit_extbuf = rtw_zvmalloc(num_xmit_extbuf * sizeof(struct xmit_buf) + 4); ++ ++ if (pxmitpriv->pallocated_xmit_extbuf == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pxmitpriv->pxmit_extbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_xmit_extbuf), 4); ++ ++ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; ++ ++ for (i = 0; i < num_xmit_extbuf; i++) { ++ _rtw_init_listhead(&pxmitbuf->list); ++ ++ pxmitbuf->priv_data = NULL; ++ pxmitbuf->padapter = padapter; ++ pxmitbuf->buf_tag = XMITBUF_MGNT; ++ ++ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, max_xmit_extbuf_size + XMITBUF_ALIGN_SZ, _TRUE); ++ if (res == _FAIL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ pxmitbuf->phead = pxmitbuf->pbuf; ++ pxmitbuf->pend = pxmitbuf->pbuf + max_xmit_extbuf_size; ++ pxmitbuf->len = 0; ++ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; ++#endif ++ ++ rtw_list_insert_tail(&pxmitbuf->list, &(pxmitpriv->free_xmit_extbuf_queue.queue)); ++#ifdef DBG_XMIT_BUF_EXT ++ pxmitbuf->no = i; ++#endif ++ pxmitbuf++; ++ ++ } ++ ++ pxmitpriv->free_xmit_extbuf_cnt = num_xmit_extbuf; ++ ++exit: ++ ; ++} ++#endif ++ ++u8 ++MptToMgntRate( ++ IN ULONG MptRateIdx ++) ++{ ++ /* Mapped to MGN_XXX defined in MgntGen.h */ ++ switch (MptRateIdx) { ++ /* CCK rate. */ ++ case MPT_RATE_1M: ++ return MGN_1M; ++ case MPT_RATE_2M: ++ return MGN_2M; ++ case MPT_RATE_55M: ++ return MGN_5_5M; ++ case MPT_RATE_11M: ++ return MGN_11M; ++ ++ /* OFDM rate. */ ++ case MPT_RATE_6M: ++ return MGN_6M; ++ case MPT_RATE_9M: ++ return MGN_9M; ++ case MPT_RATE_12M: ++ return MGN_12M; ++ case MPT_RATE_18M: ++ return MGN_18M; ++ case MPT_RATE_24M: ++ return MGN_24M; ++ case MPT_RATE_36M: ++ return MGN_36M; ++ case MPT_RATE_48M: ++ return MGN_48M; ++ case MPT_RATE_54M: ++ return MGN_54M; ++ ++ /* HT rate. */ ++ case MPT_RATE_MCS0: ++ return MGN_MCS0; ++ case MPT_RATE_MCS1: ++ return MGN_MCS1; ++ case MPT_RATE_MCS2: ++ return MGN_MCS2; ++ case MPT_RATE_MCS3: ++ return MGN_MCS3; ++ case MPT_RATE_MCS4: ++ return MGN_MCS4; ++ case MPT_RATE_MCS5: ++ return MGN_MCS5; ++ case MPT_RATE_MCS6: ++ return MGN_MCS6; ++ case MPT_RATE_MCS7: ++ return MGN_MCS7; ++ case MPT_RATE_MCS8: ++ return MGN_MCS8; ++ case MPT_RATE_MCS9: ++ return MGN_MCS9; ++ case MPT_RATE_MCS10: ++ return MGN_MCS10; ++ case MPT_RATE_MCS11: ++ return MGN_MCS11; ++ case MPT_RATE_MCS12: ++ return MGN_MCS12; ++ case MPT_RATE_MCS13: ++ return MGN_MCS13; ++ case MPT_RATE_MCS14: ++ return MGN_MCS14; ++ case MPT_RATE_MCS15: ++ return MGN_MCS15; ++ case MPT_RATE_MCS16: ++ return MGN_MCS16; ++ case MPT_RATE_MCS17: ++ return MGN_MCS17; ++ case MPT_RATE_MCS18: ++ return MGN_MCS18; ++ case MPT_RATE_MCS19: ++ return MGN_MCS19; ++ case MPT_RATE_MCS20: ++ return MGN_MCS20; ++ case MPT_RATE_MCS21: ++ return MGN_MCS21; ++ case MPT_RATE_MCS22: ++ return MGN_MCS22; ++ case MPT_RATE_MCS23: ++ return MGN_MCS23; ++ case MPT_RATE_MCS24: ++ return MGN_MCS24; ++ case MPT_RATE_MCS25: ++ return MGN_MCS25; ++ case MPT_RATE_MCS26: ++ return MGN_MCS26; ++ case MPT_RATE_MCS27: ++ return MGN_MCS27; ++ case MPT_RATE_MCS28: ++ return MGN_MCS28; ++ case MPT_RATE_MCS29: ++ return MGN_MCS29; ++ case MPT_RATE_MCS30: ++ return MGN_MCS30; ++ case MPT_RATE_MCS31: ++ return MGN_MCS31; ++ ++ /* VHT rate. */ ++ case MPT_RATE_VHT1SS_MCS0: ++ return MGN_VHT1SS_MCS0; ++ case MPT_RATE_VHT1SS_MCS1: ++ return MGN_VHT1SS_MCS1; ++ case MPT_RATE_VHT1SS_MCS2: ++ return MGN_VHT1SS_MCS2; ++ case MPT_RATE_VHT1SS_MCS3: ++ return MGN_VHT1SS_MCS3; ++ case MPT_RATE_VHT1SS_MCS4: ++ return MGN_VHT1SS_MCS4; ++ case MPT_RATE_VHT1SS_MCS5: ++ return MGN_VHT1SS_MCS5; ++ case MPT_RATE_VHT1SS_MCS6: ++ return MGN_VHT1SS_MCS6; ++ case MPT_RATE_VHT1SS_MCS7: ++ return MGN_VHT1SS_MCS7; ++ case MPT_RATE_VHT1SS_MCS8: ++ return MGN_VHT1SS_MCS8; ++ case MPT_RATE_VHT1SS_MCS9: ++ return MGN_VHT1SS_MCS9; ++ case MPT_RATE_VHT2SS_MCS0: ++ return MGN_VHT2SS_MCS0; ++ case MPT_RATE_VHT2SS_MCS1: ++ return MGN_VHT2SS_MCS1; ++ case MPT_RATE_VHT2SS_MCS2: ++ return MGN_VHT2SS_MCS2; ++ case MPT_RATE_VHT2SS_MCS3: ++ return MGN_VHT2SS_MCS3; ++ case MPT_RATE_VHT2SS_MCS4: ++ return MGN_VHT2SS_MCS4; ++ case MPT_RATE_VHT2SS_MCS5: ++ return MGN_VHT2SS_MCS5; ++ case MPT_RATE_VHT2SS_MCS6: ++ return MGN_VHT2SS_MCS6; ++ case MPT_RATE_VHT2SS_MCS7: ++ return MGN_VHT2SS_MCS7; ++ case MPT_RATE_VHT2SS_MCS8: ++ return MGN_VHT2SS_MCS8; ++ case MPT_RATE_VHT2SS_MCS9: ++ return MGN_VHT2SS_MCS9; ++ case MPT_RATE_VHT3SS_MCS0: ++ return MGN_VHT3SS_MCS0; ++ case MPT_RATE_VHT3SS_MCS1: ++ return MGN_VHT3SS_MCS1; ++ case MPT_RATE_VHT3SS_MCS2: ++ return MGN_VHT3SS_MCS2; ++ case MPT_RATE_VHT3SS_MCS3: ++ return MGN_VHT3SS_MCS3; ++ case MPT_RATE_VHT3SS_MCS4: ++ return MGN_VHT3SS_MCS4; ++ case MPT_RATE_VHT3SS_MCS5: ++ return MGN_VHT3SS_MCS5; ++ case MPT_RATE_VHT3SS_MCS6: ++ return MGN_VHT3SS_MCS6; ++ case MPT_RATE_VHT3SS_MCS7: ++ return MGN_VHT3SS_MCS7; ++ case MPT_RATE_VHT3SS_MCS8: ++ return MGN_VHT3SS_MCS8; ++ case MPT_RATE_VHT3SS_MCS9: ++ return MGN_VHT3SS_MCS9; ++ case MPT_RATE_VHT4SS_MCS0: ++ return MGN_VHT4SS_MCS0; ++ case MPT_RATE_VHT4SS_MCS1: ++ return MGN_VHT4SS_MCS1; ++ case MPT_RATE_VHT4SS_MCS2: ++ return MGN_VHT4SS_MCS2; ++ case MPT_RATE_VHT4SS_MCS3: ++ return MGN_VHT4SS_MCS3; ++ case MPT_RATE_VHT4SS_MCS4: ++ return MGN_VHT4SS_MCS4; ++ case MPT_RATE_VHT4SS_MCS5: ++ return MGN_VHT4SS_MCS5; ++ case MPT_RATE_VHT4SS_MCS6: ++ return MGN_VHT4SS_MCS6; ++ case MPT_RATE_VHT4SS_MCS7: ++ return MGN_VHT4SS_MCS7; ++ case MPT_RATE_VHT4SS_MCS8: ++ return MGN_VHT4SS_MCS8; ++ case MPT_RATE_VHT4SS_MCS9: ++ return MGN_VHT4SS_MCS9; ++ ++ case MPT_RATE_LAST: /* fully automatiMGN_VHT2SS_MCS1; */ ++ default: ++ RTW_INFO("<===MptToMgntRate(), Invalid Rate: %d!!\n", MptRateIdx); ++ return 0x0; ++ } ++} ++ ++ ++u8 HwRateToMPTRate(u8 rate) ++{ ++ u8 ret_rate = MGN_1M; ++ ++ switch (rate) { ++ case DESC_RATE1M: ++ ret_rate = MPT_RATE_1M; ++ break; ++ case DESC_RATE2M: ++ ret_rate = MPT_RATE_2M; ++ break; ++ case DESC_RATE5_5M: ++ ret_rate = MPT_RATE_55M; ++ break; ++ case DESC_RATE11M: ++ ret_rate = MPT_RATE_11M; ++ break; ++ case DESC_RATE6M: ++ ret_rate = MPT_RATE_6M; ++ break; ++ case DESC_RATE9M: ++ ret_rate = MPT_RATE_9M; ++ break; ++ case DESC_RATE12M: ++ ret_rate = MPT_RATE_12M; ++ break; ++ case DESC_RATE18M: ++ ret_rate = MPT_RATE_18M; ++ break; ++ case DESC_RATE24M: ++ ret_rate = MPT_RATE_24M; ++ break; ++ case DESC_RATE36M: ++ ret_rate = MPT_RATE_36M; ++ break; ++ case DESC_RATE48M: ++ ret_rate = MPT_RATE_48M; ++ break; ++ case DESC_RATE54M: ++ ret_rate = MPT_RATE_54M; ++ break; ++ case DESC_RATEMCS0: ++ ret_rate = MPT_RATE_MCS0; ++ break; ++ case DESC_RATEMCS1: ++ ret_rate = MPT_RATE_MCS1; ++ break; ++ case DESC_RATEMCS2: ++ ret_rate = MPT_RATE_MCS2; ++ break; ++ case DESC_RATEMCS3: ++ ret_rate = MPT_RATE_MCS3; ++ break; ++ case DESC_RATEMCS4: ++ ret_rate = MPT_RATE_MCS4; ++ break; ++ case DESC_RATEMCS5: ++ ret_rate = MPT_RATE_MCS5; ++ break; ++ case DESC_RATEMCS6: ++ ret_rate = MPT_RATE_MCS6; ++ break; ++ case DESC_RATEMCS7: ++ ret_rate = MPT_RATE_MCS7; ++ break; ++ case DESC_RATEMCS8: ++ ret_rate = MPT_RATE_MCS8; ++ break; ++ case DESC_RATEMCS9: ++ ret_rate = MPT_RATE_MCS9; ++ break; ++ case DESC_RATEMCS10: ++ ret_rate = MPT_RATE_MCS10; ++ break; ++ case DESC_RATEMCS11: ++ ret_rate = MPT_RATE_MCS11; ++ break; ++ case DESC_RATEMCS12: ++ ret_rate = MPT_RATE_MCS12; ++ break; ++ case DESC_RATEMCS13: ++ ret_rate = MPT_RATE_MCS13; ++ break; ++ case DESC_RATEMCS14: ++ ret_rate = MPT_RATE_MCS14; ++ break; ++ case DESC_RATEMCS15: ++ ret_rate = MPT_RATE_MCS15; ++ break; ++ case DESC_RATEMCS16: ++ ret_rate = MPT_RATE_MCS16; ++ break; ++ case DESC_RATEMCS17: ++ ret_rate = MPT_RATE_MCS17; ++ break; ++ case DESC_RATEMCS18: ++ ret_rate = MPT_RATE_MCS18; ++ break; ++ case DESC_RATEMCS19: ++ ret_rate = MPT_RATE_MCS19; ++ break; ++ case DESC_RATEMCS20: ++ ret_rate = MPT_RATE_MCS20; ++ break; ++ case DESC_RATEMCS21: ++ ret_rate = MPT_RATE_MCS21; ++ break; ++ case DESC_RATEMCS22: ++ ret_rate = MPT_RATE_MCS22; ++ break; ++ case DESC_RATEMCS23: ++ ret_rate = MPT_RATE_MCS23; ++ break; ++ case DESC_RATEMCS24: ++ ret_rate = MPT_RATE_MCS24; ++ break; ++ case DESC_RATEMCS25: ++ ret_rate = MPT_RATE_MCS25; ++ break; ++ case DESC_RATEMCS26: ++ ret_rate = MPT_RATE_MCS26; ++ break; ++ case DESC_RATEMCS27: ++ ret_rate = MPT_RATE_MCS27; ++ break; ++ case DESC_RATEMCS28: ++ ret_rate = MPT_RATE_MCS28; ++ break; ++ case DESC_RATEMCS29: ++ ret_rate = MPT_RATE_MCS29; ++ break; ++ case DESC_RATEMCS30: ++ ret_rate = MPT_RATE_MCS30; ++ break; ++ case DESC_RATEMCS31: ++ ret_rate = MPT_RATE_MCS31; ++ break; ++ case DESC_RATEVHTSS1MCS0: ++ ret_rate = MPT_RATE_VHT1SS_MCS0; ++ break; ++ case DESC_RATEVHTSS1MCS1: ++ ret_rate = MPT_RATE_VHT1SS_MCS1; ++ break; ++ case DESC_RATEVHTSS1MCS2: ++ ret_rate = MPT_RATE_VHT1SS_MCS2; ++ break; ++ case DESC_RATEVHTSS1MCS3: ++ ret_rate = MPT_RATE_VHT1SS_MCS3; ++ break; ++ case DESC_RATEVHTSS1MCS4: ++ ret_rate = MPT_RATE_VHT1SS_MCS4; ++ break; ++ case DESC_RATEVHTSS1MCS5: ++ ret_rate = MPT_RATE_VHT1SS_MCS5; ++ break; ++ case DESC_RATEVHTSS1MCS6: ++ ret_rate = MPT_RATE_VHT1SS_MCS6; ++ break; ++ case DESC_RATEVHTSS1MCS7: ++ ret_rate = MPT_RATE_VHT1SS_MCS7; ++ break; ++ case DESC_RATEVHTSS1MCS8: ++ ret_rate = MPT_RATE_VHT1SS_MCS8; ++ break; ++ case DESC_RATEVHTSS1MCS9: ++ ret_rate = MPT_RATE_VHT1SS_MCS9; ++ break; ++ case DESC_RATEVHTSS2MCS0: ++ ret_rate = MPT_RATE_VHT2SS_MCS0; ++ break; ++ case DESC_RATEVHTSS2MCS1: ++ ret_rate = MPT_RATE_VHT2SS_MCS1; ++ break; ++ case DESC_RATEVHTSS2MCS2: ++ ret_rate = MPT_RATE_VHT2SS_MCS2; ++ break; ++ case DESC_RATEVHTSS2MCS3: ++ ret_rate = MPT_RATE_VHT2SS_MCS3; ++ break; ++ case DESC_RATEVHTSS2MCS4: ++ ret_rate = MPT_RATE_VHT2SS_MCS4; ++ break; ++ case DESC_RATEVHTSS2MCS5: ++ ret_rate = MPT_RATE_VHT2SS_MCS5; ++ break; ++ case DESC_RATEVHTSS2MCS6: ++ ret_rate = MPT_RATE_VHT2SS_MCS6; ++ break; ++ case DESC_RATEVHTSS2MCS7: ++ ret_rate = MPT_RATE_VHT2SS_MCS7; ++ break; ++ case DESC_RATEVHTSS2MCS8: ++ ret_rate = MPT_RATE_VHT2SS_MCS8; ++ break; ++ case DESC_RATEVHTSS2MCS9: ++ ret_rate = MPT_RATE_VHT2SS_MCS9; ++ break; ++ case DESC_RATEVHTSS3MCS0: ++ ret_rate = MPT_RATE_VHT3SS_MCS0; ++ break; ++ case DESC_RATEVHTSS3MCS1: ++ ret_rate = MPT_RATE_VHT3SS_MCS1; ++ break; ++ case DESC_RATEVHTSS3MCS2: ++ ret_rate = MPT_RATE_VHT3SS_MCS2; ++ break; ++ case DESC_RATEVHTSS3MCS3: ++ ret_rate = MPT_RATE_VHT3SS_MCS3; ++ break; ++ case DESC_RATEVHTSS3MCS4: ++ ret_rate = MPT_RATE_VHT3SS_MCS4; ++ break; ++ case DESC_RATEVHTSS3MCS5: ++ ret_rate = MPT_RATE_VHT3SS_MCS5; ++ break; ++ case DESC_RATEVHTSS3MCS6: ++ ret_rate = MPT_RATE_VHT3SS_MCS6; ++ break; ++ case DESC_RATEVHTSS3MCS7: ++ ret_rate = MPT_RATE_VHT3SS_MCS7; ++ break; ++ case DESC_RATEVHTSS3MCS8: ++ ret_rate = MPT_RATE_VHT3SS_MCS8; ++ break; ++ case DESC_RATEVHTSS3MCS9: ++ ret_rate = MPT_RATE_VHT3SS_MCS9; ++ break; ++ case DESC_RATEVHTSS4MCS0: ++ ret_rate = MPT_RATE_VHT4SS_MCS0; ++ break; ++ case DESC_RATEVHTSS4MCS1: ++ ret_rate = MPT_RATE_VHT4SS_MCS1; ++ break; ++ case DESC_RATEVHTSS4MCS2: ++ ret_rate = MPT_RATE_VHT4SS_MCS2; ++ break; ++ case DESC_RATEVHTSS4MCS3: ++ ret_rate = MPT_RATE_VHT4SS_MCS3; ++ break; ++ case DESC_RATEVHTSS4MCS4: ++ ret_rate = MPT_RATE_VHT4SS_MCS4; ++ break; ++ case DESC_RATEVHTSS4MCS5: ++ ret_rate = MPT_RATE_VHT4SS_MCS5; ++ break; ++ case DESC_RATEVHTSS4MCS6: ++ ret_rate = MPT_RATE_VHT4SS_MCS6; ++ break; ++ case DESC_RATEVHTSS4MCS7: ++ ret_rate = MPT_RATE_VHT4SS_MCS7; ++ break; ++ case DESC_RATEVHTSS4MCS8: ++ ret_rate = MPT_RATE_VHT4SS_MCS8; ++ break; ++ case DESC_RATEVHTSS4MCS9: ++ ret_rate = MPT_RATE_VHT4SS_MCS9; ++ break; ++ ++ default: ++ RTW_INFO("HwRateToMRate(): Non supported Rate [%x]!!!\n", rate); ++ break; ++ } ++ return ret_rate; ++} ++ ++u8 rtw_mpRateParseFunc(PADAPTER pAdapter, u8 *targetStr) ++{ ++ u16 i = 0; ++ u8 *rateindex_Array[] = { "1M", "2M", "5.5M", "11M", "6M", "9M", "12M", "18M", "24M", "36M", "48M", "54M", ++ "HTMCS0", "HTMCS1", "HTMCS2", "HTMCS3", "HTMCS4", "HTMCS5", "HTMCS6", "HTMCS7", ++ "HTMCS8", "HTMCS9", "HTMCS10", "HTMCS11", "HTMCS12", "HTMCS13", "HTMCS14", "HTMCS15", ++ "HTMCS16", "HTMCS17", "HTMCS18", "HTMCS19", "HTMCS20", "HTMCS21", "HTMCS22", "HTMCS23", ++ "HTMCS24", "HTMCS25", "HTMCS26", "HTMCS27", "HTMCS28", "HTMCS29", "HTMCS30", "HTMCS31", ++ "VHT1MCS0", "VHT1MCS1", "VHT1MCS2", "VHT1MCS3", "VHT1MCS4", "VHT1MCS5", "VHT1MCS6", "VHT1MCS7", "VHT1MCS8", "VHT1MCS9", ++ "VHT2MCS0", "VHT2MCS1", "VHT2MCS2", "VHT2MCS3", "VHT2MCS4", "VHT2MCS5", "VHT2MCS6", "VHT2MCS7", "VHT2MCS8", "VHT2MCS9", ++ "VHT3MCS0", "VHT3MCS1", "VHT3MCS2", "VHT3MCS3", "VHT3MCS4", "VHT3MCS5", "VHT3MCS6", "VHT3MCS7", "VHT3MCS8", "VHT3MCS9", ++ "VHT4MCS0", "VHT4MCS1", "VHT4MCS2", "VHT4MCS3", "VHT4MCS4", "VHT4MCS5", "VHT4MCS6", "VHT4MCS7", "VHT4MCS8", "VHT4MCS9" ++ }; ++ ++ for (i = 0; i <= 83; i++) { ++ if (strcmp(targetStr, rateindex_Array[i]) == 0) { ++ RTW_INFO("%s , index = %d\n", __func__ , i); ++ return i; ++ } ++ } ++ ++ printk("%s ,please input a Data RATE String as:", __func__); ++ for (i = 0; i <= 83; i++) { ++ printk("%s ", rateindex_Array[i]); ++ if (i % 10 == 0) ++ printk("\n"); ++ } ++ return _FAIL; ++} ++ ++ULONG mpt_ProQueryCalTxPower( ++ PADAPTER pAdapter, ++ u8 RfPath ++) ++{ ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ ++ ULONG TxPower = 1; ++ u1Byte rate = 0; ++ struct txpwr_idx_comp tic; ++ u8 mgn_rate = MptToMgntRate(pMptCtx->MptRateIndex); ++ ++ TxPower = rtw_hal_get_tx_power_index(pAdapter, RfPath, mgn_rate, pHalData->CurrentChannelBW, pHalData->CurrentChannel, &tic); ++ ++ RTW_INFO("bw=%d, ch=%d, rate=%d, txPower:%u = %u + (%d=%d:%d) + (%d) + (%d)\n", ++ pHalData->CurrentChannelBW, pHalData->CurrentChannel, mgn_rate ++ , TxPower, tic.base, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt, tic.ebias); ++ ++ pAdapter->mppriv.txpoweridx = (u8)TxPower; ++ pMptCtx->TxPwrLevel[ODM_RF_PATH_A] = (u8)TxPower; ++ pMptCtx->TxPwrLevel[ODM_RF_PATH_B] = (u8)TxPower; ++ pMptCtx->TxPwrLevel[ODM_RF_PATH_C] = (u8)TxPower; ++ pMptCtx->TxPwrLevel[ODM_RF_PATH_D] = (u8)TxPower; ++ hal_mpt_SetTxPower(pAdapter); ++ ++ return TxPower; ++} ++ ++#ifdef CONFIG_MP_VHT_HW_TX_MODE ++static inline void dump_buf(u8 *buf, u32 len) ++{ ++ u32 i; ++ ++ RTW_INFO("-----------------Len %d----------------\n", len); ++ for (i = 0; i < len; i++) ++ RTW_INFO("%2.2x-", *(buf + i)); ++ RTW_INFO("\n"); ++} ++ ++void ByteToBit( ++ UCHAR *out, ++ bool *in, ++ UCHAR in_size) ++{ ++ UCHAR i = 0, j = 0; ++ ++ for (i = 0; i < in_size; i++) { ++ for (j = 0; j < 8; j++) { ++ if (in[8 * i + j]) ++ out[i] |= (1 << j); ++ } ++ } ++} ++ ++ ++void CRC16_generator( ++ bool *out, ++ bool *in, ++ UCHAR in_size ++) ++{ ++ UCHAR i = 0; ++ bool temp = 0, reg[] = {1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1}; ++ ++ for (i = 0; i < in_size; i++) {/* take one's complement and bit reverse*/ ++ temp = in[i] ^ reg[15]; ++ reg[15] = reg[14]; ++ reg[14] = reg[13]; ++ reg[13] = reg[12]; ++ reg[12] = reg[11]; ++ reg[11] = reg[10]; ++ reg[10] = reg[9]; ++ reg[9] = reg[8]; ++ reg[8] = reg[7]; ++ ++ reg[7] = reg[6]; ++ reg[6] = reg[5]; ++ reg[5] = reg[4]; ++ reg[4] = reg[3]; ++ reg[3] = reg[2]; ++ reg[2] = reg[1]; ++ reg[1] = reg[0]; ++ reg[12] = reg[12] ^ temp; ++ reg[5] = reg[5] ^ temp; ++ reg[0] = temp; ++ } ++ for (i = 0; i < 16; i++) /* take one's complement and bit reverse*/ ++ out[i] = 1 - reg[15 - i]; ++} ++ ++ ++ ++/*======================================== ++ SFD SIGNAL SERVICE LENGTH CRC ++ 16 bit 8 bit 8 bit 16 bit 16 bit ++========================================*/ ++void CCK_generator( ++ PRT_PMAC_TX_INFO pPMacTxInfo, ++ PRT_PMAC_PKT_INFO pPMacPktInfo ++) ++{ ++ double ratio = 0; ++ bool crc16_in[32] = {0}, crc16_out[16] = {0}; ++ bool LengthExtBit; ++ double LengthExact; ++ double LengthPSDU; ++ UCHAR i; ++ UINT PacketLength = pPMacTxInfo->PacketLength; ++ ++ if (pPMacTxInfo->bSPreamble) ++ pPMacTxInfo->SFD = 0x05CF; ++ else ++ pPMacTxInfo->SFD = 0xF3A0; ++ ++ switch (pPMacPktInfo->MCS) { ++ case 0: ++ pPMacTxInfo->SignalField = 0xA; ++ ratio = 8; ++ /*CRC16_in(1,0:7)=[0 1 0 1 0 0 0 0]*/ ++ crc16_in[1] = crc16_in[3] = 1; ++ break; ++ case 1: ++ pPMacTxInfo->SignalField = 0x14; ++ ratio = 4; ++ /*CRC16_in(1,0:7)=[0 0 1 0 1 0 0 0];*/ ++ crc16_in[2] = crc16_in[4] = 1; ++ break; ++ case 2: ++ pPMacTxInfo->SignalField = 0x37; ++ ratio = 8.0 / 5.5; ++ /*CRC16_in(1,0:7)=[1 1 1 0 1 1 0 0];*/ ++ crc16_in[0] = crc16_in[1] = crc16_in[2] = crc16_in[4] = crc16_in[5] = 1; ++ break; ++ case 3: ++ pPMacTxInfo->SignalField = 0x6E; ++ ratio = 8.0 / 11.0; ++ /*CRC16_in(1,0:7)=[0 1 1 1 0 1 1 0];*/ ++ crc16_in[1] = crc16_in[2] = crc16_in[3] = crc16_in[5] = crc16_in[6] = 1; ++ break; ++ } ++ ++ LengthExact = PacketLength * ratio; ++ LengthPSDU = ceil(LengthExact); ++ ++ if ((pPMacPktInfo->MCS == 3) && ++ ((LengthPSDU - LengthExact) >= 0.727 || (LengthPSDU - LengthExact) <= -0.727)) ++ LengthExtBit = 1; ++ else ++ LengthExtBit = 0; ++ ++ ++ pPMacTxInfo->LENGTH = (UINT)LengthPSDU; ++ /* CRC16_in(1,16:31) = LengthPSDU[0:15]*/ ++ for (i = 0; i < 16; i++) ++ crc16_in[i + 16] = (pPMacTxInfo->LENGTH >> i) & 0x1; ++ ++ if (LengthExtBit == 0) { ++ pPMacTxInfo->ServiceField = 0x0; ++ /* CRC16_in(1,8:15) = [0 0 0 0 0 0 0 0];*/ ++ } else { ++ pPMacTxInfo->ServiceField = 0x80; ++ /*CRC16_in(1,8:15)=[0 0 0 0 0 0 0 1];*/ ++ crc16_in[15] = 1; ++ } ++ ++ CRC16_generator(crc16_out, crc16_in, 32); ++ ++ _rtw_memset(pPMacTxInfo->CRC16, 0, 2); ++ ByteToBit(pPMacTxInfo->CRC16, crc16_out, 2); ++ ++} ++ ++ ++void PMAC_Get_Pkt_Param( ++ PRT_PMAC_TX_INFO pPMacTxInfo, ++ PRT_PMAC_PKT_INFO pPMacPktInfo) ++{ ++ ++ UCHAR TX_RATE_HEX = 0, MCS = 0; ++ UCHAR TX_RATE = pPMacTxInfo->TX_RATE; ++ ++ /* TX_RATE & Nss */ ++ if (MPT_IS_2SS_RATE(TX_RATE)) ++ pPMacPktInfo->Nss = 2; ++ else if (MPT_IS_3SS_RATE(TX_RATE)) ++ pPMacPktInfo->Nss = 3; ++ else if (MPT_IS_4SS_RATE(TX_RATE)) ++ pPMacPktInfo->Nss = 4; ++ else ++ pPMacPktInfo->Nss = 1; ++ ++ RTW_INFO("PMacTxInfo.Nss =%d\n", pPMacPktInfo->Nss); ++ ++ /* MCS & TX_RATE_HEX*/ ++ if (MPT_IS_CCK_RATE(TX_RATE)) { ++ switch (TX_RATE) { ++ case MPT_RATE_1M: ++ TX_RATE_HEX = MCS = 0; ++ break; ++ case MPT_RATE_2M: ++ TX_RATE_HEX = MCS = 1; ++ break; ++ case MPT_RATE_55M: ++ TX_RATE_HEX = MCS = 2; ++ break; ++ case MPT_RATE_11M: ++ TX_RATE_HEX = MCS = 3; ++ break; ++ } ++ } else if (MPT_IS_OFDM_RATE(TX_RATE)) { ++ MCS = TX_RATE - MPT_RATE_6M; ++ TX_RATE_HEX = MCS + 4; ++ } else if (MPT_IS_HT_RATE(TX_RATE)) { ++ MCS = TX_RATE - MPT_RATE_MCS0; ++ TX_RATE_HEX = MCS + 12; ++ } else if (MPT_IS_VHT_RATE(TX_RATE)) { ++ TX_RATE_HEX = TX_RATE - MPT_RATE_VHT1SS_MCS0 + 44; ++ ++ if (MPT_IS_VHT_2S_RATE(TX_RATE)) ++ MCS = TX_RATE - MPT_RATE_VHT2SS_MCS0; ++ else if (MPT_IS_VHT_3S_RATE(TX_RATE)) ++ MCS = TX_RATE - MPT_RATE_VHT3SS_MCS0; ++ else if (MPT_IS_VHT_4S_RATE(TX_RATE)) ++ MCS = TX_RATE - MPT_RATE_VHT4SS_MCS0; ++ else ++ MCS = TX_RATE - MPT_RATE_VHT1SS_MCS0; ++ } ++ ++ pPMacPktInfo->MCS = MCS; ++ pPMacTxInfo->TX_RATE_HEX = TX_RATE_HEX; ++ ++ RTW_INFO(" MCS=%d, TX_RATE_HEX =0x%x\n", MCS, pPMacTxInfo->TX_RATE_HEX); ++ /* mSTBC & Nsts*/ ++ pPMacPktInfo->Nsts = pPMacPktInfo->Nss; ++ if (pPMacTxInfo->bSTBC) { ++ if (pPMacPktInfo->Nss == 1) { ++ pPMacTxInfo->m_STBC = 2; ++ pPMacPktInfo->Nsts = pPMacPktInfo->Nss * 2; ++ } else ++ pPMacTxInfo->m_STBC = 1; ++ } else ++ pPMacTxInfo->m_STBC = 1; ++} ++ ++ ++UINT LDPC_parameter_generator( ++ UINT N_pld_int, ++ UINT N_CBPSS, ++ UINT N_SS, ++ UINT R, ++ UINT m_STBC, ++ UINT N_TCB_int ++) ++{ ++ double CR = 0.; ++ double N_pld = (double)N_pld_int; ++ double N_TCB = (double)N_TCB_int; ++ double N_CW = 0., N_shrt = 0., N_spcw = 0., N_fshrt = 0.; ++ double L_LDPC = 0., K_LDPC = 0., L_LDPC_info = 0.; ++ double N_punc = 0., N_ppcw = 0., N_fpunc = 0., N_rep = 0., N_rpcw = 0., N_frep = 0.; ++ double R_eff = 0.; ++ UINT VHTSIGA2B3 = 0;/* extra symbol from VHT-SIG-A2 Bit 3*/ ++ ++ if (R == 0) ++ CR = 0.5; ++ else if (R == 1) ++ CR = 2. / 3.; ++ else if (R == 2) ++ CR = 3. / 4.; ++ else if (R == 3) ++ CR = 5. / 6.; ++ ++ if (N_TCB <= 648.) { ++ N_CW = 1.; ++ if (N_TCB >= N_pld + 912.*(1. - CR)) ++ L_LDPC = 1296.; ++ else ++ L_LDPC = 648.; ++ } else if (N_TCB <= 1296.) { ++ N_CW = 1.; ++ if (N_TCB >= (double)N_pld + 1464.*(1. - CR)) ++ L_LDPC = 1944.; ++ else ++ L_LDPC = 1296.; ++ } else if (N_TCB <= 1944.) { ++ N_CW = 1.; ++ L_LDPC = 1944.; ++ } else if (N_TCB <= 2592.) { ++ N_CW = 2.; ++ if (N_TCB >= N_pld + 2916.*(1. - CR)) ++ L_LDPC = 1944.; ++ else ++ L_LDPC = 1296.; ++ } else { ++ N_CW = ceil(N_pld / 1944. / CR); ++ L_LDPC = 1944.; ++ } ++ /* Number of information bits per CW*/ ++ K_LDPC = L_LDPC * CR; ++ /* Number of shortening bits max(0, (N_CW * L_LDPC * R) - N_pld)*/ ++ N_shrt = (N_CW * K_LDPC - N_pld) > 0. ? (N_CW * K_LDPC - N_pld) : 0.; ++ /* Number of shortening bits per CW N_spcw = rtfloor(N_shrt/N_CW)*/ ++ N_spcw = rtfloor(N_shrt / N_CW); ++ /* The first N_fshrt CWs shorten 1 bit more*/ ++ N_fshrt = (double)((int)N_shrt % (int)N_CW); ++ /* Number of data bits for the last N_CW-N_fshrt CWs*/ ++ L_LDPC_info = K_LDPC - N_spcw; ++ /* Number of puncturing bits*/ ++ N_punc = (N_CW * L_LDPC - N_TCB - N_shrt) > 0. ? (N_CW * L_LDPC - N_TCB - N_shrt) : 0.; ++ if (((N_punc > .1 * N_CW * L_LDPC * (1. - CR)) && (N_shrt < 1.2 * N_punc * CR / (1. - CR))) || ++ (N_punc > 0.3 * N_CW * L_LDPC * (1. - CR))) { ++ /*cout << "*** N_TCB and N_punc are Recomputed ***" << endl;*/ ++ VHTSIGA2B3 = 1; ++ N_TCB += (double)N_CBPSS * N_SS * m_STBC; ++ N_punc = (N_CW * L_LDPC - N_TCB - N_shrt) > 0. ? (N_CW * L_LDPC - N_TCB - N_shrt) : 0.; ++ } else ++ VHTSIGA2B3 = 0; ++ ++ return VHTSIGA2B3; ++} /* function end of LDPC_parameter_generator */ ++ ++/*======================================== ++ Data field of PPDU ++ Get N_sym and SIGA2BB3 ++========================================*/ ++void PMAC_Nsym_generator( ++ PRT_PMAC_TX_INFO pPMacTxInfo, ++ PRT_PMAC_PKT_INFO pPMacPktInfo) ++{ ++ UINT SIGA2B3 = 0; ++ UCHAR TX_RATE = pPMacTxInfo->TX_RATE; ++ ++ UINT R, R_list[10] = {0, 0, 2, 0, 2, 1, 2, 3, 2, 3}; ++ double CR = 0; ++ UINT N_SD, N_BPSC_list[10] = {1, 2, 2, 4, 4, 6, 6, 6, 8, 8}; ++ UINT N_BPSC = 0, N_CBPS = 0, N_DBPS = 0, N_ES = 0, N_SYM = 0, N_pld = 0, N_TCB = 0; ++ int D_R = 0; ++ ++ RTW_INFO("TX_RATE = %d\n", TX_RATE); ++ /* N_SD*/ ++ if (pPMacTxInfo->BandWidth == 0) ++ N_SD = 52; ++ else if (pPMacTxInfo->BandWidth == 1) ++ N_SD = 108; ++ else ++ N_SD = 234; ++ ++ if (MPT_IS_HT_RATE(TX_RATE)) { ++ UCHAR MCS_temp; ++ ++ if (pPMacPktInfo->MCS > 23) ++ MCS_temp = pPMacPktInfo->MCS - 24; ++ else if (pPMacPktInfo->MCS > 15) ++ MCS_temp = pPMacPktInfo->MCS - 16; ++ else if (pPMacPktInfo->MCS > 7) ++ MCS_temp = pPMacPktInfo->MCS - 8; ++ else ++ MCS_temp = pPMacPktInfo->MCS; ++ ++ R = R_list[MCS_temp]; ++ ++ switch (R) { ++ case 0: ++ CR = .5; ++ break; ++ case 1: ++ CR = 2. / 3.; ++ break; ++ case 2: ++ CR = 3. / 4.; ++ break; ++ case 3: ++ CR = 5. / 6.; ++ break; ++ } ++ ++ N_BPSC = N_BPSC_list[MCS_temp]; ++ N_CBPS = N_BPSC * N_SD * pPMacPktInfo->Nss; ++ N_DBPS = (UINT)((double)N_CBPS * CR); ++ ++ if (pPMacTxInfo->bLDPC == FALSE) { ++ N_ES = (UINT)ceil((double)(N_DBPS * pPMacPktInfo->Nss) / 4. / 300.); ++ RTW_INFO("N_ES = %d\n", N_ES); ++ ++ /* N_SYM = m_STBC* (8*length+16+6*N_ES) / (m_STBC*N_DBPS)*/ ++ N_SYM = pPMacTxInfo->m_STBC * (UINT)ceil((double)(pPMacTxInfo->PacketLength * 8 + 16 + N_ES * 6) / ++ (double)(N_DBPS * pPMacTxInfo->m_STBC)); ++ ++ } else { ++ N_ES = 1; ++ /* N_pld = length * 8 + 16*/ ++ N_pld = pPMacTxInfo->PacketLength * 8 + 16; ++ RTW_INFO("N_pld = %d\n", N_pld); ++ N_SYM = pPMacTxInfo->m_STBC * (UINT)ceil((double)(N_pld) / ++ (double)(N_DBPS * pPMacTxInfo->m_STBC)); ++ RTW_INFO("N_SYM = %d\n", N_SYM); ++ /* N_avbits = N_CBPS *m_STBC *(N_pld/N_CBPS*R*m_STBC)*/ ++ N_TCB = N_CBPS * N_SYM; ++ RTW_INFO("N_TCB = %d\n", N_TCB); ++ SIGA2B3 = LDPC_parameter_generator(N_pld, N_CBPS, pPMacPktInfo->Nss, R, pPMacTxInfo->m_STBC, N_TCB); ++ RTW_INFO("SIGA2B3 = %d\n", SIGA2B3); ++ N_SYM = N_SYM + SIGA2B3 * pPMacTxInfo->m_STBC; ++ RTW_INFO("N_SYM = %d\n", N_SYM); ++ } ++ } else if (MPT_IS_VHT_RATE(TX_RATE)) { ++ R = R_list[pPMacPktInfo->MCS]; ++ ++ switch (R) { ++ case 0: ++ CR = .5; ++ break; ++ case 1: ++ CR = 2. / 3.; ++ break; ++ case 2: ++ CR = 3. / 4.; ++ break; ++ case 3: ++ CR = 5. / 6.; ++ break; ++ } ++ N_BPSC = N_BPSC_list[pPMacPktInfo->MCS]; ++ N_CBPS = N_BPSC * N_SD * pPMacPktInfo->Nss; ++ N_DBPS = (UINT)((double)N_CBPS * CR); ++ if (pPMacTxInfo->bLDPC == FALSE) { ++ if (pPMacTxInfo->bSGI) ++ N_ES = (UINT)ceil((double)(N_DBPS) / 3.6 / 600.); ++ else ++ N_ES = (UINT)ceil((double)(N_DBPS) / 4. / 600.); ++ /* N_SYM = m_STBC* (8*length+16+6*N_ES) / (m_STBC*N_DBPS)*/ ++ N_SYM = pPMacTxInfo->m_STBC * (UINT)ceil((double)(pPMacTxInfo->PacketLength * 8 + 16 + N_ES * 6) / (double)(N_DBPS * pPMacTxInfo->m_STBC)); ++ SIGA2B3 = 0; ++ } else { ++ N_ES = 1; ++ /* N_SYM = m_STBC* (8*length+N_service) / (m_STBC*N_DBPS)*/ ++ N_SYM = pPMacTxInfo->m_STBC * (UINT)ceil((double)(pPMacTxInfo->PacketLength * 8 + 16) / (double)(N_DBPS * pPMacTxInfo->m_STBC)); ++ /* N_avbits = N_sys_init * N_CBPS*/ ++ N_TCB = N_CBPS * N_SYM; ++ /* N_pld = N_sys_init * N_DBPS*/ ++ N_pld = N_SYM * N_DBPS; ++ SIGA2B3 = LDPC_parameter_generator(N_pld, N_CBPS, pPMacPktInfo->Nss, R, pPMacTxInfo->m_STBC, N_TCB); ++ N_SYM = N_SYM + SIGA2B3 * pPMacTxInfo->m_STBC; ++ } ++ ++ switch (R) { ++ case 0: ++ D_R = 2; ++ break; ++ case 1: ++ D_R = 3; ++ break; ++ case 2: ++ D_R = 4; ++ break; ++ case 3: ++ D_R = 6; ++ break; ++ } ++ ++ if (((N_CBPS / N_ES) % D_R) != 0) { ++ RTW_INFO("MCS= %d is not supported when Nss=%d and BW= %d !!\n", pPMacPktInfo->MCS, pPMacPktInfo->Nss, pPMacTxInfo->BandWidth); ++ return; ++ } ++ ++ RTW_INFO("MCS= %d Nss=%d and BW= %d !!\n", pPMacPktInfo->MCS, pPMacPktInfo->Nss, pPMacTxInfo->BandWidth); ++ } ++ ++ pPMacPktInfo->N_sym = N_SYM; ++ pPMacPktInfo->SIGA2B3 = SIGA2B3; ++} ++ ++/*======================================== ++ L-SIG Rate R Length P Tail ++ 4b 1b 12b 1b 6b ++========================================*/ ++ ++void L_SIG_generator( ++ UINT N_SYM, /* Max: 750*/ ++ PRT_PMAC_TX_INFO pPMacTxInfo, ++ PRT_PMAC_PKT_INFO pPMacPktInfo) ++{ ++ u8 sig_bi[24] = {0}; /* 24 BIT*/ ++ UINT mode, LENGTH; ++ int i; ++ ++ if (MPT_IS_OFDM_RATE(pPMacTxInfo->TX_RATE)) { ++ mode = pPMacPktInfo->MCS; ++ LENGTH = pPMacTxInfo->PacketLength; ++ } else { ++ UCHAR N_LTF; ++ double T_data; ++ UINT OFDM_symbol; ++ ++ mode = 0; ++ ++ /* Table 20-13 Num of HT-DLTFs request*/ ++ if (pPMacPktInfo->Nsts <= 2) ++ N_LTF = pPMacPktInfo->Nsts; ++ else ++ N_LTF = 4; ++ ++ if (pPMacTxInfo->bSGI) ++ T_data = 3.6; ++ else ++ T_data = 4.0; ++ ++ /*(L-SIG, HT-SIG, HT-STF, HT-LTF....HT-LTF, Data)*/ ++ if (MPT_IS_VHT_RATE(pPMacTxInfo->TX_RATE)) ++ OFDM_symbol = (UINT)ceil((double)(8 + 4 + N_LTF * 4 + N_SYM * T_data + 4) / 4.); ++ else ++ OFDM_symbol = (UINT)ceil((double)(8 + 4 + N_LTF * 4 + N_SYM * T_data) / 4.); ++ ++ RTW_INFO("%s , OFDM_symbol =%d\n", __func__, OFDM_symbol); ++ LENGTH = OFDM_symbol * 3 - 3; ++ RTW_INFO("%s , LENGTH =%d\n", __func__, LENGTH); ++ ++ } ++ /* Rate Field*/ ++ switch (mode) { ++ case 0: ++ sig_bi[0] = 1; ++ sig_bi[1] = 1; ++ sig_bi[2] = 0; ++ sig_bi[3] = 1; ++ break; ++ case 1: ++ sig_bi[0] = 1; ++ sig_bi[1] = 1; ++ sig_bi[2] = 1; ++ sig_bi[3] = 1; ++ break; ++ case 2: ++ sig_bi[0] = 0; ++ sig_bi[1] = 1; ++ sig_bi[2] = 0; ++ sig_bi[3] = 1; ++ break; ++ case 3: ++ sig_bi[0] = 0; ++ sig_bi[1] = 1; ++ sig_bi[2] = 1; ++ sig_bi[3] = 1; ++ break; ++ case 4: ++ sig_bi[0] = 1; ++ sig_bi[1] = 0; ++ sig_bi[2] = 0; ++ sig_bi[3] = 1; ++ break; ++ case 5: ++ sig_bi[0] = 1; ++ sig_bi[1] = 0; ++ sig_bi[2] = 1; ++ sig_bi[3] = 1; ++ break; ++ case 6: ++ sig_bi[0] = 0; ++ sig_bi[1] = 0; ++ sig_bi[2] = 0; ++ sig_bi[3] = 1; ++ break; ++ case 7: ++ sig_bi[0] = 0; ++ sig_bi[1] = 0; ++ sig_bi[2] = 1; ++ sig_bi[3] = 1; ++ break; ++ } ++ /*Reserved bit*/ ++ sig_bi[4] = 0; ++ ++ /* Length Field*/ ++ for (i = 0; i < 12; i++) ++ sig_bi[i + 5] = (LENGTH >> i) & 1; ++ ++ /* Parity Bit*/ ++ sig_bi[17] = 0; ++ for (i = 0; i < 17; i++) ++ sig_bi[17] = sig_bi[17] + sig_bi[i]; ++ ++ sig_bi[17] %= 2; ++ ++ /* Tail Field*/ ++ for (i = 18; i < 24; i++) ++ sig_bi[i] = 0; ++ ++ /* dump_buf(sig_bi,24);*/ ++ _rtw_memset(pPMacTxInfo->LSIG, 0, 3); ++ ByteToBit(pPMacTxInfo->LSIG, (bool *)sig_bi, 3); ++} ++ ++ ++void CRC8_generator( ++ bool *out, ++ bool *in, ++ UCHAR in_size ++) ++{ ++ UCHAR i = 0; ++ bool temp = 0, reg[] = {1, 1, 1, 1, 1, 1, 1, 1}; ++ ++ for (i = 0; i < in_size; i++) { /* take one's complement and bit reverse*/ ++ temp = in[i] ^ reg[7]; ++ reg[7] = reg[6]; ++ reg[6] = reg[5]; ++ reg[5] = reg[4]; ++ reg[4] = reg[3]; ++ reg[3] = reg[2]; ++ reg[2] = reg[1] ^ temp; ++ reg[1] = reg[0] ^ temp; ++ reg[0] = temp; ++ } ++ for (i = 0; i < 8; i++)/* take one's complement and bit reverse*/ ++ out[i] = reg[7 - i] ^ 1; ++} ++ ++/*/================================================================================ ++ HT-SIG1 MCS CW Length 24BIT + 24BIT ++ 7b 1b 16b ++ HT-SIG2 Smoothing Not sounding Rsvd AGG STBC FEC SGI N_ELTF CRC Tail ++ 1b 1b 1b 1b 2b 1b 1b 2b 8b 6b ++================================================================================*/ ++void HT_SIG_generator( ++ PRT_PMAC_TX_INFO pPMacTxInfo, ++ PRT_PMAC_PKT_INFO pPMacPktInfo ++) ++{ ++ UINT i; ++ bool sig_bi[48] = {0}, crc8[8] = {0}; ++ /* MCS Field*/ ++ for (i = 0; i < 7; i++) ++ sig_bi[i] = (pPMacPktInfo->MCS >> i) & 0x1; ++ /* Packet BW Setting*/ ++ sig_bi[7] = pPMacTxInfo->BandWidth; ++ /* HT-Length Field*/ ++ for (i = 0; i < 16; i++) ++ sig_bi[i + 8] = (pPMacTxInfo->PacketLength >> i) & 0x1; ++ /* Smoothing; 1->allow smoothing*/ ++ sig_bi[24] = 1; ++ /*Not Sounding*/ ++ sig_bi[25] = 1 - pPMacTxInfo->NDP_sound; ++ /*Reserved bit*/ ++ sig_bi[26] = 1; ++ /*/Aggregate*/ ++ sig_bi[27] = 0; ++ /*STBC Field*/ ++ if (pPMacTxInfo->bSTBC) { ++ sig_bi[28] = 1; ++ sig_bi[29] = 0; ++ } else { ++ sig_bi[28] = 0; ++ sig_bi[29] = 0; ++ } ++ /*Advance Coding, 0: BCC, 1: LDPC*/ ++ sig_bi[30] = pPMacTxInfo->bLDPC; ++ /* Short GI*/ ++ sig_bi[31] = pPMacTxInfo->bSGI; ++ /* N_ELTFs*/ ++ if (pPMacTxInfo->NDP_sound == FALSE) { ++ sig_bi[32] = 0; ++ sig_bi[33] = 0; ++ } else { ++ int N_ELTF = pPMacTxInfo->Ntx - pPMacPktInfo->Nss; ++ ++ for (i = 0; i < 2; i++) ++ sig_bi[32 + i] = (N_ELTF >> i) % 2; ++ } ++ /* CRC-8*/ ++ CRC8_generator(crc8, sig_bi, 34); ++ ++ for (i = 0; i < 8; i++) ++ sig_bi[34 + i] = crc8[i]; ++ ++ /*Tail*/ ++ for (i = 42; i < 48; i++) ++ sig_bi[i] = 0; ++ ++ _rtw_memset(pPMacTxInfo->HT_SIG, 0, 6); ++ ByteToBit(pPMacTxInfo->HT_SIG, sig_bi, 6); ++} ++ ++ ++/*====================================================================================== ++ VHT-SIG-A1 ++ BW Reserved STBC G_ID SU_Nsts P_AID TXOP_PS_NOT_ALLOW Reserved ++ 2b 1b 1b 6b 3b 9b 1b 2b 1b ++ VHT-SIG-A2 ++ SGI SGI_Nsym SU/MU coding LDPC_Extra SU_NCS Beamformed Reserved CRC Tail ++ 1b 1b 1b 1b 4b 1b 1b 8b 6b ++======================================================================================*/ ++void VHT_SIG_A_generator( ++ PRT_PMAC_TX_INFO pPMacTxInfo, ++ PRT_PMAC_PKT_INFO pPMacPktInfo) ++{ ++ UINT i; ++ bool sig_bi[48], crc8[8]; ++ ++ _rtw_memset(sig_bi, 0, 48); ++ _rtw_memset(crc8, 0, 8); ++ ++ /* BW Setting*/ ++ for (i = 0; i < 2; i++) ++ sig_bi[i] = (pPMacTxInfo->BandWidth >> i) & 0x1; ++ /* Reserved Bit*/ ++ sig_bi[2] = 1; ++ /*STBC Field*/ ++ sig_bi[3] = pPMacTxInfo->bSTBC; ++ /*Group ID: Single User->A value of 0 or 63 indicates an SU PPDU. */ ++ for (i = 0; i < 6; i++) ++ sig_bi[4 + i] = 0; ++ /* N_STS/Partial AID*/ ++ for (i = 0; i < 12; i++) { ++ if (i < 3) ++ sig_bi[10 + i] = ((pPMacPktInfo->Nsts - 1) >> i) & 0x1; ++ else ++ sig_bi[10 + i] = 0; ++ } ++ /*TXOP_PS_NOT_ALLPWED*/ ++ sig_bi[22] = 0; ++ /*Reserved Bits*/ ++ sig_bi[23] = 1; ++ /*Short GI*/ ++ sig_bi[24] = pPMacTxInfo->bSGI; ++ if (pPMacTxInfo->bSGI > 0 && (pPMacPktInfo->N_sym % 10) == 9) ++ sig_bi[25] = 1; ++ else ++ sig_bi[25] = 0; ++ /* SU/MU[0] Coding*/ ++ sig_bi[26] = pPMacTxInfo->bLDPC; /* 0:BCC, 1:LDPC */ ++ sig_bi[27] = pPMacPktInfo->SIGA2B3; /*/ Record Extra OFDM Symols is added or not when LDPC is used*/ ++ /*SU MCS/MU[1-3] Coding*/ ++ for (i = 0; i < 4; i++) ++ sig_bi[28 + i] = (pPMacPktInfo->MCS >> i) & 0x1; ++ /*SU Beamform */ ++ sig_bi[32] = 0; /*packet.TXBF_en;*/ ++ /*Reserved Bit*/ ++ sig_bi[33] = 1; ++ /*CRC-8*/ ++ CRC8_generator(crc8, sig_bi, 34); ++ for (i = 0; i < 8; i++) ++ sig_bi[34 + i] = crc8[i]; ++ /*Tail*/ ++ for (i = 42; i < 48; i++) ++ sig_bi[i] = 0; ++ ++ _rtw_memset(pPMacTxInfo->VHT_SIG_A, 0, 6); ++ ByteToBit(pPMacTxInfo->VHT_SIG_A, sig_bi, 6); ++} ++ ++/*====================================================================================== ++ VHT-SIG-B ++ Length Resesrved Trail ++ 17/19/21 BIT 3/2/2 BIT 6b ++======================================================================================*/ ++void VHT_SIG_B_generator( ++ PRT_PMAC_TX_INFO pPMacTxInfo) ++{ ++ bool sig_bi[32], crc8_bi[8]; ++ UINT i, len, res, tail = 6, total_len, crc8_in_len; ++ UINT sigb_len; ++ ++ _rtw_memset(sig_bi, 0, 32); ++ _rtw_memset(crc8_bi, 0, 8); ++ ++ /*Sounding Packet*/ ++ if (pPMacTxInfo->NDP_sound == 1) { ++ if (pPMacTxInfo->BandWidth == 0) { ++ bool sigb_temp[26] = {0, 0, 0, 0, 0, 1, 1, 1, 0, 1, 0, 0, 0, 1, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0}; ++ ++ _rtw_memcpy(sig_bi, sigb_temp, 26); ++ } else if (pPMacTxInfo->BandWidth == 1) { ++ bool sigb_temp[27] = {1, 0, 1, 0, 0, 1, 0, 1, 1, 0, 1, 0, 0, 0, 1, 0, 0, 0, 0, 1, 1, 0, 0, 0, 0, 0, 0}; ++ ++ _rtw_memcpy(sig_bi, sigb_temp, 27); ++ } else if (pPMacTxInfo->BandWidth == 2) { ++ bool sigb_temp[29] = {0, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 1, 1, 1, 1, 1, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0}; ++ ++ _rtw_memcpy(sig_bi, sigb_temp, 29); ++ } ++ } else { /* Not NDP Sounding*/ ++ bool *sigb_temp[29] = {0}; ++ ++ if (pPMacTxInfo->BandWidth == 0) { ++ len = 17; ++ res = 3; ++ } else if (pPMacTxInfo->BandWidth == 1) { ++ len = 19; ++ res = 2; ++ } else if (pPMacTxInfo->BandWidth == 2) { ++ len = 21; ++ res = 2; ++ } else { ++ len = 21; ++ res = 2; ++ } ++ total_len = len + res + tail; ++ crc8_in_len = len + res; ++ ++ /*Length Field*/ ++ sigb_len = (pPMacTxInfo->PacketLength + 3) >> 2; ++ ++ for (i = 0; i < len; i++) ++ sig_bi[i] = (sigb_len >> i) & 0x1; ++ /*Reserved Field*/ ++ for (i = 0; i < res; i++) ++ sig_bi[len + i] = 1; ++ /* CRC-8*/ ++ CRC8_generator(crc8_bi, sig_bi, crc8_in_len); ++ ++ /* Tail */ ++ for (i = 0; i < tail; i++) ++ sig_bi[len + res + i] = 0; ++ } ++ ++ _rtw_memset(pPMacTxInfo->VHT_SIG_B, 0, 4); ++ ByteToBit(pPMacTxInfo->VHT_SIG_B, sig_bi, 4); ++ ++ pPMacTxInfo->VHT_SIG_B_CRC = 0; ++ ByteToBit(&(pPMacTxInfo->VHT_SIG_B_CRC), crc8_bi, 1); ++} ++ ++/*======================= ++ VHT Delimiter ++=======================*/ ++void VHT_Delimiter_generator( ++ PRT_PMAC_TX_INFO pPMacTxInfo ++) ++{ ++ bool sig_bi[32] = {0}, crc8[8] = {0}; ++ UINT crc8_in_len = 16; ++ UINT PacketLength = pPMacTxInfo->PacketLength; ++ int j; ++ ++ /* Delimiter[0]: EOF*/ ++ sig_bi[0] = 1; ++ /* Delimiter[1]: Reserved*/ ++ sig_bi[1] = 0; ++ /* Delimiter[3:2]: MPDU Length High*/ ++ sig_bi[2] = ((PacketLength - 4) >> 12) % 2; ++ sig_bi[3] = ((PacketLength - 4) >> 13) % 2; ++ /* Delimiter[15:4]: MPDU Length Low*/ ++ for (j = 4; j < 16; j++) ++ sig_bi[j] = ((PacketLength - 4) >> (j - 4)) % 2; ++ CRC8_generator(crc8, sig_bi, crc8_in_len); ++ for (j = 16; j < 24; j++) /* Delimiter[23:16]: CRC 8*/ ++ sig_bi[j] = crc8[j - 16]; ++ for (j = 24; j < 32; j++) /* Delimiter[31:24]: Signature ('4E' in Hex, 78 in Dec)*/ ++ sig_bi[j] = (78 >> (j - 24)) % 2; ++ ++ _rtw_memset(pPMacTxInfo->VHT_Delimiter, 0, 4); ++ ByteToBit(pPMacTxInfo->VHT_Delimiter, sig_bi, 4); ++} ++ ++#endif ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_mp_ioctl.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mp_ioctl.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_mp_ioctl.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mp_ioctl.c 2018-02-11 21:44:27.139145964 +0200 +@@ -0,0 +1,2534 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_MP_IOCTL_C_ ++ ++#include ++#include ++#include "../hal/phydm/phydm_precomp.h" ++ ++/* **************** oid_rtl_seg_81_85 section start **************** */ ++NDIS_STATUS oid_rt_wireless_mode_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ if (poid_par_priv->information_buf_len < sizeof(u8)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ if (poid_par_priv->type_of_oid == SET_OID) ++ Adapter->registrypriv.wireless_mode = *(u8 *)poid_par_priv->information_buf; ++ else if (poid_par_priv->type_of_oid == QUERY_OID) { ++ *(u8 *)poid_par_priv->information_buf = Adapter->registrypriv.wireless_mode; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ ++ ++ return status; ++} ++/* **************** oid_rtl_seg_81_87_80 section start **************** */ ++NDIS_STATUS oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ struct bb_reg_param *pbbreg; ++ u16 offset; ++ u32 value; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf); ++ ++ offset = (u16)(pbbreg->offset) & 0xFFF; /* 0ffset :0x800~0xfff */ ++ if (offset < BB_REG_BASE_ADDR) ++ offset |= BB_REG_BASE_ADDR; ++ ++ value = pbbreg->value; ++ ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ write_bbreg(Adapter, offset, 0xFFFFFFFF, value); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ struct bb_reg_param *pbbreg; ++ u16 offset; ++ u32 value; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf); ++ ++ offset = (u16)(pbbreg->offset) & 0xFFF; /* 0ffset :0x800~0xfff */ ++ if (offset < BB_REG_BASE_ADDR) ++ offset |= BB_REG_BASE_ADDR; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ value = read_bbreg(Adapter, offset, 0xFFFFFFFF); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ pbbreg->value = value; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ struct rf_reg_param *pbbreg; ++ u8 path; ++ u8 offset; ++ u32 value; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf); ++ ++ if (pbbreg->path >= MAX_RF_PATH_NUMS) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ if (pbbreg->offset > 0xFF) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ if (pbbreg->value > 0xFFFFF) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ path = (u8)pbbreg->path; ++ offset = (u8)pbbreg->offset; ++ value = pbbreg->value; ++ ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ write_rfreg(Adapter, path, offset, value); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ struct rf_reg_param *pbbreg; ++ u8 path; ++ u8 offset; ++ u32 value; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf); ++ ++ if (pbbreg->path >= MAX_RF_PATH_NUMS) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ if (pbbreg->offset > 0xFF) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ path = (u8)pbbreg->path; ++ offset = (u8)pbbreg->offset; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ value = read_rfreg(Adapter, path, offset); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ pbbreg->value = value; ++ ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ ++ return status; ++} ++/* **************** oid_rtl_seg_81_87_00 section end**************** ++ * ------------------------------------------------------------------------------ */ ++ ++/* **************** oid_rtl_seg_81_80_00 section start **************** ++ * ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_set_data_rate_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u32 ratevalue;/* 4 */ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len != sizeof(u32)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ ratevalue = *((u32 *)poid_par_priv->information_buf); /* 4 */ ++ if (ratevalue >= MPT_RATE_LAST) ++ return NDIS_STATUS_INVALID_DATA; ++ ++ Adapter->mppriv.rateidx = ratevalue; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ SetDataRate(Adapter); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_start_test_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u32 mode; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (Adapter->registrypriv.mp_mode == 0) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ /* IQCalibrateBcut(Adapter); */ ++ ++ mode = *((u32 *)poid_par_priv->information_buf); ++ Adapter->mppriv.mode = mode;/* 1 for loopback */ ++ ++ if (mp_start_test(Adapter) == _FAIL) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ goto exit; ++ } ++ ++exit: ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_stop_test_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ mp_stop_test(Adapter); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u32 Channel; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->information_buf_len != sizeof(u32)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ if (poid_par_priv->type_of_oid == QUERY_OID) { ++ *((u32 *)poid_par_priv->information_buf) = Adapter->mppriv.channel; ++ return NDIS_STATUS_SUCCESS; ++ } ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ Channel = *((u32 *)poid_par_priv->information_buf); ++ if (Channel > 14) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ Adapter->mppriv.channel = Channel; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ SetChannel(Adapter); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_set_bandwidth_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u16 bandwidth; ++ u16 channel_offset; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(u32)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ bandwidth = *((u32 *)poid_par_priv->information_buf); /* 4 */ ++ channel_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ if (bandwidth != CHANNEL_WIDTH_40) ++ bandwidth = CHANNEL_WIDTH_20; ++ padapter->mppriv.bandwidth = (u8)bandwidth; ++ padapter->mppriv.prime_channel_offset = (u8)channel_offset; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ SetBandwidth(padapter); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u32 antenna; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->information_buf_len != sizeof(u32)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ if (poid_par_priv->type_of_oid == SET_OID) { ++ antenna = *(u32 *)poid_par_priv->information_buf; ++ ++ Adapter->mppriv.antenna_tx = (u16)((antenna & 0xFFFF0000) >> 16); ++ Adapter->mppriv.antenna_rx = (u16)(antenna & 0x0000FFFF); ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ SetAntenna(Adapter); ++ _irqlevel_changed_(&oldirql, RAISE); ++ } else { ++ antenna = (Adapter->mppriv.antenna_tx << 16) | Adapter->mppriv.antenna_rx; ++ *(u32 *)poid_par_priv->information_buf = antenna; ++ } ++ ++ ++ return status; ++} ++ ++NDIS_STATUS oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u32 tx_pwr_idx; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len != sizeof(u32)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ tx_pwr_idx = *((u32 *)poid_par_priv->information_buf); ++ if (tx_pwr_idx > MAX_TX_PWR_INDEX_N_MODE) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ Adapter->mppriv.txpoweridx = (u8)tx_pwr_idx; ++ ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ SetTxPower(Adapter); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++ ++/* ------------------------------------------------------------------------------ ++ * **************** oid_rtl_seg_81_80_20 section start **************** ++ * ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ if (poid_par_priv->information_buf_len == sizeof(ULONG)) { ++ *(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.tx_pktcount; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH; ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ if (poid_par_priv->information_buf_len == sizeof(ULONG)) { ++ *(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.rx_pktcount; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH; ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ if (poid_par_priv->information_buf_len == sizeof(ULONG)) { ++ *(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.rx_crcerrpktcount; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH; ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++ ++NDIS_STATUS oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ Adapter->mppriv.tx_pktcount = 0; ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ if (poid_par_priv->information_buf_len == sizeof(ULONG)) { ++ Adapter->mppriv.rx_pktcount = 0; ++ Adapter->mppriv.rx_crcerrpktcount = 0; ++ } else ++ status = NDIS_STATUS_INVALID_LENGTH; ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ResetPhyRxPktCount(Adapter); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len != sizeof(ULONG)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ *(ULONG *)poid_par_priv->information_buf = GetPhyRxPktReceived(Adapter); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ ++ if (poid_par_priv->information_buf_len != sizeof(ULONG)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ *(ULONG *)poid_par_priv->information_buf = GetPhyRxPktCRC32Error(Adapter); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ ++ return status; ++} ++/* **************** oid_rtl_seg_81_80_20 section end **************** */ ++NDIS_STATUS oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u32 bStartTest; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ bStartTest = *((u32 *)poid_par_priv->information_buf); ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ SetContinuousTx(Adapter, (u8)bStartTest); ++ if (bStartTest) { ++ struct mp_priv *pmp_priv = &Adapter->mppriv; ++ if (pmp_priv->tx.stop == 0) { ++ pmp_priv->tx.stop = 1; ++ RTW_INFO("%s: pkt tx is running...\n", __func__); ++ rtw_msleep_os(5); ++ } ++ pmp_priv->tx.stop = 0; ++ pmp_priv->tx.count = 1; ++ SetPacketTx(Adapter); ++ } ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++ ++NDIS_STATUS oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u32 bStartTest; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ bStartTest = *((u32 *)poid_par_priv->information_buf); ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ SetSingleCarrierTx(Adapter, (u8)bStartTest); ++ if (bStartTest) { ++ struct mp_priv *pmp_priv = &Adapter->mppriv; ++ if (pmp_priv->tx.stop == 0) { ++ pmp_priv->tx.stop = 1; ++ RTW_INFO("%s: pkt tx is running...\n", __func__); ++ rtw_msleep_os(5); ++ } ++ pmp_priv->tx.stop = 0; ++ pmp_priv->tx.count = 1; ++ SetPacketTx(Adapter); ++ } ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++ ++NDIS_STATUS oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u32 bStartTest; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ bStartTest = *((u32 *)poid_par_priv->information_buf); ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ SetCarrierSuppressionTx(Adapter, (u8)bStartTest); ++ if (bStartTest) { ++ struct mp_priv *pmp_priv = &Adapter->mppriv; ++ if (pmp_priv->tx.stop == 0) { ++ pmp_priv->tx.stop = 1; ++ RTW_INFO("%s: pkt tx is running...\n", __func__); ++ rtw_msleep_os(5); ++ } ++ pmp_priv->tx.stop = 0; ++ pmp_priv->tx.count = 1; ++ SetPacketTx(Adapter); ++ } ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++ ++NDIS_STATUS oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u32 bStartTest; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ bStartTest = *((u32 *)poid_par_priv->information_buf); ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ SetSingleToneTx(Adapter, (u8)bStartTest); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++ ++NDIS_STATUS oid_rt_pro_set_modulation_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ return 0; ++} ++ ++NDIS_STATUS oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ rtw_hal_set_hwreg(Adapter, HW_VAR_TRIGGER_GPIO_0, 0); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++/* **************** oid_rtl_seg_81_80_00 section end **************** ++ * ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro8711_join_bss_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ PNDIS_802_11_SSID pssid; ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ *poid_par_priv->bytes_needed = (u32)sizeof(NDIS_802_11_SSID); ++ *poid_par_priv->bytes_rw = 0; ++ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ pssid = (PNDIS_802_11_SSID)poid_par_priv->information_buf; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ if (mp_start_joinbss(Adapter, pssid) == _FAIL) ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ *poid_par_priv->bytes_rw = sizeof(NDIS_802_11_SSID); ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_read_register_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ pRW_Reg RegRWStruct; ++ u32 offset, width; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ RegRWStruct = (pRW_Reg)poid_par_priv->information_buf; ++ offset = RegRWStruct->offset; ++ width = RegRWStruct->width; ++ ++ if (offset > 0xFFF) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ switch (width) { ++ case 1: ++ RegRWStruct->value = rtw_read8(Adapter, offset); ++ break; ++ case 2: ++ RegRWStruct->value = rtw_read16(Adapter, offset); ++ break; ++ default: ++ width = 4; ++ RegRWStruct->value = rtw_read32(Adapter, offset); ++ break; ++ } ++ ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ *poid_par_priv->bytes_rw = width; ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_write_register_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ pRW_Reg RegRWStruct; ++ u32 offset, width, value; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ RegRWStruct = (pRW_Reg)poid_par_priv->information_buf; ++ offset = RegRWStruct->offset; ++ width = RegRWStruct->width; ++ value = RegRWStruct->value; ++ ++ if (offset > 0xFFF) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ switch (RegRWStruct->width) { ++ case 1: ++ if (value > 0xFF) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ break; ++ } ++ rtw_write8(padapter, offset, (u8)value); ++ break; ++ case 2: ++ if (value > 0xFFFF) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ break; ++ } ++ rtw_write16(padapter, offset, (u16)value); ++ break; ++ case 4: ++ rtw_write32(padapter, offset, value); ++ break; ++ default: ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ break; ++ } ++ ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_burst_read_register_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ pBurst_RW_Reg pBstRwReg; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ pBstRwReg = (pBurst_RW_Reg)poid_par_priv->information_buf; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ rtw_read_mem(padapter, pBstRwReg->offset, (u32)pBstRwReg->len, pBstRwReg->Data); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_burst_write_register_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ pBurst_RW_Reg pBstRwReg; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ pBstRwReg = (pBurst_RW_Reg)poid_par_priv->information_buf; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ rtw_write_mem(padapter, pBstRwReg->offset, (u32)pBstRwReg->len, pBstRwReg->Data); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_write_txcmd_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ ++ TX_CMD_Desc *TxCmd_Info; ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ ++ TxCmd_Info = (TX_CMD_Desc *)poid_par_priv->information_buf; ++ ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ rtw_write32(Adapter, TxCmd_Info->offset + 0, (unsigned int)TxCmd_Info->TxCMD.value[0]); ++ rtw_write32(Adapter, TxCmd_Info->offset + 4, (unsigned int)TxCmd_Info->TxCMD.value[1]); ++ ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++ ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ pEEPROM_RWParam pEEPROM; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ pEEPROM = (pEEPROM_RWParam)poid_par_priv->information_buf; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ pEEPROM->value = eeprom_read16(padapter, (u16)(pEEPROM->offset >> 1)); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++ ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_write16_eeprom_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ pEEPROM_RWParam pEEPROM; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ pEEPROM = (pEEPROM_RWParam)poid_par_priv->information_buf; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ eeprom_write16(padapter, (u16)(pEEPROM->offset >> 1), pEEPROM->value); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ struct mp_wiparam *pwi_param; ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(struct mp_wiparam)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ if (Adapter->mppriv.workparam.bcompleted == _FALSE) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ pwi_param = (struct mp_wiparam *)poid_par_priv->information_buf; ++ ++ _rtw_memcpy(pwi_param, &Adapter->mppriv.workparam, sizeof(struct mp_wiparam)); ++ Adapter->mppriv.act_in_progress = _FALSE; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(uint) * 2) { ++ return NDIS_STATUS_INVALID_LENGTH; ++ } ++ ++ if (*(uint *)poid_par_priv->information_buf == 1) /* init==1 */ ++ Adapter->mppriv.rx_pktloss = 0; ++ ++ *((uint *)poid_par_priv->information_buf + 1) = Adapter->mppriv.rx_pktloss; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_rd_attrib_mem_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ struct io_queue *pio_queue = (struct io_queue *)Adapter->pio_queue; ++ struct intf_hdl *pintfhdl = &pio_queue->intf; ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++#ifdef CONFIG_SDIO_HCI ++ void (*_attrib_read)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); ++#endif ++ ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++#ifdef CONFIG_SDIO_HCI ++ _irqlevel_changed_(&oldirql, LOWER); ++ { ++ u32 *plmem = (u32 *)poid_par_priv->information_buf + 2; ++ _attrib_read = pintfhdl->io_ops._attrib_read; ++ _attrib_read(pintfhdl, *((u32 *)poid_par_priv->information_buf), ++ *((u32 *)poid_par_priv->information_buf + 1), (u8 *)plmem); ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } ++ _irqlevel_changed_(&oldirql, RAISE); ++#endif ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_wr_attrib_mem_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ struct io_queue *pio_queue = (struct io_queue *)Adapter->pio_queue; ++ struct intf_hdl *pintfhdl = &pio_queue->intf; ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++#ifdef CONFIG_SDIO_HCI ++ void (*_attrib_write)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); ++#endif ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++#ifdef CONFIG_SDIO_HCI ++ _irqlevel_changed_(&oldirql, LOWER); ++ { ++ u32 *plmem = (u32 *)poid_par_priv->information_buf + 2; ++ _attrib_write = pintfhdl->io_ops._attrib_write; ++ _attrib_write(pintfhdl, *(u32 *)poid_par_priv->information_buf, ++ *((u32 *)poid_par_priv->information_buf + 1), (u8 *)plmem); ++ } ++ _irqlevel_changed_(&oldirql, RAISE); ++#endif ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ if (rtw_setrfintfs_cmd(Adapter, *(unsigned char *)poid_par_priv->information_buf) == _FAIL) ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_poll_rx_status_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ _rtw_memcpy(poid_par_priv->information_buf, (unsigned char *)&Adapter->mppriv.rxstat, sizeof(struct recv_stat)); ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ PCFG_DBG_MSG_STRUCT pdbg_msg; ++ ++ ++ ++#if 0/*#ifdef CONFIG_DEBUG_RTL871X*/ ++ ++ pdbg_msg = (PCFG_DBG_MSG_STRUCT)(poid_par_priv->information_buf); ++ ++ if (poid_par_priv->type_of_oid == SET_OID) { ++ ++ GlobalDebugLevel = pdbg_msg->DebugLevel; ++ GlobalDebugComponents = (pdbg_msg->DebugComponent_H32 << 32) | pdbg_msg->DebugComponent_L32; ++ } else { ++ pdbg_msg->DebugLevel = GlobalDebugLevel; ++ pdbg_msg->DebugComponent_H32 = (u32)(GlobalDebugComponents >> 32); ++ pdbg_msg->DebugComponent_L32 = (u32)GlobalDebugComponents; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ } ++ ++#endif ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ if (rtw_setdatarate_cmd(Adapter, poid_par_priv->information_buf) != _SUCCESS) ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++/* ----------------------------------------------------------------------------- */ ++NDIS_STATUS oid_rt_get_thermal_meter_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ u8 thermal = 0; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(u32)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ GetThermalMeter(Adapter, &thermal); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ *(u32 *)poid_par_priv->information_buf = (u32)thermal; ++ *poid_par_priv->bytes_rw = sizeof(u32); ++ ++ ++ return status; ++} ++/* ----------------------------------------------------------------------------- */ ++NDIS_STATUS oid_rt_pro_read_tssi_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (Adapter->mppriv.act_in_progress == _TRUE) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(u8)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ /* init workparam */ ++ Adapter->mppriv.act_in_progress = _TRUE; ++ Adapter->mppriv.workparam.bcompleted = _FALSE; ++ Adapter->mppriv.workparam.act_type = MPT_READ_TSSI; ++ Adapter->mppriv.workparam.io_offset = 0; ++ Adapter->mppriv.workparam.io_value = 0xFFFFFFFF; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ if (!rtw_gettssi_cmd(Adapter, 0, (u8 *)&Adapter->mppriv.workparam.io_value)) ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ /* if (poid_par_priv->type_of_oid != SET_OID) ++ * return NDIS_STATUS_NOT_ACCEPTED; */ ++ ++ if (poid_par_priv->information_buf_len < sizeof(u8)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ if (poid_par_priv->type_of_oid == SET_OID) { ++ u8 enable; ++ ++ enable = *(u8 *)poid_par_priv->information_buf; ++ ++ SetPowerTracking(Adapter, enable); ++ } else ++ GetPowerTracking(Adapter, (u8 *)poid_par_priv->information_buf); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++/* ----------------------------------------------------------------------------- */ ++NDIS_STATUS oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u32 ratevalue; ++ u8 datarates[NumRates]; ++ int i; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++#if 0 ++ ratevalue = *((u32 *)poid_par_priv->information_buf); ++ ++ for (i = 0; i < NumRates; i++) { ++ if (ratevalue == mpdatarate[i]) ++ datarates[i] = mpdatarate[i]; ++ else ++ datarates[i] = 0xff; ++ } ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ if (rtw_setbasicrate_cmd(padapter, datarates) != _SUCCESS) ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ ++ _irqlevel_changed_(&oldirql, RAISE); ++#endif ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < 8) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ *poid_par_priv->bytes_rw = 8; ++ _rtw_memcpy(poid_par_priv->information_buf, &(adapter_to_pwrctl(Adapter)->pwr_mode), 8); ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ uint pwr_mode, smart_ps; ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ *poid_par_priv->bytes_rw = 0; ++ *poid_par_priv->bytes_needed = 8; ++ ++ if (poid_par_priv->information_buf_len < 8) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ pwr_mode = *(uint *)(poid_par_priv->information_buf); ++ smart_ps = *(uint *)((int)poid_par_priv->information_buf + 4); ++ ++ *poid_par_priv->bytes_rw = 8; ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ struct setratable_parm *prate_table; ++ u8 res; ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ *poid_par_priv->bytes_needed = sizeof(struct setratable_parm); ++ if (poid_par_priv->information_buf_len < sizeof(struct setratable_parm)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ prate_table = (struct setratable_parm *)poid_par_priv->information_buf; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ res = rtw_setrttbl_cmd(Adapter, prate_table); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ if (res == _FAIL) ++ status = NDIS_STATUS_FAILURE; ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++#if 0 ++ struct mp_wi_cntx *pmp_wi_cntx = &(Adapter->mppriv.wi_cntx); ++ u8 res = _SUCCESS; ++ DEBUG_INFO(("===> Set OID_RT_PRO_H2C_GET_RATE_TABLE.\n")); ++ ++ if (pmp_wi_cntx->bmp_wi_progress == _TRUE) { ++ DEBUG_ERR(("\n mp workitem is progressing, not allow to set another workitem right now!!!\n")); ++ Status = NDIS_STATUS_NOT_ACCEPTED; ++ break; ++ } else { ++ pmp_wi_cntx->bmp_wi_progress = _TRUE; ++ pmp_wi_cntx->param.bcompleted = _FALSE; ++ pmp_wi_cntx->param.act_type = MPT_GET_RATE_TABLE; ++ pmp_wi_cntx->param.io_offset = 0x0; ++ pmp_wi_cntx->param.bytes_cnt = sizeof(struct getratable_rsp); ++ pmp_wi_cntx->param.io_value = 0xffffffff; ++ ++ res = rtw_getrttbl_cmd(Adapter, (struct getratable_rsp *)pmp_wi_cntx->param.data); ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ if (res != _SUCCESS) ++ Status = NDIS_STATUS_NOT_ACCEPTED; ++ } ++ DEBUG_INFO(("\n <=== Set OID_RT_PRO_H2C_GET_RATE_TABLE.\n")); ++#endif ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++ ++/* **************** oid_rtl_seg_87_12_00 section start **************** */ ++NDIS_STATUS oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ struct security_priv *psecuritypriv = &Adapter->securitypriv; ++ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ ENCRY_CTRL_STATE encry_mode; ++ ++ ++ *poid_par_priv->bytes_needed = sizeof(u8); ++ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ if (poid_par_priv->type_of_oid == SET_OID) { ++ encry_mode = *((u8 *)poid_par_priv->information_buf); ++ switch (encry_mode) { ++ case HW_CONTROL: ++#if 0 ++ Adapter->registrypriv.software_decrypt = _FALSE; ++ Adapter->registrypriv.software_encrypt = _FALSE; ++#else ++ psecuritypriv->sw_decrypt = _FALSE; ++ psecuritypriv->sw_encrypt = _FALSE; ++#endif ++ break; ++ case SW_CONTROL: ++#if 0 ++ Adapter->registrypriv.software_decrypt = _TRUE; ++ Adapter->registrypriv.software_encrypt = _TRUE; ++#else ++ psecuritypriv->sw_decrypt = _TRUE; ++ psecuritypriv->sw_encrypt = _TRUE; ++#endif ++ break; ++ case HW_ENCRY_SW_DECRY: ++#if 0 ++ Adapter->registrypriv.software_decrypt = _TRUE; ++ Adapter->registrypriv.software_encrypt = _FALSE; ++#else ++ psecuritypriv->sw_decrypt = _TRUE; ++ psecuritypriv->sw_encrypt = _FALSE; ++#endif ++ break; ++ case SW_ENCRY_HW_DECRY: ++#if 0 ++ Adapter->registrypriv.software_decrypt = _FALSE; ++ Adapter->registrypriv.software_encrypt = _TRUE; ++#else ++ psecuritypriv->sw_decrypt = _FALSE; ++ psecuritypriv->sw_encrypt = _TRUE; ++#endif ++ break; ++ } ++ ++ } else { ++#if 0 ++ if (Adapter->registrypriv.software_encrypt == _FALSE) { ++ if (Adapter->registrypriv.software_decrypt == _FALSE) ++ encry_mode = HW_CONTROL; ++ else ++ encry_mode = HW_ENCRY_SW_DECRY; ++ } else { ++ if (Adapter->registrypriv.software_decrypt == _FALSE) ++ encry_mode = SW_ENCRY_HW_DECRY; ++ else ++ encry_mode = SW_CONTROL; ++ } ++#else ++ ++ if ((psecuritypriv->sw_encrypt == _FALSE) && (psecuritypriv->sw_decrypt == _FALSE)) ++ encry_mode = HW_CONTROL; ++ else if ((psecuritypriv->sw_encrypt == _FALSE) && (psecuritypriv->sw_decrypt == _TRUE)) ++ encry_mode = HW_ENCRY_SW_DECRY; ++ else if ((psecuritypriv->sw_encrypt == _TRUE) && (psecuritypriv->sw_decrypt == _FALSE)) ++ encry_mode = SW_ENCRY_HW_DECRY; ++ else if ((psecuritypriv->sw_encrypt == _TRUE) && (psecuritypriv->sw_decrypt == _TRUE)) ++ encry_mode = SW_CONTROL; ++ ++#endif ++ ++ *(u8 *)poid_par_priv->information_buf = encry_mode; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ } ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_add_sta_info_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ struct sta_info *psta = NULL; ++ UCHAR *macaddr; ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ *poid_par_priv->bytes_needed = ETH_ALEN; ++ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ macaddr = (UCHAR *) poid_par_priv->information_buf ; ++ ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ psta = rtw_get_stainfo(&Adapter->stapriv, macaddr); ++ ++ if (psta == NULL) { /* the sta have been in sta_info_queue => do nothing */ ++ psta = rtw_alloc_stainfo(&Adapter->stapriv, macaddr); ++ ++ if (psta == NULL) { ++ status = NDIS_STATUS_FAILURE; ++ } ++ } ++ ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ struct sta_info *psta = NULL; ++ UCHAR *macaddr; ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ *poid_par_priv->bytes_needed = ETH_ALEN; ++ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ macaddr = (UCHAR *) poid_par_priv->information_buf ; ++ ++ psta = rtw_get_stainfo(&Adapter->stapriv, macaddr); ++ if (psta != NULL) { ++ /* _enter_critical(&(Adapter->stapriv.sta_hash_lock), &irqL); */ ++ rtw_free_stainfo(Adapter, psta); ++ /* _exit_critical(&(Adapter->stapriv.sta_hash_lock), &irqL); */ ++ } ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++#if 0 ++static u32 mp_query_drv_var(_adapter *padapter, u8 offset, u32 var) ++{ ++#ifdef CONFIG_SDIO_HCI ++ ++ if (offset == 1) { ++ u16 tmp_blk_num; ++ tmp_blk_num = rtw_read16(padapter, SDIO_RX0_RDYBLK_NUM); ++ if (adapter_to_dvobj(padapter)->rxblknum != tmp_blk_num) { ++ /* sd_recv_rxfifo(padapter); */ ++ } ++ } ++ ++#if 0 ++ if (offset <= 100) { /* For setting data rate and query data rate */ ++ if (offset == 100) { /* For query data rate */ ++ var = padapter->registrypriv.tx_rate; ++ ++ } else if (offset < 0x1d) { /* For setting data rate */ ++ padapter->registrypriv.tx_rate = offset; ++ var = padapter->registrypriv.tx_rate; ++ padapter->registrypriv.use_rate = _TRUE; ++ } else { /* not use the data rate */ ++ padapter->registrypriv.use_rate = _FALSE; ++ } ++ } else if (offset <= 110) { /* for setting debug level */ ++ if (offset == 110) { /* For query data rate */ ++ padapter->registrypriv.dbg_level = GlobalDebugLevel; ++ var = padapter->registrypriv.dbg_level; ++ } else if (offset < 110 && offset > 100) { ++ padapter->registrypriv.dbg_level = GlobalDebugLevel = offset - 100; ++ var = padapter->registrypriv.dbg_level; ++ ++ } ++ } else if (offset > 110 && offset < 116) { ++ if (115 == offset) { ++ } else { ++ switch (offset) { ++ case 111: ++ adapter_to_dvobj(padapter)->tx_block_mode = 1; ++ adapter_to_dvobj(padapter)->rx_block_mode = 1; ++ break; ++ case 112: ++ adapter_to_dvobj(padapter)->tx_block_mode = 1; ++ adapter_to_dvobj(padapter)->rx_block_mode = 0; ++ break; ++ case 113: ++ adapter_to_dvobj(padapter)->tx_block_mode = 0; ++ adapter_to_dvobj(padapter)->rx_block_mode = 1; ++ break; ++ case 114: ++ adapter_to_dvobj(padapter)->tx_block_mode = 0; ++ adapter_to_dvobj(padapter)->rx_block_mode = 0; ++ break; ++ default: ++ break; ++ ++ } ++ ++ } ++ ++ } else if (offset >= 127) { ++ u64 prnt_dbg_comp; ++ u8 chg_idx; ++ u64 tmp_dbg_comp; ++ chg_idx = offset - 0x80; ++ tmp_dbg_comp = BIT(chg_idx); ++ prnt_dbg_comp = padapter->registrypriv.dbg_component = GlobalDebugComponents; ++ if (offset == 127) { ++ /* prnt_dbg_comp=padapter->registrypriv.dbg_component= GlobalDebugComponents; */ ++ var = (u32)(padapter->registrypriv.dbg_component); ++ prnt_dbg_comp = GlobalDebugComponents; ++ prnt_dbg_comp = GlobalDebugComponents = padapter->registrypriv.dbg_component; ++ ++ } else { ++ prnt_dbg_comp = GlobalDebugComponents; ++ prnt_dbg_comp = GlobalDebugComponents = padapter->registrypriv.dbg_component; ++ ++ if (GlobalDebugComponents & tmp_dbg_comp) { ++ /* this bit is already set, now clear it */ ++ GlobalDebugComponents = GlobalDebugComponents & (~tmp_dbg_comp); ++ } else { ++ /* this bit is not set, now set it. */ ++ GlobalDebugComponents = GlobalDebugComponents | tmp_dbg_comp; ++ } ++ prnt_dbg_comp = GlobalDebugComponents; ++ ++ var = (u32)(GlobalDebugComponents); ++ /* GlobalDebugComponents=padapter->registrypriv.dbg_component; */ ++ ++ } ++ } ++#endif ++#endif ++ ++ return var; ++} ++#endif ++ ++NDIS_STATUS oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ DR_VARIABLE_STRUCT *pdrv_var; ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ *poid_par_priv->bytes_needed = sizeof(DR_VARIABLE_STRUCT); ++ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ ++ pdrv_var = (struct _DR_VARIABLE_STRUCT_ *)poid_par_priv->information_buf; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ pdrv_var->variable = mp_query_drv_var(Adapter, pdrv_var->offset, pdrv_var->variable); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ ++ if (poid_par_priv->information_buf_len < sizeof(UCHAR)) { ++ status = NDIS_STATUS_INVALID_LENGTH; ++ *poid_par_priv->bytes_needed = sizeof(UCHAR); ++ return status; ++ } ++ ++ if (poid_par_priv->type_of_oid == SET_OID) { ++ Adapter->mppriv.rx_with_status = *(UCHAR *) poid_par_priv->information_buf; ++ ++ ++ } else { ++ *(UCHAR *) poid_par_priv->information_buf = Adapter->mppriv.rx_with_status; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ /* *(u32 *)&Adapter->eeprompriv.mac_addr[0]=rtw_read32(Adapter, 0x10250050); */ ++ /* *(u16 *)&Adapter->eeprompriv.mac_addr[4]=rtw_read16(Adapter, 0x10250054); */ ++ } ++#endif ++ ++ return NDIS_STATUS_SUCCESS; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ PEFUSE_ACCESS_STRUCT pefuse; ++ u8 *data; ++ u16 addr = 0, cnts = 0, max_available_size = 0; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(EFUSE_ACCESS_STRUCT)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf; ++ addr = pefuse->start_addr; ++ cnts = pefuse->cnts; ++ data = pefuse->data; ++ ++ ++ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); ++ ++ if ((addr + cnts) > max_available_size) { ++ return NDIS_STATUS_NOT_ACCEPTED; ++ } ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ if (rtw_efuse_access(Adapter, _FALSE, addr, cnts, data) == _FAIL) { ++ status = NDIS_STATUS_FAILURE; ++ } else ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ PEFUSE_ACCESS_STRUCT pefuse; ++ u8 *data; ++ u16 addr = 0, cnts = 0, max_available_size = 0; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf; ++ addr = pefuse->start_addr; ++ cnts = pefuse->cnts; ++ data = pefuse->data; ++ ++ ++ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); ++ ++ if ((addr + cnts) > max_available_size) { ++ return NDIS_STATUS_NOT_ACCEPTED; ++ } ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ if (rtw_efuse_access(Adapter, _TRUE, addr, cnts, data) == _FAIL) ++ status = NDIS_STATUS_FAILURE; ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ PPGPKT_STRUCT ppgpkt; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ ++ *poid_par_priv->bytes_rw = 0; ++ ++ if (poid_par_priv->information_buf_len < sizeof(PGPKT_STRUCT)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ ppgpkt = (PPGPKT_STRUCT)poid_par_priv->information_buf; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ if (poid_par_priv->type_of_oid == QUERY_OID) { ++ ++ Efuse_PowerSwitch(Adapter, _FALSE, _TRUE); ++ if (Efuse_PgPacketRead(Adapter, ppgpkt->offset, ppgpkt->data, _FALSE) == _TRUE) ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ else ++ status = NDIS_STATUS_FAILURE; ++ Efuse_PowerSwitch(Adapter, _FALSE, _FALSE); ++ } else { ++ ++ Efuse_PowerSwitch(Adapter, _TRUE, _TRUE); ++ if (Efuse_PgPacketWrite(Adapter, ppgpkt->offset, ppgpkt->word_en, ppgpkt->data, _FALSE) == _TRUE) ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ else ++ status = NDIS_STATUS_FAILURE; ++ Efuse_PowerSwitch(Adapter, _TRUE, _FALSE); ++ } ++ ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u16 size; ++ u8 ret; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(u32)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ret = efuse_GetCurrentSize(Adapter, &size); ++ _irqlevel_changed_(&oldirql, RAISE); ++ if (ret == _SUCCESS) { ++ *(u32 *)poid_par_priv->information_buf = size; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } else ++ status = NDIS_STATUS_FAILURE; ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_efuse_max_size_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(u32)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ *(u32 *)poid_par_priv->information_buf = efuse_GetMaxSize(Adapter); ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status; ++ ++ ++ ++ if (poid_par_priv->type_of_oid == QUERY_OID) ++ status = oid_rt_pro_read_efuse_hdl(poid_par_priv); ++ else ++ status = oid_rt_pro_write_efuse_hdl(poid_par_priv); ++ ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u8 *data; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ u16 mapLen = 0; ++ ++ ++ ++ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); ++ ++ *poid_par_priv->bytes_rw = 0; ++ ++ if (poid_par_priv->information_buf_len < mapLen) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ data = (u8 *)poid_par_priv->information_buf; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ if (poid_par_priv->type_of_oid == QUERY_OID) { ++ ++ if (rtw_efuse_map_read(Adapter, 0, mapLen, data) == _SUCCESS) ++ *poid_par_priv->bytes_rw = mapLen; ++ else { ++ status = NDIS_STATUS_FAILURE; ++ } ++ } else { ++ /* SET_OID */ ++ ++ if (rtw_efuse_map_write(Adapter, 0, mapLen, data) == _SUCCESS) ++ *poid_par_priv->bytes_rw = mapLen; ++ else { ++ status = NDIS_STATUS_FAILURE; ++ } ++ } ++ ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ ++ return status; ++} ++ ++NDIS_STATUS oid_rt_set_crystal_cap_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ ++ u32 crystal_cap = 0; ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(u32)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ crystal_cap = *((u32 *)poid_par_priv->information_buf); /* 4 */ ++ if (crystal_cap > 0xf) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ Adapter->mppriv.curr_crystalcap = crystal_cap; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ SetCrystalCap(Adapter); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++#endif ++ return status; ++} ++ ++NDIS_STATUS oid_rt_set_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u8 rx_pkt_type; ++ /* u32 rcr_val32; */ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ /* PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); */ ++ ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(u8)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ rx_pkt_type = *((u8 *)poid_par_priv->information_buf); /* 4 */ ++ ++#if 0 ++ _irqlevel_changed_(&oldirql, LOWER); ++#if 0 ++ rcr_val8 = rtw_read8(Adapter, 0x10250048);/* RCR */ ++ rcr_val8 &= ~(RCR_AB | RCR_AM | RCR_APM | RCR_AAP); ++ ++ if (rx_pkt_type == RX_PKT_BROADCAST) ++ rcr_val8 |= (RCR_AB | RCR_ACRC32); ++ else if (rx_pkt_type == RX_PKT_DEST_ADDR) ++ rcr_val8 |= (RCR_AAP | RCR_AM | RCR_ACRC32); ++ else if (rx_pkt_type == RX_PKT_PHY_MATCH) ++ rcr_val8 |= (RCR_APM | RCR_ACRC32); ++ else ++ rcr_val8 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32); ++ rtw_write8(padapter, 0x10250048, rcr_val8); ++#else ++ rcr_val32 = rtw_read32(padapter, RCR);/* RCR = 0x10250048 */ ++ rcr_val32 &= ~(RCR_CBSSID | RCR_AB | RCR_AM | RCR_APM | RCR_AAP); ++#if 0 ++ if (rx_pkt_type == RX_PKT_BROADCAST) ++ rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32); ++ else if (rx_pkt_type == RX_PKT_DEST_ADDR) { ++ /* rcr_val32 |= (RCR_CBSSID|RCR_AAP|RCR_AM|RCR_ACRC32); */ ++ rcr_val32 |= (RCR_CBSSID | RCR_APM | RCR_ACRC32); ++ } else if (rx_pkt_type == RX_PKT_PHY_MATCH) { ++ rcr_val32 |= (RCR_APM | RCR_ACRC32); ++ /* rcr_val32 |= (RCR_AAP|RCR_ACRC32); */ ++ } else ++ rcr_val32 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32); ++#else ++ switch (rx_pkt_type) { ++ case RX_PKT_BROADCAST: ++ rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32); ++ break; ++ case RX_PKT_DEST_ADDR: ++ rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32); ++ break; ++ case RX_PKT_PHY_MATCH: ++ rcr_val32 |= (RCR_APM | RCR_ACRC32); ++ break; ++ default: ++ rcr_val32 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32); ++ break; ++ } ++ ++ if (rx_pkt_type == RX_PKT_DEST_ADDR) ++ padapter->mppriv.check_mp_pkt = 1; ++ else ++ padapter->mppriv.check_mp_pkt = 0; ++#endif ++ rtw_write32(padapter, RCR, rcr_val32); ++ ++#endif ++ _irqlevel_changed_(&oldirql, RAISE); ++#endif ++ ++ return status; ++} ++ ++NDIS_STATUS oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ u32 txagc; ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(u32)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ txagc = *(u32 *)poid_par_priv->information_buf; ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ SetTxAGCOffset(Adapter, txagc); ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++ ++NDIS_STATUS oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ ++ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ struct mp_priv *pmppriv = &Adapter->mppriv; ++ u32 type; ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) ++ return NDIS_STATUS_NOT_ACCEPTED; ++ ++ if (poid_par_priv->information_buf_len < sizeof(u32)) ++ return NDIS_STATUS_INVALID_LENGTH; ++ ++ type = *(u32 *)poid_par_priv->information_buf; ++ ++ if (_LOOPBOOK_MODE_ == type) { ++ pmppriv->mode = type; ++ set_fwstate(pmlmepriv, WIFI_MP_LPBK_STATE); /* append txdesc */ ++ } else if (_2MAC_MODE_ == type) { ++ pmppriv->mode = type; ++ _clr_fwstate_(pmlmepriv, WIFI_MP_LPBK_STATE); ++ } else ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} ++ ++unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ PMP_XMIT_PARM pparm; ++ PADAPTER padapter; ++ struct mp_priv *pmp_priv; ++ struct pkt_attrib *pattrib; ++ ++ ++ pparm = (PMP_XMIT_PARM)poid_par_priv->information_buf; ++ padapter = (PADAPTER)poid_par_priv->adapter_context; ++ pmp_priv = &padapter->mppriv; ++ ++ if (poid_par_priv->type_of_oid == QUERY_OID) { ++ pparm->enable = !pmp_priv->tx.stop; ++ pparm->count = pmp_priv->tx.sended; ++ } else { ++ if (pparm->enable == 0) ++ pmp_priv->tx.stop = 1; ++ else if (pmp_priv->tx.stop == 1) { ++ pmp_priv->tx.stop = 0; ++ pmp_priv->tx.count = pparm->count; ++ pmp_priv->tx.payload = pparm->payload_type; ++ pattrib = &pmp_priv->tx.attrib; ++ pattrib->pktlen = pparm->length; ++ _rtw_memcpy(pattrib->dst, pparm->da, ETH_ALEN); ++ SetPacketTx(padapter); ++ } else ++ return NDIS_STATUS_FAILURE; ++ } ++ ++ return NDIS_STATUS_SUCCESS; ++} ++ ++#if 0 ++unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv) ++{ ++ unsigned char *pframe, *pmp_pkt; ++ struct ethhdr *pethhdr; ++ struct pkt_attrib *pattrib; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ int llc_sz, payload_len; ++ struct mp_xmit_frame *pxframe = NULL; ++ struct mp_xmit_packet *pmp_xmitpkt = (struct mp_xmit_packet *)param; ++ u8 addr3[] = {0x02, 0xE0, 0x4C, 0x87, 0x66, 0x55}; ++ ++ /* RTW_INFO("+mp_ioctl_xmit_packet_hdl\n"); */ ++ ++ pxframe = alloc_mp_xmitframe(&padapter->mppriv); ++ if (pxframe == NULL) { ++ DEBUG_ERR(("Can't alloc pmpframe %d:%s\n", __LINE__, __FILE__)); ++ return -1; ++ } ++ ++ /* mp_xmit_pkt */ ++ payload_len = pmp_xmitpkt->len - 14; ++ pmp_pkt = (unsigned char *)pmp_xmitpkt->mem; ++ pethhdr = (struct ethhdr *)pmp_pkt; ++ ++ /* RTW_INFO("payload_len=%d, pkt_mem=0x%x\n", pmp_xmitpkt->len, (void*)pmp_xmitpkt->mem); */ ++ ++ /* RTW_INFO("pxframe=0x%x\n", (void*)pxframe); */ ++ /* RTW_INFO("pxframe->mem=0x%x\n", (void*)pxframe->mem); */ ++ ++ /* update attribute */ ++ pattrib = &pxframe->attrib; ++ memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib)); ++ pattrib->pktlen = pmp_xmitpkt->len; ++ pattrib->ether_type = ntohs(pethhdr->h_proto); ++ pattrib->hdrlen = 24; ++ pattrib->nr_frags = 1; ++ pattrib->priority = 0; ++#ifndef CONFIG_MP_LINUX ++ if (IS_MCAST(pethhdr->h_dest)) ++ pattrib->mac_id = 4; ++ else ++ pattrib->mac_id = 5; ++#else ++ pattrib->mac_id = 5; ++#endif ++ ++ /* */ ++ memset(pxframe->mem, 0 , WLANHDR_OFFSET); ++ pframe = (u8 *)(pxframe->mem) + WLANHDR_OFFSET; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ SetFrameSubType(pframe, WIFI_DATA); ++ ++ _rtw_memcpy(pwlanhdr->addr1, pethhdr->h_dest, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pethhdr->h_source, ETH_ALEN); ++ ++ _rtw_memcpy(pwlanhdr->addr3, addr3, ETH_ALEN); ++ ++ pwlanhdr->seq_ctl = 0; ++ pframe += pattrib->hdrlen; ++ ++ llc_sz = rtw_put_snap(pframe, pattrib->ether_type); ++ pframe += llc_sz; ++ ++ _rtw_memcpy(pframe, (void *)(pmp_pkt + 14), payload_len); ++ ++ pattrib->last_txcmdsz = pattrib->hdrlen + llc_sz + payload_len; ++ ++ DEBUG_INFO(("issuing mp_xmit_frame, tx_len=%d, ether_type=0x%x\n", pattrib->last_txcmdsz, pattrib->ether_type)); ++ xmit_mp_frame(padapter, pxframe); ++ ++ return _SUCCESS; ++} ++#endif ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_set_power_down_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#ifdef PLATFORM_OS_XP ++ _irqL oldirql; ++#endif ++ u8 bpwrup; ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++#ifdef PLATFORM_LINUX ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++#endif ++#endif ++ ++ ++ if (poid_par_priv->type_of_oid != SET_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ ++ ++ _irqlevel_changed_(&oldirql, LOWER); ++ ++ bpwrup = *(u8 *)poid_par_priv->information_buf; ++ /* CALL the power_down function */ ++#ifdef PLATFORM_LINUX ++#if defined(CONFIG_RTL8712) /* Linux MP insmod unknown symbol */ ++ dev_power_down(padapter, bpwrup); ++#endif ++#endif ++ _irqlevel_changed_(&oldirql, RAISE); ++ ++ /* DEBUG_ERR(("\n <=== Query OID_RT_PRO_READ_REGISTER. */ ++ /* Add:0x%08x Width:%d Value:0x%08x\n",RegRWStruct->offset,RegRWStruct->width,RegRWStruct->value)); */ ++ ++ ++ return status; ++} ++/* ------------------------------------------------------------------------------ */ ++NDIS_STATUS oid_rt_get_power_mode_hdl(struct oid_par_priv *poid_par_priv) ++{ ++#if 0 ++ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); ++ /* #ifdef PLATFORM_OS_XP */ ++ /* _irqL oldirql; ++ * #endif */ ++ ++ ++ if (poid_par_priv->type_of_oid != QUERY_OID) { ++ status = NDIS_STATUS_NOT_ACCEPTED; ++ return status; ++ } ++ if (poid_par_priv->information_buf_len < sizeof(u32)) { ++ status = NDIS_STATUS_INVALID_LENGTH; ++ return status; ++ } ++ ++ ++ /* _irqlevel_changed_(&oldirql, LOWER); */ ++ *(int *)poid_par_priv->information_buf = Adapter->registrypriv.low_power ? POWER_LOW : POWER_NORMAL; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ /* _irqlevel_changed_(&oldirql, RAISE); */ ++ ++ ++ return status; ++#else ++ return 0; ++#endif ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_odm.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_odm.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_odm.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_odm.c 2018-02-11 21:44:27.140145979 +0200 +@@ -0,0 +1,577 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#include ++#include ++ ++const char *odm_comp_str[] = { ++ /* BIT0 */"ODM_COMP_DIG", ++ /* BIT1 */"ODM_COMP_RA_MASK", ++ /* BIT2 */"ODM_COMP_DYNAMIC_TXPWR", ++ /* BIT3 */"ODM_COMP_FA_CNT", ++ /* BIT4 */"ODM_COMP_RSSI_MONITOR", ++ /* BIT5 */"ODM_COMP_SNIFFER", ++ /* BIT6 */"ODM_COMP_ANT_DIV", ++ /* BIT7 */"ODM_COMP_DFS", ++ /* BIT8 */"ODM_COMP_NOISY_DETECT", ++ /* BIT9 */"ODM_COMP_RATE_ADAPTIVE", ++ /* BIT10 */"ODM_COMP_PATH_DIV", ++ /* BIT11 */"ODM_COMP_CCX", ++ /* BIT12 */"ODM_COMP_DYNAMIC_PRICCA", ++ /* BIT13 */NULL, ++ /* BIT14 */"ODM_COMP_MP", ++ /* BIT15 */"ODM_COMP_CFO_TRACKING", ++ /* BIT16 */"ODM_COMP_ACS", ++ /* BIT17 */"PHYDM_COMP_ADAPTIVITY", ++ /* BIT18 */"PHYDM_COMP_RA_DBG", ++ /* BIT19 */"PHYDM_COMP_TXBF", ++ /* BIT20 */"ODM_COMP_EDCA_TURBO", ++ /* BIT21 */"ODM_COMP_EARLY_MODE", ++ /* BIT22 */"ODM_FW_DEBUG_TRACE", ++ /* BIT23 */NULL, ++ /* BIT24 */"ODM_COMP_TX_PWR_TRACK", ++ /* BIT25 */"ODM_COMP_RX_GAIN_TRACK", ++ /* BIT26 */"ODM_COMP_CALIBRATION", ++ /* BIT27 */NULL, ++ /* BIT28 */"ODM_PHY_CONFIG", ++ /* BIT29 */"ODM_COMP_INIT", ++ /* BIT30 */"ODM_COMP_COMMON", ++}; ++ ++#define RTW_ODM_COMP_MAX 31 ++ ++const char *odm_ability_str[] = { ++ /* BIT0 */"ODM_BB_DIG", ++ /* BIT1 */"ODM_BB_RA_MASK", ++ /* BIT2 */"ODM_BB_DYNAMIC_TXPWR", ++ /* BIT3 */"ODM_BB_FA_CNT", ++ /* BIT4 */"ODM_BB_RSSI_MONITOR", ++ /* BIT5 */"ODM_BB_CCK_PD", ++ /* BIT6 */"ODM_BB_ANT_DIV", ++ /* BIT7 */NULL, ++ /* BIT8 */"ODM_BB_PWR_TRAIN", ++ /* BIT9 */"ODM_BB_RATE_ADAPTIVE", ++ /* BIT10 */"ODM_BB_PATH_DIV", ++ /* BIT11 */NULL, ++ /* BIT12 */NULL, ++ /* BIT13 */"ODM_BB_ADAPTIVITY", ++ /* BIT14 */"ODM_BB_CFO_TRACKING", ++ /* BIT15 */"ODM_BB_NHM_CNT", ++ /* BIT16 */"ODM_BB_PRIMARY_CCA", ++ /* BIT17 */"ODM_BB_TXBF", ++ /* BIT18 */"ODM_BB_DYNAMIC_ARFR", ++ /* BIT19 */NULL, ++ /* BIT20 */"ODM_MAC_EDCA_TURBO", ++ /* BIT21 */"ODM_MAC_EARLY_MODE", ++ /* BIT22 */NULL, ++ /* BIT23 */NULL, ++ /* BIT24 */"ODM_RF_TX_PWR_TRACK", ++ /* BIT25 */"ODM_RF_RX_GAIN_TRACK", ++ /* BIT26 */"ODM_RF_CALIBRATION", ++}; ++ ++#define RTW_ODM_ABILITY_MAX 27 ++ ++const char *odm_dbg_level_str[] = { ++ NULL, ++ "ODM_DBG_OFF", ++ "ODM_DBG_SERIOUS", ++ "ODM_DBG_WARNING", ++ "ODM_DBG_LOUD", ++ "ODM_DBG_TRACE", ++}; ++ ++#define RTW_ODM_DBG_LEVEL_NUM 6 ++ ++void rtw_odm_dbg_comp_msg(void *sel, _adapter *adapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); ++ DM_ODM_T *odm = &pHalData->odmpriv; ++ int cnt = 0; ++ u64 dbg_comp = 0; ++ int i; ++ ++ rtw_hal_get_odm_var(adapter, HAL_ODM_DBG_FLAG, &dbg_comp, NULL); ++ ++ RTW_PRINT_SEL(sel, "odm.DebugComponents = 0x%016llx\n", dbg_comp); ++ for (i = 0; i < RTW_ODM_COMP_MAX; i++) { ++ if (odm_comp_str[i]) ++ RTW_PRINT_SEL(sel, "%cBIT%-2d %s\n", ++ (BIT0 & (dbg_comp >> i)) ? '+' : ' ', i, odm_comp_str[i]); ++ } ++} ++ ++inline void rtw_odm_dbg_comp_set(_adapter *adapter, u64 comps) ++{ ++ rtw_hal_set_odm_var(adapter, HAL_ODM_DBG_FLAG, &comps, _FALSE); ++} ++ ++void rtw_odm_dbg_level_msg(void *sel, _adapter *adapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); ++ DM_ODM_T *odm = &pHalData->odmpriv; ++ int cnt = 0; ++ u32 dbg_level = 0; ++ int i; ++ ++ rtw_hal_get_odm_var(adapter, HAL_ODM_DBG_LEVEL, &dbg_level, NULL); ++ RTW_PRINT_SEL(sel, "odm.DebugLevel = %u\n", dbg_level); ++ for (i = 0; i < RTW_ODM_DBG_LEVEL_NUM; i++) { ++ if (odm_dbg_level_str[i]) ++ RTW_PRINT_SEL(sel, "%u %s\n", i, odm_dbg_level_str[i]); ++ } ++} ++ ++inline void rtw_odm_dbg_level_set(_adapter *adapter, u32 level) ++{ ++ rtw_hal_set_odm_var(adapter, HAL_ODM_DBG_LEVEL, &level, _FALSE); ++} ++ ++void rtw_odm_ability_msg(void *sel, _adapter *adapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); ++ DM_ODM_T *odm = &pHalData->odmpriv; ++ int cnt = 0; ++ u32 ability = 0; ++ int i; ++ ++ ability = rtw_phydm_ability_get(adapter); ++ RTW_PRINT_SEL(sel, "odm.SupportAbility = 0x%08x\n", ability); ++ for (i = 0; i < RTW_ODM_ABILITY_MAX; i++) { ++ if (odm_ability_str[i]) ++ RTW_PRINT_SEL(sel, "%cBIT%-2d %s\n", ++ (BIT0 << i) & ability ? '+' : ' ', i, odm_ability_str[i]); ++ } ++} ++ ++inline void rtw_odm_ability_set(_adapter *adapter, u32 ability) ++{ ++ rtw_phydm_ability_set(adapter, ability); ++} ++ ++/* set ODM_CMNINFO_IC_TYPE based on chip_type */ ++void rtw_odm_init_ic_type(_adapter *adapter) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ DM_ODM_T *odm = &hal_data->odmpriv; ++ u4Byte ic_type = chip_type_to_odm_ic_type(rtw_get_chip_type(adapter)); ++ ++ rtw_warn_on(!ic_type); ++ ++ ODM_CmnInfoInit(odm, ODM_CMNINFO_IC_TYPE, ic_type); ++} ++ ++inline void rtw_odm_set_force_igi_lb(_adapter *adapter, u8 lb) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ ++ hal_data->u1ForcedIgiLb = lb; ++} ++ ++inline u8 rtw_odm_get_force_igi_lb(_adapter *adapter) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ ++ return hal_data->u1ForcedIgiLb; ++} ++ ++void rtw_odm_adaptivity_ver_msg(void *sel, _adapter *adapter) ++{ ++ RTW_PRINT_SEL(sel, "ADAPTIVITY_VERSION "ADAPTIVITY_VERSION"\n"); ++} ++ ++#define RTW_ADAPTIVITY_EN_DISABLE 0 ++#define RTW_ADAPTIVITY_EN_ENABLE 1 ++ ++void rtw_odm_adaptivity_en_msg(void *sel, _adapter *adapter) ++{ ++ struct registry_priv *regsty = &adapter->registrypriv; ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ DM_ODM_T *odm = &hal_data->odmpriv; ++ ++ RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_EN_"); ++ ++ if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_DISABLE) ++ _RTW_PRINT_SEL(sel, "DISABLE\n"); ++ else if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_ENABLE) ++ _RTW_PRINT_SEL(sel, "ENABLE\n"); ++ else ++ _RTW_PRINT_SEL(sel, "INVALID\n"); ++} ++ ++#define RTW_ADAPTIVITY_MODE_NORMAL 0 ++#define RTW_ADAPTIVITY_MODE_CARRIER_SENSE 1 ++ ++void rtw_odm_adaptivity_mode_msg(void *sel, _adapter *adapter) ++{ ++ struct registry_priv *regsty = &adapter->registrypriv; ++ ++ RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_MODE_"); ++ ++ if (regsty->adaptivity_mode == RTW_ADAPTIVITY_MODE_NORMAL) ++ _RTW_PRINT_SEL(sel, "NORMAL\n"); ++ else if (regsty->adaptivity_mode == RTW_ADAPTIVITY_MODE_CARRIER_SENSE) ++ _RTW_PRINT_SEL(sel, "CARRIER_SENSE\n"); ++ else ++ _RTW_PRINT_SEL(sel, "INVALID\n"); ++} ++ ++#define RTW_ADAPTIVITY_DML_DISABLE 0 ++#define RTW_ADAPTIVITY_DML_ENABLE 1 ++ ++void rtw_odm_adaptivity_dml_msg(void *sel, _adapter *adapter) ++{ ++ struct registry_priv *regsty = &adapter->registrypriv; ++ ++ RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_DML_"); ++ ++ if (regsty->adaptivity_dml == RTW_ADAPTIVITY_DML_DISABLE) ++ _RTW_PRINT_SEL(sel, "DISABLE\n"); ++ else if (regsty->adaptivity_dml == RTW_ADAPTIVITY_DML_ENABLE) ++ _RTW_PRINT_SEL(sel, "ENABLE\n"); ++ else ++ _RTW_PRINT_SEL(sel, "INVALID\n"); ++} ++ ++void rtw_odm_adaptivity_dc_backoff_msg(void *sel, _adapter *adapter) ++{ ++ struct registry_priv *regsty = &adapter->registrypriv; ++ ++ RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_DC_BACKOFF:%u\n", regsty->adaptivity_dc_backoff); ++} ++ ++void rtw_odm_adaptivity_config_msg(void *sel, _adapter *adapter) ++{ ++ rtw_odm_adaptivity_ver_msg(sel, adapter); ++ rtw_odm_adaptivity_en_msg(sel, adapter); ++ rtw_odm_adaptivity_mode_msg(sel, adapter); ++ rtw_odm_adaptivity_dml_msg(sel, adapter); ++ rtw_odm_adaptivity_dc_backoff_msg(sel, adapter); ++} ++ ++bool rtw_odm_adaptivity_needed(_adapter *adapter) ++{ ++ struct registry_priv *regsty = &adapter->registrypriv; ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ bool ret = _FALSE; ++ ++ if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_ENABLE) ++ ret = _TRUE; ++ ++ return ret; ++} ++ ++void rtw_odm_adaptivity_parm_msg(void *sel, _adapter *adapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); ++ DM_ODM_T *odm = &pHalData->odmpriv; ++ ++ rtw_odm_adaptivity_config_msg(sel, adapter); ++ ++ RTW_PRINT_SEL(sel, "%10s %16s %16s %22s %12s\n" ++ , "TH_L2H_ini", "TH_EDCCA_HL_diff", "TH_L2H_ini_mode2", "TH_EDCCA_HL_diff_mode2", "EDCCA_enable"); ++ RTW_PRINT_SEL(sel, "0x%-8x %-16d 0x%-14x %-22d %-12d\n" ++ , (u8)odm->TH_L2H_ini ++ , odm->TH_EDCCA_HL_diff ++ , (u8)odm->TH_L2H_ini_mode2 ++ , odm->TH_EDCCA_HL_diff_mode2 ++ , odm->EDCCA_enable ++ ); ++ ++ RTW_PRINT_SEL(sel, "%15s %9s\n", "AdapEnableState", "Adap_Flag"); ++ RTW_PRINT_SEL(sel, "%-15x %-9x\n" ++ , odm->Adaptivity_enable ++ , odm->adaptivity_flag ++ ); ++} ++ ++void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 TH_L2H_ini, s8 TH_EDCCA_HL_diff, s8 TH_L2H_ini_mode2, s8 TH_EDCCA_HL_diff_mode2, u8 EDCCA_enable) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); ++ DM_ODM_T *odm = &pHalData->odmpriv; ++ ++ odm->TH_L2H_ini = TH_L2H_ini; ++ odm->TH_EDCCA_HL_diff = TH_EDCCA_HL_diff; ++ odm->TH_L2H_ini_mode2 = TH_L2H_ini_mode2; ++ odm->TH_EDCCA_HL_diff_mode2 = TH_EDCCA_HL_diff_mode2; ++ odm->EDCCA_enable = EDCCA_enable; ++} ++ ++void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ DM_ODM_T *odm = &(hal_data->odmpriv); ++ ++ RTW_PRINT_SEL(sel, "RxRate = %s, RSSI_A = %d(%%), RSSI_B = %d(%%)\n", ++ HDATA_RATE(odm->RxRate), odm->RSSI_A, odm->RSSI_B); ++} ++ ++ ++void rtw_odm_acquirespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); ++ _irqL irqL; ++ ++ switch (type) { ++ case RT_IQK_SPINLOCK: ++ _enter_critical_bh(&pHalData->IQKSpinLock, &irqL); ++ default: ++ break; ++ } ++} ++ ++void rtw_odm_releasespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); ++ _irqL irqL; ++ ++ switch (type) { ++ case RT_IQK_SPINLOCK: ++ _exit_critical_bh(&pHalData->IQKSpinLock, &irqL); ++ default: ++ break; ++ } ++} ++ ++#ifdef CONFIG_DFS_MASTER ++inline u8 rtw_odm_get_dfs_domain(_adapter *adapter) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ PDM_ODM_T pDM_Odm = &(hal_data->odmpriv); ++ ++ return pDM_Odm->DFS_RegionDomain; ++} ++ ++inline VOID rtw_odm_radar_detect_reset(_adapter *adapter) ++{ ++ phydm_radar_detect_reset(GET_ODM(adapter)); ++} ++ ++inline VOID rtw_odm_radar_detect_disable(_adapter *adapter) ++{ ++ phydm_radar_detect_disable(GET_ODM(adapter)); ++} ++ ++/* called after ch, bw is set */ ++inline VOID rtw_odm_radar_detect_enable(_adapter *adapter) ++{ ++ phydm_radar_detect_enable(GET_ODM(adapter)); ++} ++ ++inline BOOLEAN rtw_odm_radar_detect(_adapter *adapter) ++{ ++ return phydm_radar_detect(GET_ODM(adapter)); ++} ++#endif /* CONFIG_DFS_MASTER */ ++ ++void rtw_odm_parse_rx_phy_status_chinfo(union recv_frame *rframe, u8 *phys) ++{ ++#ifndef DBG_RX_PHYSTATUS_CHINFO ++#define DBG_RX_PHYSTATUS_CHINFO 0 ++#endif ++ ++#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) ++ _adapter *adapter = rframe->u.hdr.adapter; ++ struct rx_pkt_attrib *attrib = &rframe->u.hdr.attrib; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ u8 *wlanhdr = get_recvframe_data(rframe); ++ ++ if (pDM_Odm->SupportICType & ODM_IC_PHY_STATUE_NEW_TYPE) { ++ /* ++ * 8723D: ++ * type_0(CCK) ++ * l_rxsc ++ * is filled with primary channel SC, not real rxsc. ++ * 0:LSC, 1:USC ++ * type_1(OFDM) ++ * rf_mode ++ * RF bandwidth when RX ++ * l_rxsc(legacy), ht_rxsc ++ * see below RXSC N-series ++ * type_2(Not used) ++ */ ++ /* ++ * 8821C, 8822B: ++ * type_0(CCK) ++ * l_rxsc ++ * is filled with primary channel SC, not real rxsc. ++ * 0:LSC, 1:USC ++ * type_1(OFDM) ++ * rf_mode ++ * RF bandwidth when RX ++ * l_rxsc(legacy), ht_rxsc ++ * see below RXSC AC-series ++ * type_2(Not used) ++ */ ++ ++ if ((*phys & 0xf) == 0) { ++ struct _Phy_Status_Rpt_Jaguar2_Type0 *phys_t0 = (struct _Phy_Status_Rpt_Jaguar2_Type0 *)phys; ++ ++ if (DBG_RX_PHYSTATUS_CHINFO) { ++ RTW_PRINT("phys_t%u ta="MAC_FMT" %s, %s(band:%u, ch:%u, l_rxsc:%u)\n" ++ , *phys & 0xf ++ , MAC_ARG(get_ta(wlanhdr)) ++ , is_broadcast_mac_addr(get_ra(wlanhdr)) ? "BC" : is_multicast_mac_addr(get_ra(wlanhdr)) ? "MC" : "UC" ++ , HDATA_RATE(attrib->data_rate) ++ , phys_t0->band, phys_t0->channel, phys_t0->rxsc ++ ); ++ } ++ ++ } else if ((*phys & 0xf) == 1) { ++ struct _Phy_Status_Rpt_Jaguar2_Type1 *phys_t1 = (struct _Phy_Status_Rpt_Jaguar2_Type1 *)phys; ++ u8 rxsc = (attrib->data_rate > DESC_RATE11M && attrib->data_rate < DESC_RATEMCS0) ? phys_t1->l_rxsc : phys_t1->ht_rxsc; ++ u8 pkt_cch = 0; ++ u8 pkt_bw = CHANNEL_WIDTH_20; ++ ++ #if ODM_IC_11N_SERIES_SUPPORT ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ /* RXSC N-series */ ++ #define RXSC_DUP 0 ++ #define RXSC_LSC 1 ++ #define RXSC_USC 2 ++ #define RXSC_40M 3 ++ ++ static const s8 cch_offset_by_rxsc[4] = {0, -2, 2, 0}; ++ ++ if (phys_t1->rf_mode == 0) { ++ pkt_cch = phys_t1->channel; ++ pkt_bw = CHANNEL_WIDTH_20; ++ } else if (phys_t1->rf_mode == 1) { ++ if (rxsc == RXSC_LSC || rxsc == RXSC_USC) { ++ pkt_cch = phys_t1->channel + cch_offset_by_rxsc[rxsc]; ++ pkt_bw = CHANNEL_WIDTH_20; ++ } else if (rxsc == RXSC_40M) { ++ pkt_cch = phys_t1->channel; ++ pkt_bw = CHANNEL_WIDTH_40; ++ } ++ } else ++ rtw_warn_on(1); ++ ++ goto type1_end; ++ } ++ #endif /* ODM_IC_11N_SERIES_SUPPORT */ ++ ++ #if ODM_IC_11AC_SERIES_SUPPORT ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ /* RXSC AC-series */ ++ #define RXSC_DUP 0 /* 0: RX from all SC of current rf_mode */ ++ ++ #define RXSC_LL20M_OF_160M 8 /* 1~8: RX from 20MHz SC */ ++ #define RXSC_L20M_OF_160M 6 ++ #define RXSC_L20M_OF_80M 4 ++ #define RXSC_L20M_OF_40M 2 ++ #define RXSC_U20M_OF_40M 1 ++ #define RXSC_U20M_OF_80M 3 ++ #define RXSC_U20M_OF_160M 5 ++ #define RXSC_UU20M_OF_160M 7 ++ ++ #define RXSC_L40M_OF_160M 12 /* 9~12: RX from 40MHz SC */ ++ #define RXSC_L40M_OF_80M 10 ++ #define RXSC_U40M_OF_80M 9 ++ #define RXSC_U40M_OF_160M 11 ++ ++ #define RXSC_L80M_OF_160M 14 /* 13~14: RX from 80MHz SC */ ++ #define RXSC_U80M_OF_160M 13 ++ ++ static const s8 cch_offset_by_rxsc[15] = {0, 2, -2, 6, -6, 10, -10, 14, -14, 4, -4, 12, -12, 8, -8}; ++ ++ if (phys_t1->rf_mode > 3) { ++ /* invalid rf_mode */ ++ rtw_warn_on(1); ++ goto type1_end; ++ } ++ ++ if (phys_t1->rf_mode == 0) { ++ /* RF 20MHz */ ++ pkt_cch = phys_t1->channel; ++ pkt_bw = CHANNEL_WIDTH_20; ++ goto type1_end; ++ } ++ ++ if (rxsc == 0) { ++ /* RF and RX with same BW */ ++ if (attrib->data_rate >= DESC_RATEMCS0) { ++ pkt_cch = phys_t1->channel; ++ pkt_bw = phys_t1->rf_mode; ++ } ++ goto type1_end; ++ } ++ ++ if ((phys_t1->rf_mode == 1 && rxsc >= 1 && rxsc <= 2) /* RF 40MHz, RX 20MHz */ ++ || (phys_t1->rf_mode == 2 && rxsc >= 1 && rxsc <= 4) /* RF 80MHz, RX 20MHz */ ++ || (phys_t1->rf_mode == 3 && rxsc >= 1 && rxsc <= 8) /* RF 160MHz, RX 20MHz */ ++ ) { ++ pkt_cch = phys_t1->channel + cch_offset_by_rxsc[rxsc]; ++ pkt_bw = CHANNEL_WIDTH_20; ++ } else if ((phys_t1->rf_mode == 2 && rxsc >= 9 && rxsc <= 10) /* RF 80MHz, RX 40MHz */ ++ || (phys_t1->rf_mode == 3 && rxsc >= 9 && rxsc <= 12) /* RF 160MHz, RX 40MHz */ ++ ) { ++ if (attrib->data_rate >= DESC_RATEMCS0) { ++ pkt_cch = phys_t1->channel + cch_offset_by_rxsc[rxsc]; ++ pkt_bw = CHANNEL_WIDTH_40; ++ } ++ } else if ((phys_t1->rf_mode == 3 && rxsc >= 13 && rxsc <= 14) /* RF 160MHz, RX 80MHz */ ++ ) { ++ if (attrib->data_rate >= DESC_RATEMCS0) { ++ pkt_cch = phys_t1->channel + cch_offset_by_rxsc[rxsc]; ++ pkt_bw = CHANNEL_WIDTH_80; ++ } ++ } else ++ rtw_warn_on(1); ++ ++ } ++ #endif /* ODM_IC_11AC_SERIES_SUPPORT */ ++ ++type1_end: ++ if (DBG_RX_PHYSTATUS_CHINFO) { ++ RTW_PRINT("phys_t%u ta="MAC_FMT" %s, %s(band:%u, ch:%u, rf_mode:%u, l_rxsc:%u, ht_rxsc:%u) => %u,%u\n" ++ , *phys & 0xf ++ , MAC_ARG(get_ta(wlanhdr)) ++ , is_broadcast_mac_addr(get_ra(wlanhdr)) ? "BC" : is_multicast_mac_addr(get_ra(wlanhdr)) ? "MC" : "UC" ++ , HDATA_RATE(attrib->data_rate) ++ , phys_t1->band, phys_t1->channel, phys_t1->rf_mode, phys_t1->l_rxsc, phys_t1->ht_rxsc ++ , pkt_cch, pkt_bw ++ ); ++ } ++ ++ /* for now, only return cneter channel of 20MHz packet */ ++ if (pkt_cch && pkt_bw == CHANNEL_WIDTH_20) ++ attrib->ch = pkt_cch; ++ ++ } else { ++ struct _Phy_Status_Rpt_Jaguar2_Type2 *phys_t2 = (struct _Phy_Status_Rpt_Jaguar2_Type2 *)phys; ++ ++ if (DBG_RX_PHYSTATUS_CHINFO) { ++ RTW_PRINT("phys_t%u ta="MAC_FMT" %s, %s(band:%u, ch:%u, l_rxsc:%u, ht_rxsc:%u)\n" ++ , *phys & 0xf ++ , MAC_ARG(get_ta(wlanhdr)) ++ , is_broadcast_mac_addr(get_ra(wlanhdr)) ? "BC" : is_multicast_mac_addr(get_ra(wlanhdr)) ? "MC" : "UC" ++ , HDATA_RATE(attrib->data_rate) ++ , phys_t2->band, phys_t2->channel, phys_t2->l_rxsc, phys_t2->ht_rxsc ++ ); ++ } ++ } ++ } ++#endif /* (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) */ ++ ++} ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_p2p.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_p2p.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_p2p.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_p2p.c 2018-02-11 21:44:27.140145979 +0200 +@@ -0,0 +1,5291 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_P2P_C_ ++ ++#include ++ ++#ifdef CONFIG_P2P ++ ++int rtw_p2p_is_channel_list_ok(u8 desired_ch, u8 *ch_list, u8 ch_cnt) ++{ ++ int found = 0, i = 0; ++ ++ for (i = 0; i < ch_cnt; i++) { ++ if (ch_list[i] == desired_ch) { ++ found = 1; ++ break; ++ } ++ } ++ return found ; ++} ++ ++int is_any_client_associated(_adapter *padapter) ++{ ++ return padapter->stapriv.asoc_list_cnt ? _TRUE : _FALSE; ++} ++ ++static u32 go_add_group_info_attr(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ _irqL irqL; ++ _list *phead, *plist; ++ u32 len = 0; ++ u16 attr_len = 0; ++ u8 tmplen, *pdata_attr, *pstart, *pcur; ++ struct sta_info *psta = NULL; ++ _adapter *padapter = pwdinfo->padapter; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ ++ pdata_attr = rtw_zmalloc(MAX_P2P_IE_LEN); ++ ++ if (NULL == pdata_attr) { ++ RTW_INFO("%s pdata_attr malloc failed\n", __FUNCTION__); ++ goto _exit; ++ } ++ ++ pstart = pdata_attr; ++ pcur = pdata_attr; ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ /* look up sta asoc_queue */ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ ++ plist = get_next(plist); ++ ++ ++ if (psta->is_p2p_device) { ++ tmplen = 0; ++ ++ pcur++; ++ ++ /* P2P device address */ ++ _rtw_memcpy(pcur, psta->dev_addr, ETH_ALEN); ++ pcur += ETH_ALEN; ++ ++ /* P2P interface address */ ++ _rtw_memcpy(pcur, psta->hwaddr, ETH_ALEN); ++ pcur += ETH_ALEN; ++ ++ *pcur = psta->dev_cap; ++ pcur++; ++ ++ /* *(u16*)(pcur) = cpu_to_be16(psta->config_methods); */ ++ RTW_PUT_BE16(pcur, psta->config_methods); ++ pcur += 2; ++ ++ _rtw_memcpy(pcur, psta->primary_dev_type, 8); ++ pcur += 8; ++ ++ *pcur = psta->num_of_secdev_type; ++ pcur++; ++ ++ _rtw_memcpy(pcur, psta->secdev_types_list, psta->num_of_secdev_type * 8); ++ pcur += psta->num_of_secdev_type * 8; ++ ++ if (psta->dev_name_len > 0) { ++ /* *(u16*)(pcur) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); */ ++ RTW_PUT_BE16(pcur, WPS_ATTR_DEVICE_NAME); ++ pcur += 2; ++ ++ /* *(u16*)(pcur) = cpu_to_be16( psta->dev_name_len ); */ ++ RTW_PUT_BE16(pcur, psta->dev_name_len); ++ pcur += 2; ++ ++ _rtw_memcpy(pcur, psta->dev_name, psta->dev_name_len); ++ pcur += psta->dev_name_len; ++ } ++ ++ ++ tmplen = (u8)(pcur - pstart); ++ ++ *pstart = (tmplen - 1); ++ ++ attr_len += tmplen; ++ ++ /* pstart += tmplen; */ ++ pstart = pcur; ++ ++ } ++ ++ ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ if (attr_len > 0) ++ len = rtw_set_p2p_attr_content(pbuf, P2P_ATTR_GROUP_INFO, attr_len, pdata_attr); ++ ++ rtw_mfree(pdata_attr, MAX_P2P_IE_LEN); ++ ++_exit: ++ return len; ++ ++} ++ ++static void issue_group_disc_req(struct wifidirect_info *pwdinfo, u8 *da) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ _adapter *padapter = pwdinfo->padapter; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ unsigned char category = RTW_WLAN_CATEGORY_P2P;/* P2P action frame */ ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_GO_DISC_REQUEST; ++ u8 dialogToken = 0; ++ ++ RTW_INFO("[%s]\n", __FUNCTION__); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pwdinfo->interface_addr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->interface_addr, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ /* Build P2P action frame header */ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ ++ /* there is no IE in this P2P action frame */ ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++} ++ ++static void issue_p2p_devdisc_resp(struct wifidirect_info *pwdinfo, u8 *da, u8 status, u8 dialogToken) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ _adapter *padapter = pwdinfo->padapter; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = P2P_PUB_ACTION_ACTION; ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_DEVDISC_RESP; ++ u8 p2pie[8] = { 0x00 }; ++ u32 p2pielen = 0; ++ ++ RTW_INFO("[%s]\n", __FUNCTION__); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pwdinfo->device_addr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->device_addr, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ /* Build P2P public action frame header */ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ ++ ++ /* Build P2P IE */ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* P2P_ATTR_STATUS */ ++ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_STATUS, 1, &status); ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, p2pie, &pattrib->pktlen); ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++} ++ ++static void issue_p2p_provision_resp(struct wifidirect_info *pwdinfo, u8 *raddr, u8 *frame_body, u16 config_method) ++{ ++ _adapter *padapter = pwdinfo->padapter; ++ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = P2P_PUB_ACTION_ACTION; ++ u8 dialogToken = frame_body[7]; /* The Dialog Token of provisioning discovery request frame. */ ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_PROVISION_DISC_RESP; ++ u8 wpsie[100] = { 0x00 }; ++ u8 wpsielen = 0; ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ ++ wpsielen = 0; ++ /* WPS OUI */ ++ /* *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); */ ++ RTW_PUT_BE32(wpsie, WPSOUI); ++ wpsielen += 4; ++ ++#if 0 ++ /* WPS version */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ ++#endif ++ ++ /* Config Method */ ++ /* Type: */ ++ /* *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); */ ++ RTW_PUT_BE16(wpsie + wpsielen, WPS_ATTR_CONF_METHOD); ++ wpsielen += 2; ++ ++ /* Length: */ ++ /* *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); */ ++ RTW_PUT_BE16(wpsie + wpsielen, 0x0002); ++ wpsielen += 2; ++ ++ /* Value: */ ++ /* *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( config_method ); */ ++ RTW_PUT_BE16(wpsie + wpsielen, config_method); ++ wpsielen += 2; ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); ++ ++#ifdef CONFIG_WFD ++ wfdielen = build_provdisc_resp_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++#endif ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ return; ++ ++} ++ ++static void issue_p2p_presence_resp(struct wifidirect_info *pwdinfo, u8 *da, u8 status, u8 dialogToken) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ _adapter *padapter = pwdinfo->padapter; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ unsigned char category = RTW_WLAN_CATEGORY_P2P;/* P2P action frame */ ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_PRESENCE_RESPONSE; ++ u8 p2pie[MAX_P2P_IE_LEN] = { 0x00 }; ++ u8 noa_attr_content[32] = { 0x00 }; ++ u32 p2pielen = 0; ++ ++ RTW_INFO("[%s]\n", __FUNCTION__); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pwdinfo->interface_addr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->interface_addr, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ /* Build P2P action frame header */ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ ++ ++ /* Add P2P IE header */ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* Add Status attribute in P2P IE */ ++ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_STATUS, 1, &status); ++ ++ /* Add NoA attribute in P2P IE */ ++ noa_attr_content[0] = 0x1;/* index */ ++ noa_attr_content[1] = 0x0;/* CTWindow and OppPS Parameters */ ++ ++ /* todo: Notice of Absence Descriptor(s) */ ++ ++ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_NOA, 2, noa_attr_content); ++ ++ ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, p2pie, &(pattrib->pktlen)); ++ ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++} ++ ++u32 build_beacon_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 p2pie[MAX_P2P_IE_LEN] = { 0x00 }; ++ u16 capability = 0; ++ u32 len = 0, p2pielen = 0; ++ ++ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ ++ /* According to the P2P Specification, the beacon frame should contain 3 P2P attributes */ ++ /* 1. P2P Capability */ ++ /* 2. P2P Device ID */ ++ /* 3. Notice of Absence ( NOA ) */ ++ ++ /* P2P Capability ATTR */ ++ /* Type: */ ++ /* Length: */ ++ /* Value: */ ++ /* Device Capability Bitmap, 1 byte */ ++ /* Be able to participate in additional P2P Groups and */ ++ /* support the P2P Invitation Procedure */ ++ /* Group Capability Bitmap, 1 byte */ ++ capability = P2P_DEVCAP_INVITATION_PROC | P2P_DEVCAP_CLIENT_DISCOVERABILITY; ++ capability |= ((P2P_GRPCAP_GO | P2P_GRPCAP_INTRABSS) << 8); ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) ++ capability |= (P2P_GRPCAP_GROUP_FORMATION << 8); ++ ++ capability = cpu_to_le16(capability); ++ ++ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_CAPABILITY, 2, (u8 *)&capability); ++ ++ ++ /* P2P Device ID ATTR */ ++ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_DEVICE_ID, ETH_ALEN, pwdinfo->device_addr); ++ ++ ++ /* Notice of Absence ATTR */ ++ /* Type: */ ++ /* Length: */ ++ /* Value: */ ++ ++ /* go_add_noa_attr(pwdinfo); */ ++ ++ ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); ++ ++ ++ return len; ++ ++} ++ ++#ifdef CONFIG_WFD ++u32 build_beacon_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; ++ u16 val16 = 0; ++ u32 len = 0, wfdielen = 0; ++ _adapter *padapter = pwdinfo->padapter; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++ /* WFD OUI */ ++ wfdielen = 0; ++ wfdie[wfdielen++] = 0x50; ++ wfdie[wfdielen++] = 0x6F; ++ wfdie[wfdielen++] = 0x9A; ++ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ ++ ++ /* Commented by Albert 20110812 */ ++ /* According to the WFD Specification, the beacon frame should contain 4 WFD attributes */ ++ /* 1. WFD Device Information */ ++ /* 2. Associated BSSID */ ++ /* 3. Coupled Sink Information */ ++ ++ ++ /* WFD Device Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value1: */ ++ /* WFD device information */ ++ ++ if (P2P_ROLE_GO == pwdinfo->role) { ++ if (is_any_client_associated(pwdinfo->padapter)) { ++ /* WFD primary sink + WiFi Direct mode + WSD (WFD Service Discovery) */ ++ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ } else { ++ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD (WFD Service Discovery) */ ++ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ } ++ ++ } else { ++ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ ++ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ } ++ ++ wfdielen += 2; ++ ++ /* Value2: */ ++ /* Session Management Control Port */ ++ /* Default TCP port for RTSP messages is 554 */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); ++ wfdielen += 2; ++ ++ /* Value3: */ ++ /* WFD Device Maximum Throughput */ ++ /* 300Mbps is the maximum throughput */ ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ /* Associated BSSID ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Associated BSSID */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); ++ else ++ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); ++ ++ wfdielen += ETH_ALEN; ++ ++ /* Coupled Sink Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Coupled Sink Status bitmap */ ++ /* Not coupled/available for Coupling */ ++ wfdie[wfdielen++] = 0; ++ /* MAC Addr. */ ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ ++ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ ++exit: ++ return len; ++} ++ ++u32 build_probe_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; ++ u16 val16 = 0; ++ u32 len = 0, wfdielen = 0; ++ _adapter *padapter = pwdinfo->padapter; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++ /* WFD OUI */ ++ wfdielen = 0; ++ wfdie[wfdielen++] = 0x50; ++ wfdie[wfdielen++] = 0x6F; ++ wfdie[wfdielen++] = 0x9A; ++ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ ++ ++ /* Commented by Albert 20110812 */ ++ /* According to the WFD Specification, the probe request frame should contain 4 WFD attributes */ ++ /* 1. WFD Device Information */ ++ /* 2. Associated BSSID */ ++ /* 3. Coupled Sink Information */ ++ ++ ++ /* WFD Device Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value1: */ ++ /* WFD device information */ ++ ++ if (1 == pwdinfo->wfd_tdls_enable) { ++ /* WFD primary sink + available for WFD session + WiFi TDLS mode + WSC ( WFD Service Discovery ) */ ++ val16 = pwfd_info->wfd_device_type | ++ WFD_DEVINFO_SESSION_AVAIL | ++ WFD_DEVINFO_WSD | ++ WFD_DEVINFO_PC_TDLS; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ } else { ++ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSC ( WFD Service Discovery ) */ ++ val16 = pwfd_info->wfd_device_type | ++ WFD_DEVINFO_SESSION_AVAIL | ++ WFD_DEVINFO_WSD; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ } ++ ++ wfdielen += 2; ++ ++ /* Value2: */ ++ /* Session Management Control Port */ ++ /* Default TCP port for RTSP messages is 554 */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); ++ wfdielen += 2; ++ ++ /* Value3: */ ++ /* WFD Device Maximum Throughput */ ++ /* 300Mbps is the maximum throughput */ ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ /* Associated BSSID ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Associated BSSID */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); ++ else ++ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); ++ ++ wfdielen += ETH_ALEN; ++ ++ /* Coupled Sink Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Coupled Sink Status bitmap */ ++ /* Not coupled/available for Coupling */ ++ wfdie[wfdielen++] = 0; ++ /* MAC Addr. */ ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ ++ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ ++exit: ++ return len; ++} ++ ++u32 build_probe_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 tunneled) ++{ ++ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; ++ u32 len = 0, wfdielen = 0; ++ _adapter *padapter = pwdinfo->padapter; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++ /* WFD OUI */ ++ wfdielen = 0; ++ wfdie[wfdielen++] = 0x50; ++ wfdie[wfdielen++] = 0x6F; ++ wfdie[wfdielen++] = 0x9A; ++ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ ++ ++ /* Commented by Albert 20110812 */ ++ /* According to the WFD Specification, the probe response frame should contain 4 WFD attributes */ ++ /* 1. WFD Device Information */ ++ /* 2. Associated BSSID */ ++ /* 3. Coupled Sink Information */ ++ /* 4. WFD Session Information */ ++ ++ ++ /* WFD Device Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value1: */ ++ /* WFD device information */ ++ /* WFD primary sink + available for WFD session + WiFi Direct mode */ ++ ++ if (_TRUE == pwdinfo->session_available) { ++ if (P2P_ROLE_GO == pwdinfo->role) { ++ if (is_any_client_associated(pwdinfo->padapter)) { ++ if (pwdinfo->wfd_tdls_enable) { ++ /* TDLS mode + WSD ( WFD Service Discovery ) */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); ++ } else { ++ /* WiFi Direct mode + WSD ( WFD Service Discovery ) */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); ++ } ++ } else { ++ if (pwdinfo->wfd_tdls_enable) { ++ /* available for WFD session + TDLS mode + WSD ( WFD Service Discovery ) */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); ++ } else { ++ /* available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); ++ } ++ } ++ } else { ++ if (pwdinfo->wfd_tdls_enable) { ++ /* available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); ++ } else { ++ ++ /* available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); ++ } ++ } ++ } else { ++ if (pwdinfo->wfd_tdls_enable) ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); ++ else ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); ++ ++ } ++ ++ wfdielen += 2; ++ ++ /* Value2: */ ++ /* Session Management Control Port */ ++ /* Default TCP port for RTSP messages is 554 */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); ++ wfdielen += 2; ++ ++ /* Value3: */ ++ /* WFD Device Maximum Throughput */ ++ /* 300Mbps is the maximum throughput */ ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ /* Associated BSSID ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Associated BSSID */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); ++ else ++ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); ++ ++ wfdielen += ETH_ALEN; ++ ++ /* Coupled Sink Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Coupled Sink Status bitmap */ ++ /* Not coupled/available for Coupling */ ++ wfdie[wfdielen++] = 0; ++ /* MAC Addr. */ ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ /* WFD Session Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_SESSION_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0000); ++ wfdielen += 2; ++ ++ /* Todo: to add the list of WFD device info descriptor in WFD group. */ ++ ++ } ++#ifdef CONFIG_CONCURRENT_MODE ++#ifdef CONFIG_TDLS ++ { ++ int i; ++ _adapter *iface = NULL; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ if (iface == padapter) ++ continue; ++ ++ if ((tunneled == 0) && (iface->wdinfo.wfd_tdls_enable == 1)) { ++ /* Alternative MAC Address ATTR ++ Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ALTER_MAC; ++ ++ /* Length: ++ Note: In the WFD specification, the size of length field is 2.*/ ++ RTW_PUT_BE16(wfdie + wfdielen, ETH_ALEN); ++ wfdielen += 2; ++ ++ /* Value: ++ Alternative MAC Address*/ ++ _rtw_memcpy(wfdie + wfdielen, adapter_mac_addr(iface), ETH_ALEN); ++ wfdielen += ETH_ALEN; ++ } ++ } ++ } ++ } ++ ++#endif /* CONFIG_TDLS*/ ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ ++exit: ++ return len; ++} ++ ++u32 build_assoc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; ++ u16 val16 = 0; ++ u32 len = 0, wfdielen = 0; ++ _adapter *padapter = NULL; ++ struct mlme_priv *pmlmepriv = NULL; ++ struct wifi_display_info *pwfd_info = NULL; ++ ++ padapter = pwdinfo->padapter; ++ pmlmepriv = &padapter->mlmepriv; ++ pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) ++ goto exit; ++ ++ /* WFD OUI */ ++ wfdielen = 0; ++ wfdie[wfdielen++] = 0x50; ++ wfdie[wfdielen++] = 0x6F; ++ wfdie[wfdielen++] = 0x9A; ++ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ ++ ++ /* Commented by Albert 20110812 */ ++ /* According to the WFD Specification, the probe request frame should contain 4 WFD attributes */ ++ /* 1. WFD Device Information */ ++ /* 2. Associated BSSID */ ++ /* 3. Coupled Sink Information */ ++ ++ ++ /* WFD Device Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value1: */ ++ /* WFD device information */ ++ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ ++ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ wfdielen += 2; ++ ++ /* Value2: */ ++ /* Session Management Control Port */ ++ /* Default TCP port for RTSP messages is 554 */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); ++ wfdielen += 2; ++ ++ /* Value3: */ ++ /* WFD Device Maximum Throughput */ ++ /* 300Mbps is the maximum throughput */ ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ /* Associated BSSID ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Associated BSSID */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); ++ else ++ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); ++ ++ wfdielen += ETH_ALEN; ++ ++ /* Coupled Sink Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Coupled Sink Status bitmap */ ++ /* Not coupled/available for Coupling */ ++ wfdie[wfdielen++] = 0; ++ /* MAC Addr. */ ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ ++ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ ++exit: ++ return len; ++} ++ ++u32 build_assoc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; ++ u32 len = 0, wfdielen = 0; ++ u16 val16 = 0; ++ _adapter *padapter = pwdinfo->padapter; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++ /* WFD OUI */ ++ wfdielen = 0; ++ wfdie[wfdielen++] = 0x50; ++ wfdie[wfdielen++] = 0x6F; ++ wfdie[wfdielen++] = 0x9A; ++ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ ++ ++ /* Commented by Albert 20110812 */ ++ /* According to the WFD Specification, the probe request frame should contain 4 WFD attributes */ ++ /* 1. WFD Device Information */ ++ /* 2. Associated BSSID */ ++ /* 3. Coupled Sink Information */ ++ ++ ++ /* WFD Device Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value1: */ ++ /* WFD device information */ ++ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ ++ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ wfdielen += 2; ++ ++ /* Value2: */ ++ /* Session Management Control Port */ ++ /* Default TCP port for RTSP messages is 554 */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); ++ wfdielen += 2; ++ ++ /* Value3: */ ++ /* WFD Device Maximum Throughput */ ++ /* 300Mbps is the maximum throughput */ ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ /* Associated BSSID ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Associated BSSID */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); ++ else ++ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); ++ ++ wfdielen += ETH_ALEN; ++ ++ /* Coupled Sink Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Coupled Sink Status bitmap */ ++ /* Not coupled/available for Coupling */ ++ wfdie[wfdielen++] = 0; ++ /* MAC Addr. */ ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ ++ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ ++exit: ++ return len; ++} ++ ++u32 build_nego_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; ++ u32 len = 0, wfdielen = 0; ++ u16 val16 = 0; ++ _adapter *padapter = pwdinfo->padapter; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++ /* WFD OUI */ ++ wfdielen = 0; ++ wfdie[wfdielen++] = 0x50; ++ wfdie[wfdielen++] = 0x6F; ++ wfdie[wfdielen++] = 0x9A; ++ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ ++ ++ /* Commented by Albert 20110825 */ ++ /* According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes */ ++ /* 1. WFD Device Information */ ++ /* 2. Associated BSSID ( Optional ) */ ++ /* 3. Local IP Adress ( Optional ) */ ++ ++ ++ /* WFD Device Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value1: */ ++ /* WFD device information */ ++ /* WFD primary sink + WiFi Direct mode + WSD ( WFD Service Discovery ) + WFD Session Available */ ++ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ wfdielen += 2; ++ ++ /* Value2: */ ++ /* Session Management Control Port */ ++ /* Default TCP port for RTSP messages is 554 */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); ++ wfdielen += 2; ++ ++ /* Value3: */ ++ /* WFD Device Maximum Throughput */ ++ /* 300Mbps is the maximum throughput */ ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ /* Associated BSSID ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Associated BSSID */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); ++ else ++ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); ++ ++ wfdielen += ETH_ALEN; ++ ++ /* Coupled Sink Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Coupled Sink Status bitmap */ ++ /* Not coupled/available for Coupling */ ++ wfdie[wfdielen++] = 0; ++ /* MAC Addr. */ ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ ++ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ ++exit: ++ return len; ++} ++ ++u32 build_nego_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; ++ u32 len = 0, wfdielen = 0; ++ u16 val16 = 0; ++ _adapter *padapter = pwdinfo->padapter; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++ /* WFD OUI */ ++ wfdielen = 0; ++ wfdie[wfdielen++] = 0x50; ++ wfdie[wfdielen++] = 0x6F; ++ wfdie[wfdielen++] = 0x9A; ++ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ ++ ++ /* Commented by Albert 20110825 */ ++ /* According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes */ ++ /* 1. WFD Device Information */ ++ /* 2. Associated BSSID ( Optional ) */ ++ /* 3. Local IP Adress ( Optional ) */ ++ ++ ++ /* WFD Device Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value1: */ ++ /* WFD device information */ ++ /* WFD primary sink + WiFi Direct mode + WSD ( WFD Service Discovery ) + WFD Session Available */ ++ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ wfdielen += 2; ++ ++ /* Value2: */ ++ /* Session Management Control Port */ ++ /* Default TCP port for RTSP messages is 554 */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); ++ wfdielen += 2; ++ ++ /* Value3: */ ++ /* WFD Device Maximum Throughput */ ++ /* 300Mbps is the maximum throughput */ ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ /* Associated BSSID ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Associated BSSID */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); ++ else ++ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); ++ ++ wfdielen += ETH_ALEN; ++ ++ /* Coupled Sink Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Coupled Sink Status bitmap */ ++ /* Not coupled/available for Coupling */ ++ wfdie[wfdielen++] = 0; ++ /* MAC Addr. */ ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ ++ ++ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ ++exit: ++ return len; ++} ++ ++u32 build_nego_confirm_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; ++ u32 len = 0, wfdielen = 0; ++ u16 val16 = 0; ++ _adapter *padapter = pwdinfo->padapter; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++ /* WFD OUI */ ++ wfdielen = 0; ++ wfdie[wfdielen++] = 0x50; ++ wfdie[wfdielen++] = 0x6F; ++ wfdie[wfdielen++] = 0x9A; ++ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ ++ ++ /* Commented by Albert 20110825 */ ++ /* According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes */ ++ /* 1. WFD Device Information */ ++ /* 2. Associated BSSID ( Optional ) */ ++ /* 3. Local IP Adress ( Optional ) */ ++ ++ ++ /* WFD Device Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value1: */ ++ /* WFD device information */ ++ /* WFD primary sink + WiFi Direct mode + WSD ( WFD Service Discovery ) + WFD Session Available */ ++ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ wfdielen += 2; ++ ++ /* Value2: */ ++ /* Session Management Control Port */ ++ /* Default TCP port for RTSP messages is 554 */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); ++ wfdielen += 2; ++ ++ /* Value3: */ ++ /* WFD Device Maximum Throughput */ ++ /* 300Mbps is the maximum throughput */ ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ /* Associated BSSID ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Associated BSSID */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); ++ else ++ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); ++ ++ wfdielen += ETH_ALEN; ++ ++ /* Coupled Sink Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Coupled Sink Status bitmap */ ++ /* Not coupled/available for Coupling */ ++ wfdie[wfdielen++] = 0; ++ /* MAC Addr. */ ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ ++ ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ ++exit: ++ return len; ++} ++ ++u32 build_invitation_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; ++ u32 len = 0, wfdielen = 0; ++ u16 val16 = 0; ++ _adapter *padapter = pwdinfo->padapter; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++ /* WFD OUI */ ++ wfdielen = 0; ++ wfdie[wfdielen++] = 0x50; ++ wfdie[wfdielen++] = 0x6F; ++ wfdie[wfdielen++] = 0x9A; ++ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ ++ ++ /* Commented by Albert 20110825 */ ++ /* According to the WFD Specification, the provision discovery request frame should contain 3 WFD attributes */ ++ /* 1. WFD Device Information */ ++ /* 2. Associated BSSID ( Optional ) */ ++ /* 3. Local IP Adress ( Optional ) */ ++ ++ ++ /* WFD Device Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value1: */ ++ /* WFD device information */ ++ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ ++ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ wfdielen += 2; ++ ++ /* Value2: */ ++ /* Session Management Control Port */ ++ /* Default TCP port for RTSP messages is 554 */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); ++ wfdielen += 2; ++ ++ /* Value3: */ ++ /* WFD Device Maximum Throughput */ ++ /* 300Mbps is the maximum throughput */ ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ /* Associated BSSID ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Associated BSSID */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); ++ else ++ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); ++ ++ wfdielen += ETH_ALEN; ++ ++ /* Coupled Sink Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Coupled Sink Status bitmap */ ++ /* Not coupled/available for Coupling */ ++ wfdie[wfdielen++] = 0; ++ /* MAC Addr. */ ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ ++ if (P2P_ROLE_GO == pwdinfo->role) { ++ /* WFD Session Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_SESSION_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0000); ++ wfdielen += 2; ++ ++ /* Todo: to add the list of WFD device info descriptor in WFD group. */ ++ ++ } ++ ++ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ ++exit: ++ return len; ++} ++ ++u32 build_invitation_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; ++ u16 val16 = 0; ++ u32 len = 0, wfdielen = 0; ++ _adapter *padapter = pwdinfo->padapter; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++ /* WFD OUI */ ++ wfdielen = 0; ++ wfdie[wfdielen++] = 0x50; ++ wfdie[wfdielen++] = 0x6F; ++ wfdie[wfdielen++] = 0x9A; ++ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ ++ ++ /* Commented by Albert 20110825 */ ++ /* According to the WFD Specification, the provision discovery request frame should contain 3 WFD attributes */ ++ /* 1. WFD Device Information */ ++ /* 2. Associated BSSID ( Optional ) */ ++ /* 3. Local IP Adress ( Optional ) */ ++ ++ ++ /* WFD Device Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value1: */ ++ /* WFD device information */ ++ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ ++ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ wfdielen += 2; ++ ++ /* Value2: */ ++ /* Session Management Control Port */ ++ /* Default TCP port for RTSP messages is 554 */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); ++ wfdielen += 2; ++ ++ /* Value3: */ ++ /* WFD Device Maximum Throughput */ ++ /* 300Mbps is the maximum throughput */ ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ /* Associated BSSID ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Associated BSSID */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); ++ else ++ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); ++ ++ wfdielen += ETH_ALEN; ++ ++ /* Coupled Sink Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Coupled Sink Status bitmap */ ++ /* Not coupled/available for Coupling */ ++ wfdie[wfdielen++] = 0; ++ /* MAC Addr. */ ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ ++ if (P2P_ROLE_GO == pwdinfo->role) { ++ /* WFD Session Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_SESSION_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0000); ++ wfdielen += 2; ++ ++ /* Todo: to add the list of WFD device info descriptor in WFD group. */ ++ ++ } ++ ++ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ ++exit: ++ return len; ++} ++ ++u32 build_provdisc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; ++ u32 len = 0, wfdielen = 0; ++ u16 val16 = 0; ++ _adapter *padapter = pwdinfo->padapter; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++ /* WFD OUI */ ++ wfdielen = 0; ++ wfdie[wfdielen++] = 0x50; ++ wfdie[wfdielen++] = 0x6F; ++ wfdie[wfdielen++] = 0x9A; ++ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ ++ ++ /* Commented by Albert 20110825 */ ++ /* According to the WFD Specification, the provision discovery request frame should contain 3 WFD attributes */ ++ /* 1. WFD Device Information */ ++ /* 2. Associated BSSID ( Optional ) */ ++ /* 3. Local IP Adress ( Optional ) */ ++ ++ ++ /* WFD Device Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value1: */ ++ /* WFD device information */ ++ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ ++ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ wfdielen += 2; ++ ++ /* Value2: */ ++ /* Session Management Control Port */ ++ /* Default TCP port for RTSP messages is 554 */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); ++ wfdielen += 2; ++ ++ /* Value3: */ ++ /* WFD Device Maximum Throughput */ ++ /* 300Mbps is the maximum throughput */ ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ /* Associated BSSID ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Associated BSSID */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); ++ else ++ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); ++ ++ wfdielen += ETH_ALEN; ++ ++ /* Coupled Sink Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Coupled Sink Status bitmap */ ++ /* Not coupled/available for Coupling */ ++ wfdie[wfdielen++] = 0; ++ /* MAC Addr. */ ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ ++ ++ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ ++exit: ++ return len; ++} ++ ++u32 build_provdisc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; ++ u32 len = 0, wfdielen = 0; ++ u16 val16 = 0; ++ _adapter *padapter = pwdinfo->padapter; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++ /* WFD OUI */ ++ wfdielen = 0; ++ wfdie[wfdielen++] = 0x50; ++ wfdie[wfdielen++] = 0x6F; ++ wfdie[wfdielen++] = 0x9A; ++ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ ++ ++ /* Commented by Albert 20110825 */ ++ /* According to the WFD Specification, the provision discovery response frame should contain 3 WFD attributes */ ++ /* 1. WFD Device Information */ ++ /* 2. Associated BSSID ( Optional ) */ ++ /* 3. Local IP Adress ( Optional ) */ ++ ++ ++ /* WFD Device Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value1: */ ++ /* WFD device information */ ++ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ ++ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; ++ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ wfdielen += 2; ++ ++ /* Value2: */ ++ /* Session Management Control Port */ ++ /* Default TCP port for RTSP messages is 554 */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); ++ wfdielen += 2; ++ ++ /* Value3: */ ++ /* WFD Device Maximum Throughput */ ++ /* 300Mbps is the maximum throughput */ ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ /* Associated BSSID ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Associated BSSID */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); ++ else ++ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); ++ ++ wfdielen += ETH_ALEN; ++ ++ /* Coupled Sink Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Coupled Sink Status bitmap */ ++ /* Not coupled/available for Coupling */ ++ wfdie[wfdielen++] = 0; ++ /* MAC Addr. */ ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ wfdie[wfdielen++] = 0; ++ ++ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ ++exit: ++ return len; ++} ++#endif /* CONFIG_WFD */ ++ ++u32 build_probe_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 p2pie[MAX_P2P_IE_LEN] = { 0x00 }; ++ u32 len = 0, p2pielen = 0; ++#ifdef CONFIG_INTEL_WIDI ++ struct mlme_priv *pmlmepriv = &(pwdinfo->padapter->mlmepriv); ++ u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; ++ u8 widi_version = 0, i = 0; ++ ++ if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE) ++ widi_version = 35; ++ else if (pmlmepriv->num_p2p_sdt != 0) ++ widi_version = 40; ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* Commented by Albert 20100907 */ ++ /* According to the P2P Specification, the probe response frame should contain 5 P2P attributes */ ++ /* 1. P2P Capability */ ++ /* 2. Extended Listen Timing */ ++ /* 3. Notice of Absence ( NOA ) ( Only GO needs this ) */ ++ /* 4. Device Info */ ++ /* 5. Group Info ( Only GO need this ) */ ++ ++ /* P2P Capability ATTR */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; ++ ++ /* Length: */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); */ ++ RTW_PUT_LE16(p2pie + p2pielen, 0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Device Capability Bitmap, 1 byte */ ++ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; ++ ++ /* Group Capability Bitmap, 1 byte */ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ p2pie[p2pielen] = (P2P_GRPCAP_GO | P2P_GRPCAP_INTRABSS); ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) ++ p2pie[p2pielen] |= P2P_GRPCAP_GROUP_FORMATION; ++ ++ p2pielen++; ++ } else if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE)) { ++ /* Group Capability Bitmap, 1 byte */ ++ if (pwdinfo->persistent_supported) ++ p2pie[p2pielen++] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; ++ else ++ p2pie[p2pielen++] = DMP_P2P_GRPCAP_SUPPORT; ++ } ++ ++ /* Extended Listen Timing ATTR */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_EX_LISTEN_TIMING; ++ ++ /* Length: */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0004 ); */ ++ RTW_PUT_LE16(p2pie + p2pielen, 0x0004); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Availability Period */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); */ ++ RTW_PUT_LE16(p2pie + p2pielen, 0xFFFF); ++ p2pielen += 2; ++ ++ /* Availability Interval */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); */ ++ RTW_PUT_LE16(p2pie + p2pielen, 0xFFFF); ++ p2pielen += 2; ++ ++ ++ /* Notice of Absence ATTR */ ++ /* Type: */ ++ /* Length: */ ++ /* Value: */ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ /* go_add_noa_attr(pwdinfo); */ ++ } ++ ++ /* Device Info ATTR */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ ++ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); */ ++#ifdef CONFIG_INTEL_WIDI ++ if (widi_version == 35) ++ RTW_PUT_LE16(p2pie + p2pielen, 21 + 8 + pwdinfo->device_name_len); ++ else if (widi_version == 40) ++ RTW_PUT_LE16(p2pie + p2pielen, 21 + 8 * pmlmepriv->num_p2p_sdt + pwdinfo->device_name_len); ++ else ++#endif /* CONFIG_INTEL_WIDI */ ++ RTW_PUT_LE16(p2pie + p2pielen, 21 + pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* P2P Device Address */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ /* Config Method */ ++ /* This field should be big endian. Noted by P2P specification. */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); */ ++ RTW_PUT_BE16(p2pie + p2pielen, pwdinfo->supported_wps_cm); ++ p2pielen += 2; ++ ++#ifdef CONFIG_INTEL_WIDI ++ if (widi_version == 40) { ++ /* Primary Device Type */ ++ /* Category ID */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); */ ++ RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_pdt_cid); ++ p2pielen += 2; ++ ++ /* OUI */ ++ /* *(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); */ ++ RTW_PUT_BE32(p2pie + p2pielen, WPSOUI); ++ p2pielen += 4; ++ ++ /* Sub Category ID */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); */ ++ RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_pdt_scid); ++ p2pielen += 2; ++ } else ++#endif /* CONFIG_INTEL_WIDI */ ++ { ++ /* Primary Device Type */ ++ /* Category ID */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); */ ++ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_CID_MULIT_MEDIA); ++ p2pielen += 2; ++ ++ /* OUI */ ++ /* *(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); */ ++ RTW_PUT_BE32(p2pie + p2pielen, WPSOUI); ++ p2pielen += 4; ++ ++ /* Sub Category ID */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); */ ++ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_SCID_MEDIA_SERVER); ++ p2pielen += 2; ++ } ++ ++ /* Number of Secondary Device Types */ ++#ifdef CONFIG_INTEL_WIDI ++ if (widi_version == 35) { ++ p2pie[p2pielen++] = 0x01; ++ ++ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_CID_DISPLAYS); ++ p2pielen += 2; ++ ++ RTW_PUT_BE32(p2pie + p2pielen, INTEL_DEV_TYPE_OUI); ++ p2pielen += 4; ++ ++ RTW_PUT_BE16(p2pie + p2pielen, P2P_SCID_WIDI_CONSUMER_SINK); ++ p2pielen += 2; ++ } else if (widi_version == 40) { ++ p2pie[p2pielen++] = pmlmepriv->num_p2p_sdt; ++ for (; i < pmlmepriv->num_p2p_sdt; i++) { ++ RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_sdt_cid[i]); ++ p2pielen += 2; ++ ++ RTW_PUT_BE32(p2pie + p2pielen, INTEL_DEV_TYPE_OUI); ++ p2pielen += 4; ++ ++ RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_sdt_scid[i]); ++ p2pielen += 2; ++ } ++ } else ++#endif /* CONFIG_INTEL_WIDI */ ++ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ ++ ++ /* Device Name */ ++ /* Type: */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); */ ++ RTW_PUT_BE16(p2pie + p2pielen, WPS_ATTR_DEVICE_NAME); ++ p2pielen += 2; ++ ++ /* Length: */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); */ ++ RTW_PUT_BE16(p2pie + p2pielen, pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len); ++ p2pielen += pwdinfo->device_name_len; ++ ++ /* Group Info ATTR */ ++ /* Type: */ ++ /* Length: */ ++ /* Value: */ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) ++ p2pielen += go_add_group_info_attr(pwdinfo, p2pie + p2pielen); ++ ++ ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); ++ ++ ++ return len; ++ ++} ++ ++u32 build_prov_disc_request_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 *pssid, u8 ussidlen, u8 *pdev_raddr) ++{ ++ u8 p2pie[MAX_P2P_IE_LEN] = { 0x00 }; ++ u32 len = 0, p2pielen = 0; ++ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* Commented by Albert 20110301 */ ++ /* According to the P2P Specification, the provision discovery request frame should contain 3 P2P attributes */ ++ /* 1. P2P Capability */ ++ /* 2. Device Info */ ++ /* 3. Group ID ( When joining an operating P2P Group ) */ ++ ++ /* P2P Capability ATTR */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; ++ ++ /* Length: */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); */ ++ RTW_PUT_LE16(p2pie + p2pielen, 0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Device Capability Bitmap, 1 byte */ ++ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; ++ ++ /* Group Capability Bitmap, 1 byte */ ++ if (pwdinfo->persistent_supported) ++ p2pie[p2pielen++] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; ++ else ++ p2pie[p2pielen++] = DMP_P2P_GRPCAP_SUPPORT; ++ ++ ++ /* Device Info ATTR */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ ++ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); */ ++ RTW_PUT_LE16(p2pie + p2pielen, 21 + pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* P2P Device Address */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ /* Config Method */ ++ /* This field should be big endian. Noted by P2P specification. */ ++ if (pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PBC) { ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_PBC ); */ ++ RTW_PUT_BE16(p2pie + p2pielen, WPS_CONFIG_METHOD_PBC); ++ } else { ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_DISPLAY ); */ ++ RTW_PUT_BE16(p2pie + p2pielen, WPS_CONFIG_METHOD_DISPLAY); ++ } ++ ++ p2pielen += 2; ++ ++ /* Primary Device Type */ ++ /* Category ID */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); */ ++ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_CID_MULIT_MEDIA); ++ p2pielen += 2; ++ ++ /* OUI */ ++ /* *(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); */ ++ RTW_PUT_BE32(p2pie + p2pielen, WPSOUI); ++ p2pielen += 4; ++ ++ /* Sub Category ID */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); */ ++ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_SCID_MEDIA_SERVER); ++ p2pielen += 2; ++ ++ /* Number of Secondary Device Types */ ++ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ ++ ++ /* Device Name */ ++ /* Type: */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); */ ++ RTW_PUT_BE16(p2pie + p2pielen, WPS_ATTR_DEVICE_NAME); ++ p2pielen += 2; ++ ++ /* Length: */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); */ ++ RTW_PUT_BE16(p2pie + p2pielen, pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len); ++ p2pielen += pwdinfo->device_name_len; ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) { ++ /* Added by Albert 2011/05/19 */ ++ /* In this case, the pdev_raddr is the device address of the group owner. */ ++ ++ /* P2P Group ID ATTR */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_GROUP_ID; ++ ++ /* Length: */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN + ussidlen ); */ ++ RTW_PUT_LE16(p2pie + p2pielen, ETH_ALEN + ussidlen); ++ p2pielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(p2pie + p2pielen, pdev_raddr, ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ _rtw_memcpy(p2pie + p2pielen, pssid, ussidlen); ++ p2pielen += ussidlen; ++ ++ } ++ ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); ++ ++ ++ return len; ++ ++} ++ ++ ++u32 build_assoc_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 status_code) ++{ ++ u8 p2pie[MAX_P2P_IE_LEN] = { 0x00 }; ++ u32 len = 0, p2pielen = 0; ++ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* According to the P2P Specification, the Association response frame should contain 2 P2P attributes */ ++ /* 1. Status */ ++ /* 2. Extended Listen Timing (optional) */ ++ ++ ++ /* Status ATTR */ ++ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_STATUS, 1, &status_code); ++ ++ ++ /* Extended Listen Timing ATTR */ ++ /* Type: */ ++ /* Length: */ ++ /* Value: */ ++ ++ ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); ++ ++ return len; ++ ++} ++ ++u32 build_deauth_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u32 len = 0; ++ ++ return len; ++} ++ ++u32 process_probe_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) ++{ ++ u8 *p; ++ u32 ret = _FALSE; ++ u8 *p2pie; ++ u32 p2pielen = 0; ++ int ssid_len = 0, rate_cnt = 0; ++ ++ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _SUPPORTEDRATES_IE_, (int *)&rate_cnt, ++ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); ++ ++ if (rate_cnt <= 4) { ++ int i, g_rate = 0; ++ ++ for (i = 0; i < rate_cnt; i++) { ++ if (((*(p + 2 + i) & 0xff) != 0x02) && ++ ((*(p + 2 + i) & 0xff) != 0x04) && ++ ((*(p + 2 + i) & 0xff) != 0x0B) && ++ ((*(p + 2 + i) & 0xff) != 0x16)) ++ g_rate = 1; ++ } ++ ++ if (g_rate == 0) { ++ /* There is no OFDM rate included in SupportedRates IE of this probe request frame */ ++ /* The driver should response this probe request. */ ++ return ret; ++ } ++ } else { ++ /* rate_cnt > 4 means the SupportRates IE contains the OFDM rate because the count of CCK rates are 4. */ ++ /* We should proceed the following check for this probe request. */ ++ } ++ ++ /* Added comments by Albert 20100906 */ ++ /* There are several items we should check here. */ ++ /* 1. This probe request frame must contain the P2P IE. (Done) */ ++ /* 2. This probe request frame must contain the wildcard SSID. (Done) */ ++ /* 3. Wildcard BSSID. (Todo) */ ++ /* 4. Destination Address. ( Done in mgt_dispatcher function ) */ ++ /* 5. Requested Device Type in WSC IE. (Todo) */ ++ /* 6. Device ID attribute in P2P IE. (Todo) */ ++ ++ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _SSID_IE_, (int *)&ssid_len, ++ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); ++ ++ ssid_len &= 0xff; /* Just last 1 byte is valid for ssid len of the probe request */ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ p2pie = rtw_get_p2p_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_ , len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_ , NULL, &p2pielen); ++ if (p2pie) { ++ if ((p != NULL) && _rtw_memcmp((void *)(p + 2), (void *) pwdinfo->p2p_wildcard_ssid , 7)) { ++ /* todo: */ ++ /* Check Requested Device Type attributes in WSC IE. */ ++ /* Check Device ID attribute in P2P IE */ ++ ++ ret = _TRUE; ++ } else if ((p != NULL) && (ssid_len == 0)) ++ ret = _TRUE; ++ } else { ++ /* non -p2p device */ ++ } ++ ++ } ++ ++ ++ return ret; ++ ++} ++ ++u32 process_assoc_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len, struct sta_info *psta) ++{ ++ u8 status_code = P2P_STATUS_SUCCESS; ++ u8 *pbuf, *pattr_content = NULL; ++ u32 attr_contentlen = 0; ++ u16 cap_attr = 0; ++ unsigned short frame_type, ie_offset = 0; ++ u8 *ies; ++ u32 ies_len; ++ u8 *p2p_ie; ++ u32 p2p_ielen = 0; ++ ++ if (!rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) ++ return P2P_STATUS_FAIL_REQUEST_UNABLE; ++ ++ frame_type = GetFrameSubType(pframe); ++ if (frame_type == WIFI_ASSOCREQ) ++ ie_offset = _ASOCREQ_IE_OFFSET_; ++ else /* WIFI_REASSOCREQ */ ++ ie_offset = _REASOCREQ_IE_OFFSET_; ++ ++ ies = pframe + WLAN_HDR_A3_LEN + ie_offset; ++ ies_len = len - WLAN_HDR_A3_LEN - ie_offset; ++ ++ p2p_ie = rtw_get_p2p_ie(ies , ies_len , NULL, &p2p_ielen); ++ ++ if (!p2p_ie) { ++ RTW_INFO("[%s] P2P IE not Found!!\n", __FUNCTION__); ++ status_code = P2P_STATUS_FAIL_INVALID_PARAM; ++ } else ++ RTW_INFO("[%s] P2P IE Found!!\n", __FUNCTION__); ++ ++ while (p2p_ie) { ++ /* Check P2P Capability ATTR */ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8 *)&cap_attr, (uint *) &attr_contentlen)) { ++ RTW_INFO("[%s] Got P2P Capability Attr!!\n", __FUNCTION__); ++ cap_attr = le16_to_cpu(cap_attr); ++ psta->dev_cap = cap_attr & 0xff; ++ } ++ ++ /* Check Extended Listen Timing ATTR */ ++ ++ ++ /* Check P2P Device Info ATTR */ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO, NULL, (uint *)&attr_contentlen)) { ++ RTW_INFO("[%s] Got P2P DEVICE INFO Attr!!\n", __FUNCTION__); ++ pattr_content = pbuf = rtw_zmalloc(attr_contentlen); ++ if (pattr_content) { ++ u8 num_of_secdev_type; ++ u16 dev_name_len; ++ ++ ++ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO , pattr_content, (uint *)&attr_contentlen); ++ ++ _rtw_memcpy(psta->dev_addr, pattr_content, ETH_ALEN);/* P2P Device Address */ ++ ++ pattr_content += ETH_ALEN; ++ ++ _rtw_memcpy(&psta->config_methods, pattr_content, 2);/* Config Methods */ ++ psta->config_methods = be16_to_cpu(psta->config_methods); ++ ++ pattr_content += 2; ++ ++ _rtw_memcpy(psta->primary_dev_type, pattr_content, 8); ++ ++ pattr_content += 8; ++ ++ num_of_secdev_type = *pattr_content; ++ pattr_content += 1; ++ ++ if (num_of_secdev_type == 0) ++ psta->num_of_secdev_type = 0; ++ else { ++ u32 len; ++ ++ psta->num_of_secdev_type = num_of_secdev_type; ++ ++ len = (sizeof(psta->secdev_types_list) < (num_of_secdev_type * 8)) ? (sizeof(psta->secdev_types_list)) : (num_of_secdev_type * 8); ++ ++ _rtw_memcpy(psta->secdev_types_list, pattr_content, len); ++ ++ pattr_content += (num_of_secdev_type * 8); ++ } ++ ++ ++ /* dev_name_len = attr_contentlen - ETH_ALEN - 2 - 8 - 1 - (num_of_secdev_type*8); */ ++ psta->dev_name_len = 0; ++ if (WPS_ATTR_DEVICE_NAME == be16_to_cpu(*(u16 *)pattr_content)) { ++ dev_name_len = be16_to_cpu(*(u16 *)(pattr_content + 2)); ++ ++ psta->dev_name_len = (sizeof(psta->dev_name) < dev_name_len) ? sizeof(psta->dev_name) : dev_name_len; ++ ++ _rtw_memcpy(psta->dev_name, pattr_content + 4, psta->dev_name_len); ++ } ++ ++ rtw_mfree(pbuf, attr_contentlen); ++ ++ } ++ ++ } ++ ++ /* Get the next P2P IE */ ++ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); ++ ++ } ++ ++ return status_code; ++ ++} ++ ++u32 process_p2p_devdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) ++{ ++ u8 *frame_body; ++ u8 status, dialogToken; ++ struct sta_info *psta = NULL; ++ _adapter *padapter = pwdinfo->padapter; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *p2p_ie; ++ u32 p2p_ielen = 0; ++ ++ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ ++ dialogToken = frame_body[7]; ++ status = P2P_STATUS_FAIL_UNKNOWN_P2PGROUP; ++ ++ p2p_ie = rtw_get_p2p_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen); ++ if (p2p_ie) { ++ u8 groupid[38] = { 0x00 }; ++ u8 dev_addr[ETH_ALEN] = { 0x00 }; ++ u32 attr_contentlen = 0; ++ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, groupid, &attr_contentlen)) { ++ if (_rtw_memcmp(pwdinfo->device_addr, groupid, ETH_ALEN) && ++ _rtw_memcmp(pwdinfo->p2p_group_ssid, groupid + ETH_ALEN, pwdinfo->p2p_group_ssid_len)) { ++ attr_contentlen = 0; ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_ID, dev_addr, &attr_contentlen)) { ++ _irqL irqL; ++ _list *phead, *plist; ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ /* look up sta asoc_queue */ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ ++ plist = get_next(plist); ++ ++ if (psta->is_p2p_device && (psta->dev_cap & P2P_DEVCAP_CLIENT_DISCOVERABILITY) && ++ _rtw_memcmp(psta->dev_addr, dev_addr, ETH_ALEN)) { ++ ++ /* _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); */ ++ /* issue GO Discoverability Request */ ++ issue_group_disc_req(pwdinfo, psta->hwaddr); ++ /* _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); */ ++ ++ status = P2P_STATUS_SUCCESS; ++ ++ break; ++ } else ++ status = P2P_STATUS_FAIL_INFO_UNAVAILABLE; ++ ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ } else ++ status = P2P_STATUS_FAIL_INVALID_PARAM; ++ ++ } else ++ status = P2P_STATUS_FAIL_INVALID_PARAM; ++ ++ } ++ ++ } ++ ++ ++ /* issue Device Discoverability Response */ ++ issue_p2p_devdisc_resp(pwdinfo, GetAddr2Ptr(pframe), status, dialogToken); ++ ++ ++ return (status == P2P_STATUS_SUCCESS) ? _TRUE : _FALSE; ++ ++} ++ ++u32 process_p2p_devdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) ++{ ++ return _TRUE; ++} ++ ++u8 process_p2p_provdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) ++{ ++ u8 *frame_body; ++ u8 *wpsie; ++ uint wps_ielen = 0, attr_contentlen = 0; ++ u16 uconfig_method = 0; ++ ++ ++ frame_body = (pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ ++ wpsie = rtw_get_wps_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &wps_ielen); ++ if (wpsie) { ++ if (rtw_get_wps_attr_content(wpsie, wps_ielen, WPS_ATTR_CONF_METHOD , (u8 *) &uconfig_method, &attr_contentlen)) { ++ uconfig_method = be16_to_cpu(uconfig_method); ++ switch (uconfig_method) { ++ case WPS_CM_DISPLYA: { ++ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "dis", 3); ++ break; ++ } ++ case WPS_CM_LABEL: { ++ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "lab", 3); ++ break; ++ } ++ case WPS_CM_PUSH_BUTTON: { ++ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pbc", 3); ++ break; ++ } ++ case WPS_CM_KEYPAD: { ++ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pad", 3); ++ break; ++ } ++ } ++ issue_p2p_provision_resp(pwdinfo, GetAddr2Ptr(pframe), frame_body, uconfig_method); ++ } ++ } ++ RTW_INFO("[%s] config method = %s\n", __FUNCTION__, pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req); ++ return _TRUE; ++ ++} ++ ++u8 process_p2p_provdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe) ++{ ++ ++ return _TRUE; ++} ++ ++u8 rtw_p2p_get_peer_ch_list(struct wifidirect_info *pwdinfo, u8 *ch_content, u8 ch_cnt, u8 *peer_ch_list) ++{ ++ u8 i = 0, j = 0; ++ u8 temp = 0; ++ u8 ch_no = 0; ++ ch_content += 3; ++ ch_cnt -= 3; ++ ++ while (ch_cnt > 0) { ++ ch_content += 1; ++ ch_cnt -= 1; ++ temp = *ch_content; ++ for (i = 0 ; i < temp ; i++, j++) ++ peer_ch_list[j] = *(ch_content + 1 + i); ++ ch_content += (temp + 1); ++ ch_cnt -= (temp + 1); ++ ch_no += temp ; ++ } ++ ++ return ch_no; ++} ++ ++u8 rtw_p2p_check_peer_oper_ch(struct mlme_ext_priv *pmlmeext, u8 ch) ++{ ++ u8 i = 0; ++ ++ for (i = 0; i < pmlmeext->max_chan_nums; i++) { ++ if (pmlmeext->channel_set[i].ChannelNum == ch) ++ return _SUCCESS; ++ } ++ ++ return _FAIL; ++} ++ ++u8 rtw_p2p_ch_inclusion(struct mlme_ext_priv *pmlmeext, u8 *peer_ch_list, u8 peer_ch_num, u8 *ch_list_inclusioned) ++{ ++ int i = 0, j = 0, temp = 0; ++ u8 ch_no = 0; ++ ++ for (i = 0; i < peer_ch_num; i++) { ++ for (j = temp; j < pmlmeext->max_chan_nums; j++) { ++ if (*(peer_ch_list + i) == pmlmeext->channel_set[j].ChannelNum) { ++ ch_list_inclusioned[ch_no++] = *(peer_ch_list + i); ++ temp = j; ++ break; ++ } ++ } ++ } ++ ++ return ch_no; ++} ++ ++u8 process_p2p_group_negotation_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) ++{ ++ _adapter *padapter = pwdinfo->padapter; ++ u8 result = P2P_STATUS_SUCCESS; ++ u32 p2p_ielen = 0, wps_ielen = 0; ++ u8 *ies; ++ u32 ies_len; ++ u8 *p2p_ie; ++ u8 *wpsie; ++ u16 wps_devicepassword_id = 0x0000; ++ uint wps_devicepassword_id_len = 0; ++#ifdef CONFIG_WFD ++#ifdef CONFIG_TDLS ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++#endif /* CONFIG_TDLS */ ++#endif /* CONFIG_WFD */ ++ wpsie = rtw_get_wps_ie(pframe + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &wps_ielen); ++ if (wpsie) { ++ /* Commented by Kurt 20120113 */ ++ /* If some device wants to do p2p handshake without sending prov_disc_req */ ++ /* We have to get peer_req_cm from here. */ ++ if (_rtw_memcmp(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "000", 3)) { ++ rtw_get_wps_attr_content(wpsie, wps_ielen, WPS_ATTR_DEVICE_PWID, (u8 *) &wps_devicepassword_id, &wps_devicepassword_id_len); ++ wps_devicepassword_id = be16_to_cpu(wps_devicepassword_id); ++ ++ if (wps_devicepassword_id == WPS_DPID_USER_SPEC) ++ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "dis", 3); ++ else if (wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC) ++ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pad", 3); ++ else ++ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pbc", 3); ++ } ++ } else { ++ RTW_INFO("[%s] WPS IE not Found!!\n", __FUNCTION__); ++ result = P2P_STATUS_FAIL_INCOMPATIBLE_PARAM; ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); ++ return result ; ++ } ++ ++ ies = pframe + _PUBLIC_ACTION_IE_OFFSET_; ++ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; ++ ++ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); ++ ++ if (!p2p_ie) { ++ RTW_INFO("[%s] P2P IE not Found!!\n", __FUNCTION__); ++ result = P2P_STATUS_FAIL_INCOMPATIBLE_PARAM; ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); ++ } ++ ++ while (p2p_ie) { ++ u8 attr_content = 0x00; ++ u32 attr_contentlen = 0; ++ u8 ch_content[100] = { 0x00 }; ++ uint ch_cnt = 0; ++ u8 peer_ch_list[100] = { 0x00 }; ++ u8 peer_ch_num = 0; ++ u8 ch_list_inclusioned[100] = { 0x00 }; ++ u8 ch_num_inclusioned = 0; ++ u16 cap_attr; ++ u8 listen_ch_attr[5] = { 0x00 }; ++ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_ING); ++ ++ /* Check P2P Capability ATTR */ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8 *)&cap_attr, (uint *)&attr_contentlen)) { ++ cap_attr = le16_to_cpu(cap_attr); ++ ++#if defined(CONFIG_WFD) && defined(CONFIG_TDLS) ++ if (!(cap_attr & P2P_GRPCAP_INTRABSS)) ++ ptdlsinfo->ap_prohibited = _TRUE; ++#endif /* defined(CONFIG_WFD) && defined(CONFIG_TDLS) */ ++ } ++ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GO_INTENT , &attr_content, &attr_contentlen)) { ++ RTW_INFO("[%s] GO Intent = %d, tie = %d\n", __FUNCTION__, attr_content >> 1, attr_content & 0x01); ++ pwdinfo->peer_intent = attr_content; /* include both intent and tie breaker values. */ ++ ++ if (pwdinfo->intent == (pwdinfo->peer_intent >> 1)) { ++ /* Try to match the tie breaker value */ ++ if (pwdinfo->intent == P2P_MAX_INTENT) { ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ result = P2P_STATUS_FAIL_BOTH_GOINTENT_15; ++ } else { ++ if (attr_content & 0x01) ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++ else ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); ++ } ++ } else if (pwdinfo->intent > (pwdinfo->peer_intent >> 1)) ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); ++ else ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ /* Store the group id information. */ ++ _rtw_memcpy(pwdinfo->groupid_info.go_device_addr, pwdinfo->device_addr, ETH_ALEN); ++ _rtw_memcpy(pwdinfo->groupid_info.ssid, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen); ++ } ++ } ++ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_LISTEN_CH, (u8 *)listen_ch_attr, (uint *) &attr_contentlen) && attr_contentlen == 5) ++ pwdinfo->nego_req_info.peer_ch = listen_ch_attr[4]; ++ ++ RTW_INFO(FUNC_ADPT_FMT" listen channel :%u\n", FUNC_ADPT_ARG(padapter), pwdinfo->nego_req_info.peer_ch); ++ ++ attr_contentlen = 0; ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_INTENDED_IF_ADDR, pwdinfo->p2p_peer_interface_addr, &attr_contentlen)) { ++ if (attr_contentlen != ETH_ALEN) ++ _rtw_memset(pwdinfo->p2p_peer_interface_addr, 0x00, ETH_ALEN); ++ } ++ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, ch_content, &ch_cnt)) { ++ peer_ch_num = rtw_p2p_get_peer_ch_list(pwdinfo, ch_content, ch_cnt, peer_ch_list); ++ ch_num_inclusioned = rtw_p2p_ch_inclusion(&padapter->mlmeextpriv, peer_ch_list, peer_ch_num, ch_list_inclusioned); ++ ++ if (ch_num_inclusioned == 0) { ++ RTW_INFO("[%s] No common channel in channel list!\n", __FUNCTION__); ++ result = P2P_STATUS_FAIL_NO_COMMON_CH; ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); ++ break; ++ } ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ if (!rtw_p2p_is_channel_list_ok(pwdinfo->operating_channel, ++ ch_list_inclusioned, ch_num_inclusioned)) { ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED) ++ && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { ++ RTW_INFO("[%s] desired channel NOT Found!\n", __FUNCTION__); ++ result = P2P_STATUS_FAIL_NO_COMMON_CH; ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); ++ break; ++ } else ++#endif /* CONFIG_CONCURRENT_MODE */ ++ { ++ u8 operatingch_info[5] = { 0x00 }, peer_operating_ch = 0; ++ attr_contentlen = 0; ++ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen)) ++ peer_operating_ch = operatingch_info[4]; ++ ++ if (rtw_p2p_is_channel_list_ok(peer_operating_ch, ++ ch_list_inclusioned, ch_num_inclusioned)) { ++ /** ++ * Change our operating channel as peer's for compatibility. ++ */ ++ pwdinfo->operating_channel = peer_operating_ch; ++ RTW_INFO("[%s] Change op ch to %02x as peer's\n", __FUNCTION__, pwdinfo->operating_channel); ++ } else { ++ /* Take first channel of ch_list_inclusioned as operating channel */ ++ pwdinfo->operating_channel = ch_list_inclusioned[0]; ++ RTW_INFO("[%s] Change op ch to %02x\n", __FUNCTION__, pwdinfo->operating_channel); ++ } ++ } ++ ++ } ++ } ++ } ++ ++ /* Get the next P2P IE */ ++ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); ++ } ++ ++ if (pwdinfo->ui_got_wps_info == P2P_NO_WPSINFO) { ++ result = P2P_STATUS_FAIL_INFO_UNAVAILABLE; ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_INFOR_NOREADY); ++ return result; ++ } ++ ++#ifdef CONFIG_WFD ++ rtw_process_wfd_ies(padapter, pframe + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, __func__); ++#endif ++ ++ return result ; ++} ++ ++u8 process_p2p_group_negotation_resp(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) ++{ ++ _adapter *padapter = pwdinfo->padapter; ++ u8 result = P2P_STATUS_SUCCESS; ++ u32 p2p_ielen, wps_ielen; ++ u8 *ies; ++ u32 ies_len; ++ u8 *p2p_ie; ++#ifdef CONFIG_WFD ++#ifdef CONFIG_TDLS ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++#endif /* CONFIG_TDLS */ ++#endif /* CONFIG_WFD */ ++ ++ ies = pframe + _PUBLIC_ACTION_IE_OFFSET_; ++ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; ++ ++ /* Be able to know which one is the P2P GO and which one is P2P client. */ ++ ++ if (rtw_get_wps_ie(ies, ies_len, NULL, &wps_ielen)) { ++ ++ } else { ++ RTW_INFO("[%s] WPS IE not Found!!\n", __FUNCTION__); ++ result = P2P_STATUS_FAIL_INCOMPATIBLE_PARAM; ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); ++ } ++ ++ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); ++ if (!p2p_ie) { ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); ++ result = P2P_STATUS_FAIL_INCOMPATIBLE_PARAM; ++ } else { ++ ++ u8 attr_content = 0x00; ++ u32 attr_contentlen = 0; ++ u8 operatingch_info[5] = { 0x00 }; ++ uint ch_cnt = 0; ++ u8 ch_content[100] = { 0x00 }; ++ u8 groupid[38]; ++ u16 cap_attr; ++ u8 peer_ch_list[100] = { 0x00 }; ++ u8 peer_ch_num = 0; ++ u8 ch_list_inclusioned[100] = { 0x00 }; ++ u8 ch_num_inclusioned = 0; ++ ++ while (p2p_ie) { /* Found the P2P IE. */ ++ ++ /* Check P2P Capability ATTR */ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8 *)&cap_attr, (uint *)&attr_contentlen)) { ++ cap_attr = le16_to_cpu(cap_attr); ++#ifdef CONFIG_TDLS ++ if (!(cap_attr & P2P_GRPCAP_INTRABSS)) ++ ptdlsinfo->ap_prohibited = _TRUE; ++#endif /* CONFIG_TDLS */ ++ } ++ ++ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, &attr_content, &attr_contentlen); ++ if (attr_contentlen == 1) { ++ RTW_INFO("[%s] Status = %d\n", __FUNCTION__, attr_content); ++ if (attr_content == P2P_STATUS_SUCCESS) { ++ /* Do nothing. */ ++ } else { ++ if (P2P_STATUS_FAIL_INFO_UNAVAILABLE == attr_content) ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_INFOR_NOREADY); ++ else ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ result = attr_content; ++ break; ++ } ++ } ++ ++ /* Try to get the peer's interface address */ ++ attr_contentlen = 0; ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_INTENDED_IF_ADDR, pwdinfo->p2p_peer_interface_addr, &attr_contentlen)) { ++ if (attr_contentlen != ETH_ALEN) ++ _rtw_memset(pwdinfo->p2p_peer_interface_addr, 0x00, ETH_ALEN); ++ } ++ ++ /* Try to get the peer's intent and tie breaker value. */ ++ attr_content = 0x00; ++ attr_contentlen = 0; ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GO_INTENT , &attr_content, &attr_contentlen)) { ++ RTW_INFO("[%s] GO Intent = %d, tie = %d\n", __FUNCTION__, attr_content >> 1, attr_content & 0x01); ++ pwdinfo->peer_intent = attr_content; /* include both intent and tie breaker values. */ ++ ++ if (pwdinfo->intent == (pwdinfo->peer_intent >> 1)) { ++ /* Try to match the tie breaker value */ ++ if (pwdinfo->intent == P2P_MAX_INTENT) { ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ result = P2P_STATUS_FAIL_BOTH_GOINTENT_15; ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); ++ } else { ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ if (attr_content & 0x01) ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++ else ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); ++ } ++ } else if (pwdinfo->intent > (pwdinfo->peer_intent >> 1)) { ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); ++ } else { ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++ } ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ /* Store the group id information. */ ++ _rtw_memcpy(pwdinfo->groupid_info.go_device_addr, pwdinfo->device_addr, ETH_ALEN); ++ _rtw_memcpy(pwdinfo->groupid_info.ssid, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen); ++ ++ } ++ } ++ ++ /* Try to get the operation channel information */ ++ ++ attr_contentlen = 0; ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen)) { ++ RTW_INFO("[%s] Peer's operating channel = %d\n", __FUNCTION__, operatingch_info[4]); ++ pwdinfo->peer_operating_ch = operatingch_info[4]; ++ } ++ ++ /* Try to get the channel list information */ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, pwdinfo->channel_list_attr, &pwdinfo->channel_list_attr_len)) { ++ RTW_INFO("[%s] channel list attribute found, len = %d\n", __FUNCTION__, pwdinfo->channel_list_attr_len); ++ ++ peer_ch_num = rtw_p2p_get_peer_ch_list(pwdinfo, pwdinfo->channel_list_attr, pwdinfo->channel_list_attr_len, peer_ch_list); ++ ch_num_inclusioned = rtw_p2p_ch_inclusion(&padapter->mlmeextpriv, peer_ch_list, peer_ch_num, ch_list_inclusioned); ++ ++ if (ch_num_inclusioned == 0) { ++ RTW_INFO("[%s] No common channel in channel list!\n", __FUNCTION__); ++ result = P2P_STATUS_FAIL_NO_COMMON_CH; ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); ++ break; ++ } ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ if (!rtw_p2p_is_channel_list_ok(pwdinfo->operating_channel, ++ ch_list_inclusioned, ch_num_inclusioned)) { ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED) ++ && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { ++ RTW_INFO("[%s] desired channel NOT Found!\n", __FUNCTION__); ++ result = P2P_STATUS_FAIL_NO_COMMON_CH; ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); ++ break; ++ } else ++#endif /* CONFIG_CONCURRENT_MODE */ ++ { ++ u8 operatingch_info[5] = { 0x00 }, peer_operating_ch = 0; ++ attr_contentlen = 0; ++ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen)) ++ peer_operating_ch = operatingch_info[4]; ++ ++ if (rtw_p2p_is_channel_list_ok(peer_operating_ch, ++ ch_list_inclusioned, ch_num_inclusioned)) { ++ /** ++ * Change our operating channel as peer's for compatibility. ++ */ ++ pwdinfo->operating_channel = peer_operating_ch; ++ RTW_INFO("[%s] Change op ch to %02x as peer's\n", __FUNCTION__, pwdinfo->operating_channel); ++ } else { ++ /* Take first channel of ch_list_inclusioned as operating channel */ ++ pwdinfo->operating_channel = ch_list_inclusioned[0]; ++ RTW_INFO("[%s] Change op ch to %02x\n", __FUNCTION__, pwdinfo->operating_channel); ++ } ++ } ++ ++ } ++ } ++ ++ } else ++ RTW_INFO("[%s] channel list attribute not found!\n", __FUNCTION__); ++ ++ /* Try to get the group id information if peer is GO */ ++ attr_contentlen = 0; ++ _rtw_memset(groupid, 0x00, 38); ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, groupid, &attr_contentlen)) { ++ _rtw_memcpy(pwdinfo->groupid_info.go_device_addr, &groupid[0], ETH_ALEN); ++ _rtw_memcpy(pwdinfo->groupid_info.ssid, &groupid[6], attr_contentlen - ETH_ALEN); ++ } ++ ++ /* Get the next P2P IE */ ++ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); ++ } ++ ++ } ++ ++#ifdef CONFIG_WFD ++ rtw_process_wfd_ies(padapter, pframe + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, __func__); ++#endif ++ ++ return result ; ++ ++} ++ ++u8 process_p2p_group_negotation_confirm(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) ++{ ++ _adapter *padapter = pwdinfo->padapter; ++ u8 *ies; ++ u32 ies_len; ++ u8 *p2p_ie; ++ u32 p2p_ielen = 0; ++ u8 result = P2P_STATUS_SUCCESS; ++ ies = pframe + _PUBLIC_ACTION_IE_OFFSET_; ++ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; ++ ++ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); ++ while (p2p_ie) { /* Found the P2P IE. */ ++ u8 attr_content = 0x00, operatingch_info[5] = { 0x00 }; ++ u8 groupid[38] = { 0x00 }; ++ u32 attr_contentlen = 0; ++ ++ pwdinfo->negotiation_dialog_token = 1; ++ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, &attr_content, &attr_contentlen); ++ if (attr_contentlen == 1) { ++ RTW_INFO("[%s] Status = %d\n", __FUNCTION__, attr_content); ++ result = attr_content; ++ ++ if (attr_content == P2P_STATUS_SUCCESS) { ++ u8 bcancelled = 0; ++ ++ _cancel_timer(&pwdinfo->restore_p2p_state_timer, &bcancelled); ++ ++ /* Commented by Albert 20100911 */ ++ /* Todo: Need to handle the case which both Intents are the same. */ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ if ((pwdinfo->intent) > (pwdinfo->peer_intent >> 1)) ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); ++ else if ((pwdinfo->intent) < (pwdinfo->peer_intent >> 1)) ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++ else { ++ /* Have to compare the Tie Breaker */ ++ if (pwdinfo->peer_intent & 0x01) ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++ else ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED) ++ && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { ++ /* Switch back to the AP channel soon. */ ++ _set_timer(&pwdinfo->ap_p2p_switch_timer, 100); ++ } ++#endif ++ } else { ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); ++ break; ++ } ++ } ++ ++ /* Try to get the group id information */ ++ attr_contentlen = 0; ++ _rtw_memset(groupid, 0x00, 38); ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, groupid, &attr_contentlen)) { ++ RTW_INFO("[%s] Ssid = %s, ssidlen = %zu\n", __FUNCTION__, &groupid[ETH_ALEN], strlen(&groupid[ETH_ALEN])); ++ _rtw_memcpy(pwdinfo->groupid_info.go_device_addr, &groupid[0], ETH_ALEN); ++ _rtw_memcpy(pwdinfo->groupid_info.ssid, &groupid[6], attr_contentlen - ETH_ALEN); ++ } ++ ++ attr_contentlen = 0; ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen)) { ++ RTW_INFO("[%s] Peer's operating channel = %d\n", __FUNCTION__, operatingch_info[4]); ++ pwdinfo->peer_operating_ch = operatingch_info[4]; ++ } ++ ++ /* Get the next P2P IE */ ++ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); ++ ++ } ++ ++ return result ; ++} ++ ++u8 process_p2p_presence_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) ++{ ++ u8 *frame_body; ++ u8 dialogToken = 0; ++ u8 status = P2P_STATUS_SUCCESS; ++ ++ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ ++ dialogToken = frame_body[6]; ++ ++ /* todo: check NoA attribute */ ++ ++ issue_p2p_presence_resp(pwdinfo, GetAddr2Ptr(pframe), status, dialogToken); ++ ++ return _TRUE; ++} ++ ++void find_phase_handler(_adapter *padapter) ++{ ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ NDIS_802_11_SSID ssid; ++ _irqL irqL; ++ u8 _status = 0; ++ ++ ++ _rtw_memset((unsigned char *)&ssid, 0, sizeof(NDIS_802_11_SSID)); ++ _rtw_memcpy(ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN); ++ ssid.SsidLength = P2P_WILDCARD_SSID_LEN; ++ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ _status = rtw_sitesurvey_cmd(padapter, &ssid, 1, NULL, 0); ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ ++} ++ ++void p2p_concurrent_handler(_adapter *padapter); ++ ++void restore_p2p_state_handler(_adapter *padapter) ++{ ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL)) ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) { ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ u8 union_bw = rtw_mi_get_union_bw(padapter); ++ u8 union_offset = rtw_mi_get_union_offset(padapter); ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_RSP)) { ++ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); ++ rtw_mi_buddy_issue_nulldata(padapter, NULL, 0, 3, 500); ++ } ++ } ++#endif ++ ++ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE)) { ++#ifdef CONFIG_CONCURRENT_MODE ++ p2p_concurrent_handler(padapter); ++#else ++ /* In the P2P client mode, the driver should not switch back to its listen channel */ ++ /* because this P2P client should stay at the operating channel of P2P GO. */ ++ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++#endif ++ } ++} ++ ++void pre_tx_invitereq_handler(_adapter *padapter) ++{ ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ u8 val8 = 1; ++ ++ set_channel_bwmode(padapter, pwdinfo->invitereq_info.peer_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ issue_probereq_p2p(padapter, NULL); ++ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); ++ ++} ++ ++void pre_tx_provdisc_handler(_adapter *padapter) ++{ ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ u8 val8 = 1; ++ ++ set_channel_bwmode(padapter, pwdinfo->tx_prov_disc_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ issue_probereq_p2p(padapter, NULL); ++ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); ++ ++} ++ ++void pre_tx_negoreq_handler(_adapter *padapter) ++{ ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ u8 val8 = 1; ++ ++ set_channel_bwmode(padapter, pwdinfo->nego_req_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ issue_probereq_p2p(padapter , NULL); ++ /* WIN Phone only accept unicast probe request when nego back */ ++ issue_probereq_p2p(padapter , pwdinfo->nego_req_info.peerDevAddr); ++ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); ++ ++} ++ ++#ifdef CONFIG_CONCURRENT_MODE ++void p2p_concurrent_handler(_adapter *padapter) ++{ ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 val8; ++ ++ if (rtw_mi_check_status(padapter, MI_LINKED)) { ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ u8 union_bw = rtw_mi_get_union_bw(padapter); ++ u8 union_offset = rtw_mi_get_union_offset(padapter); ++ ++ pwdinfo->operating_channel = union_ch; ++ ++ if (pwdinfo->driver_interface == DRIVER_CFG80211) { ++ RTW_INFO("%s, switch ch back to union_ch=%d\n", __func__, union_ch); ++ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); ++ ++ rtw_mi_buddy_issue_nulldata(padapter, NULL, 0, 3, 500); ++ ++ } else if (pwdinfo->driver_interface == DRIVER_WEXT) { ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) { ++ /* Now, the driver stays on the AP's channel. */ ++ /* If the pwdinfo->ext_listen_period = 0, that means the P2P listen state is not available on listen channel. */ ++ if (pwdinfo->ext_listen_period > 0) { ++ RTW_INFO("[%s] P2P_STATE_IDLE, ext_listen_period = %d\n", __FUNCTION__, pwdinfo->ext_listen_period); ++ ++ if (union_ch != pwdinfo->listen_channel) { ++ /* Will switch to listen channel so that need to send the NULL data with PW bit to AP. */ ++ rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); ++ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ } ++ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); ++ ++ if (!rtw_mi_check_mlmeinfo_state(padapter, WIFI_FW_AP_STATE)) { ++ val8 = 1; ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ } ++ /* Todo: To check the value of pwdinfo->ext_listen_period is equal to 0 or not. */ ++ _set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_period); ++ } ++ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) || ++ rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL) || ++ (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) && pwdinfo->nego_req_info.benable == _FALSE) || ++ rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ)) { ++ /* Now, the driver is in the listen state of P2P mode. */ ++ RTW_INFO("[%s] P2P_STATE_IDLE, ext_listen_interval = %d\n", __FUNCTION__, pwdinfo->ext_listen_interval); ++ ++ /* Commented by Albert 2012/11/01 */ ++ /* If the AP's channel is the same as the listen channel, we should still be in the listen state */ ++ /* Other P2P device is still able to find this device out even this device is in the AP's channel. */ ++ /* So, configure this device to be able to receive the probe request frame and set it to listen state. */ ++ if (union_ch != pwdinfo->listen_channel) { ++ ++ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); ++ if (!rtw_mi_check_status(padapter, MI_AP_MODE)) { ++ val8 = 0; ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ } ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_IDLE); ++ rtw_mi_buddy_issue_nulldata(padapter, NULL, 0, 3, 500); ++ } ++ ++ /* Todo: To check the value of pwdinfo->ext_listen_interval is equal to 0 or not. */ ++ _set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_interval); ++ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_OK)) { ++ /* The driver had finished the P2P handshake successfully. */ ++ val8 = 0; ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); ++ rtw_mi_buddy_issue_nulldata(padapter, NULL, 0, 3, 500); ++ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) { ++ val8 = 1; ++ set_channel_bwmode(padapter, pwdinfo->tx_prov_disc_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ issue_probereq_p2p(padapter, NULL); ++ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); ++ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) && pwdinfo->nego_req_info.benable == _TRUE) { ++ val8 = 1; ++ set_channel_bwmode(padapter, pwdinfo->nego_req_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ issue_probereq_p2p(padapter, NULL); ++ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); ++ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ) && pwdinfo->invitereq_info.benable == _TRUE) { ++ /* ++ val8 = 1; ++ set_channel_bwmode(padapter, , HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ issue_probereq_p2p(padapter, NULL); ++ _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); ++ */ ++ } ++ } ++ } else { ++ /* In p2p+softap. When in P2P_STATE_GONEGO_OK, not back to listen channel.*/ ++ if (!rtw_p2p_chk_state(pwdinfo , P2P_STATE_GONEGO_OK) || padapter->registrypriv.full_ch_in_p2p_handshake == 0) ++ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ else ++ RTW_INFO("%s, buddy not linked, go nego ok, not back to listen channel\n", __func__); ++ } ++ ++} ++#endif ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++static int ro_ch_handler(_adapter *adapter, u8 *buf) ++{ ++ /* TODO: move remain on channel logical here */ ++ return H2C_SUCCESS; ++} ++ ++static int cancel_ro_ch_handler(_adapter *padapter, u8 *buf) ++{ ++ int ret = H2C_SUCCESS; ++ struct p2p_roch_parm *roch_parm = (struct p2p_roch_parm *)buf; ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); ++ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; ++ struct wireless_dev *wdev; ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ u8 ch, bw, offset; ++ ++ _enter_critical_mutex(&pwdev_priv->roch_mutex, NULL); ++ ++ if (rtw_cfg80211_get_is_roch(padapter) != _TRUE) ++ goto exit; ++ ++ if (roch_parm->wdev && roch_parm->cookie) { ++ if (pcfg80211_wdinfo->ro_ch_wdev != roch_parm->wdev) { ++ RTW_WARN(FUNC_ADPT_FMT" ongoing wdev:%p, wdev:%p\n" ++ , FUNC_ADPT_ARG(padapter), pcfg80211_wdinfo->ro_ch_wdev, roch_parm->wdev); ++ rtw_warn_on(1); ++ } ++ ++ if (pcfg80211_wdinfo->remain_on_ch_cookie != roch_parm->cookie) { ++ RTW_WARN(FUNC_ADPT_FMT" ongoing cookie:0x%llx, cookie:0x%llx\n" ++ , FUNC_ADPT_ARG(padapter), pcfg80211_wdinfo->remain_on_ch_cookie, roch_parm->cookie); ++ rtw_warn_on(1); ++ } ++ } ++ ++ if (rtw_mi_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", ++ FUNC_ADPT_ARG(padapter), ch, bw, offset); ++ } else if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->listen_channel) { ++ ch = pwdinfo->listen_channel; ++ bw = CHANNEL_WIDTH_20; ++ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" back to listen ch - ch:%u, bw:%u, offset:%u\n", ++ FUNC_ADPT_ARG(padapter), ch, bw, offset); ++ } else { ++ ch = pcfg80211_wdinfo->restore_channel; ++ bw = CHANNEL_WIDTH_20; ++ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" back to restore ch - ch:%u, bw:%u, offset:%u\n", ++ FUNC_ADPT_ARG(padapter), ch, bw, offset); ++ } ++ ++ set_channel_bwmode(padapter, ch, offset, bw); ++ ++ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); ++#endif ++ ++ wdev = pcfg80211_wdinfo->ro_ch_wdev; ++ ++ rtw_cfg80211_set_is_roch(padapter, _FALSE); ++ pcfg80211_wdinfo->ro_ch_wdev = NULL; ++ pcfg80211_wdinfo->last_ro_ch_time = rtw_get_current_time(); ++ ++ rtw_cfg80211_remain_on_channel_expired(wdev ++ , pcfg80211_wdinfo->remain_on_ch_cookie ++ , &pcfg80211_wdinfo->remain_on_ch_channel ++ , pcfg80211_wdinfo->remain_on_ch_type, GFP_KERNEL); ++ ++ RTW_INFO("cfg80211_remain_on_channel_expired cookie:0x%llx\n" ++ , pcfg80211_wdinfo->remain_on_ch_cookie); ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_ScanNotify(padapter, _FALSE); ++#endif ++ ++exit: ++ _exit_critical_mutex(&pwdev_priv->roch_mutex, NULL); ++ ++ return ret; ++} ++ ++static void ro_ch_timer_process(void *FunctionContext) ++{ ++ _adapter *adapter = (_adapter *)FunctionContext; ++ ++ p2p_cancel_roch_cmd(adapter, 0, NULL, 0); ++} ++ ++static void rtw_change_p2pie_op_ch(_adapter *padapter, const u8 *frame_body, u32 len, u8 ch) ++{ ++ u8 *ies, *p2p_ie; ++ u32 ies_len, p2p_ielen; ++ ++ ies = (u8 *)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); ++ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; ++ ++ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); ++ ++ while (p2p_ie) { ++ u32 attr_contentlen = 0; ++ u8 *pattr = NULL; ++ ++ /* Check P2P_ATTR_OPERATING_CH */ ++ attr_contentlen = 0; ++ pattr = NULL; ++ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, (uint *)&attr_contentlen); ++ if (pattr != NULL) ++ *(pattr + 4) = ch; ++ ++ /* Get the next P2P IE */ ++ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); ++ } ++} ++ ++static void rtw_change_p2pie_ch_list(_adapter *padapter, const u8 *frame_body, u32 len, u8 ch) ++{ ++ u8 *ies, *p2p_ie; ++ u32 ies_len, p2p_ielen; ++ ++ ies = (u8 *)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); ++ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; ++ ++ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); ++ ++ while (p2p_ie) { ++ u32 attr_contentlen = 0; ++ u8 *pattr = NULL; ++ ++ /* Check P2P_ATTR_CH_LIST */ ++ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, (uint *)&attr_contentlen); ++ if (pattr != NULL) { ++ int i; ++ u32 num_of_ch; ++ u8 *pattr_temp = pattr + 3 ; ++ ++ attr_contentlen -= 3; ++ ++ while (attr_contentlen > 0) { ++ num_of_ch = *(pattr_temp + 1); ++ ++ for (i = 0; i < num_of_ch; i++) ++ *(pattr_temp + 2 + i) = ch; ++ ++ pattr_temp += (2 + num_of_ch); ++ attr_contentlen -= (2 + num_of_ch); ++ } ++ } ++ ++ /* Get the next P2P IE */ ++ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); ++ } ++} ++ ++static bool rtw_chk_p2pie_ch_list_with_buddy(_adapter *padapter, const u8 *frame_body, u32 len) ++{ ++ bool fit = _FALSE; ++#ifdef CONFIG_CONCURRENT_MODE ++ u8 *ies, *p2p_ie; ++ u32 ies_len, p2p_ielen; ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ ++ ies = (u8 *)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); ++ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; ++ ++ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); ++ ++ while (p2p_ie) { ++ u32 attr_contentlen = 0; ++ u8 *pattr = NULL; ++ ++ /* Check P2P_ATTR_CH_LIST */ ++ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, (uint *)&attr_contentlen); ++ if (pattr != NULL) { ++ int i; ++ u32 num_of_ch; ++ u8 *pattr_temp = pattr + 3 ; ++ ++ attr_contentlen -= 3; ++ ++ while (attr_contentlen > 0) { ++ num_of_ch = *(pattr_temp + 1); ++ ++ for (i = 0; i < num_of_ch; i++) { ++ if (*(pattr_temp + 2 + i) == union_ch) { ++ RTW_INFO(FUNC_ADPT_FMT" ch_list fit buddy_ch:%u\n", FUNC_ADPT_ARG(padapter), union_ch); ++ fit = _TRUE; ++ break; ++ } ++ } ++ ++ pattr_temp += (2 + num_of_ch); ++ attr_contentlen -= (2 + num_of_ch); ++ } ++ } ++ ++ /* Get the next P2P IE */ ++ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); ++ } ++#endif ++ return fit; ++} ++ ++static bool rtw_chk_p2pie_op_ch_with_buddy(_adapter *padapter, const u8 *frame_body, u32 len) ++{ ++ bool fit = _FALSE; ++#ifdef CONFIG_CONCURRENT_MODE ++ u8 *ies, *p2p_ie; ++ u32 ies_len, p2p_ielen; ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ ++ ies = (u8 *)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); ++ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; ++ ++ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); ++ ++ while (p2p_ie) { ++ u32 attr_contentlen = 0; ++ u8 *pattr = NULL; ++ ++ /* Check P2P_ATTR_OPERATING_CH */ ++ attr_contentlen = 0; ++ pattr = NULL; ++ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, (uint *)&attr_contentlen); ++ if (pattr != NULL) { ++ if (*(pattr + 4) == union_ch) { ++ RTW_INFO(FUNC_ADPT_FMT" op_ch fit buddy_ch:%u\n", FUNC_ADPT_ARG(padapter), union_ch); ++ fit = _TRUE; ++ break; ++ } ++ } ++ ++ /* Get the next P2P IE */ ++ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); ++ } ++#endif ++ return fit; ++} ++ ++static void rtw_cfg80211_adjust_p2pie_channel(_adapter *padapter, const u8 *frame_body, u32 len) ++{ ++#ifdef CONFIG_CONCURRENT_MODE ++ u8 *ies, *p2p_ie; ++ u32 ies_len, p2p_ielen; ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ ++ ies = (u8 *)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); ++ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; ++ ++ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); ++ ++ while (p2p_ie) { ++ u32 attr_contentlen = 0; ++ u8 *pattr = NULL; ++ ++ /* Check P2P_ATTR_CH_LIST */ ++ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, (uint *)&attr_contentlen); ++ if (pattr != NULL) { ++ int i; ++ u32 num_of_ch; ++ u8 *pattr_temp = pattr + 3 ; ++ ++ attr_contentlen -= 3; ++ ++ while (attr_contentlen > 0) { ++ num_of_ch = *(pattr_temp + 1); ++ ++ for (i = 0; i < num_of_ch; i++) { ++ if (*(pattr_temp + 2 + i) && *(pattr_temp + 2 + i) != union_ch) { ++ #ifdef RTW_SINGLE_WIPHY ++ RTW_ERR("replace ch_list:%u with:%u\n", *(pattr_temp + 2 + i), union_ch); ++ #endif ++ *(pattr_temp + 2 + i) = union_ch; /*forcing to the same channel*/ ++ } ++ } ++ ++ pattr_temp += (2 + num_of_ch); ++ attr_contentlen -= (2 + num_of_ch); ++ } ++ } ++ ++ /* Check P2P_ATTR_OPERATING_CH */ ++ attr_contentlen = 0; ++ pattr = NULL; ++ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, (uint *)&attr_contentlen); ++ if (pattr != NULL) { ++ if (*(pattr + 4) && *(pattr + 4) != union_ch) { ++ #ifdef RTW_SINGLE_WIPHY ++ RTW_ERR("replace op_ch:%u with:%u\n", *(pattr + 4), union_ch); ++ #endif ++ *(pattr + 4) = union_ch; /*forcing to the same channel */ ++ } ++ } ++ ++ /* Get the next P2P IE */ ++ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); ++ ++ } ++ ++#endif ++} ++ ++#ifdef CONFIG_WFD ++u32 rtw_xframe_build_wfd_ie(struct xmit_frame *xframe) ++{ ++ _adapter *adapter = xframe->padapter; ++ struct wifidirect_info *wdinfo = &adapter->wdinfo; ++ u8 *frame = xframe->buf_addr + TXDESC_OFFSET; ++ u8 *frame_body = frame + sizeof(struct rtw_ieee80211_hdr_3addr); ++ u8 *frame_tail = frame + xframe->attrib.pktlen; ++ u8 category, action, OUI_Subtype, dialogToken = 0; ++ u32 wfdielen = 0; ++ ++ category = frame_body[0]; ++ if (category == RTW_WLAN_CATEGORY_PUBLIC) { ++ action = frame_body[1]; ++ if (action == ACT_PUBLIC_VENDOR ++ && _rtw_memcmp(frame_body + 2, P2P_OUI, 4) == _TRUE ++ ) { ++ OUI_Subtype = frame_body[6]; ++ dialogToken = frame_body[7]; ++ ++ switch (OUI_Subtype) { ++ case P2P_GO_NEGO_REQ: ++ wfdielen = build_nego_req_wfd_ie(wdinfo, frame_tail); ++ break; ++ case P2P_GO_NEGO_RESP: ++ wfdielen = build_nego_resp_wfd_ie(wdinfo, frame_tail); ++ break; ++ case P2P_GO_NEGO_CONF: ++ wfdielen = build_nego_confirm_wfd_ie(wdinfo, frame_tail); ++ break; ++ case P2P_INVIT_REQ: ++ wfdielen = build_invitation_req_wfd_ie(wdinfo, frame_tail); ++ break; ++ case P2P_INVIT_RESP: ++ wfdielen = build_invitation_resp_wfd_ie(wdinfo, frame_tail); ++ break; ++ case P2P_PROVISION_DISC_REQ: ++ wfdielen = build_provdisc_req_wfd_ie(wdinfo, frame_tail); ++ break; ++ case P2P_PROVISION_DISC_RESP: ++ wfdielen = build_provdisc_resp_wfd_ie(wdinfo, frame_tail); ++ break; ++ case P2P_DEVDISC_REQ: ++ case P2P_DEVDISC_RESP: ++ default: ++ break; ++ } ++ ++ } ++ } else if (category == RTW_WLAN_CATEGORY_P2P) { ++ OUI_Subtype = frame_body[5]; ++ dialogToken = frame_body[6]; ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("ACTION_CATEGORY_P2P: OUI=0x%x, OUI_Subtype=%d, dialogToken=%d\n" ++ , cpu_to_be32(*((u32 *)(frame_body + 1))), OUI_Subtype, dialogToken); ++#endif ++ ++ switch (OUI_Subtype) { ++ case P2P_NOTICE_OF_ABSENCE: ++ break; ++ case P2P_PRESENCE_REQUEST: ++ break; ++ case P2P_PRESENCE_RESPONSE: ++ break; ++ case P2P_GO_DISC_REQUEST: ++ break; ++ default: ++ break; ++ } ++ } else ++ RTW_INFO("%s, action frame category=%d\n", __func__, category); ++ ++ xframe->attrib.pktlen += wfdielen; ++ ++ return wfdielen; ++} ++#endif /* CONFIG_WFD */ ++ ++bool rtw_xframe_del_wfd_ie(struct xmit_frame *xframe) ++{ ++#define DBG_XFRAME_DEL_WFD_IE 0 ++ ++ _adapter *adapter = xframe->padapter; ++ u8 *frame = xframe->buf_addr + TXDESC_OFFSET; ++ u8 *frame_body = frame + sizeof(struct rtw_ieee80211_hdr_3addr); ++ u8 *frame_tail = frame + xframe->attrib.pktlen; ++ u8 category, action, OUI_Subtype; ++ u8 *ies = NULL; ++ uint ies_len_ori = 0; ++ uint ies_len = 0; ++ ++ category = frame_body[0]; ++ if (category == RTW_WLAN_CATEGORY_PUBLIC) { ++ action = frame_body[1]; ++ if (action == ACT_PUBLIC_VENDOR ++ && _rtw_memcmp(frame_body + 2, P2P_OUI, 4) == _TRUE ++ ) { ++ OUI_Subtype = frame_body[6]; ++ ++ switch (OUI_Subtype) { ++ case P2P_GO_NEGO_REQ: ++ case P2P_GO_NEGO_RESP: ++ case P2P_GO_NEGO_CONF: ++ case P2P_INVIT_REQ: ++ case P2P_INVIT_RESP: ++ case P2P_PROVISION_DISC_REQ: ++ case P2P_PROVISION_DISC_RESP: ++ ies = frame_body + 8; ++ ies_len_ori = frame_tail - (frame_body + 8); ++ break; ++ } ++ } ++ } ++ ++ if (ies && ies_len_ori) { ++ ies_len = rtw_del_wfd_ie(ies, ies_len_ori, DBG_XFRAME_DEL_WFD_IE ? __func__ : NULL); ++ xframe->attrib.pktlen -= (ies_len_ori - ies_len); ++ } ++ ++ return ies_len_ori != ies_len; ++} ++ ++/* ++* rtw_xframe_chk_wfd_ie - ++* ++*/ ++void rtw_xframe_chk_wfd_ie(struct xmit_frame *xframe) ++{ ++ _adapter *adapter = xframe->padapter; ++ u8 *frame = xframe->buf_addr + TXDESC_OFFSET; ++ u8 *frame_body = frame + sizeof(struct rtw_ieee80211_hdr_3addr); ++ u8 *frame_tail = frame + xframe->attrib.pktlen; ++ ++ struct wifidirect_info *wdinfo = &adapter->wdinfo; ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ u8 build = 0; ++ u8 del = 0; ++ ++ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) ++ del = 1; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (_TRUE == wdinfo->wfd_info->wfd_enable) ++#endif ++ del = build = 1; ++ ++ if (del) ++ rtw_xframe_del_wfd_ie(xframe); ++ ++#ifdef CONFIG_WFD ++ if (build) ++ rtw_xframe_build_wfd_ie(xframe); ++#endif ++} ++ ++u8 *dump_p2p_attr_ch_list(u8 *p2p_ie, uint p2p_ielen, u8 *buf, u32 buf_len) ++{ ++ uint attr_contentlen = 0; ++ u8 *pattr = NULL; ++ int w_sz = 0; ++ u8 ch_cnt = 0; ++ u8 ch_list[40]; ++ bool continuous = _FALSE; ++ ++ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, &attr_contentlen); ++ if (pattr != NULL) { ++ int i, j; ++ u32 num_of_ch; ++ u8 *pattr_temp = pattr + 3 ; ++ ++ attr_contentlen -= 3; ++ ++ _rtw_memset(ch_list, 0, 40); ++ ++ while (attr_contentlen > 0) { ++ num_of_ch = *(pattr_temp + 1); ++ ++ for (i = 0; i < num_of_ch; i++) { ++ for (j = 0; j < ch_cnt; j++) { ++ if (ch_list[j] == *(pattr_temp + 2 + i)) ++ break; ++ } ++ if (j >= ch_cnt) ++ ch_list[ch_cnt++] = *(pattr_temp + 2 + i); ++ ++ } ++ ++ pattr_temp += (2 + num_of_ch); ++ attr_contentlen -= (2 + num_of_ch); ++ } ++ ++ for (j = 0; j < ch_cnt; j++) { ++ if (j == 0) ++ w_sz += snprintf(buf + w_sz, buf_len - w_sz, "%u", ch_list[j]); ++ else if (ch_list[j] - ch_list[j - 1] != 1) ++ w_sz += snprintf(buf + w_sz, buf_len - w_sz, ", %u", ch_list[j]); ++ else if (j != ch_cnt - 1 && ch_list[j + 1] - ch_list[j] == 1) { ++ /* empty */ ++ } else ++ w_sz += snprintf(buf + w_sz, buf_len - w_sz, "-%u", ch_list[j]); ++ } ++ } ++ return buf; ++} ++ ++/* ++ * return _TRUE if requester is GO, _FALSE if responder is GO ++ */ ++bool rtw_p2p_nego_intent_compare(u8 req, u8 resp) ++{ ++ if (req >> 1 == resp >> 1) ++ return req & 0x01 ? _TRUE : _FALSE; ++ else if (req >> 1 > resp >> 1) ++ return _TRUE; ++ else ++ return _FALSE; ++} ++ ++int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx) ++{ ++ int is_p2p_frame = (-1); ++ unsigned char *frame_body; ++ u8 category, action, OUI_Subtype, dialogToken = 0; ++ u8 *p2p_ie = NULL; ++ uint p2p_ielen = 0; ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); ++ int status = -1; ++ u8 ch_list_buf[128] = {'\0'}; ++ int op_ch = -1; ++ int listen_ch = -1; ++ u8 intent = 0; ++ u8 *iaddr = NULL; ++ u8 *gbssid = NULL; ++ ++ frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ category = frame_body[0]; ++ /* just for check */ ++ if (category == RTW_WLAN_CATEGORY_PUBLIC) { ++ action = frame_body[1]; ++ if (action == ACT_PUBLIC_VENDOR ++ && _rtw_memcmp(frame_body + 2, P2P_OUI, 4) == _TRUE ++ ) { ++ OUI_Subtype = frame_body[6]; ++ dialogToken = frame_body[7]; ++ is_p2p_frame = OUI_Subtype; ++ ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("ACTION_CATEGORY_PUBLIC: ACT_PUBLIC_VENDOR, OUI=0x%x, OUI_Subtype=%d, dialogToken=%d\n", ++ cpu_to_be32(*((u32 *)(frame_body + 2))), OUI_Subtype, dialogToken); ++ #endif ++ ++ p2p_ie = rtw_get_p2p_ie( ++ (u8 *)buf + sizeof(struct rtw_ieee80211_hdr_3addr) + _PUBLIC_ACTION_IE_OFFSET_ ++ , len - sizeof(struct rtw_ieee80211_hdr_3addr) - _PUBLIC_ACTION_IE_OFFSET_ ++ , NULL, &p2p_ielen); ++ ++ switch (OUI_Subtype) { /* OUI Subtype */ ++ u8 *cont; ++ uint cont_len; ++ case P2P_GO_NEGO_REQ: { ++ struct rtw_wdev_nego_info *nego_info = &pwdev_priv->nego_info; ++ ++ if (tx) { ++ #ifdef CONFIG_DRV_ISSUE_PROV_REQ /* IOT FOR S2 */ ++ if (pwdev_priv->provdisc_req_issued == _FALSE) ++ rtw_cfg80211_issue_p2p_provision_request(padapter, buf, len); ++ #endif /* CONFIG_DRV_ISSUE_PROV_REQ */ ++ ++ /* pwdev_priv->provdisc_req_issued = _FALSE; */ ++ ++ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) ++ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)); ++ #endif ++ } ++ ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len); ++ if (cont) ++ op_ch = *(cont + 4); ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_LISTEN_CH, NULL, &cont_len); ++ if (cont) ++ listen_ch = *(cont + 4); ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GO_INTENT, NULL, &cont_len); ++ if (cont) ++ intent = *cont; ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_INTENDED_IF_ADDR, NULL, &cont_len); ++ if (cont && cont_len == 6) ++ iaddr = cont; ++ ++ if (nego_info->token != dialogToken) ++ rtw_wdev_nego_info_init(nego_info); ++ ++ _rtw_memcpy(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN); ++ if (iaddr) ++ _rtw_memcpy(tx ? nego_info->iface_addr : nego_info->peer_iface_addr, iaddr, ETH_ALEN); ++ nego_info->active = tx ? 1 : 0; ++ nego_info->token = dialogToken; ++ nego_info->req_op_ch = op_ch; ++ nego_info->req_listen_ch = listen_ch; ++ nego_info->req_intent = intent; ++ nego_info->state = 0; ++ ++ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); ++ RTW_INFO("RTW_%s:P2P_GO_NEGO_REQ, dialogToken=%d, intent:%u%s, listen_ch:%d, op_ch:%d, ch_list:%s" ++ , (tx == _TRUE) ? "Tx" : "Rx" , dialogToken , (intent >> 1) , intent & 0x1 ? "+" : "-" , listen_ch , op_ch , ch_list_buf); ++ if (iaddr) ++ _RTW_INFO(", iaddr:"MAC_FMT, MAC_ARG(iaddr)); ++ _RTW_INFO("\n"); ++ ++ if (!tx) { ++ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ if (rtw_mi_check_status(padapter, MI_LINKED) ++ && rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE ++ && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { ++ RTW_INFO(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); ++ rtw_change_p2pie_ch_list(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr), 0); ++ } ++ #endif ++ } ++ ++ break; ++ } ++ case P2P_GO_NEGO_RESP: { ++ struct rtw_wdev_nego_info *nego_info = &pwdev_priv->nego_info; ++ ++ if (tx) { ++ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) ++ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)); ++ #endif ++ } ++ ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len); ++ if (cont) ++ op_ch = *(cont + 4); ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GO_INTENT, NULL, &cont_len); ++ if (cont) ++ intent = *cont; ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len); ++ if (cont) ++ status = *cont; ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_INTENDED_IF_ADDR, NULL, &cont_len); ++ if (cont && cont_len == 6) ++ iaddr = cont; ++ ++ if (nego_info->token == dialogToken && nego_info->state == 0 ++ && _rtw_memcmp(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN) == _TRUE ++ ) { ++ if (iaddr) ++ _rtw_memcpy(tx ? nego_info->iface_addr : nego_info->peer_iface_addr, iaddr, ETH_ALEN); ++ nego_info->status = (status == -1) ? 0xff : status; ++ nego_info->rsp_op_ch = op_ch; ++ nego_info->rsp_intent = intent; ++ nego_info->state = 1; ++ if (status != 0) ++ nego_info->token = 0; /* init */ ++ } ++ ++ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); ++ RTW_INFO("RTW_%s:P2P_GO_NEGO_RESP, dialogToken=%d, intent:%u%s, status:%d, op_ch:%d, ch_list:%s" ++ , (tx == _TRUE) ? "Tx" : "Rx", dialogToken, (intent >> 1), intent & 0x1 ? "+" : "-", status, op_ch, ch_list_buf); ++ if (iaddr) ++ _RTW_INFO(", iaddr:"MAC_FMT, MAC_ARG(iaddr)); ++ _RTW_INFO("\n"); ++ ++ if (!tx) { ++ pwdev_priv->provdisc_req_issued = _FALSE; ++ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ if (rtw_mi_check_status(padapter, MI_LINKED) ++ && rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE ++ && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { ++ RTW_INFO(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); ++ rtw_change_p2pie_ch_list(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr), 0); ++ } ++ #endif ++ } ++ ++ break; ++ } ++ case P2P_GO_NEGO_CONF: { ++ struct rtw_wdev_nego_info *nego_info = &pwdev_priv->nego_info; ++ bool is_go = _FALSE; ++ ++ if (tx) { ++ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) ++ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)); ++ #endif ++ } ++ ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len); ++ if (cont) ++ op_ch = *(cont + 4); ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len); ++ if (cont) ++ status = *cont; ++ ++ if (nego_info->token == dialogToken && nego_info->state == 1 ++ && _rtw_memcmp(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN) == _TRUE ++ ) { ++ nego_info->status = (status == -1) ? 0xff : status; ++ nego_info->conf_op_ch = (op_ch == -1) ? 0 : op_ch; ++ nego_info->state = 2; ++ ++ if (status == 0) { ++ if (rtw_p2p_nego_intent_compare(nego_info->req_intent, nego_info->rsp_intent) ^ !tx) ++ is_go = _TRUE; ++ } ++ ++ nego_info->token = 0; /* init */ ++ } ++ ++ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); ++ RTW_INFO("RTW_%s:P2P_GO_NEGO_CONF, dialogToken=%d, status:%d, op_ch:%d, ch_list:%s\n" ++ , (tx == _TRUE) ? "Tx" : "Rx", dialogToken, status, op_ch, ch_list_buf); ++ ++ if (!tx) { ++ } ++ ++ break; ++ } ++ case P2P_INVIT_REQ: { ++ struct rtw_wdev_invit_info *invit_info = &pwdev_priv->invit_info; ++ int flags = -1; ++ ++ if (tx) { ++ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ if (rtw_mi_check_status(padapter, MI_LINKED) ++ && padapter->registrypriv.full_ch_in_p2p_handshake == 0) ++ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)); ++ #endif ++ } ++ ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_INVITATION_FLAGS, NULL, &cont_len); ++ if (cont) ++ flags = *cont; ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len); ++ if (cont) ++ op_ch = *(cont + 4); ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_BSSID, NULL, &cont_len); ++ if (cont && cont_len == 6) ++ gbssid = cont; ++ ++ if (invit_info->token != dialogToken) ++ rtw_wdev_invit_info_init(invit_info); ++ ++ _rtw_memcpy(invit_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN); ++ if (gbssid) ++ _rtw_memcpy(invit_info->group_bssid, gbssid, ETH_ALEN); ++ invit_info->active = tx ? 1 : 0; ++ invit_info->token = dialogToken; ++ invit_info->flags = (flags == -1) ? 0x0 : flags; ++ invit_info->req_op_ch = op_ch; ++ invit_info->state = 0; ++ ++ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); ++ RTW_INFO("RTW_%s:P2P_INVIT_REQ, dialogToken=%d, flags:0x%02x, op_ch:%d, ch_list:%s" ++ , (tx == _TRUE) ? "Tx" : "Rx", dialogToken, flags, op_ch, ch_list_buf); ++ if (gbssid) ++ _RTW_INFO(", gbssid:"MAC_FMT, MAC_ARG(gbssid)); ++ _RTW_INFO("\n"); ++ ++ if (!tx) { ++ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { ++ if (op_ch != -1 && rtw_chk_p2pie_op_ch_with_buddy(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE) { ++ RTW_INFO(FUNC_ADPT_FMT" op_ch:%u has no intersect with buddy\n", FUNC_ADPT_ARG(padapter), op_ch); ++ rtw_change_p2pie_ch_list(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr), 0); ++ } else if (rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE) { ++ RTW_INFO(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); ++ rtw_change_p2pie_ch_list(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr), 0); ++ } ++ } ++ #endif ++ } ++ ++ break; ++ } ++ case P2P_INVIT_RESP: { ++ struct rtw_wdev_invit_info *invit_info = &pwdev_priv->invit_info; ++ ++ if (tx) { ++ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) ++ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)); ++ #endif ++ } ++ ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len); ++ if (cont) { ++ #ifdef CONFIG_P2P_INVITE_IOT ++ if (tx && *cont == 7) { ++ RTW_INFO("TX_P2P_INVITE_RESP, status is no common channel, change to unknown group\n"); ++ *cont = 8; /* unknow group status */ ++ } ++ #endif /* CONFIG_P2P_INVITE_IOT */ ++ status = *cont; ++ } ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len); ++ if (cont) ++ op_ch = *(cont + 4); ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_BSSID, NULL, &cont_len); ++ if (cont && cont_len == 6) ++ gbssid = cont; ++ ++ if (invit_info->token == dialogToken && invit_info->state == 0 ++ && _rtw_memcmp(invit_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN) == _TRUE ++ ) { ++ invit_info->status = (status == -1) ? 0xff : status; ++ invit_info->rsp_op_ch = op_ch; ++ invit_info->state = 1; ++ invit_info->token = 0; /* init */ ++ } ++ ++ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); ++ RTW_INFO("RTW_%s:P2P_INVIT_RESP, dialogToken=%d, status:%d, op_ch:%d, ch_list:%s" ++ , (tx == _TRUE) ? "Tx" : "Rx", dialogToken, status, op_ch, ch_list_buf); ++ if (gbssid) ++ _RTW_INFO(", gbssid:"MAC_FMT, MAC_ARG(gbssid)); ++ _RTW_INFO("\n"); ++ ++ if (!tx) { ++ } ++ ++ break; ++ } ++ case P2P_DEVDISC_REQ: ++ RTW_INFO("RTW_%s:P2P_DEVDISC_REQ, dialogToken=%d\n", (tx == _TRUE) ? "Tx" : "Rx", dialogToken); ++ break; ++ case P2P_DEVDISC_RESP: ++ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len); ++ RTW_INFO("RTW_%s:P2P_DEVDISC_RESP, dialogToken=%d, status:%d\n", (tx == _TRUE) ? "Tx" : "Rx", dialogToken, cont ? *cont : -1); ++ break; ++ case P2P_PROVISION_DISC_REQ: { ++ size_t frame_body_len = len - sizeof(struct rtw_ieee80211_hdr_3addr); ++ u8 *p2p_ie; ++ uint p2p_ielen = 0; ++ uint contentlen = 0; ++ ++ RTW_INFO("RTW_%s:P2P_PROVISION_DISC_REQ, dialogToken=%d\n", (tx == _TRUE) ? "Tx" : "Rx", dialogToken); ++ ++ /* if(tx) */ ++ { ++ pwdev_priv->provdisc_req_issued = _FALSE; ++ ++ p2p_ie = rtw_get_p2p_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen); ++ if (p2p_ie) { ++ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, NULL, &contentlen)) { ++ pwdev_priv->provdisc_req_issued = _FALSE;/* case: p2p_client join p2p GO */ ++ } else { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("provdisc_req_issued is _TRUE\n"); ++ #endif /*CONFIG_DEBUG_CFG80211*/ ++ pwdev_priv->provdisc_req_issued = _TRUE;/* case: p2p_devices connection before Nego req. */ ++ } ++ ++ } ++ } ++ } ++ break; ++ case P2P_PROVISION_DISC_RESP: ++ RTW_INFO("RTW_%s:P2P_PROVISION_DISC_RESP, dialogToken=%d\n", (tx == _TRUE) ? "Tx" : "Rx", dialogToken); ++ break; ++ default: ++ RTW_INFO("RTW_%s:OUI_Subtype=%d, dialogToken=%d\n", (tx == _TRUE) ? "Tx" : "Rx", OUI_Subtype, dialogToken); ++ break; ++ } ++ ++ } ++ ++ } else if (category == RTW_WLAN_CATEGORY_P2P) { ++ OUI_Subtype = frame_body[5]; ++ dialogToken = frame_body[6]; ++ ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("ACTION_CATEGORY_P2P: OUI=0x%x, OUI_Subtype=%d, dialogToken=%d\n", ++ cpu_to_be32(*((u32 *)(frame_body + 1))), OUI_Subtype, dialogToken); ++ #endif ++ ++ is_p2p_frame = OUI_Subtype; ++ ++ switch (OUI_Subtype) { ++ case P2P_NOTICE_OF_ABSENCE: ++ RTW_INFO("RTW_%s:P2P_NOTICE_OF_ABSENCE, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", dialogToken); ++ break; ++ case P2P_PRESENCE_REQUEST: ++ RTW_INFO("RTW_%s:P2P_PRESENCE_REQUEST, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", dialogToken); ++ break; ++ case P2P_PRESENCE_RESPONSE: ++ RTW_INFO("RTW_%s:P2P_PRESENCE_RESPONSE, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", dialogToken); ++ break; ++ case P2P_GO_DISC_REQUEST: ++ RTW_INFO("RTW_%s:P2P_GO_DISC_REQUEST, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", dialogToken); ++ break; ++ default: ++ RTW_INFO("RTW_%s:OUI_Subtype=%d, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", OUI_Subtype, dialogToken); ++ break; ++ } ++ ++ } else ++ RTW_INFO("RTW_%s:action frame category=%d\n", (tx == _TRUE) ? "TX" : "RX", category); ++ ++ return is_p2p_frame; ++} ++ ++void rtw_init_cfg80211_wifidirect_info(_adapter *padapter) ++{ ++ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; ++ ++ _rtw_memset(pcfg80211_wdinfo, 0x00, sizeof(struct cfg80211_wifidirect_info)); ++ ++ _init_timer(&pcfg80211_wdinfo->remain_on_ch_timer, padapter->pnetdev, ro_ch_timer_process, padapter); ++} ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++s32 p2p_protocol_wk_hdl(_adapter *padapter, int intCmdType, u8 *buf) ++{ ++ int ret = H2C_SUCCESS; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ switch (intCmdType) { ++ case P2P_FIND_PHASE_WK: ++ find_phase_handler(padapter); ++ break; ++ ++ case P2P_RESTORE_STATE_WK: ++ restore_p2p_state_handler(padapter); ++ break; ++ ++ case P2P_PRE_TX_PROVDISC_PROCESS_WK: ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) ++ p2p_concurrent_handler(padapter); ++ else ++ pre_tx_provdisc_handler(padapter); ++#else ++ pre_tx_provdisc_handler(padapter); ++#endif ++ break; ++ ++ case P2P_PRE_TX_INVITEREQ_PROCESS_WK: ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) ++ p2p_concurrent_handler(padapter); ++ else ++ pre_tx_invitereq_handler(padapter); ++#else ++ pre_tx_invitereq_handler(padapter); ++#endif ++ break; ++ ++ case P2P_PRE_TX_NEGOREQ_PROCESS_WK: ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) ++ p2p_concurrent_handler(padapter); ++ else ++ pre_tx_negoreq_handler(padapter); ++#else ++ pre_tx_negoreq_handler(padapter); ++#endif ++ break; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ case P2P_AP_P2P_CH_SWITCH_PROCESS_WK: ++ p2p_concurrent_handler(padapter); ++ break; ++#endif ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ case P2P_RO_CH_WK: ++ ret = ro_ch_handler(padapter, buf); ++ break; ++ case P2P_CANCEL_RO_CH_WK: ++ ret = cancel_ro_ch_handler(padapter, buf); ++ break; ++#endif ++ ++ default: ++ rtw_warn_on(1); ++ break; ++ } ++ ++ return ret; ++} ++ ++int process_p2p_cross_connect_ie(PADAPTER padapter, u8 *IEs, u32 IELength) ++{ ++ int ret = _TRUE; ++ u8 *ies; ++ u32 ies_len; ++ u8 *p2p_ie; ++ u32 p2p_ielen = 0; ++ u8 p2p_attr[MAX_P2P_IE_LEN] = { 0x00 };/* NoA length should be n*(13) + 2 */ ++ u32 attr_contentlen = 0; ++ ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ ++ if (IELength <= _BEACON_IE_OFFSET_) ++ return ret; ++ ++ ies = IEs + _BEACON_IE_OFFSET_; ++ ies_len = IELength - _BEACON_IE_OFFSET_; ++ ++ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); ++ ++ while (p2p_ie) { ++ /* Get P2P Manageability IE. */ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_MANAGEABILITY, p2p_attr, &attr_contentlen)) { ++ if ((p2p_attr[0] & (BIT(0) | BIT(1))) == 0x01) ++ ret = _FALSE; ++ break; ++ } ++ /* Get the next P2P IE */ ++ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); ++ } ++ ++ return ret; ++} ++ ++#ifdef CONFIG_P2P_PS ++void process_p2p_ps_ie(PADAPTER padapter, u8 *IEs, u32 IELength) ++{ ++ u8 *ies; ++ u32 ies_len; ++ u8 *p2p_ie; ++ u32 p2p_ielen = 0; ++ u8 noa_attr[MAX_P2P_IE_LEN] = { 0x00 };/* NoA length should be n*(13) + 2 */ ++ u32 attr_contentlen = 0; ++ ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 find_p2p = _FALSE, find_p2p_ps = _FALSE; ++ u8 noa_offset, noa_num, noa_index; ++ ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ return; ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->hw_port != HW_PORT0) ++ return; ++#endif ++ if (IELength <= _BEACON_IE_OFFSET_) ++ return; ++ ++ ies = IEs + _BEACON_IE_OFFSET_; ++ ies_len = IELength - _BEACON_IE_OFFSET_; ++ ++ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); ++ ++ while (p2p_ie) { ++ find_p2p = _TRUE; ++ /* Get Notice of Absence IE. */ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_NOA, noa_attr, &attr_contentlen)) { ++ find_p2p_ps = _TRUE; ++ noa_index = noa_attr[0]; ++ ++ if ((pwdinfo->p2p_ps_mode == P2P_PS_NONE) || ++ (noa_index != pwdinfo->noa_index)) { /* if index change, driver should reconfigure related setting. */ ++ pwdinfo->noa_index = noa_index; ++ pwdinfo->opp_ps = noa_attr[1] >> 7; ++ pwdinfo->ctwindow = noa_attr[1] & 0x7F; ++ ++ noa_offset = 2; ++ noa_num = 0; ++ /* NoA length should be n*(13) + 2 */ ++ if (attr_contentlen > 2) { ++ while (noa_offset < attr_contentlen) { ++ /* _rtw_memcpy(&wifidirect_info->noa_count[noa_num], &noa_attr[noa_offset], 1); */ ++ pwdinfo->noa_count[noa_num] = noa_attr[noa_offset]; ++ noa_offset += 1; ++ ++ _rtw_memcpy(&pwdinfo->noa_duration[noa_num], &noa_attr[noa_offset], 4); ++ noa_offset += 4; ++ ++ _rtw_memcpy(&pwdinfo->noa_interval[noa_num], &noa_attr[noa_offset], 4); ++ noa_offset += 4; ++ ++ _rtw_memcpy(&pwdinfo->noa_start_time[noa_num], &noa_attr[noa_offset], 4); ++ noa_offset += 4; ++ ++ noa_num++; ++ } ++ } ++ pwdinfo->noa_num = noa_num; ++ ++ if (pwdinfo->opp_ps == 1) { ++ pwdinfo->p2p_ps_mode = P2P_PS_CTWINDOW; ++ /* driver should wait LPS for entering CTWindow */ ++ if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) ++ p2p_ps_wk_cmd(padapter, P2P_PS_ENABLE, 1); ++ } else if (pwdinfo->noa_num > 0) { ++ pwdinfo->p2p_ps_mode = P2P_PS_NOA; ++ p2p_ps_wk_cmd(padapter, P2P_PS_ENABLE, 1); ++ } else if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) ++ p2p_ps_wk_cmd(padapter, P2P_PS_DISABLE, 1); ++ } ++ ++ break; /* find target, just break. */ ++ } ++ ++ /* Get the next P2P IE */ ++ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); ++ ++ } ++ ++ if (find_p2p == _TRUE) { ++ if ((pwdinfo->p2p_ps_mode > P2P_PS_NONE) && (find_p2p_ps == _FALSE)) ++ p2p_ps_wk_cmd(padapter, P2P_PS_DISABLE, 1); ++ } ++ ++} ++ ++void p2p_ps_wk_hdl(_adapter *padapter, u8 p2p_ps_state) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ ++ /* Pre action for p2p state */ ++ switch (p2p_ps_state) { ++ case P2P_PS_DISABLE: ++ pwdinfo->p2p_ps_state = p2p_ps_state; ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_P2P_PS_OFFLOAD, (u8 *)(&p2p_ps_state)); ++ ++ pwdinfo->noa_index = 0; ++ pwdinfo->ctwindow = 0; ++ pwdinfo->opp_ps = 0; ++ pwdinfo->noa_num = 0; ++ pwdinfo->p2p_ps_mode = P2P_PS_NONE; ++ if (pwrpriv->bFwCurrentInPSMode == _TRUE) { ++ if (pwrpriv->smart_ps == 0) { ++ pwrpriv->smart_ps = 2; ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&(pwrpriv->pwr_mode))); ++ } ++ } ++ break; ++ case P2P_PS_ENABLE: ++ if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) { ++#ifdef CONFIG_MCC_MODE ++ if (MCC_EN(padapter)) { ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { ++ RTW_INFO("P2P PS enble under MCC\n"); ++ rtw_warn_on(1); ++ } ++ ++ } ++#endif /* CONFIG_MCC_MODE */ ++ pwdinfo->p2p_ps_state = p2p_ps_state; ++ ++ if (pwdinfo->ctwindow > 0) { ++ if (pwrpriv->smart_ps != 0) { ++ pwrpriv->smart_ps = 0; ++ RTW_INFO("%s(): Enter CTW, change SmartPS\n", __FUNCTION__); ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&(pwrpriv->pwr_mode))); ++ } ++ } ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_P2P_PS_OFFLOAD, (u8 *)(&p2p_ps_state)); ++ } ++ break; ++ case P2P_PS_SCAN: ++ case P2P_PS_SCAN_DONE: ++ case P2P_PS_ALLSTASLEEP: ++ if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) { ++ pwdinfo->p2p_ps_state = p2p_ps_state; ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_P2P_PS_OFFLOAD, (u8 *)(&p2p_ps_state)); ++ } ++ break; ++ default: ++ break; ++ } ++ ++} ++ ++u8 p2p_ps_wk_cmd(_adapter *padapter, u8 p2p_ps_state, u8 enqueue) ++{ ++ struct cmd_obj *ph2c; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 res = _SUCCESS; ++ ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) ++#ifdef CONFIG_CONCURRENT_MODE ++ || (padapter->hw_port != HW_PORT0) ++#endif ++ ) ++ return res; ++ ++ if (enqueue) { ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ if (pdrvextra_cmd_parm == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pdrvextra_cmd_parm->ec_id = P2P_PS_WK_CID; ++ pdrvextra_cmd_parm->type = p2p_ps_state; ++ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->pbuf = NULL; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ } else ++ p2p_ps_wk_hdl(padapter, p2p_ps_state); ++ ++exit: ++ ++ ++ return res; ++ ++} ++#endif /* CONFIG_P2P_PS */ ++ ++static void reset_ch_sitesurvey_timer_process(void *FunctionContext) ++{ ++ _adapter *adapter = (_adapter *)FunctionContext; ++ struct wifidirect_info *pwdinfo = &adapter->wdinfo; ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ return; ++ ++ RTW_INFO("[%s] In\n", __FUNCTION__); ++ /* Reset the operation channel information */ ++ pwdinfo->rx_invitereq_info.operation_ch[0] = 0; ++#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH ++ pwdinfo->rx_invitereq_info.operation_ch[1] = 0; ++ pwdinfo->rx_invitereq_info.operation_ch[2] = 0; ++ pwdinfo->rx_invitereq_info.operation_ch[3] = 0; ++#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ ++ pwdinfo->rx_invitereq_info.scan_op_ch_only = 0; ++} ++ ++static void reset_ch_sitesurvey_timer_process2(void *FunctionContext) ++{ ++ _adapter *adapter = (_adapter *)FunctionContext; ++ struct wifidirect_info *pwdinfo = &adapter->wdinfo; ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ return; ++ ++ RTW_INFO("[%s] In\n", __FUNCTION__); ++ /* Reset the operation channel information */ ++ pwdinfo->p2p_info.operation_ch[0] = 0; ++#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH ++ pwdinfo->p2p_info.operation_ch[1] = 0; ++ pwdinfo->p2p_info.operation_ch[2] = 0; ++ pwdinfo->p2p_info.operation_ch[3] = 0; ++#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ ++ pwdinfo->p2p_info.scan_op_ch_only = 0; ++} ++ ++static void restore_p2p_state_timer_process(void *FunctionContext) ++{ ++ _adapter *adapter = (_adapter *)FunctionContext; ++ struct wifidirect_info *pwdinfo = &adapter->wdinfo; ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ return; ++ ++ p2p_protocol_wk_cmd(adapter, P2P_RESTORE_STATE_WK); ++} ++ ++static void pre_tx_scan_timer_process(void *FunctionContext) ++{ ++ _adapter *adapter = (_adapter *) FunctionContext; ++ struct wifidirect_info *pwdinfo = &adapter->wdinfo; ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ u8 _status = 0; ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ return; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) { ++ if (_TRUE == pwdinfo->tx_prov_disc_info.benable) { /* the provision discovery request frame is trigger to send or not */ ++ p2p_protocol_wk_cmd(adapter, P2P_PRE_TX_PROVDISC_PROCESS_WK); ++ /* issue_probereq_p2p(adapter, NULL); */ ++ /* _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); */ ++ } ++ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) { ++ if (_TRUE == pwdinfo->nego_req_info.benable) ++ p2p_protocol_wk_cmd(adapter, P2P_PRE_TX_NEGOREQ_PROCESS_WK); ++ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ)) { ++ if (_TRUE == pwdinfo->invitereq_info.benable) ++ p2p_protocol_wk_cmd(adapter, P2P_PRE_TX_INVITEREQ_PROCESS_WK); ++ } else ++ RTW_INFO("[%s] p2p_state is %d, ignore!!\n", __FUNCTION__, rtw_p2p_state(pwdinfo)); ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++} ++ ++static void find_phase_timer_process(void *FunctionContext) ++{ ++ _adapter *adapter = (_adapter *)FunctionContext; ++ struct wifidirect_info *pwdinfo = &adapter->wdinfo; ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ return; ++ ++ adapter->wdinfo.find_phase_state_exchange_cnt++; ++ ++ p2p_protocol_wk_cmd(adapter, P2P_FIND_PHASE_WK); ++} ++ ++#ifdef CONFIG_CONCURRENT_MODE ++void ap_p2p_switch_timer_process(void *FunctionContext) ++{ ++ _adapter *adapter = (_adapter *)FunctionContext; ++ struct wifidirect_info *pwdinfo = &adapter->wdinfo; ++#ifdef CONFIG_IOCTL_CFG80211 ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); ++#endif ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ return; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); ++#endif ++ ++ p2p_protocol_wk_cmd(adapter, P2P_AP_P2P_CH_SWITCH_PROCESS_WK); ++} ++#endif ++ ++void reset_global_wifidirect_info(_adapter *padapter) ++{ ++ struct wifidirect_info *pwdinfo; ++ ++ pwdinfo = &padapter->wdinfo; ++ pwdinfo->persistent_supported = 0; ++ pwdinfo->session_available = _TRUE; ++ rtw_tdls_wfd_enable(padapter, 0); ++ pwdinfo->wfd_tdls_weaksec = _TRUE; ++} ++ ++#ifdef CONFIG_WFD ++int rtw_init_wifi_display_info(_adapter *padapter) ++{ ++ int res = _SUCCESS; ++ struct wifi_display_info *pwfd_info = &padapter->wfd_info; ++ ++ /* Used in P2P and TDLS */ ++ pwfd_info->init_rtsp_ctrlport = 554; ++#ifdef CONFIG_IOCTL_CFG80211 ++ pwfd_info->rtsp_ctrlport = 0; ++#else ++ pwfd_info->rtsp_ctrlport = pwfd_info->init_rtsp_ctrlport; /* set non-zero value for legacy wfd */ ++#endif ++ pwfd_info->tdls_rtsp_ctrlport = 0; ++ pwfd_info->peer_rtsp_ctrlport = 0; /* Reset to 0 */ ++ pwfd_info->wfd_enable = _FALSE; ++ pwfd_info->wfd_device_type = WFD_DEVINFO_PSINK; ++ pwfd_info->scan_result_type = SCAN_RESULT_P2P_ONLY; ++ ++ /* Used in P2P */ ++ pwfd_info->peer_session_avail = _TRUE; ++ pwfd_info->wfd_pc = _FALSE; ++ ++ /* Used in TDLS */ ++ _rtw_memset(pwfd_info->ip_address, 0x00, 4); ++ _rtw_memset(pwfd_info->peer_ip_address, 0x00, 4); ++ return res; ++ ++} ++ ++inline void rtw_wfd_enable(_adapter *adapter, bool on) ++{ ++ struct wifi_display_info *wfdinfo = &adapter->wfd_info; ++ ++ if (on) { ++ wfdinfo->rtsp_ctrlport = wfdinfo->init_rtsp_ctrlport; ++ wfdinfo->wfd_enable = _TRUE; ++ ++ } else { ++ wfdinfo->wfd_enable = _FALSE; ++ wfdinfo->rtsp_ctrlport = 0; ++ } ++} ++ ++inline void rtw_wfd_set_ctrl_port(_adapter *adapter, u16 port) ++{ ++ struct wifi_display_info *wfdinfo = &adapter->wfd_info; ++ ++ wfdinfo->init_rtsp_ctrlport = port; ++ if (wfdinfo->wfd_enable == _TRUE) ++ wfdinfo->rtsp_ctrlport = port; ++ if (adapter->wdinfo.wfd_tdls_enable == 1) ++ wfdinfo->tdls_rtsp_ctrlport = port; ++} ++ ++inline void rtw_tdls_wfd_enable(_adapter *adapter, bool on) ++{ ++ struct wifi_display_info *wfdinfo = &adapter->wfd_info; ++ ++ if (on) { ++ wfdinfo->tdls_rtsp_ctrlport = wfdinfo->init_rtsp_ctrlport; ++ adapter->wdinfo.wfd_tdls_enable = 1; ++ ++ } else { ++ adapter->wdinfo.wfd_tdls_enable = 0; ++ wfdinfo->tdls_rtsp_ctrlport = 0; ++ } ++} ++ ++u32 rtw_append_beacon_wfd_ie(_adapter *adapter, u8 *pbuf) ++{ ++ struct wifidirect_info *wdinfo = &adapter->wdinfo; ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ u8 build_ie_by_self = 0; ++ u32 len = 0; ++ ++ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (_TRUE == wdinfo->wfd_info->wfd_enable) ++#endif ++ build_ie_by_self = 1; ++ ++ if (build_ie_by_self) ++ len = build_beacon_wfd_ie(wdinfo, pbuf); ++#ifdef CONFIG_IOCTL_CFG80211 ++ else if (mlme->wfd_beacon_ie && mlme->wfd_beacon_ie_len > 0) { ++ len = mlme->wfd_beacon_ie_len; ++ _rtw_memcpy(pbuf, mlme->wfd_beacon_ie, len); ++ } ++#endif ++ ++exit: ++ return len; ++} ++ ++u32 rtw_append_probe_req_wfd_ie(_adapter *adapter, u8 *pbuf) ++{ ++ struct wifidirect_info *wdinfo = &adapter->wdinfo; ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ u8 build_ie_by_self = 0; ++ u32 len = 0; ++ ++ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (_TRUE == wdinfo->wfd_info->wfd_enable) ++#endif ++ build_ie_by_self = 1; ++ ++ if (build_ie_by_self) ++ len = build_probe_req_wfd_ie(wdinfo, pbuf); ++#ifdef CONFIG_IOCTL_CFG80211 ++ else if (mlme->wfd_probe_req_ie && mlme->wfd_probe_req_ie_len > 0) { ++ len = mlme->wfd_probe_req_ie_len; ++ _rtw_memcpy(pbuf, mlme->wfd_probe_req_ie, len); ++ } ++#endif ++ ++exit: ++ return len; ++} ++ ++u32 rtw_append_probe_resp_wfd_ie(_adapter *adapter, u8 *pbuf) ++{ ++ struct wifidirect_info *wdinfo = &adapter->wdinfo; ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ u8 build_ie_by_self = 0; ++ u32 len = 0; ++ ++ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (_TRUE == wdinfo->wfd_info->wfd_enable) ++#endif ++ build_ie_by_self = 1; ++ ++ if (build_ie_by_self) ++ len = build_probe_resp_wfd_ie(wdinfo, pbuf, 0); ++#ifdef CONFIG_IOCTL_CFG80211 ++ else if (mlme->wfd_probe_resp_ie && mlme->wfd_probe_resp_ie_len > 0) { ++ len = mlme->wfd_probe_resp_ie_len; ++ _rtw_memcpy(pbuf, mlme->wfd_probe_resp_ie, len); ++ } ++#endif ++ ++exit: ++ return len; ++} ++ ++u32 rtw_append_assoc_req_wfd_ie(_adapter *adapter, u8 *pbuf) ++{ ++ struct wifidirect_info *wdinfo = &adapter->wdinfo; ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ u8 build_ie_by_self = 0; ++ u32 len = 0; ++ ++ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (_TRUE == wdinfo->wfd_info->wfd_enable) ++#endif ++ build_ie_by_self = 1; ++ ++ if (build_ie_by_self) ++ len = build_assoc_req_wfd_ie(wdinfo, pbuf); ++#ifdef CONFIG_IOCTL_CFG80211 ++ else if (mlme->wfd_assoc_req_ie && mlme->wfd_assoc_req_ie_len > 0) { ++ len = mlme->wfd_assoc_req_ie_len; ++ _rtw_memcpy(pbuf, mlme->wfd_assoc_req_ie, len); ++ } ++#endif ++ ++exit: ++ return len; ++} ++ ++u32 rtw_append_assoc_resp_wfd_ie(_adapter *adapter, u8 *pbuf) ++{ ++ struct wifidirect_info *wdinfo = &adapter->wdinfo; ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ u8 build_ie_by_self = 0; ++ u32 len = 0; ++ ++ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) ++ goto exit; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (_TRUE == wdinfo->wfd_info->wfd_enable) ++#endif ++ build_ie_by_self = 1; ++ ++ if (build_ie_by_self) ++ len = build_assoc_resp_wfd_ie(wdinfo, pbuf); ++#ifdef CONFIG_IOCTL_CFG80211 ++ else if (mlme->wfd_assoc_resp_ie && mlme->wfd_assoc_resp_ie_len > 0) { ++ len = mlme->wfd_assoc_resp_ie_len; ++ _rtw_memcpy(pbuf, mlme->wfd_assoc_resp_ie, len); ++ } ++#endif ++ ++exit: ++ return len; ++} ++ ++#endif /* CONFIG_WFD */ ++ ++void rtw_init_wifidirect_timers(_adapter *padapter) ++{ ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ ++ _init_timer(&pwdinfo->find_phase_timer, padapter->pnetdev, find_phase_timer_process, padapter); ++ _init_timer(&pwdinfo->restore_p2p_state_timer, padapter->pnetdev, restore_p2p_state_timer_process, padapter); ++ _init_timer(&pwdinfo->pre_tx_scan_timer, padapter->pnetdev, pre_tx_scan_timer_process, padapter); ++ _init_timer(&pwdinfo->reset_ch_sitesurvey, padapter->pnetdev, reset_ch_sitesurvey_timer_process, padapter); ++ _init_timer(&pwdinfo->reset_ch_sitesurvey2, padapter->pnetdev, reset_ch_sitesurvey_timer_process2, padapter); ++#ifdef CONFIG_CONCURRENT_MODE ++ _init_timer(&pwdinfo->ap_p2p_switch_timer, padapter->pnetdev, ap_p2p_switch_timer_process, padapter); ++#endif ++} ++ ++void rtw_init_wifidirect_addrs(_adapter *padapter, u8 *dev_addr, u8 *iface_addr) ++{ ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ ++ /*init device&interface address */ ++ if (dev_addr) ++ _rtw_memcpy(pwdinfo->device_addr, dev_addr, ETH_ALEN); ++ if (iface_addr) ++ _rtw_memcpy(pwdinfo->interface_addr, iface_addr, ETH_ALEN); ++#endif ++} ++ ++void init_wifidirect_info(_adapter *padapter, enum P2P_ROLE role) ++{ ++ struct wifidirect_info *pwdinfo; ++#ifdef CONFIG_WFD ++ struct wifi_display_info *pwfd_info = &padapter->wfd_info; ++#endif ++ u8 union_ch = 0; ++ pwdinfo = &padapter->wdinfo; ++ ++ pwdinfo->padapter = padapter; ++ ++ /* 1, 6, 11 are the social channel defined in the WiFi Direct specification. */ ++ pwdinfo->social_chan[0] = 1; ++ pwdinfo->social_chan[1] = 6; ++ pwdinfo->social_chan[2] = 11; ++ pwdinfo->social_chan[3] = 0; /* channel 0 for scanning ending in site survey function. */ ++ ++ if (role != P2P_ROLE_DISABLE ++ && pwdinfo->driver_interface != DRIVER_CFG80211 ++ ) { ++ #ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) ++ union_ch = rtw_mi_get_union_chan(padapter); ++ ++ if (union_ch != 0 && ++ (union_ch == 1 || union_ch == 6 || union_ch == 11) ++ ) { ++ /* Use the AP's channel as the listen channel */ ++ /* This will avoid the channel switch between AP's channel and listen channel */ ++ pwdinfo->listen_channel = union_ch; ++ } else ++ #endif /* CONFIG_CONCURRENT_MODE */ ++ { ++ /* Use the channel 11 as the listen channel */ ++ pwdinfo->listen_channel = 11; ++ } ++ } ++ ++ if (role == P2P_ROLE_DEVICE) { ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_IDLE); ++ else ++#endif ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); ++ ++ pwdinfo->intent = 1; ++ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_LISTEN); ++ } else if (role == P2P_ROLE_CLIENT) { ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ pwdinfo->intent = 1; ++ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ } else if (role == P2P_ROLE_GO) { ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ pwdinfo->intent = 15; ++ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ } ++ ++ /* Use the OFDM rate in the P2P probe response frame. ( 6(B), 9(B), 12, 18, 24, 36, 48, 54 ) */ ++ pwdinfo->support_rate[0] = 0x8c; /* 6(B) */ ++ pwdinfo->support_rate[1] = 0x92; /* 9(B) */ ++ pwdinfo->support_rate[2] = 0x18; /* 12 */ ++ pwdinfo->support_rate[3] = 0x24; /* 18 */ ++ pwdinfo->support_rate[4] = 0x30; /* 24 */ ++ pwdinfo->support_rate[5] = 0x48; /* 36 */ ++ pwdinfo->support_rate[6] = 0x60; /* 48 */ ++ pwdinfo->support_rate[7] = 0x6c; /* 54 */ ++ ++ _rtw_memcpy((void *) pwdinfo->p2p_wildcard_ssid, "DIRECT-", 7); ++ ++ _rtw_memset(pwdinfo->device_name, 0x00, WPS_MAX_DEVICE_NAME_LEN); ++ pwdinfo->device_name_len = 0; ++ ++ _rtw_memset(&pwdinfo->invitereq_info, 0x00, sizeof(struct tx_invite_req_info)); ++ pwdinfo->invitereq_info.token = 3; /* Token used for P2P invitation request frame. */ ++ ++ _rtw_memset(&pwdinfo->inviteresp_info, 0x00, sizeof(struct tx_invite_resp_info)); ++ pwdinfo->inviteresp_info.token = 0; ++ ++ pwdinfo->profileindex = 0; ++ _rtw_memset(&pwdinfo->profileinfo[0], 0x00, sizeof(struct profile_info) * P2P_MAX_PERSISTENT_GROUP_NUM); ++ ++ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); ++ ++ pwdinfo->listen_dwell = (u8)((rtw_get_current_time() % 3) + 1); ++ /* RTW_INFO( "[%s] listen_dwell time is %d00ms\n", __FUNCTION__, pwdinfo->listen_dwell ); */ ++ ++ _rtw_memset(&pwdinfo->tx_prov_disc_info, 0x00, sizeof(struct tx_provdisc_req_info)); ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_NONE; ++ ++ _rtw_memset(&pwdinfo->nego_req_info, 0x00, sizeof(struct tx_nego_req_info)); ++ ++ pwdinfo->device_password_id_for_nego = WPS_DPID_PBC; ++ pwdinfo->negotiation_dialog_token = 1; ++ ++ _rtw_memset(pwdinfo->nego_ssid, 0x00, WLAN_SSID_MAXLEN); ++ pwdinfo->nego_ssidlen = 0; ++ ++ pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO; ++#ifdef CONFIG_WFD ++ pwdinfo->supported_wps_cm = WPS_CONFIG_METHOD_DISPLAY | WPS_CONFIG_METHOD_PBC; ++ pwdinfo->wfd_info = pwfd_info; ++#else ++ pwdinfo->supported_wps_cm = WPS_CONFIG_METHOD_DISPLAY | WPS_CONFIG_METHOD_PBC | WPS_CONFIG_METHOD_KEYPAD; ++#endif /* CONFIG_WFD */ ++ pwdinfo->channel_list_attr_len = 0; ++ _rtw_memset(pwdinfo->channel_list_attr, 0x00, 100); ++ ++ _rtw_memset(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, 0x00, 4); ++ _rtw_memset(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, '0', 3); ++ _rtw_memset(&pwdinfo->groupid_info, 0x00, sizeof(struct group_id_info)); ++#ifdef CONFIG_CONCURRENT_MODE ++#ifdef CONFIG_IOCTL_CFG80211 ++ pwdinfo->ext_listen_interval = 1000; /* The interval to be available with legacy AP during p2p0-find/scan */ ++ pwdinfo->ext_listen_period = 3000; /* The time period to be available for P2P during nego */ ++#else /* !CONFIG_IOCTL_CFG80211 */ ++ /* pwdinfo->ext_listen_interval = 3000; */ ++ /* pwdinfo->ext_listen_period = 400; */ ++ pwdinfo->ext_listen_interval = 1000; ++ pwdinfo->ext_listen_period = 1000; ++#endif /* !CONFIG_IOCTL_CFG80211 */ ++#endif ++ ++ /* Commented by Kurt 20130319 ++ * For WiDi purpose: Use CFG80211 interface but controled WFD/RDS frame by driver itself. */ ++#ifdef CONFIG_IOCTL_CFG80211 ++ pwdinfo->driver_interface = DRIVER_CFG80211; ++#else ++ pwdinfo->driver_interface = DRIVER_WEXT; ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++ pwdinfo->wfd_tdls_enable = 0; ++ _rtw_memset(pwdinfo->p2p_peer_interface_addr, 0x00, ETH_ALEN); ++ _rtw_memset(pwdinfo->p2p_peer_device_addr, 0x00, ETH_ALEN); ++ ++ pwdinfo->rx_invitereq_info.operation_ch[0] = 0; ++ pwdinfo->rx_invitereq_info.operation_ch[1] = 0; /* Used to indicate the scan end in site survey function */ ++#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH ++ pwdinfo->rx_invitereq_info.operation_ch[2] = 0; ++ pwdinfo->rx_invitereq_info.operation_ch[3] = 0; ++ pwdinfo->rx_invitereq_info.operation_ch[4] = 0; ++#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ ++ pwdinfo->rx_invitereq_info.scan_op_ch_only = 0; ++ pwdinfo->p2p_info.operation_ch[0] = 0; ++ pwdinfo->p2p_info.operation_ch[1] = 0; /* Used to indicate the scan end in site survey function */ ++#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH ++ pwdinfo->p2p_info.operation_ch[2] = 0; ++ pwdinfo->p2p_info.operation_ch[3] = 0; ++ pwdinfo->p2p_info.operation_ch[4] = 0; ++#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ ++ pwdinfo->p2p_info.scan_op_ch_only = 0; ++} ++ ++#ifdef CONFIG_DBG_P2P ++ ++/** ++ * rtw_p2p_role_txt - Get the p2p role name as a text string ++ * @role: P2P role ++ * Returns: The state name as a printable text string ++ */ ++const char *rtw_p2p_role_txt(enum P2P_ROLE role) ++{ ++ switch (role) { ++ case P2P_ROLE_DISABLE: ++ return "P2P_ROLE_DISABLE"; ++ case P2P_ROLE_DEVICE: ++ return "P2P_ROLE_DEVICE"; ++ case P2P_ROLE_CLIENT: ++ return "P2P_ROLE_CLIENT"; ++ case P2P_ROLE_GO: ++ return "P2P_ROLE_GO"; ++ default: ++ return "UNKNOWN"; ++ } ++} ++ ++/** ++ * rtw_p2p_state_txt - Get the p2p state name as a text string ++ * @state: P2P state ++ * Returns: The state name as a printable text string ++ */ ++const char *rtw_p2p_state_txt(enum P2P_STATE state) ++{ ++ switch (state) { ++ case P2P_STATE_NONE: ++ return "P2P_STATE_NONE"; ++ case P2P_STATE_IDLE: ++ return "P2P_STATE_IDLE"; ++ case P2P_STATE_LISTEN: ++ return "P2P_STATE_LISTEN"; ++ case P2P_STATE_SCAN: ++ return "P2P_STATE_SCAN"; ++ case P2P_STATE_FIND_PHASE_LISTEN: ++ return "P2P_STATE_FIND_PHASE_LISTEN"; ++ case P2P_STATE_FIND_PHASE_SEARCH: ++ return "P2P_STATE_FIND_PHASE_SEARCH"; ++ case P2P_STATE_TX_PROVISION_DIS_REQ: ++ return "P2P_STATE_TX_PROVISION_DIS_REQ"; ++ case P2P_STATE_RX_PROVISION_DIS_RSP: ++ return "P2P_STATE_RX_PROVISION_DIS_RSP"; ++ case P2P_STATE_RX_PROVISION_DIS_REQ: ++ return "P2P_STATE_RX_PROVISION_DIS_REQ"; ++ case P2P_STATE_GONEGO_ING: ++ return "P2P_STATE_GONEGO_ING"; ++ case P2P_STATE_GONEGO_OK: ++ return "P2P_STATE_GONEGO_OK"; ++ case P2P_STATE_GONEGO_FAIL: ++ return "P2P_STATE_GONEGO_FAIL"; ++ case P2P_STATE_RECV_INVITE_REQ_MATCH: ++ return "P2P_STATE_RECV_INVITE_REQ_MATCH"; ++ case P2P_STATE_PROVISIONING_ING: ++ return "P2P_STATE_PROVISIONING_ING"; ++ case P2P_STATE_PROVISIONING_DONE: ++ return "P2P_STATE_PROVISIONING_DONE"; ++ case P2P_STATE_TX_INVITE_REQ: ++ return "P2P_STATE_TX_INVITE_REQ"; ++ case P2P_STATE_RX_INVITE_RESP_OK: ++ return "P2P_STATE_RX_INVITE_RESP_OK"; ++ case P2P_STATE_RECV_INVITE_REQ_DISMATCH: ++ return "P2P_STATE_RECV_INVITE_REQ_DISMATCH"; ++ case P2P_STATE_RECV_INVITE_REQ_GO: ++ return "P2P_STATE_RECV_INVITE_REQ_GO"; ++ case P2P_STATE_RECV_INVITE_REQ_JOIN: ++ return "P2P_STATE_RECV_INVITE_REQ_JOIN"; ++ case P2P_STATE_RX_INVITE_RESP_FAIL: ++ return "P2P_STATE_RX_INVITE_RESP_FAIL"; ++ case P2P_STATE_RX_INFOR_NOREADY: ++ return "P2P_STATE_RX_INFOR_NOREADY"; ++ case P2P_STATE_TX_INFOR_NOREADY: ++ return "P2P_STATE_TX_INFOR_NOREADY"; ++ default: ++ return "UNKNOWN"; ++ } ++} ++ ++void dbg_rtw_p2p_set_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line) ++{ ++ if (!_rtw_p2p_chk_state(wdinfo, state)) { ++ enum P2P_STATE old_state = _rtw_p2p_state(wdinfo); ++ _rtw_p2p_set_state(wdinfo, state); ++ RTW_INFO("[CONFIG_DBG_P2P]%s:%d set_state from %s to %s\n", caller, line ++ , rtw_p2p_state_txt(old_state), rtw_p2p_state_txt(_rtw_p2p_state(wdinfo)) ++ ); ++ } else { ++ RTW_INFO("[CONFIG_DBG_P2P]%s:%d set_state to same state %s\n", caller, line ++ , rtw_p2p_state_txt(_rtw_p2p_state(wdinfo)) ++ ); ++ } ++} ++void dbg_rtw_p2p_set_pre_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line) ++{ ++ if (_rtw_p2p_pre_state(wdinfo) != state) { ++ enum P2P_STATE old_state = _rtw_p2p_pre_state(wdinfo); ++ _rtw_p2p_set_pre_state(wdinfo, state); ++ RTW_INFO("[CONFIG_DBG_P2P]%s:%d set_pre_state from %s to %s\n", caller, line ++ , rtw_p2p_state_txt(old_state), rtw_p2p_state_txt(_rtw_p2p_pre_state(wdinfo)) ++ ); ++ } else { ++ RTW_INFO("[CONFIG_DBG_P2P]%s:%d set_pre_state to same state %s\n", caller, line ++ , rtw_p2p_state_txt(_rtw_p2p_pre_state(wdinfo)) ++ ); ++ } ++} ++#if 0 ++void dbg_rtw_p2p_restore_state(struct wifidirect_info *wdinfo, const char *caller, int line) ++{ ++ if (wdinfo->pre_p2p_state != -1) { ++ RTW_INFO("[CONFIG_DBG_P2P]%s:%d restore from %s to %s\n", caller, line ++ , p2p_state_str[wdinfo->p2p_state], p2p_state_str[wdinfo->pre_p2p_state] ++ ); ++ _rtw_p2p_restore_state(wdinfo); ++ } else { ++ RTW_INFO("[CONFIG_DBG_P2P]%s:%d restore no pre state, cur state %s\n", caller, line ++ , p2p_state_str[wdinfo->p2p_state] ++ ); ++ } ++} ++#endif ++void dbg_rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role, const char *caller, int line) ++{ ++ if (wdinfo->role != role) { ++ enum P2P_ROLE old_role = wdinfo->role; ++ _rtw_p2p_set_role(wdinfo, role); ++ RTW_INFO("[CONFIG_DBG_P2P]%s:%d set_role from %s to %s\n", caller, line ++ , rtw_p2p_role_txt(old_role), rtw_p2p_role_txt(wdinfo->role) ++ ); ++ } else { ++ RTW_INFO("[CONFIG_DBG_P2P]%s:%d set_role to same role %s\n", caller, line ++ , rtw_p2p_role_txt(wdinfo->role) ++ ); ++ } ++} ++#endif /* CONFIG_DBG_P2P */ ++ ++ ++int rtw_p2p_enable(_adapter *padapter, enum P2P_ROLE role) ++{ ++ int ret = _SUCCESS; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ if (role == P2P_ROLE_DEVICE || role == P2P_ROLE_CLIENT || role == P2P_ROLE_GO) { ++ u8 channel, ch_offset; ++ u16 bwmode; ++ ++#if defined(CONFIG_CONCURRENT_MODE) && (!defined(RTW_P2P_GROUP_INTERFACE) || !RTW_P2P_GROUP_INTERFACE) ++ /* Commented by Albert 2011/12/30 */ ++ /* The driver just supports 1 P2P group operation. */ ++ /* So, this function will do nothing if the buddy adapter had enabled the P2P function. */ ++ /*if(!rtw_p2p_chk_state(pbuddy_wdinfo, P2P_STATE_NONE)) ++ return ret;*/ ++ /*The buddy adapter had enabled the P2P function.*/ ++ if (rtw_mi_buddy_stay_in_p2p_mode(padapter)) ++ return ret; ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ /* leave IPS/Autosuspend */ ++ if (_FAIL == rtw_pwr_wakeup(padapter)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* Added by Albert 2011/03/22 */ ++ /* In the P2P mode, the driver should not support the b mode. */ ++ /* So, the Tx packet shouldn't use the CCK rate */ ++ #ifdef CONFIG_IOCTL_CFG80211 ++ if (rtw_cfg80211_iface_has_p2p_group_cap(padapter)) ++ #endif ++ update_tx_basic_rate(padapter, WIRELESS_11AGN); ++ ++ /* Enable P2P function */ ++ init_wifidirect_info(padapter, role); ++ ++ #ifdef CONFIG_IOCTL_CFG80211 ++ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) ++ adapter_wdev_data(padapter)->p2p_enabled = _TRUE; ++ #endif ++ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_P2P_STATE, NULL, _TRUE); ++#ifdef CONFIG_WFD ++ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ rtw_hal_set_odm_var(padapter, HAL_ODM_WIFI_DISPLAY_STATE, NULL, _TRUE); ++#endif ++ ++ } else if (role == P2P_ROLE_DISABLE) { ++#ifdef CONFIG_INTEL_WIDI ++ if (padapter->mlmepriv.p2p_reject_disable == _TRUE) ++ return ret; ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ #ifdef CONFIG_IOCTL_CFG80211 ++ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) ++ adapter_wdev_data(padapter)->p2p_enabled = _FALSE; ++ #endif ++ ++ pwdinfo->listen_channel = 0; ++ ++ /* Disable P2P function */ ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ _cancel_timer_ex(&pwdinfo->find_phase_timer); ++ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); ++ _cancel_timer_ex(&pwdinfo->pre_tx_scan_timer); ++ _cancel_timer_ex(&pwdinfo->reset_ch_sitesurvey); ++ _cancel_timer_ex(&pwdinfo->reset_ch_sitesurvey2); ++ reset_ch_sitesurvey_timer_process(padapter); ++ reset_ch_sitesurvey_timer_process2(padapter); ++#ifdef CONFIG_CONCURRENT_MODE ++ _cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer); ++#endif ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE); ++ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_NONE); ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DISABLE); ++ _rtw_memset(&pwdinfo->rx_prov_disc_info, 0x00, sizeof(struct rx_provdisc_req_info)); ++ ++ /* Remove profiles in wifidirect_info structure. */ ++ _rtw_memset(&pwdinfo->profileinfo[0], 0x00, sizeof(struct profile_info) * P2P_MAX_PERSISTENT_GROUP_NUM); ++ pwdinfo->profileindex = 0; ++ } ++ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_P2P_STATE, NULL, _FALSE); ++#ifdef CONFIG_WFD ++ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ rtw_hal_set_odm_var(padapter, HAL_ODM_WIFI_DISPLAY_STATE, NULL, _FALSE); ++#endif ++ ++ if (_FAIL == rtw_pwr_wakeup(padapter)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* Restore to initial setting. */ ++ update_tx_basic_rate(padapter, padapter->registrypriv.wireless_mode); ++ ++#ifdef CONFIG_INTEL_WIDI ++ rtw_reset_widi_info(padapter); ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ /* For WiDi purpose. */ ++#ifdef CONFIG_IOCTL_CFG80211 ++ pwdinfo->driver_interface = DRIVER_CFG80211; ++#else ++ pwdinfo->driver_interface = DRIVER_WEXT; ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++ } ++ ++exit: ++ return ret; ++} ++ ++#endif /* CONFIG_P2P */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_pwrctrl.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_pwrctrl.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_pwrctrl.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_pwrctrl.c 2018-02-11 21:44:27.140145979 +0200 +@@ -0,0 +1,2480 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_PWRCTRL_C_ ++ ++#include ++#include ++#include ++ ++int rtw_fw_ps_state(PADAPTER padapter) ++{ ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ int ret = _FAIL, dont_care = 0; ++ u16 fw_ps_state = 0; ++ u32 start_time; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct registry_priv *registry_par = &padapter->registrypriv; ++ ++ if (registry_par->check_fw_ps != 1) ++ return _SUCCESS; ++ ++ _enter_pwrlock(&pwrpriv->check_32k_lock); ++ ++ if (RTW_CANNOT_RUN(padapter)) { ++ RTW_INFO("%s: bSurpriseRemoved=%s , hw_init_completed=%d, bDriverStopped=%s\n", __func__ ++ , rtw_is_surprise_removed(padapter) ? "True" : "False" ++ , rtw_get_hw_init_completed(padapter) ++ , rtw_is_drv_stopped(padapter) ? "True" : "False"); ++ goto exit_fw_ps_state; ++ } ++ rtw_hal_set_hwreg(padapter, HW_VAR_SET_REQ_FW_PS, (u8 *)&dont_care); ++ { ++ /* 4. if 0x88[7]=1, driver set cmd to leave LPS/IPS. */ ++ /* Else, hw will keep in active mode. */ ++ /* debug info: */ ++ /* 0x88[7] = 32kpermission, */ ++ /* 0x88[6:0] = current_ps_state */ ++ /* 0x89[7:0] = last_rpwm */ ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_FW_PS_STATE, (u8 *)&fw_ps_state); ++ ++ if ((fw_ps_state & 0x80) == 0) ++ ret = _SUCCESS; ++ else { ++ pdbgpriv->dbg_poll_fail_cnt++; ++ RTW_INFO("%s: fw_ps_state=%04x\n", __FUNCTION__, fw_ps_state); ++ } ++ } ++ ++ ++exit_fw_ps_state: ++ _exit_pwrlock(&pwrpriv->check_32k_lock); ++ return ret; ++} ++ ++#ifdef CONFIG_IPS ++void _ips_enter(_adapter *padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ ++ pwrpriv->bips_processing = _TRUE; ++ ++ /* syn ips_mode with request */ ++ pwrpriv->ips_mode = pwrpriv->ips_mode_req; ++ ++ pwrpriv->ips_enter_cnts++; ++ RTW_INFO("==>ips_enter cnts:%d\n", pwrpriv->ips_enter_cnts); ++ ++ if (rf_off == pwrpriv->change_rfpwrstate) { ++ pwrpriv->bpower_saving = _TRUE; ++ RTW_PRINT("nolinked power save enter\n"); ++ ++ if (pwrpriv->ips_mode == IPS_LEVEL_2) ++ pwrpriv->bkeepfwalive = _TRUE; ++ ++ rtw_ips_pwr_down(padapter); ++ pwrpriv->rf_pwrstate = rf_off; ++ } ++ pwrpriv->bips_processing = _FALSE; ++ ++} ++ ++void ips_enter(_adapter *padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_IpsNotify(padapter, pwrpriv->ips_mode_req); ++#endif /* CONFIG_BT_COEXIST */ ++ ++ _enter_pwrlock(&pwrpriv->lock); ++ _ips_enter(padapter); ++ _exit_pwrlock(&pwrpriv->lock); ++} ++ ++int _ips_leave(_adapter *padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ int result = _SUCCESS; ++ ++ if ((pwrpriv->rf_pwrstate == rf_off) && (!pwrpriv->bips_processing)) { ++ pwrpriv->bips_processing = _TRUE; ++ pwrpriv->change_rfpwrstate = rf_on; ++ pwrpriv->ips_leave_cnts++; ++ RTW_INFO("==>ips_leave cnts:%d\n", pwrpriv->ips_leave_cnts); ++ ++ result = rtw_ips_pwr_up(padapter); ++ if (result == _SUCCESS) ++ pwrpriv->rf_pwrstate = rf_on; ++ RTW_PRINT("nolinked power save leave\n"); ++ ++ RTW_INFO("==> ips_leave.....LED(0x%08x)...\n", rtw_read32(padapter, 0x4c)); ++ pwrpriv->bips_processing = _FALSE; ++ ++ pwrpriv->bkeepfwalive = _FALSE; ++ pwrpriv->bpower_saving = _FALSE; ++ } ++ ++ return result; ++} ++ ++int ips_leave(_adapter *padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ int ret; ++ ++ if (!is_primary_adapter(padapter)) ++ return _SUCCESS; ++ ++ _enter_pwrlock(&pwrpriv->lock); ++ ret = _ips_leave(padapter); ++#ifdef DBG_CHECK_FW_PS_STATE ++ if (rtw_fw_ps_state(padapter) == _FAIL) { ++ RTW_INFO("ips leave doesn't leave 32k\n"); ++ pdbgpriv->dbg_leave_ips_fail_cnt++; ++ } ++#endif /* DBG_CHECK_FW_PS_STATE */ ++ _exit_pwrlock(&pwrpriv->lock); ++ ++ if (_SUCCESS == ret) ++ ODM_DMReset(&GET_HAL_DATA(padapter)->odmpriv); ++ ++#ifdef CONFIG_BT_COEXIST ++ if (_SUCCESS == ret) ++ rtw_btcoex_IpsNotify(padapter, IPS_NONE); ++#endif /* CONFIG_BT_COEXIST */ ++ ++ return ret; ++} ++#endif /* CONFIG_IPS */ ++ ++#ifdef CONFIG_AUTOSUSPEND ++ extern void autosuspend_enter(_adapter *padapter); ++ extern int autoresume_enter(_adapter *padapter); ++#endif ++ ++#ifdef SUPPORT_HW_RFOFF_DETECTED ++ int rtw_hw_suspend(_adapter *padapter); ++ int rtw_hw_resume(_adapter *padapter); ++#endif ++ ++bool rtw_pwr_unassociated_idle(_adapter *adapter) ++{ ++ u8 i; ++ _adapter *iface; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct xmit_priv *pxmit_priv = &adapter->xmitpriv; ++ struct mlme_priv *pmlmepriv; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo; ++#ifdef CONFIG_IOCTL_CFG80211 ++ struct cfg80211_wifidirect_info *pcfg80211_wdinfo; ++#endif ++#endif ++ ++ bool ret = _FALSE; ++ ++ if (adapter_to_pwrctl(adapter)->bpower_saving == _TRUE) { ++ /* RTW_INFO("%s: already in LPS or IPS mode\n", __func__); */ ++ goto exit; ++ } ++ ++ if (adapter_to_pwrctl(adapter)->ips_deny_time >= rtw_get_current_time()) { ++ /* RTW_INFO("%s ips_deny_time\n", __func__); */ ++ goto exit; ++ } ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ pmlmepriv = &(iface->mlmepriv); ++#ifdef CONFIG_P2P ++ pwdinfo = &(iface->wdinfo); ++#ifdef CONFIG_IOCTL_CFG80211 ++ pcfg80211_wdinfo = &iface->cfg80211_wdinfo; ++#endif ++#endif ++ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE | WIFI_SITE_MONITOR) ++ || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS) ++ || check_fwstate(pmlmepriv, WIFI_AP_STATE) ++ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE) ++#if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) ++ || rtw_cfg80211_get_is_roch(iface) == _TRUE ++#elif defined(CONFIG_P2P) ++ || rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE) ++ || rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) ++#endif ++#if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) ++ || rtw_get_passing_time_ms(pcfg80211_wdinfo->last_ro_ch_time) < 3000 ++#endif ++ ) ++ goto exit; ++ ++ } ++ } ++ ++#if (MP_DRIVER == 1) ++ if (adapter->registrypriv.mp_mode == 1) ++ goto exit; ++#endif ++ ++#ifdef CONFIG_INTEL_PROXIM ++ if (adapter->proximity.proxim_on == _TRUE) ++ return; ++#endif ++ ++ if (pxmit_priv->free_xmitbuf_cnt != NR_XMITBUFF || ++ pxmit_priv->free_xmit_extbuf_cnt != NR_XMIT_EXTBUFF) { ++ RTW_PRINT("There are some pkts to transmit\n"); ++ RTW_PRINT("free_xmitbuf_cnt: %d, free_xmit_extbuf_cnt: %d\n", ++ pxmit_priv->free_xmitbuf_cnt, pxmit_priv->free_xmit_extbuf_cnt); ++ goto exit; ++ } ++ ++ ret = _TRUE; ++ ++exit: ++ return ret; ++} ++ ++ ++/* ++ * ATTENTION: ++ * rtw_ps_processor() doesn't handle LPS. ++ */ ++void rtw_ps_processor(_adapter *padapter) ++{ ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif /* CONFIG_P2P */ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++#ifdef SUPPORT_HW_RFOFF_DETECTED ++ rt_rf_power_state rfpwrstate; ++#endif /* SUPPORT_HW_RFOFF_DETECTED */ ++ u32 ps_deny = 0; ++ ++ _enter_pwrlock(&adapter_to_pwrctl(padapter)->lock); ++ ps_deny = rtw_ps_deny_get(padapter); ++ _exit_pwrlock(&adapter_to_pwrctl(padapter)->lock); ++ if (ps_deny != 0) { ++ RTW_INFO(FUNC_ADPT_FMT ": ps_deny=0x%08X, skip power save!\n", ++ FUNC_ADPT_ARG(padapter), ps_deny); ++ goto exit; ++ } ++ ++ if (pwrpriv->bInSuspend == _TRUE) { /* system suspend or autosuspend */ ++ pdbgpriv->dbg_ps_insuspend_cnt++; ++ RTW_INFO("%s, pwrpriv->bInSuspend == _TRUE ignore this process\n", __FUNCTION__); ++ return; ++ } ++ ++ pwrpriv->ps_processing = _TRUE; ++ ++#ifdef SUPPORT_HW_RFOFF_DETECTED ++ if (pwrpriv->bips_processing == _TRUE) ++ goto exit; ++ ++ /* RTW_INFO("==> fw report state(0x%x)\n",rtw_read8(padapter,0x1ca)); */ ++ if (pwrpriv->bHWPwrPindetect) { ++#ifdef CONFIG_AUTOSUSPEND ++ if (padapter->registrypriv.usbss_enable) { ++ if (pwrpriv->rf_pwrstate == rf_on) { ++ if (padapter->net_closed == _TRUE) ++ pwrpriv->ps_flag = _TRUE; ++ ++ rfpwrstate = RfOnOffDetect(padapter); ++ RTW_INFO("@@@@- #1 %s==> rfstate:%s\n", __FUNCTION__, (rfpwrstate == rf_on) ? "rf_on" : "rf_off"); ++ if (rfpwrstate != pwrpriv->rf_pwrstate) { ++ if (rfpwrstate == rf_off) { ++ pwrpriv->change_rfpwrstate = rf_off; ++ ++ pwrpriv->bkeepfwalive = _TRUE; ++ pwrpriv->brfoffbyhw = _TRUE; ++ ++ autosuspend_enter(padapter); ++ } ++ } ++ } ++ } else ++#endif /* CONFIG_AUTOSUSPEND */ ++ { ++ rfpwrstate = RfOnOffDetect(padapter); ++ RTW_INFO("@@@@- #2 %s==> rfstate:%s\n", __FUNCTION__, (rfpwrstate == rf_on) ? "rf_on" : "rf_off"); ++ ++ if (rfpwrstate != pwrpriv->rf_pwrstate) { ++ if (rfpwrstate == rf_off) { ++ pwrpriv->change_rfpwrstate = rf_off; ++ pwrpriv->brfoffbyhw = _TRUE; ++ rtw_hw_suspend(padapter); ++ } else { ++ pwrpriv->change_rfpwrstate = rf_on; ++ rtw_hw_resume(padapter); ++ } ++ RTW_INFO("current rf_pwrstate(%s)\n", (pwrpriv->rf_pwrstate == rf_off) ? "rf_off" : "rf_on"); ++ } ++ } ++ pwrpriv->pwr_state_check_cnts++; ++ } ++#endif /* SUPPORT_HW_RFOFF_DETECTED */ ++ ++ if (pwrpriv->ips_mode_req == IPS_NONE) ++ goto exit; ++ ++ if (rtw_pwr_unassociated_idle(padapter) == _FALSE) ++ goto exit; ++ ++ if ((pwrpriv->rf_pwrstate == rf_on) && ((pwrpriv->pwr_state_check_cnts % 4) == 0)) { ++ RTW_INFO("==>%s .fw_state(%x)\n", __FUNCTION__, get_fwstate(pmlmepriv)); ++#if defined(CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) ++#else ++ pwrpriv->change_rfpwrstate = rf_off; ++#endif ++#ifdef CONFIG_AUTOSUSPEND ++ if (padapter->registrypriv.usbss_enable) { ++ if (pwrpriv->bHWPwrPindetect) ++ pwrpriv->bkeepfwalive = _TRUE; ++ ++ if (padapter->net_closed == _TRUE) ++ pwrpriv->ps_flag = _TRUE; ++ ++#if defined(CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) ++ if (_TRUE == pwrpriv->bInternalAutoSuspend) ++ RTW_INFO("<==%s .pwrpriv->bInternalAutoSuspend)(%x)\n", __FUNCTION__, pwrpriv->bInternalAutoSuspend); ++ else { ++ pwrpriv->change_rfpwrstate = rf_off; ++ RTW_INFO("<==%s .pwrpriv->bInternalAutoSuspend)(%x) call autosuspend_enter\n", __FUNCTION__, pwrpriv->bInternalAutoSuspend); ++ autosuspend_enter(padapter); ++ } ++#else ++ autosuspend_enter(padapter); ++#endif /* if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) */ ++ } else if (pwrpriv->bHWPwrPindetect) { ++ } else ++#endif /* CONFIG_AUTOSUSPEND */ ++ { ++#if defined(CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) ++ pwrpriv->change_rfpwrstate = rf_off; ++#endif /* defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) */ ++ ++#ifdef CONFIG_IPS ++ ips_enter(padapter); ++#endif ++ } ++ } ++exit: ++#ifndef CONFIG_IPS_CHECK_IN_WD ++ rtw_set_pwr_state_check_timer(pwrpriv); ++#endif ++ pwrpriv->ps_processing = _FALSE; ++ return; ++} ++ ++void pwr_state_check_handler(RTW_TIMER_HDL_ARGS); ++void pwr_state_check_handler(RTW_TIMER_HDL_ARGS) ++{ ++ _adapter *padapter = (_adapter *)FunctionContext; ++ rtw_ps_cmd(padapter); ++} ++ ++#ifdef CONFIG_LPS ++void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets) ++{ ++#ifdef CONFIG_CHECK_LEAVE_LPS ++ static u32 start_time = 0; ++ static u32 xmit_cnt = 0; ++ u8 bLeaveLPS = _FALSE; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ ++ ++ if (tx) { /* from tx */ ++ xmit_cnt += tx_packets; ++ ++ if (start_time == 0) ++ start_time = rtw_get_current_time(); ++ ++ if (rtw_get_passing_time_ms(start_time) > 2000) { /* 2 sec == watch dog timer */ ++ if (xmit_cnt > 8) { ++ if ((adapter_to_pwrctl(padapter)->bLeisurePs) ++ && (adapter_to_pwrctl(padapter)->pwr_mode != PS_MODE_ACTIVE) ++#ifdef CONFIG_BT_COEXIST ++ && (rtw_btcoex_IsBtControlLps(padapter) == _FALSE) ++#endif ++ ) { ++ /* RTW_INFO("leave lps via Tx = %d\n", xmit_cnt); */ ++ bLeaveLPS = _TRUE; ++ } ++ } ++ ++ start_time = rtw_get_current_time(); ++ xmit_cnt = 0; ++ } ++ ++ } else { /* from rx path */ ++ if (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 4/*2*/) { ++ if ((adapter_to_pwrctl(padapter)->bLeisurePs) ++ && (adapter_to_pwrctl(padapter)->pwr_mode != PS_MODE_ACTIVE) ++#ifdef CONFIG_BT_COEXIST ++ && (rtw_btcoex_IsBtControlLps(padapter) == _FALSE) ++#endif ++ ) { ++ /* RTW_INFO("leave lps via Rx = %d\n", pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); */ ++ bLeaveLPS = _TRUE; ++ } ++ } ++ } ++ ++ if (bLeaveLPS) { ++ /* RTW_INFO("leave lps via %s, Tx = %d, Rx = %d\n", tx?"Tx":"Rx", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod,pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); */ ++ /* rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); */ ++ rtw_lps_ctrl_wk_cmd(padapter, tx ? LPS_CTRL_TX_TRAFFIC_LEAVE : LPS_CTRL_RX_TRAFFIC_LEAVE, tx ? 0 : 1); ++ } ++#endif /* CONFIG_CHECK_LEAVE_LPS */ ++} ++ ++/* ++ * Description: ++ * This function MUST be called under power lock protect ++ * ++ * Parameters ++ * padapter ++ * pslv power state level, only could be PS_STATE_S0 ~ PS_STATE_S4 ++ * ++ */ ++void rtw_set_rpwm(PADAPTER padapter, u8 pslv) ++{ ++ u8 rpwm; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++#ifdef CONFIG_DETECT_CPWM_BY_POLLING ++ u8 cpwm_orig; ++#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ ++ pslv = PS_STATE(pslv); ++ ++#ifdef CONFIG_LPS_RPWM_TIMER ++ if (pwrpriv->brpwmtimeout == _TRUE) ++ RTW_INFO("%s: RPWM timeout, force to set RPWM(0x%02X) again!\n", __FUNCTION__, pslv); ++ else ++#endif /* CONFIG_LPS_RPWM_TIMER */ ++ { ++ if ((pwrpriv->rpwm == pslv) ++#ifdef CONFIG_LPS_LCLK ++ || ((pwrpriv->rpwm >= PS_STATE_S2) && (pslv >= PS_STATE_S2)) ++#endif ++ ) { ++ return; ++ } ++ } ++ ++ if (rtw_is_surprise_removed(padapter) || ++ (!rtw_is_hw_init_completed(padapter))) { ++ ++ pwrpriv->cpwm = PS_STATE_S4; ++ ++ return; ++ } ++ ++ if (rtw_is_drv_stopped(padapter)) { ++ ++ if (pslv < PS_STATE_S2) { ++ return; ++ } ++ } ++ ++ rpwm = pslv | pwrpriv->tog; ++#ifdef CONFIG_LPS_LCLK ++ /* only when from PS_STATE S0/S1 to S2 and higher needs ACK */ ++ if ((pwrpriv->cpwm < PS_STATE_S2) && (pslv >= PS_STATE_S2)) ++ rpwm |= PS_ACK; ++#endif ++ ++ pwrpriv->rpwm = pslv; ++ ++#ifdef CONFIG_DETECT_CPWM_BY_POLLING ++ cpwm_orig = 0; ++ if (rpwm & PS_ACK) ++ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig); ++#endif ++ ++#if defined(CONFIG_LPS_RPWM_TIMER) && !defined(CONFIG_DETECT_CPWM_BY_POLLING) ++ if (rpwm & PS_ACK) ++ _set_timer(&pwrpriv->pwr_rpwm_timer, LPS_RPWM_WAIT_MS); ++#endif /* CONFIG_LPS_RPWM_TIMER & !CONFIG_DETECT_CPWM_BY_POLLING */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); ++ ++ pwrpriv->tog += 0x80; ++ ++#ifdef CONFIG_LPS_LCLK ++ /* No LPS 32K, No Ack */ ++ if (rpwm & PS_ACK) { ++#ifdef CONFIG_DETECT_CPWM_BY_POLLING ++ u32 start_time; ++ u8 cpwm_now; ++ u8 poll_cnt = 0; ++ ++ start_time = rtw_get_current_time(); ++ ++ /* polling cpwm */ ++ do { ++ rtw_msleep_os(1); ++ poll_cnt++; ++ cpwm_now = 0; ++ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_now); ++ if ((cpwm_orig ^ cpwm_now) & 0x80) { ++ pwrpriv->cpwm = PS_STATE_S4; ++ pwrpriv->cpwm_tog = cpwm_now & PS_TOGGLE; ++#ifdef DBG_CHECK_FW_PS_STATE ++ RTW_INFO("%s: polling cpwm OK! poll_cnt=%d, cpwm_orig=%02x, cpwm_now=%02x , 0x100=0x%x\n" ++ , __FUNCTION__, poll_cnt, cpwm_orig, cpwm_now, rtw_read8(padapter, REG_CR)); ++ if (rtw_fw_ps_state(padapter) == _FAIL) { ++ RTW_INFO("leave 32k but fw state in 32k\n"); ++ pdbgpriv->dbg_rpwm_toogle_cnt++; ++ } ++#endif /* DBG_CHECK_FW_PS_STATE */ ++ break; ++ } ++ ++ if (rtw_get_passing_time_ms(start_time) > LPS_RPWM_WAIT_MS) { ++ RTW_INFO("%s: polling cpwm timeout! poll_cnt=%d, cpwm_orig=%02x, cpwm_now=%02x\n", __FUNCTION__, poll_cnt, cpwm_orig, cpwm_now); ++#ifdef DBG_CHECK_FW_PS_STATE ++ if (rtw_fw_ps_state(padapter) == _FAIL) { ++ RTW_INFO("rpwm timeout and fw ps state in 32k\n"); ++ pdbgpriv->dbg_rpwm_timeout_fail_cnt++; ++ } ++#endif /* DBG_CHECK_FW_PS_STATE */ ++#ifdef CONFIG_LPS_RPWM_TIMER ++ _set_timer(&pwrpriv->pwr_rpwm_timer, 1); ++#endif /* CONFIG_LPS_RPWM_TIMER */ ++ break; ++ } ++ } while (1); ++#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ ++ } else ++#endif /* CONFIG_LPS_LCLK */ ++ { ++ pwrpriv->cpwm = pslv; ++ } ++ ++} ++ ++u8 PS_RDY_CHECK(_adapter *padapter) ++{ ++ u32 curr_time, delta_time; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#ifdef CONFIG_IOCTL_CFG80211 ++ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; ++#endif /* CONFIG_IOCTL_CFG80211 */ ++#endif /* CONFIG_P2P */ ++ ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++ if (_TRUE == pwrpriv->bInSuspend && pwrpriv->wowlan_mode) ++ return _TRUE; ++ else if (_TRUE == pwrpriv->bInSuspend && pwrpriv->wowlan_ap_mode) ++ return _TRUE; ++ else if (_TRUE == pwrpriv->bInSuspend) ++ return _FALSE; ++#else ++ if (_TRUE == pwrpriv->bInSuspend) ++ return _FALSE; ++#endif ++ ++ curr_time = rtw_get_current_time(); ++ ++ delta_time = curr_time - pwrpriv->DelayLPSLastTimeStamp; ++ ++ if (delta_time < LPS_DELAY_TIME) ++ return _FALSE; ++ ++ if (check_fwstate(pmlmepriv, WIFI_SITE_MONITOR) ++ || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS) ++ || check_fwstate(pmlmepriv, WIFI_AP_STATE) ++ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE) ++#if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) ++ || rtw_cfg80211_get_is_roch(padapter) == _TRUE ++#endif ++ || rtw_is_scan_deny(padapter) ++#ifdef CONFIG_TDLS ++ /* TDLS link is established. */ ++ || (padapter->tdlsinfo.link_established == _TRUE) ++#endif /* CONFIG_TDLS */ ++ ) ++ return _FALSE; ++ ++ if ((padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) && (padapter->securitypriv.binstallGrpkey == _FALSE)) { ++ RTW_INFO("Group handshake still in progress !!!\n"); ++ return _FALSE; ++ } ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (!rtw_cfg80211_pwr_mgmt(padapter)) ++ return _FALSE; ++#endif ++ ++ return _TRUE; ++} ++ ++#if defined(CONFIG_FWLPS_IN_IPS) ++void rtw_set_fw_in_ips_mode(PADAPTER padapter, u8 enable) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ int cnt = 0; ++ u32 start_time; ++ u8 val8 = 0; ++ u8 cpwm_orig = 0, cpwm_now = 0; ++ u8 parm[H2C_INACTIVE_PS_LEN] = {0}; ++ ++ if (padapter->netif_up == _FALSE) { ++ RTW_INFO("%s: ERROR, netif is down\n", __func__); ++ return; ++ } ++ ++ /* u8 cmd_param; */ /* BIT0:enable, BIT1:NoConnect32k */ ++ if (enable) { ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_IpsNotify(padapter, pwrpriv->ips_mode_req); ++#endif ++ /* Enter IPS */ ++ RTW_INFO("%s: issue H2C to FW when entering IPS\n", __func__); ++ ++ parm[0] = 0x1;/* suggest by Isaac.Hsu*/ ++#ifdef CONFIG_PNO_SUPPORT ++ if (pwrpriv->pno_inited) { ++ parm[1] = pwrpriv->pnlo_info->fast_scan_iterations; ++ parm[2] = pwrpriv->pnlo_info->slow_scan_period; ++ } ++#endif ++ ++ rtw_hal_fill_h2c_cmd(padapter, /* H2C_FWLPS_IN_IPS_, */ ++ H2C_INACTIVE_PS_, ++ H2C_INACTIVE_PS_LEN, parm); ++ /* poll 0x1cc to make sure H2C command already finished by FW; MAC_0x1cc=0 means H2C done by FW. */ ++ do { ++ val8 = rtw_read8(padapter, REG_HMETFR); ++ cnt++; ++ RTW_INFO("%s polling REG_HMETFR=0x%x, cnt=%d\n", ++ __func__, val8, cnt); ++ rtw_mdelay_os(10); ++ } while (cnt < 100 && (val8 != 0)); ++ ++#ifdef CONFIG_LPS_LCLK ++ /* H2C done, enter 32k */ ++ if (val8 == 0) { ++ /* ser rpwm to enter 32k */ ++ val8 = rtw_read8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1); ++ RTW_INFO("%s: read rpwm=%02x\n", __FUNCTION__, val8); ++ val8 += 0x80; ++ val8 |= BIT(0); ++ rtw_write8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1, val8); ++ RTW_INFO("%s: write rpwm=%02x\n", __FUNCTION__, val8); ++ adapter_to_pwrctl(padapter)->tog = (val8 + 0x80) & 0x80; ++ cnt = val8 = 0; ++ if (parm[1] == 0 || parm[2] == 0) { ++ do { ++ val8 = rtw_read8(padapter, REG_CR); ++ cnt++; ++ RTW_INFO("%s polling 0x100=0x%x, cnt=%d\n", ++ __func__, val8, cnt); ++ RTW_INFO("%s 0x08:%02x, 0x03:%02x\n", ++ __func__, ++ rtw_read8(padapter, 0x08), ++ rtw_read8(padapter, 0x03)); ++ rtw_mdelay_os(10); ++ } while (cnt < 20 && (val8 != 0xEA)); ++ } ++ } ++#endif ++ } else { ++ /* Leave IPS */ ++ RTW_INFO("%s: Leaving IPS in FWLPS state\n", __func__); ++ ++#ifdef CONFIG_LPS_LCLK ++ /* for polling cpwm */ ++ cpwm_orig = 0; ++ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig); ++ ++ /* ser rpwm */ ++ val8 = rtw_read8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1); ++ val8 &= 0x80; ++ val8 += 0x80; ++ val8 |= BIT(6); ++ rtw_write8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1, val8); ++ RTW_INFO("%s: write rpwm=%02x\n", __FUNCTION__, val8); ++ adapter_to_pwrctl(padapter)->tog = (val8 + 0x80) & 0x80; ++ ++ /* do polling cpwm */ ++ start_time = rtw_get_current_time(); ++ do { ++ ++ rtw_mdelay_os(1); ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_now); ++ if ((cpwm_orig ^ cpwm_now) & 0x80) ++ break; ++ ++ if (rtw_get_passing_time_ms(start_time) > 100) { ++ RTW_INFO("%s: polling cpwm timeout when leaving IPS in FWLPS state\n", __FUNCTION__); ++ break; ++ } ++ } while (1); ++ ++#endif ++ parm[0] = 0x0; ++ parm[1] = 0x0; ++ parm[2] = 0x0; ++ rtw_hal_fill_h2c_cmd(padapter, H2C_INACTIVE_PS_, ++ H2C_INACTIVE_PS_LEN, parm); ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_IpsNotify(padapter, IPS_NONE); ++#endif ++ } ++} ++#endif /* CONFIG_PNO_SUPPORT */ ++ ++void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode, const char *msg) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif /* CONFIG_P2P */ ++#ifdef CONFIG_TDLS ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ _irqL irqL; ++ int i, j; ++ _list *plist, *phead; ++ struct sta_info *ptdls_sta; ++#endif /* CONFIG_TDLS */ ++ ++ ++ ++ if (ps_mode > PM_Card_Disable) { ++ return; ++ } ++ ++ if (pwrpriv->pwr_mode == ps_mode) { ++ if (PS_MODE_ACTIVE == ps_mode) ++ return; ++ ++#ifndef CONFIG_BT_COEXIST ++ if ((pwrpriv->smart_ps == smart_ps) && ++ (pwrpriv->bcn_ant_mode == bcn_ant_mode)) ++ return; ++#endif /* !CONFIG_BT_COEXIST */ ++ } ++ ++#ifdef CONFIG_LPS_PG ++ if ((PS_MODE_ACTIVE != ps_mode) && (pwrpriv->blpspg_info_up)) ++ rtw_hal_set_lps_pg_info(padapter); ++#endif ++ ++#ifdef CONFIG_LPS_LCLK ++ _enter_pwrlock(&pwrpriv->lock); ++#endif ++ ++ /* if(pwrpriv->pwr_mode == PS_MODE_ACTIVE) */ ++ if (ps_mode == PS_MODE_ACTIVE) { ++ if (1 ++#ifdef CONFIG_BT_COEXIST ++ && (((rtw_btcoex_IsBtControlLps(padapter) == _FALSE) ++#ifdef CONFIG_P2P_PS ++ && (pwdinfo->opp_ps == 0) ++#endif /* CONFIG_P2P_PS */ ++ ) ++ || ((rtw_btcoex_IsBtControlLps(padapter) == _TRUE) ++ && (rtw_btcoex_IsLpsOn(padapter) == _FALSE)) ++ ) ++#else /* !CONFIG_BT_COEXIST */ ++#ifdef CONFIG_P2P_PS ++ && (pwdinfo->opp_ps == 0) ++#endif /* CONFIG_P2P_PS */ ++#endif /* !CONFIG_BT_COEXIST */ ++ ) { ++ RTW_INFO(FUNC_ADPT_FMT" Leave 802.11 power save - %s\n", ++ FUNC_ADPT_ARG(padapter), msg); ++ ++ if (pwrpriv->lps_leave_cnts < UINT_MAX) ++ pwrpriv->lps_leave_cnts++; ++ else ++ pwrpriv->lps_leave_cnts = 0; ++#ifdef CONFIG_TDLS ++ for (i = 0; i < NUM_STA; i++) { ++ phead = &(pstapriv->sta_hash[i]); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ ptdls_sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); ++ ++ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) ++ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 0, 0, 0); ++ plist = get_next(plist); ++ } ++ } ++#endif /* CONFIG_TDLS */ ++ ++ pwrpriv->pwr_mode = ps_mode; ++ rtw_set_rpwm(padapter, PS_STATE_S4); ++ ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_P2P_WOWLAN) ++ if (pwrpriv->wowlan_mode == _TRUE || ++ pwrpriv->wowlan_ap_mode == _TRUE || ++ pwrpriv->wowlan_p2p_mode == _TRUE) { ++ u32 start_time, delay_ms; ++ u8 val8; ++ delay_ms = 20; ++ start_time = rtw_get_current_time(); ++ do { ++ rtw_hal_get_hwreg(padapter, HW_VAR_SYS_CLKR, &val8); ++ if (!(val8 & BIT(4))) { /* 0x08 bit4 =1 --> in 32k, bit4 = 0 --> leave 32k */ ++ pwrpriv->cpwm = PS_STATE_S4; ++ break; ++ } ++ if (rtw_get_passing_time_ms(start_time) > delay_ms) { ++ RTW_INFO("%s: Wait for FW 32K leave more than %u ms!!!\n", ++ __FUNCTION__, delay_ms); ++ pdbgpriv->dbg_wow_leave_ps_fail_cnt++; ++ break; ++ } ++ rtw_usleep_os(100); ++ } while (1); ++ } ++#endif ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); ++#ifdef CONFIG_LPS_POFF ++ rtw_hal_set_hwreg(padapter, HW_VAR_LPS_POFF_SET_MODE, ++ (u8 *)(&ps_mode)); ++#endif /*CONFIG_LPS_POFF*/ ++ ++ pwrpriv->bFwCurrentInPSMode = _FALSE; ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_LpsNotify(padapter, ps_mode); ++#endif /* CONFIG_BT_COEXIST */ ++ } ++ } else { ++ if ((PS_RDY_CHECK(padapter) && check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE)) ++#ifdef CONFIG_BT_COEXIST ++ || ((rtw_btcoex_IsBtControlLps(padapter) == _TRUE) ++ && (rtw_btcoex_IsLpsOn(padapter) == _TRUE)) ++#endif ++#ifdef CONFIG_P2P_WOWLAN ++ || (_TRUE == pwrpriv->wowlan_p2p_mode) ++#endif /* CONFIG_P2P_WOWLAN */ ++ ) { ++ u8 pslv; ++ ++ RTW_INFO(FUNC_ADPT_FMT" Enter 802.11 power save - %s\n", ++ FUNC_ADPT_ARG(padapter), msg); ++ ++ if (pwrpriv->lps_enter_cnts < UINT_MAX) ++ pwrpriv->lps_enter_cnts++; ++ else ++ pwrpriv->lps_enter_cnts = 0; ++#ifdef CONFIG_TDLS ++ for (i = 0; i < NUM_STA; i++) { ++ phead = &(pstapriv->sta_hash[i]); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ ptdls_sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); ++ ++ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) ++ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 1, 0, 0); ++ plist = get_next(plist); ++ } ++ } ++#endif /* CONFIG_TDLS */ ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_LpsNotify(padapter, ps_mode); ++#endif /* CONFIG_BT_COEXIST */ ++ ++#ifdef CONFIG_LPS_POFF ++ rtw_hal_set_hwreg(padapter, HW_VAR_LPS_POFF_SET_MODE, ++ (u8 *)(&ps_mode)); ++#endif /*CONFIG_LPS_POFF*/ ++ ++ pwrpriv->bFwCurrentInPSMode = _TRUE; ++ pwrpriv->pwr_mode = ps_mode; ++ pwrpriv->smart_ps = smart_ps; ++ pwrpriv->bcn_ant_mode = bcn_ant_mode; ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); ++ ++#ifdef CONFIG_P2P_PS ++ /* Set CTWindow after LPS */ ++ if (pwdinfo->opp_ps == 1) ++ p2p_ps_wk_cmd(padapter, P2P_PS_ENABLE, 0); ++#endif /* CONFIG_P2P_PS */ ++ ++ pslv = PS_STATE_S2; ++#ifdef CONFIG_LPS_LCLK ++ if (pwrpriv->alives == 0) ++ pslv = PS_STATE_S0; ++#endif /* CONFIG_LPS_LCLK */ ++ ++#ifdef CONFIG_BT_COEXIST ++ if ((rtw_btcoex_IsBtDisabled(padapter) == _FALSE) ++ && (rtw_btcoex_IsBtControlLps(padapter) == _TRUE)) { ++ u8 val8; ++ ++ val8 = rtw_btcoex_LpsVal(padapter); ++ if (val8 & BIT(4)) ++ pslv = PS_STATE_S2; ++ ++ } ++#endif /* CONFIG_BT_COEXIST */ ++ ++ rtw_set_rpwm(padapter, pslv); ++ } ++ } ++ ++#ifdef CONFIG_LPS_LCLK ++ _exit_pwrlock(&pwrpriv->lock); ++#endif ++ ++} ++ ++/* ++ * Return: ++ * 0: Leave OK ++ * -1: Timeout ++ * -2: Other error ++ */ ++s32 LPS_RF_ON_check(PADAPTER padapter, u32 delay_ms) ++{ ++ u32 start_time; ++ u8 bAwake = _FALSE; ++ s32 err = 0; ++ ++ ++ start_time = rtw_get_current_time(); ++ while (1) { ++ rtw_hal_get_hwreg(padapter, HW_VAR_FWLPS_RF_ON, &bAwake); ++ if (_TRUE == bAwake) ++ break; ++ ++ if (rtw_is_surprise_removed(padapter)) { ++ err = -2; ++ RTW_INFO("%s: device surprise removed!!\n", __FUNCTION__); ++ break; ++ } ++ ++ if (rtw_get_passing_time_ms(start_time) > delay_ms) { ++ err = -1; ++ RTW_INFO("%s: Wait for FW LPS leave more than %u ms!!!\n", __FUNCTION__, delay_ms); ++ break; ++ } ++ rtw_usleep_os(100); ++ } ++ ++ return err; ++} ++ ++/* ++ * Description: ++ * Enter the leisure power save mode. ++ * */ ++void LPS_Enter(PADAPTER padapter, const char *msg) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ int n_assoc_iface = 0; ++ int i; ++ char buf[32] = {0}; ++ ++ ++ /* RTW_INFO("+LeisurePSEnter\n"); */ ++ if (_FALSE == padapter->bFWReady) ++ return; ++ ++#ifdef CONFIG_BT_COEXIST ++ if (rtw_btcoex_IsBtControlLps(padapter) == _TRUE) ++ return; ++#endif ++ ++ /* Skip lps enter request if number of assocated adapters is not 1 */ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) ++ n_assoc_iface++; ++ } ++ if (n_assoc_iface != 1) ++ return; ++ ++ /* Skip lps enter request for adapter not port0 */ ++ if (get_hw_port(padapter) != HW_PORT0) ++ return; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (PS_RDY_CHECK(dvobj->padapters[i]) == _FALSE) ++ return; ++ } ++ ++#ifdef CONFIG_P2P_PS ++ if (padapter->wdinfo.p2p_ps_mode == P2P_PS_NOA) { ++ return;/* supporting p2p client ps NOA via H2C_8723B_P2P_PS_OFFLOAD */ ++ } ++#endif /* CONFIG_P2P_PS */ ++ ++ if (pwrpriv->bLeisurePs) { ++ /* Idle for a while if we connect to AP a while ago. */ ++ if (pwrpriv->LpsIdleCount >= 2) { /* 4 Sec */ ++ if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) { ++ sprintf(buf, "WIFI-%s", msg); ++ pwrpriv->bpower_saving = _TRUE; ++ rtw_set_ps_mode(padapter, pwrpriv->power_mgnt, padapter->registrypriv.smart_ps, 0, buf); ++ } ++ } else ++ pwrpriv->LpsIdleCount++; ++ } ++ ++ /* RTW_INFO("-LeisurePSEnter\n"); */ ++ ++} ++ ++/* ++ * Description: ++ * Leave the leisure power save mode. ++ * */ ++void LPS_Leave(PADAPTER padapter, const char *msg) ++{ ++#define LPS_LEAVE_TIMEOUT_MS 100 ++ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); ++ u32 start_time; ++ u8 bAwake = _FALSE; ++ char buf[32] = {0}; ++ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; ++ ++ ++ /* RTW_INFO("+LeisurePSLeave\n"); */ ++ ++#ifdef CONFIG_BT_COEXIST ++ if (rtw_btcoex_IsBtControlLps(padapter) == _TRUE) ++ return; ++#endif ++ ++ if (pwrpriv->bLeisurePs) { ++ if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) { ++ sprintf(buf, "WIFI-%s", msg); ++ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, buf); ++ ++ if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) ++ LPS_RF_ON_check(padapter, LPS_LEAVE_TIMEOUT_MS); ++ } ++ } ++ ++ pwrpriv->bpower_saving = _FALSE; ++#ifdef DBG_CHECK_FW_PS_STATE ++ if (rtw_fw_ps_state(padapter) == _FAIL) { ++ RTW_INFO("leave lps, fw in 32k\n"); ++ pdbgpriv->dbg_leave_lps_fail_cnt++; ++ } ++#endif /* DBG_CHECK_FW_PS_STATE ++ * RTW_INFO("-LeisurePSLeave\n"); */ ++ ++} ++#endif ++ ++void LeaveAllPowerSaveModeDirect(PADAPTER Adapter) ++{ ++ PADAPTER pri_padapter = GET_PRIMARY_ADAPTER(Adapter); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); ++ struct dvobj_priv *psdpriv = Adapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++#ifndef CONFIG_DETECT_CPWM_BY_POLLING ++ u8 cpwm_orig, cpwm_now; ++ u32 start_time; ++#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ ++ ++ ++ RTW_INFO("%s.....\n", __FUNCTION__); ++ ++ if (rtw_is_surprise_removed(Adapter)) { ++ RTW_INFO(FUNC_ADPT_FMT ": bSurpriseRemoved=_TRUE Skip!\n", FUNC_ADPT_ARG(Adapter)); ++ return; ++ } ++ ++ if (rtw_mi_check_status(Adapter, MI_LINKED)) { /*connect*/ ++ ++ if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) { ++ RTW_INFO("%s: Driver Already Leave LPS\n", __FUNCTION__); ++ return; ++ } ++ ++#ifdef CONFIG_LPS_LCLK ++ _enter_pwrlock(&pwrpriv->lock); ++ ++#ifndef CONFIG_DETECT_CPWM_BY_POLLING ++ cpwm_orig = 0; ++ rtw_hal_get_hwreg(Adapter, HW_VAR_CPWM, &cpwm_orig); ++#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ ++ rtw_set_rpwm(Adapter, PS_STATE_S4); ++ ++#ifndef CONFIG_DETECT_CPWM_BY_POLLING ++ ++ start_time = rtw_get_current_time(); ++ ++ /* polling cpwm */ ++ do { ++ rtw_mdelay_os(1); ++ ++ rtw_hal_get_hwreg(Adapter, HW_VAR_CPWM, &cpwm_now); ++ if ((cpwm_orig ^ cpwm_now) & 0x80) { ++ pwrpriv->cpwm = PS_STATE_S4; ++ pwrpriv->cpwm_tog = cpwm_now & PS_TOGGLE; ++#ifdef DBG_CHECK_FW_PS_STATE ++ RTW_INFO("%s: polling cpwm OK! cpwm_orig=%02x, cpwm_now=%02x, 0x100=0x%x\n" ++ , __FUNCTION__, cpwm_orig, cpwm_now, rtw_read8(Adapter, REG_CR)); ++ if (rtw_fw_ps_state(Adapter) == _FAIL) { ++ RTW_INFO("%s: leave 32k but fw state in 32k\n", __FUNCTION__); ++ pdbgpriv->dbg_rpwm_toogle_cnt++; ++ } ++#endif /* DBG_CHECK_FW_PS_STATE */ ++ break; ++ } ++ ++ if (rtw_get_passing_time_ms(start_time) > LPS_RPWM_WAIT_MS) { ++ RTW_INFO("%s: polling cpwm timeout! cpwm_orig=%02x, cpwm_now=%02x\n", __FUNCTION__, cpwm_orig, cpwm_now); ++#ifdef DBG_CHECK_FW_PS_STATE ++ if (rtw_fw_ps_state(Adapter) == _FAIL) { ++ RTW_INFO("rpwm timeout and fw ps state in 32k\n"); ++ pdbgpriv->dbg_rpwm_timeout_fail_cnt++; ++ } ++#endif /* DBG_CHECK_FW_PS_STATE */ ++ break; ++ } ++ } while (1); ++#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ ++ ++ _exit_pwrlock(&pwrpriv->lock); ++#endif ++ ++#ifdef CONFIG_P2P_PS ++ p2p_ps_wk_cmd(pri_padapter, P2P_PS_DISABLE, 0); ++#endif /* CONFIG_P2P_PS */ ++ ++#ifdef CONFIG_LPS ++ rtw_lps_ctrl_wk_cmd(pri_padapter, LPS_CTRL_LEAVE, 0); ++#endif ++ } else { ++ if (pwrpriv->rf_pwrstate == rf_off) { ++#ifdef CONFIG_AUTOSUSPEND ++ if (Adapter->registrypriv.usbss_enable) { ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ usb_disable_autosuspend(adapter_to_dvobj(Adapter)->pusbdev); ++#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 22) && LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 34)) ++ adapter_to_dvobj(Adapter)->pusbdev->autosuspend_disabled = Adapter->bDisableAutosuspend;/* autosuspend disabled by the user */ ++#endif ++ } else ++#endif ++ { ++#if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) ++#ifdef CONFIG_IPS ++ if (_FALSE == ips_leave(pri_padapter)) ++ RTW_INFO("======> ips_leave fail.............\n"); ++#endif ++#endif /* CONFIG_SWLPS_IN_IPS || (CONFIG_PLATFORM_SPRD && CONFIG_RTL8188E) */ ++ } ++ } ++ } ++ ++} ++ ++/* ++ * Description: Leave all power save mode: LPS, FwLPS, IPS if needed. ++ * Move code to function by tynli. 2010.03.26. ++ * */ ++void LeaveAllPowerSaveMode(IN PADAPTER Adapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ u8 enqueue = 0; ++ int n_assoc_iface = 0; ++ int i; ++ ++ ++ /* RTW_INFO("%s.....\n",__FUNCTION__); */ ++ ++ if (_FALSE == Adapter->bup) { ++ RTW_INFO(FUNC_ADPT_FMT ": bup=%d Skip!\n", ++ FUNC_ADPT_ARG(Adapter), Adapter->bup); ++ return; ++ } ++ ++ if (rtw_is_surprise_removed(Adapter)) { ++ RTW_INFO(FUNC_ADPT_FMT ": bSurpriseRemoved=_TRUE Skip!\n", FUNC_ADPT_ARG(Adapter)); ++ return; ++ } ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) ++ n_assoc_iface++; ++ } ++ ++ if (n_assoc_iface) { ++ /* connect */ ++#ifdef CONFIG_LPS_LCLK ++ enqueue = 1; ++#endif ++ ++#ifdef CONFIG_P2P_PS ++ p2p_ps_wk_cmd(Adapter, P2P_PS_DISABLE, enqueue); ++#endif /* CONFIG_P2P_PS */ ++ ++#ifdef CONFIG_LPS ++ rtw_lps_ctrl_wk_cmd(Adapter, LPS_CTRL_LEAVE, enqueue); ++#endif ++ ++#ifdef CONFIG_LPS_LCLK ++ LPS_Leave_check(Adapter); ++#endif ++ } else { ++ if (adapter_to_pwrctl(Adapter)->rf_pwrstate == rf_off) { ++#ifdef CONFIG_AUTOSUSPEND ++ if (Adapter->registrypriv.usbss_enable) { ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ usb_disable_autosuspend(adapter_to_dvobj(Adapter)->pusbdev); ++#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 22) && LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 34)) ++ adapter_to_dvobj(Adapter)->pusbdev->autosuspend_disabled = Adapter->bDisableAutosuspend;/* autosuspend disabled by the user */ ++#endif ++ } else ++#endif ++ { ++#if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) || (defined(CONFIG_PLATFORM_SPRD) && defined(CONFIG_RTL8188E)) ++#ifdef CONFIG_IPS ++ if (_FALSE == ips_leave(Adapter)) ++ RTW_INFO("======> ips_leave fail.............\n"); ++#endif ++#endif /* CONFIG_SWLPS_IN_IPS || (CONFIG_PLATFORM_SPRD && CONFIG_RTL8188E) */ ++ } ++ } ++ } ++ ++} ++ ++#ifdef CONFIG_LPS_LCLK ++void LPS_Leave_check( ++ PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrpriv; ++ u32 start_time; ++ u8 bReady; ++ ++ ++ pwrpriv = adapter_to_pwrctl(padapter); ++ ++ bReady = _FALSE; ++ start_time = rtw_get_current_time(); ++ ++ rtw_yield_os(); ++ ++ while (1) { ++ _enter_pwrlock(&pwrpriv->lock); ++ ++ if (rtw_is_surprise_removed(padapter) ++ || (!rtw_is_hw_init_completed(padapter)) ++#ifdef CONFIG_USB_HCI ++ || rtw_is_drv_stopped(padapter) ++#endif ++ || (pwrpriv->pwr_mode == PS_MODE_ACTIVE) ++ ) ++ bReady = _TRUE; ++ ++ _exit_pwrlock(&pwrpriv->lock); ++ ++ if (_TRUE == bReady) ++ break; ++ ++ if (rtw_get_passing_time_ms(start_time) > 100) { ++ RTW_INFO("Wait for cpwm event than 100 ms!!!\n"); ++ break; ++ } ++ rtw_msleep_os(1); ++ } ++ ++} ++ ++/* ++ * Caller:ISR handler... ++ * ++ * This will be called when CPWM interrupt is up. ++ * ++ * using to update cpwn of drv; and drv willl make a decision to up or down pwr level ++ */ ++void cpwm_int_hdl( ++ PADAPTER padapter, ++ struct reportpwrstate_parm *preportpwrstate) ++{ ++ struct pwrctrl_priv *pwrpriv; ++ ++ ++ pwrpriv = adapter_to_pwrctl(padapter); ++#if 0 ++ if (pwrpriv->cpwm_tog == (preportpwrstate->state & PS_TOGGLE)) { ++ goto exit; ++ } ++#endif ++ ++ _enter_pwrlock(&pwrpriv->lock); ++ ++#ifdef CONFIG_LPS_RPWM_TIMER ++ if (pwrpriv->rpwm < PS_STATE_S2) { ++ RTW_INFO("%s: Redundant CPWM Int. RPWM=0x%02X CPWM=0x%02x\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); ++ _exit_pwrlock(&pwrpriv->lock); ++ goto exit; ++ } ++#endif /* CONFIG_LPS_RPWM_TIMER */ ++ ++ pwrpriv->cpwm = PS_STATE(preportpwrstate->state); ++ pwrpriv->cpwm_tog = preportpwrstate->state & PS_TOGGLE; ++ ++ if (pwrpriv->cpwm >= PS_STATE_S2) { ++ if (pwrpriv->alives & CMD_ALIVE) ++ _rtw_up_sema(&padapter->cmdpriv.cmd_queue_sema); ++ ++ if (pwrpriv->alives & XMIT_ALIVE) ++ _rtw_up_sema(&padapter->xmitpriv.xmit_sema); ++ } ++ ++ _exit_pwrlock(&pwrpriv->lock); ++ ++exit: ++ return; ++} ++ ++static void cpwm_event_callback(struct work_struct *work) ++{ ++ struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, cpwm_event); ++ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); ++ _adapter *adapter = dvobj->padapters[IFACE_ID0]; ++ struct reportpwrstate_parm report; ++ ++ /* RTW_INFO("%s\n",__FUNCTION__); */ ++ ++ report.state = PS_STATE_S2; ++ cpwm_int_hdl(adapter, &report); ++} ++ ++#ifdef CONFIG_LPS_RPWM_TIMER ++static void rpwmtimeout_workitem_callback(struct work_struct *work) ++{ ++ PADAPTER padapter; ++ struct dvobj_priv *dvobj; ++ struct pwrctrl_priv *pwrpriv; ++ ++ ++ pwrpriv = container_of(work, struct pwrctrl_priv, rpwmtimeoutwi); ++ dvobj = pwrctl_to_dvobj(pwrpriv); ++ padapter = dvobj->padapters[IFACE_ID0]; ++ /* RTW_INFO("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); */ ++ ++ _enter_pwrlock(&pwrpriv->lock); ++ if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { ++ RTW_INFO("%s: rpwm=0x%02X cpwm=0x%02X CPWM done!\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); ++ goto exit; ++ } ++ _exit_pwrlock(&pwrpriv->lock); ++ ++ if (rtw_read8(padapter, 0x100) != 0xEA) { ++#if 1 ++ struct reportpwrstate_parm report; ++ ++ report.state = PS_STATE_S2; ++ RTW_INFO("\n%s: FW already leave 32K!\n\n", __func__); ++ cpwm_int_hdl(padapter, &report); ++#else ++ RTW_INFO("\n%s: FW already leave 32K!\n\n", __func__); ++ cpwm_event_callback(&pwrpriv->cpwm_event); ++#endif ++ return; ++ } ++ ++ _enter_pwrlock(&pwrpriv->lock); ++ ++ if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { ++ RTW_INFO("%s: cpwm=%d, nothing to do!\n", __func__, pwrpriv->cpwm); ++ goto exit; ++ } ++ pwrpriv->brpwmtimeout = _TRUE; ++ rtw_set_rpwm(padapter, pwrpriv->rpwm); ++ pwrpriv->brpwmtimeout = _FALSE; ++ ++exit: ++ _exit_pwrlock(&pwrpriv->lock); ++} ++ ++/* ++ * This function is a timer handler, can't do any IO in it. ++ */ ++static void pwr_rpwm_timeout_handler(void *FunctionContext) ++{ ++ PADAPTER padapter; ++ struct pwrctrl_priv *pwrpriv; ++ ++ ++ padapter = (PADAPTER)FunctionContext; ++ pwrpriv = adapter_to_pwrctl(padapter); ++ RTW_INFO("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); ++ ++ if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { ++ RTW_INFO("+%s: cpwm=%d, nothing to do!\n", __func__, pwrpriv->cpwm); ++ return; ++ } ++ ++ _set_workitem(&pwrpriv->rpwmtimeoutwi); ++} ++#endif /* CONFIG_LPS_RPWM_TIMER */ ++ ++__inline static void register_task_alive(struct pwrctrl_priv *pwrctrl, u32 tag) ++{ ++ pwrctrl->alives |= tag; ++} ++ ++__inline static void unregister_task_alive(struct pwrctrl_priv *pwrctrl, u32 tag) ++{ ++ pwrctrl->alives &= ~tag; ++} ++ ++ ++/* ++ * Description: ++ * Check if the fw_pwrstate is okay for I/O. ++ * If not (cpwm is less than S2), then the sub-routine ++ * will raise the cpwm to be greater than or equal to S2. ++ * ++ * Calling Context: Passive ++ * ++ * Constraint: ++ * 1. this function will request pwrctrl->lock ++ * ++ * Return Value: ++ * _SUCCESS hardware is ready for I/O ++ * _FAIL can't I/O right now ++ */ ++s32 rtw_register_task_alive(PADAPTER padapter, u32 task) ++{ ++ s32 res; ++ struct pwrctrl_priv *pwrctrl; ++ u8 pslv; ++ ++ ++ res = _SUCCESS; ++ pwrctrl = adapter_to_pwrctl(padapter); ++ pslv = PS_STATE_S2; ++ ++ _enter_pwrlock(&pwrctrl->lock); ++ ++ register_task_alive(pwrctrl, task); ++ ++ if (pwrctrl->bFwCurrentInPSMode == _TRUE) { ++ ++ if (pwrctrl->cpwm < pslv) { ++ if (pwrctrl->cpwm < PS_STATE_S2) ++ res = _FAIL; ++ if (pwrctrl->rpwm < pslv) ++ rtw_set_rpwm(padapter, pslv); ++ } ++ } ++ ++ _exit_pwrlock(&pwrctrl->lock); ++ ++#ifdef CONFIG_DETECT_CPWM_BY_POLLING ++ if (_FAIL == res) { ++ if (pwrctrl->cpwm >= PS_STATE_S2) ++ res = _SUCCESS; ++ } ++#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ ++ ++ ++ return res; ++} ++ ++/* ++ * Description: ++ * If task is done, call this func. to power down firmware again. ++ * ++ * Constraint: ++ * 1. this function will request pwrctrl->lock ++ * ++ * Return Value: ++ * none ++ */ ++void rtw_unregister_task_alive(PADAPTER padapter, u32 task) ++{ ++ struct pwrctrl_priv *pwrctrl; ++ u8 pslv; ++ ++ ++ pwrctrl = adapter_to_pwrctl(padapter); ++ pslv = PS_STATE_S0; ++ ++#ifdef CONFIG_BT_COEXIST ++ if ((rtw_btcoex_IsBtDisabled(padapter) == _FALSE) ++ && (rtw_btcoex_IsBtControlLps(padapter) == _TRUE)) { ++ u8 val8; ++ ++ val8 = rtw_btcoex_LpsVal(padapter); ++ if (val8 & BIT(4)) ++ pslv = PS_STATE_S2; ++ ++ } ++#endif /* CONFIG_BT_COEXIST */ ++ ++ _enter_pwrlock(&pwrctrl->lock); ++ ++ unregister_task_alive(pwrctrl, task); ++ ++ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) ++ && (pwrctrl->bFwCurrentInPSMode == _TRUE)) { ++ ++ if (pwrctrl->cpwm > pslv) { ++ if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) ++ rtw_set_rpwm(padapter, pslv); ++ } ++ } ++ ++ _exit_pwrlock(&pwrctrl->lock); ++ ++} ++ ++/* ++ * Caller: rtw_xmit_thread ++ * ++ * Check if the fw_pwrstate is okay for xmit. ++ * If not (cpwm is less than S3), then the sub-routine ++ * will raise the cpwm to be greater than or equal to S3. ++ * ++ * Calling Context: Passive ++ * ++ * Return Value: ++ * _SUCCESS rtw_xmit_thread can write fifo/txcmd afterwards. ++ * _FAIL rtw_xmit_thread can not do anything. ++ */ ++s32 rtw_register_tx_alive(PADAPTER padapter) ++{ ++ s32 res; ++ struct pwrctrl_priv *pwrctrl; ++ u8 pslv; ++ ++ ++ res = _SUCCESS; ++ pwrctrl = adapter_to_pwrctl(padapter); ++ pslv = PS_STATE_S2; ++ ++ _enter_pwrlock(&pwrctrl->lock); ++ ++ register_task_alive(pwrctrl, XMIT_ALIVE); ++ ++ if (pwrctrl->bFwCurrentInPSMode == _TRUE) { ++ ++ if (pwrctrl->cpwm < pslv) { ++ if (pwrctrl->cpwm < PS_STATE_S2) ++ res = _FAIL; ++ if (pwrctrl->rpwm < pslv) ++ rtw_set_rpwm(padapter, pslv); ++ } ++ } ++ ++ _exit_pwrlock(&pwrctrl->lock); ++ ++#ifdef CONFIG_DETECT_CPWM_BY_POLLING ++ if (_FAIL == res) { ++ if (pwrctrl->cpwm >= PS_STATE_S2) ++ res = _SUCCESS; ++ } ++#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ ++ ++ ++ return res; ++} ++ ++/* ++ * Caller: rtw_cmd_thread ++ * ++ * Check if the fw_pwrstate is okay for issuing cmd. ++ * If not (cpwm should be is less than S2), then the sub-routine ++ * will raise the cpwm to be greater than or equal to S2. ++ * ++ * Calling Context: Passive ++ * ++ * Return Value: ++ * _SUCCESS rtw_cmd_thread can issue cmds to firmware afterwards. ++ * _FAIL rtw_cmd_thread can not do anything. ++ */ ++s32 rtw_register_cmd_alive(PADAPTER padapter) ++{ ++ s32 res; ++ struct pwrctrl_priv *pwrctrl; ++ u8 pslv; ++ ++ ++ res = _SUCCESS; ++ pwrctrl = adapter_to_pwrctl(padapter); ++ pslv = PS_STATE_S2; ++ ++ _enter_pwrlock(&pwrctrl->lock); ++ ++ register_task_alive(pwrctrl, CMD_ALIVE); ++ ++ if (pwrctrl->bFwCurrentInPSMode == _TRUE) { ++ ++ if (pwrctrl->cpwm < pslv) { ++ if (pwrctrl->cpwm < PS_STATE_S2) ++ res = _FAIL; ++ if (pwrctrl->rpwm < pslv) ++ rtw_set_rpwm(padapter, pslv); ++ } ++ } ++ ++ _exit_pwrlock(&pwrctrl->lock); ++ ++#ifdef CONFIG_DETECT_CPWM_BY_POLLING ++ if (_FAIL == res) { ++ if (pwrctrl->cpwm >= PS_STATE_S2) ++ res = _SUCCESS; ++ } ++#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ ++ ++ ++ return res; ++} ++ ++/* ++ * Caller: rx_isr ++ * ++ * Calling Context: Dispatch/ISR ++ * ++ * Return Value: ++ * _SUCCESS ++ * _FAIL ++ */ ++s32 rtw_register_rx_alive(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrctrl; ++ ++ ++ pwrctrl = adapter_to_pwrctl(padapter); ++ ++ _enter_pwrlock(&pwrctrl->lock); ++ ++ register_task_alive(pwrctrl, RECV_ALIVE); ++ ++ _exit_pwrlock(&pwrctrl->lock); ++ ++ ++ return _SUCCESS; ++} ++ ++/* ++ * Caller: evt_isr or evt_thread ++ * ++ * Calling Context: Dispatch/ISR or Passive ++ * ++ * Return Value: ++ * _SUCCESS ++ * _FAIL ++ */ ++s32 rtw_register_evt_alive(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrctrl; ++ ++ ++ pwrctrl = adapter_to_pwrctl(padapter); ++ ++ _enter_pwrlock(&pwrctrl->lock); ++ ++ register_task_alive(pwrctrl, EVT_ALIVE); ++ ++ _exit_pwrlock(&pwrctrl->lock); ++ ++ ++ return _SUCCESS; ++} ++ ++/* ++ * Caller: ISR ++ * ++ * If ISR's txdone, ++ * No more pkts for TX, ++ * Then driver shall call this fun. to power down firmware again. ++ */ ++void rtw_unregister_tx_alive(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrctrl; ++ _adapter *iface; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ u8 pslv, i; ++ ++ ++ pwrctrl = adapter_to_pwrctl(padapter); ++ pslv = PS_STATE_S0; ++ ++#ifdef CONFIG_BT_COEXIST ++ if ((rtw_btcoex_IsBtDisabled(padapter) == _FALSE) ++ && (rtw_btcoex_IsBtControlLps(padapter) == _TRUE)) { ++ u8 val8; ++ ++ val8 = rtw_btcoex_LpsVal(padapter); ++ if (val8 & BIT(4)) ++ pslv = PS_STATE_S2; ++ ++ } ++#endif /* CONFIG_BT_COEXIST */ ++ ++#ifdef CONFIG_P2P_PS ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ if (iface->wdinfo.p2p_ps_mode > P2P_PS_NONE) { ++ pslv = PS_STATE_S2; ++ break; ++ } ++ } ++ } ++#endif ++ _enter_pwrlock(&pwrctrl->lock); ++ ++ unregister_task_alive(pwrctrl, XMIT_ALIVE); ++ ++ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) ++ && (pwrctrl->bFwCurrentInPSMode == _TRUE)) { ++ ++ if (pwrctrl->cpwm > pslv) { ++ if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) ++ rtw_set_rpwm(padapter, pslv); ++ } ++ } ++ ++ _exit_pwrlock(&pwrctrl->lock); ++ ++} ++ ++/* ++ * Caller: ISR ++ * ++ * If all commands have been done, ++ * and no more command to do, ++ * then driver shall call this fun. to power down firmware again. ++ */ ++void rtw_unregister_cmd_alive(PADAPTER padapter) ++{ ++ _adapter *iface; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct pwrctrl_priv *pwrctrl; ++ u8 pslv, i; ++ ++ ++ pwrctrl = adapter_to_pwrctl(padapter); ++ pslv = PS_STATE_S0; ++ ++#ifdef CONFIG_BT_COEXIST ++ if ((rtw_btcoex_IsBtDisabled(padapter) == _FALSE) ++ && (rtw_btcoex_IsBtControlLps(padapter) == _TRUE)) { ++ u8 val8; ++ ++ val8 = rtw_btcoex_LpsVal(padapter); ++ if (val8 & BIT(4)) ++ pslv = PS_STATE_S2; ++ ++ } ++#endif /* CONFIG_BT_COEXIST */ ++ ++#ifdef CONFIG_P2P_PS ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ if (iface->wdinfo.p2p_ps_mode > P2P_PS_NONE) { ++ pslv = PS_STATE_S2; ++ break; ++ } ++ } ++ } ++#endif ++ ++ _enter_pwrlock(&pwrctrl->lock); ++ ++ unregister_task_alive(pwrctrl, CMD_ALIVE); ++ ++ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) ++ && (pwrctrl->bFwCurrentInPSMode == _TRUE)) { ++ ++ if (pwrctrl->cpwm > pslv) { ++ if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) ++ rtw_set_rpwm(padapter, pslv); ++ } ++ } ++ ++ _exit_pwrlock(&pwrctrl->lock); ++ ++} ++ ++/* ++ * Caller: ISR ++ */ ++void rtw_unregister_rx_alive(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrctrl; ++ ++ ++ pwrctrl = adapter_to_pwrctl(padapter); ++ ++ _enter_pwrlock(&pwrctrl->lock); ++ ++ unregister_task_alive(pwrctrl, RECV_ALIVE); ++ ++ ++ _exit_pwrlock(&pwrctrl->lock); ++ ++} ++ ++void rtw_unregister_evt_alive(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrctrl; ++ ++ ++ pwrctrl = adapter_to_pwrctl(padapter); ++ ++ unregister_task_alive(pwrctrl, EVT_ALIVE); ++ ++ ++ _exit_pwrlock(&pwrctrl->lock); ++ ++} ++#endif /* CONFIG_LPS_LCLK */ ++ ++#ifdef CONFIG_RESUME_IN_WORKQUEUE ++ static void resume_workitem_callback(struct work_struct *work); ++#endif /* CONFIG_RESUME_IN_WORKQUEUE */ ++ ++void rtw_init_pwrctrl_priv(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++ int i = 0; ++ u8 val8 = 0; ++ ++#if defined(CONFIG_CONCURRENT_MODE) ++ if (padapter->adapter_type != PRIMARY_ADAPTER) ++ return; ++#endif ++ ++ ++#ifdef PLATFORM_WINDOWS ++ pwrctrlpriv->pnp_current_pwr_state = NdisDeviceStateD0; ++#endif ++ ++ _init_pwrlock(&pwrctrlpriv->lock); ++ _init_pwrlock(&pwrctrlpriv->check_32k_lock); ++ pwrctrlpriv->rf_pwrstate = rf_on; ++ pwrctrlpriv->ips_enter_cnts = 0; ++ pwrctrlpriv->ips_leave_cnts = 0; ++ pwrctrlpriv->lps_enter_cnts = 0; ++ pwrctrlpriv->lps_leave_cnts = 0; ++ pwrctrlpriv->bips_processing = _FALSE; ++ ++ pwrctrlpriv->ips_mode = padapter->registrypriv.ips_mode; ++ pwrctrlpriv->ips_mode_req = padapter->registrypriv.ips_mode; ++ ++ pwrctrlpriv->pwr_state_check_interval = RTW_PWR_STATE_CHK_INTERVAL; ++ pwrctrlpriv->pwr_state_check_cnts = 0; ++ pwrctrlpriv->bInternalAutoSuspend = _FALSE; ++ pwrctrlpriv->bInSuspend = _FALSE; ++ pwrctrlpriv->bkeepfwalive = _FALSE; ++ ++#ifdef CONFIG_AUTOSUSPEND ++#ifdef SUPPORT_HW_RFOFF_DETECTED ++ pwrctrlpriv->pwr_state_check_interval = (pwrctrlpriv->bHWPwrPindetect) ? 1000 : 2000; ++#endif ++#endif ++ ++ pwrctrlpriv->LpsIdleCount = 0; ++ ++#ifdef CONFIG_LPS_PG ++ pwrctrlpriv->lpspg_rsvd_page_locate = 0; ++#endif ++ ++ /* pwrctrlpriv->FWCtrlPSMode =padapter->registrypriv.power_mgnt; */ /* PS_MODE_MIN; */ ++ if (padapter->registrypriv.mp_mode == 1) ++ pwrctrlpriv->power_mgnt = PS_MODE_ACTIVE ; ++ else ++ pwrctrlpriv->power_mgnt = padapter->registrypriv.power_mgnt; /* PS_MODE_MIN; */ ++ pwrctrlpriv->bLeisurePs = (PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt) ? _TRUE : _FALSE; ++ ++ pwrctrlpriv->bFwCurrentInPSMode = _FALSE; ++ ++ pwrctrlpriv->rpwm = 0; ++ pwrctrlpriv->cpwm = PS_STATE_S4; ++ ++ pwrctrlpriv->pwr_mode = PS_MODE_ACTIVE; ++ pwrctrlpriv->smart_ps = padapter->registrypriv.smart_ps; ++ pwrctrlpriv->bcn_ant_mode = 0; ++ pwrctrlpriv->dtim = 0; ++ ++ pwrctrlpriv->tog = 0x80; ++ ++#ifdef CONFIG_LPS_LCLK ++ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&pwrctrlpriv->rpwm)); ++ ++ _init_workitem(&pwrctrlpriv->cpwm_event, cpwm_event_callback, NULL); ++ ++#ifdef CONFIG_LPS_RPWM_TIMER ++ pwrctrlpriv->brpwmtimeout = _FALSE; ++ _init_workitem(&pwrctrlpriv->rpwmtimeoutwi, rpwmtimeout_workitem_callback, NULL); ++ _init_timer(&pwrctrlpriv->pwr_rpwm_timer, padapter->pnetdev, pwr_rpwm_timeout_handler, padapter); ++#endif /* CONFIG_LPS_RPWM_TIMER */ ++#endif /* CONFIG_LPS_LCLK */ ++ ++ rtw_init_timer(&pwrctrlpriv->pwr_state_check_timer, padapter, pwr_state_check_handler); ++ ++ pwrctrlpriv->wowlan_mode = _FALSE; ++ pwrctrlpriv->wowlan_ap_mode = _FALSE; ++ pwrctrlpriv->wowlan_p2p_mode = _FALSE; ++ pwrctrlpriv->wowlan_last_wake_reason = 0; ++ ++#ifdef CONFIG_RESUME_IN_WORKQUEUE ++ _init_workitem(&pwrctrlpriv->resume_work, resume_workitem_callback, NULL); ++ pwrctrlpriv->rtw_workqueue = create_singlethread_workqueue("rtw_workqueue"); ++#endif /* CONFIG_RESUME_IN_WORKQUEUE */ ++ ++#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) ++ pwrctrlpriv->early_suspend.suspend = NULL; ++ rtw_register_early_suspend(pwrctrlpriv); ++#endif /* CONFIG_HAS_EARLYSUSPEND || CONFIG_ANDROID_POWER */ ++ ++#ifdef CONFIG_RTW_SDIO_OOB_INT ++ rtw_hal_switch_ood_int_ctrl(padapter, _TRUE); ++#endif ++ ++#ifdef CONFIG_GPIO_WAKEUP ++ /*default low active*/ ++ pwrctrlpriv->is_high_active = HIGH_ACTIVE; ++ val8 = (pwrctrlpriv->is_high_active == 0) ? 1 : 0; ++ rtw_hal_switch_gpio_wl_ctrl(padapter, WAKEUP_GPIO_IDX, _TRUE); ++ rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, val8); ++ RTW_INFO("%s: set GPIO_%d %d as default.\n", ++ __func__, WAKEUP_GPIO_IDX, val8); ++#endif /* CONFIG_GPIO_WAKEUP */ ++ ++#ifdef CONFIG_WOWLAN ++ pwrctrlpriv->wowlan_pattern_idx = DEFAULT_PATTERN_NUM; ++ pwrctrlpriv->wowlan_in_resume = _FALSE; ++ for (i = 0 ; i < MAX_WKFM_NUM; i++) { ++ _rtw_memset(pwrctrlpriv->patterns[i].content, '\0', ++ sizeof(pwrctrlpriv->patterns[i].content)); ++ _rtw_memset(pwrctrlpriv->patterns[i].mask, '\0', ++ sizeof(pwrctrlpriv->patterns[i].mask)); ++ pwrctrlpriv->patterns[i].len = 0; ++ } ++ ++#ifdef CONFIG_PNO_SUPPORT ++ pwrctrlpriv->pno_inited = _FALSE; ++ pwrctrlpriv->pnlo_info = NULL; ++ pwrctrlpriv->pscan_info = NULL; ++ pwrctrlpriv->pno_ssid_list = NULL; ++#endif /* CONFIG_PNO_SUPPORT */ ++ pwrctrlpriv->wowlan_aoac_rpt_loc = 0; ++#endif /* CONFIG_WOWLAN */ ++ ++#ifdef CONFIG_LPS_POFF ++ rtw_hal_set_hwreg(padapter, HW_VAR_LPS_POFF_INIT, 0); ++#endif ++ ++ ++} ++ ++ ++void rtw_free_pwrctrl_priv(PADAPTER adapter) ++{ ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(adapter); ++ ++#if defined(CONFIG_CONCURRENT_MODE) ++ if (adapter->adapter_type != PRIMARY_ADAPTER) ++ return; ++#endif ++ ++ ++ /* _rtw_memset((unsigned char *)pwrctrlpriv, 0, sizeof(struct pwrctrl_priv)); */ ++ ++ ++#ifdef CONFIG_RESUME_IN_WORKQUEUE ++ if (pwrctrlpriv->rtw_workqueue) { ++ flush_workqueue(pwrctrlpriv->rtw_workqueue); ++ destroy_workqueue(pwrctrlpriv->rtw_workqueue); ++ } ++#endif ++ ++#ifdef CONFIG_LPS_POFF ++ rtw_hal_set_hwreg(adapter, HW_VAR_LPS_POFF_DEINIT, 0); ++#endif ++ ++#ifdef CONFIG_WOWLAN ++#ifdef CONFIG_PNO_SUPPORT ++ if (pwrctrlpriv->pnlo_info != NULL) ++ printk("****** pnlo_info memory leak********\n"); ++ ++ if (pwrctrlpriv->pscan_info != NULL) ++ printk("****** pscan_info memory leak********\n"); ++ ++ if (pwrctrlpriv->pno_ssid_list != NULL) ++ printk("****** pno_ssid_list memory leak********\n"); ++#endif ++#endif /* CONFIG_WOWLAN */ ++ ++#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) ++ rtw_unregister_early_suspend(pwrctrlpriv); ++#endif /* CONFIG_HAS_EARLYSUSPEND || CONFIG_ANDROID_POWER */ ++ ++ _free_pwrlock(&pwrctrlpriv->lock); ++ _free_pwrlock(&pwrctrlpriv->check_32k_lock); ++ ++} ++ ++#ifdef CONFIG_RESUME_IN_WORKQUEUE ++extern int rtw_resume_process(_adapter *padapter); ++ ++static void resume_workitem_callback(struct work_struct *work) ++{ ++ struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, resume_work); ++ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); ++ _adapter *adapter = dvobj->padapters[IFACE_ID0]; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ rtw_resume_process(adapter); ++ ++ rtw_resume_unlock_suspend(); ++} ++ ++void rtw_resume_in_workqueue(struct pwrctrl_priv *pwrpriv) ++{ ++ /* accquire system's suspend lock preventing from falliing asleep while resume in workqueue */ ++ /* rtw_lock_suspend(); */ ++ ++ rtw_resume_lock_suspend(); ++ ++#if 1 ++ queue_work(pwrpriv->rtw_workqueue, &pwrpriv->resume_work); ++#else ++ _set_workitem(&pwrpriv->resume_work); ++#endif ++} ++#endif /* CONFIG_RESUME_IN_WORKQUEUE */ ++ ++#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) ++inline bool rtw_is_earlysuspend_registered(struct pwrctrl_priv *pwrpriv) ++{ ++ return (pwrpriv->early_suspend.suspend) ? _TRUE : _FALSE; ++} ++ ++inline bool rtw_is_do_late_resume(struct pwrctrl_priv *pwrpriv) ++{ ++ return (pwrpriv->do_late_resume) ? _TRUE : _FALSE; ++} ++ ++inline void rtw_set_do_late_resume(struct pwrctrl_priv *pwrpriv, bool enable) ++{ ++ pwrpriv->do_late_resume = enable; ++} ++#endif ++ ++#ifdef CONFIG_HAS_EARLYSUSPEND ++extern int rtw_resume_process(_adapter *padapter); ++static void rtw_early_suspend(struct early_suspend *h) ++{ ++ struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ rtw_set_do_late_resume(pwrpriv, _FALSE); ++} ++ ++static void rtw_late_resume(struct early_suspend *h) ++{ ++ struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); ++ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); ++ _adapter *adapter = dvobj->padapters[IFACE_ID0]; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ if (pwrpriv->do_late_resume) { ++ rtw_set_do_late_resume(pwrpriv, _FALSE); ++ rtw_resume_process(adapter); ++ } ++} ++ ++void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ /* jeff: set the early suspend level before blank screen, so we wll do late resume after scree is lit */ ++ pwrpriv->early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20; ++ pwrpriv->early_suspend.suspend = rtw_early_suspend; ++ pwrpriv->early_suspend.resume = rtw_late_resume; ++ register_early_suspend(&pwrpriv->early_suspend); ++ ++ ++} ++ ++void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ rtw_set_do_late_resume(pwrpriv, _FALSE); ++ ++ if (pwrpriv->early_suspend.suspend) ++ unregister_early_suspend(&pwrpriv->early_suspend); ++ ++ pwrpriv->early_suspend.suspend = NULL; ++ pwrpriv->early_suspend.resume = NULL; ++} ++#endif /* CONFIG_HAS_EARLYSUSPEND */ ++ ++#ifdef CONFIG_ANDROID_POWER ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ extern int rtw_resume_process(PADAPTER padapter); ++#endif ++static void rtw_early_suspend(android_early_suspend_t *h) ++{ ++ struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ rtw_set_do_late_resume(pwrpriv, _FALSE); ++} ++ ++static void rtw_late_resume(android_early_suspend_t *h) ++{ ++ struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); ++ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); ++ _adapter *adapter = dvobj->padapters[IFACE_ID0]; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ if (pwrpriv->do_late_resume) { ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ rtw_set_do_late_resume(pwrpriv, _FALSE); ++ rtw_resume_process(adapter); ++#endif ++ } ++} ++ ++void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ /* jeff: set the early suspend level before blank screen, so we wll do late resume after scree is lit */ ++ pwrpriv->early_suspend.level = ANDROID_EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20; ++ pwrpriv->early_suspend.suspend = rtw_early_suspend; ++ pwrpriv->early_suspend.resume = rtw_late_resume; ++ android_register_early_suspend(&pwrpriv->early_suspend); ++} ++ ++void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ rtw_set_do_late_resume(pwrpriv, _FALSE); ++ ++ if (pwrpriv->early_suspend.suspend) ++ android_unregister_early_suspend(&pwrpriv->early_suspend); ++ ++ pwrpriv->early_suspend.suspend = NULL; ++ pwrpriv->early_suspend.resume = NULL; ++} ++#endif /* CONFIG_ANDROID_POWER */ ++ ++u8 rtw_interface_ps_func(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val) ++{ ++ u8 bResult = _TRUE; ++ rtw_hal_intf_ps_func(padapter, efunc_id, val); ++ ++ return bResult; ++} ++ ++ ++inline void rtw_set_ips_deny(_adapter *padapter, u32 ms) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ms); ++} ++ ++/* ++* rtw_pwr_wakeup - Wake the NIC up from: 1)IPS. 2)USB autosuspend ++* @adapter: pointer to _adapter structure ++* @ips_deffer_ms: the ms wiil prevent from falling into IPS after wakeup ++* Return _SUCCESS or _FAIL ++*/ ++ ++int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); ++ struct mlme_priv *pmlmepriv; ++ int ret = _SUCCESS; ++ int i; ++ u32 start = rtw_get_current_time(); ++ ++ /* for LPS */ ++ LeaveAllPowerSaveMode(padapter); ++ ++ /* IPS still bound with primary adapter */ ++ padapter = GET_PRIMARY_ADAPTER(padapter); ++ pmlmepriv = &padapter->mlmepriv; ++ ++ if (pwrpriv->ips_deny_time < rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms)) ++ pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms); ++ ++ ++ if (pwrpriv->ps_processing) { ++ RTW_INFO("%s wait ps_processing...\n", __func__); ++ while (pwrpriv->ps_processing && rtw_get_passing_time_ms(start) <= 3000) ++ rtw_msleep_os(10); ++ if (pwrpriv->ps_processing) ++ RTW_INFO("%s wait ps_processing timeout\n", __func__); ++ else ++ RTW_INFO("%s wait ps_processing done\n", __func__); ++ } ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ if (rtw_hal_sreset_inprogress(padapter)) { ++ RTW_INFO("%s wait sreset_inprogress...\n", __func__); ++ while (rtw_hal_sreset_inprogress(padapter) && rtw_get_passing_time_ms(start) <= 4000) ++ rtw_msleep_os(10); ++ if (rtw_hal_sreset_inprogress(padapter)) ++ RTW_INFO("%s wait sreset_inprogress timeout\n", __func__); ++ else ++ RTW_INFO("%s wait sreset_inprogress done\n", __func__); ++ } ++#endif ++ ++ if (pwrpriv->bInternalAutoSuspend == _FALSE && pwrpriv->bInSuspend) { ++ RTW_INFO("%s wait bInSuspend...\n", __func__); ++ while (pwrpriv->bInSuspend ++ && ((rtw_get_passing_time_ms(start) <= 3000 && !rtw_is_do_late_resume(pwrpriv)) ++ || (rtw_get_passing_time_ms(start) <= 500 && rtw_is_do_late_resume(pwrpriv))) ++ ) ++ rtw_msleep_os(10); ++ if (pwrpriv->bInSuspend) ++ RTW_INFO("%s wait bInSuspend timeout\n", __func__); ++ else ++ RTW_INFO("%s wait bInSuspend done\n", __func__); ++ } ++ ++ /* System suspend is not allowed to wakeup */ ++ if ((pwrpriv->bInternalAutoSuspend == _FALSE) && (_TRUE == pwrpriv->bInSuspend)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* block??? */ ++ if ((pwrpriv->bInternalAutoSuspend == _TRUE) && (padapter->net_closed == _TRUE)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* I think this should be check in IPS, LPS, autosuspend functions... */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++#if defined(CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) ++ if (_TRUE == pwrpriv->bInternalAutoSuspend) { ++ if (0 == pwrpriv->autopm_cnt) { ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 33)) ++ if (usb_autopm_get_interface(adapter_to_dvobj(padapter)->pusbintf) < 0) ++ RTW_INFO("can't get autopm:\n"); ++#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 20)) ++ usb_autopm_disable(adapter_to_dvobj(padapter)->pusbintf); ++#else ++ usb_autoresume_device(adapter_to_dvobj(padapter)->pusbdev, 1); ++#endif ++ pwrpriv->autopm_cnt++; ++ } ++#endif /* #if defined (CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) */ ++ ret = _SUCCESS; ++ goto exit; ++#if defined(CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) ++ } ++#endif /* #if defined (CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) */ ++ } ++ ++ if (rf_off == pwrpriv->rf_pwrstate) { ++#ifdef CONFIG_USB_HCI ++#ifdef CONFIG_AUTOSUSPEND ++ if (pwrpriv->brfoffbyhw == _TRUE) { ++ RTW_INFO("hw still in rf_off state ...........\n"); ++ ret = _FAIL; ++ goto exit; ++ } else if (padapter->registrypriv.usbss_enable) { ++ RTW_INFO("%s call autoresume_enter....\n", __FUNCTION__); ++ if (_FAIL == autoresume_enter(padapter)) { ++ RTW_INFO("======> autoresume fail.............\n"); ++ ret = _FAIL; ++ goto exit; ++ } ++ } else ++#endif ++#endif ++ { ++#ifdef CONFIG_IPS ++ RTW_INFO("%s call ips_leave....\n", __FUNCTION__); ++ if (_FAIL == ips_leave(padapter)) { ++ RTW_INFO("======> ips_leave fail.............\n"); ++ ret = _FAIL; ++ goto exit; ++ } ++#endif ++ } ++ } ++ ++ /* TODO: the following checking need to be merged... */ ++ if (rtw_is_drv_stopped(padapter) ++ || !padapter->bup ++ || !rtw_is_hw_init_completed(padapter) ++ ) { ++ RTW_INFO("%s: bDriverStopped=%s, bup=%d, hw_init_completed=%u\n" ++ , caller ++ , rtw_is_drv_stopped(padapter) ? "True" : "False" ++ , padapter->bup ++ , rtw_get_hw_init_completed(padapter)); ++ ret = _FALSE; ++ goto exit; ++ } ++ ++exit: ++ if (pwrpriv->ips_deny_time < rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms)) ++ pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms); ++ return ret; ++ ++} ++ ++int rtw_pm_set_lps(_adapter *padapter, u8 mode) ++{ ++ int ret = 0; ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++ ++ if (mode < PS_MODE_NUM) { ++ if (pwrctrlpriv->power_mgnt != mode) { ++ if (PS_MODE_ACTIVE == mode) ++ LeaveAllPowerSaveMode(padapter); ++ else ++ pwrctrlpriv->LpsIdleCount = 2; ++ pwrctrlpriv->power_mgnt = mode; ++ pwrctrlpriv->bLeisurePs = (PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt) ? _TRUE : _FALSE; ++ } ++ } else ++ ret = -EINVAL; ++ ++ return ret; ++} ++ ++int rtw_pm_set_ips(_adapter *padapter, u8 mode) ++{ ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++ ++ if (mode == IPS_NORMAL || mode == IPS_LEVEL_2) { ++ rtw_ips_mode_req(pwrctrlpriv, mode); ++ RTW_INFO("%s %s\n", __FUNCTION__, mode == IPS_NORMAL ? "IPS_NORMAL" : "IPS_LEVEL_2"); ++ return 0; ++ } else if (mode == IPS_NONE) { ++ rtw_ips_mode_req(pwrctrlpriv, mode); ++ RTW_INFO("%s %s\n", __FUNCTION__, "IPS_NONE"); ++ if (!rtw_is_surprise_removed(padapter) && (_FAIL == rtw_pwr_wakeup(padapter))) ++ return -EFAULT; ++ } else ++ return -EINVAL; ++ return 0; ++} ++ ++/* ++ * ATTENTION: ++ * This function will request pwrctrl LOCK! ++ */ ++void rtw_ps_deny(PADAPTER padapter, PS_DENY_REASON reason) ++{ ++ struct pwrctrl_priv *pwrpriv; ++ s32 ret; ++ ++ ++ /* RTW_INFO("+" FUNC_ADPT_FMT ": Request PS deny for %d (0x%08X)\n", ++ * FUNC_ADPT_ARG(padapter), reason, BIT(reason)); */ ++ ++ pwrpriv = adapter_to_pwrctl(padapter); ++ ++ _enter_pwrlock(&pwrpriv->lock); ++ if (pwrpriv->ps_deny & BIT(reason)) { ++ RTW_INFO(FUNC_ADPT_FMT ": [WARNING] Reason %d had been set before!!\n", ++ FUNC_ADPT_ARG(padapter), reason); ++ } ++ pwrpriv->ps_deny |= BIT(reason); ++ _exit_pwrlock(&pwrpriv->lock); ++ ++ /* RTW_INFO("-" FUNC_ADPT_FMT ": Now PS deny for 0x%08X\n", ++ * FUNC_ADPT_ARG(padapter), pwrpriv->ps_deny); */ ++} ++ ++/* ++ * ATTENTION: ++ * This function will request pwrctrl LOCK! ++ */ ++void rtw_ps_deny_cancel(PADAPTER padapter, PS_DENY_REASON reason) ++{ ++ struct pwrctrl_priv *pwrpriv; ++ ++ ++ /* RTW_INFO("+" FUNC_ADPT_FMT ": Cancel PS deny for %d(0x%08X)\n", ++ * FUNC_ADPT_ARG(padapter), reason, BIT(reason)); */ ++ ++ pwrpriv = adapter_to_pwrctl(padapter); ++ ++ _enter_pwrlock(&pwrpriv->lock); ++ if ((pwrpriv->ps_deny & BIT(reason)) == 0) { ++ RTW_INFO(FUNC_ADPT_FMT ": [ERROR] Reason %d had been canceled before!!\n", ++ FUNC_ADPT_ARG(padapter), reason); ++ } ++ pwrpriv->ps_deny &= ~BIT(reason); ++ _exit_pwrlock(&pwrpriv->lock); ++ ++ /* RTW_INFO("-" FUNC_ADPT_FMT ": Now PS deny for 0x%08X\n", ++ * FUNC_ADPT_ARG(padapter), pwrpriv->ps_deny); */ ++} ++ ++/* ++ * ATTENTION: ++ * Before calling this function pwrctrl lock should be occupied already, ++ * otherwise it may return incorrect value. ++ */ ++u32 rtw_ps_deny_get(PADAPTER padapter) ++{ ++ u32 deny; ++ ++ ++ deny = adapter_to_pwrctl(padapter)->ps_deny; ++ ++ return deny; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_recv.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_recv.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_recv.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_recv.c 2018-02-11 21:44:27.140145979 +0200 +@@ -0,0 +1,4674 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_RECV_C_ ++ ++#include ++#include ++ ++#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) ++ ++ #error "Shall be Linux or Windows, but not both!\n" ++ ++#endif ++ ++ ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS); ++ ++enum { ++ SIGNAL_STAT_CALC_PROFILE_0 = 0, ++ SIGNAL_STAT_CALC_PROFILE_1, ++ SIGNAL_STAT_CALC_PROFILE_MAX ++}; ++ ++u8 signal_stat_calc_profile[SIGNAL_STAT_CALC_PROFILE_MAX][2] = { ++ {4, 1}, /* Profile 0 => pre_stat : curr_stat = 4 : 1 */ ++ {3, 7} /* Profile 1 => pre_stat : curr_stat = 3 : 7 */ ++}; ++ ++#ifndef RTW_SIGNAL_STATE_CALC_PROFILE ++ #define RTW_SIGNAL_STATE_CALC_PROFILE SIGNAL_STAT_CALC_PROFILE_1 ++#endif ++ ++#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ ++ ++void _rtw_init_sta_recv_priv(struct sta_recv_priv *psta_recvpriv) ++{ ++ ++ ++ ++ _rtw_memset((u8 *)psta_recvpriv, 0, sizeof(struct sta_recv_priv)); ++ ++ _rtw_spinlock_init(&psta_recvpriv->lock); ++ ++ /* for(i=0; iblk_strms[i]); */ ++ ++ _rtw_init_queue(&psta_recvpriv->defrag_q); ++ ++ ++} ++ ++sint _rtw_init_recv_priv(struct recv_priv *precvpriv, _adapter *padapter) ++{ ++ sint i; ++ ++ union recv_frame *precvframe; ++ sint res = _SUCCESS; ++ ++ ++ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). */ ++ /* _rtw_memset((unsigned char *)precvpriv, 0, sizeof (struct recv_priv)); */ ++ ++ _rtw_spinlock_init(&precvpriv->lock); ++ ++ _rtw_init_queue(&precvpriv->free_recv_queue); ++ _rtw_init_queue(&precvpriv->recv_pending_queue); ++ _rtw_init_queue(&precvpriv->uc_swdec_pending_queue); ++ ++ precvpriv->adapter = padapter; ++ ++ precvpriv->free_recvframe_cnt = NR_RECVFRAME; ++ ++ precvpriv->sink_udpport = 0; ++ precvpriv->pre_rtp_rxseq = 0; ++ precvpriv->cur_rtp_rxseq = 0; ++ ++#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA ++ precvpriv->store_law_data_flag = 1; ++#else ++ precvpriv->store_law_data_flag = 0; ++#endif ++ ++ rtw_os_recv_resource_init(precvpriv, padapter); ++ ++ precvpriv->pallocated_frame_buf = rtw_zvmalloc(NR_RECVFRAME * sizeof(union recv_frame) + RXFRAME_ALIGN_SZ); ++ ++ if (precvpriv->pallocated_frame_buf == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ /* _rtw_memset(precvpriv->pallocated_frame_buf, 0, NR_RECVFRAME * sizeof(union recv_frame) + RXFRAME_ALIGN_SZ); */ ++ ++ precvpriv->precv_frame_buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(precvpriv->pallocated_frame_buf), RXFRAME_ALIGN_SZ); ++ /* precvpriv->precv_frame_buf = precvpriv->pallocated_frame_buf + RXFRAME_ALIGN_SZ - */ ++ /* ((SIZE_PTR) (precvpriv->pallocated_frame_buf) &(RXFRAME_ALIGN_SZ-1)); */ ++ ++ precvframe = (union recv_frame *) precvpriv->precv_frame_buf; ++ ++ ++ for (i = 0; i < NR_RECVFRAME ; i++) { ++ _rtw_init_listhead(&(precvframe->u.list)); ++ ++ rtw_list_insert_tail(&(precvframe->u.list), &(precvpriv->free_recv_queue.queue)); ++ ++ res = rtw_os_recv_resource_alloc(padapter, precvframe); ++ ++ precvframe->u.hdr.len = 0; ++ ++ precvframe->u.hdr.adapter = padapter; ++ precvframe++; ++ ++ } ++ ++#ifdef CONFIG_USB_HCI ++ ++ ATOMIC_SET(&(precvpriv->rx_pending_cnt), 1); ++ ++ _rtw_init_sema(&precvpriv->allrxreturnevt, 0); ++ ++#endif ++ ++ res = rtw_hal_init_recv_priv(padapter); ++ ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ rtw_init_timer(&precvpriv->signal_stat_timer, padapter, RTW_TIMER_HDL_NAME(signal_stat)); ++ ++ precvpriv->signal_stat_sampling_interval = 2000; /* ms */ ++ /* precvpriv->signal_stat_converging_constant = 5000; */ /* ms */ ++ ++ rtw_set_signal_stat_timer(precvpriv); ++#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ ++ ++exit: ++ ++ ++ return res; ++ ++} ++ ++void rtw_mfree_recv_priv_lock(struct recv_priv *precvpriv); ++void rtw_mfree_recv_priv_lock(struct recv_priv *precvpriv) ++{ ++ _rtw_spinlock_free(&precvpriv->lock); ++#ifdef CONFIG_RECV_THREAD_MODE ++ _rtw_free_sema(&precvpriv->recv_sema); ++ /*_rtw_free_sema(&precvpriv->terminate_recvthread_sema);*/ ++#endif ++ ++ _rtw_spinlock_free(&precvpriv->free_recv_queue.lock); ++ _rtw_spinlock_free(&precvpriv->recv_pending_queue.lock); ++ ++ _rtw_spinlock_free(&precvpriv->free_recv_buf_queue.lock); ++ ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX ++ _rtw_spinlock_free(&precvpriv->recv_buf_pending_queue.lock); ++#endif /* CONFIG_USE_USB_BUFFER_ALLOC_RX */ ++} ++ ++void _rtw_free_recv_priv(struct recv_priv *precvpriv) ++{ ++ _adapter *padapter = precvpriv->adapter; ++ ++ ++ rtw_free_uc_swdec_pending_queue(padapter); ++ ++ rtw_mfree_recv_priv_lock(precvpriv); ++ ++ rtw_os_recv_resource_free(precvpriv); ++ ++ if (precvpriv->pallocated_frame_buf) ++ rtw_vmfree(precvpriv->pallocated_frame_buf, NR_RECVFRAME * sizeof(union recv_frame) + RXFRAME_ALIGN_SZ); ++ ++ rtw_hal_free_recv_priv(padapter); ++ ++ ++} ++ ++bool rtw_rframe_del_wfd_ie(union recv_frame *rframe, u8 ies_offset) ++{ ++#define DBG_RFRAME_DEL_WFD_IE 0 ++ u8 *ies = rframe->u.hdr.rx_data + sizeof(struct rtw_ieee80211_hdr_3addr) + ies_offset; ++ uint ies_len_ori = rframe->u.hdr.len - (ies - rframe->u.hdr.rx_data); ++ uint ies_len; ++ ++ ies_len = rtw_del_wfd_ie(ies, ies_len_ori, DBG_RFRAME_DEL_WFD_IE ? __func__ : NULL); ++ rframe->u.hdr.len -= ies_len_ori - ies_len; ++ ++ return ies_len_ori != ies_len; ++} ++ ++union recv_frame *_rtw_alloc_recvframe(_queue *pfree_recv_queue) ++{ ++ ++ union recv_frame *precvframe; ++ _list *plist, *phead; ++ _adapter *padapter; ++ struct recv_priv *precvpriv; ++ ++ if (_rtw_queue_empty(pfree_recv_queue) == _TRUE) ++ precvframe = NULL; ++ else { ++ phead = get_list_head(pfree_recv_queue); ++ ++ plist = get_next(phead); ++ ++ precvframe = LIST_CONTAINOR(plist, union recv_frame, u); ++ ++ rtw_list_delete(&precvframe->u.hdr.list); ++ padapter = precvframe->u.hdr.adapter; ++ if (padapter != NULL) { ++ precvpriv = &padapter->recvpriv; ++ if (pfree_recv_queue == &precvpriv->free_recv_queue) ++ precvpriv->free_recvframe_cnt--; ++ } ++ } ++ ++ ++ return precvframe; ++ ++} ++ ++union recv_frame *rtw_alloc_recvframe(_queue *pfree_recv_queue) ++{ ++ _irqL irqL; ++ union recv_frame *precvframe; ++ ++ _enter_critical_bh(&pfree_recv_queue->lock, &irqL); ++ ++ precvframe = _rtw_alloc_recvframe(pfree_recv_queue); ++ ++ _exit_critical_bh(&pfree_recv_queue->lock, &irqL); ++ ++ return precvframe; ++} ++ ++void rtw_init_recvframe(union recv_frame *precvframe, struct recv_priv *precvpriv) ++{ ++ /* Perry: This can be removed */ ++ _rtw_init_listhead(&precvframe->u.hdr.list); ++ ++ precvframe->u.hdr.len = 0; ++} ++ ++int rtw_free_recvframe(union recv_frame *precvframe, _queue *pfree_recv_queue) ++{ ++ _irqL irqL; ++ _adapter *padapter = precvframe->u.hdr.adapter; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ padapter = GET_PRIMARY_ADAPTER(padapter); ++ precvpriv = &padapter->recvpriv; ++ pfree_recv_queue = &precvpriv->free_recv_queue; ++ precvframe->u.hdr.adapter = padapter; ++#endif ++ ++ ++ rtw_os_free_recvframe(precvframe); ++ ++ ++ _enter_critical_bh(&pfree_recv_queue->lock, &irqL); ++ ++ rtw_list_delete(&(precvframe->u.hdr.list)); ++ ++ precvframe->u.hdr.len = 0; ++ ++ rtw_list_insert_tail(&(precvframe->u.hdr.list), get_list_head(pfree_recv_queue)); ++ ++ if (padapter != NULL) { ++ if (pfree_recv_queue == &precvpriv->free_recv_queue) ++ precvpriv->free_recvframe_cnt++; ++ } ++ ++ _exit_critical_bh(&pfree_recv_queue->lock, &irqL); ++ ++ ++ return _SUCCESS; ++ ++} ++ ++ ++ ++ ++sint _rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue) ++{ ++ ++ _adapter *padapter = precvframe->u.hdr.adapter; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ ++ ++ /* _rtw_init_listhead(&(precvframe->u.hdr.list)); */ ++ rtw_list_delete(&(precvframe->u.hdr.list)); ++ ++ ++ rtw_list_insert_tail(&(precvframe->u.hdr.list), get_list_head(queue)); ++ ++ if (padapter != NULL) { ++ if (queue == &precvpriv->free_recv_queue) ++ precvpriv->free_recvframe_cnt++; ++ } ++ ++ ++ return _SUCCESS; ++} ++ ++sint rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue) ++{ ++ sint ret; ++ _irqL irqL; ++ ++ /* _spinlock(&pfree_recv_queue->lock); */ ++ _enter_critical_bh(&queue->lock, &irqL); ++ ret = _rtw_enqueue_recvframe(precvframe, queue); ++ /* _rtw_spinunlock(&pfree_recv_queue->lock); */ ++ _exit_critical_bh(&queue->lock, &irqL); ++ ++ return ret; ++} ++ ++/* ++sint rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue) ++{ ++ return rtw_free_recvframe(precvframe, queue); ++} ++*/ ++ ++ ++ ++ ++/* ++caller : defrag ; recvframe_chk_defrag in recv_thread (passive) ++pframequeue: defrag_queue : will be accessed in recv_thread (passive) ++ ++using spinlock to protect ++ ++*/ ++ ++void rtw_free_recvframe_queue(_queue *pframequeue, _queue *pfree_recv_queue) ++{ ++ union recv_frame *precvframe; ++ _list *plist, *phead; ++ ++ _rtw_spinlock(&pframequeue->lock); ++ ++ phead = get_list_head(pframequeue); ++ plist = get_next(phead); ++ ++ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ precvframe = LIST_CONTAINOR(plist, union recv_frame, u); ++ ++ plist = get_next(plist); ++ ++ /* rtw_list_delete(&precvframe->u.hdr.list); */ /* will do this in rtw_free_recvframe() */ ++ ++ rtw_free_recvframe(precvframe, pfree_recv_queue); ++ } ++ ++ _rtw_spinunlock(&pframequeue->lock); ++ ++ ++} ++ ++u32 rtw_free_uc_swdec_pending_queue(_adapter *adapter) ++{ ++ u32 cnt = 0; ++ union recv_frame *pending_frame; ++ while ((pending_frame = rtw_alloc_recvframe(&adapter->recvpriv.uc_swdec_pending_queue))) { ++ rtw_free_recvframe(pending_frame, &adapter->recvpriv.free_recv_queue); ++ cnt++; ++ } ++ ++ if (cnt) ++ RTW_INFO(FUNC_ADPT_FMT" dequeue %d\n", FUNC_ADPT_ARG(adapter), cnt); ++ ++ return cnt; ++} ++ ++ ++sint rtw_enqueue_recvbuf_to_head(struct recv_buf *precvbuf, _queue *queue) ++{ ++ _irqL irqL; ++ ++ _enter_critical_bh(&queue->lock, &irqL); ++ ++ rtw_list_delete(&precvbuf->list); ++ rtw_list_insert_head(&precvbuf->list, get_list_head(queue)); ++ ++ _exit_critical_bh(&queue->lock, &irqL); ++ ++ return _SUCCESS; ++} ++ ++sint rtw_enqueue_recvbuf(struct recv_buf *precvbuf, _queue *queue) ++{ ++ _irqL irqL; ++#ifdef CONFIG_SDIO_HCI ++ _enter_critical_bh(&queue->lock, &irqL); ++#else ++ _enter_critical_ex(&queue->lock, &irqL); ++#endif/*#ifdef CONFIG_SDIO_HCI*/ ++ ++ rtw_list_delete(&precvbuf->list); ++ ++ rtw_list_insert_tail(&precvbuf->list, get_list_head(queue)); ++#ifdef CONFIG_SDIO_HCI ++ _exit_critical_bh(&queue->lock, &irqL); ++#else ++ _exit_critical_ex(&queue->lock, &irqL); ++#endif/*#ifdef CONFIG_SDIO_HCI*/ ++ return _SUCCESS; ++ ++} ++ ++struct recv_buf *rtw_dequeue_recvbuf(_queue *queue) ++{ ++ _irqL irqL; ++ struct recv_buf *precvbuf; ++ _list *plist, *phead; ++ ++#ifdef CONFIG_SDIO_HCI ++ _enter_critical_bh(&queue->lock, &irqL); ++#else ++ _enter_critical_ex(&queue->lock, &irqL); ++#endif/*#ifdef CONFIG_SDIO_HCI*/ ++ ++ if (_rtw_queue_empty(queue) == _TRUE) ++ precvbuf = NULL; ++ else { ++ phead = get_list_head(queue); ++ ++ plist = get_next(phead); ++ ++ precvbuf = LIST_CONTAINOR(plist, struct recv_buf, list); ++ ++ rtw_list_delete(&precvbuf->list); ++ ++ } ++ ++#ifdef CONFIG_SDIO_HCI ++ _exit_critical_bh(&queue->lock, &irqL); ++#else ++ _exit_critical_ex(&queue->lock, &irqL); ++#endif/*#ifdef CONFIG_SDIO_HCI*/ ++ ++ return precvbuf; ++ ++} ++ ++sint recvframe_chkmic(_adapter *adapter, union recv_frame *precvframe); ++sint recvframe_chkmic(_adapter *adapter, union recv_frame *precvframe) ++{ ++ ++ sint i, res = _SUCCESS; ++ u32 datalen; ++ u8 miccode[8]; ++ u8 bmic_err = _FALSE, brpt_micerror = _TRUE; ++ u8 *pframe, *payload, *pframemic; ++ u8 *mickey; ++ /* u8 *iv,rxdata_key_idx=0; */ ++ struct sta_info *stainfo; ++ struct rx_pkt_attrib *prxattrib = &precvframe->u.hdr.attrib; ++ struct security_priv *psecuritypriv = &adapter->securitypriv; ++ ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ stainfo = rtw_get_stainfo(&adapter->stapriv , &prxattrib->ta[0]); ++ ++ if (prxattrib->encrypt == _TKIP_) { ++ ++ /* calculate mic code */ ++ if (stainfo != NULL) { ++ if (IS_MCAST(prxattrib->ra)) { ++ /* mickey=&psecuritypriv->dot118021XGrprxmickey.skey[0]; */ ++ /* iv = precvframe->u.hdr.rx_data+prxattrib->hdrlen; */ ++ /* rxdata_key_idx =( ((iv[3])>>6)&0x3) ; */ ++ mickey = &psecuritypriv->dot118021XGrprxmickey[prxattrib->key_index].skey[0]; ++ ++ /* RTW_INFO("\n recvframe_chkmic: bcmc key psecuritypriv->dot118021XGrpKeyid(%d),pmlmeinfo->key_index(%d) ,recv key_id(%d)\n", */ ++ /* psecuritypriv->dot118021XGrpKeyid,pmlmeinfo->key_index,rxdata_key_idx); */ ++ ++ if (psecuritypriv->binstallGrpkey == _FALSE) { ++ res = _FAIL; ++ RTW_INFO("\n recvframe_chkmic:didn't install group key!!!!!!!!!!\n"); ++ goto exit; ++ } ++ } else { ++ mickey = &stainfo->dot11tkiprxmickey.skey[0]; ++ } ++ ++ datalen = precvframe->u.hdr.len - prxattrib->hdrlen - prxattrib->iv_len - prxattrib->icv_len - 8; /* icv_len included the mic code */ ++ pframe = precvframe->u.hdr.rx_data; ++ payload = pframe + prxattrib->hdrlen + prxattrib->iv_len; ++ ++ ++ /* rtw_seccalctkipmic(&stainfo->dot11tkiprxmickey.skey[0],pframe,payload, datalen ,&miccode[0],(unsigned char)prxattrib->priority); */ /* care the length of the data */ ++ ++ rtw_seccalctkipmic(mickey, pframe, payload, datalen , &miccode[0], (unsigned char)prxattrib->priority); /* care the length of the data */ ++ ++ pframemic = payload + datalen; ++ ++ bmic_err = _FALSE; ++ ++ for (i = 0; i < 8; i++) { ++ if (miccode[i] != *(pframemic + i)) { ++ bmic_err = _TRUE; ++ } ++ } ++ ++ ++ if (bmic_err == _TRUE) { ++ ++ ++ ++ /* double check key_index for some timing issue , */ ++ /* cannot compare with psecuritypriv->dot118021XGrpKeyid also cause timing issue */ ++ if ((IS_MCAST(prxattrib->ra) == _TRUE) && (prxattrib->key_index != pmlmeinfo->key_index)) ++ brpt_micerror = _FALSE; ++ ++ if ((prxattrib->bdecrypted == _TRUE) && (brpt_micerror == _TRUE)) { ++ rtw_handle_tkip_mic_err(adapter, stainfo, (u8)IS_MCAST(prxattrib->ra)); ++ RTW_INFO(" mic error :prxattrib->bdecrypted=%d\n", prxattrib->bdecrypted); ++ } else { ++ RTW_INFO(" mic error :prxattrib->bdecrypted=%d\n", prxattrib->bdecrypted); ++ } ++ ++ res = _FAIL; ++ ++ } else { ++ /* mic checked ok */ ++ if ((psecuritypriv->bcheck_grpkey == _FALSE) && (IS_MCAST(prxattrib->ra) == _TRUE)) { ++ psecuritypriv->bcheck_grpkey = _TRUE; ++ } ++ } ++ ++ } ++ ++ recvframe_pull_tail(precvframe, 8); ++ ++ } ++ ++exit: ++ ++ ++ return res; ++ ++} ++ ++/*#define DBG_RX_SW_DECRYPTOR*/ ++ ++/* decrypt and set the ivlen,icvlen of the recv_frame */ ++union recv_frame *decryptor(_adapter *padapter, union recv_frame *precv_frame); ++union recv_frame *decryptor(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ ++ struct rx_pkt_attrib *prxattrib = &precv_frame->u.hdr.attrib; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ union recv_frame *return_packet = precv_frame; ++ u32 res = _SUCCESS; ++ ++ ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt); ++ ++ ++ if (prxattrib->encrypt > 0) { ++ u8 *iv = precv_frame->u.hdr.rx_data + prxattrib->hdrlen; ++ prxattrib->key_index = (((iv[3]) >> 6) & 0x3) ; ++ ++ if (prxattrib->key_index > WEP_KEYS) { ++ RTW_INFO("prxattrib->key_index(%d) > WEP_KEYS\n", prxattrib->key_index); ++ ++ switch (prxattrib->encrypt) { ++ case _WEP40_: ++ case _WEP104_: ++ prxattrib->key_index = psecuritypriv->dot11PrivacyKeyIndex; ++ break; ++ case _TKIP_: ++ case _AES_: ++ default: ++ prxattrib->key_index = psecuritypriv->dot118021XGrpKeyid; ++ break; ++ } ++ } ++ } ++ ++ if ((prxattrib->encrypt > 0) && ((prxattrib->bdecrypted == 0) || (psecuritypriv->sw_decrypt == _TRUE))) { ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (!IS_MCAST(prxattrib->ra)) /* bc/mc packets use sw decryption for concurrent mode */ ++#endif ++ psecuritypriv->hw_decrypted = _FALSE; ++ ++#ifdef DBG_RX_SW_DECRYPTOR ++ RTW_INFO(ADPT_FMT" - sec_type:%s DO SW decryption\n", ++ ADPT_ARG(padapter), security_type_str(prxattrib->encrypt)); ++#endif ++ ++#ifdef DBG_RX_DECRYPTOR ++ RTW_INFO("[%s] %d:prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n", ++ __FUNCTION__, ++ __LINE__, ++ prxattrib->bdecrypted, ++ prxattrib->encrypt, ++ psecuritypriv->hw_decrypted); ++#endif ++ ++ switch (prxattrib->encrypt) { ++ case _WEP40_: ++ case _WEP104_: ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_wep); ++ rtw_wep_decrypt(padapter, (u8 *)precv_frame); ++ break; ++ case _TKIP_: ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_tkip); ++ res = rtw_tkip_decrypt(padapter, (u8 *)precv_frame); ++ break; ++ case _AES_: ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_aes); ++ res = rtw_aes_decrypt(padapter, (u8 *)precv_frame); ++ break; ++#ifdef CONFIG_WAPI_SUPPORT ++ case _SMS4_: ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_wapi); ++ rtw_sms4_decrypt(padapter, (u8 *)precv_frame); ++ break; ++#endif ++ default: ++ break; ++ } ++ } else if (prxattrib->bdecrypted == 1 ++ && prxattrib->encrypt > 0 ++ && (psecuritypriv->busetkipkey == 1 || prxattrib->encrypt != _TKIP_) ++ ) { ++#if 0 ++ if ((prxstat->icv == 1) && (prxattrib->encrypt != _AES_)) { ++ psecuritypriv->hw_decrypted = _FALSE; ++ ++ ++ rtw_free_recvframe(precv_frame, &padapter->recvpriv.free_recv_queue); ++ ++ return_packet = NULL; ++ ++ } else ++#endif ++ { ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_hw); ++ ++ psecuritypriv->hw_decrypted = _TRUE; ++#ifdef DBG_RX_DECRYPTOR ++ RTW_INFO("[%s] %d:prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n", ++ __FUNCTION__, ++ __LINE__, ++ prxattrib->bdecrypted, ++ prxattrib->encrypt, ++ psecuritypriv->hw_decrypted); ++ ++#endif ++ } ++ } else { ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_unknown); ++#ifdef DBG_RX_DECRYPTOR ++ RTW_INFO("[%s] %d:prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n", ++ __FUNCTION__, ++ __LINE__, ++ prxattrib->bdecrypted, ++ prxattrib->encrypt, ++ psecuritypriv->hw_decrypted); ++#endif ++ } ++ ++ if (res == _FAIL) { ++ rtw_free_recvframe(return_packet, &padapter->recvpriv.free_recv_queue); ++ return_packet = NULL; ++ } else ++ prxattrib->bdecrypted = _TRUE; ++ /* recvframe_chkmic(adapter, precv_frame); */ /* move to recvframme_defrag function */ ++ ++ ++ return return_packet; ++ ++} ++/* ###set the security information in the recv_frame */ ++union recv_frame *portctrl(_adapter *adapter, union recv_frame *precv_frame); ++union recv_frame *portctrl(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ u8 *psta_addr = NULL; ++ u8 *ptr; ++ uint auth_alg; ++ struct recv_frame_hdr *pfhdr; ++ struct sta_info *psta; ++ struct sta_priv *pstapriv ; ++ union recv_frame *prtnframe; ++ u16 ether_type = 0; ++ u16 eapol_type = 0x888e;/* for Funia BD's WPA issue */ ++ struct rx_pkt_attrib *pattrib; ++ ++ ++ pstapriv = &adapter->stapriv; ++ ++ auth_alg = adapter->securitypriv.dot11AuthAlgrthm; ++ ++ ptr = get_recvframe_data(precv_frame); ++ pfhdr = &precv_frame->u.hdr; ++ pattrib = &pfhdr->attrib; ++ psta_addr = pattrib->ta; ++ ++ prtnframe = NULL; ++ ++ psta = rtw_get_stainfo(pstapriv, psta_addr); ++ ++ ++ if (auth_alg == dot11AuthAlgrthm_8021X) { ++ if ((psta != NULL) && (psta->ieee8021x_blocked)) { ++ /* blocked */ ++ /* only accept EAPOL frame */ ++ ++ prtnframe = precv_frame; ++ ++ /* get ether_type */ ++ ptr = ptr + pfhdr->attrib.hdrlen + pfhdr->attrib.iv_len + LLC_HEADER_SIZE; ++ _rtw_memcpy(ðer_type, ptr, 2); ++ ether_type = ntohs((unsigned short)ether_type); ++ ++ if (ether_type == eapol_type) ++ prtnframe = precv_frame; ++ else { ++ /* free this frame */ ++ rtw_free_recvframe(precv_frame, &adapter->recvpriv.free_recv_queue); ++ prtnframe = NULL; ++ } ++ } else { ++ /* allowed */ ++ /* check decryption status, and decrypt the frame if needed */ ++ ++ ++ prtnframe = precv_frame; ++ /* check is the EAPOL frame or not (Rekey) */ ++ /* if(ether_type == eapol_type){ */ ++ /* check Rekey */ ++ ++ /* prtnframe=precv_frame; */ ++ /* } */ ++ } ++ } else ++ prtnframe = precv_frame; ++ ++ ++ return prtnframe; ++ ++} ++ ++sint recv_decache(union recv_frame *precv_frame, u8 bretry, struct stainfo_rxcache *prxcache); ++sint recv_decache(union recv_frame *precv_frame, u8 bretry, struct stainfo_rxcache *prxcache) ++{ ++ sint tid = precv_frame->u.hdr.attrib.priority; ++ ++ u16 seq_ctrl = ((precv_frame->u.hdr.attrib.seq_num & 0xffff) << 4) | ++ (precv_frame->u.hdr.attrib.frag_num & 0xf); ++ ++ ++ if (tid > 15) { ++ ++ return _FAIL; ++ } ++ ++ if (1) { /* if(bretry) */ ++ if (seq_ctrl == prxcache->tid_rxseq[tid]) { ++ ++ return _FAIL; ++ } ++ } ++ ++ prxcache->tid_rxseq[tid] = seq_ctrl; ++ ++ ++ return _SUCCESS; ++ ++} ++ ++#define PN_LESS_CHK(a, b) (((a-b) & 0x800000000000) != 0) ++#define PN_EQUAL_CHK(a, b) (a == b) ++sint recv_ucast_pn_decache(union recv_frame *precv_frame, struct stainfo_rxcache *prxcache); ++sint recv_ucast_pn_decache(union recv_frame *precv_frame, struct stainfo_rxcache *prxcache) ++{ ++ _adapter *padapter = precv_frame->u.hdr.adapter; ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ u8 *pdata = precv_frame->u.hdr.rx_data; ++ u32 data_len = precv_frame->u.hdr.len; ++ sint tid = precv_frame->u.hdr.attrib.priority; ++ u64 tmp_iv_hdr = 0; ++ u64 curr_pn = 0, pkt_pn = 0; ++ ++ if (tid > 15) ++ return _FAIL; ++ ++ if (pattrib->encrypt == _AES_) { ++ _rtw_memcpy(&tmp_iv_hdr, (pdata + pattrib->hdrlen), 8); ++ tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); ++ pkt_pn = (tmp_iv_hdr & 0x000000000000ffff) | ++ ((tmp_iv_hdr & 0xffffffff00000000) >> 16); ++ ++ _rtw_memcpy(&tmp_iv_hdr, prxcache->iv[tid], 8); ++ tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); ++ curr_pn = (tmp_iv_hdr & 0x000000000000ffff) | ++ ((tmp_iv_hdr & 0xffffffff00000000) >> 16); ++ ++ if (curr_pn == 0) { ++ _rtw_memcpy(prxcache->iv[tid], (pdata + pattrib->hdrlen), sizeof(prxcache->iv[tid])); ++ goto exit; ++ } ++ ++ if (PN_LESS_CHK(pkt_pn, curr_pn) || PN_EQUAL_CHK(pkt_pn, curr_pn)) { ++ /* return _FAIL; */ ++ } else ++ _rtw_memcpy(prxcache->iv[tid], (pdata + pattrib->hdrlen), sizeof(prxcache->iv[tid])); ++ } ++ ++exit: ++ return _SUCCESS; ++} ++ ++sint recv_bcast_pn_decache(union recv_frame *precv_frame); ++sint recv_bcast_pn_decache(union recv_frame *precv_frame) ++{ ++ _adapter *padapter = precv_frame->u.hdr.adapter; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ u8 *pdata = precv_frame->u.hdr.rx_data; ++ u32 data_len = precv_frame->u.hdr.len; ++ u64 tmp_iv_hdr = 0; ++ u64 curr_pn = 0, pkt_pn = 0; ++ u8 key_id; ++ ++ if ((pattrib->encrypt == _AES_) && ++ (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)) { ++ _rtw_memcpy(&tmp_iv_hdr, (pdata + pattrib->hdrlen), 8); ++ tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); ++ key_id = ((tmp_iv_hdr & 0x00000000c0000000) >> 30); ++ pkt_pn = (tmp_iv_hdr & 0x000000000000ffff) | ++ ((tmp_iv_hdr & 0xffffffff00000000) >> 16); ++ ++ if (key_id >= 4 ) ++ return _FAIL; ++ ++ _rtw_memcpy(&tmp_iv_hdr, psecuritypriv->iv_seq[key_id], 8); ++ tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); ++ curr_pn = (tmp_iv_hdr & 0x000000000000ffff) | ++ ((tmp_iv_hdr & 0xffffffff00000000) >> 16); ++ ++ if (PN_LESS_CHK(pkt_pn, curr_pn) || PN_EQUAL_CHK(pkt_pn, curr_pn)) { ++ return _FAIL; ++ } else ++ _rtw_memcpy(psecuritypriv->iv_seq[key_id], (pdata + pattrib->hdrlen), sizeof(psecuritypriv->iv_seq[key_id])); ++ } ++ ++ return _SUCCESS; ++} ++ ++void process_pwrbit_data(_adapter *padapter, union recv_frame *precv_frame); ++void process_pwrbit_data(_adapter *padapter, union recv_frame *precv_frame) ++{ ++#ifdef CONFIG_AP_MODE ++ unsigned char pwrbit; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta = NULL; ++ ++ psta = rtw_get_stainfo(pstapriv, pattrib->src); ++ ++ pwrbit = GetPwrMgt(ptr); ++ ++ if (psta) { ++ if (pwrbit) { ++ if (!(psta->state & WIFI_SLEEP_STATE)) { ++ /* psta->state |= WIFI_SLEEP_STATE; */ ++ /* pstapriv->sta_dz_bitmap |= BIT(psta->aid); */ ++ ++ stop_sta_xmit(padapter, psta); ++ ++ /* RTW_INFO("to sleep, sta_dz_bitmap=%x\n", pstapriv->sta_dz_bitmap); */ ++ } ++ } else { ++ if (psta->state & WIFI_SLEEP_STATE) { ++ /* psta->state ^= WIFI_SLEEP_STATE; */ ++ /* pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); */ ++ ++ wakeup_sta_to_xmit(padapter, psta); ++ ++ /* RTW_INFO("to wakeup, sta_dz_bitmap=%x\n", pstapriv->sta_dz_bitmap); */ ++ } ++ } ++ ++ } ++ ++#endif ++} ++ ++void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame); ++void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame) ++{ ++#ifdef CONFIG_AP_MODE ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta = NULL; ++ ++ psta = rtw_get_stainfo(pstapriv, pattrib->src); ++ ++ if (!psta) ++ return; ++ ++#ifdef CONFIG_TDLS ++ if (!(psta->tdls_sta_state & TDLS_LINKED_STATE)) { ++#endif /* CONFIG_TDLS */ ++ ++ if (!psta->qos_option) ++ return; ++ ++ if (!(psta->qos_info & 0xf)) ++ return; ++ ++#ifdef CONFIG_TDLS ++ } ++#endif /* CONFIG_TDLS */ ++ ++ if (psta->state & WIFI_SLEEP_STATE) { ++ u8 wmmps_ac = 0; ++ ++ switch (pattrib->priority) { ++ case 1: ++ case 2: ++ wmmps_ac = psta->uapsd_bk & BIT(1); ++ break; ++ case 4: ++ case 5: ++ wmmps_ac = psta->uapsd_vi & BIT(1); ++ break; ++ case 6: ++ case 7: ++ wmmps_ac = psta->uapsd_vo & BIT(1); ++ break; ++ case 0: ++ case 3: ++ default: ++ wmmps_ac = psta->uapsd_be & BIT(1); ++ break; ++ } ++ ++ if (wmmps_ac) { ++ if (psta->sleepq_ac_len > 0) { ++ /* process received triggered frame */ ++ xmit_delivery_enabled_frames(padapter, psta); ++ } else { ++ /* issue one qos null frame with More data bit = 0 and the EOSP bit set (=1) */ ++ issue_qos_nulldata(padapter, psta->hwaddr, (u16)pattrib->priority, 0, 0); ++ } ++ } ++ ++ } ++ ++ ++#endif ++ ++} ++ ++#ifdef CONFIG_TDLS ++sint OnTDLS(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ sint ret = _SUCCESS; ++ u8 *paction = get_recvframe_data(precv_frame); ++ u8 category_field = 1; ++#ifdef CONFIG_WFD ++ u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a }; ++#endif /* CONFIG_WFD */ ++ struct tdls_info *ptdlsinfo = &(adapter->tdlsinfo); ++ ++ /* point to action field */ ++ paction += pattrib->hdrlen ++ + pattrib->iv_len ++ + SNAP_SIZE ++ + ETH_TYPE_LEN ++ + PAYLOAD_TYPE_LEN ++ + category_field; ++ ++ RTW_INFO("[TDLS] Recv %s from "MAC_FMT" with SeqNum = %d\n", rtw_tdls_action_txt(*paction), MAC_ARG(pattrib->src), GetSequence(get_recvframe_data(precv_frame))); ++ ++ if (hal_chk_wl_func(adapter, WL_FUNC_TDLS) == _FALSE) { ++ RTW_INFO("Ignore tdls frame since hal doesn't support tdls\n"); ++ ret = _FAIL; ++ return ret; ++ } ++ ++ if (ptdlsinfo->tdls_enable == _FALSE) { ++ RTW_INFO("recv tdls frame, " ++ "but tdls haven't enabled\n"); ++ ret = _FAIL; ++ return ret; ++ } ++ ++ switch (*paction) { ++ case TDLS_SETUP_REQUEST: ++ ret = On_TDLS_Setup_Req(adapter, precv_frame); ++ break; ++ case TDLS_SETUP_RESPONSE: ++ ret = On_TDLS_Setup_Rsp(adapter, precv_frame); ++ break; ++ case TDLS_SETUP_CONFIRM: ++ ret = On_TDLS_Setup_Cfm(adapter, precv_frame); ++ break; ++ case TDLS_TEARDOWN: ++ ret = On_TDLS_Teardown(adapter, precv_frame); ++ break; ++ case TDLS_DISCOVERY_REQUEST: ++ ret = On_TDLS_Dis_Req(adapter, precv_frame); ++ break; ++ case TDLS_PEER_TRAFFIC_INDICATION: ++ ret = On_TDLS_Peer_Traffic_Indication(adapter, precv_frame); ++ break; ++ case TDLS_PEER_TRAFFIC_RESPONSE: ++ ret = On_TDLS_Peer_Traffic_Rsp(adapter, precv_frame); ++ break; ++#ifdef CONFIG_TDLS_CH_SW ++ case TDLS_CHANNEL_SWITCH_REQUEST: ++ ret = On_TDLS_Ch_Switch_Req(adapter, precv_frame); ++ break; ++ case TDLS_CHANNEL_SWITCH_RESPONSE: ++ ret = On_TDLS_Ch_Switch_Rsp(adapter, precv_frame); ++ break; ++#endif ++#ifdef CONFIG_WFD ++ /* First byte of WFA OUI */ ++ case 0x50: ++ if (_rtw_memcmp(WFA_OUI, paction, 3)) { ++ /* Probe request frame */ ++ if (*(paction + 3) == 0x04) { ++ /* WFDTDLS: for sigma test, do not setup direct link automatically */ ++ ptdlsinfo->dev_discovered = _TRUE; ++ RTW_INFO("recv tunneled probe request frame\n"); ++ issue_tunneled_probe_rsp(adapter, precv_frame); ++ } ++ /* Probe response frame */ ++ if (*(paction + 3) == 0x05) { ++ /* WFDTDLS: for sigma test, do not setup direct link automatically */ ++ ptdlsinfo->dev_discovered = _TRUE; ++ RTW_INFO("recv tunneled probe response frame\n"); ++ } ++ } ++ break; ++#endif /* CONFIG_WFD */ ++ default: ++ RTW_INFO("receive TDLS frame %d but not support\n", *paction); ++ ret = _FAIL; ++ break; ++ } ++ ++exit: ++ return ret; ++ ++} ++#endif /* CONFIG_TDLS */ ++ ++void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_info *sta); ++void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_info *sta) ++{ ++ int sz; ++ struct sta_info *psta = NULL; ++ struct stainfo_stats *pstats = NULL; ++ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ sz = get_recvframe_len(prframe); ++ precvpriv->rx_bytes += sz; ++ ++ padapter->mlmepriv.LinkDetectInfo.NumRxOkInPeriod++; ++ ++ if ((!MacAddr_isBcst(pattrib->dst)) && (!IS_MCAST(pattrib->dst))) ++ padapter->mlmepriv.LinkDetectInfo.NumRxUnicastOkInPeriod++; ++ ++ if (sta) ++ psta = sta; ++ else ++ psta = prframe->u.hdr.psta; ++ ++ if (psta) { ++ pstats = &psta->sta_stats; ++ ++ pstats->rx_data_pkts++; ++ pstats->rx_bytes += sz; ++ ++ /*record rx packets for every tid*/ ++ pstats->rx_data_qos_pkts[pattrib->priority]++; ++ ++#ifdef CONFIG_TDLS ++ if (psta->tdls_sta_state & TDLS_LINKED_STATE) { ++ struct sta_info *pap_sta = NULL; ++ pap_sta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); ++ if (pap_sta) { ++ pstats = &pap_sta->sta_stats; ++ pstats->rx_data_pkts++; ++ pstats->rx_bytes += sz; ++ } ++ } ++#endif /* CONFIG_TDLS */ ++ } ++ ++#ifdef CONFIG_CHECK_LEAVE_LPS ++ traffic_check_for_leave_lps(padapter, _FALSE, 0); ++#endif /* CONFIG_LPS */ ++ ++} ++ ++sint sta2sta_data_frame( ++ _adapter *adapter, ++ union recv_frame *precv_frame, ++ struct sta_info **psta ++); ++sint sta2sta_data_frame( ++ _adapter *adapter, ++ union recv_frame *precv_frame, ++ struct sta_info **psta ++) ++{ ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ sint ret = _SUCCESS; ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ u8 *mybssid = get_bssid(pmlmepriv); ++ u8 *myhwaddr = adapter_mac_addr(adapter); ++ u8 *sta_addr = NULL; ++ sint bmcast = IS_MCAST(pattrib->dst); ++ ++#ifdef CONFIG_TDLS ++ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; ++#ifdef CONFIG_TDLS_CH_SW ++ struct tdls_ch_switch *pchsw_info = &ptdlsinfo->chsw_info; ++#endif ++ struct sta_info *ptdls_sta = NULL; ++ u8 *psnap_type = ptr + pattrib->hdrlen + pattrib->iv_len + SNAP_SIZE; ++ /* frame body located after [+2]: ether-type, [+1]: payload type */ ++ u8 *pframe_body = psnap_type + 2 + 1; ++#endif ++ ++ ++ /* RTW_INFO("[%s] %d, seqnum:%d\n", __FUNCTION__, __LINE__, pattrib->seq_num); */ ++ ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { ++ ++ /* filter packets that SA is myself or multicast or broadcast */ ++ if (_rtw_memcmp(myhwaddr, pattrib->src, ETH_ALEN)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ if ((!_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN)) && (!bmcast)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ if (_rtw_memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || ++ _rtw_memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || ++ (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN))) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ sta_addr = pattrib->src; ++ ++ } else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { ++#ifdef CONFIG_TDLS ++ ++ /* direct link data transfer */ ++ if (ptdlsinfo->link_established == _TRUE) { ++ ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->src); ++ if (ptdls_sta == NULL) { ++ ret = _FAIL; ++ goto exit; ++ } else if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { ++ /* filter packets that SA is myself or multicast or broadcast */ ++ if (_rtw_memcmp(myhwaddr, pattrib->src, ETH_ALEN)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ /* da should be for me */ ++ if ((!_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN)) && (!bmcast)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ /* check BSSID */ ++ if (_rtw_memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || ++ _rtw_memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || ++ (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN))) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++#ifdef CONFIG_TDLS_CH_SW ++ if (ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) { ++ if (adapter->mlmeextpriv.cur_channel != rtw_get_oper_ch(adapter)) { ++ pchsw_info->ch_sw_state |= TDLS_PEER_AT_OFF_STATE; ++ if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) ++ _cancel_timer_ex(&ptdls_sta->ch_sw_timer); ++ /* On_TDLS_Peer_Traffic_Rsp(adapter, precv_frame); */ ++ } ++ } ++#endif ++ ++ /* process UAPSD tdls sta */ ++ process_pwrbit_data(adapter, precv_frame); ++ ++ /* if NULL-frame, check pwrbit */ ++ if ((GetFrameSubType(ptr) & WIFI_DATA_NULL) == WIFI_DATA_NULL) { ++ /* NULL-frame with pwrbit=1, buffer_STA should buffer frames for sleep_STA */ ++ if (GetPwrMgt(ptr)) { ++ /* it would be triggered when we are off channel and receiving NULL DATA */ ++ /* we can confirm that peer STA is at off channel */ ++ RTW_INFO("TDLS: recv peer null frame with pwr bit 1\n"); ++ /* ptdls_sta->tdls_sta_state|=TDLS_PEER_SLEEP_STATE; */ ++ } ++ ++ /* TODO: Updated BSSID's seq. */ ++ /* RTW_INFO("drop Null Data\n"); */ ++ ptdls_sta->tdls_sta_state &= ~(TDLS_WAIT_PTR_STATE); ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* receive some of all TDLS management frames, process it at ON_TDLS */ ++ if (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_TDLS, 2)) { ++ ret = OnTDLS(adapter, precv_frame); ++ goto exit; ++ } ++ ++ if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) ++ process_wmmps_data(adapter, precv_frame); ++ ++ ptdls_sta->tdls_sta_state &= ~(TDLS_WAIT_PTR_STATE); ++ ++ } ++ ++ sta_addr = pattrib->src; ++ ++ } else ++#endif /* CONFIG_TDLS */ ++ { ++ /* For Station mode, sa and bssid should always be BSSID, and DA is my mac-address */ ++ if (!_rtw_memcmp(pattrib->bssid, pattrib->src, ETH_ALEN)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ sta_addr = pattrib->bssid; ++ } ++ ++ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { ++ if (bmcast) { ++ /* For AP mode, if DA == MCAST, then BSSID should be also MCAST */ ++ if (!IS_MCAST(pattrib->bssid)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ } else { /* not mc-frame */ ++ /* For AP mode, if DA is non-MCAST, then it must be BSSID, and bssid == BSSID */ ++ if (!_rtw_memcmp(pattrib->bssid, pattrib->dst, ETH_ALEN)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ sta_addr = pattrib->src; ++ } ++ ++ } else if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) { ++ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); ++ _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); ++ _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ sta_addr = mybssid; ++ } else ++ ret = _FAIL; ++ ++ ++ ++ if (bmcast) ++ *psta = rtw_get_bcmc_stainfo(adapter); ++ else ++ *psta = rtw_get_stainfo(pstapriv, sta_addr); /* get ap_info */ ++ ++#ifdef CONFIG_TDLS ++ if (ptdls_sta != NULL) ++ *psta = ptdls_sta; ++#endif /* CONFIG_TDLS */ ++ ++ if (*psta == NULL) { ++#ifdef CONFIG_MP_INCLUDED ++ if (adapter->registrypriv.mp_mode == 1) { ++ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) ++ adapter->mppriv.rx_pktloss++; ++ } ++#endif ++ ret = _FAIL; ++ goto exit; ++ } ++ ++exit: ++ return ret; ++ ++} ++ ++sint ap2sta_data_frame( ++ _adapter *adapter, ++ union recv_frame *precv_frame, ++ struct sta_info **psta); ++sint ap2sta_data_frame( ++ _adapter *adapter, ++ union recv_frame *precv_frame, ++ struct sta_info **psta) ++{ ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ sint ret = _SUCCESS; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ u8 *mybssid = get_bssid(pmlmepriv); ++ u8 *myhwaddr = adapter_mac_addr(adapter); ++ sint bmcast = IS_MCAST(pattrib->dst); ++ ++ ++ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) ++ && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE ++ || check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) ++ ) { ++ ++ /* filter packets that SA is myself or multicast or broadcast */ ++ if (_rtw_memcmp(myhwaddr, pattrib->src, ETH_ALEN)) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s SA="MAC_FMT", myhwaddr="MAC_FMT"\n", ++ __FUNCTION__, MAC_ARG(pattrib->src), MAC_ARG(myhwaddr)); ++#endif ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* da should be for me */ ++ if ((!_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN)) && (!bmcast)) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s DA="MAC_FMT"\n", __func__, MAC_ARG(pattrib->dst)); ++#endif ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ ++ /* check BSSID */ ++ if (_rtw_memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || ++ _rtw_memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || ++ (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN))) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s BSSID="MAC_FMT", mybssid="MAC_FMT"\n", ++ __func__, MAC_ARG(pattrib->bssid), MAC_ARG(mybssid)); ++#endif ++ ++ if (!bmcast) { ++ RTW_INFO(ADPT_FMT" -issue_deauth to the nonassociated ap=" MAC_FMT " for the reason(7)\n", ADPT_ARG(adapter), MAC_ARG(pattrib->bssid)); ++ issue_deauth(adapter, pattrib->bssid, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); ++ } ++ ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ if (bmcast) ++ *psta = rtw_get_bcmc_stainfo(adapter); ++ else ++ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get ap_info */ ++ ++ if (*psta == NULL) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s can't get psta under STATION_MODE ; drop pkt\n", __FUNCTION__); ++#endif ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) { ++ } ++ ++ if (GetFrameSubType(ptr) & BIT(6)) { ++ /* No data, will not indicate to upper layer, temporily count it here */ ++ count_rx_stats(adapter, precv_frame, *psta); ++ ret = RTW_RX_HANDLED; ++ goto exit; ++ } ++ ++ } else if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) && ++ (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { ++ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); ++ _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); ++ _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ ++ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get sta_info */ ++ if (*psta == NULL) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s can't get psta under WIFI_MP_STATE ; drop pkt\n", __FUNCTION__); ++#endif ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ ++ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { ++ /* Special case */ ++ ret = RTW_RX_HANDLED; ++ goto exit; ++ } else { ++ if (_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN) && (!bmcast)) { ++ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get sta_info */ ++ if (*psta == NULL) { ++ ++ /* for AP multicast issue , modify by yiwei */ ++ static u32 send_issue_deauth_time = 0; ++ ++ /* RTW_INFO("After send deauth , %u ms has elapsed.\n", rtw_get_passing_time_ms(send_issue_deauth_time)); */ ++ ++ if (rtw_get_passing_time_ms(send_issue_deauth_time) > 10000 || send_issue_deauth_time == 0) { ++ send_issue_deauth_time = rtw_get_current_time(); ++ ++ RTW_INFO("issue_deauth to the ap=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->bssid)); ++ ++ issue_deauth(adapter, pattrib->bssid, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); ++ } ++ } ++ } ++ ++ ret = _FAIL; ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s fw_state:0x%x\n", __FUNCTION__, get_fwstate(pmlmepriv)); ++#endif ++ } ++ ++exit: ++ ++ ++ return ret; ++ ++} ++ ++sint sta2ap_data_frame( ++ _adapter *adapter, ++ union recv_frame *precv_frame, ++ struct sta_info **psta); ++sint sta2ap_data_frame( ++ _adapter *adapter, ++ union recv_frame *precv_frame, ++ struct sta_info **psta) ++{ ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ unsigned char *mybssid = get_bssid(pmlmepriv); ++ sint ret = _SUCCESS; ++ ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { ++ /* For AP mode, RA=BSSID, TX=STA(SRC_ADDR), A3=DST_ADDR */ ++ if (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ *psta = rtw_get_stainfo(pstapriv, pattrib->src); ++ if (*psta == NULL) { ++ #ifdef CONFIG_DFS_MASTER ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ ++ /* prevent RX tasklet blocks cmd_thread */ ++ if (rfctl->radar_detected == 1) ++ goto bypass_deauth7; ++ #endif ++ ++ RTW_INFO("issue_deauth to sta=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->src)); ++ ++ issue_deauth(adapter, pattrib->src, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); ++ ++#ifdef CONFIG_DFS_MASTER ++bypass_deauth7: ++#endif ++ ret = RTW_RX_HANDLED; ++ goto exit; ++ } ++ ++ process_pwrbit_data(adapter, precv_frame); ++ ++ if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) ++ process_wmmps_data(adapter, precv_frame); ++ ++ if (GetFrameSubType(ptr) & BIT(6)) { ++ /* No data, will not indicate to upper layer, temporily count it here */ ++ count_rx_stats(adapter, precv_frame, *psta); ++ ret = RTW_RX_HANDLED; ++ goto exit; ++ } ++ } else if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) && ++ (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { ++ /* RTW_INFO("%s ,in WIFI_MP_STATE\n",__func__); */ ++ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); ++ _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); ++ _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ ++ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get sta_info */ ++ if (*psta == NULL) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s can't get psta under WIFI_MP_STATE ; drop pkt\n", __FUNCTION__); ++#endif ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ } else { ++ u8 *myhwaddr = adapter_mac_addr(adapter); ++ if (!_rtw_memcmp(pattrib->ra, myhwaddr, ETH_ALEN)) { ++ ret = RTW_RX_HANDLED; ++ goto exit; ++ } ++ RTW_INFO("issue_deauth to sta=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->src)); ++ issue_deauth(adapter, pattrib->src, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); ++ ret = RTW_RX_HANDLED; ++ goto exit; ++ } ++ ++exit: ++ ++ ++ return ret; ++ ++} ++ ++sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame); ++sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *pframe = precv_frame->u.hdr.rx_data; ++ struct sta_info *psta = NULL; ++ /* uint len = precv_frame->u.hdr.len; */ ++ ++ /* RTW_INFO("+validate_recv_ctrl_frame\n"); */ ++ ++ if (GetFrameType(pframe) != WIFI_CTRL_TYPE) ++ return _FAIL; ++ ++ /* receive the frames that ra(a1) is my address */ ++ if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_mac_addr(padapter), ETH_ALEN)) ++ return _FAIL; ++ ++ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ if (psta == NULL) ++ return _FAIL; ++ ++ /* for rx pkt statistics */ ++ psta->sta_stats.rx_ctrl_pkts++; ++ ++ /* only handle ps-poll */ ++ if (GetFrameSubType(pframe) == WIFI_PSPOLL) { ++#ifdef CONFIG_AP_MODE ++ u16 aid; ++ u8 wmmps_ac = 0; ++ ++ aid = GetAid(pframe); ++ if (psta->aid != aid) ++ return _FAIL; ++ ++ switch (pattrib->priority) { ++ case 1: ++ case 2: ++ wmmps_ac = psta->uapsd_bk & BIT(0); ++ break; ++ case 4: ++ case 5: ++ wmmps_ac = psta->uapsd_vi & BIT(0); ++ break; ++ case 6: ++ case 7: ++ wmmps_ac = psta->uapsd_vo & BIT(0); ++ break; ++ case 0: ++ case 3: ++ default: ++ wmmps_ac = psta->uapsd_be & BIT(0); ++ break; ++ } ++ ++ if (wmmps_ac) ++ return _FAIL; ++ ++ if (psta->state & WIFI_STA_ALIVE_CHK_STATE) { ++ RTW_INFO("%s alive check-rx ps-poll\n", __func__); ++ psta->expire_to = pstapriv->expire_to; ++ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; ++ } ++ ++ if ((psta->state & WIFI_SLEEP_STATE) && (pstapriv->sta_dz_bitmap & BIT(psta->aid))) { ++ _irqL irqL; ++ _list *xmitframe_plist, *xmitframe_phead; ++ struct xmit_frame *pxmitframe = NULL; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ /* _enter_critical_bh(&psta->sleep_q.lock, &irqL); */ ++ _enter_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ xmitframe_phead = get_list_head(&psta->sleep_q); ++ xmitframe_plist = get_next(xmitframe_phead); ++ ++ if ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { ++ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); ++ ++ xmitframe_plist = get_next(xmitframe_plist); ++ ++ rtw_list_delete(&pxmitframe->list); ++ ++ psta->sleepq_len--; ++ ++ if (psta->sleepq_len > 0) ++ pxmitframe->attrib.mdata = 1; ++ else ++ pxmitframe->attrib.mdata = 0; ++ ++ pxmitframe->attrib.triggered = 1; ++ ++ /* RTW_INFO("handling ps-poll, q_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); */ ++ ++#if 0 ++ _exit_critical_bh(&psta->sleep_q.lock, &irqL); ++ if (rtw_hal_xmit(padapter, pxmitframe) == _TRUE) ++ rtw_os_xmit_complete(padapter, pxmitframe); ++ _enter_critical_bh(&psta->sleep_q.lock, &irqL); ++#endif ++ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); ++ ++ if (psta->sleepq_len == 0) { ++ pstapriv->tim_bitmap &= ~BIT(psta->aid); ++ ++ /* RTW_INFO("after handling ps-poll, tim=%x\n", pstapriv->tim_bitmap); */ ++ ++ /* upate BCN for TIM IE */ ++ /* update_BCNTIM(padapter); */ ++ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); ++ } ++ ++ /* _exit_critical_bh(&psta->sleep_q.lock, &irqL); */ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ } else { ++ /* _exit_critical_bh(&psta->sleep_q.lock, &irqL); */ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ /* RTW_INFO("no buffered packets to xmit\n"); */ ++ if (pstapriv->tim_bitmap & BIT(psta->aid)) { ++ if (psta->sleepq_len == 0) { ++ RTW_INFO("no buffered packets to xmit\n"); ++ ++ /* issue nulldata with More data bit = 0 to indicate we have no buffered packets */ ++ issue_nulldata_in_interrupt(padapter, psta->hwaddr, 0); ++ } else { ++ RTW_INFO("error!psta->sleepq_len=%d\n", psta->sleepq_len); ++ psta->sleepq_len = 0; ++ } ++ ++ pstapriv->tim_bitmap &= ~BIT(psta->aid); ++ ++ /* upate BCN for TIM IE */ ++ /* update_BCNTIM(padapter); */ ++ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); ++ } ++ } ++ } ++#endif /* CONFIG_AP_MODE */ ++ } else if (GetFrameSubType(pframe) == WIFI_NDPA) { ++#ifdef CONFIG_BEAMFORMING ++ beamforming_get_ndpa_frame(padapter, precv_frame); ++#endif/*CONFIG_BEAMFORMING*/ ++ } ++ ++ return _FAIL; ++ ++} ++ ++union recv_frame *recvframe_chk_defrag(PADAPTER padapter, union recv_frame *precv_frame); ++sint validate_recv_mgnt_frame(PADAPTER padapter, union recv_frame *precv_frame); ++sint validate_recv_mgnt_frame(PADAPTER padapter, union recv_frame *precv_frame) ++{ ++ /* struct mlme_priv *pmlmepriv = &adapter->mlmepriv; */ ++ ++ ++#if 0 ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { ++#ifdef CONFIG_NATIVEAP_MLME ++ mgt_dispatcher(padapter, precv_frame); ++#else ++ rtw_hostapd_mlme_rx(padapter, precv_frame); ++#endif ++ } else ++ mgt_dispatcher(padapter, precv_frame); ++#endif ++ ++ precv_frame = recvframe_chk_defrag(padapter, precv_frame); ++ if (precv_frame == NULL) { ++ return _SUCCESS; ++ } ++ ++ { ++ /* for rx pkt statistics */ ++ struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, GetAddr2Ptr(precv_frame->u.hdr.rx_data)); ++ if (psta) { ++ psta->sta_stats.rx_mgnt_pkts++; ++ if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_BEACON) ++ psta->sta_stats.rx_beacon_pkts++; ++ else if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_PROBEREQ) ++ psta->sta_stats.rx_probereq_pkts++; ++ else if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_PROBERSP) { ++ if (_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(precv_frame->u.hdr.rx_data), ETH_ALEN) == _TRUE) ++ psta->sta_stats.rx_probersp_pkts++; ++ else if (is_broadcast_mac_addr(GetAddr1Ptr(precv_frame->u.hdr.rx_data)) ++ || is_multicast_mac_addr(GetAddr1Ptr(precv_frame->u.hdr.rx_data))) ++ psta->sta_stats.rx_probersp_bm_pkts++; ++ else ++ psta->sta_stats.rx_probersp_uo_pkts++; ++ } ++ } ++ } ++ ++#ifdef CONFIG_INTEL_PROXIM ++ if (padapter->proximity.proxim_on == _TRUE) { ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ struct recv_stat *prxstat = (struct recv_stat *) precv_frame->u.hdr.rx_head ; ++ u8 *pda, *psa, *pbssid, *ptr; ++ ptr = precv_frame->u.hdr.rx_data; ++ pda = get_da(ptr); ++ psa = get_sa(ptr); ++ pbssid = get_hdr_bssid(ptr); ++ ++ ++ _rtw_memcpy(pattrib->dst, pda, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, psa, ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->bssid, pbssid, ETH_ALEN); ++ ++ switch (pattrib->to_fr_ds) { ++ case 0: ++ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); ++ break; ++ ++ case 1: ++ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pbssid, ETH_ALEN); ++ break; ++ ++ case 2: ++ _rtw_memcpy(pattrib->ra, pbssid, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); ++ break; ++ ++ case 3: ++ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); ++ break; ++ ++ default: ++ break; ++ ++ } ++ pattrib->priority = 0; ++ pattrib->hdrlen = pattrib->to_fr_ds == 3 ? 30 : 24; ++ ++ padapter->proximity.proxim_rx(padapter, precv_frame); ++ } ++#endif ++ mgt_dispatcher(padapter, precv_frame); ++ ++ return _SUCCESS; ++ ++} ++ ++sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame); ++sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ u8 bretry; ++ u8 *psa, *pda, *pbssid; ++ struct sta_info *psta = NULL; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct security_priv *psecuritypriv = &adapter->securitypriv; ++ sint ret = _SUCCESS; ++ ++ ++ bretry = GetRetry(ptr); ++ pda = get_da(ptr); ++ psa = get_sa(ptr); ++ pbssid = get_hdr_bssid(ptr); ++ ++ if (pbssid == NULL) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s pbssid == NULL\n", __func__); ++#endif ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ _rtw_memcpy(pattrib->dst, pda, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, psa, ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->bssid, pbssid, ETH_ALEN); ++ ++ switch (pattrib->to_fr_ds) { ++ case 0: ++ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); ++ ret = sta2sta_data_frame(adapter, precv_frame, &psta); ++ break; ++ ++ case 1: ++ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pbssid, ETH_ALEN); ++ ret = ap2sta_data_frame(adapter, precv_frame, &psta); ++ break; ++ ++ case 2: ++ _rtw_memcpy(pattrib->ra, pbssid, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); ++ ret = sta2ap_data_frame(adapter, precv_frame, &psta); ++ break; ++ ++ case 3: ++ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); ++ ret = _FAIL; ++ break; ++ ++ default: ++ ret = _FAIL; ++ break; ++ ++ } ++ ++ if (ret == _FAIL) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s case:%d, res:%d\n", __FUNCTION__, pattrib->to_fr_ds, ret); ++#endif ++ goto exit; ++ } else if (ret == RTW_RX_HANDLED) ++ goto exit; ++ ++ ++ if (psta == NULL) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s psta == NULL\n", __func__); ++#endif ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* psta->rssi = prxcmd->rssi; */ ++ /* psta->signal_quality= prxcmd->sq; */ ++ precv_frame->u.hdr.psta = psta; ++ ++ ++ pattrib->amsdu = 0; ++ pattrib->ack_policy = 0; ++ /* parsing QC field */ ++ if (pattrib->qos == 1) { ++ pattrib->priority = GetPriority((ptr + 24)); ++ pattrib->ack_policy = GetAckpolicy((ptr + 24)); ++ pattrib->amsdu = GetAMsdu((ptr + 24)); ++ pattrib->hdrlen = pattrib->to_fr_ds == 3 ? 32 : 26; ++ ++ if (pattrib->priority != 0 && pattrib->priority != 3) ++ adapter->recvpriv.bIsAnyNonBEPkts = _TRUE; ++ else ++ adapter->recvpriv.bIsAnyNonBEPkts = _FALSE; ++ } else { ++ pattrib->priority = 0; ++ pattrib->hdrlen = pattrib->to_fr_ds == 3 ? 30 : 24; ++ } ++ ++ ++ if (pattrib->order) /* HT-CTRL 11n */ ++ pattrib->hdrlen += 4; ++ ++ precv_frame->u.hdr.preorder_ctrl = &psta->recvreorder_ctrl[pattrib->priority]; ++ ++ /* decache, drop duplicate recv packets */ ++ if (recv_decache(precv_frame, bretry, &psta->sta_recvpriv.rxcache) == _FAIL) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s recv_decache return _FAIL\n", __func__); ++#endif ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ if (!IS_MCAST(pattrib->ra)) { ++ if (recv_ucast_pn_decache(precv_frame, &psta->sta_recvpriv.rxcache) == _FAIL) { ++ #ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s recv_decache return _FAIL\n", __func__); ++ #endif ++ ret = _FAIL; ++ goto exit; ++ } ++ } else { ++ if (recv_bcast_pn_decache(precv_frame) == _FAIL) { ++ #ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" recv_bcast_pn_decache _FAIL for invalid PN!\n" ++ , FUNC_ADPT_ARG(adapter)); ++ #endif ++ ret = _FAIL; ++ goto exit; ++ } ++ } ++ ++ if (pattrib->privacy) { ++ ++ ++#ifdef CONFIG_TDLS ++ if ((psta->tdls_sta_state & TDLS_LINKED_STATE) && (psta->dot118021XPrivacy == _AES_)) ++ pattrib->encrypt = psta->dot118021XPrivacy; ++ else ++#endif /* CONFIG_TDLS */ ++ GET_ENCRY_ALGO(psecuritypriv, psta, pattrib->encrypt, IS_MCAST(pattrib->ra)); ++ ++ ++ SET_ICE_IV_LEN(pattrib->iv_len, pattrib->icv_len, pattrib->encrypt); ++ } else { ++ pattrib->encrypt = 0; ++ pattrib->iv_len = pattrib->icv_len = 0; ++ } ++ ++exit: ++ ++ ++ return ret; ++} ++ ++#ifdef CONFIG_IEEE80211W ++static sint validate_80211w_mgmt(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ u8 type; ++ u8 subtype; ++ ++ type = GetFrameType(ptr); ++ subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ ++ ++ if (adapter->securitypriv.binstallBIPkey == _TRUE) { ++ /* unicast management frame decrypt */ ++ if (pattrib->privacy && !(IS_MCAST(GetAddr1Ptr(ptr))) && ++ (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || subtype == WIFI_ACTION)) { ++ u8 *ppp, *mgmt_DATA; ++ u32 data_len = 0; ++ ppp = GetAddr2Ptr(ptr); ++ ++ pattrib->bdecrypted = 0; ++ pattrib->encrypt = _AES_; ++ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ /* set iv and icv length */ ++ SET_ICE_IV_LEN(pattrib->iv_len, pattrib->icv_len, pattrib->encrypt); ++ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); ++ /* actual management data frame body */ ++ data_len = pattrib->pkt_len - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; ++ mgmt_DATA = rtw_zmalloc(data_len); ++ if (mgmt_DATA == NULL) { ++ RTW_INFO("%s mgmt allocate fail !!!!!!!!!\n", __FUNCTION__); ++ goto validate_80211w_fail; ++ } ++#if 0 ++ /* dump the packet content before decrypt */ ++ { ++ int pp; ++ printk("pattrib->pktlen = %d =>", pattrib->pkt_len); ++ for (pp = 0; pp < pattrib->pkt_len; pp++) ++ printk(" %02x ", ptr[pp]); ++ printk("\n"); ++ } ++#endif ++ ++ precv_frame = decryptor(adapter, precv_frame); ++ /* save actual management data frame body */ ++ _rtw_memcpy(mgmt_DATA, ptr + pattrib->hdrlen + pattrib->iv_len, data_len); ++ /* overwrite the iv field */ ++ _rtw_memcpy(ptr + pattrib->hdrlen, mgmt_DATA, data_len); ++ /* remove the iv and icv length */ ++ pattrib->pkt_len = pattrib->pkt_len - pattrib->iv_len - pattrib->icv_len; ++ rtw_mfree(mgmt_DATA, data_len); ++#if 0 ++ /* print packet content after decryption */ ++ { ++ int pp; ++ printk("after decryption pattrib->pktlen = %d @@=>", pattrib->pkt_len); ++ for (pp = 0; pp < pattrib->pkt_len; pp++) ++ printk(" %02x ", ptr[pp]); ++ printk("\n"); ++ } ++#endif ++ if (!precv_frame) { ++ RTW_INFO("%s mgmt descrypt fail !!!!!!!!!\n", __FUNCTION__); ++ goto validate_80211w_fail; ++ } ++ } else if (IS_MCAST(GetAddr1Ptr(ptr)) && ++ (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC)) { ++ sint BIP_ret = _SUCCESS; ++ /* verify BIP MME IE of broadcast/multicast de-auth/disassoc packet */ ++ BIP_ret = rtw_BIP_verify(adapter, (u8 *)precv_frame); ++ if (BIP_ret == _FAIL) { ++ /* RTW_INFO("802.11w BIP verify fail\n"); */ ++ goto validate_80211w_fail; ++ } else if (BIP_ret == RTW_RX_HANDLED) { ++ RTW_INFO("802.11w recv none protected packet\n"); ++ /* drop pkt, don't issue sa query request */ ++ /* issue_action_SA_Query(adapter, NULL, 0, 0, 0); */ ++ goto validate_80211w_fail; ++ } ++ } /* 802.11w protect */ ++ else { ++ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(ptr)); ++ ++ if (subtype == WIFI_ACTION && psta && psta->bpairwise_key_installed == _TRUE) { ++ /* according 802.11-2012 standard, these five types are not robust types */ ++ if (ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_PUBLIC && ++ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_HT && ++ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_UNPROTECTED_WNM && ++ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_SELF_PROTECTED && ++ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_P2P) { ++ RTW_INFO("action frame category=%d should robust\n", ptr[WLAN_HDR_A3_LEN]); ++ goto validate_80211w_fail; ++ } ++ } else if (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC) { ++ unsigned short reason; ++ reason = le16_to_cpu(*(unsigned short *)(ptr + WLAN_HDR_A3_LEN)); ++ RTW_INFO("802.11w recv none protected packet, reason=%d\n", reason); ++ if (reason == 6 || reason == 7) { ++ /* issue sa query request */ ++ issue_action_SA_Query(adapter, NULL, 0, 0, IEEE80211W_RIGHT_KEY); ++ } ++ goto validate_80211w_fail; ++ } ++ } ++ } ++ return _SUCCESS; ++ ++validate_80211w_fail: ++ return _FAIL; ++ ++} ++#endif /* CONFIG_IEEE80211W */ ++ ++static inline void dump_rx_packet(u8 *ptr) ++{ ++ int i; ++ ++ RTW_INFO("#############################\n"); ++ for (i = 0; i < 64; i = i + 8) ++ RTW_INFO("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr + i), ++ *(ptr + i + 1), *(ptr + i + 2) , *(ptr + i + 3) , *(ptr + i + 4), *(ptr + i + 5), *(ptr + i + 6), *(ptr + i + 7)); ++ RTW_INFO("#############################\n"); ++} ++ ++sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame); ++sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ /* shall check frame subtype, to / from ds, da, bssid */ ++ ++ /* then call check if rx seq/frag. duplicated. */ ++ ++ u8 type; ++ u8 subtype; ++ sint retval = _SUCCESS; ++ ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ u8 ver = (unsigned char)(*ptr) & 0x3 ; ++#ifdef CONFIG_FIND_BEST_CHANNEL ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++#endif ++ ++#ifdef CONFIG_TDLS ++ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; ++#endif /* CONFIG_TDLS */ ++#ifdef CONFIG_WAPI_SUPPORT ++ PRT_WAPI_T pWapiInfo = &adapter->wapiInfo; ++ struct recv_frame_hdr *phdr = &precv_frame->u.hdr; ++ u8 wai_pkt = 0; ++ u16 sc; ++ u8 external_len = 0; ++#endif ++ ++ ++#ifdef CONFIG_FIND_BEST_CHANNEL ++ if (pmlmeext->sitesurvey_res.state == SCAN_PROCESS) { ++ int ch_set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, rtw_get_oper_ch(adapter)); ++ if (ch_set_idx >= 0) ++ pmlmeext->channel_set[ch_set_idx].rx_count++; ++ } ++#endif ++ ++#ifdef CONFIG_TDLS ++ if (ptdlsinfo->ch_sensing == 1 && ptdlsinfo->cur_channel != 0) ++ ptdlsinfo->collect_pkt_num[ptdlsinfo->cur_channel - 1]++; ++#endif /* CONFIG_TDLS */ ++ ++#ifdef RTK_DMP_PLATFORM ++ if (0) { ++ RTW_INFO("++\n"); ++ { ++ int i; ++ for (i = 0; i < 64; i = i + 8) ++ RTW_INFO("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:", *(ptr + i), ++ *(ptr + i + 1), *(ptr + i + 2) , *(ptr + i + 3) , *(ptr + i + 4), *(ptr + i + 5), *(ptr + i + 6), *(ptr + i + 7)); ++ ++ } ++ RTW_INFO("--\n"); ++ } ++#endif /* RTK_DMP_PLATFORM */ ++ ++ /* add version chk */ ++ if (ver != 0) { ++ retval = _FAIL; ++ DBG_COUNTER(adapter->rx_logs.core_rx_pre_ver_err); ++ goto exit; ++ } ++ ++ type = GetFrameType(ptr); ++ subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ ++ ++ pattrib->to_fr_ds = get_tofr_ds(ptr); ++ ++ pattrib->frag_num = GetFragNum(ptr); ++ pattrib->seq_num = GetSequence(ptr); ++ ++ pattrib->pw_save = GetPwrMgt(ptr); ++ pattrib->mfrag = GetMFrag(ptr); ++ pattrib->mdata = GetMData(ptr); ++ pattrib->privacy = GetPrivacy(ptr); ++ pattrib->order = GetOrder(ptr); ++#ifdef CONFIG_WAPI_SUPPORT ++ sc = (pattrib->seq_num << 4) | pattrib->frag_num; ++#endif ++ ++#if 1 /* Dump rx packets */ ++ { ++ u8 bDumpRxPkt = 0; ++ ++ rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); ++ if (bDumpRxPkt == 1) /* dump all rx packets */ ++ dump_rx_packet(ptr); ++ else if ((bDumpRxPkt == 2) && (type == WIFI_MGT_TYPE)) ++ dump_rx_packet(ptr); ++ else if ((bDumpRxPkt == 3) && (type == WIFI_DATA_TYPE)) ++ dump_rx_packet(ptr); ++ } ++#endif ++ switch (type) { ++ case WIFI_MGT_TYPE: /* mgnt */ ++ DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt); ++#ifdef CONFIG_IEEE80211W ++ if (validate_80211w_mgmt(adapter, precv_frame) == _FAIL) { ++ retval = _FAIL; ++ DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt_err_80211w); ++ break; ++ } ++#endif /* CONFIG_IEEE80211W */ ++ ++ retval = validate_recv_mgnt_frame(adapter, precv_frame); ++ if (retval == _FAIL) { ++ DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt_err); ++ } ++ retval = _FAIL; /* only data frame return _SUCCESS */ ++ break; ++ case WIFI_CTRL_TYPE: /* ctrl */ ++ DBG_COUNTER(adapter->rx_logs.core_rx_pre_ctrl); ++ retval = validate_recv_ctrl_frame(adapter, precv_frame); ++ if (retval == _FAIL) { ++ DBG_COUNTER(adapter->rx_logs.core_rx_pre_ctrl_err); ++ } ++ retval = _FAIL; /* only data frame return _SUCCESS */ ++ break; ++ case WIFI_DATA_TYPE: /* data */ ++ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data); ++#ifdef CONFIG_WAPI_SUPPORT ++ if (pattrib->qos) ++ external_len = 2; ++ else ++ external_len = 0; ++ ++ wai_pkt = rtw_wapi_is_wai_packet(adapter, ptr); ++ ++ phdr->bIsWaiPacket = wai_pkt; ++ ++ if (wai_pkt != 0) { ++ if (sc != adapter->wapiInfo.wapiSeqnumAndFragNum) ++ adapter->wapiInfo.wapiSeqnumAndFragNum = sc; ++ else { ++ retval = _FAIL; ++ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_wapi_seq_err); ++ break; ++ } ++ } else { ++ ++ if (rtw_wapi_drop_for_key_absent(adapter, GetAddr2Ptr(ptr))) { ++ retval = _FAIL; ++ WAPI_TRACE(WAPI_RX, "drop for key absent for rx\n"); ++ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_wapi_key_err); ++ break; ++ } ++ } ++ ++#endif ++ ++ pattrib->qos = (subtype & BIT(7)) ? 1 : 0; ++ retval = validate_recv_data_frame(adapter, precv_frame); ++ if (retval == _FAIL) { ++ struct recv_priv *precvpriv = &adapter->recvpriv; ++ precvpriv->rx_drop++; ++ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_err); ++ } else if (retval == _SUCCESS) { ++#ifdef DBG_RX_DUMP_EAP ++ u8 bDumpRxPkt; ++ u16 eth_type; ++ ++ /* dump eapol */ ++ rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); ++ /* get ether_type */ ++ _rtw_memcpy(ð_type, ptr + pattrib->hdrlen + pattrib->iv_len + LLC_HEADER_SIZE, 2); ++ eth_type = ntohs((unsigned short) eth_type); ++ if ((bDumpRxPkt == 4) && (eth_type == 0x888e)) ++ dump_rx_packet(ptr); ++#endif ++ } else ++ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_handled); ++ break; ++ default: ++ DBG_COUNTER(adapter->rx_logs.core_rx_pre_unknown); ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME validate_recv_data_frame fail! type=0x%x\n", type); ++#endif ++ retval = _FAIL; ++ break; ++ } ++ ++exit: ++ ++ ++ return retval; ++} ++ ++ ++/* remove the wlanhdr and add the eth_hdr */ ++#if 1 ++ ++sint wlanhdr_to_ethhdr(union recv_frame *precvframe); ++sint wlanhdr_to_ethhdr(union recv_frame *precvframe) ++{ ++ sint rmv_len; ++ u16 eth_type, len; ++ u8 bsnaphdr; ++ u8 *psnap_type; ++ struct ieee80211_snap_hdr *psnap; ++ ++ sint ret = _SUCCESS; ++ _adapter *adapter = precvframe->u.hdr.adapter; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ ++ u8 *ptr = get_recvframe_data(precvframe) ; /* point to frame_ctrl field */ ++ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; ++ ++ ++ if (pattrib->encrypt) ++ recvframe_pull_tail(precvframe, pattrib->icv_len); ++ ++ psnap = (struct ieee80211_snap_hdr *)(ptr + pattrib->hdrlen + pattrib->iv_len); ++ psnap_type = ptr + pattrib->hdrlen + pattrib->iv_len + SNAP_SIZE; ++ /* convert hdr + possible LLC headers into Ethernet header */ ++ /* eth_type = (psnap_type[0] << 8) | psnap_type[1]; */ ++ if ((_rtw_memcmp(psnap, rtw_rfc1042_header, SNAP_SIZE) && ++ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_IPX, 2) == _FALSE) && ++ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_AARP, 2) == _FALSE)) || ++ /* eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) || */ ++ _rtw_memcmp(psnap, rtw_bridge_tunnel_header, SNAP_SIZE)) { ++ /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ ++ bsnaphdr = _TRUE; ++ } else { ++ /* Leave Ethernet header part of hdr and full payload */ ++ bsnaphdr = _FALSE; ++ } ++ ++ rmv_len = pattrib->hdrlen + pattrib->iv_len + (bsnaphdr ? SNAP_SIZE : 0); ++ len = precvframe->u.hdr.len - rmv_len; ++ ++ ++ _rtw_memcpy(ð_type, ptr + rmv_len, 2); ++ eth_type = ntohs((unsigned short)eth_type); /* pattrib->ether_type */ ++ pattrib->eth_type = eth_type; ++ ++#ifdef CONFIG_AUTO_AP_MODE ++ if (0x8899 == pattrib->eth_type) { ++ struct sta_info *psta = precvframe->u.hdr.psta; ++ ++ RTW_INFO("wlan rx: got eth_type=0x%x\n", pattrib->eth_type); ++ ++ if (psta && psta->isrc && psta->pid > 0) { ++ u16 rx_pid; ++ ++ rx_pid = *(u16 *)(ptr + rmv_len + 2); ++ ++ RTW_INFO("wlan rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", ++ rx_pid, MAC_ARG(psta->hwaddr), psta->pid); ++ ++ if (rx_pid == psta->pid) { ++ int i; ++ u16 len = *(u16 *)(ptr + rmv_len + 4); ++ /* u16 ctrl_type = *(u16*)(ptr+rmv_len+6); */ ++ ++ /* RTW_INFO("RC: len=0x%x, ctrl_type=0x%x\n", len, ctrl_type); */ ++ RTW_INFO("RC: len=0x%x\n", len); ++ ++ for (i = 0; i < len; i++) ++ RTW_INFO("0x%x\n", *(ptr + rmv_len + 6 + i)); ++ /* RTW_INFO("0x%x\n", *(ptr+rmv_len+8+i)); */ ++ ++ RTW_INFO("RC-end\n"); ++ } ++ } ++ } ++#endif /* CONFIG_AUTO_AP_MODE */ ++ ++ if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE)) { ++ ptr += rmv_len ; ++ *ptr = 0x87; ++ *(ptr + 1) = 0x12; ++ ++ eth_type = 0x8712; ++ /* append rx status for mp test packets */ ++ ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + 2) - 24); ++ if (!ptr) { ++ ret = _FAIL; ++ goto exiting; ++ } ++ _rtw_memcpy(ptr, get_rxmem(precvframe), 24); ++ ptr += 24; ++ } else { ++ ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + (bsnaphdr ? 2 : 0))); ++ if (!ptr) { ++ ret = _FAIL; ++ goto exiting; ++ } ++ } ++ ++ if (ptr) { ++ _rtw_memcpy(ptr, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(ptr + ETH_ALEN, pattrib->src, ETH_ALEN); ++ ++ if (!bsnaphdr) { ++ len = htons(len); ++ _rtw_memcpy(ptr + 12, &len, 2); ++ } ++ } ++ ++exiting: ++ return ret; ++ ++} ++ ++#else ++ ++sint wlanhdr_to_ethhdr(union recv_frame *precvframe) ++{ ++ sint rmv_len; ++ u16 eth_type; ++ u8 bsnaphdr; ++ u8 *psnap_type; ++ struct ieee80211_snap_hdr *psnap; ++ ++ sint ret = _SUCCESS; ++ _adapter *adapter = precvframe->u.hdr.adapter; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ ++ u8 *ptr = get_recvframe_data(precvframe) ; /* point to frame_ctrl field */ ++ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; ++ struct _vlan *pvlan = NULL; ++ ++ ++ psnap = (struct ieee80211_snap_hdr *)(ptr + pattrib->hdrlen + pattrib->iv_len); ++ psnap_type = ptr + pattrib->hdrlen + pattrib->iv_len + SNAP_SIZE; ++ if (psnap->dsap == 0xaa && psnap->ssap == 0xaa && psnap->ctrl == 0x03) { ++ if (_rtw_memcmp(psnap->oui, oui_rfc1042, WLAN_IEEE_OUI_LEN)) ++ bsnaphdr = _TRUE; /* wlan_pkt_format = WLAN_PKT_FORMAT_SNAP_RFC1042; */ ++ else if (_rtw_memcmp(psnap->oui, SNAP_HDR_APPLETALK_DDP, WLAN_IEEE_OUI_LEN) && ++ _rtw_memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_DDP, 2)) ++ bsnaphdr = _TRUE; /* wlan_pkt_format = WLAN_PKT_FORMAT_APPLETALK; */ ++ else if (_rtw_memcmp(psnap->oui, oui_8021h, WLAN_IEEE_OUI_LEN)) ++ bsnaphdr = _TRUE; /* wlan_pkt_format = WLAN_PKT_FORMAT_SNAP_TUNNEL; */ ++ else { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ } else ++ bsnaphdr = _FALSE; /* wlan_pkt_format = WLAN_PKT_FORMAT_OTHERS; */ ++ ++ rmv_len = pattrib->hdrlen + pattrib->iv_len + (bsnaphdr ? SNAP_SIZE : 0); ++ ++ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) { ++ ptr += rmv_len ; ++ *ptr = 0x87; ++ *(ptr + 1) = 0x12; ++ ++ /* back to original pointer */ ++ ptr -= rmv_len; ++ } ++ ++ ptr += rmv_len ; ++ ++ _rtw_memcpy(ð_type, ptr, 2); ++ eth_type = ntohs((unsigned short)eth_type); /* pattrib->ether_type */ ++ ptr += 2; ++ ++ if (pattrib->encrypt) ++ recvframe_pull_tail(precvframe, pattrib->icv_len); ++ ++ if (eth_type == 0x8100) { /* vlan */ ++ pvlan = (struct _vlan *) ptr; ++ ++ /* eth_type = get_vlan_encap_proto(pvlan); */ ++ /* eth_type = pvlan->h_vlan_encapsulated_proto; */ /* ? */ ++ rmv_len += 4; ++ ptr += 4; ++ } ++ ++ if (eth_type == 0x0800) { /* ip */ ++ /* struct iphdr* piphdr = (struct iphdr*) ptr; */ ++ /* __u8 tos = (unsigned char)(pattrib->priority & 0xff); */ ++ ++ /* piphdr->tos = tos; */ ++ ++ } else if (eth_type == 0x8712) { /* append rx status for mp test packets */ ++ /* ptr -= 16; */ ++ /* _rtw_memcpy(ptr, get_rxmem(precvframe), 16); */ ++ } else { ++#ifdef PLATFORM_OS_XP ++ NDIS_PACKET_8021Q_INFO VlanPriInfo; ++ UINT32 UserPriority = precvframe->u.hdr.attrib.priority; ++ UINT32 VlanID = (pvlan != NULL ? get_vlan_id(pvlan) : 0); ++ ++ VlanPriInfo.Value = /* Get current value. */ ++ NDIS_PER_PACKET_INFO_FROM_PACKET(precvframe->u.hdr.pkt, Ieee8021QInfo); ++ ++ VlanPriInfo.TagHeader.UserPriority = UserPriority; ++ VlanPriInfo.TagHeader.VlanId = VlanID ; ++ ++ VlanPriInfo.TagHeader.CanonicalFormatId = 0; /* Should be zero. */ ++ VlanPriInfo.TagHeader.Reserved = 0; /* Should be zero. */ ++ NDIS_PER_PACKET_INFO_FROM_PACKET(precvframe->u.hdr.pkt, Ieee8021QInfo) = VlanPriInfo.Value; ++#endif ++ } ++ ++ if (eth_type == 0x8712) { /* append rx status for mp test packets */ ++ ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + 2) - 24); ++ _rtw_memcpy(ptr, get_rxmem(precvframe), 24); ++ ptr += 24; ++ } else ++ ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + 2)); ++ ++ _rtw_memcpy(ptr, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(ptr + ETH_ALEN, pattrib->src, ETH_ALEN); ++ ++ eth_type = htons((unsigned short)eth_type) ; ++ _rtw_memcpy(ptr + 12, ð_type, 2); ++ ++exit: ++ ++ ++ return ret; ++} ++#endif ++ ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++#ifdef PLATFORM_LINUX ++static void recvframe_expand_pkt( ++ PADAPTER padapter, ++ union recv_frame *prframe) ++{ ++ struct recv_frame_hdr *pfhdr; ++ _pkt *ppkt; ++ u8 shift_sz; ++ u32 alloc_sz; ++ u8 *ptr; ++ ++ ++ pfhdr = &prframe->u.hdr; ++ ++ /* 6 is for IP header 8 bytes alignment in QoS packet case. */ ++ if (pfhdr->attrib.qos) ++ shift_sz = 6; ++ else ++ shift_sz = 0; ++ ++ /* for first fragment packet, need to allocate */ ++ /* (1536 + RXDESC_SIZE + drvinfo_sz) to reassemble packet */ ++ /* 8 is for skb->data 8 bytes alignment. ++ * alloc_sz = _RND(1536 + RXDESC_SIZE + pfhdr->attrib.drvinfosize + shift_sz + 8, 128); */ ++ alloc_sz = 1664; /* round (1536 + 24 + 32 + shift_sz + 8) to 128 bytes alignment */ ++ ++ /* 3 1. alloc new skb */ ++ /* prepare extra space for 4 bytes alignment */ ++ ppkt = rtw_skb_alloc(alloc_sz); ++ ++ if (!ppkt) ++ return; /* no way to expand */ ++ ++ /* 3 2. Prepare new skb to replace & release old skb */ ++ /* force ppkt->data at 8-byte alignment address */ ++ skb_reserve(ppkt, 8 - ((SIZE_PTR)ppkt->data & 7)); ++ /* force ip_hdr at 8-byte alignment address according to shift_sz */ ++ skb_reserve(ppkt, shift_sz); ++ ++ /* copy data to new pkt */ ++ ptr = skb_put(ppkt, pfhdr->len); ++ if (ptr) ++ _rtw_memcpy(ptr, pfhdr->rx_data, pfhdr->len); ++ ++ rtw_skb_free(pfhdr->pkt); ++ ++ /* attach new pkt to recvframe */ ++ pfhdr->pkt = ppkt; ++ pfhdr->rx_head = ppkt->head; ++ pfhdr->rx_data = ppkt->data; ++ pfhdr->rx_tail = skb_tail_pointer(ppkt); ++ pfhdr->rx_end = skb_end_pointer(ppkt); ++} ++#else ++#warning "recvframe_expand_pkt not implement, defrag may crash system" ++#endif ++#endif ++ ++/* perform defrag */ ++union recv_frame *recvframe_defrag(_adapter *adapter, _queue *defrag_q); ++union recv_frame *recvframe_defrag(_adapter *adapter, _queue *defrag_q) ++{ ++ _list *plist, *phead; ++ u8 *data, wlanhdr_offset; ++ u8 curfragnum; ++ struct recv_frame_hdr *pfhdr, *pnfhdr; ++ union recv_frame *prframe, *pnextrframe; ++ _queue *pfree_recv_queue; ++ ++ ++ curfragnum = 0; ++ pfree_recv_queue = &adapter->recvpriv.free_recv_queue; ++ ++ phead = get_list_head(defrag_q); ++ plist = get_next(phead); ++ prframe = LIST_CONTAINOR(plist, union recv_frame, u); ++ pfhdr = &prframe->u.hdr; ++ rtw_list_delete(&(prframe->u.list)); ++ ++ if (curfragnum != pfhdr->attrib.frag_num) { ++ /* the first fragment number must be 0 */ ++ /* free the whole queue */ ++ rtw_free_recvframe(prframe, pfree_recv_queue); ++ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); ++ ++ return NULL; ++ } ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++#ifndef CONFIG_SDIO_RX_COPY ++ recvframe_expand_pkt(adapter, prframe); ++#endif ++#endif ++ ++ curfragnum++; ++ ++ plist = get_list_head(defrag_q); ++ ++ plist = get_next(plist); ++ ++ data = get_recvframe_data(prframe); ++ ++ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ pnextrframe = LIST_CONTAINOR(plist, union recv_frame , u); ++ pnfhdr = &pnextrframe->u.hdr; ++ ++ ++ /* check the fragment sequence (2nd ~n fragment frame) */ ++ ++ if (curfragnum != pnfhdr->attrib.frag_num) { ++ /* the fragment number must be increasing (after decache) */ ++ /* release the defrag_q & prframe */ ++ rtw_free_recvframe(prframe, pfree_recv_queue); ++ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); ++ return NULL; ++ } ++ ++ curfragnum++; ++ ++ /* copy the 2nd~n fragment frame's payload to the first fragment */ ++ /* get the 2nd~last fragment frame's payload */ ++ ++ wlanhdr_offset = pnfhdr->attrib.hdrlen + pnfhdr->attrib.iv_len; ++ ++ recvframe_pull(pnextrframe, wlanhdr_offset); ++ ++ /* append to first fragment frame's tail (if privacy frame, pull the ICV) */ ++ recvframe_pull_tail(prframe, pfhdr->attrib.icv_len); ++ ++ /* memcpy */ ++ _rtw_memcpy(pfhdr->rx_tail, pnfhdr->rx_data, pnfhdr->len); ++ ++ recvframe_put(prframe, pnfhdr->len); ++ ++ pfhdr->attrib.icv_len = pnfhdr->attrib.icv_len; ++ plist = get_next(plist); ++ ++ }; ++ ++ /* free the defrag_q queue and return the prframe */ ++ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); ++ ++ ++ ++ return prframe; ++} ++ ++/* check if need to defrag, if needed queue the frame to defrag_q */ ++union recv_frame *recvframe_chk_defrag(PADAPTER padapter, union recv_frame *precv_frame) ++{ ++ u8 ismfrag; ++ u8 fragnum; ++ u8 *psta_addr; ++ struct recv_frame_hdr *pfhdr; ++ struct sta_info *psta; ++ struct sta_priv *pstapriv; ++ _list *phead; ++ union recv_frame *prtnframe = NULL; ++ _queue *pfree_recv_queue, *pdefrag_q; ++ ++ ++ pstapriv = &padapter->stapriv; ++ ++ pfhdr = &precv_frame->u.hdr; ++ ++ pfree_recv_queue = &padapter->recvpriv.free_recv_queue; ++ ++ /* need to define struct of wlan header frame ctrl */ ++ ismfrag = pfhdr->attrib.mfrag; ++ fragnum = pfhdr->attrib.frag_num; ++ ++ psta_addr = pfhdr->attrib.ta; ++ psta = rtw_get_stainfo(pstapriv, psta_addr); ++ if (psta == NULL) { ++ u8 type = GetFrameType(pfhdr->rx_data); ++ if (type != WIFI_DATA_TYPE) { ++ psta = rtw_get_bcmc_stainfo(padapter); ++ pdefrag_q = &psta->sta_recvpriv.defrag_q; ++ } else ++ pdefrag_q = NULL; ++ } else ++ pdefrag_q = &psta->sta_recvpriv.defrag_q; ++ ++ if ((ismfrag == 0) && (fragnum == 0)) { ++ prtnframe = precv_frame;/* isn't a fragment frame */ ++ } ++ ++ if (ismfrag == 1) { ++ /* 0~(n-1) fragment frame */ ++ /* enqueue to defraf_g */ ++ if (pdefrag_q != NULL) { ++ if (fragnum == 0) { ++ /* the first fragment */ ++ if (_rtw_queue_empty(pdefrag_q) == _FALSE) { ++ /* free current defrag_q */ ++ rtw_free_recvframe_queue(pdefrag_q, pfree_recv_queue); ++ } ++ } ++ ++ ++ /* Then enqueue the 0~(n-1) fragment into the defrag_q */ ++ ++ /* _rtw_spinlock(&pdefrag_q->lock); */ ++ phead = get_list_head(pdefrag_q); ++ rtw_list_insert_tail(&pfhdr->list, phead); ++ /* _rtw_spinunlock(&pdefrag_q->lock); */ ++ ++ ++ prtnframe = NULL; ++ ++ } else { ++ /* can't find this ta's defrag_queue, so free this recv_frame */ ++ rtw_free_recvframe(precv_frame, pfree_recv_queue); ++ prtnframe = NULL; ++ } ++ ++ } ++ ++ if ((ismfrag == 0) && (fragnum != 0)) { ++ /* the last fragment frame */ ++ /* enqueue the last fragment */ ++ if (pdefrag_q != NULL) { ++ /* _rtw_spinlock(&pdefrag_q->lock); */ ++ phead = get_list_head(pdefrag_q); ++ rtw_list_insert_tail(&pfhdr->list, phead); ++ /* _rtw_spinunlock(&pdefrag_q->lock); */ ++ ++ /* call recvframe_defrag to defrag */ ++ precv_frame = recvframe_defrag(padapter, pdefrag_q); ++ prtnframe = precv_frame; ++ ++ } else { ++ /* can't find this ta's defrag_queue, so free this recv_frame */ ++ rtw_free_recvframe(precv_frame, pfree_recv_queue); ++ prtnframe = NULL; ++ } ++ ++ } ++ ++ ++ if ((prtnframe != NULL) && (prtnframe->u.hdr.attrib.privacy)) { ++ /* after defrag we must check tkip mic code */ ++ if (recvframe_chkmic(padapter, prtnframe) == _FAIL) { ++ rtw_free_recvframe(prtnframe, pfree_recv_queue); ++ prtnframe = NULL; ++ } ++ } ++ ++ ++ return prtnframe; ++ ++} ++ ++int amsdu_to_msdu(_adapter *padapter, union recv_frame *prframe) ++{ ++ int a_len, padding_len; ++ u16 nSubframe_Length; ++ u8 nr_subframes, i; ++ u8 *pdata; ++ _pkt *sub_pkt, *subframes[MAX_SUBFRAME_COUNT]; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ _queue *pfree_recv_queue = &(precvpriv->free_recv_queue); ++ int ret = _SUCCESS; ++ ++ nr_subframes = 0; ++ ++ recvframe_pull(prframe, prframe->u.hdr.attrib.hdrlen); ++ ++ if (prframe->u.hdr.attrib.iv_len > 0) ++ recvframe_pull(prframe, prframe->u.hdr.attrib.iv_len); ++ ++ a_len = prframe->u.hdr.len; ++ ++ pdata = prframe->u.hdr.rx_data; ++ ++ while (a_len > ETH_HLEN) { ++ ++ /* Offset 12 denote 2 mac address */ ++ nSubframe_Length = RTW_GET_BE16(pdata + 12); ++ ++ if (a_len < (ETHERNET_HEADER_SIZE + nSubframe_Length)) { ++ RTW_INFO("nRemain_Length is %d and nSubframe_Length is : %d\n", a_len, nSubframe_Length); ++ break; ++ } ++ ++ sub_pkt = rtw_os_alloc_msdu_pkt(prframe, nSubframe_Length, pdata); ++ if (sub_pkt == NULL) { ++ RTW_INFO("%s(): allocate sub packet fail !!!\n", __FUNCTION__); ++ break; ++ } ++ ++ /* move the data point to data content */ ++ pdata += ETH_HLEN; ++ a_len -= ETH_HLEN; ++ ++ subframes[nr_subframes++] = sub_pkt; ++ ++ if (nr_subframes >= MAX_SUBFRAME_COUNT) { ++ RTW_INFO("ParseSubframe(): Too many Subframes! Packets dropped!\n"); ++ break; ++ } ++ ++ pdata += nSubframe_Length; ++ a_len -= nSubframe_Length; ++ if (a_len != 0) { ++ padding_len = 4 - ((nSubframe_Length + ETH_HLEN) & (4 - 1)); ++ if (padding_len == 4) ++ padding_len = 0; ++ ++ if (a_len < padding_len) { ++ RTW_INFO("ParseSubframe(): a_len < padding_len !\n"); ++ break; ++ } ++ pdata += padding_len; ++ a_len -= padding_len; ++ } ++ } ++ ++ for (i = 0; i < nr_subframes; i++) { ++ sub_pkt = subframes[i]; ++ ++ /* Indicat the packets to upper layer */ ++ if (sub_pkt) ++ rtw_os_recv_indicate_pkt(padapter, sub_pkt, &prframe->u.hdr.attrib); ++ } ++ ++ prframe->u.hdr.len = 0; ++ rtw_free_recvframe(prframe, pfree_recv_queue);/* free this recv_frame */ ++ ++ return ret; ++} ++ ++int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num); ++int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num) ++{ ++ PADAPTER padapter = preorder_ctrl->padapter; ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ u8 wsize = preorder_ctrl->wsize_b; ++ u16 wend = (preorder_ctrl->indicate_seq + wsize - 1) & 0xFFF; /* % 4096; */ ++ ++ /* Rx Reorder initialize condition. */ ++ if (preorder_ctrl->indicate_seq == 0xFFFF) { ++ preorder_ctrl->indicate_seq = seq_num; ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d init IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq, seq_num); ++#endif ++ ++ /* DbgPrint("check_indicate_seq, 1st->indicate_seq=%d\n", precvpriv->indicate_seq); */ ++ } ++ ++ /* DbgPrint("enter->check_indicate_seq(): IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ ++ ++ /* Drop out the packet which SeqNum is smaller than WinStart */ ++ if (SN_LESS(seq_num, preorder_ctrl->indicate_seq)) { ++ /* DbgPrint("CheckRxTsIndicateSeq(): Packet Drop! IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ ++ ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("%s IndicateSeq: %d > NewSeq: %d\n", __FUNCTION__, ++ preorder_ctrl->indicate_seq, seq_num); ++#endif ++ ++ ++ return _FALSE; ++ } ++ ++ /* */ ++ /* Sliding window manipulation. Conditions includes: */ ++ /* 1. Incoming SeqNum is equal to WinStart =>Window shift 1 */ ++ /* 2. Incoming SeqNum is larger than the WinEnd => Window shift N */ ++ /* */ ++ if (SN_EQUAL(seq_num, preorder_ctrl->indicate_seq)) { ++ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) & 0xFFF; ++ ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d SN_EQUAL IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq, seq_num); ++#endif ++ } else if (SN_LESS(wend, seq_num)) { ++ /* DbgPrint("CheckRxTsIndicateSeq(): Window Shift! IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ ++ ++ /* boundary situation, when seq_num cross 0xFFF */ ++ if (seq_num >= (wsize - 1)) ++ preorder_ctrl->indicate_seq = seq_num + 1 - wsize; ++ else ++ preorder_ctrl->indicate_seq = 0xFFF - (wsize - (seq_num + 1)) + 1; ++ pdbgpriv->dbg_rx_ampdu_window_shift_cnt++; ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d SN_LESS(wend, seq_num) IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq, seq_num); ++#endif ++ } ++ ++ /* DbgPrint("exit->check_indicate_seq(): IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ ++ ++ return _TRUE; ++} ++ ++int enqueue_reorder_recvframe(struct recv_reorder_ctrl *preorder_ctrl, union recv_frame *prframe); ++int enqueue_reorder_recvframe(struct recv_reorder_ctrl *preorder_ctrl, union recv_frame *prframe) ++{ ++ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; ++ _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; ++ _list *phead, *plist; ++ union recv_frame *pnextrframe; ++ struct rx_pkt_attrib *pnextattrib; ++ ++ /* DbgPrint("+enqueue_reorder_recvframe()\n"); */ ++ ++ /* _enter_critical_ex(&ppending_recvframe_queue->lock, &irql); */ ++ /* _rtw_spinlock_ex(&ppending_recvframe_queue->lock); */ ++ ++ ++ phead = get_list_head(ppending_recvframe_queue); ++ plist = get_next(phead); ++ ++ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ pnextrframe = LIST_CONTAINOR(plist, union recv_frame, u); ++ pnextattrib = &pnextrframe->u.hdr.attrib; ++ ++ if (SN_LESS(pnextattrib->seq_num, pattrib->seq_num)) ++ plist = get_next(plist); ++ else if (SN_EQUAL(pnextattrib->seq_num, pattrib->seq_num)) { ++ /* Duplicate entry is found!! Do not insert current entry. */ ++ ++ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ ++ ++ return _FALSE; ++ } else ++ break; ++ ++ /* DbgPrint("enqueue_reorder_recvframe():while\n"); */ ++ ++ } ++ ++ ++ /* _enter_critical_ex(&ppending_recvframe_queue->lock, &irql); */ ++ /* _rtw_spinlock_ex(&ppending_recvframe_queue->lock); */ ++ ++ rtw_list_delete(&(prframe->u.hdr.list)); ++ ++ rtw_list_insert_tail(&(prframe->u.hdr.list), plist); ++ ++ /* _rtw_spinunlock_ex(&ppending_recvframe_queue->lock); */ ++ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ ++ ++ ++ return _TRUE; ++ ++} ++ ++void recv_indicatepkts_pkt_loss_cnt(struct debug_priv *pdbgpriv, u64 prev_seq, u64 current_seq); ++void recv_indicatepkts_pkt_loss_cnt(struct debug_priv *pdbgpriv, u64 prev_seq, u64 current_seq) ++{ ++ if (current_seq < prev_seq) ++ pdbgpriv->dbg_rx_ampdu_loss_count += (4096 + current_seq - prev_seq); ++ ++ else ++ pdbgpriv->dbg_rx_ampdu_loss_count += (current_seq - prev_seq); ++} ++int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced); ++int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced) ++{ ++ /* _irqL irql; */ ++ /* u8 bcancelled; */ ++ _list *phead, *plist; ++ union recv_frame *prframe; ++ struct rx_pkt_attrib *pattrib; ++ /* u8 index = 0; */ ++ int bPktInBuf = _FALSE; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_in_oder); ++ ++ /* DbgPrint("+recv_indicatepkts_in_order\n"); */ ++ ++ /* _enter_critical_ex(&ppending_recvframe_queue->lock, &irql); */ ++ /* _rtw_spinlock_ex(&ppending_recvframe_queue->lock); */ ++ ++ phead = get_list_head(ppending_recvframe_queue); ++ plist = get_next(phead); ++ ++#if 0 ++ /* Check if there is any other indication thread running. */ ++ if (pTS->RxIndicateState == RXTS_INDICATE_PROCESSING) ++ return; ++#endif ++ ++ /* Handling some condition for forced indicate case. */ ++ if (bforced == _TRUE) { ++ pdbgpriv->dbg_rx_ampdu_forced_indicate_count++; ++ if (rtw_is_list_empty(phead)) { ++ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ ++ /* _rtw_spinunlock_ex(&ppending_recvframe_queue->lock); */ ++ return _TRUE; ++ } ++ ++ prframe = LIST_CONTAINOR(plist, union recv_frame, u); ++ pattrib = &prframe->u.hdr.attrib; ++ ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq, pattrib->seq_num); ++#endif ++ recv_indicatepkts_pkt_loss_cnt(pdbgpriv, preorder_ctrl->indicate_seq, pattrib->seq_num); ++ preorder_ctrl->indicate_seq = pattrib->seq_num; ++ ++ } ++ ++ /* Prepare indication list and indication. */ ++ /* Check if there is any packet need indicate. */ ++ while (!rtw_is_list_empty(phead)) { ++ ++ prframe = LIST_CONTAINOR(plist, union recv_frame, u); ++ pattrib = &prframe->u.hdr.attrib; ++ ++ if (!SN_LESS(preorder_ctrl->indicate_seq, pattrib->seq_num)) { ++ ++#if 0 ++ /* This protect buffer from overflow. */ ++ if (index >= REORDER_WIN_SIZE) { ++ RT_ASSERT(FALSE, ("IndicateRxReorderList(): Buffer overflow!!\n")); ++ bPktInBuf = TRUE; ++ break; ++ } ++#endif ++ ++ plist = get_next(plist); ++ rtw_list_delete(&(prframe->u.hdr.list)); ++ ++ if (SN_EQUAL(preorder_ctrl->indicate_seq, pattrib->seq_num)) { ++ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) & 0xFFF; ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq, pattrib->seq_num); ++#endif ++ } ++ ++#if 0 ++ index++; ++ if (index == 1) { ++ /* Cancel previous pending timer. */ ++ /* PlatformCancelTimer(Adapter, &pTS->RxPktPendingTimer); */ ++ if (bforced != _TRUE) { ++ /* RTW_INFO("_cancel_timer(&preorder_ctrl->reordering_ctrl_timer, &bcancelled);\n"); */ ++ _cancel_timer(&preorder_ctrl->reordering_ctrl_timer, &bcancelled); ++ } ++ } ++#endif ++ ++ /* Set this as a lock to make sure that only one thread is indicating packet. */ ++ /* pTS->RxIndicateState = RXTS_INDICATE_PROCESSING; */ ++ ++ /* Indicate packets */ ++ /* RT_ASSERT((index<=REORDER_WIN_SIZE), ("RxReorderIndicatePacket(): Rx Reorder buffer full!!\n")); */ ++ ++ ++ /* indicate this recv_frame */ ++ /* DbgPrint("recv_indicatepkts_in_order, indicate_seq=%d, seq_num=%d\n", precvpriv->indicate_seq, pattrib->seq_num); */ ++ if (!pattrib->amsdu) { ++ /* RTW_INFO("recv_indicatepkts_in_order, amsdu!=1, indicate_seq=%d, seq_num=%d\n", preorder_ctrl->indicate_seq, pattrib->seq_num); */ ++ ++ if (!RTW_CANNOT_RUN(padapter)) ++ rtw_recv_indicatepkt(padapter, prframe);/*indicate this recv_frame*/ ++ ++ } else if (pattrib->amsdu == 1) { ++ if (amsdu_to_msdu(padapter, prframe) != _SUCCESS) ++ rtw_free_recvframe(prframe, &precvpriv->free_recv_queue); ++ } else { ++ /* error condition; */ ++ } ++ ++ ++ /* Update local variables. */ ++ bPktInBuf = _FALSE; ++ ++ } else { ++ bPktInBuf = _TRUE; ++ break; ++ } ++ ++ /* DbgPrint("recv_indicatepkts_in_order():while\n"); */ ++ ++ } ++ ++ /* _rtw_spinunlock_ex(&ppending_recvframe_queue->lock); */ ++ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ ++ ++#if 0 ++ /* Release the indication lock and set to new indication step. */ ++ if (bPktInBuf) { ++ /* Set new pending timer. */ ++ /* pTS->RxIndicateState = RXTS_INDICATE_REORDER; */ ++ /* PlatformSetTimer(Adapter, &pTS->RxPktPendingTimer, pHTInfo->RxReorderPendingTime); */ ++ ++ _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); ++ } else { ++ /* pTS->RxIndicateState = RXTS_INDICATE_IDLE; */ ++ } ++#endif ++ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ ++ ++ /* return _TRUE; */ ++ return bPktInBuf; ++ ++} ++ ++int recv_indicatepkt_reorder(_adapter *padapter, union recv_frame *prframe); ++int recv_indicatepkt_reorder(_adapter *padapter, union recv_frame *prframe) ++{ ++ _irqL irql; ++ int retval = _SUCCESS; ++ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; ++ struct recv_reorder_ctrl *preorder_ctrl = prframe->u.hdr.preorder_ctrl; ++ _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_reoder); ++ ++ if (!pattrib->amsdu) { ++ /* s1. */ ++ retval = wlanhdr_to_ethhdr(prframe); ++ if (retval != _SUCCESS) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr error!\n", __FUNCTION__); ++#endif ++ return retval; ++ } ++ ++ /* if ((pattrib->qos!=1) || pattrib->priority!=0 || IS_MCAST(pattrib->ra) */ ++ /* || (pattrib->eth_type==0x0806) || (pattrib->ack_policy!=0)) */ ++ if (pattrib->qos != 1) { ++ if (!RTW_CANNOT_RUN(padapter)) { ++ ++ rtw_recv_indicatepkt(padapter, prframe); ++ return _SUCCESS; ++ ++ } ++ ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s pattrib->qos !=1\n", __FUNCTION__); ++#endif ++ ++ return _FAIL; ++ ++ } ++ ++ if (preorder_ctrl->enable == _FALSE) { ++ /* indicate this recv_frame */ ++ preorder_ctrl->indicate_seq = pattrib->seq_num; ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq, pattrib->seq_num); ++#endif ++ ++ rtw_recv_indicatepkt(padapter, prframe); ++ ++ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) % 4096; ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq, pattrib->seq_num); ++#endif ++ ++ return _SUCCESS; ++ } ++ ++#ifndef CONFIG_RECV_REORDERING_CTRL ++ /* indicate this recv_frame */ ++ rtw_recv_indicatepkt(padapter, prframe); ++ return _SUCCESS; ++#endif ++ ++ } else if (pattrib->amsdu == 1) { /* temp filter->means didn't support A-MSDUs in a A-MPDU */ ++ if (preorder_ctrl->enable == _FALSE) { ++ preorder_ctrl->indicate_seq = pattrib->seq_num; ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq, pattrib->seq_num); ++#endif ++ ++ retval = amsdu_to_msdu(padapter, prframe); ++ ++ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) % 4096; ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq, pattrib->seq_num); ++#endif ++ ++ if (retval != _SUCCESS) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s amsdu_to_msdu fail\n", __FUNCTION__); ++#endif ++ } ++ ++ return retval; ++ } ++ } else { ++ ++ } ++ ++ _enter_critical_bh(&ppending_recvframe_queue->lock, &irql); ++ ++ ++ /* s2. check if winstart_b(indicate_seq) needs to been updated */ ++ if (!check_indicate_seq(preorder_ctrl, pattrib->seq_num)) { ++ pdbgpriv->dbg_rx_ampdu_drop_count++; ++ /* pHTInfo->RxReorderDropCounter++; */ ++ /* ReturnRFDList(Adapter, pRfd); */ ++ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ ++ /* return _FAIL; */ ++ ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s check_indicate_seq fail\n", __FUNCTION__); ++#endif ++#if 0 ++ rtw_recv_indicatepkt(padapter, prframe); ++ ++ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); ++ ++ goto _success_exit; ++#else ++ goto _err_exit; ++#endif ++ } ++ ++ ++ /* s3. Insert all packet into Reorder Queue to maintain its ordering. */ ++ if (!enqueue_reorder_recvframe(preorder_ctrl, prframe)) { ++ /* DbgPrint("recv_indicatepkt_reorder, enqueue_reorder_recvframe fail!\n"); */ ++ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ ++ /* return _FAIL; */ ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s enqueue_reorder_recvframe fail\n", __FUNCTION__); ++#endif ++ goto _err_exit; ++ } ++ ++ ++ /* s4. */ ++ /* Indication process. */ ++ /* After Packet dropping and Sliding Window shifting as above, we can now just indicate the packets */ ++ /* with the SeqNum smaller than latest WinStart and buffer other packets. */ ++ /* */ ++ /* For Rx Reorder condition: */ ++ /* 1. All packets with SeqNum smaller than WinStart => Indicate */ ++ /* 2. All packets with SeqNum larger than or equal to WinStart => Buffer it. */ ++ /* */ ++ ++ /* recv_indicatepkts_in_order(padapter, preorder_ctrl, _TRUE); */ ++ if (recv_indicatepkts_in_order(padapter, preorder_ctrl, _FALSE) == _TRUE) { ++ if (!preorder_ctrl->bReorderWaiting) { ++ preorder_ctrl->bReorderWaiting = _TRUE; ++ _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); ++ } ++ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); ++ } else { ++ preorder_ctrl->bReorderWaiting = _FALSE; ++ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); ++ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); ++ } ++ ++ ++_success_exit: ++ ++ return _SUCCESS; ++ ++_err_exit: ++ ++ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); ++ ++ return _FAIL; ++} ++ ++ ++void rtw_reordering_ctrl_timeout_handler(void *pcontext) ++{ ++ _irqL irql; ++ struct recv_reorder_ctrl *preorder_ctrl = (struct recv_reorder_ctrl *)pcontext; ++ _adapter *padapter = preorder_ctrl->padapter; ++ _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; ++ ++ ++ if (RTW_CANNOT_RUN(padapter)) ++ return; ++ ++ /* RTW_INFO("+rtw_reordering_ctrl_timeout_handler()=>\n"); */ ++ ++ _enter_critical_bh(&ppending_recvframe_queue->lock, &irql); ++ ++ if (preorder_ctrl) ++ preorder_ctrl->bReorderWaiting = _FALSE; ++ ++ if (recv_indicatepkts_in_order(padapter, preorder_ctrl, _TRUE) == _TRUE) ++ _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); ++ ++ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); ++ ++} ++ ++int process_recv_indicatepkts(_adapter *padapter, union recv_frame *prframe); ++int process_recv_indicatepkts(_adapter *padapter, union recv_frame *prframe) ++{ ++ int retval = _SUCCESS; ++ /* struct recv_priv *precvpriv = &padapter->recvpriv; */ ++ /* struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; */ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++#ifdef CONFIG_TDLS ++ struct sta_info *psta = prframe->u.hdr.psta; ++#endif /* CONFIG_TDLS */ ++ ++#ifdef CONFIG_80211N_HT ++ ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++ ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate); ++ ++#ifdef CONFIG_TDLS ++ if ((phtpriv->ht_option == _TRUE) || ++ ((psta->tdls_sta_state & TDLS_LINKED_STATE) && ++ (psta->htpriv.ht_option == _TRUE) && ++ (psta->htpriv.ampdu_enable == _TRUE))) /* B/G/N Mode */ ++#else ++ if (phtpriv->ht_option == _TRUE) /* B/G/N Mode */ ++#endif /* CONFIG_TDLS */ ++ { ++ /* prframe->u.hdr.preorder_ctrl = &precvpriv->recvreorder_ctrl[pattrib->priority]; */ ++ ++ if (recv_indicatepkt_reorder(padapter, prframe) != _SUCCESS) { /* including perform A-MPDU Rx Ordering Buffer Control */ ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s recv_indicatepkt_reorder error!\n", __FUNCTION__); ++#endif ++ ++ if (!RTW_CANNOT_RUN(padapter)) { ++ retval = _FAIL; ++ return retval; ++ } ++ } ++ } else /* B/G mode */ ++#endif ++ { ++ retval = wlanhdr_to_ethhdr(prframe); ++ if (retval != _SUCCESS) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr error!\n", __FUNCTION__); ++#endif ++ return retval; ++ } ++ ++ if (!RTW_CANNOT_RUN(padapter)) { ++ /* indicate this recv_frame */ ++ rtw_recv_indicatepkt(padapter, prframe); ++ } else { ++ ++ retval = _FAIL; ++ return retval; ++ } ++ ++ } ++ ++ return retval; ++ ++} ++ ++#ifdef CONFIG_MP_INCLUDED ++int validate_mp_recv_frame(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ int ret = _SUCCESS; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ u8 type, subtype; ++ struct mp_priv *pmppriv = &adapter->mppriv; ++ struct mp_tx *pmptx; ++ unsigned char *sa , *da, *bs; ++ ++ pmptx = &pmppriv->tx; ++ ++#if 0 ++ if (1) { ++ u8 bDumpRxPkt; ++ type = GetFrameType(ptr); ++ subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ ++ ++ rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); ++ if (bDumpRxPkt == 1) { /* dump all rx packets */ ++ int i; ++ RTW_INFO("############ type:0x%02x subtype:0x%02x #################\n", type, subtype); ++ ++ for (i = 0; i < 64; i = i + 8) ++ RTW_INFO("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr + i), ++ *(ptr + i + 1), *(ptr + i + 2) , *(ptr + i + 3) , *(ptr + i + 4), *(ptr + i + 5), *(ptr + i + 6), *(ptr + i + 7)); ++ RTW_INFO("#############################\n"); ++ } ++ } ++#endif ++ if (pmppriv->bloopback) { ++ if (_rtw_memcmp(ptr + 24, pmptx->buf + 24, precv_frame->u.hdr.len - 24) == _FALSE) { ++ RTW_INFO("Compare payload content Fail !!!\n"); ++ ret = _FAIL; ++ } ++ } ++ if (pmppriv->bSetRxBssid == _TRUE) { ++ ++ sa = GetAddr2Ptr(ptr); ++ da = GetAddr1Ptr(ptr); ++ bs = GetAddr3Ptr(ptr); ++ type = GetFrameType(ptr); ++ subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ ++ ++ if (_rtw_memcmp(bs, adapter->mppriv.network_macaddr, ETH_ALEN) == _FALSE) ++ ret = _FAIL; ++ ++ RTW_DBG("############ type:0x%02x subtype:0x%02x #################\n", type, subtype); ++ RTW_DBG("A2 sa %02X:%02X:%02X:%02X:%02X:%02X \n", *(sa) , *(sa + 1), *(sa+ 2), *(sa + 3), *(sa + 4), *(sa + 5)); ++ RTW_DBG("A1 da %02X:%02X:%02X:%02X:%02X:%02X \n", *(da) , *(da + 1), *(da+ 2), *(da + 3), *(da + 4), *(da + 5)); ++ RTW_DBG("A3 bs %02X:%02X:%02X:%02X:%02X:%02X \n --------------------------\n", *(bs) , *(bs + 1), *(bs+ 2), *(bs + 3), *(bs + 4), *(bs + 5)); ++ } ++ ++ if (!adapter->mppriv.bmac_filter) ++ return ret; ++ ++ if (_rtw_memcmp(GetAddr2Ptr(ptr), adapter->mppriv.mac_filter, ETH_ALEN) == _FALSE) ++ ret = _FAIL; ++ ++ return ret; ++} ++ ++static sint MPwlanhdr_to_ethhdr(union recv_frame *precvframe) ++{ ++ sint rmv_len; ++ u16 eth_type, len; ++ u8 bsnaphdr; ++ u8 *psnap_type; ++ u8 mcastheadermac[] = {0x01, 0x00, 0x5e}; ++ ++ struct ieee80211_snap_hdr *psnap; ++ ++ sint ret = _SUCCESS; ++ _adapter *adapter = precvframe->u.hdr.adapter; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ ++ u8 *ptr = get_recvframe_data(precvframe) ; /* point to frame_ctrl field */ ++ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; ++ ++ ++ if (pattrib->encrypt) ++ recvframe_pull_tail(precvframe, pattrib->icv_len); ++ ++ psnap = (struct ieee80211_snap_hdr *)(ptr + pattrib->hdrlen + pattrib->iv_len); ++ psnap_type = ptr + pattrib->hdrlen + pattrib->iv_len + SNAP_SIZE; ++ /* convert hdr + possible LLC headers into Ethernet header */ ++ /* eth_type = (psnap_type[0] << 8) | psnap_type[1]; */ ++ if ((_rtw_memcmp(psnap, rtw_rfc1042_header, SNAP_SIZE) && ++ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_IPX, 2) == _FALSE) && ++ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_AARP, 2) == _FALSE)) || ++ /* eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) || */ ++ _rtw_memcmp(psnap, rtw_bridge_tunnel_header, SNAP_SIZE)) { ++ /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ ++ bsnaphdr = _TRUE; ++ } else { ++ /* Leave Ethernet header part of hdr and full payload */ ++ bsnaphdr = _FALSE; ++ } ++ ++ rmv_len = pattrib->hdrlen + pattrib->iv_len + (bsnaphdr ? SNAP_SIZE : 0); ++ len = precvframe->u.hdr.len - rmv_len; ++ ++ ++ _rtw_memcpy(ð_type, ptr + rmv_len, 2); ++ eth_type = ntohs((unsigned short)eth_type); /* pattrib->ether_type */ ++ pattrib->eth_type = eth_type; ++ ++ { ++ ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + (bsnaphdr ? 2 : 0))); ++ } ++ ++ _rtw_memcpy(ptr, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(ptr + ETH_ALEN, pattrib->src, ETH_ALEN); ++ ++ if (!bsnaphdr) { ++ len = htons(len); ++ _rtw_memcpy(ptr + 12, &len, 2); ++ } ++ ++ ++ len = htons(pattrib->seq_num); ++ /* RTW_INFO("wlan seq = %d ,seq_num =%x\n",len,pattrib->seq_num); */ ++ _rtw_memcpy(ptr + 12, &len, 2); ++ if (adapter->mppriv.bRTWSmbCfg == _TRUE) { ++ /* if(_rtw_memcmp(mcastheadermac, pattrib->dst, 3) == _TRUE) */ /* SimpleConfig Dest. */ ++ /* _rtw_memcpy(ptr+ETH_ALEN, pattrib->bssid, ETH_ALEN); */ ++ ++ if (_rtw_memcmp(mcastheadermac, pattrib->bssid, 3) == _TRUE) /* SimpleConfig Dest. */ ++ _rtw_memcpy(ptr, pattrib->bssid, ETH_ALEN); ++ ++ } ++ ++ ++ return ret; ++ ++} ++ ++ ++int mp_recv_frame(_adapter *padapter, union recv_frame *rframe) ++{ ++ int ret = _SUCCESS; ++ struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; ++#ifdef CONFIG_MP_INCLUDED ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mp_priv *pmppriv = &padapter->mppriv; ++#endif /* CONFIG_MP_INCLUDED */ ++ u8 type; ++ u8 *ptr = rframe->u.hdr.rx_data; ++ u8 *psa, *pda, *pbssid; ++ struct sta_info *psta = NULL; ++ DBG_COUNTER(padapter->rx_logs.core_rx_pre); ++ ++ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { /* &&(padapter->mppriv.check_mp_pkt == 0)) */ ++ if (pattrib->crc_err == 1) ++ padapter->mppriv.rx_crcerrpktcount++; ++ else { ++ if (_SUCCESS == validate_mp_recv_frame(padapter, rframe)) ++ padapter->mppriv.rx_pktcount++; ++ else ++ padapter->mppriv.rx_pktcount_filter_out++; ++ } ++ ++ if (pmppriv->rx_bindicatePkt == _FALSE) { ++ ret = _FAIL; ++ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ ++ goto exit; ++ } else { ++ type = GetFrameType(ptr); ++ pattrib->to_fr_ds = get_tofr_ds(ptr); ++ pattrib->frag_num = GetFragNum(ptr); ++ pattrib->seq_num = GetSequence(ptr); ++ pattrib->pw_save = GetPwrMgt(ptr); ++ pattrib->mfrag = GetMFrag(ptr); ++ pattrib->mdata = GetMData(ptr); ++ pattrib->privacy = GetPrivacy(ptr); ++ pattrib->order = GetOrder(ptr); ++ ++ if (type == WIFI_DATA_TYPE) { ++ pda = get_da(ptr); ++ psa = get_sa(ptr); ++ pbssid = get_hdr_bssid(ptr); ++ ++ _rtw_memcpy(pattrib->dst, pda, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, psa, ETH_ALEN); ++ _rtw_memcpy(pattrib->bssid, pbssid, ETH_ALEN); ++ ++ switch (pattrib->to_fr_ds) { ++ case 0: ++ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); ++ ret = sta2sta_data_frame(padapter, rframe, &psta); ++ break; ++ ++ case 1: ++ ++ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pbssid, ETH_ALEN); ++ ret = ap2sta_data_frame(padapter, rframe, &psta); ++ ++ break; ++ ++ case 2: ++ _rtw_memcpy(pattrib->ra, pbssid, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); ++ ret = sta2ap_data_frame(padapter, rframe, &psta); ++ break; ++ ++ case 3: ++ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); ++ ret = _FAIL; ++ break; ++ ++ default: ++ ret = _FAIL; ++ break; ++ } ++ ++ ret = MPwlanhdr_to_ethhdr(rframe); ++ ++ if (ret != _SUCCESS) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr: drop pkt\n", __FUNCTION__); ++#endif ++ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ ++ ret = _FAIL; ++ goto exit; ++ } ++ if (!RTW_CANNOT_RUN(padapter)) { ++ /* indicate this recv_frame */ ++ ret = rtw_recv_indicatepkt(padapter, rframe); ++ if (ret != _SUCCESS) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s rtw_recv_indicatepkt fail!\n", __FUNCTION__); ++#endif ++ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ ++ ret = _FAIL; ++ ++ goto exit; ++ } ++ } else { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s ecv_func:bDriverStopped(%s) OR bSurpriseRemoved(%s)\n", __func__, ++ rtw_is_drv_stopped(padapter) ? "True" : "False", ++ rtw_is_surprise_removed(padapter) ? "True" : "False"); ++#endif ++ ret = _FAIL; ++ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ ++ goto exit; ++ } ++ ++ } ++ } ++ ++ } ++ ++ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ ++ ret = _FAIL; ++ ++exit: ++ return ret; ++ ++} ++#endif ++ ++static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, u8 *buf) ++{ ++#define CHAN2FREQ(a) ((a < 14) ? (2407+5*a) : (5000+5*a)) ++ ++#if 0 ++#define RTW_RX_RADIOTAP_PRESENT (\ ++ (1 << IEEE80211_RADIOTAP_TSFT) | \ ++ (1 << IEEE80211_RADIOTAP_FLAGS) | \ ++ (1 << IEEE80211_RADIOTAP_RATE) | \ ++ (1 << IEEE80211_RADIOTAP_CHANNEL) | \ ++ (0 << IEEE80211_RADIOTAP_FHSS) | \ ++ (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) | \ ++ (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) | \ ++ (0 << IEEE80211_RADIOTAP_LOCK_QUALITY) | \ ++ (0 << IEEE80211_RADIOTAP_TX_ATTENUATION) | \ ++ (0 << IEEE80211_RADIOTAP_DB_TX_ATTENUATION) | \ ++ (0 << IEEE80211_RADIOTAP_DBM_TX_POWER) | \ ++ (1 << IEEE80211_RADIOTAP_ANTENNA) | \ ++ (1 << IEEE80211_RADIOTAP_DB_ANTSIGNAL) | \ ++ (0 << IEEE80211_RADIOTAP_DB_ANTNOISE) | \ ++ (0 << IEEE80211_RADIOTAP_RX_FLAGS) | \ ++ (0 << IEEE80211_RADIOTAP_TX_FLAGS) | \ ++ (0 << IEEE80211_RADIOTAP_RTS_RETRIES) | \ ++ (0 << IEEE80211_RADIOTAP_DATA_RETRIES) | \ ++ (0 << IEEE80211_RADIOTAP_MCS) | \ ++ (0 << IEEE80211_RADIOTAP_RADIOTAP_NAMESPACE)| \ ++ (0 << IEEE80211_RADIOTAP_VENDOR_NAMESPACE) | \ ++ (0 << IEEE80211_RADIOTAP_EXT) | \ ++ 0) ++ ++ /* (0 << IEEE80211_RADIOTAP_AMPDU_STATUS) | \ */ ++ /* (0 << IEEE80211_RADIOTAP_VHT) | \ */ ++#endif ++ ++#ifndef IEEE80211_RADIOTAP_RX_FLAGS ++#define IEEE80211_RADIOTAP_RX_FLAGS 14 ++#endif ++ ++#ifndef IEEE80211_RADIOTAP_MCS ++#define IEEE80211_RADIOTAP_MCS 19 ++#endif ++#ifndef IEEE80211_RADIOTAP_VHT ++#define IEEE80211_RADIOTAP_VHT 21 ++#endif ++ ++#ifndef IEEE80211_RADIOTAP_F_BADFCS ++#define IEEE80211_RADIOTAP_F_BADFCS 0x40 /* bad FCS */ ++#endif ++ ++ sint ret = _SUCCESS; ++ _adapter *adapter = precvframe->u.hdr.adapter; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ u16 tmp_16bit = 0; ++ ++ u8 data_rate[] = { ++ 2, 4, 11, 22, /* CCK */ ++ 12, 18, 24, 36, 48, 72, 93, 108, /* OFDM */ ++ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, /* HT MCS index */ ++ 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, ++ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, /* VHT Nss 1 */ ++ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, /* VHT Nss 2 */ ++ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, /* VHT Nss 3 */ ++ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, /* VHT Nss 4 */ ++ }; ++ ++ _pkt *pskb = NULL; ++ ++ struct ieee80211_radiotap_header *rtap_hdr = NULL; ++ u8 *ptr = NULL; ++ ++ u8 hdr_buf[64] = {0}; ++ u16 rt_len = 8; ++ ++ /* create header */ ++ rtap_hdr = (struct ieee80211_radiotap_header *)&hdr_buf[0]; ++ rtap_hdr->it_version = PKTHDR_RADIOTAP_VERSION; ++ ++ /* tsft */ ++ if (pattrib->tsfl) { ++ u64 tmp_64bit; ++ ++ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_TSFT); ++ tmp_64bit = cpu_to_le64(pattrib->tsfl); ++ memcpy(&hdr_buf[rt_len], &tmp_64bit, 8); ++ rt_len += 8; ++ } ++ ++ /* flags */ ++ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_FLAGS); ++ if (0) ++ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_CFP; ++ ++ if (0) ++ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_SHORTPRE; ++ ++ if ((pattrib->encrypt == 1) || (pattrib->encrypt == 5)) ++ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_WEP; ++ ++ if (pattrib->mfrag) ++ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_FRAG; ++ ++ /* always append FCS */ ++ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_FCS; ++ ++ ++ if (0) ++ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_DATAPAD; ++ ++ if (pattrib->crc_err) ++ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_BADFCS; ++ ++ if (pattrib->sgi) { ++ /* Currently unspecified but used */ ++ hdr_buf[rt_len] |= 0x80; ++ } ++ rt_len += 1; ++ ++ /* rate */ ++ if (pattrib->data_rate < 12) { ++ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_RATE); ++ if (pattrib->data_rate < 4) { ++ /* CCK */ ++ hdr_buf[rt_len] = data_rate[pattrib->data_rate]; ++ } else { ++ /* OFDM */ ++ hdr_buf[rt_len] = data_rate[pattrib->data_rate]; ++ } ++ } ++ rt_len += 1; /* force padding 1 byte for aligned */ ++ ++ /* channel */ ++ tmp_16bit = 0; ++ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_CHANNEL); ++ tmp_16bit = CHAN2FREQ(rtw_get_oper_ch(padapter)); ++ /*tmp_16bit = CHAN2FREQ(pHalData->CurrentChannel);*/ ++ memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); ++ rt_len += 2; ++ ++ /* channel flags */ ++ tmp_16bit = 0; ++ if (pHalData->CurrentBandType == 0) ++ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_2GHZ); ++ else ++ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_5GHZ); ++ ++ if (pattrib->data_rate < 12) { ++ if (pattrib->data_rate < 4) { ++ /* CCK */ ++ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_CCK); ++ } else { ++ /* OFDM */ ++ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_OFDM); ++ } ++ } else ++ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_DYN); ++ memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); ++ rt_len += 2; ++ ++ /* dBm Antenna Signal */ ++ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL); ++ hdr_buf[rt_len] = pattrib->phy_info.RecvSignalPower; ++ rt_len += 1; ++ ++#if 0 ++ /* dBm Antenna Noise */ ++ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE); ++ hdr_buf[rt_len] = 0; ++ rt_len += 1; ++ ++ /* Signal Quality */ ++ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_LOCK_QUALITY); ++ hdr_buf[rt_len] = pattrib->phy_info.SignalQuality; ++ rt_len += 1; ++#endif ++ ++ /* Antenna */ ++ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_ANTENNA); ++ hdr_buf[rt_len] = 0; /* pHalData->rf_type; */ ++ rt_len += 1; ++ ++ /* RX flags */ ++ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_RX_FLAGS); ++#if 0 ++ tmp_16bit = cpu_to_le16(0); ++ memcpy(ptr, &tmp_16bit, 1); ++#endif ++ rt_len += 2; ++ ++ /* MCS information */ ++ if (pattrib->data_rate >= 12 && pattrib->data_rate < 44) { ++ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_MCS); ++ /* known, flag */ ++ hdr_buf[rt_len] |= BIT1; /* MCS index known */ ++ ++ /* bandwidth */ ++ hdr_buf[rt_len] |= BIT0; ++ hdr_buf[rt_len + 1] |= (pattrib->bw & 0x03); ++ ++ /* guard interval */ ++ hdr_buf[rt_len] |= BIT2; ++ hdr_buf[rt_len + 1] |= (pattrib->sgi & 0x01) << 2; ++ ++ /* STBC */ ++ hdr_buf[rt_len] |= BIT5; ++ hdr_buf[rt_len + 1] |= (pattrib->stbc & 0x03) << 5; ++ ++ rt_len += 2; ++ ++ /* MCS rate index */ ++ hdr_buf[rt_len] = data_rate[pattrib->data_rate]; ++ rt_len += 1; ++ } ++ ++ /* VHT */ ++ if (pattrib->data_rate >= 44 && pattrib->data_rate < 84) { ++ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_VHT); ++ ++ /* known 16 bit, flag 8 bit */ ++ tmp_16bit = 0; ++ ++ /* Bandwidth */ ++ tmp_16bit |= BIT6; ++ ++ /* Group ID */ ++ tmp_16bit |= BIT7; ++ ++ /* Partial AID */ ++ tmp_16bit |= BIT8; ++ ++ /* STBC */ ++ tmp_16bit |= BIT0; ++ hdr_buf[rt_len + 2] |= (pattrib->stbc & 0x01); ++ ++ /* Guard interval */ ++ tmp_16bit |= BIT2; ++ hdr_buf[rt_len + 2] |= (pattrib->sgi & 0x01) << 2; ++ ++ /* LDPC extra OFDM symbol */ ++ tmp_16bit |= BIT4; ++ hdr_buf[rt_len + 2] |= (pattrib->ldpc & 0x01) << 4; ++ ++ memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); ++ rt_len += 3; ++ ++ /* bandwidth */ ++ if (pattrib->bw == 0) ++ hdr_buf[rt_len] |= 0; ++ else if (pattrib->bw == 1) ++ hdr_buf[rt_len] |= 1; ++ else if (pattrib->bw == 2) ++ hdr_buf[rt_len] |= 4; ++ else if (pattrib->bw == 3) ++ hdr_buf[rt_len] |= 11; ++ rt_len += 1; ++ ++ /* mcs_nss */ ++ if (pattrib->data_rate >= 44 && pattrib->data_rate < 54) { ++ hdr_buf[rt_len] |= 1; ++ hdr_buf[rt_len] |= data_rate[pattrib->data_rate] << 4; ++ } else if (pattrib->data_rate >= 54 && pattrib->data_rate < 64) { ++ hdr_buf[rt_len + 1] |= 2; ++ hdr_buf[rt_len + 1] |= data_rate[pattrib->data_rate] << 4; ++ } else if (pattrib->data_rate >= 64 && pattrib->data_rate < 74) { ++ hdr_buf[rt_len + 2] |= 3; ++ hdr_buf[rt_len + 2] |= data_rate[pattrib->data_rate] << 4; ++ } else if (pattrib->data_rate >= 74 && pattrib->data_rate < 84) { ++ hdr_buf[rt_len + 3] |= 4; ++ hdr_buf[rt_len + 3] |= data_rate[pattrib->data_rate] << 4; ++ } ++ rt_len += 4; ++ ++ /* coding */ ++ hdr_buf[rt_len] = 0; ++ rt_len += 1; ++ ++ /* group_id */ ++ hdr_buf[rt_len] = 0; ++ rt_len += 1; ++ ++ /* partial_aid */ ++ tmp_16bit = 0; ++ memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); ++ rt_len += 2; ++ } ++ ++ /* push to skb */ ++ pskb = (_pkt *)buf; ++ if (skb_headroom(pskb) < rt_len) { ++ RTW_INFO("%s:%d %s headroom is too small.\n", __FILE__, __LINE__, __func__); ++ ret = _FAIL; ++ return ret; ++ } ++ ++ ptr = skb_push(pskb, rt_len); ++ if (ptr) { ++ rtap_hdr->it_len = cpu_to_le16(rt_len); ++ memcpy(ptr, rtap_hdr, rt_len); ++ } else ++ ret = _FAIL; ++ ++ return ret; ++ ++} ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) ++int recv_frame_monitor(_adapter *padapter, union recv_frame *rframe) ++{ ++ int ret = _SUCCESS; ++ struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; ++ _pkt *pskb = NULL; ++ ++ /* read skb information from recv frame */ ++ pskb = rframe->u.hdr.pkt; ++ pskb->len = rframe->u.hdr.len; ++ pskb->data = rframe->u.hdr.rx_data; ++ skb_set_tail_pointer(pskb, rframe->u.hdr.len); ++ ++ /* fill radiotap header */ ++ if (fill_radiotap_hdr(padapter, rframe, (u8 *)pskb) == _FAIL) { ++ ret = _FAIL; ++ rtw_free_recvframe(rframe, pfree_recv_queue); /* free this recv_frame */ ++ goto exit; ++ } ++ ++ /* write skb information to recv frame */ ++ skb_reset_mac_header(pskb); ++ rframe->u.hdr.len = pskb->len; ++ rframe->u.hdr.rx_data = pskb->data; ++ rframe->u.hdr.rx_head = pskb->head; ++ rframe->u.hdr.rx_tail = skb_tail_pointer(pskb); ++ rframe->u.hdr.rx_end = skb_end_pointer(pskb); ++ ++ if (!RTW_CANNOT_RUN(padapter)) { ++ /* indicate this recv_frame */ ++ ret = rtw_recv_monitor(padapter, rframe); ++ if (ret != _SUCCESS) { ++ ret = _FAIL; ++ rtw_free_recvframe(rframe, pfree_recv_queue); /* free this recv_frame */ ++ goto exit; ++ } ++ } else { ++ ret = _FAIL; ++ rtw_free_recvframe(rframe, pfree_recv_queue); /* free this recv_frame */ ++ goto exit; ++ } ++ ++exit: ++ return ret; ++} ++#endif ++int recv_func_prehandle(_adapter *padapter, union recv_frame *rframe) ++{ ++ int ret = _SUCCESS; ++ struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; ++ ++#ifdef DBG_RX_COUNTER_DUMP ++ if (padapter->dump_rx_cnt_mode & DUMP_DRV_RX_COUNTER) { ++ if (pattrib->crc_err == 1) ++ padapter->drv_rx_cnt_crcerror++; ++ else ++ padapter->drv_rx_cnt_ok++; ++ } ++#endif ++ ++#ifdef CONFIG_MP_INCLUDED ++ if (padapter->registrypriv.mp_mode == 1 || padapter->mppriv.bRTWSmbCfg == _TRUE) { ++ mp_recv_frame(padapter, rframe); ++ ret = _FAIL; ++ goto exit; ++ } else ++#endif ++ { ++ /* check the frame crtl field and decache */ ++ ret = validate_recv_frame(padapter, rframe); ++ if (ret != _SUCCESS) { ++ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ ++ goto exit; ++ } ++ } ++exit: ++ return ret; ++} ++ ++/*#define DBG_RX_BMC_FRAME*/ ++int recv_func_posthandle(_adapter *padapter, union recv_frame *prframe) ++{ ++ int ret = _SUCCESS; ++ union recv_frame *orig_prframe = prframe; ++ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; ++#ifdef CONFIG_TDLS ++ u8 *psnap_type, *pcategory; ++#endif /* CONFIG_TDLS */ ++ ++ DBG_COUNTER(padapter->rx_logs.core_rx_post); ++ ++ /* DATA FRAME */ ++ rtw_led_control(padapter, LED_CTL_RX); ++ ++ prframe = decryptor(padapter, prframe); ++ if (prframe == NULL) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s decryptor: drop pkt\n", __FUNCTION__); ++#endif ++ ret = _FAIL; ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_err); ++ goto _recv_data_drop; ++ } ++ ++#ifdef DBG_RX_BMC_FRAME ++ if (IS_MCAST(pattrib->ra)) { ++ u8 *pbuf = prframe->u.hdr.rx_data; ++ u8 *sa_addr = get_sa(pbuf); ++ ++ RTW_INFO("%s =>"ADPT_FMT" Rx BC/MC from MAC: "MAC_FMT"\n", __func__, ADPT_ARG(padapter), MAC_ARG(sa_addr)); ++ } ++#endif ++ ++#if 0 ++ if (padapter->adapter_type == PRIMARY_ADAPTER) { ++ RTW_INFO("+++\n"); ++ { ++ int i; ++ u8 *ptr = get_recvframe_data(prframe); ++ for (i = 0; i < 140; i = i + 8) ++ RTW_INFO("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:", *(ptr + i), ++ *(ptr + i + 1), *(ptr + i + 2) , *(ptr + i + 3) , *(ptr + i + 4), *(ptr + i + 5), *(ptr + i + 6), *(ptr + i + 7)); ++ ++ } ++ RTW_INFO("---\n"); ++ } ++#endif ++ ++#ifdef CONFIG_TDLS ++ /* check TDLS frame */ ++ psnap_type = get_recvframe_data(orig_prframe) + pattrib->hdrlen + pattrib->iv_len + SNAP_SIZE; ++ pcategory = psnap_type + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; ++ ++ if ((_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_TDLS, ETH_TYPE_LEN)) && ++ ((*pcategory == RTW_WLAN_CATEGORY_TDLS) || (*pcategory == RTW_WLAN_CATEGORY_P2P))) { ++ ret = OnTDLS(padapter, prframe); ++ if (ret == _FAIL) ++ goto _exit_recv_func; ++ } ++#endif /* CONFIG_TDLS */ ++ ++ prframe = recvframe_chk_defrag(padapter, prframe); ++ if (prframe == NULL) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s recvframe_chk_defrag: drop pkt\n", __FUNCTION__); ++#endif ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_defrag_err); ++ goto _recv_data_drop; ++ } ++ ++ prframe = portctrl(padapter, prframe); ++ if (prframe == NULL) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s portctrl: drop pkt\n", __FUNCTION__); ++#endif ++ ret = _FAIL; ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_portctrl_err); ++ goto _recv_data_drop; ++ } ++ ++ count_rx_stats(padapter, prframe, NULL); ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ rtw_wapi_update_info(padapter, prframe); ++#endif ++ ++#ifdef CONFIG_80211N_HT ++ ret = process_recv_indicatepkts(padapter, prframe); ++ if (ret != _SUCCESS) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s process_recv_indicatepkts fail!\n", __FUNCTION__); ++#endif ++ rtw_free_recvframe(orig_prframe, pfree_recv_queue);/* free this recv_frame */ ++ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_err); ++ goto _recv_data_drop; ++ } ++#else /* CONFIG_80211N_HT */ ++ if (!pattrib->amsdu) { ++ ret = wlanhdr_to_ethhdr(prframe); ++ if (ret != _SUCCESS) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr: drop pkt\n", __FUNCTION__); ++#endif ++ rtw_free_recvframe(orig_prframe, pfree_recv_queue);/* free this recv_frame */ ++ goto _recv_data_drop; ++ } ++ ++ if (!RTW_CANNOT_RUN(padapter)) { ++ /* indicate this recv_frame */ ++ ret = rtw_recv_indicatepkt(padapter, prframe); ++ if (ret != _SUCCESS) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s rtw_recv_indicatepkt fail!\n", __FUNCTION__); ++#endif ++ goto _recv_data_drop; ++ } ++ } else { ++ ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s recv_func:bDriverStopped(%s) OR bSurpriseRemoved(%s)\n", __func__ ++ , rtw_is_drv_stopped(padapter) ? "True" : "False" ++ , rtw_is_surprise_removed(padapter) ? "True" : "False"); ++#endif ++ ret = _FAIL; ++ rtw_free_recvframe(orig_prframe, pfree_recv_queue); /* free this recv_frame */ ++ } ++ ++ } else if (pattrib->amsdu == 1) { ++ ++ ret = amsdu_to_msdu(padapter, prframe); ++ if (ret != _SUCCESS) { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s amsdu_to_msdu fail\n", __FUNCTION__); ++#endif ++ rtw_free_recvframe(orig_prframe, pfree_recv_queue); ++ goto _recv_data_drop; ++ } ++ } else { ++#ifdef DBG_RX_DROP_FRAME ++ RTW_INFO("DBG_RX_DROP_FRAME %s what is this condition??\n", __FUNCTION__); ++#endif ++ goto _recv_data_drop; ++ } ++#endif /* CONFIG_80211N_HT */ ++ ++_exit_recv_func: ++ return ret; ++ ++_recv_data_drop: ++ precvpriv->rx_drop++; ++ return ret; ++} ++ ++ ++int recv_func(_adapter *padapter, union recv_frame *rframe); ++int recv_func(_adapter *padapter, union recv_frame *rframe) ++{ ++ int ret; ++ struct rx_pkt_attrib *prxattrib = &rframe->u.hdr.attrib; ++ struct recv_priv *recvpriv = &padapter->recvpriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_priv *mlmepriv = &padapter->mlmepriv; ++ ++ if (check_fwstate(mlmepriv, WIFI_MONITOR_STATE)) { ++ /* monitor mode */ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) ++ recv_frame_monitor(padapter, rframe); ++#endif ++ ret = _SUCCESS; ++ goto exit; ++ } else ++ ++ /* check if need to handle uc_swdec_pending_queue*/ ++ if (check_fwstate(mlmepriv, WIFI_STATION_STATE) && psecuritypriv->busetkipkey) { ++ union recv_frame *pending_frame; ++ int cnt = 0; ++ ++ while ((pending_frame = rtw_alloc_recvframe(&padapter->recvpriv.uc_swdec_pending_queue))) { ++ cnt++; ++ DBG_COUNTER(padapter->rx_logs.core_rx_dequeue); ++ recv_func_posthandle(padapter, pending_frame); ++ } ++ ++ if (cnt) ++ RTW_INFO(FUNC_ADPT_FMT" dequeue %d from uc_swdec_pending_queue\n", ++ FUNC_ADPT_ARG(padapter), cnt); ++ } ++ ++ DBG_COUNTER(padapter->rx_logs.core_rx); ++ ret = recv_func_prehandle(padapter, rframe); ++ ++ if (ret == _SUCCESS) { ++ ++ /* check if need to enqueue into uc_swdec_pending_queue*/ ++ if (check_fwstate(mlmepriv, WIFI_STATION_STATE) && ++ !IS_MCAST(prxattrib->ra) && prxattrib->encrypt > 0 && ++ (prxattrib->bdecrypted == 0 || psecuritypriv->sw_decrypt == _TRUE) && ++ psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPAPSK && ++ !psecuritypriv->busetkipkey) { ++ DBG_COUNTER(padapter->rx_logs.core_rx_enqueue); ++ rtw_enqueue_recvframe(rframe, &padapter->recvpriv.uc_swdec_pending_queue); ++ /* RTW_INFO("%s: no key, enqueue uc_swdec_pending_queue\n", __func__); */ ++ ++ if (recvpriv->free_recvframe_cnt < NR_RECVFRAME / 4) { ++ /* to prevent from recvframe starvation, get recvframe from uc_swdec_pending_queue to free_recvframe_cnt */ ++ rframe = rtw_alloc_recvframe(&padapter->recvpriv.uc_swdec_pending_queue); ++ if (rframe) ++ goto do_posthandle; ++ } ++ goto exit; ++ } ++ ++do_posthandle: ++ ret = recv_func_posthandle(padapter, rframe); ++ } ++ ++exit: ++ return ret; ++} ++ ++ ++s32 rtw_recv_entry(union recv_frame *precvframe) ++{ ++ _adapter *padapter; ++ struct recv_priv *precvpriv; ++ s32 ret = _SUCCESS; ++ ++ ++ ++ padapter = precvframe->u.hdr.adapter; ++ ++ precvpriv = &padapter->recvpriv; ++ ++ ++ ret = recv_func(padapter, precvframe); ++ if (ret == _FAIL) { ++ goto _recv_entry_drop; ++ } ++ ++ ++ precvpriv->rx_pkts++; ++ ++ ++ return ret; ++ ++_recv_entry_drop: ++ ++#ifdef CONFIG_MP_INCLUDED ++ if (padapter->registrypriv.mp_mode == 1) ++ padapter->mppriv.rx_pktloss = precvpriv->rx_drop; ++#endif ++ ++ ++ ++ return ret; ++} ++ ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS) ++{ ++ _adapter *adapter = (_adapter *)FunctionContext; ++ struct recv_priv *recvpriv = &adapter->recvpriv; ++ ++ u32 tmp_s, tmp_q; ++ u8 avg_signal_strength = 0; ++ u8 avg_signal_qual = 0; ++ u32 num_signal_strength = 0; ++ u32 num_signal_qual = 0; ++ u8 ratio_pre_stat = 0, ratio_curr_stat = 0, ratio_total = 0, ratio_profile = SIGNAL_STAT_CALC_PROFILE_0; ++ ++ if (adapter->recvpriv.is_signal_dbg) { ++ /* update the user specific value, signal_strength_dbg, to signal_strength, rssi */ ++ adapter->recvpriv.signal_strength = adapter->recvpriv.signal_strength_dbg; ++ adapter->recvpriv.rssi = (s8)translate_percentage_to_dbm((u8)adapter->recvpriv.signal_strength_dbg); ++ } else { ++ ++ if (recvpriv->signal_strength_data.update_req == 0) { /* update_req is clear, means we got rx */ ++ avg_signal_strength = recvpriv->signal_strength_data.avg_val; ++ num_signal_strength = recvpriv->signal_strength_data.total_num; ++ /* after avg_vals are accquired, we can re-stat the signal values */ ++ recvpriv->signal_strength_data.update_req = 1; ++ } ++ ++ if (recvpriv->signal_qual_data.update_req == 0) { /* update_req is clear, means we got rx */ ++ avg_signal_qual = recvpriv->signal_qual_data.avg_val; ++ num_signal_qual = recvpriv->signal_qual_data.total_num; ++ /* after avg_vals are accquired, we can re-stat the signal values */ ++ recvpriv->signal_qual_data.update_req = 1; ++ } ++ ++ if (num_signal_strength == 0) { ++ if (rtw_get_on_cur_ch_time(adapter) == 0 ++ || rtw_get_passing_time_ms(rtw_get_on_cur_ch_time(adapter)) < 2 * adapter->mlmeextpriv.mlmext_info.bcn_interval ++ ) ++ goto set_timer; ++ } ++ ++ if (check_fwstate(&adapter->mlmepriv, _FW_UNDER_SURVEY) == _TRUE ++ || check_fwstate(&adapter->mlmepriv, _FW_LINKED) == _FALSE ++ ) ++ goto set_timer; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_buddy_check_fwstate(adapter, _FW_UNDER_SURVEY) == _TRUE) ++ goto set_timer; ++#endif ++ ++ if (RTW_SIGNAL_STATE_CALC_PROFILE < SIGNAL_STAT_CALC_PROFILE_MAX) ++ ratio_profile = RTW_SIGNAL_STATE_CALC_PROFILE; ++ ++ ratio_pre_stat = signal_stat_calc_profile[ratio_profile][0]; ++ ratio_curr_stat = signal_stat_calc_profile[ratio_profile][1]; ++ ratio_total = ratio_pre_stat + ratio_curr_stat; ++ ++ /* update value of signal_strength, rssi, signal_qual */ ++ tmp_s = (ratio_curr_stat * avg_signal_strength + ratio_pre_stat * recvpriv->signal_strength); ++ if (tmp_s % ratio_total) ++ tmp_s = tmp_s / ratio_total + 1; ++ else ++ tmp_s = tmp_s / ratio_total; ++ if (tmp_s > 100) ++ tmp_s = 100; ++ ++ tmp_q = (ratio_curr_stat * avg_signal_qual + ratio_pre_stat * recvpriv->signal_qual); ++ if (tmp_q % ratio_total) ++ tmp_q = tmp_q / ratio_total + 1; ++ else ++ tmp_q = tmp_q / ratio_total; ++ if (tmp_q > 100) ++ tmp_q = 100; ++ ++ recvpriv->signal_strength = tmp_s; ++ recvpriv->rssi = (s8)translate_percentage_to_dbm(tmp_s); ++ recvpriv->signal_qual = tmp_q; ++ ++#if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 ++ RTW_INFO(FUNC_ADPT_FMT" signal_strength:%3u, rssi:%3d, signal_qual:%3u" ++ ", num_signal_strength:%u, num_signal_qual:%u" ++ ", on_cur_ch_ms:%d" ++ "\n" ++ , FUNC_ADPT_ARG(adapter) ++ , recvpriv->signal_strength ++ , recvpriv->rssi ++ , recvpriv->signal_qual ++ , num_signal_strength, num_signal_qual ++ , rtw_get_on_cur_ch_time(adapter) ? rtw_get_passing_time_ms(rtw_get_on_cur_ch_time(adapter)) : 0 ++ ); ++#endif ++ } ++ ++set_timer: ++ rtw_set_signal_stat_timer(recvpriv); ++ ++} ++#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ ++ ++static void rx_process_rssi(_adapter *padapter, union recv_frame *prframe) ++{ ++ u32 last_rssi, tmp_val; ++ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ struct signal_stat *signal_stat = &padapter->recvpriv.signal_strength_data; ++#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ ++ ++ /* RTW_INFO("process_rssi=> pattrib->rssil(%d) signal_strength(%d)\n ",pattrib->RecvSignalPower,pattrib->signal_strength); */ ++ /* if(pRfd->Status.bPacketToSelf || pRfd->Status.bPacketBeacon) */ ++ { ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ if (signal_stat->update_req) { ++ signal_stat->total_num = 0; ++ signal_stat->total_val = 0; ++ signal_stat->update_req = 0; ++ } ++ ++ signal_stat->total_num++; ++ signal_stat->total_val += pattrib->phy_info.SignalStrength; ++ signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; ++#else /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ ++ ++ /* Adapter->RxStats.RssiCalculateCnt++; */ /* For antenna Test */ ++ if (padapter->recvpriv.signal_strength_data.total_num++ >= PHY_RSSI_SLID_WIN_MAX) { ++ padapter->recvpriv.signal_strength_data.total_num = PHY_RSSI_SLID_WIN_MAX; ++ last_rssi = padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index]; ++ padapter->recvpriv.signal_strength_data.total_val -= last_rssi; ++ } ++ padapter->recvpriv.signal_strength_data.total_val += pattrib->phy_info.SignalStrength; ++ ++ padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index++] = pattrib->phy_info.SignalStrength; ++ if (padapter->recvpriv.signal_strength_data.index >= PHY_RSSI_SLID_WIN_MAX) ++ padapter->recvpriv.signal_strength_data.index = 0; ++ ++ ++ tmp_val = padapter->recvpriv.signal_strength_data.total_val / padapter->recvpriv.signal_strength_data.total_num; ++ ++ if (padapter->recvpriv.is_signal_dbg) { ++ padapter->recvpriv.signal_strength = padapter->recvpriv.signal_strength_dbg; ++ padapter->recvpriv.rssi = (s8)translate_percentage_to_dbm(padapter->recvpriv.signal_strength_dbg); ++ } else { ++ padapter->recvpriv.signal_strength = tmp_val; ++ padapter->recvpriv.rssi = (s8)translate_percentage_to_dbm(tmp_val); ++ } ++ ++#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ ++ } ++} ++ ++static void rx_process_link_qual(_adapter *padapter, union recv_frame *prframe) ++{ ++ u32 last_evm = 0, tmpVal; ++ struct rx_pkt_attrib *pattrib; ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ struct signal_stat *signal_stat; ++#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ ++ ++ if (prframe == NULL || padapter == NULL) ++ return; ++ ++ pattrib = &prframe->u.hdr.attrib; ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ signal_stat = &padapter->recvpriv.signal_qual_data; ++#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ ++ ++ /* RTW_INFO("process_link_qual=> pattrib->signal_qual(%d)\n ",pattrib->signal_qual); */ ++ ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ if (signal_stat->update_req) { ++ signal_stat->total_num = 0; ++ signal_stat->total_val = 0; ++ signal_stat->update_req = 0; ++ } ++ ++ signal_stat->total_num++; ++ signal_stat->total_val += pattrib->phy_info.SignalQuality; ++ signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; ++ ++#else /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ ++ if (pattrib->phy_info.SignalQuality != 0) { ++ /* */ ++ /* 1. Record the general EVM to the sliding window. */ ++ /* */ ++ if (padapter->recvpriv.signal_qual_data.total_num++ >= PHY_LINKQUALITY_SLID_WIN_MAX) { ++ padapter->recvpriv.signal_qual_data.total_num = PHY_LINKQUALITY_SLID_WIN_MAX; ++ last_evm = padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index]; ++ padapter->recvpriv.signal_qual_data.total_val -= last_evm; ++ } ++ padapter->recvpriv.signal_qual_data.total_val += pattrib->phy_info.SignalQuality; ++ ++ padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = pattrib->phy_info.SignalQuality; ++ if (padapter->recvpriv.signal_qual_data.index >= PHY_LINKQUALITY_SLID_WIN_MAX) ++ padapter->recvpriv.signal_qual_data.index = 0; ++ ++ ++ /* <1> Showed on UI for user, in percentage. */ ++ tmpVal = padapter->recvpriv.signal_qual_data.total_val / padapter->recvpriv.signal_qual_data.total_num; ++ padapter->recvpriv.signal_qual = (u8)tmpVal; ++ ++ } ++#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ ++} ++ ++void rx_process_phy_info(_adapter *padapter, union recv_frame *rframe) ++{ ++ /* Check RSSI */ ++ rx_process_rssi(padapter, rframe); ++ ++ /* Check PWDB */ ++ /* process_PWDB(padapter, rframe); */ ++ ++ /* UpdateRxSignalStatistics8192C(Adapter, pRfd); */ ++ ++ /* Check EVM */ ++ rx_process_link_qual(padapter, rframe); ++ rtw_store_phy_info(padapter, rframe); ++} ++ ++void rx_query_phy_status( ++ union recv_frame *precvframe, ++ u8 *pphy_status) ++{ ++ PADAPTER padapter = precvframe->u.hdr.adapter; ++ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ PODM_PHY_INFO_T pPHYInfo = (PODM_PHY_INFO_T)(&pattrib->phy_info); ++ u8 *wlanhdr; ++ ODM_PACKET_INFO_T pkt_info; ++ u8 *sa; ++ struct sta_priv *pstapriv; ++ struct sta_info *psta = NULL; ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ /* _irqL irqL; */ ++ ++ pkt_info.bPacketMatchBSSID = _FALSE; ++ pkt_info.bPacketToSelf = _FALSE; ++ pkt_info.bPacketBeacon = _FALSE; ++ ++ wlanhdr = get_recvframe_data(precvframe); ++ ++ pkt_info.bPacketMatchBSSID = (!IsFrameTypeCtrl(wlanhdr)) ++ && (!pattrib->icv_err) && (!pattrib->crc_err) ++ && _rtw_memcmp(get_hdr_bssid(wlanhdr), get_bssid(&padapter->mlmepriv), ETH_ALEN); ++ ++ pkt_info.bToSelf = (!pattrib->icv_err) && (!pattrib->crc_err) ++ && _rtw_memcmp(get_ra(wlanhdr), adapter_mac_addr(padapter), ETH_ALEN); ++ ++ pkt_info.bPacketToSelf = pkt_info.bPacketMatchBSSID ++ && _rtw_memcmp(get_ra(wlanhdr), adapter_mac_addr(padapter), ETH_ALEN); ++ ++ pkt_info.bPacketBeacon = pkt_info.bPacketMatchBSSID ++ && (GetFrameSubType(wlanhdr) == WIFI_BEACON); ++ ++ sa = get_ta(wlanhdr); ++ ++ pkt_info.StationID = 0xFF; ++ ++ if (_rtw_memcmp(adapter_mac_addr(padapter), sa, ETH_ALEN) == _TRUE) { ++ static u32 start_time = 0; ++ ++#if 0 /*For debug */ ++ if (IsFrameTypeCtrl(wlanhdr)) { ++ RTW_INFO("-->Control frame: Y\n"); ++ RTW_INFO("-->pkt_len: %d\n", pattrib->pkt_len); ++ RTW_INFO("-->Sub Type = 0x%X\n", GetFrameSubType(wlanhdr)); ++ } ++ ++ /* Dump first 40 bytes of header */ ++ int i = 0; ++ ++ for (i = 0; i < 40; i++) ++ RTW_INFO("%d: %X\n", i, *((u8 *)wlanhdr + i)); ++ ++ RTW_INFO("\n"); ++#endif ++ ++ if ((start_time == 0) || (rtw_get_passing_time_ms(start_time) > 5000)) { ++ RTW_PRINT("Warning!!! %s: Confilc mac addr!!\n", __func__); ++ start_time = rtw_get_current_time(); ++ } ++ pdbgpriv->dbg_rx_conflic_mac_addr_cnt++; ++ } else { ++ pstapriv = &padapter->stapriv; ++ psta = rtw_get_stainfo(pstapriv, sa); ++ if (psta) ++ pkt_info.StationID = psta->mac_id; ++ } ++ ++ pkt_info.DataRate = pattrib->data_rate; ++ ++ /* _enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ ++ ODM_PhyStatusQuery(&pHalData->odmpriv, pPHYInfo, pphy_status, &pkt_info); ++ if (psta) ++ psta->rssi = pattrib->phy_info.RecvSignalPower; ++ /* _exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ ++ ++ { ++ precvframe->u.hdr.psta = NULL; ++ if (pkt_info.bPacketMatchBSSID ++ && (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) ++ ) { ++ if (psta) { ++ precvframe->u.hdr.psta = psta; ++ rx_process_phy_info(padapter, precvframe); ++ } ++ } else if (pkt_info.bPacketToSelf || pkt_info.bPacketBeacon) { ++ ++ if (psta) ++ precvframe->u.hdr.psta = psta; ++ rx_process_phy_info(padapter, precvframe); ++ } ++ } ++ ++ rtw_odm_parse_rx_phy_status_chinfo(precvframe, pphy_status); ++} ++/* ++* Increase and check if the continual_no_rx_packet of this @param pmlmepriv is larger than MAX_CONTINUAL_NORXPACKET_COUNT ++* @return _TRUE: ++* @return _FALSE: ++*/ ++int rtw_inc_and_chk_continual_no_rx_packet(struct sta_info *sta, int tid_index) ++{ ++ ++ int ret = _FALSE; ++ int value = ATOMIC_INC_RETURN(&sta->continual_no_rx_packet[tid_index]); ++ ++ if (value >= MAX_CONTINUAL_NORXPACKET_COUNT) ++ ret = _TRUE; ++ ++ return ret; ++} ++ ++/* ++* Set the continual_no_rx_packet of this @param pmlmepriv to 0 ++*/ ++void rtw_reset_continual_no_rx_packet(struct sta_info *sta, int tid_index) ++{ ++ ATOMIC_SET(&sta->continual_no_rx_packet[tid_index], 0); ++} ++ ++ ++s32 pre_recv_entry(union recv_frame *precvframe, u8 *pphy_status) ++{ ++ s32 ret = _SUCCESS; ++#ifdef CONFIG_CONCURRENT_MODE ++ u8 *pda; ++ u8 *pbuf = precvframe->u.hdr.rx_data; ++ _adapter *iface = NULL; ++ _adapter *primary_padapter = precvframe->u.hdr.adapter; ++ ++ pda = get_ra(pbuf); ++ ++ if (IS_MCAST(pda) == _FALSE) { /*unicast packets*/ ++ iface = rtw_get_iface_by_macddr(primary_padapter , pda); ++ if (NULL == iface) { ++ RTW_INFO("%s [WARN] Cannot find appropriate adapter - mac_addr : "MAC_FMT"\n", __func__, MAC_ARG(pda)); ++ /*rtw_warn_on(1);*/ ++ } else ++ precvframe->u.hdr.adapter = iface; ++ } else /* Handle BC/MC Packets */ ++ rtw_mi_buddy_clone_bcmc_packet(primary_padapter, precvframe, pphy_status); ++#endif ++ ++ return ret; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_rf.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_rf.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_rf.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_rf.c 2018-02-11 21:44:27.141145994 +0200 +@@ -0,0 +1,1140 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_RF_C_ ++ ++#include ++#include ++ ++u8 center_ch_2g[CENTER_CH_2G_NUM] = { ++/* G00 */1, 2, ++/* G01 */3, 4, 5, ++/* G02 */6, 7, 8, ++/* G03 */9, 10, 11, ++/* G04 */12, 13, ++/* G05 */14 ++}; ++ ++u8 center_ch_2g_40m[CENTER_CH_2G_40M_NUM] = { ++ 3, ++ 4, ++ 5, ++ 6, ++ 7, ++ 8, ++ 9, ++ 10, ++ 11, ++}; ++ ++u8 op_chs_of_cch_2g_40m[CENTER_CH_2G_40M_NUM][2] = { ++ {1, 5}, /* 3 */ ++ {2, 6}, /* 4 */ ++ {3, 7}, /* 5 */ ++ {4, 8}, /* 6 */ ++ {5, 9}, /* 7 */ ++ {6, 10}, /* 8 */ ++ {7, 11}, /* 9 */ ++ {8, 12}, /* 10 */ ++ {9, 13}, /* 11 */ ++}; ++ ++u8 center_ch_5g_all[CENTER_CH_5G_ALL_NUM] = { ++/* G00 */36, 38, 40, ++ 42, ++/* G01 */44, 46, 48, ++ /* 50, */ ++/* G02 */52, 54, 56, ++ 58, ++/* G03 */60, 62, 64, ++/* G04 */100, 102, 104, ++ 106, ++/* G05 */108, 110, 112, ++ /* 114, */ ++/* G06 */116, 118, 120, ++ 122, ++/* G07 */124, 126, 128, ++/* G08 */132, 134, 136, ++ 138, ++/* G09 */140, 142, 144, ++/* G10 */149, 151, 153, ++ 155, ++/* G11 */157, 159, 161, ++ /* 163, */ ++/* G12 */165, 167, 169, ++ 171, ++/* G13 */173, 175, 177 ++}; ++ ++u8 center_ch_5g_20m[CENTER_CH_5G_20M_NUM] = { ++/* G00 */36, 40, ++/* G01 */44, 48, ++/* G02 */52, 56, ++/* G03 */60, 64, ++/* G04 */100, 104, ++/* G05 */108, 112, ++/* G06 */116, 120, ++/* G07 */124, 128, ++/* G08 */132, 136, ++/* G09 */140, 144, ++/* G10 */149, 153, ++/* G11 */157, 161, ++/* G12 */165, 169, ++/* G13 */173, 177 ++}; ++ ++u8 center_ch_5g_40m[CENTER_CH_5G_40M_NUM] = { ++/* G00 */38, ++/* G01 */46, ++/* G02 */54, ++/* G03 */62, ++/* G04 */102, ++/* G05 */110, ++/* G06 */118, ++/* G07 */126, ++/* G08 */134, ++/* G09 */142, ++/* G10 */151, ++/* G11 */159, ++/* G12 */167, ++/* G13 */175 ++}; ++ ++u8 center_ch_5g_20m_40m[CENTER_CH_5G_20M_NUM + CENTER_CH_5G_40M_NUM] = { ++/* G00 */36, 38, 40, ++/* G01 */44, 46, 48, ++/* G02 */52, 54, 56, ++/* G03 */60, 62, 64, ++/* G04 */100, 102, 104, ++/* G05 */108, 110, 112, ++/* G06 */116, 118, 120, ++/* G07 */124, 126, 128, ++/* G08 */132, 134, 136, ++/* G09 */140, 142, 144, ++/* G10 */149, 151, 153, ++/* G11 */157, 159, 161, ++/* G12 */165, 167, 169, ++/* G13 */173, 175, 177 ++}; ++ ++u8 op_chs_of_cch_5g_40m[CENTER_CH_5G_40M_NUM][2] = { ++ {36, 40}, /* 38 */ ++ {44, 48}, /* 46 */ ++ {52, 56}, /* 54 */ ++ {60, 64}, /* 62 */ ++ {100, 104}, /* 102 */ ++ {108, 112}, /* 110 */ ++ {116, 120}, /* 118 */ ++ {124, 128}, /* 126 */ ++ {132, 136}, /* 134 */ ++ {140, 144}, /* 142 */ ++ {149, 153}, /* 151 */ ++ {157, 161}, /* 159 */ ++ {165, 169}, /* 167 */ ++ {173, 177}, /* 175 */ ++}; ++ ++u8 center_ch_5g_80m[CENTER_CH_5G_80M_NUM] = { ++/* G00 ~ G01*/42, ++/* G02 ~ G03*/58, ++/* G04 ~ G05*/106, ++/* G06 ~ G07*/122, ++/* G08 ~ G09*/138, ++/* G10 ~ G11*/155, ++/* G12 ~ G13*/171 ++}; ++ ++u8 op_chs_of_cch_5g_80m[CENTER_CH_5G_80M_NUM][4] = { ++ {36, 40, 44, 48}, /* 42 */ ++ {52, 56, 60, 64}, /* 58 */ ++ {100, 104, 108, 112}, /* 106 */ ++ {116, 120, 124, 128}, /* 122 */ ++ {132, 136, 140, 144}, /* 138 */ ++ {149, 153, 157, 161}, /* 155 */ ++ {165, 169, 173, 177}, /* 171 */ ++}; ++ ++u8 center_ch_5g_160m[CENTER_CH_5G_160M_NUM] = { ++/* G00 ~ G03*/50, ++/* G04 ~ G07*/114, ++/* G10 ~ G13*/163 ++}; ++ ++u8 op_chs_of_cch_5g_160m[CENTER_CH_5G_160M_NUM][8] = { ++ {36, 40, 44, 48, 52, 56, 60, 64}, /* 50 */ ++ {100, 104, 108, 112, 116, 120, 124, 128}, /* 114 */ ++ {149, 153, 157, 161, 165, 169, 173, 177}, /* 163 */ ++}; ++ ++struct center_chs_ent_t { ++ u8 ch_num; ++ u8 *chs; ++}; ++ ++struct center_chs_ent_t center_chs_2g_by_bw[] = { ++ {CENTER_CH_2G_NUM, center_ch_2g}, ++ {CENTER_CH_2G_40M_NUM, center_ch_2g_40m}, ++}; ++ ++struct center_chs_ent_t center_chs_5g_by_bw[] = { ++ {CENTER_CH_5G_20M_NUM, center_ch_5g_20m}, ++ {CENTER_CH_5G_40M_NUM, center_ch_5g_40m}, ++ {CENTER_CH_5G_80M_NUM, center_ch_5g_80m}, ++ {CENTER_CH_5G_160M_NUM, center_ch_5g_160m}, ++}; ++ ++/* ++ * Get center channel of smaller bandwidth by @param cch, @param bw, @param offset ++ * @cch: the given center channel ++ * @bw: the given bandwidth ++ * @offset: the given primary SC offset of the given bandwidth ++ * ++ * return center channel of smaller bandiwdth if valid, or 0 ++ */ ++u8 rtw_get_scch_by_cch_offset(u8 cch, u8 bw, u8 offset) ++{ ++ int i; ++ u8 t_cch = 0; ++ ++ if (bw == CHANNEL_WIDTH_20) { ++ t_cch = cch; ++ goto exit; ++ } ++ ++ if (offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ /* 2.4G, 40MHz */ ++ if (cch >= 3 && cch <= 11 && bw == CHANNEL_WIDTH_40) { ++ t_cch = (offset == HAL_PRIME_CHNL_OFFSET_UPPER) ? cch + 2 : cch - 2; ++ goto exit; ++ } ++ ++ /* 5G, 160MHz */ ++ if (cch >= 50 && cch <= 163 && bw == CHANNEL_WIDTH_160) { ++ t_cch = (offset == HAL_PRIME_CHNL_OFFSET_UPPER) ? cch + 8 : cch - 8; ++ goto exit; ++ ++ /* 5G, 80MHz */ ++ } else if (cch >= 42 && cch <= 171 && bw == CHANNEL_WIDTH_80) { ++ t_cch = (offset == HAL_PRIME_CHNL_OFFSET_UPPER) ? cch + 4 : cch - 4; ++ goto exit; ++ ++ /* 5G, 40MHz */ ++ } else if (cch >= 38 && cch <= 175 && bw == CHANNEL_WIDTH_40) { ++ t_cch = (offset == HAL_PRIME_CHNL_OFFSET_UPPER) ? cch + 2 : cch - 2; ++ goto exit; ++ ++ } else { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++exit: ++ return t_cch; ++} ++ ++struct op_chs_ent_t { ++ u8 ch_num; ++ u8 *chs; ++}; ++ ++struct op_chs_ent_t op_chs_of_cch_2g_by_bw[] = { ++ {1, center_ch_2g}, ++ {2, (u8 *)op_chs_of_cch_2g_40m}, ++}; ++ ++struct op_chs_ent_t op_chs_of_cch_5g_by_bw[] = { ++ {1, center_ch_5g_20m}, ++ {2, (u8 *)op_chs_of_cch_5g_40m}, ++ {4, (u8 *)op_chs_of_cch_5g_80m}, ++ {8, (u8 *)op_chs_of_cch_5g_160m}, ++}; ++ ++inline u8 center_chs_2g_num(u8 bw) ++{ ++ if (bw > CHANNEL_WIDTH_40) ++ return 0; ++ ++ return center_chs_2g_by_bw[bw].ch_num; ++} ++ ++inline u8 center_chs_2g(u8 bw, u8 id) ++{ ++ if (bw > CHANNEL_WIDTH_40) ++ return 0; ++ ++ if (id >= center_chs_2g_num(bw)) ++ return 0; ++ ++ return center_chs_2g_by_bw[bw].chs[id]; ++} ++ ++inline u8 center_chs_5g_num(u8 bw) ++{ ++ if (bw > CHANNEL_WIDTH_80) ++ return 0; ++ ++ return center_chs_5g_by_bw[bw].ch_num; ++} ++ ++inline u8 center_chs_5g(u8 bw, u8 id) ++{ ++ if (bw > CHANNEL_WIDTH_80) ++ return 0; ++ ++ if (id >= center_chs_5g_num(bw)) ++ return 0; ++ ++ return center_chs_5g_by_bw[bw].chs[id]; ++} ++ ++/* ++ * Get available op channels by @param cch, @param bw ++ * @cch: the given center channel ++ * @bw: the given bandwidth ++ * @op_chs: the pointer to return pointer of op channel array ++ * @op_ch_num: the pointer to return pointer of op channel number ++ * ++ * return valid (1) or not (0) ++ */ ++u8 rtw_get_op_chs_by_cch_bw(u8 cch, u8 bw, u8 **op_chs, u8 *op_ch_num) ++{ ++ int i; ++ struct center_chs_ent_t *c_chs_ent = NULL; ++ struct op_chs_ent_t *op_chs_ent = NULL; ++ u8 valid = 1; ++ ++ if (cch <= 14 ++ && bw >= CHANNEL_WIDTH_20 && bw <= CHANNEL_WIDTH_40 ++ ) { ++ c_chs_ent = ¢er_chs_2g_by_bw[bw]; ++ op_chs_ent = &op_chs_of_cch_2g_by_bw[bw]; ++ } else if (cch >= 36 && cch <= 177 ++ && bw >= CHANNEL_WIDTH_20 && bw <= CHANNEL_WIDTH_160 ++ ) { ++ c_chs_ent = ¢er_chs_5g_by_bw[bw]; ++ op_chs_ent = &op_chs_of_cch_5g_by_bw[bw]; ++ } else { ++ valid = 0; ++ goto exit; ++ } ++ ++ for (i = 0; i < c_chs_ent->ch_num; i++) ++ if (cch == *(c_chs_ent->chs + i)) ++ break; ++ ++ if (i == c_chs_ent->ch_num) { ++ valid = 0; ++ goto exit; ++ } ++ ++ *op_chs = op_chs_ent->chs + op_chs_ent->ch_num * i; ++ *op_ch_num = op_chs_ent->ch_num; ++ ++exit: ++ return valid; ++} ++ ++u8 rtw_get_ch_group(u8 ch, u8 *group, u8 *cck_group) ++{ ++ BAND_TYPE band = BAND_MAX; ++ s8 gp = -1, cck_gp = -1; ++ ++ if (ch <= 14) { ++ band = BAND_ON_2_4G; ++ ++ if (1 <= ch && ch <= 2) ++ gp = 0; ++ else if (3 <= ch && ch <= 5) ++ gp = 1; ++ else if (6 <= ch && ch <= 8) ++ gp = 2; ++ else if (9 <= ch && ch <= 11) ++ gp = 3; ++ else if (12 <= ch && ch <= 14) ++ gp = 4; ++ else ++ band = BAND_MAX; ++ ++ if (ch == 14) ++ cck_gp = 5; ++ else ++ cck_gp = gp; ++ } else { ++ band = BAND_ON_5G; ++ ++ if (36 <= ch && ch <= 42) ++ gp = 0; ++ else if (44 <= ch && ch <= 48) ++ gp = 1; ++ else if (50 <= ch && ch <= 58) ++ gp = 2; ++ else if (60 <= ch && ch <= 64) ++ gp = 3; ++ else if (100 <= ch && ch <= 106) ++ gp = 4; ++ else if (108 <= ch && ch <= 114) ++ gp = 5; ++ else if (116 <= ch && ch <= 122) ++ gp = 6; ++ else if (124 <= ch && ch <= 130) ++ gp = 7; ++ else if (132 <= ch && ch <= 138) ++ gp = 8; ++ else if (140 <= ch && ch <= 144) ++ gp = 9; ++ else if (149 <= ch && ch <= 155) ++ gp = 10; ++ else if (157 <= ch && ch <= 161) ++ gp = 11; ++ else if (165 <= ch && ch <= 171) ++ gp = 12; ++ else if (173 <= ch && ch <= 177) ++ gp = 13; ++ else ++ band = BAND_MAX; ++ } ++ ++ if (band == BAND_MAX ++ || (band == BAND_ON_2_4G && cck_gp == -1) ++ || gp == -1 ++ ) { ++ RTW_WARN("%s invalid channel:%u", __func__, ch); ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (group) ++ *group = gp; ++ if (cck_group && band == BAND_ON_2_4G) ++ *cck_group = cck_gp; ++ ++exit: ++ return band; ++} ++ ++int rtw_ch2freq(int chan) ++{ ++ /* see 802.11 17.3.8.3.2 and Annex J ++ * there are overlapping channel numbers in 5GHz and 2GHz bands */ ++ ++ /* ++ * RTK: don't consider the overlapping channel numbers: 5G channel <= 14, ++ * because we don't support it. simply judge from channel number ++ */ ++ ++ if (chan >= 1 && chan <= 14) { ++ if (chan == 14) ++ return 2484; ++ else if (chan < 14) ++ return 2407 + chan * 5; ++ } else if (chan >= 36 && chan <= 177) ++ return 5000 + chan * 5; ++ ++ return 0; /* not supported */ ++} ++ ++int rtw_freq2ch(int freq) ++{ ++ /* see 802.11 17.3.8.3.2 and Annex J */ ++ if (freq == 2484) ++ return 14; ++ else if (freq < 2484) ++ return (freq - 2407) / 5; ++ else if (freq >= 4910 && freq <= 4980) ++ return (freq - 4000) / 5; ++ else if (freq <= 45000) /* DMG band lower limit */ ++ return (freq - 5000) / 5; ++ else if (freq >= 58320 && freq <= 64800) ++ return (freq - 56160) / 2160; ++ else ++ return 0; ++} ++ ++bool rtw_chbw_to_freq_range(u8 ch, u8 bw, u8 offset, u32 *hi, u32 *lo) ++{ ++ u8 c_ch; ++ u32 freq; ++ u32 hi_ret = 0, lo_ret = 0; ++ int i; ++ bool valid = _FALSE; ++ ++ if (hi) ++ *hi = 0; ++ if (lo) ++ *lo = 0; ++ ++ c_ch = rtw_get_center_ch(ch, bw, offset); ++ freq = rtw_ch2freq(c_ch); ++ ++ if (!freq) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (bw == CHANNEL_WIDTH_80) { ++ hi_ret = freq + 40; ++ lo_ret = freq - 40; ++ } else if (bw == CHANNEL_WIDTH_40) { ++ hi_ret = freq + 20; ++ lo_ret = freq - 20; ++ } else if (bw == CHANNEL_WIDTH_20) { ++ hi_ret = freq + 10; ++ lo_ret = freq - 10; ++ } else ++ rtw_warn_on(1); ++ ++ if (hi) ++ *hi = hi_ret; ++ if (lo) ++ *lo = lo_ret; ++ ++ valid = _TRUE; ++ ++exit: ++ return valid; ++} ++ ++const char *const _ch_width_str[] = { ++ "20MHz", ++ "40MHz", ++ "80MHz", ++ "160MHz", ++ "80_80MHz", ++ "CHANNEL_WIDTH_MAX", ++}; ++ ++const u8 _ch_width_to_bw_cap[] = { ++ BW_CAP_20M, ++ BW_CAP_40M, ++ BW_CAP_80M, ++ BW_CAP_160M, ++ BW_CAP_80_80M, ++ 0, ++}; ++ ++const char *const _band_str[] = { ++ "2.4G", ++ "5G", ++ "BOTH", ++ "BAND_MAX", ++}; ++ ++const u8 _band_to_band_cap[] = { ++ BAND_CAP_2G, ++ BAND_CAP_5G, ++ 0, ++ 0, ++}; ++ ++#ifdef CONFIG_80211AC_VHT ++#define COUNTRY_CHPLAN_ASSIGN_EN_11AC(_val) , .en_11ac = (_val) ++#else ++#define COUNTRY_CHPLAN_ASSIGN_EN_11AC(_val) ++#endif ++ ++#if RTW_DEF_MODULE_REGULATORY_CERT ++#define COUNTRY_CHPLAN_ASSIGN_DEF_MODULE_FLAGS(_val) , .def_module_flags = (_val) ++#else ++#define COUNTRY_CHPLAN_ASSIGN_DEF_MODULE_FLAGS(_val) ++#endif ++ ++/* has def_module_flags specified, used by common map and HAL dfference map */ ++#define COUNTRY_CHPLAN_ENT(_alpha2, _chplan, _en_11ac, _def_module_flags) \ ++ {.alpha2 = (_alpha2), .chplan = (_chplan) \ ++ COUNTRY_CHPLAN_ASSIGN_EN_11AC(_en_11ac) \ ++ COUNTRY_CHPLAN_ASSIGN_DEF_MODULE_FLAGS(_def_module_flags) \ ++ } ++ ++#ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP ++ ++#include "../platform/custom_country_chplan.h" ++ ++#elif RTW_DEF_MODULE_REGULATORY_CERT ++ ++#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8821AE_HMC_M2) ++static const struct country_chplan RTL8821AE_HMC_M2_country_chplan_map[] = { ++ COUNTRY_CHPLAN_ENT("CN", 0x51, 1, 0xFB), /* China */ ++ COUNTRY_CHPLAN_ENT("RU", 0x59, 0, 0xFB), /* Russia(fac/gost), Kaliningrad */ ++ COUNTRY_CHPLAN_ENT("UA", 0x26, 0, 0xFB), /* Ukraine */ ++}; ++static const u16 RTL8821AE_HMC_M2_country_chplan_map_sz = sizeof(RTL8821AE_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); ++#endif ++ ++#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8821AU) ++static const struct country_chplan RTL8821AU_country_chplan_map[] = { ++ COUNTRY_CHPLAN_ENT("RU", 0x59, 0, 0xFB), /* Russia(fac/gost), Kaliningrad */ ++ COUNTRY_CHPLAN_ENT("UA", 0x26, 0, 0xFB), /* Ukraine */ ++}; ++static const u16 RTL8821AU_country_chplan_map_sz = sizeof(RTL8821AU_country_chplan_map) / sizeof(struct country_chplan); ++#endif ++ ++#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8812AENF_NGFF) ++static const struct country_chplan RTL8812AENF_NGFF_country_chplan_map[] = { ++}; ++static const u16 RTL8812AENF_NGFF_country_chplan_map_sz = sizeof(RTL8812AENF_NGFF_country_chplan_map) / sizeof(struct country_chplan); ++#endif ++ ++#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8812AEBT_HMC) ++static const struct country_chplan RTL8812AEBT_HMC_country_chplan_map[] = { ++}; ++static const u16 RTL8812AEBT_HMC_country_chplan_map_sz = sizeof(RTL8812AEBT_HMC_country_chplan_map) / sizeof(struct country_chplan); ++#endif ++ ++#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8188EE_HMC_M2) ++static const struct country_chplan RTL8188EE_HMC_M2_country_chplan_map[] = { ++}; ++static const u16 RTL8188EE_HMC_M2_country_chplan_map_sz = sizeof(RTL8188EE_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); ++#endif ++ ++#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8723BE_HMC_M2) ++static const struct country_chplan RTL8723BE_HMC_M2_country_chplan_map[] = { ++}; ++static const u16 RTL8723BE_HMC_M2_country_chplan_map_sz = sizeof(RTL8723BE_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); ++#endif ++ ++#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8723BS_NGFF1216) ++static const struct country_chplan RTL8723BS_NGFF1216_country_chplan_map[] = { ++}; ++static const u16 RTL8723BS_NGFF1216_country_chplan_map_sz = sizeof(RTL8723BS_NGFF1216_country_chplan_map) / sizeof(struct country_chplan); ++#endif ++ ++#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8192EEBT_HMC_M2) ++static const struct country_chplan RTL8192EEBT_HMC_M2_country_chplan_map[] = { ++}; ++static const u16 RTL8192EEBT_HMC_M2_country_chplan_map_sz = sizeof(RTL8192EEBT_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); ++#endif ++ ++/** ++ * rtw_def_module_get_chplan_from_country - ++ * @country_code: string of country code ++ * @return: ++ * Return NULL for case referring to common map ++ */ ++static const struct country_chplan *rtw_def_module_get_chplan_from_country(const char *country_code) ++{ ++ const struct country_chplan *ent = NULL; ++ const struct country_chplan *hal_map = NULL; ++ u16 hal_map_sz = 0; ++ int i; ++ ++ /* TODO: runtime selection for multi driver */ ++#if (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8821AE_HMC_M2) ++ hal_map = RTL8821AE_HMC_M2_country_chplan_map; ++ hal_map_sz = RTL8821AE_HMC_M2_country_chplan_map_sz; ++#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8821AU) ++ hal_map = RTL8821AU_country_chplan_map; ++ hal_map_sz = RTL8821AU_country_chplan_map_sz; ++#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8812AENF_NGFF) ++ hal_map = RTL8812AENF_NGFF_country_chplan_map; ++ hal_map_sz = RTL8812AENF_NGFF_country_chplan_map_sz; ++#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8812AEBT_HMC) ++ hal_map = RTL8812AEBT_HMC_country_chplan_map; ++ hal_map_sz = RTL8812AEBT_HMC_country_chplan_map_sz; ++#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8188EE_HMC_M2) ++ hal_map = RTL8188EE_HMC_M2_country_chplan_map; ++ hal_map_sz = RTL8188EE_HMC_M2_country_chplan_map_sz; ++#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8723BE_HMC_M2) ++ hal_map = RTL8723BE_HMC_M2_country_chplan_map; ++ hal_map_sz = RTL8723BE_HMC_M2_country_chplan_map_sz; ++#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8723BS_NGFF1216) ++ hal_map = RTL8723BS_NGFF1216_country_chplan_map; ++ hal_map_sz = RTL8723BS_NGFF1216_country_chplan_map_sz; ++#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8192EEBT_HMC_M2) ++ hal_map = RTL8192EEBT_HMC_M2_country_chplan_map; ++ hal_map_sz = RTL8192EEBT_HMC_M2_country_chplan_map_sz; ++#endif ++ ++ if (hal_map == NULL || hal_map_sz == 0) ++ goto exit; ++ ++ for (i = 0; i < hal_map_sz; i++) { ++ if (strncmp(country_code, hal_map[i].alpha2, 2) == 0) { ++ ent = &hal_map[i]; ++ break; ++ } ++ } ++ ++exit: ++ return ent; ++} ++#endif /* CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP or RTW_DEF_MODULE_REGULATORY_CERT */ ++ ++static const struct country_chplan country_chplan_map[] = { ++ COUNTRY_CHPLAN_ENT("AD", 0x26, 1, 0x00), /* Andorra */ ++ COUNTRY_CHPLAN_ENT("AE", 0x26, 1, 0xFB), /* United Arab Emirates */ ++ COUNTRY_CHPLAN_ENT("AF", 0x42, 1, 0x00), /* Afghanistan */ ++ COUNTRY_CHPLAN_ENT("AG", 0x30, 1, 0x00), /* Antigua & Barbuda */ ++ COUNTRY_CHPLAN_ENT("AI", 0x26, 1, 0x00), /* Anguilla(UK) */ ++ COUNTRY_CHPLAN_ENT("AL", 0x26, 1, 0xF1), /* Albania */ ++ COUNTRY_CHPLAN_ENT("AM", 0x26, 1, 0xB0), /* Armenia */ ++ COUNTRY_CHPLAN_ENT("AO", 0x26, 1, 0xE0), /* Angola */ ++ COUNTRY_CHPLAN_ENT("AQ", 0x26, 1, 0x00), /* Antarctica */ ++ COUNTRY_CHPLAN_ENT("AR", 0x57, 1, 0xF3), /* Argentina */ ++ COUNTRY_CHPLAN_ENT("AS", 0x34, 1, 0x00), /* American Samoa */ ++ COUNTRY_CHPLAN_ENT("AT", 0x26, 1, 0xFB), /* Austria */ ++ COUNTRY_CHPLAN_ENT("AU", 0x45, 1, 0xFB), /* Australia */ ++ COUNTRY_CHPLAN_ENT("AW", 0x34, 1, 0xB0), /* Aruba */ ++ COUNTRY_CHPLAN_ENT("AZ", 0x26, 1, 0xF1), /* Azerbaijan */ ++ COUNTRY_CHPLAN_ENT("BA", 0x26, 1, 0xF1), /* Bosnia & Herzegovina */ ++ COUNTRY_CHPLAN_ENT("BB", 0x34, 1, 0x50), /* Barbados */ ++ COUNTRY_CHPLAN_ENT("BD", 0x26, 1, 0xF1), /* Bangladesh */ ++ COUNTRY_CHPLAN_ENT("BE", 0x26, 1, 0xFB), /* Belgium */ ++ COUNTRY_CHPLAN_ENT("BF", 0x26, 1, 0xB0), /* Burkina Faso */ ++ COUNTRY_CHPLAN_ENT("BG", 0x26, 1, 0xF1), /* Bulgaria */ ++ COUNTRY_CHPLAN_ENT("BH", 0x47, 1, 0xF1), /* Bahrain */ ++ COUNTRY_CHPLAN_ENT("BI", 0x26, 1, 0xB0), /* Burundi */ ++ COUNTRY_CHPLAN_ENT("BJ", 0x26, 1, 0xB0), /* Benin */ ++ COUNTRY_CHPLAN_ENT("BN", 0x47, 1, 0x10), /* Brunei */ ++ COUNTRY_CHPLAN_ENT("BO", 0x30, 1, 0xF1), /* Bolivia */ ++ COUNTRY_CHPLAN_ENT("BR", 0x34, 1, 0xF1), /* Brazil */ ++ COUNTRY_CHPLAN_ENT("BS", 0x34, 1, 0x20), /* Bahamas */ ++ COUNTRY_CHPLAN_ENT("BW", 0x26, 1, 0xF1), /* Botswana */ ++ COUNTRY_CHPLAN_ENT("BY", 0x26, 1, 0xF1), /* Belarus */ ++ COUNTRY_CHPLAN_ENT("BZ", 0x34, 1, 0x00), /* Belize */ ++ COUNTRY_CHPLAN_ENT("CA", 0x34, 1, 0xFB), /* Canada */ ++ COUNTRY_CHPLAN_ENT("CC", 0x26, 1, 0x00), /* Cocos (Keeling) Islands (Australia) */ ++ COUNTRY_CHPLAN_ENT("CD", 0x26, 1, 0xB0), /* Congo, Republic of the */ ++ COUNTRY_CHPLAN_ENT("CF", 0x26, 1, 0xB0), /* Central African Republic */ ++ COUNTRY_CHPLAN_ENT("CG", 0x26, 1, 0xB0), /* Congo, Democratic Republic of the. Zaire */ ++ COUNTRY_CHPLAN_ENT("CH", 0x26, 1, 0xFB), /* Switzerland */ ++ COUNTRY_CHPLAN_ENT("CI", 0x26, 1, 0xF1), /* Cote d'Ivoire */ ++ COUNTRY_CHPLAN_ENT("CK", 0x26, 1, 0x00), /* Cook Islands */ ++ COUNTRY_CHPLAN_ENT("CL", 0x30, 1, 0xF1), /* Chile */ ++ COUNTRY_CHPLAN_ENT("CM", 0x26, 1, 0xB0), /* Cameroon */ ++ COUNTRY_CHPLAN_ENT("CN", 0x48, 1, 0xFB), /* China */ ++ COUNTRY_CHPLAN_ENT("CO", 0x34, 1, 0xF1), /* Colombia */ ++ COUNTRY_CHPLAN_ENT("CR", 0x34, 1, 0xF1), /* Costa Rica */ ++ COUNTRY_CHPLAN_ENT("CV", 0x26, 1, 0xB0), /* Cape Verde */ ++ COUNTRY_CHPLAN_ENT("CX", 0x45, 1, 0x00), /* Christmas Island (Australia) */ ++ COUNTRY_CHPLAN_ENT("CY", 0x26, 1, 0xFB), /* Cyprus */ ++ COUNTRY_CHPLAN_ENT("CZ", 0x26, 1, 0xFB), /* Czech Republic */ ++ COUNTRY_CHPLAN_ENT("DE", 0x26, 1, 0xFB), /* Germany */ ++ COUNTRY_CHPLAN_ENT("DJ", 0x26, 1, 0x80), /* Djibouti */ ++ COUNTRY_CHPLAN_ENT("DK", 0x26, 1, 0xFB), /* Denmark */ ++ COUNTRY_CHPLAN_ENT("DM", 0x34, 1, 0x00), /* Dominica */ ++ COUNTRY_CHPLAN_ENT("DO", 0x34, 1, 0xF1), /* Dominican Republic */ ++ COUNTRY_CHPLAN_ENT("DZ", 0x26, 1, 0xF1), /* Algeria */ ++ COUNTRY_CHPLAN_ENT("EC", 0x34, 1, 0xF1), /* Ecuador */ ++ COUNTRY_CHPLAN_ENT("EE", 0x26, 1, 0xFB), /* Estonia */ ++ COUNTRY_CHPLAN_ENT("EG", 0x47, 0, 0xF1), /* Egypt */ ++ COUNTRY_CHPLAN_ENT("EH", 0x47, 1, 0x80), /* Western Sahara */ ++ COUNTRY_CHPLAN_ENT("ER", 0x26, 1, 0x00), /* Eritrea */ ++ COUNTRY_CHPLAN_ENT("ES", 0x26, 1, 0xFB), /* Spain, Canary Islands, Ceuta, Melilla */ ++ COUNTRY_CHPLAN_ENT("ET", 0x26, 1, 0xB0), /* Ethiopia */ ++ COUNTRY_CHPLAN_ENT("FI", 0x26, 1, 0xFB), /* Finland */ ++ COUNTRY_CHPLAN_ENT("FJ", 0x34, 1, 0x00), /* Fiji */ ++ COUNTRY_CHPLAN_ENT("FK", 0x26, 1, 0x00), /* Falkland Islands (Islas Malvinas) (UK) */ ++ COUNTRY_CHPLAN_ENT("FM", 0x34, 1, 0x00), /* Micronesia, Federated States of (USA) */ ++ COUNTRY_CHPLAN_ENT("FO", 0x26, 1, 0x00), /* Faroe Islands (Denmark) */ ++ COUNTRY_CHPLAN_ENT("FR", 0x26, 1, 0xFB), /* France */ ++ COUNTRY_CHPLAN_ENT("GA", 0x26, 1, 0xB0), /* Gabon */ ++ COUNTRY_CHPLAN_ENT("GB", 0x26, 1, 0xFB), /* Great Britain (United Kingdom; England) */ ++ COUNTRY_CHPLAN_ENT("GD", 0x34, 1, 0xB0), /* Grenada */ ++ COUNTRY_CHPLAN_ENT("GE", 0x26, 1, 0x00), /* Georgia */ ++ COUNTRY_CHPLAN_ENT("GF", 0x26, 1, 0x80), /* French Guiana */ ++ COUNTRY_CHPLAN_ENT("GG", 0x26, 1, 0x00), /* Guernsey (UK) */ ++ COUNTRY_CHPLAN_ENT("GH", 0x26, 1, 0xF1), /* Ghana */ ++ COUNTRY_CHPLAN_ENT("GI", 0x26, 1, 0x00), /* Gibraltar (UK) */ ++ COUNTRY_CHPLAN_ENT("GL", 0x26, 1, 0x00), /* Greenland (Denmark) */ ++ COUNTRY_CHPLAN_ENT("GM", 0x26, 1, 0xB0), /* Gambia */ ++ COUNTRY_CHPLAN_ENT("GN", 0x26, 1, 0x10), /* Guinea */ ++ COUNTRY_CHPLAN_ENT("GP", 0x26, 1, 0x00), /* Guadeloupe (France) */ ++ COUNTRY_CHPLAN_ENT("GQ", 0x26, 1, 0xB0), /* Equatorial Guinea */ ++ COUNTRY_CHPLAN_ENT("GR", 0x26, 1, 0xFB), /* Greece */ ++ COUNTRY_CHPLAN_ENT("GS", 0x26, 1, 0x00), /* South Georgia and the Sandwich Islands (UK) */ ++ COUNTRY_CHPLAN_ENT("GT", 0x34, 1, 0xF1), /* Guatemala */ ++ COUNTRY_CHPLAN_ENT("GU", 0x34, 1, 0x00), /* Guam (USA) */ ++ COUNTRY_CHPLAN_ENT("GW", 0x26, 1, 0xB0), /* Guinea-Bissau */ ++ COUNTRY_CHPLAN_ENT("GY", 0x44, 1, 0x00), /* Guyana */ ++ COUNTRY_CHPLAN_ENT("HK", 0x26, 1, 0xFB), /* Hong Kong */ ++ COUNTRY_CHPLAN_ENT("HM", 0x45, 1, 0x00), /* Heard and McDonald Islands (Australia) */ ++ COUNTRY_CHPLAN_ENT("HN", 0x32, 1, 0xF1), /* Honduras */ ++ COUNTRY_CHPLAN_ENT("HR", 0x26, 1, 0xF9), /* Croatia */ ++ COUNTRY_CHPLAN_ENT("HT", 0x34, 1, 0x50), /* Haiti */ ++ COUNTRY_CHPLAN_ENT("HU", 0x26, 1, 0xFB), /* Hungary */ ++ COUNTRY_CHPLAN_ENT("ID", 0x54, 0, 0xF3), /* Indonesia */ ++ COUNTRY_CHPLAN_ENT("IE", 0x26, 1, 0xFB), /* Ireland */ ++ COUNTRY_CHPLAN_ENT("IL", 0x47, 1, 0xF1), /* Israel */ ++ COUNTRY_CHPLAN_ENT("IM", 0x26, 1, 0x00), /* Isle of Man (UK) */ ++ COUNTRY_CHPLAN_ENT("IN", 0x47, 1, 0xF1), /* India */ ++ COUNTRY_CHPLAN_ENT("IQ", 0x26, 1, 0x00), /* Iraq */ ++ COUNTRY_CHPLAN_ENT("IR", 0x26, 0, 0x00), /* Iran */ ++ COUNTRY_CHPLAN_ENT("IS", 0x26, 1, 0xFB), /* Iceland */ ++ COUNTRY_CHPLAN_ENT("IT", 0x26, 1, 0xFB), /* Italy */ ++ COUNTRY_CHPLAN_ENT("JE", 0x26, 1, 0x00), /* Jersey (UK) */ ++ COUNTRY_CHPLAN_ENT("JM", 0x51, 1, 0xF1), /* Jamaica */ ++ COUNTRY_CHPLAN_ENT("JO", 0x49, 1, 0xFB), /* Jordan */ ++ COUNTRY_CHPLAN_ENT("JP", 0x27, 1, 0xFF), /* Japan- Telec */ ++ COUNTRY_CHPLAN_ENT("KE", 0x47, 1, 0xF9), /* Kenya */ ++ COUNTRY_CHPLAN_ENT("KG", 0x26, 1, 0xF1), /* Kyrgyzstan */ ++ COUNTRY_CHPLAN_ENT("KH", 0x26, 1, 0xF1), /* Cambodia */ ++ COUNTRY_CHPLAN_ENT("KI", 0x26, 1, 0x00), /* Kiribati */ ++ COUNTRY_CHPLAN_ENT("KN", 0x34, 1, 0x00), /* Saint Kitts and Nevis */ ++ COUNTRY_CHPLAN_ENT("KR", 0x28, 1, 0xFB), /* South Korea */ ++ COUNTRY_CHPLAN_ENT("KW", 0x47, 1, 0xFB), /* Kuwait */ ++ COUNTRY_CHPLAN_ENT("KY", 0x34, 1, 0x00), /* Cayman Islands (UK) */ ++ COUNTRY_CHPLAN_ENT("KZ", 0x26, 1, 0x00), /* Kazakhstan */ ++ COUNTRY_CHPLAN_ENT("LA", 0x26, 1, 0x00), /* Laos */ ++ COUNTRY_CHPLAN_ENT("LB", 0x26, 1, 0xF1), /* Lebanon */ ++ COUNTRY_CHPLAN_ENT("LC", 0x34, 1, 0x00), /* Saint Lucia */ ++ COUNTRY_CHPLAN_ENT("LI", 0x26, 1, 0xFB), /* Liechtenstein */ ++ COUNTRY_CHPLAN_ENT("LK", 0x26, 1, 0xF1), /* Sri Lanka */ ++ COUNTRY_CHPLAN_ENT("LR", 0x26, 1, 0xB0), /* Liberia */ ++ COUNTRY_CHPLAN_ENT("LS", 0x26, 1, 0xF1), /* Lesotho */ ++ COUNTRY_CHPLAN_ENT("LT", 0x26, 1, 0xFB), /* Lithuania */ ++ COUNTRY_CHPLAN_ENT("LU", 0x26, 1, 0xFB), /* Luxembourg */ ++ COUNTRY_CHPLAN_ENT("LV", 0x26, 1, 0xFB), /* Latvia */ ++ COUNTRY_CHPLAN_ENT("LY", 0x26, 1, 0x00), /* Libya */ ++ COUNTRY_CHPLAN_ENT("MA", 0x47, 1, 0xF1), /* Morocco */ ++ COUNTRY_CHPLAN_ENT("MC", 0x26, 1, 0xFB), /* Monaco */ ++ COUNTRY_CHPLAN_ENT("MD", 0x26, 1, 0xF1), /* Moldova */ ++ COUNTRY_CHPLAN_ENT("ME", 0x26, 1, 0xF1), /* Montenegro */ ++ COUNTRY_CHPLAN_ENT("MF", 0x34, 1, 0x00), /* Saint Martin */ ++ COUNTRY_CHPLAN_ENT("MG", 0x26, 1, 0x20), /* Madagascar */ ++ COUNTRY_CHPLAN_ENT("MH", 0x34, 1, 0x00), /* Marshall Islands (USA) */ ++ COUNTRY_CHPLAN_ENT("MK", 0x26, 1, 0xF1), /* Republic of Macedonia (FYROM) */ ++ COUNTRY_CHPLAN_ENT("ML", 0x26, 1, 0xB0), /* Mali */ ++ COUNTRY_CHPLAN_ENT("MM", 0x26, 1, 0x00), /* Burma (Myanmar) */ ++ COUNTRY_CHPLAN_ENT("MN", 0x26, 1, 0x00), /* Mongolia */ ++ COUNTRY_CHPLAN_ENT("MO", 0x26, 1, 0x00), /* Macau */ ++ COUNTRY_CHPLAN_ENT("MP", 0x34, 1, 0x00), /* Northern Mariana Islands (USA) */ ++ COUNTRY_CHPLAN_ENT("MQ", 0x26, 1, 0x40), /* Martinique (France) */ ++ COUNTRY_CHPLAN_ENT("MR", 0x26, 1, 0xA0), /* Mauritania */ ++ COUNTRY_CHPLAN_ENT("MS", 0x26, 1, 0x00), /* Montserrat (UK) */ ++ COUNTRY_CHPLAN_ENT("MT", 0x26, 1, 0xFB), /* Malta */ ++ COUNTRY_CHPLAN_ENT("MU", 0x26, 1, 0xB0), /* Mauritius */ ++ COUNTRY_CHPLAN_ENT("MV", 0x26, 1, 0x00), /* Maldives */ ++ COUNTRY_CHPLAN_ENT("MW", 0x26, 1, 0xB0), /* Malawi */ ++ COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0xF1), /* Mexico */ ++ COUNTRY_CHPLAN_ENT("MY", 0x47, 1, 0xF1), /* Malaysia */ ++ COUNTRY_CHPLAN_ENT("MZ", 0x26, 1, 0xF1), /* Mozambique */ ++ COUNTRY_CHPLAN_ENT("NA", 0x26, 0, 0x00), /* Namibia */ ++ COUNTRY_CHPLAN_ENT("NC", 0x26, 1, 0x00), /* New Caledonia */ ++ COUNTRY_CHPLAN_ENT("NE", 0x26, 1, 0xB0), /* Niger */ ++ COUNTRY_CHPLAN_ENT("NF", 0x45, 1, 0x00), /* Norfolk Island (Australia) */ ++ COUNTRY_CHPLAN_ENT("NG", 0x50, 1, 0xF9), /* Nigeria */ ++ COUNTRY_CHPLAN_ENT("NI", 0x34, 1, 0xF1), /* Nicaragua */ ++ COUNTRY_CHPLAN_ENT("NL", 0x26, 1, 0xFB), /* Netherlands */ ++ COUNTRY_CHPLAN_ENT("NO", 0x26, 1, 0xFB), /* Norway */ ++ COUNTRY_CHPLAN_ENT("NP", 0x47, 1, 0xF0), /* Nepal */ ++ COUNTRY_CHPLAN_ENT("NR", 0x26, 1, 0x00), /* Nauru */ ++ COUNTRY_CHPLAN_ENT("NU", 0x45, 1, 0x00), /* Niue */ ++ COUNTRY_CHPLAN_ENT("NZ", 0x45, 1, 0xFB), /* New Zealand */ ++ COUNTRY_CHPLAN_ENT("OM", 0x26, 1, 0xF9), /* Oman */ ++ COUNTRY_CHPLAN_ENT("PA", 0x34, 1, 0xF1), /* Panama */ ++ COUNTRY_CHPLAN_ENT("PE", 0x34, 1, 0xF1), /* Peru */ ++ COUNTRY_CHPLAN_ENT("PF", 0x26, 1, 0x00), /* French Polynesia (France) */ ++ COUNTRY_CHPLAN_ENT("PG", 0x26, 1, 0xF1), /* Papua New Guinea */ ++ COUNTRY_CHPLAN_ENT("PH", 0x26, 1, 0xF1), /* Philippines */ ++ COUNTRY_CHPLAN_ENT("PK", 0x51, 1, 0xF1), /* Pakistan */ ++ COUNTRY_CHPLAN_ENT("PL", 0x26, 1, 0xFB), /* Poland */ ++ COUNTRY_CHPLAN_ENT("PM", 0x26, 1, 0x00), /* Saint Pierre and Miquelon (France) */ ++ COUNTRY_CHPLAN_ENT("PR", 0x34, 1, 0xF1), /* Puerto Rico */ ++ COUNTRY_CHPLAN_ENT("PT", 0x26, 1, 0xFB), /* Portugal */ ++ COUNTRY_CHPLAN_ENT("PW", 0x34, 1, 0x00), /* Palau */ ++ COUNTRY_CHPLAN_ENT("PY", 0x34, 1, 0xF1), /* Paraguay */ ++ COUNTRY_CHPLAN_ENT("QA", 0x51, 1, 0xF9), /* Qatar */ ++ COUNTRY_CHPLAN_ENT("RE", 0x26, 1, 0x00), /* Reunion (France) */ ++ COUNTRY_CHPLAN_ENT("RO", 0x26, 1, 0xF1), /* Romania */ ++ COUNTRY_CHPLAN_ENT("RS", 0x26, 1, 0xF1), /* Serbia, Kosovo */ ++ COUNTRY_CHPLAN_ENT("RU", 0x59, 1, 0xFB), /* Russia(fac/gost), Kaliningrad */ ++ COUNTRY_CHPLAN_ENT("RW", 0x26, 1, 0xB0), /* Rwanda */ ++ COUNTRY_CHPLAN_ENT("SA", 0x26, 1, 0xFB), /* Saudi Arabia */ ++ COUNTRY_CHPLAN_ENT("SB", 0x26, 1, 0x00), /* Solomon Islands */ ++ COUNTRY_CHPLAN_ENT("SC", 0x34, 1, 0x90), /* Seychelles */ ++ COUNTRY_CHPLAN_ENT("SE", 0x26, 1, 0xFB), /* Sweden */ ++ COUNTRY_CHPLAN_ENT("SG", 0x47, 1, 0xFB), /* Singapore */ ++ COUNTRY_CHPLAN_ENT("SH", 0x26, 1, 0x00), /* Saint Helena (UK) */ ++ COUNTRY_CHPLAN_ENT("SI", 0x26, 1, 0xFB), /* Slovenia */ ++ COUNTRY_CHPLAN_ENT("SJ", 0x26, 1, 0x00), /* Svalbard (Norway) */ ++ COUNTRY_CHPLAN_ENT("SK", 0x26, 1, 0xFB), /* Slovakia */ ++ COUNTRY_CHPLAN_ENT("SL", 0x26, 1, 0xB0), /* Sierra Leone */ ++ COUNTRY_CHPLAN_ENT("SM", 0x26, 1, 0x00), /* San Marino */ ++ COUNTRY_CHPLAN_ENT("SN", 0x26, 1, 0xF1), /* Senegal */ ++ COUNTRY_CHPLAN_ENT("SO", 0x26, 1, 0x00), /* Somalia */ ++ COUNTRY_CHPLAN_ENT("SR", 0x34, 1, 0x00), /* Suriname */ ++ COUNTRY_CHPLAN_ENT("ST", 0x34, 1, 0x80), /* Sao Tome and Principe */ ++ COUNTRY_CHPLAN_ENT("SV", 0x30, 1, 0xF1), /* El Salvador */ ++ COUNTRY_CHPLAN_ENT("SX", 0x34, 1, 0x00), /* Sint Marteen */ ++ COUNTRY_CHPLAN_ENT("SZ", 0x26, 1, 0x20), /* Swaziland */ ++ COUNTRY_CHPLAN_ENT("TC", 0x26, 1, 0x00), /* Turks and Caicos Islands (UK) */ ++ COUNTRY_CHPLAN_ENT("TD", 0x26, 1, 0xB0), /* Chad */ ++ COUNTRY_CHPLAN_ENT("TF", 0x26, 1, 0x80), /* French Southern and Antarctic Lands (FR Southern Territories) */ ++ COUNTRY_CHPLAN_ENT("TG", 0x26, 1, 0xB0), /* Togo */ ++ COUNTRY_CHPLAN_ENT("TH", 0x26, 1, 0xF1), /* Thailand */ ++ COUNTRY_CHPLAN_ENT("TJ", 0x26, 1, 0x40), /* Tajikistan */ ++ COUNTRY_CHPLAN_ENT("TK", 0x45, 1, 0x00), /* Tokelau */ ++ COUNTRY_CHPLAN_ENT("TM", 0x26, 1, 0x00), /* Turkmenistan */ ++ COUNTRY_CHPLAN_ENT("TN", 0x47, 1, 0xF1), /* Tunisia */ ++ COUNTRY_CHPLAN_ENT("TO", 0x26, 1, 0x00), /* Tonga */ ++ COUNTRY_CHPLAN_ENT("TR", 0x26, 1, 0xF1), /* Turkey, Northern Cyprus */ ++ COUNTRY_CHPLAN_ENT("TT", 0x42, 1, 0xF1), /* Trinidad & Tobago */ ++ COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0xFF), /* Taiwan */ ++ COUNTRY_CHPLAN_ENT("TZ", 0x26, 1, 0xF0), /* Tanzania */ ++ COUNTRY_CHPLAN_ENT("UA", 0x26, 1, 0xFB), /* Ukraine */ ++ COUNTRY_CHPLAN_ENT("UG", 0x26, 1, 0xF1), /* Uganda */ ++ COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0xFF), /* United States of America (USA) */ ++ COUNTRY_CHPLAN_ENT("UY", 0x34, 1, 0xF1), /* Uruguay */ ++ COUNTRY_CHPLAN_ENT("UZ", 0x47, 1, 0xF0), /* Uzbekistan */ ++ COUNTRY_CHPLAN_ENT("VA", 0x26, 1, 0x00), /* Holy See (Vatican City) */ ++ COUNTRY_CHPLAN_ENT("VC", 0x34, 1, 0x10), /* Saint Vincent and the Grenadines */ ++ COUNTRY_CHPLAN_ENT("VE", 0x30, 1, 0xF1), /* Venezuela */ ++ COUNTRY_CHPLAN_ENT("VI", 0x34, 1, 0x00), /* United States Virgin Islands (USA) */ ++ COUNTRY_CHPLAN_ENT("VN", 0x26, 1, 0xF1), /* Vietnam */ ++ COUNTRY_CHPLAN_ENT("VU", 0x26, 1, 0x00), /* Vanuatu */ ++ COUNTRY_CHPLAN_ENT("WF", 0x26, 1, 0x00), /* Wallis and Futuna (France) */ ++ COUNTRY_CHPLAN_ENT("WS", 0x34, 1, 0x00), /* Samoa */ ++ COUNTRY_CHPLAN_ENT("YE", 0x26, 1, 0x40), /* Yemen */ ++ COUNTRY_CHPLAN_ENT("YT", 0x26, 1, 0x80), /* Mayotte (France) */ ++ COUNTRY_CHPLAN_ENT("ZA", 0x26, 1, 0xF1), /* South Africa */ ++ COUNTRY_CHPLAN_ENT("ZM", 0x26, 1, 0xB0), /* Zambia */ ++ COUNTRY_CHPLAN_ENT("ZW", 0x26, 1, 0xF1), /* Zimbabwe */ ++}; ++ ++u16 const country_chplan_map_sz = sizeof(country_chplan_map) / sizeof(struct country_chplan); ++ ++/* ++* rtw_get_chplan_from_country - ++* @country_code: string of country code ++* ++* Return pointer of struct country_chplan entry or NULL when unsupported country_code is given ++*/ ++const struct country_chplan *rtw_get_chplan_from_country(const char *country_code) ++{ ++ const struct country_chplan *ent = NULL; ++ const struct country_chplan *map = NULL; ++ u16 map_sz = 0; ++ char code[2]; ++ int i; ++ ++ code[0] = alpha_to_upper(country_code[0]); ++ code[1] = alpha_to_upper(country_code[1]); ++ ++#if !defined(CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP) && RTW_DEF_MODULE_REGULATORY_CERT ++ ent = rtw_def_module_get_chplan_from_country(code); ++ if (ent != NULL) ++ goto exit; ++#endif ++ ++#ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP ++ map = CUSTOMIZED_country_chplan_map; ++ map_sz = CUSTOMIZED_country_chplan_map_sz; ++#else ++ map = country_chplan_map; ++ map_sz = country_chplan_map_sz; ++#endif ++ ++ for (i = 0; i < map_sz; i++) { ++ if (strncmp(code, map[i].alpha2, 2) == 0) { ++ ent = &map[i]; ++ break; ++ } ++ } ++ ++exit: ++ #if RTW_DEF_MODULE_REGULATORY_CERT ++ if (ent && !(COUNTRY_CHPLAN_DEF_MODULE_FALGS(ent) & RTW_DEF_MODULE_REGULATORY_CERT)) ++ ent = NULL; ++ #endif ++ ++ return ent; ++} ++ ++int rtw_ch_to_bb_gain_sel(int ch) ++{ ++ int sel = -1; ++ ++ if (ch >= 1 && ch <= 14) ++ sel = BB_GAIN_2G; ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ else if (ch >= 36 && ch < 48) ++ sel = BB_GAIN_5GLB1; ++ else if (ch >= 52 && ch <= 64) ++ sel = BB_GAIN_5GLB2; ++ else if (ch >= 100 && ch <= 120) ++ sel = BB_GAIN_5GMB1; ++ else if (ch >= 124 && ch <= 144) ++ sel = BB_GAIN_5GMB2; ++ else if (ch >= 149 && ch <= 177) ++ sel = BB_GAIN_5GHB; ++#endif ++ ++ return sel; ++} ++ ++s8 rtw_rf_get_kfree_tx_gain_offset(_adapter *padapter, u8 path, u8 ch) ++{ ++ s8 kfree_offset = 0; ++ ++#ifdef CONFIG_RF_POWER_TRIM ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); ++ struct kfree_data_t *kfree_data = GET_KFREE_DATA(padapter); ++ s8 bb_gain_sel = rtw_ch_to_bb_gain_sel(ch); ++ ++ if (bb_gain_sel < BB_GAIN_2G || bb_gain_sel >= BB_GAIN_NUM) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (kfree_data->flag & KFREE_FLAG_ON) { ++ kfree_offset = kfree_data->bb_gain[bb_gain_sel][path]; ++ if (IS_HARDWARE_TYPE_8723D(padapter)) ++ RTW_INFO("%s path:%s, ch:%u, bb_gain_sel:%d, kfree_offset:%d\n" ++ , __func__, (path == 0)?"S1":"S0", ++ ch, bb_gain_sel, kfree_offset); ++ else ++ RTW_INFO("%s path:%u, ch:%u, bb_gain_sel:%d, kfree_offset:%d\n" ++ , __func__, path, ch, bb_gain_sel, kfree_offset); ++ } ++exit: ++#endif /* CONFIG_RF_POWER_TRIM */ ++ return kfree_offset; ++} ++ ++void rtw_rf_set_tx_gain_offset(_adapter *adapter, u8 path, s8 offset) ++{ ++ u8 write_value; ++ u8 target_path = 0; ++ u32 val32 = 0; ++ ++ if (IS_HARDWARE_TYPE_8723D(adapter)) { ++ target_path = RF_PATH_A; /*in 8723D case path means S0/S1*/ ++ if (path == PPG_8723D_S1) ++ RTW_INFO("kfree gain_offset 0x55:0x%x ", ++ rtw_hal_read_rfreg(adapter, target_path, 0x55, 0xffffffff)); ++ else if (path == PPG_8723D_S0) ++ RTW_INFO("kfree gain_offset 0x65:0x%x ", ++ rtw_hal_read_rfreg(adapter, target_path, 0x65, 0xffffffff)); ++ } else { ++ target_path = path; ++ RTW_INFO("kfree gain_offset 0x55:0x%x ", rtw_hal_read_rfreg(adapter, target_path, 0x55, 0xffffffff)); ++ } ++ ++ switch (rtw_get_chip_type(adapter)) { ++#ifdef CONFIG_RTL8723D ++ case RTL8723D: ++ write_value = RF_TX_GAIN_OFFSET_8723D(offset); ++ if (path == PPG_8723D_S1) ++ rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0f8000, write_value); ++ else if (path == PPG_8723D_S0) ++ rtw_hal_write_rfreg(adapter, target_path, 0x65, 0x0f8000, write_value); ++ break; ++#endif /* CONFIG_RTL8723D */ ++#ifdef CONFIG_RTL8703B ++ case RTL8703B: ++ write_value = RF_TX_GAIN_OFFSET_8703B(offset); ++ rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0fc000, write_value); ++ break; ++#endif /* CONFIG_RTL8703B */ ++#ifdef CONFIG_RTL8188F ++ case RTL8188F: ++ write_value = RF_TX_GAIN_OFFSET_8188F(offset); ++ rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0fc000, write_value); ++ break; ++#endif /* CONFIG_RTL8188F */ ++#ifdef CONFIG_RTL8192E ++ case RTL8192E: ++ write_value = RF_TX_GAIN_OFFSET_8192E(offset); ++ rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0f8000, write_value); ++ break; ++#endif /* CONFIG_RTL8188F */ ++ ++#ifdef CONFIG_RTL8821A ++ case RTL8821: ++ write_value = RF_TX_GAIN_OFFSET_8821A(offset); ++ rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0f8000, write_value); ++ break; ++#endif /* CONFIG_RTL8821A */ ++#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++ case RTL8814A: ++ case RTL8822B: ++ case RTL8821C: ++ RTW_INFO("\nkfree by PhyDM on the sw CH. path %d\n", path); ++ break; ++#endif /* CONFIG_RTL8814A || CONFIG_RTL8822B || CONFIG_RTL8821C */ ++ ++ default: ++ rtw_warn_on(1); ++ break; ++ } ++ ++ if (IS_HARDWARE_TYPE_8723D(adapter)) { ++ if (path == PPG_8723D_S1) ++ val32 = rtw_hal_read_rfreg(adapter, target_path, 0x55, 0xffffffff); ++ else if (path == PPG_8723D_S0) ++ val32 = rtw_hal_read_rfreg(adapter, target_path, 0x65, 0xffffffff); ++ } else { ++ val32 = rtw_hal_read_rfreg(adapter, target_path, 0x55, 0xffffffff); ++ } ++ RTW_INFO(" after :0x%x\n", val32); ++} ++ ++void rtw_rf_apply_tx_gain_offset(_adapter *adapter, u8 ch) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ s8 kfree_offset = 0; ++ s8 tx_pwr_track_offset = 0; /* TODO: 8814A should consider tx pwr track when setting tx gain offset */ ++ s8 total_offset; ++ int i, total = 0; ++ ++ if (IS_HARDWARE_TYPE_8723D(adapter)) ++ total = 2; /* S1 and S0 */ ++ else ++ total = hal_data->NumTotalRFPath; ++ ++ for (i = 0; i < total; i++) { ++ kfree_offset = rtw_rf_get_kfree_tx_gain_offset(adapter, i, ch); ++ total_offset = kfree_offset + tx_pwr_track_offset; ++ rtw_rf_set_tx_gain_offset(adapter, i, total_offset); ++ } ++} ++ ++bool rtw_is_dfs_range(u32 hi, u32 lo) ++{ ++ return rtw_is_range_overlap(hi, lo, 5720 + 10, 5260 - 10) ? _TRUE : _FALSE; ++} ++ ++bool rtw_is_dfs_ch(u8 ch, u8 bw, u8 offset) ++{ ++ u32 hi, lo; ++ ++ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) ++ return _FALSE; ++ ++ return rtw_is_dfs_range(hi, lo) ? _TRUE : _FALSE; ++} ++ ++bool rtw_is_long_cac_range(u32 hi, u32 lo, u8 dfs_region) ++{ ++ return (dfs_region == PHYDM_DFS_DOMAIN_ETSI && rtw_is_range_overlap(hi, lo, 5660 + 10, 5600 - 10)) ? _TRUE : _FALSE; ++} ++ ++bool rtw_is_long_cac_ch(u8 ch, u8 bw, u8 offset, u8 dfs_region) ++{ ++ u32 hi, lo; ++ ++ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) ++ return _FALSE; ++ ++ return rtw_is_long_cac_range(hi, lo, dfs_region) ? _TRUE : _FALSE; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_sdio.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_sdio.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_sdio.c 2018-02-11 21:44:27.141145994 +0200 +@@ -0,0 +1,98 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ ******************************************************************************/ ++#define _RTW_SDIO_C_ ++ ++#include /* struct dvobj_priv and etc. */ ++#include /* RTW_SDIO_ADDR_CMD52_GEN */ ++ ++/* ++ * Description: ++ * Use SDIO cmd52 or cmd53 to read/write data ++ * ++ * Parameters: ++ * d pointer of device object(struct dvobj_priv) ++ * addr SDIO address, 17 bits ++ * buf buffer for I/O ++ * len length ++ * write 0:read, 1:write ++ * cmd52 0:cmd52, 1:cmd53 ++ * ++ * Return: ++ * _SUCCESS I/O ok. ++ * _FAIL I/O fail. ++ */ ++static u8 sdio_io(struct dvobj_priv *d, u32 addr, void *buf, size_t len, u8 write, u8 cmd52) ++{ ++ int err; ++ ++ ++ if (cmd52) ++ addr = RTW_SDIO_ADDR_CMD52_GEN(addr); ++ ++ if (write) ++ err = d->intf_ops->write(d, addr, buf, len, 0); ++ else ++ err = d->intf_ops->read(d, addr, buf, len, 0); ++ if (err) { ++ RTW_INFO("%s: [ERROR] %s FAIL! error(%d)\n", ++ __FUNCTION__, write ? "write" : "read", err); ++ return _FAIL; ++ } ++ ++ return _SUCCESS; ++} ++ ++u8 rtw_sdio_read_cmd52(struct dvobj_priv *d, u32 addr, void *buf, size_t len) ++{ ++ return sdio_io(d, addr, buf, len, 0, 1); ++} ++ ++u8 rtw_sdio_read_cmd53(struct dvobj_priv *d, u32 addr, void *buf, size_t len) ++{ ++ return sdio_io(d, addr, buf, len, 0, 0); ++} ++ ++u8 rtw_sdio_write_cmd52(struct dvobj_priv *d, u32 addr, void *buf, size_t len) ++{ ++ return sdio_io(d, addr, buf, len, 1, 1); ++} ++ ++u8 rtw_sdio_write_cmd53(struct dvobj_priv *d, u32 addr, void *buf, size_t len) ++{ ++ return sdio_io(d, addr, buf, len, 1, 0); ++} ++ ++u8 rtw_sdio_f0_read(struct dvobj_priv *d, u32 addr, void *buf, size_t len) ++{ ++ int err; ++ u8 ret; ++ ++ ++ ret = _SUCCESS; ++ addr = RTW_SDIO_ADDR_F0_GEN(addr); ++ ++ err = d->intf_ops->read(d, addr, buf, len, 0); ++ if (err) { ++ RTW_INFO("%s: [ERROR] Read f0 register FAIL!\n", __FUNCTION__); ++ ret = _FAIL; ++ } ++ ++ ++ return ret; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_security.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_security.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_security.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_security.c 2018-02-11 21:44:27.141145994 +0200 +@@ -0,0 +1,3197 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_SECURITY_C_ ++ ++#include ++ ++static const char *_security_type_str[] = { ++ "N/A", ++ "WEP40", ++ "TKIP", ++ "TKIP_WM", ++ "AES", ++ "WEP104", ++ "SMS4", ++ "WEP_WPA", ++ "BIP", ++}; ++ ++const char *security_type_str(u8 value) ++{ ++#ifdef CONFIG_IEEE80211W ++ if (value <= _BIP_) ++#else ++ if (value <= _WEP_WPA_MIXED_) ++#endif ++ return _security_type_str[value]; ++ return NULL; ++} ++ ++#ifdef DBG_SW_SEC_CNT ++#define WEP_SW_ENC_CNT_INC(sec, ra) do {\ ++ if (is_broadcast_mac_addr(ra)) \ ++ sec->wep_sw_enc_cnt_bc++; \ ++ else if (is_multicast_mac_addr(ra)) \ ++ sec->wep_sw_enc_cnt_mc++; \ ++ else \ ++ sec->wep_sw_enc_cnt_uc++; \ ++ } while (0) ++ ++#define WEP_SW_DEC_CNT_INC(sec, ra) do {\ ++ if (is_broadcast_mac_addr(ra)) \ ++ sec->wep_sw_dec_cnt_bc++; \ ++ else if (is_multicast_mac_addr(ra)) \ ++ sec->wep_sw_dec_cnt_mc++; \ ++ else \ ++ sec->wep_sw_dec_cnt_uc++; \ ++ } while (0) ++ ++#define TKIP_SW_ENC_CNT_INC(sec, ra) do {\ ++ if (is_broadcast_mac_addr(ra)) \ ++ sec->tkip_sw_enc_cnt_bc++; \ ++ else if (is_multicast_mac_addr(ra)) \ ++ sec->tkip_sw_enc_cnt_mc++; \ ++ else \ ++ sec->tkip_sw_enc_cnt_uc++; \ ++ } while (0) ++ ++#define TKIP_SW_DEC_CNT_INC(sec, ra) do {\ ++ if (is_broadcast_mac_addr(ra)) \ ++ sec->tkip_sw_dec_cnt_bc++; \ ++ else if (is_multicast_mac_addr(ra)) \ ++ sec->tkip_sw_dec_cnt_mc++; \ ++ else \ ++ sec->tkip_sw_dec_cnt_uc++; \ ++ } while (0) ++ ++#define AES_SW_ENC_CNT_INC(sec, ra) do {\ ++ if (is_broadcast_mac_addr(ra)) \ ++ sec->aes_sw_enc_cnt_bc++; \ ++ else if (is_multicast_mac_addr(ra)) \ ++ sec->aes_sw_enc_cnt_mc++; \ ++ else \ ++ sec->aes_sw_enc_cnt_uc++; \ ++ } while (0) ++ ++#define AES_SW_DEC_CNT_INC(sec, ra) do {\ ++ if (is_broadcast_mac_addr(ra)) \ ++ sec->aes_sw_dec_cnt_bc++; \ ++ else if (is_multicast_mac_addr(ra)) \ ++ sec->aes_sw_dec_cnt_mc++; \ ++ else \ ++ sec->aes_sw_dec_cnt_uc++; \ ++ } while (0) ++#else ++#define WEP_SW_ENC_CNT_INC(sec, ra) ++#define WEP_SW_DEC_CNT_INC(sec, ra) ++#define TKIP_SW_ENC_CNT_INC(sec, ra) ++#define TKIP_SW_DEC_CNT_INC(sec, ra) ++#define AES_SW_ENC_CNT_INC(sec, ra) ++#define AES_SW_DEC_CNT_INC(sec, ra) ++#endif /* DBG_SW_SEC_CNT */ ++ ++/* *****WEP related***** */ ++ ++#define CRC32_POLY 0x04c11db7 ++ ++struct arc4context { ++ u32 x; ++ u32 y; ++ u8 state[256]; ++}; ++ ++ ++static void arcfour_init(struct arc4context *parc4ctx, u8 *key, u32 key_len) ++{ ++ u32 t, u; ++ u32 keyindex; ++ u32 stateindex; ++ u8 *state; ++ u32 counter; ++ state = parc4ctx->state; ++ parc4ctx->x = 0; ++ parc4ctx->y = 0; ++ for (counter = 0; counter < 256; counter++) ++ state[counter] = (u8)counter; ++ keyindex = 0; ++ stateindex = 0; ++ for (counter = 0; counter < 256; counter++) { ++ t = state[counter]; ++ stateindex = (stateindex + key[keyindex] + t) & 0xff; ++ u = state[stateindex]; ++ state[stateindex] = (u8)t; ++ state[counter] = (u8)u; ++ if (++keyindex >= key_len) ++ keyindex = 0; ++ } ++} ++static u32 arcfour_byte(struct arc4context *parc4ctx) ++{ ++ u32 x; ++ u32 y; ++ u32 sx, sy; ++ u8 *state; ++ state = parc4ctx->state; ++ x = (parc4ctx->x + 1) & 0xff; ++ sx = state[x]; ++ y = (sx + parc4ctx->y) & 0xff; ++ sy = state[y]; ++ parc4ctx->x = x; ++ parc4ctx->y = y; ++ state[y] = (u8)sx; ++ state[x] = (u8)sy; ++ return state[(sx + sy) & 0xff]; ++} ++ ++ ++static void arcfour_encrypt(struct arc4context *parc4ctx, ++ u8 *dest, ++ u8 *src, ++ u32 len) ++{ ++ u32 i; ++ for (i = 0; i < len; i++) ++ dest[i] = src[i] ^ (unsigned char)arcfour_byte(parc4ctx); ++} ++ ++static sint bcrc32initialized = 0; ++static u32 crc32_table[256]; ++ ++ ++static u8 crc32_reverseBit(u8 data) ++{ ++ return (u8)((data << 7) & 0x80) | ((data << 5) & 0x40) | ((data << 3) & 0x20) | ((data << 1) & 0x10) | ((data >> 1) & 0x08) | ((data >> 3) & 0x04) | ((data >> 5) & 0x02) | (( ++ data >> 7) & 0x01) ; ++} ++ ++static void crc32_init(void) ++{ ++ if (bcrc32initialized == 1) ++ goto exit; ++ else { ++ sint i, j; ++ u32 c; ++ u8 *p = (u8 *)&c, *p1; ++ u8 k; ++ ++ c = 0x12340000; ++ ++ for (i = 0; i < 256; ++i) { ++ k = crc32_reverseBit((u8)i); ++ for (c = ((u32)k) << 24, j = 8; j > 0; --j) ++ c = c & 0x80000000 ? (c << 1) ^ CRC32_POLY : (c << 1); ++ p1 = (u8 *)&crc32_table[i]; ++ ++ p1[0] = crc32_reverseBit(p[3]); ++ p1[1] = crc32_reverseBit(p[2]); ++ p1[2] = crc32_reverseBit(p[1]); ++ p1[3] = crc32_reverseBit(p[0]); ++ } ++ bcrc32initialized = 1; ++ } ++exit: ++ return; ++} ++ ++static u32 getcrc32(u8 *buf, sint len) ++{ ++ u8 *p; ++ u32 crc; ++ if (bcrc32initialized == 0) ++ crc32_init(); ++ ++ crc = 0xffffffff; /* preload shift register, per CRC-32 spec */ ++ ++ for (p = buf; len > 0; ++p, --len) ++ crc = crc32_table[(crc ^ *p) & 0xff] ^ (crc >> 8); ++ return ~crc; /* transmit complement, per CRC-32 spec */ ++} ++ ++ ++/* ++ Need to consider the fragment situation ++*/ ++void rtw_wep_encrypt(_adapter *padapter, u8 *pxmitframe) ++{ ++ /* exclude ICV */ ++ ++ unsigned char crc[4]; ++ struct arc4context mycontext; ++ ++ sint curfragnum, length; ++ u32 keylength; ++ ++ u8 *pframe, *payload, *iv; /* ,*wepkey */ ++ u8 wepkey[16]; ++ u8 hw_hdr_offset = 0; ++ struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ ++ ++ if (((struct xmit_frame *)pxmitframe)->buf_addr == NULL) ++ return; ++ ++#ifdef CONFIG_USB_TX_AGGREGATION ++ hw_hdr_offset = TXDESC_SIZE + ++ (((struct xmit_frame *)pxmitframe)->pkt_offset * PACKET_OFFSET_SZ); ++#else ++#ifdef CONFIG_TX_EARLY_MODE ++ hw_hdr_offset = TXDESC_OFFSET + EARLY_MODE_INFO_SIZE; ++#else ++ hw_hdr_offset = TXDESC_OFFSET; ++#endif ++#endif ++ ++ pframe = ((struct xmit_frame *)pxmitframe)->buf_addr + hw_hdr_offset; ++ ++ /* start to encrypt each fragment */ ++ if ((pattrib->encrypt == _WEP40_) || (pattrib->encrypt == _WEP104_)) { ++ keylength = psecuritypriv->dot11DefKeylen[psecuritypriv->dot11PrivacyKeyIndex]; ++ ++ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { ++ iv = pframe + pattrib->hdrlen; ++ _rtw_memcpy(&wepkey[0], iv, 3); ++ _rtw_memcpy(&wepkey[3], &psecuritypriv->dot11DefKey[psecuritypriv->dot11PrivacyKeyIndex].skey[0], keylength); ++ payload = pframe + pattrib->iv_len + pattrib->hdrlen; ++ ++ if ((curfragnum + 1) == pattrib->nr_frags) { ++ /* the last fragment */ ++ ++ length = pattrib->last_txcmdsz - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; ++ ++ *((u32 *)crc) = cpu_to_le32(getcrc32(payload, length)); ++ ++ arcfour_init(&mycontext, wepkey, 3 + keylength); ++ arcfour_encrypt(&mycontext, payload, payload, length); ++ arcfour_encrypt(&mycontext, payload + length, crc, 4); ++ ++ } else { ++ length = pxmitpriv->frag_len - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len ; ++ *((u32 *)crc) = cpu_to_le32(getcrc32(payload, length)); ++ arcfour_init(&mycontext, wepkey, 3 + keylength); ++ arcfour_encrypt(&mycontext, payload, payload, length); ++ arcfour_encrypt(&mycontext, payload + length, crc, 4); ++ ++ pframe += pxmitpriv->frag_len; ++ pframe = (u8 *)RND4((SIZE_PTR)(pframe)); ++ ++ } ++ ++ } ++ ++ WEP_SW_ENC_CNT_INC(psecuritypriv, pattrib->ra); ++ } ++ ++ ++} ++ ++void rtw_wep_decrypt(_adapter *padapter, u8 *precvframe) ++{ ++ /* exclude ICV */ ++ u8 crc[4]; ++ struct arc4context mycontext; ++ sint length; ++ u32 keylength; ++ u8 *pframe, *payload, *iv, wepkey[16]; ++ u8 keyindex; ++ struct rx_pkt_attrib *prxattrib = &(((union recv_frame *)precvframe)->u.hdr.attrib); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++ ++ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; ++ ++ /* start to decrypt recvframe */ ++ if ((prxattrib->encrypt == _WEP40_) || (prxattrib->encrypt == _WEP104_)) { ++ iv = pframe + prxattrib->hdrlen; ++ /* keyindex=(iv[3]&0x3); */ ++ keyindex = prxattrib->key_index; ++ keylength = psecuritypriv->dot11DefKeylen[keyindex]; ++ _rtw_memcpy(&wepkey[0], iv, 3); ++ /* _rtw_memcpy(&wepkey[3], &psecuritypriv->dot11DefKey[psecuritypriv->dot11PrivacyKeyIndex].skey[0],keylength); */ ++ _rtw_memcpy(&wepkey[3], &psecuritypriv->dot11DefKey[keyindex].skey[0], keylength); ++ length = ((union recv_frame *)precvframe)->u.hdr.len - prxattrib->hdrlen - prxattrib->iv_len; ++ ++ payload = pframe + prxattrib->iv_len + prxattrib->hdrlen; ++ ++ /* decrypt payload include icv */ ++ arcfour_init(&mycontext, wepkey, 3 + keylength); ++ arcfour_encrypt(&mycontext, payload, payload, length); ++ ++ /* calculate icv and compare the icv */ ++ *((u32 *)crc) = le32_to_cpu(getcrc32(payload, length - 4)); ++ ++ ++ WEP_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); ++ } ++ ++ ++ return; ++ ++} ++ ++/* 3 =====TKIP related===== */ ++ ++static u32 secmicgetuint32(u8 *p) ++/* Convert from Byte[] to Us4Byte32 in a portable way */ ++{ ++ s32 i; ++ u32 res = 0; ++ for (i = 0; i < 4; i++) ++ res |= ((u32)(*p++)) << (8 * i); ++ return res; ++} ++ ++static void secmicputuint32(u8 *p, u32 val) ++/* Convert from Us4Byte32 to Byte[] in a portable way */ ++{ ++ long i; ++ for (i = 0; i < 4; i++) { ++ *p++ = (u8)(val & 0xff); ++ val >>= 8; ++ } ++} ++ ++static void secmicclear(struct mic_data *pmicdata) ++{ ++ /* Reset the state to the empty message. */ ++ pmicdata->L = pmicdata->K0; ++ pmicdata->R = pmicdata->K1; ++ pmicdata->nBytesInM = 0; ++ pmicdata->M = 0; ++} ++ ++void rtw_secmicsetkey(struct mic_data *pmicdata, u8 *key) ++{ ++ /* Set the key */ ++ pmicdata->K0 = secmicgetuint32(key); ++ pmicdata->K1 = secmicgetuint32(key + 4); ++ /* and reset the message */ ++ secmicclear(pmicdata); ++} ++ ++void rtw_secmicappendbyte(struct mic_data *pmicdata, u8 b) ++{ ++ /* Append the byte to our word-sized buffer */ ++ pmicdata->M |= ((unsigned long)b) << (8 * pmicdata->nBytesInM); ++ pmicdata->nBytesInM++; ++ /* Process the word if it is full. */ ++ if (pmicdata->nBytesInM >= 4) { ++ pmicdata->L ^= pmicdata->M; ++ pmicdata->R ^= ROL32(pmicdata->L, 17); ++ pmicdata->L += pmicdata->R; ++ pmicdata->R ^= ((pmicdata->L & 0xff00ff00) >> 8) | ((pmicdata->L & 0x00ff00ff) << 8); ++ pmicdata->L += pmicdata->R; ++ pmicdata->R ^= ROL32(pmicdata->L, 3); ++ pmicdata->L += pmicdata->R; ++ pmicdata->R ^= ROR32(pmicdata->L, 2); ++ pmicdata->L += pmicdata->R; ++ /* Clear the buffer */ ++ pmicdata->M = 0; ++ pmicdata->nBytesInM = 0; ++ } ++} ++ ++void rtw_secmicappend(struct mic_data *pmicdata, u8 *src, u32 nbytes) ++{ ++ /* This is simple */ ++ while (nbytes > 0) { ++ rtw_secmicappendbyte(pmicdata, *src++); ++ nbytes--; ++ } ++} ++ ++void rtw_secgetmic(struct mic_data *pmicdata, u8 *dst) ++{ ++ /* Append the minimum padding */ ++ rtw_secmicappendbyte(pmicdata, 0x5a); ++ rtw_secmicappendbyte(pmicdata, 0); ++ rtw_secmicappendbyte(pmicdata, 0); ++ rtw_secmicappendbyte(pmicdata, 0); ++ rtw_secmicappendbyte(pmicdata, 0); ++ /* and then zeroes until the length is a multiple of 4 */ ++ while (pmicdata->nBytesInM != 0) ++ rtw_secmicappendbyte(pmicdata, 0); ++ /* The appendByte function has already computed the result. */ ++ secmicputuint32(dst, pmicdata->L); ++ secmicputuint32(dst + 4, pmicdata->R); ++ /* Reset to the empty message. */ ++ secmicclear(pmicdata); ++} ++ ++ ++void rtw_seccalctkipmic(u8 *key, u8 *header, u8 *data, u32 data_len, u8 *mic_code, u8 pri) ++{ ++ ++ struct mic_data micdata; ++ u8 priority[4] = {0x0, 0x0, 0x0, 0x0}; ++ rtw_secmicsetkey(&micdata, key); ++ priority[0] = pri; ++ ++ /* Michael MIC pseudo header: DA, SA, 3 x 0, Priority */ ++ if (header[1] & 1) { /* ToDS==1 */ ++ rtw_secmicappend(&micdata, &header[16], 6); /* DA */ ++ if (header[1] & 2) /* From Ds==1 */ ++ rtw_secmicappend(&micdata, &header[24], 6); ++ else ++ rtw_secmicappend(&micdata, &header[10], 6); ++ } else { /* ToDS==0 */ ++ rtw_secmicappend(&micdata, &header[4], 6); /* DA */ ++ if (header[1] & 2) /* From Ds==1 */ ++ rtw_secmicappend(&micdata, &header[16], 6); ++ else ++ rtw_secmicappend(&micdata, &header[10], 6); ++ ++ } ++ rtw_secmicappend(&micdata, &priority[0], 4); ++ ++ ++ rtw_secmicappend(&micdata, data, data_len); ++ ++ rtw_secgetmic(&micdata, mic_code); ++} ++ ++ ++ ++ ++/* macros for extraction/creation of unsigned char/unsigned short values */ ++#define RotR1(v16) ((((v16) >> 1) & 0x7FFF) ^ (((v16) & 1) << 15)) ++#define Lo8(v16) ((u8)((v16) & 0x00FF)) ++#define Hi8(v16) ((u8)(((v16) >> 8) & 0x00FF)) ++#define Lo16(v32) ((u16)((v32) & 0xFFFF)) ++#define Hi16(v32) ((u16)(((v32) >> 16) & 0xFFFF)) ++#define Mk16(hi, lo) ((lo) ^ (((u16)(hi)) << 8)) ++ ++/* select the Nth 16-bit word of the temporal key unsigned char array TK[] */ ++#define TK16(N) Mk16(tk[2*(N)+1], tk[2*(N)]) ++ ++/* S-box lookup: 16 bits --> 16 bits */ ++#define _S_(v16) (Sbox1[0][Lo8(v16)] ^ Sbox1[1][Hi8(v16)]) ++ ++/* fixed algorithm "parameters" */ ++#define PHASE1_LOOP_CNT 8 /* this needs to be "big enough" */ ++#define TA_SIZE 6 /* 48-bit transmitter address */ ++#define TK_SIZE 16 /* 128-bit temporal key */ ++#define P1K_SIZE 10 /* 80-bit Phase1 key */ ++#define RC4_KEY_SIZE 16 /* 128-bit RC4KEY (104 bits unknown) */ ++ ++ ++/* 2-unsigned char by 2-unsigned char subset of the full AES S-box table */ ++static const unsigned short Sbox1[2][256] = /* Sbox for hash (can be in ROM) */ ++{ { ++ 0xC6A5, 0xF884, 0xEE99, 0xF68D, 0xFF0D, 0xD6BD, 0xDEB1, 0x9154, ++ 0x6050, 0x0203, 0xCEA9, 0x567D, 0xE719, 0xB562, 0x4DE6, 0xEC9A, ++ 0x8F45, 0x1F9D, 0x8940, 0xFA87, 0xEF15, 0xB2EB, 0x8EC9, 0xFB0B, ++ 0x41EC, 0xB367, 0x5FFD, 0x45EA, 0x23BF, 0x53F7, 0xE496, 0x9B5B, ++ 0x75C2, 0xE11C, 0x3DAE, 0x4C6A, 0x6C5A, 0x7E41, 0xF502, 0x834F, ++ 0x685C, 0x51F4, 0xD134, 0xF908, 0xE293, 0xAB73, 0x6253, 0x2A3F, ++ 0x080C, 0x9552, 0x4665, 0x9D5E, 0x3028, 0x37A1, 0x0A0F, 0x2FB5, ++ 0x0E09, 0x2436, 0x1B9B, 0xDF3D, 0xCD26, 0x4E69, 0x7FCD, 0xEA9F, ++ 0x121B, 0x1D9E, 0x5874, 0x342E, 0x362D, 0xDCB2, 0xB4EE, 0x5BFB, ++ 0xA4F6, 0x764D, 0xB761, 0x7DCE, 0x527B, 0xDD3E, 0x5E71, 0x1397, ++ 0xA6F5, 0xB968, 0x0000, 0xC12C, 0x4060, 0xE31F, 0x79C8, 0xB6ED, ++ 0xD4BE, 0x8D46, 0x67D9, 0x724B, 0x94DE, 0x98D4, 0xB0E8, 0x854A, ++ 0xBB6B, 0xC52A, 0x4FE5, 0xED16, 0x86C5, 0x9AD7, 0x6655, 0x1194, ++ 0x8ACF, 0xE910, 0x0406, 0xFE81, 0xA0F0, 0x7844, 0x25BA, 0x4BE3, ++ 0xA2F3, 0x5DFE, 0x80C0, 0x058A, 0x3FAD, 0x21BC, 0x7048, 0xF104, ++ 0x63DF, 0x77C1, 0xAF75, 0x4263, 0x2030, 0xE51A, 0xFD0E, 0xBF6D, ++ 0x814C, 0x1814, 0x2635, 0xC32F, 0xBEE1, 0x35A2, 0x88CC, 0x2E39, ++ 0x9357, 0x55F2, 0xFC82, 0x7A47, 0xC8AC, 0xBAE7, 0x322B, 0xE695, ++ 0xC0A0, 0x1998, 0x9ED1, 0xA37F, 0x4466, 0x547E, 0x3BAB, 0x0B83, ++ 0x8CCA, 0xC729, 0x6BD3, 0x283C, 0xA779, 0xBCE2, 0x161D, 0xAD76, ++ 0xDB3B, 0x6456, 0x744E, 0x141E, 0x92DB, 0x0C0A, 0x486C, 0xB8E4, ++ 0x9F5D, 0xBD6E, 0x43EF, 0xC4A6, 0x39A8, 0x31A4, 0xD337, 0xF28B, ++ 0xD532, 0x8B43, 0x6E59, 0xDAB7, 0x018C, 0xB164, 0x9CD2, 0x49E0, ++ 0xD8B4, 0xACFA, 0xF307, 0xCF25, 0xCAAF, 0xF48E, 0x47E9, 0x1018, ++ 0x6FD5, 0xF088, 0x4A6F, 0x5C72, 0x3824, 0x57F1, 0x73C7, 0x9751, ++ 0xCB23, 0xA17C, 0xE89C, 0x3E21, 0x96DD, 0x61DC, 0x0D86, 0x0F85, ++ 0xE090, 0x7C42, 0x71C4, 0xCCAA, 0x90D8, 0x0605, 0xF701, 0x1C12, ++ 0xC2A3, 0x6A5F, 0xAEF9, 0x69D0, 0x1791, 0x9958, 0x3A27, 0x27B9, ++ 0xD938, 0xEB13, 0x2BB3, 0x2233, 0xD2BB, 0xA970, 0x0789, 0x33A7, ++ 0x2DB6, 0x3C22, 0x1592, 0xC920, 0x8749, 0xAAFF, 0x5078, 0xA57A, ++ 0x038F, 0x59F8, 0x0980, 0x1A17, 0x65DA, 0xD731, 0x84C6, 0xD0B8, ++ 0x82C3, 0x29B0, 0x5A77, 0x1E11, 0x7BCB, 0xA8FC, 0x6DD6, 0x2C3A, ++ }, ++ ++ ++ { /* second half of table is unsigned char-reversed version of first! */ ++ 0xA5C6, 0x84F8, 0x99EE, 0x8DF6, 0x0DFF, 0xBDD6, 0xB1DE, 0x5491, ++ 0x5060, 0x0302, 0xA9CE, 0x7D56, 0x19E7, 0x62B5, 0xE64D, 0x9AEC, ++ 0x458F, 0x9D1F, 0x4089, 0x87FA, 0x15EF, 0xEBB2, 0xC98E, 0x0BFB, ++ 0xEC41, 0x67B3, 0xFD5F, 0xEA45, 0xBF23, 0xF753, 0x96E4, 0x5B9B, ++ 0xC275, 0x1CE1, 0xAE3D, 0x6A4C, 0x5A6C, 0x417E, 0x02F5, 0x4F83, ++ 0x5C68, 0xF451, 0x34D1, 0x08F9, 0x93E2, 0x73AB, 0x5362, 0x3F2A, ++ 0x0C08, 0x5295, 0x6546, 0x5E9D, 0x2830, 0xA137, 0x0F0A, 0xB52F, ++ 0x090E, 0x3624, 0x9B1B, 0x3DDF, 0x26CD, 0x694E, 0xCD7F, 0x9FEA, ++ 0x1B12, 0x9E1D, 0x7458, 0x2E34, 0x2D36, 0xB2DC, 0xEEB4, 0xFB5B, ++ 0xF6A4, 0x4D76, 0x61B7, 0xCE7D, 0x7B52, 0x3EDD, 0x715E, 0x9713, ++ 0xF5A6, 0x68B9, 0x0000, 0x2CC1, 0x6040, 0x1FE3, 0xC879, 0xEDB6, ++ 0xBED4, 0x468D, 0xD967, 0x4B72, 0xDE94, 0xD498, 0xE8B0, 0x4A85, ++ 0x6BBB, 0x2AC5, 0xE54F, 0x16ED, 0xC586, 0xD79A, 0x5566, 0x9411, ++ 0xCF8A, 0x10E9, 0x0604, 0x81FE, 0xF0A0, 0x4478, 0xBA25, 0xE34B, ++ 0xF3A2, 0xFE5D, 0xC080, 0x8A05, 0xAD3F, 0xBC21, 0x4870, 0x04F1, ++ 0xDF63, 0xC177, 0x75AF, 0x6342, 0x3020, 0x1AE5, 0x0EFD, 0x6DBF, ++ 0x4C81, 0x1418, 0x3526, 0x2FC3, 0xE1BE, 0xA235, 0xCC88, 0x392E, ++ 0x5793, 0xF255, 0x82FC, 0x477A, 0xACC8, 0xE7BA, 0x2B32, 0x95E6, ++ 0xA0C0, 0x9819, 0xD19E, 0x7FA3, 0x6644, 0x7E54, 0xAB3B, 0x830B, ++ 0xCA8C, 0x29C7, 0xD36B, 0x3C28, 0x79A7, 0xE2BC, 0x1D16, 0x76AD, ++ 0x3BDB, 0x5664, 0x4E74, 0x1E14, 0xDB92, 0x0A0C, 0x6C48, 0xE4B8, ++ 0x5D9F, 0x6EBD, 0xEF43, 0xA6C4, 0xA839, 0xA431, 0x37D3, 0x8BF2, ++ 0x32D5, 0x438B, 0x596E, 0xB7DA, 0x8C01, 0x64B1, 0xD29C, 0xE049, ++ 0xB4D8, 0xFAAC, 0x07F3, 0x25CF, 0xAFCA, 0x8EF4, 0xE947, 0x1810, ++ 0xD56F, 0x88F0, 0x6F4A, 0x725C, 0x2438, 0xF157, 0xC773, 0x5197, ++ 0x23CB, 0x7CA1, 0x9CE8, 0x213E, 0xDD96, 0xDC61, 0x860D, 0x850F, ++ 0x90E0, 0x427C, 0xC471, 0xAACC, 0xD890, 0x0506, 0x01F7, 0x121C, ++ 0xA3C2, 0x5F6A, 0xF9AE, 0xD069, 0x9117, 0x5899, 0x273A, 0xB927, ++ 0x38D9, 0x13EB, 0xB32B, 0x3322, 0xBBD2, 0x70A9, 0x8907, 0xA733, ++ 0xB62D, 0x223C, 0x9215, 0x20C9, 0x4987, 0xFFAA, 0x7850, 0x7AA5, ++ 0x8F03, 0xF859, 0x8009, 0x171A, 0xDA65, 0x31D7, 0xC684, 0xB8D0, ++ 0xC382, 0xB029, 0x775A, 0x111E, 0xCB7B, 0xFCA8, 0xD66D, 0x3A2C, ++ } ++}; ++ ++/* ++********************************************************************** ++* Routine: Phase 1 -- generate P1K, given TA, TK, IV32 ++* ++* Inputs: ++* tk[] = temporal key [128 bits] ++* ta[] = transmitter's MAC address [ 48 bits] ++* iv32 = upper 32 bits of IV [ 32 bits] ++* Output: ++* p1k[] = Phase 1 key [ 80 bits] ++* ++* Note: ++* This function only needs to be called every 2**16 packets, ++* although in theory it could be called every packet. ++* ++********************************************************************** ++*/ ++static void phase1(u16 *p1k, const u8 *tk, const u8 *ta, u32 iv32) ++{ ++ sint i; ++ /* Initialize the 80 bits of P1K[] from IV32 and TA[0..5] */ ++ p1k[0] = Lo16(iv32); ++ p1k[1] = Hi16(iv32); ++ p1k[2] = Mk16(ta[1], ta[0]); /* use TA[] as little-endian */ ++ p1k[3] = Mk16(ta[3], ta[2]); ++ p1k[4] = Mk16(ta[5], ta[4]); ++ ++ /* Now compute an unbalanced Feistel cipher with 80-bit block */ ++ /* size on the 80-bit block P1K[], using the 128-bit key TK[] */ ++ for (i = 0; i < PHASE1_LOOP_CNT ; i++) { ++ /* Each add operation here is mod 2**16 */ ++ p1k[0] += _S_(p1k[4] ^ TK16((i & 1) + 0)); ++ p1k[1] += _S_(p1k[0] ^ TK16((i & 1) + 2)); ++ p1k[2] += _S_(p1k[1] ^ TK16((i & 1) + 4)); ++ p1k[3] += _S_(p1k[2] ^ TK16((i & 1) + 6)); ++ p1k[4] += _S_(p1k[3] ^ TK16((i & 1) + 0)); ++ p1k[4] += (unsigned short)i; /* avoid "slide attacks" */ ++ } ++} ++ ++ ++/* ++********************************************************************** ++* Routine: Phase 2 -- generate RC4KEY, given TK, P1K, IV16 ++* ++* Inputs: ++* tk[] = Temporal key [128 bits] ++* p1k[] = Phase 1 output key [ 80 bits] ++* iv16 = low 16 bits of IV counter [ 16 bits] ++* Output: ++* rc4key[] = the key used to encrypt the packet [128 bits] ++* ++* Note: ++* The value {TA,IV32,IV16} for Phase1/Phase2 must be unique ++* across all packets using the same key TK value. Then, for a ++* given value of TK[], this TKIP48 construction guarantees that ++* the final RC4KEY value is unique across all packets. ++* ++* Suggested implementation optimization: if PPK[] is "overlaid" ++* appropriately on RC4KEY[], there is no need for the final ++* for loop below that copies the PPK[] result into RC4KEY[]. ++* ++********************************************************************** ++*/ ++static void phase2(u8 *rc4key, const u8 *tk, const u16 *p1k, u16 iv16) ++{ ++ sint i; ++ u16 PPK[6]; /* temporary key for mixing */ ++ /* Note: all adds in the PPK[] equations below are mod 2**16 */ ++ for (i = 0; i < 5; i++) ++ PPK[i] = p1k[i]; /* first, copy P1K to PPK */ ++ PPK[5] = p1k[4] + iv16; /* next, add in IV16 */ ++ ++ /* Bijective non-linear mixing of the 96 bits of PPK[0..5] */ ++ PPK[0] += _S_(PPK[5] ^ TK16(0)); /* Mix key in each "round" */ ++ PPK[1] += _S_(PPK[0] ^ TK16(1)); ++ PPK[2] += _S_(PPK[1] ^ TK16(2)); ++ PPK[3] += _S_(PPK[2] ^ TK16(3)); ++ PPK[4] += _S_(PPK[3] ^ TK16(4)); ++ PPK[5] += _S_(PPK[4] ^ TK16(5)); /* Total # S-box lookups == 6 */ ++ ++ /* Final sweep: bijective, "linear". Rotates kill LSB correlations */ ++ PPK[0] += RotR1(PPK[5] ^ TK16(6)); ++ PPK[1] += RotR1(PPK[0] ^ TK16(7)); /* Use all of TK[] in Phase2 */ ++ PPK[2] += RotR1(PPK[1]); ++ PPK[3] += RotR1(PPK[2]); ++ PPK[4] += RotR1(PPK[3]); ++ PPK[5] += RotR1(PPK[4]); ++ /* Note: At this point, for a given key TK[0..15], the 96-bit output */ ++ /* value PPK[0..5] is guaranteed to be unique, as a function */ ++ /* of the 96-bit "input" value {TA,IV32,IV16}. That is, P1K */ ++ /* is now a keyed permutation of {TA,IV32,IV16}. */ ++ ++ /* Set RC4KEY[0..3], which includes "cleartext" portion of RC4 key */ ++ rc4key[0] = Hi8(iv16); /* RC4KEY[0..2] is the WEP IV */ ++ rc4key[1] = (Hi8(iv16) | 0x20) & 0x7F; /* Help avoid weak (FMS) keys */ ++ rc4key[2] = Lo8(iv16); ++ rc4key[3] = Lo8((PPK[5] ^ TK16(0)) >> 1); ++ ++ ++ /* Copy 96 bits of PPK[0..5] to RC4KEY[4..15] (little-endian) */ ++ for (i = 0; i < 6; i++) { ++ rc4key[4 + 2 * i] = Lo8(PPK[i]); ++ rc4key[5 + 2 * i] = Hi8(PPK[i]); ++ } ++} ++ ++ ++/* The hlen isn't include the IV */ ++u32 rtw_tkip_encrypt(_adapter *padapter, u8 *pxmitframe) ++{ ++ /* exclude ICV */ ++ u16 pnl; ++ u32 pnh; ++ u8 rc4key[16]; ++ u8 ttkey[16]; ++ u8 crc[4]; ++ u8 hw_hdr_offset = 0; ++ struct arc4context mycontext; ++ sint curfragnum, length; ++ u32 prwskeylen; ++ ++ u8 *pframe, *payload, *iv, *prwskey; ++ union pn48 dot11txpn; ++ /* struct sta_info *stainfo; */ ++ struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ u32 res = _SUCCESS; ++ ++ if (((struct xmit_frame *)pxmitframe)->buf_addr == NULL) ++ return _FAIL; ++ ++#ifdef CONFIG_USB_TX_AGGREGATION ++ hw_hdr_offset = TXDESC_SIZE + ++ (((struct xmit_frame *)pxmitframe)->pkt_offset * PACKET_OFFSET_SZ); ++#else ++#ifdef CONFIG_TX_EARLY_MODE ++ hw_hdr_offset = TXDESC_OFFSET + EARLY_MODE_INFO_SIZE; ++#else ++ hw_hdr_offset = TXDESC_OFFSET; ++#endif ++#endif ++ ++ pframe = ((struct xmit_frame *)pxmitframe)->buf_addr + hw_hdr_offset; ++ /* 4 start to encrypt each fragment */ ++ if (pattrib->encrypt == _TKIP_) { ++ ++ /* ++ if(pattrib->psta) ++ { ++ stainfo = pattrib->psta; ++ } ++ else ++ { ++ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); ++ stainfo=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0] ); ++ } ++ */ ++ /* if (stainfo!=NULL) */ ++ { ++ /* ++ if(!(stainfo->state &_FW_LINKED)) ++ { ++ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, stainfo->state); ++ return _FAIL; ++ } ++ */ ++ ++ if (IS_MCAST(pattrib->ra)) ++ prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; ++ else { ++ /* prwskey=&stainfo->dot118021x_UncstKey.skey[0]; */ ++ prwskey = pattrib->dot118021x_UncstKey.skey; ++ } ++ ++ prwskeylen = 16; ++ ++ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { ++ iv = pframe + pattrib->hdrlen; ++ payload = pframe + pattrib->iv_len + pattrib->hdrlen; ++ ++ GET_TKIP_PN(iv, dot11txpn); ++ ++ pnl = (u16)(dot11txpn.val); ++ pnh = (u32)(dot11txpn.val >> 16); ++ ++ phase1((u16 *)&ttkey[0], prwskey, &pattrib->ta[0], pnh); ++ ++ phase2(&rc4key[0], prwskey, (u16 *)&ttkey[0], pnl); ++ ++ if ((curfragnum + 1) == pattrib->nr_frags) { /* 4 the last fragment */ ++ length = pattrib->last_txcmdsz - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; ++ *((u32 *)crc) = cpu_to_le32(getcrc32(payload, length)); /* modified by Amy*/ ++ ++ arcfour_init(&mycontext, rc4key, 16); ++ arcfour_encrypt(&mycontext, payload, payload, length); ++ arcfour_encrypt(&mycontext, payload + length, crc, 4); ++ ++ } else { ++ length = pxmitpriv->frag_len - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len ; ++ *((u32 *)crc) = cpu_to_le32(getcrc32(payload, length)); /* modified by Amy*/ ++ arcfour_init(&mycontext, rc4key, 16); ++ arcfour_encrypt(&mycontext, payload, payload, length); ++ arcfour_encrypt(&mycontext, payload + length, crc, 4); ++ ++ pframe += pxmitpriv->frag_len; ++ pframe = (u8 *)RND4((SIZE_PTR)(pframe)); ++ ++ } ++ } ++ ++ TKIP_SW_ENC_CNT_INC(psecuritypriv, pattrib->ra); ++ } ++ /* ++ else{ ++ RTW_INFO("%s, psta==NUL\n", __func__); ++ res=_FAIL; ++ } ++ */ ++ ++ } ++ return res; ++ ++} ++ ++ ++/* The hlen isn't include the IV */ ++u32 rtw_tkip_decrypt(_adapter *padapter, u8 *precvframe) ++{ ++ /* exclude ICV */ ++ u16 pnl; ++ u32 pnh; ++ u8 rc4key[16]; ++ u8 ttkey[16]; ++ u8 crc[4]; ++ struct arc4context mycontext; ++ sint length; ++ u32 prwskeylen; ++ ++ u8 *pframe, *payload, *iv, *prwskey; ++ union pn48 dot11txpn; ++ struct sta_info *stainfo; ++ struct rx_pkt_attrib *prxattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ /* struct recv_priv *precvpriv=&padapter->recvpriv; */ ++ u32 res = _SUCCESS; ++ ++ ++ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; ++ ++ /* 4 start to decrypt recvframe */ ++ if (prxattrib->encrypt == _TKIP_) { ++ ++ stainfo = rtw_get_stainfo(&padapter->stapriv , &prxattrib->ta[0]); ++ if (stainfo != NULL) { ++ ++ if (IS_MCAST(prxattrib->ra)) { ++ static u32 start = 0; ++ static u32 no_gkey_bc_cnt = 0; ++ static u32 no_gkey_mc_cnt = 0; ++ ++ if (psecuritypriv->binstallGrpkey == _FALSE) { ++ res = _FAIL; ++ ++ if (start == 0) ++ start = rtw_get_current_time(); ++ ++ if (is_broadcast_mac_addr(prxattrib->ra)) ++ no_gkey_bc_cnt++; ++ else ++ no_gkey_mc_cnt++; ++ ++ if (rtw_get_passing_time_ms(start) > 1000) { ++ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { ++ RTW_PRINT(FUNC_ADPT_FMT" no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", ++ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); ++ } ++ start = rtw_get_current_time(); ++ no_gkey_bc_cnt = 0; ++ no_gkey_mc_cnt = 0; ++ } ++ goto exit; ++ } ++ ++ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { ++ RTW_PRINT(FUNC_ADPT_FMT" gkey installed. no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", ++ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); ++ } ++ start = 0; ++ no_gkey_bc_cnt = 0; ++ no_gkey_mc_cnt = 0; ++ ++ /* RTW_INFO("rx bc/mc packets, to perform sw rtw_tkip_decrypt\n"); */ ++ /* prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; */ ++ prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; ++ prwskeylen = 16; ++ } else { ++ prwskey = &stainfo->dot118021x_UncstKey.skey[0]; ++ prwskeylen = 16; ++ } ++ ++ iv = pframe + prxattrib->hdrlen; ++ payload = pframe + prxattrib->iv_len + prxattrib->hdrlen; ++ length = ((union recv_frame *)precvframe)->u.hdr.len - prxattrib->hdrlen - prxattrib->iv_len; ++ ++ GET_TKIP_PN(iv, dot11txpn); ++ ++ pnl = (u16)(dot11txpn.val); ++ pnh = (u32)(dot11txpn.val >> 16); ++ ++ phase1((u16 *)&ttkey[0], prwskey, &prxattrib->ta[0], pnh); ++ phase2(&rc4key[0], prwskey, (unsigned short *)&ttkey[0], pnl); ++ ++ /* 4 decrypt payload include icv */ ++ ++ arcfour_init(&mycontext, rc4key, 16); ++ arcfour_encrypt(&mycontext, payload, payload, length); ++ ++ *((u32 *)crc) = le32_to_cpu(getcrc32(payload, length - 4)); ++ ++ if (crc[3] != payload[length - 1] || crc[2] != payload[length - 2] || crc[1] != payload[length - 3] || crc[0] != payload[length - 4]) { ++ res = _FAIL; ++ } ++ ++ TKIP_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); ++ } else { ++ res = _FAIL; ++ } ++ ++ } ++exit: ++ return res; ++ ++} ++ ++ ++/* 3 =====AES related===== */ ++ ++ ++ ++#define MAX_MSG_SIZE 2048 ++/*****************************/ ++/******** SBOX Table *********/ ++/*****************************/ ++ ++static u8 sbox_table[256] = { ++ 0x63, 0x7c, 0x77, 0x7b, 0xf2, 0x6b, 0x6f, 0xc5, ++ 0x30, 0x01, 0x67, 0x2b, 0xfe, 0xd7, 0xab, 0x76, ++ 0xca, 0x82, 0xc9, 0x7d, 0xfa, 0x59, 0x47, 0xf0, ++ 0xad, 0xd4, 0xa2, 0xaf, 0x9c, 0xa4, 0x72, 0xc0, ++ 0xb7, 0xfd, 0x93, 0x26, 0x36, 0x3f, 0xf7, 0xcc, ++ 0x34, 0xa5, 0xe5, 0xf1, 0x71, 0xd8, 0x31, 0x15, ++ 0x04, 0xc7, 0x23, 0xc3, 0x18, 0x96, 0x05, 0x9a, ++ 0x07, 0x12, 0x80, 0xe2, 0xeb, 0x27, 0xb2, 0x75, ++ 0x09, 0x83, 0x2c, 0x1a, 0x1b, 0x6e, 0x5a, 0xa0, ++ 0x52, 0x3b, 0xd6, 0xb3, 0x29, 0xe3, 0x2f, 0x84, ++ 0x53, 0xd1, 0x00, 0xed, 0x20, 0xfc, 0xb1, 0x5b, ++ 0x6a, 0xcb, 0xbe, 0x39, 0x4a, 0x4c, 0x58, 0xcf, ++ 0xd0, 0xef, 0xaa, 0xfb, 0x43, 0x4d, 0x33, 0x85, ++ 0x45, 0xf9, 0x02, 0x7f, 0x50, 0x3c, 0x9f, 0xa8, ++ 0x51, 0xa3, 0x40, 0x8f, 0x92, 0x9d, 0x38, 0xf5, ++ 0xbc, 0xb6, 0xda, 0x21, 0x10, 0xff, 0xf3, 0xd2, ++ 0xcd, 0x0c, 0x13, 0xec, 0x5f, 0x97, 0x44, 0x17, ++ 0xc4, 0xa7, 0x7e, 0x3d, 0x64, 0x5d, 0x19, 0x73, ++ 0x60, 0x81, 0x4f, 0xdc, 0x22, 0x2a, 0x90, 0x88, ++ 0x46, 0xee, 0xb8, 0x14, 0xde, 0x5e, 0x0b, 0xdb, ++ 0xe0, 0x32, 0x3a, 0x0a, 0x49, 0x06, 0x24, 0x5c, ++ 0xc2, 0xd3, 0xac, 0x62, 0x91, 0x95, 0xe4, 0x79, ++ 0xe7, 0xc8, 0x37, 0x6d, 0x8d, 0xd5, 0x4e, 0xa9, ++ 0x6c, 0x56, 0xf4, 0xea, 0x65, 0x7a, 0xae, 0x08, ++ 0xba, 0x78, 0x25, 0x2e, 0x1c, 0xa6, 0xb4, 0xc6, ++ 0xe8, 0xdd, 0x74, 0x1f, 0x4b, 0xbd, 0x8b, 0x8a, ++ 0x70, 0x3e, 0xb5, 0x66, 0x48, 0x03, 0xf6, 0x0e, ++ 0x61, 0x35, 0x57, 0xb9, 0x86, 0xc1, 0x1d, 0x9e, ++ 0xe1, 0xf8, 0x98, 0x11, 0x69, 0xd9, 0x8e, 0x94, ++ 0x9b, 0x1e, 0x87, 0xe9, 0xce, 0x55, 0x28, 0xdf, ++ 0x8c, 0xa1, 0x89, 0x0d, 0xbf, 0xe6, 0x42, 0x68, ++ 0x41, 0x99, 0x2d, 0x0f, 0xb0, 0x54, 0xbb, 0x16 ++}; ++ ++/*****************************/ ++/**** Function Prototypes ****/ ++/*****************************/ ++ ++static void bitwise_xor(u8 *ina, u8 *inb, u8 *out); ++static void construct_mic_iv( ++ u8 *mic_header1, ++ sint qc_exists, ++ sint a4_exists, ++ u8 *mpdu, ++ uint payload_length, ++ u8 *pn_vector, ++ uint frtype);/* add for CONFIG_IEEE80211W, none 11w also can use */ ++static void construct_mic_header1( ++ u8 *mic_header1, ++ sint header_length, ++ u8 *mpdu, ++ uint frtype);/* add for CONFIG_IEEE80211W, none 11w also can use */ ++static void construct_mic_header2( ++ u8 *mic_header2, ++ u8 *mpdu, ++ sint a4_exists, ++ sint qc_exists); ++static void construct_ctr_preload( ++ u8 *ctr_preload, ++ sint a4_exists, ++ sint qc_exists, ++ u8 *mpdu, ++ u8 *pn_vector, ++ sint c, ++ uint frtype);/* add for CONFIG_IEEE80211W, none 11w also can use */ ++static void xor_128(u8 *a, u8 *b, u8 *out); ++static void xor_32(u8 *a, u8 *b, u8 *out); ++static u8 sbox(u8 a); ++static void next_key(u8 *key, sint round); ++static void byte_sub(u8 *in, u8 *out); ++static void shift_row(u8 *in, u8 *out); ++static void mix_column(u8 *in, u8 *out); ++#ifndef PLATFORM_FREEBSD ++static void add_round_key(u8 *shiftrow_in, ++ u8 *mcol_in, ++ u8 *block_in, ++ sint round, ++ u8 *out); ++#endif /* PLATFORM_FREEBSD */ ++static void aes128k128d(u8 *key, u8 *data, u8 *ciphertext); ++ ++ ++/****************************************/ ++/* aes128k128d() */ ++/* Performs a 128 bit AES encrypt with */ ++/* 128 bit data. */ ++/****************************************/ ++static void xor_128(u8 *a, u8 *b, u8 *out) ++{ ++ sint i; ++ for (i = 0; i < 16; i++) ++ out[i] = a[i] ^ b[i]; ++} ++ ++ ++static void xor_32(u8 *a, u8 *b, u8 *out) ++{ ++ sint i; ++ for (i = 0; i < 4; i++) ++ out[i] = a[i] ^ b[i]; ++} ++ ++ ++static u8 sbox(u8 a) ++{ ++ return sbox_table[(sint)a]; ++} ++ ++ ++static void next_key(u8 *key, sint round) ++{ ++ u8 rcon; ++ u8 sbox_key[4]; ++ u8 rcon_table[12] = { ++ 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, ++ 0x1b, 0x36, 0x36, 0x36 ++ }; ++ sbox_key[0] = sbox(key[13]); ++ sbox_key[1] = sbox(key[14]); ++ sbox_key[2] = sbox(key[15]); ++ sbox_key[3] = sbox(key[12]); ++ ++ rcon = rcon_table[round]; ++ ++ xor_32(&key[0], sbox_key, &key[0]); ++ key[0] = key[0] ^ rcon; ++ ++ xor_32(&key[4], &key[0], &key[4]); ++ xor_32(&key[8], &key[4], &key[8]); ++ xor_32(&key[12], &key[8], &key[12]); ++} ++ ++ ++static void byte_sub(u8 *in, u8 *out) ++{ ++ sint i; ++ for (i = 0; i < 16; i++) ++ out[i] = sbox(in[i]); ++} ++ ++ ++static void shift_row(u8 *in, u8 *out) ++{ ++ out[0] = in[0]; ++ out[1] = in[5]; ++ out[2] = in[10]; ++ out[3] = in[15]; ++ out[4] = in[4]; ++ out[5] = in[9]; ++ out[6] = in[14]; ++ out[7] = in[3]; ++ out[8] = in[8]; ++ out[9] = in[13]; ++ out[10] = in[2]; ++ out[11] = in[7]; ++ out[12] = in[12]; ++ out[13] = in[1]; ++ out[14] = in[6]; ++ out[15] = in[11]; ++} ++ ++ ++static void mix_column(u8 *in, u8 *out) ++{ ++ sint i; ++ u8 add1b[4]; ++ u8 add1bf7[4]; ++ u8 rotl[4]; ++ u8 swap_halfs[4]; ++ u8 andf7[4]; ++ u8 rotr[4]; ++ u8 temp[4]; ++ u8 tempb[4]; ++ for (i = 0 ; i < 4; i++) { ++ if ((in[i] & 0x80) == 0x80) ++ add1b[i] = 0x1b; ++ else ++ add1b[i] = 0x00; ++ } ++ ++ swap_halfs[0] = in[2]; /* Swap halfs */ ++ swap_halfs[1] = in[3]; ++ swap_halfs[2] = in[0]; ++ swap_halfs[3] = in[1]; ++ ++ rotl[0] = in[3]; /* Rotate left 8 bits */ ++ rotl[1] = in[0]; ++ rotl[2] = in[1]; ++ rotl[3] = in[2]; ++ ++ andf7[0] = in[0] & 0x7f; ++ andf7[1] = in[1] & 0x7f; ++ andf7[2] = in[2] & 0x7f; ++ andf7[3] = in[3] & 0x7f; ++ ++ for (i = 3; i > 0; i--) { /* logical shift left 1 bit */ ++ andf7[i] = andf7[i] << 1; ++ if ((andf7[i - 1] & 0x80) == 0x80) ++ andf7[i] = (andf7[i] | 0x01); ++ } ++ andf7[0] = andf7[0] << 1; ++ andf7[0] = andf7[0] & 0xfe; ++ ++ xor_32(add1b, andf7, add1bf7); ++ ++ xor_32(in, add1bf7, rotr); ++ ++ temp[0] = rotr[0]; /* Rotate right 8 bits */ ++ rotr[0] = rotr[1]; ++ rotr[1] = rotr[2]; ++ rotr[2] = rotr[3]; ++ rotr[3] = temp[0]; ++ ++ xor_32(add1bf7, rotr, temp); ++ xor_32(swap_halfs, rotl, tempb); ++ xor_32(temp, tempb, out); ++} ++ ++ ++static void aes128k128d(u8 *key, u8 *data, u8 *ciphertext) ++{ ++ sint round; ++ sint i; ++ u8 intermediatea[16]; ++ u8 intermediateb[16]; ++ u8 round_key[16]; ++ for (i = 0; i < 16; i++) ++ round_key[i] = key[i]; ++ ++ for (round = 0; round < 11; round++) { ++ if (round == 0) { ++ xor_128(round_key, data, ciphertext); ++ next_key(round_key, round); ++ } else if (round == 10) { ++ byte_sub(ciphertext, intermediatea); ++ shift_row(intermediatea, intermediateb); ++ xor_128(intermediateb, round_key, ciphertext); ++ } else { /* 1 - 9 */ ++ byte_sub(ciphertext, intermediatea); ++ shift_row(intermediatea, intermediateb); ++ mix_column(&intermediateb[0], &intermediatea[0]); ++ mix_column(&intermediateb[4], &intermediatea[4]); ++ mix_column(&intermediateb[8], &intermediatea[8]); ++ mix_column(&intermediateb[12], &intermediatea[12]); ++ xor_128(intermediatea, round_key, ciphertext); ++ next_key(round_key, round); ++ } ++ } ++} ++ ++ ++/************************************************/ ++/* construct_mic_iv() */ ++/* Builds the MIC IV from header fields and PN */ ++/* Baron think the function is construct CCM */ ++/* nonce */ ++/************************************************/ ++static void construct_mic_iv( ++ u8 *mic_iv, ++ sint qc_exists, ++ sint a4_exists, ++ u8 *mpdu, ++ uint payload_length, ++ u8 *pn_vector, ++ uint frtype/* add for CONFIG_IEEE80211W, none 11w also can use */ ++) ++{ ++ sint i; ++ mic_iv[0] = 0x59; ++ if (qc_exists && a4_exists) ++ mic_iv[1] = mpdu[30] & 0x0f; /* QoS_TC */ ++ if (qc_exists && !a4_exists) ++ mic_iv[1] = mpdu[24] & 0x0f; /* mute bits 7-4 */ ++ if (!qc_exists) ++ mic_iv[1] = 0x00; ++#ifdef CONFIG_IEEE80211W ++ /* 802.11w management frame should set management bit(4) */ ++ if (frtype == WIFI_MGT_TYPE) ++ mic_iv[1] |= BIT(4); ++#endif /* CONFIG_IEEE80211W */ ++ for (i = 2; i < 8; i++) ++ mic_iv[i] = mpdu[i + 8]; /* mic_iv[2:7] = A2[0:5] = mpdu[10:15] */ ++#ifdef CONSISTENT_PN_ORDER ++ for (i = 8; i < 14; i++) ++ mic_iv[i] = pn_vector[i - 8]; /* mic_iv[8:13] = PN[0:5] */ ++#else ++ for (i = 8; i < 14; i++) ++ mic_iv[i] = pn_vector[13 - i]; /* mic_iv[8:13] = PN[5:0] */ ++#endif ++ mic_iv[14] = (unsigned char)(payload_length / 256); ++ mic_iv[15] = (unsigned char)(payload_length % 256); ++} ++ ++ ++/************************************************/ ++/* construct_mic_header1() */ ++/* Builds the first MIC header block from */ ++/* header fields. */ ++/* Build AAD SC,A1,A2 */ ++/************************************************/ ++static void construct_mic_header1( ++ u8 *mic_header1, ++ sint header_length, ++ u8 *mpdu, ++ uint frtype/* add for CONFIG_IEEE80211W, none 11w also can use */ ++) ++{ ++ mic_header1[0] = (u8)((header_length - 2) / 256); ++ mic_header1[1] = (u8)((header_length - 2) % 256); ++#ifdef CONFIG_IEEE80211W ++ /* 802.11w management frame don't AND subtype bits 4,5,6 of frame control field */ ++ if (frtype == WIFI_MGT_TYPE) ++ mic_header1[2] = mpdu[0]; ++ else ++#endif /* CONFIG_IEEE80211W */ ++ mic_header1[2] = mpdu[0] & 0xcf; /* Mute CF poll & CF ack bits */ ++ ++ mic_header1[3] = mpdu[1] & 0xc7; /* Mute retry, more data and pwr mgt bits */ ++ mic_header1[4] = mpdu[4]; /* A1 */ ++ mic_header1[5] = mpdu[5]; ++ mic_header1[6] = mpdu[6]; ++ mic_header1[7] = mpdu[7]; ++ mic_header1[8] = mpdu[8]; ++ mic_header1[9] = mpdu[9]; ++ mic_header1[10] = mpdu[10]; /* A2 */ ++ mic_header1[11] = mpdu[11]; ++ mic_header1[12] = mpdu[12]; ++ mic_header1[13] = mpdu[13]; ++ mic_header1[14] = mpdu[14]; ++ mic_header1[15] = mpdu[15]; ++} ++ ++ ++/************************************************/ ++/* construct_mic_header2() */ ++/* Builds the last MIC header block from */ ++/* header fields. */ ++/************************************************/ ++static void construct_mic_header2( ++ u8 *mic_header2, ++ u8 *mpdu, ++ sint a4_exists, ++ sint qc_exists ++) ++{ ++ sint i; ++ for (i = 0; i < 16; i++) ++ mic_header2[i] = 0x00; ++ ++ mic_header2[0] = mpdu[16]; /* A3 */ ++ mic_header2[1] = mpdu[17]; ++ mic_header2[2] = mpdu[18]; ++ mic_header2[3] = mpdu[19]; ++ mic_header2[4] = mpdu[20]; ++ mic_header2[5] = mpdu[21]; ++ ++ /* mic_header2[6] = mpdu[22] & 0xf0; SC */ ++ mic_header2[6] = 0x00; ++ mic_header2[7] = 0x00; /* mpdu[23]; */ ++ ++ ++ if (!qc_exists && a4_exists) { ++ for (i = 0; i < 6; i++) ++ mic_header2[8 + i] = mpdu[24 + i]; /* A4 */ ++ ++ } ++ ++ if (qc_exists && !a4_exists) { ++ mic_header2[8] = mpdu[24] & 0x0f; /* mute bits 15 - 4 */ ++ mic_header2[9] = mpdu[25] & 0x00; ++ } ++ ++ if (qc_exists && a4_exists) { ++ for (i = 0; i < 6; i++) ++ mic_header2[8 + i] = mpdu[24 + i]; /* A4 */ ++ ++ mic_header2[14] = mpdu[30] & 0x0f; ++ mic_header2[15] = mpdu[31] & 0x00; ++ } ++ ++} ++ ++ ++/************************************************/ ++/* construct_mic_header2() */ ++/* Builds the last MIC header block from */ ++/* header fields. */ ++/* Baron think the function is construct CCM */ ++/* nonce */ ++/************************************************/ ++static void construct_ctr_preload( ++ u8 *ctr_preload, ++ sint a4_exists, ++ sint qc_exists, ++ u8 *mpdu, ++ u8 *pn_vector, ++ sint c, ++ uint frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ ++) ++{ ++ sint i = 0; ++ for (i = 0; i < 16; i++) ++ ctr_preload[i] = 0x00; ++ i = 0; ++ ++ ctr_preload[0] = 0x01; /* flag */ ++ if (qc_exists && a4_exists) ++ ctr_preload[1] = mpdu[30] & 0x0f; /* QoC_Control */ ++ if (qc_exists && !a4_exists) ++ ctr_preload[1] = mpdu[24] & 0x0f; ++#ifdef CONFIG_IEEE80211W ++ /* 802.11w management frame should set management bit(4) */ ++ if (frtype == WIFI_MGT_TYPE) ++ ctr_preload[1] |= BIT(4); ++#endif /* CONFIG_IEEE80211W */ ++ for (i = 2; i < 8; i++) ++ ctr_preload[i] = mpdu[i + 8]; /* ctr_preload[2:7] = A2[0:5] = mpdu[10:15] */ ++#ifdef CONSISTENT_PN_ORDER ++ for (i = 8; i < 14; i++) ++ ctr_preload[i] = pn_vector[i - 8]; /* ctr_preload[8:13] = PN[0:5] */ ++#else ++ for (i = 8; i < 14; i++) ++ ctr_preload[i] = pn_vector[13 - i]; /* ctr_preload[8:13] = PN[5:0] */ ++#endif ++ ctr_preload[14] = (unsigned char)(c / 256); /* Ctr */ ++ ctr_preload[15] = (unsigned char)(c % 256); ++} ++ ++ ++/************************************/ ++/* bitwise_xor() */ ++/* A 128 bit, bitwise exclusive or */ ++/************************************/ ++static void bitwise_xor(u8 *ina, u8 *inb, u8 *out) ++{ ++ sint i; ++ for (i = 0; i < 16; i++) ++ out[i] = ina[i] ^ inb[i]; ++} ++ ++ ++static sint aes_cipher(u8 *key, uint hdrlen, ++ u8 *pframe, uint plen) ++{ ++ /* static unsigned char message[MAX_MSG_SIZE]; */ ++ uint qc_exists, a4_exists, i, j, payload_remainder, ++ num_blocks, payload_index; ++ ++ u8 pn_vector[6]; ++ u8 mic_iv[16]; ++ u8 mic_header1[16]; ++ u8 mic_header2[16]; ++ u8 ctr_preload[16]; ++ ++ /* Intermediate Buffers */ ++ u8 chain_buffer[16]; ++ u8 aes_out[16]; ++ u8 padded_buffer[16]; ++ u8 mic[8]; ++ /* uint offset = 0; */ ++ uint frtype = GetFrameType(pframe); ++ uint frsubtype = GetFrameSubType(pframe); ++ ++ frsubtype = frsubtype >> 4; ++ ++ ++ _rtw_memset((void *)mic_iv, 0, 16); ++ _rtw_memset((void *)mic_header1, 0, 16); ++ _rtw_memset((void *)mic_header2, 0, 16); ++ _rtw_memset((void *)ctr_preload, 0, 16); ++ _rtw_memset((void *)chain_buffer, 0, 16); ++ _rtw_memset((void *)aes_out, 0, 16); ++ _rtw_memset((void *)padded_buffer, 0, 16); ++ ++ if ((hdrlen == WLAN_HDR_A3_LEN) || (hdrlen == WLAN_HDR_A3_QOS_LEN)) ++ a4_exists = 0; ++ else ++ a4_exists = 1; ++ ++ if ( ++ ((frtype | frsubtype) == WIFI_DATA_CFACK) || ++ ((frtype | frsubtype) == WIFI_DATA_CFPOLL) || ++ ((frtype | frsubtype) == WIFI_DATA_CFACKPOLL)) { ++ qc_exists = 1; ++ if (hdrlen != WLAN_HDR_A3_QOS_LEN) ++ ++ hdrlen += 2; ++ } ++ /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ else if ((frtype == WIFI_DATA) && ++ ((frsubtype == 0x08) || ++ (frsubtype == 0x09) || ++ (frsubtype == 0x0a) || ++ (frsubtype == 0x0b))) { ++ if (hdrlen != WLAN_HDR_A3_QOS_LEN) ++ ++ hdrlen += 2; ++ qc_exists = 1; ++ } else ++ qc_exists = 0; ++ ++ pn_vector[0] = pframe[hdrlen]; ++ pn_vector[1] = pframe[hdrlen + 1]; ++ pn_vector[2] = pframe[hdrlen + 4]; ++ pn_vector[3] = pframe[hdrlen + 5]; ++ pn_vector[4] = pframe[hdrlen + 6]; ++ pn_vector[5] = pframe[hdrlen + 7]; ++ ++ construct_mic_iv( ++ mic_iv, ++ qc_exists, ++ a4_exists, ++ pframe, /* message, */ ++ plen, ++ pn_vector, ++ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ ); ++ ++ construct_mic_header1( ++ mic_header1, ++ hdrlen, ++ pframe, /* message */ ++ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ ); ++ construct_mic_header2( ++ mic_header2, ++ pframe, /* message, */ ++ a4_exists, ++ qc_exists ++ ); ++ ++ ++ payload_remainder = plen % 16; ++ num_blocks = plen / 16; ++ ++ /* Find start of payload */ ++ payload_index = (hdrlen + 8); ++ ++ /* Calculate MIC */ ++ aes128k128d(key, mic_iv, aes_out); ++ bitwise_xor(aes_out, mic_header1, chain_buffer); ++ aes128k128d(key, chain_buffer, aes_out); ++ bitwise_xor(aes_out, mic_header2, chain_buffer); ++ aes128k128d(key, chain_buffer, aes_out); ++ ++ for (i = 0; i < num_blocks; i++) { ++ bitwise_xor(aes_out, &pframe[payload_index], chain_buffer);/* bitwise_xor(aes_out, &message[payload_index], chain_buffer); */ ++ ++ payload_index += 16; ++ aes128k128d(key, chain_buffer, aes_out); ++ } ++ ++ /* Add on the final payload block if it needs padding */ ++ if (payload_remainder > 0) { ++ for (j = 0; j < 16; j++) ++ padded_buffer[j] = 0x00; ++ for (j = 0; j < payload_remainder; j++) { ++ padded_buffer[j] = pframe[payload_index++];/* padded_buffer[j] = message[payload_index++]; */ ++ } ++ bitwise_xor(aes_out, padded_buffer, chain_buffer); ++ aes128k128d(key, chain_buffer, aes_out); ++ ++ } ++ ++ for (j = 0 ; j < 8; j++) ++ mic[j] = aes_out[j]; ++ ++ /* Insert MIC into payload */ ++ for (j = 0; j < 8; j++) ++ pframe[payload_index + j] = mic[j]; /* message[payload_index+j] = mic[j]; */ ++ ++ payload_index = hdrlen + 8; ++ for (i = 0; i < num_blocks; i++) { ++ construct_ctr_preload( ++ ctr_preload, ++ a4_exists, ++ qc_exists, ++ pframe, /* message, */ ++ pn_vector, ++ i + 1, ++ frtype); /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ aes128k128d(key, ctr_preload, aes_out); ++ bitwise_xor(aes_out, &pframe[payload_index], chain_buffer);/* bitwise_xor(aes_out, &message[payload_index], chain_buffer); */ ++ for (j = 0; j < 16; j++) ++ pframe[payload_index++] = chain_buffer[j];/* for (j=0; j<16;j++) message[payload_index++] = chain_buffer[j]; */ ++ } ++ ++ if (payload_remainder > 0) { /* If there is a short final block, then pad it,*/ ++ /* encrypt it and copy the unpadded part back */ ++ construct_ctr_preload( ++ ctr_preload, ++ a4_exists, ++ qc_exists, ++ pframe, /* message, */ ++ pn_vector, ++ num_blocks + 1, ++ frtype); /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ ++ for (j = 0; j < 16; j++) ++ padded_buffer[j] = 0x00; ++ for (j = 0; j < payload_remainder; j++) { ++ padded_buffer[j] = pframe[payload_index + j]; /* padded_buffer[j] = message[payload_index+j]; */ ++ } ++ aes128k128d(key, ctr_preload, aes_out); ++ bitwise_xor(aes_out, padded_buffer, chain_buffer); ++ for (j = 0; j < payload_remainder; j++) ++ pframe[payload_index++] = chain_buffer[j];/* for (j=0; jattrib; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ /* uint offset = 0; */ ++ u32 res = _SUCCESS; ++ ++ if (((struct xmit_frame *)pxmitframe)->buf_addr == NULL) ++ return _FAIL; ++ ++#ifdef CONFIG_USB_TX_AGGREGATION ++ hw_hdr_offset = TXDESC_SIZE + ++ (((struct xmit_frame *)pxmitframe)->pkt_offset * PACKET_OFFSET_SZ); ++#else ++#ifdef CONFIG_TX_EARLY_MODE ++ hw_hdr_offset = TXDESC_OFFSET + EARLY_MODE_INFO_SIZE; ++#else ++ hw_hdr_offset = TXDESC_OFFSET; ++#endif ++#endif ++ ++ pframe = ((struct xmit_frame *)pxmitframe)->buf_addr + hw_hdr_offset; ++ ++ /* 4 start to encrypt each fragment */ ++ if ((pattrib->encrypt == _AES_)) { ++ /* ++ if(pattrib->psta) ++ { ++ stainfo = pattrib->psta; ++ } ++ else ++ { ++ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); ++ stainfo=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0] ); ++ } ++ */ ++ /* if (stainfo!=NULL) */ ++ { ++ /* ++ if(!(stainfo->state &_FW_LINKED)) ++ { ++ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, stainfo->state); ++ return _FAIL; ++ } ++ */ ++ ++ if (IS_MCAST(pattrib->ra)) ++ prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; ++ else { ++ /* prwskey=&stainfo->dot118021x_UncstKey.skey[0]; */ ++ prwskey = pattrib->dot118021x_UncstKey.skey; ++ } ++ ++#ifdef CONFIG_TDLS ++ { ++ /* Swencryption */ ++ struct sta_info *ptdls_sta; ++ ptdls_sta = rtw_get_stainfo(&padapter->stapriv , &pattrib->dst[0]); ++ if ((ptdls_sta != NULL) && (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) { ++ RTW_INFO("[%s] for tdls link\n", __FUNCTION__); ++ prwskey = &ptdls_sta->tpk.tk[0]; ++ } ++ } ++#endif /* CONFIG_TDLS */ ++ ++ prwskeylen = 16; ++ ++ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { ++ ++ if ((curfragnum + 1) == pattrib->nr_frags) { /* 4 the last fragment */ ++ length = pattrib->last_txcmdsz - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; ++ ++ aes_cipher(prwskey, pattrib->hdrlen, pframe, length); ++ } else { ++ length = pxmitpriv->frag_len - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len ; ++ ++ aes_cipher(prwskey, pattrib->hdrlen, pframe, length); ++ pframe += pxmitpriv->frag_len; ++ pframe = (u8 *)RND4((SIZE_PTR)(pframe)); ++ ++ } ++ } ++ ++ AES_SW_ENC_CNT_INC(psecuritypriv, pattrib->ra); ++ } ++ /* ++ else{ ++ RTW_INFO("%s, psta==NUL\n", __func__); ++ res=_FAIL; ++ } ++ */ ++ } ++ ++ ++ ++ return res; ++} ++ ++static sint aes_decipher(u8 *key, uint hdrlen, ++ u8 *pframe, uint plen) ++{ ++ static u8 message[MAX_MSG_SIZE]; ++ uint qc_exists, a4_exists, i, j, payload_remainder, ++ num_blocks, payload_index; ++ sint res = _SUCCESS; ++ u8 pn_vector[6]; ++ u8 mic_iv[16]; ++ u8 mic_header1[16]; ++ u8 mic_header2[16]; ++ u8 ctr_preload[16]; ++ ++ /* Intermediate Buffers */ ++ u8 chain_buffer[16]; ++ u8 aes_out[16]; ++ u8 padded_buffer[16]; ++ u8 mic[8]; ++ ++ ++ /* uint offset = 0; */ ++ uint frtype = GetFrameType(pframe); ++ uint frsubtype = GetFrameSubType(pframe); ++ frsubtype = frsubtype >> 4; ++ ++ ++ _rtw_memset((void *)mic_iv, 0, 16); ++ _rtw_memset((void *)mic_header1, 0, 16); ++ _rtw_memset((void *)mic_header2, 0, 16); ++ _rtw_memset((void *)ctr_preload, 0, 16); ++ _rtw_memset((void *)chain_buffer, 0, 16); ++ _rtw_memset((void *)aes_out, 0, 16); ++ _rtw_memset((void *)padded_buffer, 0, 16); ++ ++ /* start to decrypt the payload */ ++ ++ num_blocks = (plen - 8) / 16; /* (plen including LLC, payload_length and mic ) */ ++ ++ payload_remainder = (plen - 8) % 16; ++ ++ pn_vector[0] = pframe[hdrlen]; ++ pn_vector[1] = pframe[hdrlen + 1]; ++ pn_vector[2] = pframe[hdrlen + 4]; ++ pn_vector[3] = pframe[hdrlen + 5]; ++ pn_vector[4] = pframe[hdrlen + 6]; ++ pn_vector[5] = pframe[hdrlen + 7]; ++ ++ if ((hdrlen == WLAN_HDR_A3_LEN) || (hdrlen == WLAN_HDR_A3_QOS_LEN)) ++ a4_exists = 0; ++ else ++ a4_exists = 1; ++ ++ if ( ++ ((frtype | frsubtype) == WIFI_DATA_CFACK) || ++ ((frtype | frsubtype) == WIFI_DATA_CFPOLL) || ++ ((frtype | frsubtype) == WIFI_DATA_CFACKPOLL)) { ++ qc_exists = 1; ++ if (hdrlen != WLAN_HDR_A3_QOS_LEN) ++ ++ hdrlen += 2; ++ } /* only for data packet . add for CONFIG_IEEE80211W, none 11w also can use */ ++ else if ((frtype == WIFI_DATA) && ++ ((frsubtype == 0x08) || ++ (frsubtype == 0x09) || ++ (frsubtype == 0x0a) || ++ (frsubtype == 0x0b))) { ++ if (hdrlen != WLAN_HDR_A3_QOS_LEN) ++ ++ hdrlen += 2; ++ qc_exists = 1; ++ } else ++ qc_exists = 0; ++ ++ ++ /* now, decrypt pframe with hdrlen offset and plen long */ ++ ++ payload_index = hdrlen + 8; /* 8 is for extiv */ ++ ++ for (i = 0; i < num_blocks; i++) { ++ construct_ctr_preload( ++ ctr_preload, ++ a4_exists, ++ qc_exists, ++ pframe, ++ pn_vector, ++ i + 1, ++ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ ); ++ ++ aes128k128d(key, ctr_preload, aes_out); ++ bitwise_xor(aes_out, &pframe[payload_index], chain_buffer); ++ ++ for (j = 0; j < 16; j++) ++ pframe[payload_index++] = chain_buffer[j]; ++ } ++ ++ if (payload_remainder > 0) { /* If there is a short final block, then pad it,*/ ++ /* encrypt it and copy the unpadded part back */ ++ construct_ctr_preload( ++ ctr_preload, ++ a4_exists, ++ qc_exists, ++ pframe, ++ pn_vector, ++ num_blocks + 1, ++ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ ); ++ ++ for (j = 0; j < 16; j++) ++ padded_buffer[j] = 0x00; ++ for (j = 0; j < payload_remainder; j++) ++ padded_buffer[j] = pframe[payload_index + j]; ++ aes128k128d(key, ctr_preload, aes_out); ++ bitwise_xor(aes_out, padded_buffer, chain_buffer); ++ for (j = 0; j < payload_remainder; j++) ++ pframe[payload_index++] = chain_buffer[j]; ++ } ++ ++ /* start to calculate the mic */ ++ if ((hdrlen + plen + 8) <= MAX_MSG_SIZE) ++ _rtw_memcpy((void *)message, pframe, (hdrlen + plen + 8)); /* 8 is for ext iv len */ ++ ++ ++ pn_vector[0] = pframe[hdrlen]; ++ pn_vector[1] = pframe[hdrlen + 1]; ++ pn_vector[2] = pframe[hdrlen + 4]; ++ pn_vector[3] = pframe[hdrlen + 5]; ++ pn_vector[4] = pframe[hdrlen + 6]; ++ pn_vector[5] = pframe[hdrlen + 7]; ++ ++ ++ ++ construct_mic_iv( ++ mic_iv, ++ qc_exists, ++ a4_exists, ++ message, ++ plen - 8, ++ pn_vector, ++ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ ); ++ ++ construct_mic_header1( ++ mic_header1, ++ hdrlen, ++ message, ++ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ ); ++ construct_mic_header2( ++ mic_header2, ++ message, ++ a4_exists, ++ qc_exists ++ ); ++ ++ ++ payload_remainder = (plen - 8) % 16; ++ num_blocks = (plen - 8) / 16; ++ ++ /* Find start of payload */ ++ payload_index = (hdrlen + 8); ++ ++ /* Calculate MIC */ ++ aes128k128d(key, mic_iv, aes_out); ++ bitwise_xor(aes_out, mic_header1, chain_buffer); ++ aes128k128d(key, chain_buffer, aes_out); ++ bitwise_xor(aes_out, mic_header2, chain_buffer); ++ aes128k128d(key, chain_buffer, aes_out); ++ ++ for (i = 0; i < num_blocks; i++) { ++ bitwise_xor(aes_out, &message[payload_index], chain_buffer); ++ ++ payload_index += 16; ++ aes128k128d(key, chain_buffer, aes_out); ++ } ++ ++ /* Add on the final payload block if it needs padding */ ++ if (payload_remainder > 0) { ++ for (j = 0; j < 16; j++) ++ padded_buffer[j] = 0x00; ++ for (j = 0; j < payload_remainder; j++) ++ padded_buffer[j] = message[payload_index++]; ++ bitwise_xor(aes_out, padded_buffer, chain_buffer); ++ aes128k128d(key, chain_buffer, aes_out); ++ ++ } ++ ++ for (j = 0 ; j < 8; j++) ++ mic[j] = aes_out[j]; ++ ++ /* Insert MIC into payload */ ++ for (j = 0; j < 8; j++) ++ message[payload_index + j] = mic[j]; ++ ++ payload_index = hdrlen + 8; ++ for (i = 0; i < num_blocks; i++) { ++ construct_ctr_preload( ++ ctr_preload, ++ a4_exists, ++ qc_exists, ++ message, ++ pn_vector, ++ i + 1, ++ frtype); /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ aes128k128d(key, ctr_preload, aes_out); ++ bitwise_xor(aes_out, &message[payload_index], chain_buffer); ++ for (j = 0; j < 16; j++) ++ message[payload_index++] = chain_buffer[j]; ++ } ++ ++ if (payload_remainder > 0) { /* If there is a short final block, then pad it,*/ ++ /* encrypt it and copy the unpadded part back */ ++ construct_ctr_preload( ++ ctr_preload, ++ a4_exists, ++ qc_exists, ++ message, ++ pn_vector, ++ num_blocks + 1, ++ frtype); /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ ++ for (j = 0; j < 16; j++) ++ padded_buffer[j] = 0x00; ++ for (j = 0; j < payload_remainder; j++) ++ padded_buffer[j] = message[payload_index + j]; ++ aes128k128d(key, ctr_preload, aes_out); ++ bitwise_xor(aes_out, padded_buffer, chain_buffer); ++ for (j = 0; j < payload_remainder; j++) ++ message[payload_index++] = chain_buffer[j]; ++ } ++ ++ /* Encrypt the MIC */ ++ construct_ctr_preload( ++ ctr_preload, ++ a4_exists, ++ qc_exists, ++ message, ++ pn_vector, ++ 0, ++ frtype); /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ ++ for (j = 0; j < 16; j++) ++ padded_buffer[j] = 0x00; ++ for (j = 0; j < 8; j++) ++ padded_buffer[j] = message[j + hdrlen + 8 + plen - 8]; ++ ++ aes128k128d(key, ctr_preload, aes_out); ++ bitwise_xor(aes_out, padded_buffer, chain_buffer); ++ for (j = 0; j < 8; j++) ++ message[payload_index++] = chain_buffer[j]; ++ ++ /* compare the mic */ ++ for (i = 0; i < 8; i++) { ++ if (pframe[hdrlen + 8 + plen - 8 + i] != message[hdrlen + 8 + plen - 8 + i]) { ++ RTW_INFO("aes_decipher:mic check error mic[%d]: pframe(%x) != message(%x)\n", ++ i, pframe[hdrlen + 8 + plen - 8 + i], message[hdrlen + 8 + plen - 8 + i]); ++ res = _FAIL; ++ } ++ } ++ return res; ++} ++ ++u32 rtw_aes_decrypt(_adapter *padapter, u8 *precvframe) ++{ ++ /* exclude ICV */ ++ ++ ++ /*static*/ ++ /* unsigned char message[MAX_MSG_SIZE]; */ ++ ++ ++ /* Intermediate Buffers */ ++ ++ ++ sint length; ++ u32 prwskeylen; ++ u8 *pframe, *prwskey; /* , *payload,*iv */ ++ struct sta_info *stainfo; ++ struct rx_pkt_attrib *prxattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ /* struct recv_priv *precvpriv=&padapter->recvpriv; */ ++ u32 res = _SUCCESS; ++ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; ++ /* 4 start to encrypt each fragment */ ++ if ((prxattrib->encrypt == _AES_)) { ++ ++ stainfo = rtw_get_stainfo(&padapter->stapriv , &prxattrib->ta[0]); ++ if (stainfo != NULL) { ++ ++ if (IS_MCAST(prxattrib->ra)) { ++ static u32 start = 0; ++ static u32 no_gkey_bc_cnt = 0; ++ static u32 no_gkey_mc_cnt = 0; ++ ++ /* RTW_INFO("rx bc/mc packets, to perform sw rtw_aes_decrypt\n"); */ ++ /* prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; */ ++ if (psecuritypriv->binstallGrpkey == _FALSE) { ++ res = _FAIL; ++ ++ if (start == 0) ++ start = rtw_get_current_time(); ++ ++ if (is_broadcast_mac_addr(prxattrib->ra)) ++ no_gkey_bc_cnt++; ++ else ++ no_gkey_mc_cnt++; ++ ++ if (rtw_get_passing_time_ms(start) > 1000) { ++ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { ++ RTW_PRINT(FUNC_ADPT_FMT" no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", ++ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); ++ } ++ start = rtw_get_current_time(); ++ no_gkey_bc_cnt = 0; ++ no_gkey_mc_cnt = 0; ++ } ++ ++ goto exit; ++ } ++ ++ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { ++ RTW_PRINT(FUNC_ADPT_FMT" gkey installed. no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", ++ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); ++ } ++ start = 0; ++ no_gkey_bc_cnt = 0; ++ no_gkey_mc_cnt = 0; ++ ++ prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; ++ if (psecuritypriv->dot118021XGrpKeyid != prxattrib->key_index) { ++ RTW_INFO("not match packet_index=%d, install_index=%d\n" ++ , prxattrib->key_index, psecuritypriv->dot118021XGrpKeyid); ++ res = _FAIL; ++ goto exit; ++ } ++ } else ++ prwskey = &stainfo->dot118021x_UncstKey.skey[0]; ++ ++ length = ((union recv_frame *)precvframe)->u.hdr.len - prxattrib->hdrlen - prxattrib->iv_len; ++#if 0 ++ /* add for CONFIG_IEEE80211W, debug */ ++ if (0) ++ printk("@@@@@@@@@@@@@@@@@@ length=%d, prxattrib->hdrlen=%d, prxattrib->pkt_len=%d\n" ++ , length, prxattrib->hdrlen, prxattrib->pkt_len); ++ if (0) { ++ int no; ++ /* test print PSK */ ++ printk("PSK key below:\n"); ++ for (no = 0; no < 16; no++) ++ printk(" %02x ", prwskey[no]); ++ printk("\n"); ++ } ++ if (0) { ++ int no; ++ /* test print PSK */ ++ printk("frame:\n"); ++ for (no = 0; no < prxattrib->pkt_len; no++) ++ printk(" %02x ", pframe[no]); ++ printk("\n"); ++ } ++#endif ++ ++ res = aes_decipher(prwskey, prxattrib->hdrlen, pframe, length); ++ ++ AES_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); ++ } else { ++ res = _FAIL; ++ } ++ ++ } ++exit: ++ return res; ++} ++ ++#ifdef CONFIG_IEEE80211W ++u32 rtw_BIP_verify(_adapter *padapter, u8 *precvframe) ++{ ++ struct rx_pkt_attrib *pattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; ++ u8 *pframe; ++ u8 *BIP_AAD, *p; ++ u32 res = _FAIL; ++ uint len, ori_len; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u8 mic[16]; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ori_len = pattrib->pkt_len - WLAN_HDR_A3_LEN + BIP_AAD_SIZE; ++ BIP_AAD = rtw_zmalloc(ori_len); ++ ++ if (BIP_AAD == NULL) { ++ RTW_INFO("BIP AAD allocate fail\n"); ++ return _FAIL; ++ } ++ /* PKT start */ ++ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; ++ /* mapping to wlan header */ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ /* save the frame body + MME */ ++ _rtw_memcpy(BIP_AAD + BIP_AAD_SIZE, pframe + WLAN_HDR_A3_LEN, pattrib->pkt_len - WLAN_HDR_A3_LEN); ++ /* find MME IE pointer */ ++ p = rtw_get_ie(BIP_AAD + BIP_AAD_SIZE, _MME_IE_, &len, pattrib->pkt_len - WLAN_HDR_A3_LEN); ++ /* Baron */ ++ if (p) { ++ u16 keyid = 0; ++ u64 temp_ipn = 0; ++ /* save packet number */ ++ _rtw_memcpy(&temp_ipn, p + 4, 6); ++ temp_ipn = le64_to_cpu(temp_ipn); ++ /* BIP packet number should bigger than previous BIP packet */ ++ if (temp_ipn < pmlmeext->mgnt_80211w_IPN_rx) { ++ RTW_INFO("replay BIP packet\n"); ++ goto BIP_exit; ++ } ++ /* copy key index */ ++ _rtw_memcpy(&keyid, p + 2, 2); ++ keyid = le16_to_cpu(keyid); ++ if (keyid != padapter->securitypriv.dot11wBIPKeyid) { ++ RTW_INFO("BIP key index error!\n"); ++ goto BIP_exit; ++ } ++ /* clear the MIC field of MME to zero */ ++ _rtw_memset(p + 2 + len - 8, 0, 8); ++ ++ /* conscruct AAD, copy frame control field */ ++ _rtw_memcpy(BIP_AAD, &pwlanhdr->frame_ctl, 2); ++ ClearRetry(BIP_AAD); ++ ClearPwrMgt(BIP_AAD); ++ ClearMData(BIP_AAD); ++ /* conscruct AAD, copy address 1 to address 3 */ ++ _rtw_memcpy(BIP_AAD + 2, pwlanhdr->addr1, 18); ++ ++ if (omac1_aes_128(padapter->securitypriv.dot11wBIPKey[padapter->securitypriv.dot11wBIPKeyid].skey ++ , BIP_AAD, ori_len, mic)) ++ goto BIP_exit; ++ ++#if 0 ++ /* management packet content */ ++ { ++ int pp; ++ RTW_INFO("pkt: "); ++ for (pp = 0; pp < pattrib->pkt_len; pp++) ++ printk(" %02x ", pframe[pp]); ++ RTW_INFO("\n"); ++ /* BIP AAD + management frame body + MME(MIC is zero) */ ++ RTW_INFO("AAD+PKT: "); ++ for (pp = 0; pp < ori_len; pp++) ++ RTW_INFO(" %02x ", BIP_AAD[pp]); ++ RTW_INFO("\n"); ++ /* show the MIC result */ ++ RTW_INFO("mic: "); ++ for (pp = 0; pp < 16; pp++) ++ RTW_INFO(" %02x ", mic[pp]); ++ RTW_INFO("\n"); ++ } ++#endif ++ /* MIC field should be last 8 bytes of packet (packet without FCS) */ ++ if (_rtw_memcmp(mic, pframe + pattrib->pkt_len - 8, 8)) { ++ pmlmeext->mgnt_80211w_IPN_rx = temp_ipn; ++ res = _SUCCESS; ++ } else ++ RTW_INFO("BIP MIC error!\n"); ++ ++ } else ++ res = RTW_RX_HANDLED; ++BIP_exit: ++ ++ rtw_mfree(BIP_AAD, ori_len); ++ return res; ++} ++#endif /* CONFIG_IEEE80211W */ ++ ++#ifndef PLATFORM_FREEBSD ++/* compress 512-bits */ ++static int sha256_compress(struct sha256_state *md, unsigned char *buf) ++{ ++ u32 S[8], W[64], t0, t1; ++ u32 t; ++ int i; ++ ++ /* copy state into S */ ++ for (i = 0; i < 8; i++) ++ S[i] = md->state[i]; ++ ++ /* copy the state into 512-bits into W[0..15] */ ++ for (i = 0; i < 16; i++) ++ W[i] = WPA_GET_BE32(buf + (4 * i)); ++ ++ /* fill W[16..63] */ ++ for (i = 16; i < 64; i++) { ++ W[i] = Gamma1(W[i - 2]) + W[i - 7] + Gamma0(W[i - 15]) + ++ W[i - 16]; ++ } ++ ++ /* Compress */ ++#define RND(a, b, c, d, e, f, g, h, i) do {\ ++ t0 = h + Sigma1(e) + Ch(e, f, g) + K[i] + W[i]; \ ++ t1 = Sigma0(a) + Maj(a, b, c); \ ++ d += t0; \ ++ h = t0 + t1; \ ++ } while (0) ++ ++ for (i = 0; i < 64; ++i) { ++ RND(S[0], S[1], S[2], S[3], S[4], S[5], S[6], S[7], i); ++ t = S[7]; ++ S[7] = S[6]; ++ S[6] = S[5]; ++ S[5] = S[4]; ++ S[4] = S[3]; ++ S[3] = S[2]; ++ S[2] = S[1]; ++ S[1] = S[0]; ++ S[0] = t; ++ } ++ ++ /* feedback */ ++ for (i = 0; i < 8; i++) ++ md->state[i] = md->state[i] + S[i]; ++ return 0; ++} ++ ++/* Initialize the hash state */ ++static void sha256_init(struct sha256_state *md) ++{ ++ md->curlen = 0; ++ md->length = 0; ++ md->state[0] = 0x6A09E667UL; ++ md->state[1] = 0xBB67AE85UL; ++ md->state[2] = 0x3C6EF372UL; ++ md->state[3] = 0xA54FF53AUL; ++ md->state[4] = 0x510E527FUL; ++ md->state[5] = 0x9B05688CUL; ++ md->state[6] = 0x1F83D9ABUL; ++ md->state[7] = 0x5BE0CD19UL; ++} ++ ++/** ++ Process a block of memory though the hash ++ @param md The hash state ++ @param in The data to hash ++ @param inlen The length of the data (octets) ++ @return CRYPT_OK if successful ++*/ ++static int sha256_process(struct sha256_state *md, unsigned char *in, ++ unsigned long inlen) ++{ ++ unsigned long n; ++#define block_size 64 ++ ++ if (md->curlen > sizeof(md->buf)) ++ return -1; ++ ++ while (inlen > 0) { ++ if (md->curlen == 0 && inlen >= block_size) { ++ if (sha256_compress(md, (unsigned char *) in) < 0) ++ return -1; ++ md->length += block_size * 8; ++ in += block_size; ++ inlen -= block_size; ++ } else { ++ n = MIN(inlen, (block_size - md->curlen)); ++ _rtw_memcpy(md->buf + md->curlen, in, n); ++ md->curlen += n; ++ in += n; ++ inlen -= n; ++ if (md->curlen == block_size) { ++ if (sha256_compress(md, md->buf) < 0) ++ return -1; ++ md->length += 8 * block_size; ++ md->curlen = 0; ++ } ++ } ++ } ++ ++ return 0; ++} ++ ++ ++/** ++ Terminate the hash to get the digest ++ @param md The hash state ++ @param out [out] The destination of the hash (32 bytes) ++ @return CRYPT_OK if successful ++*/ ++static int sha256_done(struct sha256_state *md, unsigned char *out) ++{ ++ int i; ++ ++ if (md->curlen >= sizeof(md->buf)) ++ return -1; ++ ++ /* increase the length of the message */ ++ md->length += md->curlen * 8; ++ ++ /* append the '1' bit */ ++ md->buf[md->curlen++] = (unsigned char) 0x80; ++ ++ /* if the length is currently above 56 bytes we append zeros ++ * then compress. Then we can fall back to padding zeros and length ++ * encoding like normal. ++ */ ++ if (md->curlen > 56) { ++ while (md->curlen < 64) ++ md->buf[md->curlen++] = (unsigned char) 0; ++ sha256_compress(md, md->buf); ++ md->curlen = 0; ++ } ++ ++ /* pad upto 56 bytes of zeroes */ ++ while (md->curlen < 56) ++ md->buf[md->curlen++] = (unsigned char) 0; ++ ++ /* store length */ ++ WPA_PUT_BE64(md->buf + 56, md->length); ++ sha256_compress(md, md->buf); ++ ++ /* copy output */ ++ for (i = 0; i < 8; i++) ++ WPA_PUT_BE32(out + (4 * i), md->state[i]); ++ ++ return 0; ++} ++ ++/** ++ * sha256_vector - SHA256 hash for data vector ++ * @num_elem: Number of elements in the data vector ++ * @addr: Pointers to the data areas ++ * @len: Lengths of the data blocks ++ * @mac: Buffer for the hash ++ * Returns: 0 on success, -1 of failure ++ */ ++static int sha256_vector(size_t num_elem, u8 *addr[], size_t *len, ++ u8 *mac) ++{ ++ struct sha256_state ctx; ++ size_t i; ++ ++ sha256_init(&ctx); ++ for (i = 0; i < num_elem; i++) ++ if (sha256_process(&ctx, addr[i], len[i])) ++ return -1; ++ if (sha256_done(&ctx, mac)) ++ return -1; ++ return 0; ++} ++ ++static u8 os_strlen(const char *s) ++{ ++ const char *p = s; ++ while (*p) ++ p++; ++ return p - s; ++} ++ ++static int os_memcmp(void *s1, void *s2, u8 n) ++{ ++ unsigned char *p1 = s1, *p2 = s2; ++ ++ if (n == 0) ++ return 0; ++ ++ while (*p1 == *p2) { ++ p1++; ++ p2++; ++ n--; ++ if (n == 0) ++ return 0; ++ } ++ ++ return *p1 - *p2; ++} ++ ++/** ++ * hmac_sha256_vector - HMAC-SHA256 over data vector (RFC 2104) ++ * @key: Key for HMAC operations ++ * @key_len: Length of the key in bytes ++ * @num_elem: Number of elements in the data vector ++ * @addr: Pointers to the data areas ++ * @len: Lengths of the data blocks ++ * @mac: Buffer for the hash (32 bytes) ++ */ ++static void hmac_sha256_vector(u8 *key, size_t key_len, size_t num_elem, ++ u8 *addr[], size_t *len, u8 *mac) ++{ ++ unsigned char k_pad[64]; /* padding - key XORd with ipad/opad */ ++ unsigned char tk[32]; ++ u8 *_addr[6]; ++ size_t _len[6], i; ++ ++ if (num_elem > 5) { ++ /* ++ * Fixed limit on the number of fragments to avoid having to ++ * allocate memory (which could fail). ++ */ ++ return; ++ } ++ ++ /* if key is longer than 64 bytes reset it to key = SHA256(key) */ ++ if (key_len > 64) { ++ sha256_vector(1, &key, &key_len, tk); ++ key = tk; ++ key_len = 32; ++ } ++ ++ /* the HMAC_SHA256 transform looks like: ++ * ++ * SHA256(K XOR opad, SHA256(K XOR ipad, text)) ++ * ++ * where K is an n byte key ++ * ipad is the byte 0x36 repeated 64 times ++ * opad is the byte 0x5c repeated 64 times ++ * and text is the data being protected */ ++ ++ /* start out by storing key in ipad */ ++ _rtw_memset(k_pad, 0, sizeof(k_pad)); ++ _rtw_memcpy(k_pad, key, key_len); ++ /* XOR key with ipad values */ ++ for (i = 0; i < 64; i++) ++ k_pad[i] ^= 0x36; ++ ++ /* perform inner SHA256 */ ++ _addr[0] = k_pad; ++ _len[0] = 64; ++ for (i = 0; i < num_elem; i++) { ++ _addr[i + 1] = addr[i]; ++ _len[i + 1] = len[i]; ++ } ++ sha256_vector(1 + num_elem, _addr, _len, mac); ++ ++ _rtw_memset(k_pad, 0, sizeof(k_pad)); ++ _rtw_memcpy(k_pad, key, key_len); ++ /* XOR key with opad values */ ++ for (i = 0; i < 64; i++) ++ k_pad[i] ^= 0x5c; ++ ++ /* perform outer SHA256 */ ++ _addr[0] = k_pad; ++ _len[0] = 64; ++ _addr[1] = mac; ++ _len[1] = 32; ++ sha256_vector(2, _addr, _len, mac); ++} ++#endif /* PLATFORM_FREEBSD */ ++/** ++ * sha256_prf - SHA256-based Pseudo-Random Function (IEEE 802.11r, 8.5.1.5.2) ++ * @key: Key for PRF ++ * @key_len: Length of the key in bytes ++ * @label: A unique label for each purpose of the PRF ++ * @data: Extra data to bind into the key ++ * @data_len: Length of the data ++ * @buf: Buffer for the generated pseudo-random key ++ * @buf_len: Number of bytes of key to generate ++ * ++ * This function is used to derive new, cryptographically separate keys from a ++ * given key. ++ */ ++#ifndef PLATFORM_FREEBSD /* Baron */ ++static void sha256_prf(u8 *key, size_t key_len, char *label, ++ u8 *data, size_t data_len, u8 *buf, size_t buf_len) ++{ ++ u16 counter = 1; ++ size_t pos, plen; ++ u8 hash[SHA256_MAC_LEN]; ++ u8 *addr[4]; ++ size_t len[4]; ++ u8 counter_le[2], length_le[2]; ++ ++ addr[0] = counter_le; ++ len[0] = 2; ++ addr[1] = (u8 *) label; ++ len[1] = os_strlen(label); ++ addr[2] = data; ++ len[2] = data_len; ++ addr[3] = length_le; ++ len[3] = sizeof(length_le); ++ ++ WPA_PUT_LE16(length_le, buf_len * 8); ++ pos = 0; ++ while (pos < buf_len) { ++ plen = buf_len - pos; ++ WPA_PUT_LE16(counter_le, counter); ++ if (plen >= SHA256_MAC_LEN) { ++ hmac_sha256_vector(key, key_len, 4, addr, len, ++ &buf[pos]); ++ pos += SHA256_MAC_LEN; ++ } else { ++ hmac_sha256_vector(key, key_len, 4, addr, len, hash); ++ _rtw_memcpy(&buf[pos], hash, plen); ++ break; ++ } ++ counter++; ++ } ++} ++#endif /* PLATFORM_FREEBSD Baron */ ++ ++/* AES tables*/ ++const u32 Te0[256] = { ++ 0xc66363a5U, 0xf87c7c84U, 0xee777799U, 0xf67b7b8dU, ++ 0xfff2f20dU, 0xd66b6bbdU, 0xde6f6fb1U, 0x91c5c554U, ++ 0x60303050U, 0x02010103U, 0xce6767a9U, 0x562b2b7dU, ++ 0xe7fefe19U, 0xb5d7d762U, 0x4dababe6U, 0xec76769aU, ++ 0x8fcaca45U, 0x1f82829dU, 0x89c9c940U, 0xfa7d7d87U, ++ 0xeffafa15U, 0xb25959ebU, 0x8e4747c9U, 0xfbf0f00bU, ++ 0x41adadecU, 0xb3d4d467U, 0x5fa2a2fdU, 0x45afafeaU, ++ 0x239c9cbfU, 0x53a4a4f7U, 0xe4727296U, 0x9bc0c05bU, ++ 0x75b7b7c2U, 0xe1fdfd1cU, 0x3d9393aeU, 0x4c26266aU, ++ 0x6c36365aU, 0x7e3f3f41U, 0xf5f7f702U, 0x83cccc4fU, ++ 0x6834345cU, 0x51a5a5f4U, 0xd1e5e534U, 0xf9f1f108U, ++ 0xe2717193U, 0xabd8d873U, 0x62313153U, 0x2a15153fU, ++ 0x0804040cU, 0x95c7c752U, 0x46232365U, 0x9dc3c35eU, ++ 0x30181828U, 0x379696a1U, 0x0a05050fU, 0x2f9a9ab5U, ++ 0x0e070709U, 0x24121236U, 0x1b80809bU, 0xdfe2e23dU, ++ 0xcdebeb26U, 0x4e272769U, 0x7fb2b2cdU, 0xea75759fU, ++ 0x1209091bU, 0x1d83839eU, 0x582c2c74U, 0x341a1a2eU, ++ 0x361b1b2dU, 0xdc6e6eb2U, 0xb45a5aeeU, 0x5ba0a0fbU, ++ 0xa45252f6U, 0x763b3b4dU, 0xb7d6d661U, 0x7db3b3ceU, ++ 0x5229297bU, 0xdde3e33eU, 0x5e2f2f71U, 0x13848497U, ++ 0xa65353f5U, 0xb9d1d168U, 0x00000000U, 0xc1eded2cU, ++ 0x40202060U, 0xe3fcfc1fU, 0x79b1b1c8U, 0xb65b5bedU, ++ 0xd46a6abeU, 0x8dcbcb46U, 0x67bebed9U, 0x7239394bU, ++ 0x944a4adeU, 0x984c4cd4U, 0xb05858e8U, 0x85cfcf4aU, ++ 0xbbd0d06bU, 0xc5efef2aU, 0x4faaaae5U, 0xedfbfb16U, ++ 0x864343c5U, 0x9a4d4dd7U, 0x66333355U, 0x11858594U, ++ 0x8a4545cfU, 0xe9f9f910U, 0x04020206U, 0xfe7f7f81U, ++ 0xa05050f0U, 0x783c3c44U, 0x259f9fbaU, 0x4ba8a8e3U, ++ 0xa25151f3U, 0x5da3a3feU, 0x804040c0U, 0x058f8f8aU, ++ 0x3f9292adU, 0x219d9dbcU, 0x70383848U, 0xf1f5f504U, ++ 0x63bcbcdfU, 0x77b6b6c1U, 0xafdada75U, 0x42212163U, ++ 0x20101030U, 0xe5ffff1aU, 0xfdf3f30eU, 0xbfd2d26dU, ++ 0x81cdcd4cU, 0x180c0c14U, 0x26131335U, 0xc3ecec2fU, ++ 0xbe5f5fe1U, 0x359797a2U, 0x884444ccU, 0x2e171739U, ++ 0x93c4c457U, 0x55a7a7f2U, 0xfc7e7e82U, 0x7a3d3d47U, ++ 0xc86464acU, 0xba5d5de7U, 0x3219192bU, 0xe6737395U, ++ 0xc06060a0U, 0x19818198U, 0x9e4f4fd1U, 0xa3dcdc7fU, ++ 0x44222266U, 0x542a2a7eU, 0x3b9090abU, 0x0b888883U, ++ 0x8c4646caU, 0xc7eeee29U, 0x6bb8b8d3U, 0x2814143cU, ++ 0xa7dede79U, 0xbc5e5ee2U, 0x160b0b1dU, 0xaddbdb76U, ++ 0xdbe0e03bU, 0x64323256U, 0x743a3a4eU, 0x140a0a1eU, ++ 0x924949dbU, 0x0c06060aU, 0x4824246cU, 0xb85c5ce4U, ++ 0x9fc2c25dU, 0xbdd3d36eU, 0x43acacefU, 0xc46262a6U, ++ 0x399191a8U, 0x319595a4U, 0xd3e4e437U, 0xf279798bU, ++ 0xd5e7e732U, 0x8bc8c843U, 0x6e373759U, 0xda6d6db7U, ++ 0x018d8d8cU, 0xb1d5d564U, 0x9c4e4ed2U, 0x49a9a9e0U, ++ 0xd86c6cb4U, 0xac5656faU, 0xf3f4f407U, 0xcfeaea25U, ++ 0xca6565afU, 0xf47a7a8eU, 0x47aeaee9U, 0x10080818U, ++ 0x6fbabad5U, 0xf0787888U, 0x4a25256fU, 0x5c2e2e72U, ++ 0x381c1c24U, 0x57a6a6f1U, 0x73b4b4c7U, 0x97c6c651U, ++ 0xcbe8e823U, 0xa1dddd7cU, 0xe874749cU, 0x3e1f1f21U, ++ 0x964b4bddU, 0x61bdbddcU, 0x0d8b8b86U, 0x0f8a8a85U, ++ 0xe0707090U, 0x7c3e3e42U, 0x71b5b5c4U, 0xcc6666aaU, ++ 0x904848d8U, 0x06030305U, 0xf7f6f601U, 0x1c0e0e12U, ++ 0xc26161a3U, 0x6a35355fU, 0xae5757f9U, 0x69b9b9d0U, ++ 0x17868691U, 0x99c1c158U, 0x3a1d1d27U, 0x279e9eb9U, ++ 0xd9e1e138U, 0xebf8f813U, 0x2b9898b3U, 0x22111133U, ++ 0xd26969bbU, 0xa9d9d970U, 0x078e8e89U, 0x339494a7U, ++ 0x2d9b9bb6U, 0x3c1e1e22U, 0x15878792U, 0xc9e9e920U, ++ 0x87cece49U, 0xaa5555ffU, 0x50282878U, 0xa5dfdf7aU, ++ 0x038c8c8fU, 0x59a1a1f8U, 0x09898980U, 0x1a0d0d17U, ++ 0x65bfbfdaU, 0xd7e6e631U, 0x844242c6U, 0xd06868b8U, ++ 0x824141c3U, 0x299999b0U, 0x5a2d2d77U, 0x1e0f0f11U, ++ 0x7bb0b0cbU, 0xa85454fcU, 0x6dbbbbd6U, 0x2c16163aU, ++}; ++const u32 Td0[256] = { ++ 0x51f4a750U, 0x7e416553U, 0x1a17a4c3U, 0x3a275e96U, ++ 0x3bab6bcbU, 0x1f9d45f1U, 0xacfa58abU, 0x4be30393U, ++ 0x2030fa55U, 0xad766df6U, 0x88cc7691U, 0xf5024c25U, ++ 0x4fe5d7fcU, 0xc52acbd7U, 0x26354480U, 0xb562a38fU, ++ 0xdeb15a49U, 0x25ba1b67U, 0x45ea0e98U, 0x5dfec0e1U, ++ 0xc32f7502U, 0x814cf012U, 0x8d4697a3U, 0x6bd3f9c6U, ++ 0x038f5fe7U, 0x15929c95U, 0xbf6d7aebU, 0x955259daU, ++ 0xd4be832dU, 0x587421d3U, 0x49e06929U, 0x8ec9c844U, ++ 0x75c2896aU, 0xf48e7978U, 0x99583e6bU, 0x27b971ddU, ++ 0xbee14fb6U, 0xf088ad17U, 0xc920ac66U, 0x7dce3ab4U, ++ 0x63df4a18U, 0xe51a3182U, 0x97513360U, 0x62537f45U, ++ 0xb16477e0U, 0xbb6bae84U, 0xfe81a01cU, 0xf9082b94U, ++ 0x70486858U, 0x8f45fd19U, 0x94de6c87U, 0x527bf8b7U, ++ 0xab73d323U, 0x724b02e2U, 0xe31f8f57U, 0x6655ab2aU, ++ 0xb2eb2807U, 0x2fb5c203U, 0x86c57b9aU, 0xd33708a5U, ++ 0x302887f2U, 0x23bfa5b2U, 0x02036abaU, 0xed16825cU, ++ 0x8acf1c2bU, 0xa779b492U, 0xf307f2f0U, 0x4e69e2a1U, ++ 0x65daf4cdU, 0x0605bed5U, 0xd134621fU, 0xc4a6fe8aU, ++ 0x342e539dU, 0xa2f355a0U, 0x058ae132U, 0xa4f6eb75U, ++ 0x0b83ec39U, 0x4060efaaU, 0x5e719f06U, 0xbd6e1051U, ++ 0x3e218af9U, 0x96dd063dU, 0xdd3e05aeU, 0x4de6bd46U, ++ 0x91548db5U, 0x71c45d05U, 0x0406d46fU, 0x605015ffU, ++ 0x1998fb24U, 0xd6bde997U, 0x894043ccU, 0x67d99e77U, ++ 0xb0e842bdU, 0x07898b88U, 0xe7195b38U, 0x79c8eedbU, ++ 0xa17c0a47U, 0x7c420fe9U, 0xf8841ec9U, 0x00000000U, ++ 0x09808683U, 0x322bed48U, 0x1e1170acU, 0x6c5a724eU, ++ 0xfd0efffbU, 0x0f853856U, 0x3daed51eU, 0x362d3927U, ++ 0x0a0fd964U, 0x685ca621U, 0x9b5b54d1U, 0x24362e3aU, ++ 0x0c0a67b1U, 0x9357e70fU, 0xb4ee96d2U, 0x1b9b919eU, ++ 0x80c0c54fU, 0x61dc20a2U, 0x5a774b69U, 0x1c121a16U, ++ 0xe293ba0aU, 0xc0a02ae5U, 0x3c22e043U, 0x121b171dU, ++ 0x0e090d0bU, 0xf28bc7adU, 0x2db6a8b9U, 0x141ea9c8U, ++ 0x57f11985U, 0xaf75074cU, 0xee99ddbbU, 0xa37f60fdU, ++ 0xf701269fU, 0x5c72f5bcU, 0x44663bc5U, 0x5bfb7e34U, ++ 0x8b432976U, 0xcb23c6dcU, 0xb6edfc68U, 0xb8e4f163U, ++ 0xd731dccaU, 0x42638510U, 0x13972240U, 0x84c61120U, ++ 0x854a247dU, 0xd2bb3df8U, 0xaef93211U, 0xc729a16dU, ++ 0x1d9e2f4bU, 0xdcb230f3U, 0x0d8652ecU, 0x77c1e3d0U, ++ 0x2bb3166cU, 0xa970b999U, 0x119448faU, 0x47e96422U, ++ 0xa8fc8cc4U, 0xa0f03f1aU, 0x567d2cd8U, 0x223390efU, ++ 0x87494ec7U, 0xd938d1c1U, 0x8ccaa2feU, 0x98d40b36U, ++ 0xa6f581cfU, 0xa57ade28U, 0xdab78e26U, 0x3fadbfa4U, ++ 0x2c3a9de4U, 0x5078920dU, 0x6a5fcc9bU, 0x547e4662U, ++ 0xf68d13c2U, 0x90d8b8e8U, 0x2e39f75eU, 0x82c3aff5U, ++ 0x9f5d80beU, 0x69d0937cU, 0x6fd52da9U, 0xcf2512b3U, ++ 0xc8ac993bU, 0x10187da7U, 0xe89c636eU, 0xdb3bbb7bU, ++ 0xcd267809U, 0x6e5918f4U, 0xec9ab701U, 0x834f9aa8U, ++ 0xe6956e65U, 0xaaffe67eU, 0x21bccf08U, 0xef15e8e6U, ++ 0xbae79bd9U, 0x4a6f36ceU, 0xea9f09d4U, 0x29b07cd6U, ++ 0x31a4b2afU, 0x2a3f2331U, 0xc6a59430U, 0x35a266c0U, ++ 0x744ebc37U, 0xfc82caa6U, 0xe090d0b0U, 0x33a7d815U, ++ 0xf104984aU, 0x41ecdaf7U, 0x7fcd500eU, 0x1791f62fU, ++ 0x764dd68dU, 0x43efb04dU, 0xccaa4d54U, 0xe49604dfU, ++ 0x9ed1b5e3U, 0x4c6a881bU, 0xc12c1fb8U, 0x4665517fU, ++ 0x9d5eea04U, 0x018c355dU, 0xfa877473U, 0xfb0b412eU, ++ 0xb3671d5aU, 0x92dbd252U, 0xe9105633U, 0x6dd64713U, ++ 0x9ad7618cU, 0x37a10c7aU, 0x59f8148eU, 0xeb133c89U, ++ 0xcea927eeU, 0xb761c935U, 0xe11ce5edU, 0x7a47b13cU, ++ 0x9cd2df59U, 0x55f2733fU, 0x1814ce79U, 0x73c737bfU, ++ 0x53f7cdeaU, 0x5ffdaa5bU, 0xdf3d6f14U, 0x7844db86U, ++ 0xcaaff381U, 0xb968c43eU, 0x3824342cU, 0xc2a3405fU, ++ 0x161dc372U, 0xbce2250cU, 0x283c498bU, 0xff0d9541U, ++ 0x39a80171U, 0x080cb3deU, 0xd8b4e49cU, 0x6456c190U, ++ 0x7bcb8461U, 0xd532b670U, 0x486c5c74U, 0xd0b85742U, ++}; ++const u8 Td4s[256] = { ++ 0x52U, 0x09U, 0x6aU, 0xd5U, 0x30U, 0x36U, 0xa5U, 0x38U, ++ 0xbfU, 0x40U, 0xa3U, 0x9eU, 0x81U, 0xf3U, 0xd7U, 0xfbU, ++ 0x7cU, 0xe3U, 0x39U, 0x82U, 0x9bU, 0x2fU, 0xffU, 0x87U, ++ 0x34U, 0x8eU, 0x43U, 0x44U, 0xc4U, 0xdeU, 0xe9U, 0xcbU, ++ 0x54U, 0x7bU, 0x94U, 0x32U, 0xa6U, 0xc2U, 0x23U, 0x3dU, ++ 0xeeU, 0x4cU, 0x95U, 0x0bU, 0x42U, 0xfaU, 0xc3U, 0x4eU, ++ 0x08U, 0x2eU, 0xa1U, 0x66U, 0x28U, 0xd9U, 0x24U, 0xb2U, ++ 0x76U, 0x5bU, 0xa2U, 0x49U, 0x6dU, 0x8bU, 0xd1U, 0x25U, ++ 0x72U, 0xf8U, 0xf6U, 0x64U, 0x86U, 0x68U, 0x98U, 0x16U, ++ 0xd4U, 0xa4U, 0x5cU, 0xccU, 0x5dU, 0x65U, 0xb6U, 0x92U, ++ 0x6cU, 0x70U, 0x48U, 0x50U, 0xfdU, 0xedU, 0xb9U, 0xdaU, ++ 0x5eU, 0x15U, 0x46U, 0x57U, 0xa7U, 0x8dU, 0x9dU, 0x84U, ++ 0x90U, 0xd8U, 0xabU, 0x00U, 0x8cU, 0xbcU, 0xd3U, 0x0aU, ++ 0xf7U, 0xe4U, 0x58U, 0x05U, 0xb8U, 0xb3U, 0x45U, 0x06U, ++ 0xd0U, 0x2cU, 0x1eU, 0x8fU, 0xcaU, 0x3fU, 0x0fU, 0x02U, ++ 0xc1U, 0xafU, 0xbdU, 0x03U, 0x01U, 0x13U, 0x8aU, 0x6bU, ++ 0x3aU, 0x91U, 0x11U, 0x41U, 0x4fU, 0x67U, 0xdcU, 0xeaU, ++ 0x97U, 0xf2U, 0xcfU, 0xceU, 0xf0U, 0xb4U, 0xe6U, 0x73U, ++ 0x96U, 0xacU, 0x74U, 0x22U, 0xe7U, 0xadU, 0x35U, 0x85U, ++ 0xe2U, 0xf9U, 0x37U, 0xe8U, 0x1cU, 0x75U, 0xdfU, 0x6eU, ++ 0x47U, 0xf1U, 0x1aU, 0x71U, 0x1dU, 0x29U, 0xc5U, 0x89U, ++ 0x6fU, 0xb7U, 0x62U, 0x0eU, 0xaaU, 0x18U, 0xbeU, 0x1bU, ++ 0xfcU, 0x56U, 0x3eU, 0x4bU, 0xc6U, 0xd2U, 0x79U, 0x20U, ++ 0x9aU, 0xdbU, 0xc0U, 0xfeU, 0x78U, 0xcdU, 0x5aU, 0xf4U, ++ 0x1fU, 0xddU, 0xa8U, 0x33U, 0x88U, 0x07U, 0xc7U, 0x31U, ++ 0xb1U, 0x12U, 0x10U, 0x59U, 0x27U, 0x80U, 0xecU, 0x5fU, ++ 0x60U, 0x51U, 0x7fU, 0xa9U, 0x19U, 0xb5U, 0x4aU, 0x0dU, ++ 0x2dU, 0xe5U, 0x7aU, 0x9fU, 0x93U, 0xc9U, 0x9cU, 0xefU, ++ 0xa0U, 0xe0U, 0x3bU, 0x4dU, 0xaeU, 0x2aU, 0xf5U, 0xb0U, ++ 0xc8U, 0xebU, 0xbbU, 0x3cU, 0x83U, 0x53U, 0x99U, 0x61U, ++ 0x17U, 0x2bU, 0x04U, 0x7eU, 0xbaU, 0x77U, 0xd6U, 0x26U, ++ 0xe1U, 0x69U, 0x14U, 0x63U, 0x55U, 0x21U, 0x0cU, 0x7dU, ++}; ++const u8 rcons[] = { ++ 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x1B, 0x36 ++ /* for 128-bit blocks, Rijndael never uses more than 10 rcon values */ ++}; ++ ++/** ++ * Expand the cipher key into the encryption key schedule. ++ * ++ * @return the number of rounds for the given cipher key size. ++ */ ++#ifndef PLATFORM_FREEBSD /* Baron */ ++static void rijndaelKeySetupEnc(u32 rk[/*44*/], const u8 cipherKey[]) ++{ ++ int i; ++ u32 temp; ++ ++ rk[0] = GETU32(cipherKey); ++ rk[1] = GETU32(cipherKey + 4); ++ rk[2] = GETU32(cipherKey + 8); ++ rk[3] = GETU32(cipherKey + 12); ++ for (i = 0; i < 10; i++) { ++ temp = rk[3]; ++ rk[4] = rk[0] ^ ++ TE421(temp) ^ TE432(temp) ^ TE443(temp) ^ TE414(temp) ^ ++ RCON(i); ++ rk[5] = rk[1] ^ rk[4]; ++ rk[6] = rk[2] ^ rk[5]; ++ rk[7] = rk[3] ^ rk[6]; ++ rk += 4; ++ } ++} ++ ++static void rijndaelEncrypt(u32 rk[/*44*/], u8 pt[16], u8 ct[16]) ++{ ++ u32 s0, s1, s2, s3, t0, t1, t2, t3; ++ int Nr = 10; ++#ifndef FULL_UNROLL ++ int r; ++#endif /* ?FULL_UNROLL */ ++ ++ /* ++ * map byte array block to cipher state ++ * and add initial round key: ++ */ ++ s0 = GETU32(pt) ^ rk[0]; ++ s1 = GETU32(pt + 4) ^ rk[1]; ++ s2 = GETU32(pt + 8) ^ rk[2]; ++ s3 = GETU32(pt + 12) ^ rk[3]; ++ ++#define ROUND(i, d, s) do {\ ++ d##0 = TE0(s##0) ^ TE1(s##1) ^ TE2(s##2) ^ TE3(s##3) ^ rk[4 * i]; \ ++ d##1 = TE0(s##1) ^ TE1(s##2) ^ TE2(s##3) ^ TE3(s##0) ^ rk[4 * i + 1]; \ ++ d##2 = TE0(s##2) ^ TE1(s##3) ^ TE2(s##0) ^ TE3(s##1) ^ rk[4 * i + 2]; \ ++ d##3 = TE0(s##3) ^ TE1(s##0) ^ TE2(s##1) ^ TE3(s##2) ^ rk[4 * i + 3]; \ ++ } while (0) ++ ++#ifdef FULL_UNROLL ++ ++ ROUND(1, t, s); ++ ROUND(2, s, t); ++ ROUND(3, t, s); ++ ROUND(4, s, t); ++ ROUND(5, t, s); ++ ROUND(6, s, t); ++ ROUND(7, t, s); ++ ROUND(8, s, t); ++ ROUND(9, t, s); ++ ++ rk += Nr << 2; ++ ++#else /* !FULL_UNROLL */ ++ ++ /* Nr - 1 full rounds: */ ++ r = Nr >> 1; ++ for (;;) { ++ ROUND(1, t, s); ++ rk += 8; ++ if (--r == 0) ++ break; ++ ROUND(0, s, t); ++ } ++ ++#endif /* ?FULL_UNROLL */ ++ ++#undef ROUND ++ ++ /* ++ * apply last round and ++ * map cipher state to byte array block: ++ */ ++ s0 = TE41(t0) ^ TE42(t1) ^ TE43(t2) ^ TE44(t3) ^ rk[0]; ++ PUTU32(ct , s0); ++ s1 = TE41(t1) ^ TE42(t2) ^ TE43(t3) ^ TE44(t0) ^ rk[1]; ++ PUTU32(ct + 4, s1); ++ s2 = TE41(t2) ^ TE42(t3) ^ TE43(t0) ^ TE44(t1) ^ rk[2]; ++ PUTU32(ct + 8, s2); ++ s3 = TE41(t3) ^ TE42(t0) ^ TE43(t1) ^ TE44(t2) ^ rk[3]; ++ PUTU32(ct + 12, s3); ++} ++ ++static void *aes_encrypt_init(u8 *key, size_t len) ++{ ++ u32 *rk; ++ if (len != 16) ++ return NULL; ++ rk = (u32 *)rtw_malloc(AES_PRIV_SIZE); ++ if (rk == NULL) ++ return NULL; ++ rijndaelKeySetupEnc(rk, key); ++ return rk; ++} ++ ++static void aes_128_encrypt(void *ctx, u8 *plain, u8 *crypt) ++{ ++ rijndaelEncrypt(ctx, plain, crypt); ++} ++ ++ ++static void gf_mulx(u8 *pad) ++{ ++ int i, carry; ++ ++ carry = pad[0] & 0x80; ++ for (i = 0; i < AES_BLOCK_SIZE - 1; i++) ++ pad[i] = (pad[i] << 1) | (pad[i + 1] >> 7); ++ pad[AES_BLOCK_SIZE - 1] <<= 1; ++ if (carry) ++ pad[AES_BLOCK_SIZE - 1] ^= 0x87; ++} ++ ++static void aes_encrypt_deinit(void *ctx) ++{ ++ _rtw_memset(ctx, 0, AES_PRIV_SIZE); ++ rtw_mfree(ctx, AES_PRIV_SIZE); ++} ++ ++ ++/** ++ * omac1_aes_128_vector - One-Key CBC MAC (OMAC1) hash with AES-128 ++ * @key: 128-bit key for the hash operation ++ * @num_elem: Number of elements in the data vector ++ * @addr: Pointers to the data areas ++ * @len: Lengths of the data blocks ++ * @mac: Buffer for MAC (128 bits, i.e., 16 bytes) ++ * Returns: 0 on success, -1 on failure ++ * ++ * This is a mode for using block cipher (AES in this case) for authentication. ++ * OMAC1 was standardized with the name CMAC by NIST in a Special Publication ++ * (SP) 800-38B. ++ */ ++static int omac1_aes_128_vector(u8 *key, size_t num_elem, ++ u8 *addr[], size_t *len, u8 *mac) ++{ ++ void *ctx; ++ u8 cbc[AES_BLOCK_SIZE], pad[AES_BLOCK_SIZE]; ++ u8 *pos, *end; ++ size_t i, e, left, total_len; ++ ++ ctx = aes_encrypt_init(key, 16); ++ if (ctx == NULL) ++ return -1; ++ _rtw_memset(cbc, 0, AES_BLOCK_SIZE); ++ ++ total_len = 0; ++ for (e = 0; e < num_elem; e++) ++ total_len += len[e]; ++ left = total_len; ++ ++ e = 0; ++ pos = addr[0]; ++ end = pos + len[0]; ++ ++ while (left >= AES_BLOCK_SIZE) { ++ for (i = 0; i < AES_BLOCK_SIZE; i++) { ++ cbc[i] ^= *pos++; ++ if (pos >= end) { ++ e++; ++ pos = addr[e]; ++ end = pos + len[e]; ++ } ++ } ++ if (left > AES_BLOCK_SIZE) ++ aes_128_encrypt(ctx, cbc, cbc); ++ left -= AES_BLOCK_SIZE; ++ } ++ ++ _rtw_memset(pad, 0, AES_BLOCK_SIZE); ++ aes_128_encrypt(ctx, pad, pad); ++ gf_mulx(pad); ++ ++ if (left || total_len == 0) { ++ for (i = 0; i < left; i++) { ++ cbc[i] ^= *pos++; ++ if (pos >= end) { ++ e++; ++ pos = addr[e]; ++ end = pos + len[e]; ++ } ++ } ++ cbc[left] ^= 0x80; ++ gf_mulx(pad); ++ } ++ ++ for (i = 0; i < AES_BLOCK_SIZE; i++) ++ pad[i] ^= cbc[i]; ++ aes_128_encrypt(ctx, pad, mac); ++ aes_encrypt_deinit(ctx); ++ return 0; ++} ++ ++ ++/** ++ * omac1_aes_128 - One-Key CBC MAC (OMAC1) hash with AES-128 (aka AES-CMAC) ++ * @key: 128-bit key for the hash operation ++ * @data: Data buffer for which a MAC is determined ++ * @data_len: Length of data buffer in bytes ++ * @mac: Buffer for MAC (128 bits, i.e., 16 bytes) ++ * Returns: 0 on success, -1 on failure ++ * ++ * This is a mode for using block cipher (AES in this case) for authentication. ++ * OMAC1 was standardized with the name CMAC by NIST in a Special Publication ++ * (SP) 800-38B. ++ */ /* modify for CONFIG_IEEE80211W */ ++int omac1_aes_128(u8 *key, u8 *data, size_t data_len, u8 *mac) ++{ ++ return omac1_aes_128_vector(key, 1, &data, &data_len, mac); ++} ++#endif /* PLATFORM_FREEBSD Baron */ ++ ++#ifdef CONFIG_TDLS ++void wpa_tdls_generate_tpk(_adapter *padapter, PVOID sta) ++{ ++ struct sta_info *psta = (struct sta_info *)sta; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ u8 *SNonce = psta->SNonce; ++ u8 *ANonce = psta->ANonce; ++ ++ u8 key_input[SHA256_MAC_LEN]; ++ u8 *nonce[2]; ++ size_t len[2]; ++ u8 data[3 * ETH_ALEN]; ++ ++ /* IEEE Std 802.11z-2010 8.5.9.1: ++ * TPK-Key-Input = SHA-256(min(SNonce, ANonce) || max(SNonce, ANonce)) ++ */ ++ len[0] = 32; ++ len[1] = 32; ++ if (os_memcmp(SNonce, ANonce, 32) < 0) { ++ nonce[0] = SNonce; ++ nonce[1] = ANonce; ++ } else { ++ nonce[0] = ANonce; ++ nonce[1] = SNonce; ++ } ++ ++ sha256_vector(2, nonce, len, key_input); ++ ++ /* ++ * TPK-Key-Data = KDF-N_KEY(TPK-Key-Input, "TDLS PMK", ++ * min(MAC_I, MAC_R) || max(MAC_I, MAC_R) || BSSID || N_KEY) ++ * TODO: is N_KEY really included in KDF Context and if so, in which ++ * presentation format (little endian 16-bit?) is it used? It gets ++ * added by the KDF anyway.. ++ */ ++ ++ if (os_memcmp(adapter_mac_addr(padapter), psta->hwaddr, ETH_ALEN) < 0) { ++ _rtw_memcpy(data, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(data + ETH_ALEN, psta->hwaddr, ETH_ALEN); ++ } else { ++ _rtw_memcpy(data, psta->hwaddr, ETH_ALEN); ++ _rtw_memcpy(data + ETH_ALEN, adapter_mac_addr(padapter), ETH_ALEN); ++ } ++ _rtw_memcpy(data + 2 * ETH_ALEN, get_bssid(pmlmepriv), ETH_ALEN); ++ ++ sha256_prf(key_input, SHA256_MAC_LEN, "TDLS PMK", data, sizeof(data), (u8 *) &psta->tpk, sizeof(psta->tpk)); ++ ++ ++} ++ ++/** ++ * wpa_tdls_ftie_mic - Calculate TDLS FTIE MIC ++ * @kck: TPK-KCK ++ * @lnkid: Pointer to the beginning of Link Identifier IE ++ * @rsnie: Pointer to the beginning of RSN IE used for handshake ++ * @timeoutie: Pointer to the beginning of Timeout IE used for handshake ++ * @ftie: Pointer to the beginning of FT IE ++ * @mic: Pointer for writing MIC ++ * ++ * Calculate MIC for TDLS frame. ++ */ ++int wpa_tdls_ftie_mic(u8 *kck, u8 trans_seq, ++ u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie, ++ u8 *mic) ++{ ++ u8 *buf, *pos; ++ struct wpa_tdls_ftie *_ftie; ++ struct wpa_tdls_lnkid *_lnkid; ++ int ret; ++ int len = 2 * ETH_ALEN + 1 + 2 + lnkid[1] + 2 + rsnie[1] + ++ 2 + timeoutie[1] + 2 + ftie[1]; ++ buf = rtw_zmalloc(len); ++ if (!buf) { ++ RTW_INFO("TDLS: No memory for MIC calculation\n"); ++ return -1; ++ } ++ ++ pos = buf; ++ _lnkid = (struct wpa_tdls_lnkid *) lnkid; ++ /* 1) TDLS initiator STA MAC address */ ++ _rtw_memcpy(pos, _lnkid->init_sta, ETH_ALEN); ++ pos += ETH_ALEN; ++ /* 2) TDLS responder STA MAC address */ ++ _rtw_memcpy(pos, _lnkid->resp_sta, ETH_ALEN); ++ pos += ETH_ALEN; ++ /* 3) Transaction Sequence number */ ++ *pos++ = trans_seq; ++ /* 4) Link Identifier IE */ ++ _rtw_memcpy(pos, lnkid, 2 + lnkid[1]); ++ pos += 2 + lnkid[1]; ++ /* 5) RSN IE */ ++ _rtw_memcpy(pos, rsnie, 2 + rsnie[1]); ++ pos += 2 + rsnie[1]; ++ /* 6) Timeout Interval IE */ ++ _rtw_memcpy(pos, timeoutie, 2 + timeoutie[1]); ++ pos += 2 + timeoutie[1]; ++ /* 7) FTIE, with the MIC field of the FTIE set to 0 */ ++ _rtw_memcpy(pos, ftie, 2 + ftie[1]); ++ _ftie = (struct wpa_tdls_ftie *) pos; ++ _rtw_memset(_ftie->mic, 0, TDLS_MIC_LEN); ++ pos += 2 + ftie[1]; ++ ++ ret = omac1_aes_128(kck, buf, pos - buf, mic); ++ rtw_mfree(buf, len); ++ return ret; ++ ++} ++ ++/** ++ * wpa_tdls_teardown_ftie_mic - Calculate TDLS TEARDOWN FTIE MIC ++ * @kck: TPK-KCK ++ * @lnkid: Pointer to the beginning of Link Identifier IE ++ * @reason: Reason code of TDLS Teardown ++ * @dialog_token: Dialog token that was used in the MIC calculation for TPK Handshake Message 3 ++ * @trans_seq: Transaction Sequence number (1 octet) which shall be set to the value 4 ++ * @ftie: Pointer to the beginning of FT IE ++ * @mic: Pointer for writing MIC ++ * ++ * Calculate MIC for TDLS TEARDOWN frame according to Section 10.22.5 in IEEE 802.11 - 2012. ++ */ ++int wpa_tdls_teardown_ftie_mic(u8 *kck, u8 *lnkid, u16 reason, ++ u8 dialog_token, u8 trans_seq, u8 *ftie, u8 *mic) ++{ ++ u8 *buf, *pos; ++ struct wpa_tdls_ftie *_ftie; ++ int ret; ++ int len = 2 + lnkid[1] + 2 + 1 + 1 + 2 + ftie[1]; ++ ++ buf = rtw_zmalloc(len); ++ if (!buf) { ++ RTW_INFO("TDLS: No memory for MIC calculation\n"); ++ return -1; ++ } ++ ++ pos = buf; ++ /* 1) Link Identifier IE */ ++ _rtw_memcpy(pos, lnkid, 2 + lnkid[1]); ++ pos += 2 + lnkid[1]; ++ /* 2) Reason Code */ ++ _rtw_memcpy(pos, (u8 *)&reason, 2); ++ pos += 2; ++ /* 3) Dialog Token */ ++ *pos++ = dialog_token; ++ /* 4) Transaction Sequence number */ ++ *pos++ = trans_seq; ++ /* 5) FTIE, with the MIC field of the FTIE set to 0 */ ++ _rtw_memcpy(pos, ftie, 2 + ftie[1]); ++ _ftie = (struct wpa_tdls_ftie *) pos; ++ _rtw_memset(_ftie->mic, 0, TDLS_MIC_LEN); ++ pos += 2 + ftie[1]; ++ ++ ret = omac1_aes_128(kck, buf, pos - buf, mic); ++ rtw_mfree(buf, len); ++ return ret; ++ ++} ++ ++int tdls_verify_mic(u8 *kck, u8 trans_seq, ++ u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie) ++{ ++ u8 *buf, *pos; ++ int len; ++ u8 mic[16]; ++ int ret; ++ u8 *rx_ftie, *tmp_ftie; ++ ++ if (lnkid == NULL || rsnie == NULL || ++ timeoutie == NULL || ftie == NULL) ++ return _FAIL; ++ ++ len = 2 * ETH_ALEN + 1 + 2 + 18 + 2 + *(rsnie + 1) + 2 + *(timeoutie + 1) + 2 + *(ftie + 1); ++ ++ buf = rtw_zmalloc(len); ++ if (buf == NULL) ++ return _FAIL; ++ ++ pos = buf; ++ /* 1) TDLS initiator STA MAC address */ ++ _rtw_memcpy(pos, lnkid + ETH_ALEN + 2, ETH_ALEN); ++ pos += ETH_ALEN; ++ /* 2) TDLS responder STA MAC address */ ++ _rtw_memcpy(pos, lnkid + 2 * ETH_ALEN + 2, ETH_ALEN); ++ pos += ETH_ALEN; ++ /* 3) Transaction Sequence number */ ++ *pos++ = trans_seq; ++ /* 4) Link Identifier IE */ ++ _rtw_memcpy(pos, lnkid, 2 + 18); ++ pos += 2 + 18; ++ /* 5) RSN IE */ ++ _rtw_memcpy(pos, rsnie, 2 + *(rsnie + 1)); ++ pos += 2 + *(rsnie + 1); ++ /* 6) Timeout Interval IE */ ++ _rtw_memcpy(pos, timeoutie, 2 + *(timeoutie + 1)); ++ pos += 2 + *(timeoutie + 1); ++ /* 7) FTIE, with the MIC field of the FTIE set to 0 */ ++ _rtw_memcpy(pos, ftie, 2 + *(ftie + 1)); ++ pos += 2; ++ tmp_ftie = (u8 *)(pos + 2); ++ _rtw_memset(tmp_ftie, 0, 16); ++ pos += *(ftie + 1); ++ ++ ret = omac1_aes_128(kck, buf, pos - buf, mic); ++ rtw_mfree(buf, len); ++ if (ret) ++ return _FAIL; ++ rx_ftie = ftie + 4; ++ ++ if (os_memcmp(mic, rx_ftie, 16) == 0) { ++ /* Valid MIC */ ++ return _SUCCESS; ++ } ++ ++ /* Invalid MIC */ ++ RTW_INFO("[%s] Invalid MIC\n", __FUNCTION__); ++ return _FAIL; ++ ++} ++#endif /* CONFIG_TDLS */ ++ ++void rtw_use_tkipkey_handler(RTW_TIMER_HDL_ARGS) ++{ ++ _adapter *padapter = (_adapter *)FunctionContext; ++ ++ ++ ++ /* ++ if (RTW_CANNOT_RUN(padapter)) { ++ ++ return; ++ } ++ */ ++ ++ padapter->securitypriv.busetkipkey = _TRUE; ++ ++ ++ ++} ++ ++/* Restore HW wep key setting according to key_mask */ ++void rtw_sec_restore_wep_key(_adapter *adapter) ++{ ++ struct security_priv *securitypriv = &(adapter->securitypriv); ++ sint keyid; ++ ++ if ((_WEP40_ == securitypriv->dot11PrivacyAlgrthm) || (_WEP104_ == securitypriv->dot11PrivacyAlgrthm)) { ++ for (keyid = 0; keyid < 4; keyid++) { ++ if (securitypriv->key_mask & BIT(keyid)) { ++ if (keyid == securitypriv->dot11PrivacyKeyIndex) ++ rtw_set_key(adapter, securitypriv, keyid, 1, _FALSE); ++ else ++ rtw_set_key(adapter, securitypriv, keyid, 0, _FALSE); ++ } ++ } ++ } ++} ++ ++u8 rtw_handle_tkip_countermeasure(_adapter *adapter, const char *caller) ++{ ++ struct security_priv *securitypriv = &(adapter->securitypriv); ++ u8 status = _SUCCESS; ++ ++ if (securitypriv->btkip_countermeasure == _TRUE) { ++ u32 passing_ms = rtw_get_passing_time_ms(securitypriv->btkip_countermeasure_time); ++ if (passing_ms > 60 * 1000) { ++ RTW_PRINT("%s("ADPT_FMT") countermeasure time:%ds > 60s\n", ++ caller, ADPT_ARG(adapter), passing_ms / 1000); ++ securitypriv->btkip_countermeasure = _FALSE; ++ securitypriv->btkip_countermeasure_time = 0; ++ } else { ++ RTW_PRINT("%s("ADPT_FMT") countermeasure time:%ds < 60s\n", ++ caller, ADPT_ARG(adapter), passing_ms / 1000); ++ status = _FAIL; ++ } ++ } ++ ++ return status; ++} ++ ++#ifdef CONFIG_WOWLAN ++u16 rtw_cal_crc16(u8 data, u16 crc) ++{ ++ u8 shift_in, data_bit; ++ u8 crc_bit4, crc_bit11, crc_bit15; ++ u16 crc_result; ++ int index; ++ ++ for (index = 0; index < 8; index++) { ++ crc_bit15 = ((crc & BIT15) ? 1 : 0); ++ data_bit = (data & (BIT0 << index) ? 1 : 0); ++ shift_in = crc_bit15 ^ data_bit; ++ /*printf("crc_bit15=%d, DataBit=%d, shift_in=%d\n", ++ * crc_bit15, data_bit, shift_in);*/ ++ ++ crc_result = crc << 1; ++ ++ if (shift_in == 0) ++ crc_result &= (~BIT0); ++ else ++ crc_result |= BIT0; ++ /*printf("CRC =%x\n",CRC_Result);*/ ++ ++ crc_bit11 = ((crc & BIT11) ? 1 : 0) ^ shift_in; ++ ++ if (crc_bit11 == 0) ++ crc_result &= (~BIT12); ++ else ++ crc_result |= BIT12; ++ ++ /*printf("bit12 CRC =%x\n",CRC_Result);*/ ++ ++ crc_bit4 = ((crc & BIT4) ? 1 : 0) ^ shift_in; ++ ++ if (crc_bit4 == 0) ++ crc_result &= (~BIT5); ++ else ++ crc_result |= BIT5; ++ ++ /* printf("bit5 CRC =%x\n",CRC_Result); */ ++ /* repeat using the last result*/ ++ crc = crc_result; ++ } ++ return crc; ++} ++ ++/* ++ * function name :rtw_calc_crc ++ * ++ * input: char* pattern , pattern size ++ * ++ */ ++u16 rtw_calc_crc(u8 *pdata, int length) ++{ ++ u16 crc = 0xffff; ++ int i; ++ ++ for (i = 0; i < length; i++) ++ crc = rtw_cal_crc16(pdata[i], crc); ++ /* get 1' complement */ ++ crc = ~crc; ++ ++ return crc; ++} ++#endif /*CONFIG_WOWLAN*/ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_sreset.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_sreset.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_sreset.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_sreset.c 2018-02-11 21:44:27.141145994 +0200 +@@ -0,0 +1,348 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#include ++#include ++#include ++ ++void sreset_init_value(_adapter *padapter) ++{ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++ ++ _rtw_mutex_init(&psrtpriv->silentreset_mutex); ++ psrtpriv->silent_reset_inprogress = _FALSE; ++ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; ++ psrtpriv->last_tx_time = 0; ++ psrtpriv->last_tx_complete_time = 0; ++#endif ++} ++void sreset_reset_value(_adapter *padapter) ++{ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++ ++ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; ++ psrtpriv->last_tx_time = 0; ++ psrtpriv->last_tx_complete_time = 0; ++#endif ++} ++ ++u8 sreset_get_wifi_status(_adapter *padapter) ++{ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++ ++ u8 status = WIFI_STATUS_SUCCESS; ++ u32 val32 = 0; ++ _irqL irqL; ++ if (psrtpriv->silent_reset_inprogress == _TRUE) ++ return status; ++ val32 = rtw_read32(padapter, REG_TXDMA_STATUS); ++ if (val32 == 0xeaeaeaea) ++ psrtpriv->Wifi_Error_Status = WIFI_IF_NOT_EXIST; ++ else if (val32 != 0) { ++ RTW_INFO("txdmastatu(%x)\n", val32); ++ psrtpriv->Wifi_Error_Status = WIFI_MAC_TXDMA_ERROR; ++ } ++ ++ if (WIFI_STATUS_SUCCESS != psrtpriv->Wifi_Error_Status) { ++ RTW_INFO("==>%s error_status(0x%x)\n", __FUNCTION__, psrtpriv->Wifi_Error_Status); ++ status = (psrtpriv->Wifi_Error_Status & (~(USB_READ_PORT_FAIL | USB_WRITE_PORT_FAIL))); ++ } ++ RTW_INFO("==> %s wifi_status(0x%x)\n", __FUNCTION__, status); ++ ++ /* status restore */ ++ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; ++ ++ return status; ++#else ++ return WIFI_STATUS_SUCCESS; ++#endif ++} ++ ++void sreset_set_wifi_error_status(_adapter *padapter, u32 status) ++{ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ pHalData->srestpriv.Wifi_Error_Status = status; ++#endif ++} ++ ++void sreset_set_trigger_point(_adapter *padapter, s32 tgp) ++{ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ pHalData->srestpriv.dbg_trigger_point = tgp; ++#endif ++} ++ ++bool sreset_inprogress(_adapter *padapter) ++{ ++#if defined(DBG_CONFIG_ERROR_RESET) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ return pHalData->srestpriv.silent_reset_inprogress; ++#else ++ return _FALSE; ++#endif ++} ++ ++void sreset_restore_security_station(_adapter *padapter) ++{ ++ u8 EntryId = 0; ++ struct mlme_priv *mlmepriv = &padapter->mlmepriv; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta; ++ struct security_priv *psecuritypriv = &(padapter->securitypriv); ++ struct mlme_ext_info *pmlmeinfo = &padapter->mlmeextpriv.mlmext_info; ++ ++ { ++ u8 val8; ++ ++ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_8021X) { ++ val8 = 0xcc; ++#ifdef CONFIG_WAPI_SUPPORT ++ } else if (padapter->wapiInfo.bWapiEnable && pmlmeinfo->auth_algo == dot11AuthAlgrthm_WAPI) { ++ /* Disable TxUseDefaultKey, RxUseDefaultKey, RxBroadcastUseDefaultKey. */ ++ val8 = 0x4c; ++#endif ++ } else ++ val8 = 0xcf; ++ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); ++ } ++ ++#if 0 ++ if ((padapter->securitypriv.dot11PrivacyAlgrthm == _WEP40_) || ++ (padapter->securitypriv.dot11PrivacyAlgrthm == _WEP104_)) { ++ ++ for (EntryId = 0; EntryId < 4; EntryId++) { ++ if (EntryId == psecuritypriv->dot11PrivacyKeyIndex) ++ rtw_set_key(padapter, &padapter->securitypriv, EntryId, 1, _FALSE); ++ else ++ rtw_set_key(padapter, &padapter->securitypriv, EntryId, 0, _FALSE); ++ } ++ ++ } else ++#endif ++ if ((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || ++ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) { ++ psta = rtw_get_stainfo(pstapriv, get_bssid(mlmepriv)); ++ if (psta == NULL) { ++ /* DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail\n")); */ ++ } else { ++ /* pairwise key */ ++ rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _FALSE); ++ /* group key */ ++ rtw_set_key(padapter, &padapter->securitypriv, padapter->securitypriv.dot118021XGrpKeyid, 0, _FALSE); ++ } ++ } ++} ++ ++void sreset_restore_network_station(_adapter *padapter) ++{ ++ struct mlme_priv *mlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 doiqk = _FALSE; ++ ++#if 0 ++ { ++ /* ======================================================= */ ++ /* reset related register of Beacon control */ ++ ++ /* set MSR to nolink */ ++ Set_MSR(padapter, _HW_STATE_NOLINK_); ++ /* reject all data frame */ ++ rtw_write16(padapter, REG_RXFLTMAP2, 0x00); ++ /* reset TSF */ ++ rtw_write8(padapter, REG_DUAL_TSF_RST, (BIT(0) | BIT(1))); ++ ++ /* disable update TSF */ ++ SetBcnCtrlReg(padapter, BIT(4), 0); ++ ++ /* ======================================================= */ ++ } ++#endif ++ ++ rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure, _FALSE); ++ ++ { ++ u8 threshold; ++#ifdef CONFIG_USB_HCI ++ /* TH=1 => means that invalidate usb rx aggregation */ ++ /* TH=0 => means that validate usb rx aggregation, use init value. */ ++ if (mlmepriv->htpriv.ht_option) { ++ if (padapter->registrypriv.wifi_spec == 1) ++ threshold = 1; ++ else ++ threshold = 0; ++ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); ++ } else { ++ threshold = 1; ++ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); ++ } ++#endif ++ } ++ ++ doiqk = _TRUE; ++ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK , &doiqk); ++ ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ ++ doiqk = _FALSE; ++ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); ++ /* disable dynamic functions, such as high power, DIG */ ++ /*rtw_phydm_func_disable_all(padapter);*/ ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress); ++ ++ { ++ u8 join_type = 0; ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); ++ } ++ ++ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); ++ ++ mlmeext_joinbss_event_callback(padapter, 1); ++ /* restore Sequence No. */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_RESTORE_HW_SEQ, 0); ++ ++ sreset_restore_security_station(padapter); ++} ++ ++ ++void sreset_restore_network_status(_adapter *padapter) ++{ ++ struct mlme_priv *mlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if (check_fwstate(mlmepriv, WIFI_STATION_STATE)) { ++ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); ++ sreset_restore_network_station(padapter); ++#ifdef CONFIG_AP_MODE ++ } else if (check_fwstate(mlmepriv, WIFI_AP_STATE)) { ++ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); ++ rtw_ap_restore_network(padapter); ++#endif/* CONFIG_AP_MODE */ ++ } else if (check_fwstate(mlmepriv, WIFI_ADHOC_STATE)) ++ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); ++ else ++ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); ++} ++ ++void sreset_stop_adapter(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ if (padapter == NULL) ++ return; ++ ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ ++ rtw_netif_stop_queue(padapter->pnetdev); ++ ++ rtw_cancel_all_timer(padapter); ++ ++ /* TODO: OS and HCI independent */ ++#if defined(PLATFORM_LINUX) && defined(CONFIG_USB_HCI) ++ tasklet_kill(&pxmitpriv->xmit_tasklet); ++#endif ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) ++ rtw_scan_abort(padapter); ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) { ++ rtw_set_to_roam(padapter, 0); ++ _rtw_join_timeout_handler(padapter); ++ } ++ ++} ++ ++void sreset_start_adapter(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ if (padapter == NULL) ++ return; ++ ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED)) ++ sreset_restore_network_status(padapter); ++ ++ /* TODO: OS and HCI independent */ ++#if defined(PLATFORM_LINUX) && defined(CONFIG_USB_HCI) ++ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); ++#endif ++ ++ if (is_primary_adapter(padapter)) ++ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); ++ ++ rtw_netif_wake_queue(padapter->pnetdev); ++} ++ ++void sreset_reset(_adapter *padapter) ++{ ++#ifdef DBG_CONFIG_ERROR_RESET ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ _irqL irqL; ++ u32 start = rtw_get_current_time(); ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; ++ ++ ++#ifdef CONFIG_LPS ++ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "SRESET"); ++#endif/* #ifdef CONFIG_LPS */ ++ ++ _enter_pwrlock(&pwrpriv->lock); ++ ++ psrtpriv->silent_reset_inprogress = _TRUE; ++ pwrpriv->change_rfpwrstate = rf_off; ++ ++ rtw_mi_sreset_adapter_hdl(padapter, _FALSE);/*sreset_stop_adapter*/ ++#ifdef CONFIG_IPS ++ _ips_enter(padapter); ++ _ips_leave(padapter); ++#endif ++ rtw_mi_sreset_adapter_hdl(padapter, _TRUE);/*sreset_start_adapter*/ ++ ++ psrtpriv->silent_reset_inprogress = _FALSE; ++ ++ _exit_pwrlock(&pwrpriv->lock); ++ ++ RTW_INFO("%s done in %d ms\n", __FUNCTION__, rtw_get_passing_time_ms(start)); ++ pdbgpriv->dbg_sreset_cnt++; ++#endif ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_sta_mgt.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_sta_mgt.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_sta_mgt.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_sta_mgt.c 2018-02-11 21:44:27.141145994 +0200 +@@ -0,0 +1,978 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_STA_MGT_C_ ++ ++#include ++ ++#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) ++ ++ #error "Shall be Linux or Windows, but not both!\n" ++ ++#endif ++ ++ ++bool test_st_match_rule(_adapter *adapter, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port) ++{ ++ if (ntohs(*((u16 *)local_port)) == 5001 || ntohs(*((u16 *)remote_port)) == 5001) ++ return _TRUE; ++ return _FALSE; ++} ++ ++struct st_register test_st_reg = { ++ .s_proto = 0x06, ++ .rule = test_st_match_rule, ++}; ++ ++inline void rtw_st_ctl_init(struct st_ctl_t *st_ctl) ++{ ++ _rtw_memset(st_ctl->reg, 0 , sizeof(struct st_register) * SESSION_TRACKER_REG_ID_NUM); ++ _rtw_init_queue(&st_ctl->tracker_q); ++} ++ ++inline void rtw_st_ctl_clear_tracker_q(struct st_ctl_t *st_ctl) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ struct session_tracker *st; ++ ++ _enter_critical_bh(&st_ctl->tracker_q.lock, &irqL); ++ phead = &st_ctl->tracker_q.queue; ++ plist = get_next(phead); ++ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ st = LIST_CONTAINOR(plist, struct session_tracker, list); ++ plist = get_next(plist); ++ rtw_list_delete(&st->list); ++ rtw_mfree((u8 *)st, sizeof(struct session_tracker)); ++ } ++ _exit_critical_bh(&st_ctl->tracker_q.lock, &irqL); ++} ++ ++inline void rtw_st_ctl_deinit(struct st_ctl_t *st_ctl) ++{ ++ rtw_st_ctl_clear_tracker_q(st_ctl); ++ _rtw_deinit_queue(&st_ctl->tracker_q); ++} ++ ++inline void rtw_st_ctl_register(struct st_ctl_t *st_ctl, u8 st_reg_id, struct st_register *reg) ++{ ++ if (st_reg_id >= SESSION_TRACKER_REG_ID_NUM) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ st_ctl->reg[st_reg_id].s_proto = reg->s_proto; ++ st_ctl->reg[st_reg_id].rule = reg->rule; ++} ++ ++inline void rtw_st_ctl_unregister(struct st_ctl_t *st_ctl, u8 st_reg_id) ++{ ++ int i; ++ ++ if (st_reg_id >= SESSION_TRACKER_REG_ID_NUM) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ st_ctl->reg[st_reg_id].s_proto = 0; ++ st_ctl->reg[st_reg_id].rule = NULL; ++ ++ /* clear tracker queue if no session trecker registered */ ++ for (i = 0; i < SESSION_TRACKER_REG_ID_NUM; i++) ++ if (st_ctl->reg[i].s_proto != 0) ++ break; ++ if (i >= SESSION_TRACKER_REG_ID_NUM) ++ rtw_st_ctl_clear_tracker_q(st_ctl); ++} ++ ++inline bool rtw_st_ctl_chk_reg_s_proto(struct st_ctl_t *st_ctl, u8 s_proto) ++{ ++ bool ret = _FALSE; ++ int i; ++ ++ for (i = 0; i < SESSION_TRACKER_REG_ID_NUM; i++) { ++ if (st_ctl->reg[i].s_proto == s_proto) { ++ ret = _TRUE; ++ break; ++ } ++ } ++ ++ return ret; ++} ++ ++inline bool rtw_st_ctl_chk_reg_rule(struct st_ctl_t *st_ctl, _adapter *adapter, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port) ++{ ++ bool ret = _FALSE; ++ int i; ++ st_match_rule rule; ++ ++ for (i = 0; i < SESSION_TRACKER_REG_ID_NUM; i++) { ++ rule = st_ctl->reg[i].rule; ++ if (rule && rule(adapter, local_naddr, local_port, remote_naddr, remote_port) == _TRUE) { ++ ret = _TRUE; ++ break; ++ } ++ } ++ ++ return ret; ++} ++ ++#define SESSION_TRACKER_FMT IP_FMT":"PORT_FMT" "IP_FMT":"PORT_FMT" %u %d" ++#define SESSION_TRACKER_ARG(st) IP_ARG(&(st)->local_naddr), PORT_ARG(&(st)->local_port), IP_ARG(&(st)->remote_naddr), PORT_ARG(&(st)->remote_port), (st)->status, rtw_get_passing_time_ms((st)->set_time) ++ ++void dump_st_ctl(void *sel, struct st_ctl_t *st_ctl) ++{ ++ int i; ++ _irqL irqL; ++ _list *plist, *phead; ++ struct session_tracker *st; ++ ++ if (!DBG_SESSION_TRACKER) ++ return; ++ ++ for (i = 0; i < SESSION_TRACKER_REG_ID_NUM; i++) ++ RTW_PRINT_SEL(sel, "reg%d: %u %p\n", i, st_ctl->reg[i].s_proto, st_ctl->reg[i].rule); ++ ++ _enter_critical_bh(&st_ctl->tracker_q.lock, &irqL); ++ phead = &st_ctl->tracker_q.queue; ++ plist = get_next(phead); ++ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ st = LIST_CONTAINOR(plist, struct session_tracker, list); ++ plist = get_next(plist); ++ ++ RTW_PRINT_SEL(sel, SESSION_TRACKER_FMT"\n", SESSION_TRACKER_ARG(st)); ++ } ++ _exit_critical_bh(&st_ctl->tracker_q.lock, &irqL); ++ ++} ++ ++void _rtw_init_stainfo(struct sta_info *psta); ++void _rtw_init_stainfo(struct sta_info *psta) ++{ ++ ++ ++ _rtw_memset((u8 *)psta, 0, sizeof(struct sta_info)); ++ ++ _rtw_spinlock_init(&psta->lock); ++ _rtw_init_listhead(&psta->list); ++ _rtw_init_listhead(&psta->hash_list); ++ /* _rtw_init_listhead(&psta->asoc_list); */ ++ /* _rtw_init_listhead(&psta->sleep_list); */ ++ /* _rtw_init_listhead(&psta->wakeup_list); */ ++ ++ _rtw_init_queue(&psta->sleep_q); ++ psta->sleepq_len = 0; ++ ++ _rtw_init_sta_xmit_priv(&psta->sta_xmitpriv); ++ _rtw_init_sta_recv_priv(&psta->sta_recvpriv); ++ ++#ifdef CONFIG_AP_MODE ++ ++ _rtw_init_listhead(&psta->asoc_list); ++ ++ _rtw_init_listhead(&psta->auth_list); ++ ++ psta->expire_to = 0; ++ ++ psta->flags = 0; ++ ++ psta->capability = 0; ++ ++ psta->bpairwise_key_installed = _FALSE; ++ ++#ifdef CONFIG_RTW_80211R ++ psta->ft_pairwise_key_installed = _FALSE; ++#endif ++ ++#ifdef CONFIG_NATIVEAP_MLME ++ psta->nonerp_set = 0; ++ psta->no_short_slot_time_set = 0; ++ psta->no_short_preamble_set = 0; ++ psta->no_ht_gf_set = 0; ++ psta->no_ht_set = 0; ++ psta->ht_20mhz_set = 0; ++ psta->ht_40mhz_intolerant = 0; ++#endif ++ ++#ifdef CONFIG_TX_MCAST2UNI ++ psta->under_exist_checking = 0; ++#endif /* CONFIG_TX_MCAST2UNI */ ++ ++ psta->keep_alive_trycnt = 0; ++ ++#endif /* CONFIG_AP_MODE */ ++ ++ rtw_st_ctl_init(&psta->st_ctl); ++ ++ ++} ++ ++u32 _rtw_init_sta_priv(struct sta_priv *pstapriv) ++{ ++ struct sta_info *psta; ++ s32 i; ++ ++ ++ pstapriv->pallocated_stainfo_buf = rtw_zvmalloc(sizeof(struct sta_info) * NUM_STA + 4); ++ ++ if (!pstapriv->pallocated_stainfo_buf) ++ return _FAIL; ++ ++ pstapriv->pstainfo_buf = pstapriv->pallocated_stainfo_buf + 4 - ++ ((SIZE_PTR)(pstapriv->pallocated_stainfo_buf) & 3); ++ ++ _rtw_init_queue(&pstapriv->free_sta_queue); ++ ++ _rtw_spinlock_init(&pstapriv->sta_hash_lock); ++ ++ /* _rtw_init_queue(&pstapriv->asoc_q); */ ++ pstapriv->asoc_sta_count = 0; ++ _rtw_init_queue(&pstapriv->sleep_q); ++ _rtw_init_queue(&pstapriv->wakeup_q); ++ ++ psta = (struct sta_info *)(pstapriv->pstainfo_buf); ++ ++ ++ for (i = 0; i < NUM_STA; i++) { ++ _rtw_init_stainfo(psta); ++ ++ _rtw_init_listhead(&(pstapriv->sta_hash[i])); ++ ++ rtw_list_insert_tail(&psta->list, get_list_head(&pstapriv->free_sta_queue)); ++ ++ psta++; ++ } ++ ++ pstapriv->adhoc_expire_to = 4; /* 4 * 2 = 8 sec */ ++ ++#ifdef CONFIG_AP_MODE ++ ++ pstapriv->sta_dz_bitmap = 0; ++ pstapriv->tim_bitmap = 0; ++ ++ _rtw_init_listhead(&pstapriv->asoc_list); ++ _rtw_init_listhead(&pstapriv->auth_list); ++ _rtw_spinlock_init(&pstapriv->asoc_list_lock); ++ _rtw_spinlock_init(&pstapriv->auth_list_lock); ++ pstapriv->asoc_list_cnt = 0; ++ pstapriv->auth_list_cnt = 0; ++ ++ pstapriv->auth_to = 3; /* 3*2 = 6 sec */ ++ pstapriv->assoc_to = 3; ++ /* pstapriv->expire_to = 900; */ /* 900*2 = 1800 sec = 30 min, expire after no any traffic. */ ++ /* pstapriv->expire_to = 30; */ /* 30*2 = 60 sec = 1 min, expire after no any traffic. */ ++#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++ pstapriv->expire_to = 3; /* 3*2 = 6 sec */ ++#else ++ pstapriv->expire_to = 60;/* 60*2 = 120 sec = 2 min, expire after no any traffic. */ ++#endif ++#ifdef CONFIG_ATMEL_RC_PATCH ++ _rtw_memset(pstapriv->atmel_rc_pattern, 0, ETH_ALEN); ++#endif ++ pstapriv->max_num_sta = NUM_STA; ++ ++#ifdef CONFIG_RTW_MACADDR_ACL ++ _rtw_init_queue(&(pstapriv->acl_list.acl_node_q)); ++#endif ++#endif /* CONFIG_AP_MODE */ ++ ++ ++ return _SUCCESS; ++ ++} ++ ++inline int rtw_stainfo_offset(struct sta_priv *stapriv, struct sta_info *sta) ++{ ++ int offset = (((u8 *)sta) - stapriv->pstainfo_buf) / sizeof(struct sta_info); ++ ++ if (!stainfo_offset_valid(offset)) ++ RTW_INFO("%s invalid offset(%d), out of range!!!", __func__, offset); ++ ++ return offset; ++} ++ ++inline struct sta_info *rtw_get_stainfo_by_offset(struct sta_priv *stapriv, int offset) ++{ ++ if (!stainfo_offset_valid(offset)) ++ RTW_INFO("%s invalid offset(%d), out of range!!!", __func__, offset); ++ ++ return (struct sta_info *)(stapriv->pstainfo_buf + offset * sizeof(struct sta_info)); ++} ++ ++void _rtw_free_sta_xmit_priv_lock(struct sta_xmit_priv *psta_xmitpriv); ++void _rtw_free_sta_xmit_priv_lock(struct sta_xmit_priv *psta_xmitpriv) ++{ ++ ++ _rtw_spinlock_free(&psta_xmitpriv->lock); ++ ++ _rtw_spinlock_free(&(psta_xmitpriv->be_q.sta_pending.lock)); ++ _rtw_spinlock_free(&(psta_xmitpriv->bk_q.sta_pending.lock)); ++ _rtw_spinlock_free(&(psta_xmitpriv->vi_q.sta_pending.lock)); ++ _rtw_spinlock_free(&(psta_xmitpriv->vo_q.sta_pending.lock)); ++} ++ ++static void _rtw_free_sta_recv_priv_lock(struct sta_recv_priv *psta_recvpriv) ++{ ++ ++ _rtw_spinlock_free(&psta_recvpriv->lock); ++ ++ _rtw_spinlock_free(&(psta_recvpriv->defrag_q.lock)); ++ ++ ++} ++ ++void rtw_mfree_stainfo(struct sta_info *psta); ++void rtw_mfree_stainfo(struct sta_info *psta) ++{ ++ ++ if (&psta->lock != NULL) ++ _rtw_spinlock_free(&psta->lock); ++ ++ _rtw_free_sta_xmit_priv_lock(&psta->sta_xmitpriv); ++ _rtw_free_sta_recv_priv_lock(&psta->sta_recvpriv); ++ ++} ++ ++ ++/* this function is used to free the memory of lock || sema for all stainfos */ ++void rtw_mfree_all_stainfo(struct sta_priv *pstapriv); ++void rtw_mfree_all_stainfo(struct sta_priv *pstapriv) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ struct sta_info *psta = NULL; ++ ++ ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ phead = get_list_head(&pstapriv->free_sta_queue); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info , list); ++ plist = get_next(plist); ++ ++ rtw_mfree_stainfo(psta); ++ } ++ ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ ++} ++ ++void rtw_mfree_sta_priv_lock(struct sta_priv *pstapriv); ++void rtw_mfree_sta_priv_lock(struct sta_priv *pstapriv) ++{ ++ rtw_mfree_all_stainfo(pstapriv); /* be done before free sta_hash_lock */ ++ ++ _rtw_spinlock_free(&pstapriv->free_sta_queue.lock); ++ ++ _rtw_spinlock_free(&pstapriv->sta_hash_lock); ++ _rtw_spinlock_free(&pstapriv->wakeup_q.lock); ++ _rtw_spinlock_free(&pstapriv->sleep_q.lock); ++ ++#ifdef CONFIG_AP_MODE ++ _rtw_spinlock_free(&pstapriv->asoc_list_lock); ++ _rtw_spinlock_free(&pstapriv->auth_list_lock); ++#endif ++ ++} ++ ++u32 _rtw_free_sta_priv(struct sta_priv *pstapriv) ++{ ++ _irqL irqL; ++ _list *phead, *plist; ++ struct sta_info *psta = NULL; ++ struct recv_reorder_ctrl *preorder_ctrl; ++ int index; ++ ++ if (pstapriv) { ++ ++ /* delete all reordering_ctrl_timer */ ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ for (index = 0; index < NUM_STA; index++) { ++ phead = &(pstapriv->sta_hash[index]); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ int i; ++ psta = LIST_CONTAINOR(plist, struct sta_info , hash_list); ++ plist = get_next(plist); ++ ++ for (i = 0; i < 16 ; i++) { ++ preorder_ctrl = &psta->recvreorder_ctrl[i]; ++ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); ++ } ++ } ++ } ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ /*===============================*/ ++ ++ rtw_mfree_sta_priv_lock(pstapriv); ++ ++#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) ++ _rtw_deinit_queue(&(pstapriv->acl_list.acl_node_q)); ++#endif ++ ++ if (pstapriv->pallocated_stainfo_buf) ++ rtw_vmfree(pstapriv->pallocated_stainfo_buf, sizeof(struct sta_info) * NUM_STA + 4); ++ } ++ ++ return _SUCCESS; ++} ++ ++ ++/* struct sta_info *rtw_alloc_stainfo(_queue *pfree_sta_queue, unsigned char *hwaddr) */ ++struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) ++{ ++ _irqL irqL, irqL2; ++ uint tmp_aid; ++ s32 index; ++ _list *phash_list; ++ struct sta_info *psta; ++ _queue *pfree_sta_queue; ++ struct recv_reorder_ctrl *preorder_ctrl; ++ int i = 0; ++ u16 wRxSeqInitialValue = 0xffff; ++ ++ ++ pfree_sta_queue = &pstapriv->free_sta_queue; ++ ++ /* _enter_critical_bh(&(pfree_sta_queue->lock), &irqL); */ ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); ++ if (_rtw_queue_empty(pfree_sta_queue) == _TRUE) { ++ /* _exit_critical_bh(&(pfree_sta_queue->lock), &irqL); */ ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); ++ psta = NULL; ++ } else { ++ psta = LIST_CONTAINOR(get_next(&pfree_sta_queue->queue), struct sta_info, list); ++ ++ rtw_list_delete(&(psta->list)); ++ ++ /* _exit_critical_bh(&(pfree_sta_queue->lock), &irqL); */ ++ ++ tmp_aid = psta->aid; ++ ++ _rtw_init_stainfo(psta); ++ ++ psta->padapter = pstapriv->padapter; ++ ++ _rtw_memcpy(psta->hwaddr, hwaddr, ETH_ALEN); ++ ++ index = wifi_mac_hash(hwaddr); ++ ++ ++ if (index >= NUM_STA) { ++ psta = NULL; ++ goto exit; ++ } ++ phash_list = &(pstapriv->sta_hash[index]); ++ ++ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); */ ++ ++ rtw_list_insert_tail(&psta->hash_list, phash_list); ++ ++ pstapriv->asoc_sta_count++; ++ ++ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); */ ++ ++ /* Commented by Albert 2009/08/13 ++ * For the SMC router, the sequence number of first packet of WPS handshake will be 0. ++ * In this case, this packet will be dropped by recv_decache function if we use the 0x00 as the default value for tid_rxseq variable. ++ * So, we initialize the tid_rxseq variable as the 0xffff. */ ++ ++ for (i = 0; i < 16; i++) { ++ _rtw_memcpy(&psta->sta_recvpriv.rxcache.tid_rxseq[i], &wRxSeqInitialValue, 2); ++ _rtw_memset(&psta->sta_recvpriv.rxcache.iv[i], 0, sizeof(psta->sta_recvpriv.rxcache.iv[i])); ++ } ++ ++ init_addba_retry_timer(pstapriv->padapter, psta); ++#ifdef CONFIG_IEEE80211W ++ init_dot11w_expire_timer(pstapriv->padapter, psta); ++#endif /* CONFIG_IEEE80211W */ ++#ifdef CONFIG_TDLS ++ rtw_init_tdls_timer(pstapriv->padapter, psta); ++#endif /* CONFIG_TDLS */ ++ ++ /* for A-MPDU Rx reordering buffer control */ ++ for (i = 0; i < 16 ; i++) { ++ preorder_ctrl = &psta->recvreorder_ctrl[i]; ++ ++ preorder_ctrl->padapter = pstapriv->padapter; ++ ++ preorder_ctrl->enable = _FALSE; ++ ++ preorder_ctrl->indicate_seq = 0xffff; ++#ifdef DBG_RX_SEQ ++ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq); ++#endif ++ preorder_ctrl->wend_b = 0xffff; ++ /* preorder_ctrl->wsize_b = (NR_RECVBUFF-2); */ ++ preorder_ctrl->wsize_b = 64;/* 64; */ ++ preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; ++ ++ _rtw_init_queue(&preorder_ctrl->pending_recvframe_queue); ++ ++ rtw_init_recv_timer(preorder_ctrl); ++ } ++ ++ ++ /* init for DM */ ++ psta->rssi_stat.UndecoratedSmoothedPWDB = (-1); ++ psta->rssi_stat.UndecoratedSmoothedCCK = (-1); ++#ifdef CONFIG_ATMEL_RC_PATCH ++ psta->flag_atmel_rc = 0; ++#endif ++ /* init for the sequence number of received management frame */ ++ psta->RxMgmtFrameSeqNum = 0xffff; ++ psta->ra_rpt_linked = _FALSE; ++ ++ rtw_alloc_macid(pstapriv->padapter, psta); ++ ++ } ++ ++exit: ++ ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); ++ ++ ++ if (psta) ++ rtw_mi_update_iface_status(&(pstapriv->padapter->mlmepriv), 0); ++ ++ return psta; ++} ++ ++ ++/* using pstapriv->sta_hash_lock to protect */ ++u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta) ++{ ++ int i; ++ _irqL irqL0; ++ _queue *pfree_sta_queue; ++ struct recv_reorder_ctrl *preorder_ctrl; ++ struct sta_xmit_priv *pstaxmitpriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct hw_xmit *phwxmit; ++ int pending_qcnt[4]; ++ ++ ++ if (psta == NULL) ++ goto exit; ++ ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); ++ rtw_list_delete(&psta->hash_list); ++ pstapriv->asoc_sta_count--; ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); ++ rtw_mi_update_iface_status(&(padapter->mlmepriv), 0); ++ ++ ++ _enter_critical_bh(&psta->lock, &irqL0); ++ psta->state &= ~_FW_LINKED; ++ _exit_critical_bh(&psta->lock, &irqL0); ++ ++ pfree_sta_queue = &pstapriv->free_sta_queue; ++ ++ ++ pstaxmitpriv = &psta->sta_xmitpriv; ++ ++ /* rtw_list_delete(&psta->sleep_list); */ ++ ++ /* rtw_list_delete(&psta->wakeup_list); */ ++ ++ _enter_critical_bh(&pxmitpriv->lock, &irqL0); ++ ++ rtw_free_xmitframe_queue(pxmitpriv, &psta->sleep_q); ++ psta->sleepq_len = 0; ++ ++ /* vo */ ++ /* _enter_critical_bh(&(pxmitpriv->vo_pending.lock), &irqL0); */ ++ rtw_free_xmitframe_queue(pxmitpriv, &pstaxmitpriv->vo_q.sta_pending); ++ rtw_list_delete(&(pstaxmitpriv->vo_q.tx_pending)); ++ phwxmit = pxmitpriv->hwxmits; ++ phwxmit->accnt -= pstaxmitpriv->vo_q.qcnt; ++ pending_qcnt[0] = pstaxmitpriv->vo_q.qcnt; ++ pstaxmitpriv->vo_q.qcnt = 0; ++ /* _exit_critical_bh(&(pxmitpriv->vo_pending.lock), &irqL0); */ ++ ++ /* vi */ ++ /* _enter_critical_bh(&(pxmitpriv->vi_pending.lock), &irqL0); */ ++ rtw_free_xmitframe_queue(pxmitpriv, &pstaxmitpriv->vi_q.sta_pending); ++ rtw_list_delete(&(pstaxmitpriv->vi_q.tx_pending)); ++ phwxmit = pxmitpriv->hwxmits + 1; ++ phwxmit->accnt -= pstaxmitpriv->vi_q.qcnt; ++ pending_qcnt[1] = pstaxmitpriv->vi_q.qcnt; ++ pstaxmitpriv->vi_q.qcnt = 0; ++ /* _exit_critical_bh(&(pxmitpriv->vi_pending.lock), &irqL0); */ ++ ++ /* be */ ++ /* _enter_critical_bh(&(pxmitpriv->be_pending.lock), &irqL0); */ ++ rtw_free_xmitframe_queue(pxmitpriv, &pstaxmitpriv->be_q.sta_pending); ++ rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); ++ phwxmit = pxmitpriv->hwxmits + 2; ++ phwxmit->accnt -= pstaxmitpriv->be_q.qcnt; ++ pending_qcnt[2] = pstaxmitpriv->be_q.qcnt; ++ pstaxmitpriv->be_q.qcnt = 0; ++ /* _exit_critical_bh(&(pxmitpriv->be_pending.lock), &irqL0); */ ++ ++ /* bk */ ++ /* _enter_critical_bh(&(pxmitpriv->bk_pending.lock), &irqL0); */ ++ rtw_free_xmitframe_queue(pxmitpriv, &pstaxmitpriv->bk_q.sta_pending); ++ rtw_list_delete(&(pstaxmitpriv->bk_q.tx_pending)); ++ phwxmit = pxmitpriv->hwxmits + 3; ++ phwxmit->accnt -= pstaxmitpriv->bk_q.qcnt; ++ pending_qcnt[3] = pstaxmitpriv->bk_q.qcnt; ++ pstaxmitpriv->bk_q.qcnt = 0; ++ /* _exit_critical_bh(&(pxmitpriv->bk_pending.lock), &irqL0); */ ++ ++ rtw_os_wake_queue_at_free_stainfo(padapter, pending_qcnt); ++ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL0); ++ ++ ++ /* re-init sta_info; 20061114 */ /* will be init in alloc_stainfo */ ++ /* _rtw_init_sta_xmit_priv(&psta->sta_xmitpriv); */ ++ /* _rtw_init_sta_recv_priv(&psta->sta_recvpriv); */ ++#ifdef CONFIG_IEEE80211W ++ _cancel_timer_ex(&psta->dot11w_expire_timer); ++#endif /* CONFIG_IEEE80211W */ ++ _cancel_timer_ex(&psta->addba_retry_timer); ++ ++#ifdef CONFIG_TDLS ++ psta->tdls_sta_state = TDLS_STATE_NONE; ++ rtw_free_tdls_timer(psta); ++#endif /* CONFIG_TDLS */ ++ ++ /* for A-MPDU Rx reordering buffer control, cancel reordering_ctrl_timer */ ++ for (i = 0; i < 16 ; i++) { ++ _irqL irqL; ++ _list *phead, *plist; ++ union recv_frame *prframe; ++ _queue *ppending_recvframe_queue; ++ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; ++ ++ preorder_ctrl = &psta->recvreorder_ctrl[i]; ++ ++ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); ++ ++ ++ ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; ++ ++ _enter_critical_bh(&ppending_recvframe_queue->lock, &irqL); ++ ++ phead = get_list_head(ppending_recvframe_queue); ++ plist = get_next(phead); ++ ++ while (!rtw_is_list_empty(phead)) { ++ prframe = LIST_CONTAINOR(plist, union recv_frame, u); ++ ++ plist = get_next(plist); ++ ++ rtw_list_delete(&(prframe->u.hdr.list)); ++ ++ rtw_free_recvframe(prframe, pfree_recv_queue); ++ } ++ ++ _exit_critical_bh(&ppending_recvframe_queue->lock, &irqL); ++ ++ } ++ ++ if (!((psta->state & WIFI_AP_STATE) || MacAddr_isBcst(psta->hwaddr))) ++ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _FALSE); ++ ++ ++ /* release mac id for non-bc/mc station, */ ++ rtw_release_macid(pstapriv->padapter, psta); ++ ++#ifdef CONFIG_AP_MODE ++ ++ /* ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL0); ++ rtw_list_delete(&psta->asoc_list); ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL0); ++ */ ++ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL0); ++ if (!rtw_is_list_empty(&psta->auth_list)) { ++ rtw_list_delete(&psta->auth_list); ++ pstapriv->auth_list_cnt--; ++ } ++ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL0); ++ ++ psta->expire_to = 0; ++#ifdef CONFIG_ATMEL_RC_PATCH ++ psta->flag_atmel_rc = 0; ++#endif ++ psta->sleepq_ac_len = 0; ++ psta->qos_info = 0; ++ ++ psta->max_sp_len = 0; ++ psta->uapsd_bk = 0; ++ psta->uapsd_be = 0; ++ psta->uapsd_vi = 0; ++ psta->uapsd_vo = 0; ++ ++ psta->has_legacy_ac = 0; ++ ++#ifdef CONFIG_NATIVEAP_MLME ++ ++ pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); ++ pstapriv->tim_bitmap &= ~BIT(psta->aid); ++ ++ /* rtw_indicate_sta_disassoc_event(padapter, psta); */ ++ ++ if ((psta->aid > 0) && (pstapriv->sta_aid[psta->aid - 1] == psta)) { ++ pstapriv->sta_aid[psta->aid - 1] = NULL; ++ psta->aid = 0; ++ } ++ ++#endif /* CONFIG_NATIVEAP_MLME */ ++ ++#ifdef CONFIG_TX_MCAST2UNI ++ psta->under_exist_checking = 0; ++#endif /* CONFIG_TX_MCAST2UNI */ ++ ++#endif /* CONFIG_AP_MODE */ ++ ++ rtw_st_ctl_deinit(&psta->st_ctl); ++ ++ _rtw_spinlock_free(&psta->lock); ++ ++ /* _enter_critical_bh(&(pfree_sta_queue->lock), &irqL0); */ ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); ++ rtw_list_insert_tail(&psta->list, get_list_head(pfree_sta_queue)); ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); ++ /* _exit_critical_bh(&(pfree_sta_queue->lock), &irqL0); */ ++ ++exit: ++ ++ ++ return _SUCCESS; ++ ++} ++ ++/* free all stainfo which in sta_hash[all] */ ++void rtw_free_all_stainfo(_adapter *padapter) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ s32 index; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *pbcmc_stainfo = rtw_get_bcmc_stainfo(padapter); ++ u8 free_sta_num = 0; ++ char free_sta_list[NUM_STA]; ++ int stainfo_offset; ++ ++ ++ if (pstapriv->asoc_sta_count == 1) ++ goto exit; ++ ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ for (index = 0; index < NUM_STA; index++) { ++ phead = &(pstapriv->sta_hash[index]); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info , hash_list); ++ ++ plist = get_next(plist); ++ ++ if (pbcmc_stainfo != psta) { ++ rtw_list_delete(&psta->hash_list); ++ /* rtw_free_stainfo(padapter , psta); */ ++ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); ++ if (stainfo_offset_valid(stainfo_offset)) ++ free_sta_list[free_sta_num++] = stainfo_offset; ++ } ++ ++ } ++ } ++ ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ ++ for (index = 0; index < free_sta_num; index++) { ++ psta = rtw_get_stainfo_by_offset(pstapriv, free_sta_list[index]); ++ rtw_free_stainfo(padapter , psta); ++ } ++ ++exit: ++ return; ++} ++ ++/* any station allocated can be searched by hash list */ ++struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) ++{ ++ ++ _irqL irqL; ++ ++ _list *plist, *phead; ++ ++ struct sta_info *psta = NULL; ++ ++ u32 index; ++ ++ u8 *addr; ++ ++ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ ++ if (hwaddr == NULL) ++ return NULL; ++ ++ if (IS_MCAST(hwaddr)) ++ addr = bc_addr; ++ else ++ addr = hwaddr; ++ ++ index = wifi_mac_hash(addr); ++ ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ phead = &(pstapriv->sta_hash[index]); ++ plist = get_next(phead); ++ ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ ++ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); ++ ++ if ((_rtw_memcmp(psta->hwaddr, addr, ETH_ALEN)) == _TRUE) { ++ /* if found the matched address */ ++ break; ++ } ++ psta = NULL; ++ plist = get_next(plist); ++ } ++ ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ return psta; ++ ++} ++ ++u32 rtw_init_bcmc_stainfo(_adapter *padapter) ++{ ++ ++ struct sta_info *psta; ++ struct tx_servq *ptxservq; ++ u32 res = _SUCCESS; ++ NDIS_802_11_MAC_ADDRESS bcast_addr = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ /* _queue *pstapending = &padapter->xmitpriv.bm_pending; */ ++ ++ ++ psta = rtw_alloc_stainfo(pstapriv, bcast_addr); ++ ++ if (psta == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++#ifdef CONFIG_BEAMFORMING ++ psta->txbf_gid = 63; ++ psta->txbf_paid = 0; ++#endif ++ ptxservq = &(psta->sta_xmitpriv.be_q); ++ ++ /* ++ _enter_critical(&pstapending->lock, &irqL0); ++ ++ if (rtw_is_list_empty(&ptxservq->tx_pending)) ++ rtw_list_insert_tail(&ptxservq->tx_pending, get_list_head(pstapending)); ++ ++ _exit_critical(&pstapending->lock, &irqL0); ++ */ ++ ++exit: ++ return _SUCCESS; ++ ++} ++ ++ ++struct sta_info *rtw_get_bcmc_stainfo(_adapter *padapter) ++{ ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ psta = rtw_get_stainfo(pstapriv, bc_addr); ++ return psta; ++ ++} ++ ++#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) ++const char *const _acl_mode_str[] = { ++ "DISABLED", ++ "ACCEPT_UNLESS_LISTED", ++ "DENY_UNLESS_LISTED", ++}; ++ ++u8 rtw_access_ctrl(_adapter *adapter, u8 *mac_addr) ++{ ++ u8 res = _TRUE; ++ _irqL irqL; ++ _list *list, *head; ++ struct rtw_wlan_acl_node *acl_node; ++ u8 match = _FALSE; ++ struct sta_priv *stapriv = &adapter->stapriv; ++ struct wlan_acl_pool *acl = &stapriv->acl_list; ++ _queue *acl_node_q = &acl->acl_node_q; ++ ++ _enter_critical_bh(&(acl_node_q->lock), &irqL); ++ head = get_list_head(acl_node_q); ++ list = get_next(head); ++ while (rtw_end_of_queue_search(head, list) == _FALSE) { ++ acl_node = LIST_CONTAINOR(list, struct rtw_wlan_acl_node, list); ++ list = get_next(list); ++ ++ if (_rtw_memcmp(acl_node->addr, mac_addr, ETH_ALEN)) { ++ if (acl_node->valid == _TRUE) { ++ match = _TRUE; ++ break; ++ } ++ } ++ } ++ _exit_critical_bh(&(acl_node_q->lock), &irqL); ++ ++ if (acl->mode == RTW_ACL_MODE_ACCEPT_UNLESS_LISTED) ++ res = (match == _TRUE) ? _FALSE : _TRUE; ++ else if (acl->mode == RTW_ACL_MODE_DENY_UNLESS_LISTED) ++ res = (match == _TRUE) ? _TRUE : _FALSE; ++ else ++ res = _TRUE; ++ ++ return res; ++} ++ ++void dump_macaddr_acl(void *sel, _adapter *adapter) ++{ ++ struct sta_priv *stapriv = &adapter->stapriv; ++ struct wlan_acl_pool *acl = &stapriv->acl_list; ++ int i; ++ ++ RTW_PRINT_SEL(sel, "mode:%s(%d)\n", acl_mode_str(acl->mode), acl->mode); ++ RTW_PRINT_SEL(sel, "num:%d/%d\n", acl->num, NUM_ACL); ++ for (i = 0; i < NUM_ACL; i++) { ++ if (acl->aclnode[i].valid == _FALSE) ++ continue; ++ RTW_PRINT_SEL(sel, MAC_FMT"\n", MAC_ARG(acl->aclnode[i].addr)); ++ } ++} ++#endif /* CONFIG_RTW_MACADDR_ACL && CONFIG_AP_MODE */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_tdls.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_tdls.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_tdls.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_tdls.c 2018-02-11 21:44:27.142146010 +0200 +@@ -0,0 +1,3341 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_TDLS_C_ ++ ++#include ++#include ++ ++#ifdef CONFIG_TDLS ++#define ONE_SEC 1000 /* 1000 ms */ ++ ++extern unsigned char MCS_rate_2R[16]; ++extern unsigned char MCS_rate_1R[16]; ++extern void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame); ++ ++void rtw_reset_tdls_info(_adapter *padapter) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ ++ ptdlsinfo->ap_prohibited = _FALSE; ++ ++ /* For TDLS channel switch, currently we only allow it to work in wifi logo test mode */ ++ if (padapter->registrypriv.wifi_spec == 1) ++ ptdlsinfo->ch_switch_prohibited = _FALSE; ++ else ++ ptdlsinfo->ch_switch_prohibited = _TRUE; ++ ++ ptdlsinfo->link_established = _FALSE; ++ ptdlsinfo->sta_cnt = 0; ++ ptdlsinfo->sta_maximum = _FALSE; ++ ++#ifdef CONFIG_TDLS_CH_SW ++ ptdlsinfo->chsw_info.ch_sw_state = TDLS_STATE_NONE; ++ ATOMIC_SET(&ptdlsinfo->chsw_info.chsw_on, _FALSE); ++ ptdlsinfo->chsw_info.off_ch_num = 0; ++ ptdlsinfo->chsw_info.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ptdlsinfo->chsw_info.cur_time = 0; ++ ptdlsinfo->chsw_info.delay_switch_back = _FALSE; ++ ptdlsinfo->chsw_info.dump_stack = _FALSE; ++#endif ++ ++ ptdlsinfo->ch_sensing = 0; ++ ptdlsinfo->watchdog_count = 0; ++ ptdlsinfo->dev_discovered = _FALSE; ++ ++#ifdef CONFIG_WFD ++ ptdlsinfo->wfd_info = &padapter->wfd_info; ++#endif ++} ++ ++int rtw_init_tdls_info(_adapter *padapter) ++{ ++ int res = _SUCCESS; ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ ++ rtw_reset_tdls_info(padapter); ++ ++ ptdlsinfo->tdls_enable = _TRUE; ++#ifdef CONFIG_TDLS_DRIVER_SETUP ++ ptdlsinfo->driver_setup = _TRUE; ++#else ++ ptdlsinfo->driver_setup = _FALSE; ++#endif /* CONFIG_TDLS_DRIVER_SETUP */ ++ ++ _rtw_spinlock_init(&ptdlsinfo->cmd_lock); ++ _rtw_spinlock_init(&ptdlsinfo->hdl_lock); ++ ++ return res; ++ ++} ++ ++void rtw_free_tdls_info(struct tdls_info *ptdlsinfo) ++{ ++ _rtw_spinlock_free(&ptdlsinfo->cmd_lock); ++ _rtw_spinlock_free(&ptdlsinfo->hdl_lock); ++ ++ _rtw_memset(ptdlsinfo, 0, sizeof(struct tdls_info)); ++ ++} ++ ++int check_ap_tdls_prohibited(u8 *pframe, u8 pkt_len) ++{ ++ u8 tdls_prohibited_bit = 0x40; /* bit(38); TDLS_prohibited */ ++ ++ if (pkt_len < 5) ++ return _FALSE; ++ ++ pframe += 4; ++ if ((*pframe) & tdls_prohibited_bit) ++ return _TRUE; ++ ++ return _FALSE; ++} ++ ++int check_ap_tdls_ch_switching_prohibited(u8 *pframe, u8 pkt_len) ++{ ++ u8 tdls_ch_swithcing_prohibited_bit = 0x80; /* bit(39); TDLS_channel_switching prohibited */ ++ ++ if (pkt_len < 5) ++ return _FALSE; ++ ++ pframe += 4; ++ if ((*pframe) & tdls_ch_swithcing_prohibited_bit) ++ return _TRUE; ++ ++ return _FALSE; ++} ++ ++u8 rtw_tdls_is_setup_allowed(_adapter *padapter) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ ++ if (ptdlsinfo->ap_prohibited == _TRUE) ++ return _FALSE; ++ ++ return _TRUE; ++} ++ ++#ifdef CONFIG_TDLS_CH_SW ++u8 rtw_tdls_is_chsw_allowed(_adapter *padapter) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ ++ if (ptdlsinfo->ch_switch_prohibited == _TRUE) ++ return _FALSE; ++ ++ if (padapter->registrypriv.wifi_spec == 0) ++ return _FALSE; ++ ++ return _TRUE; ++} ++#endif ++ ++int _issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int wait_ack) ++{ ++ int ret = _FAIL; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl, *qc; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ pattrib->hdrlen += 2; ++ pattrib->qos_en = _TRUE; ++ pattrib->eosp = 1; ++ pattrib->ack_policy = 0; ++ pattrib->mdata = 0; ++ pattrib->retry_ctrl = _FALSE; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ if (power_mode) ++ SetPwrMgt(fctrl); ++ ++ qc = (unsigned short *)(pframe + pattrib->hdrlen - 2); ++ ++ SetPriority(qc, 7); /* Set priority to VO */ ++ ++ SetEOSP(qc, pattrib->eosp); ++ ++ SetAckpolicy(qc, pattrib->ack_policy); ++ ++ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr_qos); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ if (wait_ack) ++ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); ++ else { ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ } ++ ++exit: ++ return ret; ++ ++} ++ ++/* ++ *wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT ++ *wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX ++ *try_cnt means the maximal TX count to try ++ */ ++int issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) ++{ ++ int ret; ++ int i = 0; ++ u32 start = rtw_get_current_time(); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++#if 0 ++ psta = rtw_get_stainfo(&padapter->stapriv, da); ++ if (psta) { ++ if (power_mode) ++ rtw_hal_macid_sleep(padapter, psta->mac_id); ++ else ++ rtw_hal_macid_wakeup(padapter, psta->mac_id); ++ } else { ++ RTW_INFO(FUNC_ADPT_FMT ": Can't find sta info for " MAC_FMT ", skip macid %s!!\n", ++ FUNC_ADPT_ARG(padapter), MAC_ARG(da), power_mode ? "sleep" : "wakeup"); ++ rtw_warn_on(1); ++ } ++#endif ++ ++ do { ++ ret = _issue_nulldata_to_TDLS_peer_STA(padapter, da, power_mode, wait_ms > 0 ? _TRUE : _FALSE); ++ ++ i++; ++ ++ if (RTW_CANNOT_RUN(padapter)) ++ break; ++ ++ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) ++ rtw_msleep_os(wait_ms); ++ ++ } while ((i < try_cnt) && (ret == _FAIL || wait_ms == 0)); ++ ++ if (ret != _FAIL) { ++ ret = _SUCCESS; ++#ifndef DBG_XMIT_ACK ++ goto exit; ++#endif ++ } ++ ++ if (try_cnt && wait_ms) { ++ if (da) ++ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ else ++ RTW_INFO(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", ++ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), ++ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); ++ } ++exit: ++ return ret; ++} ++ ++void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ _irqL irqL; ++ ++ /* free peer sta_info */ ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ if (ptdlsinfo->sta_cnt != 0) ++ ptdlsinfo->sta_cnt--; ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ /* -2: AP + BC/MC sta, -4: default key */ ++ if (ptdlsinfo->sta_cnt < MAX_ALLOWED_TDLS_STA_NUM) { ++ ptdlsinfo->sta_maximum = _FALSE; ++ _rtw_memset(&ptdlsinfo->ss_record, 0x00, sizeof(struct tdls_ss_record)); ++ } ++ ++ /* clear cam */ ++ rtw_clearstakey_cmd(padapter, ptdls_sta, _TRUE); ++ ++ if (ptdlsinfo->sta_cnt == 0) { ++ rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR); ++ ptdlsinfo->link_established = _FALSE; ++ } else ++ RTW_INFO("Remain tdls sta:%02x\n", ptdlsinfo->sta_cnt); ++ ++ rtw_free_stainfo(padapter, ptdls_sta); ++ ++} ++ ++ ++/* TDLS encryption(if needed) will always be CCMP */ ++void rtw_tdls_set_key(_adapter *padapter, struct sta_info *ptdls_sta) ++{ ++ ptdls_sta->dot118021XPrivacy = _AES_; ++ rtw_setstakey_cmd(padapter, ptdls_sta, TDLS_KEY, _TRUE); ++} ++ ++#ifdef CONFIG_80211N_HT ++void rtw_tdls_process_ht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 *data, u8 Length) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++ u8 max_AMPDU_len, min_MPDU_spacing; ++ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0; ++ ++ /* Save HT capabilities in the sta object */ ++ _rtw_memset(&ptdls_sta->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap)); ++ if (data && Length >= sizeof(struct rtw_ieee80211_ht_cap)) { ++ ptdls_sta->flags |= WLAN_STA_HT; ++ ptdls_sta->flags |= WLAN_STA_WME; ++ ++ _rtw_memcpy(&ptdls_sta->htpriv.ht_cap, data, sizeof(struct rtw_ieee80211_ht_cap)); ++ } else ++ ptdls_sta->flags &= ~WLAN_STA_HT; ++ ++ if (ptdls_sta->flags & WLAN_STA_HT) { ++ if (padapter->registrypriv.ht_enable == _TRUE) { ++ ptdls_sta->htpriv.ht_option = _TRUE; ++ ptdls_sta->qos_option = _TRUE; ++ } else { ++ ptdls_sta->htpriv.ht_option = _FALSE; ++ ptdls_sta->qos_option = _FALSE; ++ } ++ } ++ ++ /* HT related cap */ ++ if (ptdls_sta->htpriv.ht_option) { ++ /* Check if sta supports rx ampdu */ ++ if (padapter->registrypriv.ampdu_enable == 1) ++ ptdls_sta->htpriv.ampdu_enable = _TRUE; ++ ++ /* AMPDU Parameters field */ ++ /* Get MIN of MAX AMPDU Length Exp */ ++ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3) > (data[2] & 0x3)) ++ max_AMPDU_len = (data[2] & 0x3); ++ else ++ max_AMPDU_len = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3); ++ /* Get MAX of MIN MPDU Start Spacing */ ++ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) > (data[2] & 0x1c)) ++ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c); ++ else ++ min_MPDU_spacing = (data[2] & 0x1c); ++ ptdls_sta->htpriv.rx_ampdu_min_spacing = max_AMPDU_len | min_MPDU_spacing; ++ ++ /* Check if sta support s Short GI 20M */ ++ if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_20)) ++ ptdls_sta->htpriv.sgi_20m = _TRUE; ++ ++ /* Check if sta support s Short GI 40M */ ++ if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_40)) ++ ptdls_sta->htpriv.sgi_40m = _TRUE; ++ ++ /* Bwmode would still followed AP's setting */ ++ if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) { ++ if (padapter->mlmeextpriv.cur_bwmode >= CHANNEL_WIDTH_40) ++ ptdls_sta->bw_mode = CHANNEL_WIDTH_40; ++ ptdls_sta->htpriv.ch_offset = padapter->mlmeextpriv.cur_ch_offset; ++ } ++ ++ /* Config LDPC Coding Capability */ ++ if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX) && GET_HT_CAP_ELE_LDPC_CAP(data)) { ++ SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX)); ++ RTW_INFO("Enable HT Tx LDPC!\n"); ++ } ++ ptdls_sta->htpriv.ldpc_cap = cur_ldpc_cap; ++ ++ /* Config STBC setting */ ++ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAP_ELE_RX_STBC(data)) { ++ SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX)); ++ RTW_INFO("Enable HT Tx STBC!\n"); ++ } ++ ptdls_sta->htpriv.stbc_cap = cur_stbc_cap; ++ ++#ifdef CONFIG_BEAMFORMING ++ /* Config Tx beamforming setting */ ++ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && ++ GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(data)) ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); ++ ++ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && ++ GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(data)) ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); ++ ptdls_sta->htpriv.beamform_cap = cur_beamform_cap; ++ if (cur_beamform_cap) ++ RTW_INFO("Client HT Beamforming Cap = 0x%02X\n", cur_beamform_cap); ++#endif /* CONFIG_BEAMFORMING */ ++ } ++ ++} ++ ++u8 *rtw_tdls_set_ht_cap(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ rtw_ht_use_default_setting(padapter); ++ ++ rtw_restructure_ht_ie(padapter, NULL, pframe, 0, &(pattrib->pktlen), padapter->mlmeextpriv.cur_channel); ++ ++ return pframe + pattrib->pktlen; ++} ++#endif ++ ++#ifdef CONFIG_80211AC_VHT ++void rtw_tdls_process_vht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 *data, u8 Length) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0, rf_type = RF_1T1R; ++ u8 *pcap_mcs; ++ u8 vht_mcs[2]; ++ ++ _rtw_memset(&ptdls_sta->vhtpriv, 0, sizeof(struct vht_priv)); ++ if (data && Length == 12) { ++ ptdls_sta->flags |= WLAN_STA_VHT; ++ ++ _rtw_memcpy(ptdls_sta->vhtpriv.vht_cap, data, 12); ++ ++#if 0 ++ if (elems.vht_op_mode_notify && elems.vht_op_mode_notify_len == 1) ++ _rtw_memcpy(&pstat->vhtpriv.vht_op_mode_notify, elems.vht_op_mode_notify, 1); ++ else /* for Frame without Operating Mode notify ie; default: 80M */ ++ pstat->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80; ++#else ++ ptdls_sta->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80; ++#endif ++ } else ++ ptdls_sta->flags &= ~WLAN_STA_VHT; ++ ++ if (ptdls_sta->flags & WLAN_STA_VHT) { ++ if (REGSTY_IS_11AC_ENABLE(&padapter->registrypriv) ++ && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) ++ && (!pmlmepriv->country_ent || COUNTRY_CHPLAN_EN_11AC(pmlmepriv->country_ent))) ++ ptdls_sta->vhtpriv.vht_option = _TRUE; ++ else ++ ptdls_sta->vhtpriv.vht_option = _FALSE; ++ } ++ ++ /* B4 Rx LDPC */ ++ if (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX) && ++ GET_VHT_CAPABILITY_ELE_RX_LDPC(data)) { ++ SET_FLAG(cur_ldpc_cap, (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX)); ++ RTW_INFO("Current VHT LDPC Setting = %02X\n", cur_ldpc_cap); ++ } ++ ptdls_sta->vhtpriv.ldpc_cap = cur_ldpc_cap; ++ ++ /* B5 Short GI for 80 MHz */ ++ ptdls_sta->vhtpriv.sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(data) & pvhtpriv->sgi_80m) ? _TRUE : _FALSE; ++ ++ /* B8 B9 B10 Rx STBC */ ++ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX) && ++ GET_VHT_CAPABILITY_ELE_RX_STBC(data)) { ++ SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); ++ RTW_INFO("Current VHT STBC Setting = %02X\n", cur_stbc_cap); ++ } ++ ptdls_sta->vhtpriv.stbc_cap = cur_stbc_cap; ++ ++ /* B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee */ ++ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && ++ GET_VHT_CAPABILITY_ELE_SU_BFEE(data)) ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); ++ ++ /* B12 SU Beamformee Capable, the target supports Beamformee and we are Beamformer */ ++ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) && ++ GET_VHT_CAPABILITY_ELE_SU_BFER(data)) ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); ++ ptdls_sta->vhtpriv.beamform_cap = cur_beamform_cap; ++ if (cur_beamform_cap) ++ RTW_INFO("Current VHT Beamforming Setting = %02X\n", cur_beamform_cap); ++ ++ /* B23 B24 B25 Maximum A-MPDU Length Exponent */ ++ ptdls_sta->vhtpriv.ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(data); ++ ++ pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(data); ++ _rtw_memcpy(vht_mcs, pcap_mcs, 2); ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ if ((rf_type == RF_1T1R) || (rf_type == RF_1T2R)) ++ vht_mcs[0] |= 0xfc; ++ else if (rf_type == RF_2T2R) ++ vht_mcs[0] |= 0xf0; ++ else if (rf_type == RF_3T3R) ++ vht_mcs[0] |= 0xc0; ++ ++ _rtw_memcpy(ptdls_sta->vhtpriv.vht_mcs_map, vht_mcs, 2); ++ ++ ptdls_sta->vhtpriv.vht_highest_rate = rtw_get_vht_highest_rate(ptdls_sta->vhtpriv.vht_mcs_map); ++} ++ ++u8 *rtw_tdls_set_aid(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ return rtw_set_ie(pframe, EID_AID, 2, (u8 *)&(padapter->mlmepriv.cur_network.aid), &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_vht_cap(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ u32 ie_len = 0; ++ ++ rtw_vht_use_default_setting(padapter); ++ ++ ie_len = rtw_build_vht_cap_ie(padapter, pframe); ++ pattrib->pktlen += ie_len; ++ ++ return pframe + ie_len; ++} ++ ++u8 *rtw_tdls_set_vht_operation(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib, u8 channel) ++{ ++ u32 ie_len = 0; ++ ++ ie_len = rtw_build_vht_operation_ie(padapter, pframe, channel); ++ pattrib->pktlen += ie_len; ++ ++ return pframe + ie_len; ++} ++ ++u8 *rtw_tdls_set_vht_op_mode_notify(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib, u8 bw) ++{ ++ u32 ie_len = 0; ++ ++ ie_len = rtw_build_vht_op_mode_notify_ie(padapter, pframe, bw); ++ pattrib->pktlen += ie_len; ++ ++ return pframe + ie_len; ++} ++#endif ++ ++ ++u8 *rtw_tdls_set_sup_ch(struct mlme_ext_priv *pmlmeext, u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ u8 sup_ch[30 * 2] = {0x00}, ch_set_idx = 0, sup_ch_idx = 2; ++ ++ do { ++ if (pmlmeext->channel_set[ch_set_idx].ChannelNum <= 14) { ++ sup_ch[0] = 1; /* First channel number */ ++ sup_ch[1] = pmlmeext->channel_set[ch_set_idx].ChannelNum; /* Number of channel */ ++ } else { ++ sup_ch[sup_ch_idx++] = pmlmeext->channel_set[ch_set_idx].ChannelNum; ++ sup_ch[sup_ch_idx++] = 1; ++ } ++ ch_set_idx++; ++ } while (pmlmeext->channel_set[ch_set_idx].ChannelNum != 0 && ch_set_idx < MAX_CHANNEL_NUM); ++ ++ return rtw_set_ie(pframe, _SUPPORTED_CH_IE_, sup_ch_idx, sup_ch, &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_rsnie(struct tdls_txmgmt *ptxmgmt, u8 *pframe, struct pkt_attrib *pattrib, int init, struct sta_info *ptdls_sta) ++{ ++ u8 *p = NULL; ++ int len = 0; ++ ++ if (ptxmgmt->len > 0) ++ p = rtw_get_ie(ptxmgmt->buf, _RSN_IE_2_, &len, ptxmgmt->len); ++ ++ if (p != NULL) ++ return rtw_set_ie(pframe, _RSN_IE_2_, len, p + 2, &(pattrib->pktlen)); ++ else if (init == _TRUE) ++ return rtw_set_ie(pframe, _RSN_IE_2_, sizeof(TDLS_RSNIE), TDLS_RSNIE, &(pattrib->pktlen)); ++ else ++ return rtw_set_ie(pframe, _RSN_IE_2_, sizeof(ptdls_sta->TDLS_RSNIE), ptdls_sta->TDLS_RSNIE, &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_ext_cap(u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ return rtw_set_ie(pframe, _EXT_CAP_IE_ , sizeof(TDLS_EXT_CAPIE), TDLS_EXT_CAPIE, &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_qos_cap(u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ return rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, sizeof(TDLS_WMMIE), TDLS_WMMIE, &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_ftie(struct tdls_txmgmt *ptxmgmt, u8 *pframe, struct pkt_attrib *pattrib, u8 *ANonce, u8 *SNonce) ++{ ++ struct wpa_tdls_ftie FTIE = {0}; ++ u8 *p = NULL; ++ int len = 0; ++ ++ if (ptxmgmt->len > 0) ++ p = rtw_get_ie(ptxmgmt->buf, _FTIE_, &len, ptxmgmt->len); ++ ++ if (p != NULL) ++ return rtw_set_ie(pframe, _FTIE_, len, p + 2, &(pattrib->pktlen)); ++ else { ++ if (ANonce != NULL) ++ _rtw_memcpy(FTIE.Anonce, ANonce, WPA_NONCE_LEN); ++ if (SNonce != NULL) ++ _rtw_memcpy(FTIE.Snonce, SNonce, WPA_NONCE_LEN); ++ return rtw_set_ie(pframe, _FTIE_ , 82, (u8 *)FTIE.mic_ctrl, &(pattrib->pktlen)); ++ } ++} ++ ++u8 *rtw_tdls_set_timeout_interval(struct tdls_txmgmt *ptxmgmt, u8 *pframe, struct pkt_attrib *pattrib, int init, struct sta_info *ptdls_sta) ++{ ++ u8 timeout_itvl[5]; /* set timeout interval to maximum value */ ++ u32 timeout_interval = TDLS_TPK_RESEND_COUNT; ++ u8 *p = NULL; ++ int len = 0; ++ ++ if (ptxmgmt->len > 0) ++ p = rtw_get_ie(ptxmgmt->buf, _TIMEOUT_ITVL_IE_, &len, ptxmgmt->len); ++ ++ if (p != NULL) ++ return rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, len, p + 2, &(pattrib->pktlen)); ++ else { ++ /* Timeout interval */ ++ timeout_itvl[0] = 0x02; ++ if (init == _TRUE) ++ _rtw_memcpy(timeout_itvl + 1, &timeout_interval, 4); ++ else ++ _rtw_memcpy(timeout_itvl + 1, (u8 *)(&ptdls_sta->TDLS_PeerKey_Lifetime), 4); ++ ++ return rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); ++ } ++} ++ ++u8 *rtw_tdls_set_bss_coexist(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ u8 iedata = 0; ++ ++ if (padapter->mlmepriv.num_FortyMHzIntolerant > 0) ++ iedata |= BIT(2); /* 20 MHz BSS Width Request */ ++ ++ /* Information Bit should be set by TDLS test plan 5.9 */ ++ iedata |= BIT(0); ++ return rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_payload_type(u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ u8 payload_type = 0x02; ++ return rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_category(u8 *pframe, struct pkt_attrib *pattrib, u8 category) ++{ ++ return rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_action(u8 *pframe, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt) ++{ ++ return rtw_set_fixed_ie(pframe, 1, &(ptxmgmt->action_code), &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_status_code(u8 *pframe, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt) ++{ ++ return rtw_set_fixed_ie(pframe, 2, (u8 *)&(ptxmgmt->status_code), &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_dialog(u8 *pframe, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt) ++{ ++ u8 dialogtoken = 1; ++ if (ptxmgmt->dialog_token) ++ return rtw_set_fixed_ie(pframe, 1, &(ptxmgmt->dialog_token), &(pattrib->pktlen)); ++ else ++ return rtw_set_fixed_ie(pframe, 1, &(dialogtoken), &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_reg_class(u8 *pframe, struct pkt_attrib *pattrib, struct sta_info *ptdls_sta) ++{ ++ u8 reg_class = 22; ++ return rtw_set_fixed_ie(pframe, 1, &(reg_class), &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_second_channel_offset(u8 *pframe, struct pkt_attrib *pattrib, u8 ch_offset) ++{ ++ return rtw_set_ie(pframe, EID_SecondaryChnlOffset , 1, &ch_offset, &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_capability(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; ++ u8 cap_from_ie[2] = {0}; ++ ++ _rtw_memcpy(cap_from_ie, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); ++ ++ return rtw_set_fixed_ie(pframe, 2, cap_from_ie, &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_supported_rate(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ u8 bssrate[NDIS_802_11_LENGTH_RATES_EX]; ++ int bssrate_len = 0; ++ u8 more_supportedrates = 0; ++ ++ rtw_set_supported_rate(bssrate, (padapter->registrypriv.wireless_mode == WIRELESS_MODE_MAX) ? padapter->mlmeextpriv.cur_wireless_mode : padapter->registrypriv.wireless_mode); ++ bssrate_len = rtw_get_rateset_len(bssrate); ++ ++ if (bssrate_len > 8) { ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); ++ more_supportedrates = 1; ++ } else ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); ++ ++ /* extended supported rates */ ++ if (more_supportedrates == 1) ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); ++ ++ return pframe; ++} ++ ++u8 *rtw_tdls_set_sup_reg_class(u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ return rtw_set_ie(pframe, _SRC_IE_ , sizeof(TDLS_SRC), TDLS_SRC, &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_linkid(u8 *pframe, struct pkt_attrib *pattrib, u8 init) ++{ ++ u8 link_id_addr[18] = {0}; ++ if (init == _TRUE) { ++ _rtw_memcpy(link_id_addr, pattrib->ra, 6); ++ _rtw_memcpy((link_id_addr + 6), pattrib->src, 6); ++ _rtw_memcpy((link_id_addr + 12), pattrib->dst, 6); ++ } else { ++ _rtw_memcpy(link_id_addr, pattrib->ra, 6); ++ _rtw_memcpy((link_id_addr + 6), pattrib->dst, 6); ++ _rtw_memcpy((link_id_addr + 12), pattrib->src, 6); ++ } ++ return rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); ++} ++ ++#ifdef CONFIG_TDLS_CH_SW ++u8 *rtw_tdls_set_target_ch(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ u8 target_ch = 1; ++ if (padapter->tdlsinfo.chsw_info.off_ch_num) ++ return rtw_set_fixed_ie(pframe, 1, &(padapter->tdlsinfo.chsw_info.off_ch_num), &(pattrib->pktlen)); ++ else ++ return rtw_set_fixed_ie(pframe, 1, &(target_ch), &(pattrib->pktlen)); ++} ++ ++u8 *rtw_tdls_set_ch_sw(u8 *pframe, struct pkt_attrib *pattrib, struct sta_info *ptdls_sta) ++{ ++ u8 ch_switch_timing[4] = {0}; ++ u16 switch_time = (ptdls_sta->ch_switch_time >= TDLS_CH_SWITCH_TIME * 1000) ? ++ ptdls_sta->ch_switch_time : TDLS_CH_SWITCH_TIME; ++ u16 switch_timeout = (ptdls_sta->ch_switch_timeout >= TDLS_CH_SWITCH_TIMEOUT * 1000) ? ++ ptdls_sta->ch_switch_timeout : TDLS_CH_SWITCH_TIMEOUT; ++ ++ _rtw_memcpy(ch_switch_timing, &switch_time, 2); ++ _rtw_memcpy(ch_switch_timing + 2, &switch_timeout, 2); ++ ++ return rtw_set_ie(pframe, _CH_SWITCH_TIMING_, 4, ch_switch_timing, &(pattrib->pktlen)); ++} ++ ++void rtw_tdls_set_ch_sw_oper_control(_adapter *padapter, u8 enable) ++{ ++ if (ATOMIC_READ(&padapter->tdlsinfo.chsw_info.chsw_on) != enable) ++ ATOMIC_SET(&padapter->tdlsinfo.chsw_info.chsw_on, enable); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_BCN_EARLY_C2H_RPT, &enable); ++ RTW_INFO("[TDLS] %s Bcn Early C2H Report\n", (enable == _TRUE) ? "Start" : "Stop"); ++} ++ ++void rtw_tdls_ch_sw_back_to_base_chnl(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv; ++ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; ++ ++ pmlmepriv = &padapter->mlmepriv; ++ ++ if ((ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) && ++ (padapter->mlmeextpriv.cur_channel != rtw_get_oper_ch(padapter))) ++ rtw_tdls_cmd(padapter, pchsw_info->addr, TDLS_CH_SW_TO_BASE_CHNL_UNSOLICITED); ++} ++ ++static void rtw_tdls_chsw_oper_init(_adapter *padapter, u32 timeout_ms) ++{ ++ struct submit_ctx *chsw_sctx = &padapter->tdlsinfo.chsw_info.chsw_sctx; ++ ++ rtw_sctx_init(chsw_sctx, timeout_ms); ++} ++ ++static int rtw_tdls_chsw_oper_wait(_adapter *padapter) ++{ ++ struct submit_ctx *chsw_sctx = &padapter->tdlsinfo.chsw_info.chsw_sctx; ++ ++ return rtw_sctx_wait(chsw_sctx, __func__); ++} ++ ++void rtw_tdls_chsw_oper_done(_adapter *padapter) ++{ ++ struct submit_ctx *chsw_sctx = &padapter->tdlsinfo.chsw_info.chsw_sctx; ++ ++ rtw_sctx_done(&chsw_sctx); ++} ++ ++s32 rtw_tdls_do_ch_sw(_adapter *padapter, struct sta_info *ptdls_sta, u8 chnl_type, u8 channel, u8 channel_offset, u16 bwmode, u16 ch_switch_time) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 center_ch, chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ u32 ch_sw_time_start, ch_sw_time_spent, wait_time; ++ u8 take_care_iqk; ++ s32 ret = _FAIL; ++ ++ ch_sw_time_start = rtw_systime_to_ms(rtw_get_current_time()); ++ ++ rtw_tdls_chsw_oper_init(padapter, TDLS_CH_SWITCH_OPER_OFFLOAD_TIMEOUT); ++ ++ /* set mac_id sleep before channel switch */ ++ rtw_hal_macid_sleep(padapter, ptdls_sta->mac_id); ++ ++ /* channel switch IOs offload to FW */ ++ if (rtw_hal_ch_sw_oper_offload(padapter, channel, channel_offset, bwmode) == _SUCCESS) { ++ if (rtw_tdls_chsw_oper_wait(padapter) == _SUCCESS) { ++ /* set channel and bw related variables in driver */ ++ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); ++ ++ rtw_set_oper_ch(padapter, channel); ++ rtw_set_oper_choffset(padapter, channel_offset); ++ rtw_set_oper_bw(padapter, bwmode); ++ ++ center_ch = rtw_get_center_ch(channel, bwmode, channel_offset); ++ pHalData->CurrentChannel = center_ch; ++ pHalData->CurrentCenterFrequencyIndex1 = center_ch; ++ pHalData->CurrentChannelBW = bwmode; ++ pHalData->nCur40MhzPrimeSC = channel_offset; ++ ++ if (bwmode == CHANNEL_WIDTH_80) { ++ if (center_ch > channel) ++ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_LOWER; ++ else if (center_ch < channel) ++ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_UPPER; ++ else ++ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ } ++ pHalData->nCur80MhzPrimeSC = chnl_offset80; ++ ++ pHalData->CurrentCenterFrequencyIndex1 = center_ch; ++ ++ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, &take_care_iqk); ++ if (take_care_iqk == _TRUE) ++ rtw_hal_ch_sw_iqk_info_restore(padapter, CH_SW_USE_CASE_TDLS); ++ ++ ch_sw_time_spent = rtw_systime_to_ms(rtw_get_current_time()) - ch_sw_time_start; ++ ++ if (chnl_type == TDLS_CH_SW_OFF_CHNL) { ++ if ((u32)ch_switch_time / 1000 > ch_sw_time_spent) ++ wait_time = (u32)ch_switch_time / 1000 - ch_sw_time_spent; ++ else ++ wait_time = 0; ++ ++ if (wait_time > 0) ++ rtw_msleep_os(wait_time); ++ } ++ ++ ret = _SUCCESS; ++ } else ++ RTW_INFO("[TDLS] chsw oper wait fail !!\n"); ++ } ++ ++ /* set mac_id wakeup after channel switch */ ++ rtw_hal_macid_wakeup(padapter, ptdls_sta->mac_id); ++ ++ return ret; ++} ++#endif ++ ++u8 *rtw_tdls_set_wmm_params(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 wmm_param_ele[24] = {0}; ++ ++ if (&pmlmeinfo->WMM_param) { ++ _rtw_memcpy(wmm_param_ele, WMM_PARA_OUI, 6); ++ if (_rtw_memcmp(&pmlmeinfo->WMM_param, &wmm_param_ele[6], 18) == _TRUE) ++ /* Use default WMM Param */ ++ _rtw_memcpy(wmm_param_ele + 6, (u8 *)&TDLS_WMM_PARAM_IE, sizeof(TDLS_WMM_PARAM_IE)); ++ else ++ _rtw_memcpy(wmm_param_ele + 6, (u8 *)&pmlmeinfo->WMM_param, sizeof(pmlmeinfo->WMM_param)); ++ return rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 24, wmm_param_ele, &(pattrib->pktlen)); ++ } else ++ return pframe; ++} ++ ++#ifdef CONFIG_WFD ++void rtw_tdls_process_wfd_ie(struct tdls_info *ptdlsinfo, u8 *ptr, u8 length) ++{ ++ u8 *wfd_ie; ++ u32 wfd_ielen = 0; ++ ++ if (!hal_chk_wl_func(tdls_info_to_adapter(ptdlsinfo), WL_FUNC_MIRACAST)) ++ return; ++ ++ /* Try to get the TCP port information when receiving the negotiation response. */ ++ ++ wfd_ie = rtw_get_wfd_ie(ptr, length, NULL, &wfd_ielen); ++ while (wfd_ie) { ++ u8 *attr_content; ++ u32 attr_contentlen = 0; ++ int i; ++ ++ RTW_INFO("[%s] WFD IE Found!!\n", __FUNCTION__); ++ attr_content = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &attr_contentlen); ++ if (attr_content && attr_contentlen) { ++ ptdlsinfo->wfd_info->peer_rtsp_ctrlport = RTW_GET_BE16(attr_content + 2); ++ RTW_INFO("[%s] Peer PORT NUM = %d\n", __FUNCTION__, ptdlsinfo->wfd_info->peer_rtsp_ctrlport); ++ } ++ ++ attr_content = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_LOCAL_IP_ADDR, NULL, &attr_contentlen); ++ if (attr_content && attr_contentlen) { ++ _rtw_memcpy(ptdlsinfo->wfd_info->peer_ip_address, (attr_content + 1), 4); ++ RTW_INFO("[%s] Peer IP = %02u.%02u.%02u.%02u\n", __FUNCTION__, ++ ptdlsinfo->wfd_info->peer_ip_address[0], ptdlsinfo->wfd_info->peer_ip_address[1], ++ ptdlsinfo->wfd_info->peer_ip_address[2], ptdlsinfo->wfd_info->peer_ip_address[3]); ++ } ++ ++ wfd_ie = rtw_get_wfd_ie(wfd_ie + wfd_ielen, (ptr + length) - (wfd_ie + wfd_ielen), NULL, &wfd_ielen); ++ } ++} ++ ++int issue_tunneled_probe_req(_adapter *padapter) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ u8 baddr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ struct tdls_txmgmt txmgmt; ++ int ret = _FAIL; ++ ++ RTW_INFO("[%s]\n", __FUNCTION__); ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ txmgmt.action_code = TUNNELED_PROBE_REQ; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, baddr, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel = pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++exit: ++ ++ return ret; ++} ++ ++int issue_tunneled_probe_rsp(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct tdls_txmgmt txmgmt; ++ int ret = _FAIL; ++ ++ RTW_INFO("[%s]\n", __FUNCTION__); ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ txmgmt.action_code = TUNNELED_PROBE_RSP; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, precv_frame->u.hdr.attrib.src, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel = pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++exit: ++ ++ return ret; ++} ++#endif /* CONFIG_WFD */ ++ ++int issue_tdls_setup_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *ptdls_sta = NULL; ++ _irqL irqL; ++ int ret = _FAIL; ++ /* Retry timer should be set at least 301 sec, using TPK_count counting 301 times. */ ++ u32 timeout_interval = TDLS_TPK_RESEND_COUNT; ++ ++ RTW_INFO("[TDLS] %s\n", __FUNCTION__); ++ ++ ptxmgmt->action_code = TDLS_SETUP_REQUEST; ++ if (rtw_tdls_is_setup_allowed(padapter) == _FALSE) ++ goto exit; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ pattrib = &pmgntframe->attrib; ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ ++ /* init peer sta_info */ ++ ptdls_sta = rtw_get_stainfo(pstapriv, ptxmgmt->peer); ++ if (ptdls_sta == NULL) { ++ ptdls_sta = rtw_alloc_stainfo(pstapriv, ptxmgmt->peer); ++ if (ptdls_sta == NULL) { ++ RTW_INFO("[%s] rtw_alloc_stainfo fail\n", __FUNCTION__); ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ } ++ ++ if (!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) ++ ptdlsinfo->sta_cnt++; ++ ++ if (ptdlsinfo->sta_cnt == MAX_ALLOWED_TDLS_STA_NUM) ++ ptdlsinfo->sta_maximum = _TRUE; ++ ++ ptdls_sta->tdls_sta_state |= TDLS_RESPONDER_STATE; ++ ++ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { ++ ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval; ++ _set_timer(&ptdls_sta->handshake_timer, TDLS_HANDSHAKE_TIME); ++ } ++ ++ pattrib->qsel = pattrib->priority; ++ ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ ++ if (wait_ack) ++ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); ++ else { ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ } ++ ++exit: ++ ++ return ret; ++} ++ ++int _issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *ptdls_sta = NULL; ++ _irqL irqL; ++ int ret = _FAIL; ++ ++ RTW_INFO("[TDLS] %s\n", __FUNCTION__); ++ ++ ptxmgmt->action_code = TDLS_TEARDOWN; ++ ptdls_sta = rtw_get_stainfo(pstapriv, ptxmgmt->peer); ++ if (ptdls_sta == NULL) { ++ RTW_INFO("Np tdls_sta for tearing down\n"); ++ goto exit; ++ } ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ rtw_mi_set_scan_deny(padapter, 550); ++ rtw_mi_scan_abort(padapter, _TRUE); ++ ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel = pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ ++ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) ++ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) ++ if (pattrib->encrypt) ++ _cancel_timer_ex(&ptdls_sta->TPK_timer); ++ ++ if (wait_ack) ++ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); ++ else { ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ } ++ ++ if (rtw_tdls_is_driver_setup(padapter)) ++ rtw_tdls_cmd(padapter, ptxmgmt->peer, TDLS_TEARDOWN_STA_LOCALLY); ++ ++exit: ++ ++ return ret; ++} ++ ++int issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack) ++{ ++ int ret = _FAIL; ++ ++ ret = _issue_tdls_teardown(padapter, ptxmgmt, wait_ack); ++ if ((ptxmgmt->status_code == _RSON_TDLS_TEAR_UN_RSN_) && (ret == _FAIL)) { ++ /* Change status code and send teardown again via AP */ ++ ptxmgmt->status_code = _RSON_TDLS_TEAR_TOOFAR_; ++ ret = _issue_tdls_teardown(padapter, ptxmgmt, wait_ack); ++ } ++ ++ return ret; ++} ++ ++int issue_tdls_dis_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ int ret = _FAIL; ++ ++ RTW_INFO("[TDLS] %s\n", __FUNCTION__); ++ ++ ptxmgmt->action_code = TDLS_DISCOVERY_REQUEST; ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ pattrib = &pmgntframe->attrib; ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel = pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ dump_mgntframe(padapter, pmgntframe); ++ RTW_INFO("issue tdls dis req\n"); ++ ++ ret = _SUCCESS; ++exit: ++ ++ return ret; ++} ++ ++int issue_tdls_setup_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ int ret = _FAIL; ++ ++ RTW_INFO("[TDLS] %s\n", __FUNCTION__); ++ ++ ptxmgmt->action_code = TDLS_SETUP_RESPONSE; ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ pattrib = &pmgntframe->attrib; ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, get_bssid(&(padapter->mlmepriv)), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel = pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ ret = _SUCCESS; ++exit: ++ ++ return ret; ++ ++} ++ ++int issue_tdls_setup_cfm(_adapter *padapter, struct tdls_txmgmt *ptxmgmt) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ int ret = _FAIL; ++ ++ RTW_INFO("[TDLS] %s\n", __FUNCTION__); ++ ++ ptxmgmt->action_code = TDLS_SETUP_CONFIRM; ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ pattrib = &pmgntframe->attrib; ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, get_bssid(&padapter->mlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel = pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ ret = _SUCCESS; ++exit: ++ ++ return ret; ++ ++} ++ ++/* TDLS Discovery Response frame is a management action frame */ ++int issue_tdls_dis_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 privacy) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ int ret = _FAIL; ++ ++ RTW_INFO("[TDLS] %s\n", __FUNCTION__); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ /* unicast probe request frame */ ++ _rtw_memcpy(pwlanhdr->addr1, ptxmgmt->peer, ETH_ALEN); ++ _rtw_memcpy(pattrib->dst, pwlanhdr->addr1, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->src, pwlanhdr->addr2, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, pwlanhdr->addr3, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ rtw_build_tdls_dis_rsp_ies(padapter, pmgntframe, pframe, ptxmgmt, privacy); ++ ++ pattrib->nr_frags = 1; ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++ ++int issue_tdls_peer_traffic_rsp(_adapter *padapter, struct sta_info *ptdls_sta, struct tdls_txmgmt *ptxmgmt) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ int ret = _FAIL; ++ ++ RTW_INFO("[TDLS] %s\n", __FUNCTION__); ++ ++ ptxmgmt->action_code = TDLS_PEER_TRAFFIC_RESPONSE; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel = pattrib->priority; ++ ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ ++exit: ++ ++ return ret; ++} ++ ++int issue_tdls_peer_traffic_indication(_adapter *padapter, struct sta_info *ptdls_sta) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct tdls_txmgmt txmgmt; ++ int ret = _FAIL; ++ ++ RTW_INFO("[TDLS] %s\n", __FUNCTION__); ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ txmgmt.action_code = TDLS_PEER_TRAFFIC_INDICATION; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ /* PTI frame's priority should be AC_VO */ ++ pattrib->priority = 7; ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel = pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ ++exit: ++ ++ return ret; ++} ++ ++#ifdef CONFIG_TDLS_CH_SW ++int issue_tdls_ch_switch_req(_adapter *padapter, struct sta_info *ptdls_sta) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct tdls_txmgmt txmgmt; ++ int ret = _FAIL; ++ ++ RTW_INFO("[TDLS] %s\n", __FUNCTION__); ++ ++ if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) { ++ RTW_INFO("[TDLS] Ignore %s since channel switch is not allowed\n", __func__); ++ goto exit; ++ } ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ txmgmt.action_code = TDLS_CHANNEL_SWITCH_REQUEST; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel = pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++exit: ++ ++ return ret; ++} ++ ++int issue_tdls_ch_switch_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ int ret = _FAIL; ++ ++ RTW_INFO("[TDLS] %s\n", __FUNCTION__); ++ ++ if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) { ++ RTW_INFO("[TDLS] Ignore %s since channel switch is not allowed\n", __func__); ++ goto exit; ++ } ++ ++ ptxmgmt->action_code = TDLS_CHANNEL_SWITCH_RESPONSE; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto exit; ++ ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, ptxmgmt->peer, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel = pattrib->priority; ++ /* ++ _enter_critical_bh(&pxmitpriv->lock, &irqL); ++ if(xmitframe_enqueue_for_tdls_sleeping_sta(padapter, pmgntframe)==_TRUE){ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ return _FALSE; ++ } ++ */ ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ ++ if (wait_ack) ++ ret = dump_mgntframe_and_wait_ack_timeout(padapter, pmgntframe, 10); ++ else { ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ } ++exit: ++ ++ return ret; ++} ++#endif ++ ++int On_TDLS_Dis_Rsp(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct sta_info *ptdls_sta = NULL, *psta = rtw_get_stainfo(&(padapter->stapriv), get_bssid(&(padapter->mlmepriv))); ++ struct recv_priv *precvpriv = &(padapter->recvpriv); ++ u8 *ptr = precv_frame->u.hdr.rx_data, *psa; ++ struct rx_pkt_attrib *pattrib = &(precv_frame->u.hdr.attrib); ++ struct tdls_info *ptdlsinfo = &(padapter->tdlsinfo); ++ u8 empty_addr[ETH_ALEN] = { 0x00 }; ++ int UndecoratedSmoothedPWDB; ++ struct tdls_txmgmt txmgmt; ++ int ret = _SUCCESS; ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ /* WFDTDLS: for sigma test, not to setup direct link automatically */ ++ ptdlsinfo->dev_discovered = _TRUE; ++ ++ psa = get_sa(ptr); ++ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), psa); ++ if (ptdls_sta != NULL) ++ ptdls_sta->sta_stats.rx_tdls_disc_rsp_pkts++; ++ ++#ifdef CONFIG_TDLS_AUTOSETUP ++ if (ptdls_sta != NULL) { ++ /* Record the tdls sta with lowest signal strength */ ++ if (ptdlsinfo->sta_maximum == _TRUE && ptdls_sta->alive_count >= 1) { ++ if (_rtw_memcmp(ptdlsinfo->ss_record.macaddr, empty_addr, ETH_ALEN)) { ++ _rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN); ++ ptdlsinfo->ss_record.RxPWDBAll = pattrib->phy_info.RxPWDBAll; ++ } else { ++ if (ptdlsinfo->ss_record.RxPWDBAll < pattrib->phy_info.RxPWDBAll) { ++ _rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN); ++ ptdlsinfo->ss_record.RxPWDBAll = pattrib->phy_info.RxPWDBAll; ++ } ++ } ++ } ++ } else { ++ if (ptdlsinfo->sta_maximum == _TRUE) { ++ if (_rtw_memcmp(ptdlsinfo->ss_record.macaddr, empty_addr, ETH_ALEN)) { ++ /* All traffics are busy, do not set up another direct link. */ ++ ret = _FAIL; ++ goto exit; ++ } else { ++ if (pattrib->phy_info.RxPWDBAll > ptdlsinfo->ss_record.RxPWDBAll) { ++ _rtw_memcpy(txmgmt.peer, ptdlsinfo->ss_record.macaddr, ETH_ALEN); ++ /* issue_tdls_teardown(padapter, ptdlsinfo->ss_record.macaddr, _FALSE); */ ++ } else { ++ ret = _FAIL; ++ goto exit; ++ } ++ } ++ } ++ ++ rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); ++ ++ if (pattrib->phy_info.RxPWDBAll + TDLS_SIGNAL_THRESH >= UndecoratedSmoothedPWDB) { ++ RTW_INFO("pattrib->RxPWDBAll=%d, pdmpriv->UndecoratedSmoothedPWDB=%d\n", pattrib->phy_info.RxPWDBAll, UndecoratedSmoothedPWDB); ++ _rtw_memcpy(txmgmt.peer, psa, ETH_ALEN); ++ issue_tdls_setup_req(padapter, &txmgmt, _FALSE); ++ } ++ } ++#endif /* CONFIG_TDLS_AUTOSETUP */ ++ ++exit: ++ return ret; ++ ++} ++ ++sint On_TDLS_Setup_Req(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ u8 *psa, *pmyid; ++ struct sta_info *ptdls_sta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ _irqL irqL; ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ u8 *prsnie, *ppairwise_cipher; ++ u8 i, k; ++ u8 ccmp_included = 0, rsnie_included = 0; ++ u16 j, pairwise_count; ++ u8 SNonce[32]; ++ u32 timeout_interval = TDLS_TPK_RESEND_COUNT; ++ sint parsing_length; /* Frame body length, without icv_len */ ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 FIXED_IE = 5; ++ unsigned char supportRate[16]; ++ int supportRateNum = 0; ++ struct tdls_txmgmt txmgmt; ++ ++ if (rtw_tdls_is_setup_allowed(padapter) == _FALSE) ++ goto exit; ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ psa = get_sa(ptr); ++ ptdls_sta = rtw_get_stainfo(pstapriv, psa); ++ ++ pmyid = adapter_mac_addr(padapter); ++ ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; ++ parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len ++ - prx_pkt_attrib->hdrlen ++ - prx_pkt_attrib->iv_len ++ - prx_pkt_attrib->icv_len ++ - LLC_HEADER_SIZE ++ - ETH_TYPE_LEN ++ - PAYLOAD_TYPE_LEN ++ - FIXED_IE; ++ ++ if (ptdls_sta == NULL) ++ ptdls_sta = rtw_alloc_stainfo(pstapriv, psa); ++ else { ++ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { ++ /* If the direct link is already set up */ ++ /* Process as re-setup after tear down */ ++ RTW_INFO("re-setup a direct link\n"); ++ } ++ /* Already receiving TDLS setup request */ ++ else if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) { ++ RTW_INFO("receive duplicated TDLS setup request frame in handshaking\n"); ++ goto exit; ++ } ++ /* When receiving and sending setup_req to the same link at the same time */ ++ /* STA with higher MAC_addr would be initiator */ ++ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) { ++ RTW_INFO("receive setup_req after sending setup_req\n"); ++ for (i = 0; i < 6; i++) { ++ if (*(pmyid + i) == *(psa + i)) { ++ } else if (*(pmyid + i) > *(psa + i)) { ++ ptdls_sta->tdls_sta_state = TDLS_INITIATOR_STATE; ++ break; ++ } else if (*(pmyid + i) < *(psa + i)) ++ goto exit; ++ } ++ } ++ } ++ ++ if (ptdls_sta) { ++ txmgmt.dialog_token = *(ptr + 2); /* Copy dialog token */ ++ txmgmt.status_code = _STATS_SUCCESSFUL_; ++ ++ /* Parsing information element */ ++ for (j = FIXED_IE; j < parsing_length;) { ++ ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j); ++ ++ switch (pIE->ElementID) { ++ case _SUPPORTEDRATES_IE_: ++ _rtw_memcpy(supportRate, pIE->data, pIE->Length); ++ supportRateNum = pIE->Length; ++ break; ++ case _COUNTRY_IE_: ++ break; ++ case _EXT_SUPPORTEDRATES_IE_: ++ if (supportRateNum <= sizeof(supportRate)) { ++ _rtw_memcpy(supportRate + supportRateNum, pIE->data, pIE->Length); ++ supportRateNum += pIE->Length; ++ } ++ break; ++ case _SUPPORTED_CH_IE_: ++ break; ++ case _RSN_IE_2_: ++ rsnie_included = 1; ++ if (prx_pkt_attrib->encrypt) { ++ prsnie = (u8 *)pIE; ++ /* Check CCMP pairwise_cipher presence. */ ++ ppairwise_cipher = prsnie + 10; ++ _rtw_memcpy(ptdls_sta->TDLS_RSNIE, pIE->data, pIE->Length); ++ pairwise_count = *(u16 *)(ppairwise_cipher - 2); ++ for (k = 0; k < pairwise_count; k++) { ++ if (_rtw_memcmp(ppairwise_cipher + 4 * k, RSN_CIPHER_SUITE_CCMP, 4) == _TRUE) ++ ccmp_included = 1; ++ } ++ ++ if (ccmp_included == 0) ++ txmgmt.status_code = _STATS_INVALID_RSNIE_; ++ } ++ break; ++ case _EXT_CAP_IE_: ++ break; ++ case _VENDOR_SPECIFIC_IE_: ++ break; ++ case _FTIE_: ++ if (prx_pkt_attrib->encrypt) ++ _rtw_memcpy(SNonce, (ptr + j + 52), 32); ++ break; ++ case _TIMEOUT_ITVL_IE_: ++ if (prx_pkt_attrib->encrypt) ++ timeout_interval = cpu_to_le32(*(u32 *)(ptr + j + 3)); ++ break; ++ case _RIC_Descriptor_IE_: ++ break; ++#ifdef CONFIG_80211N_HT ++ case _HT_CAPABILITY_IE_: ++ rtw_tdls_process_ht_cap(padapter, ptdls_sta, pIE->data, pIE->Length); ++ break; ++#endif ++#ifdef CONFIG_80211AC_VHT ++ case EID_AID: ++ break; ++ case EID_VHTCapability: ++ rtw_tdls_process_vht_cap(padapter, ptdls_sta, pIE->data, pIE->Length); ++ break; ++#endif ++ case EID_BSSCoexistence: ++ break; ++ case _LINK_ID_IE_: ++ if (_rtw_memcmp(get_bssid(pmlmepriv), pIE->data, 6) == _FALSE) ++ txmgmt.status_code = _STATS_NOT_IN_SAME_BSS_; ++ break; ++ default: ++ break; ++ } ++ ++ j += (pIE->Length + 2); ++ ++ } ++ ++ /* Check status code */ ++ /* If responder STA has/hasn't security on AP, but request hasn't/has RSNIE, it should reject */ ++ if (txmgmt.status_code == _STATS_SUCCESSFUL_) { ++ if (rsnie_included && prx_pkt_attrib->encrypt == 0) ++ txmgmt.status_code = _STATS_SEC_DISABLED_; ++ else if (rsnie_included == 0 && prx_pkt_attrib->encrypt) ++ txmgmt.status_code = _STATS_INVALID_PARAMETERS_; ++ ++#ifdef CONFIG_WFD ++ /* WFD test plan version 0.18.2 test item 5.1.5 */ ++ /* SoUT does not use TDLS if AP uses weak security */ ++ if (padapter->wdinfo.wfd_tdls_enable && (rsnie_included && prx_pkt_attrib->encrypt != _AES_)) ++ txmgmt.status_code = _STATS_SEC_DISABLED_; ++#endif /* CONFIG_WFD */ ++ } ++ ++ ptdls_sta->tdls_sta_state |= TDLS_INITIATOR_STATE; ++ if (prx_pkt_attrib->encrypt) { ++ _rtw_memcpy(ptdls_sta->SNonce, SNonce, 32); ++ ++ if (timeout_interval <= 300) ++ ptdls_sta->TDLS_PeerKey_Lifetime = TDLS_TPK_RESEND_COUNT; ++ else ++ ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval; ++ } ++ ++ /* Update station supportRate */ ++ ptdls_sta->bssratelen = supportRateNum; ++ _rtw_memcpy(ptdls_sta->bssrateset, supportRate, supportRateNum); ++ ++ if (!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) ++ ptdlsinfo->sta_cnt++; ++ /* -2: AP + BC/MC sta, -4: default key */ ++ if (ptdlsinfo->sta_cnt == MAX_ALLOWED_TDLS_STA_NUM) ++ ptdlsinfo->sta_maximum = _TRUE; ++ ++#ifdef CONFIG_WFD ++ rtw_tdls_process_wfd_ie(ptdlsinfo, ptr + FIXED_IE, parsing_length); ++#endif ++ ++ } else ++ goto exit; ++ ++ _rtw_memcpy(txmgmt.peer, prx_pkt_attrib->src, ETH_ALEN); ++ ++ if (rtw_tdls_is_driver_setup(padapter)) { ++ issue_tdls_setup_rsp(padapter, &txmgmt); ++ ++ if (txmgmt.status_code == _STATS_SUCCESSFUL_) ++ _set_timer(&ptdls_sta->handshake_timer, TDLS_HANDSHAKE_TIME); ++ else ++ free_tdls_sta(padapter, ptdls_sta); ++ } ++ ++exit: ++ ++ return _SUCCESS; ++} ++ ++int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct sta_info *ptdls_sta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ _irqL irqL; ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ u8 *psa; ++ u16 status_code = 0; ++ sint parsing_length; /* Frame body length, without icv_len */ ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 FIXED_IE = 7; ++ u8 ANonce[32]; ++ u8 *pftie = NULL, *ptimeout_ie = NULL, *plinkid_ie = NULL, *prsnie = NULL, *pftie_mic = NULL, *ppairwise_cipher = NULL; ++ u16 pairwise_count, j, k; ++ u8 verify_ccmp = 0; ++ unsigned char supportRate[16]; ++ int supportRateNum = 0; ++ struct tdls_txmgmt txmgmt; ++ int ret = _SUCCESS; ++ u32 timeout_interval = TDLS_TPK_RESEND_COUNT; ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ psa = get_sa(ptr); ++ ptdls_sta = rtw_get_stainfo(pstapriv, psa); ++ ++ if (ptdls_sta == NULL) { ++ RTW_INFO("[%s] Direct Link Peer = "MAC_FMT" not found\n", __func__, MAC_ARG(psa)); ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; ++ parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len ++ - prx_pkt_attrib->hdrlen ++ - prx_pkt_attrib->iv_len ++ - prx_pkt_attrib->icv_len ++ - LLC_HEADER_SIZE ++ - ETH_TYPE_LEN ++ - PAYLOAD_TYPE_LEN ++ - FIXED_IE; ++ ++ _rtw_memcpy(&status_code, ptr + 2, 2); ++ ++ if (status_code != 0) { ++ RTW_INFO("[TDLS] %s status_code = %d, free_tdls_sta\n", __FUNCTION__, status_code); ++ free_tdls_sta(padapter, ptdls_sta); ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ status_code = 0; ++ ++ /* parsing information element */ ++ for (j = FIXED_IE; j < parsing_length;) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j); ++ ++ switch (pIE->ElementID) { ++ case _SUPPORTEDRATES_IE_: ++ _rtw_memcpy(supportRate, pIE->data, pIE->Length); ++ supportRateNum = pIE->Length; ++ break; ++ case _COUNTRY_IE_: ++ break; ++ case _EXT_SUPPORTEDRATES_IE_: ++ if (supportRateNum <= sizeof(supportRate)) { ++ _rtw_memcpy(supportRate + supportRateNum, pIE->data, pIE->Length); ++ supportRateNum += pIE->Length; ++ } ++ break; ++ case _SUPPORTED_CH_IE_: ++ break; ++ case _RSN_IE_2_: ++ prsnie = (u8 *)pIE; ++ /* Check CCMP pairwise_cipher presence. */ ++ ppairwise_cipher = prsnie + 10; ++ _rtw_memcpy(&pairwise_count, (u16 *)(ppairwise_cipher - 2), 2); ++ for (k = 0; k < pairwise_count; k++) { ++ if (_rtw_memcmp(ppairwise_cipher + 4 * k, RSN_CIPHER_SUITE_CCMP, 4) == _TRUE) ++ verify_ccmp = 1; ++ } ++ case _EXT_CAP_IE_: ++ break; ++ case _VENDOR_SPECIFIC_IE_: ++ if (_rtw_memcmp((u8 *)pIE + 2, WMM_INFO_OUI, 6) == _TRUE) { ++ /* WMM Info ID and OUI */ ++ if ((pregistrypriv->wmm_enable == _TRUE) || (padapter->mlmepriv.htpriv.ht_option == _TRUE)) ++ ptdls_sta->qos_option = _TRUE; ++ } ++ break; ++ case _FTIE_: ++ pftie = (u8 *)pIE; ++ _rtw_memcpy(ANonce, (ptr + j + 20), 32); ++ break; ++ case _TIMEOUT_ITVL_IE_: ++ ptimeout_ie = (u8 *)pIE; ++ timeout_interval = cpu_to_le32(*(u32 *)(ptimeout_ie + 3)); ++ break; ++ case _RIC_Descriptor_IE_: ++ break; ++#ifdef CONFIG_80211N_HT ++ case _HT_CAPABILITY_IE_: ++ rtw_tdls_process_ht_cap(padapter, ptdls_sta, pIE->data, pIE->Length); ++ break; ++#endif ++#ifdef CONFIG_80211AC_VHT ++ case EID_AID: ++ /* todo in the future if necessary */ ++ break; ++ case EID_VHTCapability: ++ rtw_tdls_process_vht_cap(padapter, ptdls_sta, pIE->data, pIE->Length); ++ break; ++ case EID_OpModeNotification: ++ rtw_process_vht_op_mode_notify(padapter, pIE->data, ptdls_sta); ++ break; ++#endif ++ case EID_BSSCoexistence: ++ break; ++ case _LINK_ID_IE_: ++ plinkid_ie = (u8 *)pIE; ++ break; ++ default: ++ break; ++ } ++ ++ j += (pIE->Length + 2); ++ ++ } ++ ++ ptdls_sta->bssratelen = supportRateNum; ++ _rtw_memcpy(ptdls_sta->bssrateset, supportRate, supportRateNum); ++ _rtw_memcpy(ptdls_sta->ANonce, ANonce, 32); ++ ++#ifdef CONFIG_WFD ++ rtw_tdls_process_wfd_ie(ptdlsinfo, ptr + FIXED_IE, parsing_length); ++#endif ++ ++ if (status_code != _STATS_SUCCESSFUL_) ++ txmgmt.status_code = status_code; ++ else { ++ if (prx_pkt_attrib->encrypt) { ++ if (verify_ccmp == 1) { ++ txmgmt.status_code = _STATS_SUCCESSFUL_; ++ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { ++ wpa_tdls_generate_tpk(padapter, ptdls_sta); ++ if (tdls_verify_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie) == _FAIL) { ++ RTW_INFO("[TDLS] %s tdls_verify_mic fail, free_tdls_sta\n", __FUNCTION__); ++ free_tdls_sta(padapter, ptdls_sta); ++ ret = _FAIL; ++ goto exit; ++ } ++ ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval; ++ } ++ } else ++ txmgmt.status_code = _STATS_INVALID_RSNIE_; ++ ++ } else ++ txmgmt.status_code = _STATS_SUCCESSFUL_; ++ } ++ ++ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { ++ _rtw_memcpy(txmgmt.peer, prx_pkt_attrib->src, ETH_ALEN); ++ issue_tdls_setup_cfm(padapter, &txmgmt); ++ ++ if (txmgmt.status_code == _STATS_SUCCESSFUL_) { ++ ptdlsinfo->link_established = _TRUE; ++ ++ if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) { ++ ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; ++ ptdls_sta->state |= _FW_LINKED; ++ _cancel_timer_ex(&ptdls_sta->handshake_timer); ++ } ++ ++ if (prx_pkt_attrib->encrypt) ++ rtw_tdls_set_key(padapter, ptdls_sta); ++ ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ESTABLISHED); ++ ++ } ++ } ++ ++exit: ++ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) ++ return ret; ++ else ++ return _SUCCESS; ++ ++} ++ ++int On_TDLS_Setup_Cfm(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct sta_info *ptdls_sta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ _irqL irqL; ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ u8 *psa; ++ u16 status_code = 0; ++ sint parsing_length; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 FIXED_IE = 5; ++ u8 *pftie = NULL, *ptimeout_ie = NULL, *plinkid_ie = NULL, *prsnie = NULL, *pftie_mic = NULL, *ppairwise_cipher = NULL; ++ u16 j, pairwise_count; ++ int ret = _SUCCESS; ++ ++ psa = get_sa(ptr); ++ ptdls_sta = rtw_get_stainfo(pstapriv, psa); ++ ++ if (ptdls_sta == NULL) { ++ RTW_INFO("[%s] Direct Link Peer = "MAC_FMT" not found\n", __FUNCTION__, MAC_ARG(psa)); ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; ++ parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len ++ - prx_pkt_attrib->hdrlen ++ - prx_pkt_attrib->iv_len ++ - prx_pkt_attrib->icv_len ++ - LLC_HEADER_SIZE ++ - ETH_TYPE_LEN ++ - PAYLOAD_TYPE_LEN ++ - FIXED_IE; ++ ++ _rtw_memcpy(&status_code, ptr + 2, 2); ++ ++ if (status_code != 0) { ++ RTW_INFO("[%s] status_code = %d\n, free_tdls_sta", __FUNCTION__, status_code); ++ free_tdls_sta(padapter, ptdls_sta); ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* Parsing information element */ ++ for (j = FIXED_IE; j < parsing_length;) { ++ ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j); ++ ++ switch (pIE->ElementID) { ++ case _RSN_IE_2_: ++ prsnie = (u8 *)pIE; ++ break; ++ case _VENDOR_SPECIFIC_IE_: ++ if (_rtw_memcmp((u8 *)pIE + 2, WMM_PARA_OUI, 6) == _TRUE) { ++ /* WMM Parameter ID and OUI */ ++ ptdls_sta->qos_option = _TRUE; ++ } ++ break; ++ case _FTIE_: ++ pftie = (u8 *)pIE; ++ break; ++ case _TIMEOUT_ITVL_IE_: ++ ptimeout_ie = (u8 *)pIE; ++ break; ++#ifdef CONFIG_80211N_HT ++ case _HT_EXTRA_INFO_IE_: ++ break; ++#endif ++#ifdef CONFIG_80211AC_VHT ++ case EID_VHTOperation: ++ break; ++ case EID_OpModeNotification: ++ rtw_process_vht_op_mode_notify(padapter, pIE->data, ptdls_sta); ++ break; ++#endif ++ case _LINK_ID_IE_: ++ plinkid_ie = (u8 *)pIE; ++ break; ++ default: ++ break; ++ } ++ ++ j += (pIE->Length + 2); ++ ++ } ++ ++ if (prx_pkt_attrib->encrypt) { ++ /* Verify mic in FTIE MIC field */ ++ if (rtw_tdls_is_driver_setup(padapter) && ++ (tdls_verify_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie) == _FAIL)) { ++ free_tdls_sta(padapter, ptdls_sta); ++ ret = _FAIL; ++ goto exit; ++ } ++ } ++ ++ if (rtw_tdls_is_driver_setup(padapter)) { ++ ptdlsinfo->link_established = _TRUE; ++ ++ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) { ++ ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; ++ ptdls_sta->state |= _FW_LINKED; ++ _cancel_timer_ex(&ptdls_sta->handshake_timer); ++ } ++ ++ if (prx_pkt_attrib->encrypt) { ++ rtw_tdls_set_key(padapter, ptdls_sta); ++ ++ /* Start TPK timer */ ++ ptdls_sta->TPK_count = 0; ++ _set_timer(&ptdls_sta->TPK_timer, ONE_SEC); ++ } ++ ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ESTABLISHED); ++ } ++ ++exit: ++ return ret; ++ ++} ++ ++int On_TDLS_Dis_Req(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta_ap; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ sint parsing_length; /* Frame body length, without icv_len */ ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 FIXED_IE = 3, *dst; ++ u16 j; ++ struct tdls_txmgmt txmgmt; ++ int ret = _SUCCESS; ++ ++ if (rtw_tdls_is_driver_setup(padapter) == _FALSE) ++ goto exit; ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; ++ txmgmt.dialog_token = *(ptr + 2); ++ _rtw_memcpy(&txmgmt.peer, precv_frame->u.hdr.attrib.src, ETH_ALEN); ++ txmgmt.action_code = TDLS_DISCOVERY_RESPONSE; ++ parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len ++ - prx_pkt_attrib->hdrlen ++ - prx_pkt_attrib->iv_len ++ - prx_pkt_attrib->icv_len ++ - LLC_HEADER_SIZE ++ - ETH_TYPE_LEN ++ - PAYLOAD_TYPE_LEN ++ - FIXED_IE; ++ ++ /* Parsing information element */ ++ for (j = FIXED_IE; j < parsing_length;) { ++ ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j); ++ ++ switch (pIE->ElementID) { ++ case _LINK_ID_IE_: ++ psta_ap = rtw_get_stainfo(pstapriv, pIE->data); ++ if (psta_ap == NULL) ++ goto exit; ++ dst = pIE->data + 12; ++ if (MacAddr_isBcst(dst) == _FALSE && (_rtw_memcmp(adapter_mac_addr(padapter), dst, 6) == _FALSE)) ++ goto exit; ++ break; ++ default: ++ break; ++ } ++ ++ j += (pIE->Length + 2); ++ ++ } ++ ++ issue_tdls_dis_rsp(padapter, &txmgmt, prx_pkt_attrib->privacy); ++ ++exit: ++ return ret; ++ ++} ++ ++int On_TDLS_Teardown(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ u8 *psa; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *ptdls_sta = NULL; ++ _irqL irqL; ++ u8 reason; ++ ++ reason = *(ptr + prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN + 2); ++ RTW_INFO("[TDLS] %s Reason code(%d)\n", __FUNCTION__, reason); ++ ++ psa = get_sa(ptr); ++ ++ ptdls_sta = rtw_get_stainfo(pstapriv, psa); ++ if (ptdls_sta != NULL) { ++ if (rtw_tdls_is_driver_setup(padapter)) ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_TEARDOWN_STA_LOCALLY); ++ } ++ ++ return _SUCCESS; ++ ++} ++ ++#if 0 ++u8 TDLS_check_ch_state(uint state) ++{ ++ if (state & TDLS_CH_SWITCH_ON_STATE && ++ state & TDLS_PEER_AT_OFF_STATE) { ++ if (state & TDLS_PEER_SLEEP_STATE) ++ return 2; /* U-APSD + ch. switch */ ++ else ++ return 1; /* ch. switch */ ++ } else ++ return 0; ++} ++#endif ++ ++int On_TDLS_Peer_Traffic_Indication(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->src); ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct tdls_txmgmt txmgmt; ++ ++ ptr += pattrib->hdrlen + pattrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ ++ if (ptdls_sta != NULL) { ++ txmgmt.dialog_token = *(ptr + 2); ++ issue_tdls_peer_traffic_rsp(padapter, ptdls_sta, &txmgmt); ++ /* issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 0, 0, 0); */ ++ } else { ++ RTW_INFO("from unknown sta:"MAC_FMT"\n", MAC_ARG(pattrib->src)); ++ return _FAIL; ++ } ++ ++ return _SUCCESS; ++} ++ ++/* We process buffered data for 1. U-APSD, 2. ch. switch, 3. U-APSD + ch. switch here */ ++int On_TDLS_Peer_Traffic_Rsp(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->src); ++ u8 wmmps_ac = 0; ++ /* u8 state=TDLS_check_ch_state(ptdls_sta->tdls_sta_state); */ ++ int i; ++ ++ ptdls_sta->sta_stats.rx_data_pkts++; ++ ++ ptdls_sta->tdls_sta_state &= ~(TDLS_WAIT_PTR_STATE); ++ ++ /* Check 4-AC queue bit */ ++ if (ptdls_sta->uapsd_vo || ptdls_sta->uapsd_vi || ptdls_sta->uapsd_be || ptdls_sta->uapsd_bk) ++ wmmps_ac = 1; ++ ++ /* If it's a direct link and have buffered frame */ ++ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { ++ if (wmmps_ac) { ++ _irqL irqL; ++ _list *xmitframe_plist, *xmitframe_phead; ++ struct xmit_frame *pxmitframe = NULL; ++ ++ _enter_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); ++ ++ xmitframe_phead = get_list_head(&ptdls_sta->sleep_q); ++ xmitframe_plist = get_next(xmitframe_phead); ++ ++ /* transmit buffered frames */ ++ while (rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist) == _FALSE) { ++ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); ++ xmitframe_plist = get_next(xmitframe_plist); ++ rtw_list_delete(&pxmitframe->list); ++ ++ ptdls_sta->sleepq_len--; ++ ptdls_sta->sleepq_ac_len--; ++ if (ptdls_sta->sleepq_len > 0) { ++ pxmitframe->attrib.mdata = 1; ++ pxmitframe->attrib.eosp = 0; ++ } else { ++ pxmitframe->attrib.mdata = 0; ++ pxmitframe->attrib.eosp = 1; ++ } ++ pxmitframe->attrib.triggered = 1; ++ ++ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); ++ } ++ ++ if (ptdls_sta->sleepq_len == 0) ++ RTW_INFO("no buffered packets for tdls to xmit\n"); ++ else { ++ RTW_INFO("error!psta->sleepq_len=%d\n", ptdls_sta->sleepq_len); ++ ptdls_sta->sleepq_len = 0; ++ } ++ ++ _exit_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); ++ ++ } ++ ++ } ++ ++ return _SUCCESS; ++} ++ ++#ifdef CONFIG_TDLS_CH_SW ++sint On_TDLS_Ch_Switch_Req(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; ++ struct sta_info *ptdls_sta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ u8 *psa; ++ sint parsing_length; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 FIXED_IE = 4; ++ u16 j; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct tdls_txmgmt txmgmt; ++ u8 zaddr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; ++ u16 switch_time = TDLS_CH_SWITCH_TIME * 1000, switch_timeout = TDLS_CH_SWITCH_TIMEOUT * 1000; ++ u8 take_care_iqk; ++ ++ if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) { ++ RTW_INFO("[TDLS] Ignore %s since channel switch is not allowed\n", __func__); ++ return _FAIL; ++ } ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ psa = get_sa(ptr); ++ ptdls_sta = rtw_get_stainfo(pstapriv, psa); ++ ++ if (ptdls_sta == NULL) { ++ RTW_INFO("[%s] Direct Link Peer = "MAC_FMT" not found\n", __func__, MAC_ARG(psa)); ++ return _FAIL; ++ } ++ ++ ptdls_sta->ch_switch_time = switch_time; ++ ptdls_sta->ch_switch_timeout = switch_timeout; ++ ++ ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; ++ parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len ++ - prx_pkt_attrib->hdrlen ++ - prx_pkt_attrib->iv_len ++ - prx_pkt_attrib->icv_len ++ - LLC_HEADER_SIZE ++ - ETH_TYPE_LEN ++ - PAYLOAD_TYPE_LEN ++ - FIXED_IE; ++ ++ pchsw_info->off_ch_num = *(ptr + 2); ++ ++ if ((*(ptr + 2) == 2) && (hal_is_band_support(padapter, BAND_ON_5G))) ++ pchsw_info->off_ch_num = 44; ++ ++ if (pchsw_info->off_ch_num != pmlmeext->cur_channel) ++ pchsw_info->delay_switch_back = _FALSE; ++ ++ /* Parsing information element */ ++ for (j = FIXED_IE; j < parsing_length;) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j); ++ ++ switch (pIE->ElementID) { ++ case EID_SecondaryChnlOffset: ++ switch (*(pIE->data)) { ++ case EXTCHNL_OFFSET_UPPER: ++ pchsw_info->ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ break; ++ ++ case EXTCHNL_OFFSET_LOWER: ++ pchsw_info->ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ ++ default: ++ pchsw_info->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ } ++ break; ++ case _LINK_ID_IE_: ++ break; ++ case _CH_SWITCH_TIMING_: ++ ptdls_sta->ch_switch_time = (RTW_GET_LE16(pIE->data) >= TDLS_CH_SWITCH_TIME * 1000) ? ++ RTW_GET_LE16(pIE->data) : TDLS_CH_SWITCH_TIME * 1000; ++ ptdls_sta->ch_switch_timeout = (RTW_GET_LE16(pIE->data + 2) >= TDLS_CH_SWITCH_TIMEOUT * 1000) ? ++ RTW_GET_LE16(pIE->data + 2) : TDLS_CH_SWITCH_TIMEOUT * 1000; ++ RTW_INFO("[TDLS] %s ch_switch_time:%d, ch_switch_timeout:%d\n" ++ , __FUNCTION__, RTW_GET_LE16(pIE->data), RTW_GET_LE16(pIE->data + 2)); ++ default: ++ break; ++ } ++ ++ j += (pIE->Length + 2); ++ } ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, &take_care_iqk); ++ if (take_care_iqk == _TRUE) { ++ u8 central_chnl; ++ u8 bw_mode; ++ ++ bw_mode = (pchsw_info->ch_offset) ? CHANNEL_WIDTH_40 : CHANNEL_WIDTH_20; ++ central_chnl = rtw_get_center_ch(pchsw_info->off_ch_num, bw_mode, pchsw_info->ch_offset); ++ if (rtw_hal_ch_sw_iqk_info_search(padapter, central_chnl, bw_mode) < 0) { ++ if (!(pchsw_info->ch_sw_state & TDLS_CH_SWITCH_PREPARE_STATE)) ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_PREPARE); ++ ++ return _FAIL; ++ } ++ } ++ ++ /* cancel ch sw monitor timer for responder */ ++ if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) ++ _cancel_timer_ex(&ptdls_sta->ch_sw_monitor_timer); ++ ++ /* Todo: check status */ ++ txmgmt.status_code = 0; ++ _rtw_memcpy(txmgmt.peer, psa, ETH_ALEN); ++ ++ if (_rtw_memcmp(pchsw_info->addr, zaddr, ETH_ALEN) == _TRUE) ++ _rtw_memcpy(pchsw_info->addr, ptdls_sta->hwaddr, ETH_ALEN); ++ ++ if (ATOMIC_READ(&pchsw_info->chsw_on) == _FALSE) ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_START); ++ ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_RESP); ++ ++ return _SUCCESS; ++} ++ ++sint On_TDLS_Ch_Switch_Rsp(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; ++ struct sta_info *ptdls_sta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ u8 *psa; ++ sint parsing_length; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 FIXED_IE = 4; ++ u16 status_code, j, switch_time, switch_timeout; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ int ret = _SUCCESS; ++ ++ if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) { ++ RTW_INFO("[TDLS] Ignore %s since channel switch is not allowed\n", __func__); ++ return _SUCCESS; ++ } ++ ++ psa = get_sa(ptr); ++ ptdls_sta = rtw_get_stainfo(pstapriv, psa); ++ ++ if (ptdls_sta == NULL) { ++ RTW_INFO("[%s] Direct Link Peer = "MAC_FMT" not found\n", __func__, MAC_ARG(psa)); ++ return _FAIL; ++ } ++ ++ /* If we receive Unsolicited TDLS Channel Switch Response when channel switch is running, */ ++ /* we will go back to base channel and terminate this channel switch procedure */ ++ if (ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) { ++ if (pmlmeext->cur_channel != rtw_get_oper_ch(padapter)) { ++ RTW_INFO("[TDLS] Rx unsolicited channel switch response\n"); ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_BASE_CHNL); ++ goto exit; ++ } ++ } ++ ++ ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; ++ parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len ++ - prx_pkt_attrib->hdrlen ++ - prx_pkt_attrib->iv_len ++ - prx_pkt_attrib->icv_len ++ - LLC_HEADER_SIZE ++ - ETH_TYPE_LEN ++ - PAYLOAD_TYPE_LEN ++ - FIXED_IE; ++ ++ _rtw_memcpy(&status_code, ptr + 2, 2); ++ ++ if (status_code != 0) { ++ RTW_INFO("[TDLS] %s status_code:%d\n", __func__, status_code); ++ pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE); ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END); ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* Parsing information element */ ++ for (j = FIXED_IE; j < parsing_length;) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j); ++ ++ switch (pIE->ElementID) { ++ case _LINK_ID_IE_: ++ break; ++ case _CH_SWITCH_TIMING_: ++ _rtw_memcpy(&switch_time, pIE->data, 2); ++ if (switch_time > ptdls_sta->ch_switch_time) ++ _rtw_memcpy(&ptdls_sta->ch_switch_time, &switch_time, 2); ++ ++ _rtw_memcpy(&switch_timeout, pIE->data + 2, 2); ++ if (switch_timeout > ptdls_sta->ch_switch_timeout) ++ _rtw_memcpy(&ptdls_sta->ch_switch_timeout, &switch_timeout, 2); ++ break; ++ default: ++ break; ++ } ++ ++ j += (pIE->Length + 2); ++ } ++ ++ if ((pmlmeext->cur_channel == rtw_get_oper_ch(padapter)) && ++ (pchsw_info->ch_sw_state & TDLS_WAIT_CH_RSP_STATE)) { ++ if (ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_OFF_CHNL); ++ } ++ ++exit: ++ return ret; ++} ++#endif /* CONFIG_TDLS_CH_SW */ ++ ++#ifdef CONFIG_WFD ++void wfd_ie_tdls(_adapter *padapter, u8 *pframe, u32 *pktlen) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info *pwfd_info = padapter->tdlsinfo.wfd_info; ++ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; ++ u32 wfdielen = 0; ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) ++ return; ++ ++ /* WFD OUI */ ++ wfdielen = 0; ++ wfdie[wfdielen++] = 0x50; ++ wfdie[wfdielen++] = 0x6F; ++ wfdie[wfdielen++] = 0x9A; ++ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ ++ ++ /* ++ * Commented by Albert 20110825 ++ * According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes ++ * 1. WFD Device Information ++ * 2. Associated BSSID ( Optional ) ++ * 3. Local IP Adress ( Optional ) ++ */ ++ ++ /* WFD Device Information ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value1: */ ++ /* WFD device information */ ++ /* available for WFD session + Preferred TDLS + WSD ( WFD Service Discovery ) */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL ++ | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_WSD); ++ wfdielen += 2; ++ ++ /* Value2: */ ++ /* Session Management Control Port */ ++ /* Default TCP port for RTSP messages is 554 */ ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->tdls_rtsp_ctrlport); ++ wfdielen += 2; ++ ++ /* Value3: */ ++ /* WFD Device Maximum Throughput */ ++ /* 300Mbps is the maximum throughput */ ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ /* Associated BSSID ATTR */ ++ /* Type: */ ++ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ /* Value: */ ++ /* Associated BSSID */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); ++ else ++ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); ++ ++ /* Local IP Address ATTR */ ++ wfdie[wfdielen++] = WFD_ATTR_LOCAL_IP_ADDR; ++ ++ /* Length: */ ++ /* Note: In the WFD specification, the size of length field is 2. */ ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0005); ++ wfdielen += 2; ++ ++ /* Version: */ ++ /* 0x01: Version1;IPv4 */ ++ wfdie[wfdielen++] = 0x01; ++ ++ /* IPv4 Address */ ++ _rtw_memcpy(wfdie + wfdielen, pwfd_info->ip_address, 4); ++ wfdielen += 4; ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, pktlen); ++ ++} ++#endif /* CONFIG_WFD */ ++ ++void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) ++{ ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct sta_info *ptdls_sta = rtw_get_stainfo((&padapter->stapriv) , pattrib->dst); ++ ++ int i = 0 ; ++ u32 time; ++ u8 *pframe_head; ++ ++ /* SNonce */ ++ if (pattrib->encrypt) { ++ for (i = 0; i < 8; i++) { ++ time = rtw_get_current_time(); ++ _rtw_memcpy(&ptdls_sta->SNonce[4 * i], (u8 *)&time, 4); ++ } ++ } ++ ++ pframe_head = pframe; /* For rtw_tdls_set_ht_cap() */ ++ ++ pframe = rtw_tdls_set_payload_type(pframe, pattrib); ++ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); ++ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); ++ ++ pframe = rtw_tdls_set_capability(padapter, pframe, pattrib); ++ pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib); ++ pframe = rtw_tdls_set_sup_ch(&(padapter->mlmeextpriv), pframe, pattrib); ++ pframe = rtw_tdls_set_sup_reg_class(pframe, pattrib); ++ ++ if (pattrib->encrypt) ++ pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta); ++ ++ pframe = rtw_tdls_set_ext_cap(pframe, pattrib); ++ ++ if (pattrib->encrypt) { ++ pframe = rtw_tdls_set_ftie(ptxmgmt ++ , pframe ++ , pattrib ++ , NULL ++ , ptdls_sta->SNonce); ++ ++ pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta); ++ } ++ ++#ifdef CONFIG_80211N_HT ++ /* Sup_reg_classes(optional) */ ++ if (pregistrypriv->ht_enable == _TRUE) ++ pframe = rtw_tdls_set_ht_cap(padapter, pframe_head, pattrib); ++#endif ++ ++ pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib); ++ ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); ++ ++ if ((pregistrypriv->wmm_enable == _TRUE) || (padapter->mlmepriv.htpriv.ht_option == _TRUE)) ++ pframe = rtw_tdls_set_qos_cap(pframe, pattrib); ++ ++#ifdef CONFIG_80211AC_VHT ++ if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) && (pmlmeext->cur_channel > 14) ++ && REGSTY_IS_11AC_ENABLE(pregistrypriv) ++ && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) ++ && (!padapter->mlmepriv.country_ent || COUNTRY_CHPLAN_EN_11AC(padapter->mlmepriv.country_ent)) ++ ) { ++ pframe = rtw_tdls_set_aid(padapter, pframe, pattrib); ++ pframe = rtw_tdls_set_vht_cap(padapter, pframe, pattrib); ++ } ++#endif ++ ++#ifdef CONFIG_WFD ++ if (padapter->wdinfo.wfd_tdls_enable == 1) ++ wfd_ie_tdls(padapter, pframe, &(pattrib->pktlen)); ++#endif ++ ++} ++ ++void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) ++{ ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct sta_info *ptdls_sta; ++ u8 k; /* for random ANonce */ ++ u8 *pftie = NULL, *ptimeout_ie = NULL, *plinkid_ie = NULL, *prsnie = NULL, *pftie_mic = NULL; ++ u32 time; ++ u8 *pframe_head; ++ ++ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv) , pattrib->dst); ++ ++ if (ptdls_sta == NULL) ++ RTW_INFO("[%s] %d ptdls_sta is NULL\n", __FUNCTION__, __LINE__); ++ ++ if (pattrib->encrypt && ptdls_sta != NULL) { ++ for (k = 0; k < 8; k++) { ++ time = rtw_get_current_time(); ++ _rtw_memcpy(&ptdls_sta->ANonce[4 * k], (u8 *)&time, 4); ++ } ++ } ++ ++ pframe_head = pframe; ++ ++ pframe = rtw_tdls_set_payload_type(pframe, pattrib); ++ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); ++ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt); ++ ++ if (ptxmgmt->status_code != 0) { ++ RTW_INFO("[%s] status_code:%04x\n", __FUNCTION__, ptxmgmt->status_code); ++ return; ++ } ++ ++ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_capability(padapter, pframe, pattrib); ++ pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib); ++ pframe = rtw_tdls_set_sup_ch(&(padapter->mlmeextpriv), pframe, pattrib); ++ pframe = rtw_tdls_set_sup_reg_class(pframe, pattrib); ++ ++ if (pattrib->encrypt) { ++ prsnie = pframe; ++ pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _FALSE, ptdls_sta); ++ } ++ ++ pframe = rtw_tdls_set_ext_cap(pframe, pattrib); ++ ++ if (pattrib->encrypt) { ++ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) ++ wpa_tdls_generate_tpk(padapter, ptdls_sta); ++ ++ pftie = pframe; ++ pftie_mic = pframe + 4; ++ pframe = rtw_tdls_set_ftie(ptxmgmt ++ , pframe ++ , pattrib ++ , ptdls_sta->ANonce ++ , ptdls_sta->SNonce); ++ ++ ptimeout_ie = pframe; ++ pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _FALSE, ptdls_sta); ++ } ++ ++#ifdef CONFIG_80211N_HT ++ /* Sup_reg_classes(optional) */ ++ if (pregistrypriv->ht_enable == _TRUE) ++ pframe = rtw_tdls_set_ht_cap(padapter, pframe_head, pattrib); ++#endif ++ ++ pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib); ++ ++ plinkid_ie = pframe; ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); ++ ++ /* Fill FTIE mic */ ++ if (pattrib->encrypt && rtw_tdls_is_driver_setup(padapter) == _TRUE) ++ wpa_tdls_ftie_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie, pftie_mic); ++ ++ if ((pregistrypriv->wmm_enable == _TRUE) || (padapter->mlmepriv.htpriv.ht_option == _TRUE)) ++ pframe = rtw_tdls_set_qos_cap(pframe, pattrib); ++ ++#ifdef CONFIG_80211AC_VHT ++ if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) && (pmlmeext->cur_channel > 14) ++ && REGSTY_IS_11AC_ENABLE(pregistrypriv) ++ && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) ++ && (!padapter->mlmepriv.country_ent || COUNTRY_CHPLAN_EN_11AC(padapter->mlmepriv.country_ent)) ++ ) { ++ pframe = rtw_tdls_set_aid(padapter, pframe, pattrib); ++ pframe = rtw_tdls_set_vht_cap(padapter, pframe, pattrib); ++ pframe = rtw_tdls_set_vht_op_mode_notify(padapter, pframe, pattrib, pmlmeext->cur_bwmode); ++ } ++#endif ++ ++#ifdef CONFIG_WFD ++ if (padapter->wdinfo.wfd_tdls_enable) ++ wfd_ie_tdls(padapter, pframe, &(pattrib->pktlen)); ++#endif ++ ++} ++ ++void rtw_build_tdls_setup_cfm_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) ++{ ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct sta_info *ptdls_sta = rtw_get_stainfo((&padapter->stapriv) , pattrib->dst); ++ ++ unsigned int ie_len; ++ unsigned char *p; ++ u8 wmm_param_ele[24] = {0}; ++ u8 *pftie = NULL, *ptimeout_ie = NULL, *plinkid_ie = NULL, *prsnie = NULL, *pftie_mic = NULL; ++ ++ pframe = rtw_tdls_set_payload_type(pframe, pattrib); ++ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); ++ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); ++ ++ if (ptxmgmt->status_code != 0) ++ return; ++ ++ if (pattrib->encrypt) { ++ prsnie = pframe; ++ pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta); ++ } ++ ++ if (pattrib->encrypt) { ++ pftie = pframe; ++ pftie_mic = pframe + 4; ++ pframe = rtw_tdls_set_ftie(ptxmgmt ++ , pframe ++ , pattrib ++ , ptdls_sta->ANonce ++ , ptdls_sta->SNonce); ++ ++ ptimeout_ie = pframe; ++ pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta); ++ ++ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { ++ /* Start TPK timer */ ++ ptdls_sta->TPK_count = 0; ++ _set_timer(&ptdls_sta->TPK_timer, ONE_SEC); ++ } ++ } ++ ++ /* HT operation; todo */ ++ ++ plinkid_ie = pframe; ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); ++ ++ if (pattrib->encrypt && (rtw_tdls_is_driver_setup(padapter) == _TRUE)) ++ wpa_tdls_ftie_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie, pftie_mic); ++ ++ if (ptdls_sta->qos_option == _TRUE) ++ pframe = rtw_tdls_set_wmm_params(padapter, pframe, pattrib); ++ ++#ifdef CONFIG_80211AC_VHT ++ if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) ++ && (ptdls_sta->vhtpriv.vht_option == _TRUE) && (pmlmeext->cur_channel > 14) ++ && REGSTY_IS_11AC_ENABLE(pregistrypriv) ++ && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) ++ && (!padapter->mlmepriv.country_ent || COUNTRY_CHPLAN_EN_11AC(padapter->mlmepriv.country_ent)) ++ ) { ++ pframe = rtw_tdls_set_vht_operation(padapter, pframe, pattrib, pmlmeext->cur_channel); ++ pframe = rtw_tdls_set_vht_op_mode_notify(padapter, pframe, pattrib, pmlmeext->cur_bwmode); ++ } ++#endif ++} ++ ++void rtw_build_tdls_teardown_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) ++{ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct sta_info *ptdls_sta = rtw_get_stainfo(&(padapter->stapriv) , pattrib->dst); ++ u8 *pftie = NULL, *pftie_mic = NULL, *plinkid_ie = NULL; ++ ++ pframe = rtw_tdls_set_payload_type(pframe, pattrib); ++ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); ++ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt); ++ ++ if (pattrib->encrypt) { ++ pftie = pframe; ++ pftie_mic = pframe + 4; ++ pframe = rtw_tdls_set_ftie(ptxmgmt ++ , pframe ++ , pattrib ++ , ptdls_sta->ANonce ++ , ptdls_sta->SNonce); ++ } ++ ++ plinkid_ie = pframe; ++ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); ++ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); ++ ++ if (pattrib->encrypt && (rtw_tdls_is_driver_setup(padapter) == _TRUE)) ++ wpa_tdls_teardown_ftie_mic(ptdls_sta->tpk.kck, plinkid_ie, ptxmgmt->status_code, 1, 4, pftie, pftie_mic); ++} ++ ++void rtw_build_tdls_dis_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) ++{ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ ++ pframe = rtw_tdls_set_payload_type(pframe, pattrib); ++ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); ++ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); ++ ++} ++ ++void rtw_build_tdls_dis_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, u8 privacy) ++{ ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ u8 *pframe_head, pktlen_index; ++ ++ pktlen_index = pattrib->pktlen; ++ pframe_head = pframe; ++ ++ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_PUBLIC); ++ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_capability(padapter, pframe, pattrib); ++ ++ pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib); ++ ++ pframe = rtw_tdls_set_sup_ch(pmlmeext, pframe, pattrib); ++ ++ if (privacy) ++ pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _TRUE, NULL); ++ ++ pframe = rtw_tdls_set_ext_cap(pframe, pattrib); ++ ++ if (privacy) { ++ pframe = rtw_tdls_set_ftie(ptxmgmt, pframe, pattrib, NULL, NULL); ++ pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _TRUE, NULL); ++ } ++ ++#ifdef CONFIG_80211N_HT ++ if (pregistrypriv->ht_enable == _TRUE) ++ pframe = rtw_tdls_set_ht_cap(padapter, pframe_head - pktlen_index, pattrib); ++#endif ++ ++ pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib); ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); ++ ++} ++ ++ ++void rtw_build_tdls_peer_traffic_indication_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) ++{ ++ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ u8 AC_queue = 0; ++ struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); ++ ++ pframe = rtw_tdls_set_payload_type(pframe, pattrib); ++ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); ++ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); ++ ++ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); ++ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); ++ ++ /* PTI control */ ++ /* PU buffer status */ ++ if (ptdls_sta->uapsd_bk & BIT(1)) ++ AC_queue = BIT(0); ++ if (ptdls_sta->uapsd_be & BIT(1)) ++ AC_queue = BIT(1); ++ if (ptdls_sta->uapsd_vi & BIT(1)) ++ AC_queue = BIT(2); ++ if (ptdls_sta->uapsd_vo & BIT(1)) ++ AC_queue = BIT(3); ++ pframe = rtw_set_ie(pframe, _PTI_BUFFER_STATUS_, 1, &AC_queue, &(pattrib->pktlen)); ++ ++} ++ ++void rtw_build_tdls_peer_traffic_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) ++{ ++ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); ++ ++ pframe = rtw_tdls_set_payload_type(pframe, pattrib); ++ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); ++ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); ++ ++ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); ++ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); ++} ++ ++#ifdef CONFIG_TDLS_CH_SW ++void rtw_build_tdls_ch_switch_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); ++ u16 switch_time = TDLS_CH_SWITCH_TIME * 1000, switch_timeout = TDLS_CH_SWITCH_TIMEOUT * 1000; ++ ++ ptdls_sta->ch_switch_time = switch_time; ++ ptdls_sta->ch_switch_timeout = switch_timeout; ++ ++ pframe = rtw_tdls_set_payload_type(pframe, pattrib); ++ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); ++ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_target_ch(padapter, pframe, pattrib); ++ pframe = rtw_tdls_set_reg_class(pframe, pattrib, ptdls_sta); ++ ++ if (ptdlsinfo->chsw_info.ch_offset != HAL_PRIME_CHNL_OFFSET_DONT_CARE) { ++ switch (ptdlsinfo->chsw_info.ch_offset) { ++ case HAL_PRIME_CHNL_OFFSET_LOWER: ++ pframe = rtw_tdls_set_second_channel_offset(pframe, pattrib, SCA); ++ break; ++ case HAL_PRIME_CHNL_OFFSET_UPPER: ++ pframe = rtw_tdls_set_second_channel_offset(pframe, pattrib, SCB); ++ break; ++ } ++ } ++ ++ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); ++ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); ++ ++ pframe = rtw_tdls_set_ch_sw(pframe, pattrib, ptdls_sta); ++ ++} ++ ++void rtw_build_tdls_ch_switch_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) ++{ ++ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); ++ ++ pframe = rtw_tdls_set_payload_type(pframe, pattrib); ++ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); ++ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); ++ pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt); ++ ++ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); ++ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) ++ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); ++ ++ pframe = rtw_tdls_set_ch_sw(pframe, pattrib, ptdls_sta); ++} ++#endif ++ ++#ifdef CONFIG_WFD ++void rtw_build_tunneled_probe_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe) ++{ ++ u8 i; ++ _adapter *iface = NULL; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct wifidirect_info *pwdinfo; ++ ++ u8 category = RTW_WLAN_CATEGORY_P2P; ++ u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a}; ++ u8 probe_req = 4; ++ u8 wfdielen = 0; ++ ++ pframe = rtw_tdls_set_payload_type(pframe, pattrib); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 3, WFA_OUI, &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(probe_req), &(pattrib->pktlen)); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ pwdinfo = &iface->wdinfo; ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ wfdielen = build_probe_req_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++ } ++ } ++ } ++} ++ ++void rtw_build_tunneled_probe_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe) ++{ ++ u8 i; ++ _adapter *iface = NULL; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct wifidirect_info *pwdinfo; ++ u8 category = RTW_WLAN_CATEGORY_P2P; ++ u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a}; ++ u8 probe_rsp = 5; ++ u8 wfdielen = 0; ++ ++ pframe = rtw_tdls_set_payload_type(pframe, pattrib); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 3, WFA_OUI, &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(probe_rsp), &(pattrib->pktlen)); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ pwdinfo = &iface->wdinfo; ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ wfdielen = build_probe_resp_wfd_ie(pwdinfo, pframe, 1); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++ } ++ } ++ } ++} ++#endif /* CONFIG_WFD */ ++ ++void _tdls_tpk_timer_hdl(void *FunctionContext) ++{ ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ struct tdls_txmgmt txmgmt; ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ ptdls_sta->TPK_count++; ++ /* TPK_timer expired in a second */ ++ /* Retry timer should set at least 301 sec. */ ++ if (ptdls_sta->TPK_count >= (ptdls_sta->TDLS_PeerKey_Lifetime - 3)) { ++ RTW_INFO("[TDLS] %s, Re-Setup TDLS link with "MAC_FMT" since TPK lifetime expires!\n", __FUNCTION__, MAC_ARG(ptdls_sta->hwaddr)); ++ ptdls_sta->TPK_count = 0; ++ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); ++ issue_tdls_setup_req(ptdls_sta->padapter, &txmgmt, _FALSE); ++ } ++ ++ _set_timer(&ptdls_sta->TPK_timer, ONE_SEC); ++} ++ ++#ifdef CONFIG_TDLS_CH_SW ++void _tdls_ch_switch_timer_hdl(void *FunctionContext) ++{ ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ _adapter *padapter = ptdls_sta->padapter; ++ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; ++ ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END_TO_BASE_CHNL); ++ RTW_INFO("[TDLS] %s, can't get traffic from op_ch:%d\n", __func__, rtw_get_oper_ch(padapter)); ++} ++ ++void _tdls_delay_timer_hdl(void *FunctionContext) ++{ ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ _adapter *padapter = ptdls_sta->padapter; ++ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; ++ ++ RTW_INFO("[TDLS] %s, op_ch:%d, tdls_state:0x%08x\n", __func__, rtw_get_oper_ch(padapter), ptdls_sta->tdls_sta_state); ++ pchsw_info->delay_switch_back = _TRUE; ++} ++ ++void _tdls_stay_on_base_chnl_timer_hdl(void *FunctionContext) ++{ ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ _adapter *padapter = ptdls_sta->padapter; ++ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; ++ ++ if (ptdls_sta != NULL) { ++ issue_tdls_ch_switch_req(padapter, ptdls_sta); ++ pchsw_info->ch_sw_state |= TDLS_WAIT_CH_RSP_STATE; ++ } ++} ++ ++void _tdls_ch_switch_monitor_timer_hdl(void *FunctionContext) ++{ ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ _adapter *padapter = ptdls_sta->padapter; ++ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; ++ ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END); ++ RTW_INFO("[TDLS] %s, does not receive ch sw req\n", __func__); ++} ++ ++#endif ++ ++void _tdls_handshake_timer_hdl(void *FunctionContext) ++{ ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ _adapter *padapter = ptdls_sta->padapter; ++ struct tdls_txmgmt txmgmt; ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); ++ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; ++ ++ if (ptdls_sta != NULL) { ++ RTW_INFO("[TDLS] Handshake time out\n"); ++ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_TEARDOWN_STA); ++ else ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_TEARDOWN_STA_LOCALLY); ++ } ++} ++ ++void _tdls_pti_timer_hdl(void *FunctionContext) ++{ ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ _adapter *padapter = ptdls_sta->padapter; ++ struct tdls_txmgmt txmgmt; ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); ++ txmgmt.status_code = _RSON_TDLS_TEAR_TOOFAR_; ++ ++ if (ptdls_sta != NULL) { ++ if (ptdls_sta->tdls_sta_state & TDLS_WAIT_PTR_STATE) { ++ RTW_INFO("[TDLS] Doesn't receive PTR from peer dev:"MAC_FMT"; " ++ "Send TDLS Tear Down\n", MAC_ARG(ptdls_sta->hwaddr)); ++ issue_tdls_teardown(padapter, &txmgmt, _FALSE); ++ } ++ } ++} ++ ++void rtw_init_tdls_timer(_adapter *padapter, struct sta_info *psta) ++{ ++ psta->padapter = padapter; ++ _init_timer(&psta->TPK_timer, padapter->pnetdev, _tdls_tpk_timer_hdl, psta); ++#ifdef CONFIG_TDLS_CH_SW ++ _init_timer(&psta->ch_sw_timer, padapter->pnetdev, _tdls_ch_switch_timer_hdl, psta); ++ _init_timer(&psta->delay_timer, padapter->pnetdev, _tdls_delay_timer_hdl, psta); ++ _init_timer(&psta->stay_on_base_chnl_timer, padapter->pnetdev, _tdls_stay_on_base_chnl_timer_hdl, psta); ++ _init_timer(&psta->ch_sw_monitor_timer, padapter->pnetdev, _tdls_ch_switch_monitor_timer_hdl, psta); ++#endif ++ _init_timer(&psta->handshake_timer, padapter->pnetdev, _tdls_handshake_timer_hdl, psta); ++ _init_timer(&psta->pti_timer, padapter->pnetdev, _tdls_pti_timer_hdl, psta); ++} ++ ++void rtw_free_tdls_timer(struct sta_info *psta) ++{ ++ _cancel_timer_ex(&psta->TPK_timer); ++#ifdef CONFIG_TDLS_CH_SW ++ _cancel_timer_ex(&psta->ch_sw_timer); ++ _cancel_timer_ex(&psta->delay_timer); ++ _cancel_timer_ex(&psta->stay_on_base_chnl_timer); ++ _cancel_timer_ex(&psta->ch_sw_monitor_timer); ++#endif ++ _cancel_timer_ex(&psta->handshake_timer); ++ _cancel_timer_ex(&psta->pti_timer); ++} ++ ++u32 update_mask_tdls(_adapter *padapter, struct sta_info *psta) ++{ ++ unsigned char sta_band = 0; ++ unsigned int tx_ra_bitmap = 0; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; ++ ++ rtw_hal_update_sta_rate_mask(padapter, psta); ++ tx_ra_bitmap = psta->ra_mask; ++ ++ if (pcur_network->Configuration.DSConfig > 14) { ++ if (tx_ra_bitmap & 0xffff000) ++ sta_band |= WIRELESS_11_5N | WIRELESS_11A; ++ else ++ sta_band |= WIRELESS_11A; ++ } else { ++ if (tx_ra_bitmap & 0xffff000) ++ sta_band |= WIRELESS_11_24N | WIRELESS_11G | WIRELESS_11B; ++ else if (tx_ra_bitmap & 0xff0) ++ sta_band |= WIRELESS_11G | WIRELESS_11B; ++ else ++ sta_band |= WIRELESS_11B; ++ } ++ ++ psta->wireless_mode = sta_band; ++ ++ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); ++ tx_ra_bitmap |= ((psta->raid << 28) & 0xf0000000); ++ return tx_ra_bitmap; ++} ++ ++int rtw_tdls_is_driver_setup(_adapter *padapter) ++{ ++ return padapter->tdlsinfo.driver_setup; ++} ++ ++const char *rtw_tdls_action_txt(enum TDLS_ACTION_FIELD action) ++{ ++ switch (action) { ++ case TDLS_SETUP_REQUEST: ++ return "TDLS_SETUP_REQUEST"; ++ case TDLS_SETUP_RESPONSE: ++ return "TDLS_SETUP_RESPONSE"; ++ case TDLS_SETUP_CONFIRM: ++ return "TDLS_SETUP_CONFIRM"; ++ case TDLS_TEARDOWN: ++ return "TDLS_TEARDOWN"; ++ case TDLS_PEER_TRAFFIC_INDICATION: ++ return "TDLS_PEER_TRAFFIC_INDICATION"; ++ case TDLS_CHANNEL_SWITCH_REQUEST: ++ return "TDLS_CHANNEL_SWITCH_REQUEST"; ++ case TDLS_CHANNEL_SWITCH_RESPONSE: ++ return "TDLS_CHANNEL_SWITCH_RESPONSE"; ++ case TDLS_PEER_PSM_REQUEST: ++ return "TDLS_PEER_PSM_REQUEST"; ++ case TDLS_PEER_PSM_RESPONSE: ++ return "TDLS_PEER_PSM_RESPONSE"; ++ case TDLS_PEER_TRAFFIC_RESPONSE: ++ return "TDLS_PEER_TRAFFIC_RESPONSE"; ++ case TDLS_DISCOVERY_REQUEST: ++ return "TDLS_DISCOVERY_REQUEST"; ++ case TDLS_DISCOVERY_RESPONSE: ++ return "TDLS_DISCOVERY_RESPONSE"; ++ default: ++ return "UNKNOWN"; ++ } ++} ++ ++#endif /* CONFIG_TDLS */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_vht.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_vht.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_vht.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_vht.c 2018-02-11 21:44:27.142146010 +0200 +@@ -0,0 +1,857 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_VHT_C ++ ++#include ++ ++#ifdef CONFIG_80211AC_VHT ++/* 20/40/80, ShortGI, MCS Rate */ ++const u16 VHT_MCS_DATA_RATE[3][2][30] = { ++ { { ++ 13, 26, 39, 52, 78, 104, 117, 130, 156, 156, ++ 26, 52, 78, 104, 156, 208, 234, 260, 312, 312, ++ 39, 78, 117, 156, 234, 312, 351, 390, 468, 520 ++ }, /* Long GI, 20MHz */ ++ { ++ 14, 29, 43, 58, 87, 116, 130, 144, 173, 173, ++ 29, 58, 87, 116, 173, 231, 260, 289, 347, 347, ++ 43, 87, 130, 173, 260, 347, 390, 433, 520, 578 ++ } ++ }, /* Short GI, 20MHz */ ++ { { ++ 27, 54, 81, 108, 162, 216, 243, 270, 324, 360, ++ 54, 108, 162, 216, 324, 432, 486, 540, 648, 720, ++ 81, 162, 243, 324, 486, 648, 729, 810, 972, 1080 ++ }, /* Long GI, 40MHz */ ++ { ++ 30, 60, 90, 120, 180, 240, 270, 300, 360, 400, ++ 60, 120, 180, 240, 360, 480, 540, 600, 720, 800, ++ 90, 180, 270, 360, 540, 720, 810, 900, 1080, 1200 ++ } ++ }, /* Short GI, 40MHz */ ++ { { ++ 59, 117, 176, 234, 351, 468, 527, 585, 702, 780, ++ 117, 234, 351, 468, 702, 936, 1053, 1170, 1404, 1560, ++ 176, 351, 527, 702, 1053, 1404, 1580, 1755, 2106, 2340 ++ }, /* Long GI, 80MHz */ ++ { ++ 65, 130, 195, 260, 390, 520, 585, 650, 780, 867, ++ 130, 260, 390, 520, 780, 1040, 1170, 1300, 1560, 1734, ++ 195, 390, 585, 780, 1170, 1560, 1755, 1950, 2340, 2600 ++ } ++ } /* Short GI, 80MHz */ ++}; ++ ++u8 rtw_get_vht_highest_rate(u8 *pvht_mcs_map) ++{ ++ u8 i, j; ++ u8 bit_map; ++ u8 vht_mcs_rate = 0; ++ ++ for (i = 0; i < 2; i++) { ++ if (pvht_mcs_map[i] != 0xff) { ++ for (j = 0; j < 8; j += 2) { ++ bit_map = (pvht_mcs_map[i] >> j) & 3; ++ ++ if (bit_map != 3) ++ vht_mcs_rate = MGN_VHT1SS_MCS7 + 10 * j / 2 + i * 40 + bit_map; /* VHT rate indications begin from 0x90 */ ++ } ++ } ++ } ++ ++ /* RTW_INFO("HighestVHTMCSRate is %x\n", vht_mcs_rate); */ ++ return vht_mcs_rate; ++} ++ ++u8 rtw_vht_mcsmap_to_nss(u8 *pvht_mcs_map) ++{ ++ u8 i, j; ++ u8 bit_map; ++ u8 nss = 0; ++ ++ for (i = 0; i < 2; i++) { ++ if (pvht_mcs_map[i] != 0xff) { ++ for (j = 0; j < 8; j += 2) { ++ bit_map = (pvht_mcs_map[i] >> j) & 3; ++ ++ if (bit_map != 3) ++ nss++; ++ } ++ } ++ } ++ ++ /* RTW_INFO("%s : %dSS\n", __FUNCTION__, nss); */ ++ return nss; ++} ++ ++void rtw_vht_nss_to_mcsmap(u8 nss, u8 *target_mcs_map, u8 *cur_mcs_map) ++{ ++ u8 i, j; ++ u8 cur_rate, target_rate; ++ ++ for (i = 0; i < 2; i++) { ++ target_mcs_map[i] = 0; ++ for (j = 0; j < 8; j += 2) { ++ cur_rate = (cur_mcs_map[i] >> j) & 3; ++ if (cur_rate == 3) /* 0x3 indicates not supported that num of SS */ ++ target_rate = 3; ++ else if (nss <= ((j / 2) + i * 4)) ++ target_rate = 3; ++ else ++ target_rate = cur_rate; ++ ++ target_mcs_map[i] |= (target_rate << j); ++ } ++ } ++ ++ /* RTW_INFO("%s : %dSS\n", __FUNCTION__, nss); */ ++} ++ ++u16 rtw_vht_mcs_to_data_rate(u8 bw, u8 short_GI, u8 vht_mcs_rate) ++{ ++ if (vht_mcs_rate > MGN_VHT3SS_MCS9) ++ vht_mcs_rate = MGN_VHT3SS_MCS9; ++ /* RTW_INFO("bw=%d, short_GI=%d, ((vht_mcs_rate - MGN_VHT1SS_MCS0)&0x3f)=%d\n", bw, short_GI, ((vht_mcs_rate - MGN_VHT1SS_MCS0)&0x3f)); */ ++ return VHT_MCS_DATA_RATE[bw][short_GI][((vht_mcs_rate - MGN_VHT1SS_MCS0) & 0x3f)]; ++} ++ ++void rtw_vht_use_default_setting(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ BOOLEAN bHwLDPCSupport = _FALSE, bHwSTBCSupport = _FALSE; ++#ifdef CONFIG_BEAMFORMING ++ BOOLEAN bHwSupportBeamformer = _FALSE, bHwSupportBeamformee = _FALSE; ++ u8 mu_bfer, mu_bfee; ++#endif /* CONFIG_BEAMFORMING */ ++ u8 rf_type = 0; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ pvhtpriv->sgi_80m = TEST_FLAG(pregistrypriv->short_gi, BIT2) ? _TRUE : _FALSE; ++ ++ /* LDPC support */ ++ rtw_hal_get_def_var(padapter, HAL_DEF_RX_LDPC, (u8 *)&bHwLDPCSupport); ++ CLEAR_FLAGS(pvhtpriv->ldpc_cap); ++ if (bHwLDPCSupport) { ++ if (TEST_FLAG(pregistrypriv->ldpc_cap, BIT0)) ++ SET_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_RX); ++ } ++ rtw_hal_get_def_var(padapter, HAL_DEF_TX_LDPC, (u8 *)&bHwLDPCSupport); ++ if (bHwLDPCSupport) { ++ if (TEST_FLAG(pregistrypriv->ldpc_cap, BIT1)) ++ SET_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX); ++ } ++ if (pvhtpriv->ldpc_cap) ++ RTW_INFO("[VHT] Support LDPC = 0x%02X\n", pvhtpriv->ldpc_cap); ++ ++ /* STBC */ ++ rtw_hal_get_def_var(padapter, HAL_DEF_TX_STBC, (u8 *)&bHwSTBCSupport); ++ CLEAR_FLAGS(pvhtpriv->stbc_cap); ++ if (bHwSTBCSupport) { ++ if (TEST_FLAG(pregistrypriv->stbc_cap, BIT1)) ++ SET_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX); ++ } ++ rtw_hal_get_def_var(padapter, HAL_DEF_RX_STBC, (u8 *)&bHwSTBCSupport); ++ if (bHwSTBCSupport) { ++ if (TEST_FLAG(pregistrypriv->stbc_cap, BIT0)) ++ SET_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_RX); ++ } ++ if (pvhtpriv->stbc_cap) ++ RTW_INFO("[VHT] Support STBC = 0x%02X\n", pvhtpriv->stbc_cap); ++ ++ /* Beamforming setting */ ++ CLEAR_FLAGS(pvhtpriv->beamform_cap); ++#ifdef CONFIG_BEAMFORMING ++ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMER, (u8 *)&bHwSupportBeamformer); ++ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMEE, (u8 *)&bHwSupportBeamformee); ++ mu_bfer = _FALSE; ++ mu_bfee = _FALSE; ++ rtw_hal_get_def_var(padapter, HAL_DEF_VHT_MU_BEAMFORMER, &mu_bfer); ++ rtw_hal_get_def_var(padapter, HAL_DEF_VHT_MU_BEAMFORMEE, &mu_bfee); ++ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT0) && bHwSupportBeamformer) { ++#ifdef CONFIG_CONCURRENT_MODE ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { ++ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); ++ RTW_INFO("[VHT] CONCURRENT AP Support Beamformer\n"); ++ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT(2)) ++ && (_TRUE == mu_bfer)) { ++ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE); ++ RTW_INFO("[VHT] Support MU-MIMO AP\n"); ++ } ++ } else ++ RTW_INFO("[VHT] CONCURRENT not AP ;not allow Support Beamformer\n"); ++#else ++ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); ++ RTW_INFO("[VHT] Support Beamformer\n"); ++ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT(2)) ++ && (_TRUE == mu_bfer) ++ && ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) { ++ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE); ++ RTW_INFO("[VHT] Support MU-MIMO AP\n"); ++ } ++#endif ++ } ++ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT1) && bHwSupportBeamformee) { ++ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); ++ RTW_INFO("[VHT] Support Beamformee\n"); ++ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT(3)) ++ && (_TRUE == mu_bfee) ++ && ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE)) { ++ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE); ++ RTW_INFO("[VHT] Support MU-MIMO STA\n"); ++ } ++ } ++#endif /* CONFIG_BEAMFORMING */ ++ ++ pvhtpriv->ampdu_len = pregistrypriv->ampdu_factor; ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ if (rf_type == RF_3T3R) ++ pvhtpriv->vht_mcs_map[0] = 0xea; /* support 1SS MCS 0~9 2SS MCS 0~9 3SS MCS 0~9 */ ++ else if (rf_type == RF_2T2R) ++ pvhtpriv->vht_mcs_map[0] = 0xfa; /* support 1SS MCS 0~9 2SS MCS 0~9 */ ++ else ++ pvhtpriv->vht_mcs_map[0] = 0xfe; /* Only support 1SS MCS 0~9; */ ++ pvhtpriv->vht_mcs_map[1] = 0xff; ++ ++ if (pregistrypriv->vht_rate_sel == 1) { ++ pvhtpriv->vht_mcs_map[0] = 0xfc; /* support 1SS MCS 0~7 */ ++ } else if (pregistrypriv->vht_rate_sel == 2) { ++ pvhtpriv->vht_mcs_map[0] = 0xfd; /* Support 1SS MCS 0~8 */ ++ } else if (pregistrypriv->vht_rate_sel == 3) { ++ pvhtpriv->vht_mcs_map[0] = 0xfe; /* Support 1SS MCS 0~9 */ ++ } else if (pregistrypriv->vht_rate_sel == 4) { ++ pvhtpriv->vht_mcs_map[0] = 0xf0; /* support 1SS MCS 0~7 2SS MCS 0~7 */ ++ } else if (pregistrypriv->vht_rate_sel == 5) { ++ pvhtpriv->vht_mcs_map[0] = 0xf5; /* support 1SS MCS 0~8 2SS MCS 0~8 */ ++ } else if (pregistrypriv->vht_rate_sel == 6) { ++ pvhtpriv->vht_mcs_map[0] = 0xfa; /* support 1SS MCS 0~9 2SS MCS 0~9 */ ++ } else if (pregistrypriv->vht_rate_sel == 7) { ++ pvhtpriv->vht_mcs_map[0] = 0xf8; /* support 1SS MCS 0-7 2SS MCS 0~9 */ ++ } else if (pregistrypriv->vht_rate_sel == 8) { ++ pvhtpriv->vht_mcs_map[0] = 0xf9; /* support 1SS MCS 0-8 2SS MCS 0~9 */ ++ } else if (pregistrypriv->vht_rate_sel == 9) { ++ pvhtpriv->vht_mcs_map[0] = 0xf4; /* support 1SS MCS 0-7 2SS MCS 0~8 */ ++ } ++ ++ pvhtpriv->vht_highest_rate = rtw_get_vht_highest_rate(pvhtpriv->vht_mcs_map); ++} ++ ++u64 rtw_vht_rate_to_bitmap(u8 *pVHTRate) ++{ ++ ++ u8 i, j , tmpRate; ++ u64 RateBitmap = 0; ++ u8 Bits_3ss = 6; ++ ++ for (i = j = 0; i < Bits_3ss; i += 2, j += 10) { ++ /* every two bits means single sptial stream */ ++ tmpRate = (pVHTRate[0] >> i) & 3; ++ ++ switch (tmpRate) { ++ case 2: ++ RateBitmap = RateBitmap | (0x03ff << j); ++ break; ++ case 1: ++ RateBitmap = RateBitmap | (0x01ff << j); ++ break; ++ ++ case 0: ++ RateBitmap = RateBitmap | (0x00ff << j); ++ break; ++ ++ default: ++ break; ++ } ++ } ++ RTW_INFO("RateBitmap=%016llx , pVHTRate[0]=%02x, pVHTRate[1]=%02x\n", RateBitmap, pVHTRate[0], pVHTRate[1]); ++ return RateBitmap; ++} ++ ++void update_sta_vht_info_apmode(_adapter *padapter, PVOID sta) ++{ ++ struct sta_info *psta = (struct sta_info *)sta; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct vht_priv *pvhtpriv_ap = &pmlmepriv->vhtpriv; ++ struct vht_priv *pvhtpriv_sta = &psta->vhtpriv; ++ struct ht_priv *phtpriv_sta = &psta->htpriv; ++ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, bw_mode = 0; ++ u16 cur_beamform_cap = 0; ++ u8 *pcap_mcs; ++ ++ if (pvhtpriv_sta->vht_option == _FALSE) ++ return; ++ ++ bw_mode = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(&pvhtpriv_sta->vht_op_mode_notify); ++ ++ /* if (bw_mode > psta->bw_mode) */ ++ psta->bw_mode = bw_mode; ++ ++ /* B4 Rx LDPC */ ++ if (TEST_FLAG(pvhtpriv_ap->ldpc_cap, LDPC_VHT_ENABLE_TX) && ++ GET_VHT_CAPABILITY_ELE_RX_LDPC(pvhtpriv_sta->vht_cap)) { ++ SET_FLAG(cur_ldpc_cap, (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX)); ++ RTW_INFO("Current STA(%d) VHT LDPC = %02X\n", psta->aid, cur_ldpc_cap); ++ } ++ pvhtpriv_sta->ldpc_cap = cur_ldpc_cap; ++ ++ if (psta->bw_mode > pmlmeext->cur_bwmode) ++ psta->bw_mode = pmlmeext->cur_bwmode; ++ ++ if (psta->bw_mode == CHANNEL_WIDTH_80) { ++ /* B5 Short GI for 80 MHz */ ++ pvhtpriv_sta->sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi_80m) ? _TRUE : _FALSE; ++ /* RTW_INFO("Current STA ShortGI80MHz = %d\n", pvhtpriv_sta->sgi_80m); */ ++ } else if (psta->bw_mode >= CHANNEL_WIDTH_160) { ++ /* B5 Short GI for 80 MHz */ ++ pvhtpriv_sta->sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI160M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi_80m) ? _TRUE : _FALSE; ++ /* RTW_INFO("Current STA ShortGI160MHz = %d\n", pvhtpriv_sta->sgi_80m); */ ++ } ++ ++ /* B8 B9 B10 Rx STBC */ ++ if (TEST_FLAG(pvhtpriv_ap->stbc_cap, STBC_VHT_ENABLE_TX) && ++ GET_VHT_CAPABILITY_ELE_RX_STBC(pvhtpriv_sta->vht_cap)) { ++ SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); ++ RTW_INFO("Current STA(%d) VHT STBC = %02X\n", psta->aid, cur_stbc_cap); ++ } ++ pvhtpriv_sta->stbc_cap = cur_stbc_cap; ++ ++#ifdef CONFIG_BEAMFORMING ++ /* B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee */ ++ if (TEST_FLAG(pvhtpriv_ap->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && ++ GET_VHT_CAPABILITY_ELE_SU_BFEE(pvhtpriv_sta->vht_cap)) { ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); ++ /*Shift to BEAMFORMING_VHT_BEAMFORMER_STS_CAP*/ ++ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFEE_STS_CAP(pvhtpriv_sta->vht_cap) << 8); ++ } ++ ++ /* B12 SU Beamformee Capable, the target supports Beamformee and we are Beamformer */ ++ if (TEST_FLAG(pvhtpriv_ap->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) && ++ GET_VHT_CAPABILITY_ELE_SU_BFER(pvhtpriv_sta->vht_cap)) { ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); ++ /*Shit to BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM*/ ++ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFER_SOUND_DIM_NUM(pvhtpriv_sta->vht_cap) << 12); ++ } ++ pvhtpriv_sta->beamform_cap = cur_beamform_cap; ++ if (cur_beamform_cap) ++ RTW_INFO("Current STA(%d) VHT Beamforming Setting = %02X\n", psta->aid, cur_beamform_cap); ++#endif ++ ++ /* B23 B24 B25 Maximum A-MPDU Length Exponent */ ++ pvhtpriv_sta->ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pvhtpriv_sta->vht_cap); ++ ++ pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pvhtpriv_sta->vht_cap); ++ _rtw_memcpy(pvhtpriv_sta->vht_mcs_map, pcap_mcs, 2); ++ ++ pvhtpriv_sta->vht_highest_rate = rtw_get_vht_highest_rate(pvhtpriv_sta->vht_mcs_map); ++ ++} ++ ++void update_hw_vht_param(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 ht_AMPDU_len; ++ ++ ht_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; ++ ++ if (pvhtpriv->ampdu_len > ht_AMPDU_len) ++ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&pvhtpriv->ampdu_len)); ++} ++ ++void VHT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, rf_type = RF_1T1R; ++ u16 cur_beamform_cap = 0; ++ u8 *pcap_mcs; ++ u8 vht_mcs[2]; ++ ++ if (pIE == NULL) ++ return; ++ ++ if (pvhtpriv->vht_option == _FALSE) ++ return; ++ ++ pmlmeinfo->VHT_enable = 1; ++ ++ /* B4 Rx LDPC */ ++ if (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX) && ++ GET_VHT_CAPABILITY_ELE_RX_LDPC(pIE->data)) { ++ SET_FLAG(cur_ldpc_cap, (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX)); ++ RTW_INFO("Current VHT LDPC Setting = %02X\n", cur_ldpc_cap); ++ } ++ pvhtpriv->ldpc_cap = cur_ldpc_cap; ++ ++ /* B5 Short GI for 80 MHz */ ++ pvhtpriv->sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(pIE->data) & pvhtpriv->sgi_80m) ? _TRUE : _FALSE; ++ /* RTW_INFO("Current ShortGI80MHz = %d\n", pvhtpriv->sgi_80m); */ ++ ++ /* B8 B9 B10 Rx STBC */ ++ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX) && ++ GET_VHT_CAPABILITY_ELE_RX_STBC(pIE->data)) { ++ SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); ++ RTW_INFO("Current VHT STBC Setting = %02X\n", cur_stbc_cap); ++ } ++ pvhtpriv->stbc_cap = cur_stbc_cap; ++#ifdef CONFIG_BEAMFORMING ++#ifdef RTW_BEAMFORMING_VERSION_2 ++ /* ++ * B11 SU Beamformer Capable, ++ * the target supports Beamformer and we are Beamformee ++ */ ++ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) ++ && GET_VHT_CAPABILITY_ELE_SU_BFER(pIE->data)) { ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); ++ ++ /* Shift to BEAMFORMING_VHT_BEAMFORMEE_STS_CAP */ ++ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFEE_STS_CAP(pIE->data) << 8); ++ ++ /* ++ * B19 MU Beamformer Capable, ++ * the target supports Beamformer and we are Beamformee ++ */ ++ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE) ++ && GET_VHT_CAPABILITY_ELE_MU_BFER(pIE->data)) ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE); ++ } ++ ++ /* ++ * B12 SU Beamformee Capable, ++ * the target supports Beamformee and we are Beamformer ++ */ ++ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) ++ && GET_VHT_CAPABILITY_ELE_SU_BFEE(pIE->data)) { ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); ++ ++ /* Shit to BEAMFORMING_VHT_BEAMFORMER_SOUND_DIM */ ++ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFER_SOUND_DIM_NUM(pIE->data) << 12); ++ ++ /* ++ * B20 MU Beamformee Capable, ++ * the target supports Beamformee and we are Beamformer ++ */ ++ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE) ++ && GET_VHT_CAPABILITY_ELE_MU_BFEE(pIE->data)) ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE); ++ } ++ ++ pvhtpriv->beamform_cap = cur_beamform_cap; ++ RTW_INFO("Current VHT Beamforming Setting=0x%04X\n", cur_beamform_cap); ++#else /* !RTW_BEAMFORMING_VERSION_2 */ ++ /* B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee */ ++ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && ++ GET_VHT_CAPABILITY_ELE_SU_BFEE(pIE->data)) { ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); ++ /*Shift to BEAMFORMING_VHT_BEAMFORMER_STS_CAP*/ ++ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFEE_STS_CAP(pIE->data) << 8); ++ } ++ ++ /* B12 SU Beamformee Capable, the target supports Beamformee and we are Beamformer */ ++ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) && ++ GET_VHT_CAPABILITY_ELE_SU_BFER(pIE->data)) { ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); ++ /*Shit to BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM*/ ++ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFER_SOUND_DIM_NUM(pIE->data) << 12); ++ ++ } ++ pvhtpriv->beamform_cap = cur_beamform_cap; ++ if (cur_beamform_cap) ++ RTW_INFO("Current VHT Beamforming Setting = %02X\n", cur_beamform_cap); ++#endif /* !RTW_BEAMFORMING_VERSION_2 */ ++#endif /* CONFIG_BEAMFORMING */ ++ /* B23 B24 B25 Maximum A-MPDU Length Exponent */ ++ pvhtpriv->ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pIE->data); ++ ++ pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pIE->data); ++ _rtw_memcpy(vht_mcs, pcap_mcs, 2); ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ if ((rf_type == RF_1T1R) || (rf_type == RF_1T2R)) ++ vht_mcs[0] |= 0xfc; ++ else if (rf_type == RF_2T2R) ++ vht_mcs[0] |= 0xf0; ++ else if (rf_type == RF_3T3R) ++ vht_mcs[0] |= 0xc0; ++ ++ _rtw_memcpy(pvhtpriv->vht_mcs_map, vht_mcs, 2); ++ ++ pvhtpriv->vht_highest_rate = rtw_get_vht_highest_rate(pvhtpriv->vht_mcs_map); ++} ++ ++void VHT_operation_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++ ++ if (pIE == NULL) ++ return; ++ ++ if (pvhtpriv->vht_option == _FALSE) ++ return; ++} ++ ++void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, PVOID sta) ++{ ++ struct sta_info *psta = (struct sta_info *)sta; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct registry_priv *regsty = adapter_to_regsty(padapter); ++ u8 target_bw; ++ u8 target_rxss, current_rxss; ++ u8 update_ra = _FALSE; ++ u8 vht_mcs_map[2] = {}; ++ ++ if (pvhtpriv->vht_option == _FALSE) ++ return; ++ ++ target_bw = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(pframe); ++ target_rxss = (GET_VHT_OPERATING_MODE_FIELD_RX_NSS(pframe) + 1); ++ ++ if (target_bw != psta->bw_mode) { ++ if (hal_is_bw_support(padapter, target_bw) ++ && REGSTY_IS_BW_5G_SUPPORT(regsty, target_bw) ++ ) { ++ update_ra = _TRUE; ++ psta->bw_mode = target_bw; ++ } ++ } ++ ++ current_rxss = rtw_vht_mcsmap_to_nss(psta->vhtpriv.vht_mcs_map); ++ if (target_rxss != current_rxss) { ++ update_ra = _TRUE; ++ ++ rtw_vht_nss_to_mcsmap(target_rxss, vht_mcs_map, psta->vhtpriv.vht_mcs_map); ++ _rtw_memcpy(psta->vhtpriv.vht_mcs_map, vht_mcs_map, 2); ++ ++ rtw_hal_update_sta_rate_mask(padapter, psta); ++ } ++ ++ if (update_ra) ++ rtw_dm_ra_mask_wk_cmd(padapter, (u8 *)psta); ++} ++ ++u32 rtw_build_vht_operation_ie(_adapter *padapter, u8 *pbuf, u8 channel) ++{ ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++ /* struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; */ ++ u8 ChnlWidth, center_freq, bw_mode, rf_type = 0; ++ u32 len = 0; ++ u8 operation[5]; ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ _rtw_memset(operation, 0, 5); ++ ++ bw_mode = REGSTY_BW_5G(pregistrypriv); /* TODO: control op bw with other info */ ++ ++ if (hal_chk_bw_cap(padapter, BW_CAP_80M | BW_CAP_160M) ++ && REGSTY_BW_5G(pregistrypriv) >= CHANNEL_WIDTH_80 ++ ) { ++ center_freq = rtw_get_center_ch(channel, bw_mode, HAL_PRIME_CHNL_OFFSET_LOWER); ++ ChnlWidth = 1; ++ } else { ++ center_freq = 0; ++ ChnlWidth = 0; ++ } ++ ++ ++ SET_VHT_OPERATION_ELE_CHL_WIDTH(operation, ChnlWidth); ++ /* center frequency */ ++ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(operation, center_freq);/* Todo: need to set correct center channel */ ++ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(operation, 0); ++ ++ if (padapter->registrypriv.rf_config != RF_MAX_TYPE) ++ rf_type = padapter->registrypriv.rf_config; ++ ++ switch (rf_type) { ++ case RF_1T1R: ++ operation[3] = 0xfe; ++ operation[4] = 0xff; ++ break; ++ case RF_1T2R: ++ case RF_2T2R: ++ case RF_2T2R_GREEN: ++ operation[3] = 0xfa; ++ operation[4] = 0xff; ++ break; ++ case RF_2T3R: ++ case RF_2T4R: ++ case RF_3T3R: ++ case RF_3T4R: ++ operation[3] = 0xea; ++ operation[4] = 0xff; ++ break; ++ case RF_4T4R: ++ operation[3] = 0xaa; ++ operation[4] = 0xff; ++ break; ++ default: ++ RTW_INFO("%s, %d, unknown rf type\n", __func__, __LINE__); ++ } ++ ++ rtw_set_ie(pbuf, EID_VHTOperation, 5, operation, &len); ++ ++ return len; ++} ++ ++u32 rtw_build_vht_op_mode_notify_ie(_adapter *padapter, u8 *pbuf, u8 bw) ++{ ++ /* struct registry_priv *pregistrypriv = &padapter->registrypriv; */ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++ u32 len = 0; ++ u8 opmode = 0, rf_type = 0; ++ u8 chnl_width, rx_nss; ++ ++ chnl_width = bw; ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ if (rf_type == RF_3T3R) ++ rx_nss = 3; ++ else if (rf_type == RF_2T2R) ++ rx_nss = 2; ++ else ++ rx_nss = 1; ++ ++ SET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(&opmode, chnl_width); ++ SET_VHT_OPERATING_MODE_FIELD_RX_NSS(&opmode, (rx_nss - 1)); ++ SET_VHT_OPERATING_MODE_FIELD_RX_NSS_TYPE(&opmode, 0); /* Todo */ ++ ++ pvhtpriv->vht_op_mode_notify = opmode; ++ ++ pbuf = rtw_set_ie(pbuf, EID_OpModeNotification, 1, &opmode, &len); ++ ++ return len; ++} ++ ++u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf) ++{ ++ u8 bw, rf_type, rf_num, rx_stbc_nss = 0; ++ u16 HighestRate; ++ u8 *pcap, *pcap_mcs; ++ u32 len = 0; ++ u32 rx_packet_offset, max_recvbuf_sz; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++ ++ pcap = pvhtpriv->vht_cap; ++ _rtw_memset(pcap, 0, 32); ++ ++ /* B0 B1 Maximum MPDU Length */ ++ rtw_hal_get_def_var(padapter, HAL_DEF_RX_PACKET_OFFSET, &rx_packet_offset); ++ rtw_hal_get_def_var(padapter, HAL_DEF_MAX_RECVBUF_SZ, &max_recvbuf_sz); ++ ++ RTW_DBG("%s, line%d, Available RX buf size = %d bytes\n.", __FUNCTION__, __LINE__, max_recvbuf_sz - rx_packet_offset); ++ ++ if ((max_recvbuf_sz - rx_packet_offset) >= 11454) { ++ SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(pcap, 2); ++ RTW_INFO("%s, line%d, Set MAX MPDU len = 11454 bytes\n.", __FUNCTION__, __LINE__); ++ } else if ((max_recvbuf_sz - rx_packet_offset) >= 7991) { ++ SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(pcap, 1); ++ RTW_INFO("%s, line%d, Set MAX MPDU len = 7991 bytes\n.", __FUNCTION__, __LINE__); ++ } else if ((max_recvbuf_sz - rx_packet_offset) >= 3895) { ++ SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(pcap, 0); ++ RTW_INFO("%s, line%d, Set MAX MPDU len = 3895 bytes\n.", __FUNCTION__, __LINE__); ++ } else ++ RTW_ERR("%s, line%d, Error!! Available RX buf size < 3895 bytes\n.", __FUNCTION__, __LINE__); ++ ++ /* B2 B3 Supported Channel Width Set */ ++ if (hal_chk_bw_cap(padapter, BW_CAP_160M) && REGSTY_IS_BW_5G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_160)) { ++ if (hal_chk_bw_cap(padapter, BW_CAP_80_80M) && REGSTY_IS_BW_5G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_80_80)) ++ SET_VHT_CAPABILITY_ELE_CHL_WIDTH(pcap, 2); ++ else ++ SET_VHT_CAPABILITY_ELE_CHL_WIDTH(pcap, 1); ++ } else ++ SET_VHT_CAPABILITY_ELE_CHL_WIDTH(pcap, 0); ++ ++ /* B4 Rx LDPC */ ++ if (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_RX)) ++ SET_VHT_CAPABILITY_ELE_RX_LDPC(pcap, 1); ++ ++ /* B5 ShortGI for 80MHz */ ++ SET_VHT_CAPABILITY_ELE_SHORT_GI80M(pcap, pvhtpriv->sgi_80m ? 1 : 0); /* We can receive Short GI of 80M */ ++ ++ /* B6 ShortGI for 160MHz */ ++ /* SET_VHT_CAPABILITY_ELE_SHORT_GI160M(pcap, pvhtpriv->sgi_80m? 1 : 0); */ ++ ++ /* B7 Tx STBC */ ++ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX)) ++ SET_VHT_CAPABILITY_ELE_TX_STBC(pcap, 1); ++ ++ /* B8 B9 B10 Rx STBC */ ++ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_RX)) { ++ rtw_hal_get_def_var(padapter, HAL_DEF_RX_STBC, (u8 *)(&rx_stbc_nss)); ++ ++ SET_VHT_CAPABILITY_ELE_RX_STBC(pcap, rx_stbc_nss); ++ } ++ ++ /* B11 SU Beamformer Capable */ ++ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { ++ SET_VHT_CAPABILITY_ELE_SU_BFER(pcap, 1); ++ /* B16 17 18 Number of Sounding Dimensions */ ++ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMER_CAP, (u8 *)&rf_num); ++ SET_VHT_CAPABILITY_ELE_SOUNDING_DIMENSIONS(pcap, rf_num); ++ /* B19 MU Beamformer Capable */ ++ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) ++ SET_VHT_CAPABILITY_ELE_MU_BFER(pcap, 1); ++ } ++ ++ /* B12 SU Beamformee Capable */ ++ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) { ++ SET_VHT_CAPABILITY_ELE_SU_BFEE(pcap, 1); ++ /* B13 14 15 Compressed Steering Number of Beamformer Antennas Supported */ ++ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); ++ SET_VHT_CAPABILITY_ELE_BFER_ANT_SUPP(pcap, rf_num); ++ /* B20 SU Beamformee Capable */ ++ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) ++ SET_VHT_CAPABILITY_ELE_MU_BFEE(pcap, 1); ++ } ++ ++ /* B21 VHT TXOP PS */ ++ SET_VHT_CAPABILITY_ELE_TXOP_PS(pcap, 0); ++ /* B22 +HTC-VHT Capable */ ++ SET_VHT_CAPABILITY_ELE_HTC_VHT(pcap, 1); ++ /* B23 24 25 Maximum A-MPDU Length Exponent */ ++ if (pregistrypriv->ampdu_factor != 0xFE) ++ SET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pcap, pregistrypriv->ampdu_factor); ++ else ++ SET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pcap, 7); ++ /* B26 27 VHT Link Adaptation Capable */ ++ SET_VHT_CAPABILITY_ELE_LINK_ADAPTION(pcap, 0); ++ ++ pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pcap); ++ _rtw_memcpy(pcap_mcs, pvhtpriv->vht_mcs_map, 2); ++ ++ pcap_mcs = GET_VHT_CAPABILITY_ELE_TX_MCS(pcap); ++ _rtw_memcpy(pcap_mcs, pvhtpriv->vht_mcs_map, 2); ++ ++ /* find the largest bw supported by both registry and hal */ ++ bw = hal_largest_bw(padapter, REGSTY_BW_5G(pregistrypriv)); ++ ++ HighestRate = VHT_MCS_DATA_RATE[bw][pvhtpriv->sgi_80m][((pvhtpriv->vht_highest_rate - MGN_VHT1SS_MCS0) & 0x3f)]; ++ HighestRate = (HighestRate + 1) >> 1; ++ ++ SET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(pcap, HighestRate); /* indicate we support highest rx rate is 600Mbps. */ ++ SET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(pcap, HighestRate); /* indicate we support highest tx rate is 600Mbps. */ ++ ++ pbuf = rtw_set_ie(pbuf, EID_VHTCapability, 12, pcap, &len); ++ ++ return len; ++} ++ ++u32 rtw_restructure_vht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len) ++{ ++ u32 ielen = 0, out_len = 0; ++ u8 cap_len = 0, notify_len = 0, notify_bw = 0, operation_bw = 0, supported_chnl_width = 0; ++ u8 *p, *pframe; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++ ++ rtw_vht_use_default_setting(padapter); ++ ++ p = rtw_get_ie(in_ie + 12, EID_VHTCapability, &ielen, in_len - 12); ++ if (p && ielen > 0) { ++ supported_chnl_width = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p + 2); ++ ++ /* VHT Capabilities element */ ++ cap_len = rtw_build_vht_cap_ie(padapter, out_ie + *pout_len); ++ *pout_len += cap_len; ++ ++ /* Get HT BW */ ++ p = rtw_get_ie(in_ie + 12, _HT_EXTRA_INFO_IE_, &ielen, in_len - 12); ++ if (p && ielen > 0) { ++ struct HT_info_element *pht_info = (struct HT_info_element *)(p + 2); ++ if (pht_info->infos[0] & BIT(2)) ++ operation_bw = CHANNEL_WIDTH_40; ++ else ++ operation_bw = CHANNEL_WIDTH_20; ++ } ++ ++ /* VHT Operation element */ ++ p = rtw_get_ie(in_ie + 12, EID_VHTOperation, &ielen, in_len - 12); ++ if (p && ielen > 0) { ++ out_len = *pout_len; ++ if (GET_VHT_OPERATION_ELE_CHL_WIDTH(p + 2) >= 1) { ++ if (supported_chnl_width == 2) ++ operation_bw = CHANNEL_WIDTH_80_80; ++ else if (supported_chnl_width == 1) ++ operation_bw = CHANNEL_WIDTH_160; ++ else ++ operation_bw = CHANNEL_WIDTH_80; ++ } ++ pframe = rtw_set_ie(out_ie + out_len, EID_VHTOperation, ielen, p + 2 , pout_len); ++ } ++ ++ /* find the largest bw supported by both registry and hal */ ++ notify_bw = hal_largest_bw(padapter, REGSTY_BW_5G(pregistrypriv)); ++ ++ if (notify_bw > operation_bw) ++ notify_bw = operation_bw; ++ ++ /* Operating Mode Notification element */ ++ notify_len = rtw_build_vht_op_mode_notify_ie(padapter, out_ie + *pout_len, notify_bw); ++ *pout_len += notify_len; ++ ++ pvhtpriv->vht_option = _TRUE; ++ } ++ ++ return pvhtpriv->vht_option; ++ ++} ++ ++void VHTOnAssocRsp(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 ht_AMPDU_len; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ if (!pmlmeinfo->HT_enable) ++ return; ++ ++ if (!pmlmeinfo->VHT_enable) ++ return; ++ ++ ht_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; ++ ++ if (pvhtpriv->ampdu_len > ht_AMPDU_len) ++ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&pvhtpriv->ampdu_len)); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MAX_TIME, (u8 *)(&pvhtpriv->vht_highest_rate)); ++} ++ ++#endif /* CONFIG_80211AC_VHT */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_wapi.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_wapi.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_wapi.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_wapi.c 2018-02-11 21:44:27.142146010 +0200 +@@ -0,0 +1,1240 @@ ++#ifdef CONFIG_WAPI_SUPPORT ++ ++#include ++#include ++#include ++#include ++ ++ ++u32 wapi_debug_component = ++ /* WAPI_INIT | ++ * WAPI_API | ++ * WAPI_TX | ++ * WAPI_RX | */ ++ WAPI_ERR ; /* always open err flags on */ ++ ++void WapiFreeAllStaInfo(_adapter *padapter) ++{ ++ PRT_WAPI_T pWapiInfo; ++ PRT_WAPI_STA_INFO pWapiStaInfo; ++ PRT_WAPI_BKID pWapiBkid; ++ ++ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); ++ pWapiInfo = &padapter->wapiInfo; ++ ++ /* Pust to Idle List */ ++ rtw_wapi_return_all_sta_info(padapter); ++ ++ /* Sta Info List */ ++ while (!list_empty(&(pWapiInfo->wapiSTAIdleList))) { ++ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAIdleList.next, RT_WAPI_STA_INFO, list); ++ list_del_init(&pWapiStaInfo->list); ++ } ++ ++ /* BKID List */ ++ while (!list_empty(&(pWapiInfo->wapiBKIDIdleList))) { ++ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDIdleList.next, RT_WAPI_BKID, list); ++ list_del_init(&pWapiBkid->list); ++ } ++ WAPI_TRACE(WAPI_INIT, "<=========== %s\n", __FUNCTION__); ++ return; ++} ++ ++void WapiSetIE(_adapter *padapter) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ /* PRT_WAPI_BKID pWapiBkid; */ ++ u16 protocolVer = 1; ++ u16 akmCnt = 1; ++ u16 suiteCnt = 1; ++ u16 capability = 0; ++ u8 OUI[3]; ++ ++ OUI[0] = 0x00; ++ OUI[1] = 0x14; ++ OUI[2] = 0x72; ++ ++ pWapiInfo->wapiIELength = 0; ++ /* protocol version */ ++ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, &protocolVer, 2); ++ pWapiInfo->wapiIELength += 2; ++ /* akm */ ++ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, &akmCnt, 2); ++ pWapiInfo->wapiIELength += 2; ++ ++ if (pWapiInfo->bWapiPSK) { ++ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, OUI, 3); ++ pWapiInfo->wapiIELength += 3; ++ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x2; ++ pWapiInfo->wapiIELength += 1; ++ } else { ++ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, OUI, 3); ++ pWapiInfo->wapiIELength += 3; ++ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; ++ pWapiInfo->wapiIELength += 1; ++ } ++ ++ /* usk */ ++ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, &suiteCnt, 2); ++ pWapiInfo->wapiIELength += 2; ++ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, OUI, 3); ++ pWapiInfo->wapiIELength += 3; ++ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; ++ pWapiInfo->wapiIELength += 1; ++ ++ /* msk */ ++ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, OUI, 3); ++ pWapiInfo->wapiIELength += 3; ++ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; ++ pWapiInfo->wapiIELength += 1; ++ ++ /* Capbility */ ++ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, &capability, 2); ++ pWapiInfo->wapiIELength += 2; ++} ++ ++ ++/* PN1 > PN2, return 1, ++ * else return 0. ++ */ ++u32 WapiComparePN(u8 *PN1, u8 *PN2) ++{ ++ char i; ++ ++ if ((NULL == PN1) || (NULL == PN2)) ++ return 1; ++ ++ /* overflow case */ ++ if ((PN2[15] - PN1[15]) & 0x80) ++ return 1; ++ ++ for (i = 16; i > 0; i--) { ++ if (PN1[i - 1] == PN2[i - 1]) ++ continue; ++ else if (PN1[i - 1] > PN2[i - 1]) ++ return 1; ++ else ++ return 0; ++ } ++ ++ return 0; ++} ++ ++u8 ++WapiGetEntryForCamWrite(_adapter *padapter, u8 *pMacAddr, u8 KID, BOOLEAN IsMsk) ++{ ++ PRT_WAPI_T pWapiInfo = NULL; ++ /* PRT_WAPI_CAM_ENTRY pEntry=NULL; */ ++ u8 i = 0; ++ u8 ret = 0xff; ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ pWapiInfo = &padapter->wapiInfo; ++ ++ /* exist? */ ++ for (i = 0; i < WAPI_CAM_ENTRY_NUM; i++) { ++ if (pWapiInfo->wapiCamEntry[i].IsUsed ++ && (_rtw_memcmp(pMacAddr, pWapiInfo->wapiCamEntry[i].PeerMacAddr, ETH_ALEN) == _TRUE) ++ && pWapiInfo->wapiCamEntry[i].keyidx == KID ++ && pWapiInfo->wapiCamEntry[i].type == IsMsk) { ++ ret = pWapiInfo->wapiCamEntry[i].entry_idx; /* cover it */ ++ break; ++ } ++ } ++ ++ if (i == WAPI_CAM_ENTRY_NUM) { /* not found */ ++ for (i = 0; i < WAPI_CAM_ENTRY_NUM; i++) { ++ if (pWapiInfo->wapiCamEntry[i].IsUsed == 0) { ++ pWapiInfo->wapiCamEntry[i].IsUsed = 1; ++ pWapiInfo->wapiCamEntry[i].type = IsMsk; ++ pWapiInfo->wapiCamEntry[i].keyidx = KID; ++ _rtw_memcpy(pWapiInfo->wapiCamEntry[i].PeerMacAddr, pMacAddr, ETH_ALEN); ++ ret = pWapiInfo->wapiCamEntry[i].entry_idx; ++ break; ++ } ++ } ++ } ++ ++ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); ++ return ret; ++ ++ /* ++ if(RTIsListEmpty(&pWapiInfo->wapiCamIdleList)) { ++ return 0; ++ } ++ ++ pEntry = (PRT_WAPI_CAM_ENTRY)RTRemoveHeadList(&pWapiInfo->wapiCamIdleList); ++ RTInsertTailList(&pWapiInfo->wapiCamUsedList, &pEntry->list); ++ ++ ++ return pEntry->entry_idx;*/ ++} ++ ++u8 WapiGetEntryForCamClear(_adapter *padapter, u8 *pPeerMac, u8 keyid, u8 IsMsk) ++{ ++ PRT_WAPI_T pWapiInfo = NULL; ++ u8 i = 0; ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ pWapiInfo = &padapter->wapiInfo; ++ ++ for (i = 0; i < WAPI_CAM_ENTRY_NUM; i++) { ++ if (pWapiInfo->wapiCamEntry[i].IsUsed ++ && (_rtw_memcmp(pPeerMac, pWapiInfo->wapiCamEntry[i].PeerMacAddr, ETH_ALEN) == _TRUE) ++ && pWapiInfo->wapiCamEntry[i].keyidx == keyid ++ && pWapiInfo->wapiCamEntry[i].type == IsMsk) { ++ pWapiInfo->wapiCamEntry[i].IsUsed = 0; ++ pWapiInfo->wapiCamEntry[i].keyidx = 2; ++ _rtw_memset(pWapiInfo->wapiCamEntry[i].PeerMacAddr, 0, ETH_ALEN); ++ ++ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); ++ return pWapiInfo->wapiCamEntry[i].entry_idx; ++ } ++ } ++ ++ WAPI_TRACE(WAPI_API, "<====WapiGetReturnCamEntry(), No this cam entry.\n"); ++ return 0xff; ++ /* ++ if(RTIsListEmpty(&pWapiInfo->wapiCamUsedList)) { ++ return FALSE; ++ } ++ ++ pList = &pWapiInfo->wapiCamUsedList; ++ while(pList->Flink != &pWapiInfo->wapiCamUsedList) ++ { ++ pEntry = (PRT_WAPI_CAM_ENTRY)pList->Flink; ++ if(PlatformCompareMemory(pPeerMac,pEntry->PeerMacAddr, ETHER_ADDRLEN)== 0 ++ && keyid == pEntry->keyidx) ++ { ++ RTRemoveEntryList(pList); ++ RTInsertHeadList(&pWapiInfo->wapiCamIdleList, pList); ++ return pEntry->entry_idx; ++ } ++ pList = pList->Flink; ++ } ++ ++ return 0; ++ */ ++} ++ ++void ++WapiResetAllCamEntry(_adapter *padapter) ++{ ++ PRT_WAPI_T pWapiInfo; ++ int i; ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ pWapiInfo = &padapter->wapiInfo; ++ ++ for (i = 0; i < WAPI_CAM_ENTRY_NUM; i++) { ++ _rtw_memset(pWapiInfo->wapiCamEntry[i].PeerMacAddr, 0, ETH_ALEN); ++ pWapiInfo->wapiCamEntry[i].IsUsed = 0; ++ pWapiInfo->wapiCamEntry[i].keyidx = 2; /* invalid */ ++ pWapiInfo->wapiCamEntry[i].entry_idx = 4 + i * 2; ++ } ++ ++ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); ++ ++ return; ++} ++ ++u8 WapiWriteOneCamEntry( ++ _adapter *padapter, ++ u8 *pMacAddr, ++ u8 KeyId, ++ u8 EntryId, ++ u8 EncAlg, ++ u8 bGroupKey, ++ u8 *pKey ++) ++{ ++ u8 retVal = 0; ++ u16 usConfig = 0; ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ if (EntryId >= 32) { ++ WAPI_TRACE(WAPI_ERR, "<=== CamAddOneEntry(): ulKeyId exceed!\n"); ++ return retVal; ++ } ++ ++ usConfig = usConfig | (0x01 << 15) | ((u16)(EncAlg) << 2) | (KeyId); ++ ++ if (EncAlg == _SMS4_) { ++ if (bGroupKey == 1) ++ usConfig |= (0x01 << 6); ++ if ((EntryId % 2) == 1) /* ==0 sec key; == 1mic key */ ++ usConfig |= (0x01 << 5); ++ } ++ ++ write_cam(padapter, EntryId, usConfig, pMacAddr, pKey); ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ return 1; ++} ++ ++void rtw_wapi_init(_adapter *padapter) ++{ ++ PRT_WAPI_T pWapiInfo; ++ int i; ++ ++ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); ++ RT_ASSERT_RET(padapter); ++ ++ if (!padapter->WapiSupport) { ++ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); ++ return; ++ } ++ ++ pWapiInfo = &padapter->wapiInfo; ++ pWapiInfo->bWapiEnable = false; ++ ++ /* Init BKID List */ ++ INIT_LIST_HEAD(&pWapiInfo->wapiBKIDIdleList); ++ INIT_LIST_HEAD(&pWapiInfo->wapiBKIDStoreList); ++ for (i = 0; i < WAPI_MAX_BKID_NUM; i++) ++ list_add_tail(&pWapiInfo->wapiBKID[i].list, &pWapiInfo->wapiBKIDIdleList); ++ ++ /* Init STA List */ ++ INIT_LIST_HEAD(&pWapiInfo->wapiSTAIdleList); ++ INIT_LIST_HEAD(&pWapiInfo->wapiSTAUsedList); ++ for (i = 0; i < WAPI_MAX_STAINFO_NUM; i++) ++ list_add_tail(&pWapiInfo->wapiSta[i].list, &pWapiInfo->wapiSTAIdleList); ++ ++ for (i = 0; i < WAPI_CAM_ENTRY_NUM; i++) { ++ pWapiInfo->wapiCamEntry[i].IsUsed = 0; ++ pWapiInfo->wapiCamEntry[i].keyidx = 2; /* invalid */ ++ pWapiInfo->wapiCamEntry[i].entry_idx = 4 + i * 2; ++ } ++ ++ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_wapi_free(_adapter *padapter) ++{ ++ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); ++ RT_ASSERT_RET(padapter); ++ ++ if (!padapter->WapiSupport) { ++ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); ++ return; ++ } ++ ++ WapiFreeAllStaInfo(padapter); ++ ++ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_wapi_disable_tx(_adapter *padapter) ++{ ++ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); ++ RT_ASSERT_RET(padapter); ++ ++ if (!padapter->WapiSupport) { ++ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); ++ return; ++ } ++ ++ padapter->wapiInfo.wapiTxMsk.bTxEnable = false; ++ padapter->wapiInfo.wapiTxMsk.bSet = false; ++ ++ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); ++} ++ ++u8 rtw_wapi_is_wai_packet(_adapter *padapter, u8 *pkt_data) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ u8 WaiPkt = 0, *pTaddr, bFind = false; ++ u8 Offset_TypeWAI = 0 ; /* (mac header len + llc length) */ ++ ++ WAPI_TRACE(WAPI_TX | WAPI_RX, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return 0; ++ } ++ ++ Offset_TypeWAI = 24 + 6 ; ++ ++ /* YJ,add,091103. Data frame may also have skb->data[30]=0x88 and skb->data[31]=0xb4. */ ++ if ((pkt_data[1] & 0x40) != 0) { ++ /* RTW_INFO("data is privacy\n"); */ ++ return 0; ++ } ++ ++ pTaddr = GetAddr2Ptr(pkt_data); ++ if (list_empty(&pWapiInfo->wapiSTAUsedList)) ++ bFind = false; ++ else { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if (_rtw_memcmp(pTaddr, pWapiSta->PeerMacAddr, 6) == _TRUE) { ++ bFind = true; ++ break; ++ } ++ } ++ } ++ ++ WAPI_TRACE(WAPI_TX | WAPI_RX, "%s: bFind=%d pTaddr="MAC_FMT"\n", __FUNCTION__, bFind, MAC_ARG(pTaddr)); ++ ++ if (pkt_data[0] == WIFI_QOS_DATA_TYPE) ++ Offset_TypeWAI += 2; ++ ++ /* 88b4? */ ++ if ((pkt_data[Offset_TypeWAI] == 0x88) && (pkt_data[Offset_TypeWAI + 1] == 0xb4)) { ++ WaiPkt = pkt_data[Offset_TypeWAI + 5]; ++ ++ psecuritypriv->hw_decrypted = _TRUE; ++ } else ++ WAPI_TRACE(WAPI_TX | WAPI_RX, "%s(): non wai packet\n", __FUNCTION__); ++ ++ WAPI_TRACE(WAPI_TX | WAPI_RX, "%s(): Recvd WAI frame. IsWAIPkt(%d)\n", __FUNCTION__, WaiPkt); ++ ++ return WaiPkt; ++} ++ ++ ++void rtw_wapi_update_info(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ struct recv_frame_hdr *precv_hdr; ++ u8 *ptr; ++ u8 *pTA; ++ u8 *pRecvPN; ++ ++ ++ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { ++ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ precv_hdr = &precv_frame->u.hdr; ++ ptr = precv_hdr->rx_data; ++ ++ if (precv_hdr->attrib.qos == 1) ++ precv_hdr->UserPriority = GetTid(ptr); ++ else ++ precv_hdr->UserPriority = 0; ++ ++ pTA = GetAddr2Ptr(ptr); ++ _rtw_memcpy((u8 *)precv_hdr->WapiSrcAddr, pTA, 6); ++ pRecvPN = ptr + precv_hdr->attrib.hdrlen + 2; ++ _rtw_memcpy((u8 *)precv_hdr->WapiTempPN, pRecvPN, 16); ++ ++ WAPI_TRACE(WAPI_RX, "<========== %s\n", __FUNCTION__); ++} ++ ++/**************************************************************************** ++TRUE-----------------Drop ++FALSE---------------- handle ++add to support WAPI to N-mode ++*****************************************************************************/ ++u8 rtw_wapi_check_for_drop( ++ _adapter *padapter, ++ union recv_frame *precv_frame ++) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ u8 *pLastRecvPN = NULL; ++ u8 bFind = false; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ u8 bDrop = false; ++ struct recv_frame_hdr *precv_hdr = &precv_frame->u.hdr; ++ u8 WapiAEPNInitialValueSrc[16] = {0x37, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; ++ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ int i; ++ ++ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { ++ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return false; ++ } ++ ++ if (precv_hdr->bIsWaiPacket != 0) { ++ if (precv_hdr->bIsWaiPacket == 0x8) { ++ ++ RTW_INFO("rtw_wapi_check_for_drop: dump packet\n"); ++ for (i = 0; i < 50; i++) { ++ RTW_INFO("%02X ", ptr[i]); ++ if ((i + 1) % 8 == 0) ++ RTW_INFO("\n"); ++ } ++ RTW_INFO("\n rtw_wapi_check_for_drop: dump packet\n"); ++ ++ for (i = 0; i < 16; i++) { ++ if (ptr[i + 27] != 0) ++ break; ++ } ++ ++ if (i == 16) { ++ WAPI_TRACE(WAPI_RX, "rtw_wapi_check_for_drop: drop with zero BKID\n"); ++ return true; ++ } else ++ return false; ++ } else ++ return false; ++ } ++ ++ if (list_empty(&pWapiInfo->wapiSTAUsedList)) ++ bFind = false; ++ else { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if (_rtw_memcmp(precv_hdr->WapiSrcAddr, pWapiSta->PeerMacAddr, ETH_ALEN) == _TRUE) { ++ bFind = true; ++ break; ++ } ++ } ++ } ++ WAPI_TRACE(WAPI_RX, "%s: bFind=%d prxb->WapiSrcAddr="MAC_FMT"\n", __FUNCTION__, bFind, MAC_ARG(precv_hdr->WapiSrcAddr)); ++ ++ if (bFind) { ++ if (IS_MCAST(precv_hdr->attrib.ra)) { ++ WAPI_TRACE(WAPI_RX, "rtw_wapi_check_for_drop: multicast case\n"); ++ pLastRecvPN = pWapiSta->lastRxMulticastPN; ++ } else { ++ WAPI_TRACE(WAPI_RX, "rtw_wapi_check_for_drop: unicast case\n"); ++ switch (precv_hdr->UserPriority) { ++ case 0: ++ case 3: ++ pLastRecvPN = pWapiSta->lastRxUnicastPNBEQueue; ++ break; ++ case 1: ++ case 2: ++ pLastRecvPN = pWapiSta->lastRxUnicastPNBKQueue; ++ break; ++ case 4: ++ case 5: ++ pLastRecvPN = pWapiSta->lastRxUnicastPNVIQueue; ++ break; ++ case 6: ++ case 7: ++ pLastRecvPN = pWapiSta->lastRxUnicastPNVOQueue; ++ break; ++ default: ++ WAPI_TRACE(WAPI_ERR, "%s: Unknown TID\n", __FUNCTION__); ++ break; ++ } ++ } ++ ++ if (!WapiComparePN(precv_hdr->WapiTempPN, pLastRecvPN)) { ++ WAPI_TRACE(WAPI_RX, "%s: Equal PN!!\n", __FUNCTION__); ++ if (IS_MCAST(precv_hdr->attrib.ra)) ++ _rtw_memcpy(pLastRecvPN, WapiAEMultiCastPNInitialValueSrc, 16); ++ else ++ _rtw_memcpy(pLastRecvPN, WapiAEPNInitialValueSrc, 16); ++ bDrop = true; ++ } else ++ _rtw_memcpy(pLastRecvPN, precv_hdr->WapiTempPN, 16); ++ } ++ ++ WAPI_TRACE(WAPI_RX, "<========== %s\n", __FUNCTION__); ++ return bDrop; ++} ++ ++void rtw_build_probe_resp_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ u8 WapiIELength = 0; ++ ++ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); ++ return; ++ } ++ ++ WapiSetIE(padapter); ++ WapiIELength = pWapiInfo->wapiIELength; ++ pframe[0] = _WAPI_IE_; ++ pframe[1] = WapiIELength; ++ _rtw_memcpy(pframe + 2, pWapiInfo->wapiIE, WapiIELength); ++ pframe += WapiIELength + 2; ++ pattrib->pktlen += WapiIELength + 2; ++ ++ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_build_beacon_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ u8 WapiIELength = 0; ++ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); ++ return; ++ } ++ ++ WapiSetIE(padapter); ++ WapiIELength = pWapiInfo->wapiIELength; ++ pframe[0] = _WAPI_IE_; ++ pframe[1] = WapiIELength; ++ _rtw_memcpy(pframe + 2, pWapiInfo->wapiIE, WapiIELength); ++ pframe += WapiIELength + 2; ++ pattrib->pktlen += WapiIELength + 2; ++ ++ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_build_assoc_req_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) ++{ ++ PRT_WAPI_BKID pWapiBKID; ++ u16 bkidNum; ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ u8 WapiIELength = 0; ++ ++ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); ++ return; ++ } ++ ++ WapiSetIE(padapter); ++ WapiIELength = pWapiInfo->wapiIELength; ++ bkidNum = 0; ++ if (!list_empty(&(pWapiInfo->wapiBKIDStoreList))) { ++ list_for_each_entry(pWapiBKID, &pWapiInfo->wapiBKIDStoreList, list) { ++ bkidNum++; ++ _rtw_memcpy(pWapiInfo->wapiIE + WapiIELength + 2, pWapiBKID->bkid, 16); ++ WapiIELength += 16; ++ } ++ } ++ _rtw_memcpy(pWapiInfo->wapiIE + WapiIELength, &bkidNum, 2); ++ WapiIELength += 2; ++ ++ pframe[0] = _WAPI_IE_; ++ pframe[1] = WapiIELength; ++ _rtw_memcpy(pframe + 2, pWapiInfo->wapiIE, WapiIELength); ++ pframe += WapiIELength + 2; ++ pattrib->pktlen += WapiIELength + 2; ++ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_wapi_on_assoc_ok(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ PRT_WAPI_STA_INFO pWapiSta; ++ u8 WapiAEPNInitialValueSrc[16] = {0x37, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; ++ /* u8 WapiASUEPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; */ ++ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; ++ ++ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ pWapiSta = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAIdleList.next, RT_WAPI_STA_INFO, list); ++ list_del_init(&pWapiSta->list); ++ list_add_tail(&pWapiSta->list, &pWapiInfo->wapiSTAUsedList); ++ _rtw_memcpy(pWapiSta->PeerMacAddr, padapter->mlmeextpriv.mlmext_info.network.MacAddress, 6); ++ _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPN, WapiAEPNInitialValueSrc, 16); ++ ++ /* For chenk PN error with Qos Data after s3: add by ylb 20111114 */ ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue, WapiAEPNInitialValueSrc, 16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue, WapiAEPNInitialValueSrc, 16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue, WapiAEPNInitialValueSrc, 16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue, WapiAEPNInitialValueSrc, 16); ++ ++ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); ++} ++ ++ ++void rtw_wapi_return_one_sta_info(_adapter *padapter, u8 *MacAddr) ++{ ++ PRT_WAPI_T pWapiInfo; ++ PRT_WAPI_STA_INFO pWapiStaInfo = NULL; ++ PRT_WAPI_BKID pWapiBkid = NULL; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ pWapiInfo = &padapter->wapiInfo; ++ ++ WAPI_TRACE(WAPI_API, "==========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { ++ while (!list_empty(&(pWapiInfo->wapiBKIDStoreList))) { ++ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDStoreList.next, RT_WAPI_BKID, list); ++ list_del_init(&pWapiBkid->list); ++ _rtw_memset(pWapiBkid->bkid, 0, 16); ++ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDIdleList); ++ } ++ } ++ ++ ++ WAPI_TRACE(WAPI_API, " %s: after clear bkid\n", __FUNCTION__); ++ ++ ++ /* Remove STA info */ ++ if (list_empty(&(pWapiInfo->wapiSTAUsedList))) { ++ WAPI_TRACE(WAPI_API, " %s: wapiSTAUsedList is null\n", __FUNCTION__); ++ return; ++ } else { ++ ++ WAPI_TRACE(WAPI_API, " %s: wapiSTAUsedList is not null\n", __FUNCTION__); ++#if 0 ++ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry((pWapiInfo->wapiSTAUsedList.next), RT_WAPI_STA_INFO, list); ++ ++ list_for_each_entry(pWapiStaInfo, &(pWapiInfo->wapiSTAUsedList), list) { ++ ++ RTW_INFO("MAC Addr %02x-%02x-%02x-%02x-%02x-%02x\n", MacAddr[0], MacAddr[1], MacAddr[2], MacAddr[3], MacAddr[4], MacAddr[5]); ++ ++ ++ RTW_INFO("peer Addr %02x-%02x-%02x-%02x-%02x-%02x\n", pWapiStaInfo->PeerMacAddr[0], pWapiStaInfo->PeerMacAddr[1], pWapiStaInfo->PeerMacAddr[2], pWapiStaInfo->PeerMacAddr[3], ++ pWapiStaInfo->PeerMacAddr[4], pWapiStaInfo->PeerMacAddr[5]); ++ ++ if (pWapiStaInfo == NULL) { ++ WAPI_TRACE(WAPI_API, " %s: pWapiStaInfo == NULL Case\n", __FUNCTION__); ++ return; ++ } ++ ++ if (pWapiStaInfo->PeerMacAddr == NULL) { ++ WAPI_TRACE(WAPI_API, " %s: pWapiStaInfo->PeerMacAddr == NULL Case\n", __FUNCTION__); ++ return; ++ } ++ ++ if (MacAddr == NULL) { ++ WAPI_TRACE(WAPI_API, " %s: MacAddr == NULL Case\n", __FUNCTION__); ++ return; ++ } ++ ++ if (_rtw_memcmp(pWapiStaInfo->PeerMacAddr, MacAddr, ETH_ALEN) == _TRUE) { ++ pWapiStaInfo->bAuthenticateInProgress = false; ++ pWapiStaInfo->bSetkeyOk = false; ++ _rtw_memset(pWapiStaInfo->PeerMacAddr, 0, ETH_ALEN); ++ list_del_init(&pWapiStaInfo->list); ++ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); ++ break; ++ } ++ ++ } ++#endif ++ ++ while (!list_empty(&(pWapiInfo->wapiSTAUsedList))) { ++ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAUsedList.next, RT_WAPI_STA_INFO, list); ++ ++ RTW_INFO("peer Addr %02x-%02x-%02x-%02x-%02x-%02x\n", pWapiStaInfo->PeerMacAddr[0], pWapiStaInfo->PeerMacAddr[1], pWapiStaInfo->PeerMacAddr[2], pWapiStaInfo->PeerMacAddr[3], ++ pWapiStaInfo->PeerMacAddr[4], pWapiStaInfo->PeerMacAddr[5]); ++ ++ list_del_init(&pWapiStaInfo->list); ++ memset(pWapiStaInfo->PeerMacAddr, 0, ETH_ALEN); ++ pWapiStaInfo->bSetkeyOk = 0; ++ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); ++ } ++ ++ } ++ ++ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); ++ return; ++} ++ ++void rtw_wapi_return_all_sta_info(_adapter *padapter) ++{ ++ PRT_WAPI_T pWapiInfo; ++ PRT_WAPI_STA_INFO pWapiStaInfo; ++ PRT_WAPI_BKID pWapiBkid; ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ pWapiInfo = &padapter->wapiInfo; ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ /* Sta Info List */ ++ while (!list_empty(&(pWapiInfo->wapiSTAUsedList))) { ++ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAUsedList.next, RT_WAPI_STA_INFO, list); ++ list_del_init(&pWapiStaInfo->list); ++ memset(pWapiStaInfo->PeerMacAddr, 0, ETH_ALEN); ++ pWapiStaInfo->bSetkeyOk = 0; ++ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); ++ } ++ ++ /* BKID List */ ++ while (!list_empty(&(pWapiInfo->wapiBKIDStoreList))) { ++ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDStoreList.next, RT_WAPI_BKID, list); ++ list_del_init(&pWapiBkid->list); ++ memset(pWapiBkid->bkid, 0, 16); ++ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDIdleList); ++ } ++ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_wapi_clear_cam_entry(_adapter *padapter, u8 *pMacAddr) ++{ ++ u8 UcIndex = 0; ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 0, 0); ++ if (UcIndex != 0xff) { ++ /* CAM_mark_invalid(Adapter, UcIndex); */ ++ CAM_empty_entry(padapter, UcIndex); ++ } ++ ++ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 1, 0); ++ if (UcIndex != 0xff) { ++ /* CAM_mark_invalid(Adapter, UcIndex); */ ++ CAM_empty_entry(padapter, UcIndex); ++ } ++ ++ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 0, 1); ++ if (UcIndex != 0xff) { ++ /* CAM_mark_invalid(Adapter, UcIndex); */ ++ CAM_empty_entry(padapter, UcIndex); ++ } ++ ++ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 1, 1); ++ if (UcIndex != 0xff) { ++ /* CAM_mark_invalid(padapter, UcIndex); */ ++ CAM_empty_entry(padapter, UcIndex); ++ } ++ ++ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_wapi_clear_all_cam_entry(_adapter *padapter) ++{ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ invalidate_cam_all(padapter); /* is this ok? */ ++ WapiResetAllCamEntry(padapter); ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++} ++ ++void rtw_wapi_set_key(_adapter *padapter, RT_WAPI_KEY *pWapiKey, RT_WAPI_STA_INFO *pWapiSta, u8 bGroupKey, u8 bUseDefaultKey) ++{ ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ u8 *pMacAddr = pWapiSta->PeerMacAddr; ++ u32 EntryId = 0; ++ BOOLEAN IsPairWise = false ; ++ u8 EncAlgo; ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) { ++ WAPI_TRACE(WAPI_API, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ EncAlgo = _SMS4_; ++ ++ /* For Tx bc/mc pkt,use defualt key entry */ ++ if (bUseDefaultKey) { ++ /* when WAPI update key, keyid will be 0 or 1 by turns. */ ++ if (pWapiKey->keyId == 0) ++ EntryId = 0; ++ else ++ EntryId = 2; ++ } else { ++ /* tx/rx unicast pkt, or rx broadcast, find the key entry by peer's MacAddr */ ++ EntryId = WapiGetEntryForCamWrite(padapter, pMacAddr, pWapiKey->keyId, bGroupKey); ++ } ++ ++ if (EntryId == 0xff) { ++ WAPI_TRACE(WAPI_API, "===>No entry for WAPI setkey! !!\n"); ++ return; ++ } ++ ++ /* EntryId is also used to diff Sec key and Mic key */ ++ /* Sec Key */ ++ WapiWriteOneCamEntry(padapter, ++ pMacAddr, ++ pWapiKey->keyId, /* keyid */ ++ EntryId, /* entry */ ++ EncAlgo, /* type */ ++ bGroupKey, /* pairwise or group key */ ++ pWapiKey->dataKey); ++ /* MIC key */ ++ WapiWriteOneCamEntry(padapter, ++ pMacAddr, ++ pWapiKey->keyId, /* keyid */ ++ EntryId + 1, /* entry */ ++ EncAlgo, /* type */ ++ bGroupKey, /* pairwise or group key */ ++ pWapiKey->micKey); ++ ++ WAPI_TRACE(WAPI_API, "Set Wapi Key :KeyId:%d,EntryId:%d,PairwiseKey:%d.\n", pWapiKey->keyId, EntryId, !bGroupKey); ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++} ++ ++#if 0 ++/* YJ,test,091013 */ ++void wapi_test_set_key(struct _adapter *padapter, u8 *buf) ++{ ++ /*Data: keyType(1) + bTxEnable(1) + bAuthenticator(1) + bUpdate(1) + PeerAddr(6) + DataKey(16) + MicKey(16) + KeyId(1)*/ ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ PRT_WAPI_BKID pWapiBkid; ++ PRT_WAPI_STA_INFO pWapiSta; ++ u8 data[43]; ++ bool bTxEnable; ++ bool bUpdate; ++ bool bAuthenticator; ++ u8 PeerAddr[6]; ++ u8 WapiAEPNInitialValueSrc[16] = {0x37, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; ++ u8 WapiASUEPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; ++ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; ++ ++ WAPI_TRACE(WAPI_INIT, "===========>%s\n", __FUNCTION__); ++ ++ if (!padapter->WapiSupport) ++ return; ++ ++ copy_from_user(data, buf, 43); ++ bTxEnable = data[1]; ++ bAuthenticator = data[2]; ++ bUpdate = data[3]; ++ memcpy(PeerAddr, data + 4, 6); ++ ++ if (data[0] == 0x3) { ++ if (!list_empty(&(pWapiInfo->wapiBKIDIdleList))) { ++ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDIdleList.next, RT_WAPI_BKID, list); ++ list_del_init(&pWapiBkid->list); ++ memcpy(pWapiBkid->bkid, data + 10, 16); ++ WAPI_DATA(WAPI_INIT, "SetKey - BKID", pWapiBkid->bkid, 16); ++ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDStoreList); ++ } ++ } else { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if (!memcmp(pWapiSta->PeerMacAddr, PeerAddr, 6)) { ++ pWapiSta->bAuthenticatorInUpdata = false; ++ switch (data[0]) { ++ case 1: /* usk */ ++ if (bAuthenticator) { /* authenticator */ ++ memcpy(pWapiSta->lastTxUnicastPN, WapiAEPNInitialValueSrc, 16); ++ if (!bUpdate) { /* first */ ++ WAPI_TRACE(WAPI_INIT, "AE fisrt set usk\n"); ++ pWapiSta->wapiUsk.bSet = true; ++ memcpy(pWapiSta->wapiUsk.dataKey, data + 10, 16); ++ memcpy(pWapiSta->wapiUsk.micKey, data + 26, 16); ++ pWapiSta->wapiUsk.keyId = *(data + 42); ++ pWapiSta->wapiUsk.bTxEnable = true; ++ WAPI_DATA(WAPI_INIT, "SetKey - AE USK Data Key", pWapiSta->wapiUsk.dataKey, 16); ++ WAPI_DATA(WAPI_INIT, "SetKey - AE USK Mic Key", pWapiSta->wapiUsk.micKey, 16); ++ } else { /* update */ ++ WAPI_TRACE(WAPI_INIT, "AE update usk\n"); ++ pWapiSta->wapiUskUpdate.bSet = true; ++ pWapiSta->bAuthenticatorInUpdata = true; ++ memcpy(pWapiSta->wapiUskUpdate.dataKey, data + 10, 16); ++ memcpy(pWapiSta->wapiUskUpdate.micKey, data + 26, 16); ++ memcpy(pWapiSta->lastRxUnicastPNBEQueue, WapiASUEPNInitialValueSrc, 16); ++ memcpy(pWapiSta->lastRxUnicastPNBKQueue, WapiASUEPNInitialValueSrc, 16); ++ memcpy(pWapiSta->lastRxUnicastPNVIQueue, WapiASUEPNInitialValueSrc, 16); ++ memcpy(pWapiSta->lastRxUnicastPNVOQueue, WapiASUEPNInitialValueSrc, 16); ++ memcpy(pWapiSta->lastRxUnicastPN, WapiASUEPNInitialValueSrc, 16); ++ pWapiSta->wapiUskUpdate.keyId = *(data + 42); ++ pWapiSta->wapiUskUpdate.bTxEnable = true; ++ } ++ } else { ++ if (!bUpdate) { ++ WAPI_TRACE(WAPI_INIT, "ASUE fisrt set usk\n"); ++ if (bTxEnable) { ++ pWapiSta->wapiUsk.bTxEnable = true; ++ memcpy(pWapiSta->lastTxUnicastPN, WapiASUEPNInitialValueSrc, 16); ++ } else { ++ pWapiSta->wapiUsk.bSet = true; ++ memcpy(pWapiSta->wapiUsk.dataKey, data + 10, 16); ++ memcpy(pWapiSta->wapiUsk.micKey, data + 26, 16); ++ pWapiSta->wapiUsk.keyId = *(data + 42); ++ pWapiSta->wapiUsk.bTxEnable = false; ++ } ++ } else { ++ WAPI_TRACE(WAPI_INIT, "ASUE update usk\n"); ++ if (bTxEnable) { ++ pWapiSta->wapiUskUpdate.bTxEnable = true; ++ if (pWapiSta->wapiUskUpdate.bSet) { ++ memcpy(pWapiSta->wapiUsk.dataKey, pWapiSta->wapiUskUpdate.dataKey, 16); ++ memcpy(pWapiSta->wapiUsk.micKey, pWapiSta->wapiUskUpdate.micKey, 16); ++ pWapiSta->wapiUsk.keyId = pWapiSta->wapiUskUpdate.keyId; ++ memcpy(pWapiSta->lastRxUnicastPNBEQueue, WapiASUEPNInitialValueSrc, 16); ++ memcpy(pWapiSta->lastRxUnicastPNBKQueue, WapiASUEPNInitialValueSrc, 16); ++ memcpy(pWapiSta->lastRxUnicastPNVIQueue, WapiASUEPNInitialValueSrc, 16); ++ memcpy(pWapiSta->lastRxUnicastPNVOQueue, WapiASUEPNInitialValueSrc, 16); ++ memcpy(pWapiSta->lastRxUnicastPN, WapiASUEPNInitialValueSrc, 16); ++ pWapiSta->wapiUskUpdate.bTxEnable = false; ++ pWapiSta->wapiUskUpdate.bSet = false; ++ } ++ memcpy(pWapiSta->lastTxUnicastPN, WapiASUEPNInitialValueSrc, 16); ++ } else { ++ pWapiSta->wapiUskUpdate.bSet = true; ++ memcpy(pWapiSta->wapiUskUpdate.dataKey, data + 10, 16); ++ memcpy(pWapiSta->wapiUskUpdate.micKey, data + 26, 16); ++ pWapiSta->wapiUskUpdate.keyId = *(data + 42); ++ pWapiSta->wapiUskUpdate.bTxEnable = false; ++ } ++ } ++ } ++ break; ++ case 2: /* msk */ ++ if (bAuthenticator) { /* authenticator */ ++ pWapiInfo->wapiTxMsk.bSet = true; ++ memcpy(pWapiInfo->wapiTxMsk.dataKey, data + 10, 16); ++ memcpy(pWapiInfo->wapiTxMsk.micKey, data + 26, 16); ++ pWapiInfo->wapiTxMsk.keyId = *(data + 42); ++ pWapiInfo->wapiTxMsk.bTxEnable = true; ++ memcpy(pWapiInfo->lastTxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); ++ ++ if (!bUpdate) { /* first */ ++ WAPI_TRACE(WAPI_INIT, "AE fisrt set msk\n"); ++ if (!pWapiSta->bSetkeyOk) ++ pWapiSta->bSetkeyOk = true; ++ pWapiInfo->bFirstAuthentiateInProgress = false; ++ } else /* update */ ++ WAPI_TRACE(WAPI_INIT, "AE update msk\n"); ++ ++ WAPI_DATA(WAPI_INIT, "SetKey - AE MSK Data Key", pWapiInfo->wapiTxMsk.dataKey, 16); ++ WAPI_DATA(WAPI_INIT, "SetKey - AE MSK Mic Key", pWapiInfo->wapiTxMsk.micKey, 16); ++ } else { ++ if (!bUpdate) { ++ WAPI_TRACE(WAPI_INIT, "ASUE fisrt set msk\n"); ++ pWapiSta->wapiMsk.bSet = true; ++ memcpy(pWapiSta->wapiMsk.dataKey, data + 10, 16); ++ memcpy(pWapiSta->wapiMsk.micKey, data + 26, 16); ++ pWapiSta->wapiMsk.keyId = *(data + 42); ++ pWapiSta->wapiMsk.bTxEnable = false; ++ if (!pWapiSta->bSetkeyOk) ++ pWapiSta->bSetkeyOk = true; ++ pWapiInfo->bFirstAuthentiateInProgress = false; ++ WAPI_DATA(WAPI_INIT, "SetKey - ASUE MSK Data Key", pWapiSta->wapiMsk.dataKey, 16); ++ WAPI_DATA(WAPI_INIT, "SetKey - ASUE MSK Mic Key", pWapiSta->wapiMsk.micKey, 16); ++ } else { ++ WAPI_TRACE(WAPI_INIT, "ASUE update msk\n"); ++ pWapiSta->wapiMskUpdate.bSet = true; ++ memcpy(pWapiSta->wapiMskUpdate.dataKey, data + 10, 16); ++ memcpy(pWapiSta->wapiMskUpdate.micKey, data + 26, 16); ++ pWapiSta->wapiMskUpdate.keyId = *(data + 42); ++ pWapiSta->wapiMskUpdate.bTxEnable = false; ++ } ++ } ++ break; ++ default: ++ WAPI_TRACE(WAPI_ERR, "Unknown Flag\n"); ++ break; ++ } ++ } ++ } ++ } ++ WAPI_TRACE(WAPI_INIT, "<===========%s\n", __FUNCTION__); ++} ++ ++ ++void wapi_test_init(struct _adapter *padapter) ++{ ++ u8 keybuf[100]; ++ u8 mac_addr[6] = {0x00, 0xe0, 0x4c, 0x72, 0x04, 0x70}; ++ u8 UskDataKey[16] = {0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f}; ++ u8 UskMicKey[16] = {0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x18, 0x19, 0x1a, 0x1b, 0x1c, 0x1d, 0x1e, 0x1f}; ++ u8 UskId = 0; ++ u8 MskDataKey[16] = {0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26, 0x27, 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d, 0x2e, 0x2f}; ++ u8 MskMicKey[16] = {0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x3a, 0x3b, 0x3c, 0x3d, 0x3e, 0x3f}; ++ u8 MskId = 0; ++ ++ WAPI_TRACE(WAPI_INIT, "===========>%s\n", __FUNCTION__); ++ ++ /* Enable Wapi */ ++ WAPI_TRACE(WAPI_INIT, "%s: Enable wapi!!!!\n", __FUNCTION__); ++ padapter->wapiInfo.bWapiEnable = true; ++ padapter->pairwise_key_type = KEY_TYPE_SMS4; ++ ieee->group_key_type = KEY_TYPE_SMS4; ++ padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN; ++ padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN; ++ ++ /* set usk */ ++ WAPI_TRACE(WAPI_INIT, "%s: Set USK!!!!\n", __FUNCTION__); ++ memset(keybuf, 0, 100); ++ keybuf[0] = 1; /* set usk */ ++ keybuf[1] = 1; /* enable tx */ ++ keybuf[2] = 1; /* AE */ ++ keybuf[3] = 0; /* not update */ ++ ++ memcpy(keybuf + 4, mac_addr, 6); ++ memcpy(keybuf + 10, UskDataKey, 16); ++ memcpy(keybuf + 26, UskMicKey, 16); ++ keybuf[42] = UskId; ++ wapi_test_set_key(padapter, keybuf); ++ ++ memset(keybuf, 0, 100); ++ keybuf[0] = 1; /* set usk */ ++ keybuf[1] = 1; /* enable tx */ ++ keybuf[2] = 0; /* AE */ ++ keybuf[3] = 0; /* not update */ ++ ++ memcpy(keybuf + 4, mac_addr, 6); ++ memcpy(keybuf + 10, UskDataKey, 16); ++ memcpy(keybuf + 26, UskMicKey, 16); ++ keybuf[42] = UskId; ++ wapi_test_set_key(padapter, keybuf); ++ ++ /* set msk */ ++ WAPI_TRACE(WAPI_INIT, "%s: Set MSK!!!!\n", __FUNCTION__); ++ memset(keybuf, 0, 100); ++ keybuf[0] = 2; /* set msk */ ++ keybuf[1] = 1; /* Enable TX */ ++ keybuf[2] = 1; /* AE */ ++ keybuf[3] = 0; /* not update */ ++ memcpy(keybuf + 4, mac_addr, 6); ++ memcpy(keybuf + 10, MskDataKey, 16); ++ memcpy(keybuf + 26, MskMicKey, 16); ++ keybuf[42] = MskId; ++ wapi_test_set_key(padapter, keybuf); ++ ++ memset(keybuf, 0, 100); ++ keybuf[0] = 2; /* set msk */ ++ keybuf[1] = 1; /* Enable TX */ ++ keybuf[2] = 0; /* AE */ ++ keybuf[3] = 0; /* not update */ ++ memcpy(keybuf + 4, mac_addr, 6); ++ memcpy(keybuf + 10, MskDataKey, 16); ++ memcpy(keybuf + 26, MskMicKey, 16); ++ keybuf[42] = MskId; ++ wapi_test_set_key(padapter, keybuf); ++ WAPI_TRACE(WAPI_INIT, "<===========%s\n", __FUNCTION__); ++} ++#endif ++ ++void rtw_wapi_get_iv(_adapter *padapter, u8 *pRA, u8 *IV) ++{ ++ PWLAN_HEADER_WAPI_EXTENSION pWapiExt = NULL; ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ bool bPNOverflow = false; ++ bool bFindMatchPeer = false; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ ++ pWapiExt = (PWLAN_HEADER_WAPI_EXTENSION)IV; ++ ++ WAPI_DATA(WAPI_RX, "wapi_get_iv: pra", pRA, 6); ++ ++ if (IS_MCAST(pRA)) { ++ if (!pWapiInfo->wapiTxMsk.bTxEnable) { ++ WAPI_TRACE(WAPI_ERR, "%s: bTxEnable = 0!!\n", __FUNCTION__); ++ return; ++ } ++ ++ if (pWapiInfo->wapiTxMsk.keyId <= 1) { ++ pWapiExt->KeyIdx = pWapiInfo->wapiTxMsk.keyId; ++ pWapiExt->Reserved = 0; ++ bPNOverflow = WapiIncreasePN(pWapiInfo->lastTxMulticastPN, 1); ++ memcpy(pWapiExt->PN, pWapiInfo->lastTxMulticastPN, 16); ++ } ++ } else { ++ if (list_empty(&pWapiInfo->wapiSTAUsedList)) { ++ WAPI_TRACE(WAPI_RX, "rtw_wapi_get_iv: list is empty\n"); ++ _rtw_memset(IV, 10, 18); ++ return; ++ } else { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ WAPI_DATA(WAPI_RX, "rtw_wapi_get_iv: peermacaddr ", pWapiSta->PeerMacAddr, 6); ++ if (_rtw_memcmp((u8 *)pWapiSta->PeerMacAddr, pRA, 6) == _TRUE) { ++ bFindMatchPeer = true; ++ break; ++ } ++ } ++ ++ WAPI_TRACE(WAPI_RX, "bFindMatchPeer: %d\n", bFindMatchPeer); ++ WAPI_DATA(WAPI_RX, "Addr", pRA, 6); ++ ++ if (bFindMatchPeer) { ++ if ((!pWapiSta->wapiUskUpdate.bTxEnable) && (!pWapiSta->wapiUsk.bTxEnable)) ++ return; ++ ++ if (pWapiSta->wapiUsk.keyId <= 1) { ++ if (pWapiSta->wapiUskUpdate.bTxEnable) ++ pWapiExt->KeyIdx = pWapiSta->wapiUskUpdate.keyId; ++ else ++ pWapiExt->KeyIdx = pWapiSta->wapiUsk.keyId; ++ ++ pWapiExt->Reserved = 0; ++ bPNOverflow = WapiIncreasePN(pWapiSta->lastTxUnicastPN, 2); ++ _rtw_memcpy(pWapiExt->PN, pWapiSta->lastTxUnicastPN, 16); ++ ++ } ++ } ++ } ++ ++ } ++ ++} ++ ++bool rtw_wapi_drop_for_key_absent(_adapter *padapter, u8 *pRA) ++{ ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ bool bFindMatchPeer = false; ++ bool bDrop = false; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++ WAPI_DATA(WAPI_RX, "rtw_wapi_drop_for_key_absent: ra ", pRA, 6); ++ ++ if (psecuritypriv->dot11PrivacyAlgrthm == _SMS4_) { ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) ++ return true; ++ ++ if (IS_MCAST(pRA)) { ++ if (!pWapiInfo->wapiTxMsk.bTxEnable) { ++ bDrop = true; ++ WAPI_TRACE(WAPI_RX, "rtw_wapi_drop_for_key_absent: multicast key is absent\n"); ++ return bDrop; ++ } ++ } else { ++ if (!list_empty(&pWapiInfo->wapiSTAUsedList)) { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ WAPI_DATA(WAPI_RX, "rtw_wapi_drop_for_key_absent: pWapiSta->PeerMacAddr ", pWapiSta->PeerMacAddr, 6); ++ if (_rtw_memcmp(pRA, pWapiSta->PeerMacAddr, 6) == _TRUE) { ++ bFindMatchPeer = true; ++ break; ++ } ++ } ++ if (bFindMatchPeer) { ++ if (!pWapiSta->wapiUsk.bTxEnable) { ++ bDrop = true; ++ WAPI_TRACE(WAPI_RX, "rtw_wapi_drop_for_key_absent: unicast key is absent\n"); ++ return bDrop; ++ } ++ } else { ++ bDrop = true; ++ WAPI_TRACE(WAPI_RX, "rtw_wapi_drop_for_key_absent: no peer find\n"); ++ return bDrop; ++ } ++ ++ } else { ++ bDrop = true; ++ WAPI_TRACE(WAPI_RX, "rtw_wapi_drop_for_key_absent: no sta exist\n"); ++ return bDrop; ++ } ++ } ++ } else ++ return bDrop; ++ ++ return bDrop; ++} ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_wapi_sms4.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_wapi_sms4.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_wapi_sms4.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_wapi_sms4.c 2018-02-11 21:44:27.142146010 +0200 +@@ -0,0 +1,908 @@ ++#ifdef CONFIG_WAPI_SUPPORT ++ ++#include ++#include ++#include ++#include ++ ++ ++#ifdef CONFIG_WAPI_SW_SMS4 ++ ++#define WAPI_LITTLE_ENDIAN ++/* #define BIG_ENDIAN */ ++#define ENCRYPT 0 ++#define DECRYPT 1 ++ ++ ++/********************************************************** ++ **********************************************************/ ++const u8 Sbox[256] = { ++ 0xd6, 0x90, 0xe9, 0xfe, 0xcc, 0xe1, 0x3d, 0xb7, 0x16, 0xb6, 0x14, 0xc2, 0x28, 0xfb, 0x2c, 0x05, ++ 0x2b, 0x67, 0x9a, 0x76, 0x2a, 0xbe, 0x04, 0xc3, 0xaa, 0x44, 0x13, 0x26, 0x49, 0x86, 0x06, 0x99, ++ 0x9c, 0x42, 0x50, 0xf4, 0x91, 0xef, 0x98, 0x7a, 0x33, 0x54, 0x0b, 0x43, 0xed, 0xcf, 0xac, 0x62, ++ 0xe4, 0xb3, 0x1c, 0xa9, 0xc9, 0x08, 0xe8, 0x95, 0x80, 0xdf, 0x94, 0xfa, 0x75, 0x8f, 0x3f, 0xa6, ++ 0x47, 0x07, 0xa7, 0xfc, 0xf3, 0x73, 0x17, 0xba, 0x83, 0x59, 0x3c, 0x19, 0xe6, 0x85, 0x4f, 0xa8, ++ 0x68, 0x6b, 0x81, 0xb2, 0x71, 0x64, 0xda, 0x8b, 0xf8, 0xeb, 0x0f, 0x4b, 0x70, 0x56, 0x9d, 0x35, ++ 0x1e, 0x24, 0x0e, 0x5e, 0x63, 0x58, 0xd1, 0xa2, 0x25, 0x22, 0x7c, 0x3b, 0x01, 0x21, 0x78, 0x87, ++ 0xd4, 0x00, 0x46, 0x57, 0x9f, 0xd3, 0x27, 0x52, 0x4c, 0x36, 0x02, 0xe7, 0xa0, 0xc4, 0xc8, 0x9e, ++ 0xea, 0xbf, 0x8a, 0xd2, 0x40, 0xc7, 0x38, 0xb5, 0xa3, 0xf7, 0xf2, 0xce, 0xf9, 0x61, 0x15, 0xa1, ++ 0xe0, 0xae, 0x5d, 0xa4, 0x9b, 0x34, 0x1a, 0x55, 0xad, 0x93, 0x32, 0x30, 0xf5, 0x8c, 0xb1, 0xe3, ++ 0x1d, 0xf6, 0xe2, 0x2e, 0x82, 0x66, 0xca, 0x60, 0xc0, 0x29, 0x23, 0xab, 0x0d, 0x53, 0x4e, 0x6f, ++ 0xd5, 0xdb, 0x37, 0x45, 0xde, 0xfd, 0x8e, 0x2f, 0x03, 0xff, 0x6a, 0x72, 0x6d, 0x6c, 0x5b, 0x51, ++ 0x8d, 0x1b, 0xaf, 0x92, 0xbb, 0xdd, 0xbc, 0x7f, 0x11, 0xd9, 0x5c, 0x41, 0x1f, 0x10, 0x5a, 0xd8, ++ 0x0a, 0xc1, 0x31, 0x88, 0xa5, 0xcd, 0x7b, 0xbd, 0x2d, 0x74, 0xd0, 0x12, 0xb8, 0xe5, 0xb4, 0xb0, ++ 0x89, 0x69, 0x97, 0x4a, 0x0c, 0x96, 0x77, 0x7e, 0x65, 0xb9, 0xf1, 0x09, 0xc5, 0x6e, 0xc6, 0x84, ++ 0x18, 0xf0, 0x7d, 0xec, 0x3a, 0xdc, 0x4d, 0x20, 0x79, 0xee, 0x5f, 0x3e, 0xd7, 0xcb, 0x39, 0x48 ++}; ++ ++const u32 CK[32] = { ++ 0x00070e15, 0x1c232a31, 0x383f464d, 0x545b6269, ++ 0x70777e85, 0x8c939aa1, 0xa8afb6bd, 0xc4cbd2d9, ++ 0xe0e7eef5, 0xfc030a11, 0x181f262d, 0x343b4249, ++ 0x50575e65, 0x6c737a81, 0x888f969d, 0xa4abb2b9, ++ 0xc0c7ced5, 0xdce3eaf1, 0xf8ff060d, 0x141b2229, ++ 0x30373e45, 0x4c535a61, 0x686f767d, 0x848b9299, ++ 0xa0a7aeb5, 0xbcc3cad1, 0xd8dfe6ed, 0xf4fb0209, ++ 0x10171e25, 0x2c333a41, 0x484f565d, 0x646b7279 ++}; ++ ++#define Rotl(_x, _y) (((_x) << (_y)) | ((_x) >> (32 - (_y)))) ++ ++#define ByteSub(_A) (Sbox[(_A) >> 24 & 0xFF] << 24 | \ ++ Sbox[(_A) >> 16 & 0xFF] << 16 | \ ++ Sbox[(_A) >> 8 & 0xFF] << 8 | \ ++ Sbox[(_A) & 0xFF]) ++ ++#define L1(_B) ((_B) ^ Rotl(_B, 2) ^ Rotl(_B, 10) ^ Rotl(_B, 18) ^ Rotl(_B, 24)) ++#define L2(_B) ((_B) ^ Rotl(_B, 13) ^ Rotl(_B, 23)) ++ ++static void ++xor_block(void *dst, void *src1, void *src2) ++/* 128-bit xor: *dst = *src1 xor *src2. Pointers must be 32-bit aligned */ ++{ ++ ((u32 *)dst)[0] = ((u32 *)src1)[0] ^ ((u32 *)src2)[0]; ++ ((u32 *)dst)[1] = ((u32 *)src1)[1] ^ ((u32 *)src2)[1]; ++ ((u32 *)dst)[2] = ((u32 *)src1)[2] ^ ((u32 *)src2)[2]; ++ ((u32 *)dst)[3] = ((u32 *)src1)[3] ^ ((u32 *)src2)[3]; ++} ++ ++ ++void SMS4Crypt(u8 *Input, u8 *Output, u32 *rk) ++{ ++ u32 r, mid, x0, x1, x2, x3, *p; ++ p = (u32 *)Input; ++ x0 = p[0]; ++ x1 = p[1]; ++ x2 = p[2]; ++ x3 = p[3]; ++#ifdef WAPI_LITTLE_ENDIAN ++ x0 = Rotl(x0, 16); ++ x0 = ((x0 & 0x00FF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); ++ x1 = Rotl(x1, 16); ++ x1 = ((x1 & 0x00FF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); ++ x2 = Rotl(x2, 16); ++ x2 = ((x2 & 0x00FF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); ++ x3 = Rotl(x3, 16); ++ x3 = ((x3 & 0x00FF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); ++#endif ++ for (r = 0; r < 32; r += 4) { ++ mid = x1 ^ x2 ^ x3 ^ rk[r + 0]; ++ mid = ByteSub(mid); ++ x0 ^= L1(mid); ++ mid = x2 ^ x3 ^ x0 ^ rk[r + 1]; ++ mid = ByteSub(mid); ++ x1 ^= L1(mid); ++ mid = x3 ^ x0 ^ x1 ^ rk[r + 2]; ++ mid = ByteSub(mid); ++ x2 ^= L1(mid); ++ mid = x0 ^ x1 ^ x2 ^ rk[r + 3]; ++ mid = ByteSub(mid); ++ x3 ^= L1(mid); ++ } ++#ifdef WAPI_LITTLE_ENDIAN ++ x0 = Rotl(x0, 16); ++ x0 = ((x0 & 0x00FF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); ++ x1 = Rotl(x1, 16); ++ x1 = ((x1 & 0x00FF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); ++ x2 = Rotl(x2, 16); ++ x2 = ((x2 & 0x00FF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); ++ x3 = Rotl(x3, 16); ++ x3 = ((x3 & 0x00FF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); ++#endif ++ p = (u32 *)Output; ++ p[0] = x3; ++ p[1] = x2; ++ p[2] = x1; ++ p[3] = x0; ++} ++ ++ ++ ++void SMS4KeyExt(u8 *Key, u32 *rk, u32 CryptFlag) ++{ ++ u32 r, mid, x0, x1, x2, x3, *p; ++ ++ p = (u32 *)Key; ++ x0 = p[0]; ++ x1 = p[1]; ++ x2 = p[2]; ++ x3 = p[3]; ++#ifdef WAPI_LITTLE_ENDIAN ++ x0 = Rotl(x0, 16); ++ x0 = ((x0 & 0xFF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); ++ x1 = Rotl(x1, 16); ++ x1 = ((x1 & 0xFF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); ++ x2 = Rotl(x2, 16); ++ x2 = ((x2 & 0xFF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); ++ x3 = Rotl(x3, 16); ++ x3 = ((x3 & 0xFF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); ++#endif ++ ++ x0 ^= 0xa3b1bac6; ++ x1 ^= 0x56aa3350; ++ x2 ^= 0x677d9197; ++ x3 ^= 0xb27022dc; ++ for (r = 0; r < 32; r += 4) { ++ mid = x1 ^ x2 ^ x3 ^ CK[r + 0]; ++ mid = ByteSub(mid); ++ rk[r + 0] = x0 ^= L2(mid); ++ mid = x2 ^ x3 ^ x0 ^ CK[r + 1]; ++ mid = ByteSub(mid); ++ rk[r + 1] = x1 ^= L2(mid); ++ mid = x3 ^ x0 ^ x1 ^ CK[r + 2]; ++ mid = ByteSub(mid); ++ rk[r + 2] = x2 ^= L2(mid); ++ mid = x0 ^ x1 ^ x2 ^ CK[r + 3]; ++ mid = ByteSub(mid); ++ rk[r + 3] = x3 ^= L2(mid); ++ } ++ if (CryptFlag == DECRYPT) { ++ for (r = 0; r < 16; r++) ++ mid = rk[r], rk[r] = rk[31 - r], rk[31 - r] = mid; ++ } ++} ++ ++ ++void WapiSMS4Cryption(u8 *Key, u8 *IV, u8 *Input, u16 InputLength, ++ u8 *Output, u16 *OutputLength, u32 CryptFlag) ++{ ++ u32 blockNum, i, j, rk[32]; ++ u16 remainder; ++ u8 blockIn[16], blockOut[16], tempIV[16], k; ++ ++ *OutputLength = 0; ++ remainder = InputLength & 0x0F; ++ blockNum = InputLength >> 4; ++ if (remainder != 0) ++ blockNum++; ++ else ++ remainder = 16; ++ ++ for (k = 0; k < 16; k++) ++ tempIV[k] = IV[15 - k]; ++ ++ memcpy(blockIn, tempIV, 16); ++ ++ SMS4KeyExt((u8 *)Key, rk, CryptFlag); ++ ++ for (i = 0; i < blockNum - 1; i++) { ++ SMS4Crypt((u8 *)blockIn, blockOut, rk); ++ xor_block(&Output[i * 16], &Input[i * 16], blockOut); ++ memcpy(blockIn, blockOut, 16); ++ } ++ ++ *OutputLength = i * 16; ++ ++ SMS4Crypt((u8 *)blockIn, blockOut, rk); ++ ++ for (j = 0; j < remainder; j++) ++ Output[i * 16 + j] = Input[i * 16 + j] ^ blockOut[j]; ++ *OutputLength += remainder; ++ ++} ++ ++void WapiSMS4Encryption(u8 *Key, u8 *IV, u8 *Input, u16 InputLength, ++ u8 *Output, u16 *OutputLength) ++{ ++ ++ WapiSMS4Cryption(Key, IV, Input, InputLength, Output, OutputLength, ENCRYPT); ++} ++ ++void WapiSMS4Decryption(u8 *Key, u8 *IV, u8 *Input, u16 InputLength, ++ u8 *Output, u16 *OutputLength) ++{ ++ /* OFB mode: is also ENCRYPT flag */ ++ WapiSMS4Cryption(Key, IV, Input, InputLength, Output, OutputLength, ENCRYPT); ++} ++ ++void WapiSMS4CalculateMic(u8 *Key, u8 *IV, u8 *Input1, u8 Input1Length, ++ u8 *Input2, u16 Input2Length, u8 *Output, u8 *OutputLength) ++{ ++ u32 blockNum, i, remainder, rk[32]; ++ u8 BlockIn[16], BlockOut[16], TempBlock[16], tempIV[16], k; ++ ++ *OutputLength = 0; ++ remainder = Input1Length & 0x0F; ++ blockNum = Input1Length >> 4; ++ ++ for (k = 0; k < 16; k++) ++ tempIV[k] = IV[15 - k]; ++ ++ memcpy(BlockIn, tempIV, 16); ++ ++ SMS4KeyExt((u8 *)Key, rk, ENCRYPT); ++ ++ SMS4Crypt((u8 *)BlockIn, BlockOut, rk); ++ ++ for (i = 0; i < blockNum; i++) { ++ xor_block(BlockIn, (Input1 + i * 16), BlockOut); ++ SMS4Crypt((u8 *)BlockIn, BlockOut, rk); ++ } ++ ++ if (remainder != 0) { ++ memset(TempBlock, 0, 16); ++ memcpy(TempBlock, (Input1 + blockNum * 16), remainder); ++ ++ xor_block(BlockIn, TempBlock, BlockOut); ++ SMS4Crypt((u8 *)BlockIn, BlockOut, rk); ++ } ++ ++ remainder = Input2Length & 0x0F; ++ blockNum = Input2Length >> 4; ++ ++ for (i = 0; i < blockNum; i++) { ++ xor_block(BlockIn, (Input2 + i * 16), BlockOut); ++ SMS4Crypt((u8 *)BlockIn, BlockOut, rk); ++ } ++ ++ if (remainder != 0) { ++ memset(TempBlock, 0, 16); ++ memcpy(TempBlock, (Input2 + blockNum * 16), remainder); ++ ++ xor_block(BlockIn, TempBlock, BlockOut); ++ SMS4Crypt((u8 *)BlockIn, BlockOut, rk); ++ } ++ ++ memcpy(Output, BlockOut, 16); ++ *OutputLength = 16; ++} ++ ++void SecCalculateMicSMS4( ++ u8 KeyIdx, ++ u8 *MicKey, ++ u8 *pHeader, ++ u8 *pData, ++ u16 DataLen, ++ u8 *MicBuffer ++) ++{ ++#if 0 ++ struct ieee80211_hdr_3addr_qos *header; ++ u8 TempBuf[34], TempLen = 32, MicLen, QosOffset, *IV; ++ u16 *pTemp, fc; ++ ++ WAPI_TRACE(WAPI_TX | WAPI_RX, "=========>%s\n", __FUNCTION__); ++ ++ header = (struct ieee80211_hdr_3addr_qos *)pHeader; ++ memset(TempBuf, 0, 34); ++ memcpy(TempBuf, pHeader, 2); /* FrameCtrl */ ++ pTemp = (u16 *)TempBuf; ++ *pTemp &= 0xc78f; /* bit4,5,6,11,12,13 */ ++ ++ memcpy((TempBuf + 2), (pHeader + 4), 12); /* Addr1, Addr2 */ ++ memcpy((TempBuf + 14), (pHeader + 22), 2); /* SeqCtrl */ ++ pTemp = (u16 *)(TempBuf + 14); ++ *pTemp &= 0x000f; ++ ++ memcpy((TempBuf + 16), (pHeader + 16), 6); /* Addr3 */ ++ ++ fc = le16_to_cpu(header->frame_ctl); ++ ++ ++ ++ if (GetFrDs((u16 *)&fc) && GetToDs((u16 *)&fc)) { ++ memcpy((TempBuf + 22), (pHeader + 24), 6); ++ QosOffset = 30; ++ } else { ++ memset((TempBuf + 22), 0, 6); ++ QosOffset = 24; ++ } ++ ++ if ((fc & 0x0088) == 0x0088) { ++ memcpy((TempBuf + 28), (pHeader + QosOffset), 2); ++ TempLen += 2; ++ /* IV = pHeader + QosOffset + 2 + SNAP_SIZE + sizeof(u16) + 2; */ ++ IV = pHeader + QosOffset + 2 + 2; ++ } else { ++ IV = pHeader + QosOffset + 2; ++ /* IV = pHeader + QosOffset + SNAP_SIZE + sizeof(u16) + 2; */ ++ } ++ ++ TempBuf[TempLen - 1] = (u8)(DataLen & 0xff); ++ TempBuf[TempLen - 2] = (u8)((DataLen & 0xff00) >> 8); ++ TempBuf[TempLen - 4] = KeyIdx; ++ ++ WAPI_DATA(WAPI_TX, "CalculateMic - KEY", MicKey, 16); ++ WAPI_DATA(WAPI_TX, "CalculateMic - IV", IV, 16); ++ WAPI_DATA(WAPI_TX, "CalculateMic - TempBuf", TempBuf, TempLen); ++ WAPI_DATA(WAPI_TX, "CalculateMic - pData", pData, DataLen); ++ ++ WapiSMS4CalculateMic(MicKey, IV, TempBuf, TempLen, ++ pData, DataLen, MicBuffer, &MicLen); ++ ++ if (MicLen != 16) ++ WAPI_TRACE(WAPI_ERR, "%s: MIC Length Error!!\n", __FUNCTION__); ++ ++ WAPI_TRACE(WAPI_TX | WAPI_RX, "<=========%s\n", __FUNCTION__); ++#endif ++} ++ ++/* AddCount: 1 or 2. ++ * If overflow, return 1, ++ * else return 0. ++ */ ++u8 WapiIncreasePN(u8 *PN, u8 AddCount) ++{ ++ u8 i; ++ ++ if (NULL == PN) ++ return 1; ++ /* YJ,test,091102 */ ++ /* ++ if(AddCount == 2){ ++ RTW_INFO("############################%s(): PN[0]=0x%x\n", __FUNCTION__, PN[0]); ++ if(PN[0] == 0x48){ ++ PN[0] += AddCount; ++ return 1; ++ }else{ ++ PN[0] += AddCount; ++ return 0; ++ } ++ } ++ */ ++ /* YJ,test,091102,end */ ++ ++ for (i = 0; i < 16; i++) { ++ if (PN[i] + AddCount <= 0xff) { ++ PN[i] += AddCount; ++ return 0; ++ } else { ++ PN[i] += AddCount; ++ AddCount = 1; ++ } ++ } ++ return 1; ++} ++ ++ ++void WapiGetLastRxUnicastPNForQoSData( ++ u8 UserPriority, ++ PRT_WAPI_STA_INFO pWapiStaInfo, ++ u8 *PNOut ++) ++{ ++ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); ++ switch (UserPriority) { ++ case 0: ++ case 3: ++ memcpy(PNOut, pWapiStaInfo->lastRxUnicastPNBEQueue, 16); ++ break; ++ case 1: ++ case 2: ++ memcpy(PNOut, pWapiStaInfo->lastRxUnicastPNBKQueue, 16); ++ break; ++ case 4: ++ case 5: ++ memcpy(PNOut, pWapiStaInfo->lastRxUnicastPNVIQueue, 16); ++ break; ++ case 6: ++ case 7: ++ memcpy(PNOut, pWapiStaInfo->lastRxUnicastPNVOQueue, 16); ++ break; ++ default: ++ WAPI_TRACE(WAPI_ERR, "%s: Unknown TID\n", __FUNCTION__); ++ break; ++ } ++ WAPI_TRACE(WAPI_RX, "<=========== %s\n", __FUNCTION__); ++} ++ ++ ++void WapiSetLastRxUnicastPNForQoSData( ++ u8 UserPriority, ++ u8 *PNIn, ++ PRT_WAPI_STA_INFO pWapiStaInfo ++) ++{ ++ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); ++ switch (UserPriority) { ++ case 0: ++ case 3: ++ memcpy(pWapiStaInfo->lastRxUnicastPNBEQueue, PNIn, 16); ++ break; ++ case 1: ++ case 2: ++ memcpy(pWapiStaInfo->lastRxUnicastPNBKQueue, PNIn, 16); ++ break; ++ case 4: ++ case 5: ++ memcpy(pWapiStaInfo->lastRxUnicastPNVIQueue, PNIn, 16); ++ break; ++ case 6: ++ case 7: ++ memcpy(pWapiStaInfo->lastRxUnicastPNVOQueue, PNIn, 16); ++ break; ++ default: ++ WAPI_TRACE(WAPI_ERR, "%s: Unknown TID\n", __FUNCTION__); ++ break; ++ } ++ WAPI_TRACE(WAPI_RX, "<=========== %s\n", __FUNCTION__); ++} ++ ++ ++/**************************************************************************** ++ FALSE not RX-Reorder ++ TRUE do RX Reorder ++add to support WAPI to N-mode ++*****************************************************************************/ ++u8 WapiCheckPnInSwDecrypt( ++ _adapter *padapter, ++ struct sk_buff *pskb ++) ++{ ++ u8 ret = false; ++ ++#if 0 ++ struct ieee80211_hdr_3addr_qos *header; ++ u16 fc; ++ u8 *pDaddr, *pTaddr, *pRaddr; ++ ++ header = (struct ieee80211_hdr_3addr_qos *)pskb->data; ++ pTaddr = header->addr2; ++ pRaddr = header->addr1; ++ fc = le16_to_cpu(header->frame_ctl); ++ ++ if (GetToDs(&fc)) ++ pDaddr = header->addr3; ++ else ++ pDaddr = header->addr1; ++ ++ if ((_rtw_memcmp(pRaddr, padapter->pnetdev->dev_addr, ETH_ALEN) == 0) ++ && !(pDaddr) ++ && (GetFrameType(&fc) == WIFI_QOS_DATA_TYPE)) ++ /* && ieee->pHTInfo->bCurrentHTSupport && */ ++ /* ieee->pHTInfo->bCurRxReorderEnable) */ ++ ret = false; ++ else ++ ret = true; ++#endif ++ WAPI_TRACE(WAPI_RX, "%s: return %d\n", __FUNCTION__, ret); ++ return ret; ++} ++ ++int SecSMS4HeaderFillIV(_adapter *padapter, u8 *pxmitframe) ++{ ++ struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; ++ u8 *frame = ((struct xmit_frame *)pxmitframe)->buf_addr + TXDESC_OFFSET; ++ u8 *pSecHeader = NULL, *pos = NULL, *pRA = NULL; ++ u8 bPNOverflow = false, bFindMatchPeer = false, hdr_len = 0; ++ PWLAN_HEADER_WAPI_EXTENSION pWapiExt = NULL; ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ int ret = 0; ++ ++ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); ++ ++ return ret; ++#if 0 ++ hdr_len = sMacHdrLng; ++ if (GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE) ++ hdr_len += 2; ++ /* hdr_len += SNAP_SIZE + sizeof(u16); */ ++ ++ pos = skb_push(pskb, padapter->wapiInfo.extra_prefix_len); ++ memmove(pos, pos + padapter->wapiInfo.extra_prefix_len, hdr_len); ++ ++ pSecHeader = pskb->data + hdr_len; ++ pWapiExt = (PWLAN_HEADER_WAPI_EXTENSION)pSecHeader; ++ pRA = pskb->data + 4; ++ ++ WAPI_DATA(WAPI_TX, "FillIV - Before Fill IV", pskb->data, pskb->len); ++ ++ /* Address 1 is always receiver's address */ ++ if (IS_MCAST(pRA)) { ++ if (!pWapiInfo->wapiTxMsk.bTxEnable) { ++ WAPI_TRACE(WAPI_ERR, "%s: bTxEnable = 0!!\n", __FUNCTION__); ++ return -2; ++ } ++ if (pWapiInfo->wapiTxMsk.keyId <= 1) { ++ pWapiExt->KeyIdx = pWapiInfo->wapiTxMsk.keyId; ++ pWapiExt->Reserved = 0; ++ bPNOverflow = WapiIncreasePN(pWapiInfo->lastTxMulticastPN, 1); ++ memcpy(pWapiExt->PN, pWapiInfo->lastTxMulticastPN, 16); ++ if (bPNOverflow) { ++ /* Update MSK Notification. */ ++ WAPI_TRACE(WAPI_ERR, "===============>%s():multicast PN overflow\n", __FUNCTION__); ++ rtw_wapi_app_event_handler(padapter, NULL, 0, pRA, false, false, true, 0, false); ++ } ++ } else { ++ WAPI_TRACE(WAPI_ERR, "%s: Invalid Wapi Multicast KeyIdx!!\n", __FUNCTION__); ++ ret = -3; ++ } ++ } else { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if (!memcmp(pWapiSta->PeerMacAddr, pRA, 6)) { ++ bFindMatchPeer = true; ++ break; ++ } ++ } ++ if (bFindMatchPeer) { ++ if ((!pWapiSta->wapiUskUpdate.bTxEnable) && (!pWapiSta->wapiUsk.bTxEnable)) { ++ WAPI_TRACE(WAPI_ERR, "%s: bTxEnable = 0!!\n", __FUNCTION__); ++ return -4; ++ } ++ if (pWapiSta->wapiUsk.keyId <= 1) { ++ if (pWapiSta->wapiUskUpdate.bTxEnable) ++ pWapiExt->KeyIdx = pWapiSta->wapiUskUpdate.keyId; ++ else ++ pWapiExt->KeyIdx = pWapiSta->wapiUsk.keyId; ++ ++ pWapiExt->Reserved = 0; ++ bPNOverflow = WapiIncreasePN(pWapiSta->lastTxUnicastPN, 2); ++ memcpy(pWapiExt->PN, pWapiSta->lastTxUnicastPN, 16); ++ if (bPNOverflow) { ++ /* Update USK Notification. */ ++ WAPI_TRACE(WAPI_ERR, "===============>%s():unicast PN overflow\n", __FUNCTION__); ++ rtw_wapi_app_event_handler(padapter, NULL, 0, pWapiSta->PeerMacAddr, false, true, false, 0, false); ++ } ++ } else { ++ WAPI_TRACE(WAPI_ERR, "%s: Invalid Wapi Unicast KeyIdx!!\n", __FUNCTION__); ++ ret = -5; ++ } ++ } else { ++ WAPI_TRACE(WAPI_ERR, "%s: Can not find Peer Sta "MAC_FMT"!!\n", __FUNCTION__, MAC_ARG(pRA)); ++ ret = -6; ++ } ++ } ++ ++ WAPI_DATA(WAPI_TX, "FillIV - After Fill IV", pskb->data, pskb->len); ++ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); ++ return ret; ++#endif ++} ++ ++/* WAPI SW Enc: must have done Coalesce! */ ++void SecSWSMS4Encryption( ++ _adapter *padapter, ++ u8 *pxmitframe ++) ++{ ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ u8 *pframe = ((struct xmit_frame *)pxmitframe)->buf_addr + TXDESC_SIZE; ++ struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; ++ ++ u8 *SecPtr = NULL, *pRA, *pMicKey = NULL, *pDataKey = NULL, *pIV = NULL; ++ u8 IVOffset, DataOffset, bFindMatchPeer = false, KeyIdx = 0, MicBuffer[16]; ++ u16 OutputLength; ++ ++ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); ++ ++ WAPI_TRACE(WAPI_TX, "hdrlen: %d\n", pattrib->hdrlen); ++ ++ return; ++ ++ DataOffset = pattrib->hdrlen + pattrib->iv_len; ++ ++ pRA = pframe + 4; ++ ++ ++ if (IS_MCAST(pRA)) { ++ KeyIdx = pWapiInfo->wapiTxMsk.keyId; ++ pIV = pWapiInfo->lastTxMulticastPN; ++ pMicKey = pWapiInfo->wapiTxMsk.micKey; ++ pDataKey = pWapiInfo->wapiTxMsk.dataKey; ++ } else { ++ if (!list_empty(&(pWapiInfo->wapiSTAUsedList))) { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if (0 == memcmp(pWapiSta->PeerMacAddr, pRA, 6)) { ++ bFindMatchPeer = true; ++ break; ++ } ++ } ++ ++ if (bFindMatchPeer) { ++ if (pWapiSta->wapiUskUpdate.bTxEnable) { ++ KeyIdx = pWapiSta->wapiUskUpdate.keyId; ++ WAPI_TRACE(WAPI_TX, "%s(): Use update USK!! KeyIdx=%d\n", __FUNCTION__, KeyIdx); ++ pIV = pWapiSta->lastTxUnicastPN; ++ pMicKey = pWapiSta->wapiUskUpdate.micKey; ++ pDataKey = pWapiSta->wapiUskUpdate.dataKey; ++ } else { ++ KeyIdx = pWapiSta->wapiUsk.keyId; ++ WAPI_TRACE(WAPI_TX, "%s(): Use USK!! KeyIdx=%d\n", __FUNCTION__, KeyIdx); ++ pIV = pWapiSta->lastTxUnicastPN; ++ pMicKey = pWapiSta->wapiUsk.micKey; ++ pDataKey = pWapiSta->wapiUsk.dataKey; ++ } ++ } else { ++ WAPI_TRACE(WAPI_ERR, "%s: Can not find Peer Sta!!\n", __FUNCTION__); ++ return; ++ } ++ } else { ++ WAPI_TRACE(WAPI_ERR, "%s: wapiSTAUsedList is empty!!\n", __FUNCTION__); ++ return; ++ } ++ } ++ ++ SecPtr = pframe; ++ SecCalculateMicSMS4(KeyIdx, pMicKey, SecPtr, (SecPtr + DataOffset), pattrib->pktlen, MicBuffer); ++ ++ WAPI_DATA(WAPI_TX, "Encryption - MIC", MicBuffer, padapter->wapiInfo.extra_postfix_len); ++ ++ memcpy(pframe + pattrib->hdrlen + pattrib->iv_len + pattrib->pktlen - pattrib->icv_len, ++ (u8 *)MicBuffer, ++ padapter->wapiInfo.extra_postfix_len ++ ); ++ ++ ++ WapiSMS4Encryption(pDataKey, pIV, (SecPtr + DataOffset), pattrib->pktlen + pattrib->icv_len, (SecPtr + DataOffset), &OutputLength); ++ ++ WAPI_DATA(WAPI_TX, "Encryption - After SMS4 encryption", pframe, pattrib->hdrlen + pattrib->iv_len + pattrib->pktlen); ++ ++ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); ++} ++ ++u8 SecSWSMS4Decryption( ++ _adapter *padapter, ++ u8 *precv_frame, ++ struct recv_priv *precv_priv ++) ++{ ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ struct recv_frame_hdr *precv_hdr; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ u8 IVOffset, DataOffset, bFindMatchPeer = false, bUseUpdatedKey = false; ++ u8 KeyIdx, MicBuffer[16], lastRxPNforQoS[16]; ++ u8 *pRA, *pTA, *pMicKey, *pDataKey, *pLastRxPN, *pRecvPN, *pSecData, *pRecvMic, *pos; ++ u8 TID = 0; ++ u16 OutputLength, DataLen; ++ u8 bQosData; ++ struct sk_buff *pskb; ++ ++ WAPI_TRACE(WAPI_RX, "=========>%s\n", __FUNCTION__); ++ ++ return 0; ++ ++ precv_hdr = &((union recv_frame *)precv_frame)->u.hdr; ++ pskb = (struct sk_buff *)(precv_hdr->rx_data); ++ precv_hdr->bWapiCheckPNInDecrypt = WapiCheckPnInSwDecrypt(padapter, pskb); ++ WAPI_TRACE(WAPI_RX, "=========>%s: check PN %d\n", __FUNCTION__, precv_hdr->bWapiCheckPNInDecrypt); ++ WAPI_DATA(WAPI_RX, "Decryption - Before decryption", pskb->data, pskb->len); ++ ++ IVOffset = sMacHdrLng; ++ bQosData = GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE; ++ if (bQosData) ++ IVOffset += 2; ++ ++ /* if(GetHTC()) */ ++ /* IVOffset += 4; */ ++ ++ /* IVOffset += SNAP_SIZE + sizeof(u16); */ ++ ++ DataOffset = IVOffset + padapter->wapiInfo.extra_prefix_len; ++ ++ pRA = pskb->data + 4; ++ pTA = pskb->data + 10; ++ KeyIdx = *(pskb->data + IVOffset); ++ pRecvPN = pskb->data + IVOffset + 2; ++ pSecData = pskb->data + DataOffset; ++ DataLen = pskb->len - DataOffset; ++ pRecvMic = pskb->data + pskb->len - padapter->wapiInfo.extra_postfix_len; ++ TID = GetTid(pskb->data); ++ ++ if (!list_empty(&(pWapiInfo->wapiSTAUsedList))) { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if (0 == memcmp(pWapiSta->PeerMacAddr, pTA, 6)) { ++ bFindMatchPeer = true; ++ break; ++ } ++ } ++ } ++ ++ if (!bFindMatchPeer) { ++ WAPI_TRACE(WAPI_ERR, "%s: Can not find Peer Sta "MAC_FMT" for Key Info!!!\n", __FUNCTION__, MAC_ARG(pTA)); ++ return false; ++ } ++ ++ if (IS_MCAST(pRA)) { ++ WAPI_TRACE(WAPI_RX, "%s: Multicast decryption !!!\n", __FUNCTION__); ++ if (pWapiSta->wapiMsk.keyId == KeyIdx && pWapiSta->wapiMsk.bSet) { ++ pLastRxPN = pWapiSta->lastRxMulticastPN; ++ if (!WapiComparePN(pRecvPN, pLastRxPN)) { ++ WAPI_TRACE(WAPI_ERR, "%s: MSK PN is not larger than last, Dropped!!!\n", __FUNCTION__); ++ WAPI_DATA(WAPI_ERR, "pRecvPN:", pRecvPN, 16); ++ WAPI_DATA(WAPI_ERR, "pLastRxPN:", pLastRxPN, 16); ++ return false; ++ } ++ ++ memcpy(pLastRxPN, pRecvPN, 16); ++ pMicKey = pWapiSta->wapiMsk.micKey; ++ pDataKey = pWapiSta->wapiMsk.dataKey; ++ } else if (pWapiSta->wapiMskUpdate.keyId == KeyIdx && pWapiSta->wapiMskUpdate.bSet) { ++ WAPI_TRACE(WAPI_RX, "%s: Use Updated MSK for Decryption !!!\n", __FUNCTION__); ++ bUseUpdatedKey = true; ++ memcpy(pWapiSta->lastRxMulticastPN, pRecvPN, 16); ++ pMicKey = pWapiSta->wapiMskUpdate.micKey; ++ pDataKey = pWapiSta->wapiMskUpdate.dataKey; ++ } else { ++ WAPI_TRACE(WAPI_ERR, "%s: Can not find MSK with matched KeyIdx(%d), Dropped !!!\n", __FUNCTION__, KeyIdx); ++ return false; ++ } ++ } else { ++ WAPI_TRACE(WAPI_RX, "%s: Unicast decryption !!!\n", __FUNCTION__); ++ if (pWapiSta->wapiUsk.keyId == KeyIdx && pWapiSta->wapiUsk.bSet) { ++ WAPI_TRACE(WAPI_RX, "%s: Use USK for Decryption!!!\n", __FUNCTION__); ++ if (precv_hdr->bWapiCheckPNInDecrypt) { ++ if (GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE) { ++ WapiGetLastRxUnicastPNForQoSData(TID, pWapiSta, lastRxPNforQoS); ++ pLastRxPN = lastRxPNforQoS; ++ } else ++ pLastRxPN = pWapiSta->lastRxUnicastPN; ++ if (!WapiComparePN(pRecvPN, pLastRxPN)) ++ return false; ++ if (bQosData) ++ WapiSetLastRxUnicastPNForQoSData(TID, pRecvPN, pWapiSta); ++ else ++ memcpy(pWapiSta->lastRxUnicastPN, pRecvPN, 16); ++ } else ++ memcpy(precv_hdr->WapiTempPN, pRecvPN, 16); ++ ++ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE)) { ++ if ((pRecvPN[0] & 0x1) == 0) { ++ WAPI_TRACE(WAPI_ERR, "%s: Rx USK PN is not odd when Infra STA mode, Dropped !!!\n", __FUNCTION__); ++ return false; ++ } ++ } ++ ++ pMicKey = pWapiSta->wapiUsk.micKey; ++ pDataKey = pWapiSta->wapiUsk.dataKey; ++ } else if (pWapiSta->wapiUskUpdate.keyId == KeyIdx && pWapiSta->wapiUskUpdate.bSet) { ++ WAPI_TRACE(WAPI_RX, "%s: Use Updated USK for Decryption!!!\n", __FUNCTION__); ++ if (pWapiSta->bAuthenticatorInUpdata) ++ bUseUpdatedKey = true; ++ else ++ bUseUpdatedKey = false; ++ ++ if (bQosData) ++ WapiSetLastRxUnicastPNForQoSData(TID, pRecvPN, pWapiSta); ++ else ++ memcpy(pWapiSta->lastRxUnicastPN, pRecvPN, 16); ++ pMicKey = pWapiSta->wapiUskUpdate.micKey; ++ pDataKey = pWapiSta->wapiUskUpdate.dataKey; ++ } else { ++ WAPI_TRACE(WAPI_ERR, "%s: No valid USK!!!KeyIdx=%d pWapiSta->wapiUsk.keyId=%d pWapiSta->wapiUskUpdate.keyId=%d\n", __FUNCTION__, KeyIdx, pWapiSta->wapiUsk.keyId, ++ pWapiSta->wapiUskUpdate.keyId); ++ /* dump_buf(pskb->data,pskb->len); */ ++ return false; ++ } ++ } ++ ++ WAPI_DATA(WAPI_RX, "Decryption - DataKey", pDataKey, 16); ++ WAPI_DATA(WAPI_RX, "Decryption - IV", pRecvPN, 16); ++ WapiSMS4Decryption(pDataKey, pRecvPN, pSecData, DataLen, pSecData, &OutputLength); ++ ++ if (OutputLength != DataLen) ++ WAPI_TRACE(WAPI_ERR, "%s: Output Length Error!!!!\n", __FUNCTION__); ++ ++ WAPI_DATA(WAPI_RX, "Decryption - After decryption", pskb->data, pskb->len); ++ ++ DataLen -= padapter->wapiInfo.extra_postfix_len; ++ ++ SecCalculateMicSMS4(KeyIdx, pMicKey, pskb->data, pSecData, DataLen, MicBuffer); ++ ++ WAPI_DATA(WAPI_RX, "Decryption - MIC received", pRecvMic, SMS4_MIC_LEN); ++ WAPI_DATA(WAPI_RX, "Decryption - MIC calculated", MicBuffer, SMS4_MIC_LEN); ++ ++ if (0 == memcmp(MicBuffer, pRecvMic, padapter->wapiInfo.extra_postfix_len)) { ++ WAPI_TRACE(WAPI_RX, "%s: Check MIC OK!!\n", __FUNCTION__); ++ if (bUseUpdatedKey) { ++ /* delete the old key */ ++ if (IS_MCAST(pRA)) { ++ WAPI_TRACE(WAPI_API, "%s(): AE use new update MSK!!\n", __FUNCTION__); ++ pWapiSta->wapiMsk.keyId = pWapiSta->wapiMskUpdate.keyId; ++ memcpy(pWapiSta->wapiMsk.dataKey, pWapiSta->wapiMskUpdate.dataKey, 16); ++ memcpy(pWapiSta->wapiMsk.micKey, pWapiSta->wapiMskUpdate.micKey, 16); ++ pWapiSta->wapiMskUpdate.bTxEnable = pWapiSta->wapiMskUpdate.bSet = false; ++ } else { ++ WAPI_TRACE(WAPI_API, "%s(): AE use new update USK!!\n", __FUNCTION__); ++ pWapiSta->wapiUsk.keyId = pWapiSta->wapiUskUpdate.keyId; ++ memcpy(pWapiSta->wapiUsk.dataKey, pWapiSta->wapiUskUpdate.dataKey, 16); ++ memcpy(pWapiSta->wapiUsk.micKey, pWapiSta->wapiUskUpdate.micKey, 16); ++ pWapiSta->wapiUskUpdate.bTxEnable = pWapiSta->wapiUskUpdate.bSet = false; ++ } ++ } ++ } else { ++ WAPI_TRACE(WAPI_ERR, "%s: Check MIC Error, Dropped !!!!\n", __FUNCTION__); ++ return false; ++ } ++ ++ pos = pskb->data; ++ memmove(pos + padapter->wapiInfo.extra_prefix_len, pos, IVOffset); ++ skb_pull(pskb, padapter->wapiInfo.extra_prefix_len); ++ ++ WAPI_TRACE(WAPI_RX, "<=========%s\n", __FUNCTION__); ++ ++ return true; ++} ++ ++u32 rtw_sms4_encrypt(_adapter *padapter, u8 *pxmitframe) ++{ ++ ++ u8 *pframe; ++ u32 res = _SUCCESS; ++ ++ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) { ++ WAPI_TRACE(WAPI_TX, "<========== %s, WAPI not supported or enabled!\n", __FUNCTION__); ++ return _FAIL; ++ } ++ ++ if (((struct xmit_frame *)pxmitframe)->buf_addr == NULL) ++ return _FAIL; ++ ++ pframe = ((struct xmit_frame *)pxmitframe)->buf_addr + TXDESC_OFFSET; ++ ++ SecSWSMS4Encryption(padapter, pxmitframe); ++ ++ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); ++ return res; ++} ++ ++u32 rtw_sms4_decrypt(_adapter *padapter, u8 *precvframe) ++{ ++ u8 *pframe; ++ u32 res = _SUCCESS; ++ ++ WAPI_TRACE(WAPI_RX, "=========>%s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) { ++ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or enabled!\n", __FUNCTION__); ++ return _FAIL; ++ } ++ ++ ++ /* drop packet when hw decrypt fail ++ * return tempraily */ ++ return _FAIL; ++ ++ /* pframe=(unsigned char *)((union recv_frame*)precvframe)->u.hdr.rx_data; */ ++ ++ if (false == SecSWSMS4Decryption(padapter, precvframe, &padapter->recvpriv)) { ++ WAPI_TRACE(WAPI_ERR, "%s():SMS4 decrypt frame error\n", __FUNCTION__); ++ return _FAIL; ++ } ++ ++ WAPI_TRACE(WAPI_RX, "<=========%s\n", __FUNCTION__); ++ return res; ++} ++ ++#else ++ ++u32 rtw_sms4_encrypt(_adapter *padapter, u8 *pxmitframe) ++{ ++ WAPI_TRACE(WAPI_TX, "=========>Dummy %s\n", __FUNCTION__); ++ WAPI_TRACE(WAPI_TX, "<=========Dummy %s\n", __FUNCTION__); ++ return _SUCCESS; ++} ++ ++u32 rtw_sms4_decrypt(_adapter *padapter, u8 *precvframe) ++{ ++ WAPI_TRACE(WAPI_RX, "=========>Dummy %s\n", __FUNCTION__); ++ WAPI_TRACE(WAPI_RX, "<=========Dummy %s\n", __FUNCTION__); ++ return _SUCCESS; ++} ++ ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_wlan_util.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_wlan_util.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_wlan_util.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_wlan_util.c 2018-02-11 21:44:27.142146010 +0200 +@@ -0,0 +1,4844 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_WLAN_UTIL_C_ ++ ++#include ++ ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++ #include ++ #define ETH_TYPE_OFFSET 12 ++ #define PROTOCOL_OFFSET 23 ++ #define IP_OFFSET 30 ++#endif ++ ++unsigned char ARTHEROS_OUI1[] = {0x00, 0x03, 0x7f}; ++unsigned char ARTHEROS_OUI2[] = {0x00, 0x13, 0x74}; ++ ++unsigned char BROADCOM_OUI1[] = {0x00, 0x10, 0x18}; ++unsigned char BROADCOM_OUI2[] = {0x00, 0x0a, 0xf7}; ++unsigned char BROADCOM_OUI3[] = {0x00, 0x05, 0xb5}; ++ ++ ++unsigned char CISCO_OUI[] = {0x00, 0x40, 0x96}; ++unsigned char MARVELL_OUI[] = {0x00, 0x50, 0x43}; ++unsigned char RALINK_OUI[] = {0x00, 0x0c, 0x43}; ++unsigned char REALTEK_OUI[] = {0x00, 0xe0, 0x4c}; ++unsigned char AIRGOCAP_OUI[] = {0x00, 0x0a, 0xf5}; ++ ++unsigned char REALTEK_96B_IE[] = {0x00, 0xe0, 0x4c, 0x02, 0x01, 0x20}; ++ ++extern unsigned char RTW_WPA_OUI[]; ++extern unsigned char WPA_TKIP_CIPHER[4]; ++extern unsigned char RSN_TKIP_CIPHER[4]; ++ ++#define R2T_PHY_DELAY (0) ++ ++/* #define WAIT_FOR_BCN_TO_MIN (3000) */ ++#define WAIT_FOR_BCN_TO_MIN (6000) ++#define WAIT_FOR_BCN_TO_MAX (20000) ++ ++#define DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS 1000 ++#define DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD 3 ++ ++static u8 rtw_basic_rate_cck[4] = { ++ IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK, ++ IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK ++}; ++ ++static u8 rtw_basic_rate_ofdm[3] = { ++ IEEE80211_OFDM_RATE_6MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_OFDM_RATE_12MB | IEEE80211_BASIC_RATE_MASK, ++ IEEE80211_OFDM_RATE_24MB | IEEE80211_BASIC_RATE_MASK ++}; ++ ++static u8 rtw_basic_rate_mix[7] = { ++ IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK, ++ IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK, ++ IEEE80211_OFDM_RATE_6MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_OFDM_RATE_12MB | IEEE80211_BASIC_RATE_MASK, ++ IEEE80211_OFDM_RATE_24MB | IEEE80211_BASIC_RATE_MASK ++}; ++ ++int new_bcn_max = 3; ++ ++int cckrates_included(unsigned char *rate, int ratelen) ++{ ++ int i; ++ ++ for (i = 0; i < ratelen; i++) { ++ if ((((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || ++ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22)) ++ return _TRUE; ++ } ++ ++ return _FALSE; ++ ++} ++ ++int cckratesonly_included(unsigned char *rate, int ratelen) ++{ ++ int i; ++ ++ for (i = 0; i < ratelen; i++) { ++ if ((((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && ++ (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22)) ++ return _FALSE; ++ } ++ ++ return _TRUE; ++} ++ ++#ifdef CONFIG_GET_RAID_BY_DRV ++s8 rtw_get_tx_nss(_adapter *adapter, struct sta_info *psta) ++{ ++ u8 rf_type = RF_1T1R, custom_rf_type, vht_mcs[2]; ++ s8 nss = 1; ++ ++ custom_rf_type = adapter->registrypriv.rf_config; ++ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ if (!psta) ++ return nss; ++ ++ /* rf_config is dependent on efuse or sw config */ ++ if (custom_rf_type != RF_MAX_TYPE) ++ rf_type = custom_rf_type; ++ ++#ifdef CONFIG_80211AC_VHT ++ if (psta->vhtpriv.vht_option) { ++ u8 vht_mcs[2]; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct vht_priv *pvhtpriv_ap = &pmlmepriv->vhtpriv; ++ ++ _rtw_memcpy(vht_mcs, psta->vhtpriv.vht_mcs_map, 2); ++ /* doesn't support 5~8 SS so far */ ++ vht_mcs[1] = 0xff; ++ switch (rf_type) { ++ case RF_1T1R: ++ case RF_1T2R: ++ vht_mcs[0] |= 0xfc; ++ break; ++ case RF_2T2R: ++ case RF_2T4R: ++ case RF_2T2R_GREEN: ++ case RF_2T3R: ++ vht_mcs[0] |= 0xf0; ++ break; ++ case RF_3T3R: ++ case RF_3T4R: ++ vht_mcs[0] |= 0xc0; ++ break; ++ default: ++ RTW_INFO("%s,%d, unknown rf type\n", __func__, __LINE__); ++ break; ++ } ++ nss = rtw_vht_mcsmap_to_nss(vht_mcs); ++ } else ++#endif /* CONFIG_80211AC_VHT */ ++ if (psta->htpriv.ht_option) { ++ u8 supp_mcs_set[4]; ++ ++ _rtw_memcpy(supp_mcs_set, psta->htpriv.ht_cap.supp_mcs_set, 4); ++ ++ switch (rf_type) { ++ case RF_1T1R: ++ case RF_1T2R: ++ supp_mcs_set[1] = supp_mcs_set[2] = supp_mcs_set[3] = 0; ++ break; ++ case RF_2T2R: ++ case RF_2T4R: ++ case RF_2T2R_GREEN: ++ case RF_2T3R: ++ supp_mcs_set[2] = supp_mcs_set[3] = 0; ++ break; ++ case RF_3T3R: ++ case RF_3T4R: ++ supp_mcs_set[3] = 0; ++ break; ++ default: ++ RTW_INFO("%s,%d, unknown rf type\n", __func__, __LINE__); ++ break; ++ } ++ nss = rtw_ht_mcsset_to_nss(supp_mcs_set); ++ } ++ ++ RTW_INFO("%s: %d SS, rf_type=%d\n", __func__, nss, rf_type); ++ return nss; ++} ++ ++u8 networktype_to_raid(_adapter *adapter, struct sta_info *psta) ++{ ++ unsigned char raid; ++ switch (psta->wireless_mode) { ++ case WIRELESS_11B: ++ raid = RATR_INX_WIRELESS_B; ++ break; ++ case WIRELESS_11A: ++ case WIRELESS_11G: ++ raid = RATR_INX_WIRELESS_G; ++ break; ++ case WIRELESS_11BG: ++ raid = RATR_INX_WIRELESS_GB; ++ break; ++ case WIRELESS_11_24N: ++ case WIRELESS_11_5N: ++ raid = RATR_INX_WIRELESS_N; ++ break; ++ case WIRELESS_11A_5N: ++ case WIRELESS_11G_24N: ++ raid = RATR_INX_WIRELESS_NG; ++ break; ++ case WIRELESS_11BG_24N: ++ raid = RATR_INX_WIRELESS_NGB; ++ break; ++ default: ++ raid = RATR_INX_WIRELESS_GB; ++ break; ++ ++ } ++ return raid; ++ ++} ++ ++u8 networktype_to_raid_ex(_adapter *adapter, struct sta_info *psta) ++{ ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ u8 raid = RATEID_IDX_BGN_40M_1SS, cur_rf_type, rf_type, custom_rf_type; ++ s8 tx_nss; ++ ++ tx_nss = rtw_get_tx_nss(adapter, psta); ++ ++ switch (psta->wireless_mode) { ++ case WIRELESS_11B: ++ raid = RATEID_IDX_B; ++ break; ++ case WIRELESS_11A: ++ case WIRELESS_11G: ++ raid = RATEID_IDX_G; ++ break; ++ case WIRELESS_11BG: ++ raid = RATEID_IDX_BG; ++ break; ++ case WIRELESS_11_24N: ++ case WIRELESS_11_5N: ++ case WIRELESS_11A_5N: ++ case WIRELESS_11G_24N: ++ if (tx_nss == 1) ++ raid = RATEID_IDX_GN_N1SS; ++ else if (tx_nss == 2) ++ raid = RATEID_IDX_GN_N2SS; ++ else if (tx_nss == 3) ++ raid = RATEID_IDX_BGN_3SS; ++ else ++ RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); ++ break; ++ case WIRELESS_11B_24N: ++ case WIRELESS_11BG_24N: ++ if (psta->bw_mode == CHANNEL_WIDTH_20) { ++ if (tx_nss == 1) ++ raid = RATEID_IDX_BGN_20M_1SS_BN; ++ else if (tx_nss == 2) ++ raid = RATEID_IDX_BGN_20M_2SS_BN; ++ else if (tx_nss == 3) ++ raid = RATEID_IDX_BGN_3SS; ++ else ++ RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); ++ } else { ++ if (tx_nss == 1) ++ raid = RATEID_IDX_BGN_40M_1SS; ++ else if (tx_nss == 2) ++ raid = RATEID_IDX_BGN_40M_2SS; ++ else if (tx_nss == 3) ++ raid = RATEID_IDX_BGN_3SS; ++ else ++ RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); ++ } ++ break; ++#ifdef CONFIG_80211AC_VHT ++ case WIRELESS_11_5AC: ++ if (tx_nss == 1) ++ raid = RATEID_IDX_VHT_1SS; ++ else if (tx_nss == 2) ++ raid = RATEID_IDX_VHT_2SS; ++ else if (tx_nss == 3) ++ raid = RATEID_IDX_VHT_3SS; ++ else ++ RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); ++ break; ++ case WIRELESS_11_24AC: ++ if (psta->bw_mode >= CHANNEL_WIDTH_80) { ++ if (tx_nss == 1) ++ raid = RATEID_IDX_VHT_1SS; ++ else if (tx_nss == 2) ++ raid = RATEID_IDX_VHT_2SS; ++ else if (tx_nss == 3) ++ raid = RATEID_IDX_VHT_3SS; ++ else ++ RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); ++ } else { ++ if (tx_nss == 1) ++ raid = RATEID_IDX_MIX1; ++ else if (tx_nss == 2) ++ raid = RATEID_IDX_MIX2; ++ else if (tx_nss == 3) ++ raid = RATEID_IDX_VHT_3SS; ++ else ++ RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); ++ } ++ break; ++#endif ++ default: ++ RTW_INFO("unexpected wireless mode!(psta->wireless_mode=%x)\n", psta->wireless_mode); ++ break; ++ ++ } ++ ++ /* RTW_INFO("psta->wireless_mode=%x, tx_nss=%d\n", psta->wireless_mode, tx_nss); */ ++ ++ return raid; ++ ++} ++#endif ++u8 judge_network_type(_adapter *padapter, unsigned char *rate, int ratelen) ++{ ++ u8 network_type = 0; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ ++ if (pmlmeext->cur_channel > 14) { ++ if (pmlmeinfo->VHT_enable) ++ network_type = WIRELESS_11AC; ++ else if (pmlmeinfo->HT_enable) ++ network_type = WIRELESS_11_5N; ++ ++ network_type |= WIRELESS_11A; ++ } else { ++ if (pmlmeinfo->HT_enable) ++ network_type = WIRELESS_11_24N; ++ ++ if ((cckratesonly_included(rate, ratelen)) == _TRUE) ++ network_type |= WIRELESS_11B; ++ else if ((cckrates_included(rate, ratelen)) == _TRUE) ++ network_type |= WIRELESS_11BG; ++ else ++ network_type |= WIRELESS_11G; ++ } ++ ++ return network_type; ++} ++ ++unsigned char ratetbl_val_2wifirate(unsigned char rate); ++unsigned char ratetbl_val_2wifirate(unsigned char rate) ++{ ++ unsigned char val = 0; ++ ++ switch (rate & 0x7f) { ++ case 0: ++ val = IEEE80211_CCK_RATE_1MB; ++ break; ++ ++ case 1: ++ val = IEEE80211_CCK_RATE_2MB; ++ break; ++ ++ case 2: ++ val = IEEE80211_CCK_RATE_5MB; ++ break; ++ ++ case 3: ++ val = IEEE80211_CCK_RATE_11MB; ++ break; ++ ++ case 4: ++ val = IEEE80211_OFDM_RATE_6MB; ++ break; ++ ++ case 5: ++ val = IEEE80211_OFDM_RATE_9MB; ++ break; ++ ++ case 6: ++ val = IEEE80211_OFDM_RATE_12MB; ++ break; ++ ++ case 7: ++ val = IEEE80211_OFDM_RATE_18MB; ++ break; ++ ++ case 8: ++ val = IEEE80211_OFDM_RATE_24MB; ++ break; ++ ++ case 9: ++ val = IEEE80211_OFDM_RATE_36MB; ++ break; ++ ++ case 10: ++ val = IEEE80211_OFDM_RATE_48MB; ++ break; ++ ++ case 11: ++ val = IEEE80211_OFDM_RATE_54MB; ++ break; ++ ++ } ++ ++ return val; ++ ++} ++ ++int is_basicrate(_adapter *padapter, unsigned char rate); ++int is_basicrate(_adapter *padapter, unsigned char rate) ++{ ++ int i; ++ unsigned char val; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ for (i = 0; i < NumRates; i++) { ++ val = pmlmeext->basicrate[i]; ++ ++ if ((val != 0xff) && (val != 0xfe)) { ++ if (rate == ratetbl_val_2wifirate(val)) ++ return _TRUE; ++ } ++ } ++ ++ return _FALSE; ++} ++ ++unsigned int ratetbl2rateset(_adapter *padapter, unsigned char *rateset); ++unsigned int ratetbl2rateset(_adapter *padapter, unsigned char *rateset) ++{ ++ int i; ++ unsigned char rate; ++ unsigned int len = 0; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ for (i = 0; i < NumRates; i++) { ++ rate = pmlmeext->datarate[i]; ++ ++ switch (rate) { ++ case 0xff: ++ return len; ++ ++ case 0xfe: ++ continue; ++ ++ default: ++ rate = ratetbl_val_2wifirate(rate); ++ ++ if (is_basicrate(padapter, rate) == _TRUE) ++ rate |= IEEE80211_BASIC_RATE_MASK; ++ ++ rateset[len] = rate; ++ len++; ++ break; ++ } ++ } ++ return len; ++} ++ ++void get_rate_set(_adapter *padapter, unsigned char *pbssrate, int *bssrate_len) ++{ ++ unsigned char supportedrates[NumRates]; ++ ++ _rtw_memset(supportedrates, 0, NumRates); ++ *bssrate_len = ratetbl2rateset(padapter, supportedrates); ++ _rtw_memcpy(pbssrate, supportedrates, *bssrate_len); ++} ++ ++void set_mcs_rate_by_mask(u8 *mcs_set, u32 mask) ++{ ++ u8 mcs_rate_1r = (u8)(mask & 0xff); ++ u8 mcs_rate_2r = (u8)((mask >> 8) & 0xff); ++ u8 mcs_rate_3r = (u8)((mask >> 16) & 0xff); ++ u8 mcs_rate_4r = (u8)((mask >> 24) & 0xff); ++ ++ mcs_set[0] &= mcs_rate_1r; ++ mcs_set[1] &= mcs_rate_2r; ++ mcs_set[2] &= mcs_rate_3r; ++ mcs_set[3] &= mcs_rate_4r; ++} ++ ++void UpdateBrateTbl( ++ IN PADAPTER Adapter, ++ IN u8 *mBratesOS ++) ++{ ++ u8 i; ++ u8 rate; ++ ++ /* 1M, 2M, 5.5M, 11M, 6M, 12M, 24M are mandatory. */ ++ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { ++ rate = mBratesOS[i] & 0x7f; ++ switch (rate) { ++ case IEEE80211_CCK_RATE_1MB: ++ case IEEE80211_CCK_RATE_2MB: ++ case IEEE80211_CCK_RATE_5MB: ++ case IEEE80211_CCK_RATE_11MB: ++ case IEEE80211_OFDM_RATE_6MB: ++ case IEEE80211_OFDM_RATE_12MB: ++ case IEEE80211_OFDM_RATE_24MB: ++ mBratesOS[i] |= IEEE80211_BASIC_RATE_MASK; ++ break; ++ } ++ } ++ ++} ++ ++void UpdateBrateTblForSoftAP(u8 *bssrateset, u32 bssratelen) ++{ ++ u8 i; ++ u8 rate; ++ ++ for (i = 0; i < bssratelen; i++) { ++ rate = bssrateset[i] & 0x7f; ++ switch (rate) { ++ case IEEE80211_CCK_RATE_1MB: ++ case IEEE80211_CCK_RATE_2MB: ++ case IEEE80211_CCK_RATE_5MB: ++ case IEEE80211_CCK_RATE_11MB: ++ bssrateset[i] |= IEEE80211_BASIC_RATE_MASK; ++ break; ++ } ++ } ++ ++} ++void Set_MSR(_adapter *padapter, u8 type) ++{ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MEDIA_STATUS, (u8 *)(&type)); ++} ++ ++inline u8 rtw_get_oper_ch(_adapter *adapter) ++{ ++ return adapter_to_dvobj(adapter)->oper_channel; ++} ++ ++inline void rtw_set_oper_ch(_adapter *adapter, u8 ch) ++{ ++#ifdef DBG_CH_SWITCH ++ const int len = 128; ++ char msg[128] = {0}; ++ int cnt = 0; ++ int i = 0; ++#endif /* DBG_CH_SWITCH */ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ ++ if (dvobj->oper_channel != ch) { ++ dvobj->on_oper_ch_time = rtw_get_current_time(); ++ ++#ifdef DBG_CH_SWITCH ++ cnt += snprintf(msg + cnt, len - cnt, "switch to ch %3u", ch); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ _adapter *iface = dvobj->padapters[i]; ++ cnt += snprintf(msg + cnt, len - cnt, " ["ADPT_FMT":", ADPT_ARG(iface)); ++ if (iface->mlmeextpriv.cur_channel == ch) ++ cnt += snprintf(msg + cnt, len - cnt, "C"); ++ else ++ cnt += snprintf(msg + cnt, len - cnt, "_"); ++ if (iface->wdinfo.listen_channel == ch && !rtw_p2p_chk_state(&iface->wdinfo, P2P_STATE_NONE)) ++ cnt += snprintf(msg + cnt, len - cnt, "L"); ++ else ++ cnt += snprintf(msg + cnt, len - cnt, "_"); ++ cnt += snprintf(msg + cnt, len - cnt, "]"); ++ } ++ ++ RTW_INFO(FUNC_ADPT_FMT" %s\n", FUNC_ADPT_ARG(adapter), msg); ++#endif /* DBG_CH_SWITCH */ ++ } ++ ++ dvobj->oper_channel = ch; ++} ++ ++inline u8 rtw_get_oper_bw(_adapter *adapter) ++{ ++ return adapter_to_dvobj(adapter)->oper_bwmode; ++} ++ ++inline void rtw_set_oper_bw(_adapter *adapter, u8 bw) ++{ ++ adapter_to_dvobj(adapter)->oper_bwmode = bw; ++} ++ ++inline u8 rtw_get_oper_choffset(_adapter *adapter) ++{ ++ return adapter_to_dvobj(adapter)->oper_ch_offset; ++} ++ ++inline void rtw_set_oper_choffset(_adapter *adapter, u8 offset) ++{ ++ adapter_to_dvobj(adapter)->oper_ch_offset = offset; ++} ++ ++u8 rtw_get_offset_by_chbw(u8 ch, u8 bw, u8 *r_offset) ++{ ++ u8 valid = 1; ++ u8 offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ if (bw == CHANNEL_WIDTH_20) ++ goto exit; ++ ++ if (bw >= CHANNEL_WIDTH_80 && ch <= 14) { ++ valid = 0; ++ goto exit; ++ } ++ ++ if (ch >= 1 && ch <= 4) ++ offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ else if (ch >= 5 && ch <= 9) { ++ if (*r_offset == HAL_PRIME_CHNL_OFFSET_LOWER || *r_offset == HAL_PRIME_CHNL_OFFSET_UPPER) ++ offset = *r_offset; /* both lower and upper is valid, obey input value */ ++ else ++ offset = HAL_PRIME_CHNL_OFFSET_UPPER; /* default use upper */ ++ } else if (ch >= 10 && ch <= 13) ++ offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ else if (ch == 14) { ++ valid = 0; /* ch14 doesn't support 40MHz bandwidth */ ++ goto exit; ++ } else if (ch >= 36 && ch <= 177) { ++ switch (ch) { ++ case 36: ++ case 44: ++ case 52: ++ case 60: ++ case 100: ++ case 108: ++ case 116: ++ case 124: ++ case 132: ++ case 140: ++ case 149: ++ case 157: ++ case 165: ++ case 173: ++ offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ break; ++ case 40: ++ case 48: ++ case 56: ++ case 64: ++ case 104: ++ case 112: ++ case 120: ++ case 128: ++ case 136: ++ case 144: ++ case 153: ++ case 161: ++ case 169: ++ case 177: ++ offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ default: ++ valid = 0; ++ break; ++ } ++ } else ++ valid = 0; ++ ++exit: ++ if (valid && r_offset) ++ *r_offset = offset; ++ return valid; ++} ++ ++u8 rtw_get_offset_by_ch(u8 channel) ++{ ++ u8 offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ if (channel >= 1 && channel <= 4) ++ offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ else if (channel >= 5 && channel <= 14) ++ offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ else { ++ switch (channel) { ++ case 36: ++ case 44: ++ case 52: ++ case 60: ++ case 100: ++ case 108: ++ case 116: ++ case 124: ++ case 132: ++ case 149: ++ case 157: ++ offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ break; ++ case 40: ++ case 48: ++ case 56: ++ case 64: ++ case 104: ++ case 112: ++ case 120: ++ case 128: ++ case 136: ++ case 153: ++ case 161: ++ offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ default: ++ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ } ++ ++ } ++ ++ return offset; ++ ++} ++ ++u8 rtw_get_center_ch(u8 channel, u8 chnl_bw, u8 chnl_offset) ++{ ++ u8 center_ch = channel; ++ ++ if (chnl_bw == CHANNEL_WIDTH_80) { ++ if (channel == 36 || channel == 40 || channel == 44 || channel == 48) ++ center_ch = 42; ++ else if (channel == 52 || channel == 56 || channel == 60 || channel == 64) ++ center_ch = 58; ++ else if (channel == 100 || channel == 104 || channel == 108 || channel == 112) ++ center_ch = 106; ++ else if (channel == 116 || channel == 120 || channel == 124 || channel == 128) ++ center_ch = 122; ++ else if (channel == 132 || channel == 136 || channel == 140 || channel == 144) ++ center_ch = 138; ++ else if (channel == 149 || channel == 153 || channel == 157 || channel == 161) ++ center_ch = 155; ++ else if (channel == 165 || channel == 169 || channel == 173 || channel == 177) ++ center_ch = 171; ++ else if (channel <= 14) ++ center_ch = 7; ++ } else if (chnl_bw == CHANNEL_WIDTH_40) { ++ if (chnl_offset == HAL_PRIME_CHNL_OFFSET_LOWER) ++ center_ch = channel + 2; ++ else ++ center_ch = channel - 2; ++ } else if (chnl_bw == CHANNEL_WIDTH_20) ++ center_ch = channel; ++ else ++ rtw_warn_on(1); ++ ++ return center_ch; ++} ++ ++inline u32 rtw_get_on_oper_ch_time(_adapter *adapter) ++{ ++ return adapter_to_dvobj(adapter)->on_oper_ch_time; ++} ++ ++inline u32 rtw_get_on_cur_ch_time(_adapter *adapter) ++{ ++ if (adapter->mlmeextpriv.cur_channel == adapter_to_dvobj(adapter)->oper_channel) ++ return adapter_to_dvobj(adapter)->on_oper_ch_time; ++ else ++ return 0; ++} ++ ++void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char channel_offset, unsigned short bwmode) ++{ ++ u8 center_ch, chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++#if (defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW)) || defined(CONFIG_MCC_MODE) ++ u8 iqk_info_backup = _FALSE; ++#endif ++ ++ if (padapter->bNotifyChannelChange) ++ RTW_INFO("[%s] ch = %d, offset = %d, bwmode = %d\n", __FUNCTION__, channel, channel_offset, bwmode); ++ ++ center_ch = rtw_get_center_ch(channel, bwmode, channel_offset); ++ ++ if (bwmode == CHANNEL_WIDTH_80) { ++ if (center_ch > channel) ++ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_LOWER; ++ else if (center_ch < channel) ++ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_UPPER; ++ else ++ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ } ++ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); ++ ++#ifdef CONFIG_MCC_MODE ++ if (MCC_EN(padapter)) { ++ /* driver doesn't set channel setting reg under MCC */ ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { ++ RTW_INFO("Warning: Do not set channel setting reg MCC mode\n"); ++ rtw_warn_on(1); ++ } ++ } ++#endif ++ ++#ifdef CONFIG_DFS_MASTER ++ { ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); ++ bool ori_overlap_radar_detect_ch = rtw_rfctl_overlap_radar_detect_ch(rfctl); ++ bool new_overlap_radar_detect_ch = _rtw_rfctl_overlap_radar_detect_ch(rfctl, channel, bwmode, channel_offset); ++ ++ if (new_overlap_radar_detect_ch) ++ rtw_odm_radar_detect_enable(padapter); ++ ++ if (new_overlap_radar_detect_ch && IS_CH_WAITING(rfctl)) { ++ u8 pause = 0xFF; ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &pause); ++ } ++#endif /* CONFIG_DFS_MASTER */ ++ ++ /* set Channel */ ++ /* saved channel/bw info */ ++ rtw_set_oper_ch(padapter, channel); ++ rtw_set_oper_bw(padapter, bwmode); ++ rtw_set_oper_choffset(padapter, channel_offset); ++ ++#if (defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW)) || defined(CONFIG_MCC_MODE) ++ /* To check if we need to backup iqk info after switch chnl & bw */ ++ { ++ u8 take_care_iqk, do_iqk; ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, &take_care_iqk); ++ rtw_hal_get_hwreg(padapter, HW_VAR_DO_IQK, &do_iqk); ++ if ((take_care_iqk == _TRUE) && (do_iqk == _TRUE)) ++ iqk_info_backup = _TRUE; ++ } ++#endif ++ ++ rtw_hal_set_chnl_bw(padapter, center_ch, bwmode, channel_offset, chnl_offset80); /* set center channel */ ++ ++#if (defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW)) || defined(CONFIG_MCC_MODE) ++ if (iqk_info_backup == _TRUE) ++ rtw_hal_ch_sw_iqk_info_backup(padapter); ++#endif ++ ++#ifdef CONFIG_DFS_MASTER ++ if (ori_overlap_radar_detect_ch && !new_overlap_radar_detect_ch) { ++ u8 pause = 0x00; ++ ++ rtw_odm_radar_detect_disable(padapter); ++ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &pause); ++ } ++ } ++#endif /* CONFIG_DFS_MASTER */ ++ ++ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); ++} ++ ++int get_bsstype(unsigned short capability) ++{ ++ if (capability & BIT(0)) ++ return WIFI_FW_AP_STATE; ++ else if (capability & BIT(1)) ++ return WIFI_FW_ADHOC_STATE; ++ else ++ return 0; ++} ++ ++__inline u8 *get_my_bssid(WLAN_BSSID_EX *pnetwork) ++{ ++ return pnetwork->MacAddress; ++} ++ ++u16 get_beacon_interval(WLAN_BSSID_EX *bss) ++{ ++ unsigned short val; ++ _rtw_memcpy((unsigned char *)&val, rtw_get_beacon_interval_from_ie(bss->IEs), 2); ++ ++ return le16_to_cpu(val); ++ ++} ++ ++int is_client_associated_to_ap(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext; ++ struct mlme_ext_info *pmlmeinfo; ++ ++ if (!padapter) ++ return _FAIL; ++ ++ pmlmeext = &padapter->mlmeextpriv; ++ pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE)) ++ return _TRUE; ++ else ++ return _FAIL; ++} ++ ++int is_client_associated_to_ibss(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) ++ return _TRUE; ++ else ++ return _FAIL; ++} ++ ++int is_IBSS_empty(_adapter *padapter) ++{ ++ int i; ++ struct macid_ctl_t *macid_ctl = &padapter->dvobj->macid_ctl; ++ ++ for (i = 0; i < macid_ctl->num; i++) { ++ if (!rtw_macid_is_used(macid_ctl, i)) ++ continue; ++ if (rtw_macid_get_if_g(macid_ctl, i) != padapter->iface_id) ++ continue; ++ if (!GET_H2CCMD_MSRRPT_PARM_OPMODE(&macid_ctl->h2c_msr[i])) ++ continue; ++ if (GET_H2CCMD_MSRRPT_PARM_ROLE(&macid_ctl->h2c_msr[i]) == H2C_MSR_ROLE_ADHOC) ++ return _FAIL; ++ } ++ ++ return _TRUE; ++} ++ ++unsigned int decide_wait_for_beacon_timeout(unsigned int bcn_interval) ++{ ++ if ((bcn_interval << 2) < WAIT_FOR_BCN_TO_MIN) ++ return WAIT_FOR_BCN_TO_MIN; ++ else if ((bcn_interval << 2) > WAIT_FOR_BCN_TO_MAX) ++ return WAIT_FOR_BCN_TO_MAX; ++ else ++ return bcn_interval << 2; ++} ++ ++void CAM_empty_entry( ++ PADAPTER Adapter, ++ u8 ucIndex ++) ++{ ++ rtw_hal_set_hwreg(Adapter, HW_VAR_CAM_EMPTY_ENTRY, (u8 *)(&ucIndex)); ++} ++ ++void invalidate_cam_all(_adapter *padapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ u8 val8 = 0; ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_INVALID_ALL, &val8); ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ rtw_sec_cam_map_clr_all(&cam_ctl->used); ++ _rtw_memset(dvobj->cam_cache, 0, sizeof(struct sec_cam_ent) * SEC_CAM_ENT_NUM_SW_LIMIT); ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++} ++ ++void _clear_cam_entry(_adapter *padapter, u8 entry) ++{ ++ unsigned char null_sta[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; ++ unsigned char null_key[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; ++ ++ rtw_sec_write_cam_ent(padapter, entry, 0, null_sta, null_key); ++} ++ ++inline void write_cam(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) ++{ ++#ifdef CONFIG_WRITE_CACHE_ONLY ++ write_cam_cache(adapter, id , ctrl, mac, key); ++#else ++ rtw_sec_write_cam_ent(adapter, id, ctrl, mac, key); ++ write_cam_cache(adapter, id , ctrl, mac, key); ++#endif ++} ++ ++inline void clear_cam_entry(_adapter *adapter, u8 id) ++{ ++ _clear_cam_entry(adapter, id); ++ clear_cam_cache(adapter, id); ++} ++ ++inline void write_cam_from_cache(_adapter *adapter, u8 id) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ struct sec_cam_ent cache; ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ _rtw_memcpy(&cache, &dvobj->cam_cache[id], sizeof(struct sec_cam_ent)); ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++ ++ rtw_sec_write_cam_ent(adapter, id, cache.ctrl, cache.mac, cache.key); ++} ++void write_cam_cache(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ ++ dvobj->cam_cache[id].ctrl = ctrl; ++ _rtw_memcpy(dvobj->cam_cache[id].mac, mac, ETH_ALEN); ++ _rtw_memcpy(dvobj->cam_cache[id].key, key, 16); ++ ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++} ++ ++void clear_cam_cache(_adapter *adapter, u8 id) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ ++ _rtw_memset(&(dvobj->cam_cache[id]), 0, sizeof(struct sec_cam_ent)); ++ ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++} ++ ++inline bool _rtw_camctl_chk_cap(_adapter *adapter, u8 cap) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ ++ if (cam_ctl->sec_cap & cap) ++ return _TRUE; ++ return _FALSE; ++} ++ ++inline void _rtw_camctl_set_flags(_adapter *adapter, u32 flags) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ ++ cam_ctl->flags |= flags; ++} ++ ++inline void rtw_camctl_set_flags(_adapter *adapter, u32 flags) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ _rtw_camctl_set_flags(adapter, flags); ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++} ++ ++inline void _rtw_camctl_clr_flags(_adapter *adapter, u32 flags) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ ++ cam_ctl->flags &= ~flags; ++} ++ ++inline void rtw_camctl_clr_flags(_adapter *adapter, u32 flags) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ _rtw_camctl_clr_flags(adapter, flags); ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++} ++ ++inline bool _rtw_camctl_chk_flags(_adapter *adapter, u32 flags) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ ++ if (cam_ctl->flags & flags) ++ return _TRUE; ++ return _FALSE; ++} ++ ++void dump_sec_cam_map(void *sel, struct sec_cam_bmp *map, u8 max_num) ++{ ++ RTW_PRINT_SEL(sel, "0x%08x\n", map->m0); ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) ++ if (max_num && max_num > 32) ++ RTW_PRINT_SEL(sel, "0x%08x\n", map->m1); ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) ++ if (max_num && max_num > 64) ++ RTW_PRINT_SEL(sel, "0x%08x\n", map->m2); ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) ++ if (max_num && max_num > 96) ++ RTW_PRINT_SEL(sel, "0x%08x\n", map->m3); ++#endif ++} ++ ++inline bool rtw_sec_camid_is_set(struct sec_cam_bmp *map, u8 id) ++{ ++ if (id < 32) ++ return map->m0 & BIT(id); ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) ++ else if (id < 64) ++ return map->m1 & BIT(id - 32); ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) ++ else if (id < 96) ++ return map->m2 & BIT(id - 64); ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) ++ else if (id < 128) ++ return map->m3 & BIT(id - 96); ++#endif ++ else ++ rtw_warn_on(1); ++ ++ return 0; ++} ++ ++inline void rtw_sec_cam_map_set(struct sec_cam_bmp *map, u8 id) ++{ ++ if (id < 32) ++ map->m0 |= BIT(id); ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) ++ else if (id < 64) ++ map->m1 |= BIT(id - 32); ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) ++ else if (id < 96) ++ map->m2 |= BIT(id - 64); ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) ++ else if (id < 128) ++ map->m3 |= BIT(id - 96); ++#endif ++ else ++ rtw_warn_on(1); ++} ++ ++inline void rtw_sec_cam_map_clr(struct sec_cam_bmp *map, u8 id) ++{ ++ if (id < 32) ++ map->m0 &= ~BIT(id); ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) ++ else if (id < 64) ++ map->m1 &= ~BIT(id - 32); ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) ++ else if (id < 96) ++ map->m2 &= ~BIT(id - 64); ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) ++ else if (id < 128) ++ map->m3 &= ~BIT(id - 96); ++#endif ++ else ++ rtw_warn_on(1); ++} ++ ++inline void rtw_sec_cam_map_clr_all(struct sec_cam_bmp *map) ++{ ++ map->m0 = 0; ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) ++ map->m1 = 0; ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) ++ map->m2 = 0; ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) ++ map->m3 = 0; ++#endif ++} ++ ++inline bool rtw_sec_camid_is_drv_forbid(struct cam_ctl_t *cam_ctl, u8 id) ++{ ++ struct sec_cam_bmp forbid_map; ++ ++ forbid_map.m0 = 0x00000ff0; ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) ++ forbid_map.m1 = 0x00000000; ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) ++ forbid_map.m2 = 0x00000000; ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) ++ forbid_map.m3 = 0x00000000; ++#endif ++ ++ if (id < 32) ++ return forbid_map.m0 & BIT(id); ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) ++ else if (id < 64) ++ return forbid_map.m1 & BIT(id - 32); ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) ++ else if (id < 96) ++ return forbid_map.m2 & BIT(id - 64); ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) ++ else if (id < 128) ++ return forbid_map.m3 & BIT(id - 96); ++#endif ++ else ++ rtw_warn_on(1); ++ ++ return 1; ++} ++ ++bool _rtw_sec_camid_is_used(struct cam_ctl_t *cam_ctl, u8 id) ++{ ++ bool ret = _FALSE; ++ ++ if (id >= cam_ctl->num) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++#if 0 /* for testing */ ++ if (rtw_sec_camid_is_drv_forbid(cam_ctl, id)) { ++ ret = _TRUE; ++ goto exit; ++ } ++#endif ++ ++ ret = rtw_sec_camid_is_set(&cam_ctl->used, id); ++ ++exit: ++ return ret; ++} ++ ++inline bool rtw_sec_camid_is_used(struct cam_ctl_t *cam_ctl, u8 id) ++{ ++ _irqL irqL; ++ bool ret; ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ ret = _rtw_sec_camid_is_used(cam_ctl, id); ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++ ++ return ret; ++} ++u8 rtw_get_sec_camid(_adapter *adapter, u8 max_bk_key_num, u8 *sec_key_id) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ int i; ++ _irqL irqL; ++ u8 sec_cam_num = 0; ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ for (i = 0; i < cam_ctl->num; i++) { ++ if (_rtw_sec_camid_is_used(cam_ctl, i)) { ++ sec_key_id[sec_cam_num++] = i; ++ if (sec_cam_num == max_bk_key_num) ++ break; ++ } ++ } ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++ ++ return sec_cam_num; ++} ++ ++inline bool _rtw_camid_is_gk(_adapter *adapter, u8 cam_id) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ bool ret = _FALSE; ++ ++ if (cam_id >= cam_ctl->num) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (_rtw_sec_camid_is_used(cam_ctl, cam_id) == _FALSE) ++ goto exit; ++ ++ ret = (dvobj->cam_cache[cam_id].ctrl & BIT6) ? _TRUE : _FALSE; ++ ++exit: ++ return ret; ++} ++ ++inline bool rtw_camid_is_gk(_adapter *adapter, u8 cam_id) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ bool ret; ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ ret = _rtw_camid_is_gk(adapter, cam_id); ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++ ++ return ret; ++} ++ ++bool cam_cache_chk(_adapter *adapter, u8 id, u8 *addr, s16 kid, s8 gk) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ bool ret = _FALSE; ++ ++ if (addr && _rtw_memcmp(dvobj->cam_cache[id].mac, addr, ETH_ALEN) == _FALSE) ++ goto exit; ++ if (kid >= 0 && kid != (dvobj->cam_cache[id].ctrl & 0x03)) ++ goto exit; ++ if (gk != -1 && (gk ? _TRUE : _FALSE) != _rtw_camid_is_gk(adapter, id)) ++ goto exit; ++ ++ ret = _TRUE; ++ ++exit: ++ return ret; ++} ++ ++s16 _rtw_camid_search(_adapter *adapter, u8 *addr, s16 kid, s8 gk) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ int i; ++ s16 cam_id = -1; ++ ++ for (i = 0; i < cam_ctl->num; i++) { ++ if (cam_cache_chk(adapter, i, addr, kid, gk)) { ++ cam_id = i; ++ break; ++ } ++ } ++ ++ if (0) { ++ if (addr) ++ RTW_INFO(FUNC_ADPT_FMT" addr:"MAC_FMT" kid:%d, gk:%d, return cam_id:%d\n" ++ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), kid, gk, cam_id); ++ else ++ RTW_INFO(FUNC_ADPT_FMT" addr:%p kid:%d, gk:%d, return cam_id:%d\n" ++ , FUNC_ADPT_ARG(adapter), addr, kid, gk, cam_id); ++ } ++ ++ return cam_id; ++} ++ ++s16 rtw_camid_search(_adapter *adapter, u8 *addr, s16 kid, s8 gk) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ s16 cam_id = -1; ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ cam_id = _rtw_camid_search(adapter, addr, kid, gk); ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++ ++ return cam_id; ++} ++ ++s16 rtw_get_camid(_adapter *adapter, struct sta_info *sta, u8 *addr, s16 kid) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ int i; ++#if 0 /* for testing */ ++ static u8 start_id = 0; ++#else ++ u8 start_id = 0; ++#endif ++ s16 cam_id = -1; ++ ++ if (addr == NULL) { ++ RTW_PRINT(FUNC_ADPT_FMT" mac_address is NULL\n" ++ , FUNC_ADPT_ARG(adapter)); ++ rtw_warn_on(1); ++ goto _exit; ++ } ++ ++ /* find cam entry which has the same addr, kid (, gk bit) */ ++ if (_rtw_camctl_chk_cap(adapter, SEC_CAP_CHK_BMC) == _TRUE) ++ i = _rtw_camid_search(adapter, addr, kid, sta ? _FALSE : _TRUE); ++ else ++ i = _rtw_camid_search(adapter, addr, kid, -1); ++ ++ if (i >= 0) { ++ cam_id = i; ++ goto _exit; ++ } ++ ++ for (i = 0; i < cam_ctl->num; i++) { ++ /* bypass default key which is allocated statically */ ++#ifndef CONFIG_CONCURRENT_MODE ++ if (((i + start_id) % cam_ctl->num) < 4) ++ continue; ++#endif ++ if (_rtw_sec_camid_is_used(cam_ctl, ((i + start_id) % cam_ctl->num)) == _FALSE) ++ break; ++ } ++ ++ if (i == cam_ctl->num) { ++ if (sta) ++ RTW_PRINT(FUNC_ADPT_FMT" pairwise key with "MAC_FMT" id:%u no room\n" ++ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), kid); ++ else ++ RTW_PRINT(FUNC_ADPT_FMT" group key with "MAC_FMT" id:%u no room\n" ++ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), kid); ++ rtw_warn_on(1); ++ goto _exit; ++ } ++ ++ cam_id = ((i + start_id) % cam_ctl->num); ++ start_id = ((i + start_id + 1) % cam_ctl->num); ++ ++_exit: ++ return cam_id; ++} ++ ++s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, bool *used) ++{ ++ struct mlme_ext_info *mlmeinfo = &adapter->mlmeextpriv.mlmext_info; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ s16 cam_id = -1; ++ ++ *used = _FALSE; ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ ++ if ((((mlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) || ((mlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) ++ && !sta) { ++#ifndef CONFIG_CONCURRENT_MODE ++ /* AP/Ad-hoc mode group key static alloction to default key by key ID on Non-concurrent*/ ++ if (kid > 3) { ++ RTW_PRINT(FUNC_ADPT_FMT" group key with invalid key id:%u\n" ++ , FUNC_ADPT_ARG(adapter), kid); ++ rtw_warn_on(1); ++ goto bitmap_handle; ++ } ++ cam_id = kid; ++#else ++ u8 *addr = adapter_mac_addr(adapter); ++ ++ cam_id = rtw_get_camid(adapter, sta, addr, kid); ++ if (1) ++ RTW_PRINT(FUNC_ADPT_FMT" group key with "MAC_FMT" assigned cam_id:%u\n" ++ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), cam_id); ++#endif ++ } else { ++ u8 *addr = sta ? sta->hwaddr : NULL; ++ ++ if (!sta) { ++ if (!(mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { ++ /* bypass STA mode group key setting before connected(ex:WEP) because bssid is not ready */ ++ goto bitmap_handle; ++ } ++ addr = get_bssid(&adapter->mlmepriv);/*A2*/ ++ } ++ cam_id = rtw_get_camid(adapter, sta, addr, kid); ++ } ++ ++ ++bitmap_handle: ++ if (cam_id >= 0) { ++ *used = _rtw_sec_camid_is_used(cam_ctl, cam_id); ++ rtw_sec_cam_map_set(&cam_ctl->used, cam_id); ++ } ++ ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++ ++ return cam_id; ++} ++ ++void rtw_camid_set(_adapter *adapter, u8 cam_id) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ ++ if (cam_id < cam_ctl->num) ++ rtw_sec_cam_map_set(&cam_ctl->used, cam_id); ++ ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++} ++ ++void rtw_camid_free(_adapter *adapter, u8 cam_id) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ ++ if (cam_id < cam_ctl->num) ++ rtw_sec_cam_map_clr(&cam_ctl->used, cam_id); ++ ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++} ++ ++/*Must pause TX/RX before use this API*/ ++inline void rtw_sec_cam_swap(_adapter *adapter, u8 cam_id_a, u8 cam_id_b) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ struct sec_cam_ent cache_a, cache_b; ++ _irqL irqL; ++ bool cam_a_used, cam_b_used; ++ ++ if (1) ++ RTW_INFO(ADPT_FMT" - sec_cam %d,%d swap\n", ADPT_ARG(adapter), cam_id_a, cam_id_b); ++ ++ if (cam_id_a == cam_id_b) ++ return; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ rtw_mi_update_ap_bmc_camid(adapter, cam_id_a, cam_id_b); ++#endif ++ ++ /*setp-1. backup org cam_info*/ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ ++ cam_a_used = _rtw_sec_camid_is_used(cam_ctl, cam_id_a); ++ cam_b_used = _rtw_sec_camid_is_used(cam_ctl, cam_id_b); ++ ++ if (cam_a_used) ++ _rtw_memcpy(&cache_a, &dvobj->cam_cache[cam_id_a], sizeof(struct sec_cam_ent)); ++ ++ if (cam_b_used) ++ _rtw_memcpy(&cache_b, &dvobj->cam_cache[cam_id_b], sizeof(struct sec_cam_ent)); ++ ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++ ++ /*setp-2. clean cam_info*/ ++ if (cam_a_used) { ++ rtw_camid_free(adapter, cam_id_a); ++ clear_cam_entry(adapter, cam_id_a); ++ } ++ if (cam_b_used) { ++ rtw_camid_free(adapter, cam_id_b); ++ clear_cam_entry(adapter, cam_id_b); ++ } ++ ++ /*setp-3. set cam_info*/ ++ if (cam_a_used) { ++ write_cam(adapter, cam_id_b, cache_a.ctrl, cache_a.mac, cache_a.key); ++ rtw_camid_set(adapter, cam_id_b); ++ } ++ ++ if (cam_b_used) { ++ write_cam(adapter, cam_id_a, cache_b.ctrl, cache_b.mac, cache_b.key); ++ rtw_camid_set(adapter, cam_id_a); ++ } ++} ++ ++s16 rtw_get_empty_cam_entry(_adapter *adapter, u8 start_camid) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ int i; ++ s16 cam_id = -1; ++ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ for (i = start_camid; i < cam_ctl->num; i++) { ++ if (_FALSE == _rtw_sec_camid_is_used(cam_ctl, i)) { ++ cam_id = i; ++ break; ++ } ++ } ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++ ++ return cam_id; ++} ++void rtw_clean_dk_section(_adapter *adapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = dvobj_to_sec_camctl(dvobj); ++ s16 ept_cam_id; ++ int i; ++ ++ for (i = 0; i < 4; i++) { ++ if (rtw_sec_camid_is_used(cam_ctl, i)) { ++ ept_cam_id = rtw_get_empty_cam_entry(adapter, 4); ++ if (ept_cam_id > 0) ++ rtw_sec_cam_swap(adapter, i, ept_cam_id); ++ } ++ } ++} ++void rtw_clean_hw_dk_cam(_adapter *adapter) ++{ ++ int i; ++ ++ for (i = 0; i < 4; i++) ++ rtw_sec_clr_cam_ent(adapter, i); ++ /*_clear_cam_entry(adapter, i);*/ ++} ++ ++void flush_all_cam_entry(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct security_priv *psecpriv = &padapter->securitypriv; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta; ++ ++ psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); ++ if (psta) { ++ if (psta->state & WIFI_AP_STATE) { ++ /*clear cam when ap free per sta_info*/ ++ } else ++ rtw_clearstakey_cmd(padapter, psta, _FALSE); ++ } ++ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { ++#if 1 ++ int cam_id = -1; ++ u8 *addr = adapter_mac_addr(padapter); ++ ++ while ((cam_id = rtw_camid_search(padapter, addr, -1, -1)) >= 0) { ++ RTW_PRINT("clear wep or group key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(addr), cam_id); ++ clear_cam_entry(padapter, cam_id); ++ rtw_camid_free(padapter, cam_id); ++ } ++#else ++ /* clear default key */ ++ int i, cam_id; ++ u8 null_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; ++ ++ for (i = 0; i < 4; i++) { ++ cam_id = rtw_camid_search(padapter, null_addr, i, -1); ++ if (cam_id >= 0) { ++ clear_cam_entry(padapter, cam_id); ++ rtw_camid_free(padapter, cam_id); ++ } ++ } ++ /* clear default key related key search setting */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_DK_CFG, (u8 *)_FALSE); ++#endif ++ } ++ ++#else /*NON CONFIG_CONCURRENT_MODE*/ ++ ++ invalidate_cam_all(padapter); ++ /* clear default key related key search setting */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_DK_CFG, (u8 *)_FALSE); ++#endif ++} ++ ++#if defined(CONFIG_P2P) && defined(CONFIG_WFD) ++void rtw_process_wfd_ie(_adapter *adapter, u8 *wfd_ie, u8 wfd_ielen, const char *tag) ++{ ++ struct wifidirect_info *wdinfo = &adapter->wdinfo; ++ ++ u8 *attr_content; ++ u32 attr_contentlen = 0; ++ ++ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) ++ return; ++ ++ RTW_INFO("[%s] Found WFD IE\n", tag); ++ attr_content = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &attr_contentlen); ++ if (attr_content && attr_contentlen) { ++ wdinfo->wfd_info->peer_rtsp_ctrlport = RTW_GET_BE16(attr_content + 2); ++ RTW_INFO("[%s] Peer PORT NUM = %d\n", tag, wdinfo->wfd_info->peer_rtsp_ctrlport); ++ } ++} ++ ++void rtw_process_wfd_ies(_adapter *adapter, u8 *ies, u8 ies_len, const char *tag) ++{ ++ u8 *wfd_ie; ++ u32 wfd_ielen; ++ ++ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) ++ return; ++ ++ wfd_ie = rtw_get_wfd_ie(ies, ies_len, NULL, &wfd_ielen); ++ while (wfd_ie) { ++ rtw_process_wfd_ie(adapter, wfd_ie, wfd_ielen, tag); ++ wfd_ie = rtw_get_wfd_ie(wfd_ie + wfd_ielen, (ies + ies_len) - (wfd_ie + wfd_ielen), NULL, &wfd_ielen); ++ } ++} ++#endif /* defined(CONFIG_P2P) && defined(CONFIG_WFD) */ ++ ++int WMM_param_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) ++{ ++ /* struct registry_priv *pregpriv = &padapter->registrypriv; */ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if (pmlmepriv->qospriv.qos_option == 0) { ++ pmlmeinfo->WMM_enable = 0; ++ return _FALSE; ++ } ++ ++ if (_rtw_memcmp(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element))) ++ return _FALSE; ++ else ++ _rtw_memcpy(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element)); ++ pmlmeinfo->WMM_enable = 1; ++ return _TRUE; ++ ++#if 0 ++ if (pregpriv->wifi_spec == 1) { ++ if (pmlmeinfo->WMM_enable == 1) { ++ /* todo: compare the parameter set count & decide wheher to update or not */ ++ return _FAIL; ++ } else { ++ pmlmeinfo->WMM_enable = 1; ++ _rtw_rtw_memcpy(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element)); ++ return _TRUE; ++ } ++ } else { ++ pmlmeinfo->WMM_enable = 0; ++ return _FAIL; ++ } ++#endif ++ ++} ++ ++void WMMOnAssocRsp(_adapter *padapter) ++{ ++ u8 ACI, ACM, AIFS, ECWMin, ECWMax, aSifsTime; ++ u8 acm_mask; ++ u16 TXOP; ++ u32 acParm, i; ++ u32 edca[4], inx[4]; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ ++ acm_mask = 0; ++ ++ if (IsSupported5G(pmlmeext->cur_wireless_mode) || ++ (pmlmeext->cur_wireless_mode & WIRELESS_11_24N)) ++ aSifsTime = 16; ++ else ++ aSifsTime = 10; ++ ++ if (pmlmeinfo->WMM_enable == 0) { ++ padapter->mlmepriv.acm_mask = 0; ++ ++ AIFS = aSifsTime + (2 * pmlmeinfo->slotTime); ++ ++ if (pmlmeext->cur_wireless_mode & (WIRELESS_11G | WIRELESS_11A)) { ++ ECWMin = 4; ++ ECWMax = 10; ++ } else if (pmlmeext->cur_wireless_mode & WIRELESS_11B) { ++ ECWMin = 5; ++ ECWMax = 10; ++ } else { ++ ECWMin = 4; ++ ECWMax = 10; ++ } ++ ++ TXOP = 0; ++ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); ++ ++ ECWMin = 2; ++ ECWMax = 3; ++ TXOP = 0x2f; ++ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); ++ } else { ++ edca[0] = edca[1] = edca[2] = edca[3] = 0; ++ ++ for (i = 0; i < 4; i++) { ++ ACI = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 5) & 0x03; ++ ACM = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 4) & 0x01; ++ ++ /* AIFS = AIFSN * slot time + SIFS - r2t phy delay */ ++ AIFS = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN & 0x0f) * pmlmeinfo->slotTime + aSifsTime; ++ ++ ECWMin = (pmlmeinfo->WMM_param.ac_param[i].CW & 0x0f); ++ ECWMax = (pmlmeinfo->WMM_param.ac_param[i].CW & 0xf0) >> 4; ++ TXOP = le16_to_cpu(pmlmeinfo->WMM_param.ac_param[i].TXOP_limit); ++ ++ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); ++ ++ switch (ACI) { ++ case 0x0: ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); ++ acm_mask |= (ACM ? BIT(1) : 0); ++ edca[XMIT_BE_QUEUE] = acParm; ++ break; ++ ++ case 0x1: ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); ++ /* acm_mask |= (ACM? BIT(0):0); */ ++ edca[XMIT_BK_QUEUE] = acParm; ++ break; ++ ++ case 0x2: ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); ++ acm_mask |= (ACM ? BIT(2) : 0); ++ edca[XMIT_VI_QUEUE] = acParm; ++ break; ++ ++ case 0x3: ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); ++ acm_mask |= (ACM ? BIT(3) : 0); ++ edca[XMIT_VO_QUEUE] = acParm; ++ break; ++ } ++ ++ RTW_INFO("WMM(%x): %x, %x\n", ACI, ACM, acParm); ++ } ++ ++ if (padapter->registrypriv.acm_method == 1) ++ rtw_hal_set_hwreg(padapter, HW_VAR_ACM_CTRL, (u8 *)(&acm_mask)); ++ else ++ padapter->mlmepriv.acm_mask = acm_mask; ++ ++ inx[0] = 0; ++ inx[1] = 1; ++ inx[2] = 2; ++ inx[3] = 3; ++ ++ if (pregpriv->wifi_spec == 1) { ++ u32 j, tmp, change_inx = _FALSE; ++ ++ /* entry indx: 0->vo, 1->vi, 2->be, 3->bk. */ ++ for (i = 0; i < 4; i++) { ++ for (j = i + 1; j < 4; j++) { ++ /* compare CW and AIFS */ ++ if ((edca[j] & 0xFFFF) < (edca[i] & 0xFFFF)) ++ change_inx = _TRUE; ++ else if ((edca[j] & 0xFFFF) == (edca[i] & 0xFFFF)) { ++ /* compare TXOP */ ++ if ((edca[j] >> 16) > (edca[i] >> 16)) ++ change_inx = _TRUE; ++ } ++ ++ if (change_inx) { ++ tmp = edca[i]; ++ edca[i] = edca[j]; ++ edca[j] = tmp; ++ ++ tmp = inx[i]; ++ inx[i] = inx[j]; ++ inx[j] = tmp; ++ ++ change_inx = _FALSE; ++ } ++ } ++ } ++ } ++ ++ for (i = 0; i < 4; i++) { ++ pxmitpriv->wmm_para_seq[i] = inx[i]; ++ RTW_INFO("wmm_para_seq(%d): %d\n", i, pxmitpriv->wmm_para_seq[i]); ++ } ++ } ++} ++ ++static void bwmode_update_check(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) ++{ ++#ifdef CONFIG_80211N_HT ++ unsigned char new_bwmode; ++ unsigned char new_ch_offset; ++ struct HT_info_element *pHT_info; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++ u8 cbw40_enable = 0; ++ ++ if (!pIE) ++ return; ++ ++ if (phtpriv->ht_option == _FALSE) ++ return; ++ ++ if (pmlmeext->cur_bwmode >= CHANNEL_WIDTH_80) ++ return; ++ ++ if (pIE->Length > sizeof(struct HT_info_element)) ++ return; ++ ++ pHT_info = (struct HT_info_element *)pIE->data; ++ ++ if (hal_chk_bw_cap(padapter, BW_CAP_40M)) { ++ if (pmlmeext->cur_channel > 14) { ++ if (REGSTY_IS_BW_5G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) ++ cbw40_enable = 1; ++ } else { ++ if (REGSTY_IS_BW_2G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) ++ cbw40_enable = 1; ++ } ++ } ++ ++ if ((pHT_info->infos[0] & BIT(2)) && cbw40_enable) { ++ new_bwmode = CHANNEL_WIDTH_40; ++ ++ switch (pHT_info->infos[0] & 0x3) { ++ case 1: ++ new_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ break; ++ ++ case 3: ++ new_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ ++ default: ++ new_bwmode = CHANNEL_WIDTH_20; ++ new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ } ++ } else { ++ new_bwmode = CHANNEL_WIDTH_20; ++ new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ } ++ ++ ++ if ((new_bwmode != pmlmeext->cur_bwmode || new_ch_offset != pmlmeext->cur_ch_offset) ++ && new_bwmode < pmlmeext->cur_bwmode ++ ) { ++ pmlmeinfo->bwmode_updated = _TRUE; ++ ++ pmlmeext->cur_bwmode = new_bwmode; ++ pmlmeext->cur_ch_offset = new_ch_offset; ++ ++ /* update HT info also */ ++ HT_info_handler(padapter, pIE); ++ } else ++ pmlmeinfo->bwmode_updated = _FALSE; ++ ++ ++ if (_TRUE == pmlmeinfo->bwmode_updated) { ++ struct sta_info *psta; ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ /* set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */ ++ ++ ++ /* update ap's stainfo */ ++ psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); ++ if (psta) { ++ struct ht_priv *phtpriv_sta = &psta->htpriv; ++ ++ if (phtpriv_sta->ht_option) { ++ /* bwmode */ ++ psta->bw_mode = pmlmeext->cur_bwmode; ++ phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; ++ } else { ++ psta->bw_mode = CHANNEL_WIDTH_20; ++ phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ } ++ ++ rtw_dm_ra_mask_wk_cmd(padapter, (u8 *)psta); ++ } ++ ++ /* pmlmeinfo->bwmode_updated = _FALSE; */ /* bwmode_updated done, reset it! */ ++ } ++#endif /* CONFIG_80211N_HT */ ++} ++ ++void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) ++{ ++#ifdef CONFIG_80211N_HT ++ unsigned int i; ++ u8 rf_type = RF_1T1R; ++ u8 max_AMPDU_len, min_MPDU_spacing; ++ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ ++ if (pIE == NULL) ++ return; ++ ++ if (phtpriv->ht_option == _FALSE) ++ return; ++ ++ pmlmeinfo->HT_caps_enable = 1; ++ ++ for (i = 0; i < (pIE->Length); i++) { ++ if (i != 2) { ++ /* Commented by Albert 2010/07/12 */ ++ /* Got the endian issue here. */ ++ pmlmeinfo->HT_caps.u.HT_cap[i] &= (pIE->data[i]); ++ } else { ++ /* AMPDU Parameters field */ ++ ++ /* Get MIN of MAX AMPDU Length Exp */ ++ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3) > (pIE->data[i] & 0x3)) ++ max_AMPDU_len = (pIE->data[i] & 0x3); ++ else ++ max_AMPDU_len = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3); ++ ++ /* Get MAX of MIN MPDU Start Spacing */ ++ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) > (pIE->data[i] & 0x1c)) ++ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c); ++ else ++ min_MPDU_spacing = (pIE->data[i] & 0x1c); ++ ++ pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para = max_AMPDU_len | min_MPDU_spacing; ++ } ++ } ++ ++ /* Commented by Albert 2010/07/12 */ ++ /* Have to handle the endian issue after copying. */ ++ /* HT_ext_caps didn't be used yet. */ ++ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info = le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info); ++ pmlmeinfo->HT_caps.u.HT_cap_element.HT_ext_caps = le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_ext_caps); ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ ++ /* update the MCS set */ ++ for (i = 0; i < 16; i++) ++ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= pmlmeext->default_supported_mcs_set[i]; ++ ++ /* update the MCS rates */ ++ switch (rf_type) { ++ case RF_1T1R: ++ case RF_1T2R: ++ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_1R); ++ break; ++ case RF_2T2R: ++#ifdef CONFIG_DISABLE_MCS13TO15 ++ if (pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && pregistrypriv->wifi_spec != 1) ++ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R_13TO15_OFF); ++ else ++ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); ++#else /* CONFIG_DISABLE_MCS13TO15 */ ++ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); ++#endif /* CONFIG_DISABLE_MCS13TO15 */ ++ break; ++ case RF_3T3R: ++ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_3R); ++ break; ++ default: ++ RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); ++ } ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ /* Config STBC setting */ ++ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAP_ELE_TX_STBC(pIE->data)) { ++ SET_FLAG(cur_stbc_cap, STBC_HT_ENABLE_TX); ++ RTW_INFO("Enable HT Tx STBC !\n"); ++ } ++ phtpriv->stbc_cap = cur_stbc_cap; ++ ++#ifdef CONFIG_BEAMFORMING ++ /* Config Tx beamforming setting */ ++ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && ++ GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pIE->data)) { ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); ++ /* Shift to BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP*/ ++ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(pIE->data) << 6); ++ } ++ ++ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && ++ GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(pIE->data)) { ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); ++ /* Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ ++ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pIE->data) << 4); ++ } ++ phtpriv->beamform_cap = cur_beamform_cap; ++ if (cur_beamform_cap) ++ RTW_INFO("AP HT Beamforming Cap = 0x%02X\n", cur_beamform_cap); ++#endif /*CONFIG_BEAMFORMING*/ ++ } else { ++ /*WIFI_STATION_STATEorI_ADHOC_STATE or WIFI_ADHOC_MASTER_STATE*/ ++ /* Config LDPC Coding Capability */ ++ if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX) && GET_HT_CAP_ELE_LDPC_CAP(pIE->data)) { ++ SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX)); ++ RTW_INFO("Enable HT Tx LDPC!\n"); ++ } ++ phtpriv->ldpc_cap = cur_ldpc_cap; ++ ++ /* Config STBC setting */ ++ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAP_ELE_RX_STBC(pIE->data)) { ++ SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX)); ++ RTW_INFO("Enable HT Tx STBC!\n"); ++ } ++ phtpriv->stbc_cap = cur_stbc_cap; ++ ++#ifdef CONFIG_BEAMFORMING ++ /* Config Tx beamforming setting */ ++ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && ++ GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pIE->data)) { ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); ++ /* Shift to BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP*/ ++ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(pIE->data) << 6); ++ } ++ ++ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && ++ GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(pIE->data)) { ++ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); ++ /* Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ ++ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pIE->data) << 4); ++ } ++ phtpriv->beamform_cap = cur_beamform_cap; ++ if (cur_beamform_cap) ++ RTW_INFO("Client HT Beamforming Cap = 0x%02X\n", cur_beamform_cap); ++#endif /*CONFIG_BEAMFORMING*/ ++ } ++ ++#endif /* CONFIG_80211N_HT */ ++} ++ ++void HT_info_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) ++{ ++#ifdef CONFIG_80211N_HT ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++ ++ if (pIE == NULL) ++ return; ++ ++ if (phtpriv->ht_option == _FALSE) ++ return; ++ ++ ++ if (pIE->Length > sizeof(struct HT_info_element)) ++ return; ++ ++ pmlmeinfo->HT_info_enable = 1; ++ _rtw_memcpy(&(pmlmeinfo->HT_info), pIE->data, pIE->Length); ++#endif /* CONFIG_80211N_HT */ ++ return; ++} ++ ++void HTOnAssocRsp(_adapter *padapter) ++{ ++ unsigned char max_AMPDU_len; ++ unsigned char min_MPDU_spacing; ++ /* struct registry_priv *pregpriv = &padapter->registrypriv; */ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable)) ++ pmlmeinfo->HT_enable = 1; ++ else { ++ pmlmeinfo->HT_enable = 0; ++ /* set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */ ++ return; ++ } ++ ++ /* handle A-MPDU parameter field */ ++ /* ++ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k ++ AMPDU_para [4:2]:Min MPDU Start Spacing ++ */ ++ max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; ++ ++ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2; ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MIN_SPACE, (u8 *)(&min_MPDU_spacing)); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len)); ++ ++#if 0 /* move to rtw_update_ht_cap() */ ++ if ((pregpriv->bw_mode > 0) && ++ (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & BIT(1)) && ++ (pmlmeinfo->HT_info.infos[0] & BIT(2))) { ++ /* switch to the 40M Hz mode accoring to the AP */ ++ pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; ++ switch ((pmlmeinfo->HT_info.infos[0] & 0x3)) { ++ case EXTCHNL_OFFSET_UPPER: ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ break; ++ ++ case EXTCHNL_OFFSET_LOWER: ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ ++ default: ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ } ++ } ++#endif ++ ++ /* set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */ ++ ++#if 0 /* move to rtw_update_ht_cap() */ ++ /* */ ++ /* Config SM Power Save setting */ ++ /* */ ++ pmlmeinfo->SM_PS = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & 0x0C) >> 2; ++ if (pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC) { ++#if 0 ++ u8 i; ++ /* update the MCS rates */ ++ for (i = 0; i < 16; i++) ++ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; ++#endif ++ RTW_INFO("%s(): WLAN_HT_CAP_SM_PS_STATIC\n", __FUNCTION__); ++ } ++ ++ /* */ ++ /* Config current HT Protection mode. */ ++ /* */ ++ pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; ++#endif ++ ++} ++ ++void ERP_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if (pIE->Length > 1) ++ return; ++ ++ pmlmeinfo->ERP_enable = 1; ++ _rtw_memcpy(&(pmlmeinfo->ERP_IE), pIE->data, pIE->Length); ++} ++ ++void VCS_update(_adapter *padapter, struct sta_info *psta) ++{ ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ switch (pregpriv->vrtl_carrier_sense) { /* 0:off 1:on 2:auto */ ++ case 0: /* off */ ++ psta->rtsen = 0; ++ psta->cts2self = 0; ++ break; ++ ++ case 1: /* on */ ++ if (pregpriv->vcs_type == 1) { /* 1:RTS/CTS 2:CTS to self */ ++ psta->rtsen = 1; ++ psta->cts2self = 0; ++ } else { ++ psta->rtsen = 0; ++ psta->cts2self = 1; ++ } ++ break; ++ ++ case 2: /* auto */ ++ default: ++ if (((pmlmeinfo->ERP_enable) && (pmlmeinfo->ERP_IE & BIT(1))) ++ /*||(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT)*/ ++ ) { ++ if (pregpriv->vcs_type == 1) { ++ psta->rtsen = 1; ++ psta->cts2self = 0; ++ } else { ++ psta->rtsen = 0; ++ psta->cts2self = 1; ++ } ++ } else { ++ psta->rtsen = 0; ++ psta->cts2self = 0; ++ } ++ break; ++ } ++} ++ ++void update_ldpc_stbc_cap(struct sta_info *psta) ++{ ++#ifdef CONFIG_80211N_HT ++ ++#ifdef CONFIG_80211AC_VHT ++ if (psta->vhtpriv.vht_option) { ++ if (TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX)) ++ psta->ldpc = 1; ++ ++ if (TEST_FLAG(psta->vhtpriv.stbc_cap, STBC_VHT_ENABLE_TX)) ++ psta->stbc = 1; ++ } else ++#endif /* CONFIG_80211AC_VHT */ ++ if (psta->htpriv.ht_option) { ++ if (TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_ENABLE_TX)) ++ psta->ldpc = 1; ++ ++ if (TEST_FLAG(psta->htpriv.stbc_cap, STBC_HT_ENABLE_TX)) ++ psta->stbc = 1; ++ } else { ++ psta->ldpc = 0; ++ psta->stbc = 0; ++ } ++ ++#endif /* CONFIG_80211N_HT */ ++} ++ ++ ++/* ++ * rtw_get_bcn_keys: get beacon keys from recv frame ++ * ++ * TODO: ++ * WLAN_EID_COUNTRY ++ * WLAN_EID_ERP_INFO ++ * WLAN_EID_CHANNEL_SWITCH ++ * WLAN_EID_PWR_CONSTRAINT ++ */ ++int rtw_get_bcn_keys(ADAPTER *Adapter, u8 *pframe, u32 packet_len, ++ struct beacon_keys *recv_beacon) ++{ ++ int left; ++ u16 capability; ++ unsigned char *pos; ++ struct rtw_ieee802_11_elems elems; ++ struct rtw_ieee80211_ht_cap *pht_cap = NULL; ++ struct HT_info_element *pht_info = NULL; ++ ++ _rtw_memset(recv_beacon, 0, sizeof(*recv_beacon)); ++ ++ /* checking capabilities */ ++ capability = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN + 10)); ++ ++ /* checking IEs */ ++ left = packet_len - sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_; ++ pos = pframe + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_; ++ if (rtw_ieee802_11_parse_elems(pos, left, &elems, 1) == ParseFailed) ++ return _FALSE; ++ ++ /* check bw and channel offset */ ++ if (elems.ht_capabilities) { ++ if (elems.ht_capabilities_len != sizeof(*pht_cap)) ++ return _FALSE; ++ ++ pht_cap = (struct rtw_ieee80211_ht_cap *) elems.ht_capabilities; ++ recv_beacon->ht_cap_info = pht_cap->cap_info; ++ } ++ ++ if (elems.ht_operation) { ++ if (elems.ht_operation_len != sizeof(*pht_info)) ++ return _FALSE; ++ ++ pht_info = (struct HT_info_element *) elems.ht_operation; ++ recv_beacon->ht_info_infos_0_sco = pht_info->infos[0] & 0x03; ++ } ++ ++ /* Checking for channel */ ++ if (elems.ds_params && elems.ds_params_len == sizeof(recv_beacon->bcn_channel)) ++ _rtw_memcpy(&recv_beacon->bcn_channel, elems.ds_params, ++ sizeof(recv_beacon->bcn_channel)); ++ else if (pht_info) ++ /* In 5G, some ap do not have DSSET IE checking HT info for channel */ ++ recv_beacon->bcn_channel = pht_info->primary_channel; ++ else { ++ /* we don't find channel IE, so don't check it */ ++ /* RTW_INFO("Oops: %s we don't find channel IE, so don't check it\n", __func__); */ ++ recv_beacon->bcn_channel = Adapter->mlmeextpriv.cur_channel; ++ } ++ ++ /* checking SSID */ ++ if (elems.ssid) { ++ if (elems.ssid_len > sizeof(recv_beacon->ssid)) ++ return _FALSE; ++ ++ _rtw_memcpy(recv_beacon->ssid, elems.ssid, elems.ssid_len); ++ recv_beacon->ssid_len = elems.ssid_len; ++ } else ++ ; /* means hidden ssid */ ++ ++ /* checking RSN first */ ++ if (elems.rsn_ie && elems.rsn_ie_len) { ++ recv_beacon->encryp_protocol = ENCRYP_PROTOCOL_WPA2; ++ rtw_parse_wpa2_ie(elems.rsn_ie - 2, elems.rsn_ie_len + 2, ++ &recv_beacon->group_cipher, &recv_beacon->pairwise_cipher, ++ &recv_beacon->is_8021x); ++ } ++ /* checking WPA secon */ ++ else if (elems.wpa_ie && elems.wpa_ie_len) { ++ recv_beacon->encryp_protocol = ENCRYP_PROTOCOL_WPA; ++ rtw_parse_wpa_ie(elems.wpa_ie - 2, elems.wpa_ie_len + 2, ++ &recv_beacon->group_cipher, &recv_beacon->pairwise_cipher, ++ &recv_beacon->is_8021x); ++ } else if (capability & BIT(4)) ++ recv_beacon->encryp_protocol = ENCRYP_PROTOCOL_WEP; ++ ++ return _TRUE; ++} ++ ++void rtw_dump_bcn_keys(struct beacon_keys *recv_beacon) ++{ ++ int i; ++ char *p; ++ u8 ssid[IW_ESSID_MAX_SIZE + 1]; ++ ++ _rtw_memcpy(ssid, recv_beacon->ssid, recv_beacon->ssid_len); ++ ssid[recv_beacon->ssid_len] = '\0'; ++ ++ RTW_INFO("%s: ssid = %s\n", __func__, ssid); ++ RTW_INFO("%s: channel = %x\n", __func__, recv_beacon->bcn_channel); ++ RTW_INFO("%s: ht_cap = %x\n", __func__, recv_beacon->ht_cap_info); ++ RTW_INFO("%s: ht_info_infos_0_sco = %x\n", __func__, recv_beacon->ht_info_infos_0_sco); ++ RTW_INFO("%s: sec=%d, group = %x, pair = %x, 8021X = %x\n", __func__, ++ recv_beacon->encryp_protocol, recv_beacon->group_cipher, ++ recv_beacon->pairwise_cipher, recv_beacon->is_8021x); ++} ++ ++int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len) ++{ ++#if 0 ++ unsigned int len; ++ unsigned char *p; ++ unsigned short val16, subtype; ++ struct wlan_network *cur_network = &(Adapter->mlmepriv.cur_network); ++ /* u8 wpa_ie[255],rsn_ie[255]; */ ++ u16 wpa_len = 0, rsn_len = 0; ++ u8 encryp_protocol = 0; ++ WLAN_BSSID_EX *bssid; ++ int group_cipher = 0, pairwise_cipher = 0, is_8021x = 0; ++ unsigned char *pbuf; ++ u32 wpa_ielen = 0; ++ u8 *pbssid = GetAddr3Ptr(pframe); ++ u32 hidden_ssid = 0; ++ u8 cur_network_type, network_type = 0; ++ struct HT_info_element *pht_info = NULL; ++ struct rtw_ieee80211_ht_cap *pht_cap = NULL; ++ u32 bcn_channel; ++ unsigned short ht_cap_info; ++ unsigned char ht_info_infos_0; ++#endif ++ unsigned int len; ++ u8 *pbssid = GetAddr3Ptr(pframe); ++ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ struct wlan_network *cur_network = &(Adapter->mlmepriv.cur_network); ++ struct beacon_keys recv_beacon; ++ ++ if (is_client_associated_to_ap(Adapter) == _FALSE) ++ return _TRUE; ++ ++ len = packet_len - sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ if (len > MAX_IE_SZ) { ++ RTW_INFO("%s IE too long for survey event\n", __func__); ++ return _FAIL; ++ } ++ ++ if (_rtw_memcmp(cur_network->network.MacAddress, pbssid, 6) == _FALSE) { ++ RTW_INFO("Oops: rtw_check_network_encrypt linked but recv other bssid bcn\n" MAC_FMT MAC_FMT, ++ MAC_ARG(pbssid), MAC_ARG(cur_network->network.MacAddress)); ++ return _TRUE; ++ } ++ ++ if (rtw_get_bcn_keys(Adapter, pframe, packet_len, &recv_beacon) == _FALSE) ++ return _TRUE; /* parsing failed => broken IE */ ++ ++ /* don't care hidden ssid, use current beacon ssid directly */ ++ if (recv_beacon.ssid_len == 0) { ++ _rtw_memcpy(recv_beacon.ssid, pmlmepriv->cur_beacon_keys.ssid, ++ pmlmepriv->cur_beacon_keys.ssid_len); ++ recv_beacon.ssid_len = pmlmepriv->cur_beacon_keys.ssid_len; ++ } ++ ++ if (_rtw_memcmp(&recv_beacon, &pmlmepriv->cur_beacon_keys, sizeof(recv_beacon)) == _TRUE) ++ pmlmepriv->new_beacon_cnts = 0; ++ else if ((pmlmepriv->new_beacon_cnts == 0) || ++ _rtw_memcmp(&recv_beacon, &pmlmepriv->new_beacon_keys, sizeof(recv_beacon)) == _FALSE) { ++ RTW_ERR("%s: start new beacon (seq=%d)\n", __func__, GetSequence(pframe)); ++ ++ if (pmlmepriv->new_beacon_cnts == 0) { ++ RTW_ERR("%s: cur beacon key\n", __func__); ++ RTW_DBG_EXPR(rtw_dump_bcn_keys(&pmlmepriv->cur_beacon_keys)); ++ } ++ ++ RTW_ERR("%s: new beacon key\n", __func__); ++ RTW_DBG_EXPR(rtw_dump_bcn_keys(&recv_beacon)); ++ ++ memcpy(&pmlmepriv->new_beacon_keys, &recv_beacon, sizeof(recv_beacon)); ++ pmlmepriv->new_beacon_cnts = 1; ++ } else { ++ RTW_ERR("%s: new beacon again (seq=%d)\n", __func__, GetSequence(pframe)); ++ pmlmepriv->new_beacon_cnts++; ++ } ++ ++ /* if counter >= max, it means beacon is changed really */ ++ if (pmlmepriv->new_beacon_cnts >= new_bcn_max) { ++ RTW_ERR("%s: new beacon occur!!\n", __func__); ++ ++ /* check bw mode change only? */ ++ pmlmepriv->cur_beacon_keys.ht_cap_info = recv_beacon.ht_cap_info; ++ pmlmepriv->cur_beacon_keys.ht_info_infos_0_sco = recv_beacon.ht_info_infos_0_sco; ++ ++ if (_rtw_memcmp(&recv_beacon, &pmlmepriv->cur_beacon_keys, ++ sizeof(recv_beacon)) == _FALSE) { ++ /* beacon is changed, have to do disconnect/connect */ ++ return _FAIL; ++ } ++ ++ RTW_INFO("%s bw mode change\n", __func__); ++ RTW_INFO("%s bcn now: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, ++ cur_network->BcnInfo.ht_cap_info, ++ cur_network->BcnInfo.ht_info_infos_0); ++ ++ cur_network->BcnInfo.ht_cap_info = recv_beacon.ht_cap_info; ++ cur_network->BcnInfo.ht_info_infos_0 = ++ (cur_network->BcnInfo.ht_info_infos_0 & (~0x03)) | ++ recv_beacon.ht_info_infos_0_sco; ++ ++ RTW_INFO("%s bcn link: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, ++ cur_network->BcnInfo.ht_cap_info, ++ cur_network->BcnInfo.ht_info_infos_0); ++ ++ memcpy(&pmlmepriv->cur_beacon_keys, &recv_beacon, sizeof(recv_beacon)); ++ pmlmepriv->new_beacon_cnts = 0; ++ } ++ ++ return _SUCCESS; ++ ++#if 0 ++ bssid = (WLAN_BSSID_EX *)rtw_zmalloc(sizeof(WLAN_BSSID_EX)); ++ if (bssid == NULL) { ++ RTW_INFO("%s rtw_zmalloc fail !!!\n", __func__); ++ return _TRUE; ++ } ++ ++ if ((pmlmepriv->timeBcnInfoChkStart != 0) && (rtw_get_passing_time_ms(pmlmepriv->timeBcnInfoChkStart) > DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS)) { ++ pmlmepriv->timeBcnInfoChkStart = 0; ++ pmlmepriv->NumOfBcnInfoChkFail = 0; ++ } ++ ++ subtype = GetFrameSubType(pframe) >> 4; ++ ++ if (subtype == WIFI_BEACON) ++ bssid->Reserved[0] = 1; ++ ++ bssid->Length = sizeof(WLAN_BSSID_EX) - MAX_IE_SZ + len; ++ ++ /* below is to copy the information element */ ++ bssid->IELength = len; ++ _rtw_memcpy(bssid->IEs, (pframe + sizeof(struct rtw_ieee80211_hdr_3addr)), bssid->IELength); ++ ++ /* check bw and channel offset */ ++ /* parsing HT_CAP_IE */ ++ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); ++ if (p && len > 0) { ++ pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); ++ ht_cap_info = pht_cap->cap_info; ++ } else ++ ht_cap_info = 0; ++ /* parsing HT_INFO_IE */ ++ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); ++ if (p && len > 0) { ++ pht_info = (struct HT_info_element *)(p + 2); ++ ht_info_infos_0 = pht_info->infos[0]; ++ } else ++ ht_info_infos_0 = 0; ++ if (ht_cap_info != cur_network->BcnInfo.ht_cap_info || ++ ((ht_info_infos_0 & 0x03) != (cur_network->BcnInfo.ht_info_infos_0 & 0x03))) { ++ RTW_INFO("%s bcn now: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, ++ ht_cap_info, ht_info_infos_0); ++ RTW_INFO("%s bcn link: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, ++ cur_network->BcnInfo.ht_cap_info, cur_network->BcnInfo.ht_info_infos_0); ++ RTW_INFO("%s bw mode change\n", __func__); ++ { ++ /* bcn_info_update */ ++ cur_network->BcnInfo.ht_cap_info = ht_cap_info; ++ cur_network->BcnInfo.ht_info_infos_0 = ht_info_infos_0; ++ /* to do : need to check that whether modify related register of BB or not */ ++ } ++ /* goto _mismatch; */ ++ } ++ ++ /* Checking for channel */ ++ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _DSSET_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); ++ if (p) ++ bcn_channel = *(p + 2); ++ else {/* In 5G, some ap do not have DSSET IE checking HT info for channel */ ++ rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); ++ if (pht_info) ++ bcn_channel = pht_info->primary_channel; ++ else { /* we don't find channel IE, so don't check it */ ++ /* RTW_INFO("Oops: %s we don't find channel IE, so don't check it\n", __func__); */ ++ bcn_channel = Adapter->mlmeextpriv.cur_channel; ++ } ++ } ++ if (bcn_channel != Adapter->mlmeextpriv.cur_channel) { ++ RTW_INFO("%s beacon channel:%d cur channel:%d disconnect\n", __func__, ++ bcn_channel, Adapter->mlmeextpriv.cur_channel); ++ goto _mismatch; ++ } ++ ++ /* checking SSID */ ++ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _SSID_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); ++ if (p == NULL) { ++ RTW_INFO("%s marc: cannot find SSID for survey event\n", __func__); ++ hidden_ssid = _TRUE; ++ } else ++ hidden_ssid = _FALSE; ++ ++ if ((NULL != p) && (_FALSE == hidden_ssid && (*(p + 1)))) { ++ _rtw_memcpy(bssid->Ssid.Ssid, (p + 2), *(p + 1)); ++ bssid->Ssid.SsidLength = *(p + 1); ++ } else { ++ bssid->Ssid.SsidLength = 0; ++ bssid->Ssid.Ssid[0] = '\0'; ++ } ++ ++ ++ if (_rtw_memcmp(bssid->Ssid.Ssid, cur_network->network.Ssid.Ssid, 32) == _FALSE || ++ bssid->Ssid.SsidLength != cur_network->network.Ssid.SsidLength) { ++ if (bssid->Ssid.Ssid[0] != '\0' && bssid->Ssid.SsidLength != 0) { /* not hidden ssid */ ++ RTW_INFO("%s(), SSID is not match\n", __func__); ++ goto _mismatch; ++ } ++ } ++ ++ /* check encryption info */ ++ val16 = rtw_get_capability((WLAN_BSSID_EX *)bssid); ++ ++ if (val16 & BIT(4)) ++ bssid->Privacy = 1; ++ else ++ bssid->Privacy = 0; ++ ++ if (cur_network->network.Privacy != bssid->Privacy) { ++ RTW_INFO("%s(), privacy is not match\n", __func__); ++ goto _mismatch; ++ } ++ ++ rtw_get_sec_ie(bssid->IEs, bssid->IELength, NULL, &rsn_len, NULL, &wpa_len); ++ ++ if (rsn_len > 0) ++ encryp_protocol = ENCRYP_PROTOCOL_WPA2; ++ else if (wpa_len > 0) ++ encryp_protocol = ENCRYP_PROTOCOL_WPA; ++ else { ++ if (bssid->Privacy) ++ encryp_protocol = ENCRYP_PROTOCOL_WEP; ++ } ++ ++ if (cur_network->BcnInfo.encryp_protocol != encryp_protocol) { ++ RTW_INFO("%s(): enctyp is not match\n", __func__); ++ goto _mismatch; ++ } ++ ++ if (encryp_protocol == ENCRYP_PROTOCOL_WPA || encryp_protocol == ENCRYP_PROTOCOL_WPA2) { ++ pbuf = rtw_get_wpa_ie(&bssid->IEs[12], &wpa_ielen, bssid->IELength - 12); ++ if (pbuf && (wpa_ielen > 0)) { ++ rtw_parse_wpa_ie(pbuf, wpa_ielen + 2, &group_cipher, &pairwise_cipher, &is_8021x); ++ } else { ++ pbuf = rtw_get_wpa2_ie(&bssid->IEs[12], &wpa_ielen, bssid->IELength - 12); ++ ++ if (pbuf && (wpa_ielen > 0)) { ++ rtw_parse_wpa2_ie(pbuf, wpa_ielen + 2, &group_cipher, &pairwise_cipher, &is_8021x); ++ } ++ } ++ ++ if (pairwise_cipher != cur_network->BcnInfo.pairwise_cipher || group_cipher != cur_network->BcnInfo.group_cipher) { ++ RTW_INFO("%s pairwise_cipher(%x:%x) or group_cipher(%x:%x) is not match\n", __func__, ++ pairwise_cipher, cur_network->BcnInfo.pairwise_cipher, ++ group_cipher, cur_network->BcnInfo.group_cipher); ++ goto _mismatch; ++ } ++ ++ if (is_8021x != cur_network->BcnInfo.is_8021x) { ++ RTW_INFO("%s authentication is not match\n", __func__); ++ goto _mismatch; ++ } ++ } ++ ++ rtw_mfree((u8 *)bssid, sizeof(WLAN_BSSID_EX)); ++ return _SUCCESS; ++ ++_mismatch: ++ rtw_mfree((u8 *)bssid, sizeof(WLAN_BSSID_EX)); ++ ++ if (pmlmepriv->NumOfBcnInfoChkFail == 0) ++ pmlmepriv->timeBcnInfoChkStart = rtw_get_current_time(); ++ ++ pmlmepriv->NumOfBcnInfoChkFail++; ++ RTW_INFO("%s by "ADPT_FMT" - NumOfChkFail = %d (SeqNum of this Beacon frame = %d).\n", __func__, ADPT_ARG(Adapter), pmlmepriv->NumOfBcnInfoChkFail, GetSequence(pframe)); ++ ++ if ((pmlmepriv->timeBcnInfoChkStart != 0) && (rtw_get_passing_time_ms(pmlmepriv->timeBcnInfoChkStart) <= DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS) ++ && (pmlmepriv->NumOfBcnInfoChkFail >= DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD)) { ++ RTW_INFO("%s by "ADPT_FMT" - NumOfChkFail = %d >= threshold : %d (in %d ms), return FAIL.\n", __func__, ADPT_ARG(Adapter), pmlmepriv->NumOfBcnInfoChkFail, ++ DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD, rtw_get_passing_time_ms(pmlmepriv->timeBcnInfoChkStart)); ++ pmlmepriv->timeBcnInfoChkStart = 0; ++ pmlmepriv->NumOfBcnInfoChkFail = 0; ++ return _FAIL; ++ } ++ ++ return _SUCCESS; ++#endif ++} ++ ++void update_beacon_info(_adapter *padapter, u8 *pframe, uint pkt_len, struct sta_info *psta) ++{ ++ unsigned int i; ++ unsigned int len; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ ++#ifdef CONFIG_TDLS ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ u8 tdls_prohibited[] = { 0x00, 0x00, 0x00, 0x00, 0x10 }; /* bit(38): TDLS_prohibited */ ++#endif /* CONFIG_TDLS */ ++ ++ len = pkt_len - (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN); ++ ++ for (i = 0; i < len;) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN) + i); ++ ++ switch (pIE->ElementID) { ++ case _VENDOR_SPECIFIC_IE_: ++ /* to update WMM paramter set while receiving beacon */ ++ if (_rtw_memcmp(pIE->data, WMM_PARA_OUI, 6) && pIE->Length == WLAN_WMM_LEN) /* WMM */ ++ (WMM_param_handler(padapter, pIE)) ? report_wmm_edca_update(padapter) : 0; ++ ++ break; ++ ++ case _HT_EXTRA_INFO_IE_: /* HT info */ ++ /* HT_info_handler(padapter, pIE); */ ++ bwmode_update_check(padapter, pIE); ++ break; ++#ifdef CONFIG_80211AC_VHT ++ case EID_OpModeNotification: ++ rtw_process_vht_op_mode_notify(padapter, pIE->data, psta); ++ break; ++#endif /* CONFIG_80211AC_VHT */ ++ case _ERPINFO_IE_: ++ ERP_IE_handler(padapter, pIE); ++ VCS_update(padapter, psta); ++ break; ++ ++#ifdef CONFIG_TDLS ++ case _EXT_CAP_IE_: ++ if (check_ap_tdls_prohibited(pIE->data, pIE->Length) == _TRUE) ++ ptdlsinfo->ap_prohibited = _TRUE; ++ if (check_ap_tdls_ch_switching_prohibited(pIE->data, pIE->Length) == _TRUE) ++ ptdlsinfo->ch_switch_prohibited = _TRUE; ++ break; ++#endif /* CONFIG_TDLS */ ++ default: ++ break; ++ } ++ ++ i += (pIE->Length + 2); ++ } ++} ++ ++#ifdef CONFIG_DFS ++void process_csa_ie(_adapter *padapter, u8 *pframe, uint pkt_len) ++{ ++ unsigned int i; ++ unsigned int len; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 new_ch_no = 0; ++ ++ if (padapter->mlmepriv.handle_dfs == _TRUE) ++ return; ++ ++ len = pkt_len - (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN); ++ ++ for (i = 0; i < len;) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN) + i); ++ ++ switch (pIE->ElementID) { ++ case _CH_SWTICH_ANNOUNCE_: ++ padapter->mlmepriv.handle_dfs = _TRUE; ++ _rtw_memcpy(&new_ch_no, pIE->data + 1, 1); ++ rtw_set_csa_cmd(padapter, new_ch_no); ++ break; ++ default: ++ break; ++ } ++ ++ i += (pIE->Length + 2); ++ } ++} ++#endif /* CONFIG_DFS */ ++ ++unsigned int is_ap_in_tkip(_adapter *padapter) ++{ ++ u32 i; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ ++ if (rtw_get_capability((WLAN_BSSID_EX *)cur_network) & WLAN_CAPABILITY_PRIVACY) { ++ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pmlmeinfo->network.IELength;) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(pmlmeinfo->network.IEs + i); ++ ++ switch (pIE->ElementID) { ++ case _VENDOR_SPECIFIC_IE_: ++ if ((_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4)) && (_rtw_memcmp((pIE->data + 12), WPA_TKIP_CIPHER, 4))) ++ return _TRUE; ++ break; ++ ++ case _RSN_IE_2_: ++ if (_rtw_memcmp((pIE->data + 8), RSN_TKIP_CIPHER, 4)) ++ return _TRUE; ++ ++ default: ++ break; ++ } ++ ++ i += (pIE->Length + 2); ++ } ++ ++ return _FALSE; ++ } else ++ return _FALSE; ++ ++} ++ ++unsigned int should_forbid_n_rate(_adapter *padapter) ++{ ++ u32 i; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ WLAN_BSSID_EX *cur_network = &pmlmepriv->cur_network.network; ++ ++ if (rtw_get_capability((WLAN_BSSID_EX *)cur_network) & WLAN_CAPABILITY_PRIVACY) { ++ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < cur_network->IELength;) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(cur_network->IEs + i); ++ ++ switch (pIE->ElementID) { ++ case _VENDOR_SPECIFIC_IE_: ++ if (_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4) && ++ ((_rtw_memcmp((pIE->data + 12), WPA_CIPHER_SUITE_CCMP, 4)) || ++ (_rtw_memcmp((pIE->data + 16), WPA_CIPHER_SUITE_CCMP, 4)))) ++ return _FALSE; ++ break; ++ ++ case _RSN_IE_2_: ++ if ((_rtw_memcmp((pIE->data + 8), RSN_CIPHER_SUITE_CCMP, 4)) || ++ (_rtw_memcmp((pIE->data + 12), RSN_CIPHER_SUITE_CCMP, 4))) ++ return _FALSE; ++ ++ default: ++ break; ++ } ++ ++ i += (pIE->Length + 2); ++ } ++ ++ return _TRUE; ++ } else ++ return _FALSE; ++ ++} ++ ++ ++unsigned int is_ap_in_wep(_adapter *padapter) ++{ ++ u32 i; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ ++ if (rtw_get_capability((WLAN_BSSID_EX *)cur_network) & WLAN_CAPABILITY_PRIVACY) { ++ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pmlmeinfo->network.IELength;) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(pmlmeinfo->network.IEs + i); ++ ++ switch (pIE->ElementID) { ++ case _VENDOR_SPECIFIC_IE_: ++ if (_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4)) ++ return _FALSE; ++ break; ++ ++ case _RSN_IE_2_: ++ return _FALSE; ++ ++ default: ++ break; ++ } ++ ++ i += (pIE->Length + 2); ++ } ++ ++ return _TRUE; ++ } else ++ return _FALSE; ++ ++} ++ ++int wifirate2_ratetbl_inx(unsigned char rate); ++int wifirate2_ratetbl_inx(unsigned char rate) ++{ ++ int inx = 0; ++ rate = rate & 0x7f; ++ ++ switch (rate) { ++ case 54*2: ++ inx = 11; ++ break; ++ ++ case 48*2: ++ inx = 10; ++ break; ++ ++ case 36*2: ++ inx = 9; ++ break; ++ ++ case 24*2: ++ inx = 8; ++ break; ++ ++ case 18*2: ++ inx = 7; ++ break; ++ ++ case 12*2: ++ inx = 6; ++ break; ++ ++ case 9*2: ++ inx = 5; ++ break; ++ ++ case 6*2: ++ inx = 4; ++ break; ++ ++ case 11*2: ++ inx = 3; ++ break; ++ case 11: ++ inx = 2; ++ break; ++ ++ case 2*2: ++ inx = 1; ++ break; ++ ++ case 1*2: ++ inx = 0; ++ break; ++ ++ } ++ return inx; ++} ++ ++unsigned int update_basic_rate(unsigned char *ptn, unsigned int ptn_sz) ++{ ++ unsigned int i, num_of_rate; ++ unsigned int mask = 0; ++ ++ num_of_rate = (ptn_sz > NumRates) ? NumRates : ptn_sz; ++ ++ for (i = 0; i < num_of_rate; i++) { ++ if ((*(ptn + i)) & 0x80) ++ mask |= 0x1 << wifirate2_ratetbl_inx(*(ptn + i)); ++ } ++ return mask; ++} ++ ++unsigned int update_supported_rate(unsigned char *ptn, unsigned int ptn_sz) ++{ ++ unsigned int i, num_of_rate; ++ unsigned int mask = 0; ++ ++ num_of_rate = (ptn_sz > NumRates) ? NumRates : ptn_sz; ++ ++ for (i = 0; i < num_of_rate; i++) ++ mask |= 0x1 << wifirate2_ratetbl_inx(*(ptn + i)); ++ ++ return mask; ++} ++ ++unsigned int update_MCS_rate(struct HT_caps_element *pHT_caps) ++{ ++ unsigned int mask = 0; ++ ++ mask = ((pHT_caps->u.HT_cap_element.MCS_rate[0] << 12) | (pHT_caps->u.HT_cap_element.MCS_rate[1] << 20)); ++ ++ return mask; ++} ++ ++int support_short_GI(_adapter *padapter, struct HT_caps_element *pHT_caps, u8 bwmode) ++{ ++ unsigned char bit_offset; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if (!(pmlmeinfo->HT_enable)) ++ return _FAIL; ++ ++ bit_offset = (bwmode & CHANNEL_WIDTH_40) ? 6 : 5; ++ ++ if (pHT_caps->u.HT_cap_element.HT_caps_info & (0x1 << bit_offset)) ++ return _SUCCESS; ++ else ++ return _FAIL; ++} ++ ++unsigned char get_highest_rate_idx(u32 mask) ++{ ++ int i; ++ unsigned char rate_idx = 0; ++ ++ for (i = 31; i >= 0; i--) { ++ if (mask & BIT(i)) { ++ rate_idx = i; ++ break; ++ } ++ } ++ ++ return rate_idx; ++} ++ ++unsigned char get_highest_mcs_rate(struct HT_caps_element *pHT_caps); ++unsigned char get_highest_mcs_rate(struct HT_caps_element *pHT_caps) ++{ ++ int i, mcs_rate; ++ ++ mcs_rate = (pHT_caps->u.HT_cap_element.MCS_rate[0] | (pHT_caps->u.HT_cap_element.MCS_rate[1] << 8)); ++ ++ for (i = 15; i >= 0; i--) { ++ if (mcs_rate & (0x1 << i)) ++ break; ++ } ++ ++ return i; ++} ++ ++void Update_RA_Entry(_adapter *padapter, struct sta_info *psta) ++{ ++ rtw_hal_update_ra_mask(psta, psta->rssi_level); ++} ++ ++void set_sta_rate(_adapter *padapter, struct sta_info *psta) ++{ ++ /* rate adaptive */ ++ rtw_hal_update_ra_mask(psta, psta->rssi_level); ++} ++ ++/* Update RRSR and Rate for USERATE */ ++void update_tx_basic_rate(_adapter *padapter, u8 wirelessmode) ++{ ++ NDIS_802_11_RATES_EX supported_rates; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ ++ /* Added by Albert 2011/03/22 */ ++ /* In the P2P mode, the driver should not support the b mode. */ ++ /* So, the Tx packet shouldn't use the CCK rate */ ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ return; ++#endif /* CONFIG_P2P */ ++#ifdef CONFIG_INTEL_WIDI ++ if (padapter->mlmepriv.widi_state != INTEL_WIDI_STATE_NONE) ++ return; ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ _rtw_memset(supported_rates, 0, NDIS_802_11_LENGTH_RATES_EX); ++ ++ /* clear B mod if current channel is in 5G band, avoid tx cck rate in 5G band. */ ++ if (pmlmeext->cur_channel > 14) ++ wirelessmode &= ~(WIRELESS_11B); ++ ++ if ((wirelessmode & WIRELESS_11B) && (wirelessmode == WIRELESS_11B)) ++ _rtw_memcpy(supported_rates, rtw_basic_rate_cck, 4); ++ else if (wirelessmode & WIRELESS_11B) ++ _rtw_memcpy(supported_rates, rtw_basic_rate_mix, 7); ++ else ++ _rtw_memcpy(supported_rates, rtw_basic_rate_ofdm, 3); ++ ++ if (wirelessmode & WIRELESS_11B) ++ update_mgnt_tx_rate(padapter, IEEE80211_CCK_RATE_1MB); ++ else ++ update_mgnt_tx_rate(padapter, IEEE80211_OFDM_RATE_6MB); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, supported_rates); ++} ++ ++unsigned char check_assoc_AP(u8 *pframe, uint len) ++{ ++ unsigned int i; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ ++ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < len;) { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + i); ++ ++ switch (pIE->ElementID) { ++ case _VENDOR_SPECIFIC_IE_: ++ if ((_rtw_memcmp(pIE->data, ARTHEROS_OUI1, 3)) || (_rtw_memcmp(pIE->data, ARTHEROS_OUI2, 3))) { ++ RTW_INFO("link to Artheros AP\n"); ++ return HT_IOT_PEER_ATHEROS; ++ } else if ((_rtw_memcmp(pIE->data, BROADCOM_OUI1, 3)) ++ || (_rtw_memcmp(pIE->data, BROADCOM_OUI2, 3)) ++ || (_rtw_memcmp(pIE->data, BROADCOM_OUI3, 3))) { ++ RTW_INFO("link to Broadcom AP\n"); ++ return HT_IOT_PEER_BROADCOM; ++ } else if (_rtw_memcmp(pIE->data, MARVELL_OUI, 3)) { ++ RTW_INFO("link to Marvell AP\n"); ++ return HT_IOT_PEER_MARVELL; ++ } else if (_rtw_memcmp(pIE->data, RALINK_OUI, 3)) { ++ RTW_INFO("link to Ralink AP\n"); ++ return HT_IOT_PEER_RALINK; ++ } else if (_rtw_memcmp(pIE->data, CISCO_OUI, 3)) { ++ RTW_INFO("link to Cisco AP\n"); ++ return HT_IOT_PEER_CISCO; ++ } else if (_rtw_memcmp(pIE->data, REALTEK_OUI, 3)) { ++ u32 Vender = HT_IOT_PEER_REALTEK; ++#ifdef CONFIG_80211N_HT ++ if (pIE->Length >= 5) { ++ if (pIE->data[4] == 1) { ++ /* if(pIE->data[5] & RT_HT_CAP_USE_LONG_PREAMBLE) */ ++ /* bssDesc->BssHT.RT2RT_HT_Mode |= RT_HT_CAP_USE_LONG_PREAMBLE; */ ++ ++ if (pIE->data[5] & RT_HT_CAP_USE_92SE) { ++ /* bssDesc->BssHT.RT2RT_HT_Mode |= RT_HT_CAP_USE_92SE; */ ++ Vender = HT_IOT_PEER_REALTEK_92SE; ++ } ++ } ++ ++ if (pIE->data[5] & RT_HT_CAP_USE_SOFTAP) ++ Vender = HT_IOT_PEER_REALTEK_SOFTAP; ++ ++ if (pIE->data[4] == 2) { ++ if (pIE->data[6] & RT_HT_CAP_USE_JAGUAR_BCUT) { ++ Vender = HT_IOT_PEER_REALTEK_JAGUAR_BCUTAP; ++ RTW_INFO("link to Realtek JAGUAR_BCUTAP\n"); ++ } ++ if (pIE->data[6] & RT_HT_CAP_USE_JAGUAR_CCUT) { ++ Vender = HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP; ++ RTW_INFO("link to Realtek JAGUAR_CCUTAP\n"); ++ } ++ } ++ } ++#endif ++ RTW_INFO("link to Realtek AP\n"); ++ return Vender; ++ } else if (_rtw_memcmp(pIE->data, AIRGOCAP_OUI, 3)) { ++ RTW_INFO("link to Airgo Cap\n"); ++ return HT_IOT_PEER_AIRGO; ++ } else ++ break; ++ ++ default: ++ break; ++ } ++ ++ i += (pIE->Length + 2); ++ } ++ ++ RTW_INFO("link to new AP\n"); ++ return HT_IOT_PEER_UNKNOWN; ++} ++ ++void update_capinfo(PADAPTER Adapter, u16 updateCap) ++{ ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ BOOLEAN ShortPreamble; ++ ++ /* Check preamble mode, 2005.01.06, by rcnjko. */ ++ /* Mark to update preamble value forever, 2008.03.18 by lanhsin */ ++ /* if( pMgntInfo->RegPreambleMode == PREAMBLE_AUTO ) */ ++ { ++ ++ if (updateCap & cShortPreamble) { ++ /* Short Preamble */ ++ if (pmlmeinfo->preamble_mode != PREAMBLE_SHORT) { /* PREAMBLE_LONG or PREAMBLE_AUTO */ ++ ShortPreamble = _TRUE; ++ pmlmeinfo->preamble_mode = PREAMBLE_SHORT; ++ rtw_hal_set_hwreg(Adapter, HW_VAR_ACK_PREAMBLE, (u8 *)&ShortPreamble); ++ } ++ } else { ++ /* Long Preamble */ ++ if (pmlmeinfo->preamble_mode != PREAMBLE_LONG) { /* PREAMBLE_SHORT or PREAMBLE_AUTO */ ++ ShortPreamble = _FALSE; ++ pmlmeinfo->preamble_mode = PREAMBLE_LONG; ++ rtw_hal_set_hwreg(Adapter, HW_VAR_ACK_PREAMBLE, (u8 *)&ShortPreamble); ++ } ++ } ++ } ++ ++ if (updateCap & cIBSS) { ++ /* Filen: See 802.11-2007 p.91 */ ++ pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; ++ } else { ++ /* Filen: See 802.11-2007 p.90 */ ++ if (pmlmeext->cur_wireless_mode & (WIRELESS_11_24N | WIRELESS_11A | WIRELESS_11_5N | WIRELESS_11AC)) ++ pmlmeinfo->slotTime = SHORT_SLOT_TIME; ++ else if (pmlmeext->cur_wireless_mode & (WIRELESS_11G)) { ++ if ((updateCap & cShortSlotTime) /* && (!(pMgntInfo->pHTInfo->RT2RT_HT_Mode & RT_HT_CAP_USE_LONG_PREAMBLE)) */) { ++ /* Short Slot Time */ ++ pmlmeinfo->slotTime = SHORT_SLOT_TIME; ++ } else { ++ /* Long Slot Time */ ++ pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; ++ } ++ } else { ++ /* B Mode */ ++ pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; ++ } ++ } ++ ++ rtw_hal_set_hwreg(Adapter, HW_VAR_SLOT_TIME, &pmlmeinfo->slotTime); ++ ++} ++ ++/* ++* set adapter.mlmeextpriv.mlmext_info.HT_enable ++* set adapter.mlmeextpriv.cur_wireless_mode ++* set SIFS register ++* set mgmt tx rate ++*/ ++void update_wireless_mode(_adapter *padapter) ++{ ++ int ratelen, network_type = 0; ++ u32 SIFS_Timer; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ unsigned char *rate = cur_network->SupportedRates; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif /* CONFIG_P2P */ ++ ++ ratelen = rtw_get_rateset_len(cur_network->SupportedRates); ++ ++ if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable)) ++ pmlmeinfo->HT_enable = 1; ++ ++ if (pmlmeext->cur_channel > 14) { ++ if (pmlmeinfo->VHT_enable) ++ network_type = WIRELESS_11AC; ++ else if (pmlmeinfo->HT_enable) ++ network_type = WIRELESS_11_5N; ++ ++ network_type |= WIRELESS_11A; ++ } else { ++ if (pmlmeinfo->VHT_enable) ++ network_type = WIRELESS_11AC; ++ else if (pmlmeinfo->HT_enable) ++ network_type = WIRELESS_11_24N; ++ ++ if ((cckratesonly_included(rate, ratelen)) == _TRUE) ++ network_type |= WIRELESS_11B; ++ else if ((cckrates_included(rate, ratelen)) == _TRUE) ++ network_type |= WIRELESS_11BG; ++ else ++ network_type |= WIRELESS_11G; ++ } ++ ++ pmlmeext->cur_wireless_mode = network_type & padapter->registrypriv.wireless_mode; ++ /* RTW_INFO("network_type=%02x, padapter->registrypriv.wireless_mode=%02x\n", network_type, padapter->registrypriv.wireless_mode); */ ++#if 0 ++ if ((pmlmeext->cur_wireless_mode == WIRELESS_11G) || ++ (pmlmeext->cur_wireless_mode == WIRELESS_11BG)) /* WIRELESS_MODE_G) */ ++ SIFS_Timer = 0x0a0a;/* CCK */ ++ else ++ SIFS_Timer = 0x0e0e;/* pHalData->SifsTime; //OFDM */ ++#endif ++ ++ SIFS_Timer = 0x0a0a0808; /* 0x0808->for CCK, 0x0a0a->for OFDM ++ * change this value if having IOT issues. */ ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_RESP_SIFS, (u8 *)&SIFS_Timer); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_WIRELESS_MODE, (u8 *)&(pmlmeext->cur_wireless_mode)); ++ ++ if ((pmlmeext->cur_wireless_mode & WIRELESS_11B) ++ #ifdef CONFIG_P2P ++ && (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) ++ #ifdef CONFIG_IOCTL_CFG80211 ++ || !rtw_cfg80211_iface_has_p2p_group_cap(padapter) ++ #endif ++ ) ++ #endif ++ ) ++ update_mgnt_tx_rate(padapter, IEEE80211_CCK_RATE_1MB); ++ else ++ update_mgnt_tx_rate(padapter, IEEE80211_OFDM_RATE_6MB); ++} ++ ++void fire_write_MAC_cmd(_adapter *padapter, unsigned int addr, unsigned int value); ++void fire_write_MAC_cmd(_adapter *padapter, unsigned int addr, unsigned int value) ++{ ++#if 0 ++ struct cmd_obj *ph2c; ++ struct reg_rw_parm *pwriteMacPara; ++ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); ++ ++ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if (ph2c == NULL) ++ return; ++ ++ pwriteMacPara = (struct reg_rw_parm *)rtw_malloc(sizeof(struct reg_rw_parm)); ++ if (pwriteMacPara == NULL) { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ return; ++ } ++ ++ pwriteMacPara->rw = 1; ++ pwriteMacPara->addr = addr; ++ pwriteMacPara->value = value; ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pwriteMacPara, GEN_CMD_CODE(_Write_MACREG)); ++ rtw_enqueue_cmd(pcmdpriv, ph2c); ++#endif ++} ++ ++void update_sta_basic_rate(struct sta_info *psta, u8 wireless_mode) ++{ ++ if (IsSupportedTxCCK(wireless_mode)) { ++ /* Only B, B/G, and B/G/N AP could use CCK rate */ ++ _rtw_memcpy(psta->bssrateset, rtw_basic_rate_cck, 4); ++ psta->bssratelen = 4; ++ } else { ++ _rtw_memcpy(psta->bssrateset, rtw_basic_rate_ofdm, 3); ++ psta->bssratelen = 3; ++ } ++} ++ ++int rtw_ies_get_supported_rate(u8 *ies, uint ies_len, u8 *rate_set, u8 *rate_num) ++{ ++ u8 *ie; ++ unsigned int ie_len; ++ ++ if (!rate_set || !rate_num) ++ return _FALSE; ++ ++ *rate_num = 0; ++ ++ ie = rtw_get_ie(ies, _SUPPORTEDRATES_IE_, &ie_len, ies_len); ++ if (ie == NULL) ++ goto ext_rate; ++ ++ _rtw_memcpy(rate_set, ie + 2, ie_len); ++ *rate_num = ie_len; ++ ++ext_rate: ++ ie = rtw_get_ie(ies, _EXT_SUPPORTEDRATES_IE_, &ie_len, ies_len); ++ if (ie) { ++ _rtw_memcpy(rate_set + *rate_num, ie + 2, ie_len); ++ *rate_num += ie_len; ++ } ++ ++ if (*rate_num == 0) ++ return _FAIL; ++ ++ if (0) { ++ int i; ++ ++ for (i = 0; i < *rate_num; i++) ++ RTW_INFO("rate:0x%02x\n", *(rate_set + i)); ++ } ++ ++ return _SUCCESS; ++} ++ ++void process_addba_req(_adapter *padapter, u8 *paddba_req, u8 *addr) ++{ ++ struct sta_info *psta; ++ u16 tid, start_seq, param; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct ADDBA_request *preq = (struct ADDBA_request *)paddba_req; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 size, accept = _FALSE; ++ ++ psta = rtw_get_stainfo(pstapriv, addr); ++ if (!psta) ++ goto exit; ++ ++ start_seq = le16_to_cpu(preq->BA_starting_seqctrl) >> 4; ++ ++ param = le16_to_cpu(preq->BA_para_set); ++ tid = (param >> 2) & 0x0f; ++ ++ ++ accept = rtw_rx_ampdu_is_accept(padapter); ++ size = rtw_rx_ampdu_size(padapter); ++ ++ if (accept == _TRUE) ++ rtw_addbarsp_cmd(padapter, addr, tid, 0, size, start_seq); ++ else ++ rtw_addbarsp_cmd(padapter, addr, tid, 37, size, start_seq); /* reject ADDBA Req */ ++ ++exit: ++ return; ++} ++ ++void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len) ++{ ++ u8 *pIE; ++ u32 *pbuf; ++ ++ pIE = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); ++ pbuf = (u32 *)pIE; ++ ++ pmlmeext->TSFValue = le32_to_cpu(*(pbuf + 1)); ++ ++ pmlmeext->TSFValue = pmlmeext->TSFValue << 32; ++ ++ pmlmeext->TSFValue |= le32_to_cpu(*pbuf); ++} ++ ++void correct_TSF(_adapter *padapter, struct mlme_ext_priv *pmlmeext) ++{ ++ rtw_hal_set_hwreg(padapter, HW_VAR_CORRECT_TSF, 0); ++} ++ ++void adaptive_early_32k(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len) ++{ ++ int i; ++ u8 *pIE; ++ u32 *pbuf; ++ u64 tsf = 0; ++ u32 delay_ms; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ ++ pmlmeext->bcn_cnt++; ++ ++ pIE = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); ++ pbuf = (u32 *)pIE; ++ ++ tsf = le32_to_cpu(*(pbuf + 1)); ++ tsf = tsf << 32; ++ tsf |= le32_to_cpu(*pbuf); ++ ++ /* RTW_INFO("%s(): tsf_upper= 0x%08x, tsf_lower=0x%08x\n", __func__, (u32)(tsf>>32), (u32)tsf); */ ++ ++ /* delay = (timestamp mod 1024*100)/1000 (unit: ms) */ ++ /* delay_ms = do_div(tsf, (pmlmeinfo->bcn_interval*1024))/1000; */ ++ delay_ms = rtw_modular64(tsf, (pmlmeinfo->bcn_interval * 1024)); ++ delay_ms = delay_ms / 1000; ++ ++ if (delay_ms >= 8) { ++ pmlmeext->bcn_delay_cnt[8]++; ++ /* pmlmeext->bcn_delay_ratio[8] = (pmlmeext->bcn_delay_cnt[8] * 100) /pmlmeext->bcn_cnt; */ ++ } else { ++ pmlmeext->bcn_delay_cnt[delay_ms]++; ++ /* pmlmeext->bcn_delay_ratio[delay_ms] = (pmlmeext->bcn_delay_cnt[delay_ms] * 100) /pmlmeext->bcn_cnt; */ ++ } ++ ++ /* ++ RTW_INFO("%s(): (a)bcn_cnt = %d\n", __func__, pmlmeext->bcn_cnt); ++ ++ ++ for(i=0; i<9; i++) ++ { ++ RTW_INFO("%s():bcn_delay_cnt[%d]=%d, bcn_delay_ratio[%d]=%d\n", __func__, i, ++ pmlmeext->bcn_delay_cnt[i] , i, pmlmeext->bcn_delay_ratio[i]); ++ } ++ */ ++ ++ /* dump for adaptive_early_32k */ ++ if (pmlmeext->bcn_cnt > 100 && (pmlmeext->adaptive_tsf_done == _TRUE)) { ++ u8 ratio_20_delay, ratio_80_delay; ++ u8 DrvBcnEarly, DrvBcnTimeOut; ++ ++ ratio_20_delay = 0; ++ ratio_80_delay = 0; ++ DrvBcnEarly = 0xff; ++ DrvBcnTimeOut = 0xff; ++ ++ RTW_INFO("%s(): bcn_cnt = %d\n", __func__, pmlmeext->bcn_cnt); ++ ++ for (i = 0; i < 9; i++) { ++ pmlmeext->bcn_delay_ratio[i] = (pmlmeext->bcn_delay_cnt[i] * 100) / pmlmeext->bcn_cnt; ++ ++ ++ /* RTW_INFO("%s():bcn_delay_cnt[%d]=%d, bcn_delay_ratio[%d]=%d\n", __func__, i, */ ++ /* pmlmeext->bcn_delay_cnt[i] , i, pmlmeext->bcn_delay_ratio[i]); */ ++ ++ ratio_20_delay += pmlmeext->bcn_delay_ratio[i]; ++ ratio_80_delay += pmlmeext->bcn_delay_ratio[i]; ++ ++ if (ratio_20_delay > 20 && DrvBcnEarly == 0xff) { ++ DrvBcnEarly = i; ++ /* RTW_INFO("%s(): DrvBcnEarly = %d\n", __func__, DrvBcnEarly); */ ++ } ++ ++ if (ratio_80_delay > 80 && DrvBcnTimeOut == 0xff) { ++ DrvBcnTimeOut = i; ++ /* RTW_INFO("%s(): DrvBcnTimeOut = %d\n", __func__, DrvBcnTimeOut); */ ++ } ++ ++ /* reset adaptive_early_32k cnt */ ++ pmlmeext->bcn_delay_cnt[i] = 0; ++ pmlmeext->bcn_delay_ratio[i] = 0; ++ } ++ ++ pmlmeext->DrvBcnEarly = DrvBcnEarly; ++ pmlmeext->DrvBcnTimeOut = DrvBcnTimeOut; ++ ++ pmlmeext->bcn_cnt = 0; ++ } ++ ++} ++ ++ ++void beacon_timing_control(_adapter *padapter) ++{ ++ rtw_hal_bcn_related_reg_setting(padapter); ++} ++ ++#define CONFIG_SHARED_BMC_MACID ++ ++void dump_macid_map(void *sel, struct macid_bmp *map, u8 max_num) ++{ ++ RTW_PRINT_SEL(sel, "0x%08x\n", map->m0); ++#if (MACID_NUM_SW_LIMIT > 32) ++ if (max_num && max_num > 32) ++ RTW_PRINT_SEL(sel, "0x%08x\n", map->m1); ++#endif ++#if (MACID_NUM_SW_LIMIT > 64) ++ if (max_num && max_num > 64) ++ RTW_PRINT_SEL(sel, "0x%08x\n", map->m2); ++#endif ++#if (MACID_NUM_SW_LIMIT > 96) ++ if (max_num && max_num > 96) ++ RTW_PRINT_SEL(sel, "0x%08x\n", map->m3); ++#endif ++} ++ ++inline bool rtw_macid_is_set(struct macid_bmp *map, u8 id) ++{ ++ if (id < 32) ++ return map->m0 & BIT(id); ++#if (MACID_NUM_SW_LIMIT > 32) ++ else if (id < 64) ++ return map->m1 & BIT(id - 32); ++#endif ++#if (MACID_NUM_SW_LIMIT > 64) ++ else if (id < 96) ++ return map->m2 & BIT(id - 64); ++#endif ++#if (MACID_NUM_SW_LIMIT > 96) ++ else if (id < 128) ++ return map->m3 & BIT(id - 96); ++#endif ++ else ++ rtw_warn_on(1); ++ ++ return 0; ++} ++ ++inline void rtw_macid_map_set(struct macid_bmp *map, u8 id) ++{ ++ if (id < 32) ++ map->m0 |= BIT(id); ++#if (MACID_NUM_SW_LIMIT > 32) ++ else if (id < 64) ++ map->m1 |= BIT(id - 32); ++#endif ++#if (MACID_NUM_SW_LIMIT > 64) ++ else if (id < 96) ++ map->m2 |= BIT(id - 64); ++#endif ++#if (MACID_NUM_SW_LIMIT > 96) ++ else if (id < 128) ++ map->m3 |= BIT(id - 96); ++#endif ++ else ++ rtw_warn_on(1); ++} ++ ++/*Record bc's mac-id and sec-cam-id*/ ++inline void rtw_iface_bcmc_id_set(_adapter *padapter, u8 mac_id) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ ++ macid_ctl->iface_bmc[padapter->iface_id] = mac_id; ++} ++inline u8 rtw_iface_bcmc_id_get(_adapter *padapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ ++ return macid_ctl->iface_bmc[padapter->iface_id]; ++} ++ ++inline void rtw_macid_map_clr(struct macid_bmp *map, u8 id) ++{ ++ if (id < 32) ++ map->m0 &= ~BIT(id); ++#if (MACID_NUM_SW_LIMIT > 32) ++ else if (id < 64) ++ map->m1 &= ~BIT(id - 32); ++#endif ++#if (MACID_NUM_SW_LIMIT > 64) ++ else if (id < 96) ++ map->m2 &= ~BIT(id - 64); ++#endif ++#if (MACID_NUM_SW_LIMIT > 96) ++ else if (id < 128) ++ map->m3 &= ~BIT(id - 96); ++#endif ++ else ++ rtw_warn_on(1); ++} ++ ++inline bool rtw_macid_is_used(struct macid_ctl_t *macid_ctl, u8 id) ++{ ++ return rtw_macid_is_set(&macid_ctl->used, id); ++} ++ ++inline bool rtw_macid_is_bmc(struct macid_ctl_t *macid_ctl, u8 id) ++{ ++ return rtw_macid_is_set(&macid_ctl->bmc, id); ++} ++ ++inline s8 rtw_macid_get_if_g(struct macid_ctl_t *macid_ctl, u8 id) ++{ ++ int i; ++ ++#ifdef CONFIG_SHARED_BMC_MACID ++ if (rtw_macid_is_bmc(macid_ctl, id)) { ++ for (i = 0; i < CONFIG_IFACE_NUMBER; i++) ++ if (macid_ctl->iface_bmc[i] == id) ++ return i; ++ return -1; ++ } ++#endif ++ ++ for (i = 0; i < CONFIG_IFACE_NUMBER; i++) { ++ if (rtw_macid_is_set(&macid_ctl->if_g[i], id)) ++ return i; ++ } ++ return -1; ++} ++ ++inline s8 rtw_macid_get_ch_g(struct macid_ctl_t *macid_ctl, u8 id) ++{ ++ int i; ++ ++ for (i = 0; i < 2; i++) { ++ if (rtw_macid_is_set(&macid_ctl->ch_g[i], id)) ++ return i; ++ } ++ return -1; ++} ++ ++void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta) ++{ ++ int i; ++ _irqL irqL; ++ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ struct macid_bmp *used_map = &macid_ctl->used; ++ /* static u8 last_id = 0; for testing */ ++ u8 last_id = 0; ++ u8 is_bc_sta = _FALSE; ++ ++ if (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), ETH_ALEN)) { ++ psta->mac_id = macid_ctl->num; ++ return; ++ } ++ ++ if (_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) { ++ is_bc_sta = _TRUE; ++ rtw_iface_bcmc_id_set(padapter, INVALID_SEC_MAC_CAM_ID); /*init default value*/ ++ } ++ ++#ifdef CONFIG_SHARED_BMC_MACID ++ if (is_bc_sta ++#ifdef CONFIG_CONCURRENT_MODE ++ && (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) || check_fwstate(&padapter->mlmepriv, WIFI_NULL_STATE)) ++#endif ++ ) { ++ /* use shared broadcast & multicast macid 1 for all ifaces which configure to station mode*/ ++ _enter_critical_bh(&macid_ctl->lock, &irqL); ++ rtw_macid_map_set(used_map, 1); ++ rtw_macid_map_set(&macid_ctl->bmc, 1); ++ rtw_macid_map_set(&macid_ctl->if_g[padapter->iface_id], 1); ++ macid_ctl->sta[1] = psta; ++ /* TODO ch_g? */ ++ _exit_critical_bh(&macid_ctl->lock, &irqL); ++ i = 1; ++ goto assigned; ++ } ++#endif ++ ++#ifdef CONFIG_MCC_MODE ++ if (MCC_EN(padapter)) { ++ if (MLME_IS_AP(padapter) || MLME_IS_GO(padapter)) ++ /* GO/AP assign client macid from 8 */ ++ last_id = 8; ++ } ++#endif /* CONFIG_MCC_MODE */ ++ ++ _enter_critical_bh(&macid_ctl->lock, &irqL); ++ ++ for (i = last_id; i < macid_ctl->num; i++) { ++#ifdef CONFIG_SHARED_BMC_MACID ++ if (i == 1) ++ continue; ++#endif ++ ++#ifdef CONFIG_MCC_MODE ++ /* macid 0/1 reserve for mcc for mgnt queue macid */ ++ if (MCC_EN(padapter)) { ++ if (i == MCC_ROLE_STA_GC_MGMT_QUEUE_MACID) ++ continue; ++ if (i == MCC_ROLE_SOFTAP_GO_MGMT_QUEUE_MACID) ++ continue; ++ } ++#endif /* CONFIG_MCC_MODE */ ++ ++ if (is_bc_sta) {/*for SoftAP's Broadcast sta-info*/ ++ /*TODO:non-security AP may allociated macid = 1*/ ++ struct cam_ctl_t *cam_ctl = dvobj_to_sec_camctl(dvobj); ++ ++ if ((!rtw_macid_is_used(macid_ctl, i)) && (!rtw_sec_camid_is_used(cam_ctl, i))) ++ break; ++ } else { ++ if (!rtw_macid_is_used(macid_ctl, i)) ++ break; ++ } ++ } ++ ++ if (i < macid_ctl->num) { ++ ++ rtw_macid_map_set(used_map, i); ++ ++ if (is_bc_sta) { ++ struct cam_ctl_t *cam_ctl = dvobj_to_sec_camctl(dvobj); ++ ++ rtw_macid_map_set(&macid_ctl->bmc, i); ++ rtw_iface_bcmc_id_set(padapter, i); ++ rtw_sec_cam_map_set(&cam_ctl->used, i); ++ } ++ ++ rtw_macid_map_set(&macid_ctl->if_g[padapter->iface_id], i); ++ macid_ctl->sta[i] = psta; ++ ++ /* TODO ch_g? */ ++ ++ last_id++; ++ last_id %= macid_ctl->num; ++ } ++ ++ _exit_critical_bh(&macid_ctl->lock, &irqL); ++ ++ if (i >= macid_ctl->num) { ++ psta->mac_id = macid_ctl->num; ++ RTW_ERR(FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" no available macid\n" ++ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->hwaddr)); ++ rtw_warn_on(1); ++ goto exit; ++ } else ++ goto assigned; ++ ++assigned: ++ psta->mac_id = i; ++ RTW_INFO(FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" macid:%u\n" ++ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->hwaddr), psta->mac_id); ++ ++exit: ++ return; ++} ++ ++void rtw_release_macid(_adapter *padapter, struct sta_info *psta) ++{ ++ _irqL irqL; ++ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ u8 is_bc_sta = _FALSE; ++ ++ if (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), ETH_ALEN)) ++ return; ++ ++ if (_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) ++ is_bc_sta = _TRUE; ++ ++#ifdef CONFIG_SHARED_BMC_MACID ++ if (is_bc_sta ++#ifdef CONFIG_CONCURRENT_MODE ++ && (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) || check_fwstate(&padapter->mlmepriv, WIFI_NULL_STATE)) ++#endif ++ ) ++ return; ++ ++ if (psta->mac_id == 1) { ++ RTW_ERR(FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" with macid:%u\n" ++ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->hwaddr), psta->mac_id); ++ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) || check_fwstate(&padapter->mlmepriv, WIFI_NULL_STATE)) ++ rtw_warn_on(1); ++ return; ++ } ++#endif ++ ++ _enter_critical_bh(&macid_ctl->lock, &irqL); ++ ++ if (psta->mac_id < macid_ctl->num) { ++ int i; ++ ++ if (!rtw_macid_is_used(macid_ctl, psta->mac_id)) { ++ RTW_ERR(FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" macid:%u not used\n" ++ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->hwaddr), psta->mac_id); ++ rtw_warn_on(1); ++ } ++ ++ rtw_macid_map_clr(&macid_ctl->used, psta->mac_id); ++ rtw_macid_map_clr(&macid_ctl->bmc, psta->mac_id); ++ ++ if (is_bc_sta) { ++ struct cam_ctl_t *cam_ctl = dvobj_to_sec_camctl(dvobj); ++ u8 id = rtw_iface_bcmc_id_get(padapter); ++ ++ if ((id != INVALID_SEC_MAC_CAM_ID) && (id < cam_ctl->num)) ++ rtw_sec_cam_map_clr(&cam_ctl->used, id); ++ ++ rtw_iface_bcmc_id_set(padapter, INVALID_SEC_MAC_CAM_ID); ++ } ++ ++ for (i = 0; i < CONFIG_IFACE_NUMBER; i++) ++ rtw_macid_map_clr(&macid_ctl->if_g[i], psta->mac_id); ++ for (i = 0; i < 2; i++) ++ rtw_macid_map_clr(&macid_ctl->ch_g[i], psta->mac_id); ++ macid_ctl->sta[psta->mac_id] = NULL; ++ } ++ ++ _exit_critical_bh(&macid_ctl->lock, &irqL); ++ ++ psta->mac_id = macid_ctl->num; ++} ++ ++/* For 8188E RA */ ++u8 rtw_search_max_mac_id(_adapter *padapter) ++{ ++ u8 max_mac_id = 0; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ int i; ++ _irqL irqL; ++ ++ /* TODO: Only search for connected macid? */ ++ ++ _enter_critical_bh(&macid_ctl->lock, &irqL); ++ for (i = (macid_ctl->num - 1); i > 0 ; i--) { ++ if (rtw_macid_is_used(macid_ctl, i)) ++ break; ++ } ++ _exit_critical_bh(&macid_ctl->lock, &irqL); ++ max_mac_id = i; ++ ++ return max_mac_id; ++} ++ ++inline void rtw_macid_ctl_set_h2c_msr(struct macid_ctl_t *macid_ctl, u8 id, u8 h2c_msr) ++{ ++ if (id >= macid_ctl->num) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ macid_ctl->h2c_msr[id] = h2c_msr; ++ if (0) ++ RTW_INFO("macid:%u, h2c_msr:"H2C_MSR_FMT"\n", id, H2C_MSR_ARG(&macid_ctl->h2c_msr[id])); ++} ++ ++inline void rtw_macid_ctl_set_bw(struct macid_ctl_t *macid_ctl, u8 id, u8 bw) ++{ ++ if (id >= macid_ctl->num) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ macid_ctl->bw[id] = bw; ++ if (0) ++ RTW_INFO("macid:%u, bw:%s\n", id, ch_width_str(macid_ctl->bw[id])); ++} ++ ++inline void rtw_macid_ctl_set_vht_en(struct macid_ctl_t *macid_ctl, u8 id, u8 en) ++{ ++ if (id >= macid_ctl->num) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ macid_ctl->vht_en[id] = en; ++ if (0) ++ RTW_INFO("macid:%u, vht_en:%u\n", id, macid_ctl->vht_en[id]); ++} ++ ++inline void rtw_macid_ctl_set_rate_bmp0(struct macid_ctl_t *macid_ctl, u8 id, u32 bmp) ++{ ++ if (id >= macid_ctl->num) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ macid_ctl->rate_bmp0[id] = bmp; ++ if (0) ++ RTW_INFO("macid:%u, rate_bmp0:0x%08X\n", id, macid_ctl->rate_bmp0[id]); ++} ++ ++inline void rtw_macid_ctl_set_rate_bmp1(struct macid_ctl_t *macid_ctl, u8 id, u32 bmp) ++{ ++ if (id >= macid_ctl->num) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ macid_ctl->rate_bmp1[id] = bmp; ++ if (0) ++ RTW_INFO("macid:%u, rate_bmp1:0x%08X\n", id, macid_ctl->rate_bmp1[id]); ++} ++ ++inline void rtw_macid_ctl_init(struct macid_ctl_t *macid_ctl) ++{ ++ _rtw_spinlock_init(&macid_ctl->lock); ++} ++ ++inline void rtw_macid_ctl_deinit(struct macid_ctl_t *macid_ctl) ++{ ++ _rtw_spinlock_free(&macid_ctl->lock); ++} ++ ++#if 0 ++unsigned int setup_beacon_frame(_adapter *padapter, unsigned char *beacon_frame) ++{ ++ unsigned short ATIMWindow; ++ unsigned char *pframe; ++ struct tx_desc *ptxdesc; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ unsigned int rate_len, len = 0; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ _rtw_memset(beacon_frame, 0, 256); ++ ++ pframe = beacon_frame + TXDESC_SIZE; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); ++ ++ SetFrameSubType(pframe, WIFI_BEACON); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ len = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ /* timestamp will be inserted by hardware */ ++ pframe += 8; ++ len += 8; ++ ++ /* beacon interval: 2 bytes */ ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); ++ ++ pframe += 2; ++ len += 2; ++ ++ /* capability info: 2 bytes */ ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); ++ ++ pframe += 2; ++ len += 2; ++ ++ /* SSID */ ++ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &len); ++ ++ /* supported rates... */ ++ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &len); ++ ++ /* DS parameter set */ ++ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &len); ++ ++ /* IBSS Parameter Set... */ ++ /* ATIMWindow = cur->Configuration.ATIMWindow; */ ++ ATIMWindow = 0; ++ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &len); ++ ++ /* todo: ERP IE */ ++ ++ /* EXTERNDED SUPPORTED RATE */ ++ if (rate_len > 8) ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &len); ++ ++ if ((len + TXDESC_SIZE) > 256) { ++ /* RTW_INFO("marc: beacon frame too large\n"); */ ++ return 0; ++ } ++ ++ /* fill the tx descriptor */ ++ ptxdesc = (struct tx_desc *)beacon_frame; ++ ++ /* offset 0 */ ++ ptxdesc->txdw0 |= cpu_to_le32(len & 0x0000ffff); ++ ptxdesc->txdw0 |= cpu_to_le32(((TXDESC_SIZE + OFFSET_SZ) << OFFSET_SHT) & 0x00ff0000); /* default = 32 bytes for TX Desc */ ++ ++ /* offset 4 */ ++ ptxdesc->txdw1 |= cpu_to_le32((0x10 << QSEL_SHT) & 0x00001f00); ++ ++ /* offset 8 */ ++ ptxdesc->txdw2 |= cpu_to_le32(BMC); ++ ptxdesc->txdw2 |= cpu_to_le32(BK); ++ ++ /* offset 16 */ ++ ptxdesc->txdw4 = 0x80000000; ++ ++ /* offset 20 */ ++ ptxdesc->txdw5 = 0x00000000; /* 1M */ ++ ++ return len + TXDESC_SIZE; ++} ++#endif ++ ++_adapter *dvobj_get_port0_adapter(struct dvobj_priv *dvobj) ++{ ++ _adapter *port0_iface = NULL; ++ int i; ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (get_hw_port(dvobj->padapters[i]) == HW_PORT0) ++ break; ++ } ++ ++ if (i < 0 || i >= dvobj->iface_nums) ++ rtw_warn_on(1); ++ else ++ port0_iface = dvobj->padapters[i]; ++ ++ return port0_iface; ++} ++ ++_adapter *dvobj_get_unregisterd_adapter(struct dvobj_priv *dvobj) ++{ ++ _adapter *adapter = NULL; ++ int i; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (dvobj->padapters[i]->registered == 0) ++ break; ++ } ++ ++ if (i < dvobj->iface_nums) ++ adapter = dvobj->padapters[i]; ++ ++ return adapter; ++} ++ ++_adapter *dvobj_get_adapter_by_addr(struct dvobj_priv *dvobj, u8 *addr) ++{ ++ _adapter *adapter = NULL; ++ int i; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (_rtw_memcmp(dvobj->padapters[i]->mac_addr, addr, ETH_ALEN) == _TRUE) ++ break; ++ } ++ ++ if (i < dvobj->iface_nums) ++ adapter = dvobj->padapters[i]; ++ ++ return adapter; ++} ++ ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++void rtw_get_current_ip_address(PADAPTER padapter, u8 *pcurrentip) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct in_device *my_ip_ptr = padapter->pnetdev->ip_ptr; ++ u8 ipaddress[4]; ++ ++ if ((pmlmeinfo->state & WIFI_FW_LINKING_STATE) || ++ pmlmeinfo->state & WIFI_FW_AP_STATE) { ++ if (my_ip_ptr != NULL) { ++ struct in_ifaddr *my_ifa_list = my_ip_ptr->ifa_list ; ++ if (my_ifa_list != NULL) { ++ ipaddress[0] = my_ifa_list->ifa_address & 0xFF; ++ ipaddress[1] = (my_ifa_list->ifa_address >> 8) & 0xFF; ++ ipaddress[2] = (my_ifa_list->ifa_address >> 16) & 0xFF; ++ ipaddress[3] = my_ifa_list->ifa_address >> 24; ++ RTW_INFO("%s: %d.%d.%d.%d ==========\n", __func__, ++ ipaddress[0], ipaddress[1], ipaddress[2], ipaddress[3]); ++ _rtw_memcpy(pcurrentip, ipaddress, 4); ++ } ++ } ++ } ++} ++#endif ++#ifdef CONFIG_WOWLAN ++bool rtw_wowlan_parser_pattern_cmd(u8 *input, char *pattern, ++ int *pattern_len, char *bit_mask) ++{ ++ char *cp = NULL, *end = NULL; ++ size_t len = 0; ++ int pos = 0, mask_pos = 0, res = 0; ++ u8 member[2] = {0}; ++ ++ cp = strchr(input, '='); ++ if (cp) { ++ *cp = 0; ++ cp++; ++ input = cp; ++ } ++ ++ while (1) { ++ cp = strchr(input, ':'); ++ ++ if (cp) { ++ len = strlen(input) - strlen(cp); ++ *cp = 0; ++ cp++; ++ } else ++ len = 2; ++ ++ if (bit_mask && (strcmp(input, "-") == 0 || ++ strcmp(input, "xx") == 0 || ++ strcmp(input, "--") == 0)) { ++ /* skip this byte and leave mask bit unset */ ++ } else { ++ u8 hex; ++ ++ strncpy(member, input, len); ++ if (!rtw_check_pattern_valid(member, sizeof(member))) { ++ RTW_INFO("%s:[ERROR] pattern is invalid!!\n", ++ __func__); ++ goto error; ++ } ++ ++ res = sscanf(member, "%02hhx", &hex); ++ pattern[pos] = hex; ++ mask_pos = pos / 8; ++ if (bit_mask) ++ bit_mask[mask_pos] |= 1 << (pos % 8); ++ } ++ ++ pos++; ++ if (!cp) ++ break; ++ input = cp; ++ } ++ ++ (*pattern_len) = pos; ++ ++ return _TRUE; ++error: ++ return _FALSE; ++} ++ ++bool rtw_check_pattern_valid(u8 *input, u8 len) ++{ ++ int i = 0; ++ bool res = _FALSE; ++ ++ if (len != 2) ++ goto exit; ++ ++ for (i = 0 ; i < len ; i++) ++ if (IsHexDigit(input[i]) == _FALSE) ++ goto exit; ++ ++ res = _SUCCESS; ++ ++exit: ++ return res; ++} ++ ++u8 rtw_set_default_pattern(_adapter *adapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); ++ struct registry_priv *pregistrypriv = &adapter->registrypriv; ++ u8 index = 0; ++ u8 currentip[4]; ++ u8 multicast_addr[3] = {0x01, 0x00, 0x5e}; ++ u8 multicast_ip[4] = {0xe0, 0x28, 0x28, 0x2a}; ++ u8 unicast_mask[5] = {0x3f, 0x70, 0x80, 0xc0, 0x03}; ++ u8 multicast_mask[5] = {0x07, 0x70, 0x80, 0xc0, 0x03}; ++ u8 ip_protocol[3] = {0x08, 0x00, 0x45}; ++ u8 icmp_protocol[1] = {0x01}; ++ u8 tcp_protocol[1] = {0x06}; ++ u8 udp_protocol[1] = {0x11}; ++ ++ if (pregistrypriv->default_patterns_en == _FALSE) ++ return 0; ++ ++ for (index = 0 ; index < DEFAULT_PATTERN_NUM ; index++) { ++ _rtw_memset(pwrpriv->patterns[index].content, 0, ++ sizeof(pwrpriv->patterns[index].content)); ++ _rtw_memset(pwrpriv->patterns[index].mask, 0, ++ sizeof(pwrpriv->patterns[index].mask)); ++ pwrpriv->patterns[index].len = 0; ++ } ++ ++ rtw_get_current_ip_address(adapter, currentip); ++ ++ /*TCP/ICMP unicast*/ ++ for (index = 0 ; index < DEFAULT_PATTERN_NUM ; index++) { ++ switch (index) { ++ case 0: ++ _rtw_memcpy(pwrpriv->patterns[index].content, ++ adapter_mac_addr(adapter), ++ ETH_ALEN); ++ _rtw_memcpy(pwrpriv->patterns[index].content + ETH_TYPE_OFFSET, ++ &ip_protocol, sizeof(ip_protocol)); ++ _rtw_memcpy(pwrpriv->patterns[index].content + PROTOCOL_OFFSET, ++ &tcp_protocol, sizeof(tcp_protocol)); ++ _rtw_memcpy(pwrpriv->patterns[index].content + IP_OFFSET, ++ ¤tip, sizeof(currentip)); ++ _rtw_memcpy(pwrpriv->patterns[index].mask, ++ &unicast_mask, sizeof(unicast_mask)); ++ pwrpriv->patterns[index].len = IP_OFFSET + sizeof(currentip); ++ break; ++ case 1: ++ _rtw_memcpy(pwrpriv->patterns[index].content, ++ adapter_mac_addr(adapter), ++ ETH_ALEN); ++ _rtw_memcpy(pwrpriv->patterns[index].content + ETH_TYPE_OFFSET, ++ &ip_protocol, sizeof(ip_protocol)); ++ _rtw_memcpy(pwrpriv->patterns[index].content + PROTOCOL_OFFSET, ++ &icmp_protocol, sizeof(icmp_protocol)); ++ _rtw_memcpy(pwrpriv->patterns[index].content + IP_OFFSET, ++ ¤tip, sizeof(currentip)); ++ _rtw_memcpy(pwrpriv->patterns[index].mask, ++ &unicast_mask, sizeof(unicast_mask)); ++ pwrpriv->patterns[index].len = IP_OFFSET + sizeof(currentip); ++ break; ++ case 2: ++ _rtw_memcpy(pwrpriv->patterns[index].content, &multicast_addr, ++ sizeof(multicast_addr)); ++ _rtw_memcpy(pwrpriv->patterns[index].content + ETH_TYPE_OFFSET, ++ &ip_protocol, sizeof(ip_protocol)); ++ _rtw_memcpy(pwrpriv->patterns[index].content + PROTOCOL_OFFSET, ++ &udp_protocol, sizeof(udp_protocol)); ++ _rtw_memcpy(pwrpriv->patterns[index].content + IP_OFFSET, ++ &multicast_ip, sizeof(multicast_ip)); ++ _rtw_memcpy(pwrpriv->patterns[index].mask, ++ &multicast_mask, sizeof(multicast_mask)); ++ pwrpriv->patterns[index].len = ++ IP_OFFSET + sizeof(multicast_ip); ++ break; ++ } ++ } ++ ++ return index; ++} ++ ++bool rtw_read_from_frame_mask(_adapter *adapter, u8 idx) ++{ ++ u32 data_l = 0, data_h = 0, rx_dma_buff_sz = 0, page_sz = 0; ++ u16 offset, rx_buf_ptr = 0; ++ u16 cam_start_offset = 0; ++ u16 ctrl_l = 0, ctrl_h = 0; ++ u8 count = 0, tmp = 0; ++ int i = 0; ++ bool res = _TRUE; ++ ++ if (idx > MAX_WKFM_NUM) { ++ RTW_INFO("[Error]: %s, pattern index is out of range\n", ++ __func__); ++ return _FALSE; ++ } ++ ++ rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ_WOW, ++ (u8 *)&rx_dma_buff_sz); ++ ++ if (rx_dma_buff_sz == 0) { ++ RTW_INFO("[Error]: %s, rx_dma_buff_sz is 0!!\n", __func__); ++ return _FALSE; ++ } ++ ++ rtw_hal_get_def_var(adapter, HAL_DEF_RX_PAGE_SIZE, (u8 *)&page_sz); ++ ++ if (page_sz == 0) { ++ RTW_INFO("[Error]: %s, page_sz is 0!!\n", __func__); ++ return _FALSE; ++ } ++ ++ offset = (u16)PageNum(rx_dma_buff_sz, page_sz); ++ cam_start_offset = offset * page_sz; ++ ++ ctrl_l = 0x0; ++ ctrl_h = 0x0; ++ ++ /* Enable RX packet buffer access */ ++ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, RXPKT_BUF_SELECT); ++ ++ /* Read the WKFM CAM */ ++ for (i = 0; i < (WKFMCAM_ADDR_NUM / 2); i++) { ++ /* ++ * Set Rx packet buffer offset. ++ * RxBufer pointer increases 1, we can access 8 bytes in Rx packet buffer. ++ * CAM start offset (unit: 1 byte) = Index*WKFMCAM_SIZE ++ * RxBufer pointer addr = (CAM start offset + per entry offset of a WKFMCAM)/8 ++ * * Index: The index of the wake up frame mask ++ * * WKFMCAM_SIZE: the total size of one WKFM CAM ++ * * per entry offset of a WKFM CAM: Addr i * 4 bytes ++ */ ++ rx_buf_ptr = ++ (cam_start_offset + idx * WKFMCAM_SIZE + i * 8) >> 3; ++ rtw_write16(adapter, REG_PKTBUF_DBG_CTRL, rx_buf_ptr); ++ ++ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); ++ data_l = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L); ++ data_h = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H); ++ ++ RTW_INFO("[%d]: %08x %08x\n", i, data_h, data_l); ++ ++ count = 0; ++ ++ do { ++ tmp = rtw_read8(adapter, REG_RXPKTBUF_CTRL); ++ rtw_udelay_os(2); ++ count++; ++ } while (!tmp && count < 100); ++ ++ if (count >= 100) { ++ RTW_INFO("%s count:%d\n", __func__, count); ++ res = _FALSE; ++ } ++ } ++ ++ /* Disable RX packet buffer access */ ++ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, ++ DISABLE_TRXPKT_BUF_ACCESS); ++ return res; ++} ++ ++bool rtw_write_to_frame_mask(_adapter *adapter, u8 idx, ++ struct rtl_wow_pattern *context) ++{ ++ u32 data = 0, rx_dma_buff_sz = 0, page_sz = 0; ++ u16 offset, rx_buf_ptr = 0; ++ u16 cam_start_offset = 0; ++ u16 ctrl_l = 0, ctrl_h = 0; ++ u8 count = 0, tmp = 0; ++ int res = 0, i = 0; ++ ++ if (idx > MAX_WKFM_NUM) { ++ RTW_INFO("[Error]: %s, pattern index is out of range\n", ++ __func__); ++ return _FALSE; ++ } ++ ++ rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ_WOW, ++ (u8 *)&rx_dma_buff_sz); ++ ++ if (rx_dma_buff_sz == 0) { ++ RTW_INFO("[Error]: %s, rx_dma_buff_sz is 0!!\n", __func__); ++ return _FALSE; ++ } ++ ++ rtw_hal_get_def_var(adapter, HAL_DEF_RX_PAGE_SIZE, (u8 *)&page_sz); ++ ++ if (page_sz == 0) { ++ RTW_INFO("[Error]: %s, page_sz is 0!!\n", __func__); ++ return _FALSE; ++ } ++ ++ offset = (u16)PageNum(rx_dma_buff_sz, page_sz); ++ ++ cam_start_offset = offset * page_sz; ++ ++ if (IS_HARDWARE_TYPE_8188E(adapter)) { ++ ctrl_l = 0x0001; ++ ctrl_h = 0x0001; ++ } else { ++ ctrl_l = 0x0f01; ++ ctrl_h = 0xf001; ++ } ++ ++ /* Enable RX packet buffer access */ ++ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, RXPKT_BUF_SELECT); ++ ++ /* Write the WKFM CAM */ ++ for (i = 0; i < WKFMCAM_ADDR_NUM; i++) { ++ /* ++ * Set Rx packet buffer offset. ++ * RxBufer pointer increases 1, we can access 8 bytes in Rx packet buffer. ++ * CAM start offset (unit: 1 byte) = Index*WKFMCAM_SIZE ++ * RxBufer pointer addr = (CAM start offset + per entry offset of a WKFMCAM)/8 ++ * * Index: The index of the wake up frame mask ++ * * WKFMCAM_SIZE: the total size of one WKFM CAM ++ * * per entry offset of a WKFM CAM: Addr i * 4 bytes ++ */ ++ rx_buf_ptr = ++ (cam_start_offset + idx * WKFMCAM_SIZE + i * 4) >> 3; ++ rtw_write16(adapter, REG_PKTBUF_DBG_CTRL, rx_buf_ptr); ++ ++ if (i == 0) { ++ if (context->type == PATTERN_VALID) ++ data = BIT(31); ++ else if (context->type == PATTERN_BROADCAST) ++ data = BIT(31) | BIT(26); ++ else if (context->type == PATTERN_MULTICAST) ++ data = BIT(31) | BIT(25); ++ else if (context->type == PATTERN_UNICAST) ++ data = BIT(31) | BIT(24); ++ ++ if (context->crc != 0) ++ data |= context->crc; ++ ++ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_L, data); ++ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); ++ } else if (i == 1) { ++ data = 0; ++ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, data); ++ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_h); ++ } else if (i == 2 || i == 4) { ++ data = context->mask[i - 2]; ++ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_L, data); ++ /* write to RX packet buffer*/ ++ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); ++ } else if (i == 3 || i == 5) { ++ data = context->mask[i - 2]; ++ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, data); ++ /* write to RX packet buffer*/ ++ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_h); ++ } ++ ++ count = 0; ++ do { ++ tmp = rtw_read8(adapter, REG_RXPKTBUF_CTRL); ++ rtw_udelay_os(2); ++ count++; ++ } while (tmp && count < 100); ++ ++ if (count >= 100) ++ res = _FALSE; ++ else ++ res = _TRUE; ++ } ++ ++ /* Disable RX packet buffer access */ ++ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, ++ DISABLE_TRXPKT_BUF_ACCESS); ++ ++ return res; ++} ++ ++ ++void rtw_dump_priv_pattern(_adapter *adapter, u8 idx) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); ++ char str_1[128]; ++ char *p_str; ++ u8 val8 = 0; ++ int i = 0, j = 0, len = 0, max_len = 0; ++ ++ RTW_INFO("=========[%d]========\n", idx); ++ ++ RTW_INFO(">>>priv_pattern_content:\n"); ++ p_str = str_1; ++ max_len = sizeof(str_1); ++ for (i = 0 ; i < MAX_WKFM_PATTERN_SIZE / 8 ; i++) { ++ _rtw_memset(p_str, 0, max_len); ++ len = 0; ++ for (j = 0 ; j < 8 ; j++) { ++ val8 = pwrctl->patterns[idx].content[i * 8 + j]; ++ len += snprintf(p_str + len, max_len - len, ++ "%02x ", val8); ++ } ++ RTW_INFO("%s\n", p_str); ++ } ++ ++ RTW_INFO(">>>priv_pattern_mask:\n"); ++ for (i = 0 ; i < MAX_WKFM_SIZE / 8 ; i++) { ++ _rtw_memset(p_str, 0, max_len); ++ len = 0; ++ for (j = 0 ; j < 8 ; j++) { ++ val8 = pwrctl->patterns[idx].mask[i * 8 + j]; ++ len += snprintf(p_str + len, max_len - len, ++ "%02x ", val8); ++ } ++ RTW_INFO("%s\n", p_str); ++ } ++ ++ RTW_INFO(">>>priv_pattern_len:\n"); ++ RTW_INFO("%s: len: %d\n", __func__, pwrctl->patterns[idx].len); ++} ++ ++void rtw_clean_pattern(_adapter *adapter) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); ++ struct rtl_wow_pattern zero_pattern; ++ int i = 0; ++ ++ _rtw_memset(&zero_pattern, 0, sizeof(struct rtl_wow_pattern)); ++ ++ zero_pattern.type = PATTERN_INVALID; ++ ++ for (i = 0; i < MAX_WKFM_NUM; i++) ++ rtw_write_to_frame_mask(adapter, i, &zero_pattern); ++ ++ rtw_write8(adapter, REG_WKFMCAM_NUM, 0); ++} ++ ++void rtw_get_sec_iv(PADAPTER padapter, u8 *pcur_dot11txpn, u8 *StaAddr) ++{ ++ struct sta_info *psta; ++ struct security_priv *psecpriv = &padapter->securitypriv; ++ ++ _rtw_memset(pcur_dot11txpn, 0, 8); ++ if (NULL == StaAddr) ++ return; ++ psta = rtw_get_stainfo(&padapter->stapriv, StaAddr); ++ RTW_INFO("%s(): StaAddr: %02x %02x %02x %02x %02x %02x\n", ++ __func__, StaAddr[0], StaAddr[1], StaAddr[2], ++ StaAddr[3], StaAddr[4], StaAddr[5]); ++ ++ if (psta) { ++ if (psecpriv->dot11PrivacyAlgrthm == _AES_) ++ AES_IV(pcur_dot11txpn, psta->dot11txpn, 0); ++ else if (psecpriv->dot11PrivacyAlgrthm == _TKIP_) ++ TKIP_IV(pcur_dot11txpn, psta->dot11txpn, 0); ++ ++ RTW_INFO("%s(): CurrentIV: %02x %02x %02x %02x %02x %02x %02x %02x\n" ++ , __func__, pcur_dot11txpn[0], pcur_dot11txpn[1], ++ pcur_dot11txpn[2], pcur_dot11txpn[3], pcur_dot11txpn[4], ++ pcur_dot11txpn[5], pcur_dot11txpn[6], pcur_dot11txpn[7]); ++ } ++} ++#endif /* CONFIG_WOWLAN */ ++ ++#ifdef CONFIG_PNO_SUPPORT ++#define CSCAN_TLV_TYPE_SSID_IE 'S' ++#define CIPHER_IE "key_mgmt=" ++#define CIPHER_NONE "NONE" ++#define CIPHER_WPA_PSK "WPA-PSK" ++#define CIPHER_WPA_EAP "WPA-EAP IEEE8021X" ++/* ++ * SSIDs list parsing from cscan tlv list ++ */ ++int rtw_parse_ssid_list_tlv(char **list_str, pno_ssid_t *ssid, ++ int max, int *bytes_left) ++{ ++ char *str; ++ ++ int idx = 0; ++ ++ if ((list_str == NULL) || (*list_str == NULL) || (*bytes_left < 0)) { ++ RTW_INFO("%s error paramters\n", __func__); ++ return -1; ++ } ++ ++ str = *list_str; ++ while (*bytes_left > 0) { ++ ++ if (str[0] != CSCAN_TLV_TYPE_SSID_IE) { ++ *list_str = str; ++ RTW_INFO("nssid=%d left_parse=%d %d\n", idx, *bytes_left, str[0]); ++ return idx; ++ } ++ ++ /* Get proper CSCAN_TLV_TYPE_SSID_IE */ ++ *bytes_left -= 1; ++ str += 1; ++ ++ if (str[0] == 0) { ++ /* Broadcast SSID */ ++ ssid[idx].SSID_len = 0; ++ memset((char *)ssid[idx].SSID, 0x0, WLAN_SSID_MAXLEN); ++ *bytes_left -= 1; ++ str += 1; ++ ++ RTW_INFO("BROADCAST SCAN left=%d\n", *bytes_left); ++ } else if (str[0] <= WLAN_SSID_MAXLEN) { ++ /* Get proper SSID size */ ++ ssid[idx].SSID_len = str[0]; ++ *bytes_left -= 1; ++ str += 1; ++ ++ /* Get SSID */ ++ if (ssid[idx].SSID_len > *bytes_left) { ++ RTW_INFO("%s out of memory range len=%d but left=%d\n", ++ __func__, ssid[idx].SSID_len, *bytes_left); ++ return -1; ++ } ++ ++ memcpy((char *)ssid[idx].SSID, str, ssid[idx].SSID_len); ++ ++ *bytes_left -= ssid[idx].SSID_len; ++ str += ssid[idx].SSID_len; ++ ++ RTW_INFO("%s :size=%d left=%d\n", ++ (char *)ssid[idx].SSID, ssid[idx].SSID_len, *bytes_left); ++ } else { ++ RTW_INFO("### SSID size more that %d\n", str[0]); ++ return -1; ++ } ++ ++ if (idx++ > max) { ++ RTW_INFO("%s number of SSIDs more that %d\n", __func__, idx); ++ return -1; ++ } ++ } ++ ++ *list_str = str; ++ return idx; ++} ++ ++int rtw_parse_cipher_list(struct pno_nlo_info *nlo_info, char *list_str) ++{ ++ ++ char *pch, *pnext, *pend; ++ u8 key_len = 0, index = 0; ++ ++ pch = list_str; ++ ++ if (nlo_info == NULL || list_str == NULL) { ++ RTW_INFO("%s error paramters\n", __func__); ++ return -1; ++ } ++ ++ while (strlen(pch) != 0) { ++ pnext = strstr(pch, "key_mgmt="); ++ if (pnext != NULL) { ++ pch = pnext + strlen(CIPHER_IE); ++ pend = strstr(pch, "}"); ++ if (strncmp(pch, CIPHER_NONE, ++ strlen(CIPHER_NONE)) == 0) ++ nlo_info->ssid_cipher_info[index] = 0x00; ++ else if (strncmp(pch, CIPHER_WPA_PSK, ++ strlen(CIPHER_WPA_PSK)) == 0) ++ nlo_info->ssid_cipher_info[index] = 0x66; ++ else if (strncmp(pch, CIPHER_WPA_EAP, ++ strlen(CIPHER_WPA_EAP)) == 0) ++ nlo_info->ssid_cipher_info[index] = 0x01; ++ index++; ++ pch = pend + 1; ++ } else ++ break; ++ } ++ return 0; ++} ++ ++int rtw_dev_nlo_info_set(struct pno_nlo_info *nlo_info, pno_ssid_t *ssid, ++ int num, int pno_time, int pno_repeat, int pno_freq_expo_max) ++{ ++ ++ int i = 0; ++ struct file *fp; ++ mm_segment_t fs; ++ loff_t pos = 0; ++ u8 *source = NULL; ++ long len = 0; ++ ++ RTW_INFO("+%s+\n", __func__); ++ ++ nlo_info->fast_scan_period = pno_time; ++ nlo_info->ssid_num = num & BIT_LEN_MASK_32(8); ++ nlo_info->hidden_ssid_num = num & BIT_LEN_MASK_32(8); ++ nlo_info->slow_scan_period = (pno_time * 2); ++ nlo_info->fast_scan_iterations = 5; ++ ++ if (nlo_info->hidden_ssid_num > 8) ++ nlo_info->hidden_ssid_num = 8; ++ ++ /* TODO: channel list and probe index is all empty. */ ++ for (i = 0 ; i < num ; i++) { ++ nlo_info->ssid_length[i] ++ = ssid[i].SSID_len; ++ } ++ ++ /* cipher array */ ++ fp = filp_open("/home/timlee/wpa_kk/wpa.conf", O_RDONLY, 0644); ++ if (IS_ERR(fp)) { ++ RTW_INFO("Error, wpa_supplicant.conf doesn't exist.\n"); ++ RTW_INFO("Error, cipher array using default value.\n"); ++ return 0; ++ } ++ ++ len = i_size_read(fp->f_path.dentry->d_inode); ++ if (len < 0 || len > 2048) { ++ RTW_INFO("Error, file size is bigger than 2048.\n"); ++ RTW_INFO("Error, cipher array using default value.\n"); ++ return 0; ++ } ++ ++ fs = get_fs(); ++ set_fs(KERNEL_DS); ++ ++ source = rtw_zmalloc(2048); ++ ++ if (source != NULL) { ++ len = vfs_read(fp, source, len, &pos); ++ rtw_parse_cipher_list(nlo_info, source); ++ rtw_mfree(source, 2048); ++ } ++ ++ set_fs(fs); ++ filp_close(fp, NULL); ++ ++ RTW_INFO("-%s-\n", __func__); ++ return 0; ++} ++ ++int rtw_dev_ssid_list_set(struct pno_ssid_list *pno_ssid_list, ++ pno_ssid_t *ssid, u8 num) ++{ ++ ++ int i = 0; ++ if (num > MAX_PNO_LIST_COUNT) ++ num = MAX_PNO_LIST_COUNT; ++ ++ for (i = 0 ; i < num ; i++) { ++ _rtw_memcpy(&pno_ssid_list->node[i].SSID, ++ ssid[i].SSID, ssid[i].SSID_len); ++ pno_ssid_list->node[i].SSID_len = ssid[i].SSID_len; ++ } ++ return 0; ++} ++ ++int rtw_dev_scan_info_set(_adapter *padapter, pno_ssid_t *ssid, ++ unsigned char ch, unsigned char ch_offset, unsigned short bw_mode) ++{ ++ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ struct pno_scan_info *scan_info = pwrctl->pscan_info; ++ int i; ++ ++ scan_info->channel_num = MAX_SCAN_LIST_COUNT; ++ scan_info->orig_ch = ch; ++ scan_info->orig_bw = bw_mode; ++ scan_info->orig_40_offset = ch_offset; ++ ++ for (i = 0 ; i < scan_info->channel_num ; i++) { ++ if (i < 11) ++ scan_info->ssid_channel_info[i].active = 1; ++ else ++ scan_info->ssid_channel_info[i].active = 0; ++ ++ scan_info->ssid_channel_info[i].timeout = 100; ++ ++ scan_info->ssid_channel_info[i].tx_power = ++ PHY_GetTxPowerIndex(padapter, 0, 0x02, bw_mode, i + 1); ++ ++ scan_info->ssid_channel_info[i].channel = i + 1; ++ } ++ ++ RTW_INFO("%s, channel_num: %d, orig_ch: %d, orig_bw: %d orig_40_offset: %d\n", ++ __func__, scan_info->channel_num, scan_info->orig_ch, ++ scan_info->orig_bw, scan_info->orig_40_offset); ++ return 0; ++} ++ ++int rtw_dev_pno_set(struct net_device *net, pno_ssid_t *ssid, int num, ++ int pno_time, int pno_repeat, int pno_freq_expo_max) ++{ ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ int ret = -1; ++ ++ if (num == 0) { ++ RTW_INFO("%s, nssid is zero, no need to setup pno ssid list\n", __func__); ++ return 0; ++ } ++ ++ if (pwrctl == NULL) { ++ RTW_INFO("%s, ERROR: pwrctl is NULL\n", __func__); ++ return -1; ++ } else { ++ pwrctl->pnlo_info = ++ (pno_nlo_info_t *)rtw_zmalloc(sizeof(pno_nlo_info_t)); ++ pwrctl->pno_ssid_list = ++ (pno_ssid_list_t *)rtw_zmalloc(sizeof(pno_ssid_list_t)); ++ pwrctl->pscan_info = ++ (pno_scan_info_t *)rtw_zmalloc(sizeof(pno_scan_info_t)); ++ } ++ ++ if (pwrctl->pnlo_info == NULL || ++ pwrctl->pscan_info == NULL || ++ pwrctl->pno_ssid_list == NULL) { ++ RTW_INFO("%s, ERROR: alloc nlo_info, ssid_list, scan_info fail\n", __func__); ++ goto failing; ++ } ++ ++ pwrctl->wowlan_in_resume = _FALSE; ++ ++ pwrctl->pno_inited = _TRUE; ++ /* NLO Info */ ++ ret = rtw_dev_nlo_info_set(pwrctl->pnlo_info, ssid, num, ++ pno_time, pno_repeat, pno_freq_expo_max); ++ ++ /* SSID Info */ ++ ret = rtw_dev_ssid_list_set(pwrctl->pno_ssid_list, ssid, num); ++ ++ /* SCAN Info */ ++ ret = rtw_dev_scan_info_set(padapter, ssid, pmlmeext->cur_channel, ++ pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ ++ RTW_INFO("+%s num: %d, pno_time: %d, pno_repeat:%d, pno_freq_expo_max:%d+\n", ++ __func__, num, pno_time, pno_repeat, pno_freq_expo_max); ++ ++ return 0; ++ ++failing: ++ if (pwrctl->pnlo_info) { ++ rtw_mfree((u8 *)pwrctl->pnlo_info, sizeof(pno_nlo_info_t)); ++ pwrctl->pnlo_info = NULL; ++ } ++ if (pwrctl->pno_ssid_list) { ++ rtw_mfree((u8 *)pwrctl->pno_ssid_list, sizeof(pno_ssid_list_t)); ++ pwrctl->pno_ssid_list = NULL; ++ } ++ if (pwrctl->pscan_info) { ++ rtw_mfree((u8 *)pwrctl->pscan_info, sizeof(pno_scan_info_t)); ++ pwrctl->pscan_info = NULL; ++ } ++ ++ return -1; ++} ++ ++#ifdef CONFIG_PNO_SET_DEBUG ++void rtw_dev_pno_debug(struct net_device *net) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ int i = 0, j = 0; ++ ++ RTW_INFO("*******NLO_INFO********\n"); ++ RTW_INFO("ssid_num: %d\n", pwrctl->pnlo_info->ssid_num); ++ RTW_INFO("fast_scan_iterations: %d\n", ++ pwrctl->pnlo_info->fast_scan_iterations); ++ RTW_INFO("fast_scan_period: %d\n", pwrctl->pnlo_info->fast_scan_period); ++ RTW_INFO("slow_scan_period: %d\n", pwrctl->pnlo_info->slow_scan_period); ++ ++ ++ ++ for (i = 0 ; i < MAX_PNO_LIST_COUNT ; i++) { ++ RTW_INFO("%d SSID (%s) length (%d) cipher(%x) channel(%d)\n", ++ i, pwrctl->pno_ssid_list->node[i].SSID, pwrctl->pnlo_info->ssid_length[i], ++ pwrctl->pnlo_info->ssid_cipher_info[i], pwrctl->pnlo_info->ssid_channel_info[i]); ++ } ++ ++ RTW_INFO("******SCAN_INFO******\n"); ++ RTW_INFO("ch_num: %d\n", pwrctl->pscan_info->channel_num); ++ RTW_INFO("orig_ch: %d\n", pwrctl->pscan_info->orig_ch); ++ RTW_INFO("orig bw: %d\n", pwrctl->pscan_info->orig_bw); ++ RTW_INFO("orig 40 offset: %d\n", pwrctl->pscan_info->orig_40_offset); ++ for (i = 0 ; i < MAX_SCAN_LIST_COUNT ; i++) { ++ RTW_INFO("[%02d] avtive:%d, timeout:%d, tx_power:%d, ch:%02d\n", ++ i, pwrctl->pscan_info->ssid_channel_info[i].active, ++ pwrctl->pscan_info->ssid_channel_info[i].timeout, ++ pwrctl->pscan_info->ssid_channel_info[i].tx_power, ++ pwrctl->pscan_info->ssid_channel_info[i].channel); ++ } ++ RTW_INFO("*****************\n"); ++} ++#endif /* CONFIG_PNO_SET_DEBUG */ ++#endif /* CONFIG_PNO_SUPPORT */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_xmit.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_xmit.c +--- linux-4.14.18/3rdparty/rtl8723de/core/rtw_xmit.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_xmit.c 2018-02-11 21:44:27.143146025 +0200 +@@ -0,0 +1,5057 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTW_XMIT_C_ ++ ++#include ++#include ++ ++#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) ++ #error "Shall be Linux or Windows, but not both!\n" ++#endif ++ ++ ++static u8 P802_1H_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0xf8 }; ++static u8 RFC1042_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0x00 }; ++ ++static void _init_txservq(struct tx_servq *ptxservq) ++{ ++ _rtw_init_listhead(&ptxservq->tx_pending); ++ _rtw_init_queue(&ptxservq->sta_pending); ++ ptxservq->qcnt = 0; ++} ++ ++ ++void _rtw_init_sta_xmit_priv(struct sta_xmit_priv *psta_xmitpriv) ++{ ++ ++ ++ _rtw_memset((unsigned char *)psta_xmitpriv, 0, sizeof(struct sta_xmit_priv)); ++ ++ _rtw_spinlock_init(&psta_xmitpriv->lock); ++ ++ /* for(i = 0 ; i < MAX_NUMBLKS; i++) */ ++ /* _init_txservq(&(psta_xmitpriv->blk_q[i])); */ ++ ++ _init_txservq(&psta_xmitpriv->be_q); ++ _init_txservq(&psta_xmitpriv->bk_q); ++ _init_txservq(&psta_xmitpriv->vi_q); ++ _init_txservq(&psta_xmitpriv->vo_q); ++ _rtw_init_listhead(&psta_xmitpriv->legacy_dz); ++ _rtw_init_listhead(&psta_xmitpriv->apsd); ++ ++ ++} ++ ++s32 _rtw_init_xmit_priv(struct xmit_priv *pxmitpriv, _adapter *padapter) ++{ ++ int i; ++ struct xmit_buf *pxmitbuf; ++ struct xmit_frame *pxframe; ++ sint res = _SUCCESS; ++ ++ ++ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). */ ++ /* _rtw_memset((unsigned char *)pxmitpriv, 0, sizeof(struct xmit_priv)); */ ++ ++ _rtw_spinlock_init(&pxmitpriv->lock); ++ _rtw_spinlock_init(&pxmitpriv->lock_sctx); ++ _rtw_init_sema(&pxmitpriv->xmit_sema, 0); ++ /*_rtw_init_sema(&pxmitpriv->terminate_xmitthread_sema, 0);*/ ++ _rtw_init_completion(&pxmitpriv->xmitthread_comp); ++ ++ /* ++ Please insert all the queue initializaiton using _rtw_init_queue below ++ */ ++ ++ pxmitpriv->adapter = padapter; ++ ++ /* for(i = 0 ; i < MAX_NUMBLKS; i++) */ ++ /* _rtw_init_queue(&pxmitpriv->blk_strms[i]); */ ++ ++ _rtw_init_queue(&pxmitpriv->be_pending); ++ _rtw_init_queue(&pxmitpriv->bk_pending); ++ _rtw_init_queue(&pxmitpriv->vi_pending); ++ _rtw_init_queue(&pxmitpriv->vo_pending); ++ _rtw_init_queue(&pxmitpriv->bm_pending); ++ ++ /* _rtw_init_queue(&pxmitpriv->legacy_dz_queue); */ ++ /* _rtw_init_queue(&pxmitpriv->apsd_queue); */ ++ ++ _rtw_init_queue(&pxmitpriv->free_xmit_queue); ++ ++ /* ++ Please allocate memory with the sz = (struct xmit_frame) * NR_XMITFRAME, ++ and initialize free_xmit_frame below. ++ Please also apply free_txobj to link_up all the xmit_frames... ++ */ ++ ++ pxmitpriv->pallocated_frame_buf = rtw_zvmalloc(NR_XMITFRAME * sizeof(struct xmit_frame) + 4); ++ ++ if (pxmitpriv->pallocated_frame_buf == NULL) { ++ pxmitpriv->pxmit_frame_buf = NULL; ++ res = _FAIL; ++ goto exit; ++ } ++ pxmitpriv->pxmit_frame_buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_frame_buf), 4); ++ /* pxmitpriv->pxmit_frame_buf = pxmitpriv->pallocated_frame_buf + 4 - */ ++ /* ((SIZE_PTR) (pxmitpriv->pallocated_frame_buf) &3); */ ++ ++ pxframe = (struct xmit_frame *) pxmitpriv->pxmit_frame_buf; ++ ++ for (i = 0; i < NR_XMITFRAME; i++) { ++ _rtw_init_listhead(&(pxframe->list)); ++ ++ pxframe->padapter = padapter; ++ pxframe->frame_tag = NULL_FRAMETAG; ++ ++ pxframe->pkt = NULL; ++ ++ pxframe->buf_addr = NULL; ++ pxframe->pxmitbuf = NULL; ++ ++ rtw_list_insert_tail(&(pxframe->list), &(pxmitpriv->free_xmit_queue.queue)); ++ ++ pxframe++; ++ } ++ ++ pxmitpriv->free_xmitframe_cnt = NR_XMITFRAME; ++ ++ pxmitpriv->frag_len = MAX_FRAG_THRESHOLD; ++ ++ ++ /* init xmit_buf */ ++ _rtw_init_queue(&pxmitpriv->free_xmitbuf_queue); ++ _rtw_init_queue(&pxmitpriv->pending_xmitbuf_queue); ++ ++ pxmitpriv->pallocated_xmitbuf = rtw_zvmalloc(NR_XMITBUFF * sizeof(struct xmit_buf) + 4); ++ ++ if (pxmitpriv->pallocated_xmitbuf == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pxmitpriv->pxmitbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_xmitbuf), 4); ++ /* pxmitpriv->pxmitbuf = pxmitpriv->pallocated_xmitbuf + 4 - */ ++ /* ((SIZE_PTR) (pxmitpriv->pallocated_xmitbuf) &3); */ ++ ++ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf; ++ ++ for (i = 0; i < NR_XMITBUFF; i++) { ++ _rtw_init_listhead(&pxmitbuf->list); ++ ++ pxmitbuf->priv_data = NULL; ++ pxmitbuf->padapter = padapter; ++ pxmitbuf->buf_tag = XMITBUF_DATA; ++ ++ /* Tx buf allocation may fail sometimes, so sleep and retry. */ ++ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, (MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), _TRUE); ++ if (res == _FAIL) { ++ rtw_msleep_os(10); ++ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, (MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), _TRUE); ++ if (res == _FAIL) ++ goto exit; ++ } ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ pxmitbuf->phead = pxmitbuf->pbuf; ++ pxmitbuf->pend = pxmitbuf->pbuf + MAX_XMITBUF_SZ; ++ pxmitbuf->len = 0; ++ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; ++#endif ++ ++ pxmitbuf->flags = XMIT_VO_QUEUE; ++ ++ rtw_list_insert_tail(&pxmitbuf->list, &(pxmitpriv->free_xmitbuf_queue.queue)); ++#ifdef DBG_XMIT_BUF ++ pxmitbuf->no = i; ++#endif ++ ++ pxmitbuf++; ++ ++ } ++ ++ pxmitpriv->free_xmitbuf_cnt = NR_XMITBUFF; ++ ++ /* init xframe_ext queue, the same count as extbuf */ ++ _rtw_init_queue(&pxmitpriv->free_xframe_ext_queue); ++ ++ pxmitpriv->xframe_ext_alloc_addr = rtw_zvmalloc(NR_XMIT_EXTBUFF * sizeof(struct xmit_frame) + 4); ++ ++ if (pxmitpriv->xframe_ext_alloc_addr == NULL) { ++ pxmitpriv->xframe_ext = NULL; ++ res = _FAIL; ++ goto exit; ++ } ++ pxmitpriv->xframe_ext = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->xframe_ext_alloc_addr), 4); ++ pxframe = (struct xmit_frame *)pxmitpriv->xframe_ext; ++ ++ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { ++ _rtw_init_listhead(&(pxframe->list)); ++ ++ pxframe->padapter = padapter; ++ pxframe->frame_tag = NULL_FRAMETAG; ++ ++ pxframe->pkt = NULL; ++ ++ pxframe->buf_addr = NULL; ++ pxframe->pxmitbuf = NULL; ++ ++ pxframe->ext_tag = 1; ++ ++ rtw_list_insert_tail(&(pxframe->list), &(pxmitpriv->free_xframe_ext_queue.queue)); ++ ++ pxframe++; ++ } ++ pxmitpriv->free_xframe_ext_cnt = NR_XMIT_EXTBUFF; ++ ++ /* Init xmit extension buff */ ++ _rtw_init_queue(&pxmitpriv->free_xmit_extbuf_queue); ++ ++ pxmitpriv->pallocated_xmit_extbuf = rtw_zvmalloc(NR_XMIT_EXTBUFF * sizeof(struct xmit_buf) + 4); ++ ++ if (pxmitpriv->pallocated_xmit_extbuf == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pxmitpriv->pxmit_extbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_xmit_extbuf), 4); ++ ++ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; ++ ++ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { ++ _rtw_init_listhead(&pxmitbuf->list); ++ ++ pxmitbuf->priv_data = NULL; ++ pxmitbuf->padapter = padapter; ++ pxmitbuf->buf_tag = XMITBUF_MGNT; ++ ++ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, MAX_XMIT_EXTBUF_SZ + XMITBUF_ALIGN_SZ, _TRUE); ++ if (res == _FAIL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ pxmitbuf->phead = pxmitbuf->pbuf; ++ pxmitbuf->pend = pxmitbuf->pbuf + MAX_XMIT_EXTBUF_SZ; ++ pxmitbuf->len = 0; ++ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; ++#endif ++ ++ rtw_list_insert_tail(&pxmitbuf->list, &(pxmitpriv->free_xmit_extbuf_queue.queue)); ++#ifdef DBG_XMIT_BUF_EXT ++ pxmitbuf->no = i; ++#endif ++ pxmitbuf++; ++ ++ } ++ ++ pxmitpriv->free_xmit_extbuf_cnt = NR_XMIT_EXTBUFF; ++ ++ for (i = 0; i < CMDBUF_MAX; i++) { ++ pxmitbuf = &pxmitpriv->pcmd_xmitbuf[i]; ++ if (pxmitbuf) { ++ _rtw_init_listhead(&pxmitbuf->list); ++ ++ pxmitbuf->priv_data = NULL; ++ pxmitbuf->padapter = padapter; ++ pxmitbuf->buf_tag = XMITBUF_CMD; ++ ++ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, MAX_CMDBUF_SZ + XMITBUF_ALIGN_SZ, _TRUE); ++ if (res == _FAIL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ pxmitbuf->phead = pxmitbuf->pbuf; ++ pxmitbuf->pend = pxmitbuf->pbuf + MAX_CMDBUF_SZ; ++ pxmitbuf->len = 0; ++ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; ++#endif ++ pxmitbuf->alloc_sz = MAX_CMDBUF_SZ + XMITBUF_ALIGN_SZ; ++ } ++ } ++ ++ rtw_alloc_hwxmits(padapter); ++ rtw_init_hwxmits(pxmitpriv->hwxmits, pxmitpriv->hwxmit_entry); ++ ++ for (i = 0; i < 4; i++) ++ pxmitpriv->wmm_para_seq[i] = i; ++ ++#ifdef CONFIG_USB_HCI ++ pxmitpriv->txirp_cnt = 1; ++ ++ _rtw_init_sema(&(pxmitpriv->tx_retevt), 0); ++ ++ /* per AC pending irp */ ++ pxmitpriv->beq_cnt = 0; ++ pxmitpriv->bkq_cnt = 0; ++ pxmitpriv->viq_cnt = 0; ++ pxmitpriv->voq_cnt = 0; ++#endif ++ ++ ++#ifdef CONFIG_XMIT_ACK ++ pxmitpriv->ack_tx = _FALSE; ++ _rtw_mutex_init(&pxmitpriv->ack_tx_mutex); ++ rtw_sctx_init(&pxmitpriv->ack_tx_ops, 0); ++#endif ++ ++ rtw_hal_init_xmit_priv(padapter); ++ ++exit: ++ ++ ++ return res; ++} ++ ++void rtw_mfree_xmit_priv_lock(struct xmit_priv *pxmitpriv); ++void rtw_mfree_xmit_priv_lock(struct xmit_priv *pxmitpriv) ++{ ++ _rtw_spinlock_free(&pxmitpriv->lock); ++ _rtw_free_sema(&pxmitpriv->xmit_sema); ++ /*_rtw_free_sema(&pxmitpriv->terminate_xmitthread_sema);*/ ++ ++ _rtw_spinlock_free(&pxmitpriv->be_pending.lock); ++ _rtw_spinlock_free(&pxmitpriv->bk_pending.lock); ++ _rtw_spinlock_free(&pxmitpriv->vi_pending.lock); ++ _rtw_spinlock_free(&pxmitpriv->vo_pending.lock); ++ _rtw_spinlock_free(&pxmitpriv->bm_pending.lock); ++ ++ /* _rtw_spinlock_free(&pxmitpriv->legacy_dz_queue.lock); */ ++ /* _rtw_spinlock_free(&pxmitpriv->apsd_queue.lock); */ ++ ++ _rtw_spinlock_free(&pxmitpriv->free_xmit_queue.lock); ++ _rtw_spinlock_free(&pxmitpriv->free_xmitbuf_queue.lock); ++ _rtw_spinlock_free(&pxmitpriv->pending_xmitbuf_queue.lock); ++} ++ ++ ++void _rtw_free_xmit_priv(struct xmit_priv *pxmitpriv) ++{ ++ int i; ++ _adapter *padapter = pxmitpriv->adapter; ++ struct xmit_frame *pxmitframe = (struct xmit_frame *) pxmitpriv->pxmit_frame_buf; ++ struct xmit_buf *pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf; ++ ++ ++ rtw_hal_free_xmit_priv(padapter); ++ ++ rtw_mfree_xmit_priv_lock(pxmitpriv); ++ ++ if (pxmitpriv->pxmit_frame_buf == NULL) ++ goto out; ++ ++ for (i = 0; i < NR_XMITFRAME; i++) { ++ rtw_os_xmit_complete(padapter, pxmitframe); ++ ++ pxmitframe++; ++ } ++ ++ for (i = 0; i < NR_XMITBUFF; i++) { ++ rtw_os_xmit_resource_free(padapter, pxmitbuf, (MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), _TRUE); ++ ++ pxmitbuf++; ++ } ++ ++ if (pxmitpriv->pallocated_frame_buf) ++ rtw_vmfree(pxmitpriv->pallocated_frame_buf, NR_XMITFRAME * sizeof(struct xmit_frame) + 4); ++ ++ ++ if (pxmitpriv->pallocated_xmitbuf) ++ rtw_vmfree(pxmitpriv->pallocated_xmitbuf, NR_XMITBUFF * sizeof(struct xmit_buf) + 4); ++ ++ /* free xframe_ext queue, the same count as extbuf */ ++ if ((pxmitframe = (struct xmit_frame *)pxmitpriv->xframe_ext)) { ++ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { ++ rtw_os_xmit_complete(padapter, pxmitframe); ++ pxmitframe++; ++ } ++ } ++ if (pxmitpriv->xframe_ext_alloc_addr) ++ rtw_vmfree(pxmitpriv->xframe_ext_alloc_addr, NR_XMIT_EXTBUFF * sizeof(struct xmit_frame) + 4); ++ _rtw_spinlock_free(&pxmitpriv->free_xframe_ext_queue.lock); ++ ++ /* free xmit extension buff */ ++ _rtw_spinlock_free(&pxmitpriv->free_xmit_extbuf_queue.lock); ++ ++ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; ++ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { ++ rtw_os_xmit_resource_free(padapter, pxmitbuf, (MAX_XMIT_EXTBUF_SZ + XMITBUF_ALIGN_SZ), _TRUE); ++ ++ pxmitbuf++; ++ } ++ ++ if (pxmitpriv->pallocated_xmit_extbuf) ++ rtw_vmfree(pxmitpriv->pallocated_xmit_extbuf, NR_XMIT_EXTBUFF * sizeof(struct xmit_buf) + 4); ++ ++ for (i = 0; i < CMDBUF_MAX; i++) { ++ pxmitbuf = &pxmitpriv->pcmd_xmitbuf[i]; ++ if (pxmitbuf != NULL) ++ rtw_os_xmit_resource_free(padapter, pxmitbuf, MAX_CMDBUF_SZ + XMITBUF_ALIGN_SZ , _TRUE); ++ } ++ ++ rtw_free_hwxmits(padapter); ++ ++#ifdef CONFIG_XMIT_ACK ++ _rtw_mutex_free(&pxmitpriv->ack_tx_mutex); ++#endif ++ ++out: ++ return; ++} ++ ++u8 rtw_get_tx_bw_mode(_adapter *adapter, struct sta_info *sta) ++{ ++ u8 bw; ++ ++ bw = sta->bw_mode; ++ if (MLME_STATE(adapter) & WIFI_ASOC_STATE) { ++ if (adapter->mlmeextpriv.cur_channel <= 14) ++ bw = rtw_min(bw, ADAPTER_TX_BW_2G(adapter)); ++ else ++ bw = rtw_min(bw, ADAPTER_TX_BW_5G(adapter)); ++ } ++ ++ return bw; ++} ++ ++void rtw_get_adapter_tx_rate_bmp_by_bw(_adapter *adapter, u8 bw, u16 *r_bmp_cck_ofdm, u32 *r_bmp_ht, u32 *r_bmp_vht) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ u8 fix_bw = 0xFF; ++ u16 bmp_cck_ofdm = 0; ++ u32 bmp_ht = 0; ++ u32 bmp_vht = 0; ++ int i; ++ ++ if (adapter->fix_rate != 0xFF && adapter->fix_bw != 0xFF) ++ fix_bw = adapter->fix_bw; ++ ++ /* TODO: adapter->fix_rate */ ++ ++ for (i = 0; i < macid_ctl->num; i++) { ++ if (!rtw_macid_is_used(macid_ctl, i)) ++ continue; ++ if (rtw_macid_get_if_g(macid_ctl, i) != adapter->iface_id) ++ continue; ++ ++ if (bw == CHANNEL_WIDTH_20) /* CCK, OFDM always 20MHz */ ++ bmp_cck_ofdm |= macid_ctl->rate_bmp0[i] & 0x00000FFF; ++ ++ /* bypass mismatch bandwidth for HT, VHT */ ++ if ((fix_bw != 0xFF && fix_bw != bw) || (fix_bw == 0xFF && macid_ctl->bw[i] != bw)) ++ continue; ++ ++ if (macid_ctl->vht_en[i]) ++ bmp_vht |= (macid_ctl->rate_bmp0[i] >> 12) | (macid_ctl->rate_bmp1[i] << 20); ++ else ++ bmp_ht |= (macid_ctl->rate_bmp0[i] >> 12) | (macid_ctl->rate_bmp1[i] << 20); ++ } ++ ++ /* TODO: mlmeext->tx_rate*/ ++ ++exit: ++ if (r_bmp_cck_ofdm) ++ *r_bmp_cck_ofdm = bmp_cck_ofdm; ++ if (r_bmp_ht) ++ *r_bmp_ht = bmp_ht; ++ if (r_bmp_vht) ++ *r_bmp_vht = bmp_vht; ++} ++ ++void rtw_get_shared_macid_tx_rate_bmp_by_bw(struct dvobj_priv *dvobj, u8 bw, u16 *r_bmp_cck_ofdm, u32 *r_bmp_ht, u32 *r_bmp_vht) ++{ ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ u16 bmp_cck_ofdm = 0; ++ u32 bmp_ht = 0; ++ u32 bmp_vht = 0; ++ int i; ++ ++ for (i = 0; i < macid_ctl->num; i++) { ++ if (!rtw_macid_is_used(macid_ctl, i)) ++ continue; ++ if (rtw_macid_get_if_g(macid_ctl, i) != -1) ++ continue; ++ ++ if (bw == CHANNEL_WIDTH_20) /* CCK, OFDM always 20MHz */ ++ bmp_cck_ofdm |= macid_ctl->rate_bmp0[i] & 0x00000FFF; ++ ++ /* bypass mismatch bandwidth for HT, VHT */ ++ if (macid_ctl->bw[i] != bw) ++ continue; ++ ++ if (macid_ctl->vht_en[i]) ++ bmp_vht |= (macid_ctl->rate_bmp0[i] >> 12) | (macid_ctl->rate_bmp1[i] << 20); ++ else ++ bmp_ht |= (macid_ctl->rate_bmp0[i] >> 12) | (macid_ctl->rate_bmp1[i] << 20); ++ } ++ ++ if (r_bmp_cck_ofdm) ++ *r_bmp_cck_ofdm = bmp_cck_ofdm; ++ if (r_bmp_ht) ++ *r_bmp_ht = bmp_ht; ++ if (r_bmp_vht) ++ *r_bmp_vht = bmp_vht; ++} ++ ++void rtw_update_tx_rate_bmp(struct dvobj_priv *dvobj) ++{ ++ struct rf_ctl_t *rf_ctl = dvobj_to_rfctl(dvobj); ++ _adapter *adapter = dvobj_get_primary_adapter(dvobj); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ u8 bw; ++ u16 bmp_cck_ofdm, tmp_cck_ofdm; ++ u32 bmp_ht, tmp_ht, ori_bmp_ht[2]; ++ u8 ori_highest_ht_rate_bw_bmp; ++ u32 bmp_vht, tmp_vht, ori_bmp_vht[4]; ++ u8 ori_highest_vht_rate_bw_bmp; ++ int i; ++ ++ /* backup the original ht & vht highest bw bmp */ ++ ori_highest_ht_rate_bw_bmp = rf_ctl->highest_ht_rate_bw_bmp; ++ ori_highest_vht_rate_bw_bmp = rf_ctl->highest_vht_rate_bw_bmp; ++ ++ for (bw = CHANNEL_WIDTH_20; bw <= CHANNEL_WIDTH_160; bw++) { ++ /* backup the original ht & vht bmp */ ++ if (bw <= CHANNEL_WIDTH_40) ++ ori_bmp_ht[bw] = rf_ctl->rate_bmp_ht_by_bw[bw]; ++ if (bw <= CHANNEL_WIDTH_160) ++ ori_bmp_vht[bw] = rf_ctl->rate_bmp_vht_by_bw[bw]; ++ ++ bmp_cck_ofdm = bmp_ht = bmp_vht = 0; ++ if (hal_is_bw_support(dvobj_get_primary_adapter(dvobj), bw)) { ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (!dvobj->padapters[i]) ++ continue; ++ rtw_get_adapter_tx_rate_bmp_by_bw(dvobj->padapters[i], bw, &tmp_cck_ofdm, &tmp_ht, &tmp_vht); ++ bmp_cck_ofdm |= tmp_cck_ofdm; ++ bmp_ht |= tmp_ht; ++ bmp_vht |= tmp_vht; ++ } ++ rtw_get_shared_macid_tx_rate_bmp_by_bw(dvobj, bw, &tmp_cck_ofdm, &tmp_ht, &tmp_vht); ++ bmp_cck_ofdm |= tmp_cck_ofdm; ++ bmp_ht |= tmp_ht; ++ bmp_vht |= tmp_vht; ++ } ++ if (bw == CHANNEL_WIDTH_20) ++ rf_ctl->rate_bmp_cck_ofdm = bmp_cck_ofdm; ++ if (bw <= CHANNEL_WIDTH_40) ++ rf_ctl->rate_bmp_ht_by_bw[bw] = bmp_ht; ++ if (bw <= CHANNEL_WIDTH_160) ++ rf_ctl->rate_bmp_vht_by_bw[bw] = bmp_vht; ++ } ++ ++#ifndef DBG_HIGHEST_RATE_BMP_BW_CHANGE ++#define DBG_HIGHEST_RATE_BMP_BW_CHANGE 0 ++#endif ++ ++ { ++ u8 highest_rate_bw; ++ u8 highest_rate_bw_bmp; ++ u8 update_ht_rs = _FALSE; ++ u8 update_vht_rs = _FALSE; ++ ++ highest_rate_bw_bmp = BW_CAP_20M; ++ highest_rate_bw = CHANNEL_WIDTH_20; ++ for (bw = CHANNEL_WIDTH_20; bw <= CHANNEL_WIDTH_40; bw++) { ++ if (rf_ctl->rate_bmp_ht_by_bw[highest_rate_bw] < rf_ctl->rate_bmp_ht_by_bw[bw]) { ++ highest_rate_bw_bmp = ch_width_to_bw_cap(bw); ++ highest_rate_bw = bw; ++ } else if (rf_ctl->rate_bmp_ht_by_bw[highest_rate_bw] == rf_ctl->rate_bmp_ht_by_bw[bw]) ++ highest_rate_bw_bmp |= ch_width_to_bw_cap(bw); ++ } ++ rf_ctl->highest_ht_rate_bw_bmp = highest_rate_bw_bmp; ++ ++ if (ori_highest_ht_rate_bw_bmp != rf_ctl->highest_ht_rate_bw_bmp ++ || largest_bit(ori_bmp_ht[highest_rate_bw]) != largest_bit(rf_ctl->rate_bmp_ht_by_bw[highest_rate_bw]) ++ ) { ++ if (DBG_HIGHEST_RATE_BMP_BW_CHANGE) { ++ RTW_INFO("highest_ht_rate_bw_bmp:0x%02x=>0x%02x\n", ori_highest_ht_rate_bw_bmp, rf_ctl->highest_ht_rate_bw_bmp); ++ RTW_INFO("rate_bmp_ht_by_bw[%u]:0x%08x=>0x%08x\n", highest_rate_bw, ori_bmp_ht[highest_rate_bw], rf_ctl->rate_bmp_ht_by_bw[highest_rate_bw]); ++ } ++ update_ht_rs = _TRUE; ++ } ++ ++ highest_rate_bw_bmp = BW_CAP_20M; ++ highest_rate_bw = CHANNEL_WIDTH_20; ++ for (bw = CHANNEL_WIDTH_20; bw <= CHANNEL_WIDTH_160; bw++) { ++ if (rf_ctl->rate_bmp_vht_by_bw[highest_rate_bw] < rf_ctl->rate_bmp_vht_by_bw[bw]) { ++ highest_rate_bw_bmp = ch_width_to_bw_cap(bw); ++ highest_rate_bw = bw; ++ } else if (rf_ctl->rate_bmp_vht_by_bw[highest_rate_bw] == rf_ctl->rate_bmp_vht_by_bw[bw]) ++ highest_rate_bw_bmp |= ch_width_to_bw_cap(bw); ++ } ++ rf_ctl->highest_vht_rate_bw_bmp = highest_rate_bw_bmp; ++ ++ if (ori_highest_vht_rate_bw_bmp != rf_ctl->highest_vht_rate_bw_bmp ++ || largest_bit(ori_bmp_vht[highest_rate_bw]) != largest_bit(rf_ctl->rate_bmp_vht_by_bw[highest_rate_bw]) ++ ) { ++ if (DBG_HIGHEST_RATE_BMP_BW_CHANGE) { ++ RTW_INFO("highest_vht_rate_bw_bmp:0x%02x=>0x%02x\n", ori_highest_vht_rate_bw_bmp, rf_ctl->highest_vht_rate_bw_bmp); ++ RTW_INFO("rate_bmp_vht_by_bw[%u]:0x%08x=>0x%08x\n", highest_rate_bw, ori_bmp_vht[highest_rate_bw], rf_ctl->rate_bmp_vht_by_bw[highest_rate_bw]); ++ } ++ update_vht_rs = _TRUE; ++ } ++ ++ /* TODO: per rfpath and rate section handling? */ ++ if (update_ht_rs == _TRUE || update_vht_rs == _TRUE) ++ rtw_hal_set_tx_power_level(dvobj_get_primary_adapter(dvobj), hal_data->CurrentChannel); ++ } ++} ++ ++inline u16 rtw_get_tx_rate_bmp_cck_ofdm(struct dvobj_priv *dvobj) ++{ ++ struct rf_ctl_t *rf_ctl = dvobj_to_rfctl(dvobj); ++ ++ return rf_ctl->rate_bmp_cck_ofdm; ++} ++ ++inline u32 rtw_get_tx_rate_bmp_ht_by_bw(struct dvobj_priv *dvobj, u8 bw) ++{ ++ struct rf_ctl_t *rf_ctl = dvobj_to_rfctl(dvobj); ++ ++ return rf_ctl->rate_bmp_ht_by_bw[bw]; ++} ++ ++inline u32 rtw_get_tx_rate_bmp_vht_by_bw(struct dvobj_priv *dvobj, u8 bw) ++{ ++ struct rf_ctl_t *rf_ctl = dvobj_to_rfctl(dvobj); ++ ++ return rf_ctl->rate_bmp_vht_by_bw[bw]; ++} ++ ++u8 rtw_get_tx_bw_bmp_of_ht_rate(struct dvobj_priv *dvobj, u8 rate, u8 max_bw) ++{ ++ struct rf_ctl_t *rf_ctl = dvobj_to_rfctl(dvobj); ++ u8 bw; ++ u8 bw_bmp = 0; ++ u32 rate_bmp; ++ ++ if (!IS_HT_RATE(rate)) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ rate_bmp = 1 << (rate - MGN_MCS0); ++ ++ if (max_bw > CHANNEL_WIDTH_40) ++ max_bw = CHANNEL_WIDTH_40; ++ ++ for (bw = CHANNEL_WIDTH_20; bw <= max_bw; bw++) { ++ /* RA may use lower rate for retry */ ++ if (rf_ctl->rate_bmp_ht_by_bw[bw] >= rate_bmp) ++ bw_bmp |= ch_width_to_bw_cap(bw); ++ } ++ ++exit: ++ return bw_bmp; ++} ++ ++u8 rtw_get_tx_bw_bmp_of_vht_rate(struct dvobj_priv *dvobj, u8 rate, u8 max_bw) ++{ ++ struct rf_ctl_t *rf_ctl = dvobj_to_rfctl(dvobj); ++ u8 bw; ++ u8 bw_bmp = 0; ++ u32 rate_bmp; ++ ++ if (!IS_VHT_RATE(rate)) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ rate_bmp = 1 << (rate - MGN_VHT1SS_MCS0); ++ ++ if (max_bw > CHANNEL_WIDTH_160) ++ max_bw = CHANNEL_WIDTH_160; ++ ++ for (bw = CHANNEL_WIDTH_20; bw <= max_bw; bw++) { ++ /* RA may use lower rate for retry */ ++ if (rf_ctl->rate_bmp_vht_by_bw[bw] >= rate_bmp) ++ bw_bmp |= ch_width_to_bw_cap(bw); ++ } ++ ++exit: ++ return bw_bmp; ++} ++ ++u8 query_ra_short_GI(struct sta_info *psta, u8 bw) ++{ ++ u8 sgi = _FALSE, sgi_20m = _FALSE, sgi_40m = _FALSE, sgi_80m = _FALSE; ++ ++#ifdef CONFIG_80211N_HT ++#ifdef CONFIG_80211AC_VHT ++ if (psta->vhtpriv.vht_option) ++ sgi_80m = psta->vhtpriv.sgi_80m; ++#endif ++ sgi_20m = psta->htpriv.sgi_20m; ++ sgi_40m = psta->htpriv.sgi_40m; ++#endif ++ ++ switch (bw) { ++ case CHANNEL_WIDTH_80: ++ sgi = sgi_80m; ++ break; ++ case CHANNEL_WIDTH_40: ++ sgi = sgi_40m; ++ break; ++ case CHANNEL_WIDTH_20: ++ default: ++ sgi = sgi_20m; ++ break; ++ } ++ ++ return sgi; ++} ++ ++static void update_attrib_vcs_info(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ u32 sz; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ /* struct sta_info *psta = pattrib->psta; */ ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ /* ++ if(pattrib->psta) ++ { ++ psta = pattrib->psta; ++ } ++ else ++ { ++ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); ++ psta=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0] ); ++ } ++ ++ if(psta==NULL) ++ { ++ RTW_INFO("%s, psta==NUL\n", __func__); ++ return; ++ } ++ ++ if(!(psta->state &_FW_LINKED)) ++ { ++ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); ++ return; ++ } ++ */ ++ ++ if (pattrib->nr_frags != 1) ++ sz = padapter->xmitpriv.frag_len; ++ else /* no frag */ ++ sz = pattrib->last_txcmdsz; ++ ++ /* (1) RTS_Threshold is compared to the MPDU, not MSDU. */ ++ /* (2) If there are more than one frag in this MSDU, only the first frag uses protection frame. */ ++ /* Other fragments are protected by previous fragment. */ ++ /* So we only need to check the length of first fragment. */ ++ if (pmlmeext->cur_wireless_mode < WIRELESS_11_24N || padapter->registrypriv.wifi_spec) { ++ if (sz > padapter->registrypriv.rts_thresh) ++ pattrib->vcs_mode = RTS_CTS; ++ else { ++ if (pattrib->rtsen) ++ pattrib->vcs_mode = RTS_CTS; ++ else if (pattrib->cts2self) ++ pattrib->vcs_mode = CTS_TO_SELF; ++ else ++ pattrib->vcs_mode = NONE_VCS; ++ } ++ } else { ++ while (_TRUE) { ++#if 0 /* Todo */ ++ /* check IOT action */ ++ if (pHTInfo->IOTAction & HT_IOT_ACT_FORCED_CTS2SELF) { ++ pattrib->vcs_mode = CTS_TO_SELF; ++ pattrib->rts_rate = MGN_24M; ++ break; ++ } else if (pHTInfo->IOTAction & (HT_IOT_ACT_FORCED_RTS | HT_IOT_ACT_PURE_N_MODE)) { ++ pattrib->vcs_mode = RTS_CTS; ++ pattrib->rts_rate = MGN_24M; ++ break; ++ } ++#endif ++ ++ /* IOT action */ ++ if ((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_ATHEROS) && (pattrib->ampdu_en == _TRUE) && ++ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) { ++ pattrib->vcs_mode = CTS_TO_SELF; ++ break; ++ } ++ ++ ++ /* check ERP protection */ ++ if (pattrib->rtsen || pattrib->cts2self) { ++ if (pattrib->rtsen) ++ pattrib->vcs_mode = RTS_CTS; ++ else if (pattrib->cts2self) ++ pattrib->vcs_mode = CTS_TO_SELF; ++ ++ break; ++ } ++ ++ /* check HT op mode */ ++ if (pattrib->ht_en) { ++ u8 HTOpMode = pmlmeinfo->HT_protection; ++ if ((pmlmeext->cur_bwmode && (HTOpMode == 2 || HTOpMode == 3)) || ++ (!pmlmeext->cur_bwmode && HTOpMode == 3)) { ++ pattrib->vcs_mode = RTS_CTS; ++ break; ++ } ++ } ++ ++ /* check rts */ ++ if (sz > padapter->registrypriv.rts_thresh) { ++ pattrib->vcs_mode = RTS_CTS; ++ break; ++ } ++ ++ /* to do list: check MIMO power save condition. */ ++ ++ /* check AMPDU aggregation for TXOP */ ++ if ((pattrib->ampdu_en == _TRUE) && (!IS_HARDWARE_TYPE_8812(padapter))) { ++ pattrib->vcs_mode = RTS_CTS; ++ break; ++ } ++ ++ pattrib->vcs_mode = NONE_VCS; ++ break; ++ } ++ } ++ ++ /* for debug : force driver control vrtl_carrier_sense. */ ++ if (padapter->driver_vcs_en == 1) { ++ /* u8 driver_vcs_en; */ /* Enable=1, Disable=0 driver control vrtl_carrier_sense. */ ++ /* u8 driver_vcs_type; */ /* force 0:disable VCS, 1:RTS-CTS, 2:CTS-to-self when vcs_en=1. */ ++ pattrib->vcs_mode = padapter->driver_vcs_type; ++ } ++ ++} ++ ++static void update_attrib_phy_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) ++{ ++ struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; ++ u8 bw; ++ ++ pattrib->rtsen = psta->rtsen; ++ pattrib->cts2self = psta->cts2self; ++ ++ pattrib->mdata = 0; ++ pattrib->eosp = 0; ++ pattrib->triggered = 0; ++ pattrib->ampdu_spacing = 0; ++ ++ /* qos_en, ht_en, init rate, ,bw, ch_offset, sgi */ ++ pattrib->qos_en = psta->qos_option; ++ ++ pattrib->raid = psta->raid; ++ ++ bw = rtw_get_tx_bw_mode(padapter, psta); ++ pattrib->bwmode = rtw_min(bw, mlmeext->cur_bwmode); ++ pattrib->sgi = query_ra_short_GI(psta, pattrib->bwmode); ++ ++ pattrib->ldpc = psta->ldpc; ++ pattrib->stbc = psta->stbc; ++ ++#ifdef CONFIG_80211N_HT ++ pattrib->ht_en = psta->htpriv.ht_option; ++ pattrib->ch_offset = psta->htpriv.ch_offset; ++ pattrib->ampdu_en = _FALSE; ++ ++ if (padapter->driver_ampdu_spacing != 0xFF) /* driver control AMPDU Density for peer sta's rx */ ++ pattrib->ampdu_spacing = padapter->driver_ampdu_spacing; ++ else ++ pattrib->ampdu_spacing = psta->htpriv.rx_ampdu_min_spacing; ++#endif /* CONFIG_80211N_HT */ ++ /* if(pattrib->ht_en && psta->htpriv.ampdu_enable) */ ++ /* { */ ++ /* if(psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) */ ++ /* pattrib->ampdu_en = _TRUE; */ ++ /* } */ ++ ++#ifdef CONFIG_TDLS ++ if (pattrib->direct_link == _TRUE) { ++ psta = pattrib->ptdls_sta; ++ ++ pattrib->raid = psta->raid; ++#ifdef CONFIG_80211N_HT ++ pattrib->bwmode = rtw_get_tx_bw_mode(padapter, psta); ++ pattrib->ht_en = psta->htpriv.ht_option; ++ pattrib->ch_offset = psta->htpriv.ch_offset; ++ pattrib->sgi = query_ra_short_GI(psta, pattrib->bwmode); ++#endif /* CONFIG_80211N_HT */ ++ } ++#endif /* CONFIG_TDLS */ ++ ++ pattrib->retry_ctrl = _FALSE; ++ ++#ifdef CONFIG_AUTO_AP_MODE ++ if (psta->isrc && psta->pid > 0) ++ pattrib->pctrl = _TRUE; ++#endif ++ ++} ++ ++static s32 update_attrib_sec_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) ++{ ++ sint res = _SUCCESS; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ sint bmcast = IS_MCAST(pattrib->ra); ++ ++ _rtw_memset(pattrib->dot118021x_UncstKey.skey, 0, 16); ++ _rtw_memset(pattrib->dot11tkiptxmickey.skey, 0, 16); ++ pattrib->mac_id = psta->mac_id; ++ ++ if (psta->ieee8021x_blocked == _TRUE) { ++ ++ pattrib->encrypt = 0; ++ ++ if ((pattrib->ether_type != 0x888e) && (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _FALSE)) { ++#ifdef DBG_TX_DROP_FRAME ++ RTW_INFO("DBG_TX_DROP_FRAME %s psta->ieee8021x_blocked == _TRUE, pattrib->ether_type(%04x) != 0x888e\n", __FUNCTION__, pattrib->ether_type); ++#endif ++ res = _FAIL; ++ goto exit; ++ } ++ } else { ++ GET_ENCRY_ALGO(psecuritypriv, psta, pattrib->encrypt, bmcast); ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (pattrib->ether_type == 0x88B4) ++ pattrib->encrypt = _NO_PRIVACY_; ++#endif ++ ++ switch (psecuritypriv->dot11AuthAlgrthm) { ++ case dot11AuthAlgrthm_Open: ++ case dot11AuthAlgrthm_Shared: ++ case dot11AuthAlgrthm_Auto: ++ pattrib->key_idx = (u8)psecuritypriv->dot11PrivacyKeyIndex; ++ break; ++ case dot11AuthAlgrthm_8021X: ++ if (bmcast) ++ pattrib->key_idx = (u8)psecuritypriv->dot118021XGrpKeyid; ++ else ++ pattrib->key_idx = 0; ++ break; ++ default: ++ pattrib->key_idx = 0; ++ break; ++ } ++ ++ /* For WPS 1.0 WEP, driver should not encrypt EAPOL Packet for WPS handshake. */ ++ if (((pattrib->encrypt == _WEP40_) || (pattrib->encrypt == _WEP104_)) && (pattrib->ether_type == 0x888e)) ++ pattrib->encrypt = _NO_PRIVACY_; ++ ++ } ++ ++#ifdef CONFIG_TDLS ++ if (pattrib->direct_link == _TRUE) { ++ if (pattrib->encrypt > 0) ++ pattrib->encrypt = _AES_; ++ } ++#endif ++ ++ switch (pattrib->encrypt) { ++ case _WEP40_: ++ case _WEP104_: ++ pattrib->iv_len = 4; ++ pattrib->icv_len = 4; ++ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); ++ break; ++ ++ case _TKIP_: ++ pattrib->iv_len = 8; ++ pattrib->icv_len = 4; ++ ++ if (psecuritypriv->busetkipkey == _FAIL) { ++#ifdef DBG_TX_DROP_FRAME ++ RTW_INFO("DBG_TX_DROP_FRAME %s psecuritypriv->busetkipkey(%d)==_FAIL drop packet\n", __FUNCTION__, psecuritypriv->busetkipkey); ++#endif ++ res = _FAIL; ++ goto exit; ++ } ++ ++ if (bmcast) ++ TKIP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); ++ else ++ TKIP_IV(pattrib->iv, psta->dot11txpn, 0); ++ ++ ++ _rtw_memcpy(pattrib->dot11tkiptxmickey.skey, psta->dot11tkiptxmickey.skey, 16); ++ ++ break; ++ ++ case _AES_: ++ ++ pattrib->iv_len = 8; ++ pattrib->icv_len = 8; ++ ++ if (bmcast) ++ AES_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); ++ else ++ AES_IV(pattrib->iv, psta->dot11txpn, 0); ++ ++ break; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ case _SMS4_: ++ pattrib->iv_len = 18; ++ pattrib->icv_len = 16; ++ rtw_wapi_get_iv(padapter, pattrib->ra, pattrib->iv); ++ break; ++#endif ++ default: ++ pattrib->iv_len = 0; ++ pattrib->icv_len = 0; ++ break; ++ } ++ ++ if (pattrib->encrypt > 0) ++ _rtw_memcpy(pattrib->dot118021x_UncstKey.skey, psta->dot118021x_UncstKey.skey, 16); ++ ++ ++ if (pattrib->encrypt && ++ ((padapter->securitypriv.sw_encrypt == _TRUE) || (psecuritypriv->hw_decrypted == _FALSE))) { ++ pattrib->bswenc = _TRUE; ++ } else { ++ pattrib->bswenc = _FALSE; ++ } ++ ++#if defined(CONFIG_CONCURRENT_MODE) ++ pattrib->bmc_camid = padapter->securitypriv.dot118021x_bmc_cam_id; ++#endif ++ ++ if (pattrib->encrypt && bmcast && _rtw_camctl_chk_flags(padapter, SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH)) ++ pattrib->bswenc = _TRUE; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (pattrib->encrypt == _SMS4_) ++ pattrib->bswenc = _FALSE; ++#endif ++ ++exit: ++ ++ return res; ++ ++} ++ ++u8 qos_acm(u8 acm_mask, u8 priority) ++{ ++ u8 change_priority = priority; ++ ++ switch (priority) { ++ case 0: ++ case 3: ++ if (acm_mask & BIT(1)) ++ change_priority = 1; ++ break; ++ case 1: ++ case 2: ++ break; ++ case 4: ++ case 5: ++ if (acm_mask & BIT(2)) ++ change_priority = 0; ++ break; ++ case 6: ++ case 7: ++ if (acm_mask & BIT(3)) ++ change_priority = 5; ++ break; ++ default: ++ RTW_INFO("qos_acm(): invalid pattrib->priority: %d!!!\n", priority); ++ break; ++ } ++ ++ return change_priority; ++} ++ ++static void set_qos(struct pkt_file *ppktfile, struct pkt_attrib *pattrib) ++{ ++ struct ethhdr etherhdr; ++ struct iphdr ip_hdr; ++ s32 UserPriority = 0; ++ ++ ++ _rtw_open_pktfile(ppktfile->pkt, ppktfile); ++ _rtw_pktfile_read(ppktfile, (unsigned char *)ðerhdr, ETH_HLEN); ++ ++ /* get UserPriority from IP hdr */ ++ if (pattrib->ether_type == 0x0800) { ++ _rtw_pktfile_read(ppktfile, (u8 *)&ip_hdr, sizeof(ip_hdr)); ++ /* UserPriority = (ntohs(ip_hdr.tos) >> 5) & 0x3; */ ++ UserPriority = ip_hdr.tos >> 5; ++ } ++ /* ++ else if (pattrib->ether_type == 0x888e) { ++ ++ ++ UserPriority = 7; ++ } ++ */ ++ pattrib->priority = UserPriority; ++ pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN; ++ pattrib->subtype = WIFI_QOS_DATA_TYPE; ++} ++ ++#ifdef CONFIG_TDLS ++u8 rtw_check_tdls_established(_adapter *padapter, struct pkt_attrib *pattrib) ++{ ++ pattrib->ptdls_sta = NULL; ++ ++ pattrib->direct_link = _FALSE; ++ if (padapter->tdlsinfo.link_established == _TRUE) { ++ pattrib->ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); ++#if 1 ++ if ((pattrib->ptdls_sta != NULL) && ++ (pattrib->ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) && ++ (pattrib->ether_type != 0x0806)) { ++ pattrib->direct_link = _TRUE; ++ /* RTW_INFO("send ptk to "MAC_FMT" using direct link\n", MAC_ARG(pattrib->dst)); */ ++ } ++#else ++ if (pattrib->ptdls_sta != NULL && ++ pattrib->ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { ++ pattrib->direct_link = _TRUE; ++#if 0 ++ RTW_INFO("send ptk to "MAC_FMT" using direct link\n", MAC_ARG(pattrib->dst)); ++#endif ++ } ++ ++ /* ARP frame may be helped by AP*/ ++ if (pattrib->ether_type != 0x0806) ++ pattrib->direct_link = _FALSE; ++#endif ++ } ++ ++ return pattrib->direct_link; ++} ++ ++s32 update_tdls_attrib(_adapter *padapter, struct pkt_attrib *pattrib) ++{ ++ ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct qos_priv *pqospriv = &pmlmepriv->qospriv; ++ ++ s32 res = _SUCCESS; ++ ++ psta = rtw_get_stainfo(pstapriv, pattrib->ra); ++ if (psta == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pattrib->mac_id = psta->mac_id; ++ pattrib->psta = psta; ++ pattrib->ack_policy = 0; ++ /* get ether_hdr_len */ ++ pattrib->pkt_hdrlen = ETH_HLEN; ++ ++ /* [TDLS] TODO: setup req/rsp should be AC_BK */ ++ if (pqospriv->qos_option && psta->qos_option) { ++ pattrib->priority = 4; /* tdls management frame should be AC_VI */ ++ pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN; ++ pattrib->subtype = WIFI_QOS_DATA_TYPE; ++ } else { ++ pattrib->priority = 0; ++ pattrib->hdrlen = WLAN_HDR_A3_LEN; ++ pattrib->subtype = WIFI_DATA_TYPE; ++ } ++ ++ /* TODO:_lock */ ++ if (update_attrib_sec_info(padapter, pattrib, psta) == _FAIL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ update_attrib_phy_info(padapter, pattrib, psta); ++ ++ ++exit: ++ ++ return res; ++} ++ ++#endif /* CONFIG_TDLS */ ++ ++/*get non-qos hw_ssn control register,mapping to REG_HW_SEQ0,1,2,3*/ ++inline u8 rtw_get_hwseq_no(_adapter *padapter) ++{ ++ u8 hwseq_num = 0; ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->adapter_type != PRIMARY_ADAPTER) ++ hwseq_num = 1; ++ /* else */ ++ /* hwseq_num = 2; */ ++#endif /* CONFIG_CONCURRENT_MODE */ ++ return hwseq_num; ++} ++static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattrib) ++{ ++ uint i; ++ struct pkt_file pktfile; ++ struct sta_info *psta = NULL; ++ struct ethhdr etherhdr; ++ ++ sint bmcast; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct qos_priv *pqospriv = &pmlmepriv->qospriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ sint res = _SUCCESS; ++ ++ ++ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib); ++ ++ _rtw_open_pktfile(pkt, &pktfile); ++ i = _rtw_pktfile_read(&pktfile, (u8 *)ðerhdr, ETH_HLEN); ++ ++ pattrib->ether_type = ntohs(etherhdr.h_proto); ++ ++ ++ _rtw_memcpy(pattrib->dst, ðerhdr.h_dest, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, ðerhdr.h_source, ETH_ALEN); ++ ++ ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { ++ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, adapter_mac_addr(padapter), ETH_ALEN); ++ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_adhoc); ++ } else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { ++#ifdef CONFIG_TDLS ++ if (rtw_check_tdls_established(padapter, pattrib) == _TRUE) ++ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); /* For TDLS direct link Tx, set ra to be same to dst */ ++ else ++#endif ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, adapter_mac_addr(padapter), ETH_ALEN); ++ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_sta); ++ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, get_bssid(pmlmepriv), ETH_ALEN); ++ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_ap); ++ } else ++ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_unknown); ++ ++ bmcast = IS_MCAST(pattrib->ra); ++ if (bmcast) { ++ psta = rtw_get_bcmc_stainfo(padapter); ++ if (psta == NULL) { /* if we cannot get psta => drop the pkt */ ++ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_sta); ++#ifdef DBG_TX_DROP_FRAME ++ RTW_INFO("DBG_TX_DROP_FRAME %s get sta_info fail, ra:" MAC_FMT"\n", __func__, MAC_ARG(pattrib->ra)); ++#endif ++ res = _FAIL; ++ goto exit; ++ } ++ } else { ++ psta = rtw_get_stainfo(pstapriv, pattrib->ra); ++ if (psta == NULL) { /* if we cannot get psta => drop the pkt */ ++ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_ucast_sta); ++#ifdef DBG_TX_DROP_FRAME ++ RTW_INFO("DBG_TX_DROP_FRAME %s get sta_info fail, ra:" MAC_FMT"\n", __func__, MAC_ARG(pattrib->ra)); ++#endif ++ res = _FAIL; ++ goto exit; ++ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE && !(psta->state & _FW_LINKED)) { ++ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_ucast_ap_link); ++ res = _FAIL; ++ goto exit; ++ } ++ } ++ ++ if (!(psta->state & _FW_LINKED)) { ++ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_link); ++ RTW_INFO("%s-"ADPT_FMT" psta("MAC_FMT")->state(0x%x) != _FW_LINKED\n", __func__, ADPT_ARG(padapter), MAC_ARG(psta->hwaddr), psta->state); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pattrib->pktlen = pktfile.pkt_len; ++ ++ /* TODO: 802.1Q VLAN header */ ++ /* TODO: IPV6 */ ++ ++ if (ETH_P_IP == pattrib->ether_type) { ++ u8 ip[20]; ++ ++ _rtw_pktfile_read(&pktfile, ip, 20); ++ ++ if (GET_IPV4_IHL(ip) * 4 > 20) ++ _rtw_pktfile_read(&pktfile, NULL, GET_IPV4_IHL(ip) - 20); ++ ++ pattrib->icmp_pkt = 0; ++ pattrib->dhcp_pkt = 0; ++ ++ if (GET_IPV4_PROTOCOL(ip) == 0x01) { /* ICMP */ ++ pattrib->icmp_pkt = 1; ++ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_icmp); ++ ++ } else if (GET_IPV4_PROTOCOL(ip) == 0x11) { /* UDP */ ++ u8 udp[8]; ++ ++ _rtw_pktfile_read(&pktfile, udp, 8); ++ ++ if ((GET_UDP_SRC(udp) == 68 && GET_UDP_DST(udp) == 67) ++ || (GET_UDP_SRC(udp) == 67 && GET_UDP_DST(udp) == 68) ++ ) { ++ /* 67 : UDP BOOTP server, 68 : UDP BOOTP client */ ++ if (pattrib->pktlen > 282) { /* MINIMUM_DHCP_PACKET_SIZE */ ++ pattrib->dhcp_pkt = 1; ++ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_dhcp); ++ if (0) ++ RTW_INFO("send DHCP packet\n"); ++ } ++ } ++ ++ } else if (GET_IPV4_PROTOCOL(ip) == 0x06 /* TCP */ ++ && rtw_st_ctl_chk_reg_s_proto(&psta->st_ctl, 0x06) == _TRUE ++ ) { ++ u8 tcp[20]; ++ ++ _rtw_pktfile_read(&pktfile, tcp, 20); ++ ++ if (rtw_st_ctl_chk_reg_rule(&psta->st_ctl, padapter, IPV4_SRC(ip), TCP_SRC(tcp), IPV4_DST(ip), TCP_DST(tcp)) == _TRUE) { ++ if (GET_TCP_SYN(tcp) && GET_TCP_ACK(tcp)) { ++ session_tracker_add_cmd(padapter, psta ++ , IPV4_SRC(ip), TCP_SRC(tcp) ++ , IPV4_SRC(ip), TCP_DST(tcp)); ++ if (DBG_SESSION_TRACKER) ++ RTW_INFO(FUNC_ADPT_FMT" local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT" SYN-ACK\n" ++ , FUNC_ADPT_ARG(padapter) ++ , IP_ARG(IPV4_SRC(ip)), PORT_ARG(TCP_SRC(tcp)) ++ , IP_ARG(IPV4_DST(ip)), PORT_ARG(TCP_DST(tcp))); ++ } ++ if (GET_TCP_FIN(tcp)) { ++ session_tracker_del_cmd(padapter, psta ++ , IPV4_SRC(ip), TCP_SRC(tcp) ++ , IPV4_SRC(ip), TCP_DST(tcp)); ++ if (DBG_SESSION_TRACKER) ++ RTW_INFO(FUNC_ADPT_FMT" local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT" FIN\n" ++ , FUNC_ADPT_ARG(padapter) ++ , IP_ARG(IPV4_SRC(ip)), PORT_ARG(TCP_SRC(tcp)) ++ , IP_ARG(IPV4_DST(ip)), PORT_ARG(TCP_DST(tcp))); ++ } ++ } ++ } ++ ++ } else if (0x888e == pattrib->ether_type) ++ RTW_PRINT("send eapol packet\n"); ++ ++ if ((pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1)) ++ rtw_mi_set_scan_deny(padapter, 3000); ++ ++#ifdef CONFIG_LPS ++ /* If EAPOL , ARP , OR DHCP packet, driver must be in active mode. */ ++#ifdef CONFIG_WAPI_SUPPORT ++ if ((pattrib->ether_type == 0x88B4) || (pattrib->ether_type == 0x0806) || (pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1)) ++#else /* !CONFIG_WAPI_SUPPORT */ ++#if 0 ++ if ((pattrib->ether_type == 0x0806) || (pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1)) ++#else /* only ICMP/DHCP packets is as SPECIAL_PACKET, and leave LPS when tx IMCP/DHCP packets. */ ++ /* if ((pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1) ) */ ++ if (pattrib->icmp_pkt == 1) ++ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); ++ else if (pattrib->dhcp_pkt == 1) ++#endif ++#endif ++ { ++ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_active); ++ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SPECIAL_PACKET, 1); ++ } ++#endif /* CONFIG_LPS */ ++ ++#ifdef CONFIG_BEAMFORMING ++ update_attrib_txbf_info(padapter, pattrib, psta); ++#endif ++ ++ /* TODO:_lock */ ++ if (update_attrib_sec_info(padapter, pattrib, psta) == _FAIL) { ++ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_sec); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ update_attrib_phy_info(padapter, pattrib, psta); ++ ++ /* RTW_INFO("%s ==> mac_id(%d)\n",__FUNCTION__,pattrib->mac_id ); */ ++ ++ pattrib->psta = psta; ++ /* TODO:_unlock */ ++ ++ pattrib->pctrl = 0; ++ ++ pattrib->ack_policy = 0; ++ /* get ether_hdr_len */ ++ pattrib->pkt_hdrlen = ETH_HLEN;/* (pattrib->ether_type == 0x8100) ? (14 + 4 ): 14; */ /* vlan tag */ ++ ++ pattrib->hdrlen = WLAN_HDR_A3_LEN; ++ pattrib->subtype = WIFI_DATA_TYPE; ++ pattrib->priority = 0; ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE | WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { ++ if (pattrib->qos_en) ++ set_qos(&pktfile, pattrib); ++ } else { ++#ifdef CONFIG_TDLS ++ if (pattrib->direct_link == _TRUE) { ++ if (pattrib->qos_en) ++ set_qos(&pktfile, pattrib); ++ } else ++#endif ++ { ++ if (pqospriv->qos_option) { ++ set_qos(&pktfile, pattrib); ++ ++ if (pmlmepriv->acm_mask != 0) ++ pattrib->priority = qos_acm(pmlmepriv->acm_mask, pattrib->priority); ++ } ++ } ++ } ++ ++ /* pattrib->priority = 5; */ /* force to used VI queue, for testing */ ++ pattrib->hw_ssn_sel = pxmitpriv->hw_ssn_seq_no; ++ rtw_set_tx_chksum_offload(pkt, pattrib); ++ ++exit: ++ ++ ++ return res; ++} ++ ++static s32 xmitframe_addmic(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ sint curfragnum, length; ++ u8 *pframe, *payload, mic[8]; ++ struct mic_data micdata; ++ /* struct sta_info *stainfo; */ ++ struct qos_priv *pqospriv = &(padapter->mlmepriv.qospriv); ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ u8 priority[4] = {0x0, 0x0, 0x0, 0x0}; ++ u8 hw_hdr_offset = 0; ++ sint bmcst = IS_MCAST(pattrib->ra); ++ ++ /* ++ if(pattrib->psta) ++ { ++ stainfo = pattrib->psta; ++ } ++ else ++ { ++ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); ++ stainfo=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0]); ++ } ++ ++ if(stainfo==NULL) ++ { ++ RTW_INFO("%s, psta==NUL\n", __func__); ++ return _FAIL; ++ } ++ ++ if(!(stainfo->state &_FW_LINKED)) ++ { ++ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, stainfo->state); ++ return _FAIL; ++ } ++ */ ++ ++ ++#ifdef CONFIG_USB_TX_AGGREGATION ++ hw_hdr_offset = TXDESC_SIZE + (pxmitframe->pkt_offset * PACKET_OFFSET_SZ);; ++#else ++#ifdef CONFIG_TX_EARLY_MODE ++ hw_hdr_offset = TXDESC_OFFSET + EARLY_MODE_INFO_SIZE; ++#else ++ hw_hdr_offset = TXDESC_OFFSET; ++#endif ++#endif ++ ++ if (pattrib->encrypt == _TKIP_) { /* if(psecuritypriv->dot11PrivacyAlgrthm==_TKIP_PRIVACY_) */ ++ /* encode mic code */ ++ /* if(stainfo!= NULL) */ ++ { ++ u8 null_key[16] = {0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; ++ ++ pframe = pxmitframe->buf_addr + hw_hdr_offset; ++ ++ if (bmcst) { ++ if (_rtw_memcmp(psecuritypriv->dot118021XGrptxmickey[psecuritypriv->dot118021XGrpKeyid].skey, null_key, 16) == _TRUE) { ++ /* DbgPrint("\nxmitframe_addmic:stainfo->dot11tkiptxmickey==0\n"); */ ++ /* rtw_msleep_os(10); */ ++ return _FAIL; ++ } ++ /* start to calculate the mic code */ ++ rtw_secmicsetkey(&micdata, psecuritypriv->dot118021XGrptxmickey[psecuritypriv->dot118021XGrpKeyid].skey); ++ } else { ++ if (_rtw_memcmp(&pattrib->dot11tkiptxmickey.skey[0], null_key, 16) == _TRUE) { ++ /* DbgPrint("\nxmitframe_addmic:stainfo->dot11tkiptxmickey==0\n"); */ ++ /* rtw_msleep_os(10); */ ++ return _FAIL; ++ } ++ /* start to calculate the mic code */ ++ rtw_secmicsetkey(&micdata, &pattrib->dot11tkiptxmickey.skey[0]); ++ } ++ ++ if (pframe[1] & 1) { /* ToDS==1 */ ++ rtw_secmicappend(&micdata, &pframe[16], 6); /* DA */ ++ if (pframe[1] & 2) /* From Ds==1 */ ++ rtw_secmicappend(&micdata, &pframe[24], 6); ++ else ++ rtw_secmicappend(&micdata, &pframe[10], 6); ++ } else { /* ToDS==0 */ ++ rtw_secmicappend(&micdata, &pframe[4], 6); /* DA */ ++ if (pframe[1] & 2) /* From Ds==1 */ ++ rtw_secmicappend(&micdata, &pframe[16], 6); ++ else ++ rtw_secmicappend(&micdata, &pframe[10], 6); ++ ++ } ++ ++ /* if(pqospriv->qos_option==1) */ ++ if (pattrib->qos_en) ++ priority[0] = (u8)pxmitframe->attrib.priority; ++ ++ ++ rtw_secmicappend(&micdata, &priority[0], 4); ++ ++ payload = pframe; ++ ++ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { ++ payload = (u8 *)RND4((SIZE_PTR)(payload)); ++ ++ payload = payload + pattrib->hdrlen + pattrib->iv_len; ++ if ((curfragnum + 1) == pattrib->nr_frags) { ++ length = pattrib->last_txcmdsz - pattrib->hdrlen - pattrib->iv_len - ((pattrib->bswenc) ? pattrib->icv_len : 0); ++ rtw_secmicappend(&micdata, payload, length); ++ payload = payload + length; ++ } else { ++ length = pxmitpriv->frag_len - pattrib->hdrlen - pattrib->iv_len - ((pattrib->bswenc) ? pattrib->icv_len : 0); ++ rtw_secmicappend(&micdata, payload, length); ++ payload = payload + length + pattrib->icv_len; ++ } ++ } ++ rtw_secgetmic(&micdata, &(mic[0])); ++ /* add mic code and add the mic code length in last_txcmdsz */ ++ ++ _rtw_memcpy(payload, &(mic[0]), 8); ++ pattrib->last_txcmdsz += 8; ++ ++ payload = payload - pattrib->last_txcmdsz + 8; ++ } ++ } ++ ++ ++ return _SUCCESS; ++} ++ ++/*#define DBG_TX_SW_ENCRYPTOR*/ ++ ++static s32 xmitframe_swencrypt(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ /* struct security_priv *psecuritypriv=&padapter->securitypriv; */ ++ ++ ++ /* if((psecuritypriv->sw_encrypt)||(pattrib->bswenc)) */ ++ if (pattrib->bswenc) { ++#ifdef DBG_TX_SW_ENCRYPTOR ++ RTW_INFO(ADPT_FMT" - sec_type:%s DO SW encryption\n", ++ ADPT_ARG(padapter), security_type_str(pattrib->encrypt)); ++#endif ++ ++ switch (pattrib->encrypt) { ++ case _WEP40_: ++ case _WEP104_: ++ rtw_wep_encrypt(padapter, (u8 *)pxmitframe); ++ break; ++ case _TKIP_: ++ rtw_tkip_encrypt(padapter, (u8 *)pxmitframe); ++ break; ++ case _AES_: ++ rtw_aes_encrypt(padapter, (u8 *)pxmitframe); ++ break; ++#ifdef CONFIG_WAPI_SUPPORT ++ case _SMS4_: ++ rtw_sms4_encrypt(padapter, (u8 *)pxmitframe); ++#endif ++ default: ++ break; ++ } ++ ++ } ++ ++ ++ return _SUCCESS; ++} ++ ++s32 rtw_make_wlanhdr(_adapter *padapter , u8 *hdr, struct pkt_attrib *pattrib) ++{ ++ u16 *qc; ++ ++ struct rtw_ieee80211_hdr *pwlanhdr = (struct rtw_ieee80211_hdr *)hdr; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct qos_priv *pqospriv = &pmlmepriv->qospriv; ++ u8 qos_option = _FALSE; ++ sint res = _SUCCESS; ++ u16 *fctrl = &pwlanhdr->frame_ctl; ++ ++ /* struct sta_info *psta; */ ++ ++ /* sint bmcst = IS_MCAST(pattrib->ra); */ ++ ++ ++ /* ++ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); ++ if(pattrib->psta != psta) ++ { ++ RTW_INFO("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); ++ return; ++ } ++ ++ if(psta==NULL) ++ { ++ RTW_INFO("%s, psta==NUL\n", __func__); ++ return _FAIL; ++ } ++ ++ if(!(psta->state &_FW_LINKED)) ++ { ++ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); ++ return _FAIL; ++ } ++ */ ++ ++ _rtw_memset(hdr, 0, WLANHDR_OFFSET); ++ ++ SetFrameSubType(fctrl, pattrib->subtype); ++ ++ if (pattrib->subtype & WIFI_DATA_TYPE) { ++ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)) { ++#ifdef CONFIG_TDLS ++ if (pattrib->direct_link == _TRUE) { ++ /* TDLS data transfer, ToDS=0, FrDs=0 */ ++ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); ++ ++ if (pattrib->qos_en) ++ qos_option = _TRUE; ++ } else ++#endif /* CONFIG_TDLS */ ++ { ++ /* to_ds = 1, fr_ds = 0; */ ++ /* 1.Data transfer to AP */ ++ /* 2.Arp pkt will relayed by AP */ ++ SetToDs(fctrl); ++ _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pattrib->ta, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); ++ ++ if (pqospriv->qos_option) ++ qos_option = _TRUE; ++ } ++ } else if ((check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE)) { ++ /* to_ds = 0, fr_ds = 1; */ ++ SetFrDs(fctrl); ++ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pattrib->src, ETH_ALEN); ++ ++ if (pattrib->qos_en) ++ qos_option = _TRUE; ++ } else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { ++ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pattrib->ta, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); ++ ++ if (pattrib->qos_en) ++ qos_option = _TRUE; ++ } else { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ if (pattrib->mdata) ++ SetMData(fctrl); ++ ++ if (pattrib->encrypt) ++ SetPrivacy(fctrl); ++ ++ if (qos_option) { ++ qc = (unsigned short *)(hdr + pattrib->hdrlen - 2); ++ ++ if (pattrib->priority) ++ SetPriority(qc, pattrib->priority); ++ ++ SetEOSP(qc, pattrib->eosp); ++ ++ SetAckpolicy(qc, pattrib->ack_policy); ++ } ++ ++ /* TODO: fill HT Control Field */ ++ ++ /* Update Seq Num will be handled by f/w */ ++ { ++ struct sta_info *psta; ++ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); ++ if (pattrib->psta != psta) { ++ RTW_INFO("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); ++ return _FAIL; ++ } ++ ++ if (psta == NULL) { ++ RTW_INFO("%s, psta==NUL\n", __func__); ++ return _FAIL; ++ } ++ ++ if (!(psta->state & _FW_LINKED)) { ++ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); ++ return _FAIL; ++ } ++ ++ ++ if (psta) { ++ psta->sta_xmitpriv.txseq_tid[pattrib->priority]++; ++ psta->sta_xmitpriv.txseq_tid[pattrib->priority] &= 0xFFF; ++ pattrib->seqnum = psta->sta_xmitpriv.txseq_tid[pattrib->priority]; ++ ++ SetSeqNum(hdr, pattrib->seqnum); ++ ++#ifdef CONFIG_80211N_HT ++ /* check if enable ampdu */ ++ if (pattrib->ht_en && psta->htpriv.ampdu_enable) { ++ if (psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) ++ pattrib->ampdu_en = _TRUE; ++ } ++ ++ /* re-check if enable ampdu by BA_starting_seqctrl */ ++ if (pattrib->ampdu_en == _TRUE) { ++ u16 tx_seq; ++ ++ tx_seq = psta->BA_starting_seqctrl[pattrib->priority & 0x0f]; ++ ++ /* check BA_starting_seqctrl */ ++ if (SN_LESS(pattrib->seqnum, tx_seq)) { ++ /* RTW_INFO("tx ampdu seqnum(%d) < tx_seq(%d)\n", pattrib->seqnum, tx_seq); */ ++ pattrib->ampdu_en = _FALSE;/* AGG BK */ ++ } else if (SN_EQUAL(pattrib->seqnum, tx_seq)) { ++ psta->BA_starting_seqctrl[pattrib->priority & 0x0f] = (tx_seq + 1) & 0xfff; ++ ++ pattrib->ampdu_en = _TRUE;/* AGG EN */ ++ } else { ++ /* RTW_INFO("tx ampdu over run\n"); */ ++ psta->BA_starting_seqctrl[pattrib->priority & 0x0f] = (pattrib->seqnum + 1) & 0xfff; ++ pattrib->ampdu_en = _TRUE;/* AGG EN */ ++ } ++ ++ } ++#endif /* CONFIG_80211N_HT */ ++ } ++ } ++ ++ } else { ++ ++ } ++ ++exit: ++ ++ ++ return res; ++} ++ ++s32 rtw_txframes_pending(_adapter *padapter) ++{ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ return ((_rtw_queue_empty(&pxmitpriv->be_pending) == _FALSE) || ++ (_rtw_queue_empty(&pxmitpriv->bk_pending) == _FALSE) || ++ (_rtw_queue_empty(&pxmitpriv->vi_pending) == _FALSE) || ++ (_rtw_queue_empty(&pxmitpriv->vo_pending) == _FALSE)); ++} ++ ++s32 rtw_txframes_sta_ac_pending(_adapter *padapter, struct pkt_attrib *pattrib) ++{ ++ struct sta_info *psta; ++ struct tx_servq *ptxservq; ++ int priority = pattrib->priority; ++ /* ++ if(pattrib->psta) ++ { ++ psta = pattrib->psta; ++ } ++ else ++ { ++ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); ++ psta=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0]); ++ } ++ */ ++ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); ++ if (pattrib->psta != psta) { ++ RTW_INFO("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); ++ return 0; ++ } ++ ++ if (psta == NULL) { ++ RTW_INFO("%s, psta==NUL\n", __func__); ++ return 0; ++ } ++ ++ if (!(psta->state & _FW_LINKED)) { ++ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); ++ return 0; ++ } ++ ++ switch (priority) { ++ case 1: ++ case 2: ++ ptxservq = &(psta->sta_xmitpriv.bk_q); ++ break; ++ case 4: ++ case 5: ++ ptxservq = &(psta->sta_xmitpriv.vi_q); ++ break; ++ case 6: ++ case 7: ++ ptxservq = &(psta->sta_xmitpriv.vo_q); ++ break; ++ case 0: ++ case 3: ++ default: ++ ptxservq = &(psta->sta_xmitpriv.be_q); ++ break; ++ ++ } ++ ++ return ptxservq->qcnt; ++} ++ ++#ifdef CONFIG_TDLS ++ ++int rtw_build_tdls_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) ++{ ++ int res = _SUCCESS; ++ ++ switch (ptxmgmt->action_code) { ++ case TDLS_SETUP_REQUEST: ++ rtw_build_tdls_setup_req_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ break; ++ case TDLS_SETUP_RESPONSE: ++ rtw_build_tdls_setup_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ break; ++ case TDLS_SETUP_CONFIRM: ++ rtw_build_tdls_setup_cfm_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ break; ++ case TDLS_TEARDOWN: ++ rtw_build_tdls_teardown_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ break; ++ case TDLS_DISCOVERY_REQUEST: ++ rtw_build_tdls_dis_req_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ break; ++ case TDLS_PEER_TRAFFIC_INDICATION: ++ rtw_build_tdls_peer_traffic_indication_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ break; ++#ifdef CONFIG_TDLS_CH_SW ++ case TDLS_CHANNEL_SWITCH_REQUEST: ++ rtw_build_tdls_ch_switch_req_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ break; ++ case TDLS_CHANNEL_SWITCH_RESPONSE: ++ rtw_build_tdls_ch_switch_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ break; ++#endif ++ case TDLS_PEER_TRAFFIC_RESPONSE: ++ rtw_build_tdls_peer_traffic_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ break; ++#ifdef CONFIG_WFD ++ case TUNNELED_PROBE_REQ: ++ rtw_build_tunneled_probe_req_ies(padapter, pxmitframe, pframe); ++ break; ++ case TUNNELED_PROBE_RSP: ++ rtw_build_tunneled_probe_rsp_ies(padapter, pxmitframe, pframe); ++ break; ++#endif /* CONFIG_WFD */ ++ default: ++ res = _FAIL; ++ break; ++ } ++ ++ return res; ++} ++ ++s32 rtw_make_tdls_wlanhdr(_adapter *padapter , u8 *hdr, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt) ++{ ++ u16 *qc; ++ struct rtw_ieee80211_hdr *pwlanhdr = (struct rtw_ieee80211_hdr *)hdr; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct qos_priv *pqospriv = &pmlmepriv->qospriv; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta = NULL, *ptdls_sta = NULL; ++ u8 tdls_seq = 0, baddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; ++ ++ sint res = _SUCCESS; ++ u16 *fctrl = &pwlanhdr->frame_ctl; ++ ++ ++ _rtw_memset(hdr, 0, WLANHDR_OFFSET); ++ ++ SetFrameSubType(fctrl, pattrib->subtype); ++ ++ switch (ptxmgmt->action_code) { ++ case TDLS_SETUP_REQUEST: ++ case TDLS_SETUP_RESPONSE: ++ case TDLS_SETUP_CONFIRM: ++ case TDLS_PEER_TRAFFIC_INDICATION: ++ case TDLS_PEER_PSM_REQUEST: ++ case TUNNELED_PROBE_REQ: ++ case TUNNELED_PROBE_RSP: ++ case TDLS_DISCOVERY_REQUEST: ++ SetToDs(fctrl); ++ _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); ++ break; ++ case TDLS_CHANNEL_SWITCH_REQUEST: ++ case TDLS_CHANNEL_SWITCH_RESPONSE: ++ case TDLS_PEER_PSM_RESPONSE: ++ case TDLS_PEER_TRAFFIC_RESPONSE: ++ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); ++ tdls_seq = 1; ++ break; ++ case TDLS_TEARDOWN: ++ if (ptxmgmt->status_code == _RSON_TDLS_TEAR_UN_RSN_) { ++ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); ++ tdls_seq = 1; ++ } else { ++ SetToDs(fctrl); ++ _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); ++ } ++ break; ++ } ++ ++ if (pattrib->encrypt) ++ SetPrivacy(fctrl); ++ ++ if (ptxmgmt->action_code == TDLS_PEER_TRAFFIC_RESPONSE) ++ SetPwrMgt(fctrl); ++ ++ if (pqospriv->qos_option) { ++ qc = (unsigned short *)(hdr + pattrib->hdrlen - 2); ++ if (pattrib->priority) ++ SetPriority(qc, pattrib->priority); ++ SetAckpolicy(qc, pattrib->ack_policy); ++ } ++ ++ psta = pattrib->psta; ++ ++ /* 1. update seq_num per link by sta_info */ ++ /* 2. rewrite encrypt to _AES_, also rewrite iv_len, icv_len */ ++ if (tdls_seq == 1) { ++ ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); ++ if (ptdls_sta) { ++ ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority]++; ++ ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority] &= 0xFFF; ++ pattrib->seqnum = ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority]; ++ SetSeqNum(hdr, pattrib->seqnum); ++ ++ if (pattrib->encrypt) { ++ pattrib->encrypt = _AES_; ++ pattrib->iv_len = 8; ++ pattrib->icv_len = 8; ++ pattrib->bswenc = _FALSE; ++ } ++ pattrib->mac_id = ptdls_sta->mac_id; ++ } else { ++ res = _FAIL; ++ goto exit; ++ } ++ } else if (psta) { ++ psta->sta_xmitpriv.txseq_tid[pattrib->priority]++; ++ psta->sta_xmitpriv.txseq_tid[pattrib->priority] &= 0xFFF; ++ pattrib->seqnum = psta->sta_xmitpriv.txseq_tid[pattrib->priority]; ++ SetSeqNum(hdr, pattrib->seqnum); ++ } ++ ++ ++exit: ++ ++ ++ return res; ++} ++ ++s32 rtw_xmit_tdls_coalesce(_adapter *padapter, struct xmit_frame *pxmitframe, struct tdls_txmgmt *ptxmgmt) ++{ ++ s32 llc_sz; ++ ++ u8 *pframe, *mem_start; ++ ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ u8 *pbuf_start; ++ s32 bmcst = IS_MCAST(pattrib->ra); ++ s32 res = _SUCCESS; ++ ++ ++ if (pattrib->psta) ++ psta = pattrib->psta; ++ else { ++ if (bmcst) ++ psta = rtw_get_bcmc_stainfo(padapter); ++ else ++ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); ++ } ++ ++ if (psta == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ if (pxmitframe->buf_addr == NULL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pbuf_start = pxmitframe->buf_addr; ++ mem_start = pbuf_start + TXDESC_OFFSET; ++ ++ if (rtw_make_tdls_wlanhdr(padapter, mem_start, pattrib, ptxmgmt) == _FAIL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ pframe = mem_start; ++ pframe += pattrib->hdrlen; ++ ++ /* adding icv, if necessary... */ ++ if (pattrib->iv_len) { ++ if (psta != NULL) { ++ switch (pattrib->encrypt) { ++ case _WEP40_: ++ case _WEP104_: ++ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); ++ break; ++ case _TKIP_: ++ if (bmcst) ++ TKIP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); ++ else ++ TKIP_IV(pattrib->iv, psta->dot11txpn, 0); ++ break; ++ case _AES_: ++ if (bmcst) ++ AES_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); ++ else ++ AES_IV(pattrib->iv, psta->dot11txpn, 0); ++ break; ++ } ++ } ++ ++ _rtw_memcpy(pframe, pattrib->iv, pattrib->iv_len); ++ pframe += pattrib->iv_len; ++ ++ } ++ ++ llc_sz = rtw_put_snap(pframe, pattrib->ether_type); ++ pframe += llc_sz; ++ ++ /* pattrib->pktlen will be counted in rtw_build_tdls_ies */ ++ pattrib->pktlen = 0; ++ ++ rtw_build_tdls_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ ++ if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { ++ pframe += pattrib->pktlen; ++ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); ++ pframe += pattrib->icv_len; ++ } ++ ++ pattrib->nr_frags = 1; ++ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len + llc_sz + ++ ((pattrib->bswenc) ? pattrib->icv_len : 0) + pattrib->pktlen; ++ ++ if (xmitframe_addmic(padapter, pxmitframe) == _FAIL) { ++ res = _FAIL; ++ goto exit; ++ } ++ ++ xmitframe_swencrypt(padapter, pxmitframe); ++ ++ update_attrib_vcs_info(padapter, pxmitframe); ++ ++exit: ++ ++ ++ return res; ++} ++#endif /* CONFIG_TDLS */ ++ ++/* ++ * Calculate wlan 802.11 packet MAX size from pkt_attrib ++ * This function doesn't consider fragment case ++ */ ++u32 rtw_calculate_wlan_pkt_size_by_attribue(struct pkt_attrib *pattrib) ++{ ++ u32 len = 0; ++ ++ len = pattrib->hdrlen + pattrib->iv_len; /* WLAN Header and IV */ ++ len += SNAP_SIZE + sizeof(u16); /* LLC */ ++ len += pattrib->pktlen; ++ if (pattrib->encrypt == _TKIP_) ++ len += 8; /* MIC */ ++ len += ((pattrib->bswenc) ? pattrib->icv_len : 0); /* ICV */ ++ ++ return len; ++} ++ ++/* ++ ++This sub-routine will perform all the following: ++ ++1. remove 802.3 header. ++2. create wlan_header, based on the info in pxmitframe ++3. append sta's iv/ext-iv ++4. append LLC ++5. move frag chunk from pframe to pxmitframe->mem ++6. apply sw-encrypt, if necessary. ++ ++*/ ++s32 rtw_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe) ++{ ++ struct pkt_file pktfile; ++ ++ s32 frg_inx, frg_len, mpdu_len, llc_sz, mem_sz; ++ ++ SIZE_PTR addr; ++ ++ u8 *pframe, *mem_start; ++ u8 hw_hdr_offset; ++ ++ /* struct sta_info *psta; */ ++ /* struct sta_priv *pstapriv = &padapter->stapriv; */ ++ /* struct mlme_priv *pmlmepriv = &padapter->mlmepriv; */ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ ++ u8 *pbuf_start; ++ ++ s32 bmcst = IS_MCAST(pattrib->ra); ++ s32 res = _SUCCESS; ++ ++ ++ /* ++ if (pattrib->psta) ++ { ++ psta = pattrib->psta; ++ } else ++ { ++ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); ++ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); ++ } ++ ++ if(psta==NULL) ++ { ++ ++ RTW_INFO("%s, psta==NUL\n", __func__); ++ return _FAIL; ++ } ++ ++ ++ if(!(psta->state &_FW_LINKED)) ++ { ++ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); ++ return _FAIL; ++ } ++ */ ++ if (pxmitframe->buf_addr == NULL) { ++ RTW_INFO("==> %s buf_addr==NULL\n", __FUNCTION__); ++ return _FAIL; ++ } ++ ++ pbuf_start = pxmitframe->buf_addr; ++ ++#ifdef CONFIG_USB_TX_AGGREGATION ++ hw_hdr_offset = TXDESC_SIZE + (pxmitframe->pkt_offset * PACKET_OFFSET_SZ); ++#else ++#ifdef CONFIG_TX_EARLY_MODE /* for SDIO && Tx Agg */ ++ hw_hdr_offset = TXDESC_OFFSET + EARLY_MODE_INFO_SIZE; ++#else ++ hw_hdr_offset = TXDESC_OFFSET; ++#endif ++#endif ++ ++ mem_start = pbuf_start + hw_hdr_offset; ++ ++ if (rtw_make_wlanhdr(padapter, mem_start, pattrib) == _FAIL) { ++ RTW_INFO("rtw_xmitframe_coalesce: rtw_make_wlanhdr fail; drop pkt\n"); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ _rtw_open_pktfile(pkt, &pktfile); ++ _rtw_pktfile_read(&pktfile, NULL, pattrib->pkt_hdrlen); ++ ++ frg_inx = 0; ++ frg_len = pxmitpriv->frag_len - 4;/* 2346-4 = 2342 */ ++ ++ while (1) { ++ llc_sz = 0; ++ ++ mpdu_len = frg_len; ++ ++ pframe = mem_start; ++ ++ SetMFrag(mem_start); ++ ++ pframe += pattrib->hdrlen; ++ mpdu_len -= pattrib->hdrlen; ++ ++ /* adding icv, if necessary... */ ++ if (pattrib->iv_len) { ++#if 0 ++ /* if (check_fwstate(pmlmepriv, WIFI_MP_STATE)) */ ++ /* psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); */ ++ /* else */ ++ /* psta = rtw_get_stainfo(pstapriv, pattrib->ra); */ ++ ++ if (psta != NULL) { ++ switch (pattrib->encrypt) { ++ case _WEP40_: ++ case _WEP104_: ++ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); ++ break; ++ case _TKIP_: ++ if (bmcst) ++ TKIP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); ++ else ++ TKIP_IV(pattrib->iv, psta->dot11txpn, 0); ++ break; ++ case _AES_: ++ if (bmcst) ++ AES_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); ++ else ++ AES_IV(pattrib->iv, psta->dot11txpn, 0); ++ break; ++#ifdef CONFIG_WAPI_SUPPORT ++ case _SMS4_: ++ rtw_wapi_get_iv(padapter, pattrib->ra, pattrib->iv); ++ break; ++#endif ++ } ++ } ++#endif ++ _rtw_memcpy(pframe, pattrib->iv, pattrib->iv_len); ++ ++ ++ pframe += pattrib->iv_len; ++ ++ mpdu_len -= pattrib->iv_len; ++ } ++ ++ if (frg_inx == 0) { ++ llc_sz = rtw_put_snap(pframe, pattrib->ether_type); ++ pframe += llc_sz; ++ mpdu_len -= llc_sz; ++ } ++ ++ if ((pattrib->icv_len > 0) && (pattrib->bswenc)) ++ mpdu_len -= pattrib->icv_len; ++ ++ ++ if (bmcst) { ++ /* don't do fragment to broadcat/multicast packets */ ++ mem_sz = _rtw_pktfile_read(&pktfile, pframe, pattrib->pktlen); ++ } else ++ mem_sz = _rtw_pktfile_read(&pktfile, pframe, mpdu_len); ++ ++ pframe += mem_sz; ++ ++ if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { ++ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); ++ pframe += pattrib->icv_len; ++ } ++ ++ frg_inx++; ++ ++ if (bmcst || (rtw_endofpktfile(&pktfile) == _TRUE)) { ++ pattrib->nr_frags = frg_inx; ++ ++ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len + ((pattrib->nr_frags == 1) ? llc_sz : 0) + ++ ((pattrib->bswenc) ? pattrib->icv_len : 0) + mem_sz; ++ ++ ClearMFrag(mem_start); ++ ++ break; ++ } ++ ++ addr = (SIZE_PTR)(pframe); ++ ++ mem_start = (unsigned char *)RND4(addr) + hw_hdr_offset; ++ _rtw_memcpy(mem_start, pbuf_start + hw_hdr_offset, pattrib->hdrlen); ++ ++ } ++ ++ if (xmitframe_addmic(padapter, pxmitframe) == _FAIL) { ++ RTW_INFO("xmitframe_addmic(padapter, pxmitframe)==_FAIL\n"); ++ res = _FAIL; ++ goto exit; ++ } ++ ++ xmitframe_swencrypt(padapter, pxmitframe); ++ ++ if (bmcst == _FALSE) ++ update_attrib_vcs_info(padapter, pxmitframe); ++ else ++ pattrib->vcs_mode = NONE_VCS; ++ ++exit: ++ ++ ++ return res; ++} ++ ++#ifdef CONFIG_IEEE80211W ++/* broadcast or multicast management pkt use BIP, unicast management pkt use CCMP encryption */ ++s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe) ++{ ++ struct pkt_file pktfile; ++ s32 frg_inx, frg_len, mpdu_len, llc_sz, mem_sz; ++ SIZE_PTR addr; ++ u8 *pframe, *mem_start = NULL, *tmp_buf = NULL; ++ u8 hw_hdr_offset, subtype ; ++ struct sta_info *psta = NULL; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ u8 *pbuf_start; ++ s32 bmcst = IS_MCAST(pattrib->ra); ++ s32 res = _FAIL; ++ u8 *BIP_AAD = NULL; ++ u8 *MGMT_body = NULL; ++ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u8 MME[_MME_IE_LENGTH_]; ++ ++ _irqL irqL; ++ u32 ori_len; ++ mem_start = pframe = (u8 *)(pxmitframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ ori_len = BIP_AAD_SIZE + pattrib->pktlen; ++ tmp_buf = BIP_AAD = rtw_zmalloc(ori_len); ++ subtype = GetFrameSubType(pframe); /* bit(7)~bit(2) */ ++ ++ if (BIP_AAD == NULL) ++ return _FAIL; ++ ++ _enter_critical_bh(&padapter->security_key_mutex, &irqL); ++ ++ ++ /* IGTK key is not install, it may not support 802.11w */ ++ if (padapter->securitypriv.binstallBIPkey != _TRUE) { ++ RTW_INFO("no instll BIP key\n"); ++ goto xmitframe_coalesce_success; ++ } ++ /* station mode doesn't need TX BIP, just ready the code */ ++ if (bmcst) { ++ int frame_body_len; ++ u8 mic[16]; ++ ++ _rtw_memset(MME, 0, _MME_IE_LENGTH_); ++ ++ /* other types doesn't need the BIP */ ++ if (GetFrameSubType(pframe) != WIFI_DEAUTH && GetFrameSubType(pframe) != WIFI_DISASSOC) ++ goto xmitframe_coalesce_fail; ++ ++ MGMT_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); ++ pframe += pattrib->pktlen; ++ ++ /* octent 0 and 1 is key index ,BIP keyid is 4 or 5, LSB only need octent 0 */ ++ MME[0] = padapter->securitypriv.dot11wBIPKeyid; ++ /* copy packet number */ ++ _rtw_memcpy(&MME[2], &pmlmeext->mgnt_80211w_IPN, 6); ++ /* increase the packet number */ ++ pmlmeext->mgnt_80211w_IPN++; ++ ++ /* add MME IE with MIC all zero, MME string doesn't include element id and length */ ++ pframe = rtw_set_ie(pframe, _MME_IE_ , 16 , MME, &(pattrib->pktlen)); ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ /* total frame length - header length */ ++ frame_body_len = pattrib->pktlen - sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ /* conscruct AAD, copy frame control field */ ++ _rtw_memcpy(BIP_AAD, &pwlanhdr->frame_ctl, 2); ++ ClearRetry(BIP_AAD); ++ ClearPwrMgt(BIP_AAD); ++ ClearMData(BIP_AAD); ++ /* conscruct AAD, copy address 1 to address 3 */ ++ _rtw_memcpy(BIP_AAD + 2, pwlanhdr->addr1, 18); ++ /* copy management fram body */ ++ _rtw_memcpy(BIP_AAD + BIP_AAD_SIZE, MGMT_body, frame_body_len); ++#if 0 ++ /* dump total packet include MME with zero MIC */ ++ { ++ int i; ++ printk("Total packet: "); ++ for (i = 0; i < BIP_AAD_SIZE + frame_body_len; i++) ++ printk(" %02x ", BIP_AAD[i]); ++ printk("\n"); ++ } ++#endif ++ /* calculate mic */ ++ if (omac1_aes_128(padapter->securitypriv.dot11wBIPKey[padapter->securitypriv.dot11wBIPKeyid].skey ++ , BIP_AAD, BIP_AAD_SIZE + frame_body_len, mic)) ++ goto xmitframe_coalesce_fail; ++ ++#if 0 ++ /* dump calculated mic result */ ++ { ++ int i; ++ printk("Calculated mic result: "); ++ for (i = 0; i < 16; i++) ++ printk(" %02x ", mic[i]); ++ printk("\n"); ++ } ++#endif ++ /* copy right BIP mic value, total is 128bits, we use the 0~63 bits */ ++ _rtw_memcpy(pframe - 8, mic, 8); ++ /*/dump all packet after mic ok ++ { ++ int pp; ++ printk("pattrib->pktlen = %d\n", pattrib->pktlen); ++ for(pp=0;pp< pattrib->pktlen; pp++) ++ printk(" %02x ", mem_start[pp]); ++ printk("\n"); ++ }*/ ++ } else { /* unicast mgmt frame TX */ ++ /* start to encrypt mgmt frame */ ++ if (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || ++ subtype == WIFI_REASSOCREQ || subtype == WIFI_ACTION) { ++ if (pattrib->psta) ++ psta = pattrib->psta; ++ else ++ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); ++ ++ if (psta == NULL) { ++ ++ RTW_INFO("%s, psta==NUL\n", __func__); ++ goto xmitframe_coalesce_fail; ++ } ++ ++ if (pxmitframe->buf_addr == NULL) { ++ RTW_INFO("%s, pxmitframe->buf_addr\n", __func__); ++ goto xmitframe_coalesce_fail; ++ } ++ ++ /* RTW_INFO("%s, action frame category=%d\n", __func__, pframe[WLAN_HDR_A3_LEN]); */ ++ /* according 802.11-2012 standard, these five types are not robust types */ ++ if (subtype == WIFI_ACTION && ++ (pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_PUBLIC || ++ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_HT || ++ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_UNPROTECTED_WNM || ++ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_SELF_PROTECTED || ++ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_P2P)) ++ goto xmitframe_coalesce_fail; ++ /* before encrypt dump the management packet content */ ++ /*{ ++ int i; ++ printk("Management pkt: "); ++ for(i=0; ipktlen; i++) ++ printk(" %02x ", pframe[i]); ++ printk("=======\n"); ++ }*/ ++ if (pattrib->encrypt > 0) ++ _rtw_memcpy(pattrib->dot118021x_UncstKey.skey, psta->dot118021x_UncstKey.skey, 16); ++ ++ /* To use wrong key */ ++ if (pattrib->key_type == IEEE80211W_WRONG_KEY) { ++ RTW_INFO("use wrong key\n"); ++ pattrib->dot118021x_UncstKey.skey[0] = 0xff; ++ } ++ ++ /* bakeup original management packet */ ++ _rtw_memcpy(tmp_buf, pframe, pattrib->pktlen); ++ /* move to data portion */ ++ pframe += pattrib->hdrlen; ++ ++ /* 802.11w unicast management packet must be _AES_ */ ++ pattrib->iv_len = 8; ++ /* it's MIC of AES */ ++ pattrib->icv_len = 8; ++ ++ switch (pattrib->encrypt) { ++ case _AES_: ++ /* set AES IV header */ ++ AES_IV(pattrib->iv, psta->dot11wtxpn, 0); ++ break; ++ default: ++ goto xmitframe_coalesce_fail; ++ } ++ /* insert iv header into management frame */ ++ _rtw_memcpy(pframe, pattrib->iv, pattrib->iv_len); ++ pframe += pattrib->iv_len; ++ /* copy mgmt data portion after CCMP header */ ++ _rtw_memcpy(pframe, tmp_buf + pattrib->hdrlen, pattrib->pktlen - pattrib->hdrlen); ++ /* move pframe to end of mgmt pkt */ ++ pframe += pattrib->pktlen - pattrib->hdrlen; ++ /* add 8 bytes CCMP IV header to length */ ++ pattrib->pktlen += pattrib->iv_len; ++#if 0 ++ /* dump management packet include AES IV header */ ++ { ++ int i; ++ printk("Management pkt + IV: "); ++ /* for(i=0; ipktlen; i++) */ ++ ++ printk("@@@@@@@@@@@@@\n"); ++ } ++#endif ++ ++ if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { ++ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); ++ pframe += pattrib->icv_len; ++ } ++ /* add 8 bytes MIC */ ++ pattrib->pktlen += pattrib->icv_len; ++ /* set final tx command size */ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ /* set protected bit must be beofre SW encrypt */ ++ SetPrivacy(mem_start); ++#if 0 ++ /* dump management packet include AES header */ ++ { ++ int i; ++ printk("prepare to enc Management pkt + IV: "); ++ for (i = 0; i < pattrib->pktlen; i++) ++ printk(" %02x ", mem_start[i]); ++ printk("@@@@@@@@@@@@@\n"); ++ } ++#endif ++ /* software encrypt */ ++ xmitframe_swencrypt(padapter, pxmitframe); ++ } ++ } ++ ++xmitframe_coalesce_success: ++ _exit_critical_bh(&padapter->security_key_mutex, &irqL); ++ rtw_mfree(BIP_AAD, ori_len); ++ return _SUCCESS; ++ ++xmitframe_coalesce_fail: ++ _exit_critical_bh(&padapter->security_key_mutex, &irqL); ++ rtw_mfree(BIP_AAD, ori_len); ++ ++ return _FAIL; ++} ++#endif /* CONFIG_IEEE80211W */ ++ ++/* Logical Link Control(LLC) SubNetwork Attachment Point(SNAP) header ++ * IEEE LLC/SNAP header contains 8 octets ++ * First 3 octets comprise the LLC portion ++ * SNAP portion, 5 octets, is divided into two fields: ++ * Organizationally Unique Identifier(OUI), 3 octets, ++ * type, defined by that organization, 2 octets. ++ */ ++s32 rtw_put_snap(u8 *data, u16 h_proto) ++{ ++ struct ieee80211_snap_hdr *snap; ++ u8 *oui; ++ ++ ++ snap = (struct ieee80211_snap_hdr *)data; ++ snap->dsap = 0xaa; ++ snap->ssap = 0xaa; ++ snap->ctrl = 0x03; ++ ++ if (h_proto == 0x8137 || h_proto == 0x80f3) ++ oui = P802_1H_OUI; ++ else ++ oui = RFC1042_OUI; ++ ++ snap->oui[0] = oui[0]; ++ snap->oui[1] = oui[1]; ++ snap->oui[2] = oui[2]; ++ ++ *(u16 *)(data + SNAP_SIZE) = htons(h_proto); ++ ++ ++ return SNAP_SIZE + sizeof(u16); ++} ++ ++void rtw_update_protection(_adapter *padapter, u8 *ie, uint ie_len) ++{ ++ ++ uint protection; ++ u8 *perp; ++ sint erp_len; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ ++ ++ switch (pxmitpriv->vcs_setting) { ++ case DISABLE_VCS: ++ pxmitpriv->vcs = NONE_VCS; ++ break; ++ ++ case ENABLE_VCS: ++ break; ++ ++ case AUTO_VCS: ++ default: ++ perp = rtw_get_ie(ie, _ERPINFO_IE_, &erp_len, ie_len); ++ if (perp == NULL) ++ pxmitpriv->vcs = NONE_VCS; ++ else { ++ protection = (*(perp + 2)) & BIT(1); ++ if (protection) { ++ if (pregistrypriv->vcs_type == RTS_CTS) ++ pxmitpriv->vcs = RTS_CTS; ++ else ++ pxmitpriv->vcs = CTS_TO_SELF; ++ } else ++ pxmitpriv->vcs = NONE_VCS; ++ } ++ ++ break; ++ ++ } ++ ++ ++} ++ ++void rtw_count_tx_stats(PADAPTER padapter, struct xmit_frame *pxmitframe, int sz) ++{ ++ struct sta_info *psta = NULL; ++ struct stainfo_stats *pstats = NULL; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ u8 pkt_num = 1; ++ ++ if ((pxmitframe->frame_tag & 0x0f) == DATA_FRAMETAG) { ++#if defined(CONFIG_USB_TX_AGGREGATION) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ pkt_num = pxmitframe->agg_num; ++#endif ++ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod += pkt_num; ++ ++ pxmitpriv->tx_pkts += pkt_num; ++ ++ pxmitpriv->tx_bytes += sz; ++ ++ psta = pxmitframe->attrib.psta; ++ if (psta) { ++ pstats = &psta->sta_stats; ++ ++ pstats->tx_pkts += pkt_num; ++ ++ pstats->tx_bytes += sz; ++#ifdef CONFIG_TDLS ++ if (pxmitframe->attrib.ptdls_sta != NULL) { ++ pstats = &(pxmitframe->attrib.ptdls_sta->sta_stats); ++ pstats->tx_pkts += pkt_num; ++ pstats->tx_bytes += sz; ++ } ++#endif /* CONFIG_TDLS */ ++ } ++ ++#ifdef CONFIG_CHECK_LEAVE_LPS ++ /* traffic_check_for_leave_lps(padapter, _TRUE); */ ++#endif /* CONFIG_LPS */ ++ ++ } ++} ++ ++static struct xmit_buf *__rtw_alloc_cmd_xmitbuf(struct xmit_priv *pxmitpriv, ++ enum cmdbuf_type buf_type) ++{ ++ struct xmit_buf *pxmitbuf = NULL; ++ ++ ++ pxmitbuf = &pxmitpriv->pcmd_xmitbuf[buf_type]; ++ if (pxmitbuf != NULL) { ++ pxmitbuf->priv_data = NULL; ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ pxmitbuf->len = 0; ++ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; ++ pxmitbuf->agg_num = 0; ++ pxmitbuf->pg_num = 0; ++#endif ++#ifdef CONFIG_PCI_HCI ++ pxmitbuf->len = 0; ++#ifdef CONFIG_TRX_BD_ARCH ++ /*pxmitbuf->buf_desc = NULL;*/ ++#else ++ pxmitbuf->desc = NULL; ++#endif ++#endif ++ ++ if (pxmitbuf->sctx) { ++ RTW_INFO("%s pxmitbuf->sctx is not NULL\n", __func__); ++ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_ALLOC); ++ } ++ } else ++ RTW_INFO("%s fail, no xmitbuf available !!!\n", __func__); ++ ++exit: ++ ++ ++ return pxmitbuf; ++} ++ ++struct xmit_frame *__rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, ++ enum cmdbuf_type buf_type) ++{ ++ struct xmit_frame *pcmdframe; ++ struct xmit_buf *pxmitbuf; ++ ++ pcmdframe = rtw_alloc_xmitframe(pxmitpriv); ++ if (pcmdframe == NULL) { ++ RTW_INFO("%s, alloc xmitframe fail\n", __FUNCTION__); ++ return NULL; ++ } ++ ++ pxmitbuf = __rtw_alloc_cmd_xmitbuf(pxmitpriv, buf_type); ++ if (pxmitbuf == NULL) { ++ RTW_INFO("%s, alloc xmitbuf fail\n", __FUNCTION__); ++ rtw_free_xmitframe(pxmitpriv, pcmdframe); ++ return NULL; ++ } ++ ++ pcmdframe->frame_tag = MGNT_FRAMETAG; ++ ++ pcmdframe->pxmitbuf = pxmitbuf; ++ ++ pcmdframe->buf_addr = pxmitbuf->pbuf; ++ ++ /* initial memory to zero */ ++ _rtw_memset(pcmdframe->buf_addr, 0, pxmitbuf->alloc_sz); ++ ++ pxmitbuf->priv_data = pcmdframe; ++ ++ return pcmdframe; ++ ++} ++ ++struct xmit_buf *rtw_alloc_xmitbuf_ext(struct xmit_priv *pxmitpriv) ++{ ++ _irqL irqL; ++ struct xmit_buf *pxmitbuf = NULL; ++ _list *plist, *phead; ++ _queue *pfree_queue = &pxmitpriv->free_xmit_extbuf_queue; ++ ++ ++ _enter_critical(&pfree_queue->lock, &irqL); ++ ++ if (_rtw_queue_empty(pfree_queue) == _TRUE) ++ pxmitbuf = NULL; ++ else { ++ ++ phead = get_list_head(pfree_queue); ++ ++ plist = get_next(phead); ++ ++ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); ++ ++ rtw_list_delete(&(pxmitbuf->list)); ++ } ++ ++ if (pxmitbuf != NULL) { ++ pxmitpriv->free_xmit_extbuf_cnt--; ++#ifdef DBG_XMIT_BUF_EXT ++ RTW_INFO("DBG_XMIT_BUF_EXT ALLOC no=%d, free_xmit_extbuf_cnt=%d\n", pxmitbuf->no, pxmitpriv->free_xmit_extbuf_cnt); ++#endif ++ ++ ++ pxmitbuf->priv_data = NULL; ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ pxmitbuf->len = 0; ++ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; ++ pxmitbuf->agg_num = 1; ++#endif ++#ifdef CONFIG_PCI_HCI ++ pxmitbuf->len = 0; ++#ifdef CONFIG_TRX_BD_ARCH ++ /*pxmitbuf->buf_desc = NULL;*/ ++#else ++ pxmitbuf->desc = NULL; ++#endif ++#endif ++ ++ if (pxmitbuf->sctx) { ++ RTW_INFO("%s pxmitbuf->sctx is not NULL\n", __func__); ++ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_ALLOC); ++ } ++ ++ } ++ ++ _exit_critical(&pfree_queue->lock, &irqL); ++ ++ ++ return pxmitbuf; ++} ++ ++s32 rtw_free_xmitbuf_ext(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf) ++{ ++ _irqL irqL; ++ _queue *pfree_queue = &pxmitpriv->free_xmit_extbuf_queue; ++ ++ ++ if (pxmitbuf == NULL) ++ return _FAIL; ++ ++ _enter_critical(&pfree_queue->lock, &irqL); ++ ++ rtw_list_delete(&pxmitbuf->list); ++ ++ rtw_list_insert_tail(&(pxmitbuf->list), get_list_head(pfree_queue)); ++ pxmitpriv->free_xmit_extbuf_cnt++; ++#ifdef DBG_XMIT_BUF_EXT ++ RTW_INFO("DBG_XMIT_BUF_EXT FREE no=%d, free_xmit_extbuf_cnt=%d\n", pxmitbuf->no , pxmitpriv->free_xmit_extbuf_cnt); ++#endif ++ ++ _exit_critical(&pfree_queue->lock, &irqL); ++ ++ ++ return _SUCCESS; ++} ++ ++struct xmit_buf *rtw_alloc_xmitbuf(struct xmit_priv *pxmitpriv) ++{ ++ _irqL irqL; ++ struct xmit_buf *pxmitbuf = NULL; ++ _list *plist, *phead; ++ _queue *pfree_xmitbuf_queue = &pxmitpriv->free_xmitbuf_queue; ++ ++ ++ /* RTW_INFO("+rtw_alloc_xmitbuf\n"); */ ++ ++ _enter_critical(&pfree_xmitbuf_queue->lock, &irqL); ++ ++ if (_rtw_queue_empty(pfree_xmitbuf_queue) == _TRUE) ++ pxmitbuf = NULL; ++ else { ++ ++ phead = get_list_head(pfree_xmitbuf_queue); ++ ++ plist = get_next(phead); ++ ++ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); ++ ++ rtw_list_delete(&(pxmitbuf->list)); ++ } ++ ++ if (pxmitbuf != NULL) { ++ pxmitpriv->free_xmitbuf_cnt--; ++#ifdef DBG_XMIT_BUF ++ RTW_INFO("DBG_XMIT_BUF ALLOC no=%d, free_xmitbuf_cnt=%d\n", pxmitbuf->no, pxmitpriv->free_xmitbuf_cnt); ++#endif ++ /* RTW_INFO("alloc, free_xmitbuf_cnt=%d\n", pxmitpriv->free_xmitbuf_cnt); */ ++ ++ pxmitbuf->priv_data = NULL; ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ pxmitbuf->len = 0; ++ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; ++ pxmitbuf->agg_num = 0; ++ pxmitbuf->pg_num = 0; ++#endif ++#ifdef CONFIG_PCI_HCI ++ pxmitbuf->len = 0; ++#ifdef CONFIG_TRX_BD_ARCH ++ /*pxmitbuf->buf_desc = NULL;*/ ++#else ++ pxmitbuf->desc = NULL; ++#endif ++#endif ++ ++ if (pxmitbuf->sctx) { ++ RTW_INFO("%s pxmitbuf->sctx is not NULL\n", __func__); ++ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_ALLOC); ++ } ++ } ++#ifdef DBG_XMIT_BUF ++ else ++ RTW_INFO("DBG_XMIT_BUF rtw_alloc_xmitbuf return NULL\n"); ++#endif ++ ++ _exit_critical(&pfree_xmitbuf_queue->lock, &irqL); ++ ++ ++ return pxmitbuf; ++} ++ ++s32 rtw_free_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf) ++{ ++ _irqL irqL; ++ _queue *pfree_xmitbuf_queue = &pxmitpriv->free_xmitbuf_queue; ++ ++ ++ /* RTW_INFO("+rtw_free_xmitbuf\n"); */ ++ ++ if (pxmitbuf == NULL) ++ return _FAIL; ++ ++ if (pxmitbuf->sctx) { ++ RTW_INFO("%s pxmitbuf->sctx is not NULL\n", __func__); ++ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_FREE); ++ } ++ ++ if (pxmitbuf->buf_tag == XMITBUF_CMD) { ++ } else if (pxmitbuf->buf_tag == XMITBUF_MGNT) ++ rtw_free_xmitbuf_ext(pxmitpriv, pxmitbuf); ++ else { ++ _enter_critical(&pfree_xmitbuf_queue->lock, &irqL); ++ ++ rtw_list_delete(&pxmitbuf->list); ++ ++ rtw_list_insert_tail(&(pxmitbuf->list), get_list_head(pfree_xmitbuf_queue)); ++ ++ pxmitpriv->free_xmitbuf_cnt++; ++ /* RTW_INFO("FREE, free_xmitbuf_cnt=%d\n", pxmitpriv->free_xmitbuf_cnt); */ ++#ifdef DBG_XMIT_BUF ++ RTW_INFO("DBG_XMIT_BUF FREE no=%d, free_xmitbuf_cnt=%d\n", pxmitbuf->no , pxmitpriv->free_xmitbuf_cnt); ++#endif ++ _exit_critical(&pfree_xmitbuf_queue->lock, &irqL); ++ } ++ ++ ++ return _SUCCESS; ++} ++ ++void rtw_init_xmitframe(struct xmit_frame *pxframe) ++{ ++ if (pxframe != NULL) { /* default value setting */ ++ pxframe->buf_addr = NULL; ++ pxframe->pxmitbuf = NULL; ++ ++ _rtw_memset(&pxframe->attrib, 0, sizeof(struct pkt_attrib)); ++ /* pxframe->attrib.psta = NULL; */ ++ ++ pxframe->frame_tag = DATA_FRAMETAG; ++ ++#ifdef CONFIG_USB_HCI ++ pxframe->pkt = NULL; ++#ifdef USB_PACKET_OFFSET_SZ ++ pxframe->pkt_offset = (PACKET_OFFSET_SZ / 8); ++#else ++ pxframe->pkt_offset = 1;/* default use pkt_offset to fill tx desc */ ++#endif ++ ++#ifdef CONFIG_USB_TX_AGGREGATION ++ pxframe->agg_num = 1; ++#endif ++ ++#endif /* #ifdef CONFIG_USB_HCI */ ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ pxframe->pg_num = 1; ++ pxframe->agg_num = 1; ++#endif ++ ++#ifdef CONFIG_XMIT_ACK ++ pxframe->ack_report = 0; ++#endif ++ ++ } ++} ++ ++/* ++Calling context: ++1. OS_TXENTRY ++2. RXENTRY (rx_thread or RX_ISR/RX_CallBack) ++ ++If we turn on USE_RXTHREAD, then, no need for critical section. ++Otherwise, we must use _enter/_exit critical to protect free_xmit_queue... ++ ++Must be very very cautious... ++ ++*/ ++struct xmit_frame *rtw_alloc_xmitframe(struct xmit_priv *pxmitpriv)/* (_queue *pfree_xmit_queue) */ ++{ ++ /* ++ Please remember to use all the osdep_service api, ++ and lock/unlock or _enter/_exit critical to protect ++ pfree_xmit_queue ++ */ ++ ++ _irqL irqL; ++ struct xmit_frame *pxframe = NULL; ++ _list *plist, *phead; ++ _queue *pfree_xmit_queue = &pxmitpriv->free_xmit_queue; ++ ++ ++ _enter_critical_bh(&pfree_xmit_queue->lock, &irqL); ++ ++ if (_rtw_queue_empty(pfree_xmit_queue) == _TRUE) { ++ pxframe = NULL; ++ } else { ++ phead = get_list_head(pfree_xmit_queue); ++ ++ plist = get_next(phead); ++ ++ pxframe = LIST_CONTAINOR(plist, struct xmit_frame, list); ++ ++ rtw_list_delete(&(pxframe->list)); ++ pxmitpriv->free_xmitframe_cnt--; ++ } ++ ++ _exit_critical_bh(&pfree_xmit_queue->lock, &irqL); ++ ++ rtw_init_xmitframe(pxframe); ++ ++ ++ return pxframe; ++} ++ ++struct xmit_frame *rtw_alloc_xmitframe_ext(struct xmit_priv *pxmitpriv) ++{ ++ _irqL irqL; ++ struct xmit_frame *pxframe = NULL; ++ _list *plist, *phead; ++ _queue *queue = &pxmitpriv->free_xframe_ext_queue; ++ ++ ++ _enter_critical_bh(&queue->lock, &irqL); ++ ++ if (_rtw_queue_empty(queue) == _TRUE) { ++ pxframe = NULL; ++ } else { ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ pxframe = LIST_CONTAINOR(plist, struct xmit_frame, list); ++ ++ rtw_list_delete(&(pxframe->list)); ++ pxmitpriv->free_xframe_ext_cnt--; ++ } ++ ++ _exit_critical_bh(&queue->lock, &irqL); ++ ++ rtw_init_xmitframe(pxframe); ++ ++ ++ return pxframe; ++} ++ ++struct xmit_frame *rtw_alloc_xmitframe_once(struct xmit_priv *pxmitpriv) ++{ ++ struct xmit_frame *pxframe = NULL; ++ u8 *alloc_addr; ++ ++ alloc_addr = rtw_zmalloc(sizeof(struct xmit_frame) + 4); ++ ++ if (alloc_addr == NULL) ++ goto exit; ++ ++ pxframe = (struct xmit_frame *)N_BYTE_ALIGMENT((SIZE_PTR)(alloc_addr), 4); ++ pxframe->alloc_addr = alloc_addr; ++ ++ pxframe->padapter = pxmitpriv->adapter; ++ pxframe->frame_tag = NULL_FRAMETAG; ++ ++ pxframe->pkt = NULL; ++ ++ pxframe->buf_addr = NULL; ++ pxframe->pxmitbuf = NULL; ++ ++ rtw_init_xmitframe(pxframe); ++ ++ RTW_INFO("################## %s ##################\n", __func__); ++ ++exit: ++ return pxframe; ++} ++ ++s32 rtw_free_xmitframe(struct xmit_priv *pxmitpriv, struct xmit_frame *pxmitframe) ++{ ++ _irqL irqL; ++ _queue *queue = NULL; ++ _adapter *padapter = pxmitpriv->adapter; ++ _pkt *pndis_pkt = NULL; ++ ++ ++ if (pxmitframe == NULL) { ++ goto exit; ++ } ++ ++ if (pxmitframe->pkt) { ++ pndis_pkt = pxmitframe->pkt; ++ pxmitframe->pkt = NULL; ++ } ++ ++ if (pxmitframe->alloc_addr) { ++ RTW_INFO("################## %s with alloc_addr ##################\n", __func__); ++ rtw_mfree(pxmitframe->alloc_addr, sizeof(struct xmit_frame) + 4); ++ goto check_pkt_complete; ++ } ++ ++ if (pxmitframe->ext_tag == 0) ++ queue = &pxmitpriv->free_xmit_queue; ++ else if (pxmitframe->ext_tag == 1) ++ queue = &pxmitpriv->free_xframe_ext_queue; ++ else ++ rtw_warn_on(1); ++ ++ _enter_critical_bh(&queue->lock, &irqL); ++ ++ rtw_list_delete(&pxmitframe->list); ++ rtw_list_insert_tail(&pxmitframe->list, get_list_head(queue)); ++ if (pxmitframe->ext_tag == 0) { ++ pxmitpriv->free_xmitframe_cnt++; ++ } else if (pxmitframe->ext_tag == 1) { ++ pxmitpriv->free_xframe_ext_cnt++; ++ } else { ++ } ++ ++ _exit_critical_bh(&queue->lock, &irqL); ++ ++check_pkt_complete: ++ ++ if (pndis_pkt) ++ rtw_os_pkt_complete(padapter, pndis_pkt); ++ ++exit: ++ ++ ++ return _SUCCESS; ++} ++ ++void rtw_free_xmitframe_queue(struct xmit_priv *pxmitpriv, _queue *pframequeue) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ struct xmit_frame *pxmitframe; ++ ++ ++ _enter_critical_bh(&(pframequeue->lock), &irqL); ++ ++ phead = get_list_head(pframequeue); ++ plist = get_next(phead); ++ ++ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ ++ pxmitframe = LIST_CONTAINOR(plist, struct xmit_frame, list); ++ ++ plist = get_next(plist); ++ ++ rtw_free_xmitframe(pxmitpriv, pxmitframe); ++ ++ } ++ _exit_critical_bh(&(pframequeue->lock), &irqL); ++ ++} ++ ++s32 rtw_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue); ++ if (rtw_xmit_classifier(padapter, pxmitframe) == _FAIL) { ++ /* pxmitframe->pkt = NULL; */ ++ return _FAIL; ++ } ++ ++ return _SUCCESS; ++} ++ ++static struct xmit_frame *dequeue_one_xmitframe(struct xmit_priv *pxmitpriv, struct hw_xmit *phwxmit, struct tx_servq *ptxservq, _queue *pframe_queue) ++{ ++ _list *xmitframe_plist, *xmitframe_phead; ++ struct xmit_frame *pxmitframe = NULL; ++ ++ xmitframe_phead = get_list_head(pframe_queue); ++ xmitframe_plist = get_next(xmitframe_phead); ++ ++ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { ++ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); ++ ++ /* xmitframe_plist = get_next(xmitframe_plist); */ ++ ++ /*#ifdef RTK_DMP_PLATFORM ++ #ifdef CONFIG_USB_TX_AGGREGATION ++ if((ptxservq->qcnt>0) && (ptxservq->qcnt<=2)) ++ { ++ pxmitframe = NULL; ++ ++ tasklet_schedule(&pxmitpriv->xmit_tasklet); ++ ++ break; ++ } ++ #endif ++ #endif*/ ++ rtw_list_delete(&pxmitframe->list); ++ ++ ptxservq->qcnt--; ++ ++ /* rtw_list_insert_tail(&pxmitframe->list, &phwxmit->pending); */ ++ ++ /* ptxservq->qcnt--; */ ++ ++ break; ++ ++ /* pxmitframe = NULL; */ ++ ++ } ++ ++ return pxmitframe; ++} ++ ++struct xmit_frame *rtw_dequeue_xframe(struct xmit_priv *pxmitpriv, struct hw_xmit *phwxmit_i, sint entry) ++{ ++ _irqL irqL0; ++ _list *sta_plist, *sta_phead; ++ struct hw_xmit *phwxmit; ++ struct tx_servq *ptxservq = NULL; ++ _queue *pframe_queue = NULL; ++ struct xmit_frame *pxmitframe = NULL; ++ _adapter *padapter = pxmitpriv->adapter; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ int i, inx[4]; ++#ifdef CONFIG_USB_HCI ++ /* int j, tmp, acirp_cnt[4]; */ ++#endif ++ ++ ++ inx[0] = 0; ++ inx[1] = 1; ++ inx[2] = 2; ++ inx[3] = 3; ++ ++ if (pregpriv->wifi_spec == 1) { ++ int j, tmp, acirp_cnt[4]; ++#if 0 ++ if (flags < XMIT_QUEUE_ENTRY) { ++ /* priority exchange according to the completed xmitbuf flags. */ ++ inx[flags] = 0; ++ inx[0] = flags; ++ } ++#endif ++ ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_PCI_HCI) ++ for (j = 0; j < 4; j++) ++ inx[j] = pxmitpriv->wmm_para_seq[j]; ++#endif ++ } ++ ++ _enter_critical_bh(&pxmitpriv->lock, &irqL0); ++ ++ for (i = 0; i < entry; i++) { ++ phwxmit = phwxmit_i + inx[i]; ++ ++ /* _enter_critical_ex(&phwxmit->sta_queue->lock, &irqL0); */ ++ ++ sta_phead = get_list_head(phwxmit->sta_queue); ++ sta_plist = get_next(sta_phead); ++ ++ while ((rtw_end_of_queue_search(sta_phead, sta_plist)) == _FALSE) { ++ ++ ptxservq = LIST_CONTAINOR(sta_plist, struct tx_servq, tx_pending); ++ ++ pframe_queue = &ptxservq->sta_pending; ++ ++ pxmitframe = dequeue_one_xmitframe(pxmitpriv, phwxmit, ptxservq, pframe_queue); ++ ++ if (pxmitframe) { ++ phwxmit->accnt--; ++ ++ /* Remove sta node when there is no pending packets. */ ++ if (_rtw_queue_empty(pframe_queue)) /* must be done after get_next and before break */ ++ rtw_list_delete(&ptxservq->tx_pending); ++ ++ /* _exit_critical_ex(&phwxmit->sta_queue->lock, &irqL0); */ ++ ++ goto exit; ++ } ++ ++ sta_plist = get_next(sta_plist); ++ ++ } ++ ++ /* _exit_critical_ex(&phwxmit->sta_queue->lock, &irqL0); */ ++ ++ } ++ ++exit: ++ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL0); ++ ++ ++ return pxmitframe; ++} ++ ++#if 1 ++struct tx_servq *rtw_get_sta_pending(_adapter *padapter, struct sta_info *psta, sint up, u8 *ac) ++{ ++ struct tx_servq *ptxservq = NULL; ++ ++ ++ switch (up) { ++ case 1: ++ case 2: ++ ptxservq = &(psta->sta_xmitpriv.bk_q); ++ *(ac) = 3; ++ break; ++ ++ case 4: ++ case 5: ++ ptxservq = &(psta->sta_xmitpriv.vi_q); ++ *(ac) = 1; ++ break; ++ ++ case 6: ++ case 7: ++ ptxservq = &(psta->sta_xmitpriv.vo_q); ++ *(ac) = 0; ++ break; ++ ++ case 0: ++ case 3: ++ default: ++ ptxservq = &(psta->sta_xmitpriv.be_q); ++ *(ac) = 2; ++ break; ++ ++ } ++ ++ ++ return ptxservq; ++} ++#else ++__inline static struct tx_servq *rtw_get_sta_pending ++(_adapter *padapter, _queue **ppstapending, struct sta_info *psta, sint up) ++{ ++ struct tx_servq *ptxservq; ++ struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; ++ ++ ++#ifdef CONFIG_RTL8711 ++ ++ if (IS_MCAST(psta->hwaddr)) { ++ ptxservq = &(psta->sta_xmitpriv.be_q); /* we will use be_q to queue bc/mc frames in BCMC_stainfo */ ++ *ppstapending = &padapter->xmitpriv.bm_pending; ++ } else ++#endif ++ { ++ switch (up) { ++ case 1: ++ case 2: ++ ptxservq = &(psta->sta_xmitpriv.bk_q); ++ *ppstapending = &padapter->xmitpriv.bk_pending; ++ (phwxmits + 3)->accnt++; ++ break; ++ ++ case 4: ++ case 5: ++ ptxservq = &(psta->sta_xmitpriv.vi_q); ++ *ppstapending = &padapter->xmitpriv.vi_pending; ++ (phwxmits + 1)->accnt++; ++ break; ++ ++ case 6: ++ case 7: ++ ptxservq = &(psta->sta_xmitpriv.vo_q); ++ *ppstapending = &padapter->xmitpriv.vo_pending; ++ (phwxmits + 0)->accnt++; ++ break; ++ ++ case 0: ++ case 3: ++ default: ++ ptxservq = &(psta->sta_xmitpriv.be_q); ++ *ppstapending = &padapter->xmitpriv.be_pending; ++ (phwxmits + 2)->accnt++; ++ break; ++ ++ } ++ ++ } ++ ++ ++ return ptxservq; ++} ++#endif ++ ++/* ++ * Will enqueue pxmitframe to the proper queue, ++ * and indicate it to xx_pending list..... ++ */ ++s32 rtw_xmit_classifier(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ /* _irqL irqL0; */ ++ u8 ac_index; ++ struct sta_info *psta; ++ struct tx_servq *ptxservq; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; ++ sint res = _SUCCESS; ++ ++ ++ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class); ++ ++ /* ++ if (pattrib->psta) { ++ psta = pattrib->psta; ++ } else { ++ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); ++ psta = rtw_get_stainfo(pstapriv, pattrib->ra); ++ } ++ */ ++ ++ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); ++ if (pattrib->psta != psta) { ++ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_sta); ++ RTW_INFO("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); ++ return _FAIL; ++ } ++ ++ if (psta == NULL) { ++ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_nosta); ++ res = _FAIL; ++ RTW_INFO("rtw_xmit_classifier: psta == NULL\n"); ++ goto exit; ++ } ++ ++ if (!(psta->state & _FW_LINKED)) { ++ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_fwlink); ++ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); ++ return _FAIL; ++ } ++ ++ ptxservq = rtw_get_sta_pending(padapter, psta, pattrib->priority, (u8 *)(&ac_index)); ++ ++ /* _enter_critical(&pstapending->lock, &irqL0); */ ++ ++ if (rtw_is_list_empty(&ptxservq->tx_pending)) ++ rtw_list_insert_tail(&ptxservq->tx_pending, get_list_head(phwxmits[ac_index].sta_queue)); ++ ++ /* _enter_critical(&ptxservq->sta_pending.lock, &irqL1); */ ++ ++ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&ptxservq->sta_pending)); ++ ptxservq->qcnt++; ++ phwxmits[ac_index].accnt++; ++ ++ /* _exit_critical(&ptxservq->sta_pending.lock, &irqL1); */ ++ ++ /* _exit_critical(&pstapending->lock, &irqL0); */ ++ ++exit: ++ ++ ++ return res; ++} ++ ++void rtw_alloc_hwxmits(_adapter *padapter) ++{ ++ struct hw_xmit *hwxmits; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ pxmitpriv->hwxmit_entry = HWXMIT_ENTRY; ++ ++ pxmitpriv->hwxmits = NULL; ++ ++ pxmitpriv->hwxmits = (struct hw_xmit *)rtw_zmalloc(sizeof(struct hw_xmit) * pxmitpriv->hwxmit_entry); ++ ++ if (pxmitpriv->hwxmits == NULL) { ++ RTW_INFO("alloc hwxmits fail!...\n"); ++ return; ++ } ++ ++ hwxmits = pxmitpriv->hwxmits; ++ ++ if (pxmitpriv->hwxmit_entry == 5) { ++ /* pxmitpriv->bmc_txqueue.head = 0; */ ++ /* hwxmits[0] .phwtxqueue = &pxmitpriv->bmc_txqueue; */ ++ hwxmits[0] .sta_queue = &pxmitpriv->bm_pending; ++ ++ /* pxmitpriv->vo_txqueue.head = 0; */ ++ /* hwxmits[1] .phwtxqueue = &pxmitpriv->vo_txqueue; */ ++ hwxmits[1] .sta_queue = &pxmitpriv->vo_pending; ++ ++ /* pxmitpriv->vi_txqueue.head = 0; */ ++ /* hwxmits[2] .phwtxqueue = &pxmitpriv->vi_txqueue; */ ++ hwxmits[2] .sta_queue = &pxmitpriv->vi_pending; ++ ++ /* pxmitpriv->bk_txqueue.head = 0; */ ++ /* hwxmits[3] .phwtxqueue = &pxmitpriv->bk_txqueue; */ ++ hwxmits[3] .sta_queue = &pxmitpriv->bk_pending; ++ ++ /* pxmitpriv->be_txqueue.head = 0; */ ++ /* hwxmits[4] .phwtxqueue = &pxmitpriv->be_txqueue; */ ++ hwxmits[4] .sta_queue = &pxmitpriv->be_pending; ++ ++ } else if (pxmitpriv->hwxmit_entry == 4) { ++ ++ /* pxmitpriv->vo_txqueue.head = 0; */ ++ /* hwxmits[0] .phwtxqueue = &pxmitpriv->vo_txqueue; */ ++ hwxmits[0] .sta_queue = &pxmitpriv->vo_pending; ++ ++ /* pxmitpriv->vi_txqueue.head = 0; */ ++ /* hwxmits[1] .phwtxqueue = &pxmitpriv->vi_txqueue; */ ++ hwxmits[1] .sta_queue = &pxmitpriv->vi_pending; ++ ++ /* pxmitpriv->be_txqueue.head = 0; */ ++ /* hwxmits[2] .phwtxqueue = &pxmitpriv->be_txqueue; */ ++ hwxmits[2] .sta_queue = &pxmitpriv->be_pending; ++ ++ /* pxmitpriv->bk_txqueue.head = 0; */ ++ /* hwxmits[3] .phwtxqueue = &pxmitpriv->bk_txqueue; */ ++ hwxmits[3] .sta_queue = &pxmitpriv->bk_pending; ++ } else { ++ ++ ++ } ++ ++ ++} ++ ++void rtw_free_hwxmits(_adapter *padapter) ++{ ++ struct hw_xmit *hwxmits; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ hwxmits = pxmitpriv->hwxmits; ++ if (hwxmits) ++ rtw_mfree((u8 *)hwxmits, (sizeof(struct hw_xmit) * pxmitpriv->hwxmit_entry)); ++} ++ ++void rtw_init_hwxmits(struct hw_xmit *phwxmit, sint entry) ++{ ++ sint i; ++ for (i = 0; i < entry; i++, phwxmit++) { ++ /* _rtw_spinlock_init(&phwxmit->xmit_lock); */ ++ /* _rtw_init_listhead(&phwxmit->pending); */ ++ /* phwxmit->txcmdcnt = 0; */ ++ phwxmit->accnt = 0; ++ } ++} ++ ++#ifdef CONFIG_BR_EXT ++int rtw_br_client_tx(_adapter *padapter, struct sk_buff **pskb) ++{ ++ struct sk_buff *skb = *pskb; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ _irqL irqL; ++ /* if(check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == _TRUE) */ ++ { ++ void dhcp_flag_bcast(_adapter *priv, struct sk_buff *skb); ++ int res, is_vlan_tag = 0, i, do_nat25 = 1; ++ unsigned short vlan_hdr = 0; ++ void *br_port = NULL; ++ ++ /* mac_clone_handle_frame(priv, skb); */ ++ ++#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) ++ br_port = padapter->pnetdev->br_port; ++#else /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ ++ rcu_read_lock(); ++ br_port = rcu_dereference(padapter->pnetdev->rx_handler_data); ++ rcu_read_unlock(); ++#endif /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ ++ _enter_critical_bh(&padapter->br_ext_lock, &irqL); ++ if (!(skb->data[0] & 1) && ++ br_port && ++ memcmp(skb->data + MACADDRLEN, padapter->br_mac, MACADDRLEN) && ++ *((unsigned short *)(skb->data + MACADDRLEN * 2)) != __constant_htons(ETH_P_8021Q) && ++ *((unsigned short *)(skb->data + MACADDRLEN * 2)) == __constant_htons(ETH_P_IP) && ++ !memcmp(padapter->scdb_mac, skb->data + MACADDRLEN, MACADDRLEN) && padapter->scdb_entry) { ++ memcpy(skb->data + MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); ++ padapter->scdb_entry->ageing_timer = jiffies; ++ _exit_critical_bh(&padapter->br_ext_lock, &irqL); ++ } else ++ /* if (!priv->pmib->ethBrExtInfo.nat25_disable) */ ++ { ++ /* if (priv->dev->br_port && ++ * !memcmp(skb->data+MACADDRLEN, priv->br_mac, MACADDRLEN)) { */ ++#if 1 ++ if (*((unsigned short *)(skb->data + MACADDRLEN * 2)) == __constant_htons(ETH_P_8021Q)) { ++ is_vlan_tag = 1; ++ vlan_hdr = *((unsigned short *)(skb->data + MACADDRLEN * 2 + 2)); ++ for (i = 0; i < 6; i++) ++ *((unsigned short *)(skb->data + MACADDRLEN * 2 + 2 - i * 2)) = *((unsigned short *)(skb->data + MACADDRLEN * 2 - 2 - i * 2)); ++ skb_pull(skb, 4); ++ } ++ /* if SA == br_mac && skb== IP => copy SIP to br_ip ?? why */ ++ if (!memcmp(skb->data + MACADDRLEN, padapter->br_mac, MACADDRLEN) && ++ (*((unsigned short *)(skb->data + MACADDRLEN * 2)) == __constant_htons(ETH_P_IP))) ++ memcpy(padapter->br_ip, skb->data + WLAN_ETHHDR_LEN + 12, 4); ++ ++ if (*((unsigned short *)(skb->data + MACADDRLEN * 2)) == __constant_htons(ETH_P_IP)) { ++ if (memcmp(padapter->scdb_mac, skb->data + MACADDRLEN, MACADDRLEN)) { ++ void *scdb_findEntry(_adapter *priv, unsigned char *macAddr, unsigned char *ipAddr); ++ ++ padapter->scdb_entry = (struct nat25_network_db_entry *)scdb_findEntry(padapter, ++ skb->data + MACADDRLEN, skb->data + WLAN_ETHHDR_LEN + 12); ++ if (padapter->scdb_entry != NULL) { ++ memcpy(padapter->scdb_mac, skb->data + MACADDRLEN, MACADDRLEN); ++ memcpy(padapter->scdb_ip, skb->data + WLAN_ETHHDR_LEN + 12, 4); ++ padapter->scdb_entry->ageing_timer = jiffies; ++ do_nat25 = 0; ++ } ++ } else { ++ if (padapter->scdb_entry) { ++ padapter->scdb_entry->ageing_timer = jiffies; ++ do_nat25 = 0; ++ } else { ++ memset(padapter->scdb_mac, 0, MACADDRLEN); ++ memset(padapter->scdb_ip, 0, 4); ++ } ++ } ++ } ++ _exit_critical_bh(&padapter->br_ext_lock, &irqL); ++#endif /* 1 */ ++ if (do_nat25) { ++ int nat25_db_handle(_adapter *priv, struct sk_buff *skb, int method); ++ if (nat25_db_handle(padapter, skb, NAT25_CHECK) == 0) { ++ struct sk_buff *newskb; ++ ++ if (is_vlan_tag) { ++ skb_push(skb, 4); ++ for (i = 0; i < 6; i++) ++ *((unsigned short *)(skb->data + i * 2)) = *((unsigned short *)(skb->data + 4 + i * 2)); ++ *((unsigned short *)(skb->data + MACADDRLEN * 2)) = __constant_htons(ETH_P_8021Q); ++ *((unsigned short *)(skb->data + MACADDRLEN * 2 + 2)) = vlan_hdr; ++ } ++ ++ newskb = rtw_skb_copy(skb); ++ if (newskb == NULL) { ++ /* priv->ext_stats.tx_drops++; */ ++ DEBUG_ERR("TX DROP: rtw_skb_copy fail!\n"); ++ /* goto stop_proc; */ ++ return -1; ++ } ++ rtw_skb_free(skb); ++ ++ *pskb = skb = newskb; ++ if (is_vlan_tag) { ++ vlan_hdr = *((unsigned short *)(skb->data + MACADDRLEN * 2 + 2)); ++ for (i = 0; i < 6; i++) ++ *((unsigned short *)(skb->data + MACADDRLEN * 2 + 2 - i * 2)) = *((unsigned short *)(skb->data + MACADDRLEN * 2 - 2 - i * 2)); ++ skb_pull(skb, 4); ++ } ++ } ++ ++ if (skb_is_nonlinear(skb)) ++ DEBUG_ERR("%s(): skb_is_nonlinear!!\n", __FUNCTION__); ++ ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 18)) ++ res = skb_linearize(skb, GFP_ATOMIC); ++#else /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 18)) */ ++ res = skb_linearize(skb); ++#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 18)) */ ++ if (res < 0) { ++ DEBUG_ERR("TX DROP: skb_linearize fail!\n"); ++ /* goto free_and_stop; */ ++ return -1; ++ } ++ ++ res = nat25_db_handle(padapter, skb, NAT25_INSERT); ++ if (res < 0) { ++ if (res == -2) { ++ /* priv->ext_stats.tx_drops++; */ ++ DEBUG_ERR("TX DROP: nat25_db_handle fail!\n"); ++ /* goto free_and_stop; */ ++ return -1; ++ ++ } ++ /* we just print warning message and let it go */ ++ /* DEBUG_WARN("%s()-%d: nat25_db_handle INSERT Warning!\n", __FUNCTION__, __LINE__); */ ++ /* return -1; */ /* return -1 will cause system crash on 2011/08/30! */ ++ return 0; ++ } ++ } ++ ++ memcpy(skb->data + MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); ++ ++ dhcp_flag_bcast(padapter, skb); ++ ++ if (is_vlan_tag) { ++ skb_push(skb, 4); ++ for (i = 0; i < 6; i++) ++ *((unsigned short *)(skb->data + i * 2)) = *((unsigned short *)(skb->data + 4 + i * 2)); ++ *((unsigned short *)(skb->data + MACADDRLEN * 2)) = __constant_htons(ETH_P_8021Q); ++ *((unsigned short *)(skb->data + MACADDRLEN * 2 + 2)) = vlan_hdr; ++ } ++ } ++#if 0 ++ else { ++ if (*((unsigned short *)(skb->data + MACADDRLEN * 2)) == __constant_htons(ETH_P_8021Q)) ++ is_vlan_tag = 1; ++ ++ if (is_vlan_tag) { ++ if (ICMPV6_MCAST_MAC(skb->data) && ICMPV6_PROTO1A_VALN(skb->data)) ++ memcpy(skb->data + MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); ++ } else { ++ if (ICMPV6_MCAST_MAC(skb->data) && ICMPV6_PROTO1A(skb->data)) ++ memcpy(skb->data + MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); ++ } ++ } ++#endif /* 0 */ ++ ++ /* check if SA is equal to our MAC */ ++ if (memcmp(skb->data + MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN)) { ++ /* priv->ext_stats.tx_drops++; */ ++ DEBUG_ERR("TX DROP: untransformed frame SA:%02X%02X%02X%02X%02X%02X!\n", ++ skb->data[6], skb->data[7], skb->data[8], skb->data[9], skb->data[10], skb->data[11]); ++ /* goto free_and_stop; */ ++ return -1; ++ } ++ } ++ return 0; ++} ++#endif /* CONFIG_BR_EXT */ ++ ++u32 rtw_get_ff_hwaddr(struct xmit_frame *pxmitframe) ++{ ++ u32 addr; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ ++ switch (pattrib->qsel) { ++ case 0: ++ case 3: ++ addr = BE_QUEUE_INX; ++ break; ++ case 1: ++ case 2: ++ addr = BK_QUEUE_INX; ++ break; ++ case 4: ++ case 5: ++ addr = VI_QUEUE_INX; ++ break; ++ case 6: ++ case 7: ++ addr = VO_QUEUE_INX; ++ break; ++ case 0x10: ++ addr = BCN_QUEUE_INX; ++ break; ++ case 0x11: /* BC/MC in PS (HIQ) */ ++ addr = HIGH_QUEUE_INX; ++ break; ++ case 0x13: ++ addr = TXCMD_QUEUE_INX; ++ break; ++ case 0x12: ++ default: ++ addr = MGT_QUEUE_INX; ++ break; ++ ++ } ++ ++ return addr; ++ ++} ++ ++static void do_queue_select(_adapter *padapter, struct pkt_attrib *pattrib) ++{ ++ u8 qsel; ++ ++ qsel = pattrib->priority; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ /* if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) ++ * qsel = 7; */ ++#endif ++ ++#ifdef CONFIG_MCC_MODE ++ if (MCC_EN(padapter)) { ++ /* Under MCC */ ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) { ++ if (padapter->mcc_adapterpriv.role == MCC_ROLE_GO ++ || padapter->mcc_adapterpriv.role == MCC_ROLE_AP) { ++ pattrib->qsel = QSLT_VO; /* AP interface VO queue */ ++ } else { ++ pattrib->qsel = QSLT_BE; /* STA interface BE queue */ ++ } ++ } else ++ /* Not Under MCC */ ++ pattrib->qsel = qsel; ++ } else ++ /* Not enable MCC */ ++ pattrib->qsel = qsel; ++#else /* !CONFIG_MCC_MODE */ ++ pattrib->qsel = qsel; ++#endif /* CONFIG_MCC_MODE */ ++} ++ ++/* ++ * The main transmit(tx) entry ++ * ++ * Return ++ * 1 enqueue ++ * 0 success, hardware will handle this xmit frame(packet) ++ * <0 fail ++ */ ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) ++s32 rtw_monitor_xmit_entry(struct sk_buff *skb, struct net_device *ndev) ++{ ++ int ret = 0; ++ int rtap_len; ++ int qos_len = 0; ++ int dot11_hdr_len = 24; ++ int snap_len = 6; ++ unsigned char *pdata; ++ u16 frame_ctl; ++ unsigned char src_mac_addr[6]; ++ unsigned char dst_mac_addr[6]; ++ struct rtw_ieee80211_hdr *dot11_hdr; ++ struct ieee80211_radiotap_header *rtap_hdr; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ ++ if (skb) ++ rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, skb->truesize); ++ ++ if (unlikely(skb->len < sizeof(struct ieee80211_radiotap_header))) ++ goto fail; ++ ++ rtap_hdr = (struct ieee80211_radiotap_header *)skb->data; ++ if (unlikely(rtap_hdr->it_version)) ++ goto fail; ++ ++ rtap_len = ieee80211_get_radiotap_len(skb->data); ++ if (unlikely(skb->len < rtap_len)) ++ goto fail; ++ ++ if (rtap_len != 12) { ++ RTW_INFO("radiotap len (should be 14): %d\n", rtap_len); ++ goto fail; ++ } ++ ++ /* Skip the ratio tap header */ ++ skb_pull(skb, rtap_len); ++ ++ dot11_hdr = (struct rtw_ieee80211_hdr *)skb->data; ++ frame_ctl = le16_to_cpu(dot11_hdr->frame_ctl); ++ /* Check if the QoS bit is set */ ++ ++ if ((frame_ctl & RTW_IEEE80211_FCTL_FTYPE) == RTW_IEEE80211_FTYPE_DATA) { ++ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ u8 *buf = skb->data; ++ u32 len = skb->len; ++ u8 category, action; ++ int type = -1; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) { ++ rtw_udelay_os(500); ++ goto fail; ++ } ++ pattrib = &pmgntframe->attrib; ++ ++ update_monitor_frame_attrib(padapter, pattrib); ++ ++ pattrib->retry_ctrl = _FALSE; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ _rtw_memcpy(pframe, (void *)buf, len); ++ ++ pattrib->pktlen = len; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ if (is_broadcast_mac_addr(pwlanhdr->addr3) || is_broadcast_mac_addr(pwlanhdr->addr1)) ++ pattrib->rate = MGN_24M; ++ ++ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); ++ pattrib->seqnum = pmlmeext->mgnt_seq; ++ pmlmeext->mgnt_seq++; ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ } else { ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ u8 *buf = skb->data; ++ u32 len = skb->len; ++ u8 category, action; ++ int type = -1; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto fail; ++ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ pattrib->retry_ctrl = _FALSE; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ _rtw_memcpy(pframe, (void *)buf, len); ++ ++ pattrib->pktlen = len; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); ++ pattrib->seqnum = pmlmeext->mgnt_seq; ++ pmlmeext->mgnt_seq++; ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ } ++ ++fail: ++ ++ rtw_skb_free(skb); ++ ++ return 0; ++} ++#endif ++/* ++ * The main transmit(tx) entry ++ * ++ * Return ++ * 1 enqueue ++ * 0 success, hardware will handle this xmit frame(packet) ++ * <0 fail ++ */ ++s32 rtw_xmit(_adapter *padapter, _pkt **ppkt) ++{ ++ static u32 start = 0; ++ static u32 drop_cnt = 0; ++#ifdef CONFIG_AP_MODE ++ _irqL irqL0; ++#endif ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct xmit_frame *pxmitframe = NULL; ++#ifdef CONFIG_BR_EXT ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ void *br_port = NULL; ++#endif /* CONFIG_BR_EXT */ ++ ++ s32 res; ++ ++ DBG_COUNTER(padapter->tx_logs.core_tx); ++ ++ if (start == 0) ++ start = rtw_get_current_time(); ++ ++ pxmitframe = rtw_alloc_xmitframe(pxmitpriv); ++ ++ if (rtw_get_passing_time_ms(start) > 2000) { ++ if (drop_cnt) ++ RTW_INFO("DBG_TX_DROP_FRAME %s no more pxmitframe, drop_cnt:%u\n", __FUNCTION__, drop_cnt); ++ start = rtw_get_current_time(); ++ drop_cnt = 0; ++ } ++ ++ if (pxmitframe == NULL) { ++ drop_cnt++; ++ /*RTW_INFO("%s-"ADPT_FMT" no more xmitframe\n", __func__, ADPT_ARG(padapter));*/ ++ DBG_COUNTER(padapter->tx_logs.core_tx_err_pxmitframe); ++ return -1; ++ } ++ ++#ifdef CONFIG_BR_EXT ++ ++#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) ++ br_port = padapter->pnetdev->br_port; ++#else /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ ++ rcu_read_lock(); ++ br_port = rcu_dereference(padapter->pnetdev->rx_handler_data); ++ rcu_read_unlock(); ++#endif /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ ++ ++ if (br_port && check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) == _TRUE) { ++ res = rtw_br_client_tx(padapter, ppkt); ++ if (res == -1) { ++ rtw_free_xmitframe(pxmitpriv, pxmitframe); ++ DBG_COUNTER(padapter->tx_logs.core_tx_err_brtx); ++ return -1; ++ } ++ } ++ ++#endif /* CONFIG_BR_EXT */ ++ ++ res = update_attrib(padapter, *ppkt, &pxmitframe->attrib); ++ ++#ifdef CONFIG_MCC_MODE ++ /* record data kernel TX to driver to check MCC concurrent TX */ ++ rtw_hal_mcc_calc_tx_bytes_from_kernel(padapter, pxmitframe->attrib.pktlen); ++#endif /* CONFIG_MCC_MODE */ ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (pxmitframe->attrib.ether_type != 0x88B4) { ++ if (rtw_wapi_drop_for_key_absent(padapter, pxmitframe->attrib.ra)) { ++ WAPI_TRACE(WAPI_RX, "drop for key absend when tx\n"); ++ res = _FAIL; ++ } ++ } ++#endif ++ if (res == _FAIL) { ++ /*RTW_INFO("%s-"ADPT_FMT" update attrib fail\n", __func__, ADPT_ARG(padapter));*/ ++#ifdef DBG_TX_DROP_FRAME ++ RTW_INFO("DBG_TX_DROP_FRAME %s update attrib fail\n", __FUNCTION__); ++#endif ++ rtw_free_xmitframe(pxmitpriv, pxmitframe); ++ return -1; ++ } ++ pxmitframe->pkt = *ppkt; ++ ++ rtw_led_control(padapter, LED_CTL_TX); ++ ++ do_queue_select(padapter, &pxmitframe->attrib); ++ ++#ifdef CONFIG_AP_MODE ++ _enter_critical_bh(&pxmitpriv->lock, &irqL0); ++ if (xmitframe_enqueue_for_sleeping_sta(padapter, pxmitframe) == _TRUE) { ++ _exit_critical_bh(&pxmitpriv->lock, &irqL0); ++ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue); ++ return 1; ++ } ++ _exit_critical_bh(&pxmitpriv->lock, &irqL0); ++#endif ++ ++ /* pre_xmitframe */ ++ if (rtw_hal_xmit(padapter, pxmitframe) == _FALSE) ++ return 1; ++ ++ return 0; ++} ++ ++#ifdef CONFIG_TDLS ++sint xmitframe_enqueue_for_tdls_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ sint ret = _FALSE; ++ ++ _irqL irqL; ++ struct sta_info *ptdls_sta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ int i; ++ ++ ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); ++ if (ptdls_sta == NULL) ++ return ret; ++ else if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { ++ ++ if (pattrib->triggered == 1) { ++ ret = _TRUE; ++ return ret; ++ } ++ ++ _enter_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); ++ ++ if (ptdls_sta->state & WIFI_SLEEP_STATE) { ++ rtw_list_delete(&pxmitframe->list); ++ ++ /* _enter_critical_bh(&psta->sleep_q.lock, &irqL); */ ++ ++ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&ptdls_sta->sleep_q)); ++ ++ ptdls_sta->sleepq_len++; ++ ptdls_sta->sleepq_ac_len++; ++ ++ /* indicate 4-AC queue bit in TDLS peer traffic indication */ ++ switch (pattrib->priority) { ++ case 1: ++ case 2: ++ ptdls_sta->uapsd_bk |= BIT(1); ++ break; ++ case 4: ++ case 5: ++ ptdls_sta->uapsd_vi |= BIT(1); ++ break; ++ case 6: ++ case 7: ++ ptdls_sta->uapsd_vo |= BIT(1); ++ break; ++ case 0: ++ case 3: ++ default: ++ ptdls_sta->uapsd_be |= BIT(1); ++ break; ++ } ++ ++ /* Transmit TDLS PTI via AP */ ++ if (ptdls_sta->sleepq_len == 1) ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ISSUE_PTI); ++ ++ ret = _TRUE; ++ } ++ ++ _exit_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); ++ } ++ ++ return ret; ++ ++} ++#endif /* CONFIG_TDLS */ ++ ++#define RTW_HIQ_FILTER_ALLOW_ALL 0 ++#define RTW_HIQ_FILTER_ALLOW_SPECIAL 1 ++#define RTW_HIQ_FILTER_DENY_ALL 2 ++ ++inline bool xmitframe_hiq_filter(struct xmit_frame *xmitframe) ++{ ++ bool allow = _FALSE; ++ _adapter *adapter = xmitframe->padapter; ++ struct registry_priv *registry = &adapter->registrypriv; ++ ++ if (rtw_get_intf_type(adapter) != RTW_PCIE) { ++ ++ if (adapter->registrypriv.wifi_spec == 1) ++ allow = _TRUE; ++ else if (registry->hiq_filter == RTW_HIQ_FILTER_ALLOW_SPECIAL) { ++ ++ struct pkt_attrib *attrib = &xmitframe->attrib; ++ ++ if (attrib->ether_type == 0x0806 ++ || attrib->ether_type == 0x888e ++#ifdef CONFIG_WAPI_SUPPORT ++ || attrib->ether_type == 0x88B4 ++#endif ++ || attrib->dhcp_pkt ++ ) { ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" ether_type:0x%04x%s\n", FUNC_ADPT_ARG(xmitframe->padapter) ++ , attrib->ether_type, attrib->dhcp_pkt ? " DHCP" : ""); ++ allow = _TRUE; ++ } ++ } else if (registry->hiq_filter == RTW_HIQ_FILTER_ALLOW_ALL) ++ allow = _TRUE; ++ else if (registry->hiq_filter == RTW_HIQ_FILTER_DENY_ALL) { ++ } else ++ rtw_warn_on(1); ++ } ++ return allow; ++} ++ ++#if defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) ++ ++sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ _irqL irqL; ++ sint ret = _FALSE; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ sint bmcst = IS_MCAST(pattrib->ra); ++ bool update_tim = _FALSE; ++#ifdef CONFIG_TDLS ++ ++ if (padapter->tdlsinfo.link_established == _TRUE) ++ ret = xmitframe_enqueue_for_tdls_sleeping_sta(padapter, pxmitframe); ++#endif /* CONFIG_TDLS */ ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _FALSE) { ++ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_fwstate); ++ return ret; ++ } ++ /* ++ if(pattrib->psta) ++ { ++ psta = pattrib->psta; ++ } ++ else ++ { ++ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); ++ psta=rtw_get_stainfo(pstapriv, pattrib->ra); ++ } ++ */ ++ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); ++ if (pattrib->psta != psta) { ++ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_sta); ++ RTW_INFO("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); ++ return _FALSE; ++ } ++ ++ if (psta == NULL) { ++ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_nosta); ++ RTW_INFO("%s, psta==NUL\n", __func__); ++ return _FALSE; ++ } ++ ++ if (!(psta->state & _FW_LINKED)) { ++ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_link); ++ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); ++ return _FALSE; ++ } ++ ++ if (pattrib->triggered == 1) { ++ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_trigger); ++ /* RTW_INFO("directly xmit pspoll_triggered packet\n"); */ ++ ++ /* pattrib->triggered=0; */ ++ if (bmcst && xmitframe_hiq_filter(pxmitframe) == _TRUE) ++ pattrib->qsel = QSLT_HIGH;/* HIQ */ ++ ++ return ret; ++ } ++ ++ ++ if (bmcst) { ++ _enter_critical_bh(&psta->sleep_q.lock, &irqL); ++ ++ if (pstapriv->sta_dz_bitmap) { /* if anyone sta is in ps mode */ ++ /* pattrib->qsel = QSLT_HIGH; */ /* HIQ */ ++ ++ rtw_list_delete(&pxmitframe->list); ++ ++ /*_enter_critical_bh(&psta->sleep_q.lock, &irqL);*/ ++ ++ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&psta->sleep_q)); ++ ++ psta->sleepq_len++; ++ ++ if (!(pstapriv->tim_bitmap & BIT(0))) ++ update_tim = _TRUE; ++ ++ pstapriv->tim_bitmap |= BIT(0); ++ pstapriv->sta_dz_bitmap |= BIT(0); ++ ++ /* RTW_INFO("enqueue, sq_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); */ ++ if (update_tim == _TRUE) { ++ if (is_broadcast_mac_addr(pattrib->ra)) ++ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "buffer BC"); ++ else ++ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "buffer MC"); ++ } else ++ chk_bmc_sleepq_cmd(padapter); ++ ++ /*_exit_critical_bh(&psta->sleep_q.lock, &irqL);*/ ++ ++ ret = _TRUE; ++ ++ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_mcast); ++ ++ } ++ ++ _exit_critical_bh(&psta->sleep_q.lock, &irqL); ++ ++ return ret; ++ ++ } ++ ++ ++ _enter_critical_bh(&psta->sleep_q.lock, &irqL); ++ ++ if (psta->state & WIFI_SLEEP_STATE) { ++ u8 wmmps_ac = 0; ++ ++ if (pstapriv->sta_dz_bitmap & BIT(psta->aid)) { ++ rtw_list_delete(&pxmitframe->list); ++ ++ /* _enter_critical_bh(&psta->sleep_q.lock, &irqL); */ ++ ++ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&psta->sleep_q)); ++ ++ psta->sleepq_len++; ++ ++ switch (pattrib->priority) { ++ case 1: ++ case 2: ++ wmmps_ac = psta->uapsd_bk & BIT(0); ++ break; ++ case 4: ++ case 5: ++ wmmps_ac = psta->uapsd_vi & BIT(0); ++ break; ++ case 6: ++ case 7: ++ wmmps_ac = psta->uapsd_vo & BIT(0); ++ break; ++ case 0: ++ case 3: ++ default: ++ wmmps_ac = psta->uapsd_be & BIT(0); ++ break; ++ } ++ ++ if (wmmps_ac) ++ psta->sleepq_ac_len++; ++ ++ if (((psta->has_legacy_ac) && (!wmmps_ac)) || ((!psta->has_legacy_ac) && (wmmps_ac))) { ++ if (!(pstapriv->tim_bitmap & BIT(psta->aid))) ++ update_tim = _TRUE; ++ ++ pstapriv->tim_bitmap |= BIT(psta->aid); ++ ++ /* RTW_INFO("enqueue, sq_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); */ ++ ++ if (update_tim == _TRUE) { ++ /* RTW_INFO("sleepq_len==1, update BCNTIM\n"); */ ++ /* upate BCN for TIM IE */ ++ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "buffer UC"); ++ } ++ } ++ ++ /* _exit_critical_bh(&psta->sleep_q.lock, &irqL); */ ++ ++ /* if(psta->sleepq_len > (NR_XMITFRAME>>3)) */ ++ /* { */ ++ /* wakeup_sta_to_xmit(padapter, psta); */ ++ /* } */ ++ ++ ret = _TRUE; ++ ++ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_ucast); ++ } ++ ++ } ++ ++ _exit_critical_bh(&psta->sleep_q.lock, &irqL); ++ ++ return ret; ++ ++} ++ ++static void dequeue_xmitframes_to_sleeping_queue(_adapter *padapter, struct sta_info *psta, _queue *pframequeue) ++{ ++ sint ret; ++ _list *plist, *phead; ++ u8 ac_index; ++ struct tx_servq *ptxservq; ++ struct pkt_attrib *pattrib; ++ struct xmit_frame *pxmitframe; ++ struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; ++ ++ phead = get_list_head(pframequeue); ++ plist = get_next(phead); ++ ++ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ pxmitframe = LIST_CONTAINOR(plist, struct xmit_frame, list); ++ ++ plist = get_next(plist); ++ ++ pattrib = &pxmitframe->attrib; ++ ++ pattrib->triggered = 0; ++ ++ ret = xmitframe_enqueue_for_sleeping_sta(padapter, pxmitframe); ++ ++ if (_TRUE == ret) { ++ ptxservq = rtw_get_sta_pending(padapter, psta, pattrib->priority, (u8 *)(&ac_index)); ++ ++ ptxservq->qcnt--; ++ phwxmits[ac_index].accnt--; ++ } else { ++ /* RTW_INFO("xmitframe_enqueue_for_sleeping_sta return _FALSE\n"); */ ++ } ++ ++ } ++ ++} ++ ++void stop_sta_xmit(_adapter *padapter, struct sta_info *psta) ++{ ++ _irqL irqL0; ++ struct sta_info *psta_bmc; ++ struct sta_xmit_priv *pstaxmitpriv; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ pstaxmitpriv = &psta->sta_xmitpriv; ++ ++ /* for BC/MC Frames */ ++ psta_bmc = rtw_get_bcmc_stainfo(padapter); ++ ++ ++ _enter_critical_bh(&pxmitpriv->lock, &irqL0); ++ ++ psta->state |= WIFI_SLEEP_STATE; ++ ++#ifdef CONFIG_TDLS ++ if (!(psta->tdls_sta_state & TDLS_LINKED_STATE)) ++#endif /* CONFIG_TDLS */ ++ pstapriv->sta_dz_bitmap |= BIT(psta->aid); ++ ++ ++ ++ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->vo_q.sta_pending); ++ rtw_list_delete(&(pstaxmitpriv->vo_q.tx_pending)); ++ ++ ++ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->vi_q.sta_pending); ++ rtw_list_delete(&(pstaxmitpriv->vi_q.tx_pending)); ++ ++ ++ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->be_q.sta_pending); ++ rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); ++ ++ ++ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->bk_q.sta_pending); ++ rtw_list_delete(&(pstaxmitpriv->bk_q.tx_pending)); ++ ++#ifdef CONFIG_TDLS ++ if (!(psta->tdls_sta_state & TDLS_LINKED_STATE) && (psta_bmc != NULL)) { ++#endif /* CONFIG_TDLS */ ++ ++ ++ /* for BC/MC Frames */ ++ pstaxmitpriv = &psta_bmc->sta_xmitpriv; ++ dequeue_xmitframes_to_sleeping_queue(padapter, psta_bmc, &pstaxmitpriv->be_q.sta_pending); ++ rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); ++ ++ ++#ifdef CONFIG_TDLS ++ } ++#endif /* CONFIG_TDLS */ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL0); ++ ++ ++} ++ ++void wakeup_sta_to_xmit(_adapter *padapter, struct sta_info *psta) ++{ ++ _irqL irqL; ++ u8 update_mask = 0, wmmps_ac = 0; ++ struct sta_info *psta_bmc; ++ _list *xmitframe_plist, *xmitframe_phead; ++ struct xmit_frame *pxmitframe = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ psta_bmc = rtw_get_bcmc_stainfo(padapter); ++ ++ ++ /* _enter_critical_bh(&psta->sleep_q.lock, &irqL); */ ++ _enter_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ xmitframe_phead = get_list_head(&psta->sleep_q); ++ xmitframe_plist = get_next(xmitframe_phead); ++ ++ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { ++ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); ++ ++ xmitframe_plist = get_next(xmitframe_plist); ++ ++ rtw_list_delete(&pxmitframe->list); ++ ++ switch (pxmitframe->attrib.priority) { ++ case 1: ++ case 2: ++ wmmps_ac = psta->uapsd_bk & BIT(1); ++ break; ++ case 4: ++ case 5: ++ wmmps_ac = psta->uapsd_vi & BIT(1); ++ break; ++ case 6: ++ case 7: ++ wmmps_ac = psta->uapsd_vo & BIT(1); ++ break; ++ case 0: ++ case 3: ++ default: ++ wmmps_ac = psta->uapsd_be & BIT(1); ++ break; ++ } ++ ++ psta->sleepq_len--; ++ if (psta->sleepq_len > 0) ++ pxmitframe->attrib.mdata = 1; ++ else ++ pxmitframe->attrib.mdata = 0; ++ ++ if (wmmps_ac) { ++ psta->sleepq_ac_len--; ++ if (psta->sleepq_ac_len > 0) { ++ pxmitframe->attrib.mdata = 1; ++ pxmitframe->attrib.eosp = 0; ++ } else { ++ pxmitframe->attrib.mdata = 0; ++ pxmitframe->attrib.eosp = 1; ++ } ++ } ++ ++ pxmitframe->attrib.triggered = 1; ++ ++ /* ++ _exit_critical_bh(&psta->sleep_q.lock, &irqL); ++ if(rtw_hal_xmit(padapter, pxmitframe) == _TRUE) ++ { ++ rtw_os_xmit_complete(padapter, pxmitframe); ++ } ++ _enter_critical_bh(&psta->sleep_q.lock, &irqL); ++ */ ++ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); ++ ++ ++ } ++ ++ if (psta->sleepq_len == 0) { ++#ifdef CONFIG_TDLS ++ if (psta->tdls_sta_state & TDLS_LINKED_STATE) { ++ if (psta->state & WIFI_SLEEP_STATE) ++ psta->state ^= WIFI_SLEEP_STATE; ++ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ return; ++ } ++#endif /* CONFIG_TDLS */ ++ ++ if (pstapriv->tim_bitmap & BIT(psta->aid)) { ++ /* RTW_INFO("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); */ ++ /* upate BCN for TIM IE */ ++ /* update_BCNTIM(padapter); */ ++ update_mask = BIT(0); ++ } ++ ++ pstapriv->tim_bitmap &= ~BIT(psta->aid); ++ ++ if (psta->state & WIFI_SLEEP_STATE) ++ psta->state ^= WIFI_SLEEP_STATE; ++ ++ if (psta->state & WIFI_STA_ALIVE_CHK_STATE) { ++ RTW_INFO("%s alive check\n", __func__); ++ psta->expire_to = pstapriv->expire_to; ++ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; ++ } ++ ++ pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); ++ } ++ ++ /* for BC/MC Frames */ ++ if (!psta_bmc) ++ goto _exit; ++ ++ if ((pstapriv->sta_dz_bitmap & 0xfffe) == 0x0) { /* no any sta in ps mode */ ++ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); ++ xmitframe_plist = get_next(xmitframe_phead); ++ ++ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { ++ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); ++ ++ xmitframe_plist = get_next(xmitframe_plist); ++ ++ rtw_list_delete(&pxmitframe->list); ++ ++ psta_bmc->sleepq_len--; ++ if (psta_bmc->sleepq_len > 0) ++ pxmitframe->attrib.mdata = 1; ++ else ++ pxmitframe->attrib.mdata = 0; ++ ++ ++ pxmitframe->attrib.triggered = 1; ++ /* ++ _exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); ++ if(rtw_hal_xmit(padapter, pxmitframe) == _TRUE) ++ { ++ rtw_os_xmit_complete(padapter, pxmitframe); ++ } ++ _enter_critical_bh(&psta_bmc->sleep_q.lock, &irqL); ++ ++ */ ++ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); ++ ++ } ++ ++ if (psta_bmc->sleepq_len == 0) { ++ if (pstapriv->tim_bitmap & BIT(0)) { ++ /* RTW_INFO("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); */ ++ /* upate BCN for TIM IE */ ++ /* update_BCNTIM(padapter); */ ++ update_mask |= BIT(1); ++ } ++ pstapriv->tim_bitmap &= ~BIT(0); ++ pstapriv->sta_dz_bitmap &= ~BIT(0); ++ } ++ ++ } ++ ++_exit: ++ ++ /* _exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); */ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ if (update_mask) { ++ /* update_BCNTIM(padapter); */ ++ if ((update_mask & (BIT(0) | BIT(1))) == (BIT(0) | BIT(1))) ++ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "clear UC&BMC"); ++ else if ((update_mask & BIT(1)) == BIT(1)) ++ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "clear BMC"); ++ else ++ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "clear UC"); ++ } ++ ++} ++ ++void xmit_delivery_enabled_frames(_adapter *padapter, struct sta_info *psta) ++{ ++ _irqL irqL; ++ u8 wmmps_ac = 0; ++ _list *xmitframe_plist, *xmitframe_phead; ++ struct xmit_frame *pxmitframe = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ ++ /* _enter_critical_bh(&psta->sleep_q.lock, &irqL); */ ++ _enter_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ xmitframe_phead = get_list_head(&psta->sleep_q); ++ xmitframe_plist = get_next(xmitframe_phead); ++ ++ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { ++ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); ++ ++ xmitframe_plist = get_next(xmitframe_plist); ++ ++ switch (pxmitframe->attrib.priority) { ++ case 1: ++ case 2: ++ wmmps_ac = psta->uapsd_bk & BIT(1); ++ break; ++ case 4: ++ case 5: ++ wmmps_ac = psta->uapsd_vi & BIT(1); ++ break; ++ case 6: ++ case 7: ++ wmmps_ac = psta->uapsd_vo & BIT(1); ++ break; ++ case 0: ++ case 3: ++ default: ++ wmmps_ac = psta->uapsd_be & BIT(1); ++ break; ++ } ++ ++ if (!wmmps_ac) ++ continue; ++ ++ rtw_list_delete(&pxmitframe->list); ++ ++ psta->sleepq_len--; ++ psta->sleepq_ac_len--; ++ ++ if (psta->sleepq_ac_len > 0) { ++ pxmitframe->attrib.mdata = 1; ++ pxmitframe->attrib.eosp = 0; ++ } else { ++ pxmitframe->attrib.mdata = 0; ++ pxmitframe->attrib.eosp = 1; ++ } ++ ++ pxmitframe->attrib.triggered = 1; ++ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); ++ ++ if ((psta->sleepq_ac_len == 0) && (!psta->has_legacy_ac) && (wmmps_ac)) { ++#ifdef CONFIG_TDLS ++ if (psta->tdls_sta_state & TDLS_LINKED_STATE) { ++ /* _exit_critical_bh(&psta->sleep_q.lock, &irqL); */ ++ goto exit; ++ } ++#endif /* CONFIG_TDLS */ ++ pstapriv->tim_bitmap &= ~BIT(psta->aid); ++ ++ /* RTW_INFO("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); */ ++ /* upate BCN for TIM IE */ ++ /* update_BCNTIM(padapter); */ ++ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); ++ /* update_mask = BIT(0); */ ++ } ++ ++ } ++ ++exit: ++ /* _exit_critical_bh(&psta->sleep_q.lock, &irqL); */ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ return; ++} ++ ++#endif /* defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) */ ++ ++#ifdef CONFIG_XMIT_THREAD_MODE ++void enqueue_pending_xmitbuf( ++ struct xmit_priv *pxmitpriv, ++ struct xmit_buf *pxmitbuf) ++{ ++ _irqL irql; ++ _queue *pqueue; ++ _adapter *pri_adapter = pxmitpriv->adapter; ++ ++ pqueue = &pxmitpriv->pending_xmitbuf_queue; ++ ++ _enter_critical_bh(&pqueue->lock, &irql); ++ rtw_list_delete(&pxmitbuf->list); ++ rtw_list_insert_tail(&pxmitbuf->list, get_list_head(pqueue)); ++ _exit_critical_bh(&pqueue->lock, &irql); ++ ++#if defined(CONFIG_SDIO_HCI) && defined(CONFIG_CONCURRENT_MODE) ++ pri_adapter = GET_PRIMARY_ADAPTER(pri_adapter); ++#endif /*SDIO_HCI + CONCURRENT*/ ++ _rtw_up_sema(&(pri_adapter->xmitpriv.xmit_sema)); ++} ++ ++void enqueue_pending_xmitbuf_to_head( ++ struct xmit_priv *pxmitpriv, ++ struct xmit_buf *pxmitbuf) ++{ ++ _irqL irql; ++ _queue *pqueue = &pxmitpriv->pending_xmitbuf_queue; ++ ++ _enter_critical_bh(&pqueue->lock, &irql); ++ rtw_list_delete(&pxmitbuf->list); ++ rtw_list_insert_head(&pxmitbuf->list, get_list_head(pqueue)); ++ _exit_critical_bh(&pqueue->lock, &irql); ++} ++ ++struct xmit_buf *dequeue_pending_xmitbuf( ++ struct xmit_priv *pxmitpriv) ++{ ++ _irqL irql; ++ struct xmit_buf *pxmitbuf; ++ _queue *pqueue; ++ ++ ++ pxmitbuf = NULL; ++ pqueue = &pxmitpriv->pending_xmitbuf_queue; ++ ++ _enter_critical_bh(&pqueue->lock, &irql); ++ ++ if (_rtw_queue_empty(pqueue) == _FALSE) { ++ _list *plist, *phead; ++ ++ phead = get_list_head(pqueue); ++ plist = get_next(phead); ++ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); ++ rtw_list_delete(&pxmitbuf->list); ++ } ++ ++ _exit_critical_bh(&pqueue->lock, &irql); ++ ++ return pxmitbuf; ++} ++ ++static struct xmit_buf *dequeue_pending_xmitbuf_under_survey( ++ struct xmit_priv *pxmitpriv) ++{ ++ _irqL irql; ++ struct xmit_buf *pxmitbuf; ++#ifdef CONFIG_USB_HCI ++ struct xmit_frame *pxmitframe; ++#endif ++ _queue *pqueue; ++ ++ ++ pxmitbuf = NULL; ++ pqueue = &pxmitpriv->pending_xmitbuf_queue; ++ ++ _enter_critical_bh(&pqueue->lock, &irql); ++ ++ if (_rtw_queue_empty(pqueue) == _FALSE) { ++ _list *plist, *phead; ++ u8 type; ++ ++ phead = get_list_head(pqueue); ++ plist = phead; ++ do { ++ plist = get_next(plist); ++ if (plist == phead) ++ break; ++ ++ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); ++ ++#ifdef CONFIG_USB_HCI ++ pxmitframe = (struct xmit_frame *)pxmitbuf->priv_data; ++ if (pxmitframe) ++ type = GetFrameSubType(pxmitbuf->pbuf + TXDESC_SIZE + pxmitframe->pkt_offset * PACKET_OFFSET_SZ); ++ else ++ RTW_INFO("%s, !!!ERROR!!! For USB, TODO ITEM\n", __FUNCTION__); ++#else ++ type = GetFrameSubType(pxmitbuf->pbuf + TXDESC_OFFSET); ++#endif ++ ++ if ((type == WIFI_PROBEREQ) || ++ (type == WIFI_DATA_NULL) || ++ (type == WIFI_QOS_DATA_NULL)) { ++ rtw_list_delete(&pxmitbuf->list); ++ break; ++ } ++ pxmitbuf = NULL; ++ } while (1); ++ } ++ ++ _exit_critical_bh(&pqueue->lock, &irql); ++ ++ return pxmitbuf; ++} ++ ++static struct xmit_buf *dequeue_pending_xmitbuf_ext( ++ struct xmit_priv *pxmitpriv) ++{ ++ _irqL irql; ++ struct xmit_buf *pxmitbuf; ++ _queue *pqueue; ++ ++ pxmitbuf = NULL; ++ pqueue = &pxmitpriv->pending_xmitbuf_queue; ++ ++ _enter_critical_bh(&pqueue->lock, &irql); ++ ++ if (_rtw_queue_empty(pqueue) == _FALSE) { ++ _list *plist, *phead; ++ u8 type; ++ ++ phead = get_list_head(pqueue); ++ plist = phead; ++ do { ++ plist = get_next(plist); ++ if (plist == phead) ++ break; ++ ++ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); ++ ++ if (pxmitbuf->buf_tag == XMITBUF_MGNT) { ++ rtw_list_delete(&pxmitbuf->list); ++ break; ++ } ++ pxmitbuf = NULL; ++ } while (1); ++ } ++ ++ _exit_critical_bh(&pqueue->lock, &irql); ++ ++ return pxmitbuf; ++} ++ ++struct xmit_buf *select_and_dequeue_pending_xmitbuf(_adapter *padapter) ++{ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct xmit_buf *pxmitbuf = NULL; ++ ++ if (rtw_xmit_ac_blocked(padapter) == _TRUE) ++ pxmitbuf = dequeue_pending_xmitbuf_under_survey(pxmitpriv); ++ else { ++ pxmitbuf = dequeue_pending_xmitbuf_ext(pxmitpriv); ++ if (pxmitbuf == NULL) ++ pxmitbuf = dequeue_pending_xmitbuf(pxmitpriv); ++ } ++ ++ return pxmitbuf; ++} ++ ++sint check_pending_xmitbuf( ++ struct xmit_priv *pxmitpriv) ++{ ++ _irqL irql; ++ _queue *pqueue; ++ sint ret = _FALSE; ++ ++ pqueue = &pxmitpriv->pending_xmitbuf_queue; ++ ++ _enter_critical_bh(&pqueue->lock, &irql); ++ ++ if (_rtw_queue_empty(pqueue) == _FALSE) ++ ret = _TRUE; ++ ++ _exit_critical_bh(&pqueue->lock, &irql); ++ ++ return ret; ++} ++ ++thread_return rtw_xmit_thread(thread_context context) ++{ ++ s32 err; ++ PADAPTER padapter; ++ ++ ++ err = _SUCCESS; ++ padapter = (PADAPTER)context; ++ ++ thread_enter("RTW_XMIT_THREAD"); ++ padapter->xmitpriv.stop_req = 0; ++ ++ do { ++ err = rtw_hal_xmit_thread_handler(padapter); ++ flush_signals_thread(); ++ } while (_SUCCESS == err); ++ ++ /*_rtw_up_sema(&padapter->xmitpriv.terminate_xmitthread_sema);*/ ++ thread_exit(&padapter->xmitpriv.xmitthread_comp); ++ return 0; ++} ++#endif ++ ++bool rtw_xmit_ac_blocked(_adapter *adapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ _adapter *iface; ++ struct mlme_ext_priv *mlmeext; ++ struct mlme_ext_info *mlmeextinfo; ++ bool blocked = _FALSE; ++ int i; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ mlmeext = &iface->mlmeextpriv; ++ ++ /* check scan state */ ++ if (mlmeext_scan_state(mlmeext) != SCAN_DISABLE ++ && mlmeext_scan_state(mlmeext) != SCAN_BACK_OP ++ ) { ++ blocked = _TRUE; ++ goto exit; ++ } ++ ++ if (mlmeext_scan_state(mlmeext) == SCAN_BACK_OP ++ && !mlmeext_chk_scan_backop_flags(mlmeext, SS_BACKOP_TX_RESUME) ++ ) { ++ blocked = _TRUE; ++ goto exit; ++ } ++ } ++ ++#ifdef CONFIG_MCC_MODE ++ if (MCC_EN(adapter)) { ++ if (rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) { ++ if (MCC_STOP(adapter)) { ++ blocked = _TRUE; ++ goto exit; ++ } ++ } ++ } ++#endif /* CONFIG_MCC_MODE */ ++ ++exit: ++ return blocked; ++} ++ ++void rtw_sctx_init(struct submit_ctx *sctx, int timeout_ms) ++{ ++ sctx->timeout_ms = timeout_ms; ++ sctx->submit_time = rtw_get_current_time(); ++#ifdef PLATFORM_LINUX /* TODO: add condition wating interface for other os */ ++ init_completion(&sctx->done); ++#endif ++ sctx->status = RTW_SCTX_SUBMITTED; ++} ++ ++int rtw_sctx_wait(struct submit_ctx *sctx, const char *msg) ++{ ++ int ret = _FAIL; ++ unsigned long expire; ++ int status = 0; ++ ++#ifdef PLATFORM_LINUX ++ expire = sctx->timeout_ms ? msecs_to_jiffies(sctx->timeout_ms) : MAX_SCHEDULE_TIMEOUT; ++ if (!wait_for_completion_timeout(&sctx->done, expire)) { ++ /* timeout, do something?? */ ++ status = RTW_SCTX_DONE_TIMEOUT; ++ RTW_INFO("%s timeout: %s\n", __func__, msg); ++ } else ++ status = sctx->status; ++#endif ++ ++ if (status == RTW_SCTX_DONE_SUCCESS) ++ ret = _SUCCESS; ++ ++ return ret; ++} ++ ++bool rtw_sctx_chk_waring_status(int status) ++{ ++ switch (status) { ++ case RTW_SCTX_DONE_UNKNOWN: ++ case RTW_SCTX_DONE_BUF_ALLOC: ++ case RTW_SCTX_DONE_BUF_FREE: ++ ++ case RTW_SCTX_DONE_DRV_STOP: ++ case RTW_SCTX_DONE_DEV_REMOVE: ++ return _TRUE; ++ default: ++ return _FALSE; ++ } ++} ++ ++void rtw_sctx_done_err(struct submit_ctx **sctx, int status) ++{ ++ if (*sctx) { ++ if (rtw_sctx_chk_waring_status(status)) ++ RTW_INFO("%s status:%d\n", __func__, status); ++ (*sctx)->status = status; ++#ifdef PLATFORM_LINUX ++ complete(&((*sctx)->done)); ++#endif ++ *sctx = NULL; ++ } ++} ++ ++void rtw_sctx_done(struct submit_ctx **sctx) ++{ ++ rtw_sctx_done_err(sctx, RTW_SCTX_DONE_SUCCESS); ++} ++ ++#ifdef CONFIG_XMIT_ACK ++int rtw_ack_tx_wait(struct xmit_priv *pxmitpriv, u32 timeout_ms) ++{ ++ struct submit_ctx *pack_tx_ops = &pxmitpriv->ack_tx_ops; ++ ++ pack_tx_ops->submit_time = rtw_get_current_time(); ++ pack_tx_ops->timeout_ms = timeout_ms; ++ pack_tx_ops->status = RTW_SCTX_SUBMITTED; ++ ++ return rtw_sctx_wait(pack_tx_ops, __func__); ++} ++ ++void rtw_ack_tx_done(struct xmit_priv *pxmitpriv, int status) ++{ ++ struct submit_ctx *pack_tx_ops = &pxmitpriv->ack_tx_ops; ++ ++ if (pxmitpriv->ack_tx) ++ rtw_sctx_done_err(&pack_tx_ops, status); ++ else ++ RTW_INFO("%s ack_tx not set\n", __func__); ++} ++#endif /* CONFIG_XMIT_ACK */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.c 2018-02-11 21:44:27.143146025 +0200 +@@ -0,0 +1,1987 @@ ++//============================================================ ++// Description: ++// ++// This file is for 92CE/92CU BT 1 Antenna Co-exist mechanism ++// ++// By cosa 02/11/2011 ++// ++//============================================================ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "Mp_Precomp.h" ++ ++#if WPP_SOFTWARE_TRACE ++#include "HalBtc8188c2Ant.tmh" ++#endif ++ ++#if(BT_30_SUPPORT == 1) ++//============================================================ ++// Global variables, these are static variables ++//============================================================ ++static COEX_DM_8188C_2ANT GLCoexDm8188c2Ant; ++static PCOEX_DM_8188C_2ANT pCoexDm=&GLCoexDm8188c2Ant; ++static COEX_STA_8188C_2ANT GLCoexSta8188c2Ant; ++static PCOEX_STA_8188C_2ANT pCoexSta=&GLCoexSta8188c2Ant; ++ ++//============================================================ ++// local function start with btdm_ ++//============================================================ ++u1Byte ++halbtc8188c2ant_WifiRssiState( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte index, ++ IN u1Byte levelNum, ++ IN u1Byte rssiThresh, ++ IN u1Byte rssiThresh1 ++ ) ++{ ++ s4Byte wifiRssi=0; ++ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); ++ ++ if(levelNum == 2) ++ { ++ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || ++ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) ++ { ++ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT)) ++ { ++ wifiRssiState = BTC_RSSI_STATE_HIGH; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; ++ } ++ } ++ else ++ { ++ if(wifiRssi < rssiThresh) ++ { ++ wifiRssiState = BTC_RSSI_STATE_LOW; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ } ++ else if(levelNum == 3) ++ { ++ if(rssiThresh > rssiThresh1) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); ++ return pCoexSta->preWifiRssiState[index]; ++ } ++ ++ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || ++ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) ++ { ++ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT)) ++ { ++ wifiRssiState = BTC_RSSI_STATE_MEDIUM; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; ++ } ++ } ++ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || ++ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) ++ { ++ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT)) ++ { ++ wifiRssiState = BTC_RSSI_STATE_HIGH; ++ } ++ else if(wifiRssi < rssiThresh) ++ { ++ wifiRssiState = BTC_RSSI_STATE_LOW; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; ++ } ++ } ++ else ++ { ++ if(wifiRssi < rssiThresh1) ++ { ++ wifiRssiState = BTC_RSSI_STATE_MEDIUM; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ } ++ ++ pCoexSta->preWifiRssiState[index] = wifiRssiState; ++ ++ return wifiRssiState; ++} ++ ++u1Byte ++halbtc8188c2ant_ActionAlgorithm( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; ++ u1Byte algorithm=BT_8188C_2ANT_COEX_ALGO_UNDEFINED; ++ u1Byte numOfDiffProfile=0; ++ ++ if(!pStackInfo->bBtLinkExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No profile exists!!!\n")); ++ return algorithm; ++ } ++ ++ if(pStackInfo->bScoExist) ++ numOfDiffProfile++; ++ if(pStackInfo->bHidExist) ++ numOfDiffProfile++; ++ if(pStackInfo->bPanExist) ++ numOfDiffProfile++; ++ if(pStackInfo->bA2dpExist) ++ numOfDiffProfile++; ++ ++ if(pStackInfo->bScoExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO algorithm\n")); ++ algorithm = BT_8188C_2ANT_COEX_ALGO_SCO; ++ } ++ else ++ { ++ if(numOfDiffProfile == 1) ++ { ++ if(pStackInfo->bHidExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); ++ algorithm = BT_8188C_2ANT_COEX_ALGO_HID; ++ } ++ else if(pStackInfo->bA2dpExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); ++ algorithm = BT_8188C_2ANT_COEX_ALGO_A2DP; ++ } ++ else if(pStackInfo->bPanExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN only\n")); ++ algorithm = BT_8188C_2ANT_COEX_ALGO_PAN; ++ } ++ } ++ else ++ { ++ if( pStackInfo->bHidExist && ++ pStackInfo->bA2dpExist ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); ++ algorithm = BT_8188C_2ANT_COEX_ALGO_HID_A2DP; ++ } ++ else if( pStackInfo->bHidExist && ++ pStackInfo->bPanExist ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN\n")); ++ algorithm = BT_8188C_2ANT_COEX_ALGO_HID_PAN; ++ } ++ else if( pStackInfo->bPanExist && ++ pStackInfo->bA2dpExist ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN + A2DP\n")); ++ algorithm = BT_8188C_2ANT_COEX_ALGO_PAN_A2DP; ++ } ++ } ++ } ++ return algorithm; ++} ++ ++VOID ++halbtc8188c2ant_SetFwBalance( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bBalanceOn, ++ IN u1Byte ms0, ++ IN u1Byte ms1 ++ ) ++{ ++ u1Byte H2C_Parameter[3] ={0}; ++ ++ if(bBalanceOn) ++ { ++ H2C_Parameter[2] = 1; ++ H2C_Parameter[1] = ms1; ++ H2C_Parameter[0] = ms0; ++ } ++ else ++ { ++ H2C_Parameter[2] = 0; ++ H2C_Parameter[1] = 0; ++ H2C_Parameter[0] = 0; ++ } ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Balance=[%s:%dms:%dms], write 0xc=0x%x\n", ++ bBalanceOn?"ON":"OFF", ms0, ms1, ++ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); ++ ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0xc, 3, H2C_Parameter); ++} ++ ++VOID ++halbtc8188c2ant_Balance( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bBalanceOn, ++ IN u1Byte ms0, ++ IN u1Byte ms1 ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Balance %s\n", ++ (bForceExec? "force to":""), (bBalanceOn? "ON":"OFF"))); ++ pCoexDm->bCurBalanceOn = bBalanceOn; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreBalanceOn == pCoexDm->bCurBalanceOn) ++ return; ++ } ++ halbtc8188c2ant_SetFwBalance(pBtCoexist, bBalanceOn, ms0, ms1); ++ ++ pCoexDm->bPreBalanceOn = pCoexDm->bCurBalanceOn; ++} ++ ++VOID ++halbtc8188c2ant_SetFwDiminishWifi( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bDacOn, ++ IN BOOLEAN bInterruptOn, ++ IN u1Byte fwDacSwingLvl, ++ IN BOOLEAN bNavOn ++ ) ++{ ++ u1Byte H2C_Parameter[3] ={0}; ++ ++ if((pBtCoexist->stackInfo.minBtRssi <= -5) && (fwDacSwingLvl == 0x20)) ++ { ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], DiminishWiFi 0x20 original, but set 0x18 for Low RSSI!\n")); ++ fwDacSwingLvl = 0x18; ++ } ++ ++ H2C_Parameter[2] = 0; ++ H2C_Parameter[1] = fwDacSwingLvl; ++ H2C_Parameter[0] = 0; ++ if(bDacOn) ++ { ++ H2C_Parameter[2] |= 0x01; //BIT0 ++ if(bInterruptOn) ++ { ++ H2C_Parameter[2] |= 0x02; //BIT1 ++ } ++ } ++ if(bNavOn) ++ { ++ H2C_Parameter[2] |= 0x08; //BIT3 ++ } ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bDacOn=%s, bInterruptOn=%s, bNavOn=%s, write 0xe=0x%x\n", ++ (bDacOn?"ON":"OFF"), (bInterruptOn?"ON":"OFF"), (bNavOn?"ON":"OFF"), ++ (H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2]))); ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0xe, 3, H2C_Parameter); ++} ++ ++VOID ++halbtc8188c2ant_DiminishWifi( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bDacOn, ++ IN BOOLEAN bInterruptOn, ++ IN u1Byte fwDacSwingLvl, ++ IN BOOLEAN bNavOn ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set Diminish Wifi, bDacOn=%s, bInterruptOn=%s, fwDacSwingLvl=%d, bNavOn=%s\n", ++ (bForceExec? "force to":""), (bDacOn? "ON":"OFF"), (bInterruptOn? "ON":"OFF"), fwDacSwingLvl, (bNavOn? "ON":"OFF"))); ++ ++ pCoexDm->bCurDacOn = bDacOn; ++ pCoexDm->bCurInterruptOn = bInterruptOn; ++ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; ++ pCoexDm->bCurNavOn = bNavOn; ++ ++ if(!bForceExec) ++ { ++ if( (pCoexDm->bPreDacOn==pCoexDm->bCurDacOn) && ++ (pCoexDm->bPreInterruptOn==pCoexDm->bCurInterruptOn) && ++ (pCoexDm->preFwDacSwingLvl==pCoexDm->curFwDacSwingLvl) && ++ (pCoexDm->bPreNavOn==pCoexDm->bCurNavOn) ) ++ return; ++ } ++ halbtc8188c2ant_SetFwDiminishWifi(pBtCoexist, bDacOn, bInterruptOn, fwDacSwingLvl, bNavOn); ++ ++ pCoexDm->bPreDacOn = pCoexDm->bCurDacOn; ++ pCoexDm->bPreInterruptOn = pCoexDm->bCurInterruptOn; ++ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; ++ pCoexDm->bPreNavOn = pCoexDm->bCurNavOn; ++} ++ ++VOID ++halbtc8188c2ant_SetSwRfRxLpfCorner( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bRxRfShrinkOn ++ ) ++{ ++ if(bRxRfShrinkOn) ++ { ++ //Shrink RF Rx LPF corner ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xf0, 0xf); ++ } ++ else ++ { ++ //Resume RF Rx LPF corner ++ // After initialized, we can use pCoexDm->btRf0x1eBackup ++ if(pBtCoexist->bInitilized) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xf0, pCoexDm->btRf0x1eBackup); ++ } ++ } ++} ++ ++VOID ++halbtc8188c2ant_RfShrink( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bRxRfShrinkOn ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", ++ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); ++ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) ++ return; ++ } ++ halbtc8188c2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); ++ ++ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; ++} ++ ++VOID ++halbtc8188c2ant_SetSwPenaltyTxRateAdaptive( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bLowPenaltyRa ++ ) ++{ ++ u1Byte tmpU1; ++ ++ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); ++ if(bLowPenaltyRa) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); ++ tmpU1 &= ~BIT2; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); ++ tmpU1 |= BIT2; ++ } ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); ++} ++ ++VOID ++halbtc8188c2ant_LowPenaltyRa( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bLowPenaltyRa ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", ++ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); ++ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) ++ return; ++ } ++ halbtc8188c2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); ++ ++ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; ++} ++ ++VOID ++halbtc8188c2ant_SetSwFullTimeDacSwing( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bSwDacSwingOn, ++ IN u4Byte swDacSwingLvl ++ ) ++{ ++ u4Byte dacSwingLvl; ++ ++ if(bSwDacSwingOn) ++ { ++ if((pBtCoexist->stackInfo.minBtRssi <= -5) && (swDacSwingLvl == 0x20)) ++ { ++ dacSwingLvl = 0x18; ++ } ++ else ++ { ++ dacSwingLvl = swDacSwingLvl; ++ } ++ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, dacSwingLvl); ++ } ++ else ++ { ++ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, 0x30); ++ } ++} ++ ++VOID ++halbtc8188c2ant_DacSwing( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bDacSwingOn, ++ IN u4Byte dacSwingLvl ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", ++ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); ++ pCoexDm->bCurDacSwingOn = bDacSwingOn; ++ pCoexDm->curDacSwingLvl = dacSwingLvl; ++ ++ if(!bForceExec) ++ { ++ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && ++ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) ++ return; ++ } ++ delay_ms(30); ++ halbtc8188c2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); ++ ++ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; ++ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; ++} ++ ++VOID ++halbtc8188c2ant_SetAdcBackOff( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bAdcBackOff ++ ) ++{ ++ if(bAdcBackOff) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a07611); ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a05611); ++ } ++} ++ ++VOID ++halbtc8188c2ant_AdcBackOff( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bAdcBackOff ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", ++ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); ++ pCoexDm->bCurAdcBackOff = bAdcBackOff; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) ++ return; ++ } ++ halbtc8188c2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); ++ ++ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; ++} ++ ++VOID ++halbtc8188c2ant_SetAgcTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bAgcTableEn ++ ) ++{ ++ u1Byte rssiAdjustVal=0; ++ ++ if(bAgcTableEn) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4e1c0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4d1d0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4c1e0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4b1f0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4a200001); ++ ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xdc000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x90000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x51000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x12000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x00255); ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x641c0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x631d0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x621e0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x611f0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x60200001); ++ ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x32000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x71000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xb0000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xfc000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x10255); ++ } ++ ++ // set rssiAdjustVal for wifi module. ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); ++} ++ ++ ++VOID ++halbtc8188c2ant_AgcTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bAgcTableEn ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", ++ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); ++ pCoexDm->bCurAgcTableEn = bAgcTableEn; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) ++ return; ++ } ++ halbtc8188c2ant_SetAgcTable(pBtCoexist, bAgcTableEn); ++ ++ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; ++} ++ ++VOID ++halbtc8188c2ant_SetCoexTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u4Byte val0x6c4, ++ IN u4Byte val0x6c8, ++ IN u4Byte val0x6cc ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6cc, val0x6cc); ++} ++ ++VOID ++halbtc8188c2ant_CoexTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN u4Byte val0x6c4, ++ IN u4Byte val0x6c8, ++ IN u4Byte val0x6cc ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", ++ (bForceExec? "force to":""), val0x6c4, val0x6c8, val0x6cc)); ++ pCoexDm->curVal0x6c4 = val0x6c4; ++ pCoexDm->curVal0x6c8 = val0x6c8; ++ pCoexDm->curVal0x6cc = val0x6cc; ++ ++ if(!bForceExec) ++ { ++ if( (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && ++ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && ++ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) ++ return; ++ } ++ halbtc8188c2ant_SetCoexTable(pBtCoexist, val0x6c4, val0x6c8, val0x6cc); ++ ++ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; ++ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; ++ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; ++} ++ ++VOID ++halbtc8188c2ant_CoexAllOff( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ // fw mechanism ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++} ++VOID ++halbtc8188c2ant_InitCoexDm( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++} ++ ++ ++VOID ++halbtc8188c2ant_MonitorBtState( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN stateChange=FALSE; ++ u4Byte BT_Polling, Ratio_Act, Ratio_STA; ++ u4Byte BT_Active, BT_State; ++ u4Byte regBTActive=0, regBTState=0, regBTPolling=0; ++ u4Byte btBusyThresh=0; ++ u4Byte fwVer=0; ++ static BOOLEAN bBtBusyTraffic=FALSE; ++ BOOLEAN bRejApAggPkt=FALSE; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FirmwareVersion = 0x%x(%d)\n", fwVer, fwVer)); ++ if(fwVer < 62) ++ { ++ regBTActive = 0x488; ++ regBTState = 0x48c; ++ regBTPolling = 0x490; ++ } ++ else ++ { ++ regBTActive = 0x444; ++ regBTState = 0x448; ++ if(fwVer >= 74) ++ regBTPolling = 0x44c; ++ else ++ regBTPolling = 0x700; ++ } ++ btBusyThresh = 60; ++ ++ BT_Active = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTActive); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Active(0x%x)=0x%x\n", regBTActive, BT_Active)); ++ BT_Active = BT_Active & 0x00ffffff; ++ ++ BT_State = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTState); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_State(0x%x)=0x%x\n", regBTState, BT_State)); ++ BT_State = BT_State & 0x00ffffff; ++ ++ BT_Polling = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTPolling); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Polling(0x%x)=0x%x\n", regBTPolling, BT_Polling)); ++ ++ if(BT_Active==0xffffffff && BT_State==0xffffffff && BT_Polling==0xffffffff ) ++ return; ++ ++ // 2011/05/04 MH For Slim combo test meet a problem. Surprise remove and WLAN is running ++ // DHCP process. At the same time, the register read value might be zero. And cause BSOD 0x7f ++ // EXCEPTION_DIVIDED_BY_ZERO. In This case, the stack content may always be wrong due to ++ // HW divide trap. ++ if (BT_Polling==0) ++ return; ++ ++ Ratio_Act = BT_Active*1000/BT_Polling; ++ Ratio_STA = BT_State*1000/BT_Polling; ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_Act=%d\n", Ratio_Act)); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_STA=%d\n", Ratio_STA)); ++ ++ if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ++ { ++ if(Ratio_STA < 60) // BT PAN idle ++ { ++ } ++ else ++ { ++ // Check if BT PAN (under BT 2.1) is uplink or downlink ++ if((Ratio_Act/Ratio_STA) < 2) ++ { // BT PAN Uplink ++ pCoexSta->bBtUplink = TRUE; ++ } ++ else ++ { // BT PAN downlink ++ pCoexSta->bBtUplink = FALSE; ++ } ++ } ++ } ++ ++ // Check BT is idle or not ++ if(!pBtCoexist->stackInfo.bBtLinkExist) ++ { ++ pCoexSta->bBtBusy = FALSE; ++ } ++ else ++ { ++ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) ++ { ++ if(Ratio_Act<20) ++ { ++ pCoexSta->bBtBusy = FALSE; ++ } ++ else ++ { ++ pCoexSta->bBtBusy = TRUE; ++ } ++ } ++ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ++ { ++ if(Ratio_STA < btBusyThresh) ++ { ++ pCoexSta->bBtBusy = FALSE; ++ } ++ else ++ { ++ pCoexSta->bBtBusy = TRUE; ++ } ++ ++ if( (Ratio_STA < btBusyThresh) || ++ (Ratio_Act<180 && Ratio_STA<130) ) ++ { ++ pCoexSta->bA2dpBusy = FALSE; ++ } ++ else ++ { ++ pCoexSta->bA2dpBusy = TRUE; ++ } ++ } ++ } ++ ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &pCoexSta->bBtBusy); ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &pCoexSta->bBtBusy); ++ ++ if(bBtBusyTraffic != pCoexSta->bBtBusy) ++ { // BT idle or BT non-idle ++ bBtBusyTraffic = pCoexSta->bBtBusy; ++ stateChange = TRUE; ++ } ++ ++ if(stateChange) ++ { ++ if(!pCoexSta->bBtBusy) ++ { ++ halbtc8188c2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_CoexAllOff(pBtCoexist); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); ++ } ++ else ++ { ++ halbtc8188c2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); ++ } ++ } ++ ++ if(stateChange) ++ { ++ bRejApAggPkt = pCoexSta->bBtBusy; ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejApAggPkt); ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++ } ++} ++ ++VOID ++halbtc8188c2ant_ActionA2dpBc4( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState; ++ u4Byte wifiBw, wifiTrafficDir; ++ ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); ++ ++ if(pCoexSta->bBtBusy) ++ { ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ // fw mechanism first ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ } ++ ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); ++ } ++ else ++ { ++ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); ++ ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ } ++ ++ // sw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); ++ } ++ else ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); ++ } ++ } ++ } ++ else ++ { ++ halbtc8188c2ant_CoexAllOff(pBtCoexist); ++ } ++} ++ ++VOID ++halbtc8188c2ant_ActionA2dpBc8( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState; ++ u4Byte wifiBw, wifiTrafficDir; ++ BOOLEAN bWifiBusy=FALSE; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ if(pCoexSta->bA2dpBusy && bWifiBusy) ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); ++ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); ++ ++ // fw mechanism first ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x18); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ ++ // sw mechanism ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ } ++ else if(pCoexSta->bA2dpBusy) ++ { ++ // fw mechanism first ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, TRUE, 0x18, FALSE); ++ ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8188c2ant_CoexAllOff(pBtCoexist); ++ } ++} ++ ++VOID ++halbtc8188c2ant_ActionA2dp( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8188c2ant_ActionA2dpBc4(pBtCoexist); ++ } ++ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8188c2ant_ActionA2dpBc8(pBtCoexist); ++ } ++} ++ ++VOID ++halbtc8188c2ant_ActionPanBc4( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); ++ if(bBtHsOn) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ } ++ else ++ { ++ if(pCoexSta->bBtBusy && bWifiBusy) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ else ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ } ++ } ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++} ++ ++VOID ++halbtc8188c2ant_ActionPanBc8( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; ++ u1Byte wifiRssiState; ++ u4Byte wifiBw, wifiTrafficDir; ++ s4Byte wifiRssi; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); ++ ++ if(bBtHsOn) ++ { ++ halbtc8188c2ant_CoexAllOff(pBtCoexist); ++ } ++ else ++ { ++ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 3, 25, 50); ++ ++ if(pCoexSta->bBtBusy && bWifiBusy) ++ { ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ // fw mechanism first ++ if(pCoexSta->bBtUplink) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ else ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ } ++ // sw mechanism ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ } ++ else ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ } ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ if(pCoexSta->bBtUplink) ++ { ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); ++ } ++ } ++ else if( (wifiRssiState == BTC_RSSI_STATE_MEDIUM) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_MEDIUM) ) ++ { ++ // fw mechanism first ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); ++ ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); ++ else ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ // sw mechanism ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ } ++ else ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ } ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ // fw mechanism first ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); ++ ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ if(pCoexSta->bBtUplink) ++ { ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); ++ } ++ else ++ { ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ } ++ else ++ { ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ } ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ else if(pCoexSta->bBtBusy && !bWifiBusy && (wifiRssi < 30)) ++ { ++ // fw mechanism first ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x0a, 0x20); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8188c2ant_CoexAllOff(pBtCoexist); ++ } ++ } ++} ++ ++VOID ++halbtc8188c2ant_ActionPan( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8188c2ant_ActionPanBc4(pBtCoexist); ++ } ++ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8188c2ant_ActionPanBc8(pBtCoexist); ++ } ++} ++ ++VOID ++halbtc8188c2ant_ActionHid( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u4Byte wifiBw, wifiTrafficDir; ++ BOOLEAN bWifiBusy=FALSE; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); ++ if(BTC_WIFI_BW_LEGACY == wifiBw) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ ++ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); ++ } ++ else if(!bWifiBusy) ++ { ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ } ++ else if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ ++ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ } ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++} ++ ++ ++VOID ++halbtc8188c2ant_ActionSco( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState; ++ u4Byte wifiBw; ++ ++ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) ++ { ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); ++ ++ // fw mechanism ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ // fw mechanism first ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); ++ // fw mechanism first ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ } ++} ++ ++VOID ++halbtc8188c2ant_ActionHidA2dpBc4( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState; ++ u4Byte wifiBw, wifiTrafficDir; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); ++ ++ if(pCoexSta->bBtBusy) ++ { ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ // fw mechanism first ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x7, 0x20); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ } ++ ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); ++ } ++ else ++ { ++ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); ++ // fw mechanism first ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x7, 0x20); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ } ++ ++ // sw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); ++ } ++ else ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); ++ } ++ } ++ } ++ else ++ { ++ halbtc8188c2ant_CoexAllOff(pBtCoexist); ++ } ++} ++VOID ++halbtc8188c2ant_ActionHidA2dpBc8( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState; ++ u4Byte wifiBw; ++ ++ if(pCoexSta->bBtBusy) ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ // fw mechanism first ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); ++ } ++ else ++ { ++ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); ++ // fw mechanism ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); ++ } ++ else ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); ++ } ++ } ++ } ++ else ++ { ++ halbtc8188c2ant_CoexAllOff(pBtCoexist); ++ } ++} ++ ++VOID ++halbtc8188c2ant_ActionHidA2dp( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8188c2ant_ActionHidA2dpBc4(pBtCoexist); ++ } ++ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8188c2ant_ActionHidA2dpBc8(pBtCoexist); ++ } ++} ++ ++VOID ++halbtc8188c2ant_ActionHidPanBc4( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; ++ u4Byte wifiBw, wifiTrafficDir; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ ++ if(bBtHsOn) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ ++ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); ++ } ++ else ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); ++ if(BTC_WIFI_BW_LEGACY == wifiBw) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ ++ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); ++ } ++ else if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ ++ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ else if(!bWifiBusy) ++ { ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ } ++ } ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++} ++VOID ++halbtc8188c2ant_ActionHidPanBc8( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; ++ u1Byte wifiRssiState; ++ u4Byte wifiBw, wifiTrafficDir; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ ++ if(!bBtHsOn) ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); ++ if((pCoexSta->bBtBusy && bWifiBusy)) ++ { ++ // fw mechanism first ++ if(pCoexSta->bBtUplink) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); ++ } ++ else ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); ++ } ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ ++ // sw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ else ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ else ++ { ++ halbtc8188c2ant_CoexAllOff(pBtCoexist); ++ } ++ } ++ else ++ { ++ if(BTC_INTF_USB == pBtCoexist->chipInterface) ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ ++ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); ++ } ++ } ++ else ++ { ++ if(pCoexSta->bBtBusy) ++ { ++ // fw mechanism ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); ++ } ++ else ++ { ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ } ++} ++ ++VOID ++halbtc8188c2ant_ActionHidPan( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8188c2ant_ActionHidPanBc4(pBtCoexist); ++ } ++ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8188c2ant_ActionHidPanBc8(pBtCoexist); ++ } ++} ++ ++VOID ++halbtc8188c2ant_ActionPanA2dpBc4( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; ++ u1Byte wifiRssiState; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); ++ if(bBtHsOn) ++ { ++ if(pCoexSta->bBtBusy) ++ { ++ // fw mechanism ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); ++ } ++ else ++ { ++ halbtc8188c2ant_CoexAllOff(pBtCoexist); ++ } ++ } ++ else ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ if(pCoexSta->bBtBusy && bWifiBusy) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ else ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ } ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++} ++VOID ++halbtc8188c2ant_ActionPanA2dpBc8( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; ++ u1Byte wifiRssiState; ++ u4Byte wifiBw; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ ++ if(!bBtHsOn) ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); ++ if((pCoexSta->bBtBusy && bWifiBusy)) ++ { ++ // fw mechanism first ++ if(pCoexSta->bBtUplink) ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); ++ } ++ else ++ { ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); ++ } ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ ++ // sw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ else ++ { ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ else ++ { ++ halbtc8188c2ant_CoexAllOff(pBtCoexist); ++ } ++ } ++ else ++ { ++ if(pCoexSta->bBtBusy) ++ { ++ // fw mechanism ++ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); ++ } ++ else ++ { ++ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++} ++ ++VOID ++halbtc8188c2ant_ActionPanA2dp( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8188c2ant_ActionPanA2dpBc4(pBtCoexist); ++ } ++ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8188c2ant_ActionPanA2dpBc8(pBtCoexist); ++ } ++} ++ ++//============================================================ ++// extern function start with EXhalbtc8188c2ant_ ++//============================================================ ++VOID ++EXhalbtc8188c2ant_PowerOnSetting( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++} ++ ++VOID ++EXhalbtc8188c2ant_InitHwConfig( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bWifiOnly ++ ) ++{ ++ u1Byte u1Tmp=0; ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); ++ ++ // backup rf 0x1e value ++ pCoexDm->btRf0x1eBackup = ++ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xf0); ++ ++ if( (BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) || ++ (BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ) ++ { ++ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd) & BIT0; ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, u1Tmp); ++ ++ halbtc8188c2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0xaaaa9aaa, 0xffbd0040, 0x40000010); ++ } ++} ++ ++VOID ++EXhalbtc8188c2ant_InitCoexDm( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); ++ ++ halbtc8188c2ant_InitCoexDm(pBtCoexist); ++} ++ ++VOID ++EXhalbtc8188c2ant_DisplayCoexInfo( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; ++ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; ++ pu1Byte cliBuf=pBtCoexist->cliBuf; ++ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; ++ u4Byte u4Tmp[4]; ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ ++ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); ++ CL_PRINTF(cliBuf); ++ ++ if(pBtCoexist->bManualControl) ++ { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); ++ CL_PRINTF(cliBuf); ++ } ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ ++ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); ++ CL_PRINTF(cliBuf); ++ ++ // wifi status ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); ++ CL_PRINTF(cliBuf); ++ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); ++ CL_PRINTF(cliBuf); ++ ++ if(pStackInfo->bProfileNotified) ++ { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ ++ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); ++ CL_PRINTF(cliBuf); ++ ++ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); ++ } ++ ++ // Sw mechanism ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); ++ CL_PRINTF(cliBuf); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ ++ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); ++ CL_PRINTF(cliBuf); ++ ++ // Fw mechanism ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); ++ CL_PRINTF(cliBuf); ++ ++ // Hw setting ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ ++ pCoexDm->btRf0x1eBackup); ++ CL_PRINTF(cliBuf); ++ ++ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ ++ u1Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ ++ u4Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); ++ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); ++ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c4/0x6c8/0x6cc(coexTable)", \ ++ u4Tmp[0], u4Tmp[1], u4Tmp[2]); ++ CL_PRINTF(cliBuf); ++ ++ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++VOID ++EXhalbtc8188c2ant_IpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_IPS_ENTER == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); ++ halbtc8188c2ant_CoexAllOff(pBtCoexist); ++ } ++ else if(BTC_IPS_LEAVE == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); ++ //halbtc8188c2ant_InitCoexDm(pBtCoexist); ++ } ++} ++ ++VOID ++EXhalbtc8188c2ant_LpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_LPS_ENABLE == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); ++ halbtc8188c2ant_CoexAllOff(pBtCoexist); ++ } ++ else if(BTC_LPS_DISABLE == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); ++ halbtc8188c2ant_InitCoexDm(pBtCoexist); ++ } ++} ++ ++VOID ++EXhalbtc8188c2ant_ScanNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_SCAN_START == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); ++ } ++ else if(BTC_SCAN_FINISH == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); ++ } ++} ++ ++VOID ++EXhalbtc8188c2ant_ConnectNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_ASSOCIATE_START == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); ++ } ++ else if(BTC_ASSOCIATE_FINISH == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); ++ } ++} ++ ++VOID ++EXhalbtc8188c2ant_MediaStatusNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_MEDIA_CONNECT == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); ++ } ++ ++} ++ ++VOID ++EXhalbtc8188c2ant_SpecialPacketNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(type == BTC_PACKET_DHCP) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); ++ } ++} ++ ++VOID ++EXhalbtc8188c2ant_BtInfoNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN pu1Byte tmpBuf, ++ IN u1Byte length ++ ) ++{ ++} ++ ++VOID ++EXhalbtc8188c2ant_HaltNotify( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); ++ ++ EXhalbtc8188c2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); ++} ++ ++VOID ++EXhalbtc8188c2ant_Periodical( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte algorithm; ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Periodical!!\n")); ++ ++ // NOTE: ++ // sw mechanism must be done after fw mechanism ++ // ++ ++ if((BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) || ++ (BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ) ++ { ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_GET_BT_RSSI, NULL); ++ ++ halbtc8188c2ant_MonitorBtState(pBtCoexist); ++ algorithm = halbtc8188c2ant_ActionAlgorithm(pBtCoexist); ++ pCoexDm->curAlgorithm = algorithm; ++ switch(pCoexDm->curAlgorithm) ++ { ++ case BT_8188C_2ANT_COEX_ALGO_SCO: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO\n")); ++ halbtc8188c2ant_ActionSco(pBtCoexist); ++ break; ++ case BT_8188C_2ANT_COEX_ALGO_HID: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID\n")); ++ halbtc8188c2ant_ActionHid(pBtCoexist); ++ break; ++ case BT_8188C_2ANT_COEX_ALGO_A2DP: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP\n")); ++ halbtc8188c2ant_ActionA2dp(pBtCoexist); ++ break; ++ case BT_8188C_2ANT_COEX_ALGO_PAN: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN\n")); ++ halbtc8188c2ant_ActionPan(pBtCoexist); ++ break; ++ case BT_8188C_2ANT_COEX_ALGO_HID_A2DP: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP\n")); ++ halbtc8188c2ant_ActionHidA2dp(pBtCoexist); ++ break; ++ case BT_8188C_2ANT_COEX_ALGO_HID_PAN: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+HID\n")); ++ halbtc8188c2ant_ActionHidPan(pBtCoexist); ++ break; ++ case BT_8188C_2ANT_COEX_ALGO_PAN_A2DP: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP\n")); ++ halbtc8188c2ant_ActionPanA2dp(pBtCoexist); ++ break; ++ default: ++ break; ++ } ++ } ++} ++ ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.h 2018-02-11 21:44:27.143146025 +0200 +@@ -0,0 +1,149 @@ ++//=========================================== ++// The following is for 8188C 2Ant BT Co-exist definition ++//=========================================== ++#define BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT 6 ++ ++typedef enum _BT_INFO_SRC_8188C_2ANT{ ++ BT_INFO_SRC_8188C_2ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8188C_2ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8188C_2ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8188C_2ANT_MAX ++}BT_INFO_SRC_8188C_2ANT,*PBT_INFO_SRC_8188C_2ANT; ++ ++typedef enum _BT_8188C_2ANT_BT_STATUS{ ++ BT_8188C_2ANT_BT_STATUS_IDLE = 0x0, ++ BT_8188C_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8188C_2ANT_BT_STATUS_NON_IDLE = 0x2, ++ BT_8188C_2ANT_BT_STATUS_MAX ++}BT_8188C_2ANT_BT_STATUS,*PBT_8188C_2ANT_BT_STATUS; ++ ++typedef enum _BT_8188C_2ANT_COEX_ALGO{ ++ BT_8188C_2ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8188C_2ANT_COEX_ALGO_SCO = 0x1, ++ BT_8188C_2ANT_COEX_ALGO_HID = 0x2, ++ BT_8188C_2ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8188C_2ANT_COEX_ALGO_PAN = 0x4, ++ BT_8188C_2ANT_COEX_ALGO_HID_A2DP = 0x5, ++ BT_8188C_2ANT_COEX_ALGO_HID_PAN = 0x6, ++ BT_8188C_2ANT_COEX_ALGO_PAN_A2DP = 0x7, ++ BT_8188C_2ANT_COEX_ALGO_MAX ++}BT_8188C_2ANT_COEX_ALGO,*PBT_8188C_2ANT_COEX_ALGO; ++ ++typedef struct _COEX_DM_8188C_2ANT{ ++ // fw mechanism ++ BOOLEAN bPreBalanceOn; ++ BOOLEAN bCurBalanceOn; ++ ++ // diminishWifi ++ BOOLEAN bPreDacOn; ++ BOOLEAN bCurDacOn; ++ BOOLEAN bPreInterruptOn; ++ BOOLEAN bCurInterruptOn; ++ u1Byte preFwDacSwingLvl; ++ u1Byte curFwDacSwingLvl; ++ BOOLEAN bPreNavOn; ++ BOOLEAN bCurNavOn; ++ ++ // sw mechanism ++ BOOLEAN bPreRfRxLpfShrink; ++ BOOLEAN bCurRfRxLpfShrink; ++ u4Byte btRf0x1eBackup; ++ BOOLEAN bPreLowPenaltyRa; ++ BOOLEAN bCurLowPenaltyRa; ++ BOOLEAN bPreDacSwingOn; ++ u4Byte preDacSwingLvl; ++ BOOLEAN bCurDacSwingOn; ++ u4Byte curDacSwingLvl; ++ BOOLEAN bPreAdcBackOff; ++ BOOLEAN bCurAdcBackOff; ++ BOOLEAN bPreAgcTableEn; ++ BOOLEAN bCurAgcTableEn; ++ //u4Byte preVal0x6c0; ++ //u4Byte curVal0x6c0; ++ u4Byte preVal0x6c4; ++ u4Byte curVal0x6c4; ++ u4Byte preVal0x6c8; ++ u4Byte curVal0x6c8; ++ u4Byte preVal0x6cc; ++ u4Byte curVal0x6cc; ++ //BOOLEAN bLimitedDig; ++ ++ // algorithm related ++ u1Byte preAlgorithm; ++ u1Byte curAlgorithm; ++ //u1Byte btStatus; ++ //u1Byte wifiChnlInfo[3]; ++} COEX_DM_8188C_2ANT, *PCOEX_DM_8188C_2ANT; ++ ++typedef struct _COEX_STA_8188C_2ANT{ ++ u1Byte preWifiRssiState[4]; ++ BOOLEAN bBtBusy; ++ BOOLEAN bBtUplink; ++ BOOLEAN bBtDownLink; ++ BOOLEAN bA2dpBusy; ++}COEX_STA_8188C_2ANT, *PCOEX_STA_8188C_2ANT; ++ ++//=========================================== ++// The following is interface which will notify coex module. ++//=========================================== ++VOID ++EXhalbtc8188c2ant_PowerOnSetting( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8188c2ant_InitHwConfig( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bWifiOnly ++ ); ++VOID ++EXhalbtc8188c2ant_InitCoexDm( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8188c2ant_IpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8188c2ant_LpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8188c2ant_ScanNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8188c2ant_ConnectNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8188c2ant_MediaStatusNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8188c2ant_SpecialPacketNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8188c2ant_HaltNotify( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8188c2ant_Periodical( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8188c2ant_BtInfoNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN pu1Byte tmpBuf, ++ IN u1Byte length ++ ); ++VOID ++EXhalbtc8188c2ant_DisplayCoexInfo( ++ IN PBTC_COEXIST pBtCoexist ++ ); +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.c 2018-02-11 21:44:27.143146025 +0200 +@@ -0,0 +1,1992 @@ ++//============================================================ ++// Description: ++// ++// This file is for 92D BT 2 Antenna Co-exist mechanism ++// ++// By cosa 02/11/2011 ++// ++//============================================================ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "Mp_Precomp.h" ++ ++#if WPP_SOFTWARE_TRACE ++#include "HalBtc8192d2Ant.tmh" ++#endif ++ ++#if(BT_30_SUPPORT == 1) ++//============================================================ ++// Global variables, these are static variables ++//============================================================ ++static COEX_DM_8192D_2ANT GLCoexDm8192d2Ant; ++static PCOEX_DM_8192D_2ANT pCoexDm=&GLCoexDm8192d2Ant; ++static COEX_STA_8192D_2ANT GLCoexSta8192d2Ant; ++static PCOEX_STA_8192D_2ANT pCoexSta=&GLCoexSta8192d2Ant; ++ ++//============================================================ ++// local function start with btdm_ ++//============================================================ ++u1Byte ++halbtc8192d2ant_WifiRssiState( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte index, ++ IN u1Byte levelNum, ++ IN u1Byte rssiThresh, ++ IN u1Byte rssiThresh1 ++ ) ++{ ++ s4Byte wifiRssi=0; ++ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); ++ ++ if(levelNum == 2) ++ { ++ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || ++ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) ++ { ++ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT)) ++ { ++ wifiRssiState = BTC_RSSI_STATE_HIGH; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; ++ } ++ } ++ else ++ { ++ if(wifiRssi < rssiThresh) ++ { ++ wifiRssiState = BTC_RSSI_STATE_LOW; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ } ++ else if(levelNum == 3) ++ { ++ if(rssiThresh > rssiThresh1) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); ++ return pCoexSta->preWifiRssiState[index]; ++ } ++ ++ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || ++ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) ++ { ++ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT)) ++ { ++ wifiRssiState = BTC_RSSI_STATE_MEDIUM; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; ++ } ++ } ++ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || ++ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) ++ { ++ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT)) ++ { ++ wifiRssiState = BTC_RSSI_STATE_HIGH; ++ } ++ else if(wifiRssi < rssiThresh) ++ { ++ wifiRssiState = BTC_RSSI_STATE_LOW; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; ++ } ++ } ++ else ++ { ++ if(wifiRssi < rssiThresh1) ++ { ++ wifiRssiState = BTC_RSSI_STATE_MEDIUM; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ } ++ ++ pCoexSta->preWifiRssiState[index] = wifiRssiState; ++ ++ return wifiRssiState; ++} ++ ++u1Byte ++halbtc8192d2ant_ActionAlgorithm( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; ++ BOOLEAN bBtHsOn=FALSE; ++ u1Byte algorithm=BT_8192D_2ANT_COEX_ALGO_UNDEFINED; ++ u1Byte numOfDiffProfile=0; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ ++ if(!pStackInfo->bBtLinkExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No profile exists!!!\n")); ++ return algorithm; ++ } ++ ++ if(pStackInfo->bScoExist) ++ numOfDiffProfile++; ++ if(pStackInfo->bHidExist) ++ numOfDiffProfile++; ++ if(pStackInfo->bPanExist) ++ numOfDiffProfile++; ++ if(pStackInfo->bA2dpExist) ++ numOfDiffProfile++; ++ ++ if(pStackInfo->bScoExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO algorithm\n")); ++ algorithm = BT_8192D_2ANT_COEX_ALGO_SCO; ++ } ++ else ++ { ++ if(numOfDiffProfile == 1) ++ { ++ if(pStackInfo->bHidExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); ++ algorithm = BT_8192D_2ANT_COEX_ALGO_HID; ++ } ++ else if(pStackInfo->bA2dpExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); ++ algorithm = BT_8192D_2ANT_COEX_ALGO_A2DP; ++ } ++ else if(pStackInfo->bPanExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN only\n")); ++ algorithm = BT_8192D_2ANT_COEX_ALGO_PAN; ++ } ++ } ++ else ++ { ++ if( pStackInfo->bHidExist && ++ pStackInfo->bA2dpExist ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); ++ algorithm = BT_8192D_2ANT_COEX_ALGO_HID_A2DP; ++ } ++ else if( pStackInfo->bHidExist && ++ pStackInfo->bPanExist ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN\n")); ++ algorithm = BT_8192D_2ANT_COEX_ALGO_HID_PAN; ++ } ++ else if( pStackInfo->bPanExist && ++ pStackInfo->bA2dpExist ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN + A2DP\n")); ++ algorithm = BT_8192D_2ANT_COEX_ALGO_PAN_A2DP; ++ } ++ } ++ } ++ return algorithm; ++} ++ ++VOID ++halbtc8192d2ant_SetFwBalance( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bBalanceOn, ++ IN u1Byte ms0, ++ IN u1Byte ms1 ++ ) ++{ ++ u1Byte H2C_Parameter[3] ={0}; ++ ++ if(bBalanceOn) ++ { ++ H2C_Parameter[2] = 1; ++ H2C_Parameter[1] = ms1; ++ H2C_Parameter[0] = ms0; ++ } ++ else ++ { ++ H2C_Parameter[2] = 0; ++ H2C_Parameter[1] = 0; ++ H2C_Parameter[0] = 0; ++ } ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Balance=[%s:%dms:%dms], write 0xc=0x%x\n", ++ bBalanceOn?"ON":"OFF", ms0, ms1, ++ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); ++ ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0xc, 3, H2C_Parameter); ++} ++ ++VOID ++halbtc8192d2ant_Balance( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bBalanceOn, ++ IN u1Byte ms0, ++ IN u1Byte ms1 ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Balance %s\n", ++ (bForceExec? "force to":""), (bBalanceOn? "ON":"OFF"))); ++ pCoexDm->bCurBalanceOn = bBalanceOn; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreBalanceOn == pCoexDm->bCurBalanceOn) ++ return; ++ } ++ halbtc8192d2ant_SetFwBalance(pBtCoexist, bBalanceOn, ms0, ms1); ++ ++ pCoexDm->bPreBalanceOn = pCoexDm->bCurBalanceOn; ++} ++ ++VOID ++halbtc8192d2ant_SetFwDiminishWifi( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bDacOn, ++ IN BOOLEAN bInterruptOn, ++ IN u1Byte fwDacSwingLvl, ++ IN BOOLEAN bNavOn ++ ) ++{ ++ u1Byte H2C_Parameter[3] ={0}; ++ ++ if((pBtCoexist->stackInfo.minBtRssi <= -5) && (fwDacSwingLvl == 0x20)) ++ { ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], DiminishWiFi 0x20 original, but set 0x18 for Low RSSI!\n")); ++ fwDacSwingLvl = 0x18; ++ } ++ ++ H2C_Parameter[2] = 0; ++ H2C_Parameter[1] = fwDacSwingLvl; ++ H2C_Parameter[0] = 0; ++ if(bDacOn) ++ { ++ H2C_Parameter[2] |= 0x01; //BIT0 ++ if(bInterruptOn) ++ { ++ H2C_Parameter[2] |= 0x02; //BIT1 ++ } ++ } ++ if(bNavOn) ++ { ++ H2C_Parameter[2] |= 0x08; //BIT3 ++ } ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bDacOn=%s, bInterruptOn=%s, bNavOn=%s, write 0x12=0x%x\n", ++ (bDacOn?"ON":"OFF"), (bInterruptOn?"ON":"OFF"), (bNavOn?"ON":"OFF"), ++ (H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2]))); ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x12, 3, H2C_Parameter); ++} ++ ++ ++VOID ++halbtc8192d2ant_DiminishWifi( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bDacOn, ++ IN BOOLEAN bInterruptOn, ++ IN u1Byte fwDacSwingLvl, ++ IN BOOLEAN bNavOn ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set Diminish Wifi, bDacOn=%s, bInterruptOn=%s, fwDacSwingLvl=%d, bNavOn=%s\n", ++ (bForceExec? "force to":""), (bDacOn? "ON":"OFF"), (bInterruptOn? "ON":"OFF"), fwDacSwingLvl, (bNavOn? "ON":"OFF"))); ++ ++ pCoexDm->bCurDacOn = bDacOn; ++ pCoexDm->bCurInterruptOn = bInterruptOn; ++ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; ++ pCoexDm->bCurNavOn = bNavOn; ++ ++ if(!bForceExec) ++ { ++ if( (pCoexDm->bPreDacOn==pCoexDm->bCurDacOn) && ++ (pCoexDm->bPreInterruptOn==pCoexDm->bCurInterruptOn) && ++ (pCoexDm->preFwDacSwingLvl==pCoexDm->curFwDacSwingLvl) && ++ (pCoexDm->bPreNavOn==pCoexDm->bCurNavOn) ) ++ return; ++ } ++ halbtc8192d2ant_SetFwDiminishWifi(pBtCoexist, bDacOn, bInterruptOn, fwDacSwingLvl, bNavOn); ++ ++ pCoexDm->bPreDacOn = pCoexDm->bCurDacOn; ++ pCoexDm->bPreInterruptOn = pCoexDm->bCurInterruptOn; ++ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; ++ pCoexDm->bPreNavOn = pCoexDm->bCurNavOn; ++} ++ ++VOID ++halbtc8192d2ant_SetSwRfRxLpfCorner( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bRxRfShrinkOn ++ ) ++{ ++ if(bRxRfShrinkOn) ++ { ++ //Shrink RF Rx LPF corner ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xf2ff7); ++ } ++ else ++ { ++ //Resume RF Rx LPF corner ++ // After initialized, we can use pCoexDm->btRf0x1eBackup ++ if(pBtCoexist->bInitilized) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); ++ } ++ } ++} ++ ++ ++VOID ++halbtc8192d2ant_RfShrink( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bRxRfShrinkOn ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", ++ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); ++ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) ++ return; ++ } ++ halbtc8192d2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); ++ ++ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; ++} ++ ++VOID ++halbtc8192d2ant_SetSwPenaltyTxRateAdaptive( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bLowPenaltyRa ++ ) ++{ ++ u1Byte tmpU1; ++ ++ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); ++ if(bLowPenaltyRa) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); ++ tmpU1 &= ~BIT2; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); ++ tmpU1 |= BIT2; ++ } ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); ++} ++ ++VOID ++halbtc8192d2ant_LowPenaltyRa( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bLowPenaltyRa ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", ++ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); ++ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) ++ return; ++ } ++ halbtc8192d2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); ++ ++ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; ++} ++ ++VOID ++halbtc8192d2ant_SetSwFullTimeDacSwing( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bSwDacSwingOn, ++ IN u4Byte swDacSwingLvl ++ ) ++{ ++ u4Byte dacSwingLvl; ++ ++ if(bSwDacSwingOn) ++ { ++ if((pBtCoexist->stackInfo.minBtRssi <= -5) && (swDacSwingLvl == 0x20)) ++ { ++ dacSwingLvl = 0x18; ++ } ++ else ++ { ++ dacSwingLvl = swDacSwingLvl; ++ } ++ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, dacSwingLvl); ++ } ++ else ++ { ++ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, 0x30); ++ } ++} ++ ++VOID ++halbtc8192d2ant_DacSwing( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bDacSwingOn, ++ IN u4Byte dacSwingLvl ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", ++ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); ++ pCoexDm->bCurDacSwingOn = bDacSwingOn; ++ pCoexDm->curDacSwingLvl = dacSwingLvl; ++ ++ if(!bForceExec) ++ { ++ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && ++ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) ++ return; ++ } ++ delay_ms(30); ++ halbtc8192d2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); ++ ++ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; ++ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; ++} ++ ++VOID ++halbtc8192d2ant_SetAdcBackOff( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bAdcBackOff ++ ) ++{ ++ if(bAdcBackOff) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a07611); ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a05611); ++ } ++} ++ ++VOID ++halbtc8192d2ant_AdcBackOff( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bAdcBackOff ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", ++ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); ++ pCoexDm->bCurAdcBackOff = bAdcBackOff; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) ++ return; ++ } ++ halbtc8192d2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); ++ ++ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; ++} ++ ++VOID ++halbtc8192d2ant_SetAgcTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bAgcTableEn ++ ) ++{ ++ u1Byte rssiAdjustVal=0; ++ ++ if(bAgcTableEn) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0xa99); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xd4000); ++ ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b000001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b010001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b020001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b030001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b040001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b050001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b060001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b070001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b080001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b090001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b0A0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b0B0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7a0C0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x790D0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x780E0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x770F0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x76100001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x75110001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x74120001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x73130001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x72140001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x71150001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x70160001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6f170001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6e180001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6d190001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6c1A0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6b1B0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6a1C0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x691D0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4f1E0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4e1F0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4d200001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4c210001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4b220001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4a230001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x49240001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x48250001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x47260001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x46270001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x45280001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x44290001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x432A0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x422B0001); ++ ++ rssiAdjustVal = 12; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x30a99); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xdc000); ++ ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B000001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B010001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B020001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B030001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B040001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B050001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B060001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7A070001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x79080001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x78090001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x770A0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x760B0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x750C0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x740D0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x730E0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x720F0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x71100001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x70110001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6F120001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6E130001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6D140001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6C150001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6B160001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6A170001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x69180001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x68190001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x671A0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x661B0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x651C0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x641D0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x631E0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x621F0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x61200001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x60210001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x49220001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x48230001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x47240001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x46250001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x45260001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x44270001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x43280001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x42290001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x412A0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x402B0001); ++ } ++ ++ // set rssiAdjustVal for wifi module. ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); ++} ++ ++ ++ ++VOID ++halbtc8192d2ant_AgcTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bAgcTableEn ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", ++ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); ++ pCoexDm->bCurAgcTableEn = bAgcTableEn; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) ++ return; ++ } ++ halbtc8192d2ant_SetAgcTable(pBtCoexist, bAgcTableEn); ++ ++ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; ++} ++ ++VOID ++halbtc8192d2ant_SetCoexTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u4Byte val0x6c4, ++ IN u4Byte val0x6c8, ++ IN u4Byte val0x6cc ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6cc, val0x6cc); ++} ++ ++VOID ++halbtc8192d2ant_CoexTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN u4Byte val0x6c4, ++ IN u4Byte val0x6c8, ++ IN u4Byte val0x6cc ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", ++ (bForceExec? "force to":""), val0x6c4, val0x6c8, val0x6cc)); ++ pCoexDm->curVal0x6c4 = val0x6c4; ++ pCoexDm->curVal0x6c8 = val0x6c8; ++ pCoexDm->curVal0x6cc = val0x6cc; ++ ++ if(!bForceExec) ++ { ++ if( (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && ++ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && ++ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) ++ return; ++ } ++ halbtc8192d2ant_SetCoexTable(pBtCoexist, val0x6c4, val0x6c8, val0x6cc); ++ ++ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; ++ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; ++ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; ++} ++ ++VOID ++halbtc8192d2ant_CoexAllOff( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ // fw mechanism ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++} ++VOID ++halbtc8192d2ant_InitCoexDm( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++} ++ ++VOID ++halbtc8192d2ant_MonitorBtEnableDisable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u4Byte btActive ++ ) ++{ ++ static BOOLEAN bPreBtDisabled=FALSE; ++ static u4Byte btDisableCnt=0; ++ BOOLEAN bBtDisabled=FALSE, bForceToRoam=FALSE; ++ u4Byte u4Tmp=0; ++ ++ // This function check if bt is disabled ++ if(btActive) ++ { ++ btDisableCnt = 0; ++ bBtDisabled = FALSE; ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); ++ } ++ else ++ { ++ btDisableCnt++; ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", ++ btDisableCnt)); ++ if(btDisableCnt >= 2) ++ { ++ bBtDisabled = TRUE; ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); ++ } ++ } ++ if(bPreBtDisabled != bBtDisabled) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", ++ (bPreBtDisabled ? "disabled":"enabled"), ++ (bBtDisabled ? "disabled":"enabled"))); ++ ++ bForceToRoam = TRUE; ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_FORCE_TO_ROAM, &bForceToRoam); ++ ++ bPreBtDisabled = bBtDisabled; ++ } ++} ++ ++VOID ++halbtc8192d2ant_MonitorBtState( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN stateChange=FALSE; ++ u4Byte BT_Polling, Ratio_Act, Ratio_STA; ++ u4Byte BT_Active, BT_State; ++ u4Byte regBTActive=0, regBTState=0, regBTPolling=0; ++ u4Byte btBusyThresh=0; ++ u4Byte fwVer=0; ++ static BOOLEAN bBtBusyTraffic=FALSE; ++ BOOLEAN bRejApAggPkt=FALSE; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FirmwareVersion = 0x%x(%d)\n", fwVer, fwVer)); ++ ++ regBTActive = 0x444; ++ regBTState = 0x448; ++ regBTPolling = 0x44c; ++ ++ btBusyThresh = 40; ++ ++ BT_Active = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTActive); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Active(0x%x)=0x%x\n", regBTActive, BT_Active)); ++ BT_Active = BT_Active & 0x00ffffff; ++ ++ BT_State = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTState); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_State(0x%x)=0x%x\n", regBTState, BT_State)); ++ BT_State = BT_State & 0x00ffffff; ++ ++ BT_Polling = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTPolling); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Polling(0x%x)=0x%x\n", regBTPolling, BT_Polling)); ++ ++ if(BT_Active==0xffffffff && BT_State==0xffffffff && BT_Polling==0xffffffff ) ++ return; ++ ++ // 2011/05/04 MH For Slim combo test meet a problem. Surprise remove and WLAN is running ++ // DHCP process. At the same time, the register read value might be zero. And cause BSOD 0x7f ++ // EXCEPTION_DIVIDED_BY_ZERO. In This case, the stack content may always be wrong due to ++ // HW divide trap. ++ if (BT_Polling==0) ++ return; ++ ++ halbtc8192d2ant_MonitorBtEnableDisable(pBtCoexist, BT_Active); ++ ++ Ratio_Act = BT_Active*1000/BT_Polling; ++ Ratio_STA = BT_State*1000/BT_Polling; ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_Act=%d\n", Ratio_Act)); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_STA=%d\n", Ratio_STA)); ++ ++ if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ++ { ++ if(Ratio_STA < 60) // BT PAN idle ++ { ++ } ++ else ++ { ++ // Check if BT PAN (under BT 2.1) is uplink or downlink ++ if((Ratio_Act/Ratio_STA) < 2) ++ { // BT PAN Uplink ++ pCoexSta->bBtUplink = TRUE; ++ } ++ else ++ { // BT PAN downlink ++ pCoexSta->bBtUplink = FALSE; ++ } ++ } ++ } ++ ++ // Check BT is idle or not ++ if(!pBtCoexist->stackInfo.bBtLinkExist) ++ { ++ pCoexSta->bBtBusy = FALSE; ++ } ++ else ++ { ++ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) ++ { ++ if(Ratio_Act<20) ++ { ++ pCoexSta->bBtBusy = FALSE; ++ } ++ else ++ { ++ pCoexSta->bBtBusy = TRUE; ++ } ++ } ++ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ++ { ++ if(Ratio_STA < btBusyThresh) ++ { ++ pCoexSta->bBtBusy = FALSE; ++ } ++ else ++ { ++ pCoexSta->bBtBusy = TRUE; ++ } ++ ++ if( (Ratio_STA < btBusyThresh) || ++ (Ratio_Act<180 && Ratio_STA<130) ) ++ { ++ pCoexSta->bA2dpBusy = FALSE; ++ } ++ else ++ { ++ pCoexSta->bA2dpBusy = TRUE; ++ } ++ } ++ } ++ ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &pCoexSta->bBtBusy); ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &pCoexSta->bBtBusy); ++ ++ if(bBtBusyTraffic != pCoexSta->bBtBusy) ++ { // BT idle or BT non-idle ++ bBtBusyTraffic = pCoexSta->bBtBusy; ++ stateChange = TRUE; ++ } ++ ++ if(stateChange) ++ { ++ if(!pCoexSta->bBtBusy) ++ { ++ halbtc8192d2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_CoexAllOff(pBtCoexist); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); ++ } ++ else ++ { ++ halbtc8192d2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); ++ } ++ } ++ ++ if(stateChange) ++ { ++ bRejApAggPkt = pCoexSta->bBtBusy; ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejApAggPkt); ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++ } ++} ++ ++VOID ++halbtc8192d2ant_ActionA2dp( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState, wifiRssiState1=BTC_RSSI_STATE_HIGH; ++ u4Byte wifiBw, wifiTrafficDir; ++ BOOLEAN bWifiBusy=FALSE; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); ++ ++ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); ++ if(pCoexSta->bA2dpBusy && bWifiBusy) ++ { ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); ++ } ++ else ++ { ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 25, 0); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 40, 0); ++ } ++ } ++ ++ // fw mechanism first ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x18); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ ++ // sw mechanism ++ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ } ++ else ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ } ++ ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ } ++ else if(pCoexSta->bA2dpBusy) ++ { ++ // fw mechanism first ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, TRUE, 0x18, FALSE); ++ ++ // sw mechanism ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8192d2ant_CoexAllOff(pBtCoexist); ++ } ++} ++ ++VOID ++halbtc8192d2ant_ActionPan( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; ++ u1Byte wifiRssiState, wifiRssiState1; ++ u4Byte wifiBw, wifiTrafficDir; ++ s4Byte wifiRssi; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); ++ ++ if(bBtHsOn) ++ { ++ halbtc8192d2ant_CoexAllOff(pBtCoexist); ++ } ++ else ++ { ++ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 3, 25, 50); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); ++ } ++ else ++ { ++ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 25, 0); ++ } ++ ++ if(pCoexSta->bBtBusy && bWifiBusy) ++ { ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ // fw mechanism first ++ if(pCoexSta->bBtUplink) ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ else ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ } ++ // sw mechanism ++ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ } ++ else ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ } ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ if(pCoexSta->bBtUplink) ++ { ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); ++ } ++ } ++ else if( (wifiRssiState == BTC_RSSI_STATE_MEDIUM) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_MEDIUM) ) ++ { ++ // fw mechanism first ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); ++ ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); ++ else ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ // sw mechanism ++ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ } ++ else ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ } ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ // fw mechanism first ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); ++ ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ if(pCoexSta->bBtUplink) ++ { ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); ++ } ++ else ++ { ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ } ++ else ++ { ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ } ++ // sw mechanism ++ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ } ++ else ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ } ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ else if(pCoexSta->bBtBusy && ++ !bWifiBusy && ++ (wifiRssi < 30)) ++ { ++ // fw mechanism first ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x0a, 0x20); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ // sw mechanism ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8192d2ant_CoexAllOff(pBtCoexist); ++ } ++ } ++} ++ ++ ++VOID ++halbtc8192d2ant_ActionHid( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; ++ u4Byte wifiTrafficDir; ++ BOOLEAN bWifiBusy=FALSE; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 45, 0); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 20, 0); ++ } ++ ++ if(pCoexSta->bBtBusy && bWifiBusy) ++ { ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ // fw mechanism first ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); ++ } ++ else ++ { ++ // fw mechanism first ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, TRUE, 0x18, FALSE); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x15); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x30, FALSE); ++ } ++ // sw mechanism ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ else ++ { ++ halbtc8192d2ant_CoexAllOff(pBtCoexist); ++ } ++} ++ ++ ++ ++VOID ++halbtc8192d2ant_ActionSco( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState; ++ u4Byte wifiBw; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); ++ ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ // fw mechanism first ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ // fw mechanism first ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++} ++ ++VOID ++halbtc8192d2ant_ActionHidA2dp( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState, wifiRssiState1; ++ u4Byte wifiBw; ++ ++ if(pCoexSta->bBtBusy) ++ { ++ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 35, 0); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ // fw mechanism first ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ ++ // sw mechanism ++ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ } ++ else ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ } ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); ++ } ++ else ++ { ++ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); ++ // fw mechanism ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ } ++ else ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ } ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); ++ } ++ else ++ { ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); ++ } ++ } ++ } ++ else ++ { ++ halbtc8192d2ant_CoexAllOff(pBtCoexist); ++ } ++} ++ ++ ++VOID ++halbtc8192d2ant_ActionHidPanBc4( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; ++ u4Byte wifiBw, wifiTrafficDir; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ ++ if(bBtHsOn) ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ ++ halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); ++ } ++ else ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); ++ if(BTC_WIFI_BW_LEGACY == wifiBw) ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ ++ halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); ++ } ++ else if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ ++ halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ else if(!bWifiBusy) ++ { ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ } ++ } ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++} ++VOID ++halbtc8192d2ant_ActionHidPanBc8( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; ++ u1Byte wifiRssiState; ++ u4Byte wifiBw, wifiTrafficDir; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ ++ if(!bBtHsOn) ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); ++ if((pCoexSta->bBtBusy && bWifiBusy)) ++ { ++ // fw mechanism first ++ if(pCoexSta->bBtUplink) ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); ++ } ++ else ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); ++ } ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ ++ // sw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ else ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ else ++ { ++ halbtc8192d2ant_CoexAllOff(pBtCoexist); ++ } ++ } ++ else ++ { ++ if(BTC_INTF_USB == pBtCoexist->chipInterface) ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); ++ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ ++ halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); ++ } ++ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) ++ { ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); ++ } ++ } ++ else ++ { ++ if(pCoexSta->bBtBusy) ++ { ++ // fw mechanism ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); ++ } ++ else ++ { ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ } ++} ++ ++VOID ++halbtc8192d2ant_ActionHidPan( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8192d2ant_ActionHidPanBc4(pBtCoexist); ++ } ++ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8192d2ant_ActionHidPanBc8(pBtCoexist); ++ } ++} ++ ++VOID ++halbtc8192d2ant_ActionPanA2dpBc4( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; ++ u1Byte wifiRssiState; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); ++ if(bBtHsOn) ++ { ++ if(pCoexSta->bBtBusy) ++ { ++ // fw mechanism ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); ++ } ++ else ++ { ++ halbtc8192d2ant_CoexAllOff(pBtCoexist); ++ } ++ } ++ else ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ if(pCoexSta->bBtBusy && bWifiBusy) ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ } ++ else ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); ++ } ++ // sw mechanism ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++} ++VOID ++halbtc8192d2ant_ActionPanA2dpBc8( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; ++ u1Byte wifiRssiState; ++ u4Byte wifiBw; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ ++ if(!bBtHsOn) ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); ++ if((pCoexSta->bBtBusy && bWifiBusy)) ++ { ++ // fw mechanism first ++ if(pCoexSta->bBtUplink) ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); ++ } ++ else ++ { ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); ++ } ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); ++ ++ // sw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ else ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ else ++ { ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++ else ++ { ++ halbtc8192d2ant_CoexAllOff(pBtCoexist); ++ } ++ } ++ else ++ { ++ if(pCoexSta->bBtBusy) ++ { ++ // fw mechanism ++ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); ++ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); ++ ++ // sw mechanism ++ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); ++ } ++ else ++ { ++ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); ++ } ++ } ++} ++ ++VOID ++halbtc8192d2ant_ActionPanA2dp( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8192d2ant_ActionPanA2dpBc4(pBtCoexist); ++ } ++ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ++ { ++ halbtc8192d2ant_ActionPanA2dpBc8(pBtCoexist); ++ } ++} ++ ++BOOLEAN ++halbtc8192d2ant_IsBtCoexistEnter( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte macPhyMode; ++ BOOLEAN bRet=TRUE; ++ BOOLEAN bWifiUnder5G=FALSE; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_MAC_PHY_MODE, &macPhyMode); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); ++ ++ if(BTC_SMSP != macPhyMode) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Only support single mac single phy!!\n")); ++ bRet = FALSE; ++ } ++ ++ if(bWifiUnder5G) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under 5G or A band\n")); ++ halbtc8192d2ant_CoexAllOff(pBtCoexist); ++ bRet = FALSE; ++ } ++ ++ return bRet; ++} ++ ++//============================================================ ++// extern function start with EXhalbtc8192d2ant_ ++//============================================================ ++VOID ++EXhalbtc8192d2ant_PowerOnSetting( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++} ++ ++VOID ++EXhalbtc8192d2ant_InitHwConfig( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bWifiOnly ++ ) ++{ ++ u1Byte u1Tmp=0; ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); ++ ++ // backup rf 0x1e value ++ pCoexDm->btRf0x1eBackup = ++ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); ++ ++ if( (BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) || ++ (BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ) ++ { ++ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd) & BIT0; ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, u1Tmp); ++ ++ halbtc8192d2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0xaaaa9aaa, 0xffbd0040, 0x40000010); ++ ++ // switch control, here we set pathA to control ++ // 0x878[13] = 1, 0:pathB, 1:pathA(default) ++ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x878, BIT13, 0x1); ++ ++ // antsel control, here we use phy0 and enable antsel. ++ // 0x87c[16:15] = b'11, enable antsel, antsel output pin ++ // 0x87c[30] = 0, 0: phy0, 1:phy 1 ++ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x87c, bMaskDWord, 0x1fff8); ++ ++ // antsel to Bt or Wifi, it depends Bt on/off. ++ // 0x860[9:8] = 'b10, b10:Bt On, WL2G off(default), b01:Bt off, WL2G on. ++ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x860, BIT9|BIT8, 0x2); ++ ++ // sw/hw control switch, here we set sw control ++ // 0x870[9:8] = 'b11 sw control, 'b00 hw control ++ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x870, BIT9|BIT8, 0x3); ++ } ++} ++ ++VOID ++EXhalbtc8192d2ant_InitCoexDm( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); ++ ++ halbtc8192d2ant_InitCoexDm(pBtCoexist); ++} ++ ++VOID ++EXhalbtc8192d2ant_DisplayCoexInfo( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; ++ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; ++ pu1Byte cliBuf=pBtCoexist->cliBuf; ++ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; ++ u4Byte u4Tmp[4]; ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ ++ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); ++ CL_PRINTF(cliBuf); ++ ++ if(pBtCoexist->bManualControl) ++ { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); ++ CL_PRINTF(cliBuf); ++ } ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ ++ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); ++ CL_PRINTF(cliBuf); ++ ++ // wifi status ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); ++ CL_PRINTF(cliBuf); ++ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); ++ CL_PRINTF(cliBuf); ++ ++ if(pStackInfo->bProfileNotified) ++ { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ ++ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); ++ CL_PRINTF(cliBuf); ++ ++ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); ++ } ++ ++ // Sw mechanism ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); ++ CL_PRINTF(cliBuf); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ ++ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); ++ CL_PRINTF(cliBuf); ++ ++ // Fw mechanism ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); ++ CL_PRINTF(cliBuf); ++ ++ // Hw setting ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ ++ pCoexDm->btRf0x1eBackup); ++ CL_PRINTF(cliBuf); ++ ++ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ ++ u1Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ ++ u4Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); ++ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); ++ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c4/0x6c8/0x6cc(coexTable)", \ ++ u4Tmp[0], u4Tmp[1], u4Tmp[2]); ++ CL_PRINTF(cliBuf); ++ ++ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++VOID ++EXhalbtc8192d2ant_IpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_IPS_ENTER == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); ++ halbtc8192d2ant_CoexAllOff(pBtCoexist); ++ } ++ else if(BTC_IPS_LEAVE == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); ++ //halbtc8192d2ant_InitCoexDm(pBtCoexist); ++ } ++} ++ ++VOID ++EXhalbtc8192d2ant_LpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_LPS_ENABLE == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); ++ halbtc8192d2ant_CoexAllOff(pBtCoexist); ++ } ++ else if(BTC_LPS_DISABLE == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); ++ halbtc8192d2ant_InitCoexDm(pBtCoexist); ++ } ++} ++ ++VOID ++EXhalbtc8192d2ant_ScanNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_SCAN_START == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); ++ } ++ else if(BTC_SCAN_FINISH == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); ++ } ++} ++ ++VOID ++EXhalbtc8192d2ant_ConnectNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_ASSOCIATE_START == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); ++ } ++ else if(BTC_ASSOCIATE_FINISH == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); ++ } ++} ++ ++VOID ++EXhalbtc8192d2ant_MediaStatusNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_MEDIA_CONNECT == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); ++ } ++} ++ ++VOID ++EXhalbtc8192d2ant_SpecialPacketNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(type == BTC_PACKET_DHCP) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); ++ } ++} ++ ++VOID ++EXhalbtc8192d2ant_BtInfoNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN pu1Byte tmpBuf, ++ IN u1Byte length ++ ) ++{ ++} ++ ++VOID ++EXhalbtc8192d2ant_HaltNotify( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); ++ ++ EXhalbtc8192d2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); ++} ++ ++VOID ++EXhalbtc8192d2ant_Periodical( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte algorithm; ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Periodical!!\n")); ++ ++ // NOTE: ++ // sw mechanism must be done after fw mechanism ++ // ++ if(!halbtc8192d2ant_IsBtCoexistEnter(pBtCoexist)) ++ return; ++ ++ if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ++ { ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_GET_BT_RSSI, NULL); ++ ++ halbtc8192d2ant_MonitorBtState(pBtCoexist); ++ algorithm = halbtc8192d2ant_ActionAlgorithm(pBtCoexist); ++ pCoexDm->curAlgorithm = algorithm; ++ switch(pCoexDm->curAlgorithm) ++ { ++ case BT_8192D_2ANT_COEX_ALGO_SCO: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO\n")); ++ halbtc8192d2ant_ActionSco(pBtCoexist); ++ break; ++ case BT_8192D_2ANT_COEX_ALGO_HID: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID\n")); ++ halbtc8192d2ant_ActionHid(pBtCoexist); ++ break; ++ case BT_8192D_2ANT_COEX_ALGO_A2DP: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP\n")); ++ halbtc8192d2ant_ActionA2dp(pBtCoexist); ++ break; ++ case BT_8192D_2ANT_COEX_ALGO_PAN: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN\n")); ++ halbtc8192d2ant_ActionPan(pBtCoexist); ++ break; ++ case BT_8192D_2ANT_COEX_ALGO_HID_A2DP: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP\n")); ++ halbtc8192d2ant_ActionHidA2dp(pBtCoexist); ++ break; ++ case BT_8192D_2ANT_COEX_ALGO_HID_PAN: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+HID\n")); ++ halbtc8192d2ant_ActionHidPan(pBtCoexist); ++ break; ++ case BT_8192D_2ANT_COEX_ALGO_PAN_A2DP: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP\n")); ++ halbtc8192d2ant_ActionPanA2dp(pBtCoexist); ++ break; ++ default: ++ break; ++ } ++ } ++} ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.h 2018-02-11 21:44:27.143146025 +0200 +@@ -0,0 +1,170 @@ ++//=========================================== ++// The following is for 8192D 2Ant BT Co-exist definition ++//=========================================== ++#define BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT 6 ++ ++typedef enum _BT_INFO_SRC_8192D_2ANT{ ++ BT_INFO_SRC_8192D_2ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8192D_2ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8192D_2ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8192D_2ANT_MAX ++}BT_INFO_SRC_8192D_2ANT,*PBT_INFO_SRC_8192D_2ANT; ++ ++typedef enum _BT_8192D_2ANT_BT_STATUS{ ++ BT_8192D_2ANT_BT_STATUS_IDLE = 0x0, ++ BT_8192D_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8192D_2ANT_BT_STATUS_NON_IDLE = 0x2, ++ BT_8192D_2ANT_BT_STATUS_MAX ++}BT_8192D_2ANT_BT_STATUS,*PBT_8192D_2ANT_BT_STATUS; ++ ++typedef enum _BT_8192D_2ANT_COEX_ALGO{ ++ BT_8192D_2ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8192D_2ANT_COEX_ALGO_SCO = 0x1, ++ BT_8192D_2ANT_COEX_ALGO_HID = 0x2, ++ BT_8192D_2ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8192D_2ANT_COEX_ALGO_PAN = 0x4, ++ BT_8192D_2ANT_COEX_ALGO_HID_A2DP = 0x5, ++ BT_8192D_2ANT_COEX_ALGO_HID_PAN = 0x6, ++ BT_8192D_2ANT_COEX_ALGO_PAN_A2DP = 0x7, ++ BT_8192D_2ANT_COEX_ALGO_MAX ++}BT_8192D_2ANT_COEX_ALGO,*PBT_8192D_2ANT_COEX_ALGO; ++ ++typedef struct _COEX_DM_8192D_2ANT{ ++ // fw mechanism ++ BOOLEAN bPreBalanceOn; ++ BOOLEAN bCurBalanceOn; ++ ++ // diminishWifi ++ BOOLEAN bPreDacOn; ++ BOOLEAN bCurDacOn; ++ BOOLEAN bPreInterruptOn; ++ BOOLEAN bCurInterruptOn; ++ u1Byte preFwDacSwingLvl; ++ u1Byte curFwDacSwingLvl; ++ BOOLEAN bPreNavOn; ++ BOOLEAN bCurNavOn; ++ ++ ++ ++ ++ ++ //BOOLEAN bPreDecBtPwr; ++ //BOOLEAN bCurDecBtPwr; ++ ++ //u1Byte preFwDacSwingLvl; ++ //u1Byte curFwDacSwingLvl; ++ //BOOLEAN bCurIgnoreWlanAct; ++ //BOOLEAN bPreIgnoreWlanAct; ++ //u1Byte prePsTdma; ++ //u1Byte curPsTdma; ++ //u1Byte psTdmaPara[5]; ++ //u1Byte psTdmaDuAdjType; ++ //BOOLEAN bResetTdmaAdjust; ++ //BOOLEAN bPrePsTdmaOn; ++ //BOOLEAN bCurPsTdmaOn; ++ //BOOLEAN bPreBtAutoReport; ++ //BOOLEAN bCurBtAutoReport; ++ ++ // sw mechanism ++ BOOLEAN bPreRfRxLpfShrink; ++ BOOLEAN bCurRfRxLpfShrink; ++ u4Byte btRf0x1eBackup; ++ BOOLEAN bPreLowPenaltyRa; ++ BOOLEAN bCurLowPenaltyRa; ++ BOOLEAN bPreDacSwingOn; ++ u4Byte preDacSwingLvl; ++ BOOLEAN bCurDacSwingOn; ++ u4Byte curDacSwingLvl; ++ BOOLEAN bPreAdcBackOff; ++ BOOLEAN bCurAdcBackOff; ++ BOOLEAN bPreAgcTableEn; ++ BOOLEAN bCurAgcTableEn; ++ //u4Byte preVal0x6c0; ++ //u4Byte curVal0x6c0; ++ u4Byte preVal0x6c4; ++ u4Byte curVal0x6c4; ++ u4Byte preVal0x6c8; ++ u4Byte curVal0x6c8; ++ u4Byte preVal0x6cc; ++ u4Byte curVal0x6cc; ++ //BOOLEAN bLimitedDig; ++ ++ // algorithm related ++ u1Byte preAlgorithm; ++ u1Byte curAlgorithm; ++ //u1Byte btStatus; ++ //u1Byte wifiChnlInfo[3]; ++} COEX_DM_8192D_2ANT, *PCOEX_DM_8192D_2ANT; ++ ++typedef struct _COEX_STA_8192D_2ANT{ ++ u1Byte preWifiRssiState[4]; ++ BOOLEAN bBtBusy; ++ BOOLEAN bBtUplink; ++ BOOLEAN bBtDownLink; ++ BOOLEAN bA2dpBusy; ++}COEX_STA_8192D_2ANT, *PCOEX_STA_8192D_2ANT; ++ ++//=========================================== ++// The following is interface which will notify coex module. ++//=========================================== ++VOID ++EXhalbtc8192d2ant_PowerOnSetting( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8192d2ant_InitHwConfig( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bWifiOnly ++ ); ++VOID ++EXhalbtc8192d2ant_InitCoexDm( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8192d2ant_IpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8192d2ant_LpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8192d2ant_ScanNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8192d2ant_ConnectNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8192d2ant_MediaStatusNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8192d2ant_SpecialPacketNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8192d2ant_HaltNotify( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8192d2ant_Periodical( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8192d2ant_BtInfoNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN pu1Byte tmpBuf, ++ IN u1Byte length ++ ); ++VOID ++EXhalbtc8192d2ant_DisplayCoexInfo( ++ IN PBTC_COEXIST pBtCoexist ++ ); +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.c 2018-02-11 21:44:27.144146040 +0200 +@@ -0,0 +1,3417 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8192E Co-exist mechanism ++ * ++ * History ++ * 2012/11/15 Cosa first check in. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8192E_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8192e_1ant glcoex_dm_8192e_1ant; ++static struct coex_dm_8192e_1ant *coex_dm = &glcoex_dm_8192e_1ant; ++static struct coex_sta_8192e_1ant glcoex_sta_8192e_1ant; ++static struct coex_sta_8192e_1ant *coex_sta = &glcoex_sta_8192e_1ant; ++ ++const char *const glbt_info_src_8192e_1ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++u32 glcoex_ver_date_8192e_1ant = 20140527; ++u32 glcoex_ver_8192e_1ant = 0x4f; ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8192e1ant_ ++ * ************************************************************ */ ++u8 halbtc8192e1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_bt_rssi_state; ++ } ++ ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8192e1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_wifi_rssi_state[index]; ++ } ++ ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8192e1ant_update_ra_mask(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 dis_rate_mask) ++{ ++ coex_dm->cur_ra_mask = dis_rate_mask; ++ ++ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, ++ &coex_dm->cur_ra_mask); ++ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; ++} ++ ++void halbtc8192e1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ ++ coex_dm->cur_arfr_type = type; ++ ++ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { ++ switch (coex_dm->cur_arfr_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_4byte(btcoexist, 0x430, ++ coex_dm->backup_arfr_cnt1); ++ btcoexist->btc_write_4byte(btcoexist, 0x434, ++ coex_dm->backup_arfr_cnt2); ++ break; ++ case 1: ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x01010101); ++ } else { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x04030201); ++ } ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; ++} ++ ++void halbtc8192e1ant_retry_limit(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_retry_limit_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_retry_limit_type != ++ coex_dm->cur_retry_limit_type)) { ++ switch (coex_dm->cur_retry_limit_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ coex_dm->backup_retry_limit); ++ break; ++ case 1: /* retry limit=8 */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ 0x0808); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; ++} ++ ++void halbtc8192e1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_ampdu_time_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { ++ switch (coex_dm->cur_ampdu_time_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ coex_dm->backup_ampdu_max_time); ++ break; ++ case 1: /* AMPDU timw = 0x38 * 32us */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ 0x38); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; ++} ++ ++void halbtc8192e1ant_limited_tx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, ++ IN u8 retry_limit_type, IN u8 ampdu_time_type) ++{ ++ switch (ra_mask_type) { ++ case 0: /* normal mode */ ++ halbtc8192e1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0); ++ break; ++ case 1: /* disable cck 1/2 */ ++ halbtc8192e1ant_update_ra_mask(btcoexist, force_exec, ++ 0x00000003); ++ break; ++ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ ++ halbtc8192e1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0001f1f7); ++ break; ++ default: ++ break; ++ } ++ ++ halbtc8192e1ant_auto_rate_fallback_retry(btcoexist, force_exec, ++ arfr_type); ++ halbtc8192e1ant_retry_limit(btcoexist, force_exec, retry_limit_type); ++ halbtc8192e1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); ++} ++ ++void halbtc8192e1ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++ ++ ++} ++ ++void halbtc8192e1ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ coex_sta->c2h_bt_info_req_sent = true; ++ ++ h2c_parameter[0] |= BIT(0); /* trigger */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); ++} ++ ++void halbtc8192e1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ static u8 num_of_bt_counter_chk = 0; ++ ++ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ ++ /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ ++ ++ if (coex_sta->under_ips) { ++ coex_sta->high_priority_tx = 65535; ++ coex_sta->high_priority_rx = 65535; ++ coex_sta->low_priority_tx = 65535; ++ coex_sta->low_priority_rx = 65535; ++ return; ++ } ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ if ((coex_sta->low_priority_tx >= 1050) && ++ (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->pop_event_cnt++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", ++ reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); ++ BTC_TRACE(trace_buf); ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++ ++ if ((reg_hp_tx == 0) && (reg_hp_rx == 0) && (reg_lp_tx == 0) && ++ (reg_lp_rx == 0)) { ++ num_of_bt_counter_chk++; ++ if (num_of_bt_counter_chk >= 3) { ++ halbtc8192e1ant_query_bt_info(btcoexist); ++ num_of_bt_counter_chk = 0; ++ } ++ } ++} ++ ++ ++void halbtc8192e1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) ++{ ++ s32 wifi_rssi = 0; ++ boolean wifi_busy = false, wifi_under_b_mode = false; ++ static u8 cck_lock_counter = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ if (coex_sta->under_ips) { ++ coex_sta->crc_ok_cck = 0; ++ coex_sta->crc_ok_11g = 0; ++ coex_sta->crc_ok_11n = 0; ++ coex_sta->crc_ok_11n_agg = 0; ++ ++ coex_sta->crc_err_cck = 0; ++ coex_sta->crc_err_11g = 0; ++ coex_sta->crc_err_11n = 0; ++ coex_sta->crc_err_11n_agg = 0; ++ } else { ++ coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, ++ 0xf88); ++ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf94); ++ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf90); ++ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xfb8); ++ ++ coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, ++ 0xf84); ++ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf96); ++ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf92); ++ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xfba); ++ } ++ ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); ++ ++ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { ++ if ((coex_dm->bt_status == BT_8192E_1ANT_BT_STATUS_ACL_BUSY) || ++ (coex_dm->bt_status == ++ BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY) || ++ (coex_dm->bt_status == ++ BT_8192E_1ANT_BT_STATUS_SCO_BUSY)) { ++ if (coex_sta->crc_ok_cck > (coex_sta->crc_ok_11g + ++ coex_sta->crc_ok_11n + ++ coex_sta->crc_ok_11n_agg)) { ++ if (cck_lock_counter < 5) ++ cck_lock_counter++; ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ if (!coex_sta->pre_ccklock) { ++ ++ if (cck_lock_counter >= 5) ++ coex_sta->cck_lock = true; ++ else ++ coex_sta->cck_lock = false; ++ } else { ++ if (cck_lock_counter == 0) ++ coex_sta->cck_lock = false; ++ else ++ coex_sta->cck_lock = true; ++ } ++ ++ coex_sta->pre_ccklock = coex_sta->cck_lock; ++ ++ ++} ++ ++boolean halbtc8192e1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) ++{ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ } ++ ++ return false; ++} ++ ++void halbtc8192e1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if (bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if (!bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++} ++ ++u8 halbtc8192e1ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8192E_1ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (!bt_link_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No BT link exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (bt_link_info->sco_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->hid_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->pan_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 1) { ++ if (bt_link_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_1ANT_COEX_ALGO_SCO; ++ } else { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_1ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_1ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_1ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_1ANT_COEX_ALGO_SCO; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_1ANT_COEX_ALGO_HID_A2DP; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_1ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_1ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_1ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++void halbtc8192e1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8192e1ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ halbtc8192e1ant_set_bt_auto_report(btcoexist, ++ coex_dm->cur_bt_auto_report); ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++void halbtc8192e1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ ++ ++ if (low_penalty_ra) { ++ h2c_parameter[1] |= BIT(0); ++ h2c_parameter[2] = ++ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ ++ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ ++ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ ++ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); ++} ++ ++void halbtc8192e1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ halbtc8192e1ant_set_sw_penalty_tx_rate_adaptive(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++} ++ ++void halbtc8192e1ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8192e1ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ halbtc8192e1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8192e1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** CoexTable(%d) **********\n", type); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->coex_table_type = type; ++ ++ switch (type) { ++ case 0: ++ halbtc8192e1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x55555555, 0xffffff, 0x3); ++ break; ++ case 1: ++ halbtc8192e1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 2: ++ halbtc8192e1ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 3: ++ halbtc8192e1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 4: ++ halbtc8192e1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3); ++ break; ++ case 5: ++ halbtc8192e1ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0xaa5a5a5a, 0xffffff, 0x3); ++ break; ++ case 6: ++ halbtc8192e1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ case 7: ++ halbtc8192e1ant_coex_table(btcoexist, force_exec, ++ 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8192e1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ if (enable) { ++ h2c_parameter[0] |= BIT(0); /* function enable */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); ++} ++ ++void halbtc8192e1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ halbtc8192e1ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8192e1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8192e1ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8192e1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8192e1ant_sw_mechanism(IN struct btc_coexist *btcoexist, ++ IN boolean low_penalty_ra) ++{ ++ halbtc8192e1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); ++} ++ ++void halbtc8192e1ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) ++{ ++ u32 u32tmp = 0; ++ ++ if (init_hwcfg) { ++ btcoexist->btc_write_1byte(btcoexist, 0x944, 0x24); ++ btcoexist->btc_write_4byte(btcoexist, 0x930, 0x700700); ++ if (btcoexist->chip_interface == BTC_INTF_USB) ++ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30430004); ++ else ++ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30030004); ++ ++ /* 0x4c[27][24]='00', Set Antenna to BB */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp &= ~BIT(24); ++ u32tmp &= ~BIT(27); ++ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); ++ } else if (wifi_off) { ++ if (btcoexist->chip_interface == BTC_INTF_USB) ++ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30430004); ++ else ++ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30030004); ++ ++ /* 0x4c[27][24]='11', Set Antenna to BT, 0x64[8:7]=0, 0x64[2]=1 */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp |= BIT(24); ++ u32tmp |= BIT(27); ++ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); ++ } ++ ++ /* ext switch setting */ ++ switch (ant_pos_type) { ++ case BTC_ANT_PATH_WIFI: ++ btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x4); ++ break; ++ case BTC_ANT_PATH_BT: ++ btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x20); ++ break; ++ default: ++ case BTC_ANT_PATH_PTA: ++ btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x4); ++ break; ++ } ++} ++ ++void halbtc8192e1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ u8 real_byte1 = byte1, real_byte5 = byte5; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ if (ap_enable) { ++ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], FW for 1Ant AP mode\n"); ++ BTC_TRACE(trace_buf); ++ real_byte1 &= ~BIT(4); ++ real_byte1 |= BIT(5); ++ ++ real_byte5 |= BIT(5); ++ real_byte5 &= ~BIT(6); ++ } ++ } ++ ++ h2c_parameter[0] = real_byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = real_byte5; ++ ++ coex_dm->ps_tdma_para[0] = real_byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = real_byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++ ++void halbtc8192e1ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_busy = false; ++ u8 rssi_adjust_val = 0; ++ u8 ps_tdma_byte4_val = 0x50, ps_tdma_byte0_val = 0x51, ++ ps_tdma_byte3_val = 0x10; ++ s8 wifi_duration_adjust = 0x0; ++ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (coex_dm->cur_ps_tdma_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(on, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(off, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ return; ++ } ++ ++ if (coex_sta->scan_ap_num <= 5) ++ wifi_duration_adjust = 5; ++ else if (coex_sta->scan_ap_num >= 40) ++ wifi_duration_adjust = -15; ++ else if (coex_sta->scan_ap_num >= 20) ++ wifi_duration_adjust = -10; ++ ++ if (!coex_sta->force_lps_on) { /* only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 */ ++ ps_tdma_byte0_val = 0x61; /* no null-pkt */ ++ ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */ ++ ps_tdma_byte4_val = 0x10; /* 0x778 = d/1 toggle */ ++ } ++ ++ if ((type == 3) || (type == 13) || (type == 14)) ++ ps_tdma_byte4_val = ps_tdma_byte4_val & ++ 0xbf; /* no dynamic slot for multi-profile */ ++ ++ if (bt_link_info->slave_role == true) ++ ps_tdma_byte4_val = ps_tdma_byte4_val | ++ 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ ++ ++ if (turn_on) { ++ switch (type) { ++ default: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x1a, 0x1a, 0x0, ps_tdma_byte4_val); ++ break; ++ case 1: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x3a + ++ wifi_duration_adjust, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 2: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x2d + ++ wifi_duration_adjust, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 3: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x1d, 0x1d, 0x0, ps_tdma_byte4_val); ++ break; ++ case 4: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x15, 0x3, 0x14, 0x0); ++ break; ++ case 5: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x15, 0x3, 0x11, 0x11); ++ break; ++ case 6: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x20, 0x3, 0x11, 0x11); ++ break; ++ case 7: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x13, ++ 0xc, 0x5, 0x0, 0x0); ++ break; ++ case 8: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x25, 0x3, 0x10, 0x0); ++ break; ++ case 9: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x21, 0x3, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 10: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x13, ++ 0xa, 0xa, 0x0, 0x40); ++ break; ++ case 11: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x21, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 12: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x0a, 0x0a, 0x0, 0x50); ++ break; ++ case 13: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x12, 0x12, 0x0, ps_tdma_byte4_val); ++ break; ++ case 14: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x21, 0x3, 0x10, ps_tdma_byte4_val); ++ break; ++ case 15: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x13, ++ 0xa, 0x3, 0x8, 0x0); ++ break; ++ case 16: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x15, 0x3, 0x10, 0x0); ++ break; ++ case 18: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x25, 0x3, 0x10, 0x0); ++ break; ++ case 20: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x3f, 0x03, 0x11, 0x10); ++ break; ++ case 21: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x25, 0x03, 0x11, 0x11); ++ break; ++ case 22: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x25, 0x03, 0x11, 0x10); ++ break; ++ case 23: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x3, 0x31, 0x18); ++ break; ++ case 24: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x15, 0x3, 0x31, 0x18); ++ break; ++ case 25: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0xa, 0x3, 0x31, 0x18); ++ break; ++ case 26: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0xa, 0x3, 0x31, 0x18); ++ break; ++ case 27: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x3, 0x31, 0x98); ++ break; ++ case 28: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x69, ++ 0x25, 0x3, 0x31, 0x0); ++ break; ++ case 29: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xab, ++ 0x1a, 0x1a, 0x1, 0x10); ++ break; ++ case 30: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x30, 0x3, 0x10, 0x10); ++ break; ++ case 31: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x1a, 0x1a, 0, 0x58); ++ break; ++ case 32: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x35, 0x3, 0x11, 0x11); ++ break; ++ case 33: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xa3, ++ 0x25, 0x3, 0x30, 0x90); ++ break; ++ case 34: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x53, ++ 0x1a, 0x1a, 0x0, 0x10); ++ break; ++ case 35: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x63, ++ 0x1a, 0x1a, 0x0, 0x10); ++ break; ++ case 36: ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x12, 0x3, 0x14, 0x50); ++ break; ++ case 40: /* SoftAP only with no sta associated,BT disable ,TDMA mode for power saving */ ++ /* here softap mode screen off will cost 70-80mA for phone */ ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x23, ++ 0x18, 0x00, 0x10, 0x24); ++ break; ++ } ++ } else { ++ ++ /* disable PS tdma */ ++ switch (type) { ++ case 8: /* PTA Control */ ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x8, ++ 0x0, 0x0, 0x0, 0x0); ++ halbtc8192e1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_PTA, false, false); ++ break; ++ case 0: ++ default: /* Software control, Antenna at BT side */ ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x0, 0x0); ++ halbtc8192e1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_BT, false, false); ++ break; ++ case 9: /* Software control, Antenna at WiFi side */ ++ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x0, 0x0); ++ halbtc8192e1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_WIFI, false, false); ++ break; ++ } ++ } ++ rssi_adjust_val = 0; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssi_adjust_val); ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", ++ btcoexist->btc_read_4byte(btcoexist, 0x948), ++ btcoexist->btc_read_1byte(btcoexist, 0x765), ++ btcoexist->btc_read_1byte(btcoexist, 0x67)); ++ BTC_TRACE(trace_buf); ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++void halbtc8192e1ant_coex_all_off(IN struct btc_coexist *btcoexist) ++{ ++ /* sw all off */ ++ halbtc8192e1ant_sw_mechanism(btcoexist, false); ++ ++ /* hw all off */ ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++boolean halbtc8192e1ant_is_common_action(IN struct btc_coexist *btcoexist) ++{ ++ boolean common = false, wifi_connected = false, wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (!wifi_connected && ++ BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else { ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ common = false; ++ } ++ ++ return common; ++} ++ ++ ++void halbtc8192e1ant_tdma_duration_adjust_for_acl(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ static s32 up, dn, m, n, wait_count; ++ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ ++ u8 retry_count = 0, bt_info_ext; ++ boolean wifi_busy = false; ++ /*static boolean pre_wifi_busy = false;*/ ++ ++ if (BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifi_status) ++ wifi_busy = true; ++ else ++ wifi_busy = false; ++ ++ if ((BT_8192E_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == ++ wifi_status) || ++ (BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifi_status) || ++ (BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT == ++ wifi_status)) { ++ if (coex_dm->cur_ps_tdma != 1 && ++ coex_dm->cur_ps_tdma != 2 && ++ coex_dm->cur_ps_tdma != 3 && ++ coex_dm->cur_ps_tdma != 9) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n = 3; ++ result = 0; ++ wait_count = 0; ++ } ++ return; ++ } ++ ++ if (!coex_dm->auto_tdma_adjust) { ++ coex_dm->auto_tdma_adjust = true; ++ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ /* ============ */ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n = 3; ++ result = 0; ++ wait_count = 0; ++ } else { ++ /* accquire the BT TRx retry count from BT_Info byte2 */ ++ retry_count = coex_sta->bt_retry_cnt; ++ bt_info_ext = coex_sta->bt_info_ext; ++ ++ if ((coex_sta->low_priority_tx) > 1050 || ++ (coex_sta->low_priority_rx) > 1250) ++ retry_count++; ++ ++ result = 0; ++ wait_count++; ++ ++ if (retry_count == ++ 0) { /* no retry in the last 2-second duration */ ++ up++; ++ dn--; ++ ++ if (dn <= 0) ++ dn = 0; ++ ++ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ ++ wait_count = 0; ++ n = 3; ++ up = 0; ++ dn = 0; ++ result = 1; ++ } ++ } else if (retry_count <= ++ 3) { /* <=3 retry in the last 2-second duration */ ++ up--; ++ dn++; ++ ++ if (up <= 0) ++ up = 0; ++ ++ if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ ++ if (wait_count <= 2) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ ++ if (wait_count == 1) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ ++ if (result == -1) { ++ if ((BT_INFO_8192E_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && ++ ((coex_dm->cur_ps_tdma == 1) || ++ (coex_dm->cur_ps_tdma == 2))) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } ++ } else if (result == 1) { ++ if ((BT_INFO_8192E_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && ++ ((coex_dm->cur_ps_tdma == 1) || ++ (coex_dm->cur_ps_tdma == 2))) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = 1; ++ } ++ } else { /* no change */ ++ /* Bryant Modify ++ if(wifi_busy != pre_wifi_busy) ++ { ++ pre_wifi_busy = wifi_busy; ++ halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, true, coex_dm->cur_ps_tdma); ++ } ++ */ ++ } ++ ++ if (coex_dm->cur_ps_tdma != 1 && ++ coex_dm->cur_ps_tdma != 2 && ++ coex_dm->cur_ps_tdma != 9 && ++ coex_dm->cur_ps_tdma != 11) { ++ /* recover to previous adjust type */ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ coex_dm->ps_tdma_du_adj_type); ++ } ++ } ++} ++ ++void halbtc8192e1ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++void halbtc8192e1ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ boolean low_pwr_disable = false; ++ ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ /* recover to original 32k low power setting */ ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ case BTC_PS_LPS_ON: ++ halbtc8192e1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8192e1ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ /* when coex force to enter LPS, do not enter 32k low power. */ ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ coex_sta->force_lps_on = true; ++ break; ++ case BTC_PS_LPS_OFF: ++ halbtc8192e1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, false); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8192e1ant_action_wifi_only(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 9); ++} ++ ++void halbtc8192e1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ ++ /* This function check if bt is disabled */ ++ ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is enabled !!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ bt_disable_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], bt all counters=0, %d times!!\n", ++ bt_disable_cnt); ++ BTC_TRACE(trace_buf); ++ if (bt_disable_cnt >= 2) { ++ bt_disabled = true; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e1ant_action_wifi_only(btcoexist); ++ } ++ } ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_disabled = bt_disabled; ++ if (!bt_disabled) { ++ } else { ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ } ++ } ++} ++ ++/* ********************************************* ++ * ++ * Software Coex Mechanism start ++ * ++ * ********************************************* */ ++ ++/* SCO only or SCO+PAN(HS) */ ++ ++/* ++void halbtc8192e1ant_action_sco(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8192e1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8192e1ant_action_hid(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8192e1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8192e1ant_action_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8192e1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8192e1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8192e1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8192e1ant_action_pan_edr(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8192e1ant_sw_mechanism(btcoexist, false); ++} ++ ++ ++void halbtc8192e1ant_action_pan_hs(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8192e1ant_sw_mechanism(btcoexist, false); ++} ++ ++ ++void halbtc8192e1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8192e1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8192e1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8192e1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8192e1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8192e1ant_sw_mechanism(btcoexist, true); ++} ++ ++void halbtc8192e1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8192e1ant_sw_mechanism(btcoexist, true); ++} ++ ++*/ ++ ++/* ********************************************* ++ * ++ * Non-Software Coex Mechanism start ++ * ++ * ********************************************* */ ++void halbtc8192e1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8192e1ant_action_hs(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8192e1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, ++ bt_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ if ((!wifi_connected) && (!coex_sta->wifi_is_high_pri_task)) { ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || ++ (bt_link_info->a2dp_exist)) { ++ /* SCO/HID/A2DP busy */ ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if ((bt_link_info->pan_exist) || (wifi_busy)) { ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ } ++} ++ ++void halbtc8192e1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ /* tdma and coex table */ ++ ++ if (bt_link_info->sco_exist) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } else { /* HID */ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } ++} ++ ++void halbtc8192e1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ u8 bt_rssi_state; ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ bt_rssi_state = halbtc8192e1ant_bt_rssi_state(2, 28, 0); ++ ++ if ((coex_sta->low_priority_rx >= 1000) && ++ (coex_sta->low_priority_rx != 65535)) ++ bt_link_info->slave_role = true; ++ else ++ bt_link_info->slave_role = false; ++ ++ if (bt_link_info->hid_only) { /* HID */ ++ halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, ++ wifi_status); ++ coex_dm->auto_tdma_adjust = false; ++ return; ++ } else if (bt_link_info->a2dp_only) { /* A2DP */ ++ if (BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } else { ++ halbtc8192e1ant_tdma_duration_adjust_for_acl(btcoexist, ++ wifi_status); ++#if 0 ++ if (coex_sta->cck_lock) ++ halbtc8192e1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 3); ++ else ++#endif ++ halbtc8192e1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = true; ++ } ++ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || ++ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { /* HID+A2DP */ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); ++ coex_dm->auto_tdma_adjust = false; ++ ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && ++ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } else { ++ /* BT no-profile busy (0x9) */ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } ++} ++ ++void halbtc8192e1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) ++{ ++ /* power save state */ ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8192e1ant_action_wifi_not_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else if (bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 20); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else if ((BT_8192E_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ /* Bryant Add */ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8192e1ant_action_wifi_not_connected_asso_auth( ++ IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || ++ (bt_link_info->a2dp_exist)) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if (bt_link_info->pan_exist) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8192e1ant_action_wifi_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else if (bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 20); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else if ((BT_8192E_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ /* Bryant Add */ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8192e1ant_action_wifi_connected_specific_packet( ++ IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || ++ (bt_link_info->a2dp_exist)) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if (bt_link_info->pan_exist) { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8192e1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_busy = false; ++ boolean scan = false, link = false, roam = false; ++ boolean under_4way = false, ap_enable = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ if (under_4way) { ++ halbtc8192e1ant_action_wifi_connected_specific_packet(btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8192e1ant_action_wifi_connected_scan(btcoexist); ++ else ++ halbtc8192e1ant_action_wifi_connected_specific_packet( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ /* power save state */ ++ if (!ap_enable && ++ BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status && ++ !btcoexist->bt_link_info.hid_only) { ++ if (btcoexist->bt_link_info.a2dp_only) { /* A2DP */ ++ if (!wifi_busy) ++ halbtc8192e1ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ else { /* busy */ ++ if (coex_sta->scan_ap_num >= ++ BT_8192E_1ANT_WIFI_NOISY_THRESH) /* no force LPS, no PS-TDMA, use pure TDMA */ ++ halbtc8192e1ant_power_save_state( ++ btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ else ++ halbtc8192e1ant_power_save_state( ++ btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ } else if ((coex_sta->pan_exist == false) && ++ (coex_sta->a2dp_exist == false) && ++ (coex_sta->hid_exist == false)) ++ halbtc8192e1ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ else ++ halbtc8192e1ant_power_save_state(btcoexist, ++ BTC_PS_LPS_ON, 0x50, 0x4); ++ } else ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ ++ /* tdma and coex table */ ++ if (!wifi_busy) { ++ if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8192e1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else if ((BT_8192E_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ ++ if ((coex_sta->high_priority_tx) + ++ (coex_sta->high_priority_rx) <= 60) ++ halbtc8192e1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 2); ++ else ++ halbtc8192e1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 7); ++ } ++ } else { ++ if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8192e1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else if ((BT_8192E_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else { ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ ++ if ((coex_sta->high_priority_tx) + ++ (coex_sta->high_priority_rx) <= 60) ++ halbtc8192e1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 2); ++ else ++ halbtc8192e1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 7); ++ } ++ } ++} ++ ++void halbtc8192e1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ u8 algorithm = 0; ++ ++ algorithm = halbtc8192e1ant_action_algorithm(btcoexist); ++ coex_dm->cur_algorithm = algorithm; ++ ++ if (halbtc8192e1ant_is_common_action(btcoexist)) { ++ ++ } else { ++ switch (coex_dm->cur_algorithm) { ++ case BT_8192E_1ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_action_sco(btcoexist); */ ++ break; ++ case BT_8192E_1ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_action_hid(btcoexist); */ ++ break; ++ case BT_8192E_1ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_action_a2dp(btcoexist); */ ++ break; ++ case BT_8192E_1ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_action_a2dp_pan_hs(btcoexist); */ ++ break; ++ case BT_8192E_1ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_action_pan_edr(btcoexist); */ ++ break; ++ case BT_8192E_1ANT_COEX_ALGO_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HS mode.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_action_pan_hs(btcoexist); */ ++ break; ++ case BT_8192E_1ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_action_pan_edr_a2dp(btcoexist); */ ++ break; ++ case BT_8192E_1ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_action_pan_edr_hid(btcoexist); */ ++ break; ++ case BT_8192E_1ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_action_hid_a2dp_pan_edr(btcoexist); */ ++ break; ++ case BT_8192E_1ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_action_hid_a2dp(btcoexist); */ ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = coexist All Off!!\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8192e1ant_coex_all_off(btcoexist); */ ++ break; ++ } ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ } ++} ++ ++void halbtc8192e1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ boolean increase_scan_dev_num = false; ++ boolean bt_ctrl_agg_buf_size = false; ++ boolean miracast_plus_bt = false; ++ u8 agg_buf_size = 5; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if ((BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8192E_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ increase_scan_dev_num = true; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, ++ &increase_scan_dev_num); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if ((num_of_wifi_link >= 2) || ++ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", ++ num_of_wifi_link, wifi_link_status); ++ BTC_TRACE(trace_buf); ++ ++ if (bt_link_info->bt_link_exist) { ++ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, ++ 0, 1); ++ miracast_plus_bt = true; ++ } else { ++ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, ++ 0, 0); ++ miracast_plus_bt = false; ++ } ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if ((bt_link_info->a2dp_exist) && ++ (coex_sta->c2h_bt_inquiry_page)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8192e1ant_action_wifi_multi_port(btcoexist); ++ ++ return; ++ } else { ++ miracast_plus_bt = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ } ++ ++ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { ++ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); ++ ++ if (bt_link_info->sco_exist) ++ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, ++ false, true, 0x5); ++ else ++ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, ++ false, true, 0x8); ++ ++ halbtc8192e1ant_sw_mechanism(btcoexist, true); ++ halbtc8192e1ant_run_sw_coexist_mechanism( ++ btcoexist); /* just print debug message */ ++ } else { ++ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ ++ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x5); ++ ++ halbtc8192e1ant_sw_mechanism(btcoexist, false); ++ halbtc8192e1ant_run_sw_coexist_mechanism( ++ btcoexist); /* just print debug message */ ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8192e1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ ++ if (!wifi_connected) { ++ boolean scan = false, link = false, roam = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is non connected-idle !!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8192e1ant_action_wifi_not_connected_scan( ++ btcoexist); ++ else ++ halbtc8192e1ant_action_wifi_not_connected_asso_auth( ++ btcoexist); ++ } else ++ halbtc8192e1ant_action_wifi_not_connected(btcoexist); ++ } else /* wifi LPS/Busy */ ++ halbtc8192e1ant_action_wifi_connected(btcoexist); ++} ++ ++void halbtc8192e1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ /* force to reset coex mechanism */ ++ ++ /* sw all off */ ++ halbtc8192e1ant_sw_mechanism(btcoexist, false); ++ ++ /* halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ ++ halbtc8192e1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ coex_sta->pop_event_cnt = 0; ++} ++ ++void halbtc8192e1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ u16 u16tmp = 0; ++ u8 u8tmp = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 1Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* antenna sw ctrl to bt */ ++ halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, true, false); ++ ++ halbtc8192e1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ /* antenna switch control parameter */ ++ btcoexist->btc_write_4byte(btcoexist, 0x858, 0x55555555); ++ ++ /* coex parameters */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); ++ /* 0x790[5:0]=0x5 */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); ++ u8tmp &= 0xc0; ++ u8tmp |= 0x5; ++ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); ++ ++ /* enable counter statistics */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); ++ ++ /* enable PTA */ ++ btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); ++ /* enable mailbox interface */ ++ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x40); ++ u16tmp |= BIT(9); ++ btcoexist->btc_write_2byte(btcoexist, 0x40, u16tmp); ++ ++ /* enable PTA I2C mailbox */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x101); ++ u8tmp |= BIT(4); ++ btcoexist->btc_write_1byte(btcoexist, 0x101, u8tmp); ++ ++ /* enable bt clock when wifi is disabled. */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x93); ++ u8tmp |= BIT(0); ++ btcoexist->btc_write_1byte(btcoexist, 0x93, u8tmp); ++ /* enable bt clock when suspend. */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x7); ++ u8tmp |= BIT(0); ++ btcoexist->btc_write_1byte(btcoexist, 0x7, u8tmp); ++} ++ ++ ++/* ++void halbtc8192e1ant_wifi_off_hw_cfg(IN struct btc_coexist* btcoexist) ++{ ++ ++ ++} ++*/ ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8192e1ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8192e1ant_ ++ * ************************************************************ */ ++void ex_halbtc8192e1ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++#if 0 ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 u8tmp = 0x0; ++ u16 u16tmp = 0x0; ++ ++ btcoexist->stop_coex_dm = true; ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x67, 0x20); ++ ++ /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ ++ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); ++ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); ++ ++ /* set GRAN_BT = 1 */ ++ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); ++ /* set WLAN_ACT = 0 */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); ++ ++ /* */ ++ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ ++ /* Local setting bit define */ ++ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ ++ /* BIT1: "0" for internal switch; "1" for external switch */ ++ /* BIT2: "0" for one antenna; "1" for two antenna */ ++ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ ++ if (btcoexist->chip_interface == BTC_INTF_USB) { ++ /* fixed at S0 for USB interface */ ++ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); ++ ++ u8tmp |= 0x1; /* antenna inverse */ ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); ++ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; ++ } else { ++ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ ++ if (board_info->single_ant_path == 0) { ++ /* set to S1 */ ++ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x280); ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; ++ } else if (board_info->single_ant_path == 1) { ++ /* set to S0 */ ++ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); ++ u8tmp |= 0x1; /* antenna inverse */ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; ++ } ++ ++ if (btcoexist->chip_interface == BTC_INTF_PCI) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x384, ++ u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_SDIO) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, ++ u8tmp); ++ } ++#endif ++} ++ ++void ex_halbtc8192e1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) ++{ ++} ++ ++void ex_halbtc8192e1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ halbtc8192e1ant_init_hw_config(btcoexist, wifi_only); ++ btcoexist->stop_coex_dm = false; ++} ++ ++void ex_halbtc8192e1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = false; ++ ++ halbtc8192e1ant_init_coex_dm(btcoexist); ++ ++ halbtc8192e1ant_query_bt_info(btcoexist); ++} ++ ++void ex_halbtc8192e1ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; ++ u32 u32tmp[4]; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ if (btcoexist->stop_coex_dm) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Coex is STOPPED]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", ++ "Ant PG number/ Ant mechanism:", ++ board_info->pg_ant_num, board_info->btdm_ant_num); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", ++ "CoexVer/ FwVer/ PatchVer", ++ glcoex_ver_date_8192e_1ant, glcoex_ver_8192e_1ant, fw_ver, ++ bt_patch_ver, bt_patch_ver); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") ++ : ((BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi, coex_sta->bt_retry_cnt); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", ++ "SCO/HID/PAN/A2DP", ++ bt_link_info->sco_exist, bt_link_info->hid_exist, ++ bt_link_info->pan_exist, bt_link_info->a2dp_exist); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_BT_LINK_INFO); ++ ++ bt_info_ext = coex_sta->bt_info_ext; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "BT Info A2DP rate", ++ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); ++ CL_PRINTF(cli_buf); ++ ++ for (i = 0; i < BT_INFO_SRC_8192E_1ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8192e_1ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ if (!btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms]============"); ++ CL_PRINTF(cli_buf); ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case, ++ coex_dm->auto_tdma_adjust); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", ++ "Latest error condition(should be 0)", ++ coex_dm->error_condition); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", ++ "IgnWlanAct", ++ coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ } ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc04); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xd04); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x90c); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0xc04/ 0xd04/ 0x90c", ++ u32tmp[0], u32tmp[1], u32tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x778", ++ u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x92c); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x930); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x92c/ 0x930", ++ (u8tmp[0]), u32tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x4f); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x40/ 0x4f", ++ u8tmp[0], u8tmp[1]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x550(bcn ctrl)/0x522", ++ u32tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", ++ u32tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", ++ u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770(hp rx[31:16]/tx[15:0])", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(lp rx[31:16]/tx[15:0])", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++#if (BT_AUTO_REPORT_ONLY_8192E_1ANT == 1) ++ halbtc8192e1ant_monitor_bt_ctr(btcoexist); ++#endif ++ ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++void ex_halbtc8192e1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, ++ true); ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = false; ++ ++ halbtc8192e1ant_init_hw_config(btcoexist, false); ++ halbtc8192e1ant_init_coex_dm(btcoexist); ++ halbtc8192e1ant_query_bt_info(btcoexist); ++ } ++} ++ ++void ex_halbtc8192e1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ } ++} ++ ++void ex_halbtc8192e1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ u8 u8tmpa, u8tmpb; ++ u32 u32tmp; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_SCAN_START == type) { ++ coex_sta->wifi_is_high_pri_task = true; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, ++ 8); /* Force antenna setup for no scan result issue */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); ++ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", ++ u32tmp, u8tmpa, u8tmpb); ++ BTC_TRACE(trace_buf); ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ } ++ ++ if (coex_sta->bt_disabled) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ halbtc8192e1ant_query_bt_info(btcoexist); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ if (num_of_wifi_link >= 2) { ++ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ halbtc8192e1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8192e1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8192e1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ if (BTC_SCAN_START == type) { ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8192e1ant_action_wifi_not_connected_scan( ++ btcoexist); ++ else /* wifi is connected */ ++ halbtc8192e1ant_action_wifi_connected_scan(btcoexist); ++ } else if (BTC_SCAN_FINISH == type) { ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8192e1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8192e1ant_action_wifi_connected(btcoexist); ++ } ++} ++ ++void ex_halbtc8192e1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ if (BTC_ASSOCIATE_START == type) { ++ coex_sta->wifi_is_high_pri_task = true; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->arp_cnt = 0; ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ /* coex_dm->arp_cnt = 0; */ ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ if (num_of_wifi_link >= 2) { ++ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ halbtc8192e1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8192e1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8192e1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ if (BTC_ASSOCIATE_START == type) ++ halbtc8192e1ant_action_wifi_not_connected_asso_auth(btcoexist); ++ else if (BTC_ASSOCIATE_FINISH == type) { ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8192e1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8192e1ant_action_wifi_connected(btcoexist); ++ } ++} ++ ++void ex_halbtc8192e1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ boolean wifi_under_b_mode = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ /* Set CCK Tx/Rx high Pri except 11b mode */ ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x00); /* CCK Rx */ ++ } else { ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x10); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x10); /* CCK Rx */ ++ } ++ ++ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, ++ 0x430); ++ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, ++ 0x434); ++ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( ++ btcoexist, 0x42a); ++ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( ++ btcoexist, 0x456); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->arp_cnt = 0; ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ ++ } ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ /* h2c_parameter[0] = 0x1; */ ++ h2c_parameter[0] = 0x0; ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); ++} ++ ++void ex_halbtc8192e1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ if (BTC_PACKET_DHCP == type || ++ BTC_PACKET_EAPOL == type || ++ BTC_PACKET_ARP == type) { ++ if (BTC_PACKET_ARP == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ARP notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_dm->arp_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ARP Packet Count = %d\n", ++ coex_dm->arp_cnt); ++ BTC_TRACE(trace_buf); ++ ++ if (coex_dm->arp_cnt >= ++ 10) /* if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecificPacket(btcoexist) */ ++ coex_sta->wifi_is_high_pri_task = false; ++ else ++ coex_sta->wifi_is_high_pri_task = true; ++ } else { ++ coex_sta->wifi_is_high_pri_task = true; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet DHCP or EAPOL notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet [Type = %d] notify\n", type); ++ BTC_TRACE(trace_buf); ++ } ++ ++ coex_sta->specific_pkt_period_cnt = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ if (num_of_wifi_link >= 2) { ++ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ halbtc8192e1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8192e1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8192e1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ if (BTC_PACKET_DHCP == type || ++ BTC_PACKET_EAPOL == type || ++ ((BTC_PACKET_ARP == type) && (coex_sta->wifi_is_high_pri_task))) ++ halbtc8192e1ant_action_wifi_connected_specific_packet(btcoexist); ++} ++ ++void ex_halbtc8192e1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 bt_info = 0; ++ u8 i, rsp_source = 0; ++ boolean wifi_connected = false; ++ boolean bt_busy = false; ++ ++ coex_sta->c2h_bt_info_req_sent = false; ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8192E_1ANT_MAX) ++ rsp_source = BT_INFO_SRC_8192E_1ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ if (i == 1) ++ bt_info = tmp_buf[i]; ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ if (BT_INFO_SRC_8192E_1ANT_WIFI_FW != rsp_source) { ++ coex_sta->bt_retry_cnt = /* [3:0] */ ++ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; ++ ++ if (coex_sta->bt_retry_cnt >= 1) ++ coex_sta->pop_event_cnt++; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ++ coex_sta->c2h_bt_page = true; ++ else ++ coex_sta->c2h_bt_page = false; ++ ++ coex_sta->bt_rssi = ++ coex_sta->bt_info_c2h[rsp_source][3] * 2 - 90; ++ /* coex_sta->bt_info_c2h[rsp_source][3]*2+10; */ ++ ++ coex_sta->bt_info_ext = ++ coex_sta->bt_info_c2h[rsp_source][4]; ++ ++ coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] ++ & 0x40); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, ++ &coex_sta->bt_tx_rx_mask); ++ if (!coex_sta->bt_tx_rx_mask) { ++ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, ++ 0x3c, 0x15); ++ } ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ if (coex_sta->bt_info_ext & BIT(1)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (wifi_connected) ++ ex_halbtc8192e1ant_media_status_notify( ++ btcoexist, BTC_MEDIA_CONNECT); ++ else ++ ex_halbtc8192e1ant_media_status_notify( ++ btcoexist, BTC_MEDIA_DISCONNECT); ++ } ++ ++ if (coex_sta->bt_info_ext & BIT(3)) { ++ if (!btcoexist->manual_control && ++ !btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e1ant_ignore_wlan_act(btcoexist, ++ FORCE_EXEC, false); ++ } ++ } else { ++ /* BT already NOT ignore Wlan active, do nothing here. */ ++ } ++#if (BT_AUTO_REPORT_ONLY_8192E_1ANT == 0) ++ if ((coex_sta->bt_info_ext & BIT(4))) { ++ /* BT auto report already enabled, do nothing */ ++ } else ++ halbtc8192e1ant_bt_auto_report(btcoexist, FORCE_EXEC, ++ true); ++#endif ++ } ++ ++ /* check BIT2 first ==> check if bt is under inquiry or page scan */ ++ if (bt_info & BT_INFO_8192E_1ANT_B_INQ_PAGE) ++ coex_sta->c2h_bt_inquiry_page = true; ++ else ++ coex_sta->c2h_bt_inquiry_page = false; ++ ++ /* set link exist status */ ++ if (!(bt_info & BT_INFO_8192E_1ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (bt_info & BT_INFO_8192E_1ANT_B_FTP) ++ coex_sta->pan_exist = true; ++ else ++ coex_sta->pan_exist = false; ++ if (bt_info & BT_INFO_8192E_1ANT_B_A2DP) ++ coex_sta->a2dp_exist = true; ++ else ++ coex_sta->a2dp_exist = false; ++ if (bt_info & BT_INFO_8192E_1ANT_B_HID) ++ coex_sta->hid_exist = true; ++ else ++ coex_sta->hid_exist = false; ++ if (bt_info & BT_INFO_8192E_1ANT_B_SCO_ESCO) ++ coex_sta->sco_exist = true; ++ else ++ coex_sta->sco_exist = false; ++ } ++ ++ halbtc8192e1ant_update_bt_link_info(btcoexist); ++ ++ bt_info = bt_info & ++ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ ++ ++ if (!(bt_info & BT_INFO_8192E_1ANT_B_CONNECTION)) { ++ coex_dm->bt_status = BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info == ++ BT_INFO_8192E_1ANT_B_CONNECTION) { /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if ((bt_info & BT_INFO_8192E_1ANT_B_SCO_ESCO) || ++ (bt_info & BT_INFO_8192E_1ANT_B_SCO_BUSY)) { ++ coex_dm->bt_status = BT_8192E_1ANT_BT_STATUS_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info & BT_INFO_8192E_1ANT_B_ACL_BUSY) { ++ if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) ++ coex_dm->auto_tdma_adjust = false; ++ coex_dm->bt_status = BT_8192E_1ANT_BT_STATUS_ACL_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ coex_dm->bt_status = BT_8192E_1ANT_BT_STATUS_MAX; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if ((BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8192E_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ bt_busy = true; ++ else ++ bt_busy = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ halbtc8192e1ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8192e1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u32 u32tmp; ++ u8 u8tmpa, u8tmpb, u8tmpc; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_RF_ON == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned ON!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->stop_coex_dm = false; ++ } else if (BTC_RF_OFF == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned OFF!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, ++ true); ++ ++ halbtc8192e1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ btcoexist->stop_coex_dm = true; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); ++ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ u8tmpc = btcoexist->btc_read_1byte(btcoexist, 0x76e); ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x, 0x76e=0x%x\n", ++ u32tmp, u8tmpa, u8tmpb, u8tmpc); ++ BTC_TRACE(trace_buf); ++ ++ } ++} ++ ++void ex_halbtc8192e1ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, true); ++ ++ halbtc8192e1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ++ ex_halbtc8192e1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++ ++ btcoexist->stop_coex_dm = true; ++} ++ ++void ex_halbtc8192e1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_WIFI_PNP_SLEEP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, ++ true); ++ ++ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ ++ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ ++ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ ++ coex_sta->under_ips = false; ++ coex_sta->under_lps = false; ++ btcoexist->stop_coex_dm = true; ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->stop_coex_dm = false; ++ halbtc8192e1ant_init_hw_config(btcoexist, false); ++ halbtc8192e1ant_init_coex_dm(btcoexist); ++ halbtc8192e1ant_query_bt_info(btcoexist); ++ } ++} ++ ++void ex_halbtc8192e1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], *****************Coex DM Reset*****************\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8192e1ant_init_hw_config(btcoexist, false); ++ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ ++ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x2, 0xfffff, 0x0); */ ++ halbtc8192e1ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8192e1ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++#if (BT_AUTO_REPORT_ONLY_8192E_1ANT == 0) ++ halbtc8192e1ant_query_bt_info(btcoexist); ++ halbtc8192e1ant_monitor_bt_enable_disable(btcoexist); ++#else ++ halbtc8192e1ant_monitor_bt_ctr(btcoexist); ++ halbtc8192e1ant_monitor_wifi_ctr(btcoexist); ++ ++ if (halbtc8192e1ant_is_wifi_status_changed(btcoexist) || ++ coex_dm->auto_tdma_adjust) ++ ++ halbtc8192e1ant_run_coexist_mechanism(btcoexist); ++ ++ coex_sta->specific_pkt_period_cnt++; ++#endif ++} ++ ++ ++void ex_halbtc8192e1ant_dbg_control(IN struct btc_coexist *btcoexist, ++ IN u8 op_code, IN u8 op_len, IN u8 *pdata) ++{ ++ switch (op_code) { ++ case BTC_DBG_SET_COEX_NORMAL: ++ btcoexist->manual_control = false; ++ halbtc8192e1ant_init_coex_dm(btcoexist); ++ break; ++ case BTC_DBG_SET_COEX_WIFI_ONLY: ++ btcoexist->manual_control = true; ++ halbtc8192e1ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 9); ++ break; ++ case BTC_DBG_SET_COEX_BT_ONLY: ++ /* todo */ ++ break; ++ default: ++ break; ++ } ++} ++ ++#endif /* #if (RTL8192E_SUPPORT == 1) */ ++ ++#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ +\ Ingen nyrad vid filslut +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.h 2018-02-11 21:44:27.144146040 +0200 +@@ -0,0 +1,226 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8192E_SUPPORT == 1) ++ ++/* ******************************************* ++ * The following is for 8192E 1ANT BT Co-exist definition ++ * ******************************************* */ ++#define BT_AUTO_REPORT_ONLY_8192E_1ANT 1 ++ ++#define BT_INFO_8192E_1ANT_B_FTP BIT(7) ++#define BT_INFO_8192E_1ANT_B_A2DP BIT(6) ++#define BT_INFO_8192E_1ANT_B_HID BIT(5) ++#define BT_INFO_8192E_1ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8192E_1ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8192E_1ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8192E_1ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8192E_1ANT_B_CONNECTION BIT(0) ++ ++#define BT_INFO_8192E_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ ++ (((_BT_INFO_EXT_&BIT(0))) ? true : false) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT 2 ++ ++#define BT_8192E_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ ++ ++enum bt_info_src_8192e_1ant { ++ BT_INFO_SRC_8192E_1ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8192E_1ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8192E_1ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8192E_1ANT_MAX ++}; ++ ++enum bt_8192e_1ant_bt_status { ++ BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8192E_1ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8192E_1ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8192E_1ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8192E_1ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8192e_1ant_wifi_status { ++ BT_8192E_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8192E_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, ++ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, ++ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, ++ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, ++ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, ++ BT_8192E_1ANT_WIFI_STATUS_MAX ++}; ++ ++enum bt_8192e_1ant_coex_algo { ++ BT_8192E_1ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8192E_1ANT_COEX_ALGO_SCO = 0x1, ++ BT_8192E_1ANT_COEX_ALGO_HID = 0x2, ++ BT_8192E_1ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8192E_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, ++ BT_8192E_1ANT_COEX_ALGO_PANEDR = 0x5, ++ BT_8192E_1ANT_COEX_ALGO_PANHS = 0x6, ++ BT_8192E_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, ++ BT_8192E_1ANT_COEX_ALGO_PANEDR_HID = 0x8, ++ BT_8192E_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, ++ BT_8192E_1ANT_COEX_ALGO_HID_A2DP = 0xa, ++ BT_8192E_1ANT_COEX_ALGO_MAX = 0xb, ++}; ++ ++struct coex_dm_8192e_1ant { ++ /* fw mechanism */ ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean auto_tdma_adjust; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++ ++ /* sw mechanism */ ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ boolean limited_dig; ++ ++ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ ++ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ ++ u16 backup_retry_limit; ++ u8 backup_ampdu_max_time; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ u32 pre_ra_mask; ++ u32 cur_ra_mask; ++ u8 pre_arfr_type; ++ u8 cur_arfr_type; ++ u8 pre_retry_limit_type; ++ u8 cur_retry_limit_type; ++ u8 pre_ampdu_time_type; ++ u8 cur_ampdu_time_type; ++ u32 arp_cnt; ++ ++ u8 error_condition; ++}; ++ ++struct coex_sta_8192e_1ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 specific_pkt_period_cnt; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ s8 bt_rssi; ++ boolean bt_tx_rx_mask; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ boolean c2h_bt_info_req_sent; ++ u8 bt_info_c2h[BT_INFO_SRC_8192E_1ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8192E_1ANT_MAX]; ++ boolean c2h_bt_inquiry_page; ++ boolean c2h_bt_page; /* Add for win8.1 page out issue */ ++ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++ u32 pop_event_cnt; ++ u8 scan_ap_num; ++ ++ u32 crc_ok_cck; ++ u32 crc_ok_11g; ++ u32 crc_ok_11n; ++ u32 crc_ok_11n_agg; ++ ++ u32 crc_err_cck; ++ u32 crc_err_11g; ++ u32 crc_err_11n; ++ u32 crc_err_11n_agg; ++ ++ boolean cck_lock; ++ boolean pre_ccklock; ++ u8 coex_table_type; ++ ++ boolean force_lps_on; ++}; ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8192e1ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8192e1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); ++void ex_halbtc8192e1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8192e1ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8192e1ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8192e1ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8192e1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8192e1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8192e1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8192e1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8192e1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8192e1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8192e1ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8192e1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state); ++void ex_halbtc8192e1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); ++void ex_halbtc8192e1ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8192e1ant_display_coex_info(IN struct btc_coexist *btcoexist); ++void ex_halbtc8192e1ant_dbg_control(IN struct btc_coexist *btcoexist, ++ IN u8 op_code, IN u8 op_len, IN u8 *pdata); ++ ++#else /* #if (RTL8192E_SUPPORT == 1) */ ++#define ex_halbtc8192e1ant_power_on_setting(btcoexist) ++#define ex_halbtc8192e1ant_pre_load_firmware(btcoexist) ++#define ex_halbtc8192e1ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8192e1ant_init_coex_dm(btcoexist) ++#define ex_halbtc8192e1ant_ips_notify(btcoexist, type) ++#define ex_halbtc8192e1ant_lps_notify(btcoexist, type) ++#define ex_halbtc8192e1ant_scan_notify(btcoexist, type) ++#define ex_halbtc8192e1ant_connect_notify(btcoexist, type) ++#define ex_halbtc8192e1ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8192e1ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8192e1ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8192e1ant_rf_status_notify(btcoexist, type) ++#define ex_halbtc8192e1ant_halt_notify(btcoexist) ++#define ex_halbtc8192e1ant_pnp_notify(btcoexist, pnp_state) ++#define ex_halbtc8192e1ant_coex_dm_reset(btcoexist) ++#define ex_halbtc8192e1ant_periodical(btcoexist) ++#define ex_halbtc8192e1ant_display_coex_info(btcoexist) ++#define ex_halbtc8192e1ant_dbg_control(btcoexist, op_code, op_len, pdata) ++ ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.c 2018-02-11 21:44:27.144146040 +0200 +@@ -0,0 +1,4068 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8192E Co-exist mechanism ++ * ++ * History ++ * 2012/11/15 Cosa first check in. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8192E_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8192e_2ant glcoex_dm_8192e_2ant; ++static struct coex_dm_8192e_2ant *coex_dm = &glcoex_dm_8192e_2ant; ++static struct coex_sta_8192e_2ant glcoex_sta_8192e_2ant; ++static struct coex_sta_8192e_2ant *coex_sta = &glcoex_sta_8192e_2ant; ++ ++const char *const glbt_info_src_8192e_2ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++u32 glcoex_ver_date_8192e_2ant = 20160412; ++u32 glcoex_ver_8192e_2ant = 0x42; ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8192e2ant_ ++ * ************************************************************ */ ++u8 halbtc8192e2ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_bt_rssi_state; ++ } ++ ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8192e2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_wifi_rssi_state[index]; ++ } ++ ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8192e2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ ++ /* This function check if bt is disabled */ ++ ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is enabled !!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ bt_disable_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], bt all counters=0, %d times!!\n", ++ bt_disable_cnt); ++ BTC_TRACE(trace_buf); ++ if (bt_disable_cnt >= 2) { ++ bt_disabled = true; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_disabled = bt_disabled; ++ if (!bt_disabled) { ++ } else { ++ } ++ } ++} ++ ++u32 halbtc8192e2ant_decide_ra_mask(IN struct btc_coexist *btcoexist, ++ IN u8 ss_type, IN u32 ra_mask_type) ++{ ++ u32 dis_ra_mask = 0x0; ++ ++ switch (ra_mask_type) { ++ case 0: /* normal mode */ ++ if (ss_type == 2) ++ dis_ra_mask = 0x0; /* enable 2ss */ ++ else ++ dis_ra_mask = 0xfff00000; /* disable 2ss */ ++ break; ++ case 1: /* disable cck 1/2 */ ++ if (ss_type == 2) ++ dis_ra_mask = 0x00000003; /* enable 2ss */ ++ else ++ dis_ra_mask = 0xfff00003; /* disable 2ss */ ++ break; ++ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ ++ if (ss_type == 2) ++ dis_ra_mask = 0x0001f1f7; /* enable 2ss */ ++ else ++ dis_ra_mask = 0xfff1f1f7; /* disable 2ss */ ++ break; ++ default: ++ break; ++ } ++ ++ return dis_ra_mask; ++} ++ ++void halbtc8192e2ant_update_ra_mask(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 dis_rate_mask) ++{ ++ coex_dm->cur_ra_mask = dis_rate_mask; ++ ++ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, ++ &coex_dm->cur_ra_mask); ++ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; ++} ++ ++void halbtc8192e2ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ ++ coex_dm->cur_arfr_type = type; ++ ++ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { ++ switch (coex_dm->cur_arfr_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_4byte(btcoexist, 0x430, ++ coex_dm->backup_arfr_cnt1); ++ btcoexist->btc_write_4byte(btcoexist, 0x434, ++ coex_dm->backup_arfr_cnt2); ++ break; ++ case 1: ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x01010101); ++ } else { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x04030201); ++ } ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; ++} ++ ++void halbtc8192e2ant_retry_limit(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_retry_limit_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_retry_limit_type != ++ coex_dm->cur_retry_limit_type)) { ++ switch (coex_dm->cur_retry_limit_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ coex_dm->backup_retry_limit); ++ break; ++ case 1: /* retry limit=8 */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ 0x0808); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; ++} ++ ++void halbtc8192e2ant_ampdu_max_time(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_ampdu_time_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { ++ switch (coex_dm->cur_ampdu_time_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ coex_dm->backup_ampdu_max_time); ++ break; ++ case 1: /* AMPDU timw = 0x38 * 32us */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ 0x38); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; ++} ++ ++void halbtc8192e2ant_limited_tx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, ++ IN u8 retry_limit_type, IN u8 ampdu_time_type) ++{ ++ u32 dis_ra_mask = 0x0; ++ ++ coex_dm->cur_ra_mask_type = ra_mask_type; ++ dis_ra_mask = halbtc8192e2ant_decide_ra_mask(btcoexist, ++ coex_dm->cur_ss_type, ra_mask_type); ++ halbtc8192e2ant_update_ra_mask(btcoexist, force_exec, dis_ra_mask); ++ ++ halbtc8192e2ant_auto_rate_fallback_retry(btcoexist, force_exec, ++ arfr_type); ++ halbtc8192e2ant_retry_limit(btcoexist, force_exec, retry_limit_type); ++ halbtc8192e2ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); ++} ++ ++void halbtc8192e2ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++ ++ ++} ++ ++void halbtc8192e2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ reg_hp_txrx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx); ++ BTC_TRACE(trace_buf); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ reg_lp_txrx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx); ++ BTC_TRACE(trace_buf); ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++} ++ ++void halbtc8192e2ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ coex_sta->c2h_bt_info_req_sent = true; ++ ++ h2c_parameter[0] |= BIT(0); /* trigger */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); ++} ++ ++boolean halbtc8192e2ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) ++{ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ ++ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); ++ ++ if ((BTC_RSSI_STATE_HIGH == wifi_rssi_state) || (BTC_RSSI_STATE_LOW == wifi_rssi_state)) ++ return true; ++ } ++ ++ return false; ++} ++ ++void halbtc8192e2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if (bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if (!bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++} ++ ++u8 halbtc8192e2ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ struct btc_stack_info *stack_info = &btcoexist->stack_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8192E_2ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (!bt_link_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No BT link exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (bt_link_info->sco_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->hid_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->pan_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 1) { ++ if (bt_link_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; ++ } else { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_2ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_2ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_2ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_2ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_2ANT_COEX_ALGO_SCO_PAN; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ if (stack_info->num_of_hid >= 2) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID*2 + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_2ANT_COEX_ALGO_HID_A2DP; ++ } ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_2ANT_COEX_ALGO_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_2ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_2ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_2ANT_COEX_ALGO_SCO_PAN; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_2ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++void halbtc8192e2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, ++ IN u8 dac_swing_lvl) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ /* There are several type of dacswing */ ++ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ ++ h2c_parameter[0] = dac_swing_lvl; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); ++} ++ ++void halbtc8192e2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN u8 dec_bt_pwr_lvl) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = dec_bt_pwr_lvl; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); ++} ++ ++void halbtc8192e2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 dec_bt_pwr_lvl) ++{ ++ coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; ++ ++ if (!force_exec) { ++#if 0 /* work around, avoid h2c command fail. */ ++ if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) ++ return; ++#endif ++ } ++ halbtc8192e2ant_set_fw_dec_bt_pwr(btcoexist, ++ coex_dm->cur_bt_dec_pwr_lvl); ++ ++ coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; ++} ++ ++void halbtc8192e2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8192e2ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ halbtc8192e2ant_set_bt_auto_report(btcoexist, ++ coex_dm->cur_bt_auto_report); ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++void halbtc8192e2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 fw_dac_swing_lvl) ++{ ++ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_fw_dac_swing_lvl == ++ coex_dm->cur_fw_dac_swing_lvl) ++ return; ++ } ++ ++ halbtc8192e2ant_set_fw_dac_swing_level(btcoexist, ++ coex_dm->cur_fw_dac_swing_lvl); ++ ++ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; ++} ++ ++void halbtc8192e2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist *btcoexist, ++ IN boolean rx_rf_shrink_on) ++{ ++ if (rx_rf_shrink_on) { ++ /* Shrink RF Rx LPF corner */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Shrink RF Rx LPF corner!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff, ++ 0xffffc); ++ } else { ++ /* Resume RF Rx LPF corner */ ++ /* After initialized, we can use coex_dm->bt_rf_0x1e_backup */ ++ if (btcoexist->initilized) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Resume RF Rx LPF corner!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, ++ 0xfffff, coex_dm->bt_rf_0x1e_backup); ++ } ++ } ++} ++ ++void halbtc8192e2ant_rf_shrink(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rx_rf_shrink_on) ++{ ++ coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_rf_rx_lpf_shrink == ++ coex_dm->cur_rf_rx_lpf_shrink) ++ return; ++ } ++ halbtc8192e2ant_set_sw_rf_rx_lpf_corner(btcoexist, ++ coex_dm->cur_rf_rx_lpf_shrink); ++ ++ coex_dm->pre_rf_rx_lpf_shrink = coex_dm->cur_rf_rx_lpf_shrink; ++} ++ ++void halbtc8192e2ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ ++ ++ if (low_penalty_ra) { ++ h2c_parameter[1] |= BIT(0); ++ h2c_parameter[2] = ++ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ ++ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ ++ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ ++ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); ++} ++ ++void halbtc8192e2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ halbtc8192e2ant_set_sw_penalty_tx_rate_adaptive(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++} ++ ++void halbtc8192e2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, ++ IN u32 level) ++{ ++ u8 val = (u8)level; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Write SwDacSwing = 0x%x\n", level); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x883, 0x3e, val); ++} ++ ++void halbtc8192e2ant_set_sw_full_time_dac_swing(IN struct btc_coexist ++ *btcoexist, IN boolean sw_dac_swing_on, IN u32 sw_dac_swing_lvl) ++{ ++ if (sw_dac_swing_on) ++ halbtc8192e2ant_set_dac_swing_reg(btcoexist, sw_dac_swing_lvl); ++ else ++ halbtc8192e2ant_set_dac_swing_reg(btcoexist, 0x18); ++} ++ ++ ++void halbtc8192e2ant_dac_swing(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) ++{ ++ coex_dm->cur_dac_swing_on = dac_swing_on; ++ coex_dm->cur_dac_swing_lvl = dac_swing_lvl; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_dac_swing_on == coex_dm->cur_dac_swing_on) && ++ (coex_dm->pre_dac_swing_lvl == ++ coex_dm->cur_dac_swing_lvl)) ++ return; ++ } ++ delay_ms(30); ++ halbtc8192e2ant_set_sw_full_time_dac_swing(btcoexist, dac_swing_on, ++ dac_swing_lvl); ++ ++ coex_dm->pre_dac_swing_on = coex_dm->cur_dac_swing_on; ++ coex_dm->pre_dac_swing_lvl = coex_dm->cur_dac_swing_lvl; ++} ++ ++void halbtc8192e2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, ++ IN boolean adc_back_off) ++{ ++ if (adc_back_off) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB BackOff Level On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc05, 0x30, 0x3); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB BackOff Level Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc05, 0x30, 0x1); ++ } ++} ++ ++void halbtc8192e2ant_adc_back_off(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean adc_back_off) ++{ ++ coex_dm->cur_adc_back_off = adc_back_off; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) ++ return; ++ } ++ halbtc8192e2ant_set_adc_back_off(btcoexist, coex_dm->cur_adc_back_off); ++ ++ coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; ++} ++ ++void halbtc8192e2ant_set_agc_table(IN struct btc_coexist *btcoexist, ++ IN boolean agc_table_en) ++{ ++ /* =================BB AGC Gain Table */ ++ if (agc_table_en) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB Agc Table On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x0a1A0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x091B0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x081C0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x071D0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x061E0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x051F0001); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB Agc Table Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xaa1A0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa91B0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa81C0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa71D0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa61E0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa51F0001); ++ } ++} ++ ++void halbtc8192e2ant_agc_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean agc_table_en) ++{ ++ coex_dm->cur_agc_table_en = agc_table_en; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) ++ return; ++ } ++ halbtc8192e2ant_set_agc_table(btcoexist, agc_table_en); ++ ++ coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; ++} ++ ++void halbtc8192e2ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8192e2ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ halbtc8192e2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8192e2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ switch (type) { ++ case 0: ++ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 1: ++ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 2: ++ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 3: ++ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5fdf5fdf, 0x5fdb5fdb, 0xffffff, 0x3); ++ break; ++ case 4: ++ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0xdfffdfff, 0x5ffb5ffb, 0xffffff, 0x3); ++ break; ++ case 5: ++ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5ddd5ddd, 0x5fdb5fdb, 0xffffff, 0x3); ++ break; ++ case 6: ++ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5fff5fff, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 7: ++ if (coex_sta->scan_ap_num <= NOISY_AP_NUM_THRESH_8192E) ++ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0xffffffff, 0xfafafafa, 0xffffff, 0x3); ++ else ++ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0xffffffff, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 8: ++ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5f5f5f5f, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8192e2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ if (enable) { ++ h2c_parameter[0] |= BIT(0); /* function enable */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); ++} ++ ++void halbtc8192e2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ halbtc8192e2ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8192e2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8192e2ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8192e2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8192e2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ u8 realByte1 = byte1, realByte5 = byte5; ++ boolean bApEnable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); ++ ++ if (bApEnable) { ++ if ((byte1 & BIT4) && !(byte1 & BIT5)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], FW for 1Ant AP mode\n"); ++ realByte1 &= ~BIT4; ++ realByte1 |= BIT5; ++ ++ realByte5 |= BIT5; ++ realByte5 &= ~BIT6; ++ } ++ } ++ ++ h2c_parameter[0] = byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = byte5; ++ ++ coex_dm->ps_tdma_para[0] = byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++void halbtc8192e2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, ++ IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, ++ IN boolean limited_dig, IN boolean bt_lna_constrain) ++{ ++ /* ++ u32 wifi_bw; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if(BTC_WIFI_BW_HT40 != wifi_bw) ++ { ++ if (shrink_rx_lpf) ++ shrink_rx_lpf = false; ++ } ++ */ ++ ++ halbtc8192e2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); ++ /* halbtc8192e2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); */ ++} ++ ++void halbtc8192e2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, ++ IN boolean agc_table_shift, IN boolean adc_back_off, ++ IN boolean sw_dac_swing, IN u32 dac_swing_lvl) ++{ ++ halbtc8192e2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); ++ /* halbtc8192e2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */ ++ halbtc8192e2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, ++ dac_swing_lvl); ++} ++ ++void halbtc8192e2ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) ++{ ++ u32 u32tmp = 0; ++ ++ if (init_hwcfg) { ++ btcoexist->btc_write_1byte(btcoexist, 0x944, 0x24); ++ btcoexist->btc_write_4byte(btcoexist, 0x930, 0x700700); ++ if (btcoexist->chip_interface == BTC_INTF_USB) ++ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30430004); ++ else ++ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30030004); ++ ++ /* 0x4c[27][24]='00', Set Antenna to BB */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp &= ~BIT(24); ++ u32tmp &= ~BIT(27); ++ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); ++ } else if (wifi_off) { ++ if (btcoexist->chip_interface == BTC_INTF_USB) ++ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30430004); ++ else ++ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30030004); ++ ++ /* 0x4c[27][24]='11', Set Antenna to BT, 0x64[8:7]=0, 0x64[2]=1 */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp |= BIT(24); ++ u32tmp |= BIT(27); ++ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); ++ } ++ ++ /* ext switch setting */ ++ switch (ant_pos_type) { ++ case BTC_ANT_PATH_WIFI: ++ btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x4); ++ break; ++ case BTC_ANT_PATH_BT: ++ btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x20); ++ break; ++ default: ++ case BTC_ANT_PATH_PTA: ++ btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x4); ++ break; ++ } ++} ++ ++void halbtc8192e2ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ s8 nWiFiDurationAdjust = 0x0; ++ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ return; ++ } ++ ++ if (coex_sta->scan_ap_num >= 40) ++ nWiFiDurationAdjust = -15; ++ else if (coex_sta->scan_ap_num >= 20) ++ nWiFiDurationAdjust = -10; ++ ++ if (turn_on) { ++ switch (type) { ++ case 1: ++ default: /*d1,wb*/ ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x3c, 0x03, 0x11, 0x10); ++ break; ++ case 2: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x32, 0x03, 0x11, 0x10); ++ break; ++ case 3: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x28, 0x03, 0x11, 0x10); ++ break; ++ case 4: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1e, 0x03, 0x11, 0x10); ++ break; ++ case 5: /*d1,pb,TXpause*/ ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x3c, 0x03, 0x90, 0x10); ++ break; ++ case 6: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x32, 0x03, 0x90, 0x10); ++ break; ++ case 7: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x28, 0x03, 0x90, 0x10); ++ break; ++ case 8: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x1e, 0x03, 0x90, 0x10); ++ break; ++ case 9: /*d1,bb*/ ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x3c, 0x03, 0x31, 0x10); ++ break; ++ case 10: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x32, 0x03, 0x31, 0x10); ++ break; ++ case 11: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x28, 0x03, 0x31, 0x10); ++ break; ++ case 12: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1e, 0x03, 0x31, 0x10); ++ break; ++ case 13: /*d1,bb,TXpause*/ ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x3c, 0x03, 0x30, 0x10); ++ break; ++ case 14: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x32, 0x03, 0x30, 0x10); ++ break; ++ case 15: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x28, 0x03, 0x30, 0x10); ++ break; ++ case 16: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1e, 0x03, 0x30, 0x10); ++ break; ++ case 17: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x61, 0x20, 0x03, 0x10, 0x10); ++ break; ++ case 18: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); ++ break; ++ case 19: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x25, 0x25, 0xe1, 0x90); ++ break; ++ case 20: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x25, 0x25, 0x60, 0x90); ++ break; ++ case 21: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x61, 0x35, 0x03, 0x11, 0x11); ++ break; ++ case 22: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, 0x03, 0x11, 0x14); ++ break; ++ case 23: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x14, 0x03, 0x90, 0x14); ++ break; ++ case 24: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, 0x03, 0x31, 0x14); ++ break; ++ case 25: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, 0x03, 0x30, 0x14); ++ break; ++ case 71: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); ++ break; ++ case 80: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x3c, 0x3, 0x10, 0x50); ++ break; ++ case 81: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x3a+nWiFiDurationAdjust, 0x3, 0x10, 0x50); ++ break; ++ case 82: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x30+nWiFiDurationAdjust, 0x03, 0x10, 0x50); ++ break; ++ case 83: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x21, 0x03, 0x10, 0x50); ++ break; ++ case 84: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x15, 0x3, 0x10, 0x50); ++ break; ++ case 85: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x3a, 0x03, 0x10, 0x50); ++ break; ++ case 86: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x21, 0x03, 0x10, 0x50); ++ break; ++ case 87: ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x14, 0x03, 0x10, 0x54); ++ break; ++ ++ } ++ } else { ++ /* disable PS tdma */ ++ switch (type) { ++ default: ++ case 0: /* ANT2PTA, 0x778=1 */ ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x8, ++ 0x0, 0x0, 0x0, 0x0); ++ halbtc8192e2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_PTA, false, false); ++ break; ++ case 1: /* ANT2BT, 0x778=3 */ ++ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x8, 0x0); ++ delay_ms(5); ++ halbtc8192e2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_BT, false, false); ++ break; ++ ++ } ++ } ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++void halbtc8192e2ant_set_switch_ss_type(IN struct btc_coexist *btcoexist, ++ IN u8 ss_type) ++{ ++ u8 mimo_ps = BTC_MIMO_PS_DYNAMIC; ++ u32 dis_ra_mask = 0x0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], REAL set SS Type = %d\n", ss_type); ++ BTC_TRACE(trace_buf); ++ ++ dis_ra_mask = halbtc8192e2ant_decide_ra_mask(btcoexist, ss_type, ++ coex_dm->cur_ra_mask_type); ++ halbtc8192e2ant_update_ra_mask(btcoexist, FORCE_EXEC, dis_ra_mask); ++ ++ if (ss_type == 1) { ++ halbtc8192e2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); ++ /* switch ofdm path */ ++ btcoexist->btc_write_1byte(btcoexist, 0xc04, 0x11); ++ btcoexist->btc_write_1byte(btcoexist, 0xd04, 0x1); ++ btcoexist->btc_write_4byte(btcoexist, 0x90c, 0x81111111); ++ /* switch cck patch */ ++ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0xe77, 0x4, 0x1); */ ++ /* btcoexist->btc_write_1byte(btcoexist, 0xa07, 0x81); */ ++ mimo_ps = BTC_MIMO_PS_STATIC; ++ } else if (ss_type == 2) { ++ halbtc8192e2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ btcoexist->btc_write_1byte(btcoexist, 0xc04, 0x33); ++ btcoexist->btc_write_1byte(btcoexist, 0xd04, 0x3); ++ btcoexist->btc_write_4byte(btcoexist, 0x90c, 0x81121313); ++ /* remove, if 0xe77[2]=0x0 then CCK will fail, advised by Jenyu */ ++ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0xe77, 0x4, 0x0); */ ++ /* btcoexist->btc_write_1byte(btcoexist, 0xa07, 0x41); */ ++ mimo_ps = BTC_MIMO_PS_DYNAMIC; ++ } ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_SEND_MIMO_PS, ++ &mimo_ps); /* set rx 1ss or 2ss */ ++} ++ ++void halbtc8192e2ant_switch_ss_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 new_ss_type) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], %s Switch SS Type = %d\n", ++ (force_exec ? "force to" : ""), new_ss_type); ++ BTC_TRACE(trace_buf); ++ coex_dm->cur_ss_type = new_ss_type; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ss_type == coex_dm->cur_ss_type) ++ return; ++ } ++ halbtc8192e2ant_set_switch_ss_type(btcoexist, coex_dm->cur_ss_type); ++ ++ coex_dm->pre_ss_type = coex_dm->cur_ss_type; ++} ++ ++void halbtc8192e2ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++void halbtc8192e2ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ boolean low_pwr_disable = false; ++ boolean bApEnable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); ++ ++ if (bApEnable) { ++ ps_type = BTC_PS_WIFI_NATIVE; ++ lps_val = 0x0; ++ rpwm_val = 0x0; ++ } ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ break; ++ case BTC_PS_LPS_ON: ++ halbtc8192e2ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8192e2ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ break; ++ default: ++ break; ++ } ++} ++ ++ ++void halbtc8192e2ant_coex_all_off(IN struct btc_coexist *btcoexist) ++{ ++ /* fw all off */ ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ /* hw all off */ ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8192e2ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ /* force to reset coex mechanism */ ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); ++ ++ halbtc8192e2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ halbtc8192e2ant_switch_ss_type(btcoexist, FORCE_EXEC, 2); ++ ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++void halbtc8192e2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ ++ ++/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 1);*/ ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++boolean halbtc8192e2ant_is_common_action(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean common = false, wifi_connected = false, wifi_busy = false; ++ boolean bt_hs_on = false, low_pwr_disable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (bt_link_info->sco_exist || bt_link_info->hid_exist) ++ halbtc8192e2ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 0, 0, 0); ++ else ++ halbtc8192e2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ ++ if (!wifi_connected) { ++ ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non-connected idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ if ((BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) || ++ (BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 2);*/ ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else { ++/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 1);*/ ++ halbtc8192e2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 1); ++ } ++ ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, ++ false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, ++ 0x18); ++ ++ common = true; ++ } else { ++ if (BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 2);*/ ++ ++ halbtc8192e2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, ++ 6); ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++ common = true; ++ } else if (BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ ++ if (bt_hs_on) ++ return false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 2);*/ ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, ++ 6); ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++ common = true; ++ } else { ++ ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ common = false; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 1);*/ ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 21); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, ++ NORMAL_EXEC, 6); ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, ++ NORMAL_EXEC, 0); ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, ++ false, false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ common = true; ++ } ++ } ++ } ++ ++ return common; ++} ++void halbtc8192e2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, ++ IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) ++{ ++ static s32 up, dn, m, n, wait_count; ++ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ ++ u8 retry_count = 0; ++ ++ ++ if (!coex_dm->auto_tdma_adjust) { ++ coex_dm->auto_tdma_adjust = true; ++ { ++ if (sco_hid) { ++ if (tx_pause) { ++ if (max_interval == 1) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 13); ++ coex_dm->ps_tdma_du_adj_type = ++ 13; ++ } else if (max_interval == 2) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (max_interval == 3) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } ++ } else { ++ if (max_interval == 1) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = ++ 9; ++ } else if (max_interval == 2) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (max_interval == 3) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } ++ } ++ } else { ++ if (tx_pause) { ++ if (max_interval == 1) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 5); ++ coex_dm->ps_tdma_du_adj_type = ++ 5; ++ } else if (max_interval == 2) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (max_interval == 3) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } ++ } else { ++ if (max_interval == 1) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (max_interval == 2) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (max_interval == 3) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } ++ } ++ } ++ } ++ /* ============ */ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n = 3; ++ result = 0; ++ wait_count = 0; ++ } else { ++ /* accquire the BT TRx retry count from BT_Info byte2 */ ++ retry_count = coex_sta->bt_retry_cnt; ++ result = 0; ++ wait_count++; ++ ++ if (retry_count == ++ 0) { /* no retry in the last 2-second duration */ ++ up++; ++ dn--; ++ ++ if (dn <= 0) ++ dn = 0; ++ ++ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ ++ wait_count = 0; ++ n = 3; ++ up = 0; ++ dn = 0; ++ result = 1; ++ } ++ } else if (retry_count <= ++ 3) { /* <=3 retry in the last 2-second duration */ ++ up--; ++ dn++; ++ ++ if (up <= 0) ++ up = 0; ++ ++ if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ ++ if (wait_count <= 2) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ ++ if (wait_count == 1) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ ++ if (max_interval == 1) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 5); ++ coex_dm->ps_tdma_du_adj_type = 5; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 13); ++ coex_dm->ps_tdma_du_adj_type = 13; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 5); ++ coex_dm->ps_tdma_du_adj_type = ++ 5; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 13); ++ coex_dm->ps_tdma_du_adj_type = ++ 13; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 1); ++ coex_dm->ps_tdma_du_adj_type = 1; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 71); ++ coex_dm->ps_tdma_du_adj_type = ++ 71; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = ++ 9; ++ } ++ } ++ } ++ } else if (max_interval == 2) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } ++ } ++ } ++ } else if (max_interval == 3) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8192e2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8192e2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } ++ } ++ } ++ } ++ } ++ ++ /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ ++ /* then we have to adjust it back to the previous record one. */ ++ if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { ++ boolean scan = false, link = false, roam = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", ++ coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (!scan && !link && !roam) ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ coex_dm->ps_tdma_du_adj_type); ++ else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } ++} ++ ++/* ****************** ++ * pstdma for wifi rssi low ++ * ****************** */ ++void halbtc8192e2ant_tdma_duration_adjust_for_wifi_rssi_low( ++ IN struct btc_coexist *btcoexist/* , */ /* IN u8 wifi_status */) ++{ ++ static s32 up, dn, m, n, wait_count; ++ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ ++ u8 retry_count = 0, bt_info_ext; ++ ++ coex_dm->auto_tdma_adjust = false; ++ ++ retry_count = coex_sta->bt_retry_cnt; ++ bt_info_ext = coex_sta->bt_info_ext; ++ ++ if (!coex_dm->auto_tdma_adjust_low_rssi) { ++ coex_dm->auto_tdma_adjust_low_rssi = true; ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 81); ++ coex_dm->ps_tdma_du_adj_type = 81; ++ /* ============ */ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n = 3; ++ result = 0; ++ wait_count = 0; ++ } else { ++ /*acquire the BT TRx retry count from BT_Info byte2*/ ++ /* retry_count = coex_sta->bt_retry_cnt;*/ ++ /* bt_info_ext = coex_sta->bt_info_ext; */ ++ result = 0; ++ wait_count++; ++ ++ if ((coex_sta->low_priority_tx) > 1050 || ++ (coex_sta->low_priority_rx) > 1250) ++ retry_count++; ++ ++ if (retry_count == ++ 0) { /* no retry in the last 2-second duration */ ++ up++; ++ dn--; ++ ++ if (dn <= 0) ++ dn = 0; ++ ++ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ ++ wait_count = 0; ++ n = 3; ++ up = 0; ++ dn = 0; ++ result = 1; ++ } ++ } else if (retry_count <= ++ 3) { /* <=3 retry in the last 2-second duration */ ++ up--; ++ dn++; ++ ++ if (up <= 0) ++ up = 0; ++ ++ if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ ++ if (wait_count <= 2) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ ++ if (wait_count == 1) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 80) { ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 81); ++ coex_dm->ps_tdma_du_adj_type = 81; ++ } else if (coex_dm->cur_ps_tdma == 81) { ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 82); ++ coex_dm->ps_tdma_du_adj_type = 82; ++ } else if (coex_dm->cur_ps_tdma == 82) { ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 83); ++ coex_dm->ps_tdma_du_adj_type = 83; ++ } else if (coex_dm->cur_ps_tdma == 83) { ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 84); ++ coex_dm->ps_tdma_du_adj_type = 84; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 84) { ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 83); ++ coex_dm->ps_tdma_du_adj_type = 83; ++ } else if (coex_dm->cur_ps_tdma == 83) { ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 82); ++ coex_dm->ps_tdma_du_adj_type = 82; ++ } else if (coex_dm->cur_ps_tdma == 82) { ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 81); ++ coex_dm->ps_tdma_du_adj_type = 81; ++ } else if ((coex_dm->cur_ps_tdma == 81) && (coex_sta->scan_ap_num <= 5)) { ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 81); ++ coex_dm->ps_tdma_du_adj_type = 81; ++ } ++ } ++ ++ if (coex_dm->cur_ps_tdma != 80 && ++ coex_dm->cur_ps_tdma != 81 && ++ coex_dm->cur_ps_tdma != 82 && ++ coex_dm->cur_ps_tdma != 83 && ++ coex_dm->cur_ps_tdma != 84) { ++ /* recover to previous adjust type */ ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ coex_dm->ps_tdma_du_adj_type); ++ } ++ } ++} ++ ++ ++void halbtc8192e2ant_get_bt_rssi_threshold(IN struct btc_coexist *btcoexist, ++ IN u8 *pThres0, IN u8 *pThres1) ++{ ++ u8 ant_type; ++ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ ant_type = board_info->ant_type; ++ ++ switch (ant_type) { ++ case BTC_ANT_TYPE_0: ++ *pThres0 = 100; ++ *pThres1 = 100; ++ break; ++ case BTC_ANT_TYPE_1: ++ *pThres0 = 34; ++ *pThres1 = 42; ++ break; ++ case BTC_ANT_TYPE_2: ++ *pThres0 = 34; ++ *pThres1 = 42; ++ break; ++ case BTC_ANT_TYPE_3: ++ *pThres0 = 34; ++ *pThres1 = 42; ++ break; ++ case BTC_ANT_TYPE_4: ++ *pThres0 = 34; ++ *pThres1 = 42; ++ break; ++ default: ++ break; ++ } ++} ++ ++ ++ ++ ++/* SCO only or SCO+PAN(HS) */ ++void halbtc8192e2ant_action_sco(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ u32 wifi_bw; ++ u8 btThresh0 = 0, btThresh1 = 0; ++ ++ halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); ++ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); ++ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ else ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ else ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ else ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++void halbtc8192e2ant_action_sco_pan(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ u32 wifi_bw; ++ u8 btThresh0 = 0, btThresh1 = 0; ++ ++ ++ halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); ++ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); ++ ++ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); ++ ++ if ((BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ else ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ else ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 10); ++ else ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); ++ ++ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ else ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++ ++void halbtc8192e2ant_action_hid(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 anttype = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); ++ ++ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); ++ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); ++ ++ if (anttype == 0) { ++ /*ANTTYPE = 0 92E 2ant with SPDT*/ ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if (anttype == 1) { ++ /*92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation*/ ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if (anttype == 2) { ++ /*ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation*/ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ } else { ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ } ++ } else if (anttype == 3) { ++ /*ANTTYPE = 3, 92E 3ant with good ant. isolation*/ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else { ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } ++ } ++ ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ ++void halbtc8192e2ant_action_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ boolean long_dist = false; ++ u8 anttype = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); ++ ++ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); ++ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); ++ ++ if (anttype == 0) { ++ /*ANTTYPE = 0 92E 2ant with SPDT*/ ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ } else if (anttype == 1) { ++ /*92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation*/ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 25); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ } else { ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ } ++ } else if (anttype == 2) { ++ /*ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation*/ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } else { ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ } ++ } else if (anttype == 3) { ++ /*ANTTYPE = 3, 92E 3ant with good ant. isolation*/ ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } ++ ++ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, true, 0x06); ++ else ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++void halbtc8192e2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 15, 0); ++ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); ++ ++ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { ++ halbtc8192e2ant_tdma_duration_adjust(btcoexist, false, true, 2); ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ } else if ((bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { ++ halbtc8192e2ant_tdma_duration_adjust(btcoexist, false, false, 2); ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ } else if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8192e2ant_tdma_duration_adjust(btcoexist, false, false, 2); ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ } ++ ++ /* sw mechanism */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, true, false, true, 0x6); ++ } else { ++ halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, true, 0x6); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, true, false, true, 0x6); ++ } else { ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, true, 0x6); ++ } ++ } ++} ++ ++void halbtc8192e2ant_action_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 btThresh0 = 0, btThresh1 = 0; ++ ++ halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); ++ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); ++ /*wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0);*/ ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ else ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); ++ else ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 85); ++ ++ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ else ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++/* PAN(HS) only */ ++void halbtc8192e2ant_action_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 15, ++ 0); ++ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); ++ ++ /* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 1);*/ ++ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ else if ((bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++/* PAN(EDR)+A2DP */ ++void halbtc8192e2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 btThresh0 = 0, btThresh1 = 0; ++ ++ halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); ++ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); ++ /*wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0);*/ ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ ++ if ((BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ else ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 4); ++ else ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); ++ ++ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ else ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++} ++ ++void halbtc8192e2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 btThresh0 = 0, btThresh1 = 0; ++ ++ halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); ++ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); ++ ++ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); ++ ++ if ((BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ else ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ else ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 10); ++ else ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); ++ ++ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ else ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ ++} ++ ++/* HID+A2DP+PAN(EDR) */ ++void halbtc8192e2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 btThresh0 = 0, btThresh1 = 0; ++ ++ halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); ++ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); ++ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); ++ ++ if ((BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ else ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ else ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 4); ++ else ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); ++ ++ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ else ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++void halbtc8192e2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 btThresh0 = 0, btThresh1 = 0, anttype = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); ++ ++ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); ++ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); ++ ++ if (anttype == 0) { ++ /*92E 2ant with SPDT*/ ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ ++ } else if (anttype == 1) { ++ /*92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation*/ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 25); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ } else { ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ } ++ } else if (anttype == 2) { ++ /*ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation*/ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 25); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ } else { ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ } ++ } else if (anttype == 3) { ++ /*ANTTYPE = 3, 92E 3ant with good ant. isolation*/ ++ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } ++ ++ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && ++ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, true, 0x06); ++ else ++ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++void halbtc8192e2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ u8 algorithm = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ algorithm = halbtc8192e2ant_action_algorithm(btcoexist); ++ if (coex_sta->c2h_bt_inquiry_page && ++ (BT_8192E_2ANT_COEX_ALGO_PANHS != algorithm)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under inquiry/page scan !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_action_bt_inquiry(btcoexist); ++ return; ++ } ++ ++ coex_dm->cur_algorithm = algorithm; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", ++ coex_dm->cur_algorithm); ++ BTC_TRACE(trace_buf); ++ ++ if (halbtc8192e2ant_is_common_action(btcoexist)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant common.\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->auto_tdma_adjust = false; ++ coex_dm->auto_tdma_adjust_low_rssi = false; ++ ++ } else { ++ if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", ++ coex_dm->pre_algorithm, coex_dm->cur_algorithm); ++ BTC_TRACE(trace_buf); ++ coex_dm->auto_tdma_adjust = false; ++ coex_dm->auto_tdma_adjust_low_rssi = false; ++ ++ } ++ switch (coex_dm->cur_algorithm) { ++ case BT_8192E_2ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_action_sco(btcoexist); ++ break; ++ case BT_8192E_2ANT_COEX_ALGO_SCO_PAN: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = SCO+PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_action_sco_pan(btcoexist); ++ break; ++ case BT_8192E_2ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_action_hid(btcoexist); ++ break; ++ case BT_8192E_2ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_action_a2dp(btcoexist); ++ break; ++ case BT_8192E_2ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_action_a2dp_pan_hs(btcoexist); ++ break; ++ case BT_8192E_2ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_action_pan_edr(btcoexist); ++ break; ++ case BT_8192E_2ANT_COEX_ALGO_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_action_pan_hs(btcoexist); ++ break; ++ case BT_8192E_2ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_action_pan_edr_a2dp(btcoexist); ++ break; ++ case BT_8192E_2ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_action_pan_edr_hid(btcoexist); ++ break; ++ case BT_8192E_2ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_action_hid_a2dp_pan_edr( ++ btcoexist); ++ break; ++ case BT_8192E_2ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_action_hid_a2dp(btcoexist); ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = unknown!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_coex_all_off(btcoexist); ++ break; ++ } ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ } ++} ++ ++void halbtc8192e2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean back_up) ++{ ++ u16 u16tmp = 0; ++ u8 u8tmp = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 2Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (back_up) { ++ /* backup rf 0x1e value */ ++ coex_dm->bt_rf_0x1e_backup = ++ btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x1e, ++ 0xfffff); ++ ++ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, ++ 0x430); ++ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, ++ 0x434); ++ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( ++ btcoexist, 0x42a); ++ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( ++ btcoexist, 0x456); ++ } ++ ++ /* antenna sw ctrl to bt */ ++ halbtc8192e2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, true, false); ++ ++ halbtc8192e2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ /* antenna switch control parameter */ ++ btcoexist->btc_write_4byte(btcoexist, 0x858, 0x55555555); ++ ++ /* coex parameters */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); ++ /* 0x790[5:0]=0x5 */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); ++ u8tmp &= 0xc0; ++ u8tmp |= 0x5; ++ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); ++ ++ /* enable counter statistics */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); ++ ++ /* enable PTA */ ++ btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); ++ /* enable mailbox interface */ ++ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x40); ++ u16tmp |= BIT(9); ++ btcoexist->btc_write_2byte(btcoexist, 0x40, u16tmp); ++ ++ /* enable PTA I2C mailbox */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x101); ++ u8tmp |= BIT(4); ++ btcoexist->btc_write_1byte(btcoexist, 0x101, u8tmp); ++ ++ /* enable bt clock when wifi is disabled. */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x93); ++ u8tmp |= BIT(0); ++ btcoexist->btc_write_1byte(btcoexist, 0x93, u8tmp); ++ /* enable bt clock when suspend. */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x7); ++ u8tmp |= BIT(0); ++ btcoexist->btc_write_1byte(btcoexist, 0x7, u8tmp); ++} ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8192e2ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8192e2ant_ ++ * ************************************************************ */ ++void ex_halbtc8192e2ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++} ++ ++void ex_halbtc8192e2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ halbtc8192e2ant_init_hw_config(btcoexist, true); ++} ++ ++void ex_halbtc8192e2ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8192e2ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8192e2ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_stack_info *stack_info = &btcoexist->stack_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; ++ u16 u16tmp[4]; ++ u32 u32tmp[4]; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", ++ "Ant PG number/ Ant mechanism:", ++ board_info->pg_ant_num, board_info->btdm_ant_num); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Antenna type:", ++ board_info->ant_type); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", ++ "CoexVer/ FwVer/ PatchVer", ++ glcoex_ver_date_8192e_2ant, glcoex_ver_8192e_2ant, fw_ver, ++ bt_patch_ver, bt_patch_ver); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") ++ : ((BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi, coex_sta->bt_retry_cnt); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", ++ "SCO/HID/PAN/A2DP", ++ stack_info->sco_exist, stack_info->hid_exist, ++ stack_info->pan_exist, stack_info->a2dp_exist); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_BT_LINK_INFO); ++ ++ bt_info_ext = coex_sta->bt_info_ext; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "BT Info A2DP rate", ++ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); ++ CL_PRINTF(cli_buf); ++ ++ for (i = 0; i < BT_INFO_SRC_8192E_2ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8192e_2ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "SS Type", ++ coex_dm->cur_ss_type); ++ CL_PRINTF(cli_buf); ++ ++ /* Sw mechanism */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Sw mechanism]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", ++ "SM1[ShRf/ LpRA/ LimDig]", ++ coex_dm->cur_rf_rx_lpf_shrink, coex_dm->cur_low_penalty_ra, ++ coex_dm->limited_dig); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", ++ "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", ++ coex_dm->cur_agc_table_en, coex_dm->cur_adc_back_off, ++ coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); ++ CL_PRINTF(cli_buf); ++ ++ /* Fw mechanism */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Fw mechanism]============"); ++ CL_PRINTF(cli_buf); ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case, ++ coex_dm->auto_tdma_adjust); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", ++ "DecBtPwr/ IgnWlanAct", ++ coex_dm->cur_bt_dec_pwr_lvl, coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", ++ "RF-A, 0x1e initVal", ++ coex_dm->bt_rf_0x1e_backup); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "backup ARFR1/ARFR2/RL/AMaxTime", ++ coex_dm->backup_arfr_cnt1, coex_dm->backup_arfr_cnt2, ++ coex_dm->backup_retry_limit, ++ coex_dm->backup_ampdu_max_time); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); ++ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "0x430/0x434/0x42a/0x456", ++ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc04); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xd04); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x90c); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0xc04/ 0xd04/ 0x90c", ++ u32tmp[0], u32tmp[1], u32tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x778", ++ u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x92c); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x930); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x92c/ 0x930", ++ (u8tmp[0]), u32tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x4f); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x40/ 0x4f", ++ u8tmp[0], u8tmp[1]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x550(bcn ctrl)/0x522", ++ u32tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", ++ u32tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", ++ u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770(hp rx[31:16]/tx[15:0])", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(lp rx[31:16]/tx[15:0])", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++#if (BT_AUTO_REPORT_ONLY_8192E_2ANT == 1) ++ halbtc8192e2ant_monitor_bt_ctr(btcoexist); ++#endif ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++void ex_halbtc8192e2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ halbtc8192e2ant_coex_all_off(btcoexist); ++ halbtc8192e2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, ++ true); ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = false; ++ } ++} ++ ++void ex_halbtc8192e2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ } ++} ++ ++void ex_halbtc8192e2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (BTC_SCAN_START == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ } else if (BTC_SCAN_FINISH == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); ++ ++ } ++} ++ ++void ex_halbtc8192e2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (BTC_ASSOCIATE_START == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ } else if (BTC_ASSOCIATE_FINISH == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++} ++ ++void ex_halbtc8192e2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ h2c_parameter[0] = 0x1; ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); ++} ++ ++void ex_halbtc8192e2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (type == BTC_PACKET_DHCP) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], DHCP Packet notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++} ++ ++void ex_halbtc8192e2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 bt_info = 0; ++ u8 i, rsp_source = 0; ++ boolean bt_busy = false, limited_dig = false; ++ boolean wifi_connected = false; ++ ++ coex_sta->c2h_bt_info_req_sent = false; ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8192E_2ANT_MAX) ++ rsp_source = BT_INFO_SRC_8192E_2ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ if (i == 1) ++ bt_info = tmp_buf[i]; ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ if (BT_INFO_SRC_8192E_2ANT_WIFI_FW != rsp_source) { ++ coex_sta->bt_retry_cnt = /* [3:0] */ ++ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; ++ ++ coex_sta->bt_rssi = ++ coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; ++ ++ coex_sta->bt_info_ext = ++ coex_sta->bt_info_c2h[rsp_source][4]; ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ if ((coex_sta->bt_info_ext & BIT(1))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (wifi_connected) ++ ex_halbtc8192e2ant_media_status_notify( ++ btcoexist, BTC_MEDIA_CONNECT); ++ else ++ ex_halbtc8192e2ant_media_status_notify( ++ btcoexist, BTC_MEDIA_DISCONNECT); ++ } ++ ++ if ((coex_sta->bt_info_ext & BIT(3))) { ++ if (!btcoexist->manual_control && ++ !btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8192e2ant_ignore_wlan_act(btcoexist, ++ FORCE_EXEC, false); ++ } ++ } else { ++ /* BT already NOT ignore Wlan active, do nothing here. */ ++ } ++ ++#if (BT_AUTO_REPORT_ONLY_8192E_2ANT == 0) ++ if ((coex_sta->bt_info_ext & BIT(4))) { ++ /* BT auto report already enabled, do nothing */ ++ } else ++ halbtc8192e2ant_bt_auto_report(btcoexist, FORCE_EXEC, ++ true); ++#endif ++ } ++ ++ /* check BIT2 first ==> check if bt is under inquiry or page scan */ ++ if (bt_info & BT_INFO_8192E_2ANT_B_INQ_PAGE) ++ coex_sta->c2h_bt_inquiry_page = true; ++ else ++ coex_sta->c2h_bt_inquiry_page = false; ++ ++ /* set link exist status */ ++ if (!(bt_info & BT_INFO_8192E_2ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (bt_info & BT_INFO_8192E_2ANT_B_FTP) ++ coex_sta->pan_exist = true; ++ else ++ coex_sta->pan_exist = false; ++ if (bt_info & BT_INFO_8192E_2ANT_B_A2DP) ++ coex_sta->a2dp_exist = true; ++ else ++ coex_sta->a2dp_exist = false; ++ if (bt_info & BT_INFO_8192E_2ANT_B_HID) ++ coex_sta->hid_exist = true; ++ else ++ coex_sta->hid_exist = false; ++ if (bt_info & BT_INFO_8192E_2ANT_B_SCO_ESCO) ++ coex_sta->sco_exist = true; ++ else ++ coex_sta->sco_exist = false; ++ } ++ ++ halbtc8192e2ant_update_bt_link_info(btcoexist); ++ ++ if (!(bt_info & BT_INFO_8192E_2ANT_B_CONNECTION)) { ++ coex_dm->bt_status = BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info == ++ BT_INFO_8192E_2ANT_B_CONNECTION) { /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if ((bt_info & BT_INFO_8192E_2ANT_B_SCO_ESCO) || ++ (bt_info & BT_INFO_8192E_2ANT_B_SCO_BUSY)) { ++ coex_dm->bt_status = BT_8192E_2ANT_BT_STATUS_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info & BT_INFO_8192E_2ANT_B_ACL_BUSY) { ++ coex_dm->bt_status = BT_8192E_2ANT_BT_STATUS_ACL_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ coex_dm->bt_status = BT_8192E_2ANT_BT_STATUS_MAX; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if ((BT_8192E_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8192E_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8192E_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { ++ bt_busy = true; ++ limited_dig = true; ++ } else { ++ bt_busy = false; ++ limited_dig = false; ++ } ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ coex_dm->limited_dig = limited_dig; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); ++ ++ halbtc8192e2ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8192e2ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8192e2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, true); ++ halbtc8192e2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ex_halbtc8192e2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++} ++ ++void ex_halbtc8192e2ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++#if (BT_AUTO_REPORT_ONLY_8192E_2ANT == 0) ++ halbtc8192e2ant_query_bt_info(btcoexist); ++ halbtc8192e2ant_monitor_bt_ctr(btcoexist); ++ halbtc8192e2ant_monitor_bt_enable_disable(btcoexist); ++#else ++ if (halbtc8192e2ant_is_wifi_status_changed(btcoexist) || ++ coex_dm->auto_tdma_adjust) ++ halbtc8192e2ant_run_coexist_mechanism(btcoexist); ++#endif ++} ++ ++#endif ++ ++#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.h 2018-02-11 21:44:27.144146040 +0200 +@@ -0,0 +1,199 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8192E_SUPPORT == 1) ++/* ******************************************* ++ * The following is for 8192E 2Ant BT Co-exist definition ++ * ******************************************* */ ++#define BT_AUTO_REPORT_ONLY_8192E_2ANT 0 ++ ++#define BT_INFO_8192E_2ANT_B_FTP BIT(7) ++#define BT_INFO_8192E_2ANT_B_A2DP BIT(6) ++#define BT_INFO_8192E_2ANT_B_HID BIT(5) ++#define BT_INFO_8192E_2ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8192E_2ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8192E_2ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8192E_2ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8192E_2ANT_B_CONNECTION BIT(0) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT 2 ++#define NOISY_AP_NUM_THRESH_8192E 10 ++ ++enum bt_info_src_8192e_2ant { ++ BT_INFO_SRC_8192E_2ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8192E_2ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8192E_2ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8192E_2ANT_MAX ++}; ++ ++enum bt_8192e_2ant_bt_status { ++ BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8192E_2ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8192E_2ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8192E_2ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8192E_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8192E_2ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8192e_2ant_coex_algo { ++ BT_8192E_2ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8192E_2ANT_COEX_ALGO_SCO = 0x1, ++ BT_8192E_2ANT_COEX_ALGO_SCO_PAN = 0x2, ++ BT_8192E_2ANT_COEX_ALGO_HID = 0x3, ++ BT_8192E_2ANT_COEX_ALGO_A2DP = 0x4, ++ BT_8192E_2ANT_COEX_ALGO_A2DP_PANHS = 0x5, ++ BT_8192E_2ANT_COEX_ALGO_PANEDR = 0x6, ++ BT_8192E_2ANT_COEX_ALGO_PANHS = 0x7, ++ BT_8192E_2ANT_COEX_ALGO_PANEDR_A2DP = 0x8, ++ BT_8192E_2ANT_COEX_ALGO_PANEDR_HID = 0x9, ++ BT_8192E_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0xa, ++ BT_8192E_2ANT_COEX_ALGO_HID_A2DP = 0xb, ++ BT_8192E_2ANT_COEX_ALGO_MAX = 0xc ++}; ++ ++struct coex_dm_8192e_2ant { ++ /* fw mechanism */ ++ u8 pre_bt_dec_pwr_lvl; ++ u8 cur_bt_dec_pwr_lvl; ++ u8 pre_fw_dac_swing_lvl; ++ u8 cur_fw_dac_swing_lvl; ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean reset_tdma_adjust; ++ boolean auto_tdma_adjust; ++ boolean auto_tdma_adjust_low_rssi; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ ++ /* sw mechanism */ ++ boolean pre_rf_rx_lpf_shrink; ++ boolean cur_rf_rx_lpf_shrink; ++ u32 bt_rf_0x1e_backup; ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ boolean pre_dac_swing_on; ++ u32 pre_dac_swing_lvl; ++ boolean cur_dac_swing_on; ++ u32 cur_dac_swing_lvl; ++ boolean pre_adc_back_off; ++ boolean cur_adc_back_off; ++ boolean pre_agc_table_en; ++ boolean cur_agc_table_en; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ boolean limited_dig; ++ ++ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ ++ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ ++ u16 backup_retry_limit; ++ u8 backup_ampdu_max_time; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ u8 pre_ss_type; ++ u8 cur_ss_type; ++ ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++ ++ ++ u32 pre_ra_mask; ++ u32 cur_ra_mask; ++ u8 cur_ra_mask_type; ++ u8 pre_arfr_type; ++ u8 cur_arfr_type; ++ u8 pre_retry_limit_type; ++ u8 cur_retry_limit_type; ++ u8 pre_ampdu_time_type; ++ u8 cur_ampdu_time_type; ++}; ++ ++struct coex_sta_8192e_2ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ u8 bt_rssi; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ boolean c2h_bt_info_req_sent; ++ u8 bt_info_c2h[BT_INFO_SRC_8192E_2ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8192E_2ANT_MAX]; ++ boolean c2h_bt_inquiry_page; ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++ u8 scan_ap_num; ++}; ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8192e2ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8192e2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8192e2ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8192e2ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8192e2ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8192e2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8192e2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8192e2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8192e2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8192e2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8192e2ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8192e2ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8192e2ant_display_coex_info(IN struct btc_coexist *btcoexist); ++ ++#else /* #if (RTL8192E_SUPPORT == 1) */ ++#define ex_halbtc8192e2ant_power_on_setting(btcoexist) ++#define ex_halbtc8192e2ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8192e2ant_init_coex_dm(btcoexist) ++#define ex_halbtc8192e2ant_ips_notify(btcoexist, type) ++#define ex_halbtc8192e2ant_lps_notify(btcoexist, type) ++#define ex_halbtc8192e2ant_scan_notify(btcoexist, type) ++#define ex_halbtc8192e2ant_connect_notify(btcoexist, type) ++#define ex_halbtc8192e2ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8192e2ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8192e2ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8192e2ant_halt_notify(btcoexist) ++#define ex_halbtc8192e2ant_periodical(btcoexist) ++#define ex_halbtc8192e2ant_display_coex_info(btcoexist) ++ ++#endif ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.c 2018-02-11 21:44:27.145146055 +0200 +@@ -0,0 +1,4592 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8703B Co-exist mechanism ++ * ++ * History ++ * 2012/11/15 Cosa first check in. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8703B_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8703b_1ant glcoex_dm_8703b_1ant; ++static struct coex_dm_8703b_1ant *coex_dm = &glcoex_dm_8703b_1ant; ++static struct coex_sta_8703b_1ant glcoex_sta_8703b_1ant; ++static struct coex_sta_8703b_1ant *coex_sta = &glcoex_sta_8703b_1ant; ++static struct psdscan_sta_8703b_1ant gl_psd_scan_8703b_1ant; ++static struct psdscan_sta_8703b_1ant *psd_scan = &gl_psd_scan_8703b_1ant; ++ ++ ++const char *const glbt_info_src_8703b_1ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++u32 glcoex_ver_date_8703b_1ant = 20160218; ++u32 glcoex_ver_8703b_1ant = 0x09; ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8703b1ant_ ++ * ************************************************************ */ ++u8 halbtc8703b1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_bt_rssi_state; ++ } ++ ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8703b1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_wifi_rssi_state[index]; ++ } ++ ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8703b1ant_update_ra_mask(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 dis_rate_mask) ++{ ++ coex_dm->cur_ra_mask = dis_rate_mask; ++ ++ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, ++ &coex_dm->cur_ra_mask); ++ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; ++} ++ ++void halbtc8703b1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ ++ coex_dm->cur_arfr_type = type; ++ ++ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { ++ switch (coex_dm->cur_arfr_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_4byte(btcoexist, 0x430, ++ coex_dm->backup_arfr_cnt1); ++ btcoexist->btc_write_4byte(btcoexist, 0x434, ++ coex_dm->backup_arfr_cnt2); ++ break; ++ case 1: ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x01010101); ++ } else { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x04030201); ++ } ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; ++} ++ ++void halbtc8703b1ant_retry_limit(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_retry_limit_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_retry_limit_type != ++ coex_dm->cur_retry_limit_type)) { ++ switch (coex_dm->cur_retry_limit_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ coex_dm->backup_retry_limit); ++ break; ++ case 1: /* retry limit=8 */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ 0x0808); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; ++} ++ ++void halbtc8703b1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_ampdu_time_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { ++ switch (coex_dm->cur_ampdu_time_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ coex_dm->backup_ampdu_max_time); ++ break; ++ case 1: /* AMPDU timw = 0x38 * 32us */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ 0x38); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; ++} ++ ++void halbtc8703b1ant_limited_tx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, ++ IN u8 retry_limit_type, IN u8 ampdu_time_type) ++{ ++ switch (ra_mask_type) { ++ case 0: /* normal mode */ ++ halbtc8703b1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0); ++ break; ++ case 1: /* disable cck 1/2 */ ++ halbtc8703b1ant_update_ra_mask(btcoexist, force_exec, ++ 0x00000003); ++ break; ++ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ ++ halbtc8703b1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0001f1f7); ++ break; ++ default: ++ break; ++ } ++ ++ halbtc8703b1ant_auto_rate_fallback_retry(btcoexist, force_exec, ++ arfr_type); ++ halbtc8703b1ant_retry_limit(btcoexist, force_exec, retry_limit_type); ++ halbtc8703b1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); ++} ++ ++void halbtc8703b1ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++ ++ ++} ++ ++void halbtc8703b1ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ coex_sta->c2h_bt_info_req_sent = true; ++ ++ h2c_parameter[0] |= BIT(0); /* trigger */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); ++} ++ ++void halbtc8703b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ static u8 num_of_bt_counter_chk = 0, cnt_slave = 0; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ ++ /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", ++ reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); ++ ++ BTC_TRACE(trace_buf); ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++ ++ if ((coex_sta->low_priority_tx > 1150) && ++ (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->pop_event_cnt++; ++ ++ if ((coex_sta->low_priority_rx >= 1150) && (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) ++ && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist)) { ++ if (cnt_slave >= 3) { ++ bt_link_info->slave_role = true; ++ cnt_slave = 3; ++ } else ++ cnt_slave++; ++ } else { ++ if (cnt_slave == 0) { ++ bt_link_info->slave_role = false; ++ cnt_slave = 0; ++ } else ++ cnt_slave--; ++ ++ } ++ ++ if ((coex_sta->high_priority_tx == 0) && (coex_sta->high_priority_rx == 0) && (coex_sta->low_priority_tx == 0) && ++ (coex_sta->low_priority_rx == 0)) { ++ num_of_bt_counter_chk++; ++ if (num_of_bt_counter_chk >= 3) { ++ halbtc8703b1ant_query_bt_info(btcoexist); ++ num_of_bt_counter_chk = 0; ++ } ++ } ++ ++ ++#if 0 ++ /* Add Hi-Pri Tx/Rx counter to avoid false detection */ ++ if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) && ++ (coex_sta->high_priority_tx + coex_sta->high_priority_rx ++ >= 160) ++ && (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->bt_hi_pri_link_exist = true; ++ else ++ coex_sta->bt_hi_pri_link_exist = false; ++ ++ if ((coex_sta->acl_busy) && ++ (coex_sta->num_of_profile == 0)) { ++ if (coex_sta->low_priority_tx + ++ coex_sta->low_priority_rx >= 160) { ++ coex_sta->pan_exist = true; ++ coex_sta->num_of_profile++; ++ coex_sta->wrong_profile_notification++; ++ } ++ } ++#endif ++ ++} ++ ++ ++void halbtc8703b1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) ++{ ++ s32 wifi_rssi = 0; ++ boolean wifi_busy = false, wifi_under_b_mode = false; ++ static u8 cck_lock_counter = 0; ++ u32 total_cnt; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ if (coex_sta->under_ips) { ++ coex_sta->crc_ok_cck = 0; ++ coex_sta->crc_ok_11g = 0; ++ coex_sta->crc_ok_11n = 0; ++ coex_sta->crc_ok_11n_agg = 0; ++ ++ coex_sta->crc_err_cck = 0; ++ coex_sta->crc_err_11g = 0; ++ coex_sta->crc_err_11n = 0; ++ coex_sta->crc_err_11n_agg = 0; ++ } else { ++ coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, ++ 0xf88); ++ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf94); ++ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf90); ++ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xfb8); ++ ++ coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, ++ 0xf84); ++ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf96); ++ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf92); ++ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xfba); ++ } ++ ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); ++ ++ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { ++ total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + ++ coex_sta->crc_ok_11n + ++ coex_sta->crc_ok_11n_agg; ++ ++ if ((coex_dm->bt_status == BT_8703B_1ANT_BT_STATUS_ACL_BUSY) || ++ (coex_dm->bt_status == ++ BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY) || ++ (coex_dm->bt_status == ++ BT_8703B_1ANT_BT_STATUS_SCO_BUSY)) { ++ if (coex_sta->crc_ok_cck > (total_cnt - ++ coex_sta->crc_ok_cck)) { ++ if (cck_lock_counter < 3) ++ cck_lock_counter++; ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ if (!coex_sta->pre_ccklock) { ++ ++ if (cck_lock_counter >= 3) ++ coex_sta->cck_lock = true; ++ else ++ coex_sta->cck_lock = false; ++ } else { ++ if (cck_lock_counter == 0) ++ coex_sta->cck_lock = false; ++ else ++ coex_sta->cck_lock = true; ++ } ++ ++ if (coex_sta->cck_lock) ++ coex_sta->cck_ever_lock = true; ++ ++ coex_sta->pre_ccklock = coex_sta->cck_lock; ++ ++ ++} ++ ++boolean halbtc8703b1ant_is_wifibt_status_changed(IN struct btc_coexist *btcoexist) ++{ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false, pre_bt_off = false; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (coex_sta->bt_disabled != pre_bt_off) { ++ pre_bt_off = coex_sta->bt_disabled; ++ ++ if (coex_sta->bt_disabled) ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!\n"); ++ else ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is enabled !!\n"); ++ ++ BTC_TRACE(trace_buf); ++ return true; ++ } ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ } ++ ++ return false; ++} ++ ++void halbtc8703b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist; ++ bt_link_info->acl_busy = coex_sta->acl_busy; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if (bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if (!bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++} ++ ++void halbtc8703b1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ h2c_parameter[0] = ++ 0x1; /* enable BT AFH skip WL channel for 8703b because BT Rx LO interference */ ++ /* h2c_parameter[0] = 0x0; */ ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); ++ ++} ++ ++void halbtc8703b1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8703b1ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ halbtc8703b1ant_set_bt_auto_report(btcoexist, ++ coex_dm->cur_bt_auto_report); ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++void halbtc8703b1ant_set_fw_low_penalty_ra(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ ++ ++ if (low_penalty_ra) { ++ h2c_parameter[1] |= BIT(0); ++ h2c_parameter[2] = ++ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ ++ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ ++ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ ++ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); ++} ++ ++void halbtc8703b1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ halbtc8703b1ant_set_fw_low_penalty_ra(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++} ++ ++void halbtc8703b1ant_write_score_board( ++ IN struct btc_coexist *btcoexist, ++ IN u16 bitpos, ++ IN BOOLEAN state ++) ++{ ++ ++ static u16 originalval = 0x8002; ++ ++ if (state) ++ originalval = originalval | bitpos; ++ else ++ originalval = originalval & (~bitpos); ++ ++ ++ btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); ++#if 0 ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "\n [BTCoex], ********** Write Scoreboard = %x**********\n", ++ originalval); ++ BTC_TRACE(trace_buf); ++#endif ++ ++} ++ ++void halbtc8703b1ant_read_score_board( ++ IN struct btc_coexist *btcoexist, ++ IN u16 *score_board_val ++) ++{ ++ ++ *score_board_val = (btcoexist->btc_read_2byte(btcoexist, ++ 0xaa)) & 0x7fff; ++} ++ ++void halbtc8703b1ant_post_activestate_to_bt( ++ IN struct btc_coexist *btcoexist, ++ IN boolean wifi_active ++) ++{ ++ ++ if (wifi_active) ++ halbtc8703b1ant_write_score_board(btcoexist, (u16) BIT(0), TRUE); ++ else ++ halbtc8703b1ant_write_score_board(btcoexist, (u16) BIT(0), FALSE); ++ ++ /* The BT should set "No Shunt-down" mode if WL = Active for BT Synthesizer on/off interference WL Lo issue at 8703b b-cut. */ ++ ++} ++ ++void halbtc8703b1ant_post_onoffState_to_bt( ++ IN struct btc_coexist *btcoexist, ++ IN boolean wifi_on ++) ++{ ++ ++ if (wifi_on) ++ halbtc8703b1ant_write_score_board(btcoexist, (u16) BIT(1), TRUE); ++ else ++ halbtc8703b1ant_write_score_board(btcoexist, (u16) BIT(1), FALSE); ++ ++} ++ ++void halbtc8703b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ u16 u16tmp; ++ ++ /* This function check if bt is disabled */ ++#if 1 ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ ++ ++#else /* 8703b BT can't show correct on/off status in scoreboard[1] 2015/11/26 */ ++ ++ halbtc8703b1ant_read_score_board(btcoexist, &u16tmp); ++ ++ bt_active = u16tmp & BIT(1); ++ ++ ++#endif ++ ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ } else { ++ ++ bt_disable_cnt++; ++ if (bt_disable_cnt >= 2) { ++ bt_disabled = true; ++ bt_disable_cnt = 2; ++ } ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ } ++ ++ ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_disabled = bt_disabled; ++ ++ } ++} ++ ++void halbtc8703b1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, ++ IN boolean isenable) ++{ ++ ++#if (BT_8703B_1ANT_ENABLE_GNTBT_TO_GPIO14 == 1) ++ if (isenable) { ++ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); ++ ++ /* enable GNT_BT debug to GPIO */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); ++ } else { ++ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); ++ ++ /* Disable GNT_BT debug to GPIO, and enable chip_wakeup_host */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x1); ++ } ++#endif ++} ++ ++u32 halbtc8703b1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, ++ IN u16 reg_addr) ++{ ++ u32 j = 0; ++ ++ ++ /* wait for ready bit before access 0x7c0 */ ++ btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0x800F0000 | reg_addr); ++ ++ do { ++ j++; ++ } while (((btcoexist->btc_read_1byte(btcoexist, ++ 0x7c3)&BIT(5)) == 0) && ++ (j < BT_8703B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); ++ ++ ++ return btcoexist->btc_read_4byte(btcoexist, ++ 0x7c8); /* get read data */ ++ ++} ++ ++void halbtc8703b1ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist, ++ IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) ++{ ++ u32 val, i = 0, j = 0, bitpos = 0; ++ ++ ++ if (bit_mask == 0x0) ++ return; ++ if (bit_mask == 0xffffffff) { ++ btcoexist->btc_write_4byte(btcoexist, 0x7c4, ++ reg_value); /* put write data */ ++ ++ /* wait for ready bit before access 0x7c0 */ ++ do { ++ j++; ++ } while (((btcoexist->btc_read_1byte(btcoexist, ++ 0x7c3)&BIT(5)) == 0) && ++ (j < BT_8703B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); ++ ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x7c0, ++ 0xc00F0000 | reg_addr); ++ } else { ++ for (i = 0; i <= 31; i++) { ++ if (((bit_mask >> i) & 0x1) == 0x1) { ++ bitpos = i; ++ break; ++ } ++ } ++ ++ /* read back register value before write */ ++ val = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, ++ reg_addr); ++ val = (val & (~bit_mask)) | (reg_value << bitpos); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x7c4, ++ val); /* put write data */ ++ ++ /* wait for ready bit before access 0x7c0 */ ++ do { ++ j++; ++ } while (((btcoexist->btc_read_1byte(btcoexist, ++ 0x7c3)&BIT(5)) == 0) && ++ (j < BT_8703B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); ++ ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x7c0, ++ 0xc00F0000 | reg_addr); ++ ++ } ++ ++} ++ ++void halbtc8703b1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 val; ++ ++ val = (enable) ? 1 : 0; ++ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, ++ val); /* 0x38[7] */ ++ ++} ++ ++void halbtc8703b1ant_sw_mechanism(IN struct btc_coexist *btcoexist, ++ IN boolean low_penalty_ra) ++{ ++ halbtc8703b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); ++} ++ ++void halbtc8703b1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_control) ++{ ++ u8 val; ++ ++ val = (wifi_control) ? 1 : 0; ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, ++ val); /* 0x70[26] */ ++ ++} ++ ++void halbtc8703b1ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, ++ IN u8 control_block, IN boolean sw_control, IN u8 state) ++{ ++ u32 val = 0, bit_mask; ++ ++ state = state & 0x1; ++ val = (sw_control) ? ((state << 1) | 0x1) : 0; ++ ++ switch (control_block) { ++ case BT_8703B_1ANT_GNT_BLOCK_RFC_BB: ++ default: ++ bit_mask = 0xc000; ++ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[15:14] */ ++ bit_mask = 0x0c00; ++ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[11:10] */ ++ break; ++ case BT_8703B_1ANT_GNT_BLOCK_RFC: ++ bit_mask = 0xc000; ++ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[15:14] */ ++ break; ++ case BT_8703B_1ANT_GNT_BLOCK_BB: ++ bit_mask = 0x0c00; ++ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[11:10] */ ++ break; ++ ++ } ++ ++} ++ ++void halbtc8703b1ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, ++ IN u8 control_block, IN boolean sw_control, IN u8 state) ++{ ++ u32 val = 0, bit_mask; ++ ++ state = state & 0x1; ++ val = (sw_control) ? ((state << 1) | 0x1) : 0; ++ ++ switch (control_block) { ++ case BT_8703B_1ANT_GNT_BLOCK_RFC_BB: ++ default: ++ bit_mask = 0x3000; ++ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[13:12] */ ++ bit_mask = 0x0300; ++ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[9:8] */ ++ break; ++ case BT_8703B_1ANT_GNT_BLOCK_RFC: ++ bit_mask = 0x3000; ++ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[13:12] */ ++ break; ++ case BT_8703B_1ANT_GNT_BLOCK_BB: ++ bit_mask = 0x0300; ++ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[9:8] */ ++ break; ++ ++ } ++ ++} ++ ++void halbtc8703b1ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u8 table_type, IN u16 table_content) ++{ ++ u16 reg_addr = 0x0000; ++ ++ switch (table_type) { ++ case BT_8703B_1ANT_CTT_WL_VS_LTE: ++ reg_addr = 0xa0; ++ break; ++ case BT_8703B_1ANT_CTT_BT_VS_LTE: ++ reg_addr = 0xa4; ++ break; ++ } ++ ++ if (reg_addr != 0x0000) ++ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, ++ 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ ++ ++ ++} ++ ++ ++void halbtc8703b1ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, ++ IN u8 table_type, IN u8 table_content) ++{ ++ u16 reg_addr = 0x0000; ++ ++ switch (table_type) { ++ case BT_8703B_1ANT_LBTT_WL_BREAK_LTE: ++ reg_addr = 0xa8; ++ break; ++ case BT_8703B_1ANT_LBTT_BT_BREAK_LTE: ++ reg_addr = 0xac; ++ break; ++ case BT_8703B_1ANT_LBTT_LTE_BREAK_WL: ++ reg_addr = 0xb0; ++ break; ++ case BT_8703B_1ANT_LBTT_LTE_BREAK_BT: ++ reg_addr = 0xb4; ++ break; ++ } ++ ++ if (reg_addr != 0x0000) ++ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, ++ 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ ++ ++ ++} ++ ++void halbtc8703b1ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8703b1ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ halbtc8703b1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8703b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ u32 break_table; ++ u8 select_table; ++ ++ coex_sta->coex_table_type = type; ++ ++ if (coex_sta->concurrent_rx_mode_on == true) { ++ break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ ++ select_table = ++ 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ ++ } else { ++ break_table = 0xffffff; ++ select_table = 0x3; ++ } ++ ++ switch (type) { ++ case 0: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x55555555, break_table, ++ select_table); ++ break; ++ case 1: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, break_table, ++ select_table); ++ break; ++ case 2: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0xaa5a5a5a, 0xaa5a5a5a, break_table, ++ select_table); ++ break; ++ case 3: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0xaa555555, 0xaa5a5a5a, break_table, ++ select_table); ++ break; ++ case 4: ++ halbtc8703b1ant_coex_table(btcoexist, ++ force_exec, 0xaa555555, 0xaa5a5a5a, ++ break_table, select_table); ++ break; ++ case 5: ++ halbtc8703b1ant_coex_table(btcoexist, ++ force_exec, 0x5a5a5a5a, 0x5a5a5a5a, ++ break_table, select_table); ++ break; ++ case 6: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0xaaaaaaaa, break_table, ++ select_table); ++ break; ++ case 7: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0xaaaaaaaa, 0xaaaaaaaa, break_table, ++ select_table); ++ break; ++ case 8: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, break_table, ++ select_table); ++ break; ++ case 9: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, break_table, ++ select_table); ++ break; ++ case 10: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, break_table, ++ select_table); ++ break; ++ case 11: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, break_table, ++ select_table); ++ break; ++ case 12: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, break_table, ++ select_table); ++ break; ++ case 13: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0x5fff5fff, 0xaaaaaaaa, break_table, ++ select_table); ++ break; ++ case 14: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0x5fff5fff, 0x5ada5ada, break_table, ++ select_table); ++ break; ++ case 15: ++ halbtc8703b1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0xaaaaaaaa, break_table, ++ select_table); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8703b1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ if (enable) { ++ h2c_parameter[0] |= BIT(0); /* function enable */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); ++} ++ ++void halbtc8703b1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ halbtc8703b1ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8703b1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8703b1ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8703b1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8703b1ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ /*halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); */ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ /*halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8);*/ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++void halbtc8703b1ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ boolean low_pwr_disable = false; ++ ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ /* recover to original 32k low power setting */ ++ coex_sta->force_lps_on = false; ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ ++ break; ++ case BTC_PS_LPS_ON: ++ coex_sta->force_lps_on = true; ++ halbtc8703b1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8703b1ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ /* when coex force to enter LPS, do not enter 32k low power. */ ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ ++ break; ++ case BTC_PS_LPS_OFF: ++ coex_sta->force_lps_on = false; ++ halbtc8703b1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, false); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ ++ break; ++ default: ++ break; ++ } ++} ++ ++ ++ ++void halbtc8703b1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ u8 real_byte1 = byte1, real_byte5 = byte5; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ if (ap_enable) { ++ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], FW for 1Ant AP mode\n"); ++ BTC_TRACE(trace_buf); ++ real_byte1 &= ~BIT(4); ++ real_byte1 |= BIT(5); ++ ++ real_byte5 |= BIT(5); ++ real_byte5 &= ~BIT(6); ++ ++ halbtc8703b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ } ++ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ ++ halbtc8703b1ant_power_save_state( ++ btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } else { ++ halbtc8703b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ } ++ ++ ++ h2c_parameter[0] = real_byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = real_byte5; ++ ++ coex_dm->ps_tdma_para[0] = real_byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = real_byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++ ++void halbtc8703b1ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_busy = false; ++ u8 rssi_adjust_val = 0; ++ static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; ++ static boolean pre_wifi_busy = false; ++ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (wifi_busy != pre_wifi_busy) { ++ force_exec = true; ++ pre_wifi_busy = wifi_busy; ++ } ++ ++ /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ ++ if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) ++ psTdmaByte4Modify = 0x1; ++ else ++ psTdmaByte4Modify = 0x0; ++ ++ if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { ++ ++ force_exec = true; ++ pre_psTdmaByte4Modify = psTdmaByte4Modify; ++ } ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ return; ++ } ++ ++ if (coex_dm->cur_ps_tdma_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(on, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(off, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if (turn_on) { ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, ++ 0x1); /* enable TBTT nterrupt */ ++ } ++ ++ ++ if (turn_on) { ++ switch (type) { ++ default: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x35, 0x03, 0x11, 0x11); ++ break; ++ ++ case 3: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x3a, 0x03, 0x10, 0x10); ++ break; ++ case 4: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x21, 0x03, 0x10, 0x10); ++ break; ++ case 5: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x15, 0x03, 0x11, 0x11); ++ break; ++ case 6: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x20, 0x03, 0x11, 0x11); ++ break; ++ case 7: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); ++ break; ++ case 8: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); ++ break; ++ case 13: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x25, 0x03, 0x10, 0x10 | psTdmaByte4Modify); ++ break; ++ case 14: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x15, 0x03, 0x10, 0x10 | psTdmaByte4Modify); ++ break; ++ case 15: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x20, 0x03, 0x10, 0x10 | psTdmaByte4Modify); ++ break; ++ case 17: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x10, 0x03, 0x11, 0x14 | psTdmaByte4Modify); ++ break; ++ case 19: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x15, 0x03, 0x11, 0x10); ++ break; ++ case 20: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x30, 0x03, 0x11, 0x10); ++ break; ++ case 21: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x30, 0x03, 0x11, 0x10); ++ break; ++ case 22: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x25, 0x03, 0x11, 0x10); ++ break; ++ case 32: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x35, 0x03, 0x11, 0x11); ++ break; ++ case 33: ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x35, 0x03, 0x11, 0x10); ++ break; ++ ++ } ++ } else { ++ ++ /* disable PS tdma */ ++ switch (type) { ++ case 8: /* PTA Control */ ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, 0x8, ++ 0x0, 0x0, 0x0, 0x0); ++ break; ++ case 0: ++ default: /* Software control, Antenna at BT side */ ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x0, 0x0); ++ break; ++ case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ ++ halbtc8703b1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x48, 0x0); ++ break; ++ } ++ } ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++void halbtc8703b1ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean force_exec, IN boolean init_hwcfg, ++ IN boolean wifi_off) ++{ ++ u32 cnt_bt_cal_chk = 0; ++ boolean is_in_mp_mode = false; ++ u8 u8tmp = 0; ++ u32 u32tmp1 = 0, u32tmp2 = 0; ++ ++ coex_dm->cur_ant_pos_type = ant_pos_type; ++ ++#if 1 ++ u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x38); ++ u32tmp2 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x54); ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (Before Ant Setup) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ u8tmp, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++#endif ++ ++ if (init_hwcfg) { ++ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ ++ halbtc8703b1ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8703b1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8703B_1ANT_CTT_WL_VS_LTE, 0xffff); ++ ++ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8703b1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8703B_1ANT_CTT_BT_VS_LTE, 0xffff); ++ ++ /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ ++ while (cnt_bt_cal_chk <= 20) { ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, ++ 0x49d); ++ cnt_bt_cal_chk++; ++ if (u8tmp & BIT(0)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ delay_ms(50); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ break; ++ } ++ } ++ ++ /* set Path control owner to WL at initial step */ ++ halbtc8703b1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8703B_1ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW high */ ++ halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8703B_1ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to SW low */ ++ halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8703B_1ANT_SIG_STA_SET_TO_LOW); ++ ++ coex_sta->gnt_control_by_PTA = false; ++ ++ } else if (wifi_off) { ++ /* Disable LTE Coex Function in WiFi side */ ++ halbtc8703b1ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* set Path control owner to BT */ ++ halbtc8703b1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8703B_1ANT_PCO_BTSIDE); ++ ++ coex_sta->gnt_control_by_PTA = false; ++ } else { ++ ++ halbtc8703b1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8703B_1ANT_PCO_WLSIDE); ++ ++ ++ if (force_exec || ++ (coex_dm->cur_ant_pos_type != coex_dm->pre_ant_pos_type) || ++ init_hwcfg || wifi_off) { ++ /* internal switch setting */ ++ switch (ant_pos_type) { ++ case BTC_ANT_PATH_WIFI: ++ /* set GNT_BT to low */ ++ halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8703B_1ANT_SIG_STA_SET_TO_LOW); ++ /* Set GNT_WL to high */ ++ halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8703B_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ coex_sta->gnt_control_by_PTA = false; ++ break; ++ case BTC_ANT_PATH_BT: ++ /*halbtc8703b1ant_ltecoex_pathcontrol_owner( ++ btcoexist, BT_8703B_1ANT_PCO_BTSIDE);*/ ++ /* set GNT_BT to high */ ++ halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8703B_1ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to low */ ++ halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8703B_1ANT_SIG_STA_SET_TO_LOW); ++ ++ coex_sta->gnt_control_by_PTA = false; ++ break; ++ default: ++ case BTC_ANT_PATH_PTA: ++ /* set GNT_BT to PTA */ ++ halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_PTA, ++ BT_8703B_1ANT_SIG_STA_SET_BY_HW); ++ /* Set GNT_WL to PTA */ ++ halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_PTA, ++ BT_8703B_1ANT_SIG_STA_SET_BY_HW); ++ ++ coex_sta->gnt_control_by_PTA = true; ++ break; ++ } ++ } ++ } ++ ++#if 1 ++ u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ if (init_hwcfg) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Ant-Setup Init) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ u8tmp, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ } else if (wifi_off) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Ant-Setup WiFi off) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ u8tmp, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Ant-Setup Run time) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ u8tmp, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ } ++#endif ++ ++ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; ++} ++ ++ ++boolean halbtc8703b1ant_is_common_action(IN struct btc_coexist *btcoexist) ++{ ++ boolean common = false, wifi_connected = false, wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (!wifi_connected && ++ BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else { ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ common = false; ++ } ++ ++ return common; ++} ++ ++/* ********************************************* ++ * ++ * Software Coex Mechanism start ++ * ++ * ********************************************* */ ++ ++/* SCO only or SCO+PAN(HS) */ ++ ++/* ++void halbtc8703b1ant_action_sco(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8703b1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8703b1ant_action_hid(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8703b1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8703b1ant_action_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8703b1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8703b1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8703b1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8703b1ant_action_pan_edr(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8703b1ant_sw_mechanism(btcoexist, false); ++} ++ ++ ++void halbtc8703b1ant_action_pan_hs(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8703b1ant_sw_mechanism(btcoexist, false); ++} ++ ++ ++void halbtc8703b1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8703b1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8703b1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8703b1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8703b1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8703b1ant_sw_mechanism(btcoexist, true); ++} ++ ++void halbtc8703b1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8703b1ant_sw_mechanism(btcoexist, true); ++} ++ ++*/ ++ ++/* ********************************************* ++ * ++ * Non-Software Coex Mechanism start ++ * ++ * ********************************************* */ ++u8 halbtc8703b1ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8703B_1ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (!bt_link_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No BT link exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (bt_link_info->sco_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->hid_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->pan_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 1) { ++ if (bt_link_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8703B_1ANT_COEX_ALGO_SCO; ++ } else { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8703B_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8703B_1ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8703B_1ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8703B_1ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8703B_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8703B_1ANT_COEX_ALGO_SCO; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8703B_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8703B_1ANT_COEX_ALGO_HID_A2DP; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8703B_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8703B_1ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8703B_1ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8703B_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8703B_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8703B_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8703B_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8703B_1ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++ ++ ++void halbtc8703b1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, ++ false, false); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8703b1ant_action_wifi_only(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, ++ false, false); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++} ++ ++void halbtc8703b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, ++ false, false); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8703b1ant_action_hs(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8703b1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, ++ bt_busy = false; ++ boolean wifi_scan = false, wifi_link = false, wifi_roam = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); ++ ++ if ((wifi_link) || (wifi_roam) || (coex_sta->wifi_is_high_pri_task)) { ++ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); ++ ++ } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { ++ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); ++ ++ } else if ((!wifi_connected) && (!wifi_scan)) { ++ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { ++ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ } else if (bt_link_info->a2dp_exist) { ++ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if (wifi_scan) { ++ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ } else if (wifi_busy) { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); ++ ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 19); ++ ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } ++} ++ ++void halbtc8703b1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ /* tdma and coex table */ ++ ++ if (bt_link_info->sco_exist) { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } else { /* HID */ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } ++} ++ ++void halbtc8703b1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_busy = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ ++ if (bt_link_info->hid_only) { /* HID */ ++ halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ wifi_status); ++ coex_dm->auto_tdma_adjust = false; ++ return; ++ } else if (bt_link_info->a2dp_only) { /* A2DP */ ++ if (BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } else { ++ ++ if (coex_sta->scan_ap_num >= ++ BT_8703B_1ANT_WIFI_NOISY_THRESH) { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 17); ++ } else { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 7); ++ } ++ ++ halbtc8703b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = true; ++ } ++ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || ++ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ ++ ++ if (wifi_busy) { ++ ++ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 15); ++ else ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); ++ } else ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); ++ ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ coex_dm->auto_tdma_adjust = false; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { /* HID+A2DP */ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); ++ coex_dm->auto_tdma_adjust = false; ++ ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && ++ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ ++ if (BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 4); ++ else ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); ++ ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ coex_dm->auto_tdma_adjust = false; ++ } else { ++ /* BT no-profile busy (0x9) */ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } ++} ++ ++void halbtc8703b1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) ++{ ++ ++ /* tdma and coex table */ ++ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, ++ false, false); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8703b1ant_action_wifi_not_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if (num_of_wifi_link >= 2) { ++ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8703b1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8703b1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8703b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8703b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ /* tdma and coex table */ ++ if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else if (bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist) { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else if ((BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8703b1ant_action_wifi_not_connected_asso_auth( ++ IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if (num_of_wifi_link >= 2) { ++ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8703b1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8703b1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8703b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8703b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ /* tdma and coex table */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || ++ (bt_link_info->a2dp_exist)) { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); ++ } else if (bt_link_info->pan_exist) { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); ++ } else { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); ++ } ++} ++ ++void halbtc8703b1ant_action_wifi_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if (num_of_wifi_link >= 2) { ++ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8703b1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8703b1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8703b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8703b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ /* tdma and coex table */ ++ if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else if (bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist) { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else if ((BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8703b1ant_action_wifi_connected_specific_packet( ++ IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ boolean wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if (num_of_wifi_link >= 2) { ++ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8703b1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8703b1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8703b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8703b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ /* no specific packet process for both WiFi and BT very busy */ ++ if ((wifi_busy) && ((bt_link_info->pan_exist) || ++ (coex_sta->num_of_profile >= 2))) ++ return; ++ ++ /* tdma and coex table */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } else if (bt_link_info->a2dp_exist) { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if (bt_link_info->pan_exist) { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8703b1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_busy = false; ++ boolean scan = false, link = false, roam = false; ++ boolean under_4way = false, ap_enable = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ if (under_4way) { ++ halbtc8703b1ant_action_wifi_connected_specific_packet(btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8703b1ant_action_wifi_connected_scan(btcoexist); ++ else ++ halbtc8703b1ant_action_wifi_connected_specific_packet( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ ++ /* tdma and coex table */ ++ if (!wifi_busy) { ++ if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8703b1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else if ((BT_8703B_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else { ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ halbtc8703b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 2); ++ } ++ } else { ++ if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8703b1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else if ((BT_8703B_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else { ++ /* halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); */ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8703b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); ++ /* halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); */ ++ halbtc8703b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } ++} ++ ++void halbtc8703b1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ u8 algorithm = 0; ++ ++ algorithm = halbtc8703b1ant_action_algorithm(btcoexist); ++ coex_dm->cur_algorithm = algorithm; ++ ++ if (halbtc8703b1ant_is_common_action(btcoexist)) { ++ ++ } else { ++ switch (coex_dm->cur_algorithm) { ++ case BT_8703B_1ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8703b1ant_action_sco(btcoexist); */ ++ break; ++ case BT_8703B_1ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8703b1ant_action_hid(btcoexist); */ ++ break; ++ case BT_8703B_1ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8703b1ant_action_a2dp(btcoexist); */ ++ break; ++ case BT_8703B_1ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8703b1ant_action_a2dp_pan_hs(btcoexist); */ ++ break; ++ case BT_8703B_1ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8703b1ant_action_pan_edr(btcoexist); */ ++ break; ++ case BT_8703B_1ANT_COEX_ALGO_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HS mode.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8703b1ant_action_pan_hs(btcoexist); */ ++ break; ++ case BT_8703B_1ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8703b1ant_action_pan_edr_a2dp(btcoexist); */ ++ break; ++ case BT_8703B_1ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8703b1ant_action_pan_edr_hid(btcoexist); */ ++ break; ++ case BT_8703B_1ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8703b1ant_action_hid_a2dp_pan_edr(btcoexist); */ ++ break; ++ case BT_8703B_1ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8703b1ant_action_hid_a2dp(btcoexist); */ ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = coexist All Off!!\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8703b1ant_coex_all_off(btcoexist); */ ++ break; ++ } ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ } ++} ++ ++void halbtc8703b1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ boolean increase_scan_dev_num = false; ++ boolean bt_ctrl_agg_buf_size = false; ++ boolean miracast_plus_bt = false; ++ u8 agg_buf_size = 5; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0, wifi_bw; ++ u8 iot_peer = BTC_IOT_PEER_UNKNOWN; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->bt_whck_test) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under WHCK TEST!!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8703b1ant_action_bt_whck_test(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!!\n"); ++ halbtc8703b1ant_action_wifi_only(btcoexist); ++ return; ++ } ++ ++ if ((BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ increase_scan_dev_num = true; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, ++ &increase_scan_dev_num); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if ((num_of_wifi_link >= 2) || ++ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", ++ num_of_wifi_link, wifi_link_status); ++ BTC_TRACE(trace_buf); ++ ++ if (bt_link_info->bt_link_exist) { ++ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, ++ 0, 1); ++ miracast_plus_bt = true; ++ } else { ++ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ miracast_plus_bt = false; ++ } ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8703b1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8703b1ant_action_wifi_multi_port(btcoexist); ++ ++ return; ++ } else { ++ miracast_plus_bt = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { ++ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); ++ ++ if (BTC_IOT_PEER_CISCO != iot_peer) { ++ if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */ ++ halbtc8703b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, true, false, 0x5); ++ else ++ halbtc8703b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, false, 0x5); ++ } else { ++ if (bt_link_info->sco_exist) ++ halbtc8703b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, true, false, 0x5); ++ else { ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ halbtc8703b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, true, 0x10); ++ else ++ halbtc8703b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, true, 0x8); ++ } ++ } ++ ++ halbtc8703b1ant_sw_mechanism(btcoexist, true); ++ halbtc8703b1ant_run_sw_coexist_mechanism( ++ btcoexist); /* just print debug message */ ++ } else { ++ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ ++ halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x5); ++ ++ halbtc8703b1ant_sw_mechanism(btcoexist, false); ++ halbtc8703b1ant_run_sw_coexist_mechanism( ++ btcoexist); /* just print debug message */ ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8703b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8703b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ ++ if (!wifi_connected) { ++ boolean scan = false, link = false, roam = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is non connected-idle !!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8703b1ant_action_wifi_not_connected_scan( ++ btcoexist); ++ else ++ halbtc8703b1ant_action_wifi_not_connected_asso_auth( ++ btcoexist); ++ } else ++ halbtc8703b1ant_action_wifi_not_connected(btcoexist); ++ } else /* wifi LPS/Busy */ ++ halbtc8703b1ant_action_wifi_connected(btcoexist); ++} ++ ++u32 halbtc8703b1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) ++{ ++ u8 j; ++ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; ++ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, ++ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, ++ 32, 23, 15, 7, 0 ++ }; ++ ++ if (val == 0) ++ return 0; ++ ++ tmp = val; ++ ++ while (1) { ++ if (tmp == 1) ++ break; ++ else { ++ tmp = (tmp >> 1); ++ shiftcount++; ++ } ++ } ++ ++ ++ val_integerd_b = shiftcount + 1; ++ ++ tmp2 = 1; ++ for (j = 1; j <= val_integerd_b; j++) ++ tmp2 = tmp2 * 2; ++ ++ tmp = (val * 100) / tmp2; ++ tindex = tmp / 5; ++ ++ if (tindex > 20) ++ tindex = 20; ++ ++ val_fractiond_b = table_fraction[tindex]; ++ ++ result = val_integerd_b * 100 - val_fractiond_b; ++ ++ return result; ++ ++ ++} ++ ++void halbtc8703b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ /* force to reset coex mechanism */ ++ ++ /* sw all off */ ++ halbtc8703b1ant_sw_mechanism(btcoexist, false); ++ ++ /* halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ ++ /* halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ ++ ++ coex_sta->pop_event_cnt = 0; ++} ++ ++void halbtc8703b1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean back_up, IN boolean wifi_only) ++{ ++ u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0; ++ ++ u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70), ++ u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "\n [BTCoex], ********** 0x70/ 0x38/ 0x54 (Before Init HW config) = 0x%x/ 0x%x/ 0x%x**********\n", ++ u32tmp0, ++ u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 1Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* 0xf0[15:12] --> Chip Cut information */ ++ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, ++ 0xf1) & 0xf0) >> 4; ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, ++ 0x1); /* enable TBTT nterrupt */ ++ ++ /* BT report packet sample rate */ ++ btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); ++ ++ /* Enable BT counter statistics */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); ++ ++ /* Enable PTA (3-wire function form BT side) */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); ++ ++ /* Enable PTA (tx/rx signal form WiFi side) */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); ++ ++ halbtc8703b1ant_enable_gnt_to_gpio(btcoexist, FALSE); ++ ++ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) ++ halbtc8703b1ant_post_onoffState_to_bt(btcoexist, true); ++ ++ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ ++ /* Antenna config */ ++ if (wifi_only) { ++ coex_sta->concurrent_rx_mode_on = false; ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, ++ FORCE_EXEC, true, false); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, ++ FORCE_EXEC, false, false); ++ } else { ++ coex_sta->concurrent_rx_mode_on = true; ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); ++ /* RF 0x1[0] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x1, 0x0); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++ FORCE_EXEC, true, false); ++ } ++ ++ /* PTA parameter */ ++ halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70), ++ u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** 0x70/ 0x38/ 0x54 (After Init HW config) = 0x%x/ 0x%x/ 0x%x**********\n", ++ u32tmp0, ++ u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ ++} ++ ++ ++ ++void halbtc8703b1ant_psd_showdata(IN struct btc_coexist *btcoexist) ++{ ++ u8 *cli_buf = btcoexist->cli_buf; ++ u32 delta_freq_per_point; ++ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n\n============[PSD info] (%d)============\n", ++ psd_scan->psd_gen_count); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->psd_gen_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); ++ CL_PRINTF(cli_buf); ++ return; ++ } ++ ++ if (psd_scan->psd_point == 0) ++ delta_freq_per_point = 0; ++ else ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* if (psd_scan->is_psd_show_max_only) */ ++ if (0) { ++ psd_rep1 = psd_scan->psd_max_value / 100; ++ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; ++ ++ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + ++ psd_scan->psd_max_value_point * delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.0%d MHz", ++ freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.%d MHz", ++ freq1, freq2); ++ ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.0%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ ++ CL_PRINTF(cli_buf); ++ } else { ++ m = psd_scan->psd_start_point; ++ n = psd_scan->psd_start_point; ++ i = 1; ++ j = 1; ++ ++ while (1) { ++ do { ++ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * ++ delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (i == 1) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.000", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.0%2d", freq1, ++ freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.%3d", freq1, ++ freq2); ++ } else if ((i % 8 == 0) || ++ (m == psd_scan->psd_stop_point)) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.000\n", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.0%2d\n", freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.%3d\n", freq1, freq2); ++ } else { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.000", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.0%2d", freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.%3d", freq1, freq2); ++ } ++ ++ i++; ++ m++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); ++ ++ ++ do { ++ psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; ++ psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * ++ 100; ++ ++ if (j == 1) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.0%d", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.%d", psd_rep1, ++ psd_rep2); ++ } else if ((j % 8 == 0) || ++ (n == psd_scan->psd_stop_point)) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.0%d\n", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.%d\n", psd_rep1, psd_rep2); ++ } else { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.0%d", psd_rep1, psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.%d", psd_rep1, psd_rep2); ++ } ++ ++ j++; ++ n++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); ++ ++ if ((m > psd_scan->psd_stop_point) || ++ (n > psd_scan->psd_stop_point)) ++ break; ++ else { ++ i = 1; ++ j = 1; ++ } ++ ++ } ++ } ++ ++ ++} ++ ++void halbtc8703b1ant_psd_maxholddata(IN struct btc_coexist *btcoexist, ++ IN u32 gen_count) ++{ ++ u32 i = 0, i_max = 0, val_max = 0; ++ ++ if (gen_count == 1) { ++ memcpy(psd_scan->psd_report_max_hold, ++ psd_scan->psd_report, ++ BT_8703B_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); ++ ++ for (i = psd_scan->psd_start_point; ++ i <= psd_scan->psd_stop_point; i++) { ++ ++ } ++ ++ psd_scan->psd_max_value_point = 0; ++ psd_scan->psd_max_value = 0; ++ ++ } else { ++ for (i = psd_scan->psd_start_point; ++ i <= psd_scan->psd_stop_point; i++) { ++ if (psd_scan->psd_report[i] > ++ psd_scan->psd_report_max_hold[i]) ++ psd_scan->psd_report_max_hold[i] = ++ psd_scan->psd_report[i]; ++ ++ /* search Max Value */ ++ if (i == psd_scan->psd_start_point) { ++ i_max = i; ++ val_max = psd_scan->psd_report_max_hold[i]; ++ } else { ++ if (psd_scan->psd_report_max_hold[i] > ++ val_max) { ++ i_max = i; ++ val_max = psd_scan->psd_report_max_hold[i]; ++ } ++ } ++ ++ ++ } ++ ++ psd_scan->psd_max_value_point = i_max; ++ psd_scan->psd_max_value = val_max; ++ ++ } ++ ++ ++} ++ ++u32 halbtc8703b1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) ++{ ++ /* reg 0x808[9:0]: FFT data x */ ++ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ ++ /* reg 0x8b4[15:0]: FFT data y report */ ++ ++ u32 val = 0, psd_report = 0; ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ ++ val &= 0xffbffc00; ++ val |= point; ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ val |= 0x00400000; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); ++ ++ psd_report = val & 0x0000ffff; ++ ++ return psd_report; ++} ++ ++ ++boolean halbtc8703b1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, ++ IN u32 avgnum, IN u32 loopcnt) ++{ ++ u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0; ++ u32 points1 = 0, psd_report = 0; ++ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; ++ u32 psd_center_freq = 20 * 10 ^ 6; ++ boolean outloop = false, scan , roam, is_sweep_ok = true; ++ u8 flag = 0; ++ u32 tmp = 0, u32tmp1 = 0; ++ u32 wifi_original_channel = 1; ++ ++ psd_scan->is_psd_running = true; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ do { ++ switch (flag) { ++ case 0: /* Get PSD parameters */ ++ default: ++ ++ psd_scan->psd_band_width = 40 * 1000000; ++ psd_scan->psd_point = points; ++ psd_scan->psd_start_base = points / 2; ++ psd_scan->psd_avg_num = avgnum; ++ psd_scan->real_cent_freq = cent_freq; ++ psd_scan->real_offset = offset; ++ psd_scan->real_span = span; ++ ++ ++ points1 = psd_scan->psd_point; ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* PSD point setup */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffff0fff; ++ ++ switch (psd_scan->psd_point) { ++ case 128: ++ val |= 0x0; ++ break; ++ case 256: ++ default: ++ val |= 0x00004000; ++ break; ++ case 512: ++ val |= 0x00008000; ++ break; ++ case 1024: ++ val |= 0x0000c000; ++ break; ++ } ++ ++ switch (psd_scan->psd_avg_num) { ++ case 1: ++ val |= 0x0; ++ break; ++ case 8: ++ val |= 0x00001000; ++ break; ++ case 16: ++ val |= 0x00002000; ++ break; ++ case 32: ++ default: ++ val |= 0x00003000; ++ break; ++ } ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ flag = 1; ++ break; ++ case 1: /* calculate the PSD point index from freq/offset/span */ ++ psd_center_freq = psd_scan->psd_band_width / 2 + ++ offset * (1000000); ++ ++ start_p = psd_scan->psd_start_base + (psd_center_freq - ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_start_point = start_p - ++ psd_scan->psd_start_base; ++ ++ stop_p = psd_scan->psd_start_base + (psd_center_freq + ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_stop_point = stop_p - ++ psd_scan->psd_start_base - 1; ++ ++ flag = 2; ++ break; ++ case 2: /* set RF channel/BW/Mode */ ++ ++ /* set 3-wire off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val |= 0x00300000; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val &= 0xfeffffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* Tx-pause on */ ++ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f); ++ ++ /* store WiFi original channel */ ++ wifi_original_channel = btcoexist->btc_get_rf_reg( ++ btcoexist, BTC_RF_A, 0x18, 0x3ff); ++ ++ /* Set RF channel */ ++ if (cent_freq == 2484) ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, 0xe); ++ else ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, (cent_freq - 2412) / 5 + ++ 1); /* WiFi TRx Mask on */ ++ ++ /* save original RCK value */ ++ u32tmp1 = btcoexist->btc_get_rf_reg( ++ btcoexist, BTC_RF_A, 0x1d, 0xfffff); ++ ++ /* Enter debug mode */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, ++ 0x2, 0x1); ++ ++ /* Set RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, ++ 0xfffff, 0x2e); ++ ++ ++ /* Set RF mode = Rx, RF Gain = 0x320a0 */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, ++ 0xfffff, 0x320a0); ++ ++ while (1) { ++ if (k++ > BT_8703B_1ANT_ANTDET_SWEEPPOINT_DELAY) ++ break; ++ } ++ flag = 3; ++ break; ++ case 3: ++ psd_scan->psd_gen_count = 0; ++ for (j = 1; j <= loopcnt; j++) { ++ ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || roam) { ++ is_sweep_ok = false; ++ break; ++ } ++ memset(psd_scan->psd_report, 0, ++ psd_scan->psd_point * sizeof(u32)); ++ start_p = psd_scan->psd_start_point + ++ psd_scan->psd_start_base; ++ stop_p = psd_scan->psd_stop_point + ++ psd_scan->psd_start_base + 1; ++ ++ i = start_p; ++ point_index = 0; ++ ++ while (i < stop_p) { ++ if (i >= points1) ++ psd_report = ++ halbtc8703b1ant_psd_getdata( ++ btcoexist, i - points1); ++ else ++ psd_report = ++ halbtc8703b1ant_psd_getdata( ++ btcoexist, i); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Point=%d, psd_raw_data = 0x%08x\n", ++ i, psd_report); ++ BTC_TRACE(trace_buf); ++ if (psd_report == 0) ++ tmp = 0; ++ else ++ /* tmp = 20*log10((double)psd_report); */ ++ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ ++ tmp = 6 * halbtc8703b1ant_psd_log2base( ++ btcoexist, psd_report); ++ ++ n = i - psd_scan->psd_start_base; ++ psd_scan->psd_report[n] = tmp; ++ ++ ++ halbtc8703b1ant_psd_maxholddata( ++ btcoexist, j); ++ ++ i++; ++ ++ } ++ ++ psd_scan->psd_gen_count = j; ++ } ++ ++ flag = 100; ++ break; ++ case 99: /* error */ ++ ++ outloop = true; ++ break; ++ case 100: /* recovery */ ++ ++ /* set 3-wire on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val &= 0xffcfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val |= 0x01000000; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* Tx-pause off */ ++ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0); ++ ++ /* PSD off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffbfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ /* restore RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, ++ 0xfffff, u32tmp1); ++ ++ /* Exit debug mode */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, ++ 0x2, 0x0); ++ ++ /* restore WiFi original channel */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, ++ 0x3ff, wifi_original_channel); ++ ++ outloop = true; ++ break; ++ ++ } ++ ++ } while (!outloop); ++ ++ ++ ++ psd_scan->is_psd_running = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); ++ BTC_TRACE(trace_buf); ++ return is_sweep_ok; ++ ++} ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8703b1ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8703b1ant_ ++ * ************************************************************ */ ++void ex_halbtc8703b1ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 u8tmp = 0x0; ++ u16 u16tmp = 0x0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Execute 8703b 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Ant Det Finish = %s, Ant Det Number = %d\n", ++ (board_info->btdm_ant_det_finish ? "Yes" : "No"), ++ board_info->btdm_ant_num_by_ant_det); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = true; ++ ++ /* enable BB, REG_SYS_FUNC_EN such that we can write BB/MAC reg correctly. */ ++ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); ++ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); ++ ++ /* set Path control owner to WiFi */ ++ halbtc8703b1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8703B_1ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to high */ ++ halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8703B_1ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to low */ ++ halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8703B_1ANT_SIG_STA_SET_TO_LOW); ++ ++ /* set WLAN_ACT = 0 */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); ++ ++ halbtc8703b1ant_enable_gnt_to_gpio(btcoexist, FALSE); ++ ++ /* */ ++ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ ++ /* Local setting bit define */ ++ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ ++ /* BIT1: "0" for internal switch; "1" for external switch */ ++ /* BIT2: "0" for one antenna; "1" for two antenna */ ++ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ ++ ++ u8tmp = 0; ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; ++ ++ if (btcoexist->chip_interface == BTC_INTF_USB) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_SDIO) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); ++ ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** 0x70(MAC)/0x38/0x54 (Power-On) =0x%x/ 0x%x/ 0x%x**********\n", ++ btcoexist->btc_read_4byte(btcoexist, 0x70), ++ halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38), ++ halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54)); ++ BTC_TRACE(trace_buf); ++ ++ ++} ++ ++void ex_halbtc8703b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) ++{ ++} ++ ++void ex_halbtc8703b1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ halbtc8703b1ant_init_hw_config(btcoexist, true, wifi_only); ++ btcoexist->stop_coex_dm = false; ++} ++ ++void ex_halbtc8703b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8703b1ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_stack_info *stack_info = &btcoexist->stack_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; ++ u16 u16tmp[4]; ++ u32 u32tmp[4]; ++ u32 fa_of_dm, fa_cck; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ static u8 pop_report_in_10s = 0; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ if (btcoexist->stop_coex_dm) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Coex is STOPPED]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ if (psd_scan->ant_det_try_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", ++ "Ant PG Num/ Mech/ Pos", ++ board_info->pg_ant_num, board_info->btdm_ant_num, ++ board_info->btdm_ant_pos); ++ CL_PRINTF(cli_buf); ++ } else { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ %d/ %d (%d/%d/%d)", ++ "Ant PG Num/ Mech(Ant_Det)/ Pos", ++ board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, ++ board_info->btdm_ant_pos, ++ psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, ++ psd_scan->ant_det_result); ++ CL_PRINTF(cli_buf); ++ ++ if (board_info->btdm_ant_det_finish) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "Ant Det PSD Value", ++ psd_scan->ant_det_peak_val); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", ++ "BT stack/ hci ext ver", ++ ((stack_info->profile_notified) ? "Yes" : "No"), ++ stack_info->hci_version); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", ++ "Version Coex/ Fw/ Patch/ Cut", ++ glcoex_ver_date_8703b_1ant, glcoex_ver_8703b_1ant, fw_ver, ++ bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", ++ "WifibHiPri/ Ccklock/ CckEverLock", ++ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), ++ (coex_sta->cck_lock ? "Yes" : "No"), ++ (coex_sta->cck_ever_lock ? "Yes" : "No")); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ pop_report_in_10s++; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt/ popCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") ++ : ((BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, ++ coex_sta->pop_event_cnt); ++ CL_PRINTF(cli_buf); ++ ++ if (pop_report_in_10s >= 5) { ++ coex_sta->pop_event_cnt = 0; ++ pop_report_in_10s = 0; ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d / %d / %d / %d / %d", ++ "SCO/HID/PAN/A2DP/Hi-Pri", ++ bt_link_info->sco_exist, bt_link_info->hid_exist, ++ bt_link_info->pan_exist, bt_link_info->a2dp_exist, ++ bt_link_info->bt_hi_pri_link_exist); ++ CL_PRINTF(cli_buf); ++ ++ if (stack_info->profile_notified) ++ btcoexist->btc_disp_dbg_msg(btcoexist, ++ BTC_DBG_DISP_BT_LINK_INFO); ++ else { ++ bt_info_ext = coex_sta->bt_info_ext; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s / %d", ++ "Role/A2DP Rate/Bitpool", ++ ((bt_link_info->slave_role) ? "Slave" : "Master"), ++ (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool); ++ CL_PRINTF(cli_buf); ++ } ++ ++ ++ for (i = 0; i < BT_INFO_SRC_8703B_1ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8703b_1ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ if (btcoexist->manual_control) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms] (before Manual)============"); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "SM[LowPenaltyRA]", ++ coex_dm->cur_low_penalty_ra); ++ CL_PRINTF(cli_buf); ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case, ++ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), ++ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); ++ ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "WL/BT Coex Table Type", ++ coex_sta->coex_table_type); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8(coexTable)", ++ u32tmp[0], u32tmp[1], u32tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x778/0x6cc/IgnWlanAct", ++ u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa0); ++ u32tmp[1] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "LTE Coex Table W_L/B_L", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa8); ++ u32tmp[1] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xac); ++ u32tmp[2] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb0); ++ u32tmp[3] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "LTE Break Table W_L/B_L/L_W/L_B", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, ++ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); ++ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "0x430/0x434/0x42a/0x456", ++ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ ++ u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", ++ "LTE CoexOn/Path Ctrl Owner", ++ (int)((u32tmp[0] & BIT(7)) >> 7), ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "LTE 3Wire/OPMode/UART/UARTMode", ++ (int)((u32tmp[0] & BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), ++ (int)((u32tmp[0] & BIT(3)) >> 3), ++ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", ++ "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", ++ (int)((u32tmp[0] & BIT(12)) >> 12), (int)((u32tmp[0] & BIT(14)) >> 14), ++ ((u8tmp[0] & BIT(3)) ? "On" : "Off")); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", ++ (int)((u32tmp[0] & BIT(2)) >> 2), (int)((u32tmp[0] & BIT(3)) >> 3), ++ (int)((u32tmp[0] & BIT(1)) >> 1), (int)(u32tmp[0] & BIT(0))); ++ CL_PRINTF(cli_buf); ++ ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x4c6[4]/0x40[5] (WL/BT PTA)", ++ (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s", ++ "0x550(bcn ctrl)/0x522/4-RxAGC", ++ u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off"); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); ++ u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); ++ ++ fa_of_dm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) ++ >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + ++ ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & ++ 0xffff) ; ++ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; ++ ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xc50); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0xc50/OFDM-CCA/OFDM-FA/CCK-FA", ++ u32tmp[1] & 0xff, u32tmp[0] & 0xffff, fa_of_dm, fa_cck); ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_OK CCK/11g/11n/11n-Agg", ++ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, ++ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_Err CCK/11g/11n/11n-Agg", ++ coex_sta->crc_err_cck, coex_sta->crc_err_11g, ++ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770(high-pri rx/tx)", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(low-pri rx/tx)", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++ ++ halbtc8703b1ant_read_score_board(btcoexist, &u16tmp[0]); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x", ++ "ScoreBoard[14:0] (from BT)", u16tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++void ex_halbtc8703b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ coex_sta->under_lps = false; ++ ++ /* Write WL "Active" in Score-board for LPS off */ ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); ++ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++ FORCE_EXEC, false, true); ++ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); ++ ++ halbtc8703b1ant_init_hw_config(btcoexist, false, false); ++ halbtc8703b1ant_init_coex_dm(btcoexist); ++ halbtc8703b1ant_query_bt_info(btcoexist); ++ ++ coex_sta->under_ips = false; ++ } ++} ++ ++void ex_halbtc8703b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ coex_sta->under_ips = false; ++ ++ if (coex_sta->force_lps_on == true) { /* LPS No-32K */ ++ /* Write WL "Active" in Score-board for PS-TDMA */ ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); ++ ++ } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ ++ /* Write WL "Non-Active" in Score-board for Native-PS */ ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); ++ ++ } ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ ++ ++ /* Write WL "Active" in Score-board for LPS off */ ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); ++ ++ } ++} ++ ++void ex_halbtc8703b1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ halbtc8703b1ant_query_bt_info(btcoexist); ++ ++ if (BTC_SCAN_START == type) { ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); ++ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, ++ 8); ++ ++ /* Force antenna setup for no scan result issue */ ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ FORCE_EXEC, false, false); ++ ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8703b1ant_action_wifi_not_connected_scan(btcoexist); ++ else /* wifi is connected */ ++ halbtc8703b1ant_action_wifi_connected_scan(btcoexist); ++ ++ } else { ++ ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", coex_sta->scan_ap_num); ++ BTC_TRACE(trace_buf); ++ ++ if (!wifi_connected) ++ halbtc8703b1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8703b1ant_action_wifi_connected(btcoexist); ++ } ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START Notify() end\n"); ++ BTC_TRACE(trace_buf); ++ ++} ++ ++void ex_halbtc8703b1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ if (BTC_ASSOCIATE_START == type) { ++ coex_sta->wifi_is_high_pri_task = true; ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); ++ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, ++ 8); ++ ++ /* Force antenna setup for no scan result issue */ ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ FORCE_EXEC, false, false); ++ /* psd_scan->ant_det_is_ant_det_available = TRUE; */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->arp_cnt = 0; ++ ++ halbtc8703b1ant_action_wifi_not_connected_asso_auth(btcoexist); ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8703b1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8703b1ant_action_wifi_connected(btcoexist); ++ } ++ ++} ++ ++void ex_halbtc8703b1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); ++ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, ++ 8); ++ ++ /* Force antenna setup for no scan result issue */ ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ FORCE_EXEC, false, false); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ /* Set CCK Tx/Rx high Pri except 11b mode */ ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x00); /* CCK Rx */ ++ } else { ++ /* btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x10); */ /*CCK Tx */ ++ /* btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x10); */ /*CCK Rx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x10); /* CCK Rx */ ++ } ++ ++ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, ++ 0x430); ++ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, ++ 0x434); ++ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( ++ btcoexist, 0x42a); ++ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( ++ btcoexist, 0x456); ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ ++ ++ coex_sta->cck_ever_lock = false; ++ } ++ ++ halbtc8703b1ant_update_wifi_channel_info(btcoexist, type); ++ ++} ++ ++void ex_halbtc8703b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean under_4way = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (under_4way) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ---- under_4way!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ coex_sta->specific_pkt_period_cnt = 2; ++ } else if (BTC_PACKET_ARP == type) { ++ ++ coex_dm->arp_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ARP notify -cnt = %d\n", coex_dm->arp_cnt); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", type); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ coex_sta->specific_pkt_period_cnt = 2; ++ } ++ ++ if (coex_sta->wifi_is_high_pri_task) ++ halbtc8703b1ant_action_wifi_connected_specific_packet(btcoexist); ++} ++ ++void ex_halbtc8703b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 bt_info = 0; ++ u8 i, rsp_source = 0; ++ boolean wifi_connected = false; ++ boolean bt_busy = false; ++ ++ coex_sta->c2h_bt_info_req_sent = false; ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8703B_1ANT_MAX) ++ rsp_source = BT_INFO_SRC_8703B_1ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ if (i == 1) ++ bt_info = tmp_buf[i]; ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ if (BT_INFO_SRC_8703B_1ANT_WIFI_FW != rsp_source) { ++ ++ /* if 0xff, it means BT is under WHCK test */ ++ if (bt_info == 0xff) ++ coex_sta->bt_whck_test = true; ++ else ++ coex_sta->bt_whck_test = false; ++ ++ coex_sta->bt_retry_cnt = /* [3:0] */ ++ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; ++ ++ if (coex_sta->bt_retry_cnt >= 1) ++ coex_sta->pop_event_cnt++; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ++ coex_sta->c2h_bt_page = true; ++ else ++ coex_sta->c2h_bt_page = false; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ++ coex_sta->bt_create_connection = true; ++ else ++ coex_sta->bt_create_connection = false; ++ ++ /* unit: %, value-100 to translate to unit: dBm */ ++ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; ++ ++ /* coex_sta->bt_info_c2h[rsp_source][3]*2+10; */ ++ ++ if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) { ++ coex_sta->a2dp_bit_pool = ++ coex_sta->bt_info_c2h[rsp_source][6]; ++ } else ++ coex_sta->a2dp_bit_pool = 0; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][1] & 0x9) ++ coex_sta->acl_busy = true; ++ else ++ coex_sta->acl_busy = false; ++ ++ coex_sta->bt_info_ext = ++ coex_sta->bt_info_c2h[rsp_source][4]; ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ ++ if ((!btcoexist->manual_control) && (!btcoexist->stop_coex_dm)) { ++ ++ /* Re-Init */ ++ if (coex_sta->bt_info_ext & BIT(1)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (wifi_connected) ++ halbtc8703b1ant_update_wifi_channel_info(btcoexist, ++ BTC_MEDIA_CONNECT); ++ else ++ halbtc8703b1ant_update_wifi_channel_info(btcoexist, ++ BTC_MEDIA_DISCONNECT); ++ } ++ ++ /* If Ignore_WLanAct && not SetUp_Link */ ++ if ((coex_sta->bt_info_ext & BIT(3)) && (!(coex_sta->bt_info_ext & BIT(2)))) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8703b1ant_ignore_wlan_act(btcoexist, ++ FORCE_EXEC, false); ++ } ++ } ++ ++ /* check BIT2 first ==> check if bt is under inquiry or page scan */ ++ if (bt_info & BT_INFO_8703B_1ANT_B_INQ_PAGE) ++ coex_sta->c2h_bt_inquiry_page = true; ++ else ++ coex_sta->c2h_bt_inquiry_page = false; ++ ++ } ++ ++ coex_sta->num_of_profile = 0; ++ ++ /* set link exist status */ ++ if (!(bt_info & BT_INFO_8703B_1ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ ++ coex_sta->bt_hi_pri_link_exist = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (bt_info & BT_INFO_8703B_1ANT_B_FTP) { ++ coex_sta->pan_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->pan_exist = false; ++ if (bt_info & BT_INFO_8703B_1ANT_B_A2DP) { ++ coex_sta->a2dp_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->a2dp_exist = false; ++ if (bt_info & BT_INFO_8703B_1ANT_B_HID) { ++ coex_sta->hid_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->hid_exist = false; ++ if (bt_info & BT_INFO_8703B_1ANT_B_SCO_ESCO) { ++ coex_sta->sco_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->sco_exist = false; ++ ++ } ++ ++ ++ ++ halbtc8703b1ant_update_bt_link_info(btcoexist); ++ ++ bt_info = bt_info & ++ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ ++ ++ if (!(bt_info & BT_INFO_8703B_1ANT_B_CONNECTION)) { ++ coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info == ++ BT_INFO_8703B_1ANT_B_CONNECTION) { /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if ((bt_info & BT_INFO_8703B_1ANT_B_SCO_ESCO) || ++ (bt_info & BT_INFO_8703B_1ANT_B_SCO_BUSY)) { ++ coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info & BT_INFO_8703B_1ANT_B_ACL_BUSY) { ++ if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) ++ coex_dm->auto_tdma_adjust = false; ++ coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_ACL_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_MAX; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if ((BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ bt_busy = true; ++ else ++ bt_busy = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Manual CTRL<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ /* don't run coex mechanism while receve BTInfo if GNT_WL/GNT_BT control by SW */ ++ if (!coex_sta->gnt_control_by_PTA) ++ return; ++ ++ halbtc8703b1ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8703b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_RF_ON == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned ON!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wl_rf_off_on_event = true; ++ btcoexist->stop_coex_dm = false; ++ ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); ++ halbtc8703b1ant_post_onoffState_to_bt(btcoexist, true); ++ ++ /* halbtc8703b1ant_init_hw_config(btcoexist, false, false); */ ++ } else if (BTC_RF_OFF == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned OFF!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); ++ halbtc8703b1ant_post_onoffState_to_bt(btcoexist, false); ++ ++ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++ FORCE_EXEC, false, true); ++ ++ btcoexist->stop_coex_dm = true; ++ coex_sta->wl_rf_off_on_event = false; ++ ++ } ++} ++ ++void ex_halbtc8703b1ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); ++ halbtc8703b1ant_post_onoffState_to_bt(btcoexist, false); ++ ++ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, ++ false, true); ++ ++ ex_halbtc8703b1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++ ++ halbtc8703b1ant_enable_gnt_to_gpio(btcoexist, FALSE); ++ ++ btcoexist->stop_coex_dm = true; ++} ++ ++void ex_halbtc8703b1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_WIFI_PNP_SLEEP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); ++ halbtc8703b1ant_post_onoffState_to_bt(btcoexist, false); ++ ++ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++ FORCE_EXEC, false, true); ++ ++ btcoexist->stop_coex_dm = true; ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); ++ halbtc8703b1ant_post_onoffState_to_bt(btcoexist, true); ++ ++ btcoexist->stop_coex_dm = false; ++ } ++} ++ ++void ex_halbtc8703b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], *****************Coex DM Reset*****************\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8703b1ant_init_hw_config(btcoexist, false, false); ++ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ ++ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x2, 0xfffff, 0x0); */ ++ halbtc8703b1ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8703b1ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++ ++#if (BT_AUTO_REPORT_ONLY_8703B_1ANT == 0) ++ halbtc8703b1ant_query_bt_info(btcoexist); ++#endif ++ ++ halbtc8703b1ant_monitor_bt_ctr(btcoexist); ++ halbtc8703b1ant_monitor_wifi_ctr(btcoexist); ++ ++ halbtc8703b1ant_monitor_bt_enable_disable(btcoexist); ++ ++ /* for 4-way, DHCP, EAPOL packet */ ++ if (coex_sta->specific_pkt_period_cnt > 0) { ++ ++ coex_sta->specific_pkt_period_cnt--; ++ ++ if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No")); ++ BTC_TRACE(trace_buf); ++ ++ } ++ ++ if (halbtc8703b1ant_is_wifibt_status_changed(btcoexist)) ++ halbtc8703b1ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8703b1ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++ /* No Antenna Detection required because 8730b is only 1-Ant */ ++} ++ ++void ex_halbtc8703b1ant_antenna_isolation(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++ ++ ++} ++ ++void ex_halbtc8703b1ant_psd_scan(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++ ++ ++} ++ ++void ex_halbtc8703b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) ++{ ++ ++} ++ ++#endif ++ ++#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.h 2018-02-11 21:44:27.145146055 +0200 +@@ -0,0 +1,348 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8703B_SUPPORT == 1) ++/* ******************************************* ++ * The following is for 8703B 1ANT BT Co-exist definition ++ * ******************************************* */ ++#define BT_AUTO_REPORT_ONLY_8703B_1ANT 1 ++#define BT_8703B_1ANT_ENABLE_GNTBT_TO_GPIO14 0 ++ ++#define BT_INFO_8703B_1ANT_B_FTP BIT(7) ++#define BT_INFO_8703B_1ANT_B_A2DP BIT(6) ++#define BT_INFO_8703B_1ANT_B_HID BIT(5) ++#define BT_INFO_8703B_1ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8703B_1ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8703B_1ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8703B_1ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8703B_1ANT_B_CONNECTION BIT(0) ++ ++#define BT_INFO_8703B_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ ++ (((_BT_INFO_EXT_&BIT(0))) ? true : false) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT 2 ++ ++#define BT_8703B_1ANT_WIFI_NOISY_THRESH 50 /* max: 255 */ ++ ++/* for Antenna detection */ ++#define BT_8703B_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 ++#define BT_8703B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 ++#define BT_8703B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 ++#define BT_8703B_1ANT_ANTDET_PSDTHRES_1ANT 35 ++#define BT_8703B_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ ++#define BT_8703B_1ANT_ANTDET_SWEEPPOINT_DELAY 40000 ++#define BT_8703B_1ANT_ANTDET_ENABLE 0 ++#define BT_8703B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 ++ ++#define BT_8703B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 ++ ++enum bt_8703b_1ant_signal_state { ++ BT_8703B_1ANT_SIG_STA_SET_TO_LOW = 0x0, ++ BT_8703B_1ANT_SIG_STA_SET_BY_HW = 0x0, ++ BT_8703B_1ANT_SIG_STA_SET_TO_HIGH = 0x1, ++ BT_8703B_1ANT_SIG_STA_MAX ++}; ++ ++enum bt_8703b_1ant_path_ctrl_owner { ++ BT_8703B_1ANT_PCO_BTSIDE = 0x0, ++ BT_8703B_1ANT_PCO_WLSIDE = 0x1, ++ BT_8703B_1ANT_PCO_MAX ++}; ++ ++enum bt_8703b_1ant_gnt_ctrl_type { ++ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, ++ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW = 0x1, ++ BT_8703B_1ANT_GNT_TYPE_MAX ++}; ++ ++enum bt_8703b_1ant_gnt_ctrl_block { ++ BT_8703B_1ANT_GNT_BLOCK_RFC_BB = 0x0, ++ BT_8703B_1ANT_GNT_BLOCK_RFC = 0x1, ++ BT_8703B_1ANT_GNT_BLOCK_BB = 0x2, ++ BT_8703B_1ANT_GNT_BLOCK_MAX ++}; ++ ++enum bt_8703b_1ant_lte_coex_table_type { ++ BT_8703B_1ANT_CTT_WL_VS_LTE = 0x0, ++ BT_8703B_1ANT_CTT_BT_VS_LTE = 0x1, ++ BT_8703B_1ANT_CTT_MAX ++}; ++ ++enum bt_8703b_1ant_lte_break_table_type { ++ BT_8703B_1ANT_LBTT_WL_BREAK_LTE = 0x0, ++ BT_8703B_1ANT_LBTT_BT_BREAK_LTE = 0x1, ++ BT_8703B_1ANT_LBTT_LTE_BREAK_WL = 0x2, ++ BT_8703B_1ANT_LBTT_LTE_BREAK_BT = 0x3, ++ BT_8703B_1ANT_LBTT_MAX ++}; ++ ++enum bt_info_src_8703b_1ant { ++ BT_INFO_SRC_8703B_1ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8703B_1ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8703B_1ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8703B_1ANT_MAX ++}; ++ ++enum bt_8703b_1ant_bt_status { ++ BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8703B_1ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8703B_1ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8703B_1ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8703B_1ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8703b_1ant_wifi_status { ++ BT_8703B_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8703B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, ++ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, ++ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, ++ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, ++ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, ++ BT_8703B_1ANT_WIFI_STATUS_MAX ++}; ++ ++enum bt_8703b_1ant_coex_algo { ++ BT_8703B_1ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8703B_1ANT_COEX_ALGO_SCO = 0x1, ++ BT_8703B_1ANT_COEX_ALGO_HID = 0x2, ++ BT_8703B_1ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8703B_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, ++ BT_8703B_1ANT_COEX_ALGO_PANEDR = 0x5, ++ BT_8703B_1ANT_COEX_ALGO_PANHS = 0x6, ++ BT_8703B_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, ++ BT_8703B_1ANT_COEX_ALGO_PANEDR_HID = 0x8, ++ BT_8703B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, ++ BT_8703B_1ANT_COEX_ALGO_HID_A2DP = 0xa, ++ BT_8703B_1ANT_COEX_ALGO_MAX = 0xb, ++}; ++ ++struct coex_dm_8703b_1ant { ++ /* hw setting */ ++ u8 pre_ant_pos_type; ++ u8 cur_ant_pos_type; ++ /* fw mechanism */ ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean auto_tdma_adjust; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++ ++ /* sw mechanism */ ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ boolean limited_dig; ++ ++ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ ++ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ ++ u16 backup_retry_limit; ++ u8 backup_ampdu_max_time; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ u32 pre_ra_mask; ++ u32 cur_ra_mask; ++ u8 pre_arfr_type; ++ u8 cur_arfr_type; ++ u8 pre_retry_limit_type; ++ u8 cur_retry_limit_type; ++ u8 pre_ampdu_time_type; ++ u8 cur_ampdu_time_type; ++ u32 arp_cnt; ++ ++ u8 error_condition; ++}; ++ ++struct coex_sta_8703b_1ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ boolean bt_hi_pri_link_exist; ++ u8 num_of_profile; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 specific_pkt_period_cnt; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ s8 bt_rssi; ++ boolean bt_tx_rx_mask; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ boolean c2h_bt_info_req_sent; ++ u8 bt_info_c2h[BT_INFO_SRC_8703B_1ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8703B_1ANT_MAX]; ++ boolean bt_whck_test; ++ boolean c2h_bt_inquiry_page; ++ boolean c2h_bt_page; /* Add for win8.1 page out issue */ ++ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++ u32 pop_event_cnt; ++ u8 scan_ap_num; ++ ++ u32 crc_ok_cck; ++ u32 crc_ok_11g; ++ u32 crc_ok_11n; ++ u32 crc_ok_11n_agg; ++ ++ u32 crc_err_cck; ++ u32 crc_err_11g; ++ u32 crc_err_11n; ++ u32 crc_err_11n_agg; ++ ++ boolean cck_lock; ++ boolean pre_ccklock; ++ boolean cck_ever_lock; ++ u8 coex_table_type; ++ ++ boolean force_lps_on; ++ u32 wrong_profile_notification; ++ ++ boolean concurrent_rx_mode_on; ++ ++ u16 score_board; ++ ++ u8 a2dp_bit_pool; ++ u8 cut_version; ++ boolean acl_busy; ++ boolean wl_rf_off_on_event; ++ boolean bt_create_connection; ++ boolean gnt_control_by_PTA; ++}; ++ ++#define BT_8703B_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ ++#define BT_8703B_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ ++#define BT_8703B_1ANT_ANTDET_BUF_LEN 16 ++ ++struct psdscan_sta_8703b_1ant { ++ ++ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ ++ u32 ant_det_bt_tx_time; ++ u32 ant_det_pre_psdscan_peak_val; ++ boolean ant_det_is_ant_det_available; ++ u32 ant_det_psd_scan_peak_val; ++ boolean ant_det_is_btreply_available; ++ u32 ant_det_psd_scan_peak_freq; ++ ++ u8 ant_det_result; ++ u8 ant_det_peak_val[BT_8703B_1ANT_ANTDET_BUF_LEN]; ++ u8 ant_det_peak_freq[BT_8703B_1ANT_ANTDET_BUF_LEN]; ++ u32 ant_det_try_count; ++ u32 ant_det_fail_count; ++ u32 ant_det_inteval_count; ++ u32 ant_det_thres_offset; ++ ++ u32 real_cent_freq; ++ s32 real_offset; ++ u32 real_span; ++ ++ u32 psd_band_width; /* unit: Hz */ ++ u32 psd_point; /* 128/256/512/1024 */ ++ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_start_point; ++ u32 psd_stop_point; ++ u32 psd_max_value_point; ++ u32 psd_max_value; ++ u32 psd_start_base; ++ u32 psd_avg_num; /* 1/8/16/32 */ ++ u32 psd_gen_count; ++ boolean is_psd_running; ++ boolean is_psd_show_max_only; ++}; ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8703b1ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8703b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); ++void ex_halbtc8703b1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8703b1ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8703b1ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8703b1ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8703b1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8703b1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8703b1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8703b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8703b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8703b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8703b1ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8703b1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state); ++void ex_halbtc8703b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); ++void ex_halbtc8703b1ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist); ++void ex_halbtc8703b1ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++void ex_halbtc8703b1ant_antenna_isolation(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++ ++void ex_halbtc8703b1ant_psd_scan(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++void ex_halbtc8703b1ant_display_ant_detection(IN struct btc_coexist *btcoexist); ++ ++#else ++#define ex_halbtc8703b1ant_power_on_setting(btcoexist) ++#define ex_halbtc8703b1ant_pre_load_firmware(btcoexist) ++#define ex_halbtc8703b1ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8703b1ant_init_coex_dm(btcoexist) ++#define ex_halbtc8703b1ant_ips_notify(btcoexist, type) ++#define ex_halbtc8703b1ant_lps_notify(btcoexist, type) ++#define ex_halbtc8703b1ant_scan_notify(btcoexist, type) ++#define ex_halbtc8703b1ant_connect_notify(btcoexist, type) ++#define ex_halbtc8703b1ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8703b1ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8703b1ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8703b1ant_rf_status_notify(btcoexist, type) ++#define ex_halbtc8703b1ant_halt_notify(btcoexist) ++#define ex_halbtc8703b1ant_pnp_notify(btcoexist, pnp_state) ++#define ex_halbtc8703b1ant_coex_dm_reset(btcoexist) ++#define ex_halbtc8703b1ant_periodical(btcoexist) ++#define ex_halbtc8703b1ant_display_coex_info(btcoexist) ++#define ex_halbtc8703b1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) ++#define ex_halbtc8703b1ant_antenna_isolation(btcoexist, cent_freq, offset, span, seconds) ++#define ex_halbtc8703b1ant_psd_scan(btcoexist, cent_freq, offset, span, seconds) ++#define ex_halbtc8703b1ant_display_ant_detection(btcoexist) ++ ++#endif ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.c 2018-02-11 21:44:27.145146055 +0200 +@@ -0,0 +1,1544 @@ ++//============================================================ ++// Description: ++// ++// This file is for RTL8723A Co-exist mechanism ++// ++// History ++// 2012/08/22 Cosa first check in. ++// 2012/11/14 Cosa Revise for 8723A 1Ant out sourcing. ++// ++//============================================================ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "Mp_Precomp.h" ++ ++#if WPP_SOFTWARE_TRACE ++#include "HalBtc8723a1Ant.tmh" ++#endif ++ ++#if(BT_30_SUPPORT == 1) ++//============================================================ ++// Global variables, these are static variables ++//============================================================ ++static COEX_DM_8723A_1ANT GLCoexDm8723a1Ant; ++static PCOEX_DM_8723A_1ANT pCoexDm=&GLCoexDm8723a1Ant; ++static COEX_STA_8723A_1ANT GLCoexSta8723a1Ant; ++static PCOEX_STA_8723A_1ANT pCoexSta=&GLCoexSta8723a1Ant; ++ ++const char *const GLBtInfoSrc8723a1Ant[]={ ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++//============================================================ ++// local function proto type if needed ++//============================================================ ++//============================================================ ++// local function start with halbtc8723a1ant_ ++//============================================================ ++VOID ++halbtc8723a1ant_Reg0x550Bit3( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bSet ++ ) ++{ ++ u1Byte u1tmp=0; ++ ++ u1tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x550); ++ if(bSet) ++ { ++ u1tmp |= BIT3; ++ } ++ else ++ { ++ u1tmp &= ~BIT3; ++ } ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x550, u1tmp); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set 0x550[3]=%d\n", (bSet? 1:0))); ++} ++ ++VOID ++halbtc8723a1ant_NotifyFwScan( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte scanType ++ ) ++{ ++ u1Byte H2C_Parameter[1] ={0}; ++ ++ if(BTC_SCAN_START == scanType) ++ H2C_Parameter[0] = 0x1; ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Notify FW for wifi scan, write 0x3b=0x%x\n", ++ H2C_Parameter[0])); ++ ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x3b, 1, H2C_Parameter); ++} ++ ++VOID ++halbtc8723a1ant_QueryBtInfo( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte H2C_Parameter[1] ={0}; ++ ++ pCoexSta->bC2hBtInfoReqSent = TRUE; ++ ++ H2C_Parameter[0] |= BIT0; // trigger ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x38=0x%x\n", ++ H2C_Parameter[0])); ++ ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x38, 1, H2C_Parameter); ++} ++ ++VOID ++halbtc8723a1ant_SetSwRfRxLpfCorner( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bRxRfShrinkOn ++ ) ++{ ++ if(bRxRfShrinkOn) ++ { ++ //Shrink RF Rx LPF corner ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xf0ff7); ++ } ++ else ++ { ++ //Resume RF Rx LPF corner ++ // After initialized, we can use pCoexDm->btRf0x1eBackup ++ if(pBtCoexist->bInitilized) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); ++ } ++ } ++} ++ ++VOID ++halbtc8723a1ant_RfShrink( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bRxRfShrinkOn ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", ++ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); ++ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) ++ return; ++ } ++ halbtc8723a1ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); ++ ++ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; ++} ++ ++VOID ++halbtc8723a1ant_SetSwPenaltyTxRateAdaptive( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bLowPenaltyRa ++ ) ++{ ++ u1Byte tmpU1; ++ ++ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); ++ tmpU1 |= BIT0; ++ if(bLowPenaltyRa) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); ++ tmpU1 &= ~BIT2; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); ++ tmpU1 |= BIT2; ++ } ++ ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); ++} ++ ++VOID ++halbtc8723a1ant_LowPenaltyRa( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bLowPenaltyRa ++ ) ++{ ++ return; ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", ++ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); ++ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) ++ return; ++ } ++ halbtc8723a1ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); ++ ++ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; ++} ++ ++VOID ++halbtc8723a1ant_SetCoexTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u4Byte val0x6c0, ++ IN u4Byte val0x6c8, ++ IN u1Byte val0x6cc ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); ++} ++ ++VOID ++halbtc8723a1ant_CoexTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN u4Byte val0x6c0, ++ IN u4Byte val0x6c8, ++ IN u1Byte val0x6cc ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", ++ (bForceExec? "force to":""), val0x6c0, val0x6c8, val0x6cc)); ++ pCoexDm->curVal0x6c0 = val0x6c0; ++ pCoexDm->curVal0x6c8 = val0x6c8; ++ pCoexDm->curVal0x6cc = val0x6cc; ++ ++ if(!bForceExec) ++ { ++ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && ++ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && ++ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) ++ return; ++ } ++ halbtc8723a1ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c8, val0x6cc); ++ ++ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; ++ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; ++ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; ++} ++ ++VOID ++halbtc8723a1ant_SetFwIgnoreWlanAct( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bEnable ++ ) ++{ ++ u1Byte H2C_Parameter[1] ={0}; ++ ++ if(bEnable) ++ { ++ H2C_Parameter[0] |= BIT0; // function enable ++ } ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x25=0x%x\n", ++ H2C_Parameter[0])); ++ ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x25, 1, H2C_Parameter); ++} ++ ++VOID ++halbtc8723a1ant_IgnoreWlanAct( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bEnable ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", ++ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); ++ pCoexDm->bCurIgnoreWlanAct = bEnable; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) ++ return; ++ } ++ halbtc8723a1ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); ++ ++ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; ++} ++ ++VOID ++halbtc8723a1ant_SetFwPstdma( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type, ++ IN u1Byte byte1, ++ IN u1Byte byte2, ++ IN u1Byte byte3, ++ IN u1Byte byte4, ++ IN u1Byte byte5 ++ ) ++{ ++ u1Byte H2C_Parameter[5] ={0}; ++ u1Byte realByte1=byte1, realByte5=byte5; ++ BOOLEAN bApEnable=FALSE; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); ++ ++ // byte1[1:0] != 0 means enable pstdma ++ // for 2Ant bt coexist, if byte1 != 0 means enable pstdma ++ if(byte1) ++ { ++ if(bApEnable) ++ { ++ if(type != 5 && type != 12) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FW for 1Ant AP mode\n")); ++ realByte1 &= ~BIT4; ++ realByte1 |= BIT5; ++ ++ realByte5 |= BIT5; ++ realByte5 &= ~BIT6; ++ } ++ } ++ } ++ H2C_Parameter[0] = realByte1; ++ H2C_Parameter[1] = byte2; ++ H2C_Parameter[2] = byte3; ++ H2C_Parameter[3] = byte4; ++ H2C_Parameter[4] = realByte5; ++ ++ pCoexDm->psTdmaPara[0] = realByte1; ++ pCoexDm->psTdmaPara[1] = byte2; ++ pCoexDm->psTdmaPara[2] = byte3; ++ pCoexDm->psTdmaPara[3] = byte4; ++ pCoexDm->psTdmaPara[4] = realByte5; ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x3a(5bytes)=0x%x%08x\n", ++ H2C_Parameter[0], ++ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); ++ ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x3a, 5, H2C_Parameter); ++} ++ ++VOID ++halbtc8723a1ant_PsTdma( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bTurnOn, ++ IN u1Byte type ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", ++ (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); ++ pCoexDm->bCurPsTdmaOn = bTurnOn; ++ pCoexDm->curPsTdma = type; ++ ++ if(!bForceExec) ++ { ++ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && ++ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) ++ return; ++ } ++ if(pCoexDm->bCurPsTdmaOn) ++ { ++ switch(pCoexDm->curPsTdma) ++ { ++ case 1: ++ default: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x1a, 0x1a, 0x0, 0x40); ++ break; ++ case 2: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x12, 0x12, 0x0, 0x40); ++ break; ++ case 3: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x3f, 0x3, 0x10, 0x40); ++ break; ++ case 4: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x15, 0x3, 0x10, 0x0); ++ break; ++ case 5: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0xa9, 0x15, 0x3, 0x35, 0xc0); ++ break; ++ ++ case 8: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x25, 0x3, 0x10, 0x0); ++ break; ++ case 9: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0xa, 0xa, 0x0, 0x40); ++ break; ++ case 10: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0xa, 0xa, 0x0, 0x40); ++ break; ++ case 11: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x5, 0x5, 0x0, 0x40); ++ break; ++ case 12: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0xa9, 0xa, 0x3, 0x15, 0xc0); ++ break; ++ ++ case 18: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x25, 0x3, 0x10, 0x0); ++ break; ++ ++ case 20: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x2a, 0x2a, 0x0, 0x0); ++ break; ++ case 21: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x20, 0x3, 0x10, 0x40); ++ break; ++ case 22: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x1a, 0x1a, 0x2, 0x40); ++ break; ++ case 23: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x12, 0x12, 0x2, 0x40); ++ break; ++ case 24: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0xa, 0xa, 0x2, 0x40); ++ break; ++ case 25: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x5, 0x5, 0x2, 0x40); ++ break; ++ case 26: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x25, 0x3, 0x10, 0x0); ++ break; ++ case 27: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x5, 0x5, 0x2, 0x40); ++ break; ++ case 28: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x3, 0x2f, 0x2f, 0x0, 0x0); ++ break; ++ ++ } ++ } ++ else ++ { ++ // disable PS tdma ++ switch(pCoexDm->curPsTdma) ++ { ++ case 8: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x8, 0x0, 0x0, 0x0, 0x0); ++ break; ++ case 0: ++ default: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x0, 0x0, 0x0, 0x0, 0x0); ++ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x860, 0x210); ++ break; ++ case 9: ++ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x0, 0x0, 0x0, 0x0, 0x0); ++ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x860, 0x110); ++ break; ++ ++ } ++ } ++ ++ // update pre state ++ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; ++ pCoexDm->prePsTdma = pCoexDm->curPsTdma; ++} ++ ++ ++VOID ++halbtc8723a1ant_CoexAllOff( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ // fw all off ++ halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ ++ // sw all off ++ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); ++ ++ // hw all off ++ halbtc8723a1ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++} ++ ++VOID ++halbtc8723a1ant_InitCoexDm( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ // force to reset coex mechanism ++ halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); ++} ++ ++VOID ++halbtc8723a1ant_BtEnableAction( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); ++} ++ ++VOID ++halbtc8723a1ant_MonitorBtCtr( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u4Byte regHPTxRx, regLPTxRx, u4Tmp; ++ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; ++ u1Byte u1Tmp; ++ ++ regHPTxRx = 0x770; ++ regLPTxRx = 0x774; ++ ++ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); ++ regHPTx = u4Tmp & bMaskLWord; ++ regHPRx = (u4Tmp & bMaskHWord)>>16; ++ ++ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); ++ regLPTx = u4Tmp & bMaskLWord; ++ regLPRx = (u4Tmp & bMaskHWord)>>16; ++ ++ pCoexSta->highPriorityTx = regHPTx; ++ pCoexSta->highPriorityRx = regHPRx; ++ pCoexSta->lowPriorityTx = regLPTx; ++ pCoexSta->lowPriorityRx = regLPRx; ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); ++ ++ // reset counter ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); ++} ++ ++VOID ++halbtc8723a1ant_MonitorBtEnableDisable( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ static BOOLEAN bPreBtDisabled=FALSE; ++ static u4Byte btDisableCnt=0; ++ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; ++ ++ // This function check if bt is disabled ++ ++ if( pCoexSta->highPriorityTx == 0 && ++ pCoexSta->highPriorityRx == 0 && ++ pCoexSta->lowPriorityTx == 0 && ++ pCoexSta->lowPriorityRx == 0) ++ { ++ bBtActive = FALSE; ++ } ++ if( pCoexSta->highPriorityTx == 0xffff && ++ pCoexSta->highPriorityRx == 0xffff && ++ pCoexSta->lowPriorityTx == 0xffff && ++ pCoexSta->lowPriorityRx == 0xffff) ++ { ++ bBtActive = FALSE; ++ } ++ if(bBtActive) ++ { ++ btDisableCnt = 0; ++ bBtDisabled = FALSE; ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); ++ } ++ else ++ { ++ btDisableCnt++; ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", ++ btDisableCnt)); ++ if(btDisableCnt >= 2) ++ { ++ bBtDisabled = TRUE; ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); ++ } ++ } ++ if(bPreBtDisabled != bBtDisabled) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", ++ (bPreBtDisabled ? "disabled":"enabled"), ++ (bBtDisabled ? "disabled":"enabled"))); ++ bPreBtDisabled = bBtDisabled; ++ if(!bBtDisabled) ++ { ++ halbtc8723a1ant_BtEnableAction(pBtCoexist); ++ } ++ else ++ { ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); ++ } ++ } ++} ++ ++VOID ++halbtc8723a1ant_TdmaDurationAdjust( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ static s4Byte up,dn,m,n,WaitCount; ++ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration ++ u1Byte retryCount=0; ++ u1Byte btState; ++ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; ++ u4Byte wifiBw; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ btState = pCoexDm->btStatus; ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], TdmaDurationAdjust()\n")); ++ if(pCoexDm->psTdmaGlobalCnt != pCoexDm->psTdmaMonitorCnt) ++ { ++ pCoexDm->psTdmaMonitorCnt = 0; ++ pCoexDm->psTdmaGlobalCnt = 0; ++ } ++ if(pCoexDm->psTdmaMonitorCnt == 0) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], first run BT A2DP + WiFi busy state!!\n")); ++ if(btState == BT_STATE_8723A_1ANT_ACL_ONLY_BUSY) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); ++ pCoexDm->psTdmaDuAdjType = 1; ++ } ++ else ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); ++ pCoexDm->psTdmaDuAdjType = 22; ++ } ++ //============ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n= 3; ++ result = 0; ++ WaitCount = 0; ++ } ++ else ++ { ++ //accquire the BT TRx retry count from BT_Info byte2 ++ retryCount = pCoexSta->btRetryCnt; ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], retryCount = %d\n", retryCount)); ++ result = 0; ++ WaitCount++; ++ ++ if(retryCount == 0) // no retry in the last 2-second duration ++ { ++ up++; ++ dn--; ++ ++ if (dn <= 0) ++ dn = 0; ++ ++ if(up >= n) // if s n 2 retry count0, hռeWiFi duration ++ { ++ WaitCount = 0; ++ n = 3; ++ up = 0; ++ dn = 0; ++ result = 1; ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Increase wifi duration!!\n")); ++ } ++ } ++ else if (retryCount <= 3) // <=3 retry in the last 2-second duration ++ { ++ up--; ++ dn++; ++ ++ if (up <= 0) ++ up = 0; ++ ++ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration ++ { ++ if (WaitCount <= 2) ++ m++; // קK@blevelӦ^ ++ else ++ m = 1; ++ ++ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. ++ m = 20; ++ ++ n = 3*m; ++ up = 0; ++ dn = 0; ++ WaitCount = 0; ++ result = -1; ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); ++ } ++ } ++ else //retry count > 3, un1 retry count > 3, hկWiFi duration ++ { ++ if (WaitCount == 1) ++ m++; // קK@blevelӦ^ ++ else ++ m = 1; ++ ++ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. ++ m = 20; ++ ++ n = 3*m; ++ up = 0; ++ dn = 0; ++ WaitCount = 0; ++ result = -1; ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); ++ } ++ ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT TxRx counter H+L <= 1200\n")); ++ if(btState != BT_STATE_8723A_1ANT_ACL_ONLY_BUSY) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], NOT ACL only busy!\n")); ++ if(BTC_WIFI_BW_HT40 != wifiBw) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 20MHz\n")); ++ if(result == -1) ++ { ++ if(pCoexDm->curPsTdma == 22) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); ++ pCoexDm->psTdmaDuAdjType = 23; ++ } ++ else if(pCoexDm->curPsTdma == 23) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); ++ pCoexDm->psTdmaDuAdjType = 24; ++ } ++ else if(pCoexDm->curPsTdma == 24) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); ++ pCoexDm->psTdmaDuAdjType = 25; ++ } ++ } ++ else if (result == 1) ++ { ++ if(pCoexDm->curPsTdma == 25) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); ++ pCoexDm->psTdmaDuAdjType = 24; ++ } ++ else if(pCoexDm->curPsTdma == 24) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); ++ pCoexDm->psTdmaDuAdjType = 23; ++ } ++ else if(pCoexDm->curPsTdma == 23) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); ++ pCoexDm->psTdmaDuAdjType = 22; ++ } ++ } ++ // error handle, if not in the following state, ++ // set psTdma again. ++ if( (pCoexDm->psTdmaDuAdjType != 22) && ++ (pCoexDm->psTdmaDuAdjType != 23) && ++ (pCoexDm->psTdmaDuAdjType != 24) && ++ (pCoexDm->psTdmaDuAdjType != 25) ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], duration case out of handle!!\n")); ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); ++ pCoexDm->psTdmaDuAdjType = 23; ++ } ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 40MHz\n")); ++ if(result == -1) ++ { ++ if(pCoexDm->curPsTdma == 23) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); ++ pCoexDm->psTdmaDuAdjType = 24; ++ } ++ else if(pCoexDm->curPsTdma == 24) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); ++ pCoexDm->psTdmaDuAdjType = 25; ++ } ++ else if(pCoexDm->curPsTdma == 25) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 27); ++ pCoexDm->psTdmaDuAdjType = 27; ++ } ++ } ++ else if (result == 1) ++ { ++ if(pCoexDm->curPsTdma == 27) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); ++ pCoexDm->psTdmaDuAdjType = 25; ++ } ++ else if(pCoexDm->curPsTdma == 25) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); ++ pCoexDm->psTdmaDuAdjType = 24; ++ } ++ else if(pCoexDm->curPsTdma == 24) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); ++ pCoexDm->psTdmaDuAdjType = 23; ++ } ++ } ++ // error handle, if not in the following state, ++ // set psTdma again. ++ if( (pCoexDm->psTdmaDuAdjType != 23) && ++ (pCoexDm->psTdmaDuAdjType != 24) && ++ (pCoexDm->psTdmaDuAdjType != 25) && ++ (pCoexDm->psTdmaDuAdjType != 27) ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], duration case out of handle!!\n")); ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); ++ pCoexDm->psTdmaDuAdjType = 24; ++ } ++ } ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ACL only busy\n")); ++ if (result == -1) ++ { ++ if(pCoexDm->curPsTdma == 1) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ pCoexDm->psTdmaDuAdjType = 2; ++ } ++ else if(pCoexDm->curPsTdma == 2) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); ++ pCoexDm->psTdmaDuAdjType = 9; ++ } ++ else if(pCoexDm->curPsTdma == 9) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ } ++ else if (result == 1) ++ { ++ if(pCoexDm->curPsTdma == 11) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); ++ pCoexDm->psTdmaDuAdjType = 9; ++ } ++ else if(pCoexDm->curPsTdma == 9) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ pCoexDm->psTdmaDuAdjType = 2; ++ } ++ else if(pCoexDm->curPsTdma == 2) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); ++ pCoexDm->psTdmaDuAdjType = 1; ++ } ++ } ++ ++ // error handle, if not in the following state, ++ // set psTdma again. ++ if( (pCoexDm->psTdmaDuAdjType != 1) && ++ (pCoexDm->psTdmaDuAdjType != 2) && ++ (pCoexDm->psTdmaDuAdjType != 9) && ++ (pCoexDm->psTdmaDuAdjType != 11) ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], duration case out of handle!!\n")); ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ pCoexDm->psTdmaDuAdjType = 2; ++ } ++ } ++ } ++ } ++ ++ // if current PsTdma not match with the recorded one (when scan, dhcp...), ++ // then we have to adjust it back to the previous record one. ++ if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", ++ pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); ++ ++ if( !bScan && !bLink && !bRoam) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); ++ } ++ } ++ pCoexDm->psTdmaMonitorCnt++; ++} ++ ++ ++VOID ++halbtc8723a1ant_CoexForWifiConnect( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bWifiConnected=FALSE, bWifiBusy=FALSE; ++ u1Byte btState, btInfoOriginal=0; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); ++ ++ btState = pCoexDm->btStatus; ++ btInfoOriginal = pCoexSta->btInfoC2h[BT_INFO_SRC_8723A_1ANT_BT_RSP][0]; ++ ++ if(bWifiConnected) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi connected!!\n")); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ ++ if( !bWifiBusy && ++ ((BT_STATE_8723A_1ANT_NO_CONNECTION == btState) || ++ (BT_STATE_8723A_1ANT_CONNECT_IDLE == btState)) ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], [Wifi is idle] or [Bt is non connected idle or Bt is connected idle]!!\n")); ++ ++ if(BT_STATE_8723A_1ANT_NO_CONNECTION == btState) ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); ++ else if(BT_STATE_8723A_1ANT_CONNECT_IDLE == btState) ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ ++ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0xc0); ++ } ++ else ++ { ++ if( (BT_STATE_8723A_1ANT_SCO_ONLY_BUSY == btState) || ++ (BT_STATE_8723A_1ANT_ACL_SCO_BUSY == btState) || ++ (BT_STATE_8723A_1ANT_HID_BUSY == btState) || ++ (BT_STATE_8723A_1ANT_HID_SCO_BUSY == btState) ) ++ { ++ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0x60); ++ } ++ else ++ { ++ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0xc0); ++ } ++ switch(btState) ++ { ++ case BT_STATE_8723A_1ANT_NO_CONNECTION: ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); ++ break; ++ case BT_STATE_8723A_1ANT_CONNECT_IDLE: ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); ++ break; ++ case BT_STATE_8723A_1ANT_INQ_OR_PAG: ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ break; ++ case BT_STATE_8723A_1ANT_SCO_ONLY_BUSY: ++ case BT_STATE_8723A_1ANT_ACL_SCO_BUSY: ++ case BT_STATE_8723A_1ANT_HID_BUSY: ++ case BT_STATE_8723A_1ANT_HID_SCO_BUSY: ++ halbtc8723a1ant_TdmaDurationAdjust(pBtCoexist); ++ break; ++ case BT_STATE_8723A_1ANT_ACL_ONLY_BUSY: ++ if (btInfoOriginal&BT_INFO_8723A_1ANT_B_A2DP) ++ { ++ halbtc8723a1ant_TdmaDurationAdjust(pBtCoexist); ++ } ++ else if(btInfoOriginal&BT_INFO_8723A_1ANT_B_FTP) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); ++ } ++ else if( (btInfoOriginal&BT_INFO_8723A_1ANT_B_A2DP) && ++ (btInfoOriginal&BT_INFO_8723A_1ANT_B_FTP) ) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ } ++ else ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); ++ } ++ break; ++ default: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], error!!!, undefined case in halbtc8723a1ant_CoexForWifiConnect()!!\n")); ++ break; ++ } ++ } ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is disconnected!!\n")); ++ } ++ ++ pCoexDm->psTdmaGlobalCnt++; ++} ++ ++//============================================================ ++// work around function start with wa_halbtc8723a1ant_ ++//============================================================ ++VOID ++wa_halbtc8723a1ant_MonitorC2h( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte tmp1b=0x0; ++ u4Byte curC2hTotalCnt=0x0; ++ static u4Byte preC2hTotalCnt=0x0, sameCntPollingTime=0x0; ++ ++ curC2hTotalCnt+=pCoexSta->btInfoC2hCnt[BT_INFO_SRC_8723A_1ANT_BT_RSP]; ++ ++ if(curC2hTotalCnt == preC2hTotalCnt) ++ { ++ sameCntPollingTime++; ++ } ++ else ++ { ++ preC2hTotalCnt = curC2hTotalCnt; ++ sameCntPollingTime = 0; ++ } ++ ++ if(sameCntPollingTime >= 2) ++ { ++ tmp1b = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x1af); ++ if(tmp1b != 0x0) ++ { ++ pCoexSta->c2hHangDetectCnt++; ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x1af, 0x0); ++ } ++ } ++} ++ ++//============================================================ ++// extern function start with EXhalbtc8723a1ant_ ++//============================================================ ++VOID ++EXhalbtc8723a1ant_InitHwConfig( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Init HW Config!!\n")); ++ ++ // backup rf 0x1e value ++ pCoexDm->btRf0x1eBackup = ++ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); ++ ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x20); ++ ++ // enable counter statistics ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); ++ ++ // coex table ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, 0x0); // 1-Ant coex ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, 0xffff); // wifi break table ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, 0x55555555); //coex table ++ ++ // antenna switch control parameter ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x858, 0xaaaaaaaa); ++ ++ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x860, 0x210); //set antenna at wifi side if ANTSW is software control ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x870, 0x300); //SPDT(connected with TRSW) control by hardware PTA ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x874, 0x22804000); //ANTSW keep by GNT_BT ++ ++ // coexistence parameters ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x1); // enable RTK mode PTA ++} ++ ++VOID ++EXhalbtc8723a1ant_InitCoexDm( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); ++ ++ halbtc8723a1ant_InitCoexDm(pBtCoexist); ++} ++ ++VOID ++EXhalbtc8723a1ant_DisplayCoexInfo( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; ++ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; ++ pu1Byte cliBuf=pBtCoexist->cliBuf; ++ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; ++ u4Byte u4Tmp[4]; ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ ++ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); ++ CL_PRINTF(cliBuf); ++ ++ if(pBtCoexist->bManualControl) ++ { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); ++ CL_PRINTF(cliBuf); ++ } ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ ++ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ ++ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], ++ pCoexDm->wifiChnlInfo[2]); ++ CL_PRINTF(cliBuf); ++ ++ // wifi status ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); ++ CL_PRINTF(cliBuf); ++ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ ++ ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8723A_1ANT_BT_STATUS_IDLE == pCoexDm->btStatus)? "idle":( (BT_8723A_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy"))), ++ pCoexSta->btRssi, pCoexSta->btRetryCnt); ++ CL_PRINTF(cliBuf); ++ ++ if(pStackInfo->bProfileNotified) ++ { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ ++ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); ++ CL_PRINTF(cliBuf); ++ ++ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); ++ } ++ ++ btInfoExt = pCoexSta->btInfoExt; ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ ++ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); ++ CL_PRINTF(cliBuf); ++ ++ for(i=0; ibtInfoC2hCnt[i]) ++ { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723a1Ant[i], \ ++ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], ++ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], ++ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], ++ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); ++ CL_PRINTF(cliBuf); ++ } ++ } ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "write 0x1af=0x0 num", \ ++ pCoexSta->c2hHangDetectCnt); ++ CL_PRINTF(cliBuf); ++ ++ // Sw mechanism ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); ++ CL_PRINTF(cliBuf); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "SM1[ShRf/ LpRA/ LimDig]", \ ++ pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); ++ CL_PRINTF(cliBuf); ++ ++ // Fw mechanism ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); ++ CL_PRINTF(cliBuf); ++ ++ if(!pBtCoexist->bManualControl) ++ { ++ psTdmaCase = pCoexDm->curPsTdma; ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", "PS TDMA", \ ++ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], ++ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], ++ pCoexDm->psTdmaPara[4], psTdmaCase); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", "IgnWlanAct", \ ++ pCoexDm->bCurIgnoreWlanAct); ++ CL_PRINTF(cliBuf); ++ } ++ ++ // Hw setting ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ ++ pCoexDm->btRf0x1eBackup); ++ CL_PRINTF(cliBuf); ++ ++ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); ++ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x783); ++ u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x796); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/ 0x783/ 0x796", \ ++ u1Tmp[0], u1Tmp[1], u1Tmp[2]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x880", \ ++ u4Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ ++ u1Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); ++ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ ++ u4Tmp[0], u1Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x484); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x484(rate adaptive)", \ ++ u4Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ ++ u4Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); ++ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); ++ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); ++ u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xdac); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0xda0/0xda4/0xda8/0xdac(FA cnt)", \ ++ u4Tmp[0], u4Tmp[1], u4Tmp[2], u4Tmp[3]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); ++ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); ++ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); ++ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ ++ u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770 (hp rx[31:16]/tx[15:0])", \ ++ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); ++ CL_PRINTF(cliBuf); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(lp rx[31:16]/tx[15:0])", \ ++ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); ++ CL_PRINTF(cliBuf); ++ ++ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++VOID ++EXhalbtc8723a1ant_IpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_IPS_ENTER == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); ++ halbtc8723a1ant_CoexAllOff(pBtCoexist); ++ } ++ else if(BTC_IPS_LEAVE == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); ++ //halbtc8723a1ant_InitCoexDm(pBtCoexist); ++ } ++} ++ ++VOID ++EXhalbtc8723a1ant_LpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_LPS_ENABLE == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); ++ } ++ else if(BTC_LPS_DISABLE == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); ++ } ++} ++ ++VOID ++EXhalbtc8723a1ant_ScanNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ BOOLEAN bWifiConnected=FALSE; ++ ++ halbtc8723a1ant_NotifyFwScan(pBtCoexist, type); ++ ++ if(pBtCoexist->btInfo.bBtDisabled) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); ++ } ++ else ++ { ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); ++ if(BTC_SCAN_START == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); ++ if(!bWifiConnected) // non-connected scan ++ { ++ //set 0x550[3]=1 before PsTdma ++ halbtc8723a1ant_Reg0x550Bit3(pBtCoexist, TRUE); ++ } ++ ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); ++ } ++ else if(BTC_SCAN_FINISH == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); ++ if(!bWifiConnected) // non-connected scan ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ } ++ else ++ { ++ halbtc8723a1ant_CoexForWifiConnect(pBtCoexist); ++ } ++ } ++ } ++} ++ ++VOID ++EXhalbtc8723a1ant_ConnectNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ BOOLEAN bWifiConnected=FALSE; ++ ++ if(pBtCoexist->btInfo.bBtDisabled) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); ++ } ++ else ++ { ++ if(BTC_ASSOCIATE_START == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); ++ //set 0x550[3]=1 before PsTdma ++ halbtc8723a1ant_Reg0x550Bit3(pBtCoexist, TRUE); ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); // extend wifi slot ++ } ++ else if(BTC_ASSOCIATE_FINISH == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); ++ if(!bWifiConnected) // non-connected scan ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ } ++ else ++ { ++ halbtc8723a1ant_CoexForWifiConnect(pBtCoexist); ++ } ++ } ++ } ++} ++ ++VOID ++EXhalbtc8723a1ant_MediaStatusNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_MEDIA_CONNECT == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); ++ } ++} ++ ++VOID ++EXhalbtc8723a1ant_SpecialPacketNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(type == BTC_PACKET_DHCP) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); ++ if(pBtCoexist->btInfo.bBtDisabled) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); ++ } ++ else ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 18); ++ } ++ } ++} ++ ++VOID ++EXhalbtc8723a1ant_BtInfoNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN pu1Byte tmpBuf, ++ IN u1Byte length ++ ) ++{ ++ u1Byte btInfo=0; ++ u1Byte i, rspSource=0; ++ BOOLEAN bBtHsOn=FALSE, bBtBusy=FALSE, bForceLps=FALSE; ++ ++ pCoexSta->bC2hBtInfoReqSent = FALSE; ++ ++ rspSource = BT_INFO_SRC_8723A_1ANT_BT_RSP; ++ pCoexSta->btInfoC2hCnt[rspSource]++; ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); ++ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; ++ if(i == 0) ++ btInfo = tmpBuf[i]; ++ if(i == length-1) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); ++ } ++ } ++ ++ if(BT_INFO_SRC_8723A_1ANT_WIFI_FW != rspSource) ++ { ++ pCoexSta->btRetryCnt = ++ pCoexSta->btInfoC2h[rspSource][1]; ++ ++ pCoexSta->btRssi = ++ pCoexSta->btInfoC2h[rspSource][2]*2+10; ++ ++ pCoexSta->btInfoExt = ++ pCoexSta->btInfoC2h[rspSource][3]; ++ } ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ // check BIT2 first ==> check if bt is under inquiry or page scan ++ if(btInfo & BT_INFO_8723A_1ANT_B_INQ_PAGE) ++ { ++ pCoexSta->bC2hBtInquiryPage = TRUE; ++ } ++ else ++ { ++ pCoexSta->bC2hBtInquiryPage = FALSE; ++ } ++ btInfo &= ~BIT2; ++ if(!(btInfo & BIT0)) ++ { ++ pCoexDm->btStatus = BT_STATE_8723A_1ANT_NO_CONNECTION; ++ bForceLps = FALSE; ++ } ++ else ++ { ++ bForceLps = TRUE; ++ if(btInfo == 0x1) ++ { ++ pCoexDm->btStatus = BT_STATE_8723A_1ANT_CONNECT_IDLE; ++ } ++ else if(btInfo == 0x9) ++ { ++ pCoexDm->btStatus = BT_STATE_8723A_1ANT_ACL_ONLY_BUSY; ++ bBtBusy = TRUE; ++ } ++ else if(btInfo == 0x13) ++ { ++ pCoexDm->btStatus = BT_STATE_8723A_1ANT_SCO_ONLY_BUSY; ++ bBtBusy = TRUE; ++ } ++ else if(btInfo == 0x1b) ++ { ++ pCoexDm->btStatus = BT_STATE_8723A_1ANT_ACL_SCO_BUSY; ++ bBtBusy = TRUE; ++ } ++ else if(btInfo == 0x29) ++ { ++ pCoexDm->btStatus = BT_STATE_8723A_1ANT_HID_BUSY; ++ bBtBusy = TRUE; ++ } ++ else if(btInfo == 0x3b) ++ { ++ pCoexDm->btStatus = BT_STATE_8723A_1ANT_HID_SCO_BUSY; ++ bBtBusy = TRUE; ++ } ++ } ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bBtBusy); ++ if(bForceLps) ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); ++ else ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); ++ ++ if( (BT_STATE_8723A_1ANT_NO_CONNECTION == pCoexDm->btStatus) || ++ (BT_STATE_8723A_1ANT_CONNECT_IDLE == pCoexDm->btStatus) ) ++ { ++ if(pCoexSta->bC2hBtInquiryPage) ++ pCoexDm->btStatus = BT_STATE_8723A_1ANT_INQ_OR_PAG; ++ } ++} ++ ++VOID ++EXhalbtc8723a1ant_HaltNotify( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ halbtc8723a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); ++ ++ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, FORCE_EXEC, FALSE); ++ halbtc8723a1ant_RfShrink(pBtCoexist, FORCE_EXEC, FALSE); ++ ++ halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); ++ EXhalbtc8723a1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); ++} ++ ++VOID ++EXhalbtc8723a1ant_Periodical( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE, bWifiConnected=FALSE; ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Periodical!!\n")); ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); ++ ++ // work around for c2h hang ++ wa_halbtc8723a1ant_MonitorC2h(pBtCoexist); ++ ++ halbtc8723a1ant_QueryBtInfo(pBtCoexist); ++ halbtc8723a1ant_MonitorBtCtr(pBtCoexist); ++ halbtc8723a1ant_MonitorBtEnableDisable(pBtCoexist); ++ ++ ++ if(bScan) ++ return; ++ if(bLink) ++ return; ++ ++ if(bWifiConnected) ++ { ++ if(pBtCoexist->btInfo.bBtDisabled) ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); ++ ++ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); ++ } ++ else ++ { ++ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a1ant_CoexForWifiConnect(pBtCoexist); ++ } ++ } ++ else ++ { ++ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ ++ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); ++ } ++} ++ ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.h 2018-02-11 21:44:27.145146055 +0200 +@@ -0,0 +1,171 @@ ++//=========================================== ++// The following is for 8723A 1Ant BT Co-exist definition ++//=========================================== ++#define BT_INFO_8723A_1ANT_B_FTP BIT7 ++#define BT_INFO_8723A_1ANT_B_A2DP BIT6 ++#define BT_INFO_8723A_1ANT_B_HID BIT5 ++#define BT_INFO_8723A_1ANT_B_SCO_BUSY BIT4 ++#define BT_INFO_8723A_1ANT_B_ACL_BUSY BIT3 ++#define BT_INFO_8723A_1ANT_B_INQ_PAGE BIT2 ++#define BT_INFO_8723A_1ANT_B_SCO_ESCO BIT1 ++#define BT_INFO_8723A_1ANT_B_CONNECTION BIT0 ++ ++typedef enum _BT_STATE_8723A_1ANT{ ++ BT_STATE_8723A_1ANT_DISABLED = 0, ++ BT_STATE_8723A_1ANT_NO_CONNECTION = 1, ++ BT_STATE_8723A_1ANT_CONNECT_IDLE = 2, ++ BT_STATE_8723A_1ANT_INQ_OR_PAG = 3, ++ BT_STATE_8723A_1ANT_ACL_ONLY_BUSY = 4, ++ BT_STATE_8723A_1ANT_SCO_ONLY_BUSY = 5, ++ BT_STATE_8723A_1ANT_ACL_SCO_BUSY = 6, ++ BT_STATE_8723A_1ANT_HID_BUSY = 7, ++ BT_STATE_8723A_1ANT_HID_SCO_BUSY = 8, ++ BT_STATE_8723A_1ANT_MAX ++}BT_STATE_8723A_1ANT, *PBT_STATE_8723A_1ANT; ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8723A_1ANT 2 ++ ++typedef enum _BT_INFO_SRC_8723A_1ANT{ ++ BT_INFO_SRC_8723A_1ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8723A_1ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8723A_1ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8723A_1ANT_MAX ++}BT_INFO_SRC_8723A_1ANT,*PBT_INFO_SRC_8723A_1ANT; ++ ++typedef enum _BT_8723A_1ANT_BT_STATUS{ ++ BT_8723A_1ANT_BT_STATUS_IDLE = 0x0, ++ BT_8723A_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8723A_1ANT_BT_STATUS_NON_IDLE = 0x2, ++ BT_8723A_1ANT_BT_STATUS_MAX ++}BT_8723A_1ANT_BT_STATUS,*PBT_8723A_1ANT_BT_STATUS; ++ ++typedef enum _BT_8723A_1ANT_COEX_ALGO{ ++ BT_8723A_1ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8723A_1ANT_COEX_ALGO_SCO = 0x1, ++ BT_8723A_1ANT_COEX_ALGO_HID = 0x2, ++ BT_8723A_1ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8723A_1ANT_COEX_ALGO_PANEDR = 0x4, ++ BT_8723A_1ANT_COEX_ALGO_PANHS = 0x5, ++ BT_8723A_1ANT_COEX_ALGO_PANEDR_A2DP = 0x6, ++ BT_8723A_1ANT_COEX_ALGO_PANEDR_HID = 0x7, ++ BT_8723A_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x8, ++ BT_8723A_1ANT_COEX_ALGO_HID_A2DP = 0x9, ++ BT_8723A_1ANT_COEX_ALGO_MAX ++}BT_8723A_1ANT_COEX_ALGO,*PBT_8723A_1ANT_COEX_ALGO; ++ ++typedef struct _COEX_DM_8723A_1ANT{ ++ // fw mechanism ++ BOOLEAN bCurIgnoreWlanAct; ++ BOOLEAN bPreIgnoreWlanAct; ++ u1Byte prePsTdma; ++ u1Byte curPsTdma; ++ u1Byte psTdmaPara[5]; ++ u1Byte psTdmaDuAdjType; ++ u4Byte psTdmaMonitorCnt; ++ u4Byte psTdmaGlobalCnt; ++ BOOLEAN bResetTdmaAdjust; ++ BOOLEAN bPrePsTdmaOn; ++ BOOLEAN bCurPsTdmaOn; ++ ++ // sw mechanism ++ BOOLEAN bPreRfRxLpfShrink; ++ BOOLEAN bCurRfRxLpfShrink; ++ u4Byte btRf0x1eBackup; ++ BOOLEAN bPreLowPenaltyRa; ++ BOOLEAN bCurLowPenaltyRa; ++ u4Byte preVal0x6c0; ++ u4Byte curVal0x6c0; ++ u4Byte preVal0x6c8; ++ u4Byte curVal0x6c8; ++ u1Byte preVal0x6cc; ++ u1Byte curVal0x6cc; ++ BOOLEAN bLimitedDig; ++ ++ // algorithm related ++ u1Byte preAlgorithm; ++ u1Byte curAlgorithm; ++ u1Byte btStatus; ++ u1Byte wifiChnlInfo[3]; ++} COEX_DM_8723A_1ANT, *PCOEX_DM_8723A_1ANT; ++ ++typedef struct _COEX_STA_8723A_1ANT{ ++ u4Byte highPriorityTx; ++ u4Byte highPriorityRx; ++ u4Byte lowPriorityTx; ++ u4Byte lowPriorityRx; ++ u1Byte btRssi; ++ u1Byte preBtRssiState; ++ u1Byte preBtRssiState1; ++ u1Byte preWifiRssiState[4]; ++ BOOLEAN bC2hBtInfoReqSent; ++ u1Byte btInfoC2h[BT_INFO_SRC_8723A_1ANT_MAX][10]; ++ u4Byte btInfoC2hCnt[BT_INFO_SRC_8723A_1ANT_MAX]; ++ BOOLEAN bC2hBtInquiryPage; ++ u1Byte btRetryCnt; ++ u1Byte btInfoExt; ++ //BOOLEAN bHoldForStackOperation; ++ //u1Byte bHoldPeriodCnt; ++ // this is for c2h hang work-around ++ u4Byte c2hHangDetectCnt; ++}COEX_STA_8723A_1ANT, *PCOEX_STA_8723A_1ANT; ++ ++//=========================================== ++// The following is interface which will notify coex module. ++//=========================================== ++VOID ++EXhalbtc8723a1ant_InitHwConfig( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8723a1ant_InitCoexDm( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8723a1ant_IpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8723a1ant_LpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8723a1ant_ScanNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8723a1ant_ConnectNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8723a1ant_MediaStatusNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8723a1ant_SpecialPacketNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8723a1ant_BtInfoNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN pu1Byte tmpBuf, ++ IN u1Byte length ++ ); ++VOID ++EXhalbtc8723a1ant_HaltNotify( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8723a1ant_Periodical( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8723a1ant_DisplayCoexInfo( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.c 2018-02-11 21:44:27.145146055 +0200 +@@ -0,0 +1,3746 @@ ++//============================================================ ++// Description: ++// ++// This file is for RTL8723A Co-exist mechanism ++// ++// History ++// 2012/08/22 Cosa first check in. ++// 2012/11/14 Cosa Revise for 8723A 2Ant out sourcing. ++// ++//============================================================ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "Mp_Precomp.h" ++ ++#if WPP_SOFTWARE_TRACE ++#include "HalBtc8723a2Ant.tmh" ++#endif ++ ++#if(BT_30_SUPPORT == 1) ++//============================================================ ++// Global variables, these are static variables ++//============================================================ ++static COEX_DM_8723A_2ANT GLCoexDm8723a2Ant; ++static PCOEX_DM_8723A_2ANT pCoexDm=&GLCoexDm8723a2Ant; ++static COEX_STA_8723A_2ANT GLCoexSta8723a2Ant; ++static PCOEX_STA_8723A_2ANT pCoexSta=&GLCoexSta8723a2Ant; ++ ++const char *const GLBtInfoSrc8723a2Ant[]={ ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++//============================================================ ++// local function proto type if needed ++//============================================================ ++//============================================================ ++// local function start with halbtc8723a2ant_ ++//============================================================ ++BOOLEAN ++halbtc8723a2ant_IsWifiIdle( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bWifiConnected=FALSE, bScan=FALSE, bLink=FALSE, bRoam=FALSE; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); ++ ++ if(bWifiConnected) ++ return FALSE; ++ if(bScan) ++ return FALSE; ++ if(bLink) ++ return FALSE; ++ if(bRoam) ++ return FALSE; ++ ++ return TRUE; ++} ++ ++BOOLEAN ++halbtc8723a2ant_IsWifiConnectedIdle( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bWifiConnected=FALSE, bScan=FALSE, bLink=FALSE, bRoam=FALSE, bWifiBusy=FALSE; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ ++ if(bScan) ++ return FALSE; ++ if(bLink) ++ return FALSE; ++ if(bRoam) ++ return FALSE; ++ if(bWifiConnected && !bWifiBusy) ++ return TRUE; ++ else ++ return FALSE; ++} ++ ++u1Byte ++halbtc8723a2ant_BtRssiState( ++ u1Byte levelNum, ++ u1Byte rssiThresh, ++ u1Byte rssiThresh1 ++ ) ++{ ++ s4Byte btRssi=0; ++ u1Byte btRssiState=pCoexSta->preBtRssiState; ++ ++ btRssi = pCoexSta->btRssi; ++ ++ if(levelNum == 2) ++ { ++ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || ++ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) ++ { ++ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) ++ { ++ btRssiState = BTC_RSSI_STATE_HIGH; ++ } ++ else ++ { ++ btRssiState = BTC_RSSI_STATE_STAY_LOW; ++ } ++ } ++ else ++ { ++ if(btRssi < rssiThresh) ++ { ++ btRssiState = BTC_RSSI_STATE_LOW; ++ } ++ else ++ { ++ btRssiState = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ } ++ else if(levelNum == 3) ++ { ++ if(rssiThresh > rssiThresh1) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); ++ return pCoexSta->preBtRssiState; ++ } ++ ++ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || ++ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) ++ { ++ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) ++ { ++ btRssiState = BTC_RSSI_STATE_MEDIUM; ++ } ++ else ++ { ++ btRssiState = BTC_RSSI_STATE_STAY_LOW; ++ } ++ } ++ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || ++ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) ++ { ++ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) ++ { ++ btRssiState = BTC_RSSI_STATE_HIGH; ++ } ++ else if(btRssi < rssiThresh) ++ { ++ btRssiState = BTC_RSSI_STATE_LOW; ++ } ++ else ++ { ++ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; ++ } ++ } ++ else ++ { ++ if(btRssi < rssiThresh1) ++ { ++ btRssiState = BTC_RSSI_STATE_MEDIUM; ++ } ++ else ++ { ++ btRssiState = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ } ++ ++ pCoexSta->preBtRssiState = btRssiState; ++ ++ return btRssiState; ++} ++ ++u1Byte ++halbtc8723a2ant_WifiRssiState( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte index, ++ IN u1Byte levelNum, ++ IN u1Byte rssiThresh, ++ IN u1Byte rssiThresh1 ++ ) ++{ ++ s4Byte wifiRssi=0; ++ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); ++ ++ if(levelNum == 2) ++ { ++ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || ++ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) ++ { ++ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) ++ { ++ wifiRssiState = BTC_RSSI_STATE_HIGH; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; ++ } ++ } ++ else ++ { ++ if(wifiRssi < rssiThresh) ++ { ++ wifiRssiState = BTC_RSSI_STATE_LOW; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ } ++ else if(levelNum == 3) ++ { ++ if(rssiThresh > rssiThresh1) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); ++ return pCoexSta->preWifiRssiState[index]; ++ } ++ ++ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || ++ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) ++ { ++ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) ++ { ++ wifiRssiState = BTC_RSSI_STATE_MEDIUM; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; ++ } ++ } ++ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || ++ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) ++ { ++ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) ++ { ++ wifiRssiState = BTC_RSSI_STATE_HIGH; ++ } ++ else if(wifiRssi < rssiThresh) ++ { ++ wifiRssiState = BTC_RSSI_STATE_LOW; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; ++ } ++ } ++ else ++ { ++ if(wifiRssi < rssiThresh1) ++ { ++ wifiRssiState = BTC_RSSI_STATE_MEDIUM; ++ } ++ else ++ { ++ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ } ++ ++ pCoexSta->preWifiRssiState[index] = wifiRssiState; ++ ++ return wifiRssiState; ++} ++ ++VOID ++halbtc8723a2ant_IndicateWifiChnlBwInfo( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ u1Byte H2C_Parameter[3] ={0}; ++ u4Byte wifiBw; ++ u1Byte wifiCentralChnl; ++ ++ // only 2.4G we need to inform bt the chnl mask ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); ++ if( (BTC_MEDIA_CONNECT == type) && ++ (wifiCentralChnl <= 14) ) ++ { ++ H2C_Parameter[0] = 0x1; ++ H2C_Parameter[1] = wifiCentralChnl; ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ H2C_Parameter[2] = 0x30; ++ else ++ H2C_Parameter[2] = 0x20; ++ } ++ ++ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; ++ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; ++ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x19=0x%x\n", ++ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); ++ ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x19, 3, H2C_Parameter); ++} ++ ++VOID ++halbtc8723a2ant_QueryBtInfo( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte H2C_Parameter[1] ={0}; ++ ++ pCoexSta->bC2hBtInfoReqSent = TRUE; ++ ++ H2C_Parameter[0] |= BIT0; // trigger ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x38=0x%x\n", ++ H2C_Parameter[0])); ++ ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x38, 1, H2C_Parameter); ++} ++u1Byte ++halbtc8723a2ant_ActionAlgorithm( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; ++ BOOLEAN bBtHsOn=FALSE, bBtBusy=FALSE, bLimitedDig=FALSE; ++ u1Byte algorithm=BT_8723A_2ANT_COEX_ALGO_UNDEFINED; ++ u1Byte numOfDiffProfile=0; ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ ++ //====================== ++ // here we get BT status first ++ //====================== ++ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_IDLE; ++ ++ if((pStackInfo->bScoExist) ||(bBtHsOn) ||(pStackInfo->bHidExist)) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO or HID or HS exists, set BT non-idle !!!\n")); ++ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; ++ } ++ else ++ { ++ // A2dp profile ++ if( (pBtCoexist->stackInfo.numOfLink == 1) && ++ (pStackInfo->bA2dpExist) ) ++ { ++ if( (pCoexSta->lowPriorityTx+ pCoexSta->lowPriorityRx) < 100) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP, low priority tx+rx < 100, set BT connected-idle!!!\n")); ++ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP, low priority tx+rx >= 100, set BT non-idle!!!\n")); ++ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; ++ } ++ } ++ // Pan profile ++ if( (pBtCoexist->stackInfo.numOfLink == 1) && ++ (pStackInfo->bPanExist) ) ++ { ++ if((pCoexSta->lowPriorityTx+ pCoexSta->lowPriorityRx) < 600) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN, low priority tx+rx < 600, set BT connected-idle!!!\n")); ++ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; ++ } ++ else ++ { ++ if(pCoexSta->lowPriorityTx) ++ { ++ if((pCoexSta->lowPriorityRx /pCoexSta->lowPriorityTx)>9 ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN, low priority rx/tx > 9, set BT connected-idle!!!\n")); ++ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; ++ } ++ } ++ } ++ if(BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN, set BT non-idle!!!\n")); ++ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; ++ } ++ } ++ // Pan+A2dp profile ++ if( (pBtCoexist->stackInfo.numOfLink == 2) && ++ (pStackInfo->bA2dpExist) && ++ (pStackInfo->bPanExist) ) ++ { ++ if((pCoexSta->lowPriorityTx+ pCoexSta->lowPriorityRx) < 600) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN+A2DP, low priority tx+rx < 600, set BT connected-idle!!!\n")); ++ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; ++ } ++ else ++ { ++ if(pCoexSta->lowPriorityTx) ++ { ++ if((pCoexSta->lowPriorityRx /pCoexSta->lowPriorityTx)>9 ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN+A2DP, low priority rx/tx > 9, set BT connected-idle!!!\n")); ++ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; ++ } ++ } ++ } ++ if(BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN+A2DP, set BT non-idle!!!\n")); ++ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; ++ } ++ } ++ } ++ if(BT_8723A_2ANT_BT_STATUS_IDLE != pCoexDm->btStatus) ++ { ++ bBtBusy = TRUE; ++ bLimitedDig = TRUE; ++ } ++ else ++ { ++ bBtBusy = FALSE; ++ bLimitedDig = FALSE; ++ } ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bLimitedDig); ++ //====================== ++ ++ if(!pStackInfo->bBtLinkExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No profile exists!!!\n")); ++ return algorithm; ++ } ++ ++ if(pStackInfo->bScoExist) ++ numOfDiffProfile++; ++ if(pStackInfo->bHidExist) ++ numOfDiffProfile++; ++ if(pStackInfo->bPanExist) ++ numOfDiffProfile++; ++ if(pStackInfo->bA2dpExist) ++ numOfDiffProfile++; ++ ++ if(numOfDiffProfile == 1) ++ { ++ if(pStackInfo->bScoExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO only\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; ++ } ++ else ++ { ++ if(pStackInfo->bHidExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_HID; ++ } ++ else if(pStackInfo->bA2dpExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_A2DP; ++ } ++ else if(pStackInfo->bPanExist) ++ { ++ if(bBtHsOn) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(HS) only\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_PANHS; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(EDR) only\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } ++ else if(numOfDiffProfile == 2) ++ { ++ if(pStackInfo->bScoExist) ++ { ++ if(pStackInfo->bHidExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_HID; ++ } ++ else if(pStackInfo->bA2dpExist) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP ==> SCO\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; ++ } ++ else if(pStackInfo->bPanExist) ++ { ++ if(bBtHsOn) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(HS)\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(EDR)\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ else ++ { ++ if( pStackInfo->bHidExist && ++ pStackInfo->bA2dpExist ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; ++ } ++ else if( pStackInfo->bHidExist && ++ pStackInfo->bPanExist ) ++ { ++ if(bBtHsOn) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(HS)\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(EDR)\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ else if( pStackInfo->bPanExist && ++ pStackInfo->bA2dpExist ) ++ { ++ if(bBtHsOn) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(HS)\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_A2DP; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(EDR)\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } ++ else if(numOfDiffProfile == 3) ++ { ++ if(pStackInfo->bScoExist) ++ { ++ if( pStackInfo->bHidExist && ++ pStackInfo->bA2dpExist ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP ==> HID\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_HID; ++ } ++ else if( pStackInfo->bHidExist && ++ pStackInfo->bPanExist ) ++ { ++ if(bBtHsOn) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(HS)\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(EDR)\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ else if( pStackInfo->bPanExist && ++ pStackInfo->bA2dpExist ) ++ { ++ if(bBtHsOn) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(HS)\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ else ++ { ++ if( pStackInfo->bHidExist && ++ pStackInfo->bPanExist && ++ pStackInfo->bA2dpExist ) ++ { ++ if(bBtHsOn) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(HS)\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(EDR)\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } ++ else if(numOfDiffProfile >= 3) ++ { ++ if(pStackInfo->bScoExist) ++ { ++ if( pStackInfo->bHidExist && ++ pStackInfo->bPanExist && ++ pStackInfo->bA2dpExist ) ++ { ++ if(bBtHsOn) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n")); ++ ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); ++ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++BOOLEAN ++halbtc8723a2ant_NeedToDecBtPwr( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bRet=FALSE; ++ BOOLEAN bBtHsOn=FALSE, bWifiConnected=FALSE; ++ s4Byte btHsRssi=0; ++ u1Byte btRssiState=BTC_RSSI_STATE_HIGH; ++ ++ btRssiState = halbtc8723a2ant_BtRssiState(2, 42, 0); ++ ++ if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn)) ++ return FALSE; ++ if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected)) ++ return FALSE; ++ if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_HS_RSSI, &btHsRssi)) ++ return FALSE; ++ if(BTC_RSSI_LOW(btRssiState)) ++ return FALSE; ++ ++ if(bWifiConnected) ++ { ++ if(bBtHsOn) ++ { ++ if(btHsRssi > 37) ++ { ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Need to decrease bt power for HS mode!!\n")); ++ bRet = TRUE; ++ } ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Need to decrease bt power for Wifi is connected!!\n")); ++ bRet = TRUE; ++ } ++ } ++ ++ return bRet; ++} ++ ++VOID ++halbtc8723a2ant_SetFwDacSwingLevel( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte dacSwingLvl ++ ) ++{ ++ u1Byte H2C_Parameter[1] ={0}; ++ ++ // There are several type of dacswing ++ // 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 ++ H2C_Parameter[0] = dacSwingLvl; ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Set Dac Swing Level=0x%x\n", dacSwingLvl)); ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x29=0x%x\n", H2C_Parameter[0])); ++ ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x29, 1, H2C_Parameter); ++} ++ ++VOID ++halbtc8723a2ant_SetFwDecBtPwr( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bDecBtPwr ++ ) ++{ ++ u1Byte H2C_Parameter[1] ={0}; ++ ++ H2C_Parameter[0] = 0; ++ ++ if(bDecBtPwr) ++ { ++ H2C_Parameter[0] |= BIT1; ++ } ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], decrease Bt Power : %s, FW write 0x21=0x%x\n", ++ (bDecBtPwr? "Yes!!":"No!!"), H2C_Parameter[0])); ++ ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x21, 1, H2C_Parameter); ++} ++ ++VOID ++halbtc8723a2ant_DecBtPwr( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bDecBtPwr ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s Dec BT power = %s\n", ++ (bForceExec? "force to":""), ((bDecBtPwr)? "ON":"OFF"))); ++ pCoexDm->bCurDecBtPwr = bDecBtPwr; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreDecBtPwr == pCoexDm->bCurDecBtPwr) ++ return; ++ } ++ halbtc8723a2ant_SetFwDecBtPwr(pBtCoexist, pCoexDm->bCurDecBtPwr); ++ ++ pCoexDm->bPreDecBtPwr = pCoexDm->bCurDecBtPwr; ++} ++ ++VOID ++halbtc8723a2ant_FwDacSwingLvl( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN u1Byte fwDacSwingLvl ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set FW Dac Swing level = %d\n", ++ (bForceExec? "force to":""), fwDacSwingLvl)); ++ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->preFwDacSwingLvl == pCoexDm->curFwDacSwingLvl) ++ return; ++ } ++ ++ halbtc8723a2ant_SetFwDacSwingLevel(pBtCoexist, pCoexDm->curFwDacSwingLvl); ++ ++ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; ++} ++ ++VOID ++halbtc8723a2ant_SetSwRfRxLpfCorner( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bRxRfShrinkOn ++ ) ++{ ++ if(bRxRfShrinkOn) ++ { ++ //Shrink RF Rx LPF corner ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xf0ff7); ++ } ++ else ++ { ++ //Resume RF Rx LPF corner ++ // After initialized, we can use pCoexDm->btRf0x1eBackup ++ if(pBtCoexist->bInitilized) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); ++ } ++ } ++} ++ ++VOID ++halbtc8723a2ant_RfShrink( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bRxRfShrinkOn ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", ++ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); ++ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) ++ return; ++ } ++ halbtc8723a2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); ++ ++ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; ++} ++ ++VOID ++halbtc8723a2ant_SetSwPenaltyTxRateAdaptive( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bLowPenaltyRa ++ ) ++{ ++ u1Byte tmpU1; ++ ++ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); ++ tmpU1 |= BIT0; ++ if(bLowPenaltyRa) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); ++ tmpU1 &= ~BIT2; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); ++ tmpU1 |= BIT2; ++ } ++ ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); ++} ++ ++VOID ++halbtc8723a2ant_LowPenaltyRa( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bLowPenaltyRa ++ ) ++{ ++ return; ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", ++ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); ++ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) ++ return; ++ } ++ halbtc8723a2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); ++ ++ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; ++} ++ ++VOID ++halbtc8723a2ant_SetSwFullTimeDacSwing( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bSwDacSwingOn, ++ IN u4Byte swDacSwingLvl ++ ) ++{ ++ if(bSwDacSwingOn) ++ { ++ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, swDacSwingLvl); ++ } ++ else ++ { ++ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0xc0); ++ } ++} ++ ++ ++VOID ++halbtc8723a2ant_DacSwing( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bDacSwingOn, ++ IN u4Byte dacSwingLvl ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", ++ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); ++ pCoexDm->bCurDacSwingOn = bDacSwingOn; ++ pCoexDm->curDacSwingLvl = dacSwingLvl; ++ ++ if(!bForceExec) ++ { ++ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && ++ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) ++ return; ++ } ++ delay_ms(30); ++ halbtc8723a2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); ++ ++ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; ++ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; ++} ++ ++VOID ++halbtc8723a2ant_SetAdcBackOff( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bAdcBackOff ++ ) ++{ ++ if(bAdcBackOff) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a07611); ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a05611); ++ } ++} ++ ++VOID ++halbtc8723a2ant_AdcBackOff( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bAdcBackOff ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", ++ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); ++ pCoexDm->bCurAdcBackOff = bAdcBackOff; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) ++ return; ++ } ++ halbtc8723a2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); ++ ++ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; ++} ++ ++VOID ++halbtc8723a2ant_SetAgcTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bAgcTableEn ++ ) ++{ ++ u1Byte rssiAdjustVal=0; ++ ++ if(bAgcTableEn) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4e1c0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4d1d0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4c1e0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4b1f0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4a200001); ++ ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xdc000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x90000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x51000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x12000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x00355); ++ ++ rssiAdjustVal = 6; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x641c0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x631d0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x621e0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x611f0001); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x60200001); ++ ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x32000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x71000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xb0000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xfc000); ++ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x30355); ++ } ++ ++ // set rssiAdjustVal for wifi module. ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); ++} ++ ++ ++VOID ++halbtc8723a2ant_AgcTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bAgcTableEn ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", ++ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); ++ pCoexDm->bCurAgcTableEn = bAgcTableEn; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) ++ return; ++ } ++ halbtc8723a2ant_SetAgcTable(pBtCoexist, bAgcTableEn); ++ ++ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; ++} ++ ++VOID ++halbtc8723a2ant_SetCoexTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u4Byte val0x6c0, ++ IN u4Byte val0x6c8, ++ IN u1Byte val0x6cc ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); ++ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); ++} ++ ++VOID ++halbtc8723a2ant_CoexTable( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN u4Byte val0x6c0, ++ IN u4Byte val0x6c8, ++ IN u1Byte val0x6cc ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", ++ (bForceExec? "force to":""), val0x6c0, val0x6c8, val0x6cc)); ++ pCoexDm->curVal0x6c0 = val0x6c0; ++ pCoexDm->curVal0x6c8 = val0x6c8; ++ pCoexDm->curVal0x6cc = val0x6cc; ++ ++ if(!bForceExec) ++ { ++ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && ++ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && ++ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) ++ return; ++ } ++ halbtc8723a2ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c8, val0x6cc); ++ ++ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; ++ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; ++ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; ++} ++ ++VOID ++halbtc8723a2ant_SetFwIgnoreWlanAct( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bEnable ++ ) ++{ ++ u1Byte H2C_Parameter[1] ={0}; ++ ++ if(bEnable) ++ { ++ H2C_Parameter[0] |= BIT0; // function enable ++ } ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x25=0x%x\n", ++ H2C_Parameter[0])); ++ ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x25, 1, H2C_Parameter); ++} ++ ++VOID ++halbtc8723a2ant_IgnoreWlanAct( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bEnable ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", ++ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); ++ pCoexDm->bCurIgnoreWlanAct = bEnable; ++ ++ if(!bForceExec) ++ { ++ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) ++ return; ++ } ++ halbtc8723a2ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); ++ ++ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; ++} ++ ++VOID ++halbtc8723a2ant_SetFwPstdma( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte byte1, ++ IN u1Byte byte2, ++ IN u1Byte byte3, ++ IN u1Byte byte4, ++ IN u1Byte byte5 ++ ) ++{ ++ u1Byte H2C_Parameter[5] ={0}; ++ ++ H2C_Parameter[0] = byte1; ++ H2C_Parameter[1] = byte2; ++ H2C_Parameter[2] = byte3; ++ H2C_Parameter[3] = byte4; ++ H2C_Parameter[4] = byte5; ++ ++ pCoexDm->psTdmaPara[0] = byte1; ++ pCoexDm->psTdmaPara[1] = byte2; ++ pCoexDm->psTdmaPara[2] = byte3; ++ pCoexDm->psTdmaPara[3] = byte4; ++ pCoexDm->psTdmaPara[4] = byte5; ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x3a(5bytes)=0x%x%08x\n", ++ H2C_Parameter[0], ++ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); ++ ++ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x3a, 5, H2C_Parameter); ++} ++ ++VOID ++halbtc8723a2ant_PsTdma( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bForceExec, ++ IN BOOLEAN bTurnOn, ++ IN u1Byte type ++ ) ++{ ++ u4Byte btTxRxCnt=0; ++ ++ btTxRxCnt = pCoexSta->highPriorityTx+pCoexSta->highPriorityRx+ ++ pCoexSta->lowPriorityTx+pCoexSta->lowPriorityRx; ++ ++ if(btTxRxCnt > 3000) ++ { ++ pCoexDm->bCurPsTdmaOn = TRUE; ++ pCoexDm->curPsTdma = 8; ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], turn ON PS TDMA, type=%d for BT tx/rx counters=%d(>3000)\n", ++ pCoexDm->curPsTdma, btTxRxCnt)); ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", ++ (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); ++ pCoexDm->bCurPsTdmaOn = bTurnOn; ++ pCoexDm->curPsTdma = type; ++ } ++ ++ if(!bForceExec) ++ { ++ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && ++ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) ++ return; ++ } ++ if(pCoexDm->bCurPsTdmaOn) ++ { ++ switch(pCoexDm->curPsTdma) ++ { ++ case 1: ++ default: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x98); ++ break; ++ case 2: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x98); ++ break; ++ case 3: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0xe1, 0x98); ++ break; ++ case 4: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x5, 0x5, 0xe1, 0x80); ++ break; ++ case 5: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x98); ++ break; ++ case 6: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x98); ++ break; ++ case 7: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0x60, 0x98); ++ break; ++ case 8: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x5, 0x5, 0x60, 0x80); ++ break; ++ case 9: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x98); ++ break; ++ case 10: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x98); ++ break; ++ case 11: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0xe1, 0x98); ++ break; ++ case 12: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x98); ++ break; ++ case 13: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x98); ++ break; ++ case 14: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x98); ++ break; ++ case 15: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0x60, 0x98); ++ break; ++ case 16: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0x60, 0x98); ++ break; ++ case 17: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x2f, 0x2f, 0x60, 0x80); ++ break; ++ case 18: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x98); ++ break; ++ case 19: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0xe1, 0x98); ++ break; ++ case 20: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0x60, 0x98); ++ break; ++ } ++ } ++ else ++ { ++ // disable PS tdma ++ switch(pCoexDm->curPsTdma) ++ { ++ case 0: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x8, 0x0); ++ break; ++ case 1: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); ++ break; ++ default: ++ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x8, 0x0); ++ break; ++ } ++ } ++ ++ // update pre state ++ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; ++ pCoexDm->prePsTdma = pCoexDm->curPsTdma; ++} ++ ++ ++VOID ++halbtc8723a2ant_CoexAllOff( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ // fw all off ++ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ ++ // sw all off ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ ++ // hw all off ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++} ++ ++VOID ++halbtc8723a2ant_InitCoexDm( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ // force to reset coex mechanism ++ halbtc8723a2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0x55555555, 0xffff, 0x3); ++ halbtc8723a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); ++ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 0x20); ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, FORCE_EXEC, FALSE); ++ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); ++ ++ halbtc8723a2ant_AgcTable(pBtCoexist, FORCE_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, FORCE_EXEC, FALSE); ++ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, FORCE_EXEC, FALSE); ++ halbtc8723a2ant_RfShrink(pBtCoexist, FORCE_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, FORCE_EXEC, FALSE, 0xc0); ++} ++ ++VOID ++halbtc8723a2ant_BtInquiryPage( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bLowPwrDisable=TRUE; ++ ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); ++ ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); ++} ++ ++VOID ++halbtc8723a2ant_BtEnableAction( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ BOOLEAN bWifiConnected=FALSE; ++ ++ // Here we need to resend some wifi info to BT ++ // because bt is reset and loss of the info. ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); ++ if(bWifiConnected) ++ { ++ halbtc8723a2ant_IndicateWifiChnlBwInfo(pBtCoexist, BTC_MEDIA_CONNECT); ++ } ++ else ++ { ++ halbtc8723a2ant_IndicateWifiChnlBwInfo(pBtCoexist, BTC_MEDIA_DISCONNECT); ++ } ++ ++ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); ++} ++ ++VOID ++halbtc8723a2ant_MonitorBtCtr( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u4Byte regHPTxRx, regLPTxRx, u4Tmp; ++ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; ++ u1Byte u1Tmp; ++ ++ regHPTxRx = 0x770; ++ regLPTxRx = 0x774; ++ ++ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); ++ regHPTx = u4Tmp & bMaskLWord; ++ regHPRx = (u4Tmp & bMaskHWord)>>16; ++ ++ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); ++ regLPTx = u4Tmp & bMaskLWord; ++ regLPRx = (u4Tmp & bMaskHWord)>>16; ++ ++ pCoexSta->highPriorityTx = regHPTx; ++ pCoexSta->highPriorityRx = regHPRx; ++ pCoexSta->lowPriorityTx = regLPTx; ++ pCoexSta->lowPriorityRx = regLPRx; ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); ++ ++ // reset counter ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); ++} ++ ++VOID ++halbtc8723a2ant_MonitorBtEnableDisable( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ static BOOLEAN bPreBtDisabled=FALSE; ++ static u4Byte btDisableCnt=0; ++ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; ++ ++ // This function check if bt is disabled ++ ++ if( pCoexSta->highPriorityTx == 0 && ++ pCoexSta->highPriorityRx == 0 && ++ pCoexSta->lowPriorityTx == 0 && ++ pCoexSta->lowPriorityRx == 0) ++ { ++ bBtActive = FALSE; ++ } ++ if( pCoexSta->highPriorityTx == 0xffff && ++ pCoexSta->highPriorityRx == 0xffff && ++ pCoexSta->lowPriorityTx == 0xffff && ++ pCoexSta->lowPriorityRx == 0xffff) ++ { ++ bBtActive = FALSE; ++ } ++ if(bBtActive) ++ { ++ btDisableCnt = 0; ++ bBtDisabled = FALSE; ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); ++ } ++ else ++ { ++ btDisableCnt++; ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", ++ btDisableCnt)); ++ if(btDisableCnt >= 2) ++ { ++ bBtDisabled = TRUE; ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); ++ } ++ } ++ if(bPreBtDisabled != bBtDisabled) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", ++ (bPreBtDisabled ? "disabled":"enabled"), ++ (bBtDisabled ? "disabled":"enabled"))); ++ bPreBtDisabled = bBtDisabled; ++ if(!bBtDisabled) ++ { ++ halbtc8723a2ant_BtEnableAction(pBtCoexist); ++ } ++ } ++} ++ ++BOOLEAN ++halbtc8723a2ant_IsCommonAction( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; ++ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE; ++ BOOLEAN bLowPwrDisable=FALSE; ++ ++ if(!pStackInfo->bBtLinkExist) ++ { ++ bLowPwrDisable = FALSE; ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); ++ } ++ else ++ { ++ bLowPwrDisable = TRUE; ++ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); ++ } ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); ++ ++ if(halbtc8723a2ant_IsWifiIdle(pBtCoexist) && ++ BT_8723A_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle + Bt idle!!\n")); ++ ++ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ ++ bCommon = TRUE; ++ } ++ else if(!halbtc8723a2ant_IsWifiIdle(pBtCoexist) && ++ (BT_8723A_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus) ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-idle + BT idle!!\n")); ++ ++ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); ++ ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ ++ bCommon = TRUE; ++ } ++ else if(halbtc8723a2ant_IsWifiIdle(pBtCoexist) && ++ (BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle + Bt connected idle!!\n")); ++ ++ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ ++ bCommon = TRUE; ++ } ++ else if(!halbtc8723a2ant_IsWifiIdle(pBtCoexist) && ++ (BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-idle + Bt connected idle!!\n")); ++ ++ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ ++ bCommon = TRUE; ++ } ++ else if(halbtc8723a2ant_IsWifiIdle(pBtCoexist) && ++ (BT_8723A_2ANT_BT_STATUS_NON_IDLE == pCoexDm->btStatus) ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle + BT non-idle!!\n")); ++ ++ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ ++ bCommon = TRUE; ++ } ++ else if(halbtc8723a2ant_IsWifiConnectedIdle(pBtCoexist) && ++ (BT_8723A_2ANT_BT_STATUS_NON_IDLE == pCoexDm->btStatus) ) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected-idle + BT non-idle!!\n")); ++ ++ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ ++ bCommon = TRUE; ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-idle + BT non-idle!!\n")); ++ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); ++ ++ bCommon = FALSE; ++ } ++ ++ return bCommon; ++} ++VOID ++halbtc8723a2ant_TdmaDurationAdjust( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bScoHid, ++ IN BOOLEAN bTxPause, ++ IN u1Byte maxInterval ++ ) ++{ ++ static s4Byte up,dn,m,n,WaitCount; ++ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration ++ u1Byte retryCount=0; ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjust()\n")); ++ ++ if(pCoexDm->bResetTdmaAdjust) ++ { ++ pCoexDm->bResetTdmaAdjust = FALSE; ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); ++ { ++ if(bScoHid) ++ { ++ if(bTxPause) ++ { ++ if(maxInterval == 1) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); ++ pCoexDm->psTdmaDuAdjType = 13; ++ } ++ else if(maxInterval == 2) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); ++ pCoexDm->psTdmaDuAdjType = 14; ++ } ++ else if(maxInterval == 3) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ } ++ else ++ { ++ if(maxInterval == 1) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); ++ pCoexDm->psTdmaDuAdjType = 9; ++ } ++ else if(maxInterval == 2) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ pCoexDm->psTdmaDuAdjType = 10; ++ } ++ else if(maxInterval == 3) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ } ++ } ++ else ++ { ++ if(bTxPause) ++ { ++ if(maxInterval == 1) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); ++ pCoexDm->psTdmaDuAdjType = 5; ++ } ++ else if(maxInterval == 2) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ pCoexDm->psTdmaDuAdjType = 6; ++ } ++ else if(maxInterval == 3) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ } ++ else ++ { ++ if(maxInterval == 1) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); ++ pCoexDm->psTdmaDuAdjType = 1; ++ } ++ else if(maxInterval == 2) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ pCoexDm->psTdmaDuAdjType = 2; ++ } ++ else if(maxInterval == 3) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ } ++ } ++ } ++ //============ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n= 3; ++ result = 0; ++ WaitCount = 0; ++ } ++ else ++ { ++ //accquire the BT TRx retry count from BT_Info byte2 ++ retryCount = pCoexSta->btRetryCnt; ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], retryCount = %d\n", retryCount)); ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], up=%d, dn=%d, m=%d, n=%d, WaitCount=%d\n", ++ up, dn, m, n, WaitCount)); ++ result = 0; ++ WaitCount++; ++ ++ if(retryCount == 0) // no retry in the last 2-second duration ++ { ++ up++; ++ dn--; ++ ++ if (dn <= 0) ++ dn = 0; ++ ++ if(up >= n) // if s n 2 retry count0, hռeWiFi duration ++ { ++ WaitCount = 0; ++ n = 3; ++ up = 0; ++ dn = 0; ++ result = 1; ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); ++ } ++ } ++ else if (retryCount <= 3) // <=3 retry in the last 2-second duration ++ { ++ up--; ++ dn++; ++ ++ if (up <= 0) ++ up = 0; ++ ++ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration ++ { ++ if (WaitCount <= 2) ++ m++; // קK@blevelӦ^ ++ else ++ m = 1; ++ ++ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. ++ m = 20; ++ ++ n = 3*m; ++ up = 0; ++ dn = 0; ++ WaitCount = 0; ++ result = -1; ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); ++ } ++ } ++ else //retry count > 3, un1 retry count > 3, hկWiFi duration ++ { ++ if (WaitCount == 1) ++ m++; // קK@blevelӦ^ ++ else ++ m = 1; ++ ++ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. ++ m = 20; ++ ++ n = 3*m; ++ up = 0; ++ dn = 0; ++ WaitCount = 0; ++ result = -1; ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); ++ } ++ ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], max Interval = %d\n", maxInterval)); ++ if(maxInterval == 1) ++ { ++ if(bTxPause) ++ { ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); ++ ++ if(pCoexDm->curPsTdma == 1) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); ++ pCoexDm->psTdmaDuAdjType = 5; ++ } ++ else if(pCoexDm->curPsTdma == 2) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ pCoexDm->psTdmaDuAdjType = 6; ++ } ++ else if(pCoexDm->curPsTdma == 3) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 4) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); ++ pCoexDm->psTdmaDuAdjType = 8; ++ } ++ if(pCoexDm->curPsTdma == 9) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); ++ pCoexDm->psTdmaDuAdjType = 13; ++ } ++ else if(pCoexDm->curPsTdma == 10) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); ++ pCoexDm->psTdmaDuAdjType = 14; ++ } ++ else if(pCoexDm->curPsTdma == 11) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else if(pCoexDm->curPsTdma == 12) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); ++ pCoexDm->psTdmaDuAdjType = 16; ++ } ++ ++ if(result == -1) ++ { ++ if(pCoexDm->curPsTdma == 5) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ pCoexDm->psTdmaDuAdjType = 6; ++ } ++ else if(pCoexDm->curPsTdma == 6) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 7) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); ++ pCoexDm->psTdmaDuAdjType = 8; ++ } ++ else if(pCoexDm->curPsTdma == 13) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); ++ pCoexDm->psTdmaDuAdjType = 14; ++ } ++ else if(pCoexDm->curPsTdma == 14) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else if(pCoexDm->curPsTdma == 15) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); ++ pCoexDm->psTdmaDuAdjType = 16; ++ } ++ } ++ else if (result == 1) ++ { ++ if(pCoexDm->curPsTdma == 8) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 7) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ pCoexDm->psTdmaDuAdjType = 6; ++ } ++ else if(pCoexDm->curPsTdma == 6) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); ++ pCoexDm->psTdmaDuAdjType = 5; ++ } ++ else if(pCoexDm->curPsTdma == 16) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else if(pCoexDm->curPsTdma == 15) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); ++ pCoexDm->psTdmaDuAdjType = 14; ++ } ++ else if(pCoexDm->curPsTdma == 14) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); ++ pCoexDm->psTdmaDuAdjType = 13; ++ } ++ } ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); ++ if(pCoexDm->curPsTdma == 5) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); ++ pCoexDm->psTdmaDuAdjType = 1; ++ } ++ else if(pCoexDm->curPsTdma == 6) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ pCoexDm->psTdmaDuAdjType = 2; ++ } ++ else if(pCoexDm->curPsTdma == 7) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 8) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); ++ pCoexDm->psTdmaDuAdjType = 4; ++ } ++ if(pCoexDm->curPsTdma == 13) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); ++ pCoexDm->psTdmaDuAdjType = 9; ++ } ++ else if(pCoexDm->curPsTdma == 14) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ pCoexDm->psTdmaDuAdjType = 10; ++ } ++ else if(pCoexDm->curPsTdma == 15) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else if(pCoexDm->curPsTdma == 16) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); ++ pCoexDm->psTdmaDuAdjType = 12; ++ } ++ ++ if(result == -1) ++ { ++ if(pCoexDm->curPsTdma == 1) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ pCoexDm->psTdmaDuAdjType = 2; ++ } ++ else if(pCoexDm->curPsTdma == 2) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 3) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); ++ pCoexDm->psTdmaDuAdjType = 4; ++ } ++ else if(pCoexDm->curPsTdma == 9) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ pCoexDm->psTdmaDuAdjType = 10; ++ } ++ else if(pCoexDm->curPsTdma == 10) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else if(pCoexDm->curPsTdma == 11) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); ++ pCoexDm->psTdmaDuAdjType = 12; ++ } ++ } ++ else if (result == 1) ++ { ++ if(pCoexDm->curPsTdma == 4) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 3) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ pCoexDm->psTdmaDuAdjType = 2; ++ } ++ else if(pCoexDm->curPsTdma == 2) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); ++ pCoexDm->psTdmaDuAdjType = 1; ++ } ++ else if(pCoexDm->curPsTdma == 12) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else if(pCoexDm->curPsTdma == 11) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ pCoexDm->psTdmaDuAdjType = 10; ++ } ++ else if(pCoexDm->curPsTdma == 10) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); ++ pCoexDm->psTdmaDuAdjType = 9; ++ } ++ } ++ } ++ } ++ else if(maxInterval == 2) ++ { ++ if(bTxPause) ++ { ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); ++ if(pCoexDm->curPsTdma == 1) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ pCoexDm->psTdmaDuAdjType = 6; ++ } ++ else if(pCoexDm->curPsTdma == 2) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ pCoexDm->psTdmaDuAdjType = 6; ++ } ++ else if(pCoexDm->curPsTdma == 3) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 4) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); ++ pCoexDm->psTdmaDuAdjType = 8; ++ } ++ if(pCoexDm->curPsTdma == 9) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); ++ pCoexDm->psTdmaDuAdjType = 14; ++ } ++ else if(pCoexDm->curPsTdma == 10) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); ++ pCoexDm->psTdmaDuAdjType = 14; ++ } ++ else if(pCoexDm->curPsTdma == 11) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else if(pCoexDm->curPsTdma == 12) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); ++ pCoexDm->psTdmaDuAdjType = 16; ++ } ++ if(result == -1) ++ { ++ if(pCoexDm->curPsTdma == 5) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ pCoexDm->psTdmaDuAdjType = 6; ++ } ++ else if(pCoexDm->curPsTdma == 6) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 7) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); ++ pCoexDm->psTdmaDuAdjType = 8; ++ } ++ else if(pCoexDm->curPsTdma == 13) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); ++ pCoexDm->psTdmaDuAdjType = 14; ++ } ++ else if(pCoexDm->curPsTdma == 14) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else if(pCoexDm->curPsTdma == 15) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); ++ pCoexDm->psTdmaDuAdjType = 16; ++ } ++ } ++ else if (result == 1) ++ { ++ if(pCoexDm->curPsTdma == 8) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 7) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ pCoexDm->psTdmaDuAdjType = 6; ++ } ++ else if(pCoexDm->curPsTdma == 6) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ pCoexDm->psTdmaDuAdjType = 6; ++ } ++ else if(pCoexDm->curPsTdma == 16) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else if(pCoexDm->curPsTdma == 15) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); ++ pCoexDm->psTdmaDuAdjType = 14; ++ } ++ else if(pCoexDm->curPsTdma == 14) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); ++ pCoexDm->psTdmaDuAdjType = 14; ++ } ++ } ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); ++ if(pCoexDm->curPsTdma == 5) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ pCoexDm->psTdmaDuAdjType = 2; ++ } ++ else if(pCoexDm->curPsTdma == 6) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ pCoexDm->psTdmaDuAdjType = 2; ++ } ++ else if(pCoexDm->curPsTdma == 7) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 8) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); ++ pCoexDm->psTdmaDuAdjType = 4; ++ } ++ if(pCoexDm->curPsTdma == 13) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ pCoexDm->psTdmaDuAdjType = 10; ++ } ++ else if(pCoexDm->curPsTdma == 14) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ pCoexDm->psTdmaDuAdjType = 10; ++ } ++ else if(pCoexDm->curPsTdma == 15) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else if(pCoexDm->curPsTdma == 16) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); ++ pCoexDm->psTdmaDuAdjType = 12; ++ } ++ if(result == -1) ++ { ++ if(pCoexDm->curPsTdma == 1) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ pCoexDm->psTdmaDuAdjType = 2; ++ } ++ else if(pCoexDm->curPsTdma == 2) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 3) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); ++ pCoexDm->psTdmaDuAdjType = 4; ++ } ++ else if(pCoexDm->curPsTdma == 9) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ pCoexDm->psTdmaDuAdjType = 10; ++ } ++ else if(pCoexDm->curPsTdma == 10) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else if(pCoexDm->curPsTdma == 11) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); ++ pCoexDm->psTdmaDuAdjType = 12; ++ } ++ } ++ else if (result == 1) ++ { ++ if(pCoexDm->curPsTdma == 4) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 3) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ pCoexDm->psTdmaDuAdjType = 2; ++ } ++ else if(pCoexDm->curPsTdma == 2) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ pCoexDm->psTdmaDuAdjType = 2; ++ } ++ else if(pCoexDm->curPsTdma == 12) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else if(pCoexDm->curPsTdma == 11) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ pCoexDm->psTdmaDuAdjType = 10; ++ } ++ else if(pCoexDm->curPsTdma == 10) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ pCoexDm->psTdmaDuAdjType = 10; ++ } ++ } ++ } ++ } ++ else if(maxInterval == 3) ++ { ++ if(bTxPause) ++ { ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); ++ if(pCoexDm->curPsTdma == 1) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 2) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 3) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 4) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); ++ pCoexDm->psTdmaDuAdjType = 8; ++ } ++ if(pCoexDm->curPsTdma == 9) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else if(pCoexDm->curPsTdma == 10) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else if(pCoexDm->curPsTdma == 11) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else if(pCoexDm->curPsTdma == 12) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); ++ pCoexDm->psTdmaDuAdjType = 16; ++ } ++ if(result == -1) ++ { ++ if(pCoexDm->curPsTdma == 5) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 6) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 7) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); ++ pCoexDm->psTdmaDuAdjType = 8; ++ } ++ else if(pCoexDm->curPsTdma == 13) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else if(pCoexDm->curPsTdma == 14) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else if(pCoexDm->curPsTdma == 15) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); ++ pCoexDm->psTdmaDuAdjType = 16; ++ } ++ } ++ else if (result == 1) ++ { ++ if(pCoexDm->curPsTdma == 8) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 7) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 6) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); ++ pCoexDm->psTdmaDuAdjType = 7; ++ } ++ else if(pCoexDm->curPsTdma == 16) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else if(pCoexDm->curPsTdma == 15) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ else if(pCoexDm->curPsTdma == 14) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ pCoexDm->psTdmaDuAdjType = 15; ++ } ++ } ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); ++ if(pCoexDm->curPsTdma == 5) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 6) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 7) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 8) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); ++ pCoexDm->psTdmaDuAdjType = 4; ++ } ++ if(pCoexDm->curPsTdma == 13) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else if(pCoexDm->curPsTdma == 14) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else if(pCoexDm->curPsTdma == 15) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else if(pCoexDm->curPsTdma == 16) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); ++ pCoexDm->psTdmaDuAdjType = 12; ++ } ++ if(result == -1) ++ { ++ if(pCoexDm->curPsTdma == 1) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 2) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 3) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); ++ pCoexDm->psTdmaDuAdjType = 4; ++ } ++ else if(pCoexDm->curPsTdma == 9) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else if(pCoexDm->curPsTdma == 10) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else if(pCoexDm->curPsTdma == 11) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); ++ pCoexDm->psTdmaDuAdjType = 12; ++ } ++ } ++ else if (result == 1) ++ { ++ if(pCoexDm->curPsTdma == 4) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 3) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 2) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); ++ pCoexDm->psTdmaDuAdjType = 3; ++ } ++ else if(pCoexDm->curPsTdma == 12) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else if(pCoexDm->curPsTdma == 11) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ else if(pCoexDm->curPsTdma == 10) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ pCoexDm->psTdmaDuAdjType = 11; ++ } ++ } ++ } ++ } ++ } ++ ++ // if current PsTdma not match with the recorded one (when scan, dhcp...), ++ // then we have to adjust it back to the previous record one. ++ if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) ++ { ++ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", ++ pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); ++ ++ if( !bScan && !bLink && !bRoam) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); ++ } ++ } ++} ++ ++// SCO only or SCO+PAN(HS) ++VOID ++halbtc8723a2ant_ActionSco( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState, wifiRssiState1; ++ u4Byte wifiBw; ++ ++ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); ++ else ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ } ++ else ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ } ++ ++ // sw mechanism ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); ++ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); ++ } ++ else ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); ++ } ++ ++ // sw mechanism ++ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ } ++} ++ ++ ++VOID ++halbtc8723a2ant_ActionHid( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState, wifiRssiState1; ++ u4Byte wifiBw; ++ ++ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); ++ else ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); ++ } ++ else ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); ++ } ++ ++ // sw mechanism ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); ++ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); ++ } ++ else ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); ++ } ++ ++ // sw mechanism ++ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ } ++} ++ ++//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) ++VOID ++halbtc8723a2ant_ActionA2dp( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; ++ u4Byte wifiBw; ++ ++ btInfoExt = pCoexSta->btInfoExt; ++ ++ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); ++ else ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); ++ } ++ else ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); ++ } ++ } ++ else ++ { ++ if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); ++ } ++ else ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); ++ } ++ } ++ ++ // sw mechanism ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); ++ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); ++ } ++ else ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); ++ } ++ } ++ else ++ { ++ if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); ++ } ++ else ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); ++ } ++ } ++ ++ // sw mechanism ++ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ } ++} ++ ++VOID ++halbtc8723a2ant_ActionPanEdr( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; ++ u4Byte wifiBw; ++ ++ btInfoExt = pCoexSta->btInfoExt; ++ ++ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); ++ else ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ } ++ else ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ } ++ ++ // sw mechanism ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); ++ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ } ++ else ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ } ++ ++ // sw mechanism ++ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ } ++} ++ ++ ++//PAN(HS) only ++VOID ++halbtc8723a2ant_ActionPanHs( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState; ++ u4Byte wifiBw; ++ ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); ++ } ++ else ++ { ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ } ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ ++ // sw mechanism ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ } ++ else ++ { ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); ++ } ++ ++ // sw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ } ++} ++ ++//PAN(EDR)+A2DP ++VOID ++halbtc8723a2ant_ActionPanEdrA2dp( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; ++ u4Byte wifiBw; ++ ++ btInfoExt = pCoexSta->btInfoExt; ++ ++ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); ++ else ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ if(btInfoExt&BIT0) //a2dp basic rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); ++ } ++ else //a2dp edr rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ } ++ } ++ else ++ { ++ if(btInfoExt&BIT0) //a2dp basic rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); ++ } ++ else //a2dp edr rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ } ++ } ++ ++ // sw mechanism ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); ++ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ if(btInfoExt&BIT0) //a2dp basic rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); ++ } ++ else //a2dp edr rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); ++ } ++ } ++ else ++ { ++ if(btInfoExt&BIT0) //a2dp basic rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); ++ } ++ else //a2dp edr rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); ++ } ++ } ++ ++ // sw mechanism ++ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ } ++} ++ ++VOID ++halbtc8723a2ant_ActionPanEdrHid( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState, wifiRssiState1; ++ u4Byte wifiBw; ++ ++ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); ++ else ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ } ++ else ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); ++ } ++ ++ // sw mechanism ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); ++ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ } ++ else ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); ++ } ++ ++ // sw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ } ++} ++ ++// HID+A2DP+PAN(EDR) ++VOID ++halbtc8723a2ant_ActionHidA2dpPanEdr( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; ++ u4Byte wifiBw; ++ ++ btInfoExt = pCoexSta->btInfoExt; ++ ++ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); ++ else ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ if(btInfoExt&BIT0) //a2dp basic rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); ++ } ++ else //a2dp edr rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ } ++ } ++ else ++ { ++ if(btInfoExt&BIT0) //a2dp basic rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); ++ } ++ else //a2dp edr rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); ++ } ++ } ++ ++ // sw mechanism ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); ++ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ if(btInfoExt&BIT0) //a2dp basic rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); ++ } ++ else //a2dp edr rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); ++ } ++ } ++ else ++ { ++ if(btInfoExt&BIT0) //a2dp basic rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); ++ } ++ else //a2dp edr rate ++ { ++ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); ++ } ++ } ++ ++ // sw mechanism ++ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ } ++} ++ ++VOID ++halbtc8723a2ant_ActionHidA2dp( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; ++ u4Byte wifiBw; ++ ++ btInfoExt = pCoexSta->btInfoExt; ++ ++ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); ++ else ++ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ if(BTC_WIFI_BW_HT40 == wifiBw) ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ if(btInfoExt&BIT0) //a2dp basic rate ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); ++ } ++ else //a2dp edr rate ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 1); ++ } ++ } ++ else ++ { ++ if(btInfoExt&BIT0) //a2dp basic rate ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); ++ } ++ else //a2dp edr rate ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 1); ++ } ++ } ++ ++ // sw mechanism ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); ++ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); ++ ++ // fw mechanism ++ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ if(btInfoExt&BIT0) //a2dp basic rate ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); ++ } ++ else //a2dp edr rate ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 1); ++ } ++ } ++ else ++ { ++ if(btInfoExt&BIT0) //a2dp basic rate ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); ++ } ++ else //a2dp edr rate ++ { ++ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 1); ++ } ++ } ++ ++ // sw mechanism ++ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || ++ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ else ++ { ++ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); ++ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); ++ } ++ } ++} ++ ++VOID ++halbtc8723a2ant_RunCoexistMechanism( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; ++ u1Byte btInfoOriginal=0, btRetryCnt=0; ++ u1Byte algorithm=0; ++ ++ if(pBtCoexist->bManualControl) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Manual control!!!\n")); ++ return; ++ } ++ ++ if(pStackInfo->bProfileNotified) ++ { ++ if(pCoexSta->bHoldForStackOperation) ++ { ++ // if bt inquiry/page/pair, do not execute. ++ return; ++ } ++ ++ algorithm = halbtc8723a2ant_ActionAlgorithm(pBtCoexist); ++ if(pCoexSta->bHoldPeriodCnt && (BT_8723A_2ANT_COEX_ALGO_PANHS!=algorithm)) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex],Hold BT inquiry/page scan setting (cnt = %d)!!\n", ++ pCoexSta->bHoldPeriodCnt)); ++ if(pCoexSta->bHoldPeriodCnt >= 6) ++ { ++ pCoexSta->bHoldPeriodCnt = 0; ++ // next time the coexist parameters should be reset again. ++ } ++ else ++ pCoexSta->bHoldPeriodCnt++; ++ return; ++ } ++ ++ pCoexDm->curAlgorithm = algorithm; ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Algorithm = %d \n", pCoexDm->curAlgorithm)); ++ if(halbtc8723a2ant_IsCommonAction(pBtCoexist)) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant common.\n")); ++ pCoexDm->bResetTdmaAdjust = TRUE; ++ } ++ else ++ { ++ if(pCoexDm->curAlgorithm != pCoexDm->preAlgorithm) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], preAlgorithm=%d, curAlgorithm=%d\n", ++ pCoexDm->preAlgorithm, pCoexDm->curAlgorithm)); ++ pCoexDm->bResetTdmaAdjust = TRUE; ++ } ++ switch(pCoexDm->curAlgorithm) ++ { ++ case BT_8723A_2ANT_COEX_ALGO_SCO: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO.\n")); ++ halbtc8723a2ant_ActionSco(pBtCoexist); ++ break; ++ case BT_8723A_2ANT_COEX_ALGO_HID: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID.\n")); ++ halbtc8723a2ant_ActionHid(pBtCoexist); ++ break; ++ case BT_8723A_2ANT_COEX_ALGO_A2DP: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP.\n")); ++ halbtc8723a2ant_ActionA2dp(pBtCoexist); ++ break; ++ case BT_8723A_2ANT_COEX_ALGO_PANEDR: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n")); ++ halbtc8723a2ant_ActionPanEdr(pBtCoexist); ++ break; ++ case BT_8723A_2ANT_COEX_ALGO_PANHS: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HS mode.\n")); ++ halbtc8723a2ant_ActionPanHs(pBtCoexist); ++ break; ++ case BT_8723A_2ANT_COEX_ALGO_PANEDR_A2DP: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n")); ++ halbtc8723a2ant_ActionPanEdrA2dp(pBtCoexist); ++ break; ++ case BT_8723A_2ANT_COEX_ALGO_PANEDR_HID: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n")); ++ halbtc8723a2ant_ActionPanEdrHid(pBtCoexist); ++ break; ++ case BT_8723A_2ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n")); ++ halbtc8723a2ant_ActionHidA2dpPanEdr(pBtCoexist); ++ break; ++ case BT_8723A_2ANT_COEX_ALGO_HID_A2DP: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n")); ++ halbtc8723a2ant_ActionHidA2dp(pBtCoexist); ++ break; ++ default: ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n")); ++ halbtc8723a2ant_CoexAllOff(pBtCoexist); ++ break; ++ } ++ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; ++ } ++ } ++} ++ ++//============================================================ ++// work around function start with wa_halbtc8723a2ant_ ++//============================================================ ++VOID ++wa_halbtc8723a2ant_MonitorC2h( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ u1Byte tmp1b=0x0; ++ u4Byte curC2hTotalCnt=0x0; ++ static u4Byte preC2hTotalCnt=0x0, sameCntPollingTime=0x0; ++ ++ curC2hTotalCnt+=pCoexSta->btInfoC2hCnt[BT_INFO_SRC_8723A_2ANT_BT_RSP]; ++ ++ if(curC2hTotalCnt == preC2hTotalCnt) ++ { ++ sameCntPollingTime++; ++ } ++ else ++ { ++ preC2hTotalCnt = curC2hTotalCnt; ++ sameCntPollingTime = 0; ++ } ++ ++ if(sameCntPollingTime >= 2) ++ { ++ tmp1b = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x1af); ++ if(tmp1b != 0x0) ++ { ++ pCoexSta->c2hHangDetectCnt++; ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x1af, 0x0); ++ } ++ } ++} ++ ++//============================================================ ++// extern function start with EXhalbtc8723a2ant_ ++//============================================================ ++VOID ++EXhalbtc8723a2ant_PowerOnSetting( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++} ++ ++VOID ++EXhalbtc8723a2ant_InitHwConfig( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bWifiOnly ++ ) ++{ ++ u4Byte u4Tmp=0; ++ u1Byte u1Tmp=0; ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); ++ ++ // backup rf 0x1e value ++ pCoexDm->btRf0x1eBackup = ++ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); ++ ++ // Enable counter statistics ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x3); ++ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x20); ++} ++ ++VOID ++EXhalbtc8723a2ant_InitCoexDm( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); ++ ++ halbtc8723a2ant_InitCoexDm(pBtCoexist); ++} ++ ++VOID ++EXhalbtc8723a2ant_DisplayCoexInfo( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; ++ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; ++ pu1Byte cliBuf=pBtCoexist->cliBuf; ++ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; ++ u4Byte u4Tmp[4]; ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ ++ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); ++ CL_PRINTF(cliBuf); ++ ++ if(pBtCoexist->bManualControl) ++ { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); ++ CL_PRINTF(cliBuf); ++ } ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ ++ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ ++ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], ++ pCoexDm->wifiChnlInfo[2]); ++ CL_PRINTF(cliBuf); ++ ++ // wifi status ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); ++ CL_PRINTF(cliBuf); ++ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ ++ ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8723A_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus)? "idle":( (BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy"))), ++ pCoexSta->btRssi, pCoexSta->btRetryCnt); ++ CL_PRINTF(cliBuf); ++ ++ if(pStackInfo->bProfileNotified) ++ { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ ++ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); ++ CL_PRINTF(cliBuf); ++ ++ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); ++ } ++ ++ btInfoExt = pCoexSta->btInfoExt; ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ ++ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); ++ CL_PRINTF(cliBuf); ++ ++ for(i=0; ibtInfoC2hCnt[i]) ++ { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723a2Ant[i], \ ++ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], ++ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], ++ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], ++ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); ++ CL_PRINTF(cliBuf); ++ } ++ } ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "write 0x1af=0x0 num", \ ++ pCoexSta->c2hHangDetectCnt); ++ CL_PRINTF(cliBuf); ++ ++ // Sw mechanism ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); ++ CL_PRINTF(cliBuf); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "SM1[ShRf/ LpRA/ LimDig]", \ ++ pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); ++ CL_PRINTF(cliBuf); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ ++ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); ++ CL_PRINTF(cliBuf); ++ ++ // Fw mechanism ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); ++ CL_PRINTF(cliBuf); ++ ++ if(!pBtCoexist->bManualControl) ++ { ++ psTdmaCase = pCoexDm->curPsTdma; ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", "PS TDMA", \ ++ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], ++ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], ++ pCoexDm->psTdmaPara[4], psTdmaCase); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "DecBtPwr/ IgnWlanAct", \ ++ pCoexDm->bCurDecBtPwr, pCoexDm->bCurIgnoreWlanAct); ++ CL_PRINTF(cliBuf); ++ } ++ ++ // Hw setting ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ ++ pCoexDm->btRf0x1eBackup); ++ CL_PRINTF(cliBuf); ++ ++ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); ++ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x783); ++ u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x796); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/ 0x783/ 0x796", \ ++ u1Tmp[0], u1Tmp[1], u1Tmp[2]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x880", \ ++ u4Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ ++ u1Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); ++ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ ++ u4Tmp[0], u1Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x484); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x484(rate adaptive)", \ ++ u4Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ ++ u4Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); ++ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); ++ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); ++ u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xdac); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0xda0/0xda4/0xda8/0xdac(FA cnt)", \ ++ u4Tmp[0], u4Tmp[1], u4Tmp[2], u4Tmp[3]); ++ CL_PRINTF(cliBuf); ++ ++ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); ++ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); ++ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); ++ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ ++ u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770 (hp rx[31:16]/tx[15:0])", \ ++ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); ++ CL_PRINTF(cliBuf); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(lp rx[31:16]/tx[15:0])", \ ++ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); ++ CL_PRINTF(cliBuf); ++ ++ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++VOID ++EXhalbtc8723a2ant_IpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_IPS_ENTER == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); ++ halbtc8723a2ant_CoexAllOff(pBtCoexist); ++ } ++ else if(BTC_IPS_LEAVE == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); ++ //halbtc8723a2ant_InitCoexDm(pBtCoexist); ++ } ++} ++ ++VOID ++EXhalbtc8723a2ant_LpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_LPS_ENABLE == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); ++ } ++ else if(BTC_LPS_DISABLE == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); ++ } ++} ++ ++VOID ++EXhalbtc8723a2ant_ScanNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_SCAN_START == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); ++ } ++ else if(BTC_SCAN_FINISH == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); ++ } ++} ++ ++VOID ++EXhalbtc8723a2ant_ConnectNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_ASSOCIATE_START == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); ++ } ++ else if(BTC_ASSOCIATE_FINISH == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); ++ } ++} ++ ++VOID ++EXhalbtc8723a2ant_MediaStatusNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_MEDIA_CONNECT == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); ++ } ++ ++ halbtc8723a2ant_IndicateWifiChnlBwInfo(pBtCoexist, type); ++} ++ ++VOID ++EXhalbtc8723a2ant_SpecialPacketNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(type == BTC_PACKET_DHCP) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); ++ } ++} ++ ++VOID ++EXhalbtc8723a2ant_BtInfoNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN pu1Byte tmpBuf, ++ IN u1Byte length ++ ) ++{ ++ u1Byte btInfo=0; ++ u1Byte i, rspSource=0; ++ BOOLEAN bBtBusy=FALSE, bLimitedDig=FALSE; ++ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; ++ ++ pCoexSta->bC2hBtInfoReqSent = FALSE; ++ ++ rspSource = BT_INFO_SRC_8723A_2ANT_BT_RSP; ++ pCoexSta->btInfoC2hCnt[rspSource]++; ++ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); ++ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; ++ if(i == 0) ++ btInfo = tmpBuf[i]; ++ if(i == length-1) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); ++ } ++ else ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); ++ } ++ } ++ ++ if(BT_INFO_SRC_8723A_2ANT_WIFI_FW != rspSource) ++ { ++ pCoexSta->btRetryCnt = ++ pCoexSta->btInfoC2h[rspSource][1]; ++ ++ pCoexSta->btRssi = ++ pCoexSta->btInfoC2h[rspSource][2]*2+10; ++ ++ pCoexSta->btInfoExt = ++ pCoexSta->btInfoC2h[rspSource][3]; ++ } ++ ++ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); ++ // check BIT2 first ==> check if bt is under inquiry or page scan ++ if(btInfo & BT_INFO_8723A_2ANT_B_INQ_PAGE) ++ { ++ pCoexSta->bC2hBtInquiryPage = TRUE; ++ } ++ else ++ { ++ pCoexSta->bC2hBtInquiryPage = FALSE; ++ } ++} ++ ++VOID ++EXhalbtc8723a2ant_StackOperationNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ) ++{ ++ if(BTC_STACK_OP_INQ_PAGE_PAIR_START == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], StackOP Inquiry/page/pair start notify\n")); ++ pCoexSta->bHoldForStackOperation = TRUE; ++ pCoexSta->bHoldPeriodCnt = 1; ++ halbtc8723a2ant_BtInquiryPage(pBtCoexist); ++ } ++ else if(BTC_STACK_OP_INQ_PAGE_PAIR_FINISH == type) ++ { ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], StackOP Inquiry/page/pair finish notify\n")); ++ pCoexSta->bHoldForStackOperation = FALSE; ++ } ++} ++ ++VOID ++EXhalbtc8723a2ant_HaltNotify( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); ++ ++ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); ++ EXhalbtc8723a2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); ++} ++ ++VOID ++EXhalbtc8723a2ant_Periodical( ++ IN PBTC_COEXIST pBtCoexist ++ ) ++{ ++ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Periodical!!\n")); ++ ++ // work around for c2h hang ++ wa_halbtc8723a2ant_MonitorC2h(pBtCoexist); ++ ++ halbtc8723a2ant_QueryBtInfo(pBtCoexist); ++ halbtc8723a2ant_MonitorBtCtr(pBtCoexist); ++ halbtc8723a2ant_MonitorBtEnableDisable(pBtCoexist); ++ ++ halbtc8723a2ant_RunCoexistMechanism(pBtCoexist); ++} ++ ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.h 2018-02-11 21:44:27.145146055 +0200 +@@ -0,0 +1,184 @@ ++//=========================================== ++// The following is for 8723A 2Ant BT Co-exist definition ++//=========================================== ++#define BT_INFO_8723A_2ANT_B_FTP BIT7 ++#define BT_INFO_8723A_2ANT_B_A2DP BIT6 ++#define BT_INFO_8723A_2ANT_B_HID BIT5 ++#define BT_INFO_8723A_2ANT_B_SCO_BUSY BIT4 ++#define BT_INFO_8723A_2ANT_B_ACL_BUSY BIT3 ++#define BT_INFO_8723A_2ANT_B_INQ_PAGE BIT2 ++#define BT_INFO_8723A_2ANT_B_SCO_ESCO BIT1 ++#define BT_INFO_8723A_2ANT_B_CONNECTION BIT0 ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT 2 ++ ++typedef enum _BT_INFO_SRC_8723A_2ANT{ ++ BT_INFO_SRC_8723A_2ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8723A_2ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8723A_2ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8723A_2ANT_MAX ++}BT_INFO_SRC_8723A_2ANT,*PBT_INFO_SRC_8723A_2ANT; ++ ++typedef enum _BT_8723A_2ANT_BT_STATUS{ ++ BT_8723A_2ANT_BT_STATUS_IDLE = 0x0, ++ BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8723A_2ANT_BT_STATUS_NON_IDLE = 0x2, ++ BT_8723A_2ANT_BT_STATUS_MAX ++}BT_8723A_2ANT_BT_STATUS,*PBT_8723A_2ANT_BT_STATUS; ++ ++typedef enum _BT_8723A_2ANT_COEX_ALGO{ ++ BT_8723A_2ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8723A_2ANT_COEX_ALGO_SCO = 0x1, ++ BT_8723A_2ANT_COEX_ALGO_HID = 0x2, ++ BT_8723A_2ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8723A_2ANT_COEX_ALGO_PANEDR = 0x4, ++ BT_8723A_2ANT_COEX_ALGO_PANHS = 0x5, ++ BT_8723A_2ANT_COEX_ALGO_PANEDR_A2DP = 0x6, ++ BT_8723A_2ANT_COEX_ALGO_PANEDR_HID = 0x7, ++ BT_8723A_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x8, ++ BT_8723A_2ANT_COEX_ALGO_HID_A2DP = 0x9, ++ BT_8723A_2ANT_COEX_ALGO_MAX ++}BT_8723A_2ANT_COEX_ALGO,*PBT_8723A_2ANT_COEX_ALGO; ++ ++typedef struct _COEX_DM_8723A_2ANT{ ++ // fw mechanism ++ BOOLEAN bPreDecBtPwr; ++ BOOLEAN bCurDecBtPwr; ++ //BOOLEAN bPreBtLnaConstrain; ++ //BOOLEAN bCurBtLnaConstrain; ++ //u1Byte bPreBtPsdMode; ++ //u1Byte bCurBtPsdMode; ++ u1Byte preFwDacSwingLvl; ++ u1Byte curFwDacSwingLvl; ++ BOOLEAN bCurIgnoreWlanAct; ++ BOOLEAN bPreIgnoreWlanAct; ++ u1Byte prePsTdma; ++ u1Byte curPsTdma; ++ u1Byte psTdmaPara[5]; ++ u1Byte psTdmaDuAdjType; ++ BOOLEAN bResetTdmaAdjust; ++ BOOLEAN bPrePsTdmaOn; ++ BOOLEAN bCurPsTdmaOn; ++ //BOOLEAN bPreBtAutoReport; ++ //BOOLEAN bCurBtAutoReport; ++ ++ // sw mechanism ++ BOOLEAN bPreRfRxLpfShrink; ++ BOOLEAN bCurRfRxLpfShrink; ++ u4Byte btRf0x1eBackup; ++ BOOLEAN bPreLowPenaltyRa; ++ BOOLEAN bCurLowPenaltyRa; ++ BOOLEAN bPreDacSwingOn; ++ u4Byte preDacSwingLvl; ++ BOOLEAN bCurDacSwingOn; ++ u4Byte curDacSwingLvl; ++ BOOLEAN bPreAdcBackOff; ++ BOOLEAN bCurAdcBackOff; ++ BOOLEAN bPreAgcTableEn; ++ BOOLEAN bCurAgcTableEn; ++ u4Byte preVal0x6c0; ++ u4Byte curVal0x6c0; ++ u4Byte preVal0x6c8; ++ u4Byte curVal0x6c8; ++ u1Byte preVal0x6cc; ++ u1Byte curVal0x6cc; ++ BOOLEAN bLimitedDig; ++ ++ // algorithm related ++ u1Byte preAlgorithm; ++ u1Byte curAlgorithm; ++ u1Byte btStatus; ++ u1Byte wifiChnlInfo[3]; ++} COEX_DM_8723A_2ANT, *PCOEX_DM_8723A_2ANT; ++ ++typedef struct _COEX_STA_8723A_2ANT{ ++ u4Byte highPriorityTx; ++ u4Byte highPriorityRx; ++ u4Byte lowPriorityTx; ++ u4Byte lowPriorityRx; ++ u1Byte btRssi; ++ u1Byte preBtRssiState; ++ u1Byte preBtRssiState1; ++ u1Byte preWifiRssiState[4]; ++ BOOLEAN bC2hBtInfoReqSent; ++ u1Byte btInfoC2h[BT_INFO_SRC_8723A_2ANT_MAX][10]; ++ u4Byte btInfoC2hCnt[BT_INFO_SRC_8723A_2ANT_MAX]; ++ BOOLEAN bC2hBtInquiryPage; ++ u1Byte btRetryCnt; ++ u1Byte btInfoExt; ++ BOOLEAN bHoldForStackOperation; ++ u1Byte bHoldPeriodCnt; ++ // this is for c2h hang work-around ++ u4Byte c2hHangDetectCnt; ++}COEX_STA_8723A_2ANT, *PCOEX_STA_8723A_2ANT; ++ ++//=========================================== ++// The following is interface which will notify coex module. ++//=========================================== ++VOID ++EXhalbtc8723a2ant_PowerOnSetting( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8723a2ant_InitHwConfig( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bWifiOnly ++ ); ++VOID ++EXhalbtc8723a2ant_InitCoexDm( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8723a2ant_IpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8723a2ant_LpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8723a2ant_ScanNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8723a2ant_ConnectNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8723a2ant_MediaStatusNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8723a2ant_SpecialPacketNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8723a2ant_HaltNotify( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8723a2ant_Periodical( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtc8723a2ant_BtInfoNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN pu1Byte tmpBuf, ++ IN u1Byte length ++ ); ++VOID ++EXhalbtc8723a2ant_StackOperationNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtc8723a2ant_DisplayCoexInfo( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.c 2018-02-11 21:44:27.146146071 +0200 +@@ -0,0 +1,4845 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8723B Co-exist mechanism ++ * ++ * History ++ * 2012/11/15 Cosa first check in. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8723B_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8723b_1ant glcoex_dm_8723b_1ant; ++static struct coex_dm_8723b_1ant *coex_dm = &glcoex_dm_8723b_1ant; ++static struct coex_sta_8723b_1ant glcoex_sta_8723b_1ant; ++static struct coex_sta_8723b_1ant *coex_sta = &glcoex_sta_8723b_1ant; ++static struct psdscan_sta_8723b_1ant gl_psd_scan_8723b_1ant; ++static struct psdscan_sta_8723b_1ant *psd_scan = &gl_psd_scan_8723b_1ant; ++ ++ ++const char *const glbt_info_src_8723b_1ant[]={ ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++u32 glcoex_ver_date_8723b_1ant = 20151015; ++u32 glcoex_ver_8723b_1ant = 0x63; ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8723b1ant_ ++ * ************************************************************ */ ++ ++void halbtc8723b1ant_update_ra_mask(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 dis_rate_mask) ++{ ++ coex_dm->cur_ra_mask = dis_rate_mask; ++ ++ if( force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, ++ &coex_dm->cur_ra_mask); ++ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; ++} ++ ++void halbtc8723b1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ ++ coex_dm->cur_arfr_type = type; ++ ++ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { ++ switch (coex_dm->cur_arfr_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_4byte(btcoexist, 0x430, ++ coex_dm->backup_arfr_cnt1); ++ btcoexist->btc_write_4byte(btcoexist, 0x434, ++ coex_dm->backup_arfr_cnt2); ++ break; ++ case 1: ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x01010101); ++ } else { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x04030201); ++ } ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; ++} ++ ++void halbtc8723b1ant_retry_limit(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_retry_limit_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_retry_limit_type != ++ coex_dm->cur_retry_limit_type)) { ++ switch (coex_dm->cur_retry_limit_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ coex_dm->backup_retry_limit); ++ break; ++ case 1: /* retry limit=8 */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ 0x0808); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; ++} ++ ++void halbtc8723b1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_ampdu_time_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { ++ switch (coex_dm->cur_ampdu_time_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ coex_dm->backup_ampdu_max_time); ++ break; ++ case 1: /* AMPDU timw = 0x38 * 32us */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ 0x38); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; ++} ++ ++void halbtc8723b1ant_limited_tx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, ++ IN u8 retry_limit_type, IN u8 ampdu_time_type) ++{ ++ switch (ra_mask_type) { ++ case 0: /* normal mode */ ++ halbtc8723b1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0); ++ break; ++ case 1: /* disable cck 1/2 */ ++ halbtc8723b1ant_update_ra_mask(btcoexist, force_exec, ++ 0x00000003); ++ break; ++ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ ++ halbtc8723b1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0001f1f7); ++ break; ++ default: ++ break; ++ } ++ ++ halbtc8723b1ant_auto_rate_fallback_retry(btcoexist, force_exec, ++ arfr_type); ++ halbtc8723b1ant_retry_limit(btcoexist, force_exec, retry_limit_type); ++ halbtc8723b1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); ++} ++ ++void halbtc8723b1ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++ ++ ++} ++ ++void halbtc8723b1ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ coex_sta->c2h_bt_info_req_sent = true; ++ ++ h2c_parameter[0] |= BIT(0); /* trigger */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); ++} ++ ++void halbtc8723b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ static u32 num_of_bt_counter_chk = 0; ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ if ((coex_sta->low_priority_tx > 1050) && ++ (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->pop_event_cnt++; ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++ ++ /* This part is for wifi FW and driver to update BT's status as disabled. */ ++ /* The flow is as the following */ ++ /* 1. disable BT */ ++ /* 2. if all BT Tx/Rx counter=0, after 6 sec we query bt info */ ++ /* 3. Because BT will not rsp from mailbox, so wifi fw will know BT is disabled */ ++ /* 4. FW will rsp c2h for BT that driver will know BT is disabled. */ ++ if ((reg_hp_tx == 0) && (reg_hp_rx == 0) && (reg_lp_tx == 0) && ++ (reg_lp_rx == 0)) { ++ num_of_bt_counter_chk++; ++ if (num_of_bt_counter_chk == 3) ++ halbtc8723b1ant_query_bt_info(btcoexist); ++ } else ++ num_of_bt_counter_chk = 0; ++} ++ ++ ++void halbtc8723b1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) ++{ ++ s32 wifi_rssi = 0; ++ boolean wifi_busy = false, wifi_under_b_mode = false; ++ static u8 cck_lock_counter = 0; ++ u32 total_cnt; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ if (coex_sta->under_ips) { ++ coex_sta->crc_ok_cck = 0; ++ coex_sta->crc_ok_11g = 0; ++ coex_sta->crc_ok_11n = 0; ++ coex_sta->crc_ok_11n_agg = 0; ++ ++ coex_sta->crc_err_cck = 0; ++ coex_sta->crc_err_11g = 0; ++ coex_sta->crc_err_11n = 0; ++ coex_sta->crc_err_11n_agg = 0; ++ } else { ++ coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, ++ 0xf88); ++ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf94); ++ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf90); ++ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xfb8); ++ ++ coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, ++ 0xf84); ++ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf96); ++ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf92); ++ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xfba); ++ } ++ ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); ++ ++ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { ++ total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + ++ coex_sta->crc_ok_11n + ++ coex_sta->crc_ok_11n_agg; ++ ++ if ( (coex_dm->bt_status == BT_8723B_1ANT_BT_STATUS_ACL_BUSY) || ++ (coex_dm->bt_status == ++ BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY) || ++ (coex_dm->bt_status == ++ BT_8723B_1ANT_BT_STATUS_SCO_BUSY)) { ++ if (coex_sta->crc_ok_cck > (total_cnt - ++coex_sta->crc_ok_cck)) { ++ if (cck_lock_counter < 3) ++ cck_lock_counter++; ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ if (!coex_sta->pre_ccklock) { ++ ++ if (cck_lock_counter >= 3) ++ coex_sta->cck_lock = true; ++ else ++ coex_sta->cck_lock = false; ++ } else { ++ if (cck_lock_counter == 0) ++ coex_sta->cck_lock = false; ++ else ++ coex_sta->cck_lock = true; ++ } ++ ++ if (coex_sta->cck_lock) ++ coex_sta->cck_ever_lock = true; ++ ++ coex_sta->pre_ccklock = coex_sta->cck_lock; ++ ++ ++} ++ ++boolean halbtc8723b1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) ++{ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ ++ ++ } ++ ++ return false; ++} ++ ++void halbtc8723b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if( bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist ) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if( !bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist ) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if( !bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist ) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if( !bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist ) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++} ++ ++void halbtc8723b1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8723b1ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ halbtc8723b1ant_set_bt_auto_report(btcoexist, ++ coex_dm->cur_bt_auto_report); ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++void halbtc8723b1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ ++ ++ if (low_penalty_ra) { ++ h2c_parameter[1] |= BIT(0); ++ h2c_parameter[2] = ++ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ ++ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ ++ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ ++ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); ++} ++ ++void halbtc8723b1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ halbtc8723b1ant_set_sw_penalty_tx_rate_adaptive(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++} ++ ++void halbtc8723b1ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8723b1ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ halbtc8723b1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8723b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++#if BT_8723B_1ANT_ANTDET_ENABLE ++#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE ++ if (board_info->btdm_ant_num_by_ant_det == 2) { ++ if (type == 3) ++ type = 14; ++ else if (type == 4) ++ type = 13; ++ else if (type == 5) ++ type = 8; ++ } ++#endif ++#endif ++ ++ coex_sta->coex_table_type = type; ++ ++ switch (type) { ++ case 0: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x55555555, 0xffffff, 0x3); ++ break; ++ case 1: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 2: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 3: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 4: ++ if ((coex_sta->cck_ever_lock) && ++ (coex_sta->scan_ap_num <= 5)) ++ halbtc8723b1ant_coex_table(btcoexist, ++ force_exec, 0x55555555, 0xaaaa5a5a, ++ 0xffffff, 0x3); ++ else ++ halbtc8723b1ant_coex_table(btcoexist, ++ force_exec, 0x55555555, 0x5a5a5a5a, ++ 0xffffff, 0x3); ++ break; ++ case 5: ++ if ((coex_sta->cck_ever_lock) && ++ (coex_sta->scan_ap_num <= 5)) ++ halbtc8723b1ant_coex_table(btcoexist, ++ force_exec, 0x5a5a5a5a, 0x5aaa5a5a, ++ 0xffffff, 0x3); ++ else ++ halbtc8723b1ant_coex_table(btcoexist, ++ force_exec, 0x5a5a5a5a, 0x5aaa5a5a, ++ 0xffffff, 0x3); ++ break; ++ case 6: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ case 7: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ case 8: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 9: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 10: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 11: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 12: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 13: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ case 14: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 15: ++ halbtc8723b1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8723b1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ if (enable) { ++ h2c_parameter[0] |= BIT(0); /* function enable */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); ++} ++ ++void halbtc8723b1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ halbtc8723b1ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8723b1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8723b1ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8723b1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8723b1ant_sw_mechanism(IN struct btc_coexist *btcoexist, ++ IN boolean low_penalty_ra) ++{ ++ halbtc8723b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); ++} ++ ++void halbtc8723b1ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean force_exec, IN boolean init_hwcfg, ++ IN boolean wifi_off) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u32 fw_ver = 0, u32tmp = 0, cnt_bt_cal_chk = 0; ++ boolean pg_ext_switch = false; ++ boolean use_ext_switch = false; ++ boolean is_in_mp_mode = false; ++ u8 h2c_parameter[2] = {0}, u8tmp = 0; ++ ++ coex_dm->cur_ant_pos_type = ant_pos_type; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_EXT_SWITCH, &pg_ext_switch); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, ++ &fw_ver); /* [31:16]=fw ver, [15:0]=fw sub ver */ ++ ++ if ((fw_ver > 0 && fw_ver < 0xc0000) || pg_ext_switch) ++ use_ext_switch = true; ++ ++#if BT_8723B_1ANT_ANTDET_ENABLE ++#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE ++ if (ant_pos_type == BTC_ANT_PATH_PTA) { ++ if ((board_info->btdm_ant_det_finish) && ++ (board_info->btdm_ant_num_by_ant_det == 2)) { ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ ant_pos_type = BTC_ANT_PATH_WIFI; ++ else ++ ant_pos_type = BTC_ANT_PATH_BT; ++ } ++ } ++#endif ++#endif ++ ++ if (init_hwcfg) { ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, ++ 0x780); /* WiFi TRx Mask on */ ++ /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ ++ /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT TRx Mask on */ ++ ++ if (fw_ver >= 0x180000) { ++ /* Use H2C to set GNT_BT to HIGH */ ++ h2c_parameter[0] = 1; ++ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, ++ h2c_parameter); ++ } else { ++ /* set grant_bt to high */ ++ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); ++ } ++ /* set wlan_act control by PTA */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, ++ 0x0); /* BT select s0/s1 is controlled by BT */ ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x39, 0x8, 0x1); ++ btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x944, 0x3, 0x3); ++ btcoexist->btc_write_1byte(btcoexist, 0x930, 0x77); ++ } else if (wifi_off) { ++ if (fw_ver >= 0x180000) { ++ /* Use H2C to set GNT_BT to HIGH */ ++ h2c_parameter[0] = 1; ++ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, ++ h2c_parameter); ++ } else { ++ /* set grant_bt to high */ ++ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); ++ } ++ /* set wlan_act to always low */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, ++ &is_in_mp_mode); ++ if (!is_in_mp_mode) ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, ++ 0x20, 0x0); /* BT select s0/s1 is controlled by BT */ ++ else ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, ++ 0x20, 0x1); /* BT select s0/s1 is controlled by WiFi */ ++ ++ /* 0x4c[24:23]=00, Set Antenna control by BT_RFE_CTRL BT Vendor 0xac=0xf002 */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp &= ~BIT(23); ++ u32tmp &= ~BIT(24); ++ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); ++ } else { ++ /* Use H2C to set GNT_BT to LOW */ ++ if (fw_ver >= 0x180000) { ++ if (btcoexist->btc_read_1byte(btcoexist, 0x765) != 0) { ++ h2c_parameter[0] = 0; ++ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, ++ h2c_parameter); ++ } ++ } else { ++ /* BT calibration check */ ++ while (cnt_bt_cal_chk <= 20) { ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, ++ 0x49d); ++ cnt_bt_cal_chk++; ++ if (u8tmp & BIT(0)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ delay_ms(50); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ break; ++ } ++ } ++ ++ /* set grant_bt to PTA */ ++ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x0); ++ } ++ ++ if (btcoexist->btc_read_1byte(btcoexist, 0x76e) != 0xc) { ++ /* set wlan_act control by PTA */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++ } ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, ++ 0x1); /* BT select s0/s1 is controlled by WiFi */ ++ } ++ ++ if (use_ext_switch) { ++ if (init_hwcfg) { ++ /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp &= ~BIT(23); ++ u32tmp |= BIT(24); ++ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x948, ++ 0x0); /* fixed internal switch S1->WiFi, S0->BT */ ++ ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) { ++ /* tell firmware "no antenna inverse" */ ++ h2c_parameter[0] = 0; ++ h2c_parameter[1] = 1; /* ext switch type */ ++ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, ++ h2c_parameter); ++ } else { ++ /* tell firmware "antenna inverse" */ ++ h2c_parameter[0] = 1; ++ h2c_parameter[1] = 1; /* ext switch type */ ++ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, ++ h2c_parameter); ++ } ++ } ++ ++ if (force_exec || ++ (coex_dm->cur_ant_pos_type != ++ coex_dm->pre_ant_pos_type)) { ++ /* ext switch setting */ ++ switch (ant_pos_type) { ++ case BTC_ANT_PATH_WIFI: ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ btcoexist->btc_write_1byte_bitmask( ++ btcoexist, 0x92c, 0x3, ++ 0x1); ++ else ++ btcoexist->btc_write_1byte_bitmask( ++ btcoexist, 0x92c, 0x3, ++ 0x2); ++ break; ++ case BTC_ANT_PATH_BT: ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ btcoexist->btc_write_1byte_bitmask( ++ btcoexist, 0x92c, 0x3, ++ 0x2); ++ else ++ btcoexist->btc_write_1byte_bitmask( ++ btcoexist, 0x92c, 0x3, ++ 0x1); ++ break; ++ default: ++ case BTC_ANT_PATH_PTA: ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ btcoexist->btc_write_1byte_bitmask( ++ btcoexist, 0x92c, 0x3, ++ 0x1); ++ else ++ btcoexist->btc_write_1byte_bitmask( ++ btcoexist, 0x92c, 0x3, ++ 0x2); ++ break; ++ } ++ } ++ } else { ++ if (init_hwcfg) { ++ /* 0x4c[23]=1, 0x4c[24]=0 Antenna control by 0x64 */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp |= BIT(23); ++ u32tmp &= ~BIT(24); ++ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); ++ ++ /* Fix Ext switch Main->S1, Aux->S0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, ++ 0x0); ++ ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) { ++ ++ /* tell firmware "no antenna inverse" */ ++ h2c_parameter[0] = 0; ++ h2c_parameter[1] = ++ 0; /* internal switch type */ ++ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, ++ h2c_parameter); ++ } else { ++ ++ /* tell firmware "antenna inverse" */ ++ h2c_parameter[0] = 1; ++ h2c_parameter[1] = ++ 0; /* internal switch type */ ++ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, ++ h2c_parameter); ++ } ++ } ++ ++ if (force_exec || ++ (coex_dm->cur_ant_pos_type != ++ coex_dm->pre_ant_pos_type)) { ++ /* internal switch setting */ ++ switch (ant_pos_type) { ++ case BTC_ANT_PATH_WIFI: ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ btcoexist->btc_write_4byte( ++ btcoexist, 0x948, 0x0); ++ else ++ btcoexist->btc_write_4byte( ++ btcoexist, 0x948, ++ 0x280); ++ break; ++ case BTC_ANT_PATH_BT: ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ btcoexist->btc_write_4byte( ++ btcoexist, 0x948, ++ 0x280); ++ else ++ btcoexist->btc_write_4byte( ++ btcoexist, 0x948, 0x0); ++ break; ++ default: ++ case BTC_ANT_PATH_PTA: ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ btcoexist->btc_write_4byte( ++ btcoexist, 0x948, ++ 0x200); ++ else ++ btcoexist->btc_write_4byte( ++ btcoexist, 0x948, 0x80); ++ break; ++ } ++ } ++ } ++ ++ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; ++} ++ ++void halbtc8723b1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ u8 real_byte1 = byte1, real_byte5 = byte5; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ if (ap_enable) { ++ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ real_byte1 &= ~BIT(4); ++ real_byte1 |= BIT(5); ++ ++ real_byte5 |= BIT(5); ++ real_byte5 &= ~BIT(6); ++ } ++ } ++ ++ h2c_parameter[0] = real_byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = real_byte5; ++ ++ coex_dm->ps_tdma_para[0] = real_byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = real_byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++ ++void halbtc8723b1ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_busy = false; ++ u8 rssi_adjust_val = 0; ++ u8 ps_tdma_byte4_val = 0x50, ps_tdma_byte0_val = 0x51, ++ ps_tdma_byte3_val = 0x10; ++ s8 wifi_duration_adjust = 0x0; ++ static boolean pre_wifi_busy = false; ++ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++#if BT_8723B_1ANT_ANTDET_ENABLE ++#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE ++ if (board_info->btdm_ant_num_by_ant_det == 2) { ++ if (turn_on) ++ type = type + ++ 100; /* for WiFi RSSI low or BT RSSI low */ ++ else ++ type = 1; /* always translate to TDMA(off,1) for TDMA-off case */ ++ } ++ ++#endif ++#endif ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (wifi_busy != pre_wifi_busy) { ++ force_exec = true; ++ pre_wifi_busy = wifi_busy; ++ } ++ ++ if (!force_exec) { ++ if( (coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma) ) ++ return; ++ } ++ ++ if (coex_sta->scan_ap_num <= 5) { ++ wifi_duration_adjust = 5; ++ ++ if (coex_sta->a2dp_bit_pool >= 35) ++ wifi_duration_adjust = -10; ++ else if (coex_sta->a2dp_bit_pool >= 45) ++ wifi_duration_adjust = -15; ++ } else if (coex_sta->scan_ap_num >= 40) { ++ wifi_duration_adjust = -15; ++ ++ if (coex_sta->a2dp_bit_pool < 35) ++ wifi_duration_adjust = -5; ++ else if (coex_sta->a2dp_bit_pool < 45) ++ wifi_duration_adjust = -10; ++ } else if (coex_sta->scan_ap_num >= 20) { ++ wifi_duration_adjust = -10; ++ ++ if (coex_sta->a2dp_bit_pool >= 45) ++ wifi_duration_adjust = -15; ++ } else { ++ wifi_duration_adjust = 0; ++ ++ if (coex_sta->a2dp_bit_pool >= 35) ++ wifi_duration_adjust = -10; ++ else if (coex_sta->a2dp_bit_pool >= 45) ++ wifi_duration_adjust = -15; ++ } ++ ++ if ((type == 1) || (type == 2) || (type == 9) || (type == 11) || ++ (type == 101) ++ || (type == 102) || (type == 109) || (type == 101)) { ++ if (!coex_sta->force_lps_on) { /* Native power save TDMA, only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 */ ++ ps_tdma_byte0_val = 0x61; /* no null-pkt */ ++ ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */ ++ ps_tdma_byte4_val = ++ 0x10; /* 0x778 = d/1 toggle, no dynamic slot */ ++ } else { ++ ps_tdma_byte0_val = 0x51; /* null-pkt */ ++ ps_tdma_byte3_val = 0x10; /* tx-pause at BT-slot */ ++ ps_tdma_byte4_val = ++ 0x50; /* 0x778 = d/1 toggle, dynamic slot */ ++ } ++ } else if ((type == 3) || (type == 13) || (type == 14) || ++ (type == 103) || (type == 113) || (type == 114)) { ++ ps_tdma_byte0_val = 0x51; /* null-pkt */ ++ ps_tdma_byte3_val = 0x10; /* tx-pause at BT-slot */ ++ ps_tdma_byte4_val = ++ 0x10; /* 0x778 = d/1 toggle, no dynamic slot */ ++#if 0 ++ if (!wifi_busy) ++ ps_tdma_byte4_val = ps_tdma_byte4_val | ++ 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ ++#endif ++ } else { /* native power save case */ ++ ps_tdma_byte0_val = 0x61; /* no null-pkt */ ++ ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */ ++ ps_tdma_byte4_val = ++ 0x11; /* 0x778 = d/1 toggle, no dynamic slot */ ++ /* psTdmaByte4Va is not defne for 0x778 = d/1, 1/1 case */ ++ } ++ ++ /* if (bt_link_info->slave_role == true) */ ++ if ((bt_link_info->slave_role == true) && (bt_link_info->a2dp_exist)) ++ ps_tdma_byte4_val = ps_tdma_byte4_val | ++ 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ ++ ++ if (type > 100) { ++ ps_tdma_byte0_val = ps_tdma_byte0_val | ++ 0x82; /* set antenna control by SW */ ++ ps_tdma_byte3_val = ps_tdma_byte3_val | ++ 0x60; /* set antenna no toggle, control by antenna diversity */ ++ } ++ ++ ++ if (turn_on) { ++ switch (type) { ++ default: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x1a, 0x1a, 0x0, ps_tdma_byte4_val); ++ break; ++ case 1: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x3a + ++ wifi_duration_adjust, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 2: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x2d + ++ wifi_duration_adjust, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 3: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x30, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 4: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x15, 0x3, 0x14, 0x0); ++ break; ++ case 5: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x1f, 0x3, ++ ps_tdma_byte3_val, 0x11); ++ break; ++ case 6: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x20, 0x3, ++ ps_tdma_byte3_val, 0x11); ++ break; ++ case 7: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13, ++ 0xc, 0x5, 0x0, 0x0); ++ break; ++ case 8: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x25, 0x3, 0x10, 0x0); ++ break; ++ case 9: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x21, 0x3, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 10: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13, ++ 0xa, 0xa, 0x0, 0x40); ++ break; ++ case 11: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x21, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 12: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x0a, 0x0a, 0x0, 0x50); ++ break; ++ case 13: ++ if (coex_sta->scan_ap_num <= 3) ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x40, 0x3, ++ ps_tdma_byte3_val, ++ ps_tdma_byte4_val); ++ else ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x21, 0x3, ++ ps_tdma_byte3_val, ++ ps_tdma_byte4_val); ++ break; ++ case 14: ++ if (coex_sta->scan_ap_num <= 3) ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x30, 0x3, 0x10, 0x50); ++ else ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x21, 0x3, ++ ps_tdma_byte3_val, ++ ps_tdma_byte4_val); ++ break; ++ case 15: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13, ++ 0xa, 0x3, 0x8, 0x0); ++ break; ++ case 16: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x15, 0x3, 0x10, 0x0); ++ break; ++ case 18: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x25, 0x3, 0x10, 0x0); ++ break; ++ case 20: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x3f, 0x03, ++ ps_tdma_byte3_val, 0x10); ++ break; ++ case 21: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x25, 0x03, 0x11, 0x11); ++ break; ++ case 22: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x25, 0x03, ++ ps_tdma_byte3_val, 0x10); ++ break; ++ case 23: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x3, 0x31, 0x18); ++ break; ++ case 24: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x15, 0x3, 0x31, 0x18); ++ break; ++ case 25: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0xa, 0x3, 0x31, 0x18); ++ break; ++ case 26: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0xa, 0x3, 0x31, 0x18); ++ break; ++ case 27: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x3, 0x31, 0x98); ++ break; ++ case 28: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x69, ++ 0x25, 0x3, 0x31, 0x0); ++ break; ++ case 29: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xab, ++ 0x1a, 0x1a, 0x1, 0x10); ++ break; ++ case 30: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x30, 0x3, 0x10, 0x10); ++ break; ++ case 31: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x1a, 0x1a, 0, 0x58); ++ break; ++ case 32: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x35, 0x3, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 33: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x35, 0x3, ++ ps_tdma_byte3_val, 0x10); ++ break; ++ case 34: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x53, ++ 0x1a, 0x1a, 0x0, 0x10); ++ break; ++ case 35: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x63, ++ 0x1a, 0x1a, 0x0, 0x10); ++ break; ++ case 36: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x12, 0x3, 0x14, 0x50); ++ break; ++ case 40: /* SoftAP only with no sta associated,BT disable ,TDMA mode for power saving */ ++ /* here softap mode screen off will cost 70-80mA for phone */ ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x23, ++ 0x18, 0x00, 0x10, 0x24); ++ break; ++ ++ /* for 1-Ant translate to 2-Ant */ ++ case 101: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x3a + ++ wifi_duration_adjust, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 102: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x2d + ++ wifi_duration_adjust, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 103: ++ /* halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, 0x1d, 0x1d, 0x0, ps_tdma_byte4_val); */ ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x3a, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 105: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x15, 0x3, ++ ps_tdma_byte3_val, 0x11); ++ break; ++ case 106: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x20, 0x3, ++ ps_tdma_byte3_val, 0x11); ++ break; ++ case 109: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x21, 0x3, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 111: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x21, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 113: ++ /* halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, 0x12, 0x12, 0x0, ps_tdma_byte4_val); */ ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x21, 0x3, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 114: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x21, 0x3, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 120: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x3f, 0x03, ++ ps_tdma_byte3_val, 0x10); ++ break; ++ case 122: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x25, 0x03, ++ ps_tdma_byte3_val, 0x10); ++ break; ++ case 132: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x25, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 133: ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x25, 0x03, ++ ps_tdma_byte3_val, 0x11); ++ break; ++ ++ } ++ } else { ++ ++ /* disable PS tdma */ ++ switch (type) { ++ case 8: /* PTA Control */ ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x8, ++ 0x0, 0x0, 0x0, 0x0); ++ break; ++ case 0: ++ default: /* Software control, Antenna at BT side */ ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x0, 0x0); ++ break; ++ case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ ++ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x48, 0x0); ++ break; ++ } ++ } ++ rssi_adjust_val = 0; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssi_adjust_val); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", ++ btcoexist->btc_read_4byte(btcoexist, 0x948), ++ btcoexist->btc_read_1byte(btcoexist, 0x765), ++ btcoexist->btc_read_1byte(btcoexist, 0x67)); ++ BTC_TRACE(trace_buf); ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++void halbtc8723b1ant_tdma_duration_adjust_for_acl(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ static s32 up, dn, m, n, wait_count; ++ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ ++ u8 retry_count = 0, bt_info_ext; ++ boolean wifi_busy = false; ++ ++ if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifi_status) ++ wifi_busy = true; ++ else ++ wifi_busy = false; ++ ++ if ((BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == ++ wifi_status) || ++ (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifi_status) || ++ (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT == ++ wifi_status)) { ++ if (coex_dm->cur_ps_tdma != 1 && ++ coex_dm->cur_ps_tdma != 2 && ++ coex_dm->cur_ps_tdma != 3 && ++ coex_dm->cur_ps_tdma != 9) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n = 3; ++ result = 0; ++ wait_count = 0; ++ } ++ return; ++ } ++ ++ if (!coex_dm->auto_tdma_adjust) { ++ coex_dm->auto_tdma_adjust = true; ++ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ /* ============ */ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n = 3; ++ result = 0; ++ wait_count = 0; ++ } else { ++ /* accquire the BT TRx retry count from BT_Info byte2 */ ++ retry_count = coex_sta->bt_retry_cnt; ++ bt_info_ext = coex_sta->bt_info_ext; ++ ++ if ((coex_sta->low_priority_tx) > 1050 || ++ (coex_sta->low_priority_rx) > 1250) ++ retry_count++; ++ ++ result = 0; ++ wait_count++; ++ ++ if (retry_count == ++ 0) { /* no retry in the last 2-second duration */ ++ up++; ++ dn--; ++ ++ if (dn <= 0) ++ dn = 0; ++ ++ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ ++ wait_count = 0; ++ n = 3; ++ up = 0; ++ dn = 0; ++ result = 1; ++ } ++ } else if (retry_count <= ++ 3) { /* <=3 retry in the last 2-second duration */ ++ up--; ++ dn++; ++ ++ if (up <= 0) ++ up = 0; ++ ++ if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ ++ if (wait_count <= 2) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ ++ if (wait_count == 1) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ ++ if (result == -1) { ++ /* if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && ++ ((coex_dm->cur_ps_tdma == 1) ||(coex_dm->cur_ps_tdma == 2)) ) ++ { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } ++ else */ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } ++ } else if (result == 1) { ++ /* if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && ++ ((coex_dm->cur_ps_tdma == 1) ||(coex_dm->cur_ps_tdma == 2)) ) ++ { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } ++ else */ if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = 1; ++ } ++ } else { /* no change */ ++ /* Bryant Modify ++ if(wifi_busy != pre_wifi_busy) ++ { ++ pre_wifi_busy = wifi_busy; ++ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, true, coex_dm->cur_ps_tdma); ++ } ++ */ ++ ++ } ++ ++ if (coex_dm->cur_ps_tdma != 1 && ++ coex_dm->cur_ps_tdma != 2 && ++ coex_dm->cur_ps_tdma != 9 && ++ coex_dm->cur_ps_tdma != 11) { ++ /* recover to previous adjust type */ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ coex_dm->ps_tdma_du_adj_type); ++ } ++ } ++} ++ ++void halbtc8723b1ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++void halbtc8723b1ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ boolean low_pwr_disable = false; ++ ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ /* recover to original 32k low power setting */ ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ case BTC_PS_LPS_ON: ++ halbtc8723b1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8723b1ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ /* when coex force to enter LPS, do not enter 32k low power. */ ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ coex_sta->force_lps_on = true; ++ break; ++ case BTC_PS_LPS_OFF: ++ halbtc8723b1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, false); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8723b1ant_action_wifi_only(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, ++ false, false); ++} ++ ++void halbtc8723b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ ++ /* This function check if bt is disabled */ ++ ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ } else { ++ bt_disable_cnt++; ++ if (bt_disable_cnt >= 2) ++ bt_disabled = true; ++ } ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->bt_disabled = bt_disabled; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ if (bt_disabled) { ++ halbtc8723b1ant_action_wifi_only(btcoexist); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ } ++ } ++} ++ ++/* ********************************************* ++ * ++ * Non-Software Coex Mechanism start ++ * ++ * ********************************************* */ ++void halbtc8723b1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, ++ false, false); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8723b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, ++ false, false); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8723b1ant_action_hs(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8723b1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, ++ bt_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ if (coex_sta->bt_abnormal_scan) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 33); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ } else if ((!wifi_connected) && (!coex_sta->wifi_is_high_pri_task)) { ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || ++ (bt_link_info->a2dp_exist)) { ++ /* SCO/HID/A2DP busy */ ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ ++ if (coex_sta->c2h_bt_remote_name_req) ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 33); ++ else ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if ((bt_link_info->pan_exist) || (wifi_busy)) { ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ ++ if (coex_sta->c2h_bt_remote_name_req) ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 33); ++ else ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ ++ } ++} ++ ++void halbtc8723b1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ /* tdma and coex table */ ++ ++ if (bt_link_info->sco_exist) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } else { /* HID */ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } ++} ++ ++void halbtc8723b1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ if ((coex_sta->low_priority_rx >= 950) && (!coex_sta->under_ips)) ++ bt_link_info->slave_role = true; ++ else ++ bt_link_info->slave_role = false; ++ ++ if (bt_link_info->hid_only) { /* HID */ ++ halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ wifi_status); ++ coex_dm->auto_tdma_adjust = false; ++ return; ++ } else if (bt_link_info->a2dp_only) { /* A2DP */ ++ if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } else { ++ halbtc8723b1ant_tdma_duration_adjust_for_acl(btcoexist, ++ wifi_status); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = true; ++ } ++ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || ++ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { /* HID+A2DP */ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); ++ coex_dm->auto_tdma_adjust = false; ++ ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && ++ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } else { ++ /* BT no-profile busy (0x9) */ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } ++} ++ ++void halbtc8723b1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) ++{ ++ /* power save state */ ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, ++ false, false); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8723b1ant_action_wifi_not_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else if (bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 20); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ /* Bryant Add */ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8723b1ant_action_wifi_not_connected_asso_auth( ++ IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || ++ (bt_link_info->a2dp_exist)) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); ++ } else if (bt_link_info->pan_exist) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); ++ } else { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); ++ } ++} ++ ++void halbtc8723b1ant_action_wifi_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else if (bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 20); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ /* Bryant Add */ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8723b1ant_action_wifi_connected_specific_packet( ++ IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ /* no specific packet process for both WiFi and BT very busy */ ++ if ((wifi_busy) && ((bt_link_info->pan_exist) || ++ (coex_sta->num_of_profile >= 2))) ++ return; ++ ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } else if (bt_link_info->a2dp_exist) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if (bt_link_info->pan_exist) { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8723b1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_busy = false; ++ boolean scan = false, link = false, roam = false; ++ boolean under_4way = false, ap_enable = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ if (under_4way) { ++ halbtc8723b1ant_action_wifi_connected_specific_packet(btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8723b1ant_action_wifi_connected_scan(btcoexist); ++ else ++ halbtc8723b1ant_action_wifi_connected_specific_packet( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ /* power save state */ ++ if (!ap_enable && ++ BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status && ++ !btcoexist->bt_link_info.hid_only) { ++ if (btcoexist->bt_link_info.a2dp_only) { /* A2DP */ ++ if (!wifi_busy) ++ halbtc8723b1ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ else { /* busy */ ++ if (coex_sta->scan_ap_num >= ++ BT_8723B_1ANT_WIFI_NOISY_THRESH) /* no force LPS, no PS-TDMA, use pure TDMA */ ++ halbtc8723b1ant_power_save_state( ++ btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ else ++ halbtc8723b1ant_power_save_state( ++ btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ } else if ((coex_sta->pan_exist == false) && ++ (coex_sta->a2dp_exist == false) && ++ (coex_sta->hid_exist == false)) ++ halbtc8723b1ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ else ++ halbtc8723b1ant_power_save_state(btcoexist, ++ BTC_PS_LPS_ON, 0x50, 0x4); ++ } else ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ ++ /* tdma and coex table */ ++ if (!wifi_busy) { ++ if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8723b1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else { ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ halbtc8723b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); ++ /* if ((coex_sta->high_priority_tx) + ++ (coex_sta->high_priority_rx) <= 60) */ ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 2); ++ /* else ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 7); */ ++ } ++ } else { ++ if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8723b1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else { ++ /* halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ halbtc8723b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); ++ if ((coex_sta->high_priority_tx) + ++ (coex_sta->high_priority_rx) <= 60) ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 2); ++ else ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 7); */ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8723b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ ++ } ++ } ++} ++ ++void halbtc8723b1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false, wifi_busy = false; ++ boolean increase_scan_dev_num = false; ++ boolean bt_ctrl_agg_buf_size = false; ++ boolean miracast_plus_bt = false; ++ u8 agg_buf_size = 5; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0, wifi_bw; ++ u8 iot_peer = BTC_IOT_PEER_UNKNOWN; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->bt_whck_test) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under WHCK TEST!!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b1ant_action_bt_whck_test(btcoexist); ++ return; ++ } ++ ++ if ((BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ increase_scan_dev_num = true; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, ++ &increase_scan_dev_num); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if ((num_of_wifi_link >= 2) || ++ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { ++ if (bt_link_info->bt_link_exist) { ++ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, ++ 0, 1); ++ miracast_plus_bt = true; ++ } else { ++ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, ++ 0, 0); ++ miracast_plus_bt = false; ++ } ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (((bt_link_info->a2dp_exist) || (wifi_busy)) && ++ (coex_sta->c2h_bt_inquiry_page)) ++ halbtc8723b1ant_action_bt_inquiry(btcoexist); ++ else ++ halbtc8723b1ant_action_wifi_multi_port(btcoexist); ++ ++ return; ++ } else { ++ miracast_plus_bt = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { ++ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); ++ ++ /* if(BTC_IOT_PEER_CISCO != iot_peer) */ ++ if ((BTC_IOT_PEER_CISCO != iot_peer) && ++ (BTC_IOT_PEER_BROADCOM != iot_peer)) { ++ if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */ ++ /* halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, true, false, 0x5); */ ++ halbtc8723b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, false, 0x5); ++ else ++ halbtc8723b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, false, 0x5); ++ /* halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x8); */ ++ } else { ++ if (bt_link_info->sco_exist) ++ halbtc8723b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, true, false, 0x5); ++ else { ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ halbtc8723b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, true, 0x10); ++ else ++ halbtc8723b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, true, 0x8); ++ } ++ } ++ ++ halbtc8723b1ant_sw_mechanism(btcoexist, true); ++ } else { ++ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ ++ halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x5); ++ ++ halbtc8723b1ant_sw_mechanism(btcoexist, false); ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8723b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8723b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ ++ if (!wifi_connected) { ++ boolean scan = false, link = false, roam = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is non connected-idle !!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8723b1ant_action_wifi_not_connected_scan( ++ btcoexist); ++ else ++ halbtc8723b1ant_action_wifi_not_connected_asso_auth( ++ btcoexist); ++ } else ++ halbtc8723b1ant_action_wifi_not_connected(btcoexist); ++ } else /* wifi LPS/Busy */ ++ halbtc8723b1ant_action_wifi_connected(btcoexist); ++} ++ ++void halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ /* force to reset coex mechanism */ ++ ++ /* sw all off */ ++ halbtc8723b1ant_sw_mechanism(btcoexist, false); ++ ++ /* halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ ++ /* halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ ++ ++ coex_sta->pop_event_cnt = 0; ++} ++ ++void halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean back_up, IN boolean wifi_only) ++{ ++ u32 u32tmp = 0; /* , fw_ver; */ ++ u8 u8tmpa = 0, u8tmpb = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 1Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ psd_scan->ant_det_is_ant_det_available = false; ++ ++ /* 0xf0[15:12] --> Chip Cut information */ ++ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, ++ 0xf1) & 0xf0) >> 4; ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, ++ 0x1); /* enable TBTT nterrupt */ ++ ++ /* 0x790[5:0]=0x5 */ ++ btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); ++ ++ /* Enable counter statistics */ ++ /* btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); //0x76e[3] =1, WLAN_Act control by PTA */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); ++ ++ ++ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, 0x1); //BT select s0/s1 is controlled by WiFi */ ++ ++ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ ++ /* Antenna config */ ++ if (wifi_only) ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, ++ FORCE_EXEC, true, false); ++ else ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++ FORCE_EXEC, true, false); ++ ++ /* PTA parameter */ ++ halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); ++ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", ++ u32tmp, u8tmpa, u8tmpb); ++ BTC_TRACE(trace_buf); ++} ++ ++void halbtc8723b1ant_mechanism_switch(IN struct btc_coexist *btcoexist, ++ IN boolean bSwitchTo2Antenna) ++{ ++ ++ if (bSwitchTo2Antenna) { /* 1-Ant -> 2-Ant */ ++ /* un-lock TRx Mask setup for 8723b f-cut */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, 0x80, 0x1); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, 0x1, 0x1); ++ /* WiFi TRx Mask on */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, ++ 0x0); ++ ++ /* BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1 */ ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x2c, ++ 0x7c45); ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x30, ++ 0x7c45); ++ ++ /* BT TRx Mask on */ ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x1); ++ ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++ FORCE_EXEC, false, false); ++ } else { ++ /* WiFi TRx Mask on */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, ++ 0x780); ++ ++ /* lock TRx Mask setup for 8723b f-cut */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, 0x80, 0x0); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, 0x1, 0x0); ++ ++ /* BT TRx Mask on */ ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); ++ ++ /* BT TRx Mask ock 0x2c[0], 0x30[0] = 0 */ ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x2c, ++ 0x7c44); ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x30, ++ 0x7c44); ++ ++ ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ FORCE_EXEC, false, false); ++ } ++ ++} ++ ++u32 halbtc8723b1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) ++{ ++ u8 j; ++ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; ++ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, ++ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, ++ 32, 23, 15, 7, 0 ++ }; ++ ++ if (val == 0) ++ return 0; ++ ++ tmp = val; ++ ++ while (1) { ++ if (tmp == 1) ++ break; ++ else { ++ tmp = (tmp >> 1); ++ shiftcount++; ++ } ++ } ++ ++ ++ val_integerd_b = shiftcount + 1; ++ ++ tmp2 = 1; ++ for (j = 1; j <= val_integerd_b; j++) ++ tmp2 = tmp2 * 2; ++ ++ tmp = (val * 100) / tmp2; ++ tindex = tmp / 5; ++ ++ if (tindex > 20) ++ tindex = 20; ++ ++ val_fractiond_b = table_fraction[tindex]; ++ ++ result = val_integerd_b * 100 - val_fractiond_b; ++ ++ return result; ++ ++ ++} ++ ++void halbtc8723b1ant_psd_show_antenna_detect_result(IN struct btc_coexist ++ *btcoexist) ++{ ++ u8 *cli_buf = btcoexist->cli_buf; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n============[Antenna Detection info] ============\n"); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->ant_det_result == 1) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", ++ "Ant Det Result", "2-Antenna (Bad-Isolation)", ++ BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ else if (psd_scan->ant_det_result == 2) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "2-Antenna (Good-Isolation)", ++ BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset, ++ BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "1-Antenna", ++ BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT, ++ BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset); ++ ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", ++ "Antenna Detection Finish", ++ (board_info->btdm_ant_det_finish ++ ? "Yes" : "No")); ++ CL_PRINTF(cli_buf); ++ ++ switch (psd_scan->ant_det_result) { ++ case 0: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is not available)"); ++ break; ++ case 1: /* 2-Ant bad-isolation */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 2: /* 2-Ant good-isolation */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 3: /* 1-Ant */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 4: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Uncertainty result)"); ++ break; ++ case 5: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); ++ break; ++ case 6: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(WiFi is Scanning)"); ++ break; ++ case 7: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is not idle)"); ++ break; ++ case 8: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Abort by WiFi Scanning)"); ++ break; ++ case 9: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Antenna Init is not ready)"); ++ break; ++ case 10: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is Inquiry or page)"); ++ break; ++ case 11: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is Disabled)"); ++ break; ++ } ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "Ant Detect Total Count", psd_scan->ant_det_try_count); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "Ant Detect Fail Count", psd_scan->ant_det_fail_count); ++ CL_PRINTF(cli_buf); ++ ++ if ((!board_info->btdm_ant_det_finish) && ++ (psd_scan->ant_det_result != 5)) ++ return; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", ++ (psd_scan->ant_det_result ? "ok" : "fail")); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", ++ psd_scan->ant_det_bt_tx_time); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", ++ psd_scan->ant_det_bt_le_channel); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", ++ "WiFi PSD Cent-Ch/Offset/Span", ++ psd_scan->real_cent_freq, psd_scan->real_offset, ++ psd_scan->real_span); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", ++ "PSD Pre-Scan Peak Value", ++ psd_scan->ant_det_pre_psdscan_peak_val / 100); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", ++ "PSD Pre-Scan result", ++ (psd_scan->ant_det_result != 5 ? "ok" : "fail"), ++ BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->ant_det_result == 5) ++ return; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", ++ "PSD Scan Peak Value", psd_scan->ant_det_peak_val); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", ++ "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", ++ (board_info->tfbga_package) ? "Yes" : "No"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "PSD Threshold Offset", psd_scan->ant_det_thres_offset); ++ CL_PRINTF(cli_buf); ++ ++} ++ ++void halbtc8723b1ant_psd_showdata(IN struct btc_coexist *btcoexist) ++{ ++ u8 *cli_buf = btcoexist->cli_buf; ++ u32 delta_freq_per_point; ++ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n\n============[PSD info] (%d)============\n", ++ psd_scan->psd_gen_count); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->psd_gen_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); ++ CL_PRINTF(cli_buf); ++ return; ++ } ++ ++ if (psd_scan->psd_point == 0) ++ delta_freq_per_point = 0; ++ else ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* if (psd_scan->is_psd_show_max_only) */ ++ if (0) { ++ psd_rep1 = psd_scan->psd_max_value / 100; ++ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; ++ ++ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + ++ psd_scan->psd_max_value_point * delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.0%d MHz", ++ freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.%d MHz", ++ freq1, freq2); ++ ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.0%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ ++ CL_PRINTF(cli_buf); ++ } else { ++ m = psd_scan->psd_start_point; ++ n = psd_scan->psd_start_point; ++ i = 1; ++ j = 1; ++ ++ while (1) { ++ do { ++ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * ++ delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (i == 1) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.000", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.0%2d", freq1, ++ freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.%3d", freq1, ++ freq2); ++ } else if ((i % 8 == 0) || ++ (m == psd_scan->psd_stop_point)) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.000\n", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.0%2d\n", freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.%3d\n", freq1, freq2); ++ } else { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.000", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.0%2d", freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.%3d", freq1, freq2); ++ } ++ ++ i++; ++ m++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); ++ ++ ++ do { ++ psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; ++ psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * ++ 100; ++ ++ if (j == 1) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.0%d", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.%d", psd_rep1, ++ psd_rep2); ++ } else if ((j % 8 == 0) || ++ (n == psd_scan->psd_stop_point)) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.0%d\n", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.%d\n", psd_rep1, psd_rep2); ++ } else { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.0%d", psd_rep1, psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.%d", psd_rep1, psd_rep2); ++ } ++ ++ j++; ++ n++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); ++ ++ if ((m > psd_scan->psd_stop_point) || ++ (n > psd_scan->psd_stop_point)) ++ break; ++ else { ++ i = 1; ++ j = 1; ++ } ++ ++ } ++ } ++ ++ ++} ++ ++void halbtc8723b1ant_psd_max_holddata(IN struct btc_coexist *btcoexist, ++ IN u32 gen_count) ++{ ++ u32 i = 0, i_max = 0, val_max = 0; ++ ++ if (gen_count == 1) { ++ memcpy(psd_scan->psd_report_max_hold, ++ psd_scan->psd_report, ++ BT_8723B_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); ++ ++ psd_scan->psd_max_value_point = 0; ++ psd_scan->psd_max_value = 0; ++ ++ } else { ++ for (i = psd_scan->psd_start_point; ++ i <= psd_scan->psd_stop_point; i++) { ++ if (psd_scan->psd_report[i] > ++ psd_scan->psd_report_max_hold[i]) ++ psd_scan->psd_report_max_hold[i] = ++ psd_scan->psd_report[i]; ++ ++ /* search Max Value */ ++ if (i == psd_scan->psd_start_point) { ++ i_max = i; ++ val_max = psd_scan->psd_report_max_hold[i]; ++ } else { ++ if (psd_scan->psd_report_max_hold[i] > ++ val_max) { ++ i_max = i; ++ val_max = psd_scan->psd_report_max_hold[i]; ++ } ++ } ++ ++ } ++ ++ psd_scan->psd_max_value_point = i_max; ++ psd_scan->psd_max_value = val_max; ++ ++ } ++ ++ ++} ++ ++u32 halbtc8723b1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) ++{ ++ /* reg 0x808[9:0]: FFT data x */ ++ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ ++ /* reg 0x8b4[15:0]: FFT data y report */ ++ ++ u32 val = 0, psd_report = 0; ++ int k = 0; ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ ++ val &= 0xffbffc00; ++ val |= point; ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ val |= 0x00400000; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ while (1) { ++ if (k++ > BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY) ++ break; ++ } ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); ++ ++ psd_report = val & 0x0000ffff; ++ ++ return psd_report; ++} ++ ++ ++boolean halbtc8723b1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, ++ IN u32 avgnum, IN u32 loopcnt) ++{ ++ u32 i, val, n, k = 0, j, point_index = 0; ++ u32 points1 = 0, psd_report = 0; ++ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; ++ u32 psd_center_freq = 20 * 10 ^ 6; ++ boolean outloop = false, scan , roam, is_sweep_ok = true; ++ u8 flag = 0; ++ u32 tmp; ++ u32 wifi_original_channel = 1; ++ ++ psd_scan->is_psd_running = true; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ do { ++ switch (flag) { ++ case 0: /* Get PSD parameters */ ++ default: ++ ++ psd_scan->psd_band_width = 40 * 1000000; ++ psd_scan->psd_point = points; ++ psd_scan->psd_start_base = points / 2; ++ psd_scan->psd_avg_num = avgnum; ++ psd_scan->real_cent_freq = cent_freq; ++ psd_scan->real_offset = offset; ++ psd_scan->real_span = span; ++ ++ ++ points1 = psd_scan->psd_point; ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* PSD point setup */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffff0fff; ++ ++ switch (psd_scan->psd_point) { ++ case 128: ++ val |= 0x0; ++ break; ++ case 256: ++ default: ++ val |= 0x00004000; ++ break; ++ case 512: ++ val |= 0x00008000; ++ break; ++ case 1024: ++ val |= 0x0000c000; ++ break; ++ } ++ ++ switch (psd_scan->psd_avg_num) { ++ case 1: ++ val |= 0x0; ++ break; ++ case 8: ++ val |= 0x00001000; ++ break; ++ case 16: ++ val |= 0x00002000; ++ break; ++ case 32: ++ default: ++ val |= 0x00003000; ++ break; ++ } ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ flag = 1; ++ break; ++ case 1: /* calculate the PSD point index from freq/offset/span */ ++ psd_center_freq = psd_scan->psd_band_width / 2 + ++ offset * (1000000); ++ ++ start_p = psd_scan->psd_start_base + (psd_center_freq - ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_start_point = start_p - ++ psd_scan->psd_start_base; ++ ++ stop_p = psd_scan->psd_start_base + (psd_center_freq + ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_stop_point = stop_p - ++ psd_scan->psd_start_base - 1; ++ ++ flag = 2; ++ break; ++ case 2: /* set RF channel/BW/Mode */ ++ ++ /* set 3-wire off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val |= 0x00300000; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val &= 0xfeffffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* store WiFi original channel */ ++ wifi_original_channel = btcoexist->btc_get_rf_reg( ++ btcoexist, BTC_RF_A, 0x18, 0x3ff); ++ ++ /* Set RF channel */ ++ if (cent_freq == 2484) ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, 0xe); ++ else ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, (cent_freq - 2412) / 5 + ++ 1); /* WiFi TRx Mask on */ ++ ++ ++ /* Set RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, ++ 0xfffff, 0x3e4); ++ ++ /* Set TRx mask off */ ++ /* un-lock TRx Mask setup */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, ++ 0x80, 0x1); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, ++ 0x1, 0x1); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, ++ 0xfffff, 0x0); ++ ++ /* Set RF mode = Rx, RF Gain = 0x8a0 */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, ++ 0xfffff, 0x308a0); ++ ++ while (1) { ++ if (k++ > BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY) ++ break; ++ } ++ flag = 3; ++ break; ++ case 3: ++ psd_scan->psd_gen_count = 0; ++ for (j = 1; j <= loopcnt; j++) { ++ ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || roam) { ++ is_sweep_ok = false; ++ break; ++ } ++ memset(psd_scan->psd_report, 0, ++ psd_scan->psd_point * sizeof(u32)); ++ start_p = psd_scan->psd_start_point + ++ psd_scan->psd_start_base; ++ stop_p = psd_scan->psd_stop_point + ++ psd_scan->psd_start_base + 1; ++ ++ i = start_p; ++ point_index = 0; ++ ++ while (i < stop_p) { ++ if (i >= points1) ++ psd_report = ++ halbtc8723b1ant_psd_getdata( ++ btcoexist, i - points1); ++ else ++ psd_report = ++ halbtc8723b1ant_psd_getdata( ++ btcoexist, i); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Point=%d, psd_raw_data = 0x%08x\n", ++ i, psd_report); ++ BTC_TRACE(trace_buf); ++ if (psd_report == 0) ++ tmp = 0; ++ else ++ /* tmp = 20*log10((double)psd_report); */ ++ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ ++ tmp = 6 * halbtc8723b1ant_psd_log2base( ++ btcoexist, psd_report); ++ ++ n = i - psd_scan->psd_start_base; ++ psd_scan->psd_report[n] = tmp; ++ ++ ++ halbtc8723b1ant_psd_max_holddata( ++ btcoexist, j); ++ ++ i++; ++ ++ } ++ ++ psd_scan->psd_gen_count = j; ++ } ++ ++ flag = 100; ++ break; ++ case 99: /* error */ ++ ++ outloop = true; ++ break; ++ case 100: /* recovery */ ++ ++ /* set 3-wire on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val &= 0xffcfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val |= 0x01000000; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* PSD off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffbfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ /* TRx Mask on */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, ++ 0xfffff, 0x780); ++ ++ /* lock TRx Mask setup */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, ++ 0x80, 0x0); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, ++ 0x1, 0x0); ++ ++ /* Set RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, ++ 0xfffff, 0x0); ++ ++ /* restore WiFi original channel */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, ++ 0x3ff, wifi_original_channel); ++ ++ outloop = true; ++ break; ++ ++ } ++ ++ } while (!outloop); ++ ++ ++ ++ psd_scan->is_psd_running = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); ++ BTC_TRACE(trace_buf); ++ return is_sweep_ok; ++ ++} ++ ++void halbtc8723b1ant_psd_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 bt_tx_time, IN u32 bt_le_channel) ++{ ++ u32 i = 0; ++ u32 wlpsd_cent_freq = 2484, wlpsd_span = 2, wlpsd_sweep_count = 50; ++ s32 wlpsd_offset = -4; ++ u8 bt_le_ch[13] = {3,6,8,11,13,16,18,21,23,26,28,31,33}; ++ ++ u8 h2c_parameter[3] ={0},u8tmpa,u8tmpb; ++ ++ u8 state=0; ++ boolean outloop = false, bt_resp = false; ++ u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, ++ u32tmp; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ board_info->btdm_ant_det_finish = false; ++ memset(psd_scan->ant_det_peak_val, 0, 16*sizeof(u8)); ++ memset(psd_scan->ant_det_peak_freq, 0, 16*sizeof(u8)); ++ ++ if (board_info->tfbga_package) /* for TFBGA */ ++ psd_scan->ant_det_thres_offset = 5; ++ else ++ psd_scan->ant_det_thres_offset = 0; ++ ++ do { ++ switch (state) { ++ case 0: ++ if (bt_le_channel == 39) ++ wlpsd_cent_freq = 2484; ++ else { ++ for (i = 1; i <= 13; i++) { ++ if (bt_le_ch[i - 1] == ++ bt_le_channel) { ++ wlpsd_cent_freq = 2412 ++ + (i - 1) * 5; ++ break; ++ } ++ } ++ ++ if (i == 14) { ++ ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", ++ bt_le_channel); ++ BTC_TRACE(trace_buf); ++ outloop = true; ++ break; ++ } ++ } ++ ++ wlpsd_sweep_count = bt_tx_time * 238 / ++ 100; /* bt_tx_time/0.42 */ ++ wlpsd_sweep_count = wlpsd_sweep_count / 5; ++ ++ if (wlpsd_sweep_count % 5 != 0) ++ wlpsd_sweep_count = (wlpsd_sweep_count / ++ 5 + 1) * 5; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", ++ bt_tx_time, bt_le_channel); ++ BTC_TRACE(trace_buf); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", ++ wlpsd_cent_freq, ++ wlpsd_offset, ++ wlpsd_span, ++ wlpsd_sweep_count); ++ BTC_TRACE(trace_buf); ++ ++ state = 1; ++ break; ++ case 1: /* stop coex DM & set antenna path */ ++ /* Stop Coex DM */ ++ btcoexist->stop_coex_dm = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* set native power save */ ++ halbtc8723b1ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ ++ /* Set TDMA off, */ ++ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, ++ false, 0); ++ ++ /* Set coex table */ ++ halbtc8723b1ant_coex_table_with_type(btcoexist, ++ FORCE_EXEC, 0); ++ ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ /* Set Antenna path, switch WiFi to un-certain antenna port */ ++ halbtc8723b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_BT, FORCE_EXEC, false, ++ false); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ ++ h2c_parameter[0] = 0x1; ++ h2c_parameter[1] = 0xd; ++ h2c_parameter[2] = 0x14; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", ++ h2c_parameter[1], ++ h2c_parameter[2]); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, ++ h2c_parameter); ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, ++ 0x948); ++ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); ++ u8tmpb = btcoexist->btc_read_1byte(btcoexist, ++ 0x778); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x778=0x%x\n", ++ u32tmp, u8tmpa, u8tmpb); ++ BTC_TRACE(trace_buf); ++ ++ state = 2; ++ break; ++ case 2: /* Pre-sweep background psd */ ++ if (!halbtc8723b1ant_psd_sweep_point(btcoexist, ++ wlpsd_cent_freq, wlpsd_offset, wlpsd_span, ++ BT_8723B_1ANT_ANTDET_PSD_POINTS, ++ BT_8723B_1ANT_ANTDET_PSD_AVGNUM, 3)) { ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ psd_scan->ant_det_result = 8; ++ state = 99; ++ break; ++ } ++ ++ psd_scan->ant_det_pre_psdscan_peak_val = ++ psd_scan->psd_max_value; ++ ++ if (psd_scan->psd_max_value > ++ (BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset) * 100) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", ++ psd_scan->psd_max_value / 100, ++ BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ BTC_TRACE(trace_buf); ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ psd_scan->ant_det_result = 5; ++ state = 99; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", ++ psd_scan->psd_max_value / 100, ++ BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ BTC_TRACE(trace_buf); ++ state = 3; ++ } ++ break; ++ case 3: ++ bt_resp = btcoexist->btc_set_bt_ant_detection( ++ btcoexist, (u8)(bt_tx_time & 0xff), ++ (u8)(bt_le_channel & 0xff)); ++ ++ if (!halbtc8723b1ant_psd_sweep_point(btcoexist, ++ wlpsd_cent_freq, wlpsd_offset, ++ wlpsd_span, ++ BT_8723B_1ANT_ANTDET_PSD_POINTS, ++ BT_8723B_1ANT_ANTDET_PSD_AVGNUM, ++ wlpsd_sweep_count)) { ++ board_info->btdm_ant_det_finish ++ = false; ++ board_info->btdm_ant_num_by_ant_det ++ = 1; ++ psd_scan->ant_det_result = 8; ++ state = 99; ++ break; ++ } ++ ++ psd_scan->ant_det_psd_scan_peak_val = ++ psd_scan->psd_max_value; ++ psd_scan->ant_det_psd_scan_peak_freq = ++ psd_scan->psd_max_value_point; ++ state = 4; ++ break; ++ case 4: ++ ++ if (psd_scan->psd_point == 0) ++ delta_freq_per_point = 0; ++ else ++ delta_freq_per_point = ++ psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ psd_rep1 = psd_scan->psd_max_value / 100; ++ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * ++ 100; ++ ++ freq = ((psd_scan->real_cent_freq - 20) * ++ 1000000 + psd_scan->psd_max_value_point ++ * delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (freq2 < 100) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", ++ freq1, freq2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_freq, ++ BT_8723B_1ANT_ANTDET_BUF_LEN, ++ "%d.0%d", freq1, freq2); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", ++ freq1, freq2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_freq, ++ BT_8723B_1ANT_ANTDET_BUF_LEN, ++ "%d.%d", freq1, freq2); ++ } ++ ++ if (psd_rep2 < 10) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.0%d dB\n", ++ psd_rep1, psd_rep2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_val, ++ BT_8723B_1ANT_ANTDET_BUF_LEN, ++ "%d.0%d", psd_rep1, psd_rep2); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.%d dB\n", ++ psd_rep1, psd_rep2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_val, ++ BT_8723B_1ANT_ANTDET_BUF_LEN, ++ "%d.%d", psd_rep1, psd_rep2); ++ } ++ ++ psd_scan->ant_det_is_btreply_available = true; ++ ++ if (bt_resp == false) { ++ psd_scan->ant_det_is_btreply_available = ++ false; ++ psd_scan->ant_det_result = 0; ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->psd_max_value > ++ (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) ++ * 100) { ++ psd_scan->ant_det_result = 1; ++ board_info->btdm_ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 2; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->psd_max_value > ++ (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset) * 100) { ++ psd_scan->ant_det_result = 2; ++ board_info->btdm_ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 2; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->psd_max_value > ++ (BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT) * ++ 100) { ++ psd_scan->ant_det_result = 3; ++ board_info->btdm_ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ psd_scan->ant_det_result = 4; ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ state = 99; ++ break; ++ case 99: /* restore setup */ ++ ++ /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ ++ h2c_parameter[0] = 0x0; ++ h2c_parameter[1] = 0x0; ++ h2c_parameter[2] = 0x0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", ++ h2c_parameter[1], h2c_parameter[2]); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, ++ h2c_parameter); ++ ++ /* Set Antenna Path */ ++ halbtc8723b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_PTA, FORCE_EXEC, false, ++ false); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ /* Resume Coex DM */ ++ btcoexist->stop_coex_dm = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ /* stimulate coex running */ ++ halbtc8723b1ant_run_coexist_mechanism( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ outloop = true; ++ break; ++ } ++ ++ } while (!outloop); ++ ++ ++ ++} ++ ++void halbtc8723b1ant_psd_antenna_detection_check(IN struct btc_coexist ++ *btcoexist) ++{ ++ static u32 ant_det_count = 0, ant_det_fail_count = 0; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ boolean scan, roam; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ ++ /* psd_scan->ant_det_bt_tx_time = 20; */ ++ psd_scan->ant_det_bt_tx_time = ++ BT_8723B_1ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ ++ psd_scan->ant_det_bt_le_channel = BT_8723B_1ANT_ANTDET_BTTXCHANNEL; ++ ++ ant_det_count++; ++ ++ psd_scan->ant_det_try_count = ant_det_count; ++ ++ if (scan || roam) { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 6; ++ } else if (coex_sta->bt_disabled) { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 11; ++ } else if (coex_sta->num_of_profile >= 1) { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 7; ++ } else if ( ++ !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 9; ++ } else if (coex_sta->c2h_bt_inquiry_page) { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 10; ++ } else ++ halbtc8723b1ant_psd_antenna_detection(btcoexist, ++ psd_scan->ant_det_bt_tx_time, ++ psd_scan->ant_det_bt_le_channel); ++ ++ if (!board_info->btdm_ant_det_finish) ++ ant_det_fail_count++; ++ ++ psd_scan->ant_det_fail_count = ant_det_fail_count; ++ ++} ++ ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8723b1ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8723b1ant_ ++ * ************************************************************ */ ++void ex_halbtc8723b1ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 u8tmp=0x0; ++ u16 u16tmp=0x0; ++ u32 value; ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Execute 8723b 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Ant Det Finish = %s, Ant Det Number = %d\n", ++ (board_info->btdm_ant_det_finish ? "Yes" : "No"), ++ board_info->btdm_ant_num_by_ant_det); ++ BTC_TRACE(trace_buf); ++ ++ ++ btcoexist->stop_coex_dm = true; ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x67, 0x20); ++ ++ /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ ++ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); ++ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); ++ ++ /* set GRAN_BT = 1 */ ++ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); ++ /* set WLAN_ACT = 0 */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); ++ ++ /* */ ++ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ ++ /* Local setting bit define */ ++ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ ++ /* BIT1: "0" for internal switch; "1" for external switch */ ++ /* BIT2: "0" for one antenna; "1" for two antenna */ ++ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ ++ if(btcoexist->chip_interface == BTC_INTF_USB) { ++ /* fixed at S0 for USB interface */ ++ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); ++ ++ u8tmp |= 0x1; /* antenna inverse */ ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); ++ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; ++ } else { ++ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ ++ if (board_info->single_ant_path == 0) { ++ /* set to S1 */ ++ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x280); ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; ++ value = 1; ++ } else if (board_info->single_ant_path == 1) { ++ /* set to S0 */ ++ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); ++ u8tmp |= 0x1; /* antenna inverse */ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; ++ value = 0; ++ } ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, ++ &value); ++ ++ if(btcoexist->chip_interface == BTC_INTF_PCI) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x384, ++ u8tmp); ++ else if(btcoexist->chip_interface == BTC_INTF_SDIO) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, ++ u8tmp); ++ } ++} ++ ++void ex_halbtc8723b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) ++{ ++} ++ ++void ex_halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ halbtc8723b1ant_init_hw_config(btcoexist, true, wifi_only); ++ btcoexist->stop_coex_dm = false; ++} ++ ++void ex_halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = false; ++ ++ halbtc8723b1ant_init_coex_dm(btcoexist); ++ ++ halbtc8723b1ant_query_bt_info(btcoexist); ++} ++ ++void ex_halbtc8723b1ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case=0; ++ u16 u16tmp[4]; ++ u32 u32tmp[4]; ++ u32 fa_ofdm, fa_cck; ++ u32 fw_ver=0, bt_patch_ver=0; ++ static u8 pop_report_in_10s = 0; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if(btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ if(btcoexist->stop_coex_dm) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Coex is STOPPED]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ if (psd_scan->ant_det_try_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", ++ "Ant PG Num/ Mech/ Pos", ++ board_info->pg_ant_num, board_info->btdm_ant_num, ++ board_info->btdm_ant_pos); ++ CL_PRINTF(cli_buf); ++ } else { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ %d/ %d (%d/%d/%d)", ++ "Ant PG Num/ Mech(Ant_Det)/ Pos", ++ board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, ++ board_info->btdm_ant_pos, ++ psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, ++ psd_scan->ant_det_result); ++ CL_PRINTF(cli_buf); ++ ++ if (board_info->btdm_ant_det_finish) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "Ant Det PSD Value", ++ psd_scan->ant_det_peak_val); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", ++ "Version Coex/ Fw/ Patch/ Cut", ++ glcoex_ver_date_8723b_1ant, glcoex_ver_8723b_1ant, fw_ver, ++ bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", ++ "WifibHiPri/ Ccklock/ CckEverLock", ++ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), ++ (coex_sta->cck_lock ? "Yes" : "No"), ++ (coex_sta->cck_ever_lock ? "Yes" : "No")); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "BT Abnormal scan", ++ (coex_sta->bt_abnormal_scan) ? "Yes" : "No"); ++ CL_PRINTF(cli_buf); ++ ++ pop_report_in_10s++; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt/ popCnt]", ++ ((coex_sta->bt_disabled)? ("disabled"): (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") ++ : ((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi, coex_sta->bt_retry_cnt, ++ coex_sta->pop_event_cnt); ++ CL_PRINTF(cli_buf); ++ ++ if (pop_report_in_10s >= 5) { ++ coex_sta->pop_event_cnt = 0; ++ pop_report_in_10s = 0; ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d / %d / %d / %d / %d / %d", ++ "SCO/HID/PAN/A2DP/NameReq/WHQL", ++ bt_link_info->sco_exist, bt_link_info->hid_exist, ++ bt_link_info->pan_exist, bt_link_info->a2dp_exist, ++ coex_sta->c2h_bt_remote_name_req, ++ coex_sta->bt_whck_test); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "BT Role", ++ (bt_link_info->slave_role) ? "Slave" : "Master"); ++ CL_PRINTF(cli_buf); ++ ++ bt_info_ext = coex_sta->bt_info_ext; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d", ++ "A2DP Rate/Bitpool", ++ (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool); ++ CL_PRINTF(cli_buf); ++ ++ for (i = 0; i < BT_INFO_SRC_8723B_1ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8723b_1ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ ++ if(btcoexist->manual_control) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms] (before Manual)============"); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "SM[LowPenaltyRA]", ++ coex_dm->cur_low_penalty_ra); ++ CL_PRINTF(cli_buf); ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ if (board_info->btdm_ant_num_by_ant_det == 2) { ++ if (coex_dm->cur_ps_tdma_on) ++ ps_tdma_case = ps_tdma_case + ++ 100; /* for WiFi RSSI low or BT RSSI low */ ++ else ++ ps_tdma_case = ++ 1; /* always translate to TDMA(off,1) for TDMA-off case */ ++ } ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case, ++ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), ++ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); ++ ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "Coex Table Type", ++ coex_sta->coex_table_type); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "IgnWlanAct", ++ coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ ++ /* ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Latest error condition(should be 0)", ++ coex_dm->error_condition); ++ CL_PRINTF(cli_buf); ++ */ ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "backup ARFR1/ARFR2/RL/AMaxTime", ++ coex_dm->backup_arfr_cnt1, coex_dm->backup_arfr_cnt2, ++ coex_dm->backup_retry_limit, ++ coex_dm->backup_ampdu_max_time); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); ++ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "0x430/0x434/0x42a/0x456", ++ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x880); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x778/0x6cc/0x880[29:25]", ++ u8tmp[0], u32tmp[0], (u32tmp[1] & 0x3e000000) >> 25); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x764); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x76e); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x948/ 0x67[5] / 0x764 / 0x76e", ++ u32tmp[0], ((u8tmp[0] & 0x20) >> 5), (u32tmp[1] & 0xffff), ++ u8tmp[1]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x92c); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x930); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x944); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", ++ u32tmp[0] & 0x3, u32tmp[1] & 0xff, u32tmp[2] & 0x3); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x39); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x38[11]/0x40/0x4c[24:23]/0x64[0]", ++ ((u8tmp[0] & 0x8) >> 3), u8tmp[1], ++ ((u32tmp[0] & 0x01800000) >> 23), u8tmp[2] & 0x1); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x550(bcn ctrl)/0x522", ++ u32tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x49c); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0xc50(dig)/0x49c(null-drop)", ++ u32tmp[0] & 0xff, u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); ++ u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); ++ ++ fa_ofdm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) ++ >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + ++ ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & ++ 0xffff) ; ++ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "OFDM-CCA/OFDM-FA/CCK-FA", ++ u32tmp[0] & 0xffff, fa_ofdm, fa_cck); ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_OK CCK/11g/11n/11n-Agg", ++ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, ++ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_Err CCK/11g/11n/11n-Agg", ++ coex_sta->crc_err_cck, coex_sta->crc_err_11g, ++ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8(coexTable)", ++ u32tmp[0], u32tmp[1], u32tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770(high-pri rx/tx)", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(low-pri rx/tx)", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++#if (BT_AUTO_REPORT_ONLY_8723B_1ANT == 1) ++ /* halbtc8723b1ant_monitor_bt_ctr(btcoexist); */ ++#endif ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++void ex_halbtc8723b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if(btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++ FORCE_EXEC, false, true); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723b1ant_init_hw_config(btcoexist, false, false); ++ halbtc8723b1ant_init_coex_dm(btcoexist); ++ halbtc8723b1ant_query_bt_info(btcoexist); ++ ++ coex_sta->under_ips = false; ++ } ++} ++ ++void ex_halbtc8723b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if(btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ } ++} ++ ++void ex_halbtc8723b1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected=false, bt_hs_on=false; ++ u32 wifi_link_status=0; ++ u32 num_of_wifi_link=0; ++ boolean bt_ctrl_agg_buf_size=false; ++ u8 agg_buf_size=5; ++ ++ u8 u8tmpa, u8tmpb; ++ u32 u32tmp; ++ ++ if(btcoexist->manual_control || ++ btcoexist->stop_coex_dm ) ++ return; ++ ++ if (BTC_SCAN_START == type) { ++ coex_sta->wifi_is_high_pri_task = true; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ psd_scan->ant_det_is_ant_det_available = true; ++ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, ++ 8); /* Force antenna setup for no scan result issue */ ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ FORCE_EXEC, false, false); ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); ++ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", ++ u32tmp, u8tmpa, u8tmpb); ++ BTC_TRACE(trace_buf); ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ } ++ ++ if(coex_sta->bt_disabled) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++&wifi_connected); ++ ++ halbtc8723b1ant_query_bt_info(btcoexist); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status>>16; ++ if (num_of_wifi_link >= 2) { ++ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ halbtc8723b1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8723b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8723b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ if (BTC_SCAN_START == type) { ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8723b1ant_action_wifi_not_connected_scan( ++ btcoexist); ++ else /* wifi is connected */ ++ halbtc8723b1ant_action_wifi_connected_scan(btcoexist); ++ } else if (BTC_SCAN_FINISH == type) { ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8723b1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8723b1ant_action_wifi_connected(btcoexist); ++ } ++} ++ ++void ex_halbtc8723b1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected=false, bt_hs_on=false; ++ u32 wifi_link_status=0; ++ u32 num_of_wifi_link=0; ++ boolean bt_ctrl_agg_buf_size=false; ++ u8 agg_buf_size=5; ++ ++ if(btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled ) ++ return; ++ ++ if (BTC_ASSOCIATE_START == type) { ++ coex_sta->wifi_is_high_pri_task = true; ++ psd_scan->ant_det_is_ant_det_available = true; ++ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, ++ 8); /* Force antenna setup for no scan result issue */ ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ FORCE_EXEC, false, false); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->arp_cnt = 0; ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ /* coex_dm->arp_cnt = 0; */ ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ if (num_of_wifi_link >= 2) { ++ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ halbtc8723b1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8723b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8723b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ if (BTC_ASSOCIATE_START == type) ++ halbtc8723b1ant_action_wifi_not_connected_asso_auth(btcoexist); ++ else if (BTC_ASSOCIATE_FINISH == type) { ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8723b1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8723b1ant_action_wifi_connected(btcoexist); ++ } ++} ++ ++void ex_halbtc8723b1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] ={0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ boolean wifi_under_b_mode = false; ++ ++ if(btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled ) ++ return; ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, ++ 8); /* Force antenna setup for no scan result issue */ ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ FORCE_EXEC, false, false); ++ psd_scan->ant_det_is_ant_det_available = true; ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ /* Set CCK Tx/Rx high Pri except 11b mode */ ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x00); /* CCK Rx */ ++ } else { ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x10); /* CCK Rx */ ++ } ++ ++ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, ++ 0x430); ++ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, ++ 0x434); ++ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( ++ btcoexist, 0x42a); ++ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( ++ btcoexist, 0x456); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->arp_cnt = 0; ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ ++ ++ coex_sta->cck_ever_lock = false; ++ } ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ /* h2c_parameter[0] = 0x1; */ ++ h2c_parameter[0] = 0x0; ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); ++} ++ ++void ex_halbtc8723b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean bt_hs_on=false; ++ u32 wifi_link_status=0; ++ u32 num_of_wifi_link=0; ++ boolean bt_ctrl_agg_buf_size=false, under_4way=false; ++ u8 agg_buf_size=5; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if(btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled ) ++ return; ++ ++ if (BTC_PACKET_DHCP == type || ++ BTC_PACKET_EAPOL == type || ++ BTC_PACKET_ARP == type) { ++ if (BTC_PACKET_ARP == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ARP notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_dm->arp_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ARP Packet Count = %d\n", ++ coex_dm->arp_cnt); ++ BTC_TRACE(trace_buf); ++ ++ if ((coex_dm->arp_cnt >= 10) && ++ (!under_4way)) /* if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecificPacket(btcoexist) */ ++ coex_sta->wifi_is_high_pri_task = false; ++ else ++ coex_sta->wifi_is_high_pri_task = true; ++ } else { ++ coex_sta->wifi_is_high_pri_task = true; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet DHCP or EAPOL notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet [Type = %d] notify\n", type); ++ BTC_TRACE(trace_buf); ++ } ++ ++ coex_sta->specific_pkt_period_cnt = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ if (num_of_wifi_link >= 2) { ++ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ halbtc8723b1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8723b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8723b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ if (BTC_PACKET_DHCP == type || ++ BTC_PACKET_EAPOL == type || ++ ((BTC_PACKET_ARP == type) && (coex_sta->wifi_is_high_pri_task))) ++ halbtc8723b1ant_action_wifi_connected_specific_packet(btcoexist); ++} ++ ++void ex_halbtc8723b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 bt_info = 0; ++ u8 i, rsp_source=0; ++ boolean wifi_connected=false; ++ boolean bt_busy=false; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ coex_sta->c2h_bt_info_req_sent = false; ++ ++ rsp_source = tmp_buf[0]&0xf; ++ if(rsp_source >= BT_INFO_SRC_8723B_1ANT_MAX) ++ rsp_source = BT_INFO_SRC_8723B_1ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++"[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, ++length); ++ BTC_TRACE(trace_buf); ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ if (i == 1) ++ bt_info = tmp_buf[i]; ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ /* if 0xff, it means BT is under WHCK test */ ++ if (bt_info == 0xff) ++ coex_sta->bt_whck_test = true; ++ else ++ coex_sta->bt_whck_test = false; ++ ++ if (BT_INFO_SRC_8723B_1ANT_WIFI_FW != rsp_source) { ++ coex_sta->bt_retry_cnt = /* [3:0] */ ++ coex_sta->bt_info_c2h[rsp_source][2]&0xf; ++ ++ if (coex_sta->bt_retry_cnt >= 1) ++ coex_sta->pop_event_cnt++; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][2]&0x20) ++ coex_sta->c2h_bt_remote_name_req = true; ++ else ++ coex_sta->c2h_bt_remote_name_req = false; ++ ++ coex_sta->bt_rssi = ++ coex_sta->bt_info_c2h[rsp_source][3]*2-90; ++ /* coex_sta->bt_info_c2h[rsp_source][3]*2+10; */ ++ ++ coex_sta->bt_info_ext = ++ coex_sta->bt_info_c2h[rsp_source][4]; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][1] == 0x49) { ++ coex_sta->a2dp_bit_pool = ++ coex_sta->bt_info_c2h[rsp_source][6]; ++ } else ++ coex_sta->a2dp_bit_pool = 0; ++ ++ coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] ++ & 0x40); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, ++ &coex_sta->bt_tx_rx_mask); ++ ++#if BT_8723B_1ANT_ANTDET_ENABLE ++#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE ++ if ((board_info->btdm_ant_det_finish) && ++ (board_info->btdm_ant_num_by_ant_det == 2)) { ++ if (coex_sta->bt_tx_rx_mask) { ++ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x1\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1 */ ++ btcoexist->btc_set_bt_reg(btcoexist, ++ BTC_BT_REG_RF, 0x2c, 0x7c45); ++ btcoexist->btc_set_bt_reg(btcoexist, ++ BTC_BT_REG_RF, 0x30, 0x7c45); ++ ++ btcoexist->btc_set_bt_reg(btcoexist, ++ BTC_BT_REG_RF, 0x3c, 0x1); ++ } ++ } else ++#endif ++#endif ++ ++ { ++ if (!coex_sta->bt_tx_rx_mask) { ++ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, ++ 0x3c, 0x15); ++ ++ /* BT TRx Mask lock 0x2c[0], 0x30[0] = 0 */ ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, ++ 0x2c, 0x7c44); ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, ++ 0x30, 0x7c44); ++ } ++ } ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ if (coex_sta->bt_info_ext & BIT(1)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (wifi_connected) ++ ex_halbtc8723b1ant_media_status_notify( ++ btcoexist, BTC_MEDIA_CONNECT); ++ else ++ ex_halbtc8723b1ant_media_status_notify( ++ btcoexist, BTC_MEDIA_DISCONNECT); ++ } ++ ++ if (coex_sta->bt_info_ext & BIT(3)) { ++ if(!btcoexist->manual_control && ++ !btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b1ant_ignore_wlan_act(btcoexist, ++ FORCE_EXEC, false); ++ } ++ } else { ++ /* BT already NOT ignore Wlan active, do nothing here. */ ++ } ++#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 0) ++ if ((coex_sta->bt_info_ext & BIT(4))) { ++ /* BT auto report already enabled, do nothing */ ++ } else ++ halbtc8723b1ant_bt_auto_report(btcoexist, FORCE_EXEC, ++ true); ++#endif ++ } ++ ++ /* check BIT2 first ==> check if bt is under inquiry or page scan */ ++ if (bt_info & BT_INFO_8723B_1ANT_B_INQ_PAGE) ++ coex_sta->c2h_bt_inquiry_page = true; ++ else ++ coex_sta->c2h_bt_inquiry_page = false; ++ ++ coex_sta->num_of_profile = 0; ++ ++ /* set link exist status */ ++ if (!(bt_info & BT_INFO_8723B_1ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ ++ coex_sta->bt_hi_pri_link_exist = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (bt_info & BT_INFO_8723B_1ANT_B_FTP) { ++ coex_sta->pan_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->pan_exist = false; ++ if (bt_info & BT_INFO_8723B_1ANT_B_A2DP) { ++ coex_sta->a2dp_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->a2dp_exist = false; ++ if (bt_info & BT_INFO_8723B_1ANT_B_HID) { ++ coex_sta->hid_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->hid_exist = false; ++ if (bt_info & BT_INFO_8723B_1ANT_B_SCO_ESCO) { ++ coex_sta->sco_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->sco_exist = false; ++ ++ if ((coex_sta->hid_exist == false) && ++ (coex_sta->c2h_bt_inquiry_page == false) && ++ (coex_sta->sco_exist == false)) { ++ if (coex_sta->high_priority_tx + ++ coex_sta->high_priority_rx >= 160) { ++ coex_sta->hid_exist = true; ++ coex_sta->wrong_profile_notification++; ++ coex_sta->num_of_profile++; ++ bt_info = bt_info | 0x28; ++ } ++ } ++ ++ /* Add Hi-Pri Tx/Rx counter to avoid false detection */ ++ if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) && ++ (coex_sta->high_priority_tx + ++ coex_sta->high_priority_rx >= 160) ++ && (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->bt_hi_pri_link_exist = true; ++ ++ if ((bt_info & BT_INFO_8723B_1ANT_B_ACL_BUSY) && ++ (coex_sta->num_of_profile == 0)) { ++ if (coex_sta->low_priority_tx + ++ coex_sta->low_priority_rx >= 160) { ++ coex_sta->pan_exist = true; ++ coex_sta->num_of_profile++; ++ coex_sta->wrong_profile_notification++; ++ bt_info = bt_info | 0x88; ++ } ++ } ++ } ++ ++ halbtc8723b1ant_update_bt_link_info(btcoexist); ++ ++ bt_info = bt_info & ++ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ ++ ++ if (!(bt_info & BT_INFO_8723B_1ANT_B_CONNECTION)) ++ coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ else if (bt_info == ++ BT_INFO_8723B_1ANT_B_CONNECTION) /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE; ++ else if ((bt_info & BT_INFO_8723B_1ANT_B_SCO_ESCO) || ++ (bt_info & BT_INFO_8723B_1ANT_B_SCO_BUSY)) ++ coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_SCO_BUSY; ++ else if (bt_info & BT_INFO_8723B_1ANT_B_ACL_BUSY) { ++ if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) ++ coex_dm->auto_tdma_adjust = false; ++ coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_ACL_BUSY; ++ } else ++ coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_MAX; ++ ++ if( (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status) ) ++ bt_busy = true; ++ else ++ bt_busy = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ halbtc8723b1ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8723b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u32 u32tmp; ++ u8 u8tmpa,u8tmpb, u8tmpc; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_RF_ON == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned ON!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->stop_coex_dm = false; ++ } else if (BTC_RF_OFF == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned OFF!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++0x0, 0x0); ++ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++FORCE_EXEC, false, true); ++ ++ halbtc8723b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ btcoexist->stop_coex_dm = true; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); ++ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ u8tmpc = btcoexist->btc_read_1byte(btcoexist, 0x76e); ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x, 0x76e=0x%x\n", ++ u32tmp, u8tmpa, u8tmpb, u8tmpc); ++ BTC_TRACE(trace_buf); ++ ++ } ++} ++ ++void ex_halbtc8723b1ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, ++ false, true); ++ ++ halbtc8723b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ++ ex_halbtc8723b1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++ ++ btcoexist->stop_coex_dm = true; ++} ++ ++void ex_halbtc8723b1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ if (BTC_WIFI_PNP_SLEEP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++ FORCE_EXEC, false, true); ++ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ ++ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ ++ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ ++ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ ++ coex_sta->under_ips = false; ++ coex_sta->under_lps = false; ++ btcoexist->stop_coex_dm = true; ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->stop_coex_dm = false; ++ halbtc8723b1ant_init_hw_config(btcoexist, false, false); ++ halbtc8723b1ant_init_coex_dm(btcoexist); ++ halbtc8723b1ant_query_bt_info(btcoexist); ++ } ++} ++ ++void ex_halbtc8723b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) ++{ ++ ++ halbtc8723b1ant_init_hw_config(btcoexist, false, false); ++ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ ++ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x2, 0xfffff, 0x0); */ ++ halbtc8723b1ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8723b1ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ==========================Periodical===========================\n"); ++ BTC_TRACE(trace_buf); ++ ++#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 0) ++ halbtc8723b1ant_query_bt_info(btcoexist); ++ halbtc8723b1ant_monitor_bt_enable_disable(btcoexist); ++#else ++ halbtc8723b1ant_monitor_bt_ctr(btcoexist); ++ halbtc8723b1ant_monitor_wifi_ctr(btcoexist); ++#if BT_8723B_1ANT_ANTDET_ENABLE ++ halbtc8723b1ant_monitor_bt_enable_disable(btcoexist); ++#endif ++ ++ if ((coex_sta->high_priority_tx + coex_sta->high_priority_rx < 50) && ++ (bt_link_info->hid_exist == true)) ++ bt_link_info->hid_exist = false; ++ ++ if( halbtc8723b1ant_is_wifi_status_changed(btcoexist) || ++ coex_dm->auto_tdma_adjust ) ++ halbtc8723b1ant_run_coexist_mechanism(btcoexist); ++ ++ coex_sta->specific_pkt_period_cnt++; ++ ++ /* sample to set bt to execute Ant detection */ ++ /* btcoexist->btc_set_bt_ant_detection(btcoexist, 20, 14); ++ * ++ if (psd_scan->is_ant_det_enable) ++ { ++ if (psd_scan->psd_gen_count > psd_scan->realseconds) ++ psd_scan->psd_gen_count = 0; ++ ++ halbtc8723b1ant_antenna_detection(btcoexist, psd_scan->realcent_freq, psd_scan->realoffset, psd_scan->realspan, psd_scan->realseconds); ++ psd_scan->psd_gen_total_count +=2; ++ psd_scan->psd_gen_count += 2; ++ } ++ */ ++#endif ++} ++ ++void ex_halbtc8723b1ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++#if BT_8723B_1ANT_ANTDET_ENABLE ++ static u32 ant_det_count = 0, ant_det_fail_count = 0; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ /*boolean scan, roam;*/ ++ ++ if (seconds == 0) { ++ psd_scan->ant_det_try_count = 0; ++ psd_scan->ant_det_fail_count = 0; ++ ant_det_count = 0; ++ ant_det_fail_count = 0; ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ return; ++ } ++ ++ if (!board_info->btdm_ant_det_finish) { ++ psd_scan->ant_det_inteval_count = ++ psd_scan->ant_det_inteval_count + 2; ++ ++ if (psd_scan->ant_det_inteval_count >= ++ BT_8723B_1ANT_ANTDET_RETRY_INTERVAL) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b1ant_psd_antenna_detection_check(btcoexist); ++ ++ if (board_info->btdm_ant_det_finish) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); ++ BTC_TRACE(trace_buf); ++#if 1 ++ if (board_info->btdm_ant_num_by_ant_det == 2) ++ halbtc8723b1ant_mechanism_switch( ++ btcoexist, true); ++ else ++ halbtc8723b1ant_mechanism_switch( ++ btcoexist, false); ++#endif ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ psd_scan->ant_det_inteval_count = 0; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", ++ psd_scan->ant_det_inteval_count); ++ BTC_TRACE(trace_buf); ++ } ++ ++ } ++#endif ++ ++ ++/* ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ ++ psd_scan->ant_det_bt_tx_time = seconds; ++ psd_scan->ant_det_bt_le_channel = cent_freq; ++ ++ if (seconds == 0) ++ { ++ psd_scan->ant_det_try_count = 0; ++ psd_scan->ant_det_fail_count = 0; ++ ant_det_count = 0; ++ ant_det_fail_count = 0; ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ return; ++ } ++ else ++ { ++ ant_det_count++; ++ ++ psd_scan->ant_det_try_count = ant_det_count; ++ ++ if (scan ||roam) ++ { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 6; ++ } ++ else if (coex_sta->num_of_profile >= 1) ++ { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 7; ++ } ++ else if (!psd_scan->ant_det_is_ant_det_available) ++ { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 9; ++ } ++ else if (coex_sta->c2h_bt_inquiry_page) ++ { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 10; ++ } ++ else ++ { ++ ++ } ++ ++ if (!board_info->btdm_ant_det_finish) ++ ant_det_fail_count++; ++ ++ psd_scan->ant_det_fail_count = ant_det_fail_count; ++ } ++*/ ++} ++ ++ ++void ex_halbtc8723b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) ++{ ++#if BT_8723B_1ANT_ANTDET_ENABLE ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ if (psd_scan->ant_det_try_count != 0) { ++ halbtc8723b1ant_psd_show_antenna_detect_result(btcoexist); ++ ++ if (board_info->btdm_ant_det_finish) ++ halbtc8723b1ant_psd_showdata(btcoexist); ++ return; ++ } ++#endif ++ ++ /* halbtc8723b1ant_show_psd_data(btcoexist); */ ++} ++ ++#endif ++ ++#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.h 2018-02-11 21:44:27.146146071 +0200 +@@ -0,0 +1,288 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8723B_SUPPORT == 1) ++/* ******************************************* ++ * The following is for 8723B 1ANT BT Co-exist definition ++ * ******************************************* */ ++#define BT_AUTO_REPORT_ONLY_8723B_1ANT 1 ++ ++#define BT_INFO_8723B_1ANT_B_FTP BIT(7) ++#define BT_INFO_8723B_1ANT_B_A2DP BIT(6) ++#define BT_INFO_8723B_1ANT_B_HID BIT(5) ++#define BT_INFO_8723B_1ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8723B_1ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8723B_1ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8723B_1ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8723B_1ANT_B_CONNECTION BIT(0) ++ ++#define BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ ++ (((_BT_INFO_EXT_&BIT(0))) ? true : false) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT 2 ++ ++#define BT_8723B_1ANT_WIFI_NOISY_THRESH 50 /* 30 //max: 255 */ ++ ++/* for Antenna detection */ ++#define BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 ++#define BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 ++#define BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 ++#define BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT 32 ++#define BT_8723B_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ ++#define BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY 40000 ++#define BT_8723B_1ANT_ANTDET_ENABLE 1 ++#define BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 1 ++#define BT_8723B_1ANT_ANTDET_BTTXTIME 100 ++#define BT_8723B_1ANT_ANTDET_BTTXCHANNEL 39 ++ ++enum bt_info_src_8723b_1ant { ++ BT_INFO_SRC_8723B_1ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8723B_1ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8723B_1ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8723B_1ANT_MAX ++}; ++ ++enum bt_8723b_1ant_bt_status { ++ BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8723B_1ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8723B_1ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8723B_1ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8723B_1ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8723b_1ant_wifi_status { ++ BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, ++ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, ++ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, ++ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, ++ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, ++ BT_8723B_1ANT_WIFI_STATUS_MAX ++}; ++ ++enum bt_8723b_1ant_coex_algo { ++ BT_8723B_1ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8723B_1ANT_COEX_ALGO_SCO = 0x1, ++ BT_8723B_1ANT_COEX_ALGO_HID = 0x2, ++ BT_8723B_1ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, ++ BT_8723B_1ANT_COEX_ALGO_PANEDR = 0x5, ++ BT_8723B_1ANT_COEX_ALGO_PANHS = 0x6, ++ BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, ++ BT_8723B_1ANT_COEX_ALGO_PANEDR_HID = 0x8, ++ BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, ++ BT_8723B_1ANT_COEX_ALGO_HID_A2DP = 0xa, ++ BT_8723B_1ANT_COEX_ALGO_MAX = 0xb, ++}; ++ ++struct coex_dm_8723b_1ant { ++ /* hw setting */ ++ u8 pre_ant_pos_type; ++ u8 cur_ant_pos_type; ++ /* fw mechanism */ ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean auto_tdma_adjust; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++ ++ /* sw mechanism */ ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ ++ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ ++ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ ++ u16 backup_retry_limit; ++ u8 backup_ampdu_max_time; ++ ++ /* algorithm related */ ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ u32 pre_ra_mask; ++ u32 cur_ra_mask; ++ u8 pre_arfr_type; ++ u8 cur_arfr_type; ++ u8 pre_retry_limit_type; ++ u8 cur_retry_limit_type; ++ u8 pre_ampdu_time_type; ++ u8 cur_ampdu_time_type; ++ u32 arp_cnt; ++ ++ u8 error_condition; ++}; ++ ++struct coex_sta_8723b_1ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ boolean bt_hi_pri_link_exist; ++ u8 num_of_profile; ++ boolean bt_abnormal_scan; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 specific_pkt_period_cnt; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ s8 bt_rssi; ++ boolean bt_tx_rx_mask; ++ boolean c2h_bt_info_req_sent; ++ u8 bt_info_c2h[BT_INFO_SRC_8723B_1ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8723B_1ANT_MAX]; ++ boolean bt_whck_test; ++ boolean c2h_bt_inquiry_page; ++ boolean c2h_bt_remote_name_req; ++ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++ u32 pop_event_cnt; ++ u8 scan_ap_num; ++ ++ u32 crc_ok_cck; ++ u32 crc_ok_11g; ++ u32 crc_ok_11n; ++ u32 crc_ok_11n_agg; ++ ++ u32 crc_err_cck; ++ u32 crc_err_11g; ++ u32 crc_err_11n; ++ u32 crc_err_11n_agg; ++ ++ boolean cck_lock; ++ boolean pre_ccklock; ++ boolean cck_ever_lock; ++ u8 coex_table_type; ++ ++ boolean force_lps_on; ++ u32 wrong_profile_notification; ++ ++ u8 a2dp_bit_pool; ++ u8 cut_version; ++}; ++ ++#define BT_8723B_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ ++#define BT_8723B_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ ++#define BT_8723B_1ANT_ANTDET_BUF_LEN 16 ++ ++struct psdscan_sta_8723b_1ant { ++ ++ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ ++ u32 ant_det_bt_tx_time; ++ u32 ant_det_pre_psdscan_peak_val; ++ boolean ant_det_is_ant_det_available; ++ u32 ant_det_psd_scan_peak_val; ++ boolean ant_det_is_btreply_available; ++ u32 ant_det_psd_scan_peak_freq; ++ ++ u8 ant_det_result; ++ u8 ant_det_peak_val[BT_8723B_1ANT_ANTDET_BUF_LEN]; ++ u8 ant_det_peak_freq[BT_8723B_1ANT_ANTDET_BUF_LEN]; ++ u32 ant_det_try_count; ++ u32 ant_det_fail_count; ++ u32 ant_det_inteval_count; ++ u32 ant_det_thres_offset; ++ ++ u32 real_cent_freq; ++ s32 real_offset; ++ u32 real_span; ++ ++ u32 psd_band_width; /* unit: Hz */ ++ u32 psd_point; /* 128/256/512/1024 */ ++ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_start_point; ++ u32 psd_stop_point; ++ u32 psd_max_value_point; ++ u32 psd_max_value; ++ u32 psd_start_base; ++ u32 psd_avg_num; /* 1/8/16/32 */ ++ u32 psd_gen_count; ++ boolean is_psd_running; ++ boolean is_psd_show_max_only; ++}; ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8723b1ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723b1ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723b1ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723b1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723b1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723b1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8723b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723b1ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723b1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state); ++void ex_halbtc8723b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723b1ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723b1ant_display_coex_info(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723b1ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++ ++void ex_halbtc8723b1ant_display_ant_detection(IN struct btc_coexist *btcoexist); ++ ++#else ++#define ex_halbtc8723b1ant_power_on_setting(btcoexist) ++#define ex_halbtc8723b1ant_pre_load_firmware(btcoexist) ++#define ex_halbtc8723b1ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8723b1ant_init_coex_dm(btcoexist) ++#define ex_halbtc8723b1ant_ips_notify(btcoexist, type) ++#define ex_halbtc8723b1ant_lps_notify(btcoexist, type) ++#define ex_halbtc8723b1ant_scan_notify(btcoexist, type) ++#define ex_halbtc8723b1ant_connect_notify(btcoexist, type) ++#define ex_halbtc8723b1ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8723b1ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8723b1ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8723b1ant_rf_status_notify(btcoexist, type) ++#define ex_halbtc8723b1ant_halt_notify(btcoexist) ++#define ex_halbtc8723b1ant_pnp_notify(btcoexist, pnp_state) ++#define ex_halbtc8723b1ant_coex_dm_reset(btcoexist) ++#define ex_halbtc8723b1ant_periodical(btcoexist) ++#define ex_halbtc8723b1ant_display_coex_info(btcoexist) ++#define ex_halbtc8723b1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) ++#define ex_halbtc8723b1ant_display_ant_detection(btcoexist) ++ ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.c 2018-02-11 21:44:27.146146071 +0200 +@@ -0,0 +1,4920 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8723B Co-exist mechanism ++ * ++ * History ++ * 2012/11/15 Cosa first check in. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8723B_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8723b_2ant glcoex_dm_8723b_2ant; ++static struct coex_dm_8723b_2ant *coex_dm = &glcoex_dm_8723b_2ant; ++static struct coex_sta_8723b_2ant glcoex_sta_8723b_2ant; ++static struct coex_sta_8723b_2ant *coex_sta = &glcoex_sta_8723b_2ant; ++ ++const char *const glbt_info_src_8723b_2ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++u32 glcoex_ver_date_8723b_2ant = 20151223; ++u32 glcoex_ver_8723b_2ant = 0x4a; ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8723b2ant_ ++ * ************************************************************ */ ++u8 halbtc8723b2ant_bt_rssi_state(u8 *ppre_bt_rssi_state, u8 level_num, ++ u8 rssi_thresh, u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = *ppre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return *ppre_bt_rssi_state; ++ } ++ ++ if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || ++ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ *ppre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8723b2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 *pprewifi_rssi_state, IN u8 level_num, IN u8 rssi_thresh, ++ IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = *pprewifi_rssi_state; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || ++ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return *pprewifi_rssi_state; ++ } ++ ++ if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || ++ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((*pprewifi_rssi_state == BTC_RSSI_STATE_MEDIUM) || ++ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ *pprewifi_rssi_state = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8723b2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ ++ /* This function check if bt is disabled */ ++ ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ } else { ++ bt_disable_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], bt all counters=0, %d times!!\n", ++ bt_disable_cnt); ++ BTC_TRACE(trace_buf); ++ if (bt_disable_cnt >= 2) ++ bt_disabled = true; ++ } ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->bt_disabled = bt_disabled; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ if (bt_disabled) { ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ } ++ } ++} ++ ++ ++void halbtc8723b2ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++} ++ ++void halbtc8723b2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ if ((coex_sta->low_priority_tx > 1050) && ++ (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->pop_event_cnt++; ++ ++ if ((coex_sta->low_priority_rx >= 950) && ++ (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) && ++ (!coex_sta->under_ips)) ++ bt_link_info->slave_role = true; ++ else ++ bt_link_info->slave_role = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ reg_hp_txrx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx); ++ BTC_TRACE(trace_buf); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ reg_lp_txrx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx); ++ BTC_TRACE(trace_buf); ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++} ++ ++void halbtc8723b2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) ++{ ++ ++ ++ if (coex_sta->under_ips) { ++ coex_sta->crc_ok_cck = 0; ++ coex_sta->crc_ok_11g = 0; ++ coex_sta->crc_ok_11n = 0; ++ coex_sta->crc_ok_11n_agg = 0; ++ ++ coex_sta->crc_err_cck = 0; ++ coex_sta->crc_err_11g = 0; ++ coex_sta->crc_err_11n = 0; ++ coex_sta->crc_err_11n_agg = 0; ++ } else { ++ coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, ++ 0xf88); ++ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf94); ++ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf90); ++ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xfb8); ++ ++ coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, ++ 0xf84); ++ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf96); ++ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf92); ++ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xfba); ++ } ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); ++} ++ ++void halbtc8723b2ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ coex_sta->c2h_bt_info_req_sent = true; ++ ++ h2c_parameter[0] |= BIT(0); /* trigger */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); ++} ++ ++boolean halbtc8723b2ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) ++{ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false; ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ ++ ++ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ ++ if ((BTC_RSSI_STATE_HIGH == wifi_rssi_state) || ++ (BTC_RSSI_STATE_LOW == wifi_rssi_state)) ++ return true; ++ ++ } ++ ++ return false; ++} ++ ++void halbtc8723b2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if (bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if (!bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++} ++ ++u8 halbtc8723b2ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8723B_2ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (!bt_link_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No BT link exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (bt_link_info->sco_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->hid_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->pan_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 1) { ++ if (bt_link_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723B_2ANT_COEX_ALGO_SCO; ++ } else { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723B_2ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723B_2ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723B_2ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_HID_A2DP; ++ } ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723B_2ANT_COEX_ALGO_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++void halbtc8723b2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, ++ IN u8 dac_swing_lvl) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ /* There are several type of dacswing */ ++ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ ++ h2c_parameter[0] = dac_swing_lvl; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); ++} ++ ++void halbtc8723b2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN u8 dec_bt_pwr_lvl) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = dec_bt_pwr_lvl; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); ++} ++ ++void halbtc8723b2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 dec_bt_pwr_lvl) ++{ ++ coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) ++ return; ++ } ++ halbtc8723b2ant_set_fw_dec_bt_pwr(btcoexist, ++ coex_dm->cur_bt_dec_pwr_lvl); ++ ++ coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; ++} ++ ++void halbtc8723b2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8723b2ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ halbtc8723b2ant_set_bt_auto_report(btcoexist, ++ coex_dm->cur_bt_auto_report); ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++void halbtc8723b2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 fw_dac_swing_lvl) ++{ ++ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_fw_dac_swing_lvl == ++ coex_dm->cur_fw_dac_swing_lvl) ++ return; ++ } ++ ++ halbtc8723b2ant_set_fw_dac_swing_level(btcoexist, ++ coex_dm->cur_fw_dac_swing_lvl); ++ ++ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; ++} ++ ++void halbtc8723b2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist *btcoexist, ++ IN boolean rx_rf_shrink_on) ++{ ++ if (rx_rf_shrink_on) { ++ /* Shrink RF Rx LPF corner */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Shrink RF Rx LPF corner!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff, ++ 0xffffc); ++ } else { ++ /* Resume RF Rx LPF corner */ ++ /* After initialized, we can use coex_dm->bt_rf_0x1e_backup */ ++ if (btcoexist->initilized) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Resume RF Rx LPF corner!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, ++ 0xfffff, coex_dm->bt_rf_0x1e_backup); ++ } ++ } ++} ++ ++void halbtc8723b2ant_rf_shrink(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rx_rf_shrink_on) ++{ ++ coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_rf_rx_lpf_shrink == ++ coex_dm->cur_rf_rx_lpf_shrink) ++ return; ++ } ++ halbtc8723b2ant_set_sw_rf_rx_lpf_corner(btcoexist, ++ coex_dm->cur_rf_rx_lpf_shrink); ++ ++ coex_dm->pre_rf_rx_lpf_shrink = coex_dm->cur_rf_rx_lpf_shrink; ++} ++ ++void halbtc8723b2ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ ++ ++ if (low_penalty_ra) { ++ h2c_parameter[1] |= BIT(0); ++ h2c_parameter[2] = ++ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ ++ h2c_parameter[3] = 0xf4; /* MCS7 or OFDM54 */ ++ h2c_parameter[4] = 0xf5; /* MCS6 or OFDM48 */ ++ h2c_parameter[5] = 0xf6; /* MCS5 or OFDM36 */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); ++} ++ ++void halbtc8723b2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ halbtc8723b2ant_set_sw_penalty_tx_rate_adaptive(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++} ++ ++void halbtc8723b2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, ++ IN u32 level) ++{ ++ u8 val = (u8)level; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Write SwDacSwing = 0x%x\n", level); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x883, 0x3e, val); ++} ++ ++void halbtc8723b2ant_set_sw_full_time_dac_swing(IN struct btc_coexist ++ *btcoexist, IN boolean sw_dac_swing_on, IN u32 sw_dac_swing_lvl) ++{ ++ if (sw_dac_swing_on) ++ halbtc8723b2ant_set_dac_swing_reg(btcoexist, sw_dac_swing_lvl); ++ else ++ halbtc8723b2ant_set_dac_swing_reg(btcoexist, 0x18); ++} ++ ++ ++void halbtc8723b2ant_dac_swing(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) ++{ ++ coex_dm->cur_dac_swing_on = dac_swing_on; ++ coex_dm->cur_dac_swing_lvl = dac_swing_lvl; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_dac_swing_on == coex_dm->cur_dac_swing_on) && ++ (coex_dm->pre_dac_swing_lvl == ++ coex_dm->cur_dac_swing_lvl)) ++ return; ++ } ++ delay_ms(30); ++ halbtc8723b2ant_set_sw_full_time_dac_swing(btcoexist, dac_swing_on, ++ dac_swing_lvl); ++ ++ coex_dm->pre_dac_swing_on = coex_dm->cur_dac_swing_on; ++ coex_dm->pre_dac_swing_lvl = coex_dm->cur_dac_swing_lvl; ++} ++ ++void halbtc8723b2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, ++ IN boolean adc_back_off) ++{ ++ if (adc_back_off) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB BackOff Level On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc05, 0x30, 0x3); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB BackOff Level Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc05, 0x30, 0x1); ++ } ++} ++ ++void halbtc8723b2ant_adc_back_off(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean adc_back_off) ++{ ++ coex_dm->cur_adc_back_off = adc_back_off; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) ++ return; ++ } ++ halbtc8723b2ant_set_adc_back_off(btcoexist, coex_dm->cur_adc_back_off); ++ ++ coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; ++} ++ ++void halbtc8723b2ant_set_agc_table(IN struct btc_coexist *btcoexist, ++ IN boolean agc_table_en) ++{ ++ u8 rssi_adjust_val = 0; ++ ++ /* =================BB AGC Gain Table */ ++ if (agc_table_en) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB Agc Table On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6e1A0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6d1B0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6c1C0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6b1D0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6a1E0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x691F0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x68200001); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB Agc Table Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xaa1A0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa91B0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa81C0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa71D0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa61E0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa51F0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa4200001); ++ } ++ ++ ++ /* =================RF Gain */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); ++ if (agc_table_en) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Agc Table On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x38fff); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x38ffe); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Agc Table Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x380c3); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x28ce6); ++ } ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xed, 0xfffff, 0x1); ++ if (agc_table_en) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Agc Table On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, ++ 0x38fff); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, ++ 0x38ffe); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Agc Table Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, ++ 0x380c3); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, ++ 0x28ce6); ++ } ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xed, 0xfffff, 0x0); ++ ++ /* set rssi_adjust_val for wifi module. */ ++ if (agc_table_en) ++ rssi_adjust_val = 8; ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, ++ &rssi_adjust_val); ++} ++ ++void halbtc8723b2ant_agc_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean agc_table_en) ++{ ++ coex_dm->cur_agc_table_en = agc_table_en; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) ++ return; ++ } ++ halbtc8723b2ant_set_agc_table(btcoexist, agc_table_en); ++ ++ coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; ++} ++ ++void halbtc8723b2ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8723b2ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ halbtc8723b2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8723b2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_sta->coex_table_type = type; ++ ++ switch (type) { ++ case 0: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x55555555, 0xffffff, 0x3); ++ break; ++ case 1: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5afa5afa, 0xffffff, 0x3); ++ break; ++ case 2: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x5ada5ada, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 3: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ case 4: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0xffffffff, 0xffffffff, 0xffffff, 0x3); ++ break; ++ case 5: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x5fff5fff, 0x5fff5fff, 0xffffff, 0x3); ++ break; ++ case 6: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x55ff55ff, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 7: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 8: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 9: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 10: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 11: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 12: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 13: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ case 14: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 15: ++ halbtc8723b2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8723b2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ if (enable) { ++ h2c_parameter[0] |= BIT(0); /* function enable */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); ++} ++ ++void halbtc8723b2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8723b2ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8723b2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8723b2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ halbtc8723b2ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8723b2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ ++ ++ if ((coex_sta->a2dp_exist) && (coex_sta->hid_exist)) ++ byte5 = byte5 | 0x1; ++ ++ h2c_parameter[0] = byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = byte5; ++ ++ coex_dm->ps_tdma_para[0] = byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++void halbtc8723b2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, ++ IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, ++ IN boolean limited_dig, IN boolean bt_lna_constrain) ++{ ++ /* ++ u32 wifi_bw; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if(BTC_WIFI_BW_HT40 != wifi_bw) ++ { ++ if (shrink_rx_lpf) ++ shrink_rx_lpf = false; ++ } ++ */ ++ ++ /* halbtc8723b2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); */ ++ halbtc8723b2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); ++} ++ ++void halbtc8723b2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, ++ IN boolean agc_table_shift, IN boolean adc_back_off, ++ IN boolean sw_dac_swing, IN u32 dac_swing_lvl) ++{ ++ /* halbtc8723b2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ ++ /* halbtc8723b2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */ ++ /* halbtc8723b2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, dac_swing_lvl); */ ++} ++ ++void halbtc8723b2ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ PADAPTER pAdapter = btcoexist->Adapter; ++ u32 fw_ver = 0, u32tmp = 0, cnt_bt_cal_chk = 0; ++ boolean pg_ext_switch = false; ++ boolean use_ext_switch = false; ++ u8 h2c_parameter[2] = {0}; ++ u32 u32tmp_1[4]; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_EXT_SWITCH, &pg_ext_switch); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, ++ &fw_ver); /* [31:16]=fw ver, [15:0]=fw sub ver */ ++ ++ if ((fw_ver > 0 && fw_ver < 0xc0000) || pg_ext_switch) ++ use_ext_switch = true; ++ ++ if (init_hwcfg) { ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x39, 0x8, 0x1); ++ btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x944, 0x3, 0x3); ++ btcoexist->btc_write_1byte(btcoexist, 0x930, 0x77); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, 0x1); ++ ++ if (fw_ver >= 0x180000) { ++ /* Use H2C to set GNT_BT to High to avoid A2DP click */ ++ h2c_parameter[0] = 1; ++ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, ++ h2c_parameter); ++ ++ cnt_bt_cal_chk = 0; ++ while(1) ++ { ++ if( pAdapter->bFWReady == FALSE ) ++ { ++ //RT_TRACE(COMP_INIT , DBG_LOUD, ("halbtc8723b2ant_SetAntPath(): we don't need to wait for H2C command completion because of Fw download fail!!!\n")); ++ break; ++ } ++ ++ if( btcoexist->btc_read_1byte(btcoexist, 0x765) == 0x18 ) ++ break; ++ ++ cnt_bt_cal_chk++; ++ if( cnt_bt_cal_chk > 20 ) ++ break; ++ } ++ } else ++ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); ++ u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ if( (u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) ++ btcoexist->btc_write_4byte(btcoexist, 0x948, u32tmp_1[0]); ++ else ++ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, ++ 0x0); /* WiFi TRx Mask off */ ++ /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ ++ /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x01); //BT TRx Mask off */ ++ ++ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { ++ /* tell firmware "no antenna inverse" */ ++ h2c_parameter[0] = 0; ++ } else { ++ /* tell firmware "antenna inverse" */ ++ h2c_parameter[0] = 1; ++ } ++ ++ if (use_ext_switch) { ++ /* ext switch type */ ++ h2c_parameter[1] = 1; ++ } else { ++ /* int switch type */ ++ h2c_parameter[1] = 0; ++ } ++ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, h2c_parameter); ++ } else { ++ if (fw_ver >= 0x180000) { ++ /* Use H2C to set GNT_BT to "Control by PTA"*/ ++ h2c_parameter[0] = 0; ++ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, ++ h2c_parameter); ++ ++ cnt_bt_cal_chk = 0; ++ while(1) ++ { ++ if( pAdapter->bFWReady == FALSE ) ++ { ++ //RT_TRACE(COMP_INIT , DBG_LOUD, ("halbtc8723b2ant_SetAntPath(): we don't need to wait for H2C command completion because of Fw download fail!!!\n")); ++ break; ++ } ++ ++ if( btcoexist->btc_read_1byte(btcoexist, 0x765) == 0x0 ) ++ break; ++ ++ cnt_bt_cal_chk++; ++ if( cnt_bt_cal_chk > 20 ) ++ break; ++ } ++ } else ++ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x0); ++ } ++ ++ /* ext switch setting */ ++ if (use_ext_switch) { ++ if (init_hwcfg) { ++ /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp &= ~BIT(23); ++ u32tmp |= BIT(24); ++ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); ++ } ++ u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ if( (u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) ++ btcoexist->btc_write_4byte(btcoexist, 0x948, u32tmp_1[0]); ++ else ++ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); ++ ++ switch (ant_pos_type) { ++ case BTC_ANT_WIFI_AT_MAIN: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, ++ 0x92c, 0x3, ++ 0x1); /* ext switch main at wifi */ ++ break; ++ case BTC_ANT_WIFI_AT_AUX: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, ++ 0x92c, 0x3, ++ 0x2); /* ext switch aux at wifi */ ++ break; ++ } ++ } else { /* internal switch */ ++ if (init_hwcfg) { ++ /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp |= BIT(23); ++ u32tmp &= ~BIT(24); ++ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); ++ } ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, ++ 0x0); /* fixed external switch S1->Main, S0->Aux */ ++ switch (ant_pos_type) { ++ case BTC_ANT_WIFI_AT_MAIN: ++ u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ if( (u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) ++ btcoexist->btc_write_4byte(btcoexist, 0x948, u32tmp_1[0]); ++ else ++ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); ++ break; ++ case BTC_ANT_WIFI_AT_AUX: ++ u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ if( (u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) ++ btcoexist->btc_write_4byte(btcoexist, 0x948, u32tmp_1[0]); ++ else ++ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x280); ++ break; ++ } ++ } ++} ++#if 0 ++boolean halbtc8723b2ant_CoexSwitchThresCheck(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state1, bt_rssi_state; ++ u32 vendor; ++ u8 offset = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_VENDOR, &vendor); ++ ++ /* if (vendor == BTC_VENDOR_LENOVO) */ ++ /* offset = 20; */ ++ ++ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES ++ - coex_dm->switch_thres_offset, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ ++ if (BTC_RSSI_LOW(wifi_rssi_state1) || BTC_RSSI_LOW(bt_rssi_state)) ++ return true; ++ ++ return false; ++} ++#endif ++ ++void halbtc8723b2ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state1, bt_rssi_state; ++ s8 wifi_duration_adjust = 0x0; ++ u8 psTdmaByte4Modify = 0x0; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES ++ - coex_dm->switch_thres_offset, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], %s turn %s PS TDMA, type=%d\n", ++ (force_exec ? "force to" : ""), (turn_on ? "ON" : "OFF"), type); ++ BTC_TRACE(trace_buf); ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ if (!(BTC_RSSI_HIGH(wifi_rssi_state1) && ++ BTC_RSSI_HIGH(bt_rssi_state)) && turn_on) ++ /* if (halbtc8723b2ant_CoexSwitchThresCheck(btcoexist) && turn_on) */ ++ { ++ type = type + 100; /* for WiFi RSSI low or BT RSSI low */ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ } else ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ return; ++ } ++ ++ if (coex_sta->scan_ap_num <= 5) { ++ if (coex_sta->a2dp_bit_pool >= 45) ++ wifi_duration_adjust = -15; ++ else if (coex_sta->a2dp_bit_pool >= 35) ++ wifi_duration_adjust = -10; ++ else ++ wifi_duration_adjust = 5; ++ } else if (coex_sta->scan_ap_num <= 20) { ++ if (coex_sta->a2dp_bit_pool >= 45) ++ wifi_duration_adjust = -15; ++ else if (coex_sta->a2dp_bit_pool >= 35) ++ wifi_duration_adjust = -10; ++ else ++ wifi_duration_adjust = 0; ++ } else if (coex_sta->scan_ap_num <= 40) { ++ if (coex_sta->a2dp_bit_pool >= 45) ++ wifi_duration_adjust = -15; ++ else if (coex_sta->a2dp_bit_pool >= 35) ++ wifi_duration_adjust = -10; ++ else ++ wifi_duration_adjust = -5; ++ } else { ++ if (coex_sta->a2dp_bit_pool >= 45) ++ wifi_duration_adjust = -15; ++ else if (coex_sta->a2dp_bit_pool >= 35) ++ wifi_duration_adjust = -10; ++ else ++ wifi_duration_adjust = -10; ++ } ++ ++ if ((bt_link_info->slave_role == true) && (bt_link_info->a2dp_exist)) ++ psTdmaByte4Modify = ++ 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ ++ ++ ++ if (turn_on) { ++ switch (type) { ++ case 1: ++ default: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c + wifi_duration_adjust, 0x03, 0xf1, ++ 0x90 | psTdmaByte4Modify); ++ break; ++ case 2: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x2d + wifi_duration_adjust, 0x03, 0xf1, ++ 0x90 | psTdmaByte4Modify); ++ break; ++ case 3: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0xf1, 0x90 | ++ psTdmaByte4Modify); ++ break; ++ case 4: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x10, 0x03, 0xf1, 0x90 | ++ psTdmaByte4Modify); ++ break; ++ case 5: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c + wifi_duration_adjust, 0x3, 0x70, ++ 0x90 | psTdmaByte4Modify); ++ break; ++ case 6: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x2d + wifi_duration_adjust, 0x3, 0x70, ++ 0x90 | psTdmaByte4Modify); ++ break; ++ case 7: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0x70, 0x90 | ++ psTdmaByte4Modify); ++ break; ++ case 8: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xa3, ++ 0x10, 0x3, 0x70, 0x90 | ++ psTdmaByte4Modify); ++ break; ++ case 9: ++ /* ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c + wifi_duration_adjust, 0x03, 0xf1, ++ 0x90 | psTdmaByte4Modify); ++ */ ++ /* Bryant Modify for BT no-profile busy case */ ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c + wifi_duration_adjust, 0x03, 0xf1, ++ 0x91); ++ ++ break; ++ case 10: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x2d + wifi_duration_adjust, 0x03, 0xf1, ++ 0x90 | psTdmaByte4Modify); ++ break; ++ case 11: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0xf1, 0x90 | ++ psTdmaByte4Modify); ++ break; ++ case 12: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x10, 0x3, 0xf1, 0x90 | ++ psTdmaByte4Modify); ++ break; ++ case 13: ++ /* ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c + wifi_duration_adjust, 0x3, 0x70, ++ 0x90 | psTdmaByte4Modify); ++ */ ++ /* Bryant Modify for BT no-profile busy case */ ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c + wifi_duration_adjust, 0x3, 0x70, ++ 0x91); ++ break; ++ case 14: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x2d + wifi_duration_adjust, 0x3, 0x70, ++ 0x90 | psTdmaByte4Modify); ++ break; ++ case 15: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0x70, 0x90 | ++ psTdmaByte4Modify); ++ break; ++ case 16: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x10, 0x3, 0x70, 0x90 | ++ psTdmaByte4Modify); ++ break; ++ case 17: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xa3, ++ 0x2f, 0x2f, 0x60, 0x90); ++ break; ++ case 18: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x5, 0x5, 0xe1, 0x90); ++ break; ++ case 19: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x25, 0xe1, 0x90); ++ break; ++ case 20: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x25, 0x60, 0x90); ++ break; ++ case 21: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x15, 0x03, 0x70, 0x90); ++ break; ++ case 22: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x35, 0x03, 0xf1, 0x90); ++ break; ++ case 23: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x35, 0x03, 0x71, 0x10); ++ break; ++ ++ case 33: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0xf1, 0x91); ++ ++ break; ++ case 71: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c + wifi_duration_adjust, 0x03, 0xf1, ++ 0x90); ++ break; ++ case 101: ++ case 105: ++ case 113: ++ case 171: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x3a + wifi_duration_adjust, 0x03, 0x70, ++ 0x50 | psTdmaByte4Modify); ++ break; ++ case 102: ++ case 106: ++ case 110: ++ case 114: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x2d + wifi_duration_adjust, 0x03, 0x70, ++ 0x50 | psTdmaByte4Modify); ++ break; ++ case 103: ++ case 107: ++ case 111: ++ case 115: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x1c, 0x03, 0x70, 0x50 | ++ psTdmaByte4Modify); ++ break; ++ case 104: ++ case 108: ++ case 112: ++ case 116: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x10, 0x03, 0x70, 0x50 | ++ psTdmaByte4Modify); ++ break; ++ case 109: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c, 0x03, 0xf1, 0x90 | ++ psTdmaByte4Modify); ++ break; ++ /* case 113: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c, 0x03, 0x70, 0x90 | ++ psTdmaByte4Modify); ++ break; */ ++ case 121: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x15, 0x03, 0x70, 0x90 | ++ psTdmaByte4Modify); ++ break; ++ case 122: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x35, 0x03, 0x71, 0x11); ++ break; ++ case 123: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x35, 0x03, 0x71, 0x10); ++ break; ++ case 133: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x1c, 0x3, 0x70, 0x51); ++ ++ break; ++ } ++ } else { ++ /* disable PS tdma */ ++ switch (type) { ++ case 0: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x40, 0x0); ++ break; ++ case 1: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x48, 0x0); ++ break; ++ default: ++ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x40, 0x0); ++ break; ++ } ++ } ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++void halbtc8723b2ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 1); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 1); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++void halbtc8723b2ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ boolean low_pwr_disable = false; ++ ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ /* recover to original 32k low power setting */ ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ case BTC_PS_LPS_ON: ++ halbtc8723b2ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8723b2ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ /* when coex force to enter LPS, do not enter 32k low power. */ ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ coex_sta->force_lps_on = true; ++ break; ++ case BTC_PS_LPS_OFF: ++ halbtc8723b2ant_ps_tdma_check_for_power_save_state( ++ btcoexist, false); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ default: ++ break; ++ } ++} ++ ++ ++void halbtc8723b2ant_coex_all_off(IN struct btc_coexist *btcoexist) ++{ ++ /* fw all off */ ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ /* hw all off */ ++ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8723b2ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ /* force to reset coex mechanism */ ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8723b2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); ++ ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ coex_sta->pop_event_cnt = 0; ++ ++} ++ ++void halbtc8723b2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, ++ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ boolean wifi_connected = false; ++ boolean low_pwr_disable = true; ++ boolean scan = false, link = false, roam = false; ++ boolean wifi_busy = false; ++ ++ ++ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, 15, 0); ++ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state1, 2, ++ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ if (coex_sta->bt_abnormal_scan) { ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 23); ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ } else if (scan || link || roam) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi link process + BT Inq/Page!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 7); ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); ++ } else if (wifi_connected) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT Inq/Page!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 7); ++ ++ if (wifi_busy) ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); ++ else ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi no-link + BT Inq/Page!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ } ++ ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ /* ++ coex_dm->need_recover0x948 = true; ++ coex_dm->backup0x948 = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ ++ halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_AUX, false, false); ++ */ ++} ++ ++ ++void halbtc8723b2ant_action_wifi_link_process(IN struct btc_coexist *btcoexist) ++{ ++ u32 u32tmp; ++ u8 u8tmpa, u8tmpb; ++ ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 15); ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); ++ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x76e=0x%x\n", ++ u32tmp, u8tmpa, u8tmpb); ++ BTC_TRACE(trace_buf); ++} ++ ++boolean halbtc8723b2ant_action_wifi_idle_process(IN struct btc_coexist ++ *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, ++ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u8 ap_num = 0; ++ ++ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, 15, 0); ++ /* wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES-coex_dm->switch_thres_offset-coex_dm->switch_thres_offset, 0); */ ++ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state1, 2, ++ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset - coex_dm->switch_thres_offset, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset - coex_dm->switch_thres_offset, 0); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); ++ ++ /* define the office environment */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && ++ (coex_sta->hid_exist == true) && ++ (coex_sta->a2dp_exist == true)) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi idle process for BT HID+A2DP exist!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723b2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x6); ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, ++ false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, ++ 0x18); ++ ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ ++ return true; ++ } else { ++ halbtc8723b2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x18); ++ return false; ++ } ++ ++ ++} ++ ++ ++ ++boolean halbtc8723b2ant_is_common_action(IN struct btc_coexist *btcoexist) ++{ ++ boolean common = false, wifi_connected = false, wifi_busy = false; ++ boolean bt_hs_on = false, low_pwr_disable = false; ++ boolean asus_8723b = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (!wifi_connected) { ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non-connected idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, ++ 0x0); ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, ++ false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, ++ 0x18); ++ ++ common = true; ++ } else { ++ if (BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, ++ false, false, 0x8); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, ++ 0xfffff, 0x0); ++ halbtc8723b2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 0); ++ ++ halbtc8723b2ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 1); ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, ++ 0xb); ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, ++ false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++ common = true; ++ } else if (BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ ++ if (bt_hs_on) ++ return false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, ++ false, false, 0x8); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, ++ 0xfffff, 0x0); ++ halbtc8723b2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 0); ++ ++ halbtc8723b2ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 1); ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, ++ 0xb); ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++ common = true; ++ } else { ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ /* btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_IS_ASUS_8723B, &asus_8723b); ++ if (!asus_8723b) ++ common = false; ++ else ++ common = halbtc8723b2ant_action_wifi_idle_process( ++ btcoexist); */ ++ common = false; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ /* common = false; */ ++ common = halbtc8723b2ant_action_wifi_idle_process( ++ btcoexist); ++ } ++ } ++ } ++ ++ return common; ++} ++void halbtc8723b2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, ++ IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) ++{ ++ static s32 up, dn, m, n, wait_count; ++ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ ++ u8 retry_count = 0; ++ ++ if (!coex_dm->auto_tdma_adjust) { ++ coex_dm->auto_tdma_adjust = true; ++ { ++ if (sco_hid) { ++ if (tx_pause) { ++ if (max_interval == 1) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 13); ++ coex_dm->ps_tdma_du_adj_type = ++ 13; ++ } else if (max_interval == 2) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (max_interval == 3) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } ++ } else { ++ if (max_interval == 1) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = ++ 9; ++ } else if (max_interval == 2) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (max_interval == 3) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } ++ } ++ } else { ++ if (tx_pause) { ++ if (max_interval == 1) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 5); ++ coex_dm->ps_tdma_du_adj_type = ++ 5; ++ } else if (max_interval == 2) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (max_interval == 3) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } ++ } else { ++ if (max_interval == 1) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (max_interval == 2) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (max_interval == 3) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } ++ } ++ } ++ } ++ /* ============ */ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n = 3; ++ result = 0; ++ wait_count = 0; ++ } else { ++ /* accquire the BT TRx retry count from BT_Info byte2 */ ++ retry_count = coex_sta->bt_retry_cnt; ++ ++ if ((coex_sta->low_priority_tx) > 1050 || ++ (coex_sta->low_priority_rx) > 1250) ++ retry_count++; ++ ++ result = 0; ++ wait_count++; ++ ++ if (retry_count == ++ 0) { /* no retry in the last 2-second duration */ ++ up++; ++ dn--; ++ ++ if (dn <= 0) ++ dn = 0; ++ ++ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ ++ wait_count = 0; ++ n = 3; ++ up = 0; ++ dn = 0; ++ result = 1; ++ } ++ } else if (retry_count <= ++ 3) { /* <=3 retry in the last 2-second duration */ ++ up--; ++ dn++; ++ ++ if (up <= 0) ++ up = 0; ++ ++ if (dn == 2) {/* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ ++ if (wait_count <= 2) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ ++ if (wait_count == 1) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ ++ if (max_interval == 1) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 71) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 5); ++ coex_dm->ps_tdma_du_adj_type = 5; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 5); ++ coex_dm->ps_tdma_du_adj_type = 5; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 13); ++ coex_dm->ps_tdma_du_adj_type = 13; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 5); ++ coex_dm->ps_tdma_du_adj_type = ++ 5; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 13); ++ coex_dm->ps_tdma_du_adj_type = ++ 13; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 71); ++ coex_dm->ps_tdma_du_adj_type = 71; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 71) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 71); ++ coex_dm->ps_tdma_du_adj_type = ++ 71; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = ++ 9; ++ } ++ } ++ } ++ } else if (max_interval == 2) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } ++ } ++ } ++ } else if (max_interval == 3) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8723b2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8723b2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } ++ } ++ } ++ } ++ } ++ ++ /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ ++ /* then we have to adjust it back to the previous record one. */ ++ if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { ++ boolean scan = false, link = false, roam = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", ++ coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (!scan && !link && !roam) ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ coex_dm->ps_tdma_du_adj_type); ++ else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } ++} ++ ++/* SCO only or SCO+PAN(HS) */ ++void halbtc8723b2ant_action_sco(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, 15, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 4); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for SCO quality at 11b/g mode */ ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ else /* for SCO quality & wifi performance balance at 11n mode */ ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); /* for voice quality */ ++ ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ true, 0x4); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ true, 0x4); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ true, 0x4); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ true, 0x4); ++ } ++ } ++} ++ ++ ++void halbtc8723b2ant_action_hid(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, 15, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ else /* for HID quality & wifi performance balance at 11n mode */ ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 9); ++ ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); ++ else ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); ++ ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ ++void halbtc8723b2ant_action_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, ++ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ u8 ap_num = 0; ++ ++ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, 15, 0); ++ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state1, 2, ++ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); ++ ++ /* define the office environment */ ++ if ((ap_num >= 10) && BTC_RSSI_HIGH(wifi_rssi_state1) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ /* dbg_print(" AP#>10(%d)\n", ap_num); */ ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, ++ 0x0); ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ ++ /* sw mechanism */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ true, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ true, 0x18); ++ } ++ return; ++ ++ } ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ } else { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 13); ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, false, false, ++ 1); ++ else ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, false, true, 1); ++ ++ /* sw mechanism */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8723b2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, ++ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, 15, 0); ++ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state1, 2, ++ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ } else { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 13); ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, false, true, 2); ++ ++ /* sw mechanism */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8723b2ant_action_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, ++ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, 15, 0); ++ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state1, 2, ++ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 10); ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ } else { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 13); ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); ++ else ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ ++ /* sw mechanism */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++ ++/* PAN(HS) only */ ++void halbtc8723b2ant_action_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, ++ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, 15, 0); ++ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state1, 2, ++ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++/* PAN(EDR)+A2DP */ ++void halbtc8723b2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, ++ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u8 ap_num = 0; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, 15, 0); ++ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state1, 2, ++ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ else ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &ap_num); ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 12); ++ ++ if(ap_num < 10) ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 1); ++ else ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 3); ++ ++ } else { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 13); ++ if(ap_num < 10) ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 1); ++ else ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 3); ++ } ++ ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8723b2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, ++ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, 15, 0); ++ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state1, 2, ++ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ } else { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 14); ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, ++ 3); ++ /* halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 11); */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, ++ 0xfffff, 0x780); ++ } else { ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, ++ 6); ++ /* halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, ++ 0xfffff, 0x0); ++ } ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 2); ++ } else { ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ /* halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, ++ 0x0); ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 2); ++ } ++ ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++/* HID+A2DP+PAN(EDR) */ ++void halbtc8723b2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, ++ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, 15, 0); ++ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state1, 2, ++ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ } else { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 14); ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, ++ true, 3); ++ else ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, ++ false, 3); ++ } else ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 3); ++ ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8723b2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, ++ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ u8 ap_num = 0; ++ ++ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, 15, 0); ++ /* bt_rssi_state = halbtc8723b2ant_bt_rssi_state(2, 29, 0); */ ++ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state1, 2, ++ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 0); ++ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 3, ++ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - ++ coex_dm->switch_thres_offset, 37); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &ap_num); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x5); ++ ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_LEGACY == wifi_bw) { ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ } else { ++ /* only 802.11N mode we have to dec bt power to 4 degree */ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) { ++ /* need to check ap Number of Not */ ++ if (ap_num < 10) ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, ++ NORMAL_EXEC, 4); ++ else ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, ++ NORMAL_EXEC, 2); ++ } else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ } ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ } else { ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 14); ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ ++ if(BTC_RSSI_HIGH(bt_rssi_state)) { ++ if(ap_num < 10) ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 1); ++ else ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 3); ++ } else { ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 18); ++ btcoexist->btc_write_1byte(btcoexist, 0x456, 0x38); ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, 0x0808); ++ btcoexist->btc_write_4byte(btcoexist, 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, 0x434, 0x01010000); ++ ++ if(ap_num < 10) ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 1); ++ else ++ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 3); ++ } ++ ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8723b2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8723b2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ /* hw all off */ ++ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ ++ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++} ++ ++void halbtc8723b2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ u8 algorithm = 0; ++ u32 num_of_wifi_link = 0; ++ u32 wifi_link_status = 0; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean miracast_plus_bt = false; ++ boolean scan = false, link = false, roam = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->bt_whck_test) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under WHCK TEST!!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_action_bt_whck_test(btcoexist); ++ return; ++ } ++ ++ algorithm = halbtc8723b2ant_action_algorithm(btcoexist); ++ if (coex_sta->c2h_bt_inquiry_page && ++ (BT_8723B_2ANT_COEX_ALGO_PANHS != algorithm)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under inquiry/page scan !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_action_bt_inquiry(btcoexist); ++ return; ++ } else { ++ /* ++ if(coex_dm->need_recover0x948) ++ { ++ coex_dm->need_recover0x948 = false; ++ btcoexist->btc_write_4byte(btcoexist, 0x948, coex_dm->backup0x948); ++ } ++ */ ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || link || roam) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under Link Process !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_action_wifi_link_process(btcoexist); ++ return; ++ } ++ ++ /* for P2P */ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if ((num_of_wifi_link >= 2) || ++ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", ++ num_of_wifi_link, wifi_link_status); ++ BTC_TRACE(trace_buf); ++ ++ if (bt_link_info->bt_link_exist) ++ miracast_plus_bt = true; ++ else ++ miracast_plus_bt = false; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ halbtc8723b2ant_action_wifi_multi_port(btcoexist); ++ ++ return; ++ } else { ++ miracast_plus_bt = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ } ++ ++ coex_dm->cur_algorithm = algorithm; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", ++ coex_dm->cur_algorithm); ++ BTC_TRACE(trace_buf); ++ ++ if (halbtc8723b2ant_is_common_action(btcoexist)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant common.\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->auto_tdma_adjust = false; ++ } else { ++ if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", ++ coex_dm->pre_algorithm, coex_dm->cur_algorithm); ++ BTC_TRACE(trace_buf); ++ coex_dm->auto_tdma_adjust = false; ++ } ++ switch (coex_dm->cur_algorithm) { ++ case BT_8723B_2ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_action_sco(btcoexist); ++ break; ++ case BT_8723B_2ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_action_hid(btcoexist); ++ break; ++ case BT_8723B_2ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_action_a2dp(btcoexist); ++ break; ++ case BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_action_a2dp_pan_hs(btcoexist); ++ break; ++ case BT_8723B_2ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_action_pan_edr(btcoexist); ++ break; ++ case BT_8723B_2ANT_COEX_ALGO_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_action_pan_hs(btcoexist); ++ break; ++ case BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_action_pan_edr_a2dp(btcoexist); ++ break; ++ case BT_8723B_2ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_action_pan_edr_hid(btcoexist); ++ break; ++ case BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_action_hid_a2dp_pan_edr( ++ btcoexist); ++ break; ++ case BT_8723B_2ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_action_hid_a2dp(btcoexist); ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_coex_all_off(btcoexist); ++ break; ++ } ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ } ++} ++ ++void halbtc8723b2ant_wifi_off_hw_cfg(IN struct btc_coexist *btcoexist) ++{ ++ boolean is_in_mp_mode = false; ++ u8 h2c_parameter[2] = {0}; ++ u32 fw_ver = 0; ++ ++ /* set wlan_act to low */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, ++ 0x780); /* WiFi goto standby while GNT_BT 0-->1 */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ if (fw_ver >= 0x180000) { ++ /* Use H2C to set GNT_BT to HIGH */ ++ h2c_parameter[0] = 1; ++ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, h2c_parameter); ++ } else ++ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, ++ &is_in_mp_mode); ++ if (!is_in_mp_mode) ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, ++ 0x0); /* BT select s0/s1 is controlled by BT */ ++ else ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, ++ 0x1); /* BT select s0/s1 is controlled by WiFi */ ++} ++ ++void halbtc8723b2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean back_up) ++{ ++ u8 u8tmp = 0; ++ u32 vendor; ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 2Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_VENDOR, &vendor); ++ if (vendor == BTC_VENDOR_LENOVO) ++ coex_dm->switch_thres_offset = 0; ++ else if (vendor == BTC_VENDOR_ASUS) ++ coex_dm->switch_thres_offset = 0; ++ else ++ coex_dm->switch_thres_offset = 20; ++ ++ /* 0xf0[15:12] --> Chip Cut information */ ++ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, ++ 0xf1) & 0xf0) >> 4; ++ ++ /* backup rf 0x1e value */ ++ coex_dm->bt_rf_0x1e_backup = ++ btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff); ++ ++ /* 0x790[5:0]=0x5 */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); ++ u8tmp &= 0xc0; ++ u8tmp |= 0x5; ++ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); ++ ++ /* Antenna config */ ++ halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, true, ++ false); ++ coex_sta->dis_ver_info_cnt = 0; ++ ++ /* PTA parameter */ ++ halbtc8723b2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ /* Enable counter statistics */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, ++ 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); ++} ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8723b2ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8723b2ant_ ++ * ************************************************************ */ ++void ex_halbtc8723b2ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u16 u16tmp = 0x0; ++ u32 value = 0; ++ u32 u32tmp_1[4]; ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x67, 0x20); ++ ++ /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ ++ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); ++ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); ++ DbgPrint("--- TEST 5 ---\n"); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); ++ ++ if (btcoexist->chip_interface == BTC_INTF_USB) { ++ /* fixed at S0 for USB interface */ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; ++ } else { ++ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ ++ if (board_info->single_ant_path == 0) { ++ /* set to S1 */ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; ++ } else if (board_info->single_ant_path == 1) { ++ /* set to S0 */ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; ++ } ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, ++ &value); ++ } ++} ++ ++void ex_halbtc8723b2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */ ++ ++ /* */ ++ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ ++ /* Local setting bit define */ ++ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ ++ /* BIT1: "0" for internal switch; "1" for external switch */ ++ /* BIT2: "0" for one antenna; "1" for two antenna */ ++ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ ++ if (btcoexist->chip_interface == BTC_INTF_USB) { ++ /* fixed at S0 for USB interface */ ++ u8tmp |= 0x1; /* antenna inverse */ ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); ++ } else { ++ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ ++ if (board_info->single_ant_path == 0) { ++ } else if (board_info->single_ant_path == 1) { ++ /* set to S0 */ ++ u8tmp |= 0x1; /* antenna inverse */ ++ } ++ ++ if (btcoexist->chip_interface == BTC_INTF_PCI) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x384, ++ u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_SDIO) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, ++ u8tmp); ++ } ++} ++ ++void ex_halbtc8723b2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ halbtc8723b2ant_init_hw_config(btcoexist, true); ++} ++ ++void ex_halbtc8723b2ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723b2ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8723b2ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; ++ u32 u32tmp[4]; ++ u32 fa_of_dm, fa_cck; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ static u8 pop_report_in_10s = 0; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", ++ "Ant PG number/ Ant mechanism:", ++ board_info->pg_ant_num, board_info->btdm_ant_num); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", ++ "Version Coex/ Fw/ Patch/ Cut", ++ glcoex_ver_date_8723b_2ant, glcoex_ver_8723b_2ant, fw_ver, ++ bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "BT Abnormal scan", ++ (coex_sta->bt_abnormal_scan) ? "Yes" : "No"); ++ CL_PRINTF(cli_buf); ++ ++ pop_report_in_10s++; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt/ popCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") ++ : ((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, ++ coex_sta->pop_event_cnt); ++ CL_PRINTF(cli_buf); ++ ++ if (pop_report_in_10s >= 5) { ++ coex_sta->pop_event_cnt = 0; ++ pop_report_in_10s = 0; ++ } ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d / %d / %d / %d / %d / %d", ++ "SCO/HID/PAN/A2DP/NameReq/WHQL", ++ bt_link_info->sco_exist, bt_link_info->hid_exist, ++ bt_link_info->pan_exist, bt_link_info->a2dp_exist, ++ coex_sta->c2h_bt_remote_name_req, ++ coex_sta->bt_whck_test); ++ CL_PRINTF(cli_buf); ++ ++ { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "BT Role", ++ (bt_link_info->slave_role) ? "Slave" : "Master"); ++ CL_PRINTF(cli_buf); ++ } ++ ++ bt_info_ext = coex_sta->bt_info_ext; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", ++ "A2DP Rate/Bitpool", ++ (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool); ++ CL_PRINTF(cli_buf); ++ ++ for (i = 0; i < BT_INFO_SRC_8723B_2ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8723b_2ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ /* Sw mechanism */ ++ if (btcoexist->manual_control) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Sw mechanism] (before Manual)============"); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Sw mechanism]============"); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", ++ "SM1[ShRf/ LpRA/ LimDig]", ++ coex_dm->cur_rf_rx_lpf_shrink, coex_dm->cur_low_penalty_ra, ++ coex_dm->limited_dig); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", ++ "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", ++ coex_dm->cur_agc_table_en, coex_dm->cur_adc_back_off, ++ coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); ++ CL_PRINTF(cli_buf); ++ ++ /* Fw mechanism */ ++ if (btcoexist->manual_control) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Fw mechanism] (before Manual) ============"); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Fw mechanism]============"); ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ ++ if (coex_dm->is_switch_to_1dot5_ant) ++ ps_tdma_case = ps_tdma_case + 100; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case, ++ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), ++ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "Coex Table Type", ++ coex_sta->coex_table_type); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", ++ "DecBtPwr/ IgnWlanAct", ++ coex_dm->cur_bt_dec_pwr_lvl, coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", ++ "RF-A, 0x1e initVal", ++ coex_dm->bt_rf_0x1e_backup); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x880); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x778/0x880[29:25]", ++ u8tmp[0], (u32tmp[0] & 0x3e000000) >> 25); ++ CL_PRINTF(cli_buf); ++ ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x765); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x948/ 0x67[5] / 0x765", ++ u32tmp[0], ((u8tmp[0] & 0x20) >> 5), u8tmp[1]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x92c); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x930); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x944); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", ++ u32tmp[0] & 0x3, u32tmp[1] & 0xff, u32tmp[2] & 0x3); ++ CL_PRINTF(cli_buf); ++ ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x39); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x38[11]/0x40/0x4c[24:23]/0x64[0]", ++ ((u8tmp[0] & 0x8) >> 3), u8tmp[1], ++ ((u32tmp[0] & 0x01800000) >> 23), u8tmp[2] & 0x1); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x550(bcn ctrl)/0x522", ++ u32tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x49c); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0xc50(dig)/0x49c(null-drop)", ++ u32tmp[0] & 0xff, u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); ++ u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); ++ ++ fa_of_dm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) ++ >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + \ ++ ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & ++ 0xffff) ; ++ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "OFDM-CCA/OFDM-FA/CCK-FA", ++ u32tmp[0] & 0xffff, fa_of_dm, fa_cck); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_OK CCK/11g/11n/11n-Agg", ++ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, ++ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_Err CCK/11g/11n/11n-Agg", ++ coex_sta->crc_err_cck, coex_sta->crc_err_11g, ++ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", ++ u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770(high-pri rx/tx)", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(low-pri rx/tx)", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++#if (BT_AUTO_REPORT_ONLY_8723B_2ANT == 1) ++ /* halbtc8723b2ant_monitor_bt_ctr(btcoexist); */ ++#endif ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++void ex_halbtc8723b2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ halbtc8723b2ant_wifi_off_hw_cfg(btcoexist); ++ halbtc8723b2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ halbtc8723b2ant_coex_all_off(btcoexist); ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = false; ++ halbtc8723b2ant_init_hw_config(btcoexist, false); ++ halbtc8723b2ant_init_coex_dm(btcoexist); ++ halbtc8723b2ant_query_bt_info(btcoexist); ++ } ++} ++ ++void ex_halbtc8723b2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ } ++} ++ ++void ex_halbtc8723b2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u32 u32tmp; ++ u8 u8tmpa, u8tmpb; ++ ++ ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); ++ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); ++ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); ++ ++ if (BTC_SCAN_START == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, FALSE, FALSE); ++ } else if (BTC_SCAN_FINISH == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ } ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x76e=0x%x\n", ++ u32tmp, u8tmpa, u8tmpb); ++ BTC_TRACE(trace_buf); ++} ++ ++void ex_halbtc8723b2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (BTC_ASSOCIATE_START == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, FALSE, FALSE); ++ } else if (BTC_ASSOCIATE_FINISH == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++} ++ ++void ex_halbtc8723b2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ u8 ap_num = 0; ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, FALSE, FALSE); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ h2c_parameter[0] = 0x1; ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else { ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &ap_num); ++ if (ap_num < 10) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); ++} ++ ++void ex_halbtc8723b2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (type == BTC_PACKET_DHCP) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], DHCP Packet notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++} ++ ++void ex_halbtc8723b2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 bt_info = 0; ++ u8 i, rsp_source = 0; ++ boolean bt_busy = false, limited_dig = false; ++ boolean wifi_connected = false; ++ ++ coex_sta->c2h_bt_info_req_sent = false; ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8723B_2ANT_MAX) ++ rsp_source = BT_INFO_SRC_8723B_2ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ if (i == 1) ++ bt_info = tmp_buf[i]; ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), return for Manual CTRL<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ /* if 0xff, it means BT is under WHCK test */ ++ if (bt_info == 0xff) ++ coex_sta->bt_whck_test = true; ++ else ++ coex_sta->bt_whck_test = false; ++ ++ if (BT_INFO_SRC_8723B_2ANT_WIFI_FW != rsp_source) { ++ coex_sta->bt_retry_cnt = /* [3:0] */ ++ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; ++ ++ if (coex_sta->bt_retry_cnt >= 1) ++ coex_sta->pop_event_cnt++; ++ ++ coex_sta->bt_rssi = ++ coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; ++ ++ coex_sta->bt_info_ext = ++ coex_sta->bt_info_c2h[rsp_source][4]; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ++ coex_sta->c2h_bt_remote_name_req = true; ++ else ++ coex_sta->c2h_bt_remote_name_req = false; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][1] == 0x49) { ++ coex_sta->a2dp_bit_pool = ++ coex_sta->bt_info_c2h[rsp_source][6]; ++ } else ++ coex_sta->a2dp_bit_pool = 0; ++ ++ coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] ++ & 0x40); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, ++ &coex_sta->bt_tx_rx_mask); ++ if (coex_sta->bt_tx_rx_mask) { ++ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x01 => Need to switch BT TRx Mask */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x01\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, ++ 0x3c, 0x01); ++ } ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ if ((coex_sta->bt_info_ext & BIT(1))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (wifi_connected) ++ ex_halbtc8723b2ant_media_status_notify( ++ btcoexist, BTC_MEDIA_CONNECT); ++ else ++ ex_halbtc8723b2ant_media_status_notify( ++ btcoexist, BTC_MEDIA_DISCONNECT); ++ } ++ ++ if ((coex_sta->bt_info_ext & BIT(3))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, ++ false); ++ } else { ++ /* BT already NOT ignore Wlan active, do nothing here. */ ++ } ++#if (BT_AUTO_REPORT_ONLY_8723B_2ANT == 0) ++ if ((coex_sta->bt_info_ext & BIT(4))) { ++ /* BT auto report already enabled, do nothing */ ++ } else ++ halbtc8723b2ant_bt_auto_report(btcoexist, FORCE_EXEC, ++ true); ++#endif ++ } ++ ++ /* check BIT2 first ==> check if bt is under inquiry or page scan */ ++ if (bt_info & BT_INFO_8723B_2ANT_B_INQ_PAGE) ++ coex_sta->c2h_bt_inquiry_page = true; ++ else ++ coex_sta->c2h_bt_inquiry_page = false; ++ ++ /* set link exist status */ ++ if (!(bt_info & BT_INFO_8723B_2ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (bt_info & BT_INFO_8723B_2ANT_B_FTP) ++ coex_sta->pan_exist = true; ++ else ++ coex_sta->pan_exist = false; ++ if (bt_info & BT_INFO_8723B_2ANT_B_A2DP) ++ coex_sta->a2dp_exist = true; ++ else ++ coex_sta->a2dp_exist = false; ++ if (bt_info & BT_INFO_8723B_2ANT_B_HID) ++ coex_sta->hid_exist = true; ++ else ++ coex_sta->hid_exist = false; ++ if (bt_info & BT_INFO_8723B_2ANT_B_SCO_ESCO) ++ coex_sta->sco_exist = true; ++ else ++ coex_sta->sco_exist = false; ++ ++ if ((coex_sta->hid_exist == false) && ++ (coex_sta->c2h_bt_inquiry_page == false) && ++ (coex_sta->sco_exist == false)) { ++ if (coex_sta->high_priority_tx + ++ coex_sta->high_priority_rx >= 160) { ++ coex_sta->hid_exist = true; ++ bt_info = bt_info | 0x28; ++ } ++ } ++ } ++ ++ halbtc8723b2ant_update_bt_link_info(btcoexist); ++ ++ if (!(bt_info & BT_INFO_8723B_2ANT_B_CONNECTION)) { ++ coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info == ++ BT_INFO_8723B_2ANT_B_CONNECTION) { /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if ((bt_info & BT_INFO_8723B_2ANT_B_SCO_ESCO) || ++ (bt_info & BT_INFO_8723B_2ANT_B_SCO_BUSY)) { ++ coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info & BT_INFO_8723B_2ANT_B_ACL_BUSY) { ++ coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_ACL_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_MAX; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if ((BT_8723B_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8723B_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8723B_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { ++ bt_busy = true; ++ limited_dig = true; ++ } else { ++ bt_busy = false; ++ limited_dig = false; ++ } ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ coex_dm->limited_dig = limited_dig; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); ++ ++ halbtc8723b2ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8723b2ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723b2ant_wifi_off_hw_cfg(btcoexist); ++ /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ ++ /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT goto standby while GNT_BT 1-->0 */ ++ halbtc8723b2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ++ ex_halbtc8723b2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++} ++ ++void ex_halbtc8723b2ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_WIFI_PNP_SLEEP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ ++ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ ++ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ ++ coex_sta->under_ips = false; ++ coex_sta->under_lps = false; ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_init_hw_config(btcoexist, false); ++ halbtc8723b2ant_init_coex_dm(btcoexist); ++ halbtc8723b2ant_query_bt_info(btcoexist); ++ } ++} ++ ++void ex_halbtc8723b2ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ==========================Periodical===========================\n"); ++ BTC_TRACE(trace_buf); ++ if (coex_sta->dis_ver_info_cnt <= 5) { ++ coex_sta->dis_ver_info_cnt += 1; ++ if (coex_sta->dis_ver_info_cnt == 3) { ++ /* Antenna config to set 0x765 = 0x0 (GNT_BT control by PTA) after initial */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set GNT_BT control by PTA\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723b2ant_set_ant_path(btcoexist, ++ BTC_ANT_WIFI_AT_MAIN, false, false); ++ } ++ } ++ ++#if (BT_AUTO_REPORT_ONLY_8723B_2ANT == 0) ++ halbtc8723b2ant_query_bt_info(btcoexist); ++ halbtc8723b2ant_monitor_bt_enable_disable(btcoexist); ++#else ++ halbtc8723b2ant_monitor_bt_ctr(btcoexist); ++ halbtc8723b2ant_monitor_wifi_ctr(btcoexist); ++ ++ /* for some BT speaker that Hi-Pri pkt appear begore start play, this will cause HID exist */ ++ if ((coex_sta->high_priority_tx + coex_sta->high_priority_rx < 50) && ++ (bt_link_info->hid_exist == true)) ++ bt_link_info->hid_exist = false; ++ ++ if (halbtc8723b2ant_is_wifi_status_changed(btcoexist) || ++ coex_dm->auto_tdma_adjust) ++ halbtc8723b2ant_run_coexist_mechanism(btcoexist); ++#endif ++} ++ ++#endif ++ ++#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.h 2018-02-11 21:44:27.146146071 +0200 +@@ -0,0 +1,214 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8723B_SUPPORT == 1) ++/* ******************************************* ++ * The following is for 8723B 2Ant BT Co-exist definition ++ * ******************************************* */ ++#define BT_AUTO_REPORT_ONLY_8723B_2ANT 1 ++ ++ ++#define BT_INFO_8723B_2ANT_B_FTP BIT(7) ++#define BT_INFO_8723B_2ANT_B_A2DP BIT(6) ++#define BT_INFO_8723B_2ANT_B_HID BIT(5) ++#define BT_INFO_8723B_2ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8723B_2ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8723B_2ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8723B_2ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8723B_2ANT_B_CONNECTION BIT(0) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT 2 ++ ++ ++#define BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES 42 /* WiFi RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation */ ++#define BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES 46 /* BT RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation */ ++ ++enum bt_info_src_8723b_2ant { ++ BT_INFO_SRC_8723B_2ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8723B_2ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8723B_2ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8723B_2ANT_MAX ++}; ++ ++enum bt_8723b_2ant_bt_status { ++ BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8723B_2ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8723B_2ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8723B_2ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8723B_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8723B_2ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8723b_2ant_coex_algo { ++ BT_8723B_2ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8723B_2ANT_COEX_ALGO_SCO = 0x1, ++ BT_8723B_2ANT_COEX_ALGO_HID = 0x2, ++ BT_8723B_2ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, ++ BT_8723B_2ANT_COEX_ALGO_PANEDR = 0x5, ++ BT_8723B_2ANT_COEX_ALGO_PANHS = 0x6, ++ BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, ++ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID = 0x8, ++ BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, ++ BT_8723B_2ANT_COEX_ALGO_HID_A2DP = 0xa, ++ BT_8723B_2ANT_COEX_ALGO_MAX = 0xb, ++}; ++ ++struct coex_dm_8723b_2ant { ++ /* fw mechanism */ ++ u8 pre_bt_dec_pwr_lvl; ++ u8 cur_bt_dec_pwr_lvl; ++ u8 pre_fw_dac_swing_lvl; ++ u8 cur_fw_dac_swing_lvl; ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean reset_tdma_adjust; ++ boolean auto_tdma_adjust; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ ++ /* sw mechanism */ ++ boolean pre_rf_rx_lpf_shrink; ++ boolean cur_rf_rx_lpf_shrink; ++ u32 bt_rf_0x1e_backup; ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ boolean pre_dac_swing_on; ++ u32 pre_dac_swing_lvl; ++ boolean cur_dac_swing_on; ++ u32 cur_dac_swing_lvl; ++ boolean pre_adc_back_off; ++ boolean cur_adc_back_off; ++ boolean pre_agc_table_en; ++ boolean cur_agc_table_en; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ boolean limited_dig; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ boolean need_recover0x948; ++ u32 backup0x948; ++ ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++ ++ boolean is_switch_to_1dot5_ant; ++ u8 switch_thres_offset; ++}; ++ ++struct coex_sta_8723b_2ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ boolean bt_abnormal_scan; ++ boolean under_lps; ++ boolean under_ips; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ u8 bt_rssi; ++ boolean bt_tx_rx_mask; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ boolean c2h_bt_info_req_sent; ++ u8 bt_info_c2h[BT_INFO_SRC_8723B_2ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8723B_2ANT_MAX]; ++ boolean bt_whck_test; ++ boolean c2h_bt_inquiry_page; ++ boolean c2h_bt_remote_name_req; ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++ u32 pop_event_cnt; ++ u8 scan_ap_num; ++ ++ u32 crc_ok_cck; ++ u32 crc_ok_11g; ++ u32 crc_ok_11n; ++ u32 crc_ok_11n_agg; ++ ++ u32 crc_err_cck; ++ u32 crc_err_11g; ++ u32 crc_err_11n; ++ u32 crc_err_11n_agg; ++ ++ u8 coex_table_type; ++ boolean force_lps_on; ++ ++ u8 dis_ver_info_cnt; ++ ++ u8 a2dp_bit_pool; ++ u8 cut_version; ++}; ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8723b2ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723b2ant_pre_load_firmware(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723b2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8723b2ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723b2ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723b2ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723b2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723b2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723b2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723b2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723b2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8723b2ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723b2ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state); ++void ex_halbtc8723b2ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723b2ant_display_coex_info(IN struct btc_coexist *btcoexist); ++ ++#else ++#define ex_halbtc8723b2ant_power_on_setting(btcoexist) ++#define ex_halbtc8723b2ant_pre_load_firmware(btcoexist) ++#define ex_halbtc8723b2ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8723b2ant_init_coex_dm(btcoexist) ++#define ex_halbtc8723b2ant_ips_notify(btcoexist, type) ++#define ex_halbtc8723b2ant_lps_notify(btcoexist, type) ++#define ex_halbtc8723b2ant_scan_notify(btcoexist, type) ++#define ex_halbtc8723b2ant_connect_notify(btcoexist, type) ++#define ex_halbtc8723b2ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8723b2ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8723b2ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8723b2ant_halt_notify(btcoexist) ++#define ex_halbtc8723b2ant_pnp_notify(btcoexist, pnp_state) ++#define ex_halbtc8723b2ant_periodical(btcoexist) ++#define ex_halbtc8723b2ant_display_coex_info(btcoexist) ++ ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.c 2018-02-11 21:44:27.149146116 +0200 +@@ -0,0 +1,6290 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8723D Co-exist mechanism ++ * ++ * History ++ * 2012/11/15 Cosa first check in. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8723D_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8723d_1ant glcoex_dm_8723d_1ant; ++static struct coex_dm_8723d_1ant *coex_dm = &glcoex_dm_8723d_1ant; ++static struct coex_sta_8723d_1ant glcoex_sta_8723d_1ant; ++static struct coex_sta_8723d_1ant *coex_sta = &glcoex_sta_8723d_1ant; ++static struct psdscan_sta_8723d_1ant gl_psd_scan_8723d_1ant; ++static struct psdscan_sta_8723d_1ant *psd_scan = &gl_psd_scan_8723d_1ant; ++ ++ ++const char *const glbt_info_src_8723d_1ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++/* ************************************************************ ++ * BtCoex Version Format: ++ * 1. date : glcoex_ver_date_XXXXX_1ant ++ * 2. WifiCoexVersion : glcoex_ver_XXXX_1ant ++ * 3. BtCoexVersion : glcoex_ver_btdesired_XXXXX_1ant ++ * 4. others : glcoex_ver_XXXXXX_XXXXX_1ant ++ * ++ * Variable should be indicated IC and Antenna numbers !!! ++ * Please strictly follow this order and naming style !!! ++ * ++ * ************************************************************ */ ++u32 glcoex_ver_date_8723d_1ant = 20170111; ++u32 glcoex_ver_8723d_1ant = 0x14; ++u32 glcoex_ver_btdesired_8723d_1ant = 0x10; ++ ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8723d1ant_ ++ * ************************************************************ */ ++u8 halbtc8723d1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_bt_rssi_state; ++ } ++ ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8723d1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_wifi_rssi_state[index]; ++ } ++ ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8723d1ant_update_ra_mask(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 dis_rate_mask) ++{ ++ coex_dm->cur_ra_mask = dis_rate_mask; ++ ++ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, ++ &coex_dm->cur_ra_mask); ++ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; ++} ++ ++void halbtc8723d1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ ++ coex_dm->cur_arfr_type = type; ++ ++ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { ++ switch (coex_dm->cur_arfr_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_4byte(btcoexist, 0x430, ++ coex_dm->backup_arfr_cnt1); ++ btcoexist->btc_write_4byte(btcoexist, 0x434, ++ coex_dm->backup_arfr_cnt2); ++ break; ++ case 1: ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x01010101); ++ } else { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x04030201); ++ } ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; ++} ++ ++void halbtc8723d1ant_retry_limit(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_retry_limit_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_retry_limit_type != ++ coex_dm->cur_retry_limit_type)) { ++ switch (coex_dm->cur_retry_limit_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ coex_dm->backup_retry_limit); ++ break; ++ case 1: /* retry limit=8 */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ 0x0808); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; ++} ++ ++void halbtc8723d1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_ampdu_time_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { ++ switch (coex_dm->cur_ampdu_time_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ coex_dm->backup_ampdu_max_time); ++ break; ++ case 1: /* AMPDU timw = 0x38 * 32us */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ 0x38); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; ++} ++ ++void halbtc8723d1ant_limited_tx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, ++ IN u8 retry_limit_type, IN u8 ampdu_time_type) ++{ ++ switch (ra_mask_type) { ++ case 0: /* normal mode */ ++ halbtc8723d1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0); ++ break; ++ case 1: /* disable cck 1/2 */ ++ halbtc8723d1ant_update_ra_mask(btcoexist, force_exec, ++ 0x00000003); ++ break; ++ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ ++ halbtc8723d1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0001f1f7); ++ break; ++ default: ++ break; ++ } ++ ++ halbtc8723d1ant_auto_rate_fallback_retry(btcoexist, force_exec, ++ arfr_type); ++ halbtc8723d1ant_retry_limit(btcoexist, force_exec, retry_limit_type); ++ halbtc8723d1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); ++} ++ ++void halbtc8723d1ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++ ++ ++} ++ ++void halbtc8723d1ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] |= BIT(0); /* trigger */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WL query BT info!!\n"); ++ BTC_TRACE(trace_buf); ++} ++ ++void halbtc8723d1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ static u8 num_of_bt_counter_chk = 0, cnt_slave = 0, cnt_overhead = 0, ++ cnt_autoslot_hang = 0; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ ++ /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ if (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ ++ if (coex_sta->high_priority_rx >= 15) { ++ if (cnt_overhead < 3) ++ cnt_overhead++; ++ ++ if (cnt_overhead == 3) ++ coex_sta->is_hiPri_rx_overhead = true; ++ } else { ++ if (cnt_overhead > 0) ++ cnt_overhead--; ++ ++ if (cnt_overhead == 0) ++ coex_sta->is_hiPri_rx_overhead = false; ++ } ++ } else ++ coex_sta->is_hiPri_rx_overhead = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", ++ reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); ++ ++ BTC_TRACE(trace_buf); ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++ ++ if ((coex_sta->low_priority_tx > 1150) && ++ (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->pop_event_cnt++; ++ ++ if ((coex_sta->low_priority_rx >= 1150) && ++ (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) ++ && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && ++ (coex_sta->bt_link_exist)) { ++ if (cnt_slave >= 2) { ++ bt_link_info->slave_role = true; ++ cnt_slave = 2; ++ } else ++ cnt_slave++; ++ } else { ++ if (cnt_slave == 0) { ++ bt_link_info->slave_role = false; ++ cnt_slave = 0; ++ } else ++ cnt_slave--; ++ ++ } ++ ++ if (coex_sta->is_tdma_btautoslot) { ++ if ((coex_sta->low_priority_tx >= 1300) && ++ (coex_sta->low_priority_rx <= 150)) { ++ if (cnt_autoslot_hang >= 2) { ++ coex_sta->is_tdma_btautoslot_hang = true; ++ cnt_autoslot_hang = 2; ++ } else ++ cnt_autoslot_hang++; ++ } else { ++ if (cnt_autoslot_hang == 0) { ++ coex_sta->is_tdma_btautoslot_hang = false; ++ cnt_autoslot_hang = 0; ++ } else ++ cnt_autoslot_hang--; ++ } ++ } ++ ++ if (!coex_sta->bt_disabled) { ++ ++ if ((coex_sta->high_priority_tx == 0) && ++ (coex_sta->high_priority_rx == 0) && ++ (coex_sta->low_priority_tx == 0) && ++ (coex_sta->low_priority_rx == 0)) { ++ num_of_bt_counter_chk++; ++ if (num_of_bt_counter_chk >= 3) { ++ halbtc8723d1ant_query_bt_info(btcoexist); ++ num_of_bt_counter_chk = 0; ++ } ++ } ++ } ++ ++} ++ ++void halbtc8723d1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) ++{ ++#if 1 ++ s32 wifi_rssi = 0; ++ boolean wifi_busy = false, wifi_under_b_mode = false, ++ wifi_scan = false; ++ boolean bt_idle = false, wl_idle = false; ++ static u8 cck_lock_counter = 0, wl_noisy_count0 = 0, ++ wl_noisy_count1 = 3, wl_noisy_count2 = 0; ++ u32 total_cnt, reg_val1, reg_val2, cck_cnt; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); ++ ++ coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_OK_CCK); ++ coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_OK_LEGACY); ++ coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_OK_HT); ++ coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_OK_VHT); ++ ++ coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_ERROR_CCK); ++ coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY); ++ coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_ERROR_HT); ++ coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_ERROR_VHT); ++ ++ cck_cnt = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; ++ ++ if (cck_cnt > 250) { ++ if (wl_noisy_count2 < 3) ++ wl_noisy_count2++; ++ ++ if (wl_noisy_count2 == 3) { ++ wl_noisy_count0 = 0; ++ wl_noisy_count1 = 0; ++ } ++ } else if (cck_cnt < 50) { ++ if (wl_noisy_count0 < 3) ++ wl_noisy_count0++; ++ ++ if (wl_noisy_count0 == 3) { ++ wl_noisy_count1 = 0; ++ wl_noisy_count2 = 0; ++ } ++ } else { ++ if (wl_noisy_count1 < 3) ++ wl_noisy_count1++; ++ ++ if (wl_noisy_count1 == 3) { ++ wl_noisy_count0 = 0; ++ wl_noisy_count2 = 0; ++ } ++ } ++ ++ if (wl_noisy_count2 == 3) ++ coex_sta->wl_noisy_level = 2; ++ else if (wl_noisy_count1 == 3) ++ coex_sta->wl_noisy_level = 1; ++ else ++ coex_sta->wl_noisy_level = 0; ++ ++ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { ++ total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + ++ coex_sta->crc_ok_11n + coex_sta->crc_ok_11n_vht; ++ ++ if ((coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_ACL_BUSY) || ++ (coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY) || ++ (coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_SCO_BUSY)) { ++ if (coex_sta->crc_ok_cck > (total_cnt - ++ coex_sta->crc_ok_cck)) { ++ if (cck_lock_counter < 3) ++ cck_lock_counter++; ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ if (!coex_sta->pre_ccklock) { ++ ++ if (cck_lock_counter >= 3) ++ coex_sta->cck_lock = true; ++ else ++ coex_sta->cck_lock = false; ++ } else { ++ if (cck_lock_counter == 0) ++ coex_sta->cck_lock = false; ++ else ++ coex_sta->cck_lock = true; ++ } ++ ++ if (coex_sta->cck_lock) ++ coex_sta->cck_ever_lock = true; ++ ++ coex_sta->pre_ccklock = coex_sta->cck_lock; ++ ++#endif ++} ++ ++void halbtc8723d1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ boolean bt_busy = false; ++ ++ ++ coex_sta->num_of_profile = 0; ++ ++ /* set link exist status */ ++ if (!(coex_sta->bt_info & BT_INFO_8723D_1ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_FTP) { ++ coex_sta->pan_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->pan_exist = false; ++ ++ if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_A2DP) { ++ coex_sta->a2dp_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->a2dp_exist = false; ++ ++ if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_HID) { ++ coex_sta->hid_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->hid_exist = false; ++ ++ if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_SCO_ESCO) { ++ coex_sta->sco_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->sco_exist = false; ++ ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ bt_link_info->acl_busy = coex_sta->acl_busy; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if (bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if (!bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++ ++ if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_INQ_PAGE) { ++ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_INQ_PAGE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Inq/page!!!\n"); ++ } else if (!(coex_sta->bt_info & BT_INFO_8723D_1ANT_B_CONNECTION)) { ++ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); ++ } else if (coex_sta->bt_info == BT_INFO_8723D_1ANT_B_CONNECTION) { ++ /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); ++ } else if (((coex_sta->bt_info & BT_INFO_8723D_1ANT_B_SCO_ESCO) || ++ (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_SCO_BUSY)) && ++ (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_ACL_BUSY)) { ++ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL SCO busy!!!\n"); ++ } else if ((coex_sta->bt_info & BT_INFO_8723D_1ANT_B_SCO_ESCO) || ++ (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_SCO_BUSY)) { ++ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); ++ } else if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_ACL_BUSY) { ++ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_ACL_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); ++ } else { ++ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_MAX; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); ++ } ++ ++ BTC_TRACE(trace_buf); ++ ++ if ((BT_8723D_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8723D_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ bt_busy = true; ++ else ++ bt_busy = false; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++} ++ ++ ++void halbtc8723d1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ h2c_parameter[0] = ++ 0x1; /* enable BT AFH skip WL channel for 8723d because BT Rx LO interference */ ++ /* h2c_parameter[0] = 0x0; */ ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); ++ ++} ++ ++u8 halbtc8723d1ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8723D_1ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (!bt_link_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No BT link exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (bt_link_info->sco_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->hid_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->pan_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 1) { ++ if (bt_link_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_1ANT_COEX_ALGO_SCO; ++ } else { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_1ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_1ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_1ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_1ANT_COEX_ALGO_SCO; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_1ANT_COEX_ALGO_HID_A2DP; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_1ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_1ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_1ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++void halbtc8723d1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8723d1ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ halbtc8723d1ant_set_bt_auto_report(btcoexist, ++ coex_dm->cur_bt_auto_report); ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++void halbtc8723d1ant_set_fw_low_penalty_ra(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++#if 1 ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ ++ ++ if (low_penalty_ra) { ++ h2c_parameter[1] |= BIT(0); ++ h2c_parameter[2] = ++ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ ++ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ ++ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ ++ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); ++#endif ++} ++ ++void halbtc8723d1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++#if 1 ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ ++ halbtc8723d1ant_set_fw_low_penalty_ra(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++#if 0 ++ if (low_penalty_ra) ++ btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 15); ++ else ++ btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 0); ++#endif ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++ ++#endif ++ ++} ++ ++void halbtc8723d1ant_write_score_board( ++ IN struct btc_coexist *btcoexist, ++ IN u16 bitpos, ++ IN boolean state ++) ++{ ++ ++ static u16 originalval = 0x8002; ++ ++ if (state) ++ originalval = originalval | bitpos; ++ else ++ originalval = originalval & (~bitpos); ++ ++ ++ btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); ++ ++} ++ ++void halbtc8723d1ant_read_score_board( ++ IN struct btc_coexist *btcoexist, ++ IN u16 *score_board_val ++) ++{ ++ ++ *score_board_val = (btcoexist->btc_read_2byte(btcoexist, ++ 0xaa)) & 0x7fff; ++} ++ ++void halbtc8723d1ant_post_state_to_bt( ++ IN struct btc_coexist *btcoexist, ++ IN u16 type, ++ IN boolean state ++) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], halbtc8723d1ant_post_state_to_bt: type = %d, state =%d\n", ++ type, state); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_write_score_board(btcoexist, (u16) type, state); ++} ++ ++boolean halbtc8723d1ant_is_wifibt_status_changed(IN struct btc_coexist ++ *btcoexist) ++{ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false, pre_bt_off = false, pre_bt_slave = false; ++ static u8 pre_hid_busy_num = 0, pre_wl_noisy_level = 0; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (coex_sta->bt_disabled != pre_bt_off) { ++ pre_bt_off = coex_sta->bt_disabled; ++ ++ if (coex_sta->bt_disabled) ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!\n"); ++ else ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is enabled !!\n"); ++ ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->bt_coex_supported_feature = 0; ++ coex_sta->bt_coex_supported_version = 0; ++ coex_sta->bt_ble_scan_type = 0; ++ coex_sta->bt_ble_scan_para[0] = 0; ++ coex_sta->bt_ble_scan_para[1] = 0; ++ coex_sta->bt_ble_scan_para[2] = 0; ++ coex_sta->bt_reg_vendor_ac = 0xffff; ++ coex_sta->bt_reg_vendor_ae = 0xffff; ++ return true; ++ } ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ ++ if (wifi_busy) ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, true); ++ else ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, false); ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ if (coex_sta->wl_noisy_level != pre_wl_noisy_level) { ++ pre_wl_noisy_level = coex_sta->wl_noisy_level; ++ return true; ++ } ++ } ++ ++ if (!coex_sta->bt_disabled) { ++ if (coex_sta->hid_busy_num != pre_hid_busy_num) { ++ pre_hid_busy_num = coex_sta->hid_busy_num; ++ return true; ++ } ++ } ++ ++ if (bt_link_info->slave_role != pre_bt_slave) { ++ pre_bt_slave = bt_link_info->slave_role; ++ return true; ++ } ++ ++ return false; ++} ++ ++void halbtc8723d1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ u16 u16tmp; ++ ++ /* This function check if bt is disabled */ ++#if 0 ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ ++ ++#else ++ ++ /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */ ++ halbtc8723d1ant_read_score_board(btcoexist, &u16tmp); ++ ++ bt_active = u16tmp & BIT(1); ++ ++ ++#endif ++ ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ } else { ++ ++ bt_disable_cnt++; ++ if (bt_disable_cnt >= 2) { ++ bt_disabled = true; ++ bt_disable_cnt = 2; ++ } ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ } ++ ++ if (bt_disabled) ++ halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); ++ else ++ halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, true); ++ ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_disabled = bt_disabled; ++ } ++ ++} ++ ++ ++ ++void halbtc8723d1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, ++ boolean isenable) ++{ ++#if BT_8723D_1ANT_COEX_DBG ++ if (isenable) { ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); ++ ++ /* enable GNT_BT to GPIO debug */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); ++ ++ /* 0x48[20] = 0 for GPIO14 = GNT_WL*/ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x0); ++ /* 0x40[17] = 0 for GPIO14 = GNT_WL*/ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, 0x02, 0x0); ++ ++ /* 0x66[9] = 0 for GPIO15 = GNT_B T*/ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x02, 0x0); ++ /* 0x66[7] = 0 ++ for GPIO15 = GNT_BT*/ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, 0x80, 0x0); ++ /* 0x8[8] = 0 for GPIO15 = GNT_BT*/ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x9, 0x1, 0x0); ++ ++ /* BT Vendor Reg 0x76[0] = 0 for GPIO15 = GNT_BT, this is not set here*/ ++ } else { ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); ++ ++ /* Disable GNT_BT debug to GPIO, and enable chip_wakeup_host */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x1); ++ ++ /* 0x48[20] = 0 for GPIO14 = GNT_WL*/ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x1); ++ } ++ ++#endif ++} ++ ++u32 halbtc8723d1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, ++ IN u16 reg_addr) ++{ ++ u32 j = 0, delay_count = 0; ++ ++ ++ /* wait for ready bit before access 0x7c0 */ ++ btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0x800F0000 | reg_addr); ++ ++ while (1) { ++ if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { ++ delay_ms(50); ++ delay_count++; ++ if (delay_count >= 10) { ++ delay_count = 0; ++ break; ++ } ++ } else ++ break; ++ } ++ ++ return btcoexist->btc_read_4byte(btcoexist, ++ 0x7c8); /* get read data */ ++ ++} ++ ++void halbtc8723d1ant_ltecoex_indirect_write_reg(IN struct btc_coexist ++ *btcoexist, ++ IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) ++{ ++ u32 val, i = 0, j = 0, bitpos = 0, delay_count = 0; ++ ++ ++ if (bit_mask == 0x0) ++ return; ++ if (bit_mask == 0xffffffff) { ++ btcoexist->btc_write_4byte(btcoexist, 0x7c4, ++ reg_value); /* put write data */ ++ ++ /* wait for ready bit before access 0x7c0 */ ++ while (1) { ++ if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { ++ delay_ms(50); ++ delay_count++; ++ if (delay_count >= 10) { ++ delay_count = 0; ++ break; ++ } ++ } else ++ break; ++ } ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x7c0, ++ 0xc00F0000 | reg_addr); ++ } else { ++ for (i = 0; i <= 31; i++) { ++ if (((bit_mask >> i) & 0x1) == 0x1) { ++ bitpos = i; ++ break; ++ } ++ } ++ ++ /* read back register value before write */ ++ val = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, ++ reg_addr); ++ val = (val & (~bit_mask)) | (reg_value << bitpos); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x7c4, ++ val); /* put write data */ ++ ++ /* wait for ready bit before access 0x7c0 */ ++ while (1) { ++ if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { ++ delay_ms(50); ++ delay_count++; ++ if (delay_count >= 10) { ++ delay_count = 0; ++ break; ++ } ++ } else ++ break; ++ } ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x7c0, ++ 0xc00F0000 | reg_addr); ++ ++ } ++ ++} ++ ++void halbtc8723d1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 val; ++ ++ val = (enable) ? 1 : 0; ++ halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, ++ val); /* 0x38[7] */ ++ ++} ++ ++void halbtc8723d1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_control) ++{ ++ u8 val; ++ ++ val = (wifi_control) ? 1 : 0; ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, ++ val); /* 0x70[26] */ ++ ++} ++ ++void halbtc8723d1ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, ++ IN u8 control_block, IN boolean sw_control, IN u8 state) ++{ ++ u32 val = 0, val_orig = 0; ++ ++ if (!sw_control) ++ val = 0x0; ++ else if (state & 0x1) ++ val = 0x3; ++ else ++ val = 0x1; ++ ++ val_orig = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x38); ++ ++ switch (control_block) { ++ case BT_8723D_1ANT_GNT_BLOCK_RFC_BB: ++ default: ++ val = ((val << 14) | (val << 10)) | (val_orig & 0xffff33ff); ++ break; ++ case BT_8723D_1ANT_GNT_BLOCK_RFC: ++ val = (val << 14) | (val_orig & 0xffff3fff); ++ break; ++ case BT_8723D_1ANT_GNT_BLOCK_BB: ++ val = (val << 10) | (val_orig & 0xfffff3ff); ++ break; ++ } ++ ++ halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, 0xffffffff, val); ++} ++ ++ ++void halbtc8723d1ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, ++ IN u8 control_block, IN boolean sw_control, IN u8 state) ++{ ++ u32 val = 0, val_orig = 0; ++ ++ if (!sw_control) ++ val = 0x0; ++ else if (state & 0x1) ++ val = 0x3; ++ else ++ val = 0x1; ++ ++ val_orig = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x38); ++ ++ switch (control_block) { ++ case BT_8723D_1ANT_GNT_BLOCK_RFC_BB: ++ default: ++ val = ((val << 12) | (val << 8)) | (val_orig & 0xffffccff); ++ break; ++ case BT_8723D_1ANT_GNT_BLOCK_RFC: ++ val = (val << 12) | (val_orig & 0xffffcfff); ++ break; ++ case BT_8723D_1ANT_GNT_BLOCK_BB: ++ val = (val << 8) | (val_orig & 0xfffffcff); ++ break; ++ } ++ ++ halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, ++ 0xffffffff, val); ++} ++ ++ ++void halbtc8723d1ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u8 table_type, IN u16 table_content) ++{ ++ u16 reg_addr = 0x0000; ++ ++ switch (table_type) { ++ case BT_8723D_1ANT_CTT_WL_VS_LTE: ++ reg_addr = 0xa0; ++ break; ++ case BT_8723D_1ANT_CTT_BT_VS_LTE: ++ reg_addr = 0xa4; ++ break; ++ } ++ ++ if (reg_addr != 0x0000) ++ halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, ++ 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ ++ ++ ++} ++ ++ ++void halbtc8723d1ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, ++ IN u8 table_type, IN u8 table_content) ++{ ++ u16 reg_addr = 0x0000; ++ ++ switch (table_type) { ++ case BT_8723D_1ANT_LBTT_WL_BREAK_LTE: ++ reg_addr = 0xa8; ++ break; ++ case BT_8723D_1ANT_LBTT_BT_BREAK_LTE: ++ reg_addr = 0xac; ++ break; ++ case BT_8723D_1ANT_LBTT_LTE_BREAK_WL: ++ reg_addr = 0xb0; ++ break; ++ case BT_8723D_1ANT_LBTT_LTE_BREAK_BT: ++ reg_addr = 0xb4; ++ break; ++ } ++ ++ if (reg_addr != 0x0000) ++ halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, ++ 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ ++ ++} ++ ++void halbtc8723d1ant_set_wltoggle_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 interval, ++ IN u8 val0x6c4_b0, IN u8 val0x6c4_b1, IN u8 val0x6c4_b2, ++ IN u8 val0x6c4_b3) ++{ ++ static u8 pre_h2c_parameter[6] = {0}; ++ u8 cur_h2c_parameter[6] = {0}; ++ u8 i, match_cnt = 0; ++ ++ cur_h2c_parameter[0] = 0x7; /* op_code, 0x7= wlan toggle slot*/ ++ ++ cur_h2c_parameter[1] = interval; ++ cur_h2c_parameter[2] = val0x6c4_b0; ++ cur_h2c_parameter[3] = val0x6c4_b1; ++ cur_h2c_parameter[4] = val0x6c4_b2; ++ cur_h2c_parameter[5] = val0x6c4_b3; ++ ++ if (!force_exec) { ++ for (i = 1; i <= 5; i++) { ++ if (cur_h2c_parameter[i] != pre_h2c_parameter[i]) ++ break; ++ ++ match_cnt++; ++ } ++ ++ if (match_cnt == 5) ++ return; ++ } ++ ++ for (i = 1; i <= 5; i++) ++ pre_h2c_parameter[i] = cur_h2c_parameter[i]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, cur_h2c_parameter); ++} ++ ++ ++void halbtc8723d1ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8723d1ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ ++ halbtc8723d1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8723d1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ u32 break_table; ++ u8 select_table; ++ ++ coex_sta->coex_table_type = type; ++ ++ if (coex_sta->concurrent_rx_mode_on == true) { ++ break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ ++ select_table = ++ 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ ++ } else { ++ break_table = 0xffffff; ++ select_table = 0x3; ++ } ++ ++ switch (type) { ++ case 0: ++ halbtc8723d1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x55555555, break_table, ++ select_table); ++ break; ++ case 1: ++ halbtc8723d1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, break_table, ++ select_table); ++ break; ++ case 2: ++ halbtc8723d1ant_coex_table(btcoexist, force_exec, ++ 0xaa5a5a5a, 0xaa5a5a5a, break_table, ++ select_table); ++ break; ++ case 3: ++ halbtc8723d1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, break_table, ++ select_table); ++ break; ++ case 4: ++ halbtc8723d1ant_coex_table(btcoexist, force_exec, ++ 0xa5555555, 0x5a5a5a5a, break_table, ++ select_table); ++ break; ++ case 5: ++ halbtc8723d1ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0x5a5a5a5a, break_table, ++ select_table); ++ break; ++ case 6: ++ halbtc8723d1ant_coex_table(btcoexist, force_exec, ++ 0xa5555555, 0x5a5a5a5a, break_table, ++ select_table); ++ break; ++ case 7: ++ halbtc8723d1ant_coex_table(btcoexist, force_exec, ++ 0xaa555555, 0xaa555555, break_table, ++ select_table); ++ break; ++ case 8: ++ halbtc8723d1ant_coex_table(btcoexist, force_exec, ++ 0xa5555555, 0xaaaaaaaa, break_table, ++ select_table); ++ break; ++ case 9: ++ halbtc8723d1ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0xaaaa5aaa, break_table, ++ select_table); ++ break; ++ case 10: ++ halbtc8723d1ant_coex_table(btcoexist, force_exec, ++ 0xaaaaaaaa, 0xaaaaaaaa, break_table, ++ select_table); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8723d1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ if (enable) { ++ h2c_parameter[0] |= BIT(0); /* function enable */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); ++} ++ ++void halbtc8723d1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ halbtc8723d1ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8723d1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8723d1ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8723d1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8723d1ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ /*halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); */ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, ++ h2c_parameter); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ /*halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8);*/ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, ++ h2c_parameter); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++void halbtc8723d1ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ boolean low_pwr_disable = false; ++ ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ /* recover to original 32k low power setting */ ++ coex_sta->force_lps_on = false; ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ ++ break; ++ case BTC_PS_LPS_ON: ++ coex_sta->force_lps_on = true; ++ halbtc8723d1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8723d1ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ /* when coex force to enter LPS, do not enter 32k low power. */ ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ ++ break; ++ case BTC_PS_LPS_OFF: ++ coex_sta->force_lps_on = false; ++ halbtc8723d1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, false); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ ++ break; ++ default: ++ break; ++ } ++} ++ ++ ++void halbtc8723d1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ u8 real_byte1 = byte1, real_byte5 = byte5; ++ boolean ap_enable = false; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ if (byte5 & BIT(2)) ++ coex_sta->is_tdma_btautoslot = true; ++ else ++ coex_sta->is_tdma_btautoslot = false; ++ ++ /* release bt-auto slot for auto-slot hang is detected!! */ ++ if (coex_sta->is_tdma_btautoslot) ++ if ((coex_sta->is_tdma_btautoslot_hang) || ++ (bt_link_info->slave_role)) ++ byte5 = byte5 & 0xfb; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], FW for AP mode\n"); ++ BTC_TRACE(trace_buf); ++ real_byte1 &= ~BIT(4); ++ real_byte1 |= BIT(5); ++ ++ real_byte5 |= BIT(5); ++ real_byte5 &= ~BIT(6); ++ ++ halbtc8723d1ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ ++ halbtc8723d1ant_power_save_state( ++ btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } else { ++ halbtc8723d1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, ++ 0x0); ++ } ++ ++ ++ h2c_parameter[0] = real_byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = real_byte5; ++ ++ coex_dm->ps_tdma_para[0] = real_byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = real_byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++ ++void halbtc8723d1ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ boolean wifi_busy = false; ++ static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; ++ static boolean pre_wifi_busy = false; ++ ++ ++#if BT_8723D_1ANT_ANTDET_ENABLE ++ ++ if (board_info->btdm_ant_num_by_ant_det == 2) { ++#if 0 ++ if (turn_on) ++ type = type + ++ 100; ++#endif ++ } ++ ++#endif ++ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (wifi_busy != pre_wifi_busy) { ++ force_exec = true; ++ pre_wifi_busy = wifi_busy; ++ } ++ ++ /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ ++ if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) ++ psTdmaByte4Modify = 0x1; ++ else ++ psTdmaByte4Modify = 0x0; ++ ++ if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { ++ ++ force_exec = true; ++ pre_psTdmaByte4Modify = psTdmaByte4Modify; ++ } ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ return; ++ } ++ ++ if (coex_dm->cur_ps_tdma_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(on, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, ++ 0x1); /* enable TBTT nterrupt */ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(off, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } ++ ++ ++ if (turn_on) { ++ switch (type) { ++ default: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x35, 0x03, 0x11, 0x11); ++ break; ++ case 3: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x3a, 0x03, 0x10, 0x50); ++ break; ++ case 4: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x21, 0x03, 0x10, 0x50); ++ break; ++ case 5: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x15, 0x03, 0x11, 0x11); ++ break; ++ case 6: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x20, 0x03, 0x11, 0x11); ++ break; ++ case 7: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x10, 0x03, 0x10, 0x54 | ++ psTdmaByte4Modify); ++ break; ++ case 8: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x10, 0x03, 0x10, 0x54 | ++ psTdmaByte4Modify); ++ break; ++ case 9: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x55, 0x10, 0x03, 0x10, 0x54 | ++ psTdmaByte4Modify); ++ break; ++ case 10: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x30, 0x03, 0x11, 0x10); ++ break; ++ case 11: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x65, 0x25, 0x03, 0x11, 0x11 | ++ psTdmaByte4Modify); ++ break; ++ case 12: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x55, 0x30, 0x03, 0x10, 0x50 | ++ psTdmaByte4Modify); ++ break; ++ case 13: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x25, 0x03, 0x10, 0x50 | ++ psTdmaByte4Modify); ++ break; ++ case 14: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x15, 0x03, 0x10, 0x50 | ++ psTdmaByte4Modify); ++ break; ++ case 15: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x20, 0x03, 0x10, 0x50 | ++ psTdmaByte4Modify); ++ break; ++ case 16: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x10, 0x03, 0x11, 0x15 | ++ psTdmaByte4Modify); ++ break; ++ case 17: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x10, 0x03, 0x11, 0x14); ++ break; ++ case 18: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x30, 0x03, 0x10, 0x50 | ++ psTdmaByte4Modify); ++ break; ++ case 19: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x15, 0x03, 0x11, 0x10); ++ break; ++ case 20: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x30, 0x03, 0x11, 0x10); ++ break; ++ case 21: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x30, 0x03, 0x11, 0x10); ++ break; ++ case 22: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x25, 0x03, 0x11, 0x10); ++ break; ++ case 23: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x10, 0x03, 0x11, 0x10); ++ break; ++ case 27: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x10, 0x03, 0x11, 0x15); ++ break; ++ case 32: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x35, 0x03, 0x11, 0x11); ++ break; ++ case 33: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x35, 0x03, 0x11, 0x10); ++ break; ++ case 57: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x10, 0x03, 0x10, 0x50 | ++ psTdmaByte4Modify); ++ break; ++ case 58: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x10, 0x03, 0x10, 0x50 | ++ psTdmaByte4Modify); ++ break; ++ case 67: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x10, 0x03, 0x11, 0x10 | ++ psTdmaByte4Modify); ++ break; ++ /* 1-Ant to 2-Ant TDMA case */ ++ case 103: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x3a, 0x03, 0x70, 0x10); ++ break; ++ case 104: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x21, 0x03, 0x70, 0x10); ++ break; ++ case 105: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x15, 0x03, 0x71, 0x11); ++ break; ++ case 106: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x20, 0x03, 0x71, 0x11); ++ break; ++ case 107: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x10, 0x03, 0x70, 0x14 | ++ psTdmaByte4Modify); ++ break; ++ case 108: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x10, 0x03, 0x70, 0x14 | ++ psTdmaByte4Modify); ++ break; ++ case 113: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x25, 0x03, 0x70, 0x10 | ++ psTdmaByte4Modify); ++ break; ++ case 114: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x15, 0x03, 0x70, 0x10 | ++ psTdmaByte4Modify); ++ break; ++ case 115: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x20, 0x03, 0x70, 0x10 | ++ psTdmaByte4Modify); ++ break; ++ case 117: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x10, 0x03, 0x71, 0x14 | ++ psTdmaByte4Modify); ++ break; ++ case 119: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x15, 0x03, 0x71, 0x10); ++ break; ++ case 120: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x30, 0x03, 0x71, 0x10); ++ break; ++ case 121: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x30, 0x03, 0x71, 0x10); ++ break; ++ case 122: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x25, 0x03, 0x71, 0x10); ++ break; ++ case 132: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x35, 0x03, 0x71, 0x11); ++ break; ++ case 133: ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x35, 0x03, 0x71, 0x10); ++ break; ++ } ++ } else { ++ ++ /* disable PS tdma */ ++ switch (type) { ++ case 8: /* PTA Control */ ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x8, ++ 0x0, 0x0, 0x0, 0x0); ++ break; ++ case 0: ++ default: /* Software control, Antenna at BT side */ ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x0, 0x0); ++ break; ++ case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ ++ halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x48, 0x0); ++ break; ++ } ++ } ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++ ++void halbtc8723d1ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean force_exec, ++ IN u8 phase) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u32 cnt_bt_cal_chk = 0; ++ boolean is_in_mp_mode = false, is_hw_ant_div_on = false; ++ u8 u8tmp0 = 0, u8tmp1 = 0; ++ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; ++ u16 u16tmp0, u16tmp1 = 0; ++ ++#if BT_8723D_1ANT_ANTDET_ENABLE ++ ++ if (ant_pos_type == BTC_ANT_PATH_PTA) { ++ if ((board_info->btdm_ant_det_finish) && ++ (board_info->btdm_ant_num_by_ant_det == 2)) { ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ ant_pos_type = BTC_ANT_PATH_WIFI; ++ else ++ ant_pos_type = BTC_ANT_PATH_BT; ++ } ++ } ++ ++#endif ++ ++ u32tmp1 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x38); ++ ++ /* To avoid indirect access fail */ ++ if (((u32tmp1 & 0xf000) >> 12) != ((u32tmp1 & 0x0f00) >> 8)) { ++ force_exec = true; ++ coex_sta->gnt_error_cnt++; ++ } ++ ++#if BT_8723D_1ANT_COEX_DBG ++ u32tmp2 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa); ++ u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); ++ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before Set Ant Pat)\n", ++ u8tmp0, u16tmp1, u8tmp1); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa = 0x%x(Before Set Ant Path)\n", ++ u32tmp1, u32tmp2, u16tmp0); ++ BTC_TRACE(trace_buf); ++#endif ++ ++ coex_dm->cur_ant_pos_type = ant_pos_type; ++ ++ if (!force_exec) { ++ if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** Skip Antenna Path Setup because no change!!**********\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ } ++ ++ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; ++ ++ ++ switch (phase) { ++ case BT_8723D_1ANT_PHASE_COEX_POWERON: ++ /* Set Path control to WL */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, ++ 0x80, 0x0); ++ ++ /* set Path control owner to WL at initial step */ ++ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8723D_1ANT_PCO_BTSIDE); ++ ++ /* set GNT_BT to SW high */ ++ halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to SW low */ ++ halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_BT; ++ ++ coex_sta->run_time_state = false; ++ ++ break; ++ case BT_8723D_1ANT_PHASE_COEX_INIT: ++ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ ++ halbtc8723d1ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8723d1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8723D_1ANT_CTT_WL_VS_LTE, 0xffff); ++ ++ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8723d1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8723D_1ANT_CTT_BT_VS_LTE, 0xffff); ++ ++ /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ ++ while (cnt_bt_cal_chk <= 20) { ++ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, ++ 0x49d); ++ cnt_bt_cal_chk++; ++ if (u8tmp0 & BIT(0)) { ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ delay_ms(50); ++ } else { ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** WL is NOT calibrating (wait cnt=%d)**********\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ break; ++ } ++ } ++ ++ /* Set Path control to WL */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, ++ 0x80, 0x1); ++ ++ /* set Path control owner to WL at initial step */ ++ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8723D_1ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW high */ ++ halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to SW low */ ++ halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_BT; ++ ++ coex_sta->run_time_state = false; ++ break; ++ case BT_8723D_1ANT_PHASE_WLANONLY_INIT: ++ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ ++ halbtc8723d1ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8723d1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8723D_1ANT_CTT_WL_VS_LTE, 0xffff); ++ ++ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8723d1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8723D_1ANT_CTT_BT_VS_LTE, 0xffff); ++ ++ /* Set Path control to WL */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, ++ 0x80, 0x1); ++ ++ /* set Path control owner to WL at initial step */ ++ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8723D_1ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW low */ ++ halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_1ANT_SIG_STA_SET_TO_LOW); ++ /* Set GNT_WL to SW high */ ++ halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_WIFI; ++ ++ coex_sta->run_time_state = false; ++ break; ++ case BT_8723D_1ANT_PHASE_WLAN_OFF: ++ /* Disable LTE Coex Function in WiFi side */ ++ halbtc8723d1ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* Set Path control to BT */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, ++ 0x80, 0x0); ++ ++ /* set Path control owner to BT */ ++ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8723D_1ANT_PCO_BTSIDE); ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_BT; ++ ++ coex_sta->run_time_state = false; ++ break; ++ case BT_8723D_1ANT_PHASE_2G_RUNTIME: ++ ++ /* wait for WL/BT IQK finish, keep 0x38 = 0xff00 for WL IQK */ ++ while (cnt_bt_cal_chk <= 20) { ++ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, ++ 0x1e6); ++ ++ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, ++ 0x49d); ++ ++ cnt_bt_cal_chk++; ++ if ((u8tmp0 & BIT(0)) || (u8tmp1 & BIT(0))) { ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "[BTCoex], ########### WL or BT is IQK (wait cnt=%d)\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ delay_ms(50); ++ } else { ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** WL and BT is NOT IQK (wait cnt=%d)\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ break; ++ } ++ } ++ ++ ++ /* Set Path control to WL */ ++ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x1); */ ++ ++ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8723D_1ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to PTA */ ++ halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_PTA, ++ BT_8723D_1ANT_SIG_STA_SET_BY_HW); ++ /* Set GNT_WL to PTA */ ++ halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_PTA, ++ BT_8723D_1ANT_SIG_STA_SET_BY_HW); ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_PTA; ++ ++ coex_sta->run_time_state = true; ++ break; ++ case BT_8723D_1ANT_PHASE_BTMPMODE: ++ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8723D_1ANT_PCO_WLSIDE); ++ ++ /* Set Path control to WL */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, ++ 0x80, 0x1); ++ ++ /* set GNT_BT to high */ ++ halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to low */ ++ halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_1ANT_SIG_STA_SET_TO_LOW); ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_BT; ++ ++ coex_sta->run_time_state = false; ++ break; ++ case BT_8723D_1ANT_PHASE_ANTENNA_DET: ++ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8723D_1ANT_PCO_WLSIDE); ++ ++ /* Set Path control to WL */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, ++ 0x80, 0x1); ++ ++ /* set GNT_BT to high */ ++ halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to high */ ++ halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_BT; ++ ++ coex_sta->run_time_state = false; ++ ++ break; ++ } ++ ++ ++ is_hw_ant_div_on = board_info->ant_div_cfg; ++ ++ if ((is_hw_ant_div_on) && (phase != BT_8723D_1ANT_PHASE_ANTENNA_DET)) ++ ++ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) ++ /* 0x948 = 0x200, 0x0 while antenna diversity */ ++ btcoexist->btc_write_2byte(btcoexist, 0x948, 0x100); ++ else /* 0x948 = 0x80, 0x0 while antenna diversity */ ++ btcoexist->btc_write_2byte(btcoexist, 0x948, 0x40); ++ ++ else if ((is_hw_ant_div_on == false) && ++ (phase != BT_8723D_1ANT_PHASE_WLAN_OFF)) { /* internal switch setting */ ++ ++ switch (ant_pos_type) { ++ ++ case BTC_ANT_PATH_WIFI: ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ ++ btcoexist->btc_write_2byte( ++ btcoexist, 0x948, 0x0); ++ else ++ btcoexist->btc_write_2byte( ++ btcoexist, 0x948, 0x280); ++ ++ break; ++ case BTC_ANT_PATH_BT: ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ ++ btcoexist->btc_write_2byte( ++ btcoexist, 0x948, 0x280); ++ else ++ btcoexist->btc_write_2byte( ++ btcoexist, 0x948, 0x0); ++ ++ break; ++ default: ++ case BTC_ANT_PATH_PTA: ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ btcoexist->btc_write_2byte( ++ btcoexist, 0x948, ++ 0x200); ++ else ++ btcoexist->btc_write_2byte( ++ btcoexist, 0x948, 0x80); ++ break; ++ } ++ } ++ ++ ++#if BT_8723D_1ANT_COEX_DBG ++ u32tmp1 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa); ++ u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); ++ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(After Set Ant Pat)\n", ++ u8tmp0, u16tmp1, u8tmp1); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa = 0x%x(After Set Ant Path)\n", ++ u32tmp1, u32tmp2, u16tmp0); ++ BTC_TRACE(trace_buf); ++#endif ++ ++} ++ ++ ++boolean halbtc8723d1ant_is_common_action(IN struct btc_coexist *btcoexist) ++{ ++ boolean common = false, wifi_connected = false, wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (!wifi_connected && ++ BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ common = true; ++ } else if (wifi_connected && ++ (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ common = true; ++ } else if (wifi_connected && ++ (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE != ++ coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ common = true; ++ } else { ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ common = false; ++ } ++ ++ return common; ++} ++ ++ ++/* ********************************************* ++ * ++ * Non-Software Coex Mechanism start ++ * ++ * ********************************************* */ ++void halbtc8723d1ant_action_bt_whql_test(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8723d1ant_action_bt_hs(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8723d1ant_action_bt_relink(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ coex_sta->bt_relink_downcount = 2; ++} ++ ++void halbtc8723d1ant_action_bt_idle(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (!wifi_busy) { ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ } else { ++ /* if wl busy */ ++ if (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 8); ++ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); ++ } else { ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ } ++} ++ ++} ++ ++void halbtc8723d1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, wifi_busy = false, bt_busy = false; ++ boolean wifi_scan = false, wifi_link = false, wifi_roam = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); ++ ++ ++ if ((coex_sta->bt_create_connection) && ((wifi_link) || (wifi_roam) ++ || (wifi_scan) || (wifi_busy) || (coex_sta->wifi_is_high_pri_task))) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi link/roam/Scan/busy/hi-pri-task + BT Inq/Page!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ ++ if ((bt_link_info->a2dp_exist) && (!bt_link_info->pan_exist)) ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 17); ++ else ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); ++ } else if ((!wifi_connected) && (!wifi_scan)) { ++ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if (bt_link_info->pan_exist) { ++ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ } else if (bt_link_info->a2dp_exist) { ++ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 16); ++ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ ++ if ((wifi_link) || (wifi_roam) || (wifi_scan) || (wifi_busy) ++ || (coex_sta->wifi_is_high_pri_task)) ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); ++ else ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); ++ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } ++} ++ ++ ++void halbtc8723d1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, wifi_busy = false; ++ u32 wifi_bw = 1; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, ++ &wifi_bw); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ ++ if (bt_link_info->sco_exist) { ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 5); ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 5); ++ } else if (coex_sta->hid_busy_num >= 2) { ++ /*for 4/18 hid */ ++ /* if 11bg mode */ ++ if (wifi_bw == 0) { ++ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 6); ++ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x1, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 11); ++ } else { ++ ++ if (wifi_busy) { ++ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 6); ++ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x2, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 11); ++ } else { ++ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 6); ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 3); ++ ++ } ++ } ++ } else { ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 6); ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 3); ++ } ++} ++ ++ ++void halbtc8723d1ant_action_wifi_only(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ /* halbtc8723d1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 10); ++} ++ ++void halbtc8723d1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ ++ if ((BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) || ++ (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status)) ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ else if (!bt_link_info->pan_exist) ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ else ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8723d1ant_action_wifi_linkscan_process(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ if (bt_link_info->pan_exist) { ++ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ } else if (bt_link_info->a2dp_exist) { ++ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 27); ++ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); ++ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } ++} ++ ++void halbtc8723d1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_busy = false, wifi_turbo = false; ++ u32 wifi_bw = 1; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], scan_ap_num = %d, wl_noisy_level = %d\n", ++ coex_sta->scan_ap_num, coex_sta->wl_noisy_level); ++ BTC_TRACE(trace_buf); ++ ++#if 1 ++ if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) ++ wifi_turbo = true; ++#endif ++ ++ if ((coex_sta->bt_relink_downcount != 0) ++ && (!bt_link_info->pan_exist) && (wifi_busy)) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); ++ BTC_TRACE(trace_buf); ++ ++ /*halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32);*/ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ } else if (bt_link_info->a2dp_only) { /* A2DP */ ++ if (!wifi_busy) { ++ /*halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32);*/ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 27); ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else { ++ ++ if (coex_sta->wl_noisy_level == 2) ++ halbtc8723d1ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 17); ++ else ++ halbtc8723d1ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ ++ if (wifi_turbo) ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 8); ++ else ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else if (((bt_link_info->a2dp_exist) && ++ (bt_link_info->pan_exist)) || ++ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ ++ ++ if ((bt_link_info->hid_exist) && (coex_sta->hid_busy_num >= 2)) { ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 6); ++ if (wifi_bw == 0) /* 11bg mode */ ++ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x1, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ else ++ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x2, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 12); ++ } else if (wifi_busy) { ++ if (((coex_sta->a2dp_bit_pool > 40) && ++ (coex_sta->a2dp_bit_pool < 255)) || ++ (!coex_sta->is_A2DP_3M)) ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 15); ++ else if (wifi_turbo) ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 18); ++ else ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 13); ++ } else ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 14); ++ ++ if (bt_link_info->hid_exist) ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ else if (wifi_turbo) ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 8); ++ else ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { /* HID+A2DP */ ++ ++ if ((wifi_busy) && (coex_sta->hid_busy_num >= 2)) { /*for 4/18 hid */ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 6); ++ if (wifi_bw == 0) /* 11bg mode */ ++ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x1, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ else ++ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x2, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 9); ++ } else { ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 8); ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ } ++ ++ } else if ((bt_link_info->pan_only) ++ || (bt_link_info->hid_exist && bt_link_info->pan_exist)) { ++ /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ ++ ++ if ((bt_link_info->hid_exist) && (bt_link_info->pan_exist) && ++ (coex_sta->hid_busy_num >= 2)) { ++ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 6); ++ if (wifi_bw == 0) /* 11bg mode */ ++ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x1, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ else ++ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x2, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 12); ++ } else { ++ if (!wifi_busy) ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 4); ++ else ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 3); ++ ++ if (bt_link_info->hid_exist) ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ else if (wifi_turbo) ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 8); ++ else ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else { ++ /* BT no-profile busy (0x9) */ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } ++} ++ ++void halbtc8723d1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) ++{ ++ /* tdma and coex table */ ++ halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++ ++void halbtc8723d1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_busy = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ ++ if (BT_8723D_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ ++ if (bt_link_info->hid_only) /* HID only */ ++ halbtc8723d1ant_action_bt_sco_hid_only_busy(btcoexist); ++ else ++ halbtc8723d1ant_action_wifi_connected_bt_acl_busy(btcoexist); ++ ++ } else if ((BT_8723D_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8723d1ant_action_bt_sco_hid_only_busy(btcoexist); ++ } else ++ halbtc8723d1ant_action_bt_idle(btcoexist); ++} ++ ++ ++void halbtc8723d1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ u8 algorithm = 0; ++ ++ algorithm = halbtc8723d1ant_action_algorithm(btcoexist); ++ coex_dm->cur_algorithm = algorithm; ++ ++ if (halbtc8723d1ant_is_common_action(btcoexist)) { ++ ++ } else { ++ switch (coex_dm->cur_algorithm) { ++ case BT_8723D_1ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ break; ++ case BT_8723D_1ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ break; ++ case BT_8723D_1ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ break; ++ case BT_8723D_1ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ break; ++ case BT_8723D_1ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ break; ++ case BT_8723D_1ANT_COEX_ALGO_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HS mode.\n"); ++ BTC_TRACE(trace_buf); ++ break; ++ case BT_8723D_1ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ break; ++ case BT_8723D_1ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ break; ++ case BT_8723D_1ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ break; ++ case BT_8723D_1ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = coexist All Off!!\n"); ++ BTC_TRACE(trace_buf); ++ break; ++ } ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ } ++} ++ ++ ++void halbtc8723d1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ boolean increase_scan_dev_num = false; ++ boolean bt_ctrl_agg_buf_size = false; ++ boolean miracast_plus_bt = false, wifi_under_5g = false; ++ u8 agg_buf_size = 5; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0, wifi_bw; ++ u8 iot_peer = BTC_IOT_PEER_UNKNOWN; ++ boolean scan = false, link = false, roam = false, under_4way = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (!coex_sta->run_time_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], return for run_time_state = false !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->freeze_coexrun_by_btinfo) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), return for freeze_coexrun_by_btinfo\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->bt_whck_test) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under WHCK TEST!!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d1ant_action_bt_whql_test(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!!\n"); ++ halbtc8723d1ant_action_wifi_only(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under inquiry/page scan !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d1ant_action_bt_inquiry(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->is_setupLink) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is re-link !!!\n"); ++ halbtc8723d1ant_action_bt_relink(btcoexist); ++ return; ++ } ++ ++ if ((BT_8723D_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8723D_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ increase_scan_dev_num = true; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, ++ &increase_scan_dev_num); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if ((num_of_wifi_link >= 2) || ++ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", ++ num_of_wifi_link, wifi_link_status); ++ BTC_TRACE(trace_buf); ++ ++ if (bt_link_info->bt_link_exist) ++ miracast_plus_bt = true; ++ else ++ miracast_plus_bt = false; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ ++ halbtc8723d1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ false, 0x5); ++ ++ if (scan || link || roam || under_4way) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], scan = %d, link = %d, roam = %d 4way = %d!!!\n", ++ scan, link, roam, under_4way); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under linkscan process + Multi-Port !!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_action_wifi_linkscan_process(btcoexist); ++ } else ++ ++ halbtc8723d1ant_action_wifi_multi_port(btcoexist); ++ ++ return; ++ } else { ++ ++ miracast_plus_bt = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); ++ ++ if (BTC_IOT_PEER_CISCO == iot_peer) { ++ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ halbtc8723d1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, true, 0x10); ++ else ++ halbtc8723d1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, true, 0x8); ++ } else ++ halbtc8723d1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x5); ++ } ++ ++ halbtc8723d1ant_run_sw_coexist_mechanism( ++ btcoexist); /* just print debug message */ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is hs\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d1ant_action_bt_hs(btcoexist); ++ return; ++ } ++ ++ if ((BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) || ++ (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is idle\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d1ant_action_bt_idle(btcoexist); ++ return; ++ } ++ ++ if (scan || link || roam || under_4way) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], scan = %d, link = %d, roam = %d 4way = %d!!!\n", ++ scan, link, roam, under_4way); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under linkscan process!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_action_wifi_linkscan_process(btcoexist); ++ } else if (wifi_connected) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under connected!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_action_wifi_connected(btcoexist); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under not-connected!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_action_wifi_not_connected(btcoexist); ++ } ++} ++ ++ ++void halbtc8723d1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ /* force to reset coex mechanism */ ++ halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->pop_event_cnt = 0; ++ coex_sta->cnt_RemoteNameReq = 0; ++ coex_sta->cnt_ReInit = 0; ++ coex_sta->cnt_setupLink = 0; ++ coex_sta->cnt_IgnWlanAct = 0; ++ coex_sta->cnt_Page = 0; ++ coex_sta->cnt_RoleSwitch = 0; ++ ++ halbtc8723d1ant_query_bt_info(btcoexist); ++} ++ ++void halbtc8723d1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean back_up, IN boolean wifi_only) ++{ ++ u32 u32tmp1 = 0, u32tmp2 = 0; ++ u16 u16tmp1 = 0; ++ u8 u8tmp0 = 0, u8tmp1 = 0; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 i = 0; ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 1Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++#if BT_8723D_1ANT_COEX_DBG ++ u32tmp1 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x38); ++ u32tmp2 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x54); ++ u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); ++ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before init_hw_config)\n", ++ u8tmp0, u16tmp1, u8tmp1); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x (Before init_hw_config)\n", ++ u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++#endif ++ ++ ++ coex_sta->bt_coex_supported_feature = 0; ++ coex_sta->bt_coex_supported_version = 0; ++ coex_sta->bt_ble_scan_type = 0; ++ coex_sta->bt_ble_scan_para[0] = 0; ++ coex_sta->bt_ble_scan_para[1] = 0; ++ coex_sta->bt_ble_scan_para[2] = 0; ++ coex_sta->bt_reg_vendor_ac = 0xffff; ++ coex_sta->bt_reg_vendor_ae = 0xffff; ++ coex_sta->isolation_btween_wb = BT_8723D_1ANT_DEFAULT_ISOLATION; ++ coex_sta->gnt_error_cnt = 0; ++ coex_sta->bt_relink_downcount = 0; ++ ++ for (i = 0; i <= 9; i++) ++ coex_sta->bt_afh_map[i] = 0; ++ ++ /* 0xf0[15:12] --> Chip Cut information */ ++ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, ++ 0xf1) & 0xf0) >> 4; ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, ++ 0x1); /* enable TBTT nterrupt */ ++ ++ /* BT report packet sample rate */ ++ btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); ++ ++ /* Init 0x778 = 0x1 for 1-Ant */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); ++ ++ /* Enable PTA (3-wire function form BT side) */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); ++ ++ /* Enable PTA (tx/rx signal form WiFi side) */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); ++ ++ halbtc8723d1ant_enable_gnt_to_gpio(btcoexist, true); ++ ++#if 0 ++ /* check if WL firmware download ok */ ++ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ONOFF, true); ++#endif ++ ++ /* PTA parameter */ ++ halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ psd_scan->ant_det_is_ant_det_available = true; ++ ++ /* Antenna config */ ++ if (wifi_only) { ++ coex_sta->concurrent_rx_mode_on = false; ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_WLANONLY_INIT); ++ ++ btcoexist->stop_coex_dm = true; ++ } else { ++ /*Set BT polluted packet on for Tx rate adaptive not including Tx retry break by PTA, 0x45c[19] =1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); ++ ++ coex_sta->concurrent_rx_mode_on = true; ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); ++ /* RF 0x1[0] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x1, 0x0); ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_COEX_INIT); ++ ++ btcoexist->stop_coex_dm = false; ++ } ++ ++ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** Single Antenna, Antenna at Main Port: S1**********\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** Single Antenna, Antenna at Aux Port: S0**********\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++} ++ ++u32 halbtc8723d1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) ++{ ++ u8 j; ++ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; ++ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, ++ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, ++ 32, 23, 15, 7, 0 ++ }; ++ ++ if (val == 0) ++ return 0; ++ ++ tmp = val; ++ ++ while (1) { ++ if (tmp == 1) ++ break; ++ else { ++ tmp = (tmp >> 1); ++ shiftcount++; ++ } ++ } ++ ++ ++ val_integerd_b = shiftcount + 1; ++ ++ tmp2 = 1; ++ for (j = 1; j <= val_integerd_b; j++) ++ tmp2 = tmp2 * 2; ++ ++ tmp = (val * 100) / tmp2; ++ tindex = tmp / 5; ++ ++ if (tindex > 20) ++ tindex = 20; ++ ++ val_fractiond_b = table_fraction[tindex]; ++ ++ result = val_integerd_b * 100 - val_fractiond_b; ++ ++ return result; ++ ++ ++} ++ ++void halbtc8723d1ant_psd_show_antenna_detect_result(IN struct btc_coexist ++ *btcoexist) ++{ ++ u8 *cli_buf = btcoexist->cli_buf; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n============[Antenna Detection info] ============\n"); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->ant_det_result == 12) { /* Get Ant Det from BT */ ++ ++ if (board_info->btdm_ant_num_by_ant_det == 1) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "1-Antenna", ++ BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT, ++ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION); ++ else { ++ ++ if (psd_scan->ant_det_psd_scan_peak_val > ++ (BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) ++ * 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %s (>%d)", ++ "Ant Det Result", "2-Antenna (Bad-Isolation)", ++ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "2-Antenna (Good-Isolation)", ++ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION, ++ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ } ++ } else if (psd_scan->ant_det_result == 1) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", ++ "Ant Det Result", "2-Antenna (Bad-Isolation)", ++ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ else if (psd_scan->ant_det_result == 2) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "2-Antenna (Good-Isolation)", ++ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset, ++ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "1-Antenna", ++ BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT, ++ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset); ++ ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", ++ "Antenna Detection Finish", ++ (board_info->btdm_ant_det_finish ++ ? "Yes" : "No")); ++ CL_PRINTF(cli_buf); ++ ++ switch (psd_scan->ant_det_result) { ++ case 0: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is not available)"); ++ break; ++ case 1: /* 2-Ant bad-isolation */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 2: /* 2-Ant good-isolation */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 3: /* 1-Ant */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 4: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Uncertainty result)"); ++ break; ++ case 5: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); ++ break; ++ case 6: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(WiFi is Scanning)"); ++ break; ++ case 7: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is not idle)"); ++ break; ++ case 8: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Abort by WiFi Scanning)"); ++ break; ++ case 9: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Antenna Init is not ready)"); ++ break; ++ case 10: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is Inquiry or page)"); ++ break; ++ case 11: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is Disabled)"); ++ case 12: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available, result from BT"); ++ break; ++ } ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->ant_det_result == 12) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", ++ "PSD Scan Peak Value", ++ psd_scan->ant_det_psd_scan_peak_val / 100); ++ CL_PRINTF(cli_buf); ++ return; ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "Ant Detect Total Count", psd_scan->ant_det_try_count); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "Ant Detect Fail Count", psd_scan->ant_det_fail_count); ++ CL_PRINTF(cli_buf); ++ ++ if ((!board_info->btdm_ant_det_finish) && ++ (psd_scan->ant_det_result != 5)) ++ return; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", ++ (psd_scan->ant_det_result ? "ok" : "fail")); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", ++ psd_scan->ant_det_bt_tx_time); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", ++ psd_scan->ant_det_bt_le_channel); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", ++ "WiFi PSD Cent-Ch/Offset/Span", ++ psd_scan->real_cent_freq, psd_scan->real_offset, ++ psd_scan->real_span); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", ++ "PSD Pre-Scan Peak Value", ++ psd_scan->ant_det_pre_psdscan_peak_val / 100); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", ++ "PSD Pre-Scan result", ++ (psd_scan->ant_det_result != 5 ? "ok" : "fail"), ++ BT_8723D_1ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->ant_det_result == 5) ++ return; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", ++ "PSD Scan Peak Value", psd_scan->ant_det_peak_val); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", ++ "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", ++ (board_info->tfbga_package) ? "Yes" : "No"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "PSD Threshold Offset", psd_scan->ant_det_thres_offset); ++ CL_PRINTF(cli_buf); ++ ++} ++ ++ ++ ++void halbtc8723d1ant_psd_showdata(IN struct btc_coexist *btcoexist) ++{ ++ u8 *cli_buf = btcoexist->cli_buf; ++ u32 delta_freq_per_point; ++ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; ++ ++ if (psd_scan->ant_det_result == 12) ++ return; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n\n============[PSD info] (%d)============\n", ++ psd_scan->psd_gen_count); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->psd_gen_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); ++ CL_PRINTF(cli_buf); ++ return; ++ } ++ ++ if (psd_scan->psd_point == 0) ++ delta_freq_per_point = 0; ++ else ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* if (psd_scan->is_psd_show_max_only) */ ++ if (0) { ++ psd_rep1 = psd_scan->psd_max_value / 100; ++ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; ++ ++ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + ++ psd_scan->psd_max_value_point * delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.0%d MHz", ++ freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.%d MHz", ++ freq1, freq2); ++ ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.0%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ ++ CL_PRINTF(cli_buf); ++ } else { ++ m = psd_scan->psd_start_point; ++ n = psd_scan->psd_start_point; ++ i = 1; ++ j = 1; ++ ++ while (1) { ++ do { ++ freq = ((psd_scan->real_cent_freq - 20) * ++ 1000000 + m * ++ delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (i == 1) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.000", ++ freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.0%2d", ++ freq1, ++ freq2); ++ else ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.%3d", ++ freq1, ++ freq2); ++ } else if ((i % 8 == 0) || ++ (m == psd_scan->psd_stop_point)) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%6d.000\n", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%6d.0%2d\n", freq1, ++ freq2); ++ else ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%6d.%3d\n", freq1, ++ freq2); ++ } else { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%6d.000", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%6d.0%2d", freq1, ++ freq2); ++ else ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%6d.%3d", freq1, ++ freq2); ++ } ++ ++ i++; ++ m++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); ++ ++ ++ do { ++ psd_rep1 = psd_scan->psd_report_max_hold[n] / ++ 100; ++ psd_rep2 = psd_scan->psd_report_max_hold[n] - ++ psd_rep1 * ++ 100; ++ ++ if (j == 1) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.0%d", ++ psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.%d", ++ psd_rep1, ++ psd_rep2); ++ } else if ((j % 8 == 0) || ++ (n == psd_scan->psd_stop_point)) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%7d.0%d\n", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%7d.%d\n", psd_rep1, ++ psd_rep2); ++ } else { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%7d.0%d", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%7d.%d", psd_rep1, ++ psd_rep2); ++ } ++ ++ j++; ++ n++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); ++ ++ if ((m > psd_scan->psd_stop_point) || ++ (n > psd_scan->psd_stop_point)) ++ break; ++ else { ++ i = 1; ++ j = 1; ++ } ++ ++ } ++ } ++ ++ ++} ++ ++ ++#ifdef PLATFORM_WINDOWS ++#pragma optimize("", off) ++#endif ++void halbtc8723d1ant_psd_maxholddata(IN struct btc_coexist *btcoexist, ++ IN u32 gen_count) ++{ ++ u32 i = 0; ++ u32 loop_i_max = 0, loop_val_max = 0; ++ ++ if (gen_count == 1) { ++ memcpy(psd_scan->psd_report_max_hold, ++ psd_scan->psd_report, ++ BT_8723D_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); ++ } ++ ++ for (i = psd_scan->psd_start_point; ++ i <= psd_scan->psd_stop_point; i++) { ++ ++ /* update max-hold value at each freq point */ ++ if (psd_scan->psd_report[i] > psd_scan->psd_report_max_hold[i]) ++ psd_scan->psd_report_max_hold[i] = ++ psd_scan->psd_report[i]; ++ ++ /* search the max value in this seep */ ++ if (psd_scan->psd_report[i] > loop_val_max) { ++ loop_val_max = psd_scan->psd_report[i]; ++ loop_i_max = i; ++ } ++ } ++ ++ if (gen_count <= BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT) ++ psd_scan->psd_loop_max_value[gen_count - 1] = loop_val_max; ++} ++ ++#ifdef PLATFORM_WINDOWS ++#pragma optimize("", off) ++#endif ++u32 halbtc8723d1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) ++{ ++ /* reg 0x808[9:0]: FFT data x */ ++ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ ++ /* reg 0x8b4[15:0]: FFT data y report */ ++ ++ u32 val = 0, psd_report = 0; ++ int k = 0; ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ ++ val &= 0xffbffc00; ++ val |= point; ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ val |= 0x00400000; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ while (1) { ++ if (k++ > BT_8723D_1ANT_ANTDET_SWEEPPOINT_DELAY) ++ break; ++ } ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); ++ ++ psd_report = val & 0x0000ffff; ++ ++ return psd_report; ++} ++ ++#ifdef PLATFORM_WINDOWS ++#pragma optimize("", off) ++#endif ++boolean halbtc8723d1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, ++ IN u32 avgnum, IN u32 loopcnt) ++{ ++ u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0; ++ u32 points1 = 0, psd_report = 0; ++ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; ++ u32 psd_center_freq = 20 * 10 ^ 6; ++ boolean outloop = false, scan , roam, is_sweep_ok = true; ++ u8 flag = 0; ++ u32 tmp = 0, u32tmp1 = 0; ++ u32 wifi_original_channel = 1; ++ u32 psd_sum = 0, avg_cnt = 0; ++ u32 i_max = 0, val_max = 0, val_max2 = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ do { ++ switch (flag) { ++ case 0: /* Get PSD parameters */ ++ default: ++ ++ psd_scan->psd_band_width = 40 * 1000000; ++ psd_scan->psd_point = points; ++ psd_scan->psd_start_base = points / 2; ++ psd_scan->psd_avg_num = avgnum; ++ psd_scan->real_cent_freq = cent_freq; ++ psd_scan->real_offset = offset; ++ psd_scan->real_span = span; ++ ++ ++ points1 = psd_scan->psd_point; ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* PSD point setup */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffff0fff; ++ ++ switch (psd_scan->psd_point) { ++ case 128: ++ val |= 0x0; ++ break; ++ case 256: ++ default: ++ val |= 0x00004000; ++ break; ++ case 512: ++ val |= 0x00008000; ++ break; ++ case 1024: ++ val |= 0x0000c000; ++ break; ++ } ++ ++ switch (psd_scan->psd_avg_num) { ++ case 1: ++ val |= 0x0; ++ break; ++ case 8: ++ val |= 0x00001000; ++ break; ++ case 16: ++ val |= 0x00002000; ++ break; ++ case 32: ++ default: ++ val |= 0x00003000; ++ break; ++ } ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ flag = 1; ++ break; ++ case 1: /* calculate the PSD point index from freq/offset/span */ ++ psd_center_freq = psd_scan->psd_band_width / 2 + ++ offset * (1000000); ++ ++ start_p = psd_scan->psd_start_base + (psd_center_freq - ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_start_point = start_p - ++ psd_scan->psd_start_base; ++ ++ stop_p = psd_scan->psd_start_base + (psd_center_freq + ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_stop_point = stop_p - ++ psd_scan->psd_start_base - 1; ++ ++ flag = 2; ++ break; ++ case 2: /* set RF channel/BW/Mode */ ++ ++ /* set 3-wire off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val |= 0x00300000; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val &= 0xfeffffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* Tx-pause on */ ++ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f); ++ ++ /* store WiFi original channel */ ++ wifi_original_channel = btcoexist->btc_get_rf_reg( ++ btcoexist, BTC_RF_A, 0x18, 0x3ff); ++ ++ /* Set RF channel */ ++ if (cent_freq == 2484) ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, 0xe); ++ else ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, (cent_freq - 2412) / 5 + ++ 1); /* WiFi TRx Mask on */ ++ ++ /* save original RCK value */ ++ u32tmp1 = btcoexist->btc_get_rf_reg( ++ btcoexist, BTC_RF_A, 0x1d, 0xfffff); ++ ++ /* Enter debug mode */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, ++ 0x2, 0x1); ++ ++ /* Set RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, ++ 0xfffff, 0x2e); ++ ++ ++ /* Set RF mode = Rx, RF Gain = 0x320a0 */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, ++ 0xfffff, 0x320a0); ++ ++ while (1) { ++ if (k++ > BT_8723D_1ANT_ANTDET_SWEEPPOINT_DELAY) ++ break; ++ } ++ flag = 3; ++ break; ++ case 3: ++ psd_scan->psd_gen_count = 0; ++ for (j = 1; j <= loopcnt; j++) { ++ ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || roam) { ++ is_sweep_ok = false; ++ break; ++ } ++ memset(psd_scan->psd_report, 0, ++ psd_scan->psd_point * sizeof(u32)); ++ start_p = psd_scan->psd_start_point + ++ psd_scan->psd_start_base; ++ stop_p = psd_scan->psd_stop_point + ++ psd_scan->psd_start_base + 1; ++ ++ i = start_p; ++ point_index = 0; ++ ++ while (i < stop_p) { ++ if (i >= points1) ++ psd_report = ++ halbtc8723d1ant_psd_getdata( ++ btcoexist, i - points1); ++ else ++ psd_report = ++ halbtc8723d1ant_psd_getdata( ++ btcoexist, i); ++ ++ if (psd_report == 0) ++ tmp = 0; ++ else ++ /* tmp = 20*log10((double)psd_report); */ ++ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ ++ tmp = 6 * halbtc8723d1ant_psd_log2base( ++ btcoexist, psd_report); ++ ++ n = i - psd_scan->psd_start_base; ++ psd_scan->psd_report[n] = tmp; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Point=%d, psd_dB_data = %d\n", ++ i, psd_scan->psd_report[n]); ++ BTC_TRACE(trace_buf); ++ ++ i++; ++ ++ } ++ ++ halbtc8723d1ant_psd_maxholddata(btcoexist, j); ++ ++ psd_scan->psd_gen_count = j; ++ ++ /*Accumulate Max PSD value in this loop if the value > threshold */ ++ if (psd_scan->psd_loop_max_value[j - 1] >= ++ 4000) { ++ psd_sum = psd_sum + ++ psd_scan->psd_loop_max_value[j - ++ 1]; ++ avg_cnt++; ++ } ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Loop=%d, Max_dB_data = %d\n", ++ j, psd_scan->psd_loop_max_value[j ++ - 1]); ++ BTC_TRACE(trace_buf); ++ ++ } ++ ++ if (loopcnt == BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT) { ++ ++ /* search the Max Value between each-freq-point-max-hold value of all sweep*/ ++ for (i = 1; ++ i <= BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT; ++ i++) { ++ ++ if (i == 1) { ++ i_max = i; ++ val_max = psd_scan->psd_loop_max_value[i ++ - 1]; ++ val_max2 = ++ psd_scan->psd_loop_max_value[i ++ - 1]; ++ } else if ( ++ psd_scan->psd_loop_max_value[i - ++ 1] > val_max) { ++ val_max2 = val_max; ++ i_max = i; ++ val_max = psd_scan->psd_loop_max_value[i ++ - 1]; ++ } else if ( ++ psd_scan->psd_loop_max_value[i - ++ 1] > val_max2) ++ val_max2 = ++ psd_scan->psd_loop_max_value[i ++ - 1]; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "i = %d, val_hold= %d, val_max = %d, val_max2 = %d\n", ++ i, psd_scan->psd_loop_max_value[i ++ - 1], ++ val_max, val_max2); ++ ++ BTC_TRACE(trace_buf); ++ } ++ ++ psd_scan->psd_max_value_point = i_max; ++ psd_scan->psd_max_value = val_max; ++ psd_scan->psd_max_value2 = val_max2; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "val_max = %d, val_max2 = %d\n", ++ psd_scan->psd_max_value, ++ psd_scan->psd_max_value2); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if (avg_cnt != 0) { ++ psd_scan->psd_avg_value = (psd_sum / avg_cnt); ++ if ((psd_sum % avg_cnt) >= (avg_cnt / 2)) ++ psd_scan->psd_avg_value++; ++ } else ++ psd_scan->psd_avg_value = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "AvgLoop=%d, Avg_dB_data = %d\n", ++ avg_cnt, psd_scan->psd_avg_value); ++ BTC_TRACE(trace_buf); ++ ++ flag = 100; ++ break; ++ case 99: /* error */ ++ ++ outloop = true; ++ break; ++ case 100: /* recovery */ ++ ++ /* set 3-wire on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val &= 0xffcfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val |= 0x01000000; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* Tx-pause off */ ++ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0); ++ ++ /* PSD off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffbfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ /* restore RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, ++ 0xfffff, u32tmp1); ++ ++ /* Exit debug mode */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, ++ 0x2, 0x0); ++ ++ /* restore WiFi original channel */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, ++ 0x3ff, wifi_original_channel); ++ ++ outloop = true; ++ break; ++ ++ } ++ ++ } while (!outloop); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); ++ BTC_TRACE(trace_buf); ++ return is_sweep_ok; ++ ++} ++ ++#ifdef PLATFORM_WINDOWS ++#pragma optimize("", off) ++#endif ++boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist ++ *btcoexist) ++{ ++ u32 i = 0; ++ u32 wlpsd_cent_freq = 2484, wlpsd_span = 2; ++ s32 wlpsd_offset = -4; ++ u32 bt_tx_time, bt_le_channel; ++ u8 bt_le_ch[13] = {3, 6, 8, 11, 13, 16, 18, 21, 23, 26, 28, 31, 33}; ++ ++ u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb; ++ ++ u8 state = 0; ++ boolean outloop = false, bt_resp = false, ant_det_finish = false; ++ u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, ++ u32tmp, u32tmp0, u32tmp1, u32tmp2 ; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); ++ memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); ++ ++ psd_scan->ant_det_bt_tx_time = ++ BT_8723D_1ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ ++ psd_scan->ant_det_bt_le_channel = BT_8723D_1ANT_ANTDET_BTTXCHANNEL; ++ ++ bt_tx_time = psd_scan->ant_det_bt_tx_time; ++ bt_le_channel = psd_scan->ant_det_bt_le_channel; ++ ++ if (board_info->tfbga_package) /* for TFBGA */ ++ psd_scan->ant_det_thres_offset = 5; ++ else ++ psd_scan->ant_det_thres_offset = 0; ++ ++ do { ++ switch (state) { ++ case 0: ++ if (bt_le_channel == 39) ++ wlpsd_cent_freq = 2484; ++ else { ++ for (i = 1; i <= 13; i++) { ++ if (bt_le_ch[i - 1] == ++ bt_le_channel) { ++ wlpsd_cent_freq = 2412 ++ + (i - 1) * 5; ++ break; ++ } ++ } ++ ++ if (i == 14) { ++ ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", ++ bt_le_channel); ++ BTC_TRACE(trace_buf); ++ outloop = true; ++ break; ++ } ++ } ++#if 0 ++ wlpsd_sweep_count = bt_tx_time * 238 / ++ 100; /* bt_tx_time/0.42 */ ++ wlpsd_sweep_count = wlpsd_sweep_count / 5; ++ ++ if (wlpsd_sweep_count % 5 != 0) ++ wlpsd_sweep_count = (wlpsd_sweep_count / ++ 5 + 1) * 5; ++#endif ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", ++ bt_tx_time, bt_le_channel); ++ BTC_TRACE(trace_buf); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", ++ wlpsd_cent_freq, ++ wlpsd_offset, ++ wlpsd_span, ++ BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT); ++ BTC_TRACE(trace_buf); ++ ++ state = 1; ++ break; ++ case 1: /* stop coex DM & set antenna path */ ++ /* Stop Coex DM */ ++ btcoexist->stop_coex_dm = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* Set TDMA off, */ ++ halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, ++ false, 0); ++ ++ /* Set coex table */ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, ++ FORCE_EXEC, 0); ++ ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ /* Set Antenna path, switch WiFi to un-certain antenna port */ ++ /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_ANTENNA_DET); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ ++ h2c_parameter[0] = 0x1; ++ h2c_parameter[1] = 0xd; ++ h2c_parameter[2] = 0x14; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", ++ h2c_parameter[1], ++ h2c_parameter[2]); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, ++ h2c_parameter); ++ ++ u32tmp = btcoexist->btc_read_2byte(btcoexist, 0x948); ++ u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70); ++ u32tmp1 = halbtc8723d1ant_ltecoex_indirect_read_reg( ++ btcoexist, 0x38); ++ u32tmp2 = halbtc8723d1ant_ltecoex_indirect_read_reg( ++ btcoexist, 0x54); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** 0x948 = 0x%x, 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (Before Ant Det)\n", ++ u32tmp, u32tmp0, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ ++ state = 2; ++ break; ++ case 2: /* Pre-sweep background psd */ ++ if (!halbtc8723d1ant_psd_sweep_point(btcoexist, ++ wlpsd_cent_freq, wlpsd_offset, wlpsd_span, ++ BT_8723D_1ANT_ANTDET_PSD_POINTS, ++ BT_8723D_1ANT_ANTDET_PSD_AVGNUM, 3)) { ++ ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ psd_scan->ant_det_result = 8; ++ state = 99; ++ break; ++ } ++ ++ psd_scan->ant_det_pre_psdscan_peak_val = ++ psd_scan->psd_max_value; ++ ++ if (psd_scan->ant_det_pre_psdscan_peak_val > ++ (BT_8723D_1ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset) * 100) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", ++ psd_scan->ant_det_pre_psdscan_peak_val / ++ 100, ++ BT_8723D_1ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ BTC_TRACE(trace_buf); ++ ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ psd_scan->ant_det_result = 5; ++ state = 99; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", ++ psd_scan->ant_det_pre_psdscan_peak_val / ++ 100, ++ BT_8723D_1ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ BTC_TRACE(trace_buf); ++ state = 3; ++ } ++ break; ++ case 3: ++ ++ bt_resp = btcoexist->btc_set_bt_ant_detection( ++ btcoexist, (u8)(bt_tx_time & 0xff), ++ (u8)(bt_le_channel & 0xff)); ++ ++ /* Sync WL Rx PSD with BT Tx time because H2C->Mailbox delay */ ++ delay_ms(20); ++ ++ if (!halbtc8723d1ant_psd_sweep_point(btcoexist, ++ wlpsd_cent_freq, wlpsd_offset, ++ wlpsd_span, ++ BT_8723D_1ANT_ANTDET_PSD_POINTS, ++ BT_8723D_1ANT_ANTDET_PSD_AVGNUM, ++ BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT)) { ++ ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ psd_scan->ant_det_result = 8; ++ state = 99; ++ break; ++ } ++ ++#if 1 ++ psd_scan->ant_det_psd_scan_peak_val = ++ psd_scan->psd_max_value; ++#endif ++#if 0 ++ psd_scan->ant_det_psd_scan_peak_val = ++ ((psd_scan->psd_max_value - psd_scan->psd_avg_value) < ++ 800) ? ++ psd_scan->psd_max_value : (( ++ psd_scan->psd_max_value - ++ psd_scan->psd_max_value2 <= 300) ? ++ psd_scan->psd_avg_value : ++ psd_scan->psd_max_value2); ++#endif ++ psd_scan->ant_det_psd_scan_peak_freq = ++ psd_scan->psd_max_value_point; ++ state = 4; ++ break; ++ case 4: ++ ++ if (psd_scan->psd_point == 0) ++ delta_freq_per_point = 0; ++ else ++ delta_freq_per_point = ++ psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ psd_rep1 = psd_scan->ant_det_psd_scan_peak_val / 100; ++ psd_rep2 = psd_scan->ant_det_psd_scan_peak_val - ++ psd_rep1 * ++ 100; ++ ++ freq = ((psd_scan->real_cent_freq - 20) * ++ 1000000 + psd_scan->psd_max_value_point ++ * delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (freq2 < 100) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", ++ freq1, freq2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_freq, ++ BT_8723D_1ANT_ANTDET_BUF_LEN, ++ "%d.0%d", freq1, freq2); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", ++ freq1, freq2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_freq, ++ BT_8723D_1ANT_ANTDET_BUF_LEN, ++ "%d.%d", freq1, freq2); ++ } ++ ++ if (psd_rep2 < 10) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.0%d dB\n", ++ psd_rep1, psd_rep2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_val, ++ BT_8723D_1ANT_ANTDET_BUF_LEN, ++ "%d.0%d", psd_rep1, psd_rep2); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.%d dB\n", ++ psd_rep1, psd_rep2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_val, ++ BT_8723D_1ANT_ANTDET_BUF_LEN, ++ "%d.%d", psd_rep1, psd_rep2); ++ } ++ ++ psd_scan->ant_det_is_btreply_available = true; ++ ++ if (bt_resp == false) { ++ psd_scan->ant_det_is_btreply_available = ++ false; ++ psd_scan->ant_det_result = 0; ++ ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->ant_det_psd_scan_peak_val > ++ (BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) ++ * 100) { ++ psd_scan->ant_det_result = 1; ++ ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 2; ++ coex_sta->isolation_btween_wb = (u8)(85 - ++ psd_scan->ant_det_psd_scan_peak_val / ++ 100) & 0xff; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->ant_det_psd_scan_peak_val > ++ (BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset) * 100) { ++ psd_scan->ant_det_result = 2; ++ ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 2; ++ coex_sta->isolation_btween_wb = (u8)(85 - ++ psd_scan->ant_det_psd_scan_peak_val / ++ 100) & 0xff; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->ant_det_psd_scan_peak_val > ++ (BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT) * ++ 100) { ++ psd_scan->ant_det_result = 3; ++ ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ coex_sta->isolation_btween_wb = (u8)(85 - ++ psd_scan->ant_det_psd_scan_peak_val / ++ 100) & 0xff; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ psd_scan->ant_det_result = 4; ++ ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ state = 99; ++ break; ++ case 99: /* restore setup */ ++ ++ /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ ++ h2c_parameter[0] = 0x0; ++ h2c_parameter[1] = 0x0; ++ h2c_parameter[2] = 0x0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", ++ h2c_parameter[1], h2c_parameter[2]); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, ++ h2c_parameter); ++ ++ /* Set Antenna Path, GNT_WL/GNT_BT control by PTA */ ++ /* Set Antenna path, switch WiFi to certain antenna port */ ++ halbtc8723d1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ outloop = true; ++ break; ++ } ++ ++ } while (!outloop); ++ ++ return ant_det_finish; ++ ++} ++ ++#ifdef PLATFORM_WINDOWS ++#pragma optimize("", off) ++#endif ++boolean halbtc8723d1ant_psd_antenna_detection_check(IN struct btc_coexist ++ *btcoexist) ++{ ++ static u32 ant_det_count = 0, ant_det_fail_count = 0; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ boolean scan, roam, ant_det_finish = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ ant_det_count++; ++ ++ psd_scan->ant_det_try_count = ant_det_count; ++ ++ if (scan || roam) { ++ ant_det_finish = false; ++ psd_scan->ant_det_result = 6; ++ } else if (coex_sta->bt_disabled) { ++ ant_det_finish = false; ++ psd_scan->ant_det_result = 11; ++ } else if (coex_sta->num_of_profile >= 1) { ++ ant_det_finish = false; ++ psd_scan->ant_det_result = 7; ++ } else if ( ++ !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ ++ ant_det_finish = false; ++ psd_scan->ant_det_result = 9; ++ } else if (coex_sta->c2h_bt_inquiry_page) { ++ ant_det_finish = false; ++ psd_scan->ant_det_result = 10; ++ } else { ++ ++ ant_det_finish = halbtc8723d1ant_psd_antenna_detection( ++ btcoexist); ++ ++ delay_ms(psd_scan->ant_det_bt_tx_time); ++ } ++ ++ /* board_info->ant_det_result = psd_scan->ant_det_result; */ ++ ++ if (!ant_det_finish) ++ ant_det_fail_count++; ++ ++ psd_scan->ant_det_fail_count = ant_det_fail_count; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n", ++ psd_scan->ant_det_result, ++ psd_scan->ant_det_fail_count, ++ ant_det_finish == true ? "Yes" : "No"); ++ BTC_TRACE(trace_buf); ++ ++ return ant_det_finish; ++ ++} ++ ++ ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8723d1ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8723d1ant_ ++ * ************************************************************ */ ++void ex_halbtc8723d1ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 u8tmp = 0x0; ++ u16 u16tmp = 0x0; ++ u32 value = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Execute 8723d 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Ant Det Finish = %s, Ant Det Number = %d\n", ++ (board_info->btdm_ant_det_finish ? "Yes" : "No"), ++ board_info->btdm_ant_num_by_ant_det); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = true; ++ psd_scan->ant_det_is_ant_det_available = false; ++ ++ /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ ++ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); ++ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); ++ ++ /* Local setting bit define */ ++ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ ++ /* BIT1: "0" for internal switch; "1" for external switch */ ++ /* BIT2: "0" for one antenna; "1" for two antenna */ ++ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ ++ ++ /* Set Antenna Path to BT side */ ++ /* Check efuse 0xc3[6] for Single Antenna Path */ ++ if (board_info->single_ant_path == 0) { ++ /* set to S1 */ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; ++ u8tmp = 0; ++ value = 1; ++ } else if (board_info->single_ant_path == 1) { ++ /* set to S0 */ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; ++ u8tmp = 1; ++ value = 0; ++ } ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (Power On) single_ant_path = %d, btdm_ant_pos = %d **********\n", ++ board_info->single_ant_path , board_info->btdm_ant_pos); ++ BTC_TRACE(trace_buf); ++ ++ /* Set Antenna Path to BT side */ ++ halbtc8723d1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_COEX_POWERON); ++ ++ /* Write Single Antenna Position to Registry to tell BT for 8723d. This line can be removed ++ since BT EFuse also add "single antenna position" in EFuse for 8723d*/ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, ++ &value); ++ ++ /* Save"single antenna position" info in Local register setting for FW reading, because FW may not ready at power on */ ++ if (btcoexist->chip_interface == BTC_INTF_PCI) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_USB) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_SDIO) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); ++ ++ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ ++ halbtc8723d1ant_enable_gnt_to_gpio(btcoexist, true); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", ++ halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x38)); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0x948 (Power-On) = 0x%x / 0x%x**********\n", ++ btcoexist->btc_read_4byte(btcoexist, 0x70), ++ btcoexist->btc_read_2byte(btcoexist, 0x948)); ++ BTC_TRACE(trace_buf); ++ ++} ++ ++void ex_halbtc8723d1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) ++{ ++} ++ ++void ex_halbtc8723d1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ halbtc8723d1ant_init_hw_config(btcoexist, true, wifi_only); ++} ++ ++void ex_halbtc8723d1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723d1ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_stack_info *stack_info = &btcoexist->stack_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, ps_tdma_case = 0; ++ u16 u16tmp[4]; ++ u32 u32tmp[4]; ++ u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; ++ u32 fw_ver = 0, bt_patch_ver = 0, bt_coex_ver = 0; ++ static u8 pop_report_in_10s = 0, cnt = 0; ++ u32 phyver = 0; ++ boolean lte_coex_on = false; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ if (btcoexist->stop_coex_dm) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Coex is STOPPED]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ if (!coex_sta->bt_disabled) { ++ if (coex_sta->bt_coex_supported_feature == 0) ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, ++ &coex_sta->bt_coex_supported_feature); ++ ++ if ((coex_sta->bt_coex_supported_version == 0) || ++ (coex_sta->bt_coex_supported_version == 0xffff)) ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, ++ &coex_sta->bt_coex_supported_version); ++ ++ if (coex_sta->bt_reg_vendor_ac == 0xffff) ++ coex_sta->bt_reg_vendor_ac = (u16)( ++ btcoexist->btc_get_bt_reg(btcoexist, 3, ++ 0xac) & 0xffff); ++ ++ if (coex_sta->bt_reg_vendor_ae == 0xffff) ++ coex_sta->bt_reg_vendor_ae = (u16)( ++ btcoexist->btc_get_bt_reg(btcoexist, 3, ++ 0xae) & 0xffff); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, ++ &bt_patch_ver); ++ btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; ++ ++ if (coex_sta->num_of_profile > 0) { ++ cnt++; ++ ++ if (cnt >= 3) { ++ btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, ++ &coex_sta->bt_afh_map[0]); ++ cnt = 0; ++ } ++ } ++ } ++ ++ if (psd_scan->ant_det_try_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", ++ "Ant PG Num/ Mech/ Pos", ++ board_info->pg_ant_num, board_info->btdm_ant_num, ++ (board_info->btdm_ant_pos == 1 ? "S1" : "S0")); ++ CL_PRINTF(cli_buf); ++ } else { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ %d/ %s (%d/%d/%d)", ++ "Ant PG Num/ Mech(Ant_Det)/ Pos", ++ board_info->pg_ant_num, ++ board_info->btdm_ant_num_by_ant_det, ++ (board_info->btdm_ant_pos == 1 ? "S1" : "S0"), ++ psd_scan->ant_det_try_count, ++ psd_scan->ant_det_fail_count, ++ psd_scan->ant_det_result); ++ CL_PRINTF(cli_buf); ++ ++ if (board_info->btdm_ant_det_finish) { ++ ++ if (psd_scan->ant_det_result != 12) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %s", ++ "Ant Det PSD Value", ++ psd_scan->ant_det_peak_val); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d", ++ "Ant Det PSD Value", ++ psd_scan->ant_det_psd_scan_peak_val ++ / 100); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ if (board_info->ant_det_result_five_complete) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ %d", ++ "AntDet(Registry) Num/PSD Value", ++ board_info->btdm_ant_num_by_ant_det, ++ (board_info->antdetval & 0x7f)); ++ CL_PRINTF(cli_buf); ++ } ++ ++ bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); ++ ++ bt_coex_ver = ((coex_sta->bt_coex_supported_version & 0xff00) >> 8); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", ++ "CoexVer WL/ BT_Desired/ BT_Report", ++ glcoex_ver_date_8723d_1ant, glcoex_ver_8723d_1ant, ++ glcoex_ver_btdesired_8723d_1ant, ++ bt_coex_ver, ++ (bt_coex_ver == 0xff ? "Unknown" : ++ (coex_sta->bt_disabled ? "BT-disable" : ++ (bt_coex_ver >= glcoex_ver_btdesired_8723d_1ant ? ++ "Match" : "Mis-Match")))); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c", ++ "W_FW/ B_FW/ Phy/ Kt", ++ fw_ver, bt_patch_ver, phyver, ++ coex_sta->cut_version + 65); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ pop_report_in_10s++; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = [%s/ %d dBm/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt/ popCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") ++ : ((BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, ++ coex_sta->pop_event_cnt); ++ CL_PRINTF(cli_buf); ++ ++ if (pop_report_in_10s >= 5) { ++ coex_sta->pop_event_cnt = 0; ++ pop_report_in_10s = 0; ++ } ++ ++ if (coex_sta->num_of_profile != 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %s%s%s%s%s", ++ "Profiles", ++ ((bt_link_info->a2dp_exist) ? "A2DP," : ""), ++ ((bt_link_info->sco_exist) ? "SCO," : ""), ++ ((bt_link_info->hid_exist) ? ++ ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : ++ "HID(2/18),") : ""), ++ ((bt_link_info->pan_exist) ? "PAN," : ""), ++ ((coex_sta->voice_over_HOGP) ? "Voice" : "")); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = None", ++ "Profiles"); ++ ++ CL_PRINTF(cli_buf); ++ ++ if (bt_link_info->a2dp_exist) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s", ++ "A2DP Rate/Bitpool/Auto_Slot", ++ ((coex_sta->is_A2DP_3M) ? "3M" : "No_3M"), ++ coex_sta->a2dp_bit_pool, ++ ((coex_sta->is_autoslot) ? "On" : "Off") ++ ); ++ CL_PRINTF(cli_buf); ++ } ++ ++ if (bt_link_info->hid_exist) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "HID PairNum/Forbid_Slot", ++ coex_sta->hid_pair_cnt, ++ coex_sta->forbidden_slot ++ ); ++ CL_PRINTF(cli_buf); ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s/ 0x%x", ++ "Role/RoleSwCnt/IgnWlact/Feature", ++ ((bt_link_info->slave_role) ? "Slave" : "Master"), ++ coex_sta->cnt_RoleSwitch, ++ ((coex_dm->cur_ignore_wlan_act) ? "Yes" : "No"), ++ coex_sta->bt_coex_supported_feature); ++ CL_PRINTF(cli_buf); ++ ++ if ((coex_sta->bt_ble_scan_type & 0x7) != 0x0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "BLEScan Type/TV/Init/Ble", ++ coex_sta->bt_ble_scan_type, ++ (coex_sta->bt_ble_scan_type & 0x1 ? ++ coex_sta->bt_ble_scan_para[0] : 0x0), ++ (coex_sta->bt_ble_scan_type & 0x2 ? ++ coex_sta->bt_ble_scan_para[1] : 0x0), ++ (coex_sta->bt_ble_scan_type & 0x4 ? ++ coex_sta->bt_ble_scan_para[2] : 0x0)); ++ CL_PRINTF(cli_buf); ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", ++ "ReInit/ReLink/IgnWlact/Page/NameReq", ++ coex_sta->cnt_ReInit, ++ coex_sta->cnt_setupLink, ++ coex_sta->cnt_IgnWlanAct, ++ coex_sta->cnt_Page, ++ coex_sta->cnt_RemoteNameReq ++ ); ++ CL_PRINTF(cli_buf); ++ ++ halbtc8723d1ant_read_score_board(btcoexist, &u16tmp[0]); ++ ++ if ((coex_sta->bt_reg_vendor_ae == 0xffff) || ++ (coex_sta->bt_reg_vendor_ac == 0xffff)) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ %04x", ++ "0xae[4]/0xac[1:0]/Scoreboard", u16tmp[0]); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ %04x", ++ "0xae[4]/0xac[1:0]/Scoreboard", ++ ((coex_sta->bt_reg_vendor_ae & BIT(4)) >> 4), ++ coex_sta->bt_reg_vendor_ac & 0x3, u16tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ if (coex_sta->num_of_profile > 0) { ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x", ++ "AFH MAP", ++ coex_sta->bt_afh_map[0], ++ coex_sta->bt_afh_map[1], ++ coex_sta->bt_afh_map[2], ++ coex_sta->bt_afh_map[3], ++ coex_sta->bt_afh_map[4], ++ coex_sta->bt_afh_map[5], ++ coex_sta->bt_afh_map[6], ++ coex_sta->bt_afh_map[7], ++ coex_sta->bt_afh_map[8], ++ coex_sta->bt_afh_map[9] ++ ); ++ CL_PRINTF(cli_buf); ++ } ++ ++ for (i = 0; i < BT_INFO_SRC_8723D_1ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x (%d)", ++ glbt_info_src_8723d_1ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ ++ if (btcoexist->manual_control) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms] (before Manual)============"); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Mechanisms]============"); ++ ++ CL_PRINTF(cli_buf); ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x (case-%d, %s)", ++ "TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case, ++ (coex_dm->cur_ps_tdma_on ? "TDMA On" : "TDMA Off")); ++ ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ 0x%x/ 0x%x/ 0x%x", ++ "Table/0x6c0/0x6c4/0x6c8", ++ coex_sta->coex_table_type, u32tmp[0], u32tmp[1], u32tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x", ++ "0x778/0x6cc", ++ u8tmp[0], u32tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", ++ "AntDiv/ ForceLPS", ++ ((board_info->ant_div_cfg) ? "On" : "Off"), ++ ((coex_sta->force_lps_on) ? "On" : "Off")); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? true : false; ++ ++ if (lte_coex_on) { ++ ++ u32tmp[0] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa0); ++ u32tmp[1] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "LTE Coex Table W_L/B_L", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa8); ++ u32tmp[1] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xac); ++ u32tmp[2] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb0); ++ u32tmp[3] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "LTE Break Table W_L/B_L/L_W/L_B", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, ++ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ } ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ /* ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); ++ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "0x430/0x434/0x42a/0x456", ++ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ */ ++ ++ u32tmp[0] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp[1] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", ++ "LTE Coex/Path Owner", ++ ((lte_coex_on) ? "On" : "Off") , ++ ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); ++ CL_PRINTF(cli_buf); ++ ++ if (lte_coex_on) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ %d/ %d/ %d", ++ "LTE 3Wire/OPMode/UART/UARTMode", ++ (int)((u32tmp[0] & BIT(6)) >> 6), ++ (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), ++ (int)((u32tmp[0] & BIT(3)) >> 3), ++ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "LTE_Busy/UART_Busy", ++ (int)((u32tmp[1] & BIT(1)) >> 1), (int)(u32tmp[1] & BIT(0))); ++ CL_PRINTF(cli_buf); ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s %d", ++ "GNT_WL_Ctrl/GNT_BT_Ctrl/Dbg", ++ ((u32tmp[0] & BIT(12)) ? "SW" : "HW"), ++ ((u32tmp[0] & BIT(8)) ? "SW" : "HW"), ++ ((u32tmp[0] & BIT(14)) ? "SW" : "HW"), ++ ((u32tmp[0] & BIT(10)) ? "SW" : "HW"), ++ ((u8tmp[0] & BIT(3)) ? "On" : "Off"), ++ coex_sta->gnt_error_cnt); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "GNT_WL/GNT_BT", ++ (int)((u32tmp[1] & BIT(2)) >> 2), ++ (int)((u32tmp[1] & BIT(3)) >> 3)); ++ CL_PRINTF(cli_buf); ++ ++ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x948); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x948/0x67[7]", ++ u16tmp[0], (int)((u8tmp[0] & BIT(7)) >> 7)); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x964); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x864); ++ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xab7); ++ u8tmp[3] = btcoexist->btc_read_1byte(btcoexist, 0xa01); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x964[1]/0x864[0]/0xab7[5]/0xa01[7]", ++ (int)((u8tmp[0] & BIT(1)) >> 1), (int)((u8tmp[1] & BIT(0))), ++ (int)((u8tmp[2] & BIT(3)) >> 3), ++ (int)((u8tmp[3] & BIT(7)) >> 7)); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x45e); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x4c6[4]/0x40[5]/0x45e[3](TxRetry)", ++ (int)((u8tmp[0] & BIT(4)) >> 4), ++ (int)((u8tmp[1] & BIT(5)) >> 5), ++ (int)((u8tmp[2] & BIT(3)) >> 3)); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s", ++ "0x550/0x522/4-RxAGC", ++ u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off"); ++ CL_PRINTF(cli_buf); ++ ++ fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_FA_OFDM); ++ fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_FA_CCK); ++ cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_CCA_OFDM); ++ cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_CCA_CCK); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", ++ cca_cck, fa_cck, cca_ofdm, fa_ofdm); ++ CL_PRINTF(cli_buf); ++ ++#if 1 ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_OK CCK/11g/11n/11n-agg", ++ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, ++ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_Err CCK/11g/11n/11n-agg", ++ coex_sta->crc_err_cck, coex_sta->crc_err_11g, ++ coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); ++ CL_PRINTF(cli_buf); ++#endif ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d", ++ "WlHiPri/ Locking/ Locked/ Noisy", ++ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), ++ (coex_sta->cck_lock ? "Yes" : "No"), ++ (coex_sta->cck_ever_lock ? "Yes" : "No"), ++ coex_sta->wl_noisy_level); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", ++ "0x770(Hi-pri rx/tx)", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx, ++ (coex_sta->is_hiPri_rx_overhead ? "(scan overhead!!)" : "")); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", ++ "0x774(Lo-pri rx/tx)", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx, ++ (bt_link_info->slave_role ? "(Slave!!)" : ( ++ coex_sta->is_tdma_btautoslot_hang ? "(auto-slot hang!!)" : ""))); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++void ex_halbtc8723d1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ ++ /* Write WL "Active" in Score-board for LPS off */ ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_1ANT_SCOREBOARD_ONOFF | ++ BT_8723D_1ANT_SCOREBOARD_SCAN | ++ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, ++ false); ++ ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_WLAN_OFF); ++ ++ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++#if 0 ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); ++ ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ONOFF, true); ++#endif ++ ++ halbtc8723d1ant_init_hw_config(btcoexist, false, false); ++ halbtc8723d1ant_init_coex_dm(btcoexist);; ++ ++ coex_sta->under_ips = false; ++ } ++} ++ ++void ex_halbtc8723d1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ ++ if (coex_sta->force_lps_on == true) { /* LPS No-32K */ ++ /* Write WL "Active" in Score-board for PS-TDMA */ ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); ++ ++ } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ ++ /* Write WL "Non-Active" in Score-board for Native-PS */ ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE, false); ++ ++ } ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ ++ /* Write WL "Active" in Score-board for LPS off */ ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); ++ ++ } ++} ++ ++void ex_halbtc8723d1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ coex_sta->freeze_coexrun_by_btinfo = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ halbtc8723d1ant_query_bt_info(btcoexist); ++ ++ if (BTC_SCAN_START == type) { ++ ++ if (!wifi_connected) ++ coex_sta->wifi_is_high_pri_task = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_1ANT_SCOREBOARD_SCAN | ++ BT_8723D_1ANT_SCOREBOARD_ONOFF, ++ true); ++ ++ /* Force antenna setup for no scan result issue */ ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8723d1ant_run_coexist_mechanism(btcoexist); ++ ++ } else { ++ ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", ++ coex_sta->scan_ap_num); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_run_coexist_mechanism(btcoexist); ++ } ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN Notify() end\n"); ++ BTC_TRACE(trace_buf); ++ ++} ++ ++void ex_halbtc8723d1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ if (BTC_ASSOCIATE_START == type) { ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_1ANT_SCOREBOARD_SCAN | ++ BT_8723D_1ANT_SCOREBOARD_ONOFF, ++ true); ++ ++ /* Force antenna setup for no scan result issue */ ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_dm->arp_cnt = 0; ++ ++ halbtc8723d1ant_run_coexist_mechanism(btcoexist); ++ ++ /* To keep TDMA case during connect process, ++ to avoid changed by Btinfo and runcoexmechanism */ ++ coex_sta->freeze_coexrun_by_btinfo = true; ++ } else { ++ ++ coex_sta->wifi_is_high_pri_task = false; ++ coex_sta->freeze_coexrun_by_btinfo = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_run_coexist_mechanism(btcoexist); ++ } ++ ++} ++ ++void ex_halbtc8723d1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_1ANT_SCOREBOARD_ONOFF, ++ true); ++ ++ /* Force antenna setup for no scan result issue */ ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ /* Set CCK Tx/Rx high Pri except 11b mode */ ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x00); /* CCK Rx */ ++ } else { ++ /* btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x10); */ /*CCK Tx */ ++ /* btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x10); */ /*CCK Rx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x10); /* CCK Rx */ ++ } ++ ++ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, ++ 0x430); ++ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, ++ 0x434); ++ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( ++ btcoexist, 0x42a); ++ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( ++ btcoexist, 0x456); ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE, false); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ ++ ++ coex_sta->cck_ever_lock = false; ++ } ++ ++ halbtc8723d1ant_update_wifi_channel_info(btcoexist, type); ++ ++} ++ ++void ex_halbtc8723d1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean under_4way = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (under_4way) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ---- under_4way!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ coex_sta->specific_pkt_period_cnt = 2; ++ } else if (BTC_PACKET_ARP == type) { ++ ++ coex_dm->arp_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ARP notify -cnt = %d\n", ++ coex_dm->arp_cnt); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", ++ type); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ coex_sta->specific_pkt_period_cnt = 2; ++ } ++ ++ if (coex_sta->wifi_is_high_pri_task) { ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_SCAN, true); ++ halbtc8723d1ant_run_coexist_mechanism(btcoexist); ++ } ++} ++ ++void ex_halbtc8723d1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 i, rsp_source = 0; ++ boolean wifi_connected = false; ++ boolean wifi_scan = false, wifi_link = false, wifi_roam = false, ++ wifi_busy = false; ++ static boolean is_scoreboard_scan = false; ++ ++ if (psd_scan->is_AntDet_running == true) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], bt_info_notify return for AntDet is running\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8723D_1ANT_MAX) ++ rsp_source = BT_INFO_SRC_8723D_1ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt_info[%d], len=%d, data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ coex_sta->bt_info = coex_sta->bt_info_c2h[rsp_source][1]; ++ coex_sta->bt_info_ext = coex_sta->bt_info_c2h[rsp_source][4]; ++ coex_sta->bt_info_ext2 = coex_sta->bt_info_c2h[rsp_source][5]; ++ ++ if (BT_INFO_SRC_8723D_1ANT_WIFI_FW != rsp_source) { ++ ++ /* if 0xff, it means BT is under WHCK test */ ++ coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? true : ++ false); ++ ++ coex_sta->bt_create_connection = (( ++ coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? true : ++ false); ++ ++ /* unit: %, value-100 to translate to unit: dBm */ ++ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + ++ 10; ++ ++ coex_sta->c2h_bt_remote_name_req = (( ++ coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? true : ++ false); ++ ++ coex_sta->is_A2DP_3M = ((coex_sta->bt_info_c2h[rsp_source][2] & ++ 0x10) ? true : false); ++ ++ coex_sta->acl_busy = ((coex_sta->bt_info_c2h[rsp_source][1] & ++ 0x9) ? true : false); ++ ++ coex_sta->voice_over_HOGP = ((coex_sta->bt_info_ext & 0x10) ? ++ true : false); ++ ++ coex_sta->c2h_bt_inquiry_page = ((coex_sta->bt_info & ++ BT_INFO_8723D_1ANT_B_INQ_PAGE) ? true : false); ++ ++ coex_sta->a2dp_bit_pool = ((( ++ coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) ? ++ coex_sta->bt_info_c2h[rsp_source][6] : 0); ++ ++ coex_sta->bt_retry_cnt = coex_sta->bt_info_c2h[rsp_source][2] & ++ 0xf; ++ ++ coex_sta->is_autoslot = coex_sta->bt_info_ext2 & 0x8; ++ ++ coex_sta->forbidden_slot = coex_sta->bt_info_ext2 & 0x7; ++ ++ coex_sta->hid_busy_num = (coex_sta->bt_info_ext2 & 0x30) >> 4; ++ ++ coex_sta->hid_pair_cnt = (coex_sta->bt_info_ext2 & 0xc0) >> 6; ++ ++ if (coex_sta->bt_retry_cnt >= 1) ++ coex_sta->pop_event_cnt++; ++ ++ if (coex_sta->c2h_bt_remote_name_req) ++ coex_sta->cnt_RemoteNameReq++; ++ ++ if (coex_sta->bt_info_ext & BIT(1)) ++ coex_sta->cnt_ReInit++; ++ ++ if (coex_sta->bt_info_ext & BIT(2)) { ++ coex_sta->cnt_setupLink++; ++ coex_sta->is_setupLink = true; ++ } else ++ coex_sta->is_setupLink = false; ++ ++ if (coex_sta->bt_info_ext & BIT(3)) ++ coex_sta->cnt_IgnWlanAct++; ++ ++ if (coex_sta->bt_info_ext & BIT(6)) ++ coex_sta->cnt_RoleSwitch++; ++ ++ if (coex_sta->bt_create_connection) { ++ coex_sta->cnt_Page++; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, ++ &wifi_busy); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); ++ ++ if ((wifi_link) || (wifi_roam) || (wifi_scan) || ++ (coex_sta->wifi_is_high_pri_task) || (wifi_busy)) { ++ ++ is_scoreboard_scan = true; ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_SCAN, true); ++ ++ } else ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_SCAN, false); ++ ++ } else { ++ if (is_scoreboard_scan) { ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_SCAN, false); ++ is_scoreboard_scan = false; ++ } ++ } ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ ++ if ((!btcoexist->manual_control) && ++ (!btcoexist->stop_coex_dm)) { ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ /* Re-Init */ ++ if ((coex_sta->bt_info_ext & BIT(1))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ if (wifi_connected) ++ halbtc8723d1ant_update_wifi_channel_info( ++ btcoexist, BTC_MEDIA_CONNECT); ++ else ++ halbtc8723d1ant_update_wifi_channel_info( ++ btcoexist, ++ BTC_MEDIA_DISCONNECT); ++ } ++ ++ ++ /* If Ignore_WLanAct && not SetUp_Link or Role_Switch */ ++ if ((coex_sta->bt_info_ext & BIT(3)) && ++ (!(coex_sta->bt_info_ext & BIT(2))) && ++ (!(coex_sta->bt_info_ext & BIT(6)))) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d1ant_ignore_wlan_act(btcoexist, ++ FORCE_EXEC, false); ++ } else { ++ if (coex_sta->bt_info_ext & BIT(2)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ignore Wlan active because Re-link!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (coex_sta->bt_info_ext & BIT(6)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ignore Wlan active because Role-Switch!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ } ++ ++ } ++ ++ if ((coex_sta->bt_info_ext & BIT(5))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt(btcoexist); ++ ++ if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) ++ coex_sta->bt_ble_scan_para[0] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x1); ++ if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) ++ coex_sta->bt_ble_scan_para[1] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x2); ++ if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) ++ coex_sta->bt_ble_scan_para[2] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x4); ++ } ++ ++ halbtc8723d1ant_update_bt_link_info(btcoexist); ++ ++ halbtc8723d1ant_run_coexist_mechanism(btcoexist); ++} ++ ++ ++ ++void ex_halbtc8723d1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_RF_ON == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned ON!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = false; ++#if 0 ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ONOFF, true); ++#endif ++ ++ } else if (BTC_RF_OFF == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned OFF!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_1ANT_SCOREBOARD_ONOFF | ++ BT_8723D_1ANT_SCOREBOARD_SCAN | ++ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, ++ false); ++ ++ halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_WLAN_OFF); ++ ++ btcoexist->stop_coex_dm = true; ++ } ++} ++ ++void ex_halbtc8723d1ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_1ANT_SCOREBOARD_ONOFF | ++ BT_8723D_1ANT_SCOREBOARD_SCAN | ++ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, ++ false); ++ ++ halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_WLAN_OFF); ++ ++ halbtc8723d1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ++ ex_halbtc8723d1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++ ++ btcoexist->stop_coex_dm = true; ++} ++ ++void ex_halbtc8723d1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if ((BTC_WIFI_PNP_SLEEP == pnp_state) || ++ (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_1ANT_SCOREBOARD_ONOFF | ++ BT_8723D_1ANT_SCOREBOARD_SCAN | ++ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, ++ false); ++ ++ if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) { ++ ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ } else { ++ ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_WLAN_OFF); ++ } ++ ++ btcoexist->stop_coex_dm = true; ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++#if 0 ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_ONOFF, true); ++#endif ++ btcoexist->stop_coex_dm = false; ++ } ++} ++ ++ ++void ex_halbtc8723d1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], *****************Coex DM Reset*****************\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d1ant_init_hw_config(btcoexist, false, false); ++ halbtc8723d1ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8723d1ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ boolean wifi_busy = false; ++ u4Byte value = 0; ++ u32 bt_patch_ver; ++ static u8 cnt = 0; ++ boolean bt_relink_finish = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ************* Periodical *************\n"); ++ BTC_TRACE(trace_buf); ++ ++#if (BT_AUTO_REPORT_ONLY_8723D_1ANT == 0) ++ halbtc8723d1ant_query_bt_info(btcoexist); ++ ++#endif ++ ++ halbtc8723d1ant_monitor_bt_ctr(btcoexist); ++ halbtc8723d1ant_monitor_wifi_ctr(btcoexist); ++ ++ halbtc8723d1ant_monitor_bt_enable_disable(btcoexist); ++ ++#if 0 ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ /* halbtc8723d1ant_read_score_board(btcoexist, &bt_scoreboard_val); */ ++ ++ if (wifi_busy) { ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, true); ++ /* ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_WLBUSY, true); ++ ++ if (bt_scoreboard_val & BIT(6)) ++ halbtc8723d1ant_query_bt_info(btcoexist); */ ++ } else { ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, false); ++ /* ++ halbtc8723d1ant_post_state_to_bt(btcoexist, ++ BT_8723D_1ANT_SCOREBOARD_WLBUSY, ++ false); */ ++ } ++#endif ++ ++ if (coex_sta->bt_relink_downcount != 0) { ++ coex_sta->bt_relink_downcount--; ++ ++ if (coex_sta->bt_relink_downcount == 0) ++ bt_relink_finish = true; ++ } ++ ++ /* for 4-way, DHCP, EAPOL packet */ ++ if (coex_sta->specific_pkt_period_cnt > 0) { ++ ++ coex_sta->specific_pkt_period_cnt--; ++ ++ if ((coex_sta->specific_pkt_period_cnt == 0) && ++ (coex_sta->wifi_is_high_pri_task)) ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", ++ (coex_sta->wifi_is_high_pri_task ? "Yes" : ++ "No")); ++ BTC_TRACE(trace_buf); ++ ++ } ++ ++ if (!coex_sta->bt_disabled) { ++ ++#if BT_8723D_1ANT_ANTDET_ENABLE ++ ++ if (board_info->btdm_ant_det_finish) { ++ if ((psd_scan->ant_det_result == 12) && ++ (psd_scan->ant_det_psd_scan_peak_val == 0) ++ && (!psd_scan->is_AntDet_running)) { ++ psd_scan->ant_det_psd_scan_peak_val = ++ btcoexist->btc_get_ant_det_val_from_bt( ++ btcoexist) * 100; ++ ++ board_info->antdetval = psd_scan->ant_det_psd_scan_peak_val/100; ++ value = board_info->antdetval; ++ ++#ifdef PLATFORM_WINDOWS ++ { ++ PWCHAR registryName; ++ ++ registryName = L"antdetval"; ++ PlatformWriteCommonDwordRegistry(registryName, &value); ++ } ++#endif ++ } ++ } ++ ++#endif ++ } ++ ++ if (halbtc8723d1ant_is_wifibt_status_changed(btcoexist)) ++ halbtc8723d1ant_run_coexist_mechanism(btcoexist); ++ ++ ++} ++ ++void ex_halbtc8723d1ant_set_antenna_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (type == 2) { /* two antenna */ ++ board_info->ant_div_cfg = true; ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ } else { /* one antenna */ ++ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ } ++} ++ ++#ifdef PLATFORM_WINDOWS ++#pragma optimize("", off) ++#endif ++void ex_halbtc8723d1ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++ ++ static u32 ant_det_count = 0, ant_det_fail_count = 0; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u16 u16tmp; ++ u8 AntDetval = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n"); ++ BTC_TRACE(trace_buf); ++ ++#if BT_8723D_1ANT_ANTDET_ENABLE ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Call AntennaDetect()!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (seconds == 0) { ++ psd_scan->ant_det_try_count = 0; ++ psd_scan->ant_det_fail_count = 0; ++ ant_det_count = 0; ++ ant_det_fail_count = 0; ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ return; ++ } ++ ++ if (!board_info->btdm_ant_det_finish) { ++ psd_scan->ant_det_inteval_count = ++ psd_scan->ant_det_inteval_count + 2; ++ ++ if (psd_scan->ant_det_inteval_count >= ++ BT_8723D_2ANT_ANTDET_RETRY_INTERVAL) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ psd_scan->is_AntDet_running = true; ++ ++ halbtc8723d1ant_read_score_board(btcoexist, &u16tmp); ++ ++ if (u16tmp & BIT( ++ 2)) { /* Antenna detection is already done before last WL power on */ ++ board_info->btdm_ant_det_finish = true; ++ psd_scan->ant_det_try_count = 1; ++ psd_scan->ant_det_fail_count = 0; ++ board_info->btdm_ant_num_by_ant_det = (u16tmp & ++ BIT(3)) ? 1 : 2; ++ psd_scan->ant_det_result = 12; ++ ++ psd_scan->ant_det_psd_scan_peak_val = ++ btcoexist->btc_get_ant_det_val_from_bt( ++ btcoexist) * 100; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Result from BT (%d-Ant)\n", ++ board_info->btdm_ant_num_by_ant_det); ++ BTC_TRACE(trace_buf); ++ } else ++ board_info->btdm_ant_det_finish = ++ halbtc8723d1ant_psd_antenna_detection_check( ++ btcoexist); ++ ++ board_info->ant_det_result = psd_scan->ant_det_result; ++ btcoexist->bdontenterLPS = false; ++ ++ if (board_info->btdm_ant_det_finish) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (board_info->btdm_ant_num_by_ant_det == 2) { ++ board_info->ant_div_cfg = true; ++ halbtc8723d1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_WIFI, FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ } else ++ halbtc8723d1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME); ++ ++ /*for 8723d, btc_set_bt_trx_mask is just used to ++ notify BT stop le tx and Ant Det Result , not set BT RF TRx Mask */ ++ if (psd_scan->ant_det_result != 12) { ++ ++ AntDetval = (u8)( ++ psd_scan->ant_det_psd_scan_peak_val ++ / 100) & 0x7f; ++ ++ AntDetval = ++ (board_info->btdm_ant_num_by_ant_det ++ == 1) ? (AntDetval | 0x80) : ++ AntDetval; ++ board_info->antdetval = AntDetval; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxx AntennaDetect(), Ant Count = %d, PSD Val = %d\n", ++ ((AntDetval & ++ 0x80) ? 1 ++ : 2), AntDetval ++ & 0x7f); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->btc_set_bt_trx_mask( ++ btcoexist, AntDetval)) ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask ok!\n"); ++ else ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask fail!\n"); ++ ++ BTC_TRACE(trace_buf); ++ } else ++ board_info->antdetval = ++ psd_scan->ant_det_psd_scan_peak_val/100; ++ ++ board_info->btdm_ant_det_complete_fail = false; ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ board_info->btdm_ant_det_complete_fail = true; ++ } ++ ++ psd_scan->ant_det_inteval_count = 0; ++ psd_scan->is_AntDet_running = false; ++ /* stimulate coex running */ ++ halbtc8723d1ant_run_coexist_mechanism( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", ++ psd_scan->ant_det_inteval_count); ++ BTC_TRACE(trace_buf); ++ ++ if (psd_scan->ant_det_inteval_count == 8) ++ btcoexist->bdontenterLPS = true; ++ else ++ btcoexist->bdontenterLPS = false; ++ } ++ ++ } ++#endif ++ ++ ++} ++ ++ ++void ex_halbtc8723d1ant_display_ant_detection(IN struct btc_coexist *btcoexist) ++{ ++#if BT_8723D_1ANT_ANTDET_ENABLE ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ if (psd_scan->ant_det_try_count != 0) { ++ halbtc8723d1ant_psd_show_antenna_detect_result(btcoexist); ++ ++ if (board_info->btdm_ant_det_finish) ++ halbtc8723d1ant_psd_showdata(btcoexist); ++ } ++#endif ++ ++} ++ ++void ex_halbtc8723d1ant_antenna_isolation(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++ ++ ++} ++ ++void ex_halbtc8723d1ant_psd_scan(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++ ++ ++} ++ ++ ++#endif ++ ++#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.h 2018-02-11 21:44:27.149146116 +0200 +@@ -0,0 +1,413 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8723D_SUPPORT == 1) ++ ++/* ******************************************* ++ * The following is for 8723D 1ANT BT Co-exist definition ++ * ******************************************* */ ++#define BT_8723D_1ANT_COEX_DBG 0 ++#define BT_AUTO_REPORT_ONLY_8723D_1ANT 1 ++ ++#define BT_INFO_8723D_1ANT_B_FTP BIT(7) ++#define BT_INFO_8723D_1ANT_B_A2DP BIT(6) ++#define BT_INFO_8723D_1ANT_B_HID BIT(5) ++#define BT_INFO_8723D_1ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8723D_1ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8723D_1ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8723D_1ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8723D_1ANT_B_CONNECTION BIT(0) ++ ++#define BT_INFO_8723D_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ ++ (((_BT_INFO_EXT_&BIT(0))) ? true : false) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT 2 ++ ++#define BT_8723D_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ ++#define BT_8723D_1ANT_DEFAULT_ISOLATION 15 /* unit: dB */ ++ ++ ++/* for Antenna detection */ ++#define BT_8723D_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 ++#define BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 ++#define BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 ++#define BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT 35 ++#define BT_8723D_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ ++#define BT_8723D_1ANT_ANTDET_SWEEPPOINT_DELAY 60000 ++#define BT_8723D_1ANT_ANTDET_ENABLE 1 ++#define BT_8723D_1ANT_ANTDET_BTTXTIME 100 ++#define BT_8723D_1ANT_ANTDET_BTTXCHANNEL 39 ++#define BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT 50 ++ ++#define BT_8723D_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 ++ ++enum bt_8723d_1ant_signal_state { ++ BT_8723D_1ANT_SIG_STA_SET_TO_LOW = 0x0, ++ BT_8723D_1ANT_SIG_STA_SET_BY_HW = 0x0, ++ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH = 0x1, ++ BT_8723D_1ANT_SIG_STA_MAX ++}; ++ ++enum bt_8723d_1ant_path_ctrl_owner { ++ BT_8723D_1ANT_PCO_BTSIDE = 0x0, ++ BT_8723D_1ANT_PCO_WLSIDE = 0x1, ++ BT_8723D_1ANT_PCO_MAX ++}; ++ ++enum bt_8723d_1ant_gnt_ctrl_type { ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, ++ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW = 0x1, ++ BT_8723D_1ANT_GNT_TYPE_MAX ++}; ++ ++enum bt_8723d_1ant_gnt_ctrl_block { ++ BT_8723D_1ANT_GNT_BLOCK_RFC_BB = 0x0, ++ BT_8723D_1ANT_GNT_BLOCK_RFC = 0x1, ++ BT_8723D_1ANT_GNT_BLOCK_BB = 0x2, ++ BT_8723D_1ANT_GNT_BLOCK_MAX ++}; ++ ++enum bt_8723d_1ant_lte_coex_table_type { ++ BT_8723D_1ANT_CTT_WL_VS_LTE = 0x0, ++ BT_8723D_1ANT_CTT_BT_VS_LTE = 0x1, ++ BT_8723D_1ANT_CTT_MAX ++}; ++ ++enum bt_8723d_1ant_lte_break_table_type { ++ BT_8723D_1ANT_LBTT_WL_BREAK_LTE = 0x0, ++ BT_8723D_1ANT_LBTT_BT_BREAK_LTE = 0x1, ++ BT_8723D_1ANT_LBTT_LTE_BREAK_WL = 0x2, ++ BT_8723D_1ANT_LBTT_LTE_BREAK_BT = 0x3, ++ BT_8723D_1ANT_LBTT_MAX ++}; ++ ++enum bt_info_src_8723d_1ant { ++ BT_INFO_SRC_8723D_1ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8723D_1ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8723D_1ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8723D_1ANT_MAX ++}; ++ ++enum bt_8723d_1ant_bt_status { ++ BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8723D_1ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8723D_1ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8723D_1ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8723D_1ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8723d_1ant_wifi_status { ++ BT_8723D_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8723D_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, ++ BT_8723D_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, ++ BT_8723D_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, ++ BT_8723D_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, ++ BT_8723D_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, ++ BT_8723D_1ANT_WIFI_STATUS_MAX ++}; ++ ++enum bt_8723d_1ant_coex_algo { ++ BT_8723D_1ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8723D_1ANT_COEX_ALGO_SCO = 0x1, ++ BT_8723D_1ANT_COEX_ALGO_HID = 0x2, ++ BT_8723D_1ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8723D_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, ++ BT_8723D_1ANT_COEX_ALGO_PANEDR = 0x5, ++ BT_8723D_1ANT_COEX_ALGO_PANHS = 0x6, ++ BT_8723D_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, ++ BT_8723D_1ANT_COEX_ALGO_PANEDR_HID = 0x8, ++ BT_8723D_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, ++ BT_8723D_1ANT_COEX_ALGO_HID_A2DP = 0xa, ++ BT_8723D_1ANT_COEX_ALGO_MAX = 0xb, ++}; ++ ++enum bt_8723d_1ant_phase { ++ BT_8723D_1ANT_PHASE_COEX_INIT = 0x0, ++ BT_8723D_1ANT_PHASE_WLANONLY_INIT = 0x1, ++ BT_8723D_1ANT_PHASE_WLAN_OFF = 0x2, ++ BT_8723D_1ANT_PHASE_2G_RUNTIME = 0x3, ++ BT_8723D_1ANT_PHASE_5G_RUNTIME = 0x4, ++ BT_8723D_1ANT_PHASE_BTMPMODE = 0x5, ++ BT_8723D_1ANT_PHASE_ANTENNA_DET = 0x6, ++ BT_8723D_1ANT_PHASE_COEX_POWERON = 0x7, ++ BT_8723D_1ANT_PHASE_MAX ++}; ++ ++enum bt_8723d_1ant_Scoreboard { ++ BT_8723D_1ANT_SCOREBOARD_ACTIVE = BIT(0), ++ BT_8723D_1ANT_SCOREBOARD_ONOFF = BIT(1), ++ BT_8723D_1ANT_SCOREBOARD_SCAN = BIT(2), ++ BT_8723D_1ANT_SCOREBOARD_UNDERTEST = BIT(3), ++ BT_8723D_1ANT_SCOREBOARD_WLBUSY = BIT(6) ++}; ++ ++struct coex_dm_8723d_1ant { ++ /* hw setting */ ++ u8 pre_ant_pos_type; ++ u8 cur_ant_pos_type; ++ /* fw mechanism */ ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++ ++ /* sw mechanism */ ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ boolean limited_dig; ++ ++ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ ++ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ ++ u16 backup_retry_limit; ++ u8 backup_ampdu_max_time; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ u32 pre_ra_mask; ++ u32 cur_ra_mask; ++ u8 pre_arfr_type; ++ u8 cur_arfr_type; ++ u8 pre_retry_limit_type; ++ u8 cur_retry_limit_type; ++ u8 pre_ampdu_time_type; ++ u8 cur_ampdu_time_type; ++ u32 arp_cnt; ++ ++ u8 error_condition; ++}; ++ ++struct coex_sta_8723d_1ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ boolean bt_hi_pri_link_exist; ++ u8 num_of_profile; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 specific_pkt_period_cnt; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ boolean is_hiPri_rx_overhead; ++ s8 bt_rssi; ++ boolean bt_tx_rx_mask; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ u8 bt_info_c2h[BT_INFO_SRC_8723D_1ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8723D_1ANT_MAX]; ++ boolean bt_whck_test; ++ boolean c2h_bt_inquiry_page; ++ boolean c2h_bt_remote_name_req; ++ boolean c2h_bt_page; /* Add for win8.1 page out issue */ ++ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++ u8 bt_info_ext2; ++ u32 pop_event_cnt; ++ u8 scan_ap_num; ++ ++ u32 crc_ok_cck; ++ u32 crc_ok_11g; ++ u32 crc_ok_11n; ++ u32 crc_ok_11n_vht; ++ ++ u32 crc_err_cck; ++ u32 crc_err_11g; ++ u32 crc_err_11n; ++ u32 crc_err_11n_vht; ++ ++ boolean cck_lock; ++ boolean pre_ccklock; ++ boolean cck_ever_lock; ++ u8 coex_table_type; ++ ++ boolean force_lps_on; ++ ++ boolean concurrent_rx_mode_on; ++ ++ u16 score_board; ++ u8 isolation_btween_wb; /* 0~ 50 */ ++ ++ u8 a2dp_bit_pool; ++ u8 cut_version; ++ boolean acl_busy; ++ boolean bt_create_connection; ++ ++ u32 bt_coex_supported_feature; ++ u32 bt_coex_supported_version; ++ ++ u8 bt_ble_scan_type; ++ u32 bt_ble_scan_para[3]; ++ ++ boolean run_time_state; ++ boolean freeze_coexrun_by_btinfo; ++ ++ boolean is_A2DP_3M; ++ boolean voice_over_HOGP; ++ u8 bt_info; ++ boolean is_autoslot; ++ u8 forbidden_slot; ++ u8 hid_busy_num; ++ u8 hid_pair_cnt; ++ ++ u32 cnt_RemoteNameReq; ++ u32 cnt_setupLink; ++ u32 cnt_ReInit; ++ u32 cnt_IgnWlanAct; ++ u32 cnt_Page; ++ u32 cnt_RoleSwitch; ++ ++ u16 bt_reg_vendor_ac; ++ u16 bt_reg_vendor_ae; ++ ++ boolean is_setupLink; ++ u8 wl_noisy_level; ++ u32 gnt_error_cnt; ++ ++ u8 bt_afh_map[10]; ++ u8 bt_relink_downcount; ++ boolean is_tdma_btautoslot; ++ boolean is_tdma_btautoslot_hang; ++}; ++ ++#define BT_8723D_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ ++#define BT_8723D_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ ++#define BT_8723D_1ANT_ANTDET_BUF_LEN 16 ++ ++struct psdscan_sta_8723d_1ant { ++ ++ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ ++ u32 ant_det_bt_tx_time; ++ u32 ant_det_pre_psdscan_peak_val; ++ boolean ant_det_is_ant_det_available; ++ u32 ant_det_psd_scan_peak_val; ++ boolean ant_det_is_btreply_available; ++ u32 ant_det_psd_scan_peak_freq; ++ ++ u8 ant_det_result; ++ u8 ant_det_peak_val[BT_8723D_1ANT_ANTDET_BUF_LEN]; ++ u8 ant_det_peak_freq[BT_8723D_1ANT_ANTDET_BUF_LEN]; ++ u32 ant_det_try_count; ++ u32 ant_det_fail_count; ++ u32 ant_det_inteval_count; ++ u32 ant_det_thres_offset; ++ ++ u32 real_cent_freq; ++ s32 real_offset; ++ u32 real_span; ++ ++ u32 psd_band_width; /* unit: Hz */ ++ u32 psd_point; /* 128/256/512/1024 */ ++ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_start_point; ++ u32 psd_stop_point; ++ u32 psd_max_value_point; ++ u32 psd_max_value; ++ u32 psd_max_value2; ++ u32 psd_avg_value; /* filter loop_max_value that below BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT, and average the rest*/ ++ u32 psd_loop_max_value[BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT]; /*max value in each loop */ ++ u32 psd_start_base; ++ u32 psd_avg_num; /* 1/8/16/32 */ ++ u32 psd_gen_count; ++ boolean is_AntDet_running; ++ boolean is_psd_show_max_only; ++}; ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8723d1ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723d1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723d1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8723d1ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723d1ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d1ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8723d1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d1ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723d1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state); ++void ex_halbtc8723d1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723d1ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723d1ant_set_antenna_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723d1ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++void ex_halbtc8723d1ant_antenna_isolation(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++ ++void ex_halbtc8723d1ant_psd_scan(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++void ex_halbtc8723d1ant_display_ant_detection(IN struct btc_coexist *btcoexist); ++ ++#else ++#define ex_halbtc8723d1ant_power_on_setting(btcoexist) ++#define ex_halbtc8723d1ant_pre_load_firmware(btcoexist) ++#define ex_halbtc8723d1ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8723d1ant_init_coex_dm(btcoexist) ++#define ex_halbtc8723d1ant_ips_notify(btcoexist, type) ++#define ex_halbtc8723d1ant_lps_notify(btcoexist, type) ++#define ex_halbtc8723d1ant_scan_notify(btcoexist, type) ++#define ex_halbtc8723d1ant_connect_notify(btcoexist, type) ++#define ex_halbtc8723d1ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8723d1ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8723d1ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8723d1ant_rf_status_notify(btcoexist, type) ++#define ex_halbtc8723d1ant_halt_notify(btcoexist) ++#define ex_halbtc8723d1ant_pnp_notify(btcoexist, pnp_state) ++#define ex_halbtc8723d1ant_coex_dm_reset(btcoexist) ++#define ex_halbtc8723d1ant_periodical(btcoexist) ++#define ex_halbtc8723d1ant_display_coex_info(btcoexist) ++#define ex_halbtc8723d1ant_set_antenna_notify(btcoexist, type) ++#define ex_halbtc8723d1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) ++#define ex_halbtc8723d1ant_antenna_isolation(btcoexist, cent_freq, offset, span, seconds) ++#define ex_halbtc8723d1ant_psd_scan(btcoexist, cent_freq, offset, span, seconds) ++#define ex_halbtc8723d1ant_display_ant_detection(btcoexist) ++#endif ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.c 2018-02-11 21:44:27.149146116 +0200 +@@ -0,0 +1,6835 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8723D Co-exist mechanism ++ * ++ * History ++ * 2012/11/15 Cosa first check in. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8723D_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8723d_2ant glcoex_dm_8723d_2ant; ++static struct coex_dm_8723d_2ant *coex_dm = &glcoex_dm_8723d_2ant; ++static struct coex_sta_8723d_2ant glcoex_sta_8723d_2ant; ++static struct coex_sta_8723d_2ant *coex_sta = &glcoex_sta_8723d_2ant; ++static struct psdscan_sta_8723d_2ant gl_psd_scan_8723d_2ant; ++static struct psdscan_sta_8723d_2ant *psd_scan = &gl_psd_scan_8723d_2ant; ++ ++const char *const glbt_info_src_8723d_2ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++/* ************************************************************ ++ * BtCoex Version Format: ++ * 1. date : glcoex_ver_date_XXXXX_1ant ++ * 2. WifiCoexVersion : glcoex_ver_XXXX_1ant ++ * 3. BtCoexVersion : glcoex_ver_btdesired_XXXXX_1ant ++ * 4. others : glcoex_ver_XXXXXX_XXXXX_1ant ++ * ++ * Variable should be indicated IC and Antenna numbers !!! ++ * Please strictly follow this order and naming style !!! ++ * ++ * ************************************************************ */ ++u32 glcoex_ver_date_8723d_2ant = 20170111; ++u32 glcoex_ver_8723d_2ant = 0x14; ++u32 glcoex_ver_btdesired_8723d_2ant = 0x10; ++ ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8723d2ant_ ++ * ************************************************************ */ ++u8 halbtc8723d2ant_bt_rssi_state(u8 *ppre_bt_rssi_state, u8 level_num, ++ u8 rssi_thresh, u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = *ppre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return *ppre_bt_rssi_state; ++ } ++ ++ if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || ++ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ *ppre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8723d2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 *pprewifi_rssi_state, IN u8 level_num, IN u8 rssi_thresh, ++ IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = *pprewifi_rssi_state; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || ++ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return *pprewifi_rssi_state; ++ } ++ ++ if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || ++ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((*pprewifi_rssi_state == BTC_RSSI_STATE_MEDIUM) || ++ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ *pprewifi_rssi_state = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8723d2ant_coex_switch_threshold(IN struct btc_coexist *btcoexist, ++ IN u8 isolation_measuared) ++{ ++ s8 interference_wl_tx = 0, interference_bt_tx = 0; ++ ++ ++ interference_wl_tx = BT_8723D_2ANT_WIFI_MAX_TX_POWER - ++ isolation_measuared; ++ interference_bt_tx = BT_8723D_2ANT_BT_MAX_TX_POWER - ++ isolation_measuared; ++ ++ ++ ++ coex_sta->wifi_coex_thres = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; ++ coex_sta->wifi_coex_thres2 = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES2; ++ ++ coex_sta->bt_coex_thres = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1; ++ coex_sta->bt_coex_thres2 = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES2; ++ ++ ++ /* ++ coex_sta->wifi_coex_thres = interference_wl_tx + BT_8723D_2ANT_WIFI_SIR_THRES1; ++ coex_sta->wifi_coex_thres2 = interference_wl_tx + BT_8723D_2ANT_WIFI_SIR_THRES2; ++ ++ coex_sta->bt_coex_thres = interference_bt_tx + BT_8723D_2ANT_BT_SIR_THRES1; ++ coex_sta->bt_coex_thres2 = interference_bt_tx + BT_8723D_2ANT_BT_SIR_THRES2; ++ */ ++ ++ ++ ++ ++ ++ /* ++ if ( BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - ++ BT_8723D_2ANT_DEFAULT_ISOLATION) ) ++ coex_sta->wifi_coex_thres = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; ++ else ++ coex_sta->wifi_coex_thres = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - ++ BT_8723D_2ANT_DEFAULT_ISOLATION); ++ ++ if ( BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - ++ BT_8723D_2ANT_DEFAULT_ISOLATION) ) ++ coex_sta->bt_coex_thres = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1; ++ else ++ coex_sta->bt_coex_thres = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - ++ BT_8723D_2ANT_DEFAULT_ISOLATION); ++ ++ */ ++} ++ ++ ++void halbtc8723d2ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++} ++ ++void halbtc8723d2ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ ++ h2c_parameter[0] |= BIT(0); /* trigger */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); ++} ++ ++void halbtc8723d2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ static u8 num_of_bt_counter_chk = 0, cnt_slave = 0, cnt_overhead = 0, ++ cnt_autoslot_hang = 0; ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ if (BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ ++ if (coex_sta->high_priority_rx >= 15) { ++ if (cnt_overhead < 3) ++ cnt_overhead++; ++ ++ if (cnt_overhead == 3) ++ coex_sta->is_hiPri_rx_overhead = true; ++ } else { ++ if (cnt_overhead > 0) ++ cnt_overhead--; ++ ++ if (cnt_overhead == 0) ++ coex_sta->is_hiPri_rx_overhead = false; ++ } ++ } else ++ coex_sta->is_hiPri_rx_overhead = false; ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++ ++ if ((coex_sta->low_priority_tx > 1050) && ++ (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->pop_event_cnt++; ++ ++ if ((coex_sta->low_priority_rx >= 950) && ++ (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) ++ && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && ++ (coex_sta->bt_link_exist)) { ++ if (cnt_slave >= 2) { ++ bt_link_info->slave_role = true; ++ cnt_slave = 2; ++ } else ++ cnt_slave++; ++ } else { ++ if (cnt_slave == 0) { ++ bt_link_info->slave_role = false; ++ cnt_slave = 0; ++ } else ++ cnt_slave--; ++ ++ } ++ ++ if (coex_sta->is_tdma_btautoslot) { ++ if ((coex_sta->low_priority_tx >= 1300) && ++ (coex_sta->low_priority_rx <= 150)) { ++ if (cnt_autoslot_hang >= 2) { ++ coex_sta->is_tdma_btautoslot_hang = true; ++ cnt_autoslot_hang = 2; ++ } else ++ cnt_autoslot_hang++; ++ } else { ++ if (cnt_autoslot_hang == 0) { ++ coex_sta->is_tdma_btautoslot_hang = false; ++ cnt_autoslot_hang = 0; ++ } else ++ cnt_autoslot_hang--; ++ } ++ } ++ ++ if (coex_sta->sco_exist) { ++ if ((coex_sta->high_priority_tx >= 400) && ++ (coex_sta->high_priority_rx >= 400)) ++ coex_sta->is_eSCO_mode = false; ++ else ++ coex_sta->is_eSCO_mode = true; ++ } ++ ++ if (!coex_sta->bt_disabled) { ++ ++ if ((coex_sta->high_priority_tx == 0) && ++ (coex_sta->high_priority_rx == 0) && ++ (coex_sta->low_priority_tx == 0) && ++ (coex_sta->low_priority_rx == 0)) { ++ num_of_bt_counter_chk++; ++ if (num_of_bt_counter_chk >= 3) { ++ halbtc8723d2ant_query_bt_info(btcoexist); ++ num_of_bt_counter_chk = 0; ++ } ++ } ++ } ++ ++} ++ ++void halbtc8723d2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) ++{ ++#if 1 ++ s32 wifi_rssi = 0; ++ boolean wifi_busy = false, wifi_under_b_mode = false, ++ wifi_scan = false; ++ boolean bt_idle = false, wl_idle = false; ++ static u8 cck_lock_counter = 0, wl_noisy_count0 = 0, ++ wl_noisy_count1 = 3, wl_noisy_count2 = 0; ++ u32 total_cnt, reg_val1, reg_val2, cck_cnt; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_OK_CCK); ++ coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_OK_LEGACY); ++ coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_OK_HT); ++ coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_OK_VHT); ++ ++ coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_ERROR_CCK); ++ coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY); ++ coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_ERROR_HT); ++ coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_PHY_counter( ++ btcoexist, PHYDM_INFO_CRC32_ERROR_VHT); ++ ++ cck_cnt = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; ++ ++ if (cck_cnt > 250) { ++ if (wl_noisy_count2 < 3) ++ wl_noisy_count2++; ++ ++ if (wl_noisy_count2 == 3) { ++ wl_noisy_count0 = 0; ++ wl_noisy_count1 = 0; ++ } ++ } else if (cck_cnt < 50) { ++ if (wl_noisy_count0 < 3) ++ wl_noisy_count0++; ++ ++ if (wl_noisy_count0 == 3) { ++ wl_noisy_count1 = 0; ++ wl_noisy_count2 = 0; ++ } ++ } else { ++ if (wl_noisy_count1 < 3) ++ wl_noisy_count1++; ++ ++ if (wl_noisy_count1 == 3) { ++ wl_noisy_count0 = 0; ++ wl_noisy_count2 = 0; ++ } ++ } ++ ++ if (wl_noisy_count2 == 3) ++ coex_sta->wl_noisy_level = 2; ++ else if (wl_noisy_count1 == 3) ++ coex_sta->wl_noisy_level = 1; ++ else ++ coex_sta->wl_noisy_level = 0; ++ ++ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { ++ total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + ++ coex_sta->crc_ok_11n + coex_sta->crc_ok_11n_vht; ++ ++ if ((coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_ACL_BUSY) || ++ (coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY) || ++ (coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_SCO_BUSY)) { ++ if (coex_sta->crc_ok_cck > (total_cnt - ++ coex_sta->crc_ok_cck)) { ++ if (cck_lock_counter < 3) ++ cck_lock_counter++; ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ if (!coex_sta->pre_ccklock) { ++ ++ if (cck_lock_counter >= 3) ++ coex_sta->cck_lock = true; ++ else ++ coex_sta->cck_lock = false; ++ } else { ++ if (cck_lock_counter == 0) ++ coex_sta->cck_lock = false; ++ else ++ coex_sta->cck_lock = true; ++ } ++ ++ if (coex_sta->cck_lock) ++ coex_sta->cck_ever_lock = true; ++ ++ coex_sta->pre_ccklock = coex_sta->cck_lock; ++ ++#endif ++} ++ ++void halbtc8723d2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ boolean bt_busy = false; ++ ++ ++ coex_sta->num_of_profile = 0; ++ ++ /* set link exist status */ ++ if (!(coex_sta->bt_info & BT_INFO_8723D_2ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_FTP) { ++ coex_sta->pan_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->pan_exist = false; ++ ++ if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_A2DP) { ++ coex_sta->a2dp_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->a2dp_exist = false; ++ ++ if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_HID) { ++ coex_sta->hid_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->hid_exist = false; ++ ++ if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_ESCO) { ++ coex_sta->sco_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->sco_exist = false; ++ ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ bt_link_info->acl_busy = coex_sta->acl_busy; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if (bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if (!bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++ ++ if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_INQ_PAGE) { ++ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_INQ_PAGE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Inq/page!!!\n"); ++ } else if (!(coex_sta->bt_info & BT_INFO_8723D_2ANT_B_CONNECTION)) { ++ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); ++ } else if (coex_sta->bt_info == BT_INFO_8723D_2ANT_B_CONNECTION) { ++ /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); ++ } else if (((coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_ESCO) || ++ (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_BUSY)) && ++ (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_ACL_BUSY)) { ++ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL SCO busy!!!\n"); ++ } else if ((coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_ESCO) || ++ (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_BUSY)) { ++ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); ++ } else if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_ACL_BUSY) { ++ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_ACL_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); ++ } else { ++ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_MAX; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); ++ } ++ ++ BTC_TRACE(trace_buf); ++ ++ if ((BT_8723D_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8723D_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ bt_busy = true; ++ else ++ bt_busy = false; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++} ++ ++void halbtc8723d2ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ h2c_parameter[0] = ++ 0x1; /* enable BT AFH skip WL channel for 8723d because BT Rx LO interference */ ++ /* h2c_parameter[0] = 0x0; */ ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); ++ ++} ++ ++void halbtc8723d2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, ++ IN u8 dac_swing_lvl) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ /* There are several type of dacswing */ ++ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ ++ h2c_parameter[0] = dac_swing_lvl; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); ++} ++ ++void halbtc8723d2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 fw_dac_swing_lvl) ++{ ++ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_fw_dac_swing_lvl == ++ coex_dm->cur_fw_dac_swing_lvl) ++ return; ++ } ++ ++ halbtc8723d2ant_set_fw_dac_swing_level(btcoexist, ++ coex_dm->cur_fw_dac_swing_lvl); ++ ++ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; ++} ++ ++void halbtc8723d2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN u8 dec_bt_pwr_lvl) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = dec_bt_pwr_lvl; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); ++} ++ ++void halbtc8723d2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 dec_bt_pwr_lvl) ++{ ++ coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) ++ return; ++ } ++ halbtc8723d2ant_set_fw_dec_bt_pwr(btcoexist, ++ coex_dm->cur_bt_dec_pwr_lvl); ++ ++ coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; ++} ++ ++void halbtc8723d2ant_set_fw_low_penalty_ra(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++#if 1 ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ ++ ++ if (low_penalty_ra) { ++ h2c_parameter[1] |= BIT(0); ++ h2c_parameter[2] = ++ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ ++ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ ++ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ ++ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); ++#endif ++} ++ ++void halbtc8723d2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++#if 1 ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ ++ halbtc8723d2ant_set_fw_low_penalty_ra(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++#if 0 ++ if (low_penalty_ra) ++ btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 15); ++ else ++ btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 0); ++#endif ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++ ++#endif ++} ++ ++void halbtc8723d2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8723d2ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ halbtc8723d2ant_set_bt_auto_report(btcoexist, ++ coex_dm->cur_bt_auto_report); ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++void halbtc8723d2ant_write_score_board( ++ IN struct btc_coexist *btcoexist, ++ IN u16 bitpos, ++ IN boolean state ++) ++{ ++ ++ static u16 originalval = 0x8002; ++ ++ if (state) ++ originalval = originalval | bitpos; ++ else ++ originalval = originalval & (~bitpos); ++ ++ ++ btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); ++ ++} ++ ++void halbtc8723d2ant_read_score_board( ++ IN struct btc_coexist *btcoexist, ++ IN u16 *score_board_val ++) ++{ ++ ++ *score_board_val = (btcoexist->btc_read_2byte(btcoexist, ++ 0xaa)) & 0x7fff; ++} ++ ++ ++void halbtc8723d2ant_post_state_to_bt( ++ IN struct btc_coexist *btcoexist, ++ IN u16 type, ++ IN boolean state ++) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], halbtc8723d2ant_post_state_to_bt: type = %d, state =%d\n", ++ type, state); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_write_score_board(btcoexist, (u16) type, state); ++ ++} ++ ++boolean halbtc8723d2ant_is_wifibt_status_changed(IN struct btc_coexist ++ *btcoexist) ++{ ++ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false, pre_bt_off = false, pre_bt_slave = false; ++ static u8 pre_hid_busy_num = 0, pre_wl_noisy_level = 0; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (coex_sta->bt_disabled != pre_bt_off) { ++ pre_bt_off = coex_sta->bt_disabled; ++ ++ if (coex_sta->bt_disabled) ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!\n"); ++ else ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is enabled !!\n"); ++ ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->bt_coex_supported_feature = 0; ++ coex_sta->bt_coex_supported_version = 0; ++ coex_sta->bt_ble_scan_type = 0; ++ coex_sta->bt_ble_scan_para[0] = 0; ++ coex_sta->bt_ble_scan_para[1] = 0; ++ coex_sta->bt_ble_scan_para[2] = 0; ++ coex_sta->bt_reg_vendor_ac = 0xffff; ++ coex_sta->bt_reg_vendor_ae = 0xffff; ++ return true; ++ } ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ ++ if (wifi_busy) ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, true); ++ else ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, false); ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ if (coex_sta->wl_noisy_level != pre_wl_noisy_level) { ++ pre_wl_noisy_level = coex_sta->wl_noisy_level; ++ return true; ++ } ++ } ++ ++ if (!coex_sta->bt_disabled) { ++ if (coex_sta->hid_busy_num != pre_hid_busy_num) { ++ pre_hid_busy_num = coex_sta->hid_busy_num; ++ return true; ++ } ++ } ++ ++ if (bt_link_info->slave_role != pre_bt_slave) { ++ pre_bt_slave = bt_link_info->slave_role; ++ return true; ++ } ++ ++ return false; ++} ++ ++void halbtc8723d2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ u16 u16tmp; ++ ++ /* This function check if bt is disabled */ ++#if 0 ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ ++ ++#else ++ ++ /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */ ++ halbtc8723d2ant_read_score_board(btcoexist, &u16tmp); ++ ++ bt_active = u16tmp & BIT(1); ++ ++ ++#endif ++ ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ } else { ++ ++ bt_disable_cnt++; ++ if (bt_disable_cnt >= 2) { ++ bt_disabled = true; ++ bt_disable_cnt = 2; ++ } ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ } ++ ++ if (bt_disabled) ++ halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); ++ else ++ halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, true); ++ ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_disabled = bt_disabled; ++ } ++ ++} ++ ++ ++ ++void halbtc8723d2ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, ++ boolean isenable) ++{ ++#if BT_8723D_2ANT_COEX_DBG ++ if (isenable) { ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); ++ ++ /* enable GNT_BT to GPIO debug */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); ++ ++ /* 0x48[20] = 0 for GPIO14 = GNT_WL*/ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x0); ++ /* 0x40[17] = 0 for GPIO14 = GNT_WL*/ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, 0x02, 0x0); ++ ++ /* 0x66[9] = 0 for GPIO15 = GNT_BT*/ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x02, 0x0); ++ /* 0x66[7] = 0 ++ for GPIO15 = GNT_BT*/ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, 0x80, 0x0); ++ /* 0x8[8] = 0 for GPIO15 = GNT_BT*/ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x9, 0x1, 0x0); ++ ++ /* BT Vendor Reg 0x76[0] = 0 for GPIO15 = GNT_BT, this is not set here*/ ++ } else { ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); ++ ++ /* Disable GNT_BT debug to GPIO, and enable chip_wakeup_host */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x1); ++ ++ /* 0x48[20] = 0 for GPIO14 = GNT_WL*/ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x1); ++ } ++ ++#endif ++} ++ ++u32 halbtc8723d2ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, ++ IN u16 reg_addr) ++{ ++ u32 j = 0, delay_count = 0; ++ ++ ++ /* wait for ready bit before access 0x7c0 */ ++ btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0x800F0000 | reg_addr); ++ ++ while (1) { ++ if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { ++ delay_ms(50); ++ delay_count++; ++ if (delay_count >= 10) { ++ delay_count = 0; ++ break; ++ } ++ } else ++ break; ++ } ++ ++ return btcoexist->btc_read_4byte(btcoexist, ++ 0x7c8); /* get read data */ ++ ++} ++ ++void halbtc8723d2ant_ltecoex_indirect_write_reg(IN struct btc_coexist ++ *btcoexist, ++ IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) ++{ ++ u32 val, i = 0, j = 0, bitpos = 0, delay_count = 0; ++ ++ ++ if (bit_mask == 0x0) ++ return; ++ if (bit_mask == 0xffffffff) { ++ btcoexist->btc_write_4byte(btcoexist, 0x7c4, ++ reg_value); /* put write data */ ++ ++ /* wait for ready bit before access 0x7c0 */ ++ while (1) { ++ if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { ++ delay_ms(50); ++ delay_count++; ++ if (delay_count >= 10) { ++ delay_count = 0; ++ break; ++ } ++ } else ++ break; ++ } ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x7c0, ++ 0xc00F0000 | reg_addr); ++ } else { ++ for (i = 0; i <= 31; i++) { ++ if (((bit_mask >> i) & 0x1) == 0x1) { ++ bitpos = i; ++ break; ++ } ++ } ++ ++ /* read back register value before write */ ++ val = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, ++ reg_addr); ++ val = (val & (~bit_mask)) | (reg_value << bitpos); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x7c4, ++ val); /* put write data */ ++ ++ /* wait for ready bit before access 0x7c0 */ ++ while (1) { ++ if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { ++ delay_ms(50); ++ delay_count++; ++ if (delay_count >= 10) { ++ delay_count = 0; ++ break; ++ } ++ } else ++ break; ++ } ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x7c0, ++ 0xc00F0000 | reg_addr); ++ ++ } ++ ++} ++ ++void halbtc8723d2ant_ltecoex_enable(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 val; ++ ++ val = (enable) ? 1 : 0; ++ halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, ++ val); /* 0x38[7] */ ++ ++} ++ ++void halbtc8723d2ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_control) ++{ ++ u8 val; ++ ++ val = (wifi_control) ? 1 : 0; ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, ++ val); /* 0x70[26] */ ++ ++} ++ ++void halbtc8723d2ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, ++ IN u8 control_block, IN boolean sw_control, IN u8 state) ++{ ++ u32 val = 0, val_orig = 0; ++ ++ if (!sw_control) ++ val = 0x0; ++ else if (state & 0x1) ++ val = 0x3; ++ else ++ val = 0x1; ++ ++ val_orig = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x38); ++ ++ switch (control_block) { ++ case BT_8723D_2ANT_GNT_BLOCK_RFC_BB: ++ default: ++ val = ((val << 14) | (val << 10)) | (val_orig & 0xffff33ff); ++ break; ++ case BT_8723D_2ANT_GNT_BLOCK_RFC: ++ val = (val << 14) | (val_orig & 0xffff3fff); ++ break; ++ case BT_8723D_2ANT_GNT_BLOCK_BB: ++ val = (val << 10) | (val_orig & 0xfffff3ff); ++ break; ++ } ++ ++ halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, 0xffffffff, val); ++} ++ ++ ++void halbtc8723d2ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, ++ IN u8 control_block, IN boolean sw_control, IN u8 state) ++{ ++ u32 val = 0, val_orig = 0; ++ ++ if (!sw_control) ++ val = 0x0; ++ else if (state & 0x1) ++ val = 0x3; ++ else ++ val = 0x1; ++ ++ val_orig = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x38); ++ ++ switch (control_block) { ++ case BT_8723D_2ANT_GNT_BLOCK_RFC_BB: ++ default: ++ val = ((val << 12) | (val << 8)) | (val_orig & 0xffffccff); ++ break; ++ case BT_8723D_2ANT_GNT_BLOCK_RFC: ++ val = (val << 12) | (val_orig & 0xffffcfff); ++ break; ++ case BT_8723D_2ANT_GNT_BLOCK_BB: ++ val = (val << 8) | (val_orig & 0xfffffcff); ++ break; ++ } ++ ++ halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, 0xffffffff, val); ++} ++ ++void halbtc8723d2ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u8 table_type, IN u16 table_content) ++{ ++ u16 reg_addr = 0x0000; ++ ++ switch (table_type) { ++ case BT_8723D_2ANT_CTT_WL_VS_LTE: ++ reg_addr = 0xa0; ++ break; ++ case BT_8723D_2ANT_CTT_BT_VS_LTE: ++ reg_addr = 0xa4; ++ break; ++ } ++ ++ if (reg_addr != 0x0000) ++ halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, ++ 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ ++ ++ ++} ++ ++ ++void halbtc8723d2ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, ++ IN u8 table_type, IN u8 table_content) ++{ ++ u16 reg_addr = 0x0000; ++ ++ switch (table_type) { ++ case BT_8723D_2ANT_LBTT_WL_BREAK_LTE: ++ reg_addr = 0xa8; ++ break; ++ case BT_8723D_2ANT_LBTT_BT_BREAK_LTE: ++ reg_addr = 0xac; ++ break; ++ case BT_8723D_2ANT_LBTT_LTE_BREAK_WL: ++ reg_addr = 0xb0; ++ break; ++ case BT_8723D_2ANT_LBTT_LTE_BREAK_BT: ++ reg_addr = 0xb4; ++ break; ++ } ++ ++ if (reg_addr != 0x0000) ++ halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, ++ 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ ++ ++ ++} ++ ++void halbtc8723d2ant_set_wltoggle_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 interval, ++ IN u8 val0x6c4_b0, IN u8 val0x6c4_b1, IN u8 val0x6c4_b2, ++ IN u8 val0x6c4_b3) ++{ ++ static u8 pre_h2c_parameter[6] = {0}; ++ u8 cur_h2c_parameter[6] = {0}; ++ u8 i, match_cnt = 0; ++ ++ cur_h2c_parameter[0] = 0x7; /* op_code, 0x7= wlan toggle slot*/ ++ ++ cur_h2c_parameter[1] = interval; ++ cur_h2c_parameter[2] = val0x6c4_b0; ++ cur_h2c_parameter[3] = val0x6c4_b1; ++ cur_h2c_parameter[4] = val0x6c4_b2; ++ cur_h2c_parameter[5] = val0x6c4_b3; ++ ++ if (!force_exec) { ++ for (i = 1; i <= 5; i++) { ++ if (cur_h2c_parameter[i] != pre_h2c_parameter[i]) ++ break; ++ ++ match_cnt++; ++ } ++ ++ if (match_cnt == 5) ++ return; ++ } ++ ++ for (i = 1; i <= 5; i++) ++ pre_h2c_parameter[i] = cur_h2c_parameter[i]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, cur_h2c_parameter); ++} ++ ++void halbtc8723d2ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8723d2ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ halbtc8723d2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8723d2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ u32 break_table; ++ u8 select_table; ++ ++ coex_sta->coex_table_type = type; ++ ++ if (coex_sta->concurrent_rx_mode_on == true) { ++ break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ ++ select_table = ++ 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ ++ } else { ++ break_table = 0xffffff; ++ select_table = 0x3; ++ } ++ ++ switch (type) { ++ case 0: ++ halbtc8723d2ant_coex_table(btcoexist, force_exec, ++ 0xffffffff, 0xffffffff, break_table, select_table); ++ break; ++ case 1: ++ halbtc8723d2ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, break_table, select_table); ++ break; ++ case 2: ++ halbtc8723d2ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0x5a5a5a5a, break_table, select_table); ++ break; ++ case 3: ++ halbtc8723d2ant_coex_table(btcoexist, force_exec, ++ 0xaa555555, 0xaa5a5a5a, break_table, select_table); ++ break; ++ case 4: ++ halbtc8723d2ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, break_table, select_table); ++ break; ++ case 5: ++ halbtc8723d2ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x55555555, break_table, select_table); ++ break; ++ case 6: ++ halbtc8723d2ant_coex_table(btcoexist, force_exec, ++ 0xa5555555, 0xfafafafa, break_table, select_table); ++ break; ++ case 7: ++ halbtc8723d2ant_coex_table(btcoexist, force_exec, ++ 0xa5555555, 0xaa5a5a5a, break_table, select_table); ++ break; ++ case 8: ++ halbtc8723d2ant_coex_table(btcoexist, force_exec, ++ 0xa5555555, 0xfafafafa, break_table, select_table); ++ break; ++ case 9: ++ halbtc8723d2ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0xaaaa5aaa, break_table, select_table); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8723d2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ if (enable) { ++ h2c_parameter[0] |= BIT(0); /* function enable */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); ++} ++ ++void halbtc8723d2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ halbtc8723d2ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8723d2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8723d2ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8723d2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8723d2ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ u8 h2c_parameter[5] = {0, 0, 0, 0x40, 0}; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ /*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); */ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, ++ h2c_parameter); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ /*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8);*/ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, ++ h2c_parameter); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++void halbtc8723d2ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ boolean low_pwr_disable = false; ++ ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ /* recover to original 32k low power setting */ ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ case BTC_PS_LPS_ON: ++ halbtc8723d2ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8723d2ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ /* when coex force to enter LPS, do not enter 32k low power. */ ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ coex_sta->force_lps_on = true; ++ break; ++ case BTC_PS_LPS_OFF: ++ halbtc8723d2ant_ps_tdma_check_for_power_save_state( ++ btcoexist, false); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ default: ++ break; ++ } ++} ++ ++ ++ ++void halbtc8723d2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ u8 real_byte1 = byte1, real_byte5 = byte5; ++ boolean ap_enable = false; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ if (byte5 & BIT(2)) ++ coex_sta->is_tdma_btautoslot = true; ++ else ++ coex_sta->is_tdma_btautoslot = false; ++ ++ /* release bt-auto slot for auto-slot hang is detected!! */ ++ if (coex_sta->is_tdma_btautoslot) ++ if ((coex_sta->is_tdma_btautoslot_hang) || ++ (bt_link_info->slave_role)) ++ byte5 = byte5 & 0xfb; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], FW for AP mode\n"); ++ BTC_TRACE(trace_buf); ++ real_byte1 &= ~BIT(4); ++ real_byte1 |= BIT(5); ++ ++ real_byte5 |= BIT(5); ++ real_byte5 &= ~BIT(6); ++ ++ halbtc8723d2ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ ++ halbtc8723d2ant_power_save_state( ++ btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } else { ++ halbtc8723d2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, ++ 0x0); ++ } ++ ++ ++ h2c_parameter[0] = real_byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = real_byte5; ++ ++ coex_dm->ps_tdma_para[0] = real_byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = real_byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++void halbtc8723d2ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ ++ static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ ++ if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) ++ psTdmaByte4Modify = 0x1; ++ else ++ psTdmaByte4Modify = 0x0; ++ ++ if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { ++ ++ force_exec = true; ++ pre_psTdmaByte4Modify = psTdmaByte4Modify; ++ } ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ return; ++ } ++ ++ if (coex_dm->cur_ps_tdma_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(on, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, ++ 0x1); /* enable TBTT nterrupt */ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(off, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } ++ ++ ++ if (turn_on) { ++ switch (type) { ++ case 1: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x10, 0x03, 0x91, ++ 0x54 | psTdmaByte4Modify); ++ break; ++ case 2: ++ default: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x35, 0x03, 0x11, ++ 0x11 | psTdmaByte4Modify); ++ break; ++ case 3: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x3a, 0x3, 0x91, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 4: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x21, 0x3, 0x91, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 5: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x25, 0x3, 0x91, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 6: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x10, 0x3, 0x91, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 7: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x20, 0x3, 0x91, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 8: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x15, 0x03, 0x11, ++ 0x11); ++ break; ++ case 10: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x30, 0x03, 0x11, ++ 0x10); ++ break; ++ case 11: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x35, 0x03, 0x11, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 12: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x35, 0x03, 0x11, 0x11); ++ break; ++ case 13: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x1c, 0x03, 0x11, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 14: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x20, 0x03, 0x11, ++ 0x11); ++ break; ++ case 15: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x10, 0x03, 0x11, ++ 0x14); ++ break; ++ case 16: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x10, 0x03, 0x11, ++ 0x15); ++ break; ++ case 21: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x30, 0x03, 0x11, ++ 0x10); ++ break; ++ case 22: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x25, 0x03, 0x11, ++ 0x10); ++ break; ++ case 23: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x10, 0x03, 0x11, ++ 0x10); ++ break; ++ case 51: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x10, 0x03, 0x91, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 101: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x10, 0x03, 0x10, ++ 0x54 | psTdmaByte4Modify); ++ break; ++ case 102: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x35, 0x03, 0x11, ++ 0x11 | psTdmaByte4Modify); ++ break; ++ case 103: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x3a, 0x3, 0x10, ++ 0x50 | psTdmaByte4Modify); ++ break; ++ case 104: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x21, 0x3, 0x10, ++ 0x50 | psTdmaByte4Modify); ++ break; ++ case 105: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x25, 0x3, 0x10, ++ 0x50 | psTdmaByte4Modify); ++ break; ++ case 106: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x10, 0x3, 0x10, ++ 0x50 | psTdmaByte4Modify); ++ break; ++ case 107: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x20, 0x3, 0x10, ++ 0x50 | psTdmaByte4Modify); ++ break; ++ case 108: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x30, 0x3, 0x10, ++ 0x50 | psTdmaByte4Modify); ++ break; ++ case 109: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x55, ++ 0x10, 0x03, 0x10, ++ 0x54 | psTdmaByte4Modify); ++ break; ++ case 110: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x55, ++ 0x30, 0x03, 0x10, ++ 0x50 | psTdmaByte4Modify); ++ break; ++ case 111: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x65, ++ 0x25, 0x03, 0x11, ++ 0x11 | psTdmaByte4Modify); ++ break; ++ case 151: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x10, 0x03, 0x10, ++ 0x50 | psTdmaByte4Modify); ++ break; ++ } ++ } else { ++ /* disable PS tdma */ ++ switch (type) { ++ case 0: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x40, 0x0); ++ break; ++ case 1: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x48, 0x0); ++ break; ++ default: ++ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x40, 0x0); ++ break; ++ } ++ } ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean force_exec, ++ IN u8 phase) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u32 u32tmp = 0; ++ boolean pg_ext_switch = false, is_hw_ant_div_on = false; ++ u8 h2c_parameter[2] = {0}; ++ u32 cnt_bt_cal_chk = 0; ++ u8 u8tmp0 = 0, u8tmp1 = 0; ++ boolean is_in_mp_mode = false; ++ u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0; ++ u16 u16tmp0 = 0, u16tmp1 = 0; ++ ++ ++ u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x38); ++ ++ /* To avoid indirect access fail */ ++ if (((u32tmp1 & 0xf000) >> 12) != ((u32tmp1 & 0x0f00) >> 8)) { ++ force_exec = true; ++ coex_sta->gnt_error_cnt++; ++ } ++ ++ ++#if BT_8723D_2ANT_COEX_DBG ++ u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa); ++ u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); ++ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before Set Ant Pat)\n", ++ u8tmp0, u16tmp1, u8tmp1); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa = 0x%x (Before Set Ant Path)\n", ++ u32tmp1, u32tmp2, u16tmp0); ++ BTC_TRACE(trace_buf); ++#endif ++ ++ coex_dm->cur_ant_pos_type = ant_pos_type; ++ ++ if (!force_exec) { ++ if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** Skip Antenna Path Setup because no change!!**********\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ } ++ ++ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; ++ ++ switch (phase) { ++ case BT_8723D_2ANT_PHASE_COEX_POWERON: ++ /* Set Path control to WL */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, ++ 0x80, 0x0); ++ ++ /* set Path control owner to WL at initial step */ ++ halbtc8723d2ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8723D_2ANT_PCO_BTSIDE); ++ ++ /* set GNT_BT to SW high */ ++ halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to SW low */ ++ halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_WIFI; ++ ++ coex_sta->run_time_state = false; ++ ++ break; ++ case BT_8723D_2ANT_PHASE_COEX_INIT: ++ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ ++ halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8723d2ant_ltecoex_set_coex_table( ++ btcoexist, ++ BT_8723D_2ANT_CTT_WL_VS_LTE, ++ 0xffff); ++ ++ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8723d2ant_ltecoex_set_coex_table( ++ btcoexist, ++ BT_8723D_2ANT_CTT_BT_VS_LTE, ++ 0xffff); ++ ++ /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ ++ while (cnt_bt_cal_chk <= 20) { ++ u8tmp0 = btcoexist->btc_read_1byte( ++ btcoexist, ++ 0x49d); ++ cnt_bt_cal_chk++; ++ if (u8tmp0 & BIT(0)) { ++ BTC_SPRINTF( ++ trace_buf, ++ BT_TMP_BUF_SIZE, ++ "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE( ++ trace_buf); ++ delay_ms(50); ++ } else { ++ BTC_SPRINTF( ++ trace_buf, ++ BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE( ++ trace_buf); ++ break; ++ } ++ } ++ ++ ++ /* Set Path control to WL */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, ++ 0x67, 0x80, 0x1); ++ ++ /* set Path control owner to WL at initial step */ ++ halbtc8723d2ant_ltecoex_pathcontrol_owner( ++ btcoexist, ++ BT_8723D_2ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW high */ ++ halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to SW high */ ++ halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); ++ ++ coex_sta->run_time_state = false; ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) { ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ ant_pos_type = ++ BTC_ANT_WIFI_AT_MAIN; ++ else ++ ant_pos_type = ++ BTC_ANT_WIFI_AT_AUX; ++ } ++ ++ break; ++ case BT_8723D_2ANT_PHASE_WLANONLY_INIT: ++ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ ++ halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8723d2ant_ltecoex_set_coex_table( ++ btcoexist, ++ BT_8723D_2ANT_CTT_WL_VS_LTE, ++ 0xffff); ++ ++ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8723d2ant_ltecoex_set_coex_table( ++ btcoexist, ++ BT_8723D_2ANT_CTT_BT_VS_LTE, ++ 0xffff); ++ ++ /* Set Path control to WL */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, ++ 0x67, 0x80, 0x1); ++ ++ /* set Path control owner to WL at initial step */ ++ halbtc8723d2ant_ltecoex_pathcontrol_owner( ++ btcoexist, ++ BT_8723D_2ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW Low */ ++ halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_2ANT_SIG_STA_SET_TO_LOW); ++ /* Set GNT_WL to SW high */ ++ halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); ++ ++ coex_sta->run_time_state = false; ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) { ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ ant_pos_type = ++ BTC_ANT_WIFI_AT_MAIN; ++ else ++ ant_pos_type = ++ BTC_ANT_WIFI_AT_AUX; ++ } ++ ++ break; ++ case BT_8723D_2ANT_PHASE_WLAN_OFF: ++ /* Disable LTE Coex Function in WiFi side */ ++ halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* Set Path control to BT */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, ++ 0x67, 0x80, 0x0); ++ ++ /* set Path control owner to BT */ ++ halbtc8723d2ant_ltecoex_pathcontrol_owner( ++ btcoexist, ++ BT_8723D_2ANT_PCO_BTSIDE); ++ ++ coex_sta->run_time_state = false; ++ break; ++ case BT_8723D_2ANT_PHASE_2G_RUNTIME: ++ ++ /* wait for WL/BT IQK finish, keep 0x38 = 0xff00 for WL IQK */ ++ while (cnt_bt_cal_chk <= 20) { ++ u8tmp0 = btcoexist->btc_read_1byte( ++ btcoexist, ++ 0x1e6); ++ ++ u8tmp1 = btcoexist->btc_read_1byte( ++ btcoexist, ++ 0x49d); ++ ++ cnt_bt_cal_chk++; ++ if ((u8tmp0 & BIT(0)) || ++ (u8tmp1 & BIT(0))) { ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "[BTCoex], ########### WL or BT is IQK (wait cnt=%d)\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ delay_ms(50); ++ } else { ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** WL and BT is NOT IQK (wait cnt=%d)\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ break; ++ } ++ } ++ ++ /* Set Path control to WL */ ++ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x1);*/ ++ ++ /* set Path control owner to WL at runtime step */ ++ halbtc8723d2ant_ltecoex_pathcontrol_owner( ++ btcoexist, ++ BT_8723D_2ANT_PCO_WLSIDE); ++ ++ ++ halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA, ++ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); ++ ++ /* Set GNT_WL to PTA */ ++ halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA, ++ BT_8723D_2ANT_SIG_STA_SET_BY_HW); ++ ++ coex_sta->run_time_state = true; ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) { ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ ant_pos_type = ++ BTC_ANT_WIFI_AT_MAIN; ++ else ++ ant_pos_type = ++ BTC_ANT_WIFI_AT_AUX; ++ } ++ ++ break; ++ case BT_8723D_2ANT_PHASE_BTMPMODE: ++ /* Disable LTE Coex Function in WiFi side */ ++ halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* Set Path control to WL */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, ++ 0x67, 0x80, 0x1); ++ ++ /* set Path control owner to WL */ ++ halbtc8723d2ant_ltecoex_pathcontrol_owner( ++ btcoexist, ++ BT_8723D_2ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW Hi */ ++ halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); ++ ++ /* Set GNT_WL to SW Lo */ ++ halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_2ANT_SIG_STA_SET_TO_LOW); ++ ++ coex_sta->run_time_state = false; ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) { ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ ant_pos_type = ++ BTC_ANT_WIFI_AT_MAIN; ++ else ++ ant_pos_type = ++ BTC_ANT_WIFI_AT_AUX; ++ } ++ ++ break; ++ case BT_8723D_2ANT_PHASE_ANTENNA_DET: ++ ++ /* Set Path control to WL */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, ++ 0x80, 0x1); ++ ++ /* set Path control owner to WL */ ++ halbtc8723d2ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8723D_2ANT_PCO_WLSIDE); ++ ++ /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ ++ /* set GNT_BT to SW high */ ++ halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); ++ ++ /* Set GNT_WL to SW high */ ++ halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_WIFI_AT_AUX; ++ ++ coex_sta->run_time_state = false; ++ ++ break; ++ } ++ ++ is_hw_ant_div_on = board_info->ant_div_cfg; ++ ++ if ((is_hw_ant_div_on) && (phase != BT_8723D_2ANT_PHASE_ANTENNA_DET)) ++ btcoexist->btc_write_2byte(btcoexist, 0x948, 0x140); ++ else if ((is_hw_ant_div_on == false) && ++ (phase != BT_8723D_2ANT_PHASE_WLAN_OFF)) { ++ ++ switch (ant_pos_type) { ++ case BTC_ANT_WIFI_AT_MAIN: ++ ++ btcoexist->btc_write_2byte(btcoexist, ++ 0x948, 0x0); ++ break; ++ case BTC_ANT_WIFI_AT_AUX: ++ ++ btcoexist->btc_write_2byte(btcoexist, ++ 0x948, 0x280); ++ break; ++ } ++ } ++ ++ ++#if BT_8723D_2ANT_COEX_DBG ++ u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa); ++ u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); ++ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(After Set Ant Pat)\n", ++ u8tmp0, u16tmp1, u8tmp1); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa= 0x%x (After Set Ant Path)\n", ++ u32tmp1, u32tmp2, u16tmp0); ++ BTC_TRACE(trace_buf); ++#endif ++ ++} ++ ++u8 halbtc8723d2ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8723D_2ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (!bt_link_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No BT link exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (bt_link_info->sco_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->hid_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->pan_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 0) { ++ ++ if (bt_link_info->acl_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No-Profile busy\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_2ANT_COEX_ALGO_NOPROFILEBUSY; ++ } ++ } else if (num_of_diff_profile == 1) { ++ if (bt_link_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_2ANT_COEX_ALGO_SCO; ++ } else { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_2ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_2ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_2ANT_COEX_ALGO_SCO; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP ==> A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_2ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_2ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_HID_A2DP; ++ } ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_2ANT_COEX_ALGO_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP ==> HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8723D_2ANT_COEX_ALGO_HID_A2DP; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_PANEDR_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++ ++ ++void halbtc8723d2ant_action_coex_all_off(IN struct btc_coexist *btcoexist) ++{ ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ /* fw all off */ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8723d2ant_action_bt_whql_test(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++} ++ ++void halbtc8723d2ant_action_bt_hs(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false, wifi_turbo = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", ++ coex_sta->scan_ap_num, coex_sta->wl_noisy_level); ++ BTC_TRACE(trace_buf); ++ ++#if 1 ++ if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) ++ wifi_turbo = true; ++#endif ++ ++ ++ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ ++ } else { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } ++ ++} ++ ++ ++void halbtc8723d2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ ++ boolean wifi_connected = false; ++ boolean wifi_scan = false, wifi_link = false, wifi_roam = false; ++ boolean wifi_busy = false; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); ++ ++ if ((coex_sta->bt_create_connection) && ((wifi_link) || (wifi_roam) ++ || (wifi_scan) || (wifi_busy) || (coex_sta->wifi_is_high_pri_task))) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi link/roam/Scan/busy/hi-pri-task + BT Inq/Page!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 8); ++ ++ if ((bt_link_info->a2dp_exist) && (!bt_link_info->pan_exist)) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 15); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 11); ++ } else if ((!wifi_connected) && (!wifi_scan)) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi no-link + no-scan + BT Inq/Page!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (bt_link_info->pan_exist) { ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ ++ } else if (bt_link_info->a2dp_exist) { ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 16); ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ } else { ++ ++ if ((wifi_link) || (wifi_roam) || (wifi_scan) || (wifi_busy) ++ || (coex_sta->wifi_is_high_pri_task)) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ } ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++} ++ ++ ++void halbtc8723d2ant_action_bt_relink(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ coex_sta->bt_relink_downcount = 2; ++} ++ ++void halbtc8723d2ant_action_bt_idle(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (!wifi_busy) { ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 8); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); ++ } else { /* if wl busy */ ++ ++ if (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else { ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 8); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 12); ++ } ++ } ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++} ++ ++ ++ ++/* SCO only or SCO+PAN(HS) */ ++void halbtc8723d2ant_action_sco(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ u32 wifi_bw = 1; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, ++ &wifi_bw); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ if (coex_sta->is_eSCO_mode) ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ else /* 2-Ant free run if eSCO mode */ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); ++ } ++ ++} ++ ++ ++void halbtc8723d2ant_action_hid(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ u32 wifi_bw = 1; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ /*for 4/18 hid */ ++ if (coex_sta->hid_busy_num >= 2) { ++ if (wifi_bw == 0) { /* if 11bg mode */ ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 8); ++ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x1, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 111); ++ } else { ++ ++ if (wifi_busy) { ++ halbtc8723d2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 8); ++ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x2, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 111); ++ } else { ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 3); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); ++ } ++ } ++ } else { ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 3); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); ++ } ++ } ++ ++} ++ ++ ++/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ ++void halbtc8723d2ant_action_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false, wifi_turbo = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", ++ coex_sta->scan_ap_num, coex_sta->wl_noisy_level); ++ BTC_TRACE(trace_buf); ++ ++#if 1 ++ if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) ++ wifi_turbo = true; ++#endif ++ ++ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 1); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 16); ++ } else { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ if ((coex_sta->bt_relink_downcount != 0) ++ && (wifi_busy)) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ ++ } else { ++ ++ if (wifi_turbo) ++ halbtc8723d2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 6); ++ else ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 7); ++ ++ if (wifi_busy) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 101); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 16); ++ /*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 102);*/ ++ } ++ ++ } ++ ++} ++ ++ ++void halbtc8723d2ant_action_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false, wifi_turbo = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", ++ coex_sta->scan_ap_num, coex_sta->wl_noisy_level); ++ BTC_TRACE(trace_buf); ++ ++#if 1 ++ if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) ++ wifi_turbo = true; ++#endif ++ ++ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++#if 0 ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++#endif ++ ++ ++#if 1 ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 3); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 4); ++ } else { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ if (wifi_turbo) ++ halbtc8723d2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 6); ++ else ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 7); ++ ++ if (wifi_busy) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 103); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 104); ++ ++ } ++ ++#endif ++ ++} ++ ++void halbtc8723d2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ u32 wifi_bw = 1; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, ++ &wifi_bw); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 1); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 16); ++ } else { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ if ((coex_sta->bt_relink_downcount != 0) ++ && (wifi_busy)) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } else if (wifi_busy) { ++ if (coex_sta->hid_busy_num >= 2) { ++ halbtc8723d2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 8); ++ if (wifi_bw == 0) /*11bg mode */ ++ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x1, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ else ++ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x2, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 109); ++ } else { ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 101); ++ } ++ } else { ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 1); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 16); ++ } ++ ++ } ++ ++} ++ ++ ++void halbtc8723d2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false, wifi_turbo = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", ++ coex_sta->scan_ap_num, coex_sta->wl_noisy_level); ++ BTC_TRACE(trace_buf); ++ ++#if 1 ++ if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) ++ wifi_turbo = true; ++#endif ++ ++ ++ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) { ++ ++ if ((coex_sta->a2dp_bit_pool > 40) && ++ (coex_sta->a2dp_bit_pool < 255)) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 7); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 5); ++ } else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 6); ++ ++ } else { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ if (wifi_turbo) ++ halbtc8723d2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 6); ++ else ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 7); ++ ++ if (wifi_busy) { ++ ++ if ((coex_sta->a2dp_bit_pool > 40) && ++ (coex_sta->a2dp_bit_pool < 255)) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 107); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 105); ++ } else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 106); ++ ++ } ++ ++} ++ ++ ++/* PAN(EDR)+A2DP */ ++void halbtc8723d2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false, wifi_turbo = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", ++ coex_sta->scan_ap_num, coex_sta->wl_noisy_level); ++ BTC_TRACE(trace_buf); ++ ++#if 1 ++ if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) ++ wifi_turbo = true; ++#endif ++ ++ ++ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) { ++ ++ if (((coex_sta->a2dp_bit_pool > 40) && ++ (coex_sta->a2dp_bit_pool < 255)) || ++ (!coex_sta->is_A2DP_3M)) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 7); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 5); ++ } else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 6); ++ } else { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ if (wifi_turbo) ++ halbtc8723d2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 6); ++ else ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 7); ++ ++ if (wifi_busy) { ++ ++ if ((coex_sta->a2dp_bit_pool > 40) && ++ (coex_sta->a2dp_bit_pool < 255)) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 107); ++ else if (wifi_turbo) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 108); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 105); ++ } else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 106); ++ ++ } ++ ++} ++ ++ ++void halbtc8723d2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ u32 wifi_bw = 1; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, ++ &wifi_bw); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 3); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 4); ++ } else { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ if (coex_sta->hid_busy_num >= 2) { ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 8); ++ if (wifi_bw == 0) /*11bg mode */ ++ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x1, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ else ++ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x2, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 110); ++ } else { ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ ++ if (wifi_busy) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 103); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 104); ++ } ++ ++ } ++ ++} ++ ++ ++/* HID+A2DP+PAN(EDR) */ ++void halbtc8723d2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ u32 wifi_bw = 1; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, ++ &wifi_bw); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) { ++ ++ if (((coex_sta->a2dp_bit_pool > 40) && ++ (coex_sta->a2dp_bit_pool < 255)) || ++ (!coex_sta->is_A2DP_3M)) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 7); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 5); ++ } else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 6); ++ } else { ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ if (coex_sta->hid_busy_num >= 2) { ++ halbtc8723d2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 8); ++ if (wifi_bw == 0) /*11bg mode */ ++ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x1, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ else ++ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, ++ NORMAL_EXEC, ++ 0x2, 0xaa, ++ 0x5a, 0xaa, ++ 0xaa); ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 110); ++ } else { ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ ++ if (wifi_busy) { ++ ++ if ((coex_sta->a2dp_bit_pool > 40) && ++ (coex_sta->a2dp_bit_pool < 255)) ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 107); ++ else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 105); ++ } else ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 106); ++ } ++ } ++ ++} ++ ++ ++void halbtc8723d2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* hw all off */ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++} ++ ++void halbtc8723d2ant_action_wifi_linkscan_process(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ ++ if (bt_link_info->pan_exist) { ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ ++ } else if (bt_link_info->a2dp_exist) { ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 16); ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ } else { ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ } ++ ++} ++ ++void halbtc8723d2ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ /* fw all off */ ++ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8723d2ant_action_wifi_connected(IN struct btc_coexist *btcoexist) ++{ ++ switch (coex_dm->cur_algorithm) { ++ ++ case BT_8723D_2ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_sco(btcoexist); ++ break; ++ case BT_8723D_2ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_hid(btcoexist); ++ break; ++ case BT_8723D_2ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_a2dp(btcoexist); ++ break; ++ case BT_8723D_2ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_a2dp_pan_hs(btcoexist); ++ break; ++ case BT_8723D_2ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_pan_edr(btcoexist); ++ break; ++ case BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_pan_edr_a2dp(btcoexist); ++ break; ++ case BT_8723D_2ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_pan_edr_hid(btcoexist); ++ break; ++ case BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_hid_a2dp_pan_edr( ++ btcoexist); ++ break; ++ case BT_8723D_2ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_hid_a2dp(btcoexist); ++ break; ++ case BT_8723D_2ANT_COEX_ALGO_NOPROFILEBUSY: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = No-Profile busy.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_bt_idle(btcoexist); ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_coex_all_off(btcoexist); ++ break; ++ } ++ ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ ++} ++ ++ ++void halbtc8723d2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ u8 algorithm = 0; ++ u32 num_of_wifi_link = 0; ++ u32 wifi_link_status = 0; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean miracast_plus_bt = false; ++ boolean scan = false, link = false, roam = false, ++ under_4way = false, ++ wifi_connected = false, wifi_under_5g = false, ++ bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (!coex_sta->run_time_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], return for run_time_state = false !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->freeze_coexrun_by_btinfo) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), return for freeze_coexrun_by_btinfo\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->bt_whck_test) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under WHCK TEST!!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_bt_whql_test(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled!!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_coex_all_off(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under inquiry/page scan !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_bt_inquiry(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->is_setupLink) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is re-link !!!\n"); ++ halbtc8723d2ant_action_bt_relink(btcoexist); ++ return; ++ } ++ ++ /* for P2P */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if ((num_of_wifi_link >= 2) || ++ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", ++ num_of_wifi_link, wifi_link_status); ++ BTC_TRACE(trace_buf); ++ ++ if (bt_link_info->bt_link_exist) ++ miracast_plus_bt = true; ++ else ++ miracast_plus_bt = false; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ ++ if (scan || link || roam || under_4way) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], scan = %d, link = %d, roam = %d 4way = %d!!!\n", ++ scan, link, roam, under_4way); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under linkscan process + Multi-Port !!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_action_wifi_linkscan_process(btcoexist); ++ } else ++ ++ halbtc8723d2ant_action_wifi_multi_port(btcoexist); ++ ++ return; ++ } else { ++ miracast_plus_bt = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is hs\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_bt_hs(btcoexist); ++ return; ++ } ++ ++ if ((BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) || ++ (BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, bt idle!!.\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_action_bt_idle(btcoexist); ++ return; ++ } ++ ++ algorithm = halbtc8723d2ant_action_algorithm(btcoexist); ++ coex_dm->cur_algorithm = algorithm; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", ++ coex_dm->cur_algorithm); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ if (scan || link || roam || under_4way) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under Link Process !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_wifi_linkscan_process(btcoexist); ++ } else if (wifi_connected) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, wifi connected!!.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_wifi_connected(btcoexist); ++ ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, wifi not-connected!!.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_action_wifi_not_connected(btcoexist); ++ } ++} ++ ++ ++void halbtc8723d2ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); ++ ++ coex_sta->pop_event_cnt = 0; ++ coex_sta->cnt_RemoteNameReq = 0; ++ coex_sta->cnt_ReInit = 0; ++ coex_sta->cnt_setupLink = 0; ++ coex_sta->cnt_IgnWlanAct = 0; ++ coex_sta->cnt_Page = 0; ++ ++ halbtc8723d2ant_query_bt_info(btcoexist); ++} ++ ++ ++void halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ u8 u8tmp0 = 0, u8tmp1 = 0; ++ u32 vendor; ++ u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0; ++ u16 u16tmp1 = 0; ++ u8 i = 0; ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 2Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++#if BT_8723D_2ANT_COEX_DBG ++ u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x38); ++ u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x54); ++ u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); ++ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before init_hw_config)\n", ++ u8tmp0, u16tmp1, u8tmp1); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x (Before init_hw_config)\n", ++ u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++#endif ++ ++ ++ coex_sta->bt_coex_supported_feature = 0; ++ coex_sta->bt_coex_supported_version = 0; ++ coex_sta->bt_ble_scan_type = 0; ++ coex_sta->bt_ble_scan_para[0] = 0; ++ coex_sta->bt_ble_scan_para[1] = 0; ++ coex_sta->bt_ble_scan_para[2] = 0; ++ coex_sta->bt_reg_vendor_ac = 0xffff; ++ coex_sta->bt_reg_vendor_ae = 0xffff; ++ coex_sta->gnt_error_cnt = 0; ++ coex_sta->bt_relink_downcount = 0; ++ ++ for (i = 0; i <= 9; i++) ++ coex_sta->bt_afh_map[i] = 0; ++ ++#if 0 ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_VENDOR, &vendor); ++ if (vendor == BTC_VENDOR_LENOVO) ++ coex_dm->switch_thres_offset = 0; ++ else ++ coex_dm->switch_thres_offset = 20; ++#endif ++ /* 0xf0[15:12] --> Chip Cut information */ ++ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, ++ 0xf1) & 0xf0) >> 4; ++ ++ coex_sta->dis_ver_info_cnt = 0; ++ ++ /* default isolation = 15dB */ ++ coex_sta->isolation_btween_wb = BT_8723D_2ANT_DEFAULT_ISOLATION; ++ halbtc8723d2ant_coex_switch_threshold(btcoexist, ++ coex_sta->isolation_btween_wb); ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, ++ 0x1); /* enable TBTT nterrupt */ ++ ++ /* BT report packet sample rate */ ++ btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); ++ ++ /* Init 0x778 = 0x1 for 2-Ant */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); ++ ++ /* Enable PTA (3-wire function form BT side) */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); ++ ++ /* Enable PTA (tx/rx signal form WiFi side) */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); ++ ++ halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, true); ++ ++#if 0 ++ /* check if WL firmware download ok */ ++ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ONOFF, true); ++#endif ++ ++ /* Enable counter statistics */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, ++ 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ ++ ++ /* WLAN_Tx by GNT_WL 0x950[29] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x20, 0x0); ++ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ ++ psd_scan->ant_det_is_ant_det_available = true; ++ ++ if (wifi_only) { ++ coex_sta->concurrent_rx_mode_on = false; ++ /* Path config */ ++ /* Set Antenna Path */ ++ halbtc8723d2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_WLANONLY_INIT); ++ ++ btcoexist->stop_coex_dm = true; ++ } else { ++ /*Set BT polluted packet on for Tx rate adaptive not including Tx retry break by PTA, 0x45c[19] =1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); ++ ++ coex_sta->concurrent_rx_mode_on = true; ++ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); */ ++ ++ /* RF 0x1[0] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x1, 0x0); ++ ++ /* Path config */ ++ halbtc8723d2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_COEX_INIT); ++ ++ btcoexist->stop_coex_dm = false; ++ } ++ ++ ++} ++ ++u32 halbtc8723d2ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) ++{ ++ u8 j; ++ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; ++ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, ++ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, ++ 32, 23, 15, 7, 0 ++ }; ++ ++ if (val == 0) ++ return 0; ++ ++ tmp = val; ++ ++ while (1) { ++ if (tmp == 1) ++ break; ++ else { ++ tmp = (tmp >> 1); ++ shiftcount++; ++ } ++ } ++ ++ ++ val_integerd_b = shiftcount + 1; ++ ++ tmp2 = 1; ++ for (j = 1; j <= val_integerd_b; j++) ++ tmp2 = tmp2 * 2; ++ ++ tmp = (val * 100) / tmp2; ++ tindex = tmp / 5; ++ ++ if (tindex > 20) ++ tindex = 20; ++ ++ val_fractiond_b = table_fraction[tindex]; ++ ++ result = val_integerd_b * 100 - val_fractiond_b; ++ ++ return result; ++ ++ ++} ++ ++void halbtc8723d2ant_psd_show_antenna_detect_result(IN struct btc_coexist ++ *btcoexist) ++{ ++ u8 *cli_buf = btcoexist->cli_buf; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n============[Antenna Detection info] ============\n"); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->ant_det_result == 12) { /* Get Ant Det from BT */ ++ ++ if (board_info->btdm_ant_num_by_ant_det == 1) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "1-Antenna", ++ BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT, ++ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION); ++ else { ++ ++ if (psd_scan->ant_det_psd_scan_peak_val > ++ (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) ++ * 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %s (>%d)", ++ "Ant Det Result", "2-Antenna (Bad-Isolation)", ++ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "2-Antenna (Good-Isolation)", ++ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset, ++ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ } ++ ++ } else if (psd_scan->ant_det_result == 1) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", ++ "Ant Det Result", "2-Antenna (Bad-Isolation)", ++ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ else if (psd_scan->ant_det_result == 2) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "2-Antenna (Good-Isolation)", ++ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset, ++ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "1-Antenna", ++ BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT, ++ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset); ++ ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", ++ "Antenna Detection Finish", ++ (board_info->btdm_ant_det_finish ++ ? "Yes" : "No")); ++ CL_PRINTF(cli_buf); ++ ++ switch (psd_scan->ant_det_result) { ++ case 0: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is not available)"); ++ break; ++ case 1: /* 2-Ant bad-isolation */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 2: /* 2-Ant good-isolation */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 3: /* 1-Ant */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 4: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Uncertainty result)"); ++ break; ++ case 5: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); ++ break; ++ case 6: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(WiFi is Scanning)"); ++ break; ++ case 7: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is not idle)"); ++ break; ++ case 8: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Abort by WiFi Scanning)"); ++ break; ++ case 9: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Antenna Init is not ready)"); ++ break; ++ case 10: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is Inquiry or page)"); ++ break; ++ case 11: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is Disabled)"); ++ case 12: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available, result from BT"); ++ break; ++ } ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->ant_det_result == 12) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", ++ "PSD Scan Peak Value", ++ psd_scan->ant_det_psd_scan_peak_val / 100); ++ CL_PRINTF(cli_buf); ++ return; ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "Ant Detect Total Count", psd_scan->ant_det_try_count); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "Ant Detect Fail Count", psd_scan->ant_det_fail_count); ++ CL_PRINTF(cli_buf); ++ ++ if ((!board_info->btdm_ant_det_finish) && ++ (psd_scan->ant_det_result != 5)) ++ return; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", ++ (psd_scan->ant_det_result ? "ok" : "fail")); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", ++ psd_scan->ant_det_bt_tx_time); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", ++ psd_scan->ant_det_bt_le_channel); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", ++ "WiFi PSD Cent-Ch/Offset/Span", ++ psd_scan->real_cent_freq, psd_scan->real_offset, ++ psd_scan->real_span); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", ++ "PSD Pre-Scan Peak Value", ++ psd_scan->ant_det_pre_psdscan_peak_val / 100); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", ++ "PSD Pre-Scan result", ++ (psd_scan->ant_det_result != 5 ? "ok" : "fail"), ++ BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->ant_det_result == 5) ++ return; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", ++ "PSD Scan Peak Value", psd_scan->ant_det_peak_val); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", ++ "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", ++ (board_info->tfbga_package) ? "Yes" : "No"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "PSD Threshold Offset", psd_scan->ant_det_thres_offset); ++ CL_PRINTF(cli_buf); ++ ++} ++ ++void halbtc8723d2ant_psd_showdata(IN struct btc_coexist *btcoexist) ++{ ++ u8 *cli_buf = btcoexist->cli_buf; ++ u32 delta_freq_per_point; ++ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; ++ ++ if (psd_scan->ant_det_result == 12) ++ return; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n\n============[PSD info] (%d)============\n", ++ psd_scan->psd_gen_count); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->psd_gen_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); ++ CL_PRINTF(cli_buf); ++ return; ++ } ++ ++ if (psd_scan->psd_point == 0) ++ delta_freq_per_point = 0; ++ else ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* if (psd_scan->is_psd_show_max_only) */ ++ if (0) { ++ psd_rep1 = psd_scan->psd_max_value / 100; ++ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; ++ ++ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + ++ psd_scan->psd_max_value_point * delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.0%d MHz", ++ freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.%d MHz", ++ freq1, freq2); ++ ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.0%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ ++ CL_PRINTF(cli_buf); ++ } else { ++ m = psd_scan->psd_start_point; ++ n = psd_scan->psd_start_point; ++ i = 1; ++ j = 1; ++ ++ while (1) { ++ do { ++ freq = ((psd_scan->real_cent_freq - 20) * ++ 1000000 + m * ++ delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (i == 1) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.000", ++ freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.0%2d", ++ freq1, ++ freq2); ++ else ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.%3d", ++ freq1, ++ freq2); ++ } else if ((i % 8 == 0) || ++ (m == psd_scan->psd_stop_point)) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%6d.000\n", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%6d.0%2d\n", freq1, ++ freq2); ++ else ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%6d.%3d\n", freq1, ++ freq2); ++ } else { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%6d.000", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%6d.0%2d", freq1, ++ freq2); ++ else ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%6d.%3d", freq1, ++ freq2); ++ } ++ ++ i++; ++ m++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); ++ ++ ++ do { ++ psd_rep1 = psd_scan->psd_report_max_hold[n] / ++ 100; ++ psd_rep2 = psd_scan->psd_report_max_hold[n] - ++ psd_rep1 * ++ 100; ++ ++ if (j == 1) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.0%d", ++ psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.%d", ++ psd_rep1, ++ psd_rep2); ++ } else if ((j % 8 == 0) || ++ (n == psd_scan->psd_stop_point)) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%7d.0%d\n", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%7d.%d\n", psd_rep1, ++ psd_rep2); ++ } else { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%7d.0%d", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, ++ BT_TMP_BUF_SIZE, ++ "%7d.%d", psd_rep1, ++ psd_rep2); ++ } ++ ++ j++; ++ n++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); ++ ++ if ((m > psd_scan->psd_stop_point) || ++ (n > psd_scan->psd_stop_point)) ++ break; ++ else { ++ i = 1; ++ j = 1; ++ } ++ ++ } ++ } ++ ++ ++} ++ ++#ifdef PLATFORM_WINDOWS ++#pragma optimize("", off) ++#endif ++void halbtc8723d2ant_psd_maxholddata(IN struct btc_coexist *btcoexist, ++ IN u32 gen_count) ++{ ++ u32 i = 0; ++ u32 loop_i_max = 0, loop_val_max = 0; ++ ++ if (gen_count == 1) { ++ memcpy(psd_scan->psd_report_max_hold, ++ psd_scan->psd_report, ++ BT_8723D_2ANT_ANTDET_PSD_POINTS * sizeof(u32)); ++ } ++ ++ for (i = psd_scan->psd_start_point; ++ i <= psd_scan->psd_stop_point; i++) { ++ ++ /* update max-hold value at each freq point */ ++ if (psd_scan->psd_report[i] > psd_scan->psd_report_max_hold[i]) ++ psd_scan->psd_report_max_hold[i] = ++ psd_scan->psd_report[i]; ++ ++ /* search the max value in this seep */ ++ if (psd_scan->psd_report[i] > loop_val_max) { ++ loop_val_max = psd_scan->psd_report[i]; ++ loop_i_max = i; ++ } ++ } ++ ++ if (gen_count <= BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT) ++ psd_scan->psd_loop_max_value[gen_count - 1] = loop_val_max; ++ ++} ++ ++ ++#ifdef PLATFORM_WINDOWS ++#pragma optimize("", off) ++#endif ++u32 halbtc8723d2ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) ++{ ++ /* reg 0x808[9:0]: FFT data x */ ++ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ ++ /* reg 0x8b4[15:0]: FFT data y report */ ++ ++ u32 val = 0, psd_report = 0; ++ int k = 0; ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ ++ val &= 0xffbffc00; ++ val |= point; ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ val |= 0x00400000; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ while (1) { ++ if (k++ > BT_8723D_2ANT_ANTDET_SWEEPPOINT_DELAY) ++ break; ++ } ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); ++ ++ psd_report = val & 0x0000ffff; ++ ++ return psd_report; ++} ++ ++#ifdef PLATFORM_WINDOWS ++#pragma optimize("", off) ++#endif ++boolean halbtc8723d2ant_psd_sweep_point(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, ++ IN u32 avgnum, IN u32 loopcnt) ++{ ++ u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0; ++ u32 points1 = 0, psd_report = 0; ++ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; ++ u32 psd_center_freq = 20 * 10 ^ 6; ++ boolean outloop = false, scan , roam, is_sweep_ok = true; ++ u8 flag = 0; ++ u32 tmp = 0, u32tmp1 = 0; ++ u32 wifi_original_channel = 1; ++ u32 psd_sum = 0, avg_cnt = 0; ++ u32 i_max = 0, val_max = 0, val_max2 = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ do { ++ switch (flag) { ++ case 0: /* Get PSD parameters */ ++ default: ++ ++ psd_scan->psd_band_width = 40 * 1000000; ++ psd_scan->psd_point = points; ++ psd_scan->psd_start_base = points / 2; ++ psd_scan->psd_avg_num = avgnum; ++ psd_scan->real_cent_freq = cent_freq; ++ psd_scan->real_offset = offset; ++ psd_scan->real_span = span; ++ ++ ++ points1 = psd_scan->psd_point; ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* PSD point setup */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffff0fff; ++ ++ switch (psd_scan->psd_point) { ++ case 128: ++ val |= 0x0; ++ break; ++ case 256: ++ default: ++ val |= 0x00004000; ++ break; ++ case 512: ++ val |= 0x00008000; ++ break; ++ case 1024: ++ val |= 0x0000c000; ++ break; ++ } ++ ++ switch (psd_scan->psd_avg_num) { ++ case 1: ++ val |= 0x0; ++ break; ++ case 8: ++ val |= 0x00001000; ++ break; ++ case 16: ++ val |= 0x00002000; ++ break; ++ case 32: ++ default: ++ val |= 0x00003000; ++ break; ++ } ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ flag = 1; ++ break; ++ case 1: /* calculate the PSD point index from freq/offset/span */ ++ psd_center_freq = psd_scan->psd_band_width / 2 + ++ offset * (1000000); ++ ++ start_p = psd_scan->psd_start_base + (psd_center_freq - ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_start_point = start_p - ++ psd_scan->psd_start_base; ++ ++ stop_p = psd_scan->psd_start_base + (psd_center_freq + ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_stop_point = stop_p - ++ psd_scan->psd_start_base - 1; ++ ++ flag = 2; ++ break; ++ case 2: /* set RF channel/BW/Mode */ ++ ++ /* set 3-wire off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val |= 0x00300000; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val &= 0xfeffffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* Tx-pause on */ ++ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f); ++ ++ /* store WiFi original channel */ ++ wifi_original_channel = btcoexist->btc_get_rf_reg( ++ btcoexist, BTC_RF_A, 0x18, 0x3ff); ++ ++ /* Set RF channel */ ++ if (cent_freq == 2484) ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, 0xe); ++ else ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, (cent_freq - 2412) / 5 + ++ 1); /* WiFi TRx Mask on */ ++ ++ /* save original RCK value */ ++ u32tmp1 = btcoexist->btc_get_rf_reg( ++ btcoexist, BTC_RF_A, 0x1d, 0xfffff); ++ ++ /* Enter debug mode */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, ++ 0x2, 0x1); ++ ++ /* Set RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, ++ 0xfffff, 0x2e); ++ ++ ++ /* Set RF mode = Rx, RF Gain = 0x320a0 */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, ++ 0xfffff, 0x320a0); ++ ++ while (1) { ++ if (k++ > BT_8723D_2ANT_ANTDET_SWEEPPOINT_DELAY) ++ break; ++ } ++ flag = 3; ++ break; ++ case 3: ++ psd_scan->psd_gen_count = 0; ++ for (j = 1; j <= loopcnt; j++) { ++ ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || roam) { ++ is_sweep_ok = false; ++ break; ++ } ++ memset(psd_scan->psd_report, 0, ++ psd_scan->psd_point * sizeof(u32)); ++ start_p = psd_scan->psd_start_point + ++ psd_scan->psd_start_base; ++ stop_p = psd_scan->psd_stop_point + ++ psd_scan->psd_start_base + 1; ++ ++ i = start_p; ++ point_index = 0; ++ ++ while (i < stop_p) { ++ if (i >= points1) ++ psd_report = ++ halbtc8723d2ant_psd_getdata( ++ btcoexist, i - points1); ++ else ++ psd_report = ++ halbtc8723d2ant_psd_getdata( ++ btcoexist, i); ++ ++ if (psd_report == 0) ++ tmp = 0; ++ else ++ /* tmp = 20*log10((double)psd_report); */ ++ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ ++ tmp = 6 * halbtc8723d2ant_psd_log2base( ++ btcoexist, psd_report); ++ ++ n = i - psd_scan->psd_start_base; ++ psd_scan->psd_report[n] = tmp; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Point=%d, psd_dB_data = %d\n", ++ i, psd_scan->psd_report[n]); ++ BTC_TRACE(trace_buf); ++ ++ i++; ++ ++ } ++ ++ halbtc8723d2ant_psd_maxholddata(btcoexist, j); ++ ++ psd_scan->psd_gen_count = j; ++ ++ /*Accumulate Max PSD value in this loop if the value > threshold */ ++ if (psd_scan->psd_loop_max_value[j - 1] >= ++ 4000) { ++ psd_sum = psd_sum + ++ psd_scan->psd_loop_max_value[j - ++ 1]; ++ avg_cnt++; ++ } ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Loop=%d, Max_dB_data = %d\n", ++ j, psd_scan->psd_loop_max_value[j ++ - 1]); ++ BTC_TRACE(trace_buf); ++ ++ } ++ ++ if (loopcnt == BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT) { ++ ++ /* search the Max Value between each-freq-point-max-hold value of all sweep*/ ++ for (i = 1; ++ i <= BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT; ++ i++) { ++ ++ if (i == 1) { ++ i_max = i; ++ val_max = psd_scan->psd_loop_max_value[i ++ - 1]; ++ val_max2 = ++ psd_scan->psd_loop_max_value[i ++ - 1]; ++ } else if ( ++ psd_scan->psd_loop_max_value[i - ++ 1] > val_max) { ++ val_max2 = val_max; ++ i_max = i; ++ val_max = psd_scan->psd_loop_max_value[i ++ - 1]; ++ } else if ( ++ psd_scan->psd_loop_max_value[i - ++ 1] > val_max2) ++ val_max2 = ++ psd_scan->psd_loop_max_value[i ++ - 1]; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "i = %d, val_hold= %d, val_max = %d, val_max2 = %d\n", ++ i, psd_scan->psd_loop_max_value[i ++ - 1], ++ val_max, val_max2); ++ ++ BTC_TRACE(trace_buf); ++ } ++ ++ psd_scan->psd_max_value_point = i_max; ++ psd_scan->psd_max_value = val_max; ++ psd_scan->psd_max_value2 = val_max2; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "val_max = %d, val_max2 = %d\n", ++ psd_scan->psd_max_value, ++ psd_scan->psd_max_value2); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if (avg_cnt != 0) { ++ psd_scan->psd_avg_value = (psd_sum / avg_cnt); ++ if ((psd_sum % avg_cnt) >= (avg_cnt / 2)) ++ psd_scan->psd_avg_value++; ++ } else ++ psd_scan->psd_avg_value = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "AvgLoop=%d, Avg_dB_data = %d\n", ++ avg_cnt, psd_scan->psd_avg_value); ++ BTC_TRACE(trace_buf); ++ ++ flag = 100; ++ break; ++ case 99: /* error */ ++ ++ outloop = true; ++ break; ++ case 100: /* recovery */ ++ ++ /* set 3-wire on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val &= 0xffcfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val |= 0x01000000; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* Tx-pause off */ ++ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0); ++ ++ /* PSD off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffbfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ /* restore RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, ++ 0xfffff, u32tmp1); ++ ++ /* Exit debug mode */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, ++ 0x2, 0x0); ++ ++ /* restore WiFi original channel */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, ++ 0x3ff, wifi_original_channel); ++ ++ outloop = true; ++ break; ++ ++ } ++ ++ } while (!outloop); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); ++ BTC_TRACE(trace_buf); ++ return is_sweep_ok; ++ ++} ++ ++#ifdef PLATFORM_WINDOWS ++#pragma optimize("", off) ++#endif ++boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist ++ *btcoexist) ++{ ++ u32 i = 0; ++ u32 wlpsd_cent_freq = 2484, wlpsd_span = 2; ++ s32 wlpsd_offset = -4; ++ u32 bt_tx_time, bt_le_channel; ++ u8 bt_le_ch[13] = {3, 6, 8, 11, 13, 16, 18, 21, 23, 26, 28, 31, 33}; ++ ++ u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb; ++ ++ u8 state = 0; ++ boolean outloop = false, bt_resp = false, ant_det_finish = false; ++ u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, ++ u32tmp, u32tmp0, u32tmp1, u32tmp2 ; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); ++ memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); ++ ++ psd_scan->ant_det_bt_tx_time = ++ BT_8723D_2ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ ++ psd_scan->ant_det_bt_le_channel = BT_8723D_2ANT_ANTDET_BTTXCHANNEL; ++ ++ bt_tx_time = psd_scan->ant_det_bt_tx_time; ++ bt_le_channel = psd_scan->ant_det_bt_le_channel; ++ ++ if (board_info->tfbga_package) /* for TFBGA */ ++ psd_scan->ant_det_thres_offset = 5; ++ else ++ psd_scan->ant_det_thres_offset = 0; ++ ++ do { ++ switch (state) { ++ case 0: ++ if (bt_le_channel == 39) ++ wlpsd_cent_freq = 2484; ++ else { ++ for (i = 1; i <= 13; i++) { ++ if (bt_le_ch[i - 1] == ++ bt_le_channel) { ++ wlpsd_cent_freq = 2412 ++ + (i - 1) * 5; ++ break; ++ } ++ } ++ ++ if (i == 14) { ++ ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", ++ bt_le_channel); ++ BTC_TRACE(trace_buf); ++ outloop = true; ++ break; ++ } ++ } ++#if 0 ++ wlpsd_sweep_count = bt_tx_time * 238 / ++ 100; /* bt_tx_time/0.42 */ ++ wlpsd_sweep_count = wlpsd_sweep_count / 5; ++ ++ if (wlpsd_sweep_count % 5 != 0) ++ wlpsd_sweep_count = (wlpsd_sweep_count / ++ 5 + 1) * 5; ++#endif ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", ++ bt_tx_time, bt_le_channel); ++ BTC_TRACE(trace_buf); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", ++ wlpsd_cent_freq, ++ wlpsd_offset, ++ wlpsd_span, ++ BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT); ++ BTC_TRACE(trace_buf); ++ ++ state = 1; ++ break; ++ case 1: /* stop coex DM & set antenna path */ ++ /* Stop Coex DM */ ++ btcoexist->stop_coex_dm = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* Set TDMA off, */ ++ halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC, ++ false, 0); ++ ++ /* Set coex table */ ++ halbtc8723d2ant_coex_table_with_type(btcoexist, ++ FORCE_EXEC, 0); ++ ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ /* Set Antenna path, switch WiFi to un-certain antenna port */ ++ /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ ++ halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++ FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_ANTENNA_DET); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ ++ h2c_parameter[0] = 0x1; ++ h2c_parameter[1] = 0xd; ++ h2c_parameter[2] = 0x14; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", ++ h2c_parameter[1], ++ h2c_parameter[2]); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, ++ h2c_parameter); ++ ++ u32tmp = btcoexist->btc_read_2byte(btcoexist, 0x948); ++ u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70); ++ u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg( ++ btcoexist, 0x38); ++ u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg( ++ btcoexist, 0x54); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** 0x948 = 0x%x, 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (Before Ant Det)\n", ++ u32tmp, u32tmp0, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ ++ state = 2; ++ break; ++ case 2: /* Pre-sweep background psd */ ++ if (!halbtc8723d2ant_psd_sweep_point(btcoexist, ++ wlpsd_cent_freq, wlpsd_offset, wlpsd_span, ++ BT_8723D_2ANT_ANTDET_PSD_POINTS, ++ BT_8723D_2ANT_ANTDET_PSD_AVGNUM, 3)) { ++ ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ psd_scan->ant_det_result = 8; ++ state = 99; ++ break; ++ } ++ ++ psd_scan->ant_det_pre_psdscan_peak_val = ++ psd_scan->psd_max_value; ++ ++ if (psd_scan->ant_det_pre_psdscan_peak_val > ++ (BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset) * 100) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", ++ psd_scan->ant_det_pre_psdscan_peak_val / ++ 100, ++ BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ BTC_TRACE(trace_buf); ++ ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ psd_scan->ant_det_result = 5; ++ state = 99; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", ++ psd_scan->ant_det_pre_psdscan_peak_val / ++ 100, ++ BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ BTC_TRACE(trace_buf); ++ state = 3; ++ } ++ break; ++ case 3: ++ bt_resp = btcoexist->btc_set_bt_ant_detection( ++ btcoexist, (u8)(bt_tx_time & 0xff), ++ (u8)(bt_le_channel & 0xff)); ++ ++ /* Sync WL Rx PSD with BT Tx time because H2C->Mailbox delay */ ++ delay_ms(20); ++ ++ if (!halbtc8723d2ant_psd_sweep_point(btcoexist, ++ wlpsd_cent_freq, wlpsd_offset, ++ wlpsd_span, ++ BT_8723D_2ANT_ANTDET_PSD_POINTS, ++ BT_8723D_2ANT_ANTDET_PSD_AVGNUM, ++ BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT)) { ++ ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ psd_scan->ant_det_result = 8; ++ state = 99; ++ break; ++ } ++ ++#if 1 ++ psd_scan->ant_det_psd_scan_peak_val = ++ psd_scan->psd_max_value; ++#endif ++#if 0 ++ psd_scan->ant_det_psd_scan_peak_val = ++ ((psd_scan->psd_max_value - psd_scan->psd_avg_value) < ++ 800) ? ++ psd_scan->psd_max_value : (( ++ psd_scan->psd_max_value - ++ psd_scan->psd_max_value2 <= 300) ? ++ psd_scan->psd_avg_value : ++ psd_scan->psd_max_value2); ++#endif ++ psd_scan->ant_det_psd_scan_peak_freq = ++ psd_scan->psd_max_value_point; ++ state = 4; ++ break; ++ case 4: ++ ++ if (psd_scan->psd_point == 0) ++ delta_freq_per_point = 0; ++ else ++ delta_freq_per_point = ++ psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ psd_rep1 = psd_scan->ant_det_psd_scan_peak_val / 100; ++ psd_rep2 = psd_scan->ant_det_psd_scan_peak_val - ++ psd_rep1 * ++ 100; ++ ++ freq = ((psd_scan->real_cent_freq - 20) * ++ 1000000 + psd_scan->psd_max_value_point ++ * delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (freq2 < 100) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", ++ freq1, freq2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_freq, ++ BT_8723D_2ANT_ANTDET_BUF_LEN, ++ "%d.0%d", freq1, freq2); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", ++ freq1, freq2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_freq, ++ BT_8723D_2ANT_ANTDET_BUF_LEN, ++ "%d.%d", freq1, freq2); ++ } ++ ++ if (psd_rep2 < 10) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.0%d dB\n", ++ psd_rep1, psd_rep2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_val, ++ BT_8723D_2ANT_ANTDET_BUF_LEN, ++ "%d.0%d", psd_rep1, psd_rep2); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.%d dB\n", ++ psd_rep1, psd_rep2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_val, ++ BT_8723D_2ANT_ANTDET_BUF_LEN, ++ "%d.%d", psd_rep1, psd_rep2); ++ } ++ ++ psd_scan->ant_det_is_btreply_available = true; ++ ++ if (bt_resp == false) { ++ psd_scan->ant_det_is_btreply_available = ++ false; ++ psd_scan->ant_det_result = 0; ++ ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->ant_det_psd_scan_peak_val > ++ (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) ++ * 100) { ++ psd_scan->ant_det_result = 1; ++ ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 2; ++ coex_sta->isolation_btween_wb = (u8)(85 - ++ psd_scan->ant_det_psd_scan_peak_val / ++ 100) & 0xff; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->ant_det_psd_scan_peak_val > ++ (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset) * 100) { ++ psd_scan->ant_det_result = 2; ++ ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 2; ++ coex_sta->isolation_btween_wb = (u8)(85 - ++ psd_scan->ant_det_psd_scan_peak_val / ++ 100) & 0xff; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->ant_det_psd_scan_peak_val > ++ (BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT) * ++ 100) { ++ psd_scan->ant_det_result = 3; ++ ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ coex_sta->isolation_btween_wb = (u8)(85 - ++ psd_scan->ant_det_psd_scan_peak_val / ++ 100) & 0xff; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ psd_scan->ant_det_result = 4; ++ ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ state = 99; ++ break; ++ case 99: /* restore setup */ ++ ++ /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ ++ h2c_parameter[0] = 0x0; ++ h2c_parameter[1] = 0x0; ++ h2c_parameter[2] = 0x0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", ++ h2c_parameter[1], h2c_parameter[2]); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, ++ h2c_parameter); ++ ++ /* Set Antenna Path, GNT_WL/GNT_BT control by PTA */ ++ /* Set Antenna path, switch WiFi to certain antenna port */ ++ halbtc8723d2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_2G_RUNTIME); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ outloop = true; ++ break; ++ } ++ ++ } while (!outloop); ++ ++ return ant_det_finish; ++ ++} ++ ++#ifdef PLATFORM_WINDOWS ++#pragma optimize("", off) ++#endif ++boolean halbtc8723d2ant_psd_antenna_detection_check(IN struct btc_coexist ++ *btcoexist) ++{ ++ static u32 ant_det_count = 0, ant_det_fail_count = 0; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ boolean scan, roam, ant_det_finish = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ ant_det_count++; ++ ++ psd_scan->ant_det_try_count = ant_det_count; ++ ++ if (scan || roam) { ++ ant_det_finish = false; ++ psd_scan->ant_det_result = 6; ++ } else if (coex_sta->bt_disabled) { ++ ant_det_finish = false; ++ psd_scan->ant_det_result = 11; ++ } else if (coex_sta->num_of_profile >= 1) { ++ ant_det_finish = false; ++ psd_scan->ant_det_result = 7; ++ } else if ( ++ !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ ++ ant_det_finish = false; ++ psd_scan->ant_det_result = 9; ++ } else if (coex_sta->c2h_bt_inquiry_page) { ++ ant_det_finish = false; ++ psd_scan->ant_det_result = 10; ++ } else { ++ ++ ant_det_finish = halbtc8723d2ant_psd_antenna_detection( ++ btcoexist); ++ ++ delay_ms(psd_scan->ant_det_bt_tx_time); ++ } ++ ++ ++ if (!ant_det_finish) ++ ant_det_fail_count++; ++ ++ psd_scan->ant_det_fail_count = ant_det_fail_count; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n", ++ psd_scan->ant_det_result, ++ psd_scan->ant_det_fail_count, ++ ant_det_finish == true ? "Yes" : "No"); ++ BTC_TRACE(trace_buf); ++ ++ return ant_det_finish; ++ ++} ++ ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8723d2ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8723d2ant_ ++ * ************************************************************ */ ++void ex_halbtc8723d2ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 u8tmp = 0x0; ++ u16 u16tmp = 0x0; ++ u32 value = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Execute 8723d 2-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Ant Det Finish = %s, Ant Det Number = %d\n", ++ (board_info->btdm_ant_det_finish ? "Yes" : "No"), ++ board_info->btdm_ant_num_by_ant_det); ++ BTC_TRACE(trace_buf); ++ ++ ++ btcoexist->stop_coex_dm = true; ++ psd_scan->ant_det_is_ant_det_available = false; ++ ++ /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ ++ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); ++ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); ++ ++ ++ /* Local setting bit define */ ++ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ ++ /* BIT1: "0" for internal switch; "1" for external switch */ ++ /* BIT2: "0" for one antenna; "1" for two antenna */ ++ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ ++ ++ /* Set path control to WL */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x1); ++ btcoexist->btc_write_2byte(btcoexist, 0x948, 0x0); ++ ++ /* Check efuse 0xc3[6] for Single Antenna Path */ ++ if (board_info->single_ant_path == 0) { ++ /* set to S1 */ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; ++ u8tmp = 4; ++ value = 1; ++ } else if (board_info->single_ant_path == 1) { ++ /* set to S0 */ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; ++ u8tmp = 5; ++ value = 0; ++ } ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (Power On) single_ant_path = %d, btdm_ant_pos = %d **********\n", ++ board_info->single_ant_path , board_info->btdm_ant_pos); ++ BTC_TRACE(trace_buf); ++ ++ /* Set Antenna Path to BT side */ ++ halbtc8723d2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_1ANT_PHASE_COEX_POWERON); ++ ++ /* Write Single Antenna Position to Registry to tell BT for 872db. This line can be removed ++ since BT EFuse also add "single antenna position" in EFuse for 8723d*/ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, ++ &value); ++ ++ /* Save"single antenna position" info in Local register setting for FW reading, because FW may not ready at power on */ ++ if (btcoexist->chip_interface == BTC_INTF_PCI) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_USB) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_SDIO) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); ++ ++ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ ++ halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, true); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", ++ halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38)); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0x948 (Power-On) = 0x%x / 0x%x**********\n", ++ btcoexist->btc_read_4byte(btcoexist, 0x70), ++ btcoexist->btc_read_2byte(btcoexist, 0x948)); ++ BTC_TRACE(trace_buf); ++} ++ ++void ex_halbtc8723d2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */ ++ ++ /* */ ++ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ ++ /* Local setting bit define */ ++ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ ++ /* BIT1: "0" for internal switch; "1" for external switch */ ++ /* BIT2: "0" for one antenna; "1" for two antenna */ ++ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ ++ if (btcoexist->chip_interface == BTC_INTF_USB) { ++ /* fixed at S0 for USB interface */ ++ u8tmp |= 0x1; /* antenna inverse */ ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); ++ } else { ++ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ ++ if (board_info->single_ant_path == 0) { ++ } else if (board_info->single_ant_path == 1) { ++ /* set to S0 */ ++ u8tmp |= 0x1; /* antenna inverse */ ++ } ++ ++ if (btcoexist->chip_interface == BTC_INTF_PCI) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, ++ u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_SDIO) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, ++ u8tmp); ++ } ++} ++ ++ ++void ex_halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ halbtc8723d2ant_init_hw_config(btcoexist, wifi_only); ++} ++ ++void ex_halbtc8723d2ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ ++ halbtc8723d2ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, ps_tdma_case = 0; ++ u32 u32tmp[4]; ++ u16 u16tmp[4]; ++ u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck, bt_coex_ver = 0; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ static u8 pop_report_in_10s = 0, cnt = 0; ++ u32 phyver = 0; ++ boolean lte_coex_on = false; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ if (!coex_sta->bt_disabled) { ++ ++ if (coex_sta->bt_coex_supported_feature == 0) ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, ++ &coex_sta->bt_coex_supported_feature); ++ ++ if ((coex_sta->bt_coex_supported_version == 0) || ++ (coex_sta->bt_coex_supported_version == 0xffff)) ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, ++ &coex_sta->bt_coex_supported_version); ++ ++ if (coex_sta->bt_reg_vendor_ac == 0xffff) ++ coex_sta->bt_reg_vendor_ac = (u16)( ++ btcoexist->btc_get_bt_reg(btcoexist, 3, ++ 0xac) & 0xffff); ++ ++ if (coex_sta->bt_reg_vendor_ae == 0xffff) ++ coex_sta->bt_reg_vendor_ae = (u16)( ++ btcoexist->btc_get_bt_reg(btcoexist, 3, ++ 0xae) & 0xffff); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, ++ &bt_patch_ver); ++ btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; ++ ++ if (coex_sta->num_of_profile > 0) { ++ cnt++; ++ ++ if (cnt >= 3) { ++ btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, ++ &coex_sta->bt_afh_map[0]); ++ cnt = 0; ++ } ++ } ++ } ++ ++ if (psd_scan->ant_det_try_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", ++ "Ant PG Num/ Mech/ Pos", ++ board_info->pg_ant_num, board_info->btdm_ant_num, ++ (board_info->btdm_ant_pos == 1 ? "S1" : "S0")); ++ CL_PRINTF(cli_buf); ++ } else { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ %d/ %s (retry=%d/fail=%d/result=%d)", ++ "Ant PG Num/ Mech(Ant_Det)/ Pos", ++ board_info->pg_ant_num, ++ board_info->btdm_ant_num_by_ant_det, ++ (board_info->btdm_ant_pos == 1 ? "S1" : "S0"), ++ psd_scan->ant_det_try_count, ++ psd_scan->ant_det_fail_count, ++ psd_scan->ant_det_result); ++ CL_PRINTF(cli_buf); ++ ++ if (board_info->btdm_ant_det_finish) { ++ ++ if (psd_scan->ant_det_result != 12) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %s", ++ "Ant Det PSD Value", ++ psd_scan->ant_det_peak_val); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d", ++ "Ant Det PSD Value", ++ psd_scan->ant_det_psd_scan_peak_val ++ / 100); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ if (board_info->ant_det_result_five_complete) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ %d", ++ "AntDet(Registry) Num/PSD Value", ++ board_info->btdm_ant_num_by_ant_det, ++ (board_info->antdetval & 0x7f)); ++ CL_PRINTF(cli_buf); ++ } ++ ++ ++ bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); ++ ++ bt_coex_ver = coex_sta->bt_coex_supported_version & 0xff; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", ++ "CoexVer WL/ BT_Desired/ BT_Report", ++ glcoex_ver_date_8723d_2ant, glcoex_ver_8723d_2ant, ++ glcoex_ver_btdesired_8723d_2ant, ++ bt_coex_ver, ++ (bt_coex_ver == 0xff ? "Unknown" : ++ (coex_sta->bt_disabled ? "BT-disable" : ++ (bt_coex_ver >= glcoex_ver_btdesired_8723d_2ant ? ++ "Match" : "Mis-Match")))); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c", ++ "W_FW/ B_FW/ Phy/ Kt", ++ fw_ver, bt_patch_ver, phyver, ++ coex_sta->cut_version + 65); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d ", ++ "Isolation/WL_Thres/BT_Thres", ++ coex_sta->isolation_btween_wb, ++ coex_sta->wifi_coex_thres, ++ coex_sta->bt_coex_thres); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ pop_report_in_10s++; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = [%s/ %d dBm/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt/ popCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") ++ : ((BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, ++ coex_sta->pop_event_cnt); ++ CL_PRINTF(cli_buf); ++ ++ if (pop_report_in_10s >= 5) { ++ coex_sta->pop_event_cnt = 0; ++ pop_report_in_10s = 0; ++ } ++ ++ ++ if (coex_sta->num_of_profile != 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %s%s%s%s%s", ++ "Profiles", ++ ((bt_link_info->a2dp_exist) ? "A2DP," : ""), ++ ((bt_link_info->sco_exist) ? "SCO," : ""), ++ ((bt_link_info->hid_exist) ? ++ ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : ++ "HID(2/18),") : ""), ++ ((bt_link_info->pan_exist) ? "PAN," : ""), ++ ((coex_sta->voice_over_HOGP) ? "Voice" : "")); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = None", ++ "Profiles"); ++ ++ CL_PRINTF(cli_buf); ++ ++ ++ if (bt_link_info->a2dp_exist) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s", ++ "A2DP Rate/Bitpool/Auto_Slot", ++ ((coex_sta->is_A2DP_3M) ? "3M" : "No_3M"), ++ coex_sta->a2dp_bit_pool, ++ ((coex_sta->is_autoslot) ? "On" : "Off") ++ ); ++ CL_PRINTF(cli_buf); ++ } ++ ++ if (bt_link_info->hid_exist) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "HID PairNum/Forbid_Slot", ++ coex_sta->hid_pair_cnt, ++ coex_sta->forbidden_slot ++ ); ++ CL_PRINTF(cli_buf); ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s/ 0x%x/ 0x%x", ++ "Role/IgnWlanAct/Feature/BLEScan", ++ ((bt_link_info->slave_role) ? "Slave" : "Master"), ++ ((coex_dm->cur_ignore_wlan_act) ? "Yes" : "No"), ++ coex_sta->bt_coex_supported_feature, ++ coex_sta->bt_ble_scan_type); ++ CL_PRINTF(cli_buf); ++ ++ if ((coex_sta->bt_ble_scan_type & 0x7) != 0x0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%08x/ 0x%08x/ 0x%08x", ++ "BLEScan Intv-Win TV/Init/Ble", ++ (coex_sta->bt_ble_scan_type & 0x1 ? ++ coex_sta->bt_ble_scan_para[0] : 0x0), ++ (coex_sta->bt_ble_scan_type & 0x2 ? ++ coex_sta->bt_ble_scan_para[1] : 0x0), ++ (coex_sta->bt_ble_scan_type & 0x4 ? ++ coex_sta->bt_ble_scan_para[2] : 0x0)); ++ ++ CL_PRINTF(cli_buf); ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", ++ "ReInit/ReLink/IgnWlact/Page/NameReq", ++ coex_sta->cnt_ReInit, ++ coex_sta->cnt_setupLink, ++ coex_sta->cnt_IgnWlanAct, ++ coex_sta->cnt_Page, ++ coex_sta->cnt_RemoteNameReq ++ ); ++ CL_PRINTF(cli_buf); ++ ++ halbtc8723d2ant_read_score_board(btcoexist, &u16tmp[0]); ++ ++ if ((coex_sta->bt_reg_vendor_ae == 0xffff) || ++ (coex_sta->bt_reg_vendor_ac == 0xffff)) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ %04x", ++ "0xae[4]/0xac[1:0]/Scoreboard", u16tmp[0]); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ %04x", ++ "0xae[4]/0xac[1:0]/Scoreboard", ++ ((coex_sta->bt_reg_vendor_ae & BIT(4)) >> 4), ++ coex_sta->bt_reg_vendor_ac & 0x3, u16tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ if (coex_sta->num_of_profile > 0) { ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x", ++ "AFH MAP", ++ coex_sta->bt_afh_map[0], ++ coex_sta->bt_afh_map[1], ++ coex_sta->bt_afh_map[2], ++ coex_sta->bt_afh_map[3], ++ coex_sta->bt_afh_map[4], ++ coex_sta->bt_afh_map[5], ++ coex_sta->bt_afh_map[6], ++ coex_sta->bt_afh_map[7], ++ coex_sta->bt_afh_map[8], ++ coex_sta->bt_afh_map[9] ++ ); ++ CL_PRINTF(cli_buf); ++ } ++ ++ for (i = 0; i < BT_INFO_SRC_8723D_2ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x (%d)", ++ glbt_info_src_8723d_2ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ /* Sw mechanism */ ++ if (btcoexist->manual_control) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanism] (before Manual)============"); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Mechanism]============"); ++ ++ CL_PRINTF(cli_buf); ++ ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x (case-%d, %s, %s)", ++ "TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case, ++ (coex_dm->cur_ps_tdma_on ? "TDMA On" : "TDMA Off"), ++ (coex_dm->is_switch_to_1dot5_ant ? "1.5Ant" : "2Ant")); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ 0x%x/ 0x%x/ 0x%x", ++ "Table/0x6c0/0x6c4/0x6c8", ++ coex_sta->coex_table_type, u32tmp[0], u32tmp[1], u32tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x", ++ "0x778/0x6cc", ++ u8tmp[0], u32tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", ++ "AntDiv/ ForceLPS", ++ ((board_info->ant_div_cfg) ? "On" : "Off"), ++ ((coex_sta->force_lps_on) ? "On" : "Off")); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "WL_DACSwing/ BT_Dec_Pwr", coex_dm->cur_fw_dac_swing_lvl, ++ coex_dm->cur_bt_dec_pwr_lvl); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? true : false; ++ ++ if (lte_coex_on) { ++ ++ u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa0); ++ u32tmp[1] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "LTE Coex Table W_L/B_L", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa8); ++ u32tmp[1] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xac); ++ u32tmp[2] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb0); ++ u32tmp[3] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "LTE Break Table W_L/B_L/L_W/L_B", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, ++ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ } ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ /* ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); ++ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "0x430/0x434/0x42a/0x456", ++ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ */ ++ u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp[1] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", ++ "LTE Coex/Path Owner", ++ ((lte_coex_on) ? "On" : "Off") , ++ ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); ++ CL_PRINTF(cli_buf); ++ ++ if (lte_coex_on) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ %d/ %d/ %d", ++ "LTE 3Wire/OPMode/UART/UARTMode", ++ (int)((u32tmp[0] & BIT(6)) >> 6), ++ (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), ++ (int)((u32tmp[0] & BIT(3)) >> 3), ++ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "LTE_Busy/UART_Busy", ++ (int)((u32tmp[1] & BIT(1)) >> 1), (int)(u32tmp[1] & BIT(0))); ++ CL_PRINTF(cli_buf); ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s %d", ++ "GNT_WL_Ctrl/GNT_BT_Ctrl/Dbg", ++ ((u32tmp[0] & BIT(12)) ? "SW" : "HW"), ++ ((u32tmp[0] & BIT(8)) ? "SW" : "HW"), ++ ((u32tmp[0] & BIT(14)) ? "SW" : "HW"), ++ ((u32tmp[0] & BIT(10)) ? "SW" : "HW"), ++ ((u8tmp[0] & BIT(3)) ? "On" : "Off"), ++ coex_sta->gnt_error_cnt); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "GNT_WL/GNT_BT", ++ (int)((u32tmp[1] & BIT(2)) >> 2), ++ (int)((u32tmp[1] & BIT(3)) >> 3)); ++ CL_PRINTF(cli_buf); ++ ++ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x948); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x948/0x67[7]", ++ u16tmp[0], (int)((u8tmp[0] & BIT(7)) >> 7)); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x964); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x864); ++ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xab7); ++ u8tmp[3] = btcoexist->btc_read_1byte(btcoexist, 0xa01); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x964[1]/0x864[0]/0xab7[5]/0xa01[7]", ++ (int)((u8tmp[0] & BIT(1)) >> 1), (int)((u8tmp[1] & BIT(0))), ++ (int)((u8tmp[2] & BIT(3)) >> 3), ++ (int)((u8tmp[3] & BIT(7)) >> 7)); ++ CL_PRINTF(cli_buf); ++ ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x45e); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x4c6[4]/0x40[5]/0x45e[3](TxRetry)", ++ (int)((u8tmp[0] & BIT(4)) >> 4), ++ (int)((u8tmp[1] & BIT(5)) >> 5), ++ (int)((u8tmp[2] & BIT(3)) >> 3)); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s", ++ "0x550/0x522/4-RxAGC", ++ u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off"); ++ CL_PRINTF(cli_buf); ++ ++ fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_FA_OFDM); ++ fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_FA_CCK); ++ cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_CCA_OFDM); ++ cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_CCA_CCK); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", ++ cca_cck, fa_cck, cca_ofdm, fa_ofdm); ++ CL_PRINTF(cli_buf); ++ ++#if 1 ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_OK CCK/11g/11n/11n-agg", ++ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, ++ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_Err CCK/11g/11n/11n-agg", ++ coex_sta->crc_err_cck, coex_sta->crc_err_11g, ++ coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); ++ CL_PRINTF(cli_buf); ++#endif ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d", ++ "WlHiPri/ Locking/ Locked/ Noisy", ++ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), ++ (coex_sta->cck_lock ? "Yes" : "No"), ++ (coex_sta->cck_ever_lock ? "Yes" : "No"), ++ coex_sta->wl_noisy_level); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", ++ "0x770(Hi-pri rx/tx)", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx, ++ (coex_sta->is_hiPri_rx_overhead ? "(scan overhead!!)" : "")); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", ++ "0x774(Lo-pri rx/tx)", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx, ++ (bt_link_info->slave_role ? "(Slave!!)" : ( ++ coex_sta->is_tdma_btautoslot_hang ? "(auto-slot hang!!)" : ""))); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++void ex_halbtc8723d2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ coex_sta->under_lps = false; ++ ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_2ANT_SCOREBOARD_ONOFF | ++ BT_8723D_2ANT_SCOREBOARD_SCAN | ++ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, ++ false); ++ ++ halbtc8723d2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_WLAN_OFF); ++ ++ halbtc8723d2ant_action_coex_all_off(btcoexist); ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = false; ++#if 0 ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); ++ ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ONOFF, true); ++#endif ++ halbtc8723d2ant_init_hw_config(btcoexist, false); ++ halbtc8723d2ant_init_coex_dm(btcoexist); ++ halbtc8723d2ant_query_bt_info(btcoexist); ++ } ++} ++ ++void ex_halbtc8723d2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ coex_sta->under_ips = false; ++ ++ if (coex_sta->force_lps_on == true) { /* LPS No-32K */ ++ /* Write WL "Active" in Score-board for PS-TDMA */ ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); ++ ++ } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ ++ /* Write WL "Non-Active" in Score-board for Native-PS */ ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE, false); ++ } ++ ++ ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); ++ } ++} ++ ++void ex_halbtc8723d2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u32 u32tmp; ++ u8 u8tmpa, u8tmpb; ++ boolean wifi_connected = false; ++ ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ /* this can't be removed for RF off_on event, or BT would dis-connect */ ++ halbtc8723d2ant_query_bt_info(btcoexist); ++ ++ if (BTC_SCAN_START == type) { ++ ++ if (!wifi_connected) ++ coex_sta->wifi_is_high_pri_task = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_2ANT_SCOREBOARD_SCAN | ++ BT_8723D_2ANT_SCOREBOARD_ONOFF, ++ true); ++ ++ halbtc8723d2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8723d2ant_run_coexist_mechanism(btcoexist); ++ ++ } else if (BTC_SCAN_FINISH == type) { ++ ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", ++ coex_sta->scan_ap_num); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_SCAN, false); ++ ++ halbtc8723d2ant_run_coexist_mechanism(btcoexist); ++ } ++ ++} ++ ++void ex_halbtc8723d2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_ASSOCIATE_START == type) { ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_2ANT_SCOREBOARD_SCAN | ++ BT_8723D_2ANT_SCOREBOARD_ONOFF, ++ true); ++ ++ halbtc8723d2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8723d2ant_run_coexist_mechanism(btcoexist); ++ /* To keep TDMA case during connect process, ++ to avoid changed by Btinfo and runcoexmechanism */ ++ coex_sta->freeze_coexrun_by_btinfo = true; ++ ++ coex_dm->arp_cnt = 0; ++ ++ } else if (BTC_ASSOCIATE_FINISH == type) { ++ ++ coex_sta->wifi_is_high_pri_task = false; ++ coex_sta->freeze_coexrun_by_btinfo = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_run_coexist_mechanism(btcoexist); ++ } ++} ++ ++void ex_halbtc8723d2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ u8 ap_num = 0; ++ boolean wifi_under_b_mode = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_2ANT_SCOREBOARD_ONOFF, ++ true); ++ ++ halbtc8723d2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_2G_RUNTIME); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ /* Set CCK Tx/Rx high Pri except 11b mode */ ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x00); /* CCK Rx */ ++ } else { ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x10); /* CCK Rx */ ++ } ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ ++ ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE, false); ++ } ++ ++ ++ halbtc8723d2ant_update_wifi_channel_info(btcoexist, type); ++} ++ ++void ex_halbtc8723d2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean under_4way = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (under_4way) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ---- under_4way!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ coex_sta->specific_pkt_period_cnt = 2; ++ ++ } else if (BTC_PACKET_ARP == type) { ++ ++ coex_dm->arp_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ARP notify -cnt = %d\n", ++ coex_dm->arp_cnt); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", ++ type); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ coex_sta->specific_pkt_period_cnt = 2; ++ } ++ ++ if (coex_sta->wifi_is_high_pri_task) { ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); ++ halbtc8723d2ant_run_coexist_mechanism(btcoexist); ++ } ++ ++} ++ ++void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 i, rsp_source = 0; ++ boolean wifi_connected = false; ++ boolean wifi_scan = false, wifi_link = false, wifi_roam = false, ++ wifi_busy = false; ++ static boolean is_scoreboard_scan = false; ++ ++ if (psd_scan->is_AntDet_running == true) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], bt_info_notify return for AntDet is running\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8723D_2ANT_MAX) ++ rsp_source = BT_INFO_SRC_8723D_2ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt_info[%d], len=%d, data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ coex_sta->bt_info = coex_sta->bt_info_c2h[rsp_source][1]; ++ coex_sta->bt_info_ext = coex_sta->bt_info_c2h[rsp_source][4]; ++ coex_sta->bt_info_ext2 = coex_sta->bt_info_c2h[rsp_source][5]; ++ ++ if (BT_INFO_SRC_8723D_2ANT_WIFI_FW != rsp_source) { ++ ++ /* if 0xff, it means BT is under WHCK test */ ++ coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? true : ++ false); ++ ++ coex_sta->bt_create_connection = (( ++ coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? true : ++ false); ++ ++ /* unit: %, value-100 to translate to unit: dBm */ ++ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + ++ 10; ++ ++ coex_sta->c2h_bt_remote_name_req = (( ++ coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? true : ++ false); ++ ++ coex_sta->is_A2DP_3M = ((coex_sta->bt_info_c2h[rsp_source][2] & ++ 0x10) ? true : false); ++ ++ coex_sta->acl_busy = ((coex_sta->bt_info_c2h[rsp_source][1] & ++ 0x9) ? true : false); ++ ++ coex_sta->voice_over_HOGP = ((coex_sta->bt_info_ext & 0x10) ? ++ true : false); ++ ++ coex_sta->c2h_bt_inquiry_page = ((coex_sta->bt_info & ++ BT_INFO_8723D_2ANT_B_INQ_PAGE) ? true : false); ++ ++ coex_sta->a2dp_bit_pool = ((( ++ coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) ? ++ coex_sta->bt_info_c2h[rsp_source][6] : 0); ++ ++ coex_sta->bt_retry_cnt = coex_sta->bt_info_c2h[rsp_source][2] & ++ 0xf; ++ ++ coex_sta->is_autoslot = coex_sta->bt_info_ext2 & 0x8; ++ ++ coex_sta->forbidden_slot = coex_sta->bt_info_ext2 & 0x7; ++ ++ coex_sta->hid_busy_num = (coex_sta->bt_info_ext2 & 0x30) >> 4; ++ ++ coex_sta->hid_pair_cnt = (coex_sta->bt_info_ext2 & 0xc0) >> 6; ++ ++ if (coex_sta->bt_retry_cnt >= 1) ++ coex_sta->pop_event_cnt++; ++ ++ if (coex_sta->c2h_bt_remote_name_req) ++ coex_sta->cnt_RemoteNameReq++; ++ ++ if (coex_sta->bt_info_ext & BIT(1)) ++ coex_sta->cnt_ReInit++; ++ ++ if (coex_sta->bt_info_ext & BIT(2)) { ++ coex_sta->cnt_setupLink++; ++ coex_sta->is_setupLink = true; ++ } else ++ coex_sta->is_setupLink = false; ++ ++ if (coex_sta->bt_info_ext & BIT(3)) ++ coex_sta->cnt_IgnWlanAct++; ++ ++ if (coex_sta->bt_create_connection) { ++ coex_sta->cnt_Page++; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, ++ &wifi_busy); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); ++ ++ if ((wifi_link) || (wifi_roam) || (wifi_scan) || ++ (coex_sta->wifi_is_high_pri_task) || (wifi_busy)) { ++ ++ is_scoreboard_scan = true; ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_SCAN, true); ++ ++ } else ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_SCAN, false); ++ ++ } else { ++ if (is_scoreboard_scan) { ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_SCAN, false); ++ is_scoreboard_scan = false; ++ } ++ } ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ ++ if ((!btcoexist->manual_control) && ++ (!btcoexist->stop_coex_dm)) { ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ /* Re-Init */ ++ if ((coex_sta->bt_info_ext & BIT(1))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ if (wifi_connected) ++ halbtc8723d2ant_update_wifi_channel_info( ++ btcoexist, BTC_MEDIA_CONNECT); ++ else ++ halbtc8723d2ant_update_wifi_channel_info( ++ btcoexist, ++ BTC_MEDIA_DISCONNECT); ++ } ++ ++ ++ /* If Ignore_WLanAct && not SetUp_Link or Role_Switch */ ++ if ((coex_sta->bt_info_ext & BIT(3)) && ++ (!(coex_sta->bt_info_ext & BIT(2))) && ++ (!(coex_sta->bt_info_ext & BIT(6)))) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8723d2ant_ignore_wlan_act(btcoexist, ++ FORCE_EXEC, false); ++ } else { ++ if (coex_sta->bt_info_ext & BIT(2)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ignore Wlan active because Re-link!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (coex_sta->bt_info_ext & BIT(6)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ignore Wlan active because Role-Switch!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ } ++ ++ } ++ ++ if ((coex_sta->bt_info_ext & BIT(5))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt(btcoexist); ++ ++ if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) ++ coex_sta->bt_ble_scan_para[0] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x1); ++ if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) ++ coex_sta->bt_ble_scan_para[1] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x2); ++ if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) ++ coex_sta->bt_ble_scan_para[2] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x4); ++ } ++ ++ halbtc8723d2ant_update_bt_link_info(btcoexist); ++ ++ halbtc8723d2ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8723d2ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_RF_ON == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned ON!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = false; ++#if 0 ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ONOFF, true); ++#endif ++ } else if (BTC_RF_OFF == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned OFF!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_WLAN_OFF); ++ ++ halbtc8723d2ant_action_coex_all_off(btcoexist); ++ ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_2ANT_SCOREBOARD_ONOFF | ++ BT_8723D_2ANT_SCOREBOARD_SCAN | ++ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, ++ false); ++ ++ btcoexist->stop_coex_dm = true; ++ ++ } ++} ++ ++void ex_halbtc8723d2ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8723d2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_WLAN_OFF); ++ ++ ex_halbtc8723d2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++ ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_2ANT_SCOREBOARD_ONOFF | ++ BT_8723D_2ANT_SCOREBOARD_SCAN | ++ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, ++ false); ++} ++ ++void ex_halbtc8723d2ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if ((BTC_WIFI_PNP_SLEEP == pnp_state) || ++ (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ ++ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ ++ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ ++ coex_sta->under_ips = false; ++ coex_sta->under_lps = false; ++ ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE | ++ BT_8723D_2ANT_SCOREBOARD_ONOFF | ++ BT_8723D_2ANT_SCOREBOARD_SCAN | ++ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, ++ false); ++ ++ if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) { ++ ++ halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_2G_RUNTIME); ++ } else { ++ ++ halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_WLAN_OFF); ++ } ++ ++ ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++#if 0 ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_ONOFF, true); ++#endif ++ } ++} ++ ++void ex_halbtc8723d2ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ boolean wifi_busy = false; ++ u32 bt_patch_ver; ++ static u8 cnt = 0; ++ boolean bt_relink_finish = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ************* Periodical *************\n"); ++ BTC_TRACE(trace_buf); ++ ++#if (BT_AUTO_REPORT_ONLY_8723D_2ANT == 0) ++ halbtc8723d2ant_query_bt_info(btcoexist); ++#endif ++ ++ halbtc8723d2ant_monitor_bt_ctr(btcoexist); ++ halbtc8723d2ant_monitor_wifi_ctr(btcoexist); ++ halbtc8723d2ant_monitor_bt_enable_disable(btcoexist); ++ ++#if 0 ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ /* halbtc8723d2ant_read_score_board(btcoexist, &bt_scoreboard_val); */ ++ ++ if (wifi_busy) { ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, true); ++ /* ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_WLBUSY, true); ++ ++ if (bt_scoreboard_val & BIT(6)) ++ halbtc8723d2ant_query_bt_info(btcoexist); */ ++ } else { ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, false); ++ /* ++ halbtc8723d2ant_post_state_to_bt(btcoexist, ++ BT_8723D_2ANT_SCOREBOARD_WLBUSY, ++ false); */ ++ } ++#endif ++ ++ if (coex_sta->bt_relink_downcount != 0) { ++ coex_sta->bt_relink_downcount--; ++ ++ if (coex_sta->bt_relink_downcount == 0) ++ bt_relink_finish = true; ++ } ++ ++ /* for 4-way, DHCP, EAPOL packet */ ++ if (coex_sta->specific_pkt_period_cnt > 0) { ++ ++ coex_sta->specific_pkt_period_cnt--; ++ ++ if ((coex_sta->specific_pkt_period_cnt == 0) && ++ (coex_sta->wifi_is_high_pri_task)) ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", ++ (coex_sta->wifi_is_high_pri_task ? "Yes" : ++ "No")); ++ BTC_TRACE(trace_buf); ++ ++ } ++ ++ if (!coex_sta->bt_disabled) { ++ ++#if BT_8723D_2ANT_ANTDET_ENABLE ++ ++ if (board_info->btdm_ant_det_finish) { ++ if ((psd_scan->ant_det_result == 12) && ++ (psd_scan->ant_det_psd_scan_peak_val == 0) ++ && (!psd_scan->is_AntDet_running)) ++ psd_scan->ant_det_psd_scan_peak_val = ++ btcoexist->btc_get_ant_det_val_from_bt( ++ btcoexist) * 100; ++ } ++ ++#endif ++ } ++ ++ ++ if (halbtc8723d2ant_is_wifibt_status_changed(btcoexist)) ++ halbtc8723d2ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8723d2ant_set_antenna_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (type == 2) { /* two antenna */ ++ board_info->ant_div_cfg = true; ++ ++ halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, ++ FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_2G_RUNTIME); ++ ++ } else { /* one antenna */ ++ ++ halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8723D_2ANT_PHASE_2G_RUNTIME); ++ ++ } ++} ++ ++#ifdef PLATFORM_WINDOWS ++#pragma optimize("", off) ++#endif ++void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++ ++ static u32 ant_det_count = 0, ant_det_fail_count = 0; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u16 u16tmp; ++ u8 AntDetval = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n"); ++ BTC_TRACE(trace_buf); ++ ++#if BT_8723D_2ANT_ANTDET_ENABLE ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Call AntennaDetect()!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (seconds == 0) { ++ psd_scan->ant_det_try_count = 0; ++ psd_scan->ant_det_fail_count = 0; ++ ant_det_count = 0; ++ ant_det_fail_count = 0; ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ return; ++ } ++ ++ if (!board_info->btdm_ant_det_finish) { ++ psd_scan->ant_det_inteval_count = ++ psd_scan->ant_det_inteval_count + 2; ++ ++ if (psd_scan->ant_det_inteval_count >= ++ BT_8723D_2ANT_ANTDET_RETRY_INTERVAL) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ psd_scan->is_AntDet_running = true; ++ ++ halbtc8723d2ant_read_score_board(btcoexist, &u16tmp); ++ ++ if (u16tmp & BIT( ++ 2)) { /* Antenna detection is already done before last WL power on */ ++ board_info->btdm_ant_det_finish = true; ++ psd_scan->ant_det_try_count = 1; ++ psd_scan->ant_det_fail_count = 0; ++ board_info->btdm_ant_num_by_ant_det = (u16tmp & ++ BIT(3)) ? 1 : 2; ++ psd_scan->ant_det_result = 12; ++ ++ psd_scan->ant_det_psd_scan_peak_val = ++ btcoexist->btc_get_ant_det_val_from_bt( ++ btcoexist) * 100; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Result from BT (%d-Ant)\n", ++ board_info->btdm_ant_num_by_ant_det); ++ BTC_TRACE(trace_buf); ++ } else ++ board_info->btdm_ant_det_finish = ++ halbtc8723d2ant_psd_antenna_detection_check( ++ btcoexist); ++ ++ btcoexist->bdontenterLPS = false; ++ ++ if (board_info->btdm_ant_det_finish) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /*for 8723d, btc_set_bt_trx_mask is just used to ++ notify BT stop le tx and Ant Det Result , not set BT RF TRx Mask */ ++ if (psd_scan->ant_det_result != 12) { ++ ++ AntDetval = (u8)( ++ psd_scan->ant_det_psd_scan_peak_val ++ / 100) & 0x7f; ++ ++ AntDetval = ++ (board_info->btdm_ant_num_by_ant_det ++ == 1) ? (AntDetval | 0x80) : ++ AntDetval; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxx AntennaDetect(), Ant Count = %d, PSD Val = %d\n", ++ ((AntDetval & ++ 0x80) ? 1 ++ : 2), AntDetval ++ & 0x7f); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->btc_set_bt_trx_mask( ++ btcoexist, AntDetval)) ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask ok!\n"); ++ else ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask fail!\n"); ++ ++ BTC_TRACE(trace_buf); ++ } else ++ board_info->antdetval = ++ psd_scan->ant_det_psd_scan_peak_val/100; ++ ++ board_info->btdm_ant_det_complete_fail = false; ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ psd_scan->ant_det_inteval_count = 0; ++ psd_scan->is_AntDet_running = false; ++ ++ /* stimulate coex running */ ++ halbtc8723d2ant_run_coexist_mechanism( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", ++ psd_scan->ant_det_inteval_count); ++ BTC_TRACE(trace_buf); ++ ++ if (psd_scan->ant_det_inteval_count == 8) ++ btcoexist->bdontenterLPS = true; ++ else ++ btcoexist->bdontenterLPS = false; ++ } ++ ++ } ++#endif ++ ++ ++} ++ ++ ++void ex_halbtc8723d2ant_display_ant_detection(IN struct btc_coexist *btcoexist) ++{ ++ ++#if BT_8723D_2ANT_ANTDET_ENABLE ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ if (psd_scan->ant_det_try_count != 0) { ++ halbtc8723d2ant_psd_show_antenna_detect_result(btcoexist); ++ ++ if (board_info->btdm_ant_det_finish) ++ halbtc8723d2ant_psd_showdata(btcoexist); ++ } ++#endif ++ ++} ++ ++ ++#endif ++ ++#endif /* #if (RTL8723D_SUPPORT == 1) */ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.h 2018-02-11 21:44:27.149146116 +0200 +@@ -0,0 +1,420 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8723D_SUPPORT == 1) ++ ++/* ******************************************* ++ * The following is for 8723D 2Ant BT Co-exist definition ++ * ******************************************* */ ++#define BT_8723D_2ANT_COEX_DBG 0 ++#define BT_AUTO_REPORT_ONLY_8723D_2ANT 1 ++ ++ ++#define BT_INFO_8723D_2ANT_B_FTP BIT(7) ++#define BT_INFO_8723D_2ANT_B_A2DP BIT(6) ++#define BT_INFO_8723D_2ANT_B_HID BIT(5) ++#define BT_INFO_8723D_2ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8723D_2ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8723D_2ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8723D_2ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8723D_2ANT_B_CONNECTION BIT(0) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT 2 ++ ++ ++#define BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 80 /* unit: % WiFi RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 42 */ ++#define BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1 80 /* unit: % BT RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 46 */ ++#define BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES2 80 /* unit: % WiFi RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 42 */ ++#define BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES2 80 /* unit: % BT RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 46 */ ++#define BT_8723D_2ANT_DEFAULT_ISOLATION 15 /* unit: dB */ ++#define BT_8723D_2ANT_WIFI_MAX_TX_POWER 15 /* unit: dBm */ ++#define BT_8723D_2ANT_BT_MAX_TX_POWER 3 /* unit: dBm */ ++#define BT_8723D_2ANT_WIFI_SIR_THRES1 -15 /* unit: dB */ ++#define BT_8723D_2ANT_WIFI_SIR_THRES2 -30 /* unit: dB */ ++#define BT_8723D_2ANT_BT_SIR_THRES1 -15 /* unit: dB */ ++#define BT_8723D_2ANT_BT_SIR_THRES2 -30 /* unit: dB */ ++ ++ ++/* for Antenna detection */ ++#define BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND 50 ++#define BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 ++#define BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 52 ++#define BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT 40 ++#define BT_8723D_2ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ ++#define BT_8723D_2ANT_ANTDET_SWEEPPOINT_DELAY 60000 ++#define BT_8723D_2ANT_ANTDET_ENABLE 1 ++#define BT_8723D_2ANT_ANTDET_BTTXTIME 100 ++#define BT_8723D_2ANT_ANTDET_BTTXCHANNEL 39 ++#define BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT 50 ++ ++ ++#define BT_8723D_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 ++ ++enum bt_8723d_2ant_signal_state { ++ BT_8723D_2ANT_SIG_STA_SET_TO_LOW = 0x0, ++ BT_8723D_2ANT_SIG_STA_SET_BY_HW = 0x0, ++ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH = 0x1, ++ BT_8723D_2ANT_SIG_STA_MAX ++}; ++ ++enum bt_8723d_2ant_path_ctrl_owner { ++ BT_8723D_2ANT_PCO_BTSIDE = 0x0, ++ BT_8723D_2ANT_PCO_WLSIDE = 0x1, ++ BT_8723D_2ANT_PCO_MAX ++}; ++ ++enum bt_8723d_2ant_gnt_ctrl_type { ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, ++ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW = 0x1, ++ BT_8723D_2ANT_GNT_TYPE_MAX ++}; ++ ++enum bt_8723d_2ant_gnt_ctrl_block { ++ BT_8723D_2ANT_GNT_BLOCK_RFC_BB = 0x0, ++ BT_8723D_2ANT_GNT_BLOCK_RFC = 0x1, ++ BT_8723D_2ANT_GNT_BLOCK_BB = 0x2, ++ BT_8723D_2ANT_GNT_BLOCK_MAX ++}; ++ ++enum bt_8723d_2ant_lte_coex_table_type { ++ BT_8723D_2ANT_CTT_WL_VS_LTE = 0x0, ++ BT_8723D_2ANT_CTT_BT_VS_LTE = 0x1, ++ BT_8723D_2ANT_CTT_MAX ++}; ++ ++enum bt_8723d_2ant_lte_break_table_type { ++ BT_8723D_2ANT_LBTT_WL_BREAK_LTE = 0x0, ++ BT_8723D_2ANT_LBTT_BT_BREAK_LTE = 0x1, ++ BT_8723D_2ANT_LBTT_LTE_BREAK_WL = 0x2, ++ BT_8723D_2ANT_LBTT_LTE_BREAK_BT = 0x3, ++ BT_8723D_2ANT_LBTT_MAX ++}; ++ ++enum bt_info_src_8723d_2ant { ++ BT_INFO_SRC_8723D_2ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8723D_2ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8723D_2ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8723D_2ANT_MAX ++}; ++ ++enum bt_8723d_2ant_bt_status { ++ BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8723D_2ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8723D_2ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8723D_2ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8723D_2ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8723d_2ant_coex_algo { ++ BT_8723D_2ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8723D_2ANT_COEX_ALGO_SCO = 0x1, ++ BT_8723D_2ANT_COEX_ALGO_HID = 0x2, ++ BT_8723D_2ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8723D_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, ++ BT_8723D_2ANT_COEX_ALGO_PANEDR = 0x5, ++ BT_8723D_2ANT_COEX_ALGO_PANHS = 0x6, ++ BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, ++ BT_8723D_2ANT_COEX_ALGO_PANEDR_HID = 0x8, ++ BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, ++ BT_8723D_2ANT_COEX_ALGO_HID_A2DP = 0xa, ++ BT_8723D_2ANT_COEX_ALGO_NOPROFILEBUSY = 0xb, ++ BT_8723D_2ANT_COEX_ALGO_MAX ++}; ++ ++enum bt_8723d_2ant_phase { ++ BT_8723D_2ANT_PHASE_COEX_INIT = 0x0, ++ BT_8723D_2ANT_PHASE_WLANONLY_INIT = 0x1, ++ BT_8723D_2ANT_PHASE_WLAN_OFF = 0x2, ++ BT_8723D_2ANT_PHASE_2G_RUNTIME = 0x3, ++ BT_8723D_2ANT_PHASE_5G_RUNTIME = 0x4, ++ BT_8723D_2ANT_PHASE_BTMPMODE = 0x5, ++ BT_8723D_2ANT_PHASE_ANTENNA_DET = 0x6, ++ BT_8723D_2ANT_PHASE_COEX_POWERON = 0x7, ++ BT_8723D_2ANT_PHASE_MAX ++}; ++ ++enum bt_8723d_2ant_Scoreboard { ++ BT_8723D_2ANT_SCOREBOARD_ACTIVE = BIT(0), ++ BT_8723D_2ANT_SCOREBOARD_ONOFF = BIT(1), ++ BT_8723D_2ANT_SCOREBOARD_SCAN = BIT(2), ++ BT_8723D_2ANT_SCOREBOARD_UNDERTEST = BIT(3), ++ BT_8723D_2ANT_SCOREBOARD_WLBUSY = BIT(6) ++}; ++ ++ ++ ++struct coex_dm_8723d_2ant { ++ /* fw mechanism */ ++ u8 pre_bt_dec_pwr_lvl; ++ u8 cur_bt_dec_pwr_lvl; ++ u8 pre_fw_dac_swing_lvl; ++ u8 cur_fw_dac_swing_lvl; ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean reset_tdma_adjust; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ ++ /* sw mechanism */ ++ boolean pre_rf_rx_lpf_shrink; ++ boolean cur_rf_rx_lpf_shrink; ++ u32 bt_rf_0x1e_backup; ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ boolean pre_dac_swing_on; ++ u32 pre_dac_swing_lvl; ++ boolean cur_dac_swing_on; ++ u32 cur_dac_swing_lvl; ++ boolean pre_adc_back_off; ++ boolean cur_adc_back_off; ++ boolean pre_agc_table_en; ++ boolean cur_agc_table_en; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ boolean limited_dig; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ boolean need_recover0x948; ++ u32 backup0x948; ++ ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++ ++ boolean is_switch_to_1dot5_ant; ++ u8 switch_thres_offset; ++ u32 arp_cnt; ++ ++ u8 pre_ant_pos_type; ++ u8 cur_ant_pos_type; ++}; ++ ++struct coex_sta_8723d_2ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ boolean is_hiPri_rx_overhead; ++ u8 bt_rssi; ++ boolean bt_tx_rx_mask; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ u8 bt_info_c2h[BT_INFO_SRC_8723D_2ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8723D_2ANT_MAX]; ++ boolean bt_whck_test; ++ boolean c2h_bt_inquiry_page; ++ boolean c2h_bt_remote_name_req; ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++ u8 bt_info_ext2; ++ u32 pop_event_cnt; ++ u8 scan_ap_num; ++ ++ u32 crc_ok_cck; ++ u32 crc_ok_11g; ++ u32 crc_ok_11n; ++ u32 crc_ok_11n_vht; ++ ++ u32 crc_err_cck; ++ u32 crc_err_11g; ++ u32 crc_err_11n; ++ u32 crc_err_11n_vht; ++ ++ boolean cck_lock; ++ boolean pre_ccklock; ++ boolean cck_ever_lock; ++ u8 coex_table_type; ++ boolean force_lps_on; ++ ++ u8 dis_ver_info_cnt; ++ ++ u8 a2dp_bit_pool; ++ u8 cut_version; ++ ++ boolean concurrent_rx_mode_on; ++ ++ u16 score_board; ++ u8 isolation_btween_wb; /* 0~ 50 */ ++ u8 wifi_coex_thres; ++ u8 bt_coex_thres; ++ u8 wifi_coex_thres2; ++ u8 bt_coex_thres2; ++ ++ u8 num_of_profile; ++ boolean acl_busy; ++ boolean bt_create_connection; ++ boolean wifi_is_high_pri_task; ++ u32 specific_pkt_period_cnt; ++ u32 bt_coex_supported_feature; ++ u32 bt_coex_supported_version; ++ ++ u8 bt_ble_scan_type; ++ u32 bt_ble_scan_para[3]; ++ ++ boolean run_time_state; ++ boolean freeze_coexrun_by_btinfo; ++ ++ boolean is_A2DP_3M; ++ boolean voice_over_HOGP; ++ u8 bt_info; ++ boolean is_autoslot; ++ u8 forbidden_slot; ++ u8 hid_busy_num; ++ u8 hid_pair_cnt; ++ ++ u32 cnt_RemoteNameReq; ++ u32 cnt_setupLink; ++ u32 cnt_ReInit; ++ u32 cnt_IgnWlanAct; ++ u32 cnt_Page; ++ u32 cnt_RoleSwitch; ++ ++ u16 bt_reg_vendor_ac; ++ u16 bt_reg_vendor_ae; ++ ++ boolean is_setupLink; ++ boolean wl_noisy_level; ++ u32 gnt_error_cnt; ++ ++ u8 bt_afh_map[10]; ++ u8 bt_relink_downcount; ++ boolean is_tdma_btautoslot; ++ boolean is_tdma_btautoslot_hang; ++ ++ boolean is_eSCO_mode; ++}; ++ ++#define BT_8723D_2ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ ++#define BT_8723D_2ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ ++#define BT_8723D_2ANT_ANTDET_BUF_LEN 16 ++ ++struct psdscan_sta_8723d_2ant { ++ ++ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ ++ u32 ant_det_bt_tx_time; ++ u32 ant_det_pre_psdscan_peak_val; ++ boolean ant_det_is_ant_det_available; ++ u32 ant_det_psd_scan_peak_val; ++ boolean ant_det_is_btreply_available; ++ u32 ant_det_psd_scan_peak_freq; ++ ++ u8 ant_det_result; ++ u8 ant_det_peak_val[BT_8723D_2ANT_ANTDET_BUF_LEN]; ++ u8 ant_det_peak_freq[BT_8723D_2ANT_ANTDET_BUF_LEN]; ++ u32 ant_det_try_count; ++ u32 ant_det_fail_count; ++ u32 ant_det_inteval_count; ++ u32 ant_det_thres_offset; ++ ++ u32 real_cent_freq; ++ s32 real_offset; ++ u32 real_span; ++ ++ u32 psd_band_width; /* unit: Hz */ ++ u32 psd_point; /* 128/256/512/1024 */ ++ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_start_point; ++ u32 psd_stop_point; ++ u32 psd_max_value_point; ++ u32 psd_max_value; ++ u32 psd_max_value2; ++ u32 psd_avg_value; /* filter loop_max_value that below BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT, and average the rest*/ ++ u32 psd_loop_max_value[BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT]; /*max value in each loop */ ++ u32 psd_start_base; ++ u32 psd_avg_num; /* 1/8/16/32 */ ++ u32 psd_gen_count; ++ boolean is_AntDet_running; ++ boolean is_psd_show_max_only; ++}; ++ ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8723d2ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723d2ant_pre_load_firmware(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8723d2ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723d2ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d2ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8723d2ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d2ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723d2ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state); ++void ex_halbtc8723d2ant_set_antenna_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8723d2ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist); ++void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++void ex_halbtc8723d2ant_display_ant_detection(IN struct btc_coexist *btcoexist); ++ ++ ++#else ++#define ex_halbtc8723d2ant_power_on_setting(btcoexist) ++#define ex_halbtc8723d2ant_pre_load_firmware(btcoexist) ++#define ex_halbtc8723d2ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8723d2ant_init_coex_dm(btcoexist) ++#define ex_halbtc8723d2ant_ips_notify(btcoexist, type) ++#define ex_halbtc8723d2ant_lps_notify(btcoexist, type) ++#define ex_halbtc8723d2ant_scan_notify(btcoexist, type) ++#define ex_halbtc8723d2ant_connect_notify(btcoexist, type) ++#define ex_halbtc8723d2ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8723d2ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8723d2ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8723d2ant_rf_status_notify(btcoexist, type) ++#define ex_halbtc8723d2ant_halt_notify(btcoexist) ++#define ex_halbtc8723d2ant_pnp_notify(btcoexist, pnp_state) ++#define ex_halbtc8723d2ant_periodical(btcoexist) ++#define ex_halbtc8723d2ant_display_coex_info(btcoexist) ++#define ex_halbtc8723d2ant_set_antenna_notify(btcoexist, type) ++#define ex_halbtc8723d2ant_display_ant_detection(btcoexist) ++#define ex_halbtc8723d2ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) ++#endif ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.c 2018-02-11 21:44:27.147146086 +0200 +@@ -0,0 +1,3457 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8812A Co-exist mechanism ++ * ++ * History ++ * 2012/11/15 Cosa first check in. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8812A_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8812a_1ant glcoex_dm_8812a_1ant; ++static struct coex_dm_8812a_1ant *coex_dm = &glcoex_dm_8812a_1ant; ++static struct coex_sta_8812a_1ant glcoex_sta_8812a_1ant; ++static struct coex_sta_8812a_1ant *coex_sta = &glcoex_sta_8812a_1ant; ++ ++const char *const glbt_info_src_8812a_1ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++u32 glcoex_ver_date_8812a_1ant = 20140708; ++u32 glcoex_ver_8812a_1ant = 0x52; ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8812a1ant_ ++ * ************************************************************ */ ++u8 halbtc8812a1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_bt_rssi_state; ++ } ++ ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8812a1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_wifi_rssi_state[index]; ++ } ++ ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8812a1ant_update_ra_mask(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 dis_rate_mask) ++{ ++ coex_dm->cur_ra_mask = dis_rate_mask; ++ ++ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, ++ &coex_dm->cur_ra_mask); ++ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; ++} ++ ++/* to check 0x430/0x434 is correct?? */ ++void halbtc8812a1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ ++ coex_dm->cur_arfr_type = type; ++ ++ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { ++ switch (coex_dm->cur_arfr_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_4byte(btcoexist, 0x430, ++ coex_dm->backup_arfr_cnt1); ++ btcoexist->btc_write_4byte(btcoexist, 0x434, ++ coex_dm->backup_arfr_cnt2); ++ break; ++ case 1: ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x01010101); ++ } else { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x04030201); ++ } ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; ++} ++ ++/* to check 0x42a ?? */ ++void halbtc8812a1ant_retry_limit(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_retry_limit_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_retry_limit_type != ++ coex_dm->cur_retry_limit_type)) { ++ switch (coex_dm->cur_retry_limit_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ coex_dm->backup_retry_limit); ++ break; ++ case 1: /* retry limit=8 */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ 0x0808); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; ++} ++ ++/* to check 0x456?? */ ++void halbtc8812a1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_ampdu_time_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { ++ switch (coex_dm->cur_ampdu_time_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ coex_dm->backup_ampdu_max_time); ++ break; ++ case 1: /* AMPDU timw = 0x38 * 32us */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ 0x38); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; ++} ++ ++void halbtc8812a1ant_limited_tx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, ++ IN u8 retry_limit_type, IN u8 ampdu_time_type) ++{ ++ switch (ra_mask_type) { ++ case 0: /* normal mode */ ++ halbtc8812a1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0); ++ break; ++ case 1: /* disable cck 1/2 */ ++ halbtc8812a1ant_update_ra_mask(btcoexist, force_exec, ++ 0x00000003); ++ break; ++ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ ++ halbtc8812a1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0001f1f7); ++ break; ++ default: ++ break; ++ } ++ ++ halbtc8812a1ant_auto_rate_fallback_retry(btcoexist, force_exec, ++ arfr_type); ++ halbtc8812a1ant_retry_limit(btcoexist, force_exec, retry_limit_type); ++ halbtc8812a1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); ++} ++ ++void halbtc8812a1ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++ ++ ++} ++ ++void halbtc8812a1ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 data_len = 3; ++ u8 buf[5] = {0}; ++ ++ if (!coex_sta->bt_disabled) { ++ if (!coex_sta->bt_info_query_cnt || ++ (coex_sta->bt_info_c2h_cnt[BT_INFO_SRC_8812A_1ANT_BT_RSP] ++ - coex_sta->bt_info_query_cnt) > 2) { ++ buf[0] = data_len; ++ buf[1] = 0x1; /* polling enable, 1=enable, 0=disable */ ++ buf[2] = 0x2; /* polling time in seconds */ ++ buf[3] = 0x1; /* auto report enable, 1=enable, 0=disable */ ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_INFO, ++ (void *)&buf[0]); ++ } ++ } ++ coex_sta->bt_info_query_cnt++; ++} ++ ++void halbtc8812a1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ static u8 num_of_bt_counter_chk = 0; ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ if ((coex_sta->low_priority_tx > 1150) && ++ (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->pop_event_cnt++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", ++ reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); ++ BTC_TRACE(trace_buf); ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++ ++ if ((reg_hp_tx == 0) && (reg_hp_rx == 0) && (reg_lp_tx == 0) && ++ (reg_lp_rx == 0)) { ++ num_of_bt_counter_chk++; ++ if (num_of_bt_counter_chk >= 3) { ++ halbtc8812a1ant_query_bt_info(btcoexist); ++ num_of_bt_counter_chk = 0; ++ } ++ } ++} ++ ++/* to check registers */ ++void halbtc8812a1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) ++{ ++ s32 wifi_rssi = 0; ++ boolean wifi_busy = false, wifi_under_b_mode = false; ++ static u8 cck_lock_counter = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ if (coex_sta->under_ips) { ++ coex_sta->crc_ok_cck = 0; ++ coex_sta->crc_ok_11g = 0; ++ coex_sta->crc_ok_11n = 0; ++ coex_sta->crc_ok_11n_agg = 0; ++ ++ coex_sta->crc_err_cck = 0; ++ coex_sta->crc_err_11g = 0; ++ coex_sta->crc_err_11n = 0; ++ coex_sta->crc_err_11n_agg = 0; ++ } else { ++ coex_sta->crc_ok_cck = btcoexist->btc_read_2byte(btcoexist, ++ 0xf04); ++ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf14); ++ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf10); ++ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xf40); ++ ++ coex_sta->crc_err_cck = btcoexist->btc_read_2byte(btcoexist, ++ 0xf06); ++ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf16); ++ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf12); ++ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xf42); ++ } ++ ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x0); ++ ++ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { ++ if ((coex_dm->bt_status == BT_8812A_1ANT_BT_STATUS_ACL_BUSY) || ++ (coex_dm->bt_status == ++ BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY) || ++ (coex_dm->bt_status == ++ BT_8812A_1ANT_BT_STATUS_SCO_BUSY)) { ++ if (coex_sta->crc_ok_cck > (coex_sta->crc_ok_11g + ++ coex_sta->crc_ok_11n + ++ coex_sta->crc_ok_11n_agg)) { ++ if (cck_lock_counter < 5) ++ cck_lock_counter++; ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ if (!coex_sta->pre_ccklock) { ++ ++ if (cck_lock_counter >= 5) ++ coex_sta->cck_lock = true; ++ else ++ coex_sta->cck_lock = false; ++ } else { ++ if (cck_lock_counter == 0) ++ coex_sta->cck_lock = false; ++ else ++ coex_sta->cck_lock = true; ++ } ++ ++ coex_sta->pre_ccklock = coex_sta->cck_lock; ++ ++ ++} ++ ++boolean halbtc8812a1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) ++{ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ } ++ ++ return false; ++} ++ ++void halbtc8812a1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if (bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if (!bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++} ++ ++u8 halbtc8812a1ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8812A_1ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (!bt_link_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No BT link exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (bt_link_info->sco_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->hid_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->pan_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 1) { ++ if (bt_link_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_1ANT_COEX_ALGO_SCO; ++ } else { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_1ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_1ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_1ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_1ANT_COEX_ALGO_SCO; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_1ANT_COEX_ALGO_HID_A2DP; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_1ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_1ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_1ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++void halbtc8812a1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8812a1ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ halbtc8812a1ant_set_bt_auto_report(btcoexist, ++ coex_dm->cur_bt_auto_report); ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++/* to check */ ++void halbtc8812a1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++ u8 tmp_u1; ++ ++ tmp_u1 = btcoexist->btc_read_1byte(btcoexist, 0x4fd); ++ tmp_u1 |= BIT(0); ++ if (low_penalty_ra) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Tx rate adaptive, set low penalty!!\n"); ++ BTC_TRACE(trace_buf); ++ tmp_u1 &= ~BIT(2); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Tx rate adaptive, set normal!!\n"); ++ BTC_TRACE(trace_buf); ++ tmp_u1 |= BIT(2); ++ } ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x4fd, tmp_u1); ++} ++ ++void halbtc8812a1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ halbtc8812a1ant_set_sw_penalty_tx_rate_adaptive(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++} ++ ++void halbtc8812a1ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8812a1ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ halbtc8812a1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8812a1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** CoexTable(%d) **********\n", type); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->coex_table_type = type; ++ ++ switch (type) { ++ case 0: ++ halbtc8812a1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x55555555, 0xffffff, 0x3); ++ break; ++ case 1: ++ halbtc8812a1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 2: ++ halbtc8812a1ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 3: ++ halbtc8812a1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 4: ++ halbtc8812a1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3); ++ break; ++ case 5: ++ halbtc8812a1ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0xaa5a5a5a, 0xffffff, 0x3); ++ break; ++ case 6: ++ halbtc8812a1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ case 7: ++ halbtc8812a1ant_coex_table(btcoexist, force_exec, ++ 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8812a1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 data_len = 3; ++ u8 buf[5] = {0}; ++ ++ buf[0] = data_len; ++ buf[1] = 0x1; /* OP_Code */ ++ buf[2] = 0x1; /* OP_Code_Length */ ++ if (enable) ++ buf[3] = 0x1; /* OP_Code_Content */ ++ else ++ buf[3] = 0x0; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, ++ (void *)&buf[0]); ++} ++ ++void halbtc8812a1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ halbtc8812a1ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8812a1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8812a1ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8812a1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8812a1ant_sw_mechanism(IN struct btc_coexist *btcoexist, ++ IN boolean low_penalty_ra) ++{ ++ halbtc8812a1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); ++} ++ ++/* to check force_exec */ ++void halbtc8812a1ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean force_exec, IN boolean init_hwcfg, ++ IN boolean wifi_off) ++{ ++ u8 u8tmp = 0; ++ ++ coex_dm->cur_ant_pos_type = ant_pos_type; ++ ++ if (init_hwcfg) { ++ btcoexist->btc_write_1byte(btcoexist, 0xcb3, 0x77); ++ btcoexist->btc_write_4byte(btcoexist, 0x900, 0x00000400); ++ btcoexist->btc_write_1byte(btcoexist, 0x76d, 0x1); ++ } else if (wifi_off) { ++ btcoexist->btc_write_1byte(btcoexist, 0xcb3, 0x77); ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0xcb7); ++ u8tmp &= ~BIT(3); ++ u8tmp |= BIT(2); ++ btcoexist->btc_write_1byte(btcoexist, 0xcb7, u8tmp); ++ } ++ ++ if (force_exec || ++ (coex_dm->cur_ant_pos_type != coex_dm->pre_ant_pos_type)) { ++ /* ext switch setting */ ++ switch (ant_pos_type) { ++ case BTC_ANT_PATH_WIFI: ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, ++ 0xcb7); ++ u8tmp |= BIT(3); ++ u8tmp &= ~BIT(2); ++ btcoexist->btc_write_1byte(btcoexist, 0xcb7, ++ u8tmp); ++ break; ++ case BTC_ANT_PATH_BT: ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, ++ 0xcb7); ++ u8tmp &= ~BIT(3); ++ u8tmp |= BIT(2); ++ btcoexist->btc_write_1byte(btcoexist, 0xcb7, ++ u8tmp); ++ break; ++ default: ++ case BTC_ANT_PATH_PTA: ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, ++ 0xcb7); ++ u8tmp |= BIT(3); ++ u8tmp &= ~BIT(2); ++ btcoexist->btc_write_1byte(btcoexist, 0xcb7, ++ u8tmp); ++ break; ++ } ++ } ++ ++ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; ++} ++ ++void halbtc8812a1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ u8 real_byte1 = byte1, real_byte5 = byte5; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ if (ap_enable) { ++ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], FW for 1Ant AP mode\n"); ++ BTC_TRACE(trace_buf); ++ real_byte1 &= ~BIT(4); ++ real_byte1 |= BIT(5); ++ ++ real_byte5 |= BIT(5); ++ real_byte5 &= ~BIT(6); ++ } ++ } ++ ++ h2c_parameter[0] = real_byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = real_byte5; ++ ++ coex_dm->ps_tdma_para[0] = real_byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = real_byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++ ++void halbtc8812a1ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_busy = false; ++ u8 rssi_adjust_val = 0; ++ u8 ps_tdma_byte4_val = 0x50, ps_tdma_byte0_val = 0x51, ++ ps_tdma_byte3_val = 0x10; ++ s8 wifi_duration_adjust = 0x0; ++ static boolean pre_wifi_busy = false; ++ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (wifi_busy != pre_wifi_busy) { ++ force_exec = true; ++ pre_wifi_busy = wifi_busy; ++ } ++ ++ if (coex_dm->cur_ps_tdma_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(on, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(off, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ return; ++ } ++ ++ if (coex_sta->scan_ap_num <= 5) ++ wifi_duration_adjust = 2; ++ else if (coex_sta->scan_ap_num >= 40) ++ wifi_duration_adjust = -15; ++ else if (coex_sta->scan_ap_num >= 20) ++ wifi_duration_adjust = -10; ++ ++ if (!coex_sta->force_lps_on) { /* only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 */ ++ ps_tdma_byte0_val = 0x61; /* no null-pkt */ ++ ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */ ++ ps_tdma_byte4_val = 0x10; /* 0x778 = d/1 toggle */ ++ } ++ ++ if ((type == 3) || (type == 13) || (type == 14)) { ++ ps_tdma_byte4_val = ps_tdma_byte4_val & ++ 0xbf; /* no dynamic slot for multi-profile */ ++ ++ if (!wifi_busy) ++ ps_tdma_byte4_val = ps_tdma_byte4_val | ++ 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ ++ } ++ ++ if (bt_link_info->slave_role == true) ++ ps_tdma_byte4_val = ps_tdma_byte4_val | ++ 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ ++ ++ if (turn_on) { ++ switch (type) { ++ default: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x1a, 0x1a, 0x0, ps_tdma_byte4_val); ++ break; ++ case 1: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x3a + ++ wifi_duration_adjust, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 2: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x2d + ++ wifi_duration_adjust, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 3: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x1d, 0x1d, 0x0, ps_tdma_byte4_val); ++ break; ++ case 4: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x15, 0x3, 0x14, 0x0); ++ break; ++ case 5: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x15, 0x3, 0x11, 0x11); ++ break; ++ case 6: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x20, 0x3, 0x11, 0x11); ++ break; ++ case 7: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x13, ++ 0xc, 0x5, 0x0, 0x0); ++ break; ++ case 8: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x25, 0x3, 0x10, 0x0); ++ break; ++ case 9: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x21, 0x3, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 10: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x13, ++ 0xa, 0xa, 0x0, 0x40); ++ break; ++ case 11: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, ++ ps_tdma_byte0_val, 0x21, 0x03, ++ ps_tdma_byte3_val, ps_tdma_byte4_val); ++ break; ++ case 12: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x0a, 0x0a, 0x0, 0x50); ++ break; ++ case 13: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x12, 0x12, 0x0, ps_tdma_byte4_val); ++ break; ++ case 14: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x21, 0x3, 0x10, ps_tdma_byte4_val); ++ break; ++ case 15: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x13, ++ 0xa, 0x3, 0x8, 0x0); ++ break; ++ case 16: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x15, 0x3, 0x10, 0x0); ++ break; ++ case 18: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x25, 0x3, 0x10, 0x0); ++ break; ++ case 20: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x3f, 0x03, 0x11, 0x10); ++ break; ++ case 21: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x25, 0x03, 0x11, 0x11); ++ break; ++ case 22: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x25, 0x03, 0x11, 0x10); ++ break; ++ case 23: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x3, 0x31, 0x18); ++ break; ++ case 24: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x15, 0x3, 0x31, 0x18); ++ break; ++ case 25: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0xa, 0x3, 0x31, 0x18); ++ break; ++ case 26: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0xa, 0x3, 0x31, 0x18); ++ break; ++ case 27: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x3, 0x31, 0x98); ++ break; ++ case 28: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x69, ++ 0x25, 0x3, 0x31, 0x0); ++ break; ++ case 29: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xab, ++ 0x1a, 0x1a, 0x1, 0x10); ++ break; ++ case 30: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x30, 0x3, 0x10, 0x10); ++ break; ++ case 31: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x1a, 0x1a, 0, 0x58); ++ break; ++ case 32: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x35, 0x3, 0x11, 0x11); ++ break; ++ case 33: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xa3, ++ 0x25, 0x3, 0x30, 0x90); ++ break; ++ case 34: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x53, ++ 0x1a, 0x1a, 0x0, 0x10); ++ break; ++ case 35: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x63, ++ 0x1a, 0x1a, 0x0, 0x10); ++ break; ++ case 36: ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x12, 0x3, 0x14, 0x50); ++ break; ++ case 40: /* SoftAP only with no sta associated,BT disable ,TDMA mode for power saving */ ++ /* here softap mode screen off will cost 70-80mA for phone */ ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x23, ++ 0x18, 0x00, 0x10, 0x24); ++ break; ++ } ++ } else { ++ ++ /* disable PS tdma */ ++ switch (type) { ++ case 8: /* PTA Control */ ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x8, ++ 0x0, 0x0, 0x0, 0x0); ++ break; ++ case 0: ++ default: /* Software control, Antenna at BT side */ ++ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x0, 0x0); ++ break; ++ } ++ } ++ rssi_adjust_val = 0; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssi_adjust_val); ++ ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++boolean halbtc8812a1ant_is_common_action(IN struct btc_coexist *btcoexist) ++{ ++ boolean common = false, wifi_connected = false, wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (!wifi_connected && ++ BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else { ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ common = false; ++ } ++ ++ return common; ++} ++ ++ ++void halbtc8812a1ant_tdma_duration_adjust_for_acl(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ static s32 up, dn, m, n, wait_count; ++ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ ++ u8 retry_count = 0, bt_info_ext; ++ boolean wifi_busy = false; ++ ++ if (BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifi_status) ++ wifi_busy = true; ++ else ++ wifi_busy = false; ++ ++ if ((BT_8812A_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == ++ wifi_status) || ++ (BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifi_status) || ++ (BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT == ++ wifi_status)) { ++ if (coex_dm->cur_ps_tdma != 1 && ++ coex_dm->cur_ps_tdma != 2 && ++ coex_dm->cur_ps_tdma != 3 && ++ coex_dm->cur_ps_tdma != 9) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n = 3; ++ result = 0; ++ wait_count = 0; ++ } ++ return; ++ } ++ ++ if (!coex_dm->auto_tdma_adjust) { ++ coex_dm->auto_tdma_adjust = true; ++ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ /* ============ */ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n = 3; ++ result = 0; ++ wait_count = 0; ++ } else { ++ /* accquire the BT TRx retry count from BT_Info byte2 */ ++ retry_count = coex_sta->bt_retry_cnt; ++ bt_info_ext = coex_sta->bt_info_ext; ++ ++ if ((coex_sta->low_priority_tx) > 1150 || ++ (coex_sta->low_priority_rx) > 1250) ++ retry_count++; ++ ++ result = 0; ++ wait_count++; ++ ++ if (retry_count == ++ 0) { /* no retry in the last 2-second duration */ ++ up++; ++ dn--; ++ ++ if (dn <= 0) ++ dn = 0; ++ ++ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ ++ wait_count = 0; ++ n = 3; ++ up = 0; ++ dn = 0; ++ result = 1; ++ } ++ } else if (retry_count <= ++ 3) { /* <=3 retry in the last 2-second duration */ ++ up--; ++ dn++; ++ ++ if (up <= 0) ++ up = 0; ++ ++ if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ ++ if (wait_count <= 2) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ ++ if (wait_count == 1) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ ++ if (result == -1) { ++ if ((BT_INFO_8812A_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && ++ ((coex_dm->cur_ps_tdma == 1) || ++ (coex_dm->cur_ps_tdma == 2))) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } ++ } else if (result == 1) { ++ if ((BT_INFO_8812A_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && ++ ((coex_dm->cur_ps_tdma == 1) || ++ (coex_dm->cur_ps_tdma == 2))) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = 1; ++ } ++ } else { /* no change */ ++ /* Bryant Modify ++ if(wifi_busy != pre_wifi_busy) ++ { ++ pre_wifi_busy = wifi_busy; ++ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, true, coex_dm->cur_ps_tdma); ++ } ++ */ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(on, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if (coex_dm->cur_ps_tdma != 1 && ++ coex_dm->cur_ps_tdma != 2 && ++ coex_dm->cur_ps_tdma != 9 && ++ coex_dm->cur_ps_tdma != 11) { ++ /* recover to previous adjust type */ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ coex_dm->ps_tdma_du_adj_type); ++ } ++ } ++} ++ ++void halbtc8812a1ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++void halbtc8812a1ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ boolean low_pwr_disable = false; ++ ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ /* recover to original 32k low power setting */ ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ case BTC_PS_LPS_ON: ++ halbtc8812a1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8812a1ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ /* when coex force to enter LPS, do not enter 32k low power. */ ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ coex_sta->force_lps_on = true; ++ break; ++ case BTC_PS_LPS_OFF: ++ halbtc8812a1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, false); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8812a1ant_action_wifi_only(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, ++ false, false); ++} ++ ++void halbtc8812a1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ ++ /* This function check if bt is disabled */ ++ ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is enabled !!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ bt_disable_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], bt all counters=0, %d times!!\n", ++ bt_disable_cnt); ++ BTC_TRACE(trace_buf); ++ if (bt_disable_cnt >= 2) { ++ bt_disabled = true; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a1ant_action_wifi_only(btcoexist); ++ } ++ } ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_disabled = bt_disabled; ++ if (!bt_disabled) { ++ } else { ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ } ++ } ++} ++ ++/* ********************************************* ++ * ++ * Software Coex Mechanism start ++ * ++ * ********************************************* */ ++ ++/* SCO only or SCO+PAN(HS) */ ++ ++/* ++void halbtc8812a1ant_action_sco(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8812a1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8812a1ant_action_hid(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8812a1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8812a1ant_action_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8812a1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8812a1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8812a1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8812a1ant_action_pan_edr(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8812a1ant_sw_mechanism(btcoexist, false); ++} ++ ++ ++void halbtc8812a1ant_action_pan_hs(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8812a1ant_sw_mechanism(btcoexist, false); ++} ++ ++ ++void halbtc8812a1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8812a1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8812a1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8812a1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8812a1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8812a1ant_sw_mechanism(btcoexist, true); ++} ++ ++void halbtc8812a1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8812a1ant_sw_mechanism(btcoexist, true); ++} ++ ++*/ ++ ++/* ********************************************* ++ * ++ * Non-Software Coex Mechanism start ++ * ++ * ********************************************* */ ++void halbtc8812a1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, ++ false, false); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8812a1ant_action_hs(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8812a1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, ++ bt_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ if ((!wifi_connected) && (!coex_sta->wifi_is_high_pri_task)) { ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || ++ (bt_link_info->a2dp_exist)) { ++ /* SCO/HID/A2DP busy */ ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if ((bt_link_info->pan_exist) || (wifi_busy)) { ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ } ++} ++ ++void halbtc8812a1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ /* tdma and coex table */ ++ ++ if (bt_link_info->sco_exist) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } else { /* HID */ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } ++} ++ ++void halbtc8812a1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ u8 bt_rssi_state; ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ bt_rssi_state = halbtc8812a1ant_bt_rssi_state(2, 28, 0); ++ ++ if ((coex_sta->low_priority_rx >= 950) && (!coex_sta->under_ips)) ++ bt_link_info->slave_role = true; ++ else ++ bt_link_info->slave_role = false; ++ ++ if (bt_link_info->hid_only) { /* HID */ ++ halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, ++ wifi_status); ++ coex_dm->auto_tdma_adjust = false; ++ return; ++ } else if (bt_link_info->a2dp_only) { /* A2DP */ ++ if (BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } else { ++ halbtc8812a1ant_tdma_duration_adjust_for_acl(btcoexist, ++ wifi_status); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = true; ++ } ++ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || ++ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { /* HID+A2DP */ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); ++ coex_dm->auto_tdma_adjust = false; ++ ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && ++ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } else { ++ /* BT no-profile busy (0x9) */ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } ++} ++ ++void halbtc8812a1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) ++{ ++ /* power save state */ ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, ++ false, false); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8812a1ant_action_wifi_not_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else if (bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 20); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else if ((BT_8812A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ /* Bryant Add */ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8812a1ant_action_wifi_not_connected_asso_auth( ++ IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || ++ (bt_link_info->a2dp_exist)) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); ++ } else if (bt_link_info->pan_exist) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); ++ } else { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); ++ } ++} ++ ++void halbtc8812a1ant_action_wifi_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else if (bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 20); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else if ((BT_8812A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ /* Bryant Add */ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8812a1ant_action_wifi_connected_specific_packet( ++ IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || ++ (bt_link_info->a2dp_exist)) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if (bt_link_info->pan_exist) { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ NORMAL_EXEC, false, false); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8812a1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_busy = false; ++ boolean scan = false, link = false, roam = false; ++ boolean under_4way = false, ap_enable = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ if (under_4way) { ++ halbtc8812a1ant_action_wifi_connected_specific_packet(btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8812a1ant_action_wifi_connected_scan(btcoexist); ++ else ++ halbtc8812a1ant_action_wifi_connected_specific_packet( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ /* power save state */ ++ if (!ap_enable && ++ BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status && ++ !btcoexist->bt_link_info.hid_only) { ++ if (btcoexist->bt_link_info.a2dp_only) { /* A2DP */ ++ if (!wifi_busy) ++ halbtc8812a1ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ else { /* busy */ ++ if (coex_sta->scan_ap_num >= ++ BT_8812A_1ANT_WIFI_NOISY_THRESH) /* no force LPS, no PS-TDMA, use pure TDMA */ ++ halbtc8812a1ant_power_save_state( ++ btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ else ++ halbtc8812a1ant_power_save_state( ++ btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ } else if ((coex_sta->pan_exist == false) && ++ (coex_sta->a2dp_exist == false) && ++ (coex_sta->hid_exist == false)) ++ halbtc8812a1ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ else ++ halbtc8812a1ant_power_save_state(btcoexist, ++ BTC_PS_LPS_ON, 0x50, 0x4); ++ } else ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ ++ /* tdma and coex table */ ++ if (!wifi_busy) { ++ if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8812a1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else if ((BT_8812A_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ halbtc8812a1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); ++ if ((coex_sta->high_priority_tx) + ++ (coex_sta->high_priority_rx) <= 60) ++ halbtc8812a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 2); ++ else ++ halbtc8812a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 7); ++ } ++ } else { ++ if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8812a1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else if ((BT_8812A_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else { ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ halbtc8812a1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); ++ if ((coex_sta->high_priority_tx) + ++ (coex_sta->high_priority_rx) <= 60) ++ halbtc8812a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 2); ++ else ++ halbtc8812a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 7); ++ } ++ } ++} ++ ++void halbtc8812a1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ u8 algorithm = 0; ++ ++ algorithm = halbtc8812a1ant_action_algorithm(btcoexist); ++ coex_dm->cur_algorithm = algorithm; ++ ++ if (halbtc8812a1ant_is_common_action(btcoexist)) { ++ ++ } else { ++ switch (coex_dm->cur_algorithm) { ++ case BT_8812A_1ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8812a1ant_action_sco(btcoexist); */ ++ break; ++ case BT_8812A_1ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8812a1ant_action_hid(btcoexist); */ ++ break; ++ case BT_8812A_1ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8812a1ant_action_a2dp(btcoexist); */ ++ break; ++ case BT_8812A_1ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8812a1ant_action_a2dp_pan_hs(btcoexist); */ ++ break; ++ case BT_8812A_1ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8812a1ant_action_pan_edr(btcoexist); */ ++ break; ++ case BT_8812A_1ANT_COEX_ALGO_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HS mode.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8812a1ant_action_pan_hs(btcoexist); */ ++ break; ++ case BT_8812A_1ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8812a1ant_action_pan_edr_a2dp(btcoexist); */ ++ break; ++ case BT_8812A_1ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8812a1ant_action_pan_edr_hid(btcoexist); */ ++ break; ++ case BT_8812A_1ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8812a1ant_action_hid_a2dp_pan_edr(btcoexist); */ ++ break; ++ case BT_8812A_1ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8812a1ant_action_hid_a2dp(btcoexist); */ ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = coexist All Off!!\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8812a1ant_coex_all_off(btcoexist); */ ++ break; ++ } ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ } ++} ++ ++void halbtc8812a1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ boolean increase_scan_dev_num = false; ++ boolean bt_ctrl_agg_buf_size = false; ++ boolean miracast_plus_bt = false; ++ u8 agg_buf_size = 5; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0, wifi_bw; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if ((BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8812A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ increase_scan_dev_num = true; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, ++ &increase_scan_dev_num); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if ((num_of_wifi_link >= 2) || ++ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", ++ num_of_wifi_link, wifi_link_status); ++ BTC_TRACE(trace_buf); ++ ++ if (bt_link_info->bt_link_exist) { ++ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, ++ 0, 1); ++ miracast_plus_bt = true; ++ } else { ++ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, ++ 0, 0); ++ miracast_plus_bt = false; ++ } ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if ((bt_link_info->a2dp_exist) && ++ (coex_sta->c2h_bt_inquiry_page)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8812a1ant_action_wifi_multi_port(btcoexist); ++ ++ return; ++ } else { ++ miracast_plus_bt = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { ++ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); ++ ++ if (bt_link_info->sco_exist) ++ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, true, ++ false, 0x5); ++ else { ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, ++ false, true, 0x10); ++ else ++ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, ++ false, true, 0x8); ++ } ++ ++ halbtc8812a1ant_sw_mechanism(btcoexist, true); ++ halbtc8812a1ant_run_sw_coexist_mechanism( ++ btcoexist); /* just print debug message */ ++ } else { ++ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ ++ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x5); ++ ++ halbtc8812a1ant_sw_mechanism(btcoexist, false); ++ halbtc8812a1ant_run_sw_coexist_mechanism( ++ btcoexist); /* //just print debug message */ ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8812a1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ ++ if (!wifi_connected) { ++ boolean scan = false, link = false, roam = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is non connected-idle !!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8812a1ant_action_wifi_not_connected_scan( ++ btcoexist); ++ else ++ halbtc8812a1ant_action_wifi_not_connected_asso_auth( ++ btcoexist); ++ } else ++ halbtc8812a1ant_action_wifi_not_connected(btcoexist); ++ } else /* wifi LPS/Busy */ ++ halbtc8812a1ant_action_wifi_connected(btcoexist); ++} ++ ++void halbtc8812a1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ /* force to reset coex mechanism */ ++ ++ /* sw all off */ ++ halbtc8812a1ant_sw_mechanism(btcoexist, false); ++ ++ /* halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ ++ /* halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ ++ ++ coex_sta->pop_event_cnt = 0; ++} ++ ++void halbtc8812a1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean back_up, IN boolean wifi_only) ++{ ++ u8 u8tmp = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 1Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* ant sw control to BT */ ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, ++ true, false); ++ ++ /* 0x790[5:0]=0x5 */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); ++ u8tmp &= 0xc0; ++ u8tmp |= 0x5; ++ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); ++ ++ /* PTA parameter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, 0xffff); ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, 0x55555555); ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, 0x55555555); ++ ++ /* coex parameters */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); ++ ++ /* enable counter statistics */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); ++ ++ /* enable PTA */ ++ btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); ++ ++ /* bt clock related */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x4); ++ u8tmp |= BIT(7); ++ btcoexist->btc_write_1byte(btcoexist, 0x4, u8tmp); ++ ++ /* bt clock related */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x7); ++ u8tmp |= BIT(1); ++ btcoexist->btc_write_1byte(btcoexist, 0x7, u8tmp); ++} ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8812a1ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8812a1ant_ ++ * ************************************************************ */ ++void ex_halbtc8812a1ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++} ++ ++void ex_halbtc8812a1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) ++{ ++} ++ ++void ex_halbtc8812a1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ halbtc8812a1ant_init_hw_config(btcoexist, true, wifi_only); ++ btcoexist->stop_coex_dm = false; ++} ++ ++void ex_halbtc8812a1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = false; ++ ++ halbtc8812a1ant_init_coex_dm(btcoexist); ++ ++ halbtc8812a1ant_query_bt_info(btcoexist); ++} ++ ++void ex_halbtc8812a1ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; ++ u32 u32tmp[4]; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ if (btcoexist->stop_coex_dm) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Coex is STOPPED]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", ++ "Ant PG number/ Ant mechanism:", ++ board_info->pg_ant_num, board_info->btdm_ant_num); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", ++ "CoexVer/ FwVer/ PatchVer", ++ glcoex_ver_date_8812a_1ant, glcoex_ver_8812a_1ant, fw_ver, ++ bt_patch_ver, bt_patch_ver); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") ++ : ((BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi, coex_sta->bt_retry_cnt); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", ++ "SCO/HID/PAN/A2DP", ++ bt_link_info->sco_exist, bt_link_info->hid_exist, ++ bt_link_info->pan_exist, bt_link_info->a2dp_exist); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_BT_LINK_INFO); ++ ++ bt_info_ext = coex_sta->bt_info_ext; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "BT Info A2DP rate", ++ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); ++ CL_PRINTF(cli_buf); ++ ++ for (i = 0; i < BT_INFO_SRC_8812A_1ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8812a_1ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ if (!btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms]============"); ++ CL_PRINTF(cli_buf); ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", ++ "Latest error condition(should be 0)", ++ coex_dm->error_condition); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", ++ "IgnWlanAct", ++ coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ } ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x778", ++ u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcb3); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xcb7); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x900); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0xcb3/0xcb7/0x900", ++ u8tmp[0], u8tmp[1], u32tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", ++ u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x550(bcn ctrl)/0x522", ++ u32tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", ++ u32tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", ++ u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770(hp rx[31:16]/tx[15:0])", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(lp rx[31:16]/tx[15:0])", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++ ++void ex_halbtc8812a1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++ FORCE_EXEC, false, true); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8812a1ant_init_hw_config(btcoexist, false, false); ++ halbtc8812a1ant_init_coex_dm(btcoexist); ++ halbtc8812a1ant_query_bt_info(btcoexist); ++ ++ coex_sta->under_ips = false; ++ } ++} ++ ++void ex_halbtc8812a1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ } ++} ++ ++void ex_halbtc8812a1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_SCAN_START == type) { ++ coex_sta->wifi_is_high_pri_task = true; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, ++ 8); /* Force antenna setup for no scan result issue */ ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ FORCE_EXEC, false, false); ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ } ++ ++ if (coex_sta->bt_disabled) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ halbtc8812a1ant_query_bt_info(btcoexist); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ if (num_of_wifi_link >= 2) { ++ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ halbtc8812a1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8812a1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8812a1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ if (BTC_SCAN_START == type) { ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8812a1ant_action_wifi_not_connected_scan( ++ btcoexist); ++ else /* wifi is connected */ ++ halbtc8812a1ant_action_wifi_connected_scan(btcoexist); ++ } else if (BTC_SCAN_FINISH == type) { ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8812a1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8812a1ant_action_wifi_connected(btcoexist); ++ } ++} ++ ++void ex_halbtc8812a1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ if (BTC_ASSOCIATE_START == type) { ++ coex_sta->wifi_is_high_pri_task = true; ++ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, ++ 8); /* Force antenna setup for no scan result issue */ ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ FORCE_EXEC, false, false); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->arp_cnt = 0; ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ /* coex_dm->arp_cnt = 0; */ ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ if (num_of_wifi_link >= 2) { ++ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ halbtc8812a1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8812a1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8812a1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ if (BTC_ASSOCIATE_START == type) ++ halbtc8812a1ant_action_wifi_not_connected_asso_auth(btcoexist); ++ else if (BTC_ASSOCIATE_FINISH == type) { ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8812a1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8812a1ant_action_wifi_connected(btcoexist); ++ } ++} ++ ++/* to check registers... */ ++void ex_halbtc8812a1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 data_len = 5; ++ u8 buf[6] = {0}; ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ boolean wifi_under_b_mode = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, ++ 8); /* Force antenna setup for no scan result issue */ ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ FORCE_EXEC, false, false); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++#if 0 ++ /* Set CCK Tx/Rx high Pri except 11b mode */ ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x00); /* CCK Rx */ ++ } else { ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x10); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x10); /* CCK Rx */ ++ } ++#endif ++ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, ++ 0x430); ++ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, ++ 0x434); ++ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( ++ btcoexist, 0x42a); ++ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( ++ btcoexist, 0x456); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->arp_cnt = 0; ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ ++ } ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ /* h2c_parameter[0] = 0x1; */ ++ h2c_parameter[0] = 0x0; ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ buf[0] = data_len; ++ buf[1] = 0x5; /* OP_Code */ ++ buf[2] = 0x3; /* OP_Code_Length */ ++ buf[3] = h2c_parameter[0]; /* OP_Code_Content */ ++ buf[4] = h2c_parameter[1]; ++ buf[5] = h2c_parameter[2]; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, ++ (void *)&buf[0]); ++} ++ ++void ex_halbtc8812a1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ if (BTC_PACKET_DHCP == type || ++ BTC_PACKET_EAPOL == type || ++ BTC_PACKET_ARP == type) { ++ if (BTC_PACKET_ARP == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ARP notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_dm->arp_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ARP Packet Count = %d\n", ++ coex_dm->arp_cnt); ++ BTC_TRACE(trace_buf); ++ ++ if (coex_dm->arp_cnt >= ++ 10) /* if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecificPacket(btcoexist) */ ++ coex_sta->wifi_is_high_pri_task = false; ++ else ++ coex_sta->wifi_is_high_pri_task = true; ++ } else { ++ coex_sta->wifi_is_high_pri_task = true; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet DHCP or EAPOL notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet [Type = %d] notify\n", type); ++ BTC_TRACE(trace_buf); ++ } ++ ++ coex_sta->specific_pkt_period_cnt = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ if (num_of_wifi_link >= 2) { ++ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ halbtc8812a1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8812a1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8812a1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ if (BTC_PACKET_DHCP == type || ++ BTC_PACKET_EAPOL == type || ++ ((BTC_PACKET_ARP == type) && (coex_sta->wifi_is_high_pri_task))) ++ halbtc8812a1ant_action_wifi_connected_specific_packet(btcoexist); ++} ++ ++void ex_halbtc8812a1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 bt_info = 0; ++ u8 i, rsp_source = 0; ++ boolean wifi_connected = false; ++ boolean bt_busy = false; ++ ++ coex_sta->c2h_bt_info_req_sent = false; ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8812A_1ANT_MAX) ++ rsp_source = BT_INFO_SRC_8812A_1ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ if (i == 1) ++ bt_info = tmp_buf[i]; ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ if (BT_INFO_SRC_8812A_1ANT_WIFI_FW != rsp_source) { ++ coex_sta->bt_retry_cnt = /* [3:0] */ ++ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; ++ ++ if (coex_sta->bt_retry_cnt >= 1) ++ coex_sta->pop_event_cnt++; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ++ coex_sta->c2h_bt_page = true; ++ else ++ coex_sta->c2h_bt_page = false; ++ ++ coex_sta->bt_rssi = ++ coex_sta->bt_info_c2h[rsp_source][3] * 2 - 90; ++ /* coex_sta->bt_info_c2h[rsp_source][3]*2+10; */ ++ ++ coex_sta->bt_info_ext = ++ coex_sta->bt_info_c2h[rsp_source][4]; ++ ++ coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] ++ & 0x40); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, ++ &coex_sta->bt_tx_rx_mask); ++ if (!coex_sta->bt_tx_rx_mask) { ++ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, ++ 0x3c, 0x15); ++ } ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ if (coex_sta->bt_info_ext & BIT(1)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (wifi_connected) ++ ex_halbtc8812a1ant_media_status_notify( ++ btcoexist, BTC_MEDIA_CONNECT); ++ else ++ ex_halbtc8812a1ant_media_status_notify( ++ btcoexist, BTC_MEDIA_DISCONNECT); ++ } ++ ++ if (coex_sta->bt_info_ext & BIT(3)) { ++ if (!btcoexist->manual_control && ++ !btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a1ant_ignore_wlan_act(btcoexist, ++ FORCE_EXEC, false); ++ } ++ } else { ++ /* BT already NOT ignore Wlan active, do nothing here. */ ++ } ++#if (BT_AUTO_REPORT_ONLY_8812A_1ANT == 0) ++ if ((coex_sta->bt_info_ext & BIT(4))) { ++ /* BT auto report already enabled, do nothing */ ++ } else ++ halbtc8812a1ant_bt_auto_report(btcoexist, FORCE_EXEC, ++ true); ++#endif ++ } ++ ++ /* check BIT2 first ==> check if bt is under inquiry or page scan */ ++ if (bt_info & BT_INFO_8812A_1ANT_B_INQ_PAGE) ++ coex_sta->c2h_bt_inquiry_page = true; ++ else ++ coex_sta->c2h_bt_inquiry_page = false; ++ ++ /* set link exist status */ ++ if (!(bt_info & BT_INFO_8812A_1ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (bt_info & BT_INFO_8812A_1ANT_B_FTP) ++ coex_sta->pan_exist = true; ++ else ++ coex_sta->pan_exist = false; ++ if (bt_info & BT_INFO_8812A_1ANT_B_A2DP) ++ coex_sta->a2dp_exist = true; ++ else ++ coex_sta->a2dp_exist = false; ++ if (bt_info & BT_INFO_8812A_1ANT_B_HID) ++ coex_sta->hid_exist = true; ++ else ++ coex_sta->hid_exist = false; ++ if (bt_info & BT_INFO_8812A_1ANT_B_SCO_ESCO) ++ coex_sta->sco_exist = true; ++ else ++ coex_sta->sco_exist = false; ++ } ++ ++ halbtc8812a1ant_update_bt_link_info(btcoexist); ++ ++ bt_info = bt_info & ++ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ ++ ++ if (!(bt_info & BT_INFO_8812A_1ANT_B_CONNECTION)) { ++ coex_dm->bt_status = BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info == ++ BT_INFO_8812A_1ANT_B_CONNECTION) { /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if ((bt_info & BT_INFO_8812A_1ANT_B_SCO_ESCO) || ++ (bt_info & BT_INFO_8812A_1ANT_B_SCO_BUSY)) { ++ coex_dm->bt_status = BT_8812A_1ANT_BT_STATUS_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info & BT_INFO_8812A_1ANT_B_ACL_BUSY) { ++ if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) ++ coex_dm->auto_tdma_adjust = false; ++ coex_dm->bt_status = BT_8812A_1ANT_BT_STATUS_ACL_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ coex_dm->bt_status = BT_8812A_1ANT_BT_STATUS_MAX; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if ((BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8812A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ bt_busy = true; ++ else ++ bt_busy = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ halbtc8812a1ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8812a1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_RF_ON == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned ON!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->stop_coex_dm = false; ++ } else if (BTC_RF_OFF == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned OFF!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++ FORCE_EXEC, false, true); ++ ++ halbtc8812a1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ btcoexist->stop_coex_dm = true; ++ } ++} ++ ++void ex_halbtc8812a1ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, ++ false, true); ++ ++ halbtc8812a1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ++ ex_halbtc8812a1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++ ++ btcoexist->stop_coex_dm = true; ++} ++ ++void ex_halbtc8812a1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_WIFI_PNP_SLEEP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, ++ FORCE_EXEC, false, true); ++ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ ++ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ ++ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ ++ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ ++ coex_sta->under_ips = false; ++ coex_sta->under_lps = false; ++ btcoexist->stop_coex_dm = true; ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->stop_coex_dm = false; ++ halbtc8812a1ant_init_hw_config(btcoexist, false, false); ++ halbtc8812a1ant_init_coex_dm(btcoexist); ++ halbtc8812a1ant_query_bt_info(btcoexist); ++ } ++} ++ ++void ex_halbtc8812a1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], *****************Coex DM Reset*****************\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8812a1ant_init_hw_config(btcoexist, false, false); ++ halbtc8812a1ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8812a1ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++#if (BT_AUTO_REPORT_ONLY_8812A_1ANT == 0) ++ halbtc8812a1ant_query_bt_info(btcoexist); ++ halbtc8812a1ant_monitor_bt_enable_disable(btcoexist); ++#else ++ halbtc8812a1ant_monitor_bt_ctr(btcoexist); ++ halbtc8812a1ant_monitor_wifi_ctr(btcoexist); ++ ++ if (halbtc8812a1ant_is_wifi_status_changed(btcoexist) || ++ coex_dm->auto_tdma_adjust) ++ halbtc8812a1ant_run_coexist_mechanism(btcoexist); ++ ++ coex_sta->specific_pkt_period_cnt++; ++#endif ++} ++ ++void ex_halbtc8812a1ant_dbg_control(IN struct btc_coexist *btcoexist, ++ IN u8 op_code, IN u8 op_len, IN u8 *pdata) ++{ ++ switch (op_code) { ++ case BTC_DBG_SET_COEX_NORMAL: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set CoexMode to Normal\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->manual_control = false; ++ halbtc8812a1ant_init_coex_dm(btcoexist); ++ break; ++ case BTC_DBG_SET_COEX_WIFI_ONLY: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set CoexMode to Wifi Only\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->manual_control = true; ++ halbtc8812a1ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 9); ++ break; ++ case BTC_DBG_SET_COEX_BT_ONLY: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set CoexMode to BT only\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->manual_control = true; ++ halbtc8812a1ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); ++ break; ++ case BTC_DBG_SET_COEX_DEC_BT_PWR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set Dec BT power\n"); ++ BTC_TRACE(trace_buf); ++ { ++ u8 data_len = 4; ++ u8 buf[6] = {0}; ++ u8 dec_bt_pwr = 0, pwr_level = 0; ++ if (op_len == 2) { ++ dec_bt_pwr = pdata[0]; ++ pwr_level = pdata[1]; ++ ++ buf[0] = data_len; ++ buf[1] = 0x3; /* OP_Code */ ++ buf[2] = 0x2; /* OP_Code_Length */ ++ ++ buf[3] = dec_bt_pwr; /* OP_Code_Content */ ++ buf[4] = pwr_level; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set Dec BT power=%d, pwr_level=%d\n", ++ dec_bt_pwr, pwr_level); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_CTRL_BT_COEX, ++ (void *)&buf[0]); ++ } ++ } ++ break; ++ ++ case BTC_DBG_SET_COEX_BT_AFH_MAP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set BT AFH Map\n"); ++ BTC_TRACE(trace_buf); ++ { ++ u8 data_len = 5; ++ u8 buf[6] = {0}; ++ if (op_len == 3) { ++ buf[0] = data_len; ++ buf[1] = 0x5; /* OP_Code */ ++ buf[2] = 0x3; /* OP_Code_Length */ ++ ++ buf[3] = pdata[0]; /* OP_Code_Content */ ++ buf[4] = pdata[1]; ++ buf[5] = pdata[2]; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set BT AFH Map = %02x %02x %02x\n", ++ pdata[0], pdata[1], pdata[2]); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_CTRL_BT_COEX, ++ (void *)&buf[0]); ++ } ++ } ++ break; ++ ++ case BTC_DBG_SET_COEX_BT_IGNORE_WLAN_ACT: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set BT Ignore Wlan Active\n"); ++ BTC_TRACE(trace_buf); ++ { ++ u8 data_len = 3; ++ u8 buf[6] = {0}; ++ if (op_len == 1) { ++ buf[0] = data_len; ++ buf[1] = 0x1; /* OP_Code */ ++ buf[2] = 0x1; /* OP_Code_Length */ ++ ++ buf[3] = pdata[0]; /* OP_Code_Content */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set BT Ignore Wlan Active = 0x%x\n", ++ pdata[0]); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_CTRL_BT_COEX, ++ (void *)&buf[0]); ++ } ++ } ++ break; ++ default: ++ break; ++ } ++} ++ ++#endif ++ ++#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ +\ Ingen nyrad vid filslut +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.h 2018-02-11 21:44:27.147146086 +0200 +@@ -0,0 +1,230 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8812A_SUPPORT == 1) ++ ++/* ******************************************* ++ * The following is for 8812A 1ANT BT Co-exist definition ++ * ******************************************* */ ++#define BT_AUTO_REPORT_ONLY_8812A_1ANT 1 ++ ++#define BT_INFO_8812A_1ANT_B_FTP BIT(7) ++#define BT_INFO_8812A_1ANT_B_A2DP BIT(6) ++#define BT_INFO_8812A_1ANT_B_HID BIT(5) ++#define BT_INFO_8812A_1ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8812A_1ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8812A_1ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8812A_1ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8812A_1ANT_B_CONNECTION BIT(0) ++ ++#define BT_INFO_8812A_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ ++ (((_BT_INFO_EXT_&BIT(0))) ? true : false) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT 2 ++ ++#define BT_8812A_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ ++ ++enum bt_info_src_8812a_1ant { ++ BT_INFO_SRC_8812A_1ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8812A_1ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8812A_1ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8812A_1ANT_MAX ++}; ++ ++enum bt_8812a_1ant_bt_status { ++ BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8812A_1ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8812A_1ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8812A_1ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8812A_1ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8812a_1ant_wifi_status { ++ BT_8812A_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8812A_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, ++ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, ++ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, ++ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, ++ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, ++ BT_8812A_1ANT_WIFI_STATUS_MAX ++}; ++ ++enum bt_8812a_1ant_coex_algo { ++ BT_8812A_1ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8812A_1ANT_COEX_ALGO_SCO = 0x1, ++ BT_8812A_1ANT_COEX_ALGO_HID = 0x2, ++ BT_8812A_1ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8812A_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, ++ BT_8812A_1ANT_COEX_ALGO_PANEDR = 0x5, ++ BT_8812A_1ANT_COEX_ALGO_PANHS = 0x6, ++ BT_8812A_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, ++ BT_8812A_1ANT_COEX_ALGO_PANEDR_HID = 0x8, ++ BT_8812A_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, ++ BT_8812A_1ANT_COEX_ALGO_HID_A2DP = 0xa, ++ BT_8812A_1ANT_COEX_ALGO_MAX = 0xb, ++}; ++ ++struct coex_dm_8812a_1ant { ++ /* hw setting */ ++ u8 pre_ant_pos_type; ++ u8 cur_ant_pos_type; ++ /* fw mechanism */ ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean auto_tdma_adjust; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++ ++ /* sw mechanism */ ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ boolean limited_dig; ++ ++ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ ++ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ ++ u16 backup_retry_limit; ++ u8 backup_ampdu_max_time; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ u32 pre_ra_mask; ++ u32 cur_ra_mask; ++ u8 pre_arfr_type; ++ u8 cur_arfr_type; ++ u8 pre_retry_limit_type; ++ u8 cur_retry_limit_type; ++ u8 pre_ampdu_time_type; ++ u8 cur_ampdu_time_type; ++ u32 arp_cnt; ++ ++ u8 error_condition; ++}; ++ ++struct coex_sta_8812a_1ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 specific_pkt_period_cnt; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ s8 bt_rssi; ++ boolean bt_tx_rx_mask; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ boolean c2h_bt_info_req_sent; ++ u8 bt_info_c2h[BT_INFO_SRC_8812A_1ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8812A_1ANT_MAX]; ++ u32 bt_info_query_cnt; ++ boolean c2h_bt_inquiry_page; ++ boolean c2h_bt_page; /* Add for win8.1 page out issue */ ++ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++ u32 pop_event_cnt; ++ u8 scan_ap_num; ++ ++ u32 crc_ok_cck; ++ u32 crc_ok_11g; ++ u32 crc_ok_11n; ++ u32 crc_ok_11n_agg; ++ ++ u32 crc_err_cck; ++ u32 crc_err_11g; ++ u32 crc_err_11n; ++ u32 crc_err_11n_agg; ++ ++ boolean cck_lock; ++ boolean pre_ccklock; ++ u8 coex_table_type; ++ ++ boolean force_lps_on; ++}; ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8812a1ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8812a1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); ++void ex_halbtc8812a1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8812a1ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8812a1ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8812a1ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8812a1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8812a1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8812a1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8812a1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8812a1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8812a1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8812a1ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8812a1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state); ++void ex_halbtc8812a1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); ++void ex_halbtc8812a1ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8812a1ant_dbg_control(IN struct btc_coexist *btcoexist, ++ IN u8 op_code, IN u8 op_len, IN u8 *pdata); ++void ex_halbtc8812a1ant_display_coex_info(IN struct btc_coexist *btcoexist); ++ ++#else ++#define ex_halbtc8812a1ant_power_on_setting(btcoexist) ++#define ex_halbtc8812a1ant_pre_load_firmware(btcoexist) ++#define ex_halbtc8812a1ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8812a1ant_init_coex_dm(btcoexist) ++#define ex_halbtc8812a1ant_ips_notify(btcoexist, type) ++#define ex_halbtc8812a1ant_lps_notify(btcoexist, type) ++#define ex_halbtc8812a1ant_scan_notify(btcoexist, type) ++#define ex_halbtc8812a1ant_connect_notify(btcoexist, type) ++#define ex_halbtc8812a1ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8812a1ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8812a1ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8812a1ant_rf_status_notify(btcoexist, type) ++#define ex_halbtc8812a1ant_halt_notify(btcoexist) ++#define ex_halbtc8812a1ant_pnp_notify(btcoexist, pnp_state) ++#define ex_halbtc8812a1ant_coex_dm_reset(btcoexist) ++#define ex_halbtc8812a1ant_periodical(btcoexist) ++#define ex_halbtc8812a1ant_dbg_control(btcoexist, op_code, op_len, pdata) ++#define ex_halbtc8812a1ant_display_coex_info(btcoexist) ++ ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.c 2018-02-11 21:44:27.147146086 +0200 +@@ -0,0 +1,4782 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8812A Co-exist mechanism ++ * ++ * History ++ * 2012/08/22 Cosa first check in. ++ * 2012/11/14 Cosa Revise for 8812A 2Ant out sourcing. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8812A_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8812a_2ant glcoex_dm_8812a_2ant; ++static struct coex_dm_8812a_2ant *coex_dm = &glcoex_dm_8812a_2ant; ++static struct coex_sta_8812a_2ant glcoex_sta_8812a_2ant; ++static struct coex_sta_8812a_2ant *coex_sta = &glcoex_sta_8812a_2ant; ++ ++const char *const glbt_info_src_8812a_2ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++u32 glcoex_ver_date_8812a_2ant = 20150724; ++u32 glcoex_ver_8812a_2ant = 0x37; ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8812a2ant_ ++ * ************************************************************ */ ++u8 halbtc8812a2ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_bt_rssi_state; ++ } ++ ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8812a2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_wifi_rssi_state[index]; ++ } ++ ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8812a2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_stack_info *stack_info = &btcoexist->stack_info; ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ ++ /* This function check if bt is disabled */ ++ ++ /* only 8812a need to consider if core stack is installed. */ ++ if (!stack_info->hci_version) ++ bt_active = false; ++ ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is enabled !!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ bt_disable_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], bt is detected as disabled %d times!!\n", ++ bt_disable_cnt); ++ BTC_TRACE(trace_buf); ++ if (bt_disable_cnt >= 2) { ++ bt_disabled = true; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_disabled = bt_disabled; ++ if (!bt_disabled) { ++ } else { ++ } ++ } ++} ++ ++u32 halbtc8812a2ant_decide_ra_mask(IN struct btc_coexist *btcoexist, ++ IN u32 ra_mask_type) ++{ ++ u32 dis_ra_mask = 0x0; ++ ++ switch (ra_mask_type) { ++ case 0: /* normal mode */ ++ dis_ra_mask = 0x0; ++ break; ++ case 1: /* disable cck 1/2 */ ++ dis_ra_mask = 0x00000003; ++ break; ++ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ ++ dis_ra_mask = 0x0001f1f7; ++ break; ++ default: ++ break; ++ } ++ ++ return dis_ra_mask; ++} ++ ++void halbtc8812a2ant_update_ra_mask(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 dis_rate_mask) ++{ ++ coex_dm->cur_ra_mask = dis_rate_mask; ++ ++ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, ++ &coex_dm->cur_ra_mask); ++ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; ++} ++ ++void halbtc8812a2ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ ++ coex_dm->cur_arfr_type = type; ++ ++ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { ++ switch (coex_dm->cur_arfr_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_4byte(btcoexist, 0x430, ++ coex_dm->backup_arfr_cnt1); ++ btcoexist->btc_write_4byte(btcoexist, 0x434, ++ coex_dm->backup_arfr_cnt2); ++ break; ++ case 1: ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x01010101); ++ } else { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x04030201); ++ } ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; ++} ++ ++void halbtc8812a2ant_retry_limit(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_retry_limit_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_retry_limit_type != ++ coex_dm->cur_retry_limit_type)) { ++ switch (coex_dm->cur_retry_limit_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ coex_dm->backup_retry_limit); ++ break; ++ case 1: /* retry limit=8 */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ 0x0808); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; ++} ++ ++void halbtc8812a2ant_ampdu_max_time(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_ampdu_time_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { ++ switch (coex_dm->cur_ampdu_time_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ coex_dm->backup_ampdu_max_time); ++ break; ++ case 1: /* AMPDU timw = 0x38 * 32us */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ 0x38); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; ++} ++ ++void halbtc8812a2ant_limited_tx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, ++ IN u8 retry_limit_type, IN u8 ampdu_time_type) ++{ ++ u32 dis_ra_mask = 0x0; ++ ++ coex_dm->cur_ra_mask_type = ra_mask_type; ++ dis_ra_mask = halbtc8812a2ant_decide_ra_mask(btcoexist, ra_mask_type); ++ halbtc8812a2ant_update_ra_mask(btcoexist, force_exec, dis_ra_mask); ++ ++ halbtc8812a2ant_auto_rate_fallback_retry(btcoexist, force_exec, ++ arfr_type); ++ halbtc8812a2ant_retry_limit(btcoexist, force_exec, retry_limit_type); ++ halbtc8812a2ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); ++} ++ ++void halbtc8812a2ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++ ++ ++} ++ ++void halbtc8812a2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ reg_hp_txrx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx); ++ BTC_TRACE(trace_buf); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ reg_lp_txrx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx); ++ BTC_TRACE(trace_buf); ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++} ++ ++void halbtc8812a2ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 data_len = 3; ++ u8 buf[5] = {0}; ++ ++ if (!coex_sta->bt_disabled) { ++ if (!coex_sta->bt_info_query_cnt || ++ (coex_sta->bt_info_c2h_cnt[BT_INFO_SRC_8812A_2ANT_BT_RSP] ++ - coex_sta->bt_info_query_cnt) > 2) { ++ buf[0] = data_len; ++ buf[1] = 0x1; /* polling enable, 1=enable, 0=disable */ ++ buf[2] = 0x2; /* polling time in seconds */ ++ buf[3] = 0x1; /* auto report enable, 1=enable, 0=disable */ ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_INFO, ++ (void *)&buf[0]); ++ } ++ } ++ coex_sta->bt_info_query_cnt++; ++} ++ ++boolean halbtc8812a2ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) ++{ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ } ++ ++ return false; ++} ++ ++void halbtc8812a2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ bt_link_info->acl_busy = coex_sta->acl_busy; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if (bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if (!bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++} ++ ++u8 halbtc8812a2ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ struct btc_stack_info *stack_info = &btcoexist->stack_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8812A_2ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (!bt_link_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No BT link exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (bt_link_info->sco_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->hid_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->pan_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 0) { ++ if (bt_link_info->acl_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ACL Busy only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR; ++ } ++ } else if (num_of_diff_profile == 1) { ++ if (bt_link_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO; ++ } else { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_2ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_2ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ if (stack_info->num_of_hid >= 2) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID*2 + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_HID_A2DP; ++ } ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_SCO_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_SCO_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++void halbtc8812a2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, ++ IN u8 dac_swing_lvl) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ /* There are several type of dacswing */ ++ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ ++ h2c_parameter[0] = dac_swing_lvl; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); ++} ++ ++void halbtc8812a2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN u8 dec_bt_pwr_lvl) ++{ ++ u8 data_len = 4; ++ u8 buf[6] = {0}; ++ ++ buf[0] = data_len; ++ buf[1] = 0x3; /* OP_Code */ ++ buf[2] = 0x2; /* OP_Code_Length */ ++ if (dec_bt_pwr_lvl) ++ buf[3] = 0x1; /* OP_Code_Content */ ++ else ++ buf[3] = 0x0; ++ buf[4] = dec_bt_pwr_lvl;/* pwr_level */ ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, ++ (void *)&buf[0]); ++} ++ ++void halbtc8812a2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 dec_bt_pwr_lvl) ++{ ++ coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) ++ return; ++ } ++ halbtc8812a2ant_set_fw_dec_bt_pwr(btcoexist, ++ coex_dm->cur_bt_dec_pwr_lvl); ++ ++ coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; ++} ++ ++void halbtc8812a2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 fw_dac_swing_lvl) ++{ ++ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_fw_dac_swing_lvl == ++ coex_dm->cur_fw_dac_swing_lvl) ++ return; ++ } ++ ++ halbtc8812a2ant_set_fw_dac_swing_level(btcoexist, ++ coex_dm->cur_fw_dac_swing_lvl); ++ ++ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; ++} ++ ++void halbtc8812a2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist *btcoexist, ++ IN boolean rx_rf_shrink_on) ++{ ++ if (rx_rf_shrink_on) { ++ /* Shrink RF Rx LPF corner */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Shrink RF Rx LPF corner!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff, ++ 0xffffc); ++ } else { ++ /* Resume RF Rx LPF corner */ ++ /* After initialized, we can use coex_dm->bt_rf_0x1e_backup */ ++ if (btcoexist->initilized) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Resume RF Rx LPF corner!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, ++ 0xfffff, coex_dm->bt_rf_0x1e_backup); ++ } ++ } ++} ++ ++void halbtc8812a2ant_rf_shrink(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rx_rf_shrink_on) ++{ ++ coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_rf_rx_lpf_shrink == ++ coex_dm->cur_rf_rx_lpf_shrink) ++ return; ++ } ++ halbtc8812a2ant_set_sw_rf_rx_lpf_corner(btcoexist, ++ coex_dm->cur_rf_rx_lpf_shrink); ++ ++ coex_dm->pre_rf_rx_lpf_shrink = coex_dm->cur_rf_rx_lpf_shrink; ++} ++ ++void halbtc8812a2ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++ u8 tmp_u1; ++ ++ tmp_u1 = btcoexist->btc_read_1byte(btcoexist, 0x4fd); ++ tmp_u1 |= BIT(0); ++ if (low_penalty_ra) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Tx rate adaptive, set low penalty!!\n"); ++ BTC_TRACE(trace_buf); ++ tmp_u1 &= ~BIT(2); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Tx rate adaptive, set normal!!\n"); ++ BTC_TRACE(trace_buf); ++ tmp_u1 |= BIT(2); ++ } ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x4fd, tmp_u1); ++} ++ ++void halbtc8812a2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++ return; ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ halbtc8812a2ant_set_sw_penalty_tx_rate_adaptive(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++} ++ ++void halbtc8812a2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, ++ IN u32 level) ++{ ++ u8 val = (u8)level; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Write SwDacSwing = 0x%x\n", level); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc5b, 0x3e, val); ++} ++ ++void halbtc8812a2ant_set_sw_full_time_dac_swing(IN struct btc_coexist ++ *btcoexist, IN boolean sw_dac_swing_on, IN u32 sw_dac_swing_lvl) ++{ ++ if (sw_dac_swing_on) ++ halbtc8812a2ant_set_dac_swing_reg(btcoexist, sw_dac_swing_lvl); ++ else ++ halbtc8812a2ant_set_dac_swing_reg(btcoexist, 0x18); ++} ++ ++ ++void halbtc8812a2ant_dac_swing(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) ++{ ++ coex_dm->cur_dac_swing_on = dac_swing_on; ++ coex_dm->cur_dac_swing_lvl = dac_swing_lvl; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_dac_swing_on == coex_dm->cur_dac_swing_on) && ++ (coex_dm->pre_dac_swing_lvl == ++ coex_dm->cur_dac_swing_lvl)) ++ return; ++ } ++ delay_ms(30); ++ halbtc8812a2ant_set_sw_full_time_dac_swing(btcoexist, dac_swing_on, ++ dac_swing_lvl); ++ ++ coex_dm->pre_dac_swing_on = coex_dm->cur_dac_swing_on; ++ coex_dm->pre_dac_swing_lvl = coex_dm->cur_dac_swing_lvl; ++} ++ ++void halbtc8812a2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, ++ IN boolean adc_back_off) ++{ ++ if (adc_back_off) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB BackOff Level On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x3); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB BackOff Level Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x1); ++ } ++} ++ ++void halbtc8812a2ant_adc_back_off(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean adc_back_off) ++{ ++ coex_dm->cur_adc_back_off = adc_back_off; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) ++ return; ++ } ++ halbtc8812a2ant_set_adc_back_off(btcoexist, coex_dm->cur_adc_back_off); ++ ++ coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; ++} ++ ++void halbtc8812a2ant_set_agc_table(IN struct btc_coexist *btcoexist, ++ IN boolean agc_table_en) ++{ ++ u8 rssi_adjust_val = 0; ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); ++ if (agc_table_en) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Agc Table On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x28F4B); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x10AB2); ++ rssi_adjust_val = 8; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Agc Table Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x2884B); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x104B2); ++ } ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); ++ ++ /* set rssi_adjust_val for wifi module. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, ++ &rssi_adjust_val); ++} ++ ++void halbtc8812a2ant_agc_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean agc_table_en) ++{ ++ coex_dm->cur_agc_table_en = agc_table_en; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) ++ return; ++ } ++ halbtc8812a2ant_set_agc_table(btcoexist, agc_table_en); ++ ++ coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; ++} ++ ++void halbtc8812a2ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8812a2ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ halbtc8812a2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8812a2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ switch (type) { ++ case 0: ++ halbtc8812a2ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 1: ++ halbtc8812a2ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 2: ++ halbtc8812a2ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5ffb5ffb, 0xffffff, 0x3); ++ break; ++ case 3: ++ halbtc8812a2ant_coex_table(btcoexist, force_exec, ++ 0x5fdf5fdf, 0x5fdb5fdb, 0xffffff, 0x3); ++ break; ++ case 4: ++ halbtc8812a2ant_coex_table(btcoexist, force_exec, ++ 0xdfffdfff, 0x5fdb5fdb, 0xffffff, 0x3); ++ break; ++ case 5: ++ halbtc8812a2ant_coex_table(btcoexist, force_exec, ++ 0x5ddd5ddd, 0x5fdb5fdb, 0xffffff, 0x3); ++ break; ++ ++ default: ++ break; ++ } ++} ++ ++void halbtc8812a2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 data_len = 3; ++ u8 buf[5] = {0}; ++ ++ buf[0] = data_len; ++ buf[1] = 0x1; /* OP_Code */ ++ buf[2] = 0x1; /* OP_Code_Length */ ++ if (enable) ++ buf[3] = 0x1; /* OP_Code_Content */ ++ else ++ buf[3] = 0x0; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, ++ (void *)&buf[0]); ++} ++ ++void halbtc8812a2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ halbtc8812a2ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8812a2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ u8 real_byte1 = byte1, real_byte5 = byte5; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ if (ap_enable) { ++ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], FW for 1Ant AP mode\n"); ++ BTC_TRACE(trace_buf); ++ real_byte1 &= ~BIT(4); ++ real_byte1 |= BIT(5); ++ ++ real_byte5 |= BIT(5); ++ real_byte5 &= ~BIT(6); ++ } ++ } ++ ++ h2c_parameter[0] = real_byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = real_byte5; ++ ++ ++ coex_dm->ps_tdma_para[0] = real_byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = real_byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++void halbtc8812a2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8812a2ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8812a2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8812a2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, ++ IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, ++ IN boolean limited_dig, IN boolean bt_lna_constrain) ++{ ++ /* ++ u32 wifi_bw; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if(BTC_WIFI_BW_HT40 != wifi_bw) ++ { ++ if (shrink_rx_lpf) ++ shrink_rx_lpf = false; ++ } ++ */ ++ ++ halbtc8812a2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); ++ /* halbtc8812a2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); */ ++} ++ ++void halbtc8812a2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, ++ IN boolean agc_table_shift, IN boolean adc_back_off, ++ IN boolean sw_dac_swing, IN u32 dac_swing_lvl) ++{ ++ /* halbtc8812a2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ ++ halbtc8812a2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); ++ halbtc8812a2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, ++ dac_swing_lvl); ++} ++ ++void halbtc8812a2ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) ++{ ++ u8 u8tmp = 0; ++ ++ if (init_hwcfg) { ++ btcoexist->btc_write_4byte(btcoexist, 0x900, 0x00000400); ++ btcoexist->btc_write_1byte(btcoexist, 0x76d, 0x1); ++ } else if (wifi_off) { ++ ++ } ++ ++ /* ext switch setting */ ++ switch (ant_pos_type) { ++ case BTC_ANT_WIFI_AT_CPL_MAIN: ++ break; ++ case BTC_ANT_WIFI_AT_CPL_AUX: ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0xcb7); ++ u8tmp &= ~BIT(3); ++ u8tmp |= BIT(2); ++ btcoexist->btc_write_1byte(btcoexist, 0xcb7, u8tmp); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8812a2ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ return; ++ } ++ if (turn_on) { ++ switch (type) { ++ case 1: ++ default: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1a, 0x1a, 0xa1, 0x90); ++ break; ++ case 2: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x12, 0x12, 0xa1, 0x90); ++ break; ++ case 3: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0xb1, 0x90); ++ break; ++ case 4: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x10, 0x3, 0xb1, 0x90); ++ break; ++ case 5: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1a, 0x1a, 0x21, 0x10); ++ break; ++ case 6: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x12, 0x12, 0x21, 0x10); ++ break; ++ case 7: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0x21, 0x10); ++ break; ++ case 8: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x10, 0x3, 0x21, 0x10); ++ break; ++ case 9: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1a, 0x1a, 0xa1, 0x10); ++ break; ++ case 10: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x12, 0x12, 0xa1, 0x10); ++ break; ++ case 11: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0xb1, 0x10); ++ break; ++ case 12: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x10, 0x3, 0xb1, 0x10); ++ break; ++ case 13: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1a, 0x1a, 0x21, 0x10); ++ break; ++ case 14: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x12, 0x12, 0x21, 0x10); ++ break; ++ case 15: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0x21, 0x10); ++ break; ++ case 16: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x10, 0x3, 0x21, 0x10); ++ break; ++ case 17: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x35, 0x3, 0xb1, 0x11); ++ break; ++ case 18: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x5, 0x5, 0xe1, 0x90); ++ break; ++ case 19: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x25, 0xe1, 0x90); ++ break; ++ case 20: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x25, 0x60, 0x90); ++ break; ++ case 21: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x15, 0x3, 0x70, 0x90); ++ break; ++ case 22: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x1a, 0x1a, 0x21, 0x10); ++ break; ++ case 23: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x03, 0x31, 0x10); ++ break; ++ ++ case 71: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1a, 0x1a, 0xe1, 0x90); ++ break; ++ ++ /* following cases is for wifi rssi low, started from 81 */ ++ case 81: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x3a, 0x3, 0x90, 0x50); ++ break; ++ case 82: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x2b, 0x3, 0x90, 0x50); ++ break; ++ case 83: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x21, 0x3, 0x90, 0x50); ++ break; ++ case 84: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x15, 0x3, 0x90, 0x50); ++ break; ++ case 85: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x1d, 0x1d, 0x80, 0x50); ++ break; ++ case 86: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x15, 0x15, 0x80, 0x50); ++ break; ++ } ++ } else { ++ /* disable PS tdma */ ++ switch (type) { ++ case 0: /* ANT2PTA, 0x778=0x1 */ ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x8, ++ 0x0, 0x0, 0x0, 0x0); ++ break; ++ case 1: /* ANT2BT, 0x778=3 */ ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x8, 0x0); ++ delay_ms(5); ++ halbtc8812a2ant_set_ant_path(btcoexist, ++ BTC_ANT_WIFI_AT_CPL_AUX, false, false); ++ break; ++ default: ++ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x0, 0x0); ++ break; ++ } ++ } ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++void halbtc8812a2ant_coex_all_off(IN struct btc_coexist *btcoexist) ++{ ++ /* fw all off */ ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ /* hw all off */ ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8812a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ /* force to reset coex mechanism */ ++ ++ halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); ++ ++ halbtc8812a2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++void halbtc8812a2ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++void halbtc8812a2ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN boolean low_pwr_disable, IN u8 lps_val, ++ IN u8 rpwm_val) ++{ ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ break; ++ case BTC_PS_LPS_ON: ++ halbtc8812a2ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8812a2ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8812a2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, ++ 0x0, 0x0); ++ ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++boolean halbtc8812a2ant_is_common_action(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean common = false, wifi_connected = false, wifi_busy = false; ++ boolean bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under inquiry/page scan !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_bt_inquiry(btcoexist); ++ return true; ++ } ++ ++ if (bt_link_info->sco_exist || bt_link_info->hid_exist) ++ halbtc8812a2ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 0, 0, 0); ++ else ++ halbtc8812a2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ ++ if (!wifi_connected) { ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ false, 0x0, 0x0); ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non-connected idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ if ((BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) || ++ (BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ halbtc8812a2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); ++ } else { ++ halbtc8812a2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 0); ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 1); ++ } ++ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, ++ false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, ++ 0x18); ++ ++ common = true; ++ } else { ++ if (BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, false, 0x0, 0x0); ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, ++ false, false, 0x8); ++ ++ halbtc8812a2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 0); ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, ++ 6); ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++ common = true; ++ } else if (BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ if (bt_hs_on) ++ return false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, true, 0x0, 0x0); ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, ++ false, false, 0x8); ++ ++ halbtc8812a2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 0); ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, ++ 6); ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++ common = true; ++ } else { ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ common = false; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8812a2ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, true, 0x0, 0x0); ++ ++ halbtc8812a2ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8812a2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 0); ++ ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 17); ++ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, ++ NORMAL_EXEC, 6); ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, ++ NORMAL_EXEC, 0); ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, ++ false, false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ common = true; ++ } ++ } ++ } ++ ++ return common; ++} ++ ++void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, ++ IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) ++{ ++ static s32 up, dn, m, n, wait_count; ++ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ ++ u8 retry_count = 0; ++ ++ coex_dm->auto_tdma_adjust_low_rssi = false; ++ ++ if (!coex_dm->auto_tdma_adjust) { ++ coex_dm->auto_tdma_adjust = true; ++ { ++ if (sco_hid) { ++ if (tx_pause) { ++ if (max_interval == 1) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 13); ++ coex_dm->ps_tdma_du_adj_type = ++ 13; ++ } else if (max_interval == 2) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (max_interval == 3) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } ++ } else { ++ if (max_interval == 1) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = ++ 9; ++ } else if (max_interval == 2) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (max_interval == 3) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } ++ } ++ } else { ++ if (tx_pause) { ++ if (max_interval == 1) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 5); ++ coex_dm->ps_tdma_du_adj_type = ++ 5; ++ } else if (max_interval == 2) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (max_interval == 3) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } ++ } else { ++ if (max_interval == 1) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (max_interval == 2) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (max_interval == 3) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } ++ } ++ } ++ } ++ /* ============ */ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n = 3; ++ result = 0; ++ wait_count = 0; ++ } else { ++ /* accquire the BT TRx retry count from BT_Info byte2 */ ++ retry_count = coex_sta->bt_retry_cnt; ++ result = 0; ++ wait_count++; ++ ++ if (retry_count == ++ 0) { /* no retry in the last 2-second duration */ ++ up++; ++ dn--; ++ ++ if (dn <= 0) ++ dn = 0; ++ ++ if (up >= n) { /* if s n 2 retry count0, hռeWiFi duration */ ++ wait_count = 0; ++ n = 3; ++ up = 0; ++ dn = 0; ++ result = 1; ++ } ++ } else if (retry_count <= ++ 3) { /* <=3 retry in the last 2-second duration */ ++ up--; ++ dn++; ++ ++ if (up <= 0) ++ up = 0; ++ ++ if (dn == 2) { /* if s 2 2 retry count< 3, hկWiFi duration */ ++ if (wait_count <= 2) ++ m++; /* קK@blevelӦ^ */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ } else { /* retry count > 3, un1 retry count > 3, hկWiFi duration */ ++ if (wait_count == 1) ++ m++; /* קK@blevelӦ^ */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ ++ if (max_interval == 1) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 71) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 5); ++ coex_dm->ps_tdma_du_adj_type = 5; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 5); ++ coex_dm->ps_tdma_du_adj_type = 5; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 13); ++ coex_dm->ps_tdma_du_adj_type = 13; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 5); ++ coex_dm->ps_tdma_du_adj_type = ++ 5; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 13); ++ coex_dm->ps_tdma_du_adj_type = ++ 13; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 71); ++ coex_dm->ps_tdma_du_adj_type = 71; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 71) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 71); ++ coex_dm->ps_tdma_du_adj_type = ++ 71; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = ++ 9; ++ } ++ } ++ } ++ } else if (max_interval == 2) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } ++ } ++ } ++ } else if (max_interval == 3) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8812a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8812a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } ++ } ++ } ++ } ++ } ++ ++ /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ ++ /* then we have to adjust it back to the previous record one. */ ++ if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { ++ boolean scan = false, link = false, roam = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", ++ coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (!scan && !link && !roam) ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ coex_dm->ps_tdma_du_adj_type); ++ else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } ++} ++ ++/* ****************** ++ * pstdma for wifi rssi low ++ * ****************** */ ++void halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( ++ IN struct btc_coexist *btcoexist/* , */ /* IN u8 wifi_status */) ++{ ++ static s32 up, dn, m, n, wait_count; ++ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ ++ u8 retry_count = 0, bt_info_ext; ++ ++ coex_dm->auto_tdma_adjust = false; ++ ++ retry_count = coex_sta->bt_retry_cnt; ++ bt_info_ext = coex_sta->bt_info_ext; ++ ++ if (!coex_dm->auto_tdma_adjust_low_rssi) { ++ coex_dm->auto_tdma_adjust_low_rssi = true; ++ ++ if (BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(bt_info_ext)) { ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 83); ++ coex_dm->ps_tdma_du_adj_type = 83; ++ } else { ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 82); ++ coex_dm->ps_tdma_du_adj_type = 82; ++ } ++ /* ============ */ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n = 3; ++ result = 0; ++ wait_count = 0; ++ } else { ++ /* accquire the BT TRx retry count from BT_Info byte2 ++ * retry_count = coex_sta->bt_retry_cnt; ++ * bt_info_ext = coex_sta->bt_info_ext; */ ++ result = 0; ++ wait_count++; ++ ++ if ((coex_sta->low_priority_tx) > 1150 || ++ (coex_sta->low_priority_rx) > 1250) ++ retry_count++; ++ ++ if (retry_count == ++ 0) { /* no retry in the last 2-second duration */ ++ up++; ++ dn--; ++ ++ if (dn <= 0) ++ dn = 0; ++ ++ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ ++ wait_count = 0; ++ n = 3; ++ up = 0; ++ dn = 0; ++ result = 1; ++ } ++ } else if (retry_count <= ++ 3) { /* <=3 retry in the last 2-second duration */ ++ up--; ++ dn++; ++ ++ if (up <= 0) ++ up = 0; ++ ++ if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ ++ if (wait_count <= 2) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ ++ if (wait_count == 1) ++ m++; /* to avoid loop between the two levels */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ ++ if (result == -1) { ++ if ((BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(bt_info_ext)) && ++ ((coex_dm->cur_ps_tdma == 81) || ++ (coex_dm->cur_ps_tdma == 82))) { ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 84); ++ coex_dm->ps_tdma_du_adj_type = 84; ++ } else if (coex_dm->cur_ps_tdma == 81) { ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 82); ++ coex_dm->ps_tdma_du_adj_type = 82; ++ } else if (coex_dm->cur_ps_tdma == 82) { ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 83); ++ coex_dm->ps_tdma_du_adj_type = 83; ++ } else if (coex_dm->cur_ps_tdma == 83) { ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 84); ++ coex_dm->ps_tdma_du_adj_type = 84; ++ } ++ } else if (result == 1) { ++ if ((BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(bt_info_ext)) && ++ ((coex_dm->cur_ps_tdma == 81) || ++ (coex_dm->cur_ps_tdma == 82))) { ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 83); ++ coex_dm->ps_tdma_du_adj_type = 83; ++ } else if (coex_dm->cur_ps_tdma == 84) { ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 83); ++ coex_dm->ps_tdma_du_adj_type = 83; ++ } else if (coex_dm->cur_ps_tdma == 83) { ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 82); ++ coex_dm->ps_tdma_du_adj_type = 82; ++ } else if (coex_dm->cur_ps_tdma == 82) { ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ true, 81); ++ coex_dm->ps_tdma_du_adj_type = 81; ++ } ++ } ++ ++ if (coex_dm->cur_ps_tdma != 81 && ++ coex_dm->cur_ps_tdma != 82 && ++ coex_dm->cur_ps_tdma != 83 && ++ coex_dm->cur_ps_tdma != 84) { ++ /* recover to previous adjust type */ ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ coex_dm->ps_tdma_du_adj_type); ++ } ++ } ++} ++ ++void halbtc8812a2ant_get_bt_rssi_threshold(IN struct btc_coexist *btcoexist, ++ IN u8 *pThres0, IN u8 *pThres1) ++{ ++ u8 ant_type; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &ant_type); ++ ++ switch (ant_type) { ++ case BTC_ANT_TYPE_0: ++ *pThres0 = 100; ++ *pThres1 = 100; ++ break; ++ case BTC_ANT_TYPE_1: ++ *pThres0 = 34; ++ *pThres1 = 42; ++ break; ++ case BTC_ANT_TYPE_2: ++ *pThres0 = 34; ++ *pThres1 = 42; ++ break; ++ case BTC_ANT_TYPE_3: ++ *pThres0 = 34; ++ *pThres1 = 42; ++ break; ++ case BTC_ANT_TYPE_4: ++ *pThres0 = 34; ++ *pThres1 = 42; ++ break; ++ default: ++ break; ++ } ++} ++ ++ ++ ++void halbtc8812a2ant_action_sco(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 bt_thresh0 = 0, bt_thresh1 = 0; ++ ++ ++ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, ++ &bt_thresh1); ++ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, ++ bt_thresh1); ++ ++ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, ++ 0); ++ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ ++ ++ /* power save state */ ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, ++ 0x0, 0x0); ++ ++ /* coex table */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ else ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ /* pstdma */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); ++ else ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); ++ ++ /* decrease BT power */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ ++ /* limited Rx */ ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ /* fw dac swing level */ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ true, 0x6); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ true, 0x6); ++ } ++ } else { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ true, 0x6); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ true, 0x6); ++ } ++ } ++} ++ ++void halbtc8812a2ant_action_sco_hid(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 bt_thresh0 = 0, bt_thresh1 = 0; ++ ++ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, ++ &bt_thresh1); ++ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, ++ bt_thresh1); ++ ++ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, ++ 0); ++ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ ++ ++ /* power save state */ ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, ++ 0x0, 0x0); ++ ++ /* coex table */ ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ /* pstdma */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); ++ else ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); ++ ++ /* decrease BT power */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ ++ /* limited Rx */ ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x8); ++ ++ /* fw dac swing level */ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x6); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x6); ++ } ++ } else { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x6); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x6); ++ } ++ } ++} ++ ++void halbtc8812a2ant_action_hid(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 bt_thresh0 = 0, bt_thresh1 = 0; ++ ++ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, ++ &bt_thresh1); ++ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, ++ bt_thresh1); ++ ++ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, ++ 0); ++ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ ++ ++ /* power save state */ ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, ++ 0x0, 0x0); ++ ++ /* coex table */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ else ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ /* pstdma */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); ++ else ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ ++ /* decrease BT power */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ ++ /* limited Rx */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ else ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, ++ 0x8); ++ ++ ++ /* fw dac swing level */ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ ++void halbtc8812a2ant_action_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 bt_thresh0 = 0, bt_thresh1 = 0; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, ++ &bt_thresh1); ++ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, ++ bt_thresh1); ++ ++ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, ++ 0); ++ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ ++ ++ /* power save state */ ++ if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state)))) ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ true, 0x0, 0x0); ++ else ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, ++ 0x50, 0x4); ++ ++ /* coex table */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ /* pstdma */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, false, ++ 1); ++ else ++ halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( ++ btcoexist); ++ ++ /* decrease BT power */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ ++ /* limited Rx */ ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ /* fw dac swing level */ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ ++ /* sw mechanism */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8812a2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 bt_thresh0 = 0, bt_thresh1 = 0; ++ ++ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, ++ &bt_thresh1); ++ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, ++ bt_thresh1); ++ ++ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, ++ 0); ++ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ ++ ++ /* power save state */ ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, ++ 0x0, 0x0); ++ ++ /* coex table */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ ++ /* pstdma */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, false, ++ 2); ++ else ++ halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, true, 2); ++ ++ /* decrease BT power */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ ++ /* limited Rx */ ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ /* fw dac swing level */ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ ++ /* sw mechanism */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ true, 0x6); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ true, 0x6); ++ } ++ } else { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ true, 0x6); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ true, 0x6); ++ } ++ } ++} ++ ++void halbtc8812a2ant_action_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 bt_thresh0 = 0, bt_thresh1 = 0; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ ++ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, ++ &bt_thresh1); ++ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, ++ bt_thresh1); ++ ++ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, ++ 0); ++ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ ++ ++ /* power save state */ ++ if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state)))) ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ true, 0x0, 0x0); ++ else ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, ++ 0x50, 0x4); ++ ++ /* coex table */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ /* pstdma */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); ++ else ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 85); ++ ++ /* decrease BT power */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ ++ /* limited Rx */ ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ /* fw dac swing level */ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ ++ /* sw mechanism */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++/* PAN(HS) only */ ++void halbtc8812a2ant_action_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, ++ 0); ++ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); ++ ++ /* power save state */ ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, ++ 0x0, 0x0); ++ ++ /* coex table */ ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ ++ /* pstdma */ ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ ++ /* decrease BT power */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ ++ /* limited Rx */ ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ /* fw dac swing level */ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++/* PAN(EDR)+A2DP */ ++void halbtc8812a2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 bt_thresh0 = 0, bt_thresh1 = 0; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, ++ &bt_thresh1); ++ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, ++ bt_thresh1); ++ ++ ++ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, ++ 0); ++ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ ++ ++ /* power save state */ ++ if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state)))) ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ true, 0x0, 0x0); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ true, 0x0, 0x0); ++ else ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, ++ 0x50, 0x4); ++ ++ /* coex table */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ else ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ /* pstdma */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, false, ++ 3); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, true, 3); ++ else { ++ coex_dm->auto_tdma_adjust = false; ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); ++ } ++ ++ /* decrease BT power */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ ++ /* limited Rx */ ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ /* fw dac swing level */ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8812a2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 bt_thresh0 = 0, bt_thresh1 = 0; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, ++ &bt_thresh1); ++ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, ++ bt_thresh1); ++ ++ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, ++ 0); ++ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ ++ ++ /* power save state */ ++ if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state)))) ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ true, 0x0, 0x0); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ true, 0x0, 0x0); ++ else ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, ++ 0x50, 0x4); ++ ++ /* coex table */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ else ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ /* pstdma */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 10); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); ++ else ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 85); ++ ++ /* decrease BT power */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ ++ /* limited Rx */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ else ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, ++ 0x8); ++ ++ /* fw dac swing level */ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++/* HID+A2DP+PAN(EDR) */ ++void halbtc8812a2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 bt_thresh0 = 0, bt_thresh1 = 0; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, ++ &bt_thresh1); ++ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, ++ bt_thresh1); ++ ++ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, ++ 0); ++ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ ++ ++ /* power save state */ ++ if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state)))) ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ true, 0x0, 0x0); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ true, 0x0, 0x0); ++ else ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, ++ 0x50, 0x4); ++ ++ /* coex table */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ else ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ /* pstdma */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, false, 3); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, true, 3); ++ else { ++ coex_dm->auto_tdma_adjust = false; ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); ++ } ++ ++ /* decrease BT power */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ ++ /* limited Rx */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ else ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, ++ 0x8); ++ ++ ++ /* fw dac swing level */ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8812a2ant_action_hid_a2dp_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 bt_thresh0 = 0, bt_thresh1 = 0; ++ ++ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, ++ &bt_thresh1); ++ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, ++ bt_thresh1); ++ ++ ++ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, ++ 0); ++ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ ++ ++ /* power save state */ ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, ++ 0x0, 0x0); ++ ++ /* coex table */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ else ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ /* pstdma */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, false, 2); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, true, 2); ++ else ++ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, true, 2); ++ ++ /* decrease BT power */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ ++ /* limited Rx */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ else ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, ++ 0x8); ++ ++ /* fw dac swing level */ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8812a2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_bw; ++ u8 bt_thresh0 = 0, bt_thresh1 = 0; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, ++ &bt_thresh1); ++ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, ++ bt_thresh1); ++ ++ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, ++ 0); ++ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ ++ ++ /* power save state */ ++ if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state)))) ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ true, 0x0, 0x0); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ true, 0x0, 0x0); ++ else ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, ++ 0x50, 0x4); ++ ++ /* coex table */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ else ++ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ /* pstdma */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, false, 2); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, true, 2); ++ else { ++ coex_dm->auto_tdma_adjust = false; ++ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 82); ++ } ++ ++ /* decrease BT power */ ++ if (BTC_RSSI_LOW(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); ++ ++ /* limited Rx */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ else if (BTC_RSSI_LOW(wifi_rssi_state) && ++ (!BTC_RSSI_LOW(bt_rssi_state))) ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ else ++ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, ++ 0x8); ++ ++ /* fw dac swing level */ ++ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if (BTC_RSSI_HIGH(wifi_rssi_state)) { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++ ++void halbtc8812a2ant_coex_under_5g(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8812a2ant_coex_all_off(btcoexist); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Under 5G, force set BT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); ++} ++/* **************************************************** */ ++void halbtc8812a2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_under_5g = false; ++ u8 algorithm = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if (wifi_under_5g) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), run 5G coex setting!!<===\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_coex_under_5g(btcoexist); ++ return; ++ } ++ ++ ++ algorithm = halbtc8812a2ant_action_algorithm(btcoexist); ++ if (coex_sta->c2h_bt_inquiry_page && ++ (BT_8812A_2ANT_COEX_ALGO_PANHS != algorithm)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under inquiry/page scan !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_bt_inquiry(btcoexist); ++ return; ++ } ++ ++ coex_dm->cur_algorithm = algorithm; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", ++ coex_dm->cur_algorithm); ++ BTC_TRACE(trace_buf); ++ ++ if (halbtc8812a2ant_is_common_action(btcoexist)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant common.\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->auto_tdma_adjust = false; ++ coex_dm->auto_tdma_adjust_low_rssi = false; ++ } else { ++ if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", ++ coex_dm->pre_algorithm, coex_dm->cur_algorithm); ++ BTC_TRACE(trace_buf); ++ coex_dm->auto_tdma_adjust = false; ++ coex_dm->auto_tdma_adjust_low_rssi = false; ++ } ++ switch (coex_dm->cur_algorithm) { ++ case BT_8812A_2ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_sco(btcoexist); ++ break; ++ case BT_8812A_2ANT_COEX_ALGO_SCO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = SCO+HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_sco_hid(btcoexist); ++ break; ++ case BT_8812A_2ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_hid(btcoexist); ++ break; ++ case BT_8812A_2ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_a2dp(btcoexist); ++ break; ++ case BT_8812A_2ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_a2dp_pan_hs(btcoexist); ++ break; ++ case BT_8812A_2ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_pan_edr(btcoexist); ++ break; ++ case BT_8812A_2ANT_COEX_ALGO_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_pan_hs(btcoexist); ++ break; ++ case BT_8812A_2ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_pan_edr_a2dp(btcoexist); ++ break; ++ case BT_8812A_2ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_pan_edr_hid(btcoexist); ++ break; ++ case BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_hid_a2dp_pan_edr( ++ btcoexist); ++ break; ++ case BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_hid_a2dp_pan_hs( ++ btcoexist); ++ break; ++ case BT_8812A_2ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_action_hid_a2dp(btcoexist); ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_coex_all_off(btcoexist); ++ break; ++ } ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ } ++ ++} ++ ++void halbtc8812a2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean back_up) ++{ ++ u8 u8tmp = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 2Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (back_up) { ++ /* backup rf 0x1e value */ ++ coex_dm->bt_rf_0x1e_backup = ++ btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x1e, ++ 0xfffff); ++ ++ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, ++ 0x430); ++ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, ++ 0x434); ++ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( ++ btcoexist, 0x42a); ++ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( ++ btcoexist, 0x456); ++ } ++ ++ /* ant sw control to BT */ ++ halbtc8812a2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_CPL_AUX, true, ++ false); ++ ++ /* 0x790[5:0]=0x5 */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); ++ u8tmp &= 0xc0; ++ u8tmp |= 0x5; ++ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); ++ ++ /* PTA parameter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, 0xffff); ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, 0x55555555); ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, 0x55555555); ++ ++ /* coex parameters */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); ++ ++ /* enable counter statistics */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); ++ ++ /* enable PTA */ ++ btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); ++ ++ /* bt clock related */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x4); ++ u8tmp |= BIT(7); ++ btcoexist->btc_write_1byte(btcoexist, 0x4, u8tmp); ++ ++ /* bt clock related */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x7); ++ u8tmp |= BIT(1); ++ btcoexist->btc_write_1byte(btcoexist, 0x7, u8tmp); ++} ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8812a2ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8812a2ant_ ++ * ************************************************************ */ ++void ex_halbtc8812a2ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++} ++ ++void ex_halbtc8812a2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ halbtc8812a2ant_init_hw_config(btcoexist, true); ++ btcoexist->stop_coex_dm = false; ++} ++ ++void ex_halbtc8812a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->stop_coex_dm = false; ++ halbtc8812a2ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8812a2ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; ++ u16 u16tmp[4]; ++ u32 u32tmp[4]; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Coex is STOPPED]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", ++ "Ant PG number/ Ant mechanism:", ++ board_info->pg_ant_num, board_info->btdm_ant_num); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", ++ "CoexVer/ FwVer/ PatchVer", ++ glcoex_ver_date_8812a_2ant, glcoex_ver_8812a_2ant, fw_ver, ++ bt_patch_ver, bt_patch_ver); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") ++ : ((BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi, coex_sta->bt_retry_cnt); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", ++ "SCO/HID/PAN/A2DP", ++ bt_link_info->sco_exist, bt_link_info->hid_exist, ++ bt_link_info->pan_exist, bt_link_info->a2dp_exist); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_BT_LINK_INFO); ++ ++ bt_info_ext = coex_sta->bt_info_ext; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "BT Info A2DP rate", ++ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); ++ CL_PRINTF(cli_buf); ++ ++ for (i = 0; i < BT_INFO_SRC_8812A_2ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8812a_2ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ /* Sw mechanism */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Sw mechanism]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", ++ "SM1[ShRf/ LpRA/ LimDig]", ++ coex_dm->cur_rf_rx_lpf_shrink, coex_dm->cur_low_penalty_ra, ++ coex_dm->limited_dig); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", ++ "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", ++ coex_dm->cur_agc_table_en, coex_dm->cur_adc_back_off, ++ coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); ++ CL_PRINTF(cli_buf); ++ ++ /* Fw mechanism */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Fw mechanism]============"); ++ CL_PRINTF(cli_buf); ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d/%d)", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ++ ps_tdma_case, coex_dm->auto_tdma_adjust, ++ coex_dm->auto_tdma_adjust_low_rssi); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", ++ "DecBtPwr/ IgnWlanAct", ++ coex_dm->cur_bt_dec_pwr_lvl, coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", ++ "RF-A, 0x1e initVal", ++ coex_dm->bt_rf_0x1e_backup); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "backup ARFR1/ARFR2/RL/AMaxTime", ++ coex_dm->backup_arfr_cnt1, coex_dm->backup_arfr_cnt2, ++ coex_dm->backup_retry_limit, ++ coex_dm->backup_ampdu_max_time); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); ++ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "0x430/0x434/0x42a/0x456", ++ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x ", ++ "0x778 (W_Act)/ 0x6cc (CoTab Sel)", ++ u8tmp[0], u8tmp[1]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x8db); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xc5b); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x8db(ADC)/0xc5b[29:25](DAC)", ++ ((u8tmp[0] & 0x60) >> 5), ((u8tmp[1] & 0x3e) >> 1)); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcb3); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xcb7); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0xcb3/ 0xcb7", ++ u8tmp[0], u8tmp[1]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x974); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x40/ 0x4c[24:23]/ 0x974", ++ u8tmp[0], ((u32tmp[0] & 0x01800000) >> 23), u32tmp[1]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x550(bcn ctrl)/0x522", ++ u32tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa0a); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0xc50(DIG)/0xa0a(CCK-TH)", ++ u32tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0xf48/ 0xa5b (FA cnt-- OFDM : CCK)", ++ u32tmp[0], (u8tmp[0] << 8) + u8tmp[1]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", ++ u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770(high-pri rx/tx)", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(low-pri rx/tx)", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++#if (BT_AUTO_REPORT_ONLY_8812A_2ANT == 1) ++ halbtc8812a2ant_monitor_bt_ctr(btcoexist); ++#endif ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++void ex_halbtc8812a2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ boolean wifi_under_5g = false; ++ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ halbtc8812a2ant_coex_all_off(btcoexist); ++ halbtc8812a2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_CPL_AUX, ++ false, true); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS notify, force set BT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ex_halbtc8812a2ant_media_status_notify(btcoexist, ++ BTC_MEDIA_DISCONNECT); ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, ++ &wifi_under_5g); ++ if (!wifi_under_5g) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS notify, force set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, ++ false); ++ } ++ } ++} ++ ++void ex_halbtc8812a2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ } ++} ++ ++void ex_halbtc8812a2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (BTC_SCAN_START == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ } else if (BTC_SCAN_FINISH == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++} ++ ++void ex_halbtc8812a2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (BTC_ASSOCIATE_START == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ } else if (BTC_ASSOCIATE_FINISH == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++} ++ ++void ex_halbtc8812a2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 data_len = 5; ++ u8 buf[6] = {0}; ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ h2c_parameter[0] = 0x1; ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ buf[0] = data_len; ++ buf[1] = 0x5; /* OP_Code */ ++ buf[2] = 0x3; /* OP_Code_Length */ ++ buf[3] = h2c_parameter[0]; /* OP_Code_Content */ ++ buf[4] = h2c_parameter[1]; ++ buf[5] = h2c_parameter[2]; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, ++ (void *)&buf[0]); ++} ++ ++void ex_halbtc8812a2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (type == BTC_PACKET_DHCP) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], DHCP Packet notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++} ++ ++void ex_halbtc8812a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 bt_info = 0; ++ u8 i, rsp_source = 0; ++ boolean bt_busy = false, limited_dig = false; ++ boolean wifi_connected = false, wifi_under_5g = false; ++ ++ coex_sta->c2h_bt_info_req_sent = false; ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8812A_2ANT_MAX) ++ rsp_source = BT_INFO_SRC_8812A_2ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ if (i == 1) ++ bt_info = tmp_buf[i]; ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ if (BT_INFO_SRC_8812A_2ANT_WIFI_FW != rsp_source) { ++ coex_sta->bt_retry_cnt = /* [3:0] */ ++ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; ++ ++ coex_sta->bt_rssi = ++ coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; ++ ++ coex_sta->bt_info_ext = ++ coex_sta->bt_info_c2h[rsp_source][4]; ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ if ((coex_sta->bt_info_ext & BIT(1))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (wifi_connected) ++ ex_halbtc8812a2ant_media_status_notify( ++ btcoexist, BTC_MEDIA_CONNECT); ++ else ++ ex_halbtc8812a2ant_media_status_notify( ++ btcoexist, BTC_MEDIA_DISCONNECT); ++ } ++ ++ if ((coex_sta->bt_info_ext & BIT(3)) && !wifi_under_5g) { ++ /* BT already ignored WlanAct */ ++ if (!btcoexist->manual_control && ++ !btcoexist->stop_coex_dm) { ++ if (!coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_ignore_wlan_act( ++ btcoexist, FORCE_EXEC, false); ++ } ++ } ++ } else { ++ /* BT already NOT ignore Wlan active, do nothing here. */ ++ ++ if (coex_sta->under_ips) { ++ /* work around for 8812a combo hw bug => when IPS, wlanAct is always high. */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS, set BT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_ignore_wlan_act(btcoexist, ++ FORCE_EXEC, true); ++ } ++ } ++ } ++ ++ /* check BIT2 first ==> check if bt is under inquiry or page scan */ ++ if (bt_info & BT_INFO_8812A_2ANT_B_INQ_PAGE) ++ coex_sta->c2h_bt_inquiry_page = true; ++ else ++ coex_sta->c2h_bt_inquiry_page = false; ++ ++ /* set link exist status */ ++ if (!(bt_info & BT_INFO_8812A_2ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ coex_sta->acl_busy = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (bt_info & BT_INFO_8812A_2ANT_B_FTP) ++ coex_sta->pan_exist = true; ++ else ++ coex_sta->pan_exist = false; ++ if (bt_info & BT_INFO_8812A_2ANT_B_A2DP) ++ coex_sta->a2dp_exist = true; ++ else ++ coex_sta->a2dp_exist = false; ++ if (bt_info & BT_INFO_8812A_2ANT_B_HID) ++ coex_sta->hid_exist = true; ++ else ++ coex_sta->hid_exist = false; ++ if (bt_info & BT_INFO_8812A_2ANT_B_SCO_ESCO) ++ coex_sta->sco_exist = true; ++ else ++ coex_sta->sco_exist = false; ++ if (bt_info & BT_INFO_8812A_2ANT_B_ACL_BUSY) ++ coex_sta->acl_busy = true; ++ else ++ coex_sta->acl_busy = false; ++ ++ } ++ ++ halbtc8812a2ant_update_bt_link_info(btcoexist); ++ ++ if (!(bt_info & BT_INFO_8812A_2ANT_B_CONNECTION)) { ++ coex_dm->bt_status = BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info == ++ BT_INFO_8812A_2ANT_B_CONNECTION) { /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if ((bt_info & BT_INFO_8812A_2ANT_B_SCO_ESCO) || ++ (bt_info & BT_INFO_8812A_2ANT_B_SCO_BUSY)) { ++ coex_dm->bt_status = BT_8812A_2ANT_BT_STATUS_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info & BT_INFO_8812A_2ANT_B_ACL_BUSY) { ++ coex_dm->bt_status = BT_8812A_2ANT_BT_STATUS_ACL_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ coex_dm->bt_status = BT_8812A_2ANT_BT_STATUS_MAX; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if ((BT_8812A_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8812A_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8812A_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { ++ bt_busy = true; ++ if (!wifi_under_5g) ++ limited_dig = true; ++ } else { ++ bt_busy = false; ++ limited_dig = false; ++ } ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ coex_dm->limited_dig = limited_dig; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); ++ ++ halbtc8812a2ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8812a2ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_RF_ON == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned ON!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->stop_coex_dm = false; ++ } ++ if (BTC_RF_OFF == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned OFF!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ true, 0x0, 0x0); ++ halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); ++ /* halbtc8812a2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, false, true); */ ++ halbtc8812a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ btcoexist->stop_coex_dm = true; ++ ++ } ++} ++ ++ ++void ex_halbtc8812a2ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8812a2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_CPL_AUX, false, ++ true); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Halt notify, force set BT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8812a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ex_halbtc8812a2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++ ++ /* 0x522=0xff, pause tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x522, 0xff); ++ /* 0x40[7:6]=2'b01, modify BT mode. */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0xc0, 0x2); ++ btcoexist->stop_coex_dm = true; ++} ++ ++void ex_halbtc8812a2ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++#if (BT_AUTO_REPORT_ONLY_8812A_2ANT == 0) ++ halbtc8812a2ant_query_bt_info(btcoexist); ++ halbtc8812a2ant_monitor_bt_ctr(btcoexist); ++ halbtc8812a2ant_monitor_bt_enable_disable(btcoexist); ++#else ++ if (halbtc8812a2ant_is_wifi_status_changed(btcoexist) || ++ coex_dm->auto_tdma_adjust || ++ coex_dm->auto_tdma_adjust_low_rssi) ++ halbtc8812a2ant_run_coexist_mechanism(btcoexist); ++#endif ++} ++ ++void ex_halbtc8812a2ant_dbg_control(IN struct btc_coexist *btcoexist, ++ IN u8 op_code, IN u8 op_len, IN u8 *pdata) ++{ ++ switch (op_code) { ++ case BTC_DBG_SET_COEX_DEC_BT_PWR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set Dec BT power\n"); ++ BTC_TRACE(trace_buf); ++ { ++ u8 data_len = 4; ++ u8 buf[6] = {0}; ++ u8 dec_bt_pwr = 0, pwr_level = 0; ++ if (op_len == 2) { ++ dec_bt_pwr = pdata[0]; ++ pwr_level = pdata[1]; ++ ++ buf[0] = data_len; ++ buf[1] = 0x3; /* OP_Code */ ++ buf[2] = 0x2; /* OP_Code_Length */ ++ ++ buf[3] = dec_bt_pwr; /* OP_Code_Content */ ++ buf[4] = pwr_level; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set Dec BT power=%d, pwr_level=%d\n", ++ dec_bt_pwr, pwr_level); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_CTRL_BT_COEX, ++ (void *)&buf[0]); ++ } ++ } ++ break; ++ ++ case BTC_DBG_SET_COEX_BT_AFH_MAP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set BT AFH Map\n"); ++ BTC_TRACE(trace_buf); ++ { ++ u8 data_len = 5; ++ u8 buf[6] = {0}; ++ if (op_len == 3) { ++ buf[0] = data_len; ++ buf[1] = 0x5; /* OP_Code */ ++ buf[2] = 0x3; /* OP_Code_Length */ ++ ++ buf[3] = pdata[0]; /* OP_Code_Content */ ++ buf[4] = pdata[1]; ++ buf[5] = pdata[2]; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set BT AFH Map = %02x %02x %02x\n", ++ pdata[0], pdata[1], pdata[2]); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_CTRL_BT_COEX, ++ (void *)&buf[0]); ++ } ++ } ++ break; ++ ++ case BTC_DBG_SET_COEX_BT_IGNORE_WLAN_ACT: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set BT Ignore Wlan Active\n"); ++ BTC_TRACE(trace_buf); ++ { ++ u8 data_len = 3; ++ u8 buf[6] = {0}; ++ if (op_len == 1) { ++ buf[0] = data_len; ++ buf[1] = 0x1; /* OP_Code */ ++ buf[2] = 0x1; /* OP_Code_Length */ ++ ++ buf[3] = pdata[0]; /* OP_Code_Content */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set BT Ignore Wlan Active = 0x%x\n", ++ pdata[0]); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_CTRL_BT_COEX, ++ (void *)&buf[0]); ++ } ++ } ++ break; ++ ++ default: ++ break; ++ } ++} ++ ++#endif ++ ++#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ +\ Ingen nyrad vid filslut +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.h 2018-02-11 21:44:27.147146086 +0200 +@@ -0,0 +1,202 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8812A_SUPPORT == 1) ++ ++/* ******************************************* ++ * The following is for 8812A 2Ant BT Co-exist definition ++ * ******************************************* */ ++#define BT_AUTO_REPORT_ONLY_8812A_2ANT 0 ++ ++#define BT_INFO_8812A_2ANT_B_FTP BIT(7) ++#define BT_INFO_8812A_2ANT_B_A2DP BIT(6) ++#define BT_INFO_8812A_2ANT_B_HID BIT(5) ++#define BT_INFO_8812A_2ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8812A_2ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8812A_2ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8812A_2ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8812A_2ANT_B_CONNECTION BIT(0) ++ ++#define BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ ++ (((_BT_INFO_EXT_&BIT(0))) ? true : false) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT 2 ++ ++enum bt_info_src_8812a_2ant { ++ BT_INFO_SRC_8812A_2ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8812A_2ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8812A_2ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8812A_2ANT_MAX ++}; ++ ++enum bt_8812a_2ant_bt_status { ++ BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8812A_2ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8812A_2ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8812A_2ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8812A_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8812A_2ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8812a_2ant_coex_algo { ++ BT_8812A_2ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8812A_2ANT_COEX_ALGO_SCO = 0x1, ++ BT_8812A_2ANT_COEX_ALGO_SCO_HID = 0x2, ++ BT_8812A_2ANT_COEX_ALGO_HID = 0x3, ++ BT_8812A_2ANT_COEX_ALGO_A2DP = 0x4, ++ BT_8812A_2ANT_COEX_ALGO_A2DP_PANHS = 0x5, ++ BT_8812A_2ANT_COEX_ALGO_PANEDR = 0x6, ++ BT_8812A_2ANT_COEX_ALGO_PANHS = 0x7, ++ BT_8812A_2ANT_COEX_ALGO_PANEDR_A2DP = 0x8, ++ BT_8812A_2ANT_COEX_ALGO_PANEDR_HID = 0x9, ++ BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0xa, ++ BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANHS = 0xb, ++ BT_8812A_2ANT_COEX_ALGO_HID_A2DP = 0xc, ++ BT_8812A_2ANT_COEX_ALGO_MAX = 0xd ++}; ++ ++struct coex_dm_8812a_2ant { ++ /* fw mechanism */ ++ u8 pre_bt_dec_pwr_lvl; ++ u8 cur_bt_dec_pwr_lvl; ++ u8 pre_fw_dac_swing_lvl; ++ u8 cur_fw_dac_swing_lvl; ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean auto_tdma_adjust; ++ boolean auto_tdma_adjust_low_rssi; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++ ++ /* sw mechanism */ ++ boolean pre_rf_rx_lpf_shrink; ++ boolean cur_rf_rx_lpf_shrink; ++ u32 bt_rf_0x1e_backup; ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ boolean pre_dac_swing_on; ++ u32 pre_dac_swing_lvl; ++ boolean cur_dac_swing_on; ++ u32 cur_dac_swing_lvl; ++ boolean pre_adc_back_off; ++ boolean cur_adc_back_off; ++ boolean pre_agc_table_en; ++ boolean cur_agc_table_en; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ boolean limited_dig; ++ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ ++ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ ++ u16 backup_retry_limit; ++ u8 backup_ampdu_max_time; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ u32 pre_ra_mask; ++ u32 cur_ra_mask; ++ u8 cur_ra_mask_type; ++ u8 pre_arfr_type; ++ u8 cur_arfr_type; ++ u8 pre_retry_limit_type; ++ u8 cur_retry_limit_type; ++ u8 pre_ampdu_time_type; ++ u8 cur_ampdu_time_type; ++}; ++ ++struct coex_sta_8812a_2ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ boolean acl_busy; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ u8 bt_rssi; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ boolean c2h_bt_info_req_sent; ++ u8 bt_info_c2h[BT_INFO_SRC_8812A_2ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8812A_2ANT_MAX]; ++ u32 bt_info_query_cnt; ++ boolean c2h_bt_inquiry_page; ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++}; ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8812a2ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8812a2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8812a2ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8812a2ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8812a2ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8812a2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8812a2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8812a2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8812a2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8812a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8812a2ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++ ++void ex_halbtc8812a2ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8812a2ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8812a2ant_display_coex_info(IN struct btc_coexist *btcoexist); ++void ex_halbtc8812a2ant_dbg_control(IN struct btc_coexist *btcoexist, ++ IN u8 op_code, IN u8 op_len, IN u8 *pdata); ++ ++#else ++#define ex_halbtc8812a2ant_power_on_setting(btcoexist) ++#define ex_halbtc8812a2ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8812a2ant_init_coex_dm(btcoexist) ++#define ex_halbtc8812a2ant_ips_notify(btcoexist, type) ++#define ex_halbtc8812a2ant_lps_notify(btcoexist, type) ++#define ex_halbtc8812a2ant_scan_notify(btcoexist, type) ++#define ex_halbtc8812a2ant_connect_notify(btcoexist, type) ++#define ex_halbtc8812a2ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8812a2ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8812a2ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8812a2ant_rf_status_notify(btcoexist, type) ++#define ex_halbtc8812a2ant_halt_notify(btcoexist) ++#define ex_halbtc8812a2ant_periodical(btcoexist) ++#define ex_halbtc8812a2ant_display_coex_info(btcoexist) ++#define ex_halbtc8812a2ant_dbg_control(btcoexist, op_code, op_len, pdata) ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.c 2018-02-11 21:44:27.147146086 +0200 +@@ -0,0 +1,3100 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for 8821A_1ANT Co-exist mechanism ++ * ++ * History ++ * 2012/11/15 Cosa first check in. ++ * ++ * ************************************************************ ++ * SY modify 2015/04/27 ++ * ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8821A_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8821a_1ant glcoex_dm_8821a_1ant; ++static struct coex_dm_8821a_1ant *coex_dm = &glcoex_dm_8821a_1ant; ++static struct coex_sta_8821a_1ant glcoex_sta_8821a_1ant; ++static struct coex_sta_8821a_1ant *coex_sta = &glcoex_sta_8821a_1ant; ++ ++const char *const glbt_info_src_8821a_1ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++u32 glcoex_ver_date_8821a_1ant = 20150615; ++u32 glcoex_ver_8821a_1ant = 0x61; ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8821a1ant_ ++ * ************************************************************ */ ++u8 halbtc8821a1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_bt_rssi_state; ++ } ++ ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8821a1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_wifi_rssi_state[index]; ++ } ++ ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8821a1ant_update_ra_mask(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 dis_rate_mask) ++{ ++ coex_dm->cur_ra_mask = dis_rate_mask; ++ ++ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, ++ &coex_dm->cur_ra_mask); ++ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; ++} ++ ++void halbtc8821a1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ ++ coex_dm->cur_arfr_type = type; ++ ++ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { ++ switch (coex_dm->cur_arfr_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_4byte(btcoexist, 0x430, ++ coex_dm->backup_arfr_cnt1); ++ btcoexist->btc_write_4byte(btcoexist, 0x434, ++ coex_dm->backup_arfr_cnt2); ++ break; ++ case 1: ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x01010101); ++ } else { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x04030201); ++ } ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; ++} ++ ++void halbtc8821a1ant_retry_limit(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_retry_limit_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_retry_limit_type != ++ coex_dm->cur_retry_limit_type)) { ++ switch (coex_dm->cur_retry_limit_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ coex_dm->backup_retry_limit); ++ break; ++ case 1: /* retry limit=8 */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ 0x0808); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; ++} ++ ++void halbtc8821a1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_ampdu_time_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { ++ switch (coex_dm->cur_ampdu_time_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ coex_dm->backup_ampdu_max_time); ++ break; ++ case 1: /* AMPDU timw = 0x38 * 32us */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ 0x38); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; ++} ++ ++void halbtc8821a1ant_limited_tx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, ++ IN u8 retry_limit_type, IN u8 ampdu_time_type) ++{ ++ switch (ra_mask_type) { ++ case 0: /* normal mode */ ++ halbtc8821a1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0); ++ break; ++ case 1: /* disable cck 1/2 */ ++ halbtc8821a1ant_update_ra_mask(btcoexist, force_exec, ++ 0x00000003); ++ break; ++ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ ++ halbtc8821a1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0001f1f7); ++ break; ++ default: ++ break; ++ } ++ ++ halbtc8821a1ant_auto_rate_fallback_retry(btcoexist, force_exec, ++ arfr_type); ++ halbtc8821a1ant_retry_limit(btcoexist, force_exec, retry_limit_type); ++ halbtc8821a1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); ++} ++ ++ ++/* ture/xxxx/x:1 ++ * false/false/x: 64 ++ * false/ture/x:x */ ++void halbtc8821a1ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++ ++ ++} ++ ++void halbtc8821a1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++#if 0 ++ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ ++ if (!(btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8)) { ++ coex_sta->high_priority_tx = 65535; ++ coex_sta->high_priority_rx = 65535; ++ coex_sta->low_priority_tx = 65535; ++ coex_sta->low_priority_rx = 65535; ++ return; ++ } ++#endif ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++} ++ ++void halbtc8821a1ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ coex_sta->c2h_bt_info_req_sent = true; ++ ++ h2c_parameter[0] |= BIT(0); /* trigger */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); ++} ++ ++boolean halbtc8821a1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) ++{ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ } ++ ++ return false; ++} ++ ++void halbtc8821a1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if (bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if (!bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++} ++ ++u8 halbtc8821a1ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8821A_1ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (!bt_link_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No BT link exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (bt_link_info->sco_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->hid_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->pan_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 1) { ++ if (bt_link_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_1ANT_COEX_ALGO_SCO; ++ } else { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_1ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_1ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_1ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_1ANT_COEX_ALGO_SCO; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_1ANT_COEX_ALGO_HID_A2DP; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_1ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_1ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_1ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++void halbtc8821a1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8821a1ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ halbtc8821a1ant_set_bt_auto_report(btcoexist, ++ coex_dm->cur_bt_auto_report); ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++void halbtc8821a1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ ++ ++ if (low_penalty_ra) { ++ h2c_parameter[1] |= BIT(0); ++ h2c_parameter[2] = ++ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ ++ h2c_parameter[3] = 0xf5; /* MCS7 or OFDM54 */ ++ h2c_parameter[4] = 0xa0; /* MCS6 or OFDM48// */ ++ h2c_parameter[5] = 0xa0; /* MCS5 or OFDM36 // */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); ++} ++ ++void halbtc8821a1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ halbtc8821a1ant_set_sw_penalty_tx_rate_adaptive(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++} ++ ++void halbtc8821a1ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8821a1ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ halbtc8821a1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8821a1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** CoexTable(%d) **********\n", type); ++ BTC_TRACE(trace_buf); ++ ++ switch (type) { ++ case 0: ++ halbtc8821a1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x55555555, 0xffffff, 0x3); ++ break; ++ case 1: ++ halbtc8821a1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 2: ++ halbtc8821a1ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 3: ++ halbtc8821a1ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ case 4: ++ halbtc8821a1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 5: ++ halbtc8821a1ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0xaaaa5a5a, 0xffffff, 0x3); ++ break; ++ case 6: ++ halbtc8821a1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3); ++ break; ++ case 7: ++ halbtc8821a1ant_coex_table(btcoexist, force_exec, ++ 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8821a1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ if (enable) { ++ h2c_parameter[0] |= BIT(0); /* function enable */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); ++} ++ ++void halbtc8821a1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ halbtc8821a1ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8821a1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ u8 real_byte1 = byte1, real_byte5 = byte5; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ if (ap_enable) { ++ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], FW for 1Ant AP mode\n"); ++ BTC_TRACE(trace_buf); ++ real_byte1 &= ~BIT(4); ++ real_byte1 |= BIT(5); ++ ++ real_byte5 |= BIT(5); ++ real_byte5 &= ~BIT(6); ++ } ++ } ++ ++ h2c_parameter[0] = real_byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = real_byte5; ++ ++ coex_dm->ps_tdma_para[0] = real_byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = real_byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++void halbtc8821a1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8821a1ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8821a1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8821a1ant_sw_mechanism(IN struct btc_coexist *btcoexist, ++ IN boolean low_penalty_ra) ++{ ++ halbtc8821a1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); ++} ++ ++void halbtc8821a1ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u32 u32tmp = 0; ++ u8 h2c_parameter[2] = {0}; ++ ++ if (init_hwcfg) { ++ /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp &= ~BIT(23); ++ u32tmp |= BIT(24); ++ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); ++ ++ /* 0x765 = 0x18 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x765, 0x18, 0x3); ++ ++ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { ++ /* tell firmware "antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ ++ h2c_parameter[0] = 1; ++ h2c_parameter[1] = 1; ++ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, ++ h2c_parameter); ++ ++ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, 0x1); //Main Ant to BT for IPS case 0x4c[23]=1 */ ++ } else { ++ /* tell firmware "no antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ ++ h2c_parameter[0] = 0; ++ h2c_parameter[1] = 1; ++ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, ++ h2c_parameter); ++ ++ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, 0x0); //Aux Ant to BT for IPS case 0x4c[23]=1 */ ++ } ++ } else if (wifi_off) { ++ /* 0x4c[24:23]=00, Set Antenna control by BT_RFE_CTRL BT Vendor 0xac=0xf002 */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp &= ~BIT(23); ++ u32tmp &= ~BIT(24); ++ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); ++ ++ /* 0x765 = 0x18 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x765, 0x18, 0x3); ++ } else { ++ /* 0x765 = 0x0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x765, 0x18, 0x0); ++ } ++ ++ /* ext switch setting */ ++ switch (ant_pos_type) { ++ case BTC_ANT_PATH_WIFI: ++ btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x77); ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ btcoexist->btc_write_1byte_bitmask(btcoexist, ++ 0xcb7, 0x30, 0x1); ++ else ++ btcoexist->btc_write_1byte_bitmask(btcoexist, ++ 0xcb7, 0x30, 0x2); ++ break; ++ case BTC_ANT_PATH_BT: ++ btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x77); ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ btcoexist->btc_write_1byte_bitmask(btcoexist, ++ 0xcb7, 0x30, 0x2); ++ else ++ btcoexist->btc_write_1byte_bitmask(btcoexist, ++ 0xcb7, 0x30, 0x1); ++ break; ++ default: ++ case BTC_ANT_PATH_PTA: ++ btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x66); ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ btcoexist->btc_write_1byte_bitmask(btcoexist, ++ 0xcb7, 0x30, 0x1); ++ else ++ btcoexist->btc_write_1byte_bitmask(btcoexist, ++ 0xcb7, 0x30, 0x2); ++ break; ++ } ++} ++ ++void halbtc8821a1ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ u8 rssi_adjust_val = 0; ++ /* u32 fw_ver=0; */ ++ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ if (coex_dm->cur_ps_tdma_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(on, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(off, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ return; ++ } ++ if (turn_on) { ++ switch (type) { ++ default: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x1a, 0x1a, 0x0, 0x50); ++ break; ++ case 1: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x3a, 0x03, 0x10, 0x50); ++ rssi_adjust_val = 11; ++ break; ++ case 2: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x2b, 0x03, 0x10, 0x50); ++ rssi_adjust_val = 14; ++ break; ++ case 3: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x1d, 0x1d, 0x0, 0x52); ++ break; ++ case 4: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x15, 0x3, 0x14, 0x0); ++ rssi_adjust_val = 17; ++ break; ++ case 5: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x15, 0x3, 0x11, 0x10); ++ break; ++ case 6: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x20, 0x3, 0x11, 0x13); ++ break; ++ case 7: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x13, ++ 0xc, 0x5, 0x0, 0x0); ++ break; ++ case 8: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x25, 0x3, 0x10, 0x0); ++ break; ++ case 9: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x21, 0x3, 0x10, 0x50); ++ rssi_adjust_val = 18; ++ break; ++ case 10: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x13, ++ 0xa, 0xa, 0x0, 0x40); ++ break; ++ case 11: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x15, 0x03, 0x10, 0x50); ++ rssi_adjust_val = 20; ++ break; ++ case 12: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x0a, 0x0a, 0x0, 0x50); ++ break; ++ case 13: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x12, 0x12, 0x0, 0x50); ++ break; ++ case 14: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x1e, 0x3, 0x10, 0x14); ++ break; ++ case 15: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x13, ++ 0xa, 0x3, 0x8, 0x0); ++ break; ++ case 16: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x15, 0x3, 0x10, 0x0); ++ rssi_adjust_val = 18; ++ break; ++ case 18: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x93, ++ 0x25, 0x3, 0x10, 0x0); ++ rssi_adjust_val = 14; ++ break; ++ case 20: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x35, 0x03, 0x11, 0x10); ++ break; ++ case 21: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x25, 0x03, 0x11, 0x11); ++ break; ++ case 22: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x25, 0x03, 0x11, 0x10); ++ break; ++ case 23: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x3, 0x31, 0x18); ++ rssi_adjust_val = 22; ++ break; ++ case 24: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x15, 0x3, 0x31, 0x18); ++ rssi_adjust_val = 22; ++ break; ++ case 25: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0xa, 0x3, 0x31, 0x18); ++ rssi_adjust_val = 22; ++ break; ++ case 26: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0xa, 0x3, 0x31, 0x18); ++ rssi_adjust_val = 22; ++ break; ++ case 27: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x3, 0x31, 0x98); ++ rssi_adjust_val = 22; ++ break; ++ case 28: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x69, ++ 0x25, 0x3, 0x31, 0x0); ++ break; ++ case 29: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xab, ++ 0x1a, 0x1a, 0x1, 0x10); ++ break; ++ case 30: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x30, 0x3, 0x10, 0x10); ++ break; ++ case 31: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x1a, 0x1a, 0, 0x58); ++ break; ++ case 32: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, ++ 0x35, 0x3, 0x11, 0x11); ++ break; ++ case 33: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xa3, ++ 0x25, 0x3, 0x30, 0x90); ++ break; ++ case 34: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x53, ++ 0x1a, 0x1a, 0x0, 0x10); ++ break; ++ case 35: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x63, ++ 0x1a, 0x1a, 0x0, 0x10); ++ break; ++ case 36: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x12, 0x3, 0x14, 0x50); ++ break; ++ case 40: /* SoftAP only with no sta associated,BT disable ,TDMA mode for power saving */ ++ /* here softap mode screen off will cost 70-80mA for phone */ ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x23, ++ 0x18, 0x00, 0x10, 0x24); ++ break; ++ case 41: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x15, 0x3, 0x11, 0x11); ++ break; ++ case 42: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x20, 0x3, 0x11, 0x11); ++ break; ++ case 43: ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, ++ 0x30, 0x3, 0x10, 0x11); ++ break; ++ } ++ } else { ++ /* disable PS tdma */ ++ switch (type) { ++ case 8: /* PTA Control */ ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x8, ++ 0x0, 0x0, 0x0, 0x0); ++ halbtc8821a1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_PTA, false, false); ++ break; ++ case 0: ++ default: /* Software control, Antenna at BT side */ ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x0, 0x0); ++ halbtc8821a1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_BT, false, false); ++ break; ++ case 9: /* Software control, Antenna at WiFi side */ ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x0, 0x0); ++ halbtc8821a1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_WIFI, false, false); ++ break; ++ case 10: /* under 5G */ ++ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x8, 0x0); ++ halbtc8821a1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_BT, false, false); ++ break; ++ } ++ } ++ rssi_adjust_val = 0; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssi_adjust_val); ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++void halbtc8821a1ant_coex_all_off(IN struct btc_coexist *btcoexist) ++{ ++ /* sw all off */ ++ halbtc8821a1ant_sw_mechanism(btcoexist, false); ++ ++ /* hw all off */ ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++boolean halbtc8821a1ant_is_common_action(IN struct btc_coexist *btcoexist) ++{ ++ boolean common = false, wifi_connected = false, wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (!wifi_connected && ++ BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_sw_mechanism(btcoexist, false); ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_sw_mechanism(btcoexist, false); ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_sw_mechanism(btcoexist, false); ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_sw_mechanism(btcoexist, false); ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_sw_mechanism(btcoexist, false); ++ ++ common = true; ++ } else { ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ common = false; ++ } ++ ++ return common; ++} ++ ++void halbtc8821a1ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 1); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++void halbtc8821a1ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ boolean low_pwr_disable = false; ++ ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ /* recover to original 32k low power setting */ ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ break; ++ case BTC_PS_LPS_ON: ++ halbtc8821a1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8821a1ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ /* when coex force to enter LPS, do not enter 32k low power. */ ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ break; ++ case BTC_PS_LPS_OFF: ++ halbtc8821a1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, false); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8821a1ant_coex_under_5g(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ halbtc8821a1ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); ++ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 10); ++ ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ ++ halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 5); ++} ++ ++void halbtc8821a1ant_action_wifi_only(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 9); ++} ++ ++void halbtc8821a1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ ++ /* This function check if bt is disabled */ ++ ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is enabled !!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ bt_disable_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], bt all counters=0, %d times!!\n", ++ bt_disable_cnt); ++ BTC_TRACE(trace_buf); ++ if (bt_disable_cnt >= 2) { ++ bt_disabled = true; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_action_wifi_only(btcoexist); ++ } ++ } ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_disabled = bt_disabled; ++ if (!bt_disabled) { ++ } else { ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ } ++ } ++} ++ ++/* ********************************************* ++ * ++ * Software Coex Mechanism start ++ * ++ * ********************************************* */ ++ ++void halbtc8821a1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ /* halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); */ ++ halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, false, false); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++/* SCO only or SCO+PAN(HS) */ ++void halbtc8821a1ant_action_sco(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_sw_mechanism(btcoexist, true); ++} ++ ++void halbtc8821a1ant_action_hid(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_sw_mechanism(btcoexist, true); ++} ++ ++/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ ++void halbtc8821a1ant_action_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8821a1ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8821a1ant_action_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_sw_mechanism(btcoexist, false); ++} ++ ++/* PAN(HS) only */ ++void halbtc8821a1ant_action_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_sw_mechanism(btcoexist, false); ++} ++ ++/* PAN(EDR)+A2DP */ ++void halbtc8821a1ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8821a1ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_sw_mechanism(btcoexist, true); ++} ++ ++/* HID+A2DP+PAN(EDR) */ ++void halbtc8821a1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_sw_mechanism(btcoexist, true); ++} ++ ++void halbtc8821a1ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_sw_mechanism(btcoexist, true); ++} ++ ++/* ********************************************* ++ * ++ * Non-Software Coex Mechanism start ++ * ++ * ********************************************* */ ++void halbtc8821a1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8821a1ant_action_hs(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8821a1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, ++ bt_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ if ((!wifi_connected) && (!coex_sta->wifi_is_high_pri_task)) { ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } ++ ++ /* sy modify */ ++ else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || ++ (bt_link_info->a2dp_exist)) { ++ /* SCO/HID/A2DP busy */ ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } ++ ++ /* sy modify */ ++ ++ else if ((bt_link_info->a2dp_exist) && ++ (bt_link_info->hid_exist)) { ++ /* A2DP+HID busy */ ++ halbtc8821a1ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 14); ++ ++ halbtc8821a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ } ++ ++ ++ else if ((bt_link_info->pan_exist) || (wifi_busy)) { ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ } ++} ++ ++void halbtc8821a1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ /* tdma and coex table */ ++ ++ if (bt_link_info->sco_exist) { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 41); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } else { /* HID */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 42); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8821a1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ u8 bt_rssi_state; ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ bt_rssi_state = halbtc8821a1ant_bt_rssi_state(2, 28, 0); ++ ++ if (bt_link_info->hid_only) { /* HID */ ++ halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, ++ wifi_status); ++ coex_dm->auto_tdma_adjust = false; ++ return; ++ } else if (bt_link_info->a2dp_only) { /* A2DP */ ++ if (BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { ++ /* halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); */ ++ /* halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ coex_dm->auto_tdma_adjust = false; ++ } else if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ /* halbtc8821a1ant_tdma_duration_adjust_for_acl(btcoexist, wifi_status); */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 14); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ } else { /* for low BT RSSI */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 14); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ coex_dm->auto_tdma_adjust = false; ++ } ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { /* HID+A2DP */ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 14); ++ coex_dm->auto_tdma_adjust = false; ++ } else { /* for low BT RSSI */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 14); ++ coex_dm->auto_tdma_adjust = false; ++ } ++ ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && ++ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); ++ coex_dm->auto_tdma_adjust = false; ++ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || ++ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 43); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ coex_dm->auto_tdma_adjust = false; ++ } else { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ coex_dm->auto_tdma_adjust = false; ++ } ++} ++ ++void halbtc8821a1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) ++{ ++ /* power save state */ ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ halbtc8821a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8821a1ant_action_wifi_not_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ /* sy modify */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 14); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ } else if (bt_link_info->a2dp_exist && bt_link_info->pan_exist) { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 20); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else if ((BT_8821A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ /* halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); */ ++ /* halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); */ ++ ++ /* Bryant Add */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8821a1ant_action_wifi_not_connected_asso_auth( ++ IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { ++ /* sy modify */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ } else if ((bt_link_info->a2dp_exist) || (bt_link_info->pan_exist)) { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8821a1ant_action_wifi_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ /* sy modify */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 14); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ } else if (bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist) { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 20); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else if ((BT_8821A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ /* halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); */ ++ /* halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); */ ++ ++ /* Bryant Add */ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8821a1ant_action_wifi_connected_specific_packet( ++ IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ /* tdma and coex table */ ++ /* sy modify */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || ++ (bt_link_info->a2dp_exist)) { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } ++ ++ if ((bt_link_info->hid_exist) && (bt_link_info->a2dp_exist)) { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 14); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ } ++ ++ ++ else if (bt_link_info->pan_exist) { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8821a1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_busy = false; ++ boolean scan = false, link = false, roam = false; ++ boolean under_4way = false, ap_enable = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ if (under_4way) { ++ halbtc8821a1ant_action_wifi_connected_specific_packet(btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8821a1ant_action_wifi_connected_scan(btcoexist); ++ else ++ halbtc8821a1ant_action_wifi_connected_specific_packet( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ /* power save state */ ++ if (!ap_enable && ++ BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status && ++ !btcoexist->bt_link_info.hid_only) { ++ if (!wifi_busy && btcoexist->bt_link_info.a2dp_only) /* A2DP */ ++ halbtc8821a1ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ else ++ halbtc8821a1ant_power_save_state(btcoexist, ++ BTC_PS_LPS_ON, 0x50, 0x4); ++ } else ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ ++ /* tdma and coex table */ ++ if (!wifi_busy) { ++ if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8821a1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else if ((BT_8821A_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 2); ++ } ++ } else { ++ if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8821a1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else if ((BT_8821A_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else { ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 2); ++ } ++ } ++} ++ ++void halbtc8821a1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ u8 algorithm = 0; ++ ++ algorithm = halbtc8821a1ant_action_algorithm(btcoexist); ++ coex_dm->cur_algorithm = algorithm; ++ ++ if (halbtc8821a1ant_is_common_action(btcoexist)) { ++ ++ } else { ++ switch (coex_dm->cur_algorithm) { ++ case BT_8821A_1ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_action_sco(btcoexist); ++ break; ++ case BT_8821A_1ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_action_hid(btcoexist); ++ break; ++ case BT_8821A_1ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_action_a2dp(btcoexist); ++ break; ++ case BT_8821A_1ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_action_a2dp_pan_hs(btcoexist); ++ break; ++ case BT_8821A_1ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_action_pan_edr(btcoexist); ++ break; ++ case BT_8821A_1ANT_COEX_ALGO_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HS mode.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_action_pan_hs(btcoexist); ++ break; ++ case BT_8821A_1ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_action_pan_edr_a2dp(btcoexist); ++ break; ++ case BT_8821A_1ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_action_pan_edr_hid(btcoexist); ++ break; ++ case BT_8821A_1ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_action_hid_a2dp_pan_edr( ++ btcoexist); ++ break; ++ case BT_8821A_1ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_action_hid_a2dp(btcoexist); ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = coexist All Off!!\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8821a1ant_coex_all_off(btcoexist); */ ++ break; ++ } ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ } ++} ++ ++void halbtc8821a1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ boolean increase_scan_dev_num = false; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean wifi_under_5g = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if (wifi_under_5g) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_coex_under_5g(btcoexist); ++ return; ++ } ++ if (coex_sta->bt_whck_test) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under WHCK TEST!!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_action_bt_whck_test(btcoexist); ++ return; ++ } ++ ++ if ((BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8821A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ increase_scan_dev_num = true; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, ++ &increase_scan_dev_num); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ if ((num_of_wifi_link >= 2) || ++ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { ++ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ halbtc8821a1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (!bt_link_info->sco_exist && !bt_link_info->hid_exist) ++ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ else { ++ if (wifi_connected) { ++ wifi_rssi_state = halbtc8821a1ant_wifi_rssi_state( ++ btcoexist, 1, 2, 30, 0); ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ /* halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 1, 1); */ ++ halbtc8821a1ant_limited_tx(btcoexist, ++ NORMAL_EXEC, 1, 1, 0, 1); ++ } else { ++ /* halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 1, 1); */ ++ halbtc8821a1ant_limited_tx(btcoexist, ++ NORMAL_EXEC, 1, 1, 0, 1); ++ } ++ } else ++ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, ++ 0, 0); ++ ++ } ++ ++ if (bt_link_info->sco_exist) { ++ bt_ctrl_agg_buf_size = true; ++ agg_buf_size = 0x3; ++ } else if (bt_link_info->hid_exist) { ++ bt_ctrl_agg_buf_size = true; ++ agg_buf_size = 0x5; ++ } else if (bt_link_info->a2dp_exist || bt_link_info->pan_exist) { ++ bt_ctrl_agg_buf_size = true; ++ agg_buf_size = 0x8; ++ } ++ halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ halbtc8821a1ant_run_sw_coexist_mechanism(btcoexist); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8821a1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8821a1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ ++ if (!wifi_connected) { ++ boolean scan = false, link = false, roam = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is non connected-idle !!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8821a1ant_action_wifi_not_connected_scan( ++ btcoexist); ++ else ++ halbtc8821a1ant_action_wifi_not_connected_asso_auth( ++ btcoexist); ++ } else ++ halbtc8821a1ant_action_wifi_not_connected(btcoexist); ++ } else /* wifi LPS/Busy */ ++ halbtc8821a1ant_action_wifi_connected(btcoexist); ++} ++ ++void halbtc8821a1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ /* force to reset coex mechanism */ ++ /* sw all off */ ++ halbtc8821a1ant_sw_mechanism(btcoexist, false); ++ ++ /* halbtc8821a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ ++ halbtc8821a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++} ++ ++void halbtc8821a1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean back_up, IN boolean wifi_only) ++{ ++ u8 u8tmp = 0; ++ boolean wifi_under_5g = false; ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 1Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (wifi_only) ++ return; ++ ++ if (back_up) { ++ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, ++ 0x430); ++ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, ++ 0x434); ++ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( ++ btcoexist, 0x42a); ++ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( ++ btcoexist, 0x456); ++ } ++ ++ /* 0x790[5:0]=0x5 */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); ++ u8tmp &= 0xc0; ++ u8tmp |= 0x5; ++ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ /* Antenna config */ ++ if (wifi_under_5g) ++ halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, true, ++ false); ++ else ++ halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, true, ++ false); ++ ++ /* PTA parameter */ ++ halbtc8821a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ /* Enable counter statistics */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, ++ 0xc); /* 0x76e[3] =1, WLAN_Act control by PTA */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); ++} ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8821a1ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8821a1ant_ ++ * ************************************************************ */ ++void ex_halbtc8821a1ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++} ++ ++void ex_halbtc8821a1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ halbtc8821a1ant_init_hw_config(btcoexist, true, wifi_only); ++} ++ ++void ex_halbtc8821a1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = false; ++ ++ halbtc8821a1ant_init_coex_dm(btcoexist); ++ ++ halbtc8821a1ant_query_bt_info(btcoexist); ++} ++ ++void ex_halbtc8821a1ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; ++ u16 u16tmp[4]; ++ u32 u32tmp[4]; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ if (btcoexist->stop_coex_dm) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Coex is STOPPED]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", ++ "Ant PG Num/ Ant Mech/ Ant Pos:", ++ board_info->pg_ant_num, board_info->btdm_ant_num, ++ board_info->btdm_ant_pos); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", ++ "CoexVer/ FwVer/ PatchVer", ++ glcoex_ver_date_8821a_1ant, glcoex_ver_8821a_1ant, fw_ver, ++ bt_patch_ver, bt_patch_ver); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") ++ : ((BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi, coex_sta->bt_retry_cnt); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", ++ "SCO/HID/PAN/A2DP", ++ bt_link_info->sco_exist, bt_link_info->hid_exist, ++ bt_link_info->pan_exist, bt_link_info->a2dp_exist); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_BT_LINK_INFO); ++ ++ bt_info_ext = coex_sta->bt_info_ext; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "BT Info A2DP rate", ++ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); ++ CL_PRINTF(cli_buf); ++ ++ for (i = 0; i < BT_INFO_SRC_8821A_1ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8821a_1ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ if (!btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "SM[LowPenaltyRA]", ++ coex_dm->cur_low_penalty_ra); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms]============"); ++ CL_PRINTF(cli_buf); ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case, ++ coex_dm->auto_tdma_adjust); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", ++ "IgnWlanAct", ++ coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", ++ "Latest error condition(should be 0)", ++ coex_dm->error_condition); ++ CL_PRINTF(cli_buf); ++ } ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "backup ARFR1/ARFR2/RL/AMaxTime", ++ coex_dm->backup_arfr_cnt1, coex_dm->backup_arfr_cnt2, ++ coex_dm->backup_retry_limit, ++ coex_dm->backup_ampdu_max_time); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); ++ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "0x430/0x434/0x42a/0x456", ++ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc58); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x778/ 0xc58[29:25]", ++ u8tmp[0], (u32tmp[0] & 0x3e000000) >> 25); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x8db); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8db[6:5]", ++ ((u8tmp[0] & 0x60) >> 5)); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x975); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0xcb4[29:28]/0xcb4[7:0]/0x974[9:8]", ++ (u32tmp[0] & 0x30000000) >> 28, u32tmp[0] & 0xff, ++ u8tmp[0] & 0x3); ++ CL_PRINTF(cli_buf); ++ ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x64); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x40/0x4c[24:23]/0x64[0]", ++ u8tmp[0], ((u32tmp[0] & 0x01800000) >> 23), u8tmp[1] & 0x1); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x550(bcn ctrl)/0x522", ++ u32tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", ++ u32tmp[0] & 0xff); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5d); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "OFDM-FA/ CCK-FA", ++ u32tmp[0], (u8tmp[0] << 8) + u8tmp[1]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8(coexTable)", ++ u32tmp[0], u32tmp[1], u32tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770(high-pri rx/tx)", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(low-pri rx/tx)", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++#if (BT_AUTO_REPORT_ONLY_8821A_1ANT == 1) ++ halbtc8821a1ant_monitor_bt_ctr(btcoexist); ++#endif ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++void ex_halbtc8821a1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ boolean wifi_under_5g = false; ++ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, ++ &wifi_under_5g); ++ if (wifi_under_5g) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_coex_under_5g(btcoexist); ++ return; ++ } ++ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, ++ true); ++ /* halbtc8821a1ant_set_ant_path_d_cut(btcoexist, false, false, false, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); */ ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = false; ++ ++ halbtc8821a1ant_init_hw_config(btcoexist, false, false); ++ halbtc8821a1ant_init_coex_dm(btcoexist); ++ halbtc8821a1ant_query_bt_info(btcoexist); ++ } ++} ++ ++void ex_halbtc8821a1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ ++ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ } ++} ++ ++void ex_halbtc8821a1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ boolean wifi_under_5g = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if (wifi_under_5g) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_coex_under_5g(btcoexist); ++ return; ++ } ++ ++ if (BTC_SCAN_START == type) { ++ coex_sta->wifi_is_high_pri_task = true; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, ++ 8); /* Force antenna setup for no scan result issue */ ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if (coex_sta->bt_disabled) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ halbtc8821a1ant_query_bt_info(btcoexist); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ if (num_of_wifi_link >= 2) { ++ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ halbtc8821a1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8821a1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8821a1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ if (BTC_SCAN_START == type) { ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8821a1ant_action_wifi_not_connected_scan( ++ btcoexist); ++ else /* wifi is connected */ ++ halbtc8821a1ant_action_wifi_connected_scan(btcoexist); ++ } else if (BTC_SCAN_FINISH == type) { ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8821a1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8821a1ant_action_wifi_connected(btcoexist); ++ } ++} ++ ++void ex_halbtc8821a1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ boolean wifi_under_5g = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if (wifi_under_5g) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_coex_under_5g(btcoexist); ++ return; ++ } ++ ++ if (BTC_ASSOCIATE_START == type) { ++ coex_sta->wifi_is_high_pri_task = true; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->arp_cnt = 0; ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->arp_cnt = 0; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ if (num_of_wifi_link >= 2) { ++ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ halbtc8821a1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8821a1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8821a1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ if (BTC_ASSOCIATE_START == type) ++ halbtc8821a1ant_action_wifi_not_connected_asso_auth(btcoexist); ++ else if (BTC_ASSOCIATE_FINISH == type) { ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8821a1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8821a1ant_action_wifi_connected(btcoexist); ++ } ++} ++ ++void ex_halbtc8821a1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ boolean wifi_under_5g = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if (wifi_under_5g) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_coex_under_5g(btcoexist); ++ return; ++ } ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->arp_cnt = 0; ++ } ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ /* h2c_parameter[0] = 0x1; */ ++ h2c_parameter[0] = 0x0; ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); ++} ++ ++void ex_halbtc8821a1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ boolean wifi_under_5g = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if (wifi_under_5g) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_coex_under_5g(btcoexist); ++ return; ++ } ++ ++ if (BTC_PACKET_DHCP == type || ++ BTC_PACKET_EAPOL == type || ++ BTC_PACKET_ARP == type) { ++ coex_sta->wifi_is_high_pri_task = true; ++ ++ if (BTC_PACKET_ARP == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ARP notify\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet DHCP or EAPOL notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet [Type = %d] notify\n", type); ++ BTC_TRACE(trace_buf); ++ } ++ ++ coex_sta->specific_pkt_period_cnt = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ if (num_of_wifi_link >= 2) { ++ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ halbtc8821a1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8821a1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8821a1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ if (BTC_PACKET_DHCP == type || ++ BTC_PACKET_EAPOL == type || ++ BTC_PACKET_ARP == type) { ++ if (BTC_PACKET_ARP == type) { ++ coex_dm->arp_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ARP Packet Count = %d\n", ++ coex_dm->arp_cnt); ++ BTC_TRACE(trace_buf); ++ if (coex_dm->arp_cnt >= ++ 10) /* if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecificPacket(btcoexist) */ ++ return; ++ } ++ ++ halbtc8821a1ant_action_wifi_connected_specific_packet(btcoexist); ++ } ++} ++ ++void ex_halbtc8821a1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 bt_info = 0; ++ u8 i, rsp_source = 0; ++ boolean wifi_connected = false; ++ boolean bt_busy = false; ++ boolean wifi_under_5g = false; ++ ++ ++ coex_sta->c2h_bt_info_req_sent = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8821A_1ANT_MAX) ++ rsp_source = BT_INFO_SRC_8821A_1ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ if (i == 1) ++ bt_info = tmp_buf[i]; ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ /* if 0xff, it means BT is under WHCK test */ ++ if (bt_info == 0xff) ++ coex_sta->bt_whck_test = true; ++ else ++ coex_sta->bt_whck_test = false; ++ ++ if (BT_INFO_SRC_8821A_1ANT_WIFI_FW != rsp_source) { ++ coex_sta->bt_retry_cnt = /* [3:0] */ ++ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ++ coex_sta->c2h_bt_page = true; ++ else ++ coex_sta->c2h_bt_page = false; ++ ++ coex_sta->bt_rssi = ++ coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; ++ ++ coex_sta->bt_info_ext = ++ coex_sta->bt_info_c2h[rsp_source][4]; ++ ++ coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] ++ & 0x40); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, ++ &coex_sta->bt_tx_rx_mask); ++ if (!coex_sta->bt_tx_rx_mask) { ++ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, ++ 0x3c, 0x15); ++ } ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ if (coex_sta->bt_info_ext & BIT(1)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (wifi_connected) ++ ex_halbtc8821a1ant_media_status_notify( ++ btcoexist, BTC_MEDIA_CONNECT); ++ else ++ ex_halbtc8821a1ant_media_status_notify( ++ btcoexist, BTC_MEDIA_DISCONNECT); ++ } ++ ++ if ((coex_sta->bt_info_ext & BIT(3)) && !wifi_under_5g) { ++ if (!btcoexist->manual_control && ++ !btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_ignore_wlan_act(btcoexist, ++ FORCE_EXEC, false); ++ } ++ } else { ++ /* BT already NOT ignore Wlan active, do nothing here. */ ++ } ++#if (BT_AUTO_REPORT_ONLY_8821A_1ANT == 0) ++ if ((coex_sta->bt_info_ext & BIT(4))) { ++ /* BT auto report already enabled, do nothing */ ++ } else ++ halbtc8821a1ant_bt_auto_report(btcoexist, FORCE_EXEC, ++ true); ++#endif ++ } ++ ++ /* check BIT2 first ==> check if bt is under inquiry or page scan */ ++ if (bt_info & BT_INFO_8821A_1ANT_B_INQ_PAGE) ++ coex_sta->c2h_bt_inquiry_page = true; ++ else ++ coex_sta->c2h_bt_inquiry_page = false; ++ ++ /* set link exist status */ ++ if (!(bt_info & BT_INFO_8821A_1ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (bt_info & BT_INFO_8821A_1ANT_B_FTP) ++ coex_sta->pan_exist = true; ++ else ++ coex_sta->pan_exist = false; ++ if (bt_info & BT_INFO_8821A_1ANT_B_A2DP) ++ coex_sta->a2dp_exist = true; ++ else ++ coex_sta->a2dp_exist = false; ++ if (bt_info & BT_INFO_8821A_1ANT_B_HID) ++ coex_sta->hid_exist = true; ++ else ++ coex_sta->hid_exist = false; ++ if (bt_info & BT_INFO_8821A_1ANT_B_SCO_ESCO) ++ coex_sta->sco_exist = true; ++ else ++ coex_sta->sco_exist = false; ++ } ++ ++ halbtc8821a1ant_update_bt_link_info(btcoexist); ++ ++ bt_info = bt_info & ++ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ ++ ++ if (!(bt_info & BT_INFO_8821A_1ANT_B_CONNECTION)) { ++ coex_dm->bt_status = BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info == ++ BT_INFO_8821A_1ANT_B_CONNECTION) { /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if ((bt_info & BT_INFO_8821A_1ANT_B_SCO_ESCO) || ++ (bt_info & BT_INFO_8821A_1ANT_B_SCO_BUSY)) { ++ coex_dm->bt_status = BT_8821A_1ANT_BT_STATUS_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info & BT_INFO_8821A_1ANT_B_ACL_BUSY) { ++ if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) ++ coex_dm->auto_tdma_adjust = false; ++ coex_dm->bt_status = BT_8821A_1ANT_BT_STATUS_ACL_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ coex_dm->bt_status = BT_8821A_1ANT_BT_STATUS_MAX; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if ((BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8821A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ bt_busy = true; ++ else ++ bt_busy = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ halbtc8821a1ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8821a1ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_under_5g = false; ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if (wifi_under_5g) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_coex_under_5g(btcoexist); ++ return; ++ } ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8821a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, true); ++ /* halbtc8821a1ant_set_ant_path_d_cut(btcoexist, false, false, false, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); */ ++ ++ halbtc8821a1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ++ ex_halbtc8821a1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++ ++ btcoexist->stop_coex_dm = true; ++} ++ ++void ex_halbtc8821a1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ boolean wifi_under_5g = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if (wifi_under_5g) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a1ant_coex_under_5g(btcoexist); ++ return; ++ } ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_WIFI_PNP_SLEEP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, ++ true); ++ /* halbtc8821a1ant_set_ant_path_d_cut(btcoexist, false, false, false, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); */ ++ ++ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ ++ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ ++ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ ++ coex_sta->under_ips = false; ++ coex_sta->under_lps = false; ++ btcoexist->stop_coex_dm = true; ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->stop_coex_dm = false; ++ halbtc8821a1ant_init_hw_config(btcoexist, false, false); ++ halbtc8821a1ant_init_coex_dm(btcoexist); ++ halbtc8821a1ant_query_bt_info(btcoexist); ++ } ++} ++ ++void ex_halbtc8821a1ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++#if (BT_AUTO_REPORT_ONLY_8821A_1ANT == 0) ++ halbtc8821a1ant_query_bt_info(btcoexist); ++ halbtc8821a1ant_monitor_bt_ctr(btcoexist); ++ halbtc8821a1ant_monitor_bt_enable_disable(btcoexist); ++#else ++ if (halbtc8821a1ant_is_wifi_status_changed(btcoexist) || ++ coex_dm->auto_tdma_adjust) { ++ /* if(coex_sta->specific_pkt_period_cnt > 2) */ ++ /* { */ ++ halbtc8821a1ant_run_coexist_mechanism(btcoexist); ++ /* } */ ++ } ++ ++ coex_sta->specific_pkt_period_cnt++; ++#endif ++} ++ ++#endif ++ ++#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.h 2018-02-11 21:44:27.147146086 +0200 +@@ -0,0 +1,197 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8821A_SUPPORT == 1) ++ ++/* ******************************************* ++ * The following is for 8821A 1ANT BT Co-exist definition ++ * ******************************************* */ ++#define BT_AUTO_REPORT_ONLY_8821A_1ANT 1 ++ ++#define BT_INFO_8821A_1ANT_B_FTP BIT(7) ++#define BT_INFO_8821A_1ANT_B_A2DP BIT(6) ++#define BT_INFO_8821A_1ANT_B_HID BIT(5) ++#define BT_INFO_8821A_1ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8821A_1ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8821A_1ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8821A_1ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8821A_1ANT_B_CONNECTION BIT(0) ++ ++#define BT_INFO_8821A_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ ++ (((_BT_INFO_EXT_&BIT(0))) ? true : false) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT 2 ++ ++enum bt_info_src_8821a_1ant { ++ BT_INFO_SRC_8821A_1ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8821A_1ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8821A_1ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8821A_1ANT_MAX ++}; ++ ++enum bt_8821a_1ant_bt_status { ++ BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8821A_1ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8821A_1ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8821A_1ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8821A_1ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8821a_1ant_wifi_status { ++ BT_8821A_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8821A_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, ++ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, ++ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, ++ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, ++ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, ++ BT_8821A_1ANT_WIFI_STATUS_MAX ++}; ++ ++enum bt_8821a_1ant_coex_algo { ++ BT_8821A_1ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8821A_1ANT_COEX_ALGO_SCO = 0x1, ++ BT_8821A_1ANT_COEX_ALGO_HID = 0x2, ++ BT_8821A_1ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8821A_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, ++ BT_8821A_1ANT_COEX_ALGO_PANEDR = 0x5, ++ BT_8821A_1ANT_COEX_ALGO_PANHS = 0x6, ++ BT_8821A_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, ++ BT_8821A_1ANT_COEX_ALGO_PANEDR_HID = 0x8, ++ BT_8821A_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, ++ BT_8821A_1ANT_COEX_ALGO_HID_A2DP = 0xa, ++ BT_8821A_1ANT_COEX_ALGO_MAX = 0xb, ++}; ++ ++struct coex_dm_8821a_1ant { ++ /* fw mechanism */ ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean auto_tdma_adjust; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++ ++ /* sw mechanism */ ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ ++ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ ++ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ ++ u16 backup_retry_limit; ++ u8 backup_ampdu_max_time; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ u32 pre_ra_mask; ++ u32 cur_ra_mask; ++ u8 pre_arfr_type; ++ u8 cur_arfr_type; ++ u8 pre_retry_limit_type; ++ u8 cur_retry_limit_type; ++ u8 pre_ampdu_time_type; ++ u8 cur_ampdu_time_type; ++ u32 arp_cnt; ++ ++ u8 error_condition; ++}; ++ ++struct coex_sta_8821a_1ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 specific_pkt_period_cnt; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ u8 bt_rssi; ++ boolean bt_tx_rx_mask; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ boolean c2h_bt_info_req_sent; ++ u8 bt_info_c2h[BT_INFO_SRC_8821A_1ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8821A_1ANT_MAX]; ++ boolean c2h_bt_inquiry_page; ++ boolean c2h_bt_page; /* Add for win8.1 page out issue */ ++ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++ boolean ++ bt_whck_test; /* Add for ASUS WHQL TEST that enable wifi test bt */ ++}; ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8821a1ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821a1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8821a1ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821a1ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821a1ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821a1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821a1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821a1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821a1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821a1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8821a1ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821a1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state); ++void ex_halbtc8821a1ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821a1ant_display_coex_info(IN struct btc_coexist *btcoexist); ++ ++#else ++#define ex_halbtc8821a1ant_power_on_setting(btcoexist) ++#define ex_halbtc8821a1ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8821a1ant_init_coex_dm(btcoexist) ++#define ex_halbtc8821a1ant_ips_notify(btcoexist, type) ++#define ex_halbtc8821a1ant_lps_notify(btcoexist, type) ++#define ex_halbtc8821a1ant_scan_notify(btcoexist, type) ++#define ex_halbtc8821a1ant_connect_notify(btcoexist, type) ++#define ex_halbtc8821a1ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8821a1ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8821a1ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8821a1ant_halt_notify(btcoexist) ++#define ex_halbtc8821a1ant_pnp_notify(btcoexist, pnp_state) ++#define ex_halbtc8821a1ant_periodical(btcoexist) ++#define ex_halbtc8821a1ant_display_coex_info(btcoexist) ++ ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.c 2018-02-11 21:44:27.147146086 +0200 +@@ -0,0 +1,4560 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8821A Co-exist mechanism ++ * ++ * History ++ * 2012/11/15 Cosa first check in. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8821A_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8821a_2ant glcoex_dm_8821a_2ant; ++static struct coex_dm_8821a_2ant *coex_dm = &glcoex_dm_8821a_2ant; ++static struct coex_sta_8821a_2ant glcoex_sta_8821a_2ant; ++static struct coex_sta_8821a_2ant *coex_sta = &glcoex_sta_8821a_2ant; ++ ++const char *const glbt_info_src_8821a_2ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++u32 glcoex_ver_date_8821a_2ant = 20150921; ++u32 glcoex_ver_8821a_2ant = 0x58; ++/* modify 20140903v43 a2dpandhid tdmaonoff a2dp glitch _ tdma off 778=3(case1)->778=1(case0) ++ * and to improve tp while a2dphid case23->case25 , case123->case125 for asus spec ++ * and modify for asus bt WHQL test _ tdma off_ 778=3->1_ ++ * ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8821a2ant_ ++ * ************************************************************ */ ++u8 halbtc8821a2ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_bt_rssi_state; ++ } ++ ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8821a2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_wifi_rssi_state[index]; ++ } ++ ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8821a2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ ++ /* This function check if bt is disabled */ ++ ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is enabled !!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ bt_disable_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], bt all counters=0, %d times!!\n", ++ bt_disable_cnt); ++ BTC_TRACE(trace_buf); ++ if (bt_disable_cnt >= 2) { ++ bt_disabled = true; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_disabled = bt_disabled; ++ if (!bt_disabled) { ++ } else { ++ } ++ } ++} ++ ++void halbtc8821a2ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++} ++ ++void halbtc8821a2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ if ((coex_sta->low_priority_rx >= 950) && ++ (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) && ++ (!coex_sta->under_ips)) ++ bt_link_info->slave_role = true; ++ else ++ bt_link_info->slave_role = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ reg_hp_txrx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx); ++ BTC_TRACE(trace_buf); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ reg_lp_txrx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx); ++ BTC_TRACE(trace_buf); ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++} ++ ++void halbtc8821a2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) ++{ ++ if (coex_sta->under_ips) { ++ coex_sta->crc_ok_cck = 0; ++ coex_sta->crc_ok_11g = 0; ++ coex_sta->crc_ok_11n = 0; ++ coex_sta->crc_ok_11n_agg = 0; ++ ++ coex_sta->crc_err_cck = 0; ++ coex_sta->crc_err_11g = 0; ++ coex_sta->crc_err_11n = 0; ++ coex_sta->crc_err_11n_agg = 0; ++ } else { ++ coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, ++ 0xf88); ++ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf94); ++ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf90); ++ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xfb8); ++ ++ coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, ++ 0xf84); ++ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf96); ++ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf92); ++ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xfba); ++ } ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); ++} ++ ++void halbtc8821a2ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ coex_sta->c2h_bt_info_req_sent = true; ++ ++ h2c_parameter[0] |= BIT(0); /* trigger */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); ++} ++ ++boolean halbtc8821a2ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) ++{ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ ++ ++ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 3, ++ 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); ++ ++ if ((BTC_RSSI_STATE_HIGH == wifi_rssi_state) || ++ (BTC_RSSI_STATE_LOW == wifi_rssi_state)) ++ return true; ++ ++ } ++ ++ return false; ++} ++ ++void halbtc8821a2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if (bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if (!bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++} ++ ++u8 halbtc8821a2ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8821A_2ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (!bt_link_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No BT link exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (bt_link_info->sco_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->hid_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->pan_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 1) { ++ if (bt_link_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; ++ } else { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_2ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_2ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_2ANT_COEX_ALGO_HID_A2DP; ++ } ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_2ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_2ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(HS) ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(EDR) ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_2ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++void halbtc8821a2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, ++ IN u8 dac_swing_lvl) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ /* There are several type of dacswing */ ++ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ ++ h2c_parameter[0] = dac_swing_lvl; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); ++} ++ ++void halbtc8821a2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN u8 dec_bt_pwr_lvl) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = dec_bt_pwr_lvl; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); ++} ++ ++void halbtc8821a2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 dec_bt_pwr_lvl) ++{ ++ coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) ++ return; ++ } ++ halbtc8821a2ant_set_fw_dec_bt_pwr(btcoexist, ++ coex_dm->cur_bt_dec_pwr_lvl); ++ ++ coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; ++} ++ ++void halbtc8821a2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8821a2ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ halbtc8821a2ant_set_bt_auto_report(btcoexist, ++ coex_dm->cur_bt_auto_report); ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++void halbtc8821a2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 fw_dac_swing_lvl) ++{ ++ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_fw_dac_swing_lvl == ++ coex_dm->cur_fw_dac_swing_lvl) ++ return; ++ } ++ ++ halbtc8821a2ant_set_fw_dac_swing_level(btcoexist, ++ coex_dm->cur_fw_dac_swing_lvl); ++ ++ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; ++} ++ ++void halbtc8821a2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist *btcoexist, ++ IN boolean rx_rf_shrink_on) ++{ ++ if (rx_rf_shrink_on) { ++ /* Shrink RF Rx LPF corner */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Shrink RF Rx LPF corner!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff, ++ 0xffffc); ++ } else { ++ /* Resume RF Rx LPF corner */ ++ /* After initialized, we can use coex_dm->bt_rf_0x1e_backup */ ++ if (btcoexist->initilized) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Resume RF Rx LPF corner!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, ++ 0xfffff, coex_dm->bt_rf_0x1e_backup); ++ } ++ } ++} ++ ++void halbtc8821a2ant_rf_shrink(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rx_rf_shrink_on) ++{ ++ coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_rf_rx_lpf_shrink == ++ coex_dm->cur_rf_rx_lpf_shrink) ++ return; ++ } ++ halbtc8821a2ant_set_sw_rf_rx_lpf_corner(btcoexist, ++ coex_dm->cur_rf_rx_lpf_shrink); ++ ++ coex_dm->pre_rf_rx_lpf_shrink = coex_dm->cur_rf_rx_lpf_shrink; ++} ++ ++void halbtc8821a2ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ ++ ++ if (low_penalty_ra) { ++ h2c_parameter[1] |= BIT(0); ++ h2c_parameter[2] = ++ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ ++ h2c_parameter[3] = 0xf5; /* MCS7 or OFDM54 */ ++ h2c_parameter[4] = 0xa0; /* MCS6 or OFDM48 */ ++ h2c_parameter[5] = 0xa0; /* MCS5 or OFDM36 */ ++ /* h2c_parameter[3] = 0xf7; //MCS7 or OFDM54 */ ++ /* h2c_parameter[4] = 0xf8; //MCS6 or OFDM48 */ ++ /* h2c_parameter[5] = 0xf9; //MCS5 or OFDM36 */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); ++} ++ ++void halbtc8821a2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ halbtc8821a2ant_set_sw_penalty_tx_rate_adaptive(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++} ++ ++void halbtc8821a2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, ++ IN u32 level) ++{ ++ u8 val = (u8)level; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Write SwDacSwing = 0x%x\n", level); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc5b, 0x3e, val); ++} ++ ++void halbtc8821a2ant_set_sw_full_time_dac_swing(IN struct btc_coexist ++ *btcoexist, IN boolean sw_dac_swing_on, IN u32 sw_dac_swing_lvl) ++{ ++ if (sw_dac_swing_on) ++ halbtc8821a2ant_set_dac_swing_reg(btcoexist, sw_dac_swing_lvl); ++ else ++ halbtc8821a2ant_set_dac_swing_reg(btcoexist, 0x18); ++} ++ ++ ++void halbtc8821a2ant_dac_swing(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) ++{ ++ coex_dm->cur_dac_swing_on = dac_swing_on; ++ coex_dm->cur_dac_swing_lvl = dac_swing_lvl; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_dac_swing_on == coex_dm->cur_dac_swing_on) && ++ (coex_dm->pre_dac_swing_lvl == ++ coex_dm->cur_dac_swing_lvl)) ++ return; ++ } ++ delay_ms(30); ++ halbtc8821a2ant_set_sw_full_time_dac_swing(btcoexist, dac_swing_on, ++ dac_swing_lvl); ++ ++ coex_dm->pre_dac_swing_on = coex_dm->cur_dac_swing_on; ++ coex_dm->pre_dac_swing_lvl = coex_dm->cur_dac_swing_lvl; ++} ++ ++void halbtc8821a2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, ++ IN boolean adc_back_off) ++{ ++ if (adc_back_off) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB BackOff Level On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x3); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB BackOff Level Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x1); ++ } ++} ++ ++void halbtc8821a2ant_adc_back_off(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean adc_back_off) ++{ ++ coex_dm->cur_adc_back_off = adc_back_off; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) ++ return; ++ } ++ halbtc8821a2ant_set_adc_back_off(btcoexist, coex_dm->cur_adc_back_off); ++ ++ coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; ++} ++ ++void halbtc8821a2ant_set_agc_table(IN struct btc_coexist *btcoexist, ++ IN boolean agc_table_en) ++{ ++ u8 rssi_adjust_val = 0; ++ ++ /* =================BB AGC Gain Table */ ++ if (agc_table_en) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB Agc Table On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6e1A0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6d1B0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6c1C0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6b1D0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6a1E0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x691F0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x68200001); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB Agc Table Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xaa1A0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa91B0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa81C0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa71D0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa61E0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa51F0001); ++ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa4200001); ++ } ++ ++ ++ /* =================RF Gain */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); ++ if (agc_table_en) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Agc Table On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x38fff); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x38ffe); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Agc Table Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x380c3); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x28ce6); ++ } ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xed, 0xfffff, 0x1); ++ if (agc_table_en) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Agc Table On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, ++ 0x38fff); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, ++ 0x38ffe); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Agc Table Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, ++ 0x380c3); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, ++ 0x28ce6); ++ } ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xed, 0xfffff, 0x0); ++ ++ /* set rssi_adjust_val for wifi module. */ ++ if (agc_table_en) ++ rssi_adjust_val = 8; ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, ++ &rssi_adjust_val); ++} ++ ++void halbtc8821a2ant_agc_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean agc_table_en) ++{ ++ coex_dm->cur_agc_table_en = agc_table_en; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) ++ return; ++ } ++ halbtc8821a2ant_set_agc_table(btcoexist, agc_table_en); ++ ++ coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; ++} ++ ++void halbtc8821a2ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8821a2ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ halbtc8821a2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8821a2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_sta->coex_table_type = type; ++ ++ switch (type) { ++ case 0: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x55555555, 0xffffff, 0x3); ++ break; ++ case 1: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5afa5afa, 0xffffff, 0x3); ++ break; ++ case 2: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x5ada5ada, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 3: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ case 4: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0xffffffff, 0xffffffff, 0xffffff, 0x3); ++ break; ++ case 5: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x5fff5fff, 0x5fff5fff, 0xffffff, 0x3); ++ break; ++ case 6: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x55ff55ff, 0x5a5a5a5a, 0xffffff, 0x3); ++ break; ++ case 7: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 8: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 9: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 10: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 11: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 12: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 13: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ case 14: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); ++ break; ++ case 15: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); ++ break; ++ case 16: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0x5fdf5fdf, 0x5fdb5fdb, 0xffffff, 0x3); ++ break; ++ case 17: ++ halbtc8821a2ant_coex_table(btcoexist, force_exec, ++ 0xfafafafa, 0xfafafafa, 0xffffff, 0x3); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8821a2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ if (enable) { ++ h2c_parameter[0] |= BIT(0); /* function enable */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); ++} ++ ++void halbtc8821a2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8821a2ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8821a2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8821a2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ halbtc8821a2ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8821a2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ ++ h2c_parameter[0] = byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = byte5; ++ ++ coex_dm->ps_tdma_para[0] = byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++void halbtc8821a2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, ++ IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, ++ IN boolean limited_dig, IN boolean bt_lna_constrain) ++{ ++ /* ++ u32 wifi_bw; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if(BTC_WIFI_BW_HT40 != wifi_bw) ++ { ++ if (shrink_rx_lpf) ++ shrink_rx_lpf = false; ++ } ++ */ ++ ++ /* halbtc8821a2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); */ ++ halbtc8821a2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); ++} ++ ++void halbtc8821a2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, ++ IN boolean agc_table_shift, IN boolean adc_back_off, ++ IN boolean sw_dac_swing, IN u32 dac_swing_lvl) ++{ ++ /* halbtc8821a2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ ++ /* halbtc8821a2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */ ++ halbtc8821a2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, ++ dac_swing_lvl); ++} ++ ++void halbtc8821a2ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u32 u32tmp = 0; ++ u8 h2c_parameter[2] = {0}; ++ ++ if (init_hwcfg) { ++ /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp &= ~BIT(23); ++ u32tmp |= BIT(24); ++ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x974, 0x3ff); ++ /* btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x77); */ ++ ++ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { ++ /* tell firmware "antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ ++ h2c_parameter[0] = 1; ++ h2c_parameter[1] = 1; ++ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, ++ h2c_parameter); ++ } else { ++ /* tell firmware "no antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ ++ h2c_parameter[0] = 0; ++ h2c_parameter[1] = 1; ++ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, ++ h2c_parameter); ++ } ++ } ++ ++ /* ext switch setting */ ++ switch (ant_pos_type) { ++ case BTC_ANT_WIFI_AT_MAIN: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, ++ 0x30, 0x1); ++ break; ++ case BTC_ANT_WIFI_AT_AUX: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, ++ 0x30, 0x2); ++ break; ++ } ++} ++ ++void halbtc8821a2ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ u8 wifi_rssi_state1, bt_rssi_state; ++ ++ ++ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, ++ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); ++ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, ++ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); ++ ++ if (!(BTC_RSSI_HIGH(wifi_rssi_state1) && ++ BTC_RSSI_HIGH(bt_rssi_state)) && turn_on) { ++ type = type + 100; /* for WiFi RSSI low or BT RSSI low */ ++ } ++ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ return; ++ } ++ if (turn_on) { ++ switch (type) { ++ case 1: ++ default: ++ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); */ ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c, 0x03, 0xf1, 0x90); ++ break; ++ case 2: ++ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); */ ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x2d, 0x03, 0xf1, 0x90); ++ break; ++ case 3: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0xf1, 0x90); ++ break; ++ case 4: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x10, 0x03, 0xf1, 0x90); ++ break; ++ case 5: ++ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); */ ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c, 0x3, 0x70, 0x90); ++ break; ++ case 6: ++ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); */ ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x2d, 0x3, 0x70, 0x90); ++ break; ++ case 7: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0x70, 0x90); ++ break; ++ case 8: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xa3, ++ 0x10, 0x3, 0x70, 0x90); ++ break; ++ case 9: ++ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); */ ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c, 0x03, 0xf1, 0x90); ++ break; ++ case 10: ++ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); */ ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x2d, 0x03, 0xf1, 0x90); ++ break; ++ case 11: ++ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0xa, 0xa, 0xe1, 0x90); */ ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0xf1, 0x90); ++ break; ++ case 12: ++ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); */ ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x10, 0x3, 0xf1, 0x90); ++ break; ++ case 13: ++ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); */ ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c, 0x3, 0x70, 0x90); ++ break; ++ case 14: ++ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); */ ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x2d, 0x3, 0x70, 0x90); ++ break; ++ case 15: ++ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0xa, 0xa, 0x60, 0x90); */ ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0x70, 0x90); ++ break; ++ case 16: ++ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x5, 0x5, 0x60, 0x90); */ ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x10, 0x3, 0x70, 0x90); ++ break; ++ case 17: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xa3, ++ 0x2f, 0x2f, 0x60, 0x90); ++ break; ++ case 18: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x5, 0x5, 0xe1, 0x90); ++ break; ++ case 19: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x25, 0xe1, 0x90); ++ break; ++ case 20: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x25, 0x60, 0x90); ++ break; ++ case 21: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x15, 0x03, 0x70, 0x90); ++ break; ++ case 23: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1e, 0x03, 0xf0, 0x14); ++ break; ++ case 24: ++ case 124: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x3c, 0x03, 0x70, 0x50); ++ break; ++ /* case25/case125 : for lenovo bt pan tp degrade<30% while wifi downlink */ ++ case 25: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x14, 0x03, 0xf1, 0x90); ++ break; ++ case 26: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x30, 0x03, 0xf1, 0x90); ++ break; ++ case 71: ++ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); */ ++ ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c, 0x03, 0xf1, 0x90); ++ break; ++ case 101: ++ case 105: ++ case 171: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x3a, 0x03, 0x70, 0x50); ++ break; ++ case 102: ++ case 106: ++ case 110: ++ case 114: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x2d, 0x03, 0x70, 0x50); ++ break; ++ case 103: ++ case 107: ++ case 111: ++ case 115: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x1c, 0x03, 0x70, 0x50); ++ break; ++ case 104: ++ case 108: ++ case 112: ++ case 116: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x10, 0x03, 0x70, 0x50); ++ break; ++ case 109: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c, 0x03, 0xf1, 0x90); ++ break; ++ case 113: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3c, 0x03, 0x70, 0x90); ++ break; ++ case 121: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x15, 0x03, 0x70, 0x90); ++ break; ++ case 22: ++ case 122: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x35, 0x03, 0x71, 0x11); ++ break; ++ case 123: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x1c, 0x03, 0x70, 0x54); ++ break; ++ /* case25/case125 : for lenovo bt pan tp degrade<30% while wifi downlink */ ++ case 125: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x14, 0x03, 0x70, 0x50); ++ break; ++ case 126: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x30, 0x03, 0x70, 0x50); ++ break; ++ } ++ } else { ++ /* disable PS tdma */ ++ switch (type) { ++ case 0: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x40, 0x0); ++ break; ++ case 1: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x48, 0x0); ++ break; ++ default: ++ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x40, 0x0); ++ break; ++ } ++ } ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++void halbtc8821a2ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 1); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 1); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++void halbtc8821a2ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ boolean low_pwr_disable = false; ++ ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ /* recover to original 32k low power setting */ ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ case BTC_PS_LPS_ON: ++ halbtc8821a2ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8821a2ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ /* when coex force to enter LPS, do not enter 32k low power. */ ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ coex_sta->force_lps_on = true; ++ break; ++ case BTC_PS_LPS_OFF: ++ halbtc8821a2ant_ps_tdma_check_for_power_save_state( ++ btcoexist, false); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ default: ++ break; ++ } ++} ++ ++ ++void halbtc8821a2ant_coex_all_off(IN struct btc_coexist *btcoexist) ++{ ++ /* fw all off */ ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ /* hw all off */ ++ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8821a2ant_coex_under_5g(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a2ant_coex_all_off(btcoexist); ++ ++ halbtc8821a2ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); ++} ++ ++void halbtc8821a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ /* force to reset coex mechanism */ ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8821a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); ++ ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++void halbtc8821a2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ boolean wifi_connected = false; ++ boolean low_pwr_disable = true; ++ boolean scan = false, link = false, roam = false; ++ ++ ++ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, ++ 0); ++ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, ++ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); ++ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, ++ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ if (scan || link || roam) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi link process + BT Inq/Page!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 15); ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ } else if (wifi_connected) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT Inq/Page!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 15); ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi no-link + BT Inq/Page!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ } ++ ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++} ++ ++ ++void halbtc8821a2ant_action_wifi_link_process(IN struct btc_coexist *btcoexist) ++{ ++ u8 u8tmpa, u8tmpb; ++ ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 15); ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ ++ ++ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); ++ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], 0x765=0x%x, 0x76e=0x%x\n", u8tmpa, ++ u8tmpb); ++ BTC_TRACE(trace_buf); ++} ++ ++boolean halbtc8821a2ant_action_wifi_idle_process(IN struct btc_coexist ++ *btcoexist) ++{ ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u8 ap_num = 0; ++ ++ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, ++ 0); ++ /* wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); */ ++ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, ++ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES - 20, 0); ++ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, ++ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); ++ ++ /* define the office environment */ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && ++ (coex_sta->hid_exist == true) && ++ (coex_sta->a2dp_exist == true)) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi idle process for BT HID+A2DP exist!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821a2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x6); ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, ++ false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, ++ 0x18); ++ ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ ++ return true; ++ } ++ ++ /* */ ++ else if (coex_sta->pan_exist == true) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi idle process for BT PAN exist!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821a2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x6); ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, ++ false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, ++ 0x18); ++ ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ ++ return true; ++ } ++ ++ else { ++ halbtc8821a2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x18); ++ return false; ++ } ++ ++ ++} ++ ++ ++ ++boolean halbtc8821a2ant_is_common_action(IN struct btc_coexist *btcoexist) ++{ ++ boolean common = false, wifi_connected = false, wifi_busy = false; ++ boolean bt_hs_on = false, low_pwr_disable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (!wifi_connected) { ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non-connected idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, ++ 0x0); ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, ++ false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, ++ 0x18); ++ ++ common = true; ++ } else { ++ if (BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, ++ false, false, 0x8); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, ++ 0xfffff, 0x0); ++ halbtc8821a2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 0); ++ ++ halbtc8821a2ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 1); ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, ++ 0xb); ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, ++ false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++ common = true; ++ } else if (BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ ++ if (bt_hs_on) ++ return false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, ++ false, false, 0x8); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, ++ 0xfffff, 0x0); ++ halbtc8821a2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 0); ++ ++ halbtc8821a2ant_power_save_state(btcoexist, ++ BTC_PS_WIFI_NATIVE, 0x0, 0x0); ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 1); ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, ++ 0xb); ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++ common = true; ++ } else { ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ common = false; ++ /* common = halbtc8821a2ant_action_wifi_idle_process(btcoexist); */ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ /* common = false; */ ++ common = halbtc8821a2ant_action_wifi_idle_process( ++ btcoexist); ++ } ++ } ++ } ++ ++ return common; ++} ++void halbtc8821a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, ++ IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) ++{ ++ static s32 up, dn, m, n, wait_count; ++ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ ++ u8 retry_count = 0; ++ ++ if (!coex_dm->auto_tdma_adjust) { ++ coex_dm->auto_tdma_adjust = true; ++ { ++ if (sco_hid) { ++ if (tx_pause) { ++ if (max_interval == 1) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 13); ++ coex_dm->ps_tdma_du_adj_type = ++ 13; ++ } else if (max_interval == 2) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (max_interval == 3) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } ++ } else { ++ if (max_interval == 1) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = ++ 9; ++ } else if (max_interval == 2) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (max_interval == 3) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } ++ } ++ } else { ++ if (tx_pause) { ++ if (max_interval == 1) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 5); ++ coex_dm->ps_tdma_du_adj_type = ++ 5; ++ } else if (max_interval == 2) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (max_interval == 3) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } ++ } else { ++ if (max_interval == 1) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (max_interval == 2) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (max_interval == 3) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } ++ } ++ } ++ } ++ /* ============ */ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n = 3; ++ result = 0; ++ wait_count = 0; ++ } else { ++ /* accquire the BT TRx retry count from BT_Info byte2 */ ++ retry_count = coex_sta->bt_retry_cnt; ++ result = 0; ++ wait_count++; ++ ++ if (retry_count == ++ 0) { /* no retry in the last 2-second duration */ ++ up++; ++ dn--; ++ ++ if (dn <= 0) ++ dn = 0; ++ ++ if (up >= n) { /* if s n 2 retry count0, hռeWiFi duration */ ++ wait_count = 0; ++ n = 3; ++ up = 0; ++ dn = 0; ++ result = 1; ++ } ++ } else if (retry_count <= ++ 3) { /* <=3 retry in the last 2-second duration */ ++ up--; ++ dn++; ++ ++ if (up <= 0) ++ up = 0; ++ ++ if (dn == 2) { /* if s 2 2 retry count< 3, hկWiFi duration */ ++ if (wait_count <= 2) ++ m++; /* קK@blevelӦ^ */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ } else { /* retry count > 3, un1 retry count > 3, hկWiFi duration */ ++ if (wait_count == 1) ++ m++; /* קK@blevelӦ^ */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ ++ if (max_interval == 1) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 71) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 5); ++ coex_dm->ps_tdma_du_adj_type = 5; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 5); ++ coex_dm->ps_tdma_du_adj_type = 5; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 13); ++ coex_dm->ps_tdma_du_adj_type = 13; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 5); ++ coex_dm->ps_tdma_du_adj_type = ++ 5; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 13); ++ coex_dm->ps_tdma_du_adj_type = ++ 13; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 71); ++ coex_dm->ps_tdma_du_adj_type = 71; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 71) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 71); ++ coex_dm->ps_tdma_du_adj_type = ++ 71; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = ++ 9; ++ } ++ } ++ } ++ } else if (max_interval == 2) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } ++ } ++ } ++ } else if (max_interval == 3) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8821a2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821a2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } ++ } ++ } ++ } ++ } ++ ++ /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ ++ /* then we have to adjust it back to the previous record one. */ ++ if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { ++ boolean scan = false, link = false, roam = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", ++ coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (!scan && !link && !roam) ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ coex_dm->ps_tdma_du_adj_type); ++ else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } ++} ++ ++/* SCO only or SCO+PAN(HS) */ ++void halbtc8821a2ant_action_sco(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 wifi_rssi_state, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, ++ 0); ++ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, ++ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 4); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for SCO quality at 11b/g mode */ ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ else { /* for SCO quality & wifi performance balance at 11n mode */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ halbtc8821a2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 8); ++ else { ++ if (bt_link_info->sco_only) ++ halbtc8821a2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 17); ++ else ++ halbtc8821a2ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 12); ++ } ++ } ++ ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 0); /* for voice quality */ ++ ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ true, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ true, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ true, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ true, 0x18); ++ } ++ } ++} ++ ++ ++void halbtc8821a2ant_action_hid(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, ++ 0); ++ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, ++ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ else /* for HID quality & wifi performance balance at 11n mode */ ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 24); ++ ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ ++void halbtc8821a2ant_action_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ u8 ap_num = 0; ++ ++ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, ++ 0); ++ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, ++ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); ++ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, ++ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); ++ ++ /* define the office environment */ ++ if ((ap_num >= 10) && BTC_RSSI_HIGH(wifi_rssi_state1) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ /* dbg_print(" AP#>10(%d)\n", ap_num); */ ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, ++ 0x0); ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x8); ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ /* halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); */ ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); ++ ++ /* sw mechanism */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ true, 0x6); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ true, 0x6); ++ } ++ return; ++ ++ } ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ } else { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 13); ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ /* halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, false, 1); */ ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); ++ } else { ++ /* halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, true, 1); */ ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); ++ } ++ ++ /* sw mechanism */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8821a2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, ++ 0); ++ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, ++ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); ++ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, ++ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ } else { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 13); ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ ++ halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, true, 2); ++ ++ /* sw mechanism */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8821a2ant_action_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, ++ 0); ++ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, ++ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); ++ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, ++ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 10); ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ } else { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 13); ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 26); ++ else ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 26); ++ ++ /* sw mechanism */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++ ++/* PAN(HS) only */ ++void halbtc8821a2ant_action_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, ++ 0); ++ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, ++ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); ++ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, ++ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++/* PAN(EDR)+A2DP */ ++void halbtc8821a2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, ++ 0); ++ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, ++ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); ++ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, ++ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ else ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 12); ++ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, ++ true, 3); ++ else ++ halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, ++ false, 3); ++ } else { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 13); ++ halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, true, 3); ++ } ++ ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8821a2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, ++ 0); ++ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, ++ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); ++ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, ++ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ } else { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 14); ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, ++ 3); ++ /* halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 11); */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, ++ 0xfffff, 0x780); ++ } else { ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, ++ 6); ++ /* halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, ++ 0xfffff, 0x0); ++ } ++ halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, false, 2); ++ } else { ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ /* halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, ++ 0x0); ++ halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, true, 2); ++ } ++ ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++/* HID+A2DP+PAN(EDR) */ ++void halbtc8821a2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, ++ 0); ++ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, ++ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); ++ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, ++ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); ++ ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ } else { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 14); ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, ++ true, 3); ++ else ++ halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, ++ false, 3); ++ } else ++ halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, true, 3); ++ ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8821a2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; ++ u32 wifi_bw; ++ u8 ap_num = 0; ++ ++ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, ++ 0); ++ /* bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, 29, 0); */ ++ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, ++ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); ++ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(3, ++ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 37); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); ++ ++ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x5); ++ ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_LEGACY == wifi_bw) { ++ if (BTC_RSSI_HIGH(bt_rssi_state)) ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ } else { ++ /* only 802.11N mode we have to dec bt power to 4 degree */ ++ if (BTC_RSSI_HIGH(bt_rssi_state)) { ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &ap_num); ++ /* need to check ap Number of Not */ ++ if (ap_num < 10) ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, ++ NORMAL_EXEC, 4); ++ else ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, ++ NORMAL_EXEC, 2); ++ } else if (BTC_RSSI_MEDIUM(bt_rssi_state)) ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ else ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ } ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, ++ 0x0, 0x0); ++ } else { ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 14); ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ /* halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, false, 3); */ ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); ++ } else { ++ /* halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, true, 3); */ ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); ++ } ++ ++ /* sw mechanism */ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } else { ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, ++ false, 0x18); ++ } else { ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ } ++ } ++} ++ ++void halbtc8821a2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8821a2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ /* hw all off */ ++ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ ++ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++} ++ ++void halbtc8821a2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_under_5g = false; ++ u8 algorithm = 0; ++ u32 num_of_wifi_link = 0; ++ u32 wifi_link_status = 0; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean miracast_plus_bt = false; ++ boolean scan = false, link = false, roam = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if (wifi_under_5g) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), run 5G coex setting!!<===\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_coex_under_5g(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->bt_whck_test) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under WHCK TEST!!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_action_bt_whck_test(btcoexist); ++ return; ++ } ++ ++ algorithm = halbtc8821a2ant_action_algorithm(btcoexist); ++ if (coex_sta->c2h_bt_inquiry_page && ++ (BT_8821A_2ANT_COEX_ALGO_PANHS != algorithm)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under inquiry/page scan !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_action_bt_inquiry(btcoexist); ++ return; ++ } else { ++ ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || link || roam) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under Link Process !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_action_wifi_link_process(btcoexist); ++ return; ++ } ++ ++ /* for P2P */ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if ((num_of_wifi_link >= 2) || ++ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", ++ num_of_wifi_link, wifi_link_status); ++ BTC_TRACE(trace_buf); ++ ++ if (bt_link_info->bt_link_exist) ++ miracast_plus_bt = true; ++ else ++ miracast_plus_bt = false; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ halbtc8821a2ant_action_wifi_multi_port(btcoexist); ++ ++ return; ++ } else { ++ miracast_plus_bt = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ } ++ ++ coex_dm->cur_algorithm = algorithm; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", ++ coex_dm->cur_algorithm); ++ BTC_TRACE(trace_buf); ++ ++ if (halbtc8821a2ant_is_common_action(btcoexist)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant common.\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->auto_tdma_adjust = false; ++ } else { ++ if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", ++ coex_dm->pre_algorithm, coex_dm->cur_algorithm); ++ BTC_TRACE(trace_buf); ++ coex_dm->auto_tdma_adjust = false; ++ } ++ switch (coex_dm->cur_algorithm) { ++ case BT_8821A_2ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_action_sco(btcoexist); ++ break; ++ case BT_8821A_2ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_action_hid(btcoexist); ++ break; ++ case BT_8821A_2ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_action_a2dp(btcoexist); ++ break; ++ case BT_8821A_2ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_action_a2dp_pan_hs(btcoexist); ++ break; ++ case BT_8821A_2ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_action_pan_edr(btcoexist); ++ break; ++ case BT_8821A_2ANT_COEX_ALGO_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_action_pan_hs(btcoexist); ++ break; ++ case BT_8821A_2ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_action_pan_edr_a2dp(btcoexist); ++ break; ++ case BT_8821A_2ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_action_pan_edr_hid(btcoexist); ++ break; ++ case BT_8821A_2ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_action_hid_a2dp_pan_edr( ++ btcoexist); ++ break; ++ case BT_8821A_2ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_action_hid_a2dp(btcoexist); ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_coex_all_off(btcoexist); ++ break; ++ } ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ } ++} ++ ++void halbtc8821a2ant_wifi_off_hw_cfg(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[2] = {0}; ++ u32 fw_ver = 0; ++ ++ /* set wlan_act to low */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, ++ 0x780); /* WiFi goto standby while GNT_BT 0-->1 */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ if (fw_ver >= 0x180000) { ++ /* Use H2C to set GNT_BT to HIGH */ ++ h2c_parameter[0] = 1; ++ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, h2c_parameter); ++ } else ++ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); ++} ++ ++void halbtc8821a2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean back_up) ++{ ++ u8 u8tmp = 0; ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 2Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* backup rf 0x1e value */ ++ coex_dm->bt_rf_0x1e_backup = ++ btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff); ++ ++ /* 0x790[5:0]=0x5 */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); ++ u8tmp &= 0xc0; ++ u8tmp |= 0x5; ++ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); ++ ++ /* Antenna config */ ++ halbtc8821a2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, true, ++ false); ++ coex_sta->dis_ver_info_cnt = 0; ++ ++ /* PTA parameter */ ++ halbtc8821a2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ /* Enable counter statistics */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, ++ 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); ++} ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8821a2ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8821a2ant_ ++ * ************************************************************ */ ++void ex_halbtc8821a2ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++ ++} ++ ++void ex_halbtc8821a2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */ ++ ++ /* */ ++ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ ++ /* Local setting bit define */ ++ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ ++ /* BIT1: "0" for internal switch; "1" for external switch */ ++ /* BIT2: "0" for one antenna; "1" for two antenna */ ++ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ ++ if (btcoexist->chip_interface == BTC_INTF_USB) { ++ /* fixed at S0 for USB interface */ ++ u8tmp |= 0x1; /* antenna inverse */ ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); ++ } else { ++ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ ++ if (board_info->single_ant_path == 0) { ++ } else if (board_info->single_ant_path == 1) { ++ /* set to S0 */ ++ u8tmp |= 0x1; /* antenna inverse */ ++ } ++ ++ if (btcoexist->chip_interface == BTC_INTF_PCI) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x384, ++ u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_SDIO) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, ++ u8tmp); ++ } ++} ++ ++void ex_halbtc8821a2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ halbtc8821a2ant_init_hw_config(btcoexist, true); ++} ++ ++void ex_halbtc8821a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821a2ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8821a2ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; ++ u32 u32tmp[4]; ++ u32 fa_of_dm, fa_cck; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", ++ "Ant PG number/ Ant mechanism:", ++ board_info->pg_ant_num, board_info->btdm_ant_num); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", ++ "CoexVer/ FwVer/ PatchVer", ++ glcoex_ver_date_8821a_2ant, glcoex_ver_8821a_2ant, fw_ver, ++ bt_patch_ver, bt_patch_ver); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %ddBm/ %d] ", ++ "BT [status/ rssi/ retryCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") ++ : ((BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", ++ "SCO/HID/PAN/A2DP", ++ bt_link_info->sco_exist, bt_link_info->hid_exist, ++ bt_link_info->pan_exist, bt_link_info->a2dp_exist); ++ CL_PRINTF(cli_buf); ++ ++ { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "BT Role", ++ (bt_link_info->slave_role) ? "Slave" : "Master"); ++ CL_PRINTF(cli_buf); ++ } ++ ++ bt_info_ext = coex_sta->bt_info_ext; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "BT Info A2DP rate", ++ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); ++ CL_PRINTF(cli_buf); ++ ++ for (i = 0; i < BT_INFO_SRC_8821A_2ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8821a_2ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ /* Sw mechanism */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Sw mechanism]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", ++ "SM1[ShRf/ LpRA/ LimDig]", ++ coex_dm->cur_rf_rx_lpf_shrink, coex_dm->cur_low_penalty_ra, ++ coex_dm->limited_dig); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", ++ "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", ++ coex_dm->cur_agc_table_en, coex_dm->cur_adc_back_off, ++ coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); ++ CL_PRINTF(cli_buf); ++ ++ /* Fw mechanism */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Fw mechanism]============"); ++ CL_PRINTF(cli_buf); ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case, ++ coex_dm->auto_tdma_adjust); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "Coex Table Type", ++ coex_sta->coex_table_type); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", ++ "DecBtPwr/ IgnWlanAct", ++ coex_dm->cur_bt_dec_pwr_lvl, coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", ++ "RF-A, 0x1e initVal", ++ coex_dm->bt_rf_0x1e_backup); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xc5b); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x880); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x778/0x880[29:25]/0xc58[29:25]", ++ u8tmp[0], (u32tmp[0] & 0x3e000000) >> 25, ++ ((u8tmp[1] & 0x3e) >> 1)); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x764); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x76e); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x764/ 0x765/ 0x76e", ++ (u32tmp[0] & 0xff), (u32tmp[0] & 0xff00) >> 8, u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0xcb4[7:0](ctrl)/ 0xcb4[29:28](val)", ++ u32tmp[0] & 0xff, ((u32tmp[0] & 0x30000000) >> 28)); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x974); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x40/ 0x4c[24:23]/ 0x974", ++ u8tmp[0], ((u32tmp[0] & 0x01800000) >> 23), u32tmp[1]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x550(bcn ctrl)/0x522", ++ u32tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x49c); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0xc50(dig)/0x49c(null-drop)", ++ u32tmp[0] & 0xff, u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); ++ u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); ++ ++ fa_of_dm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) ++ >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + \ ++ ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & ++ 0xffff) ; ++ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "OFDM-CCA/OFDM-FA/CCK-FA", ++ u32tmp[0] & 0xffff, fa_of_dm, fa_cck); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_OK CCK/11g/11n/11n-Agg", ++ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, ++ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_Err CCK/11g/11n/11n-Agg", ++ coex_sta->crc_err_cck, coex_sta->crc_err_11g, ++ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", ++ u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770(high-pri rx/tx)", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(low-pri rx/tx)", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++#if (BT_AUTO_REPORT_ONLY_8821A_2ANT == 1) ++ /* halbtc8821a2ant_monitor_bt_ctr(btcoexist); */ ++#endif ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++void ex_halbtc8821a2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ halbtc8821a2ant_wifi_off_hw_cfg(btcoexist); ++ halbtc8821a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ halbtc8821a2ant_coex_all_off(btcoexist); ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = false; ++ halbtc8821a2ant_init_hw_config(btcoexist, false); ++ halbtc8821a2ant_init_coex_dm(btcoexist); ++ halbtc8821a2ant_query_bt_info(btcoexist); ++ } ++} ++ ++void ex_halbtc8821a2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ } ++} ++ ++void ex_halbtc8821a2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 u8tmpa, u8tmpb; ++ ++ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); ++ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); ++ ++ if (BTC_SCAN_START == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ } else if (BTC_SCAN_FINISH == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], 0x765=0x%x, 0x76e=0x%x\n", u8tmpa, ++ u8tmpb); ++ BTC_TRACE(trace_buf); ++} ++ ++void ex_halbtc8821a2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (BTC_ASSOCIATE_START == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ } else if (BTC_ASSOCIATE_FINISH == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++} ++ ++void ex_halbtc8821a2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ u8 ap_num = 0; ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ h2c_parameter[0] = 0x1; ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else { ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &ap_num); ++ if (ap_num < 10) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); ++} ++ ++void ex_halbtc8821a2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (type == BTC_PACKET_DHCP) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], DHCP Packet notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++} ++ ++void ex_halbtc8821a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 bt_info = 0; ++ u8 i, rsp_source = 0; ++ boolean bt_busy = false, limited_dig = false; ++ boolean wifi_connected = false, wifi_under_5g = false; ++ ++ coex_sta->c2h_bt_info_req_sent = false; ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8821A_2ANT_MAX) ++ rsp_source = BT_INFO_SRC_8821A_2ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ if (i == 1) ++ bt_info = tmp_buf[i]; ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), return for Manual CTRL<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ /* if 0xff, it means BT is under WHCK test */ ++ if (bt_info == 0xff) ++ coex_sta->bt_whck_test = true; ++ else ++ coex_sta->bt_whck_test = false; ++ ++ if (BT_INFO_SRC_8821A_2ANT_WIFI_FW != rsp_source) { ++ coex_sta->bt_retry_cnt = /* [3:0] */ ++ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; ++ ++ coex_sta->bt_rssi = ++ coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; ++ ++ coex_sta->bt_info_ext = ++ coex_sta->bt_info_c2h[rsp_source][4]; ++ ++ coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] ++ & 0x40); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, ++ &coex_sta->bt_tx_rx_mask); ++ if (coex_sta->bt_tx_rx_mask) { ++ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x01 => Need to switch BT TRx Mask */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x01\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, ++ 0x3c, 0x01); ++ } ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ if ((coex_sta->bt_info_ext & BIT(1))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ if (wifi_connected) ++ ex_halbtc8821a2ant_media_status_notify( ++ btcoexist, BTC_MEDIA_CONNECT); ++ else ++ ex_halbtc8821a2ant_media_status_notify( ++ btcoexist, BTC_MEDIA_DISCONNECT); ++ } ++ ++ ++ if (!btcoexist->manual_control && !wifi_under_5g) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info = 0x%x!!\n", ++ coex_sta->bt_info_ext); ++ BTC_TRACE(trace_buf); ++ if ((coex_sta->bt_info_ext & BIT(3))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3=1, wifi_connected=%d\n", ++ wifi_connected); ++ BTC_TRACE(trace_buf); ++ if (wifi_connected) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_ignore_wlan_act( ++ btcoexist, FORCE_EXEC, false); ++ } ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3=0, wifi_connected=%d\n", ++ wifi_connected); ++ BTC_TRACE(trace_buf); ++ /* BT already NOT ignore Wlan active, do nothing here. */ ++ if (!wifi_connected) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_ignore_wlan_act( ++ btcoexist, FORCE_EXEC, true); ++ } ++ } ++ } ++ ++#if (BT_AUTO_REPORT_ONLY_8821A_2ANT == 0) ++ if ((coex_sta->bt_info_ext & BIT(4))) { ++ /* BT auto report already enabled, do nothing */ ++ } else ++ halbtc8821a2ant_bt_auto_report(btcoexist, FORCE_EXEC, ++ true); ++#endif ++ } ++ ++ /* check BIT2 first ==> check if bt is under inquiry or page scan */ ++ if (bt_info & BT_INFO_8821A_2ANT_B_INQ_PAGE) ++ coex_sta->c2h_bt_inquiry_page = true; ++ else ++ coex_sta->c2h_bt_inquiry_page = false; ++ ++ /* set link exist status */ ++ if (!(bt_info & BT_INFO_8821A_2ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (bt_info & BT_INFO_8821A_2ANT_B_FTP) ++ coex_sta->pan_exist = true; ++ else ++ coex_sta->pan_exist = false; ++ if (bt_info & BT_INFO_8821A_2ANT_B_A2DP) ++ coex_sta->a2dp_exist = true; ++ else ++ coex_sta->a2dp_exist = false; ++ if (bt_info & BT_INFO_8821A_2ANT_B_HID) ++ coex_sta->hid_exist = true; ++ else ++ coex_sta->hid_exist = false; ++ if (bt_info & BT_INFO_8821A_2ANT_B_SCO_ESCO) ++ coex_sta->sco_exist = true; ++ else ++ coex_sta->sco_exist = false; ++ ++ if ((coex_sta->hid_exist == false) && ++ (coex_sta->c2h_bt_inquiry_page == false) && ++ (coex_sta->sco_exist == false)) { ++ if (coex_sta->high_priority_tx + ++ coex_sta->high_priority_rx >= 160) ++ coex_sta->hid_exist = true; ++ } ++ } ++ ++ halbtc8821a2ant_update_bt_link_info(btcoexist); ++ ++ if (!(bt_info & BT_INFO_8821A_2ANT_B_CONNECTION)) { ++ coex_dm->bt_status = BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info == ++ BT_INFO_8821A_2ANT_B_CONNECTION) { /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if ((bt_info & BT_INFO_8821A_2ANT_B_SCO_ESCO) || ++ (bt_info & BT_INFO_8821A_2ANT_B_SCO_BUSY)) { ++ coex_dm->bt_status = BT_8821A_2ANT_BT_STATUS_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info & BT_INFO_8821A_2ANT_B_ACL_BUSY) { ++ coex_dm->bt_status = BT_8821A_2ANT_BT_STATUS_ACL_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ coex_dm->bt_status = BT_8821A_2ANT_BT_STATUS_MAX; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if ((BT_8821A_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8821A_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8821A_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { ++ bt_busy = true; ++ limited_dig = true; ++ } else { ++ bt_busy = false; ++ limited_dig = false; ++ } ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ coex_dm->limited_dig = limited_dig; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); ++ ++ halbtc8821a2ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8821a2ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821a2ant_wifi_off_hw_cfg(btcoexist); ++ /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ ++ /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT goto standby while GNT_BT 1-->0 */ ++ halbtc8821a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ++ ex_halbtc8821a2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++} ++ ++void ex_halbtc8821a2ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_WIFI_PNP_SLEEP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_init_hw_config(btcoexist, false); ++ halbtc8821a2ant_init_coex_dm(btcoexist); ++ halbtc8821a2ant_query_bt_info(btcoexist); ++ } ++} ++ ++void ex_halbtc8821a2ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ==========================Periodical===========================\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (coex_sta->dis_ver_info_cnt <= 5) { ++ coex_sta->dis_ver_info_cnt += 1; ++ if (coex_sta->dis_ver_info_cnt == 3) { ++ /* Antenna config to set 0x765 = 0x0 (GNT_BT control by PTA) after initial */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Set GNT_BT control by PTA\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821a2ant_set_ant_path(btcoexist, ++ BTC_ANT_WIFI_AT_MAIN, false, false); ++ } ++ } ++ ++#if (BT_AUTO_REPORT_ONLY_8821A_2ANT == 0) ++ halbtc8821a2ant_query_bt_info(btcoexist); ++ halbtc8821a2ant_monitor_bt_enable_disable(btcoexist); ++#else ++ halbtc8821a2ant_monitor_bt_ctr(btcoexist); ++ halbtc8821a2ant_monitor_wifi_ctr(btcoexist); ++ ++ if (halbtc8821a2ant_is_wifi_status_changed(btcoexist) || ++ coex_dm->auto_tdma_adjust) ++ halbtc8821a2ant_run_coexist_mechanism(btcoexist); ++#endif ++} ++ ++#endif ++ ++#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ +\ Ingen nyrad vid filslut +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.h 2018-02-11 21:44:27.147146086 +0200 +@@ -0,0 +1,205 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8821A_SUPPORT == 1) ++ ++/* ******************************************* ++ * The following is for 8821A 2Ant BT Co-exist definition ++ * ******************************************* */ ++#define BT_AUTO_REPORT_ONLY_8821A_2ANT 1 ++ ++ ++#define BT_INFO_8821A_2ANT_B_FTP BIT(7) ++#define BT_INFO_8821A_2ANT_B_A2DP BIT(6) ++#define BT_INFO_8821A_2ANT_B_HID BIT(5) ++#define BT_INFO_8821A_2ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8821A_2ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8821A_2ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8821A_2ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8821A_2ANT_B_CONNECTION BIT(0) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT 2 ++ ++ ++#define BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES 42 /* WiFi RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation */ ++#define BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES 46 /* BT RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation */ ++ ++enum bt_info_src_8821a_2ant { ++ BT_INFO_SRC_8821A_2ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8821A_2ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8821A_2ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8821A_2ANT_MAX ++}; ++ ++enum bt_8821a_2ant_bt_status { ++ BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8821A_2ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8821A_2ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8821A_2ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8821A_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8821A_2ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8821a_2ant_coex_algo { ++ BT_8821A_2ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8821A_2ANT_COEX_ALGO_SCO = 0x1, ++ BT_8821A_2ANT_COEX_ALGO_HID = 0x2, ++ BT_8821A_2ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8821A_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, ++ BT_8821A_2ANT_COEX_ALGO_PANEDR = 0x5, ++ BT_8821A_2ANT_COEX_ALGO_PANHS = 0x6, ++ BT_8821A_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, ++ BT_8821A_2ANT_COEX_ALGO_PANEDR_HID = 0x8, ++ BT_8821A_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, ++ BT_8821A_2ANT_COEX_ALGO_HID_A2DP = 0xa, ++ BT_8821A_2ANT_COEX_ALGO_MAX = 0xb, ++}; ++ ++struct coex_dm_8821a_2ant { ++ /* fw mechanism */ ++ u8 pre_bt_dec_pwr_lvl; ++ u8 cur_bt_dec_pwr_lvl; ++ u8 pre_fw_dac_swing_lvl; ++ u8 cur_fw_dac_swing_lvl; ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean reset_tdma_adjust; ++ boolean auto_tdma_adjust; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ ++ /* sw mechanism */ ++ boolean pre_rf_rx_lpf_shrink; ++ boolean cur_rf_rx_lpf_shrink; ++ u32 bt_rf_0x1e_backup; ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ boolean pre_dac_swing_on; ++ u32 pre_dac_swing_lvl; ++ boolean cur_dac_swing_on; ++ u32 cur_dac_swing_lvl; ++ boolean pre_adc_back_off; ++ boolean cur_adc_back_off; ++ boolean pre_agc_table_en; ++ boolean cur_agc_table_en; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ boolean limited_dig; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ boolean need_recover0x948; ++ u32 backup0x948; ++ ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++}; ++ ++struct coex_sta_8821a_2ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ u8 bt_rssi; ++ boolean bt_tx_rx_mask; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ boolean c2h_bt_info_req_sent; ++ u8 bt_info_c2h[BT_INFO_SRC_8821A_2ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8821A_2ANT_MAX]; ++ boolean bt_whck_test; ++ boolean c2h_bt_inquiry_page; ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++ ++ u32 crc_ok_cck; ++ u32 crc_ok_11g; ++ u32 crc_ok_11n; ++ u32 crc_ok_11n_agg; ++ ++ u32 crc_err_cck; ++ u32 crc_err_11g; ++ u32 crc_err_11n; ++ u32 crc_err_11n_agg; ++ ++ u8 coex_table_type; ++ boolean force_lps_on; ++ ++ u8 dis_ver_info_cnt; ++}; ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8821a2ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821a2ant_pre_load_firmware(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821a2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8821a2ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821a2ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821a2ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821a2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821a2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821a2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821a2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8821a2ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821a2ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state); ++void ex_halbtc8821a2ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821a2ant_display_coex_info(IN struct btc_coexist *btcoexist); ++ ++#else ++#define ex_halbtc8821a2ant_power_on_setting(btcoexist) ++#define ex_halbtc8821a2ant_pre_load_firmware(btcoexist) ++#define ex_halbtc8821a2ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8821a2ant_init_coex_dm(btcoexist) ++#define ex_halbtc8821a2ant_ips_notify(btcoexist, type) ++#define ex_halbtc8821a2ant_lps_notify(btcoexist, type) ++#define ex_halbtc8821a2ant_scan_notify(btcoexist, type) ++#define ex_halbtc8821a2ant_connect_notify(btcoexist, type) ++#define ex_halbtc8821a2ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8821a2ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8821a2ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8821a2ant_halt_notify(btcoexist) ++#define ex_halbtc8821a2ant_pnp_notify(btcoexist, pnp_state) ++#define ex_halbtc8821a2ant_periodical(btcoexist) ++#define ex_halbtc8821a2ant_display_coex_info(btcoexist) ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.c 2018-02-11 21:44:27.147146086 +0200 +@@ -0,0 +1,3997 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8821A_CSR_CSR Co-exist mechanism ++ * ++ * History ++ * 2012/08/22 Cosa first check in. ++ * 2012/11/14 Cosa Revise for 8821A_CSR 2Ant out sourcing. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8821A_SUPPORT == 1) ++ ++#define _BTCOEX_CSR 1 ++ ++#ifndef rtw_warn_on_8821acsr2ant ++#define rtw_warn_on_8821acsr2ant(condition) do {} while (0) ++#endif ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8821a_csr_2ant glcoex_dm_8821a_csr_2ant; ++static struct coex_dm_8821a_csr_2ant *coex_dm = &glcoex_dm_8821a_csr_2ant; ++static struct coex_sta_8821a_csr_2ant glcoex_sta_8821a_csr_2ant; ++static struct coex_sta_8821a_csr_2ant *coex_sta = &glcoex_sta_8821a_csr_2ant; ++ ++const char *const glbt_info_src_8821a_csr_2ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++u32 glcoex_ver_date_8821a_csr_2ant = 20140901; ++u32 glcoex_ver_8821a_csr_2ant = 0x51; ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8821aCsr2ant_ ++ * ************************************************************ */ ++u8 halbtc8821aCsr2ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, ++ u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_bt_rssi_state; ++ } ++ ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8821aCsr2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_wifi_rssi_state[index]; ++ } ++ ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8821aCsr2ant_monitor_bt_enable_disable(IN struct btc_coexist ++ *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ ++ /* This function check if bt is disabled */ ++ ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is enabled !!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ bt_disable_cnt++; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], bt all counters=0, %d times!!\n", ++ bt_disable_cnt); ++ BTC_TRACE(trace_buf); ++ if (bt_disable_cnt >= 2) { ++ bt_disabled = true; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_disabled = bt_disabled; ++ if (!bt_disabled) { ++ } else { ++ } ++ } ++} ++ ++void halbtc8821aCsr2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ reg_hp_txrx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx); ++ BTC_TRACE(trace_buf); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", ++ reg_lp_txrx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx); ++ BTC_TRACE(trace_buf); ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x5d); ++} ++ ++void halbtc8821aCsr2ant_update_ra_mask(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 dis_rate_mask) ++{ ++ coex_dm->cur_ra_mask = dis_rate_mask; ++ ++ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, ++ &coex_dm->cur_ra_mask); ++ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; ++} ++ ++void halbtc8821aCsr2ant_auto_rate_fallback_retry(IN struct btc_coexist ++ *btcoexist, IN boolean force_exec, IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ ++ coex_dm->cur_arfr_type = type; ++ ++ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { ++ switch (coex_dm->cur_arfr_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_4byte(btcoexist, 0x430, ++ coex_dm->backup_arfr_cnt1); ++ btcoexist->btc_write_4byte(btcoexist, 0x434, ++ coex_dm->backup_arfr_cnt2); ++ break; ++ case 1: ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x01010101); ++ } else { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x04030201); ++ } ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; ++} ++ ++void halbtc8821aCsr2ant_retry_limit(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_retry_limit_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_retry_limit_type != ++ coex_dm->cur_retry_limit_type)) { ++ switch (coex_dm->cur_retry_limit_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ coex_dm->backup_retry_limit); ++ break; ++ case 1: /* retry limit=8 */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ 0x0808); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; ++} ++ ++void halbtc8821aCsr2ant_ampdu_max_time(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_ampdu_time_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { ++ switch (coex_dm->cur_ampdu_time_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ coex_dm->backup_ampdu_max_time); ++ break; ++ case 1: /* AMPDU timw = 0x38 * 32us */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ 0x38); ++ break; ++ case 2: ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ 0x17); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; ++} ++ ++void halbtc8821aCsr2Ant_AmpduMaxNum(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_ampdu_num_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_ampdu_num_type != coex_dm->cur_ampdu_num_type)) { ++ switch (coex_dm->cur_ampdu_num_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_2byte(btcoexist, 0x4ca, ++ coex_dm->backup_ampdu_max_num); ++ break; ++ case 1: ++ btcoexist->btc_write_2byte(btcoexist, 0x4ca, ++ 0x0808); ++ break; ++ case 2: ++ btcoexist->btc_write_2byte(btcoexist, 0x4ca, ++ 0x1f1f); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_ampdu_num_type = coex_dm->cur_ampdu_num_type; ++ ++} ++ ++void halbtc8821aCsr2ant_limited_tx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, ++ IN u8 retry_limit_type, IN u8 ampdu_time_type, IN u8 ampdu_num_type) ++{ ++ switch (ra_mask_type) { ++ case 0: /* normal mode */ ++ halbtc8821aCsr2ant_update_ra_mask(btcoexist, force_exec, ++ 0x0); ++ break; ++ case 1: /* disable cck 1/2 */ ++ halbtc8821aCsr2ant_update_ra_mask(btcoexist, force_exec, ++ 0x00000003); ++ break; ++ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ ++ halbtc8821aCsr2ant_update_ra_mask(btcoexist, force_exec, ++ 0x0001f1f7); ++ break; ++ default: ++ break; ++ } ++ ++ halbtc8821aCsr2ant_auto_rate_fallback_retry(btcoexist, force_exec, ++ arfr_type); ++ halbtc8821aCsr2ant_retry_limit(btcoexist, force_exec, retry_limit_type); ++ halbtc8821aCsr2ant_ampdu_max_time(btcoexist, force_exec, ++ ampdu_time_type); ++ halbtc8821aCsr2Ant_AmpduMaxNum(btcoexist, force_exec, ampdu_num_type); ++} ++ ++ ++ ++void halbtc8821aCsr2ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++} ++ ++void halbtc8821aCsr2ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ coex_sta->c2h_bt_info_req_sent = true; ++ ++ h2c_parameter[0] |= BIT(0); /* trigger */ ++ ++ rtw_warn_on_8821acsr2ant(_BTCOEX_CSR); ++ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); ++} ++ ++u8 halbtc8821aCsr2ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_stack_info *stack_info = &btcoexist->stack_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ /* sync StackInfo with BT firmware and stack */ ++ stack_info->hid_exist = coex_sta->hid_exist; ++ stack_info->bt_link_exist = coex_sta->bt_link_exist; ++ stack_info->sco_exist = coex_sta->sco_exist; ++ stack_info->pan_exist = coex_sta->pan_exist; ++ stack_info->a2dp_exist = coex_sta->a2dp_exist; ++ ++ if (!stack_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No profile exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (stack_info->sco_exist) ++ num_of_diff_profile++; ++ if (stack_info->hid_exist) ++ num_of_diff_profile++; ++ if (stack_info->pan_exist) ++ num_of_diff_profile++; ++ if (stack_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 1) { ++ if (stack_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_SCO; ++ } else { ++ if (stack_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_HID; ++ } else if (stack_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_A2DP; ++ } else if (stack_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (stack_info->sco_exist) { ++ if (stack_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; ++ } else if (stack_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; ++ } else if (stack_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (stack_info->hid_exist && ++ stack_info->a2dp_exist) { ++ if (stack_info->num_of_hid >= 2) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID*2 + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP; ++ } ++ } else if (stack_info->hid_exist && ++ stack_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (stack_info->pan_exist && ++ stack_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (stack_info->sco_exist) { ++ if (stack_info->hid_exist && ++ stack_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; ++ } else if (stack_info->hid_exist && ++ stack_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (stack_info->pan_exist && ++ stack_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (stack_info->hid_exist && ++ stack_info->pan_exist && ++ stack_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (stack_info->sco_exist) { ++ if (stack_info->hid_exist && ++ stack_info->pan_exist && ++ stack_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++boolean halbtc8821aCsr2ant_need_to_dec_bt_pwr(IN struct btc_coexist *btcoexist) ++{ ++ boolean ret = false; ++ boolean bt_hs_on = false, wifi_connected = false; ++ s32 bt_hs_rssi = 0; ++ u8 bt_rssi_state; ++ ++ if (!btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on)) ++ return false; ++ if (!btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected)) ++ return false; ++ if (!btcoexist->btc_get(btcoexist, BTC_GET_S4_HS_RSSI, &bt_hs_rssi)) ++ return false; ++ ++ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); ++ ++ if (wifi_connected) { ++ if (bt_hs_on) { ++ if (bt_hs_rssi > 37) ++ ret = true; ++ } else { ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ ret = true; ++ } ++ } ++ ++ return ret; ++} ++ ++void halbtc8821aCsr2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, ++ IN u8 dac_swing_lvl) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ /* There are several type of dacswing */ ++ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ ++ h2c_parameter[0] = dac_swing_lvl; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); ++} ++ ++void halbtc8821aCsr2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN boolean dec_bt_pwr) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (dec_bt_pwr) ++ h2c_parameter[0] |= BIT(1); ++ ++ rtw_warn_on_8821acsr2ant(_BTCOEX_CSR); ++ btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); ++} ++ ++void halbtc8821aCsr2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean dec_bt_pwr) ++{ ++ coex_dm->cur_dec_bt_pwr = dec_bt_pwr; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_dec_bt_pwr == coex_dm->cur_dec_bt_pwr) ++ return; ++ } ++ ++ /* TODO: may CSR consider to decrease BT power? */ ++ /* halbtc8821aCsr2ant_set_fw_dec_bt_pwr(btcoexist, coex_dm->cur_dec_bt_pwr); */ ++ ++ coex_dm->pre_dec_bt_pwr = coex_dm->cur_dec_bt_pwr; ++} ++ ++void halbtc8821aCsr2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ rtw_warn_on_8821acsr2ant(_BTCOEX_CSR); ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8821aCsr2ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ /* halbtc8821aCsr2ant_set_bt_auto_report(btcoexist, coex_dm->cur_bt_auto_report); */ ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++void halbtc8821aCsr2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 fw_dac_swing_lvl) ++{ ++ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_fw_dac_swing_lvl == ++ coex_dm->cur_fw_dac_swing_lvl) ++ return; ++ } ++ ++ halbtc8821aCsr2ant_set_fw_dac_swing_level(btcoexist, ++ coex_dm->cur_fw_dac_swing_lvl); ++ ++ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; ++} ++ ++void halbtc8821aCsr2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist ++ *btcoexist, IN boolean rx_rf_shrink_on) ++{ ++ if (rx_rf_shrink_on) { ++ /* Shrink RF Rx LPF corner */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Shrink RF Rx LPF corner!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff, ++ 0xffffc); ++ } else { ++ /* Resume RF Rx LPF corner */ ++ /* After initialized, we can use coex_dm->bt_rf_0x1e_backup */ ++ if (btcoexist->initilized) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Resume RF Rx LPF corner!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, ++ 0xfffff, coex_dm->bt_rf_0x1e_backup); ++ } ++ } ++} ++ ++void halbtc8821aCsr2ant_rf_shrink(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rx_rf_shrink_on) ++{ ++ coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_rf_rx_lpf_shrink == ++ coex_dm->cur_rf_rx_lpf_shrink) ++ return; ++ } ++ halbtc8821aCsr2ant_set_sw_rf_rx_lpf_corner(btcoexist, ++ coex_dm->cur_rf_rx_lpf_shrink); ++ ++ coex_dm->pre_rf_rx_lpf_shrink = coex_dm->cur_rf_rx_lpf_shrink; ++} ++ ++void halbtc8821aCsr2ant_set_sw_penalty_tx_rate_adaptive( ++ IN struct btc_coexist *btcoexist, IN boolean low_penalty_ra) ++{ ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ ++ ++ if (low_penalty_ra) { ++ h2c_parameter[1] |= BIT(0); ++ h2c_parameter[2] = ++ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ ++ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ ++ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ ++ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); ++} ++ ++void halbtc8821aCsr2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ halbtc8821aCsr2ant_set_sw_penalty_tx_rate_adaptive(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++} ++ ++void halbtc8821aCsr2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, ++ IN u32 level) ++{ ++ u8 val = (u8)level; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Write SwDacSwing = 0x%x\n", level); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc5b, 0x3e, val); ++} ++ ++void halbtc8821aCsr2ant_set_sw_full_time_dac_swing(IN struct btc_coexist ++ *btcoexist, IN boolean sw_dac_swing_on, IN u32 sw_dac_swing_lvl) ++{ ++ if (sw_dac_swing_on) ++ halbtc8821aCsr2ant_set_dac_swing_reg(btcoexist, ++ sw_dac_swing_lvl); ++ else ++ halbtc8821aCsr2ant_set_dac_swing_reg(btcoexist, 0x18); ++} ++ ++ ++void halbtc8821aCsr2ant_dac_swing(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) ++{ ++ coex_dm->cur_dac_swing_on = dac_swing_on; ++ coex_dm->cur_dac_swing_lvl = dac_swing_lvl; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_dac_swing_on == coex_dm->cur_dac_swing_on) && ++ (coex_dm->pre_dac_swing_lvl == ++ coex_dm->cur_dac_swing_lvl)) ++ return; ++ } ++ delay_ms(30); ++ halbtc8821aCsr2ant_set_sw_full_time_dac_swing(btcoexist, dac_swing_on, ++ dac_swing_lvl); ++ ++ coex_dm->pre_dac_swing_on = coex_dm->cur_dac_swing_on; ++ coex_dm->pre_dac_swing_lvl = coex_dm->cur_dac_swing_lvl; ++} ++ ++void halbtc8821aCsr2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, ++ IN boolean adc_back_off) ++{ ++ if (adc_back_off) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB BackOff Level On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x3); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BB BackOff Level Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x1); ++ } ++} ++ ++void halbtc8821aCsr2ant_adc_back_off(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean adc_back_off) ++{ ++ coex_dm->cur_adc_back_off = adc_back_off; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) ++ return; ++ } ++ halbtc8821aCsr2ant_set_adc_back_off(btcoexist, ++ coex_dm->cur_adc_back_off); ++ ++ coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; ++} ++ ++void halbtc8821aCsr2ant_set_agc_table(IN struct btc_coexist *btcoexist, ++ IN boolean agc_table_en) ++{ ++ u8 rssi_adjust_val = 0; ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); ++ if (agc_table_en) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Agc Table On!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x28F4B); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x10AB2); ++ rssi_adjust_val = 8; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Agc Table Off!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x2884B); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, ++ 0x104B2); ++ } ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); ++ ++ /* set rssi_adjust_val for wifi module. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, ++ &rssi_adjust_val); ++} ++ ++void halbtc8821aCsr2ant_agc_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean agc_table_en) ++{ ++ coex_dm->cur_agc_table_en = agc_table_en; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) ++ return; ++ } ++ halbtc8821aCsr2ant_set_agc_table(btcoexist, agc_table_en); ++ ++ coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; ++} ++ ++void halbtc8821aCsr2ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8821aCsr2ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ halbtc8821aCsr2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, ++ val0x6c8, val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8821aCsr2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ if (enable) { ++ h2c_parameter[0] |= BIT(0); /* function enable */ ++ } ++ ++ rtw_warn_on_8821acsr2ant(_BTCOEX_CSR); ++ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); ++} ++ ++void halbtc8821aCsr2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ /* halbtc8821aCsr2ant_set_fw_ignore_wlan_act(btcoexist, enable); */ ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8821aCsr2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = byte5; ++ h2c_parameter[5] = 0x01; ++ ++ coex_dm->ps_tdma_para[0] = byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = byte5; ++ coex_dm->ps_tdma_para[5] = 0x01; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 6, h2c_parameter); ++} ++ ++void halbtc8821aCsr2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, ++ IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, ++ IN boolean limited_dig, IN boolean bt_lna_constrain) ++{ ++ u32 wifi_bw; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_HT40 != wifi_bw) { /* only shrink RF Rx LPF for HT40 */ ++ if (shrink_rx_lpf) ++ shrink_rx_lpf = false; ++ } ++ ++ halbtc8821aCsr2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); ++ halbtc8821aCsr2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, ++ low_penalty_ra); ++ ++ /* no limited DIG */ ++ /* halbtc8821aCsr2ant_setBtLnaConstrain(btcoexist, NORMAL_EXEC, bt_lna_constrain); */ ++} ++ ++void halbtc8821aCsr2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, ++ IN boolean agc_table_shift, IN boolean adc_back_off, ++ IN boolean sw_dac_swing, IN u32 dac_swing_lvl) ++{ ++ /* halbtc8821aCsr2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ ++ halbtc8821aCsr2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); ++ halbtc8821aCsr2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, ++ dac_swing_lvl); ++} ++ ++void halbtc8821aCsr2ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u32 u32tmp = 0; ++ u8 h2c_parameter[2] = {0}; ++ ++ if (init_hwcfg) { ++ /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp &= ~BIT(23); ++ u32tmp |= BIT(24); ++ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x974, 0x3ff); ++ btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x77); ++ ++ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { ++ /* tell firmware "antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ ++ h2c_parameter[0] = 1; ++ h2c_parameter[1] = 1; ++ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, ++ h2c_parameter); ++ } else { ++ /* tell firmware "no antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ ++ h2c_parameter[0] = 0; ++ h2c_parameter[1] = 1; ++ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, ++ h2c_parameter); ++ } ++ } ++ ++ /* ext switch setting */ ++ switch (ant_pos_type) { ++ case BTC_ANT_WIFI_AT_MAIN: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, ++ 0x30, 0x1); ++ break; ++ case BTC_ANT_WIFI_AT_AUX: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, ++ 0x30, 0x2); ++ break; ++ } ++} ++ ++void halbtc8821aCsr2ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ return; ++ } ++ if (turn_on) { ++ switch (type) { ++ case 1: ++ default: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x1a, 0x1a, 0xe1, 0x90); ++ break; ++ case 2: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x12, 0x12, 0xe1, 0x90); ++ break; ++ case 3: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x1c, 0x3, 0xf1, 0x90); ++ break; ++ case 4: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x10, 0x03, 0xf1, 0x90); ++ break; ++ case 5: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x1a, 0x1a, 0x60, 0x90); ++ break; ++ case 6: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x12, 0x12, 0x60, 0x90); ++ break; ++ case 7: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x1c, 0x3, 0x70, 0x90); ++ break; ++ case 8: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xa3, 0x10, 0x3, 0x70, 0x90); ++ break; ++ case 9: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x1a, 0x1a, 0xe1, 0x90); ++ break; ++ case 10: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x12, 0x12, 0xe1, 0x90); ++ break; ++ case 11: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0xa, 0xa, 0xe1, 0x90); ++ break; ++ case 12: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x5, 0x5, 0xe1, 0x90); ++ break; ++ case 13: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x1a, 0x1a, 0x60, 0x90); ++ break; ++ case 14: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x12, 0x12, 0x60, 0x90); ++ break; ++ case 15: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0xa, 0xa, 0x60, 0x90); ++ break; ++ case 16: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x5, 0x5, 0x60, 0x90); ++ break; ++ case 17: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xa3, 0x2f, 0x2f, 0x60, 0x90); ++ break; ++ case 18: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x5, 0x5, 0xe1, 0x90); ++ break; ++ case 19: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x25, 0x25, 0xe1, 0x90); ++ break; ++ case 20: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x25, 0x25, 0x60, 0x90); ++ break; ++ case 21: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x15, 0x03, 0x70, 0x90); ++ break; ++ case 22: /* ad2dp master */ ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xeb, 0x11, 0x11, 0x21, 0x10); ++ break; ++ case 23: /* a2dp slave */ ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xeb, 0x12, 0x12, 0x20, 0x10); ++ break; ++ case 71: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x1a, 0x1a, 0xe1, 0x90); ++ break; ++ } ++ } else { ++ /* disable PS tdma */ ++ switch (type) { ++ case 0: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x40, 0x0); ++ break; ++ case 1: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x48, 0x0); ++ break; ++ default: ++ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x40, 0x0); ++ break; ++ } ++ } ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++void halbtc8821aCsr2ant_coex_all_off(IN struct btc_coexist *btcoexist) ++{ ++ /* fw all off */ ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ /* sw all off */ ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ /* hw all off */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55555555, ++ 0x55555555, 0xffff, 0x3); ++} ++ ++void halbtc8821aCsr2ant_coex_under_5g(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821aCsr2ant_coex_all_off(btcoexist); ++ ++ halbtc8821aCsr2ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); ++} ++ ++void halbtc8821aCsr2ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ /* force to reset coex mechanism */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, FORCE_EXEC, 0x55555555, ++ 0x55555555, 0xffff, 0x3); ++ ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, false); ++ ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++void halbtc8821aCsr2ant_bt_inquiry_page(IN struct btc_coexist *btcoexist) ++{ ++ boolean low_pwr_disable = true; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55ff55ff, ++ 0x5afa5afa, 0xffff, 0x3); ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); ++} ++boolean halbtc8821aCsr2ant_is_common_action(IN struct btc_coexist *btcoexist) ++{ ++ boolean common = false, wifi_connected = false, wifi_busy = false; ++ boolean low_pwr_disable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (!wifi_connected && ++ BT_8821A_CSR_2ANT_BT_STATUS_IDLE == coex_dm->bt_status) { ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi IPS + BT IPS!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, ++ false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, ++ 0x18); ++ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, ++ 0, 0); ++ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8821A_CSR_2ANT_BT_STATUS_IDLE == ++ coex_dm->bt_status)) { ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Busy + BT IPS!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ false, 1); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi LPS + BT IPS!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ false, 1); ++ } ++ ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, ++ false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, ++ 0x18); ++ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, ++ 0, 0); ++ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi IPS + BT LPS!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, ++ false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, ++ 0x18); ++ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, ++ 0, 0); ++ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Busy + BT LPS!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ false, 1); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi LPS + BT LPS!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ false, 1); ++ } ++ ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, true, ++ true); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, ++ 0x18); ++ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, ++ 0, 0); ++ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE == ++ coex_dm->bt_status)) { ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi IPS + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); */ ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, ++ false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, ++ 0x18); ++ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, ++ 0, 0); ++ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); ++ ++ common = true; ++ } else { ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Busy + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ common = false; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi LPS + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 21); ++ ++ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, ++ NORMAL_EXEC, true); ++ else ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, ++ NORMAL_EXEC, false); ++ ++ common = true; ++ } ++ ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, true, ++ true); ++ } ++ ++ if (common == true) ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0x55ff55ff, 0x5afa5afa, 0xffff, 0x3); ++ ++ return common; ++} ++void halbtc8821aCsr2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, ++ IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) ++{ ++ static s32 up, dn, m, n, wait_count; ++ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ ++ u8 retry_count = 0; ++ ++ if (coex_dm->reset_tdma_adjust) { ++ coex_dm->reset_tdma_adjust = false; ++ { ++ if (sco_hid) { ++ if (tx_pause) { ++ if (max_interval == 1) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 13); ++ coex_dm->ps_tdma_du_adj_type = ++ 13; ++ } else if (max_interval == 2) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (max_interval == 3) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } ++ } else { ++ if (max_interval == 1) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = ++ 9; ++ } else if (max_interval == 2) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (max_interval == 3) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } ++ } ++ } else { ++ if (tx_pause) { ++ if (max_interval == 1) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 5); ++ coex_dm->ps_tdma_du_adj_type = ++ 5; ++ } else if (max_interval == 2) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (max_interval == 3) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } ++ } else { ++ if (max_interval == 1) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (max_interval == 2) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (max_interval == 3) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } ++ } ++ } ++ } ++ /* ============ */ ++ up = 0; ++ dn = 0; ++ m = 1; ++ n = 3; ++ result = 0; ++ wait_count = 0; ++ } else { ++ /* accquire the BT TRx retry count from BT_Info byte2 */ ++ retry_count = coex_sta->bt_retry_cnt; ++ result = 0; ++ wait_count++; ++ ++ if (retry_count == ++ 0) { /* no retry in the last 2-second duration */ ++ up++; ++ dn--; ++ ++ if (dn <= 0) ++ dn = 0; ++ ++ if (up >= n) { /* if s n 2 retry count0, hռeWiFi duration */ ++ wait_count = 0; ++ n = 3; ++ up = 0; ++ dn = 0; ++ result = 1; ++ } ++ } else if (retry_count <= ++ 3) { /* <=3 retry in the last 2-second duration */ ++ up--; ++ dn++; ++ ++ if (up <= 0) ++ up = 0; ++ ++ if (dn == 2) { /* if s 2 2 retry count< 3, hկWiFi duration */ ++ if (wait_count <= 2) ++ m++; /* קK@blevelӦ^ */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ } else { /* retry count > 3, un1 retry count > 3, hկWiFi duration */ ++ if (wait_count == 1) ++ m++; /* קK@blevelӦ^ */ ++ else ++ m = 1; ++ ++ if (m >= 20) /* m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. */ ++ m = 20; ++ ++ n = 3 * m; ++ up = 0; ++ dn = 0; ++ wait_count = 0; ++ result = -1; ++ } ++ ++ if (max_interval == 1) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 71) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 5); ++ coex_dm->ps_tdma_du_adj_type = 5; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 5); ++ coex_dm->ps_tdma_du_adj_type = 5; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 13); ++ coex_dm->ps_tdma_du_adj_type = 13; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 5); ++ coex_dm->ps_tdma_du_adj_type = ++ 5; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 13); ++ coex_dm->ps_tdma_du_adj_type = ++ 13; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 71); ++ coex_dm->ps_tdma_du_adj_type = 71; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 9); ++ coex_dm->ps_tdma_du_adj_type = 9; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 71) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 1); ++ coex_dm->ps_tdma_du_adj_type = ++ 1; ++ } else if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 71); ++ coex_dm->ps_tdma_du_adj_type = ++ 71; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 9); ++ coex_dm->ps_tdma_du_adj_type = ++ 9; ++ } ++ } ++ } ++ } else if (max_interval == 2) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 6); ++ coex_dm->ps_tdma_du_adj_type = 6; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 14); ++ coex_dm->ps_tdma_du_adj_type = 14; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 6); ++ coex_dm->ps_tdma_du_adj_type = ++ 6; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 14); ++ coex_dm->ps_tdma_du_adj_type = ++ 14; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 2); ++ coex_dm->ps_tdma_du_adj_type = 2; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 10); ++ coex_dm->ps_tdma_du_adj_type = 10; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 2); ++ coex_dm->ps_tdma_du_adj_type = ++ 2; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 10); ++ coex_dm->ps_tdma_du_adj_type = ++ 10; ++ } ++ } ++ } ++ } else if (max_interval == 3) { ++ if (tx_pause) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 7); ++ coex_dm->ps_tdma_du_adj_type = 7; ++ } else if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 8); ++ coex_dm->ps_tdma_du_adj_type = 8; ++ } ++ if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 15); ++ coex_dm->ps_tdma_du_adj_type = 15; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 16); ++ coex_dm->ps_tdma_du_adj_type = 16; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 8); ++ coex_dm->ps_tdma_du_adj_type = ++ 8; ++ } else if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 16); ++ coex_dm->ps_tdma_du_adj_type = ++ 16; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 7); ++ coex_dm->ps_tdma_du_adj_type = ++ 7; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 15); ++ coex_dm->ps_tdma_du_adj_type = ++ 15; ++ } ++ } ++ } else { ++ if (coex_dm->cur_ps_tdma == 5) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 6) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 7) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 3); ++ coex_dm->ps_tdma_du_adj_type = 3; ++ } else if (coex_dm->cur_ps_tdma == 8) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 4); ++ coex_dm->ps_tdma_du_adj_type = 4; ++ } ++ if (coex_dm->cur_ps_tdma == 13) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 14) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 15) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 11); ++ coex_dm->ps_tdma_du_adj_type = 11; ++ } else if (coex_dm->cur_ps_tdma == 16) { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, ++ NORMAL_EXEC, true, 12); ++ coex_dm->ps_tdma_du_adj_type = 12; ++ } ++ if (result == -1) { ++ if (coex_dm->cur_ps_tdma == 1) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 4); ++ coex_dm->ps_tdma_du_adj_type = ++ 4; ++ } else if (coex_dm->cur_ps_tdma == 9) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 12); ++ coex_dm->ps_tdma_du_adj_type = ++ 12; ++ } ++ } else if (result == 1) { ++ if (coex_dm->cur_ps_tdma == 4) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 3) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 2) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 3); ++ coex_dm->ps_tdma_du_adj_type = ++ 3; ++ } else if (coex_dm->cur_ps_tdma == 12) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 11) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } else if (coex_dm->cur_ps_tdma == 10) { ++ halbtc8821aCsr2ant_ps_tdma( ++ btcoexist, NORMAL_EXEC, ++ true, 11); ++ coex_dm->ps_tdma_du_adj_type = ++ 11; ++ } ++ } ++ } ++ } ++ } ++ ++ /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ ++ /* then we have to adjust it back to the previous record one. */ ++ if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { ++ boolean scan = false, link = false, roam = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", ++ coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (!scan && !link && !roam) ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ coex_dm->ps_tdma_du_adj_type); ++ else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ /* when halbtc8821aCsr2ant_tdma_duration_adjust() is called, fw dac swing is included in the function. */ ++ /* if(coex_dm->ps_tdma_du_adj_type == 71) */ ++ /* halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc); //Skip because A2DP get worse at HT40 */ ++ /* else */ ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, ++ 0x6); ++} ++ ++/* SCO only or SCO+PAN(HS) */ ++void halbtc8821aCsr2ant_action_sco(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55555555, ++ 0x55555555, 0xffffff, 0x3); ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ halbtc8821aCsr2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, true); ++ ++ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 1, 0, 2, 0); ++ ++ if (coex_sta->slave == false) ++ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ true, 0x4); ++ else ++ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ true, 0x2); ++ ++ /* ++ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, 15, 0); ++ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); ++ ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 4); ++ ++ if(halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); ++ else ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_LEGACY == wifi_bw) ++ { ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x5a5a5a5a, 0x5a5a5a5a, 0xffff, 0x3); ++ } ++ else ++ { ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x5aea5aea, 0x5aea5aea, 0xffff, 0x3); ++ } ++ ++ if(BTC_WIFI_BW_HT40 == wifi_bw) ++ { ++ ++ ++ ++ ++ if( (bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } ++ else ++ { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } ++ ++ ++ if( (wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,true,true,false,false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,true,false,false,0x18); ++ } ++ else ++ { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,true,true,false,false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,false,false,false,0x18); ++ } ++ } ++ else ++ { ++ ++ ++ ++ if( (bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } ++ else ++ { ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } ++ ++ ++ if( (wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,false,true,false,false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,true,false,false,0x18); ++ } ++ else ++ { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,false,true,false,false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,false,false,false,0x18); ++ } ++ } ++ */ ++} ++ ++ ++void halbtc8821aCsr2ant_action_hid(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, ++ 15, 0); ++ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); ++ ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); ++ else ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); ++ else /* for HID quality & wifi performance balance at 11n mode */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0x55ff55ff, 0x5aea5aea, 0xffff, 0x3); ++ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ /* fw mechanism */ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 9); ++ else ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 13); ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } else { ++ /* fw mechanism */ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 9); ++ else ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 13); ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ true, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ true, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } ++} ++ ++/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ ++void halbtc8821aCsr2ant_action_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x8); ++ ++ if (coex_sta->slave == false) { ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0xfdfdfdfd, 0xdfdadfda, 0xffffff, 0x3); ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, ++ 0, 1); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, true, ++ 0x0c); ++ } else { ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0xfdfdfdfd, 0xdfdadfda, 0xffffff, 0x3); ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); ++ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, ++ 0, 2); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, true, ++ 0x18); ++ } ++ ++ /* ++ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, 15, 0); ++ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); ++ ++ ++ ++ ++ ++ if(halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); ++ else ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if(BTC_WIFI_BW_HT40 == wifi_bw) ++ { ++ ++ if( (bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, false, false, 1); ++ } ++ else ++ { ++ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, false, true, 1); ++ } ++ ++ ++ if( (wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,true,false,false,false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,true,false,false,0x18); ++ } ++ else ++ { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,true,false,false,false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,false,false,false,0x18); ++ } ++ } ++ else ++ { ++ ++ if( (bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, false, false, 1); ++ } ++ else ++ { ++ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, false, true, 1); ++ } ++ ++ ++ if( (wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) ++ { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,false,false,false,false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,true,false,false,0x18); ++ } ++ else ++ { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,false,false,false,false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,false,false,false,0x18); ++ } ++ } ++ */ ++} ++ ++void halbtc8821aCsr2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state, bt_info_ext; ++ u32 wifi_bw; ++ ++ bt_info_ext = coex_sta->bt_info_ext; ++ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, ++ 15, 0); ++ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); ++ ++ /* fw dac swing is called in halbtc8821aCsr2ant_tdma_duration_adjust() */ ++ /* halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); */ ++ ++ ++ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); ++ else ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ /* fw mechanism */ ++ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, ++ false, true, 2); ++ else /* a2dp edr rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, ++ false, true, 1); ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } else { ++ /* fw mechanism */ ++ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, ++ false, true, 2); ++ else /* a2dp edr rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, ++ false, true, 1); ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } ++} ++ ++void halbtc8821aCsr2ant_action_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, ++ 15, 0); ++ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); ++ ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); ++ else ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0x55ff55ff, 0x5aff5aff, 0xffff, 0x3); ++ else /* for HID quality & wifi performance balance at 11n mode */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0x55ff55ff, 0x5aff5aff, 0xffff, 0x3); ++ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ /* fw mechanism */ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 1); ++ else ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 5); ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } else { ++ /* fw mechanism */ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 1); ++ else ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 5); ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } ++} ++ ++ ++/* PAN(HS) only */ ++void halbtc8821aCsr2ant_action_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, ++ 15, 0); ++ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); ++ ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ /* fw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, ++ true); ++ else ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, ++ false); ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } else { ++ /* fw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, ++ true); ++ else ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, ++ false); ++ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ false, 1); ++ else ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, ++ false, 1); ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } ++} ++ ++/* PAN(EDR)+A2DP */ ++void halbtc8821aCsr2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state, bt_info_ext; ++ u32 wifi_bw; ++ ++ bt_info_ext = coex_sta->bt_info_ext; ++ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, ++ 15, 0); ++ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); ++ ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); ++ else ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0x55ff55ff, 0x5afa5afa, 0xffff, 0x3); ++ else /* for HID quality & wifi performance balance at 11n mode */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0x55ff55ff, 0x5afa5afa, 0xffff, 0x3); ++ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ /* fw mechanism */ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, false, false, 3); ++ else /* a2dp edr rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, false, false, 3); ++ } else { ++ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, false, true, 3); ++ else /* a2dp edr rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, false, true, 3); ++ } ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ }; ++ } else { ++ /* fw mechanism */ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, false, false, 3); ++ else /* a2dp edr rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, false, false, 3); ++ } else { ++ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, false, true, 3); ++ else /* a2dp edr rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, false, true, 3); ++ } ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ false, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } ++} ++ ++void halbtc8821aCsr2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state; ++ u32 wifi_bw; ++ ++ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, ++ 15, 0); ++ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); ++ ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); ++ else ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0x55ff55ff, 0x5a5f5a5f, 0xffff, 0x3); ++ else /* for HID quality & wifi performance balance at 11n mode */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0x55ff55ff, 0x5a5f5a5f, 0xffff, 0x3); ++ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 3); ++ /* fw mechanism */ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 10); ++ else ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 14); ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } else { ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ /* fw mechanism */ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 10); ++ else ++ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 14); ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ true, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ true, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } ++} ++ ++/* HID+A2DP+PAN(EDR) */ ++void halbtc8821aCsr2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist ++ *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state, bt_info_ext; ++ u32 wifi_bw; ++ ++ bt_info_ext = coex_sta->bt_info_ext; ++ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, ++ 15, 0); ++ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); ++ ++ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ ++ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); ++ else ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); ++ else /* for HID quality & wifi performance balance at 11n mode */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); ++ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ /* fw mechanism */ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 3); ++ else /* a2dp edr rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 3); ++ } else { ++ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 3); ++ else /* a2dp edr rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 3); ++ } ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } else { ++ /* fw mechanism */ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, false, 3); ++ else /* a2dp edr rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, false, 3); ++ } else { ++ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 3); ++ else /* a2dp edr rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 3); ++ } ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ true, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ true, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } ++} ++ ++void halbtc8821aCsr2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ u8 wifi_rssi_state, bt_rssi_state, bt_info_ext; ++ u32 wifi_bw; ++ ++ bt_info_ext = coex_sta->bt_info_ext; ++ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, ++ 15, 0); ++ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); ++ ++ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); ++ else ++ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_LEGACY == wifi_bw) { /* for HID at 11b/g mode */ ++ /* Allen halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0x55ff55ff, 0x5f5b5f5b, 0xffffff, 0x3); ++ } else { /* for HID quality & wifi performance balance at 11n mode */ ++ /* Allen halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, ++ 0x55ff55ff, 0x5f5b5f5b, 0xffffff, 0x3); ++ ++ } ++ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) { ++ /* fw mechanism */ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 2); ++ else /* a2dp edr rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 2); ++ } else { ++ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 2); ++ else /* a2dp edr rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 2); ++ } ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, ++ false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } else { ++ /* fw mechanism */ ++ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ if (bt_info_ext & BIT(0)) { /* a2dp basic rate */ ++ /* halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, true, false, 2); */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 2); ++ ++ } else { /* a2dp edr rate */ ++ /* Allen halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, true, false, 2); */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 2); ++ } ++ } else { ++ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 2); ++ else /* a2dp edr rate */ ++ halbtc8821aCsr2ant_tdma_duration_adjust( ++ btcoexist, true, true, 2); ++ } ++ ++ /* sw mechanism */ ++ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || ++ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ true, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, ++ false, false, 0x18); ++ } else { ++ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, ++ true, false, false); ++ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, ++ false, false, 0x18); ++ } ++ } ++} ++ ++void halbtc8821aCsr2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_under_5g = false; ++ u8 algorithm = 0; ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Manual control!!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ if (wifi_under_5g) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), run 5G coex setting!!<===\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_coex_under_5g(btcoexist); ++ return; ++ } ++ ++ { ++ algorithm = halbtc8821aCsr2ant_action_algorithm(btcoexist); ++ if (coex_sta->c2h_bt_inquiry_page && ++ (BT_8821A_CSR_2ANT_COEX_ALGO_PANHS != algorithm)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under inquiry/page scan !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_bt_inquiry_page(btcoexist); ++ return; ++ } ++ ++ coex_dm->cur_algorithm = algorithm; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Algorithm = %d\n", coex_dm->cur_algorithm); ++ BTC_TRACE(trace_buf); ++ ++ if (halbtc8821aCsr2ant_is_common_action(btcoexist)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant common.\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->reset_tdma_adjust = true; ++ } else { ++ if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", ++ coex_dm->pre_algorithm, ++ coex_dm->cur_algorithm); ++ BTC_TRACE(trace_buf); ++ coex_dm->reset_tdma_adjust = true; ++ } ++ switch (coex_dm->cur_algorithm) { ++ case BT_8821A_CSR_2ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_action_sco( ++ btcoexist); ++ break; ++ case BT_8821A_CSR_2ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_action_hid( ++ btcoexist); ++ break; ++ case BT_8821A_CSR_2ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_action_a2dp( ++ btcoexist); ++ break; ++ case BT_8821A_CSR_2ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_action_a2dp_pan_hs( ++ btcoexist); ++ break; ++ case BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_action_pan_edr( ++ btcoexist); ++ break; ++ case BT_8821A_CSR_2ANT_COEX_ALGO_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_action_pan_hs( ++ btcoexist); ++ break; ++ case BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_action_pan_edr_a2dp( ++ btcoexist); ++ break; ++ case BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_action_pan_edr_hid( ++ btcoexist); ++ break; ++ case BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR ++ : ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_action_hid_a2dp_pan_edr( ++ btcoexist); ++ break; ++ case BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_action_hid_a2dp( ++ btcoexist); ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_coex_all_off( ++ btcoexist); ++ break; ++ } ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ } ++ } ++} ++ ++ ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8821aCsr2ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8821aCsr2ant_ ++ * ************************************************************ */ ++void ex_halbtc8821aCsr2ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++} ++ ++void ex_halbtc8821aCsr2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 2Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (wifi_only) ++ return; ++ ++ /* if(back_up) */ ++ { ++ /* backup rf 0x1e value */ ++ coex_dm->bt_rf_0x1e_backup = btcoexist->btc_get_rf_reg( ++ btcoexist, BTC_RF_A, 0x1e, 0xfffff); ++ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, ++ 0x430); ++ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, ++ 0x434); ++ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( ++ btcoexist, 0x42a); ++ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( ++ btcoexist, 0x456); ++ coex_dm->backup_ampdu_max_num = btcoexist->btc_read_2byte( ++ btcoexist, 0x4ca); ++ } ++ ++#if 0 /* REMOVE */ ++ /* 0x790[5:0]=0x5 */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); ++ u8tmp &= 0xc0; ++ u8tmp |= 0x5; ++ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); ++#endif ++ ++ /* Antenna config */ ++ halbtc8821aCsr2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, true, ++ false); ++ ++ /* PTA parameter */ ++ halbtc8821aCsr2ant_coex_table(btcoexist, FORCE_EXEC, 0x55555555, ++ 0x55555555, 0xffff, 0x3); ++ ++ /* Enable counter statistics */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, ++ 0xc); /* 0x76e[3] =1, WLAN_Act control by PTA */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); ++ ++#if 0 /* REMOVE */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); ++#endif ++} ++ ++void ex_halbtc8821aCsr2ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821aCsr2ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8821aCsr2ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_stack_info *stack_info = &btcoexist->stack_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; ++ u32 u32tmp[4]; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", ++ "Ant PG number/ Ant mechanism:", ++ board_info->pg_ant_num, board_info->btdm_ant_num); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "[Action Manual control]!!"); ++ CL_PRINTF(cli_buf); ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", ++ "CoexVer/ FwVer/ PatchVer", ++ glcoex_ver_date_8821a_csr_2ant, glcoex_ver_8821a_csr_2ant, ++ fw_ver, bt_patch_ver, bt_patch_ver); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt]", ++ ((coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") : (( ++ BT_8821A_CSR_2ANT_BT_STATUS_IDLE == coex_dm->bt_status) ++ ? "idle" : ((BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE ++ == coex_dm->bt_status) ? "connected-idle" : "busy"))), ++ coex_sta->bt_rssi, coex_sta->bt_retry_cnt); ++ CL_PRINTF(cli_buf); ++ ++ if (stack_info->profile_notified) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", ++ stack_info->sco_exist, stack_info->hid_exist, ++ stack_info->pan_exist, stack_info->a2dp_exist); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_disp_dbg_msg(btcoexist, ++ BTC_DBG_DISP_BT_LINK_INFO); ++ } ++ ++ bt_info_ext = coex_sta->bt_info_ext; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "BT Info A2DP rate", ++ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); ++ CL_PRINTF(cli_buf); ++ ++ for (i = 0; i < BT_INFO_SRC_8821A_CSR_2ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8821a_csr_2ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ /* Sw mechanism */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Sw mechanism]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", ++ "SM1[ShRf/ LpRA/ LimDig]", ++ coex_dm->cur_rf_rx_lpf_shrink, coex_dm->cur_low_penalty_ra, ++ coex_dm->limited_dig); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", ++ "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", ++ coex_dm->cur_agc_table_en, coex_dm->cur_adc_back_off, ++ coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); ++ CL_PRINTF(cli_buf); ++ ++ /* Fw mechanism */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Fw mechanism]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (!btcoexist->manual_control) { ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", ++ "DecBtPwr/ IgnWlanAct", ++ coex_dm->cur_dec_bt_pwr, coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ } ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", ++ "RF-A, 0x1e initVal", ++ coex_dm->bt_rf_0x1e_backup); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x ", ++ "0x778 (W_Act)/ 0x6cc (CoTab Sel)", ++ u8tmp[0], u8tmp[1]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x8db); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xc5b); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x8db(ADC)/0xc5b[29:25](DAC)", ++ ((u8tmp[0] & 0x60) >> 5), ((u8tmp[1] & 0x3e) >> 1)); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0xcb4[7:0](ctrl)/ 0xcb4[29:28](val)", ++ u32tmp[0] & 0xff, ((u32tmp[0] & 0x30000000) >> 28)); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x974); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x40/ 0x4c[24:23]/ 0x974", ++ u8tmp[0], ((u32tmp[0] & 0x01800000) >> 23), u32tmp[1]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x550(bcn ctrl)/0x522", ++ u32tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa0a); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0xc50(DIG)/0xa0a(CCK-TH)", ++ u32tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "OFDM-FA/ CCK-FA", ++ u32tmp[0], (u8tmp[0] << 8) + u8tmp[1]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8", ++ u32tmp[0], u32tmp[1], u32tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770 (hi-pri Rx/Tx)", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(low-pri Rx/Tx)", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++void ex_halbtc8821aCsr2ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ halbtc8821aCsr2ant_coex_all_off(btcoexist); ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = false; ++ /* halbtc8821aCsr2ant_init_coex_dm(btcoexist); */ ++ } ++} ++ ++void ex_halbtc8821aCsr2ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ } ++} ++ ++void ex_halbtc8821aCsr2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (BTC_SCAN_START == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ } else if (BTC_SCAN_FINISH == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++} ++ ++void ex_halbtc8821aCsr2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ if (BTC_ASSOCIATE_START == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ } else if (BTC_ASSOCIATE_FINISH == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++} ++ ++void ex_halbtc8821aCsr2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ h2c_parameter[0] = 0x1; ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ ++} ++ ++void ex_halbtc8821aCsr2ant_specific_packet_notify(IN struct btc_coexist ++ *btcoexist, IN u8 type) ++{ ++ if (type == BTC_PACKET_DHCP) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], DHCP Packet notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++} ++ ++void ex_halbtc8821aCsr2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 bt_info = 0; ++ u8 i, rsp_source = 0; ++ boolean bt_busy = false, limited_dig = false; ++ boolean wifi_connected = false, bt_hs_on = false, ++ wifi_under_5g = false; ++ ++ coex_sta->c2h_bt_info_req_sent = false; ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8821A_CSR_2ANT_MAX) ++ rsp_source = BT_INFO_SRC_8821A_CSR_2ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ if (i == 1) ++ bt_info = tmp_buf[i]; ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (BT_INFO_SRC_8821A_CSR_2ANT_WIFI_FW != rsp_source) { ++ coex_sta->bt_retry_cnt = /* [3:0] */ ++ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; ++ ++ coex_sta->bt_rssi = ++ coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; ++ ++ coex_sta->bt_info_ext = ++ coex_sta->bt_info_c2h[rsp_source][4]; ++ ++#if 0 /* REMOVE */ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ if ((coex_sta->bt_info_ext & BIT(1))) { ++ ++ if (wifi_connected) ++ ex_halbtc8821aCsr2ant_media_status_notify( ++ btcoexist, BTC_MEDIA_CONNECT); ++ else ++ ex_halbtc8821aCsr2ant_media_status_notify( ++ btcoexist, BTC_MEDIA_DISCONNECT); ++ } ++#endif ++ ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (bt_info == ++ BT_INFO_8821A_CSR_2ANT_B_CONNECTION) { /* connection exists but no busy */ ++ coex_sta->bt_link_exist = true; ++ coex_dm->bt_status = ++ BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE; ++ } else if (bt_info & ++ BT_INFO_8821A_CSR_2ANT_B_CONNECTION) { /* connection exists and some link is busy */ ++ coex_sta->bt_link_exist = true; ++ ++ if (bt_info & BT_INFO_8821A_CSR_2ANT_B_FTP) ++ coex_sta->pan_exist = true; ++ else ++ coex_sta->pan_exist = false; ++ ++ if (bt_info & BT_INFO_8821A_CSR_2ANT_B_A2DP) ++ coex_sta->a2dp_exist = true; ++ else ++ coex_sta->a2dp_exist = false; ++ ++ if (bt_info & BT_INFO_8821A_CSR_2ANT_B_HID) ++ coex_sta->hid_exist = true; ++ else ++ coex_sta->hid_exist = false; ++ ++ if (bt_info & BT_INFO_8821A_CSR_2ANT_B_SCO_ESCO) ++ coex_sta->sco_exist = true; ++ else ++ coex_sta->sco_exist = false; ++ ++ if (coex_sta->bt_info_ext & 0x80) ++ coex_sta->slave = true; /* Slave */ ++ else ++ coex_sta->slave = false; /* Master */ ++ ++ coex_dm->bt_status = ++ BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE; ++ } else { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->slave = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ coex_dm->bt_status = BT_8821A_CSR_2ANT_BT_STATUS_IDLE; ++ } ++ ++ if (bt_hs_on) ++ coex_dm->bt_status = ++ BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE; ++ ++ if (bt_info & BT_INFO_8821A_CSR_2ANT_B_INQ_PAGE) { ++ coex_sta->c2h_bt_inquiry_page = true; ++ coex_dm->bt_status = BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE; ++ } else ++ coex_sta->c2h_bt_inquiry_page = false; ++ ++ ++ if (BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE == coex_dm->bt_status) ++ bt_busy = true; ++ else ++ bt_busy = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ if (BT_8821A_CSR_2ANT_BT_STATUS_IDLE != coex_dm->bt_status) ++ limited_dig = true; ++ else ++ limited_dig = false; ++ coex_dm->limited_dig = limited_dig; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); ++ ++ halbtc8821aCsr2ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8821aCsr2ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821aCsr2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ex_halbtc8821aCsr2ant_media_status_notify(btcoexist, ++ BTC_MEDIA_DISCONNECT); ++} ++ ++void ex_halbtc8821aCsr2ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_WIFI_PNP_SLEEP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821aCsr2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ++ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ ++ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ ++ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ ++ coex_sta->under_ips = false; ++ coex_sta->under_lps = false; ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++ } ++} ++ ++void ex_halbtc8821aCsr2ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821aCsr2ant_monitor_bt_ctr(btcoexist); ++ halbtc8821aCsr2ant_monitor_bt_enable_disable(btcoexist); ++} ++ ++#endif ++ ++#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ +\ Ingen nyrad vid filslut +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.h 2018-02-11 21:44:27.147146086 +0200 +@@ -0,0 +1,188 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8821A_SUPPORT == 1) ++ ++/* ******************************************* ++ * The following is for 8821A_CSR 2Ant BT Co-exist definition ++ * ******************************************* */ ++#define BT_INFO_8821A_CSR_2ANT_B_FTP BIT(7) ++#define BT_INFO_8821A_CSR_2ANT_B_A2DP BIT(6) ++#define BT_INFO_8821A_CSR_2ANT_B_HID BIT(5) ++#define BT_INFO_8821A_CSR_2ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8821A_CSR_2ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8821A_CSR_2ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8821A_CSR_2ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8821A_CSR_2ANT_B_CONNECTION BIT(0) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT 2 ++ ++enum bt_info_src_8821a_csr_2ant { ++ BT_INFO_SRC_8821A_CSR_2ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8821A_CSR_2ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8821A_CSR_2ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8821A_CSR_2ANT_MAX ++}; ++ ++enum bt_8821a_csr_2ant_bt_status { ++ BT_8821A_CSR_2ANT_BT_STATUS_IDLE = 0x0, ++ BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE = 0x2, ++ BT_8821A_CSR_2ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8821a_csr_2ant_coex_algo { ++ BT_8821A_CSR_2ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8821A_CSR_2ANT_COEX_ALGO_SCO = 0x1, ++ BT_8821A_CSR_2ANT_COEX_ALGO_HID = 0x2, ++ BT_8821A_CSR_2ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8821A_CSR_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR = 0x5, ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANHS = 0x6, ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, ++ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID = 0x8, ++ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, ++ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP = 0xa, ++ BT_8821A_CSR_2ANT_COEX_ALGO_MAX = 0xb, ++}; ++ ++struct coex_dm_8821a_csr_2ant { ++ /* fw mechanism */ ++ boolean pre_dec_bt_pwr; ++ boolean cur_dec_bt_pwr; ++ u8 pre_fw_dac_swing_lvl; ++ u8 cur_fw_dac_swing_lvl; ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[6]; ++ u8 ps_tdma_du_adj_type; ++ boolean reset_tdma_adjust; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ ++ /* sw mechanism */ ++ boolean pre_rf_rx_lpf_shrink; ++ boolean cur_rf_rx_lpf_shrink; ++ u32 bt_rf_0x1e_backup; ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ boolean pre_dac_swing_on; ++ u32 pre_dac_swing_lvl; ++ boolean cur_dac_swing_on; ++ u32 cur_dac_swing_lvl; ++ boolean pre_adc_back_off; ++ boolean cur_adc_back_off; ++ boolean pre_agc_table_en; ++ boolean cur_agc_table_en; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ boolean limited_dig; ++ ++ u32 pre_ra_mask; ++ u32 cur_ra_mask; ++ ++ u8 cur_ampdu_num_type; ++ u8 pre_ampdu_num_type; ++ u16 backup_ampdu_max_num; ++ ++ u8 cur_ampdu_time_type; ++ u8 pre_ampdu_time_type; ++ u8 backup_ampdu_max_time; ++ ++ u8 cur_arfr_type; ++ u8 pre_arfr_type; ++ u32 backup_arfr_cnt1; ++ u32 backup_arfr_cnt2; ++ ++ u8 cur_retry_limit_type; ++ u8 pre_retry_limit_type; ++ u16 backup_retry_limit; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++}; ++ ++struct coex_sta_8821a_csr_2ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean slave; ++ boolean hid_exist; ++ boolean pan_exist; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ u8 bt_rssi; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ boolean c2h_bt_info_req_sent; ++ u8 bt_info_c2h[BT_INFO_SRC_8821A_CSR_2ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8821A_CSR_2ANT_MAX]; ++ boolean c2h_bt_inquiry_page; ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++}; ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8821aCsr2ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821aCsr2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8821aCsr2ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821aCsr2ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821aCsr2ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821aCsr2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821aCsr2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821aCsr2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821aCsr2ant_specific_packet_notify(IN struct btc_coexist ++ *btcoexist, IN u8 type); ++void ex_halbtc8821aCsr2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8821aCsr2ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821aCsr2ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state); ++void ex_halbtc8821aCsr2ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821aCsr2ant_display_coex_info(IN struct btc_coexist *btcoexist); ++ ++#else ++#define ex_halbtc8821aCsr2ant_power_on_setting(btcoexist) ++#define ex_halbtc8821aCsr2ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8821aCsr2ant_init_coex_dm(btcoexist) ++#define ex_halbtc8821aCsr2ant_ips_notify(btcoexist, type) ++#define ex_halbtc8821aCsr2ant_lps_notify(btcoexist, type) ++#define ex_halbtc8821aCsr2ant_scan_notify(btcoexist, type) ++#define ex_halbtc8821aCsr2ant_connect_notify(btcoexist, type) ++#define ex_halbtc8821aCsr2ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8821aCsr2ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8821aCsr2ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8821aCsr2ant_halt_notify(btcoexist) ++#define ex_halbtc8821aCsr2ant_pnp_notify(btcoexist, pnp_state) ++#define ex_halbtc8821aCsr2ant_periodical(btcoexist) ++#define ex_halbtc8821aCsr2ant_display_coex_info(btcoexist) ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.c 2018-02-11 21:44:27.149146116 +0200 +@@ -0,0 +1,5979 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8821C Co-exist mechanism ++ * ++ * History ++ * 2012/11/15 Cosa first check in. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8821C_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8821c_1ant glcoex_dm_8821c_1ant; ++static struct coex_dm_8821c_1ant *coex_dm = &glcoex_dm_8821c_1ant; ++static struct coex_sta_8821c_1ant glcoex_sta_8821c_1ant; ++static struct coex_sta_8821c_1ant *coex_sta = &glcoex_sta_8821c_1ant; ++static struct psdscan_sta_8821c_1ant gl_psd_scan_8821c_1ant; ++static struct psdscan_sta_8821c_1ant *psd_scan = &gl_psd_scan_8821c_1ant; ++static struct rfe_type_8821c_1ant gl_rfe_type_8821c_1ant; ++static struct rfe_type_8821c_1ant *rfe_type = &gl_rfe_type_8821c_1ant; ++ ++ ++const char *const glbt_info_src_8821c_1ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++u32 glcoex_ver_date_8821c_1ant = 20160316; ++u32 glcoex_ver_8821c_1ant = 0x00; ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8821c1ant_ ++ * ************************************************************ */ ++u8 halbtc8821c1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_bt_rssi_state; ++ } ++ ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8821c1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_wifi_rssi_state[index]; ++ } ++ ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8821c1ant_update_ra_mask(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 dis_rate_mask) ++{ ++ coex_dm->cur_ra_mask = dis_rate_mask; ++ ++ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, ++ &coex_dm->cur_ra_mask); ++ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; ++} ++ ++void halbtc8821c1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ ++ coex_dm->cur_arfr_type = type; ++ ++ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { ++ switch (coex_dm->cur_arfr_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_4byte(btcoexist, 0x430, ++ coex_dm->backup_arfr_cnt1); ++ btcoexist->btc_write_4byte(btcoexist, 0x434, ++ coex_dm->backup_arfr_cnt2); ++ break; ++ case 1: ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x01010101); ++ } else { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x04030201); ++ } ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; ++} ++ ++void halbtc8821c1ant_retry_limit(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_retry_limit_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_retry_limit_type != ++ coex_dm->cur_retry_limit_type)) { ++ switch (coex_dm->cur_retry_limit_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ coex_dm->backup_retry_limit); ++ break; ++ case 1: /* retry limit=8 */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ 0x0808); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; ++} ++ ++void halbtc8821c1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_ampdu_time_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { ++ switch (coex_dm->cur_ampdu_time_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ coex_dm->backup_ampdu_max_time); ++ break; ++ case 1: /* AMPDU timw = 0x38 * 32us */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ 0x38); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; ++} ++ ++void halbtc8821c1ant_limited_tx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, ++ IN u8 retry_limit_type, IN u8 ampdu_time_type) ++{ ++ switch (ra_mask_type) { ++ case 0: /* normal mode */ ++ halbtc8821c1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0); ++ break; ++ case 1: /* disable cck 1/2 */ ++ halbtc8821c1ant_update_ra_mask(btcoexist, force_exec, ++ 0x00000003); ++ break; ++ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ ++ halbtc8821c1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0001f1f7); ++ break; ++ default: ++ break; ++ } ++ ++ halbtc8821c1ant_auto_rate_fallback_retry(btcoexist, force_exec, ++ arfr_type); ++ halbtc8821c1ant_retry_limit(btcoexist, force_exec, retry_limit_type); ++ halbtc8821c1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); ++} ++ ++void halbtc8821c1ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++ ++ ++} ++ ++void halbtc8821c1ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ coex_sta->c2h_bt_info_req_sent = true; ++ ++ h2c_parameter[0] |= BIT(0); /* trigger */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WL query BT info!!\n"); ++ BTC_TRACE(trace_buf); ++} ++ ++void halbtc8821c1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ static u8 num_of_bt_counter_chk = 0, cnt_slave = 0; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ ++ /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", ++ reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); ++ ++ BTC_TRACE(trace_buf); ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++ ++ if ((coex_sta->low_priority_tx > 1150) && ++ (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->pop_event_cnt++; ++ ++ if ((coex_sta->low_priority_rx >= 1150) && (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) ++ && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist)) { ++ if (cnt_slave >= 3) { ++ bt_link_info->slave_role = true; ++ cnt_slave = 3; ++ } else ++ cnt_slave++; ++ } else { ++ if (cnt_slave == 0) { ++ bt_link_info->slave_role = false; ++ cnt_slave = 0; ++ } else ++ cnt_slave--; ++ ++ } ++ ++ if ((coex_sta->high_priority_tx == 0) && (coex_sta->high_priority_rx == 0) && (coex_sta->low_priority_tx == 0) && ++ (coex_sta->low_priority_rx == 0)) { ++ num_of_bt_counter_chk++; ++ if (num_of_bt_counter_chk >= 3) { ++ halbtc8821c1ant_query_bt_info(btcoexist); ++ num_of_bt_counter_chk = 0; ++ } ++ } ++ ++#if 0 ++ /* Add Hi-Pri Tx/Rx counter to avoid false detection */ ++ if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) && ++ (coex_sta->high_priority_tx + coex_sta->high_priority_rx ++ >= 160) ++ && (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->bt_hi_pri_link_exist = true; ++ else ++ coex_sta->bt_hi_pri_link_exist = false; ++ ++ if ((coex_sta->acl_busy) && ++ (coex_sta->num_of_profile == 0)) { ++ if (coex_sta->low_priority_tx + ++ coex_sta->low_priority_rx >= 160) { ++ coex_sta->pan_exist = true; ++ coex_sta->num_of_profile++; ++ coex_sta->wrong_profile_notification++; ++ } ++ } ++#endif ++ ++} ++ ++ ++ ++void halbtc8821c1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) ++{ ++ s32 wifi_rssi = 0; ++ boolean wifi_busy = false, wifi_under_b_mode = false; ++ static u8 cck_lock_counter = 0; ++ u32 total_cnt; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ if (coex_sta->under_ips) { ++ coex_sta->crc_ok_cck = 0; ++ coex_sta->crc_ok_11g = 0; ++ coex_sta->crc_ok_11n = 0; ++ coex_sta->crc_ok_11n_agg = 0; ++ ++ coex_sta->crc_err_cck = 0; ++ coex_sta->crc_err_11g = 0; ++ coex_sta->crc_err_11n = 0; ++ coex_sta->crc_err_11n_agg = 0; ++ } else { ++ coex_sta->crc_ok_cck = btcoexist->btc_read_2byte(btcoexist, ++ 0xf04); ++ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf14); ++ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf10); ++ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xf0c); ++ ++ coex_sta->crc_err_cck = btcoexist->btc_read_2byte(btcoexist,0xf00) + btcoexist->btc_read_2byte(btcoexist,0xf06); ++ ++ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf16); ++ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf12); ++ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xf0e); ++ } ++ ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x0); ++ ++ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { ++ total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + ++ coex_sta->crc_ok_11n + ++ coex_sta->crc_ok_11n_agg; ++ ++ if ((coex_dm->bt_status == BT_8821C_1ANT_BT_STATUS_ACL_BUSY) || ++ (coex_dm->bt_status == ++ BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY) || ++ (coex_dm->bt_status == ++ BT_8821C_1ANT_BT_STATUS_SCO_BUSY)) { ++ if (coex_sta->crc_ok_cck > (total_cnt - ++ coex_sta->crc_ok_cck)) { ++ if (cck_lock_counter < 3) ++ cck_lock_counter++; ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ if (!coex_sta->pre_ccklock) { ++ ++ if (cck_lock_counter >= 3) ++ coex_sta->cck_lock = true; ++ else ++ coex_sta->cck_lock = false; ++ } else { ++ if (cck_lock_counter == 0) ++ coex_sta->cck_lock = false; ++ else ++ coex_sta->cck_lock = true; ++ } ++ ++ if (coex_sta->cck_lock) ++ coex_sta->cck_ever_lock = true; ++ ++ coex_sta->pre_ccklock = coex_sta->cck_lock; ++ ++ ++} ++ ++boolean halbtc8821c1ant_is_wifibt_status_changed(IN struct btc_coexist *btcoexist) ++{ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false, pre_bt_off = false; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (coex_sta->bt_disabled != pre_bt_off) { ++ pre_bt_off = coex_sta->bt_disabled; ++ ++ if (coex_sta->bt_disabled) ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!\n"); ++ else ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is enabled !!\n"); ++ ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->bt_coex_supported_feature = 0; ++ coex_sta->bt_coex_supported_version = 0; ++ return true; ++ } ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ } ++ ++ return false; ++} ++ ++void halbtc8821c1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist; ++ bt_link_info->acl_busy = coex_sta->acl_busy; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if (bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if (!bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++} ++ ++void halbtc8821c1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ h2c_parameter[0] = ++ 0x1; /* enable BT AFH skip WL channel for 8821c because BT Rx LO interference */ ++ /* h2c_parameter[0] = 0x0; */ ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); ++ ++} ++ ++u8 halbtc8821c1ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8821C_1ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (!bt_link_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No BT link exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (bt_link_info->sco_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->hid_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->pan_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 1) { ++ if (bt_link_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; ++ } else { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_1ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_1ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_1ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_1ANT_COEX_ALGO_HID_A2DP; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_1ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_1ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_1ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++void halbtc8821c1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8821c1ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ halbtc8821c1ant_set_bt_auto_report(btcoexist, ++ coex_dm->cur_bt_auto_report); ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++void halbtc8821c1ant_set_fw_low_penalty_ra(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ ++ ++ if (low_penalty_ra) { ++ h2c_parameter[1] |= BIT(0); ++ h2c_parameter[2] = ++ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ ++ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ ++ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ ++ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); ++} ++ ++void halbtc8821c1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ halbtc8821c1ant_set_fw_low_penalty_ra(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++} ++ ++void halbtc8821c1ant_sw_mechanism(IN struct btc_coexist *btcoexist, ++ IN boolean low_penalty_ra) ++{ ++ halbtc8821c1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); ++} ++ ++void halbtc8821c1ant_write_score_board( ++ IN struct btc_coexist *btcoexist, ++ IN u16 bitpos, ++ IN BOOLEAN state ++) ++{ ++ ++ static u16 originalval = 0x8002; ++ ++ if (state) ++ originalval = originalval | bitpos; ++ else ++ originalval = originalval & (~bitpos); ++ ++ btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); ++} ++ ++void halbtc8821c1ant_read_score_board( ++ IN struct btc_coexist *btcoexist, ++ IN u16 *score_board_val ++) ++{ ++ ++ *score_board_val = (btcoexist->btc_read_2byte(btcoexist, ++ 0xaa)) & 0x7fff; ++} ++ ++void halbtc8821c1ant_post_activestate_to_bt( ++ IN struct btc_coexist *btcoexist, ++ IN boolean wifi_active ++) ++{ ++ ++ if (wifi_active) ++ halbtc8821c1ant_write_score_board(btcoexist, (u16) BIT(0), TRUE); ++ else ++ halbtc8821c1ant_write_score_board(btcoexist, (u16) BIT(0), FALSE); ++} ++ ++ ++void halbtc8821c1ant_post_onoffstate_to_bt( ++ IN struct btc_coexist *btcoexist, ++ IN boolean wifi_on ++) ++{ ++ ++ if (wifi_on) ++ halbtc8821c1ant_write_score_board(btcoexist, (u16) BIT(1), TRUE); ++ else ++ halbtc8821c1ant_write_score_board(btcoexist, (u16) BIT(1), FALSE); ++} ++ ++void halbtc8821c1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ u16 u16tmp; ++ ++ /* This function check if bt is disabled */ ++#if 0 ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ ++ ++#else ++ ++ /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */ ++ halbtc8821c1ant_read_score_board(btcoexist, &u16tmp); ++ ++ bt_active = u16tmp & BIT(1); ++ ++ ++#endif ++ ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ } else { ++ ++ bt_disable_cnt++; ++ if (bt_disable_cnt >= 2) { ++ bt_disabled = true; ++ bt_disable_cnt = 2; ++ } ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ } ++ ++ ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_disabled = bt_disabled; ++ } ++ ++} ++ ++void halbtc8821c1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, ++ boolean isenable) ++{ ++ static u8 bitVal[5] = {0,0,0,0,0}; ++ static boolean state = false; ++ ++ if (state ==isenable) ++ return; ++ else ++ state = isenable; ++ ++ if (isenable) { ++ ++ /* enable GNT_WL, GNT_BT to GPIO for debug */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); ++ ++ /* store original value */ ++ bitVal[0] = (btcoexist->btc_read_1byte(btcoexist, 0x66) & BIT(4)) >>4; /*0x66[4] */ ++ bitVal[1] = (btcoexist->btc_read_1byte(btcoexist, 0x67) & BIT(0)); /*0x66[8] */ ++ bitVal[2] = (btcoexist->btc_read_1byte(btcoexist, 0x42) & BIT(3)) >> 3; /*0x40[19] */ ++ bitVal[3] = (btcoexist->btc_read_1byte(btcoexist, 0x65) & BIT(7)) >> 7; /*0x64[15] */ ++ bitVal[4] = (btcoexist->btc_read_1byte(btcoexist, 0x72) & BIT(2)) >> 2; /*0x70[18] */ ++ ++ /* switch GPIO Mux */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), 0x0); /*0x66[4] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), 0x0); /*0x66[8] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), 0x0); /*0x40[19] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), 0x0); /*0x64[15] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), 0x0); /*0x70[18] = 0 */ ++ ++ ++ } else { ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); ++ ++ /* Restore original value */ ++ /* switch GPIO Mux */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), bitVal[0]); /*0x66[4] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), bitVal[1]); /*0x66[8] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), bitVal[2]); /*0x40[19] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), bitVal[3]); /*0x64[15] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), bitVal[4]); /*0x70[18] = 0 */ ++ } ++ ++} ++ ++u32 halbtc8821c1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, ++ IN u16 reg_addr) ++{ ++ u32 j = 0; ++ ++ ++ /* wait for ready bit before access 0x1700 */ ++ btcoexist->btc_write_4byte(btcoexist, 0x1700, 0x800F0000 | reg_addr); ++ ++ do { ++ j++; ++ } while (((btcoexist->btc_read_1byte(btcoexist, ++ 0x1703)&BIT(5)) == 0) && ++ (j < BT_8821C_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); ++ ++ ++ return btcoexist->btc_read_4byte(btcoexist, ++ 0x1708); /* get read data */ ++ ++} ++ ++void halbtc8821c1ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist, ++ IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) ++{ ++ u32 val, i = 0, j = 0, bitpos = 0; ++ ++ ++ if (bit_mask == 0x0) ++ return; ++ if (bit_mask == 0xffffffff) { ++ btcoexist->btc_write_4byte(btcoexist, 0x1704, ++ reg_value); /* put write data */ ++ ++ /* wait for ready bit before access 0x1700 */ ++ do { ++ j++; ++ } while (((btcoexist->btc_read_1byte(btcoexist, ++ 0x1703)&BIT(5)) == 0) && ++ (j < BT_8821C_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); ++ ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x1700, ++ 0xc00F0000 | reg_addr); ++ } else { ++ for (i = 0; i <= 31; i++) { ++ if (((bit_mask >> i) & 0x1) == 0x1) { ++ bitpos = i; ++ break; ++ } ++ } ++ ++ /* read back register value before write */ ++ val = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, ++ reg_addr); ++ val = (val & (~bit_mask)) | (reg_value << bitpos); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x1704, ++ val); /* put write data */ ++ ++ /* wait for ready bit before access 0x1700 */ ++ do { ++ j++; ++ } while (((btcoexist->btc_read_1byte(btcoexist, ++ 0x1703)&BIT(5)) == 0) && ++ (j < BT_8821C_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); ++ ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x1700, ++ 0xc00F0000 | reg_addr); ++ ++ } ++ ++} ++ ++void halbtc8821c1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 val; ++ ++ val = (enable) ? 1 : 0; ++ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, ++ val); /* 0x38[7] */ ++ ++} ++ ++void halbtc8821c1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_control) ++{ ++ u8 val; ++ ++ val = (wifi_control) ? 1 : 0; ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, ++ val); /* 0x70[26] */ ++ ++} ++ ++void halbtc8821c1ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, ++ IN u8 control_block, IN boolean sw_control, IN u8 state) ++{ ++ u32 val = 0, bit_mask; ++ ++ state = state & 0x1; ++ val = (sw_control) ? ((state << 1) | 0x1) : 0; ++ ++ switch (control_block) { ++ case BT_8821C_1ANT_GNT_BLOCK_RFC_BB: ++ default: ++ bit_mask = 0xc000; ++ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[15:14] */ ++ bit_mask = 0x0c00; ++ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[11:10] */ ++ break; ++ case BT_8821C_1ANT_GNT_BLOCK_RFC: ++ bit_mask = 0xc000; ++ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[15:14] */ ++ break; ++ case BT_8821C_1ANT_GNT_BLOCK_BB: ++ bit_mask = 0x0c00; ++ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[11:10] */ ++ break; ++ ++ } ++ ++} ++ ++void halbtc8821c1ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, ++ IN u8 control_block, IN boolean sw_control, IN u8 state) ++{ ++ u32 val = 0, bit_mask; ++ ++ state = state & 0x1; ++ val = (sw_control) ? ((state << 1) | 0x1) : 0; ++ ++ switch (control_block) { ++ case BT_8821C_1ANT_GNT_BLOCK_RFC_BB: ++ default: ++ bit_mask = 0x3000; ++ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[13:12] */ ++ bit_mask = 0x0300; ++ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[9:8] */ ++ break; ++ case BT_8821C_1ANT_GNT_BLOCK_RFC: ++ bit_mask = 0x3000; ++ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[13:12] */ ++ break; ++ case BT_8821C_1ANT_GNT_BLOCK_BB: ++ bit_mask = 0x0300; ++ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[9:8] */ ++ break; ++ ++ } ++ ++} ++ ++void halbtc8821c1ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u8 table_type, IN u16 table_content) ++{ ++ u16 reg_addr = 0x0000; ++ ++ switch (table_type) { ++ case BT_8821C_1ANT_CTT_WL_VS_LTE: ++ reg_addr = 0xa0; ++ break; ++ case BT_8821C_1ANT_CTT_BT_VS_LTE: ++ reg_addr = 0xa4; ++ break; ++ } ++ ++ if (reg_addr != 0x0000) ++ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, ++ 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ ++ ++ ++} ++ ++ ++void halbtc8821c1ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, ++ IN u8 table_type, IN u8 table_content) ++{ ++ u16 reg_addr = 0x0000; ++ ++ switch (table_type) { ++ case BT_8821C_1ANT_LBTT_WL_BREAK_LTE: ++ reg_addr = 0xa8; ++ break; ++ case BT_8821C_1ANT_LBTT_BT_BREAK_LTE: ++ reg_addr = 0xac; ++ break; ++ case BT_8821C_1ANT_LBTT_LTE_BREAK_WL: ++ reg_addr = 0xb0; ++ break; ++ case BT_8821C_1ANT_LBTT_LTE_BREAK_BT: ++ reg_addr = 0xb4; ++ break; ++ } ++ ++ if (reg_addr != 0x0000) ++ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, ++ 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ ++ ++ ++} ++ ++void halbtc8821c1ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8821c1ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ ++ halbtc8821c1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8821c1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ u32 break_table; ++ u8 select_table; ++ ++ coex_sta->coex_table_type = type; ++ ++ if (coex_sta->concurrent_rx_mode_on == true) { ++ break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ ++ select_table = ++ 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ ++ } else { ++ break_table = 0xffffff; ++ select_table = 0x3; ++ } ++ ++ switch (type) { ++ case 0: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x55555555, break_table, ++ select_table); ++ break; ++ case 1: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, break_table, ++ select_table); ++ break; ++ case 2: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0xaa5a5a5a, 0xaa5a5a5a, break_table, ++ select_table); ++ break; ++ case 3: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0xaa555555, 0xaa5a5a5a, break_table, ++ select_table); ++ break; ++ case 4: ++ halbtc8821c1ant_coex_table(btcoexist, ++ force_exec, 0xaa555555, 0xaa5a5a5a, ++ break_table, select_table); ++ break; ++ case 5: ++ halbtc8821c1ant_coex_table(btcoexist, ++ force_exec, 0x5a5a5a5a, 0x5a5a5a5a, ++ break_table, select_table); ++ break; ++ case 6: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0xaaaaaaaa, break_table, ++ select_table); ++ break; ++ case 7: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0xaaaaaaaa, 0xaaaaaaaa, break_table, ++ select_table); ++ break; ++ case 8: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, break_table, ++ select_table); ++ break; ++ case 9: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, break_table, ++ select_table); ++ break; ++ case 10: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, break_table, ++ select_table); ++ break; ++ case 11: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, break_table, ++ select_table); ++ break; ++ case 12: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0x5ada5ada, break_table, ++ select_table); ++ break; ++ case 13: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0x5fff5fff, 0xaaaaaaaa, break_table, ++ select_table); ++ break; ++ case 14: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0x5fff5fff, 0x5ada5ada, break_table, ++ select_table); ++ break; ++ case 15: ++ halbtc8821c1ant_coex_table(btcoexist, force_exec, ++ 0x55dd55dd, 0xaaaaaaaa, break_table, ++ select_table); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8821c1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ if (enable) { ++ h2c_parameter[0] |= BIT(0); /* function enable */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); ++} ++ ++void halbtc8821c1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ halbtc8821c1ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8821c1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8821c1ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8821c1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8821c1ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ /*halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); */ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ /*halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8);*/ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++void halbtc8821c1ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ boolean low_pwr_disable = false; ++ ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ /* recover to original 32k low power setting */ ++ coex_sta->force_lps_on = false; ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ ++ break; ++ case BTC_PS_LPS_ON: ++ coex_sta->force_lps_on = true; ++ halbtc8821c1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8821c1ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ /* when coex force to enter LPS, do not enter 32k low power. */ ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ ++ break; ++ case BTC_PS_LPS_OFF: ++ coex_sta->force_lps_on = false; ++ halbtc8821c1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, false); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ ++ break; ++ default: ++ break; ++ } ++} ++ ++ ++void halbtc8821c1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ u8 real_byte1 = byte1, real_byte5 = byte5; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ if (ap_enable) { ++ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], FW for 1Ant AP mode\n"); ++ BTC_TRACE(trace_buf); ++ real_byte1 &= ~BIT(4); ++ real_byte1 |= BIT(5); ++ ++ real_byte5 |= BIT(5); ++ real_byte5 &= ~BIT(6); ++ ++ halbtc8821c1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ } ++ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ ++ halbtc8821c1ant_power_save_state( ++ btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } else { ++ halbtc8821c1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ } ++ ++ ++ h2c_parameter[0] = real_byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = real_byte5; ++ ++ coex_dm->ps_tdma_para[0] = real_byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = real_byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++ ++void halbtc8821c1ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ boolean wifi_busy = false; ++ static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; ++ static boolean pre_wifi_busy = false; ++ ++ ++#if BT_8821C_1ANT_ANTDET_ENABLE ++#if BT_8821C_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE ++ if (board_info->btdm_ant_num_by_ant_det == 2) { ++ if (turn_on) ++ type = type + ++ 100; /* for WiFi RSSI low or BT RSSI low */ ++ } ++ ++#endif ++#endif ++ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (wifi_busy != pre_wifi_busy) { ++ force_exec = true; ++ pre_wifi_busy = wifi_busy; ++ } ++ ++ /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ ++ if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) ++ psTdmaByte4Modify = 0x1; ++ else ++ psTdmaByte4Modify = 0x0; ++ ++ if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { ++ ++ force_exec = true; ++ pre_psTdmaByte4Modify = psTdmaByte4Modify; ++ } ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ return; ++ } ++ ++ if (coex_dm->cur_ps_tdma_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(on, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** TDMA(off, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } ++ ++ ++ if (turn_on) { ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, ++ 0x1); /* enable TBTT nterrupt */ ++ ++ switch (type) { ++ default: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x35, 0x03, 0x11, 0x11); ++ break; ++ ++ case 3: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x3a, 0x03, 0x10, 0x10); ++ break; ++ case 4: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x21, 0x03, 0x10, 0x10); ++ break; ++ case 5: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x15, 0x03, 0x11, 0x11); ++ break; ++ case 6: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x20, 0x03, 0x11, 0x11); ++ break; ++ case 7: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); ++ break; ++ case 8: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); ++ break; ++ case 13: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x25, 0x03, 0x10, 0x10 | psTdmaByte4Modify); ++ break; ++ case 14: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x15, 0x03, 0x10, 0x10 | psTdmaByte4Modify); ++ break; ++ case 15: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x20, 0x03, 0x10, 0x10 | psTdmaByte4Modify); ++ break; ++ case 17: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x10, 0x03, 0x11, 0x14 | psTdmaByte4Modify); ++ break;; ++ case 19: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x15, 0x03, 0x11, 0x10); ++ break; ++ case 20: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x30, 0x03, 0x11, 0x10); ++ break; ++ case 21: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x30, 0x03, 0x11, 0x10); ++ break; ++ case 22: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x25, 0x03, 0x11, 0x10); ++ break; ++ case 32: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x35, 0x03, 0x11, 0x11); ++ break; ++ case 33: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x35, 0x03, 0x11, 0x10); ++ break; ++ ++ /* 1-Ant to 2-Ant TDMA case */ ++ case 103: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x3a, 0x03, 0x70, 0x10); ++ break; ++ case 104: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x21, 0x03, 0x70, 0x10); ++ break; ++ case 105: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x15, 0x03, 0x71, 0x11); ++ break; ++ case 106: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x20, 0x03, 0x71, 0x11); ++ break; ++ case 107: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x10, 0x03, 0x70, 0x14 | psTdmaByte4Modify); ++ break; ++ case 108: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x10, 0x03, 0x70, 0x14 | psTdmaByte4Modify); ++ break; ++ case 113: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x25, 0x03, 0x70, 0x10 | psTdmaByte4Modify); ++ break; ++ case 114: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x15, 0x03, 0x70, 0x10 | psTdmaByte4Modify); ++ break; ++ case 115: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xd3, 0x20, 0x03, 0x70, 0x10 | psTdmaByte4Modify); ++ break; ++ case 117: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x10, 0x03, 0x71, 0x14 | psTdmaByte4Modify); ++ break;; ++ case 119: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x15, 0x03, 0x71, 0x10); ++ break; ++ case 120: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x30, 0x03, 0x71, 0x10); ++ break; ++ case 121: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x30, 0x03, 0x71, 0x10); ++ break; ++ case 122: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x25, 0x03, 0x71, 0x10); ++ break; ++ case 132: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x35, 0x03, 0x71, 0x11); ++ break; ++ case 133: ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, ++ 0xe3, 0x35, 0x03, 0x71, 0x10); ++ break; ++ ++ } ++ } else { ++ ++ /* disable PS tdma */ ++ switch (type) { ++ case 8: /* PTA Control */ ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, 0x8, ++ 0x0, 0x0, 0x0, 0x0); ++ break; ++ case 0: ++ default: /* Software control, Antenna at BT side */ ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x0, 0x0); ++ break; ++ case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ ++ halbtc8821c1ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x48, 0x0); ++ break; ++ } ++ } ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++void halbtc8821c1ant_set_int_block(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 pos_type) ++{ ++ u8 regval_0xcba; ++ u32 u32tmp1 = 0; ++ ++ coex_dm->cur_int_block_status = pos_type; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_int_block_status == coex_dm->cur_int_block_status) ++ return; ++ } ++ ++ coex_dm->pre_int_block_status = coex_dm->cur_int_block_status; ++ ++ regval_0xcba = btcoexist->btc_read_1byte(btcoexist, 0xcba); ++ ++ switch(pos_type){ ++ ++ case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG: ++ regval_0xcba = regval_0xcba & (~(BIT(2)) ) | BIT(0); /* 0xcb8[16] = 1, 0xcb8[18] = 0, WL_G select BTG */ ++ break; ++ case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG: ++ regval_0xcba = regval_0xcba & (~(BIT(2) | BIT(0)) ); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ ++ regval_0xcba = regval_0xcba | BIT(4) | BIT(5) ; /* 0xcb8[21:20] = 2b'11, WL_G @ WLAG on */ ++ regval_0xcba = regval_0xcba & (~(BIT(7)) ) | BIT(6); /* 0xcb8[23:22] = 2b'01, WL_A @ WLAG off */ ++ ++ break; ++ case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG: ++ regval_0xcba = regval_0xcba & (~(BIT(2) | BIT(0)) ); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ ++ regval_0xcba = regval_0xcba & (~(BIT(5))) | BIT(4); /* 0xcb8[21:20] = 2b'01, WL_G @ WLAG off */ ++ regval_0xcba = regval_0xcba | BIT(6) | BIT(7); /* 0xcb8[23:22] = 2b'11, WL_A @ WLAG on */ ++ ++ break; ++ } ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcba, 0xff, regval_0xcba); ++ ++ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb8); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Int Block setup) 0xcb8 = 0x%08x **********\n", ++ u32tmp1); ++ BTC_TRACE(trace_buf); ++ ++} ++ ++void halbtc8821c1ant_set_ext_band_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 pos_type) ++{ ++ ++#if 0 ++ boolean switch_polatiry_inverse = false; ++ u8 regval_0xcb6; ++ u32 u32tmp1 = 0, u32tmp2 = 0; ++ ++ if (!rfe_type->ext_band_switch_exist) ++ return; ++ ++ coex_dm->cur_ext_band_switch_status = pos_type; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ext_band_switch_status == coex_dm->cur_ext_band_switch_status) ++ return; ++ } ++ ++ coex_dm->pre_ext_band_switch_status = coex_dm->cur_ext_band_switch_status; ++ ++ /* swap control polarity if use different switch control polarity*/ ++ switch_polatiry_inverse = (rfe_type->ext_band_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); ++ ++ /*swap control polarity for WL_A, default polarity 0xcb4[21] = 0 && 0xcb4[23] = 1 is for WL_G */ ++ switch_polatiry_inverse = (pos_type == BT_8821C_1ANT_EXT_BAND_SWITCH_TO_WLA? ~switch_polatiry_inverse: switch_polatiry_inverse); ++ ++ regval_0xcb6 = btcoexist->btc_read_1byte(btcoexist, 0xcb6); ++ ++ /* for normal switch polrity, 0xcb4[21] =1 && 0xcb4[23] = 0 for WL_A, vice versa */ ++ regval_0xcb6 = (switch_polatiry_inverse == 1? ( (regval_0xcb6 & (~(BIT(7))) ) | BIT(5)) : ( (regval_0xcb6 & (~(BIT(5))) ) | BIT(7)) ); ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb6, 0xff, regval_0xcb6); ++ ++ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb0); ++ u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Ext Band switch setup) 0xcb0 = 0x%08x, 0xcb4 = 0x%08x**********\n", ++ u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++#endif ++ ++} ++ ++void halbtc8821c1ant_set_ext_ant_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 ctrl_type, IN u8 pos_type) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ boolean switch_polatiry_inverse = false; ++ u8 regval_0xcb7 = 0, regval_0x64; ++ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; ++ ++ if (!rfe_type->ext_ant_switch_exist) ++ return; ++ ++ coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ext_ant_switch_status == coex_dm->cur_ext_ant_switch_status) ++ return; ++ } ++ ++ coex_dm->pre_ext_ant_switch_status = coex_dm->cur_ext_ant_switch_status; ++ ++ /* swap control polarity if use different switch control polarity*/ ++ /* Normal switch polarity for DPDT, 0xcb4[29:28] = 2b'01 => BTG to Main, WLG to Aux, 0xcb4[29:28] = 2b'10 => BTG to Aux, WLG to Main */ ++ /* Normal switch polarity for SPDT, 0xcb4[29:28] = 2b'01 => Ant to BTG, 0xcb4[29:28] = 2b'10 => Ant to WLG */ ++ switch_polatiry_inverse = (rfe_type->ext_ant_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); ++ ++ /* swap control polarity if 1-Ant at Aux */ ++ if ( (rfe_type->ext_ant_switch_type == BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT) && (board_info->single_ant_path == 0) ) ++ switch_polatiry_inverse = ~switch_polatiry_inverse; ++ ++ switch(pos_type) ++ { ++ default: ++ case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT: ++ case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE: ++ ++ break; ++ case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLG: ++ switch_polatiry_inverse = (rfe_type->wlg_Locate_at_btg == 0? ~switch_polatiry_inverse: switch_polatiry_inverse); ++ break; ++ case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLA: ++ /*switch_polatiry_inverse = (rfe_type->ext_band_switch_exist == 1? ~switch_polatiry_inverse: switch_polatiry_inverse);*/ ++ break; ++ } ++ ++ ++ switch(ctrl_type) ++ { ++ default: ++ case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x77); /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ ++ ++ regval_0xcb7 = (switch_polatiry_inverse == false? 0x1 : 0x2); /* 0xcb4[29:28] = 2b'01 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, 0x30, regval_0xcb7); ++ ++ break; ++ case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x66); /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ ++ ++ regval_0xcb7 = (switch_polatiry_inverse == false? 0x2 : 0x1); /* 0xcb4[29:28] = 2b'10 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 @ GNT_BT=1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, 0x30, regval_0xcb7); ++ ++ break; ++ case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x88); /* */ ++ ++ /* no regval_0xcb7 setup required, because antenna switch control value by antenna diversity */ ++ ++ break; ++ case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x1); /* 0x4c[23] = 1 */ ++ ++ regval_0x64 = (switch_polatiry_inverse == false? 0x0 : 0x1); /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, regval_0x64); ++ break; ++ case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x0); /* 0x4c[24] = 0 */ ++ ++ /* no setup required, because antenna switch control value by BT vendor 0xac[1:0] */ ++ break; ++ } ++ ++ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Ext Ant switch setup) 0xcb4 = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x**********\n", ++ u32tmp1, u32tmp2, u32tmp3); ++ BTC_TRACE(trace_buf); ++ ++ ++} ++ ++void halbtc8821c1ant_set_rfe_type(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++#if 0 ++ rfe_type->ext_band_switch_exist = false; ++ rfe_type->ext_band_switch_type = BT_8821C_1ANT_EXT_BAND_SWITCH_USE_SPDT; // SPDT; ++ rfe_type->ext_band_switch_ctrl_polarity = 0; ++ ++ if (rfe_type->ext_band_switch_exist) { ++ ++ /* band switch use RFE_ctrl1 (pin name: PAPE_A) and RFE_ctrl3 (pin name: LNAON_A) */ ++ ++ /* set RFE_ctrl1 as software control */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb0, 0xf0, 0x7); ++ ++ /* set RFE_ctrl3 as software control */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb1, 0xf0, 0x7); ++ ++ } ++#endif ++ ++ /* the following setup should be got from Efuse in the future */ ++ rfe_type->rfe_module_type = board_info->rfe_type; ++ ++ rfe_type->ext_ant_switch_ctrl_polarity = 0; ++ rfe_type->ext_ant_switch_diversity = false; ++ ++ switch(rfe_type->rfe_module_type) ++ { ++ case 0: ++ default: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*2-Ant, DPDT, WLG*/ ++ rfe_type->wlg_Locate_at_btg = false; ++ rfe_type->ext_ant_switch_diversity = true; ++ break; ++ case 1: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, WLG */ ++ rfe_type->wlg_Locate_at_btg = false; ++ break; ++ case 2: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, BTG */ ++ rfe_type->wlg_Locate_at_btg = true; ++ break; ++ case 3: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, WLG */ ++ rfe_type->wlg_Locate_at_btg = false; ++ break; ++ case 4: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, BTG */; ++ rfe_type->wlg_Locate_at_btg = true; ++ break; ++ case 5: ++ rfe_type->ext_ant_switch_exist = false; /*2-Ant, no antenna switch, WLG*/ ++ rfe_type->wlg_Locate_at_btg = false; ++ ++ } ++ ++ ++ if (rfe_type->wlg_Locate_at_btg) ++ halbtc8821c1ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); ++ else ++ halbtc8821c1ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); ++ ++ ++} ++ ++ ++void halbtc8821c1ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean force_exec, ++ IN u8 phase ) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u32 cnt_bt_cal_chk = 0; ++ boolean is_in_mp_mode = false; ++ u8 u8tmp = 0; ++ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; ++ u16 u16tmp1 = 0; ++ ++#if BT_8821C_1ANT_ANTDET_ENABLE ++#if BT_8821C_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE ++ if (ant_pos_type == BTC_ANT_PATH_PTA) { ++ if ((board_info->btdm_ant_det_finish) && ++ (board_info->btdm_ant_num_by_ant_det == 2)) { ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ ant_pos_type = BTC_ANT_PATH_WIFI; ++ else ++ ant_pos_type = BTC_ANT_PATH_BT; ++ } ++ } ++#endif ++#endif ++ ++ coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; ++ ++ if (!force_exec) { ++ if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) ++ return; ++ } ++ ++ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; ++ ++#if 1 ++ u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x38); ++ u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x54); ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ u32tmp3, u8tmp, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++#endif ++ ++ ++ switch (phase) ++ { ++ case BT_8821C_1ANT_PHASE_COEX_INIT: ++ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ ++ halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8821c1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8821C_1ANT_CTT_WL_VS_LTE, 0xffff); ++ ++ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8821c1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8821C_1ANT_CTT_BT_VS_LTE, 0xffff); ++ ++ /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ ++ while (cnt_bt_cal_chk <= 20) { ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, ++ 0x49d); ++ cnt_bt_cal_chk++; ++ if (u8tmp & BIT(0)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ delay_ms(50); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ break; ++ } ++ } ++ ++ /* set Path control owner to WL at initial step */ ++ halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8821C_1ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW high */ ++ halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to SW low */ ++ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_1ANT_SIG_STA_SET_TO_LOW); ++ ++ coex_sta->run_time_state = false; ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_BT; ++ ++ break; ++ case BT_8821C_1ANT_PHASE_WLANONLY_INIT: ++ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ ++ halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8821c1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8821C_1ANT_CTT_WL_VS_LTE, 0xffff); ++ ++ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8821c1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8821C_1ANT_CTT_BT_VS_LTE, 0xffff); ++ ++ /* set Path control owner to WL at initial step */ ++ halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8821C_1ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW Low */ ++ halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_1ANT_SIG_STA_SET_TO_LOW); ++ /* Set GNT_WL to SW high */ ++ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ coex_sta->run_time_state = false; ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_WIFI; ++ ++ break; ++ case BT_8821C_1ANT_PHASE_WLAN_OFF: ++ /* Disable LTE Coex Function in WiFi side */ ++ halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* set Path control owner to BT */ ++ halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8821C_1ANT_PCO_BTSIDE); ++ ++ /* Set Ext Ant Switch to BT control at wifi off step */ ++ halbtc8821c1ant_set_ext_ant_switch(btcoexist, ++ FORCE_EXEC, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE); ++ ++ coex_sta->run_time_state = false; ++ break; ++ case BT_8821C_1ANT_PHASE_2G_RUNTIME: ++ ++ /* set Path control owner to WL at runtime step */ ++ halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8821C_1ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to PTA */ ++ halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_PTA, ++ BT_8821C_1ANT_SIG_STA_SET_BY_HW); ++ ++ if (rfe_type->wlg_Locate_at_btg) /* Set GNT_WL to PTA */ ++ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_PTA, ++ BT_8821C_1ANT_SIG_STA_SET_BY_HW); ++ else /* Set GNT_WL to SW High */ ++ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ coex_sta->run_time_state = true; ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type){ ++ if (rfe_type->wlg_Locate_at_btg) ++ ant_pos_type = BTC_ANT_PATH_WIFI; ++ else ++ ant_pos_type = BTC_ANT_PATH_PTA; ++ } ++ ++ if (rfe_type->wlg_Locate_at_btg) ++ halbtc8821c1ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); ++ else ++ halbtc8821c1ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); ++ ++ break; ++ case BT_8821C_1ANT_PHASE_5G_RUNTIME: ++ ++ /* set Path control owner to WL at runtime step */ ++ halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8821C_1ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW Hi */ ++ halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ /* Set GNT_WL to SW Hi */ ++ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ coex_sta->run_time_state = true; ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) { ++ /* if (rfe_type->ext_band_switch_exist) ++ ant_pos_type = BTC_ANT_PATH_PTA; ++ else */ ++ ant_pos_type = BTC_ANT_PATH_WIFI5G; ++ } ++ ++ halbtc8821c1ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG); ++ ++ break; ++ case BT_8821C_1ANT_PHASE_BTMPMODE: ++ /* Disable LTE Coex Function in WiFi side */ ++ halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* set Path control owner to WL */ ++ halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8821C_1ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW Hi */ ++ halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ /* Set GNT_WL to SW Lo */ ++ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_1ANT_SIG_STA_SET_TO_LOW); ++ ++ coex_sta->run_time_state = false; ++ ++ /* Set Ext Ant Switch to BT side at BT MP mode */ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_BT; ++ ++ break; ++ } ++ ++ if (phase != BT_8821C_1ANT_PHASE_WLAN_OFF) ++ { ++ switch (ant_pos_type) { ++ case BTC_ANT_PATH_WIFI: ++ halbtc8821c1ant_set_ext_ant_switch( btcoexist, ++ force_exec, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLG); ++ break; ++ case BTC_ANT_PATH_WIFI5G: ++ halbtc8821c1ant_set_ext_ant_switch( btcoexist, ++ force_exec, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLA); ++ break; ++ case BTC_ANT_PATH_BT: ++ halbtc8821c1ant_set_ext_ant_switch( btcoexist, ++ force_exec, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT); ++ break; ++ default: ++ case BTC_ANT_PATH_PTA: ++ halbtc8821c1ant_set_ext_ant_switch( btcoexist, ++ force_exec, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE); ++ break; ++ } ++ ++ } ++#if 1 ++ u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Ant-Setup phase---%d) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ phase, u32tmp3, u8tmp, u32tmp1, u32tmp2); ++ ++ BTC_TRACE(trace_buf); ++#endif ++} ++ ++ ++boolean halbtc8821c1ant_is_common_action(IN struct btc_coexist *btcoexist) ++{ ++ boolean common = false, wifi_connected = false, wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (!wifi_connected && ++ BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else { ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ common = false; ++ } ++ ++ return common; ++} ++ ++ ++/* ********************************************* ++ * ++ * Software Coex Mechanism start ++ * ++ * ********************************************* */ ++ ++/* SCO only or SCO+PAN(HS) */ ++ ++/* ++void halbtc8821c1ant_action_sco(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8821c1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8821c1ant_action_hid(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8821c1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8821c1ant_action_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8821c1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8821c1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8821c1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8821c1ant_action_pan_edr(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8821c1ant_sw_mechanism(btcoexist, false); ++} ++ ++ ++void halbtc8821c1ant_action_pan_hs(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8821c1ant_sw_mechanism(btcoexist, false); ++} ++ ++ ++void halbtc8821c1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8821c1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8821c1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8821c1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8821c1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8821c1ant_sw_mechanism(btcoexist, true); ++} ++ ++void halbtc8821c1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8821c1ant_sw_mechanism(btcoexist, true); ++} ++ ++*/ ++ ++/* ********************************************* ++ * ++ * Non-Software Coex Mechanism start ++ * ++ * ********************************************* */ ++void halbtc8821c1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, ++ BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8821c1ant_action_wifi_under5g(IN struct btc_coexist *btcoexist) ++{ ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, ++ BT_8821C_1ANT_PHASE_5G_RUNTIME); ++} ++ ++ ++void halbtc8821c1ant_action_wifi_only(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_under_5g = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if(wifi_under_5g) ++ { ++ halbtc8821c1ant_action_wifi_under5g(btcoexist); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (wlan only -- under 5g ) **********\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, ++ BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++} ++ ++void halbtc8821c1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, ++ BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8821c1ant_action_hs(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, ++ BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++} ++ ++void halbtc8821c1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, ++ bt_busy = false; ++ boolean wifi_scan = false, wifi_link = false, wifi_roam = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); ++ ++ if ((wifi_link) || (wifi_roam) || (coex_sta->wifi_is_high_pri_task)) { ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); ++ ++ } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); ++ ++ } else if ((!wifi_connected) && (!wifi_scan)) { ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ } else if (bt_link_info->a2dp_exist) { ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if (wifi_scan) { ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ } else if (wifi_busy) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 19); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } ++} ++ ++void halbtc8821c1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ /* tdma and coex table */ ++ ++ if (bt_link_info->sco_exist) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } else { /* HID */ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } ++} ++ ++void halbtc8821c1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (bt_link_info->hid_only) { /* HID */ ++ halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, ++ wifi_status); ++ coex_dm->auto_tdma_adjust = false; ++ return; ++ } else if (bt_link_info->a2dp_only) { /* A2DP */ ++ if (BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } else { ++ ++ if (coex_sta->scan_ap_num >= ++ BT_8821C_1ANT_WIFI_NOISY_THRESH) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 17); ++ } else { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 7); ++ } ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = true; ++ } ++ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || ++ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ ++ ++ if (wifi_busy) { ++ ++ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 15); ++ else ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); ++ } else ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ coex_dm->auto_tdma_adjust = false; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { /* HID+A2DP */ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); ++ coex_dm->auto_tdma_adjust = false; ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && ++ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ ++ if (BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 4); ++ else ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); ++ coex_dm->auto_tdma_adjust = false; ++ } else { ++ /* BT no-profile busy (0x9) */ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ coex_dm->auto_tdma_adjust = false; ++ } ++} ++ ++void halbtc8821c1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) ++{ ++ /* tdma and coex table */ ++ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, ++ BT_8821C_1ANT_PHASE_2G_RUNTIME ); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8821c1ant_action_wifi_not_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if (num_of_wifi_link >= 2) { ++ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8821c1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8821c1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8821c1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ /* tdma and coex table */ ++ if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else if (bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else if ((BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8821c1ant_action_wifi_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if (num_of_wifi_link >= 2) { ++ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8821c1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8821c1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8821c1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ ++ /* tdma and coex table */ ++ if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else if (bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } else { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } else if ((BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8821c1ant_action_wifi_not_connected_asso_auth( ++ IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if (num_of_wifi_link >= 2) { ++ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8821c1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8821c1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8821c1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ /* tdma and coex table */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || ++ (bt_link_info->a2dp_exist)) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); ++ } else if (bt_link_info->pan_exist) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); ++ } else { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); ++ } ++} ++ ++void halbtc8821c1ant_action_wifi_connected_specific_packet( ++ IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ boolean wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if (num_of_wifi_link >= 2) { ++ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8821c1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8821c1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8821c1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ /* no specific packet process for both WiFi and BT very busy */ ++ if ((wifi_busy) && ((bt_link_info->pan_exist) || ++ (coex_sta->num_of_profile >= 2))) ++ return; ++ ++ /* tdma and coex table */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } else if (bt_link_info->a2dp_exist) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if (bt_link_info->pan_exist) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); ++ } ++} ++ ++void halbtc8821c1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_busy = false; ++ boolean scan = false, link = false, roam = false; ++ boolean under_4way = false, ap_enable = false, wifi_under_5g = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ if (wifi_under_5g) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under 5G!!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_action_wifi_under5g(btcoexist); ++ return; ++ } else { ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ if (under_4way) { ++ halbtc8821c1ant_action_wifi_connected_specific_packet(btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8821c1ant_action_wifi_connected_scan(btcoexist); ++ else ++ halbtc8821c1ant_action_wifi_connected_specific_packet( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ ++ /* tdma and coex table */ ++ if (!wifi_busy) { ++ if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8821c1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else if ((BT_8821C_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 2); ++ } ++ } else { ++ if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8821c1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else if ((BT_8821C_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else { ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 4); ++ } ++ } ++} ++ ++void halbtc8821c1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ u8 algorithm = 0; ++ ++ algorithm = halbtc8821c1ant_action_algorithm(btcoexist); ++ coex_dm->cur_algorithm = algorithm; ++ ++ if (halbtc8821c1ant_is_common_action(btcoexist)) { ++ ++ } else { ++ switch (coex_dm->cur_algorithm) { ++ case BT_8821C_1ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8821c1ant_action_sco(btcoexist); */ ++ break; ++ case BT_8821C_1ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8821c1ant_action_hid(btcoexist); */ ++ break; ++ case BT_8821C_1ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8821c1ant_action_a2dp(btcoexist); */ ++ break; ++ case BT_8821C_1ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8821c1ant_action_a2dp_pan_hs(btcoexist); */ ++ break; ++ case BT_8821C_1ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8821c1ant_action_pan_edr(btcoexist); */ ++ break; ++ case BT_8821C_1ANT_COEX_ALGO_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HS mode.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8821c1ant_action_pan_hs(btcoexist); */ ++ break; ++ case BT_8821C_1ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8821c1ant_action_pan_edr_a2dp(btcoexist); */ ++ break; ++ case BT_8821C_1ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8821c1ant_action_pan_edr_hid(btcoexist); */ ++ break; ++ case BT_8821C_1ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8821c1ant_action_hid_a2dp_pan_edr(btcoexist); */ ++ break; ++ case BT_8821C_1ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8821c1ant_action_hid_a2dp(btcoexist); */ ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = coexist All Off!!\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8821c1ant_coex_all_off(btcoexist); */ ++ break; ++ } ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ } ++} ++ ++ ++void halbtc8821c1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ boolean increase_scan_dev_num = false; ++ boolean bt_ctrl_agg_buf_size = false; ++ boolean miracast_plus_bt = false, wifi_under_5g = false; ++ u8 agg_buf_size = 5; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0, wifi_bw; ++ u8 iot_peer = BTC_IOT_PEER_UNKNOWN; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (!coex_sta->run_time_state){ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], return for run_time_state = false !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ if (wifi_under_5g) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under 5G!!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_action_wifi_under5g(btcoexist); ++ return; ++ } else{ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under 2G!!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ } ++ ++ if (coex_sta->bt_whck_test) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under WHCK TEST!!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c1ant_action_bt_whck_test(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!!\n"); ++ halbtc8821c1ant_action_wifi_only(btcoexist); ++ return; ++ } ++ ++ if ((BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ increase_scan_dev_num = true; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, ++ &increase_scan_dev_num); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if ((num_of_wifi_link >= 2) || ++ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", ++ num_of_wifi_link, wifi_link_status); ++ BTC_TRACE(trace_buf); ++ ++ if (bt_link_info->bt_link_exist) { ++ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, ++ 0, 1); ++ miracast_plus_bt = true; ++ } else { ++ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ miracast_plus_bt = false; ++ } ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8821c1ant_action_wifi_multi_port(btcoexist); ++ ++ ++ return; ++ } else { ++ miracast_plus_bt = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { ++ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); ++ ++ if (BTC_IOT_PEER_CISCO != iot_peer) { ++ if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */ ++ halbtc8821c1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, true, false, 0x5); ++ else ++ halbtc8821c1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, false, 0x5); ++ } else { ++ if (bt_link_info->sco_exist) ++ halbtc8821c1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, true, false, 0x5); ++ else { ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ halbtc8821c1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, true, 0x10); ++ else ++ halbtc8821c1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, true, 0x8); ++ } ++ } ++ ++ halbtc8821c1ant_sw_mechanism(btcoexist, true); ++ halbtc8821c1ant_run_sw_coexist_mechanism( ++ btcoexist); /* just print debug message */ ++ } else { ++ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ ++ halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x5); ++ ++ halbtc8821c1ant_sw_mechanism(btcoexist, false); ++ halbtc8821c1ant_run_sw_coexist_mechanism( ++ btcoexist); /* just print debug message */ ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8821c1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ ++ if (!wifi_connected) { ++ boolean scan = false, link = false, roam = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is non connected-idle !!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8821c1ant_action_wifi_not_connected_scan( ++ btcoexist); ++ else ++ halbtc8821c1ant_action_wifi_not_connected_asso_auth( ++ btcoexist); ++ } else ++ halbtc8821c1ant_action_wifi_not_connected(btcoexist); ++ } else /* wifi LPS/Busy */ ++ halbtc8821c1ant_action_wifi_connected(btcoexist); ++} ++ ++void halbtc8821c1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ /* force to reset coex mechanism */ ++ ++ /* sw all off */ ++ halbtc8821c1ant_sw_mechanism(btcoexist, false); ++ ++ coex_sta->pop_event_cnt = 0; ++} ++ ++void halbtc8821c1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean back_up, IN boolean wifi_only) ++{ ++ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; ++ u16 u16tmp1 = 0; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ u32tmp3, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 1Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->bt_coex_supported_feature = 0; ++ coex_sta->bt_coex_supported_version = 0; ++ ++ /* Setup RF front end type */ ++ halbtc8821c1ant_set_rfe_type(btcoexist); ++ ++ /* 0xf0[15:12] --> Chip Cut information */ ++ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, ++ 0xf1) & 0xf0) >> 4; ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, ++ 0x1); /* enable TBTT nterrupt */ ++ ++ /* BT report packet sample rate */ ++ btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); ++ ++ /* Init 0x778 = 0x1 for 1-Ant */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); ++ ++ /* Enable PTA (3-wire function form BT side) */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); ++ ++ /* Enable PTA (tx/rx signal form WiFi side) */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); ++ ++ halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, TRUE); ++ ++ /* check if WL firmware download ok */ ++ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) ++ halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, TRUE); ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ ++ /* Antenna config */ ++ if (wifi_only) { ++ coex_sta->concurrent_rx_mode_on = false; ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, ++ FORCE_EXEC, BT_8821C_1ANT_PHASE_WLANONLY_INIT); ++ } else { ++ coex_sta->concurrent_rx_mode_on = true; ++ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); */ ++ ++ /* RF 0x1[1] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx, mask Tx only */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x2, 0x0); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, BT_8821C_1ANT_PHASE_COEX_INIT); ++ } ++ ++ /* PTA parameter */ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ psd_scan->ant_det_is_ant_det_available = TRUE; ++ ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ u32tmp3, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ ++} ++ ++u32 halbtc8821c1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) ++{ ++ u8 j; ++ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; ++ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, ++ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, ++ 32, 23, 15, 7, 0 ++ }; ++ ++ if (val == 0) ++ return 0; ++ ++ tmp = val; ++ ++ while (1) { ++ if (tmp == 1) ++ break; ++ else { ++ tmp = (tmp >> 1); ++ shiftcount++; ++ } ++ } ++ ++ ++ val_integerd_b = shiftcount + 1; ++ ++ tmp2 = 1; ++ for (j = 1; j <= val_integerd_b; j++) ++ tmp2 = tmp2 * 2; ++ ++ tmp = (val * 100) / tmp2; ++ tindex = tmp / 5; ++ ++ if (tindex > 20) ++ tindex = 20; ++ ++ val_fractiond_b = table_fraction[tindex]; ++ ++ result = val_integerd_b * 100 - val_fractiond_b; ++ ++ return result; ++ ++ ++} ++ ++void halbtc8821c1ant_psd_show_antenna_detect_result(IN struct btc_coexist ++ *btcoexist) ++{ ++ u8 *cli_buf = btcoexist->cli_buf; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n============[Antenna Detection info] ============\n"); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->ant_det_result == 1) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", ++ "Ant Det Result", "2-Antenna (Bad-Isolation)", ++ BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ else if (psd_scan->ant_det_result == 2) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "2-Antenna (Good-Isolation)", ++ BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset, ++ BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "1-Antenna", ++ BT_8821C_1ANT_ANTDET_PSDTHRES_1ANT, ++ BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset); ++ ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", ++ "Antenna Detection Finish", ++ (board_info->btdm_ant_det_finish ++ ? "Yes" : "No")); ++ CL_PRINTF(cli_buf); ++ ++ switch (psd_scan->ant_det_result) { ++ case 0: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is not available)"); ++ break; ++ case 1: /* 2-Ant bad-isolation */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 2: /* 2-Ant good-isolation */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 3: /* 1-Ant */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 4: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Uncertainty result)"); ++ break; ++ case 5: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); ++ break; ++ case 6: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(WiFi is Scanning)"); ++ break; ++ case 7: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is not idle)"); ++ break; ++ case 8: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Abort by WiFi Scanning)"); ++ break; ++ case 9: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Antenna Init is not ready)"); ++ break; ++ case 10: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is Inquiry or page)"); ++ break; ++ case 11: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is Disabled)"); ++ break; ++ } ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "Ant Detect Total Count", psd_scan->ant_det_try_count); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "Ant Detect Fail Count", psd_scan->ant_det_fail_count); ++ CL_PRINTF(cli_buf); ++ ++ if ((!board_info->btdm_ant_det_finish) && ++ (psd_scan->ant_det_result != 5)) ++ return; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", ++ (psd_scan->ant_det_result ? "ok" : "fail")); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", ++ psd_scan->ant_det_bt_tx_time); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", ++ psd_scan->ant_det_bt_le_channel); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", ++ "WiFi PSD Cent-Ch/Offset/Span", ++ psd_scan->real_cent_freq, psd_scan->real_offset, ++ psd_scan->real_span); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", ++ "PSD Pre-Scan Peak Value", ++ psd_scan->ant_det_pre_psdscan_peak_val / 100); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", ++ "PSD Pre-Scan result", ++ (psd_scan->ant_det_result != 5 ? "ok" : "fail"), ++ BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->ant_det_result == 5) ++ return; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", ++ "PSD Scan Peak Value", psd_scan->ant_det_peak_val); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", ++ "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", ++ (board_info->tfbga_package) ? "Yes" : "No"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "PSD Threshold Offset", psd_scan->ant_det_thres_offset); ++ CL_PRINTF(cli_buf); ++ ++} ++ ++ ++ ++void halbtc8821c1ant_psd_showdata(IN struct btc_coexist *btcoexist) ++{ ++ u8 *cli_buf = btcoexist->cli_buf; ++ u32 delta_freq_per_point; ++ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n\n============[PSD info] (%d)============\n", ++ psd_scan->psd_gen_count); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->psd_gen_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); ++ CL_PRINTF(cli_buf); ++ return; ++ } ++ ++ if (psd_scan->psd_point == 0) ++ delta_freq_per_point = 0; ++ else ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* if (psd_scan->is_psd_show_max_only) */ ++ if (0) { ++ psd_rep1 = psd_scan->psd_max_value / 100; ++ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; ++ ++ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + ++ psd_scan->psd_max_value_point * delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.0%d MHz", ++ freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.%d MHz", ++ freq1, freq2); ++ ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.0%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ ++ CL_PRINTF(cli_buf); ++ } else { ++ m = psd_scan->psd_start_point; ++ n = psd_scan->psd_start_point; ++ i = 1; ++ j = 1; ++ ++ while (1) { ++ do { ++ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * ++ delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (i == 1) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.000", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.0%2d", freq1, ++ freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.%3d", freq1, ++ freq2); ++ } else if ((i % 8 == 0) || ++ (m == psd_scan->psd_stop_point)) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.000\n", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.0%2d\n", freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.%3d\n", freq1, freq2); ++ } else { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.000", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.0%2d", freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.%3d", freq1, freq2); ++ } ++ ++ i++; ++ m++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); ++ ++ ++ do { ++ psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; ++ psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * ++ 100; ++ ++ if (j == 1) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.0%d", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.%d", psd_rep1, ++ psd_rep2); ++ } else if ((j % 8 == 0) || ++ (n == psd_scan->psd_stop_point)) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.0%d\n", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.%d\n", psd_rep1, psd_rep2); ++ } else { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.0%d", psd_rep1, psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.%d", psd_rep1, psd_rep2); ++ } ++ ++ j++; ++ n++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); ++ ++ if ((m > psd_scan->psd_stop_point) || ++ (n > psd_scan->psd_stop_point)) ++ break; ++ else { ++ i = 1; ++ j = 1; ++ } ++ ++ } ++ } ++ ++ ++} ++ ++void halbtc8821c1ant_psd_maxholddata(IN struct btc_coexist *btcoexist, ++ IN u32 gen_count) ++{ ++ u32 i = 0, i_max = 0, val_max = 0; ++ ++ if (gen_count == 1) { ++ memcpy(psd_scan->psd_report_max_hold, ++ psd_scan->psd_report, ++ BT_8821C_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); ++ ++ for (i = psd_scan->psd_start_point; ++ i <= psd_scan->psd_stop_point; i++) { ++ ++ } ++ ++ psd_scan->psd_max_value_point = 0; ++ psd_scan->psd_max_value = 0; ++ ++ } else { ++ for (i = psd_scan->psd_start_point; ++ i <= psd_scan->psd_stop_point; i++) { ++ if (psd_scan->psd_report[i] > ++ psd_scan->psd_report_max_hold[i]) ++ psd_scan->psd_report_max_hold[i] = ++ psd_scan->psd_report[i]; ++ ++ /* search Max Value */ ++ if (i == psd_scan->psd_start_point) { ++ i_max = i; ++ val_max = psd_scan->psd_report_max_hold[i]; ++ } else { ++ if (psd_scan->psd_report_max_hold[i] > ++ val_max) { ++ i_max = i; ++ val_max = psd_scan->psd_report_max_hold[i]; ++ } ++ } ++ ++ ++ } ++ ++ psd_scan->psd_max_value_point = i_max; ++ psd_scan->psd_max_value = val_max; ++ ++ } ++ ++ ++} ++ ++u32 halbtc8821c1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) ++{ ++ /* reg 0x808[9:0]: FFT data x */ ++ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ ++ /* reg 0x8b4[15:0]: FFT data y report */ ++ ++ u32 val = 0, psd_report = 0; ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ ++ val &= 0xffbffc00; ++ val |= point; ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ val |= 0x00400000; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); ++ ++ psd_report = val & 0x0000ffff; ++ ++ return psd_report; ++} ++ ++ ++boolean halbtc8821c1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, ++ IN u32 avgnum, IN u32 loopcnt) ++{ ++ u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0; ++ u32 points1 = 0, psd_report = 0; ++ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; ++ u32 psd_center_freq = 20 * 10 ^ 6; ++ boolean outloop = false, scan , roam, is_sweep_ok = true; ++ u8 flag = 0; ++ u32 tmp = 0, u32tmp1 = 0; ++ u32 wifi_original_channel = 1; ++ ++ psd_scan->is_psd_running = true; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ do { ++ switch (flag) { ++ case 0: /* Get PSD parameters */ ++ default: ++ ++ psd_scan->psd_band_width = 40 * 1000000; ++ psd_scan->psd_point = points; ++ psd_scan->psd_start_base = points / 2; ++ psd_scan->psd_avg_num = avgnum; ++ psd_scan->real_cent_freq = cent_freq; ++ psd_scan->real_offset = offset; ++ psd_scan->real_span = span; ++ ++ ++ points1 = psd_scan->psd_point; ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* PSD point setup */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffff0fff; ++ ++ switch (psd_scan->psd_point) { ++ case 128: ++ val |= 0x0; ++ break; ++ case 256: ++ default: ++ val |= 0x00004000; ++ break; ++ case 512: ++ val |= 0x00008000; ++ break; ++ case 1024: ++ val |= 0x0000c000; ++ break; ++ } ++ ++ switch (psd_scan->psd_avg_num) { ++ case 1: ++ val |= 0x0; ++ break; ++ case 8: ++ val |= 0x00001000; ++ break; ++ case 16: ++ val |= 0x00002000; ++ break; ++ case 32: ++ default: ++ val |= 0x00003000; ++ break; ++ } ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ flag = 1; ++ break; ++ case 1: /* calculate the PSD point index from freq/offset/span */ ++ psd_center_freq = psd_scan->psd_band_width / 2 + ++ offset * (1000000); ++ ++ start_p = psd_scan->psd_start_base + (psd_center_freq - ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_start_point = start_p - ++ psd_scan->psd_start_base; ++ ++ stop_p = psd_scan->psd_start_base + (psd_center_freq + ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_stop_point = stop_p - ++ psd_scan->psd_start_base - 1; ++ ++ flag = 2; ++ break; ++ case 2: /* set RF channel/BW/Mode */ ++ ++ /* set 3-wire off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val |= 0x00300000; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val &= 0xfeffffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* Tx-pause on */ ++ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f); ++ ++ /* store WiFi original channel */ ++ wifi_original_channel = btcoexist->btc_get_rf_reg( ++ btcoexist, BTC_RF_A, 0x18, 0x3ff); ++ ++ /* Set RF channel */ ++ if (cent_freq == 2484) ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, 0xe); ++ else ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, (cent_freq - 2412) / 5 + ++ 1); /* WiFi TRx Mask on */ ++ ++ /* save original RCK value */ ++ u32tmp1 = btcoexist->btc_get_rf_reg( ++ btcoexist, BTC_RF_A, 0x1d, 0xfffff); ++ ++ /* Enter debug mode */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, ++ 0x2, 0x1); ++ ++ /* Set RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, ++ 0xfffff, 0x2e); ++ ++ ++ /* Set RF mode = Rx, RF Gain = 0x320a0 */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, ++ 0xfffff, 0x320a0); ++ ++ while (1) { ++ if (k++ > BT_8821C_1ANT_ANTDET_SWEEPPOINT_DELAY) ++ break; ++ } ++ flag = 3; ++ break; ++ case 3: ++ psd_scan->psd_gen_count = 0; ++ for (j = 1; j <= loopcnt; j++) { ++ ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || roam) { ++ is_sweep_ok = false; ++ break; ++ } ++ memset(psd_scan->psd_report, 0, ++ psd_scan->psd_point * sizeof(u32)); ++ start_p = psd_scan->psd_start_point + ++ psd_scan->psd_start_base; ++ stop_p = psd_scan->psd_stop_point + ++ psd_scan->psd_start_base + 1; ++ ++ i = start_p; ++ point_index = 0; ++ ++ while (i < stop_p) { ++ if (i >= points1) ++ psd_report = ++ halbtc8821c1ant_psd_getdata( ++ btcoexist, i - points1); ++ else ++ psd_report = ++ halbtc8821c1ant_psd_getdata( ++ btcoexist, i); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Point=%d, psd_raw_data = 0x%08x\n", ++ i, psd_report); ++ BTC_TRACE(trace_buf); ++ if (psd_report == 0) ++ tmp = 0; ++ else ++ /* tmp = 20*log10((double)psd_report); */ ++ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ ++ tmp = 6 * halbtc8821c1ant_psd_log2base( ++ btcoexist, psd_report); ++ ++ n = i - psd_scan->psd_start_base; ++ psd_scan->psd_report[n] = tmp; ++ ++ ++ halbtc8821c1ant_psd_maxholddata( ++ btcoexist, j); ++ ++ i++; ++ ++ } ++ ++ psd_scan->psd_gen_count = j; ++ } ++ ++ flag = 100; ++ break; ++ case 99: /* error */ ++ ++ outloop = true; ++ break; ++ case 100: /* recovery */ ++ ++ /* set 3-wire on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val &= 0xffcfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val |= 0x01000000; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* Tx-pause off */ ++ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0); ++ ++ /* PSD off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffbfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ /* restore RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, ++ 0xfffff, u32tmp1); ++ ++ /* Exit debug mode */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, ++ 0x2, 0x0); ++ ++ /* restore WiFi original channel */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, ++ 0x3ff, wifi_original_channel); ++ ++ outloop = true; ++ break; ++ ++ } ++ ++ } while (!outloop); ++ ++ ++ ++ psd_scan->is_psd_running = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); ++ BTC_TRACE(trace_buf); ++ return is_sweep_ok; ++ ++} ++ ++ ++void halbtc8821c1ant_psd_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 bt_tx_time, IN u32 bt_le_channel) ++{ ++ u32 i = 0; ++ u32 wlpsd_cent_freq = 2484, wlpsd_span = 2, wlpsd_sweep_count = 50; ++ s32 wlpsd_offset = -4; ++ u8 bt_le_ch[13] = {3, 6, 8, 11, 13, 16, 18, 21, 23, 26, 28, 31, 33}; ++ ++ u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb; ++ ++ u8 state = 0; ++ boolean outloop = false, bt_resp = false; ++ u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, ++ u32tmp, u32tmp0, u32tmp1, u32tmp2 ; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ board_info->btdm_ant_det_finish = false; ++ memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); ++ memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); ++ ++ if (board_info->tfbga_package) /* for TFBGA */ ++ psd_scan->ant_det_thres_offset = 5; ++ else ++ psd_scan->ant_det_thres_offset = 0; ++ ++ do { ++ switch (state) { ++ case 0: ++ if (bt_le_channel == 39) ++ wlpsd_cent_freq = 2484; ++ else { ++ for (i = 1; i <= 13; i++) { ++ if (bt_le_ch[i - 1] == ++ bt_le_channel) { ++ wlpsd_cent_freq = 2412 ++ + (i - 1) * 5; ++ break; ++ } ++ } ++ ++ if (i == 14) { ++ ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", ++ bt_le_channel); ++ BTC_TRACE(trace_buf); ++ outloop = true; ++ break; ++ } ++ } ++ ++ wlpsd_sweep_count = bt_tx_time * 238 / ++ 100; /* bt_tx_time/0.42 */ ++ wlpsd_sweep_count = wlpsd_sweep_count / 5; ++ ++ if (wlpsd_sweep_count % 5 != 0) ++ wlpsd_sweep_count = (wlpsd_sweep_count / ++ 5 + 1) * 5; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", ++ bt_tx_time, bt_le_channel); ++ BTC_TRACE(trace_buf); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", ++ wlpsd_cent_freq, ++ wlpsd_offset, ++ wlpsd_span, ++ wlpsd_sweep_count); ++ BTC_TRACE(trace_buf); ++ ++ state = 1; ++ break; ++ case 1: /* stop coex DM & set antenna path */ ++ /* Stop Coex DM */ ++ btcoexist->stop_coex_dm = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* Set TDMA off, */ ++ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, ++ false, 0); ++ ++ /* Set coex table */ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, ++ FORCE_EXEC, 0); ++ ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ halbtc8821c1ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); ++ ++ halbtc8821c1ant_set_ext_ant_switch( btcoexist, ++ FORCE_EXEC, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT); ++ ++ /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ ++ /* set GNT_BT to SW high */ ++ halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to SW high */ ++ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ ++ h2c_parameter[0] = 0x1; ++ h2c_parameter[1] = 0xd; ++ h2c_parameter[2] = 0x14; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", ++ h2c_parameter[1], ++ h2c_parameter[2]); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, ++ h2c_parameter); ++ ++ u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70); ++ u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (Before Ant Det) **********\n", ++ u32tmp0, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ ++ state = 2; ++ break; ++ case 2: /* Pre-sweep background psd */ ++ if (!halbtc8821c1ant_psd_sweep_point(btcoexist, ++ wlpsd_cent_freq, wlpsd_offset, wlpsd_span, ++ BT_8821C_1ANT_ANTDET_PSD_POINTS, ++ BT_8821C_1ANT_ANTDET_PSD_AVGNUM, 3)) { ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ psd_scan->ant_det_result = 8; ++ state = 99; ++ break; ++ } ++ ++ psd_scan->ant_det_pre_psdscan_peak_val = ++ psd_scan->psd_max_value; ++ ++ if (psd_scan->psd_max_value > ++ (BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset) * 100) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", ++ psd_scan->psd_max_value / 100, ++ BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ BTC_TRACE(trace_buf); ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ psd_scan->ant_det_result = 5; ++ state = 99; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", ++ psd_scan->psd_max_value / 100, ++ BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ BTC_TRACE(trace_buf); ++ state = 3; ++ } ++ break; ++ case 3: ++ ++ bt_resp = btcoexist->btc_set_bt_ant_detection( ++ btcoexist, (u8)(bt_tx_time & 0xff), ++ (u8)(bt_le_channel & 0xff)); ++ ++ if (!halbtc8821c1ant_psd_sweep_point(btcoexist, ++ wlpsd_cent_freq, wlpsd_offset, ++ wlpsd_span, ++ BT_8821C_1ANT_ANTDET_PSD_POINTS, ++ BT_8821C_1ANT_ANTDET_PSD_AVGNUM, ++ wlpsd_sweep_count)) { ++ board_info->btdm_ant_det_finish ++ = false; ++ board_info->btdm_ant_num_by_ant_det ++ = 1; ++ psd_scan->ant_det_result = 8; ++ state = 99; ++ break; ++ } ++ ++ psd_scan->ant_det_psd_scan_peak_val = ++ psd_scan->psd_max_value; ++ psd_scan->ant_det_psd_scan_peak_freq = ++ psd_scan->psd_max_value_point; ++ state = 4; ++ break; ++ case 4: ++ ++ if (psd_scan->psd_point == 0) ++ delta_freq_per_point = 0; ++ else ++ delta_freq_per_point = ++ psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ psd_rep1 = psd_scan->psd_max_value / 100; ++ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * ++ 100; ++ ++ freq = ((psd_scan->real_cent_freq - 20) * ++ 1000000 + psd_scan->psd_max_value_point ++ * delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (freq2 < 100) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", ++ freq1, freq2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_freq, ++ BT_8821C_1ANT_ANTDET_BUF_LEN, ++ "%d.0%d", freq1, freq2); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", ++ freq1, freq2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_freq, ++ BT_8821C_1ANT_ANTDET_BUF_LEN, ++ "%d.%d", freq1, freq2); ++ } ++ ++ if (psd_rep2 < 10) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.0%d dB\n", ++ psd_rep1, psd_rep2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_val, ++ BT_8821C_1ANT_ANTDET_BUF_LEN, ++ "%d.0%d", psd_rep1, psd_rep2); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.%d dB\n", ++ psd_rep1, psd_rep2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_val, ++ BT_8821C_1ANT_ANTDET_BUF_LEN, ++ "%d.%d", psd_rep1, psd_rep2); ++ } ++ ++ psd_scan->ant_det_is_btreply_available = true; ++ ++ if (bt_resp == false) { ++ psd_scan->ant_det_is_btreply_available = ++ false; ++ psd_scan->ant_det_result = 0; ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->psd_max_value > ++ (BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) ++ * 100) { ++ psd_scan->ant_det_result = 1; ++ board_info->btdm_ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 2; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->psd_max_value > ++ (BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset) * 100) { ++ psd_scan->ant_det_result = 2; ++ board_info->btdm_ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 2; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->psd_max_value > ++ (BT_8821C_1ANT_ANTDET_PSDTHRES_1ANT) * ++ 100) { ++ psd_scan->ant_det_result = 3; ++ board_info->btdm_ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ psd_scan->ant_det_result = 4; ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ state = 99; ++ break; ++ case 99: /* restore setup */ ++ ++ /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ ++ h2c_parameter[0] = 0x0; ++ h2c_parameter[1] = 0x0; ++ h2c_parameter[2] = 0x0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", ++ h2c_parameter[1], h2c_parameter[2]); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, ++ h2c_parameter); ++ ++ /* Set Antenna Path, GNT_WL/GNT_BT control by PTA */ ++ halbtc8821c1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ /* Resume Coex DM */ ++ btcoexist->stop_coex_dm = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ /* stimulate coex running */ ++ halbtc8821c1ant_run_coexist_mechanism( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ outloop = true; ++ break; ++ } ++ ++ } while (!outloop); ++ ++ ++ ++} ++ ++void halbtc8821c1ant_psd_antenna_detection_check(IN struct btc_coexist ++ *btcoexist) ++{ ++ static u32 ant_det_count = 0, ant_det_fail_count = 0; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ boolean scan, roam; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ ++ /* psd_scan->ant_det_bt_tx_time = 20; */ ++ psd_scan->ant_det_bt_tx_time = ++ BT_8821C_1ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ ++ psd_scan->ant_det_bt_le_channel = BT_8821C_1ANT_ANTDET_BTTXCHANNEL; ++ ++ ant_det_count++; ++ ++ psd_scan->ant_det_try_count = ant_det_count; ++ ++ if (scan || roam) { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 6; ++ } else if (coex_sta->bt_disabled) { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 11; ++ } else if (coex_sta->num_of_profile >= 1) { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 7; ++ } else if ( ++ !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 9; ++ } else if (coex_sta->c2h_bt_inquiry_page) { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 10; ++ } else { ++ ++ btcoexist->stop_coex_dm = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_psd_antenna_detection(btcoexist, ++ psd_scan->ant_det_bt_tx_time, ++ psd_scan->ant_det_bt_le_channel); ++ ++ delay_ms(psd_scan->ant_det_bt_tx_time); ++ ++ btcoexist->stop_coex_dm = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ /* stimulate coex running */ ++ /* ++ halbtc8821c1ant_run_coexist_mechanism( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); ++ BTC_TRACE(trace_buf); ++ */ ++ } ++ ++ if (!board_info->btdm_ant_det_finish) ++ ant_det_fail_count++; ++ ++ psd_scan->ant_det_fail_count = ant_det_fail_count; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n", ++ psd_scan->ant_det_result, ++ psd_scan->ant_det_fail_count, ++ board_info->btdm_ant_det_finish == TRUE ? "Yes" : "No"); ++ BTC_TRACE(trace_buf); ++ ++} ++ ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8821c1ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8821c1ant_ ++ * ************************************************************ */ ++void ex_halbtc8821c1ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 u8tmp = 0x0; ++ u16 u16tmp = 0x0; ++ u32 value = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Execute 8821c 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Ant Det Finish = %s, Ant Det Number = %d\n", ++ (board_info->btdm_ant_det_finish ? "Yes" : "No"), ++ board_info->btdm_ant_num_by_ant_det); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = true; ++ psd_scan->ant_det_is_ant_det_available = FALSE; ++ ++ /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ ++ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); ++ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); ++ ++ /* Local setting bit define */ ++ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ ++ /* BIT1: "0" for internal switch; "1" for external switch */ ++ /* BIT2: "0" for one antenna; "1" for two antenna */ ++ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ ++ ++ /* Check efuse 0xc3[6] for Single Antenna Path */ ++ if (board_info->single_ant_path == 0) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** Single Antenna, Antenna at Aux Port**********\n"); ++ BTC_TRACE(trace_buf); ++ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; ++ ++ u8tmp = 1; ++ } else if (board_info->single_ant_path == 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** Single Antenna, Antenna at Main Port**********\n"); ++ BTC_TRACE(trace_buf); ++ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; ++ ++ u8tmp = 0; ++ } ++ ++ ++ /* Save"single antenna position" info in Local register setting for FW reading, because FW may not ready at power on */ ++ if (btcoexist->chip_interface == BTC_INTF_PCI) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_USB) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_SDIO) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); ++ ++ /* Setup RF front end type */ ++ halbtc8821c1ant_set_rfe_type(btcoexist); ++ ++ /* Set Antenna Path to BT side */ ++ halbtc8821c1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_1ANT_PHASE_COEX_INIT); ++ ++ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ ++ halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, TRUE); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", ++ halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38)); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0xcb4 (Power-On) = 0x%x / 0x%x**********\n", ++ btcoexist->btc_read_4byte(btcoexist, 0x70), btcoexist->btc_read_4byte(btcoexist, 0xcb4)); ++ BTC_TRACE(trace_buf); ++ ++} ++ ++void ex_halbtc8821c1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) ++{ ++} ++ ++void ex_halbtc8821c1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ halbtc8821c1ant_init_hw_config(btcoexist, true, wifi_only); ++ btcoexist->stop_coex_dm = false; ++ ++} ++ ++void ex_halbtc8821c1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_init_coex_dm(btcoexist); ++ ++ /* halbtc8821c1ant_query_bt_info(btcoexist); */ ++} ++ ++void ex_halbtc8821c1ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_stack_info *stack_info = &btcoexist->stack_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; ++ u16 u16tmp[4]; ++ u32 u32tmp[4]; ++ u32 fa_of_dm, fa_cck; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ static u8 pop_report_in_10s = 0; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ if (btcoexist->stop_coex_dm) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Coex is STOPPED]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ if (psd_scan->ant_det_try_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s / %d", ++ "Ant PG Num/ Mech/ Pos/ RFE", ++ board_info->pg_ant_num, board_info->btdm_ant_num, ++ (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT? "Main" : "Aux"), ++ rfe_type->rfe_module_type); ++ CL_PRINTF(cli_buf); ++ } else { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ %d/ %s/ %d (%d/%d/%d)", ++ "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", ++ board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, ++ (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT ? "Main" : "Aux"), ++ rfe_type->rfe_module_type, ++ psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, ++ psd_scan->ant_det_result); ++ CL_PRINTF(cli_buf); ++ ++ if (board_info->btdm_ant_det_finish) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "Ant Det PSD Value", ++ psd_scan->ant_det_peak_val); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", ++ "BT stack/ hci ext ver", ++ ((stack_info->profile_notified) ? "Yes" : "No"), ++ stack_info->hci_version); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", ++ "Version Coex/ Fw/ Patch/ Cut", ++ glcoex_ver_date_8821c_1ant, glcoex_ver_8821c_1ant, fw_ver, ++ bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", ++ "WifibHiPri/ Ccklock/ CckEverLock", ++ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), ++ (coex_sta->cck_lock ? "Yes" : "No"), ++ (coex_sta->cck_ever_lock ? "Yes" : "No")); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ pop_report_in_10s++; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt/ popCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") ++ : ((BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, ++ coex_sta->pop_event_cnt); ++ CL_PRINTF(cli_buf); ++ ++ if (pop_report_in_10s >= 5) { ++ coex_sta->pop_event_cnt = 0; ++ pop_report_in_10s = 0; ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d / %d / %d / %d / %d", ++ "SCO/HID/PAN/A2DP/Hi-Pri", ++ bt_link_info->sco_exist, bt_link_info->hid_exist, ++ bt_link_info->pan_exist, bt_link_info->a2dp_exist, ++ bt_link_info->bt_hi_pri_link_exist); ++ CL_PRINTF(cli_buf); ++ ++ if (stack_info->profile_notified) ++ btcoexist->btc_disp_dbg_msg(btcoexist, ++ BTC_DBG_DISP_BT_LINK_INFO); ++ else { ++ bt_info_ext = coex_sta->bt_info_ext; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s / %d/ %x/ %04x", ++ "Role/A2DP Rate/Bitpool/Feature/Ver", ++ ((bt_link_info->slave_role) ? "Slave" : "Master"), ++ (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool, ++ coex_sta->bt_coex_supported_feature, ++ coex_sta->bt_coex_supported_version); ++ CL_PRINTF(cli_buf); ++ } ++ ++ ++ for (i = 0; i < BT_INFO_SRC_8821C_1ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8821c_1ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ ++ if (btcoexist->manual_control) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms] (before Manual)============"); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms]============"); ++ ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "SM[LowPenaltyRA]", ++ coex_dm->cur_low_penalty_ra); ++ CL_PRINTF(cli_buf); ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case, ++ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), ++ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); ++ ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "WL/BT Coex Table Type", ++ coex_sta->coex_table_type); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8(coexTable)", ++ u32tmp[0], u32tmp[1], u32tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x778/0x6cc/IgnWlanAct", ++ u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa0); ++ u32tmp[1] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "LTE Coex Table W_L/B_L", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa8); ++ u32tmp[1] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xac); ++ u32tmp[2] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb0); ++ u32tmp[3] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "LTE Break Table W_L/B_L/L_W/L_B", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, ++ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); ++ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "0x430/0x434/0x42a/0x456", ++ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ ++ u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", ++ "LTE CoexOn/Path Ctrl Owner", ++ (int)((u32tmp[0] & BIT(7)) >> 7), ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "LTE 3Wire/OPMode/UART/UARTMode", ++ (int)((u32tmp[0] & BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), ++ (int)((u32tmp[0] & BIT(3)) >> 3), ++ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", ++ "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", ++ (int)((u32tmp[0] & BIT(12)) >> 12), (int)((u32tmp[0] & BIT(14)) >> 14), ++ ((u8tmp[0] & BIT(3)) ? "On" : "Off")); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", ++ (int)((u32tmp[0] & BIT(2)) >> 2), (int)((u32tmp[0] & BIT(3)) >> 3), ++ (int)((u32tmp[0] & BIT(1)) >> 1), (int)(u32tmp[0] & BIT(0))); ++ CL_PRINTF(cli_buf); ++ ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcba); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%04x/ 0x%04x/ 0x%02x %s", ++ "0xcb0/0xcb4/0xcb8[23:16]", ++ u32tmp[0], u32tmp[1],u8tmp[0], ( (u8tmp[0] & 0x5) == 0x1 ? "BTG": ( (u8tmp[0] & 0xf0) == 0x70? "WL_G" : "WL_A" ) )); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x4c[24:23]/0x64[0]/x4c6[4]/0x40[5]", ++ (u32tmp[0] & ( BIT(24) | BIT(23) )) >> 23 , u8tmp[2]&0x1 , (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); ++ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xc50); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s/ 0x%x", ++ "0x550/0x522/4-RxAGC/0xc50", ++ u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off", u8tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xf4c); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xf08); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5d); ++ ++ fa_of_dm = (u32tmp[0] & 0xffff) + (u32tmp[1] & 0xffff); ++ ++ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", ++ u32tmp[2] & 0xffff, fa_cck, ((u32tmp[2] & 0xffff0000) >> 16), fa_of_dm); ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_OK CCK/11g/11n/11ac", ++ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, ++ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_Err CCK/11g/11n/11ac", ++ coex_sta->crc_err_cck, coex_sta->crc_err_11g, ++ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770(high-pri rx/tx)", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(low-pri rx/tx)", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++ ++ halbtc8821c1ant_read_score_board(btcoexist, &u16tmp[0]); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x", ++ "ScoreBoard[14:0] (from BT)", u16tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++void ex_halbtc8821c1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ ++ /* Write WL "Active" in Score-board for LPS off */ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, false); ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_1ANT_PHASE_WLAN_OFF); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); ++ ++ halbtc8821c1ant_init_hw_config(btcoexist, false, false); ++ halbtc8821c1ant_init_coex_dm(btcoexist);; ++ ++ coex_sta->under_ips = false; ++ } ++} ++ ++void ex_halbtc8821c1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ ++ if (coex_sta->force_lps_on == true) { /* LPS No-32K */ ++ /* Write WL "Active" in Score-board for PS-TDMA */ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); ++ ++ } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ ++ /* Write WL "Non-Active" in Score-board for Native-PS */ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, false); ++ ++ } ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ ++ /* Write WL "Active" in Score-board for LPS off */ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); ++ ++ } ++} ++ ++void ex_halbtc8821c1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false; ++ ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN notify()\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_SCAN_START == type) //for dual band, no action for BTC_SCAN_START, the action is change to switchband_notify ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ halbtc8821c1ant_query_bt_info(btcoexist); ++ ++ if (BTC_SCAN_START_2G == type) { ++ ++ if (!wifi_connected) ++ coex_sta->wifi_is_high_pri_task = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify (2G)\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, ++ 8); ++ ++ /* Force antenna setup for no scan result issue */ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8821c1ant_action_wifi_not_connected_scan(btcoexist); ++ else /* wifi is connected */ ++ halbtc8821c1ant_action_wifi_connected_scan(btcoexist); ++ ++ } else { ++ ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", coex_sta->scan_ap_num); ++ BTC_TRACE(trace_buf); ++ ++ if (!wifi_connected) ++ halbtc8821c1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8821c1ant_action_wifi_connected(btcoexist); ++ } ++ ++ ++} ++ ++void ex_halbtc8821c1ant_switchband_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ ++ if(type == BTC_SWITCH_TO_5G) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], switchband_notify --- switch to 5G\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_action_wifi_under5g(btcoexist); ++ ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], switchband_notify --- switch to 2G\n"); ++ BTC_TRACE(trace_buf); ++ ++ ex_halbtc8821c1ant_scan_notify(btcoexist, ++ BTC_SCAN_START_2G); ++ } ++} ++ ++ ++void ex_halbtc8821c1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false; ++ ++ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ if ( (BTC_ASSOCIATE_5G_START == type) || (BTC_ASSOCIATE_5G_FINISH== type)) { ++ ++ if (BTC_ASSOCIATE_5G_START == type) ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], connect_notify --- 5G start\n"); ++ else ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], connect_notify --- 5G finish\n"); ++ ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_action_wifi_under5g(btcoexist); ++ return; ++ } ++ ++ if (BTC_ASSOCIATE_START == type) { ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ ++ /* Force antenna setup for no scan result issue */ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify (2G)\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_dm->arp_cnt = 0; ++ ++ halbtc8821c1ant_action_wifi_not_connected_asso_auth(btcoexist); ++ } else { ++ ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify (2G)\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8821c1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8821c1ant_action_wifi_connected(btcoexist); ++ } ++ ++} ++ ++void ex_halbtc8821c1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_under_b_mode = false, wifi_under_5g = false; ++ ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ if (wifi_under_5g) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under 5G!!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); ++ halbtc8821c1ant_action_wifi_under5g(btcoexist); ++ return; ++ } ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); ++ ++ /* Force antenna setup for no scan result issue */ ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ /* Set CCK Tx/Rx high Pri except 11b mode */ ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x00); /* CCK Rx */ ++ } else { ++ /* btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x10); */ /*CCK Tx */ ++ /* btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x10); */ /*CCK Rx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x10); /* CCK Rx */ ++ } ++ ++ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, ++ 0x430); ++ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, ++ 0x434); ++ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( ++ btcoexist, 0x42a); ++ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( ++ btcoexist, 0x456); ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, false); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ ++ ++ coex_sta->cck_ever_lock = false; ++ } ++ ++ halbtc8821c1ant_update_wifi_channel_info(btcoexist, type); ++ ++} ++ ++void ex_halbtc8821c1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean under_4way = false, wifi_under_5g = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ if (wifi_under_5g) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under 5G!!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_action_wifi_under5g(btcoexist); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (under_4way) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ---- under_4way!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ coex_sta->specific_pkt_period_cnt = 2; ++ } else if (BTC_PACKET_ARP == type) { ++ ++ coex_dm->arp_cnt++; ++ ++ if (coex_sta->wifi_is_high_pri_task) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ARP notify -cnt = %d\n", coex_dm->arp_cnt); ++ BTC_TRACE(trace_buf); ++ } ++ ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", type); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ coex_sta->specific_pkt_period_cnt = 2; ++ } ++ ++ if (coex_sta->wifi_is_high_pri_task) ++ halbtc8821c1ant_action_wifi_connected_specific_packet(btcoexist); ++} ++ ++void ex_halbtc8821c1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 bt_info = 0; ++ u8 i, rsp_source = 0; ++ boolean wifi_connected = false; ++ boolean bt_busy = false; ++ ++ coex_sta->c2h_bt_info_req_sent = false; ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8821C_1ANT_MAX) ++ rsp_source = BT_INFO_SRC_8821C_1ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ if (i == 1) ++ bt_info = tmp_buf[i]; ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ if (BT_INFO_SRC_8821C_1ANT_WIFI_FW != rsp_source) { ++ ++ /* if 0xff, it means BT is under WHCK test */ ++ if (bt_info == 0xff) ++ coex_sta->bt_whck_test = true; ++ else ++ coex_sta->bt_whck_test = false; ++ ++ coex_sta->bt_retry_cnt = /* [3:0] */ ++ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; ++ ++ if (coex_sta->bt_retry_cnt >= 1) ++ coex_sta->pop_event_cnt++; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ++ coex_sta->c2h_bt_page = true; ++ else ++ coex_sta->c2h_bt_page = false; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ++ coex_sta->bt_create_connection = true; ++ else ++ coex_sta->bt_create_connection = false; ++ ++ /* unit: %, value-100 to translate to unit: dBm */ ++ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; ++ ++ /* coex_sta->bt_info_c2h[rsp_source][3] * 2 - 90; */ ++ ++ if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) { ++ coex_sta->a2dp_bit_pool = ++ coex_sta->bt_info_c2h[rsp_source][6]; ++ } else ++ coex_sta->a2dp_bit_pool = 0; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][1] & 0x9) ++ coex_sta->acl_busy = true; ++ else ++ coex_sta->acl_busy = false; ++ ++ coex_sta->bt_info_ext = ++ coex_sta->bt_info_c2h[rsp_source][4]; ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ ++ if ((!btcoexist->manual_control) && (!btcoexist->stop_coex_dm)) { ++ ++ /* Re-Init */ ++ if (coex_sta->bt_info_ext & BIT(1)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (wifi_connected) ++ halbtc8821c1ant_update_wifi_channel_info(btcoexist, ++ BTC_MEDIA_CONNECT); ++ else ++ halbtc8821c1ant_update_wifi_channel_info(btcoexist, ++ BTC_MEDIA_DISCONNECT); ++ } ++ ++ /* If Ignore_WLanAct && not SetUp_Link */ ++ if ((coex_sta->bt_info_ext & BIT(3)) && (!(coex_sta->bt_info_ext & BIT(2)))) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c1ant_ignore_wlan_act(btcoexist, ++ FORCE_EXEC, false); ++ } ++ } ++ /* check BIT2 first ==> check if bt is under inquiry or page scan */ ++ if (bt_info & BT_INFO_8821C_1ANT_B_INQ_PAGE) ++ coex_sta->c2h_bt_inquiry_page = true; ++ else ++ coex_sta->c2h_bt_inquiry_page = false; ++ } ++ ++ coex_sta->num_of_profile = 0; ++ ++ /* set link exist status */ ++ if (!(bt_info & BT_INFO_8821C_1ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ ++ coex_sta->bt_hi_pri_link_exist = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (bt_info & BT_INFO_8821C_1ANT_B_FTP) { ++ coex_sta->pan_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->pan_exist = false; ++ if (bt_info & BT_INFO_8821C_1ANT_B_A2DP) { ++ coex_sta->a2dp_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->a2dp_exist = false; ++ if (bt_info & BT_INFO_8821C_1ANT_B_HID) { ++ coex_sta->hid_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->hid_exist = false; ++ if (bt_info & BT_INFO_8821C_1ANT_B_SCO_ESCO) { ++ coex_sta->sco_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->sco_exist = false; ++ ++ } ++ ++ halbtc8821c1ant_update_bt_link_info(btcoexist); ++ ++ bt_info = bt_info & ++ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ ++ ++ if (!(bt_info & BT_INFO_8821C_1ANT_B_CONNECTION)) { ++ coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info == ++ BT_INFO_8821C_1ANT_B_CONNECTION) { /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if ((bt_info & BT_INFO_8821C_1ANT_B_SCO_ESCO) || ++ (bt_info & BT_INFO_8821C_1ANT_B_SCO_BUSY)) { ++ coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info & BT_INFO_8821C_1ANT_B_ACL_BUSY) { ++ if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) ++ coex_dm->auto_tdma_adjust = false; ++ coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_ACL_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_MAX; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if ((BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ bt_busy = true; ++ else ++ bt_busy = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Manual CTRL<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ halbtc8821c1ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8821c1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_RF_ON == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned ON!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wl_rf_off_on_event = true; ++ btcoexist->stop_coex_dm = false; ++ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, TRUE); ++ halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, TRUE); ++ ++ } else if (BTC_RF_OFF == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned OFF!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, FALSE); ++ halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, FALSE); ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ halbtc8821c1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_1ANT_PHASE_WLAN_OFF); ++ ++ btcoexist->stop_coex_dm = true; ++ coex_sta->wl_rf_off_on_event = false; ++ } ++} ++ ++void ex_halbtc8821c1ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ ++ halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, FALSE); ++ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, FALSE); ++ halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, FALSE); ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_1ANT_PHASE_WLAN_OFF); ++ ++ halbtc8821c1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ++ ex_halbtc8821c1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++ ++ btcoexist->stop_coex_dm = true; ++} ++ ++void ex_halbtc8821c1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_WIFI_PNP_SLEEP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ ++ halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, FALSE); ++ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, FALSE); ++ halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, FALSE); ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ halbtc8821c1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_1ANT_PHASE_WLAN_OFF); ++ ++ btcoexist->stop_coex_dm = true; ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_post_activestate_to_bt(btcoexist, TRUE); ++ halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, TRUE); ++ ++ btcoexist->stop_coex_dm = false; ++ } ++} ++ ++ ++void ex_halbtc8821c1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], *****************Coex DM Reset*****************\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c1ant_init_hw_config(btcoexist, false, false); ++ halbtc8821c1ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8821c1ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ============== Periodical ==============\n"); ++ BTC_TRACE(trace_buf); ++ ++#if (BT_AUTO_REPORT_ONLY_8821C_1ANT == 0) ++ halbtc8821c1ant_query_bt_info(btcoexist); ++ ++#endif ++ ++ halbtc8821c1ant_monitor_bt_ctr(btcoexist); ++ halbtc8821c1ant_monitor_wifi_ctr(btcoexist); ++ ++ halbtc8821c1ant_monitor_bt_enable_disable(btcoexist); ++ ++ /* for 4-way, DHCP, EAPOL packet */ ++ if (coex_sta->specific_pkt_period_cnt > 0) { ++ ++ coex_sta->specific_pkt_period_cnt--; ++ ++ if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No")); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if (coex_sta->bt_coex_supported_feature == 0) ++ coex_sta->bt_coex_supported_feature = btcoexist->btc_get_bt_coex_supported_feature(btcoexist); ++ ++ if ( (coex_sta->bt_coex_supported_version == 0) && (!coex_sta->bt_disabled) ) ++ coex_sta->bt_coex_supported_version = btcoexist->btc_get_bt_coex_supported_version(btcoexist); ++ ++ if (halbtc8821c1ant_is_wifibt_status_changed(btcoexist)) ++ halbtc8821c1ant_run_coexist_mechanism(btcoexist); ++ ++ ++} ++ ++void ex_halbtc8821c1ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++#if BT_8821C_1ANT_ANTDET_ENABLE ++ static u32 ant_det_count = 0, ant_det_fail_count = 0; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ /*boolean scan, roam;*/ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Call AntennaDetect()!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (seconds == 0) { ++ psd_scan->ant_det_try_count = 0; ++ psd_scan->ant_det_fail_count = 0; ++ ant_det_count = 0; ++ ant_det_fail_count = 0; ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ return; ++ } ++ ++ if (!board_info->btdm_ant_det_finish) { ++ psd_scan->ant_det_inteval_count = ++ psd_scan->ant_det_inteval_count + 2; ++ ++ if (psd_scan->ant_det_inteval_count >= ++ BT_8821C_2ANT_ANTDET_RETRY_INTERVAL) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c1ant_psd_antenna_detection_check(btcoexist); ++ ++ if (board_info->btdm_ant_det_finish) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); ++ BTC_TRACE(trace_buf); ++#if 1 ++ if (board_info->btdm_ant_num_by_ant_det == 2) ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, ++ FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); ++ else ++ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, ++ FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); ++#endif ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ psd_scan->ant_det_inteval_count = 0; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", ++ psd_scan->ant_det_inteval_count); ++ BTC_TRACE(trace_buf); ++ } ++ ++ } ++#endif ++ ++ ++} ++ ++ ++void ex_halbtc8821c1ant_display_ant_detection(IN struct btc_coexist *btcoexist) ++{ ++#if BT_8821C_1ANT_ANTDET_ENABLE ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ if (psd_scan->ant_det_try_count != 0) { ++ halbtc8821c1ant_psd_show_antenna_detect_result(btcoexist); ++ ++ if (board_info->btdm_ant_det_finish) ++ halbtc8821c1ant_psd_showdata(btcoexist); ++ return; ++ } ++#endif ++ ++} ++ ++void ex_halbtc8821c1ant_antenna_isolation(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++ ++ ++} ++ ++void ex_halbtc8821c1ant_psd_scan(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++ ++ ++} ++ ++ ++#endif ++ ++#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.h 2018-02-11 21:44:27.150146132 +0200 +@@ -0,0 +1,432 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8821C_SUPPORT == 1) ++ ++/* ******************************************* ++ * The following is for 8821C 1ANT BT Co-exist definition ++ * ******************************************* */ ++#define BT_AUTO_REPORT_ONLY_8821C_1ANT 1 ++ ++#define BT_INFO_8821C_1ANT_B_FTP BIT(7) ++#define BT_INFO_8821C_1ANT_B_A2DP BIT(6) ++#define BT_INFO_8821C_1ANT_B_HID BIT(5) ++#define BT_INFO_8821C_1ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8821C_1ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8821C_1ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8821C_1ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8821C_1ANT_B_CONNECTION BIT(0) ++ ++#define BT_INFO_8821C_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ ++ (((_BT_INFO_EXT_&BIT(0))) ? true : false) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT 2 ++ ++#define BT_8821C_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ ++ ++/* for Antenna detection */ ++#define BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 ++#define BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 ++#define BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 ++#define BT_8821C_1ANT_ANTDET_PSDTHRES_1ANT 35 ++#define BT_8821C_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ ++#define BT_8821C_1ANT_ANTDET_SWEEPPOINT_DELAY 40000 ++#define BT_8821C_1ANT_ANTDET_ENABLE 0 ++#define BT_8821C_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 ++#define BT_8821C_1ANT_ANTDET_BTTXTIME 100 ++#define BT_8821C_1ANT_ANTDET_BTTXCHANNEL 39 ++ ++#define BT_8821C_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 ++ ++enum bt_8821c_1ant_signal_state { ++ BT_8821C_1ANT_SIG_STA_SET_TO_LOW = 0x0, ++ BT_8821C_1ANT_SIG_STA_SET_BY_HW = 0x0, ++ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH = 0x1, ++ BT_8821C_1ANT_SIG_STA_MAX ++}; ++ ++enum bt_8821c_1ant_path_ctrl_owner { ++ BT_8821C_1ANT_PCO_BTSIDE = 0x0, ++ BT_8821C_1ANT_PCO_WLSIDE = 0x1, ++ BT_8821C_1ANT_PCO_MAX ++}; ++ ++enum bt_8821c_1ant_gnt_ctrl_type { ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, ++ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW = 0x1, ++ BT_8821C_1ANT_GNT_TYPE_MAX ++}; ++ ++enum bt_8821c_1ant_gnt_ctrl_block { ++ BT_8821C_1ANT_GNT_BLOCK_RFC_BB = 0x0, ++ BT_8821C_1ANT_GNT_BLOCK_RFC = 0x1, ++ BT_8821C_1ANT_GNT_BLOCK_BB = 0x2, ++ BT_8821C_1ANT_GNT_BLOCK_MAX ++}; ++ ++enum bt_8821c_1ant_lte_coex_table_type { ++ BT_8821C_1ANT_CTT_WL_VS_LTE = 0x0, ++ BT_8821C_1ANT_CTT_BT_VS_LTE = 0x1, ++ BT_8821C_1ANT_CTT_MAX ++}; ++ ++enum bt_8821c_1ant_lte_break_table_type { ++ BT_8821C_1ANT_LBTT_WL_BREAK_LTE = 0x0, ++ BT_8821C_1ANT_LBTT_BT_BREAK_LTE = 0x1, ++ BT_8821C_1ANT_LBTT_LTE_BREAK_WL = 0x2, ++ BT_8821C_1ANT_LBTT_LTE_BREAK_BT = 0x3, ++ BT_8821C_1ANT_LBTT_MAX ++}; ++ ++enum bt_info_src_8821c_1ant { ++ BT_INFO_SRC_8821C_1ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8821C_1ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8821C_1ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8821C_1ANT_MAX ++}; ++ ++enum bt_8821c_1ant_bt_status { ++ BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8821C_1ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8821C_1ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8821C_1ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8821C_1ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8821c_1ant_wifi_status { ++ BT_8821C_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8821C_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, ++ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, ++ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, ++ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, ++ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, ++ BT_8821C_1ANT_WIFI_STATUS_MAX ++}; ++ ++enum bt_8821c_1ant_coex_algo { ++ BT_8821C_1ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8821C_1ANT_COEX_ALGO_SCO = 0x1, ++ BT_8821C_1ANT_COEX_ALGO_HID = 0x2, ++ BT_8821C_1ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8821C_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, ++ BT_8821C_1ANT_COEX_ALGO_PANEDR = 0x5, ++ BT_8821C_1ANT_COEX_ALGO_PANHS = 0x6, ++ BT_8821C_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, ++ BT_8821C_1ANT_COEX_ALGO_PANEDR_HID = 0x8, ++ BT_8821C_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, ++ BT_8821C_1ANT_COEX_ALGO_HID_A2DP = 0xa, ++ BT_8821C_1ANT_COEX_ALGO_MAX = 0xb, ++}; ++ ++enum bt_8821c_1ant_ext_ant_switch_type { ++ BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT = 0x0, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT = 0x1, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_MAX ++}; ++ ++ ++enum bt_8821c_1ant_ext_ant_switch_ctrl_type { ++ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW = 0x0, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA = 0x1, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV = 0x2, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC = 0x3, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT = 0x4, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_MAX ++}; ++ ++enum bt_8821c_1ant_ext_ant_switch_pos_type { ++ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT = 0x0, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLG = 0x1, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLA = 0x2, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE = 0x3, ++ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_MAX ++}; ++ ++enum bt_8821c_1ant_ext_band_switch_pos_type { ++ BT_8821C_1ANT_EXT_BAND_SWITCH_TO_WLG = 0x0, ++ BT_8821C_1ANT_EXT_BAND_SWITCH_TO_WLA = 0x1, ++ BT_8821C_1ANT_EXT_BAND_SWITCH_TO_MAX ++}; ++ ++enum bt_8821c_1ant_int_block{ ++ BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG = 0x0, ++ BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG = 0x1, ++ BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG = 0x2, ++ BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_MAX ++}; ++ ++enum bt_8821c_1ant_phase{ ++ BT_8821C_1ANT_PHASE_COEX_INIT = 0x0, ++ BT_8821C_1ANT_PHASE_WLANONLY_INIT = 0x1, ++ BT_8821C_1ANT_PHASE_WLAN_OFF = 0x2, ++ BT_8821C_1ANT_PHASE_2G_RUNTIME = 0x3, ++ BT_8821C_1ANT_PHASE_5G_RUNTIME = 0x4, ++ BT_8821C_1ANT_PHASE_BTMPMODE = 0x5, ++ BT_8821C_1ANT_PHASE_MAX ++}; ++ ++ ++struct coex_dm_8821c_1ant { ++ /* hw setting */ ++ u32 pre_ant_pos_type; ++ u32 cur_ant_pos_type; ++ /* fw mechanism */ ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean auto_tdma_adjust; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++ ++ /* sw mechanism */ ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ boolean limited_dig; ++ ++ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ ++ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ ++ u16 backup_retry_limit; ++ u8 backup_ampdu_max_time; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ u32 pre_ra_mask; ++ u32 cur_ra_mask; ++ u8 pre_arfr_type; ++ u8 cur_arfr_type; ++ u8 pre_retry_limit_type; ++ u8 cur_retry_limit_type; ++ u8 pre_ampdu_time_type; ++ u8 cur_ampdu_time_type; ++ u32 arp_cnt; ++ ++ u32 pre_ext_ant_switch_status; ++ u32 cur_ext_ant_switch_status; ++ ++ u8 pre_ext_band_switch_status; ++ u8 cur_ext_band_switch_status; ++ ++ u8 pre_int_block_status; ++ u8 cur_int_block_status; ++ ++ u8 error_condition; ++}; ++ ++struct coex_sta_8821c_1ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ boolean bt_hi_pri_link_exist; ++ u8 num_of_profile; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 specific_pkt_period_cnt; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ s8 bt_rssi; ++ boolean bt_tx_rx_mask; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ boolean c2h_bt_info_req_sent; ++ u8 bt_info_c2h[BT_INFO_SRC_8821C_1ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8821C_1ANT_MAX]; ++ boolean bt_whck_test; ++ boolean c2h_bt_inquiry_page; ++ boolean c2h_bt_page; /* Add for win8.1 page out issue */ ++ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++ u32 pop_event_cnt; ++ u8 scan_ap_num; ++ ++ u32 crc_ok_cck; ++ u32 crc_ok_11g; ++ u32 crc_ok_11n; ++ u32 crc_ok_11n_agg; ++ ++ u32 crc_err_cck; ++ u32 crc_err_11g; ++ u32 crc_err_11n; ++ u32 crc_err_11n_agg; ++ ++ boolean cck_lock; ++ boolean pre_ccklock; ++ boolean cck_ever_lock; ++ u8 coex_table_type; ++ ++ boolean force_lps_on; ++ u32 wrong_profile_notification; ++ ++ boolean concurrent_rx_mode_on; ++ ++ u16 score_board; ++ ++ u8 a2dp_bit_pool; ++ u8 cut_version; ++ boolean acl_busy; ++ boolean wl_rf_off_on_event; ++ boolean bt_create_connection; ++ boolean run_time_state; ++ ++ u32 bt_coex_supported_feature; ++ u32 bt_coex_supported_version; ++}; ++ ++ ++#define BT_8821C_1ANT_EXT_BAND_SWITCH_USE_DPDT 0 ++#define BT_8821C_1ANT_EXT_BAND_SWITCH_USE_SPDT 1 ++ ++ ++struct rfe_type_8821c_1ant{ ++ ++ u8 rfe_module_type; ++ boolean ext_ant_switch_exist; ++ u8 ext_ant_switch_type; /* 0:DPDT, 1:SPDT */ ++ u8 ext_ant_switch_ctrl_polarity; /* iF 0: DPDT_P=0, DPDT_N=1 => BTG to Main, WL_A+G to Aux */ ++ ++ boolean ext_band_switch_exist; ++ u8 ext_band_switch_type; /* 0:DPDT, 1:SPDT */ ++ u8 ext_band_switch_ctrl_polarity; ++ ++ boolean wlg_Locate_at_btg; /* If true: WLG at BTG, If false: WLG at WLAG */ ++ ++ boolean ext_ant_switch_diversity; /* If diversity on */ ++}; ++ ++#define BT_8821C_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ ++#define BT_8821C_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ ++#define BT_8821C_1ANT_ANTDET_BUF_LEN 16 ++ ++struct psdscan_sta_8821c_1ant { ++ ++ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ ++ u32 ant_det_bt_tx_time; ++ u32 ant_det_pre_psdscan_peak_val; ++ boolean ant_det_is_ant_det_available; ++ u32 ant_det_psd_scan_peak_val; ++ boolean ant_det_is_btreply_available; ++ u32 ant_det_psd_scan_peak_freq; ++ ++ u8 ant_det_result; ++ u8 ant_det_peak_val[BT_8821C_1ANT_ANTDET_BUF_LEN]; ++ u8 ant_det_peak_freq[BT_8821C_1ANT_ANTDET_BUF_LEN]; ++ u32 ant_det_try_count; ++ u32 ant_det_fail_count; ++ u32 ant_det_inteval_count; ++ u32 ant_det_thres_offset; ++ ++ u32 real_cent_freq; ++ s32 real_offset; ++ u32 real_span; ++ ++ u32 psd_band_width; /* unit: Hz */ ++ u32 psd_point; /* 128/256/512/1024 */ ++ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_start_point; ++ u32 psd_stop_point; ++ u32 psd_max_value_point; ++ u32 psd_max_value; ++ u32 psd_start_base; ++ u32 psd_avg_num; /* 1/8/16/32 */ ++ u32 psd_gen_count; ++ boolean is_psd_running; ++ boolean is_psd_show_max_only; ++}; ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8821c1ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821c1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821c1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8821c1ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821c1ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c1ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c1ant_switchband_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8821c1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c1ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821c1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state); ++void ex_halbtc8821c1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821c1ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821c1ant_display_coex_info(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821c1ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++void ex_halbtc8821c1ant_antenna_isolation(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++ ++void ex_halbtc8821c1ant_psd_scan(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++void ex_halbtc8821c1ant_display_ant_detection(IN struct btc_coexist *btcoexist); ++ ++#else ++#define ex_halbtc8821c1ant_power_on_setting(btcoexist) ++#define ex_halbtc8821c1ant_pre_load_firmware(btcoexist) ++#define ex_halbtc8821c1ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8821c1ant_init_coex_dm(btcoexist) ++#define ex_halbtc8821c1ant_ips_notify(btcoexist, type) ++#define ex_halbtc8821c1ant_lps_notify(btcoexist, type) ++#define ex_halbtc8821c1ant_scan_notify(btcoexist, type) ++#define ex_halbtc8821c1ant_switchband_notify(btcoexist,type) ++#define ex_halbtc8821c1ant_connect_notify(btcoexist, type) ++#define ex_halbtc8821c1ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8821c1ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8821c1ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8821c1ant_rf_status_notify(btcoexist, type) ++#define ex_halbtc8821c1ant_halt_notify(btcoexist) ++#define ex_halbtc8821c1ant_pnp_notify(btcoexist, pnp_state) ++#define ex_halbtc8821c1ant_coex_dm_reset(btcoexist) ++#define ex_halbtc8821c1ant_periodical(btcoexist) ++#define ex_halbtc8821c1ant_display_coex_info(btcoexist) ++#define ex_halbtc8821c1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) ++#define ex_halbtc8821c1ant_antenna_isolation(btcoexist, cent_freq, offset, span, seconds) ++#define ex_halbtc8821c1ant_psd_scan(btcoexist, cent_freq, offset, span, seconds) ++#define ex_halbtc8821c1ant_display_ant_detection(btcoexist) ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.c 2018-02-11 21:44:27.150146132 +0200 +@@ -0,0 +1,6096 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8821C Co-exist mechanism ++ * ++ * History ++ * 2012/11/15 Cosa first check in. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8821C_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8821c_2ant glcoex_dm_8821c_2ant; ++static struct coex_dm_8821c_2ant *coex_dm = &glcoex_dm_8821c_2ant; ++static struct coex_sta_8821c_2ant glcoex_sta_8821c_2ant; ++static struct coex_sta_8821c_2ant *coex_sta = &glcoex_sta_8821c_2ant; ++static struct psdscan_sta_8821c_2ant gl_psd_scan_8821c_2ant; ++static struct psdscan_sta_8821c_2ant *psd_scan = &gl_psd_scan_8821c_2ant; ++static struct rfe_type_8821c_2ant gl_rfe_type_8821c_2ant; ++static struct rfe_type_8821c_2ant *rfe_type = &gl_rfe_type_8821c_2ant; ++ ++const char *const glbt_info_src_8821c_2ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++u32 glcoex_ver_date_8821c_2ant = 20160316; ++u32 glcoex_ver_8821c_2ant = 0x00; ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8821c2ant_ ++ * ************************************************************ */ ++u8 halbtc8821c2ant_bt_rssi_state(u8 *ppre_bt_rssi_state, u8 level_num, ++ u8 rssi_thresh, u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = *ppre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return *ppre_bt_rssi_state; ++ } ++ ++ if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || ++ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ *ppre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8821c2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 *pprewifi_rssi_state, IN u8 level_num, IN u8 rssi_thresh, ++ IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = *pprewifi_rssi_state; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || ++ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return *pprewifi_rssi_state; ++ } ++ ++ if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || ++ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((*pprewifi_rssi_state == BTC_RSSI_STATE_MEDIUM) || ++ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ *pprewifi_rssi_state = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8821c2ant_coex_switch_threshold(IN struct btc_coexist *btcoexist, ++ IN u8 isolation_measuared) ++{ ++ s8 interference_wl_tx = 0, interference_bt_tx = 0; ++ ++ ++ interference_wl_tx = BT_8821C_2ANT_WIFI_MAX_TX_POWER - isolation_measuared; ++ interference_bt_tx = BT_8821C_2ANT_BT_MAX_TX_POWER - isolation_measuared; ++ ++ ++ ++ coex_sta->wifi_coex_thres = BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; ++ coex_sta->wifi_coex_thres2 = BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES2; ++ ++ coex_sta->bt_coex_thres = BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1; ++ coex_sta->bt_coex_thres2 = BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES2; ++ ++ ++ /* ++ coex_sta->wifi_coex_thres = interference_wl_tx + BT_8821C_2ANT_WIFI_SIR_THRES1; ++ coex_sta->wifi_coex_thres2 = interference_wl_tx + BT_8821C_2ANT_WIFI_SIR_THRES2; ++ ++ coex_sta->bt_coex_thres = interference_bt_tx + BT_8821C_2ANT_BT_SIR_THRES1; ++ coex_sta->bt_coex_thres2 = interference_bt_tx + BT_8821C_2ANT_BT_SIR_THRES2; ++ */ ++ ++ ++ ++ ++ ++ /* ++ if ( BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - ++ BT_8821C_2ANT_DEFAULT_ISOLATION) ) ++ coex_sta->wifi_coex_thres = BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; ++ else ++ coex_sta->wifi_coex_thres = BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - ++ BT_8821C_2ANT_DEFAULT_ISOLATION); ++ ++ if ( BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - ++ BT_8821C_2ANT_DEFAULT_ISOLATION) ) ++ coex_sta->bt_coex_thres = BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1; ++ else ++ coex_sta->bt_coex_thres = BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - ++ BT_8821C_2ANT_DEFAULT_ISOLATION); ++ ++ */ ++} ++ ++ ++void halbtc8821c2ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++} ++ ++void halbtc8821c2ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ coex_sta->c2h_bt_info_req_sent = true; ++ ++ h2c_parameter[0] |= BIT(0); /* trigger */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); ++} ++ ++void halbtc8821c2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ static u8 num_of_bt_counter_chk = 0, cnt_slave = 0; ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++ ++ if ((coex_sta->low_priority_tx > 1050) && ++ (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->pop_event_cnt++; ++ ++ if ((coex_sta->low_priority_rx >= 950) && (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) ++ && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist)) { ++ if (cnt_slave >= 2) { ++ bt_link_info->slave_role = true; ++ cnt_slave = 2; ++ } else ++ cnt_slave++; ++ } else { ++ if (cnt_slave == 0) { ++ bt_link_info->slave_role = false; ++ cnt_slave = 0; ++ } else ++ cnt_slave--; ++ ++ } ++ ++ if ((coex_sta->high_priority_tx == 0) && (coex_sta->high_priority_rx == 0) && (coex_sta->low_priority_tx == 0) && ++ (coex_sta->low_priority_rx == 0)) { ++ num_of_bt_counter_chk++; ++ if (num_of_bt_counter_chk >= 3) { ++ halbtc8821c2ant_query_bt_info(btcoexist); ++ num_of_bt_counter_chk = 0; ++ } ++ } ++ ++} ++ ++void halbtc8821c2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) ++{ ++ ++ ++ if (coex_sta->under_ips) { ++ coex_sta->crc_ok_cck = 0; ++ coex_sta->crc_ok_11g = 0; ++ coex_sta->crc_ok_11n = 0; ++ coex_sta->crc_ok_11n_agg = 0; ++ ++ coex_sta->crc_err_cck = 0; ++ coex_sta->crc_err_11g = 0; ++ coex_sta->crc_err_11n = 0; ++ coex_sta->crc_err_11n_agg = 0; ++ } else { ++ coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, ++ 0xf88); ++ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf94); ++ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf90); ++ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xfb8); ++ ++ coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, ++ 0xf84); ++ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf96); ++ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf92); ++ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xfba); ++ } ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); ++} ++ ++ ++boolean halbtc8821c2ant_is_wifibt_status_changed(IN struct btc_coexist *btcoexist) ++{ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false, pre_bt_off = false; ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (coex_sta->bt_disabled != pre_bt_off) { ++ pre_bt_off = coex_sta->bt_disabled; ++ ++ if (coex_sta->bt_disabled) ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!\n"); ++ else ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is enabled !!\n"); ++ ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->bt_coex_supported_feature = 0; ++ coex_sta->bt_coex_supported_version = 0; ++ return true; ++ } ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ ++ } ++ ++ return false; ++} ++ ++void halbtc8821c2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ bt_link_info->acl_busy = coex_sta->acl_busy; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if (bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if (!bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++} ++ ++void halbtc8821c2ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ h2c_parameter[0] = ++ 0x1; /* enable BT AFH skip WL channel for 8821c because BT Rx LO interference */ ++ /* h2c_parameter[0] = 0x0; */ ++ h2c_parameter[1] = wifi_central_chnl; ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); ++ ++} ++ ++void halbtc8821c2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, ++ IN u8 dac_swing_lvl) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ /* There are several type of dacswing */ ++ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ ++ h2c_parameter[0] = dac_swing_lvl; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); ++} ++ ++void halbtc8821c2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 fw_dac_swing_lvl) ++{ ++ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_fw_dac_swing_lvl == ++ coex_dm->cur_fw_dac_swing_lvl) ++ return; ++ } ++ ++ halbtc8821c2ant_set_fw_dac_swing_level(btcoexist, ++ coex_dm->cur_fw_dac_swing_lvl); ++ ++ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; ++} ++ ++void halbtc8821c2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN u8 dec_bt_pwr_lvl) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = dec_bt_pwr_lvl; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); ++} ++ ++void halbtc8821c2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 dec_bt_pwr_lvl) ++{ ++ coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) ++ return; ++ } ++ halbtc8821c2ant_set_fw_dec_bt_pwr(btcoexist, ++ coex_dm->cur_bt_dec_pwr_lvl); ++ ++ coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; ++} ++ ++void halbtc8821c2ant_set_fw_low_penalty_ra(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ ++ ++ if (low_penalty_ra) { ++ h2c_parameter[1] |= BIT(0); ++ h2c_parameter[2] = ++ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ ++ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ ++ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ ++ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); ++} ++ ++void halbtc8821c2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ halbtc8821c2ant_set_fw_low_penalty_ra(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++} ++ ++void halbtc8821c2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8821c2ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ halbtc8821c2ant_set_bt_auto_report(btcoexist, ++ coex_dm->cur_bt_auto_report); ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++void halbtc8821c2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, ++ IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, ++ IN boolean limited_dig, IN boolean bt_lna_constrain) ++{ ++ ++ halbtc8821c2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); ++} ++ ++void halbtc8821c2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, ++ IN boolean agc_table_shift, IN boolean adc_back_off, ++ IN boolean sw_dac_swing, IN u32 dac_swing_lvl) ++{ ++ /* halbtc8821c2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ ++ /* halbtc8821c2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */ ++} ++ ++void halbtc8821c2ant_write_score_board( ++ IN struct btc_coexist *btcoexist, ++ IN u16 bitpos, ++ IN BOOLEAN state ++) ++{ ++ ++ static u16 originalval = 0x8002; ++ ++ if (state) ++ originalval = originalval | bitpos; ++ else ++ originalval = originalval & (~bitpos); ++ ++ ++ btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); ++ ++} ++ ++void halbtc8821c2ant_read_score_board( ++ IN struct btc_coexist *btcoexist, ++ IN u16 *score_board_val ++) ++{ ++ ++ *score_board_val = (btcoexist->btc_read_2byte(btcoexist, ++ 0xaa)) & 0x7fff; ++} ++ ++void halbtc8821c2ant_post_activestate_to_bt( ++ IN struct btc_coexist *btcoexist, ++ IN boolean wifi_active ++) ++{ ++ ++ if (wifi_active) ++ halbtc8821c2ant_write_score_board(btcoexist, (u16) BIT(0), TRUE); ++ else ++ halbtc8821c2ant_write_score_board(btcoexist, (u16) BIT(0), FALSE); ++ ++ /* The BT should set "No Shunt-down" mode if WL = Active for BT Synthesizer on/off interference WL Lo issue at 8703b b-cut. */ ++ ++} ++ ++void halbtc8821c2ant_post_onoffstate_to_bt( ++ IN struct btc_coexist *btcoexist, ++ IN boolean wifi_on ++) ++{ ++ ++ if (wifi_on) ++ halbtc8821c2ant_write_score_board(btcoexist, (u16) BIT(1), TRUE); ++ else ++ halbtc8821c2ant_write_score_board(btcoexist, (u16) BIT(1), FALSE); ++ ++} ++ ++void halbtc8821c2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ u16 u16tmp; ++ ++ /* This function check if bt is disabled */ ++#if 0 ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ ++ ++#else ++ ++ /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */ ++ halbtc8821c2ant_read_score_board(btcoexist, &u16tmp); ++ ++ bt_active = u16tmp & BIT(1); ++ ++ ++#endif ++ ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ } else { ++ ++ bt_disable_cnt++; ++ if (bt_disable_cnt >= 2) { ++ bt_disabled = true; ++ bt_disable_cnt = 2; ++ } ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ } ++ ++ ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_disabled = bt_disabled; ++ } ++ ++} ++ ++void halbtc8821c2ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, ++ boolean isenable) ++{ ++ static u8 bitVal[5] = {0,0,0,0,0}; ++ static boolean state = false; ++ ++ if (state ==isenable) ++ return; ++ else ++ state = isenable; ++ ++ if (isenable) { ++ ++ /* enable GNT_WL, GNT_BT to GPIO for debug */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); ++ ++ /* store original value */ ++ bitVal[0] = (btcoexist->btc_read_1byte(btcoexist, 0x66) & BIT(4)) >>4; /*0x66[4] */ ++ bitVal[1] = (btcoexist->btc_read_1byte(btcoexist, 0x67) & BIT(0)); /*0x66[8] */ ++ bitVal[2] = (btcoexist->btc_read_1byte(btcoexist, 0x42) & BIT(3)) >> 3; /*0x40[19] */ ++ bitVal[3] = (btcoexist->btc_read_1byte(btcoexist, 0x65) & BIT(7)) >> 7; /*0x64[15] */ ++ bitVal[4] = (btcoexist->btc_read_1byte(btcoexist, 0x72) & BIT(2)) >> 2; /*0x70[18] */ ++ ++ /* switch GPIO Mux */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), 0x0); /*0x66[4] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), 0x0); /*0x66[8] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), 0x0); /*0x40[19] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), 0x0); /*0x64[15] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), 0x0); /*0x70[18] = 0 */ ++ ++ ++ } else { ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); ++ ++ /* Restore original value */ ++ /* switch GPIO Mux */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), bitVal[0]); /*0x66[4] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), bitVal[1]); /*0x66[8] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), bitVal[2]); /*0x40[19] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), bitVal[3]); /*0x64[15] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), bitVal[4]); /*0x70[18] = 0 */ ++ } ++ ++} ++ ++u32 halbtc8821c2ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, ++ IN u16 reg_addr) ++{ ++ u32 j = 0; ++ ++ ++ /* wait for ready bit before access 0x1700 */ ++ btcoexist->btc_write_4byte(btcoexist, 0x1700, 0x800F0000 | reg_addr); ++ ++ do { ++ j++; ++ } while (((btcoexist->btc_read_1byte(btcoexist, ++ 0x1703)&BIT(5)) == 0) && ++ (j < BT_8821C_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); ++ ++ ++ return btcoexist->btc_read_4byte(btcoexist, ++ 0x1708); /* get read data */ ++ ++} ++ ++void halbtc8821c2ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist, ++ IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) ++{ ++ u32 val, i = 0, j = 0, bitpos = 0; ++ ++ ++ if (bit_mask == 0x0) ++ return; ++ if (bit_mask == 0xffffffff) { ++ btcoexist->btc_write_4byte(btcoexist, 0x1704, ++ reg_value); /* put write data */ ++ ++ /* wait for ready bit before access 0x1700 */ ++ do { ++ j++; ++ } while (((btcoexist->btc_read_1byte(btcoexist, ++ 0x1703)&BIT(5)) == 0) && ++ (j < BT_8821C_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); ++ ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x1700, ++ 0xc00F0000 | reg_addr); ++ } else { ++ for (i = 0; i <= 31; i++) { ++ if (((bit_mask >> i) & 0x1) == 0x1) { ++ bitpos = i; ++ break; ++ } ++ } ++ ++ /* read back register value before write */ ++ val = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, ++ reg_addr); ++ val = (val & (~bit_mask)) | (reg_value << bitpos); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x1704, ++ val); /* put write data */ ++ ++ /* wait for ready bit before access 0x7c0 */ ++ do { ++ j++; ++ } while (((btcoexist->btc_read_1byte(btcoexist, ++ 0x1703)&BIT(5)) == 0) && ++ (j < BT_8821C_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); ++ ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x1700, ++ 0xc00F0000 | reg_addr); ++ ++ } ++ ++} ++ ++void halbtc8821c2ant_ltecoex_enable(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 val; ++ ++ val = (enable) ? 1 : 0; ++ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, ++ val); /* 0x38[7] */ ++ ++} ++ ++void halbtc8821c2ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_control) ++{ ++ u8 val; ++ ++ val = (wifi_control) ? 1 : 0; ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, ++ val); /* 0x70[26] */ ++ ++} ++ ++void halbtc8821c2ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, ++ IN u8 control_block, IN boolean sw_control, IN u8 state) ++{ ++ u32 val = 0, bit_mask; ++ ++ state = state & 0x1; ++ val = (sw_control) ? ((state << 1) | 0x1) : 0; ++ ++ switch (control_block) { ++ case BT_8821C_2ANT_GNT_BLOCK_RFC_BB: ++ default: ++ bit_mask = 0xc000; ++ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[15:14] */ ++ bit_mask = 0x0c00; ++ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[11:10] */ ++ break; ++ case BT_8821C_2ANT_GNT_BLOCK_RFC: ++ bit_mask = 0xc000; ++ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[15:14] */ ++ break; ++ case BT_8821C_2ANT_GNT_BLOCK_BB: ++ bit_mask = 0x0c00; ++ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[11:10] */ ++ break; ++ ++ } ++ ++} ++ ++void halbtc8821c2ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, ++ IN u8 control_block, IN boolean sw_control, IN u8 state) ++{ ++ u32 val = 0, bit_mask; ++ ++ state = state & 0x1; ++ val = (sw_control) ? ((state << 1) | 0x1) : 0; ++ ++ switch (control_block) { ++ case BT_8821C_2ANT_GNT_BLOCK_RFC_BB: ++ default: ++ bit_mask = 0x3000; ++ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[13:12] */ ++ bit_mask = 0x0300; ++ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[9:8] */ ++ break; ++ case BT_8821C_2ANT_GNT_BLOCK_RFC: ++ bit_mask = 0x3000; ++ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[13:12] */ ++ break; ++ case BT_8821C_2ANT_GNT_BLOCK_BB: ++ bit_mask = 0x0300; ++ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[9:8] */ ++ break; ++ ++ } ++ ++} ++ ++void halbtc8821c2ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u8 table_type, IN u16 table_content) ++{ ++ u16 reg_addr = 0x0000; ++ ++ switch (table_type) { ++ case BT_8821C_2ANT_CTT_WL_VS_LTE: ++ reg_addr = 0xa0; ++ break; ++ case BT_8821C_2ANT_CTT_BT_VS_LTE: ++ reg_addr = 0xa4; ++ break; ++ } ++ ++ if (reg_addr != 0x0000) ++ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, ++ 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ ++ ++ ++} ++ ++ ++void halbtc8821c2ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, ++ IN u8 table_type, IN u8 table_content) ++{ ++ u16 reg_addr = 0x0000; ++ ++ switch (table_type) { ++ case BT_8821C_2ANT_LBTT_WL_BREAK_LTE: ++ reg_addr = 0xa8; ++ break; ++ case BT_8821C_2ANT_LBTT_BT_BREAK_LTE: ++ reg_addr = 0xac; ++ break; ++ case BT_8821C_2ANT_LBTT_LTE_BREAK_WL: ++ reg_addr = 0xb0; ++ break; ++ case BT_8821C_2ANT_LBTT_LTE_BREAK_BT: ++ reg_addr = 0xb4; ++ break; ++ } ++ ++ if (reg_addr != 0x0000) ++ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, ++ 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ ++ ++ ++} ++ ++ ++void halbtc8821c2ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8821c2ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ halbtc8821c2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8821c2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ u32 break_table; ++ u8 select_table; ++ ++ coex_sta->coex_table_type = type; ++ ++ if (coex_sta->concurrent_rx_mode_on == true) { ++ break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ ++ select_table = ++ 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ ++ } else { ++ break_table = 0xffffff; ++ select_table = 0x3; ++ } ++ ++ switch (type) { ++ case 0: ++ halbtc8821c2ant_coex_table(btcoexist, force_exec, ++ 0xffffffff, 0xffffffff, break_table, select_table); ++ break; ++ case 1: ++ halbtc8821c2ant_coex_table(btcoexist, force_exec, ++ 0xaaaaaaaa, 0xaaaaaaaa, break_table, select_table); ++ break; ++ case 2: ++ halbtc8821c2ant_coex_table(btcoexist, force_exec, ++ 0x5a5a5a5a, 0x5a5a5a5a, break_table, select_table); ++ break; ++ case 3: ++ halbtc8821c2ant_coex_table(btcoexist, force_exec, ++ 0xdafadafa, 0xdafadafa, break_table, select_table); ++ break; ++ case 4: ++ halbtc8821c2ant_coex_table(btcoexist, force_exec, ++ 0xddffddff, 0xffbbffbb, break_table, select_table); ++ break; ++ case 5: ++ halbtc8821c2ant_coex_table(btcoexist, force_exec, ++ 0x5fff5fff, 0x5fff5fff, break_table, select_table); ++ break; ++ case 6: ++ halbtc8821c2ant_coex_table(btcoexist, force_exec, ++ 0x55ff55ff, 0x5a5a5a5a, break_table, select_table); ++ break; ++ case 7: ++ halbtc8821c2ant_coex_table(btcoexist, force_exec, ++ 0x5aff55ff, 0x5a7a5a7a, break_table, select_table); ++ break; ++ case 8: ++ halbtc8821c2ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0xaaaaaaaa, break_table, select_table); ++ break; ++ default: ++ break; ++ } ++} ++ ++void halbtc8821c2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ if (enable) { ++ h2c_parameter[0] |= BIT(0); /* function enable */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); ++} ++ ++void halbtc8821c2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ return; ++ } ++ halbtc8821c2ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8821c2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8821c2ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8821c2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8821c2ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ u8 h2c_parameter[5] = {0, 0, 0, 0x40, 0}; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ /*halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); */ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ /*halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8);*/ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++void halbtc8821c2ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ boolean low_pwr_disable = false; ++ ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ /* recover to original 32k low power setting */ ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ case BTC_PS_LPS_ON: ++ halbtc8821c2ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8821c2ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ /* when coex force to enter LPS, do not enter 32k low power. */ ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ coex_sta->force_lps_on = true; ++ break; ++ case BTC_PS_LPS_OFF: ++ halbtc8821c2ant_ps_tdma_check_for_power_save_state( ++ btcoexist, false); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ default: ++ break; ++ } ++} ++ ++ ++ ++void halbtc8821c2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ u8 real_byte1 = byte1, real_byte5 = byte5; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ if (ap_enable) { ++ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], FW for 1Ant AP mode\n"); ++ BTC_TRACE(trace_buf); ++ real_byte1 &= ~BIT(4); ++ real_byte1 |= BIT(5); ++ ++ real_byte5 |= BIT(5); ++ real_byte5 &= ~BIT(6); ++ ++ halbtc8821c2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ } ++ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ ++ halbtc8821c2ant_power_save_state( ++ btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } else { ++ halbtc8821c2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ } ++ ++ ++ h2c_parameter[0] = real_byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = real_byte5; ++ ++ coex_dm->ps_tdma_para[0] = real_byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = real_byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++void halbtc8821c2ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ ++ static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ ++ if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) ++ psTdmaByte4Modify = 0x1; ++ else ++ psTdmaByte4Modify = 0x0; ++ ++ if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { ++ ++ force_exec = true; ++ pre_psTdmaByte4Modify = psTdmaByte4Modify; ++ } ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ return; ++ } ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], %s turn %s PS TDMA, type=%d\n", ++ (force_exec ? "force to" : ""), (turn_on ? "ON" : "OFF"), type); ++ BTC_TRACE(trace_buf); ++ ++ ++ if (turn_on) { ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, ++ 0x1); /* enable TBTT nterrupt */ ++ } ++ ++ ++ if (turn_on) { ++ switch (type) { ++ case 1: ++ default: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x10, 0x03, 0xf1, ++ 0x14 | psTdmaByte4Modify); ++ break; ++ case 2: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x35, 0x03, 0x71, ++ 0x11 | psTdmaByte4Modify); ++ break; ++ case 3: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x3a, 0x3, 0xf1, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 4: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x21, 0x3, 0xf1, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 5: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x30, 0x3, 0xf1, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 6: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x3, 0xf1, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 7: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x25, 0x3, 0xf1, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 11: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x30, 0x03, 0x71, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 12: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x21, 0x03, 0x71, ++ 0x11 | psTdmaByte4Modify); ++ break; ++ case 13: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x1c, 0x03, 0x71, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 101: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x10, 0x03, 0x70, ++ 0x14 | psTdmaByte4Modify); ++ break; ++ case 102: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, ++ 0x35, 0x03, 0x71, ++ 0x11 | psTdmaByte4Modify); ++ break; ++ case 103: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x3a, 0x3, 0x70, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 104: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x21, 0x3, 0x70, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 105: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x30, 0x3, 0x70, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 106: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x1c, 0x3, 0x70, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ case 107: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, ++ 0x25, 0x3, 0x70, ++ 0x10 | psTdmaByte4Modify); ++ break; ++ ++ ++ } ++ } else { ++ /* disable PS tdma */ ++ switch (type) { ++ case 0: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x40, 0x0); ++ break; ++ case 1: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x48, 0x0); ++ break; ++ default: ++ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x0, ++ 0x0, 0x0, 0x40, 0x0); ++ break; ++ } ++ } ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++void halbtc8821c2ant_set_int_block(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 pos_type) ++{ ++ u8 regval_0xcba; ++ u32 u32tmp1 = 0; ++ ++ coex_dm->cur_int_block_status = pos_type; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_int_block_status == coex_dm->cur_int_block_status) ++ return; ++ } ++ ++ coex_dm->pre_int_block_status = coex_dm->cur_int_block_status; ++ ++ regval_0xcba = btcoexist->btc_read_1byte(btcoexist, 0xcba); ++ ++ switch(pos_type){ ++ ++ case BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG: ++ regval_0xcba = regval_0xcba & (~(BIT(2)) ) | BIT(0); /* 0xcb8[16] = 1, 0xcb8[18] = 0, WL_G select BTG */ ++ break; ++ case BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG: ++ regval_0xcba = regval_0xcba & (~(BIT(2) | BIT(0)) ); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ ++ regval_0xcba = regval_0xcba | BIT(4) | BIT(5) ; /* 0xcb8[21:20] = 2b'11, WL_G @ WLAG on */ ++ regval_0xcba = regval_0xcba & (~(BIT(7)) ) | BIT(6); /* 0xcb8[23:22] = 2b'01, WL_A @ WLAG off */ ++ ++ break; ++ case BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG: ++ regval_0xcba = regval_0xcba & (~(BIT(2) | BIT(0)) ); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ ++ regval_0xcba = regval_0xcba & (~(BIT(5))) | BIT(4); /* 0xcb8[21:20] = 2b'01, WL_G @ WLAG off */ ++ regval_0xcba = regval_0xcba | BIT(6) | BIT(7); /* 0xcb8[23:22] = 2b'11, WL_A @ WLAG on */ ++ ++ break; ++ } ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcba, 0xff, regval_0xcba); ++ ++ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb8); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Int Block setup) 0xcb8 = 0x%08x **********\n", ++ u32tmp1); ++ BTC_TRACE(trace_buf); ++ ++} ++ ++void halbtc8821c2ant_set_ext_band_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 pos_type) ++{ ++ ++#if 0 ++ boolean switch_polatiry_inverse = false; ++ u8 regval_0xcb6; ++ u32 u32tmp1 = 0, u32tmp2 = 0; ++ ++ if (!rfe_type->ext_band_switch_exist) ++ return; ++ ++ coex_dm->cur_ext_band_switch_status = pos_type; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ext_band_switch_status == coex_dm->cur_ext_band_switch_status) ++ return; ++ } ++ ++ coex_dm->pre_ext_band_switch_status = coex_dm->cur_ext_band_switch_status; ++ ++ /* swap control polarity if use different switch control polarity*/ ++ switch_polatiry_inverse = (rfe_type->ext_band_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); ++ ++ /*swap control polarity for WL_A, default polarity 0xcb4[21] = 0 && 0xcb4[23] = 1 is for WL_G */ ++ switch_polatiry_inverse = (pos_type == BT_8821C_2ANT_EXT_BAND_SWITCH_TO_WLA? ~switch_polatiry_inverse: switch_polatiry_inverse); ++ ++ regval_0xcb6 = btcoexist->btc_read_1byte(btcoexist, 0xcb6); ++ ++ /* for normal switch polrity, 0xcb4[21] =1 && 0xcb4[23] = 0 for WL_A, vice versa */ ++ regval_0xcb6 = (switch_polatiry_inverse == 1? ( (regval_0xcb6 & (~(BIT(7))) ) | BIT(5)) : ( (regval_0xcb6 & (~(BIT(5))) ) | BIT(7)) ); ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb6, 0xff, regval_0xcb6); ++ ++ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb0); ++ u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Ext Band switch setup) 0xcb0 = 0x%08x, 0xcb4 = 0x%08x**********\n", ++ u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++#endif ++ ++} ++ ++void halbtc8821c2ant_set_ext_ant_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 ctrl_type, IN u8 pos_type) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ boolean switch_polatiry_inverse = false; ++ u8 regval_0xcb7 = 0, regval_0x64; ++ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; ++ ++ if (!rfe_type->ext_ant_switch_exist) ++ return; ++ ++ coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ext_ant_switch_status == coex_dm->cur_ext_ant_switch_status) ++ return; ++ } ++ ++ coex_dm->pre_ext_ant_switch_status = coex_dm->cur_ext_ant_switch_status; ++ ++ /* swap control polarity if use different switch control polarity*/ ++ /* Normal switch polarity for DPDT, 0xcb4[29:28] = 2b'01 => BTG to Main, WLG to Aux, 0xcb4[29:28] = 2b'10 => BTG to Aux, WLG to Main */ ++ /* Normal switch polarity for SPDT, 0xcb4[29:28] = 2b'01 => Ant to BTG, 0xcb4[29:28] = 2b'10 => Ant to WLG */ ++ switch_polatiry_inverse = (rfe_type->ext_ant_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); ++ ++ switch(pos_type) ++ { ++ default: ++ case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT: ++ case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE: ++ ++ break; ++ case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLG: ++ switch_polatiry_inverse = (rfe_type->wlg_Locate_at_btg == 0? ~switch_polatiry_inverse: switch_polatiry_inverse); ++ break; ++ case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLA: ++ ++ break; ++ } ++ ++ ++ switch(ctrl_type) ++ { ++ default: ++ case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x77); /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ ++ ++ regval_0xcb7 = (switch_polatiry_inverse == false? 0x1 : 0x2); /* 0xcb4[29:28] = 2b'01 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, 0x30, regval_0xcb7); ++ ++ break; ++ case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x66); /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ ++ ++ regval_0xcb7 = (switch_polatiry_inverse == false? 0x2 : 0x1); /* 0xcb4[29:28] = 2b'10 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 @ GNT_BT=1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, 0x30, regval_0xcb7); ++ ++ break; ++ case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x88); /* */ ++ ++ /* no regval_0xcb7 setup required, because antenna switch control value by antenna diversity */ ++ ++ break; ++ case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x1); /* 0x4c[23] = 1 */ ++ ++ regval_0x64 = (switch_polatiry_inverse == false? 0x0 : 0x1); /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, regval_0x64); ++ break; ++ case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x0); /* 0x4c[24] = 0 */ ++ ++ /* no setup required, because antenna switch control value by BT vendor 0x1c[1:0] */ ++ break; ++ } ++ ++ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Ext Ant switch setup) 0xcb4 = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x**********\n", ++ u32tmp1, u32tmp2, u32tmp3); ++ BTC_TRACE(trace_buf); ++ ++ ++} ++ ++void halbtc8821c2ant_set_rfe_type(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++#if 0 ++ rfe_type->ext_band_switch_exist = false; ++ rfe_type->ext_band_switch_type = BT_8821C_2ANT_EXT_BAND_SWITCH_USE_SPDT; // SPDT; ++ rfe_type->ext_band_switch_ctrl_polarity = 0; ++ ++ if (rfe_type->ext_band_switch_exist) { ++ ++ /* band switch use RFE_ctrl1 (pin name: PAPE_A) and RFE_ctrl3 (pin name: LNAON_A) */ ++ ++ /* set RFE_ctrl1 as software control */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb0, 0xf0, 0x7); ++ ++ /* set RFE_ctrl3 as software control */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb1, 0xf0, 0x7); ++ ++ } ++#endif ++ ++ /* the following setup should be got from Efuse in the future */ ++ rfe_type->rfe_module_type = board_info->rfe_type; ++ ++ rfe_type->ext_ant_switch_ctrl_polarity = 0; ++ rfe_type->ext_ant_switch_diversity = false; ++ ++ switch(rfe_type->rfe_module_type) ++ { ++ case 0: ++ default: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*2-Ant, DPDT, WLG*/ ++ rfe_type->wlg_Locate_at_btg = false; ++ /*rfe_type->ext_ant_switch_diversity = true;*/ ++ break; ++ case 1: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, WLG */ ++ rfe_type->wlg_Locate_at_btg = false; ++ break; ++ case 2: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, BTG */ ++ rfe_type->wlg_Locate_at_btg = true; ++ break; ++ case 3: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, WLG */ ++ rfe_type->wlg_Locate_at_btg = false; ++ break; ++ case 4: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, BTG */; ++ rfe_type->wlg_Locate_at_btg = true; ++ break; ++ case 5: ++ rfe_type->ext_ant_switch_exist = false; /*2-Ant, no antenna switch, WLG*/ ++ rfe_type->wlg_Locate_at_btg = false; ++ ++ } ++ ++ ++ if (rfe_type->wlg_Locate_at_btg) ++ halbtc8821c2ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); ++ else ++ halbtc8821c2ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); ++ ++ ++} ++ ++ ++void halbtc8821c2ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean force_exec, ++ IN u8 phase ) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u32 cnt_bt_cal_chk = 0; ++ boolean is_in_mp_mode = false; ++ u8 u8tmp = 0; ++ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; ++ u16 u16tmp1 = 0; ++ ++#if BT_8821C_2ANT_ANTDET_ENABLE ++#if BT_8821C_2ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE ++ if (ant_pos_type == BTC_ANT_PATH_PTA) { ++ if ((board_info->btdm_ant_det_finish) && ++ (board_info->btdm_ant_num_by_ant_det == 2)) { ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) ++ ant_pos_type = BTC_ANT_WIFI_AT_MAIN; ++ else ++ ant_pos_type = BTC_ANT_WIFI_AT_AUX; ++ } ++ } ++#endif ++#endif ++ ++ coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; ++ ++ if (!force_exec) { ++ if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) ++ return; ++ } ++ ++ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; ++ ++#if 1 ++ u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x38); ++ u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x54); ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ u32tmp3, u8tmp, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++#endif ++ ++ ++ switch (phase) ++ { ++ case BT_8821C_2ANT_PHASE_COEX_INIT: ++ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ ++ halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8821c2ant_ltecoex_set_coex_table(btcoexist, ++ BT_8821C_2ANT_CTT_WL_VS_LTE, 0xffff); ++ ++ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8821c2ant_ltecoex_set_coex_table(btcoexist, ++ BT_8821C_2ANT_CTT_BT_VS_LTE, 0xffff); ++ ++ /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ ++ while (cnt_bt_cal_chk <= 20) { ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, ++ 0x49d); ++ cnt_bt_cal_chk++; ++ if (u8tmp & BIT(0)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ delay_ms(50); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", ++ cnt_bt_cal_chk); ++ BTC_TRACE(trace_buf); ++ break; ++ } ++ } ++ ++ /* set Path control owner to WL at initial step */ ++ halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8821C_2ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW high */ ++ halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to SW high */ ++ halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); ++ ++ coex_sta->run_time_state = false; ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ { ++ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) ++ ant_pos_type = BTC_ANT_WIFI_AT_MAIN; ++ else ++ ant_pos_type = BTC_ANT_WIFI_AT_AUX; ++ } ++ ++ break; ++ case BT_8821C_2ANT_PHASE_WLANONLY_INIT: ++ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ ++ halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8821c2ant_ltecoex_set_coex_table(btcoexist, ++ BT_8821C_2ANT_CTT_WL_VS_LTE, 0xffff); ++ ++ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8821c2ant_ltecoex_set_coex_table(btcoexist, ++ BT_8821C_2ANT_CTT_BT_VS_LTE, 0xffff); ++ ++ /* set Path control owner to WL at initial step */ ++ halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8821C_2ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW Low */ ++ halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_2ANT_SIG_STA_SET_TO_LOW); ++ /* Set GNT_WL to SW high */ ++ halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); ++ ++ coex_sta->run_time_state = false; ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ { ++ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) ++ ant_pos_type = BTC_ANT_WIFI_AT_MAIN; ++ else ++ ant_pos_type = BTC_ANT_WIFI_AT_AUX; ++ } ++ ++ break; ++ case BT_8821C_2ANT_PHASE_WLAN_OFF: ++ /* Disable LTE Coex Function in WiFi side */ ++ halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* set Path control owner to BT */ ++ halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8821C_2ANT_PCO_BTSIDE); ++ ++ /* Set Ext Ant Switch to BT control at wifi off step */ ++ halbtc8821c2ant_set_ext_ant_switch(btcoexist, ++ FORCE_EXEC, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE); ++ coex_sta->run_time_state = false; ++ break; ++ case BT_8821C_2ANT_PHASE_2G_RUNTIME: ++ ++ /* set Path control owner to WL at runtime step */ ++ halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8821C_2ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to PTA */ ++ halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_PTA, ++ BT_8821C_2ANT_SIG_STA_SET_BY_HW); ++ ++ /* Set GNT_WL to PTA */ ++ halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_PTA, ++ BT_8821C_2ANT_SIG_STA_SET_BY_HW); ++ ++ coex_sta->run_time_state = true; ++ ++ if (rfe_type->wlg_Locate_at_btg) ++ halbtc8821c2ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); ++ else ++ halbtc8821c2ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ { ++ if (rfe_type->ext_ant_switch_diversity) ++ ant_pos_type = BTC_ANT_WIFI_AT_DIVERSITY; ++ else { ++ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) ++ ant_pos_type = BTC_ANT_WIFI_AT_MAIN; ++ else ++ ant_pos_type = BTC_ANT_WIFI_AT_AUX; ++ } ++ } ++ ++ break; ++ case BT_8821C_2ANT_PHASE_5G_RUNTIME: ++ ++ /* set Path control owner to WL at runtime step */ ++ halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8821C_2ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW Hi */ ++ halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); ++ ++ /* Set GNT_WL to SW Hi */ ++ halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); ++ ++ coex_sta->run_time_state = true; ++ ++ halbtc8821c2ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG); ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ { ++ if (rfe_type->ext_ant_switch_diversity) ++ ant_pos_type = BTC_ANT_WIFI_AT_DIVERSITY; ++ else { ++ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) ++ ant_pos_type = BTC_ANT_WIFI_AT_MAIN; ++ else ++ ant_pos_type = BTC_ANT_WIFI_AT_AUX; ++ } ++ } ++ ++ break; ++ case BT_8821C_2ANT_PHASE_BTMPMODE: ++ /* Disable LTE Coex Function in WiFi side */ ++ halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* set Path control owner to WL */ ++ halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8821C_2ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to SW Hi */ ++ halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); ++ ++ /* Set GNT_WL to SW Lo */ ++ halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_2ANT_SIG_STA_SET_TO_LOW); ++ ++ coex_sta->run_time_state = false; ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ { ++ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) ++ ant_pos_type = BTC_ANT_WIFI_AT_MAIN; ++ else ++ ant_pos_type = BTC_ANT_WIFI_AT_AUX; ++ } ++ ++ break; ++ } ++ ++ if (phase != BT_8821C_2ANT_PHASE_WLAN_OFF) ++ { ++ switch (ant_pos_type) { ++ default: ++ case BTC_ANT_WIFI_AT_MAIN: ++ halbtc8821c2ant_set_ext_ant_switch( btcoexist, ++ force_exec, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLG); ++ break; ++ case BTC_ANT_WIFI_AT_AUX: ++ halbtc8821c2ant_set_ext_ant_switch( btcoexist, ++ force_exec, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT); ++ break; ++ case BTC_ANT_WIFI_AT_DIVERSITY: ++ halbtc8821c2ant_set_ext_ant_switch( btcoexist, ++ force_exec, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE); ++ break; ++ } ++ ++ } ++#if 1 ++ u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Ant-Setup phase---%d) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ phase, u32tmp3, u8tmp, u32tmp1, u32tmp2); ++ ++ BTC_TRACE(trace_buf); ++#endif ++ ++} ++ ++ ++u8 halbtc8821c2ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8821C_2ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (!bt_link_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No BT link exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (bt_link_info->sco_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->hid_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->pan_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 0) { ++ ++ if (bt_link_info->acl_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No-Profile busy\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_2ANT_COEX_ALGO_NOPROFILEBUSY; ++ } ++ } else if (num_of_diff_profile == 1) { ++ if (bt_link_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_2ANT_COEX_ALGO_SCO; ++ } else { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_2ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_2ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_2ANT_COEX_ALGO_SCO; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP ==> A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_2ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_2ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_2ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_HID_A2DP; ++ } ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_2ANT_COEX_ALGO_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP ==> HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8821C_2ANT_COEX_ALGO_HID_A2DP; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_PANEDR_HID; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_PANEDR_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++ ++ ++void halbtc8821c2ant_action_coex_all_off(IN struct btc_coexist *btcoexist) ++{ ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ /* fw all off */ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++} ++ ++void halbtc8821c2ant_action_wifi_under5g(IN struct btc_coexist *btcoexist) ++{ ++ ++ /* fw all off */ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, ++ BT_8821C_2ANT_PHASE_5G_RUNTIME); ++} ++ ++void halbtc8821c2ant_action_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ /* fw all off */ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ coex_sta->pop_event_cnt = 0; ++} ++ ++void halbtc8821c2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ ++ boolean wifi_connected = false; ++ boolean scan = false, link = false, roam = false; ++ boolean wifi_busy = false; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (link || roam || coex_sta->wifi_is_high_pri_task) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi link/roam/hi-pri-task process + BT Inq/Page!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 8); ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); ++ ++ } else if (scan) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi scan process + BT Inq/Page!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 8); ++ ++ if (coex_sta->bt_create_connection) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 12); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); ++ ++ } else if (wifi_connected) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT Inq/Page!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 7); ++ ++ if (wifi_busy) { ++ ++ if ((bt_link_info->a2dp_exist) && (bt_link_info->acl_busy)) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); ++ ++ } else ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi no-link + BT Inq/Page!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++} ++ ++void halbtc8821c2ant_action_wifi_link_process(IN struct btc_coexist *btcoexist) ++{ ++ u32 u32tmp, u32tmpb; ++ u8 u8tmpa; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ ++ if ((bt_link_info->a2dp_exist) && (bt_link_info->acl_busy)) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); ++ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++} ++ ++ ++void halbtc8821c2ant_action_wifi_nonconnected(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ /* fw all off */ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw all off */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++} ++ ++void halbtc8821c2ant_action_bt_idle(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ ++ boolean wifi_connected = false; ++ boolean scan = false, link = false, roam = false; ++ boolean wifi_busy = false; ++ ++ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || link || roam) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi link process + BT Idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 7); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); ++ } else if (wifi_connected) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT Idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (wifi_busy) { ++ if (!BTC_RSSI_HIGH(bt_rssi_state2)) ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 2); ++ else ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 0); ++ } else { ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 0); ++ } ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi no-link + BT Idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++} ++ ++ ++/* SCO only or SCO+PAN(HS) */ ++void halbtc8821c2ant_action_sco(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } ++ ++ ++ /* sw mechanism */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++} ++ ++ ++void halbtc8821c2ant_action_hid(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } ++ ++ ++ /* sw mechanism */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++} ++ ++/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ ++void halbtc8821c2ant_action_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); ++ else ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); ++ } else { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ ++ if (wifi_busy) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 101); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 102); ++ ++ } ++ ++ /* sw mechanism */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++} ++ ++void halbtc8821c2ant_action_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++#if 0 ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++#endif ++ ++ ++#if 1 ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 4); ++ } else { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ ++ if (wifi_busy) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 103); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 104); ++ ++ } ++ ++#endif ++ ++ ++ /* sw mechanism */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++} ++ ++ ++/* PAN(HS) only */ ++void halbtc8821c2ant_action_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ ++ } else { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } ++ ++ ++ /* sw mechanism */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++} ++ ++ ++void halbtc8821c2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); ++ ++ ++ } else { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ ++ if (wifi_busy) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 101); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 102); ++ ++ } ++ ++ ++ /* sw mechanism */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++} ++ ++ ++void halbtc8821c2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) { ++ ++ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 7); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ } else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); ++ ++ } else { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ ++ if (wifi_busy) { ++ ++ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 107); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 105); ++ } else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 106); ++ ++ } ++ ++ ++ /* sw mechanism */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++} ++ ++ ++ ++/* PAN(EDR)+A2DP */ ++void halbtc8821c2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) { ++ ++ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 7); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ } else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); ++ } else { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ ++ if (wifi_busy) { ++ ++ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 107); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 105); ++ } else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 106); ++ ++ } ++ ++ ++ /* sw mechanism */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++} ++ ++void halbtc8821c2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); ++ else ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 4); ++ ++ ++ } else { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ ++ if (wifi_busy) ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 103); ++ else ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 104); ++ ++ } ++ ++ ++ /* sw mechanism */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++} ++ ++/* HID+A2DP+PAN(EDR) */ ++void halbtc8821c2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) ++{ ++ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state, bt_rssi_state; ++ ++ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; ++ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; ++ u8 wifi_rssi_state2, bt_rssi_state2; ++ boolean wifi_busy = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state, 2, ++ coex_sta->wifi_coex_thres , 0); ++ ++ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, ++ &prewifi_rssi_state2, 2, ++ coex_sta->wifi_coex_thres2 , 0); ++ ++ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, ++ coex_sta->bt_coex_thres , 0); ++ ++ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, ++ coex_sta->bt_coex_thres2 , 0); ++ ++ ++ if (BTC_RSSI_HIGH(wifi_rssi_state) && ++ BTC_RSSI_HIGH(bt_rssi_state)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && ++ BTC_RSSI_HIGH(bt_rssi_state2)) { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); ++ ++ coex_dm->is_switch_to_1dot5_ant = false; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ if (wifi_busy) { ++ ++ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 7); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ } else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); ++ } else { ++ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ coex_dm->is_switch_to_1dot5_ant = true; ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); ++ ++ if (wifi_busy) { ++ ++ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 107); ++ else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 105); ++ } else ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 106); ++ } ++ ++ /* sw mechanism */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, ++ false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, ++ false, 0x18); ++ ++} ++ ++ ++ ++void halbtc8821c2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw mechanism all off */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++} ++ ++void halbtc8821c2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) ++{ ++ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); ++ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); ++ ++ /* sw mechanism all off */ ++ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); ++ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); ++ ++ /* hw all off */ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++} ++ ++void halbtc8821c2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ u8 algorithm = 0; ++ u32 num_of_wifi_link = 0; ++ u32 wifi_link_status = 0; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean miracast_plus_bt = false; ++ boolean scan = false, link = false, roam = false, wifi_connected = false, wifi_under_5g =false; ++ ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (!coex_sta->run_time_state){ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], return for run_time_state = false !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ if (wifi_under_5g) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under 5G!!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_action_wifi_under5g(btcoexist); ++ return; ++ } else{ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under 2G!!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, BT_8821C_2ANT_PHASE_2G_RUNTIME); ++ } ++ ++ ++ if (coex_sta->bt_whck_test) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under WHCK TEST!!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_bt_whck_test(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled!!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_coex_all_off(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under inquiry/page scan !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_bt_inquiry(btcoexist); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || link || roam) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under Link Process !!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_wifi_link_process(btcoexist); ++ return; ++ } ++ ++ /* for P2P */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if ((num_of_wifi_link >= 2) || ++ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", ++ num_of_wifi_link, wifi_link_status); ++ BTC_TRACE(trace_buf); ++ ++ if (bt_link_info->bt_link_exist) ++ miracast_plus_bt = true; ++ else ++ miracast_plus_bt = false; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ halbtc8821c2ant_action_wifi_multi_port(btcoexist); ++ ++ return; ++ } else { ++ miracast_plus_bt = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ } ++ ++ ++ algorithm = halbtc8821c2ant_action_algorithm(btcoexist); ++ coex_dm->cur_algorithm = algorithm; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", ++ coex_dm->cur_algorithm); ++ BTC_TRACE(trace_buf); ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ if (!wifi_connected) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, wifi non-connected!!.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_wifi_nonconnected(btcoexist); ++ ++ } else if ((BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) || (BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, bt idle!!.\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_action_bt_idle(btcoexist); ++ ++ } else { ++ ++ if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", ++ coex_dm->pre_algorithm, coex_dm->cur_algorithm); ++ BTC_TRACE(trace_buf); ++ } ++ ++ switch (coex_dm->cur_algorithm) { ++ ++ case BT_8821C_2ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_sco(btcoexist); ++ break; ++ case BT_8821C_2ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_hid(btcoexist); ++ break; ++ case BT_8821C_2ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_a2dp(btcoexist); ++ break; ++ case BT_8821C_2ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_a2dp_pan_hs(btcoexist); ++ break; ++ case BT_8821C_2ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_pan_edr(btcoexist); ++ break; ++ case BT_8821C_2ANT_COEX_ALGO_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_pan_hs(btcoexist); ++ break; ++ case BT_8821C_2ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_pan_edr_a2dp(btcoexist); ++ break; ++ case BT_8821C_2ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_pan_edr_hid(btcoexist); ++ break; ++ case BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_hid_a2dp_pan_edr( ++ btcoexist); ++ break; ++ case BT_8821C_2ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_hid_a2dp(btcoexist); ++ break; ++ case BT_8821C_2ANT_COEX_ALGO_NOPROFILEBUSY: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = No-Profile busy.\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_bt_idle(btcoexist); ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_action_coex_all_off(btcoexist); ++ break; ++ } ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ } ++} ++ ++void halbtc8821c2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ u8 u8tmp = 0; ++ u32 vendor; ++ u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0, u32tmp3 =0; ++ ++ ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ u32tmp3, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf);; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 2Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->bt_coex_supported_feature = 0; ++ coex_sta->bt_coex_supported_version = 0; ++ ++ ++ /* 0xf0[15:12] --> Chip Cut information */ ++ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, ++ 0xf1) & 0xf0) >> 4; ++ ++ coex_sta->dis_ver_info_cnt = 0; ++ ++ /* default isolation = 15dB */ ++ coex_sta->isolation_btween_wb = BT_8821C_2ANT_DEFAULT_ISOLATION; ++ halbtc8821c2ant_coex_switch_threshold(btcoexist, coex_sta->isolation_btween_wb); ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, ++ 0x1); /* enable TBTT nterrupt */ ++ ++ /* BT report packet sample rate */ ++ btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); ++ ++ /* Init 0x778 = 0x1 for 2-Ant */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); ++ ++ /* Enable PTA (3-wire function form BT side) */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); ++ ++ /* Enable PTA (tx/rx signal form WiFi side) */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); ++ ++ halbtc8821c2ant_enable_gnt_to_gpio(btcoexist, TRUE); ++ ++ /* check if WL firmware download ok */ ++ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) ++ halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, true); ++ ++ /* Enable counter statistics */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, ++ 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ ++ ++ if (wifi_only) { ++ ++ coex_sta->concurrent_rx_mode_on = false; ++ ++ /* Set Antenna Path */ ++ halbtc8821c2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_2ANT_PHASE_WLANONLY_INIT); ++ } else { ++ coex_sta->concurrent_rx_mode_on = true; ++ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); */ ++ ++ /* RF 0x1[1] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx, mask Tx only */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x2, 0x0); ++ ++ /* Set Antenna Path */ ++ halbtc8821c2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_2ANT_PHASE_COEX_INIT); ++ } ++ ++ /* WLAN_Tx by GNT_WL 0x950[29] = 0 */ ++ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x20, 0x0); */ ++ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ halbtc8821c2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ ++ psd_scan->ant_det_is_ant_det_available = TRUE; ++ ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ u32tmp3, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ ++} ++ ++u32 halbtc8821c2ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) ++{ ++ u8 j; ++ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; ++ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, ++ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, ++ 32, 23, 15, 7, 0 ++ }; ++ ++ if (val == 0) ++ return 0; ++ ++ tmp = val; ++ ++ while (1) { ++ if (tmp == 1) ++ break; ++ else { ++ tmp = (tmp >> 1); ++ shiftcount++; ++ } ++ } ++ ++ ++ val_integerd_b = shiftcount + 1; ++ ++ tmp2 = 1; ++ for (j = 1; j <= val_integerd_b; j++) ++ tmp2 = tmp2 * 2; ++ ++ tmp = (val * 100) / tmp2; ++ tindex = tmp / 5; ++ ++ if (tindex > 20) ++ tindex = 20; ++ ++ val_fractiond_b = table_fraction[tindex]; ++ ++ result = val_integerd_b * 100 - val_fractiond_b; ++ ++ return result; ++ ++ ++} ++ ++void halbtc8821c2ant_psd_show_antenna_detect_result(IN struct btc_coexist ++ *btcoexist) ++{ ++ u8 *cli_buf = btcoexist->cli_buf; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n============[Antenna Detection info] ============\n"); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->ant_det_result == 1) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", ++ "Ant Det Result", "2-Antenna (Bad-Isolation)", ++ BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ else if (psd_scan->ant_det_result == 2) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "2-Antenna (Good-Isolation)", ++ BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset, ++ BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", ++ "Ant Det Result", "1-Antenna", ++ BT_8821C_2ANT_ANTDET_PSDTHRES_1ANT, ++ BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset); ++ ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", ++ "Antenna Detection Finish", ++ (board_info->btdm_ant_det_finish ++ ? "Yes" : "No")); ++ CL_PRINTF(cli_buf); ++ ++ switch (psd_scan->ant_det_result) { ++ case 0: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is not available)"); ++ break; ++ case 1: /* 2-Ant bad-isolation */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 2: /* 2-Ant good-isolation */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 3: /* 1-Ant */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is available)"); ++ break; ++ case 4: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Uncertainty result)"); ++ break; ++ case 5: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); ++ break; ++ case 6: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(WiFi is Scanning)"); ++ break; ++ case 7: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is not idle)"); ++ break; ++ case 8: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Abort by WiFi Scanning)"); ++ break; ++ case 9: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(Antenna Init is not ready)"); ++ break; ++ case 10: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is Inquiry or page)"); ++ break; ++ case 11: ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "(BT is Disabled)"); ++ break; ++ } ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "Ant Detect Total Count", psd_scan->ant_det_try_count); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "Ant Detect Fail Count", psd_scan->ant_det_fail_count); ++ CL_PRINTF(cli_buf); ++ ++ if ((!board_info->btdm_ant_det_finish) && ++ (psd_scan->ant_det_result != 5)) ++ return; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", ++ (psd_scan->ant_det_result ? "ok" : "fail")); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", ++ psd_scan->ant_det_bt_tx_time); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", ++ psd_scan->ant_det_bt_le_channel); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", ++ "WiFi PSD Cent-Ch/Offset/Span", ++ psd_scan->real_cent_freq, psd_scan->real_offset, ++ psd_scan->real_span); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", ++ "PSD Pre-Scan Peak Value", ++ psd_scan->ant_det_pre_psdscan_peak_val / 100); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", ++ "PSD Pre-Scan result", ++ (psd_scan->ant_det_result != 5 ? "ok" : "fail"), ++ BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->ant_det_result == 5) ++ return; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", ++ "PSD Scan Peak Value", psd_scan->ant_det_peak_val); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", ++ "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", ++ (board_info->tfbga_package) ? "Yes" : "No"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "PSD Threshold Offset", psd_scan->ant_det_thres_offset); ++ CL_PRINTF(cli_buf); ++ ++} ++ ++void halbtc8821c2ant_psd_showdata(IN struct btc_coexist *btcoexist) ++{ ++ u8 *cli_buf = btcoexist->cli_buf; ++ u32 delta_freq_per_point; ++ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n\n============[PSD info] (%d)============\n", ++ psd_scan->psd_gen_count); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->psd_gen_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); ++ CL_PRINTF(cli_buf); ++ return; ++ } ++ ++ if (psd_scan->psd_point == 0) ++ delta_freq_per_point = 0; ++ else ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* if (psd_scan->is_psd_show_max_only) */ ++ if (0) { ++ psd_rep1 = psd_scan->psd_max_value / 100; ++ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; ++ ++ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + ++ psd_scan->psd_max_value_point * delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.0%d MHz", ++ freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.%d MHz", ++ freq1, freq2); ++ ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.0%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ ++ CL_PRINTF(cli_buf); ++ } else { ++ m = psd_scan->psd_start_point; ++ n = psd_scan->psd_start_point; ++ i = 1; ++ j = 1; ++ ++ while (1) { ++ do { ++ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * ++ delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (i == 1) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.000", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.0%2d", freq1, ++ freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.%3d", freq1, ++ freq2); ++ } else if ((i % 8 == 0) || ++ (m == psd_scan->psd_stop_point)) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.000\n", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.0%2d\n", freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.%3d\n", freq1, freq2); ++ } else { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.000", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.0%2d", freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.%3d", freq1, freq2); ++ } ++ ++ i++; ++ m++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); ++ ++ ++ do { ++ psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; ++ psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * ++ 100; ++ ++ if (j == 1) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.0%d", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.%d", psd_rep1, ++ psd_rep2); ++ } else if ((j % 8 == 0) || ++ (n == psd_scan->psd_stop_point)) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.0%d\n", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.%d\n", psd_rep1, psd_rep2); ++ } else { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.0%d", psd_rep1, psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.%d", psd_rep1, psd_rep2); ++ } ++ ++ j++; ++ n++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); ++ ++ if ((m > psd_scan->psd_stop_point) || ++ (n > psd_scan->psd_stop_point)) ++ break; ++ else { ++ i = 1; ++ j = 1; ++ } ++ ++ } ++ } ++ ++ ++} ++ ++void halbtc8821c2ant_psd_maxholddata(IN struct btc_coexist *btcoexist, ++ IN u32 gen_count) ++{ ++ u32 i = 0, i_max = 0, val_max = 0; ++ ++ if (gen_count == 1) { ++ memcpy(psd_scan->psd_report_max_hold, ++ psd_scan->psd_report, ++ BT_8821C_2ANT_ANTDET_PSD_POINTS * sizeof(u32)); ++ ++ psd_scan->psd_max_value_point = 0; ++ psd_scan->psd_max_value = 0; ++ ++ } else { ++ for (i = psd_scan->psd_start_point; ++ i <= psd_scan->psd_stop_point; i++) { ++ if (psd_scan->psd_report[i] > ++ psd_scan->psd_report_max_hold[i]) ++ psd_scan->psd_report_max_hold[i] = ++ psd_scan->psd_report[i]; ++ ++ /* search Max Value */ ++ if (i == psd_scan->psd_start_point) { ++ i_max = i; ++ val_max = psd_scan->psd_report_max_hold[i]; ++ } else { ++ if (psd_scan->psd_report_max_hold[i] > ++ val_max) { ++ i_max = i; ++ val_max = psd_scan->psd_report_max_hold[i]; ++ } ++ } ++ ++ } ++ ++ psd_scan->psd_max_value_point = i_max; ++ psd_scan->psd_max_value = val_max; ++ ++ } ++ ++ ++} ++ ++u32 halbtc8821c2ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) ++{ ++ /* reg 0x808[9:0]: FFT data x */ ++ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ ++ /* reg 0x8b4[15:0]: FFT data y report */ ++ ++ u32 val = 0, psd_report = 0; ++ int k = 0; ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ ++ val &= 0xffbffc00; ++ val |= point; ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ val |= 0x00400000; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ while (1) { ++ if (k++ > BT_8821C_2ANT_ANTDET_SWEEPPOINT_DELAY) ++ break; ++ } ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); ++ ++ psd_report = val & 0x0000ffff; ++ ++ return psd_report; ++} ++ ++ ++boolean halbtc8821c2ant_psd_sweep_point(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, ++ IN u32 avgnum, IN u32 loopcnt) ++{ ++ u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0; ++ u32 points1 = 0, psd_report = 0; ++ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; ++ u32 psd_center_freq = 20 * 10 ^ 6; ++ boolean outloop = false, scan , roam, is_sweep_ok = true; ++ u8 flag = 0; ++ u32 tmp = 0, u32tmp1 = 0; ++ u32 wifi_original_channel = 1; ++ ++ psd_scan->is_psd_running = true; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ do { ++ switch (flag) { ++ case 0: /* Get PSD parameters */ ++ default: ++ ++ psd_scan->psd_band_width = 40 * 1000000; ++ psd_scan->psd_point = points; ++ psd_scan->psd_start_base = points / 2; ++ psd_scan->psd_avg_num = avgnum; ++ psd_scan->real_cent_freq = cent_freq; ++ psd_scan->real_offset = offset; ++ psd_scan->real_span = span; ++ ++ ++ points1 = psd_scan->psd_point; ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* PSD point setup */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffff0fff; ++ ++ switch (psd_scan->psd_point) { ++ case 128: ++ val |= 0x0; ++ break; ++ case 256: ++ default: ++ val |= 0x00004000; ++ break; ++ case 512: ++ val |= 0x00008000; ++ break; ++ case 1024: ++ val |= 0x0000c000; ++ break; ++ } ++ ++ switch (psd_scan->psd_avg_num) { ++ case 1: ++ val |= 0x0; ++ break; ++ case 8: ++ val |= 0x00001000; ++ break; ++ case 16: ++ val |= 0x00002000; ++ break; ++ case 32: ++ default: ++ val |= 0x00003000; ++ break; ++ } ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ flag = 1; ++ break; ++ case 1: /* calculate the PSD point index from freq/offset/span */ ++ psd_center_freq = psd_scan->psd_band_width / 2 + ++ offset * (1000000); ++ ++ start_p = psd_scan->psd_start_base + (psd_center_freq - ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_start_point = start_p - ++ psd_scan->psd_start_base; ++ ++ stop_p = psd_scan->psd_start_base + (psd_center_freq + ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_stop_point = stop_p - ++ psd_scan->psd_start_base - 1; ++ ++ flag = 2; ++ break; ++ case 2: /* set RF channel/BW/Mode */ ++ ++ /* set 3-wire off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val |= 0x00300000; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val &= 0xfeffffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* Tx-pause on */ ++ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f); ++ ++ /* store WiFi original channel */ ++ wifi_original_channel = btcoexist->btc_get_rf_reg( ++ btcoexist, BTC_RF_A, 0x18, 0x3ff); ++ ++ /* Set RF channel */ ++ if (cent_freq == 2484) ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, 0xe); ++ else ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, (cent_freq - 2412) / 5 + ++ 1); /* WiFi TRx Mask on */ ++ ++ /* save original RCK value */ ++ u32tmp1 = btcoexist->btc_get_rf_reg( ++ btcoexist, BTC_RF_A, 0x1d, 0xfffff); ++ ++ /* Enter debug mode */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, ++ 0x2, 0x1); ++ ++ /* Set RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, ++ 0xfffff, 0x2e); ++ ++ ++ /* Set RF mode = Rx, RF Gain = 0x320a0 */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, ++ 0xfffff, 0x320a0); ++ ++ while (1) { ++ if (k++ > BT_8821C_2ANT_ANTDET_SWEEPPOINT_DELAY) ++ break; ++ } ++ flag = 3; ++ break; ++ case 3: ++ psd_scan->psd_gen_count = 0; ++ ++ for (j = 1; j <= loopcnt; j++) { ++ ++ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, 0xfffff, 0x320a0); */ ++ ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || roam) { ++ is_sweep_ok = false; ++ break; ++ } ++ memset(psd_scan->psd_report, 0, ++ psd_scan->psd_point * sizeof(u32)); ++ start_p = psd_scan->psd_start_point + ++ psd_scan->psd_start_base; ++ stop_p = psd_scan->psd_stop_point + ++ psd_scan->psd_start_base + 1; ++ ++ i = start_p; ++ point_index = 0; ++ ++ while (i < stop_p) { ++ if (i >= points1) ++ psd_report = ++ halbtc8821c2ant_psd_getdata( ++ btcoexist, i - points1); ++ else ++ psd_report = ++ halbtc8821c2ant_psd_getdata( ++ btcoexist, i); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Point=%d, psd_raw_data = 0x%08x\n", ++ i, psd_report); ++ BTC_TRACE(trace_buf); ++ if (psd_report == 0) ++ tmp = 0; ++ else ++ /* tmp = 20*log10((double)psd_report); */ ++ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ ++ tmp = 6 * halbtc8821c2ant_psd_log2base( ++ btcoexist, psd_report); ++ ++ n = i - psd_scan->psd_start_base; ++ psd_scan->psd_report[n] = tmp; ++ ++ ++ halbtc8821c2ant_psd_maxholddata( ++ btcoexist, j); ++ ++ i++; ++ ++ } ++ ++ psd_scan->psd_gen_count = j; ++ ++ ++ /* ++ val = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ tmp = btcoexist->btc_read_4byte(btcoexist, 0x64); ++ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "0x54 = 0x%08x, 0x67 = 0x%08x, 0x6c4 = 0x%08x\n", val, (tmp & 0xff000000) >> 24 ,u32tmp1); ++ BTC_TRACE(trace_buf); ++ */ ++ ++ } ++ ++ flag = 100; ++ break; ++ case 99: /* error */ ++ ++ outloop = true; ++ break; ++ case 100: /* recovery */ ++ ++ /* set 3-wire on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val &= 0xffcfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val |= 0x01000000; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* Tx-pause off */ ++ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0); ++ ++ /* PSD off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffbfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ /* restore RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, ++ 0xfffff, u32tmp1); ++ ++ /* Exit debug mode */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, ++ 0x2, 0x0); ++ ++ /* restore WiFi original channel */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, ++ 0x3ff, wifi_original_channel); ++ ++ outloop = true; ++ break; ++ ++ } ++ ++ } while (!outloop); ++ ++ ++ ++ psd_scan->is_psd_running = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); ++ BTC_TRACE(trace_buf); ++ return is_sweep_ok; ++ ++} ++ ++void halbtc8821c2ant_psd_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 bt_tx_time, IN u32 bt_le_channel) ++{ ++ u32 i = 0; ++ u32 wlpsd_cent_freq = 2484, wlpsd_span = 2, wlpsd_sweep_count = 50; ++ s32 wlpsd_offset = -4; ++ u8 bt_le_ch[13] = {3, 6, 8, 11, 13, 16, 18, 21, 23, 26, 28, 31, 33}; ++ ++ u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb; ++ ++ u8 state = 0; ++ boolean outloop = false, bt_resp = false; ++ u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, ++ u32tmp, u32tmp0, u32tmp1, u32tmp2 ; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ board_info->btdm_ant_det_finish = false; ++ memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); ++ memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); ++ ++ if (board_info->tfbga_package) /* for TFBGA */ ++ psd_scan->ant_det_thres_offset = 5; ++ else ++ psd_scan->ant_det_thres_offset = 0; ++ ++ do { ++ switch (state) { ++ case 0: ++ if (bt_le_channel == 39) ++ wlpsd_cent_freq = 2484; ++ else { ++ for (i = 1; i <= 13; i++) { ++ if (bt_le_ch[i - 1] == ++ bt_le_channel) { ++ wlpsd_cent_freq = 2412 ++ + (i - 1) * 5; ++ break; ++ } ++ } ++ ++ if (i == 14) { ++ ++ BTC_SPRINTF(trace_buf, ++ BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", ++ bt_le_channel); ++ BTC_TRACE(trace_buf); ++ outloop = true; ++ break; ++ } ++ } ++ ++ wlpsd_sweep_count = bt_tx_time * 238 / ++ 100; /* bt_tx_time/0.42 */ ++ wlpsd_sweep_count = wlpsd_sweep_count / 5; ++ ++ if (wlpsd_sweep_count % 5 != 0) ++ wlpsd_sweep_count = (wlpsd_sweep_count / ++ 5 + 1) * 5; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", ++ bt_tx_time, bt_le_channel); ++ BTC_TRACE(trace_buf); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", ++ wlpsd_cent_freq, ++ wlpsd_offset, ++ wlpsd_span, ++ wlpsd_sweep_count); ++ BTC_TRACE(trace_buf); ++ ++ state = 1; ++ break; ++ case 1: /* stop coex DM & set antenna path */ ++ /* Stop Coex DM */ ++ /* ++ btcoexist->stop_coex_dm = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); ++ BTC_TRACE(trace_buf); */ ++ ++ /* Set TDMA off, */ ++ halbtc8821c2ant_ps_tdma(btcoexist, FORCE_EXEC, ++ false, 0); ++ ++ /* Set coex table */ ++ halbtc8821c2ant_coex_table_with_type(btcoexist, ++ FORCE_EXEC, 0); ++ ++ if (board_info->btdm_ant_pos == ++ BTC_ANTENNA_AT_MAIN_PORT) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); ++ ++ halbtc8821c2ant_set_ext_ant_switch( btcoexist, ++ FORCE_EXEC, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT); ++ ++ /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ ++ /* set GNT_BT to SW high */ ++ halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to SW high */ ++ halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, ++ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); ++ ++ ++ /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ ++ h2c_parameter[0] = 0x1; ++ h2c_parameter[1] = 0xd; ++ h2c_parameter[2] = 0x14; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", ++ h2c_parameter[1], ++ h2c_parameter[2]); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, ++ h2c_parameter); ++ ++ u32tmp = btcoexist->btc_read_2byte(btcoexist, 0x948); ++ u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70); ++ u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** 0x948 = 0x%x, 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (Before Ant Det) **********\n", ++ u32tmp, u32tmp0, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ ++ state = 2; ++ break; ++ case 2: /* Pre-sweep background psd */ ++ if (!halbtc8821c2ant_psd_sweep_point(btcoexist, ++ wlpsd_cent_freq, wlpsd_offset, wlpsd_span, ++ BT_8821C_2ANT_ANTDET_PSD_POINTS, ++ BT_8821C_2ANT_ANTDET_PSD_AVGNUM, 3)) { ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ psd_scan->ant_det_result = 8; ++ state = 99; ++ break; ++ } ++ ++ psd_scan->ant_det_pre_psdscan_peak_val = ++ psd_scan->psd_max_value; ++ ++ if (psd_scan->psd_max_value > ++ (BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset) * 100) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", ++ psd_scan->psd_max_value / 100, ++ BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ BTC_TRACE(trace_buf); ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ psd_scan->ant_det_result = 5; ++ state = 99; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", ++ psd_scan->psd_max_value / 100, ++ BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND ++ + psd_scan->ant_det_thres_offset); ++ BTC_TRACE(trace_buf); ++ state = 3; ++ } ++ break; ++ case 3: ++ bt_resp = btcoexist->btc_set_bt_ant_detection( ++ btcoexist, (u8)(bt_tx_time & 0xff), ++ (u8)(bt_le_channel & 0xff)); ++ ++ if (!halbtc8821c2ant_psd_sweep_point(btcoexist, ++ wlpsd_cent_freq, wlpsd_offset, ++ wlpsd_span, ++ BT_8821C_2ANT_ANTDET_PSD_POINTS, ++ BT_8821C_2ANT_ANTDET_PSD_AVGNUM, ++ wlpsd_sweep_count)) { ++ board_info->btdm_ant_det_finish ++ = false; ++ board_info->btdm_ant_num_by_ant_det ++ = 1; ++ psd_scan->ant_det_result = 8; ++ state = 99; ++ break; ++ } ++ ++ psd_scan->ant_det_psd_scan_peak_val = ++ psd_scan->psd_max_value; ++ psd_scan->ant_det_psd_scan_peak_freq = ++ psd_scan->psd_max_value_point; ++ state = 4; ++ break; ++ case 4: ++ ++ if (psd_scan->psd_point == 0) ++ delta_freq_per_point = 0; ++ else ++ delta_freq_per_point = ++ psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ psd_rep1 = psd_scan->psd_max_value / 100; ++ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * ++ 100; ++ ++ freq = ((psd_scan->real_cent_freq - 20) * ++ 1000000 + psd_scan->psd_max_value_point ++ * delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (freq2 < 100) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", ++ freq1, freq2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_freq, ++ BT_8821C_2ANT_ANTDET_BUF_LEN, ++ "%d.0%d", freq1, freq2); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", ++ freq1, freq2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_freq, ++ BT_8821C_2ANT_ANTDET_BUF_LEN, ++ "%d.%d", freq1, freq2); ++ } ++ ++ if (psd_rep2 < 10) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.0%d dB\n", ++ psd_rep1, psd_rep2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_val, ++ BT_8821C_2ANT_ANTDET_BUF_LEN, ++ "%d.0%d", psd_rep1, psd_rep2); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.%d dB\n", ++ psd_rep1, psd_rep2); ++ BTC_TRACE(trace_buf); ++ CL_SPRINTF(psd_scan->ant_det_peak_val, ++ BT_8821C_2ANT_ANTDET_BUF_LEN, ++ "%d.%d", psd_rep1, psd_rep2); ++ } ++ ++ psd_scan->ant_det_is_btreply_available = true; ++ ++ if (bt_resp == false) { ++ psd_scan->ant_det_is_btreply_available = ++ false; ++ psd_scan->ant_det_result = 0; ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->psd_max_value > ++ (BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) ++ * 100) { ++ psd_scan->ant_det_result = 1; ++ board_info->btdm_ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 2; ++ coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->psd_max_value / 100) & 0xff; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->psd_max_value > ++ (BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION ++ + psd_scan->ant_det_thres_offset) * 100) { ++ psd_scan->ant_det_result = 2; ++ board_info->btdm_ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 2; ++ coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->psd_max_value / 100) & 0xff; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (psd_scan->psd_max_value > ++ (BT_8821C_2ANT_ANTDET_PSDTHRES_1ANT) * ++ 100) { ++ psd_scan->ant_det_result = 3; ++ board_info->btdm_ant_det_finish = true; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->psd_max_value / 100) & 0xff; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ psd_scan->ant_det_result = 4; ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ state = 99; ++ break; ++ case 99: /* restore setup */ ++ ++ /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ ++ h2c_parameter[0] = 0x0; ++ h2c_parameter[1] = 0x0; ++ h2c_parameter[2] = 0x0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", ++ h2c_parameter[1], h2c_parameter[2]); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, ++ h2c_parameter); ++ ++ /* Set Antenna Path, GNT_WL/GNT_BT control by PTA */ ++ /* Set Antenna path, switch WiFi to certain antenna port */ ++ halbtc8821c2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_2ANT_PHASE_2G_RUNTIME); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ /* Resume Coex DM */ ++ /* ++ btcoexist->stop_coex_dm = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); ++ BTC_TRACE(trace_buf); */ ++ ++ /* stimulate coex running */ ++ ++ halbtc8821c2ant_run_coexist_mechanism( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ outloop = true; ++ break; ++ } ++ ++ } while (!outloop); ++ ++ ++ ++} ++ ++void halbtc8821c2ant_psd_antenna_detection_check(IN struct btc_coexist ++ *btcoexist) ++{ ++ static u32 ant_det_count = 0, ant_det_fail_count = 0; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ boolean scan, roam; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ ++ /* psd_scan->ant_det_bt_tx_time = 20; */ ++ psd_scan->ant_det_bt_tx_time = ++ BT_8821C_2ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ ++ psd_scan->ant_det_bt_le_channel = BT_8821C_2ANT_ANTDET_BTTXCHANNEL; ++ ++ ant_det_count++; ++ ++ psd_scan->ant_det_try_count = ant_det_count; ++ ++ if (scan || roam) { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 6; ++ } else if (coex_sta->bt_disabled) { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 11; ++ } else if (coex_sta->num_of_profile >= 1) { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 7; ++ } else if ( ++ !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 9; ++ } else if (coex_sta->c2h_bt_inquiry_page) { ++ board_info->btdm_ant_det_finish = false; ++ psd_scan->ant_det_result = 10; ++ } else { ++ ++ btcoexist->stop_coex_dm = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_psd_antenna_detection(btcoexist, ++ psd_scan->ant_det_bt_tx_time, ++ psd_scan->ant_det_bt_le_channel); ++ ++ delay_ms(psd_scan->ant_det_bt_tx_time); ++ ++ btcoexist->stop_coex_dm = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); ++ BTC_TRACE(trace_buf); ++ ++ /* stimulate coex running */ ++ ++ halbtc8821c2ant_run_coexist_mechanism( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ ++ if (!board_info->btdm_ant_det_finish) ++ ant_det_fail_count++; ++ ++ psd_scan->ant_det_fail_count = ant_det_fail_count; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n", ++ psd_scan->ant_det_result, ++ psd_scan->ant_det_fail_count, ++ board_info->btdm_ant_det_finish == TRUE ? "Yes" : "No"); ++ BTC_TRACE(trace_buf); ++ ++} ++ ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8821c2ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8821c2ant_ ++ * ************************************************************ */ ++void ex_halbtc8821c2ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 u8tmp = 0x0; ++ u16 u16tmp = 0x0; ++ u32 value = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Execute 8821c 2-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Ant Det Finish = %s, Ant Det Number = %d\n", ++ (board_info->btdm_ant_det_finish ? "Yes" : "No"), ++ board_info->btdm_ant_num_by_ant_det); ++ BTC_TRACE(trace_buf); ++ ++ ++ btcoexist->stop_coex_dm = true; ++ psd_scan->ant_det_is_ant_det_available = FALSE; ++ ++ /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ ++ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); ++ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); ++ ++ ++ /* Local setting bit define */ ++ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ ++ /* BIT1: "0" for internal switch; "1" for external switch */ ++ /* BIT2: "0" for one antenna; "1" for two antenna */ ++ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ ++ ++ /* Check efuse 0xc3[6] for Single Antenna Path */ ++ if (board_info->single_ant_path == 0) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** Single Antenna, Antenna at Aux Port**********\n"); ++ BTC_TRACE(trace_buf); ++ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; ++ ++ u8tmp = 7; ++ } else if (board_info->single_ant_path == 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** Single Antenna, Antenna at Main Port**********\n"); ++ BTC_TRACE(trace_buf); ++ ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; ++ ++ u8tmp = 6; ++ } ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (Power On) single_ant_path = %d, btdm_ant_pos = %d **********\n", ++ board_info->single_ant_path , board_info->btdm_ant_pos); ++ BTC_TRACE(trace_buf); ++ ++ /* Save"single antenna position" info in Local register setting for FW reading, because FW may not ready at power on */ ++ if (btcoexist->chip_interface == BTC_INTF_PCI) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_USB) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_SDIO) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); ++ ++ /* Setup RF front end type */ ++ halbtc8821c2ant_set_rfe_type(btcoexist); ++ ++ /* Set Antenna Path by Efuse */ ++ halbtc8821c2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_2ANT_PHASE_COEX_INIT); ++ ++ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ ++ halbtc8821c2ant_enable_gnt_to_gpio(btcoexist, TRUE); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", ++ halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38)); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0xcb4 (Power-On) = 0x%x / 0x%x**********\n", ++ btcoexist->btc_read_4byte(btcoexist, 0x70), btcoexist->btc_read_4byte(btcoexist, 0xcb4)); ++ BTC_TRACE(trace_buf); ++ ++} ++ ++void ex_halbtc8821c2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */ ++ ++ /* */ ++ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ ++ /* Local setting bit define */ ++ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ ++ /* BIT1: "0" for internal switch; "1" for external switch */ ++ /* BIT2: "0" for one antenna; "1" for two antenna */ ++ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ ++ if (btcoexist->chip_interface == BTC_INTF_USB) { ++ /* fixed at S0 for USB interface */ ++ u8tmp |= 0x1; /* antenna inverse */ ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); ++ } else { ++ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ ++ if (board_info->single_ant_path == 0) { ++ } else if (board_info->single_ant_path == 1) { ++ /* set to S0 */ ++ u8tmp |= 0x1; /* antenna inverse */ ++ } ++ ++ if (btcoexist->chip_interface == BTC_INTF_PCI) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, ++ u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_SDIO) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, ++ u8tmp); ++ } ++} ++ ++ ++void ex_halbtc8821c2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ btcoexist->stop_coex_dm = false; ++ halbtc8821c2ant_init_hw_config(btcoexist, wifi_only); ++} ++ ++void ex_halbtc8821c2ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = false; ++ ++ halbtc8821c2ant_action_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8821c2ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_stack_info *stack_info = &btcoexist->stack_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; ++ u16 u16tmp[4]; ++ u32 u32tmp[4]; ++ u32 fa_of_dm, fa_cck; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ static u8 pop_report_in_10s = 0; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ if (btcoexist->stop_coex_dm) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Coex is STOPPED]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ if (psd_scan->ant_det_try_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s / %d", ++ "Ant PG Num/ Mech/ Pos/ RFE", ++ board_info->pg_ant_num, board_info->btdm_ant_num, ++ (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT? "Main" : "Aux"), ++ rfe_type->rfe_module_type); ++ CL_PRINTF(cli_buf); ++ } else { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ %d/ %s/ %d (%d/%d/%d)", ++ "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", ++ board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, ++ (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT ? "Main" : "Aux"), ++ rfe_type->rfe_module_type, ++ psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, ++ psd_scan->ant_det_result); ++ CL_PRINTF(cli_buf); ++ ++ if (board_info->btdm_ant_det_finish) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "Ant Det PSD Value", ++ psd_scan->ant_det_peak_val); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", ++ "BT stack/ hci ext ver", ++ ((stack_info->profile_notified) ? "Yes" : "No"), ++ stack_info->hci_version); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", ++ "Version Coex/ Fw/ Patch/ Cut", ++ glcoex_ver_date_8821c_2ant, glcoex_ver_8821c_2ant, fw_ver, ++ bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", ++ "WifibHiPri/ Ccklock/ CckEverLock", ++ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), ++ (coex_sta->cck_lock ? "Yes" : "No"), ++ (coex_sta->cck_ever_lock ? "Yes" : "No")); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ pop_report_in_10s++; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt/ popCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") ++ : ((BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, ++ coex_sta->pop_event_cnt); ++ CL_PRINTF(cli_buf); ++ ++ if (pop_report_in_10s >= 5) { ++ coex_sta->pop_event_cnt = 0; ++ pop_report_in_10s = 0; ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d / %d / %d / %d / %d", ++ "SCO/HID/PAN/A2DP/Hi-Pri", ++ bt_link_info->sco_exist, bt_link_info->hid_exist, ++ bt_link_info->pan_exist, bt_link_info->a2dp_exist, ++ bt_link_info->bt_hi_pri_link_exist); ++ CL_PRINTF(cli_buf); ++ ++ if (stack_info->profile_notified) ++ btcoexist->btc_disp_dbg_msg(btcoexist, ++ BTC_DBG_DISP_BT_LINK_INFO); ++ else { ++ bt_info_ext = coex_sta->bt_info_ext; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s / %d/ %x/ %04x", ++ "Role/A2DP Rate/Bitpool/Feature/Ver", ++ ((bt_link_info->slave_role) ? "Slave" : "Master"), ++ (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool, ++ coex_sta->bt_coex_supported_feature, ++ coex_sta->bt_coex_supported_version); ++ CL_PRINTF(cli_buf); ++ } ++ ++ ++ for (i = 0; i < BT_INFO_SRC_8821C_2ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8821c_2ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ ++ if (btcoexist->manual_control) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms] (before Manual)============"); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms]============"); ++ ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "SM[LowPenaltyRA]", ++ coex_dm->cur_low_penalty_ra); ++ CL_PRINTF(cli_buf); ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case, ++ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), ++ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); ++ ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "WL/BT Coex Table Type", ++ coex_sta->coex_table_type); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8(coexTable)", ++ u32tmp[0], u32tmp[1], u32tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x778/0x6cc/IgnWlanAct", ++ u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa0); ++ u32tmp[1] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "LTE Coex Table W_L/B_L", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa8); ++ u32tmp[1] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xac); ++ u32tmp[2] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb0); ++ u32tmp[3] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "LTE Break Table W_L/B_L/L_W/L_B", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, ++ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); ++ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "0x430/0x434/0x42a/0x456", ++ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ ++ u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", ++ "LTE CoexOn/Path Ctrl Owner", ++ (int)((u32tmp[0] & BIT(7)) >> 7), ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "LTE 3Wire/OPMode/UART/UARTMode", ++ (int)((u32tmp[0] & BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), ++ (int)((u32tmp[0] & BIT(3)) >> 3), ++ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", ++ "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", ++ (int)((u32tmp[0] & BIT(12)) >> 12), (int)((u32tmp[0] & BIT(14)) >> 14), ++ ((u8tmp[0] & BIT(3)) ? "On" : "Off")); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", ++ (int)((u32tmp[0] & BIT(2)) >> 2), (int)((u32tmp[0] & BIT(3)) >> 3), ++ (int)((u32tmp[0] & BIT(1)) >> 1), (int)(u32tmp[0] & BIT(0))); ++ CL_PRINTF(cli_buf); ++ ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcba); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%04x/ 0x%04x/ 0x%02x %s", ++ "0xcb0/0xcb4/0xcb8[23:16]", ++ u32tmp[0], u32tmp[1],u8tmp[0], ( (u8tmp[0] & 0x5) == 0x1 ? "BTG": ( (u8tmp[0] & 0xf0) == 0x70? "WL_G" : "WL_A" ) )); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x4c[24:23]/0x64[0]/x4c6[4]/0x40[5]", ++ (u32tmp[0] & ( BIT(24) | BIT(23) )) >> 23 , u8tmp[2]&0x1 , (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); ++ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xc50); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s/ 0x%x", ++ "0x550/0x522/4-RxAGC/0xc50", ++ u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off", u8tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xf4c); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xf08); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5d); ++ ++ fa_of_dm = (u32tmp[0] & 0xffff) + (u32tmp[1] & 0xffff); ++ ++ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", ++ u32tmp[2] & 0xffff, fa_cck, ((u32tmp[2] & 0xffff0000) >> 16), fa_of_dm); ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_OK CCK/11g/11n/11ac", ++ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, ++ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_Err CCK/11g/11n/11ac", ++ coex_sta->crc_err_cck, coex_sta->crc_err_11g, ++ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770(high-pri rx/tx)", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(low-pri rx/tx)", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++ ++ halbtc8821c2ant_read_score_board(btcoexist, &u16tmp[0]); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x", ++ "ScoreBoard[14:0] (from BT)", u16tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++ ++ ++void ex_halbtc8821c2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ coex_sta->under_lps = false; ++ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, false); ++ ++ halbtc8821c2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_2ANT_PHASE_WLAN_OFF); ++ ++ halbtc8821c2ant_action_coex_all_off(btcoexist); ++ } else if (BTC_IPS_LEAVE == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->under_ips = false; ++ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); ++ ++ halbtc8821c2ant_init_hw_config(btcoexist, false); ++ halbtc8821c2ant_action_init_coex_dm(btcoexist); ++ halbtc8821c2ant_query_bt_info(btcoexist); ++ } ++} ++ ++void ex_halbtc8821c2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_LPS_ENABLE == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->under_lps = true; ++ coex_sta->under_ips = false; ++ ++ if (coex_sta->force_lps_on == true) { /* LPS No-32K */ ++ /* Write WL "Active" in Score-board for PS-TDMA */ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); ++ ++ } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ ++ /* Write WL "Non-Active" in Score-board for Native-PS */ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, false); ++ ++ } ++ } else if (BTC_LPS_DISABLE == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->under_lps = false; ++ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); ++ } ++} ++ ++void ex_halbtc8821c2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u32 u32tmp; ++ u8 u8tmpa, u8tmpb; ++ boolean wifi_connected = false; ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN notify()\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_SCAN_START == type) //for dual band, no action for BTC_SCAN_START, the action is change to switchband_notify ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ halbtc8821c2ant_query_bt_info(btcoexist); /* this can't be removed for RF off_on event, or BT would dis-connect */ ++ ++ if (BTC_SCAN_START_2G == type) { ++ ++ if (!wifi_connected) ++ coex_sta->wifi_is_high_pri_task = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify (2G)\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_2ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8821c2ant_run_coexist_mechanism(btcoexist); ++ ++ } else if (BTC_SCAN_FINISH == type) { ++ ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", coex_sta->scan_ap_num); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_run_coexist_mechanism(btcoexist); ++ } ++ ++} ++ ++void ex_halbtc8821c2ant_switchband_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ if(type == BTC_SWITCH_TO_5G) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], switchband_notify --- switch to 5G\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_action_wifi_under5g(btcoexist); ++ ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], switchband_notify --- switch to 2G\n"); ++ BTC_TRACE(trace_buf); ++ ++ ex_halbtc8821c2ant_scan_notify(btcoexist, ++ BTC_SCAN_START_2G); ++ } ++} ++ ++ ++void ex_halbtc8821c2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ if ( (BTC_ASSOCIATE_5G_START == type) || (BTC_ASSOCIATE_5G_FINISH== type)) { ++ ++ if (BTC_ASSOCIATE_5G_START == type) ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], connect_notify --- 5G start\n"); ++ else ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], connect_notify --- 5G finish\n"); ++ ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_action_wifi_under5g(btcoexist); ++ return; ++ } ++ ++ ++ if (BTC_ASSOCIATE_START == type) { ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify (2G)\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_2ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8821c2ant_run_coexist_mechanism(btcoexist); ++ ++ coex_dm->arp_cnt = 0; ++ ++ } else if (BTC_ASSOCIATE_FINISH == type) { ++ ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify (2G)\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_run_coexist_mechanism(btcoexist); ++ } ++} ++ ++void ex_halbtc8821c2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ u8 ap_num = 0; ++ boolean wifi_under_b_mode = false, wifi_under_5g = false; ++ ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ if (wifi_under_5g) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under 5G!!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); ++ halbtc8821c2ant_action_wifi_under5g(btcoexist); ++ return; ++ } ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA connect notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); ++ ++ halbtc8821c2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_2ANT_PHASE_2G_RUNTIME); ++ ++ /* psd_scan->ant_det_is_ant_det_available = TRUE; */ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ /* Set CCK Tx/Rx high Pri except 11b mode */ ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x00); /* CCK Rx */ ++ } else { ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x10); /* CCK Rx */ ++ } ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], MEDIA disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, false); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ ++ } ++ ++ ++ halbtc8821c2ant_update_wifi_channel_info(btcoexist, type); ++} ++ ++void ex_halbtc8821c2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean under_4way = false, wifi_under_5g = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ if (wifi_under_5g) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under 5G!!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_action_wifi_under5g(btcoexist); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (under_4way) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ---- under_4way!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ coex_sta->specific_pkt_period_cnt = 2; ++ ++ } else if (BTC_PACKET_ARP == type) { ++ ++ coex_dm->arp_cnt++; ++ ++ if (coex_sta->wifi_is_high_pri_task) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ARP notify -cnt = %d\n", coex_dm->arp_cnt); ++ BTC_TRACE(trace_buf); ++ } ++ ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", type); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ coex_sta->specific_pkt_period_cnt = 2; ++ } ++ ++ if (coex_sta->wifi_is_high_pri_task) ++ halbtc8821c2ant_run_coexist_mechanism(btcoexist); ++ ++} ++ ++void ex_halbtc8821c2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 bt_info = 0; ++ u8 i, rsp_source = 0; ++ boolean bt_busy = false, limited_dig = false; ++ boolean wifi_connected = false; ++ ++ coex_sta->c2h_bt_info_req_sent = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8821C_2ANT_MAX) ++ rsp_source = BT_INFO_SRC_8821C_2ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ if (i == 1) ++ bt_info = tmp_buf[i]; ++ ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ if (BT_INFO_SRC_8821C_2ANT_WIFI_FW != rsp_source) { ++ ++ /* if 0xff, it means BT is under WHCK test */ ++ if (bt_info == 0xff) ++ coex_sta->bt_whck_test = true; ++ else ++ coex_sta->bt_whck_test = false; ++ ++ coex_sta->bt_retry_cnt = /* [3:0] */ ++ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; ++ ++ if (coex_sta->bt_retry_cnt >= 1) ++ coex_sta->pop_event_cnt++; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ++ coex_sta->bt_create_connection = true; ++ else ++ coex_sta->bt_create_connection = false; ++ ++ /* unit: %, value-100 to translate to unit: dBm */ ++ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ++ coex_sta->c2h_bt_remote_name_req = true; ++ else ++ coex_sta->c2h_bt_remote_name_req = false; ++ ++ if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) { ++ coex_sta->a2dp_bit_pool = ++ coex_sta->bt_info_c2h[rsp_source][6]; ++ } else ++ coex_sta->a2dp_bit_pool = 0; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][1] & 0x9) ++ coex_sta->acl_busy = true; ++ else ++ coex_sta->acl_busy = false; ++ ++ coex_sta->bt_info_ext = ++ coex_sta->bt_info_c2h[rsp_source][4]; ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ ++ if ((!btcoexist->manual_control) && (!btcoexist->stop_coex_dm)) { ++ ++ /* Re-Init */ ++ if ((coex_sta->bt_info_ext & BIT(1))) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ if (wifi_connected) ++ ex_halbtc8821c2ant_media_status_notify( ++ btcoexist, BTC_MEDIA_CONNECT); ++ else ++ ex_halbtc8821c2ant_media_status_notify( ++ btcoexist, BTC_MEDIA_DISCONNECT); ++ } ++ ++ ++ /* If Ignore_WLanAct && not SetUp_Link */ ++ if ((coex_sta->bt_info_ext & BIT(3)) && (!(coex_sta->bt_info_ext & BIT(2)))) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_ignore_wlan_act(btcoexist, ++ FORCE_EXEC, false); ++ } ++ } ++ ++ /* check BIT2 first ==> check if bt is under inquiry or page scan */ ++ if (bt_info & BT_INFO_8821C_2ANT_B_INQ_PAGE) ++ coex_sta->c2h_bt_inquiry_page = true; ++ else ++ coex_sta->c2h_bt_inquiry_page = false; ++ } ++ ++ coex_sta->num_of_profile = 0; ++ ++ /* set link exist status */ ++ if (!(bt_info & BT_INFO_8821C_2ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (bt_info & BT_INFO_8821C_2ANT_B_FTP) { ++ coex_sta->pan_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->pan_exist = false; ++ ++ if (bt_info & BT_INFO_8821C_2ANT_B_A2DP) { ++ coex_sta->a2dp_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->a2dp_exist = false; ++ ++ if (bt_info & BT_INFO_8821C_2ANT_B_HID) { ++ coex_sta->hid_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->hid_exist = false; ++ ++ if (bt_info & BT_INFO_8821C_2ANT_B_SCO_ESCO) { ++ coex_sta->sco_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->sco_exist = false; ++ ++ } ++ ++ halbtc8821c2ant_update_bt_link_info(btcoexist); ++ ++ if (!(bt_info & BT_INFO_8821C_2ANT_B_CONNECTION)) { ++ coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info == ++ BT_INFO_8821C_2ANT_B_CONNECTION) { /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if ((bt_info & BT_INFO_8821C_2ANT_B_SCO_ESCO) || ++ (bt_info & BT_INFO_8821C_2ANT_B_SCO_BUSY)) { ++ coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info & BT_INFO_8821C_2ANT_B_ACL_BUSY) { ++ coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_ACL_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_MAX; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if ((BT_8821C_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8821C_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8821C_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { ++ bt_busy = true; ++ limited_dig = true; ++ } else { ++ bt_busy = false; ++ limited_dig = false; ++ } ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ coex_dm->limited_dig = limited_dig; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Manual CTRL<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ halbtc8821c2ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8821c2ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_RF_ON == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned ON!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wl_rf_off_on_event = true; ++ btcoexist->stop_coex_dm = false; ++ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, TRUE); ++ halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, TRUE); ++ } else if (BTC_RF_OFF == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned OFF!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_2ANT_PHASE_WLAN_OFF); ++ ++ halbtc8821c2ant_action_coex_all_off(btcoexist); ++ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, FALSE); ++ halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, FALSE); ++ btcoexist->stop_coex_dm = true; ++ coex_sta->wl_rf_off_on_event = false; ++ ++ } ++} ++ ++void ex_halbtc8821c2ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8821C_2ANT_PHASE_WLAN_OFF); ++ ++ ex_halbtc8821c2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++ ++ halbtc8821c2ant_enable_gnt_to_gpio(btcoexist, FALSE); ++ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, FALSE); ++ halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, FALSE); ++} ++ ++void ex_halbtc8821c2ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_WIFI_PNP_SLEEP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ ++ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ ++ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ ++ coex_sta->under_ips = false; ++ coex_sta->under_lps = false; ++ ++ halbtc8821c2ant_enable_gnt_to_gpio(btcoexist, FALSE); ++ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, FALSE); ++ halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, FALSE); ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8821c2ant_post_activestate_to_bt(btcoexist, TRUE); ++ halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, TRUE); ++ } ++} ++ ++void ex_halbtc8821c2ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ============== Periodical ==============\n"); ++ BTC_TRACE(trace_buf); ++ ++#if (BT_AUTO_REPORT_ONLY_8821C_2ANT == 0) ++ halbtc8821c2ant_query_bt_info(btcoexist); ++#endif ++ ++ halbtc8821c2ant_monitor_bt_ctr(btcoexist); ++ halbtc8821c2ant_monitor_wifi_ctr(btcoexist); ++ halbtc8821c2ant_monitor_bt_enable_disable(btcoexist); ++ ++ /* for 4-way, DHCP, EAPOL packet */ ++ if (coex_sta->specific_pkt_period_cnt > 0) { ++ ++ coex_sta->specific_pkt_period_cnt--; ++ ++ if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No")); ++ BTC_TRACE(trace_buf); ++ ++ } ++ ++ if (coex_sta->bt_coex_supported_feature == 0) ++ coex_sta->bt_coex_supported_feature = btcoexist->btc_get_bt_coex_supported_feature(btcoexist); ++ ++ if ( (coex_sta->bt_coex_supported_version == 0) && (!coex_sta->bt_disabled) ) ++ coex_sta->bt_coex_supported_version = btcoexist->btc_get_bt_coex_supported_version(btcoexist); ++ ++ if (halbtc8821c2ant_is_wifibt_status_changed(btcoexist)) ++ halbtc8821c2ant_run_coexist_mechanism(btcoexist); ++} ++ ++ ++void ex_halbtc8821c2ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n"); ++ BTC_TRACE(trace_buf); ++ ++#if BT_8821C_2ANT_ANTDET_ENABLE ++ static u32 ant_det_count = 0, ant_det_fail_count = 0; ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ /*boolean scan, roam;*/ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Call AntennaDetect()!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (seconds == 0) { ++ psd_scan->ant_det_try_count = 0; ++ psd_scan->ant_det_fail_count = 0; ++ ant_det_count = 0; ++ ant_det_fail_count = 0; ++ board_info->btdm_ant_det_finish = false; ++ board_info->btdm_ant_num_by_ant_det = 1; ++ return; ++ } ++ ++ if (!board_info->btdm_ant_det_finish) { ++ psd_scan->ant_det_inteval_count = ++ psd_scan->ant_det_inteval_count + 2; ++ ++ if (psd_scan->ant_det_inteval_count >= ++ BT_8821C_2ANT_ANTDET_RETRY_INTERVAL) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8821c2ant_psd_antenna_detection_check(btcoexist); ++ ++ if (board_info->btdm_ant_det_finish) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); ++ BTC_TRACE(trace_buf); ++ ++#if 0 ++ board_info->btdm_ant_det_finish = false; ++#endif ++ ++#if 0 ++ if (board_info->btdm_ant_num_by_ant_det == 2) ++ halbtc8821c2ant_mechanism_switch( ++ btcoexist, true); ++ else ++ halbtc8821c2ant_mechanism_switch( ++ btcoexist, false); ++#endif ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ psd_scan->ant_det_inteval_count = 0; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", ++ psd_scan->ant_det_inteval_count); ++ BTC_TRACE(trace_buf); ++ } ++ ++ } ++#endif ++ ++ ++} ++ ++ ++void ex_halbtc8821c2ant_display_ant_detection(IN struct btc_coexist *btcoexist) ++{ ++ ++#if BT_8821C_2ANT_ANTDET_ENABLE ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ if (psd_scan->ant_det_try_count != 0) { ++ halbtc8821c2ant_psd_show_antenna_detect_result(btcoexist); ++ ++ if (board_info->btdm_ant_det_finish) ++ halbtc8821c2ant_psd_showdata(btcoexist); ++ return; ++ } ++#endif ++ ++} ++ ++ ++#endif ++ ++#endif /* #if (RTL8821C_SUPPORT == 1) */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.h 2018-02-11 21:44:27.150146132 +0200 +@@ -0,0 +1,433 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8821C_SUPPORT == 1) ++ ++/* ******************************************* ++ * The following is for 8821C 2Ant BT Co-exist definition ++ * ******************************************* */ ++#define BT_AUTO_REPORT_ONLY_8821C_2ANT 1 ++ ++ ++#define BT_INFO_8821C_2ANT_B_FTP BIT(7) ++#define BT_INFO_8821C_2ANT_B_A2DP BIT(6) ++#define BT_INFO_8821C_2ANT_B_HID BIT(5) ++#define BT_INFO_8821C_2ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8821C_2ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8821C_2ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8821C_2ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8821C_2ANT_B_CONNECTION BIT(0) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT 2 ++ ++ ++#define BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 80 /* unit: % WiFi RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 42 */ ++#define BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1 80 /* unit: % BT RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 46 */ ++#define BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES2 80 /* unit: % WiFi RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 42 */ ++#define BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES2 80 /* unit: % BT RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 46 */ ++#define BT_8821C_2ANT_DEFAULT_ISOLATION 15 /* unit: dB */ ++#define BT_8821C_2ANT_WIFI_MAX_TX_POWER 15 /* unit: dBm */ ++#define BT_8821C_2ANT_BT_MAX_TX_POWER 3 /* unit: dBm */ ++#define BT_8821C_2ANT_WIFI_SIR_THRES1 -15 /* unit: dB */ ++#define BT_8821C_2ANT_WIFI_SIR_THRES2 -30 /* unit: dB */ ++#define BT_8821C_2ANT_BT_SIR_THRES1 -15 /* unit: dB */ ++#define BT_8821C_2ANT_BT_SIR_THRES2 -30 /* unit: dB */ ++ ++ ++/* for Antenna detection */ ++#define BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND 50 ++#define BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 ++#define BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 52 ++#define BT_8821C_2ANT_ANTDET_PSDTHRES_1ANT 40 ++#define BT_8821C_2ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ ++#define BT_8821C_2ANT_ANTDET_SWEEPPOINT_DELAY 40000 ++#define BT_8821C_2ANT_ANTDET_ENABLE 0 ++#define BT_8821C_2ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 ++#define BT_8821C_2ANT_ANTDET_BTTXTIME 100 ++#define BT_8821C_2ANT_ANTDET_BTTXCHANNEL 39 ++ ++#define BT_8821C_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 ++ ++enum bt_8821c_2ant_signal_state { ++ BT_8821C_2ANT_SIG_STA_SET_TO_LOW = 0x0, ++ BT_8821C_2ANT_SIG_STA_SET_BY_HW = 0x0, ++ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH = 0x1, ++ BT_8821C_2ANT_SIG_STA_MAX ++}; ++ ++enum bt_8821c_2ant_path_ctrl_owner { ++ BT_8821C_2ANT_PCO_BTSIDE = 0x0, ++ BT_8821C_2ANT_PCO_WLSIDE = 0x1, ++ BT_8821C_2ANT_PCO_MAX ++}; ++ ++enum bt_8821c_2ant_gnt_ctrl_type { ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, ++ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW = 0x1, ++ BT_8821C_2ANT_GNT_TYPE_MAX ++}; ++ ++enum bt_8821c_2ant_gnt_ctrl_block { ++ BT_8821C_2ANT_GNT_BLOCK_RFC_BB = 0x0, ++ BT_8821C_2ANT_GNT_BLOCK_RFC = 0x1, ++ BT_8821C_2ANT_GNT_BLOCK_BB = 0x2, ++ BT_8821C_2ANT_GNT_BLOCK_MAX ++}; ++ ++enum bt_8821c_2ant_lte_coex_table_type { ++ BT_8821C_2ANT_CTT_WL_VS_LTE = 0x0, ++ BT_8821C_2ANT_CTT_BT_VS_LTE = 0x1, ++ BT_8821C_2ANT_CTT_MAX ++}; ++ ++enum bt_8821c_2ant_lte_break_table_type { ++ BT_8821C_2ANT_LBTT_WL_BREAK_LTE = 0x0, ++ BT_8821C_2ANT_LBTT_BT_BREAK_LTE = 0x1, ++ BT_8821C_2ANT_LBTT_LTE_BREAK_WL = 0x2, ++ BT_8821C_2ANT_LBTT_LTE_BREAK_BT = 0x3, ++ BT_8821C_2ANT_LBTT_MAX ++}; ++ ++enum bt_info_src_8821c_2ant { ++ BT_INFO_SRC_8821C_2ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8821C_2ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8821C_2ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8821C_2ANT_MAX ++}; ++ ++enum bt_8821c_2ant_bt_status { ++ BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8821C_2ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8821C_2ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8821C_2ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8821C_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8821C_2ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8821c_2ant_coex_algo { ++ BT_8821C_2ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8821C_2ANT_COEX_ALGO_SCO = 0x1, ++ BT_8821C_2ANT_COEX_ALGO_HID = 0x2, ++ BT_8821C_2ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8821C_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, ++ BT_8821C_2ANT_COEX_ALGO_PANEDR = 0x5, ++ BT_8821C_2ANT_COEX_ALGO_PANHS = 0x6, ++ BT_8821C_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, ++ BT_8821C_2ANT_COEX_ALGO_PANEDR_HID = 0x8, ++ BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, ++ BT_8821C_2ANT_COEX_ALGO_HID_A2DP = 0xa, ++ BT_8821C_2ANT_COEX_ALGO_NOPROFILEBUSY = 0xb, ++ BT_8821C_2ANT_COEX_ALGO_MAX ++}; ++ ++enum bt_8821c_2ant_ext_ant_switch_ctrl_type { ++ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW = 0x0, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_PTA = 0x1, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV = 0x2, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_MAC = 0x3, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT = 0x4, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_MAX ++}; ++ ++enum bt_8821c_2ant_ext_ant_switch_pos_type { ++ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT = 0x0, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLG = 0x1, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLA = 0x2, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE = 0x3, ++ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_MAX ++}; ++ ++enum bt_8821c_2ant_ext_band_switch_pos_type { ++ BT_8821C_2ANT_EXT_BAND_SWITCH_TO_WLG = 0x0, ++ BT_8821C_2ANT_EXT_BAND_SWITCH_TO_WLA = 0x1, ++ BT_8821C_2ANT_EXT_BAND_SWITCH_TO_MAX ++}; ++ ++enum bt_8821c_2ant_int_block{ ++ BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG = 0x0, ++ BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG = 0x1, ++ BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG = 0x2, ++ BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_MAX ++}; ++ ++enum bt_8821c_2ant_phase{ ++ BT_8821C_2ANT_PHASE_COEX_INIT = 0x0, ++ BT_8821C_2ANT_PHASE_WLANONLY_INIT = 0x1, ++ BT_8821C_2ANT_PHASE_WLAN_OFF = 0x2, ++ BT_8821C_2ANT_PHASE_2G_RUNTIME = 0x3, ++ BT_8821C_2ANT_PHASE_5G_RUNTIME = 0x4, ++ BT_8821C_2ANT_PHASE_BTMPMODE = 0x5, ++ BT_8821C_2ANT_PHASE_MAX ++}; ++ ++struct coex_dm_8821c_2ant { ++ /* hw setting */ ++ u32 pre_ant_pos_type; ++ u32 cur_ant_pos_type; ++ /* fw mechanism */ ++ u8 pre_bt_dec_pwr_lvl; ++ u8 cur_bt_dec_pwr_lvl; ++ u8 pre_fw_dac_swing_lvl; ++ u8 cur_fw_dac_swing_lvl; ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean reset_tdma_adjust; ++ boolean auto_tdma_adjust; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ ++ /* sw mechanism */ ++ boolean pre_rf_rx_lpf_shrink; ++ boolean cur_rf_rx_lpf_shrink; ++ u32 bt_rf_0x1e_backup; ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ boolean pre_dac_swing_on; ++ u32 pre_dac_swing_lvl; ++ boolean cur_dac_swing_on; ++ u32 cur_dac_swing_lvl; ++ boolean pre_adc_back_off; ++ boolean cur_adc_back_off; ++ boolean pre_agc_table_en; ++ boolean cur_agc_table_en; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ boolean limited_dig; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ boolean need_recover0x948; ++ u32 backup0x948; ++ ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++ ++ boolean is_switch_to_1dot5_ant; ++ u8 switch_thres_offset; ++ u32 arp_cnt; ++ ++ u32 pre_ext_ant_switch_status; ++ u32 cur_ext_ant_switch_status; ++ ++ u8 pre_ext_band_switch_status; ++ u8 cur_ext_band_switch_status; ++ ++ u8 pre_int_block_status; ++ u8 cur_int_block_status; ++}; ++ ++struct coex_sta_8821c_2ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ u8 bt_rssi; ++ boolean bt_tx_rx_mask; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ boolean c2h_bt_info_req_sent; ++ u8 bt_info_c2h[BT_INFO_SRC_8821C_2ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8821C_2ANT_MAX]; ++ boolean bt_whck_test; ++ boolean c2h_bt_inquiry_page; ++ boolean c2h_bt_remote_name_req; ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++ u32 pop_event_cnt; ++ u8 scan_ap_num; ++ ++ u32 crc_ok_cck; ++ u32 crc_ok_11g; ++ u32 crc_ok_11n; ++ u32 crc_ok_11n_agg; ++ ++ u32 crc_err_cck; ++ u32 crc_err_11g; ++ u32 crc_err_11n; ++ u32 crc_err_11n_agg; ++ ++ ++ boolean cck_lock; ++ boolean pre_ccklock; ++ boolean cck_ever_lock; ++ ++ u8 coex_table_type; ++ boolean force_lps_on; ++ ++ u8 dis_ver_info_cnt; ++ ++ u8 a2dp_bit_pool; ++ u8 cut_version; ++ ++ boolean concurrent_rx_mode_on; ++ ++ u16 score_board; ++ u8 isolation_btween_wb; /* 0~ 50 */ ++ u8 wifi_coex_thres; ++ u8 bt_coex_thres; ++ u8 wifi_coex_thres2; ++ u8 bt_coex_thres2; ++ ++ u8 num_of_profile; ++ boolean acl_busy; ++ boolean wl_rf_off_on_event; ++ boolean bt_create_connection; ++ boolean run_time_state; ++ boolean wifi_is_high_pri_task; ++ u32 specific_pkt_period_cnt; ++ u32 bt_coex_supported_feature; ++ u32 bt_coex_supported_version; ++}; ++ ++#define BT_8821C_2ANT_EXT_ANT_SWITCH_USE_DPDT 0 ++#define BT_8821C_2ANT_EXT_ANT_SWITCH_USE_SPDT 1 ++ ++#define BT_8821C_2ANT_EXT_BAND_SWITCH_USE_DPDT 0 ++#define BT_8821C_2ANT_EXT_BAND_SWITCH_USE_SPDT 1 ++ ++ ++struct rfe_type_8821c_2ant{ ++ ++ u8 rfe_module_type; ++ boolean ext_ant_switch_exist; ++ u8 ext_ant_switch_type; /* 0:DPDT, 1:SPDT */ ++ u8 ext_ant_switch_ctrl_polarity; /* iF 0: DPDT_P=0, DPDT_N=1 => BTG to Main, WL_A+G to Aux */ ++ ++ boolean ext_band_switch_exist; ++ u8 ext_band_switch_type; /* 0:DPDT, 1:SPDT */ ++ u8 ext_band_switch_ctrl_polarity; ++ ++ boolean wlg_Locate_at_btg; /* If true: WLG at BTG, If false: WLG at WLAG */ ++ ++ boolean ext_ant_switch_diversity; /* If diversity on */ ++}; ++ ++#define BT_8821C_2ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ ++#define BT_8821C_2ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ ++#define BT_8821C_2ANT_ANTDET_BUF_LEN 16 ++ ++struct psdscan_sta_8821c_2ant { ++ ++ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ ++ u32 ant_det_bt_tx_time; ++ u32 ant_det_pre_psdscan_peak_val; ++ boolean ant_det_is_ant_det_available; ++ u32 ant_det_psd_scan_peak_val; ++ boolean ant_det_is_btreply_available; ++ u32 ant_det_psd_scan_peak_freq; ++ ++ u8 ant_det_result; ++ u8 ant_det_peak_val[BT_8821C_2ANT_ANTDET_BUF_LEN]; ++ u8 ant_det_peak_freq[BT_8821C_2ANT_ANTDET_BUF_LEN]; ++ u32 ant_det_try_count; ++ u32 ant_det_fail_count; ++ u32 ant_det_inteval_count; ++ u32 ant_det_thres_offset; ++ ++ u32 real_cent_freq; ++ s32 real_offset; ++ u32 real_span; ++ ++ u32 psd_band_width; /* unit: Hz */ ++ u32 psd_point; /* 128/256/512/1024 */ ++ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_start_point; ++ u32 psd_stop_point; ++ u32 psd_max_value_point; ++ u32 psd_max_value; ++ u32 psd_start_base; ++ u32 psd_avg_num; /* 1/8/16/32 */ ++ u32 psd_gen_count; ++ boolean is_psd_running; ++ boolean is_psd_show_max_only; ++}; ++ ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8821c2ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821c2ant_pre_load_firmware(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821c2ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8821c2ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821c2ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c2ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c2ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c2ant_switchband_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c2ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c2ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c2ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8821c2ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8821c2ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821c2ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state); ++void ex_halbtc8821c2ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821c2ant_display_coex_info(IN struct btc_coexist *btcoexist); ++void ex_halbtc8821c2ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++void ex_halbtc8821c2ant_display_ant_detection(IN struct btc_coexist *btcoexist); ++ ++ ++#else ++#define ex_halbtc8821c2ant_power_on_setting(btcoexist) ++#define ex_halbtc8821c2ant_pre_load_firmware(btcoexist) ++#define ex_halbtc8821c2ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8821c2ant_init_coex_dm(btcoexist) ++#define ex_halbtc8821c2ant_ips_notify(btcoexist, type) ++#define ex_halbtc8821c2ant_lps_notify(btcoexist, type) ++#define ex_halbtc8821c2ant_scan_notify(btcoexist, type) ++#define ex_halbtc8821c2ant_switchband_notify(btcoexist,type) ++#define ex_halbtc8821c2ant_connect_notify(btcoexist, type) ++#define ex_halbtc8821c2ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8821c2ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8821c2ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8821c2ant_rf_status_notify(btcoexist, type) ++#define ex_halbtc8821c2ant_halt_notify(btcoexist) ++#define ex_halbtc8821c2ant_pnp_notify(btcoexist, pnp_state) ++#define ex_halbtc8821c2ant_periodical(btcoexist) ++#define ex_halbtc8821c2ant_display_coex_info(btcoexist) ++#define ex_halbtc8821c2ant_display_ant_detection(btcoexist) ++#define ex_halbtc8821c2ant_antenna_detection(btcoexist, centFreq, offset, span, seconds) ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.c 2018-02-11 21:44:27.148146101 +0200 +@@ -0,0 +1,6006 @@ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for RTL8822B Co-exist mechanism ++ * ++ * History ++ * 2012/11/15 Cosa first check in. ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include "Mp_Precomp.h" ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8822B_SUPPORT == 1) ++/* ************************************************************ ++ * Global variables, these are static variables ++ * ************************************************************ */ ++static u8 *trace_buf = &gl_btc_trace_buf[0]; ++static struct coex_dm_8822b_1ant glcoex_dm_8822b_1ant; ++static struct coex_dm_8822b_1ant *coex_dm = &glcoex_dm_8822b_1ant; ++static struct coex_sta_8822b_1ant glcoex_sta_8822b_1ant; ++static struct coex_sta_8822b_1ant *coex_sta = &glcoex_sta_8822b_1ant; ++static struct psdscan_sta_8822b_1ant gl_psd_scan_8822b_1ant; ++static struct psdscan_sta_8822b_1ant *psd_scan = &gl_psd_scan_8822b_1ant; ++static struct rfe_type_8822b_1ant gl_rfe_type_8822b_1ant; ++static struct rfe_type_8822b_1ant *rfe_type = &gl_rfe_type_8822b_1ant; ++ ++ ++ ++const char *const glbt_info_src_8822b_1ant[] = { ++ "BT Info[wifi fw]", ++ "BT Info[bt rsp]", ++ "BT Info[bt auto report]", ++}; ++ ++u32 glcoex_ver_date_8822b_1ant = 20160411; ++u32 glcoex_ver_8822b_1ant = 0x14; ++ ++/* ************************************************************ ++ * local function proto type if needed ++ * ************************************************************ ++ * ************************************************************ ++ * local function start with halbtc8822b1ant_ ++ * ************************************************************ */ ++u8 halbtc8822b1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) ++{ ++ s32 bt_rssi = 0; ++ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; ++ ++ bt_rssi = coex_sta->bt_rssi; ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Rssi thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_bt_rssi_state; ++ } ++ ++ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (bt_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_bt_rssi_state == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (bt_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) ++ bt_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (bt_rssi < rssi_thresh) ++ bt_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (bt_rssi < rssi_thresh1) ++ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_bt_rssi_state = bt_rssi_state; ++ ++ return bt_rssi_state; ++} ++ ++u8 halbtc8822b1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, ++ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) ++{ ++ s32 wifi_rssi = 0; ++ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ ++ if (level_num == 2) { ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else { ++ if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } else if (level_num == 3) { ++ if (rssi_thresh > rssi_thresh1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi RSSI thresh error!!\n"); ++ BTC_TRACE(trace_buf); ++ return coex_sta->pre_wifi_rssi_state[index]; ++ } ++ ++ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) ++ || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_LOW)) { ++ if (wifi_rssi >= (rssi_thresh + ++ BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; ++ } else if ((coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_MEDIUM) || ++ (coex_sta->pre_wifi_rssi_state[index] == ++ BTC_RSSI_STATE_STAY_MEDIUM)) { ++ if (wifi_rssi >= (rssi_thresh1 + ++ BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) ++ wifi_rssi_state = BTC_RSSI_STATE_HIGH; ++ else if (wifi_rssi < rssi_thresh) ++ wifi_rssi_state = BTC_RSSI_STATE_LOW; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; ++ } else { ++ if (wifi_rssi < rssi_thresh1) ++ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; ++ else ++ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; ++ } ++ } ++ ++ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; ++ ++ return wifi_rssi_state; ++} ++ ++void halbtc8822b1ant_update_ra_mask(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 dis_rate_mask) ++{ ++ coex_dm->cur_ra_mask = dis_rate_mask; ++ ++ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, ++ &coex_dm->cur_ra_mask); ++ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; ++} ++ ++void halbtc8822b1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ ++ coex_dm->cur_arfr_type = type; ++ ++ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { ++ switch (coex_dm->cur_arfr_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_4byte(btcoexist, 0x430, ++ coex_dm->backup_arfr_cnt1); ++ btcoexist->btc_write_4byte(btcoexist, 0x434, ++ coex_dm->backup_arfr_cnt2); ++ break; ++ case 1: ++ btcoexist->btc_get(btcoexist, ++ BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ if (wifi_under_b_mode) { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x01010101); ++ } else { ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x430, 0x0); ++ btcoexist->btc_write_4byte(btcoexist, ++ 0x434, 0x04030201); ++ } ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; ++} ++ ++void halbtc8822b1ant_retry_limit(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_retry_limit_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_retry_limit_type != ++ coex_dm->cur_retry_limit_type)) { ++ switch (coex_dm->cur_retry_limit_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ coex_dm->backup_retry_limit); ++ break; ++ case 1: /* retry limit=8 */ ++ btcoexist->btc_write_2byte(btcoexist, 0x42a, ++ 0x0808); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; ++} ++ ++void halbtc8822b1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ coex_dm->cur_ampdu_time_type = type; ++ ++ if (force_exec || ++ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { ++ switch (coex_dm->cur_ampdu_time_type) { ++ case 0: /* normal mode */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ coex_dm->backup_ampdu_max_time); ++ break; ++ case 1: /* AMPDU timw = 0x38 * 32us */ ++ btcoexist->btc_write_1byte(btcoexist, 0x456, ++ 0x38); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; ++} ++ ++void halbtc8822b1ant_limited_tx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, ++ IN u8 retry_limit_type, IN u8 ampdu_time_type) ++{ ++ switch (ra_mask_type) { ++ case 0: /* normal mode */ ++ halbtc8822b1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0); ++ break; ++ case 1: /* disable cck 1/2 */ ++ halbtc8822b1ant_update_ra_mask(btcoexist, force_exec, ++ 0x00000003); ++ break; ++ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ ++ halbtc8822b1ant_update_ra_mask(btcoexist, force_exec, ++ 0x0001f1f7); ++ break; ++ default: ++ break; ++ } ++ ++ halbtc8822b1ant_auto_rate_fallback_retry(btcoexist, force_exec, ++ arfr_type); ++ halbtc8822b1ant_retry_limit(btcoexist, force_exec, retry_limit_type); ++ halbtc8822b1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); ++} ++ ++/* ++1: true / don't care / don't care ++max: false / false / don't care ++7: false / true / 7 ++*/ ++ ++void halbtc8822b1ant_limited_rx(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean rej_ap_agg_pkt, ++ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) ++{ ++ boolean reject_rx_agg = rej_ap_agg_pkt; ++ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; ++ u8 rx_agg_size = agg_buf_size; ++ ++ /* ============================================ */ ++ /* Rx Aggregation related setting */ ++ /* ============================================ */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ &reject_rx_agg); ++ /* decide BT control aggregation buf size or not */ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ &bt_ctrl_rx_agg_size); ++ /* aggregation buf size, only work when BT control Rx aggregation size. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); ++ /* real update aggregation setting */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); ++ ++ ++} ++ ++void halbtc8822b1ant_query_bt_info(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ coex_sta->c2h_bt_info_req_sent = true; ++ ++ h2c_parameter[0] |= BIT(0); /* trigger */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); ++} ++ ++void halbtc8822b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) ++{ ++ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; ++ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; ++ static u8 num_of_bt_counter_chk = 0, cnt_slave = 0; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ ++ /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ ++ ++ if (coex_sta->under_ips) { ++ /* coex_sta->high_priority_tx = 65535; */ ++ /* coex_sta->high_priority_rx = 65535; */ ++ /* coex_sta->low_priority_tx = 65535; */ ++ /* coex_sta->low_priority_rx = 65535; */ ++ /* return; */ ++ } ++ ++ reg_hp_txrx = 0x770; ++ reg_lp_txrx = 0x774; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); ++ reg_hp_tx = u32tmp & MASKLWORD; ++ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); ++ reg_lp_tx = u32tmp & MASKLWORD; ++ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; ++ ++ coex_sta->high_priority_tx = reg_hp_tx; ++ coex_sta->high_priority_rx = reg_hp_rx; ++ coex_sta->low_priority_tx = reg_lp_tx; ++ coex_sta->low_priority_rx = reg_lp_rx; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", ++ reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); ++ BTC_TRACE(trace_buf); ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); ++ ++ if ((coex_sta->low_priority_tx > 1150) && ++ (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->pop_event_cnt++; ++ ++ if ((coex_sta->low_priority_rx >= 1150) && (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) ++ && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist) ) { ++ if (cnt_slave >= 3) { ++ bt_link_info->slave_role = true; ++ cnt_slave = 3; ++ } else { ++ cnt_slave ++; ++ } ++ } else { ++ if(cnt_slave == 0) { ++ bt_link_info->slave_role = false; ++ cnt_slave = 0; ++ } else{ ++ cnt_slave--; ++ } ++ ++ } ++ ++ if ((coex_sta->high_priority_tx == 0) && (coex_sta->high_priority_rx == 0) && (coex_sta->low_priority_tx == 0) && ++ (coex_sta->low_priority_rx == 0)) { ++ num_of_bt_counter_chk++; ++ ++ if (num_of_bt_counter_chk >= 3) { ++ halbtc8822b1ant_query_bt_info(btcoexist); ++ num_of_bt_counter_chk = 0; ++ } ++ } ++#if 0 ++ /* Add Hi-Pri Tx/Rx counter to avoid false detection */ ++ if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) && ++ (coex_sta->high_priority_tx + coex_sta->high_priority_rx ++ >= 160) ++ && (!coex_sta->c2h_bt_inquiry_page)) ++ coex_sta->bt_hi_pri_link_exist = true; ++ else ++ coex_sta->bt_hi_pri_link_exist = false; ++ ++ if ((coex_sta->acl_busy) && ++ (coex_sta->num_of_profile == 0)) { ++ if (coex_sta->low_priority_tx + ++ coex_sta->low_priority_rx >= 160) { ++ coex_sta->pan_exist = true; ++ coex_sta->num_of_profile++; ++ coex_sta->wrong_profile_notification++; ++ } ++ } ++#endif ++ ++} ++ ++ ++void halbtc8822b1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) ++ { ++ s32 wifi_rssi = 0; ++ boolean wifi_busy = false, wifi_under_b_mode = false; ++ static u8 cck_lock_counter = 0; ++ u32 total_cnt; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE,&wifi_under_b_mode); ++ ++ if (coex_sta->under_ips) { ++ coex_sta->crc_ok_cck = 0; ++ coex_sta->crc_ok_11g = 0; ++ coex_sta->crc_ok_11n = 0; ++ coex_sta->crc_ok_11n_agg = 0; ++ ++ coex_sta->crc_err_cck = 0; ++ coex_sta->crc_err_11g = 0; ++ coex_sta->crc_err_11n = 0; ++ coex_sta->crc_err_11n_agg = 0; ++ } else { ++ coex_sta->crc_ok_cck = btcoexist->btc_read_2byte(btcoexist, ++ 0xf04); ++ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf14); ++ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf10); ++ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xf0c); ++ ++ coex_sta->crc_err_cck = btcoexist->btc_read_2byte(btcoexist,0xf00) + btcoexist->btc_read_2byte(btcoexist,0xf06); ++ ++ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, ++ 0xf16); ++ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, ++ 0xf12); ++ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, ++ 0xf0e); ++ } ++ ++ ++ /* reset counter */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x0); ++ ++ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { ++ total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + ++ coex_sta->crc_ok_11n + ++ coex_sta->crc_ok_11n_agg; ++ ++ if ((coex_dm->bt_status == BT_8822B_1ANT_BT_STATUS_ACL_BUSY) || ++ (coex_dm->bt_status == ++ BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY) || ++ (coex_dm->bt_status == ++ BT_8822B_1ANT_BT_STATUS_SCO_BUSY)) { ++ if (coex_sta->crc_ok_cck > (total_cnt - ++ coex_sta->crc_ok_cck)) { ++ if (cck_lock_counter < 3) ++ cck_lock_counter++; ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ } else { ++ if (cck_lock_counter > 0) ++ cck_lock_counter--; ++ } ++ ++ if (!coex_sta->pre_ccklock) { ++ ++ if (cck_lock_counter >= 3) ++ coex_sta->cck_lock = true; ++ else ++ coex_sta->cck_lock = false; ++ } else { ++ if (cck_lock_counter == 0) ++ coex_sta->cck_lock = false; ++ else ++ coex_sta->cck_lock = true; ++ } ++ ++ if (coex_sta->cck_lock) ++ coex_sta->cck_ever_lock = true; ++ ++ coex_sta->pre_ccklock = coex_sta->cck_lock; ++ ++ ++ } ++ ++ ++boolean halbtc8822b1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) ++{ ++ static boolean pre_wifi_busy = false, pre_under_4way = false, ++ pre_bt_hs_on = false, pre_bt_off = false; ++ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; ++ boolean wifi_connected = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ if (coex_sta->bt_disabled != pre_bt_off) ++ { ++ pre_bt_off = coex_sta->bt_disabled; ++ ++ if (coex_sta->bt_disabled) ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!\n"); ++ else ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is enabled !!\n"); ++ ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->bt_coex_supported_feature = 0; ++ coex_sta->bt_coex_supported_version = 0; ++ return true; ++ } ++ ++ if (wifi_connected) { ++ if (wifi_busy != pre_wifi_busy) { ++ pre_wifi_busy = wifi_busy; ++ return true; ++ } ++ if (under_4way != pre_under_4way) { ++ pre_under_4way = under_4way; ++ return true; ++ } ++ if (bt_hs_on != pre_bt_hs_on) { ++ pre_bt_hs_on = bt_hs_on; ++ return true; ++ } ++ } ++ ++ return false; ++} ++ ++void halbtc8822b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; ++ bt_link_info->sco_exist = coex_sta->sco_exist; ++ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; ++ bt_link_info->pan_exist = coex_sta->pan_exist; ++ bt_link_info->hid_exist = coex_sta->hid_exist; ++ bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist; ++ bt_link_info->acl_busy = coex_sta->acl_busy; ++ ++ /* work around for HS mode. */ ++ if (bt_hs_on) { ++ bt_link_info->pan_exist = true; ++ bt_link_info->bt_link_exist = true; ++ } ++ ++ /* check if Sco only */ ++ if (bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->sco_only = true; ++ else ++ bt_link_info->sco_only = false; ++ ++ /* check if A2dp only */ ++ if (!bt_link_info->sco_exist && ++ bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->a2dp_only = true; ++ else ++ bt_link_info->a2dp_only = false; ++ ++ /* check if Pan only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist && ++ !bt_link_info->hid_exist) ++ bt_link_info->pan_only = true; ++ else ++ bt_link_info->pan_only = false; ++ ++ /* check if Hid only */ ++ if (!bt_link_info->sco_exist && ++ !bt_link_info->a2dp_exist && ++ !bt_link_info->pan_exist && ++ bt_link_info->hid_exist) ++ bt_link_info->hid_only = true; ++ else ++ bt_link_info->hid_only = false; ++} ++ ++void halbtc8822b1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_parameter[3] = {0}; ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ ++ /* only 2.4G we need to inform bt the chnl mask */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ if ((BTC_MEDIA_CONNECT == type) && ++ (wifi_central_chnl <= 14)) { ++ ++ h2c_parameter[0] = 0x1; /* enable BT AFH skip WL channel for 8822b because BT Rx LO interference */ ++ h2c_parameter[1] = wifi_central_chnl; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ h2c_parameter[2] = 0x30; ++ else ++ h2c_parameter[2] = 0x20; ++ } ++ ++ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; ++ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; ++ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); ++ ++} ++ ++u8 halbtc8822b1ant_action_algorithm(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean bt_hs_on = false; ++ u8 algorithm = BT_8822B_1ANT_COEX_ALGO_UNDEFINED; ++ u8 num_of_diff_profile = 0; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ ++ if (!bt_link_info->bt_link_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], No BT link exists!!!\n"); ++ BTC_TRACE(trace_buf); ++ return algorithm; ++ } ++ ++ if (bt_link_info->sco_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->hid_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->pan_exist) ++ num_of_diff_profile++; ++ if (bt_link_info->a2dp_exist) ++ num_of_diff_profile++; ++ ++ if (num_of_diff_profile == 1) { ++ if (bt_link_info->sco_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; ++ } else { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8822B_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8822B_1ANT_COEX_ALGO_A2DP; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(HS) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8822B_1ANT_COEX_ALGO_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = PAN(EDR) only\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8822B_1ANT_COEX_ALGO_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 2) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8822B_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; ++ } else if (bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8822B_1ANT_COEX_ALGO_HID_A2DP; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8822B_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8822B_1ANT_COEX_ALGO_A2DP_PANHS; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8822B_1ANT_COEX_ALGO_PANEDR_A2DP; ++ } ++ } ++ } ++ } else if (num_of_diff_profile == 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8822B_1ANT_COEX_ALGO_HID; ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8822B_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } else if (bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } else { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8822B_1ANT_COEX_ALGO_HID_A2DP; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8822B_1ANT_COEX_ALGO_HID_A2DP_PANEDR; ++ } ++ } ++ } ++ } else if (num_of_diff_profile >= 3) { ++ if (bt_link_info->sco_exist) { ++ if (bt_link_info->hid_exist && ++ bt_link_info->pan_exist && ++ bt_link_info->a2dp_exist) { ++ if (bt_hs_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); ++ BTC_TRACE(trace_buf); ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = ++ BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; ++ } ++ } ++ } ++ } ++ ++ return algorithm; ++} ++ ++void halbtc8822b1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean enable_auto_report) ++{ ++ u8 h2c_parameter[1] = {0}; ++ ++ h2c_parameter[0] = 0; ++ ++ if (enable_auto_report) ++ h2c_parameter[0] |= BIT(0); ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); ++} ++ ++void halbtc8822b1ant_bt_auto_report(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable_auto_report) ++{ ++ coex_dm->cur_bt_auto_report = enable_auto_report; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) ++ return; ++ } ++ halbtc8822b1ant_set_bt_auto_report(btcoexist, ++ coex_dm->cur_bt_auto_report); ++ ++ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; ++} ++ ++void halbtc8822b1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist ++ *btcoexist, IN boolean low_penalty_ra) ++{ ++ u8 h2c_parameter[6] = {0}; ++ ++ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ ++ ++ if (low_penalty_ra) { ++ h2c_parameter[1] |= BIT(0); ++ h2c_parameter[2] = ++ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ ++ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ ++ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ ++ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); ++} ++ ++void halbtc8822b1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean low_penalty_ra) ++{ ++ coex_dm->cur_low_penalty_ra = low_penalty_ra; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) ++ return; ++ } ++ halbtc8822b1ant_set_sw_penalty_tx_rate_adaptive(btcoexist, ++ coex_dm->cur_low_penalty_ra); ++ ++ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; ++} ++ ++void halbtc8822b1ant_write_score_board( ++ IN struct btc_coexist *btcoexist, ++ IN u16 bitpos, ++ IN BOOLEAN state ++) ++{ ++ ++ static u16 originalval = 0x8002; ++ ++ if (state) ++ originalval = originalval | bitpos; ++ else ++ originalval = originalval & (~bitpos); ++ ++ btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); ++} ++ ++void halbtc8822b1ant_read_score_board( ++ IN struct btc_coexist *btcoexist, ++ IN u16 *score_board_val ++) ++{ ++ ++ *score_board_val = (btcoexist->btc_read_2byte(btcoexist, ++ 0xaa)) & 0x7fff; ++} ++ ++void halbtc8822b1ant_post_activestate_to_bt( ++ IN struct btc_coexist *btcoexist, ++ IN boolean wifi_active ++) ++{ ++ ++ if (wifi_active) ++ halbtc8822b1ant_write_score_board(btcoexist, (u16) BIT(0), TRUE); ++ else ++ halbtc8822b1ant_write_score_board(btcoexist, (u16) BIT(0), FALSE); ++} ++ ++ ++void halbtc8822b1ant_post_onoffstate_to_bt( ++ IN struct btc_coexist *btcoexist, ++ IN boolean wifi_on ++) ++{ ++ ++ if (wifi_on) ++ halbtc8822b1ant_write_score_board(btcoexist, (u16) BIT(1), TRUE); ++ else ++ halbtc8822b1ant_write_score_board(btcoexist, (u16) BIT(1), FALSE); ++} ++ ++ ++void halbtc8822b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) ++{ ++ static u32 bt_disable_cnt = 0; ++ boolean bt_active = true, bt_disabled = false; ++ u16 u16tmp; ++ ++ /* This function check if bt is disabled */ ++#if 1 ++ if (coex_sta->high_priority_tx == 0 && ++ coex_sta->high_priority_rx == 0 && ++ coex_sta->low_priority_tx == 0 && ++ coex_sta->low_priority_rx == 0) ++ bt_active = false; ++ if (coex_sta->high_priority_tx == 0xffff && ++ coex_sta->high_priority_rx == 0xffff && ++ coex_sta->low_priority_tx == 0xffff && ++ coex_sta->low_priority_rx == 0xffff) ++ bt_active = false; ++ ++ ++#else ++ ++ /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */ ++ halbtc8822b1ant_read_score_board(btcoexist, &u16tmp); ++ ++ bt_active = u16tmp & BIT(1); ++ ++ ++#endif ++ ++ if (bt_active) { ++ bt_disable_cnt = 0; ++ bt_disabled = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ } else { ++ ++ bt_disable_cnt++; ++ if (bt_disable_cnt >= 2) { ++ bt_disabled = true; ++ bt_disable_cnt = 2; ++ } ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, ++ &bt_disabled); ++ } ++ ++ ++ if (coex_sta->bt_disabled != bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is from %s to %s!!\n", ++ (coex_sta->bt_disabled ? "disabled" : "enabled"), ++ (bt_disabled ? "disabled" : "enabled")); ++ BTC_TRACE(trace_buf); ++ coex_sta->bt_disabled = bt_disabled; ++ } ++ ++} ++ ++ ++ ++void halbtc8822b1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, ++ boolean isenable) ++{ ++ static u8 bitVal[5] = {0,0,0,0,0}; ++ static boolean state = false; ++ ++ if (state ==isenable) ++ return; ++ else ++ state = isenable; ++ ++ if (isenable) { ++ ++ /* enable GNT_WL, GNT_BT to GPIO for debug */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); ++ ++ /* store original value */ ++ bitVal[0] = (btcoexist->btc_read_1byte(btcoexist, 0x66) & BIT(4)) >>4; /*0x66[4] */ ++ bitVal[1] = (btcoexist->btc_read_1byte(btcoexist, 0x67) & BIT(0)); /*0x66[8] */ ++ bitVal[2] = (btcoexist->btc_read_1byte(btcoexist, 0x42) & BIT(3)) >> 3; /*0x40[19] */ ++ bitVal[3] = (btcoexist->btc_read_1byte(btcoexist, 0x65) & BIT(7)) >> 7; /*0x64[15] */ ++ bitVal[4] = (btcoexist->btc_read_1byte(btcoexist, 0x72) & BIT(2)) >> 2; /*0x70[18] */ ++ ++ /* switch GPIO Mux */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), 0x0); /*0x66[4] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), 0x0); /*0x66[8] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), 0x0); /*0x40[19] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), 0x0); /*0x64[15] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), 0x0); /*0x70[18] = 0 */ ++ ++ ++ } else { ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); ++ ++ /* Restore original value */ ++ /* switch GPIO Mux */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), bitVal[0]); /*0x66[4] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), bitVal[1]); /*0x66[8] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), bitVal[2]); /*0x40[19] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), bitVal[3]); /*0x64[15] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), bitVal[4]); /*0x70[18] = 0 */ ++ } ++ ++} ++ ++ ++u32 halbtc8822b1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, ++ IN u16 reg_addr) ++{ ++ u32 j = 0; ++ ++ ++ /* wait for ready bit before access 0x1700 */ ++ btcoexist->btc_write_4byte(btcoexist, 0x1700, 0x800F0000 | reg_addr); ++ ++ do { ++ j++; ++ } while (((btcoexist->btc_read_1byte(btcoexist, ++ 0x1703) & BIT(5)) == 0) && ++ (j < BT_8822B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); ++ ++ ++ return btcoexist->btc_read_4byte(btcoexist, ++ 0x1708); /* get read data */ ++ ++} ++ ++void halbtc8822b1ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist, ++ IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) ++{ ++ u32 val, i = 0, j = 0, bitpos = 0; ++ ++ ++ if (bit_mask == 0x0) ++ return; ++ if (bit_mask == 0xffffffff) { ++ btcoexist->btc_write_4byte(btcoexist, 0x1704, ++ reg_value); /* put write data */ ++ ++ /* wait for ready bit before access 0x1700 */ ++ do { ++ j++; ++ } while (((btcoexist->btc_read_1byte(btcoexist, ++ 0x1703) & BIT(5)) == 0) && ++ (j < BT_8822B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); ++ ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x1700, ++ 0xc00F0000 | reg_addr); ++ } else { ++ for (i = 0; i <= 31; i++) { ++ if (((bit_mask >> i) & 0x1) == 0x1) { ++ bitpos = i; ++ break; ++ } ++ } ++ ++ /* read back register value before write */ ++ val = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ reg_addr); ++ val = (val & (~bit_mask)) | (reg_value << bitpos); ++ ++ /* put write data value */ ++ btcoexist->btc_write_4byte(btcoexist, 0x1704, ++ val); /* put write data */ ++ ++ /* wait for ready bit before access 0x1700 */ ++ do { ++ j++; ++ } while (((btcoexist->btc_read_1byte(btcoexist, ++ 0x1703) & BIT(5)) == 0) && ++ (j < BT_8822B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); ++ ++ /* write data add*/ ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x1700, ++ 0xc00F0000 | reg_addr); ++ ++ } ++ ++} ++ ++void halbtc8822b1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ u8 val; ++ ++ val = (enable) ? 1 : 0; ++ /* 0x38[7] */ ++ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, ++ val); /* 0x38[7] */ ++ ++} ++ ++ ++void halbtc8822b1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_control) ++{ ++ u8 val; ++ ++ val = (wifi_control) ? 1 : 0; ++ /* 0x70[26] */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, ++ val); /* 0x70[26] */ ++ ++} ++ ++void halbtc8822b1ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, ++ IN u8 control_block, IN boolean sw_control, IN u8 state) ++{ ++ u32 val = 0, bit_mask; ++ ++ state = state & 0x1; ++ /*LTE indirect 0x38=0xccxx (sw : gnt_wl=1,sw gnt_bt=1) ++ 0x38=0xddxx (sw : gnt_bt=1 , sw gnt_wl=0) ++ 0x38=0x55xx(hw pta :gnt_wl /gnt_bt ) */ ++ val = (sw_control) ? ((state << 1) | 0x1) : 0; ++ ++ switch (control_block) { ++ case BT_8822B_1ANT_GNT_BLOCK_RFC_BB: ++ default: ++ bit_mask = 0xc000; ++ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[15:14] */ ++ bit_mask = 0x0c00; ++ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[11:10] */ ++ break; ++ case BT_8822B_1ANT_GNT_BLOCK_RFC: ++ bit_mask = 0xc000; ++ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[15:14] */ ++ break; ++ case BT_8822B_1ANT_GNT_BLOCK_BB: ++ bit_mask = 0x0c00; ++ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[11:10] */ ++ break; ++ ++ } ++ ++} ++ ++void halbtc8822b1ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, ++ IN u8 control_block, IN boolean sw_control, IN u8 state) ++{ ++ u32 val = 0, bit_mask; ++ /*LTE indirect 0x38=0xccxx (sw : gnt_wl=1,sw gnt_bt=1) ++ 0x38=0xddxx (sw : gnt_bt=1 , sw gnt_wl=0) ++ 0x38=0x55xx(hw pta :gnt_wl /gnt_bt ) */ ++ ++ state = state & 0x1; ++ val = (sw_control) ? ((state << 1) | 0x1) : 0; ++ ++ switch (control_block) { ++ case BT_8822B_1ANT_GNT_BLOCK_RFC_BB: ++ default: ++ bit_mask = 0x3000; ++ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[13:12] */ ++ bit_mask = 0x0300; ++ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[9:8] */ ++ break; ++ case BT_8822B_1ANT_GNT_BLOCK_RFC: ++ bit_mask = 0x3000; ++ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[13:12] */ ++ break; ++ case BT_8822B_1ANT_GNT_BLOCK_BB: ++ bit_mask = 0x0300; ++ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, ++ 0x38, bit_mask, val); /* 0x38[9:8] */ ++ break; ++ ++ } ++ ++} ++ ++void halbtc8822b1ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u8 table_type, IN u16 table_content) ++{ ++ u16 reg_addr = 0x0000; ++ ++ switch (table_type) { ++ case BT_8822B_1ANT_CTT_WL_VS_LTE: ++ reg_addr = 0xa0; ++ break; ++ case BT_8822B_1ANT_CTT_BT_VS_LTE: ++ reg_addr = 0xa4; ++ break; ++ } ++ ++ if (reg_addr != 0x0000) ++ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, ++ 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ ++ ++ ++} ++ ++ ++void halbtc8822b1ant_ltcoex_set_break_table(IN struct btc_coexist *btcoexist, ++ IN u8 table_type, IN u8 table_content) ++{ ++ u16 reg_addr = 0x0000; ++ ++ switch (table_type) { ++ case BT_8822B_1ANT_LBTT_WL_BREAK_LTE: ++ reg_addr = 0xa8; ++ break; ++ case BT_8822B_1ANT_LBTT_BT_BREAK_LTE: ++ reg_addr = 0xac; ++ break; ++ case BT_8822B_1ANT_LBTT_LTE_BREAK_WL: ++ reg_addr = 0xb0; ++ break; ++ case BT_8822B_1ANT_LBTT_LTE_BREAK_BT: ++ reg_addr = 0xb4; ++ break; ++ } ++ ++ if (reg_addr != 0x0000) ++ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, ++ 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ ++ ++ ++} ++ ++void halbtc8822b1ant_set_coex_table(IN struct btc_coexist *btcoexist, ++ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); ++} ++ ++void halbtc8822b1ant_coex_table(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, ++ IN u32 val0x6c8, IN u8 val0x6cc) ++{ ++ coex_dm->cur_val0x6c0 = val0x6c0; ++ coex_dm->cur_val0x6c4 = val0x6c4; ++ coex_dm->cur_val0x6c8 = val0x6c8; ++ coex_dm->cur_val0x6cc = val0x6cc; ++ ++ ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && ++ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && ++ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && ++ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) ++ return; ++ } ++ halbtc8822b1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, ++ val0x6cc); ++ ++ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; ++ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; ++ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; ++ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; ++} ++ ++void halbtc8822b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 type) ++{ ++ u32 break_table; ++ u8 select_table; ++ ++ ++ ++ coex_sta->coex_table_type = type; ++ ++ if (coex_sta->concurrent_rx_mode_on == true) { ++ ++ break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ ++ select_table = ++ 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ ++ } else { ++ ++ break_table = 0xffffff; ++ select_table = 0x3; ++ } ++ ++ switch (type) { ++ case 0: ++ halbtc8822b1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x55555555, break_table, ++ select_table); ++ break; ++ case 1: ++ halbtc8822b1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0x5a5a5a5a, break_table, ++ select_table); ++ break; ++ case 2: ++ halbtc8822b1ant_coex_table(btcoexist, force_exec, ++ 0xaa5a5a5a, 0xaa5a5a5a, break_table, ++ select_table); ++ break; ++ case 3: ++ halbtc8822b1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0xaa5a5a5a, break_table, ++ select_table); ++ break; ++ case 4: ++ halbtc8822b1ant_coex_table(btcoexist, ++ force_exec, 0xaa555555, 0xaa5a5a5a, ++ break_table, select_table); ++ break; ++ case 5: ++ halbtc8822b1ant_coex_table(btcoexist, ++ force_exec, 0x5a5a5a5a, 0x5a5a5a5a, ++ break_table, select_table); ++ break; ++ case 6: ++ halbtc8822b1ant_coex_table(btcoexist, force_exec, ++ 0x55555555, 0xaaaaaaaa, break_table, ++ select_table); ++ break; ++ case 7: ++ halbtc8822b1ant_coex_table(btcoexist, force_exec, ++ 0xaaaaaaaa, 0xaaaaaaaa, break_table, ++ select_table); ++ break; ++ case 8: ++ halbtc8822b1ant_coex_table(btcoexist, force_exec, ++ 0xffffffff, 0xffffffff, break_table, ++ select_table); ++ break; ++ ++ default: ++ break; ++ } ++} ++ ++void halbtc8822b1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean enable) ++{ ++ ++ ++ u8 h2c_parameter[1] = {0}; ++ ++ if (enable) { ++ h2c_parameter[0] |= BIT(0); /* function enable */ ++ } ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); ++} ++ ++void halbtc8822b1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean enable) ++{ ++ ++ coex_dm->cur_ignore_wlan_act = enable; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ignore_wlan_act == ++ coex_dm->cur_ignore_wlan_act) ++ { ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++ return; ++ } ++ } ++ ++ halbtc8822b1ant_set_fw_ignore_wlan_act(btcoexist, enable); ++ ++ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; ++} ++ ++void halbtc8822b1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN u8 lps_val, IN u8 rpwm_val) ++{ ++ u8 lps = lps_val; ++ u8 rpwm = rpwm_val; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); ++ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); ++} ++ ++void halbtc8822b1ant_lps_rpwm(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ coex_dm->cur_lps = lps_val; ++ coex_dm->cur_rpwm = rpwm_val; ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_lps == coex_dm->cur_lps) && ++ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) ++ return; ++ } ++ halbtc8822b1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); ++ ++ coex_dm->pre_lps = coex_dm->cur_lps; ++ coex_dm->pre_rpwm = coex_dm->cur_rpwm; ++} ++ ++void halbtc8822b1ant_ps_tdma_check_for_power_save_state( ++ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) ++{ ++ u8 lps_mode = 0x0; ++ u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); ++ ++ if (lps_mode) { /* already under LPS state */ ++ if (new_ps_state) { ++ /* keep state under LPS, do nothing. */ ++ } else { ++ /* will leave LPS state, turn off psTdma first */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++ } ++ } else { /* NO PS state */ ++ if (new_ps_state) { ++ /* will enter LPS state, turn off psTdma first */ ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++ } else { ++ /* keep state under NO PS state, do nothing. */ ++ } ++ } ++} ++ ++ ++void halbtc8822b1ant_power_save_state(IN struct btc_coexist *btcoexist, ++ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) ++{ ++ boolean low_pwr_disable = false; ++ ++ switch (ps_type) { ++ case BTC_PS_WIFI_NATIVE: ++ /* recover to original 32k low power setting */ ++ coex_sta->force_lps_on = false; ++ low_pwr_disable = false; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ case BTC_PS_LPS_ON: ++ ++ coex_sta->force_lps_on = true; ++ halbtc8822b1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, true); ++ halbtc8822b1ant_lps_rpwm(btcoexist, NORMAL_EXEC, ++ lps_val, rpwm_val); ++ /* when coex force to enter LPS, do not enter 32k low power. */ ++ low_pwr_disable = true; ++ btcoexist->btc_set(btcoexist, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ &low_pwr_disable); ++ /* power save must executed before psTdma. */ ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, ++ NULL); ++ coex_sta->force_lps_on = true; ++ break; ++ case BTC_PS_LPS_OFF: ++ ++ coex_sta->force_lps_on = false; ++ halbtc8822b1ant_ps_tdma_check_for_power_save_state( ++ btcoexist, false); ++ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, ++ NULL); ++ coex_sta->force_lps_on = false; ++ break; ++ default: ++ break; ++ } ++} ++ ++ ++void halbtc8822b1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, ++ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) ++{ ++ u8 h2c_parameter[5] = {0}; ++ u8 real_byte1 = byte1, real_byte5 = byte5; ++ boolean ap_enable = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ ++ if (ap_enable) { ++ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], FW for 1Ant AP mode\n"); ++ BTC_TRACE(trace_buf); ++ ++ real_byte1 &= ~BIT(4); ++ real_byte1 |= BIT(5); ++ ++ real_byte5 |= BIT(5); ++ real_byte5 &= ~BIT(6); ++ ++ halbtc8822b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ } ++ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { ++ ++ halbtc8822b1ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, ++ 0x4); ++ } else { ++ halbtc8822b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, ++ 0x0); ++ } ++ ++ ++ h2c_parameter[0] = real_byte1; ++ h2c_parameter[1] = byte2; ++ h2c_parameter[2] = byte3; ++ h2c_parameter[3] = byte4; ++ h2c_parameter[4] = real_byte5; ++ ++ coex_dm->ps_tdma_para[0] = real_byte1; ++ coex_dm->ps_tdma_para[1] = byte2; ++ coex_dm->ps_tdma_para[2] = byte3; ++ coex_dm->ps_tdma_para[3] = byte4; ++ coex_dm->ps_tdma_para[4] = real_byte5; ++ ++ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); ++} ++ ++void halbtc8822b1ant_ps_tdma(IN struct btc_coexist *btcoexist, ++ IN boolean force_exec, IN boolean turn_on, IN u8 type) ++{ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_busy = false; ++ static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; ++ static boolean pre_wifi_busy = false; ++ ++ coex_dm->cur_ps_tdma_on = turn_on; ++ coex_dm->cur_ps_tdma = type; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (wifi_busy != pre_wifi_busy) { ++ force_exec = true; ++ pre_wifi_busy = wifi_busy; ++ } ++ ++ /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ ++ if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) ++ psTdmaByte4Modify = 0x1; ++ else ++ psTdmaByte4Modify = 0x0; ++ ++ if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { ++ ++ force_exec = true; ++ pre_psTdmaByte4Modify = psTdmaByte4Modify; ++ } ++ ++ if (coex_dm->cur_ps_tdma_on) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********TDMA(on, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], **********TDMA(off, %d) **********\n", ++ coex_dm->cur_ps_tdma); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if (!force_exec) { ++ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && ++ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) ++ { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], return for no-TDMA case change\n"); ++ BTC_TRACE(trace_buf); ++ ++ return; ++ } ++ } ++ ++ ++ if (turn_on) { ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, ++ 0x1); /* enable TBTT nterrupt */ ++ ++ switch (type) { ++ default: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x51,0x1a, 0x1a, 0x0, 0x10); ++ break; ++ case 1: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x3a,0x03,0x11, 0x10); ++ break; ++ case 3: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x3a, 0x03, 0x10, 0x10); ++ break; ++ case 4: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x21, 0x03, 0x10, 0x10); ++ break; ++ case 5: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x15, 0x3,0x11, 0x11); ++ break; ++ case 7: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); ++ break; ++ case 8: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); ++ break; ++ case 13: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x25, 0x03, 0x10, 0x10 | psTdmaByte4Modify); ++ break; ++ case 14: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x15, 0x03, 0x10, 0x10 | psTdmaByte4Modify); ++ break; ++ case 15: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x51, 0x20, 0x03, 0x10, 0x10 | psTdmaByte4Modify); ++ break; ++ case 17: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x10, 0x03, 0x11, 0x14 | psTdmaByte4Modify); ++ break;; ++ ++ case 20: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x30, 0x03,0x11, 0x10); ++ break; ++ case 22: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x25, 0x03,0x11, 0x10); ++ break; ++ case 32: ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x61, 0x35, 0x3,0x11, 0x11); ++ break; ++ case 41:/*HID*/ ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x51,0x45, 0x3, 0x11, 0x11); ++ break; ++ case 42:/*A2DP*/ ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x51,0x1e, 0x3, 0x10, 0x14| psTdmaByte4Modify); ++ break; ++ case 43:/*A2DP+HID*/ ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x51,0x45, 0x3, 0x10, 0x14); ++ break; ++ case 44:/*A2DP+OPP old */ ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x51,0x25, 0x3, 0x10, 0x10); ++ break; ++ case 45:/*OPP new -> WIFI FW check the ncuu_p ack of AP , if has no null_p ack , wifi fw will extened wifi slot */ ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x51,0x3a, 0x3, 0x10, 0x10); ++ break; ++ case 46:/*A2DP+OPP new-> WIFI FW check the ncuu_p ack of AP , if has no null_p ack , wifi fw will extened wifi slot*/ ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x51,0x1a, 0x3, 0x10, 0x10); ++ break; ++ ++ } ++ } else { ++ ++ switch (type) { ++ case 0: ++ default: /* Software control, Antenna at BT side */ ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x0,0x0, 0x0, 0x0, 0x0); ++ /* ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_BT, FORCE_EXEC, false, ++ false); */ ++ break; ++ case 8: /* PTA Control */ ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x8,0x0, 0x0, 0x0, 0x0); ++ /* ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_PTA, FORCE_EXEC, false, ++ false); */ ++ break; ++ case 9: /* Software control, Antenna at WiFi side */ ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x0,0x0, 0x0, 0x0, 0x0); ++ /* ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_WIFI, FORCE_EXEC,false,false); */ ++ break; ++ case 10: /* under 5G , 0x778=1*/ ++ halbtc8822b1ant_set_fw_pstdma(btcoexist, ++ 0x0,0x0, 0x0, 0x0, 0x0); ++ ++ /* ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_WIFI5G, FORCE_EXEC, false, ++ false); */ ++ ++ break; ++ } ++ } ++ ++ ++ /* update pre state */ ++ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; ++ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; ++} ++ ++ ++void halbtc8822b1ant_sw_mechanism(IN struct btc_coexist *btcoexist, ++ IN boolean low_penalty_ra) ++{ ++ halbtc8822b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); ++} ++ ++void halbtc8822b1ant_set_rfe_type(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ ++ ++ /* the following setup should be got from Efuse in the future */ ++ rfe_type->rfe_module_type = board_info->rfe_type; ++ ++ rfe_type->ext_ant_switch_ctrl_polarity = 0;; ++ ++ switch(rfe_type->rfe_module_type) ++ { ++ case 0: ++ default: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; ++ break; ++ case 1: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; ++ break; ++ case 2: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; ++ break; ++ case 3: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; ++ break; ++ case 4: ++ rfe_type->ext_ant_switch_exist = true; ++ rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SP3T; /* SP3T */; ++ break; ++ } ++ ++ ++} ++ ++ ++void halbtc8822b1ant_set_ext_ant_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 ctrl_type, IN u8 pos_type) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ boolean switch_polatiry_inverse = false; ++ u8 regval_0xcbd = 0, regval_0x64; ++ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; ++ ++ if (!rfe_type->ext_ant_switch_exist) ++ return; ++ ++ coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; ++ ++ if (!force_exec) { ++ if (coex_dm->pre_ext_ant_switch_status == coex_dm->cur_ext_ant_switch_status) ++ return; ++ } ++ ++ coex_dm->pre_ext_ant_switch_status = coex_dm->cur_ext_ant_switch_status; ++ ++ /* swap control polarity if use different switch control polarity*/ ++ /* Normal switch polarity for SPDT, 0xcbd[1:0] = 2b'01 => Ant to BTG, 0xcbd[1:0] = 2b'10 => Ant to WLG */ ++ switch_polatiry_inverse = (rfe_type->ext_ant_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); ++ ++ ++ switch(pos_type) ++ { ++ default: ++ case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_BT: ++ case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE: ++ ++ break; ++ case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLG: ++ switch_polatiry_inverse = ~switch_polatiry_inverse; ++ break; ++ case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLA: ++ break; ++ } ++ ++ ++ if (rfe_type->ext_ant_switch_type == BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT) ++ { ++ switch(ctrl_type) ++ { ++ default: ++ case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x77); /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ ++ ++ regval_0xcbd = (switch_polatiry_inverse == false? 0x1 : 0x2); /* 0xcbd[1:0] = 2b'01 for no switch_polatiry_inverse, ANTSWB =1, ANTSW =0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x3, regval_0xcbd); ++ ++ break; ++ case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x66); /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ ++ ++ regval_0xcbd = (switch_polatiry_inverse == false? 0x2 : 0x1); /* 0xcbd[1:0] = 2b'10 for no switch_polatiry_inverse, ANTSWB =1, ANTSW =0 @ GNT_BT=1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x3, regval_0xcbd); ++ ++ break; ++ case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x88); /* */ ++ ++ /* no regval_0xcbd setup required, because antenna switch control value by antenna diversity */ ++ ++ break; ++ case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x1); /* 0x4c[23] = 1 */ ++ ++ regval_0x64 = (switch_polatiry_inverse == false? 0x0 : 0x1); /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, regval_0x64); ++ break; ++ case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT: ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x0); /* 0x4c[24] = 0 */ ++ ++ /* no setup required, because antenna switch control value by BT vendor 0xac[1:0] */ ++ break; ++ } ++ } ++ ++ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcbd); ++ u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Ext Ant switch setup) 0xcbd = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x**********\n", ++ u32tmp1, u32tmp2, u32tmp3); ++ BTC_TRACE(trace_buf); ++ ++ ++} ++ ++ ++void halbtc8822b1ant_set_ant_path(IN struct btc_coexist *btcoexist, ++ IN u8 ant_pos_type, IN boolean force_exec, ++ IN u8 phase) ++ ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 u8tmp = 0; ++ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; ++ ++ coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; ++ ++ if (!force_exec) { ++ if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) ++ return; ++ } ++ ++ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; ++ ++#if 1 ++ u32tmp1 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x38); ++ u32tmp2 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0x54); ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ u32tmp3, u8tmp, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++#endif ++ ++ switch (phase) ++ { ++ case BT_8822B_1ANT_PHASE_COEX_INIT: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_COEX_INIT) **********\n" ); ++ BTC_TRACE(trace_buf); ++ ++ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ ++ halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8822B_1ANT_CTT_WL_VS_LTE, 0xffff); ++ ++ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8822B_1ANT_CTT_BT_VS_LTE, 0xffff); ++ ++ /* set GNT_BT to SW high */ ++ halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8822B_1ANT_GNT_CTRL_BY_SW, ++ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ /* set GNT_WL to SW low */ ++ halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8822B_1ANT_GNT_CTRL_BY_SW, ++ BT_8822B_1ANT_SIG_STA_SET_TO_LOW); ++ ++ /* set Path control owner to WL at initial step */ ++ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8822B_1ANT_PCO_WLSIDE); ++ ++ coex_sta->run_time_state = false; ++ ++ /* Ext switch buffer mux */ ++ btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_BT; ++ ++ break; ++ case BT_8822B_1ANT_PHASE_WLANONLY_INIT: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_WLANONLY_INIT) **********\n" ); ++ BTC_TRACE(trace_buf); ++ ++ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ ++ halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8822B_1ANT_CTT_WL_VS_LTE, 0xffff); ++ ++ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ ++ halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, ++ BT_8822B_1ANT_CTT_BT_VS_LTE, 0xffff); ++ ++ /* set GNT_BT to SW Low */ ++ halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8822B_1ANT_GNT_CTRL_BY_SW, ++ BT_8822B_1ANT_SIG_STA_SET_TO_LOW); ++ ++ /* Set GNT_WL to SW high */ ++ halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8822B_1ANT_GNT_CTRL_BY_SW, ++ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ /* set Path control owner to WL at initial step */ ++ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8822B_1ANT_PCO_WLSIDE); ++ ++ coex_sta->run_time_state = false; ++ ++ /* Ext switch buffer mux */ ++ btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_WIFI; ++ ++ break; ++ case BT_8822B_1ANT_PHASE_WLAN_OFF: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_WLAN_OFF) **********\n" ); ++ BTC_TRACE(trace_buf); ++ ++ /* Disable LTE Coex Function in WiFi side */ ++ halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* set Path control owner to BT */ ++ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8822B_1ANT_PCO_BTSIDE); ++ ++ /* Set Ext Ant Switch to BT control at wifi off step */ ++ halbtc8822b1ant_set_ext_ant_switch(btcoexist, ++ FORCE_EXEC, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE); ++ ++ coex_sta->run_time_state = false; ++ ++ break; ++ case BT_8822B_1ANT_PHASE_2G_RUNTIME: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_2G_RUNTIME) **********\n" ); ++ BTC_TRACE(trace_buf); ++ ++ /* set GNT_BT to PTA */ ++ halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8822B_1ANT_GNT_CTRL_BY_PTA, ++ BT_8822B_1ANT_SIG_STA_SET_BY_HW); ++ ++ /* Set GNT_WL to PTA */ ++ halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8822B_1ANT_GNT_CTRL_BY_PTA, ++ BT_8822B_1ANT_SIG_STA_SET_BY_HW); ++ ++ /* set Path control owner to WL at runtime step */ ++ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8822B_1ANT_PCO_WLSIDE); ++ ++ coex_sta->run_time_state = true; ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_PTA; ++ ++ break; ++ case BT_8822B_1ANT_PHASE_5G_RUNTIME: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_5G_RUNTIME) **********\n" ); ++ BTC_TRACE(trace_buf); ++ ++ /* set GNT_BT to SW Hi */ ++ halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8822B_1ANT_GNT_CTRL_BY_SW, ++ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ /* Set GNT_WL to SW Hi */ ++ halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8822B_1ANT_GNT_CTRL_BY_SW, ++ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ /* set Path control owner to WL at runtime step */ ++ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8822B_1ANT_PCO_WLSIDE); ++ ++ coex_sta->run_time_state = true; ++ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_WIFI5G; ++ ++ break; ++ case BT_8822B_1ANT_PHASE_BTMPMODE : ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_BTMPMODE) **********\n" ); ++ BTC_TRACE(trace_buf); ++ ++ /* Disable LTE Coex Function in WiFi side */ ++ halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); ++ ++ /* set GNT_BT to SW Hi */ ++ halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8822B_1ANT_GNT_CTRL_BY_SW, ++ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); ++ ++ /* Set GNT_WL to SW Lo */ ++ halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8822B_1ANT_GNT_CTRL_BY_SW, ++ BT_8822B_1ANT_SIG_STA_SET_TO_LOW); ++ ++ /* set Path control owner to WL */ ++ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8822B_1ANT_PCO_WLSIDE); ++ ++ coex_sta->run_time_state = false; ++ ++ /* Set Ext Ant Switch to BT side at BT MP mode */ ++ if (BTC_ANT_PATH_AUTO == ant_pos_type) ++ ant_pos_type = BTC_ANT_PATH_BT; ++ ++ break; ++ } ++ ++ ++ if (phase != BT_8822B_1ANT_PHASE_WLAN_OFF) ++ { ++ switch (ant_pos_type) { ++ case BTC_ANT_PATH_WIFI: ++ halbtc8822b1ant_set_ext_ant_switch( btcoexist, ++ force_exec, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLG); ++ break; ++ case BTC_ANT_PATH_WIFI5G: ++ halbtc8822b1ant_set_ext_ant_switch( btcoexist, ++ force_exec, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLA); ++ break; ++ case BTC_ANT_PATH_BT: ++ halbtc8822b1ant_set_ext_ant_switch( btcoexist, ++ force_exec, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_BT); ++ break; ++ default: ++ case BTC_ANT_PATH_PTA: ++ halbtc8822b1ant_set_ext_ant_switch( btcoexist, ++ force_exec, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE); ++ break; ++ } ++ ++ } ++#if 1 ++ u32tmp1 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (After Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ u32tmp3, u8tmp, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ ++#endif ++ ++} ++ ++ ++void halbtc8822b1ant_coex_all_off(IN struct btc_coexist *btcoexist) ++{ ++ /* sw all off */ ++ halbtc8822b1ant_sw_mechanism(btcoexist, false); ++ ++ /* hw all off */ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++boolean halbtc8822b1ant_is_common_action(IN struct btc_coexist *btcoexist) ++{ ++ boolean common = false, wifi_connected = false, wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ if (!wifi_connected && ++ BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (wifi_connected && ++ (BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi connected + BT connected-idle!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else if (!wifi_connected && ++ (BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ ++ ++ common = true; ++ } else { ++ if (wifi_busy) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ common = false; ++ } ++ ++ return common; ++} ++ ++void halbtc8822b1ant_action_wifi_under5g(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], under 5g start \n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 10); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, ++ BT_8822B_1ANT_PHASE_5G_RUNTIME); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); ++ ++ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ ++ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 5); ++ ++} ++ ++ ++ ++void halbtc8822b1ant_action_wifi_only(IN struct btc_coexist *btcoexist) ++{ ++ boolean wifi_under_5g = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if(wifi_under_5g) ++ { ++ halbtc8822b1ant_action_wifi_under5g(btcoexist); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (wlan only -- under 5g ) **********\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (wlan only -- under 2g ) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++} ++ ++/* ********************************************* ++ * ++ * Software Coex Mechanism start ++ * ++ * ********************************************* */ ++ ++/* SCO only or SCO+PAN(HS) */ ++ ++/* ++void halbtc8822b1ant_action_sco(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8822b1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8822b1ant_action_hid(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8822b1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8822b1ant_action_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8822b1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8822b1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8822b1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8822b1ant_action_pan_edr(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8822b1ant_sw_mechanism(btcoexist, false); ++} ++ ++ ++void halbtc8822b1ant_action_pan_hs(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8822b1ant_sw_mechanism(btcoexist, false); ++} ++ ++ ++void halbtc8822b1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8822b1ant_sw_mechanism(btcoexist, false); ++} ++ ++void halbtc8822b1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8822b1ant_sw_mechanism(btcoexist, true); ++} ++ ++ ++void halbtc8822b1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8822b1ant_sw_mechanism(btcoexist, true); ++} ++ ++void halbtc8822b1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) ++{ ++ halbtc8822b1ant_sw_mechanism(btcoexist, true); ++} ++ ++*/ ++ ++/* ********************************************* ++ * ++ * Non-Software Coex Mechanism start ++ * ++ * ********************************************* */ ++void halbtc8822b1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex],action_bt_whck_test\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++void halbtc8822b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex],action_wifi_multi_port\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++} ++ ++void halbtc8822b1ant_action_hs(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], action_hs\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++} ++ ++/*"""bt inquiry"""" + wifi any + bt any*/ ++void halbtc8822b1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) ++{ ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, ++ bt_busy = false; ++ ++ ++ boolean wifi_scan = false, link = false, roam = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (bt inquiry) **********\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** scan = %d, link =%d, roam = %d**********\n", ++ wifi_scan, link, roam); ++ BTC_TRACE(trace_buf); ++ ++ if ( (link) || (roam) || (coex_sta->wifi_is_high_pri_task)){ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (bt inquiry wifi connect or scan ) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); ++ ++ } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); ++ ++ } else if ((!wifi_connected) && (!wifi_scan)) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (bt inquiry wifi non connect) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ ++ } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if (bt_link_info->a2dp_exist) { ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if (wifi_scan) { ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if (wifi_busy) { ++ ++ /* for BT inquiry/page fail after S4 resume */ ++ /* halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); */ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 1); ++ }else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (bt inquiry wifi connect) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 1); ++ } ++ ++/* ++ if ((wifi_link) || (wifi_roam) || (coex_sta->wifi_is_high_pri_task)) { ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); ++ ++ } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); ++ ++ } else if ((!wifi_connected) && (!wifi_scan)) { ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ } else if (bt_link_info->a2dp_exist) { ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else if (wifi_scan) { ++ ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ ++ } else if (wifi_busy) { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } else { ++ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 19); ++ ++ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); ++ } ++*/ ++} ++ ++void halbtc8822b1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (bt sco hid only busy) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ /*SCO + wifi conected idle or busy / 0x778=1@wifi slot*/ ++ if (bt_link_info->sco_exist) { ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ ++ } else { /* HID + wifi conected idle or busy / 0x778=1@wifi slot */ ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ ++ } ++} ++ ++/*wifi connected + bt acl busy*/ ++void halbtc8822b1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist ++ *btcoexist, IN u8 wifi_status) ++{ ++ ++ u8 bt_rssi_state; ++ ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ bt_rssi_state = halbtc8822b1ant_bt_rssi_state(2, 28, 0); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (wifi connect acl busy) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (bt_link_info->hid_only) { /* HID + wifi conected idle or busy / 0x778=1@wifi slot */ ++ halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ wifi_status); ++ return; ++ } else if (bt_link_info->a2dp_only) { /* A2DP + wifi conected idle or busy */ ++ if (BT_8822B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ } else { ++ if (coex_sta->scan_ap_num >= ++ BT_8822B_1ANT_WIFI_NOISY_THRESH) { ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 17); ++ } else { ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 42); ++ } ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ coex_dm->auto_tdma_adjust = true; ++ } ++ ++ /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ ++ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || ++ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 44); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 1); ++ } else if (bt_link_info->hid_exist && ++ bt_link_info->a2dp_exist) { /* HID+A2DP */ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 42); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 1); ++ ++ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && ++ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP)*/ ++ /* ++ if (BT_8723D_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) ++ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 4); ++ else ++ */ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 45); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 1); ++ } else { ++ /* BT no-profile busy (0x9) */ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 1); ++ } ++} ++ ++/*wifi not connected + bt action*/ ++void halbtc8822b1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (wifi not connect) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ /* tdma and coex table */ ++ halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++} ++ ++/*""""wl not connected scan"""" + bt action*/ ++void halbtc8822b1ant_action_wifi_not_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (wifi non connect scan) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if (num_of_wifi_link >= 2) { ++ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8822b1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8822b1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8822b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8822b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ /* tdma and coex table */ ++ if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ } else if (bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist) { ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ } else { ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ } ++ } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 5); ++ } ++} ++ ++/*""""wl not connected asso"""" + bt action*/ ++void halbtc8822b1ant_action_wifi_not_connected_asso_auth( ++ IN struct btc_coexist *btcoexist) ++{ ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (wifi non connect asso_auth) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if (num_of_wifi_link >= 2) { ++ ++ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8822b1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8822b1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8822b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8822b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ ++ /* tdma and coex table */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || ++ (bt_link_info->a2dp_exist)) { ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); ++ } else if (bt_link_info->pan_exist) { ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); ++ } else { ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); ++ } ++} ++ ++/*""""wl connected scan"""" + bt action*/ ++void halbtc8822b1ant_action_wifi_connected_scan(IN struct btc_coexist ++ *btcoexist) ++{ ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (wifi connect scan) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if (num_of_wifi_link >= 2) { ++ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8822b1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8822b1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8822b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8822b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ /* tdma and coex table */ ++ if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ if (bt_link_info->a2dp_exist) { ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 32); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ } else if (bt_link_info->a2dp_exist && ++ bt_link_info->pan_exist) { ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, ++ 22); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ } else { ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ } ++ } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_SCAN); ++ } else { ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 5); ++ } ++} ++ ++/*""""wl connected specific packet"""" + bt action*/ ++void halbtc8822b1ant_action_wifi_connected_specific_packet( ++ IN struct btc_coexist *btcoexist) ++{ ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0; ++ boolean bt_ctrl_agg_buf_size = false; ++ u8 agg_buf_size = 5; ++ boolean wifi_busy = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (wifi connect specific packet) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if (num_of_wifi_link >= 2) { ++ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8822b1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8822b1ant_action_wifi_multi_port(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->c2h_bt_inquiry_page) { ++ halbtc8822b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8822b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ /* no specific packet process for both WiFi and BT very busy */ ++ if ((wifi_busy) && ((bt_link_info->pan_exist) || ++ (coex_sta->num_of_profile >= 2))) ++ return; ++ ++ /* tdma and coex table */ ++ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); ++ } else if (bt_link_info->a2dp_exist) { ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 1); ++ } else if (bt_link_info->pan_exist) { ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 1); ++ } else { ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 5); ++ } ++} ++ ++/*wifi connected input point : to set different ps and tdma case (+bt different case)*/ ++void halbtc8822b1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) ++{ ++ ++ boolean wifi_busy = false; ++ boolean scan = false, link = false, roam = false; ++ boolean under_4way = false, ap_enable = false, wifi_under_5g=false; ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ if (wifi_under_5g) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under 5g<===\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_action_wifi_under5g(btcoexist); ++ ++ return; ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under 2g<===\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ } ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (under_4way) { ++ halbtc8822b1ant_action_wifi_connected_specific_packet(btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8822b1ant_action_wifi_connected_scan(btcoexist); ++ else ++ halbtc8822b1ant_action_wifi_connected_specific_packet( ++ btcoexist); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ &ap_enable); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ /* tdma and coex table */ ++ if (!wifi_busy) { ++ if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8822b1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_IDLE); ++ } else { ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ ++ if ((coex_sta->high_priority_tx) + ++ (coex_sta->high_priority_rx) <= 60) ++ /*sy modify case16 -> case17*/ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ else ++ halbtc8822b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 7); ++ } ++ } else { ++ if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { ++ halbtc8822b1ant_action_wifi_connected_bt_acl_busy( ++ btcoexist, ++ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == ++ coex_dm->bt_status) || ++ (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == ++ coex_dm->bt_status)) { ++ halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, ++ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_BUSY); ++ } else { ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, ++ 8); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ ++ if ((coex_sta->high_priority_tx) + ++ (coex_sta->high_priority_rx) <= 60) ++ /*sy modify case16 -> case17*/ ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 1); ++ else ++ halbtc8822b1ant_coex_table_with_type(btcoexist, ++ NORMAL_EXEC, 7); ++ } ++ } ++} ++ ++void halbtc8822b1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ ++ u8 algorithm = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (runswcoexmech) **********\n"); ++ BTC_TRACE(trace_buf); ++ algorithm = halbtc8822b1ant_action_algorithm(btcoexist); ++ coex_dm->cur_algorithm = algorithm; ++ ++ if (halbtc8822b1ant_is_common_action(btcoexist)) { ++ ++ } else { ++ switch (coex_dm->cur_algorithm) { ++ case BT_8822B_1ANT_COEX_ALGO_SCO: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = SCO.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8822b1ant_action_sco(btcoexist); */ ++ break; ++ case BT_8822B_1ANT_COEX_ALGO_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8822b1ant_action_hid(btcoexist); */ ++ break; ++ case BT_8822B_1ANT_COEX_ALGO_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8822b1ant_action_a2dp(btcoexist); */ ++ break; ++ case BT_8822B_1ANT_COEX_ALGO_A2DP_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8822b1ant_action_a2dp_pan_hs(btcoexist); */ ++ break; ++ case BT_8822B_1ANT_COEX_ALGO_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR).\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8822b1ant_action_pan_edr(btcoexist); */ ++ break; ++ case BT_8822B_1ANT_COEX_ALGO_PANHS: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HS mode.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8822b1ant_action_pan_hs(btcoexist); */ ++ break; ++ case BT_8822B_1ANT_COEX_ALGO_PANEDR_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8822b1ant_action_pan_edr_a2dp(btcoexist); */ ++ break; ++ case BT_8822B_1ANT_COEX_ALGO_PANEDR_HID: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8822b1ant_action_pan_edr_hid(btcoexist); */ ++ break; ++ case BT_8822B_1ANT_COEX_ALGO_HID_A2DP_PANEDR: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8822b1ant_action_hid_a2dp_pan_edr(btcoexist); */ ++ break; ++ case BT_8822B_1ANT_COEX_ALGO_HID_A2DP: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = HID+A2DP.\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8822b1ant_action_hid_a2dp(btcoexist); */ ++ break; ++ default: ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Action algorithm = coexist All Off!!\n"); ++ BTC_TRACE(trace_buf); ++ /* halbtc8822b1ant_coex_all_off(btcoexist); */ ++ break; ++ } ++ coex_dm->pre_algorithm = coex_dm->cur_algorithm; ++ } ++} ++ ++void halbtc8822b1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) ++{ ++ ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ boolean wifi_connected = false, bt_hs_on = false; ++ boolean increase_scan_dev_num = false; ++ boolean bt_ctrl_agg_buf_size = false; ++ boolean miracast_plus_bt = false; ++ u8 agg_buf_size = 5; ++ u32 wifi_link_status = 0; ++ u32 num_of_wifi_link = 0, wifi_bw; ++ u8 iot_peer = BTC_IOT_PEER_UNKNOWN; ++ boolean wifi_under_5g = false; ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism()===>\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (coex_sta->under_ips) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is under IPS !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ if (!coex_sta->run_time_state){ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], return for run_time_state = false !!!\n"); ++ BTC_TRACE(trace_buf); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if(wifi_under_5g) ++ { ++ halbtc8822b1ant_action_wifi_under5g(btcoexist); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under 5G!!! \n"); ++ BTC_TRACE(trace_buf); ++ return; ++ }else{ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], WiFi is under 2G!!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ NORMAL_EXEC, BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ } ++ ++ if (coex_sta->bt_whck_test) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is under WHCK TEST!!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8822b1ant_action_bt_whck_test(btcoexist); ++ return; ++ } ++ ++ if (coex_sta->bt_disabled) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT is disabled !!!\n"); ++ halbtc8822b1ant_action_wifi_only(btcoexist); ++ return; ++ } ++ ++ if ((BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ increase_scan_dev_num = true; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, ++ &increase_scan_dev_num); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, ++ &wifi_link_status); ++ num_of_wifi_link = wifi_link_status >> 16; ++ ++ if ((num_of_wifi_link >= 2) || ++ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", ++ num_of_wifi_link, wifi_link_status); ++ BTC_TRACE(trace_buf); ++ ++ if (bt_link_info->bt_link_exist) { ++ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, ++ 0, 1); ++ miracast_plus_bt = true; ++ } else { ++ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ miracast_plus_bt = false; ++ } ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, ++ bt_ctrl_agg_buf_size, agg_buf_size); ++ ++ if ((bt_link_info->a2dp_exist) && ++ (coex_sta->c2h_bt_inquiry_page)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8822b1ant_action_bt_inquiry(btcoexist); ++ } else ++ halbtc8822b1ant_action_wifi_multi_port(btcoexist); ++ ++ return; ++ } else { ++ miracast_plus_bt = false; ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, ++ &miracast_plus_bt); ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ ++ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { ++ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); ++ ++ if (BTC_IOT_PEER_CISCO != iot_peer) { ++ if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */ ++ halbtc8822b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, true, false, 0x5); ++ else ++ halbtc8822b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, false, 0x5); ++ } else { ++ if (bt_link_info->sco_exist) ++ halbtc8822b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, true, false, 0x5); ++ else { ++ if (BTC_WIFI_BW_HT40 == wifi_bw) ++ halbtc8822b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, true, 0x10); ++ else ++ halbtc8822b1ant_limited_rx(btcoexist, ++ NORMAL_EXEC, false, true, 0x8); ++ } ++ } ++ ++ halbtc8822b1ant_sw_mechanism(btcoexist, true); ++ halbtc8822b1ant_run_sw_coexist_mechanism( ++ btcoexist); /* just print debug message */ ++ } else { ++ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); ++ ++ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, ++ 0x5); ++ ++ halbtc8822b1ant_sw_mechanism(btcoexist, false); ++ halbtc8822b1ant_run_sw_coexist_mechanism( ++ btcoexist); /* //just print debug message */ ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); ++ if (coex_sta->c2h_bt_inquiry_page) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "############# [BTCoex], BT Is Inquirying\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8822b1ant_action_bt_inquiry(btcoexist); ++ return; ++ } else if (bt_hs_on) { ++ halbtc8822b1ant_action_hs(btcoexist); ++ return; ++ } ++ ++ ++ if (!wifi_connected) { ++ boolean scan = false, link = false, roam = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], wifi is non connected-idle !!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); ++ ++ if (scan || link || roam) { ++ if (scan) ++ halbtc8822b1ant_action_wifi_not_connected_scan( ++ btcoexist); ++ else ++ halbtc8822b1ant_action_wifi_not_connected_asso_auth( ++ btcoexist); ++ } else ++ halbtc8822b1ant_action_wifi_not_connected(btcoexist); ++ } else /* wifi LPS/Busy */ ++ halbtc8822b1ant_action_wifi_connected(btcoexist); ++} ++ ++u32 halbtc8822b1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) ++{ ++ u8 j; ++ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; ++ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, ++ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, ++ 32, 23, 15, 7, 0 ++ }; ++ ++ if (val == 0) ++ return 0; ++ ++ tmp = val; ++ ++ while (1) { ++ if (tmp == 1) ++ break; ++ else { ++ tmp = (tmp >> 1); ++ shiftcount++; ++ } ++ } ++ ++ ++ val_integerd_b = shiftcount + 1; ++ ++ tmp2 = 1; ++ for (j = 1; j <= val_integerd_b; j++) ++ tmp2 = tmp2 * 2; ++ ++ tmp = (val * 100) / tmp2; ++ tindex = tmp / 5; ++ ++ if (tindex > 20) ++ tindex = 20; ++ ++ val_fractiond_b = table_fraction[tindex]; ++ ++ result = val_integerd_b * 100 - val_fractiond_b; ++ ++ return result; ++ ++ ++} ++ ++void halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ /* force to reset coex mechanism */ ++ ++ /* sw all off */ ++ halbtc8822b1ant_sw_mechanism(btcoexist, false); ++ ++ /* halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ ++ /* halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ ++ ++ coex_sta->pop_event_cnt = 0; ++} ++ ++void halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean back_up, IN boolean wifi_only) ++{ ++ ++ u8 u8tmp = 0; ++ boolean wifi_under_5g = false; ++ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; ++ ++ ++ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); ++ u32tmp1 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u32tmp2 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", ++ u32tmp3, u32tmp1, u32tmp2); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 1Ant Init HW Config!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->bt_coex_supported_feature = 0; ++ coex_sta->bt_coex_supported_version = 0; ++ ++ /* Setup RF front end type */ ++ halbtc8822b1ant_set_rfe_type(btcoexist); ++ ++ /* 0xf0[15:12] --> Chip Cut information */ ++ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, ++ 0xf1) & 0xf0) >> 4; ++ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, ++ 0x1); /* enable TBTT nterrupt */ ++ ++ /* BT report packet sample rate */ ++ /* 0x790[5:0]=0x5 */ ++ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); ++ u8tmp &= 0xc0; ++ u8tmp |= 0x5; ++ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); ++ ++ /* Enable BT counter statistics */ ++ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); ++ ++ /* Enable PTA (3-wire function form BT side) */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); ++ ++ /* Enable PTA (tx/rx signal form WiFi side) */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); ++ ++ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ ++ /*btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1);*/ ++ ++ /* enable GNT_WL */ ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); ++ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); ++ ++ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) ++ halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, TRUE); ++ ++ /* Antenna config */ ++ if (wifi_only) { ++ ++ coex_sta->concurrent_rx_mode_on = false; ++ halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, ++ FORCE_EXEC, BT_8822B_1ANT_PHASE_WLANONLY_INIT); ++ } else { ++ ++ coex_sta->concurrent_rx_mode_on = true; ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, BT_8822B_1ANT_PHASE_COEX_INIT); ++ } ++ ++ ++ /* PTA parameter */ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); ++ ++ halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, TRUE); ++ ++} ++ ++ ++ ++void halbtc8822b1ant_psd_showdata(IN struct btc_coexist *btcoexist) ++{ ++ u8 *cli_buf = btcoexist->cli_buf; ++ u32 delta_freq_per_point; ++ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n\n============[PSD info] (%d)============\n", ++ psd_scan->psd_gen_count); ++ CL_PRINTF(cli_buf); ++ ++ if (psd_scan->psd_gen_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); ++ CL_PRINTF(cli_buf); ++ return; ++ } ++ ++ if (psd_scan->psd_point == 0) ++ delta_freq_per_point = 0; ++ else ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* if (psd_scan->is_psd_show_max_only) */ ++ if (0) { ++ psd_rep1 = psd_scan->psd_max_value / 100; ++ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; ++ ++ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + ++ psd_scan->psd_max_value_point * delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.0%d MHz", ++ freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq = %d.%d MHz", ++ freq1, freq2); ++ ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.0%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ ", Value = %d.%d dB, (%d)\n", ++ psd_rep1, psd_rep2, psd_scan->psd_max_value); ++ ++ CL_PRINTF(cli_buf); ++ } else { ++ m = psd_scan->psd_start_point; ++ n = psd_scan->psd_start_point; ++ i = 1; ++ j = 1; ++ ++ while (1) { ++ do { ++ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * ++ delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ if (i == 1) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.000", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.0%2d", freq1, ++ freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Freq%6d.%3d", freq1, ++ freq2); ++ } else if ((i % 8 == 0) || ++ (m == psd_scan->psd_stop_point)) { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.000\n", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.0%2d\n", freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.%3d\n", freq1, freq2); ++ } else { ++ if (freq2 == 0) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.000", freq1); ++ else if (freq2 < 100) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.0%2d", freq1, freq2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%6d.%3d", freq1, freq2); ++ } ++ ++ i++; ++ m++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); ++ ++ ++ do { ++ psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; ++ psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * ++ 100; ++ ++ if (j == 1) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.0%d", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n Val %7d.%d", psd_rep1, ++ psd_rep2); ++ } else if ((j % 8 == 0) || ++ (n == psd_scan->psd_stop_point)) { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.0%d\n", psd_rep1, ++ psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.%d\n", psd_rep1, psd_rep2); ++ } else { ++ if (psd_rep2 < 10) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.0%d", psd_rep1, psd_rep2); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "%7d.%d", psd_rep1, psd_rep2); ++ } ++ ++ j++; ++ n++; ++ CL_PRINTF(cli_buf); ++ ++ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); ++ ++ if ((m > psd_scan->psd_stop_point) || ++ (n > psd_scan->psd_stop_point)) ++ break; ++ else { ++ i = 1; ++ j = 1; ++ } ++ ++ } ++ } ++ ++ ++} ++ ++void halbtc8822b1ant_psd_max_holddata(IN struct btc_coexist *btcoexist, ++ IN u32 gen_count) ++{ ++ u32 i = 0, i_max = 0, val_max = 0; ++ ++ if (gen_count == 1) { ++ memcpy(psd_scan->psd_report_max_hold, ++ psd_scan->psd_report, ++ BT_8822B_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); ++ ++ for (i = psd_scan->psd_start_point; ++ i <= psd_scan->psd_stop_point; i++) { ++ ++ } ++ ++ psd_scan->psd_max_value_point = 0; ++ psd_scan->psd_max_value = 0; ++ ++ } else { ++ for (i = psd_scan->psd_start_point; ++ i <= psd_scan->psd_stop_point; i++) { ++ if (psd_scan->psd_report[i] > ++ psd_scan->psd_report_max_hold[i]) ++ psd_scan->psd_report_max_hold[i] = ++ psd_scan->psd_report[i]; ++ ++ /* search Max Value */ ++ if (i == psd_scan->psd_start_point) { ++ i_max = i; ++ val_max = psd_scan->psd_report_max_hold[i]; ++ } else { ++ if (psd_scan->psd_report_max_hold[i] > ++ val_max) { ++ i_max = i; ++ val_max = psd_scan->psd_report_max_hold[i]; ++ } ++ } ++ ++ ++ ++ } ++ ++ psd_scan->psd_max_value_point = i_max; ++ psd_scan->psd_max_value = val_max; ++ ++ } ++ ++ ++} ++ ++u32 halbtc8822b1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) ++{ ++ /* reg 0x808[9:0]: FFT data x */ ++ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ ++ /* reg 0x8b4[15:0]: FFT data y report */ ++ ++ u32 val = 0, psd_report = 0; ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ ++ val &= 0xffbffc00; ++ val |= point; ++ ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ val |= 0x00400000; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); ++ ++ psd_report = val & 0x0000ffff; ++ ++ return psd_report; ++} ++ ++ ++void halbtc8822b1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, ++ IN u32 avgnum) ++{ ++ u32 i, val, n, k = 0; ++ u32 points1 = 0, psd_report = 0; ++ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; ++ u32 psd_center_freq = 20 * 10 ^ 6, freq, freq1, freq2; ++ boolean outloop = false; ++ u8 flag = 0; ++ u32 tmp, psd_rep1, psd_rep2; ++ u32 wifi_original_channel = 1; ++ ++ psd_scan->is_psd_running = true; ++ ++ do { ++ switch (flag) { ++ case 0: /* Get PSD parameters */ ++ default: ++ ++ psd_scan->psd_band_width = 40 * 1000000; ++ psd_scan->psd_point = points; ++ psd_scan->psd_start_base = points / 2; ++ psd_scan->psd_avg_num = avgnum; ++ psd_scan->real_cent_freq = cent_freq; ++ psd_scan->real_offset = offset; ++ psd_scan->real_span = span; ++ ++ ++ points1 = psd_scan->psd_point; ++ delta_freq_per_point = psd_scan->psd_band_width / ++ psd_scan->psd_point; ++ ++ /* PSD point setup */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffff0fff; ++ ++ switch (psd_scan->psd_point) { ++ case 128: ++ val |= 0x0; ++ break; ++ case 256: ++ default: ++ val |= 0x00004000; ++ break; ++ case 512: ++ val |= 0x00008000; ++ break; ++ case 1024: ++ val |= 0x0000c000; ++ break; ++ } ++ ++ switch (psd_scan->psd_avg_num) { ++ case 1: ++ val |= 0x0; ++ break; ++ case 8: ++ val |= 0x00001000; ++ break; ++ case 16: ++ val |= 0x00002000; ++ break; ++ case 32: ++ default: ++ val |= 0x00003000; ++ break; ++ } ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ flag = 1; ++ break; ++ case 1: /* calculate the PSD point index from freq/offset/span */ ++ psd_center_freq = psd_scan->psd_band_width / 2 + ++ offset * (1000000); ++ ++ start_p = psd_scan->psd_start_base + (psd_center_freq - ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_start_point = start_p - ++ psd_scan->psd_start_base; ++ ++ stop_p = psd_scan->psd_start_base + (psd_center_freq + ++ span * (1000000) / 2) / delta_freq_per_point; ++ psd_scan->psd_stop_point = stop_p - ++ psd_scan->psd_start_base - 1; ++ ++ flag = 2; ++ break; ++ case 2: /* set RF channel/BW/Mode */ ++ ++ /* set 3-wire off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val |= 0x00300000; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val &= 0xfeffffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* store WiFi original channel */ ++ wifi_original_channel = btcoexist->btc_get_rf_reg( ++ btcoexist, BTC_RF_A, 0x18, 0x3ff); ++ ++ /* Set RF channel */ ++ if (cent_freq == 2484) ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, 0xe); ++ else ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, ++ 0x18, 0x3ff, (cent_freq - 2412) / 5 + ++ 1); /* WiFi TRx Mask on */ ++ ++ /* Set RF mode = Rx, RF Gain = 0x8a0 */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, ++ 0xfffff, 0x308a0); ++ ++ /* Set RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, ++ 0xfffff, 0x3e4); ++ ++ /* Set TRx mask off */ ++ /* un-lock TRx Mask setup */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, ++ 0x80, 0x1); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, ++ 0x1, 0x1); ++ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, ++ 0xfffff, 0x0); ++ ++ flag = 3; ++ break; ++ case 3: ++ memset(psd_scan->psd_report, 0, ++ psd_scan->psd_point * sizeof(u32)); ++ start_p = psd_scan->psd_start_point + ++ psd_scan->psd_start_base; ++ stop_p = psd_scan->psd_stop_point + ++ psd_scan->psd_start_base + 1; ++ ++ i = start_p; ++ ++ while (i < stop_p) { ++ if (i >= points1) ++ psd_report = ++ halbtc8822b1ant_psd_getdata( ++ btcoexist, i - points1); ++ else ++ psd_report = ++ halbtc8822b1ant_psd_getdata( ++ btcoexist, i); ++ ++ if (psd_report == 0) ++ tmp = 0; ++ else ++ /* tmp = 20*log10((double)psd_report); */ ++ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ ++ tmp = 6 * halbtc8822b1ant_psd_log2base( ++ btcoexist, psd_report); ++ ++ n = i - psd_scan->psd_start_base; ++ psd_scan->psd_report[n] = tmp; ++ psd_rep1 = psd_scan->psd_report[n] / 100; ++ psd_rep2 = psd_scan->psd_report[n] - psd_rep1 * ++ 100; ++ ++ freq = ((cent_freq - 20) * 1000000 + n * ++ delta_freq_per_point); ++ freq1 = freq / 1000000; ++ freq2 = freq / 1000 - freq1 * 1000; ++ ++ i++; ++ ++ k = 0; ++ ++ /* Add Delay between PSD point */ ++ while (1) { ++ if (k++ > 20000) ++ break; ++ } ++ ++ } ++ ++ flag = 100; ++ break; ++ case 99: /* error */ ++ ++ outloop = true; ++ break; ++ case 100: /* recovery */ ++ ++ /* set 3-wire on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); ++ val &= 0xffcfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); ++ ++ /* CCK on */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x800); ++ val |= 0x01000000; ++ btcoexist->btc_write_4byte(btcoexist, 0x800, val); ++ ++ /* PSD off */ ++ val = btcoexist->btc_read_4byte(btcoexist, 0x808); ++ val &= 0xffbfffff; ++ btcoexist->btc_write_4byte(btcoexist, 0x808, val); ++ ++ /* TRx Mask on */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, ++ 0xfffff, 0x780); ++ ++ /* lock TRx Mask setup */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, ++ 0x80, 0x0); ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, ++ 0x1, 0x0); ++ ++ /* Set RF Rx filter corner */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, ++ 0xfffff, 0x0); ++ ++ /* restore WiFi original channel */ ++ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, ++ 0x3ff, wifi_original_channel); ++ ++ outloop = true; ++ break; ++ ++ } ++ ++ } while (!outloop); ++ ++ ++ ++ psd_scan->is_psd_running = false; ++ ++ ++} ++ ++#if (BTC_COEX_OFFLOAD == 1) ++void halbtc8822b1ant_wifi_info_notify(IN struct btc_coexist *btcoexist) ++{ ++ u8 h2c_para[4] = {0}; ++ u8 opcode_ver = 0; ++ u8 ap_num = 0; ++ s32 wifi_rssi = 0; ++ boolean wifi_busy = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); ++ ++ h2c_para[0] = ap_num; /* AP number */ ++ h2c_para[1] = (u8)wifi_busy; /* Busy */ ++ h2c_para[2] = (u8)wifi_rssi; /* RSSI */ ++ ++ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_INFO_NOTIFY, ++ opcode_ver, &h2c_para[0], 3); ++} ++ ++void halbtc8822b1ant_setManual(IN struct btc_coexist *btcoexist, ++ IN boolean manual) ++{ ++ u8 h2c_para[4] = {0}; ++ u8 opcode_ver = 0; ++ u8 set_type = 0; ++ ++ if (manual) ++ set_type = 1; ++ else ++ set_type = 0; ++ ++ h2c_para[0] = set_type; /* set_type */ ++ ++ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_SET_CONTROL, opcode_ver, ++ &h2c_para[0], 1); ++} ++ ++/* ************************************************************ ++ * work around function start with wa_halbtc8822b1ant_ ++ * ************************************************************ ++ * ************************************************************ ++ * extern function start with ex_halbtc8822b1ant_ ++ * ************************************************************ */ ++ ++void ex_halbtc8822b1ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{} ++void ex_halbtc8822b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) ++{} ++void ex_halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{} ++void ex_halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{} ++void ex_halbtc8822b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ u8 h2c_para[4] = {0}; ++ u8 opcode_ver = 0; ++ u8 ips_notify = 0; ++ ++ if (BTC_IPS_ENTER == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ ips_notify = 1; ++ } else if (BTC_IPS_LEAVE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ h2c_para[0] = ips_notify; /* IPS notify */ ++ h2c_para[1] = 0xff; /* LPS notify */ ++ h2c_para[2] = 0xff; /* RF state notify */ ++ h2c_para[3] = 0xff; /* pnp notify */ ++ ++ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_POWER_STATE_NOTIFY, ++ opcode_ver, &h2c_para[0], 4); ++} ++void ex_halbtc8822b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ u8 h2c_para[4] = {0}; ++ u8 opcode_ver = 0; ++ u8 lps_notify = 0; ++ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ lps_notify = 1; ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ h2c_para[0] = 0xff; /* IPS notify */ ++ h2c_para[1] = lps_notify; /* LPS notify */ ++ h2c_para[2] = 0xff; /* RF state notify */ ++ h2c_para[3] = 0xff; /* pnp notify */ ++ ++ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_POWER_STATE_NOTIFY, ++ opcode_ver, &h2c_para[0], 4); ++} ++ ++void ex_halbtc8822b1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_para[4] = {0}; ++ u8 opcode_ver = 0; ++ u8 scan_start = 0; ++ boolean under_4way = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ if (BTC_SCAN_START == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ scan_start = 1; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ h2c_para[0] = scan_start; /* scan notify */ ++ h2c_para[1] = 0xff; /* connect notify */ ++ h2c_para[2] = 0xff; /* specific packet notify */ ++ if (under_4way) ++ h2c_para[3] = 1; /* under 4way progress */ ++ else ++ h2c_para[3] = 0; ++ ++ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_PROGRESS_NOTIFY, ++ opcode_ver, &h2c_para[0], 4); ++} ++ ++void ex_halbtc8822b1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_para[4] = {0}; ++ u8 opcode_ver = 0; ++ u8 connect_start = 0; ++ boolean under_4way = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ if (BTC_ASSOCIATE_START == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ connect_start = 1; ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], CONNECT FINISH notify\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ h2c_para[0] = 0xff; /* scan notify */ ++ h2c_para[1] = connect_start; /* connect notify */ ++ h2c_para[2] = 0xff; /* specific packet notify */ ++ if (under_4way) ++ h2c_para[3] = 1; /* under 4way progress */ ++ else ++ h2c_para[3] = 0; ++ ++ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_PROGRESS_NOTIFY, ++ opcode_ver, &h2c_para[0], 4); ++} ++ ++void ex_halbtc8822b1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u32 wifi_bw; ++ u8 wifi_central_chnl; ++ u8 h2c_para[5] = {0}; ++ u8 opcode_ver = 0; ++ u8 port = 0, connected = 0, freq = 0, bandwidth = 0, iot_peer = 0; ++ boolean wifi_under_5g = false; ++ ++ if (BTC_MEDIA_CONNECT == type) ++ connected = 1; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); ++ bandwidth = (u8)wifi_bw; ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if (wifi_under_5g) ++ freq = 1; ++ else ++ freq = 0; ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ &wifi_central_chnl); ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); ++ ++ h2c_para[0] = (connected << 4) | ++ port; /* port need to be implemented in the future (p2p port, ...) */ ++ h2c_para[1] = (freq << 4) | bandwidth; ++ h2c_para[2] = wifi_central_chnl; ++ h2c_para[3] = iot_peer; ++ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_STATUS_NOTIFY, ++ opcode_ver, &h2c_para[0], 4); ++} ++ ++void ex_halbtc8822b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_para[4] = {0}; ++ u8 opcode_ver = 0; ++ u8 connect_start = 0; ++ boolean under_4way = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ h2c_para[0] = 0xff; /* scan notify */ ++ h2c_para[1] = 0xff; /* connect notify */ ++ h2c_para[2] = type; /* specific packet notify */ ++ if (under_4way) ++ h2c_para[3] = 1; /* under 4way progress */ ++ else ++ h2c_para[3] = 0; ++ ++ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_PROGRESS_NOTIFY, ++ opcode_ver, &h2c_para[0], 4); ++} ++ ++void ex_halbtc8822b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{} ++void ex_halbtc8822b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ u8 h2c_para[4] = {0}; ++ u8 opcode_ver = 0; ++ u8 rfstate_notify = 0; ++ ++ if (BTC_RF_ON == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned ON!!\n"); ++ BTC_TRACE(trace_buf); ++ rfstate_notify = 1; ++ } else if (BTC_RF_OFF == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned OFF!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ h2c_para[0] = 0xff; /* IPS notify */ ++ h2c_para[1] = 0xff; /* LPS notify */ ++ h2c_para[2] = rfstate_notify; /* RF state notify */ ++ h2c_para[3] = 0xff; /* pnp notify */ ++ ++ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_POWER_STATE_NOTIFY, ++ opcode_ver, &h2c_para[0], 4); ++} ++ ++void ex_halbtc8822b1ant_halt_notify(IN struct btc_coexist *btcoexist) ++{} ++void ex_halbtc8822b1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ u8 h2c_para[4] = {0}; ++ u8 opcode_ver = 0; ++ u8 pnp_notify = 0; ++ ++ if (BTC_WIFI_PNP_SLEEP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ pnp_notify = 1; ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ h2c_para[0] = 0xff; /* IPS notify */ ++ h2c_para[1] = 0xff; /* LPS notify */ ++ h2c_para[2] = 0xff; /* RF state notify */ ++ h2c_para[3] = pnp_notify; /* pnp notify */ ++ ++ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_POWER_STATE_NOTIFY, ++ opcode_ver, &h2c_para[0], 4); ++} ++ ++void ex_halbtc8822b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) ++{} ++void ex_halbtc8822b1ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++ ++ halbtc8822b1ant_wifi_info_notify(btcoexist); ++} ++ ++void ex_halbtc8822b1ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; ++ u16 u16tmp[4]; ++ u32 u32tmp[4]; ++ u32 fa_of_dm, fa_cck; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ static u8 pop_report_in_10s = 0; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ if (btcoexist->stop_coex_dm) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Coex is STOPPED]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ if (psd_scan->ant_det_try_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", ++ "Ant PG Num/ Mech/ Pos", ++ board_info->pg_ant_num, board_info->btdm_ant_num, ++ board_info->btdm_ant_pos); ++ CL_PRINTF(cli_buf); ++ } else { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ %d/ %d (%d/%d/%d)", ++ "Ant PG Num/ Mech(Ant_Det)/ Pos", ++ board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, ++ board_info->btdm_ant_pos, ++ psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, ++ psd_scan->ant_det_result); ++ CL_PRINTF(cli_buf); ++ ++ if (board_info->btdm_ant_det_finish) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "Ant Det PSD Value", ++ psd_scan->ant_det_peak_val); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", ++ "CoexVer/ FwVer/ PatchVer", ++ glcoex_ver_date_8822b_1ant, glcoex_ver_8822b_1ant, fw_ver, ++ bt_patch_ver, bt_patch_ver); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", ++ "WifibHiPri/ Ccklock/ CckEverLock", ++ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), ++ (coex_sta->cck_lock ? "Yes" : "No"), ++ (coex_sta->cck_ever_lock ? "Yes" : "No")); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ pop_report_in_10s++; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt/ popCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") ++ : ((BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi, coex_sta->bt_retry_cnt, ++ coex_sta->pop_event_cnt); ++ CL_PRINTF(cli_buf); ++ ++ if (pop_report_in_10s >= 5) { ++ coex_sta->pop_event_cnt = 0; ++ pop_report_in_10s = 0; ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d / %d / %d / %d / %d", ++ "SCO/HID/PAN/A2DP/Hi-Pri", ++ bt_link_info->sco_exist, bt_link_info->hid_exist, ++ bt_link_info->pan_exist, bt_link_info->a2dp_exist, ++ bt_link_info->bt_hi_pri_link_exist); ++ CL_PRINTF(cli_buf); ++ ++ { ++ bt_info_ext = coex_sta->bt_info_ext; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", ++ "BT Role/A2DP rate", ++ (bt_link_info->slave_role) ? "Slave" : "Master", ++ (bt_info_ext & BIT(0)) ? "BR" : "EDR"); ++ CL_PRINTF(cli_buf); ++ } ++ ++ /*bt info*/ ++ for (i = 0; i < BT_INFO_SRC_8822B_1ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8822b_1ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ ++ if (btcoexist->manual_control) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms] (before Manual)============"); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "SM[LowPenaltyRA]", ++ coex_dm->cur_low_penalty_ra); ++ CL_PRINTF(cli_buf); ++ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case, ++ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), ++ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); ++ ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "WL/BT Coex Table Type", ++ coex_sta->coex_table_type); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8(coexTable)", ++ u32tmp[0], u32tmp[1], u32tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x778/0x6cc/IgnWlanAct", ++ u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa0); ++ u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "LTE Coex Table W_L/B_L", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa8); ++ u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xac); ++ u32tmp[2] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb0); ++ u32tmp[3] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "LTE Break Table W_L/B_L/L_W/L_B", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, ++ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); ++ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "0x430/0x434/0x42a/0x456", ++ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ ++ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", ++ "LTE CoexOn/Path Ctrl Owner", ++ (int)((u32tmp[0]&BIT(7)) >> 7), ((u8tmp[0]&BIT(2)) ? "WL" : "BT")); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "LTE 3Wire/OPMode/UART/UARTMode", ++ (int)((u32tmp[0]&BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), ++ (int)((u32tmp[0]&BIT(3)) >> 3), ++ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", ++ "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", ++ (int)((u32tmp[0]&BIT(12)) >> 12), (int)((u32tmp[0]&BIT(14)) >> 14), ++ ((u8tmp[0]&BIT(3)) ? "On" : "Off")); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", ++ (int)((u32tmp[0]&BIT(2)) >> 2), (int)((u32tmp[0]&BIT(3)) >> 3), ++ (int)((u32tmp[0]&BIT(1)) >> 1), (int)(u32tmp[0]&BIT(0))); ++ CL_PRINTF(cli_buf); ++ ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x4c6[4]/0x40[5] (WL/BT PTA)", ++ (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s", ++ "0x550(bcn ctrl)/0x522/4-RxAGC", ++ u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off"); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); ++ u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); ++ ++ fa_of_dm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) ++ >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + \ ++ ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & ++ 0xffff) ; ++ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; ++ ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xc50); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0xc50/OFDM-CCA/OFDM-FA/CCK-FA", ++ u32tmp[1] & 0xff, u32tmp[0] & 0xffff, fa_of_dm, fa_cck); ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_OK CCK/11g/11n/11n-Agg", ++ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, ++ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_Err CCK/11g/11n/11n-Agg", ++ coex_sta->crc_err_cck, coex_sta->crc_err_11g, ++ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770(high-pri rx/tx)", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(low-pri rx/tx)", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++#if (BT_AUTO_REPORT_ONLY_8822B_1ANT == 1) ++ /* halbtc8822b1ant_monitor_bt_ctr(btcoexist); */ ++#endif ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++} ++void ex_halbtc8822b1ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{} ++void ex_halbtc8822b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) ++{} ++void ex_halbtc8822b1ant_dbg_control(IN struct btc_coexist *btcoexist, ++ IN u8 op_code, IN u8 op_len, IN u8 *pdata) ++{ ++ switch (op_code) { ++ case BTC_DBG_SET_COEX_MANUAL_CTRL: { ++ boolean manual = (boolean)*pdata; ++ ++ halbtc8822b1ant_setManual(btcoexist, manual); ++ } ++ break; ++ default: ++ break; ++ } ++} ++ ++#else ++void ex_halbtc8822b1ant_power_on_setting(IN struct btc_coexist *btcoexist) ++{ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ u8 u8tmp = 0x0; ++ u16 u16tmp = 0x0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "xxxxxxxxxxxxxxxx Execute 8822b 1-Ant PowerOn Setting!! xxxxxxxxxxxxxxxx\n"); ++ BTC_TRACE(trace_buf); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "Ant Det Finish = %s, Ant Det Number = %d\n", ++ board_info->btdm_ant_det_finish ? "Yes" : "No", ++ board_info->btdm_ant_num_by_ant_det); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = true; ++ ++ /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ ++ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); ++ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); ++ ++ /* set Path control owner to WiFi */ ++ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, ++ BT_8822B_1ANT_PCO_WLSIDE); ++ ++ /* set GNT_BT to high */ ++ halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, ++ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8822B_1ANT_GNT_CTRL_BY_SW, ++ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); ++ /* Set GNT_WL to low */ ++ halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, ++ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, ++ BT_8822B_1ANT_GNT_CTRL_BY_SW, ++ BT_8822B_1ANT_SIG_STA_SET_TO_LOW); ++ ++ /* set WLAN_ACT = 0 */ ++ //btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); ++ ++ /* SD1 Chunchu red x issue */ ++ btcoexist->btc_write_1byte(btcoexist, 0xff1a, 0x0); ++ ++ halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, TRUE); ++ ++ /* */ ++ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ ++ /* Local setting bit define */ ++ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ ++ /* BIT1: "0" for internal switch; "1" for external switch */ ++ /* BIT2: "0" for one antenna; "1" for two antenna */ ++ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ ++ ++ u8tmp = 0; ++ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; ++ ++ if (btcoexist->chip_interface == BTC_INTF_USB) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); ++ else if (btcoexist->chip_interface == BTC_INTF_SDIO) ++ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); ++ ++ BTC_TRACE(trace_buf); ++ ++ ++} ++ ++void ex_halbtc8822b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) ++{ ++} ++ ++void ex_halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (ini hw config) **********\n"); ++ ++ halbtc8822b1ant_init_hw_config(btcoexist, true, wifi_only); ++ btcoexist->stop_coex_dm = false; ++} ++ ++void ex_halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Coex Mechanism Init!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ btcoexist->stop_coex_dm = false; ++ ++ halbtc8822b1ant_init_coex_dm(btcoexist); ++ ++ halbtc8822b1ant_query_bt_info(btcoexist); ++} ++ ++void ex_halbtc8822b1ant_display_coex_info(IN struct btc_coexist *btcoexist) ++{ ++ ++ struct btc_board_info *board_info = &btcoexist->board_info; ++ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; ++ u8 *cli_buf = btcoexist->cli_buf; ++ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; ++ u16 u16tmp[4]; ++ u32 u32tmp[4]; ++ u32 fa_of_dm, fa_cck; ++ u32 fw_ver = 0, bt_patch_ver = 0; ++ static u8 pop_report_in_10s = 0; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (display coexinfo) **********\n"); ++ BTC_TRACE(trace_buf); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** displaycoexinfostart, 0xcb4/0xcbd = 0x%x/0x%x\n", ++ btcoexist->btc_read_1byte(btcoexist, 0xcb4), ++ btcoexist->btc_read_1byte(btcoexist, 0xcbd)); ++ BTC_TRACE(trace_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[BT Coexist info]============"); ++ CL_PRINTF(cli_buf); ++ ++ if (btcoexist->manual_control) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Under Manual Control]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ if (btcoexist->stop_coex_dm) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n ============[Coex is STOPPED]============"); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n =========================================="); ++ CL_PRINTF(cli_buf); ++ } ++ ++ if (psd_scan->ant_det_try_count == 0) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "Ant PG Num/ Mech/ Pos/ RFE", ++ board_info->pg_ant_num, board_info->btdm_ant_num, ++ board_info->btdm_ant_pos, ++ rfe_type->rfe_module_type); ++ CL_PRINTF(cli_buf); ++ } else { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d/ %d/ %d/ %d (%d/%d/%d)", ++ "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", ++ board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, ++ board_info->btdm_ant_pos, ++ rfe_type->rfe_module_type, ++ psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, ++ psd_scan->ant_det_result); ++ CL_PRINTF(cli_buf); ++ ++ if (board_info->btdm_ant_det_finish) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", ++ "Ant Det PSD Value", ++ psd_scan->ant_det_peak_val); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", ++ "Version Coex/ Fw/ Patch/ Cut", ++ glcoex_ver_date_8822b_1ant, glcoex_ver_8822b_1ant, fw_ver, ++ bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", ++ "Wifi channel informed to BT", ++ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], ++ coex_dm->wifi_chnl_info[2]); ++ CL_PRINTF(cli_buf); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", ++ "WifibHiPri/ Ccklock/ CckEverLock", ++ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), ++ (coex_sta->cck_lock ? "Yes" : "No"), ++ (coex_sta->cck_ever_lock ? "Yes" : "No")); ++ CL_PRINTF(cli_buf); ++ ++ /* wifi status */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Wifi Status]============"); ++ CL_PRINTF(cli_buf); ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[BT Status]============"); ++ CL_PRINTF(cli_buf); ++ ++ pop_report_in_10s++; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", ++ "BT [status/ rssi/ retryCnt/ popCnt]", ++ ((coex_sta->bt_disabled) ? ("disabled") : (( ++ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") ++ : ((BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == ++ coex_dm->bt_status) ? "non-connected idle" : ++ ((BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ++ ? "connected-idle" : "busy")))), ++ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, ++ coex_sta->pop_event_cnt); ++ CL_PRINTF(cli_buf); ++ /*bt rssi */ ++ /*bt pop_even_cnt : bt retry*/ ++ ++ if (pop_report_in_10s >= 5) { ++ coex_sta->pop_event_cnt = 0; ++ pop_report_in_10s = 0; ++ } ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %d / %d / %d / %d / %d", ++ "SCO/HID/PAN/A2DP/Hi-Pri", ++ bt_link_info->sco_exist, bt_link_info->hid_exist, ++ bt_link_info->pan_exist, bt_link_info->a2dp_exist, ++ bt_link_info->bt_hi_pri_link_exist); ++ CL_PRINTF(cli_buf); ++ ++ { ++ bt_info_ext = coex_sta->bt_info_ext; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s / %d/ %x/ %04x", ++ "Role/A2DP Rate/Bitpool/Feature/Ver", ++ ((bt_link_info->slave_role) ? "Slave" : "Master"), ++ (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool, ++ coex_sta->bt_coex_supported_feature, ++ coex_sta->bt_coex_supported_version); ++ CL_PRINTF(cli_buf); ++ } ++ ++ /*bt info*/ ++ for (i = 0; i < BT_INFO_SRC_8822B_1ANT_MAX; i++) { ++ if (coex_sta->bt_info_c2h_cnt[i]) { ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", ++ glbt_info_src_8822b_1ant[i], ++ coex_sta->bt_info_c2h[i][0], ++ coex_sta->bt_info_c2h[i][1], ++ coex_sta->bt_info_c2h[i][2], ++ coex_sta->bt_info_c2h[i][3], ++ coex_sta->bt_info_c2h[i][4], ++ coex_sta->bt_info_c2h[i][5], ++ coex_sta->bt_info_c2h[i][6], ++ coex_sta->bt_info_c2h_cnt[i]); ++ CL_PRINTF(cli_buf); ++ } ++ } ++ ++ ++ if (btcoexist->manual_control) ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms] (before Manual)============"); ++ else ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[mechanisms]============"); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "SM[LowPenaltyRA]", ++ coex_dm->cur_low_penalty_ra); ++ CL_PRINTF(cli_buf); ++ ++ /*(ps)tdma*/ ++ ps_tdma_case = coex_dm->cur_ps_tdma; ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", ++ "PS TDMA", ++ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], ++ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], ++ coex_dm->ps_tdma_para[4], ps_tdma_case, ++ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), ++ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); ++ ++ CL_PRINTF(cli_buf); ++ ++ /*coex table type*/ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", ++ "WL/BT Coex Table Type", ++ coex_sta->coex_table_type); ++ CL_PRINTF(cli_buf); ++ ++ /*coex table :0x6c0 0x6c4 , break table: 0x6c8*/ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x6c0/0x6c4/0x6c8(coexTable)", ++ u32tmp[0], u32tmp[1], u32tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ /*PTA : 0x778=1/3/d , WL BA,RTS,CTS :0x6cc H/L pri */ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x778/0x6cc/IgnWlanAct", ++ u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); ++ CL_PRINTF(cli_buf); ++ ++ ++ /*LTE : WL/LTE coex table : 0xa0 */ ++ ++ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa0); ++ ++ /*LTE : BT/LTE coex table : 0xa4 */ ++ u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "LTE Coex Table W_L/B_L", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ /*LTE : WL/LTE break table : 0xa8 */ ++ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xa8); ++ /*LTE : WL/LTE break table : 0xac */ ++ u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xac); ++ /*LTE : LTE/WL break table : 0xb0 */ ++ u32tmp[2] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb0); ++ /*LTE : LTE/BT break table : 0xb4 */ ++ u32tmp[3] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, ++ 0xb4); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "LTE Break Table W_L/B_L/L_W/L_B", ++ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, ++ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); ++ CL_PRINTF(cli_buf); ++ ++ /* Hw setting */ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", ++ "============[Hw setting]============"); ++ CL_PRINTF(cli_buf); ++ ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); ++ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", ++ "0x430/0x434/0x42a/0x456", ++ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); ++ CL_PRINTF(cli_buf); ++ ++ /*ANT setting*/ ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xcb4); ++ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xcbd); ++ u8tmp[3] = btcoexist->btc_read_1byte(btcoexist, 0x1991); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0xcb4/0xcbd/0x1991", ++ u8tmp[1], u8tmp[2], u8tmp[3]); ++ CL_PRINTF(cli_buf); ++ ++ /*LTE on/off , Path ctrl owner*/ ++ /*sy add*/ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x64); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", ++ "0x73/ 0x4c/ 0x64[0]", u8tmp[0], (u32tmp[0] & ( BIT(24) | BIT(23) )) >> 23, u8tmp[1]&0x1); ++ CL_PRINTF(cli_buf); ++ ++ ++ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", ++ "LTE CoexOn/Path Ctrl Owner", ++ (int)((u32tmp[0]&BIT(7)) >> 7), ((u8tmp[0]&BIT(2)) ? "WL" : "BT")); ++ CL_PRINTF(cli_buf); ++ ++ /*LTE mode*/ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "LTE 3Wire/OPMode/UART/UARTMode", ++ (int)((u32tmp[0]&BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), ++ (int)((u32tmp[0]&BIT(3)) >> 3), ++ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", ++ "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", ++ (int)((u32tmp[0]&BIT(12)) >> 12), (int)((u32tmp[0]&BIT(14)) >> 14), ++ ((u8tmp[0]&BIT(3)) ? "On" : "Off")); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", ++ (int)((u32tmp[0]&BIT(2)) >> 2), (int)((u32tmp[0]&BIT(3)) >> 3), ++ (int)((u32tmp[0]&BIT(1)) >> 1), (int)(u32tmp[0]&BIT(0))); ++ CL_PRINTF(cli_buf); ++ ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", ++ "0x4c6[4]/0x40[5] (WL/BT PTA)", ++ (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x974); ++ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xc50); ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "0x550(bcn ctrl)/0x522/0x974/0xc50", ++ u32tmp[0], u8tmp[0], u8tmp[1], u8tmp[2]); ++ CL_PRINTF(cli_buf); ++ ++ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); ++ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xf4c); ++ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xf08); ++ ++ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); ++ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5d); ++ ++ fa_of_dm = (u32tmp[0] & 0xffff) + (u32tmp[1] & 0xffff); ++ ++ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, ++ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", ++ "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", ++ u32tmp[2] & 0xffff, fa_cck, ((u32tmp[2] & 0xffff0000) >> 16), fa_of_dm); ++ CL_PRINTF(cli_buf); ++ ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_OK CCK/11g/11n/11ac", ++ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, ++ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", ++ "CRC_Err CCK/11g/11n/11ac", ++ coex_sta->crc_err_cck, coex_sta->crc_err_11g, ++ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); ++ CL_PRINTF(cli_buf); ++ ++ /*0x770:bt high pri trx*/ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x770(high-pri rx/tx)", ++ coex_sta->high_priority_rx, coex_sta->high_priority_tx); ++ CL_PRINTF(cli_buf); ++ /*0x774:bt low pri trx*/ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", ++ "0x774(low-pri rx/tx)", ++ coex_sta->low_priority_rx, coex_sta->low_priority_tx); ++ CL_PRINTF(cli_buf); ++ ++ halbtc8822b1ant_read_score_board(btcoexist, &u16tmp[0]); ++ ++ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x", ++ "ScoreBoard[14:0] (from BT)", u16tmp[0]); ++ ++ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** displaycoexinfo end, 0xcb4/0xcbd = 0x%x/0x%x\n", ++ btcoexist->btc_read_1byte(btcoexist, 0xcb4), ++ btcoexist->btc_read_1byte(btcoexist, 0xcbd)); ++ BTC_TRACE(trace_buf); ++} ++ ++ ++void ex_halbtc8822b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ ++ if (BTC_IPS_ENTER == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS ENTER notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_ips = true; ++ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8822B_1ANT_PHASE_WLAN_OFF); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); ++ } else if (BTC_IPS_LEAVE == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], IPS LEAVE notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); ++ ++ /*leave IPS : run ini hw config (exclude wifi only)*/ ++ halbtc8822b1ant_init_hw_config(btcoexist, false, false); ++ /*sw all off*/ ++ halbtc8822b1ant_init_coex_dm(btcoexist); ++ /*leave IPS : Query bt info*/ ++ halbtc8822b1ant_query_bt_info(btcoexist); ++ ++ coex_sta->under_ips = false; ++ } ++} ++ ++void ex_halbtc8822b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) ++{ ++ if (btcoexist->manual_control || btcoexist->stop_coex_dm) ++ return; ++ ++ if (BTC_LPS_ENABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS ENABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = true; ++ ++ if (coex_sta->force_lps_on == true) { /* LPS No-32K */ ++ /* Write WL "Active" in Score-board for PS-TDMA */ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); ++ ++ } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ ++ /* Write WL "Non-Active" in Score-board for Native-PS */ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); ++ ++ } ++ } else if (BTC_LPS_DISABLE == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], LPS DISABLE notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->under_lps = false; ++ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); ++ } ++} ++ ++ ++void ex_halbtc8822b1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN notify()\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ if (BTC_SCAN_START == type) ++ return; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ ++ if (BTC_SCAN_START_2G == type) { ++ coex_sta->wifi_is_high_pri_task = true; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 2g SCAN START notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8822b1ant_action_wifi_not_connected_scan( ++ btcoexist); ++ else /* wifi is connected */ ++ halbtc8822b1ant_action_wifi_connected_scan(btcoexist); ++ ++ } else { ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ /*WL scan finish , then get and update sacn ap numbers */ ++ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, ++ &coex_sta->scan_ap_num); ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", coex_sta->scan_ap_num); ++ BTC_TRACE(trace_buf); ++ ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8822b1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8822b1ant_action_wifi_connected(btcoexist); ++ } ++ ++ ++} ++ ++void ex_halbtc8822b1ant_switchband_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ ++ boolean wifi_connected = false; ++ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (switchband_notify) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm) ++ return; ++ ++ ++ if(type == BTC_SWITCH_TO_5G) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (switchband_notify BTC_SWITCH_TO_5G) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_action_wifi_under5g(btcoexist); ++ return; ++ } else if (type == BTC_SWITCH_TO_24G_NoForScan) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (switchband_notify BTC_SWITCH_TO_2G (no for scan)) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_run_coexist_mechanism(btcoexist); ++ ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (switchband_notify BTC_SWITCH_TO_2G) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ ex_halbtc8822b1ant_scan_notify(btcoexist, ++ BTC_SCAN_START_2G); ++ } ++ ++} ++ ++void ex_halbtc8822b1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_connected = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (connect notify) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); ++ ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ ++ if ( (BTC_ASSOCIATE_5G_START == type) || (BTC_ASSOCIATE_5G_FINISH== type)) { ++ ++ if (BTC_ASSOCIATE_5G_START== type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (5G associate start notify) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_action_wifi_under5g(btcoexist); ++ ++ } else if (BTC_ASSOCIATE_5G_FINISH == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (5G associate finish notify) **********\n"); ++ BTC_TRACE(trace_buf); ++ ++ } ++ ++ return; ++ ++} ++ ++ ++ if (BTC_ASSOCIATE_START == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 2G CONNECT START notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME); ++ ++ coex_dm->arp_cnt = 0; ++ ++ halbtc8822b1ant_action_wifi_not_connected_asso_auth(btcoexist); ++ ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 2G CONNECT Finish notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ ++ if (!wifi_connected) /* non-connected scan */ ++ halbtc8822b1ant_action_wifi_not_connected(btcoexist); ++ else ++ halbtc8822b1ant_action_wifi_connected(btcoexist); ++ } ++ ++} ++ ++void ex_halbtc8822b1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean wifi_under_b_mode = false; ++ boolean wifi_under_5g = false; ++ u32 cnt_bt_cal_chk = 0; ++ boolean is_in_mp_mode = false; ++ u8 u8tmp = 0; ++ u32 u32tmp1 = 0, u32tmp2 = 0; ++ ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if(wifi_under_5g) ++ { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 5g media notify \n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); ++ ++ halbtc8822b1ant_action_wifi_under5g(btcoexist); ++ return; ++ } ++ ++ ++ ++ if (BTC_MEDIA_CONNECT == type) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 2g media connect notify"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, ++ &wifi_under_b_mode); ++ ++ /* Set CCK Tx/Rx high Pri except 11b mode */ ++ if (wifi_under_b_mode) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (media status notity under b mode) **********\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x00); /* CCK Rx */ ++ } else { ++ /* btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x10); */ /*CCK Tx */ ++ /* btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x10); */ /*CCK Rx */ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (media status notity not under b mode) **********\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, ++ 0x00); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, ++ 0x10); /* CCK Rx */ ++ } ++ ++ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, ++ 0x430); ++ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, ++ 0x434); ++ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( ++ btcoexist, 0x42a); ++ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( ++ btcoexist, 0x456); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 2g media disconnect notify\n"); ++ BTC_TRACE(trace_buf); ++ coex_dm->arp_cnt = 0; ++ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); ++ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ ++ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ ++ ++ coex_sta->cck_ever_lock = false; ++ } ++ ++ halbtc8822b1ant_update_wifi_channel_info(btcoexist, type); ++ ++} ++ ++void ex_halbtc8822b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ boolean under_4way = false, wifi_under_5g = false; ++ ++ if (btcoexist->manual_control || ++ btcoexist->stop_coex_dm || ++ coex_sta->bt_disabled) ++ return; ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ if(wifi_under_5g) ++ { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], 5g special packet notify \n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_action_wifi_under5g(btcoexist); ++ return; ++ } ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ &under_4way); ++ ++ if (under_4way) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ---- under_4way!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ coex_sta->specific_pkt_period_cnt = 2; ++ } else if (BTC_PACKET_ARP == type) { ++ ++ coex_dm->arp_cnt++; ++ ++ if (coex_sta->wifi_is_high_pri_task) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet ARP notify -cnt = %d\n", coex_dm->arp_cnt); ++ BTC_TRACE(trace_buf); ++ } ++ ++ } else { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", type); ++ BTC_TRACE(trace_buf); ++ ++ coex_sta->wifi_is_high_pri_task = true; ++ coex_sta->specific_pkt_period_cnt = 2; ++ } ++ ++ if (coex_sta->wifi_is_high_pri_task) ++ halbtc8822b1ant_action_wifi_connected_specific_packet(btcoexist); ++ ++} ++ ++void ex_halbtc8822b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length) ++{ ++ u8 bt_info = 0; ++ u8 i, rsp_source = 0; ++ boolean bt_busy = false; ++ boolean wifi_connected = false; ++ boolean wifi_under_5g = false; ++ ++ ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); ++ ++ coex_sta->c2h_bt_info_req_sent = false; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ********** (BtInfo Notify) **********\n" ); ++ BTC_TRACE(trace_buf); ++ ++ rsp_source = tmp_buf[0] & 0xf; ++ if (rsp_source >= BT_INFO_SRC_8822B_1ANT_MAX) ++ rsp_source = BT_INFO_SRC_8822B_1ANT_WIFI_FW; ++ coex_sta->bt_info_c2h_cnt[rsp_source]++; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, ++ length); ++ BTC_TRACE(trace_buf); ++ ++ for (i = 0; i < length; i++) { ++ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; ++ if (i == 1) ++ bt_info = tmp_buf[i]; ++ if (i == length - 1) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } else { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", ++ tmp_buf[i]); ++ BTC_TRACE(trace_buf); ++ } ++ } ++ ++ ++ if (BT_INFO_SRC_8822B_1ANT_WIFI_FW != rsp_source) { ++ ++ /* if 0xff, it means BT is under WHCK test */ ++ if (bt_info == 0xff) ++ coex_sta->bt_whck_test = true; ++ else ++ coex_sta->bt_whck_test = false; ++ ++ coex_sta->bt_retry_cnt = /* [3:0] */ ++ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; ++ ++ if (coex_sta->bt_retry_cnt >= 1) ++ coex_sta->pop_event_cnt++; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ++ coex_sta->c2h_bt_page = true; ++ else ++ coex_sta->c2h_bt_page = false; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ++ coex_sta->bt_create_connection = true; ++ else ++ coex_sta->bt_create_connection = false; ++ ++ /* unit: %, value-100 to translate to unit: dBm */ ++ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; ++ ++ /* coex_sta->bt_info_c2h[rsp_source][3] * 2 - 90; */ ++ ++ if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) { ++ coex_sta->a2dp_bit_pool = ++ coex_sta->bt_info_c2h[rsp_source][6]; ++ } else ++ coex_sta->a2dp_bit_pool = 0; ++ ++ if (coex_sta->bt_info_c2h[rsp_source][1] & 0x9) ++ coex_sta->acl_busy = true; ++ else ++ coex_sta->acl_busy = false; ++ ++ coex_sta->bt_info_ext = ++ coex_sta->bt_info_c2h[rsp_source][4]; ++ ++ /* Here we need to resend some wifi info to BT */ ++ /* because bt is reset and loss of the info. */ ++ ++ if ((!btcoexist->manual_control) && (!btcoexist->stop_coex_dm)) { ++ ++ /* Re-Init */ ++ if (coex_sta->bt_info_ext & BIT(1)) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, ++ &wifi_connected); ++ if (wifi_connected) ++ halbtc8822b1ant_update_wifi_channel_info(btcoexist, ++ BTC_MEDIA_CONNECT); ++ else ++ halbtc8822b1ant_update_wifi_channel_info(btcoexist, ++ BTC_MEDIA_DISCONNECT); ++ } ++ ++ /* If Ignore_WLanAct && not SetUp_Link */ ++ if ((coex_sta->bt_info_ext & BIT(3)) && (!(coex_sta->bt_info_ext & BIT(2)))) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); ++ BTC_TRACE(trace_buf); ++ halbtc8822b1ant_ignore_wlan_act(btcoexist, ++ FORCE_EXEC, false); ++ } ++ } ++ /* check BIT2 first ==> check if bt is under inquiry or page scan */ ++ if (bt_info & BT_INFO_8822B_1ANT_B_INQ_PAGE) ++ coex_sta->c2h_bt_inquiry_page = true; ++ else ++ coex_sta->c2h_bt_inquiry_page = false; ++ } ++ ++ coex_sta->num_of_profile = 0; ++ ++ /* set link exist status */ ++ if (!(bt_info & BT_INFO_8822B_1ANT_B_CONNECTION)) { ++ coex_sta->bt_link_exist = false; ++ coex_sta->pan_exist = false; ++ coex_sta->a2dp_exist = false; ++ coex_sta->hid_exist = false; ++ coex_sta->sco_exist = false; ++ ++ coex_sta->bt_hi_pri_link_exist = false; ++ } else { /* connection exists */ ++ coex_sta->bt_link_exist = true; ++ if (bt_info & BT_INFO_8822B_1ANT_B_FTP) { ++ coex_sta->pan_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->pan_exist = false; ++ if (bt_info & BT_INFO_8822B_1ANT_B_A2DP) { ++ coex_sta->a2dp_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->a2dp_exist = false; ++ if (bt_info & BT_INFO_8822B_1ANT_B_HID) { ++ coex_sta->hid_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->hid_exist = false; ++ if (bt_info & BT_INFO_8822B_1ANT_B_SCO_ESCO) { ++ coex_sta->sco_exist = true; ++ coex_sta->num_of_profile++; ++ } else ++ coex_sta->sco_exist = false; ++ ++ } ++ ++ halbtc8822b1ant_update_bt_link_info(btcoexist); ++ ++ bt_info = bt_info & ++ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ ++ ++ if (!(bt_info & BT_INFO_8822B_1ANT_B_CONNECTION)) { ++ coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info == ++ BT_INFO_8822B_1ANT_B_CONNECTION) { /* connection exists but no busy */ ++ coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if ((bt_info & BT_INFO_8822B_1ANT_B_SCO_ESCO) || ++ (bt_info & BT_INFO_8822B_1ANT_B_SCO_BUSY)) { ++ coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_SCO_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else if (bt_info & BT_INFO_8822B_1ANT_B_ACL_BUSY) { ++ if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) ++ coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_ACL_BUSY; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); ++ BTC_TRACE(trace_buf); ++ } else { ++ coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_MAX; ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); ++ BTC_TRACE(trace_buf); ++ } ++ ++ if ((BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || ++ (BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || ++ (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) ++ bt_busy = true; ++ else ++ bt_busy = false; ++ ++ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); ++ ++ halbtc8822b1ant_run_coexist_mechanism(btcoexist); ++} ++ ++void ex_halbtc8822b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_RF_ON == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned ON!!\n"); ++ BTC_TRACE(trace_buf); ++ btcoexist->stop_coex_dm = false; ++ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); ++ halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, true); ++ } else if (BTC_RF_OFF == type) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], RF is turned OFF!!\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8822B_1ANT_PHASE_WLAN_OFF); ++ ++ halbtc8822b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ++ btcoexist->stop_coex_dm = true; ++ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); ++ halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, false); ++ ++ } ++} ++ ++void ex_halbtc8822b1ant_halt_notify(IN struct btc_coexist *btcoexist) ++{ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); ++ halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, false); ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8822B_1ANT_PHASE_WLAN_OFF); ++ ++ halbtc8822b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ++ ++ ex_halbtc8822b1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); ++ ++ halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, FALSE); ++ ++ btcoexist->stop_coex_dm = true; ++} ++ ++void ex_halbtc8822b1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state) ++{ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); ++ BTC_TRACE(trace_buf); ++ ++ if (BTC_WIFI_PNP_SLEEP == pnp_state) { ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to SLEEP\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); ++ halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, false); ++ ++ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); ++ ++ halbtc8822b1ant_set_ant_path(btcoexist, ++ BTC_ANT_PATH_AUTO, ++ FORCE_EXEC, ++ BT_8822B_1ANT_PHASE_WLAN_OFF); ++ ++ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, ++ 5); ++ ++ halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, FALSE); ++ ++ btcoexist->stop_coex_dm = true; ++ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], Pnp notify to WAKE UP\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); ++ halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, true); ++ ++ btcoexist->stop_coex_dm = false; ++ } ++} ++ ++void ex_halbtc8822b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) ++{ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], *****************Coex DM Reset*****************\n"); ++ BTC_TRACE(trace_buf); ++ ++ halbtc8822b1ant_init_hw_config(btcoexist, false, false); ++ halbtc8822b1ant_init_coex_dm(btcoexist); ++} ++ ++void ex_halbtc8822b1ant_periodical(IN struct btc_coexist *btcoexist) ++{ ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ==========================Periodical===========================\n"); ++ BTC_TRACE(trace_buf); ++ ++#if (BT_AUTO_REPORT_ONLY_8822B_1ANT == 0) ++ halbtc8822b1ant_query_bt_info(btcoexist); ++#endif ++ ++ halbtc8822b1ant_monitor_bt_ctr(btcoexist); ++ halbtc8822b1ant_monitor_wifi_ctr(btcoexist); ++ ++ halbtc8822b1ant_monitor_bt_enable_disable(btcoexist); ++ ++ /* for 4-way, DHCP, EAPOL packet */ ++ if (coex_sta->specific_pkt_period_cnt > 0) { ++ ++ coex_sta->specific_pkt_period_cnt--; ++ ++ if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) ++ coex_sta->wifi_is_high_pri_task = false; ++ ++ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, ++ "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No")); ++ BTC_TRACE(trace_buf); ++ } ++ ++ ++ if (coex_sta->bt_coex_supported_feature == 0) ++ coex_sta->bt_coex_supported_feature = btcoexist->btc_get_bt_coex_supported_feature(btcoexist); ++ ++ if ( (coex_sta->bt_coex_supported_version == 0) && (!coex_sta->bt_disabled) ) ++ coex_sta->bt_coex_supported_version = btcoexist->btc_get_bt_coex_supported_version(btcoexist); ++ ++ if (halbtc8822b1ant_is_wifi_status_changed(btcoexist)) ++ halbtc8822b1ant_run_coexist_mechanism(btcoexist); ++ ++} ++ ++void ex_halbtc8822b1ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++} ++ ++void ex_halbtc8822b1ant_antenna_isolation(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++ ++ ++} ++ ++void ex_halbtc8822b1ant_psd_scan(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) ++{ ++ ++ ++} ++ ++void ex_halbtc8822b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) ++{ ++ ++} ++ ++void ex_halbtc8822b1ant_dbg_control(IN struct btc_coexist *btcoexist, ++ IN u8 op_code, IN u8 op_len, IN u8 *pdata) ++{} ++#endif /* #if(BTC_COEX_OFFLOAD == 1) */ ++ ++#endif ++ ++#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.h 2018-02-11 21:44:27.148146101 +0200 +@@ -0,0 +1,408 @@ ++ ++#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) ++ ++#if (RTL8822B_SUPPORT == 1) ++ ++/* ******************************************* ++ * The following is for 8822B 1ANT BT Co-exist definition ++ * ******************************************* */ ++#define BT_AUTO_REPORT_ONLY_8822B_1ANT 1 ++ ++#define BT_INFO_8822B_1ANT_B_FTP BIT(7) ++#define BT_INFO_8822B_1ANT_B_A2DP BIT(6) ++#define BT_INFO_8822B_1ANT_B_HID BIT(5) ++#define BT_INFO_8822B_1ANT_B_SCO_BUSY BIT(4) ++#define BT_INFO_8822B_1ANT_B_ACL_BUSY BIT(3) ++#define BT_INFO_8822B_1ANT_B_INQ_PAGE BIT(2) ++#define BT_INFO_8822B_1ANT_B_SCO_ESCO BIT(1) ++#define BT_INFO_8822B_1ANT_B_CONNECTION BIT(0) ++ ++#define BT_INFO_8822B_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ ++ (((_BT_INFO_EXT_&BIT(0))) ? true : false) ++ ++#define BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT 2 ++ ++#define BT_8822B_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ ++ ++/* for Antenna detection */ ++#define BT_8822B_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 ++#define BT_8822B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 ++#define BT_8822B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 ++#define BT_8822B_1ANT_ANTDET_PSDTHRES_1ANT 35 ++#define BT_8822B_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ ++#define BT_8822B_1ANT_ANTDET_ENABLE 0 ++#define BT_8822B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 ++ ++#define BT_8822B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 ++#define BT_8822B_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ ++ ++ ++enum bt_8822b_1ant_signal_state { ++ BT_8822B_1ANT_SIG_STA_SET_TO_LOW = 0x0, ++ BT_8822B_1ANT_SIG_STA_SET_BY_HW = 0x0, ++ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH = 0x1, ++ BT_8822B_1ANT_SIG_STA_MAX ++}; ++ ++enum bt_8822b_1ant_path_ctrl_owner { ++ BT_8822B_1ANT_PCO_BTSIDE = 0x0, ++ BT_8822B_1ANT_PCO_WLSIDE = 0x1, ++ BT_8822B_1ANT_PCO_MAX ++}; ++ ++enum bt_8822b_1ant_gnt_ctrl_type { ++ BT_8822B_1ANT_GNT_CTRL_BY_PTA = 0x0, ++ BT_8822B_1ANT_GNT_CTRL_BY_SW = 0x1, ++ BT_8822B_1ANT_GNT_CTRL_MAX ++}; ++ ++enum bt_8822b_1ant_gnt_ctrl_block { ++ BT_8822B_1ANT_GNT_BLOCK_RFC_BB = 0x0, ++ BT_8822B_1ANT_GNT_BLOCK_RFC = 0x1, ++ BT_8822B_1ANT_GNT_BLOCK_BB = 0x2, ++ BT_8822B_1ANT_GNT_BLOCK_MAX ++}; ++ ++enum bt_8822b_1ant_lte_coex_table_type { ++ BT_8822B_1ANT_CTT_WL_VS_LTE = 0x0, ++ BT_8822B_1ANT_CTT_BT_VS_LTE = 0x1, ++ BT_8822B_1ANT_CTT_MAX ++}; ++ ++enum bt_8822b_1ant_lte_break_table_type { ++ BT_8822B_1ANT_LBTT_WL_BREAK_LTE = 0x0, ++ BT_8822B_1ANT_LBTT_BT_BREAK_LTE = 0x1, ++ BT_8822B_1ANT_LBTT_LTE_BREAK_WL = 0x2, ++ BT_8822B_1ANT_LBTT_LTE_BREAK_BT = 0x3, ++ BT_8822B_1ANT_LBTT_MAX ++}; ++ ++enum bt_info_src_8822b_1ant { ++ BT_INFO_SRC_8822B_1ANT_WIFI_FW = 0x0, ++ BT_INFO_SRC_8822B_1ANT_BT_RSP = 0x1, ++ BT_INFO_SRC_8822B_1ANT_BT_ACTIVE_SEND = 0x2, ++ BT_INFO_SRC_8822B_1ANT_MAX ++}; ++ ++enum bt_8822b_1ant_bt_status { ++ BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, ++ BT_8822B_1ANT_BT_STATUS_INQ_PAGE = 0x2, ++ BT_8822B_1ANT_BT_STATUS_ACL_BUSY = 0x3, ++ BT_8822B_1ANT_BT_STATUS_SCO_BUSY = 0x4, ++ BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, ++ BT_8822B_1ANT_BT_STATUS_MAX ++}; ++ ++enum bt_8822b_1ant_wifi_status { ++ BT_8822B_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, ++ BT_8822B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, ++ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, ++ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, ++ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, ++ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, ++ BT_8822B_1ANT_WIFI_STATUS_MAX ++}; ++ ++enum bt_8822b_1ant_coex_algo { ++ BT_8822B_1ANT_COEX_ALGO_UNDEFINED = 0x0, ++ BT_8822B_1ANT_COEX_ALGO_SCO = 0x1, ++ BT_8822B_1ANT_COEX_ALGO_HID = 0x2, ++ BT_8822B_1ANT_COEX_ALGO_A2DP = 0x3, ++ BT_8822B_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, ++ BT_8822B_1ANT_COEX_ALGO_PANEDR = 0x5, ++ BT_8822B_1ANT_COEX_ALGO_PANHS = 0x6, ++ BT_8822B_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, ++ BT_8822B_1ANT_COEX_ALGO_PANEDR_HID = 0x8, ++ BT_8822B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, ++ BT_8822B_1ANT_COEX_ALGO_HID_A2DP = 0xa, ++ BT_8822B_1ANT_COEX_ALGO_MAX = 0xb, ++}; ++ ++enum bt_8822b_1ant_ext_ant_switch_type { ++ BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT = 0x0, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SP3T = 0x1, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_MAX ++}; ++ ++enum bt_8822b_1ant_ext_ant_switch_ctrl_type { ++ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW = 0x0, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA = 0x1, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV = 0x2, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC = 0x3, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT = 0x4, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_MAX ++}; ++ ++enum bt_8822b_1ant_ext_ant_switch_pos_type { ++ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_BT = 0x0, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLG = 0x1, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLA = 0x2, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE = 0x3, ++ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_MAX ++}; ++ ++enum bt_8822b_1ant_phase{ ++ BT_8822B_1ANT_PHASE_COEX_INIT = 0x0, ++ BT_8822B_1ANT_PHASE_WLANONLY_INIT = 0x1, ++ BT_8822B_1ANT_PHASE_WLAN_OFF = 0x2, ++ BT_8822B_1ANT_PHASE_2G_RUNTIME = 0x3, ++ BT_8822B_1ANT_PHASE_5G_RUNTIME = 0x4, ++ BT_8822B_1ANT_PHASE_BTMPMODE = 0x5, ++ BT_8822B_1ANT_PHASE_MAX ++}; ++ ++ ++struct coex_dm_8822b_1ant { ++ /* hw setting */ ++ u32 pre_ant_pos_type; ++ u32 cur_ant_pos_type; ++ /* fw mechanism */ ++ boolean cur_ignore_wlan_act; ++ boolean pre_ignore_wlan_act; ++ u8 pre_ps_tdma; ++ u8 cur_ps_tdma; ++ u8 ps_tdma_para[5]; ++ u8 ps_tdma_du_adj_type; ++ boolean auto_tdma_adjust; ++ boolean pre_ps_tdma_on; ++ boolean cur_ps_tdma_on; ++ boolean pre_bt_auto_report; ++ boolean cur_bt_auto_report; ++ u8 pre_lps; ++ u8 cur_lps; ++ u8 pre_rpwm; ++ u8 cur_rpwm; ++ ++ /* sw mechanism */ ++ boolean pre_low_penalty_ra; ++ boolean cur_low_penalty_ra; ++ u32 pre_val0x6c0; ++ u32 cur_val0x6c0; ++ u32 pre_val0x6c4; ++ u32 cur_val0x6c4; ++ u32 pre_val0x6c8; ++ u32 cur_val0x6c8; ++ u8 pre_val0x6cc; ++ u8 cur_val0x6cc; ++ boolean limited_dig; ++ ++ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ ++ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ ++ u16 backup_retry_limit; ++ u8 backup_ampdu_max_time; ++ ++ /* algorithm related */ ++ u8 pre_algorithm; ++ u8 cur_algorithm; ++ u8 bt_status; ++ u8 wifi_chnl_info[3]; ++ ++ u32 pre_ra_mask; ++ u32 cur_ra_mask; ++ u8 pre_arfr_type; ++ u8 cur_arfr_type; ++ u8 pre_retry_limit_type; ++ u8 cur_retry_limit_type; ++ u8 pre_ampdu_time_type; ++ u8 cur_ampdu_time_type; ++ u32 arp_cnt; ++ ++ u32 pre_ext_ant_switch_status; ++ u32 cur_ext_ant_switch_status; ++ ++ u8 error_condition; ++}; ++ ++struct coex_sta_8822b_1ant { ++ boolean bt_disabled; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ boolean pan_exist; ++ boolean bt_hi_pri_link_exist; ++ u8 num_of_profile; ++ ++ boolean under_lps; ++ boolean under_ips; ++ u32 specific_pkt_period_cnt; ++ u32 high_priority_tx; ++ u32 high_priority_rx; ++ u32 low_priority_tx; ++ u32 low_priority_rx; ++ s8 bt_rssi; ++ boolean bt_tx_rx_mask; ++ u8 pre_bt_rssi_state; ++ u8 pre_wifi_rssi_state[4]; ++ boolean c2h_bt_info_req_sent; ++ u8 bt_info_c2h[BT_INFO_SRC_8822B_1ANT_MAX][10]; ++ u32 bt_info_c2h_cnt[BT_INFO_SRC_8822B_1ANT_MAX]; ++ boolean bt_whck_test; ++ boolean c2h_bt_inquiry_page; ++ boolean c2h_bt_page; /* Add for win8.1 page out issue */ ++ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ ++ u8 bt_retry_cnt; ++ u8 bt_info_ext; ++ u32 pop_event_cnt; ++ u8 scan_ap_num; ++ ++ u32 crc_ok_cck; ++ u32 crc_ok_11g; ++ u32 crc_ok_11n; ++ u32 crc_ok_11n_agg; ++ ++ u32 crc_err_cck; ++ u32 crc_err_11g; ++ u32 crc_err_11n; ++ u32 crc_err_11n_agg; ++ ++ boolean cck_lock; ++ boolean pre_ccklock; ++ boolean cck_ever_lock; ++ u8 coex_table_type; ++ ++ boolean force_lps_on; ++ u32 wrong_profile_notification; ++ ++ boolean concurrent_rx_mode_on; ++ ++ u32 special_pkt_period_cnt; ++ ++ u16 score_board; ++ ++ u8 a2dp_bit_pool; ++ u8 cut_version; ++ boolean acl_busy; ++ boolean wl_rf_off_on_event; ++ boolean bt_create_connection; ++ boolean run_time_state; ++ ++ u32 bt_coex_supported_feature; ++ u32 bt_coex_supported_version; ++}; ++ ++struct rfe_type_8822b_1ant{ ++ ++ u8 rfe_module_type; ++ boolean ext_ant_switch_exist; ++ u8 ext_ant_switch_type; ++ u8 ext_ant_switch_ctrl_polarity; /* iF 0: ANTSW(rfe_sel9)=0, ANTSWB(rfe_sel8)=1 => Ant to BT/5G */ ++}; ++ ++ ++#define BT_8822B_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ ++#define BT_8822B_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ ++#define BT_8822B_1ANT_ANTDET_BUF_LEN 16 ++ ++struct psdscan_sta_8822b_1ant { ++ ++ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ ++ u32 ant_det_bt_tx_time; ++ u32 ant_det_pre_psdscan_peak_val; ++ boolean ant_det_is_ant_det_available; ++ u32 ant_det_psd_scan_peak_val; ++ boolean ant_det_is_btreply_available; ++ u32 ant_det_psd_scan_peak_freq; ++ ++ u8 ant_det_result; ++ u8 ant_det_peak_val[BT_8822B_1ANT_ANTDET_BUF_LEN]; ++ u8 ant_det_peak_freq[BT_8822B_1ANT_ANTDET_BUF_LEN]; ++ u32 ant_det_try_count; ++ u32 ant_det_fail_count; ++ u32 ant_det_inteval_count; ++ u32 ant_det_thres_offset; ++ ++ u32 real_cent_freq; ++ s32 real_offset; ++ u32 real_span; ++ ++ u32 psd_band_width; /* unit: Hz */ ++ u32 psd_point; /* 128/256/512/1024 */ ++ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ ++ u32 psd_start_point; ++ u32 psd_stop_point; ++ u32 psd_max_value_point; ++ u32 psd_max_value; ++ u32 psd_start_base; ++ u32 psd_avg_num; /* 1/8/16/32 */ ++ u32 psd_gen_count; ++ boolean is_psd_running; ++ boolean is_psd_show_max_only; ++}; ++ ++/* ******************************************* ++ * The following is interface which will notify coex module. ++ * ******************************************* */ ++void ex_halbtc8822b1ant_power_on_setting(IN struct btc_coexist *btcoexist); ++void ex_halbtc8822b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); ++void ex_halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, ++ IN boolean wifi_only); ++void ex_halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist); ++void ex_halbtc8822b1ant_ips_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8822b1ant_lps_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8822b1ant_scan_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8822b1ant_switchband_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8822b1ant_connect_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8822b1ant_media_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8822b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8822b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8822b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, ++ IN u8 type); ++void ex_halbtc8822b1ant_halt_notify(IN struct btc_coexist *btcoexist); ++void ex_halbtc8822b1ant_pnp_notify(IN struct btc_coexist *btcoexist, ++ IN u8 pnp_state); ++void ex_halbtc8822b1ant_ScoreBoardStatusNotify(IN struct btc_coexist *btcoexist, ++ IN u8 *tmp_buf, IN u8 length); ++void ex_halbtc8822b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); ++void ex_halbtc8822b1ant_periodical(IN struct btc_coexist *btcoexist); ++void ex_halbtc8822b1ant_display_coex_info(IN struct btc_coexist *btcoexist); ++void ex_halbtc8822b1ant_antenna_detection(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++void ex_halbtc8822b1ant_antenna_isolation(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++ ++void ex_halbtc8822b1ant_psd_scan(IN struct btc_coexist *btcoexist, ++ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); ++void ex_halbtc8822b1ant_display_ant_detection(IN struct btc_coexist *btcoexist); ++ ++void ex_halbtc8822b1ant_dbg_control(IN struct btc_coexist *btcoexist, ++ IN u8 op_code, IN u8 op_len, IN u8 *pdata); ++ ++#else ++#define ex_halbtc8822b1ant_power_on_setting(btcoexist) ++#define ex_halbtc8822b1ant_pre_load_firmware(btcoexist) ++#define ex_halbtc8822b1ant_init_hw_config(btcoexist, wifi_only) ++#define ex_halbtc8822b1ant_init_coex_dm(btcoexist) ++#define ex_halbtc8822b1ant_ips_notify(btcoexist, type) ++#define ex_halbtc8822b1ant_lps_notify(btcoexist, type) ++#define ex_halbtc8822b1ant_scan_notify(btcoexist, type) ++#define ex_halbtc8822b1ant_switchband_notify(btcoexist, type) ++#define ex_halbtc8822b1ant_connect_notify(btcoexist, type) ++#define ex_halbtc8822b1ant_media_status_notify(btcoexist, type) ++#define ex_halbtc8822b1ant_specific_packet_notify(btcoexist, type) ++#define ex_halbtc8822b1ant_bt_info_notify(btcoexist, tmp_buf, length) ++#define ex_halbtc8822b1ant_rf_status_notify(btcoexist, type) ++#define ex_halbtc8822b1ant_halt_notify(btcoexist) ++#define ex_halbtc8822b1ant_pnp_notify(btcoexist, pnp_state) ++#define ex_halbtc8822b1ant_ScoreBoardStatusNotify(btcoexist, tmp_buf, length) ++#define ex_halbtc8822b1ant_coex_dm_reset(btcoexist) ++#define ex_halbtc8822b1ant_periodical(btcoexist) ++#define ex_halbtc8822b1ant_display_coex_info(btcoexist) ++#define ex_halbtc8822b1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) ++#define ex_halbtc8822b1ant_antenna_isolation(btcoexist, cent_freq, offset, span, seconds) ++#define ex_halbtc8822b1ant_psd_scan(btcoexist, cent_freq, offset, span, seconds) ++#define ex_halbtc8822b1ant_display_ant_detection(btcoexist) ++#define ex_halbtc8822b1ant_dbg_control(btcoexist, op_code, op_len, pdata) ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtcOutSrc.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtcOutSrc.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtcOutSrc.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtcOutSrc.h 2018-02-11 21:44:27.148146101 +0200 +@@ -0,0 +1,1000 @@ ++#ifndef __HALBTC_OUT_SRC_H__ ++#define __HALBTC_OUT_SRC_H__ ++ ++ ++#define BTC_COEX_OFFLOAD 0 ++#define BTC_TMP_BUF_SHORT 20 ++ ++extern u1Byte gl_btc_trace_buf[]; ++#define BTC_SPRINTF rsprintf ++#define BTC_TRACE(_MSG_)\ ++do {\ ++ if (GLBtcDbgType[COMP_COEX] & BIT(DBG_LOUD)) {\ ++ RTW_INFO("%s", _MSG_);\ ++ } \ ++} while (0) ++#define BT_PrintData(adapter, _MSG_, len, data) RTW_DBG_DUMP((_MSG_), data, len) ++ ++ ++#define NORMAL_EXEC FALSE ++#define FORCE_EXEC TRUE ++ ++#define BTC_RF_OFF 0x0 ++#define BTC_RF_ON 0x1 ++ ++#define BTC_RF_A 0x0 ++#define BTC_RF_B 0x1 ++#define BTC_RF_C 0x2 ++#define BTC_RF_D 0x3 ++ ++#define BTC_SMSP SINGLEMAC_SINGLEPHY ++#define BTC_DMDP DUALMAC_DUALPHY ++#define BTC_DMSP DUALMAC_SINGLEPHY ++#define BTC_MP_UNKNOWN 0xff ++ ++#define BT_COEX_ANT_TYPE_PG 0 ++#define BT_COEX_ANT_TYPE_ANTDIV 1 ++#define BT_COEX_ANT_TYPE_DETECTED 2 ++ ++#define BTC_MIMO_PS_STATIC 0 /* 1ss */ ++#define BTC_MIMO_PS_DYNAMIC 1 /* 2ss */ ++ ++#define BTC_RATE_DISABLE 0 ++#define BTC_RATE_ENABLE 1 ++ ++/* single Antenna definition */ ++#define BTC_ANT_PATH_WIFI 0 ++#define BTC_ANT_PATH_BT 1 ++#define BTC_ANT_PATH_PTA 2 ++#define BTC_ANT_PATH_WIFI5G 3 ++#define BTC_ANT_PATH_AUTO 4 ++/* dual Antenna definition */ ++#define BTC_ANT_WIFI_AT_MAIN 0 ++#define BTC_ANT_WIFI_AT_AUX 1 ++#define BTC_ANT_WIFI_AT_DIVERSITY 2 ++/* coupler Antenna definition */ ++#define BTC_ANT_WIFI_AT_CPL_MAIN 0 ++#define BTC_ANT_WIFI_AT_CPL_AUX 1 ++ ++typedef enum _BTC_POWERSAVE_TYPE { ++ BTC_PS_WIFI_NATIVE = 0, /* wifi original power save behavior */ ++ BTC_PS_LPS_ON = 1, ++ BTC_PS_LPS_OFF = 2, ++ BTC_PS_MAX ++} BTC_POWERSAVE_TYPE, *PBTC_POWERSAVE_TYPE; ++ ++typedef enum _BTC_BT_REG_TYPE { ++ BTC_BT_REG_RF = 0, ++ BTC_BT_REG_MODEM = 1, ++ BTC_BT_REG_BLUEWIZE = 2, ++ BTC_BT_REG_VENDOR = 3, ++ BTC_BT_REG_LE = 4, ++ BTC_BT_REG_MAX ++} BTC_BT_REG_TYPE, *PBTC_BT_REG_TYPE; ++ ++typedef enum _BTC_CHIP_INTERFACE { ++ BTC_INTF_UNKNOWN = 0, ++ BTC_INTF_PCI = 1, ++ BTC_INTF_USB = 2, ++ BTC_INTF_SDIO = 3, ++ BTC_INTF_MAX ++} BTC_CHIP_INTERFACE, *PBTC_CHIP_INTERFACE; ++ ++typedef enum _BTC_CHIP_TYPE { ++ BTC_CHIP_UNDEF = 0, ++ BTC_CHIP_CSR_BC4 = 1, ++ BTC_CHIP_CSR_BC8 = 2, ++ BTC_CHIP_RTL8723A = 3, ++ BTC_CHIP_RTL8821 = 4, ++ BTC_CHIP_RTL8723B = 5, ++ BTC_CHIP_MAX ++} BTC_CHIP_TYPE, *PBTC_CHIP_TYPE; ++ ++/* following is for wifi link status */ ++#define WIFI_STA_CONNECTED BIT0 ++#define WIFI_AP_CONNECTED BIT1 ++#define WIFI_HS_CONNECTED BIT2 ++#define WIFI_P2P_GO_CONNECTED BIT3 ++#define WIFI_P2P_GC_CONNECTED BIT4 ++ ++/* following is for command line utility */ ++#define CL_SPRINTF rsprintf ++#define CL_PRINTF DCMD_Printf ++ ++struct btc_board_info { ++ /* The following is some board information */ ++ u8 bt_chip_type; ++ u8 pg_ant_num; /* pg ant number */ ++ u8 btdm_ant_num; /* ant number for btdm */ ++ u8 btdm_ant_num_by_ant_det; /* ant number for btdm after antenna detection */ ++ u8 btdm_ant_pos; /* Bryant Add to indicate Antenna Position for (pg_ant_num = 2) && (btdm_ant_num =1) (DPDT+1Ant case) */ ++ u8 single_ant_path; /* current used for 8723b only, 1=>s0, 0=>s1 */ ++ boolean tfbga_package; /* for Antenna detect threshold */ ++ boolean btdm_ant_det_finish; ++ u8 ant_type; ++ u8 rfe_type; ++ u8 ant_div_cfg; ++ boolean btdm_ant_det_complete_fail; ++ u8 ant_det_result; ++ boolean ant_det_result_five_complete; ++ u32 antdetval; ++}; ++ ++typedef enum _BTC_DBG_OPCODE { ++ BTC_DBG_SET_COEX_NORMAL = 0x0, ++ BTC_DBG_SET_COEX_WIFI_ONLY = 0x1, ++ BTC_DBG_SET_COEX_BT_ONLY = 0x2, ++ BTC_DBG_SET_COEX_DEC_BT_PWR = 0x3, ++ BTC_DBG_SET_COEX_BT_AFH_MAP = 0x4, ++ BTC_DBG_SET_COEX_BT_IGNORE_WLAN_ACT = 0x5, ++ BTC_DBG_SET_COEX_MANUAL_CTRL = 0x6, ++ BTC_DBG_MAX ++} BTC_DBG_OPCODE, *PBTC_DBG_OPCODE; ++ ++typedef enum _BTC_RSSI_STATE { ++ BTC_RSSI_STATE_HIGH = 0x0, ++ BTC_RSSI_STATE_MEDIUM = 0x1, ++ BTC_RSSI_STATE_LOW = 0x2, ++ BTC_RSSI_STATE_STAY_HIGH = 0x3, ++ BTC_RSSI_STATE_STAY_MEDIUM = 0x4, ++ BTC_RSSI_STATE_STAY_LOW = 0x5, ++ BTC_RSSI_MAX ++} BTC_RSSI_STATE, *PBTC_RSSI_STATE; ++#define BTC_RSSI_HIGH(_rssi_) ((_rssi_ == BTC_RSSI_STATE_HIGH || _rssi_ == BTC_RSSI_STATE_STAY_HIGH) ? TRUE:FALSE) ++#define BTC_RSSI_MEDIUM(_rssi_) ((_rssi_ == BTC_RSSI_STATE_MEDIUM || _rssi_ == BTC_RSSI_STATE_STAY_MEDIUM) ? TRUE:FALSE) ++#define BTC_RSSI_LOW(_rssi_) ((_rssi_ == BTC_RSSI_STATE_LOW || _rssi_ == BTC_RSSI_STATE_STAY_LOW) ? TRUE:FALSE) ++ ++typedef enum _BTC_WIFI_ROLE { ++ BTC_ROLE_STATION = 0x0, ++ BTC_ROLE_AP = 0x1, ++ BTC_ROLE_IBSS = 0x2, ++ BTC_ROLE_HS_MODE = 0x3, ++ BTC_ROLE_MAX ++} BTC_WIFI_ROLE, *PBTC_WIFI_ROLE; ++ ++typedef enum _BTC_WIRELESS_FREQ { ++ BTC_FREQ_2_4G = 0x0, ++ BTC_FREQ_5G = 0x1, ++ BTC_FREQ_MAX ++} BTC_WIRELESS_FREQ, *PBTC_WIRELESS_FREQ; ++ ++typedef enum _BTC_WIFI_BW_MODE { ++ BTC_WIFI_BW_LEGACY = 0x0, ++ BTC_WIFI_BW_HT20 = 0x1, ++ BTC_WIFI_BW_HT40 = 0x2, ++ BTC_WIFI_BW_HT80 = 0x3, ++ BTC_WIFI_BW_HT160 = 0x4, ++ BTC_WIFI_BW_MAX ++} BTC_WIFI_BW_MODE, *PBTC_WIFI_BW_MODE; ++ ++typedef enum _BTC_WIFI_TRAFFIC_DIR { ++ BTC_WIFI_TRAFFIC_TX = 0x0, ++ BTC_WIFI_TRAFFIC_RX = 0x1, ++ BTC_WIFI_TRAFFIC_MAX ++} BTC_WIFI_TRAFFIC_DIR, *PBTC_WIFI_TRAFFIC_DIR; ++ ++typedef enum _BTC_WIFI_PNP { ++ BTC_WIFI_PNP_WAKE_UP = 0x0, ++ BTC_WIFI_PNP_SLEEP = 0x1, ++ BTC_WIFI_PNP_SLEEP_KEEP_ANT = 0x2, ++ BTC_WIFI_PNP_MAX ++} BTC_WIFI_PNP, *PBTC_WIFI_PNP; ++ ++typedef enum _BTC_IOT_PEER { ++ BTC_IOT_PEER_UNKNOWN = 0, ++ BTC_IOT_PEER_REALTEK = 1, ++ BTC_IOT_PEER_REALTEK_92SE = 2, ++ BTC_IOT_PEER_BROADCOM = 3, ++ BTC_IOT_PEER_RALINK = 4, ++ BTC_IOT_PEER_ATHEROS = 5, ++ BTC_IOT_PEER_CISCO = 6, ++ BTC_IOT_PEER_MERU = 7, ++ BTC_IOT_PEER_MARVELL = 8, ++ BTC_IOT_PEER_REALTEK_SOFTAP = 9, /* peer is RealTek SOFT_AP, by Bohn, 2009.12.17 */ ++ BTC_IOT_PEER_SELF_SOFTAP = 10, /* Self is SoftAP */ ++ BTC_IOT_PEER_AIRGO = 11, ++ BTC_IOT_PEER_INTEL = 12, ++ BTC_IOT_PEER_RTK_APCLIENT = 13, ++ BTC_IOT_PEER_REALTEK_81XX = 14, ++ BTC_IOT_PEER_REALTEK_WOW = 15, ++ BTC_IOT_PEER_REALTEK_JAGUAR_BCUTAP = 16, ++ BTC_IOT_PEER_REALTEK_JAGUAR_CCUTAP = 17, ++ BTC_IOT_PEER_MAX, ++} BTC_IOT_PEER, *PBTC_IOT_PEER; ++ ++/* for 8723b-d cut large current issue */ ++typedef enum _BTC_WIFI_COEX_STATE { ++ BTC_WIFI_STAT_INIT, ++ BTC_WIFI_STAT_IQK, ++ BTC_WIFI_STAT_NORMAL_OFF, ++ BTC_WIFI_STAT_MP_OFF, ++ BTC_WIFI_STAT_NORMAL, ++ BTC_WIFI_STAT_ANT_DIV, ++ BTC_WIFI_STAT_MAX ++} BTC_WIFI_COEX_STATE, *PBTC_WIFI_COEX_STATE; ++ ++typedef enum _BTC_ANT_TYPE { ++ BTC_ANT_TYPE_0, ++ BTC_ANT_TYPE_1, ++ BTC_ANT_TYPE_2, ++ BTC_ANT_TYPE_3, ++ BTC_ANT_TYPE_4, ++ BTC_ANT_TYPE_MAX ++} BTC_ANT_TYPE, *PBTC_ANT_TYPE; ++ ++typedef enum _BTC_VENDOR { ++ BTC_VENDOR_LENOVO, ++ BTC_VENDOR_ASUS, ++ BTC_VENDOR_OTHER ++} BTC_VENDOR, *PBTC_VENDOR; ++ ++ ++/* defined for BFP_BTC_GET */ ++typedef enum _BTC_GET_TYPE { ++ /* type BOOLEAN */ ++ BTC_GET_BL_HS_OPERATION, ++ BTC_GET_BL_HS_CONNECTING, ++ BTC_GET_BL_WIFI_CONNECTED, ++ BTC_GET_BL_WIFI_BUSY, ++ BTC_GET_BL_WIFI_SCAN, ++ BTC_GET_BL_WIFI_LINK, ++ BTC_GET_BL_WIFI_ROAM, ++ BTC_GET_BL_WIFI_4_WAY_PROGRESS, ++ BTC_GET_BL_WIFI_UNDER_5G, ++ BTC_GET_BL_WIFI_AP_MODE_ENABLE, ++ BTC_GET_BL_WIFI_ENABLE_ENCRYPTION, ++ BTC_GET_BL_WIFI_UNDER_B_MODE, ++ BTC_GET_BL_EXT_SWITCH, ++ BTC_GET_BL_WIFI_IS_IN_MP_MODE, ++ BTC_GET_BL_IS_ASUS_8723B, ++ ++ /* type s4Byte */ ++ BTC_GET_S4_WIFI_RSSI, ++ BTC_GET_S4_HS_RSSI, ++ ++ /* type u4Byte */ ++ BTC_GET_U4_WIFI_BW, ++ BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, ++ BTC_GET_U4_WIFI_FW_VER, ++ BTC_GET_U4_WIFI_LINK_STATUS, ++ BTC_GET_U4_BT_PATCH_VER, ++ BTC_GET_U4_VENDOR, ++ BTC_GET_U4_SUPPORTED_VERSION, ++ BTC_GET_U4_SUPPORTED_FEATURE, ++ BTC_GET_U4_WIFI_IQK_TOTAL, ++ BTC_GET_U4_WIFI_IQK_OK, ++ BTC_GET_U4_WIFI_IQK_FAIL, ++ ++ /* type u1Byte */ ++ BTC_GET_U1_WIFI_DOT11_CHNL, ++ BTC_GET_U1_WIFI_CENTRAL_CHNL, ++ BTC_GET_U1_WIFI_HS_CHNL, ++ BTC_GET_U1_WIFI_P2P_CHNL, ++ BTC_GET_U1_MAC_PHY_MODE, ++ BTC_GET_U1_AP_NUM, ++ BTC_GET_U1_ANT_TYPE, ++ BTC_GET_U1_IOT_PEER, ++ ++ /*===== for 1Ant ======*/ ++ BTC_GET_U1_LPS_MODE, ++ ++ BTC_GET_MAX ++} BTC_GET_TYPE, *PBTC_GET_TYPE; ++ ++/* defined for BFP_BTC_SET */ ++typedef enum _BTC_SET_TYPE { ++ /* type BOOLEAN */ ++ BTC_SET_BL_BT_DISABLE, ++ BTC_SET_BL_BT_TRAFFIC_BUSY, ++ BTC_SET_BL_BT_LIMITED_DIG, ++ BTC_SET_BL_FORCE_TO_ROAM, ++ BTC_SET_BL_TO_REJ_AP_AGG_PKT, ++ BTC_SET_BL_BT_CTRL_AGG_SIZE, ++ BTC_SET_BL_INC_SCAN_DEV_NUM, ++ BTC_SET_BL_BT_TX_RX_MASK, ++ BTC_SET_BL_MIRACAST_PLUS_BT, ++ ++ /* type u1Byte */ ++ BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, ++ BTC_SET_U1_AGG_BUF_SIZE, ++ ++ /* type trigger some action */ ++ BTC_SET_ACT_GET_BT_RSSI, ++ BTC_SET_ACT_AGGREGATE_CTRL, ++ BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, ++ /*===== for 1Ant ======*/ ++ /* type BOOLEAN */ ++ ++ /* type u1Byte */ ++ BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, ++ BTC_SET_U1_LPS_VAL, ++ BTC_SET_U1_RPWM_VAL, ++ /* type trigger some action */ ++ BTC_SET_ACT_LEAVE_LPS, ++ BTC_SET_ACT_ENTER_LPS, ++ BTC_SET_ACT_NORMAL_LPS, ++ BTC_SET_ACT_DISABLE_LOW_POWER, ++ BTC_SET_ACT_UPDATE_RAMASK, ++ BTC_SET_ACT_SEND_MIMO_PS, ++ /* BT Coex related */ ++ BTC_SET_ACT_CTRL_BT_INFO, ++ BTC_SET_ACT_CTRL_BT_COEX, ++ BTC_SET_ACT_CTRL_8723B_ANT, ++ /*=================*/ ++ BTC_SET_MAX ++} BTC_SET_TYPE, *PBTC_SET_TYPE; ++ ++typedef enum _BTC_DBG_DISP_TYPE { ++ BTC_DBG_DISP_COEX_STATISTICS = 0x0, ++ BTC_DBG_DISP_BT_LINK_INFO = 0x1, ++ BTC_DBG_DISP_WIFI_STATUS = 0x2, ++ BTC_DBG_DISP_MAX ++} BTC_DBG_DISP_TYPE, *PBTC_DBG_DISP_TYPE; ++ ++typedef enum _BTC_NOTIFY_TYPE_IPS { ++ BTC_IPS_LEAVE = 0x0, ++ BTC_IPS_ENTER = 0x1, ++ BTC_IPS_MAX ++} BTC_NOTIFY_TYPE_IPS, *PBTC_NOTIFY_TYPE_IPS; ++typedef enum _BTC_NOTIFY_TYPE_LPS { ++ BTC_LPS_DISABLE = 0x0, ++ BTC_LPS_ENABLE = 0x1, ++ BTC_LPS_MAX ++} BTC_NOTIFY_TYPE_LPS, *PBTC_NOTIFY_TYPE_LPS; ++typedef enum _BTC_NOTIFY_TYPE_SCAN { ++ BTC_SCAN_FINISH = 0x0, ++ BTC_SCAN_START = 0x1, ++ BTC_SCAN_START_2G = 0x2, ++ BTC_SCAN_MAX ++} BTC_NOTIFY_TYPE_SCAN, *PBTC_NOTIFY_TYPE_SCAN; ++typedef enum _BTC_NOTIFY_TYPE_SWITCHBAND { ++ BTC_NOT_SWITCH = 0x0, ++ BTC_SWITCH_TO_24G = 0x1, ++ BTC_SWITCH_TO_5G = 0x2, ++ BTC_SWITCH_TO_24G_NOFORSCAN = 0x3, ++ BTC_SWITCH_MAX ++} BTC_NOTIFY_TYPE_SWITCHBAND, *PBTC_NOTIFY_TYPE_SWITCHBAND; ++typedef enum _BTC_NOTIFY_TYPE_ASSOCIATE { ++ BTC_ASSOCIATE_FINISH = 0x0, ++ BTC_ASSOCIATE_START = 0x1, ++ BTC_ASSOCIATE_5G_FINISH = 0x2, ++ BTC_ASSOCIATE_5G_START = 0x3, ++ BTC_ASSOCIATE_MAX ++} BTC_NOTIFY_TYPE_ASSOCIATE, *PBTC_NOTIFY_TYPE_ASSOCIATE; ++typedef enum _BTC_NOTIFY_TYPE_MEDIA_STATUS { ++ BTC_MEDIA_DISCONNECT = 0x0, ++ BTC_MEDIA_CONNECT = 0x1, ++ BTC_MEDIA_MAX ++} BTC_NOTIFY_TYPE_MEDIA_STATUS, *PBTC_NOTIFY_TYPE_MEDIA_STATUS; ++typedef enum _BTC_NOTIFY_TYPE_SPECIFIC_PACKET { ++ BTC_PACKET_UNKNOWN = 0x0, ++ BTC_PACKET_DHCP = 0x1, ++ BTC_PACKET_ARP = 0x2, ++ BTC_PACKET_EAPOL = 0x3, ++ BTC_PACKET_MAX ++} BTC_NOTIFY_TYPE_SPECIFIC_PACKET, *PBTC_NOTIFY_TYPE_SPECIFIC_PACKET; ++typedef enum _BTC_NOTIFY_TYPE_STACK_OPERATION { ++ BTC_STACK_OP_NONE = 0x0, ++ BTC_STACK_OP_INQ_PAGE_PAIR_START = 0x1, ++ BTC_STACK_OP_INQ_PAGE_PAIR_FINISH = 0x2, ++ BTC_STACK_OP_MAX ++} BTC_NOTIFY_TYPE_STACK_OPERATION, *PBTC_NOTIFY_TYPE_STACK_OPERATION; ++ ++/* Bryant Add */ ++typedef enum _BTC_ANTENNA_POS { ++ BTC_ANTENNA_AT_MAIN_PORT = 0x1, ++ BTC_ANTENNA_AT_AUX_PORT = 0x2, ++} BTC_ANTENNA_POS, *PBTC_ANTENNA_POS; ++ ++/* Bryant Add */ ++typedef enum _BTC_BT_OFFON { ++ BTC_BT_OFF = 0x0, ++ BTC_BT_ON = 0x1, ++} BTC_BTOFFON, *PBTC_BT_OFFON; ++ ++/*================================================== ++For following block is for coex offload ++==================================================*/ ++typedef struct _COL_H2C { ++ u1Byte opcode; ++ u1Byte opcode_ver:4; ++ u1Byte req_num:4; ++ u1Byte buf[1]; ++} COL_H2C, *PCOL_H2C; ++ ++#define COL_C2H_ACK_HDR_LEN 3 ++typedef struct _COL_C2H_ACK { ++ u1Byte status; ++ u1Byte opcode_ver:4; ++ u1Byte req_num:4; ++ u1Byte ret_len; ++ u1Byte buf[1]; ++} COL_C2H_ACK, *PCOL_C2H_ACK; ++ ++#define COL_C2H_IND_HDR_LEN 3 ++typedef struct _COL_C2H_IND { ++ u1Byte type; ++ u1Byte version; ++ u1Byte length; ++ u1Byte data[1]; ++} COL_C2H_IND, *PCOL_C2H_IND; ++ ++/*============================================ ++NOTE: for debug message, the following define should match ++the strings in coexH2cResultString. ++============================================*/ ++typedef enum _COL_H2C_STATUS { ++ /* c2h status */ ++ COL_STATUS_C2H_OK = 0x00, /* Wifi received H2C request and check content ok. */ ++ COL_STATUS_C2H_UNKNOWN = 0x01, /* Not handled routine */ ++ COL_STATUS_C2H_UNKNOWN_OPCODE = 0x02, /* Invalid OP code, It means that wifi firmware received an undefiend OP code. */ ++ COL_STATUS_C2H_OPCODE_VER_MISMATCH = 0x03, /* Wifi firmware and wifi driver mismatch, need to update wifi driver or wifi or. */ ++ COL_STATUS_C2H_PARAMETER_ERROR = 0x04, /* Error paraneter.(ex: parameters = NULL but it should have values) */ ++ COL_STATUS_C2H_PARAMETER_OUT_OF_RANGE = 0x05, /* Wifi firmware needs to check the parameters from H2C request and return the status.(ex: ch = 500, it's wrong) */ ++ /* other COL status start from here */ ++ COL_STATUS_C2H_REQ_NUM_MISMATCH , /* c2h req_num mismatch, means this c2h is not we expected. */ ++ COL_STATUS_H2C_HALMAC_FAIL , /* HALMAC return fail. */ ++ COL_STATUS_H2C_TIMTOUT , /* not received the c2h response from fw */ ++ COL_STATUS_INVALID_C2H_LEN , /* invalid coex offload c2h ack length, must >= 3 */ ++ COL_STATUS_COEX_DATA_OVERFLOW , /* coex returned length over the c2h ack length. */ ++ COL_STATUS_MAX ++} COL_H2C_STATUS, *PCOL_H2C_STATUS; ++ ++#define COL_MAX_H2C_REQ_NUM 16 ++ ++#define COL_H2C_BUF_LEN 20 ++typedef enum _COL_OPCODE { ++ COL_OP_WIFI_STATUS_NOTIFY = 0x0, ++ COL_OP_WIFI_PROGRESS_NOTIFY = 0x1, ++ COL_OP_WIFI_INFO_NOTIFY = 0x2, ++ COL_OP_WIFI_POWER_STATE_NOTIFY = 0x3, ++ COL_OP_SET_CONTROL = 0x4, ++ COL_OP_GET_CONTROL = 0x5, ++ COL_OP_WIFI_OPCODE_MAX ++} COL_OPCODE, *PCOL_OPCODE; ++ ++typedef enum _COL_IND_TYPE { ++ COL_IND_BT_INFO = 0x0, ++ COL_IND_PSTDMA = 0x1, ++ COL_IND_LIMITED_TX_RX = 0x2, ++ COL_IND_COEX_TABLE = 0x3, ++ COL_IND_REQ = 0x4, ++ COL_IND_MAX ++} COL_IND_TYPE, *PCOL_IND_TYPE; ++ ++typedef struct _COL_SINGLE_H2C_RECORD { ++ u1Byte h2c_buf[COL_H2C_BUF_LEN]; /* the latest sent h2c buffer */ ++ u4Byte h2c_len; ++ u1Byte c2h_ack_buf[COL_H2C_BUF_LEN]; /* the latest received c2h buffer */ ++ u4Byte c2h_ack_len; ++ u4Byte count; /* the total number of the sent h2c command */ ++ u4Byte status[COL_STATUS_MAX]; /* the c2h status for the sent h2c command */ ++} COL_SINGLE_H2C_RECORD, *PCOL_SINGLE_H2C_RECORD; ++ ++typedef struct _COL_SINGLE_C2H_IND_RECORD { ++ u1Byte ind_buf[COL_H2C_BUF_LEN]; /* the latest received c2h indication buffer */ ++ u4Byte ind_len; ++ u4Byte count; /* the total number of the rcvd c2h indication */ ++ u4Byte status[COL_STATUS_MAX]; /* the c2h indication verified status */ ++} COL_SINGLE_C2H_IND_RECORD, *PCOL_SINGLE_C2H_IND_RECORD; ++ ++typedef struct _BTC_OFFLOAD { ++ /* H2C command related */ ++ u1Byte h2c_req_num; ++ u4Byte cnt_h2c_sent; ++ COL_SINGLE_H2C_RECORD h2c_record[COL_OP_WIFI_OPCODE_MAX]; ++ ++ /* C2H Ack related */ ++ u4Byte cnt_c2h_ack; ++ u4Byte status[COL_STATUS_MAX]; ++ struct completion c2h_event[COL_MAX_H2C_REQ_NUM]; /* for req_num = 1~COL_MAX_H2C_REQ_NUM */ ++ u1Byte c2h_ack_buf[COL_MAX_H2C_REQ_NUM][COL_H2C_BUF_LEN]; ++ u1Byte c2h_ack_len[COL_MAX_H2C_REQ_NUM]; ++ ++ /* C2H Indication related */ ++ u4Byte cnt_c2h_ind; ++ COL_SINGLE_C2H_IND_RECORD c2h_ind_record[COL_IND_MAX]; ++ u4Byte c2h_ind_status[COL_STATUS_MAX]; ++ u1Byte c2h_ind_buf[COL_H2C_BUF_LEN]; ++ u1Byte c2h_ind_len; ++} BTC_OFFLOAD, *PBTC_OFFLOAD; ++extern BTC_OFFLOAD gl_coex_offload; ++/*==================================================*/ ++ ++typedef u1Byte ++(*BFP_BTC_R1)( ++ IN PVOID pBtcContext, ++ IN u4Byte RegAddr ++ ); ++typedef u2Byte ++(*BFP_BTC_R2)( ++ IN PVOID pBtcContext, ++ IN u4Byte RegAddr ++ ); ++typedef u4Byte ++(*BFP_BTC_R4)( ++ IN PVOID pBtcContext, ++ IN u4Byte RegAddr ++ ); ++typedef VOID ++(*BFP_BTC_W1)( ++ IN PVOID pBtcContext, ++ IN u4Byte RegAddr, ++ IN u1Byte Data ++ ); ++typedef VOID ++(*BFP_BTC_W1_BIT_MASK)( ++ IN PVOID pBtcContext, ++ IN u4Byte regAddr, ++ IN u1Byte bitMask, ++ IN u1Byte data1b ++ ); ++typedef VOID ++(*BFP_BTC_W2)( ++ IN PVOID pBtcContext, ++ IN u4Byte RegAddr, ++ IN u2Byte Data ++ ); ++typedef VOID ++(*BFP_BTC_W4)( ++ IN PVOID pBtcContext, ++ IN u4Byte RegAddr, ++ IN u4Byte Data ++ ); ++typedef VOID ++(*BFP_BTC_LOCAL_REG_W1)( ++ IN PVOID pBtcContext, ++ IN u4Byte RegAddr, ++ IN u1Byte Data ++ ); ++typedef VOID ++(*BFP_BTC_SET_BB_REG)( ++ IN PVOID pBtcContext, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask, ++ IN u4Byte Data ++ ); ++typedef u4Byte ++(*BFP_BTC_GET_BB_REG)( ++ IN PVOID pBtcContext, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask ++ ); ++typedef VOID ++(*BFP_BTC_SET_RF_REG)( ++ IN PVOID pBtcContext, ++ IN u1Byte eRFPath, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask, ++ IN u4Byte Data ++ ); ++typedef u4Byte ++(*BFP_BTC_GET_RF_REG)( ++ IN PVOID pBtcContext, ++ IN u1Byte eRFPath, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask ++ ); ++typedef VOID ++(*BFP_BTC_FILL_H2C)( ++ IN PVOID pBtcContext, ++ IN u1Byte elementId, ++ IN u4Byte cmdLen, ++ IN pu1Byte pCmdBuffer ++ ); ++ ++typedef BOOLEAN ++(*BFP_BTC_GET)( ++ IN PVOID pBtCoexist, ++ IN u1Byte getType, ++ OUT PVOID pOutBuf ++ ); ++ ++typedef BOOLEAN ++(*BFP_BTC_SET)( ++ IN PVOID pBtCoexist, ++ IN u1Byte setType, ++ OUT PVOID pInBuf ++ ); ++typedef u2Byte ++(*BFP_BTC_SET_BT_REG)( ++ IN PVOID pBtcContext, ++ IN u1Byte regType, ++ IN u4Byte offset, ++ IN u4Byte value ++ ); ++typedef BOOLEAN ++(*BFP_BTC_SET_BT_ANT_DETECTION)( ++ IN PVOID pBtcContext, ++ IN u1Byte txTime, ++ IN u1Byte btChnl ++ ); ++ ++typedef BOOLEAN ++(*BFP_BTC_SET_BT_TRX_MASK)( ++ IN PVOID pBtcContext, ++ IN u1Byte bt_trx_mask ++ ); ++ ++typedef u4Byte ++(*BFP_BTC_GET_BT_REG)( ++ IN PVOID pBtcContext, ++ IN u1Byte regType, ++ IN u4Byte offset ++ ); ++typedef VOID ++(*BFP_BTC_DISP_DBG_MSG)( ++ IN PVOID pBtCoexist, ++ IN u1Byte dispType ++ ); ++ ++typedef COL_H2C_STATUS ++(*BFP_BTC_COEX_H2C_PROCESS)( ++ IN PVOID pBtCoexist, ++ IN u1Byte opcode, ++ IN u1Byte opcode_ver, ++ IN pu1Byte ph2c_par, ++ IN u1Byte h2c_par_len ++ ); ++ ++typedef u4Byte ++(*BFP_BTC_GET_BT_COEX_SUPPORTED_FEATURE)( ++ IN PVOID pBtcContext ++ ); ++ ++typedef u4Byte ++(*BFP_BTC_GET_BT_COEX_SUPPORTED_VERSION)( ++ IN PVOID pBtcContext ++ ); ++ ++typedef u4Byte ++(*BFP_BTC_GET_PHYDM_VERSION)( ++ IN PVOID pBtcContext ++ ); ++ ++typedef VOID ++(*BTC_PHYDM_MODIFY_RA_PCR_THRESHLOD)( ++ IN PVOID pDM_Odm, ++ IN u1Byte RA_offset_direction, ++ IN u1Byte RA_threshold_offset ++ ); ++ ++typedef u4Byte ++(*BTC_PHYDM_CMNINFOQUERY)( ++ IN PVOID pDM_Odm, ++ IN u1Byte info_type ++ ); ++ ++typedef u1Byte ++(*BFP_BTC_GET_ANT_DET_VAL_FROM_BT)( ++ ++ IN PVOID pBtcContext ++ ); ++ ++typedef u1Byte ++(*BFP_BTC_GET_BLE_SCAN_TYPE_FROM_BT)( ++ IN PVOID pBtcContext ++ ); ++ ++typedef u4Byte ++(*BFP_BTC_GET_BLE_SCAN_PARA_FROM_BT)( ++ IN PVOID pBtcContext, ++ IN u1Byte scanType ++ ); ++ ++typedef BOOLEAN ++(*BFP_BTC_GET_BT_AFH_MAP_FROM_BT)( ++ IN PVOID pBtcContext, ++ IN u1Byte mapType, ++ OUT pu1Byte afhMap ++ ); ++ ++struct btc_bt_info { ++ boolean bt_disabled; ++ boolean bt_enable_disable_change; ++ u8 rssi_adjust_for_agc_table_on; ++ u8 rssi_adjust_for_1ant_coex_type; ++ boolean pre_bt_ctrl_agg_buf_size; ++ boolean bt_ctrl_agg_buf_size; ++ boolean pre_reject_agg_pkt; ++ boolean reject_agg_pkt; ++ boolean increase_scan_dev_num; ++ boolean bt_tx_rx_mask; ++ u8 pre_agg_buf_size; ++ u8 agg_buf_size; ++ boolean bt_busy; ++ boolean limited_dig; ++ u16 bt_hci_ver; ++ u16 bt_real_fw_ver; ++ u8 bt_fw_ver; ++ u32 get_bt_fw_ver_cnt; ++ u32 bt_get_fw_ver; ++ boolean miracast_plus_bt; ++ ++ boolean bt_disable_low_pwr; ++ ++ boolean bt_ctrl_lps; ++ boolean bt_lps_on; ++ boolean force_to_roam; /* for 1Ant solution */ ++ u8 lps_val; ++ u8 rpwm_val; ++ u32 ra_mask; ++}; ++ ++struct btc_stack_info { ++ boolean profile_notified; ++ u16 hci_version; /* stack hci version */ ++ u8 num_of_link; ++ boolean bt_link_exist; ++ boolean sco_exist; ++ boolean acl_exist; ++ boolean a2dp_exist; ++ boolean hid_exist; ++ u8 num_of_hid; ++ boolean pan_exist; ++ boolean unknown_acl_exist; ++ s8 min_bt_rssi; ++}; ++ ++struct btc_bt_link_info { ++ boolean bt_link_exist; ++ boolean bt_hi_pri_link_exist; ++ boolean sco_exist; ++ boolean sco_only; ++ boolean a2dp_exist; ++ boolean a2dp_only; ++ boolean hid_exist; ++ boolean hid_only; ++ boolean pan_exist; ++ boolean pan_only; ++ boolean slave_role; ++ boolean acl_busy; ++}; ++ ++struct btc_statistics { ++ u32 cnt_bind; ++ u32 cnt_power_on; ++ u32 cnt_pre_load_firmware; ++ u32 cnt_init_hw_config; ++ u32 cnt_init_coex_dm; ++ u32 cnt_ips_notify; ++ u32 cnt_lps_notify; ++ u32 cnt_scan_notify; ++ u32 cnt_connect_notify; ++ u32 cnt_media_status_notify; ++ u32 cnt_specific_packet_notify; ++ u32 cnt_bt_info_notify; ++ u32 cnt_rf_status_notify; ++ u32 cnt_periodical; ++ u32 cnt_coex_dm_switch; ++ u32 cnt_stack_operation_notify; ++ u32 cnt_dbg_ctrl; ++}; ++ ++struct btc_coexist { ++ BOOLEAN bBinded; /*make sure only one adapter can bind the data context*/ ++ PVOID Adapter; /*default adapter*/ ++ struct btc_board_info board_info; ++ struct btc_bt_info bt_info; /*some bt info referenced by non-bt module*/ ++ struct btc_stack_info stack_info; ++ struct btc_bt_link_info bt_link_info; ++ BTC_CHIP_INTERFACE chip_interface; ++ PVOID odm_priv; ++ ++ BOOLEAN initilized; ++ BOOLEAN stop_coex_dm; ++ BOOLEAN manual_control; ++ BOOLEAN bdontenterLPS; ++ pu1Byte cli_buf; ++ struct btc_statistics statistics; ++ u1Byte pwrModeVal[10]; ++ ++ /* function pointers */ ++ /* io related */ ++ BFP_BTC_R1 btc_read_1byte; ++ BFP_BTC_W1 btc_write_1byte; ++ BFP_BTC_W1_BIT_MASK btc_write_1byte_bitmask; ++ BFP_BTC_R2 btc_read_2byte; ++ BFP_BTC_W2 btc_write_2byte; ++ BFP_BTC_R4 btc_read_4byte; ++ BFP_BTC_W4 btc_write_4byte; ++ BFP_BTC_LOCAL_REG_W1 btc_write_local_reg_1byte; ++ /* read/write bb related */ ++ BFP_BTC_SET_BB_REG btc_set_bb_reg; ++ BFP_BTC_GET_BB_REG btc_get_bb_reg; ++ ++ /* read/write rf related */ ++ BFP_BTC_SET_RF_REG btc_set_rf_reg; ++ BFP_BTC_GET_RF_REG btc_get_rf_reg; ++ ++ /* fill h2c related */ ++ BFP_BTC_FILL_H2C btc_fill_h2c; ++ /* other */ ++ BFP_BTC_DISP_DBG_MSG btc_disp_dbg_msg; ++ /* normal get/set related */ ++ BFP_BTC_GET btc_get; ++ BFP_BTC_SET btc_set; ++ ++ BFP_BTC_GET_BT_REG btc_get_bt_reg; ++ BFP_BTC_SET_BT_REG btc_set_bt_reg; ++ ++ BFP_BTC_SET_BT_ANT_DETECTION btc_set_bt_ant_detection; ++ ++ BFP_BTC_COEX_H2C_PROCESS btc_coex_h2c_process; ++ BFP_BTC_SET_BT_TRX_MASK btc_set_bt_trx_mask; ++ BFP_BTC_GET_BT_COEX_SUPPORTED_FEATURE btc_get_bt_coex_supported_feature; ++ BFP_BTC_GET_BT_COEX_SUPPORTED_VERSION btc_get_bt_coex_supported_version; ++ BFP_BTC_GET_PHYDM_VERSION btc_get_bt_phydm_version; ++ BTC_PHYDM_MODIFY_RA_PCR_THRESHLOD btc_phydm_modify_RA_PCR_threshold; ++ BTC_PHYDM_CMNINFOQUERY btc_phydm_query_PHY_counter; ++ BFP_BTC_GET_ANT_DET_VAL_FROM_BT btc_get_ant_det_val_from_bt; ++ BFP_BTC_GET_BLE_SCAN_TYPE_FROM_BT btc_get_ble_scan_type_from_bt; ++ BFP_BTC_GET_BLE_SCAN_PARA_FROM_BT btc_get_ble_scan_para_from_bt; ++ BFP_BTC_GET_BT_AFH_MAP_FROM_BT btc_get_bt_afh_map_from_bt; ++}; ++typedef struct btc_coexist *PBTC_COEXIST; ++ ++extern struct btc_coexist GLBtCoexist; ++ ++BOOLEAN ++EXhalbtcoutsrc_InitlizeVariables( ++ IN PVOID Adapter ++ ); ++VOID ++EXhalbtcoutsrc_PowerOnSetting( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtcoutsrc_PreLoadFirmware( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtcoutsrc_InitHwConfig( ++ IN PBTC_COEXIST pBtCoexist, ++ IN BOOLEAN bWifiOnly ++ ); ++VOID ++EXhalbtcoutsrc_InitCoexDm( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtcoutsrc_IpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtcoutsrc_LpsNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtcoutsrc_ScanNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtcoutsrc_SetAntennaPathNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtcoutsrc_ConnectNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte action ++ ); ++VOID ++EXhalbtcoutsrc_MediaStatusNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN RT_MEDIA_STATUS mediaStatus ++ ); ++VOID ++EXhalbtcoutsrc_SpecificPacketNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte pktType ++ ); ++VOID ++EXhalbtcoutsrc_BtInfoNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN pu1Byte tmpBuf, ++ IN u1Byte length ++ ); ++VOID ++EXhalbtcoutsrc_RfStatusNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtcoutsrc_StackOperationNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++ ); ++VOID ++EXhalbtcoutsrc_HaltNotify( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtcoutsrc_PnpNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte pnpState ++ ); ++VOID ++EXhalbtcoutsrc_CoexDmSwitch( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtcoutsrc_Periodical( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtcoutsrc_DbgControl( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte opCode, ++ IN u1Byte opLen, ++ IN pu1Byte pData ++ ); ++VOID ++EXhalbtcoutsrc_AntennaDetection( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u4Byte centFreq, ++ IN u4Byte offset, ++ IN u4Byte span, ++ IN u4Byte seconds ++ ); ++VOID ++EXhalbtcoutsrc_StackUpdateProfileInfo( ++ VOID ++ ); ++VOID ++EXhalbtcoutsrc_SetHciVersion( ++ IN u2Byte hciVersion ++ ); ++VOID ++EXhalbtcoutsrc_SetBtPatchVersion( ++ IN u2Byte btHciVersion, ++ IN u2Byte btPatchVersion ++ ); ++VOID ++EXhalbtcoutsrc_UpdateMinBtRssi( ++ IN s1Byte btRssi ++ ); ++#if 0 ++VOID ++EXhalbtcoutsrc_SetBtExist( ++ IN BOOLEAN bBtExist ++ ); ++#endif ++VOID ++EXhalbtcoutsrc_SetChipType( ++ IN u1Byte chipType ++ ); ++VOID ++EXhalbtcoutsrc_SetAntNum( ++ IN u1Byte type, ++ IN u1Byte antNum ++ ); ++VOID ++EXhalbtcoutsrc_SetSingleAntPath( ++ IN u1Byte singleAntPath ++ ); ++VOID ++EXhalbtcoutsrc_DisplayBtCoexInfo( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++VOID ++EXhalbtcoutsrc_DisplayAntDetection( ++ IN PBTC_COEXIST pBtCoexist ++ ); ++ ++#define MASKBYTE0 0xff ++#define MASKBYTE1 0xff00 ++#define MASKBYTE2 0xff0000 ++#define MASKBYTE3 0xff000000 ++#define MASKHWORD 0xffff0000 ++#define MASKLWORD 0x0000ffff ++#define MASKDWORD 0xffffffff ++#define MASK12BITS 0xfff ++#define MASKH4BITS 0xf0000000 ++#define MASKOFDM_D 0xffc00000 ++#define MASKCCK 0x3f3f3f3f ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/Mp_Precomp.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/Mp_Precomp.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/btc/Mp_Precomp.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/Mp_Precomp.h 2018-02-11 21:44:27.148146101 +0200 +@@ -0,0 +1,89 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __MP_PRECOMP_H__ ++#define __MP_PRECOMP_H__ ++ ++#include ++#include ++ ++#define BT_TMP_BUF_SIZE 100 ++ ++#ifdef PLATFORM_LINUX ++#define rsprintf snprintf ++#elif defined(PLATFORM_WINDOWS) ++#define rsprintf sprintf_s ++#endif ++ ++#define DCMD_Printf DBG_BT_INFO ++ ++#define delay_ms(ms) rtw_mdelay_os(ms) ++ ++#ifdef bEnable ++#undef bEnable ++#endif ++ ++#define WPP_SOFTWARE_TRACE 0 ++ ++typedef enum _BTC_MSG_COMP_TYPE{ ++ COMP_COEX = 0, ++ COMP_MAX ++}BTC_MSG_COMP_TYPE; ++extern u4Byte GLBtcDbgType[]; ++ ++#define DBG_OFF 0 ++#define DBG_SEC 1 ++#define DBG_SERIOUS 2 ++#define DBG_WARNING 3 ++#define DBG_LOUD 4 ++#define DBG_TRACE 5 ++ ++#ifdef CONFIG_BT_COEXIST ++#define BT_SUPPORT 1 ++#define COEX_SUPPORT 1 ++#define HS_SUPPORT 1 ++#else ++#define BT_SUPPORT 0 ++#define COEX_SUPPORT 0 ++#define HS_SUPPORT 0 ++#endif ++ ++#include "HalBtcOutSrc.h" ++#include "HalBtc8188c2Ant.h" ++#include "HalBtc8192d2Ant.h" ++#include "HalBtc8192e1Ant.h" ++#include "HalBtc8192e2Ant.h" ++#include "HalBtc8723a1Ant.h" ++#include "HalBtc8723a2Ant.h" ++#include "HalBtc8723b1Ant.h" ++#include "HalBtc8723b2Ant.h" ++#include "HalBtc8812a1Ant.h" ++#include "HalBtc8812a2Ant.h" ++#include "HalBtc8821a1Ant.h" ++#include "HalBtc8821a2Ant.h" ++#include "HalBtc8821aCsr2Ant.h" ++#include "HalBtc8703b1Ant.h" ++#include "halbtc8723d1ant.h" ++#include "halbtc8723d2ant.h" ++#include "HalBtc8822b1Ant.h" ++#include "halbtc8821c1ant.h" ++#include "halbtc8821c2ant.h" ++ ++ ++#endif // __MP_PRECOMP_H__ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/efuse_mask.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/efuse_mask.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/efuse_mask.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/efuse_mask.h 2018-02-11 21:44:27.150146132 +0200 +@@ -0,0 +1,98 @@ ++ ++#if DEV_BUS_TYPE == RT_USB_INTERFACE ++ ++#if defined(CONFIG_RTL8188E) ++ #include "rtl8188e/HalEfuseMask8188E_USB.h" ++#endif ++ ++#if defined(CONFIG_RTL8812A) ++ #include "rtl8812a/HalEfuseMask8812A_USB.h" ++#endif ++ ++#if defined(CONFIG_RTL8821A) ++ #include "rtl8812a/HalEfuseMask8821A_USB.h" ++#endif ++ ++#if defined(CONFIG_RTL8192E) ++ #include "rtl8192e/HalEfuseMask8192E_USB.h" ++#endif ++ ++#if defined(CONFIG_RTL8723B) ++ #include "rtl8723b/HalEfuseMask8723B_USB.h" ++#endif ++ ++#if defined(CONFIG_RTL8814A) ++ #include "rtl8814a/HalEfuseMask8814A_USB.h" ++#endif ++ ++#if defined(CONFIG_RTL8703B) ++ #include "rtl8703b/HalEfuseMask8703B_USB.h" ++#endif ++ ++#if defined(CONFIG_RTL8723D) ++ #include "rtl8723d/HalEfuseMask8723D_USB.h" ++#endif ++ ++#if defined(CONFIG_RTL8188F) ++ #include "rtl8188f/HalEfuseMask8188F_USB.h" ++#endif ++ ++#if defined(CONFIG_RTL8822B) ++ #include "rtl8822b/HalEfuseMask8822B_USB.h" ++#endif ++ ++#elif DEV_BUS_TYPE == RT_PCI_INTERFACE ++ ++#if defined(CONFIG_RTL8188E) ++ #include "rtl8188e/HalEfuseMask8188E_PCIE.h" ++#endif ++ ++#if defined(CONFIG_RTL8812A) ++ #include "rtl8812a/HalEfuseMask8812A_PCIE.h" ++#endif ++ ++#if defined(CONFIG_RTL8821A) ++ #include "rtl8812a/HalEfuseMask8821A_PCIE.h" ++#endif ++ ++#if defined(CONFIG_RTL8192E) ++ #include "rtl8192e/HalEfuseMask8192E_PCIE.h" ++#endif ++ ++#if defined(CONFIG_RTL8723B) ++ #include "rtl8723b/HalEfuseMask8723B_PCIE.h" ++#endif ++ ++#if defined(CONFIG_RTL8814A) ++ #include "rtl8814a/HalEfuseMask8814A_PCIE.h" ++#endif ++ ++#if defined(CONFIG_RTL8703B) ++ #include "rtl8703b/HalEfuseMask8703B_PCIE.h" ++#endif ++ ++#if defined(CONFIG_RTL8822B) ++ #include "rtl8822b/HalEfuseMask8822B_PCIE.h" ++#endif ++#if defined(CONFIG_RTL8723D) ++ #include "rtl8723d/HalEfuseMask8723D_PCIE.h" ++#endif ++ ++#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE ++ ++#if defined(CONFIG_RTL8188E) ++ #include "rtl8188e/HalEfuseMask8188E_SDIO.h" ++#endif ++ ++#if defined(CONFIG_RTL8703B) ++ #include "rtl8703b/HalEfuseMask8703B_SDIO.h" ++#endif ++ ++#if defined(CONFIG_RTL8188F) ++ #include "rtl8188f/HalEfuseMask8188F_SDIO.h" ++#endif ++ ++#if defined(CONFIG_RTL8723D) ++ #include "rtl8723d/HalEfuseMask8723D_SDIO.h" ++#endif ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.c 2018-02-11 21:44:27.150146132 +0200 +@@ -0,0 +1,96 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++/*#include "Mp_Precomp.h"*/ ++#include ++ ++#include "HalEfuseMask8723D_PCIE.h" ++ ++/****************************************************************************** ++* MPCIE.TXT ++******************************************************************************/ ++ ++u1Byte Array_MP_8723D_MPCIE[] = { ++ 0xFF, ++ 0xF3, ++ 0x00, ++ 0x0E, ++ 0x70, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x07, ++ 0xF3, ++ 0xFF, ++ 0xFF, ++ 0x7C, ++ 0x70, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++}; ++ ++u2Byte ++EFUSE_GetArrayLen_MP_8723D_MPCIE(VOID) ++{ ++ return sizeof(Array_MP_8723D_MPCIE) / sizeof(u1Byte); ++} ++ ++VOID ++EFUSE_GetMaskArray_MP_8723D_MPCIE( ++ IN OUT pu1Byte Array ++) ++{ ++ u2Byte len = EFUSE_GetArrayLen_MP_8723D_MPCIE(), i = 0; ++ ++ for (i = 0; i < len; ++i) ++ Array[i] = Array_MP_8723D_MPCIE[i]; ++} ++BOOLEAN ++EFUSE_IsAddressMasked_MP_8723D_MPCIE( ++ IN u2Byte Offset ++) ++{ ++ int r = Offset / 16; ++ int c = (Offset % 16) / 2; ++ int result = 0; ++ ++ if (c < 4) /* Upper double word */ ++ result = (Array_MP_8723D_MPCIE[r] & (0x10 << c)); ++ else ++ result = (Array_MP_8723D_MPCIE[r] & (0x01 << (c - 4))); ++ ++ return (result > 0) ? 0 : 1; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.h 2018-02-11 21:44:27.150146132 +0200 +@@ -0,0 +1,37 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++/****************************************************************************** ++* MPCIE.TXT ++******************************************************************************/ ++ ++ ++u2Byte ++EFUSE_GetArrayLen_MP_8723D_MPCIE(VOID); ++ ++VOID ++EFUSE_GetMaskArray_MP_8723D_MPCIE( ++ IN OUT pu1Byte Array ++); ++ ++BOOLEAN ++EFUSE_IsAddressMasked_MP_8723D_MPCIE(/* TC: Test Chip, MP: MP Chip */ ++ IN u2Byte Offset ++); +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.c 2018-02-11 21:44:27.150146132 +0200 +@@ -0,0 +1,93 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++******************************************************************************/ ++ ++#include ++#include "HalEfuseMask8723D_SDIO.h" ++ ++/****************************************************************************** ++* MSDIO.TXT ++******************************************************************************/ ++ ++u1Byte Array_MP_8723D_MSDIO[] = { ++ 0xFF, ++ 0xF3, ++ 0x00, ++ 0x0E, ++ 0x70, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x07, ++ 0xF3, ++ 0xFF, ++ 0xFF, ++ 0xFF, ++ 0xFF, ++ 0xFF, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++}; ++ ++u2Byte ++EFUSE_GetArrayLen_MP_8723D_MSDIO(VOID) ++{ ++ return sizeof(Array_MP_8723D_MSDIO) / sizeof(u1Byte); ++} ++ ++VOID ++EFUSE_GetMaskArray_MP_8723D_MSDIO( ++ IN OUT pu1Byte Array ++) ++{ ++ u2Byte len = EFUSE_GetArrayLen_MP_8723D_MSDIO(), i = 0; ++ ++ for (i = 0; i < len; ++i) ++ Array[i] = Array_MP_8723D_MSDIO[i]; ++} ++BOOLEAN ++EFUSE_IsAddressMasked_MP_8723D_MSDIO( ++ IN u2Byte Offset ++) ++{ ++ int r = Offset / 16; ++ int c = (Offset % 16) / 2; ++ int result = 0; ++ /* Upper double word */ ++ if (c < 4) ++ result = (Array_MP_8723D_MSDIO[r] & (0x10 << c)); ++ else ++ result = (Array_MP_8723D_MSDIO[r] & (0x01 << (c - 4))); ++ ++ return (result > 0) ? 0 : 1; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.h 2018-02-11 21:44:27.150146132 +0200 +@@ -0,0 +1,35 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++******************************************************************************/ ++ ++/****************************************************************************** ++* MSDIO.TXT ++******************************************************************************/ ++ ++u2Byte ++EFUSE_GetArrayLen_MP_8723D_MSDIO(VOID); ++ ++VOID ++EFUSE_GetMaskArray_MP_8723D_MSDIO( ++ IN OUT pu1Byte Array ++); ++/* TC: Test Chip, MP: MP Chip */ ++BOOLEAN ++EFUSE_IsAddressMasked_MP_8723D_MSDIO( ++ IN u2Byte Offset ++); +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.c 2018-02-11 21:44:27.150146132 +0200 +@@ -0,0 +1,97 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++/* #include "Mp_Precomp.h" */ ++/* #include "../odm_precomp.h" */ ++ ++#include ++#include "HalEfuseMask8723D_USB.h" ++/****************************************************************************** ++* MUSB.TXT ++******************************************************************************/ ++ ++u1Byte Array_MP_8723D_MUSB[] = { ++ 0xFF, ++ 0xF3, ++ 0x00, ++ 0x0E, ++ 0x70, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x07, ++ 0xF3, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0xFF, ++ 0xFF, ++ 0xFF, ++ 0xFF, ++ 0xB0, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ 0x00, ++ ++}; ++ ++u2Byte ++EFUSE_GetArrayLen_MP_8723D_MUSB(VOID) ++{ ++ return sizeof(Array_MP_8723D_MUSB) / sizeof(u1Byte); ++} ++ ++VOID ++EFUSE_GetMaskArray_MP_8723D_MUSB( ++ IN OUT pu1Byte Array ++) ++{ ++ u2Byte len = EFUSE_GetArrayLen_MP_8723D_MUSB(), i = 0; ++ ++ for (i = 0; i < len; ++i) ++ Array[i] = Array_MP_8723D_MUSB[i]; ++} ++BOOLEAN ++EFUSE_IsAddressMasked_MP_8723D_MUSB( ++ IN u2Byte Offset ++) ++{ ++ int r = Offset / 16; ++ int c = (Offset % 16) / 2; ++ int result = 0; ++ ++ if (c < 4) /* Upper double word */ ++ result = (Array_MP_8723D_MUSB[r] & (0x10 << c)); ++ else ++ result = (Array_MP_8723D_MUSB[r] & (0x01 << (c - 4))); ++ ++ return (result > 0) ? 0 : 1; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.h 2018-02-11 21:44:27.150146132 +0200 +@@ -0,0 +1,39 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++ ++ ++/****************************************************************************** ++* MUSB.TXT ++******************************************************************************/ ++ ++ ++u2Byte ++EFUSE_GetArrayLen_MP_8723D_MUSB(VOID); ++ ++VOID ++EFUSE_GetMaskArray_MP_8723D_MUSB( ++ IN OUT pu1Byte Array ++); ++ ++BOOLEAN ++EFUSE_IsAddressMasked_MP_8723D_MUSB(/* TC: Test Chip, MP: MP Chip */ ++ IN u2Byte Offset ++); +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_btcoex.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_btcoex.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/hal_btcoex.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_btcoex.c 2018-02-11 21:44:27.150146132 +0200 +@@ -0,0 +1,4411 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define __HAL_BTCOEX_C__ ++ ++#ifdef CONFIG_BT_COEXIST ++ ++#include ++#include ++#include ++ ++/* ************************************ ++ * Global variables ++ * ************************************ */ ++const char *const BtProfileString[] = { ++ "NONE", ++ "A2DP", ++ "PAN", ++ "HID", ++ "SCO", ++}; ++ ++const char *const BtSpecString[] = { ++ "1.0b", ++ "1.1", ++ "1.2", ++ "2.0+EDR", ++ "2.1+EDR", ++ "3.0+HS", ++ "4.0", ++}; ++ ++const char *const BtLinkRoleString[] = { ++ "Master", ++ "Slave", ++}; ++ ++const char *const h2cStaString[] = { ++ "successful", ++ "h2c busy", ++ "rf off", ++ "fw not read", ++}; ++ ++const char *const ioStaString[] = { ++ "success", ++ "can not IO", ++ "rf off", ++ "fw not read", ++ "wait io timeout", ++ "invalid len", ++ "idle Q empty", ++ "insert waitQ fail", ++ "unknown fail", ++ "wrong level", ++ "h2c stopped", ++}; ++ ++const char *const GLBtcWifiBwString[] = { ++ "11bg", ++ "HT20", ++ "HT40", ++ "HT80", ++ "HT160" ++}; ++ ++const char *const GLBtcWifiFreqString[] = { ++ "2.4G", ++ "5G" ++}; ++ ++const char *const GLBtcIotPeerString[] = { ++ "UNKNOWN", ++ "REALTEK", ++ "REALTEK_92SE", ++ "BROADCOM", ++ "RALINK", ++ "ATHEROS", ++ "CISCO", ++ "MERU", ++ "MARVELL", ++ "REALTEK_SOFTAP", /* peer is RealTek SOFT_AP, by Bohn, 2009.12.17 */ ++ "SELF_SOFTAP", /* Self is SoftAP */ ++ "AIRGO", ++ "INTEL", ++ "RTK_APCLIENT", ++ "REALTEK_81XX", ++ "REALTEK_WOW", ++ "REALTEK_JAGUAR_BCUTAP", ++ "REALTEK_JAGUAR_CCUTAP" ++}; ++ ++const char *const coexOpcodeString[] = { ++ "Wifi status notify", ++ "Wifi progress", ++ "Wifi info", ++ "Power state", ++ "Set Control", ++ "Get Control" ++}; ++ ++const char *const coexIndTypeString[] = { ++ "bt info", ++ "pstdma", ++ "limited tx/rx", ++ "coex table", ++ "request" ++}; ++ ++const char *const coexH2cResultString[] = { ++ "ok", ++ "unknown", ++ "un opcode", ++ "opVer MM", ++ "par Err", ++ "par OoR", ++ "reqNum MM", ++ "halMac Fail", ++ "h2c TimeOut", ++ "Invalid c2h Len", ++ "data overflow" ++}; ++ ++#define HALBTCOUTSRC_AGG_CHK_WINDOW_IN_MS 8000 ++ ++struct btc_coexist GLBtCoexist; ++BTC_OFFLOAD gl_coex_offload; ++u8 GLBtcWiFiInScanState; ++u8 GLBtcWiFiInIQKState; ++u8 GLBtcWiFiInIPS; ++u8 GLBtcWiFiInLPS; ++u8 GLBtcBtCoexAliveRegistered; ++ ++/* ++ * BT control H2C/C2H ++ */ ++/* EXT_EID */ ++typedef enum _bt_ext_eid { ++ C2H_WIFI_FW_ACTIVE_RSP = 0, ++ C2H_TRIG_BY_BT_FW ++} BT_EXT_EID; ++ ++/* C2H_STATUS */ ++typedef enum _bt_c2h_status { ++ BT_STATUS_OK = 0, ++ BT_STATUS_VERSION_MISMATCH, ++ BT_STATUS_UNKNOWN_OPCODE, ++ BT_STATUS_ERROR_PARAMETER ++} BT_C2H_STATUS; ++ ++/* C2H BT OP CODES */ ++typedef enum _bt_op_code { ++ BT_OP_GET_BT_VERSION = 0x00, ++ BT_OP_WRITE_REG_ADDR = 0x0c, ++ BT_OP_WRITE_REG_VALUE = 0x0d, ++ ++ BT_OP_READ_REG = 0x11, ++ ++ BT_LO_OP_GET_AFH_MAP_L = 0x1e, ++ BT_LO_OP_GET_AFH_MAP_M = 0x1f, ++ BT_LO_OP_GET_AFH_MAP_H = 0x20, ++ ++ BT_OP_GET_BT_COEX_SUPPORTED_FEATURE = 0x2a, ++ BT_OP_GET_BT_COEX_SUPPORTED_VERSION = 0x2b, ++ BT_OP_GET_BT_ANT_DET_VAL = 0x2c, ++ BT_OP_GET_BT_BLE_SCAN_PARA = 0x2d, ++ BT_OP_GET_BT_BLE_SCAN_TYPE = 0x2e, ++ BT_OP_MAX ++} BT_OP_CODE; ++ ++#define BTC_MPOPER_TIMEOUT 50 /* unit: ms */ ++ ++#define C2H_MAX_SIZE 16 ++u8 GLBtcBtMpOperSeq; ++_mutex GLBtcBtMpOperLock; ++_timer GLBtcBtMpOperTimer; ++_sema GLBtcBtMpRptSema; ++u8 GLBtcBtMpRptSeq; ++u8 GLBtcBtMpRptStatus; ++u8 GLBtcBtMpRptRsp[C2H_MAX_SIZE]; ++u8 GLBtcBtMpRptRspSize; ++u8 GLBtcBtMpRptWait; ++u8 GLBtcBtMpRptWiFiOK; ++u8 GLBtcBtMpRptBTOK; ++ ++/* ++ * Debug ++ */ ++u32 GLBtcDbgType[COMP_MAX]; ++u8 GLBtcDbgBuf[BT_TMP_BUF_SIZE]; ++u1Byte gl_btc_trace_buf[BT_TMP_BUF_SIZE]; ++ ++typedef struct _btcoexdbginfo { ++ u8 *info; ++ u32 size; /* buffer total size */ ++ u32 len; /* now used length */ ++} BTCDBGINFO, *PBTCDBGINFO; ++ ++BTCDBGINFO GLBtcDbgInfo; ++ ++#define BT_Operation(Adapter) _FALSE ++ ++static void DBG_BT_INFO_INIT(PBTCDBGINFO pinfo, u8 *pbuf, u32 size) ++{ ++ if (NULL == pinfo) ++ return; ++ ++ _rtw_memset(pinfo, 0, sizeof(BTCDBGINFO)); ++ ++ if (pbuf && size) { ++ pinfo->info = pbuf; ++ pinfo->size = size; ++ } ++} ++ ++void DBG_BT_INFO(u8 *dbgmsg) ++{ ++ PBTCDBGINFO pinfo; ++ u32 msglen, buflen; ++ u8 *pbuf; ++ ++ ++ pinfo = &GLBtcDbgInfo; ++ ++ if (NULL == pinfo->info) ++ return; ++ ++ msglen = strlen(dbgmsg); ++ if (pinfo->len + msglen > pinfo->size) ++ return; ++ ++ pbuf = pinfo->info + pinfo->len; ++ _rtw_memcpy(pbuf, dbgmsg, msglen); ++ pinfo->len += msglen; ++} ++ ++/* ************************************ ++ * Debug related function ++ * ************************************ */ ++static u8 halbtcoutsrc_IsBtCoexistAvailable(PBTC_COEXIST pBtCoexist) ++{ ++ if (!pBtCoexist->bBinded || ++ NULL == pBtCoexist->Adapter) ++ return _FALSE; ++ return _TRUE; ++} ++ ++static void halbtcoutsrc_DbgInit(void) ++{ ++ u8 i; ++ ++ for (i = 0; i < COMP_MAX; i++) ++ GLBtcDbgType[i] = 0; ++} ++ ++static u8 halbtcoutsrc_IsCsrBtCoex(PBTC_COEXIST pBtCoexist) ++{ ++ if (pBtCoexist->board_info.bt_chip_type == BTC_CHIP_CSR_BC4 ++ || pBtCoexist->board_info.bt_chip_type == BTC_CHIP_CSR_BC8 ++ ) ++ return _TRUE; ++ return _FALSE; ++} ++ ++static void halbtcoutsrc_EnterPwrLock(PBTC_COEXIST pBtCoexist) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj((PADAPTER)pBtCoexist->Adapter); ++ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); ++ ++ _enter_pwrlock(&pwrpriv->lock); ++} ++ ++static void halbtcoutsrc_ExitPwrLock(PBTC_COEXIST pBtCoexist) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj((PADAPTER)pBtCoexist->Adapter); ++ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); ++ ++ _exit_pwrlock(&pwrpriv->lock); ++} ++ ++static u8 halbtcoutsrc_IsHwMailboxExist(PBTC_COEXIST pBtCoexist) ++{ ++ if (pBtCoexist->board_info.bt_chip_type == BTC_CHIP_CSR_BC4 ++ || pBtCoexist->board_info.bt_chip_type == BTC_CHIP_CSR_BC8 ++ ) ++ return _FALSE; ++ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) ++ return _FALSE; ++ else ++ return _TRUE; ++} ++ ++static void halbtcoutsrc_LeaveLps(PBTC_COEXIST pBtCoexist) ++{ ++ PADAPTER padapter; ++ ++ ++ padapter = pBtCoexist->Adapter; ++ ++ pBtCoexist->bt_info.bt_ctrl_lps = _TRUE; ++ pBtCoexist->bt_info.bt_lps_on = _FALSE; ++ ++ rtw_btcoex_LPS_Leave(padapter); ++} ++ ++void halbtcoutsrc_EnterLps(PBTC_COEXIST pBtCoexist) ++{ ++ PADAPTER padapter; ++ ++ ++ padapter = pBtCoexist->Adapter; ++ ++ if (pBtCoexist->bdontenterLPS == _FALSE) { ++ pBtCoexist->bt_info.bt_ctrl_lps = _TRUE; ++ pBtCoexist->bt_info.bt_lps_on = _TRUE; ++ ++ rtw_btcoex_LPS_Enter(padapter); ++ } ++} ++ ++void halbtcoutsrc_NormalLps(PBTC_COEXIST pBtCoexist) ++{ ++ PADAPTER padapter; ++ ++ ++ ++ padapter = pBtCoexist->Adapter; ++ ++ if (pBtCoexist->bt_info.bt_ctrl_lps) { ++ pBtCoexist->bt_info.bt_lps_on = _FALSE; ++ rtw_btcoex_LPS_Leave(padapter); ++ pBtCoexist->bt_info.bt_ctrl_lps = _FALSE; ++ ++ /* recover the LPS state to the original */ ++#if 0 ++ padapter->HalFunc.UpdateLPSStatusHandler( ++ padapter, ++ pPSC->RegLeisurePsMode, ++ pPSC->RegPowerSaveMode); ++#endif ++ } ++} ++ ++/* ++ * Constraint: ++ * 1. this function will request pwrctrl->lock ++ */ ++void halbtcoutsrc_LeaveLowPower(PBTC_COEXIST pBtCoexist) ++{ ++#ifdef CONFIG_LPS_LCLK ++ PADAPTER padapter; ++ PHAL_DATA_TYPE pHalData; ++ struct pwrctrl_priv *pwrctrl; ++ s32 ready; ++ u32 stime; ++ s32 utime; ++ u32 timeout; /* unit: ms */ ++ ++ ++ padapter = pBtCoexist->Adapter; ++ pHalData = GET_HAL_DATA(padapter); ++ pwrctrl = adapter_to_pwrctl(padapter); ++ ready = _FAIL; ++#ifdef LPS_RPWM_WAIT_MS ++ timeout = LPS_RPWM_WAIT_MS; ++#else /* !LPS_RPWM_WAIT_MS */ ++ timeout = 30; ++#endif /* !LPS_RPWM_WAIT_MS */ ++ ++ if (GLBtcBtCoexAliveRegistered == _TRUE) ++ return; ++ ++ stime = rtw_get_current_time(); ++ do { ++ ready = rtw_register_task_alive(padapter, BTCOEX_ALIVE); ++ if (_SUCCESS == ready) ++ break; ++ ++ utime = rtw_get_passing_time_ms(stime); ++ if (utime > timeout) ++ break; ++ ++ rtw_msleep_os(1); ++ } while (1); ++ ++ GLBtcBtCoexAliveRegistered = _TRUE; ++#endif /* CONFIG_LPS_LCLK */ ++} ++ ++/* ++ * Constraint: ++ * 1. this function will request pwrctrl->lock ++ */ ++void halbtcoutsrc_NormalLowPower(PBTC_COEXIST pBtCoexist) ++{ ++#ifdef CONFIG_LPS_LCLK ++ PADAPTER padapter; ++ ++ if (GLBtcBtCoexAliveRegistered == _FALSE) ++ return; ++ ++ padapter = pBtCoexist->Adapter; ++ rtw_unregister_task_alive(padapter, BTCOEX_ALIVE); ++ ++ GLBtcBtCoexAliveRegistered = _FALSE; ++#endif /* CONFIG_LPS_LCLK */ ++} ++ ++void halbtcoutsrc_DisableLowPower(PBTC_COEXIST pBtCoexist, u8 bLowPwrDisable) ++{ ++ pBtCoexist->bt_info.bt_disable_low_pwr = bLowPwrDisable; ++ if (bLowPwrDisable) ++ halbtcoutsrc_LeaveLowPower(pBtCoexist); /* leave 32k low power. */ ++ else ++ halbtcoutsrc_NormalLowPower(pBtCoexist); /* original 32k low power behavior. */ ++} ++ ++void halbtcoutsrc_AggregationCheck(PBTC_COEXIST pBtCoexist) ++{ ++ PADAPTER padapter; ++ BOOLEAN bNeedToAct = _FALSE; ++ static u32 preTime = 0; ++ u32 curTime = 0; ++ ++ padapter = pBtCoexist->Adapter; ++ ++ /* ===================================== */ ++ /* To void continuous deleteBA=>addBA=>deleteBA=>addBA */ ++ /* This function is not allowed to continuous called. */ ++ /* It can only be called after 8 seconds. */ ++ /* ===================================== */ ++ ++ curTime = rtw_systime_to_ms(rtw_get_current_time()); ++ if ((curTime - preTime) < HALBTCOUTSRC_AGG_CHK_WINDOW_IN_MS) /* over 8 seconds you can execute this function again. */ ++ return; ++ else ++ preTime = curTime; ++ ++ if (pBtCoexist->bt_info.reject_agg_pkt) { ++ bNeedToAct = _TRUE; ++ pBtCoexist->bt_info.pre_reject_agg_pkt = pBtCoexist->bt_info.reject_agg_pkt; ++ } else { ++ if (pBtCoexist->bt_info.pre_reject_agg_pkt) { ++ bNeedToAct = _TRUE; ++ pBtCoexist->bt_info.pre_reject_agg_pkt = pBtCoexist->bt_info.reject_agg_pkt; ++ } ++ ++ if (pBtCoexist->bt_info.pre_bt_ctrl_agg_buf_size != ++ pBtCoexist->bt_info.bt_ctrl_agg_buf_size) { ++ bNeedToAct = _TRUE; ++ pBtCoexist->bt_info.pre_bt_ctrl_agg_buf_size = pBtCoexist->bt_info.bt_ctrl_agg_buf_size; ++ } ++ ++ if (pBtCoexist->bt_info.bt_ctrl_agg_buf_size) { ++ if (pBtCoexist->bt_info.pre_agg_buf_size != ++ pBtCoexist->bt_info.agg_buf_size) ++ bNeedToAct = _TRUE; ++ pBtCoexist->bt_info.pre_agg_buf_size = pBtCoexist->bt_info.agg_buf_size; ++ } ++ } ++ ++ if (bNeedToAct) ++ rtw_btcoex_rx_ampdu_apply(padapter); ++} ++ ++u8 halbtcoutsrc_IsWifiBusy(PADAPTER padapter) ++{ ++ if (rtw_mi_check_status(padapter, MI_AP_MODE)) ++ return _TRUE; ++ if (rtw_mi_busy_traffic_check(padapter, _FALSE)) ++ return _TRUE; ++ ++ return _FALSE; ++} ++ ++static u32 _halbtcoutsrc_GetWifiLinkStatus(PADAPTER padapter) ++{ ++ struct mlme_priv *pmlmepriv; ++ u8 bp2p; ++ u32 portConnectedStatus; ++ ++ ++ pmlmepriv = &padapter->mlmepriv; ++ bp2p = _FALSE; ++ portConnectedStatus = 0; ++ ++#ifdef CONFIG_P2P ++ if (!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE)) ++ bp2p = _TRUE; ++#endif /* CONFIG_P2P */ ++ ++ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) { ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { ++ if (_TRUE == bp2p) ++ portConnectedStatus |= WIFI_P2P_GO_CONNECTED; ++ else ++ portConnectedStatus |= WIFI_AP_CONNECTED; ++ } else { ++ if (_TRUE == bp2p) ++ portConnectedStatus |= WIFI_P2P_GC_CONNECTED; ++ else ++ portConnectedStatus |= WIFI_STA_CONNECTED; ++ } ++ } ++ ++ return portConnectedStatus; ++} ++ ++u32 halbtcoutsrc_GetWifiLinkStatus(PBTC_COEXIST pBtCoexist) ++{ ++ /* ================================= */ ++ /* return value: */ ++ /* [31:16]=> connected port number */ ++ /* [15:0]=> port connected bit define */ ++ /* ================================ */ ++ ++ PADAPTER padapter; ++ u32 retVal; ++ u32 portConnectedStatus, numOfConnectedPort; ++ struct dvobj_priv *dvobj; ++ _adapter *iface; ++ int i; ++ ++ padapter = pBtCoexist->Adapter; ++ retVal = 0; ++ portConnectedStatus = 0; ++ numOfConnectedPort = 0; ++ dvobj = adapter_to_dvobj(padapter); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ retVal = _halbtcoutsrc_GetWifiLinkStatus(iface); ++ if (retVal) { ++ portConnectedStatus |= retVal; ++ numOfConnectedPort++; ++ } ++ } ++ } ++ retVal = (numOfConnectedPort << 16) | portConnectedStatus; ++ ++ return retVal; ++} ++ ++static void _btmpoper_timer_hdl(void *p) ++{ ++ if (GLBtcBtMpRptWait) { ++ GLBtcBtMpRptWait = 0; ++ _rtw_up_sema(&GLBtcBtMpRptSema); ++ } ++} ++ ++/* ++ * !IMPORTANT! ++ * Before call this function, caller should acquire "GLBtcBtMpOperLock"! ++ * Othrewise there will be racing problem and something may go wrong. ++ */ ++static u8 _btmpoper_cmd(PBTC_COEXIST pBtCoexist, u8 opcode, u8 opcodever, u8 *cmd, u8 size) ++{ ++ PADAPTER padapter; ++ u8 buf[H2C_BTMP_OPER_LEN] = {0}; ++ u8 buflen; ++ u8 seq; ++ u8 timer_cancelled; ++ s32 ret; ++ ++ ++ if (!cmd && size) ++ size = 0; ++ if ((size + 2) > H2C_BTMP_OPER_LEN) ++ return BT_STATUS_H2C_LENGTH_EXCEEDED; ++ buflen = size + 2; ++ ++ seq = GLBtcBtMpOperSeq & 0xF; ++ GLBtcBtMpOperSeq++; ++ ++ buf[0] = (opcodever & 0xF) | (seq << 4); ++ buf[1] = opcode; ++ if (cmd && size) ++ _rtw_memcpy(buf + 2, cmd, size); ++ ++ GLBtcBtMpRptWait = 1; ++ GLBtcBtMpRptWiFiOK = 0; ++ GLBtcBtMpRptBTOK = 0; ++ GLBtcBtMpRptStatus = 0; ++ padapter = pBtCoexist->Adapter; ++ _set_timer(&GLBtcBtMpOperTimer, BTC_MPOPER_TIMEOUT); ++ if (rtw_hal_fill_h2c_cmd(padapter, H2C_BT_MP_OPER, buflen, buf) == _FAIL) { ++ _cancel_timer(&GLBtcBtMpOperTimer, &timer_cancelled); ++ ret = BT_STATUS_H2C_FAIL; ++ goto exit; ++ } ++ ++ _rtw_down_sema(&GLBtcBtMpRptSema); ++ /* GLBtcBtMpRptWait should be 0 here*/ ++ ++ if (!GLBtcBtMpRptWiFiOK) { ++ RTW_ERR("%s: Didn't get H2C Rsp Event!\n", __FUNCTION__); ++ ret = BT_STATUS_H2C_TIMTOUT; ++ goto exit; ++ } ++ if (!GLBtcBtMpRptBTOK) { ++ RTW_DBG("%s: Didn't get BT response!\n", __FUNCTION__); ++ ret = BT_STATUS_H2C_BT_NO_RSP; ++ goto exit; ++ } ++ if (seq != GLBtcBtMpRptSeq) { ++ RTW_ERR("%s: Sequence number not match!(%d!=%d)!\n", ++ __FUNCTION__, seq, GLBtcBtMpRptSeq); ++ ret = BT_STATUS_C2H_REQNUM_MISMATCH; ++ goto exit; ++ } ++ ++ switch (GLBtcBtMpRptStatus) { ++ /* Examine the status reported from C2H */ ++ case BT_STATUS_OK: ++ ret = BT_STATUS_BT_OP_SUCCESS; ++ RTW_DBG("%s: C2H status = BT_STATUS_BT_OP_SUCCESS\n", __FUNCTION__); ++ break; ++ case BT_STATUS_VERSION_MISMATCH: ++ ret = BT_STATUS_OPCODE_L_VERSION_MISMATCH; ++ RTW_DBG("%s: C2H status = BT_STATUS_OPCODE_L_VERSION_MISMATCH\n", __FUNCTION__); ++ break; ++ case BT_STATUS_UNKNOWN_OPCODE: ++ ret = BT_STATUS_UNKNOWN_OPCODE_L; ++ RTW_DBG("%s: C2H status = MP_BT_STATUS_UNKNOWN_OPCODE_L\n", __FUNCTION__); ++ break; ++ case BT_STATUS_ERROR_PARAMETER: ++ ret = BT_STATUS_PARAMETER_FORMAT_ERROR_L; ++ RTW_DBG("%s: C2H status = MP_BT_STATUS_PARAMETER_FORMAT_ERROR_L\n", __FUNCTION__); ++ break; ++ default: ++ ret = BT_STATUS_UNKNOWN_STATUS_L; ++ RTW_DBG("%s: C2H status = MP_BT_STATUS_UNKNOWN_STATUS_L\n", __FUNCTION__); ++ break; ++ } ++ ++exit: ++ return ret; ++} ++ ++u32 halbtcoutsrc_GetBtPatchVer(PBTC_COEXIST pBtCoexist) ++{ ++ if (pBtCoexist->bt_info.get_bt_fw_ver_cnt <= 5) { ++ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { ++ _irqL irqL; ++ u8 ret; ++ ++ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ ret = _btmpoper_cmd(pBtCoexist, BT_OP_GET_BT_VERSION, 0, NULL, 0); ++ if (BT_STATUS_BT_OP_SUCCESS == ret) { ++ pBtCoexist->bt_info.bt_real_fw_ver = le16_to_cpu(*(u16 *)GLBtcBtMpRptRsp); ++ pBtCoexist->bt_info.bt_fw_ver = *(GLBtcBtMpRptRsp + 2); ++ pBtCoexist->bt_info.get_bt_fw_ver_cnt++; ++ } ++ ++ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ } else { ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ u1Byte dataLen = 2; ++ u1Byte buf[4] = {0}; ++ ++ buf[0] = 0x0; /* OP_Code */ ++ buf[1] = 0x0; /* OP_Code_Length */ ++ BT_SendEventExtBtCoexControl(pBtCoexist->Adapter, _FALSE, dataLen, &buf[0]); ++#endif /* !CONFIG_BT_COEXIST_SOCKET_TRX */ ++ } ++ } ++ ++exit: ++ return pBtCoexist->bt_info.bt_real_fw_ver; ++} ++ ++s32 halbtcoutsrc_GetWifiRssi(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData; ++ s32 UndecoratedSmoothedPWDB = 0; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ ++ UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; ++ ++ return UndecoratedSmoothedPWDB; ++} ++ ++u32 halbtcoutsrc_GetBtCoexSupportedFeature(void *pBtcContext) ++{ ++ PBTC_COEXIST pBtCoexist; ++ u32 ret = BT_STATUS_BT_OP_SUCCESS; ++ u32 data = 0; ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ ++ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { ++ u8 buf[3] = {0}; ++ _irqL irqL; ++ u8 op_code; ++ u8 status; ++ ++ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ op_code = BT_OP_GET_BT_COEX_SUPPORTED_FEATURE; ++ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); ++ if (status == BT_STATUS_BT_OP_SUCCESS) ++ data = le16_to_cpu(*(u16 *)GLBtcBtMpRptRsp); ++ else ++ ret = SET_BT_MP_OPER_RET(op_code, status); ++ ++ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ } else ++ ret = BT_STATUS_NOT_IMPLEMENT; ++ ++ return data; ++} ++ ++u32 halbtcoutsrc_GetBtCoexSupportedVersion(void *pBtcContext) ++{ ++ PBTC_COEXIST pBtCoexist; ++ u32 ret = BT_STATUS_BT_OP_SUCCESS; ++ u32 data = 0xFFFF; ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ ++ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { ++ u8 buf[3] = {0}; ++ _irqL irqL; ++ u8 op_code; ++ u8 status; ++ ++ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ op_code = BT_OP_GET_BT_COEX_SUPPORTED_VERSION; ++ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); ++ if (status == BT_STATUS_BT_OP_SUCCESS) ++ data = le16_to_cpu(*(u16 *)GLBtcBtMpRptRsp); ++ else ++ ret = SET_BT_MP_OPER_RET(op_code, status); ++ ++ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ } else ++ ret = BT_STATUS_NOT_IMPLEMENT; ++ ++ return data; ++} ++ ++static u8 halbtcoutsrc_GetWifiScanAPNum(PADAPTER padapter) ++{ ++ struct mlme_priv *pmlmepriv; ++ struct mlme_ext_priv *pmlmeext; ++ static u8 scan_AP_num = 0; ++ ++ ++ pmlmepriv = &padapter->mlmepriv; ++ pmlmeext = &padapter->mlmeextpriv; ++ ++ if (GLBtcWiFiInScanState == _FALSE) { ++ if (pmlmepriv->num_of_scanned > 0xFF) ++ scan_AP_num = 0xFF; ++ else ++ scan_AP_num = (u8)pmlmepriv->num_of_scanned; ++ } ++ ++ return scan_AP_num; ++} ++ ++u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ PHAL_DATA_TYPE pHalData; ++ struct mlme_ext_priv *mlmeext; ++ u8 bSoftApExist, bVwifiExist; ++ u8 *pu8; ++ s32 *pS4Tmp; ++ u32 *pU4Tmp; ++ u8 *pU1Tmp; ++ u8 ret; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return _FALSE; ++ ++ padapter = pBtCoexist->Adapter; ++ pHalData = GET_HAL_DATA(padapter); ++ mlmeext = &padapter->mlmeextpriv; ++ bSoftApExist = _FALSE; ++ bVwifiExist = _FALSE; ++ pu8 = (u8 *)pOutBuf; ++ pS4Tmp = (s32 *)pOutBuf; ++ pU4Tmp = (u32 *)pOutBuf; ++ pU1Tmp = (u8 *)pOutBuf; ++ ret = _TRUE; ++ ++ switch (getType) { ++ case BTC_GET_BL_HS_OPERATION: ++ *pu8 = _FALSE; ++ ret = _FALSE; ++ break; ++ ++ case BTC_GET_BL_HS_CONNECTING: ++ *pu8 = _FALSE; ++ ret = _FALSE; ++ break; ++ ++ case BTC_GET_BL_WIFI_CONNECTED: ++ *pu8 = (rtw_mi_check_status(padapter, MI_LINKED)) ? _TRUE : _FALSE; ++ break; ++ ++ case BTC_GET_BL_WIFI_BUSY: ++ *pu8 = halbtcoutsrc_IsWifiBusy(padapter); ++ break; ++ ++ case BTC_GET_BL_WIFI_SCAN: ++#if 0 ++ *pu8 = (rtw_mi_check_fwstate(padapter, WIFI_SITE_MONITOR)) ? _TRUE : _FALSE; ++#else ++ /* Use the value of the new variable GLBtcWiFiInScanState to judge whether WiFi is in scan state or not, since the originally used flag ++ WIFI_SITE_MONITOR in fwstate may not be cleared in time */ ++ *pu8 = GLBtcWiFiInScanState; ++#endif ++ break; ++ ++ case BTC_GET_BL_WIFI_LINK: ++ *pu8 = (rtw_mi_check_status(padapter, MI_STA_LINKING)) ? _TRUE : _FALSE; ++ break; ++ ++ case BTC_GET_BL_WIFI_ROAM: ++ *pu8 = (rtw_mi_check_status(padapter, MI_STA_LINKING)) ? _TRUE : _FALSE; ++ break; ++ ++ case BTC_GET_BL_WIFI_4_WAY_PROGRESS: ++ *pu8 = _FALSE; ++ break; ++ ++ case BTC_GET_BL_WIFI_UNDER_5G: ++ *pu8 = (pHalData->CurrentBandType == 1) ? _TRUE : _FALSE; ++ break; ++ ++ case BTC_GET_BL_WIFI_AP_MODE_ENABLE: ++ *pu8 = (rtw_mi_check_status(padapter, MI_AP_MODE)) ? _TRUE : _FALSE; ++ break; ++ ++ case BTC_GET_BL_WIFI_ENABLE_ENCRYPTION: ++ *pu8 = padapter->securitypriv.dot11PrivacyAlgrthm == 0 ? _FALSE : _TRUE; ++ break; ++ ++ case BTC_GET_BL_WIFI_UNDER_B_MODE: ++ if (mlmeext->cur_wireless_mode == WIRELESS_11B) ++ *pu8 = _TRUE; ++ else ++ *pu8 = _FALSE; ++ break; ++ ++ case BTC_GET_BL_WIFI_IS_IN_MP_MODE: ++ if (padapter->registrypriv.mp_mode == 0) ++ *pu8 = _FALSE; ++ else ++ *pu8 = _TRUE; ++ break; ++ ++ case BTC_GET_BL_EXT_SWITCH: ++ *pu8 = _FALSE; ++ break; ++ case BTC_GET_BL_IS_ASUS_8723B: ++ /* Always return FALSE in linux driver since this case is added only for windows driver */ ++ *pu8 = _FALSE; ++ break; ++ ++ case BTC_GET_S4_WIFI_RSSI: ++ *pS4Tmp = halbtcoutsrc_GetWifiRssi(padapter); ++ break; ++ ++ case BTC_GET_S4_HS_RSSI: ++ *pS4Tmp = 0; ++ ret = _FALSE; ++ break; ++ ++ case BTC_GET_U4_WIFI_BW: ++ if (IsLegacyOnly(mlmeext->cur_wireless_mode)) ++ *pU4Tmp = BTC_WIFI_BW_LEGACY; ++ else { ++ switch (pHalData->CurrentChannelBW) { ++ case CHANNEL_WIDTH_20: ++ *pU4Tmp = BTC_WIFI_BW_HT20; ++ break; ++ case CHANNEL_WIDTH_40: ++ *pU4Tmp = BTC_WIFI_BW_HT40; ++ break; ++ case CHANNEL_WIDTH_80: ++ *pU4Tmp = BTC_WIFI_BW_HT80; ++ break; ++ case CHANNEL_WIDTH_160: ++ *pU4Tmp = BTC_WIFI_BW_HT160; ++ break; ++ default: ++ RTW_INFO("[BTCOEX] unkown bandwidth(%d)\n", pHalData->CurrentChannelBW); ++ *pU4Tmp = BTC_WIFI_BW_HT40; ++ break; ++ } ++ ++ } ++ break; ++ ++ case BTC_GET_U4_WIFI_TRAFFIC_DIRECTION: { ++ PRT_LINK_DETECT_T plinkinfo; ++ plinkinfo = &padapter->mlmepriv.LinkDetectInfo; ++ ++ if (plinkinfo->NumTxOkInPeriod > plinkinfo->NumRxOkInPeriod) ++ *pU4Tmp = BTC_WIFI_TRAFFIC_TX; ++ else ++ *pU4Tmp = BTC_WIFI_TRAFFIC_RX; ++ } ++ break; ++ ++ case BTC_GET_U4_WIFI_FW_VER: ++ *pU4Tmp = pHalData->FirmwareVersion << 16; ++ *pU4Tmp |= pHalData->FirmwareSubVersion; ++ break; ++ ++ case BTC_GET_U4_WIFI_LINK_STATUS: ++ *pU4Tmp = halbtcoutsrc_GetWifiLinkStatus(pBtCoexist); ++ break; ++ ++ case BTC_GET_U4_BT_PATCH_VER: ++ *pU4Tmp = halbtcoutsrc_GetBtPatchVer(pBtCoexist); ++ break; ++ ++ case BTC_GET_U4_VENDOR: ++ *pU4Tmp = BTC_VENDOR_OTHER; ++ break; ++ ++ case BTC_GET_U4_SUPPORTED_VERSION: ++ *pU4Tmp = halbtcoutsrc_GetBtCoexSupportedVersion(pBtCoexist); ++ break; ++ case BTC_GET_U4_SUPPORTED_FEATURE: ++ *pU4Tmp = halbtcoutsrc_GetBtCoexSupportedFeature(pBtCoexist); ++ break; ++ ++ case BTC_GET_U4_WIFI_IQK_TOTAL: ++ *pU4Tmp = pHalData->odmpriv.nIQK_Cnt; ++ break; ++ ++ case BTC_GET_U4_WIFI_IQK_OK: ++ *pU4Tmp = pHalData->odmpriv.nIQK_OK_Cnt; ++ break; ++ ++ case BTC_GET_U4_WIFI_IQK_FAIL: ++ *pU4Tmp = pHalData->odmpriv.nIQK_Fail_Cnt; ++ break; ++ ++ case BTC_GET_U1_WIFI_DOT11_CHNL: ++ *pU1Tmp = padapter->mlmeextpriv.cur_channel; ++ break; ++ ++ case BTC_GET_U1_WIFI_CENTRAL_CHNL: ++ *pU1Tmp = pHalData->CurrentChannel; ++ break; ++ ++ case BTC_GET_U1_WIFI_HS_CHNL: ++ *pU1Tmp = 0; ++ ret = _FALSE; ++ break; ++ ++ case BTC_GET_U1_WIFI_P2P_CHNL: ++#ifdef CONFIG_P2P ++ { ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ *pU1Tmp = pwdinfo->operating_channel; ++ } ++#else ++ *pU1Tmp = 0; ++#endif ++ break; ++ ++ case BTC_GET_U1_MAC_PHY_MODE: ++ /* *pU1Tmp = BTC_SMSP; ++ * *pU1Tmp = BTC_DMSP; ++ * *pU1Tmp = BTC_DMDP; ++ * *pU1Tmp = BTC_MP_UNKNOWN; */ ++ break; ++ ++ case BTC_GET_U1_AP_NUM: ++ *pU1Tmp = halbtcoutsrc_GetWifiScanAPNum(padapter); ++ break; ++ case BTC_GET_U1_ANT_TYPE: ++ switch (pHalData->bt_coexist.btAntisolation) { ++ case 0: ++ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_0; ++ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_0; ++ break; ++ case 1: ++ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_1; ++ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_1; ++ break; ++ case 2: ++ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_2; ++ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_2; ++ break; ++ case 3: ++ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_3; ++ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_3; ++ break; ++ case 4: ++ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_4; ++ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_4; ++ break; ++ } ++ break; ++ case BTC_GET_U1_IOT_PEER: ++ *pU1Tmp = mlmeext->mlmext_info.assoc_AP_vendor; ++ break; ++ ++ /* =======1Ant=========== */ ++ case BTC_GET_U1_LPS_MODE: ++ *pU1Tmp = padapter->dvobj->pwrctl_priv.pwr_mode; ++ break; ++ ++ default: ++ ret = _FALSE; ++ break; ++ } ++ ++ return ret; ++} ++ ++u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ PHAL_DATA_TYPE pHalData; ++ u8 *pu8; ++ u8 *pU1Tmp; ++ u32 *pU4Tmp; ++ u8 ret; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ padapter = pBtCoexist->Adapter; ++ pHalData = GET_HAL_DATA(padapter); ++ pu8 = (u8 *)pInBuf; ++ pU1Tmp = (u8 *)pInBuf; ++ pU4Tmp = (u32 *)pInBuf; ++ ret = _TRUE; ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return _FALSE; ++ ++ switch (setType) { ++ /* set some u8 type variables. */ ++ case BTC_SET_BL_BT_DISABLE: ++ pBtCoexist->bt_info.bt_disabled = *pu8; ++ break; ++ ++ case BTC_SET_BL_BT_TRAFFIC_BUSY: ++ pBtCoexist->bt_info.bt_busy = *pu8; ++ break; ++ ++ case BTC_SET_BL_BT_LIMITED_DIG: ++ pBtCoexist->bt_info.limited_dig = *pu8; ++ break; ++ ++ case BTC_SET_BL_FORCE_TO_ROAM: ++ pBtCoexist->bt_info.force_to_roam = *pu8; ++ break; ++ ++ case BTC_SET_BL_TO_REJ_AP_AGG_PKT: ++ pBtCoexist->bt_info.reject_agg_pkt = *pu8; ++ break; ++ ++ case BTC_SET_BL_BT_CTRL_AGG_SIZE: ++ pBtCoexist->bt_info.bt_ctrl_agg_buf_size = *pu8; ++ break; ++ ++ case BTC_SET_BL_INC_SCAN_DEV_NUM: ++ pBtCoexist->bt_info.increase_scan_dev_num = *pu8; ++ break; ++ ++ case BTC_SET_BL_BT_TX_RX_MASK: ++ pBtCoexist->bt_info.bt_tx_rx_mask = *pu8; ++ break; ++ ++ case BTC_SET_BL_MIRACAST_PLUS_BT: ++ pBtCoexist->bt_info.miracast_plus_bt = *pu8; ++ break; ++ ++ /* set some u8 type variables. */ ++ case BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON: ++ pBtCoexist->bt_info.rssi_adjust_for_agc_table_on = *pU1Tmp; ++ break; ++ ++ case BTC_SET_U1_AGG_BUF_SIZE: ++ pBtCoexist->bt_info.agg_buf_size = *pU1Tmp; ++ break; ++ ++ /* the following are some action which will be triggered */ ++ case BTC_SET_ACT_GET_BT_RSSI: ++#if 0 ++ BT_SendGetBtRssiEvent(padapter); ++#else ++ ret = _FALSE; ++#endif ++ break; ++ ++ case BTC_SET_ACT_AGGREGATE_CTRL: ++ halbtcoutsrc_AggregationCheck(pBtCoexist); ++ break; ++ ++ /* =======1Ant=========== */ ++ /* set some u8 type variables. */ ++ case BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE: ++ pBtCoexist->bt_info.rssi_adjust_for_1ant_coex_type = *pU1Tmp; ++ break; ++ ++ case BTC_SET_U1_LPS_VAL: ++ pBtCoexist->bt_info.lps_val = *pU1Tmp; ++ break; ++ ++ case BTC_SET_U1_RPWM_VAL: ++ pBtCoexist->bt_info.rpwm_val = *pU1Tmp; ++ break; ++ ++ /* the following are some action which will be triggered */ ++ case BTC_SET_ACT_LEAVE_LPS: ++ halbtcoutsrc_LeaveLps(pBtCoexist); ++ break; ++ ++ case BTC_SET_ACT_ENTER_LPS: ++ halbtcoutsrc_EnterLps(pBtCoexist); ++ break; ++ ++ case BTC_SET_ACT_NORMAL_LPS: ++ halbtcoutsrc_NormalLps(pBtCoexist); ++ break; ++ ++ case BTC_SET_ACT_DISABLE_LOW_POWER: ++ halbtcoutsrc_DisableLowPower(pBtCoexist, *pu8); ++ break; ++ ++ case BTC_SET_ACT_UPDATE_RAMASK: ++ pBtCoexist->bt_info.ra_mask = *pU4Tmp; ++ ++ if (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) == _TRUE) { ++ struct sta_info *psta; ++ PWLAN_BSSID_EX cur_network; ++ ++ cur_network = &padapter->mlmeextpriv.mlmext_info.network; ++ psta = rtw_get_stainfo(&padapter->stapriv, cur_network->MacAddress); ++ rtw_hal_update_ra_mask(psta, 0); ++ } ++ break; ++ ++ case BTC_SET_ACT_SEND_MIMO_PS: { ++ u8 newMimoPsMode = 3; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ /* *pU1Tmp = 0 use SM_PS static type */ ++ /* *pU1Tmp = 1 disable SM_PS */ ++ if (*pU1Tmp == 0) ++ newMimoPsMode = WLAN_HT_CAP_SM_PS_STATIC; ++ else if (*pU1Tmp == 1) ++ newMimoPsMode = WLAN_HT_CAP_SM_PS_DISABLED; ++ ++ if (check_fwstate(&padapter->mlmepriv , WIFI_ASOC_STATE) == _TRUE) { ++ /* issue_action_SM_PS(padapter, get_my_bssid(&(pmlmeinfo->network)), newMimoPsMode); */ ++ issue_action_SM_PS_wait_ack(padapter , get_my_bssid(&(pmlmeinfo->network)) , newMimoPsMode, 3 , 1); ++ } ++ } ++ break; ++ ++ case BTC_SET_ACT_CTRL_BT_INFO: ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ { ++ u8 dataLen = *pU1Tmp; ++ u8 tmpBuf[BTC_TMP_BUF_SHORT]; ++ if (dataLen) ++ _rtw_memcpy(tmpBuf, pU1Tmp + 1, dataLen); ++ BT_SendEventExtBtInfoControl(padapter, dataLen, &tmpBuf[0]); ++ } ++#else /* !CONFIG_BT_COEXIST_SOCKET_TRX */ ++ ret = _FALSE; ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++ break; ++ ++ case BTC_SET_ACT_CTRL_BT_COEX: ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ { ++ u8 dataLen = *pU1Tmp; ++ u8 tmpBuf[BTC_TMP_BUF_SHORT]; ++ if (dataLen) ++ _rtw_memcpy(tmpBuf, pU1Tmp + 1, dataLen); ++ BT_SendEventExtBtCoexControl(padapter, _FALSE, dataLen, &tmpBuf[0]); ++ } ++#else /* !CONFIG_BT_COEXIST_SOCKET_TRX */ ++ ret = _FALSE; ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++ break; ++ case BTC_SET_ACT_CTRL_8723B_ANT: ++#if 0 ++ { ++ u1Byte dataLen = *pU1Tmp; ++ u1Byte tmpBuf[BTC_TMP_BUF_SHORT]; ++ if (dataLen) ++ PlatformMoveMemory(&tmpBuf[0], pU1Tmp + 1, dataLen); ++ BT_Set8723bAnt(Adapter, dataLen, &tmpBuf[0]); ++ } ++#else ++ ret = _FALSE; ++#endif ++ break; ++ /* ===================== */ ++ default: ++ ret = _FALSE; ++ break; ++ } ++ ++ return ret; ++} ++ ++u8 halbtcoutsrc_UnderIps(PBTC_COEXIST pBtCoexist) ++{ ++ PADAPTER padapter; ++ struct pwrctrl_priv *pwrpriv; ++ u8 bMacPwrCtrlOn; ++ ++ padapter = pBtCoexist->Adapter; ++ pwrpriv = &padapter->dvobj->pwrctl_priv; ++ bMacPwrCtrlOn = _FALSE; ++ ++ if ((_TRUE == pwrpriv->bips_processing) ++ && (IPS_NONE != pwrpriv->ips_mode_req) ++ ) ++ return _TRUE; ++ ++ if (rf_off == pwrpriv->rf_pwrstate) ++ return _TRUE; ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); ++ if (_FALSE == bMacPwrCtrlOn) ++ return _TRUE; ++ ++ return _FALSE; ++} ++ ++u8 halbtcoutsrc_UnderLps(PBTC_COEXIST pBtCoexist) ++{ ++ return GLBtcWiFiInLPS; ++} ++ ++u8 halbtcoutsrc_Under32K(PBTC_COEXIST pBtCoexist) ++{ ++ /* todo: the method to check whether wifi is under 32K or not */ ++ return _FALSE; ++} ++ ++u8 halbtcoutsrc_is_autoload_fail(PBTC_COEXIST pBtCoexist) ++{ ++ PADAPTER padapter; ++ PHAL_DATA_TYPE pHalData; ++ ++ padapter = pBtCoexist->Adapter; ++ pHalData = GET_HAL_DATA(padapter); ++ ++ return pHalData->bautoload_fail_flag; ++} ++ ++u8 halbtcoutsrc_is_fw_ready(PBTC_COEXIST pBtCoexist) ++{ ++ PADAPTER padapter; ++ ++ padapter = pBtCoexist->Adapter; ++ ++ return padapter->bFWReady; ++} ++ ++void halbtcoutsrc_DisplayCoexStatistics(PBTC_COEXIST pBtCoexist) ++{ ++#if 0 ++ PADAPTER padapter = (PADAPTER)pBtCoexist->Adapter; ++ PBT_MGNT pBtMgnt = &padapter->MgntInfo.BtInfo.BtMgnt; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ u8 *cliBuf = pBtCoexist->cliBuf; ++ u1Byte i, j; ++ u1Byte tmpbuf[BTC_TMP_BUF_SHORT]; ++ ++ ++ if (gl_coex_offload.cnt_h2c_sent) { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Coex h2c notify]============"); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = H2c(%d)/Ack(%d)", "Coex h2c/c2h overall statistics", ++ gl_coex_offload.cnt_h2c_sent, gl_coex_offload.cnt_c2h_ack); ++ for (j = 0; j < COL_STATUS_MAX; j++) { ++ if (gl_coex_offload.status[j]) { ++ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, ", %s:%d", coexH2cResultString[j], gl_coex_offload.status[j]); ++ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, BTC_TMP_BUF_SHORT); ++ } ++ } ++ CL_PRINTF(cliBuf); ++ } ++ for (i = 0; i < COL_OP_WIFI_OPCODE_MAX; i++) { ++ if (gl_coex_offload.h2c_record[i].count) { ++ /*==========================================*/ ++ /* H2C result statistics*/ ++ /*==========================================*/ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = total:%d", coexOpcodeString[i], gl_coex_offload.h2c_record[i].count); ++ for (j = 0; j < COL_STATUS_MAX; j++) { ++ if (gl_coex_offload.h2c_record[i].status[j]) { ++ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, ", %s:%d", coexH2cResultString[j], gl_coex_offload.h2c_record[i].status[j]); ++ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, BTC_TMP_BUF_SHORT); ++ } ++ } ++ CL_PRINTF(cliBuf); ++ /*==========================================*/ ++ /* H2C/C2H content*/ ++ /*==========================================*/ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = ", "H2C / C2H content"); ++ for (j = 0; j < gl_coex_offload.h2c_record[i].h2c_len; j++) { ++ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, "%02x ", gl_coex_offload.h2c_record[i].h2c_buf[j]); ++ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, 3); ++ } ++ if (gl_coex_offload.h2c_record[i].c2h_ack_len) { ++ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, "/ ", 2); ++ for (j = 0; j < gl_coex_offload.h2c_record[i].c2h_ack_len; j++) { ++ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, "%02x ", gl_coex_offload.h2c_record[i].c2h_ack_buf[j]); ++ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, 3); ++ } ++ } ++ CL_PRINTF(cliBuf); ++ /*==========================================*/ ++ } ++ } ++ ++ if (gl_coex_offload.cnt_c2h_ind) { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Coex c2h indication]============"); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = Ind(%d)", "C2H indication statistics", ++ gl_coex_offload.cnt_c2h_ind); ++ for (j = 0; j < COL_STATUS_MAX; j++) { ++ if (gl_coex_offload.c2h_ind_status[j]) { ++ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, ", %s:%d", coexH2cResultString[j], gl_coex_offload.c2h_ind_status[j]); ++ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, BTC_TMP_BUF_SHORT); ++ } ++ } ++ CL_PRINTF(cliBuf); ++ } ++ for (i = 0; i < COL_IND_MAX; i++) { ++ if (gl_coex_offload.c2h_ind_record[i].count) { ++ /*==========================================*/ ++ /* H2C result statistics*/ ++ /*==========================================*/ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = total:%d", coexIndTypeString[i], gl_coex_offload.c2h_ind_record[i].count); ++ for (j = 0; j < COL_STATUS_MAX; j++) { ++ if (gl_coex_offload.c2h_ind_record[i].status[j]) { ++ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, ", %s:%d", coexH2cResultString[j], gl_coex_offload.c2h_ind_record[i].status[j]); ++ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, BTC_TMP_BUF_SHORT); ++ } ++ } ++ CL_PRINTF(cliBuf); ++ /*==========================================*/ ++ /* content*/ ++ /*==========================================*/ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = ", "C2H indication content"); ++ for (j = 0; j < gl_coex_offload.c2h_ind_record[i].ind_len; j++) { ++ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, "%02x ", gl_coex_offload.c2h_ind_record[i].ind_buf[j]); ++ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, 3); ++ } ++ CL_PRINTF(cliBuf); ++ /*==========================================*/ ++ } ++ } ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Statistics]============"); ++ CL_PRINTF(cliBuf); ++ ++#if (H2C_USE_IO_THREAD != 1) ++ for (i = 0; i < H2C_STATUS_MAX; i++) { ++ if (pHalData->h2cStatistics[i]) { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s] = %d", "H2C statistics", \ ++ h2cStaString[i], pHalData->h2cStatistics[i]); ++ CL_PRINTF(cliBuf); ++ } ++ } ++#else ++ for (i = 0; i < IO_STATUS_MAX; i++) { ++ if (Adapter->ioComStr.ioH2cStatistics[i]) { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s] = %d", "H2C statistics", \ ++ ioStaString[i], Adapter->ioComStr.ioH2cStatistics[i]); ++ CL_PRINTF(cliBuf); ++ } ++ } ++#endif ++#if 0 ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "lastHMEBoxNum", \ ++ pHalData->LastHMEBoxNum); ++ CL_PRINTF(cliBuf); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x / 0x%x", "LastOkH2c/FirstFailH2c(fwNotRead)", \ ++ pHalData->lastSuccessH2cEid, pHalData->firstFailedH2cEid); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", "c2hIsr/c2hIntr/clr1AF/noRdy/noBuf", \ ++ pHalData->InterruptLog.nIMR_C2HCMD, DBG_Var.c2hInterruptCnt, DBG_Var.c2hClrReadC2hCnt, ++ DBG_Var.c2hNotReadyCnt, DBG_Var.c2hBufAlloFailCnt); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "c2hPacket", \ ++ DBG_Var.c2hPacketCnt); ++ CL_PRINTF(cliBuf); ++#endif ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "Periodical/ DbgCtrl", \ ++ pBtCoexist->statistics.cntPeriodical, pBtCoexist->statistics.cntDbgCtrl); ++ CL_PRINTF(cliBuf); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "PowerOn/InitHw/InitCoexDm/RfStatus", \ ++ pBtCoexist->statistics.cntPowerOn, pBtCoexist->statistics.cntInitHwConfig, pBtCoexist->statistics.cntInitCoexDm, ++ pBtCoexist->statistics.cntRfStatusNotify); ++ CL_PRINTF(cliBuf); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", "Ips/Lps/Scan/Connect/Mstatus", \ ++ pBtCoexist->statistics.cntIpsNotify, pBtCoexist->statistics.cntLpsNotify, ++ pBtCoexist->statistics.cntScanNotify, pBtCoexist->statistics.cntConnectNotify, ++ pBtCoexist->statistics.cntMediaStatusNotify); ++ CL_PRINTF(cliBuf); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "Special pkt/Bt info/ bind", ++ pBtCoexist->statistics.cntSpecialPacketNotify, pBtCoexist->statistics.cntBtInfoNotify, ++ pBtCoexist->statistics.cntBind); ++ CL_PRINTF(cliBuf); ++#endif ++ PADAPTER padapter = pBtCoexist->Adapter; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ u8 *cliBuf = pBtCoexist->cli_buf; ++ ++ if (pHalData->EEPROMBluetoothCoexist == 1) { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Coex Status]============"); ++ CL_PRINTF(cliBuf); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", "IsBtDisabled", rtw_btcoex_IsBtDisabled(padapter)); ++ CL_PRINTF(cliBuf); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", "IsBtControlLps", rtw_btcoex_IsBtControlLps(padapter)); ++ CL_PRINTF(cliBuf); ++ } ++} ++ ++void halbtcoutsrc_DisplayBtLinkInfo(PBTC_COEXIST pBtCoexist) ++{ ++#if 0 ++ PADAPTER padapter = (PADAPTER)pBtCoexist->Adapter; ++ PBT_MGNT pBtMgnt = &padapter->MgntInfo.BtInfo.BtMgnt; ++ u8 *cliBuf = pBtCoexist->cliBuf; ++ u8 i; ++ ++ ++ if (pBtCoexist->stack_info.profile_notified) { ++ for (i = 0; i < pBtMgnt->ExtConfig.NumberOfACL; i++) { ++ if (pBtMgnt->ExtConfig.HCIExtensionVer >= 1) { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", "Bt link type/spec/role", \ ++ BtProfileString[pBtMgnt->ExtConfig.aclLink[i].BTProfile], ++ BtSpecString[pBtMgnt->ExtConfig.aclLink[i].BTCoreSpec], ++ BtLinkRoleString[pBtMgnt->ExtConfig.aclLink[i].linkRole]); ++ CL_PRINTF(cliBuf); ++ } else { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", "Bt link type/spec", \ ++ BtProfileString[pBtMgnt->ExtConfig.aclLink[i].BTProfile], ++ BtSpecString[pBtMgnt->ExtConfig.aclLink[i].BTCoreSpec]); ++ CL_PRINTF(cliBuf); ++ } ++ } ++ } ++#endif ++} ++ ++void halbtcoutsrc_DisplayWifiStatus(PBTC_COEXIST pBtCoexist) ++{ ++ PADAPTER padapter = pBtCoexist->Adapter; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ u8 *cliBuf = pBtCoexist->cli_buf; ++ s32 wifiRssi = 0, btHsRssi = 0; ++ BOOLEAN bScan = _FALSE, bLink = _FALSE, bRoam = _FALSE, bWifiBusy = _FALSE, bWifiUnderBMode = _FALSE; ++ u32 wifiBw = BTC_WIFI_BW_HT20, wifiTrafficDir = BTC_WIFI_TRAFFIC_TX, wifiFreq = BTC_FREQ_2_4G; ++ u32 wifiLinkStatus = 0x0; ++ BOOLEAN bBtHsOn = _FALSE, bLowPower = _FALSE; ++ u8 wifiChnl = 0, wifiP2PChnl = 0, nScanAPNum = 0, FwPSState; ++ u32 iqk_cnt_total = 0, iqk_cnt_ok = 0, iqk_cnt_fail = 0; ++ ++ wifiLinkStatus = halbtcoutsrc_GetWifiLinkStatus(pBtCoexist); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", "STA/vWifi/HS/p2pGo/p2pGc", \ ++ ((wifiLinkStatus & WIFI_STA_CONNECTED) ? 1 : 0), ((wifiLinkStatus & WIFI_AP_CONNECTED) ? 1 : 0), ++ ((wifiLinkStatus & WIFI_HS_CONNECTED) ? 1 : 0), ((wifiLinkStatus & WIFI_P2P_GO_CONNECTED) ? 1 : 0), ++ ((wifiLinkStatus & WIFI_P2P_GC_CONNECTED) ? 1 : 0)); ++ CL_PRINTF(cliBuf); ++ ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", "Link/ Roam/ Scan", \ ++ bLink, bRoam, bScan); ++ CL_PRINTF(cliBuf); ++ ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_IQK_TOTAL, &iqk_cnt_total); ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_IQK_OK, &iqk_cnt_ok); ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_IQK_FAIL, &iqk_cnt_fail); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d %s %s", ++ "IQK All/ OK/ Fail/AutoLoad/FWDL", iqk_cnt_total, iqk_cnt_ok, iqk_cnt_fail, ++ ((halbtcoutsrc_is_autoload_fail(pBtCoexist) == _TRUE) ? "fail":"ok"), ((halbtcoutsrc_is_fw_ready(pBtCoexist) == _TRUE) ? "ok":"fail")); ++ CL_PRINTF(cliBuf); ++ ++ if (wifiLinkStatus & WIFI_STA_CONNECTED) { ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "IOT Peer", GLBtcIotPeerString[padapter->mlmeextpriv.mlmext_info.assoc_AP_vendor]); ++ CL_PRINTF(cliBuf); ++ } ++ ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U1_WIFI_DOT11_CHNL, &wifiChnl); ++ if ((wifiLinkStatus & WIFI_P2P_GO_CONNECTED) || (wifiLinkStatus & WIFI_P2P_GC_CONNECTED)) ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U1_WIFI_P2P_CHNL, &wifiP2PChnl); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dBm/ %d/ %d", "RSSI/ STA_Chnl/ P2P_Chnl", \ ++ wifiRssi -100, wifiChnl, wifiP2PChnl); ++ CL_PRINTF(cliBuf); ++ ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifiFreq); ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); ++ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U1_AP_NUM, &nScanAPNum); ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s/ %s/ %d ", "Band/ BW/ Traffic/ APCnt", \ ++ GLBtcWifiFreqString[wifiFreq], ((bWifiUnderBMode) ? "11b" : GLBtcWifiBwString[wifiBw]), ++ ((!bWifiBusy) ? "idle" : ((BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ? "uplink" : "downlink")), ++ nScanAPNum); ++ CL_PRINTF(cliBuf); ++ ++ /* power status */ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s%s%s", "Power Status", \ ++ ((halbtcoutsrc_UnderIps(pBtCoexist) == _TRUE) ? "IPS ON" : "IPS OFF"), ++ ((halbtcoutsrc_UnderLps(pBtCoexist) == _TRUE) ? ", LPS ON" : ", LPS OFF"), ++ ((halbtcoutsrc_Under32K(pBtCoexist) == _TRUE) ? ", 32k" : "")); ++ CL_PRINTF(cliBuf); ++ ++ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x (0x%x/0x%x)", "Power mode cmd(lps/rpwm)", \ ++ pBtCoexist->pwrModeVal[0], pBtCoexist->pwrModeVal[1], ++ pBtCoexist->pwrModeVal[2], pBtCoexist->pwrModeVal[3], ++ pBtCoexist->pwrModeVal[4], pBtCoexist->pwrModeVal[5], ++ pBtCoexist->bt_info.lps_val, ++ pBtCoexist->bt_info.rpwm_val); ++ CL_PRINTF(cliBuf); ++} ++ ++void halbtcoutsrc_DisplayDbgMsg(void *pBtcContext, u8 dispType) ++{ ++ PBTC_COEXIST pBtCoexist; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ switch (dispType) { ++ case BTC_DBG_DISP_COEX_STATISTICS: ++ halbtcoutsrc_DisplayCoexStatistics(pBtCoexist); ++ break; ++ case BTC_DBG_DISP_BT_LINK_INFO: ++ halbtcoutsrc_DisplayBtLinkInfo(pBtCoexist); ++ break; ++ case BTC_DBG_DISP_WIFI_STATUS: ++ halbtcoutsrc_DisplayWifiStatus(pBtCoexist); ++ break; ++ default: ++ break; ++ } ++} ++ ++/* ************************************ ++ * IO related function ++ * ************************************ */ ++u8 halbtcoutsrc_Read1Byte(void *pBtcContext, u32 RegAddr) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ padapter = pBtCoexist->Adapter; ++ ++ return rtw_read8(padapter, RegAddr); ++} ++ ++u16 halbtcoutsrc_Read2Byte(void *pBtcContext, u32 RegAddr) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ padapter = pBtCoexist->Adapter; ++ ++ return rtw_read16(padapter, RegAddr); ++} ++ ++u32 halbtcoutsrc_Read4Byte(void *pBtcContext, u32 RegAddr) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ padapter = pBtCoexist->Adapter; ++ ++ return rtw_read32(padapter, RegAddr); ++} ++ ++void halbtcoutsrc_Write1Byte(void *pBtcContext, u32 RegAddr, u8 Data) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ padapter = pBtCoexist->Adapter; ++ ++ rtw_write8(padapter, RegAddr, Data); ++} ++ ++void halbtcoutsrc_BitMaskWrite1Byte(void *pBtcContext, u32 regAddr, u8 bitMask, u8 data1b) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ u8 originalValue, bitShift; ++ u8 i; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ padapter = pBtCoexist->Adapter; ++ originalValue = 0; ++ bitShift = 0; ++ ++ if (bitMask != 0xff) { ++ originalValue = rtw_read8(padapter, regAddr); ++ ++ for (i = 0; i <= 7; i++) { ++ if ((bitMask >> i) & 0x1) ++ break; ++ } ++ bitShift = i; ++ ++ data1b = (originalValue & ~bitMask) | ((data1b << bitShift) & bitMask); ++ } ++ ++ rtw_write8(padapter, regAddr, data1b); ++} ++ ++void halbtcoutsrc_Write2Byte(void *pBtcContext, u32 RegAddr, u16 Data) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ padapter = pBtCoexist->Adapter; ++ ++ rtw_write16(padapter, RegAddr, Data); ++} ++ ++void halbtcoutsrc_Write4Byte(void *pBtcContext, u32 RegAddr, u32 Data) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ padapter = pBtCoexist->Adapter; ++ ++ rtw_write32(padapter, RegAddr, Data); ++} ++ ++void halbtcoutsrc_WriteLocalReg1Byte(void *pBtcContext, u32 RegAddr, u8 Data) ++{ ++ PBTC_COEXIST pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ PADAPTER Adapter = pBtCoexist->Adapter; ++ ++ if (BTC_INTF_SDIO == pBtCoexist->chip_interface) ++ rtw_write8(Adapter, SDIO_LOCAL_BASE | RegAddr, Data); ++ else ++ rtw_write8(Adapter, RegAddr, Data); ++} ++ ++void halbtcoutsrc_SetBbReg(void *pBtcContext, u32 RegAddr, u32 BitMask, u32 Data) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ padapter = pBtCoexist->Adapter; ++ ++ PHY_SetBBReg(padapter, RegAddr, BitMask, Data); ++} ++ ++ ++u32 halbtcoutsrc_GetBbReg(void *pBtcContext, u32 RegAddr, u32 BitMask) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ padapter = pBtCoexist->Adapter; ++ ++ return PHY_QueryBBReg(padapter, RegAddr, BitMask); ++} ++ ++void halbtcoutsrc_SetRfReg(void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMask, u32 Data) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ padapter = pBtCoexist->Adapter; ++ ++ PHY_SetRFReg(padapter, eRFPath, RegAddr, BitMask, Data); ++} ++ ++u32 halbtcoutsrc_GetRfReg(void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMask) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ padapter = pBtCoexist->Adapter; ++ ++ return PHY_QueryRFReg(padapter, eRFPath, RegAddr, BitMask); ++} ++ ++u16 halbtcoutsrc_SetBtReg(void *pBtcContext, u8 RegType, u32 RegAddr, u32 Data) ++{ ++ PBTC_COEXIST pBtCoexist; ++ u16 ret = BT_STATUS_BT_OP_SUCCESS; ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ ++ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { ++ u8 buf[3] = {0}; ++ _irqL irqL; ++ u8 op_code; ++ u8 status; ++ ++ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ Data = cpu_to_le32(Data); ++ op_code = BT_OP_WRITE_REG_VALUE; ++ status = _btmpoper_cmd(pBtCoexist, op_code, 0, (u8 *)&Data, 3); ++ if (status != BT_STATUS_BT_OP_SUCCESS) ++ ret = SET_BT_MP_OPER_RET(op_code, status); ++ else { ++ buf[0] = RegType; ++ *(u16 *)(buf + 1) = cpu_to_le16((u16)RegAddr); ++ op_code = BT_OP_WRITE_REG_ADDR; ++ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 3); ++ if (status != BT_STATUS_BT_OP_SUCCESS) ++ ret = SET_BT_MP_OPER_RET(op_code, status); ++ } ++ ++ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ } else ++ ret = BT_STATUS_NOT_IMPLEMENT; ++ ++ return ret; ++} ++ ++u8 halbtcoutsrc_SetBtAntDetection(void *pBtcContext, u8 txTime, u8 btChnl) ++{ ++ /* Always return _FALSE since we don't implement this yet */ ++#if 0 ++ PBTC_COEXIST pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ PADAPTER Adapter = pBtCoexist->Adapter; ++ u1Byte btCanTx = 0; ++ BOOLEAN bStatus = FALSE; ++ ++ bStatus = NDBG_SetBtAntDetection(Adapter, txTime, btChnl, &btCanTx); ++ if (bStatus && btCanTx) ++ return _TRUE; ++ else ++ return _FALSE; ++#else ++ return _FALSE; ++#endif ++} ++ ++BOOLEAN ++halbtcoutsrc_SetBtTRXMASK( ++ IN PVOID pBtcContext, ++ IN u1Byte bt_trx_mask ++ ) ++{ ++#if 0 ++ struct btc_coexist *pBtCoexist=(struct btc_coexist *)pBtcContext; ++ PADAPTER Adapter=pBtCoexist->Adapter; ++ BOOLEAN bStatus=FALSE; ++ u1Byte btCanTx=0; ++ ++ if(IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) ++ { ++ bStatus = NDBG_SetBtTRXMASK(Adapter, 1, bt_trx_mask, &btCanTx); ++ } ++ ++ ++ if(bStatus && btCanTx) ++ return TRUE; ++ else ++ return FALSE; ++#else ++ return _FALSE; ++#endif ++} ++ ++u16 halbtcoutsrc_GetBtReg_with_status(void *pBtcContext, u8 RegType, u32 RegAddr, u32 *data) ++{ ++ PBTC_COEXIST pBtCoexist; ++ u16 ret = BT_STATUS_BT_OP_SUCCESS; ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ ++ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { ++ u8 buf[3] = {0}; ++ _irqL irqL; ++ u8 op_code; ++ u8 status; ++ ++ buf[0] = RegType; ++ *(u16 *)(buf + 1) = cpu_to_le16((u16)RegAddr); ++ ++ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ op_code = BT_OP_READ_REG; ++ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 3); ++ if (status == BT_STATUS_BT_OP_SUCCESS) ++ *data = le16_to_cpu(*(u16 *)GLBtcBtMpRptRsp); ++ else ++ ret = SET_BT_MP_OPER_RET(op_code, status); ++ ++ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ } else ++ ret = BT_STATUS_NOT_IMPLEMENT; ++ ++ return ret; ++} ++ ++u32 halbtcoutsrc_GetBtReg(void *pBtcContext, u8 RegType, u32 RegAddr) ++{ ++ u32 regVal; ++ ++ return (BT_STATUS_BT_OP_SUCCESS == halbtcoutsrc_GetBtReg_with_status(pBtcContext, RegType, RegAddr, ®Val)) ? regVal : 0xffffffff; ++} ++ ++void halbtcoutsrc_FillH2cCmd(void *pBtcContext, u8 elementId, u32 cmdLen, u8 *pCmdBuffer) ++{ ++ PBTC_COEXIST pBtCoexist; ++ PADAPTER padapter; ++ ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ padapter = pBtCoexist->Adapter; ++ ++ rtw_hal_fill_h2c_cmd(padapter, elementId, cmdLen, pCmdBuffer); ++} ++ ++static void halbtcoutsrc_coex_offload_init(void) ++{ ++ u1Byte i; ++ ++ gl_coex_offload.h2c_req_num = 0; ++ gl_coex_offload.cnt_h2c_sent = 0; ++ gl_coex_offload.cnt_c2h_ack = 0; ++ gl_coex_offload.cnt_c2h_ind = 0; ++ ++ for (i = 0; i < COL_MAX_H2C_REQ_NUM; i++) ++ init_completion(&gl_coex_offload.c2h_event[i]); ++} ++ ++static COL_H2C_STATUS halbtcoutsrc_send_h2c(PADAPTER Adapter, PCOL_H2C pcol_h2c, u16 h2c_cmd_len) ++{ ++ COL_H2C_STATUS h2c_status = COL_STATUS_C2H_OK; ++ u8 i; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0)) ++ reinit_completion(&gl_coex_offload.c2h_event[pcol_h2c->req_num]); /* set event to un signaled state */ ++#else ++ INIT_COMPLETION(gl_coex_offload.c2h_event[pcol_h2c->req_num]); ++#endif ++ ++ if (TRUE) { ++#if 0 /*(USE_HAL_MAC_API == 1) */ ++ if (RT_STATUS_SUCCESS == HAL_MAC_Send_BT_COEX(&GET_HAL_MAC_INFO(Adapter), (pu1Byte)(pcol_h2c), (u4Byte)h2c_cmd_len, 1)) { ++ if (!wait_for_completion_timeout(&gl_coex_offload.c2h_event[pcol_h2c->req_num], 20)) { ++ h2c_status = COL_STATUS_H2C_TIMTOUT; ++ } ++ } else { ++ h2c_status = COL_STATUS_H2C_HALMAC_FAIL; ++ } ++#endif ++ } ++ ++ return h2c_status; ++} ++ ++static COL_H2C_STATUS halbtcoutsrc_check_c2h_ack(PADAPTER Adapter, PCOL_SINGLE_H2C_RECORD pH2cRecord) ++{ ++ COL_H2C_STATUS c2h_status = COL_STATUS_C2H_OK; ++ PCOL_H2C p_h2c_cmd = (PCOL_H2C)&pH2cRecord->h2c_buf[0]; ++ u8 req_num = p_h2c_cmd->req_num; ++ PCOL_C2H_ACK p_c2h_ack = (PCOL_C2H_ACK)&gl_coex_offload.c2h_ack_buf[req_num]; ++ ++ ++ if ((COL_C2H_ACK_HDR_LEN + p_c2h_ack->ret_len) > gl_coex_offload.c2h_ack_len[req_num]) { ++ c2h_status = COL_STATUS_COEX_DATA_OVERFLOW; ++ return c2h_status; ++ } ++ /* else */ ++ { ++ _rtw_memmove(&pH2cRecord->c2h_ack_buf[0], &gl_coex_offload.c2h_ack_buf[req_num], gl_coex_offload.c2h_ack_len[req_num]); ++ pH2cRecord->c2h_ack_len = gl_coex_offload.c2h_ack_len[req_num]; ++ } ++ ++ ++ if (p_c2h_ack->req_num != p_h2c_cmd->req_num) { ++ c2h_status = COL_STATUS_C2H_REQ_NUM_MISMATCH; ++ } else if (p_c2h_ack->opcode_ver != p_h2c_cmd->opcode_ver) { ++ c2h_status = COL_STATUS_C2H_OPCODE_VER_MISMATCH; ++ } else { ++ c2h_status = p_c2h_ack->status; ++ } ++ ++ return c2h_status; ++} ++ ++COL_H2C_STATUS halbtcoutsrc_CoexH2cProcess(void *pBtCoexist, ++ u8 opcode, u8 opcode_ver, u8 *ph2c_par, u8 h2c_par_len) ++{ ++ PADAPTER Adapter = ((struct btc_coexist *)pBtCoexist)->Adapter; ++ u8 H2C_Parameter[BTC_TMP_BUF_SHORT] = {0}; ++ PCOL_H2C pcol_h2c = (PCOL_H2C)&H2C_Parameter[0]; ++ u16 paraLen = 0; ++ COL_H2C_STATUS h2c_status = COL_STATUS_C2H_OK, c2h_status = COL_STATUS_C2H_OK; ++ COL_H2C_STATUS ret_status = COL_STATUS_C2H_OK; ++ u16 i, col_h2c_len = 0; ++ ++ pcol_h2c->opcode = opcode; ++ pcol_h2c->opcode_ver = opcode_ver; ++ pcol_h2c->req_num = gl_coex_offload.h2c_req_num; ++ gl_coex_offload.h2c_req_num++; ++ gl_coex_offload.h2c_req_num %= 16; ++ ++ _rtw_memmove(&pcol_h2c->buf[0], ph2c_par, h2c_par_len); ++ ++ ++ col_h2c_len = h2c_par_len + 2; /* 2=sizeof(OPCode, OPCode_version and Request number) */ ++ BT_PrintData(Adapter, "[COL], H2C cmd: ", col_h2c_len, H2C_Parameter); ++ ++ gl_coex_offload.cnt_h2c_sent++; ++ ++ gl_coex_offload.h2c_record[opcode].count++; ++ gl_coex_offload.h2c_record[opcode].h2c_len = col_h2c_len; ++ _rtw_memmove((PVOID)&gl_coex_offload.h2c_record[opcode].h2c_buf[0], (PVOID)pcol_h2c, col_h2c_len); ++ ++ h2c_status = halbtcoutsrc_send_h2c(Adapter, pcol_h2c, col_h2c_len); ++ ++ gl_coex_offload.h2c_record[opcode].c2h_ack_len = 0; ++ ++ if (COL_STATUS_C2H_OK == h2c_status) { ++ /* if reach here, it means H2C get the correct c2h response, */ ++ c2h_status = halbtcoutsrc_check_c2h_ack(Adapter, &gl_coex_offload.h2c_record[opcode]); ++ ret_status = c2h_status; ++ } else { ++ /* check h2c status error, return error status code to upper layer. */ ++ ret_status = h2c_status; ++ } ++ gl_coex_offload.h2c_record[opcode].status[ret_status]++; ++ gl_coex_offload.status[ret_status]++; ++ ++ return ret_status; ++} ++ ++u8 halbtcoutsrc_GetAntDetValFromBt(void *pBtcContext) ++{ ++ /* Always return 0 since we don't implement this yet */ ++#if 0 ++ struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; ++ PADAPTER Adapter = pBtCoexist->Adapter; ++ u1Byte AntDetVal = 0x0; ++ u1Byte opcodeVer = 1; ++ BOOLEAN status = false; ++ ++ status = NDBG_GetAntDetValFromBt(Adapter, opcodeVer, &AntDetVal); ++ ++ RT_TRACE(COMP_DBG, DBG_LOUD, ("$$$ halbtcoutsrc_GetAntDetValFromBt(): status = %d, feature = %x\n", status, AntDetVal)); ++ ++ return AntDetVal; ++#else ++ return 0; ++#endif ++} ++ ++u8 halbtcoutsrc_GetBleScanTypeFromBt(void *pBtcContext) ++{ ++ PBTC_COEXIST pBtCoexist; ++ u32 ret = BT_STATUS_BT_OP_SUCCESS; ++ u8 data = 0; ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ ++ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { ++ u8 buf[3] = {0}; ++ _irqL irqL; ++ u8 op_code; ++ u8 status; ++ ++ ++ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ op_code = BT_OP_GET_BT_BLE_SCAN_TYPE; ++ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); ++ if (status == BT_STATUS_BT_OP_SUCCESS) ++ data = *(u8 *)GLBtcBtMpRptRsp; ++ else ++ ret = SET_BT_MP_OPER_RET(op_code, status); ++ ++ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ } else ++ ret = BT_STATUS_NOT_IMPLEMENT; ++ ++ return data; ++} ++ ++u32 halbtcoutsrc_GetBleScanParaFromBt(void *pBtcContext, u8 scanType) ++{ ++ PBTC_COEXIST pBtCoexist; ++ u32 ret = BT_STATUS_BT_OP_SUCCESS; ++ u32 data = 0; ++ ++ pBtCoexist = (PBTC_COEXIST)pBtcContext; ++ ++ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { ++ u8 buf[3] = {0}; ++ _irqL irqL; ++ u8 op_code; ++ u8 status; ++ ++ ++ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ op_code = BT_OP_GET_BT_BLE_SCAN_PARA; ++ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); ++ if (status == BT_STATUS_BT_OP_SUCCESS) ++ data = le32_to_cpu(*(u32 *)GLBtcBtMpRptRsp); ++ else ++ ret = SET_BT_MP_OPER_RET(op_code, status); ++ ++ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ } else ++ ret = BT_STATUS_NOT_IMPLEMENT; ++ ++ return data; ++} ++ ++u8 halbtcoutsrc_GetBtAFHMapFromBt(void *pBtcContext, u8 mapType, u8 *afhMap) ++{ ++ struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; ++ u8 buf[2] = {0}; ++ _irqL irqL; ++ u8 op_code; ++ u32 *AfhMapL = (u32 *)&(afhMap[0]); ++ u32 *AfhMapM = (u32 *)&(afhMap[4]); ++ u16 *AfhMapH = (u16 *)&(afhMap[8]); ++ u8 status; ++ u32 ret = BT_STATUS_BT_OP_SUCCESS; ++ ++ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _FALSE) ++ return _FALSE; ++ ++ buf[0] = 0; ++ buf[1] = mapType; ++ ++ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ op_code = BT_LO_OP_GET_AFH_MAP_L; ++ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); ++ if (status == BT_STATUS_BT_OP_SUCCESS) ++ *AfhMapL = le32_to_cpu(*(u32 *)GLBtcBtMpRptRsp); ++ else { ++ ret = SET_BT_MP_OPER_RET(op_code, status); ++ goto exit; ++ } ++ ++ op_code = BT_LO_OP_GET_AFH_MAP_M; ++ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); ++ if (status == BT_STATUS_BT_OP_SUCCESS) ++ *AfhMapM = le32_to_cpu(*(u32 *)GLBtcBtMpRptRsp); ++ else { ++ ret = SET_BT_MP_OPER_RET(op_code, status); ++ goto exit; ++ } ++ ++ op_code = BT_LO_OP_GET_AFH_MAP_H; ++ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); ++ if (status == BT_STATUS_BT_OP_SUCCESS) ++ *AfhMapH = le16_to_cpu(*(u16 *)GLBtcBtMpRptRsp); ++ else { ++ ret = SET_BT_MP_OPER_RET(op_code, status); ++ goto exit; ++ } ++ ++exit: ++ ++ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); ++ ++ return (ret == BT_STATUS_BT_OP_SUCCESS) ? _TRUE : _FALSE; ++} ++ ++u32 halbtcoutsrc_GetPhydmVersion(void *pBtcContext) ++{ ++ struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; ++ PADAPTER Adapter = pBtCoexist->Adapter; ++ ++#ifdef CONFIG_RTL8192E ++ return RELEASE_VERSION_8192E; ++#endif ++ ++#ifdef CONFIG_RTL8821A ++ return RELEASE_VERSION_8821A; ++#endif ++ ++#ifdef CONFIG_RTL8723B ++ return RELEASE_VERSION_8723B; ++#endif ++ ++#ifdef CONFIG_RTL8812A ++ return RELEASE_VERSION_8812A; ++#endif ++ ++#ifdef CONFIG_RTL8703B ++ return RELEASE_VERSION_8703B; ++#endif ++ ++#ifdef CONFIG_RTL8822B ++ return RELEASE_VERSION_8822B; ++#endif ++ ++#ifdef CONFIG_RTL8723D ++ return RELEASE_VERSION_8723D; ++#endif ++ ++} ++ ++void halbtcoutsrc_phydm_modify_RA_PCR_threshold(void *pBtcContext, u8 RA_offset_direction, u8 RA_threshold_offset) ++{ ++ struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; ++ ++/* switch to #if 0 in case the phydm version does not provide the function */ ++#if 1 ++ phydm_modify_RA_PCR_threshold(pBtCoexist->odm_priv, RA_offset_direction, RA_threshold_offset); ++#endif ++} ++ ++u32 halbtcoutsrc_phydm_query_PHY_counter(void *pBtcContext, u8 info_type) ++{ ++ struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; ++ ++/* switch to #if 0 in case the phydm version does not provide the function */ ++#if 1 ++ return PHYDM_CmnInfoQuery((PDM_ODM_T)pBtCoexist->odm_priv, (PHYDM_INFO_QUERY_E)info_type); ++#else ++ return 0; ++#endif ++} ++ ++#if 0 ++static void BT_CoexOffloadRecordErrC2hAck(PADAPTER Adapter) ++{ ++ PADAPTER pDefaultAdapter = GetDefaultAdapter(Adapter); ++ ++ if (pDefaultAdapter != Adapter) ++ return; ++ ++ if (!hal_btcoex_IsBtExist(Adapter)) ++ return; ++ ++ gl_coex_offload.cnt_c2h_ack++; ++ ++ gl_coex_offload.status[COL_STATUS_INVALID_C2H_LEN]++; ++} ++ ++static void BT_CoexOffloadC2hAckCheck(PADAPTER Adapter, u8 *tmpBuf, u8 length) ++{ ++ PADAPTER pDefaultAdapter = GetDefaultAdapter(Adapter); ++ PCOL_C2H_ACK p_c2h_ack = NULL; ++ u8 req_num = 0xff; ++ ++ if (pDefaultAdapter != Adapter) ++ return; ++ ++ if (!hal_btcoex_IsBtExist(Adapter)) ++ return; ++ ++ gl_coex_offload.cnt_c2h_ack++; ++ ++ if (length < COL_C2H_ACK_HDR_LEN) { /* c2h ack length must >= 3 (status, opcode_ver, req_num and ret_len) */ ++ gl_coex_offload.status[COL_STATUS_INVALID_C2H_LEN]++; ++ } else { ++ BT_PrintData(Adapter, "[COL], c2h ack:", length, tmpBuf); ++ ++ p_c2h_ack = (PCOL_C2H_ACK)tmpBuf; ++ req_num = p_c2h_ack->req_num; ++ ++ _rtw_memmove(&gl_coex_offload.c2h_ack_buf[req_num][0], tmpBuf, length); ++ gl_coex_offload.c2h_ack_len[req_num] = length; ++ ++ complete(&gl_coex_offload.c2h_event[req_num]); ++ } ++} ++ ++static void BT_CoexOffloadC2hIndCheck(PADAPTER Adapter, u8 *tmpBuf, u8 length) ++{ ++ PADAPTER pDefaultAdapter = GetDefaultAdapter(Adapter); ++ PCOL_C2H_IND p_c2h_ind = NULL; ++ u8 ind_type = 0, ind_version = 0, ind_length = 0; ++ ++ if (pDefaultAdapter != Adapter) ++ return; ++ ++ if (!hal_btcoex_IsBtExist(Adapter)) ++ return; ++ ++ gl_coex_offload.cnt_c2h_ind++; ++ ++ if (length < COL_C2H_IND_HDR_LEN) { /* c2h indication length must >= 3 (type, version and length) */ ++ gl_coex_offload.c2h_ind_status[COL_STATUS_INVALID_C2H_LEN]++; ++ } else { ++ BT_PrintData(Adapter, "[COL], c2h indication:", length, tmpBuf); ++ ++ p_c2h_ind = (PCOL_C2H_IND)tmpBuf; ++ ind_type = p_c2h_ind->type; ++ ind_version = p_c2h_ind->version; ++ ind_length = p_c2h_ind->length; ++ ++ _rtw_memmove(&gl_coex_offload.c2h_ind_buf[0], tmpBuf, length); ++ gl_coex_offload.c2h_ind_len = length; ++ ++ /* log */ ++ gl_coex_offload.c2h_ind_record[ind_type].count++; ++ gl_coex_offload.c2h_ind_record[ind_type].status[COL_STATUS_C2H_OK]++; ++ _rtw_memmove(&gl_coex_offload.c2h_ind_record[ind_type].ind_buf[0], tmpBuf, length); ++ gl_coex_offload.c2h_ind_record[ind_type].ind_len = length; ++ ++ gl_coex_offload.c2h_ind_status[COL_STATUS_C2H_OK]++; ++ /*TODO: need to check c2h indication length*/ ++ /* TODO: Notification */ ++ } ++} ++ ++void BT_CoexOffloadC2hCheck(PADAPTER Adapter, u8 *Buffer, u8 Length) ++{ ++#if 0 /*(USE_HAL_MAC_API == 1)*/ ++ u8 c2hSubCmdId = 0, c2hAckLen = 0, h2cCmdId = 0, h2cSubCmdId = 0, c2hIndLen = 0; ++ ++ BT_PrintData(Adapter, "[COL], c2h packet:", Length - 2, Buffer + 2); ++ c2hSubCmdId = (u1Byte)C2H_HDR_GET_C2H_SUB_CMD_ID(Buffer); ++ ++ if (c2hSubCmdId == C2H_SUB_CMD_ID_H2C_ACK_HDR || ++ c2hSubCmdId == C2H_SUB_CMD_ID_BT_COEX_INFO) { ++ if (c2hSubCmdId == C2H_SUB_CMD_ID_H2C_ACK_HDR) { ++ /* coex c2h ack */ ++ h2cCmdId = (u1Byte)H2C_ACK_HDR_GET_H2C_CMD_ID(Buffer); ++ h2cSubCmdId = (u1Byte)H2C_ACK_HDR_GET_H2C_SUB_CMD_ID(Buffer); ++ if (h2cCmdId == 0xff && h2cSubCmdId == 0x60) { ++ c2hAckLen = (u1Byte)C2H_HDR_GET_LEN(Buffer); ++ if (c2hAckLen >= 8) ++ BT_CoexOffloadC2hAckCheck(Adapter, &Buffer[12], (u1Byte)(c2hAckLen - 8)); ++ else ++ BT_CoexOffloadRecordErrC2hAck(Adapter); ++ } ++ } else if (c2hSubCmdId == C2H_SUB_CMD_ID_BT_COEX_INFO) { ++ /* coex c2h indication */ ++ c2hIndLen = (u1Byte)C2H_HDR_GET_LEN(Buffer); ++ BT_CoexOffloadC2hIndCheck(Adapter, &Buffer[4], (u1Byte)c2hIndLen); ++ } ++ } ++#endif ++} ++#endif ++ ++/* ************************************ ++ * Extern functions called by other module ++ * ************************************ */ ++u8 EXhalbtcoutsrc_BindBtCoexWithAdapter(void *padapter) ++{ ++ PBTC_COEXIST pBtCoexist = &GLBtCoexist; ++ u8 antNum = 1, chipType = 0, singleAntPath = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA((PADAPTER)padapter); ++ ++ if (pBtCoexist->bBinded) ++ return _FALSE; ++ else ++ pBtCoexist->bBinded = _TRUE; ++ ++ pBtCoexist->statistics.cnt_bind++; ++ ++ pBtCoexist->Adapter = padapter; ++ pBtCoexist->odm_priv = (PVOID)&(pHalData->odmpriv); ++ ++ pBtCoexist->stack_info.profile_notified = _FALSE; ++ ++ pBtCoexist->bt_info.bt_ctrl_agg_buf_size = _FALSE; ++ pBtCoexist->bt_info.agg_buf_size = 5; ++ ++ pBtCoexist->bt_info.increase_scan_dev_num = _FALSE; ++ pBtCoexist->bt_info.miracast_plus_bt = _FALSE; ++ ++ antNum = rtw_btcoex_get_pg_ant_num((PADAPTER)padapter); ++ EXhalbtcoutsrc_SetAntNum(BT_COEX_ANT_TYPE_PG, antNum); ++ ++ if (antNum == 1) { ++ singleAntPath = rtw_btcoex_get_pg_single_ant_path((PADAPTER)padapter); ++ EXhalbtcoutsrc_SetSingleAntPath(singleAntPath); ++ } ++ /* set default antenna position to main port */ ++ pBtCoexist->board_info.btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; ++ ++ pBtCoexist->board_info.btdm_ant_det_finish = _FALSE; ++ pBtCoexist->board_info.btdm_ant_num_by_ant_det = 1; ++ ++ pBtCoexist->board_info.tfbga_package = rtw_btcoex_is_tfbga_package_type((PADAPTER)padapter); ++ ++ pBtCoexist->board_info.ant_div_cfg = rtw_btcoex_get_ant_div_cfg((PADAPTER)padapter); ++ ++ return _TRUE; ++} ++ ++u8 EXhalbtcoutsrc_InitlizeVariables(void *padapter) ++{ ++ PBTC_COEXIST pBtCoexist = &GLBtCoexist; ++ ++ /* pBtCoexist->statistics.cntBind++; */ ++ ++ halbtcoutsrc_DbgInit(); ++ ++ halbtcoutsrc_coex_offload_init(); ++ ++#ifdef CONFIG_PCI_HCI ++ pBtCoexist->chip_interface = BTC_INTF_PCI; ++#elif defined(CONFIG_USB_HCI) ++ pBtCoexist->chip_interface = BTC_INTF_USB; ++#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ pBtCoexist->chip_interface = BTC_INTF_SDIO; ++#else ++ pBtCoexist->chip_interface = BTC_INTF_UNKNOWN; ++#endif ++ ++ EXhalbtcoutsrc_BindBtCoexWithAdapter(padapter); ++ ++ pBtCoexist->btc_read_1byte = halbtcoutsrc_Read1Byte; ++ pBtCoexist->btc_write_1byte = halbtcoutsrc_Write1Byte; ++ pBtCoexist->btc_write_1byte_bitmask = halbtcoutsrc_BitMaskWrite1Byte; ++ pBtCoexist->btc_read_2byte = halbtcoutsrc_Read2Byte; ++ pBtCoexist->btc_write_2byte = halbtcoutsrc_Write2Byte; ++ pBtCoexist->btc_read_4byte = halbtcoutsrc_Read4Byte; ++ pBtCoexist->btc_write_4byte = halbtcoutsrc_Write4Byte; ++ pBtCoexist->btc_write_local_reg_1byte = halbtcoutsrc_WriteLocalReg1Byte; ++ ++ pBtCoexist->btc_set_bb_reg = halbtcoutsrc_SetBbReg; ++ pBtCoexist->btc_get_bb_reg = halbtcoutsrc_GetBbReg; ++ ++ pBtCoexist->btc_set_rf_reg = halbtcoutsrc_SetRfReg; ++ pBtCoexist->btc_get_rf_reg = halbtcoutsrc_GetRfReg; ++ ++ pBtCoexist->btc_fill_h2c = halbtcoutsrc_FillH2cCmd; ++ pBtCoexist->btc_disp_dbg_msg = halbtcoutsrc_DisplayDbgMsg; ++ ++ pBtCoexist->btc_get = halbtcoutsrc_Get; ++ pBtCoexist->btc_set = halbtcoutsrc_Set; ++ pBtCoexist->btc_get_bt_reg = halbtcoutsrc_GetBtReg; ++ pBtCoexist->btc_set_bt_reg = halbtcoutsrc_SetBtReg; ++ pBtCoexist->btc_set_bt_ant_detection = halbtcoutsrc_SetBtAntDetection; ++ pBtCoexist->btc_set_bt_trx_mask = halbtcoutsrc_SetBtTRXMASK; ++ pBtCoexist->btc_coex_h2c_process = halbtcoutsrc_CoexH2cProcess; ++ pBtCoexist->btc_get_bt_coex_supported_feature = halbtcoutsrc_GetBtCoexSupportedFeature; ++ pBtCoexist->btc_get_bt_coex_supported_version= halbtcoutsrc_GetBtCoexSupportedVersion; ++ pBtCoexist->btc_get_ant_det_val_from_bt = halbtcoutsrc_GetAntDetValFromBt; ++ pBtCoexist->btc_get_ble_scan_type_from_bt = halbtcoutsrc_GetBleScanTypeFromBt; ++ pBtCoexist->btc_get_ble_scan_para_from_bt = halbtcoutsrc_GetBleScanParaFromBt; ++ pBtCoexist->btc_get_bt_afh_map_from_bt = halbtcoutsrc_GetBtAFHMapFromBt; ++ pBtCoexist->btc_get_bt_phydm_version = halbtcoutsrc_GetPhydmVersion; ++ pBtCoexist->btc_phydm_modify_RA_PCR_threshold = halbtcoutsrc_phydm_modify_RA_PCR_threshold; ++ pBtCoexist->btc_phydm_query_PHY_counter = halbtcoutsrc_phydm_query_PHY_counter; ++ ++ pBtCoexist->cli_buf = &GLBtcDbgBuf[0]; ++ ++ GLBtcWiFiInScanState = _FALSE; ++ ++ GLBtcWiFiInIQKState = _FALSE; ++ ++ GLBtcWiFiInIPS = _FALSE; ++ ++ GLBtcWiFiInLPS = _FALSE; ++ ++ GLBtcBtCoexAliveRegistered = _FALSE; ++ ++ /* BT Control H2C/C2H*/ ++ GLBtcBtMpOperSeq = 0; ++ _rtw_mutex_init(&GLBtcBtMpOperLock); ++ _init_timer(&GLBtcBtMpOperTimer, ((PADAPTER)padapter)->pnetdev, _btmpoper_timer_hdl, pBtCoexist); ++ _rtw_init_sema(&GLBtcBtMpRptSema, 0); ++ GLBtcBtMpRptSeq = 0; ++ GLBtcBtMpRptStatus = 0; ++ _rtw_memset(GLBtcBtMpRptRsp, 0, C2H_MAX_SIZE); ++ GLBtcBtMpRptRspSize = 0; ++ GLBtcBtMpRptWait = 0; ++ GLBtcBtMpRptWiFiOK = 0; ++ GLBtcBtMpRptBTOK = 0; ++ ++ return _TRUE; ++} ++ ++void EXhalbtcoutsrc_PowerOnSetting(PBTC_COEXIST pBtCoexist) ++{ ++ HAL_DATA_TYPE *pHalData = NULL; ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ pHalData = GET_HAL_DATA((PADAPTER)pBtCoexist->Adapter); ++ ++ /* Power on setting function is only added in 8723B currently */ ++ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_power_on_setting(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_power_on_setting(pBtCoexist); ++ } ++ ++ if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_power_on_setting(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_power_on_setting(pBtCoexist); ++ } ++ ++ if ((IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) && (pHalData->EEPROMBluetoothCoexist == _TRUE)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_power_on_setting(pBtCoexist); ++ } ++ ++ if ((IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) && (pHalData->EEPROMBluetoothCoexist == _TRUE)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_power_on_setting(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_power_on_setting(pBtCoexist); ++ } ++} ++ ++void EXhalbtcoutsrc_PreLoadFirmware(PBTC_COEXIST pBtCoexist) ++{ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ pBtCoexist->statistics.cnt_pre_load_firmware++; ++ ++ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_pre_load_firmware(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_pre_load_firmware(pBtCoexist); ++ } ++ ++ if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_pre_load_firmware(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_pre_load_firmware(pBtCoexist); ++ } ++ ++ if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_pre_load_firmware(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_pre_load_firmware(pBtCoexist); ++ } ++} ++ ++void EXhalbtcoutsrc_init_hw_config(PBTC_COEXIST pBtCoexist, u8 bWifiOnly) ++{ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ pBtCoexist->statistics.cnt_init_hw_config++; ++ ++ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ++ ex_halbtc8821aCsr2ant_init_hw_config(pBtCoexist, bWifiOnly); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821a2ant_init_hw_config(pBtCoexist, bWifiOnly); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821a1ant_init_hw_config(pBtCoexist, bWifiOnly); ++ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_init_hw_config(pBtCoexist, bWifiOnly); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_init_hw_config(pBtCoexist, bWifiOnly); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_init_hw_config(pBtCoexist, bWifiOnly); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_init_hw_config(pBtCoexist, bWifiOnly); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_init_hw_config(pBtCoexist, bWifiOnly); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8192e2ant_init_hw_config(pBtCoexist, bWifiOnly); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_init_hw_config(pBtCoexist, bWifiOnly); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_init_hw_config(pBtCoexist, bWifiOnly); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_init_hw_config(pBtCoexist, bWifiOnly); ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_init_hw_config(pBtCoexist, bWifiOnly); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_init_hw_config(pBtCoexist, bWifiOnly); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_init_hw_config(pBtCoexist, bWifiOnly); ++ } ++} ++ ++void EXhalbtcoutsrc_init_coex_dm(PBTC_COEXIST pBtCoexist) ++{ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ pBtCoexist->statistics.cnt_init_coex_dm++; ++ ++ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ++ ex_halbtc8821aCsr2ant_init_coex_dm(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821a2ant_init_coex_dm(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821a1ant_init_coex_dm(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_init_coex_dm(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_init_coex_dm(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_init_coex_dm(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_init_coex_dm(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_init_coex_dm(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8192e2ant_init_coex_dm(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_init_coex_dm(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_init_coex_dm(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_init_coex_dm(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_init_coex_dm(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_init_coex_dm(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_init_coex_dm(pBtCoexist); ++ } ++ ++ pBtCoexist->initilized = _TRUE; ++} ++ ++void EXhalbtcoutsrc_ips_notify(PBTC_COEXIST pBtCoexist, u8 type) ++{ ++ u8 ipsType; ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ pBtCoexist->statistics.cnt_ips_notify++; ++ if (pBtCoexist->manual_control) ++ return; ++ ++ if (IPS_NONE == type) { ++ ipsType = BTC_IPS_LEAVE; ++ GLBtcWiFiInIPS = _FALSE; ++ } else { ++ ipsType = BTC_IPS_ENTER; ++ GLBtcWiFiInIPS = _TRUE; ++ } ++ ++ /* All notify is called in cmd thread, don't need to leave low power again ++ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ ++ ++ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ++ ex_halbtc8821aCsr2ant_ips_notify(pBtCoexist, ipsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821a2ant_ips_notify(pBtCoexist, ipsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821a1ant_ips_notify(pBtCoexist, ipsType); ++ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_ips_notify(pBtCoexist, ipsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_ips_notify(pBtCoexist, ipsType); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_ips_notify(pBtCoexist, ipsType); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_ips_notify(pBtCoexist, ipsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_ips_notify(pBtCoexist, ipsType); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8192e2ant_ips_notify(pBtCoexist, ipsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_ips_notify(pBtCoexist, ipsType); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_ips_notify(pBtCoexist, ipsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_ips_notify(pBtCoexist, ipsType); ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_ips_notify(pBtCoexist, ipsType); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_ips_notify(pBtCoexist, ipsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_ips_notify(pBtCoexist, ipsType); ++ } ++ ++ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ ++} ++ ++void EXhalbtcoutsrc_lps_notify(PBTC_COEXIST pBtCoexist, u8 type) ++{ ++ u8 lpsType; ++ ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ pBtCoexist->statistics.cnt_lps_notify++; ++ if (pBtCoexist->manual_control) ++ return; ++ ++ if (PS_MODE_ACTIVE == type) { ++ lpsType = BTC_LPS_DISABLE; ++ GLBtcWiFiInLPS = _FALSE; ++ } else { ++ lpsType = BTC_LPS_ENABLE; ++ GLBtcWiFiInLPS = _TRUE; ++ } ++ ++ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ++ ex_halbtc8821aCsr2ant_lps_notify(pBtCoexist, lpsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821a2ant_lps_notify(pBtCoexist, lpsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821a1ant_lps_notify(pBtCoexist, lpsType); ++ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_lps_notify(pBtCoexist, lpsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_lps_notify(pBtCoexist, lpsType); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_lps_notify(pBtCoexist, lpsType); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_lps_notify(pBtCoexist, lpsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_lps_notify(pBtCoexist, lpsType); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8192e2ant_lps_notify(pBtCoexist, lpsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_lps_notify(pBtCoexist, lpsType); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_lps_notify(pBtCoexist, lpsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_lps_notify(pBtCoexist, lpsType); ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_lps_notify(pBtCoexist, lpsType); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_lps_notify(pBtCoexist, lpsType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_lps_notify(pBtCoexist, lpsType); ++ } ++} ++ ++void EXhalbtcoutsrc_scan_notify(PBTC_COEXIST pBtCoexist, u8 type) ++{ ++ u8 scanType; ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ pBtCoexist->statistics.cnt_scan_notify++; ++ if (pBtCoexist->manual_control) ++ return; ++ ++ if (type) { ++ scanType = BTC_SCAN_START; ++ GLBtcWiFiInScanState = _TRUE; ++ } else { ++ scanType = BTC_SCAN_FINISH; ++ GLBtcWiFiInScanState = _FALSE; ++ } ++ ++ /* All notify is called in cmd thread, don't need to leave low power again ++ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ ++ ++ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ++ ex_halbtc8821aCsr2ant_scan_notify(pBtCoexist, scanType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821a2ant_scan_notify(pBtCoexist, scanType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821a1ant_scan_notify(pBtCoexist, scanType); ++ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_scan_notify(pBtCoexist, scanType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_scan_notify(pBtCoexist, scanType); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_scan_notify(pBtCoexist, scanType); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_scan_notify(pBtCoexist, scanType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_scan_notify(pBtCoexist, scanType); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8192e2ant_scan_notify(pBtCoexist, scanType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_scan_notify(pBtCoexist, scanType); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_scan_notify(pBtCoexist, scanType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_scan_notify(pBtCoexist, scanType); ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_scan_notify(pBtCoexist, scanType); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_scan_notify(pBtCoexist, scanType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_scan_notify(pBtCoexist, scanType); ++ } ++ ++ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ ++} ++ ++void EXhalbtcoutsrc_SetAntennaPathNotify(PBTC_COEXIST pBtCoexist, u8 type) ++{ ++#if 0 ++ u8 switchType; ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ if (pBtCoexist->manual_control) ++ return; ++ ++ halbtcoutsrc_LeaveLowPower(pBtCoexist); ++ ++ switchType = type; ++ ++ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_set_antenna_notify(pBtCoexist, type); ++ } ++ if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_set_antenna_notify(pBtCoexist, type); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_set_antenna_notify(pBtCoexist, type); ++ } ++ ++ halbtcoutsrc_NormalLowPower(pBtCoexist); ++#endif ++} ++ ++void EXhalbtcoutsrc_connect_notify(PBTC_COEXIST pBtCoexist, u8 action) ++{ ++ u8 assoType; ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ pBtCoexist->statistics.cnt_connect_notify++; ++ if (pBtCoexist->manual_control) ++ return; ++ ++ if (action) ++ assoType = BTC_ASSOCIATE_START; ++ else ++ assoType = BTC_ASSOCIATE_FINISH; ++ ++ /* All notify is called in cmd thread, don't need to leave low power again ++ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ ++ ++ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ++ ex_halbtc8821aCsr2ant_connect_notify(pBtCoexist, assoType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821a2ant_connect_notify(pBtCoexist, assoType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821a1ant_connect_notify(pBtCoexist, assoType); ++ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_connect_notify(pBtCoexist, assoType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_connect_notify(pBtCoexist, assoType); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_connect_notify(pBtCoexist, assoType); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_connect_notify(pBtCoexist, assoType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_connect_notify(pBtCoexist, assoType); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8192e2ant_connect_notify(pBtCoexist, assoType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_connect_notify(pBtCoexist, assoType); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_connect_notify(pBtCoexist, assoType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_connect_notify(pBtCoexist, assoType); ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_connect_notify(pBtCoexist, assoType); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_connect_notify(pBtCoexist, assoType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_connect_notify(pBtCoexist, assoType); ++ } ++ ++ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ ++} ++ ++void EXhalbtcoutsrc_media_status_notify(PBTC_COEXIST pBtCoexist, RT_MEDIA_STATUS mediaStatus) ++{ ++ u8 mStatus; ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ pBtCoexist->statistics.cnt_media_status_notify++; ++ if (pBtCoexist->manual_control) ++ return; ++ ++ if (RT_MEDIA_CONNECT == mediaStatus) ++ mStatus = BTC_MEDIA_CONNECT; ++ else ++ mStatus = BTC_MEDIA_DISCONNECT; ++ ++ /* All notify is called in cmd thread, don't need to leave low power again ++ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ ++ ++ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ++ ex_halbtc8821aCsr2ant_media_status_notify(pBtCoexist, mStatus); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821a2ant_media_status_notify(pBtCoexist, mStatus); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821a1ant_media_status_notify(pBtCoexist, mStatus); ++ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_media_status_notify(pBtCoexist, mStatus); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_media_status_notify(pBtCoexist, mStatus); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_media_status_notify(pBtCoexist, mStatus); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_media_status_notify(pBtCoexist, mStatus); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_media_status_notify(pBtCoexist, mStatus); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8192e2ant_media_status_notify(pBtCoexist, mStatus); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_media_status_notify(pBtCoexist, mStatus); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_media_status_notify(pBtCoexist, mStatus); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_media_status_notify(pBtCoexist, mStatus); ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_media_status_notify(pBtCoexist, mStatus); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_media_status_notify(pBtCoexist, mStatus); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_media_status_notify(pBtCoexist, mStatus); ++ } ++ ++ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ ++} ++ ++void EXhalbtcoutsrc_specific_packet_notify(PBTC_COEXIST pBtCoexist, u8 pktType) ++{ ++ u8 packetType; ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ pBtCoexist->statistics.cnt_specific_packet_notify++; ++ if (pBtCoexist->manual_control) ++ return; ++ ++ if (PACKET_DHCP == pktType) ++ packetType = BTC_PACKET_DHCP; ++ else if (PACKET_EAPOL == pktType) ++ packetType = BTC_PACKET_EAPOL; ++ else if (PACKET_ARP == pktType) ++ packetType = BTC_PACKET_ARP; ++ else { ++ packetType = BTC_PACKET_UNKNOWN; ++ return; ++ } ++ ++ /* All notify is called in cmd thread, don't need to leave low power again ++ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ ++ ++ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ++ ex_halbtc8821aCsr2ant_specific_packet_notify(pBtCoexist, packetType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821a2ant_specific_packet_notify(pBtCoexist, packetType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821a1ant_specific_packet_notify(pBtCoexist, packetType); ++ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_specific_packet_notify(pBtCoexist, packetType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_specific_packet_notify(pBtCoexist, packetType); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_specific_packet_notify(pBtCoexist, packetType); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_specific_packet_notify(pBtCoexist, packetType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_specific_packet_notify(pBtCoexist, packetType); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8192e2ant_specific_packet_notify(pBtCoexist, packetType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_specific_packet_notify(pBtCoexist, packetType); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_specific_packet_notify(pBtCoexist, packetType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_specific_packet_notify(pBtCoexist, packetType); ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_specific_packet_notify(pBtCoexist, packetType); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_specific_packet_notify(pBtCoexist, packetType); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_specific_packet_notify(pBtCoexist, packetType); ++ } ++ ++ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ ++} ++ ++void EXhalbtcoutsrc_bt_info_notify(PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 length) ++{ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ pBtCoexist->statistics.cnt_bt_info_notify++; ++ ++ /* All notify is called in cmd thread, don't need to leave low power again ++ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ ++ ++ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ++ ex_halbtc8821aCsr2ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821a2ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821a1ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8192e2ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_bt_info_notify(pBtCoexist, tmpBuf, length); ++ } ++ ++ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ ++} ++ ++VOID ++EXhalbtcoutsrc_RfStatusNotify( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u1Byte type ++) ++{ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ pBtCoexist->statistics.cnt_rf_status_notify++; ++ ++ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_rf_status_notify(pBtCoexist, type); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_rf_status_notify(pBtCoexist, type); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_rf_status_notify(pBtCoexist, type); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_rf_status_notify(pBtCoexist, type); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_rf_status_notify(pBtCoexist, type); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_rf_status_notify(pBtCoexist, type); ++ } ++} ++ ++void EXhalbtcoutsrc_StackOperationNotify(PBTC_COEXIST pBtCoexist, u8 type) ++{ ++#if 0 ++ u8 stackOpType; ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ pBtCoexist->statistics.cntStackOperationNotify++; ++ if (pBtCoexist->manual_control) ++ return; ++ ++ if ((HCI_BT_OP_INQUIRY_START == type) || ++ (HCI_BT_OP_PAGING_START == type) || ++ (HCI_BT_OP_PAIRING_START == type)) ++ stackOpType = BTC_STACK_OP_INQ_PAGE_PAIR_START; ++ else if ((HCI_BT_OP_INQUIRY_FINISH == type) || ++ (HCI_BT_OP_PAGING_SUCCESS == type) || ++ (HCI_BT_OP_PAGING_UNSUCCESS == type) || ++ (HCI_BT_OP_PAIRING_FINISH == type)) ++ stackOpType = BTC_STACK_OP_INQ_PAGE_PAIR_FINISH; ++ else ++ stackOpType = BTC_STACK_OP_NONE; ++ ++#endif ++} ++ ++void EXhalbtcoutsrc_halt_notify(PBTC_COEXIST pBtCoexist) ++{ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ++ ex_halbtc8821aCsr2ant_halt_notify(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821a2ant_halt_notify(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821a1ant_halt_notify(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_halt_notify(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_halt_notify(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_halt_notify(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_halt_notify(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_halt_notify(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8192e2ant_halt_notify(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_halt_notify(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_halt_notify(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_halt_notify(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_halt_notify(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_halt_notify(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_halt_notify(pBtCoexist); ++ } ++} ++ ++void EXhalbtcoutsrc_SwitchBtTRxMask(PBTC_COEXIST pBtCoexist) ++{ ++ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) { ++ halbtcoutsrc_SetBtReg(pBtCoexist, 0, 0x3c, 0x01); /* BT goto standby while GNT_BT 1-->0 */ ++ } else if (pBtCoexist->board_info.btdm_ant_num == 1) { ++ halbtcoutsrc_SetBtReg(pBtCoexist, 0, 0x3c, 0x15); /* BT goto standby while GNT_BT 1-->0 */ ++ } ++ } ++} ++ ++void EXhalbtcoutsrc_pnp_notify(PBTC_COEXIST pBtCoexist, u8 pnpState) ++{ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ /* */ ++ /* currently only 1ant we have to do the notification, */ ++ /* once pnp is notified to sleep state, we have to leave LPS that we can sleep normally. */ ++ /* */ ++ ++ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_pnp_notify(pBtCoexist, pnpState); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_pnp_notify(pBtCoexist, pnpState); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_pnp_notify(pBtCoexist, pnpState); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_pnp_notify(pBtCoexist, pnpState); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_pnp_notify(pBtCoexist, pnpState); ++ } else if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ++ ex_halbtc8821aCsr2ant_pnp_notify(pBtCoexist, pnpState); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821a1ant_pnp_notify(pBtCoexist, pnpState); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821a2ant_pnp_notify(pBtCoexist, pnpState); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_pnp_notify(pBtCoexist, pnpState); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_pnp_notify(pBtCoexist, pnpState); ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_pnp_notify(pBtCoexist, pnpState); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_pnp_notify(pBtCoexist, pnpState); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_pnp_notify(pBtCoexist, pnpState); ++ } ++} ++ ++void EXhalbtcoutsrc_CoexDmSwitch(PBTC_COEXIST pBtCoexist) ++{ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ pBtCoexist->statistics.cnt_coex_dm_switch++; ++ ++ halbtcoutsrc_LeaveLowPower(pBtCoexist); ++ ++ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) { ++ pBtCoexist->stop_coex_dm = TRUE; ++ ex_halbtc8723b1ant_coex_dm_reset(pBtCoexist); ++ EXhalbtcoutsrc_SetAntNum(BT_COEX_ANT_TYPE_DETECTED, 2); ++ ex_halbtc8723b2ant_init_hw_config(pBtCoexist, FALSE); ++ ex_halbtc8723b2ant_init_coex_dm(pBtCoexist); ++ pBtCoexist->stop_coex_dm = FALSE; ++ } ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) { ++ pBtCoexist->stop_coex_dm = TRUE; ++ ex_halbtc8723d1ant_coex_dm_reset(pBtCoexist); ++ EXhalbtcoutsrc_SetAntNum(BT_COEX_ANT_TYPE_DETECTED, 2); ++ ex_halbtc8723d2ant_init_hw_config(pBtCoexist, FALSE); ++ ex_halbtc8723d2ant_init_coex_dm(pBtCoexist); ++ pBtCoexist->stop_coex_dm = FALSE; ++ } ++ } ++ ++ halbtcoutsrc_NormalLowPower(pBtCoexist); ++} ++ ++void EXhalbtcoutsrc_periodical(PBTC_COEXIST pBtCoexist) ++{ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ pBtCoexist->statistics.cnt_periodical++; ++ ++ /* Periodical should be called in cmd thread, */ ++ /* don't need to leave low power again ++ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ ++ ++ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ++ ex_halbtc8821aCsr2ant_periodical(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821a2ant_periodical(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) { ++ if (!halbtcoutsrc_UnderIps(pBtCoexist)) ++ ex_halbtc8821a1ant_periodical(pBtCoexist); ++ } ++ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_periodical(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_periodical(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_periodical(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_periodical(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_periodical(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8192e2ant_periodical(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_periodical(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_periodical(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_periodical(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_periodical(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_periodical(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_periodical(pBtCoexist); ++ } ++ ++ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ ++} ++ ++void EXhalbtcoutsrc_dbg_control(PBTC_COEXIST pBtCoexist, u8 opCode, u8 opLen, u8 *pData) ++{ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ pBtCoexist->statistics.cnt_dbg_ctrl++; ++ ++ /* This function doesn't be called yet, */ ++ /* default no need to leave low power to avoid deadlock ++ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ ++ ++ if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_dbg_control(pBtCoexist, opCode, opLen, pData); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_dbg_control(pBtCoexist, opCode, opLen, pData); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_dbg_control(pBtCoexist, opCode, opLen, pData); ++ } else if(IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) ++ if(pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_dbg_control(pBtCoexist, opCode, opLen, pData); ++ ++ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ ++} ++ ++#if 0 ++VOID ++EXhalbtcoutsrc_AntennaDetection( ++ IN PBTC_COEXIST pBtCoexist, ++ IN u4Byte centFreq, ++ IN u4Byte offset, ++ IN u4Byte span, ++ IN u4Byte seconds ++) ++{ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ /* Need to refine the following power save operations to enable this function in the future */ ++#if 0 ++ IPSDisable(pBtCoexist->Adapter, FALSE, 0); ++ LeisurePSLeave(pBtCoexist->Adapter, LPS_DISABLE_BT_COEX); ++#endif ++ ++ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_AntennaDetection(pBtCoexist, centFreq, offset, span, seconds); ++ } ++ ++ /* IPSReturn(pBtCoexist->Adapter, 0xff); */ ++} ++#endif ++ ++void EXhalbtcoutsrc_StackUpdateProfileInfo(void) ++{ ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ PBTC_COEXIST pBtCoexist = &GLBtCoexist; ++ PADAPTER padapter = (PADAPTER)GLBtCoexist.Adapter; ++ PBT_MGNT pBtMgnt = &padapter->coex_info.BtMgnt; ++ u8 i; ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ pBtCoexist->stack_info.profile_notified = _TRUE; ++ ++ pBtCoexist->stack_info.num_of_link = ++ pBtMgnt->ExtConfig.NumberOfACL + pBtMgnt->ExtConfig.NumberOfSCO; ++ ++ /* reset first */ ++ pBtCoexist->stack_info.bt_link_exist = _FALSE; ++ pBtCoexist->stack_info.sco_exist = _FALSE; ++ pBtCoexist->stack_info.acl_exist = _FALSE; ++ pBtCoexist->stack_info.a2dp_exist = _FALSE; ++ pBtCoexist->stack_info.hid_exist = _FALSE; ++ pBtCoexist->stack_info.num_of_hid = 0; ++ pBtCoexist->stack_info.pan_exist = _FALSE; ++ ++ if (!pBtMgnt->ExtConfig.NumberOfACL) ++ pBtCoexist->stack_info.min_bt_rssi = 0; ++ ++ if (pBtCoexist->stack_info.num_of_link) { ++ pBtCoexist->stack_info.bt_link_exist = _TRUE; ++ if (pBtMgnt->ExtConfig.NumberOfSCO) ++ pBtCoexist->stack_info.sco_exist = _TRUE; ++ if (pBtMgnt->ExtConfig.NumberOfACL) ++ pBtCoexist->stack_info.acl_exist = _TRUE; ++ } ++ ++ for (i = 0; i < pBtMgnt->ExtConfig.NumberOfACL; i++) { ++ if (BT_PROFILE_A2DP == pBtMgnt->ExtConfig.aclLink[i].BTProfile) ++ pBtCoexist->stack_info.a2dp_exist = _TRUE; ++ else if (BT_PROFILE_PAN == pBtMgnt->ExtConfig.aclLink[i].BTProfile) ++ pBtCoexist->stack_info.pan_exist = _TRUE; ++ else if (BT_PROFILE_HID == pBtMgnt->ExtConfig.aclLink[i].BTProfile) { ++ pBtCoexist->stack_info.hid_exist = _TRUE; ++ pBtCoexist->stack_info.num_of_hid++; ++ } else ++ pBtCoexist->stack_info.unknown_acl_exist = _TRUE; ++ } ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++} ++ ++void EXhalbtcoutsrc_UpdateMinBtRssi(s8 btRssi) ++{ ++ PBTC_COEXIST pBtCoexist = &GLBtCoexist; ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ pBtCoexist->stack_info.min_bt_rssi = btRssi; ++} ++ ++void EXhalbtcoutsrc_SetHciVersion(u16 hciVersion) ++{ ++ PBTC_COEXIST pBtCoexist = &GLBtCoexist; ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ pBtCoexist->stack_info.hci_version = hciVersion; ++} ++ ++void EXhalbtcoutsrc_SetBtPatchVersion(u16 btHciVersion, u16 btPatchVersion) ++{ ++ PBTC_COEXIST pBtCoexist = &GLBtCoexist; ++ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ pBtCoexist->bt_info.bt_real_fw_ver = btPatchVersion; ++ pBtCoexist->bt_info.bt_hci_ver = btHciVersion; ++} ++ ++#if 0 ++void EXhalbtcoutsrc_SetBtExist(u8 bBtExist) ++{ ++ GLBtCoexist.boardInfo.bBtExist = bBtExist; ++} ++#endif ++void EXhalbtcoutsrc_SetChipType(u8 chipType) ++{ ++ switch (chipType) { ++ default: ++ case BT_2WIRE: ++ case BT_ISSC_3WIRE: ++ case BT_ACCEL: ++ case BT_RTL8756: ++ GLBtCoexist.board_info.bt_chip_type = BTC_CHIP_UNDEF; ++ break; ++ case BT_CSR_BC4: ++ GLBtCoexist.board_info.bt_chip_type = BTC_CHIP_CSR_BC4; ++ break; ++ case BT_CSR_BC8: ++ GLBtCoexist.board_info.bt_chip_type = BTC_CHIP_CSR_BC8; ++ break; ++ case BT_RTL8723A: ++ GLBtCoexist.board_info.bt_chip_type = BTC_CHIP_RTL8723A; ++ break; ++ case BT_RTL8821: ++ GLBtCoexist.board_info.bt_chip_type = BTC_CHIP_RTL8821; ++ break; ++ case BT_RTL8723B: ++ GLBtCoexist.board_info.bt_chip_type = BTC_CHIP_RTL8723B; ++ break; ++ } ++} ++ ++void EXhalbtcoutsrc_SetAntNum(u8 type, u8 antNum) ++{ ++ if (BT_COEX_ANT_TYPE_PG == type) { ++ GLBtCoexist.board_info.pg_ant_num = antNum; ++ GLBtCoexist.board_info.btdm_ant_num = antNum; ++#if 0 ++ /* The antenna position: Main (default) or Aux for pgAntNum=2 && btdmAntNum =1 */ ++ /* The antenna position should be determined by auto-detect mechanism */ ++ /* The following is assumed to main, and those must be modified if y auto-detect mechanism is ready */ ++ if ((GLBtCoexist.board_info.pg_ant_num == 2) && (GLBtCoexist.board_info.btdm_ant_num == 1)) ++ GLBtCoexist.board_info.btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; ++ else ++ GLBtCoexist.board_info.btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; ++#endif ++ } else if (BT_COEX_ANT_TYPE_ANTDIV == type) { ++ GLBtCoexist.board_info.btdm_ant_num = antNum; ++ /* GLBtCoexist.boardInfo.btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; */ ++ } else if (BT_COEX_ANT_TYPE_DETECTED == type) { ++ GLBtCoexist.board_info.btdm_ant_num = antNum; ++ /* GLBtCoexist.boardInfo.btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; */ ++ } ++} ++ ++/* ++ * Currently used by 8723b only, S0 or S1 ++ * */ ++void EXhalbtcoutsrc_SetSingleAntPath(u8 singleAntPath) ++{ ++ GLBtCoexist.board_info.single_ant_path = singleAntPath; ++} ++ ++void EXhalbtcoutsrc_DisplayBtCoexInfo(PBTC_COEXIST pBtCoexist) ++{ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ halbtcoutsrc_LeaveLowPower(pBtCoexist); ++ ++ /* To prevent the racing with IPS enter */ ++ halbtcoutsrc_EnterPwrLock(pBtCoexist); ++ ++ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { ++ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ++ ex_halbtc8821aCsr2ant_display_coex_info(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821a2ant_display_coex_info(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821a1ant_display_coex_info(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723b2ant_display_coex_info(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_display_coex_info(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8703b1ant_display_coex_info(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8723d2ant_display_coex_info(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723d1ant_display_coex_info(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8192e2ant_display_coex_info(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8192e1ant_display_coex_info(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_display_coex_info(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8812a1ant_display_coex_info(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_display_coex_info(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_display_coex_info(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_display_coex_info(pBtCoexist); ++ } ++ ++ halbtcoutsrc_ExitPwrLock(pBtCoexist); ++ ++ halbtcoutsrc_NormalLowPower(pBtCoexist); ++} ++ ++void EXhalbtcoutsrc_DisplayAntDetection(PBTC_COEXIST pBtCoexist) ++{ ++ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ halbtcoutsrc_LeaveLowPower(pBtCoexist); ++ ++ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8723b1ant_display_ant_detection(pBtCoexist); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_display_ant_detection(pBtCoexist); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_display_ant_detection(pBtCoexist); ++ } ++ ++ halbtcoutsrc_NormalLowPower(pBtCoexist); ++} ++ ++void EXhalbtcoutsrc_BTOffOnNotify(PBTC_COEXIST pBtCoexist, u8 bBTON) ++{ ++#if 0 /* Jenyu Need commit to windows' SVN */ ++ if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8812a2ant_bt_off_on_notify(pBtCoexist, (bBTON == _TRUE) ? BTC_BT_ON : BTC_BT_OFF); ++ } ++#endif ++} ++ ++void EXhalbtcoutsrc_set_rfe_type(u8 type) ++{ ++ GLBtCoexist.board_info.rfe_type= type; ++} ++ ++void EXhalbtcoutsrc_switchband_notify(struct btc_coexist *pBtCoexist, u8 type) ++{ ++ if(!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) ++ return; ++ ++ if(pBtCoexist->manual_control) ++ return; ++ ++ ++ halbtcoutsrc_LeaveLowPower(pBtCoexist); ++ ++ if(IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { ++ if(pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8822b1ant_switchband_notify(pBtCoexist, type); ++ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { ++ if (pBtCoexist->board_info.btdm_ant_num == 2) ++ ex_halbtc8821c2ant_switchband_notify(pBtCoexist, type); ++ else if (pBtCoexist->board_info.btdm_ant_num == 1) ++ ex_halbtc8821c1ant_switchband_notify(pBtCoexist, type); ++ } ++ ++ halbtcoutsrc_NormalLowPower(pBtCoexist); ++} ++ ++static void halbt_init_hw_config92C(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData; ++ u8 u1Tmp; ++ ++ ++ pHalData = GET_HAL_DATA(padapter); ++ if ((pHalData->bt_coexist.btChipType == BT_CSR_BC4) || ++ (pHalData->bt_coexist.btChipType == BT_CSR_BC8)) { ++ if (pHalData->rf_type == RF_1T1R) { ++ /* Config to 1T1R */ ++ u1Tmp = rtw_read8(padapter, rOFDM0_TRxPathEnable); ++ u1Tmp &= ~BIT(1); ++ rtw_write8(padapter, rOFDM0_TRxPathEnable, u1Tmp); ++ RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xC04 = 0x%x\n", u1Tmp)); ++ ++ u1Tmp = rtw_read8(padapter, rOFDM1_TRxPathEnable); ++ u1Tmp &= ~BIT(1); ++ rtw_write8(padapter, rOFDM1_TRxPathEnable, u1Tmp); ++ RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xD04 = 0x%x\n", u1Tmp)); ++ } ++ } ++} ++ ++static void halbt_init_hw_config92D(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData; ++ u8 u1Tmp; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ if ((pHalData->bt_coexist.btChipType == BT_CSR_BC4) || ++ (pHalData->bt_coexist.btChipType == BT_CSR_BC8)) { ++ if (pHalData->rf_type == RF_1T1R) { ++ /* Config to 1T1R */ ++ u1Tmp = rtw_read8(padapter, rOFDM0_TRxPathEnable); ++ u1Tmp &= ~BIT(1); ++ rtw_write8(padapter, rOFDM0_TRxPathEnable, u1Tmp); ++ RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xC04 = 0x%x\n", u1Tmp)); ++ ++ u1Tmp = rtw_read8(padapter, rOFDM1_TRxPathEnable); ++ u1Tmp &= ~BIT(1); ++ rtw_write8(padapter, rOFDM1_TRxPathEnable, u1Tmp); ++ RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xD04 = 0x%x\n", u1Tmp)); ++ } ++ } ++} ++ ++/* ++ * Description: ++ * Run BT-Coexist mechansim or not ++ * ++ */ ++void hal_btcoex_SetBTCoexist(PADAPTER padapter, u8 bBtExist) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ pHalData->bt_coexist.bBtExist = bBtExist; ++} ++ ++/* ++ * Dewcription: ++ * Check is co-exist mechanism enabled or not ++ * ++ * Return: ++ * _TRUE Enable BT co-exist mechanism ++ * _FALSE Disable BT co-exist mechanism ++ */ ++u8 hal_btcoex_IsBtExist(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ return pHalData->bt_coexist.bBtExist; ++} ++ ++u8 hal_btcoex_IsBtDisabled(PADAPTER padapter) ++{ ++ if (!hal_btcoex_IsBtExist(padapter)) ++ return _TRUE; ++ ++ if (GLBtCoexist.bt_info.bt_disabled) ++ return _TRUE; ++ else ++ return _FALSE; ++} ++ ++void hal_btcoex_SetChipType(PADAPTER padapter, u8 chipType) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ pHalData->bt_coexist.btChipType = chipType; ++} ++ ++void hal_btcoex_SetPgAntNum(PADAPTER padapter, u8 antNum) ++{ ++ PHAL_DATA_TYPE pHalData; ++ ++ ++ pHalData = GET_HAL_DATA(padapter); ++ ++ pHalData->bt_coexist.btTotalAntNum = antNum; ++} ++ ++u8 hal_btcoex_Initialize(PADAPTER padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 ret; ++ ++ ++ _rtw_memset(&GLBtCoexist, 0, sizeof(GLBtCoexist)); ++ ++ hal_btcoex_SetBTCoexist(padapter, rtw_btcoex_get_bt_coexist(padapter)); ++ hal_btcoex_SetChipType(padapter, rtw_btcoex_get_chip_type(padapter)); ++ hal_btcoex_SetPgAntNum(padapter, rtw_btcoex_get_pg_ant_num(padapter)); ++ ++ ret = EXhalbtcoutsrc_InitlizeVariables((void *)padapter); ++ ++ return ret; ++} ++ ++void hal_btcoex_PowerOnSetting(PADAPTER padapter) ++{ ++ EXhalbtcoutsrc_PowerOnSetting(&GLBtCoexist); ++} ++ ++void hal_btcoex_PowerOffSetting(PADAPTER padapter) ++{ ++ /* Clear the WiFi on/off bit in scoreboard reg. if necessary */ ++ if (IS_HARDWARE_TYPE_8703B(padapter) || IS_HARDWARE_TYPE_8723D(padapter) ++ || IS_HARDWARE_TYPE_8821C(padapter) || IS_HARDWARE_TYPE_8822B(padapter)) ++ rtw_write16(padapter, 0xaa, 0x8000); ++} ++ ++void hal_btcoex_PreLoadFirmware(PADAPTER padapter) ++{ ++ EXhalbtcoutsrc_PreLoadFirmware(&GLBtCoexist); ++} ++ ++void hal_btcoex_InitHwConfig(PADAPTER padapter, u8 bWifiOnly) ++{ ++ if (!hal_btcoex_IsBtExist(padapter)) ++ return; ++ ++ EXhalbtcoutsrc_init_hw_config(&GLBtCoexist, bWifiOnly); ++ EXhalbtcoutsrc_init_coex_dm(&GLBtCoexist); ++} ++ ++void hal_btcoex_IpsNotify(PADAPTER padapter, u8 type) ++{ ++ EXhalbtcoutsrc_ips_notify(&GLBtCoexist, type); ++} ++ ++void hal_btcoex_LpsNotify(PADAPTER padapter, u8 type) ++{ ++ EXhalbtcoutsrc_lps_notify(&GLBtCoexist, type); ++} ++ ++void hal_btcoex_ScanNotify(PADAPTER padapter, u8 type) ++{ ++ EXhalbtcoutsrc_scan_notify(&GLBtCoexist, type); ++} ++ ++void hal_btcoex_ConnectNotify(PADAPTER padapter, u8 action) ++{ ++ EXhalbtcoutsrc_connect_notify(&GLBtCoexist, action); ++} ++ ++void hal_btcoex_MediaStatusNotify(PADAPTER padapter, u8 mediaStatus) ++{ ++ EXhalbtcoutsrc_media_status_notify(&GLBtCoexist, mediaStatus); ++} ++ ++void hal_btcoex_SpecialPacketNotify(PADAPTER padapter, u8 pktType) ++{ ++ EXhalbtcoutsrc_specific_packet_notify(&GLBtCoexist, pktType); ++} ++ ++void hal_btcoex_IQKNotify(PADAPTER padapter, u8 state) ++{ ++ GLBtcWiFiInIQKState = state; ++} ++ ++void hal_btcoex_BtInfoNotify(PADAPTER padapter, u8 length, u8 *tmpBuf) ++{ ++ if (GLBtcWiFiInIQKState == _TRUE) ++ return; ++ ++ EXhalbtcoutsrc_bt_info_notify(&GLBtCoexist, tmpBuf, length); ++} ++ ++void hal_btcoex_BtMpRptNotify(PADAPTER padapter, u8 length, u8 *tmpBuf) ++{ ++ u8 extid, status, len, seq; ++ ++ ++ if (!GLBtcBtMpRptWait) ++ return; ++ ++ if ((length < 3) || (!tmpBuf)) ++ return; ++ ++ extid = tmpBuf[0]; ++ /* not response from BT FW then exit*/ ++ switch (extid) { ++ case C2H_WIFI_FW_ACTIVE_RSP: ++ GLBtcBtMpRptWiFiOK = 1; ++ return; ++ ++ case C2H_TRIG_BY_BT_FW: ++ _cancel_timer_ex(&GLBtcBtMpOperTimer); ++ GLBtcBtMpRptWait = 0; ++ GLBtcBtMpRptBTOK = 1; ++ break; ++ ++ default: ++ return; ++ } ++ ++ status = tmpBuf[1] & 0xF; ++ len = length - 3; ++ seq = tmpBuf[2] >> 4; ++ ++ GLBtcBtMpRptSeq = seq; ++ GLBtcBtMpRptStatus = status; ++ _rtw_memcpy(GLBtcBtMpRptRsp, tmpBuf + 3, len); ++ GLBtcBtMpRptRspSize = len; ++ _rtw_up_sema(&GLBtcBtMpRptSema); ++} ++ ++void hal_btcoex_SuspendNotify(PADAPTER padapter, u8 state) ++{ ++ switch (state) { ++ case BTCOEX_SUSPEND_STATE_SUSPEND: ++ EXhalbtcoutsrc_pnp_notify(&GLBtCoexist, BTC_WIFI_PNP_SLEEP); ++ break; ++ case BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT: ++ /* should switch to "#if 1" once all ICs' coex. revision are upgraded to support the KEEP_ANT case */ ++#if 0 ++ EXhalbtcoutsrc_pnp_notify(&GLBtCoexist, BTC_WIFI_PNP_SLEEP_KEEP_ANT); ++#else ++ EXhalbtcoutsrc_pnp_notify(&GLBtCoexist, BTC_WIFI_PNP_SLEEP); ++ EXhalbtcoutsrc_pnp_notify(&GLBtCoexist, BTC_WIFI_PNP_SLEEP_KEEP_ANT); ++#endif ++ break; ++ case BTCOEX_SUSPEND_STATE_RESUME: ++ EXhalbtcoutsrc_pnp_notify(&GLBtCoexist, BTC_WIFI_PNP_WAKE_UP); ++ break; ++ } ++} ++ ++void hal_btcoex_HaltNotify(PADAPTER padapter, u8 do_halt) ++{ ++ if (do_halt == 1) ++ EXhalbtcoutsrc_halt_notify(&GLBtCoexist); ++ ++ GLBtCoexist.bBinded = _FALSE; ++ GLBtCoexist.Adapter = NULL; ++} ++ ++void hal_btcoex_SwitchBtTRxMask(PADAPTER padapter) ++{ ++ EXhalbtcoutsrc_SwitchBtTRxMask(&GLBtCoexist); ++} ++ ++void hal_btcoex_Hanlder(PADAPTER padapter) ++{ ++ u32 bt_patch_ver; ++ ++ EXhalbtcoutsrc_periodical(&GLBtCoexist); ++ ++ if (GLBtCoexist.bt_info.bt_get_fw_ver == 0) { ++ GLBtCoexist.btc_get(&GLBtCoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); ++ GLBtCoexist.bt_info.bt_get_fw_ver = bt_patch_ver; ++ } ++} ++ ++s32 hal_btcoex_IsBTCoexRejectAMPDU(PADAPTER padapter) ++{ ++ return (s32)GLBtCoexist.bt_info.reject_agg_pkt; ++} ++ ++s32 hal_btcoex_IsBTCoexCtrlAMPDUSize(PADAPTER padapter) ++{ ++ return (s32)GLBtCoexist.bt_info.bt_ctrl_agg_buf_size; ++} ++ ++u32 hal_btcoex_GetAMPDUSize(PADAPTER padapter) ++{ ++ return (u32)GLBtCoexist.bt_info.agg_buf_size; ++} ++ ++void hal_btcoex_SetManualControl(PADAPTER padapter, u8 bmanual) ++{ ++ GLBtCoexist.manual_control = bmanual; ++} ++ ++u8 hal_btcoex_1Ant(PADAPTER padapter) ++{ ++ if (hal_btcoex_IsBtExist(padapter) == _FALSE) ++ return _FALSE; ++ ++ if (GLBtCoexist.board_info.btdm_ant_num == 1) ++ return _TRUE; ++ ++ return _FALSE; ++} ++ ++u8 hal_btcoex_IsBtControlLps(PADAPTER padapter) ++{ ++ if (GLBtCoexist.bdontenterLPS == _TRUE) ++ return _TRUE; ++ ++ if (hal_btcoex_IsBtExist(padapter) == _FALSE) ++ return _FALSE; ++ ++ if (GLBtCoexist.bt_info.bt_disabled) ++ return _FALSE; ++ ++ if (GLBtCoexist.bt_info.bt_ctrl_lps) ++ return _TRUE; ++ ++ return _FALSE; ++} ++ ++u8 hal_btcoex_IsLpsOn(PADAPTER padapter) ++{ ++ if (GLBtCoexist.bdontenterLPS == _TRUE) ++ return _FALSE; ++ ++ if (hal_btcoex_IsBtExist(padapter) == _FALSE) ++ return _FALSE; ++ ++ if (GLBtCoexist.bt_info.bt_disabled) ++ return _FALSE; ++ ++ if (GLBtCoexist.bt_info.bt_lps_on) ++ return _TRUE; ++ ++ return _FALSE; ++} ++ ++u8 hal_btcoex_RpwmVal(PADAPTER padapter) ++{ ++ return GLBtCoexist.bt_info.rpwm_val; ++} ++ ++u8 hal_btcoex_LpsVal(PADAPTER padapter) ++{ ++ return GLBtCoexist.bt_info.lps_val; ++} ++ ++u32 hal_btcoex_GetRaMask(PADAPTER padapter) ++{ ++ if (!hal_btcoex_IsBtExist(padapter)) ++ return 0; ++ ++ if (GLBtCoexist.bt_info.bt_disabled) ++ return 0; ++ ++ /* Modify by YiWei , suggest by Cosa and Jenyu ++ * Remove the limit antenna number , because 2 antenna case (ex: 8192eu)also want to get BT coex report rate mask. ++ */ ++ /*if (GLBtCoexist.board_info.btdm_ant_num != 1) ++ return 0;*/ ++ ++ return GLBtCoexist.bt_info.ra_mask; ++} ++ ++void hal_btcoex_RecordPwrMode(PADAPTER padapter, u8 *pCmdBuf, u8 cmdLen) ++{ ++ ++ _rtw_memcpy(GLBtCoexist.pwrModeVal, pCmdBuf, cmdLen); ++} ++ ++void hal_btcoex_DisplayBtCoexInfo(PADAPTER padapter, u8 *pbuf, u32 bufsize) ++{ ++ PBTCDBGINFO pinfo; ++ ++ ++ pinfo = &GLBtcDbgInfo; ++ DBG_BT_INFO_INIT(pinfo, pbuf, bufsize); ++ EXhalbtcoutsrc_DisplayBtCoexInfo(&GLBtCoexist); ++ DBG_BT_INFO_INIT(pinfo, NULL, 0); ++} ++ ++void hal_btcoex_SetDBG(PADAPTER padapter, u32 *pDbgModule) ++{ ++ u32 i; ++ ++ ++ if (NULL == pDbgModule) ++ return; ++ ++ for (i = 0; i < COMP_MAX; i++) ++ GLBtcDbgType[i] = pDbgModule[i]; ++} ++ ++u32 hal_btcoex_GetDBG(PADAPTER padapter, u8 *pStrBuf, u32 bufSize) ++{ ++ s32 count; ++ u8 *pstr; ++ u32 leftSize; ++ ++ ++ if ((NULL == pStrBuf) || (0 == bufSize)) ++ return 0; ++ ++ count = 0; ++ pstr = pStrBuf; ++ leftSize = bufSize; ++ /* RTW_INFO(FUNC_ADPT_FMT ": bufsize=%d\n", FUNC_ADPT_ARG(padapter), bufSize); */ ++ ++ count = rtw_sprintf(pstr, leftSize, "#define DBG\t%d\n", DBG); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ ++ count = rtw_sprintf(pstr, leftSize, "BTCOEX Debug Setting:\n"); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ ++ count = rtw_sprintf(pstr, leftSize, ++ "COMP_COEX: 0x%08X\n\n", ++ GLBtcDbgType[COMP_COEX]); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ ++#if 0 ++ count = rtw_sprintf(pstr, leftSize, "INTERFACE Debug Setting Definition:\n"); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ count = rtw_sprintf(pstr, leftSize, "\tbit[0]=%d for INTF_INIT\n", ++ GLBtcDbgType[BTC_MSG_INTERFACE] & INTF_INIT ? 1 : 0); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ count = rtw_sprintf(pstr, leftSize, "\tbit[2]=%d for INTF_NOTIFY\n\n", ++ GLBtcDbgType[BTC_MSG_INTERFACE] & INTF_NOTIFY ? 1 : 0); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ ++ count = rtw_sprintf(pstr, leftSize, "ALGORITHM Debug Setting Definition:\n"); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ count = rtw_sprintf(pstr, leftSize, "\tbit[0]=%d for BT_RSSI_STATE\n", ++ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_BT_RSSI_STATE ? 1 : 0); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ count = rtw_sprintf(pstr, leftSize, "\tbit[1]=%d for WIFI_RSSI_STATE\n", ++ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_WIFI_RSSI_STATE ? 1 : 0); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ count = rtw_sprintf(pstr, leftSize, "\tbit[2]=%d for BT_MONITOR\n", ++ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_BT_MONITOR ? 1 : 0); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ count = rtw_sprintf(pstr, leftSize, "\tbit[3]=%d for TRACE\n", ++ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE ? 1 : 0); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ count = rtw_sprintf(pstr, leftSize, "\tbit[4]=%d for TRACE_FW\n", ++ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE_FW ? 1 : 0); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ count = rtw_sprintf(pstr, leftSize, "\tbit[5]=%d for TRACE_FW_DETAIL\n", ++ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE_FW_DETAIL ? 1 : 0); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ count = rtw_sprintf(pstr, leftSize, "\tbit[6]=%d for TRACE_FW_EXEC\n", ++ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE_FW_EXEC ? 1 : 0); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ count = rtw_sprintf(pstr, leftSize, "\tbit[7]=%d for TRACE_SW\n", ++ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE_SW ? 1 : 0); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ count = rtw_sprintf(pstr, leftSize, "\tbit[8]=%d for TRACE_SW_DETAIL\n", ++ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE_SW_DETAIL ? 1 : 0); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++ count = rtw_sprintf(pstr, leftSize, "\tbit[9]=%d for TRACE_SW_EXEC\n", ++ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE_SW_EXEC ? 1 : 0); ++ if ((count < 0) || (count >= leftSize)) ++ goto exit; ++ pstr += count; ++ leftSize -= count; ++#endif ++ ++exit: ++ count = pstr - pStrBuf; ++ /* RTW_INFO(FUNC_ADPT_FMT ": usedsize=%d\n", FUNC_ADPT_ARG(padapter), count); */ ++ ++ return count; ++} ++ ++u8 hal_btcoex_IncreaseScanDeviceNum(PADAPTER padapter) ++{ ++ if (!hal_btcoex_IsBtExist(padapter)) ++ return _FALSE; ++ ++ if (GLBtCoexist.bt_info.increase_scan_dev_num) ++ return _TRUE; ++ ++ return _FALSE; ++} ++ ++u8 hal_btcoex_IsBtLinkExist(PADAPTER padapter) ++{ ++ if (GLBtCoexist.bt_link_info.bt_link_exist) ++ return _TRUE; ++ ++ return _FALSE; ++} ++ ++void hal_btcoex_SetBtPatchVersion(PADAPTER padapter, u16 btHciVer, u16 btPatchVer) ++{ ++ EXhalbtcoutsrc_SetBtPatchVersion(btHciVer, btPatchVer); ++} ++ ++void hal_btcoex_SetHciVersion(PADAPTER padapter, u16 hciVersion) ++{ ++ EXhalbtcoutsrc_SetHciVersion(hciVersion); ++} ++ ++void hal_btcoex_StackUpdateProfileInfo(void) ++{ ++ EXhalbtcoutsrc_StackUpdateProfileInfo(); ++} ++ ++void hal_btcoex_BTOffOnNotify(PADAPTER padapter, u8 bBTON) ++{ ++ EXhalbtcoutsrc_BTOffOnNotify(&GLBtCoexist, bBTON); ++} ++ ++/* ++ * Description: ++ * Setting BT coex antenna isolation type . ++ * coex mechanisn/ spital stream/ best throughput ++ * anttype = 0 , PSTDMA / 2SS / 0.5T , bad isolation , WiFi/BT ANT Distance<15cm , (<20dB) for 2,3 antenna ++ * anttype = 1 , PSTDMA / 1SS / 0.5T , normal isolaiton , 50cm>WiFi/BT ANT Distance>15cm , (>20dB) for 2 antenna ++ * anttype = 2 , TDMA / 2SS / T , normal isolaiton , 50cm>WiFi/BT ANT Distance>15cm , (>20dB) for 3 antenna ++ * anttype = 3 , no TDMA / 1SS / 0.5T , good isolation , WiFi/BT ANT Distance >50cm , (>40dB) for 2 antenna ++ * anttype = 4 , no TDMA / 2SS / T , good isolation , WiFi/BT ANT Distance >50cm , (>40dB) for 3 antenna ++ * wifi only throughput ~ T ++ * wifi/BT share one antenna with SPDT ++ */ ++void hal_btcoex_SetAntIsolationType(PADAPTER padapter, u8 anttype) ++{ ++ PHAL_DATA_TYPE pHalData; ++ PBTC_COEXIST pBtCoexist = &GLBtCoexist; ++ ++ /*RTW_INFO("####%s , anttype = %d , %d\n" , __func__ , anttype , __LINE__); */ ++ pHalData = GET_HAL_DATA(padapter); ++ ++ ++ pHalData->bt_coexist.btAntisolation = anttype; ++ ++ switch (pHalData->bt_coexist.btAntisolation) { ++ case 0: ++ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_0; ++ break; ++ case 1: ++ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_1; ++ break; ++ case 2: ++ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_2; ++ break; ++ case 3: ++ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_3; ++ break; ++ case 4: ++ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_4; ++ break; ++ } ++ ++} ++ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++int ++hal_btcoex_ParseAntIsolationConfigFile( ++ PADAPTER Adapter, ++ char *buffer ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u32 i = 0 , j = 0; ++ char *szLine , *ptmp; ++ int rtStatus = _SUCCESS; ++ char param_value_string[10]; ++ u8 param_value; ++ u8 anttype = 4; ++ ++ u8 ant_num = 3 , ant_distance = 50 , rfe_type = 1; ++ ++ typedef struct ant_isolation { ++ char *param_name; /* antenna isolation config parameter name */ ++ u8 *value; /* antenna isolation config parameter value */ ++ } ANT_ISOLATION; ++ ++ ANT_ISOLATION ant_isolation_param[] = { ++ {"ANT_NUMBER" , &ant_num}, ++ {"ANT_DISTANCE" , &ant_distance}, ++ {"RFE_TYPE" , &rfe_type}, ++ {NULL , 0} ++ }; ++ ++ ++ ++ /* RTW_INFO("===>Hal_ParseAntIsolationConfigFile()\n" ); */ ++ ++ ptmp = buffer; ++ for (szLine = GetLineFromBuffer(ptmp) ; szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { ++ /* skip comment */ ++ if (IsCommentString(szLine)) ++ continue; ++ ++ /* RTW_INFO("%s : szLine = %s , strlen(szLine) = %d\n" , __func__ , szLine , strlen(szLine));*/ ++ for (j = 0 ; ant_isolation_param[j].param_name != NULL ; j++) { ++ if (strstr(szLine , ant_isolation_param[j].param_name) != NULL) { ++ i = 0; ++ while (i < strlen(szLine)) { ++ if (szLine[i] != '"') ++ ++i; ++ else { ++ /* skip only has one " */ ++ if (strpbrk(szLine , "\"") == strrchr(szLine , '"')) { ++ RTW_INFO("Fail to parse parameters , format error!\n"); ++ break; ++ } ++ _rtw_memset((PVOID)param_value_string , 0 , 10); ++ if (!ParseQualifiedString(szLine , &i , param_value_string , '"' , '"')) { ++ RTW_INFO("Fail to parse parameters\n"); ++ return _FAIL; ++ } else if (!GetU1ByteIntegerFromStringInDecimal(param_value_string , ant_isolation_param[j].value)) ++ RTW_INFO("Fail to GetU1ByteIntegerFromStringInDecimal\n"); ++ ++ break; ++ } ++ } ++ } ++ } ++ } ++ ++ /* YiWei 20140716 , for BT coex antenna isolation control */ ++ /* rfe_type = 0 was SPDT , rfe_type = 1 was coupler */ ++ if (ant_num == 3 && ant_distance >= 50) ++ anttype = 3; ++ else if (ant_num == 2 && ant_distance >= 50 && rfe_type == 1) ++ anttype = 2; ++ else if (ant_num == 3 && ant_distance >= 15 && ant_distance < 50) ++ anttype = 2; ++ else if (ant_num == 2 && ant_distance >= 15 && ant_distance < 50 && rfe_type == 1) ++ anttype = 2; ++ else if ((ant_num == 2 && ant_distance < 15 && rfe_type == 1) || (ant_num == 3 && ant_distance < 15)) ++ anttype = 1; ++ else if (ant_num == 2 && rfe_type == 0) ++ anttype = 0; ++ else ++ anttype = 0; ++ ++ hal_btcoex_SetAntIsolationType(Adapter, anttype); ++ ++ RTW_INFO("%s : ant_num = %d\n" , __func__ , ant_num); ++ RTW_INFO("%s : ant_distance = %d\n" , __func__ , ant_distance); ++ RTW_INFO("%s : rfe_type = %d\n" , __func__ , rfe_type); ++ /* RTW_INFO("<===Hal_ParseAntIsolationConfigFile()\n"); */ ++ return rtStatus; ++} ++ ++ ++int ++hal_btcoex_AntIsolationConfig_ParaFile( ++ IN PADAPTER Adapter, ++ IN char *pFileName ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ int rlen = 0 , rtStatus = _FAIL; ++ ++ _rtw_memset(pHalData->para_file_buf , 0 , MAX_PARA_FILE_BUF_LEN); ++ ++ rtw_get_phy_file_path(Adapter, pFileName); ++ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { ++ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); ++ if (rlen > 0) ++ rtStatus = _SUCCESS; ++ } ++ ++ ++ if (rtStatus == _SUCCESS) { ++ /*RTW_INFO("%s(): read %s ok\n", __func__ , pFileName);*/ ++ rtStatus = hal_btcoex_ParseAntIsolationConfigFile(Adapter , pHalData->para_file_buf); ++ } else ++ RTW_INFO("%s(): No File %s, Load from *** Array!\n" , __func__ , pFileName); ++ ++ return rtStatus; ++} ++#endif /* CONFIG_LOAD_PHY_PARA_FROM_FILE */ ++ ++u16 hal_btcoex_btreg_read(PADAPTER padapter, u8 type, u16 addr, u32 *data) ++{ ++ u16 ret = 0; ++ ++ halbtcoutsrc_LeaveLowPower(&GLBtCoexist); ++ ++ ret = halbtcoutsrc_GetBtReg_with_status(&GLBtCoexist, type, addr, data); ++ ++ halbtcoutsrc_NormalLowPower(&GLBtCoexist); ++ ++ return ret; ++} ++ ++u16 hal_btcoex_btreg_write(PADAPTER padapter, u8 type, u16 addr, u16 val) ++{ ++ u16 ret = 0; ++ ++ halbtcoutsrc_LeaveLowPower(&GLBtCoexist); ++ ++ ret = halbtcoutsrc_SetBtReg(&GLBtCoexist, type, addr, val); ++ ++ halbtcoutsrc_NormalLowPower(&GLBtCoexist); ++ ++ return ret; ++} ++ ++void hal_btcoex_set_rfe_type(u8 type) ++{ ++ EXhalbtcoutsrc_set_rfe_type(type); ++} ++void hal_btcoex_switchband_notify(u8 under_scan, u8 band_type) ++{ ++ switch (band_type) { ++ case BAND_ON_2_4G: ++ if (under_scan) ++ EXhalbtcoutsrc_switchband_notify(&GLBtCoexist, BTC_SWITCH_TO_24G); ++ else ++ EXhalbtcoutsrc_switchband_notify(&GLBtCoexist, BTC_SWITCH_TO_24G_NOFORSCAN); ++ break; ++ case BAND_ON_5G: ++ EXhalbtcoutsrc_switchband_notify(&GLBtCoexist, BTC_SWITCH_TO_5G); ++ break; ++ default: ++ RTW_INFO("[BTCOEX] unkown switch band type\n"); ++ break; ++ } ++} ++#endif /* CONFIG_BT_COEXIST */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_com.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_com.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/hal_com.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_com.c 2018-02-11 21:44:27.151146147 +0200 +@@ -0,0 +1,10423 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _HAL_COM_C_ ++ ++#include ++#include "hal_com_h2c.h" ++ ++#include "hal_data.h" ++ ++/* #define CONFIG_GTK_OL_DBG */ ++ ++/*#define DBG_SEC_CAM_MOVE*/ ++#ifdef DBG_SEC_CAM_MOVE ++void rtw_hal_move_sta_gk_to_dk(_adapter *adapter) ++{ ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ int cam_id, index = 0; ++ u8 *addr = NULL; ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ return; ++ ++ addr = get_bssid(pmlmepriv); ++ ++ if (addr == NULL) { ++ RTW_INFO("%s: get bssid MAC addr fail!!\n", __func__); ++ return; ++ } ++ ++ rtw_clean_dk_section(adapter); ++ ++ do { ++ cam_id = rtw_camid_search(adapter, addr, index, 1); ++ ++ if (cam_id == -1) ++ RTW_INFO("%s: cam_id: %d, key_id:%d\n", __func__, cam_id, index); ++ else ++ rtw_sec_cam_swap(adapter, cam_id, index); ++ ++ index++; ++ } while (index < 4); ++ ++} ++ ++void rtw_hal_read_sta_dk_key(_adapter *adapter, u8 key_id) ++{ ++ struct security_priv *psecuritypriv = &adapter->securitypriv; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ u8 get_key[16]; ++ ++ _rtw_memset(get_key, 0, sizeof(get_key)); ++ ++ if (key_id > 4) { ++ RTW_INFO("%s [ERROR] gtk_keyindex:%d invalid\n", __func__, key_id); ++ rtw_warn_on(1); ++ return; ++ } ++ rtw_sec_read_cam_ent(adapter, key_id, NULL, NULL, get_key); ++ ++ /*update key into related sw variable*/ ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ if (_rtw_camid_is_gk(adapter, key_id)) { ++ RTW_INFO("[HW KEY] -Key-id:%d "KEY_FMT"\n", key_id, KEY_ARG(get_key)); ++ RTW_INFO("[cam_cache KEY] - Key-id:%d "KEY_FMT"\n", key_id, KEY_ARG(&dvobj->cam_cache[key_id].key)); ++ } ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++ ++} ++#endif ++ ++ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ char rtw_phy_para_file_path[PATH_LENGTH_MAX]; ++#endif ++ ++void dump_chip_info(HAL_VERSION ChipVersion) ++{ ++ int cnt = 0; ++ u8 buf[128] = {0}; ++ ++ if (IS_8188E(ChipVersion)) ++ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8188E_"); ++ else if (IS_8188F(ChipVersion)) ++ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8188F_"); ++ else if (IS_8812_SERIES(ChipVersion)) ++ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8812_"); ++ else if (IS_8192E(ChipVersion)) ++ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8192E_"); ++ else if (IS_8821_SERIES(ChipVersion)) ++ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8821_"); ++ else if (IS_8723B_SERIES(ChipVersion)) ++ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8723B_"); ++ else if (IS_8703B_SERIES(ChipVersion)) ++ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8703B_"); ++ else if (IS_8723D_SERIES(ChipVersion)) ++ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8723D_"); ++ else if (IS_8814A_SERIES(ChipVersion)) ++ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8814A_"); ++ else if (IS_8822B_SERIES(ChipVersion)) ++ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8822B_"); ++ else if (IS_8821C_SERIES(ChipVersion)) ++ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8821C_"); ++ else ++ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_UNKNOWN_"); ++ ++ cnt += sprintf((buf + cnt), "%s_", IS_NORMAL_CHIP(ChipVersion) ? "Normal_Chip" : "Test_Chip"); ++ if (IS_CHIP_VENDOR_TSMC(ChipVersion)) ++ cnt += sprintf((buf + cnt), "%s_", "TSMC"); ++ else if (IS_CHIP_VENDOR_UMC(ChipVersion)) ++ cnt += sprintf((buf + cnt), "%s_", "UMC"); ++ else if (IS_CHIP_VENDOR_SMIC(ChipVersion)) ++ cnt += sprintf((buf + cnt), "%s_", "SMIC"); ++ ++ if (IS_A_CUT(ChipVersion)) ++ cnt += sprintf((buf + cnt), "A_CUT_"); ++ else if (IS_B_CUT(ChipVersion)) ++ cnt += sprintf((buf + cnt), "B_CUT_"); ++ else if (IS_C_CUT(ChipVersion)) ++ cnt += sprintf((buf + cnt), "C_CUT_"); ++ else if (IS_D_CUT(ChipVersion)) ++ cnt += sprintf((buf + cnt), "D_CUT_"); ++ else if (IS_E_CUT(ChipVersion)) ++ cnt += sprintf((buf + cnt), "E_CUT_"); ++ else if (IS_F_CUT(ChipVersion)) ++ cnt += sprintf((buf + cnt), "F_CUT_"); ++ else if (IS_I_CUT(ChipVersion)) ++ cnt += sprintf((buf + cnt), "I_CUT_"); ++ else if (IS_J_CUT(ChipVersion)) ++ cnt += sprintf((buf + cnt), "J_CUT_"); ++ else if (IS_K_CUT(ChipVersion)) ++ cnt += sprintf((buf + cnt), "K_CUT_"); ++ else ++ cnt += sprintf((buf + cnt), "UNKNOWN_CUT(%d)_", ChipVersion.CUTVersion); ++ ++ if (IS_1T1R(ChipVersion)) ++ cnt += sprintf((buf + cnt), "1T1R_"); ++ else if (IS_1T2R(ChipVersion)) ++ cnt += sprintf((buf + cnt), "1T2R_"); ++ else if (IS_2T2R(ChipVersion)) ++ cnt += sprintf((buf + cnt), "2T2R_"); ++ else if (IS_3T3R(ChipVersion)) ++ cnt += sprintf((buf + cnt), "3T3R_"); ++ else if (IS_3T4R(ChipVersion)) ++ cnt += sprintf((buf + cnt), "3T4R_"); ++ else if (IS_4T4R(ChipVersion)) ++ cnt += sprintf((buf + cnt), "4T4R_"); ++ else ++ cnt += sprintf((buf + cnt), "UNKNOWN_RFTYPE(%d)_", ChipVersion.RFType); ++ ++ cnt += sprintf((buf + cnt), "RomVer(%d)\n", ChipVersion.ROMVer); ++ ++ RTW_INFO("%s", buf); ++} ++void rtw_hal_config_rftype(PADAPTER padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ if (IS_1T1R(pHalData->VersionID)) { ++ pHalData->rf_type = RF_1T1R; ++ pHalData->NumTotalRFPath = 1; ++ } else if (IS_2T2R(pHalData->VersionID)) { ++ pHalData->rf_type = RF_2T2R; ++ pHalData->NumTotalRFPath = 2; ++ } else if (IS_1T2R(pHalData->VersionID)) { ++ pHalData->rf_type = RF_1T2R; ++ pHalData->NumTotalRFPath = 2; ++ } else if (IS_3T3R(pHalData->VersionID)) { ++ pHalData->rf_type = RF_3T3R; ++ pHalData->NumTotalRFPath = 3; ++ } else if (IS_4T4R(pHalData->VersionID)) { ++ pHalData->rf_type = RF_4T4R; ++ pHalData->NumTotalRFPath = 4; ++ } else { ++ pHalData->rf_type = RF_1T1R; ++ pHalData->NumTotalRFPath = 1; ++ } ++ ++ RTW_INFO("%s RF_Type is %d TotalTxPath is %d\n", __FUNCTION__, pHalData->rf_type, pHalData->NumTotalRFPath); ++} ++ ++#define EEPROM_CHANNEL_PLAN_BY_HW_MASK 0x80 ++ ++/* ++ * Description: ++ * Use hardware(efuse), driver parameter(registry) and default channel plan ++ * to decide which one should be used. ++ * ++ * Parameters: ++ * padapter pointer of adapter ++ * hw_alpha2 country code from HW (efuse/eeprom/mapfile) ++ * hw_chplan channel plan from HW (efuse/eeprom/mapfile) ++ * BIT[7] software configure mode; 0:Enable, 1:disable ++ * BIT[6:0] Channel Plan ++ * sw_alpha2 country code from HW (registry/module param) ++ * sw_chplan channel plan from SW (registry/module param) ++ * def_chplan channel plan used when HW/SW both invalid ++ * AutoLoadFail efuse autoload fail or not ++ * ++ * Return: ++ * Final channel plan decision ++ * ++ */ ++u8 hal_com_config_channel_plan( ++ IN PADAPTER padapter, ++ IN char *hw_alpha2, ++ IN u8 hw_chplan, ++ IN char *sw_alpha2, ++ IN u8 sw_chplan, ++ IN u8 def_chplan, ++ IN BOOLEAN AutoLoadFail ++) ++{ ++ PHAL_DATA_TYPE pHalData; ++ u8 force_hw_chplan = _FALSE; ++ int chplan = -1; ++ const struct country_chplan *country_ent = NULL, *ent; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ ++ /* treat 0xFF as invalid value, bypass hw_chplan & force_hw_chplan parsing */ ++ if (hw_chplan == 0xFF) ++ goto chk_hw_country_code; ++ ++ if (AutoLoadFail == _TRUE) ++ goto chk_sw_config; ++ ++#ifndef CONFIG_FORCE_SW_CHANNEL_PLAN ++ if (hw_chplan & EEPROM_CHANNEL_PLAN_BY_HW_MASK) ++ force_hw_chplan = _TRUE; ++#endif ++ ++ hw_chplan &= (~EEPROM_CHANNEL_PLAN_BY_HW_MASK); ++ ++chk_hw_country_code: ++ if (hw_alpha2 && !IS_ALPHA2_NO_SPECIFIED(hw_alpha2)) { ++ ent = rtw_get_chplan_from_country(hw_alpha2); ++ if (ent) { ++ /* get chplan from hw country code, by pass hw chplan setting */ ++ country_ent = ent; ++ chplan = ent->chplan; ++ goto chk_sw_config; ++ } else ++ RTW_PRINT("%s unsupported hw_alpha2:\"%c%c\"\n", __func__, hw_alpha2[0], hw_alpha2[1]); ++ } ++ ++ if (rtw_is_channel_plan_valid(hw_chplan)) ++ chplan = hw_chplan; ++ else if (force_hw_chplan == _TRUE) { ++ RTW_PRINT("%s unsupported hw_chplan:0x%02X\n", __func__, hw_chplan); ++ /* hw infomaton invalid, refer to sw information */ ++ force_hw_chplan = _FALSE; ++ } ++ ++chk_sw_config: ++ if (force_hw_chplan == _TRUE) ++ goto done; ++ ++ if (sw_alpha2 && !IS_ALPHA2_NO_SPECIFIED(sw_alpha2)) { ++ ent = rtw_get_chplan_from_country(sw_alpha2); ++ if (ent) { ++ /* get chplan from sw country code, by pass sw chplan setting */ ++ country_ent = ent; ++ chplan = ent->chplan; ++ goto done; ++ } else ++ RTW_PRINT("%s unsupported sw_alpha2:\"%c%c\"\n", __func__, sw_alpha2[0], sw_alpha2[1]); ++ } ++ ++ if (rtw_is_channel_plan_valid(sw_chplan)) { ++ /* cancel hw_alpha2 because chplan is specified by sw_chplan*/ ++ country_ent = NULL; ++ chplan = sw_chplan; ++ } else if (sw_chplan != RTW_CHPLAN_MAX) ++ RTW_PRINT("%s unsupported sw_chplan:0x%02X\n", __func__, sw_chplan); ++ ++done: ++ if (chplan == -1) { ++ RTW_PRINT("%s use def_chplan:0x%02X\n", __func__, def_chplan); ++ chplan = def_chplan; ++ } else if (country_ent) { ++ RTW_PRINT("%s country code:\"%c%c\" with chplan:0x%02X\n", __func__ ++ , country_ent->alpha2[0], country_ent->alpha2[1], country_ent->chplan); ++ } else ++ RTW_PRINT("%s chplan:0x%02X\n", __func__, chplan); ++ ++ padapter->mlmepriv.country_ent = country_ent; ++ pHalData->bDisableSWChannelPlan = force_hw_chplan; ++ ++ return chplan; ++} ++ ++BOOLEAN ++HAL_IsLegalChannel( ++ IN PADAPTER Adapter, ++ IN u32 Channel ++) ++{ ++ BOOLEAN bLegalChannel = _TRUE; ++ ++ if (Channel > 14) { ++ if (IsSupported5G(Adapter->registrypriv.wireless_mode) == _FALSE) { ++ bLegalChannel = _FALSE; ++ RTW_INFO("Channel > 14 but wireless_mode do not support 5G\n"); ++ } ++ } else if ((Channel <= 14) && (Channel >= 1)) { ++ if (IsSupported24G(Adapter->registrypriv.wireless_mode) == _FALSE) { ++ bLegalChannel = _FALSE; ++ RTW_INFO("(Channel <= 14) && (Channel >=1) but wireless_mode do not support 2.4G\n"); ++ } ++ } else { ++ bLegalChannel = _FALSE; ++ RTW_INFO("Channel is Invalid !!!\n"); ++ } ++ ++ return bLegalChannel; ++} ++ ++u8 MRateToHwRate(u8 rate) ++{ ++ u8 ret = DESC_RATE1M; ++ ++ switch (rate) { ++ case MGN_1M: ++ ret = DESC_RATE1M; ++ break; ++ case MGN_2M: ++ ret = DESC_RATE2M; ++ break; ++ case MGN_5_5M: ++ ret = DESC_RATE5_5M; ++ break; ++ case MGN_11M: ++ ret = DESC_RATE11M; ++ break; ++ case MGN_6M: ++ ret = DESC_RATE6M; ++ break; ++ case MGN_9M: ++ ret = DESC_RATE9M; ++ break; ++ case MGN_12M: ++ ret = DESC_RATE12M; ++ break; ++ case MGN_18M: ++ ret = DESC_RATE18M; ++ break; ++ case MGN_24M: ++ ret = DESC_RATE24M; ++ break; ++ case MGN_36M: ++ ret = DESC_RATE36M; ++ break; ++ case MGN_48M: ++ ret = DESC_RATE48M; ++ break; ++ case MGN_54M: ++ ret = DESC_RATE54M; ++ break; ++ ++ case MGN_MCS0: ++ ret = DESC_RATEMCS0; ++ break; ++ case MGN_MCS1: ++ ret = DESC_RATEMCS1; ++ break; ++ case MGN_MCS2: ++ ret = DESC_RATEMCS2; ++ break; ++ case MGN_MCS3: ++ ret = DESC_RATEMCS3; ++ break; ++ case MGN_MCS4: ++ ret = DESC_RATEMCS4; ++ break; ++ case MGN_MCS5: ++ ret = DESC_RATEMCS5; ++ break; ++ case MGN_MCS6: ++ ret = DESC_RATEMCS6; ++ break; ++ case MGN_MCS7: ++ ret = DESC_RATEMCS7; ++ break; ++ case MGN_MCS8: ++ ret = DESC_RATEMCS8; ++ break; ++ case MGN_MCS9: ++ ret = DESC_RATEMCS9; ++ break; ++ case MGN_MCS10: ++ ret = DESC_RATEMCS10; ++ break; ++ case MGN_MCS11: ++ ret = DESC_RATEMCS11; ++ break; ++ case MGN_MCS12: ++ ret = DESC_RATEMCS12; ++ break; ++ case MGN_MCS13: ++ ret = DESC_RATEMCS13; ++ break; ++ case MGN_MCS14: ++ ret = DESC_RATEMCS14; ++ break; ++ case MGN_MCS15: ++ ret = DESC_RATEMCS15; ++ break; ++ case MGN_MCS16: ++ ret = DESC_RATEMCS16; ++ break; ++ case MGN_MCS17: ++ ret = DESC_RATEMCS17; ++ break; ++ case MGN_MCS18: ++ ret = DESC_RATEMCS18; ++ break; ++ case MGN_MCS19: ++ ret = DESC_RATEMCS19; ++ break; ++ case MGN_MCS20: ++ ret = DESC_RATEMCS20; ++ break; ++ case MGN_MCS21: ++ ret = DESC_RATEMCS21; ++ break; ++ case MGN_MCS22: ++ ret = DESC_RATEMCS22; ++ break; ++ case MGN_MCS23: ++ ret = DESC_RATEMCS23; ++ break; ++ case MGN_MCS24: ++ ret = DESC_RATEMCS24; ++ break; ++ case MGN_MCS25: ++ ret = DESC_RATEMCS25; ++ break; ++ case MGN_MCS26: ++ ret = DESC_RATEMCS26; ++ break; ++ case MGN_MCS27: ++ ret = DESC_RATEMCS27; ++ break; ++ case MGN_MCS28: ++ ret = DESC_RATEMCS28; ++ break; ++ case MGN_MCS29: ++ ret = DESC_RATEMCS29; ++ break; ++ case MGN_MCS30: ++ ret = DESC_RATEMCS30; ++ break; ++ case MGN_MCS31: ++ ret = DESC_RATEMCS31; ++ break; ++ ++ case MGN_VHT1SS_MCS0: ++ ret = DESC_RATEVHTSS1MCS0; ++ break; ++ case MGN_VHT1SS_MCS1: ++ ret = DESC_RATEVHTSS1MCS1; ++ break; ++ case MGN_VHT1SS_MCS2: ++ ret = DESC_RATEVHTSS1MCS2; ++ break; ++ case MGN_VHT1SS_MCS3: ++ ret = DESC_RATEVHTSS1MCS3; ++ break; ++ case MGN_VHT1SS_MCS4: ++ ret = DESC_RATEVHTSS1MCS4; ++ break; ++ case MGN_VHT1SS_MCS5: ++ ret = DESC_RATEVHTSS1MCS5; ++ break; ++ case MGN_VHT1SS_MCS6: ++ ret = DESC_RATEVHTSS1MCS6; ++ break; ++ case MGN_VHT1SS_MCS7: ++ ret = DESC_RATEVHTSS1MCS7; ++ break; ++ case MGN_VHT1SS_MCS8: ++ ret = DESC_RATEVHTSS1MCS8; ++ break; ++ case MGN_VHT1SS_MCS9: ++ ret = DESC_RATEVHTSS1MCS9; ++ break; ++ case MGN_VHT2SS_MCS0: ++ ret = DESC_RATEVHTSS2MCS0; ++ break; ++ case MGN_VHT2SS_MCS1: ++ ret = DESC_RATEVHTSS2MCS1; ++ break; ++ case MGN_VHT2SS_MCS2: ++ ret = DESC_RATEVHTSS2MCS2; ++ break; ++ case MGN_VHT2SS_MCS3: ++ ret = DESC_RATEVHTSS2MCS3; ++ break; ++ case MGN_VHT2SS_MCS4: ++ ret = DESC_RATEVHTSS2MCS4; ++ break; ++ case MGN_VHT2SS_MCS5: ++ ret = DESC_RATEVHTSS2MCS5; ++ break; ++ case MGN_VHT2SS_MCS6: ++ ret = DESC_RATEVHTSS2MCS6; ++ break; ++ case MGN_VHT2SS_MCS7: ++ ret = DESC_RATEVHTSS2MCS7; ++ break; ++ case MGN_VHT2SS_MCS8: ++ ret = DESC_RATEVHTSS2MCS8; ++ break; ++ case MGN_VHT2SS_MCS9: ++ ret = DESC_RATEVHTSS2MCS9; ++ break; ++ case MGN_VHT3SS_MCS0: ++ ret = DESC_RATEVHTSS3MCS0; ++ break; ++ case MGN_VHT3SS_MCS1: ++ ret = DESC_RATEVHTSS3MCS1; ++ break; ++ case MGN_VHT3SS_MCS2: ++ ret = DESC_RATEVHTSS3MCS2; ++ break; ++ case MGN_VHT3SS_MCS3: ++ ret = DESC_RATEVHTSS3MCS3; ++ break; ++ case MGN_VHT3SS_MCS4: ++ ret = DESC_RATEVHTSS3MCS4; ++ break; ++ case MGN_VHT3SS_MCS5: ++ ret = DESC_RATEVHTSS3MCS5; ++ break; ++ case MGN_VHT3SS_MCS6: ++ ret = DESC_RATEVHTSS3MCS6; ++ break; ++ case MGN_VHT3SS_MCS7: ++ ret = DESC_RATEVHTSS3MCS7; ++ break; ++ case MGN_VHT3SS_MCS8: ++ ret = DESC_RATEVHTSS3MCS8; ++ break; ++ case MGN_VHT3SS_MCS9: ++ ret = DESC_RATEVHTSS3MCS9; ++ break; ++ case MGN_VHT4SS_MCS0: ++ ret = DESC_RATEVHTSS4MCS0; ++ break; ++ case MGN_VHT4SS_MCS1: ++ ret = DESC_RATEVHTSS4MCS1; ++ break; ++ case MGN_VHT4SS_MCS2: ++ ret = DESC_RATEVHTSS4MCS2; ++ break; ++ case MGN_VHT4SS_MCS3: ++ ret = DESC_RATEVHTSS4MCS3; ++ break; ++ case MGN_VHT4SS_MCS4: ++ ret = DESC_RATEVHTSS4MCS4; ++ break; ++ case MGN_VHT4SS_MCS5: ++ ret = DESC_RATEVHTSS4MCS5; ++ break; ++ case MGN_VHT4SS_MCS6: ++ ret = DESC_RATEVHTSS4MCS6; ++ break; ++ case MGN_VHT4SS_MCS7: ++ ret = DESC_RATEVHTSS4MCS7; ++ break; ++ case MGN_VHT4SS_MCS8: ++ ret = DESC_RATEVHTSS4MCS8; ++ break; ++ case MGN_VHT4SS_MCS9: ++ ret = DESC_RATEVHTSS4MCS9; ++ break; ++ default: ++ break; ++ } ++ ++ return ret; ++} ++ ++u8 HwRateToMRate(u8 rate) ++{ ++ u8 ret_rate = MGN_1M; ++ ++ switch (rate) { ++ ++ case DESC_RATE1M: ++ ret_rate = MGN_1M; ++ break; ++ case DESC_RATE2M: ++ ret_rate = MGN_2M; ++ break; ++ case DESC_RATE5_5M: ++ ret_rate = MGN_5_5M; ++ break; ++ case DESC_RATE11M: ++ ret_rate = MGN_11M; ++ break; ++ case DESC_RATE6M: ++ ret_rate = MGN_6M; ++ break; ++ case DESC_RATE9M: ++ ret_rate = MGN_9M; ++ break; ++ case DESC_RATE12M: ++ ret_rate = MGN_12M; ++ break; ++ case DESC_RATE18M: ++ ret_rate = MGN_18M; ++ break; ++ case DESC_RATE24M: ++ ret_rate = MGN_24M; ++ break; ++ case DESC_RATE36M: ++ ret_rate = MGN_36M; ++ break; ++ case DESC_RATE48M: ++ ret_rate = MGN_48M; ++ break; ++ case DESC_RATE54M: ++ ret_rate = MGN_54M; ++ break; ++ case DESC_RATEMCS0: ++ ret_rate = MGN_MCS0; ++ break; ++ case DESC_RATEMCS1: ++ ret_rate = MGN_MCS1; ++ break; ++ case DESC_RATEMCS2: ++ ret_rate = MGN_MCS2; ++ break; ++ case DESC_RATEMCS3: ++ ret_rate = MGN_MCS3; ++ break; ++ case DESC_RATEMCS4: ++ ret_rate = MGN_MCS4; ++ break; ++ case DESC_RATEMCS5: ++ ret_rate = MGN_MCS5; ++ break; ++ case DESC_RATEMCS6: ++ ret_rate = MGN_MCS6; ++ break; ++ case DESC_RATEMCS7: ++ ret_rate = MGN_MCS7; ++ break; ++ case DESC_RATEMCS8: ++ ret_rate = MGN_MCS8; ++ break; ++ case DESC_RATEMCS9: ++ ret_rate = MGN_MCS9; ++ break; ++ case DESC_RATEMCS10: ++ ret_rate = MGN_MCS10; ++ break; ++ case DESC_RATEMCS11: ++ ret_rate = MGN_MCS11; ++ break; ++ case DESC_RATEMCS12: ++ ret_rate = MGN_MCS12; ++ break; ++ case DESC_RATEMCS13: ++ ret_rate = MGN_MCS13; ++ break; ++ case DESC_RATEMCS14: ++ ret_rate = MGN_MCS14; ++ break; ++ case DESC_RATEMCS15: ++ ret_rate = MGN_MCS15; ++ break; ++ case DESC_RATEMCS16: ++ ret_rate = MGN_MCS16; ++ break; ++ case DESC_RATEMCS17: ++ ret_rate = MGN_MCS17; ++ break; ++ case DESC_RATEMCS18: ++ ret_rate = MGN_MCS18; ++ break; ++ case DESC_RATEMCS19: ++ ret_rate = MGN_MCS19; ++ break; ++ case DESC_RATEMCS20: ++ ret_rate = MGN_MCS20; ++ break; ++ case DESC_RATEMCS21: ++ ret_rate = MGN_MCS21; ++ break; ++ case DESC_RATEMCS22: ++ ret_rate = MGN_MCS22; ++ break; ++ case DESC_RATEMCS23: ++ ret_rate = MGN_MCS23; ++ break; ++ case DESC_RATEMCS24: ++ ret_rate = MGN_MCS24; ++ break; ++ case DESC_RATEMCS25: ++ ret_rate = MGN_MCS25; ++ break; ++ case DESC_RATEMCS26: ++ ret_rate = MGN_MCS26; ++ break; ++ case DESC_RATEMCS27: ++ ret_rate = MGN_MCS27; ++ break; ++ case DESC_RATEMCS28: ++ ret_rate = MGN_MCS28; ++ break; ++ case DESC_RATEMCS29: ++ ret_rate = MGN_MCS29; ++ break; ++ case DESC_RATEMCS30: ++ ret_rate = MGN_MCS30; ++ break; ++ case DESC_RATEMCS31: ++ ret_rate = MGN_MCS31; ++ break; ++ case DESC_RATEVHTSS1MCS0: ++ ret_rate = MGN_VHT1SS_MCS0; ++ break; ++ case DESC_RATEVHTSS1MCS1: ++ ret_rate = MGN_VHT1SS_MCS1; ++ break; ++ case DESC_RATEVHTSS1MCS2: ++ ret_rate = MGN_VHT1SS_MCS2; ++ break; ++ case DESC_RATEVHTSS1MCS3: ++ ret_rate = MGN_VHT1SS_MCS3; ++ break; ++ case DESC_RATEVHTSS1MCS4: ++ ret_rate = MGN_VHT1SS_MCS4; ++ break; ++ case DESC_RATEVHTSS1MCS5: ++ ret_rate = MGN_VHT1SS_MCS5; ++ break; ++ case DESC_RATEVHTSS1MCS6: ++ ret_rate = MGN_VHT1SS_MCS6; ++ break; ++ case DESC_RATEVHTSS1MCS7: ++ ret_rate = MGN_VHT1SS_MCS7; ++ break; ++ case DESC_RATEVHTSS1MCS8: ++ ret_rate = MGN_VHT1SS_MCS8; ++ break; ++ case DESC_RATEVHTSS1MCS9: ++ ret_rate = MGN_VHT1SS_MCS9; ++ break; ++ case DESC_RATEVHTSS2MCS0: ++ ret_rate = MGN_VHT2SS_MCS0; ++ break; ++ case DESC_RATEVHTSS2MCS1: ++ ret_rate = MGN_VHT2SS_MCS1; ++ break; ++ case DESC_RATEVHTSS2MCS2: ++ ret_rate = MGN_VHT2SS_MCS2; ++ break; ++ case DESC_RATEVHTSS2MCS3: ++ ret_rate = MGN_VHT2SS_MCS3; ++ break; ++ case DESC_RATEVHTSS2MCS4: ++ ret_rate = MGN_VHT2SS_MCS4; ++ break; ++ case DESC_RATEVHTSS2MCS5: ++ ret_rate = MGN_VHT2SS_MCS5; ++ break; ++ case DESC_RATEVHTSS2MCS6: ++ ret_rate = MGN_VHT2SS_MCS6; ++ break; ++ case DESC_RATEVHTSS2MCS7: ++ ret_rate = MGN_VHT2SS_MCS7; ++ break; ++ case DESC_RATEVHTSS2MCS8: ++ ret_rate = MGN_VHT2SS_MCS8; ++ break; ++ case DESC_RATEVHTSS2MCS9: ++ ret_rate = MGN_VHT2SS_MCS9; ++ break; ++ case DESC_RATEVHTSS3MCS0: ++ ret_rate = MGN_VHT3SS_MCS0; ++ break; ++ case DESC_RATEVHTSS3MCS1: ++ ret_rate = MGN_VHT3SS_MCS1; ++ break; ++ case DESC_RATEVHTSS3MCS2: ++ ret_rate = MGN_VHT3SS_MCS2; ++ break; ++ case DESC_RATEVHTSS3MCS3: ++ ret_rate = MGN_VHT3SS_MCS3; ++ break; ++ case DESC_RATEVHTSS3MCS4: ++ ret_rate = MGN_VHT3SS_MCS4; ++ break; ++ case DESC_RATEVHTSS3MCS5: ++ ret_rate = MGN_VHT3SS_MCS5; ++ break; ++ case DESC_RATEVHTSS3MCS6: ++ ret_rate = MGN_VHT3SS_MCS6; ++ break; ++ case DESC_RATEVHTSS3MCS7: ++ ret_rate = MGN_VHT3SS_MCS7; ++ break; ++ case DESC_RATEVHTSS3MCS8: ++ ret_rate = MGN_VHT3SS_MCS8; ++ break; ++ case DESC_RATEVHTSS3MCS9: ++ ret_rate = MGN_VHT3SS_MCS9; ++ break; ++ case DESC_RATEVHTSS4MCS0: ++ ret_rate = MGN_VHT4SS_MCS0; ++ break; ++ case DESC_RATEVHTSS4MCS1: ++ ret_rate = MGN_VHT4SS_MCS1; ++ break; ++ case DESC_RATEVHTSS4MCS2: ++ ret_rate = MGN_VHT4SS_MCS2; ++ break; ++ case DESC_RATEVHTSS4MCS3: ++ ret_rate = MGN_VHT4SS_MCS3; ++ break; ++ case DESC_RATEVHTSS4MCS4: ++ ret_rate = MGN_VHT4SS_MCS4; ++ break; ++ case DESC_RATEVHTSS4MCS5: ++ ret_rate = MGN_VHT4SS_MCS5; ++ break; ++ case DESC_RATEVHTSS4MCS6: ++ ret_rate = MGN_VHT4SS_MCS6; ++ break; ++ case DESC_RATEVHTSS4MCS7: ++ ret_rate = MGN_VHT4SS_MCS7; ++ break; ++ case DESC_RATEVHTSS4MCS8: ++ ret_rate = MGN_VHT4SS_MCS8; ++ break; ++ case DESC_RATEVHTSS4MCS9: ++ ret_rate = MGN_VHT4SS_MCS9; ++ break; ++ ++ default: ++ RTW_INFO("HwRateToMRate(): Non supported Rate [%x]!!!\n", rate); ++ break; ++ } ++ ++ return ret_rate; ++} ++ ++void HalSetBrateCfg( ++ IN PADAPTER Adapter, ++ IN u8 *mBratesOS, ++ OUT u16 *pBrateCfg) ++{ ++ u8 i, is_brate, brate; ++ ++ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { ++ is_brate = mBratesOS[i] & IEEE80211_BASIC_RATE_MASK; ++ brate = mBratesOS[i] & 0x7f; ++ ++ if (is_brate) { ++ switch (brate) { ++ case IEEE80211_CCK_RATE_1MB: ++ *pBrateCfg |= RATE_1M; ++ break; ++ case IEEE80211_CCK_RATE_2MB: ++ *pBrateCfg |= RATE_2M; ++ break; ++ case IEEE80211_CCK_RATE_5MB: ++ *pBrateCfg |= RATE_5_5M; ++ break; ++ case IEEE80211_CCK_RATE_11MB: ++ *pBrateCfg |= RATE_11M; ++ break; ++ case IEEE80211_OFDM_RATE_6MB: ++ *pBrateCfg |= RATE_6M; ++ break; ++ case IEEE80211_OFDM_RATE_9MB: ++ *pBrateCfg |= RATE_9M; ++ break; ++ case IEEE80211_OFDM_RATE_12MB: ++ *pBrateCfg |= RATE_12M; ++ break; ++ case IEEE80211_OFDM_RATE_18MB: ++ *pBrateCfg |= RATE_18M; ++ break; ++ case IEEE80211_OFDM_RATE_24MB: ++ *pBrateCfg |= RATE_24M; ++ break; ++ case IEEE80211_OFDM_RATE_36MB: ++ *pBrateCfg |= RATE_36M; ++ break; ++ case IEEE80211_OFDM_RATE_48MB: ++ *pBrateCfg |= RATE_48M; ++ break; ++ case IEEE80211_OFDM_RATE_54MB: ++ *pBrateCfg |= RATE_54M; ++ break; ++ } ++ } ++ } ++} ++ ++static VOID ++_OneOutPipeMapping( ++ IN PADAPTER pAdapter ++) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); ++ ++ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ ++ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];/* VI */ ++ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[0];/* BE */ ++ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[0];/* BK */ ++ ++ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ ++ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ ++ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ ++ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ ++} ++ ++static VOID ++_TwoOutPipeMapping( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bWIFICfg ++) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); ++ ++ if (bWIFICfg) { /* WMM */ ++ ++ /* BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA */ ++ /* { 0, 1, 0, 1, 0, 0, 0, 0, 0 }; */ ++ /* 0:ep_0 num, 1:ep_1 num */ ++ ++ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[1];/* VO */ ++ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];/* VI */ ++ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[1];/* BE */ ++ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[0];/* BK */ ++ ++ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ ++ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ ++ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ ++ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ ++ ++ } else { /* typical setting */ ++ ++ ++ /* BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA */ ++ /* { 1, 1, 0, 0, 0, 0, 0, 0, 0 }; */ ++ /* 0:ep_0 num, 1:ep_1 num */ ++ ++ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ ++ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];/* VI */ ++ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[1];/* BE */ ++ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];/* BK */ ++ ++ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ ++ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ ++ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ ++ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ ++ ++ } ++ ++} ++ ++static VOID _ThreeOutPipeMapping( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bWIFICfg ++) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); ++ ++ if (bWIFICfg) { /* for WMM */ ++ ++ /* BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA */ ++ /* { 1, 2, 1, 0, 0, 0, 0, 0, 0 }; */ ++ /* 0:H, 1:N, 2:L */ ++ ++ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ ++ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];/* VI */ ++ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];/* BE */ ++ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];/* BK */ ++ ++ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ ++ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ ++ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ ++ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ ++ ++ } else { /* typical setting */ ++ ++ ++ /* BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA */ ++ /* { 2, 2, 1, 0, 0, 0, 0, 0, 0 }; */ ++ /* 0:H, 1:N, 2:L */ ++ ++ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ ++ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];/* VI */ ++ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];/* BE */ ++ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[2];/* BK */ ++ ++ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ ++ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ ++ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ ++ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ ++ } ++ ++} ++static VOID _FourOutPipeMapping( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bWIFICfg ++) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); ++ ++ if (bWIFICfg) { /* for WMM */ ++ ++ /* BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA */ ++ /* { 1, 2, 1, 0, 0, 0, 0, 0, 0 }; */ ++ /* 0:H, 1:N, 2:L ,3:E */ ++ ++ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ ++ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];/* VI */ ++ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];/* BE */ ++ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];/* BK */ ++ ++ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ ++ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ ++ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[3];/* HIGH */ ++ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ ++ ++ } else { /* typical setting */ ++ ++ ++ /* BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA */ ++ /* { 2, 2, 1, 0, 0, 0, 0, 0, 0 }; */ ++ /* 0:H, 1:N, 2:L */ ++ ++ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ ++ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];/* VI */ ++ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];/* BE */ ++ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[2];/* BK */ ++ ++ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ ++ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ ++ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[3];/* HIGH */ ++ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ ++ } ++ ++} ++BOOLEAN ++Hal_MappingOutPipe( ++ IN PADAPTER pAdapter, ++ IN u8 NumOutPipe ++) ++{ ++ struct registry_priv *pregistrypriv = &pAdapter->registrypriv; ++ ++ BOOLEAN bWIFICfg = (pregistrypriv->wifi_spec) ? _TRUE : _FALSE; ++ ++ BOOLEAN result = _TRUE; ++ ++ switch (NumOutPipe) { ++ case 2: ++ _TwoOutPipeMapping(pAdapter, bWIFICfg); ++ break; ++ case 3: ++ case 4: ++ _ThreeOutPipeMapping(pAdapter, bWIFICfg); ++ break; ++ case 1: ++ _OneOutPipeMapping(pAdapter); ++ break; ++ default: ++ result = _FALSE; ++ break; ++ } ++ ++ return result; ++ ++} ++ ++void rtw_hal_dump_macaddr(void *sel, _adapter *adapter) ++{ ++ int i; ++ _adapter *iface; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ u8 mac_addr[ETH_ALEN]; ++ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ rtw_mbid_cam_dump(sel, __func__, adapter); ++#else ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (iface) { ++ rtw_hal_get_macaddr_port(iface, mac_addr); ++ RTW_PRINT_SEL(sel, ADPT_FMT"- hw port(%d) mac_addr ="MAC_FMT"\n", ++ ADPT_ARG(iface), iface->hw_port, MAC_ARG(mac_addr)); ++ } ++ } ++#endif ++} ++ ++void rtw_restore_mac_addr(_adapter *adapter) ++{ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ _adapter *iface; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ ++ rtw_mbid_cam_restore(adapter); ++#else ++ int i; ++ _adapter *iface; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (iface) ++ rtw_hal_set_macaddr_port(iface, adapter_mac_addr(iface)); ++ } ++#endif ++ if (1) ++ rtw_hal_dump_macaddr(RTW_DBGDUMP, adapter); ++} ++ ++void rtw_init_hal_com_default_value(PADAPTER Adapter) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ struct registry_priv *regsty = adapter_to_regsty(Adapter); ++ ++ pHalData->AntDetection = 1; ++ pHalData->u1ForcedIgiLb = regsty->force_igi_lb; ++} ++ ++#ifdef CONFIG_FW_C2H_REG ++void c2h_evt_clear(_adapter *adapter) ++{ ++ rtw_write8(adapter, REG_C2HEVT_CLEAR, C2H_EVT_HOST_CLOSE); ++} ++ ++s32 c2h_evt_read_88xx(_adapter *adapter, u8 *buf) ++{ ++ s32 ret = _FAIL; ++ int i; ++ u8 trigger; ++ ++ if (buf == NULL) ++ goto exit; ++ ++ trigger = rtw_read8(adapter, REG_C2HEVT_CLEAR); ++ ++ if (trigger == C2H_EVT_HOST_CLOSE) { ++ goto exit; /* Not ready */ ++ } else if (trigger != C2H_EVT_FW_CLOSE) { ++ goto clear_evt; /* Not a valid value */ ++ } ++ ++ _rtw_memset(buf, 0, C2H_REG_LEN); ++ ++ /* Read ID, LEN, SEQ */ ++ SET_C2H_ID_88XX(buf, rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL)); ++ SET_C2H_SEQ_88XX(buf, rtw_read8(adapter, REG_C2HEVT_CMD_SEQ_88XX)); ++ SET_C2H_PLEN_88XX(buf, rtw_read8(adapter, REG_C2HEVT_CMD_LEN_88XX)); ++ ++ if (0) { ++ RTW_INFO("%s id=0x%02x, seq=%u, plen=%u, trigger=0x%02x\n", __func__ ++ , C2H_ID_88XX(buf), C2H_SEQ_88XX(buf), C2H_PLEN_88XX(buf), trigger); ++ } ++ ++ /* Read the content */ ++ for (i = 0; i < C2H_PLEN_88XX(buf); i++) ++ *(C2H_PAYLOAD_88XX(buf) + i) = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL + 2 + i); ++ ++ RTW_DBG_DUMP("payload:\n", C2H_PAYLOAD_88XX(buf), C2H_PLEN_88XX(buf)); ++ ++ ret = _SUCCESS; ++ ++clear_evt: ++ /* ++ * Clear event to notify FW we have read the command. ++ * If this field isn't clear, the FW won't update the next command message. ++ */ ++ c2h_evt_clear(adapter); ++ ++exit: ++ return ret; ++} ++#endif /* CONFIG_FW_C2H_REG */ ++ ++#ifdef CONFIG_FW_C2H_PKT ++#ifndef DBG_C2H_PKT_PRE_HDL ++#define DBG_C2H_PKT_PRE_HDL 0 ++#endif ++#ifndef DBG_C2H_PKT_HDL ++#define DBG_C2H_PKT_HDL 0 ++#endif ++void rtw_hal_c2h_pkt_pre_hdl(_adapter *adapter, u8 *buf, u16 len) ++{ ++#ifdef RTW_HALMAC ++ /* TODO: extract hal_mac IC's code here*/ ++#else ++ u8 parse_fail = 0; ++ u8 hdl_here = 0; ++ s32 ret = _FAIL; ++ u8 id, seq, plen; ++ u8 *payload; ++ ++ if (rtw_hal_c2h_pkt_hdr_parse(adapter, buf, len, &id, &seq, &plen, &payload) != _SUCCESS) { ++ parse_fail = 1; ++ goto exit; ++ } ++ ++ hdl_here = rtw_hal_c2h_id_handle_directly(adapter, id, seq, plen, payload) == _TRUE ? 1 : 0; ++ if (hdl_here) ++ ret = rtw_hal_c2h_handler(adapter, id, seq, plen, payload); ++ else ++ ret = rtw_c2h_packet_wk_cmd(adapter, buf, len); ++ ++exit: ++ if (parse_fail) ++ RTW_ERR("%s parse fail, buf=%p, len=:%u\n", __func__, buf, len); ++ else if (ret != _SUCCESS || DBG_C2H_PKT_PRE_HDL > 0) { ++ RTW_PRINT("%s: id=0x%02x, seq=%u, plen=%u, %s %s\n", __func__, id, seq, plen ++ , hdl_here ? "handle" : "enqueue" ++ , ret == _SUCCESS ? "ok" : "fail" ++ ); ++ if (DBG_C2H_PKT_PRE_HDL >= 2) ++ RTW_PRINT_DUMP("dump: ", buf, len); ++ } ++#endif ++} ++ ++void rtw_hal_c2h_pkt_hdl(_adapter *adapter, u8 *buf, u16 len) ++{ ++#ifdef RTW_HALMAC ++ adapter->HalFunc.hal_mac_c2h_handler(adapter, buf, len); ++#else ++ u8 parse_fail = 0; ++ u8 bypass = 0; ++ s32 ret = _FAIL; ++ u8 id, seq, plen; ++ u8 *payload; ++ ++ if (rtw_hal_c2h_pkt_hdr_parse(adapter, buf, len, &id, &seq, &plen, &payload) != _SUCCESS) { ++ parse_fail = 1; ++ goto exit; ++ } ++ ++#ifdef CONFIG_WOWLAN ++ if (adapter_to_pwrctl(adapter)->wowlan_mode == _TRUE) { ++ bypass = 1; ++ ret = _SUCCESS; ++ goto exit; ++ } ++#endif ++ ++ ret = rtw_hal_c2h_handler(adapter, id, seq, plen, payload); ++ ++exit: ++ if (parse_fail) ++ RTW_ERR("%s parse fail, buf=%p, len=:%u\n", __func__, buf, len); ++ else if (ret != _SUCCESS || bypass || DBG_C2H_PKT_HDL > 0) { ++ RTW_PRINT("%s: id=0x%02x, seq=%u, plen=%u, %s %s\n", __func__, id, seq, plen ++ , !bypass ? "handle" : "bypass" ++ , ret == _SUCCESS ? "ok" : "fail" ++ ); ++ if (DBG_C2H_PKT_HDL >= 2) ++ RTW_PRINT_DUMP("dump: ", buf, len); ++ } ++#endif ++} ++#endif /* CONFIG_FW_C2H_PKT */ ++ ++void c2h_iqk_offload(_adapter *adapter, u8 *data, u8 len) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct submit_ctx *iqk_sctx = &hal_data->iqk_sctx; ++ ++ RTW_INFO("IQK offload finish in %dms\n", rtw_get_passing_time_ms(iqk_sctx->submit_time)); ++ if (0) ++ RTW_INFO_DUMP("C2H_IQK_FINISH: ", data, len); ++ ++ rtw_sctx_done(&iqk_sctx); ++} ++ ++int c2h_iqk_offload_wait(_adapter *adapter, u32 timeout_ms) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct submit_ctx *iqk_sctx = &hal_data->iqk_sctx; ++ ++ iqk_sctx->submit_time = rtw_get_current_time(); ++ iqk_sctx->timeout_ms = timeout_ms; ++ iqk_sctx->status = RTW_SCTX_SUBMITTED; ++ ++ return rtw_sctx_wait(iqk_sctx, __func__); ++} ++ ++#define GET_C2H_MAC_HIDDEN_RPT_UUID_X(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 0, 0, 8) ++#define GET_C2H_MAC_HIDDEN_RPT_UUID_Y(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 1, 0, 8) ++#define GET_C2H_MAC_HIDDEN_RPT_UUID_Z(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 2, 0, 5) ++#define GET_C2H_MAC_HIDDEN_RPT_UUID_CRC(_data) LE_BITS_TO_2BYTE(((u8 *)(_data)) + 2, 5, 11) ++#define GET_C2H_MAC_HIDDEN_RPT_HCI_TYPE(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 4, 0, 4) ++#define GET_C2H_MAC_HIDDEN_RPT_PACKAGE_TYPE(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 4, 4, 3) ++#define GET_C2H_MAC_HIDDEN_RPT_TR_SWITCH(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 4, 7, 1) ++#define GET_C2H_MAC_HIDDEN_RPT_WL_FUNC(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 5, 0, 4) ++#define GET_C2H_MAC_HIDDEN_RPT_HW_STYPE(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 5, 4, 4) ++#define GET_C2H_MAC_HIDDEN_RPT_BW(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 0, 3) ++#define GET_C2H_MAC_HIDDEN_RPT_FAB(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 3, 2) ++#define GET_C2H_MAC_HIDDEN_RPT_ANT_NUM(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 5, 3) ++#define GET_C2H_MAC_HIDDEN_RPT_80211_PROTOCOL(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 7, 2, 2) ++#define GET_C2H_MAC_HIDDEN_RPT_NIC_ROUTER(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 7, 6, 2) ++ ++#ifndef DBG_C2H_MAC_HIDDEN_RPT_HANDLE ++#define DBG_C2H_MAC_HIDDEN_RPT_HANDLE 0 ++#endif ++ ++#ifdef CONFIG_RTW_MAC_HIDDEN_RPT ++int c2h_mac_hidden_rpt_hdl(_adapter *adapter, u8 *data, u8 len) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ int ret = _FAIL; ++ ++ u32 uuid; ++ u8 uuid_x; ++ u8 uuid_y; ++ u8 uuid_z; ++ u16 uuid_crc; ++ ++ u8 hci_type; ++ u8 package_type; ++ u8 tr_switch; ++ u8 wl_func; ++ u8 hw_stype; ++ u8 bw; ++ u8 fab; ++ u8 ant_num; ++ u8 protocol; ++ u8 nic; ++ ++ int i; ++ ++ if (len < MAC_HIDDEN_RPT_LEN) { ++ RTW_WARN("%s len(%u) < %d\n", __func__, len, MAC_HIDDEN_RPT_LEN); ++ goto exit; ++ } ++ ++ uuid_x = GET_C2H_MAC_HIDDEN_RPT_UUID_X(data); ++ uuid_y = GET_C2H_MAC_HIDDEN_RPT_UUID_Y(data); ++ uuid_z = GET_C2H_MAC_HIDDEN_RPT_UUID_Z(data); ++ uuid_crc = GET_C2H_MAC_HIDDEN_RPT_UUID_CRC(data); ++ ++ hci_type = GET_C2H_MAC_HIDDEN_RPT_HCI_TYPE(data); ++ package_type = GET_C2H_MAC_HIDDEN_RPT_PACKAGE_TYPE(data); ++ ++ tr_switch = GET_C2H_MAC_HIDDEN_RPT_TR_SWITCH(data); ++ ++ wl_func = GET_C2H_MAC_HIDDEN_RPT_WL_FUNC(data); ++ hw_stype = GET_C2H_MAC_HIDDEN_RPT_HW_STYPE(data); ++ ++ bw = GET_C2H_MAC_HIDDEN_RPT_BW(data); ++ fab = GET_C2H_MAC_HIDDEN_RPT_FAB(data); ++ ant_num = GET_C2H_MAC_HIDDEN_RPT_ANT_NUM(data); ++ ++ protocol = GET_C2H_MAC_HIDDEN_RPT_80211_PROTOCOL(data); ++ nic = GET_C2H_MAC_HIDDEN_RPT_NIC_ROUTER(data); ++ ++ if (DBG_C2H_MAC_HIDDEN_RPT_HANDLE) { ++ for (i = 0; i < len; i++) ++ RTW_PRINT("%s: 0x%02X\n", __func__, *(data + i)); ++ ++ RTW_PRINT("uuid x:0x%02x y:0x%02x z:0x%x crc:0x%x\n", uuid_x, uuid_y, uuid_z, uuid_crc); ++ RTW_PRINT("hci_type:0x%x\n", hci_type); ++ RTW_PRINT("package_type:0x%x\n", package_type); ++ RTW_PRINT("tr_switch:0x%x\n", tr_switch); ++ RTW_PRINT("wl_func:0x%x\n", wl_func); ++ RTW_PRINT("hw_stype:0x%x\n", hw_stype); ++ RTW_PRINT("bw:0x%x\n", bw); ++ RTW_PRINT("fab:0x%x\n", fab); ++ RTW_PRINT("ant_num:0x%x\n", ant_num); ++ RTW_PRINT("protocol:0x%x\n", protocol); ++ RTW_PRINT("nic:0x%x\n", nic); ++ } ++ ++ /* ++ * NOTICE: ++ * for now, the following is common info/format ++ * if there is any hal difference need to export ++ * some IC dependent code will need to be implement ++ */ ++ hal_data->PackageType = package_type; ++ hal_spec->wl_func &= mac_hidden_wl_func_to_hal_wl_func(wl_func); ++ hal_spec->bw_cap &= mac_hidden_max_bw_to_hal_bw_cap(bw); ++ hal_spec->nss_num = rtw_min(hal_spec->nss_num, ant_num); ++ hal_spec->proto_cap &= mac_hidden_proto_to_hal_proto_cap(protocol); ++ ++ /* TODO: tr_switch */ ++ /* TODO: fab */ ++ ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++ ++int c2h_mac_hidden_rpt_2_hdl(_adapter *adapter, u8 *data, u8 len) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ int ret = _FAIL; ++ ++ int i; ++ ++ if (len < MAC_HIDDEN_RPT_2_LEN) { ++ RTW_WARN("%s len(%u) < %d\n", __func__, len, MAC_HIDDEN_RPT_2_LEN); ++ goto exit; ++ } ++ ++ if (DBG_C2H_MAC_HIDDEN_RPT_HANDLE) { ++ for (i = 0; i < len; i++) ++ RTW_PRINT("%s: 0x%02X\n", __func__, *(data + i)); ++ } ++ ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++ ++int hal_read_mac_hidden_rpt(_adapter *adapter) ++{ ++ int ret = _FAIL; ++ int ret_fwdl; ++ u8 mac_hidden_rpt[MAC_HIDDEN_RPT_LEN + MAC_HIDDEN_RPT_2_LEN] = {0}; ++ u32 start = rtw_get_current_time(); ++ u32 cnt = 0; ++ u32 timeout_ms = 800; ++ u32 min_cnt = 10; ++ u8 id = C2H_DEFEATURE_RSVD; ++ int i; ++ ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) ++ u8 hci_type = rtw_get_intf_type(adapter); ++ ++ if ((hci_type == RTW_USB || hci_type == RTW_PCIE) ++ && !rtw_is_hw_init_completed(adapter)) ++ rtw_hal_power_on(adapter); ++#endif ++ ++ /* inform FW mac hidden rpt from reg is needed */ ++ rtw_write8(adapter, REG_C2HEVT_MSG_NORMAL, C2H_DEFEATURE_RSVD); ++ ++ /* download FW */ ++ ret_fwdl = rtw_hal_fw_dl(adapter, _FALSE); ++ if (ret_fwdl != _SUCCESS) ++ goto mac_hidden_rpt_hdl; ++ ++ /* polling for data ready */ ++ start = rtw_get_current_time(); ++ do { ++ cnt++; ++ id = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL); ++ if (id == C2H_MAC_HIDDEN_RPT || RTW_CANNOT_IO(adapter)) ++ break; ++ rtw_msleep_os(10); ++ } while (rtw_get_passing_time_ms(start) < timeout_ms || cnt < min_cnt); ++ ++ if (id == C2H_MAC_HIDDEN_RPT) { ++ /* read data */ ++ for (i = 0; i < MAC_HIDDEN_RPT_LEN + MAC_HIDDEN_RPT_2_LEN; i++) ++ mac_hidden_rpt[i] = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL + 2 + i); ++ } ++ ++ /* inform FW mac hidden rpt has read */ ++ rtw_write8(adapter, REG_C2HEVT_MSG_NORMAL, C2H_DBG); ++ ++mac_hidden_rpt_hdl: ++ c2h_mac_hidden_rpt_hdl(adapter, mac_hidden_rpt, MAC_HIDDEN_RPT_LEN); ++ c2h_mac_hidden_rpt_2_hdl(adapter, mac_hidden_rpt + MAC_HIDDEN_RPT_LEN, MAC_HIDDEN_RPT_2_LEN); ++ ++ if (ret_fwdl == _SUCCESS && id == C2H_MAC_HIDDEN_RPT) ++ ret = _SUCCESS; ++ ++exit: ++ ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) ++ if ((hci_type == RTW_USB || hci_type == RTW_PCIE) ++ && !rtw_is_hw_init_completed(adapter)) ++ rtw_hal_power_off(adapter); ++#endif ++ ++ RTW_INFO("%s %s! (%u, %dms), fwdl:%d, id:0x%02x\n", __func__ ++ , (ret == _SUCCESS) ? "OK" : "Fail", cnt, rtw_get_passing_time_ms(start), ret_fwdl, id); ++ ++ return ret; ++} ++#endif /* CONFIG_RTW_MAC_HIDDEN_RPT */ ++ ++int c2h_defeature_dbg_hdl(_adapter *adapter, u8 *data, u8 len) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ int ret = _FAIL; ++ ++ int i; ++ ++ if (len < DEFEATURE_DBG_LEN) { ++ RTW_WARN("%s len(%u) < %d\n", __func__, len, DEFEATURE_DBG_LEN); ++ goto exit; ++ } ++ ++ for (i = 0; i < len; i++) ++ RTW_PRINT("%s: 0x%02X\n", __func__, *(data + i)); ++ ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++ ++#ifndef DBG_CUSTOMER_STR_RPT_HANDLE ++#define DBG_CUSTOMER_STR_RPT_HANDLE 0 ++#endif ++ ++#ifdef CONFIG_RTW_CUSTOMER_STR ++s32 rtw_hal_h2c_customer_str_req(_adapter *adapter) ++{ ++ u8 h2c_data[H2C_CUSTOMER_STR_REQ_LEN] = {0}; ++ ++ SET_H2CCMD_CUSTOMER_STR_REQ_EN(h2c_data, 1); ++ return rtw_hal_fill_h2c_cmd(adapter, H2C_CUSTOMER_STR_REQ, H2C_CUSTOMER_STR_REQ_LEN, h2c_data); ++} ++ ++#define C2H_CUSTOMER_STR_RPT_BYTE0(_data) ((u8 *)(_data)) ++#define C2H_CUSTOMER_STR_RPT_2_BYTE8(_data) ((u8 *)(_data)) ++ ++int c2h_customer_str_rpt_hdl(_adapter *adapter, u8 *data, u8 len) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ int ret = _FAIL; ++ int i; ++ ++ if (len < CUSTOMER_STR_RPT_LEN) { ++ RTW_WARN("%s len(%u) < %d\n", __func__, len, CUSTOMER_STR_RPT_LEN); ++ goto exit; ++ } ++ ++ if (DBG_CUSTOMER_STR_RPT_HANDLE) ++ RTW_PRINT_DUMP("customer_str_rpt: ", data, CUSTOMER_STR_RPT_LEN); ++ ++ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ ++ if (dvobj->customer_str_sctx != NULL) { ++ if (dvobj->customer_str_sctx->status != RTW_SCTX_SUBMITTED) ++ RTW_WARN("%s invalid sctx.status:%d\n", __func__, dvobj->customer_str_sctx->status); ++ _rtw_memcpy(dvobj->customer_str, C2H_CUSTOMER_STR_RPT_BYTE0(data), CUSTOMER_STR_RPT_LEN); ++ dvobj->customer_str_sctx->status = RTX_SCTX_CSTR_WAIT_RPT2; ++ } else ++ RTW_WARN("%s sctx not set\n", __func__); ++ ++ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++ ++int c2h_customer_str_rpt_2_hdl(_adapter *adapter, u8 *data, u8 len) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ int ret = _FAIL; ++ int i; ++ ++ if (len < CUSTOMER_STR_RPT_2_LEN) { ++ RTW_WARN("%s len(%u) < %d\n", __func__, len, CUSTOMER_STR_RPT_2_LEN); ++ goto exit; ++ } ++ ++ if (DBG_CUSTOMER_STR_RPT_HANDLE) ++ RTW_PRINT_DUMP("customer_str_rpt_2: ", data, CUSTOMER_STR_RPT_2_LEN); ++ ++ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ ++ if (dvobj->customer_str_sctx != NULL) { ++ if (dvobj->customer_str_sctx->status != RTX_SCTX_CSTR_WAIT_RPT2) ++ RTW_WARN("%s rpt not ready\n", __func__); ++ _rtw_memcpy(dvobj->customer_str + CUSTOMER_STR_RPT_LEN, C2H_CUSTOMER_STR_RPT_2_BYTE8(data), CUSTOMER_STR_RPT_2_LEN); ++ rtw_sctx_done(&dvobj->customer_str_sctx); ++ } else ++ RTW_WARN("%s sctx not set\n", __func__); ++ ++ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++ ++/* read customer str */ ++s32 rtw_hal_customer_str_read(_adapter *adapter, u8 *cs) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct submit_ctx sctx; ++ s32 ret = _SUCCESS; ++ ++ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ if (dvobj->customer_str_sctx != NULL) ++ ret = _FAIL; ++ else { ++ rtw_sctx_init(&sctx, 2 * 1000); ++ dvobj->customer_str_sctx = &sctx; ++ } ++ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ ++ if (ret == _FAIL) { ++ RTW_WARN("%s another handle ongoing\n", __func__); ++ goto exit; ++ } ++ ++ ret = rtw_customer_str_req_cmd(adapter); ++ if (ret != _SUCCESS) { ++ RTW_WARN("%s read cmd fail\n", __func__); ++ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ dvobj->customer_str_sctx = NULL; ++ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ goto exit; ++ } ++ ++ /* wait till rpt done or timeout */ ++ rtw_sctx_wait(&sctx, __func__); ++ ++ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ dvobj->customer_str_sctx = NULL; ++ if (sctx.status == RTW_SCTX_DONE_SUCCESS) ++ _rtw_memcpy(cs, dvobj->customer_str, RTW_CUSTOMER_STR_LEN); ++ else ++ ret = _FAIL; ++ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ ++exit: ++ return ret; ++} ++ ++s32 rtw_hal_h2c_customer_str_write(_adapter *adapter, const u8 *cs) ++{ ++ u8 h2c_data_w1[H2C_CUSTOMER_STR_W1_LEN] = {0}; ++ u8 h2c_data_w2[H2C_CUSTOMER_STR_W2_LEN] = {0}; ++ u8 h2c_data_w3[H2C_CUSTOMER_STR_W3_LEN] = {0}; ++ s32 ret; ++ ++ SET_H2CCMD_CUSTOMER_STR_W1_EN(h2c_data_w1, 1); ++ _rtw_memcpy(H2CCMD_CUSTOMER_STR_W1_BYTE0(h2c_data_w1), cs, 6); ++ ++ SET_H2CCMD_CUSTOMER_STR_W2_EN(h2c_data_w2, 1); ++ _rtw_memcpy(H2CCMD_CUSTOMER_STR_W2_BYTE6(h2c_data_w2), cs + 6, 6); ++ ++ SET_H2CCMD_CUSTOMER_STR_W3_EN(h2c_data_w3, 1); ++ _rtw_memcpy(H2CCMD_CUSTOMER_STR_W3_BYTE12(h2c_data_w3), cs + 6 + 6, 4); ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_CUSTOMER_STR_W1, H2C_CUSTOMER_STR_W1_LEN, h2c_data_w1); ++ if (ret != _SUCCESS) { ++ RTW_WARN("%s w1 fail\n", __func__); ++ goto exit; ++ } ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_CUSTOMER_STR_W2, H2C_CUSTOMER_STR_W2_LEN, h2c_data_w2); ++ if (ret != _SUCCESS) { ++ RTW_WARN("%s w2 fail\n", __func__); ++ goto exit; ++ } ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_CUSTOMER_STR_W3, H2C_CUSTOMER_STR_W3_LEN, h2c_data_w3); ++ if (ret != _SUCCESS) { ++ RTW_WARN("%s w3 fail\n", __func__); ++ goto exit; ++ } ++ ++exit: ++ return ret; ++} ++ ++/* write customer str and check if value reported is the same as requested */ ++s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct submit_ctx sctx; ++ s32 ret = _SUCCESS; ++ ++ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ if (dvobj->customer_str_sctx != NULL) ++ ret = _FAIL; ++ else { ++ rtw_sctx_init(&sctx, 2 * 1000); ++ dvobj->customer_str_sctx = &sctx; ++ } ++ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ ++ if (ret == _FAIL) { ++ RTW_WARN("%s another handle ongoing\n", __func__); ++ goto exit; ++ } ++ ++ ret = rtw_customer_str_write_cmd(adapter, cs); ++ if (ret != _SUCCESS) { ++ RTW_WARN("%s write cmd fail\n", __func__); ++ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ dvobj->customer_str_sctx = NULL; ++ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ goto exit; ++ } ++ ++ ret = rtw_customer_str_req_cmd(adapter); ++ if (ret != _SUCCESS) { ++ RTW_WARN("%s read cmd fail\n", __func__); ++ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ dvobj->customer_str_sctx = NULL; ++ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ goto exit; ++ } ++ ++ /* wait till rpt done or timeout */ ++ rtw_sctx_wait(&sctx, __func__); ++ ++ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ dvobj->customer_str_sctx = NULL; ++ if (sctx.status == RTW_SCTX_DONE_SUCCESS) { ++ if (_rtw_memcmp(cs, dvobj->customer_str, RTW_CUSTOMER_STR_LEN) != _TRUE) { ++ RTW_WARN("%s read back check fail\n", __func__); ++ RTW_INFO_DUMP("write req: ", cs, RTW_CUSTOMER_STR_LEN); ++ RTW_INFO_DUMP("read back: ", dvobj->customer_str, RTW_CUSTOMER_STR_LEN); ++ ret = _FAIL; ++ } ++ } else ++ ret = _FAIL; ++ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); ++ ++exit: ++ return ret; ++} ++#endif /* CONFIG_RTW_CUSTOMER_STR */ ++ ++u8 rtw_hal_networktype_to_raid(_adapter *adapter, struct sta_info *psta) ++{ ++#ifdef CONFIG_GET_RAID_BY_DRV /*Just for 8188E now*/ ++ if (IS_NEW_GENERATION_IC(adapter)) ++ return networktype_to_raid_ex(adapter, psta); ++ else ++ return networktype_to_raid(adapter, psta); ++#else ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); ++ u8 bw; ++ ++ bw = rtw_get_tx_bw_mode(adapter, psta); ++ ++ return phydm_rate_id_mapping(&pHalData->odmpriv, psta->wireless_mode, pHalData->rf_type, bw); ++#endif ++} ++u8 rtw_get_mgntframe_raid(_adapter *adapter, unsigned char network_type) ++{ ++ ++ u8 raid; ++ if (IS_NEW_GENERATION_IC(adapter)) { ++ ++ raid = (network_type & WIRELESS_11B) ? RATEID_IDX_B ++ : RATEID_IDX_G; ++ } else { ++ raid = (network_type & WIRELESS_11B) ? RATR_INX_WIRELESS_B ++ : RATR_INX_WIRELESS_G; ++ } ++ return raid; ++} ++ ++void rtw_hal_update_sta_rate_mask(PADAPTER padapter, struct sta_info *psta) ++{ ++ u8 i, rf_type, limit; ++ u64 tx_ra_bitmap; ++ ++ if (psta == NULL) ++ return; ++ ++ tx_ra_bitmap = 0; ++ ++ /* b/g mode ra_bitmap */ ++ for (i = 0; i < sizeof(psta->bssrateset); i++) { ++ if (psta->bssrateset[i]) ++ tx_ra_bitmap |= rtw_get_bit_value_from_ieee_value(psta->bssrateset[i] & 0x7f); ++ } ++ ++#ifdef CONFIG_80211N_HT ++#ifdef CONFIG_80211AC_VHT ++ /* AC mode ra_bitmap */ ++ if (psta->vhtpriv.vht_option) ++ tx_ra_bitmap |= (rtw_vht_rate_to_bitmap(psta->vhtpriv.vht_mcs_map) << 12); ++ else ++#endif /* CONFIG_80211AC_VHT */ ++ { ++ /* n mode ra_bitmap */ ++ if (psta->htpriv.ht_option) { ++ rf_type = RF_1T1R; ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ if (rf_type == RF_2T2R) ++ limit = 16; /* 2R */ ++ else if (rf_type == RF_3T3R) ++ limit = 24; /* 3R */ ++ else ++ limit = 8; /* 1R */ ++ ++ ++ /* Handling SMPS mode for AP MODE only*/ ++ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { ++ /*0:static SMPS, 1:dynamic SMPS, 3:SMPS disabled, 2:reserved*/ ++ if (psta->htpriv.smps_cap == 0 || psta->htpriv.smps_cap == 1) { ++ /*operate with only one active receive chain // 11n-MCS rate <= MSC7*/ ++ limit = 8;/* 1R*/ ++ } ++ } ++ ++ for (i = 0; i < limit; i++) { ++ if (psta->htpriv.ht_cap.supp_mcs_set[i / 8] & BIT(i % 8)) ++ tx_ra_bitmap |= BIT(i + 12); ++ } ++ } ++ } ++ RTW_INFO("supp_mcs_set = %02x, %02x, %02x, rf_type=%d, tx_ra_bitmap=%016llx\n" ++ , psta->htpriv.ht_cap.supp_mcs_set[0], psta->htpriv.ht_cap.supp_mcs_set[1], psta->htpriv.ht_cap.supp_mcs_set[2], rf_type, tx_ra_bitmap); ++#endif /* CONFIG_80211N_HT */ ++ psta->ra_mask = tx_ra_bitmap; ++ psta->init_rate = get_highest_rate_idx(tx_ra_bitmap) & 0x3f; ++} ++ ++#ifndef SEC_CAM_ACCESS_TIMEOUT_MS ++ #define SEC_CAM_ACCESS_TIMEOUT_MS 200 ++#endif ++ ++#ifndef DBG_SEC_CAM_ACCESS ++ #define DBG_SEC_CAM_ACCESS 0 ++#endif ++ ++u32 rtw_sec_read_cam(_adapter *adapter, u8 addr) ++{ ++ _mutex *mutex = &adapter_to_dvobj(adapter)->cam_ctl.sec_cam_access_mutex; ++ u32 rdata; ++ u32 cnt = 0; ++ u32 start = 0, end = 0; ++ u8 timeout = 0; ++ u8 sr = 0; ++ ++ _enter_critical_mutex(mutex, NULL); ++ ++ rtw_write32(adapter, REG_CAMCMD, CAM_POLLINIG | addr); ++ ++ start = rtw_get_current_time(); ++ while (1) { ++ if (rtw_is_surprise_removed(adapter)) { ++ sr = 1; ++ break; ++ } ++ ++ cnt++; ++ if (0 == (rtw_read32(adapter, REG_CAMCMD) & CAM_POLLINIG)) ++ break; ++ ++ if (rtw_get_passing_time_ms(start) > SEC_CAM_ACCESS_TIMEOUT_MS) { ++ timeout = 1; ++ break; ++ } ++ } ++ end = rtw_get_current_time(); ++ ++ rdata = rtw_read32(adapter, REG_CAMREAD); ++ ++ _exit_critical_mutex(mutex, NULL); ++ ++ if (DBG_SEC_CAM_ACCESS || timeout) { ++ RTW_INFO(FUNC_ADPT_FMT" addr:0x%02x, rdata:0x%08x, to:%u, polling:%u, %d ms\n" ++ , FUNC_ADPT_ARG(adapter), addr, rdata, timeout, cnt, rtw_get_time_interval_ms(start, end)); ++ } ++ ++ return rdata; ++} ++ ++void rtw_sec_write_cam(_adapter *adapter, u8 addr, u32 wdata) ++{ ++ _mutex *mutex = &adapter_to_dvobj(adapter)->cam_ctl.sec_cam_access_mutex; ++ u32 cnt = 0; ++ u32 start = 0, end = 0; ++ u8 timeout = 0; ++ u8 sr = 0; ++ ++ _enter_critical_mutex(mutex, NULL); ++ ++ rtw_write32(adapter, REG_CAMWRITE, wdata); ++ rtw_write32(adapter, REG_CAMCMD, CAM_POLLINIG | CAM_WRITE | addr); ++ ++ start = rtw_get_current_time(); ++ while (1) { ++ if (rtw_is_surprise_removed(adapter)) { ++ sr = 1; ++ break; ++ } ++ ++ cnt++; ++ if (0 == (rtw_read32(adapter, REG_CAMCMD) & CAM_POLLINIG)) ++ break; ++ ++ if (rtw_get_passing_time_ms(start) > SEC_CAM_ACCESS_TIMEOUT_MS) { ++ timeout = 1; ++ break; ++ } ++ } ++ end = rtw_get_current_time(); ++ ++ _exit_critical_mutex(mutex, NULL); ++ ++ if (DBG_SEC_CAM_ACCESS || timeout) { ++ RTW_INFO(FUNC_ADPT_FMT" addr:0x%02x, wdata:0x%08x, to:%u, polling:%u, %d ms\n" ++ , FUNC_ADPT_ARG(adapter), addr, wdata, timeout, cnt, rtw_get_time_interval_ms(start, end)); ++ } ++} ++ ++void rtw_sec_read_cam_ent(_adapter *adapter, u8 id, u8 *ctrl, u8 *mac, u8 *key) ++{ ++ unsigned int val, addr; ++ u8 i; ++ u32 rdata; ++ u8 begin = 0; ++ u8 end = 5; /* TODO: consider other key length accordingly */ ++ ++ if (!ctrl && !mac && !key) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ /* TODO: check id range */ ++ ++ if (!ctrl && !mac) ++ begin = 2; /* read from key */ ++ ++ if (!key && !mac) ++ end = 0; /* read to ctrl */ ++ else if (!key) ++ end = 2; /* read to mac */ ++ ++ for (i = begin; i <= end; i++) { ++ rdata = rtw_sec_read_cam(adapter, (id << 3) | i); ++ ++ switch (i) { ++ case 0: ++ if (ctrl) ++ _rtw_memcpy(ctrl, (u8 *)(&rdata), 2); ++ if (mac) ++ _rtw_memcpy(mac, ((u8 *)(&rdata)) + 2, 2); ++ break; ++ case 1: ++ if (mac) ++ _rtw_memcpy(mac + 2, (u8 *)(&rdata), 4); ++ break; ++ default: ++ if (key) ++ _rtw_memcpy(key + (i - 2) * 4, (u8 *)(&rdata), 4); ++ break; ++ } ++ } ++ ++exit: ++ return; ++} ++ ++ ++void rtw_sec_write_cam_ent(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) ++{ ++ unsigned int i; ++ int j; ++ u8 addr; ++ u32 wdata; ++ ++ /* TODO: consider other key length accordingly */ ++#if 0 ++ switch ((ctrl & 0x1c) >> 2) { ++ case _WEP40_: ++ case _TKIP_: ++ case _AES_: ++ case _WEP104_: ++ ++ } ++#else ++ j = 7; ++#endif ++ ++ for (; j >= 0; j--) { ++ switch (j) { ++ case 0: ++ wdata = (ctrl | (mac[0] << 16) | (mac[1] << 24)); ++ break; ++ case 1: ++ wdata = (mac[2] | (mac[3] << 8) | (mac[4] << 16) | (mac[5] << 24)); ++ break; ++ case 6: ++ case 7: ++ wdata = 0; ++ break; ++ default: ++ i = (j - 2) << 2; ++ wdata = (key[i] | (key[i + 1] << 8) | (key[i + 2] << 16) | (key[i + 3] << 24)); ++ break; ++ } ++ ++ addr = (id << 3) + j; ++ ++ rtw_sec_write_cam(adapter, addr, wdata); ++ } ++} ++ ++void rtw_sec_clr_cam_ent(_adapter *adapter, u8 id) ++{ ++ u8 addr; ++ ++ addr = (id << 3); ++ rtw_sec_write_cam(adapter, addr, 0); ++} ++ ++bool rtw_sec_read_cam_is_gk(_adapter *adapter, u8 id) ++{ ++ bool res; ++ u16 ctrl; ++ ++ rtw_sec_read_cam_ent(adapter, id, (u8 *)&ctrl, NULL, NULL); ++ ++ res = (ctrl & BIT6) ? _TRUE : _FALSE; ++ return res; ++} ++#ifdef CONFIG_MBSSID_CAM ++void rtw_mbid_cam_init(struct dvobj_priv *dvobj) ++{ ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ ++ _rtw_spinlock_init(&mbid_cam_ctl->lock); ++ mbid_cam_ctl->bitmap = 0; ++ ATOMIC_SET(&mbid_cam_ctl->mbid_entry_num, 0); ++ _rtw_memset(&dvobj->mbid_cam_cache, 0, sizeof(dvobj->mbid_cam_cache)); ++} ++ ++void rtw_mbid_cam_deinit(struct dvobj_priv *dvobj) ++{ ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ ++ _rtw_spinlock_free(&mbid_cam_ctl->lock); ++} ++ ++void rtw_mbid_cam_reset(_adapter *adapter) ++{ ++ _irqL irqL; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ ++ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ mbid_cam_ctl->bitmap = 0; ++ _rtw_memset(&dvobj->mbid_cam_cache, 0, sizeof(dvobj->mbid_cam_cache)); ++ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ ++ ATOMIC_SET(&mbid_cam_ctl->mbid_entry_num, 0); ++} ++static u8 _rtw_mbid_cam_search_by_macaddr(_adapter *adapter, u8 *mac_addr) ++{ ++ u8 i; ++ u8 cam_id = INVALID_CAM_ID; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ ++ for (i = 0; i < TOTAL_MBID_CAM_NUM; i++) { ++ if (mac_addr && _rtw_memcmp(dvobj->mbid_cam_cache[i].mac_addr, mac_addr, ETH_ALEN) == _TRUE) { ++ cam_id = i; ++ break; ++ } ++ } ++ ++ RTW_INFO("%s mac:"MAC_FMT" - cam_id:%d\n", __func__, MAC_ARG(mac_addr), cam_id); ++ return cam_id; ++} ++ ++u8 rtw_mbid_cam_search_by_macaddr(_adapter *adapter, u8 *mac_addr) ++{ ++ _irqL irqL; ++ ++ u8 cam_id = INVALID_CAM_ID; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ ++ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ cam_id = _rtw_mbid_cam_search_by_macaddr(adapter, mac_addr); ++ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ ++ return cam_id; ++} ++static u8 _rtw_mbid_cam_search_by_ifaceid(_adapter *adapter, u8 iface_id) ++{ ++ u8 i; ++ u8 cam_id = INVALID_CAM_ID; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ ++ for (i = 0; i < TOTAL_MBID_CAM_NUM; i++) { ++ if (iface_id == dvobj->mbid_cam_cache[i].iface_id) { ++ cam_id = i; ++ break; ++ } ++ } ++ if (cam_id != INVALID_CAM_ID) ++ RTW_INFO("%s iface_id:%d mac:"MAC_FMT" - cam_id:%d\n", ++ __func__, iface_id, MAC_ARG(dvobj->mbid_cam_cache[cam_id].mac_addr), cam_id); ++ ++ return cam_id; ++} ++ ++u8 rtw_mbid_cam_search_by_ifaceid(_adapter *adapter, u8 iface_id) ++{ ++ _irqL irqL; ++ u8 cam_id = INVALID_CAM_ID; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ ++ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ cam_id = _rtw_mbid_cam_search_by_ifaceid(adapter, iface_id); ++ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ ++ return cam_id; ++} ++u8 rtw_get_max_mbid_cam_id(_adapter *adapter) ++{ ++ _irqL irqL; ++ s8 i; ++ u8 cam_id = INVALID_CAM_ID; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ ++ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ for (i = (TOTAL_MBID_CAM_NUM - 1); i >= 0; i--) { ++ if (mbid_cam_ctl->bitmap & BIT(i)) { ++ cam_id = i; ++ break; ++ } ++ } ++ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ /*RTW_INFO("%s max cam_id:%d\n", __func__, cam_id);*/ ++ return cam_id; ++} ++ ++inline u8 rtw_get_mbid_cam_entry_num(_adapter *adapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ ++ return ATOMIC_READ(&mbid_cam_ctl->mbid_entry_num); ++} ++ ++static inline void mbid_cam_cache_init(_adapter *adapter, struct mbid_cam_cache *pmbid_cam, u8 *mac_addr) ++{ ++ if (adapter && pmbid_cam && mac_addr) { ++ _rtw_memcpy(pmbid_cam->mac_addr, mac_addr, ETH_ALEN); ++ pmbid_cam->iface_id = adapter->iface_id; ++ } ++} ++static inline void mbid_cam_cache_clr(struct mbid_cam_cache *pmbid_cam) ++{ ++ if (pmbid_cam) { ++ _rtw_memset(pmbid_cam->mac_addr, 0, ETH_ALEN); ++ pmbid_cam->iface_id = CONFIG_IFACE_NUMBER; ++ } ++} ++ ++u8 rtw_mbid_camid_alloc(_adapter *adapter, u8 *mac_addr) ++{ ++ _irqL irqL; ++ u8 cam_id = INVALID_CAM_ID, i; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ u8 entry_num = ATOMIC_READ(&mbid_cam_ctl->mbid_entry_num); ++ ++ if (entry_num >= TOTAL_MBID_CAM_NUM) { ++ RTW_INFO(FUNC_ADPT_FMT" failed !! MBSSID number :%d over TOTAL_CAM_ENTRY(8)\n", FUNC_ADPT_ARG(adapter), entry_num); ++ rtw_warn_on(1); ++ } ++ ++ if (INVALID_CAM_ID != rtw_mbid_cam_search_by_macaddr(adapter, mac_addr)) ++ goto exit; ++ ++ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ for (i = 0; i < TOTAL_MBID_CAM_NUM; i++) { ++ if (!(mbid_cam_ctl->bitmap & BIT(i))) { ++ mbid_cam_ctl->bitmap |= BIT(i); ++ cam_id = i; ++ break; ++ } ++ } ++ if ((cam_id != INVALID_CAM_ID) && (mac_addr)) ++ mbid_cam_cache_init(adapter, &dvobj->mbid_cam_cache[cam_id], mac_addr); ++ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ ++ if (cam_id != INVALID_CAM_ID) { ++ ATOMIC_INC(&mbid_cam_ctl->mbid_entry_num); ++ RTW_INFO("%s mac:"MAC_FMT" - cam_id:%d\n", __func__, MAC_ARG(mac_addr), cam_id); ++#ifdef DBG_MBID_CAM_DUMP ++ rtw_mbid_cam_cache_dump(RTW_DBGDUMP, __func__, adapter); ++#endif ++ } else ++ RTW_INFO("%s [WARN] "MAC_FMT" - invalid cam_id:%d\n", __func__, MAC_ARG(mac_addr), cam_id); ++exit: ++ return cam_id; ++} ++ ++u8 rtw_mbid_cam_info_change(_adapter *adapter, u8 *mac_addr) ++{ ++ _irqL irqL; ++ u8 entry_id = INVALID_CAM_ID; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ ++ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ entry_id = _rtw_mbid_cam_search_by_ifaceid(adapter, adapter->iface_id); ++ if (entry_id != INVALID_CAM_ID) ++ mbid_cam_cache_init(adapter, &dvobj->mbid_cam_cache[entry_id], mac_addr); ++ ++ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ ++ return entry_id; ++} ++ ++u8 rtw_mbid_cam_assign(_adapter *adapter, u8 *mac_addr, u8 camid) ++{ ++ _irqL irqL; ++ u8 ret = _FALSE; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ ++ if ((camid >= TOTAL_MBID_CAM_NUM) || (camid == INVALID_CAM_ID)) { ++ RTW_INFO(FUNC_ADPT_FMT" failed !! invlaid mbid_canid :%d\n", FUNC_ADPT_ARG(adapter), camid); ++ rtw_warn_on(1); ++ } ++ if (INVALID_CAM_ID != rtw_mbid_cam_search_by_macaddr(adapter, mac_addr)) ++ goto exit; ++ ++ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ if (!(mbid_cam_ctl->bitmap & BIT(camid))) { ++ if (mac_addr) { ++ mbid_cam_ctl->bitmap |= BIT(camid); ++ mbid_cam_cache_init(adapter, &dvobj->mbid_cam_cache[camid], mac_addr); ++ ret = _TRUE; ++ } ++ } ++ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ ++ if (ret == _TRUE) { ++ ATOMIC_INC(&mbid_cam_ctl->mbid_entry_num); ++ RTW_INFO("%s mac:"MAC_FMT" - cam_id:%d\n", __func__, MAC_ARG(mac_addr), camid); ++#ifdef DBG_MBID_CAM_DUMP ++ rtw_mbid_cam_cache_dump(RTW_DBGDUMP, __func__, adapter); ++#endif ++ } else ++ RTW_INFO("%s [WARN] mac:"MAC_FMT" - cam_id:%d assigned failed\n", __func__, MAC_ARG(mac_addr), camid); ++ ++exit: ++ return ret; ++} ++ ++void rtw_mbid_camid_clean(_adapter *adapter, u8 mbss_canid) ++{ ++ _irqL irqL; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ ++ if ((mbss_canid >= TOTAL_MBID_CAM_NUM) || (mbss_canid == INVALID_CAM_ID)) { ++ RTW_INFO(FUNC_ADPT_FMT" failed !! invlaid mbid_canid :%d\n", FUNC_ADPT_ARG(adapter), mbss_canid); ++ rtw_warn_on(1); ++ } ++ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ mbid_cam_cache_clr(&dvobj->mbid_cam_cache[mbss_canid]); ++ mbid_cam_ctl->bitmap &= (~BIT(mbss_canid)); ++ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ ATOMIC_DEC(&mbid_cam_ctl->mbid_entry_num); ++ RTW_INFO("%s - cam_id:%d\n", __func__, mbss_canid); ++} ++int rtw_mbid_cam_cache_dump(void *sel, const char *fun_name, _adapter *adapter) ++{ ++ _irqL irqL; ++ u8 i; ++ _adapter *iface; ++ u8 iface_id; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ u8 entry_num = ATOMIC_READ(&mbid_cam_ctl->mbid_entry_num); ++ u8 max_cam_id = rtw_get_max_mbid_cam_id(adapter); ++ ++ RTW_PRINT_SEL(sel, "== MBSSID CAM DUMP (%s)==\n", fun_name); ++ ++ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ RTW_PRINT_SEL(sel, "Entry numbers:%d, max_camid:%d, bitmap:0x%08x\n", entry_num, max_cam_id, mbid_cam_ctl->bitmap); ++ for (i = 0; i < TOTAL_MBID_CAM_NUM; i++) { ++ RTW_PRINT_SEL(sel, "CAM_ID = %d\t", i); ++ ++ if (mbid_cam_ctl->bitmap & BIT(i)) { ++ iface_id = dvobj->mbid_cam_cache[i].iface_id; ++ RTW_PRINT_SEL(sel, "IF_ID:%d\t", iface_id); ++ RTW_PRINT_SEL(sel, "MAC Addr:"MAC_FMT"\t", MAC_ARG(dvobj->mbid_cam_cache[i].mac_addr)); ++ ++ iface = dvobj->padapters[iface_id]; ++ if (iface) { ++ if (check_fwstate(&iface->mlmepriv, WIFI_STATION_STATE) == _TRUE) ++ RTW_PRINT_SEL(sel, "ROLE:%s\n", "STA"); ++ else if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE) ++ RTW_PRINT_SEL(sel, "ROLE:%s\n", "AP"); ++ else ++ RTW_PRINT_SEL(sel, "ROLE:%s\n", "NONE"); ++ } ++ ++ } else ++ RTW_PRINT_SEL(sel, "N/A\n"); ++ } ++ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); ++ return 0; ++} ++ ++static void read_mbssid_cam(_adapter *padapter, u8 cam_addr, u8 *mac) ++{ ++ u8 poll = 1; ++ u8 cam_ready = _FALSE; ++ u32 cam_data1 = 0; ++ u16 cam_data2 = 0; ++ ++ if (RTW_CANNOT_RUN(padapter)) ++ return; ++ ++ rtw_write32(padapter, REG_MBIDCAMCFG_2, BIT_MBIDCAM_POLL | ((cam_addr & MBIDCAM_ADDR_MASK) << MBIDCAM_ADDR_SHIFT)); ++ ++ do { ++ if (0 == (rtw_read32(padapter, REG_MBIDCAMCFG_2) & BIT_MBIDCAM_POLL)) { ++ cam_ready = _TRUE; ++ break; ++ } ++ poll++; ++ } while ((poll % 10) != 0 && !RTW_CANNOT_RUN(padapter)); ++ ++ if (cam_ready) { ++ cam_data1 = rtw_read32(padapter, REG_MBIDCAMCFG_1); ++ mac[0] = cam_data1 & 0xFF; ++ mac[1] = (cam_data1 >> 8) & 0xFF; ++ mac[2] = (cam_data1 >> 16) & 0xFF; ++ mac[3] = (cam_data1 >> 24) & 0xFF; ++ ++ cam_data2 = rtw_read16(padapter, REG_MBIDCAMCFG_2); ++ mac[4] = cam_data2 & 0xFF; ++ mac[5] = (cam_data2 >> 8) & 0xFF; ++ } ++ ++} ++int rtw_mbid_cam_dump(void *sel, const char *fun_name, _adapter *adapter) ++{ ++ /*_irqL irqL;*/ ++ u8 i; ++ u8 mac_addr[ETH_ALEN]; ++ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ ++ RTW_PRINT_SEL(sel, "\n== MBSSID HW-CAM DUMP (%s)==\n", fun_name); ++ ++ /*_enter_critical_bh(&mbid_cam_ctl->lock, &irqL);*/ ++ for (i = 0; i < TOTAL_MBID_CAM_NUM; i++) { ++ RTW_PRINT_SEL(sel, "CAM_ID = %d\t", i); ++ _rtw_memset(mac_addr, 0, ETH_ALEN); ++ read_mbssid_cam(adapter, i, mac_addr); ++ RTW_PRINT_SEL(sel, "MAC Addr:"MAC_FMT"\n", MAC_ARG(mac_addr)); ++ } ++ /*_exit_critical_bh(&mbid_cam_ctl->lock, &irqL);*/ ++ return 0; ++} ++ ++static void write_mbssid_cam(_adapter *padapter, u8 cam_addr, u8 *mac) ++{ ++ u32 cam_val[2] = {0}; ++ ++ cam_val[0] = (mac[3] << 24) | (mac[2] << 16) | (mac[1] << 8) | mac[0]; ++ cam_val[1] = ((cam_addr & MBIDCAM_ADDR_MASK) << MBIDCAM_ADDR_SHIFT) | (mac[5] << 8) | mac[4]; ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MBSSID_CAM_WRITE, (u8 *)cam_val); ++} ++ ++static void clear_mbssid_cam(_adapter *padapter, u8 cam_addr) ++{ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MBSSID_CAM_CLEAR, &cam_addr); ++} ++static void enable_mbssid_cam(_adapter *adapter) ++{ ++ u8 max_cam_id = rtw_get_max_mbid_cam_id(adapter); ++ /*enable MBSSID*/ ++ rtw_write32(adapter, REG_RCR, rtw_read32(adapter, REG_RCR) | RCR_ENMBID); ++ if (max_cam_id != INVALID_CAM_ID) { ++ rtw_write8(adapter, REG_MBID_NUM, ++ ((rtw_read8(adapter, REG_MBID_NUM) & 0xF8) | (max_cam_id & 0x07))); ++ } ++} ++void rtw_mbid_cam_restore(_adapter *adapter) ++{ ++ u8 i; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; ++ ++#ifdef DBG_MBID_CAM_DUMP ++ rtw_mbid_cam_cache_dump(RTW_DBGDUMP, __func__, adapter); ++#endif ++ ++ for (i = 0; i < TOTAL_MBID_CAM_NUM; i++) { ++ if (mbid_cam_ctl->bitmap & BIT(i)) { ++ write_mbssid_cam(adapter, i, dvobj->mbid_cam_cache[i].mac_addr); ++ RTW_INFO("%s - cam_id:%d => mac:"MAC_FMT"\n", __func__, i, MAC_ARG(dvobj->mbid_cam_cache[i].mac_addr)); ++ } ++ } ++ enable_mbssid_cam(adapter); ++} ++#endif /*CONFIG_MBSSID_CAM*/ ++ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++void rtw_hal_set_macaddr_mbid(_adapter *adapter, u8 *mac_addr) ++{ ++ ++#if 0 /*TODO - modify for more flexible*/ ++ u8 idx = 0; ++ ++ if ((check_fwstate(&adapter->mlmepriv, WIFI_STATION_STATE) == _TRUE) && ++ (DEV_STA_NUM(adapter_to_dvobj(adapter)) == 1)) { ++ for (idx = 0; idx < 6; idx++) ++ rtw_write8(GET_PRIMARY_ADAPTER(adapter), (REG_MACID + idx), val[idx]); ++ } else { ++ /*MBID entry_id = 0~7 ,0 for root AP, 1~7 for VAP*/ ++ u8 entry_id; ++ ++ if ((check_fwstate(&adapter->mlmepriv, WIFI_AP_STATE) == _TRUE) && ++ (DEV_AP_NUM(adapter_to_dvobj(adapter)) == 1)) { ++ entry_id = 0; ++ if (rtw_mbid_cam_assign(adapter, val, entry_id)) { ++ RTW_INFO(FUNC_ADPT_FMT" Root AP assigned success\n", FUNC_ADPT_ARG(adapter)); ++ write_mbssid_cam(adapter, entry_id, val); ++ } ++ } else { ++ entry_id = rtw_mbid_camid_alloc(adapter, val); ++ if (entry_id != INVALID_CAM_ID) ++ write_mbssid_cam(adapter, entry_id, val); ++ } ++ } ++#else ++ { ++ /* ++ MBID entry_id = 0~7 ,for IFACE_ID0 ~ IFACE_IDx ++ */ ++ u8 entry_id = rtw_mbid_camid_alloc(adapter, mac_addr); ++ ++ ++ if (entry_id != INVALID_CAM_ID) { ++ write_mbssid_cam(adapter, entry_id, mac_addr); ++ enable_mbssid_cam(adapter); ++ } ++ } ++#endif ++} ++ ++void rtw_hal_change_macaddr_mbid(_adapter *adapter, u8 *mac_addr) ++{ ++ u8 idx = 0; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ u8 entry_id; ++ ++ if (!mac_addr) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ ++ entry_id = rtw_mbid_cam_info_change(adapter, mac_addr); ++ ++ if (entry_id != INVALID_CAM_ID) ++ write_mbssid_cam(adapter, entry_id, mac_addr); ++} ++ ++ ++#endif/*#ifdef CONFIG_MI_WITH_MBSSID_CAM*/ ++ ++void rtw_hal_set_macaddr_port(_adapter *adapter, u8 *val) ++{ ++ u8 idx = 0; ++ u32 reg_macid = 0; ++ ++ if (val == NULL) ++ return; ++ ++ RTW_INFO("%s "ADPT_FMT"- hw port(%d) mac_addr ="MAC_FMT"\n", __func__, ++ ADPT_ARG(adapter), adapter->hw_port, MAC_ARG(val)); ++ ++ switch (adapter->hw_port) { ++ case HW_PORT0: ++ default: ++ reg_macid = REG_MACID; ++ break; ++ case HW_PORT1: ++ reg_macid = REG_MACID1; ++ break; ++#if defined(CONFIG_RTL8814A) ++ case HW_PORT2: ++ reg_macid = REG_MACID2; ++ break; ++ case HW_PORT3: ++ reg_macid = REG_MACID3; ++ break; ++ case HW_PORT4: ++ reg_macid = REG_MACID4; ++ break; ++#endif/*defined(CONFIG_RTL8814A)*/ ++ } ++ ++ for (idx = 0; idx < 6; idx++) ++ rtw_write8(GET_PRIMARY_ADAPTER(adapter), (reg_macid + idx), val[idx]); ++} ++void rtw_hal_get_macaddr_port(_adapter *adapter, u8 *mac_addr) ++{ ++ u8 idx = 0; ++ u32 reg_macid = 0; ++ ++ if (mac_addr == NULL) ++ return; ++ ++ _rtw_memset(mac_addr, 0, ETH_ALEN); ++ switch (adapter->hw_port) { ++ case HW_PORT0: ++ default: ++ reg_macid = REG_MACID; ++ break; ++ case HW_PORT1: ++ reg_macid = REG_MACID1; ++ break; ++#if defined(CONFIG_RTL8814A) ++ case HW_PORT2: ++ reg_macid = REG_MACID2; ++ break; ++ case HW_PORT3: ++ reg_macid = REG_MACID3; ++ break; ++ case HW_PORT4: ++ reg_macid = REG_MACID4; ++ break; ++#endif /*defined(CONFIG_RTL8814A)*/ ++ } ++ ++ for (idx = 0; idx < 6; idx++) ++ mac_addr[idx] = rtw_read8(GET_PRIMARY_ADAPTER(adapter), (reg_macid + idx)); ++ ++ RTW_INFO("%s "ADPT_FMT"- hw port(%d) mac_addr ="MAC_FMT"\n", __func__, ++ ADPT_ARG(adapter), adapter->hw_port, MAC_ARG(mac_addr)); ++} ++ ++void rtw_hal_set_bssid(_adapter *adapter, u8 *val) ++{ ++ u8 idx = 0; ++ u32 reg_bssid = 0; ++ ++ switch (adapter->hw_port) { ++ case HW_PORT0: ++ default: ++ reg_bssid = REG_BSSID; ++ break; ++ case HW_PORT1: ++ reg_bssid = REG_BSSID1; ++ break; ++#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) ++ case HW_PORT2: ++ reg_bssid = REG_BSSID2; ++ break; ++ case HW_PORT3: ++ reg_bssid = REG_BSSID3; ++ break; ++ case HW_PORT4: ++ reg_bssid = REG_BSSID4; ++ break; ++#endif/*defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B)*/ ++ } ++ ++ for (idx = 0 ; idx < 6; idx++) ++ rtw_write8(adapter, (reg_bssid + idx), val[idx]); ++ ++ RTW_INFO("%s "ADPT_FMT"- hw port -%d BSSID: "MAC_FMT"\n", __func__, ADPT_ARG(adapter), adapter->hw_port, MAC_ARG(val)); ++} ++ ++void rtw_hal_get_msr(_adapter *adapter, u8 *net_type) ++{ ++ switch (adapter->hw_port) { ++ case HW_PORT0: ++ /*REG_CR - BIT[17:16]-Network Type for port 1*/ ++ *net_type = rtw_read8(adapter, MSR) & 0x03; ++ break; ++ case HW_PORT1: ++ /*REG_CR - BIT[19:18]-Network Type for port 1*/ ++ *net_type = (rtw_read8(adapter, MSR) & 0x0C) >> 2; ++ break; ++#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) ++ case HW_PORT2: ++ /*REG_CR_EXT- BIT[1:0]-Network Type for port 2*/ ++ *net_type = rtw_read8(adapter, MSR1) & 0x03; ++ break; ++ case HW_PORT3: ++ /*REG_CR_EXT- BIT[3:2]-Network Type for port 3*/ ++ *net_type = (rtw_read8(adapter, MSR1) & 0x0C) >> 2; ++ break; ++ case HW_PORT4: ++ /*REG_CR_EXT- BIT[5:4]-Network Type for port 4*/ ++ *net_type = (rtw_read8(adapter, MSR1) & 0x30) >> 4; ++ break; ++#endif /*#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B)*/ ++ default: ++ RTW_INFO("[WARN] "ADPT_FMT"- invalid hw port -%d\n", ++ ADPT_ARG(adapter), adapter->hw_port); ++ rtw_warn_on(1); ++ break; ++ } ++} ++ ++void rtw_hal_set_msr(_adapter *adapter, u8 net_type) ++{ ++ u8 val8 = 0; ++ ++ switch (adapter->hw_port) { ++ case HW_PORT0: ++#if defined(CONFIG_MI_WITH_MBSSID_CAM) && defined(CONFIG_MBSSID_CAM) /*For 2 hw ports - 88E/92E/8812/8821/8723B*/ ++ if (rtw_get_mbid_cam_entry_num(adapter)) { ++ if (net_type != _HW_STATE_NOLINK_) ++ net_type = _HW_STATE_AP_; ++ } ++#endif ++ /*REG_CR - BIT[17:16]-Network Type for port 0*/ ++ val8 = rtw_read8(adapter, MSR) & 0x0C; ++ val8 |= net_type; ++ rtw_write8(adapter, MSR, val8); ++ break; ++ case HW_PORT1: ++ /*REG_CR - BIT[19:18]-Network Type for port 1*/ ++ val8 = rtw_read8(adapter, MSR) & 0x03; ++ val8 |= net_type << 2; ++ rtw_write8(adapter, MSR, val8); ++ break; ++#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++ case HW_PORT2: ++ /*REG_CR_EXT- BIT[1:0]-Network Type for port 2*/ ++ val8 = rtw_read8(adapter, MSR1) & 0xFC; ++ val8 |= net_type; ++ rtw_write8(adapter, MSR1, val8); ++ break; ++ case HW_PORT3: ++ /*REG_CR_EXT- BIT[3:2]-Network Type for port 3*/ ++ val8 = rtw_read8(adapter, MSR1) & 0xF3; ++ val8 |= net_type << 2; ++ rtw_write8(adapter, MSR1, val8); ++ break; ++ case HW_PORT4: ++ /*REG_CR_EXT- BIT[5:4]-Network Type for port 4*/ ++ val8 = rtw_read8(adapter, MSR1) & 0xCF; ++ val8 |= net_type << 4; ++ rtw_write8(adapter, MSR1, val8); ++ break; ++#endif /* CONFIG_RTL8814A | CONFIG_RTL8822B */ ++ default: ++ RTW_INFO("[WARN] "ADPT_FMT"- invalid hw port -%d\n", ++ ADPT_ARG(adapter), adapter->hw_port); ++ rtw_warn_on(1); ++ break; ++ } ++} ++ ++void rtw_hal_port_reconfig(_adapter *adapter, u8 port) ++{ ++#ifdef CONFIG_CONCURRENT_MODE ++ u8 hal_port_num = 0; ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ ++ if (port > (hal_spec->port_num - 1)) { ++ RTW_INFO("[WARN] "ADPT_FMT"- hw_port : %d,will switch to invalid port-%d\n", ++ ADPT_ARG(adapter), adapter->hw_port, port); ++ rtw_warn_on(1); ++ } ++ ++ RTW_PRINT(ADPT_FMT"- hw_port : %d,will switch to port-%d\n", ++ ADPT_ARG(adapter), adapter->hw_port, port); ++ ++#endif ++ ++} ++ ++ ++void hw_var_port_switch(_adapter *adapter) ++{ ++#ifdef CONFIG_CONCURRENT_MODE ++#ifdef CONFIG_RUNTIME_PORT_SWITCH ++ /* ++ 0x102: MSR ++ 0x550: REG_BCN_CTRL ++ 0x551: REG_BCN_CTRL_1 ++ 0x55A: REG_ATIMWND ++ 0x560: REG_TSFTR ++ 0x568: REG_TSFTR1 ++ 0x570: REG_ATIMWND_1 ++ 0x610: REG_MACID ++ 0x618: REG_BSSID ++ 0x700: REG_MACID1 ++ 0x708: REG_BSSID1 ++ */ ++ ++ int i; ++ u8 msr; ++ u8 bcn_ctrl; ++ u8 bcn_ctrl_1; ++ u8 atimwnd[2]; ++ u8 atimwnd_1[2]; ++ u8 tsftr[8]; ++ u8 tsftr_1[8]; ++ u8 macid[6]; ++ u8 bssid[6]; ++ u8 macid_1[6]; ++ u8 bssid_1[6]; ++ ++ u8 hw_port; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ _adapter *iface = NULL; ++ ++ msr = rtw_read8(adapter, MSR); ++ bcn_ctrl = rtw_read8(adapter, REG_BCN_CTRL); ++ bcn_ctrl_1 = rtw_read8(adapter, REG_BCN_CTRL_1); ++ ++ for (i = 0; i < 2; i++) ++ atimwnd[i] = rtw_read8(adapter, REG_ATIMWND + i); ++ for (i = 0; i < 2; i++) ++ atimwnd_1[i] = rtw_read8(adapter, REG_ATIMWND_1 + i); ++ ++ for (i = 0; i < 8; i++) ++ tsftr[i] = rtw_read8(adapter, REG_TSFTR + i); ++ for (i = 0; i < 8; i++) ++ tsftr_1[i] = rtw_read8(adapter, REG_TSFTR1 + i); ++ ++ for (i = 0; i < 6; i++) ++ macid[i] = rtw_read8(adapter, REG_MACID + i); ++ ++ for (i = 0; i < 6; i++) ++ bssid[i] = rtw_read8(adapter, REG_BSSID + i); ++ ++ for (i = 0; i < 6; i++) ++ macid_1[i] = rtw_read8(adapter, REG_MACID1 + i); ++ ++ for (i = 0; i < 6; i++) ++ bssid_1[i] = rtw_read8(adapter, REG_BSSID1 + i); ++ ++#ifdef DBG_RUNTIME_PORT_SWITCH ++ RTW_INFO(FUNC_ADPT_FMT" before switch\n" ++ "msr:0x%02x\n" ++ "bcn_ctrl:0x%02x\n" ++ "bcn_ctrl_1:0x%02x\n" ++ "atimwnd:0x%04x\n" ++ "atimwnd_1:0x%04x\n" ++ "tsftr:%llu\n" ++ "tsftr1:%llu\n" ++ "macid:"MAC_FMT"\n" ++ "bssid:"MAC_FMT"\n" ++ "macid_1:"MAC_FMT"\n" ++ "bssid_1:"MAC_FMT"\n" ++ , FUNC_ADPT_ARG(adapter) ++ , msr ++ , bcn_ctrl ++ , bcn_ctrl_1 ++ , *((u16 *)atimwnd) ++ , *((u16 *)atimwnd_1) ++ , *((u64 *)tsftr) ++ , *((u64 *)tsftr_1) ++ , MAC_ARG(macid) ++ , MAC_ARG(bssid) ++ , MAC_ARG(macid_1) ++ , MAC_ARG(bssid_1) ++ ); ++#endif /* DBG_RUNTIME_PORT_SWITCH */ ++ ++ /* disable bcn function, disable update TSF */ ++ rtw_write8(adapter, REG_BCN_CTRL, (bcn_ctrl & (~EN_BCN_FUNCTION)) | DIS_TSF_UDT); ++ rtw_write8(adapter, REG_BCN_CTRL_1, (bcn_ctrl_1 & (~EN_BCN_FUNCTION)) | DIS_TSF_UDT); ++ ++ /* switch msr */ ++ msr = (msr & 0xf0) | ((msr & 0x03) << 2) | ((msr & 0x0c) >> 2); ++ rtw_write8(adapter, MSR, msr); ++ ++ /* write port0 */ ++ rtw_write8(adapter, REG_BCN_CTRL, bcn_ctrl_1 & ~EN_BCN_FUNCTION); ++ for (i = 0; i < 2; i++) ++ rtw_write8(adapter, REG_ATIMWND + i, atimwnd_1[i]); ++ for (i = 0; i < 8; i++) ++ rtw_write8(adapter, REG_TSFTR + i, tsftr_1[i]); ++ for (i = 0; i < 6; i++) ++ rtw_write8(adapter, REG_MACID + i, macid_1[i]); ++ for (i = 0; i < 6; i++) ++ rtw_write8(adapter, REG_BSSID + i, bssid_1[i]); ++ ++ /* write port1 */ ++ rtw_write8(adapter, REG_BCN_CTRL_1, bcn_ctrl & ~EN_BCN_FUNCTION); ++ for (i = 0; i < 2; i++) ++ rtw_write8(adapter, REG_ATIMWND_1 + i, atimwnd[i]); ++ for (i = 0; i < 8; i++) ++ rtw_write8(adapter, REG_TSFTR1 + i, tsftr[i]); ++ for (i = 0; i < 6; i++) ++ rtw_write8(adapter, REG_MACID1 + i, macid[i]); ++ for (i = 0; i < 6; i++) ++ rtw_write8(adapter, REG_BSSID1 + i, bssid[i]); ++ ++ /* write bcn ctl */ ++#ifdef CONFIG_BT_COEXIST ++ /* always enable port0 beacon function for PSTDMA */ ++ if (IS_HARDWARE_TYPE_8723B(adapter) || IS_HARDWARE_TYPE_8703B(adapter) ++ || IS_HARDWARE_TYPE_8723D(adapter)) ++ bcn_ctrl_1 |= EN_BCN_FUNCTION; ++ /* always disable port1 beacon function for PSTDMA */ ++ if (IS_HARDWARE_TYPE_8723B(adapter) || IS_HARDWARE_TYPE_8703B(adapter)) ++ bcn_ctrl &= ~EN_BCN_FUNCTION; ++#endif ++ rtw_write8(adapter, REG_BCN_CTRL, bcn_ctrl_1); ++ rtw_write8(adapter, REG_BCN_CTRL_1, bcn_ctrl); ++ ++ if (adapter->iface_id == IFACE_ID0) ++ iface = dvobj->padapters[IFACE_ID1]; ++ else if (adapter->iface_id == IFACE_ID1) ++ iface = dvobj->padapters[IFACE_ID0]; ++ ++ ++ if (adapter->hw_port == HW_PORT0) { ++ adapter->hw_port = HW_PORT1; ++ iface->hw_port = HW_PORT0; ++ RTW_PRINT("port switch - port0("ADPT_FMT"), port1("ADPT_FMT")\n", ++ ADPT_ARG(iface), ADPT_ARG(adapter)); ++ } else { ++ adapter->hw_port = HW_PORT0; ++ iface->hw_port = HW_PORT1; ++ RTW_PRINT("port switch - port0("ADPT_FMT"), port1("ADPT_FMT")\n", ++ ADPT_ARG(adapter), ADPT_ARG(iface)); ++ } ++ ++#ifdef DBG_RUNTIME_PORT_SWITCH ++ msr = rtw_read8(adapter, MSR); ++ bcn_ctrl = rtw_read8(adapter, REG_BCN_CTRL); ++ bcn_ctrl_1 = rtw_read8(adapter, REG_BCN_CTRL_1); ++ ++ for (i = 0; i < 2; i++) ++ atimwnd[i] = rtw_read8(adapter, REG_ATIMWND + i); ++ for (i = 0; i < 2; i++) ++ atimwnd_1[i] = rtw_read8(adapter, REG_ATIMWND_1 + i); ++ ++ for (i = 0; i < 8; i++) ++ tsftr[i] = rtw_read8(adapter, REG_TSFTR + i); ++ for (i = 0; i < 8; i++) ++ tsftr_1[i] = rtw_read8(adapter, REG_TSFTR1 + i); ++ ++ for (i = 0; i < 6; i++) ++ macid[i] = rtw_read8(adapter, REG_MACID + i); ++ ++ for (i = 0; i < 6; i++) ++ bssid[i] = rtw_read8(adapter, REG_BSSID + i); ++ ++ for (i = 0; i < 6; i++) ++ macid_1[i] = rtw_read8(adapter, REG_MACID1 + i); ++ ++ for (i = 0; i < 6; i++) ++ bssid_1[i] = rtw_read8(adapter, REG_BSSID1 + i); ++ ++ RTW_INFO(FUNC_ADPT_FMT" after switch\n" ++ "msr:0x%02x\n" ++ "bcn_ctrl:0x%02x\n" ++ "bcn_ctrl_1:0x%02x\n" ++ "atimwnd:%u\n" ++ "atimwnd_1:%u\n" ++ "tsftr:%llu\n" ++ "tsftr1:%llu\n" ++ "macid:"MAC_FMT"\n" ++ "bssid:"MAC_FMT"\n" ++ "macid_1:"MAC_FMT"\n" ++ "bssid_1:"MAC_FMT"\n" ++ , FUNC_ADPT_ARG(adapter) ++ , msr ++ , bcn_ctrl ++ , bcn_ctrl_1 ++ , *((u16 *)atimwnd) ++ , *((u16 *)atimwnd_1) ++ , *((u64 *)tsftr) ++ , *((u64 *)tsftr_1) ++ , MAC_ARG(macid) ++ , MAC_ARG(bssid) ++ , MAC_ARG(macid_1) ++ , MAC_ARG(bssid_1) ++ ); ++#endif /* DBG_RUNTIME_PORT_SWITCH */ ++ ++#endif /* CONFIG_RUNTIME_PORT_SWITCH */ ++#endif /* CONFIG_CONCURRENT_MODE */ ++} ++ ++const char *const _h2c_msr_role_str[] = { ++ "RSVD", ++ "STA", ++ "AP", ++ "GC", ++ "GO", ++ "TDLS", ++ "ADHOC", ++ "INVALID", ++}; ++ ++/* ++* rtw_hal_set_FwMediaStatusRpt_cmd - ++* ++* @adapter: ++* @opmode: 0:disconnect, 1:connect ++* @miracast: 0:it's not in miracast scenario. 1:it's in miracast scenario ++* @miracast_sink: 0:source. 1:sink ++* @role: The role of this macid. 0:rsvd. 1:STA. 2:AP. 3:GC. 4:GO. 5:TDLS ++* @macid: ++* @macid_ind: 0:update Media Status to macid. 1:update Media Status from macid to macid_end ++* @macid_end: ++*/ ++s32 rtw_hal_set_FwMediaStatusRpt_cmd(_adapter *adapter, bool opmode, bool miracast, bool miracast_sink, u8 role, u8 macid, bool macid_ind, u8 macid_end) ++{ ++ struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; ++ u8 parm[H2C_MEDIA_STATUS_RPT_LEN] = {0}; ++ int i; ++ s32 ret; ++ ++ SET_H2CCMD_MSRRPT_PARM_OPMODE(parm, opmode); ++ SET_H2CCMD_MSRRPT_PARM_MACID_IND(parm, macid_ind); ++ SET_H2CCMD_MSRRPT_PARM_MIRACAST(parm, miracast); ++ SET_H2CCMD_MSRRPT_PARM_MIRACAST_SINK(parm, miracast_sink); ++ SET_H2CCMD_MSRRPT_PARM_ROLE(parm, role); ++ SET_H2CCMD_MSRRPT_PARM_MACID(parm, macid); ++ SET_H2CCMD_MSRRPT_PARM_MACID_END(parm, macid_end); ++ ++ RTW_DBG_DUMP("MediaStatusRpt parm:", parm, H2C_MEDIA_STATUS_RPT_LEN); ++ ++#ifdef CONFIG_DFS_MASTER ++ /* workaround for TXPAUSE cleared issue by FW's MediaStatusRpt handling */ ++ if (macid_ind == 0 && macid == 1) { ++ u8 parm0_bak = parm[0]; ++ ++ SET_H2CCMD_MSRRPT_PARM_MACID_IND(&parm0_bak, 0); ++ if (macid_ctl->h2c_msr[macid] == parm0_bak) { ++ ret = _SUCCESS; ++ goto post_action; ++ } ++ } ++#endif ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_MEDIA_STATUS_RPT, H2C_MEDIA_STATUS_RPT_LEN, parm); ++ if (ret != _SUCCESS) ++ goto exit; ++ ++#ifdef CONFIG_DFS_MASTER ++post_action: ++#endif ++ ++#if defined(CONFIG_RTL8188E) ++ if (rtw_get_chip_type(adapter) == RTL8188E) { ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ ++ /* 8188E FW doesn't set macid no link, driver does it by self */ ++ if (opmode) ++ rtw_hal_set_hwreg(adapter, HW_VAR_MACID_LINK, &macid); ++ else ++ rtw_hal_set_hwreg(adapter, HW_VAR_MACID_NOLINK, &macid); ++ ++ /* for 8188E RA */ ++#if (RATE_ADAPTIVE_SUPPORT == 1) ++ if (hal_data->fw_ractrl == _FALSE) { ++ u8 max_macid; ++ ++ max_macid = rtw_search_max_mac_id(adapter); ++ rtw_hal_set_hwreg(adapter, HW_VAR_TX_RPT_MAX_MACID, &max_macid); ++ } ++#endif ++ } ++#endif ++ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ++ /* TODO: this should move to IOT issue area */ ++ if (rtw_get_chip_type(adapter) == RTL8812 ++ || rtw_get_chip_type(adapter) == RTL8821 ++ ) { ++ if (MLME_IS_STA(adapter)) ++ Hal_PatchwithJaguar_8812(adapter, opmode); ++ } ++#endif ++ ++ SET_H2CCMD_MSRRPT_PARM_MACID_IND(parm, 0); ++ if (macid_ind == 0) ++ macid_end = macid; ++ ++ for (i = macid; macid <= macid_end; macid++) { ++ rtw_macid_ctl_set_h2c_msr(macid_ctl, macid, parm[0]); ++ if (!opmode) { ++ rtw_macid_ctl_set_bw(macid_ctl, macid, CHANNEL_WIDTH_20); ++ rtw_macid_ctl_set_vht_en(macid_ctl, macid, 0); ++ rtw_macid_ctl_set_rate_bmp0(macid_ctl, macid, 0); ++ rtw_macid_ctl_set_rate_bmp1(macid_ctl, macid, 0); ++ } ++ } ++ if (!opmode) ++ rtw_update_tx_rate_bmp(adapter_to_dvobj(adapter)); ++ ++exit: ++ return ret; ++} ++ ++inline s32 rtw_hal_set_FwMediaStatusRpt_single_cmd(_adapter *adapter, bool opmode, bool miracast, bool miracast_sink, u8 role, u8 macid) ++{ ++ return rtw_hal_set_FwMediaStatusRpt_cmd(adapter, opmode, miracast, miracast_sink, role, macid, 0, 0); ++} ++ ++inline s32 rtw_hal_set_FwMediaStatusRpt_range_cmd(_adapter *adapter, bool opmode, bool miracast, bool miracast_sink, u8 role, u8 macid, u8 macid_end) ++{ ++ return rtw_hal_set_FwMediaStatusRpt_cmd(adapter, opmode, miracast, miracast_sink, role, macid, 1, macid_end); ++} ++ ++void rtw_hal_set_FwRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) ++{ ++ struct hal_ops *pHalFunc = &padapter->HalFunc; ++ u8 u1H2CRsvdPageParm[H2C_RSVDPAGE_LOC_LEN] = {0}; ++ u8 ret = 0; ++ ++ RTW_INFO("RsvdPageLoc: ProbeRsp=%d PsPoll=%d Null=%d QoSNull=%d BTNull=%d\n", ++ rsvdpageloc->LocProbeRsp, rsvdpageloc->LocPsPoll, ++ rsvdpageloc->LocNullData, rsvdpageloc->LocQosNull, ++ rsvdpageloc->LocBTQosNull); ++ ++ SET_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(u1H2CRsvdPageParm, rsvdpageloc->LocProbeRsp); ++ SET_H2CCMD_RSVDPAGE_LOC_PSPOLL(u1H2CRsvdPageParm, rsvdpageloc->LocPsPoll); ++ SET_H2CCMD_RSVDPAGE_LOC_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocNullData); ++ SET_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocQosNull); ++ SET_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocBTQosNull); ++ ++ ret = rtw_hal_fill_h2c_cmd(padapter, ++ H2C_RSVD_PAGE, ++ H2C_RSVDPAGE_LOC_LEN, ++ u1H2CRsvdPageParm); ++ ++} ++ ++#ifdef CONFIG_RTW_SDIO_OOB_INT ++void rtw_hal_switch_ood_int_ctrl(_adapter *padapter, u8 enable) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ RTW_INFO("%s: >>>>>>\n", __func__); ++ if (IS_8723D_SERIES(pHalData->VersionID)) ++ rtw_hal_set_hwreg(padapter, HW_SET_OOB_CTRL, (u8 *)(&enable)); ++} ++#endif ++ ++#ifdef CONFIG_GPIO_WAKEUP ++void rtw_hal_switch_gpio_wl_ctrl(_adapter *padapter, u8 index, u8 enable) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ ++ if (IS_8723D_SERIES(pHalData->VersionID)) ++ rtw_hal_set_hwreg(padapter, HW_SET_GPIO_WL_CTRL, (u8 *)(&enable)); ++ /* ++ * Switch GPIO_13, GPIO_14 to wlan control, or pull GPIO_13,14 MUST fail. ++ * It happended at 8723B/8192E/8821A. New IC will check multi function GPIO, ++ * and implement HAL function. ++ * TODO: GPIO_8 multi function? ++ */ ++ ++ if (index == 13 || index == 14) ++ rtw_hal_set_hwreg(padapter, HW_SET_GPIO_WL_CTRL, (u8 *)(&enable)); ++} ++ ++void rtw_hal_set_output_gpio(_adapter *padapter, u8 index, u8 outputval) ++{ ++ if (index <= 7) { ++ /* config GPIO mode */ ++ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 3, ++ rtw_read8(padapter, REG_GPIO_PIN_CTRL + 3) & ~BIT(index)); ++ ++ /* config GPIO Sel */ ++ /* 0: input */ ++ /* 1: output */ ++ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 2, ++ rtw_read8(padapter, REG_GPIO_PIN_CTRL + 2) | BIT(index)); ++ ++ /* set output value */ ++ if (outputval) { ++ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 1, ++ rtw_read8(padapter, REG_GPIO_PIN_CTRL + 1) | BIT(index)); ++ } else { ++ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 1, ++ rtw_read8(padapter, REG_GPIO_PIN_CTRL + 1) & ~BIT(index)); ++ } ++ } else if (index <= 15) { ++ /* 88C Series: */ ++ /* index: 11~8 transform to 3~0 */ ++ /* 8723 Series: */ ++ /* index: 12~8 transform to 4~0 */ ++ ++ index -= 8; ++ ++ /* config GPIO mode */ ++ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 3, ++ rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 3) & ~BIT(index)); ++ ++ /* config GPIO Sel */ ++ /* 0: input */ ++ /* 1: output */ ++ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 2, ++ rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 2) | BIT(index)); ++ ++ /* set output value */ ++ if (outputval) { ++ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 1, ++ rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 1) | BIT(index)); ++ } else { ++ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 1, ++ rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 1) & ~BIT(index)); ++ } ++ } else { ++ RTW_INFO("%s: invalid GPIO%d=%d\n", ++ __FUNCTION__, index, outputval); ++ } ++} ++#endif ++ ++void rtw_hal_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) ++{ ++ struct hal_ops *pHalFunc = &padapter->HalFunc; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ u8 res = 0, count = 0, ret = 0; ++#ifdef CONFIG_WOWLAN ++ u8 u1H2CAoacRsvdPageParm[H2C_AOAC_RSVDPAGE_LOC_LEN] = {0}; ++ ++ RTW_INFO("AOACRsvdPageLoc: RWC=%d ArpRsp=%d NbrAdv=%d GtkRsp=%d GtkInfo=%d ProbeReq=%d NetworkList=%d\n", ++ rsvdpageloc->LocRemoteCtrlInfo, rsvdpageloc->LocArpRsp, ++ rsvdpageloc->LocNbrAdv, rsvdpageloc->LocGTKRsp, ++ rsvdpageloc->LocGTKInfo, rsvdpageloc->LocProbeReq, ++ rsvdpageloc->LocNetList); ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED)) { ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocRemoteCtrlInfo); ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocArpRsp); ++ /* SET_H2CCMD_AOAC_RSVDPAGE_LOC_NEIGHBOR_ADV(u1H2CAoacRsvdPageParm, rsvdpageloc->LocNbrAdv); */ ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKRsp); ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKInfo); ++#ifdef CONFIG_GTK_OL ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_EXT_MEM(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKEXTMEM); ++#endif /* CONFIG_GTK_OL */ ++ ret = rtw_hal_fill_h2c_cmd(padapter, ++ H2C_AOAC_RSVD_PAGE, ++ H2C_AOAC_RSVDPAGE_LOC_LEN, ++ u1H2CAoacRsvdPageParm); ++ ++ _rtw_memset(&u1H2CAoacRsvdPageParm, 0, sizeof(u1H2CAoacRsvdPageParm)); ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_AOAC_REPORT(u1H2CAoacRsvdPageParm, ++ rsvdpageloc->LocAOACReport); ++ ret = rtw_hal_fill_h2c_cmd(padapter, ++ H2C_AOAC_RSVDPAGE3, ++ H2C_AOAC_RSVDPAGE_LOC_LEN, ++ u1H2CAoacRsvdPageParm); ++ pwrpriv->wowlan_aoac_rpt_loc = rsvdpageloc->LocAOACReport; ++ } ++#ifdef CONFIG_PNO_SUPPORT ++ else { ++ ++ if (!pwrpriv->wowlan_in_resume) { ++ RTW_INFO("NLO_INFO=%d\n", rsvdpageloc->LocPNOInfo); ++ _rtw_memset(&u1H2CAoacRsvdPageParm, 0, ++ sizeof(u1H2CAoacRsvdPageParm)); ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_NLO_INFO(u1H2CAoacRsvdPageParm, ++ rsvdpageloc->LocPNOInfo); ++ ret = rtw_hal_fill_h2c_cmd(padapter, ++ H2C_AOAC_RSVDPAGE3, ++ H2C_AOAC_RSVDPAGE_LOC_LEN, ++ u1H2CAoacRsvdPageParm); ++ } ++ } ++#endif /* CONFIG_PNO_SUPPORT */ ++#endif /* CONFIG_WOWLAN */ ++} ++ ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++static void rtw_hal_force_enable_rxdma(_adapter *adapter) ++{ ++ RTW_INFO("%s: Set 0x690=0x00\n", __func__); ++ rtw_write8(adapter, REG_WOW_CTRL, ++ (rtw_read8(adapter, REG_WOW_CTRL) & 0xf0)); ++ RTW_PRINT("%s: Release RXDMA\n", __func__); ++ rtw_write32(adapter, REG_RXPKT_NUM, ++ (rtw_read32(adapter, REG_RXPKT_NUM) & (~RW_RELEASE_EN))); ++} ++ ++static void rtw_hal_disable_tx_report(_adapter *adapter) ++{ ++ rtw_write8(adapter, REG_TX_RPT_CTRL, ++ ((rtw_read8(adapter, REG_TX_RPT_CTRL) & ~BIT(1))) & ~BIT(5)); ++ RTW_INFO("disable TXRPT:0x%02x\n", rtw_read8(adapter, REG_TX_RPT_CTRL)); ++} ++ ++static void rtw_hal_enable_tx_report(_adapter *adapter) ++{ ++ rtw_write8(adapter, REG_TX_RPT_CTRL, ++ ((rtw_read8(adapter, REG_TX_RPT_CTRL) | BIT(1))) | BIT(5)); ++ RTW_INFO("enable TX_RPT:0x%02x\n", rtw_read8(adapter, REG_TX_RPT_CTRL)); ++} ++ ++static void rtw_hal_release_rx_dma(_adapter *adapter) ++{ ++ u32 val32 = 0; ++ ++ val32 = rtw_read32(adapter, REG_RXPKT_NUM); ++ ++ rtw_write32(adapter, REG_RXPKT_NUM, (val32 & (~RW_RELEASE_EN))); ++ ++ RTW_INFO("%s, [0x%04x]: 0x%08x\n", ++ __func__, REG_RXPKT_NUM, (val32 & (~RW_RELEASE_EN))); ++} ++ ++static u8 rtw_hal_pause_rx_dma(_adapter *adapter) ++{ ++ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); ++ u8 ret = 0; ++ s8 trycnt = 100; ++ u16 len = 0; ++ u32 tmp = 0; ++ int res = 0; ++ /* RX DMA stop */ ++ RTW_PRINT("Pause DMA\n"); ++ rtw_write32(adapter, REG_RXPKT_NUM, ++ (rtw_read32(adapter, REG_RXPKT_NUM) | RW_RELEASE_EN)); ++ do { ++ if ((rtw_read32(adapter, REG_RXPKT_NUM) & RXDMA_IDLE)) { ++#ifdef CONFIG_USB_HCI ++ /* stop interface before leave */ ++ if (_TRUE == hal->usb_intf_start) { ++ rtw_intf_stop(adapter); ++ RTW_ENABLE_FUNC(adapter, DF_RX_BIT); ++ RTW_ENABLE_FUNC(adapter, DF_TX_BIT); ++ } ++#endif /* CONFIG_USB_HCI */ ++ ++ RTW_PRINT("RX_DMA_IDLE is true\n"); ++ ret = _SUCCESS; ++ break; ++ } ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ else { ++ /* If RX_DMA is not idle, receive one pkt from DMA */ ++ res = sdio_local_read(adapter, ++ SDIO_REG_RX0_REQ_LEN, 4, (u8 *)&tmp); ++ len = le16_to_cpu(tmp); ++ RTW_PRINT("RX len:%d\n", len); ++ ++ if (len > 0) ++ res = RecvOnePkt(adapter, len); ++ else ++ RTW_PRINT("read length fail %d\n", len); ++ ++ RTW_PRINT("RecvOnePkt Result: %d\n", res); ++ } ++#endif /* CONFIG_SDIO_HCI || CONFIG_GSPI_HCI */ ++ ++#ifdef CONFIG_USB_HCI ++ else { ++ /* to avoid interface start repeatedly */ ++ if (_FALSE == hal->usb_intf_start) ++ rtw_intf_start(adapter); ++ } ++#endif /* CONFIG_USB_HCI */ ++ } while (trycnt--); ++ ++ if (trycnt < 0) { ++ tmp = rtw_read16(adapter, REG_RXPKT_NUM + 3); ++ ++ RTW_PRINT("Stop RX DMA failed......\n"); ++ RTW_PRINT("%s, RXPKT_NUM: 0x%04x\n", ++ __func__, tmp); ++ tmp = rtw_read16(adapter, REG_RXPKT_NUM + 2); ++ if (tmp & BIT(3)) ++ RTW_PRINT("%s, RX DMA has req\n", ++ __func__); ++ else ++ RTW_PRINT("%s, RX DMA no req\n", ++ __func__); ++ ret = _FAIL; ++ } ++ ++ return ret; ++} ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++static u8 rtw_hal_enable_cpwm2(_adapter *adapter) ++{ ++ u8 ret = 0; ++ int res = 0; ++ u32 tmp = 0; ++#ifdef CONFIG_GPIO_WAKEUP ++ return _SUCCESS; ++#else ++ RTW_PRINT("%s\n", __func__); ++ ++ res = sdio_local_read(adapter, SDIO_REG_HIMR, 4, (u8 *)&tmp); ++ if (!res) ++ RTW_INFO("read SDIO_REG_HIMR: 0x%08x\n", tmp); ++ else ++ RTW_INFO("sdio_local_read fail\n"); ++ ++ tmp = SDIO_HIMR_CPWM2_MSK; ++ ++ res = sdio_local_write(adapter, SDIO_REG_HIMR, 4, (u8 *)&tmp); ++ ++ if (!res) { ++ res = sdio_local_read(adapter, SDIO_REG_HIMR, 4, (u8 *)&tmp); ++ RTW_INFO("read again SDIO_REG_HIMR: 0x%08x\n", tmp); ++ ret = _SUCCESS; ++ } else { ++ RTW_INFO("sdio_local_write fail\n"); ++ ret = _FAIL; ++ } ++ ++ return ret; ++#endif /* CONFIG_CPIO_WAKEUP */ ++} ++#endif /* CONFIG_SDIO_HCI, CONFIG_GSPI_HCI */ ++#endif /* CONFIG_WOWLAN || CONFIG_AP_WOWLAN */ ++ ++#ifdef CONFIG_WOWLAN ++/* ++ * rtw_hal_check_wow_ctrl ++ * chk_type: _TRUE means to check enable, if 0x690 & bit1, WOW enable successful ++ * _FALSE means to check disable, if 0x690 & bit1, WOW disable fail ++ */ ++static u8 rtw_hal_check_wow_ctrl(_adapter *adapter, u8 chk_type) ++{ ++ u8 mstatus = 0; ++ u8 trycnt = 25; ++ u8 res = _FALSE; ++ ++ mstatus = rtw_read8(adapter, REG_WOW_CTRL); ++ RTW_INFO("%s mstatus:0x%02x\n", __func__, mstatus); ++ ++ if (chk_type) { ++ while (!(mstatus & BIT1) && trycnt > 1) { ++ mstatus = rtw_read8(adapter, REG_WOW_CTRL); ++ RTW_PRINT("Loop index: %d :0x%02x\n", ++ trycnt, mstatus); ++ trycnt--; ++ rtw_msleep_os(20); ++ } ++ if (mstatus & BIT1) ++ res = _TRUE; ++ else ++ res = _FALSE; ++ } else { ++ while (mstatus & BIT1 && trycnt > 1) { ++ mstatus = rtw_read8(adapter, REG_WOW_CTRL); ++ RTW_PRINT("Loop index: %d :0x%02x\n", ++ trycnt, mstatus); ++ trycnt--; ++ rtw_msleep_os(20); ++ } ++ ++ if (mstatus & BIT1) ++ res = _FALSE; ++ else ++ res = _TRUE; ++ } ++ RTW_PRINT("%s check_type: %d res: %d trycnt: %d\n", ++ __func__, chk_type, res, (25 - trycnt)); ++ return res; ++} ++ ++#ifdef CONFIG_PNO_SUPPORT ++static u8 rtw_hal_check_pno_enabled(_adapter *adapter) ++{ ++ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); ++ u8 res = 0, count = 0; ++ u8 ret = _FALSE; ++ ++ if (ppwrpriv->wowlan_pno_enable && ppwrpriv->wowlan_in_resume == _FALSE) { ++ res = rtw_read8(adapter, REG_PNO_STATUS); ++ while (!(res & BIT(7)) && count < 25) { ++ RTW_INFO("[%d] cmd: 0x81 REG_PNO_STATUS: 0x%02x\n", ++ count, res); ++ res = rtw_read8(adapter, REG_PNO_STATUS); ++ count++; ++ rtw_msleep_os(2); ++ } ++ if (res & BIT(7)) ++ ret = _TRUE; ++ else ++ ret = _FALSE; ++ RTW_INFO("cmd: 0x81 REG_PNO_STATUS: ret(%d)\n", ret); ++ } ++ return ret; ++} ++#endif ++ ++static void rtw_hal_backup_rate(_adapter *adapter) ++{ ++ RTW_INFO("%s\n", __func__); ++ /* backup data rate to register 0x8b for wowlan FW */ ++ rtw_write8(adapter, 0x8d, 1); ++ rtw_write8(adapter, 0x8c, 0); ++ rtw_write8(adapter, 0x8f, 0x40); ++ rtw_write8(adapter, 0x8b, rtw_read8(adapter, 0x2f0)); ++} ++ ++#ifdef CONFIG_GTK_OL ++static void rtw_hal_fw_sync_cam_id(_adapter *adapter) ++{ ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ int cam_id, index = 0; ++ u8 *addr = NULL; ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ return; ++ ++ addr = get_bssid(pmlmepriv); ++ ++ if (addr == NULL) { ++ RTW_INFO("%s: get bssid MAC addr fail!!\n", __func__); ++ return; ++ } ++ ++ rtw_clean_dk_section(adapter); ++ ++ do { ++ cam_id = rtw_camid_search(adapter, addr, index, 1); ++ ++ if (cam_id == -1) ++ RTW_INFO("%s: cam_id: %d, key_id:%d\n", __func__, cam_id, index); ++ else ++ rtw_sec_cam_swap(adapter, cam_id, index); ++ ++ index++; ++ } while (index < 4); ++ ++ rtw_write8(adapter, REG_SECCFG, 0xcc); ++} ++static void rtw_hal_update_gtk_offload_info(_adapter *adapter) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); ++ struct aoac_report *paoac_rpt = &pwrctl->wowlan_aoac_rpt; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct security_priv *psecuritypriv = &adapter->securitypriv; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ _irqL irqL; ++ u8 get_key[16]; ++ u8 gtk_keyindex = 0, offset = 0; ++ u64 replay_count = 0; ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ return; ++ ++ _rtw_memset(get_key, 0, sizeof(get_key)); ++ _rtw_memcpy(&replay_count, ++ paoac_rpt->replay_counter_eapol_key, 8); ++ ++ /*read gtk key index*/ ++ gtk_keyindex = paoac_rpt->key_index; ++ ++ if (gtk_keyindex == 5 || gtk_keyindex == 0) { ++ RTW_INFO("%s no rekey event happened.\n", __func__); ++ } else if (gtk_keyindex > 0 && gtk_keyindex < 4) { ++ ++ RTW_INFO("%s update security key.\n", __func__); ++ ++ /*read key from sec-cam,for DK ,keyindex is equal to cam-id*/ ++ rtw_sec_read_cam_ent(adapter, gtk_keyindex, NULL, NULL, get_key); ++ ++ rtw_clean_hw_dk_cam(adapter); ++ if (_rtw_camid_is_gk(adapter, gtk_keyindex)) { ++ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ _rtw_memcpy(&dvobj->cam_cache[gtk_keyindex].key, get_key, 16); ++ _exit_critical_bh(&cam_ctl->lock, &irqL); ++ } else { ++ struct setkey_parm parm_gtk; ++ ++ parm_gtk.algorithm = psecuritypriv->dot118021XGrpPrivacy; ++ parm_gtk.keyid = gtk_keyindex; ++ _rtw_memcpy(parm_gtk.key, get_key, 16); ++ setkey_hdl(adapter, (u8 *)&parm_gtk); ++ } ++ ++ /*update key into related sw variable and sec-cam cache*/ ++ psecuritypriv->dot118021XGrpKeyid = gtk_keyindex; ++ _rtw_memcpy(&psecuritypriv->dot118021XGrpKey[gtk_keyindex], ++ get_key, 16); ++ /* update SW TKIP TX/RX MIC value */ ++ if (psecuritypriv->dot118021XGrpPrivacy == _TKIP_) { ++ offset = RTW_KEK_LEN + RTW_TKIP_MIC_LEN; ++ _rtw_memcpy( ++ &psecuritypriv->dot118021XGrptxmickey[gtk_keyindex], ++ &(paoac_rpt->group_key[offset]), ++ RTW_TKIP_MIC_LEN); ++ ++ offset = RTW_KEK_LEN; ++ _rtw_memcpy( ++ &psecuritypriv->dot118021XGrprxmickey[gtk_keyindex], ++ &(paoac_rpt->group_key[offset]), ++ RTW_TKIP_MIC_LEN); ++ } ++ ++ RTW_PRINT("GTK (%d) "KEY_FMT"\n", gtk_keyindex, ++ KEY_ARG(psecuritypriv->dot118021XGrpKey[gtk_keyindex].skey)); ++ } ++ ++ rtw_clean_dk_section(adapter); ++ ++ rtw_write8(adapter, REG_SECCFG, 0x0c); ++ ++ #ifdef CONFIG_GTK_OL_DBG ++ /* if (gtk_keyindex != 5) */ ++ dump_sec_cam(RTW_DBGDUMP, adapter); ++ dump_sec_cam_cache(RTW_DBGDUMP, adapter); ++ #endif ++} ++#endif ++ ++static void rtw_dump_aoac_rpt(_adapter *adapter) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); ++ struct aoac_report *paoac_rpt = &pwrctl->wowlan_aoac_rpt; ++ ++ RTW_INFO_DUMP("[AOAC-RPT] IV -", paoac_rpt->iv, 8); ++ RTW_INFO_DUMP("[AOAC-RPT] Replay counter of EAPOL key - ", ++ paoac_rpt->replay_counter_eapol_key, 8); ++ RTW_INFO_DUMP("[AOAC-RPT] Group key - ", paoac_rpt->group_key, 32); ++ RTW_INFO("[AOAC-RPT] Key Index - %d\n", paoac_rpt->key_index); ++ RTW_INFO("[AOAC-RPT] Security Type - %d\n", paoac_rpt->scurity_type); ++} ++ ++static bool rtw_hal_get_rsvd_page(_adapter *adapter, u32 page_offset, ++ u32 page_num, u8 *buffer, u32 buffer_size) ++{ ++ u32 addr = 0, size = 0, page_size = 0, data_low = 0, data_high = 0; ++ u16 txbndy = 0, offset = 0; ++ u8 i = 0, count = 0; ++ bool rst = _FALSE; ++ ++ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); ++ ++ addr = page_offset * page_size; ++ size = page_num * page_size; ++ ++ if (buffer_size < size) { ++ RTW_ERR("%s buffer_size(%d) < get page total size(%d)\n", ++ __func__, buffer_size, size); ++ return rst; ++ } ++ ++ txbndy = rtw_read8(adapter, REG_TDECTRL + 1); ++ ++ offset = (txbndy + page_offset) << 4; ++ count = (sizeof(struct aoac_report) / 8) + 1; ++ ++ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, 0x69); ++ ++ for (i = 0 ; i < count ; i++) { ++ rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, offset + i); ++ data_low = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L); ++ data_high = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H); ++ _rtw_memcpy(buffer + (i * 8), ++ &data_low, sizeof(data_low)); ++ _rtw_memcpy(buffer + ((i * 8) + 4), ++ &data_high, sizeof(data_high)); ++ } ++ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, 0x0); ++ return _TRUE; ++} ++ ++static void rtw_hal_get_aoac_rpt(_adapter *adapter) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); ++ struct aoac_report *paoac_rpt = &pwrctl->wowlan_aoac_rpt; ++ u32 page_offset = 0, page_number = 0; ++ u32 page_size = 0, buf_size = 0; ++ u8 *buffer = NULL; ++ u8 i = 0, tmp = 0; ++ int ret = -1; ++ ++ /* read aoac report from rsvd page */ ++ page_offset = pwrctl->wowlan_aoac_rpt_loc; ++ page_number = 1; ++ ++ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); ++ buf_size = page_size * page_number; ++ ++ buffer = rtw_zvmalloc(buf_size); ++ ++ if (NULL == buffer) { ++ RTW_ERR("%s buffer allocate failed size(%d)\n", ++ __func__, buf_size); ++ return; ++ } ++ ++ RTW_INFO("Get AOAC Report from rsvd page_offset:%d\n", page_offset); ++ ++ ret = rtw_hal_get_rsvd_page(adapter, page_offset, ++ page_number, buffer, buf_size); ++ ++ if (ret == _FALSE) { ++ RTW_ERR("%s get aoac report failed\n", __func__); ++ rtw_warn_on(1); ++ goto _exit; ++ } ++ ++ _rtw_memset(paoac_rpt, 0, sizeof(struct aoac_report)); ++ _rtw_memcpy(paoac_rpt, buffer, sizeof(struct aoac_report)); ++ ++ for (i = 0 ; i < 4 ; i++) { ++ tmp = paoac_rpt->replay_counter_eapol_key[i]; ++ paoac_rpt->replay_counter_eapol_key[i] = ++ paoac_rpt->replay_counter_eapol_key[7 - i]; ++ paoac_rpt->replay_counter_eapol_key[7 - i] = tmp; ++ } ++ ++ /* rtw_dump_aoac_rpt(adapter); */ ++ ++_exit: ++ if (buffer) ++ rtw_vmfree(buffer, buf_size); ++ ++} ++ ++static void rtw_hal_update_tx_iv(_adapter *adapter) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); ++ struct aoac_report *paoac_rpt = &pwrctl->wowlan_aoac_rpt; ++ struct sta_info *psta; ++ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct security_priv *psecpriv = &adapter->securitypriv; ++ ++ u16 val16 = 0; ++ u32 val32 = 0; ++ u64 txiv = 0; ++ u8 *pval = NULL; ++ ++ psta = rtw_get_stainfo(&adapter->stapriv, ++ get_my_bssid(&pmlmeinfo->network)); ++ ++ /* Update TX iv data. */ ++ pval = (u8 *)&paoac_rpt->iv; ++ ++ if (psecpriv->dot11PrivacyAlgrthm == _TKIP_) { ++ val16 = ((u16)(paoac_rpt->iv[2]) << 0) + ++ ((u16)(paoac_rpt->iv[0]) << 8); ++ val32 = ((u32)(paoac_rpt->iv[4])<< 0) + ++ ((u32)(paoac_rpt->iv[5]) << 8) + ++ ((u32)(paoac_rpt->iv[6]) << 16) + ++ ((u32)(paoac_rpt->iv[7]) << 24); ++ } else if (psecpriv->dot11PrivacyAlgrthm == _AES_) { ++ val16 = ((u16)(paoac_rpt->iv[0]) << 0) + ++ ((u16)(paoac_rpt->iv[1]) << 8); ++ val32 = ((u32) (paoac_rpt->iv[4]) << 0) + ++ ((u32)(paoac_rpt->iv[5]) << 8) + ++ ((u32)(paoac_rpt->iv[6]) << 16) + ++ ((u32)(paoac_rpt->iv[7]) << 24); ++ } ++ ++ if (psta) { ++ txiv = val16 + ((u64)val32 << 16); ++ if (txiv != 0) ++ psta->dot11txpn.val = txiv; ++ } ++} ++ ++static void rtw_hal_update_sw_security_info(_adapter *adapter) ++{ ++ rtw_hal_update_tx_iv(adapter); ++ rtw_hal_update_gtk_offload_info(adapter); ++} ++ ++static u8 rtw_hal_set_keep_alive_cmd(_adapter *adapter, u8 enable, u8 pkt_type) ++{ ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ ++ u8 u1H2CKeepAliveParm[H2C_KEEP_ALIVE_CTRL_LEN] = {0}; ++ u8 adopt = 1, check_period = 5; ++ u8 ret = _FAIL; ++ ++ RTW_INFO("%s(): enable = %d\n", __func__, enable); ++ SET_H2CCMD_KEEPALIVE_PARM_ENABLE(u1H2CKeepAliveParm, enable); ++ SET_H2CCMD_KEEPALIVE_PARM_ADOPT(u1H2CKeepAliveParm, adopt); ++ SET_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(u1H2CKeepAliveParm, pkt_type); ++ SET_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(u1H2CKeepAliveParm, check_period); ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, ++ H2C_KEEP_ALIVE, ++ H2C_KEEP_ALIVE_CTRL_LEN, ++ u1H2CKeepAliveParm); ++ ++ return ret; ++} ++ ++static u8 rtw_hal_set_disconnect_decision_cmd(_adapter *adapter, u8 enable) ++{ ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ u8 u1H2CDisconDecisionParm[H2C_DISCON_DECISION_LEN] = {0}; ++ u8 adopt = 1, check_period = 10, trypkt_num = 0; ++ u8 ret = _FAIL; ++ ++ RTW_INFO("%s(): enable = %d\n", __func__, enable); ++ SET_H2CCMD_DISCONDECISION_PARM_ENABLE(u1H2CDisconDecisionParm, enable); ++ SET_H2CCMD_DISCONDECISION_PARM_ADOPT(u1H2CDisconDecisionParm, adopt); ++ SET_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(u1H2CDisconDecisionParm, check_period); ++ SET_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(u1H2CDisconDecisionParm, trypkt_num); ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, ++ H2C_DISCON_DECISION, ++ H2C_DISCON_DECISION_LEN, ++ u1H2CDisconDecisionParm); ++ return ret; ++} ++ ++static u8 rtw_hal_set_wowlan_ctrl_cmd(_adapter *adapter, u8 enable, u8 change_unit) ++{ ++ struct security_priv *psecpriv = &adapter->securitypriv; ++ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ ++ u8 u1H2CWoWlanCtrlParm[H2C_WOWLAN_LEN] = {0}; ++ u8 discont_wake = 1, gpionum = 0, gpio_dur = 0; ++ u8 hw_unicast = 0, gpio_pulse_cnt = 0, gpio_pulse_en = 0; ++ u8 sdio_wakeup_enable = 1; ++ u8 gpio_high_active = 0; ++ u8 magic_pkt = 0; ++ u8 gpio_unit = 0; /*0: 64ns, 1: 8ms*/ ++ u8 ret = _FAIL; ++ ++#ifdef CONFIG_GPIO_WAKEUP ++ gpio_high_active = ppwrpriv->is_high_active; ++ gpionum = WAKEUP_GPIO_IDX; ++ sdio_wakeup_enable = 0; ++#endif /* CONFIG_GPIO_WAKEUP */ ++ ++ if (!ppwrpriv->wowlan_pno_enable) ++ magic_pkt = enable; ++ ++ if (psecpriv->dot11PrivacyAlgrthm == _WEP40_ || psecpriv->dot11PrivacyAlgrthm == _WEP104_) ++ hw_unicast = 1; ++ else ++ hw_unicast = 0; ++ ++ RTW_INFO("%s(): enable=%d change_unit=%d\n", __func__, ++ enable, change_unit); ++ ++ /* time = (gpio_dur/2) * gpio_unit, default:256 ms */ ++ if (enable && change_unit) { ++ gpio_dur = 0x40; ++ gpio_unit = 1; ++ gpio_pulse_en = 1; ++ } ++ ++#ifdef CONFIG_PLATFORM_ARM_RK3188 ++ if (enable) { ++ gpio_pulse_en = 1; ++ gpio_pulse_cnt = 0x04; ++ } ++#endif ++ ++ SET_H2CCMD_WOWLAN_FUNC_ENABLE(u1H2CWoWlanCtrlParm, enable); ++ SET_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(u1H2CWoWlanCtrlParm, enable); ++ SET_H2CCMD_WOWLAN_MAGIC_PKT_ENABLE(u1H2CWoWlanCtrlParm, magic_pkt); ++ SET_H2CCMD_WOWLAN_UNICAST_PKT_ENABLE(u1H2CWoWlanCtrlParm, hw_unicast); ++ SET_H2CCMD_WOWLAN_ALL_PKT_DROP(u1H2CWoWlanCtrlParm, 0); ++ SET_H2CCMD_WOWLAN_GPIO_ACTIVE(u1H2CWoWlanCtrlParm, gpio_high_active); ++ ++#ifdef CONFIG_GTK_OL ++ SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(u1H2CWoWlanCtrlParm, 0); ++#else ++ SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(u1H2CWoWlanCtrlParm, enable); ++#endif ++ SET_H2CCMD_WOWLAN_DISCONNECT_WAKE_UP(u1H2CWoWlanCtrlParm, discont_wake); ++ SET_H2CCMD_WOWLAN_GPIONUM(u1H2CWoWlanCtrlParm, gpionum); ++ SET_H2CCMD_WOWLAN_DATAPIN_WAKE_UP(u1H2CWoWlanCtrlParm, sdio_wakeup_enable); ++ ++ SET_H2CCMD_WOWLAN_GPIO_DURATION(u1H2CWoWlanCtrlParm, gpio_dur); ++ SET_H2CCMD_WOWLAN_CHANGE_UNIT(u1H2CWoWlanCtrlParm, gpio_unit); ++ ++ SET_H2CCMD_WOWLAN_GPIO_PULSE_EN(u1H2CWoWlanCtrlParm, gpio_pulse_en); ++ SET_H2CCMD_WOWLAN_GPIO_PULSE_COUNT(u1H2CWoWlanCtrlParm, gpio_pulse_cnt); ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, ++ H2C_WOWLAN, ++ H2C_WOWLAN_LEN, ++ u1H2CWoWlanCtrlParm); ++ return ret; ++} ++ ++static u8 rtw_hal_set_remote_wake_ctrl_cmd(_adapter *adapter, u8 enable) ++{ ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ struct security_priv *psecuritypriv = &(adapter->securitypriv); ++ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); ++ struct registry_priv *pregistrypriv = &adapter->registrypriv; ++ u8 u1H2CRemoteWakeCtrlParm[H2C_REMOTE_WAKE_CTRL_LEN] = {0}; ++ u8 ret = _FAIL, count = 0; ++ ++ RTW_INFO("%s(): enable=%d\n", __func__, enable); ++ ++ if (!ppwrpriv->wowlan_pno_enable) { ++ SET_H2CCMD_REMOTE_WAKECTRL_ENABLE( ++ u1H2CRemoteWakeCtrlParm, enable); ++ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN( ++ u1H2CRemoteWakeCtrlParm, 1); ++#ifdef CONFIG_GTK_OL ++ if (psecuritypriv->binstallKCK_KEK == _TRUE) { ++ SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN( ++ u1H2CRemoteWakeCtrlParm, 1); ++ } else { ++ SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN( ++ u1H2CRemoteWakeCtrlParm, 0); ++ } ++#endif /* CONFIG_GTK_OL */ ++ ++ if (pregistrypriv->default_patterns_en == _FALSE) { ++ SET_H2CCMD_REMOTE_WAKE_CTRL_FW_UNICAST_EN( ++ u1H2CRemoteWakeCtrlParm, enable); ++ /* ++ * filter NetBios name service pkt to avoid being waked-up ++ * by this kind of unicast pkt this exceptional modification ++ * is used for match competitor's behavior ++ */ ++ SET_H2CCMD_REMOTE_WAKE_CTRL_NBNS_FILTER_EN( ++ u1H2CRemoteWakeCtrlParm, enable); ++ } ++ ++ if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) ++ SET_H2CCMD_REMOTE_WAKE_CTRL_TKIP_OFFLOAD_EN( ++ u1H2CRemoteWakeCtrlParm, enable); ++ ++ if ((psecuritypriv->dot11PrivacyAlgrthm == _AES_) || ++ (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) || ++ (psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_)) { ++ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION( ++ u1H2CRemoteWakeCtrlParm, 0); ++ } else { ++ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION( ++ u1H2CRemoteWakeCtrlParm, 1); ++ } ++ ++ SET_H2CCMD_REMOTE_WAKE_CTRL_FW_PARSING_UNTIL_WAKEUP( ++ u1H2CRemoteWakeCtrlParm, 1); ++ } ++#ifdef CONFIG_PNO_SUPPORT ++ else { ++ SET_H2CCMD_REMOTE_WAKECTRL_ENABLE( ++ u1H2CRemoteWakeCtrlParm, enable); ++ SET_H2CCMD_REMOTE_WAKE_CTRL_NLO_OFFLOAD_EN( ++ u1H2CRemoteWakeCtrlParm, enable); ++ } ++#endif ++ ++#ifdef CONFIG_P2P_WOWLAN ++ if (_TRUE == ppwrpriv->wowlan_p2p_mode) { ++ RTW_INFO("P2P OFFLOAD ENABLE\n"); ++ SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(u1H2CRemoteWakeCtrlParm, 1); ++ } else { ++ RTW_INFO("P2P OFFLOAD DISABLE\n"); ++ SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(u1H2CRemoteWakeCtrlParm, 0); ++ } ++#endif /* CONFIG_P2P_WOWLAN */ ++ ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, ++ H2C_REMOTE_WAKE_CTRL, ++ H2C_REMOTE_WAKE_CTRL_LEN, ++ u1H2CRemoteWakeCtrlParm); ++ return ret; ++} ++ ++static u8 rtw_hal_set_global_info_cmd(_adapter *adapter, u8 group_alg, u8 pairwise_alg) ++{ ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ u8 ret = _FAIL; ++ u8 u1H2CAOACGlobalInfoParm[H2C_AOAC_GLOBAL_INFO_LEN] = {0}; ++ ++ RTW_INFO("%s(): group_alg=%d pairwise_alg=%d\n", ++ __func__, group_alg, pairwise_alg); ++ SET_H2CCMD_AOAC_GLOBAL_INFO_PAIRWISE_ENC_ALG(u1H2CAOACGlobalInfoParm, ++ pairwise_alg); ++ SET_H2CCMD_AOAC_GLOBAL_INFO_GROUP_ENC_ALG(u1H2CAOACGlobalInfoParm, ++ group_alg); ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, ++ H2C_AOAC_GLOBAL_INFO, ++ H2C_AOAC_GLOBAL_INFO_LEN, ++ u1H2CAOACGlobalInfoParm); ++ ++ return ret; ++} ++ ++#ifdef CONFIG_PNO_SUPPORT ++static u8 rtw_hal_set_scan_offload_info_cmd(_adapter *adapter, ++ PRSVDPAGE_LOC rsvdpageloc, u8 enable) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ ++ u8 u1H2CScanOffloadInfoParm[H2C_SCAN_OFFLOAD_CTRL_LEN] = {0}; ++ u8 res = 0, count = 0, ret = _FAIL; ++ ++ RTW_INFO("%s: loc_probe_packet:%d, loc_scan_info: %d loc_ssid_info:%d\n", ++ __func__, rsvdpageloc->LocProbePacket, ++ rsvdpageloc->LocScanInfo, rsvdpageloc->LocSSIDInfo); ++ ++ SET_H2CCMD_AOAC_NLO_FUN_EN(u1H2CScanOffloadInfoParm, enable); ++ SET_H2CCMD_AOAC_NLO_IPS_EN(u1H2CScanOffloadInfoParm, enable); ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_SCAN_INFO(u1H2CScanOffloadInfoParm, ++ rsvdpageloc->LocScanInfo); ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_PROBE_PACKET(u1H2CScanOffloadInfoParm, ++ rsvdpageloc->LocProbePacket); ++ /* ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_SSID_INFO(u1H2CScanOffloadInfoParm, ++ rsvdpageloc->LocSSIDInfo); ++ */ ++ ret = rtw_hal_fill_h2c_cmd(adapter, ++ H2C_D0_SCAN_OFFLOAD_INFO, ++ H2C_SCAN_OFFLOAD_CTRL_LEN, ++ u1H2CScanOffloadInfoParm); ++ return ret; ++} ++#endif /* CONFIG_PNO_SUPPORT */ ++ ++void rtw_hal_set_fw_wow_related_cmd(_adapter *padapter, u8 enable) ++{ ++ struct security_priv *psecpriv = &padapter->securitypriv; ++ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct sta_info *psta = NULL; ++ u16 media_status_rpt; ++ u8 pkt_type = 0; ++ u8 ret = _SUCCESS; ++ ++ RTW_PRINT("+%s()+: enable=%d\n", __func__, enable); ++ ++ rtw_hal_set_wowlan_ctrl_cmd(padapter, enable, _FALSE); ++ ++ if (enable) { ++ rtw_hal_set_global_info_cmd(padapter, ++ psecpriv->dot118021XGrpPrivacy, ++ psecpriv->dot11PrivacyAlgrthm); ++ ++ if (!(ppwrpriv->wowlan_pno_enable)) { ++ rtw_hal_set_disconnect_decision_cmd(padapter, enable); ++#ifdef CONFIG_ARP_KEEP_ALIVE ++ if ((psecpriv->dot11PrivacyAlgrthm == _WEP40_) || ++ (psecpriv->dot11PrivacyAlgrthm == _WEP104_)) ++ pkt_type = 0; ++ else ++ pkt_type = 1; ++#else ++ pkt_type = 0; ++#endif /* CONFIG_ARP_KEEP_ALIVE */ ++ rtw_hal_set_keep_alive_cmd(padapter, enable, pkt_type); ++ } ++ rtw_hal_set_remote_wake_ctrl_cmd(padapter, enable); ++#ifdef CONFIG_PNO_SUPPORT ++ rtw_hal_check_pno_enabled(padapter); ++#endif /* CONFIG_PNO_SUPPORT */ ++ } else { ++#if 0 ++ { ++ u32 PageSize = 0; ++ rtw_hal_get_def_var(padapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&PageSize); ++ dump_TX_FIFO(padapter, 4, PageSize); ++ } ++#endif ++ ++ rtw_hal_set_remote_wake_ctrl_cmd(padapter, enable); ++ } ++ RTW_PRINT("-%s()-\n", __func__); ++} ++#endif /* CONFIG_WOWLAN */ ++ ++#ifdef CONFIG_AP_WOWLAN ++static u8 rtw_hal_set_ap_wowlan_ctrl_cmd(_adapter *adapter, u8 enable) ++{ ++ struct security_priv *psecpriv = &adapter->securitypriv; ++ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ ++ u8 u1H2CAPWoWlanCtrlParm[H2C_AP_WOW_GPIO_CTRL_LEN] = {0}; ++ u8 gpionum = 0, gpio_dur = 0; ++ u8 gpio_pulse = enable; ++ u8 sdio_wakeup_enable = 1; ++ u8 gpio_high_active = 0; ++ u8 ret = _FAIL; ++ ++#ifdef CONFIG_GPIO_WAKEUP ++ gpio_high_active = ppwrpriv->is_high_active; ++ gpionum = WAKEUP_GPIO_IDX; ++ sdio_wakeup_enable = 0; ++#endif /*CONFIG_GPIO_WAKEUP*/ ++ ++ RTW_INFO("%s(): enable=%d\n", __func__, enable); ++ ++ SET_H2CCMD_AP_WOW_GPIO_CTRL_INDEX(u1H2CAPWoWlanCtrlParm, ++ gpionum); ++ SET_H2CCMD_AP_WOW_GPIO_CTRL_PLUS(u1H2CAPWoWlanCtrlParm, ++ gpio_pulse); ++ SET_H2CCMD_AP_WOW_GPIO_CTRL_HIGH_ACTIVE(u1H2CAPWoWlanCtrlParm, ++ gpio_high_active); ++ SET_H2CCMD_AP_WOW_GPIO_CTRL_EN(u1H2CAPWoWlanCtrlParm, ++ enable); ++ SET_H2CCMD_AP_WOW_GPIO_CTRL_DURATION(u1H2CAPWoWlanCtrlParm, ++ gpio_dur); ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, ++ H2C_AP_WOW_GPIO_CTRL, ++ H2C_AP_WOW_GPIO_CTRL_LEN, ++ u1H2CAPWoWlanCtrlParm); ++ ++ return ret; ++} ++ ++static u8 rtw_hal_set_ap_offload_ctrl_cmd(_adapter *adapter, u8 enable) ++{ ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ u8 u1H2CAPOffloadCtrlParm[H2C_WOWLAN_LEN] = {0}; ++ u8 ret = _FAIL; ++ ++ RTW_INFO("%s(): bFuncEn=%d\n", __func__, enable); ++ ++ SET_H2CCMD_AP_WOWLAN_EN(u1H2CAPOffloadCtrlParm, enable); ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, ++ H2C_AP_OFFLOAD, ++ H2C_AP_OFFLOAD_LEN, ++ u1H2CAPOffloadCtrlParm); ++ ++ return ret; ++} ++ ++static u8 rtw_hal_set_ap_ps_cmd(_adapter *adapter, u8 enable) ++{ ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ u8 ap_ps_parm[H2C_AP_PS_LEN] = {0}; ++ u8 ret = _FAIL; ++ ++ RTW_INFO("%s(): enable=%d\n" , __func__ , enable); ++ ++ SET_H2CCMD_AP_WOW_PS_EN(ap_ps_parm, enable); ++#ifndef CONFIG_USB_HCI ++ SET_H2CCMD_AP_WOW_PS_32K_EN(ap_ps_parm, enable); ++#endif /*CONFIG_USB_HCI*/ ++ SET_H2CCMD_AP_WOW_PS_RF(ap_ps_parm, enable); ++ ++ if (enable) ++ SET_H2CCMD_AP_WOW_PS_DURATION(ap_ps_parm, 0x32); ++ else ++ SET_H2CCMD_AP_WOW_PS_DURATION(ap_ps_parm, 0x0); ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_SAP_PS_, ++ H2C_AP_PS_LEN, ap_ps_parm); ++ ++ return ret; ++} ++ ++static void rtw_hal_set_ap_rsvdpage_loc_cmd(PADAPTER padapter, ++ PRSVDPAGE_LOC rsvdpageloc) ++{ ++ struct hal_ops *pHalFunc = &padapter->HalFunc; ++ u8 rsvdparm[H2C_AOAC_RSVDPAGE_LOC_LEN] = {0}; ++ u8 ret = _FAIL, header = 0; ++ ++ if (pHalFunc->fill_h2c_cmd == NULL) { ++ RTW_INFO("%s: Please hook fill_h2c_cmd first!\n", __func__); ++ return; ++ } ++ ++ header = rtw_read8(padapter, REG_BCNQ_BDNY); ++ ++ RTW_INFO("%s: beacon: %d, probeRsp: %d, header:0x%02x\n", __func__, ++ rsvdpageloc->LocApOffloadBCN, ++ rsvdpageloc->LocProbeRsp, ++ header); ++ ++ SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_BCN(rsvdparm, ++ rsvdpageloc->LocApOffloadBCN + header); ++ ++ ret = rtw_hal_fill_h2c_cmd(padapter, H2C_BCN_RSVDPAGE, ++ H2C_BCN_RSVDPAGE_LEN, rsvdparm); ++ ++ if (ret == _FAIL) ++ RTW_INFO("%s: H2C_BCN_RSVDPAGE cmd fail\n", __func__); ++ ++ rtw_msleep_os(10); ++ ++ _rtw_memset(&rsvdparm, 0, sizeof(rsvdparm)); ++ ++ SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_ProbeRsp(rsvdparm, ++ rsvdpageloc->LocProbeRsp + header); ++ ++ ret = rtw_hal_fill_h2c_cmd(padapter, H2C_PROBERSP_RSVDPAGE, ++ H2C_PROBERSP_RSVDPAGE_LEN, rsvdparm); ++ ++ if (ret == _FAIL) ++ RTW_INFO("%s: H2C_PROBERSP_RSVDPAGE cmd fail\n", __func__); ++ ++ rtw_msleep_os(10); ++} ++ ++static void rtw_hal_set_fw_ap_wow_related_cmd(_adapter *padapter, u8 enable) ++{ ++ rtw_hal_set_ap_offload_ctrl_cmd(padapter, enable); ++ rtw_hal_set_ap_wowlan_ctrl_cmd(padapter, enable); ++ rtw_hal_set_ap_ps_cmd(padapter, enable); ++} ++ ++static void rtw_hal_ap_wow_enable(_adapter *padapter) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct hal_ops *pHalFunc = &padapter->HalFunc; ++ struct sta_info *psta = NULL; ++#ifdef DBG_CHECK_FW_PS_STATE ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++#endif /*DBG_CHECK_FW_PS_STATE*/ ++ int res; ++ u16 media_status_rpt; ++ ++ RTW_INFO("%s, WOWLAN_AP_ENABLE\n", __func__); ++#ifdef DBG_CHECK_FW_PS_STATE ++ if (rtw_fw_ps_state(padapter) == _FAIL) { ++ pdbgpriv->dbg_enwow_dload_fw_fail_cnt++; ++ RTW_PRINT("wowlan enable no leave 32k\n"); ++ } ++#endif /*DBG_CHECK_FW_PS_STATE*/ ++ ++ /* 1. Download WOWLAN FW*/ ++ rtw_hal_fw_dl(padapter, _TRUE); ++ ++ media_status_rpt = RT_MEDIA_CONNECT; ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, ++ (u8 *)&media_status_rpt); ++ ++ issue_beacon(padapter, 0); ++ ++ rtw_msleep_os(2); ++ ++ if (IS_HARDWARE_TYPE_8188E(padapter)) ++ rtw_hal_disable_tx_report(padapter); ++ ++ /* RX DMA stop */ ++ res = rtw_hal_pause_rx_dma(padapter); ++ if (res == _FAIL) ++ RTW_PRINT("[WARNING] pause RX DMA fail\n"); ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ /* Enable CPWM2 only. */ ++ res = rtw_hal_enable_cpwm2(padapter); ++ if (res == _FAIL) ++ RTW_PRINT("[WARNING] enable cpwm2 fail\n"); ++#endif ++ ++#ifdef CONFIG_GPIO_WAKEUP ++ rtw_hal_switch_gpio_wl_ctrl(padapter, WAKEUP_GPIO_IDX, _TRUE); ++#endif ++ /* 5. Set Enable WOWLAN H2C command. */ ++ RTW_PRINT("Set Enable AP WOWLan cmd\n"); ++ rtw_hal_set_fw_ap_wow_related_cmd(padapter, 1); ++ ++ rtw_write8(padapter, REG_MCUTST_WOWLAN, 0); ++#ifdef CONFIG_USB_HCI ++ rtw_mi_intf_stop(padapter); ++ /* Invoid SE0 reset signal during suspending*/ ++ rtw_write8(padapter, REG_RSV_CTRL, 0x20); ++ rtw_write8(padapter, REG_RSV_CTRL, 0x60); ++#endif /*CONFIG_USB_HCI*/ ++} ++ ++static void rtw_hal_ap_wow_disable(_adapter *padapter) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ struct hal_ops *pHalFunc = &padapter->HalFunc; ++#ifdef DBG_CHECK_FW_PS_STATE ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++#endif /*DBG_CHECK_FW_PS_STATE*/ ++ u16 media_status_rpt; ++ u8 val8; ++ ++ RTW_INFO("%s, WOWLAN_AP_DISABLE\n", __func__); ++ /* 1. Read wakeup reason*/ ++ pwrctl->wowlan_wake_reason = rtw_read8(padapter, REG_MCUTST_WOWLAN); ++ ++ RTW_PRINT("wakeup_reason: 0x%02x\n", ++ pwrctl->wowlan_wake_reason); ++ ++ rtw_hal_set_fw_ap_wow_related_cmd(padapter, 0); ++ ++ rtw_msleep_os(2); ++#ifdef DBG_CHECK_FW_PS_STATE ++ if (rtw_fw_ps_state(padapter) == _FAIL) { ++ pdbgpriv->dbg_diswow_dload_fw_fail_cnt++; ++ RTW_PRINT("wowlan enable no leave 32k\n"); ++ } ++#endif /*DBG_CHECK_FW_PS_STATE*/ ++ ++ if (IS_HARDWARE_TYPE_8188E(padapter)) ++ rtw_hal_enable_tx_report(padapter); ++ ++ rtw_hal_force_enable_rxdma(padapter); ++ ++ rtw_hal_fw_dl(padapter, _FALSE); ++ ++#ifdef CONFIG_GPIO_WAKEUP ++ val8 = (pwrctl->is_high_active == 0) ? 1 : 0; ++ RTW_PRINT("Set Wake GPIO to default(%d).\n", val8); ++ rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, val8); ++#endif ++ media_status_rpt = RT_MEDIA_CONNECT; ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, ++ (u8 *)&media_status_rpt); ++ ++ issue_beacon(padapter, 0); ++} ++#endif /*CONFIG_AP_WOWLAN*/ ++ ++#ifdef CONFIG_P2P_WOWLAN ++static int update_hidden_ssid(u8 *ies, u32 ies_len, u8 hidden_ssid_mode) ++{ ++ u8 *ssid_ie; ++ sint ssid_len_ori; ++ int len_diff = 0; ++ ++ ssid_ie = rtw_get_ie(ies, WLAN_EID_SSID, &ssid_len_ori, ies_len); ++ ++ /* RTW_INFO("%s hidden_ssid_mode:%u, ssid_ie:%p, ssid_len_ori:%d\n", __FUNCTION__, hidden_ssid_mode, ssid_ie, ssid_len_ori); */ ++ ++ if (ssid_ie && ssid_len_ori > 0) { ++ switch (hidden_ssid_mode) { ++ case 1: { ++ u8 *next_ie = ssid_ie + 2 + ssid_len_ori; ++ u32 remain_len = 0; ++ ++ remain_len = ies_len - (next_ie - ies); ++ ++ ssid_ie[1] = 0; ++ _rtw_memcpy(ssid_ie + 2, next_ie, remain_len); ++ len_diff -= ssid_len_ori; ++ ++ break; ++ } ++ case 2: ++ _rtw_memset(&ssid_ie[2], 0, ssid_len_ori); ++ break; ++ default: ++ break; ++ } ++ } ++ ++ return len_diff; ++} ++ ++static void rtw_hal_construct_P2PBeacon(_adapter *padapter, u8 *pframe, u32 *pLength) ++{ ++ /* struct xmit_frame *pmgntframe; */ ++ /* struct pkt_attrib *pattrib; */ ++ /* unsigned char *pframe; */ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ unsigned int rate_len; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ u32 pktlen; ++ /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ ++ /* _irqL irqL; ++ * struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ * #endif */ /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif /* CONFIG_P2P */ ++ ++ /* for debug */ ++ u8 *dbgbuf = pframe; ++ u8 dbgbufLen = 0, index = 0; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ ++ /* _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); ++ * #endif */ /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); ++ /* pmlmeext->mgnt_seq++; */ ++ SetFrameSubType(pframe, WIFI_BEACON); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { ++ /* RTW_INFO("ie len=%d\n", cur_network->IELength); */ ++#ifdef CONFIG_P2P ++ /* for P2P : Primary Device Type & Device Name */ ++ u32 wpsielen = 0, insert_len = 0; ++ u8 *wpsie = NULL; ++ wpsie = rtw_get_wps_ie(cur_network->IEs + _FIXED_IE_LENGTH_, cur_network->IELength - _FIXED_IE_LENGTH_, NULL, &wpsielen); ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && wpsie && wpsielen > 0) { ++ uint wps_offset, remainder_ielen; ++ u8 *premainder_ie, *pframe_wscie; ++ ++ wps_offset = (uint)(wpsie - cur_network->IEs); ++ ++ premainder_ie = wpsie + wpsielen; ++ ++ remainder_ielen = cur_network->IELength - wps_offset - wpsielen; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (pwdinfo->driver_interface == DRIVER_CFG80211) { ++ if (pmlmepriv->wps_beacon_ie && pmlmepriv->wps_beacon_ie_len > 0) { ++ _rtw_memcpy(pframe, cur_network->IEs, wps_offset); ++ pframe += wps_offset; ++ pktlen += wps_offset; ++ ++ _rtw_memcpy(pframe, pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len); ++ pframe += pmlmepriv->wps_beacon_ie_len; ++ pktlen += pmlmepriv->wps_beacon_ie_len; ++ ++ /* copy remainder_ie to pframe */ ++ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); ++ pframe += remainder_ielen; ++ pktlen += remainder_ielen; ++ } else { ++ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); ++ pframe += cur_network->IELength; ++ pktlen += cur_network->IELength; ++ } ++ } else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ { ++ pframe_wscie = pframe + wps_offset; ++ _rtw_memcpy(pframe, cur_network->IEs, wps_offset + wpsielen); ++ pframe += (wps_offset + wpsielen); ++ pktlen += (wps_offset + wpsielen); ++ ++ /* now pframe is end of wsc ie, insert Primary Device Type & Device Name */ ++ /* Primary Device Type */ ++ /* Type: */ ++ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_ATTR_PRIMARY_DEV_TYPE); ++ insert_len += 2; ++ ++ /* Length: */ ++ *(u16 *)(pframe + insert_len) = cpu_to_be16(0x0008); ++ insert_len += 2; ++ ++ /* Value: */ ++ /* Category ID */ ++ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); ++ insert_len += 2; ++ ++ /* OUI */ ++ *(u32 *)(pframe + insert_len) = cpu_to_be32(WPSOUI); ++ insert_len += 4; ++ ++ /* Sub Category ID */ ++ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); ++ insert_len += 2; ++ ++ ++ /* Device Name */ ++ /* Type: */ ++ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); ++ insert_len += 2; ++ ++ /* Length: */ ++ *(u16 *)(pframe + insert_len) = cpu_to_be16(pwdinfo->device_name_len); ++ insert_len += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(pframe + insert_len, pwdinfo->device_name, pwdinfo->device_name_len); ++ insert_len += pwdinfo->device_name_len; ++ ++ ++ /* update wsc ie length */ ++ *(pframe_wscie + 1) = (wpsielen - 2) + insert_len; ++ ++ /* pframe move to end */ ++ pframe += insert_len; ++ pktlen += insert_len; ++ ++ /* copy remainder_ie to pframe */ ++ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); ++ pframe += remainder_ielen; ++ pktlen += remainder_ielen; ++ } ++ } else ++#endif /* CONFIG_P2P */ ++ { ++ int len_diff; ++ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); ++ len_diff = update_hidden_ssid( ++ pframe + _BEACON_IE_OFFSET_ ++ , cur_network->IELength - _BEACON_IE_OFFSET_ ++ , pmlmeinfo->hidden_ssid_mode ++ ); ++ pframe += (cur_network->IELength + len_diff); ++ pktlen += (cur_network->IELength + len_diff); ++ } ++#if 0 ++ { ++ u8 *wps_ie; ++ uint wps_ielen; ++ u8 sr = 0; ++ wps_ie = rtw_get_wps_ie(pmgntframe->buf_addr + TXDESC_OFFSET + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_, ++ pattrib->pktlen - sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_, NULL, &wps_ielen); ++ if (wps_ie && wps_ielen > 0) ++ rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8 *)(&sr), NULL); ++ if (sr != 0) ++ set_fwstate(pmlmepriv, WIFI_UNDER_WPS); ++ else ++ _clr_fwstate_(pmlmepriv, WIFI_UNDER_WPS); ++ } ++#endif ++#ifdef CONFIG_P2P ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ u32 len; ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (pwdinfo->driver_interface == DRIVER_CFG80211) { ++ len = pmlmepriv->p2p_beacon_ie_len; ++ if (pmlmepriv->p2p_beacon_ie && len > 0) ++ _rtw_memcpy(pframe, pmlmepriv->p2p_beacon_ie, len); ++ } else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ { ++ len = build_beacon_p2p_ie(pwdinfo, pframe); ++ } ++ ++ pframe += len; ++ pktlen += len; ++ ++ #ifdef CONFIG_WFD ++ len = rtw_append_beacon_wfd_ie(padapter, pframe); ++ pframe += len; ++ pktlen += len; ++ #endif ++ ++ } ++#endif /* CONFIG_P2P */ ++ ++ goto _issue_bcn; ++ ++ } ++ ++ /* below for ad-hoc mode */ ++ ++ /* timestamp will be inserted by hardware */ ++ pframe += 8; ++ pktlen += 8; ++ ++ /* beacon interval: 2 bytes */ ++ ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); ++ ++ pframe += 2; ++ pktlen += 2; ++ ++ /* capability info: 2 bytes */ ++ ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); ++ ++ pframe += 2; ++ pktlen += 2; ++ ++ /* SSID */ ++ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pktlen); ++ ++ /* supported rates... */ ++ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pktlen); ++ ++ /* DS parameter set */ ++ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pktlen); ++ ++ /* if( (pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) */ ++ { ++ u8 erpinfo = 0; ++ u32 ATIMWindow; ++ /* IBSS Parameter Set... */ ++ /* ATIMWindow = cur->Configuration.ATIMWindow; */ ++ ATIMWindow = 0; ++ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pktlen); ++ ++ /* ERP IE */ ++ pframe = rtw_set_ie(pframe, _ERPINFO_IE_, 1, &erpinfo, &pktlen); ++ } ++ ++ ++ /* EXTERNDED SUPPORTED RATE */ ++ if (rate_len > 8) ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen); ++ ++ ++ /* todo:HT for adhoc */ ++ ++_issue_bcn: ++ ++ /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ ++ /* pmlmepriv->update_bcn = _FALSE; ++ * ++ * _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); ++ * #endif */ /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ ++ ++ *pLength = pktlen; ++#if 0 ++ /* printf dbg msg */ ++ dbgbufLen = pktlen; ++ RTW_INFO("======> DBG MSG FOR CONSTRAUCT P2P BEACON\n"); ++ ++ for (index = 0; index < dbgbufLen; index++) ++ printk("%x ", *(dbgbuf + index)); ++ ++ printk("\n"); ++ RTW_INFO("<====== DBG MSG FOR CONSTRAUCT P2P BEACON\n"); ++ ++#endif ++} ++ ++static int get_reg_classes_full_count(struct p2p_channels channel_list) ++{ ++ int cnt = 0; ++ int i; ++ ++ for (i = 0; i < channel_list.reg_classes; i++) ++ cnt += channel_list.reg_class[i].channels; ++ ++ return cnt; ++} ++ ++static void rtw_hal_construct_P2PProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength) ++{ ++ /* struct xmit_frame *pmgntframe; */ ++ /* struct pkt_attrib *pattrib; */ ++ /* unsigned char *pframe; */ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ unsigned char *mac; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ /* WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); */ ++ u16 beacon_interval = 100; ++ u16 capInfo = 0; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 wpsie[255] = { 0x00 }; ++ u32 wpsielen = 0, p2pielen = 0; ++ u32 pktlen; ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++#ifdef CONFIG_INTEL_WIDI ++ u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ /* for debug */ ++ u8 *dbgbuf = pframe; ++ u8 dbgbufLen = 0, index = 0; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ mac = adapter_mac_addr(padapter); ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ /* DA filled by FW */ ++ _rtw_memset(pwlanhdr->addr1, 0, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); ++ ++ /* Use the device address for BSSID field. */ ++ _rtw_memcpy(pwlanhdr->addr3, mac, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, 0); ++ SetFrameSubType(fctrl, WIFI_PROBERSP); ++ ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ pframe += pktlen; ++ ++ ++ /* timestamp will be inserted by hardware */ ++ pframe += 8; ++ pktlen += 8; ++ ++ /* beacon interval: 2 bytes */ ++ _rtw_memcpy(pframe, (unsigned char *) &beacon_interval, 2); ++ pframe += 2; ++ pktlen += 2; ++ ++ /* capability info: 2 bytes */ ++ /* ESS and IBSS bits must be 0 (defined in the 3.1.2.1.1 of WiFi Direct Spec) */ ++ capInfo |= cap_ShortPremble; ++ capInfo |= cap_ShortSlot; ++ ++ _rtw_memcpy(pframe, (unsigned char *) &capInfo, 2); ++ pframe += 2; ++ pktlen += 2; ++ ++ ++ /* SSID */ ++ pframe = rtw_set_ie(pframe, _SSID_IE_, 7, pwdinfo->p2p_wildcard_ssid, &pktlen); ++ ++ /* supported rates... */ ++ /* Use the OFDM rate in the P2P probe response frame. ( 6(B), 9(B), 12, 18, 24, 36, 48, 54 ) */ ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pwdinfo->support_rate, &pktlen); ++ ++ /* DS parameter set */ ++ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&pwdinfo->listen_channel, &pktlen); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (pwdinfo->driver_interface == DRIVER_CFG80211) { ++ if (pmlmepriv->wps_probe_resp_ie != NULL && pmlmepriv->p2p_probe_resp_ie != NULL) { ++ /* WPS IE */ ++ _rtw_memcpy(pframe, pmlmepriv->wps_probe_resp_ie, pmlmepriv->wps_probe_resp_ie_len); ++ pktlen += pmlmepriv->wps_probe_resp_ie_len; ++ pframe += pmlmepriv->wps_probe_resp_ie_len; ++ ++ /* P2P IE */ ++ _rtw_memcpy(pframe, pmlmepriv->p2p_probe_resp_ie, pmlmepriv->p2p_probe_resp_ie_len); ++ pktlen += pmlmepriv->p2p_probe_resp_ie_len; ++ pframe += pmlmepriv->p2p_probe_resp_ie_len; ++ } ++ } else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ { ++ ++ /* Todo: WPS IE */ ++ /* Noted by Albert 20100907 */ ++ /* According to the WPS specification, all the WPS attribute is presented by Big Endian. */ ++ ++ wpsielen = 0; ++ /* WPS OUI */ ++ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); ++ wpsielen += 4; ++ ++ /* WPS version */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ ++ ++#ifdef CONFIG_INTEL_WIDI ++ /* Commented by Kurt */ ++ /* Appended WiDi info. only if we did issued_probereq_widi(), and then we saved ven. ext. in pmlmepriv->sa_ext. */ ++ if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE ++ || pmlmepriv->num_p2p_sdt != 0) { ++ /* Sec dev type */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SEC_DEV_TYPE_LIST); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0008); ++ wpsielen += 2; ++ ++ /* Value: */ ++ /* Category ID */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_CID_DISPLAYS); ++ wpsielen += 2; ++ ++ /* OUI */ ++ *(u32 *)(wpsie + wpsielen) = cpu_to_be32(INTEL_DEV_TYPE_OUI); ++ wpsielen += 4; ++ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_SCID_WIDI_CONSUMER_SINK); ++ wpsielen += 2; ++ ++ if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE) { ++ /* Vendor Extension */ ++ _rtw_memcpy(wpsie + wpsielen, pmlmepriv->sa_ext, L2SDTA_SERVICE_VE_LEN); ++ wpsielen += L2SDTA_SERVICE_VE_LEN; ++ } ++ } ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ /* WiFi Simple Config State */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SIMPLE_CONF_STATE); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_WSC_STATE_NOT_CONFIG; /* Not Configured. */ ++ ++ /* Response Type */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_RESP_TYPE); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_RESPONSE_TYPE_8021X; ++ ++ /* UUID-E */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_UUID_E); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0010); ++ wpsielen += 2; ++ ++ /* Value: */ ++ if (pwdinfo->external_uuid == 0) { ++ _rtw_memset(wpsie + wpsielen, 0x0, 16); ++ _rtw_memcpy(wpsie + wpsielen, mac, ETH_ALEN); ++ } else ++ _rtw_memcpy(wpsie + wpsielen, pwdinfo->uuid, 0x10); ++ wpsielen += 0x10; ++ ++ /* Manufacturer */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_MANUFACTURER); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0007); ++ wpsielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(wpsie + wpsielen, "Realtek", 7); ++ wpsielen += 7; ++ ++ /* Model Name */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_MODEL_NAME); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0006); ++ wpsielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(wpsie + wpsielen, "8192CU", 6); ++ wpsielen += 6; ++ ++ /* Model Number */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_MODEL_NUMBER); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = 0x31; /* character 1 */ ++ ++ /* Serial Number */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SERIAL_NUMBER); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(ETH_ALEN); ++ wpsielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(wpsie + wpsielen, "123456" , ETH_ALEN); ++ wpsielen += ETH_ALEN; ++ ++ /* Primary Device Type */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_PRIMARY_DEV_TYPE); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0008); ++ wpsielen += 2; ++ ++ /* Value: */ ++ /* Category ID */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); ++ wpsielen += 2; ++ ++ /* OUI */ ++ *(u32 *)(wpsie + wpsielen) = cpu_to_be32(WPSOUI); ++ wpsielen += 4; ++ ++ /* Sub Category ID */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); ++ wpsielen += 2; ++ ++ /* Device Name */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->device_name_len); ++ wpsielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(wpsie + wpsielen, pwdinfo->device_name, pwdinfo->device_name_len); ++ wpsielen += pwdinfo->device_name_len; ++ ++ /* Config Method */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_CONF_METHOD); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); ++ wpsielen += 2; ++ ++ /* Value: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->supported_wps_cm); ++ wpsielen += 2; ++ ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pktlen); ++ ++ ++ p2pielen = build_probe_resp_p2p_ie(pwdinfo, pframe); ++ pframe += p2pielen; ++ pktlen += p2pielen; ++ } ++ ++#ifdef CONFIG_WFD ++ wfdielen = rtw_append_probe_resp_wfd_ie(padapter, pframe); ++ pframe += wfdielen; ++ pktlen += wfdielen; ++#endif ++ ++ *pLength = pktlen; ++ ++#if 0 ++ /* printf dbg msg */ ++ dbgbufLen = pktlen; ++ RTW_INFO("======> DBG MSG FOR CONSTRAUCT P2P Probe Rsp\n"); ++ ++ for (index = 0; index < dbgbufLen; index++) ++ printk("%x ", *(dbgbuf + index)); ++ ++ printk("\n"); ++ RTW_INFO("<====== DBG MSG FOR CONSTRAUCT P2P Probe Rsp\n"); ++#endif ++} ++static void rtw_hal_construct_P2PNegoRsp(_adapter *padapter, u8 *pframe, u32 *pLength) ++{ ++ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = P2P_PUB_ACTION_ACTION; ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_GO_NEGO_RESP; ++ u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; ++ u8 p2pielen = 0, i; ++ uint wpsielen = 0; ++ u16 wps_devicepassword_id = 0x0000; ++ uint wps_devicepassword_id_len = 0; ++ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh; ++ u16 len_channellist_attr = 0; ++ u32 pktlen; ++ u8 dialogToken = 0; ++ ++ /* struct xmit_frame *pmgntframe; */ ++ /* struct pkt_attrib *pattrib; */ ++ /* unsigned char *pframe; */ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ /* WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); */ ++ ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++ ++ /* for debug */ ++ u8 *dbgbuf = pframe; ++ u8 dbgbufLen = 0, index = 0; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ /* RA, filled by FW */ ++ _rtw_memset(pwlanhdr->addr1, 0, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, 0); ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ pframe += pktlen; ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pktlen)); ++ ++ /* dialog token, filled by FW */ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pktlen)); ++ ++ _rtw_memset(wpsie, 0x00, 255); ++ wpsielen = 0; ++ ++ /* WPS Section */ ++ wpsielen = 0; ++ /* WPS OUI */ ++ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); ++ wpsielen += 4; ++ ++ /* WPS version */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ ++ ++ /* Device Password ID */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_PWID); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); ++ wpsielen += 2; ++ ++ /* Value: */ ++ if (wps_devicepassword_id == WPS_DPID_USER_SPEC) ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_REGISTRAR_SPEC); ++ else if (wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC) ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_USER_SPEC); ++ else ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_PBC); ++ wpsielen += 2; ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pktlen); ++ ++ ++ /* P2P IE Section. */ ++ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* Commented by Albert 20100908 */ ++ /* According to the P2P Specification, the group negoitation response frame should contain 9 P2P attributes */ ++ /* 1. Status */ ++ /* 2. P2P Capability */ ++ /* 3. Group Owner Intent */ ++ /* 4. Configuration Timeout */ ++ /* 5. Operating Channel */ ++ /* 6. Intended P2P Interface Address */ ++ /* 7. Channel List */ ++ /* 8. Device Info */ ++ /* 9. Group ID ( Only GO ) */ ++ ++ ++ /* ToDo: */ ++ ++ /* P2P Status */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_STATUS; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); ++ p2pielen += 2; ++ ++ /* Value, filled by FW */ ++ p2pie[p2pielen++] = 1; ++ ++ /* P2P Capability */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Device Capability Bitmap, 1 byte */ ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) { ++ /* Commented by Albert 2011/03/08 */ ++ /* According to the P2P specification */ ++ /* if the sending device will be client, the P2P Capability should be reserved of group negotation response frame */ ++ p2pie[p2pielen++] = 0; ++ } else { ++ /* Be group owner or meet the error case */ ++ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; ++ } ++ ++ /* Group Capability Bitmap, 1 byte */ ++ if (pwdinfo->persistent_supported) ++ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN | P2P_GRPCAP_PERSISTENT_GROUP; ++ else ++ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN; ++ ++ /* Group Owner Intent */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_GO_INTENT; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); ++ p2pielen += 2; ++ ++ /* Value: */ ++ if (pwdinfo->peer_intent & 0x01) { ++ /* Peer's tie breaker bit is 1, our tie breaker bit should be 0 */ ++ p2pie[p2pielen++] = (pwdinfo->intent << 1); ++ } else { ++ /* Peer's tie breaker bit is 0, our tie breaker bit should be 1 */ ++ p2pie[p2pielen++] = ((pwdinfo->intent << 1) | BIT(0)); ++ } ++ ++ ++ /* Configuration Timeout */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CONF_TIMEOUT; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P GO */ ++ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P Client */ ++ ++ /* Operating Channel */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Operating Class */ ++ if (pwdinfo->operating_channel <= 14) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x51; ++ } else if ((pwdinfo->operating_channel >= 36) && (pwdinfo->operating_channel <= 48)) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x73; ++ } else { ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x7c; ++ } ++ ++ /* Channel Number */ ++ p2pie[p2pielen++] = pwdinfo->operating_channel; /* operating channel number */ ++ ++ /* Intended P2P Interface Address */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_INTENDED_IF_ADDR; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN); ++ p2pielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ /* Channel List */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; ++ ++ /* Country String(3) */ ++ /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ ++ /* + number of channels in all classes */ ++ len_channellist_attr = 3 ++ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes ++ + get_reg_classes_full_count(pmlmeext->channel_list); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_buddy_check_fwstate(padapter, _FW_LINKED)) ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(5 + 1); ++ else ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); ++ ++#else ++ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); ++ ++#endif ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Channel Entry List */ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) { ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ ++ /* Operating Class */ ++ if (union_ch > 14) { ++ if (union_ch >= 149) ++ p2pie[p2pielen++] = 0x7c; ++ else ++ p2pie[p2pielen++] = 0x73; ++ } else ++ p2pie[p2pielen++] = 0x51; ++ ++ ++ /* Number of Channels */ ++ /* Just support 1 channel and this channel is AP's channel */ ++ p2pie[p2pielen++] = 1; ++ ++ /* Channel List */ ++ p2pie[p2pielen++] = union_ch; ++ } else { ++ int i, j; ++ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; ++ ++ /* Number of Channels */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; ++ ++ /* Channel List */ ++ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; ++ } ++ } ++#else /* CONFIG_CONCURRENT_MODE */ ++ { ++ int i, j; ++ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; ++ ++ /* Number of Channels */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; ++ ++ /* Channel List */ ++ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; ++ } ++ } ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ ++ /* Device Info */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ ++ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(21 + pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* P2P Device Address */ ++ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ /* Config Method */ ++ /* This field should be big endian. Noted by P2P specification. */ ++ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->supported_wps_cm); ++ ++ p2pielen += 2; ++ ++ /* Primary Device Type */ ++ /* Category ID */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); ++ p2pielen += 2; ++ ++ /* OUI */ ++ *(u32 *)(p2pie + p2pielen) = cpu_to_be32(WPSOUI); ++ p2pielen += 4; ++ ++ /* Sub Category ID */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); ++ p2pielen += 2; ++ ++ /* Number of Secondary Device Types */ ++ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ ++ ++ /* Device Name */ ++ /* Type: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); ++ p2pielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->device_name_len); ++ p2pielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name , pwdinfo->device_name_len); ++ p2pielen += pwdinfo->device_name_len; ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ /* Group ID Attribute */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_GROUP_ID; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN + pwdinfo->nego_ssidlen); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* p2P Device Address */ ++ _rtw_memcpy(p2pie + p2pielen , pwdinfo->device_addr, ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ /* SSID */ ++ _rtw_memcpy(p2pie + p2pielen, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen); ++ p2pielen += pwdinfo->nego_ssidlen; ++ ++ } ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pktlen); ++ ++#ifdef CONFIG_WFD ++ wfdielen = build_nego_resp_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pktlen += wfdielen; ++#endif ++ ++ *pLength = pktlen; ++#if 0 ++ /* printf dbg msg */ ++ dbgbufLen = pktlen; ++ RTW_INFO("======> DBG MSG FOR CONSTRAUCT Nego Rsp\n"); ++ ++ for (index = 0; index < dbgbufLen; index++) ++ printk("%x ", *(dbgbuf + index)); ++ ++ printk("\n"); ++ RTW_INFO("<====== DBG MSG FOR CONSTRAUCT Nego Rsp\n"); ++#endif ++} ++ ++static void rtw_hal_construct_P2PInviteRsp(_adapter *padapter, u8 *pframe, u32 *pLength) ++{ ++ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = P2P_PUB_ACTION_ACTION; ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_INVIT_RESP; ++ u8 p2pie[255] = { 0x00 }; ++ u8 p2pielen = 0, i; ++ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; ++ u16 len_channellist_attr = 0; ++ u32 pktlen; ++ u8 dialogToken = 0; ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++ ++ /* struct xmit_frame *pmgntframe; */ ++ /* struct pkt_attrib *pattrib; */ ++ /* unsigned char *pframe; */ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ /* for debug */ ++ u8 *dbgbuf = pframe; ++ u8 dbgbufLen = 0, index = 0; ++ ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ /* RA fill by FW */ ++ _rtw_memset(pwlanhdr->addr1, 0, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ ++ /* BSSID fill by FW */ ++ _rtw_memset(pwlanhdr->addr3, 0, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, 0); ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pktlen)); ++ ++ /* dialog token, filled by FW */ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pktlen)); ++ ++ /* P2P IE Section. */ ++ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2pie[p2pielen++] = 0x50; ++ p2pie[p2pielen++] = 0x6F; ++ p2pie[p2pielen++] = 0x9A; ++ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* Commented by Albert 20101005 */ ++ /* According to the P2P Specification, the P2P Invitation response frame should contain 5 P2P attributes */ ++ /* 1. Status */ ++ /* 2. Configuration Timeout */ ++ /* 3. Operating Channel ( Only GO ) */ ++ /* 4. P2P Group BSSID ( Only GO ) */ ++ /* 5. Channel List */ ++ ++ /* P2P Status */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_STATUS; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); ++ p2pielen += 2; ++ ++ /* Value: filled by FW, defult value is FAIL INFO UNAVAILABLE */ ++ p2pie[p2pielen++] = P2P_STATUS_FAIL_INFO_UNAVAILABLE; ++ ++ /* Configuration Timeout */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CONF_TIMEOUT; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P GO */ ++ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P Client */ ++ ++ /* due to defult value is FAIL INFO UNAVAILABLE, so the following IE is not needed */ ++#if 0 ++ if (status_code == P2P_STATUS_SUCCESS) { ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ /* The P2P Invitation request frame asks this Wi-Fi device to be the P2P GO */ ++ /* In this case, the P2P Invitation response frame should carry the two more P2P attributes. */ ++ /* First one is operating channel attribute. */ ++ /* Second one is P2P Group BSSID attribute. */ ++ ++ /* Operating Channel */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Operating Class */ ++ p2pie[p2pielen++] = 0x51; /* Copy from SD7 */ ++ ++ /* Channel Number */ ++ p2pie[p2pielen++] = pwdinfo->operating_channel; /* operating channel number */ ++ ++ ++ /* P2P Group BSSID */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_GROUP_BSSID; ++ ++ /* Length: */ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* P2P Device Address for GO */ ++ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ p2pielen += ETH_ALEN; ++ ++ } ++ ++ /* Channel List */ ++ /* Type: */ ++ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; ++ ++ /* Length: */ ++ /* Country String(3) */ ++ /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ ++ /* + number of channels in all classes */ ++ len_channellist_attr = 3 ++ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes ++ + get_reg_classes_full_count(pmlmeext->channel_list); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(5 + 1); ++ else ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); ++ ++#else ++ ++ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); ++ ++#endif ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Country String */ ++ p2pie[p2pielen++] = 'X'; ++ p2pie[p2pielen++] = 'X'; ++ ++ /* The third byte should be set to 0x04. */ ++ /* Described in the "Operating Channel Attribute" section. */ ++ p2pie[p2pielen++] = 0x04; ++ ++ /* Channel Entry List */ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) { ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ ++ /* Operating Class */ ++ if (union_ch > 14) { ++ if (union_ch >= 149) ++ p2pie[p2pielen++] = 0x7c; ++ else ++ p2pie[p2pielen++] = 0x73; ++ ++ } else ++ p2pie[p2pielen++] = 0x51; ++ ++ ++ /* Number of Channels */ ++ /* Just support 1 channel and this channel is AP's channel */ ++ p2pie[p2pielen++] = 1; ++ ++ /* Channel List */ ++ p2pie[p2pielen++] = union_ch; ++ } else { ++ int i, j; ++ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; ++ ++ /* Number of Channels */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; ++ ++ /* Channel List */ ++ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; ++ } ++ } ++#else /* CONFIG_CONCURRENT_MODE */ ++ { ++ int i, j; ++ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { ++ /* Operating Class */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; ++ ++ /* Number of Channels */ ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; ++ ++ /* Channel List */ ++ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) ++ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; ++ } ++ } ++#endif /* CONFIG_CONCURRENT_MODE */ ++ } ++#endif ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pktlen); ++ ++#ifdef CONFIG_WFD ++ wfdielen = build_invitation_resp_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pktlen += wfdielen; ++#endif ++ ++ *pLength = pktlen; ++ ++#if 0 ++ /* printf dbg msg */ ++ dbgbufLen = pktlen; ++ RTW_INFO("======> DBG MSG FOR CONSTRAUCT Invite Rsp\n"); ++ ++ for (index = 0; index < dbgbufLen; index++) ++ printk("%x ", *(dbgbuf + index)); ++ ++ printk("\n"); ++ RTW_INFO("<====== DBG MSG FOR CONSTRAUCT Invite Rsp\n"); ++#endif ++} ++ ++ ++static void rtw_hal_construct_P2PProvisionDisRsp(_adapter *padapter, u8 *pframe, u32 *pLength) ++{ ++ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = P2P_PUB_ACTION_ACTION; ++ u8 dialogToken = 0; ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_PROVISION_DISC_RESP; ++ u8 wpsie[100] = { 0x00 }; ++ u8 wpsielen = 0; ++ u32 pktlen; ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++ ++ /* struct xmit_frame *pmgntframe; */ ++ /* struct pkt_attrib *pattrib; */ ++ /* unsigned char *pframe; */ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ /* for debug */ ++ u8 *dbgbuf = pframe; ++ u8 dbgbufLen = 0, index = 0; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ /* RA filled by FW */ ++ _rtw_memset(pwlanhdr->addr1, 0, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, 0); ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pktlen)); ++ /* dialog token, filled by FW */ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pktlen)); ++ ++ wpsielen = 0; ++ /* WPS OUI */ ++ /* *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); */ ++ RTW_PUT_BE32(wpsie, WPSOUI); ++ wpsielen += 4; ++ ++#if 0 ++ /* WPS version */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ ++#endif ++ ++ /* Config Method */ ++ /* Type: */ ++ /* *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); */ ++ RTW_PUT_BE16(wpsie + wpsielen, WPS_ATTR_CONF_METHOD); ++ wpsielen += 2; ++ ++ /* Length: */ ++ /* *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); */ ++ RTW_PUT_BE16(wpsie + wpsielen, 0x0002); ++ wpsielen += 2; ++ ++ /* Value: filled by FW, default value is PBC */ ++ /* *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( config_method ); */ ++ RTW_PUT_BE16(wpsie + wpsielen, WPS_CM_PUSH_BUTTON); ++ wpsielen += 2; ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pktlen); ++ ++#ifdef CONFIG_WFD ++ wfdielen = build_provdisc_resp_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pktlen += wfdielen; ++#endif ++ ++ *pLength = pktlen; ++ ++ /* printf dbg msg */ ++#if 0 ++ dbgbufLen = pktlen; ++ RTW_INFO("======> DBG MSG FOR CONSTRAUCT ProvisionDis Rsp\n"); ++ ++ for (index = 0; index < dbgbufLen; index++) ++ printk("%x ", *(dbgbuf + index)); ++ ++ printk("\n"); ++ RTW_INFO("<====== DBG MSG FOR CONSTRAUCT ProvisionDis Rsp\n"); ++#endif ++} ++ ++u8 rtw_hal_set_FwP2PRsvdPage_cmd(_adapter *adapter, PRSVDPAGE_LOC rsvdpageloc) ++{ ++ u8 u1H2CP2PRsvdPageParm[H2C_P2PRSVDPAGE_LOC_LEN] = {0}; ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ u8 ret = _FAIL; ++ ++ RTW_INFO("P2PRsvdPageLoc: P2PBeacon=%d P2PProbeRsp=%d NegoRsp=%d InviteRsp=%d PDRsp=%d\n", ++ rsvdpageloc->LocP2PBeacon, rsvdpageloc->LocP2PProbeRsp, ++ rsvdpageloc->LocNegoRsp, rsvdpageloc->LocInviteRsp, ++ rsvdpageloc->LocPDRsp); ++ ++ SET_H2CCMD_RSVDPAGE_LOC_P2P_BCN(u1H2CP2PRsvdPageParm, rsvdpageloc->LocProbeRsp); ++ SET_H2CCMD_RSVDPAGE_LOC_P2P_PROBE_RSP(u1H2CP2PRsvdPageParm, rsvdpageloc->LocPsPoll); ++ SET_H2CCMD_RSVDPAGE_LOC_P2P_NEGO_RSP(u1H2CP2PRsvdPageParm, rsvdpageloc->LocNullData); ++ SET_H2CCMD_RSVDPAGE_LOC_P2P_INVITE_RSP(u1H2CP2PRsvdPageParm, rsvdpageloc->LocQosNull); ++ SET_H2CCMD_RSVDPAGE_LOC_P2P_PD_RSP(u1H2CP2PRsvdPageParm, rsvdpageloc->LocBTQosNull); ++ ++ /* FillH2CCmd8723B(padapter, H2C_8723B_P2P_OFFLOAD_RSVD_PAGE, H2C_P2PRSVDPAGE_LOC_LEN, u1H2CP2PRsvdPageParm); */ ++ ret = rtw_hal_fill_h2c_cmd(adapter, ++ H2C_P2P_OFFLOAD_RSVD_PAGE, ++ H2C_P2PRSVDPAGE_LOC_LEN, ++ u1H2CP2PRsvdPageParm); ++ ++ return ret; ++} ++ ++u8 rtw_hal_set_p2p_wowlan_offload_cmd(_adapter *adapter) ++{ ++ ++ u8 offload_cmd[H2C_P2P_OFFLOAD_LEN] = {0}; ++ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); ++ struct P2P_WoWlan_Offload_t *p2p_wowlan_offload = (struct P2P_WoWlan_Offload_t *)offload_cmd; ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ u8 ret = _FAIL; ++ ++ _rtw_memset(p2p_wowlan_offload, 0 , sizeof(struct P2P_WoWlan_Offload_t)); ++ RTW_INFO("%s\n", __func__); ++ switch (pwdinfo->role) { ++ case P2P_ROLE_DEVICE: ++ RTW_INFO("P2P_ROLE_DEVICE\n"); ++ p2p_wowlan_offload->role = 0; ++ break; ++ case P2P_ROLE_CLIENT: ++ RTW_INFO("P2P_ROLE_CLIENT\n"); ++ p2p_wowlan_offload->role = 1; ++ break; ++ case P2P_ROLE_GO: ++ RTW_INFO("P2P_ROLE_GO\n"); ++ p2p_wowlan_offload->role = 2; ++ break; ++ default: ++ RTW_INFO("P2P_ROLE_DISABLE\n"); ++ break; ++ } ++ p2p_wowlan_offload->Wps_Config[0] = pwdinfo->supported_wps_cm >> 8; ++ p2p_wowlan_offload->Wps_Config[1] = pwdinfo->supported_wps_cm; ++ offload_cmd = (u8 *)p2p_wowlan_offload; ++ RTW_INFO("p2p_wowlan_offload: %x:%x:%x\n", offload_cmd[0], offload_cmd[1], offload_cmd[2]); ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, ++ H2C_P2P_OFFLOAD, ++ H2C_P2P_OFFLOAD_LEN, ++ offload_cmd); ++ return ret; ++ ++ /* FillH2CCmd8723B(adapter, H2C_8723B_P2P_OFFLOAD, sizeof(struct P2P_WoWlan_Offload_t), (u8 *)p2p_wowlan_offload); */ ++} ++#endif /* CONFIG_P2P_WOWLAN */ ++ ++static void rtw_hal_construct_beacon(_adapter *padapter, ++ u8 *pframe, u32 *pLength) ++{ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u16 *fctrl; ++ u32 rate_len, pktlen; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); ++ /* pmlmeext->mgnt_seq++; */ ++ SetFrameSubType(pframe, WIFI_BEACON); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ /* timestamp will be inserted by hardware */ ++ pframe += 8; ++ pktlen += 8; ++ ++ /* beacon interval: 2 bytes */ ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); ++ ++ pframe += 2; ++ pktlen += 2; ++ ++ /* capability info: 2 bytes */ ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); ++ ++ pframe += 2; ++ pktlen += 2; ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { ++ /* RTW_INFO("ie len=%d\n", cur_network->IELength); */ ++ pktlen += cur_network->IELength - sizeof(NDIS_802_11_FIXED_IEs); ++ _rtw_memcpy(pframe, cur_network->IEs + sizeof(NDIS_802_11_FIXED_IEs), pktlen); ++ ++ goto _ConstructBeacon; ++ } ++ ++ /* below for ad-hoc mode */ ++ ++ /* SSID */ ++ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pktlen); ++ ++ /* supported rates... */ ++ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pktlen); ++ ++ /* DS parameter set */ ++ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pktlen); ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { ++ u32 ATIMWindow; ++ /* IBSS Parameter Set... */ ++ /* ATIMWindow = cur->Configuration.ATIMWindow; */ ++ ATIMWindow = 0; ++ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pktlen); ++ } ++ ++ ++ /* todo: ERP IE */ ++ ++ ++ /* EXTERNDED SUPPORTED RATE */ ++ if (rate_len > 8) ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen); ++ ++ ++ /* todo:HT for adhoc */ ++ ++_ConstructBeacon: ++ ++ if ((pktlen + TXDESC_SIZE) > 512) { ++ RTW_INFO("beacon frame too large\n"); ++ return; ++ } ++ ++ *pLength = pktlen; ++ ++ /* RTW_INFO("%s bcn_sz=%d\n", __FUNCTION__, pktlen); */ ++ ++} ++ ++static void rtw_hal_construct_PSPoll(_adapter *padapter, ++ u8 *pframe, u32 *pLength) ++{ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u16 *fctrl; ++ u32 pktlen; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ /* Frame control. */ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ SetPwrMgt(fctrl); ++ SetFrameSubType(pframe, WIFI_PSPOLL); ++ ++ /* AID. */ ++ SetDuration(pframe, (pmlmeinfo->aid | 0xc000)); ++ ++ /* BSSID. */ ++ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ /* TA. */ ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ ++ *pLength = 16; ++} ++ ++void rtw_hal_construct_NullFunctionData( ++ PADAPTER padapter, ++ u8 *pframe, ++ u32 *pLength, ++ u8 *StaAddr, ++ u8 bQoS, ++ u8 AC, ++ u8 bEosp, ++ u8 bForcePowerSave) ++{ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u16 *fctrl; ++ u32 pktlen; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wlan_network *cur_network = &pmlmepriv->cur_network; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ ++ /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &pwlanhdr->frame_ctl; ++ *(fctrl) = 0; ++ if (bForcePowerSave) ++ SetPwrMgt(fctrl); ++ ++ switch (cur_network->network.InfrastructureMode) { ++ case Ndis802_11Infrastructure: ++ SetToDs(fctrl); ++ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, StaAddr, ETH_ALEN); ++ break; ++ case Ndis802_11APMode: ++ SetFrDs(fctrl); ++ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ break; ++ case Ndis802_11IBSS: ++ default: ++ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ break; ++ } ++ ++ SetSeqNum(pwlanhdr, 0); ++ ++ if (bQoS == _TRUE) { ++ struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; ++ ++ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); ++ ++ pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos *)pframe; ++ SetPriority(&pwlanqoshdr->qc, AC); ++ SetEOSP(&pwlanqoshdr->qc, bEosp); ++ ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); ++ } else { ++ SetFrameSubType(pframe, WIFI_DATA_NULL); ++ ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ } ++ ++ *pLength = pktlen; ++} ++ ++void rtw_hal_construct_ProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength, ++ u8 *StaAddr, BOOLEAN bHideSSID) ++{ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u16 *fctrl; ++ u8 *mac, *bssid; ++ u32 pktlen; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ ++ /*RTW_INFO("%s\n", __FUNCTION__);*/ ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ mac = adapter_mac_addr(padapter); ++ bssid = cur_network->MacAddress; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, bssid, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, 0); ++ SetFrameSubType(fctrl, WIFI_PROBERSP); ++ ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ pframe += pktlen; ++ ++ if (cur_network->IELength > MAX_IE_SZ) ++ return; ++ ++ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); ++ pframe += cur_network->IELength; ++ pktlen += cur_network->IELength; ++ ++ *pLength = pktlen; ++} ++ ++#ifdef CONFIG_WOWLAN ++/* ++ * Description: ++ * Construct the ARP response packet to support ARP offload. ++ * */ ++static void rtw_hal_construct_ARPRsp( ++ PADAPTER padapter, ++ u8 *pframe, ++ u32 *pLength, ++ u8 *pIPAddress ++) ++{ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u16 *fctrl; ++ u32 pktlen; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wlan_network *cur_network = &pmlmepriv->cur_network; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ static u8 ARPLLCHeader[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x08, 0x06}; ++ u8 *pARPRspPkt = pframe; ++ /* for TKIP Cal MIC */ ++ u8 *payload = pframe; ++ u8 EncryptionHeadOverhead = 0; ++ /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &pwlanhdr->frame_ctl; ++ *(fctrl) = 0; ++ ++ /* ------------------------------------------------------------------------- */ ++ /* MAC Header. */ ++ /* ------------------------------------------------------------------------- */ ++ SetFrameType(fctrl, WIFI_DATA); ++ /* SetFrameSubType(fctrl, 0); */ ++ SetToDs(fctrl); ++ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, 0); ++ SetDuration(pwlanhdr, 0); ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ *pLength = sMacHdrLng; ++#else ++ *pLength = 24; ++#endif ++ switch (psecuritypriv->dot11PrivacyAlgrthm) { ++ case _WEP40_: ++ case _WEP104_: ++ EncryptionHeadOverhead = 4; ++ break; ++ case _TKIP_: ++ EncryptionHeadOverhead = 8; ++ break; ++ case _AES_: ++ EncryptionHeadOverhead = 8; ++ break; ++#ifdef CONFIG_WAPI_SUPPORT ++ case _SMS4_: ++ EncryptionHeadOverhead = 18; ++ break; ++#endif ++ default: ++ EncryptionHeadOverhead = 0; ++ } ++ ++ if (EncryptionHeadOverhead > 0) { ++ _rtw_memset(&(pframe[*pLength]), 0, EncryptionHeadOverhead); ++ *pLength += EncryptionHeadOverhead; ++ /* SET_80211_HDR_WEP(pARPRspPkt, 1); */ /* Suggested by CCW. */ ++ SetPrivacy(fctrl); ++ } ++ ++ /* ------------------------------------------------------------------------- */ ++ /* Frame Body. */ ++ /* ------------------------------------------------------------------------- */ ++ pARPRspPkt = (u8 *)(pframe + *pLength); ++ payload = pARPRspPkt; /* Get Payload pointer */ ++ /* LLC header */ ++ _rtw_memcpy(pARPRspPkt, ARPLLCHeader, 8); ++ *pLength += 8; ++ ++ /* ARP element */ ++ pARPRspPkt += 8; ++ SET_ARP_PKT_HW(pARPRspPkt, 0x0100); ++ SET_ARP_PKT_PROTOCOL(pARPRspPkt, 0x0008); /* IP protocol */ ++ SET_ARP_PKT_HW_ADDR_LEN(pARPRspPkt, 6); ++ SET_ARP_PKT_PROTOCOL_ADDR_LEN(pARPRspPkt, 4); ++ SET_ARP_PKT_OPERATION(pARPRspPkt, 0x0200); /* ARP response */ ++ SET_ARP_PKT_SENDER_MAC_ADDR(pARPRspPkt, adapter_mac_addr(padapter)); ++ SET_ARP_PKT_SENDER_IP_ADDR(pARPRspPkt, pIPAddress); ++#ifdef CONFIG_ARP_KEEP_ALIVE ++ if (!is_zero_mac_addr(pmlmepriv->gw_mac_addr)) { ++ SET_ARP_PKT_TARGET_MAC_ADDR(pARPRspPkt, pmlmepriv->gw_mac_addr); ++ SET_ARP_PKT_TARGET_IP_ADDR(pARPRspPkt, pmlmepriv->gw_ip); ++ } else ++#endif ++ { ++ SET_ARP_PKT_TARGET_MAC_ADDR(pARPRspPkt, ++ get_my_bssid(&(pmlmeinfo->network))); ++ SET_ARP_PKT_TARGET_IP_ADDR(pARPRspPkt, ++ pIPAddress); ++ RTW_INFO("%s Target Mac Addr:" MAC_FMT "\n", __FUNCTION__, ++ MAC_ARG(get_my_bssid(&(pmlmeinfo->network)))); ++ RTW_INFO("%s Target IP Addr" IP_FMT "\n", __FUNCTION__, ++ IP_ARG(pIPAddress)); ++ } ++ ++ *pLength += 28; ++ ++ if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) ++ *pLength += 8; ++} ++ ++#ifdef CONFIG_PNO_SUPPORT ++static void rtw_hal_construct_ProbeReq(_adapter *padapter, u8 *pframe, ++ u32 *pLength, pno_ssid_t *ssid) ++{ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u16 *fctrl; ++ u32 pktlen; ++ unsigned char *mac; ++ unsigned char bssrate[NumRates]; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ int bssrate_len = 0; ++ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ mac = adapter_mac_addr(padapter); ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, bc_addr, ETH_ALEN); ++ ++ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, 0); ++ SetFrameSubType(pframe, WIFI_PROBEREQ); ++ ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ pframe += pktlen; ++ ++ if (ssid == NULL) ++ pframe = rtw_set_ie(pframe, _SSID_IE_, 0, NULL, &pktlen); ++ else { ++ /* RTW_INFO("%s len:%d\n", ssid->SSID, ssid->SSID_len); */ ++ pframe = rtw_set_ie(pframe, _SSID_IE_, ssid->SSID_len, ssid->SSID, &pktlen); ++ } ++ ++ get_rate_set(padapter, bssrate, &bssrate_len); ++ ++ if (bssrate_len > 8) { ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &pktlen); ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &pktlen); ++ } else ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &pktlen); ++ ++ *pLength = pktlen; ++} ++ ++static void rtw_hal_construct_PNO_info(_adapter *padapter, ++ u8 *pframe, u32 *pLength) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ int i; ++ ++ u8 *pPnoInfoPkt = pframe; ++ pPnoInfoPkt = (u8 *)(pframe + *pLength); ++ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_num, 1); ++ ++ pPnoInfoPkt += 1; ++ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->hidden_ssid_num, 1); ++ ++ pPnoInfoPkt += 3; ++ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->fast_scan_period, 1); ++ ++ pPnoInfoPkt += 4; ++ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->fast_scan_iterations, 4); ++ ++ pPnoInfoPkt += 4; ++ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->slow_scan_period, 4); ++ ++ pPnoInfoPkt += 4; ++ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_length, MAX_PNO_LIST_COUNT); ++ ++ pPnoInfoPkt += MAX_PNO_LIST_COUNT; ++ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_cipher_info, MAX_PNO_LIST_COUNT); ++ ++ pPnoInfoPkt += MAX_PNO_LIST_COUNT; ++ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_channel_info, MAX_PNO_LIST_COUNT); ++ ++ pPnoInfoPkt += MAX_PNO_LIST_COUNT; ++ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->loc_probe_req, MAX_HIDDEN_AP); ++ ++ pPnoInfoPkt += MAX_HIDDEN_AP; ++ ++ /* ++ SSID is located at 128th Byte in NLO info Page ++ */ ++ ++ *pLength += 128; ++ pPnoInfoPkt = pframe + 128; ++ ++ for (i = 0; i < pwrctl->pnlo_info->ssid_num ; i++) { ++ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pno_ssid_list->node[i].SSID, ++ pwrctl->pnlo_info->ssid_length[i]); ++ *pLength += WLAN_SSID_MAXLEN; ++ pPnoInfoPkt += WLAN_SSID_MAXLEN; ++ } ++} ++ ++static void rtw_hal_construct_ssid_list(_adapter *padapter, ++ u8 *pframe, u32 *pLength) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ u8 *pSSIDListPkt = pframe; ++ int i; ++ ++ pSSIDListPkt = (u8 *)(pframe + *pLength); ++ ++ for (i = 0; i < pwrctl->pnlo_info->ssid_num ; i++) { ++ _rtw_memcpy(pSSIDListPkt, &pwrctl->pno_ssid_list->node[i].SSID, ++ pwrctl->pnlo_info->ssid_length[i]); ++ ++ *pLength += WLAN_SSID_MAXLEN; ++ pSSIDListPkt += WLAN_SSID_MAXLEN; ++ } ++} ++ ++static void rtw_hal_construct_scan_info(_adapter *padapter, ++ u8 *pframe, u32 *pLength) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ u8 *pScanInfoPkt = pframe; ++ int i; ++ ++ pScanInfoPkt = (u8 *)(pframe + *pLength); ++ ++ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->channel_num, 1); ++ ++ *pLength += 1; ++ pScanInfoPkt += 1; ++ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_ch, 1); ++ ++ ++ *pLength += 1; ++ pScanInfoPkt += 1; ++ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_bw, 1); ++ ++ ++ *pLength += 1; ++ pScanInfoPkt += 1; ++ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_40_offset, 1); ++ ++ *pLength += 1; ++ pScanInfoPkt += 1; ++ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_80_offset, 1); ++ ++ *pLength += 1; ++ pScanInfoPkt += 1; ++ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->periodScan, 1); ++ ++ *pLength += 1; ++ pScanInfoPkt += 1; ++ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->period_scan_time, 1); ++ ++ *pLength += 1; ++ pScanInfoPkt += 1; ++ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->enableRFE, 1); ++ ++ *pLength += 1; ++ pScanInfoPkt += 1; ++ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->rfe_type, 8); ++ ++ *pLength += 8; ++ pScanInfoPkt += 8; ++ ++ for (i = 0 ; i < MAX_SCAN_LIST_COUNT ; i++) { ++ _rtw_memcpy(pScanInfoPkt, ++ &pwrctl->pscan_info->ssid_channel_info[i], 4); ++ *pLength += 4; ++ pScanInfoPkt += 4; ++ } ++} ++#endif /* CONFIG_PNO_SUPPORT */ ++ ++#ifdef CONFIG_GTK_OL ++static void rtw_hal_construct_GTKRsp( ++ PADAPTER padapter, ++ u8 *pframe, ++ u32 *pLength ++) ++{ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u16 *fctrl; ++ u32 pktlen; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wlan_network *cur_network = &pmlmepriv->cur_network; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ static u8 LLCHeader[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x88, 0x8E}; ++ static u8 GTKbody_a[11] = {0x01, 0x03, 0x00, 0x5F, 0x02, 0x03, 0x12, 0x00, 0x10, 0x42, 0x0B}; ++ u8 mic[RTW_TKIP_MIC_LEN] = {0}; ++ u8 *pGTKRspPkt = pframe; ++ u8 EncryptionHeadOverhead = 0; ++ /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &pwlanhdr->frame_ctl; ++ *(fctrl) = 0; ++ ++ /* ------------------------------------------------------------------------- */ ++ /* MAC Header. */ ++ /* ------------------------------------------------------------------------- */ ++ SetFrameType(fctrl, WIFI_DATA); ++ /* SetFrameSubType(fctrl, 0); */ ++ SetToDs(fctrl); ++ ++ _rtw_memcpy(pwlanhdr->addr1, ++ get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ _rtw_memcpy(pwlanhdr->addr2, ++ adapter_mac_addr(padapter), ETH_ALEN); ++ ++ _rtw_memcpy(pwlanhdr->addr3, ++ get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, 0); ++ SetDuration(pwlanhdr, 0); ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ *pLength = sMacHdrLng; ++#else ++ *pLength = 24; ++#endif /* CONFIG_WAPI_SUPPORT */ ++ ++ /* ------------------------------------------------------------------------- */ ++ /* Security Header: leave space for it if necessary. */ ++ /* ------------------------------------------------------------------------- */ ++ switch (psecuritypriv->dot11PrivacyAlgrthm) { ++ case _WEP40_: ++ case _WEP104_: ++ EncryptionHeadOverhead = 4; ++ break; ++ case _TKIP_: ++ EncryptionHeadOverhead = 8; ++ break; ++ case _AES_: ++ EncryptionHeadOverhead = 8; ++ break; ++#ifdef CONFIG_WAPI_SUPPORT ++ case _SMS4_: ++ EncryptionHeadOverhead = 18; ++ break; ++#endif /* CONFIG_WAPI_SUPPORT */ ++ default: ++ EncryptionHeadOverhead = 0; ++ } ++ ++ if (EncryptionHeadOverhead > 0) { ++ _rtw_memset(&(pframe[*pLength]), 0, EncryptionHeadOverhead); ++ *pLength += EncryptionHeadOverhead; ++ /* SET_80211_HDR_WEP(pGTKRspPkt, 1); */ /* Suggested by CCW. */ ++ /* GTK's privacy bit is done by FW */ ++ /* SetPrivacy(fctrl); */ ++ } ++ /* ------------------------------------------------------------------------- */ ++ /* Frame Body. */ ++ /* ------------------------------------------------------------------------- */ ++ pGTKRspPkt = (u8 *)(pframe + *pLength); ++ /* LLC header */ ++ _rtw_memcpy(pGTKRspPkt, LLCHeader, 8); ++ *pLength += 8; ++ ++ /* GTK element */ ++ pGTKRspPkt += 8; ++ ++ /* GTK frame body after LLC, part 1 */ ++ /* TKIP key_length = 32, AES key_length = 16 */ ++ if (psecuritypriv->dot118021XGrpPrivacy == _TKIP_) ++ GTKbody_a[8] = 0x20; ++ ++ _rtw_memcpy(pGTKRspPkt, GTKbody_a, 11); ++ *pLength += 11; ++ pGTKRspPkt += 11; ++ /* GTK frame body after LLC, part 2 */ ++ _rtw_memset(&(pframe[*pLength]), 0, 88); ++ *pLength += 88; ++ pGTKRspPkt += 88; ++ ++ if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) ++ *pLength += 8; ++ ++} ++#endif /* CONFIG_GTK_OL */ ++ ++void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, ++ u8 tx_desc, u32 page_size, u8 *page_num, u32 *total_pkt_len, ++ RSVDPAGE_LOC *rsvd_page_loc) ++{ ++ struct security_priv *psecuritypriv = &adapter->securitypriv; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); ++ struct mlme_ext_priv *pmlmeext; ++ struct mlme_ext_info *pmlmeinfo; ++ u32 ARPLength = 0, GTKLength = 0, PNOLength = 0, ScanInfoLength = 0; ++ u32 SSIDLegnth = 0, ProbeReqLength = 0; ++ u8 CurtPktPageNum = 0; ++ u8 currentip[4]; ++ u8 cur_dot11txpn[8]; ++ ++#ifdef CONFIG_GTK_OL ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct sta_info *psta; ++ u8 kek[RTW_KEK_LEN]; ++ u8 kck[RTW_KCK_LEN]; ++ u32 gtk_index = 0; ++#endif /* CONFIG_GTK_OL */ ++#ifdef CONFIG_PNO_SUPPORT ++ int pno_index; ++ u8 ssid_num; ++#endif /* CONFIG_PNO_SUPPORT */ ++ ++ pmlmeext = &adapter->mlmeextpriv; ++ pmlmeinfo = &pmlmeext->mlmext_info; ++ ++ if (pwrctl->wowlan_pno_enable == _FALSE) { ++ /* ARP RSP * 1 page */ ++ rtw_get_current_ip_address(adapter, currentip); ++ ++ rsvd_page_loc->LocArpRsp = *page_num; ++ ++ RTW_INFO("LocArpRsp: %d\n", rsvd_page_loc->LocArpRsp); ++ ++ rtw_hal_construct_ARPRsp(adapter, &pframe[index], ++ &ARPLength, currentip); ++ ++ rtw_hal_fill_fake_txdesc(adapter, ++ &pframe[index - tx_desc], ++ ARPLength, _FALSE, _FALSE, _TRUE); ++ ++ CurtPktPageNum = (u8)PageNum(tx_desc + ARPLength, page_size); ++ ++ *page_num += CurtPktPageNum; ++ ++ index += (CurtPktPageNum * page_size); ++ ++ /* 3 SEC IV * 1 page */ ++ rtw_get_sec_iv(adapter, cur_dot11txpn, ++ get_my_bssid(&pmlmeinfo->network)); ++ ++ rsvd_page_loc->LocRemoteCtrlInfo = *page_num; ++ ++ RTW_INFO("LocRemoteCtrlInfo: %d\n", rsvd_page_loc->LocRemoteCtrlInfo); ++ ++ _rtw_memcpy(pframe + index - tx_desc, cur_dot11txpn, _AES_IV_LEN_); ++ ++ CurtPktPageNum = (u8)PageNum(_AES_IV_LEN_, page_size); ++ ++ *page_num += CurtPktPageNum; ++ ++ *total_pkt_len = index + _AES_IV_LEN_; ++#ifdef CONFIG_GTK_OL ++ index += (CurtPktPageNum * page_size); ++ ++ /* if the ap staion info. exists, get the kek, kck from staion info. */ ++ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); ++ if (psta == NULL) { ++ _rtw_memset(kek, 0, RTW_KEK_LEN); ++ _rtw_memset(kck, 0, RTW_KCK_LEN); ++ RTW_INFO("%s, KEK, KCK download rsvd page all zero\n", ++ __func__); ++ } else { ++ _rtw_memcpy(kek, psta->kek, RTW_KEK_LEN); ++ _rtw_memcpy(kck, psta->kck, RTW_KCK_LEN); ++ } ++ ++ /* 3 KEK, KCK */ ++ rsvd_page_loc->LocGTKInfo = *page_num; ++ ++ gtk_index = psecuritypriv->dot118021XGrpKeyid; ++ GTKLength = 0; ++ ++ RTW_INFO("LocGTKInfo: %d, gtk_index:%d\n", ++ rsvd_page_loc->LocGTKInfo, gtk_index); ++ ++ if (IS_HARDWARE_TYPE_8188E(adapter) || IS_HARDWARE_TYPE_8812(adapter)) { ++ _rtw_memcpy(pframe + index - tx_desc, ++ &psecuritypriv->dot11PrivacyAlgrthm, 1); ++ _rtw_memcpy(pframe + index - tx_desc + 1, ++ &psecuritypriv->dot118021XGrpPrivacy, 1); ++ _rtw_memcpy(pframe + index - tx_desc + 2, ++ kck, RTW_KCK_LEN); ++ _rtw_memcpy(pframe + index - tx_desc + 2 + RTW_KCK_LEN, ++ kek, RTW_KEK_LEN); ++ GTKLength = tx_desc + 2 + RTW_KCK_LEN + RTW_KEK_LEN; ++ } else { ++ _rtw_memcpy(pframe + index - tx_desc, kck, RTW_KCK_LEN); ++ _rtw_memcpy(pframe + index - tx_desc + RTW_KCK_LEN, kek, RTW_KEK_LEN); ++ GTKLength = tx_desc + RTW_KCK_LEN + RTW_KEK_LEN; ++ } ++ ++ if (psta != NULL && ++ psecuritypriv->dot118021XGrpPrivacy == _TKIP_) { ++ _rtw_memcpy(pframe + index - tx_desc + 56, ++ &psta->dot11tkiptxmickey, RTW_TKIP_MIC_LEN); ++ GTKLength += RTW_TKIP_MIC_LEN; ++ } ++ ++ CurtPktPageNum = (u8)PageNum(GTKLength, page_size); ++#if 0 ++ { ++ int i; ++ printk("\ntoFW KCK: "); ++ for (i = 0; i < 16; i++) ++ printk(" %02x ", kck[i]); ++ printk("\ntoFW KEK: "); ++ for (i = 0; i < 16; i++) ++ printk(" %02x ", kek[i]); ++ printk("\n"); ++ } ++ ++ RTW_INFO("%s(): HW_VAR_SET_TX_CMD: KEK KCK %p %d\n", ++ __FUNCTION__, &pframe[index - tx_desc], ++ (tx_desc + RTW_KCK_LEN + RTW_KEK_LEN)); ++#endif ++ GTKLength = 0; ++ *page_num += CurtPktPageNum; ++ ++ index += (CurtPktPageNum * page_size); ++ ++ /* 3 GTK Response */ ++ rsvd_page_loc->LocGTKRsp = *page_num; ++ RTW_INFO("LocGTKRsp: %d\n", rsvd_page_loc->LocGTKRsp); ++ rtw_hal_construct_GTKRsp(adapter, &pframe[index], >KLength); ++ ++ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], ++ GTKLength, _FALSE, _FALSE, _TRUE); ++#if 0 ++ { ++ int gj; ++ printk("123GTK pkt=>\n"); ++ for (gj = 0; gj < GTKLegnth + tx_desc; gj++) { ++ printk(" %02x ", pframe[index - tx_desc + gj]); ++ if ((gj + 1) % 16 == 0) ++ printk("\n"); ++ } ++ printk(" <=end\n"); ++ } ++ ++ RTW_INFO("%s(): HW_VAR_SET_TX_CMD: GTK RSP %p %d\n", ++ __FUNCTION__, &pframe[index - tx_desc], ++ (tx_desc + GTKLegnth)); ++#endif ++ ++ CurtPktPageNum = (u8)PageNum(tx_desc + GTKLength, page_size); ++ ++ *page_num += CurtPktPageNum; ++ ++ index += (CurtPktPageNum * page_size); ++ ++ /* below page is empty for GTK extension memory */ ++ /* 3(11) GTK EXT MEM */ ++ rsvd_page_loc->LocGTKEXTMEM = *page_num; ++ ++ CurtPktPageNum = 2; ++ ++ if (page_size >= 256) ++ CurtPktPageNum = 1; ++ ++ *page_num += CurtPktPageNum; ++ /* extension memory for FW */ ++ index += (CurtPktPageNum * page_size); ++ ++ /*Reserve 1 page for AOAC report*/ ++ rsvd_page_loc->LocAOACReport = *page_num; ++ RTW_INFO("LocAOACReport: %d\n", rsvd_page_loc->LocAOACReport); ++ ++ *page_num += 1; ++ *total_pkt_len = index + (page_size * 1); ++#endif /* CONFIG_GTK_OL */ ++ } else { ++#ifdef CONFIG_PNO_SUPPORT ++ if (pwrctl->wowlan_in_resume == _FALSE && ++ pwrctl->pno_inited == _TRUE) { ++ ++ /* Broadcast Probe Request */ ++ rsvd_page_loc->LocProbePacket = *page_num; ++ ++ RTW_INFO("loc_probe_req: %d\n", ++ rsvd_page_loc->LocProbePacket); ++ ++ rtw_hal_construct_ProbeReq( ++ adapter, ++ &pframe[index], ++ &ProbeReqLength, ++ NULL); ++ ++ rtw_hal_fill_fake_txdesc(adapter, ++ &pframe[index - tx_desc], ++ ProbeReqLength, _FALSE, _FALSE, _FALSE); ++ ++ CurtPktPageNum = ++ (u8)PageNum(tx_desc + ProbeReqLength, page_size); ++ ++ *page_num += CurtPktPageNum; ++ ++ index += (CurtPktPageNum * page_size); ++ ++ /* Hidden SSID Probe Request */ ++ ssid_num = pwrctl->pnlo_info->hidden_ssid_num; ++ ++ for (pno_index = 0 ; pno_index < ssid_num ; pno_index++) { ++ pwrctl->pnlo_info->loc_probe_req[pno_index] = ++ *page_num; ++ ++ rtw_hal_construct_ProbeReq( ++ adapter, ++ &pframe[index], ++ &ProbeReqLength, ++ &pwrctl->pno_ssid_list->node[pno_index]); ++ ++ rtw_hal_fill_fake_txdesc(adapter, ++ &pframe[index - tx_desc], ++ ProbeReqLength, _FALSE, _FALSE, _FALSE); ++ ++ CurtPktPageNum = ++ (u8)PageNum(tx_desc + ProbeReqLength, page_size); ++ ++ *page_num += CurtPktPageNum; ++ ++ index += (CurtPktPageNum * page_size); ++ } ++ ++ /* PNO INFO Page */ ++ rsvd_page_loc->LocPNOInfo = *page_num; ++ RTW_INFO("LocPNOInfo: %d\n", rsvd_page_loc->LocPNOInfo); ++ rtw_hal_construct_PNO_info(adapter, ++ &pframe[index - tx_desc], ++ &PNOLength); ++ ++ CurtPktPageNum = (u8)PageNum(PNOLength, page_size); ++ *page_num += CurtPktPageNum; ++ index += (CurtPktPageNum * page_size); ++ ++ /* Scan Info Page */ ++ rsvd_page_loc->LocScanInfo = *page_num; ++ RTW_INFO("LocScanInfo: %d\n", rsvd_page_loc->LocScanInfo); ++ rtw_hal_construct_scan_info(adapter, ++ &pframe[index - tx_desc], ++ &ScanInfoLength); ++ ++ CurtPktPageNum = (u8)PageNum(ScanInfoLength, page_size); ++ *page_num += CurtPktPageNum; ++ *total_pkt_len = index + ScanInfoLength; ++ index += (CurtPktPageNum * page_size); ++ ++ } ++#endif /* CONFIG_PNO_SUPPORT */ ++ } ++} ++ ++static void rtw_hal_gate_bb(_adapter *adapter, bool stop) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); ++ u8 val8 = 0; ++ u16 val16 = 0; ++ ++ if (stop) { ++ /* Pause TX*/ ++ pwrpriv->wowlan_txpause_status = rtw_read8(adapter, REG_TXPAUSE); ++ rtw_write8(adapter, REG_TXPAUSE, 0xff); ++ val8 = rtw_read8(adapter, REG_SYS_FUNC_EN); ++ val8 &= ~BIT(0); ++ rtw_write8(adapter, REG_SYS_FUNC_EN, val8); ++ RTW_INFO("%s: BB gated: 0x%02x, store TXPAUSE: %02x\n", ++ __func__, ++ rtw_read8(adapter, REG_SYS_FUNC_EN), ++ pwrpriv->wowlan_txpause_status); ++ } else { ++ val8 = rtw_read8(adapter, REG_SYS_FUNC_EN); ++ val8 |= BIT(0); ++ rtw_write8(adapter, REG_SYS_FUNC_EN, val8); ++ RTW_INFO("%s: BB release: 0x%02x, recover TXPAUSE:%02x\n", ++ __func__, rtw_read8(adapter, REG_SYS_FUNC_EN), ++ pwrpriv->wowlan_txpause_status); ++ /* release TX*/ ++ rtw_write8(adapter, REG_TXPAUSE, pwrpriv->wowlan_txpause_status); ++ } ++} ++ ++static void rtw_hal_reset_mac_rx(_adapter *adapter) ++{ ++ u8 val8 = 0; ++ /* Set REG_CR bit1, bit3, bit7 to 0*/ ++ val8 = rtw_read8(adapter, REG_CR); ++ val8 &= 0x75; ++ rtw_write8(adapter, REG_CR, val8); ++ val8 = rtw_read8(adapter, REG_CR); ++ /* Set REG_CR bit1, bit3, bit7 to 1*/ ++ val8 |= 0x8a; ++ rtw_write8(adapter, REG_CR, val8); ++ RTW_INFO("0x%04x: %02x\n", REG_CR, rtw_read8(adapter, REG_CR)); ++} ++ ++static void rtw_hal_set_wow_rxff_boundary(_adapter *adapter, bool wow_mode) ++{ ++ u8 val8 = 0; ++ u16 rxff_bndy = 0; ++ u32 rx_dma_buff_sz = 0; ++ ++ val8 = rtw_read8(adapter, REG_FIFOPAGE + 3); ++ if (val8 != 0) ++ RTW_INFO("%s:[%04x]some PKTs in TXPKTBUF\n", ++ __func__, (REG_FIFOPAGE + 3)); ++ ++ rtw_hal_reset_mac_rx(adapter); ++ ++ if (wow_mode) { ++ rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ_WOW, ++ (u8 *)&rx_dma_buff_sz); ++ rxff_bndy = rx_dma_buff_sz - 1; ++ ++ rtw_write16(adapter, (REG_TRXFF_BNDY + 2), rxff_bndy); ++ RTW_INFO("%s: wow mode, 0x%04x: 0x%04x\n", __func__, ++ REG_TRXFF_BNDY + 2, ++ rtw_read16(adapter, (REG_TRXFF_BNDY + 2))); ++ } else { ++ rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ, ++ (u8 *)&rx_dma_buff_sz); ++ rxff_bndy = rx_dma_buff_sz - 1; ++ rtw_write16(adapter, (REG_TRXFF_BNDY + 2), rxff_bndy); ++ RTW_INFO("%s: normal mode, 0x%04x: 0x%04x\n", __func__, ++ REG_TRXFF_BNDY + 2, ++ rtw_read16(adapter, (REG_TRXFF_BNDY + 2))); ++ } ++} ++ ++static int rtw_hal_set_pattern(_adapter *adapter, u8 *pattern, ++ u8 len, u8 *mask, u8 idx) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); ++ struct mlme_ext_priv *pmlmeext = NULL; ++ struct mlme_ext_info *pmlmeinfo = NULL; ++ struct rtl_wow_pattern wow_pattern; ++ u8 mask_hw[MAX_WKFM_SIZE] = {0}; ++ u8 content[MAX_WKFM_PATTERN_SIZE] = {0}; ++ u8 broadcast_addr[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ u8 multicast_addr1[2] = {0x33, 0x33}; ++ u8 multicast_addr2[3] = {0x01, 0x00, 0x5e}; ++ u8 res = _FALSE, index = 0, mask_len = 0; ++ u8 mac_addr[ETH_ALEN] = {0}; ++ u16 count = 0; ++ int i, j; ++ ++ if (pwrctl->wowlan_pattern_idx > MAX_WKFM_NUM) { ++ RTW_INFO("%s pattern_idx is more than MAX_FMC_NUM: %d\n", ++ __func__, MAX_WKFM_NUM); ++ return _FALSE; ++ } ++ ++ pmlmeext = &adapter->mlmeextpriv; ++ pmlmeinfo = &pmlmeext->mlmext_info; ++ _rtw_memcpy(mac_addr, adapter_mac_addr(adapter), ETH_ALEN); ++ _rtw_memset(&wow_pattern, 0, sizeof(struct rtl_wow_pattern)); ++ ++ mask_len = DIV_ROUND_UP(len, 8); ++ ++ /* 1. setup A1 table */ ++ if (memcmp(pattern, broadcast_addr, ETH_ALEN) == 0) ++ wow_pattern.type = PATTERN_BROADCAST; ++ else if (memcmp(pattern, multicast_addr1, 2) == 0) ++ wow_pattern.type = PATTERN_MULTICAST; ++ else if (memcmp(pattern, multicast_addr2, 3) == 0) ++ wow_pattern.type = PATTERN_MULTICAST; ++ else if (memcmp(pattern, mac_addr, ETH_ALEN) == 0) ++ wow_pattern.type = PATTERN_UNICAST; ++ else ++ wow_pattern.type = PATTERN_INVALID; ++ ++ /* translate mask from os to mask for hw */ ++ ++/****************************************************************************** ++ * pattern from OS uses 'ethenet frame', like this: ++ ++ | 6 | 6 | 2 | 20 | Variable | 4 | ++ |--------+--------+------+-----------+------------+-----| ++ | 802.3 Mac Header | IP Header | TCP Packet | FCS | ++ | DA | SA | Type | ++ ++ * BUT, packet catched by our HW is in '802.11 frame', begin from LLC, ++ ++ | 24 or 30 | 6 | 2 | 20 | Variable | 4 | ++ |-------------------+--------+------+-----------+------------+-----| ++ | 802.11 MAC Header | LLC | IP Header | TCP Packet | FCS | ++ | Others | Tpye | ++ ++ * Therefore, we need translate mask_from_OS to mask_to_hw. ++ * We should left-shift mask by 6 bits, then set the new bit[0~5] = 0, ++ * because new mask[0~5] means 'SA', but our HW packet begins from LLC, ++ * bit[0~5] corresponds to first 6 Bytes in LLC, they just don't match. ++ ******************************************************************************/ ++ /* Shift 6 bits */ ++ for (i = 0; i < mask_len - 1; i++) { ++ mask_hw[i] = mask[i] >> 6; ++ mask_hw[i] |= (mask[i + 1] & 0x3F) << 2; ++ } ++ ++ mask_hw[i] = (mask[i] >> 6) & 0x3F; ++ /* Set bit 0-5 to zero */ ++ mask_hw[0] &= 0xC0; ++ ++ for (i = 0; i < (MAX_WKFM_SIZE / 4); i++) { ++ wow_pattern.mask[i] = mask_hw[i * 4]; ++ wow_pattern.mask[i] |= (mask_hw[i * 4 + 1] << 8); ++ wow_pattern.mask[i] |= (mask_hw[i * 4 + 2] << 16); ++ wow_pattern.mask[i] |= (mask_hw[i * 4 + 3] << 24); ++ } ++ ++ /* To get the wake up pattern from the mask. ++ * We do not count first 12 bits which means ++ * DA[6] and SA[6] in the pattern to match HW design. */ ++ count = 0; ++ for (i = 12; i < len; i++) { ++ if ((mask[i / 8] >> (i % 8)) & 0x01) { ++ content[count] = pattern[i]; ++ count++; ++ } ++ } ++ ++ wow_pattern.crc = rtw_calc_crc(content, count); ++ ++ if (wow_pattern.crc != 0) { ++ if (wow_pattern.type == PATTERN_INVALID) ++ wow_pattern.type = PATTERN_VALID; ++ } ++ ++ index = idx; ++ ++ if (!pwrctl->bInSuspend) ++ index += 2; ++ ++ /* write pattern */ ++ res = rtw_write_to_frame_mask(adapter, index, &wow_pattern); ++ ++ if (res == _FALSE) ++ RTW_INFO("%s: ERROR!! idx: %d write_to_frame_mask_cam fail\n", ++ __func__, idx); ++ ++ return res; ++} ++ ++static void rtw_hal_dl_pattern(_adapter *adapter, u8 mode) ++{ ++ struct registry_priv *pregistrypriv = &adapter->registrypriv; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); ++ int i = 0, total = 0; ++ ++ total = pwrpriv->wowlan_pattern_idx; ++ ++ if (total > MAX_WKFM_NUM) ++ total = MAX_WKFM_NUM; ++ ++ rtw_clean_pattern(adapter); ++ ++ switch (mode) { ++ case 0: ++ RTW_INFO("%s: total patterns: %d\n", __func__, total); ++ break; ++ case 1: ++ rtw_set_default_pattern(adapter); ++ for (i = 0 ; i < total ; i++) { ++ rtw_hal_set_pattern(adapter, ++ pwrpriv->patterns[i].content, ++ pwrpriv->patterns[i].len, ++ pwrpriv->patterns[i].mask, i); ++ } ++ rtw_write8(adapter, REG_WKFMCAM_NUM, total); ++ RTW_INFO("%s: pattern total: %d downloaded\n", ++ __func__, total); ++ break; ++ case 2: ++ pwrpriv->wowlan_pattern_idx = DEFAULT_PATTERN_NUM; ++ ++ for (i = DEFAULT_PATTERN_NUM ; i < MAX_WKFM_NUM ; i++) { ++ _rtw_memset(pwrpriv->patterns[i].content, '\0', ++ sizeof(pwrpriv->patterns[i].content)); ++ _rtw_memset(pwrpriv->patterns[i].mask, '\0', ++ sizeof(pwrpriv->patterns[i].mask)); ++ pwrpriv->patterns[i].len = 0; ++ } ++ RTW_INFO("%s: clean patterns\n", __func__); ++ break; ++ default: ++ RTW_INFO("%s: unknown mode\n", __func__); ++ break; ++ } ++} ++ ++static void rtw_hal_wow_enable(_adapter *adapter) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); ++ struct security_priv *psecuritypriv = &adapter->securitypriv; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ struct sta_info *psta = NULL; ++ int res; ++ u16 media_status_rpt; ++ ++ ++ RTW_PRINT("%s, WOWLAN_ENABLE\n", __func__); ++ rtw_hal_gate_bb(adapter, _TRUE); ++#ifdef CONFIG_GTK_OL ++ if (psecuritypriv->binstallKCK_KEK == _TRUE) ++ rtw_hal_fw_sync_cam_id(adapter); ++#endif ++ if (IS_HARDWARE_TYPE_8723B(adapter)) ++ rtw_hal_backup_rate(adapter); ++ ++ /* RX DMA stop */ ++ if (IS_HARDWARE_TYPE_8188E(adapter)) ++ rtw_hal_disable_tx_report(adapter); ++ ++ res = rtw_hal_pause_rx_dma(adapter); ++ if (res == _FAIL) ++ RTW_PRINT("[WARNING] pause RX DMA fail\n"); ++ ++ /* Reconfig RX_FF Boundary */ ++ rtw_hal_set_wow_rxff_boundary(adapter, _TRUE); ++ ++ /* redownload wow pattern */ ++ rtw_hal_dl_pattern(adapter, 1); ++ ++ rtw_hal_fw_dl(adapter, _TRUE); ++ media_status_rpt = RT_MEDIA_CONNECT; ++ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_FW_JOINBSSRPT, ++ (u8 *)&media_status_rpt); ++ ++ if (!pwrctl->wowlan_pno_enable) { ++ psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); ++ if (psta != NULL) ++ rtw_sta_media_status_rpt(adapter, psta, 1); ++ } ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ /* Enable CPWM2 only. */ ++ res = rtw_hal_enable_cpwm2(adapter); ++ if (res == _FAIL) ++ RTW_PRINT("[WARNING] enable cpwm2 fail\n"); ++#endif ++#ifdef CONFIG_GPIO_WAKEUP ++ rtw_hal_switch_gpio_wl_ctrl(adapter, WAKEUP_GPIO_IDX, _TRUE); ++#endif ++ /* Set WOWLAN H2C command. */ ++ RTW_PRINT("Set WOWLan cmd\n"); ++ rtw_hal_set_fw_wow_related_cmd(adapter, 1); ++ ++ res = rtw_hal_check_wow_ctrl(adapter, _TRUE); ++ ++ if (res == _FALSE) ++ RTW_INFO("[Error]%s: set wowlan CMD fail!!\n", __func__); ++ ++ pwrctl->wowlan_wake_reason = ++ rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); ++ ++ RTW_PRINT("wowlan_wake_reason: 0x%02x\n", ++ pwrctl->wowlan_wake_reason); ++#ifdef CONFIG_GTK_OL_DBG ++ dump_sec_cam(RTW_DBGDUMP, adapter); ++#endif ++#ifdef CONFIG_USB_HCI ++ /* free adapter's resource */ ++ rtw_mi_intf_stop(adapter); ++ ++ /* Invoid SE0 reset signal during suspending*/ ++ rtw_write8(adapter, REG_RSV_CTRL, 0x20); ++ rtw_write8(adapter, REG_RSV_CTRL, 0x60); ++#endif /*CONFIG_USB_HCI*/ ++ ++ rtw_hal_gate_bb(adapter, _FALSE); ++} ++ ++static void rtw_hal_wow_disable(_adapter *adapter) ++{ ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); ++ struct security_priv *psecuritypriv = &adapter->securitypriv; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ struct sta_info *psta = NULL; ++ int res; ++ u16 media_status_rpt; ++ u8 val8; ++ ++ RTW_PRINT("%s, WOWLAN_DISABLE\n", __func__); ++ ++ if (!pwrctl->wowlan_pno_enable) { ++ psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); ++ if (psta != NULL) ++ rtw_sta_media_status_rpt(adapter, psta, 0); ++ else ++ RTW_INFO("%s: psta is null\n", __func__); ++ } ++ ++ if (0) { ++ RTW_INFO("0x630:0x%02x\n", rtw_read8(adapter, 0x630)); ++ RTW_INFO("0x631:0x%02x\n", rtw_read8(adapter, 0x631)); ++ } ++ ++ pwrctl->wowlan_wake_reason = rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); ++ ++ RTW_PRINT("wakeup_reason: 0x%02x\n", ++ pwrctl->wowlan_wake_reason); ++ ++ rtw_hal_set_fw_wow_related_cmd(adapter, 0); ++ ++ res = rtw_hal_check_wow_ctrl(adapter, _FALSE); ++ ++ if (res == _FALSE) { ++ RTW_INFO("[Error]%s: disable WOW cmd fail\n!!", __func__); ++ rtw_hal_force_enable_rxdma(adapter); ++ } ++ ++ rtw_hal_gate_bb(adapter, _TRUE); ++ ++ res = rtw_hal_pause_rx_dma(adapter); ++ if (res == _FAIL) ++ RTW_PRINT("[WARNING] pause RX DMA fail\n"); ++ ++ /* clean HW pattern match */ ++ rtw_hal_dl_pattern(adapter, 0); ++ ++ /* config RXFF boundary to original */ ++ rtw_hal_set_wow_rxff_boundary(adapter, _FALSE); ++ ++ rtw_hal_release_rx_dma(adapter); ++ ++ if (IS_HARDWARE_TYPE_8188E(adapter)) ++ rtw_hal_enable_tx_report(adapter); ++ ++#ifdef CONFIG_GTK_OL ++ if (((pwrctl->wowlan_wake_reason != RX_DISASSOC) || ++ (pwrctl->wowlan_wake_reason != RX_DEAUTH) || ++ (pwrctl->wowlan_wake_reason != FW_DECISION_DISCONNECT)) && ++ psecuritypriv->binstallKCK_KEK == _TRUE) { ++ rtw_hal_get_aoac_rpt(adapter); ++ rtw_hal_update_sw_security_info(adapter); ++ } ++#endif /*CONFIG_GTK_OL*/ ++ ++ rtw_hal_fw_dl(adapter, _FALSE); ++ ++#ifdef CONFIG_GPIO_WAKEUP ++ val8 = (pwrctl->is_high_active == 0) ? 1 : 0; ++ RTW_PRINT("Set Wake GPIO to default(%d).\n", val8); ++ rtw_hal_set_output_gpio(adapter, WAKEUP_GPIO_IDX, val8); ++#endif ++ ++ if ((pwrctl->wowlan_wake_reason != FW_DECISION_DISCONNECT) && ++ (pwrctl->wowlan_wake_reason != RX_PAIRWISEKEY) && ++ (pwrctl->wowlan_wake_reason != RX_DISASSOC) && ++ (pwrctl->wowlan_wake_reason != RX_DEAUTH)) { ++ ++ media_status_rpt = RT_MEDIA_CONNECT; ++ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_FW_JOINBSSRPT, ++ (u8 *)&media_status_rpt); ++ ++ if (psta != NULL) ++ rtw_sta_media_status_rpt(adapter, psta, 1); ++ } ++ rtw_hal_gate_bb(adapter, _FALSE); ++} ++#endif /*CONFIG_WOWLAN*/ ++ ++#ifdef CONFIG_P2P_WOWLAN ++void rtw_hal_set_p2p_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, ++ u8 tx_desc, u32 page_size, u8 *page_num, u32 *total_pkt_len, ++ RSVDPAGE_LOC *rsvd_page_loc) ++{ ++ u32 P2PNegoRspLength = 0, P2PInviteRspLength = 0; ++ u32 P2PPDRspLength = 0, P2PProbeRspLength = 0, P2PBCNLength = 0; ++ u8 CurtPktPageNum = 0; ++ ++ /* P2P Beacon */ ++ rsvd_page_loc->LocP2PBeacon = *page_num; ++ rtw_hal_construct_P2PBeacon(adapter, &pframe[index], &P2PBCNLength); ++ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], ++ P2PBCNLength, _FALSE, _FALSE, _FALSE); ++ ++#if 0 ++ RTW_INFO("%s(): HW_VAR_SET_TX_CMD: PROBE RSP %p %d\n", ++ __FUNCTION__, &pframe[index - tx_desc], (P2PBCNLength + tx_desc)); ++#endif ++ ++ CurtPktPageNum = (u8)PageNum(tx_desc + P2PBCNLength, page_size); ++ ++ *page_num += CurtPktPageNum; ++ ++ index += (CurtPktPageNum * page_size); ++ ++ /* P2P Probe rsp */ ++ rsvd_page_loc->LocP2PProbeRsp = *page_num; ++ rtw_hal_construct_P2PProbeRsp(adapter, &pframe[index], ++ &P2PProbeRspLength); ++ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], ++ P2PProbeRspLength, _FALSE, _FALSE, _FALSE); ++ ++ /* RTW_INFO("%s(): HW_VAR_SET_TX_CMD: PROBE RSP %p %d\n", */ ++ /* __FUNCTION__, &pframe[index-tx_desc], (P2PProbeRspLength+tx_desc)); */ ++ ++ CurtPktPageNum = (u8)PageNum(tx_desc + P2PProbeRspLength, page_size); ++ ++ *page_num += CurtPktPageNum; ++ ++ index += (CurtPktPageNum * page_size); ++ ++ /* P2P nego rsp */ ++ rsvd_page_loc->LocNegoRsp = *page_num; ++ rtw_hal_construct_P2PNegoRsp(adapter, &pframe[index], ++ &P2PNegoRspLength); ++ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], ++ P2PNegoRspLength, _FALSE, _FALSE, _FALSE); ++ ++ /* RTW_INFO("%s(): HW_VAR_SET_TX_CMD: QOS NULL DATA %p %d\n", */ ++ /* __FUNCTION__, &pframe[index-tx_desc], (NegoRspLength+tx_desc)); */ ++ ++ CurtPktPageNum = (u8)PageNum(tx_desc + P2PNegoRspLength, page_size); ++ ++ *page_num += CurtPktPageNum; ++ ++ index += (CurtPktPageNum * page_size); ++ ++ /* P2P invite rsp */ ++ rsvd_page_loc->LocInviteRsp = *page_num; ++ rtw_hal_construct_P2PInviteRsp(adapter, &pframe[index], ++ &P2PInviteRspLength); ++ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], ++ P2PInviteRspLength, _FALSE, _FALSE, _FALSE); ++ ++ /* RTW_INFO("%s(): HW_VAR_SET_TX_CMD: QOS NULL DATA %p %d\n", */ ++ /* __FUNCTION__, &pframe[index-tx_desc], (InviteRspLength+tx_desc)); */ ++ ++ CurtPktPageNum = (u8)PageNum(tx_desc + P2PInviteRspLength, page_size); ++ ++ *page_num += CurtPktPageNum; ++ ++ index += (CurtPktPageNum * page_size); ++ ++ /* P2P provision discovery rsp */ ++ rsvd_page_loc->LocPDRsp = *page_num; ++ rtw_hal_construct_P2PProvisionDisRsp(adapter, ++ &pframe[index], &P2PPDRspLength); ++ ++ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], ++ P2PPDRspLength, _FALSE, _FALSE, _FALSE); ++ ++ /* RTW_INFO("%s(): HW_VAR_SET_TX_CMD: QOS NULL DATA %p %d\n", */ ++ /* __FUNCTION__, &pframe[index-tx_desc], (PDRspLength+tx_desc)); */ ++ ++ CurtPktPageNum = (u8)PageNum(tx_desc + P2PPDRspLength, page_size); ++ ++ *page_num += CurtPktPageNum; ++ ++ *total_pkt_len = index + P2PPDRspLength; ++ ++ index += (CurtPktPageNum * page_size); ++ ++ ++} ++#endif /* CONFIG_P2P_WOWLAN */ ++ ++#ifdef CONFIG_LPS_PG ++ #define LPSPG_RSVD_PAGE_SET_MACID(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 0, 8, _value)/*used macid*/ ++ #define LPSPG_RSVD_PAGE_SET_MBSSCAMID(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 8, 8, _value)/*used BSSID CAM entry*/ ++ #define LPSPG_RSVD_PAGE_SET_PMC_NUM(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 16, 8, _value)/*Max used Pattern Match CAM entry*/ ++ #define LPSPG_RSVD_PAGE_SET_MU_RAID_GID(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 24, 8, _value)/*Max MU rate table Group ID*/ ++ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_NUM(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x04, 0, 8, _value)/*used Security CAM entry number*/ ++ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID1(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 0, 8, _value)/*used Security CAM entry -1*/ ++ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID2(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 8, 8, _value)/*used Security CAM entry -2*/ ++ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID3(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 16, 8, _value)/*used Security CAM entry -3*/ ++ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID4(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 24, 8, _value)/*used Security CAM entry -4*/ ++ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID5(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 0, 8, _value)/*used Security CAM entry -5*/ ++ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID6(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 8, 8, _value)/*used Security CAM entry -6*/ ++ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID7(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 16, 8, _value)/*used Security CAM entry -7*/ ++ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID8(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 24, 8, _value)/*used Security CAM entry -8*/ ++#endif ++#ifdef CONFIG_LPS_PG ++#include "hal_halmac.h" ++ ++#define DBG_LPSPG_SEC_DUMP ++#define LPS_PG_INFO_RSVD_LEN 16 ++ ++static void rtw_hal_set_lps_pg_info_rsvd_page(_adapter *adapter) ++{ ++ u8 cur_pag_num = 0; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); ++ struct sta_info *psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(&adapter->mlmepriv)); ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ u8 lps_pg_info[LPS_PG_INFO_RSVD_LEN] = {0}; ++#ifdef CONFIG_MBSSID_CAM ++ u8 cam_id = INVALID_CAM_ID; ++#endif ++ u8 *psec_cam_id = lps_pg_info + 8; ++ u8 sec_cam_num = 0; ++ ++ if (!psta) { ++ RTW_ERR("%s [ERROR] sta is NULL\n", __func__); ++ rtw_warn_on(1); ++ return; ++ } ++ ++ LPSPG_RSVD_PAGE_SET_MACID(lps_pg_info, psta->mac_id); /*used macid*/ ++ RTW_INFO("[LPSPG-INFO] mac_id:%d\n", psta->mac_id); ++ ++#ifdef CONFIG_MBSSID_CAM ++ cam_id = rtw_mbid_cam_search_by_ifaceid(adapter, adapter->iface_id); ++ if (cam_id != INVALID_CAM_ID) ++ LPSPG_RSVD_PAGE_SET_MBSSCAMID(lps_pg_info, cam_id); /*used BSSID CAM entry*/ ++ RTW_INFO("[LPSPG-INFO] mbss_cam_id:%d\n", cam_id); ++#endif ++ ++#ifdef CONFIG_WOWLAN /*&& pattern match cam used*/ ++ if (pwrpriv->wowlan_mode == _TRUE && ++ check_fwstate(&adapter->mlmepriv, _FW_LINKED) == _TRUE) { ++ LPSPG_RSVD_PAGE_SET_PMC_NUM(lps_pg_info, pwrpriv->wowlan_pattern_idx); /*Max used Pattern Match CAM entry*/ ++ RTW_INFO("[LPSPG-INFO] Max Pattern Match CAM entry :%d\n", _value); ++ } ++#endif ++#ifdef CONFIG_BEAMFORMING /*&& MU BF*/ ++ LPSPG_RSVD_PAGE_SET_MU_RAID_GID(lps_pg_info, _value); /*Max MU rate table Group ID*/ ++ RTW_INFO("[LPSPG-INFO] Max MU rate table Group ID :%d\n", _value); ++#endif ++ ++ sec_cam_num = rtw_get_sec_camid(adapter, 8, psec_cam_id); ++ if (sec_cam_num < 8) ++ LPSPG_RSVD_PAGE_SET_SEC_CAM_NUM(lps_pg_info, sec_cam_num); /*used Security CAM entry number*/ ++ RTW_INFO("[LPSPG-INFO] Security CAM entry number :%d\n", sec_cam_num); ++ ++#ifdef DBG_LPSPG_SEC_DUMP ++ { ++ int i; ++ ++ for (i = 0; i < sec_cam_num; i++) ++ RTW_INFO("%d = sec_cam_id:%d\n", i, psec_cam_id[i]); ++ } ++#endif ++ ++#ifdef DBG_LPSPG_INFO_DUMP ++ RTW_INFO("==== DBG_LPSPG_INFO_RSVD_PAGE_DUMP====\n"); ++ RTW_INFO(" %02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X\n", ++ *(lps_pg_info), *(lps_pg_info + 1), *(lps_pg_info + 2), *(lps_pg_info + 3), ++ *(lps_pg_info + 4), *(lps_pg_info + 5), *(lps_pg_info + 6), *(lps_pg_info + 7)); ++ RTW_INFO(" %02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X\n", ++ *(lps_pg_info + 8), *(lps_pg_info + 9), *(lps_pg_info + 10), *(lps_pg_info + 11), ++ *(lps_pg_info + 12), *(lps_pg_info + 13), *(lps_pg_info + 14), *(lps_pg_info + 15)); ++ RTW_INFO("==== DBG_LPSPG_INFO_RSVD_PAGE_DUMP====\n"); ++#endif ++ ++ rtw_halmac_download_rsvd_page(dvobj, pwrpriv->lpspg_rsvd_page_locate, lps_pg_info, LPS_PG_INFO_RSVD_LEN); ++ ++} ++ ++#define DBG_LPSPG_INFO_DUMP ++static u8 rtw_hal_set_lps_pg_info_cmd(_adapter *adapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ ++ u8 lpspg_info[H2C_LPS_PG_INFO_LEN] = {0}; ++ u8 ret = _FAIL; ++ ++ RTW_INFO("%s: loc_lpspg_info:%d\n", __func__, pwrpriv->lpspg_rsvd_page_locate); ++ ++ if (_NO_PRIVACY_ != adapter->securitypriv.dot11PrivacyAlgrthm) ++ SET_H2CCMD_LPSPG_SEC_CAM_EN(lpspg_info, 1); /*SecurityCAM_En*/ ++#ifdef CONFIG_MBSSID_CAM ++ SET_H2CCMD_LPSPG_MBID_CAM_EN(lpspg_info, 1); /*BSSIDCAM_En*/ ++#endif ++ ++#ifdef CONFIG_WOWLAN /*&& pattern match cam used*/ ++ if (pwrpriv->wowlan_mode == _TRUE && ++ check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ ++ SET_H2CCMD_LPSPG_PMC_CAM_EN(lpspg_info, 1); /*PatternMatchCAM_En*/ ++ } ++#endif ++ ++#ifdef CONFIG_MACID_SEARCH ++ SET_H2CCMD_LPSPG_MACID_SEARCH_EN(lpspg_info, 1); /*MACIDSearch_En*/ ++#endif ++ ++#ifdef CONFIG_TX_SC ++ SET_H2CCMD_LPSPG_TXSC_EN(lpspg_info, 1); /*TXSC_En*/ ++#endif ++ ++#ifdef CONFIG_BEAMFORMING /*&& MU BF*/ ++ SET_H2CCMD_LPSPG_MU_RATE_TB_EN(lpspg_info, 1); /*MURateTable_En*/ ++#endif ++ ++ SET_H2CCMD_LPSPG_LOC(lpspg_info, pwrpriv->lpspg_rsvd_page_locate); ++ ++#ifdef DBG_LPSPG_INFO_DUMP ++ RTW_INFO("==== DBG_LPSPG_INFO_CMD_DUMP====\n"); ++ RTW_INFO(" H2C_CMD: 0x%02x, H2C_LEN: %d\n", H2C_LPS_PG_INFO, H2C_LPS_PG_INFO_LEN); ++ RTW_INFO(" %02X:%02X\n", *(lpspg_info), *(lpspg_info + 1)); ++ RTW_INFO("==== DBG_LPSPG_INFO_CMD_DUMP====\n"); ++#endif ++ ++ ret = rtw_hal_fill_h2c_cmd(adapter, ++ H2C_LPS_PG_INFO, ++ H2C_LPS_PG_INFO_LEN, ++ lpspg_info); ++ return ret; ++} ++u8 rtw_hal_set_lps_pg_info(_adapter *adapter) ++{ ++ u8 ret = _FAIL; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); ++ ++ if (pwrpriv->lpspg_rsvd_page_locate == 0) { ++ RTW_ERR("%s [ERROR] lpspg_rsvd_page_locate = 0\n", __func__); ++ rtw_warn_on(1); ++ return ret; ++ } ++ ++ rtw_hal_set_lps_pg_info_rsvd_page(adapter); ++ ret = rtw_hal_set_lps_pg_info_cmd(adapter); ++ if (_SUCCESS == ret) ++ pwrpriv->blpspg_info_up = _FALSE; ++ ++ return ret; ++} ++#endif /*CONFIG_LPS_PG*/ ++ ++/* ++ * Description: Fill the reserved packets that FW will use to RSVD page. ++ * Now we just send 4 types packet to rsvd page. ++ * (1)Beacon, (2)Ps-poll, (3)Null data, (4)ProbeRsp. ++ * Input: ++ * finished - FALSE:At the first time we will send all the packets as a large packet to Hw, ++ * so we need to set the packet length to total lengh. ++ * TRUE: At the second time, we should send the first packet (default:beacon) ++ * to Hw again and set the lengh in descriptor to the real beacon lengh. ++ * 2009.10.15 by tynli. ++ * ++ * Page Size = 128: 8188e, 8723a/b, 8192c/d, ++ * Page Size = 256: 8192e, 8821a ++ * Page Size = 512: 8812a ++ */ ++ ++void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) ++{ ++ PHAL_DATA_TYPE pHalData; ++ struct xmit_frame *pcmdframe; ++ struct pkt_attrib *pattrib; ++ struct xmit_priv *pxmitpriv; ++ struct mlme_ext_priv *pmlmeext; ++ struct mlme_ext_info *pmlmeinfo; ++ struct pwrctrl_priv *pwrctl; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct hal_ops *pHalFunc = &adapter->HalFunc; ++ u32 BeaconLength = 0, ProbeRspLength = 0, PSPollLength = 0; ++ u32 NullDataLength = 0, QosNullLength = 0, BTQosNullLength = 0; ++ u32 ProbeReqLength = 0, NullFunctionDataLength = 0; ++ u8 TxDescLen = TXDESC_SIZE, TxDescOffset = TXDESC_OFFSET; ++ u8 TotalPageNum = 0 , CurtPktPageNum = 0 , RsvdPageNum = 0; ++ u8 *ReservedPagePacket; ++ u16 BufIndex = 0; ++ u32 TotalPacketLen = 0, MaxRsvdPageBufSize = 0, PageSize = 0; ++ RSVDPAGE_LOC RsvdPageLoc; ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ struct sreset_priv *psrtpriv; ++#endif /* DBG_CONFIG_ERROR_DETECT */ ++ ++#ifdef CONFIG_MCC_MODE ++ u8 dl_mcc_page = _FAIL; ++#endif /* CONFIG_MCC_MODE */ ++ ++ pHalData = GET_HAL_DATA(adapter); ++#ifdef DBG_CONFIG_ERROR_DETECT ++ psrtpriv = &pHalData->srestpriv; ++#endif ++ pxmitpriv = &adapter->xmitpriv; ++ pmlmeext = &adapter->mlmeextpriv; ++ pmlmeinfo = &pmlmeext->mlmext_info; ++ pwrctl = adapter_to_pwrctl(adapter); ++ ++ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&PageSize); ++ ++ if (PageSize == 0) { ++ RTW_INFO("[Error]: %s, PageSize is zero!!\n", __func__); ++ return; ++ } ++ ++ if (pwrctl->wowlan_mode == _TRUE || pwrctl->wowlan_ap_mode == _TRUE) ++ RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _TRUE); ++ else ++ RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _FALSE); ++ ++ RTW_INFO("%s PageSize: %d, RsvdPageNUm: %d\n", __func__, PageSize, RsvdPageNum); ++ ++ MaxRsvdPageBufSize = RsvdPageNum * PageSize; ++ ++ if (MaxRsvdPageBufSize > MAX_CMDBUF_SZ) { ++ RTW_INFO("%s MaxRsvdPageBufSize(%d) is larger than MAX_CMDBUF_SZ(%d)", ++ __func__, MaxRsvdPageBufSize, MAX_CMDBUF_SZ); ++ rtw_warn_on(1); ++ return; ++ } ++ ++ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); ++ ++ if (pcmdframe == NULL) { ++ RTW_INFO("%s: alloc ReservedPagePacket fail!\n", __FUNCTION__); ++ return; ++ } ++ ++ ReservedPagePacket = pcmdframe->buf_addr; ++ _rtw_memset(&RsvdPageLoc, 0, sizeof(RSVDPAGE_LOC)); ++ ++ /* beacon * 2 pages */ ++ BufIndex = TxDescOffset; ++ rtw_hal_construct_beacon(adapter, ++ &ReservedPagePacket[BufIndex], &BeaconLength); ++ ++ /* ++ * When we count the first page size, we need to reserve description size for the RSVD ++ * packet, it will be filled in front of the packet in TXPKTBUF. ++ */ ++ CurtPktPageNum = (u8)PageNum((TxDescLen + BeaconLength), PageSize); ++ /* If we don't add 1 more page, ARP offload function will fail at 8723bs.*/ ++ if (CurtPktPageNum == 1) ++ CurtPktPageNum += 1; ++ ++ TotalPageNum += CurtPktPageNum; ++ ++ BufIndex += (CurtPktPageNum * PageSize); ++ ++ if (pwrctl->wowlan_ap_mode == _TRUE) { ++ /* (4) probe response*/ ++ RsvdPageLoc.LocProbeRsp = TotalPageNum; ++ rtw_hal_construct_ProbeRsp( ++ adapter, &ReservedPagePacket[BufIndex], ++ &ProbeRspLength, ++ get_my_bssid(&pmlmeinfo->network), _FALSE); ++ rtw_hal_fill_fake_txdesc(adapter, ++ &ReservedPagePacket[BufIndex - TxDescLen], ++ ProbeRspLength, _FALSE, _FALSE, _FALSE); ++ ++ CurtPktPageNum = (u8)PageNum(TxDescLen + ProbeRspLength, PageSize); ++ TotalPageNum += CurtPktPageNum; ++ TotalPacketLen = BufIndex + ProbeRspLength; ++ BufIndex += (CurtPktPageNum * PageSize); ++ goto download_page; ++ } ++ ++ /* ps-poll * 1 page */ ++ RsvdPageLoc.LocPsPoll = TotalPageNum; ++ RTW_INFO("LocPsPoll: %d\n", RsvdPageLoc.LocPsPoll); ++ rtw_hal_construct_PSPoll(adapter, ++ &ReservedPagePacket[BufIndex], &PSPollLength); ++ rtw_hal_fill_fake_txdesc(adapter, ++ &ReservedPagePacket[BufIndex - TxDescLen], ++ PSPollLength, _TRUE, _FALSE, _FALSE); ++ ++ CurtPktPageNum = (u8)PageNum((TxDescLen + PSPollLength), PageSize); ++ ++ TotalPageNum += CurtPktPageNum; ++ ++ BufIndex += (CurtPktPageNum * PageSize); ++ ++#ifdef CONFIG_BT_COEXIST ++ /* BT Qos null data * 1 page */ ++ RsvdPageLoc.LocBTQosNull = TotalPageNum; ++ RTW_INFO("LocBTQosNull: %d\n", RsvdPageLoc.LocBTQosNull); ++ rtw_hal_construct_NullFunctionData( ++ adapter, ++ &ReservedPagePacket[BufIndex], ++ &BTQosNullLength, ++ get_my_bssid(&pmlmeinfo->network), ++ _TRUE, 0, 0, _FALSE); ++ rtw_hal_fill_fake_txdesc(adapter, ++ &ReservedPagePacket[BufIndex - TxDescLen], ++ BTQosNullLength, _FALSE, _TRUE, _FALSE); ++ ++ CurtPktPageNum = (u8)PageNum(TxDescLen + BTQosNullLength, PageSize); ++ ++ TotalPageNum += CurtPktPageNum; ++ ++ BufIndex += (CurtPktPageNum * PageSize); ++#endif /* CONFIG_BT_COEXIT */ ++ ++#ifdef CONFIG_MCC_MODE ++ if (MCC_EN(adapter)) { ++ dl_mcc_page = rtw_hal_dl_mcc_fw_rsvd_page(adapter, ReservedPagePacket, ++ &BufIndex, TxDescLen, PageSize, ++ &TotalPageNum, &TotalPacketLen, &RsvdPageLoc); ++ } else ++ dl_mcc_page = _FAIL; ++ ++ if (dl_mcc_page == _FAIL) { ++#endif /* CONFIG_MCC_MODE */ ++ ++ /* null data * 1 page */ ++ RsvdPageLoc.LocNullData = TotalPageNum; ++ RTW_INFO("LocNullData: %d\n", RsvdPageLoc.LocNullData); ++ rtw_hal_construct_NullFunctionData( ++ adapter, ++ &ReservedPagePacket[BufIndex], ++ &NullDataLength, ++ get_my_bssid(&pmlmeinfo->network), ++ _FALSE, 0, 0, _FALSE); ++ rtw_hal_fill_fake_txdesc(adapter, ++ &ReservedPagePacket[BufIndex - TxDescLen], ++ NullDataLength, _FALSE, _FALSE, _FALSE); ++ ++ CurtPktPageNum = (u8)PageNum(TxDescLen + NullDataLength, PageSize); ++ ++ TotalPageNum += CurtPktPageNum; ++ ++ BufIndex += (CurtPktPageNum * PageSize); ++#ifdef CONFIG_MCC_MODE ++ } ++#endif /* CONFIG_MCC_MODE */ ++ ++ /* Qos null data * 1 page */ ++ RsvdPageLoc.LocQosNull = TotalPageNum; ++ RTW_INFO("LocQosNull: %d\n", RsvdPageLoc.LocQosNull); ++ rtw_hal_construct_NullFunctionData( ++ adapter, ++ &ReservedPagePacket[BufIndex], ++ &QosNullLength, ++ get_my_bssid(&pmlmeinfo->network), ++ _TRUE, 0, 0, _FALSE); ++ rtw_hal_fill_fake_txdesc(adapter, ++ &ReservedPagePacket[BufIndex - TxDescLen], ++ QosNullLength, _FALSE, _FALSE, _FALSE); ++ ++ CurtPktPageNum = (u8)PageNum(TxDescLen + QosNullLength, PageSize); ++ ++ TotalPageNum += CurtPktPageNum; ++ ++ TotalPacketLen = BufIndex + QosNullLength; ++ ++ BufIndex += (CurtPktPageNum * PageSize); ++ ++#ifdef CONFIG_WOWLAN ++ if (pwrctl->wowlan_mode == _TRUE && ++ pwrctl->wowlan_in_resume == _FALSE) { ++ rtw_hal_set_wow_fw_rsvd_page(adapter, ReservedPagePacket, ++ BufIndex, TxDescLen, PageSize, ++ &TotalPageNum, &TotalPacketLen, &RsvdPageLoc); ++ } ++#endif /* CONFIG_WOWLAN */ ++ ++#ifdef CONFIG_P2P_WOWLAN ++ if (_TRUE == pwrctl->wowlan_p2p_mode) { ++ rtw_hal_set_p2p_wow_fw_rsvd_page(adapter, ReservedPagePacket, ++ BufIndex, TxDescLen, PageSize, ++ &TotalPageNum, &TotalPacketLen, &RsvdPageLoc); ++ } ++#endif /* CONFIG_P2P_WOWLAN */ ++ ++#ifdef CONFIG_LPS_PG ++ /* must reserved last 1 x page for LPS PG Info*/ ++ pwrctl->lpspg_rsvd_page_locate = TotalPageNum; ++ pwrctl->blpspg_info_up = _TRUE; ++#endif ++ ++download_page: ++ /* RTW_INFO("%s BufIndex(%d), TxDescLen(%d), PageSize(%d)\n",__func__, BufIndex, TxDescLen, PageSize);*/ ++ RTW_INFO("%s PageNum(%d), pktlen(%d)\n", ++ __func__, TotalPageNum, TotalPacketLen); ++ ++ if (TotalPacketLen > MaxRsvdPageBufSize) { ++ RTW_INFO("%s(ERROR): rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n", ++ __FUNCTION__, TotalPacketLen, MaxRsvdPageBufSize); ++ rtw_warn_on(1); ++ goto error; ++ } else { ++ /* update attribute */ ++ pattrib = &pcmdframe->attrib; ++ update_mgntframe_attrib(adapter, pattrib); ++ pattrib->qsel = QSLT_BEACON; ++ pattrib->pktlen = TotalPacketLen - TxDescOffset; ++ pattrib->last_txcmdsz = TotalPacketLen - TxDescOffset; ++#ifdef CONFIG_PCI_HCI ++ dump_mgntframe(adapter, pcmdframe); ++#else ++ dump_mgntframe_and_wait(adapter, pcmdframe, 100); ++#endif ++ } ++ ++ RTW_INFO("%s: Set RSVD page location to Fw ,TotalPacketLen(%d), TotalPageNum(%d)\n", ++ __func__, TotalPacketLen, TotalPageNum); ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ rtw_hal_set_FwRsvdPage_cmd(adapter, &RsvdPageLoc); ++#ifdef CONFIG_WOWLAN ++ if (pwrctl->wowlan_mode == _TRUE && ++ pwrctl->wowlan_in_resume == _FALSE) ++ rtw_hal_set_FwAoacRsvdPage_cmd(adapter, &RsvdPageLoc); ++#endif /* CONFIG_WOWLAN */ ++#ifdef CONFIG_AP_WOWLAN ++ if (pwrctl->wowlan_ap_mode == _TRUE) ++ rtw_hal_set_ap_rsvdpage_loc_cmd(adapter, &RsvdPageLoc); ++#endif /* CONFIG_AP_WOWLAN */ ++ } else if (pwrctl->wowlan_pno_enable) { ++#ifdef CONFIG_PNO_SUPPORT ++ rtw_hal_set_FwAoacRsvdPage_cmd(adapter, &RsvdPageLoc); ++ if (pwrctl->wowlan_in_resume) ++ rtw_hal_set_scan_offload_info_cmd(adapter, ++ &RsvdPageLoc, 0); ++ else ++ rtw_hal_set_scan_offload_info_cmd(adapter, ++ &RsvdPageLoc, 1); ++#endif /* CONFIG_PNO_SUPPORT */ ++ } ++#ifdef CONFIG_P2P_WOWLAN ++ if (_TRUE == pwrctl->wowlan_p2p_mode) ++ rtw_hal_set_FwP2PRsvdPage_cmd(adapter, &RsvdPageLoc); ++#endif /* CONFIG_P2P_WOWLAN */ ++ return; ++error: ++ rtw_free_xmitframe(pxmitpriv, pcmdframe); ++} ++static void rtw_hal_set_hw_update_tsf(PADAPTER padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++#if defined(CONFIG_RTL8822B) || defined(CONFIG_MI_WITH_MBSSID_CAM) ++ RTW_INFO("[Warn] %s "ADPT_FMT" enter func\n", __func__, ADPT_ARG(padapter)); ++ rtw_warn_on(1); ++ return; ++#endif ++ ++ if (!pmlmeext->en_hw_update_tsf) ++ return; ++ ++ /* check REG_RCR bit is set */ ++ if (!(rtw_read32(padapter, REG_RCR) & RCR_CBSSID_BCN)) ++ return; ++ ++ /* enable hw update tsf function for non-AP */ ++ if (rtw_linked_check(padapter) && ++ check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) { ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->hw_port == HW_PORT1) ++ rtw_write8(padapter, REG_BCN_CTRL_1, rtw_read8(padapter, REG_BCN_CTRL_1) & (~DIS_TSF_UDT)); ++ else ++#endif ++ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) & (~DIS_TSF_UDT)); ++ } ++ pmlmeext->en_hw_update_tsf = _FALSE; ++} ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_TDLS_CH_SW ++s32 rtw_hal_ch_sw_oper_offload(_adapter *padapter, u8 channel, u8 channel_offset, u16 bwmode) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ u8 ch_sw_h2c_buf[4] = {0x00, 0x00, 0x00, 0x00}; ++ ++ ++ SET_H2CCMD_CH_SW_OPER_OFFLOAD_CH_NUM(ch_sw_h2c_buf, channel); ++ SET_H2CCMD_CH_SW_OPER_OFFLOAD_BW_MODE(ch_sw_h2c_buf, bwmode); ++ switch (bwmode) { ++ case CHANNEL_WIDTH_40: ++ SET_H2CCMD_CH_SW_OPER_OFFLOAD_BW_40M_SC(ch_sw_h2c_buf, channel_offset); ++ break; ++ case CHANNEL_WIDTH_80: ++ SET_H2CCMD_CH_SW_OPER_OFFLOAD_BW_80M_SC(ch_sw_h2c_buf, channel_offset); ++ break; ++ case CHANNEL_WIDTH_20: ++ default: ++ break; ++ } ++ SET_H2CCMD_CH_SW_OPER_OFFLOAD_RFE_TYPE(ch_sw_h2c_buf, pHalData->RFEType); ++ ++ return rtw_hal_fill_h2c_cmd(padapter, H2C_CHNL_SWITCH_OPER_OFFLOAD, sizeof(ch_sw_h2c_buf), ch_sw_h2c_buf); ++} ++#endif ++#endif ++ ++void SetHwReg(_adapter *adapter, u8 variable, u8 *val) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ ++ switch (variable) { ++ case HW_VAR_MEDIA_STATUS: { ++ u8 net_type = *((u8 *)val); ++ ++ rtw_hal_set_msr(adapter, net_type); ++ } ++ break; ++ case HW_VAR_MAC_ADDR: ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ rtw_hal_set_macaddr_mbid(adapter, val); ++#else ++ rtw_hal_set_macaddr_port(adapter, val); ++#endif ++ break; ++ case HW_VAR_BSSID: ++ rtw_hal_set_bssid(adapter, val); ++ break; ++#ifdef CONFIG_MBSSID_CAM ++ case HW_VAR_MBSSID_CAM_WRITE: { ++ u32 cmd = 0; ++ u32 *cam_val = (u32 *)val; ++ ++ rtw_write32(adapter, REG_MBIDCAMCFG_1, cam_val[0]); ++ cmd = BIT_MBIDCAM_POLL | BIT_MBIDCAM_WT_EN | BIT_MBIDCAM_VALID | cam_val[1]; ++ rtw_write32(adapter, REG_MBIDCAMCFG_2, cmd); ++ } ++ break; ++ case HW_VAR_MBSSID_CAM_CLEAR: { ++ u32 cmd; ++ u8 entry_id = *(u8 *)val; ++ ++ rtw_write32(adapter, REG_MBIDCAMCFG_1, 0); ++ ++ cmd = BIT_MBIDCAM_POLL | BIT_MBIDCAM_WT_EN | ((entry_id & MBIDCAM_ADDR_MASK) << MBIDCAM_ADDR_SHIFT); ++ rtw_write32(adapter, REG_MBIDCAMCFG_2, cmd); ++ } ++ break; ++ case HW_VAR_RCR_MBSSID_EN: ++ if (*((u8 *)val)) ++ rtw_write32(adapter, REG_RCR, rtw_read32(adapter, REG_RCR) | RCR_ENMBID); ++ else { ++ u32 val32; ++ ++ val32 = rtw_read32(adapter, REG_RCR); ++ val32 &= ~(RCR_ENMBID); ++ rtw_write32(adapter, REG_RCR, val32); ++ } ++ break; ++#endif ++ case HW_VAR_PORT_SWITCH: ++ hw_var_port_switch(adapter); ++ break; ++ case HW_VAR_INIT_RTS_RATE: { ++ u16 brate_cfg = *((u16 *)val); ++ u8 rate_index = 0; ++ HAL_VERSION *hal_ver = &hal_data->VersionID; ++ ++ if (IS_8188E(*hal_ver)) { ++ ++ while (brate_cfg > 0x1) { ++ brate_cfg = (brate_cfg >> 1); ++ rate_index++; ++ } ++ rtw_write8(adapter, REG_INIRTS_RATE_SEL, rate_index); ++ } else ++ rtw_warn_on(1); ++ } ++ break; ++ case HW_VAR_SEC_CFG: { ++ u16 reg_scr_ori; ++ u16 reg_scr; ++ ++ reg_scr = reg_scr_ori = rtw_read16(adapter, REG_SECCFG); ++ reg_scr |= (SCR_CHK_KEYID | SCR_RxDecEnable | SCR_TxEncEnable); ++ ++ if (_rtw_camctl_chk_cap(adapter, SEC_CAP_CHK_BMC)) ++ reg_scr |= SCR_CHK_BMC; ++ ++ if (_rtw_camctl_chk_flags(adapter, SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH)) ++ reg_scr |= SCR_NoSKMC; ++ ++ if (reg_scr != reg_scr_ori) ++ rtw_write16(adapter, REG_SECCFG, reg_scr); ++ } ++ break; ++ case HW_VAR_SEC_DK_CFG: { ++ struct security_priv *sec = &adapter->securitypriv; ++ u8 reg_scr = rtw_read8(adapter, REG_SECCFG); ++ ++ if (val) { /* Enable default key related setting */ ++ reg_scr |= SCR_TXBCUSEDK; ++ if (sec->dot11AuthAlgrthm != dot11AuthAlgrthm_8021X) ++ reg_scr |= (SCR_RxUseDK | SCR_TxUseDK); ++ } else /* Disable default key related setting */ ++ reg_scr &= ~(SCR_RXBCUSEDK | SCR_TXBCUSEDK | SCR_RxUseDK | SCR_TxUseDK); ++ ++ rtw_write8(adapter, REG_SECCFG, reg_scr); ++ } ++ break; ++ ++ case HW_VAR_ASIX_IOT: ++ /* enable ASIX IOT function */ ++ if (*((u8 *)val) == _TRUE) { ++ /* 0xa2e[0]=0 (disable rake receiver) */ ++ rtw_write8(adapter, rCCK0_FalseAlarmReport + 2, ++ rtw_read8(adapter, rCCK0_FalseAlarmReport + 2) & ~(BIT0)); ++ /* 0xa1c=0xa0 (reset channel estimation if signal quality is bad) */ ++ rtw_write8(adapter, rCCK0_DSPParameter2, 0xa0); ++ } else { ++ /* restore reg:0xa2e, reg:0xa1c */ ++ rtw_write8(adapter, rCCK0_FalseAlarmReport + 2, ++ rtw_read8(adapter, rCCK0_FalseAlarmReport + 2) | (BIT0)); ++ rtw_write8(adapter, rCCK0_DSPParameter2, 0x00); ++ } ++ break; ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++ case HW_VAR_WOWLAN: { ++ struct wowlan_ioctl_param *poidparam; ++ ++ poidparam = (struct wowlan_ioctl_param *)val; ++ switch (poidparam->subcode) { ++#ifdef CONFIG_WOWLAN ++ case WOWLAN_PATTERN_CLEAN: ++ rtw_hal_dl_pattern(adapter, 2); ++ break; ++ case WOWLAN_ENABLE: ++ rtw_hal_wow_enable(adapter); ++ break; ++ case WOWLAN_DISABLE: ++ rtw_hal_wow_disable(adapter); ++ break; ++#endif /*CONFIG_WOWLAN*/ ++#ifdef CONFIG_AP_WOWLAN ++ case WOWLAN_AP_ENABLE: ++ rtw_hal_ap_wow_enable(adapter); ++ break; ++ case WOWLAN_AP_DISABLE: ++ rtw_hal_ap_wow_disable(adapter); ++ break; ++#endif /*CONFIG_AP_WOWLAN*/ ++ default: ++ break; ++ } ++ } ++ break; ++#endif /*defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN)*/ ++ ++ case HW_VAR_EN_HW_UPDATE_TSF: ++ rtw_hal_set_hw_update_tsf(adapter); ++ break; ++ ++ case HW_VAR_APFM_ON_MAC: ++ hal_data->bMacPwrCtrlOn = *val; ++ RTW_INFO("%s: bMacPwrCtrlOn=%d\n", __func__, hal_data->bMacPwrCtrlOn); ++ break; ++ default: ++ if (0) ++ RTW_PRINT(FUNC_ADPT_FMT" variable(%d) not defined!\n", ++ FUNC_ADPT_ARG(adapter), variable); ++ break; ++ } ++ ++} ++ ++void GetHwReg(_adapter *adapter, u8 variable, u8 *val) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ ++ ++ switch (variable) { ++ case HW_VAR_BASIC_RATE: ++ *((u16 *)val) = hal_data->BasicRateSet; ++ break; ++ case HW_VAR_RF_TYPE: ++ *((u8 *)val) = hal_data->rf_type; ++ break; ++ case HW_VAR_MEDIA_STATUS: ++ rtw_hal_get_msr(adapter, val); ++ break; ++ case HW_VAR_DO_IQK: ++ *val = hal_data->bNeedIQK; ++ break; ++ case HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO: ++ if (hal_is_band_support(adapter, BAND_ON_5G)) ++ *val = _TRUE; ++ else ++ *val = _FALSE; ++ break; ++ case HW_VAR_APFM_ON_MAC: ++ *val = hal_data->bMacPwrCtrlOn; ++ break; ++ default: ++ if (0) ++ RTW_PRINT(FUNC_ADPT_FMT" variable(%d) not defined!\n", ++ FUNC_ADPT_ARG(adapter), variable); ++ break; ++ } ++ ++} ++ ++u8 ++SetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ u8 bResult = _SUCCESS; ++ ++ switch (variable) { ++ ++ case HAL_DEF_DBG_DUMP_RXPKT: ++ hal_data->bDumpRxPkt = *((u8 *)value); ++ break; ++ case HAL_DEF_DBG_DUMP_TXPKT: ++ hal_data->bDumpTxPkt = *((u8 *)value); ++ break; ++ case HAL_DEF_ANT_DETECT: ++ hal_data->AntDetection = *((u8 *)value); ++ break; ++ case HAL_DEF_DBG_DIS_PWT: ++ hal_data->bDisableTXPowerTraining = *((u8 *)value); ++ break; ++ default: ++ RTW_PRINT("%s: [WARNING] HAL_DEF_VARIABLE(%d) not defined!\n", __FUNCTION__, variable); ++ bResult = _FAIL; ++ break; ++ } ++ ++ return bResult; ++} ++ ++#ifdef CONFIG_BEAMFORMING ++u8 rtw_hal_query_txbfer_rf_num(_adapter *adapter) ++{ ++ struct registry_priv *pregistrypriv = &adapter->registrypriv; ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ ++ if ((pregistrypriv->beamformer_rf_num) && (IS_HARDWARE_TYPE_8814AE(adapter) || IS_HARDWARE_TYPE_8814AU(adapter) || IS_HARDWARE_TYPE_8822BU(adapter) || IS_HARDWARE_TYPE_8821C(adapter))) ++ return pregistrypriv->beamformer_rf_num; ++ else if (IS_HARDWARE_TYPE_8814AE(adapter) ++#if 0 ++#if defined(CONFIG_USB_HCI) ++ || (IS_HARDWARE_TYPE_8814AU(adapter) && (pUsbModeMech->CurUsbMode == 2 || pUsbModeMech->HubUsbMode == 2)) /* for USB3.0 */ ++#endif ++#endif ++ ) { ++ /*BF cap provided by Yu Chen, Sean, 2015, 01 */ ++ if (hal_data->rf_type == RF_3T3R) ++ return 2; ++ else if (hal_data->rf_type == RF_4T4R) ++ return 3; ++ else ++ return 1; ++ } else ++ return 1; ++ ++} ++u8 rtw_hal_query_txbfee_rf_num(_adapter *adapter) ++{ ++ struct registry_priv *pregistrypriv = &adapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ ++ if ((pregistrypriv->beamformee_rf_num) && (IS_HARDWARE_TYPE_8814AE(adapter) || IS_HARDWARE_TYPE_8814AU(adapter) || IS_HARDWARE_TYPE_8822BU(adapter) || IS_HARDWARE_TYPE_8821C(adapter))) ++ return pregistrypriv->beamformee_rf_num; ++ else if (IS_HARDWARE_TYPE_8814AE(adapter) || IS_HARDWARE_TYPE_8814AU(adapter)) { ++ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_BROADCOM) ++ return 2; ++ else ++ return 2;/*TODO: May be 3 in the future, by ChenYu. */ ++ } else ++ return 1; ++ ++} ++#endif ++ ++u8 ++GetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ u8 bResult = _SUCCESS; ++ ++ switch (variable) { ++ case HAL_DEF_UNDERCORATEDSMOOTHEDPWDB: { ++ struct mlme_priv *pmlmepriv; ++ struct sta_priv *pstapriv; ++ struct sta_info *psta; ++ ++ pmlmepriv = &adapter->mlmepriv; ++ pstapriv = &adapter->stapriv; ++ psta = rtw_get_stainfo(pstapriv, pmlmepriv->cur_network.network.MacAddress); ++ if (psta) ++ *((int *)value) = psta->rssi_stat.UndecoratedSmoothedPWDB; ++ } ++ break; ++ case HAL_DEF_DBG_DUMP_RXPKT: ++ *((u8 *)value) = hal_data->bDumpRxPkt; ++ break; ++ case HAL_DEF_DBG_DUMP_TXPKT: ++ *((u8 *)value) = hal_data->bDumpTxPkt; ++ break; ++ case HAL_DEF_ANT_DETECT: ++ *((u8 *)value) = hal_data->AntDetection; ++ break; ++ case HAL_DEF_MACID_SLEEP: ++ *(u8 *)value = _FALSE; ++ break; ++ case HAL_DEF_TX_PAGE_SIZE: ++ *((u32 *)value) = PAGE_SIZE_128; ++ break; ++ case HAL_DEF_DBG_DIS_PWT: ++ *(u8 *)value = hal_data->bDisableTXPowerTraining; ++ break; ++ case HAL_DEF_EXPLICIT_BEAMFORMER: ++ case HAL_DEF_EXPLICIT_BEAMFORMEE: ++ case HAL_DEF_VHT_MU_BEAMFORMER: ++ case HAL_DEF_VHT_MU_BEAMFORMEE: ++ *(u8 *)value = _FALSE; ++ break; ++#ifdef CONFIG_BEAMFORMING ++ case HAL_DEF_BEAMFORMER_CAP: ++ *(u8 *)value = rtw_hal_query_txbfer_rf_num(adapter); ++ break; ++ case HAL_DEF_BEAMFORMEE_CAP: ++ *(u8 *)value = rtw_hal_query_txbfee_rf_num(adapter); ++ break; ++#endif ++ default: ++ RTW_PRINT("%s: [WARNING] HAL_DEF_VARIABLE(%d) not defined!\n", __FUNCTION__, variable); ++ bResult = _FAIL; ++ break; ++ } ++ ++ return bResult; ++} ++ ++void SetHalODMVar( ++ PADAPTER Adapter, ++ HAL_ODM_VARIABLE eVariable, ++ PVOID pValue1, ++ BOOLEAN bSet) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T podmpriv = &pHalData->odmpriv; ++ /* _irqL irqL; */ ++ switch (eVariable) { ++ case HAL_ODM_STA_INFO: { ++ struct sta_info *psta = (struct sta_info *)pValue1; ++ if (bSet) { ++ RTW_INFO("### Set STA_(%d) info ###\n", psta->mac_id); ++ ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS, psta->mac_id, psta); ++ } else { ++ RTW_INFO("### Clean STA_(%d) info ###\n", psta->mac_id); ++ /* _enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ ++ ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS, psta->mac_id, NULL); ++ ++ /* _exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ ++ } ++ } ++ break; ++ case HAL_ODM_P2P_STATE: ++ ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_WIFI_DIRECT, bSet); ++ break; ++ case HAL_ODM_WIFI_DISPLAY_STATE: ++ ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_WIFI_DISPLAY, bSet); ++ break; ++ case HAL_ODM_REGULATION: ++ ODM_CmnInfoInit(podmpriv, ODM_CMNINFO_DOMAIN_CODE_2G, pHalData->Regulation2_4G); ++ ODM_CmnInfoInit(podmpriv, ODM_CMNINFO_DOMAIN_CODE_5G, pHalData->Regulation5G); ++ break; ++#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) ++ case HAL_ODM_NOISE_MONITOR: { ++ struct noise_info *pinfo = (struct noise_info *)pValue1; ++ ++#ifdef DBG_NOISE_MONITOR ++ RTW_INFO("### Noise monitor chan(%d)-bPauseDIG:%d,IGIValue:0x%02x,max_time:%d (ms) ###\n", ++ pinfo->chan, pinfo->bPauseDIG, pinfo->IGIValue, pinfo->max_time); ++#endif ++ ++ pHalData->noise[pinfo->chan] = ODM_InbandNoise_Monitor(podmpriv, pinfo->bPauseDIG, pinfo->IGIValue, pinfo->max_time); ++ RTW_INFO("chan_%d, noise = %d (dBm)\n", pinfo->chan, pHalData->noise[pinfo->chan]); ++#ifdef DBG_NOISE_MONITOR ++ RTW_INFO("noise_a = %d, noise_b = %d noise_all:%d\n", ++ podmpriv->noise_level.noise[ODM_RF_PATH_A], ++ podmpriv->noise_level.noise[ODM_RF_PATH_B], ++ podmpriv->noise_level.noise_all); ++#endif ++ } ++ break; ++#endif/*#ifdef CONFIG_BACKGROUND_NOISE_MONITOR*/ ++ ++ case HAL_ODM_INITIAL_GAIN: { ++ u8 rx_gain = *((u8 *)(pValue1)); ++ /*printk("rx_gain:%x\n",rx_gain);*/ ++ if (rx_gain == 0xff) {/*restore rx gain*/ ++ /*ODM_Write_DIG(podmpriv,pDigTable->BackupIGValue);*/ ++ odm_PauseDIG(podmpriv, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_0, rx_gain); ++ } else { ++ /*pDigTable->BackupIGValue = pDigTable->CurIGValue;*/ ++ /*ODM_Write_DIG(podmpriv,rx_gain);*/ ++ odm_PauseDIG(podmpriv, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_0, rx_gain); ++ } ++ } ++ break; ++ case HAL_ODM_FA_CNT_DUMP: ++ if (*((u8 *)pValue1)) ++ podmpriv->DebugComponents |= (ODM_COMP_DIG | ODM_COMP_FA_CNT); ++ else ++ podmpriv->DebugComponents &= ~(ODM_COMP_DIG | ODM_COMP_FA_CNT); ++ break; ++ case HAL_ODM_DBG_FLAG: ++ ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_DBG_COMP, *((u8Byte *)pValue1)); ++ break; ++ case HAL_ODM_DBG_LEVEL: ++ ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_DBG_LEVEL, *((u4Byte *)pValue1)); ++ break; ++ case HAL_ODM_RX_INFO_DUMP: { ++ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure(podmpriv , PHYDM_FALSEALMCNT); ++ pDIG_T pDM_DigTable = &podmpriv->DM_DigTable; ++ void *sel; ++ ++ sel = pValue1; ++ ++ _RTW_PRINT_SEL(sel , "============ Rx Info dump ===================\n"); ++ _RTW_PRINT_SEL(sel , "bLinked = %d, RSSI_Min = %d(%%), CurrentIGI = 0x%x\n", podmpriv->bLinked, podmpriv->RSSI_Min, pDM_DigTable->CurIGValue); ++ _RTW_PRINT_SEL(sel , "Cnt_Cck_fail = %d, Cnt_Ofdm_fail = %d, Total False Alarm = %d\n", FalseAlmCnt->Cnt_Cck_fail, FalseAlmCnt->Cnt_Ofdm_fail, FalseAlmCnt->Cnt_all); ++ ++ if (podmpriv->bLinked) { ++ _RTW_PRINT_SEL(sel , "RxRate = %s", HDATA_RATE(podmpriv->RxRate)); ++ _RTW_PRINT_SEL(sel , " RSSI_A = %d(%%), RSSI_B = %d(%%)\n", podmpriv->RSSI_A, podmpriv->RSSI_B); ++#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA ++ rtw_dump_raw_rssi_info(Adapter, sel); ++#endif ++ } ++ } ++ break; ++ case HAL_ODM_RX_Dframe_INFO: { ++ void *sel; ++ ++ sel = pValue1; ++ ++ /*_RTW_PRINT_SEL(sel , "HAL_ODM_RX_Dframe_INFO\n");*/ ++#ifdef DBG_RX_DFRAME_RAW_DATA ++ rtw_dump_rx_dframe_info(Adapter, sel); ++#endif ++ } ++ break; ++ ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++ case HAL_ODM_AUTO_CHNL_SEL: { ++ ACS_OP acs_op = *(ACS_OP *)pValue1; ++ ++ rtw_phydm_func_set(Adapter, ODM_BB_NHM_CNT); ++ ++ if (ACS_INIT == acs_op) { ++#ifdef DBG_AUTO_CHNL_SEL_NHM ++ RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: ACS_INIT\n", ADPT_ARG(Adapter)); ++#endif ++ odm_AutoChannelSelectInit(podmpriv); ++ } else if (ACS_RESET == acs_op) { ++ /* Reset statistics for auto channel selection mechanism.*/ ++#ifdef DBG_AUTO_CHNL_SEL_NHM ++ RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: ACS_RESET\n", ADPT_ARG(Adapter)); ++#endif ++ odm_AutoChannelSelectReset(podmpriv); ++ ++ } else if (ACS_SELECT == acs_op) { ++ /* Collect NHM measurement result after current channel */ ++#ifdef DBG_AUTO_CHNL_SEL_NHM ++ RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: ACS_SELECT, CH(%d)\n", ADPT_ARG(Adapter), rtw_get_acs_channel(Adapter)); ++#endif ++ odm_AutoChannelSelect(podmpriv, rtw_get_acs_channel(Adapter)); ++ } else ++ RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: Unexpected OP\n", ADPT_ARG(Adapter)); ++ ++ } ++ break; ++#endif ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ case HAL_ODM_ANTDIV_SELECT: { ++ u8 antenna = (*(u8 *)pValue1); ++ ++ /*switch antenna*/ ++ ODM_UpdateRxIdleAnt(&pHalData->odmpriv, antenna); ++ /*RTW_INFO("==> HAL_ODM_ANTDIV_SELECT, Ant_(%s)\n", (antenna == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT");*/ ++ ++ } ++ break; ++#endif ++ ++ default: ++ break; ++ } ++} ++ ++void GetHalODMVar( ++ PADAPTER Adapter, ++ HAL_ODM_VARIABLE eVariable, ++ PVOID pValue1, ++ PVOID pValue2) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T podmpriv = &pHalData->odmpriv; ++ ++ switch (eVariable) { ++#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) ++ case HAL_ODM_NOISE_MONITOR: { ++ u8 chan = *(u8 *)pValue1; ++ *(s16 *)pValue2 = pHalData->noise[chan]; ++#ifdef DBG_NOISE_MONITOR ++ RTW_INFO("### Noise monitor chan(%d)-noise:%d (dBm) ###\n", ++ chan, pHalData->noise[chan]); ++#endif ++ } ++ break; ++#endif/*#ifdef CONFIG_BACKGROUND_NOISE_MONITOR*/ ++ case HAL_ODM_DBG_FLAG: ++ *((u8Byte *)pValue1) = podmpriv->DebugComponents; ++ break; ++ case HAL_ODM_DBG_LEVEL: ++ *((u4Byte *)pValue1) = podmpriv->DebugLevel; ++ break; ++ ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++ case HAL_ODM_AUTO_CHNL_SEL: { ++#ifdef DBG_AUTO_CHNL_SEL_NHM ++ RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: GET_BEST_CHAN\n", ADPT_ARG(Adapter)); ++#endif ++ /* Retrieve better channel from NHM mechanism */ ++ if (IsSupported24G(Adapter->registrypriv.wireless_mode)) ++ *((u8 *)(pValue1)) = ODM_GetAutoChannelSelectResult(podmpriv, BAND_ON_2_4G); ++ if (IsSupported5G(Adapter->registrypriv.wireless_mode)) ++ *((u8 *)(pValue2)) = ODM_GetAutoChannelSelectResult(podmpriv, BAND_ON_5G); ++ } ++ break; ++#endif ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ case HAL_ODM_ANTDIV_SELECT: { ++ pFAT_T pDM_FatTable = &podmpriv->DM_FatTable; ++ *((u8 *)pValue1) = pDM_FatTable->RxIdleAnt; ++ } ++ break; ++#endif ++ case HAL_ODM_INITIAL_GAIN: { ++ pDIG_T pDM_DigTable = &podmpriv->DM_DigTable; ++ *((u8 *)pValue1) = pDM_DigTable->CurIGValue; ++ } ++ break; ++ default: ++ break; ++ } ++} ++ ++ ++u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); ++ PDM_ODM_T podmpriv = &pHalData->odmpriv; ++ u32 result = 0; ++ ++ switch (ops) { ++ case HAL_PHYDM_DIS_ALL_FUNC: ++ podmpriv->SupportAbility = DYNAMIC_FUNC_DISABLE; ++ break; ++ case HAL_PHYDM_FUNC_SET: ++ podmpriv->SupportAbility |= ability; ++ break; ++ case HAL_PHYDM_FUNC_CLR: ++ podmpriv->SupportAbility &= ~(ability); ++ break; ++ case HAL_PHYDM_ABILITY_BK: ++ /* dm flag backup*/ ++ podmpriv->BK_SupportAbility = podmpriv->SupportAbility; ++ break; ++ case HAL_PHYDM_ABILITY_RESTORE: ++ /* restore dm flag */ ++ podmpriv->SupportAbility = podmpriv->BK_SupportAbility; ++ break; ++ case HAL_PHYDM_ABILITY_SET: ++ podmpriv->SupportAbility = ability; ++ break; ++ case HAL_PHYDM_ABILITY_GET: ++ result = podmpriv->SupportAbility; ++ break; ++ } ++ return result; ++} ++ ++ ++BOOLEAN ++eqNByte( ++ u8 *str1, ++ u8 *str2, ++ u32 num ++) ++{ ++ if (num == 0) ++ return _FALSE; ++ while (num > 0) { ++ num--; ++ if (str1[num] != str2[num]) ++ return _FALSE; ++ } ++ return _TRUE; ++} ++ ++/* ++ * Description: ++ * Translate a character to hex digit. ++ * */ ++u32 ++MapCharToHexDigit( ++ IN char chTmp ++) ++{ ++ if (chTmp >= '0' && chTmp <= '9') ++ return chTmp - '0'; ++ else if (chTmp >= 'a' && chTmp <= 'f') ++ return 10 + (chTmp - 'a'); ++ else if (chTmp >= 'A' && chTmp <= 'F') ++ return 10 + (chTmp - 'A'); ++ else ++ return 0; ++} ++ ++ ++ ++/* ++ * Description: ++ * Parse hex number from the string pucStr. ++ * */ ++BOOLEAN ++GetHexValueFromString( ++ IN char *szStr, ++ IN OUT u32 *pu4bVal, ++ IN OUT u32 *pu4bMove ++) ++{ ++ char *szScan = szStr; ++ ++ /* Check input parameter. */ ++ if (szStr == NULL || pu4bVal == NULL || pu4bMove == NULL) { ++ RTW_INFO("GetHexValueFromString(): Invalid inpur argumetns! szStr: %p, pu4bVal: %p, pu4bMove: %p\n", szStr, pu4bVal, pu4bMove); ++ return _FALSE; ++ } ++ ++ /* Initialize output. */ ++ *pu4bMove = 0; ++ *pu4bVal = 0; ++ ++ /* Skip leading space. */ ++ while (*szScan != '\0' && ++ (*szScan == ' ' || *szScan == '\t')) { ++ szScan++; ++ (*pu4bMove)++; ++ } ++ ++ /* Skip leading '0x' or '0X'. */ ++ if (*szScan == '0' && (*(szScan + 1) == 'x' || *(szScan + 1) == 'X')) { ++ szScan += 2; ++ (*pu4bMove) += 2; ++ } ++ ++ /* Check if szScan is now pointer to a character for hex digit, */ ++ /* if not, it means this is not a valid hex number. */ ++ if (!IsHexDigit(*szScan)) ++ return _FALSE; ++ ++ /* Parse each digit. */ ++ do { ++ (*pu4bVal) <<= 4; ++ *pu4bVal += MapCharToHexDigit(*szScan); ++ ++ szScan++; ++ (*pu4bMove)++; ++ } while (IsHexDigit(*szScan)); ++ ++ return _TRUE; ++} ++ ++BOOLEAN ++GetFractionValueFromString( ++ IN char *szStr, ++ IN OUT u8 *pInteger, ++ IN OUT u8 *pFraction, ++ IN OUT u32 *pu4bMove ++) ++{ ++ char *szScan = szStr; ++ ++ /* Initialize output. */ ++ *pu4bMove = 0; ++ *pInteger = 0; ++ *pFraction = 0; ++ ++ /* Skip leading space. */ ++ while (*szScan != '\0' && (*szScan == ' ' || *szScan == '\t')) { ++ ++szScan; ++ ++(*pu4bMove); ++ } ++ ++ /* Parse each digit. */ ++ do { ++ (*pInteger) *= 10; ++ *pInteger += (*szScan - '0'); ++ ++ ++szScan; ++ ++(*pu4bMove); ++ ++ if (*szScan == '.') { ++ ++szScan; ++ ++(*pu4bMove); ++ ++ if (*szScan < '0' || *szScan > '9') ++ return _FALSE; ++ else { ++ *pFraction = *szScan - '0'; ++ ++szScan; ++ ++(*pu4bMove); ++ return _TRUE; ++ } ++ } ++ } while (*szScan >= '0' && *szScan <= '9'); ++ ++ return _TRUE; ++} ++ ++/* ++ * Description: ++ * Return TRUE if szStr is comment out with leading " */ /* ". ++ * */ ++BOOLEAN ++IsCommentString( ++ IN char *szStr ++) ++{ ++ if (*szStr == '/' && *(szStr + 1) == '/') ++ return _TRUE; ++ else ++ return _FALSE; ++} ++ ++BOOLEAN ++GetU1ByteIntegerFromStringInDecimal( ++ IN char *Str, ++ IN OUT u8 *pInt ++) ++{ ++ u16 i = 0; ++ *pInt = 0; ++ ++ while (Str[i] != '\0') { ++ if (Str[i] >= '0' && Str[i] <= '9') { ++ *pInt *= 10; ++ *pInt += (Str[i] - '0'); ++ } else ++ return _FALSE; ++ ++i; ++ } ++ ++ return _TRUE; ++} ++ ++/* <20121004, Kordan> For example, ++ * ParseQualifiedString(inString, 0, outString, '[', ']') gets "Kordan" from a string "Hello [Kordan]". ++ * If RightQualifier does not exist, it will hang on in the while loop */ ++BOOLEAN ++ParseQualifiedString( ++ IN char *In, ++ IN OUT u32 *Start, ++ OUT char *Out, ++ IN char LeftQualifier, ++ IN char RightQualifier ++) ++{ ++ u32 i = 0, j = 0; ++ char c = In[(*Start)++]; ++ ++ if (c != LeftQualifier) ++ return _FALSE; ++ ++ i = (*Start); ++ while ((c = In[(*Start)++]) != RightQualifier) ++ ; /* find ']' */ ++ j = (*Start) - 2; ++ strncpy((char *)Out, (const char *)(In + i), j - i + 1); ++ ++ return _TRUE; ++} ++ ++BOOLEAN ++isAllSpaceOrTab( ++ u8 *data, ++ u8 size ++) ++{ ++ u8 cnt = 0, NumOfSpaceAndTab = 0; ++ ++ while (size > cnt) { ++ if (data[cnt] == ' ' || data[cnt] == '\t' || data[cnt] == '\0') ++ ++NumOfSpaceAndTab; ++ ++ ++cnt; ++ } ++ ++ return size == NumOfSpaceAndTab; ++} ++ ++ ++void rtw_hal_check_rxfifo_full(_adapter *adapter) ++{ ++ struct dvobj_priv *psdpriv = adapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); ++ struct registry_priv *regsty = &adapter->registrypriv; ++ int save_cnt = _FALSE; ++ ++ if (regsty->check_hw_status == 1) { ++ /* switch counter to RX fifo */ ++ if (IS_8188E(pHalData->VersionID) || ++ IS_8188F(pHalData->VersionID) || ++ IS_8812_SERIES(pHalData->VersionID) || ++ IS_8821_SERIES(pHalData->VersionID) || ++ IS_8723B_SERIES(pHalData->VersionID) || ++ IS_8192E(pHalData->VersionID) || ++ IS_8703B_SERIES(pHalData->VersionID) || ++ IS_8723D_SERIES(pHalData->VersionID)) { ++ rtw_write8(adapter, REG_RXERR_RPT + 3, rtw_read8(adapter, REG_RXERR_RPT + 3) | 0xa0); ++ save_cnt = _TRUE; ++ } else { ++ /* todo: other chips */ ++ } ++ ++ ++ if (save_cnt) { ++ pdbgpriv->dbg_rx_fifo_last_overflow = pdbgpriv->dbg_rx_fifo_curr_overflow; ++ pdbgpriv->dbg_rx_fifo_curr_overflow = rtw_read16(adapter, REG_RXERR_RPT); ++ pdbgpriv->dbg_rx_fifo_diff_overflow = pdbgpriv->dbg_rx_fifo_curr_overflow - pdbgpriv->dbg_rx_fifo_last_overflow; ++ } else { ++ /* special value to indicate no implementation */ ++ pdbgpriv->dbg_rx_fifo_last_overflow = 1; ++ pdbgpriv->dbg_rx_fifo_curr_overflow = 1; ++ pdbgpriv->dbg_rx_fifo_diff_overflow = 1; ++ } ++ } ++} ++ ++void linked_info_dump(_adapter *padapter, u8 benable) ++{ ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++ ++ if (padapter->bLinkInfoDump == benable) ++ return; ++ ++ RTW_INFO("%s %s\n", __FUNCTION__, (benable) ? "enable" : "disable"); ++ ++ if (benable) { ++#ifdef CONFIG_LPS ++ pwrctrlpriv->org_power_mgnt = pwrctrlpriv->power_mgnt;/* keep org value */ ++ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); ++#endif ++ ++#ifdef CONFIG_IPS ++ pwrctrlpriv->ips_org_mode = pwrctrlpriv->ips_mode;/* keep org value */ ++ rtw_pm_set_ips(padapter, IPS_NONE); ++#endif ++ } else { ++#ifdef CONFIG_IPS ++ rtw_pm_set_ips(padapter, pwrctrlpriv->ips_org_mode); ++#endif /* CONFIG_IPS */ ++ ++#ifdef CONFIG_LPS ++ rtw_pm_set_lps(padapter, pwrctrlpriv->org_power_mgnt); ++#endif /* CONFIG_LPS */ ++ } ++ padapter->bLinkInfoDump = benable ; ++} ++ ++#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA ++void rtw_get_raw_rssi_info(void *sel, _adapter *padapter) ++{ ++ u8 isCCKrate, rf_path; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; ++ RTW_PRINT_SEL(sel, "RxRate = %s, PWDBALL = %d(%%), rx_pwr_all = %d(dBm)\n", ++ HDATA_RATE(psample_pkt_rssi->data_rate), psample_pkt_rssi->pwdball, psample_pkt_rssi->pwr_all); ++ isCCKrate = (psample_pkt_rssi->data_rate <= DESC_RATE11M) ? TRUE : FALSE; ++ ++ if (isCCKrate) ++ psample_pkt_rssi->mimo_signal_strength[0] = psample_pkt_rssi->pwdball; ++ ++ for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { ++ RTW_PRINT_SEL(sel, "RF_PATH_%d=>signal_strength:%d(%%),signal_quality:%d(%%)\n" ++ , rf_path, psample_pkt_rssi->mimo_signal_strength[rf_path], psample_pkt_rssi->mimo_signal_quality[rf_path]); ++ ++ if (!isCCKrate) { ++ RTW_PRINT_SEL(sel, "\trx_ofdm_pwr:%d(dBm),rx_ofdm_snr:%d(dB)\n", ++ psample_pkt_rssi->ofdm_pwr[rf_path], psample_pkt_rssi->ofdm_snr[rf_path]); ++ } ++ } ++} ++ ++void rtw_dump_raw_rssi_info(_adapter *padapter, void *sel) ++{ ++ u8 isCCKrate, rf_path; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; ++ _RTW_PRINT_SEL(sel, "============ RAW Rx Info dump ===================\n"); ++ _RTW_PRINT_SEL(sel, "RxRate = %s, PWDBALL = %d(%%), rx_pwr_all = %d(dBm)\n", HDATA_RATE(psample_pkt_rssi->data_rate), psample_pkt_rssi->pwdball, psample_pkt_rssi->pwr_all); ++ ++ isCCKrate = (psample_pkt_rssi->data_rate <= DESC_RATE11M) ? TRUE : FALSE; ++ ++ if (isCCKrate) ++ psample_pkt_rssi->mimo_signal_strength[0] = psample_pkt_rssi->pwdball; ++ ++ for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { ++ _RTW_PRINT_SEL(sel , "RF_PATH_%d=>signal_strength:%d(%%),signal_quality:%d(%%)" ++ , rf_path, psample_pkt_rssi->mimo_signal_strength[rf_path], psample_pkt_rssi->mimo_signal_quality[rf_path]); ++ ++ if (!isCCKrate) ++ _RTW_PRINT_SEL(sel , ",rx_ofdm_pwr:%d(dBm),rx_ofdm_snr:%d(dB)\n", psample_pkt_rssi->ofdm_pwr[rf_path], psample_pkt_rssi->ofdm_snr[rf_path]); ++ else ++ _RTW_PRINT_SEL(sel , "\n"); ++ ++ } ++} ++#endif ++ ++#ifdef DBG_RX_DFRAME_RAW_DATA ++void rtw_dump_rx_dframe_info(_adapter *padapter, void *sel) ++{ ++ _irqL irqL; ++ u8 isCCKrate, rf_path; ++ struct recv_priv *precvpriv = &(padapter->recvpriv); ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta; ++ struct sta_recv_dframe_info *psta_dframe_info; ++ int i; ++ _list *plist, *phead; ++ char *BW; ++ u8 bc_addr[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ u8 null_addr[6] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; ++ ++ if (precvpriv->store_law_data_flag) { ++ ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ for (i = 0; i < NUM_STA; i++) { ++ phead = &(pstapriv->sta_hash[i]); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ ++ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); ++ plist = get_next(plist); ++ ++ if (psta) { ++ psta_dframe_info = &psta->sta_dframe_info; ++ if ((_rtw_memcmp(psta->hwaddr, bc_addr, 6) != _TRUE) ++ && (_rtw_memcmp(psta->hwaddr, null_addr, 6) != _TRUE) ++ && (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), 6) != _TRUE)) { ++ ++ ++ isCCKrate = (psta_dframe_info->sta_data_rate <= DESC_RATE11M) ? TRUE : FALSE; ++ ++ switch (psta_dframe_info->sta_bw_mode) { ++ ++ case CHANNEL_WIDTH_20: ++ BW = "20M"; ++ break; ++ ++ case CHANNEL_WIDTH_40: ++ BW = "40M"; ++ break; ++ ++ case CHANNEL_WIDTH_80: ++ BW = "80M"; ++ break; ++ ++ case CHANNEL_WIDTH_160: ++ BW = "160M"; ++ break; ++ ++ default: ++ BW = ""; ++ break; ++ } ++ ++ RTW_PRINT_SEL(sel, "==============================\n"); ++ _RTW_PRINT_SEL(sel, "macaddr =" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); ++ _RTW_PRINT_SEL(sel, "BW=%s, sgi =%d\n", BW, psta_dframe_info->sta_sgi); ++ _RTW_PRINT_SEL(sel, "Rx_Data_Rate = %s\n", HDATA_RATE(psta_dframe_info->sta_data_rate)); ++ ++ for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { ++ ++ if (!isCCKrate) { ++ ++ _RTW_PRINT_SEL(sel , "RF_PATH_%d RSSI:%d(dBm)", rf_path, psta_dframe_info->sta_RxPwr[rf_path]); ++ _RTW_PRINT_SEL(sel , ",rx_ofdm_snr:%d(dB)\n", psta_dframe_info->sta_ofdm_snr[rf_path]); ++ ++ } else ++ ++ _RTW_PRINT_SEL(sel , "RF_PATH_%d RSSI:%d(dBm)\n", rf_path, (psta_dframe_info->sta_mimo_signal_strength[rf_path]) - 100); ++ } ++ } ++ } ++ } ++ } ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ } ++} ++#endif ++void rtw_store_phy_info(_adapter *padapter, union recv_frame *prframe) ++{ ++ u8 isCCKrate, rf_path , dframe_type; ++ u8 *ptr; ++ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++#ifdef DBG_RX_DFRAME_RAW_DATA ++ struct sta_recv_dframe_info *psta_dframe_info; ++#endif ++ struct recv_priv *precvpriv = &(padapter->recvpriv); ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; ++ struct sta_info *psta = prframe->u.hdr.psta; ++ PODM_PHY_INFO_T pPhyInfo = (PODM_PHY_INFO_T)(&pattrib->phy_info); ++ struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; ++ psample_pkt_rssi->data_rate = pattrib->data_rate; ++ ptr = prframe->u.hdr.rx_data; ++ dframe_type = GetFrameType(ptr); ++ /*RTW_INFO("=>%s\n", __FUNCTION__);*/ ++ ++ ++ if (precvpriv->store_law_data_flag) { ++ isCCKrate = (pattrib->data_rate <= DESC_RATE11M) ? TRUE : FALSE; ++ ++ psample_pkt_rssi->pwdball = pPhyInfo->RxPWDBAll; ++ psample_pkt_rssi->pwr_all = pPhyInfo->RecvSignalPower; ++ ++ for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { ++ psample_pkt_rssi->mimo_signal_strength[rf_path] = pPhyInfo->RxMIMOSignalStrength[rf_path]; ++ psample_pkt_rssi->mimo_signal_quality[rf_path] = pPhyInfo->RxMIMOSignalQuality[rf_path]; ++ if (!isCCKrate) { ++ psample_pkt_rssi->ofdm_pwr[rf_path] = pPhyInfo->RxPwr[rf_path]; ++ psample_pkt_rssi->ofdm_snr[rf_path] = pPhyInfo->RxSNR[rf_path]; ++ } ++ } ++#ifdef DBG_RX_DFRAME_RAW_DATA ++ if ((dframe_type == WIFI_DATA_TYPE) || (dframe_type == WIFI_QOS_DATA_TYPE) || (padapter->registrypriv.mp_mode == 1)) { ++ ++ /*RTW_INFO("=>%s WIFI_DATA_TYPE or WIFI_QOS_DATA_TYPE\n", __FUNCTION__);*/ ++ if (psta) { ++ psta_dframe_info = &psta->sta_dframe_info; ++ /*RTW_INFO("=>%s psta->hwaddr="MAC_FMT" !\n", __FUNCTION__, MAC_ARG(psta->hwaddr));*/ ++ if ((_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN) != _TRUE) || (padapter->registrypriv.mp_mode == 1)) { ++ psta_dframe_info->sta_data_rate = pattrib->data_rate; ++ psta_dframe_info->sta_sgi = pattrib->sgi; ++ psta_dframe_info->sta_bw_mode = pattrib->bw; ++ for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { ++ ++ psta_dframe_info->sta_mimo_signal_strength[rf_path] = (pPhyInfo->RxMIMOSignalStrength[rf_path]);/*Percentage to dbm*/ ++ ++ if (!isCCKrate) { ++ psta_dframe_info->sta_ofdm_snr[rf_path] = pPhyInfo->RxSNR[rf_path]; ++ psta_dframe_info->sta_RxPwr[rf_path] = pPhyInfo->RxPwr[rf_path]; ++ } ++ } ++ } ++ } ++ } ++#endif ++ } ++ ++} ++ ++ ++int check_phy_efuse_tx_power_info_valid(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ u8 *pContent = pHalData->efuse_eeprom_data; ++ int index = 0; ++ u16 tx_index_offset = 0x0000; ++ ++ switch (rtw_get_chip_type(padapter)) { ++ case RTL8723B: ++ tx_index_offset = EEPROM_TX_PWR_INX_8723B; ++ break; ++ case RTL8703B: ++ tx_index_offset = EEPROM_TX_PWR_INX_8703B; ++ break; ++ case RTL8723D: ++ tx_index_offset = EEPROM_TX_PWR_INX_8723D; ++ break; ++ case RTL8188E: ++ tx_index_offset = EEPROM_TX_PWR_INX_88E; ++ break; ++ case RTL8188F: ++ tx_index_offset = EEPROM_TX_PWR_INX_8188F; ++ break; ++ case RTL8192E: ++ tx_index_offset = EEPROM_TX_PWR_INX_8192E; ++ break; ++ case RTL8821: ++ tx_index_offset = EEPROM_TX_PWR_INX_8821; ++ break; ++ case RTL8812: ++ tx_index_offset = EEPROM_TX_PWR_INX_8812; ++ break; ++ case RTL8814A: ++ tx_index_offset = EEPROM_TX_PWR_INX_8814; ++ break; ++ case RTL8822B: ++ tx_index_offset = EEPROM_TX_PWR_INX_8822B; ++ break; ++ case RTL8821C: ++ tx_index_offset = EEPROM_TX_PWR_INX_8821C; ++ break; ++ default: ++ tx_index_offset = 0x0010; ++ break; ++ } ++ ++ /* TODO: chacking length by ICs */ ++ for (index = 0 ; index < 11 ; index++) { ++ if (pContent[tx_index_offset + index] == 0xFF) ++ return _FALSE; ++ } ++ return _TRUE; ++} ++ ++int hal_efuse_macaddr_offset(_adapter *adapter) ++{ ++ u8 interface_type = 0; ++ int addr_offset = -1; ++ ++ interface_type = rtw_get_intf_type(adapter); ++ ++ switch (rtw_get_chip_type(adapter)) { ++#ifdef CONFIG_RTL8723B ++ case RTL8723B: ++ if (interface_type == RTW_USB) ++ addr_offset = EEPROM_MAC_ADDR_8723BU; ++ else if (interface_type == RTW_SDIO) ++ addr_offset = EEPROM_MAC_ADDR_8723BS; ++ else if (interface_type == RTW_PCIE) ++ addr_offset = EEPROM_MAC_ADDR_8723BE; ++ break; ++#endif ++#ifdef CONFIG_RTL8703B ++ case RTL8703B: ++ if (interface_type == RTW_USB) ++ addr_offset = EEPROM_MAC_ADDR_8703BU; ++ else if (interface_type == RTW_SDIO) ++ addr_offset = EEPROM_MAC_ADDR_8703BS; ++ break; ++#endif ++#ifdef CONFIG_RTL8723D ++ case RTL8723D: ++ if (interface_type == RTW_USB) ++ addr_offset = EEPROM_MAC_ADDR_8723DU; ++ else if (interface_type == RTW_SDIO) ++ addr_offset = EEPROM_MAC_ADDR_8723DS; ++ else if (interface_type == RTW_PCIE) ++ addr_offset = EEPROM_MAC_ADDR_8723DE; ++ break; ++#endif ++ ++#ifdef CONFIG_RTL8188E ++ case RTL8188E: ++ if (interface_type == RTW_USB) ++ addr_offset = EEPROM_MAC_ADDR_88EU; ++ else if (interface_type == RTW_SDIO) ++ addr_offset = EEPROM_MAC_ADDR_88ES; ++ else if (interface_type == RTW_PCIE) ++ addr_offset = EEPROM_MAC_ADDR_88EE; ++ break; ++#endif ++#ifdef CONFIG_RTL8188F ++ case RTL8188F: ++ if (interface_type == RTW_USB) ++ addr_offset = EEPROM_MAC_ADDR_8188FU; ++ else if (interface_type == RTW_SDIO) ++ addr_offset = EEPROM_MAC_ADDR_8188FS; ++ break; ++#endif ++#ifdef CONFIG_RTL8812A ++ case RTL8812: ++ if (interface_type == RTW_USB) ++ addr_offset = EEPROM_MAC_ADDR_8812AU; ++ else if (interface_type == RTW_PCIE) ++ addr_offset = EEPROM_MAC_ADDR_8812AE; ++ break; ++#endif ++#ifdef CONFIG_RTL8821A ++ case RTL8821: ++ if (interface_type == RTW_USB) ++ addr_offset = EEPROM_MAC_ADDR_8821AU; ++ else if (interface_type == RTW_SDIO) ++ addr_offset = EEPROM_MAC_ADDR_8821AS; ++ else if (interface_type == RTW_PCIE) ++ addr_offset = EEPROM_MAC_ADDR_8821AE; ++ break; ++#endif ++#ifdef CONFIG_RTL8192E ++ case RTL8192E: ++ if (interface_type == RTW_USB) ++ addr_offset = EEPROM_MAC_ADDR_8192EU; ++ else if (interface_type == RTW_SDIO) ++ addr_offset = EEPROM_MAC_ADDR_8192ES; ++ else if (interface_type == RTW_PCIE) ++ addr_offset = EEPROM_MAC_ADDR_8192EE; ++ break; ++#endif ++#ifdef CONFIG_RTL8814A ++ case RTL8814A: ++ if (interface_type == RTW_USB) ++ addr_offset = EEPROM_MAC_ADDR_8814AU; ++ else if (interface_type == RTW_PCIE) ++ addr_offset = EEPROM_MAC_ADDR_8814AE; ++ break; ++#endif ++ ++#ifdef CONFIG_RTL8822B ++ case RTL8822B: ++ if (interface_type == RTW_USB) ++ addr_offset = EEPROM_MAC_ADDR_8822BU; ++ else if (interface_type == RTW_SDIO) ++ addr_offset = EEPROM_MAC_ADDR_8822BS; ++ else if (interface_type == RTW_PCIE) ++ addr_offset = EEPROM_MAC_ADDR_8822BE; ++ break; ++#endif /* CONFIG_RTL8822B */ ++ ++#ifdef CONFIG_RTL8821C ++ case RTL8821C: ++ if (interface_type == RTW_USB) ++ addr_offset = EEPROM_MAC_ADDR_8821CU; ++ else if (interface_type == RTW_SDIO) ++ addr_offset = EEPROM_MAC_ADDR_8821CS; ++ else if (interface_type == RTW_PCIE) ++ addr_offset = EEPROM_MAC_ADDR_8821CE; ++ break; ++#endif /* CONFIG_RTL8821C */ ++ } ++ ++ if (addr_offset == -1) { ++ RTW_ERR("%s: unknown combination - chip_type:%u, interface:%u\n" ++ , __func__, rtw_get_chip_type(adapter), rtw_get_intf_type(adapter)); ++ } ++ ++ return addr_offset; ++} ++ ++int Hal_GetPhyEfuseMACAddr(PADAPTER padapter, u8 *mac_addr) ++{ ++ int ret = _FAIL; ++ int addr_offset; ++ ++ addr_offset = hal_efuse_macaddr_offset(padapter); ++ if (addr_offset == -1) ++ goto exit; ++ ++ ret = rtw_efuse_map_read(padapter, addr_offset, ETH_ALEN, mac_addr); ++ ++exit: ++ return ret; ++} ++ ++void rtw_dump_cur_efuse(PADAPTER padapter) ++{ ++ int i =0; ++ int mapsize =0; ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&mapsize, _FALSE); ++ ++ if (mapsize <= 0 || mapsize > EEPROM_MAX_SIZE) { ++ RTW_ERR("wrong map size %d\n", mapsize); ++ return; ++ } ++ ++ if (hal_data->efuse_file_status == EFUSE_FILE_LOADED) ++ RTW_INFO("EFUSE FILE\n"); ++ else ++ RTW_INFO("HW EFUSE\n"); ++ ++#ifdef CONFIG_RTW_DEBUG ++ for (i = 0; i < mapsize; i++) { ++ if (i % 16 == 0) ++ RTW_PRINT_SEL(RTW_DBGDUMP, "0x%03x: ", i); ++ ++ _RTW_PRINT_SEL(RTW_DBGDUMP, "%02X%s" ++ , hal_data->efuse_eeprom_data[i] ++ , ((i + 1) % 16 == 0) ? "\n" : (((i + 1) % 8 == 0) ? " " : " ") ++ ); ++ } ++ _RTW_PRINT_SEL(RTW_DBGDUMP, "\n"); ++#endif ++} ++ ++ ++#ifdef CONFIG_EFUSE_CONFIG_FILE ++u32 Hal_readPGDataFromConfigFile(PADAPTER padapter) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); ++ u32 ret = _FALSE; ++ u32 maplen = 0; ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&maplen, _FALSE); ++ ++ if (maplen < 256 || maplen > EEPROM_MAX_SIZE) { ++ RTW_ERR("eFuse length error :%d\n", maplen); ++ return _FALSE; ++ } ++ ++ ret = rtw_read_efuse_from_file(EFUSE_MAP_PATH, hal_data->efuse_eeprom_data, maplen); ++ ++ hal_data->efuse_file_status = ((ret == _FAIL) ? EFUSE_FILE_FAILED : EFUSE_FILE_LOADED); ++ ++ if (hal_data->efuse_file_status == EFUSE_FILE_LOADED) ++ rtw_dump_cur_efuse(padapter); ++ ++ return ret; ++} ++ ++u32 Hal_ReadMACAddrFromFile(PADAPTER padapter, u8 *mac_addr) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); ++ u32 ret = _FAIL; ++ ++ if (rtw_read_macaddr_from_file(WIFIMAC_PATH, mac_addr) == _SUCCESS ++ && rtw_check_invalid_mac_address(mac_addr, _TRUE) == _FALSE ++ ) { ++ hal_data->macaddr_file_status = MACADDR_FILE_LOADED; ++ ret = _SUCCESS; ++ } else ++ hal_data->macaddr_file_status = MACADDR_FILE_FAILED; ++ ++ return ret; ++} ++#endif /* CONFIG_EFUSE_CONFIG_FILE */ ++ ++int hal_config_macaddr(_adapter *adapter, bool autoload_fail) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ u8 addr[ETH_ALEN]; ++ int addr_offset = hal_efuse_macaddr_offset(adapter); ++ u8 *hw_addr = NULL; ++ int ret = _SUCCESS; ++ ++ if (autoload_fail) ++ goto bypass_hw_pg; ++ ++ if (addr_offset != -1) ++ hw_addr = &hal_data->efuse_eeprom_data[addr_offset]; ++ ++#ifdef CONFIG_EFUSE_CONFIG_FILE ++ /* if the hw_addr is written by efuse file, set to NULL */ ++ if (hal_data->efuse_file_status == EFUSE_FILE_LOADED) ++ hw_addr = NULL; ++#endif ++ ++ if (!hw_addr) { ++ /* try getting hw pg data */ ++ if (Hal_GetPhyEfuseMACAddr(adapter, addr) == _SUCCESS) ++ hw_addr = addr; ++ } ++ ++ /* check hw pg data */ ++ if (hw_addr && rtw_check_invalid_mac_address(hw_addr, _TRUE) == _FALSE) { ++ _rtw_memcpy(hal_data->EEPROMMACAddr, hw_addr, ETH_ALEN); ++ goto exit; ++ } ++ ++bypass_hw_pg: ++ ++#ifdef CONFIG_EFUSE_CONFIG_FILE ++ /* check wifi mac file */ ++ if (Hal_ReadMACAddrFromFile(adapter, addr) == _SUCCESS) { ++ _rtw_memcpy(hal_data->EEPROMMACAddr, addr, ETH_ALEN); ++ goto exit; ++ } ++#endif ++ ++ _rtw_memset(hal_data->EEPROMMACAddr, 0, ETH_ALEN); ++ ret = _FAIL; ++ ++exit: ++ return ret; ++} ++ ++#ifdef CONFIG_RF_POWER_TRIM ++u32 Array_kfreemap[] = { ++ 0x08, 0xe, ++ 0x06, 0xc, ++ 0x04, 0xa, ++ 0x02, 0x8, ++ 0x00, 0x6, ++ 0x03, 0x4, ++ 0x05, 0x2, ++ 0x07, 0x0, ++ 0x09, 0x0, ++ 0x0c, 0x0, ++}; ++ ++void rtw_bb_rf_gain_offset(_adapter *padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct registry_priv *registry_par = &padapter->registrypriv; ++ struct kfree_data_t *kfree_data = &pHalData->kfree_data; ++ u8 value = pHalData->EEPROMRFGainOffset; ++ u8 tmp = 0x3e; ++ u32 res, i = 0; ++ u4Byte ArrayLen = sizeof(Array_kfreemap) / sizeof(u32); ++ pu4Byte Array = Array_kfreemap; ++ u4Byte v1 = 0, v2 = 0, GainValue = 0, target = 0; ++ ++ if (registry_par->RegPwrTrimEnable == 2) { ++ RTW_INFO("Registry kfree default force disable.\n"); ++ return; ++ } ++ ++#if defined(CONFIG_RTL8723B) ++ if (value & BIT4 || (registry_par->RegPwrTrimEnable == 1)) { ++ RTW_INFO("Offset RF Gain.\n"); ++ RTW_INFO("Offset RF Gain. pHalData->EEPROMRFGainVal=0x%x\n", pHalData->EEPROMRFGainVal); ++ ++ if (pHalData->EEPROMRFGainVal != 0xff) { ++ ++ if (pHalData->ant_path == ODM_RF_PATH_A) ++ GainValue = (pHalData->EEPROMRFGainVal & 0x0f); ++ ++ else ++ GainValue = (pHalData->EEPROMRFGainVal & 0xf0) >> 4; ++ RTW_INFO("Ant PATH_%d GainValue Offset = 0x%x\n", (pHalData->ant_path == ODM_RF_PATH_A) ? (ODM_RF_PATH_A) : (ODM_RF_PATH_B), GainValue); ++ ++ for (i = 0; i < ArrayLen; i += 2) { ++ /* RTW_INFO("ArrayLen in =%d ,Array 1 =0x%x ,Array2 =0x%x\n",i,Array[i],Array[i]+1); */ ++ v1 = Array[i]; ++ v2 = Array[i + 1]; ++ if (v1 == GainValue) { ++ RTW_INFO("Offset RF Gain. got v1 =0x%x ,v2 =0x%x\n", v1, v2); ++ target = v2; ++ break; ++ } ++ } ++ RTW_INFO("pHalData->EEPROMRFGainVal=0x%x ,Gain offset Target Value=0x%x\n", pHalData->EEPROMRFGainVal, target); ++ ++ res = rtw_hal_read_rfreg(padapter, RF_PATH_A, 0x7f, 0xffffffff); ++ RTW_INFO("Offset RF Gain. before reg 0x7f=0x%08x\n", res); ++ PHY_SetRFReg(padapter, RF_PATH_A, REG_RF_BB_GAIN_OFFSET, BIT18 | BIT17 | BIT16 | BIT15, target); ++ res = rtw_hal_read_rfreg(padapter, RF_PATH_A, 0x7f, 0xffffffff); ++ ++ RTW_INFO("Offset RF Gain. After reg 0x7f=0x%08x\n", res); ++ ++ } else ++ ++ RTW_INFO("Offset RF Gain. pHalData->EEPROMRFGainVal=0x%x != 0xff, didn't run Kfree\n", pHalData->EEPROMRFGainVal); ++ } else ++ RTW_INFO("Using the default RF gain.\n"); ++ ++#elif defined(CONFIG_RTL8188E) ++ if (value & BIT4 || (registry_par->RegPwrTrimEnable == 1)) { ++ RTW_INFO("8188ES Offset RF Gain.\n"); ++ RTW_INFO("8188ES Offset RF Gain. EEPROMRFGainVal=0x%x\n", ++ pHalData->EEPROMRFGainVal); ++ ++ if (pHalData->EEPROMRFGainVal != 0xff) { ++ res = rtw_hal_read_rfreg(padapter, RF_PATH_A, ++ REG_RF_BB_GAIN_OFFSET, 0xffffffff); ++ ++ RTW_INFO("Offset RF Gain. reg 0x55=0x%x\n", res); ++ res &= 0xfff87fff; ++ ++ res |= (pHalData->EEPROMRFGainVal & 0x0f) << 15; ++ RTW_INFO("Offset RF Gain. res=0x%x\n", res); ++ ++ rtw_hal_write_rfreg(padapter, RF_PATH_A, ++ REG_RF_BB_GAIN_OFFSET, ++ RF_GAIN_OFFSET_MASK, res); ++ } else { ++ RTW_INFO("Offset RF Gain. EEPROMRFGainVal=0x%x == 0xff, didn't run Kfree\n", ++ pHalData->EEPROMRFGainVal); ++ } ++ } else ++ RTW_INFO("Using the default RF gain.\n"); ++#else ++ /* TODO: call this when channel switch */ ++ if (kfree_data->flag & KFREE_FLAG_ON) ++ rtw_rf_apply_tx_gain_offset(padapter, 6); /* input ch6 to select BB_GAIN_2G */ ++#endif ++ ++} ++#endif /*CONFIG_RF_POWER_TRIM */ ++ ++bool kfree_data_is_bb_gain_empty(struct kfree_data_t *data) ++{ ++#ifdef CONFIG_RF_POWER_TRIM ++ int i, j; ++ ++ for (i = 0; i < BB_GAIN_NUM; i++) ++ for (j = 0; j < RF_PATH_MAX; j++) ++ if (data->bb_gain[i][j] != 0) ++ return 0; ++#endif ++ return 1; ++} ++ ++#ifdef CONFIG_USB_RX_AGGREGATION ++void rtw_set_usb_agg_by_mode_normal(_adapter *padapter, u8 cur_wireless_mode) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ if (cur_wireless_mode < WIRELESS_11_24N ++ && cur_wireless_mode > 0) { /* ABG mode */ ++#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER ++ u32 remainder = 0; ++ u8 quotient = 0; ++ ++ remainder = MAX_RECVBUF_SZ % (4 * 1024); ++ quotient = (u8)(MAX_RECVBUF_SZ >> 12); ++ ++ if (quotient > 5) { ++ pHalData->rxagg_usb_size = 0x6; ++ pHalData->rxagg_usb_timeout = 0x10; ++ } else { ++ if (remainder >= 2048) { ++ pHalData->rxagg_usb_size = quotient; ++ pHalData->rxagg_usb_timeout = 0x10; ++ } else { ++ pHalData->rxagg_usb_size = (quotient - 1); ++ pHalData->rxagg_usb_timeout = 0x10; ++ } ++ } ++#else /* !CONFIG_PREALLOC_RX_SKB_BUFFER */ ++ if (0x6 != pHalData->rxagg_usb_size || 0x10 != pHalData->rxagg_usb_timeout) { ++ pHalData->rxagg_usb_size = 0x6; ++ pHalData->rxagg_usb_timeout = 0x10; ++ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, ++ pHalData->rxagg_usb_size | (pHalData->rxagg_usb_timeout << 8)); ++ } ++#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ ++ ++ } else if (cur_wireless_mode >= WIRELESS_11_24N ++ && cur_wireless_mode <= WIRELESS_MODE_MAX) { /* N AC mode */ ++#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER ++ u32 remainder = 0; ++ u8 quotient = 0; ++ ++ remainder = MAX_RECVBUF_SZ % (4 * 1024); ++ quotient = (u8)(MAX_RECVBUF_SZ >> 12); ++ ++ if (quotient > 5) { ++ pHalData->rxagg_usb_size = 0x5; ++ pHalData->rxagg_usb_timeout = 0x20; ++ } else { ++ if (remainder >= 2048) { ++ pHalData->rxagg_usb_size = quotient; ++ pHalData->rxagg_usb_timeout = 0x10; ++ } else { ++ pHalData->rxagg_usb_size = (quotient - 1); ++ pHalData->rxagg_usb_timeout = 0x10; ++ } ++ } ++#else /* !CONFIG_PREALLOC_RX_SKB_BUFFER */ ++ if ((0x5 != pHalData->rxagg_usb_size) || (0x20 != pHalData->rxagg_usb_timeout)) { ++ pHalData->rxagg_usb_size = 0x5; ++ pHalData->rxagg_usb_timeout = 0x20; ++ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, ++ pHalData->rxagg_usb_size | (pHalData->rxagg_usb_timeout << 8)); ++ } ++#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ ++ ++ } else { ++ /* RTW_INFO("%s: Unknow wireless mode(0x%x)\n",__func__,padapter->mlmeextpriv.cur_wireless_mode); */ ++ } ++} ++ ++void rtw_set_usb_agg_by_mode_customer(_adapter *padapter, u8 cur_wireless_mode, u8 UsbDmaSize, u8 Legacy_UsbDmaSize) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ if (cur_wireless_mode < WIRELESS_11_24N ++ && cur_wireless_mode > 0) { /* ABG mode */ ++ if (Legacy_UsbDmaSize != pHalData->rxagg_usb_size ++ || 0x10 != pHalData->rxagg_usb_timeout) { ++ pHalData->rxagg_usb_size = Legacy_UsbDmaSize; ++ pHalData->rxagg_usb_timeout = 0x10; ++ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, ++ pHalData->rxagg_usb_size | (pHalData->rxagg_usb_timeout << 8)); ++ } ++ } else if (cur_wireless_mode >= WIRELESS_11_24N ++ && cur_wireless_mode <= WIRELESS_MODE_MAX) { /* N AC mode */ ++ if (UsbDmaSize != pHalData->rxagg_usb_size ++ || 0x20 != pHalData->rxagg_usb_timeout) { ++ pHalData->rxagg_usb_size = UsbDmaSize; ++ pHalData->rxagg_usb_timeout = 0x20; ++ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, ++ pHalData->rxagg_usb_size | (pHalData->rxagg_usb_timeout << 8)); ++ } ++ } else { ++ /* RTW_INFO("%s: Unknown wireless mode(0x%x)\n",__func__,padapter->mlmeextpriv.cur_wireless_mode); */ ++ } ++} ++ ++void rtw_set_usb_agg_by_mode(_adapter *padapter, u8 cur_wireless_mode) ++{ ++#ifdef CONFIG_PLATFORM_NOVATEK_NT72668 ++ rtw_set_usb_agg_by_mode_customer(padapter, cur_wireless_mode, 0x3, 0x3); ++ return; ++#endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */ ++ ++ rtw_set_usb_agg_by_mode_normal(padapter, cur_wireless_mode); ++} ++#endif /* CONFIG_USB_RX_AGGREGATION */ ++ ++/* To avoid RX affect TX throughput */ ++void dm_DynamicUsbTxAgg(_adapter *padapter, u8 from_timer) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 cur_wireless_mode = WIRELESS_INVALID; ++ ++#ifdef CONFIG_USB_RX_AGGREGATION ++ if (IS_HARDWARE_TYPE_8821U(padapter)) { /* || IS_HARDWARE_TYPE_8192EU(padapter)) */ ++ /* This AGG_PH_TH only for UsbRxAggMode == USB_RX_AGG_USB */ ++ if ((pHalData->rxagg_mode == RX_AGG_USB) && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { ++ if (pdvobjpriv->traffic_stat.cur_tx_tp > 2 && pdvobjpriv->traffic_stat.cur_rx_tp < 30) ++ rtw_write16(padapter , REG_RXDMA_AGG_PG_TH , 0x1010); ++ else if (pdvobjpriv->traffic_stat.last_tx_bytes > 220000 && pdvobjpriv->traffic_stat.cur_rx_tp < 30) ++ rtw_write16(padapter , REG_RXDMA_AGG_PG_TH , 0x1006); ++ else ++ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, 0x2005); /* dmc agg th 20K */ ++ ++ /* RTW_INFO("TX_TP=%u, RX_TP=%u\n", pdvobjpriv->traffic_stat.cur_tx_tp, pdvobjpriv->traffic_stat.cur_rx_tp); */ ++ } ++ } else if (IS_HARDWARE_TYPE_8812(padapter)) { ++#ifdef CONFIG_CONCURRENT_MODE ++ u8 i; ++ _adapter *iface; ++ u8 bassocaed = _FALSE; ++ struct mlme_ext_priv *mlmeext; ++ ++ for (i = 0; i < pdvobjpriv->iface_nums; i++) { ++ iface = pdvobjpriv->padapters[i]; ++ mlmeext = &iface->mlmeextpriv; ++ if (rtw_linked_check(iface) == _TRUE) { ++ if (mlmeext->cur_wireless_mode >= cur_wireless_mode) ++ cur_wireless_mode = mlmeext->cur_wireless_mode; ++ bassocaed = _TRUE; ++ } ++ } ++ if (bassocaed) ++#endif ++ rtw_set_usb_agg_by_mode(padapter, cur_wireless_mode); ++#ifdef CONFIG_PLATFORM_NOVATEK_NT72668 ++ } else { ++ rtw_set_usb_agg_by_mode(padapter, cur_wireless_mode); ++#endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */ ++ } ++#endif ++} ++ ++/* bus-agg check for SoftAP mode */ ++inline u8 rtw_hal_busagg_qsel_check(_adapter *padapter, u8 pre_qsel, u8 next_qsel) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u8 chk_rst = _SUCCESS; ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ return chk_rst; ++ ++ /* if((pre_qsel == 0xFF)||(next_qsel== 0xFF)) */ ++ /* return chk_rst; */ ++ ++ if (((pre_qsel == QSLT_HIGH) || ((next_qsel == QSLT_HIGH))) ++ && (pre_qsel != next_qsel)) { ++ /* RTW_INFO("### bus-agg break cause of qsel misatch, pre_qsel=0x%02x,next_qsel=0x%02x ###\n", */ ++ /* pre_qsel,next_qsel); */ ++ chk_rst = _FAIL; ++ } ++ return chk_rst; ++} ++ ++/* ++ * Description: ++ * dump_TX_FIFO: This is only used to dump TX_FIFO for debug WoW mode offload ++ * contant. ++ * ++ * Input: ++ * adapter: adapter pointer. ++ * page_num: The max. page number that user want to dump. ++ * page_size: page size of each page. eg. 128 bytes, 256 bytes, 512byte. ++ */ ++void dump_TX_FIFO(_adapter *padapter, u8 page_num, u16 page_size) ++{ ++ ++ int i; ++ u8 val = 0; ++ u8 base = 0; ++ u32 addr = 0; ++ u32 count = (page_size / 8); ++ ++ if (page_num <= 0) { ++ RTW_INFO("!!%s: incorrect input page_num paramter!\n", __func__); ++ return; ++ } ++ ++ if (page_size < 128 || page_size > 512) { ++ RTW_INFO("!!%s: incorrect input page_size paramter!\n", __func__); ++ return; ++ } ++ ++ RTW_INFO("+%s+\n", __func__); ++ val = rtw_read8(padapter, 0x106); ++ rtw_write8(padapter, 0x106, 0x69); ++ RTW_INFO("0x106: 0x%02x\n", val); ++ base = rtw_read8(padapter, 0x209); ++ RTW_INFO("0x209: 0x%02x\n", base); ++ ++ addr = ((base)*page_size) / 8; ++ for (i = 0 ; i < page_num * count ; i += 2) { ++ rtw_write32(padapter, 0x140, addr + i); ++ printk(" %08x %08x ", rtw_read32(padapter, 0x144), rtw_read32(padapter, 0x148)); ++ rtw_write32(padapter, 0x140, addr + i + 1); ++ printk(" %08x %08x\n", rtw_read32(padapter, 0x144), rtw_read32(padapter, 0x148)); ++ } ++} ++ ++#ifdef CONFIG_GPIO_API ++u8 rtw_hal_get_gpio(_adapter *adapter, u8 gpio_num) ++{ ++ u8 value = 0; ++ u8 direction = 0; ++ u32 gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL + 2; ++ u8 gpio_num_to_set = gpio_num; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); ++ ++ if (rtw_hal_gpio_func_check(adapter, gpio_num) == _FAIL) ++ return value; ++ ++ rtw_ps_deny(adapter, PS_DENY_IOCTL); ++ ++ RTW_INFO("rf_pwrstate=0x%02x\n", pwrpriv->rf_pwrstate); ++ LeaveAllPowerSaveModeDirect(adapter); ++ ++ if (gpio_num > 7) { ++ gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL_2 + 2; ++ gpio_num_to_set = gpio_num - 8; ++ } ++ ++ /* Read GPIO Direction */ ++ direction = (rtw_read8(adapter, gpio_ctrl_reg_to_set) & BIT(gpio_num_to_set)) >> gpio_num; ++ ++ /* According the direction to read register value */ ++ if (direction) ++ value = (rtw_read8(adapter, gpio_ctrl_reg_to_set) & BIT(gpio_num_to_set)) >> gpio_num; ++ else ++ value = (rtw_read8(adapter, gpio_ctrl_reg_to_set) & BIT(gpio_num_to_set)) >> gpio_num; ++ ++ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); ++ RTW_INFO("%s direction=%d value=%d\n", __FUNCTION__, direction, value); ++ ++ return value; ++} ++ ++int rtw_hal_set_gpio_output_value(_adapter *adapter, u8 gpio_num, bool isHigh) ++{ ++ u8 direction = 0; ++ u8 res = -1; ++ u32 gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL + 2; ++ u8 gpio_num_to_set = gpio_num; ++ ++ if (rtw_hal_gpio_func_check(adapter, gpio_num) == _FAIL) ++ return -1; ++ ++ rtw_ps_deny(adapter, PS_DENY_IOCTL); ++ ++ LeaveAllPowerSaveModeDirect(adapter); ++ ++ if (gpio_num > 7) { ++ gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL_2 + 2; ++ gpio_num_to_set = gpio_num - 8; ++ } ++ ++ /* Read GPIO direction */ ++ direction = (rtw_read8(adapter, REG_GPIO_PIN_CTRL + 2) & BIT(gpio_num)) >> gpio_num; ++ ++ /* If GPIO is output direction, setting value. */ ++ if (direction) { ++ if (isHigh) ++ rtw_write8(adapter, gpio_ctrl_reg_to_set, rtw_read8(adapter, gpio_ctrl_reg_to_set) | BIT(gpio_num_to_set)); ++ else ++ rtw_write8(adapter, gpio_ctrl_reg_to_set, rtw_read8(adapter, gpio_ctrl_reg_to_set) & ~BIT(gpio_num_to_set)); ++ ++ RTW_INFO("%s Set gpio %x[%d]=%d\n", __FUNCTION__, REG_GPIO_PIN_CTRL + 1, gpio_num, isHigh); ++ res = 0; ++ } else { ++ RTW_INFO("%s The gpio is input,not be set!\n", __FUNCTION__); ++ res = -1; ++ } ++ ++ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); ++ return res; ++} ++ ++int rtw_hal_config_gpio(_adapter *adapter, u8 gpio_num, bool isOutput) ++{ ++ u32 gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL + 2; ++ u8 gpio_num_to_set = gpio_num; ++ ++ if (rtw_hal_gpio_func_check(adapter, gpio_num) == _FAIL) ++ return -1; ++ ++ RTW_INFO("%s gpio_num =%d direction=%d\n", __FUNCTION__, gpio_num, isOutput); ++ ++ rtw_ps_deny(adapter, PS_DENY_IOCTL); ++ ++ LeaveAllPowerSaveModeDirect(adapter); ++ ++ rtw_hal_gpio_multi_func_reset(adapter, gpio_num); ++ ++ if (gpio_num > 7) { ++ gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL_2 + 2; ++ gpio_num_to_set = gpio_num - 8; ++ } ++ ++ if (isOutput) ++ rtw_write8(adapter, gpio_ctrl_reg_to_set, rtw_read8(adapter, gpio_ctrl_reg_to_set) | BIT(gpio_num_to_set)); ++ else ++ rtw_write8(adapter, gpio_ctrl_reg_to_set, rtw_read8(adapter, gpio_ctrl_reg_to_set) & ~BIT(gpio_num_to_set)); ++ ++ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); ++ ++ return 0; ++} ++int rtw_hal_register_gpio_interrupt(_adapter *adapter, int gpio_num, void(*callback)(u8 level)) ++{ ++ u8 value; ++ u8 direction; ++ PHAL_DATA_TYPE phal = GET_HAL_DATA(adapter); ++ ++ if (IS_HARDWARE_TYPE_8188E(adapter)) { ++ if (gpio_num > 7 || gpio_num < 4) { ++ RTW_PRINT("%s The gpio number does not included 4~7.\n", __FUNCTION__); ++ return -1; ++ } ++ } ++ ++ rtw_ps_deny(adapter, PS_DENY_IOCTL); ++ ++ LeaveAllPowerSaveModeDirect(adapter); ++ ++ /* Read GPIO direction */ ++ direction = (rtw_read8(adapter, REG_GPIO_PIN_CTRL + 2) & BIT(gpio_num)) >> gpio_num; ++ if (direction) { ++ RTW_PRINT("%s Can't register output gpio as interrupt.\n", __FUNCTION__); ++ return -1; ++ } ++ ++ /* Config GPIO Mode */ ++ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 3, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 3) | BIT(gpio_num)); ++ ++ /* Register GPIO interrupt handler*/ ++ adapter->gpiointpriv.callback[gpio_num] = callback; ++ ++ /* Set GPIO interrupt mode, 0:positive edge, 1:negative edge */ ++ value = rtw_read8(adapter, REG_GPIO_PIN_CTRL) & BIT(gpio_num); ++ adapter->gpiointpriv.interrupt_mode = rtw_read8(adapter, REG_HSIMR + 2) ^ value; ++ rtw_write8(adapter, REG_GPIO_INTM, adapter->gpiointpriv.interrupt_mode); ++ ++ /* Enable GPIO interrupt */ ++ adapter->gpiointpriv.interrupt_enable_mask = rtw_read8(adapter, REG_HSIMR + 2) | BIT(gpio_num); ++ rtw_write8(adapter, REG_HSIMR + 2, adapter->gpiointpriv.interrupt_enable_mask); ++ ++ rtw_hal_update_hisr_hsisr_ind(adapter, 1); ++ ++ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); ++ ++ return 0; ++} ++int rtw_hal_disable_gpio_interrupt(_adapter *adapter, int gpio_num) ++{ ++ u8 value; ++ u8 direction; ++ PHAL_DATA_TYPE phal = GET_HAL_DATA(adapter); ++ ++ if (IS_HARDWARE_TYPE_8188E(adapter)) { ++ if (gpio_num > 7 || gpio_num < 4) { ++ RTW_INFO("%s The gpio number does not included 4~7.\n", __FUNCTION__); ++ return -1; ++ } ++ } ++ ++ rtw_ps_deny(adapter, PS_DENY_IOCTL); ++ ++ LeaveAllPowerSaveModeDirect(adapter); ++ ++ /* Config GPIO Mode */ ++ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 3, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 3) & ~BIT(gpio_num)); ++ ++ /* Unregister GPIO interrupt handler*/ ++ adapter->gpiointpriv.callback[gpio_num] = NULL; ++ ++ /* Reset GPIO interrupt mode, 0:positive edge, 1:negative edge */ ++ adapter->gpiointpriv.interrupt_mode = rtw_read8(adapter, REG_GPIO_INTM) & ~BIT(gpio_num); ++ rtw_write8(adapter, REG_GPIO_INTM, 0x00); ++ ++ /* Disable GPIO interrupt */ ++ adapter->gpiointpriv.interrupt_enable_mask = rtw_read8(adapter, REG_HSIMR + 2) & ~BIT(gpio_num); ++ rtw_write8(adapter, REG_HSIMR + 2, adapter->gpiointpriv.interrupt_enable_mask); ++ ++ if (!adapter->gpiointpriv.interrupt_enable_mask) ++ rtw_hal_update_hisr_hsisr_ind(adapter, 0); ++ ++ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); ++ ++ return 0; ++} ++#endif ++ ++s8 rtw_hal_ch_sw_iqk_info_search(_adapter *padapter, u8 central_chnl, u8 bw_mode) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 i; ++ ++ for (i = 0; i < MAX_IQK_INFO_BACKUP_CHNL_NUM; i++) { ++ if ((pHalData->iqk_reg_backup[i].central_chnl != 0)) { ++ if ((pHalData->iqk_reg_backup[i].central_chnl == central_chnl) ++ && (pHalData->iqk_reg_backup[i].bw_mode == bw_mode)) ++ return i; ++ } ++ } ++ ++ return -1; ++} ++ ++void rtw_hal_ch_sw_iqk_info_backup(_adapter *padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ s8 res; ++ u8 i; ++ ++ /* If it's an existed record, overwrite it */ ++ res = rtw_hal_ch_sw_iqk_info_search(padapter, pHalData->CurrentChannel, pHalData->CurrentChannelBW); ++ if ((res >= 0) && (res < MAX_IQK_INFO_BACKUP_CHNL_NUM)) { ++ rtw_hal_set_hwreg(padapter, HW_VAR_CH_SW_IQK_INFO_BACKUP, (u8 *)&(pHalData->iqk_reg_backup[res])); ++ return; ++ } ++ ++ /* Search for the empty record to use */ ++ for (i = 0; i < MAX_IQK_INFO_BACKUP_CHNL_NUM; i++) { ++ if (pHalData->iqk_reg_backup[i].central_chnl == 0) { ++ rtw_hal_set_hwreg(padapter, HW_VAR_CH_SW_IQK_INFO_BACKUP, (u8 *)&(pHalData->iqk_reg_backup[i])); ++ return; ++ } ++ } ++ ++ /* Else, overwrite the oldest record */ ++ for (i = 1; i < MAX_IQK_INFO_BACKUP_CHNL_NUM; i++) ++ _rtw_memcpy(&(pHalData->iqk_reg_backup[i - 1]), &(pHalData->iqk_reg_backup[i]), sizeof(struct hal_iqk_reg_backup)); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_CH_SW_IQK_INFO_BACKUP, (u8 *)&(pHalData->iqk_reg_backup[MAX_IQK_INFO_BACKUP_CHNL_NUM - 1])); ++} ++ ++void rtw_hal_ch_sw_iqk_info_restore(_adapter *padapter, u8 ch_sw_use_case) ++{ ++ rtw_hal_set_hwreg(padapter, HW_VAR_CH_SW_IQK_INFO_RESTORE, &ch_sw_use_case); ++} ++ ++void rtw_dump_mac_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_counter) ++{ ++ u32 mac_cck_ok = 0, mac_ofdm_ok = 0, mac_ht_ok = 0, mac_vht_ok = 0; ++ u32 mac_cck_err = 0, mac_ofdm_err = 0, mac_ht_err = 0, mac_vht_err = 0; ++ u32 mac_cck_fa = 0, mac_ofdm_fa = 0, mac_ht_fa = 0; ++ u32 DropPacket = 0; ++ ++ if (!rx_counter) { ++ rtw_warn_on(1); ++ return; ++ } ++ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ ++ ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x3); ++ mac_cck_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x0); ++ mac_ofdm_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x6); ++ mac_ht_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ ++ mac_vht_ok = 0; ++ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x0); ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x1); ++ mac_vht_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0]*/ ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ ++ } ++ ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x4); ++ mac_cck_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x1); ++ mac_ofdm_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x7); ++ mac_ht_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ ++ mac_vht_err = 0; ++ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x1); ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x1); ++ mac_vht_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0]*/ ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ ++ } ++ ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x5); ++ mac_cck_fa = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x2); ++ mac_ofdm_fa = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x9); ++ mac_ht_fa = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ ++ ++ /* Mac_DropPacket */ ++ rtw_write32(padapter, REG_RXERR_RPT, (rtw_read32(padapter, REG_RXERR_RPT) & 0x0FFFFFFF) | Mac_DropPacket); ++ DropPacket = rtw_read32(padapter, REG_RXERR_RPT) & 0x0000FFFF; ++ ++ rx_counter->rx_pkt_ok = mac_cck_ok + mac_ofdm_ok + mac_ht_ok + mac_vht_ok; ++ rx_counter->rx_pkt_crc_error = mac_cck_err + mac_ofdm_err + mac_ht_err + mac_vht_err; ++ rx_counter->rx_cck_fa = mac_cck_fa; ++ rx_counter->rx_ofdm_fa = mac_ofdm_fa; ++ rx_counter->rx_ht_fa = mac_ht_fa; ++ rx_counter->rx_pkt_drop = DropPacket; ++} ++void rtw_reset_mac_rx_counters(_adapter *padapter) ++{ ++ ++ /* If no packet rx, MaxRx clock be gating ,BIT_DISGCLK bit19 set 1 for fix*/ ++ if (IS_HARDWARE_TYPE_8703B(padapter) || ++ IS_HARDWARE_TYPE_8723D(padapter) || ++ IS_HARDWARE_TYPE_8188F(padapter)) ++ PHY_SetMacReg(padapter, REG_RCR, BIT19, 0x1); ++ ++ /* reset mac counter */ ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT27, 0x1); ++ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT27, 0x0); ++} ++ ++void rtw_dump_phy_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_counter) ++{ ++ u32 cckok = 0, cckcrc = 0, ofdmok = 0, ofdmcrc = 0, htok = 0, htcrc = 0, OFDM_FA = 0, CCK_FA = 0, vht_ok = 0, vht_err = 0; ++ if (!rx_counter) { ++ rtw_warn_on(1); ++ return; ++ } ++ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { ++ cckok = PHY_QueryBBReg(padapter, 0xF04, 0x3FFF); /* [13:0] */ ++ ofdmok = PHY_QueryBBReg(padapter, 0xF14, 0x3FFF); /* [13:0] */ ++ htok = PHY_QueryBBReg(padapter, 0xF10, 0x3FFF); /* [13:0] */ ++ vht_ok = PHY_QueryBBReg(padapter, 0xF0C, 0x3FFF); /* [13:0] */ ++ cckcrc = PHY_QueryBBReg(padapter, 0xF04, 0x3FFF0000); /* [29:16] */ ++ ofdmcrc = PHY_QueryBBReg(padapter, 0xF14, 0x3FFF0000); /* [29:16] */ ++ htcrc = PHY_QueryBBReg(padapter, 0xF10, 0x3FFF0000); /* [29:16] */ ++ vht_err = PHY_QueryBBReg(padapter, 0xF0C, 0x3FFF0000); /* [29:16] */ ++ CCK_FA = PHY_QueryBBReg(padapter, 0xA5C, bMaskLWord); ++ OFDM_FA = PHY_QueryBBReg(padapter, 0xF48, bMaskLWord); ++ } else { ++ cckok = PHY_QueryBBReg(padapter, 0xF88, bMaskDWord); ++ ofdmok = PHY_QueryBBReg(padapter, 0xF94, bMaskLWord); ++ htok = PHY_QueryBBReg(padapter, 0xF90, bMaskLWord); ++ vht_ok = 0; ++ cckcrc = PHY_QueryBBReg(padapter, 0xF84, bMaskDWord); ++ ofdmcrc = PHY_QueryBBReg(padapter, 0xF94, bMaskHWord); ++ htcrc = PHY_QueryBBReg(padapter, 0xF90, bMaskHWord); ++ vht_err = 0; ++ OFDM_FA = PHY_QueryBBReg(padapter, 0xCF0, bMaskLWord) + PHY_QueryBBReg(padapter, 0xCF2, bMaskLWord) + ++ PHY_QueryBBReg(padapter, 0xDA2, bMaskLWord) + PHY_QueryBBReg(padapter, 0xDA4, bMaskLWord) + ++ PHY_QueryBBReg(padapter, 0xDA6, bMaskLWord) + PHY_QueryBBReg(padapter, 0xDA8, bMaskLWord); ++ ++ CCK_FA = (rtw_read8(padapter, 0xA5B) << 8) | (rtw_read8(padapter, 0xA5C)); ++ } ++ ++ rx_counter->rx_pkt_ok = cckok + ofdmok + htok + vht_ok; ++ rx_counter->rx_pkt_crc_error = cckcrc + ofdmcrc + htcrc + vht_err; ++ rx_counter->rx_ofdm_fa = OFDM_FA; ++ rx_counter->rx_cck_fa = CCK_FA; ++ ++} ++ ++void rtw_reset_phy_trx_ok_counters(_adapter *padapter) ++{ ++ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { ++ PHY_SetBBReg(padapter, 0xB58, BIT0, 0x1); ++ PHY_SetBBReg(padapter, 0xB58, BIT0, 0x0); ++ } ++} ++void rtw_reset_phy_rx_counters(_adapter *padapter) ++{ ++ /* reset phy counter */ ++ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { ++ rtw_reset_phy_trx_ok_counters(padapter); ++ ++ PHY_SetBBReg(padapter, 0x9A4, BIT17, 0x1);/* reset OFDA FA counter */ ++ PHY_SetBBReg(padapter, 0x9A4, BIT17, 0x0); ++ ++ PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x0);/* reset CCK FA counter */ ++ PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x1); ++ } else { ++ PHY_SetBBReg(padapter, 0xF14, BIT16, 0x1); ++ rtw_msleep_os(10); ++ PHY_SetBBReg(padapter, 0xF14, BIT16, 0x0); ++ ++ PHY_SetBBReg(padapter, 0xD00, BIT27, 0x1);/* reset OFDA FA counter */ ++ PHY_SetBBReg(padapter, 0xC0C, BIT31, 0x1);/* reset OFDA FA counter */ ++ PHY_SetBBReg(padapter, 0xD00, BIT27, 0x0); ++ PHY_SetBBReg(padapter, 0xC0C, BIT31, 0x0); ++ ++ PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x0);/* reset CCK FA counter */ ++ PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x1); ++ } ++} ++#ifdef DBG_RX_COUNTER_DUMP ++void rtw_dump_drv_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_counter) ++{ ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ if (!rx_counter) { ++ rtw_warn_on(1); ++ return; ++ } ++ rx_counter->rx_pkt_ok = padapter->drv_rx_cnt_ok; ++ rx_counter->rx_pkt_crc_error = padapter->drv_rx_cnt_crcerror; ++ rx_counter->rx_pkt_drop = precvpriv->rx_drop - padapter->drv_rx_cnt_drop; ++} ++void rtw_reset_drv_rx_counters(_adapter *padapter) ++{ ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ padapter->drv_rx_cnt_ok = 0; ++ padapter->drv_rx_cnt_crcerror = 0; ++ padapter->drv_rx_cnt_drop = precvpriv->rx_drop; ++} ++void rtw_dump_phy_rxcnts_preprocess(_adapter *padapter, u8 rx_cnt_mode) ++{ ++ u8 initialgain; ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); ++ ++ if ((!(padapter->dump_rx_cnt_mode & DUMP_PHY_RX_COUNTER)) && (rx_cnt_mode & DUMP_PHY_RX_COUNTER)) { ++ rtw_hal_get_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, NULL); ++ RTW_INFO("%s CurIGValue:0x%02x\n", __FUNCTION__, initialgain); ++ rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE); ++ /*disable dynamic functions, such as high power, DIG*/ ++ rtw_phydm_ability_backup(padapter); ++ rtw_phydm_func_clr(padapter, (ODM_BB_DIG | ODM_BB_FA_CNT)); ++ } else if ((padapter->dump_rx_cnt_mode & DUMP_PHY_RX_COUNTER) && (!(rx_cnt_mode & DUMP_PHY_RX_COUNTER))) { ++ /* turn on phy-dynamic functions */ ++ rtw_phydm_ability_restore(padapter); ++ initialgain = 0xff; /* restore RX GAIN */ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE); ++ ++ } ++} ++ ++void rtw_dump_rx_counters(_adapter *padapter) ++{ ++ struct dbg_rx_counter rx_counter; ++ ++ if (padapter->dump_rx_cnt_mode & DUMP_DRV_RX_COUNTER) { ++ _rtw_memset(&rx_counter, 0, sizeof(struct dbg_rx_counter)); ++ rtw_dump_drv_rx_counters(padapter, &rx_counter); ++ RTW_INFO("Drv Received packet OK:%d CRC error:%d Drop Packets: %d\n", ++ rx_counter.rx_pkt_ok, rx_counter.rx_pkt_crc_error, rx_counter.rx_pkt_drop); ++ rtw_reset_drv_rx_counters(padapter); ++ } ++ ++ if (padapter->dump_rx_cnt_mode & DUMP_MAC_RX_COUNTER) { ++ _rtw_memset(&rx_counter, 0, sizeof(struct dbg_rx_counter)); ++ rtw_dump_mac_rx_counters(padapter, &rx_counter); ++ RTW_INFO("Mac Received packet OK:%d CRC error:%d FA Counter: %d Drop Packets: %d\n", ++ rx_counter.rx_pkt_ok, rx_counter.rx_pkt_crc_error, ++ rx_counter.rx_cck_fa + rx_counter.rx_ofdm_fa + rx_counter.rx_ht_fa, ++ rx_counter.rx_pkt_drop); ++ rtw_reset_mac_rx_counters(padapter); ++ } ++ ++ if (padapter->dump_rx_cnt_mode & DUMP_PHY_RX_COUNTER) { ++ _rtw_memset(&rx_counter, 0, sizeof(struct dbg_rx_counter)); ++ rtw_dump_phy_rx_counters(padapter, &rx_counter); ++ /* RTW_INFO("%s: OFDM_FA =%d\n", __FUNCTION__, rx_counter.rx_ofdm_fa); */ ++ /* RTW_INFO("%s: CCK_FA =%d\n", __FUNCTION__, rx_counter.rx_cck_fa); */ ++ RTW_INFO("Phy Received packet OK:%d CRC error:%d FA Counter: %d\n", rx_counter.rx_pkt_ok, rx_counter.rx_pkt_crc_error, ++ rx_counter.rx_ofdm_fa + rx_counter.rx_cck_fa); ++ rtw_reset_phy_rx_counters(padapter); ++ } ++} ++#endif ++void rtw_get_noise(_adapter *padapter) ++{ ++#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct noise_info info; ++ if (rtw_linked_check(padapter)) { ++ info.bPauseDIG = _TRUE; ++ info.IGIValue = 0x1e; ++ info.max_time = 100;/* ms */ ++ info.chan = pmlmeext->cur_channel ;/* rtw_get_oper_ch(padapter); */ ++ rtw_ps_deny(padapter, PS_DENY_IOCTL); ++ LeaveAllPowerSaveModeDirect(padapter); ++ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &info, _FALSE); ++ /* ODM_InbandNoise_Monitor(podmpriv,_TRUE,0x20,100); */ ++ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); ++ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &(info.chan), &(padapter->recvpriv.noise)); ++#ifdef DBG_NOISE_MONITOR ++ RTW_INFO("chan:%d,noise_level:%d\n", info.chan, padapter->recvpriv.noise); ++#endif ++ } ++#endif ++ ++} ++u8 rtw_get_current_tx_sgi(_adapter *padapter, u8 macid) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u8 curr_tx_sgi = 0; ++ ++#if defined(CONFIG_RTL8188E) ++ curr_tx_sgi = ODM_RA_GetDecisionRate_8188E(pDM_Odm, macid); ++#else ++ curr_tx_sgi = ((pRA_Table->link_tx_rate[macid]) & 0x80) >> 7; ++#endif ++ ++ return curr_tx_sgi; ++ ++} ++u8 rtw_get_current_tx_rate(_adapter *padapter, u8 macid) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u8 rate_id = 0; ++ ++#if (RATE_ADAPTIVE_SUPPORT == 1) ++ rate_id = ODM_RA_GetDecisionRate_8188E(pDM_Odm, macid); ++#else ++ rate_id = (pRA_Table->link_tx_rate[macid]) & 0x7f; ++#endif ++ ++ return rate_id; ++ ++} ++ ++void update_IOT_info(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ switch (pmlmeinfo->assoc_AP_vendor) { ++ case HT_IOT_PEER_MARVELL: ++ pmlmeinfo->turboMode_cts2self = 1; ++ pmlmeinfo->turboMode_rtsen = 0; ++ break; ++ ++ case HT_IOT_PEER_RALINK: ++ pmlmeinfo->turboMode_cts2self = 0; ++ pmlmeinfo->turboMode_rtsen = 1; ++ /* disable high power */ ++ rtw_phydm_func_clr(padapter, ODM_BB_DYNAMIC_TXPWR); ++ break; ++ case HT_IOT_PEER_REALTEK: ++ /* rtw_write16(padapter, 0x4cc, 0xffff); */ ++ /* rtw_write16(padapter, 0x546, 0x01c0); */ ++ /* disable high power */ ++ rtw_phydm_func_clr(padapter, ODM_BB_DYNAMIC_TXPWR); ++ break; ++ default: ++ pmlmeinfo->turboMode_cts2self = 0; ++ pmlmeinfo->turboMode_rtsen = 1; ++ break; ++ } ++ ++} ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++void rtw_acs_start(_adapter *padapter, bool bStart) ++{ ++ if (_TRUE == bStart) { ++ ACS_OP acs_op = ACS_INIT; ++ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &acs_op, _TRUE); ++ rtw_set_acs_channel(padapter, 0); ++ SET_ACS_STATE(padapter, ACS_ENABLE); ++ } else { ++ SET_ACS_STATE(padapter, ACS_DISABLE); ++#ifdef DBG_AUTO_CHNL_SEL_NHM ++ if (1) { ++ u8 best_24g_ch = 0; ++ u8 best_5g_ch = 0; ++ ++ rtw_hal_get_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &(best_24g_ch), &(best_5g_ch)); ++ RTW_INFO("[ACS-"ADPT_FMT"] Best 2.4G CH:%u\n", ADPT_ARG(padapter), best_24g_ch); ++ RTW_INFO("[ACS-"ADPT_FMT"] Best 5G CH:%u\n", ADPT_ARG(padapter), best_5g_ch); ++ } ++#endif ++ } ++} ++#endif ++ ++/* TODO: merge with phydm, see odm_SetCrystalCap() */ ++void hal_set_crystal_cap(_adapter *adapter, u8 crystal_cap) ++{ ++ crystal_cap = crystal_cap & 0x3F; ++ ++ switch (rtw_get_chip_type(adapter)) { ++#if defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8188F) ++ case RTL8188E: ++ case RTL8188F: ++ /* write 0x24[16:11] = 0x24[22:17] = CrystalCap */ ++ PHY_SetBBReg(adapter, REG_AFE_XTAL_CTRL, 0x007FF800, (crystal_cap | (crystal_cap << 6))); ++ break; ++#endif ++#if defined(CONFIG_RTL8812A) ++ case RTL8812: ++ /* write 0x2C[30:25] = 0x2C[24:19] = CrystalCap */ ++ PHY_SetBBReg(adapter, REG_MAC_PHY_CTRL, 0x7FF80000, (crystal_cap | (crystal_cap << 6))); ++ break; ++#endif ++#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) || \ ++ defined(CONFIG_RTL8723D) || defined(CONFIG_RTL8821A) || \ ++ defined(CONFIG_RTL8192E) ++ case RTL8723B: ++ case RTL8703B: ++ case RTL8723D: ++ case RTL8821: ++ case RTL8192E: ++ /* write 0x2C[23:18] = 0x2C[17:12] = CrystalCap */ ++ PHY_SetBBReg(adapter, REG_MAC_PHY_CTRL, 0x00FFF000, (crystal_cap | (crystal_cap << 6))); ++ break; ++#endif ++#if defined(CONFIG_RTL8814A) ++ case RTL8814A: ++ /* write 0x2C[26:21] = 0x2C[20:15] = CrystalCap*/ ++ PHY_SetBBReg(adapter, REG_MAC_PHY_CTRL, 0x07FF8000, (crystal_cap | (crystal_cap << 6))); ++ break; ++#endif ++#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++ ++ case RTL8822B: ++ case RTL8821C: ++ /* write 0x28[6:1] = 0x24[30:25] = CrystalCap */ ++ crystal_cap = crystal_cap & 0x3F; ++ PHY_SetBBReg(adapter, REG_AFE_XTAL_CTRL, 0x7E000000, crystal_cap); ++ PHY_SetBBReg(adapter, REG_AFE_PLL_CTRL, 0x7E, crystal_cap); ++ break; ++#endif ++ default: ++ rtw_warn_on(1); ++ } ++} ++ ++int hal_spec_init(_adapter *adapter) ++{ ++ u8 interface_type = 0; ++ int ret = _SUCCESS; ++ ++ interface_type = rtw_get_intf_type(adapter); ++ ++ switch (rtw_get_chip_type(adapter)) { ++#ifdef CONFIG_RTL8723B ++ case RTL8723B: ++ init_hal_spec_8723b(adapter); ++ break; ++#endif ++#ifdef CONFIG_RTL8703B ++ case RTL8703B: ++ init_hal_spec_8703b(adapter); ++ break; ++#endif ++#ifdef CONFIG_RTL8723D ++ case RTL8723D: ++ init_hal_spec_8723d(adapter); ++ break; ++#endif ++#ifdef CONFIG_RTL8188E ++ case RTL8188E: ++ init_hal_spec_8188e(adapter); ++ break; ++#endif ++#ifdef CONFIG_RTL8188F ++ case RTL8188F: ++ init_hal_spec_8188f(adapter); ++ break; ++#endif ++#ifdef CONFIG_RTL8812A ++ case RTL8812: ++ init_hal_spec_8812a(adapter); ++ break; ++#endif ++#ifdef CONFIG_RTL8821A ++ case RTL8821: ++ init_hal_spec_8821a(adapter); ++ break; ++#endif ++#ifdef CONFIG_RTL8192E ++ case RTL8192E: ++ init_hal_spec_8192e(adapter); ++ break; ++#endif ++#ifdef CONFIG_RTL8814A ++ case RTL8814A: ++ init_hal_spec_8814a(adapter); ++ break; ++#endif ++#ifdef CONFIG_RTL8822B ++ case RTL8822B: ++ rtl8822b_init_hal_spec(adapter); ++ break; ++#endif ++#ifdef CONFIG_RTL8821C ++ case RTL8821C: ++ init_hal_spec_rtl8821c(adapter); ++ break; ++#endif ++ default: ++ RTW_ERR("%s: unknown chip_type:%u\n" ++ , __func__, rtw_get_chip_type(adapter)); ++ ret = _FAIL; ++ break; ++ } ++ ++ return ret; ++} ++ ++static const char *const _band_cap_str[] = { ++ /* BIT0 */"2G", ++ /* BIT1 */"5G", ++}; ++ ++static const char *const _bw_cap_str[] = { ++ /* BIT0 */"5M", ++ /* BIT1 */"10M", ++ /* BIT2 */"20M", ++ /* BIT3 */"40M", ++ /* BIT4 */"80M", ++ /* BIT5 */"160M", ++ /* BIT6 */"80_80M", ++}; ++ ++static const char *const _proto_cap_str[] = { ++ /* BIT0 */"b", ++ /* BIT1 */"g", ++ /* BIT2 */"n", ++ /* BIT3 */"ac", ++}; ++ ++static const char *const _wl_func_str[] = { ++ /* BIT0 */"P2P", ++ /* BIT1 */"MIRACAST", ++ /* BIT2 */"TDLS", ++ /* BIT3 */"FTM", ++}; ++ ++void dump_hal_spec(void *sel, _adapter *adapter) ++{ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ int i; ++ ++ RTW_PRINT_SEL(sel, "macid_num:%u\n", hal_spec->macid_num); ++ RTW_PRINT_SEL(sel, "sec_cap:0x%02x\n", hal_spec->sec_cap); ++ RTW_PRINT_SEL(sel, "sec_cam_ent_num:%u\n", hal_spec->sec_cam_ent_num); ++ RTW_PRINT_SEL(sel, "rfpath_num_2g:%u\n", hal_spec->rfpath_num_2g); ++ RTW_PRINT_SEL(sel, "rfpath_num_5g:%u\n", hal_spec->rfpath_num_5g); ++ RTW_PRINT_SEL(sel, "max_tx_cnt:%u\n", hal_spec->max_tx_cnt); ++ RTW_PRINT_SEL(sel, "nss_num:%u\n", hal_spec->nss_num); ++ ++ RTW_PRINT_SEL(sel, "band_cap:"); ++ for (i = 0; i < BAND_CAP_BIT_NUM; i++) { ++ if (((hal_spec->band_cap) >> i) & BIT0 && _band_cap_str[i]) ++ _RTW_PRINT_SEL(sel, "%s ", _band_cap_str[i]); ++ } ++ _RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "bw_cap:"); ++ for (i = 0; i < BW_CAP_BIT_NUM; i++) { ++ if (((hal_spec->bw_cap) >> i) & BIT0 && _bw_cap_str[i]) ++ _RTW_PRINT_SEL(sel, "%s ", _bw_cap_str[i]); ++ } ++ _RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "proto_cap:"); ++ for (i = 0; i < PROTO_CAP_BIT_NUM; i++) { ++ if (((hal_spec->proto_cap) >> i) & BIT0 && _proto_cap_str[i]) ++ _RTW_PRINT_SEL(sel, "%s ", _proto_cap_str[i]); ++ } ++ _RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "wl_func:"); ++ for (i = 0; i < WL_FUNC_BIT_NUM; i++) { ++ if (((hal_spec->wl_func) >> i) & BIT0 && _wl_func_str[i]) ++ _RTW_PRINT_SEL(sel, "%s ", _wl_func_str[i]); ++ } ++ _RTW_PRINT_SEL(sel, "\n"); ++} ++ ++inline bool hal_chk_band_cap(_adapter *adapter, u8 cap) ++{ ++ return GET_HAL_SPEC(adapter)->band_cap & cap; ++} ++ ++inline bool hal_chk_bw_cap(_adapter *adapter, u8 cap) ++{ ++ return GET_HAL_SPEC(adapter)->bw_cap & cap; ++} ++ ++inline bool hal_chk_proto_cap(_adapter *adapter, u8 cap) ++{ ++ return GET_HAL_SPEC(adapter)->proto_cap & cap; ++} ++ ++inline bool hal_chk_wl_func(_adapter *adapter, u8 func) ++{ ++ return GET_HAL_SPEC(adapter)->wl_func & func; ++} ++ ++inline bool hal_is_band_support(_adapter *adapter, u8 band) ++{ ++ return GET_HAL_SPEC(adapter)->band_cap & band_to_band_cap(band); ++} ++ ++inline bool hal_is_bw_support(_adapter *adapter, u8 bw) ++{ ++ return GET_HAL_SPEC(adapter)->bw_cap & ch_width_to_bw_cap(bw); ++} ++ ++inline bool hal_is_wireless_mode_support(_adapter *adapter, u8 mode) ++{ ++ u8 proto_cap = GET_HAL_SPEC(adapter)->proto_cap; ++ ++ if (mode == WIRELESS_11B) ++ if ((proto_cap & PROTO_CAP_11B) && hal_chk_band_cap(adapter, BAND_CAP_2G)) ++ return 1; ++ ++ if (mode == WIRELESS_11G) ++ if ((proto_cap & PROTO_CAP_11G) && hal_chk_band_cap(adapter, BAND_CAP_2G)) ++ return 1; ++ ++ if (mode == WIRELESS_11A) ++ if ((proto_cap & PROTO_CAP_11G) && hal_chk_band_cap(adapter, BAND_CAP_5G)) ++ return 1; ++ ++ if (mode == WIRELESS_11_24N) ++ if ((proto_cap & PROTO_CAP_11N) && hal_chk_band_cap(adapter, BAND_CAP_2G)) ++ return 1; ++ ++ if (mode == WIRELESS_11_5N) ++ if ((proto_cap & PROTO_CAP_11N) && hal_chk_band_cap(adapter, BAND_CAP_5G)) ++ return 1; ++ ++ if (mode == WIRELESS_11AC) ++ if ((proto_cap & PROTO_CAP_11AC) && hal_chk_band_cap(adapter, BAND_CAP_5G)) ++ return 1; ++ ++ return 0; ++} ++ ++/* ++* hal_largest_bw - starting from in_bw, get largest bw supported by HAL ++* @adapter: ++* @in_bw: starting bw, value of CHANNEL_WIDTH ++* ++* Returns: value of CHANNEL_WIDTH ++*/ ++u8 hal_largest_bw(_adapter *adapter, u8 in_bw) ++{ ++ for (; in_bw > CHANNEL_WIDTH_20; in_bw--) { ++ if (hal_is_bw_support(adapter, in_bw)) ++ break; ++ } ++ ++ if (!hal_is_bw_support(adapter, in_bw)) ++ rtw_warn_on(1); ++ ++ return in_bw; ++} ++ ++void rtw_hal_correct_tsf(_adapter *padapter, u8 hw_port, u64 tsf) ++{ ++ if (hw_port == HW_PORT0) { ++ /*disable related TSF function*/ ++ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) & (~EN_BCN_FUNCTION)); ++ ++ rtw_write32(padapter, REG_TSFTR, tsf); ++ rtw_write32(padapter, REG_TSFTR + 4, tsf >> 32); ++ ++ /*enable related TSF function*/ ++ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) | EN_BCN_FUNCTION); ++ } else if (hw_port == HW_PORT1) { ++ /*disable related TSF function*/ ++ rtw_write8(padapter, REG_BCN_CTRL_1, rtw_read8(padapter, REG_BCN_CTRL_1) & (~EN_BCN_FUNCTION)); ++ ++ rtw_write32(padapter, REG_TSFTR1, tsf); ++ rtw_write32(padapter, REG_TSFTR1 + 4, tsf >> 32); ++ ++ /*enable related TSF function*/ ++ rtw_write8(padapter, REG_BCN_CTRL_1, rtw_read8(padapter, REG_BCN_CTRL_1) | EN_BCN_FUNCTION); ++ } else ++ RTW_INFO("%s-[WARN] "ADPT_FMT" invalid hw_port:%d\n", __func__, ADPT_ARG(padapter), hw_port); ++} ++ ++void ResumeTxBeacon(_adapter *padapter) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ ++ ++ /* 2010.03.01. Marked by tynli. No need to call workitem beacause we record the value */ ++ /* which should be read from register to a global variable. */ ++ ++ ++ pHalData->RegFwHwTxQCtrl |= BIT(6); ++ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl); ++ rtw_write8(padapter, REG_TBTT_PROHIBIT + 1, 0xff); ++ pHalData->RegReg542 |= BIT(0); ++ rtw_write8(padapter, REG_TBTT_PROHIBIT + 2, pHalData->RegReg542); ++} ++ ++void StopTxBeacon(_adapter *padapter) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ ++ ++ /* 2010.03.01. Marked by tynli. No need to call workitem beacause we record the value */ ++ /* which should be read from register to a global variable. */ ++ ++ ++ pHalData->RegFwHwTxQCtrl &= ~BIT(6); ++ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl); ++ rtw_write8(padapter, REG_TBTT_PROHIBIT + 1, 0x64); ++ pHalData->RegReg542 &= ~BIT(0); ++ rtw_write8(padapter, REG_TBTT_PROHIBIT + 2, pHalData->RegReg542); ++ ++ /*CheckFwRsvdPageContent(padapter);*/ /* 2010.06.23. Added by tynli. */ ++} ++ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM /*HW port0 - MBSS*/ ++void hw_var_set_opmode_mbid(_adapter *Adapter, u8 mode) ++{ ++ RTW_INFO("%s()-"ADPT_FMT" mode = %d\n", __func__, ADPT_ARG(Adapter), mode); ++ ++ rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR) & (~(RCR_CBSSID_DATA | RCR_CBSSID_BCN))); ++ ++ /* disable Port0 TSF update*/ ++ rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL) | DIS_TSF_UDT); ++ ++ /* set net_type */ ++ Set_MSR(Adapter, mode); ++ ++ if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) { ++ if (!rtw_mi_check_status(Adapter, MI_AP_MODE)) ++ StopTxBeacon(Adapter); ++ ++ rtw_write8(Adapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_ATIM);/*disable atim wnd*/ ++ } else if (mode == _HW_STATE_ADHOC_) { ++ ResumeTxBeacon(Adapter); ++ rtw_write8(Adapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); ++ ++ } else if (mode == _HW_STATE_AP_) { ++ ResumeTxBeacon(Adapter); ++ ++ rtw_write8(Adapter, REG_BCN_CTRL, DIS_TSF_UDT | DIS_BCNQ_SUB); ++ ++ /*enable to rx data frame*/ ++ rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); ++ ++ /*Beacon Control related register for first time*/ ++ rtw_write8(Adapter, REG_BCNDMATIM, 0x02); /* 2ms */ ++ ++ /*rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF);*/ ++ rtw_write8(Adapter, REG_ATIMWND, 0x0a); /* 10ms */ ++ rtw_write16(Adapter, REG_BCNTCFG, 0x00); ++ rtw_write16(Adapter, REG_TBTT_PROHIBIT, 0xff04); ++ rtw_write16(Adapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ ++ ++ /*reset TSF*/ ++ rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(0)); ++ ++ /*enable BCN0 Function for if1*/ ++ /*don't enable update TSF0 for if1 (due to TSF update when beacon,probe rsp are received)*/ ++ rtw_write8(Adapter, REG_BCN_CTRL, (DIS_TSF_UDT | EN_BCN_FUNCTION | EN_TXBCN_RPT | DIS_BCNQ_SUB)); ++ ++ if (IS_HARDWARE_TYPE_8821(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter))/* select BCN on port 0 for DualBeacon*/ ++ rtw_write8(Adapter, REG_CCK_CHECK, rtw_read8(Adapter, REG_CCK_CHECK) & (~BIT_BCN_PORT_SEL)); ++ ++ } ++ ++} ++#endif ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++u8 rtw_hal_antdiv_before_linked(_adapter *padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 cur_ant, change_ant; ++ ++ if (!pHalData->AntDivCfg) ++ return _FALSE; ++ ++ if (pHalData->sw_antdiv_bl_state == 0) { ++ pHalData->sw_antdiv_bl_state = 1; ++ ++ rtw_hal_get_odm_var(padapter, HAL_ODM_ANTDIV_SELECT, &cur_ant, NULL); ++ change_ant = (cur_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; ++ ++ return rtw_antenna_select_cmd(padapter, change_ant, _FALSE); ++ } ++ ++ pHalData->sw_antdiv_bl_state = 0; ++ return _FALSE; ++} ++ ++void rtw_hal_antdiv_rssi_compared(_adapter *padapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ if (pHalData->AntDivCfg) { ++ /*RTW_INFO("update_network=> org-RSSI(%d), new-RSSI(%d)\n", dst->Rssi, src->Rssi);*/ ++ /*select optimum_antenna for before linked =>For antenna diversity*/ ++ if (dst->Rssi >= src->Rssi) {/*keep org parameter*/ ++ src->Rssi = dst->Rssi; ++ src->PhyInfo.Optimum_antenna = dst->PhyInfo.Optimum_antenna; ++ } ++ } ++} ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_com_c2h.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_com_c2h.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/hal_com_c2h.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_com_c2h.h 2018-02-11 21:44:27.151146147 +0200 +@@ -0,0 +1,117 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __COMMON_C2H_H__ ++#define __COMMON_C2H_H__ ++ ++#define C2H_TYPE_REG 0 ++#define C2H_TYPE_PKT 1 ++ ++/* ++* C2H event format: ++* Fields TRIGGER PAYLOAD SEQ PLEN ID ++* BITS [127:120] [119:16] [15:8] [7:4] [3:0] ++*/ ++#define C2H_ID(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)), 0, 4) ++#define C2H_PLEN(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)), 4, 4) ++#define C2H_SEQ(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)) + 1, 0, 8) ++#define C2H_PAYLOAD(_c2h) (((u8*)(_c2h)) + 2) ++ ++#define SET_C2H_ID(_c2h, _val) SET_BITS_TO_LE_1BYTE(((u8*)(_c2h)), 0, 4, _val) ++#define SET_C2H_PLEN(_c2h, _val) SET_BITS_TO_LE_1BYTE(((u8*)(_c2h)), 4, 4, _val) ++#define SET_C2H_SEQ(_c2h, _val) SET_BITS_TO_LE_1BYTE(((u8*)(_c2h)) + 1 , 0, 8, _val) ++ ++/* ++* C2H event format: ++* Fields TRIGGER PLEN PAYLOAD SEQ ID ++* BITS [127:120] [119:112] [111:16] [15:8] [7:0] ++*/ ++#define C2H_ID_88XX(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)), 0, 8) ++#define C2H_SEQ_88XX(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)) + 1, 0, 8) ++#define C2H_PAYLOAD_88XX(_c2h) (((u8*)(_c2h)) + 2) ++#define C2H_PLEN_88XX(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)) + 14, 0, 8) ++#define C2H_TRIGGER_88XX(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)) + 15, 0, 8) ++ ++#define SET_C2H_ID_88XX(_c2h, _val) SET_BITS_TO_LE_1BYTE(((u8*)(_c2h)), 0, 8, _val) ++#define SET_C2H_SEQ_88XX(_c2h, _val) SET_BITS_TO_LE_1BYTE(((u8*)(_c2h)) + 1, 0, 8, _val) ++#define SET_C2H_PLEN_88XX(_c2h, _val) SET_BITS_TO_LE_1BYTE(((u8*)(_c2h)) + 14, 0, 8, _val) ++ ++typedef enum _C2H_EVT { ++ C2H_DBG = 0x00, ++ C2H_LB = 0x01, ++ C2H_TXBF = 0x02, ++ C2H_CCX_TX_RPT = 0x03, ++ C2H_FW_SCAN_COMPLETE = 0x7, ++ C2H_BT_INFO = 0x09, ++ C2H_BT_MP_INFO = 0x0B, ++ C2H_RA_RPT = 0x0C, ++ C2H_RA_PARA_RPT = 0x0E, ++ C2H_FW_CHNL_SWITCH_COMPLETE = 0x10, ++ C2H_IQK_FINISH = 0x11, ++ C2H_MAILBOX_STATUS = 0x15, ++ C2H_P2P_RPORT = 0x16, ++ C2H_MCC = 0x17, ++ C2H_MAC_HIDDEN_RPT = 0x19, ++ C2H_MAC_HIDDEN_RPT_2 = 0x1A, ++ C2H_BCN_EARLY_RPT = 0x1E, ++ C2H_DEFEATURE_DBG = 0x22, ++ C2H_CUSTOMER_STR_RPT = 0x24, ++ C2H_CUSTOMER_STR_RPT_2 = 0x25, ++ C2H_DEFEATURE_RSVD = 0xFD, ++ C2H_EXTEND = 0xff, ++} C2H_EVT; ++ ++typedef enum _EXTEND_C2H_EVT { ++ EXTEND_C2H_DBG_PRINT = 0 ++} EXTEND_C2H_EVT; ++ ++#define C2H_REG_LEN 16 ++ ++/* C2H_IQK_FINISH, 0x11 */ ++#define IQK_OFFLOAD_LEN 1 ++void c2h_iqk_offload(_adapter *adapter, u8 *data, u8 len); ++int c2h_iqk_offload_wait(_adapter *adapter, u32 timeout_ms); ++#define rtl8812_iqk_wait c2h_iqk_offload_wait /* TODO: remove this after phydm call c2h_iqk_offload_wait instead */ ++ ++#ifdef CONFIG_RTW_MAC_HIDDEN_RPT ++/* C2H_MAC_HIDDEN_RPT, 0x19 */ ++#define MAC_HIDDEN_RPT_LEN 8 ++int c2h_mac_hidden_rpt_hdl(_adapter *adapter, u8 *data, u8 len); ++ ++/* C2H_MAC_HIDDEN_RPT_2, 0x1A */ ++#define MAC_HIDDEN_RPT_2_LEN 5 ++int c2h_mac_hidden_rpt_2_hdl(_adapter *adapter, u8 *data, u8 len); ++int hal_read_mac_hidden_rpt(_adapter *adapter); ++#endif /* CONFIG_RTW_MAC_HIDDEN_RPT */ ++ ++/* C2H_DEFEATURE_DBG, 0x22 */ ++#define DEFEATURE_DBG_LEN 1 ++int c2h_defeature_dbg_hdl(_adapter *adapter, u8 *data, u8 len); ++ ++#ifdef CONFIG_RTW_CUSTOMER_STR ++/* C2H_CUSTOMER_STR_RPT, 0x24 */ ++#define CUSTOMER_STR_RPT_LEN 8 ++int c2h_customer_str_rpt_hdl(_adapter *adapter, u8 *data, u8 len); ++ ++/* C2H_CUSTOMER_STR_RPT_2, 0x25 */ ++#define CUSTOMER_STR_RPT_2_LEN 8 ++int c2h_customer_str_rpt_2_hdl(_adapter *adapter, u8 *data, u8 len); ++#endif /* CONFIG_RTW_CUSTOMER_STR */ ++ ++#endif /* __COMMON_C2H_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_com_phycfg.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_com_phycfg.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/hal_com_phycfg.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_com_phycfg.c 2018-02-11 21:44:27.152146162 +0200 +@@ -0,0 +1,5452 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _HAL_COM_PHYCFG_C_ ++ ++#include ++#include ++ ++#define PG_TXPWR_MSB_DIFF_S4BIT(_pg_v) (((_pg_v) & 0xf0) >> 4) ++#define PG_TXPWR_LSB_DIFF_S4BIT(_pg_v) ((_pg_v) & 0x0f) ++#define PG_TXPWR_MSB_DIFF_TO_S8BIT(_pg_v) ((PG_TXPWR_MSB_DIFF_S4BIT(_pg_v) & BIT3) ? (PG_TXPWR_MSB_DIFF_S4BIT(_pg_v) | 0xF0) : PG_TXPWR_MSB_DIFF_S4BIT(_pg_v)) ++#define PG_TXPWR_LSB_DIFF_TO_S8BIT(_pg_v) ((PG_TXPWR_LSB_DIFF_S4BIT(_pg_v) & BIT3) ? (PG_TXPWR_LSB_DIFF_S4BIT(_pg_v) | 0xF0) : PG_TXPWR_LSB_DIFF_S4BIT(_pg_v)) ++#define IS_PG_TXPWR_BASE_INVALID(_base) ((_base) > 63) ++#define IS_PG_TXPWR_DIFF_INVALID(_diff) ((_diff) > 7 || (_diff) < -8) ++#define PG_TXPWR_INVALID_BASE 255 ++#define PG_TXPWR_INVALID_DIFF 8 ++ ++#if !IS_PG_TXPWR_BASE_INVALID(PG_TXPWR_INVALID_BASE) ++#error "PG_TXPWR_BASE definition has problem" ++#endif ++ ++#if !IS_PG_TXPWR_DIFF_INVALID(PG_TXPWR_INVALID_DIFF) ++#error "PG_TXPWR_DIFF definition has problem" ++#endif ++ ++#define PG_TXPWR_SRC_PG_DATA 0 ++#define PG_TXPWR_SRC_IC_DEF 1 ++#define PG_TXPWR_SRC_DEF 2 ++#define PG_TXPWR_SRC_NUM 3 ++ ++const char *const _pg_txpwr_src_str[] = { ++ "PG_DATA", ++ "IC_DEF", ++ "DEF", ++ "UNKNOWN" ++}; ++ ++#define pg_txpwr_src_str(src) (((src) >= PG_TXPWR_SRC_NUM) ? _pg_txpwr_src_str[PG_TXPWR_SRC_NUM] : _pg_txpwr_src_str[(src)]) ++ ++#ifndef DBG_PG_TXPWR_READ ++#define DBG_PG_TXPWR_READ 0 ++#endif ++ ++void dump_pg_txpwr_info_2g(void *sel, TxPowerInfo24G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt) ++{ ++ int path, group, tx_idx; ++ ++ RTW_PRINT_SEL(sel, "2.4G\n"); ++ RTW_PRINT_SEL(sel, "CCK-1T base:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (group = 0; group < MAX_CHNL_GROUP_24G; group++) ++ _RTW_PRINT_SEL(sel, "G%02d ", group); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (group = 0; group < MAX_CHNL_GROUP_24G; group++) ++ _RTW_PRINT_SEL(sel, "%3u ", txpwr_info->IndexCCK_Base[path][group]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "CCK diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) ++ _RTW_PRINT_SEL(sel, "%dT ", path + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->CCK_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "BW40-1S base:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (group = 0; group < MAX_CHNL_GROUP_24G - 1; group++) ++ _RTW_PRINT_SEL(sel, "G%02d ", group); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (group = 0; group < MAX_CHNL_GROUP_24G - 1; group++) ++ _RTW_PRINT_SEL(sel, "%3u ", txpwr_info->IndexBW40_Base[path][group]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "OFDM diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) ++ _RTW_PRINT_SEL(sel, "%dT ", path + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->OFDM_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "BW20 diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) ++ _RTW_PRINT_SEL(sel, "%dS ", path + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW20_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "BW40 diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) ++ _RTW_PRINT_SEL(sel, "%dS ", path + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW40_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++} ++ ++void dump_pg_txpwr_info_5g(void *sel, TxPowerInfo5G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt) ++{ ++ int path, group, tx_idx; ++ ++ RTW_PRINT_SEL(sel, "5G\n"); ++ RTW_PRINT_SEL(sel, "BW40-1S base:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (group = 0; group < MAX_CHNL_GROUP_5G; group++) ++ _RTW_PRINT_SEL(sel, "G%02d ", group); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (group = 0; group < MAX_CHNL_GROUP_5G; group++) ++ _RTW_PRINT_SEL(sel, "%3u ", txpwr_info->IndexBW40_Base[path][group]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "OFDM diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) ++ _RTW_PRINT_SEL(sel, "%dT ", path + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->OFDM_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "BW20 diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) ++ _RTW_PRINT_SEL(sel, "%dS ", path + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW20_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "BW40 diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) ++ _RTW_PRINT_SEL(sel, "%dS ", path + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW40_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "BW80 diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) ++ _RTW_PRINT_SEL(sel, "%dS ", path + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW80_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "BW160 diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) ++ _RTW_PRINT_SEL(sel, "%dS ", path + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW160_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++} ++ ++const struct map_t pg_txpwr_def_info = ++ MAP_ENT(0xB8, 1, 0xFF ++ , MAPSEG_ARRAY_ENT(0x10, 168, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE, 0xEE, 0xEE, ++ 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, ++ 0x04, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, ++ 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, ++ 0xEE, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, ++ 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, ++ 0x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, ++ 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xEE, ++ 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE) ++ ); ++ ++#ifdef CONFIG_RTL8188E ++static const struct map_t rtl8188e_pg_txpwr_def_info = ++ MAP_ENT(0xB8, 1, 0xFF ++ , MAPSEG_ARRAY_ENT(0x10, 12, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24) ++ ); ++#endif ++ ++#ifdef CONFIG_RTL8188F ++static const struct map_t rtl8188f_pg_txpwr_def_info = ++ MAP_ENT(0xB8, 1, 0xFF ++ , MAPSEG_ARRAY_ENT(0x10, 12, ++ 0x22, 0x22, 0x22, 0x22, 0x22, 0x22, 0x27, 0x27, 0x27, 0x27, 0x27, 0x24) ++ ); ++#endif ++ ++#ifdef CONFIG_RTL8723B ++static const struct map_t rtl8723b_pg_txpwr_def_info = ++ MAP_ENT(0xB8, 2, 0xFF ++ , MAPSEG_ARRAY_ENT(0x10, 12, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0xE0) ++ , MAPSEG_ARRAY_ENT(0x3A, 12, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0xE0) ++ ); ++#endif ++ ++#ifdef CONFIG_RTL8703B ++static const struct map_t rtl8703b_pg_txpwr_def_info = ++ MAP_ENT(0xB8, 1, 0xFF ++ , MAPSEG_ARRAY_ENT(0x10, 12, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02) ++ ); ++#endif ++ ++#ifdef CONFIG_RTL8723D ++static const struct map_t rtl8723d_pg_txpwr_def_info = ++ MAP_ENT(0xB8, 2, 0xFF ++ , MAPSEG_ARRAY_ENT(0x10, 12, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02) ++ , MAPSEG_ARRAY_ENT(0x3A, 12, ++ 0x22, 0x22, 0x22, 0x22, 0x22, 0x22, 0x21, 0x21, 0x21, 0x21, 0x21, 0x02) ++ ); ++#endif ++ ++#ifdef CONFIG_RTL8192E ++static const struct map_t rtl8192e_pg_txpwr_def_info = ++ MAP_ENT(0xB8, 2, 0xFF ++ , MAPSEG_ARRAY_ENT(0x10, 14, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE) ++ , MAPSEG_ARRAY_ENT(0x3A, 14, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE) ++ ); ++#endif ++ ++#ifdef CONFIG_RTL8821A ++static const struct map_t rtl8821a_pg_txpwr_def_info = ++ MAP_ENT(0xB8, 1, 0xFF ++ , MAPSEG_ARRAY_ENT(0x10, 39, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xFF, 0xFF, 0xFF, 0xFF, ++ 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, ++ 0x04, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00) ++ ); ++#endif ++ ++#ifdef CONFIG_RTL8821C ++static const struct map_t rtl8821c_pg_txpwr_def_info = ++ MAP_ENT(0xB8, 1, 0xFF ++ , MAPSEG_ARRAY_ENT(0x10, 54, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xFF, 0xFF, 0xFF, 0xFF, ++ 0xFF, 0xFF, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, ++ 0x02, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xEC, 0xFF, 0xFF, 0xFF, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02) ++ ); ++#endif ++ ++#ifdef CONFIG_RTL8812A ++static const struct map_t rtl8812a_pg_txpwr_def_info = ++ MAP_ENT(0xB8, 1, 0xFF ++ , MAPSEG_ARRAY_ENT(0x10, 82, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, ++ 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, ++ 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, 0x00, 0xEE, 0xFF, 0xFF, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, ++ 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, ++ 0x00, 0xEE) ++ ); ++#endif ++ ++#ifdef CONFIG_RTL8822B ++static const struct map_t rtl8822b_pg_txpwr_def_info = ++ MAP_ENT(0xB8, 1, 0xFF ++ , MAPSEG_ARRAY_ENT(0x10, 82, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, ++ 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, ++ 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, 0xEC, 0xEC, 0xFF, 0xFF, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, ++ 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, ++ 0xEC, 0xEC) ++ ); ++#endif ++ ++#ifdef CONFIG_RTL8814A ++static const struct map_t rtl8814a_pg_txpwr_def_info = ++ MAP_ENT(0xB8, 1, 0xFF ++ , MAPSEG_ARRAY_ENT(0x10, 168, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, ++ 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, ++ 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x00, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, ++ 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, ++ 0x00, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, ++ 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, ++ 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x00, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, ++ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, ++ 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, ++ 0xEE, 0xEE, 0xEE, 0xEE, 0x00, 0xEE, 0xEE, 0xEE) ++ ); ++#endif ++ ++const struct map_t *hal_pg_txpwr_def_info(_adapter *adapter) ++{ ++ u8 interface_type = 0; ++ const struct map_t *map = NULL; ++ ++ interface_type = rtw_get_intf_type(adapter); ++ ++ switch (rtw_get_chip_type(adapter)) { ++#ifdef CONFIG_RTL8723B ++ case RTL8723B: ++ map = &rtl8723b_pg_txpwr_def_info; ++ break; ++#endif ++#ifdef CONFIG_RTL8703B ++ case RTL8703B: ++ map = &rtl8703b_pg_txpwr_def_info; ++ break; ++#endif ++#ifdef CONFIG_RTL8723D ++ case RTL8723D: ++ map = &rtl8723d_pg_txpwr_def_info; ++ break; ++#endif ++#ifdef CONFIG_RTL8188E ++ case RTL8188E: ++ map = &rtl8188e_pg_txpwr_def_info; ++ break; ++#endif ++#ifdef CONFIG_RTL8188F ++ case RTL8188F: ++ map = &rtl8188f_pg_txpwr_def_info; ++ break; ++#endif ++#ifdef CONFIG_RTL8812A ++ case RTL8812: ++ map = &rtl8812a_pg_txpwr_def_info; ++ break; ++#endif ++#ifdef CONFIG_RTL8821A ++ case RTL8821: ++ map = &rtl8821a_pg_txpwr_def_info; ++ break; ++#endif ++#ifdef CONFIG_RTL8192E ++ case RTL8192E: ++ map = &rtl8192e_pg_txpwr_def_info; ++ break; ++#endif ++#ifdef CONFIG_RTL8814A ++ case RTL8814A: ++ map = &rtl8814a_pg_txpwr_def_info; ++ break; ++#endif ++#ifdef CONFIG_RTL8822B ++ case RTL8822B: ++ map = &rtl8822b_pg_txpwr_def_info; ++ break; ++#endif ++#ifdef CONFIG_RTL8821C ++ case RTL8821C: ++ map = &rtl8821c_pg_txpwr_def_info; ++ break; ++#endif ++ } ++ ++ if (map == NULL) { ++ RTW_ERR("%s: unknown chip_type:%u\n" ++ , __func__, rtw_get_chip_type(adapter)); ++ rtw_warn_on(1); ++ } ++ ++ return map; ++} ++ ++static u8 hal_chk_pg_txpwr_info_2g(_adapter *adapter, TxPowerInfo24G *pwr_info) ++{ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ u8 path, group, tx_idx; ++ ++ if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_2G)) ++ return _SUCCESS; ++ ++ for (path = 0; path < MAX_RF_PATH; path++) { ++ if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) ++ continue; ++ for (group = 0; group < MAX_CHNL_GROUP_24G; group++) { ++ if (IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexCCK_Base[path][group]) ++ || IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexBW40_Base[path][group])) ++ return _FAIL; ++ } ++ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { ++ if (!HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) ++ continue; ++ if (IS_PG_TXPWR_DIFF_INVALID(pwr_info->CCK_Diff[path][tx_idx]) ++ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) ++ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) ++ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx])) ++ return _FAIL; ++ } ++ } ++ ++ return _SUCCESS; ++} ++ ++static u8 hal_chk_pg_txpwr_info_5g(_adapter *adapter, TxPowerInfo5G *pwr_info) ++{ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ u8 path, group, tx_idx; ++ ++ if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_5G)) ++ return _SUCCESS; ++ ++ for (path = 0; path < MAX_RF_PATH; path++) { ++ if (!HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) ++ continue; ++ for (group = 0; group < MAX_CHNL_GROUP_5G; group++) ++ if (IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexBW40_Base[path][group])) ++ return _FAIL; ++ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { ++ if (!HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) ++ continue; ++ if (IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) ++ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) ++ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx]) ++ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW80_Diff[path][tx_idx]) ++ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW160_Diff[path][tx_idx])) ++ return _FAIL; ++ } ++ } ++#endif /* CONFIG_IEEE80211_BAND_5GHZ */ ++ return _SUCCESS; ++} ++ ++static inline void hal_init_pg_txpwr_info_2g(_adapter *adapter, TxPowerInfo24G *pwr_info) ++{ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ u8 path, group, tx_idx; ++ ++ if (pwr_info == NULL) ++ return; ++ ++ _rtw_memset(pwr_info, 0, sizeof(TxPowerInfo24G)); ++ ++ /* init with invalid value */ ++ for (path = 0; path < MAX_RF_PATH; path++) { ++ for (group = 0; group < MAX_CHNL_GROUP_24G; group++) { ++ pwr_info->IndexCCK_Base[path][group] = PG_TXPWR_INVALID_BASE; ++ pwr_info->IndexBW40_Base[path][group] = PG_TXPWR_INVALID_BASE; ++ } ++ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { ++ pwr_info->CCK_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; ++ pwr_info->OFDM_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; ++ pwr_info->BW20_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; ++ pwr_info->BW40_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; ++ } ++ } ++ ++ /* init for dummy base and diff */ ++ for (path = 0; path < MAX_RF_PATH; path++) { ++ if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) ++ break; ++ /* 2.4G BW40 base has 1 less group than CCK base*/ ++ pwr_info->IndexBW40_Base[path][MAX_CHNL_GROUP_24G - 1] = 0; ++ ++ /* dummy diff */ ++ pwr_info->CCK_Diff[path][0] = 0; /* 2.4G CCK-1TX */ ++ pwr_info->BW40_Diff[path][0] = 0; /* 2.4G BW40-1S */ ++ } ++} ++ ++static inline void hal_init_pg_txpwr_info_5g(_adapter *adapter, TxPowerInfo5G *pwr_info) ++{ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ u8 path, group, tx_idx; ++ ++ if (pwr_info == NULL) ++ return; ++ ++ _rtw_memset(pwr_info, 0, sizeof(TxPowerInfo5G)); ++ ++ /* init with invalid value */ ++ for (path = 0; path < MAX_RF_PATH; path++) { ++ for (group = 0; group < MAX_CHNL_GROUP_5G; group++) ++ pwr_info->IndexBW40_Base[path][group] = PG_TXPWR_INVALID_BASE; ++ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { ++ pwr_info->OFDM_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; ++ pwr_info->BW20_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; ++ pwr_info->BW40_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; ++ pwr_info->BW80_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; ++ pwr_info->BW160_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; ++ } ++ } ++ ++ for (path = 0; path < MAX_RF_PATH; path++) { ++ if (!HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) ++ break; ++ /* dummy diff */ ++ pwr_info->BW40_Diff[path][0] = 0; /* 5G BW40-1S */ ++ } ++#endif /* CONFIG_IEEE80211_BAND_5GHZ */ ++} ++ ++#if DBG_PG_TXPWR_READ ++#define LOAD_PG_TXPWR_WARN_COND(_txpwr_src) 1 ++#else ++#define LOAD_PG_TXPWR_WARN_COND(_txpwr_src) (_txpwr_src > PG_TXPWR_SRC_PG_DATA) ++#endif ++ ++u16 hal_load_pg_txpwr_info_path_2g( ++ _adapter *adapter, ++ TxPowerInfo24G *pwr_info, ++ u32 path, ++ u8 txpwr_src, ++ const struct map_t *txpwr_map, ++ u16 pg_offset) ++{ ++#define PG_TXPWR_1PATH_BYTE_NUM_2G 18 ++ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ u16 offset = pg_offset; ++ u8 group, tx_idx; ++ u8 val; ++ u8 tmp_base; ++ s8 tmp_diff; ++ ++ if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_2G)) { ++ offset += PG_TXPWR_1PATH_BYTE_NUM_2G; ++ goto exit; ++ } ++ ++ if (DBG_PG_TXPWR_READ) ++ RTW_INFO("%s [%c] offset:0x%03x\n", __func__, rf_path_char(path), offset); ++ ++ for (group = 0; group < MAX_CHNL_GROUP_24G; group++) { ++ if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) { ++ tmp_base = map_read8(txpwr_map, offset); ++ if (!IS_PG_TXPWR_BASE_INVALID(tmp_base) ++ && IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexCCK_Base[path][group]) ++ ) { ++ pwr_info->IndexCCK_Base[path][group] = tmp_base; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 2G G%02d CCK-1T base:%u from %s\n", rf_path_char(path), group, tmp_base, pg_txpwr_src_str(txpwr_src)); ++ } ++ } ++ offset++; ++ } ++ ++ for (group = 0; group < MAX_CHNL_GROUP_24G - 1; group++) { ++ if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) { ++ tmp_base = map_read8(txpwr_map, offset); ++ if (!IS_PG_TXPWR_BASE_INVALID(tmp_base) ++ && IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexBW40_Base[path][group]) ++ ) { ++ pwr_info->IndexBW40_Base[path][group] = tmp_base; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 2G G%02d BW40-1S base:%u from %s\n", rf_path_char(path), group, tmp_base, pg_txpwr_src_str(txpwr_src)); ++ } ++ } ++ offset++; ++ } ++ ++ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { ++ if (tx_idx == 0) { ++ if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) { ++ val = map_read8(txpwr_map, offset); ++ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) ++ ) { ++ pwr_info->BW20_Diff[path][tx_idx] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 2G BW20-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) ++ ) { ++ pwr_info->OFDM_Diff[path][tx_idx] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 2G OFDM-%dT diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ } ++ offset++; ++ } else { ++ if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) { ++ val = map_read8(txpwr_map, offset); ++ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx]) ++ ) { ++ pwr_info->BW40_Diff[path][tx_idx] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 2G BW40-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ ++ } ++ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) ++ ) { ++ pwr_info->BW20_Diff[path][tx_idx] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 2G BW20-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ } ++ offset++; ++ ++ if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) { ++ val = map_read8(txpwr_map, offset); ++ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) ++ ) { ++ pwr_info->OFDM_Diff[path][tx_idx] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 2G OFDM-%dT diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->CCK_Diff[path][tx_idx]) ++ ) { ++ pwr_info->CCK_Diff[path][tx_idx] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 2G CCK-%dT diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ } ++ offset++; ++ } ++ } ++ ++ if (offset != pg_offset + PG_TXPWR_1PATH_BYTE_NUM_2G) { ++ RTW_ERR("%s parse %d bytes != %d\n", __func__, offset - pg_offset, PG_TXPWR_1PATH_BYTE_NUM_2G); ++ rtw_warn_on(1); ++ } ++ ++exit: ++ return offset; ++} ++ ++u16 hal_load_pg_txpwr_info_path_5g( ++ _adapter *adapter, ++ TxPowerInfo5G *pwr_info, ++ u32 path, ++ u8 txpwr_src, ++ const struct map_t *txpwr_map, ++ u16 pg_offset) ++{ ++#define PG_TXPWR_1PATH_BYTE_NUM_5G 24 ++ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ u16 offset = pg_offset; ++ u8 group, tx_idx; ++ u8 val; ++ u8 tmp_base; ++ s8 tmp_diff; ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_5G)) ++#endif ++ { ++ offset += PG_TXPWR_1PATH_BYTE_NUM_5G; ++ goto exit; ++ } ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ if (DBG_PG_TXPWR_READ) ++ RTW_INFO("%s[%c] eaddr:0x%03x\n", __func__, rf_path_char(path), offset); ++ ++ for (group = 0; group < MAX_CHNL_GROUP_5G; group++) { ++ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) { ++ tmp_base = map_read8(txpwr_map, offset); ++ if (!IS_PG_TXPWR_BASE_INVALID(tmp_base) ++ && IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexBW40_Base[path][group]) ++ ) { ++ pwr_info->IndexBW40_Base[path][group] = tmp_base; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 5G G%02d BW40-1S base:%u from %s\n", rf_path_char(path), group, tmp_base, pg_txpwr_src_str(txpwr_src)); ++ } ++ } ++ offset++; ++ } ++ ++ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { ++ if (tx_idx == 0) { ++ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) { ++ val = map_read8(txpwr_map, offset); ++ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) ++ ) { ++ pwr_info->BW20_Diff[path][tx_idx] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 5G BW20-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) ++ ) { ++ pwr_info->OFDM_Diff[path][tx_idx] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ } ++ offset++; ++ } else { ++ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) { ++ val = map_read8(txpwr_map, offset); ++ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx]) ++ ) { ++ pwr_info->BW40_Diff[path][tx_idx] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 5G BW40-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) ++ ) { ++ pwr_info->BW20_Diff[path][tx_idx] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 5G BW20-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ } ++ offset++; ++ } ++ } ++ ++ /* OFDM diff 2T ~ 3T */ ++ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, 1)) { ++ val = map_read8(txpwr_map, offset); ++ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][1]) ++ ) { ++ pwr_info->OFDM_Diff[path][1] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), 2, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ if (HAL_SPEC_CHK_TX_CNT(hal_spec, 2)) { ++ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][2]) ++ ) { ++ pwr_info->OFDM_Diff[path][2] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), 3, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ } ++ } ++ offset++; ++ ++ /* OFDM diff 4T */ ++ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, 3)) { ++ val = map_read8(txpwr_map, offset); ++ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][3]) ++ ) { ++ pwr_info->OFDM_Diff[path][3] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), 4, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ } ++ offset++; ++ ++ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { ++ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) { ++ val = map_read8(txpwr_map, offset); ++ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW80_Diff[path][tx_idx]) ++ ) { ++ pwr_info->BW80_Diff[path][tx_idx] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 5G BW80-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); ++ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) ++ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW160_Diff[path][tx_idx]) ++ ) { ++ pwr_info->BW160_Diff[path][tx_idx] = tmp_diff; ++ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) ++ RTW_INFO("[%c] 5G BW160-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); ++ } ++ } ++ offset++; ++ } ++ ++ if (offset != pg_offset + PG_TXPWR_1PATH_BYTE_NUM_5G) { ++ RTW_ERR("%s parse %d bytes != %d\n", __func__, offset - pg_offset, PG_TXPWR_1PATH_BYTE_NUM_5G); ++ rtw_warn_on(1); ++ } ++ ++#endif /* #ifdef CONFIG_IEEE80211_BAND_5GHZ */ ++ ++exit: ++ return offset; ++} ++ ++void hal_load_pg_txpwr_info( ++ _adapter *adapter, ++ TxPowerInfo24G *pwr_info_2g, ++ TxPowerInfo5G *pwr_info_5g, ++ u8 *pg_data, ++ BOOLEAN AutoLoadFail ++) ++{ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ u8 path; ++ u16 pg_offset; ++ u8 txpwr_src = PG_TXPWR_SRC_PG_DATA; ++ struct map_t pg_data_map = MAP_ENT(184, 1, 0xFF, MAPSEG_PTR_ENT(0x00, 184, pg_data)); ++ const struct map_t *txpwr_map = NULL; ++ ++ /* init with invalid value and some dummy base and diff */ ++ hal_init_pg_txpwr_info_2g(adapter, pwr_info_2g); ++ hal_init_pg_txpwr_info_5g(adapter, pwr_info_5g); ++ ++select_src: ++ pg_offset = 0x10; ++ ++ switch (txpwr_src) { ++ case PG_TXPWR_SRC_PG_DATA: ++ txpwr_map = &pg_data_map; ++ break; ++ case PG_TXPWR_SRC_IC_DEF: ++ txpwr_map = hal_pg_txpwr_def_info(adapter); ++ break; ++ case PG_TXPWR_SRC_DEF: ++ default: ++ txpwr_map = &pg_txpwr_def_info; ++ break; ++ }; ++ ++ if (txpwr_map == NULL) ++ goto end_parse; ++ ++ for (path = 0; path < MAX_RF_PATH ; path++) { ++ if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && !HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) ++ break; ++ pg_offset = hal_load_pg_txpwr_info_path_2g(adapter, pwr_info_2g, path, txpwr_src, txpwr_map, pg_offset); ++ pg_offset = hal_load_pg_txpwr_info_path_5g(adapter, pwr_info_5g, path, txpwr_src, txpwr_map, pg_offset); ++ } ++ ++ if (hal_chk_pg_txpwr_info_2g(adapter, pwr_info_2g) == _SUCCESS ++ && hal_chk_pg_txpwr_info_5g(adapter, pwr_info_5g) == _SUCCESS) ++ goto exit; ++ ++end_parse: ++ txpwr_src++; ++ if (txpwr_src < PG_TXPWR_SRC_NUM) ++ goto select_src; ++ ++ if (hal_chk_pg_txpwr_info_2g(adapter, pwr_info_2g) != _SUCCESS ++ || hal_chk_pg_txpwr_info_5g(adapter, pwr_info_5g) != _SUCCESS) ++ rtw_warn_on(1); ++ ++exit: ++ if (DBG_PG_TXPWR_READ) { ++ if (pwr_info_2g) ++ dump_pg_txpwr_info_2g(RTW_DBGDUMP, pwr_info_2g, 4, 4); ++ if (pwr_info_5g) ++ dump_pg_txpwr_info_5g(RTW_DBGDUMP, pwr_info_5g, 4, 4); ++ } ++ ++ return; ++} ++ ++void hal_load_txpwr_info( ++ _adapter *adapter, ++ TxPowerInfo24G *pwr_info_2g, ++ TxPowerInfo5G *pwr_info_5g, ++ u8 *pg_data ++) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ u8 max_tx_cnt = hal_spec->max_tx_cnt; ++ u8 rfpath, ch_idx, group, tx_idx; ++ ++ /* load from pg data (or default value) */ ++ hal_load_pg_txpwr_info(adapter, pwr_info_2g, pwr_info_5g, pg_data, _FALSE); ++ ++ /* transform to hal_data */ ++ for (rfpath = 0; rfpath < MAX_RF_PATH; rfpath++) { ++ ++ if (!pwr_info_2g || !HAL_SPEC_CHK_RF_PATH_2G(hal_spec, rfpath)) ++ goto bypass_2g; ++ ++ /* 2.4G base */ ++ for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) { ++ u8 cck_group; ++ ++ if (rtw_get_ch_group(ch_idx + 1, &group, &cck_group) != BAND_ON_2_4G) ++ continue; ++ ++ hal_data->Index24G_CCK_Base[rfpath][ch_idx] = pwr_info_2g->IndexCCK_Base[rfpath][cck_group]; ++ hal_data->Index24G_BW40_Base[rfpath][ch_idx] = pwr_info_2g->IndexBW40_Base[rfpath][group]; ++ } ++ ++ /* 2.4G diff */ ++ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { ++ if (tx_idx >= max_tx_cnt) ++ break; ++ ++ hal_data->CCK_24G_Diff[rfpath][tx_idx] = pwr_info_2g->CCK_Diff[rfpath][tx_idx]; ++ hal_data->OFDM_24G_Diff[rfpath][tx_idx] = pwr_info_2g->OFDM_Diff[rfpath][tx_idx]; ++ hal_data->BW20_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW20_Diff[rfpath][tx_idx]; ++ hal_data->BW40_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW40_Diff[rfpath][tx_idx]; ++ } ++bypass_2g: ++ ; ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ if (!pwr_info_5g || !HAL_SPEC_CHK_RF_PATH_5G(hal_spec, rfpath)) ++ goto bypass_5g; ++ ++ /* 5G base */ ++ for (ch_idx = 0; ch_idx < CENTER_CH_5G_ALL_NUM; ch_idx++) { ++ if (rtw_get_ch_group(center_ch_5g_all[ch_idx], &group, NULL) != BAND_ON_5G) ++ continue; ++ hal_data->Index5G_BW40_Base[rfpath][ch_idx] = pwr_info_5g->IndexBW40_Base[rfpath][group]; ++ } ++ ++ for (ch_idx = 0 ; ch_idx < CENTER_CH_5G_80M_NUM; ch_idx++) { ++ u8 upper, lower; ++ ++ if (rtw_get_ch_group(center_ch_5g_80m[ch_idx], &group, NULL) != BAND_ON_5G) ++ continue; ++ ++ upper = pwr_info_5g->IndexBW40_Base[rfpath][group]; ++ lower = pwr_info_5g->IndexBW40_Base[rfpath][group + 1]; ++ hal_data->Index5G_BW80_Base[rfpath][ch_idx] = (upper + lower) / 2; ++ } ++ ++ /* 5G diff */ ++ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { ++ if (tx_idx >= max_tx_cnt) ++ break; ++ ++ hal_data->OFDM_5G_Diff[rfpath][tx_idx] = pwr_info_5g->OFDM_Diff[rfpath][tx_idx]; ++ hal_data->BW20_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW20_Diff[rfpath][tx_idx]; ++ hal_data->BW40_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW40_Diff[rfpath][tx_idx]; ++ hal_data->BW80_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW80_Diff[rfpath][tx_idx]; ++ } ++bypass_5g: ++ ; ++#endif /* CONFIG_IEEE80211_BAND_5GHZ */ ++ } ++} ++ ++void dump_hal_txpwr_info_2g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ int path, ch_idx, tx_idx; ++ ++ RTW_PRINT_SEL(sel, "2.4G\n"); ++ RTW_PRINT_SEL(sel, "CCK-1T base:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", center_ch_2g[ch_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) ++ _RTW_PRINT_SEL(sel, "%2u ", hal_data->Index24G_CCK_Base[path][ch_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "CCK diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%dT ", tx_idx + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", hal_data->CCK_24G_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "BW40-1S base:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", center_ch_2g[ch_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) ++ _RTW_PRINT_SEL(sel, "%2u ", hal_data->Index24G_BW40_Base[path][ch_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "OFDM diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%dT ", tx_idx + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", hal_data->OFDM_24G_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "BW20 diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW20_24G_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "BW40 diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW40_24G_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++} ++ ++void dump_hal_txpwr_info_5g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt) ++{ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ int path, ch_idx, tx_idx; ++ u8 dump_section = 0; ++ u8 ch_idx_s = 0; ++ ++ RTW_PRINT_SEL(sel, "5G\n"); ++ RTW_PRINT_SEL(sel, "BW40-1S base:\n"); ++ do { ++ #define DUMP_5G_BW40_BASE_SECTION_NUM 3 ++ u8 end[DUMP_5G_BW40_BASE_SECTION_NUM] = {64, 144, 177}; ++ ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (ch_idx = ch_idx_s; ch_idx < CENTER_CH_5G_ALL_NUM; ch_idx++) { ++ _RTW_PRINT_SEL(sel, "%3d ", center_ch_5g_all[ch_idx]); ++ if (end[dump_section] == center_ch_5g_all[ch_idx]) ++ break; ++ } ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (ch_idx = ch_idx_s; ch_idx < CENTER_CH_5G_ALL_NUM; ch_idx++) { ++ _RTW_PRINT_SEL(sel, "%3u ", hal_data->Index5G_BW40_Base[path][ch_idx]); ++ if (end[dump_section] == center_ch_5g_all[ch_idx]) ++ break; ++ } ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ ch_idx_s = ch_idx + 1; ++ dump_section++; ++ if (dump_section >= DUMP_5G_BW40_BASE_SECTION_NUM) ++ break; ++ } while (1); ++ ++ RTW_PRINT_SEL(sel, "BW80-1S base:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (ch_idx = 0; ch_idx < CENTER_CH_5G_80M_NUM; ch_idx++) ++ _RTW_PRINT_SEL(sel, "%3d ", center_ch_5g_80m[ch_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (ch_idx = 0; ch_idx < CENTER_CH_5G_80M_NUM; ch_idx++) ++ _RTW_PRINT_SEL(sel, "%3u ", hal_data->Index5G_BW80_Base[path][ch_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "OFDM diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%dT ", tx_idx + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", hal_data->OFDM_5G_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "BW20 diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW20_5G_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "BW40 diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW40_5G_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ RTW_PRINT_SEL(sel, "BW80 diff:\n"); ++ RTW_PRINT_SEL(sel, "%4s ", ""); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); ++ _RTW_PRINT_SEL(sel, "\n"); ++ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { ++ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); ++ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) ++ _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW80_5G_Diff[path][tx_idx]); ++ _RTW_PRINT_SEL(sel, "\n"); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++#endif /* CONFIG_IEEE80211_BAND_5GHZ */ ++} ++ ++/* ++* rtw_regsty_get_target_tx_power - ++* ++* Return dBm or -1 for undefined ++*/ ++s8 rtw_regsty_get_target_tx_power( ++ IN PADAPTER Adapter, ++ IN u8 Band, ++ IN u8 RfPath, ++ IN RATE_SECTION RateSection ++) ++{ ++ struct registry_priv *regsty = adapter_to_regsty(Adapter); ++ s8 value = 0; ++ ++ if (RfPath > RF_PATH_D) { ++ RTW_PRINT("%s invalid RfPath:%d\n", __func__, RfPath); ++ return -1; ++ } ++ ++ if (Band != BAND_ON_2_4G ++ #ifdef CONFIG_IEEE80211_BAND_5GHZ ++ && Band != BAND_ON_5G ++ #endif ++ ) { ++ RTW_PRINT("%s invalid Band:%d\n", __func__, Band); ++ return -1; ++ } ++ ++ if (RateSection >= RATE_SECTION_NUM ++ #ifdef CONFIG_IEEE80211_BAND_5GHZ ++ || (Band == BAND_ON_5G && RateSection == CCK) ++ #endif ++ ) { ++ RTW_PRINT("%s invalid RateSection:%d in Band:%d, RfPath:%d\n", __func__ ++ , RateSection, Band, RfPath); ++ return -1; ++ } ++ ++ if (Band == BAND_ON_2_4G) ++ value = regsty->target_tx_pwr_2g[RfPath][RateSection]; ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ else /* BAND_ON_5G */ ++ value = regsty->target_tx_pwr_5g[RfPath][RateSection - 1]; ++#endif ++ ++ return value; ++} ++ ++bool rtw_regsty_chk_target_tx_power_valid(_adapter *adapter) ++{ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ int path, tx_num, band, rs; ++ s8 target; ++ ++ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { ++ if (!hal_is_band_support(adapter, band)) ++ continue; ++ ++ for (path = 0; path < RF_PATH_MAX; path++) { ++ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) ++ break; ++ ++ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { ++ tx_num = rate_section_to_tx_num(rs); ++ if (tx_num >= hal_spec->nss_num) ++ continue; ++ ++ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) ++ continue; ++ ++ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) ++ continue; ++ ++ target = rtw_regsty_get_target_tx_power(adapter, band, path, rs); ++ if (target == -1) { ++ RTW_PRINT("%s return _FALSE for band:%d, path:%d, rs:%d, t:%d\n", __func__, band, path, rs, target); ++ return _FALSE; ++ } ++ } ++ } ++ } ++ ++ return _TRUE; ++} ++ ++/* ++* PHY_GetTxPowerByRateBase - ++* ++* Return 2 times of dBm ++*/ ++u8 ++PHY_GetTxPowerByRateBase( ++ IN PADAPTER Adapter, ++ IN u8 Band, ++ IN u8 RfPath, ++ IN u8 TxNum, ++ IN RATE_SECTION RateSection ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 value = 0; ++ ++ if (RfPath > RF_PATH_D) { ++ RTW_PRINT("%s invalid RfPath:%d\n", __func__, RfPath); ++ return 0; ++ } ++ ++ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { ++ RTW_PRINT("%s invalid Band:%d\n", __func__, Band); ++ return 0; ++ } ++ ++ if (RateSection >= RATE_SECTION_NUM ++ || (Band == BAND_ON_5G && RateSection == CCK) ++ ) { ++ RTW_PRINT("%s invalid RateSection:%d in Band:%d, RfPath:%d, TxNum:%d\n", __func__ ++ , RateSection, Band, RfPath, TxNum); ++ return 0; ++ } ++ ++ if (Band == BAND_ON_2_4G) ++ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][RateSection]; ++ else /* BAND_ON_5G */ ++ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][RateSection - 1]; ++ ++ return value; ++} ++ ++VOID ++phy_SetTxPowerByRateBase( ++ IN PADAPTER Adapter, ++ IN u8 Band, ++ IN u8 RfPath, ++ IN RATE_SECTION RateSection, ++ IN u8 TxNum, ++ IN u8 Value ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ if (RfPath > RF_PATH_D) { ++ RTW_PRINT("%s invalid RfPath:%d\n", __func__, RfPath); ++ return; ++ } ++ ++ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { ++ RTW_PRINT("%s invalid Band:%d\n", __func__, Band); ++ return; ++ } ++ ++ if (RateSection >= RATE_SECTION_NUM ++ || (Band == BAND_ON_5G && RateSection == CCK) ++ ) { ++ RTW_PRINT("%s invalid RateSection:%d in %sG, RfPath:%d, TxNum:%d\n", __func__ ++ , RateSection, (Band == BAND_ON_2_4G) ? "2.4" : "5", RfPath, TxNum); ++ return; ++ } ++ ++ if (Band == BAND_ON_2_4G) ++ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][RateSection] = Value; ++ else /* BAND_ON_5G */ ++ pHalData->TxPwrByRateBase5G[RfPath][TxNum][RateSection - 1] = Value; ++} ++ ++static inline BOOLEAN phy_is_txpwr_by_rate_undefined_of_band_path(_adapter *adapter, u8 band, u8 path) ++{ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ u8 tx_num = 0, rate_idx = 0; ++ ++ for (tx_num = 0; tx_num < TX_PWR_BY_RATE_NUM_RF; tx_num++) { ++ if (tx_num >= hal_spec->max_tx_cnt || tx_num >= hal_spec->nss_num) ++ goto exit; ++ for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++) { ++ if (hal_data->TxPwrByRateOffset[band][path][tx_num][rate_idx] != 0) ++ goto exit; ++ } ++ } ++ ++exit: ++ return (tx_num >= hal_spec->max_tx_cnt || tx_num >= hal_spec->nss_num) ? _TRUE : _FALSE; ++} ++ ++static inline void phy_txpwr_by_rate_duplicate_band_path(_adapter *adapter, u8 band, u8 s_path, u8 t_path) ++{ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ u8 tx_num = 0, rate_idx = 0; ++ ++ for (tx_num = 0; tx_num < TX_PWR_BY_RATE_NUM_RF; tx_num++) ++ for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++) ++ hal_data->TxPwrByRateOffset[band][t_path][tx_num][rate_idx] = hal_data->TxPwrByRateOffset[band][s_path][tx_num][rate_idx]; ++} ++ ++static void phy_txpwr_by_rate_chk_for_path_dup(_adapter *adapter) ++{ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ u8 band, path; ++ s8 src_path; ++ ++ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) ++ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) ++ hal_data->txpwr_by_rate_undefined_band_path[band][path] = 0; ++ ++ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { ++ if (!hal_is_band_support(adapter, band)) ++ continue; ++ ++ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { ++ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) ++ continue; ++ ++ if (phy_is_txpwr_by_rate_undefined_of_band_path(adapter, band, path)) ++ hal_data->txpwr_by_rate_undefined_band_path[band][path] = 1; ++ } ++ } ++ ++ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { ++ if (!hal_is_band_support(adapter, band)) ++ continue; ++ ++ src_path = -1; ++ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { ++ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) ++ continue; ++ ++ /* find src */ ++ if (src_path == -1 && hal_data->txpwr_by_rate_undefined_band_path[band][path] == 0) ++ src_path = path; ++ } ++ ++ if (src_path == -1) { ++ RTW_ERR("%s all power by rate undefined\n", __func__); ++ continue; ++ } ++ ++ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { ++ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) ++ continue; ++ ++ /* duplicate src to undefined one */ ++ if (hal_data->txpwr_by_rate_undefined_band_path[band][path] == 1) { ++ RTW_INFO("%s duplicate %s [%c] to [%c]\n", __func__ ++ , band_str(band), rf_path_char(src_path), rf_path_char(path)); ++ phy_txpwr_by_rate_duplicate_band_path(adapter, band, src_path, path); ++ } ++ } ++ } ++} ++ ++VOID ++phy_StoreTxPowerByRateBase( ++ IN PADAPTER pAdapter ++) ++{ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(pAdapter); ++ struct registry_priv *regsty = adapter_to_regsty(pAdapter); ++ ++ u8 rate_sec_base[RATE_SECTION_NUM] = { ++ MGN_11M, ++ MGN_54M, ++ MGN_MCS7, ++ MGN_MCS15, ++ MGN_MCS23, ++ MGN_MCS31, ++ MGN_VHT1SS_MCS7, ++ MGN_VHT2SS_MCS7, ++ MGN_VHT3SS_MCS7, ++ MGN_VHT4SS_MCS7, ++ }; ++ ++ u8 band, path, rs, tx_num, base, index; ++ ++ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { ++ if (!hal_is_band_support(pAdapter, band)) ++ continue; ++ ++ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { ++ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) ++ break; ++ ++ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { ++ tx_num = rate_section_to_tx_num(rs); ++ if (tx_num >= hal_spec->nss_num) ++ continue; ++ ++ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) ++ continue; ++ ++ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) ++ continue; ++ ++ if (regsty->target_tx_pwr_valid == _TRUE) ++ base = 2 * rtw_regsty_get_target_tx_power(pAdapter, band, path, rs); ++ else ++ base = _PHY_GetTxPowerByRate(pAdapter, band, path, tx_num, rate_sec_base[rs]); ++ phy_SetTxPowerByRateBase(pAdapter, band, path, rs, tx_num, base); ++ } ++ } ++ } ++} ++ ++VOID ++PHY_GetRateValuesOfTxPowerByRate( ++ IN PADAPTER pAdapter, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Value, ++ OUT u8 *Rate, ++ OUT s8 *PwrByRateVal, ++ OUT u8 *RateNum ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ u8 index = 0, i = 0; ++ ++ switch (RegAddr) { ++ case rTxAGC_A_Rate18_06: ++ case rTxAGC_B_Rate18_06: ++ Rate[0] = MGN_6M; ++ Rate[1] = MGN_9M; ++ Rate[2] = MGN_12M; ++ Rate[3] = MGN_18M; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case rTxAGC_A_Rate54_24: ++ case rTxAGC_B_Rate54_24: ++ Rate[0] = MGN_24M; ++ Rate[1] = MGN_36M; ++ Rate[2] = MGN_48M; ++ Rate[3] = MGN_54M; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case rTxAGC_A_CCK1_Mcs32: ++ Rate[0] = MGN_1M; ++ PwrByRateVal[0] = (s8)((((Value >> (8 + 4)) & 0xF)) * 10 + ++ ((Value >> 8) & 0xF)); ++ *RateNum = 1; ++ break; ++ ++ case rTxAGC_B_CCK11_A_CCK2_11: ++ if (BitMask == 0xffffff00) { ++ Rate[0] = MGN_2M; ++ Rate[1] = MGN_5_5M; ++ Rate[2] = MGN_11M; ++ for (i = 1; i < 4; ++i) { ++ PwrByRateVal[i - 1] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 3; ++ } else if (BitMask == 0x000000ff) { ++ Rate[0] = MGN_11M; ++ PwrByRateVal[0] = (s8)((((Value >> 4) & 0xF)) * 10 + ++ (Value & 0xF)); ++ *RateNum = 1; ++ } ++ break; ++ ++ case rTxAGC_A_Mcs03_Mcs00: ++ case rTxAGC_B_Mcs03_Mcs00: ++ Rate[0] = MGN_MCS0; ++ Rate[1] = MGN_MCS1; ++ Rate[2] = MGN_MCS2; ++ Rate[3] = MGN_MCS3; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case rTxAGC_A_Mcs07_Mcs04: ++ case rTxAGC_B_Mcs07_Mcs04: ++ Rate[0] = MGN_MCS4; ++ Rate[1] = MGN_MCS5; ++ Rate[2] = MGN_MCS6; ++ Rate[3] = MGN_MCS7; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case rTxAGC_A_Mcs11_Mcs08: ++ case rTxAGC_B_Mcs11_Mcs08: ++ Rate[0] = MGN_MCS8; ++ Rate[1] = MGN_MCS9; ++ Rate[2] = MGN_MCS10; ++ Rate[3] = MGN_MCS11; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case rTxAGC_A_Mcs15_Mcs12: ++ case rTxAGC_B_Mcs15_Mcs12: ++ Rate[0] = MGN_MCS12; ++ Rate[1] = MGN_MCS13; ++ Rate[2] = MGN_MCS14; ++ Rate[3] = MGN_MCS15; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ ++ break; ++ ++ case rTxAGC_B_CCK1_55_Mcs32: ++ Rate[0] = MGN_1M; ++ Rate[1] = MGN_2M; ++ Rate[2] = MGN_5_5M; ++ for (i = 1; i < 4; ++i) { ++ PwrByRateVal[i - 1] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 3; ++ break; ++ ++ case 0xC20: ++ case 0xE20: ++ case 0x1820: ++ case 0x1a20: ++ Rate[0] = MGN_1M; ++ Rate[1] = MGN_2M; ++ Rate[2] = MGN_5_5M; ++ Rate[3] = MGN_11M; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xC24: ++ case 0xE24: ++ case 0x1824: ++ case 0x1a24: ++ Rate[0] = MGN_6M; ++ Rate[1] = MGN_9M; ++ Rate[2] = MGN_12M; ++ Rate[3] = MGN_18M; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xC28: ++ case 0xE28: ++ case 0x1828: ++ case 0x1a28: ++ Rate[0] = MGN_24M; ++ Rate[1] = MGN_36M; ++ Rate[2] = MGN_48M; ++ Rate[3] = MGN_54M; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xC2C: ++ case 0xE2C: ++ case 0x182C: ++ case 0x1a2C: ++ Rate[0] = MGN_MCS0; ++ Rate[1] = MGN_MCS1; ++ Rate[2] = MGN_MCS2; ++ Rate[3] = MGN_MCS3; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xC30: ++ case 0xE30: ++ case 0x1830: ++ case 0x1a30: ++ Rate[0] = MGN_MCS4; ++ Rate[1] = MGN_MCS5; ++ Rate[2] = MGN_MCS6; ++ Rate[3] = MGN_MCS7; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xC34: ++ case 0xE34: ++ case 0x1834: ++ case 0x1a34: ++ Rate[0] = MGN_MCS8; ++ Rate[1] = MGN_MCS9; ++ Rate[2] = MGN_MCS10; ++ Rate[3] = MGN_MCS11; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xC38: ++ case 0xE38: ++ case 0x1838: ++ case 0x1a38: ++ Rate[0] = MGN_MCS12; ++ Rate[1] = MGN_MCS13; ++ Rate[2] = MGN_MCS14; ++ Rate[3] = MGN_MCS15; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xC3C: ++ case 0xE3C: ++ case 0x183C: ++ case 0x1a3C: ++ Rate[0] = MGN_VHT1SS_MCS0; ++ Rate[1] = MGN_VHT1SS_MCS1; ++ Rate[2] = MGN_VHT1SS_MCS2; ++ Rate[3] = MGN_VHT1SS_MCS3; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xC40: ++ case 0xE40: ++ case 0x1840: ++ case 0x1a40: ++ Rate[0] = MGN_VHT1SS_MCS4; ++ Rate[1] = MGN_VHT1SS_MCS5; ++ Rate[2] = MGN_VHT1SS_MCS6; ++ Rate[3] = MGN_VHT1SS_MCS7; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xC44: ++ case 0xE44: ++ case 0x1844: ++ case 0x1a44: ++ Rate[0] = MGN_VHT1SS_MCS8; ++ Rate[1] = MGN_VHT1SS_MCS9; ++ Rate[2] = MGN_VHT2SS_MCS0; ++ Rate[3] = MGN_VHT2SS_MCS1; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xC48: ++ case 0xE48: ++ case 0x1848: ++ case 0x1a48: ++ Rate[0] = MGN_VHT2SS_MCS2; ++ Rate[1] = MGN_VHT2SS_MCS3; ++ Rate[2] = MGN_VHT2SS_MCS4; ++ Rate[3] = MGN_VHT2SS_MCS5; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xC4C: ++ case 0xE4C: ++ case 0x184C: ++ case 0x1a4C: ++ Rate[0] = MGN_VHT2SS_MCS6; ++ Rate[1] = MGN_VHT2SS_MCS7; ++ Rate[2] = MGN_VHT2SS_MCS8; ++ Rate[3] = MGN_VHT2SS_MCS9; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xCD8: ++ case 0xED8: ++ case 0x18D8: ++ case 0x1aD8: ++ Rate[0] = MGN_MCS16; ++ Rate[1] = MGN_MCS17; ++ Rate[2] = MGN_MCS18; ++ Rate[3] = MGN_MCS19; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xCDC: ++ case 0xEDC: ++ case 0x18DC: ++ case 0x1aDC: ++ Rate[0] = MGN_MCS20; ++ Rate[1] = MGN_MCS21; ++ Rate[2] = MGN_MCS22; ++ Rate[3] = MGN_MCS23; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xCE0: ++ case 0xEE0: ++ case 0x18E0: ++ case 0x1aE0: ++ Rate[0] = MGN_VHT3SS_MCS0; ++ Rate[1] = MGN_VHT3SS_MCS1; ++ Rate[2] = MGN_VHT3SS_MCS2; ++ Rate[3] = MGN_VHT3SS_MCS3; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xCE4: ++ case 0xEE4: ++ case 0x18E4: ++ case 0x1aE4: ++ Rate[0] = MGN_VHT3SS_MCS4; ++ Rate[1] = MGN_VHT3SS_MCS5; ++ Rate[2] = MGN_VHT3SS_MCS6; ++ Rate[3] = MGN_VHT3SS_MCS7; ++ for (i = 0; i < 4; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 4; ++ break; ++ ++ case 0xCE8: ++ case 0xEE8: ++ case 0x18E8: ++ case 0x1aE8: ++ Rate[0] = MGN_VHT3SS_MCS8; ++ Rate[1] = MGN_VHT3SS_MCS9; ++ for (i = 0; i < 2; ++i) { ++ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + ++ ((Value >> (i * 8)) & 0xF)); ++ } ++ *RateNum = 2; ++ break; ++ ++ default: ++ RTW_PRINT("Invalid RegAddr 0x%x in %s()\n", RegAddr, __func__); ++ break; ++ }; ++} ++ ++void ++PHY_StoreTxPowerByRateNew( ++ IN PADAPTER pAdapter, ++ IN u32 Band, ++ IN u32 RfPath, ++ IN u32 TxNum, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u8 i = 0, rates[4] = {0}, rateNum = 0; ++ s8 PwrByRateVal[4] = {0}; ++ ++ PHY_GetRateValuesOfTxPowerByRate(pAdapter, RegAddr, BitMask, Data, rates, PwrByRateVal, &rateNum); ++ ++ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { ++ RTW_PRINT("Invalid Band %d\n", Band); ++ return; ++ } ++ ++ if (RfPath > ODM_RF_PATH_D) { ++ RTW_PRINT("Invalid RfPath %d\n", RfPath); ++ return; ++ } ++ ++ if (TxNum > ODM_RF_PATH_D) { ++ RTW_PRINT("Invalid TxNum %d\n", TxNum); ++ return; ++ } ++ ++ for (i = 0; i < rateNum; ++i) { ++ u8 rate_idx = PHY_GetRateIndexOfTxPowerByRate(rates[i]); ++ ++ if (IS_1T_RATE(rates[i])) ++ pHalData->TxPwrByRateOffset[Band][RfPath][RF_1TX][rate_idx] = PwrByRateVal[i]; ++ else if (IS_2T_RATE(rates[i])) ++ pHalData->TxPwrByRateOffset[Band][RfPath][RF_2TX][rate_idx] = PwrByRateVal[i]; ++ else if (IS_3T_RATE(rates[i])) ++ pHalData->TxPwrByRateOffset[Band][RfPath][RF_3TX][rate_idx] = PwrByRateVal[i]; ++ else if (IS_4T_RATE(rates[i])) ++ pHalData->TxPwrByRateOffset[Band][RfPath][RF_4TX][rate_idx] = PwrByRateVal[i]; ++ else ++ rtw_warn_on(1); ++ } ++} ++ ++VOID ++PHY_InitTxPowerByRate( ++ IN PADAPTER pAdapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u8 band = 0, rfPath = 0, TxNum = 0, rate = 0, i = 0, j = 0; ++ ++ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band) ++ for (rfPath = 0; rfPath < TX_PWR_BY_RATE_NUM_RF; ++rfPath) ++ for (TxNum = 0; TxNum < TX_PWR_BY_RATE_NUM_RF; ++TxNum) ++ for (rate = 0; rate < TX_PWR_BY_RATE_NUM_RATE; ++rate) ++ pHalData->TxPwrByRateOffset[band][rfPath][TxNum][rate] = 0; ++} ++ ++VOID ++PHY_StoreTxPowerByRate( ++ IN PADAPTER pAdapter, ++ IN u32 Band, ++ IN u32 RfPath, ++ IN u32 TxNum, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ ++ if (pDM_Odm->PhyRegPgVersion > 0) ++ PHY_StoreTxPowerByRateNew(pAdapter, Band, RfPath, TxNum, RegAddr, BitMask, Data); ++ else ++ RTW_INFO("Invalid PHY_REG_PG.txt version %d\n", pDM_Odm->PhyRegPgVersion); ++ ++} ++ ++VOID ++phy_ConvertTxPowerByRateInDbmToRelativeValues( ++ IN PADAPTER pAdapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u8 base = 0, i = 0, value = 0, ++ band = 0, path = 0, txNum = 0, index = 0, ++ startIndex = 0, endIndex = 0; ++ u8 cckRates[4] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}, ++ ofdmRates[8] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M}, ++ mcs0_7Rates[8] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}, ++ mcs8_15Rates[8] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}, ++ mcs16_23Rates[8] = {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23}, ++ vht1ssRates[10] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4, ++ MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9}, ++ vht2ssRates[10] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, ++ MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9}, ++ vht3ssRates[10] = {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4, ++ MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9}; ++ ++ /* RTW_INFO("===>PHY_ConvertTxPowerByRateInDbmToRelativeValues()\n" ); */ ++ ++ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band) { ++ for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_D; ++path) { ++ for (txNum = RF_1TX; txNum < RF_MAX_TX_NUM; ++txNum) { ++ /* CCK */ ++ if (band == BAND_ON_2_4G) { ++ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, CCK); ++ for (i = 0; i < sizeof(cckRates); ++i) { ++ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, cckRates[i]); ++ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, cckRates[i], value - base); ++ } ++ } ++ ++ /* OFDM */ ++ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, OFDM); ++ for (i = 0; i < sizeof(ofdmRates); ++i) { ++ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, ofdmRates[i]); ++ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, ofdmRates[i], value - base); ++ } ++ ++ /* HT MCS0~7 */ ++ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, HT_1SS); ++ for (i = 0; i < sizeof(mcs0_7Rates); ++i) { ++ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, mcs0_7Rates[i]); ++ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, mcs0_7Rates[i], value - base); ++ } ++ ++ /* HT MCS8~15 */ ++ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, HT_2SS); ++ for (i = 0; i < sizeof(mcs8_15Rates); ++i) { ++ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, mcs8_15Rates[i]); ++ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, mcs8_15Rates[i], value - base); ++ } ++ ++ /* HT MCS16~23 */ ++ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, HT_3SS); ++ for (i = 0; i < sizeof(mcs16_23Rates); ++i) { ++ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, mcs16_23Rates[i]); ++ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, mcs16_23Rates[i], value - base); ++ } ++ ++ /* VHT 1SS */ ++ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, VHT_1SS); ++ for (i = 0; i < sizeof(vht1ssRates); ++i) { ++ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, vht1ssRates[i]); ++ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, vht1ssRates[i], value - base); ++ } ++ ++ /* VHT 2SS */ ++ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, VHT_2SS); ++ for (i = 0; i < sizeof(vht2ssRates); ++i) { ++ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, vht2ssRates[i]); ++ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, vht2ssRates[i], value - base); ++ } ++ ++ /* VHT 3SS */ ++ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, VHT_3SS); ++ for (i = 0; i < sizeof(vht3ssRates); ++i) { ++ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, vht3ssRates[i]); ++ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, vht3ssRates[i], value - base); ++ } ++ } ++ } ++ } ++ ++ /* RTW_INFO("<===PHY_ConvertTxPowerByRateInDbmToRelativeValues()\n" ); */ ++} ++ ++/* ++ * This function must be called if the value in the PHY_REG_PG.txt(or header) ++ * is exact dBm values ++ */ ++VOID ++PHY_TxPowerByRateConfiguration( ++ IN PADAPTER pAdapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ phy_txpwr_by_rate_chk_for_path_dup(pAdapter); ++ phy_StoreTxPowerByRateBase(pAdapter); ++ phy_ConvertTxPowerByRateInDbmToRelativeValues(pAdapter); ++} ++ ++VOID ++PHY_SetTxPowerIndexByRateSection( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Channel, ++ IN u8 RateSection ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ ++ if (RateSection >= RATE_SECTION_NUM) { ++ RTW_INFO("Invalid RateSection %d in %s", RateSection, __func__); ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (RateSection == CCK && pHalData->CurrentBandType != BAND_ON_2_4G) ++ goto exit; ++ ++ PHY_SetTxPowerIndexByRateArray(pAdapter, RFPath, pHalData->CurrentChannelBW, Channel, ++ rates_by_sections[RateSection].rates, rates_by_sections[RateSection].rate_num); ++ ++exit: ++ return; ++} ++ ++BOOLEAN ++phy_GetChnlIndex( ++ IN u8 Channel, ++ OUT u8 *ChannelIdx ++) ++{ ++ u8 i = 0; ++ BOOLEAN bIn24G = _TRUE; ++ ++ if (Channel <= 14) { ++ bIn24G = _TRUE; ++ *ChannelIdx = Channel - 1; ++ } else { ++ bIn24G = _FALSE; ++ ++ for (i = 0; i < CENTER_CH_5G_ALL_NUM; ++i) { ++ if (center_ch_5g_all[i] == Channel) { ++ *ChannelIdx = i; ++ return bIn24G; ++ } ++ } ++ } ++ ++ return bIn24G; ++} ++ ++u8 ++PHY_GetTxPowerIndexBase( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN CHANNEL_WIDTH BandWidth, ++ IN u8 Channel, ++ OUT PBOOLEAN bIn24G ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ u8 i = 0; /* default set to 1S */ ++ u8 txPower = 0; ++ u8 chnlIdx = (Channel - 1); ++ ++ if (HAL_IsLegalChannel(pAdapter, Channel) == _FALSE) { ++ chnlIdx = 0; ++ RTW_INFO("Illegal channel!!\n"); ++ } ++ ++ *bIn24G = phy_GetChnlIndex(Channel, &chnlIdx); ++ ++ /* RTW_INFO("[%s] Channel Index: %d\n", (*bIn24G?"2.4G":"5G"), chnlIdx); */ ++ ++ if (*bIn24G) { /* 3 ============================== 2.4 G ============================== */ ++ if (IS_CCK_RATE(Rate)) ++ txPower = pHalData->Index24G_CCK_Base[RFPath][chnlIdx]; ++ else if (MGN_6M <= Rate) ++ txPower = pHalData->Index24G_BW40_Base[RFPath][chnlIdx]; ++ else ++ RTW_INFO("PHY_GetTxPowerIndexBase: INVALID Rate.\n"); ++ ++ /* RTW_INFO("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", */ ++ /* ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower); */ ++ ++ /* OFDM-1T */ ++ if ((MGN_6M <= Rate && Rate <= MGN_54M) && !IS_CCK_RATE(Rate)) { ++ txPower += pHalData->OFDM_24G_Diff[RFPath][TX_1S]; ++ /* RTW_INFO("+PowerDiff 2.4G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_24G_Diff[RFPath][TX_1S]); */ ++ } ++ /* BW20-1S, BW20-2S */ ++ if (BandWidth == CHANNEL_WIDTH_20) { ++ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW20_24G_Diff[RFPath][TX_1S]; ++ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW20_24G_Diff[RFPath][TX_2S]; ++ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW20_24G_Diff[RFPath][TX_3S]; ++ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW20_24G_Diff[RFPath][TX_4S]; ++ ++ /* RTW_INFO("+PowerDiff 2.4G (RF-%c): (BW20-1S, BW20-2S, BW20-3S, BW20-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ ++ /* pHalData->BW20_24G_Diff[RFPath][TX_1S], pHalData->BW20_24G_Diff[RFPath][TX_2S], */ ++ /* pHalData->BW20_24G_Diff[RFPath][TX_3S], pHalData->BW20_24G_Diff[RFPath][TX_4S]); */ ++ } ++ /* BW40-1S, BW40-2S */ ++ else if (BandWidth == CHANNEL_WIDTH_40) { ++ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; ++ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; ++ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW40_24G_Diff[RFPath][TX_3S]; ++ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW40_24G_Diff[RFPath][TX_4S]; ++ ++ /* RTW_INFO("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S, BW40-3S, BW40-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ ++ /* pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S], */ ++ /* pHalData->BW40_24G_Diff[RFPath][TX_3S], pHalData->BW40_24G_Diff[RFPath][TX_4S]); */ ++ } ++ /* Willis suggest adopt BW 40M power index while in BW 80 mode */ ++ else if (BandWidth == CHANNEL_WIDTH_80) { ++ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; ++ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; ++ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW40_24G_Diff[RFPath][TX_3S]; ++ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW40_24G_Diff[RFPath][TX_4S]; ++ ++ /* RTW_INFO("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S, BW40-3S, BW40-4T) = (%d, %d, %d, %d) P.S. Current is in BW 80MHz\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ ++ /* pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S], */ ++ /* pHalData->BW40_24G_Diff[RFPath][TX_3S], pHalData->BW40_24G_Diff[RFPath][TX_4S]); */ ++ } ++ } ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ else { /* 3 ============================== 5 G ============================== */ ++ if (MGN_6M <= Rate) ++ txPower = pHalData->Index5G_BW40_Base[RFPath][chnlIdx]; ++ else ++ RTW_INFO("===> mpt_ProQueryCalTxPower_Jaguar: INVALID Rate.\n"); ++ ++ /* RTW_INFO("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", */ ++ /* ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower); */ ++ ++ /* OFDM-1T */ ++ if ((MGN_6M <= Rate && Rate <= MGN_54M) && !IS_CCK_RATE(Rate)) { ++ txPower += pHalData->OFDM_5G_Diff[RFPath][TX_1S]; ++ /* RTW_INFO("+PowerDiff 5G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_5G_Diff[RFPath][TX_1S]); */ ++ } ++ ++ /* BW20-1S, BW20-2S */ ++ if (BandWidth == CHANNEL_WIDTH_20) { ++ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW20_5G_Diff[RFPath][TX_1S]; ++ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW20_5G_Diff[RFPath][TX_2S]; ++ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW20_5G_Diff[RFPath][TX_3S]; ++ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW20_5G_Diff[RFPath][TX_4S]; ++ ++ /* RTW_INFO("+PowerDiff 5G (RF-%c): (BW20-1S, BW20-2S, BW20-3S, BW20-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ ++ /* pHalData->BW20_5G_Diff[RFPath][TX_1S], pHalData->BW20_5G_Diff[RFPath][TX_2S], */ ++ /* pHalData->BW20_5G_Diff[RFPath][TX_3S], pHalData->BW20_5G_Diff[RFPath][TX_4S]); */ ++ } ++ /* BW40-1S, BW40-2S */ ++ else if (BandWidth == CHANNEL_WIDTH_40) { ++ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW40_5G_Diff[RFPath][TX_1S]; ++ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW40_5G_Diff[RFPath][TX_2S]; ++ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW40_5G_Diff[RFPath][TX_3S]; ++ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW40_5G_Diff[RFPath][TX_4S]; ++ ++ /* RTW_INFO("+PowerDiff 5G(RF-%c): (BW40-1S, BW40-2S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ ++ /* pHalData->BW40_5G_Diff[RFPath][TX_1S], pHalData->BW40_5G_Diff[RFPath][TX_2S], */ ++ /* pHalData->BW40_5G_Diff[RFPath][TX_3S], pHalData->BW40_5G_Diff[RFPath][TX_4S]); */ ++ } ++ /* BW80-1S, BW80-2S */ ++ else if (BandWidth == CHANNEL_WIDTH_80) { ++ /* <20121220, Kordan> Get the index of array "Index5G_BW80_Base". */ ++ for (i = 0; i < CENTER_CH_5G_80M_NUM; ++i) ++ if (center_ch_5g_80m[i] == Channel) ++ chnlIdx = i; ++ ++ txPower = pHalData->Index5G_BW80_Base[RFPath][chnlIdx]; ++ ++ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += + pHalData->BW80_5G_Diff[RFPath][TX_1S]; ++ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW80_5G_Diff[RFPath][TX_2S]; ++ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW80_5G_Diff[RFPath][TX_3S]; ++ if ((MGN_MCS23 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) ++ txPower += pHalData->BW80_5G_Diff[RFPath][TX_4S]; ++ ++ /* RTW_INFO("+PowerDiff 5G(RF-%c): (BW80-1S, BW80-2S, BW80-3S, BW80-4S) = (%d, %d, %d, %d)\n",((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ ++ /* pHalData->BW80_5G_Diff[RFPath][TX_1S], pHalData->BW80_5G_Diff[RFPath][TX_2S], */ ++ /* pHalData->BW80_5G_Diff[RFPath][TX_3S], pHalData->BW80_5G_Diff[RFPath][TX_4S]); */ ++ } ++ } ++#endif /* CONFIG_IEEE80211_BAND_5GHZ */ ++ ++ return txPower; ++} ++ ++s8 ++PHY_GetTxPowerTrackingOffset( ++ PADAPTER pAdapter, ++ u8 RFPath, ++ u8 Rate ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ s8 offset = 0; ++ ++ if (pDM_Odm->RFCalibrateInfo.TxPowerTrackControl == _FALSE) ++ return offset; ++ ++ if ((Rate == MGN_1M) || (Rate == MGN_2M) || (Rate == MGN_5_5M) || (Rate == MGN_11M)) { ++ offset = pDM_Odm->RFCalibrateInfo.Remnant_CCKSwingIdx; ++ /*RTW_INFO("+Remnant_CCKSwingIdx = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_CCKSwingIdx);*/ ++ } else { ++ offset = pDM_Odm->RFCalibrateInfo.Remnant_OFDMSwingIdx[RFPath]; ++ /*RTW_INFO("+Remanant_OFDMSwingIdx[RFPath %u][Rate 0x%x] = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath]); */ ++ ++ } ++ ++ return offset; ++} ++ ++/*The same as MRateToHwRate in hal_com.c*/ ++u8 ++PHY_GetRateIndexOfTxPowerByRate( ++ IN u8 Rate ++) ++{ ++ u8 index = 0; ++ switch (Rate) { ++ case MGN_1M: ++ index = 0; ++ break; ++ case MGN_2M: ++ index = 1; ++ break; ++ case MGN_5_5M: ++ index = 2; ++ break; ++ case MGN_11M: ++ index = 3; ++ break; ++ case MGN_6M: ++ index = 4; ++ break; ++ case MGN_9M: ++ index = 5; ++ break; ++ case MGN_12M: ++ index = 6; ++ break; ++ case MGN_18M: ++ index = 7; ++ break; ++ case MGN_24M: ++ index = 8; ++ break; ++ case MGN_36M: ++ index = 9; ++ break; ++ case MGN_48M: ++ index = 10; ++ break; ++ case MGN_54M: ++ index = 11; ++ break; ++ case MGN_MCS0: ++ index = 12; ++ break; ++ case MGN_MCS1: ++ index = 13; ++ break; ++ case MGN_MCS2: ++ index = 14; ++ break; ++ case MGN_MCS3: ++ index = 15; ++ break; ++ case MGN_MCS4: ++ index = 16; ++ break; ++ case MGN_MCS5: ++ index = 17; ++ break; ++ case MGN_MCS6: ++ index = 18; ++ break; ++ case MGN_MCS7: ++ index = 19; ++ break; ++ case MGN_MCS8: ++ index = 20; ++ break; ++ case MGN_MCS9: ++ index = 21; ++ break; ++ case MGN_MCS10: ++ index = 22; ++ break; ++ case MGN_MCS11: ++ index = 23; ++ break; ++ case MGN_MCS12: ++ index = 24; ++ break; ++ case MGN_MCS13: ++ index = 25; ++ break; ++ case MGN_MCS14: ++ index = 26; ++ break; ++ case MGN_MCS15: ++ index = 27; ++ break; ++ case MGN_MCS16: ++ index = 28; ++ break; ++ case MGN_MCS17: ++ index = 29; ++ break; ++ case MGN_MCS18: ++ index = 30; ++ break; ++ case MGN_MCS19: ++ index = 31; ++ break; ++ case MGN_MCS20: ++ index = 32; ++ break; ++ case MGN_MCS21: ++ index = 33; ++ break; ++ case MGN_MCS22: ++ index = 34; ++ break; ++ case MGN_MCS23: ++ index = 35; ++ break; ++ case MGN_MCS24: ++ index = 36; ++ break; ++ case MGN_MCS25: ++ index = 37; ++ break; ++ case MGN_MCS26: ++ index = 38; ++ break; ++ case MGN_MCS27: ++ index = 39; ++ break; ++ case MGN_MCS28: ++ index = 40; ++ break; ++ case MGN_MCS29: ++ index = 41; ++ break; ++ case MGN_MCS30: ++ index = 42; ++ break; ++ case MGN_MCS31: ++ index = 43; ++ break; ++ case MGN_VHT1SS_MCS0: ++ index = 44; ++ break; ++ case MGN_VHT1SS_MCS1: ++ index = 45; ++ break; ++ case MGN_VHT1SS_MCS2: ++ index = 46; ++ break; ++ case MGN_VHT1SS_MCS3: ++ index = 47; ++ break; ++ case MGN_VHT1SS_MCS4: ++ index = 48; ++ break; ++ case MGN_VHT1SS_MCS5: ++ index = 49; ++ break; ++ case MGN_VHT1SS_MCS6: ++ index = 50; ++ break; ++ case MGN_VHT1SS_MCS7: ++ index = 51; ++ break; ++ case MGN_VHT1SS_MCS8: ++ index = 52; ++ break; ++ case MGN_VHT1SS_MCS9: ++ index = 53; ++ break; ++ case MGN_VHT2SS_MCS0: ++ index = 54; ++ break; ++ case MGN_VHT2SS_MCS1: ++ index = 55; ++ break; ++ case MGN_VHT2SS_MCS2: ++ index = 56; ++ break; ++ case MGN_VHT2SS_MCS3: ++ index = 57; ++ break; ++ case MGN_VHT2SS_MCS4: ++ index = 58; ++ break; ++ case MGN_VHT2SS_MCS5: ++ index = 59; ++ break; ++ case MGN_VHT2SS_MCS6: ++ index = 60; ++ break; ++ case MGN_VHT2SS_MCS7: ++ index = 61; ++ break; ++ case MGN_VHT2SS_MCS8: ++ index = 62; ++ break; ++ case MGN_VHT2SS_MCS9: ++ index = 63; ++ break; ++ case MGN_VHT3SS_MCS0: ++ index = 64; ++ break; ++ case MGN_VHT3SS_MCS1: ++ index = 65; ++ break; ++ case MGN_VHT3SS_MCS2: ++ index = 66; ++ break; ++ case MGN_VHT3SS_MCS3: ++ index = 67; ++ break; ++ case MGN_VHT3SS_MCS4: ++ index = 68; ++ break; ++ case MGN_VHT3SS_MCS5: ++ index = 69; ++ break; ++ case MGN_VHT3SS_MCS6: ++ index = 70; ++ break; ++ case MGN_VHT3SS_MCS7: ++ index = 71; ++ break; ++ case MGN_VHT3SS_MCS8: ++ index = 72; ++ break; ++ case MGN_VHT3SS_MCS9: ++ index = 73; ++ break; ++ case MGN_VHT4SS_MCS0: ++ index = 74; ++ break; ++ case MGN_VHT4SS_MCS1: ++ index = 75; ++ break; ++ case MGN_VHT4SS_MCS2: ++ index = 76; ++ break; ++ case MGN_VHT4SS_MCS3: ++ index = 77; ++ break; ++ case MGN_VHT4SS_MCS4: ++ index = 78; ++ break; ++ case MGN_VHT4SS_MCS5: ++ index = 79; ++ break; ++ case MGN_VHT4SS_MCS6: ++ index = 80; ++ break; ++ case MGN_VHT4SS_MCS7: ++ index = 81; ++ break; ++ case MGN_VHT4SS_MCS8: ++ index = 82; ++ break; ++ case MGN_VHT4SS_MCS9: ++ index = 83; ++ break; ++ default: ++ RTW_INFO("Invalid rate 0x%x in %s\n", Rate, __FUNCTION__); ++ break; ++ }; ++ ++ return index; ++} ++ ++s8 ++_PHY_GetTxPowerByRate( ++ IN PADAPTER pAdapter, ++ IN u8 Band, ++ IN u8 RFPath, ++ IN u8 TxNum, ++ IN u8 Rate ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ s8 value = 0; ++ u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate(Rate); ++ ++ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { ++ RTW_INFO("Invalid band %d in %s\n", Band, __func__); ++ goto exit; ++ } ++ if (RFPath > ODM_RF_PATH_D) { ++ RTW_INFO("Invalid RfPath %d in %s\n", RFPath, __func__); ++ goto exit; ++ } ++ if (TxNum >= RF_MAX_TX_NUM) { ++ RTW_INFO("Invalid TxNum %d in %s\n", TxNum, __func__); ++ goto exit; ++ } ++ if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) { ++ RTW_INFO("Invalid RateIndex %d in %s\n", rateIndex, __func__); ++ goto exit; ++ } ++ ++ value = pHalData->TxPwrByRateOffset[Band][RFPath][TxNum][rateIndex]; ++ ++exit: ++ return value; ++} ++ ++ ++s8 ++PHY_GetTxPowerByRate( ++ IN PADAPTER pAdapter, ++ IN u8 Band, ++ IN u8 RFPath, ++ IN u8 TxNum, ++ IN u8 Rate ++) ++{ ++ if (!phy_is_tx_power_by_rate_needed(pAdapter)) ++ return 0; ++ ++ return _PHY_GetTxPowerByRate(pAdapter, Band, RFPath, TxNum, Rate); ++} ++ ++#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI ++s8 ++PHY_GetTxPowerByRateOriginal( ++ IN PADAPTER pAdapter, ++ IN u8 Band, ++ IN u8 RFPath, ++ IN u8 TxNum, ++ IN u8 Rate ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ s8 value = 0, limit = 0; ++ u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate(Rate); ++ ++ if ((pAdapter->registrypriv.RegEnableTxPowerByRate == 2 && pHalData->EEPROMRegulatory == 2) || ++ pAdapter->registrypriv.RegEnableTxPowerByRate == 0) ++ return 0; ++ ++ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { ++ DBG_871X("Invalid band %d in %s\n", Band, __func__); ++ return value; ++ } ++ if (RFPath > ODM_RF_PATH_D) { ++ DBG_871X("Invalid RfPath %d in %s\n", RFPath, __func__); ++ return value; ++ } ++ if (TxNum >= RF_MAX_TX_NUM) { ++ DBG_871X("Invalid TxNum %d in %s\n", TxNum, __func__); ++ return value; ++ } ++ if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) { ++ DBG_871X("Invalid RateIndex %d in %s\n", rateIndex, __func__); ++ return value; ++ } ++ ++ value = pHalData->TxPwrByRate[Band][RFPath][TxNum][rateIndex]; ++ ++ return value; ++} ++ ++#endif ++ ++ ++VOID ++PHY_SetTxPowerByRate( ++ IN PADAPTER pAdapter, ++ IN u8 Band, ++ IN u8 RFPath, ++ IN u8 TxNum, ++ IN u8 Rate, ++ IN s8 Value ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate(Rate); ++ ++ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { ++ RTW_INFO("Invalid band %d in %s\n", Band, __FUNCTION__); ++ return; ++ } ++ if (RFPath > ODM_RF_PATH_D) { ++ RTW_INFO("Invalid RfPath %d in %s\n", RFPath, __FUNCTION__); ++ return; ++ } ++ if (TxNum >= RF_MAX_TX_NUM) { ++ RTW_INFO("Invalid TxNum %d in %s\n", TxNum, __FUNCTION__); ++ return; ++ } ++ if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) { ++ RTW_INFO("Invalid RateIndex %d in %s\n", rateIndex, __FUNCTION__); ++ return; ++ } ++ ++ pHalData->TxPwrByRateOffset[Band][RFPath][TxNum][rateIndex] = Value; ++} ++ ++VOID ++PHY_SetTxPowerLevelByPath( ++ IN PADAPTER Adapter, ++ IN u8 channel, ++ IN u8 path ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ BOOLEAN bIsIn24G = (pHalData->CurrentBandType == BAND_ON_2_4G); ++ ++ /* if ( pMgntInfo->RegNByteAccess == 0 ) */ ++ { ++ if (bIsIn24G) ++ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, CCK); ++ ++ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, OFDM); ++ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, HT_MCS0_MCS7); ++ ++ if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter)) ++ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, VHT_1SSMCS0_1SSMCS9); ++ ++ if (pHalData->NumTotalRFPath >= 2) { ++ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, HT_MCS8_MCS15); ++ ++ if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter)) ++ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, VHT_2SSMCS0_2SSMCS9); ++ ++ if (IS_HARDWARE_TYPE_8814A(Adapter)) { ++ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, HT_MCS16_MCS23); ++ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, VHT_3SSMCS0_3SSMCS9); ++ } ++ } ++ } ++} ++ ++#ifndef DBG_TX_POWER_IDX ++#define DBG_TX_POWER_IDX 0 ++#endif ++ ++VOID ++PHY_SetTxPowerIndexByRateArray( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN CHANNEL_WIDTH BandWidth, ++ IN u8 Channel, ++ IN u8 *Rates, ++ IN u8 RateArraySize ++) ++{ ++ u32 powerIndex = 0; ++ int i = 0; ++ ++ for (i = 0; i < RateArraySize; ++i) { ++#if DBG_TX_POWER_IDX ++ struct txpwr_idx_comp tic; ++ ++ powerIndex = rtw_hal_get_tx_power_index(pAdapter, RFPath, Rates[i], BandWidth, Channel, &tic); ++ RTW_INFO("TXPWR: [%c][%s]ch:%u, %s, pwr_idx:%u = %u + (%d=%d:%d) + (%d) + (%d)\n" ++ , rf_path_char(RFPath), ch_width_str(BandWidth), Channel, MGN_RATE_STR(Rates[i]) ++ , powerIndex, tic.base, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt, tic.ebias); ++#else ++ powerIndex = PHY_GetTxPowerIndex(pAdapter, RFPath, Rates[i], BandWidth, Channel); ++#endif ++ PHY_SetTxPowerIndex(pAdapter, powerIndex, RFPath, Rates[i]); ++ } ++} ++ ++s8 ++phy_GetWorldWideLimit( ++ s8 *LimitTable ++) ++{ ++ s8 min = LimitTable[0]; ++ u8 i = 0; ++ ++ for (i = 0; i < MAX_REGULATION_NUM; ++i) { ++ if (LimitTable[i] < min) ++ min = LimitTable[i]; ++ } ++ ++ return min; ++} ++ ++s8 ++phy_GetChannelIndexOfTxPowerLimit( ++ IN u8 Band, ++ IN u8 Channel ++) ++{ ++ s8 channelIndex = -1; ++ u8 i = 0; ++ ++ if (Band == BAND_ON_2_4G) ++ channelIndex = Channel - 1; ++ else if (Band == BAND_ON_5G) { ++ for (i = 0; i < CENTER_CH_5G_ALL_NUM; ++i) { ++ if (center_ch_5g_all[i] == Channel) ++ channelIndex = i; ++ } ++ } else ++ RTW_PRINT("Invalid Band %d in %s\n", Band, __func__); ++ ++ if (channelIndex == -1) ++ RTW_PRINT("Invalid Channel %d of Band %d in %s\n", Channel, Band, __func__); ++ ++ return channelIndex; ++} ++ ++static s8 _phy_get_txpwr_lmt( ++ IN PADAPTER Adapter, ++ IN u32 RegPwrTblSel, ++ IN BAND_TYPE Band, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 RfPath, ++ IN u8 DataRate, ++ IN u8 Channel, ++ BOOLEAN no_sc ++) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(Adapter); ++ s8 regulation = -1, bw = -1, rs = -1; ++ u8 cch = 0; ++ u8 bw_bmp = 0; ++ s8 min_lmt = MAX_POWER_INDEX; ++ s8 tmp_lmt; ++ u8 final_bw = Bandwidth, final_cch = Channel; ++ ++ if ((Adapter->registrypriv.RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory != 1) || ++ Adapter->registrypriv.RegEnableTxPowerLimit == 0) ++ goto exit; ++ ++ switch (RegPwrTblSel) { ++ case 1: ++ regulation = TXPWR_LMT_ETSI; ++ break; ++ case 2: ++ regulation = TXPWR_LMT_MKK; ++ break; ++ case 3: ++ regulation = TXPWR_LMT_FCC; ++ break; ++ case 4: ++ regulation = TXPWR_LMT_WW; ++ break; ++ default: ++ regulation = (Band == BAND_ON_2_4G) ? hal_data->Regulation2_4G : hal_data->Regulation5G; ++ break; ++ } ++ ++ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { ++ RTW_ERR("%s invalid band:%u\n", __func__, Band); ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (IS_CCK_RATE(DataRate)) ++ rs = CCK; ++ else if (IS_OFDM_RATE(DataRate)) ++ rs = OFDM; ++ else if (IS_HT1SS_RATE(DataRate)) ++ rs = HT_1SS; ++ else if (IS_HT2SS_RATE(DataRate)) ++ rs = HT_2SS; ++ else if (IS_HT3SS_RATE(DataRate)) ++ rs = HT_3SS; ++ else if (IS_HT4SS_RATE(DataRate)) ++ rs = HT_4SS; ++ else if (IS_VHT1SS_RATE(DataRate)) ++ rs = VHT_1SS; ++ else if (IS_VHT2SS_RATE(DataRate)) ++ rs = VHT_2SS; ++ else if (IS_VHT3SS_RATE(DataRate)) ++ rs = VHT_3SS; ++ else if (IS_VHT4SS_RATE(DataRate)) ++ rs = VHT_4SS; ++ else { ++ RTW_ERR("%s invalid rate 0x%x\n", __func__, DataRate); ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (Band == BAND_ON_5G && rs == CCK) { ++ RTW_ERR("Wrong rate No CCK(0x%x) in 5G Band\n", DataRate); ++ goto exit; ++ } ++ ++ if (no_sc == _TRUE) { ++ /* use the input center channel and bandwidth directly */ ++ cch = Channel; ++ bw_bmp = ch_width_to_bw_cap(Bandwidth); ++ } else { ++ /* ++ * find the possible tx bandwidth bmp for this rate, and then will get center channel for each bandwidth ++ * if no possible tx bandwidth bmp, select valid bandwidth up to current RF bandwidth into bmp ++ */ ++ if (rs == CCK || rs == OFDM) ++ bw_bmp = BW_CAP_20M; /* CCK, OFDM only BW 20M */ ++ else if (IS_HT_RATE_SECTION(rs)) { ++ bw_bmp = rtw_get_tx_bw_bmp_of_ht_rate(dvobj, DataRate, Bandwidth); ++ if (bw_bmp == 0) ++ bw_bmp = ch_width_to_bw_cap(Bandwidth > CHANNEL_WIDTH_40 ? CHANNEL_WIDTH_40 : Bandwidth); ++ } else if (IS_VHT_RATE_SECTION(rs)) { ++ bw_bmp = rtw_get_tx_bw_bmp_of_vht_rate(dvobj, DataRate, Bandwidth); ++ if (bw_bmp == 0) ++ bw_bmp = ch_width_to_bw_cap(Bandwidth > CHANNEL_WIDTH_160 ? CHANNEL_WIDTH_160 : Bandwidth); ++ } else ++ rtw_warn_on(1); ++ } ++ ++ if (bw_bmp == 0) ++ goto exit; ++ ++ /* loop for each possible tx bandwidth to find minimum limit */ ++ for (bw = CHANNEL_WIDTH_20; bw <= Bandwidth; bw++) { ++ s8 ch_idx; ++ ++ if (!(ch_width_to_bw_cap(bw) & bw_bmp)) ++ continue; ++ ++ if (no_sc == _FALSE) { ++ if (bw == CHANNEL_WIDTH_20) ++ cch = hal_data->cch_20; ++ else if (bw == CHANNEL_WIDTH_40) ++ cch = hal_data->cch_40; ++ else if (bw == CHANNEL_WIDTH_80) ++ cch = hal_data->cch_80; ++ else { ++ cch = 0; ++ rtw_warn_on(1); ++ } ++ } ++ ++ ch_idx = phy_GetChannelIndexOfTxPowerLimit(Band, cch); ++ if (ch_idx == -1) ++ continue; ++ ++ if (Band == BAND_ON_2_4G) { ++ s8 limits[MAX_REGULATION_NUM] = {0}; ++ u8 i = 0; ++ ++ for (i = 0; i < MAX_REGULATION_NUM; ++i) ++ limits[i] = hal_data->TxPwrLimit_2_4G[i][bw][rs][ch_idx][RfPath]; ++ ++ tmp_lmt = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : ++ hal_data->TxPwrLimit_2_4G[regulation][bw][rs][ch_idx][RfPath]; ++ ++ } else if (Band == BAND_ON_5G) { ++ s8 limits[MAX_REGULATION_NUM] = {0}; ++ u8 i = 0; ++ ++ for (i = 0; i < MAX_REGULATION_NUM; ++i) ++ limits[i] = hal_data->TxPwrLimit_5G[i][bw][rs][ch_idx][RfPath]; ++ ++ tmp_lmt = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : ++ hal_data->TxPwrLimit_5G[regulation][bw][rs][ch_idx][RfPath]; ++ } else ++ continue; ++ ++ if (min_lmt >= tmp_lmt) { ++ min_lmt = tmp_lmt; ++ final_cch = cch; ++ final_bw = bw; ++ } ++ } ++ ++exit: ++ return min_lmt; ++} ++ ++inline s8 ++PHY_GetTxPowerLimit( ++ IN PADAPTER Adapter, ++ IN u32 RegPwrTblSel, ++ IN BAND_TYPE Band, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 RfPath, ++ IN u8 DataRate, ++ IN u8 Channel ++) ++{ ++ BOOLEAN no_sc = _FALSE; ++ ++ /* MP mode channel don't use secondary channel */ ++ if (rtw_mi_mp_mode_check(Adapter) == _TRUE) ++ no_sc = _TRUE; ++ ++ return _phy_get_txpwr_lmt(Adapter, RegPwrTblSel, Band, Bandwidth, RfPath, DataRate, Channel, no_sc); ++} ++ ++inline s8 ++PHY_GetTxPowerLimit_no_sc( ++ IN PADAPTER Adapter, ++ IN u32 RegPwrTblSel, ++ IN BAND_TYPE Band, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 RfPath, ++ IN u8 DataRate, ++ IN u8 Channel ++) ++{ ++ return _phy_get_txpwr_lmt(Adapter, RegPwrTblSel, Band, Bandwidth, RfPath, DataRate, Channel, _TRUE); ++} ++ ++#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI ++s8 ++PHY_GetTxPowerLimitOriginal( ++ IN PADAPTER Adapter, ++ IN u32 RegPwrTblSel, ++ IN BAND_TYPE Band, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 RfPath, ++ IN u8 DataRate, ++ IN u8 Channel ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ s16 band = -1, regulation = -1, bandwidth = -1, ++ rateSection = -1, channel = -1; ++ s8 powerLimit = MAX_POWER_INDEX; ++ ++ if ((Adapter->registrypriv.RegEnableTxPowerLimit == 2 && pHalData->EEPROMRegulatory != 1) || ++ Adapter->registrypriv.RegEnableTxPowerLimit == 0) ++ return MAX_POWER_INDEX; ++ ++ switch (Adapter->registrypriv.RegPwrTblSel) { ++ case 1: ++ regulation = TXPWR_LMT_ETSI; ++ break; ++ ++ case 2: ++ regulation = TXPWR_LMT_MKK; ++ break; ++ ++ case 3: ++ regulation = TXPWR_LMT_FCC; ++ break; ++ ++ case 4: ++ regulation = TXPWR_LMT_WW; ++ break; ++ ++ default: ++ regulation = (Band == BAND_ON_2_4G) ? pHalData->Regulation2_4G ++ : pHalData->Regulation5G; ++ break; ++ } ++ ++ /*DBG_871X("pMgntInfo->RegPwrTblSel %d, final regulation %d\n", Adapter->registrypriv.RegPwrTblSel, regulation );*/ ++ ++ ++ if (Band == BAND_ON_2_4G) ++ band = 0; ++ else if (Band == BAND_ON_5G) ++ band = 1; ++ ++ if (Bandwidth == CHANNEL_WIDTH_20) ++ bandwidth = 0; ++ else if (Bandwidth == CHANNEL_WIDTH_40) ++ bandwidth = 1; ++ else if (Bandwidth == CHANNEL_WIDTH_80) ++ bandwidth = 2; ++ else if (Bandwidth == CHANNEL_WIDTH_160) ++ bandwidth = 3; ++ ++ switch (DataRate) { ++ case MGN_1M: ++ case MGN_2M: ++ case MGN_5_5M: ++ case MGN_11M: ++ rateSection = 0; ++ break; ++ ++ case MGN_6M: ++ case MGN_9M: ++ case MGN_12M: ++ case MGN_18M: ++ case MGN_24M: ++ case MGN_36M: ++ case MGN_48M: ++ case MGN_54M: ++ rateSection = 1; ++ break; ++ ++ case MGN_MCS0: ++ case MGN_MCS1: ++ case MGN_MCS2: ++ case MGN_MCS3: ++ case MGN_MCS4: ++ case MGN_MCS5: ++ case MGN_MCS6: ++ case MGN_MCS7: ++ rateSection = 2; ++ break; ++ ++ case MGN_MCS8: ++ case MGN_MCS9: ++ case MGN_MCS10: ++ case MGN_MCS11: ++ case MGN_MCS12: ++ case MGN_MCS13: ++ case MGN_MCS14: ++ case MGN_MCS15: ++ rateSection = 3; ++ break; ++ ++ case MGN_MCS16: ++ case MGN_MCS17: ++ case MGN_MCS18: ++ case MGN_MCS19: ++ case MGN_MCS20: ++ case MGN_MCS21: ++ case MGN_MCS22: ++ case MGN_MCS23: ++ rateSection = 4; ++ break; ++ ++ case MGN_MCS24: ++ case MGN_MCS25: ++ case MGN_MCS26: ++ case MGN_MCS27: ++ case MGN_MCS28: ++ case MGN_MCS29: ++ case MGN_MCS30: ++ case MGN_MCS31: ++ rateSection = 5; ++ break; ++ ++ case MGN_VHT1SS_MCS0: ++ case MGN_VHT1SS_MCS1: ++ case MGN_VHT1SS_MCS2: ++ case MGN_VHT1SS_MCS3: ++ case MGN_VHT1SS_MCS4: ++ case MGN_VHT1SS_MCS5: ++ case MGN_VHT1SS_MCS6: ++ case MGN_VHT1SS_MCS7: ++ case MGN_VHT1SS_MCS8: ++ case MGN_VHT1SS_MCS9: ++ rateSection = 6; ++ break; ++ ++ case MGN_VHT2SS_MCS0: ++ case MGN_VHT2SS_MCS1: ++ case MGN_VHT2SS_MCS2: ++ case MGN_VHT2SS_MCS3: ++ case MGN_VHT2SS_MCS4: ++ case MGN_VHT2SS_MCS5: ++ case MGN_VHT2SS_MCS6: ++ case MGN_VHT2SS_MCS7: ++ case MGN_VHT2SS_MCS8: ++ case MGN_VHT2SS_MCS9: ++ rateSection = 7; ++ break; ++ ++ case MGN_VHT3SS_MCS0: ++ case MGN_VHT3SS_MCS1: ++ case MGN_VHT3SS_MCS2: ++ case MGN_VHT3SS_MCS3: ++ case MGN_VHT3SS_MCS4: ++ case MGN_VHT3SS_MCS5: ++ case MGN_VHT3SS_MCS6: ++ case MGN_VHT3SS_MCS7: ++ case MGN_VHT3SS_MCS8: ++ case MGN_VHT3SS_MCS9: ++ rateSection = 8; ++ break; ++ ++ case MGN_VHT4SS_MCS0: ++ case MGN_VHT4SS_MCS1: ++ case MGN_VHT4SS_MCS2: ++ case MGN_VHT4SS_MCS3: ++ case MGN_VHT4SS_MCS4: ++ case MGN_VHT4SS_MCS5: ++ case MGN_VHT4SS_MCS6: ++ case MGN_VHT4SS_MCS7: ++ case MGN_VHT4SS_MCS8: ++ case MGN_VHT4SS_MCS9: ++ rateSection = 9; ++ break; ++ ++ default: ++ DBG_871X("Wrong rate 0x%x\n", DataRate); ++ break; ++ } ++ ++ if (Band == BAND_ON_5G && rateSection == 0) ++ DBG_871X("Wrong rate 0x%x: No CCK in 5G Band\n", DataRate); ++ ++ /*workaround for wrong index combination to obtain tx power limit,*/ ++ /*OFDM only exists in BW 20M*/ ++ if (rateSection == 1) ++ bandwidth = 0; ++ ++ /*workaround for wrong index combination to obtain tx power limit,*/ ++ /*CCK table will only be given in BW 20M*/ ++ if (rateSection == 0) ++ bandwidth = 0; ++ ++ /*workaround for wrong indxe combination to obtain tx power limit,*/ ++ /*HT on 80M will reference to HT on 40M*/ ++ if ((rateSection == 2 || rateSection == 3) && Band == BAND_ON_5G && bandwidth == 2) ++ bandwidth = 1; ++ ++ if (Band == BAND_ON_2_4G) ++ channel = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_2_4G, Channel); ++ else if (Band == BAND_ON_5G) ++ channel = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_5G, Channel); ++ else if (Band == BAND_ON_BOTH) ++ /*BAND_ON_BOTH don't care temporarily*/ ++ ++ if (band == -1 || regulation == -1 || bandwidth == -1 || ++ rateSection == -1 || channel == -1) { ++ /*DBG_871X("Wrong index value to access power limit table [band %d][regulation %d][bandwidth %d][rf_path %d][rate_section %d][chnlGroup %d]\n",*/ ++ /* band, regulation, bandwidth, RfPath, rateSection, channelGroup );*/ ++ ++ return MAX_POWER_INDEX; ++ } ++ ++ if (Band == BAND_ON_2_4G) { ++ s8 limits[10] = {0}; ++ u8 i = 0; ++ ++ if (bandwidth >= MAX_2_4G_BANDWIDTH_NUM) ++ bandwidth = MAX_2_4G_BANDWIDTH_NUM - 1; ++ ++ for (i = 0; i < MAX_REGULATION_NUM; ++i) ++ limits[i] = pHalData->TxPwrLimit_2_4G_Original[i][bandwidth][rateSection][channel][RfPath]; ++ ++ powerLimit = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : ++ pHalData->TxPwrLimit_2_4G_Original[regulation][bandwidth][rateSection][channel][RfPath]; ++ ++ } else if (Band == BAND_ON_5G) { ++ s8 limits[10] = {0}; ++ u8 i = 0; ++ ++ for (i = 0; i < MAX_REGULATION_NUM; ++i) ++ limits[i] = pHalData->TxPwrLimit_5G_Original[i][bandwidth][rateSection][channel][RfPath]; ++ ++ powerLimit = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : ++ pHalData->TxPwrLimit_5G_Original[regulation][bandwidth][rateSection][channel][RfPath]; ++ } else ++ DBG_871X("No power limit table of the specified band\n"); ++ ++ /*combine 5G VHT & HT rate*/ ++ /*5G 20M and 40M HT and VHT can cross reference*/ ++ /* ++ if (Band == BAND_ON_5G && powerLimit == MAX_POWER_INDEX) { ++ if (bandwidth == 0 || bandwidth == 1) { ++ if (rateSection == 2) ++ powerLimit = pHalData->TxPwrLimit_5G_Original[regulation] ++ [bandwidth][4][channelGroup][RfPath]; ++ else if (rateSection == 4) ++ powerLimit = pHalData->TxPwrLimit_5G_Original[regulation] ++ [bandwidth][2][channelGroup][RfPath]; ++ else if (rateSection == 3) ++ powerLimit = pHalData->TxPwrLimit_5G_Original[regulation] ++ [bandwidth][5][channelGroup][RfPath]; ++ else if (rateSection == 5) ++ powerLimit = pHalData->TxPwrLimit_5G_Original[regulation] ++ [bandwidth][3][channelGroup][RfPath]; ++ } ++ } ++ */ ++ /*DBG_871X("TxPwrLmt[Regulation %d][Band %d][BW %d][RFPath %d][Rate 0x%x][Chnl %d] = %d\n",*/ ++ /* regulation, pHalData->CurrentBandType, Bandwidth, RfPath, DataRate, Channel, powerLimit);*/ ++ return powerLimit; ++} ++#endif ++ ++ ++VOID ++phy_CrossReferenceHTAndVHTTxPowerLimit( ++ IN PADAPTER pAdapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u8 regulation, bw, channel, rs, ref_rs; ++ int ht_ref_vht_5g_20_40 = 0; ++ int vht_ref_ht_5g_20_40 = 0; ++ int ht_has_ref_5g_20_40 = 0; ++ int vht_has_ref_5g_20_40 = 0; ++ ++ pHalData->tx_pwr_lmt_5g_20_40_ref = 0; ++ ++ for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) { ++ ++ for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; ++bw) { ++ ++ for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { ++ ++ for (rs = 0; rs < MAX_RATE_SECTION_NUM; ++rs) { ++ ++ /* 5G 20M 40M VHT and HT can cross reference */ ++ if (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40) { ++ if (rs == HT_1SS) ++ ref_rs = VHT_1SS; ++ else if (rs == HT_2SS) ++ ref_rs = VHT_2SS; ++ else if (rs == HT_3SS) ++ ref_rs = VHT_3SS; ++ else if (rs == HT_4SS) ++ ref_rs = VHT_4SS; ++ else if (rs == VHT_1SS) ++ ref_rs = HT_1SS; ++ else if (rs == VHT_2SS) ++ ref_rs = HT_2SS; ++ else if (rs == VHT_3SS) ++ ref_rs = HT_3SS; ++ else if (rs == VHT_4SS) ++ ref_rs = HT_4SS; ++ else ++ continue; ++ ++ if (pHalData->TxPwrLimit_5G[regulation][bw][ref_rs][channel][RF_PATH_A] == MAX_POWER_INDEX) ++ continue; ++ ++ if (IS_HT_RATE_SECTION(rs)) ++ ht_has_ref_5g_20_40++; ++ else if (IS_VHT_RATE_SECTION(rs)) ++ vht_has_ref_5g_20_40++; ++ else ++ continue; ++ ++ if (pHalData->TxPwrLimit_5G[regulation][bw][rs][channel][RF_PATH_A] != MAX_POWER_INDEX) ++ continue; ++ ++ if (IS_HT_RATE_SECTION(rs) && IS_VHT_RATE_SECTION(ref_rs)) ++ ht_ref_vht_5g_20_40++; ++ else if (IS_VHT_RATE_SECTION(rs) && IS_HT_RATE_SECTION(ref_rs)) ++ vht_ref_ht_5g_20_40++; ++ ++ if (0) ++ RTW_INFO("reg:%u, bw:%u, ch:%u, %s ref %s\n" ++ , regulation, bw, channel ++ , rate_section_str(rs), rate_section_str(ref_rs)); ++ ++ pHalData->TxPwrLimit_5G[regulation][bw][rs][channel][RF_PATH_A] = ++ pHalData->TxPwrLimit_5G[regulation][bw][ref_rs][channel][RF_PATH_A]; ++ } ++ ++ } ++ } ++ } ++ } ++ ++ if (0) { ++ RTW_INFO("ht_ref_vht_5g_20_40:%d, ht_has_ref_5g_20_40:%d\n", ht_ref_vht_5g_20_40, ht_has_ref_5g_20_40); ++ RTW_INFO("vht_ref_hht_5g_20_40:%d, vht_has_ref_5g_20_40:%d\n", vht_ref_ht_5g_20_40, vht_has_ref_5g_20_40); ++ } ++ ++ /* 5G 20M&40M HT all come from VHT*/ ++ if (ht_ref_vht_5g_20_40 && ht_has_ref_5g_20_40 == ht_ref_vht_5g_20_40) ++ pHalData->tx_pwr_lmt_5g_20_40_ref |= TX_PWR_LMT_REF_HT_FROM_VHT; ++ ++ /* 5G 20M&40M VHT all come from HT*/ ++ if (vht_ref_ht_5g_20_40 && vht_has_ref_5g_20_40 == vht_ref_ht_5g_20_40) ++ pHalData->tx_pwr_lmt_5g_20_40_ref |= TX_PWR_LMT_REF_VHT_FROM_HT; ++} ++ ++VOID ++PHY_ConvertTxPowerLimitToPowerIndex( ++ IN PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 base; ++ u8 regulation, bw, channel, rateSection; ++ s8 tempValue = 0, tempPwrLmt = 0; ++ u8 rfPath = 0; ++ ++ if (pHalData->odmpriv.PhyRegPgValueType != PHY_REG_PG_EXACT_VALUE) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ phy_CrossReferenceHTAndVHTTxPowerLimit(Adapter); ++ ++ for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) { ++ ++ for (bw = 0; bw < MAX_2_4G_BANDWIDTH_NUM; ++bw) { ++ ++ for (channel = 0; channel < CENTER_CH_2G_NUM; ++channel) { ++ ++ for (rateSection = CCK; rateSection <= HT_4SS; ++rateSection) { ++ tempPwrLmt = pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][channel][RF_PATH_A]; ++ ++ if (tempPwrLmt != MAX_POWER_INDEX) { ++ ++ for (rfPath = RF_PATH_A; rfPath < MAX_RF_PATH; ++rfPath) { ++ base = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_2_4G, rfPath, rate_section_to_tx_num(rateSection), rateSection); ++ tempValue = tempPwrLmt - base; ++ pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][channel][rfPath] = tempValue; ++ } ++ } ++ } ++ } ++ } ++ } ++ ++ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(Adapter)) { ++ ++ for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) { ++ ++ for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; ++bw) { ++ ++ for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { ++ ++ for (rateSection = OFDM; rateSection <= VHT_4SS; ++rateSection) { ++ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation][bw][rateSection][channel][RF_PATH_A]; ++ ++ if (tempPwrLmt != MAX_POWER_INDEX) { ++ ++ for (rfPath = RF_PATH_A; rfPath < MAX_RF_PATH; ++rfPath) { ++ base = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_5G, rfPath, rate_section_to_tx_num(rateSection), rateSection); ++ tempValue = tempPwrLmt - base; ++ pHalData->TxPwrLimit_5G[regulation][bw][rateSection][channel][rfPath] = tempValue; ++ } ++ } ++ } ++ } ++ } ++ } ++ } ++} ++ ++/* ++* PHY_InitTxPowerLimit - Set all hal_data.TxPwrLimit_2_4G, TxPwrLimit_5G array to MAX_POWER_INDEX ++*/ ++VOID ++PHY_InitTxPowerLimit( ++ IN PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 i, j, k, l, m; ++ ++ for (i = 0; i < MAX_REGULATION_NUM; ++i) ++ for (j = 0; j < MAX_2_4G_BANDWIDTH_NUM; ++j) ++ for (k = 0; k < MAX_RATE_SECTION_NUM; ++k) ++ for (m = 0; m < CENTER_CH_2G_NUM; ++m) ++ for (l = 0; l < MAX_RF_PATH; ++l) ++ pHalData->TxPwrLimit_2_4G[i][j][k][m][l] = MAX_POWER_INDEX; ++ ++ for (i = 0; i < MAX_REGULATION_NUM; ++i) ++ for (j = 0; j < MAX_5G_BANDWIDTH_NUM; ++j) ++ for (k = 0; k < MAX_RATE_SECTION_NUM; ++k) ++ for (m = 0; m < CENTER_CH_5G_ALL_NUM; ++m) ++ for (l = 0; l < MAX_RF_PATH; ++l) ++ pHalData->TxPwrLimit_5G[i][j][k][m][l] = MAX_POWER_INDEX; ++} ++ ++/* ++* PHY_SetTxPowerLimit - Parsing TX power limit from phydm array, called by odm_ConfigBB_TXPWR_LMT_XXX in phydm ++*/ ++VOID ++PHY_SetTxPowerLimit( ++ IN PDM_ODM_T pDM_Odm, ++ IN u8 *Regulation, ++ IN u8 *Band, ++ IN u8 *Bandwidth, ++ IN u8 *RateSection, ++ IN u8 *RfPath, ++ IN u8 *Channel, ++ IN u8 *PowerLimit ++) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 regulation = 0, bandwidth = 0, rateSection = 0, channel; ++ s8 powerLimit = 0, prevPowerLimit, channelIndex; ++ ++ if (0) ++ RTW_INFO("Index of power limit table [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s][val %s]\n" ++ , Band, Regulation, Bandwidth, RateSection, RfPath, Channel, PowerLimit); ++ ++ if (GetU1ByteIntegerFromStringInDecimal((s8 *)Channel, &channel) == _FALSE ++ || GetU1ByteIntegerFromStringInDecimal((s8 *)PowerLimit, &powerLimit) == _FALSE ++ ) { ++ RTW_PRINT("Illegal index of power limit table [ch %s][val %s]\n", Channel, PowerLimit); ++ return; ++ } ++ ++ powerLimit = powerLimit > MAX_POWER_INDEX ? MAX_POWER_INDEX : powerLimit; ++ ++ if (eqNByte(Regulation, (u8 *)("FCC"), 3)) ++ regulation = TXPWR_LMT_FCC; ++ else if (eqNByte(Regulation, (u8 *)("MKK"), 3)) ++ regulation = TXPWR_LMT_MKK; ++ else if (eqNByte(Regulation, (u8 *)("ETSI"), 4)) ++ regulation = TXPWR_LMT_ETSI; ++ else if (eqNByte(Regulation, (u8 *)("WW13"), 4)) ++ regulation = TXPWR_LMT_WW; ++ else { ++ RTW_PRINT("unknown regulation:%s", Regulation); ++ return; ++ } ++ ++ if (eqNByte(RateSection, (u8 *)("CCK"), 3) && eqNByte(RfPath, (u8 *)("1T"), 2)) ++ rateSection = CCK; ++ else if (eqNByte(RateSection, (u8 *)("OFDM"), 4) && eqNByte(RfPath, (u8 *)("1T"), 2)) ++ rateSection = OFDM; ++ else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("1T"), 2)) ++ rateSection = HT_1SS; ++ else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("2T"), 2)) ++ rateSection = HT_2SS; ++ else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("3T"), 2)) ++ rateSection = HT_3SS; ++ else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("4T"), 2)) ++ rateSection = HT_4SS; ++ else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("1T"), 2)) ++ rateSection = VHT_1SS; ++ else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("2T"), 2)) ++ rateSection = VHT_2SS; ++ else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("3T"), 2)) ++ rateSection = VHT_3SS; ++ else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("4T"), 2)) ++ rateSection = VHT_4SS; ++ else { ++ RTW_PRINT("Wrong rate section: (%s,%s)\n", RateSection, RfPath); ++ return; ++ } ++ ++ if (eqNByte(Bandwidth, (u8 *)("20M"), 3)) ++ bandwidth = CHANNEL_WIDTH_20; ++ else if (eqNByte(Bandwidth, (u8 *)("40M"), 3)) ++ bandwidth = CHANNEL_WIDTH_40; ++ else if (eqNByte(Bandwidth, (u8 *)("80M"), 3)) ++ bandwidth = CHANNEL_WIDTH_80; ++ else { ++ RTW_PRINT("unknown bandwidth: %s\n", Bandwidth); ++ return; ++ } ++ ++ if (eqNByte(Band, (u8 *)("2.4G"), 4)) { ++ channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_2_4G, channel); ++ ++ if (channelIndex == -1) { ++ RTW_PRINT("unsupported channel: %d at 2.4G\n", channel); ++ return; ++ } ++ ++ if (bandwidth >= MAX_2_4G_BANDWIDTH_NUM) { ++ RTW_PRINT("unsupported bandwidth: %s at 2.4G\n", Bandwidth); ++ return; ++ } ++ ++ prevPowerLimit = pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A]; ++ ++ if (prevPowerLimit != MAX_POWER_INDEX) ++ RTW_PRINT("duplicate tx power limit combination [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s]\n" ++ , Band, Regulation, Bandwidth, RateSection, RfPath, Channel); ++ ++ if (powerLimit < prevPowerLimit) ++ pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A] = powerLimit; ++ ++ if (0) ++ RTW_INFO("2.4G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n" ++ , regulation, bandwidth, rateSection, channelIndex, pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A]); ++ } else if (eqNByte(Band, (u8 *)("5G"), 2)) { ++ ++ channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_5G, channel); ++ ++ if (channelIndex == -1) { ++ RTW_PRINT("unsupported channel: %d at 5G\n", channel); ++ return; ++ } ++ ++ prevPowerLimit = pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A]; ++ ++ if (prevPowerLimit != MAX_POWER_INDEX) ++ RTW_PRINT("duplicate tx power limit combination [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s]\n" ++ , Band, Regulation, Bandwidth, RateSection, RfPath, Channel); ++ ++ if (powerLimit < prevPowerLimit) ++ pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A] = powerLimit; ++ ++ if (0) ++ RTW_INFO("5G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n" ++ , regulation, bandwidth, rateSection, channel, pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A]); ++ } else { ++ RTW_PRINT("Cannot recognize the band info in %s\n", Band); ++ return; ++ } ++} ++ ++u8 ++PHY_GetTxPowerIndex( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN CHANNEL_WIDTH BandWidth, ++ IN u8 Channel ++) ++{ ++ return rtw_hal_get_tx_power_index(pAdapter, RFPath, Rate, BandWidth, Channel, NULL); ++} ++ ++VOID ++PHY_SetTxPowerIndex( ++ IN PADAPTER pAdapter, ++ IN u32 PowerIndex, ++ IN u8 RFPath, ++ IN u8 Rate ++) ++{ ++ if (IS_HARDWARE_TYPE_8814A(pAdapter)) { ++#if (RTL8814A_SUPPORT == 1) ++ PHY_SetTxPowerIndex_8814A(pAdapter, PowerIndex, RFPath, Rate); ++#endif ++ } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) { ++#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) ++ PHY_SetTxPowerIndex_8812A(pAdapter, PowerIndex, RFPath, Rate); ++#endif ++ } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { ++#if (RTL8723B_SUPPORT == 1) ++ PHY_SetTxPowerIndex_8723B(pAdapter, PowerIndex, RFPath, Rate); ++#endif ++ } else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { ++#if (RTL8703B_SUPPORT == 1) ++ PHY_SetTxPowerIndex_8703B(pAdapter, PowerIndex, RFPath, Rate); ++#endif ++ } else if (IS_HARDWARE_TYPE_8723D(pAdapter)) { ++#if (RTL8723D_SUPPORT == 1) ++ PHY_SetTxPowerIndex_8723D(pAdapter, PowerIndex, RFPath, Rate); ++#endif ++ } else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { ++#if (RTL8192E_SUPPORT == 1) ++ PHY_SetTxPowerIndex_8192E(pAdapter, PowerIndex, RFPath, Rate); ++#endif ++ } else if (IS_HARDWARE_TYPE_8188E(pAdapter)) { ++#if (RTL8188E_SUPPORT == 1) ++ PHY_SetTxPowerIndex_8188E(pAdapter, PowerIndex, RFPath, Rate); ++#endif ++ } else if (IS_HARDWARE_TYPE_8188F(pAdapter)) { ++#if (RTL8188F_SUPPORT == 1) ++ PHY_SetTxPowerIndex_8188F(pAdapter, PowerIndex, RFPath, Rate); ++#endif ++ } else if (IS_HARDWARE_TYPE_8822B(pAdapter)) ++ rtw_hal_set_tx_power_index(pAdapter, PowerIndex, RFPath, Rate); ++ else if (IS_HARDWARE_TYPE_8821C(pAdapter)) ++ rtw_hal_set_tx_power_index(pAdapter, PowerIndex, RFPath, Rate); ++} ++ ++void dump_tx_power_idx_title(void *sel, _adapter *adapter) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ u8 bw = hal_data->CurrentChannelBW; ++ ++ RTW_PRINT_SEL(sel, "%s", ch_width_str(bw)); ++ if (bw >= CHANNEL_WIDTH_80) ++ _RTW_PRINT_SEL(sel, ", cch80:%u", hal_data->cch_80); ++ if (bw >= CHANNEL_WIDTH_40) ++ _RTW_PRINT_SEL(sel, ", cch40:%u", hal_data->cch_40); ++ _RTW_PRINT_SEL(sel, ", cch20:%u\n", hal_data->cch_20); ++ ++ RTW_PRINT_SEL(sel, "%-4s %-9s %-3s %-4s %-3s %-4s %-4s %-3s %-5s\n" ++ , "path", "rate", "pwr", "base", "", "(byr", "lmt)", "tpt", "ebias"); ++} ++ ++void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath, u8 rs) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ u8 power_idx; ++ struct txpwr_idx_comp tic; ++ u8 tx_num, i; ++ u8 band = hal_data->CurrentBandType; ++ u8 cch = hal_data->CurrentChannel; ++ u8 bw = hal_data->CurrentChannelBW; ++ ++ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, rfpath)) ++ return; ++ ++ if (rs >= RATE_SECTION_NUM) ++ return; ++ ++ tx_num = rate_section_to_tx_num(rs); ++ if (tx_num >= hal_spec->nss_num || tx_num >= hal_spec->max_tx_cnt) ++ return; ++ ++ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) ++ return; ++ ++ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) ++ return; ++ ++ for (i = 0; i < rates_by_sections[rs].rate_num; i++) { ++ power_idx = rtw_hal_get_tx_power_index(adapter, rfpath, rates_by_sections[rs].rates[i], bw, cch, &tic); ++ ++ RTW_PRINT_SEL(sel, "%4c %9s %3u %4u %3d (%3d %3d) %3d %5d\n" ++ , rf_path_char(rfpath), MGN_RATE_STR(rates_by_sections[rs].rates[i]) ++ , power_idx, tic.base, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt, tic.ebias); ++ } ++} ++ ++void dump_tx_power_idx(void *sel, _adapter *adapter) ++{ ++ u8 rfpath, rs; ++ ++ dump_tx_power_idx_title(sel, adapter); ++ for (rfpath = RF_PATH_A; rfpath < RF_PATH_MAX; rfpath++) ++ for (rs = CCK; rs < RATE_SECTION_NUM; rs++) ++ dump_tx_power_idx_by_path_rs(sel, adapter, rfpath, rs); ++} ++ ++bool phy_is_tx_power_limit_needed(_adapter *adapter) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); ++ ++ if (regsty->RegEnableTxPowerLimit == 1 ++ || (regsty->RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory == 1)) ++ return _TRUE; ++ return _FALSE; ++} ++ ++bool phy_is_tx_power_by_rate_needed(_adapter *adapter) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); ++ ++ if (regsty->RegEnableTxPowerByRate == 1 ++ || (regsty->RegEnableTxPowerByRate == 2 && hal_data->EEPROMRegulatory != 2)) ++ return _TRUE; ++ return _FALSE; ++} ++ ++int phy_load_tx_power_by_rate(_adapter *adapter, u8 chk_file) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); ++ int ret = _FAIL; ++ ++ hal_data->txpwr_by_rate_loaded = 0; ++ PHY_InitTxPowerByRate(adapter); ++ ++ /* tx power limit is based on tx power by rate */ ++ hal_data->txpwr_limit_loaded = 0; ++ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ if (chk_file ++ && phy_ConfigBBWithPgParaFile(adapter, PHY_FILE_PHY_REG_PG) == _SUCCESS ++ ) { ++ hal_data->txpwr_by_rate_from_file = 1; ++ goto post_hdl; ++ } ++#endif ++ ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if (HAL_STATUS_SUCCESS == ODM_ConfigBBWithHeaderFile(&hal_data->odmpriv, CONFIG_BB_PHY_REG_PG)) { ++ RTW_INFO("default power by rate loaded\n"); ++ hal_data->txpwr_by_rate_from_file = 0; ++ goto post_hdl; ++ } ++#endif ++ ++ RTW_ERR("%s():Read Tx power by rate fail\n", __func__); ++ goto exit; ++ ++post_hdl: ++ if (hal_data->odmpriv.PhyRegPgValueType != PHY_REG_PG_EXACT_VALUE) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ PHY_TxPowerByRateConfiguration(adapter); ++ hal_data->txpwr_by_rate_loaded = 1; ++ ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++ ++int phy_load_tx_power_limit(_adapter *adapter, u8 chk_file) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); ++ int ret = _FAIL; ++ ++ hal_data->txpwr_limit_loaded = 0; ++ PHY_InitTxPowerLimit(adapter); ++ ++ if (!hal_data->txpwr_by_rate_loaded && regsty->target_tx_pwr_valid != _TRUE) { ++ RTW_ERR("%s():Read Tx power limit before target tx power is specify\n", __func__); ++ goto exit; ++ } ++ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ if (chk_file ++ && PHY_ConfigRFWithPowerLimitTableParaFile(adapter, PHY_FILE_TXPWR_LMT) == _SUCCESS ++ ) { ++ hal_data->txpwr_limit_from_file = 1; ++ goto post_hdl; ++ } ++#endif ++ ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if (HAL_STATUS_SUCCESS == ODM_ConfigRFWithHeaderFile(&hal_data->odmpriv, CONFIG_RF_TXPWR_LMT, (ODM_RF_RADIO_PATH_E)0)) { ++ RTW_INFO("default power limit loaded\n"); ++ hal_data->txpwr_limit_from_file = 0; ++ goto post_hdl; ++ } ++#endif ++ ++ RTW_ERR("%s():Read Tx power limit fail\n", __func__); ++ goto exit; ++ ++post_hdl: ++ PHY_ConvertTxPowerLimitToPowerIndex(adapter); ++ hal_data->txpwr_limit_loaded = 1; ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++ ++void phy_load_tx_power_ext_info(_adapter *adapter, u8 chk_file) ++{ ++ struct registry_priv *regsty = adapter_to_regsty(adapter); ++ ++ /* check registy target tx power */ ++ regsty->target_tx_pwr_valid = rtw_regsty_chk_target_tx_power_valid(adapter); ++ ++ /* power by rate and limit */ ++ if (phy_is_tx_power_by_rate_needed(adapter) ++ || (phy_is_tx_power_limit_needed(adapter) && regsty->target_tx_pwr_valid != _TRUE) ++ ) ++ phy_load_tx_power_by_rate(adapter, chk_file); ++ ++ if (phy_is_tx_power_limit_needed(adapter)) ++ phy_load_tx_power_limit(adapter, chk_file); ++} ++ ++inline void phy_reload_tx_power_ext_info(_adapter *adapter) ++{ ++ phy_load_tx_power_ext_info(adapter, 1); ++} ++ ++inline void phy_reload_default_tx_power_ext_info(_adapter *adapter) ++{ ++ phy_load_tx_power_ext_info(adapter, 0); ++} ++ ++void dump_tx_power_ext_info(void *sel, _adapter *adapter) ++{ ++ struct registry_priv *regsty = adapter_to_regsty(adapter); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ ++ if (regsty->target_tx_pwr_valid == _TRUE) ++ RTW_PRINT_SEL(sel, "target_tx_power: from registry\n"); ++ else if (phy_is_tx_power_by_rate_needed(adapter)) ++ RTW_PRINT_SEL(sel, "target_tx_power: from power by rate\n"); ++ else ++ RTW_PRINT_SEL(sel, "target_tx_power: unavailable\n"); ++ ++ RTW_PRINT_SEL(sel, "tx_power_by_rate: %s, %s, %s\n" ++ , phy_is_tx_power_by_rate_needed(adapter) ? "enabled" : "disabled" ++ , hal_data->txpwr_by_rate_loaded ? "loaded" : "unloaded" ++ , hal_data->txpwr_by_rate_from_file ? "file" : "default" ++ ); ++ ++ RTW_PRINT_SEL(sel, "tx_power_limit: %s, %s, %s\n" ++ , phy_is_tx_power_limit_needed(adapter) ? "enabled" : "disabled" ++ , hal_data->txpwr_limit_loaded ? "loaded" : "unloaded" ++ , hal_data->txpwr_limit_from_file ? "file" : "default" ++ ); ++} ++ ++void dump_target_tx_power(void *sel, _adapter *adapter) ++{ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct registry_priv *regsty = adapter_to_regsty(adapter); ++ int path, tx_num, band, rs; ++ u8 target; ++ ++ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { ++ if (!hal_is_band_support(adapter, band)) ++ continue; ++ ++ for (path = 0; path < RF_PATH_MAX; path++) { ++ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) ++ break; ++ ++ RTW_PRINT_SEL(sel, "[%s][%c]%s\n", band_str(band), rf_path_char(path) ++ , (regsty->target_tx_pwr_valid == _FALSE && hal_data->txpwr_by_rate_undefined_band_path[band][path]) ? "(dup)" : ""); ++ ++ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { ++ tx_num = rate_section_to_tx_num(rs); ++ if (tx_num >= hal_spec->nss_num) ++ continue; ++ ++ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) ++ continue; ++ ++ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) ++ continue; ++ ++ target = PHY_GetTxPowerByRateBase(adapter, band, path, rate_section_to_tx_num(rs), rs); ++ ++ if (target % 2) ++ _RTW_PRINT_SEL(sel, "%7s: %2d.5\n", rate_section_str(rs), target / 2); ++ else ++ _RTW_PRINT_SEL(sel, "%7s: %4d\n", rate_section_str(rs), target / 2); ++ } ++ } ++ } ++ ++exit: ++ return; ++} ++ ++void dump_tx_power_by_rate(void *sel, _adapter *adapter) ++{ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ int path, tx_num, band, n, rs; ++ u8 rate_num, max_rate_num, base; ++ s8 by_rate_offset; ++ ++ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { ++ if (!hal_is_band_support(adapter, band)) ++ continue; ++ ++ for (path = 0; path < RF_PATH_MAX; path++) { ++ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) ++ break; ++ ++ RTW_PRINT_SEL(sel, "[%s][%c]%s\n", band_str(band), rf_path_char(path) ++ , hal_data->txpwr_by_rate_undefined_band_path[band][path] ? "(dup)" : ""); ++ ++ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { ++ tx_num = rate_section_to_tx_num(rs); ++ if (tx_num >= hal_spec->nss_num) ++ continue; ++ ++ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) ++ continue; ++ ++ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) ++ continue; ++ ++ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) ++ max_rate_num = 10; ++ else ++ max_rate_num = 8; ++ rate_num = rate_section_rate_num(rs); ++ base = PHY_GetTxPowerByRateBase(adapter, band, path, tx_num, rs); ++ ++ RTW_PRINT_SEL(sel, "%7s: ", rate_section_str(rs)); ++ ++ /* dump power by rate in db */ ++ for (n = rate_num - 1; n >= 0; n--) { ++ by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, tx_num, rates_by_sections[rs].rates[n]); ++ ++ if ((base + by_rate_offset) % 2) ++ _RTW_PRINT_SEL(sel, "%2d.5 ", (base + by_rate_offset) / 2); ++ else ++ _RTW_PRINT_SEL(sel, "%4d ", (base + by_rate_offset) / 2); ++ } ++ for (n = 0; n < max_rate_num - rate_num; n++) ++ _RTW_PRINT_SEL(sel, "%4s ", ""); ++ ++ _RTW_PRINT_SEL(sel, "|"); ++ ++ /* dump power by rate in offset */ ++ for (n = rate_num - 1; n >= 0; n--) { ++ by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, tx_num, rates_by_sections[rs].rates[n]); ++ _RTW_PRINT_SEL(sel, "%3d ", by_rate_offset); ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ ++ } ++ } ++ } ++} ++ ++void dump_tx_power_limit(void *sel, _adapter *adapter) ++{ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); ++ ++ int bw, band, ch_num, rs, i, path; ++ u8 ch, n, rd, rfpath_num; ++ ++ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) ++ RTW_PRINT_SEL(sel, "tx_pwr_lmt_5g_20_40_ref:0x%02x\n", hal_data->tx_pwr_lmt_5g_20_40_ref); ++ ++ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { ++ if (!hal_is_band_support(adapter, band)) ++ continue; ++ ++ rd = (band == BAND_ON_2_4G ? hal_data->Regulation2_4G : hal_data->Regulation5G); ++ rfpath_num = (band == BAND_ON_2_4G ? hal_spec->rfpath_num_2g : hal_spec->rfpath_num_5g); ++ ++ for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; bw++) { ++ ++ if (bw >= CHANNEL_WIDTH_160) ++ break; ++ if (band == BAND_ON_2_4G && bw >= CHANNEL_WIDTH_80) ++ break; ++ ++ if (band == BAND_ON_2_4G) ++ ch_num = CENTER_CH_2G_NUM; ++ else ++ ch_num = center_chs_5g_num(bw); ++ ++ if (ch_num == 0) { ++ rtw_warn_on(1); ++ break; ++ } ++ ++ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { ++ if (band == BAND_ON_2_4G && IS_VHT_RATE_SECTION(rs)) ++ continue; ++ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) ++ continue; ++ if (bw > CHANNEL_WIDTH_20 && (IS_CCK_RATE_SECTION(rs) || IS_OFDM_RATE_SECTION(rs))) ++ continue; ++ if (bw > CHANNEL_WIDTH_40 && IS_HT_RATE_SECTION(rs)) ++ continue; ++ ++ if (rate_section_to_tx_num(rs) >= hal_spec->nss_num) ++ continue; ++ ++ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) ++ continue; ++ ++ /* by pass 5G 20M, 40M pure reference */ ++ if (band == BAND_ON_5G && (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40)) { ++ if (hal_data->tx_pwr_lmt_5g_20_40_ref == TX_PWR_LMT_REF_HT_FROM_VHT) { ++ if (IS_HT_RATE_SECTION(rs)) ++ continue; ++ } else if (hal_data->tx_pwr_lmt_5g_20_40_ref == TX_PWR_LMT_REF_VHT_FROM_HT) { ++ if (IS_VHT_RATE_SECTION(rs) && bw <= CHANNEL_WIDTH_40) ++ continue; ++ } ++ } ++ ++ RTW_PRINT_SEL(sel, "[%s][%s][%s]\n" ++ , band_str(band) ++ , ch_width_str(bw) ++ , rate_section_str(rs) ++ ); ++ ++ /* header for limit in db */ ++ RTW_PRINT_SEL(sel, "%3s %5s %5s %5s %5s " ++ , "ch" ++ , (rd == TXPWR_LMT_FCC ? "*FCC" : "FCC") ++ , (rd == TXPWR_LMT_ETSI ? "*ETSI" : "ETSI") ++ , (rd == TXPWR_LMT_MKK ? "*MKK" : "MKK") ++ , (rd == TXPWR_LMT_WW ? "*WW" : "WW") ++ ); ++ ++ /* header for limit offset */ ++ for (path = 0; path < RF_PATH_MAX; path++) { ++ if (path >= rfpath_num) ++ break; ++ _RTW_PRINT_SEL(sel, "|%3c %3c %3c %3c " ++ , (rd == TXPWR_LMT_FCC ? rf_path_char(path) : ' ') ++ , (rd == TXPWR_LMT_ETSI ? rf_path_char(path) : ' ') ++ , (rd == TXPWR_LMT_MKK ? rf_path_char(path) : ' ') ++ , (rd == TXPWR_LMT_WW ? rf_path_char(path) : ' ') ++ ); ++ } ++ _RTW_PRINT_SEL(sel, "\n"); ++ ++ for (n = 0; n < ch_num; n++) { ++ s8 limit_idx[RF_PATH_MAX][MAX_REGULATION_NUM]; ++ s8 limit_offset[MAX_REGULATION_NUM]; ++ u8 base; ++ ++ if (band == BAND_ON_2_4G) ++ ch = n + 1; ++ else ++ ch = center_chs_5g(bw, n); ++ ++ if (ch == 0) { ++ rtw_warn_on(1); ++ break; ++ } ++ ++ /* dump limit in db (calculate from path A) */ ++ limit_offset[0] = PHY_GetTxPowerLimit_no_sc(adapter, 3, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* FCC */ ++ limit_offset[1] = PHY_GetTxPowerLimit_no_sc(adapter, 1, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* ETSI */ ++ limit_offset[2] = PHY_GetTxPowerLimit_no_sc(adapter, 2, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* MKK */ ++ limit_offset[3] = PHY_GetTxPowerLimit_no_sc(adapter, 4, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* WW */ ++ ++ base = PHY_GetTxPowerByRateBase(adapter, band, RF_PATH_A, rate_section_to_tx_num(rs), rs); ++ ++ RTW_PRINT_SEL(sel, "%3u ", ch); ++ for (i = 0; i < MAX_REGULATION_NUM; i++) { ++ if (limit_offset[i] == MAX_POWER_INDEX) { ++ limit_idx[0][i] = MAX_POWER_INDEX; ++ _RTW_PRINT_SEL(sel, "%5s ", "NA"); ++ } else { ++ limit_idx[0][i] = limit_offset[i] + base; ++ if ((limit_offset[i] + base) % 2) ++ _RTW_PRINT_SEL(sel, "%3d.5 ", (limit_offset[i] + base) / 2); ++ else ++ _RTW_PRINT_SEL(sel, "%5d ", (limit_offset[i] + base) / 2); ++ } ++ } ++ ++ /* dump limit offset of each path */ ++ for (path = 0; path < RF_PATH_MAX; path++) { ++ if (path >= rfpath_num) ++ break; ++ limit_offset[0] = PHY_GetTxPowerLimit_no_sc(adapter, 3, band, bw, path, rates_by_sections[rs].rates[0], ch); /* FCC */ ++ limit_offset[1] = PHY_GetTxPowerLimit_no_sc(adapter, 1, band, bw, path, rates_by_sections[rs].rates[0], ch); /* ETSI */ ++ limit_offset[2] = PHY_GetTxPowerLimit_no_sc(adapter, 2, band, bw, path, rates_by_sections[rs].rates[0], ch); /* MKK */ ++ limit_offset[3] = PHY_GetTxPowerLimit_no_sc(adapter, 4, band, bw, path, rates_by_sections[rs].rates[0], ch); /* WW */ ++ ++ base = PHY_GetTxPowerByRateBase(adapter, band, path, rate_section_to_tx_num(rs), rs); ++ ++ _RTW_PRINT_SEL(sel, "|"); ++ for (i = 0; i < MAX_REGULATION_NUM; i++) { ++ if (limit_offset[i] == MAX_POWER_INDEX) { ++ limit_idx[path][i] = MAX_POWER_INDEX; ++ _RTW_PRINT_SEL(sel, "%3s ", "NA"); ++ } else { ++ limit_idx[path][i] = limit_offset[i] + base; ++ _RTW_PRINT_SEL(sel, "%3d ", limit_offset[i]); ++ } ++ } ++ } ++ ++ /* compare limit_idx of each path, print 'x' when mismatch */ ++ if (rfpath_num > 1) { ++ for (i = 0; i < MAX_REGULATION_NUM; i++) { ++ for (path = 0; path < RF_PATH_MAX; path++) { ++ if (path >= rfpath_num) ++ break; ++ if (limit_idx[path][i] != limit_idx[(path + 1) % rfpath_num][i]) ++ break; ++ } ++ if (path >= rfpath_num) ++ _RTW_PRINT_SEL(sel, " "); ++ else ++ _RTW_PRINT_SEL(sel, "x"); ++ } ++ } ++ _RTW_PRINT_SEL(sel, "\n"); ++ ++ } ++ RTW_PRINT_SEL(sel, "\n"); ++ } /* loop for rate sections */ ++ } /* loop for bandwidths */ ++ } /* loop for bands */ ++} ++ ++/* ++ * phy file path is stored in global char array rtw_phy_para_file_path ++ * need to care about racing ++ */ ++int rtw_get_phy_file_path(_adapter *adapter, const char *file_name) ++{ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ int len = 0; ++ ++ if (file_name) { ++ len += snprintf(rtw_phy_para_file_path, PATH_LENGTH_MAX, "%s", rtw_phy_file_path); ++ #if defined(CONFIG_MULTIDRV) || defined(REALTEK_CONFIG_PATH_WITH_IC_NAME_FOLDER) ++ len += snprintf(rtw_phy_para_file_path + len, PATH_LENGTH_MAX - len, "%s/", hal_spec->ic_name); ++ #endif ++ len += snprintf(rtw_phy_para_file_path + len, PATH_LENGTH_MAX - len, "%s", file_name); ++ ++ return _TRUE; ++ } ++#endif ++ return _FALSE; ++} ++ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++int ++phy_ConfigMACWithParaFile( ++ IN PADAPTER Adapter, ++ IN char *pFileName ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ int rlen = 0, rtStatus = _FAIL; ++ char *szLine, *ptmp; ++ u32 u4bRegOffset, u4bRegValue, u4bMove; ++ ++ if (!(Adapter->registrypriv.load_phy_file & LOAD_MAC_PARA_FILE)) ++ return rtStatus; ++ ++ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); ++ ++ if ((pHalData->mac_reg_len == 0) && (pHalData->mac_reg == NULL)) { ++ rtw_get_phy_file_path(Adapter, pFileName); ++ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { ++ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); ++ if (rlen > 0) { ++ rtStatus = _SUCCESS; ++ pHalData->mac_reg = rtw_zvmalloc(rlen); ++ if (pHalData->mac_reg) { ++ _rtw_memcpy(pHalData->mac_reg, pHalData->para_file_buf, rlen); ++ pHalData->mac_reg_len = rlen; ++ } else ++ RTW_INFO("%s mac_reg alloc fail !\n", __FUNCTION__); ++ } ++ } ++ } else { ++ if ((pHalData->mac_reg_len != 0) && (pHalData->mac_reg != NULL)) { ++ _rtw_memcpy(pHalData->para_file_buf, pHalData->mac_reg, pHalData->mac_reg_len); ++ rtStatus = _SUCCESS; ++ } else ++ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); ++ } ++ ++ if (rtStatus == _SUCCESS) { ++ ptmp = pHalData->para_file_buf; ++ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { ++ if (!IsCommentString(szLine)) { ++ /* Get 1st hex value as register offset */ ++ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { ++ if (u4bRegOffset == 0xffff) { ++ /* Ending. */ ++ break; ++ } ++ ++ /* Get 2nd hex value as register value. */ ++ szLine += u4bMove; ++ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) ++ rtw_write8(Adapter, u4bRegOffset, (u8)u4bRegValue); ++ } ++ } ++ } ++ } else ++ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); ++ ++ return rtStatus; ++} ++ ++int ++phy_ConfigBBWithParaFile( ++ IN PADAPTER Adapter, ++ IN char *pFileName, ++ IN u32 ConfigType ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ int rlen = 0, rtStatus = _FAIL; ++ char *szLine, *ptmp; ++ u32 u4bRegOffset, u4bRegValue, u4bMove; ++ char *pBuf = NULL; ++ u32 *pBufLen = NULL; ++ ++ if (!(Adapter->registrypriv.load_phy_file & LOAD_BB_PARA_FILE)) ++ return rtStatus; ++ ++ switch (ConfigType) { ++ case CONFIG_BB_PHY_REG: ++ pBuf = pHalData->bb_phy_reg; ++ pBufLen = &pHalData->bb_phy_reg_len; ++ break; ++ case CONFIG_BB_AGC_TAB: ++ pBuf = pHalData->bb_agc_tab; ++ pBufLen = &pHalData->bb_agc_tab_len; ++ break; ++ default: ++ RTW_INFO("Unknown ConfigType!! %d\r\n", ConfigType); ++ break; ++ } ++ ++ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); ++ ++ if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) { ++ rtw_get_phy_file_path(Adapter, pFileName); ++ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { ++ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); ++ if (rlen > 0) { ++ rtStatus = _SUCCESS; ++ pBuf = rtw_zvmalloc(rlen); ++ if (pBuf) { ++ _rtw_memcpy(pBuf, pHalData->para_file_buf, rlen); ++ *pBufLen = rlen; ++ ++ switch (ConfigType) { ++ case CONFIG_BB_PHY_REG: ++ pHalData->bb_phy_reg = pBuf; ++ break; ++ case CONFIG_BB_AGC_TAB: ++ pHalData->bb_agc_tab = pBuf; ++ break; ++ } ++ } else ++ RTW_INFO("%s(): ConfigType %d alloc fail !\n", __FUNCTION__, ConfigType); ++ } ++ } ++ } else { ++ if ((pBufLen != NULL) && (*pBufLen != 0) && (pBuf != NULL)) { ++ _rtw_memcpy(pHalData->para_file_buf, pBuf, *pBufLen); ++ rtStatus = _SUCCESS; ++ } else ++ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); ++ } ++ ++ if (rtStatus == _SUCCESS) { ++ ptmp = pHalData->para_file_buf; ++ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { ++ if (!IsCommentString(szLine)) { ++ /* Get 1st hex value as register offset. */ ++ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { ++ if (u4bRegOffset == 0xffff) { ++ /* Ending. */ ++ break; ++ } else if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) { ++#ifdef CONFIG_LONG_DELAY_ISSUE ++ rtw_msleep_os(50); ++#else ++ rtw_mdelay_os(50); ++#endif ++ } else if (u4bRegOffset == 0xfd) ++ rtw_mdelay_os(5); ++ else if (u4bRegOffset == 0xfc) ++ rtw_mdelay_os(1); ++ else if (u4bRegOffset == 0xfb) ++ rtw_udelay_os(50); ++ else if (u4bRegOffset == 0xfa) ++ rtw_udelay_os(5); ++ else if (u4bRegOffset == 0xf9) ++ rtw_udelay_os(1); ++ ++ /* Get 2nd hex value as register value. */ ++ szLine += u4bMove; ++ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { ++ /* RTW_INFO("[BB-ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue); */ ++ PHY_SetBBReg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); ++ ++ if (u4bRegOffset == 0xa24) ++ pHalData->odmpriv.RFCalibrateInfo.RegA24 = u4bRegValue; ++ ++ /* Add 1us delay between BB/RF register setting. */ ++ rtw_udelay_os(1); ++ } ++ } ++ } ++ } ++ } else ++ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); ++ ++ return rtStatus; ++} ++ ++VOID ++phy_DecryptBBPgParaFile( ++ PADAPTER Adapter, ++ char *buffer ++) ++{ ++ u32 i = 0, j = 0; ++ u8 map[95] = {0}; ++ u8 currentChar; ++ char *BufOfLines, *ptmp; ++ ++ /* RTW_INFO("=====>phy_DecryptBBPgParaFile()\n"); */ ++ /* 32 the ascii code of the first visable char, 126 the last one */ ++ for (i = 0; i < 95; ++i) ++ map[i] = (u8)(94 - i); ++ ++ ptmp = buffer; ++ i = 0; ++ for (BufOfLines = GetLineFromBuffer(ptmp); BufOfLines != NULL; BufOfLines = GetLineFromBuffer(ptmp)) { ++ /* RTW_INFO("Encrypted Line: %s\n", BufOfLines); */ ++ ++ for (j = 0; j < strlen(BufOfLines); ++j) { ++ currentChar = BufOfLines[j]; ++ ++ if (currentChar == '\0') ++ break; ++ ++ currentChar -= (u8)((((i + j) * 3) % 128)); ++ ++ BufOfLines[j] = map[currentChar - 32] + 32; ++ } ++ /* RTW_INFO("Decrypted Line: %s\n", BufOfLines ); */ ++ if (strlen(BufOfLines) != 0) ++ i++; ++ BufOfLines[strlen(BufOfLines)] = '\n'; ++ } ++} ++ ++int ++phy_ParseBBPgParaFile( ++ PADAPTER Adapter, ++ char *buffer ++) ++{ ++ int rtStatus = _SUCCESS; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ char *szLine, *ptmp; ++ u32 u4bRegOffset, u4bRegMask, u4bRegValue; ++ u32 u4bMove; ++ BOOLEAN firstLine = _TRUE; ++ u8 tx_num = 0; ++ u8 band = 0, rf_path = 0; ++ ++ /* RTW_INFO("=====>phy_ParseBBPgParaFile()\n"); */ ++ ++ if (Adapter->registrypriv.RegDecryptCustomFile == 1) ++ phy_DecryptBBPgParaFile(Adapter, buffer); ++ ++ ptmp = buffer; ++ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { ++ if (isAllSpaceOrTab(szLine, sizeof(*szLine))) ++ continue; ++ ++ if (!IsCommentString(szLine)) { ++ /* Get header info (relative value or exact value) */ ++ if (firstLine) { ++ if (eqNByte(szLine, (u8 *)("#[v1]"), 5)) { ++ ++ pHalData->odmpriv.PhyRegPgVersion = szLine[3] - '0'; ++ /* RTW_INFO("This is a new format PHY_REG_PG.txt\n"); */ ++ } else if (eqNByte(szLine, (u8 *)("#[v0]"), 5)) { ++ pHalData->odmpriv.PhyRegPgVersion = szLine[3] - '0'; ++ /* RTW_INFO("This is a old format PHY_REG_PG.txt ok\n"); */ ++ } else { ++ RTW_INFO("The format in PHY_REG_PG are invalid %s\n", szLine); ++ return _FAIL; ++ } ++ ++ if (eqNByte(szLine + 5, (u8 *)("[Exact]#"), 8)) { ++ pHalData->odmpriv.PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; ++ /* RTW_INFO("The values in PHY_REG_PG are exact values ok\n"); */ ++ firstLine = _FALSE; ++ continue; ++ } else if (eqNByte(szLine + 5, (pu1Byte)("[Relative]#"), 11)) { ++ pHalData->odmpriv.PhyRegPgValueType = PHY_REG_PG_RELATIVE_VALUE; ++ /* RTW_INFO("The values in PHY_REG_PG are relative values ok\n"); */ ++ firstLine = _FALSE; ++ continue; ++ } else { ++ RTW_INFO("The values in PHY_REG_PG are invalid %s\n", szLine); ++ return _FAIL; ++ } ++ } ++ ++ if (pHalData->odmpriv.PhyRegPgVersion == 0) { ++ /* Get 1st hex value as register offset. */ ++ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { ++ szLine += u4bMove; ++ if (u4bRegOffset == 0xffff) { ++ /* Ending. */ ++ break; ++ } ++ ++ /* Get 2nd hex value as register mask. */ ++ if (GetHexValueFromString(szLine, &u4bRegMask, &u4bMove)) ++ szLine += u4bMove; ++ else ++ return _FAIL; ++ ++ if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_RELATIVE_VALUE) { ++ /* Get 3rd hex value as register value. */ ++ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { ++ PHY_StoreTxPowerByRate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, u4bRegValue); ++ /* RTW_INFO("[ADDR] %03X=%08X Mask=%08x\n", u4bRegOffset, u4bRegValue, u4bRegMask); */ ++ } else ++ return _FAIL; ++ } else if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE) { ++ u32 combineValue = 0; ++ u8 integer = 0, fraction = 0; ++ ++ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) ++ szLine += u4bMove; ++ else ++ return _FAIL; ++ ++ integer *= 2; ++ if (fraction == 5) ++ integer += 1; ++ combineValue |= (((integer / 10) << 4) + (integer % 10)); ++ /* RTW_INFO(" %d", integer ); */ ++ ++ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) ++ szLine += u4bMove; ++ else ++ return _FAIL; ++ ++ integer *= 2; ++ if (fraction == 5) ++ integer += 1; ++ combineValue <<= 8; ++ combineValue |= (((integer / 10) << 4) + (integer % 10)); ++ /* RTW_INFO(" %d", integer ); */ ++ ++ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) ++ szLine += u4bMove; ++ else ++ return _FAIL; ++ ++ integer *= 2; ++ if (fraction == 5) ++ integer += 1; ++ combineValue <<= 8; ++ combineValue |= (((integer / 10) << 4) + (integer % 10)); ++ /* RTW_INFO(" %d", integer ); */ ++ ++ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) ++ szLine += u4bMove; ++ else ++ return _FAIL; ++ ++ integer *= 2; ++ if (fraction == 5) ++ integer += 1; ++ combineValue <<= 8; ++ combineValue |= (((integer / 10) << 4) + (integer % 10)); ++ /* RTW_INFO(" %d", integer ); */ ++ PHY_StoreTxPowerByRate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, combineValue); ++ ++ /* RTW_INFO("[ADDR] 0x%3x = 0x%4x\n", u4bRegOffset, combineValue ); */ ++ } ++ } ++ } else if (pHalData->odmpriv.PhyRegPgVersion > 0) { ++ u32 index = 0, cnt = 0; ++ ++ if (eqNByte(szLine, "0xffff", 6)) ++ break; ++ ++ if (!eqNByte("#[END]#", szLine, 7)) { ++ /* load the table label info */ ++ if (szLine[0] == '#') { ++ index = 0; ++ if (eqNByte(szLine, "#[2.4G]" , 7)) { ++ band = BAND_ON_2_4G; ++ index += 8; ++ } else if (eqNByte(szLine, "#[5G]", 5)) { ++ band = BAND_ON_5G; ++ index += 6; ++ } else { ++ RTW_INFO("Invalid band %s in PHY_REG_PG.txt\n", szLine); ++ return _FAIL; ++ } ++ ++ rf_path = szLine[index] - 'A'; ++ /* RTW_INFO(" Table label Band %d, RfPath %d\n", band, rf_path ); */ ++ } else { /* load rows of tables */ ++ if (szLine[1] == '1') ++ tx_num = RF_1TX; ++ else if (szLine[1] == '2') ++ tx_num = RF_2TX; ++ else if (szLine[1] == '3') ++ tx_num = RF_3TX; ++ else if (szLine[1] == '4') ++ tx_num = RF_4TX; ++ else { ++ RTW_INFO("Invalid row in PHY_REG_PG.txt '%c'(%d)\n", szLine[1], szLine[1]); ++ return _FAIL; ++ } ++ ++ while (szLine[index] != ']') ++ ++index; ++ ++index;/* skip ] */ ++ ++ /* Get 2nd hex value as register offset. */ ++ szLine += index; ++ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) ++ szLine += u4bMove; ++ else ++ return _FAIL; ++ ++ /* Get 2nd hex value as register mask. */ ++ if (GetHexValueFromString(szLine, &u4bRegMask, &u4bMove)) ++ szLine += u4bMove; ++ else ++ return _FAIL; ++ ++ if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_RELATIVE_VALUE) { ++ /* Get 3rd hex value as register value. */ ++ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { ++ PHY_StoreTxPowerByRate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, u4bRegValue); ++ /* RTW_INFO("[ADDR] %03X (tx_num %d) =%08X Mask=%08x\n", u4bRegOffset, tx_num, u4bRegValue, u4bRegMask); */ ++ } else ++ return _FAIL; ++ } else if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE) { ++ u32 combineValue = 0; ++ u8 integer = 0, fraction = 0; ++ ++ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) ++ szLine += u4bMove; ++ else ++ return _FAIL; ++ ++ integer *= 2; ++ if (fraction == 5) ++ integer += 1; ++ combineValue |= (((integer / 10) << 4) + (integer % 10)); ++ /* RTW_INFO(" %d", integer ); */ ++ ++ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) ++ szLine += u4bMove; ++ else ++ return _FAIL; ++ ++ integer *= 2; ++ if (fraction == 5) ++ integer += 1; ++ combineValue <<= 8; ++ combineValue |= (((integer / 10) << 4) + (integer % 10)); ++ /* RTW_INFO(" %d", integer ); */ ++ ++ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) ++ szLine += u4bMove; ++ else ++ return _FAIL; ++ ++ integer *= 2; ++ if (fraction == 5) ++ integer += 1; ++ combineValue <<= 8; ++ combineValue |= (((integer / 10) << 4) + (integer % 10)); ++ /* RTW_INFO(" %d", integer ); */ ++ ++ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) ++ szLine += u4bMove; ++ else ++ return _FAIL; ++ ++ integer *= 2; ++ if (fraction == 5) ++ integer += 1; ++ combineValue <<= 8; ++ combineValue |= (((integer / 10) << 4) + (integer % 10)); ++ /* RTW_INFO(" %d", integer ); */ ++ PHY_StoreTxPowerByRate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, combineValue); ++ ++ /* RTW_INFO("[ADDR] 0x%3x (tx_num %d) = 0x%4x\n", u4bRegOffset, tx_num, combineValue ); */ ++ } ++ } ++ } ++ } ++ } ++ } ++ /* RTW_INFO("<=====phy_ParseBBPgParaFile()\n"); */ ++ return rtStatus; ++} ++ ++int ++phy_ConfigBBWithPgParaFile( ++ IN PADAPTER Adapter, ++ IN const char *pFileName) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ int rlen = 0, rtStatus = _FAIL; ++ ++ if (!(Adapter->registrypriv.load_phy_file & LOAD_BB_PG_PARA_FILE)) ++ return rtStatus; ++ ++ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); ++ ++ if (pHalData->bb_phy_reg_pg == NULL) { ++ rtw_get_phy_file_path(Adapter, pFileName); ++ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { ++ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); ++ if (rlen > 0) { ++ rtStatus = _SUCCESS; ++ pHalData->bb_phy_reg_pg = rtw_zvmalloc(rlen); ++ if (pHalData->bb_phy_reg_pg) { ++ _rtw_memcpy(pHalData->bb_phy_reg_pg, pHalData->para_file_buf, rlen); ++ pHalData->bb_phy_reg_pg_len = rlen; ++ } else ++ RTW_INFO("%s bb_phy_reg_pg alloc fail !\n", __FUNCTION__); ++ } ++ } ++ } else { ++ if ((pHalData->bb_phy_reg_pg_len != 0) && (pHalData->bb_phy_reg_pg != NULL)) { ++ _rtw_memcpy(pHalData->para_file_buf, pHalData->bb_phy_reg_pg, pHalData->bb_phy_reg_pg_len); ++ rtStatus = _SUCCESS; ++ } else ++ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); ++ } ++ ++ if (rtStatus == _SUCCESS) { ++ /* RTW_INFO("phy_ConfigBBWithPgParaFile(): read %s ok\n", pFileName); */ ++ phy_ParseBBPgParaFile(Adapter, pHalData->para_file_buf); ++ } else ++ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); ++ ++ return rtStatus; ++} ++ ++#if (MP_DRIVER == 1) ++ ++int ++phy_ConfigBBWithMpParaFile( ++ IN PADAPTER Adapter, ++ IN char *pFileName ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ int rlen = 0, rtStatus = _FAIL; ++ char *szLine, *ptmp; ++ u32 u4bRegOffset, u4bRegValue, u4bMove; ++ ++ if (!(Adapter->registrypriv.load_phy_file & LOAD_BB_MP_PARA_FILE)) ++ return rtStatus; ++ ++ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); ++ ++ if ((pHalData->bb_phy_reg_mp_len == 0) && (pHalData->bb_phy_reg_mp == NULL)) { ++ rtw_get_phy_file_path(Adapter, pFileName); ++ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { ++ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); ++ if (rlen > 0) { ++ rtStatus = _SUCCESS; ++ pHalData->bb_phy_reg_mp = rtw_zvmalloc(rlen); ++ if (pHalData->bb_phy_reg_mp) { ++ _rtw_memcpy(pHalData->bb_phy_reg_mp, pHalData->para_file_buf, rlen); ++ pHalData->bb_phy_reg_mp_len = rlen; ++ } else ++ RTW_INFO("%s bb_phy_reg_mp alloc fail !\n", __FUNCTION__); ++ } ++ } ++ } else { ++ if ((pHalData->bb_phy_reg_mp_len != 0) && (pHalData->bb_phy_reg_mp != NULL)) { ++ _rtw_memcpy(pHalData->para_file_buf, pHalData->bb_phy_reg_mp, pHalData->bb_phy_reg_mp_len); ++ rtStatus = _SUCCESS; ++ } else ++ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); ++ } ++ ++ if (rtStatus == _SUCCESS) { ++ /* RTW_INFO("phy_ConfigBBWithMpParaFile(): read %s ok\n", pFileName); */ ++ ++ ptmp = pHalData->para_file_buf; ++ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { ++ if (!IsCommentString(szLine)) { ++ /* Get 1st hex value as register offset. */ ++ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { ++ if (u4bRegOffset == 0xffff) { ++ /* Ending. */ ++ break; ++ } else if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) { ++#ifdef CONFIG_LONG_DELAY_ISSUE ++ rtw_msleep_os(50); ++#else ++ rtw_mdelay_os(50); ++#endif ++ } else if (u4bRegOffset == 0xfd) ++ rtw_mdelay_os(5); ++ else if (u4bRegOffset == 0xfc) ++ rtw_mdelay_os(1); ++ else if (u4bRegOffset == 0xfb) ++ rtw_udelay_os(50); ++ else if (u4bRegOffset == 0xfa) ++ rtw_udelay_os(5); ++ else if (u4bRegOffset == 0xf9) ++ rtw_udelay_os(1); ++ ++ /* Get 2nd hex value as register value. */ ++ szLine += u4bMove; ++ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { ++ /* RTW_INFO("[ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue); */ ++ PHY_SetBBReg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); ++ ++ /* Add 1us delay between BB/RF register setting. */ ++ rtw_udelay_os(1); ++ } ++ } ++ } ++ } ++ } else ++ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); ++ ++ return rtStatus; ++} ++ ++#endif ++ ++int ++PHY_ConfigRFWithParaFile( ++ IN PADAPTER Adapter, ++ IN char *pFileName, ++ IN u8 eRFPath ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ int rlen = 0, rtStatus = _FAIL; ++ char *szLine, *ptmp; ++ u32 u4bRegOffset, u4bRegValue, u4bMove; ++ u16 i; ++ char *pBuf = NULL; ++ u32 *pBufLen = NULL; ++ ++ if (!(Adapter->registrypriv.load_phy_file & LOAD_RF_PARA_FILE)) ++ return rtStatus; ++ ++ switch (eRFPath) { ++ case ODM_RF_PATH_A: ++ pBuf = pHalData->rf_radio_a; ++ pBufLen = &pHalData->rf_radio_a_len; ++ break; ++ case ODM_RF_PATH_B: ++ pBuf = pHalData->rf_radio_b; ++ pBufLen = &pHalData->rf_radio_b_len; ++ break; ++ default: ++ RTW_INFO("Unknown RF path!! %d\r\n", eRFPath); ++ break; ++ } ++ ++ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); ++ ++ if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) { ++ rtw_get_phy_file_path(Adapter, pFileName); ++ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { ++ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); ++ if (rlen > 0) { ++ rtStatus = _SUCCESS; ++ pBuf = rtw_zvmalloc(rlen); ++ if (pBuf) { ++ _rtw_memcpy(pBuf, pHalData->para_file_buf, rlen); ++ *pBufLen = rlen; ++ ++ switch (eRFPath) { ++ case ODM_RF_PATH_A: ++ pHalData->rf_radio_a = pBuf; ++ break; ++ case ODM_RF_PATH_B: ++ pHalData->rf_radio_b = pBuf; ++ break; ++ } ++ } else ++ RTW_INFO("%s(): eRFPath=%d alloc fail !\n", __FUNCTION__, eRFPath); ++ } ++ } ++ } else { ++ if ((pBufLen != NULL) && (*pBufLen != 0) && (pBuf != NULL)) { ++ _rtw_memcpy(pHalData->para_file_buf, pBuf, *pBufLen); ++ rtStatus = _SUCCESS; ++ } else ++ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); ++ } ++ ++ if (rtStatus == _SUCCESS) { ++ /* RTW_INFO("%s(): read %s successfully\n", __FUNCTION__, pFileName); */ ++ ++ ptmp = pHalData->para_file_buf; ++ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { ++ if (!IsCommentString(szLine)) { ++ /* Get 1st hex value as register offset. */ ++ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { ++ if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) { ++ /* Deay specific ms. Only RF configuration require delay. */ ++#ifdef CONFIG_LONG_DELAY_ISSUE ++ rtw_msleep_os(50); ++#else ++ rtw_mdelay_os(50); ++#endif ++ } else if (u4bRegOffset == 0xfd) { ++ /* delay_ms(5); */ ++ for (i = 0; i < 100; i++) ++ rtw_udelay_os(MAX_STALL_TIME); ++ } else if (u4bRegOffset == 0xfc) { ++ /* delay_ms(1); */ ++ for (i = 0; i < 20; i++) ++ rtw_udelay_os(MAX_STALL_TIME); ++ } else if (u4bRegOffset == 0xfb) ++ rtw_udelay_os(50); ++ else if (u4bRegOffset == 0xfa) ++ rtw_udelay_os(5); ++ else if (u4bRegOffset == 0xf9) ++ rtw_udelay_os(1); ++ else if (u4bRegOffset == 0xffff) ++ break; ++ ++ /* Get 2nd hex value as register value. */ ++ szLine += u4bMove; ++ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { ++ PHY_SetRFReg(Adapter, eRFPath, u4bRegOffset, bRFRegOffsetMask, u4bRegValue); ++ ++ /* Temp add, for frequency lock, if no delay, that may cause */ ++ /* frequency shift, ex: 2412MHz => 2417MHz */ ++ /* If frequency shift, the following action may works. */ ++ /* Fractional-N table in radio_a.txt */ ++ /* 0x2a 0x00001 */ /* channel 1 */ ++ /* 0x2b 0x00808 frequency divider. */ ++ /* 0x2b 0x53333 */ ++ /* 0x2c 0x0000c */ ++ rtw_udelay_os(1); ++ } ++ } ++ } ++ } ++ } else ++ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); ++ ++ return rtStatus; ++} ++ ++VOID ++initDeltaSwingIndexTables( ++ PADAPTER Adapter, ++ char *Band, ++ char *Path, ++ char *Sign, ++ char *Channel, ++ char *Rate, ++ char *Data ++) ++{ ++#define STR_EQUAL_5G(_band, _path, _sign, _rate, _chnl) \ ++ ((strcmp(Band, _band) == 0) && (strcmp(Path, _path) == 0) && (strcmp(Sign, _sign) == 0) &&\ ++ (strcmp(Rate, _rate) == 0) && (strcmp(Channel, _chnl) == 0)\ ++ ) ++#define STR_EQUAL_2G(_band, _path, _sign, _rate) \ ++ ((strcmp(Band, _band) == 0) && (strcmp(Path, _path) == 0) && (strcmp(Sign, _sign) == 0) &&\ ++ (strcmp(Rate, _rate) == 0)\ ++ ) ++ ++#define STORE_SWING_TABLE(_array, _iteratedIdx) \ ++ do { \ ++ for (token = strsep(&Data, delim); token != NULL; token = strsep(&Data, delim)) {\ ++ sscanf(token, "%d", &idx);\ ++ _array[_iteratedIdx++] = (u8)idx;\ ++ } } while (0)\ ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ u32 j = 0; ++ char *token; ++ char delim[] = ","; ++ u32 idx = 0; ++ ++ /* RTW_INFO("===>initDeltaSwingIndexTables(): Band: %s;\nPath: %s;\nSign: %s;\nChannel: %s;\nRate: %s;\n, Data: %s;\n", */ ++ /* Band, Path, Sign, Channel, Rate, Data); */ ++ ++ if (STR_EQUAL_2G("2G", "A", "+", "CCK")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, j); ++ else if (STR_EQUAL_2G("2G", "A", "-", "CCK")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, j); ++ else if (STR_EQUAL_2G("2G", "B", "+", "CCK")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, j); ++ else if (STR_EQUAL_2G("2G", "B", "-", "CCK")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, j); ++ else if (STR_EQUAL_2G("2G", "A", "+", "ALL")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, j); ++ else if (STR_EQUAL_2G("2G", "A", "-", "ALL")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, j); ++ else if (STR_EQUAL_2G("2G", "B", "+", "ALL")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, j); ++ else if (STR_EQUAL_2G("2G", "B", "-", "ALL")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, j); ++ else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "0")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0], j); ++ else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "0")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0], j); ++ else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "0")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0], j); ++ else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "0")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0], j); ++ else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "1")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1], j); ++ else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "1")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1], j); ++ else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "1")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1], j); ++ else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "1")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1], j); ++ else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "2")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2], j); ++ else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "2")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2], j); ++ else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "2")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2], j); ++ else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "2")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2], j); ++ else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "3")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[3], j); ++ else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "3")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[3], j); ++ else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "3")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[3], j); ++ else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "3")) ++ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[3], j); ++ else ++ RTW_INFO("===>initDeltaSwingIndexTables(): The input is invalid!!\n"); ++} ++ ++int ++PHY_ConfigRFWithTxPwrTrackParaFile( ++ IN PADAPTER Adapter, ++ IN char *pFileName ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ int rlen = 0, rtStatus = _FAIL; ++ char *szLine, *ptmp; ++ u32 i = 0, j = 0; ++ char c = 0; ++ ++ if (!(Adapter->registrypriv.load_phy_file & LOAD_RF_TXPWR_TRACK_PARA_FILE)) ++ return rtStatus; ++ ++ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); ++ ++ if ((pHalData->rf_tx_pwr_track_len == 0) && (pHalData->rf_tx_pwr_track == NULL)) { ++ rtw_get_phy_file_path(Adapter, pFileName); ++ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { ++ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); ++ if (rlen > 0) { ++ rtStatus = _SUCCESS; ++ pHalData->rf_tx_pwr_track = rtw_zvmalloc(rlen); ++ if (pHalData->rf_tx_pwr_track) { ++ _rtw_memcpy(pHalData->rf_tx_pwr_track, pHalData->para_file_buf, rlen); ++ pHalData->rf_tx_pwr_track_len = rlen; ++ } else ++ RTW_INFO("%s rf_tx_pwr_track alloc fail !\n", __FUNCTION__); ++ } ++ } ++ } else { ++ if ((pHalData->rf_tx_pwr_track_len != 0) && (pHalData->rf_tx_pwr_track != NULL)) { ++ _rtw_memcpy(pHalData->para_file_buf, pHalData->rf_tx_pwr_track, pHalData->rf_tx_pwr_track_len); ++ rtStatus = _SUCCESS; ++ } else ++ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); ++ } ++ ++ if (rtStatus == _SUCCESS) { ++ /* RTW_INFO("%s(): read %s successfully\n", __FUNCTION__, pFileName); */ ++ ++ ptmp = pHalData->para_file_buf; ++ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { ++ if (!IsCommentString(szLine)) { ++ char band[5] = "", path[5] = "", sign[5] = ""; ++ char chnl[5] = "", rate[10] = ""; ++ char data[300] = ""; /* 100 is too small */ ++ ++ if (strlen(szLine) < 10 || szLine[0] != '[') ++ continue; ++ ++ strncpy(band, szLine + 1, 2); ++ strncpy(path, szLine + 5, 1); ++ strncpy(sign, szLine + 8, 1); ++ ++ i = 10; /* szLine+10 */ ++ if (!ParseQualifiedString(szLine, &i, rate, '[', ']')) { ++ /* RTW_INFO("Fail to parse rate!\n"); */ ++ } ++ if (!ParseQualifiedString(szLine, &i, chnl, '[', ']')) { ++ /* RTW_INFO("Fail to parse channel group!\n"); */ ++ } ++ while (szLine[i] != '{' && i < strlen(szLine)) ++ i++; ++ if (!ParseQualifiedString(szLine, &i, data, '{', '}')) { ++ /* RTW_INFO("Fail to parse data!\n"); */ ++ } ++ ++ initDeltaSwingIndexTables(Adapter, band, path, sign, chnl, rate, data); ++ } ++ } ++ } else ++ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); ++#if 0 ++ for (i = 0; i < DELTA_SWINGIDX_SIZE; ++i) { ++ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P[i]); ++ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N[i]); ++ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P[i]); ++ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N[i]); ++ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P[i]); ++ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N[i]); ++ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P[i]); ++ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N[i]); ++ ++ for (j = 0; j < 3; ++j) { ++ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[j][i]); ++ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[j][i]); ++ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[j][i]); ++ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[j][i]); ++ } ++ } ++#endif ++ return rtStatus; ++} ++ ++int ++phy_ParsePowerLimitTableFile( ++ PADAPTER Adapter, ++ char *buffer ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ u32 i = 0, forCnt = 0; ++ u8 loadingStage = 0, limitValue = 0, fraction = 0; ++ char *szLine, *ptmp; ++ int rtStatus = _SUCCESS; ++ char band[10], bandwidth[10], rateSection[10], ++ regulation[TXPWR_LMT_MAX_REGULATION_NUM][10], rfPath[10], colNumBuf[10]; ++ u8 colNum = 0; ++ ++ RTW_INFO("===>phy_ParsePowerLimitTableFile()\n"); ++ ++ if (Adapter->registrypriv.RegDecryptCustomFile == 1) ++ phy_DecryptBBPgParaFile(Adapter, buffer); ++ ++ ptmp = buffer; ++ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { ++ if (isAllSpaceOrTab(szLine, sizeof(*szLine))) ++ continue; ++ ++ /* skip comment */ ++ if (IsCommentString(szLine)) ++ continue; ++ ++ if (loadingStage == 0) { ++ for (forCnt = 0; forCnt < TXPWR_LMT_MAX_REGULATION_NUM; ++forCnt) ++ _rtw_memset((PVOID) regulation[forCnt], 0, 10); ++ _rtw_memset((PVOID) band, 0, 10); ++ _rtw_memset((PVOID) bandwidth, 0, 10); ++ _rtw_memset((PVOID) rateSection, 0, 10); ++ _rtw_memset((PVOID) rfPath, 0, 10); ++ _rtw_memset((PVOID) colNumBuf, 0, 10); ++ ++ if (szLine[0] != '#' || szLine[1] != '#') ++ continue; ++ ++ /* skip the space */ ++ i = 2; ++ while (szLine[i] == ' ' || szLine[i] == '\t') ++ ++i; ++ ++ szLine[--i] = ' '; /* return the space in front of the regulation info */ ++ ++ /* Parse the label of the table */ ++ if (!ParseQualifiedString(szLine, &i, band, ' ', ',')) { ++ RTW_INFO("Fail to parse band!\n"); ++ return _FAIL; ++ } ++ if (!ParseQualifiedString(szLine, &i, bandwidth, ' ', ',')) { ++ RTW_INFO("Fail to parse bandwidth!\n"); ++ return _FAIL; ++ } ++ if (!ParseQualifiedString(szLine, &i, rfPath, ' ', ',')) { ++ RTW_INFO("Fail to parse rf path!\n"); ++ return _FAIL; ++ } ++ if (!ParseQualifiedString(szLine, &i, rateSection, ' ', ',')) { ++ RTW_INFO("Fail to parse rate!\n"); ++ return _FAIL; ++ } ++ ++ loadingStage = 1; ++ } else if (loadingStage == 1) { ++ if (szLine[0] != '#' || szLine[1] != '#') ++ continue; ++ ++ /* skip the space */ ++ i = 2; ++ while (szLine[i] == ' ' || szLine[i] == '\t') ++ ++i; ++ ++ if (!eqNByte((u8 *)(szLine + i), (u8 *)("START"), 5)) { ++ RTW_INFO("Lost \"## START\" label\n"); ++ return _FAIL; ++ } ++ ++ loadingStage = 2; ++ } else if (loadingStage == 2) { ++ if (szLine[0] != '#' || szLine[1] != '#') ++ continue; ++ ++ /* skip the space */ ++ i = 2; ++ while (szLine[i] == ' ' || szLine[i] == '\t') ++ ++i; ++ ++ if (!ParseQualifiedString(szLine, &i, colNumBuf, '#', '#')) { ++ RTW_INFO("Fail to parse column number!\n"); ++ return _FAIL; ++ } ++ ++ if (!GetU1ByteIntegerFromStringInDecimal(colNumBuf, &colNum)) ++ return _FAIL; ++ ++ if (colNum > TXPWR_LMT_MAX_REGULATION_NUM) { ++ RTW_INFO("unvalid col number %d (greater than max %d)\n", ++ colNum, TXPWR_LMT_MAX_REGULATION_NUM); ++ return _FAIL; ++ } ++ ++ for (forCnt = 0; forCnt < colNum; ++forCnt) { ++ u8 regulation_name_cnt = 0; ++ ++ /* skip the space */ ++ while (szLine[i] == ' ' || szLine[i] == '\t') ++ ++i; ++ ++ while (szLine[i] != ' ' && szLine[i] != '\t' && szLine[i] != '\0') ++ regulation[forCnt][regulation_name_cnt++] = szLine[i++]; ++ /* RTW_INFO("regulation %s!\n", regulation[forCnt]); */ ++ ++ if (regulation_name_cnt == 0) { ++ RTW_INFO("unvalid number of regulation!\n"); ++ return _FAIL; ++ } ++ } ++ ++ loadingStage = 3; ++ } else if (loadingStage == 3) { ++ char channel[10] = {0}, powerLimit[10] = {0}; ++ u8 cnt = 0; ++ ++ /* the table ends */ ++ if (szLine[0] == '#' && szLine[1] == '#') { ++ i = 2; ++ while (szLine[i] == ' ' || szLine[i] == '\t') ++ ++i; ++ ++ if (eqNByte((u8 *)(szLine + i), (u8 *)("END"), 3)) { ++ loadingStage = 0; ++ continue; ++ } else { ++ RTW_INFO("Wrong format\n"); ++ RTW_INFO("<===== phy_ParsePowerLimitTableFile()\n"); ++ return _FAIL; ++ } ++ } ++ ++ if ((szLine[0] != 'c' && szLine[0] != 'C') || ++ (szLine[1] != 'h' && szLine[1] != 'H')) { ++ RTW_INFO("Meet wrong channel => power limt pair '%c','%c'(%d,%d)\n", szLine[0], szLine[1], szLine[0], szLine[1]); ++ continue; ++ } ++ i = 2;/* move to the location behind 'h' */ ++ ++ /* load the channel number */ ++ cnt = 0; ++ while (szLine[i] >= '0' && szLine[i] <= '9') { ++ channel[cnt] = szLine[i]; ++ ++cnt; ++ ++i; ++ } ++ /* RTW_INFO("chnl %s!\n", channel); */ ++ ++ for (forCnt = 0; forCnt < colNum; ++forCnt) { ++ /* skip the space between channel number and the power limit value */ ++ while (szLine[i] == ' ' || szLine[i] == '\t') ++ ++i; ++ ++ /* load the power limit value */ ++ cnt = 0; ++ fraction = 0; ++ _rtw_memset((PVOID) powerLimit, 0, 10); ++ while ((szLine[i] >= '0' && szLine[i] <= '9') || szLine[i] == '.') { ++ if (szLine[i] == '.') { ++ if ((szLine[i + 1] >= '0' && szLine[i + 1] <= '9')) { ++ fraction = szLine[i + 1]; ++ i += 2; ++ } else { ++ RTW_INFO("Wrong fraction in TXPWR_LMT.txt\n"); ++ return _FAIL; ++ } ++ ++ break; ++ } ++ ++ powerLimit[cnt] = szLine[i]; ++ ++cnt; ++ ++i; ++ } ++ ++ if (powerLimit[0] == '\0') { ++ powerLimit[0] = '6'; ++ powerLimit[1] = '3'; ++ i += 2; ++ } else { ++ if (!GetU1ByteIntegerFromStringInDecimal(powerLimit, &limitValue)) ++ return _FAIL; ++ ++ limitValue *= 2; ++ cnt = 0; ++ if (fraction == '5') ++ ++limitValue; ++ ++ /* the value is greater or equal to 100 */ ++ if (limitValue >= 100) { ++ powerLimit[cnt++] = limitValue / 100 + '0'; ++ limitValue %= 100; ++ ++ if (limitValue >= 10) { ++ powerLimit[cnt++] = limitValue / 10 + '0'; ++ limitValue %= 10; ++ } else ++ powerLimit[cnt++] = '0'; ++ ++ powerLimit[cnt++] = limitValue + '0'; ++ } ++ /* the value is greater or equal to 10 */ ++ else if (limitValue >= 10) { ++ powerLimit[cnt++] = limitValue / 10 + '0'; ++ limitValue %= 10; ++ powerLimit[cnt++] = limitValue + '0'; ++ } ++ /* the value is less than 10 */ ++ else ++ powerLimit[cnt++] = limitValue + '0'; ++ ++ powerLimit[cnt] = '\0'; ++ } ++ ++ /* RTW_INFO("ch%s => %s\n", channel, powerLimit); */ ++ ++ /* store the power limit value */ ++ PHY_SetTxPowerLimit(pDM_Odm, (u8 *)regulation[forCnt], (u8 *)band, ++ (u8 *)bandwidth, (u8 *)rateSection, (u8 *)rfPath, (u8 *)channel, (u8 *)powerLimit); ++ ++ } ++ } else { ++ RTW_INFO("Abnormal loading stage in phy_ParsePowerLimitTableFile()!\n"); ++ rtStatus = _FAIL; ++ break; ++ } ++ } ++ ++ RTW_INFO("<===phy_ParsePowerLimitTableFile()\n"); ++ return rtStatus; ++} ++ ++int ++PHY_ConfigRFWithPowerLimitTableParaFile( ++ IN PADAPTER Adapter, ++ IN const char *pFileName ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ int rlen = 0, rtStatus = _FAIL; ++ ++ if (!(Adapter->registrypriv.load_phy_file & LOAD_RF_TXPWR_LMT_PARA_FILE)) ++ return rtStatus; ++ ++ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); ++ ++ if (pHalData->rf_tx_pwr_lmt == NULL) { ++ rtw_get_phy_file_path(Adapter, pFileName); ++ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { ++ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); ++ if (rlen > 0) { ++ rtStatus = _SUCCESS; ++ pHalData->rf_tx_pwr_lmt = rtw_zvmalloc(rlen); ++ if (pHalData->rf_tx_pwr_lmt) { ++ _rtw_memcpy(pHalData->rf_tx_pwr_lmt, pHalData->para_file_buf, rlen); ++ pHalData->rf_tx_pwr_lmt_len = rlen; ++ } else ++ RTW_INFO("%s rf_tx_pwr_lmt alloc fail !\n", __FUNCTION__); ++ } ++ } ++ } else { ++ if ((pHalData->rf_tx_pwr_lmt_len != 0) && (pHalData->rf_tx_pwr_lmt != NULL)) { ++ _rtw_memcpy(pHalData->para_file_buf, pHalData->rf_tx_pwr_lmt, pHalData->rf_tx_pwr_lmt_len); ++ rtStatus = _SUCCESS; ++ } else ++ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); ++ } ++ ++ if (rtStatus == _SUCCESS) { ++ /* RTW_INFO("%s(): read %s ok\n", __FUNCTION__, pFileName); */ ++ rtStatus = phy_ParsePowerLimitTableFile(Adapter, pHalData->para_file_buf); ++ } else ++ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); ++ ++ return rtStatus; ++} ++ ++void phy_free_filebuf_mask(_adapter *padapter, u8 mask) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ if (pHalData->mac_reg && (mask & LOAD_MAC_PARA_FILE)) { ++ rtw_vmfree(pHalData->mac_reg, pHalData->mac_reg_len); ++ pHalData->mac_reg = NULL; ++ } ++ if (mask & LOAD_BB_PARA_FILE) { ++ if (pHalData->bb_phy_reg) { ++ rtw_vmfree(pHalData->bb_phy_reg, pHalData->bb_phy_reg_len); ++ pHalData->bb_phy_reg = NULL; ++ } ++ if (pHalData->bb_agc_tab) { ++ rtw_vmfree(pHalData->bb_agc_tab, pHalData->bb_agc_tab_len); ++ pHalData->bb_agc_tab = NULL; ++ } ++ } ++ if (pHalData->bb_phy_reg_pg && (mask & LOAD_BB_PG_PARA_FILE)) { ++ rtw_vmfree(pHalData->bb_phy_reg_pg, pHalData->bb_phy_reg_pg_len); ++ pHalData->bb_phy_reg_pg = NULL; ++ } ++ if (pHalData->bb_phy_reg_mp && (mask & LOAD_BB_MP_PARA_FILE)) { ++ rtw_vmfree(pHalData->bb_phy_reg_mp, pHalData->bb_phy_reg_mp_len); ++ pHalData->bb_phy_reg_mp = NULL; ++ } ++ if (mask & LOAD_RF_PARA_FILE) { ++ if (pHalData->rf_radio_a) { ++ rtw_vmfree(pHalData->rf_radio_a, pHalData->rf_radio_a_len); ++ pHalData->rf_radio_a = NULL; ++ } ++ if (pHalData->rf_radio_b) { ++ rtw_vmfree(pHalData->rf_radio_b, pHalData->rf_radio_b_len); ++ pHalData->rf_radio_b = NULL; ++ } ++ } ++ if (pHalData->rf_tx_pwr_track && (mask & LOAD_RF_TXPWR_TRACK_PARA_FILE)) { ++ rtw_vmfree(pHalData->rf_tx_pwr_track, pHalData->rf_tx_pwr_track_len); ++ pHalData->rf_tx_pwr_track = NULL; ++ } ++ if (pHalData->rf_tx_pwr_lmt && (mask & LOAD_RF_TXPWR_LMT_PARA_FILE)) { ++ rtw_vmfree(pHalData->rf_tx_pwr_lmt, pHalData->rf_tx_pwr_lmt_len); ++ pHalData->rf_tx_pwr_lmt = NULL; ++ } ++} ++ ++inline void phy_free_filebuf(_adapter *padapter) ++{ ++ phy_free_filebuf_mask(padapter, 0xFF); ++} ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_dm.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_dm.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/hal_dm.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_dm.c 2018-02-11 21:44:27.152146162 +0200 +@@ -0,0 +1,217 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2014 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#include ++#include ++ ++/* A mapping from HalData to ODM. */ ++ODM_BOARD_TYPE_E boardType(u8 InterfaceSel) ++{ ++ ODM_BOARD_TYPE_E board = ODM_BOARD_DEFAULT; ++ ++#ifdef CONFIG_PCI_HCI ++ INTERFACE_SELECT_PCIE pcie = (INTERFACE_SELECT_PCIE)InterfaceSel; ++ switch (pcie) { ++ case INTF_SEL0_SOLO_MINICARD: ++ board |= ODM_BOARD_MINICARD; ++ break; ++ case INTF_SEL1_BT_COMBO_MINICARD: ++ board |= ODM_BOARD_BT; ++ board |= ODM_BOARD_MINICARD; ++ break; ++ default: ++ board = ODM_BOARD_DEFAULT; ++ break; ++ } ++ ++#elif defined(CONFIG_USB_HCI) ++ INTERFACE_SELECT_USB usb = (INTERFACE_SELECT_USB)InterfaceSel; ++ switch (usb) { ++ case INTF_SEL1_USB_High_Power: ++ board |= ODM_BOARD_EXT_LNA; ++ board |= ODM_BOARD_EXT_PA; ++ break; ++ case INTF_SEL2_MINICARD: ++ board |= ODM_BOARD_MINICARD; ++ break; ++ case INTF_SEL4_USB_Combo: ++ board |= ODM_BOARD_BT; ++ break; ++ case INTF_SEL5_USB_Combo_MF: ++ board |= ODM_BOARD_BT; ++ break; ++ case INTF_SEL0_USB: ++ case INTF_SEL3_USB_Solo: ++ default: ++ board = ODM_BOARD_DEFAULT; ++ break; ++ } ++ ++#endif ++ /* RTW_INFO("===> boardType(): (pHalData->InterfaceSel, pDM_Odm->BoardType) = (%d, %d)\n", InterfaceSel, board); */ ++ ++ return board; ++} ++ ++void Init_ODM_ComInfo(_adapter *adapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); ++ int i; ++ ++ _rtw_memset(pDM_Odm, 0, sizeof(*pDM_Odm)); ++ ++ pDM_Odm->Adapter = adapter; ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PLATFORM, ODM_CE); ++ ++ rtw_odm_init_ic_type(adapter); ++ ++ if (rtw_get_intf_type(adapter) == RTW_GSPI) ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_INTERFACE, ODM_ITRF_SDIO); ++ else ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_INTERFACE, rtw_get_intf_type(adapter)); ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_MP_TEST_CHIP, IS_NORMAL_CHIP(pHalData->VersionID)); ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PATCH_ID, pHalData->CustomerID); ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BWIFI_TEST, adapter->registrypriv.wifi_spec); ++ ++ ++ if (pHalData->rf_type == RF_1T1R) ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_1T1R); ++ else if (pHalData->rf_type == RF_1T2R) ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_1T2R); ++ else if (pHalData->rf_type == RF_2T2R) ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T2R); ++ else if (pHalData->rf_type == RF_2T2R_GREEN) ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T2R_GREEN); ++ else if (pHalData->rf_type == RF_2T3R) ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T3R); ++ else if (pHalData->rf_type == RF_2T4R) ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T4R); ++ else if (pHalData->rf_type == RF_3T3R) ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_3T3R); ++ else if (pHalData->rf_type == RF_3T4R) ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_3T4R); ++ else if (pHalData->rf_type == RF_4T4R) ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_4T4R); ++ else ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_XTXR); ++ ++ ++ { ++ /* 1 ======= BoardType: ODM_CMNINFO_BOARD_TYPE ======= */ ++ u8 odm_board_type = ODM_BOARD_DEFAULT; ++ ++ if (pHalData->ExternalLNA_2G != 0) { ++ odm_board_type |= ODM_BOARD_EXT_LNA; ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_LNA, 1); ++ } ++ if (pHalData->ExternalLNA_5G != 0) { ++ odm_board_type |= ODM_BOARD_EXT_LNA_5G; ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_5G_EXT_LNA, 1); ++ } ++ if (pHalData->ExternalPA_2G != 0) { ++ odm_board_type |= ODM_BOARD_EXT_PA; ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_PA, 1); ++ } ++ if (pHalData->ExternalPA_5G != 0) { ++ odm_board_type |= ODM_BOARD_EXT_PA_5G; ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_5G_EXT_PA, 1); ++ } ++ if (pHalData->EEPROMBluetoothCoexist) ++ odm_board_type |= ODM_BOARD_BT; ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BOARD_TYPE, odm_board_type); ++ /* 1 ============== End of BoardType ============== */ ++ } ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_DOMAIN_CODE_2G, pHalData->Regulation2_4G); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_DOMAIN_CODE_5G, pHalData->Regulation5G); ++ ++#ifdef CONFIG_DFS_MASTER ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_DFS_REGION_DOMAIN, adapter->registrypriv.dfs_region_domain); ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_DFS_MASTER_ENABLE, &(adapter_to_rfctl(adapter)->dfs_master_enabled)); ++#endif ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_GPA, pHalData->TypeGPA); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_APA, pHalData->TypeAPA); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_GLNA, pHalData->TypeGLNA); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_ALNA, pHalData->TypeALNA); ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RFE_TYPE, pHalData->RFEType); ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_TRSW, 0); ++ ++ /*Add by YuChen for kfree init*/ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_REGRFKFREEENABLE, adapter->registrypriv.RegPwrTrimEnable); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RFKFREEENABLE, pHalData->RfKFreeEnable); ++ ++ /*Antenna diversity relative parameters*/ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, pHalData->TRxAntDivType); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BE_FIX_TX_ANT, pHalData->b_fix_tx_ant); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH, pHalData->with_extenal_ant_switch); ++ ++ /*Add by YuChen for adaptivity init*/ ++ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE, (adapter->registrypriv.adaptivity_mode != 0) ? TRUE : FALSE); ++ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_DCBACKOFF, adapter->registrypriv.adaptivity_dc_backoff); ++ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY, (adapter->registrypriv.adaptivity_dml != 0) ? TRUE : FALSE); ++ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_TH_L2H_INI, adapter->registrypriv.adaptivity_th_l2h_ini); ++ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, adapter->registrypriv.adaptivity_th_edcca_hl_diff); ++ ++ ++ /* Pointer reference */ ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_TX_UNI, &(dvobj->traffic_stat.tx_bytes)); ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_RX_UNI, &(dvobj->traffic_stat.rx_bytes)); ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_WM_MODE, &(pmlmeext->cur_wireless_mode)); ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BAND, &(pHalData->CurrentBandType)); ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_FORCED_RATE, &(pHalData->ForcedDataRate)); ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_FORCED_IGI_LB, &(pHalData->u1ForcedIgiLb)); ++ ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SEC_CHNL_OFFSET, &(pHalData->nCur40MhzPrimeSC)); ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SEC_MODE, &(adapter->securitypriv.dot11PrivacyAlgrthm)); ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BW, &(pHalData->CurrentChannelBW)); ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_CHNL, &(pHalData->CurrentChannel)); ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_NET_CLOSED, &(adapter->net_closed)); ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_FORCED_IGI_LB, &(pHalData->u1ForcedIgiLb)); ++ ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SCAN, &(pmlmepriv->bScanInProcess)); ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_POWER_SAVING, &(pwrctl->bpower_saving)); ++ /*Add by Yuchen for phydm beamforming*/ ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_TX_TP, &(dvobj->traffic_stat.cur_tx_tp)); ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_RX_TP, &(dvobj->traffic_stat.cur_rx_tp)); ++#ifdef CONFIG_USB_HCI ++ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_HUBUSBMODE, &(dvobj->usb_speed)); ++#endif ++ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) ++ ODM_CmnInfoPtrArrayHook(pDM_Odm, ODM_CMNINFO_STA_STATUS, i, NULL); ++ ++ PHYDM_InitDebugSetting(pDM_Odm); ++ ++ /* TODO */ ++ /* ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BT_OPERATION, _FALSE); */ ++ /* ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BT_DISABLE_EDCA, _FALSE); */ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_dm.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/hal_dm.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_dm.h 2018-02-11 21:44:27.152146162 +0200 +@@ -0,0 +1,25 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_DM_H__ ++#define __HAL_DM_H__ ++ ++void Init_ODM_ComInfo(_adapter *adapter); ++ ++#endif /* __HAL_DM_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_halmac.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_halmac.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/hal_halmac.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_halmac.c 2018-02-11 21:44:27.152146162 +0200 +@@ -0,0 +1,2379 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _HAL_HALMAC_C_ ++ ++#include /* PADAPTER, struct dvobj_priv, SDIO_ERR_VAL8 and etc. */ ++#include /* efuse, PHAL_DATA_TYPE and etc. */ ++#include "halmac/halmac_api.h" /* HALMAC_FW_SIZE_MAX_88XX and etc. */ ++#include "hal_halmac.h" /* dvobj_to_halmac() and ect. */ ++ ++#define DEFAULT_INDICATOR_TIMELMT 1000 /* ms */ ++#define FIRMWARE_MAX_SIZE HALMAC_FW_SIZE_MAX_88XX ++ ++/* ++ * Driver API for HALMAC operations ++ */ ++ ++#ifdef CONFIG_SDIO_HCI ++#include ++static u8 _halmac_sdio_cmd52_read(void *p, u32 offset) ++{ ++ struct dvobj_priv *d; ++ u8 val; ++ u8 ret; ++ ++ ++ d = (struct dvobj_priv *)p; ++ ret = rtw_sdio_read_cmd52(d, offset, &val, 1); ++ if (_FAIL == ret) { ++ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); ++ return SDIO_ERR_VAL8; ++ } ++ ++ return val; ++} ++ ++static void _halmac_sdio_cmd52_write(void *p, u32 offset, u8 val) ++{ ++ struct dvobj_priv *d; ++ u8 ret; ++ ++ ++ d = (struct dvobj_priv *)p; ++ ret = rtw_sdio_write_cmd52(d, offset, &val, 1); ++ if (_FAIL == ret) ++ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); ++} ++ ++static u8 _halmac_sdio_reg_read_8(void *p, u32 offset) ++{ ++ struct dvobj_priv *d; ++ u8 *pbuf; ++ u8 val; ++ int err; ++ ++ ++ d = (struct dvobj_priv *)p; ++ val = SDIO_ERR_VAL8; ++ pbuf = rtw_zmalloc(1); ++ if (!pbuf) ++ return val; ++ ++ err = d->intf_ops->read(d, offset, pbuf, 1, 0); ++ if (err) { ++ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); ++ goto exit; ++ } ++ ++ val = *pbuf; ++ ++exit: ++ rtw_mfree(pbuf, 1); ++ ++ return val; ++} ++ ++static u16 _halmac_sdio_reg_read_16(void *p, u32 offset) ++{ ++ struct dvobj_priv *d; ++ u8 *pbuf; ++ u16 val; ++ int err; ++ ++ ++ d = (struct dvobj_priv *)p; ++ val = SDIO_ERR_VAL16; ++ pbuf = rtw_zmalloc(2); ++ if (!pbuf) ++ return val; ++ ++ err = d->intf_ops->read(d, offset, pbuf, 2, 0); ++ if (err) { ++ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); ++ goto exit; ++ } ++ ++ val = le16_to_cpu(*(u16 *)pbuf); ++ ++exit: ++ rtw_mfree(pbuf, 2); ++ ++ return val; ++} ++ ++static u32 _halmac_sdio_reg_read_32(void *p, u32 offset) ++{ ++ struct dvobj_priv *d; ++ u8 *pbuf; ++ u32 val; ++ int err; ++ ++ ++ d = (struct dvobj_priv *)p; ++ val = SDIO_ERR_VAL32; ++ pbuf = rtw_zmalloc(4); ++ if (!pbuf) ++ return val; ++ ++ err = d->intf_ops->read(d, offset, pbuf, 4, 0); ++ if (err) { ++ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); ++ goto exit; ++ } ++ ++ val = le32_to_cpu(*(u32 *)pbuf); ++ ++exit: ++ rtw_mfree(pbuf, 4); ++ ++ return val; ++} ++ ++static u8 _halmac_sdio_reg_read_n(void *p, u32 offset, u32 size, u8 *data) ++{ ++ struct dvobj_priv *d = (struct dvobj_priv *)p; ++ PSDIO_DATA psdio = &d->intf_data; ++ ++ u8 *pbuf; ++ int err; ++ u8 rst = _FALSE; ++ u32 sdio_read_size; ++ ++ sdio_read_size = RND4(size); ++ if (sdio_read_size > psdio->block_transfer_len) ++ sdio_read_size = _RND(sdio_read_size, psdio->block_transfer_len); ++ ++ pbuf = rtw_zmalloc(sdio_read_size); ++ if ((!pbuf) || (!data)) ++ return rst; ++ ++ err = d->intf_ops->read(d, offset, pbuf, sdio_read_size, 0); ++ if (err) { ++ RTW_ERR("%s: [ERROR] I/O FAIL!\n", __func__); ++ goto exit; ++ } ++ ++ _rtw_memcpy(data, pbuf, size); ++ rst = _TRUE; ++exit: ++ rtw_mfree(pbuf, sdio_read_size); ++ ++ return rst; ++} ++ ++static void _halmac_sdio_reg_write_8(void *p, u32 offset, u8 val) ++{ ++ struct dvobj_priv *d; ++ u8 *pbuf; ++ int err; ++ ++ ++ d = (struct dvobj_priv *)p; ++ pbuf = rtw_zmalloc(1); ++ if (!pbuf) ++ return; ++ _rtw_memcpy(pbuf, &val, 1); ++ ++ err = d->intf_ops->write(d, offset, pbuf, 1, 0); ++ if (err) ++ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); ++ ++ rtw_mfree(pbuf, 1); ++} ++ ++static void _halmac_sdio_reg_write_16(void *p, u32 offset, u16 val) ++{ ++ struct dvobj_priv *d; ++ u8 *pbuf; ++ int err; ++ ++ ++ d = (struct dvobj_priv *)p; ++ val = cpu_to_le16(val); ++ pbuf = rtw_zmalloc(2); ++ if (!pbuf) ++ return; ++ _rtw_memcpy(pbuf, &val, 2); ++ ++ err = d->intf_ops->write(d, offset, pbuf, 2, 0); ++ if (err) ++ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); ++ ++ rtw_mfree(pbuf, 2); ++} ++ ++static void _halmac_sdio_reg_write_32(void *p, u32 offset, u32 val) ++{ ++ struct dvobj_priv *d; ++ u8 *pbuf; ++ int err; ++ ++ ++ d = (struct dvobj_priv *)p; ++ val = cpu_to_le32(val); ++ pbuf = rtw_zmalloc(4); ++ if (!pbuf) ++ return; ++ _rtw_memcpy(pbuf, &val, 4); ++ ++ err = d->intf_ops->write(d, offset, pbuf, 4, 0); ++ if (err) ++ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); ++ ++ rtw_mfree(pbuf, 4); ++} ++ ++#else /* !CONFIG_SDIO_HCI */ ++ ++static u8 _halmac_reg_read_8(void *p, u32 offset) ++{ ++ struct dvobj_priv *d; ++ PADAPTER adapter; ++ ++ ++ d = (struct dvobj_priv *)p; ++ adapter = d->padapters[IFACE_ID0]; ++ ++ return rtw_read8(adapter, offset); ++} ++ ++static u16 _halmac_reg_read_16(void *p, u32 offset) ++{ ++ struct dvobj_priv *d; ++ PADAPTER adapter; ++ ++ ++ d = (struct dvobj_priv *)p; ++ adapter = d->padapters[IFACE_ID0]; ++ ++ return rtw_read16(adapter, offset); ++} ++ ++static u32 _halmac_reg_read_32(void *p, u32 offset) ++{ ++ struct dvobj_priv *d; ++ PADAPTER adapter; ++ ++ ++ d = (struct dvobj_priv *)p; ++ adapter = d->padapters[IFACE_ID0]; ++ ++ return rtw_read32(adapter, offset); ++} ++ ++static void _halmac_reg_write_8(void *p, u32 offset, u8 val) ++{ ++ struct dvobj_priv *d; ++ PADAPTER adapter; ++ int err; ++ ++ ++ d = (struct dvobj_priv *)p; ++ adapter = d->padapters[IFACE_ID0]; ++ ++ err = rtw_write8(adapter, offset, val); ++ if (err == _FAIL) ++ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); ++} ++ ++static void _halmac_reg_write_16(void *p, u32 offset, u16 val) ++{ ++ struct dvobj_priv *d; ++ PADAPTER adapter; ++ int err; ++ ++ ++ d = (struct dvobj_priv *)p; ++ adapter = d->padapters[IFACE_ID0]; ++ ++ err = rtw_write16(adapter, offset, val); ++ if (err == _FAIL) ++ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); ++} ++ ++static void _halmac_reg_write_32(void *p, u32 offset, u32 val) ++{ ++ struct dvobj_priv *d; ++ PADAPTER adapter; ++ int err; ++ ++ ++ d = (struct dvobj_priv *)p; ++ adapter = d->padapters[IFACE_ID0]; ++ ++ err = rtw_write32(adapter, offset, val); ++ if (err == _FAIL) ++ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); ++} ++#endif /* !CONFIG_SDIO_HCI */ ++ ++static u8 _halmac_mfree(void *p, void *buffer, u32 size) ++{ ++ rtw_mfree(buffer, size); ++ return _TRUE; ++} ++ ++static void *_halmac_malloc(void *p, u32 size) ++{ ++ return rtw_zmalloc(size); ++} ++ ++static u8 _halmac_memcpy(void *p, void *dest, void *src, u32 size) ++{ ++ _rtw_memcpy(dest, src, size); ++ return _TRUE; ++} ++ ++static u8 _halmac_memset(void *p, void *addr, u8 value, u32 size) ++{ ++ _rtw_memset(addr, value, size); ++ return _TRUE; ++} ++ ++static void _halmac_udelay(void *p, u32 us) ++{ ++ rtw_udelay_os(us); ++} ++ ++static u8 _halmac_mutex_init(void *p, HALMAC_MUTEX *pMutex) ++{ ++ _rtw_mutex_init(pMutex); ++ return _TRUE; ++} ++ ++static u8 _halmac_mutex_deinit(void *p, HALMAC_MUTEX *pMutex) ++{ ++ _rtw_mutex_free(pMutex); ++ return _TRUE; ++} ++ ++static u8 _halmac_mutex_lock(void *p, HALMAC_MUTEX *pMutex) ++{ ++ int err; ++ ++ err = _enter_critical_mutex(pMutex, NULL); ++ if (err) ++ return _FALSE; ++ ++ return _TRUE; ++} ++ ++static u8 _halmac_mutex_unlock(void *p, HALMAC_MUTEX *pMutex) ++{ ++ _exit_critical_mutex(pMutex, NULL); ++ return _TRUE; ++} ++ ++static u8 _halmac_msg_print(void *p, u32 msg_type, u8 msg_level, s8 *fmt, ...) ++{ ++#define MSG_LEN 100 ++#define MSG_PREFIX "[HALMAC]" ++ va_list args; ++ u8 str[MSG_LEN] = {0}; ++ u32 type; ++ u8 level; ++ ++ ++ str[0] = '\n'; ++ type = 0xFFFFFFFF; ++ if (rtw_drv_log_level <= _DRV_ERR_) ++ level = HALMAC_DBG_ERR; ++ else if (rtw_drv_log_level <= _DRV_INFO_) ++ level = HALMAC_DBG_WARN; ++ else ++ level = HALMAC_DBG_TRACE; ++ ++ if (!(type & BIT(msg_type))) ++ return _TRUE; ++ if (level < msg_level) ++ return _TRUE; ++ ++ va_start(args, fmt); ++ vsnprintf(str, MSG_LEN, fmt, args); ++ va_end(args); ++ ++ if (msg_level <= HALMAC_DBG_ERR) ++ RTW_ERR(MSG_PREFIX "%s", str); ++ else if (msg_level <= HALMAC_DBG_WARN) ++ RTW_WARN(MSG_PREFIX "%s", str); ++ else ++ RTW_DBG(MSG_PREFIX "%s", str); ++ ++ return _TRUE; ++} ++ ++static u8 _halmac_buff_print(void *p, u32 msg_type, u8 msg_level, s8 *buf, u32 size) ++{ ++#define MSG_PREFIX "[HALMAC]" ++ u32 type; ++ u8 level; ++ ++ type = 0xFFFFFFFF; ++ if (rtw_drv_log_level <= _DRV_ERR_) ++ level = HALMAC_DBG_ERR; ++ else if (rtw_drv_log_level <= _DRV_INFO_) ++ level = HALMAC_DBG_WARN; ++ else ++ level = HALMAC_DBG_TRACE; ++ ++ if (!(type & BIT(msg_type))) ++ return _TRUE; ++ if (level < msg_level) ++ return _TRUE; ++ ++ if (msg_level <= HALMAC_DBG_WARN) ++ RTW_INFO_DUMP(MSG_PREFIX, buf, size); ++ else ++ RTW_DBG_DUMP(MSG_PREFIX, buf, size); ++ ++ return _TRUE; ++} ++ ++ ++const char *const RTW_HALMAC_FEATURE_NAME[] = { ++ "HALMAC_FEATURE_CFG_PARA", ++ "HALMAC_FEATURE_DUMP_PHYSICAL_EFUSE", ++ "HALMAC_FEATURE_DUMP_LOGICAL_EFUSE", ++ "HALMAC_FEATURE_UPDATE_PACKET", ++ "HALMAC_FEATURE_UPDATE_DATAPACK", ++ "HALMAC_FEATURE_RUN_DATAPACK", ++ "HALMAC_FEATURE_CHANNEL_SWITCH", ++ "HALMAC_FEATURE_IQK", ++ "HALMAC_FEATURE_POWER_TRACKING", ++ "HALMAC_FEATURE_PSD", ++ "HALMAC_FEATURE_ALL" ++}; ++ ++static inline u8 is_valid_id_status(HALMAC_FEATURE_ID id, HALMAC_CMD_PROCESS_STATUS status) ++{ ++ switch (id) { ++ case HALMAC_FEATURE_CFG_PARA: ++ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); ++ break; ++ case HALMAC_FEATURE_DUMP_PHYSICAL_EFUSE: ++ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); ++ if (HALMAC_CMD_PROCESS_DONE != status) { ++ RTW_INFO("%s: id(%d) unspecified status(%d)!\n", ++ __FUNCTION__, id, status); ++ } ++ break; ++ case HALMAC_FEATURE_DUMP_LOGICAL_EFUSE: ++ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); ++ if (HALMAC_CMD_PROCESS_DONE != status) { ++ RTW_INFO("%s: id(%d) unspecified status(%d)!\n", ++ __FUNCTION__, id, status); ++ } ++ break; ++ case HALMAC_FEATURE_UPDATE_PACKET: ++ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); ++ break; ++ case HALMAC_FEATURE_UPDATE_DATAPACK: ++ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); ++ break; ++ case HALMAC_FEATURE_RUN_DATAPACK: ++ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); ++ break; ++ case HALMAC_FEATURE_CHANNEL_SWITCH: ++ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); ++ break; ++ case HALMAC_FEATURE_IQK: ++ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); ++ break; ++ case HALMAC_FEATURE_POWER_TRACKING: ++ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); ++ break; ++ case HALMAC_FEATURE_PSD: ++ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); ++ break; ++ case HALMAC_FEATURE_ALL: ++ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); ++ break; ++ default: ++ RTW_INFO("%s: unknown feature id(%d)\n", __FUNCTION__, id); ++ return _FALSE; ++ } ++ ++ return _TRUE; ++} ++ ++static int init_halmac_event_with_waittime(struct dvobj_priv *d, HALMAC_FEATURE_ID id, u8 *buf, u32 size, u32 time) ++{ ++ struct submit_ctx *sctx; ++ ++ ++ if (!d->hmpriv.indicator[id].sctx) { ++ sctx = (struct submit_ctx *)rtw_zmalloc(sizeof(*sctx)); ++ if (!sctx) ++ return -1; ++ } else { ++ RTW_INFO("%s: id(%d) sctx is not NULL!!\n", __FUNCTION__, id); ++ sctx = d->hmpriv.indicator[id].sctx; ++ d->hmpriv.indicator[id].sctx = NULL; ++ } ++ ++ rtw_sctx_init(sctx, time); ++ d->hmpriv.indicator[id].buffer = buf; ++ d->hmpriv.indicator[id].buf_size = size; ++ d->hmpriv.indicator[id].ret_size = 0; ++ d->hmpriv.indicator[id].status = 0; ++ /* fill sctx at least to sure other variables are all ready! */ ++ d->hmpriv.indicator[id].sctx = sctx; ++ ++ return 0; ++} ++ ++static inline int init_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id, u8 *buf, u32 size) ++{ ++ return init_halmac_event_with_waittime(d, id, buf, size, DEFAULT_INDICATOR_TIMELMT); ++} ++ ++static void free_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id) ++{ ++ struct submit_ctx *sctx; ++ ++ ++ if (!d->hmpriv.indicator[id].sctx) ++ return; ++ ++ sctx = d->hmpriv.indicator[id].sctx; ++ d->hmpriv.indicator[id].sctx = NULL; ++ rtw_mfree((u8 *)sctx, sizeof(*sctx)); ++} ++ ++static int wait_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id) ++{ ++ struct submit_ctx *sctx; ++ int ret; ++ ++ ++ sctx = d->hmpriv.indicator[id].sctx; ++ if (!sctx) ++ return -1; ++ ++ ret = rtw_sctx_wait(sctx, RTW_HALMAC_FEATURE_NAME[id]); ++ free_halmac_event(d, id); ++ if (_SUCCESS == ret) ++ return 0; ++ ++ return -1; ++} ++ ++/* ++ * Return: ++ * Always return _TRUE, HALMAC don't care the return value. ++ */ ++static u8 _halmac_event_indication(void *p, HALMAC_FEATURE_ID feature_id, HALMAC_CMD_PROCESS_STATUS process_status, u8 *buf, u32 size) ++{ ++ struct dvobj_priv *d; ++ PADAPTER adapter; ++ PHAL_DATA_TYPE hal; ++ struct halmac_indicator *tbl, *indicator; ++ struct submit_ctx *sctx; ++ u32 cpsz; ++ u8 ret; ++ ++ ++ d = (struct dvobj_priv *)p; ++ adapter = d->padapters[IFACE_ID0]; ++ hal = GET_HAL_DATA(adapter); ++ tbl = d->hmpriv.indicator; ++ ++ ret = is_valid_id_status(feature_id, process_status); ++ if (_FALSE == ret) ++ goto exit; ++ ++ indicator = &tbl[feature_id]; ++ indicator->status = process_status; ++ indicator->ret_size = size; ++ if (!indicator->sctx) { ++ RTW_INFO("%s: No feature id(%d) waiting!!\n", __FUNCTION__, feature_id); ++ goto exit; ++ } ++ sctx = indicator->sctx; ++ ++ if (HALMAC_CMD_PROCESS_ERROR == process_status) { ++ RTW_INFO("%s: Something wrong id(%d)!!\n", __FUNCTION__, feature_id); ++ rtw_sctx_done_err(&sctx, RTW_SCTX_DONE_UNKNOWN); ++ goto exit; ++ } ++ ++ if (size > indicator->buf_size) { ++ RTW_INFO("%s: id(%d) buffer is not enough(%d<%d), data will be truncated!\n", ++ __FUNCTION__, feature_id, indicator->buf_size, size); ++ cpsz = indicator->buf_size; ++ } else ++ cpsz = size; ++ if (cpsz && indicator->buffer) ++ _rtw_memcpy(indicator->buffer, buf, cpsz); ++ ++ rtw_sctx_done(&sctx); ++ ++exit: ++ return _TRUE; ++} ++ ++HALMAC_PLATFORM_API rtw_halmac_platform_api = { ++ /* R/W register */ ++#ifdef CONFIG_SDIO_HCI ++ .SDIO_CMD52_READ = _halmac_sdio_cmd52_read, ++ .SDIO_CMD53_READ_8 = _halmac_sdio_reg_read_8, ++ .SDIO_CMD53_READ_16 = _halmac_sdio_reg_read_16, ++ .SDIO_CMD53_READ_32 = _halmac_sdio_reg_read_32, ++ .SDIO_CMD53_READ_N = _halmac_sdio_reg_read_n, ++ .SDIO_CMD52_WRITE = _halmac_sdio_cmd52_write, ++ .SDIO_CMD53_WRITE_8 = _halmac_sdio_reg_write_8, ++ .SDIO_CMD53_WRITE_16 = _halmac_sdio_reg_write_16, ++ .SDIO_CMD53_WRITE_32 = _halmac_sdio_reg_write_32, ++ ++#endif /* CONFIG_SDIO_HCI */ ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCIE_HCI) ++ .REG_READ_8 = _halmac_reg_read_8, ++ .REG_READ_16 = _halmac_reg_read_16, ++ .REG_READ_32 = _halmac_reg_read_32, ++ .REG_WRITE_8 = _halmac_reg_write_8, ++ .REG_WRITE_16 = _halmac_reg_write_16, ++ .REG_WRITE_32 = _halmac_reg_write_32, ++#endif /* CONFIG_USB_HCI || CONFIG_PCIE_HCI */ ++ ++ /* Write data */ ++#if 0 ++ /* impletement in HAL-IC level */ ++ .SEND_RSVD_PAGE = sdio_write_data_rsvd_page, ++ .SEND_H2C_PKT = sdio_write_data_h2c, ++#endif ++ /* Memory allocate */ ++ .RTL_FREE = _halmac_mfree, ++ .RTL_MALLOC = _halmac_malloc, ++ .RTL_MEMCPY = _halmac_memcpy, ++ .RTL_MEMSET = _halmac_memset, ++ ++ /* Sleep */ ++ .RTL_DELAY_US = _halmac_udelay, ++ ++ /* Process Synchronization */ ++ .MUTEX_INIT = _halmac_mutex_init, ++ .MUTEX_DEINIT = _halmac_mutex_deinit, ++ .MUTEX_LOCK = _halmac_mutex_lock, ++ .MUTEX_UNLOCK = _halmac_mutex_unlock, ++ ++ .MSG_PRINT = _halmac_msg_print, ++ .BUFF_PRINT = _halmac_buff_print, ++ .EVENT_INDICATION = _halmac_event_indication, ++}; ++ ++u8 rtw_halmac_read8(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ ++ ++ /* WARNING: pintf_dev should not be null! */ ++ mac = dvobj_to_halmac(pintfhdl->pintf_dev); ++ api = HALMAC_GET_API(mac); ++ ++ return api->halmac_reg_read_8(mac, addr); ++} ++ ++u16 rtw_halmac_read16(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ ++ ++ /* WARNING: pintf_dev should not be null! */ ++ mac = dvobj_to_halmac(pintfhdl->pintf_dev); ++ api = HALMAC_GET_API(mac); ++ ++ return api->halmac_reg_read_16(mac, addr); ++} ++ ++u32 rtw_halmac_read32(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ ++ ++ /* WARNING: pintf_dev should not be null! */ ++ mac = dvobj_to_halmac(pintfhdl->pintf_dev); ++ api = HALMAC_GET_API(mac); ++ ++ return api->halmac_reg_read_32(mac, addr); ++} ++ ++void rtw_halmac_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem) ++{ ++#if defined(CONFIG_SDIO_HCI) ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ ++ if (pmem == NULL) { ++ RTW_ERR("pmem is NULL\n"); ++ return; ++ } ++ /* WARNING: pintf_dev should not be null! */ ++ mac = dvobj_to_halmac(pintfhdl->pintf_dev); ++ api = HALMAC_GET_API(mac); ++ ++ api->halmac_reg_sdio_cmd53_read_n(mac, addr, cnt, pmem); ++#endif ++} ++ ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++u8 rtw_halmac_iread8(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ ++ /* WARNING: pintf_dev should not be null! */ ++ mac = dvobj_to_halmac(pintfhdl->pintf_dev); ++ api = HALMAC_GET_API(mac); ++ ++ /*return api->halmac_reg_read_indirect_8(mac, addr);*/ ++ return api->halmac_reg_read_8(mac, addr); ++} ++ ++u16 rtw_halmac_iread16(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ u16 val16 = 0; ++ ++ /* WARNING: pintf_dev should not be null! */ ++ mac = dvobj_to_halmac(pintfhdl->pintf_dev); ++ api = HALMAC_GET_API(mac); ++ ++ /*return api->halmac_reg_read_indirect_16(mac, addr);*/ ++ return api->halmac_reg_read_16(mac, addr); ++} ++ ++u32 rtw_halmac_iread32(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ ++ ++ /* WARNING: pintf_dev should not be null! */ ++ mac = dvobj_to_halmac(pintfhdl->pintf_dev); ++ api = HALMAC_GET_API(mac); ++ ++ return api->halmac_reg_read_indirect_32(mac, addr); ++} ++#endif ++ ++int rtw_halmac_write8(struct intf_hdl *pintfhdl, u32 addr, u8 value) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ ++ ++ /* WARNING: pintf_dev should not be null! */ ++ mac = dvobj_to_halmac(pintfhdl->pintf_dev); ++ api = HALMAC_GET_API(mac); ++ ++ status = api->halmac_reg_write_8(mac, addr, value); ++ ++ if (status == HALMAC_RET_SUCCESS) ++ return 0; ++ ++ return -1; ++} ++ ++int rtw_halmac_write16(struct intf_hdl *pintfhdl, u32 addr, u16 value) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ ++ ++ /* WARNING: pintf_dev should not be null! */ ++ mac = dvobj_to_halmac(pintfhdl->pintf_dev); ++ api = HALMAC_GET_API(mac); ++ ++ status = api->halmac_reg_write_16(mac, addr, value); ++ ++ if (status == HALMAC_RET_SUCCESS) ++ return 0; ++ ++ return -1; ++} ++ ++int rtw_halmac_write32(struct intf_hdl *pintfhdl, u32 addr, u32 value) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ ++ ++ /* WARNING: pintf_dev should not be null! */ ++ mac = dvobj_to_halmac(pintfhdl->pintf_dev); ++ api = HALMAC_GET_API(mac); ++ ++ status = api->halmac_reg_write_32(mac, addr, value); ++ ++ if (status == HALMAC_RET_SUCCESS) ++ return 0; ++ ++ return -1; ++} ++ ++static int init_priv(struct halmacpriv *priv) ++{ ++ struct halmac_indicator *indicator; ++ u32 count, size; ++ ++ ++ size = sizeof(*priv); ++ _rtw_memset(priv, 0, size); ++ ++ count = HALMAC_FEATURE_ALL + 1; ++ size = sizeof(*indicator) * count; ++ indicator = (struct halmac_indicator *)rtw_zmalloc(size); ++ if (!indicator) ++ return -1; ++ priv->indicator = indicator; ++ ++ return 0; ++} ++ ++static void deinit_priv(struct halmacpriv *priv) ++{ ++ struct halmac_indicator *indicator; ++ ++ ++ indicator = priv->indicator; ++ priv->indicator = NULL; ++ if (indicator) { ++ u32 count, size; ++ ++ count = HALMAC_FEATURE_ALL + 1; ++#ifdef CONFIG_RTW_DEBUG ++ { ++ struct submit_ctx *sctx; ++ u32 i; ++ ++ for (i = 0; i < count; i++) { ++ if (!indicator[i].sctx) ++ continue; ++ ++ RTW_INFO("%s: %s id(%d) sctx still exist!!\n", ++ __FUNCTION__, RTW_HALMAC_FEATURE_NAME[i], i); ++ sctx = indicator[i].sctx; ++ indicator[i].sctx = NULL; ++ rtw_mfree((u8 *)sctx, sizeof(*sctx)); ++ } ++ } ++#endif /* !CONFIG_RTW_DEBUG */ ++ size = sizeof(*indicator) * count; ++ rtw_mfree((u8 *)indicator, size); ++ } ++} ++ ++int rtw_halmac_init_adapter(struct dvobj_priv *d, PHALMAC_PLATFORM_API pf_api) ++{ ++ PHALMAC_ADAPTER halmac; ++ PHALMAC_API api; ++ HALMAC_INTERFACE intf; ++ HALMAC_RET_STATUS status; ++ int err = 0; ++ ++ ++ halmac = dvobj_to_halmac(d); ++ if (halmac) { ++ err = 0; ++ goto out; ++ } ++ ++ err = init_priv(&d->hmpriv); ++ if (err) ++ goto out; ++ ++#ifdef CONFIG_SDIO_HCI ++ intf = HALMAC_INTERFACE_SDIO; ++#elif defined(CONFIG_USB_HCI) ++ intf = HALMAC_INTERFACE_USB; ++#elif defined(CONFIG_PCIE_HCI) ++ intf = HALMAC_INTERFACE_PCIE; ++#else ++#warning "INTERFACE(CONFIG_XXX_HCI) not be defined!!" ++ intf = HALMAC_INTERFACE_UNDEFINE; ++#endif ++ status = halmac_init_adapter(d, pf_api, intf, &halmac, &api); ++ if (HALMAC_RET_SUCCESS != status) { ++ RTW_INFO("%s: halmac_init_adapter fail!(status=%d)\n", __FUNCTION__, status); ++ err = -1; ++ goto out; ++ } ++ ++ dvobj_set_halmac(d, halmac); ++ ++out: ++ if (err) ++ rtw_halmac_deinit_adapter(d); ++ ++ return err; ++} ++ ++int rtw_halmac_deinit_adapter(struct dvobj_priv *d) ++{ ++ PHALMAC_ADAPTER halmac; ++ HALMAC_RET_STATUS status; ++ int err = 0; ++ ++ ++ halmac = dvobj_to_halmac(d); ++ if (!halmac) { ++ err = 0; ++ goto out; ++ } ++ ++ deinit_priv(&d->hmpriv); ++ ++ status = halmac_deinit_adapter(halmac); ++ dvobj_set_halmac(d, NULL); ++ if (status != HALMAC_RET_SUCCESS) { ++ err = -1; ++ goto out; ++ } ++ ++out: ++ return err; ++} ++ ++int rtw_halmac_poweron(struct dvobj_priv *d) ++{ ++ PHALMAC_ADAPTER halmac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ int err = -1; ++ ++ ++ halmac = dvobj_to_halmac(d); ++ if (!halmac) ++ goto out; ++ ++ api = HALMAC_GET_API(halmac); ++ ++ status = api->halmac_pre_init_system_cfg(halmac); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ status = api->halmac_mac_power_switch(halmac, HALMAC_MAC_POWER_ON); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ status = api->halmac_init_system_cfg(halmac); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ err = 0; ++out: ++ return err; ++} ++ ++int rtw_halmac_poweroff(struct dvobj_priv *d) ++{ ++ PHALMAC_ADAPTER halmac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ int err = -1; ++ ++ ++ halmac = dvobj_to_halmac(d); ++ if (!halmac) ++ goto out; ++ ++ api = HALMAC_GET_API(halmac); ++ ++ status = api->halmac_mac_power_switch(halmac, HALMAC_MAC_POWER_OFF); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ err = 0; ++out: ++ return err; ++} ++ ++/* ++ * Note: ++ * When this function return, the register REG_RCR may be changed. ++ */ ++int rtw_halmac_config_rx_info(struct dvobj_priv *d, HALMAC_DRV_INFO info) ++{ ++ PHALMAC_ADAPTER halmac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ int err = -1; ++ ++ ++ halmac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(halmac); ++ ++ status = api->halmac_cfg_drv_info(halmac, info); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ err = 0; ++out: ++ return err; ++} ++ ++#ifdef CONFIG_SUPPORT_TRX_SHARED ++static inline HALMAC_RX_FIFO_EXPANDING_MODE _trx_share_mode_drv2halmac(u8 trx_share_mode) ++{ ++ if (0 == trx_share_mode) ++ return HALMAC_RX_FIFO_EXPANDING_MODE_DISABLE; ++ else if (1 == trx_share_mode) ++ return HALMAC_RX_FIFO_EXPANDING_MODE_1_BLOCK; ++ else if (2 == trx_share_mode) ++ return HALMAC_RX_FIFO_EXPANDING_MODE_2_BLOCK; ++ else if (3 == trx_share_mode) ++ return HALMAC_RX_FIFO_EXPANDING_MODE_3_BLOCK; ++ else ++ return HALMAC_RX_FIFO_EXPANDING_MODE_DISABLE; ++} ++static HALMAC_RX_FIFO_EXPANDING_MODE _rtw_get_trx_share_mode(_adapter *adapter) ++{ ++ struct registry_priv *registry_par = &adapter->registrypriv; ++ ++ return _trx_share_mode_drv2halmac(registry_par->trx_share_mode); ++} ++void dump_trx_share_mode(void *sel, _adapter *adapter) ++{ ++ struct registry_priv *registry_par = &adapter->registrypriv; ++ u8 mode = _trx_share_mode_drv2halmac(registry_par->trx_share_mode); ++ ++ if (HALMAC_RX_FIFO_EXPANDING_MODE_1_BLOCK == mode) ++ RTW_PRINT_SEL(sel, "TRx share mode : %s\n", "RX_FIFO_EXPANDING_MODE_1"); ++ else if (HALMAC_RX_FIFO_EXPANDING_MODE_2_BLOCK == mode) ++ RTW_PRINT_SEL(sel, "TRx share mode : %s\n", "RX_FIFO_EXPANDING_MODE_2"); ++ else if (HALMAC_RX_FIFO_EXPANDING_MODE_3_BLOCK == mode) ++ RTW_PRINT_SEL(sel, "TRx share mode : %s\n", "RX_FIFO_EXPANDING_MODE_3"); ++ else ++ RTW_PRINT_SEL(sel, "TRx share mode : %s\n", "DISABLE"); ++} ++#endif ++ ++static HALMAC_RET_STATUS init_mac_flow(struct dvobj_priv *d) ++{ ++ PADAPTER p; ++ PHALMAC_ADAPTER halmac; ++ PHALMAC_API api; ++ HALMAC_WLAN_ADDR hwa; ++ HALMAC_RET_STATUS status; ++ u8 wifi_test = 0; ++ u8 nettype; ++ int err; ++ ++ ++ p = d->padapters[IFACE_ID0]; ++ halmac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(halmac); ++ if (p->registrypriv.wifi_spec) ++ wifi_test = 1; ++ ++#ifdef CONFIG_SUPPORT_TRX_SHARED ++ status = api->halmac_cfg_rx_fifo_expanding_mode(halmac, _rtw_get_trx_share_mode(p)); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++#endif ++ ++#if 0 ++ status = api->halmac_cfg_drv_rsvd_pg_num(halmac, HALMAC_RSVD_PG_NUM16);/*HALMAC_RSVD_PG_NUM24/HALMAC_RSVD_PG_NUM32*/ ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ status = api->halmac_set_bulkout_num(halmac, d->RtNumOutPipes); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++#endif /* CONFIG_USB_HCI */ ++ ++ if (wifi_test) ++ status = api->halmac_init_mac_cfg(halmac, HALMAC_TRX_MODE_WMM); ++ else ++ status = api->halmac_init_mac_cfg(halmac, HALMAC_TRX_MODE_NORMAL); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ err = rtw_halmac_rx_agg_switch(d, _TRUE); ++ if (err) ++ goto out; ++ ++ nettype = dvobj_to_regsty(d)->wireless_mode; ++ if (IsSupportedVHT(nettype) == _TRUE) ++ status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_AC); ++ else if (IsSupportedHT(nettype) == _TRUE) ++ status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_N); ++ else if (IsSupportedTxOFDM(nettype) == _TRUE) ++ status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_G); ++ else ++ status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_B); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++out: ++ return status; ++} ++ ++static inline HALMAC_RF_TYPE _rf_type_drv2halmac(RT_RF_TYPE_DEF_E rf_drv) ++{ ++ HALMAC_RF_TYPE rf_mac; ++ ++ ++ switch (rf_drv) { ++ case RF_1T2R: ++ rf_mac = HALMAC_RF_1T2R; ++ break; ++ case RF_2T4R: ++ rf_mac = HALMAC_RF_2T4R; ++ break; ++ case RF_2T2R: ++ rf_mac = HALMAC_RF_2T2R; ++ break; ++ case RF_1T1R: ++ rf_mac = HALMAC_RF_1T1R; ++ break; ++ case RF_2T2R_GREEN: ++ rf_mac = HALMAC_RF_2T2R_GREEN; ++ break; ++ case RF_2T3R: ++ rf_mac = HALMAC_RF_2T3R; ++ break; ++ case RF_3T3R: ++ rf_mac = HALMAC_RF_3T3R; ++ break; ++ case RF_3T4R: ++ rf_mac = HALMAC_RF_3T4R; ++ break; ++ case RF_4T4R: ++ rf_mac = HALMAC_RF_4T4R; ++ break; ++ default: ++ rf_mac = (HALMAC_RF_TYPE)rf_drv; ++ break; ++ } ++ ++ return rf_mac; ++} ++ ++static int _send_general_info(struct dvobj_priv *d) ++{ ++ PADAPTER adapter; ++ PHAL_DATA_TYPE hal; ++ PHALMAC_ADAPTER halmac; ++ PHALMAC_API api; ++ HALMAC_GENERAL_INFO info; ++ HALMAC_RET_STATUS status; ++ u8 val8; ++ ++ ++ adapter = d->padapters[IFACE_ID0]; ++ hal = GET_HAL_DATA(adapter); ++ halmac = dvobj_to_halmac(d); ++ if (!halmac) ++ return -1; ++ api = HALMAC_GET_API(halmac); ++ ++ _rtw_memset(&info, 0, sizeof(info)); ++ info.rfe_type = (u8)hal->RFEType; ++ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, &val8); ++ info.rf_type = _rf_type_drv2halmac(val8); ++ ++ status = api->halmac_send_general_info(halmac, &info); ++ switch (status) { ++ case HALMAC_RET_SUCCESS: ++ break; ++ case HALMAC_RET_NO_DLFW: ++ RTW_WARN("%s: halmac_send_general_info() fail because fw not dl!\n", ++ __FUNCTION__); ++ /* go through */ ++ default: ++ return -1; ++ } ++ ++ return 0; ++} ++ ++/* ++ * Notices: ++ * Make sure ++ * 1. rtw_hal_get_hwreg(HW_VAR_RF_TYPE) ++ * 2. HAL_DATA_TYPE.rfe_type ++ * already ready for use before calling this function. ++ */ ++static int _halmac_init_hal(struct dvobj_priv *d, u8 *fw, u32 fwsize) ++{ ++ PADAPTER adapter; ++ PHALMAC_ADAPTER halmac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ u32 ok = _TRUE; ++ u8 fw_ok = _FALSE; ++ int err, err_ret = -1; ++ ++ ++ adapter = d->padapters[IFACE_ID0]; ++ halmac = dvobj_to_halmac(d); ++ if (!halmac) ++ goto out; ++ api = HALMAC_GET_API(halmac); ++ ++ /* StatePowerOff */ ++ ++ /* SKIP: halmac_init_adapter (Already done before) */ ++ ++ /* halmac_pre_Init_system_cfg */ ++ /* halmac_mac_power_switch(on) */ ++ /* halmac_Init_system_cfg */ ++ ok = rtw_hal_power_on(adapter); ++ if (_FALSE == ok) ++ goto out; ++ ++ /* StatePowerOn */ ++ ++ /* DownloadFW */ ++ d->hmpriv.send_general_info = 0; ++ if (fw && fwsize) { ++ err = rtw_halmac_dlfw(d, fw, fwsize); ++ if (err) ++ goto out; ++ fw_ok = _TRUE; ++ } ++ ++ /* InitMACFlow */ ++ status = init_mac_flow(d); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ /* halmac_send_general_info */ ++ if (_TRUE == fw_ok) { ++ d->hmpriv.send_general_info = 0; ++ err = _send_general_info(d); ++ if (err) ++ goto out; ++ } else ++ d->hmpriv.send_general_info = 1; ++ ++ /* Init Phy parameter-MAC */ ++ ok = rtw_hal_init_mac_register(adapter); ++ if (_FALSE == ok) ++ goto out; ++ ++ /* StateMacInitialized */ ++ ++ /* halmac_cfg_drv_info */ ++ err = rtw_halmac_config_rx_info(d, HALMAC_DRV_INFO_PHY_STATUS); ++ if (err) ++ goto out; ++ ++ /* halmac_set_hw_value(HALMAC_HW_EN_BB_RF) */ ++ /* Init BB, RF */ ++ ok = rtw_hal_init_phy(adapter); ++ if (_FALSE == ok) ++ goto out; ++ ++ status = api->halmac_init_interface_cfg(halmac); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ /* SKIP: halmac_verify_platform_api */ ++ /* SKIP: halmac_h2c_lb */ ++ ++ /* StateRxIdle */ ++ ++ err_ret = 0; ++out: ++ return err_ret; ++} ++ ++int rtw_halmac_init_hal(struct dvobj_priv *d) ++{ ++ return _halmac_init_hal(d, NULL, 0); ++} ++ ++/* ++ * Notices: ++ * Make sure ++ * 1. rtw_hal_get_hwreg(HW_VAR_RF_TYPE) ++ * 2. HAL_DATA_TYPE.rfe_type ++ * already ready for use before calling this function. ++ */ ++int rtw_halmac_init_hal_fw(struct dvobj_priv *d, u8 *fw, u32 fwsize) ++{ ++ return _halmac_init_hal(d, fw, fwsize); ++} ++ ++/* ++ * Notices: ++ * Make sure ++ * 1. rtw_hal_get_hwreg(HW_VAR_RF_TYPE) ++ * 2. HAL_DATA_TYPE.rfe_type ++ * already ready for use before calling this function. ++ */ ++int rtw_halmac_init_hal_fw_file(struct dvobj_priv *d, u8 *fwpath) ++{ ++ u8 *fw = NULL; ++ u32 fwmaxsize, size = 0; ++ int err = 0; ++ ++ ++ fwmaxsize = FIRMWARE_MAX_SIZE; ++ fw = rtw_zmalloc(fwmaxsize); ++ if (!fw) ++ return -1; ++ ++ size = rtw_retrieve_from_file(fwpath, fw, fwmaxsize); ++ if (!size) { ++ err = -1; ++ goto exit; ++ } ++ ++ err = _halmac_init_hal(d, fw, size); ++ ++exit: ++ rtw_mfree(fw, fwmaxsize); ++ fw = NULL; ++ ++ return err; ++} ++ ++int rtw_halmac_deinit_hal(struct dvobj_priv *d) ++{ ++ PADAPTER adapter; ++ PHALMAC_ADAPTER halmac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ int err = -1; ++ ++ ++ adapter = d->padapters[IFACE_ID0]; ++ halmac = dvobj_to_halmac(d); ++ if (!halmac) ++ goto out; ++ api = HALMAC_GET_API(halmac); ++ ++ status = api->halmac_deinit_interface_cfg(halmac); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ rtw_hal_power_off(adapter); ++ ++ err = 0; ++out: ++ return err; ++} ++ ++int rtw_halmac_self_verify(struct dvobj_priv *d) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ int err = -1; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ status = api->halmac_verify_platform_api(mac); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ status = api->halmac_h2c_lb(mac); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ err = 0; ++out: ++ return err; ++} ++ ++int rtw_halmac_dlfw(struct dvobj_priv *d, u8 *fw, u32 fwsize) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ int err = 0; ++ PHAL_DATA_TYPE hal; ++ HALMAC_FW_VERSION fw_vesion; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ hal = GET_HAL_DATA(d->padapters[IFACE_ID0]); ++ ++ if ((!fw) || (!fwsize)) ++ return -1; ++ ++ /* 1. Driver Stop Tx */ ++ /* ToDo */ ++ ++ /* 2. Driver Check Tx FIFO is empty */ ++ /* ToDo */ ++ ++ /* 3. Config MAX download size */ ++#ifdef CONFIG_USB_HCI ++ /* for USB do not exceed MAX_CMDBUF_SZ */ ++ api->halmac_cfg_max_dl_size(mac, 0x1000); ++#elif defined CONFIG_PCIE_HCI ++ /* required a even length from u32 */ ++ api->halmac_cfg_max_dl_size(mac, (MAX_CMDBUF_SZ - TXDESC_OFFSET) & 0xFFFFFFFE); ++#endif ++ ++ /* 4. Download Firmware */ ++ status = api->halmac_download_firmware(mac, fw, fwsize); ++ if (HALMAC_RET_SUCCESS != status) ++ return -1; ++ ++ if (d->hmpriv.send_general_info) { ++ d->hmpriv.send_general_info = 0; ++ err = _send_general_info(d); ++ } ++ ++ /* 5. Driver resume TX if needed */ ++ /* ToDo */ ++ ++ /* 6. Reset driver variables if needed */ ++ hal->LastHMEBoxNum = 0; ++ ++ ++ /* 7. Get FW version */ ++ status = api->halmac_get_fw_version(mac, &fw_vesion); ++ if (status == HALMAC_RET_SUCCESS) { ++ hal->FirmwareVersion = fw_vesion.version; ++ hal->FirmwareSubVersion = fw_vesion.sub_version; ++ } ++ ++ return err; ++} ++ ++int rtw_halmac_dlfw_from_file(struct dvobj_priv *d, u8 *fwpath) ++{ ++ u8 *fw = NULL; ++ u32 fwmaxsize, size = 0; ++ int err = 0; ++ ++ ++ fwmaxsize = FIRMWARE_MAX_SIZE; ++ fw = rtw_zmalloc(fwmaxsize); ++ if (!fw) ++ return -1; ++ ++ size = rtw_retrieve_from_file(fwpath, fw, fwmaxsize); ++ if (size) ++ err = rtw_halmac_dlfw(d, fw, size); ++ else ++ err = -1; ++ ++ rtw_mfree(fw, fwmaxsize); ++ fw = NULL; ++ ++ return err; ++} ++ ++/* ++ * Description: ++ * Power on/off BB/RF domain. ++ * ++ * Parameters: ++ * enable _TRUE/_FALSE for power on/off ++ * ++ * Return: ++ * 0 Success ++ * others Fail ++ */ ++int rtw_halmac_phy_power_switch(struct dvobj_priv *d, u8 enable) ++{ ++ PADAPTER adapter; ++ PHALMAC_ADAPTER halmac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ ++ ++ adapter = d->padapters[IFACE_ID0]; ++ halmac = dvobj_to_halmac(d); ++ if (!halmac) ++ return -1; ++ api = HALMAC_GET_API(halmac); ++ ++ status = api->halmac_set_hw_value(halmac, HALMAC_HW_EN_BB_RF, &enable); ++ if (status != HALMAC_RET_SUCCESS) ++ return -1; ++ ++ return 0; ++} ++ ++static u8 _is_fw_read_cmd_down(PADAPTER adapter, u8 msgbox_num) ++{ ++ u8 read_down = _FALSE; ++ int retry_cnts = 100; ++ u8 valid; ++ ++ /* RTW_INFO("_is_fw_read_cmd_down, reg_1cc(%x), msg_box(%d)...\n", rtw_read8(adapter, REG_HMETFR), msgbox_num); */ ++ ++ do { ++ valid = rtw_read8(adapter, REG_HMETFR) & BIT(msgbox_num); ++ if (0 == valid) ++ read_down = _TRUE; ++ else ++ rtw_msleep_os(1); ++ } while ((!read_down) && (retry_cnts--)); ++ ++ return read_down; ++} ++ ++int rtw_halmac_send_h2c(struct dvobj_priv *d, u8 *h2c) ++{ ++ PADAPTER adapter = d->padapters[IFACE_ID0]; ++ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); ++ u8 h2c_box_num = 0; ++ u32 msgbox_addr = 0; ++ u32 msgbox_ex_addr = 0; ++ u32 h2c_cmd = 0; ++ u32 h2c_cmd_ex = 0; ++ s32 ret = _FAIL; ++ ++ if (adapter->bFWReady == _FALSE) { ++ RTW_INFO("%s: return H2C cmd because fw is not ready\n", __FUNCTION__); ++ return ret; ++ } ++ ++ if (!h2c) { ++ RTW_INFO("%s: pbuf is NULL\n", __FUNCTION__); ++ return ret; ++ } ++ ++ if (rtw_is_surprise_removed(adapter)) { ++ RTW_INFO("%s: surprise removed\n", __FUNCTION__); ++ return ret; ++ } ++ ++ _enter_critical_mutex(&d->h2c_fwcmd_mutex, NULL); ++ ++ /* pay attention to if race condition happened in H2C cmd setting */ ++ h2c_box_num = hal->LastHMEBoxNum; ++ ++ if (!_is_fw_read_cmd_down(adapter, h2c_box_num)) { ++ RTW_INFO(" fw read cmd failed...\n"); ++ goto exit; ++ } ++ ++ /* Write Ext command(byte 4 -7) */ ++ msgbox_ex_addr = REG_HMEBOX_E0 + (h2c_box_num * EX_MESSAGE_BOX_SIZE); ++ _rtw_memcpy((u8 *)(&h2c_cmd_ex), h2c + 4, EX_MESSAGE_BOX_SIZE); ++ h2c_cmd_ex = le32_to_cpu(h2c_cmd_ex); ++ rtw_write32(adapter, msgbox_ex_addr, h2c_cmd_ex); ++ ++ /* Write command (byte 0 -3 ) */ ++ msgbox_addr = REG_HMEBOX0 + (h2c_box_num * MESSAGE_BOX_SIZE); ++ _rtw_memcpy((u8 *)(&h2c_cmd), h2c, 4); ++ h2c_cmd = le32_to_cpu(h2c_cmd); ++ rtw_write32(adapter, msgbox_addr, h2c_cmd); ++ ++ /* update last msg box number */ ++ hal->LastHMEBoxNum = (h2c_box_num + 1) % MAX_H2C_BOX_NUMS; ++ ret = _SUCCESS; ++ ++exit: ++ _exit_critical_mutex(&d->h2c_fwcmd_mutex, NULL); ++ return ret; ++} ++ ++int rtw_halmac_c2h_handle(struct dvobj_priv *d, u8 *c2h, u32 size) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ status = api->halmac_get_c2h_info(mac, c2h, size); ++ if (HALMAC_RET_SUCCESS != status) ++ return -1; ++ ++ return 0; ++} ++ ++int rtw_halmac_get_physical_efuse_size(struct dvobj_priv *d, u32 *size) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ u32 val; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ status = api->halmac_get_efuse_size(mac, &val); ++ if (HALMAC_RET_SUCCESS != status) ++ return -1; ++ ++ *size = val; ++ return 0; ++} ++ ++int rtw_halmac_read_physical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ HALMAC_FEATURE_ID id; ++ int ret; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ id = HALMAC_FEATURE_DUMP_PHYSICAL_EFUSE; ++ ++ ret = init_halmac_event(d, id, map, size); ++ if (ret) ++ return -1; ++ ++ status = api->halmac_dump_efuse_map(mac, HALMAC_EFUSE_R_AUTO); ++ if (HALMAC_RET_SUCCESS != status) { ++ free_halmac_event(d, id); ++ return -1; ++ } ++ ++ ret = wait_halmac_event(d, id); ++ if (ret) ++ return -1; ++ ++ return 0; ++} ++ ++int rtw_halmac_read_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ u8 v; ++ u32 i; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ for (i = 0; i < cnt; i++) { ++ status = api->halmac_read_efuse(mac, offset + i, &v); ++ if (HALMAC_RET_SUCCESS != status) ++ return -1; ++ data[i] = v; ++ } ++ ++ return 0; ++} ++ ++int rtw_halmac_write_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ u32 i; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ for (i = 0; i < cnt; i++) { ++ status = api->halmac_write_efuse(mac, offset + i, data[i]); ++ if (HALMAC_RET_SUCCESS != status) ++ return -1; ++ } ++ ++ return 0; ++} ++ ++int rtw_halmac_get_logical_efuse_size(struct dvobj_priv *d, u32 *size) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ u32 val; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ status = api->halmac_get_logical_efuse_size(mac, &val); ++ if (HALMAC_RET_SUCCESS != status) ++ return -1; ++ ++ *size = val; ++ return 0; ++} ++ ++int rtw_halmac_read_logical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ HALMAC_FEATURE_ID id; ++ int ret; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ id = HALMAC_FEATURE_DUMP_LOGICAL_EFUSE; ++ ++ ret = init_halmac_event(d, id, map, size); ++ if (ret) ++ return -1; ++ ++ status = api->halmac_dump_logical_efuse_map(mac, HALMAC_EFUSE_R_AUTO); ++ if (HALMAC_RET_SUCCESS != status) { ++ free_halmac_event(d, id); ++ return -1; ++ } ++ ++ ret = wait_halmac_event(d, id); ++ if (ret) ++ return -1; ++ ++ return 0; ++} ++ ++int rtw_halmac_write_logical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size, u8 *maskmap, u32 masksize) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_PG_EFUSE_INFO pginfo; ++ HALMAC_RET_STATUS status; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ pginfo.pEfuse_map = map; ++ pginfo.efuse_map_size = size; ++ pginfo.pEfuse_mask = maskmap; ++ pginfo.efuse_mask_size = masksize; ++ ++ status = api->halmac_pg_efuse_by_map(mac, &pginfo, HALMAC_EFUSE_R_AUTO); ++ if (HALMAC_RET_SUCCESS != status) ++ return -1; ++ ++ return 0; ++} ++ ++int rtw_halmac_read_logical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ u8 v; ++ u32 i; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ for (i = 0; i < cnt; i++) { ++ status = api->halmac_read_logical_efuse(mac, offset + i, &v); ++ if (HALMAC_RET_SUCCESS != status) ++ return -1; ++ data[i] = v; ++ } ++ ++ return 0; ++} ++ ++int rtw_halmac_write_logical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ u32 i; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ for (i = 0; i < cnt; i++) { ++ status = api->halmac_write_logical_efuse(mac, offset + i, data[i]); ++ if (HALMAC_RET_SUCCESS != status) ++ return -1; ++ } ++ ++ return 0; ++} ++ ++int rtw_halmac_write_bt_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ u32 i; ++ u8 bank = 1; ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ for (i = 0; i < cnt; i++) { ++ status = api->halmac_write_efuse_bt(mac, offset + i, data[i], bank); ++ if (HALMAC_RET_SUCCESS != status) { ++ printk("%s: halmac_write_efuse_bt status = %d\n", __FUNCTION__, status); ++ return -1; ++ } ++ } ++ printk("%s: halmac_write_efuse_bt status = HALMAC_RET_SUCCESS %d\n", __FUNCTION__, status); ++ return 0; ++} ++ ++ ++int rtw_halmac_read_bt_physical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ HALMAC_FEATURE_ID id; ++ int ret; ++ int bank = 1; ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ status = api->halmac_dump_efuse_map_bt(mac, bank, size, map); ++ if (HALMAC_RET_SUCCESS != status) { ++ printk("%s: halmac_dump_efuse_map_bt fail!\n", __FUNCTION__); ++ return -1; ++ } ++ ++ printk("%s: OK!\n", __FUNCTION__); ++ ++ return 0; ++} ++ ++static inline u8 _hw_port_drv2halmac(enum _hw_port hwport) ++{ ++ u8 port = 0; ++ ++ ++ switch (hwport) { ++ case HW_PORT0: ++ port = 0; ++ break; ++ case HW_PORT1: ++ port = 1; ++ break; ++ case HW_PORT2: ++ port = 2; ++ break; ++ case HW_PORT3: ++ port = 3; ++ break; ++ case HW_PORT4: ++ port = 4; ++ break; ++ default: ++ port = hwport; ++ break; ++ } ++ ++ return port; ++} ++ ++int rtw_halmac_set_mac_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) ++{ ++ PHALMAC_ADAPTER halmac; ++ PHALMAC_API api; ++ u8 port; ++ HALMAC_WLAN_ADDR hwa; ++ HALMAC_RET_STATUS status; ++ int err = -1; ++ ++ ++ halmac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(halmac); ++ ++ port = _hw_port_drv2halmac(hwport); ++ _rtw_memset(&hwa, 0, sizeof(hwa)); ++ _rtw_memcpy(hwa.Address, addr, 6); ++ ++ status = api->halmac_cfg_mac_addr(halmac, port, &hwa); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ err = 0; ++out: ++ return err; ++} ++ ++int rtw_halmac_set_bssid(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) ++{ ++ PHALMAC_ADAPTER halmac; ++ PHALMAC_API api; ++ u8 port; ++ HALMAC_WLAN_ADDR hwa; ++ HALMAC_RET_STATUS status; ++ int err = -1; ++ ++ halmac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(halmac); ++ port = _hw_port_drv2halmac(hwport); ++ ++ _rtw_memset(&hwa, 0, sizeof(HALMAC_WLAN_ADDR)); ++ _rtw_memcpy(hwa.Address, addr, 6); ++ status = api->halmac_cfg_bssid(halmac, port, &hwa); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ err = 0; ++out: ++ return err; ++} ++ ++int rtw_halmac_set_bandwidth(struct dvobj_priv *d, u8 channel, u8 pri_ch_idx, u8 bw) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ status = api->halmac_cfg_ch_bw(mac, channel, pri_ch_idx, bw); ++ if (HALMAC_RET_SUCCESS != status) ++ return -1; ++ ++ return 0; ++} ++ ++int rtw_halmac_get_hw_value(struct dvobj_priv *d, HALMAC_HW_ID hw_id, VOID *pvalue) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ status = api->halmac_get_hw_value(mac, hw_id, pvalue); ++ if (HALMAC_RET_SUCCESS != status) ++ return -1; ++ ++ return 0; ++} ++ ++int rtw_halmac_dump_fifo(struct dvobj_priv *d, HAL_FIFO_SEL halmac_fifo_sel) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ u8 *pfifo_map = NULL; ++ u32 fifo_size = 0; ++ s8 ret = 0; ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ fifo_size = api->halmac_get_fifo_size(mac, halmac_fifo_sel); ++ if (fifo_size) ++ pfifo_map = rtw_vmalloc(fifo_size); ++ if (pfifo_map == NULL) ++ return -1; ++ ++ status = api->halmac_dump_fifo(mac, halmac_fifo_sel, pfifo_map, fifo_size); ++ if (HALMAC_RET_SUCCESS != status) { ++ ret = -1; ++ goto _exit; ++ } ++ ++_exit: ++ if (pfifo_map) ++ rtw_vmfree(pfifo_map, fifo_size); ++ return ret; ++ ++} ++ ++int rtw_halmac_rx_agg_switch(struct dvobj_priv *d, u8 enable) ++{ ++ PADAPTER adapter; ++ PHAL_DATA_TYPE hal; ++ PHALMAC_ADAPTER halmac; ++ PHALMAC_API api; ++ HALMAC_RXAGG_CFG rxaggcfg; ++ HALMAC_RET_STATUS status; ++ int err = -1; ++ ++ ++ adapter = d->padapters[IFACE_ID0]; ++ hal = GET_HAL_DATA(adapter); ++ halmac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(halmac); ++ _rtw_memset((void *)&rxaggcfg, 0, sizeof(rxaggcfg)); ++ ++ if (_TRUE == enable) { ++#ifdef CONFIG_SDIO_HCI ++ rxaggcfg.mode = HALMAC_RX_AGG_MODE_DMA; ++ rxaggcfg.threshold.drv_define = 0; ++#elif defined(CONFIG_USB_HCI) && defined(CONFIG_USB_RX_AGGREGATION) ++ switch (hal->rxagg_mode) { ++ case RX_AGG_DISABLE: ++ rxaggcfg.mode = HALMAC_RX_AGG_MODE_NONE; ++ break; ++ ++ case RX_AGG_DMA: ++ rxaggcfg.mode = HALMAC_RX_AGG_MODE_DMA; ++ if (hal->rxagg_dma_size || hal->rxagg_dma_timeout) { ++ rxaggcfg.threshold.drv_define = 1; ++ rxaggcfg.threshold.timeout = hal->rxagg_dma_timeout; ++ rxaggcfg.threshold.size = hal->rxagg_dma_size; ++ } ++ break; ++ ++ case RX_AGG_USB: ++ case RX_AGG_MIX: ++ rxaggcfg.mode = HALMAC_RX_AGG_MODE_USB; ++ if (hal->rxagg_usb_size || hal->rxagg_usb_timeout) { ++ rxaggcfg.threshold.drv_define = 1; ++ rxaggcfg.threshold.timeout = hal->rxagg_usb_timeout; ++ rxaggcfg.threshold.size = hal->rxagg_usb_size; ++ } ++ break; ++ } ++#endif /* CONFIG_USB_HCI */ ++ } else ++ rxaggcfg.mode = HALMAC_RX_AGG_MODE_NONE; ++ ++ status = api->halmac_cfg_rx_aggregation(halmac, &rxaggcfg); ++ if (status != HALMAC_RET_SUCCESS) ++ goto out; ++ ++ err = 0; ++out: ++ return err; ++} ++ ++int rtw_halmac_get_wow_reason(struct dvobj_priv *d, u8 *reason) ++{ ++ PADAPTER adapter; ++ u8 val8; ++ int err = -1; ++ ++ ++ adapter = d->padapters[IFACE_ID0]; ++ ++ val8 = rtw_read8(adapter, 0x1C7); ++ if (val8 == 0xEA) ++ goto out; ++ ++ *reason = val8; ++ err = 0; ++out: ++ return err; ++} ++ ++/* ++ * Description: ++ * Get RX driver info size. RX driver info is a small memory space between ++ * scriptor and RX payload. ++ * ++ * +-------------------------+ ++ * | RX descriptor | ++ * | usually 24 bytes | ++ * +-------------------------+ ++ * | RX driver info | ++ * | depends on driver cfg | ++ * +-------------------------+ ++ * | RX paylad | ++ * | | ++ * +-------------------------+ ++ * ++ * Parameter: ++ * d pointer to struct dvobj_priv of driver ++ * sz rx driver info size in bytes. ++ * ++ * Rteurn: ++ * 0 Success ++ * other Fail ++ */ ++int rtw_halmac_get_drv_info_sz(struct dvobj_priv *d, u8 *sz) ++{ ++ HALMAC_RET_STATUS status; ++ PHALMAC_ADAPTER halmac = dvobj_to_halmac(d); ++ PHALMAC_API api = HALMAC_GET_API(halmac); ++ u8 dw = 0; ++ ++ status = api->halmac_get_hw_value(halmac, HALMAC_HW_DRV_INFO_SIZE, &dw); ++ if (status != HALMAC_RET_SUCCESS) ++ return -1; ++ ++ *sz = dw * 8; ++ return 0; ++} ++int rtw_halmac_get_rsvd_drv_pg_bndy(struct dvobj_priv *dvobj, u16 *drv_pg) ++{ ++ HALMAC_RET_STATUS status; ++ PHALMAC_ADAPTER halmac = dvobj_to_halmac(dvobj); ++ PHALMAC_API api = HALMAC_GET_API(halmac); ++ ++ status = api->halmac_get_hw_value(halmac, HALMAC_HW_RSVD_PG_BNDY, drv_pg); ++ if (status != HALMAC_RET_SUCCESS) ++ return -1; ++ ++ return 0; ++} ++ ++int rtw_halmac_download_rsvd_page(struct dvobj_priv *dvobj, u8 pg_offset, u8 *pbuf, u32 size) ++{ ++ HALMAC_RET_STATUS status = HALMAC_RET_SUCCESS; ++ PHALMAC_ADAPTER halmac = dvobj_to_halmac(dvobj); ++ PHALMAC_API api = HALMAC_GET_API(halmac); ++ ++ status = api->halmac_dl_drv_rsvd_page(halmac, pg_offset, pbuf, size); ++ if (status != HALMAC_RET_SUCCESS) ++ return -1; ++ ++ return 0; ++ ++} ++ ++#ifdef CONFIG_SDIO_HCI ++ ++/* ++ * Description: ++ * Update queue allocated page number to driver ++ * ++ * Parameter: ++ * d pointer to struct dvobj_priv of driver ++ * ++ * Rteurn: ++ * 0 Success, "page" is valid. ++ * others Fail, "page" is invalid. ++ */ ++int rtw_halmac_query_tx_page_num(struct dvobj_priv *d) ++{ ++ PADAPTER adapter; ++ struct halmacpriv *hmpriv; ++ PHALMAC_ADAPTER halmac; ++ PHALMAC_API api; ++ HALMAC_RQPN_MAP rqpn; ++ HALMAC_DMA_MAPPING dmaqueue; ++ HALMAC_TXFF_ALLOCATION fifosize; ++ HALMAC_RET_STATUS status; ++ u8 i; ++ ++ ++ adapter = d->padapters[IFACE_ID0]; ++ hmpriv = &d->hmpriv; ++ halmac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(halmac); ++ _rtw_memset((void *)&rqpn, 0, sizeof(rqpn)); ++ _rtw_memset((void *)&fifosize, 0, sizeof(fifosize)); ++ ++ status = api->halmac_get_hw_value(halmac, HALMAC_HW_RQPN_MAPPING, &rqpn); ++ if (status != HALMAC_RET_SUCCESS) ++ return -1; ++ status = api->halmac_get_hw_value(halmac, HALMAC_HW_TXFF_ALLOCATION, &fifosize); ++ if (status != HALMAC_RET_SUCCESS) ++ return -1; ++ ++ for (i = 0; i < HW_QUEUE_ENTRY; i++) { ++ hmpriv->txpage[i] = 0; ++ ++ /* Driver index mapping to HALMAC DMA queue */ ++ dmaqueue = HALMAC_DMA_MAPPING_UNDEFINE; ++ switch (i) { ++ case VO_QUEUE_INX: ++ dmaqueue = rqpn.dma_map_vo; ++ break; ++ case VI_QUEUE_INX: ++ dmaqueue = rqpn.dma_map_vi; ++ break; ++ case BE_QUEUE_INX: ++ dmaqueue = rqpn.dma_map_be; ++ break; ++ case BK_QUEUE_INX: ++ dmaqueue = rqpn.dma_map_bk; ++ break; ++ case MGT_QUEUE_INX: ++ dmaqueue = rqpn.dma_map_mg; ++ break; ++ case HIGH_QUEUE_INX: ++ dmaqueue = rqpn.dma_map_hi; ++ break; ++ case BCN_QUEUE_INX: ++ case TXCMD_QUEUE_INX: ++ /* Unlimited */ ++ hmpriv->txpage[i] = 0xFFFF; ++ continue; ++ } ++ ++ switch (dmaqueue) { ++ case HALMAC_DMA_MAPPING_EXTRA: ++ hmpriv->txpage[i] = fifosize.extra_queue_pg_num; ++ break; ++ case HALMAC_DMA_MAPPING_LOW: ++ hmpriv->txpage[i] = fifosize.low_queue_pg_num; ++ break; ++ case HALMAC_DMA_MAPPING_NORMAL: ++ hmpriv->txpage[i] = fifosize.normal_queue_pg_num; ++ break; ++ case HALMAC_DMA_MAPPING_HIGH: ++ hmpriv->txpage[i] = fifosize.high_queue_pg_num; ++ break; ++ case HALMAC_DMA_MAPPING_UNDEFINE: ++ break; ++ } ++ hmpriv->txpage[i] += fifosize.pub_queue_pg_num; ++ } ++ ++ return 0; ++} ++ ++/* ++ * Description: ++ * Get specific queue allocated page number ++ * ++ * Parameter: ++ * d pointer to struct dvobj_priv of driver ++ * queue target queue to query, VO/VI/BE/BK/.../TXCMD_QUEUE_INX ++ * page return allocated page number ++ * ++ * Rteurn: ++ * 0 Success, "page" is valid. ++ * others Fail, "page" is invalid. ++ */ ++int rtw_halmac_get_tx_queue_page_num(struct dvobj_priv *d, u8 queue, u32 *page) ++{ ++ *page = 0; ++ if (queue < HW_QUEUE_ENTRY) ++ *page = d->hmpriv.txpage[queue]; ++ ++ return 0; ++} ++ ++/* ++ * Return: ++ * address for SDIO command ++ */ ++u32 rtw_halmac_sdio_get_tx_addr(struct dvobj_priv *d, u8 *desc, u32 size) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ u32 addr; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ status = api->halmac_get_sdio_tx_addr(mac, desc, size, &addr); ++ if (HALMAC_RET_SUCCESS != status) ++ return 0; ++ ++ return addr; ++} ++ ++int rtw_halmac_sdio_tx_allowed(struct dvobj_priv *d, u8 *buf, u32 size) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ status = api->halmac_tx_allowed_sdio(mac, buf, size); ++ if (HALMAC_RET_SUCCESS != status) ++ return -1; ++ ++ return 0; ++} ++ ++u32 rtw_halmac_sdio_get_rx_addr(struct dvobj_priv *d, u8 *seq) ++{ ++ u8 id; ++ ++#define RTW_SDIO_ADDR_RX_RX0FF_PRFIX 0x0E000 ++#define RTW_SDIO_ADDR_RX_RX0FF_GEN(a) (RTW_SDIO_ADDR_RX_RX0FF_PRFIX|(a&0x3)) ++ ++ id = *seq; ++ (*seq)++; ++ return RTW_SDIO_ADDR_RX_RX0FF_GEN(id); ++} ++#endif /* CONFIG_SDIO_HCI */ ++ ++#ifdef CONFIG_USB_HCI ++u8 rtw_halmac_usb_get_bulkout_id(struct dvobj_priv *d, u8 *buf, u32 size) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ u8 bulkout_id; ++ ++ ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ ++ status = api->halmac_get_usb_bulkout_id(mac, buf, size, &bulkout_id); ++ if (HALMAC_RET_SUCCESS != status) ++ return 0; ++ ++ return bulkout_id; ++} ++ ++static inline HALMAC_USB_MODE _usb_mode_drv2halmac(enum RTW_USB_SPEED usb_mode) ++{ ++ HALMAC_USB_MODE halmac_usb_mode = HALMAC_USB_MODE_U2; ++ ++ switch (usb_mode) { ++ case RTW_USB_SPEED_2: ++ halmac_usb_mode = HALMAC_USB_MODE_U2; ++ break; ++ case RTW_USB_SPEED_3: ++ halmac_usb_mode = HALMAC_USB_MODE_U3; ++ break; ++ default: ++ halmac_usb_mode = HALMAC_USB_MODE_U2; ++ break; ++ } ++ ++ return halmac_usb_mode; ++} ++ ++u8 rtw_halmac_switch_usb_mode(struct dvobj_priv *d, enum RTW_USB_SPEED usb_mode) ++{ ++ PHALMAC_ADAPTER mac; ++ PHALMAC_API api; ++ HALMAC_RET_STATUS status; ++ PADAPTER adapter; ++ HALMAC_USB_MODE halmac_usb_mode; ++ ++ adapter = d->padapters[IFACE_ID0]; ++ mac = dvobj_to_halmac(d); ++ api = HALMAC_GET_API(mac); ++ halmac_usb_mode = _usb_mode_drv2halmac(usb_mode); ++ status = api->halmac_set_hw_value(mac, HALMAC_HW_USB_MODE, (void *)&halmac_usb_mode); ++ ++ if (HALMAC_RET_SUCCESS != status) ++ return _FAIL; ++ ++ return _SUCCESS; ++} ++#endif /* CONFIG_USB_HCI */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_halmac.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_halmac.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/hal_halmac.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_halmac.h 2018-02-11 21:44:27.152146162 +0200 +@@ -0,0 +1,118 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _HAL_HALMAC_H_ ++#define _HAL_HALMAC_H_ ++ ++#include /* adapter_to_dvobj(), struct intf_hdl and etc. */ ++#include "halmac/halmac_api.h" /* PHALMAC_ADAPTER and etc. */ ++ ++/* HALMAC Definition for Driver */ ++#define RTW_HALMAC_H2C_MAX_SIZE HALMAC_H2C_CMD_ORIGINAL_SIZE_88XX ++#define RTW_HALMAC_BA_SSN_RPT_SIZE 4 ++ ++#define dvobj_set_halmac(d, mac) ((d)->halmac = (mac)) ++#define dvobj_to_halmac(d) ((PHALMAC_ADAPTER)((d)->halmac)) ++#define adapter_to_halmac(p) dvobj_to_halmac(adapter_to_dvobj(p)) ++ ++/* for H2C cmd */ ++#define MAX_H2C_BOX_NUMS 4 ++#define MESSAGE_BOX_SIZE 4 ++#define EX_MESSAGE_BOX_SIZE 4 ++ ++typedef enum _RTW_HALMAC_MODE { ++ RTW_HALMAC_MODE_NORMAL, ++ RTW_HALMAC_MODE_WIFI_TEST, ++} RTW_HALMAC_MODE; ++ ++extern HALMAC_PLATFORM_API rtw_halmac_platform_api; ++ ++/* HALMAC API for Driver(HAL) */ ++u8 rtw_halmac_read8(struct intf_hdl *, u32 addr); ++u16 rtw_halmac_read16(struct intf_hdl *, u32 addr); ++u32 rtw_halmac_read32(struct intf_hdl *, u32 addr); ++void rtw_halmac_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++u8 rtw_halmac_iread8(struct intf_hdl *pintfhdl, u32 addr); ++u16 rtw_halmac_iread16(struct intf_hdl *pintfhdl, u32 addr); ++u32 rtw_halmac_iread32(struct intf_hdl *pintfhdl, u32 addr); ++#endif ++int rtw_halmac_write8(struct intf_hdl *, u32 addr, u8 value); ++int rtw_halmac_write16(struct intf_hdl *, u32 addr, u16 value); ++int rtw_halmac_write32(struct intf_hdl *, u32 addr, u32 value); ++ ++int rtw_halmac_init_adapter(struct dvobj_priv *, PHALMAC_PLATFORM_API); ++int rtw_halmac_deinit_adapter(struct dvobj_priv *); ++int rtw_halmac_poweron(struct dvobj_priv *); ++int rtw_halmac_poweroff(struct dvobj_priv *); ++int rtw_halmac_init_hal(struct dvobj_priv *); ++int rtw_halmac_init_hal_fw(struct dvobj_priv *, u8 *fw, u32 fwsize); ++int rtw_halmac_init_hal_fw_file(struct dvobj_priv *, u8 *fwpath); ++int rtw_halmac_deinit_hal(struct dvobj_priv *); ++int rtw_halmac_self_verify(struct dvobj_priv *); ++int rtw_halmac_dlfw(struct dvobj_priv *, u8 *fw, u32 fwsize); ++int rtw_halmac_dlfw_from_file(struct dvobj_priv *, u8 *fwpath); ++int rtw_halmac_phy_power_switch(struct dvobj_priv *, u8 enable); ++int rtw_halmac_send_h2c(struct dvobj_priv *, u8 *h2c); ++int rtw_halmac_c2h_handle(struct dvobj_priv *, u8 *c2h, u32 size); ++ ++int rtw_halmac_get_physical_efuse_size(struct dvobj_priv *, u32 *size); ++int rtw_halmac_read_physical_efuse_map(struct dvobj_priv *, u8 *map, u32 size); ++int rtw_halmac_read_physical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); ++int rtw_halmac_write_physical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); ++int rtw_halmac_get_logical_efuse_size(struct dvobj_priv *, u32 *size); ++int rtw_halmac_read_logical_efuse_map(struct dvobj_priv *, u8 *map, u32 size); ++int rtw_halmac_write_logical_efuse_map(struct dvobj_priv *, u8 *map, u32 size, u8 *maskmap, u32 masksize); ++int rtw_halmac_read_logical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); ++int rtw_halmac_write_logical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); ++ ++int rtw_halmac_write_bt_physical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); ++int rtw_halmac_read_bt_physical_efuse_map(struct dvobj_priv *, u8 *map, u32 size); ++ ++int rtw_halmac_config_rx_info(struct dvobj_priv *, HALMAC_DRV_INFO); ++int rtw_halmac_set_mac_address(struct dvobj_priv *, enum _hw_port, u8 *addr); ++int rtw_halmac_set_bssid(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr); ++ ++int rtw_halmac_set_bandwidth(struct dvobj_priv *, u8 channel, u8 pri_ch_idx, u8 bw); ++int rtw_halmac_rx_agg_switch(struct dvobj_priv *, u8 enable); ++int rtw_halmac_get_hw_value(struct dvobj_priv *d, HALMAC_HW_ID hw_id, VOID *pvalue); ++ ++int rtw_halmac_get_wow_reason(struct dvobj_priv *, u8 *reason); ++int rtw_halmac_get_drv_info_sz(struct dvobj_priv *d, u8 *sz); ++ ++int rtw_halmac_get_rsvd_drv_pg_bndy(struct dvobj_priv *dvobj, u16 *drv_pg); ++int rtw_halmac_download_rsvd_page(struct dvobj_priv *dvobj, u8 pg_offset, u8 *pbuf, u32 size); ++ ++#ifdef CONFIG_SDIO_HCI ++int rtw_halmac_query_tx_page_num(struct dvobj_priv *); ++int rtw_halmac_get_tx_queue_page_num(struct dvobj_priv *, u8 queue, u32 *page); ++u32 rtw_halmac_sdio_get_tx_addr(struct dvobj_priv *, u8 *desc, u32 size); ++int rtw_halmac_sdio_tx_allowed(struct dvobj_priv *, u8 *buf, u32 size); ++u32 rtw_halmac_sdio_get_rx_addr(struct dvobj_priv *, u8 *seq); ++#endif /* CONFIG_SDIO_HCI */ ++ ++#ifdef CONFIG_USB_HCI ++u8 rtw_halmac_usb_get_bulkout_id(struct dvobj_priv *, u8 *buf, u32 size); ++u8 rtw_halmac_switch_usb_mode(struct dvobj_priv *d, enum RTW_USB_SPEED usb_mode); ++#endif /* CONFIG_USB_HCI */ ++ ++#ifdef CONFIG_SUPPORT_TRX_SHARED ++void dump_trx_share_mode(void *sel, _adapter *adapter); ++#endif ++#endif /* _HAL_HALMAC_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_hci/hal_pci.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_hci/hal_pci.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/hal_hci/hal_pci.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_hci/hal_pci.c 2018-02-11 21:44:27.152146162 +0200 +@@ -0,0 +1,23 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _HAL_PCI_C_ ++ ++#include ++#include +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_intf.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_intf.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/hal_intf.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_intf.c 2018-02-11 21:44:27.152146162 +0200 +@@ -0,0 +1,1319 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#define _HAL_INTF_C_ ++ ++#include ++#include ++ ++const u32 _chip_type_to_odm_ic_type[] = { ++ 0, ++ ODM_RTL8188E, ++ ODM_RTL8192E, ++ ODM_RTL8812, ++ ODM_RTL8821, ++ ODM_RTL8723B, ++ ODM_RTL8814A, ++ ODM_RTL8703B, ++ ODM_RTL8188F, ++ ODM_RTL8822B, ++ ODM_RTL8723D, ++ ODM_RTL8821C, ++ 0, ++}; ++ ++void rtw_hal_chip_configure(_adapter *padapter) ++{ ++ padapter->HalFunc.intf_chip_configure(padapter); ++} ++ ++void rtw_hal_read_chip_info(_adapter *padapter) ++{ ++ u8 hci_type = rtw_get_intf_type(padapter); ++ u32 start = rtw_get_current_time(); ++ ++ /* before access eFuse, make sure card enable has been called */ ++ if ((hci_type == RTW_SDIO || hci_type == RTW_GSPI) ++ && !rtw_is_hw_init_completed(padapter)) ++ rtw_hal_power_on(padapter); ++ ++ padapter->HalFunc.read_adapter_info(padapter); ++ ++ if ((hci_type == RTW_SDIO || hci_type == RTW_GSPI) ++ && !rtw_is_hw_init_completed(padapter)) ++ rtw_hal_power_off(padapter); ++ ++ RTW_INFO("%s in %d ms\n", __func__, rtw_get_passing_time_ms(start)); ++} ++ ++void rtw_hal_read_chip_version(_adapter *padapter) ++{ ++ padapter->HalFunc.read_chip_version(padapter); ++ rtw_odm_init_ic_type(padapter); ++} ++ ++void rtw_hal_def_value_init(_adapter *padapter) ++{ ++ if (is_primary_adapter(padapter)) { ++ padapter->HalFunc.init_default_value(padapter); ++ ++ rtw_init_hal_com_default_value(padapter); ++ ++ { ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); ++ ++ /* hal_spec is ready here */ ++ dvobj->macid_ctl.num = rtw_min(hal_spec->macid_num, MACID_NUM_SW_LIMIT); ++ ++ dvobj->cam_ctl.sec_cap = hal_spec->sec_cap; ++ dvobj->cam_ctl.num = rtw_min(hal_spec->sec_cam_ent_num, SEC_CAM_ENT_NUM_SW_LIMIT); ++ } ++ } ++} ++ ++u8 rtw_hal_data_init(_adapter *padapter) ++{ ++ if (is_primary_adapter(padapter)) { ++ padapter->hal_data_sz = sizeof(HAL_DATA_TYPE); ++ padapter->HalData = rtw_zvmalloc(padapter->hal_data_sz); ++ if (padapter->HalData == NULL) { ++ RTW_INFO("cant not alloc memory for HAL DATA\n"); ++ return _FAIL; ++ } ++ } ++ return _SUCCESS; ++} ++ ++void rtw_hal_data_deinit(_adapter *padapter) ++{ ++ if (is_primary_adapter(padapter)) { ++ if (padapter->HalData) { ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ phy_free_filebuf(padapter); ++#endif ++ rtw_vmfree(padapter->HalData, padapter->hal_data_sz); ++ padapter->HalData = NULL; ++ padapter->hal_data_sz = 0; ++ } ++ } ++} ++ ++void rtw_hal_free_data(_adapter *padapter) ++{ ++ /* free HAL Data */ ++ rtw_hal_data_deinit(padapter); ++} ++void rtw_hal_dm_init(_adapter *padapter) ++{ ++ if (is_primary_adapter(padapter)) { ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ ++ padapter->HalFunc.dm_init(padapter); ++ ++ _rtw_spinlock_init(&pHalData->IQKSpinLock); ++ ++ phy_load_tx_power_ext_info(padapter, 1); ++ } ++} ++void rtw_hal_dm_deinit(_adapter *padapter) ++{ ++ if (is_primary_adapter(padapter)) { ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ ++ padapter->HalFunc.dm_deinit(padapter); ++ ++ _rtw_spinlock_free(&pHalData->IQKSpinLock); ++ } ++} ++void rtw_hal_sw_led_init(_adapter *padapter) ++{ ++ if (padapter->HalFunc.InitSwLeds) ++ padapter->HalFunc.InitSwLeds(padapter); ++} ++ ++void rtw_hal_sw_led_deinit(_adapter *padapter) ++{ ++ if (padapter->HalFunc.DeInitSwLeds) ++ padapter->HalFunc.DeInitSwLeds(padapter); ++} ++ ++u32 rtw_hal_power_on(_adapter *padapter) ++{ ++ u32 ret = 0; ++ ++ ret = padapter->HalFunc.hal_power_on(padapter); ++ ++#ifdef CONFIG_BT_COEXIST ++ if (ret == _SUCCESS) ++ rtw_btcoex_PowerOnSetting(padapter); ++#endif ++ ++ return ret; ++} ++ ++void rtw_hal_power_off(_adapter *padapter) ++{ ++ struct macid_ctl_t *macid_ctl = &padapter->dvobj->macid_ctl; ++ ++ _rtw_memset(macid_ctl->h2c_msr, 0, MACID_NUM_SW_LIMIT); ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_PowerOffSetting(padapter); ++#endif ++ ++ padapter->HalFunc.hal_power_off(padapter); ++} ++ ++void rtw_hal_init_opmode(_adapter *padapter) ++{ ++ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType = Ndis802_11InfrastructureMax; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ sint fw_state; ++ ++ fw_state = get_fwstate(pmlmepriv); ++ ++ if (fw_state & WIFI_ADHOC_STATE) ++ networkType = Ndis802_11IBSS; ++ else if (fw_state & WIFI_STATION_STATE) ++ networkType = Ndis802_11Infrastructure; ++ else if (fw_state & WIFI_AP_STATE) ++ networkType = Ndis802_11APMode; ++ else ++ return; ++ ++ rtw_setopmode_cmd(padapter, networkType, _FALSE); ++} ++ ++uint rtw_hal_init(_adapter *padapter) ++{ ++ uint status = _SUCCESS; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ int i; ++ ++ status = padapter->HalFunc.hal_init(padapter); ++ ++ if (status == _SUCCESS) { ++ pHalData->hw_init_completed = _TRUE; ++ rtw_restore_mac_addr(padapter); ++ ++ if (padapter->registrypriv.notch_filter == 1) ++ rtw_hal_notch_filter(padapter, 1); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) ++ rtw_sec_restore_wep_key(dvobj->padapters[i]); ++ ++ rtw_led_control(padapter, LED_CTL_POWER_ON); ++ ++ init_hw_mlme_ext(padapter); ++ ++ rtw_hal_init_opmode(padapter); ++ ++#ifdef CONFIG_RF_POWER_TRIM ++ rtw_bb_rf_gain_offset(padapter); ++#endif /*CONFIG_RF_POWER_TRIM*/ ++ ++ } else { ++ pHalData->hw_init_completed = _FALSE; ++ RTW_INFO("rtw_hal_init: hal__init fail\n"); ++ } ++ ++ ++ return status; ++ ++} ++ ++uint rtw_hal_deinit(_adapter *padapter) ++{ ++ uint status = _SUCCESS; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ int i; ++ ++ status = padapter->HalFunc.hal_deinit(padapter); ++ ++ if (status == _SUCCESS) { ++ rtw_led_control(padapter, LED_CTL_POWER_OFF); ++ pHalData->hw_init_completed = _FALSE; ++ } else ++ RTW_INFO("\n rtw_hal_deinit: hal_init fail\n"); ++ ++ ++ return status; ++} ++ ++void rtw_hal_set_hwreg(_adapter *padapter, u8 variable, u8 *val) ++{ ++ padapter->HalFunc.SetHwRegHandler(padapter, variable, val); ++} ++ ++void rtw_hal_get_hwreg(_adapter *padapter, u8 variable, u8 *val) ++{ ++ padapter->HalFunc.GetHwRegHandler(padapter, variable, val); ++} ++ ++u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue) ++{ ++ return padapter->HalFunc.SetHalDefVarHandler(padapter, eVariable, pValue); ++} ++u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue) ++{ ++ return padapter->HalFunc.GetHalDefVarHandler(padapter, eVariable, pValue); ++} ++ ++void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, BOOLEAN bSet) ++{ ++ padapter->HalFunc.SetHalODMVarHandler(padapter, eVariable, pValue1, bSet); ++} ++void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, PVOID pValue2) ++{ ++ padapter->HalFunc.GetHalODMVarHandler(padapter, eVariable, pValue1, pValue2); ++} ++ ++/* FOR SDIO & PCIE */ ++void rtw_hal_enable_interrupt(_adapter *padapter) ++{ ++#if defined(CONFIG_PCI_HCI) || defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) ++ if (padapter->HalFunc.enable_interrupt) ++ padapter->HalFunc.enable_interrupt(padapter); ++ else ++ RTW_INFO("%s: HalFunc.enable_interrupt is NULL!\n", __func__); ++#endif /* #if defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) */ ++} ++ ++/* FOR SDIO & PCIE */ ++void rtw_hal_disable_interrupt(_adapter *padapter) ++{ ++#if defined(CONFIG_PCI_HCI) || defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) ++ if (padapter->HalFunc.disable_interrupt) ++ padapter->HalFunc.disable_interrupt(padapter); ++ else ++ RTW_INFO("%s: HalFunc.disable_interrupt is NULL!\n", __func__); ++#endif /* #if defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) */ ++} ++ ++ ++u8 rtw_hal_check_ips_status(_adapter *padapter) ++{ ++ u8 val = _FALSE; ++ if (padapter->HalFunc.check_ips_status) ++ val = padapter->HalFunc.check_ips_status(padapter); ++ else ++ RTW_INFO("%s: HalFunc.check_ips_status is NULL!\n", __FUNCTION__); ++ ++ return val; ++} ++ ++s32 rtw_hal_fw_dl(_adapter *padapter, u8 wowlan) ++{ ++ return padapter->HalFunc.fw_dl(padapter, wowlan); ++} ++ ++void rtw_hal_clear_interrupt(_adapter *padapter) ++{ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ if (padapter->HalFunc.clear_interrupt) ++ padapter->HalFunc.clear_interrupt(padapter); ++ else ++ RTW_INFO("%s: HalFunc.clear_interrupt is NULL!\n", __func__); ++#endif ++} ++ ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) ++u32 rtw_hal_inirp_init(_adapter *padapter) ++{ ++ if (is_primary_adapter(padapter)) ++ return padapter->HalFunc.inirp_init(padapter); ++ return _SUCCESS; ++} ++u32 rtw_hal_inirp_deinit(_adapter *padapter) ++{ ++ ++ if (is_primary_adapter(padapter)) ++ return padapter->HalFunc.inirp_deinit(padapter); ++ ++ return _SUCCESS; ++} ++#endif /* #if defined(CONFIG_USB_HCI) || defined (CONFIG_PCI_HCI) */ ++ ++#if defined(CONFIG_PCI_HCI) ++void rtw_hal_irp_reset(_adapter *padapter) ++{ ++ padapter->HalFunc.irp_reset(GET_PRIMARY_ADAPTER(padapter)); ++} ++#endif /* #if defined(CONFIG_PCI_HCI) */ ++ ++/* for USB Auto-suspend */ ++u8 rtw_hal_intf_ps_func(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val) ++{ ++ if (padapter->HalFunc.interface_ps_func) ++ return padapter->HalFunc.interface_ps_func(padapter, efunc_id, val); ++ return _FAIL; ++} ++ ++s32 rtw_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ return padapter->HalFunc.hal_xmitframe_enqueue(padapter, pxmitframe); ++} ++ ++s32 rtw_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ return padapter->HalFunc.hal_xmit(padapter, pxmitframe); ++} ++ ++/* ++ * [IMPORTANT] This function would be run in interrupt context. ++ */ ++s32 rtw_hal_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe) ++{ ++ s32 ret = _FAIL; ++ u8 *pframe, subtype; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ update_mgntframe_attrib_addr(padapter, pmgntframe); ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ subtype = GetFrameSubType(pframe); /* bit(7)~bit(2) */ ++ ++ /* pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; */ ++ /* _rtw_memcpy(pmgntframe->attrib.ra, pwlanhdr->addr1, ETH_ALEN); */ ++ ++#ifdef CONFIG_IEEE80211W ++ if (padapter->securitypriv.binstallBIPkey == _TRUE && (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || ++ subtype == WIFI_ACTION)) { ++ if (IS_MCAST(pmgntframe->attrib.ra) && pmgntframe->attrib.key_type != IEEE80211W_NO_KEY) { ++ pmgntframe->attrib.encrypt = _BIP_; ++ /* pmgntframe->attrib.bswenc = _TRUE; */ ++ } else if (pmgntframe->attrib.key_type != IEEE80211W_NO_KEY) { ++ psta = rtw_get_stainfo(pstapriv, pmgntframe->attrib.ra); ++ if (psta && psta->bpairwise_key_installed == _TRUE) { ++ pmgntframe->attrib.encrypt = _AES_; ++ pmgntframe->attrib.bswenc = _TRUE; ++ } else { ++ RTW_INFO("%s, %d, bpairwise_key_installed is FALSE\n", __func__, __LINE__); ++ goto no_mgmt_coalesce; ++ } ++ } ++ RTW_INFO("encrypt=%d, bswenc=%d\n", pmgntframe->attrib.encrypt, pmgntframe->attrib.bswenc); ++ rtw_mgmt_xmitframe_coalesce(padapter, pmgntframe->pkt, pmgntframe); ++ } ++#endif /* CONFIG_IEEE80211W */ ++no_mgmt_coalesce: ++ ret = padapter->HalFunc.mgnt_xmit(padapter, pmgntframe); ++ return ret; ++} ++ ++s32 rtw_hal_init_xmit_priv(_adapter *padapter) ++{ ++ return padapter->HalFunc.init_xmit_priv(padapter); ++} ++void rtw_hal_free_xmit_priv(_adapter *padapter) ++{ ++ padapter->HalFunc.free_xmit_priv(padapter); ++} ++ ++s32 rtw_hal_init_recv_priv(_adapter *padapter) ++{ ++ return padapter->HalFunc.init_recv_priv(padapter); ++} ++void rtw_hal_free_recv_priv(_adapter *padapter) ++{ ++ padapter->HalFunc.free_recv_priv(padapter); ++} ++void rtw_update_ramask(_adapter *padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level) ++{ ++ padapter->HalFunc.UpdateRAMaskHandler(padapter, psta, psta->mac_id, rssi_level); ++} ++void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level) ++{ ++ _adapter *padapter; ++ struct mlme_priv *pmlmepriv; ++ ++ if (!psta) ++ return; ++ ++ padapter = psta->padapter; ++ ++ pmlmepriv = &(padapter->mlmepriv); ++#ifdef CONFIG_AP_MODE ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ add_RATid(padapter, psta, rssi_level); ++ else { ++#else ++ { ++#endif ++ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); ++ rtw_update_ramask(padapter, psta, psta->mac_id, rssi_level); ++ } ++} ++ ++/* Start specifical interface thread */ ++void rtw_hal_start_thread(_adapter *padapter) ++{ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++#ifndef CONFIG_SDIO_TX_TASKLET ++ padapter->HalFunc.run_thread(padapter); ++#endif ++#endif ++} ++/* Start specifical interface thread */ ++void rtw_hal_stop_thread(_adapter *padapter) ++{ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++#ifndef CONFIG_SDIO_TX_TASKLET ++ ++ padapter->HalFunc.cancel_thread(padapter); ++ ++#endif ++#endif ++} ++ ++u32 rtw_hal_read_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask) ++{ ++ u32 data = 0; ++ if (padapter->HalFunc.read_bbreg) ++ data = padapter->HalFunc.read_bbreg(padapter, RegAddr, BitMask); ++ return data; ++} ++void rtw_hal_write_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data) ++{ ++ if (padapter->HalFunc.write_bbreg) ++ padapter->HalFunc.write_bbreg(padapter, RegAddr, BitMask, Data); ++} ++ ++u32 rtw_hal_read_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask) ++{ ++ u32 data = 0; ++ ++ if (padapter->HalFunc.read_rfreg) { ++ data = padapter->HalFunc.read_rfreg(padapter, eRFPath, RegAddr, BitMask); ++ ++ if (match_rf_read_sniff_ranges(eRFPath, RegAddr, BitMask)) { ++ RTW_INFO("DBG_IO rtw_hal_read_rfreg(%u, 0x%04x, 0x%08x) read:0x%08x(0x%08x)\n" ++ , eRFPath, RegAddr, BitMask, (data << PHY_CalculateBitShift(BitMask)), data); ++ } ++ } ++ ++ return data; ++} ++ ++void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask, u32 Data) ++{ ++ if (padapter->HalFunc.write_rfreg) { ++ ++ if (match_rf_write_sniff_ranges(eRFPath, RegAddr, BitMask)) { ++ RTW_INFO("DBG_IO rtw_hal_write_rfreg(%u, 0x%04x, 0x%08x) write:0x%08x(0x%08x)\n" ++ , eRFPath, RegAddr, BitMask, (Data << PHY_CalculateBitShift(BitMask)), Data); ++ } ++ ++ padapter->HalFunc.write_rfreg(padapter, eRFPath, RegAddr, BitMask, Data); ++ ++#ifdef CONFIG_PCI_HCI ++ if (!IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(padapter)) /*For N-Series IC, suggest by Jenyu*/ ++ rtw_udelay_os(2); ++#endif ++ } ++} ++ ++#if defined(CONFIG_PCI_HCI) ++s32 rtw_hal_interrupt_handler(_adapter *padapter) ++{ ++ s32 ret = _FAIL; ++ ret = padapter->HalFunc.interrupt_handler(padapter); ++ return ret; ++} ++#endif ++#if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) ++void rtw_hal_interrupt_handler(_adapter *padapter, u16 pkt_len, u8 *pbuf) ++{ ++ padapter->HalFunc.interrupt_handler(padapter, pkt_len, pbuf); ++} ++#endif ++ ++void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ u8 cch_160 = Bandwidth == CHANNEL_WIDTH_160 ? channel : 0; ++ u8 cch_80 = Bandwidth == CHANNEL_WIDTH_80 ? channel : 0; ++ u8 cch_40 = Bandwidth == CHANNEL_WIDTH_40 ? channel : 0; ++ u8 cch_20 = Bandwidth == CHANNEL_WIDTH_20 ? channel : 0; ++ ++ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); ++ if (pDM_Odm->RFCalibrateInfo.bIQKInProgress == _TRUE) ++ RTW_ERR("%s, %d, IQK may race condition\n", __func__, __LINE__); ++ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); ++ ++ /* MP mode channel don't use secondary channel */ ++ if (rtw_mi_mp_mode_check(padapter) == _FALSE) { ++ #if 0 ++ if (cch_160 != 0) ++ cch_80 = rtw_get_scch_by_cch_offset(cch_160, CHANNEL_WIDTH_160, Offset80); ++ #endif ++ if (cch_80 != 0) ++ cch_40 = rtw_get_scch_by_cch_offset(cch_80, CHANNEL_WIDTH_80, Offset80); ++ if (cch_40 != 0) ++ cch_20 = rtw_get_scch_by_cch_offset(cch_40, CHANNEL_WIDTH_40, Offset40); ++ } ++ ++ pHalData->cch_80 = cch_80; ++ pHalData->cch_40 = cch_40; ++ pHalData->cch_20 = cch_20; ++ ++ if (0) ++ RTW_INFO("%s cch:%u, %s, offset40:%u, offset80:%u (%u, %u, %u)\n", __func__ ++ , channel, ch_width_str(Bandwidth), Offset40, Offset80 ++ , pHalData->cch_80, pHalData->cch_40, pHalData->cch_20); ++ ++ padapter->HalFunc.set_chnl_bw_handler(padapter, channel, Bandwidth, Offset40, Offset80); ++} ++ ++void rtw_hal_set_tx_power_level(_adapter *padapter, u8 channel) ++{ ++ if (padapter->HalFunc.set_tx_power_level_handler) ++ padapter->HalFunc.set_tx_power_level_handler(padapter, channel); ++} ++ ++void rtw_hal_get_tx_power_level(_adapter *padapter, s32 *powerlevel) ++{ ++ if (padapter->HalFunc.get_tx_power_level_handler) ++ padapter->HalFunc.get_tx_power_level_handler(padapter, powerlevel); ++} ++ ++void rtw_hal_dm_watchdog(_adapter *padapter) ++{ ++#ifdef CONFIG_MCC_MODE ++ if (MCC_EN(padapter)) { ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) ++ return; ++ } ++#endif /* CONFIG_MCC_MODE */ ++ ++ padapter->HalFunc.hal_dm_watchdog(padapter); ++ ++} ++ ++#ifdef CONFIG_LPS_LCLK_WD_TIMER ++void rtw_hal_dm_watchdog_in_lps(_adapter *padapter) ++{ ++#if defined(CONFIG_CONCURRENT_MODE) ++ if (padapter->hw_port != HW_PORT0) ++ return; ++#endif ++ ++ if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) { ++ padapter->HalFunc.hal_dm_watchdog_in_lps(padapter);/* this fuction caller is in interrupt context */ ++ } ++} ++#endif ++ ++void rtw_hal_bcn_related_reg_setting(_adapter *padapter) ++{ ++ padapter->HalFunc.SetBeaconRelatedRegistersHandler(padapter); ++} ++ ++#ifdef CONFIG_HOSTAPD_MLME ++s32 rtw_hal_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt) ++{ ++ if (padapter->HalFunc.hostap_mgnt_xmit_entry) ++ return padapter->HalFunc.hostap_mgnt_xmit_entry(padapter, pkt); ++ return _FAIL; ++} ++#endif /* CONFIG_HOSTAPD_MLME */ ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++void rtw_hal_sreset_init(_adapter *padapter) ++{ ++ padapter->HalFunc.sreset_init_value(padapter); ++} ++void rtw_hal_sreset_reset(_adapter *padapter) ++{ ++ padapter = GET_PRIMARY_ADAPTER(padapter); ++ padapter->HalFunc.silentreset(padapter); ++} ++ ++void rtw_hal_sreset_reset_value(_adapter *padapter) ++{ ++ padapter->HalFunc.sreset_reset_value(padapter); ++} ++ ++void rtw_hal_sreset_xmit_status_check(_adapter *padapter) ++{ ++ padapter->HalFunc.sreset_xmit_status_check(padapter); ++} ++void rtw_hal_sreset_linked_status_check(_adapter *padapter) ++{ ++ padapter->HalFunc.sreset_linked_status_check(padapter); ++} ++u8 rtw_hal_sreset_get_wifi_status(_adapter *padapter) ++{ ++ return padapter->HalFunc.sreset_get_wifi_status(padapter); ++} ++ ++bool rtw_hal_sreset_inprogress(_adapter *padapter) ++{ ++ padapter = GET_PRIMARY_ADAPTER(padapter); ++ return padapter->HalFunc.sreset_inprogress(padapter); ++} ++#endif /* DBG_CONFIG_ERROR_DETECT */ ++ ++#ifdef CONFIG_IOL ++int rtw_hal_iol_cmd(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt) ++{ ++ if (adapter->HalFunc.IOL_exec_cmds_sync) ++ return adapter->HalFunc.IOL_exec_cmds_sync(adapter, xmit_frame, max_wating_ms, bndy_cnt); ++ return _FAIL; ++} ++#endif ++ ++#ifdef CONFIG_XMIT_THREAD_MODE ++s32 rtw_hal_xmit_thread_handler(_adapter *padapter) ++{ ++ return padapter->HalFunc.xmit_thread_handler(padapter); ++} ++#endif ++ ++void rtw_hal_notch_filter(_adapter *adapter, bool enable) ++{ ++ if (adapter->HalFunc.hal_notch_filter) ++ adapter->HalFunc.hal_notch_filter(adapter, enable); ++} ++ ++#ifdef CONFIG_FW_C2H_REG ++inline bool rtw_hal_c2h_valid(_adapter *adapter, u8 *buf) ++{ ++ HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); ++ HAL_VERSION *hal_ver = &HalData->VersionID; ++ bool ret = _FAIL; ++ ++ ret = C2H_ID_88XX(buf) || C2H_PLEN_88XX(buf); ++ ++ return ret; ++} ++ ++inline s32 rtw_hal_c2h_evt_read(_adapter *adapter, u8 *buf) ++{ ++ HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); ++ HAL_VERSION *hal_ver = &HalData->VersionID; ++ s32 ret = _FAIL; ++ ++ ret = c2h_evt_read_88xx(adapter, buf); ++ ++ return ret; ++} ++ ++bool rtw_hal_c2h_reg_hdr_parse(_adapter *adapter, u8 *buf, u8 *id, u8 *seq, u8 *plen, u8 **payload) ++{ ++ HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); ++ HAL_VERSION *hal_ver = &HalData->VersionID; ++ bool ret = _FAIL; ++ ++ *id = C2H_ID_88XX(buf); ++ *seq = C2H_SEQ_88XX(buf); ++ *plen = C2H_PLEN_88XX(buf); ++ *payload = C2H_PAYLOAD_88XX(buf); ++ ret = _SUCCESS; ++ ++ return ret; ++} ++#endif /* CONFIG_FW_C2H_REG */ ++ ++#ifdef CONFIG_FW_C2H_PKT ++bool rtw_hal_c2h_pkt_hdr_parse(_adapter *adapter, u8 *buf, u16 len, u8 *id, u8 *seq, u8 *plen, u8 **payload) ++{ ++ HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); ++ HAL_VERSION *hal_ver = &HalData->VersionID; ++ bool ret = _FAIL; ++ ++ if (!buf || len > 256 || len < 3) ++ goto exit; ++ ++ *id = C2H_ID_88XX(buf); ++ *seq = C2H_SEQ_88XX(buf); ++ *plen = len - 2; ++ *payload = C2H_PAYLOAD_88XX(buf); ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++#endif /* CONFIG_FW_C2H_PKT */ ++ ++#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTL8723B) ++#include /* for MPTBT_FwC2hBtMpCtrl */ ++#endif ++s32 c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) ++{ ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ DM_ODM_T *odm = &hal_data->odmpriv; ++ u8 sub_id = 0; ++ s32 ret = _SUCCESS; ++ ++ switch (id) { ++ case C2H_DBG: ++ RTW_INFO_DUMP("C2H_DBG: ", payload, plen); ++ break; ++ case C2H_FW_SCAN_COMPLETE: ++ RTW_INFO("[C2H], FW Scan Complete\n"); ++ break; ++ ++#ifdef CONFIG_BT_COEXIST ++ case C2H_BT_INFO: ++ rtw_btcoex_BtInfoNotify(adapter, plen, payload); ++ break; ++ case C2H_BT_MP_INFO: ++ #if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTL8723B) ++ MPTBT_FwC2hBtMpCtrl(adapter, payload, plen); ++ #endif ++ rtw_btcoex_BtMpRptNotify(adapter, plen, payload); ++ break; ++ case C2H_MAILBOX_STATUS: ++ RTW_INFO_DUMP("C2H_MAILBOX_STATUS: ", payload, plen); ++ break; ++#endif /* CONFIG_BT_COEXIST */ ++ ++ case C2H_IQK_FINISH: ++ c2h_iqk_offload(adapter, payload, plen); ++ break; ++ ++#if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW) ++ case C2H_FW_CHNL_SWITCH_COMPLETE: ++ rtw_tdls_chsw_oper_done(adapter); ++ break; ++ case C2H_BCN_EARLY_RPT: ++ rtw_tdls_ch_sw_back_to_base_chnl(adapter); ++ break; ++#endif ++ ++#ifdef CONFIG_MCC_MODE ++ case C2H_MCC: ++ rtw_hal_mcc_c2h_handler(adapter, plen, payload); ++ break; ++#endif ++ ++#ifdef CONFIG_RTW_MAC_HIDDEN_RPT ++ case C2H_MAC_HIDDEN_RPT: ++ c2h_mac_hidden_rpt_hdl(adapter, payload, plen); ++ break; ++ case C2H_MAC_HIDDEN_RPT_2: ++ c2h_mac_hidden_rpt_2_hdl(adapter, payload, plen); ++ break; ++#endif ++ ++ case C2H_DEFEATURE_DBG: ++ c2h_defeature_dbg_hdl(adapter, payload, plen); ++ break; ++ ++#ifdef CONFIG_RTW_CUSTOMER_STR ++ case C2H_CUSTOMER_STR_RPT: ++ c2h_customer_str_rpt_hdl(adapter, payload, plen); ++ break; ++ case C2H_CUSTOMER_STR_RPT_2: ++ c2h_customer_str_rpt_2_hdl(adapter, payload, plen); ++ break; ++#endif ++ ++ case C2H_EXTEND: ++ sub_id = payload[0]; ++ /* no handle, goto default */ ++ ++ default: ++ if (phydm_c2H_content_parsing(odm, id, plen, payload) != TRUE) ++ ret = _FAIL; ++ break; ++ } ++ ++exit: ++ if (ret != _SUCCESS) { ++ if (id == C2H_EXTEND) ++ RTW_WARN("%s: unknown C2H(0x%02x, 0x%02x)\n", __func__, id, sub_id); ++ else ++ RTW_WARN("%s: unknown C2H(0x%02x)\n", __func__, id); ++ } ++ ++ return ret; ++} ++ ++#ifndef RTW_HALMAC ++s32 rtw_hal_c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) ++{ ++ s32 ret = _FAIL; ++ ++ ret = adapter->HalFunc.c2h_handler(adapter, id, seq, plen, payload); ++ if (ret != _SUCCESS) ++ ret = c2h_handler(adapter, id, seq, plen, payload); ++ ++ return ret; ++} ++ ++s32 rtw_hal_c2h_id_handle_directly(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) ++{ ++ switch (id) { ++ case C2H_CCX_TX_RPT: ++ case C2H_BT_MP_INFO: ++ case C2H_FW_CHNL_SWITCH_COMPLETE: ++ case C2H_IQK_FINISH: ++ case C2H_MCC: ++ case C2H_BCN_EARLY_RPT: ++ return _TRUE; ++ default: ++ return _FALSE; ++ } ++} ++#endif /* !RTW_HALMAC */ ++ ++s32 rtw_hal_is_disable_sw_channel_plan(PADAPTER padapter) ++{ ++ return GET_HAL_DATA(padapter)->bDisableSWChannelPlan; ++} ++ ++s32 rtw_hal_macid_sleep(PADAPTER padapter, u8 macid) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ u8 support; ++ ++ support = _FALSE; ++ rtw_hal_get_def_var(padapter, HAL_DEF_MACID_SLEEP, &support); ++ if (_FALSE == support) ++ return _FAIL; ++ ++ if (macid >= macid_ctl->num) { ++ RTW_ERR(FUNC_ADPT_FMT": Invalid macid(%u)\n", ++ FUNC_ADPT_ARG(padapter), macid); ++ return _FAIL; ++ } ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MACID_SLEEP, &macid); ++ ++ return _SUCCESS; ++} ++ ++s32 rtw_hal_macid_wakeup(PADAPTER padapter, u8 macid) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ u8 support; ++ ++ support = _FALSE; ++ rtw_hal_get_def_var(padapter, HAL_DEF_MACID_SLEEP, &support); ++ if (_FALSE == support) ++ return _FAIL; ++ ++ if (macid >= macid_ctl->num) { ++ RTW_ERR(FUNC_ADPT_FMT": Invalid macid(%u)\n", ++ FUNC_ADPT_ARG(padapter), macid); ++ return _FAIL; ++ } ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MACID_WAKEUP, &macid); ++ ++ return _SUCCESS; ++} ++ ++s32 rtw_hal_fill_h2c_cmd(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) ++{ ++ _adapter *pri_adapter = GET_PRIMARY_ADAPTER(padapter); ++ ++ if (pri_adapter->bFWReady == _TRUE) ++ return padapter->HalFunc.fill_h2c_cmd(padapter, ElementID, CmdLen, pCmdBuffer); ++ else if (padapter->registrypriv.mp_mode == 0) ++ RTW_PRINT(FUNC_ADPT_FMT" FW doesn't exit when no MP mode, by pass H2C id:0x%02x\n" ++ , FUNC_ADPT_ARG(padapter), ElementID); ++ return _FAIL; ++} ++ ++void rtw_hal_fill_fake_txdesc(_adapter *padapter, u8 *pDesc, u32 BufferLen, ++ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame) ++{ ++ padapter->HalFunc.fill_fake_txdesc(padapter, pDesc, BufferLen, IsPsPoll, IsBTQosNull, bDataFrame); ++ ++} ++u8 rtw_hal_get_txbuff_rsvd_page_num(_adapter *adapter, bool wowlan) ++{ ++ return adapter->HalFunc.hal_get_tx_buff_rsvd_page_num(adapter, wowlan); ++} ++ ++#ifdef CONFIG_GPIO_API ++void rtw_hal_update_hisr_hsisr_ind(_adapter *padapter, u32 flag) ++{ ++ if (padapter->HalFunc.update_hisr_hsisr_ind) ++ padapter->HalFunc.update_hisr_hsisr_ind(padapter, flag); ++} ++ ++int rtw_hal_gpio_func_check(_adapter *padapter, u8 gpio_num) ++{ ++ int ret = _SUCCESS; ++ ++ if (padapter->HalFunc.hal_gpio_func_check) ++ ret = padapter->HalFunc.hal_gpio_func_check(padapter, gpio_num); ++ ++ return ret; ++} ++ ++void rtw_hal_gpio_multi_func_reset(_adapter *padapter, u8 gpio_num) ++{ ++ if (padapter->HalFunc.hal_gpio_multi_func_reset) ++ padapter->HalFunc.hal_gpio_multi_func_reset(padapter, gpio_num); ++} ++#endif ++ ++void rtw_hal_fw_correct_bcn(_adapter *padapter) ++{ ++ if (padapter->HalFunc.fw_correct_bcn) ++ padapter->HalFunc.fw_correct_bcn(padapter); ++} ++ ++void rtw_hal_set_tx_power_index(PADAPTER padapter, u32 powerindex, u8 rfpath, u8 rate) ++{ ++ return padapter->HalFunc.set_tx_power_index_handler(padapter, powerindex, rfpath, rate); ++} ++ ++u8 rtw_hal_get_tx_power_index(PADAPTER padapter, u8 rfpath, u8 rate, u8 bandwidth, u8 channel, struct txpwr_idx_comp *tic) ++{ ++ return padapter->HalFunc.get_tx_power_index_handler(padapter, rfpath, rate, bandwidth, channel, tic); ++} ++ ++#ifdef RTW_HALMAC ++/* ++ * Description: ++ * Initialize MAC registers ++ * ++ * Return: ++ * _TRUE success ++ * _FALSE fail ++ */ ++u8 rtw_hal_init_mac_register(PADAPTER adapter) ++{ ++ return adapter->HalFunc.init_mac_register(adapter); ++} ++ ++/* ++ * Description: ++ * Initialize PHY(BB/RF) related functions ++ * ++ * Return: ++ * _TRUE success ++ * _FALSE fail ++ */ ++u8 rtw_hal_init_phy(PADAPTER adapter) ++{ ++ return adapter->HalFunc.init_phy(adapter); ++} ++#endif /* RTW_HALMAC */ ++ ++#define rtw_hal_error_msg(ops_fun) \ ++ RTW_PRINT("### %s - Error : Please hook HalFunc.%s ###\n", __FUNCTION__, ops_fun) ++ ++u8 rtw_hal_ops_check(_adapter *padapter) ++{ ++ u8 ret = _SUCCESS; ++#if 1 ++ /*** initialize section ***/ ++ if (NULL == padapter->HalFunc.read_chip_version) { ++ rtw_hal_error_msg("read_chip_version"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.init_default_value) { ++ rtw_hal_error_msg("init_default_value"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.intf_chip_configure) { ++ rtw_hal_error_msg("intf_chip_configure"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.read_adapter_info) { ++ rtw_hal_error_msg("read_adapter_info"); ++ ret = _FAIL; ++ } ++ ++ if (NULL == padapter->HalFunc.hal_power_on) { ++ rtw_hal_error_msg("hal_power_on"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.hal_power_off) { ++ rtw_hal_error_msg("hal_power_off"); ++ ret = _FAIL; ++ } ++ ++ if (NULL == padapter->HalFunc.hal_init) { ++ rtw_hal_error_msg("hal_init"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.hal_deinit) { ++ rtw_hal_error_msg("hal_deinit"); ++ ret = _FAIL; ++ } ++ ++ /*** xmit section ***/ ++ if (NULL == padapter->HalFunc.init_xmit_priv) { ++ rtw_hal_error_msg("init_xmit_priv"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.free_xmit_priv) { ++ rtw_hal_error_msg("free_xmit_priv"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.hal_xmit) { ++ rtw_hal_error_msg("hal_xmit"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.mgnt_xmit) { ++ rtw_hal_error_msg("mgnt_xmit"); ++ ret = _FAIL; ++ } ++#ifdef CONFIG_XMIT_THREAD_MODE ++ if (NULL == padapter->HalFunc.xmit_thread_handler) { ++ rtw_hal_error_msg("xmit_thread_handler"); ++ ret = _FAIL; ++ } ++#endif ++ if (NULL == padapter->HalFunc.hal_xmitframe_enqueue) { ++ rtw_hal_error_msg("hal_xmitframe_enqueue"); ++ ret = _FAIL; ++ } ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++#ifndef CONFIG_SDIO_TX_TASKLET ++ if (NULL == padapter->HalFunc.run_thread) { ++ rtw_hal_error_msg("run_thread"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.cancel_thread) { ++ rtw_hal_error_msg("cancel_thread"); ++ ret = _FAIL; ++ } ++#endif ++#endif ++ ++ /*** recv section ***/ ++ if (NULL == padapter->HalFunc.init_recv_priv) { ++ rtw_hal_error_msg("init_recv_priv"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.free_recv_priv) { ++ rtw_hal_error_msg("free_recv_priv"); ++ ret = _FAIL; ++ } ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) ++ if (NULL == padapter->HalFunc.inirp_init) { ++ rtw_hal_error_msg("inirp_init"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.inirp_deinit) { ++ rtw_hal_error_msg("inirp_deinit"); ++ ret = _FAIL; ++ } ++#endif /* #if defined(CONFIG_USB_HCI) || defined (CONFIG_PCI_HCI) */ ++ ++ ++ /*** interrupt hdl section ***/ ++#if defined(CONFIG_PCI_HCI) ++ if (NULL == padapter->HalFunc.irp_reset) { ++ rtw_hal_error_msg("irp_reset"); ++ ret = _FAIL; ++ } ++#endif/*#if defined(CONFIG_PCI_HCI)*/ ++#if (defined(CONFIG_PCI_HCI)) || (defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT)) ++ if (NULL == padapter->HalFunc.interrupt_handler) { ++ rtw_hal_error_msg("interrupt_handler"); ++ ret = _FAIL; ++ } ++#endif /*#if (defined(CONFIG_PCI_HCI)) || (defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT))*/ ++ ++#if defined(CONFIG_PCI_HCI) || defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) ++ if (NULL == padapter->HalFunc.enable_interrupt) { ++ rtw_hal_error_msg("enable_interrupt"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.disable_interrupt) { ++ rtw_hal_error_msg("disable_interrupt"); ++ ret = _FAIL; ++ } ++#endif /* defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) */ ++ ++ ++ /*** DM section ***/ ++ if (NULL == padapter->HalFunc.dm_init) { ++ rtw_hal_error_msg("dm_init"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.dm_deinit) { ++ rtw_hal_error_msg("dm_deinit"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.hal_dm_watchdog) { ++ rtw_hal_error_msg("hal_dm_watchdog"); ++ ret = _FAIL; ++ } ++#ifdef CONFIG_LPS_LCLK_WD_TIMER ++ if (NULL == padapter->HalFunc.hal_dm_watchdog_in_lps) { ++ rtw_hal_error_msg("hal_dm_watchdog_in_lps"); ++ ret = _FAIL; ++ } ++#endif ++ ++ /*** xxx section ***/ ++ if (NULL == padapter->HalFunc.set_chnl_bw_handler) { ++ rtw_hal_error_msg("set_chnl_bw_handler"); ++ ret = _FAIL; ++ } ++ ++ if (NULL == padapter->HalFunc.SetHwRegHandler) { ++ rtw_hal_error_msg("SetHwRegHandler"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.GetHwRegHandler) { ++ rtw_hal_error_msg("GetHwRegHandler"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.GetHalDefVarHandler) { ++ rtw_hal_error_msg("GetHalDefVarHandler"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.SetHalDefVarHandler) { ++ rtw_hal_error_msg("SetHalDefVarHandler"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.GetHalODMVarHandler) { ++ rtw_hal_error_msg("GetHalODMVarHandler"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.SetHalODMVarHandler) { ++ rtw_hal_error_msg("SetHalODMVarHandler"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.UpdateRAMaskHandler) { ++ rtw_hal_error_msg("UpdateRAMaskHandler"); ++ ret = _FAIL; ++ } ++ ++ if (NULL == padapter->HalFunc.SetBeaconRelatedRegistersHandler) { ++ rtw_hal_error_msg("SetBeaconRelatedRegistersHandler"); ++ ret = _FAIL; ++ } ++ ++ if (NULL == padapter->HalFunc.fill_h2c_cmd) { ++ rtw_hal_error_msg("fill_h2c_cmd"); ++ ret = _FAIL; ++ } ++ ++#ifdef RTW_HALMAC ++ if (NULL == padapter->HalFunc.hal_mac_c2h_handler) { ++ rtw_hal_error_msg("hal_mac_c2h_handler"); ++ ret = _FAIL; ++ } ++#elif !defined(CONFIG_RTL8188E) ++ if (NULL == padapter->HalFunc.c2h_handler) { ++ rtw_hal_error_msg("c2h_handler"); ++ ret = _FAIL; ++ } ++#endif ++ ++#if defined(CONFIG_LPS) || defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++ if (NULL == padapter->HalFunc.fill_fake_txdesc) { ++ rtw_hal_error_msg("fill_fake_txdesc"); ++ ret = _FAIL; ++ } ++#endif ++ if (NULL == padapter->HalFunc.hal_get_tx_buff_rsvd_page_num) { ++ rtw_hal_error_msg("hal_get_tx_buff_rsvd_page_num"); ++ ret = _FAIL; ++ } ++ ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ if (NULL == padapter->HalFunc.clear_interrupt) { ++ rtw_hal_error_msg("clear_interrupt"); ++ ret = _FAIL; ++ } ++#endif ++#endif /* CONFIG_WOWLAN */ ++ ++ if (NULL == padapter->HalFunc.fw_dl) { ++ rtw_hal_error_msg("fw_dl"); ++ ret = _FAIL; ++ } ++ ++ if ((IS_HARDWARE_TYPE_8814A(padapter) ++ || IS_HARDWARE_TYPE_8822BU(padapter) || IS_HARDWARE_TYPE_8822BS(padapter)) ++ && NULL == padapter->HalFunc.fw_correct_bcn) { ++ rtw_hal_error_msg("fw_correct_bcn"); ++ ret = _FAIL; ++ } ++ ++ if (IS_HARDWARE_TYPE_8822B(padapter) || IS_HARDWARE_TYPE_8821C(padapter)) { ++ if (!padapter->HalFunc.set_tx_power_index_handler) { ++ rtw_hal_error_msg("set_tx_power_index_handler"); ++ ret = _FAIL; ++ } ++ } ++ ++ if (!padapter->HalFunc.get_tx_power_index_handler) { ++ rtw_hal_error_msg("get_tx_power_index_handler"); ++ ret = _FAIL; ++ } ++ ++ /*** SReset section ***/ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ if (NULL == padapter->HalFunc.sreset_init_value) { ++ rtw_hal_error_msg("sreset_init_value"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.sreset_reset_value) { ++ rtw_hal_error_msg("sreset_reset_value"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.silentreset) { ++ rtw_hal_error_msg("silentreset"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.sreset_xmit_status_check) { ++ rtw_hal_error_msg("sreset_xmit_status_check"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.sreset_linked_status_check) { ++ rtw_hal_error_msg("sreset_linked_status_check"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.sreset_get_wifi_status) { ++ rtw_hal_error_msg("sreset_get_wifi_status"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.sreset_inprogress) { ++ rtw_hal_error_msg("sreset_inprogress"); ++ ret = _FAIL; ++ } ++#endif /* #ifdef DBG_CONFIG_ERROR_DETECT */ ++ ++#ifdef RTW_HALMAC ++ if (NULL == padapter->HalFunc.init_mac_register) { ++ rtw_hal_error_msg("init_mac_register"); ++ ret = _FAIL; ++ } ++ if (NULL == padapter->HalFunc.init_phy) { ++ rtw_hal_error_msg("init_phy"); ++ ret = _FAIL; ++ } ++#endif /* RTW_HALMAC */ ++#endif ++ return ret; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_mcc.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_mcc.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/hal_mcc.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_mcc.c 2018-02-11 21:44:27.152146162 +0200 +@@ -0,0 +1,1490 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2015 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ ******************************************************************************/ ++#ifdef CONFIG_MCC_MODE ++#define _HAL_MCC_C_ ++ ++#include /* PADAPTER */ ++#include /* mcc structure */ ++#include /* HAL_DATA */ ++#include /* power control */ ++ ++/* backup IQK value */ ++void rtw_hal_mcc_backup_IQK_val(PADAPTER padapter) ++{ ++ u8 take_care_iqk = _FALSE; ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, &take_care_iqk); ++ if (take_care_iqk == _TRUE && MCC_EN(padapter)) ++ rtw_hal_ch_sw_iqk_info_restore(padapter, CH_SW_USE_CASE_MCC); ++} ++ ++u8 rtw_hal_check_mcc_status(PADAPTER padapter, u8 mcc_status) ++{ ++ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); ++ ++ if (pmccobjpriv->mcc_status & (mcc_status)) ++ return _TRUE; ++ else ++ return _FALSE; ++} ++ ++void rtw_hal_set_mcc_status(PADAPTER padapter, u8 mcc_status) ++{ ++ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); ++ ++ pmccobjpriv->mcc_status |= (mcc_status); ++} ++ ++void rtw_hal_clear_mcc_status(PADAPTER padapter, u8 mcc_status) ++{ ++ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); ++ ++ pmccobjpriv->mcc_status &= (~mcc_status); ++} ++ ++static void rtw_hal_config_mcc_role_setting(PADAPTER padapter) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct mcc_obj_priv *pmccobjpriv = &(pdvobjpriv->mcc_objpriv); ++ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta = NULL; ++ struct registry_priv *preg = &padapter->registrypriv; ++ ++ /* GO/AP is 1nd order GC/STA is 2nd order */ ++ switch (pmccadapriv->role) { ++ case MCC_ROLE_STA: ++ case MCC_ROLE_GC: ++ pmccadapriv->order = 1; ++ pmccadapriv->mcc_duration = pmccobjpriv->duration; ++ ++ switch (pmlmeext->cur_bwmode) { ++ case CHANNEL_WIDTH_20: ++ /* ++ * target tx byte(bytes) = target tx tp(Mbits/sec) * 1024 * 1024 / 8 * (duration(ms) / 1024) ++ * = target tx tp(Mbits/sec) * 128 * duration(ms) ++ * note: ++ * target tx tp(Mbits/sec) * 1024 * 1024 / 8 ==> Mbits to bytes ++ * duration(ms) / 1024 ==> msec to sec ++ */ ++ pmccadapriv->mcc_target_tx_bytes_to_port = preg->rtw_mcc_sta_bw20_target_tx_tp * 128 * pmccadapriv->mcc_duration; ++ break; ++ case CHANNEL_WIDTH_40: ++ pmccadapriv->mcc_target_tx_bytes_to_port = preg->rtw_mcc_sta_bw40_target_tx_tp * 128 * pmccadapriv->mcc_duration; ++ break; ++ case CHANNEL_WIDTH_80: ++ pmccadapriv->mcc_target_tx_bytes_to_port = preg->rtw_mcc_sta_bw80_target_tx_tp * 128 * pmccadapriv->mcc_duration; ++ break; ++ case CHANNEL_WIDTH_160: ++ case CHANNEL_WIDTH_80_80: ++ RTW_INFO(FUNC_ADPT_FMT": not support bwmode = %d\n" ++ , FUNC_ADPT_ARG(padapter), pmlmeext->cur_bwmode); ++ break; ++ } ++ ++ /* assign used mac to avoid affecting RA */ ++ pmccadapriv->mgmt_queue_macid = MCC_ROLE_STA_GC_MGMT_QUEUE_MACID; ++ ++ psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); ++ if (psta) { ++ /* combine AP/GO macid and mgmt queue macid to bitmap */ ++ pmccadapriv->mcc_macid_bitmap = BIT(psta->mac_id) | BIT(pmccadapriv->mgmt_queue_macid); ++ } else { ++ RTW_INFO(FUNC_ADPT_FMT":AP/GO station info is NULL\n", FUNC_ADPT_ARG(padapter)); ++ rtw_warn_on(1); ++ } ++ break; ++ case MCC_ROLE_AP: ++ case MCC_ROLE_GO: ++ pmccadapriv->order = 0; ++ pmccadapriv->mcc_duration = 100 - pmccobjpriv->duration; /* 100 means beacon interval */ ++ ++ switch (pmlmeext->cur_bwmode) { ++ case CHANNEL_WIDTH_20: ++ pmccadapriv->mcc_target_tx_bytes_to_port = preg->rtw_mcc_ap_bw20_target_tx_tp * 128 * pmccadapriv->mcc_duration; ++ break; ++ case CHANNEL_WIDTH_40: ++ pmccadapriv->mcc_target_tx_bytes_to_port = preg->rtw_mcc_ap_bw40_target_tx_tp * 128 * pmccadapriv->mcc_duration; ++ break; ++ case CHANNEL_WIDTH_80: ++ pmccadapriv->mcc_target_tx_bytes_to_port = preg->rtw_mcc_ap_bw80_target_tx_tp * 128 * pmccadapriv->mcc_duration; ++ break; ++ case CHANNEL_WIDTH_160: ++ case CHANNEL_WIDTH_80_80: ++ RTW_INFO(FUNC_ADPT_FMT": not support bwmode = %d\n" ++ , FUNC_ADPT_ARG(padapter), pmlmeext->cur_bwmode); ++ break; ++ } ++ ++ ++ psta = rtw_get_bcmc_stainfo(padapter); ++ ++ if (psta != NULL) ++ pmccadapriv->mgmt_queue_macid = psta->mac_id; ++ else { ++ pmccadapriv->mgmt_queue_macid = MCC_ROLE_SOFTAP_GO_MGMT_QUEUE_MACID; ++ RTW_INFO(FUNC_ADPT_FMT":bcmc station is NULL, use macid %d\n" ++ , FUNC_ADPT_ARG(padapter), pmccadapriv->mgmt_queue_macid); ++ } ++ ++ /* combine client macid and mgmt queue macid to bitmap */ ++ pmccadapriv->mcc_macid_bitmap = (0xff << 8) | BIT(pmccadapriv->mgmt_queue_macid); ++ break; ++ default: ++ RTW_INFO("Unknown role\n"); ++ rtw_warn_on(1); ++ break; ++ } ++ ++ pmccobjpriv->iface[pmccadapriv->order] = padapter; ++ RTW_INFO(FUNC_ADPT_FMT": order:%d, role:%d, mcc duration:%d, target tx bytes:%d, mgmt queue macid:%d, bitmap:0x%02x\n" ++ , FUNC_ADPT_ARG(padapter), pmccadapriv->order, pmccadapriv->role, pmccadapriv->mcc_duration ++ , pmccadapriv->mcc_target_tx_bytes_to_port, pmccadapriv->mgmt_queue_macid, pmccadapriv->mcc_macid_bitmap); ++} ++ ++static void rtw_hal_clear_mcc_macid(PADAPTER padapter) ++{ ++ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; ++ ++ switch (pmccadapriv->role) { ++ case MCC_ROLE_STA: ++ case MCC_ROLE_GC: ++ /* release mgmt queue macid */ ++ rtw_hal_set_FwMediaStatusRpt_single_cmd(padapter ++ , 0, 0, 0, H2C_MSR_ROLE_AP, pmccadapriv->mgmt_queue_macid); ++ break; ++ case MCC_ROLE_AP: ++ case MCC_ROLE_GO: ++ /* nothing to do */ ++ break; ++ default: ++ RTW_INFO("Unknown role\n"); ++ rtw_warn_on(1); ++ break; ++ } ++} ++static u8 rtw_hal_decide_mcc_role(PADAPTER padapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ _adapter *iface = NULL; ++ struct mcc_adapter_priv *pmccadapriv = NULL; ++ struct wifidirect_info *pwdinfo = NULL; ++ struct mlme_priv *pmlmepriv = NULL; ++ u8 ret = _SUCCESS, i = 0; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (iface == NULL) ++ continue; ++ ++ pmccadapriv = &iface->mcc_adapterpriv; ++ ++ if (MLME_IS_GO(iface)) ++ pmccadapriv->role = MCC_ROLE_GO; ++ else if (MLME_IS_AP(iface)) ++ pmccadapriv->role = MCC_ROLE_AP; ++ else if (MLME_IS_GC(iface)) ++ pmccadapriv->role = MCC_ROLE_GC; ++ else if (MLME_IS_STA(iface)) ++ pmccadapriv->role = MCC_ROLE_STA; ++ else { ++ pwdinfo = &iface->wdinfo; ++ pmlmepriv = &iface->mlmepriv; ++ ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(iface)); ++ RTW_INFO("Unknown:P2P state:%d, mlme state:0x%2x, mlmext info state:0x%02x\n", ++ pwdinfo->role, pmlmepriv->fw_state, iface->mlmeextpriv.mlmext_info.state); ++ rtw_warn_on(1); ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ if (ret == _SUCCESS) ++ rtw_hal_config_mcc_role_setting(iface); ++ } ++ ++exit: ++ return ret; ++} ++ ++static void rtw_hal_init_mcc_parameter(PADAPTER padapter) ++{ ++} ++ ++static void rtw_hal_construct_CTS(PADAPTER padapter, u8 *pframe, u32 *pLength) ++{ ++ u8 broadcast_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ /* frame type, length = 1*/ ++ SetFrameSubType(pframe, WIFI_RTS); ++ ++ /* frame control flag, length = 1 */ ++ *(pframe + 1) = 0; ++ ++ /* frame duration, length = 2 */ ++ *(pframe + 2) = 0x00; ++ *(pframe + 3) = 0x78; ++ ++ /* frame recvaddr, length = 6 */ ++ _rtw_memcpy((pframe + 4), broadcast_addr, ETH_ALEN); ++ _rtw_memcpy((pframe + 4 + ETH_ALEN), adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy((pframe + 4 + ETH_ALEN * 2), adapter_mac_addr(padapter), ETH_ALEN); ++ *pLength = 22; ++} ++ ++u8 rtw_hal_dl_mcc_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 *index, ++ u8 tx_desc, u32 page_size, u8 *page_num, u32 *total_pkt_len, ++ RSVDPAGE_LOC *rsvd_page_loc) ++{ ++ u32 len = 0; ++ _adapter *iface = NULL; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); ++ struct mlme_ext_info *pmlmeinfo = NULL; ++ struct mlme_ext_priv *pmlmeext = NULL; ++ u8 ret = _SUCCESS, i = 0, order = 0, CurtPktPageNum = 0; ++ u8 bssid[ETH_ALEN] = {0}; ++ ++ /* check proccess mcc start setting */ ++ if (!rtw_hal_check_mcc_status(adapter, MCC_STATUS_PROCESS_MCC_START_SETTING)) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (iface == NULL) ++ continue; ++ ++ order = iface->mcc_adapterpriv.order; ++ dvobj->mcc_objpriv.mcc_loc_rsvd_paga[order] = *page_num; ++ ++ switch (iface->mcc_adapterpriv.role) { ++ case MCC_ROLE_STA: ++ case MCC_ROLE_GC: ++ /* Build NULL DATA */ ++ RTW_INFO("LocNull(order:%d): %d\n" ++ , order, dvobj->mcc_objpriv.mcc_loc_rsvd_paga[order]); ++ len = 0; ++ pmlmeext = &iface->mlmeextpriv; ++ pmlmeinfo = &pmlmeext->mlmext_info; ++ ++ _rtw_memcpy(bssid, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); ++ rtw_hal_construct_NullFunctionData(iface ++ , &pframe[*index], &len, bssid, _FALSE, 0, 0, _FALSE); ++ rtw_hal_fill_fake_txdesc(iface, &pframe[*index - tx_desc], ++ len, _FALSE, _FALSE, _FALSE); ++ ++ CurtPktPageNum = (u8)PageNum(tx_desc + len, page_size); ++ *page_num += CurtPktPageNum; ++ *index += (CurtPktPageNum * page_size); ++ *total_pkt_len = *index + len; ++ break; ++ case MCC_ROLE_AP: ++ /* Bulid CTS */ ++ RTW_INFO("LocCTS(order:%d): %d\n" ++ , order, dvobj->mcc_objpriv.mcc_loc_rsvd_paga[order]); ++ ++ len = 0; ++ rtw_hal_construct_CTS(iface, &pframe[*index], &len); ++ rtw_hal_fill_fake_txdesc(iface, &pframe[*index - tx_desc], ++ len, _FALSE, _FALSE, _FALSE); ++ ++ CurtPktPageNum = (u8)PageNum(tx_desc + len, page_size); ++ *page_num += CurtPktPageNum; ++ *index += (CurtPktPageNum * page_size); ++ *total_pkt_len = *index + len; ++ break; ++ case MCC_ROLE_GO: ++ /* To DO */ ++ break; ++ } ++ } ++exit: ++ return ret; ++} ++ ++/* ++* 1. Download MCC rsvd page ++* 2. Re-Download beacon after download rsvd page ++*/ ++static void rtw_hal_set_fw_mcc_rsvd_page(PADAPTER padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ PADAPTER port0_iface = dvobj_get_port0_adapter(dvobj); ++ PADAPTER iface = NULL; ++ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); ++ u8 mstatus = RT_MEDIA_CONNECT, i = 0; ++ ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ ++ rtw_hal_set_hwreg(port0_iface, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus)); ++ ++ /* Re-Download beacon */ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = pmccobjpriv->iface[i]; ++ pmccadapriv = &iface->mcc_adapterpriv; ++ if (pmccadapriv->role == MCC_ROLE_AP ++ || pmccadapriv->role == MCC_ROLE_GO) ++ tx_beacon_hdl(iface, NULL); ++ } ++} ++ ++static void rtw_hal_set_mcc_rsvdpage_cmd(_adapter *padapter) ++{ ++ u8 cmd[H2C_MCC_LOCATION_LEN] = {0}, i = 0, order = 0; ++ _adapter *iface = NULL; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); ++ ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (iface == NULL) ++ continue; ++ ++ order = iface->mcc_adapterpriv.order; ++ if (order >= H2C_MCC_LOCATION_LEN) { ++ RTW_INFO(FUNC_ADPT_FMT" only support 3 interface at most(%d)\n" ++ , FUNC_ADPT_ARG(padapter), order); ++ continue; ++ } ++ ++ SET_H2CCMD_MCC_RSVDPAGE_LOC((cmd + order), (pmccobjpriv->mcc_loc_rsvd_paga[order])); ++ } ++ ++#ifdef CONFIG_MCC_MODE_DEBUG ++ RTW_INFO("=========================\n"); ++ RTW_INFO("MCC RSVD PAGE LOC:\n"); ++ for (i = 0; i < H2C_MCC_LOCATION_LEN; i++) ++ pr_dbg("0x%x ", cmd[i]); ++ pr_dbg("\n"); ++ RTW_INFO("=========================\n"); ++#endif /* CONFIG_MCC_MODE_DEBUG */ ++ ++ rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_LOCATION, H2C_MCC_LOCATION_LEN, cmd); ++} ++ ++static void rtw_hal_set_mcc_noa_cmd(PADAPTER padapter) ++{ ++ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u8 cmd[H2C_MCC_NOA_PARAM_LEN] = {0}; ++ u8 noa_fw_eable = 1; ++ u8 noa_tsf_sync_offset = 50; ++ u8 noa_start_time = 30; ++ u8 noa_interval = pmlmepriv->cur_network.network.Configuration.BeaconPeriod; ++ u8 swchannel_early_time = MCC_SWCH_FW_EARLY_TIME; ++ u8 i = 0; ++ ++ /* FW set NOA enable */ ++ SET_H2CCMD_MCC_NOA_FW_EN(cmd, noa_fw_eable); ++ /* TSF Sync offset */ ++ SET_H2CCMD_MCC_NOA_TSF_SYNC_OFFSET(cmd, noa_tsf_sync_offset); ++ /* NoA start time offset */ ++ SET_H2CCMD_MCC_NOA_START_TIME(cmd, noa_start_time); ++ /* NoA interval */ ++ SET_H2CCMD_MCC_NOA_INTERVAL(cmd, noa_interval); ++ /* Early time to inform driver by C2H before switch channel */ ++ SET_H2CCMD_MCC_EARLY_TIME(cmd, swchannel_early_time); ++ ++#ifdef CONFIG_MCC_MODE_DEBUG ++ RTW_INFO("=========================\n"); ++ RTW_INFO("NoA:\n"); ++ for (i = 0; i < H2C_MCC_NOA_PARAM_LEN; i++) ++ pr_dbg("0x%x ", cmd[i]); ++ pr_dbg("\n"); ++ RTW_INFO("=========================\n"); ++#endif /* CONFIG_MCC_MODE_DEBUG */ ++ ++ rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_NOA_PARAM, H2C_MCC_NOA_PARAM_LEN, cmd); ++} ++ ++static void rtw_hal_set_mcc_IQK_offload_cmd(PADAPTER padapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct mcc_adapter_priv *pmccadapriv = NULL; ++ _adapter *iface = NULL; ++ u8 cmd[H2C_MCC_IQK_PARAM_LEN] = {0}, bready = 0, i = 0, order = 0; ++ u16 TX_X = 0, TX_Y = 0, RX_X = 0, RX_Y = 0; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (iface == NULL) ++ continue; ++ ++ pmccadapriv = &iface->mcc_adapterpriv; ++ order = pmccadapriv->order; ++ /* TO DO for multi-antenna(FW not support) */ ++ TX_X = pmccadapriv->mcc_iqk_arr[0].TX_X & 0x7ff;/* [10:0] */ ++ TX_Y = pmccadapriv->mcc_iqk_arr[0].TX_Y & 0x7ff;/* [10:0] */ ++ RX_X = pmccadapriv->mcc_iqk_arr[0].RX_X & 0x3ff;/* [9:0] */ ++ RX_Y = pmccadapriv->mcc_iqk_arr[0].RX_Y & 0x3ff;/* [9:0] */ ++ _rtw_memset(cmd, 0, H2C_MCC_IQK_PARAM_LEN); ++ ++ /* ready or not */ ++ if (order == 1) ++ bready = 1; ++ else ++ bready = 0; ++ ++ SET_H2CCMD_MCC_IQK_READY(cmd, bready); ++ SET_H2CCMD_MCC_IQK_ORDER(cmd, order); ++ ++ /* fill RX_X[7:0] to (cmd+1)[7:0] bitlen=8 */ ++ SET_H2CCMD_MCC_IQK_RX_L(cmd, (u8)(RX_X & 0xff)); ++ /* fill RX_X[9:8] to (cmd+2)[1:0] bitlen=2 */ ++ SET_H2CCMD_MCC_IQK_RX_M1(cmd, (u8)((RX_X >> 8) & 0x03)); ++ /* fill RX_Y[5:0] to (cmd+2)[7:2] bitlen=6 */ ++ SET_H2CCMD_MCC_IQK_RX_M2(cmd, (u8)(RX_Y & 0x3f)); ++ /* fill RX_Y[9:6] to (cmd+3)[3:0] bitlen=4 */ ++ SET_H2CCMD_MCC_IQK_RX_H(cmd, (u8)((RX_Y >> 6) & 0x0f)); ++ ++ ++ /* fill TX_X[7:0] to (cmd+4)[7:0] bitlen=8 */ ++ SET_H2CCMD_MCC_IQK_TX_L(cmd, (u8)(TX_X & 0xff)); ++ /* fill TX_X[10:8] to (cmd+5)[2:0] bitlen=3 */ ++ SET_H2CCMD_MCC_IQK_TX_M1(cmd, (u8)((TX_X >> 8) & 0x07)); ++ /* fill TX_Y[4:0] to (cmd+5)[7:3] bitlen=5 */ ++ SET_H2CCMD_MCC_IQK_TX_M2(cmd, (u8)(TX_Y & 0x1f)); ++ /* fill TX_Y[10:5] to (cmd+6)[5:0] bitlen=6 */ ++ SET_H2CCMD_MCC_IQK_TX_H(cmd, (u8)((TX_Y >> 5) & 0x3f)); ++ ++#ifdef CONFIG_MCC_MODE_DEBUG ++ RTW_INFO("=========================\n"); ++ RTW_INFO(FUNC_ADPT_FMT" IQK:\n", FUNC_ADPT_ARG(iface)); ++ RTW_INFO("TX_X: 0x%02x\n", TX_X); ++ RTW_INFO("TX_Y: 0x%02x\n", TX_Y); ++ RTW_INFO("RX_X: 0x%02x\n", RX_X); ++ RTW_INFO("RX_Y: 0x%02x\n", RX_Y); ++ RTW_INFO("cmd[0]:0x%02x\n", cmd[0]); ++ RTW_INFO("cmd[1]:0x%02x\n", cmd[1]); ++ RTW_INFO("cmd[2]:0x%02x\n", cmd[2]); ++ RTW_INFO("cmd[3]:0x%02x\n", cmd[3]); ++ RTW_INFO("cmd[4]:0x%02x\n", cmd[4]); ++ RTW_INFO("cmd[5]:0x%02x\n", cmd[5]); ++ RTW_INFO("cmd[6]:0x%02x\n", cmd[6]); ++ RTW_INFO("=========================\n"); ++#endif /* CONFIG_MCC_MODE_DEBUG */ ++ ++ rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_IQK_PARAM, H2C_MCC_IQK_PARAM_LEN, cmd); ++ } ++} ++ ++ ++static void rtw_hal_set_mcc_macid_cmd(PADAPTER padapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct mcc_adapter_priv *pmccadapriv = NULL; ++ _adapter *iface = NULL; ++ u8 cmd[H2C_MCC_MACID_BITMAP_LEN] = {0}, i = 0, order = 0; ++ u16 bitmap = 0; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (iface == NULL) ++ continue; ++ ++ pmccadapriv = &iface->mcc_adapterpriv; ++ order = pmccadapriv->order; ++ bitmap = pmccadapriv->mcc_macid_bitmap; ++ ++ if (order >= (H2C_MCC_MACID_BITMAP_LEN / 2)) { ++ RTW_INFO(FUNC_ADPT_FMT" only support 3 interface at most(%d)\n" ++ , FUNC_ADPT_ARG(padapter), order); ++ continue; ++ } ++ SET_H2CCMD_MCC_MACID_BITMAP_L((cmd + order * 2), (u8)(bitmap & 0xff)); ++ SET_H2CCMD_MCC_MACID_BITMAP_H((cmd + order * 2), (u8)((bitmap >> 8) & 0xff)); ++ } ++ ++#ifdef CONFIG_MCC_MODE_DEBUG ++ RTW_INFO("=========================\n"); ++ RTW_INFO("MACID BITMAP: "); ++ for (i = 0; i < H2C_MCC_MACID_BITMAP_LEN; i++) ++ pr_dbg("0x%x ", cmd[i]); ++ pr_dbg("\n"); ++ RTW_INFO("=========================\n"); ++#endif /* CONFIG_MCC_MODE_DEBUG */ ++ rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_MACID_BITMAP, H2C_MCC_MACID_BITMAP_LEN, cmd); ++} ++ ++static void rtw_hal_set_mcc_parameter_cmd(PADAPTER padapter, u8 stop) ++{ ++ u8 cmd[H2C_MCC_INFO_LEN] = {0}, i = 0; ++ u8 order = 0, totalnum = 0, chidx = 0, bw = 0, bw40sc = 0, bw80sc = 0; ++ u8 duration = 0, role = 0, incurch = 0, rfetype = 0, distxnull = 0, c2hrpt = 0, chscan = 0; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); ++ struct mlme_ext_priv *pmlmeext = NULL; ++ struct mlme_ext_info *pmlmeinfo = NULL; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ _adapter *iface = NULL; ++ ++ RTW_INFO(FUNC_ADPT_FMT": stop=%d\n", FUNC_ADPT_ARG(padapter), stop); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = pmccobjpriv->iface[i]; ++ if (iface == NULL) ++ continue; ++ ++ if (stop) { ++ if (iface != padapter) ++ continue; ++ } ++ ++ ++ order = iface->mcc_adapterpriv.order; ++ if (!stop) ++ totalnum = dvobj->iface_nums; ++ else ++ totalnum = 0xff; /* 0xff means stop */ ++ ++ pmlmeext = &iface->mlmeextpriv; ++ chidx = pmlmeext->cur_channel; ++ bw = pmlmeext->cur_bwmode; ++ bw40sc = pmlmeext->cur_ch_offset; ++ ++ /* decide 80 band width offset */ ++ if (bw == CHANNEL_WIDTH_80) { ++ u8 center_ch = rtw_get_center_ch(chidx, bw, bw40sc); ++ ++ if (center_ch > chidx) ++ bw80sc = HAL_PRIME_CHNL_OFFSET_LOWER; ++ else if (center_ch < chidx) ++ bw80sc = HAL_PRIME_CHNL_OFFSET_UPPER; ++ else ++ bw80sc = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ } else ++ bw80sc = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ duration = iface->mcc_adapterpriv.mcc_duration; ++ role = iface->mcc_adapterpriv.role; ++ ++ incurch = _FALSE; ++ ++ if (IS_HARDWARE_TYPE_8812(padapter)) ++ rfetype = pHalData->RFEType; /* RFETYPE (only for 8812)*/ ++ else ++ rfetype = 0; ++ ++ /* STA/GC TX NULL data to inform AP/GC for ps mode */ ++ switch (role) { ++ case MCC_ROLE_GO: ++ case MCC_ROLE_AP: ++ distxnull = MCC_DISABLE_TX_NULL; ++ break; ++ case MCC_ROLE_GC: ++ case MCC_ROLE_STA: ++ distxnull = MCC_ENABLE_TX_NULL; ++ break; ++ } ++ ++ c2hrpt = MCC_C2H_REPORT_ALL_STATUS; ++ chscan = MCC_CHIDX; ++ ++ SET_H2CCMD_MCC_INFO_ORDER(cmd, order); ++ SET_H2CCMD_MCC_INFO_TOTALNUM(cmd, totalnum); ++ SET_H2CCMD_MCC_INFO_CHIDX(cmd, chidx); ++ SET_H2CCMD_MCC_INFO_BW(cmd, bw); ++ SET_H2CCMD_MCC_INFO_BW40SC(cmd, bw40sc); ++ SET_H2CCMD_MCC_INFO_BW80SC(cmd, bw80sc); ++ SET_H2CCMD_MCC_INFO_DURATION(cmd, duration); ++ SET_H2CCMD_MCC_INFO_ROLE(cmd, role); ++ SET_H2CCMD_MCC_INFO_INCURCH(cmd, incurch); ++ SET_H2CCMD_MCC_INFO_RFETYPE(cmd, rfetype); ++ SET_H2CCMD_MCC_INFO_DISTXNULL(cmd, distxnull); ++ SET_H2CCMD_MCC_INFO_C2HRPT(cmd, c2hrpt); ++ SET_H2CCMD_MCC_INFO_CHSCAN(cmd, chscan); ++ ++#ifdef CONFIG_MCC_MODE_DEBUG ++ RTW_INFO("=========================\n"); ++ RTW_INFO(FUNC_ADPT_FMT" MCC INFO:\n", FUNC_ADPT_ARG(iface)); ++ RTW_INFO("cmd[0]:0x%02x\n", cmd[0]); ++ RTW_INFO("cmd[1]:0x%02x\n", cmd[1]); ++ RTW_INFO("cmd[2]:0x%02x\n", cmd[2]); ++ RTW_INFO("cmd[3]:0x%02x\n", cmd[3]); ++ RTW_INFO("cmd[4]:0x%02x\n", cmd[4]); ++ RTW_INFO("cmd[5]:0x%02x\n", cmd[5]); ++ RTW_INFO("cmd[6]:0x%02x\n", cmd[6]); ++ RTW_INFO("=========================\n"); ++#endif /* CONFIG_MCC_MODE_DEBUG */ ++ ++ rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_INFO, H2C_MCC_INFO_LEN, cmd); ++ } ++} ++ ++static u8 rtw_hal_set_mcc_start_setting(PADAPTER padapter, u8 status) ++{ ++ u8 ret = _SUCCESS; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); ++ ++ if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) { ++ rtw_warn_on(1); ++ RTW_INFO("PS mode is not active before start mcc, force exit ps mode\n"); ++ LeaveAllPowerSaveModeDirect(padapter); ++ } ++ ++ if (dvobj->iface_nums > MAX_MCC_NUM) { ++ RTW_INFO("%s: current iface num(%d) > MAX_MCC_NUM(%d)\n", __func__, dvobj->iface_nums, MAX_MCC_NUM); ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ if (rtw_hal_decide_mcc_role(padapter) == _FAIL) { ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* set mcc status to indicate process mcc start setting */ ++ rtw_hal_set_mcc_status(padapter, MCC_STATUS_PROCESS_MCC_START_SETTING); ++ ++ /* only download rsvd page for connect */ ++ if (status == MCC_SETCMD_STATUS_START_CONNECT) { ++ /* download mcc rsvd page */ ++ rtw_hal_set_fw_mcc_rsvd_page(padapter); ++ rtw_hal_set_mcc_rsvdpage_cmd(padapter); ++ } ++ ++ /* configure NoA setting */ ++ rtw_hal_set_mcc_noa_cmd(padapter); ++ ++ /* IQK value offload */ ++ rtw_hal_set_mcc_IQK_offload_cmd(padapter); ++ ++ /* set mac id to fw */ ++ rtw_hal_set_mcc_macid_cmd(padapter); ++ ++ /* set mcc parameter */ ++ rtw_hal_set_mcc_parameter_cmd(padapter, _FALSE); ++ ++exit: ++ return ret; ++} ++ ++static void rtw_hal_set_mcc_stop_setting(PADAPTER padapter, u8 status) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ _adapter *iface = NULL; ++ u8 i = 0; ++ /* ++ * when adapter disconnect, stop mcc mod ++ * total=0xf means stop mcc mode ++ */ ++ ++ switch (status) { ++ default: ++ /* let fw switch to other interface channel */ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (iface == NULL) ++ continue; ++ /* use other interface to set cmd */ ++ if (iface != padapter) { ++ rtw_hal_set_mcc_parameter_cmd(iface, _TRUE); ++ break; ++ } ++ } ++ break; ++ } ++} ++ ++static void rtw_hal_mcc_status_hdl(PADAPTER padapter, u8 status) ++{ ++ switch (status) { ++ case MCC_SETCMD_STATUS_STOP_DISCONNECT: ++ rtw_hal_clear_mcc_status(padapter, MCC_STATUS_NEED_MCC | MCC_STATUS_DOING_MCC); ++ break; ++ case MCC_SETCMD_STATUS_STOP_SCAN_START: ++ rtw_hal_set_mcc_status(padapter, MCC_STATUS_NEED_MCC); ++ rtw_hal_clear_mcc_status(padapter, MCC_STATUS_DOING_MCC); ++ break; ++ ++ case MCC_SETCMD_STATUS_START_CONNECT: ++ case MCC_SETCMD_STATUS_START_SCAN_DONE: ++ rtw_hal_set_mcc_status(padapter, MCC_STATUS_NEED_MCC | MCC_STATUS_DOING_MCC); ++ break; ++ default: ++ RTW_INFO(FUNC_ADPT_FMT" error status(%d)\n", FUNC_ADPT_ARG(padapter), status); ++ break; ++ } ++} ++ ++static void rtw_hal_mcc_stop_posthdl(PADAPTER padapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ _adapter *iface = NULL; ++ u8 i = 0; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (iface == NULL) ++ continue; ++ /* release network queue */ ++ rtw_netif_wake_queue(iface->pnetdev); ++ iface->mcc_adapterpriv.mcc_tx_bytes_from_kernel = 0; ++ iface->mcc_adapterpriv.mcc_last_tx_bytes_from_kernel = 0; ++ iface->mcc_adapterpriv.mcc_tx_bytes_to_port = 0; ++ } ++} ++ ++static void rtw_hal_mcc_start_posthdl(PADAPTER padapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ _adapter *iface = NULL; ++ u8 i = 0; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (iface == NULL) ++ continue; ++ iface->mcc_adapterpriv.mcc_tx_bytes_from_kernel = 0; ++ iface->mcc_adapterpriv.mcc_last_tx_bytes_from_kernel = 0; ++ iface->mcc_adapterpriv.mcc_tx_bytes_to_port = 0; ++ } ++} ++ ++/* ++ * rtw_hal_set_mcc_setting - set mcc setting ++ * @padapter: currnet padapter to stop/start MCC ++ * @stop: stop mcc or not ++ * @return val: 1 for SUCCESS, 0 for fail ++ */ ++static u8 rtw_hal_set_mcc_setting(PADAPTER padapter, u8 status) ++{ ++ u8 ret = _FAIL; ++ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); ++ u8 stop = (status < MCC_SETCMD_STATUS_START_CONNECT) ? _TRUE : _FALSE; ++ u32 start_time = rtw_get_current_time(); ++ ++ RTW_INFO("===> "FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ ++ rtw_sctx_init(&pmccobjpriv->mcc_sctx, MCC_EXPIRE_TIME); ++ pmccobjpriv->mcc_c2h_status = MCC_RPT_MAX; ++ ++ if (stop == _FALSE) { ++ pmccobjpriv->duration = MCC_DURATION; ++ ++ /* handle mcc start */ ++ if (rtw_hal_set_mcc_start_setting(padapter, status) == _FAIL) ++ goto exit; ++ ++ /* wait for C2H */ ++ if (!rtw_sctx_wait(&pmccobjpriv->mcc_sctx, __func__)) ++ RTW_INFO(FUNC_ADPT_FMT": wait for mcc start C2H time out\n", FUNC_ADPT_ARG(padapter)); ++ else ++ ret = _SUCCESS; ++ ++ if (ret == _SUCCESS) { ++ RTW_INFO(FUNC_ADPT_FMT": mcc start sucecssfully\n", FUNC_ADPT_ARG(padapter)); ++ rtw_hal_mcc_start_posthdl(padapter); ++ } ++ } else { ++ ++ /* set mcc status to indicate process mcc start setting */ ++ rtw_hal_set_mcc_status(padapter, MCC_STATUS_PROCESS_MCC_STOP_SETTING); ++ ++ /* handle mcc stop */ ++ rtw_hal_set_mcc_stop_setting(padapter, status); ++ ++ /* wait for C2H */ ++ if (!rtw_sctx_wait(&pmccobjpriv->mcc_sctx, __func__)) ++ RTW_INFO(FUNC_ADPT_FMT": wait for mcc stop C2H time out\n", FUNC_ADPT_ARG(padapter)); ++ else { ++ ret = _SUCCESS; ++ rtw_hal_mcc_stop_posthdl(padapter); ++ } ++ } ++ ++exit: ++ ++ rtw_hal_mcc_status_hdl(padapter, status); ++ /* clear mcc status */ ++ rtw_hal_clear_mcc_status(padapter ++ , MCC_STATUS_PROCESS_MCC_START_SETTING | MCC_STATUS_PROCESS_MCC_STOP_SETTING); ++ ++ RTW_INFO(FUNC_ADPT_FMT" in %dms <===\n" ++ , FUNC_ADPT_ARG(padapter), rtw_get_passing_time_ms(start_time)); ++ return ret; ++} ++ ++/** ++ * rtw_hal_mcc_check_case_not_limit_traffic - handler flow ctrl for special case ++ * @cur_iface: fw stay channel setting of this iface ++ * @next_iface: fw will swich channel setting of this iface ++ */ ++static void rtw_hal_mcc_check_case_not_limit_traffic(PADAPTER cur_iface, PADAPTER next_iface) ++{ ++ u8 cur_bw = cur_iface->mlmeextpriv.cur_bwmode; ++ u8 next_bw = next_iface->mlmeextpriv.cur_bwmode; ++ ++ /* for both interface are VHT80, doesn't limit_traffic according to iperf results */ ++ if (cur_bw == CHANNEL_WIDTH_80 && next_bw == CHANNEL_WIDTH_80) { ++ cur_iface->mcc_adapterpriv.mcc_tp_limit = _FALSE; ++ next_iface->mcc_adapterpriv.mcc_tp_limit = _FALSE; ++ } ++} ++ ++ ++/** ++ * rtw_hal_mcc_sw_ch_fw_notify_hdl - handler flow ctrl ++ */ ++static void rtw_hal_mcc_sw_ch_fw_notify_hdl(PADAPTER padapter) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); ++ struct mcc_adapter_priv *cur_mccadapriv = NULL, *next_mccadapriv = NULL; ++ _adapter *iface = NULL, *cur_iface = NULL, *next_iface = NULL; ++ struct registry_priv *preg = &padapter->registrypriv; ++ u8 cur_op_ch = pdvobjpriv->oper_channel; ++ u8 i = 0, iface_num = pdvobjpriv->iface_nums, cur_order = 0, next_order = 0; ++ static u8 cnt = 1; ++ u32 single_tx_cri = preg->rtw_mcc_single_tx_cri; ++ ++ for (i = 0; i < iface_num; i++) { ++ iface = pdvobjpriv->padapters[i]; ++ if (cur_op_ch == iface->mlmeextpriv.cur_channel) { ++ cur_iface = iface; ++ cur_mccadapriv = &cur_iface->mcc_adapterpriv; ++ cur_order = cur_mccadapriv->order; ++ next_order = (cur_order + 1) % iface_num; ++ next_iface = pmccobjpriv->iface[next_order]; ++ next_mccadapriv = &next_iface->mcc_adapterpriv; ++ break; ++ } ++ } ++ ++ /* check other interface tx busy traffic or not under every 2 switch channel notify(Mbits/100ms) */ ++ if (cnt == 2) { ++ cur_mccadapriv->mcc_tp = (cur_mccadapriv->mcc_tx_bytes_from_kernel ++ - cur_mccadapriv->mcc_last_tx_bytes_from_kernel) * 10 * 8 / 1024 / 1024; ++ cur_mccadapriv->mcc_last_tx_bytes_from_kernel = cur_mccadapriv->mcc_tx_bytes_from_kernel; ++ ++ next_mccadapriv->mcc_tp = (next_mccadapriv->mcc_tx_bytes_from_kernel ++ - next_mccadapriv->mcc_last_tx_bytes_from_kernel) * 10 * 8 / 1024 / 1024; ++ next_mccadapriv->mcc_last_tx_bytes_from_kernel = next_mccadapriv->mcc_tx_bytes_from_kernel; ++ ++ cnt = 1; ++ } else ++ cnt = 2; ++ ++ /* check single TX or cuncurrnet TX */ ++ if (next_mccadapriv->mcc_tp < single_tx_cri) { ++ /* single TX, does not stop */ ++ cur_mccadapriv->mcc_tx_stop = _FALSE; ++ cur_mccadapriv->mcc_tp_limit = _FALSE; ++ } else { ++ /* concurrent TX, stop */ ++ cur_mccadapriv->mcc_tx_stop = _TRUE; ++ cur_mccadapriv->mcc_tp_limit = _TRUE; ++ } ++ ++ if (cur_mccadapriv->mcc_tp < single_tx_cri) { ++ next_mccadapriv->mcc_tx_stop = _FALSE; ++ next_mccadapriv->mcc_tp_limit = _FALSE; ++ } else { ++ next_mccadapriv->mcc_tx_stop = _FALSE; ++ next_mccadapriv->mcc_tp_limit = _TRUE; ++ next_mccadapriv->mcc_tx_bytes_to_port = 0; ++ } ++ ++ /* stop current iface kernel queue or not */ ++ if (cur_mccadapriv->mcc_tx_stop) ++ rtw_netif_stop_queue(cur_iface->pnetdev); ++ else ++ rtw_netif_wake_queue(cur_iface->pnetdev); ++ ++ /* stop next iface kernel queue or not */ ++ if (next_mccadapriv->mcc_tx_stop) ++ rtw_netif_stop_queue(next_iface->pnetdev); ++ else ++ rtw_netif_wake_queue(next_iface->pnetdev); ++ ++ /* start xmit tasklet */ ++ rtw_os_xmit_schedule(next_iface); ++ ++ rtw_hal_mcc_check_case_not_limit_traffic(cur_iface, next_iface); ++ ++ if (0) { ++ RTW_INFO("order:%d, mcc_tx_stop:%d, mcc_tp:%d\n", ++ cur_mccadapriv->order, cur_mccadapriv->mcc_tx_stop, cur_mccadapriv->mcc_tp); ++ dump_os_queue(0, cur_iface); ++ RTW_INFO("order:%d, mcc_tx_stop:%d, mcc_tp:%d\n", ++ next_mccadapriv->order, next_mccadapriv->mcc_tx_stop, next_mccadapriv->mcc_tp); ++ dump_os_queue(0, next_iface); ++ } ++} ++ ++/** ++ * rtw_hal_mcc_c2h_handler - mcc c2h handler ++ */ ++void rtw_hal_mcc_c2h_handler(PADAPTER padapter, u8 buflen, u8 *tmpBuf) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); ++ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; ++ struct submit_ctx *mcc_sctx = &pmccobjpriv->mcc_sctx; ++ _irqL irqL; ++ ++ /* RTW_INFO("[length]=%d, [C2H data]="MAC_FMT"\n", buflen, MAC_ARG(tmpBuf)); */ ++ /* To avoid reg is set, but driver recive c2h to set wrong oper_channel */ ++ if (MCC_RPT_STOPMCC == pmccobjpriv->mcc_c2h_status) { ++ RTW_INFO(FUNC_ADPT_FMT" MCC alread stops return\n", FUNC_ADPT_ARG(padapter)); ++ return; ++ } ++ ++ pmccobjpriv->mcc_c2h_status = tmpBuf[0]; ++ switch (pmccobjpriv->mcc_c2h_status) { ++ case MCC_RPT_SUCCESS: ++ pdvobjpriv->oper_channel = tmpBuf[1]; ++ _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); ++ pmccobjpriv->cur_mcc_success_cnt++; ++ _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); ++ break; ++ case MCC_RPT_TXNULL_FAIL: ++ RTW_INFO("[MCC] TXNULL FAIL\n"); ++ break; ++ case MCC_RPT_STOPMCC: ++ RTW_INFO("[MCC] MCC stop (time:%d)\n", rtw_get_current_time()); ++ pmccobjpriv->mcc_c2h_status = MCC_RPT_STOPMCC; ++ rtw_sctx_done(&mcc_sctx); ++ break; ++ case MCC_RPT_READY: ++ _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); ++ /* initialize counter & time */ ++ pmccobjpriv->mcc_launch_time = rtw_get_current_time(); ++ pmccobjpriv->mcc_c2h_status = MCC_RPT_READY; ++ pmccobjpriv->cur_mcc_success_cnt = 0; ++ pmccobjpriv->prev_mcc_success_cnt = 0; ++ pmccobjpriv->mcc_tolerance_time = MCC_TOLERANCE_TIME; ++ _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); ++ ++ RTW_INFO("[MCC] MCC ready (time:%d)\n", pmccobjpriv->mcc_launch_time); ++ rtw_sctx_done(&mcc_sctx); ++ break; ++ case MCC_RPT_SWICH_CHANNEL_NOTIFY: ++ pdvobjpriv->oper_channel = tmpBuf[1]; ++ rtw_hal_mcc_sw_ch_fw_notify_hdl(padapter); ++ break; ++ default: ++ /* RTW_INFO("[MCC] Other MCC status(%d)\n", pmccobjpriv->mcc_c2h_status); */ ++ break; ++ } ++} ++ ++ ++/** ++ * rtw_hal_mcc_sw_status_check - check mcc swich channel status ++ * @padapter: primary adapter ++ */ ++void rtw_hal_mcc_sw_status_check(PADAPTER padapter) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); ++ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); ++ u8 cur_cnt = 0, prev_cnt = 0, diff_cnt = 0, check_ret = _FAIL; ++ _irqL irqL; ++ ++ /* #define MCC_RESTART 1 */ ++ ++ if (!MCC_EN(padapter)) ++ return; ++ ++ _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); ++ ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { ++ ++ if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) { ++ rtw_warn_on(1); ++ RTW_INFO("PS mode is not active under mcc, force exit ps mode\n"); ++ LeaveAllPowerSaveModeDirect(padapter); ++ } ++ ++ if (rtw_get_passing_time_ms(pmccobjpriv->mcc_launch_time) > 2000) { ++ _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); ++ ++ cur_cnt = pmccobjpriv->cur_mcc_success_cnt; ++ prev_cnt = pmccobjpriv->prev_mcc_success_cnt; ++ if (cur_cnt < prev_cnt) ++ diff_cnt = (cur_cnt + 255) - prev_cnt; ++ else ++ diff_cnt = cur_cnt - prev_cnt; ++ ++ if (diff_cnt < 30) { ++ pmccobjpriv->mcc_tolerance_time--; ++ RTW_INFO("%s: diff_cnt:%d, tolerance_time:%d\n", ++ __func__, diff_cnt, pmccobjpriv->mcc_tolerance_time); ++ } else ++ pmccobjpriv->mcc_tolerance_time = MCC_TOLERANCE_TIME; ++ ++ pmccobjpriv->prev_mcc_success_cnt = pmccobjpriv->cur_mcc_success_cnt; ++ ++ if (pmccobjpriv->mcc_tolerance_time != 0) ++ check_ret = _SUCCESS; ++ ++ _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); ++ ++ if (check_ret != _SUCCESS) { ++ RTW_INFO("============ MCC swich channel check fail (%d)=============\n", diff_cnt); ++ /* restart MCC */ ++#ifdef MCC_RESTART ++ rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_STOP_DISCONNECT); ++ rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_CONNECT); ++#endif /* MCC_RESTART */ ++ } ++ } else { ++ _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); ++ pmccobjpriv->prev_mcc_success_cnt = pmccobjpriv->cur_mcc_success_cnt; ++ _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); ++ } ++ ++ } ++ _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); ++} ++ ++/** ++ * rtw_hal_mcc_change_scan_flag - change scan flag under mcc ++ * ++ * MCC mode under sitesurvey goto AP channel to tx bcn & data ++ * MCC mode under sitesurvey doesn't support TX data for station mode (FW not support) ++ * ++ * @padapter: the adapter to be change scan flag ++ * @ch: pointer to rerurn ch ++ * @bw: pointer to rerurn bw ++ * @offset: pointer to rerurn offset ++ */ ++u8 rtw_hal_mcc_change_scan_flag(PADAPTER padapter, u8 *ch, u8 *bw, u8 *offset) ++{ ++ u8 need_ch_setting_union = _TRUE, i = 0, flags = 0, role = 0; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct mcc_adapter_priv *pmccadapriv = NULL; ++ struct mlme_ext_priv *pmlmeext = NULL; ++ ++ if (!MCC_EN(padapter)) ++ goto exit; ++ ++ if (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) ++ goto exit; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ if (!dvobj->padapters[i]) ++ continue; ++ ++ pmlmeext = &dvobj->padapters[i]->mlmeextpriv; ++ pmccadapriv = &dvobj->padapters[i]->mcc_adapterpriv; ++ role = pmccadapriv->role; ++ ++ switch (role) { ++ case MCC_ROLE_AP: ++ case MCC_ROLE_GO: ++ *ch = pmlmeext->cur_channel; ++ *bw = pmlmeext->cur_bwmode; ++ *offset = pmlmeext->cur_ch_offset; ++ need_ch_setting_union = _FALSE; ++ break; ++ case MCC_ROLE_STA: ++ case MCC_ROLE_GC: ++ break; ++ default: ++ RTW_INFO("unknown role\n"); ++ rtw_warn_on(1); ++ break; ++ } ++ ++ /* check other scan flag */ ++ flags = mlmeext_scan_backop_flags(pmlmeext); ++ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC)) ++ flags &= ~SS_BACKOP_PS_ANNC; ++ ++ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_TX_RESUME)) ++ flags &= ~SS_BACKOP_TX_RESUME; ++ ++ mlmeext_assign_scan_backop_flags(pmlmeext, flags); ++ ++ } ++exit: ++ return need_ch_setting_union; ++} ++ ++/** ++ * rtw_hal_mcc_calc_tx_bytes_from_kernel - calculte tx bytes from kernel to check concurrent tx or not ++ * @padapter: the adapter to be record tx bytes ++ * @len: data len ++ */ ++inline void rtw_hal_mcc_calc_tx_bytes_from_kernel(PADAPTER padapter, u32 len) ++{ ++ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; ++ ++ if (MCC_EN(padapter)) { ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { ++ pmccadapriv->mcc_tx_bytes_from_kernel += len; ++ if (0) ++ RTW_INFO("%s(order:%d): mcc tx bytes from kernel:%lld\n" ++ , __func__, pmccadapriv->order, pmccadapriv->mcc_tx_bytes_from_kernel); ++ } ++ } ++} ++ ++/** ++ * rtw_hal_mcc_calc_tx_bytes_to_port - calculte tx bytes to write port in order to flow crtl ++ * @padapter: the adapter to be record tx bytes ++ * @len: data len ++ */ ++inline void rtw_hal_mcc_calc_tx_bytes_to_port(PADAPTER padapter, u32 len) ++{ ++ if (MCC_EN(padapter)) { ++ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); ++ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; ++ ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) ++ pmccadapriv->mcc_tx_bytes_to_port += len; ++ if (0) ++ RTW_INFO("%s(order:%d): mcc tx bytes to port:%d, mcc target tx bytes to port:%d\n" ++ , __func__, pmccadapriv->order, pmccadapriv->mcc_tx_bytes_to_port ++ , pmccadapriv->mcc_target_tx_bytes_to_port); ++ } ++} ++ ++/** ++ * rtw_hal_mcc_stop_tx_bytes_to_port - stop write port to hw or not ++ * @padapter: the adapter to be stopped ++ */ ++inline u8 rtw_hal_mcc_stop_tx_bytes_to_port(PADAPTER padapter) ++{ ++ if (MCC_EN(padapter)) { ++ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); ++ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; ++ ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { ++ if (pmccadapriv->mcc_tp_limit) { ++ if (pmccadapriv->mcc_tx_bytes_to_port >= pmccadapriv->mcc_target_tx_bytes_to_port) { ++ pmccadapriv->mcc_tx_stop = _TRUE; ++ rtw_netif_stop_queue(padapter->pnetdev); ++ return _TRUE; ++ } ++ } ++ } ++ } ++ ++ return _FALSE; ++} ++ ++/** ++ * rtw_hal_set_mcc_setting_scan_start - setting mcc under scan start ++ * @padapter: the adapter to be setted ++ * @ch_setting_changed: softap channel setting to be changed or not ++ */ ++u8 rtw_hal_set_mcc_setting_scan_start(PADAPTER padapter) ++{ ++ u8 ret = _FAIL; ++ ++ if (MCC_EN(padapter)) { ++ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); ++ ++ _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) { ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { ++ ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_STOP_SCAN_START); ++ /* issue null data to all station connected to AP before scan */ ++ rtw_hal_mcc_issue_null_data(padapter, 0, 1); ++ } ++ } ++ _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); ++ } ++ ++ return ret; ++} ++ ++/** ++ * rtw_hal_set_mcc_setting_scan_complete - setting mcc after scan commplete ++ * @padapter: the adapter to be setted ++ * @ch_setting_changed: softap channel setting to be changed or not ++ */ ++u8 rtw_hal_set_mcc_setting_scan_complete(PADAPTER padapter) ++{ ++ u8 ret = _FAIL; ++ ++ if (MCC_EN(padapter)) { ++ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); ++ ++ _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); ++ ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) ++ ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_SCAN_DONE); ++ ++ _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); ++ } ++ ++ return ret; ++} ++ ++ ++/** ++ * rtw_hal_set_mcc_setting_start_bss_network - setting mcc under softap start ++ * @padapter: the adapter to be setted ++ * @chbw_grouped: channel bw offset can not be allowed or not ++ */ ++u8 rtw_hal_set_mcc_setting_start_bss_network(PADAPTER padapter, u8 chbw_allow) ++{ ++ u8 ret = _FAIL; ++ ++ if (MCC_EN(padapter)) { ++ /* channel bw offset can not be allowed, start MCC */ ++ if (chbw_allow == _FALSE) { ++ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); ++ ++ rtw_hal_mcc_backup_IQK_val(padapter); ++ _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); ++ ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_CONNECT); ++ _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); ++ } ++ } ++ ++ return ret; ++} ++ ++/** ++ * rtw_hal_set_mcc_setting_disconnect - setting mcc under mlme disconnect(stop softap/disconnect from AP) ++ * @padapter: the adapter to be setted ++ */ ++u8 rtw_hal_set_mcc_setting_disconnect(PADAPTER padapter) ++{ ++ u8 ret = _FAIL; ++ ++ if (MCC_EN(padapter)) { ++ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); ++ ++ _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) { ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) ++ ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_STOP_DISCONNECT); ++ } ++ _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); ++ } ++ ++ return ret; ++} ++ ++/** ++ * rtw_hal_set_mcc_setting_join_done_chk_ch - setting mcc under join done ++ * @padapter: the adapter to be checked ++ */ ++u8 rtw_hal_set_mcc_setting_join_done_chk_ch(PADAPTER padapter) ++{ ++ u8 ret = _FAIL; ++ ++ if (MCC_EN(padapter)) { ++ struct mi_state mstate; ++ ++ rtw_mi_status_no_self(padapter, &mstate); ++ ++ if (MSTATE_STA_LD_NUM(&mstate) || MSTATE_STA_LG_NUM(&mstate) || MSTATE_AP_NUM(&mstate)) { ++ bool chbw_allow = _TRUE; ++ u8 u_ch, u_offset, u_bw; ++ struct mlme_ext_priv *cur_mlmeext = &padapter->mlmeextpriv; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ ++ if (rtw_mi_get_ch_setting_union_no_self(padapter, &u_ch, &u_bw, &u_offset) <= 0) { ++ dump_adapters_status(RTW_DBGDUMP , dvobj); ++ rtw_warn_on(1); ++ } ++ RTW_INFO(FUNC_ADPT_FMT" union no self: %u,%u,%u\n" ++ , FUNC_ADPT_ARG(padapter), u_ch, u_bw, u_offset); ++ ++ /* chbw_allow? */ ++ chbw_allow = rtw_is_chbw_grouped(cur_mlmeext->cur_channel ++ , cur_mlmeext->cur_bwmode, cur_mlmeext->cur_ch_offset ++ , u_ch, u_bw, u_offset); ++ ++ RTW_INFO(FUNC_ADPT_FMT" chbw_allow:%d\n" ++ , FUNC_ADPT_ARG(padapter), chbw_allow); ++ ++ /* if chbw_allow = false, start MCC setting */ ++ if (chbw_allow == _FALSE) { ++ struct mcc_obj_priv *pmccobjpriv = &dvobj->mcc_objpriv; ++ ++ rtw_hal_mcc_backup_IQK_val(padapter); ++ _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); ++ ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_CONNECT); ++ _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); ++ } ++ } ++ } ++ ++ return ret; ++} ++ ++/** ++ * rtw_hal_set_mcc_setting_chk_start_clnt_join - check change channel under start clnt join ++ * @padapter: the adapter to be checked ++ * @ch: pointer to rerurn ch ++ * @bw: pointer to rerurn bw ++ * @offset: pointer to rerurn offset ++ * @chbw_allow: allow to use adapter's channel setting ++ */ ++u8 rtw_hal_set_mcc_setting_chk_start_clnt_join(PADAPTER padapter, u8 *ch, u8 *bw, u8 *offset, u8 chbw_allow) ++{ ++ u8 ret = _FAIL; ++ ++ /* if chbw_allow = false under en_mcc = TRUE, we do not change channel related setting */ ++ if (MCC_EN(padapter)) { ++ /* restore union channel related setting to current channel related setting */ ++ if (chbw_allow == _FALSE) { ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ *ch = pmlmeext->cur_channel; ++ *bw = pmlmeext->cur_bwmode; ++ *offset = pmlmeext->cur_ch_offset; ++ ++ RTW_INFO(FUNC_ADPT_FMT" en_mcc:%d(%d,%d,%d,)\n" ++ , FUNC_ADPT_ARG(padapter), padapter->registrypriv.en_mcc ++ , *ch, *bw, *offset); ++ ret = _SUCCESS; ++ } ++ } ++ ++ return ret; ++} ++ ++void rtw_hal_dump_mcc_info(void *sel, struct dvobj_priv *dvobj) ++{ ++ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); ++ struct mcc_adapter_priv *pmccadapriv = NULL; ++ _adapter *iface = NULL, *adapter = NULL; ++ struct registry_priv *regpriv = NULL; ++ u8 i = 0; ++ ++ /* regpriv is common for all adapter */ ++ adapter = dvobj->padapters[IFACE_ID0]; ++ ++ RTW_PRINT_SEL(sel, "**********************************************\n"); ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (!iface) ++ continue; ++ ++ regpriv = &iface->registrypriv; ++ pmccadapriv = &iface->mcc_adapterpriv; ++ if (pmccadapriv) { ++ RTW_PRINT_SEL(sel, "adapter mcc info:\n"); ++ RTW_PRINT_SEL(sel, "ifname:%s\n", ADPT_ARG(iface)); ++ RTW_PRINT_SEL(sel, "order:%d\n", pmccadapriv->order); ++ RTW_PRINT_SEL(sel, "duration:%d\n", pmccadapriv->mcc_duration); ++ RTW_PRINT_SEL(sel, "target tx bytes:%d\n", pmccadapriv->mcc_target_tx_bytes_to_port); ++ RTW_PRINT_SEL(sel, "current TP:%d\n", pmccadapriv->mcc_tp); ++ RTW_PRINT_SEL(sel, "mgmt queue macid:%d\n", pmccadapriv->mgmt_queue_macid); ++ RTW_PRINT_SEL(sel, "macid bitmap:0x%02x\n\n", pmccadapriv->mcc_macid_bitmap); ++ RTW_PRINT_SEL(sel, "registry data:\n"); ++ RTW_PRINT_SEL(sel, "en_mcc:%d\n", regpriv->en_mcc); ++ RTW_PRINT_SEL(sel, "ap target tx TP(BW:20M):%d Mbps\n", regpriv->rtw_mcc_ap_bw20_target_tx_tp); ++ RTW_PRINT_SEL(sel, "ap target tx TP(BW:40M):%d Mbps\n", regpriv->rtw_mcc_ap_bw40_target_tx_tp); ++ RTW_PRINT_SEL(sel, "ap target tx TP(BW:80M):%d Mbps\n", regpriv->rtw_mcc_ap_bw80_target_tx_tp); ++ RTW_PRINT_SEL(sel, "sta target tx TP(BW:20M):%d Mbps\n", regpriv->rtw_mcc_sta_bw20_target_tx_tp); ++ RTW_PRINT_SEL(sel, "sta target tx TP(BW:40M ):%d Mbps\n", regpriv->rtw_mcc_sta_bw40_target_tx_tp); ++ RTW_PRINT_SEL(sel, "sta target tx TP(BW:80M):%d Mbps\n", regpriv->rtw_mcc_sta_bw80_target_tx_tp); ++ RTW_PRINT_SEL(sel, "single tx criteria:%d Mbps\n", regpriv->rtw_mcc_single_tx_cri); ++ RTW_PRINT_SEL(sel, "**********************************************\n"); ++ } ++ } ++ RTW_PRINT_SEL(sel, "------------------------------------------\n"); ++ RTW_PRINT_SEL(sel, "define data:\n"); ++ RTW_PRINT_SEL(sel, "ap target tx TP(BW:20M):%d Mbps\n", MCC_AP_BW20_TARGET_TX_TP); ++ RTW_PRINT_SEL(sel, "ap target tx TP(BW:40M):%d Mbps\n", MCC_AP_BW40_TARGET_TX_TP); ++ RTW_PRINT_SEL(sel, "ap target tx TP(BW:80M):%d Mbps\n", MCC_AP_BW80_TARGET_TX_TP); ++ RTW_PRINT_SEL(sel, "sta target tx TP(BW:20M):%d Mbps\n", MCC_STA_BW20_TARGET_TX_TP); ++ RTW_PRINT_SEL(sel, "sta target tx TP(BW:40M):%d Mbps\n", MCC_STA_BW40_TARGET_TX_TP); ++ RTW_PRINT_SEL(sel, "sta target tx TP(BW:80M):%d Mbps\n", MCC_STA_BW80_TARGET_TX_TP); ++ RTW_PRINT_SEL(sel, "single tx criteria:%d Mbps\n", MCC_SINGLE_TX_CRITERIA); ++ RTW_PRINT_SEL(sel, "------------------------------------------\n"); ++} ++ ++inline void update_mcc_mgntframe_attrib(_adapter *padapter, struct pkt_attrib *pattrib) ++{ ++ if (MCC_EN(padapter)) { ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { ++ /* use QSLT_MGNT to check mgnt queue or bcn queue */ ++ if (pattrib->qsel == QSLT_MGNT) { ++ pattrib->mac_id = padapter->mcc_adapterpriv.mgmt_queue_macid; ++ pattrib->qsel = QSLT_VO; ++ } ++ } ++ } ++} ++ ++inline u8 rtw_hal_mcc_link_status_chk(_adapter *padapter, const char *msg) ++{ ++ u8 ret = _TRUE, i = 0; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ _adapter *iface; ++ struct mlme_ext_priv *mlmeext; ++ ++ if (MCC_EN(padapter)) { ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) { ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ mlmeext = &iface->mlmeextpriv; ++ if (mlmeext_scan_state(mlmeext) != SCAN_DISABLE) { ++#ifdef DBG_EXPIRATION_CHK ++ RTW_INFO(FUNC_ADPT_FMT" don't enter %s under scan for MCC mode\n", FUNC_ADPT_ARG(padapter), msg); ++#endif ++ ret = _FALSE; ++ goto exit; ++ } ++ } ++ } ++ } ++ ++exit: ++ return ret; ++} ++ ++void rtw_hal_mcc_issue_null_data(_adapter *padapter, u8 chbw_allow, u8 ps_mode) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ _adapter *iface = NULL; ++ u32 start = rtw_get_current_time(); ++ u8 i = 0; ++ ++ if (MCC_EN(padapter)) { ++ if (chbw_allow == _FALSE) { ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ /* issue null data to inform ap station will leave */ ++ if (is_client_associated_to_ap(iface)) { ++ struct mlme_ext_priv *mlmeext = &iface->mlmeextpriv; ++ u8 ch = mlmeext->cur_channel; ++ u8 bw = mlmeext->cur_bwmode; ++ u8 offset = mlmeext->cur_ch_offset; ++ ++ set_channel_bwmode(iface, ch, bw, offset); ++ issue_nulldata(iface, NULL, ps_mode, 3, 50); ++ } ++ } ++ RTW_INFO("%s(%d ms)\n", __func__, rtw_get_passing_time_ms(start)); ++ } ++ } ++} ++ ++#endif /* CONFIG_MCC_MODE */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_mp.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_mp.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/hal_mp.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_mp.c 2018-02-11 21:44:27.152146162 +0200 +@@ -0,0 +1,2255 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _HAL_MP_C_ ++ ++#include ++ ++#ifdef CONFIG_MP_INCLUDED ++ ++#ifdef RTW_HALMAC ++ #include /* struct HAL_DATA_TYPE, RF register definition and etc. */ ++#else /* !RTW_HALMAC */ ++ #ifdef CONFIG_RTL8188E ++ #include ++ #endif ++ #ifdef CONFIG_RTL8723B ++ #include ++ #endif ++ #ifdef CONFIG_RTL8192E ++ #include ++ #endif ++ #ifdef CONFIG_RTL8814A ++ #include ++ #endif ++ #if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ++ #include ++ #endif ++ #ifdef CONFIG_RTL8703B ++ #include ++ #endif ++ #ifdef CONFIG_RTL8723D ++ #include ++ #endif ++ #ifdef CONFIG_RTL8188F ++ #include ++ #endif ++#endif /* !RTW_HALMAC */ ++ ++ ++u8 MgntQuery_NssTxRate(u16 Rate) ++{ ++ u8 NssNum = RF_TX_NUM_NONIMPLEMENT; ++ ++ if ((Rate >= MGN_MCS8 && Rate <= MGN_MCS15) || ++ (Rate >= MGN_VHT2SS_MCS0 && Rate <= MGN_VHT2SS_MCS9)) ++ NssNum = RF_2TX; ++ else if ((Rate >= MGN_MCS16 && Rate <= MGN_MCS23) || ++ (Rate >= MGN_VHT3SS_MCS0 && Rate <= MGN_VHT3SS_MCS9)) ++ NssNum = RF_3TX; ++ else if ((Rate >= MGN_MCS24 && Rate <= MGN_MCS31) || ++ (Rate >= MGN_VHT4SS_MCS0 && Rate <= MGN_VHT4SS_MCS9)) ++ NssNum = RF_4TX; ++ else ++ NssNum = RF_1TX; ++ ++ return NssNum; ++} ++ ++void hal_mpt_SwitchRfSetting(PADAPTER pAdapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ u8 ChannelToSw = pMptCtx->MptChannelToSw; ++ ULONG ulRateIdx = pMptCtx->MptRateIndex; ++ ULONG ulbandwidth = pMptCtx->MptBandWidth; ++ ++ /* <20120525, Kordan> Dynamic mechanism for APK, asked by Dennis.*/ ++ if (IS_HARDWARE_TYPE_8188ES(pAdapter) && (1 <= ChannelToSw && ChannelToSw <= 11) && ++ (ulRateIdx == MPT_RATE_MCS0 || ulRateIdx == MPT_RATE_1M || ulRateIdx == MPT_RATE_6M)) { ++ pMptCtx->backup0x52_RF_A = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0); ++ pMptCtx->backup0x52_RF_B = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0); ++ ++ if ((PlatformEFIORead4Byte(pAdapter, 0xF4) & BIT29) == BIT29) { ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xB); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0xB); ++ } else { ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xD); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0xD); ++ } ++ } else if (IS_HARDWARE_TYPE_8188EE(pAdapter)) { /* <20140903, VincentL> Asked by RF Eason and Edlu*/ ++ if (ChannelToSw == 3 && ulbandwidth == MPT_BW_40MHZ) { ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xB); /*RF 0x52 = 0x0007E4BD*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0xB); /*RF 0x52 = 0x0007E4BD*/ ++ } else { ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0x9); /*RF 0x52 = 0x0007E49D*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0x9); /*RF 0x52 = 0x0007E49D*/ ++ } ++ } else if (IS_HARDWARE_TYPE_8188E(pAdapter)) { ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, pMptCtx->backup0x52_RF_A); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, pMptCtx->backup0x52_RF_B); ++ } ++} ++ ++s32 hal_mpt_SetPowerTracking(PADAPTER padapter, u8 enable) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ ++ ++ if (!netif_running(padapter->pnetdev)) { ++ return _FAIL; ++ } ++ ++ if (check_fwstate(&padapter->mlmepriv, WIFI_MP_STATE) == _FALSE) { ++ return _FAIL; ++ } ++ if (enable) ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; ++ else ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _FALSE; ++ ++ return _SUCCESS; ++} ++ ++void hal_mpt_GetPowerTracking(PADAPTER padapter, u8 *enable) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ ++ ++ *enable = pDM_Odm->RFCalibrateInfo.TxPowerTrackControl; ++} ++ ++ ++void hal_mpt_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14) ++{ ++ u32 TempVal = 0, TempVal2 = 0, TempVal3 = 0; ++ u32 CurrCCKSwingVal = 0, CCKSwingIndex = 12; ++ u8 i; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); ++ u1Byte u1Channel = pHalData->CurrentChannel; ++ ULONG ulRateIdx = pMptCtx->MptRateIndex; ++ u1Byte DataRate = 0xFF; ++ ++ /* Suggested by BB David. 2015.04.27*/ ++ if(IS_HARDWARE_TYPE_8188F(Adapter)) ++ return; ++ ++ /* Do not modify CCK TX filter parameters for 8822B*/ ++ if(IS_HARDWARE_TYPE_8822B(Adapter) || IS_HARDWARE_TYPE_8821C(Adapter) || IS_HARDWARE_TYPE_8723D(Adapter)) ++ return; ++ ++ DataRate = MptToMgntRate(ulRateIdx); ++ ++ if (u1Channel == 14 && IS_CCK_RATE(DataRate)) ++ pHalData->bCCKinCH14 = TRUE; ++ else ++ pHalData->bCCKinCH14 = FALSE; ++ ++ if (IS_HARDWARE_TYPE_8703B(Adapter)) { ++ if ((u1Channel == 14) && IS_CCK_RATE(DataRate)) { ++ /* Channel 14 in CCK, need to set 0xA26~0xA29 to 0 for 8703B */ ++ PHY_SetBBReg(Adapter, rCCK0_TxFilter2, bMaskHWord, 0); ++ PHY_SetBBReg(Adapter, rCCK0_DebugPort, bMaskLWord, 0); ++ ++ } else { ++ /* Normal setting for 8703B, just recover to the default setting. */ ++ /* This hardcore values reference from the parameter which BB team gave. */ ++ for (i = 0 ; i < 2 ; ++i) ++ PHY_SetBBReg(Adapter, pHalData->RegForRecover[i].offset, bMaskDWord, pHalData->RegForRecover[i].value); ++ ++ } ++ } else if (IS_HARDWARE_TYPE_8723D(Adapter)) { ++ /* 2.4G CCK TX DFIR */ ++ /* 2016.01.20 Suggest from RS BB mingzhi*/ ++ if ((u1Channel == 14)) { ++ PHY_SetBBReg(Adapter, rCCK0_TxFilter2, bMaskDWord, 0x0000B81C); ++ PHY_SetBBReg(Adapter, rCCK0_DebugPort, bMaskDWord, 0x00000000); ++ PHY_SetBBReg(Adapter, 0xAAC, bMaskDWord, 0x00003667); ++ } else { ++ for (i = 0 ; i < 3 ; ++i) { ++ PHY_SetBBReg(Adapter, ++ pHalData->RegForRecover[i].offset, ++ bMaskDWord, ++ pHalData->RegForRecover[i].value); ++ } ++ } ++ } else { ++ ++ /* get current cck swing value and check 0xa22 & 0xa23 later to match the table.*/ ++ CurrCCKSwingVal = read_bbreg(Adapter, rCCK0_TxFilter1, bMaskHWord); ++ ++ if (!pHalData->bCCKinCH14) { ++ /* Readback the current bb cck swing value and compare with the table to */ ++ /* get the current swing index */ ++ for (i = 0; i < CCK_TABLE_SIZE; i++) { ++ if (((CurrCCKSwingVal & 0xff) == (u32)CCKSwingTable_Ch1_Ch13[i][0]) && ++ (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)CCKSwingTable_Ch1_Ch13[i][1])) { ++ CCKSwingIndex = i; ++ break; ++ } ++ } ++ ++ /*Write 0xa22 0xa23*/ ++ TempVal = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][0] + ++ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][1] << 8); ++ ++ ++ /*Write 0xa24 ~ 0xa27*/ ++ TempVal2 = 0; ++ TempVal2 = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][2] + ++ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][3] << 8) + ++ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][4] << 16) + ++ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][5] << 24); ++ ++ /*Write 0xa28 0xa29*/ ++ TempVal3 = 0; ++ TempVal3 = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][6] + ++ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][7] << 8); ++ } else { ++ for (i = 0; i < CCK_TABLE_SIZE; i++) { ++ if (((CurrCCKSwingVal & 0xff) == (u32)CCKSwingTable_Ch14[i][0]) && ++ (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)CCKSwingTable_Ch14[i][1])) { ++ CCKSwingIndex = i; ++ break; ++ } ++ } ++ ++ /*Write 0xa22 0xa23*/ ++ TempVal = CCKSwingTable_Ch14[CCKSwingIndex][0] + ++ (CCKSwingTable_Ch14[CCKSwingIndex][1] << 8); ++ ++ /*Write 0xa24 ~ 0xa27*/ ++ TempVal2 = 0; ++ TempVal2 = CCKSwingTable_Ch14[CCKSwingIndex][2] + ++ (CCKSwingTable_Ch14[CCKSwingIndex][3] << 8) + ++ (CCKSwingTable_Ch14[CCKSwingIndex][4] << 16) + ++ (CCKSwingTable_Ch14[CCKSwingIndex][5] << 24); ++ ++ /*Write 0xa28 0xa29*/ ++ TempVal3 = 0; ++ TempVal3 = CCKSwingTable_Ch14[CCKSwingIndex][6] + ++ (CCKSwingTable_Ch14[CCKSwingIndex][7] << 8); ++ } ++ ++ write_bbreg(Adapter, rCCK0_TxFilter1, bMaskHWord, TempVal); ++ write_bbreg(Adapter, rCCK0_TxFilter2, bMaskDWord, TempVal2); ++ write_bbreg(Adapter, rCCK0_DebugPort, bMaskLWord, TempVal3); ++ } ++ ++} ++ ++void hal_mpt_SetChannel(PADAPTER pAdapter) ++{ ++ u8 eRFPath; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ struct mp_priv *pmp = &pAdapter->mppriv; ++ u8 channel = pmp->channel; ++ u8 bandwidth = pmp->bandwidth; ++ ++ hal_mpt_SwitchRfSetting(pAdapter); ++ ++ pHalData->bSwChnl = _TRUE; ++ pHalData->bSetChnlBW = _TRUE; ++ rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, 0, 0); ++ ++ hal_mpt_CCKTxPowerAdjust(pAdapter, pHalData->bCCKinCH14); ++ ++} ++ ++/* ++ * Notice ++ * Switch bandwitdth may change center frequency(channel) ++ */ ++void hal_mpt_SetBandwidth(PADAPTER pAdapter) ++{ ++ struct mp_priv *pmp = &pAdapter->mppriv; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ u8 channel = pmp->channel; ++ u8 bandwidth = pmp->bandwidth; ++ ++ pHalData->bSwChnl = _TRUE; ++ pHalData->bSetChnlBW = _TRUE; ++ rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, 0, 0); ++ ++ hal_mpt_SwitchRfSetting(pAdapter); ++} ++ ++void mpt_SetTxPower_Old(PADAPTER pAdapter, MPT_TXPWR_DEF Rate, u8 *pTxPower) ++{ ++ switch (Rate) { ++ case MPT_CCK: { ++ u4Byte TxAGC = 0, pwr = 0; ++ u1Byte rf; ++ ++ pwr = pTxPower[ODM_RF_PATH_A]; ++ if (pwr < 0x3f) { ++ TxAGC = (pwr << 16) | (pwr << 8) | (pwr); ++ PHY_SetBBReg(pAdapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, pTxPower[ODM_RF_PATH_A]); ++ PHY_SetBBReg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, 0xffffff00, TxAGC); ++ } ++ pwr = pTxPower[ODM_RF_PATH_B]; ++ if (pwr < 0x3f) { ++ TxAGC = (pwr << 16) | (pwr << 8) | (pwr); ++ PHY_SetBBReg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte0, pTxPower[ODM_RF_PATH_B]); ++ PHY_SetBBReg(pAdapter, rTxAGC_B_CCK1_55_Mcs32, 0xffffff00, TxAGC); ++ } ++ } ++ break; ++ ++ case MPT_OFDM_AND_HT: { ++ u4Byte TxAGC = 0; ++ u1Byte pwr = 0, rf; ++ ++ pwr = pTxPower[0]; ++ if (pwr < 0x3f) { ++ TxAGC |= ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); ++ RTW_INFO("HT Tx-rf(A) Power = 0x%x\n", TxAGC); ++ PHY_SetBBReg(pAdapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); ++ PHY_SetBBReg(pAdapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); ++ PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); ++ PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); ++ PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs11_Mcs08, bMaskDWord, TxAGC); ++ PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs15_Mcs12, bMaskDWord, TxAGC); ++ } ++ TxAGC = 0; ++ pwr = pTxPower[1]; ++ if (pwr < 0x3f) { ++ TxAGC |= ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); ++ RTW_INFO("HT Tx-rf(B) Power = 0x%x\n", TxAGC); ++ PHY_SetBBReg(pAdapter, rTxAGC_B_Rate18_06, bMaskDWord, TxAGC); ++ PHY_SetBBReg(pAdapter, rTxAGC_B_Rate54_24, bMaskDWord, TxAGC); ++ PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs03_Mcs00, bMaskDWord, TxAGC); ++ PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs07_Mcs04, bMaskDWord, TxAGC); ++ PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs11_Mcs08, bMaskDWord, TxAGC); ++ PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs15_Mcs12, bMaskDWord, TxAGC); ++ } ++ } ++ break; ++ ++ default: ++ break; ++ } ++ RTW_INFO("<===mpt_SetTxPower_Old()\n"); ++} ++ ++void ++mpt_SetTxPower( ++ PADAPTER pAdapter, ++ MPT_TXPWR_DEF Rate, ++ pu1Byte pTxPower ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ u1Byte path = 0 , i = 0, MaxRate = MGN_6M; ++ u1Byte StartPath = ODM_RF_PATH_A, EndPath = ODM_RF_PATH_B; ++ ++ if (IS_HARDWARE_TYPE_8814A(pAdapter)) ++ EndPath = ODM_RF_PATH_D; ++ else if (IS_HARDWARE_TYPE_8188F(pAdapter) || IS_HARDWARE_TYPE_8723D(pAdapter) || IS_HARDWARE_TYPE_8821C(pAdapter)) ++ EndPath = ODM_RF_PATH_A; ++ ++ switch (Rate) { ++ case MPT_CCK: { ++ u1Byte rate[] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}; ++ ++ for (path = StartPath; path <= EndPath; path++) ++ for (i = 0; i < sizeof(rate); ++i) ++ PHY_SetTxPowerIndex(pAdapter, pTxPower[path], path, rate[i]); ++ } ++ break; ++ case MPT_OFDM: { ++ u1Byte rate[] = { ++ MGN_6M, MGN_9M, MGN_12M, MGN_18M, ++ MGN_24M, MGN_36M, MGN_48M, MGN_54M, ++ }; ++ ++ for (path = StartPath; path <= EndPath; path++) ++ for (i = 0; i < sizeof(rate); ++i) ++ PHY_SetTxPowerIndex(pAdapter, pTxPower[path], path, rate[i]); ++ } ++ break; ++ case MPT_HT: { ++ u1Byte rate[] = { ++ MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, ++ MGN_MCS5, MGN_MCS6, MGN_MCS7, MGN_MCS8, MGN_MCS9, ++ MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, ++ MGN_MCS15, MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, ++ MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23, MGN_MCS24, ++ MGN_MCS25, MGN_MCS26, MGN_MCS27, MGN_MCS28, MGN_MCS29, ++ MGN_MCS30, MGN_MCS31, ++ }; ++ if (pHalData->rf_type == RF_3T3R) ++ MaxRate = MGN_MCS23; ++ else if (pHalData->rf_type == RF_2T2R) ++ MaxRate = MGN_MCS15; ++ else ++ MaxRate = MGN_MCS7; ++ for (path = StartPath; path <= EndPath; path++) { ++ for (i = 0; i < sizeof(rate); ++i) { ++ if (rate[i] > MaxRate) ++ break; ++ PHY_SetTxPowerIndex(pAdapter, pTxPower[path], path, rate[i]); ++ } ++ } ++ } ++ break; ++ case MPT_VHT: { ++ u1Byte rate[] = { ++ MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4, ++ MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9, ++ MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, ++ MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9, ++ MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4, ++ MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9, ++ MGN_VHT4SS_MCS0, MGN_VHT4SS_MCS1, MGN_VHT4SS_MCS2, MGN_VHT4SS_MCS3, MGN_VHT4SS_MCS4, ++ MGN_VHT4SS_MCS5, MGN_VHT4SS_MCS6, MGN_VHT4SS_MCS7, MGN_VHT4SS_MCS8, MGN_VHT4SS_MCS9, ++ }; ++ if (pHalData->rf_type == RF_3T3R) ++ MaxRate = MGN_VHT3SS_MCS9; ++ else if (pHalData->rf_type == RF_2T2R || pHalData->rf_type == RF_2T4R) ++ MaxRate = MGN_VHT2SS_MCS9; ++ else ++ MaxRate = MGN_VHT1SS_MCS9; ++ ++ for (path = StartPath; path <= EndPath; path++) { ++ for (i = 0; i < sizeof(rate); ++i) { ++ if (rate[i] > MaxRate) ++ break; ++ PHY_SetTxPowerIndex(pAdapter, pTxPower[path], path, rate[i]); ++ } ++ } ++ } ++ break; ++ default: ++ RTW_INFO("<===mpt_SetTxPower: Illegal channel!!\n"); ++ break; ++ } ++} ++ ++void hal_mpt_SetTxPower(PADAPTER pAdapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ ++ if (pHalData->rf_chip < RF_TYPE_MAX) { ++ if (IS_HARDWARE_TYPE_8188E(pAdapter) || ++ IS_HARDWARE_TYPE_8723B(pAdapter) || ++ IS_HARDWARE_TYPE_8192E(pAdapter) || ++ IS_HARDWARE_TYPE_8703B(pAdapter) || ++ IS_HARDWARE_TYPE_8188F(pAdapter)) { ++ u8 path = (pHalData->AntennaTxPath == ANTENNA_A) ? (ODM_RF_PATH_A) : (ODM_RF_PATH_B); ++ ++ RTW_INFO("===> MPT_ProSetTxPower: Old\n"); ++ ++ mpt_SetTxPower_Old(pAdapter, MPT_CCK, pMptCtx->TxPwrLevel); ++ mpt_SetTxPower_Old(pAdapter, MPT_OFDM_AND_HT, pMptCtx->TxPwrLevel); ++ ++ } else { ++ RTW_INFO("===> MPT_ProSetTxPower: Jaguar/Jaguar2\n"); ++ mpt_SetTxPower(pAdapter, MPT_CCK, pMptCtx->TxPwrLevel); ++ mpt_SetTxPower(pAdapter, MPT_OFDM, pMptCtx->TxPwrLevel); ++ mpt_SetTxPower(pAdapter, MPT_HT, pMptCtx->TxPwrLevel); ++ mpt_SetTxPower(pAdapter, MPT_VHT, pMptCtx->TxPwrLevel); ++ ++ } ++ } else ++ RTW_INFO("RFChipID < RF_TYPE_MAX, the RF chip is not supported - %d\n", pHalData->rf_chip); ++ ++ ODM_ClearTxPowerTrackingState(pDM_Odm); ++} ++ ++void hal_mpt_SetDataRate(PADAPTER pAdapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ u32 DataRate; ++ ++ DataRate = MptToMgntRate(pMptCtx->MptRateIndex); ++ ++ hal_mpt_SwitchRfSetting(pAdapter); ++ ++ hal_mpt_CCKTxPowerAdjust(pAdapter, pHalData->bCCKinCH14); ++#ifdef CONFIG_RTL8723B ++ if (IS_HARDWARE_TYPE_8723B(pAdapter) || IS_HARDWARE_TYPE_8188F(pAdapter)) { ++ if (IS_CCK_RATE(DataRate)) { ++ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, 0xF, 0x6); ++ else ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0x6); ++ } else { ++ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, 0xF, 0xE); ++ else ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0xE); ++ } ++ } ++ ++ if ((IS_HARDWARE_TYPE_8723BS(pAdapter) && ++ ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)))) { ++ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, 0xF, 0xE); ++ else ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0xE); ++ } ++#endif ++} ++ ++#define RF_PATH_AB 22 ++ ++#ifdef CONFIG_RTL8814A ++VOID mpt_ToggleIG_8814A(PADAPTER pAdapter) ++{ ++ u1Byte Path = 0; ++ u4Byte IGReg = rA_IGI_Jaguar, IGvalue = 0; ++ ++ for (Path; Path <= ODM_RF_PATH_D; Path++) { ++ switch (Path) { ++ case ODM_RF_PATH_B: ++ IGReg = rB_IGI_Jaguar; ++ break; ++ case ODM_RF_PATH_C: ++ IGReg = rC_IGI_Jaguar2; ++ break; ++ case ODM_RF_PATH_D: ++ IGReg = rD_IGI_Jaguar2; ++ break; ++ default: ++ IGReg = rA_IGI_Jaguar; ++ break; ++ } ++ ++ IGvalue = PHY_QueryBBReg(pAdapter, IGReg, bMaskByte0); ++ PHY_SetBBReg(pAdapter, IGReg, bMaskByte0, IGvalue + 2); ++ PHY_SetBBReg(pAdapter, IGReg, bMaskByte0, IGvalue); ++ } ++} ++ ++VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) ++{ ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; ++ R_ANTENNA_SELECT_OFDM *p_ofdm_tx; /* OFDM Tx register */ ++ R_ANTENNA_SELECT_CCK *p_cck_txrx; ++ u8 ForcedDataRate = MptToMgntRate(pMptCtx->MptRateIndex); ++ u8 HtStbcCap = pAdapter->registrypriv.stbc_cap; ++ /*/PRT_HIGH_THROUGHPUT pHTInfo = GET_HT_INFO(pMgntInfo);*/ ++ /*/PRT_VERY_HIGH_THROUGHPUT pVHTInfo = GET_VHT_INFO(pMgntInfo);*/ ++ ++ u32 ulAntennaTx = pHalData->AntennaTxPath; ++ u32 ulAntennaRx = pHalData->AntennaRxPath; ++ u8 NssforRate = MgntQuery_NssTxRate(ForcedDataRate); ++ ++ if ((NssforRate == RF_2TX) || ((NssforRate == RF_1TX) && IS_HT_RATE(ForcedDataRate)) || ((NssforRate == RF_1TX) && IS_VHT_RATE(ForcedDataRate))) { ++ RTW_INFO("===> SetAntenna 2T ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); ++ ++ switch (ulAntennaTx) { ++ case ANTENNA_BC: ++ pMptCtx->MptRfPath = ODM_RF_PATH_BC; ++ /*pHalData->ValidTxPath = 0x06; linux no use */ ++ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x106); /*/ 0x940[15:4]=12'b0000_0100_0011*/ ++ break; ++ ++ case ANTENNA_CD: ++ pMptCtx->MptRfPath = ODM_RF_PATH_CD; ++ /*pHalData->ValidTxPath = 0x0C;*/ ++ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x40c); /*/ 0x940[15:4]=12'b0000_0100_0011*/ ++ break; ++ case ANTENNA_AB: ++ default: ++ pMptCtx->MptRfPath = ODM_RF_PATH_AB; ++ /*pHalData->ValidTxPath = 0x03;*/ ++ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x043); /*/ 0x940[15:4]=12'b0000_0100_0011*/ ++ break; ++ } ++ ++ } else if (NssforRate == RF_3TX) { ++ RTW_INFO("===> SetAntenna 3T ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); ++ ++ switch (ulAntennaTx) { ++ case ANTENNA_BCD: ++ pMptCtx->MptRfPath = ODM_RF_PATH_BCD; ++ /*pHalData->ValidTxPath = 0x0e;*/ ++ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0fff0000, 0x90e); /*/ 0x940[27:16]=12'b0010_0100_0111*/ ++ break; ++ ++ case ANTENNA_ABC: ++ default: ++ pMptCtx->MptRfPath = ODM_RF_PATH_ABC; ++ /*pHalData->ValidTxPath = 0x0d;*/ ++ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0fff0000, 0x247); /*/ 0x940[27:16]=12'b0010_0100_0111*/ ++ break; ++ } ++ ++ } else { /*/if(NssforRate == RF_1TX)*/ ++ RTW_INFO("===> SetAntenna 1T ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); ++ switch (ulAntennaTx) { ++ case ANTENNA_BCD: ++ pMptCtx->MptRfPath = ODM_RF_PATH_BCD; ++ /*pHalData->ValidTxPath = 0x0e;*/ ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x7); ++ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0x000f00000, 0xe); ++ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0xe); ++ break; ++ ++ case ANTENNA_BC: ++ pMptCtx->MptRfPath = ODM_RF_PATH_BC; ++ /*pHalData->ValidTxPath = 0x06;*/ ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x6); ++ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0x000f00000, 0x6); ++ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x6); ++ break; ++ case ANTENNA_B: ++ pMptCtx->MptRfPath = ODM_RF_PATH_B; ++ /*pHalData->ValidTxPath = 0x02;*/ ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x4); /*/ 0xa07[7:4] = 4'b0100*/ ++ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x002); /*/ 0x93C[31:20]=12'b0000_0000_0010*/ ++ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x2); /* 0x80C[7:4] = 4'b0010*/ ++ break; ++ ++ case ANTENNA_C: ++ pMptCtx->MptRfPath = ODM_RF_PATH_C; ++ /*pHalData->ValidTxPath = 0x04;*/ ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x2); /*/ 0xa07[7:4] = 4'b0010*/ ++ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x004); /*/ 0x93C[31:20]=12'b0000_0000_0100*/ ++ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x4); /*/ 0x80C[7:4] = 4'b0100*/ ++ break; ++ ++ case ANTENNA_D: ++ pMptCtx->MptRfPath = ODM_RF_PATH_D; ++ /*pHalData->ValidTxPath = 0x08;*/ ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x1); /*/ 0xa07[7:4] = 4'b0001*/ ++ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x008); /*/ 0x93C[31:20]=12'b0000_0000_1000*/ ++ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x8); /*/ 0x80C[7:4] = 4'b1000*/ ++ break; ++ ++ case ANTENNA_A: ++ default: ++ pMptCtx->MptRfPath = ODM_RF_PATH_A; ++ /*pHalData->ValidTxPath = 0x01;*/ ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x8); /*/ 0xa07[7:4] = 4'b1000*/ ++ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x001); /*/ 0x93C[31:20]=12'b0000_0000_0001*/ ++ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x1); /*/ 0x80C[7:4] = 4'b0001*/ ++ break; ++ } ++ } ++ ++ switch (ulAntennaRx) { ++ case ANTENNA_A: ++ /*pHalData->ValidRxPath = 0x01;*/ ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x0); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ ++ /*/ CCA related PD_delay_th*/ ++ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); ++ break; ++ ++ case ANTENNA_B: ++ /*pHalData->ValidRxPath = 0x02;*/ ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x1); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ ++ /*/ CCA related PD_delay_th*/ ++ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); ++ break; ++ ++ case ANTENNA_C: ++ /*pHalData->ValidRxPath = 0x04;*/ ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x44); ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x2); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ ++ /*/ CCA related PD_delay_th*/ ++ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); ++ break; ++ ++ case ANTENNA_D: ++ /*pHalData->ValidRxPath = 0x08;*/ ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x88); ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x3); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ ++ /*/ CCA related PD_delay_th*/ ++ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); ++ break; ++ ++ case ANTENNA_BC: ++ /*pHalData->ValidRxPath = 0x06;*/ ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x66); ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x6); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ ++ /*/ CCA related PD_delay_th*/ ++ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); ++ break; ++ ++ case ANTENNA_CD: ++ /*pHalData->ValidRxPath = 0x0C;*/ ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xcc); ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0xB); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ ++ /*/ CCA related PD_delay_th*/ ++ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); ++ break; ++ ++ case ANTENNA_BCD: ++ /*pHalData->ValidRxPath = 0x0e;*/ ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xee); ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x6); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, Rx mode*/ ++ /*/ CCA related PD_delay_th*/ ++ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0x8); ++ break; ++ ++ case ANTENNA_ABCD: ++ /*pHalData->ValidRxPath = 0x0f;*/ ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xff); ++ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x1); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ ++ /*/ CCA related PD_delay_th*/ ++ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0x8); ++ break; ++ ++ default: ++ break; ++ } ++ ++ PHY_Set_SecCCATH_by_RXANT_8814A(pAdapter, ulAntennaRx); ++ ++ mpt_ToggleIG_8814A(pAdapter); ++} ++#endif /* CONFIG_RTL8814A */ ++#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++VOID ++mpt_SetSingleTone_8814A( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bSingleTone, ++ IN BOOLEAN bEnPMacTx) ++{ ++ ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ u1Byte StartPath = ODM_RF_PATH_A, EndPath = ODM_RF_PATH_A; ++ static u4Byte regIG0 = 0, regIG1 = 0, regIG2 = 0, regIG3 = 0; ++ ++ if (bSingleTone) { ++ regIG0 = PHY_QueryBBReg(pAdapter, rA_TxScale_Jaguar, bMaskDWord); /*/ 0xC1C[31:21]*/ ++ regIG1 = PHY_QueryBBReg(pAdapter, rB_TxScale_Jaguar, bMaskDWord); /*/ 0xE1C[31:21]*/ ++ regIG2 = PHY_QueryBBReg(pAdapter, rC_TxScale_Jaguar2, bMaskDWord); /*/ 0x181C[31:21]*/ ++ regIG3 = PHY_QueryBBReg(pAdapter, rD_TxScale_Jaguar2, bMaskDWord); /*/ 0x1A1C[31:21]*/ ++ ++ switch (pMptCtx->MptRfPath) { ++ case ODM_RF_PATH_A: ++ case ODM_RF_PATH_B: ++ case ODM_RF_PATH_C: ++ case ODM_RF_PATH_D: ++ StartPath = pMptCtx->MptRfPath; ++ EndPath = pMptCtx->MptRfPath; ++ break; ++ case ODM_RF_PATH_AB: ++ EndPath = ODM_RF_PATH_B; ++ break; ++ case ODM_RF_PATH_BC: ++ StartPath = ODM_RF_PATH_B; ++ EndPath = ODM_RF_PATH_C; ++ break; ++ case ODM_RF_PATH_ABC: ++ EndPath = ODM_RF_PATH_C; ++ break; ++ case ODM_RF_PATH_BCD: ++ StartPath = ODM_RF_PATH_B; ++ EndPath = ODM_RF_PATH_D; ++ break; ++ case ODM_RF_PATH_ABCD: ++ EndPath = ODM_RF_PATH_D; ++ break; ++ } ++ ++ if (bEnPMacTx == FALSE) { ++ hal_mpt_SetOFDMContinuousTx(pAdapter, _TRUE); ++ issue_nulldata(pAdapter, NULL, 1, 3, 500); ++ } ++ ++ PHY_SetBBReg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); /*/ Disable CCA*/ ++ ++ for (StartPath; StartPath <= EndPath; StartPath++) { ++ PHY_SetRFReg(pAdapter, StartPath, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ ++ PHY_SetRFReg(pAdapter, StartPath, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ ++ ++ PHY_SetRFReg(pAdapter, StartPath, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ ++ } ++ ++ PHY_SetBBReg(pAdapter, rA_TxScale_Jaguar, 0xFFE00000, 0); /*/ 0xC1C[31:21]*/ ++ PHY_SetBBReg(pAdapter, rB_TxScale_Jaguar, 0xFFE00000, 0); /*/ 0xE1C[31:21]*/ ++ PHY_SetBBReg(pAdapter, rC_TxScale_Jaguar2, 0xFFE00000, 0); /*/ 0x181C[31:21]*/ ++ PHY_SetBBReg(pAdapter, rD_TxScale_Jaguar2, 0xFFE00000, 0); /*/ 0x1A1C[31:21]*/ ++ } else { ++ switch (pMptCtx->MptRfPath) { ++ case ODM_RF_PATH_A: ++ case ODM_RF_PATH_B: ++ case ODM_RF_PATH_C: ++ case ODM_RF_PATH_D: ++ StartPath = pMptCtx->MptRfPath; ++ EndPath = pMptCtx->MptRfPath; ++ break; ++ case ODM_RF_PATH_AB: ++ EndPath = ODM_RF_PATH_B; ++ break; ++ case ODM_RF_PATH_BC: ++ StartPath = ODM_RF_PATH_B; ++ EndPath = ODM_RF_PATH_C; ++ break; ++ case ODM_RF_PATH_ABC: ++ EndPath = ODM_RF_PATH_C; ++ break; ++ case ODM_RF_PATH_BCD: ++ StartPath = ODM_RF_PATH_B; ++ EndPath = ODM_RF_PATH_D; ++ break; ++ case ODM_RF_PATH_ABCD: ++ EndPath = ODM_RF_PATH_D; ++ break; ++ } ++ for (StartPath; StartPath <= EndPath; StartPath++) ++ PHY_SetRFReg(pAdapter, StartPath, LNA_Low_Gain_3, BIT1, 0x0); /* RF LO disabled */ ++ ++ PHY_SetBBReg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); /* Enable CCA*/ ++ ++ if (bEnPMacTx == FALSE) ++ hal_mpt_SetOFDMContinuousTx(pAdapter, _FALSE); ++ ++ PHY_SetBBReg(pAdapter, rA_TxScale_Jaguar, bMaskDWord, regIG0); /* 0xC1C[31:21]*/ ++ PHY_SetBBReg(pAdapter, rB_TxScale_Jaguar, bMaskDWord, regIG1); /* 0xE1C[31:21]*/ ++ PHY_SetBBReg(pAdapter, rC_TxScale_Jaguar2, bMaskDWord, regIG2); /* 0x181C[31:21]*/ ++ PHY_SetBBReg(pAdapter, rD_TxScale_Jaguar2, bMaskDWord, regIG3); /* 0x1A1C[31:21]*/ ++ } ++} ++ ++#endif ++ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ++void mpt_SetRFPath_8812A(PADAPTER pAdapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; ++ struct mp_priv *pmp = &pAdapter->mppriv; ++ u8 channel = pmp->channel; ++ u8 bandwidth = pmp->bandwidth; ++ u8 eLNA_2g = pHalData->ExternalLNA_2G; ++ u32 ulAntennaTx, ulAntennaRx; ++ ++ ulAntennaTx = pHalData->AntennaTxPath; ++ ulAntennaRx = pHalData->AntennaRxPath; ++ ++ switch (ulAntennaTx) { ++ case ANTENNA_A: ++ pMptCtx->MptRfPath = ODM_RF_PATH_A; ++ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x1111); ++ if (pHalData->RFEType == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) ++ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0); ++ break; ++ case ANTENNA_B: ++ pMptCtx->MptRfPath = ODM_RF_PATH_B; ++ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x2222); ++ if (pHalData->RFEType == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) ++ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x1); ++ break; ++ case ANTENNA_AB: ++ pMptCtx->MptRfPath = ODM_RF_PATH_AB; ++ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x3333); ++ if (pHalData->RFEType == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) ++ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0); ++ break; ++ default: ++ pMptCtx->MptRfPath = ODM_RF_PATH_AB; ++ RTW_INFO("Unknown Tx antenna.\n"); ++ break; ++ } ++ ++ switch (ulAntennaRx) { ++ u32 reg0xC50 = 0; ++ case ANTENNA_A: ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, BIT19 | BIT18 | BIT17 | BIT16, 0x3); ++ ++ /*/ <20121101, Kordan> To prevent gain table from not switched, asked by Ynlin.*/ ++ reg0xC50 = PHY_QueryBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0); ++ PHY_SetBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50 + 2); ++ PHY_SetBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50); ++ ++ /* set PWED_TH for BB Yn user guide R29 */ ++ if (IS_HARDWARE_TYPE_8812(pAdapter)) { ++ if (channel <= 14) { /* 2.4G */ ++ if (bandwidth == CHANNEL_WIDTH_20 ++ && eLNA_2g == 0) { ++ /* 0x830[3:1]=3'b010 */ ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x02); ++ } else ++ /* 0x830[3:1]=3'b100 */ ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); ++ } else ++ /* 0x830[3:1]=3'b100 for 5G */ ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); ++ } ++ break; ++ case ANTENNA_B: ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1);/*/ RF_A_0x0[19:16] = 1, Standby mode */ ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x1); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, BIT19 | BIT18 | BIT17 | BIT16, 0x3); ++ ++ /*/ <20121101, Kordan> To prevent gain table from not switched, asked by Ynlin.*/ ++ reg0xC50 = PHY_QueryBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0); ++ PHY_SetBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50 + 2); ++ PHY_SetBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50); ++ ++ /* set PWED_TH for BB Yn user guide R29 */ ++ if (IS_HARDWARE_TYPE_8812(pAdapter)) { ++ if (channel <= 14) { ++ if (bandwidth == CHANNEL_WIDTH_20 ++ && eLNA_2g == 0) { ++ /* 0x830[3:1]=3'b010 */ ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x02); ++ } else ++ /* 0x830[3:1]=3'b100 */ ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); ++ } else ++ /* 0x830[3:1]=3'b100 for 5G */ ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); ++ } ++ break; ++ case ANTENNA_AB: ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x33); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, Rx mode*/ ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); ++ /* set PWED_TH for BB Yn user guide R29 */ ++ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); ++ break; ++ default: ++ RTW_INFO("Unknown Rx antenna.\n"); ++ break; ++ } ++} ++#endif ++ ++#ifdef CONFIG_RTL8723B ++void mpt_SetRFPath_8723B(PADAPTER pAdapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u32 ulAntennaTx, ulAntennaRx; ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ulAntennaTx = pHalData->AntennaTxPath; ++ ulAntennaRx = pHalData->AntennaRxPath; ++ ++ if (pHalData->rf_chip >= RF_TYPE_MAX) { ++ RTW_INFO("This RF chip ID is not supported\n"); ++ return; ++ } ++ ++ switch (pAdapter->mppriv.antenna_tx) { ++ u8 p = 0, i = 0; ++ case ANTENNA_A: { /*/ Actually path S1 (Wi-Fi)*/ ++ pMptCtx->MptRfPath = ODM_RF_PATH_A; ++ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x0); ++ PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x0); /* AGC Table Sel*/ ++ ++ /*/<20130522, Kordan> 0x51 and 0x71 should be set immediately after path switched, or they might be overwritten.*/ ++ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)) ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); ++ else ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); ++ ++ for (i = 0; i < 3; ++i) { ++ u4Byte offset = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_A][i][0]; ++ u4Byte data = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_A][i][1]; ++ ++ if (offset != 0) { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); ++ RTW_INFO("Switch to S1 TxIQC(offset, data) = (0x%X, 0x%X)\n", offset, data); ++ } ++ } ++ for (i = 0; i < 2; ++i) { ++ u4Byte offset = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_A][i][0]; ++ u4Byte data = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_A][i][1]; ++ ++ if (offset != 0) { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); ++ RTW_INFO("Switch to S1 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); ++ } ++ } ++ } ++ break; ++ case ANTENNA_B: { /*/ Actually path S0 (BT)*/ ++ u4Byte offset; ++ u4Byte data; ++ ++ pMptCtx->MptRfPath = ODM_RF_PATH_B; ++ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x5); ++ PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x1); /*/ AGC Table Sel.*/ ++ /* <20130522, Kordan> 0x51 and 0x71 should be set immediately after path switched, or they might be overwritten.*/ ++ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)) ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); ++ else ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); ++ ++ for (i = 0; i < 3; ++i) { ++ /*/ <20130603, Kordan> Because BB suppors only 1T1R, we restore IQC to S1 instead of S0.*/ ++ offset = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_A][i][0]; ++ data = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_B][i][1]; ++ if (pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_B][i][0] != 0) { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); ++ RTW_INFO("Switch to S0 TxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); ++ } ++ } ++ /*/ <20130603, Kordan> Because BB suppors only 1T1R, we restore IQC to S1 instead of S0.*/ ++ for (i = 0; i < 2; ++i) { ++ offset = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_A][i][0]; ++ data = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_B][i][1]; ++ if (pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_B][i][0] != 0) { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); ++ RTW_INFO("Switch to S0 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); ++ } ++ } ++ } ++ break; ++ default: ++ pMptCtx->MptRfPath = RF_PATH_AB; ++ break; ++ } ++} ++#endif ++ ++#ifdef CONFIG_RTL8703B ++void mpt_SetRFPath_8703B(PADAPTER pAdapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u4Byte ulAntennaTx, ulAntennaRx; ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ulAntennaTx = pHalData->AntennaTxPath; ++ ulAntennaRx = pHalData->AntennaRxPath; ++ ++ if (pHalData->rf_chip >= RF_TYPE_MAX) { ++ RTW_INFO("This RF chip ID is not supported\n"); ++ return; ++ } ++ ++ switch (pAdapter->mppriv.antenna_tx) { ++ u1Byte p = 0, i = 0; ++ ++ case ANTENNA_A: { /* Actually path S1 (Wi-Fi) */ ++ pMptCtx->MptRfPath = ODM_RF_PATH_A; ++ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x0); ++ PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x0); /* AGC Table Sel*/ ++ ++ for (i = 0; i < 3; ++i) { ++ u4Byte offset = pRFCalibrateInfo->TxIQC_8703B[i][0]; ++ u4Byte data = pRFCalibrateInfo->TxIQC_8703B[i][1]; ++ ++ if (offset != 0) { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); ++ RTW_INFO("Switch to S1 TxIQC(offset, data) = (0x%X, 0x%X)\n", offset, data); ++ } ++ ++ } ++ for (i = 0; i < 2; ++i) { ++ u4Byte offset = pRFCalibrateInfo->RxIQC_8703B[i][0]; ++ u4Byte data = pRFCalibrateInfo->RxIQC_8703B[i][1]; ++ ++ if (offset != 0) { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); ++ RTW_INFO("Switch to S1 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); ++ } ++ } ++ } ++ break; ++ case ANTENNA_B: { /* Actually path S0 (BT)*/ ++ pMptCtx->MptRfPath = ODM_RF_PATH_B; ++ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x5); ++ PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x1); /* AGC Table Sel */ ++ ++ for (i = 0; i < 3; ++i) { ++ u4Byte offset = pRFCalibrateInfo->TxIQC_8703B[i][0]; ++ u4Byte data = pRFCalibrateInfo->TxIQC_8703B[i][1]; ++ ++ if (pRFCalibrateInfo->TxIQC_8703B[i][0] != 0) { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); ++ RTW_INFO("Switch to S0 TxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); ++ } ++ } ++ for (i = 0; i < 2; ++i) { ++ u4Byte offset = pRFCalibrateInfo->RxIQC_8703B[i][0]; ++ u4Byte data = pRFCalibrateInfo->RxIQC_8703B[i][1]; ++ ++ if (pRFCalibrateInfo->RxIQC_8703B[i][0] != 0) { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); ++ RTW_INFO("Switch to S0 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); ++ } ++ } ++ } ++ break; ++ default: ++ pMptCtx->MptRfPath = RF_PATH_AB; ++ break; ++ } ++ ++} ++#endif ++ ++#ifdef CONFIG_RTL8723D ++void mpt_SetRFPath_8723D(PADAPTER pAdapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u1Byte p = 0, i = 0; ++ u4Byte ulAntennaTx, ulAntennaRx, offset = 0, data = 0, val32 = 0; ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ulAntennaTx = pHalData->AntennaTxPath; ++ ulAntennaRx = pHalData->AntennaRxPath; ++ ++ if (pHalData->rf_chip >= RF_TYPE_MAX) { ++ RTW_INFO("This RF chip ID is not supported\n"); ++ return; ++ } ++ ++ switch (pAdapter->mppriv.antenna_tx) { ++ /* Actually path S1 (Wi-Fi) */ ++ case ANTENNA_A: { ++ pMptCtx->MptRfPath = ODM_RF_PATH_A; ++ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7|BIT6, 0); ++ } ++ break; ++ /* Actually path S0 (BT) */ ++ case ANTENNA_B: { ++ pMptCtx->MptRfPath = ODM_RF_PATH_B; ++ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7|BIT6, 0xA); ++ ++ } ++ break; ++ default: ++ pMptCtx->MptRfPath = RF_PATH_AB; ++ break; ++ } ++} ++#endif ++ ++VOID mpt_SetRFPath_819X(PADAPTER pAdapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ u4Byte ulAntennaTx, ulAntennaRx; ++ R_ANTENNA_SELECT_OFDM *p_ofdm_tx; /* OFDM Tx register */ ++ R_ANTENNA_SELECT_CCK *p_cck_txrx; ++ u1Byte r_rx_antenna_ofdm = 0, r_ant_select_cck_val = 0; ++ u1Byte chgTx = 0, chgRx = 0; ++ u4Byte r_ant_sel_cck_val = 0, r_ant_select_ofdm_val = 0, r_ofdm_tx_en_val = 0; ++ ++ ulAntennaTx = pHalData->AntennaTxPath; ++ ulAntennaRx = pHalData->AntennaRxPath; ++ ++ p_ofdm_tx = (R_ANTENNA_SELECT_OFDM *)&r_ant_select_ofdm_val; ++ p_cck_txrx = (R_ANTENNA_SELECT_CCK *)&r_ant_select_cck_val; ++ ++ p_ofdm_tx->r_ant_ht1 = 0x1; ++ p_ofdm_tx->r_ant_ht2 = 0x2;/*Second TX RF path is A*/ ++ p_ofdm_tx->r_ant_non_ht = 0x3;/*/ 0x1+0x2=0x3 */ ++ ++ switch (ulAntennaTx) { ++ case ANTENNA_A: ++ p_ofdm_tx->r_tx_antenna = 0x1; ++ r_ofdm_tx_en_val = 0x1; ++ p_ofdm_tx->r_ant_l = 0x1; ++ p_ofdm_tx->r_ant_ht_s1 = 0x1; ++ p_ofdm_tx->r_ant_non_ht_s1 = 0x1; ++ p_cck_txrx->r_ccktx_enable = 0x8; ++ chgTx = 1; ++ /*/ From SD3 Willis suggestion !!! Set RF A=TX and B as standby*/ ++ /*/if (IS_HARDWARE_TYPE_8192S(pAdapter))*/ ++ { ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 2); ++ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 1); ++ r_ofdm_tx_en_val = 0x3; ++ /*/ Power save*/ ++ /*/cosa r_ant_select_ofdm_val = 0x11111111;*/ ++ /*/ We need to close RFB by SW control*/ ++ if (pHalData->rf_type == RF_2T2R) { ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0); ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 1); ++ PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0); ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 1); ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 0); ++ } ++ } ++ pMptCtx->MptRfPath = ODM_RF_PATH_A; ++ break; ++ case ANTENNA_B: ++ p_ofdm_tx->r_tx_antenna = 0x2; ++ r_ofdm_tx_en_val = 0x2; ++ p_ofdm_tx->r_ant_l = 0x2; ++ p_ofdm_tx->r_ant_ht_s1 = 0x2; ++ p_ofdm_tx->r_ant_non_ht_s1 = 0x2; ++ p_cck_txrx->r_ccktx_enable = 0x4; ++ chgTx = 1; ++ /*/ From SD3 Willis suggestion !!! Set RF A as standby*/ ++ /*/if (IS_HARDWARE_TYPE_8192S(pAdapter))*/ ++ { ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 1); ++ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 2); ++ ++ /*/ 2008/10/31 MH From SD3 Willi's suggestion. We must read RF 1T table.*/ ++ /*/ 2009/01/08 MH From Sd3 Willis. We need to close RFA by SW control*/ ++ if (pHalData->rf_type == RF_2T2R || pHalData->rf_type == RF_1T2R) { ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 1); ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_RFInterfaceOE, BIT10, 0); ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0); ++ /*/PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0);*/ ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 0); ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); ++ } ++ } ++ pMptCtx->MptRfPath = ODM_RF_PATH_B; ++ break; ++ case ANTENNA_AB:/*/ For 8192S*/ ++ p_ofdm_tx->r_tx_antenna = 0x3; ++ r_ofdm_tx_en_val = 0x3; ++ p_ofdm_tx->r_ant_l = 0x3; ++ p_ofdm_tx->r_ant_ht_s1 = 0x3; ++ p_ofdm_tx->r_ant_non_ht_s1 = 0x3; ++ p_cck_txrx->r_ccktx_enable = 0xC; ++ chgTx = 1; ++ /*/ From SD3Willis suggestion !!! Set RF B as standby*/ ++ /*/if (IS_HARDWARE_TYPE_8192S(pAdapter))*/ ++ { ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 2); ++ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 2); ++ /* Disable Power save*/ ++ /*cosa r_ant_select_ofdm_val = 0x3321333;*/ ++ /* 2009/01/08 MH From Sd3 Willis. We need to enable RFA/B by SW control*/ ++ if (pHalData->rf_type == RF_2T2R) { ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0); ++ ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0); ++ /*/PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0);*/ ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 1); ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); ++ } ++ } ++ pMptCtx->MptRfPath = ODM_RF_PATH_AB; ++ break; ++ default: ++ break; ++ } ++#if 0 ++ /* r_rx_antenna_ofdm, bit0=A, bit1=B, bit2=C, bit3=D */ ++ /* r_cckrx_enable : CCK default, 0=A, 1=B, 2=C, 3=D */ ++ /* r_cckrx_enable_2 : CCK option, 0=A, 1=B, 2=C, 3=D */ ++#endif ++ switch (ulAntennaRx) { ++ case ANTENNA_A: ++ r_rx_antenna_ofdm = 0x1; /* A*/ ++ p_cck_txrx->r_cckrx_enable = 0x0; /* default: A*/ ++ p_cck_txrx->r_cckrx_enable_2 = 0x0; /* option: A*/ ++ chgRx = 1; ++ break; ++ case ANTENNA_B: ++ r_rx_antenna_ofdm = 0x2; /*/ B*/ ++ p_cck_txrx->r_cckrx_enable = 0x1; /*/ default: B*/ ++ p_cck_txrx->r_cckrx_enable_2 = 0x1; /*/ option: B*/ ++ chgRx = 1; ++ break; ++ case ANTENNA_AB:/*/ For 8192S and 8192E/U...*/ ++ r_rx_antenna_ofdm = 0x3;/*/ AB*/ ++ p_cck_txrx->r_cckrx_enable = 0x0;/*/ default:A*/ ++ p_cck_txrx->r_cckrx_enable_2 = 0x1;/*/ option:B*/ ++ chgRx = 1; ++ break; ++ default: ++ break; ++ } ++ ++ ++ if (chgTx && chgRx) { ++ switch (pHalData->rf_chip) { ++ case RF_8225: ++ case RF_8256: ++ case RF_6052: ++ /*/r_ant_sel_cck_val = r_ant_select_cck_val;*/ ++ PHY_SetBBReg(pAdapter, rFPGA1_TxInfo, 0x7fffffff, r_ant_select_ofdm_val); /*/OFDM Tx*/ ++ PHY_SetBBReg(pAdapter, rFPGA0_TxInfo, 0x0000000f, r_ofdm_tx_en_val); /*/OFDM Tx*/ ++ PHY_SetBBReg(pAdapter, rOFDM0_TRxPathEnable, 0x0000000f, r_rx_antenna_ofdm); /*/OFDM Rx*/ ++ PHY_SetBBReg(pAdapter, rOFDM1_TRxPathEnable, 0x0000000f, r_rx_antenna_ofdm); /*/OFDM Rx*/ ++ if (IS_HARDWARE_TYPE_8192E(pAdapter)) { ++ PHY_SetBBReg(pAdapter, rOFDM0_TRxPathEnable, 0x000000F0, r_rx_antenna_ofdm); /*/OFDM Rx*/ ++ PHY_SetBBReg(pAdapter, rOFDM1_TRxPathEnable, 0x000000F0, r_rx_antenna_ofdm); /*/OFDM Rx*/ ++ } ++ PHY_SetBBReg(pAdapter, rCCK0_AFESetting, bMaskByte3, r_ant_select_cck_val);/*/r_ant_sel_cck_val); /CCK TxRx*/ ++ break; ++ ++ default: ++ RTW_INFO("Unsupported RFChipID for switching antenna.\n"); ++ break; ++ } ++ } ++} /* MPT_ProSetRFPath */ ++ ++ ++void hal_mpt_SetAntenna(PADAPTER pAdapter) ++ ++{ ++ RTW_INFO("Do %s\n", __func__); ++#ifdef CONFIG_RTL8814A ++ if (IS_HARDWARE_TYPE_8814A(pAdapter)) { ++ mpt_SetRFPath_8814A(pAdapter); ++ return; ++ } ++#endif ++#ifdef CONFIG_RTL8822B ++ if (IS_HARDWARE_TYPE_8822B(pAdapter)) { ++ rtl8822b_mp_config_rfpath(pAdapter); ++ return; ++ } ++#endif ++#ifdef CONFIG_RTL8821C ++ if (IS_HARDWARE_TYPE_8821C(pAdapter)) { ++ rtl8821c_mp_config_rfpath(pAdapter); ++ return; ++ } ++#endif ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) { ++ mpt_SetRFPath_8812A(pAdapter); ++ return; ++ } ++#endif ++#ifdef CONFIG_RTL8723B ++ if (IS_HARDWARE_TYPE_8723B(pAdapter)) { ++ mpt_SetRFPath_8723B(pAdapter); ++ return; ++ } ++#endif ++ ++#ifdef CONFIG_RTL8703B ++ if (IS_HARDWARE_TYPE_8703B(pAdapter)) { ++ mpt_SetRFPath_8703B(pAdapter); ++ return; ++ } ++#endif ++ ++#ifdef CONFIG_RTL8723D ++ if (IS_HARDWARE_TYPE_8723D(pAdapter)) { ++ mpt_SetRFPath_8723D(pAdapter); ++ return; ++ } ++#endif ++ /* else if (IS_HARDWARE_TYPE_8821B(pAdapter)) ++ mpt_SetRFPath_8821B(pAdapter); ++ Prepare for 8822B ++ else if (IS_HARDWARE_TYPE_8822B(Context)) ++ mpt_SetRFPath_8822B(Context); ++ */ ++ mpt_SetRFPath_819X(pAdapter); ++ RTW_INFO("mpt_SetRFPath_819X Do %s\n", __func__); ++} ++ ++s32 hal_mpt_SetThermalMeter(PADAPTER pAdapter, u8 target_ther) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ if (!netif_running(pAdapter->pnetdev)) { ++ return _FAIL; ++ } ++ ++ ++ if (check_fwstate(&pAdapter->mlmepriv, WIFI_MP_STATE) == _FALSE) { ++ return _FAIL; ++ } ++ ++ ++ target_ther &= 0xff; ++ if (target_ther < 0x07) ++ target_ther = 0x07; ++ else if (target_ther > 0x1d) ++ target_ther = 0x1d; ++ ++ pHalData->EEPROMThermalMeter = target_ther; ++ ++ return _SUCCESS; ++} ++ ++ ++void hal_mpt_TriggerRFThermalMeter(PADAPTER pAdapter) ++{ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x42, BIT17 | BIT16, 0x03); ++ ++} ++ ++ ++u8 hal_mpt_ReadRFThermalMeter(PADAPTER pAdapter) ++ ++{ ++ u32 ThermalValue = 0; ++ ++ ThermalValue = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, 0x42, 0xfc00); /*0x42: RF Reg[15:10]*/ ++ return (u8)ThermalValue; ++ ++} ++ ++ ++void hal_mpt_GetThermalMeter(PADAPTER pAdapter, u8 *value) ++{ ++#if 0 ++ fw_cmd(pAdapter, IOCMD_GET_THERMAL_METER); ++ rtw_msleep_os(1000); ++ fw_cmd_data(pAdapter, value, 1); ++ *value &= 0xFF; ++#else ++ hal_mpt_TriggerRFThermalMeter(pAdapter); ++ rtw_msleep_os(1000); ++ *value = hal_mpt_ReadRFThermalMeter(pAdapter); ++#endif ++ ++} ++ ++ ++void hal_mpt_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ pAdapter->mppriv.MptCtx.bSingleCarrier = bStart; ++ ++ if (bStart) {/*/ Start Single Carrier.*/ ++ /*/ Start Single Carrier.*/ ++ /*/ 1. if OFDM block on?*/ ++ if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) ++ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1); /*set OFDM block on*/ ++ ++ /*/ 2. set CCK test mode off, set to CCK normal mode*/ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0); ++ ++ /*/ 3. turn on scramble setting*/ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 1); ++ ++ /*/ 4. Turn On Continue Tx and turn off the other test modes.*/ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) ++ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_SingleCarrier); ++ else ++#endif /* CONFIG_RTL8812A || CONFIG_RTL8821A || CONFIG_RTL8814A || CONFIG_RTL8822B || CONFIG_RTL8821C */ ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_SingleCarrier); ++ ++ } else { ++ /*/ Stop Single Carrier.*/ ++ /*/ Stop Single Carrier.*/ ++ /*/ Turn off all test modes.*/ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) ++ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); ++ else ++#endif /* CONFIG_RTL8812A || CONFIG_RTL8821A || CONFIG_RTL8814A || CONFIG_RTL8822B || CONFIG_RTL8821C */ ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); ++ ++ rtw_msleep_os(10); ++ /*/BB Reset*/ ++ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); ++ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); ++ } ++} ++ ++ ++void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ u4Byte ulAntennaTx = pHalData->AntennaTxPath; ++ static u4Byte regRF = 0, regBB0 = 0, regBB1 = 0, regBB2 = 0, regBB3 = 0; ++ u8 rfPath; ++ ++ switch (ulAntennaTx) { ++ case ANTENNA_B: ++ rfPath = ODM_RF_PATH_B; ++ break; ++ case ANTENNA_C: ++ rfPath = ODM_RF_PATH_C; ++ break; ++ case ANTENNA_D: ++ rfPath = ODM_RF_PATH_D; ++ break; ++ case ANTENNA_A: ++ default: ++ rfPath = ODM_RF_PATH_A; ++ break; ++ } ++ ++ pAdapter->mppriv.MptCtx.bSingleTone = bStart; ++ if (bStart) { ++ /*/ Start Single Tone.*/ ++ /*/ <20120326, Kordan> To amplify the power of tone for Xtal calibration. (asked by Edlu)*/ ++ if (IS_HARDWARE_TYPE_8188E(pAdapter)) { ++ regRF = PHY_QueryRFReg(pAdapter, rfPath, LNA_Low_Gain_3, bRFRegOffsetMask); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ ++ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x0); ++ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 0x0); ++ } else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { /*/ USB need to do RF LO disable first, PCIE isn't required to follow this order.*/ ++ /*/Set MAC REG 88C: Prevent SingleTone Fail*/ ++ PHY_SetMacReg(pAdapter, 0x88C, 0xF00000, 0xF); ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO disabled*/ ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ ++ } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { ++ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x56, 0xF, 0x1); /*/ RF LO enabled*/ ++ } else { ++ /*/ S0/S1 both use PATH A to configure*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x76, 0xF, 0x1); /*/ RF LO enabled*/ ++ } ++ } else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { ++ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /* Tx mode */ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, 0xF000, 0x1); /* RF LO enabled */ ++ } ++ } else if (IS_HARDWARE_TYPE_8188F(pAdapter)) { ++ /*Set BB REG 88C: Prevent SingleTone Fail*/ ++ PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, 0xF00000, 0xF); ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x2); ++ ++ } else if (IS_HARDWARE_TYPE_8723D(pAdapter)) { ++ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { ++ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x0); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, BIT0, 0x1); ++ } else {/* S0/S1 both use PATH A to configure */ ++ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x0); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x63, BIT0, 0x1); ++ } ++ } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8822B(pAdapter)) { ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++ u1Byte p = ODM_RF_PATH_A; ++ ++ regRF = PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, bRFRegOffsetMask); ++ regBB0 = PHY_QueryBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord); ++ regBB1 = PHY_QueryBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord); ++ regBB2 = PHY_QueryBBReg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, bMaskDWord); ++ regBB3 = PHY_QueryBBReg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, bMaskDWord); ++ ++ PHY_SetBBReg(pAdapter, rOFDMCCKEN_Jaguar, BIT29 | BIT28, 0x0); /*/ Disable CCK and OFDM*/ ++ ++ if (pMptCtx->MptRfPath == ODM_RF_PATH_AB) { ++ for (p = ODM_RF_PATH_A; p <= ODM_RF_PATH_B; ++p) { ++ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ ++ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ ++ PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ ++ } ++ } else { ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ ++ } ++ ++ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); /*/ 0xCB0[[23:16, 7:4] = 0x77007*/ ++ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); /*/ 0xCB0[[23:16, 7:4] = 0x77007*/ ++ ++ if (pHalData->ExternalPA_5G) { ++ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x12); /*/ 0xCB4[23:16] = 0x12*/ ++ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x12); /*/ 0xEB4[23:16] = 0x12*/ ++ } else if (pHalData->ExternalPA_2G) { ++ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x11); /*/ 0xCB4[23:16] = 0x11*/ ++ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x11); /*/ 0xEB4[23:16] = 0x11*/ ++ } ++#endif ++ } ++#ifdef CONFIG_RTL8814A ++ else if (IS_HARDWARE_TYPE_8814A(pAdapter)) ++ mpt_SetSingleTone_8814A(pAdapter, TRUE, FALSE); ++#endif ++ else /*/ Turn On SingleTone and turn off the other test modes.*/ ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_SingleTone); ++ ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); ++ ++ } else {/*/ Stop Single Ton e.*/ ++ ++ if (IS_HARDWARE_TYPE_8188E(pAdapter)) { ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, LNA_Low_Gain_3, bRFRegOffsetMask, regRF); ++ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x1); ++ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 0x1); ++ } else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x3);/*/ Tx mode*/ ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x0);/*/ RF LO disabled */ ++ /*/ RESTORE MAC REG 88C: Enable RF Functions*/ ++ PHY_SetMacReg(pAdapter, 0x88C, 0xF00000, 0x0); ++ } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { ++ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x56, 0xF, 0x0); /*/ RF LO disabled*/ ++ } else { ++ /*/ S0/S1 both use PATH A to configure*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x76, 0xF, 0x0); /*/ RF LO disabled*/ ++ } ++ } else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { ++ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /* Rx mode */ ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, 0xF000, 0x0); /* RF LO disabled */ ++ } ++ } else if (IS_HARDWARE_TYPE_8188F(pAdapter)) { ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x3); /*Tx mode*/ ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x0); /*RF LO disabled*/ ++ /*Set BB REG 88C: Prevent SingleTone Fail*/ ++ PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, 0xF00000, 0xc); ++ } else if (IS_HARDWARE_TYPE_8723D(pAdapter)) { ++ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { ++ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0x3); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x1); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, BIT0, 0x0); ++ } else { /* S0/S1 both use PATH A to configure */ ++ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0x3); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x1); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x63, BIT0, 0x0); ++ } ++ } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8822B(pAdapter)) { ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++ u1Byte p = ODM_RF_PATH_A; ++ ++ PHY_SetBBReg(pAdapter, rOFDMCCKEN_Jaguar, BIT29 | BIT28, 0x3); /*/ Disable CCK and OFDM*/ ++ ++ if (pMptCtx->MptRfPath == ODM_RF_PATH_AB) { ++ for (p = ODM_RF_PATH_A; p <= ODM_RF_PATH_B; ++p) { ++ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, bRFRegOffsetMask, regRF); ++ PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x0); /*/ RF LO disabled*/ ++ } ++ } else { ++ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, bRFRegOffsetMask, regRF); ++ PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x0); /*/ RF LO disabled*/ ++ } ++ ++ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord, regBB0); ++ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord, regBB1); ++ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, bMaskDWord, regBB2); ++ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, bMaskDWord, regBB3); ++#endif ++ } ++#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++ else if (IS_HARDWARE_TYPE_8814A(pAdapter)) ++ mpt_SetSingleTone_8814A(pAdapter, FALSE, FALSE); ++ ++ else/*/ Turn off all test modes.*/ ++ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); ++#endif ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); ++ ++ } ++} ++ ++void hal_mpt_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) ++{ ++ u8 Rate; ++ ++ pAdapter->mppriv.MptCtx.bCarrierSuppression = bStart; ++ ++ Rate = HwRateToMPTRate(pAdapter->mppriv.rateidx); ++ if (bStart) {/* Start Carrier Suppression.*/ ++ if (Rate <= MPT_RATE_11M) { ++ /*/ 1. if CCK block on?*/ ++ if (!read_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn)) ++ write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, bEnable);/*set CCK block on*/ ++ ++ /*/Turn Off All Test Mode*/ ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) ++ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); /* rSingleTone_ContTx_Jaguar*/ ++ else ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); ++ ++ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); /*/transmit mode*/ ++ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, 0x0); /*/turn off scramble setting*/ ++ ++ /*/Set CCK Tx Test Rate*/ ++ write_bbreg(pAdapter, rCCK0_System, bCCKTxRate, 0x0); /*/Set FTxRate to 1Mbps*/ ++ } ++ ++ /*Set for dynamic set Power index*/ ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); ++ ++ } else {/* Stop Carrier Suppression.*/ ++ ++ if (Rate <= MPT_RATE_11M) { ++ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); /*normal mode*/ ++ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, 0x1); /*turn on scramble setting*/ ++ ++ /*BB Reset*/ ++ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); ++ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); ++ } ++ /*Stop for dynamic set Power index*/ ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); ++ } ++ RTW_INFO("\n MPT_ProSetCarrierSupp() is finished.\n"); ++} ++ ++void hal_mpt_SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart) ++{ ++ u32 cckrate; ++ ++ if (bStart) { ++ ++ /*/ 1. if CCK block on?*/ ++ if (!read_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn)) ++ write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, bEnable);/*set CCK block on*/ ++ ++ /*/Turn Off All Test Mode*/ ++ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) ++ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); /*rSingleTone_ContTx_Jaguar*/ ++ else ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); ++ ++ /*/Set CCK Tx Test Rate*/ ++ ++ cckrate = pAdapter->mppriv.rateidx; ++ ++ write_bbreg(pAdapter, rCCK0_System, bCCKTxRate, cckrate); ++ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); /*/transmit mode*/ ++ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, bEnable); /*/turn on scramble setting*/ ++ ++ if (!IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) { ++ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* rCCK0_RxHP 0xa15[1:0] = 11 force cck rxiq = 0*/ ++ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /*/ 0xc08[16] = 1 force ofdm rxiq = ofdm txiq*/ ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 1); ++ PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 1); ++ } ++ ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); ++ ++ } else { ++ ++ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); /*/normal mode*/ ++ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, bEnable); /*/turn on scramble setting*/ ++ ++ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_8814A(pAdapter) /* && !IS_HARDWARE_TYPE_8822B(pAdapter) */) { ++ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0);/* rCCK0_RxHP 0xa15[1:0] = 2b00*/ ++ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /*/ 0xc08[16] = 0*/ ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 0); ++ PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 0); ++ } ++ ++ /*/BB Reset*/ ++ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); ++ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); ++ ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); ++ } ++ ++ pAdapter->mppriv.MptCtx.bCckContTx = bStart; ++ pAdapter->mppriv.MptCtx.bOfdmContTx = _FALSE; ++} ++ ++void hal_mpt_SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ if (bStart) { ++ if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) ++ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1);/*/set OFDM block on*/ ++ ++ /*/ 2. set CCK test mode off, set to CCK normal mode*/ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0); ++ ++ /*/ 3. turn on scramble setting*/ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 1); ++ ++ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_8814A(pAdapter) /*&& !IS_HARDWARE_TYPE_8822B(pAdapter)*/) { ++ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* rCCK0_RxHP 0xa15[1:0] = 2b'11*/ ++ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /* 0xc08[16] = 1*/ ++ } ++ ++ /*/ 4. Turn On Continue Tx and turn off the other test modes.*/ ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) ++ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ContinuousTx); /*rSingleTone_ContTx_Jaguar*/ ++ else ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ContinuousTx); ++ ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); ++ ++ } else { ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) ++ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); ++ else ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); ++ /*/Delay 10 ms*/ ++ rtw_msleep_os(10); ++ ++ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_8814A(pAdapter) /*&&! IS_HARDWARE_TYPE_8822B(pAdapter)*/) { ++ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0);/*/ 0xa15[1:0] = 0*/ ++ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0);/*/ 0xc08[16] = 0*/ ++ } ++ ++ /*/BB Reset*/ ++ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); ++ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); ++ ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); ++ } ++ ++ pAdapter->mppriv.MptCtx.bCckContTx = _FALSE; ++ pAdapter->mppriv.MptCtx.bOfdmContTx = bStart; ++} ++ ++void hal_mpt_SetContinuousTx(PADAPTER pAdapter, u8 bStart) ++{ ++ u8 Rate; ++ ++ Rate = HwRateToMPTRate(pAdapter->mppriv.rateidx); ++ pAdapter->mppriv.MptCtx.bStartContTx = bStart; ++ ++ if (Rate <= MPT_RATE_11M) ++ hal_mpt_SetCCKContinuousTx(pAdapter, bStart); ++ else if (Rate >= MPT_RATE_6M) ++ hal_mpt_SetOFDMContinuousTx(pAdapter, bStart); ++} ++ ++u32 hal_mpt_query_phytxok(PADAPTER pAdapter) ++{ ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ RT_PMAC_TX_INFO PMacTxInfo = pMptCtx->PMacTxInfo; ++ u16 count = 0; ++ ++ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) ++ count = PHY_QueryBBReg(pAdapter, 0xF50, bMaskLWord); /* [15:0]*/ ++ else ++ count = PHY_QueryBBReg(pAdapter, 0xF50, bMaskHWord); /* [31:16]*/ ++ ++ if (count > 50000) { ++ rtw_reset_phy_trx_ok_counters(pAdapter); ++ pAdapter->mppriv.tx.sended += count; ++ count = 0; ++ } ++ ++ return pAdapter->mppriv.tx.sended + count; ++ ++} ++ ++#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821B) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++/* for HW TX mode */ ++static VOID mpt_StopCckContTx( ++ PADAPTER pAdapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ u1Byte u1bReg; ++ ++ pMptCtx->bCckContTx = FALSE; ++ pMptCtx->bOfdmContTx = FALSE; ++ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); /*normal mode*/ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x1); /*turn on scramble setting*/ ++ ++ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) { ++ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0); /* 0xa15[1:0] = 2b00*/ ++ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /* 0xc08[16] = 0*/ ++ ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 0); ++ PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 0); ++ } ++ ++ /*BB Reset*/ ++ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); ++ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); ++ ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); ++ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); ++ ++} /* mpt_StopCckContTx */ ++ ++ ++static VOID mpt_StopOfdmContTx( ++ PADAPTER pAdapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ u1Byte u1bReg; ++ u4Byte data; ++ ++ pMptCtx->bCckContTx = FALSE; ++ pMptCtx->bOfdmContTx = FALSE; ++ ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) ++ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); ++ else ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); ++ ++ rtw_mdelay_os(10); ++ ++ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) { ++ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0); /* 0xa15[1:0] = 0*/ ++ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /* 0xc08[16] = 0*/ ++ } ++ ++ /*BB Reset*/ ++ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); ++ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); ++ ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); ++ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); ++} /* mpt_StopOfdmContTx */ ++ ++ ++static VOID mpt_StartCckContTx( ++ PADAPTER pAdapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ u4Byte cckrate; ++ ++ /* 1. if CCK block on */ ++ if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn)) ++ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn, 1);/*set CCK block on*/ ++ ++ /*Turn Off All Test Mode*/ ++ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) ++ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); ++ else ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); ++ ++ cckrate = pAdapter->mppriv.rateidx; ++ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKTxRate, cckrate); ++ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); /*transmit mode*/ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x1); /*turn on scramble setting*/ ++ ++ if (!IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) { ++ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* 0xa15[1:0] = 11 force cck rxiq = 0*/ ++ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /* 0xc08[16] = 1 force ofdm rxiq = ofdm txiq*/ ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 1); ++ PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 1); ++ } ++ ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); ++ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); ++ ++ pMptCtx->bCckContTx = TRUE; ++ pMptCtx->bOfdmContTx = FALSE; ++ ++} /* mpt_StartCckContTx */ ++ ++ ++static VOID mpt_StartOfdmContTx( ++ PADAPTER pAdapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ ++ /* 1. if OFDM block on?*/ ++ if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) ++ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1);/*set OFDM block on*/ ++ ++ /* 2. set CCK test mode off, set to CCK normal mode*/ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0); ++ ++ /* 3. turn on scramble setting*/ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 1); ++ ++ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) { ++ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* 0xa15[1:0] = 2b'11*/ ++ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /* 0xc08[16] = 1*/ ++ } ++ ++ /* 4. Turn On Continue Tx and turn off the other test modes.*/ ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) ++ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ContinuousTx); ++ else ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ContinuousTx); ++ ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); ++ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); ++ ++ pMptCtx->bCckContTx = FALSE; ++ pMptCtx->bOfdmContTx = TRUE; ++} /* mpt_StartOfdmContTx */ ++ ++ ++void mpt_ProSetPMacTx(PADAPTER Adapter) ++{ ++ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); ++ RT_PMAC_TX_INFO PMacTxInfo = pMptCtx->PMacTxInfo; ++ u32 u4bTmp; ++ ++ DbgPrint("SGI %d bSPreamble %d bSTBC %d bLDPC %d NDP_sound %d\n", PMacTxInfo.bSGI, PMacTxInfo.bSPreamble, PMacTxInfo.bSTBC, PMacTxInfo.bLDPC, PMacTxInfo.NDP_sound); ++ DbgPrint("TXSC %d BandWidth %d PacketPeriod %d PacketCount %d PacketLength %d PacketPattern %d\n", PMacTxInfo.TX_SC, PMacTxInfo.BandWidth, PMacTxInfo.PacketPeriod, PMacTxInfo.PacketCount, ++ PMacTxInfo.PacketLength, PMacTxInfo.PacketPattern); ++#if 0 ++ PRINT_DATA("LSIG ", PMacTxInfo.LSIG, 3); ++ PRINT_DATA("HT_SIG", PMacTxInfo.HT_SIG, 6); ++ PRINT_DATA("VHT_SIG_A", PMacTxInfo.VHT_SIG_A, 6); ++ PRINT_DATA("VHT_SIG_B", PMacTxInfo.VHT_SIG_B, 4); ++ DbgPrint("VHT_SIG_B_CRC %x\n", PMacTxInfo.VHT_SIG_B_CRC); ++ PRINT_DATA("VHT_Delimiter", PMacTxInfo.VHT_Delimiter, 4); ++ ++ PRINT_DATA("Src Address", Adapter->mac_addr, 6); ++ PRINT_DATA("Dest Address", PMacTxInfo.MacAddress, 6); ++#endif ++ ++ if (PMacTxInfo.bEnPMacTx == FALSE) { ++ if (PMacTxInfo.Mode == CONTINUOUS_TX) { ++ PHY_SetBBReg(Adapter, 0xb04, 0xf, 2); /* TX Stop*/ ++ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) ++ mpt_StopCckContTx(Adapter); ++ else ++ mpt_StopOfdmContTx(Adapter); ++ } else if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) { ++ u4bTmp = PHY_QueryBBReg(Adapter, 0xf50, bMaskLWord); ++ PHY_SetBBReg(Adapter, 0xb1c, bMaskLWord, u4bTmp + 50); ++ PHY_SetBBReg(Adapter, 0xb04, 0xf, 2); /*TX Stop*/ ++ } else ++ PHY_SetBBReg(Adapter, 0xb04, 0xf, 2); /* TX Stop*/ ++ ++ if (PMacTxInfo.Mode == OFDM_Single_Tone_TX) { ++ /* Stop HW TX -> Stop Continuous TX -> Stop RF Setting*/ ++ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) ++ mpt_StopCckContTx(Adapter); ++ else ++ mpt_StopOfdmContTx(Adapter); ++ ++ mpt_SetSingleTone_8814A(Adapter, FALSE, TRUE); ++ } ++ ++ return; ++ } ++ ++ if (PMacTxInfo.Mode == CONTINUOUS_TX) { ++ PMacTxInfo.PacketCount = 1; ++ ++ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) ++ mpt_StartCckContTx(Adapter); ++ else ++ mpt_StartOfdmContTx(Adapter); ++ } else if (PMacTxInfo.Mode == OFDM_Single_Tone_TX) { ++ /* Continuous TX -> HW TX -> RF Setting */ ++ PMacTxInfo.PacketCount = 1; ++ ++ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) ++ mpt_StartCckContTx(Adapter); ++ else ++ mpt_StartOfdmContTx(Adapter); ++ } else if (PMacTxInfo.Mode == PACKETS_TX) { ++ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE) && PMacTxInfo.PacketCount == 0) ++ PMacTxInfo.PacketCount = 0xffff; ++ } ++ ++ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) { ++ /* 0xb1c[0:15] TX packet count 0xb1C[31:16] SFD*/ ++ u4bTmp = PMacTxInfo.PacketCount | (PMacTxInfo.SFD << 16); ++ PHY_SetBBReg(Adapter, 0xb1c, bMaskDWord, u4bTmp); ++ /* 0xb40 7:0 SIGNAL 15:8 SERVICE 31:16 LENGTH*/ ++ u4bTmp = PMacTxInfo.SignalField | (PMacTxInfo.ServiceField << 8) | (PMacTxInfo.LENGTH << 16); ++ PHY_SetBBReg(Adapter, 0xb40, bMaskDWord, u4bTmp); ++ u4bTmp = PMacTxInfo.CRC16[0] | (PMacTxInfo.CRC16[1] << 8); ++ PHY_SetBBReg(Adapter, 0xb44, bMaskLWord, u4bTmp); ++ ++ if (PMacTxInfo.bSPreamble) ++ PHY_SetBBReg(Adapter, 0xb0c, BIT27, 0); ++ else ++ PHY_SetBBReg(Adapter, 0xb0c, BIT27, 1); ++ } else { ++ PHY_SetBBReg(Adapter, 0xb18, 0xfffff, PMacTxInfo.PacketCount); ++ ++ u4bTmp = PMacTxInfo.LSIG[0] | ((PMacTxInfo.LSIG[1]) << 8) | ((PMacTxInfo.LSIG[2]) << 16) | ((PMacTxInfo.PacketPattern) << 24); ++ PHY_SetBBReg(Adapter, 0xb08, bMaskDWord, u4bTmp); /* Set 0xb08[23:0] = LSIG, 0xb08[31:24] = Data init octet*/ ++ ++ if (PMacTxInfo.PacketPattern == 0x12) ++ u4bTmp = 0x3000000; ++ else ++ u4bTmp = 0; ++ } ++ ++ if (IS_MPT_HT_RATE(PMacTxInfo.TX_RATE)) { ++ u4bTmp |= PMacTxInfo.HT_SIG[0] | ((PMacTxInfo.HT_SIG[1]) << 8) | ((PMacTxInfo.HT_SIG[2]) << 16); ++ PHY_SetBBReg(Adapter, 0xb0c, bMaskDWord, u4bTmp); ++ u4bTmp = PMacTxInfo.HT_SIG[3] | ((PMacTxInfo.HT_SIG[4]) << 8) | ((PMacTxInfo.HT_SIG[5]) << 16); ++ PHY_SetBBReg(Adapter, 0xb10, 0xffffff, u4bTmp); ++ } else if (IS_MPT_VHT_RATE(PMacTxInfo.TX_RATE)) { ++ u4bTmp |= PMacTxInfo.VHT_SIG_A[0] | ((PMacTxInfo.VHT_SIG_A[1]) << 8) | ((PMacTxInfo.VHT_SIG_A[2]) << 16); ++ PHY_SetBBReg(Adapter, 0xb0c, bMaskDWord, u4bTmp); ++ u4bTmp = PMacTxInfo.VHT_SIG_A[3] | ((PMacTxInfo.VHT_SIG_A[4]) << 8) | ((PMacTxInfo.VHT_SIG_A[5]) << 16); ++ PHY_SetBBReg(Adapter, 0xb10, 0xffffff, u4bTmp); ++ ++ _rtw_memcpy(&u4bTmp, PMacTxInfo.VHT_SIG_B, 4); ++ PHY_SetBBReg(Adapter, 0xb14, bMaskDWord, u4bTmp); ++ } ++ ++ if (IS_MPT_VHT_RATE(PMacTxInfo.TX_RATE)) { ++ u4bTmp = (PMacTxInfo.VHT_SIG_B_CRC << 24) | PMacTxInfo.PacketPeriod; /* for TX interval */ ++ PHY_SetBBReg(Adapter, 0xb20, bMaskDWord, u4bTmp); ++ ++ _rtw_memcpy(&u4bTmp, PMacTxInfo.VHT_Delimiter, 4); ++ PHY_SetBBReg(Adapter, 0xb24, bMaskDWord, u4bTmp); ++ ++ /* 0xb28 - 0xb34 24 byte Probe Request MAC Header*/ ++ /*& Duration & Frame control*/ ++ PHY_SetBBReg(Adapter, 0xb28, bMaskDWord, 0x00000040); ++ ++ /* Address1 [0:3]*/ ++ u4bTmp = PMacTxInfo.MacAddress[0] | (PMacTxInfo.MacAddress[1] << 8) | (PMacTxInfo.MacAddress[2] << 16) | (PMacTxInfo.MacAddress[3] << 24); ++ PHY_SetBBReg(Adapter, 0xb2C, bMaskDWord, u4bTmp); ++ ++ /* Address3 [3:0]*/ ++ PHY_SetBBReg(Adapter, 0xb38, bMaskDWord, u4bTmp); ++ ++ /* Address2[0:1] & Address1 [5:4]*/ ++ u4bTmp = PMacTxInfo.MacAddress[4] | (PMacTxInfo.MacAddress[5] << 8) | (Adapter->mac_addr[0] << 16) | (Adapter->mac_addr[1] << 24); ++ PHY_SetBBReg(Adapter, 0xb30, bMaskDWord, u4bTmp); ++ ++ /* Address2 [5:2]*/ ++ u4bTmp = Adapter->mac_addr[2] | (Adapter->mac_addr[3] << 8) | (Adapter->mac_addr[4] << 16) | (Adapter->mac_addr[5] << 24); ++ PHY_SetBBReg(Adapter, 0xb34, bMaskDWord, u4bTmp); ++ ++ /* Sequence Control & Address3 [5:4]*/ ++ /*u4bTmp = PMacTxInfo.MacAddress[4]|(PMacTxInfo.MacAddress[5] << 8) ;*/ ++ /*PHY_SetBBReg(Adapter, 0xb38, bMaskDWord, u4bTmp);*/ ++ } else { ++ PHY_SetBBReg(Adapter, 0xb20, bMaskDWord, PMacTxInfo.PacketPeriod); /* for TX interval*/ ++ /* & Duration & Frame control */ ++ PHY_SetBBReg(Adapter, 0xb24, bMaskDWord, 0x00000040); ++ ++ /* 0xb24 - 0xb38 24 byte Probe Request MAC Header*/ ++ /* Address1 [0:3]*/ ++ u4bTmp = PMacTxInfo.MacAddress[0] | (PMacTxInfo.MacAddress[1] << 8) | (PMacTxInfo.MacAddress[2] << 16) | (PMacTxInfo.MacAddress[3] << 24); ++ PHY_SetBBReg(Adapter, 0xb28, bMaskDWord, u4bTmp); ++ ++ /* Address3 [3:0]*/ ++ PHY_SetBBReg(Adapter, 0xb34, bMaskDWord, u4bTmp); ++ ++ /* Address2[0:1] & Address1 [5:4]*/ ++ u4bTmp = PMacTxInfo.MacAddress[4] | (PMacTxInfo.MacAddress[5] << 8) | (Adapter->mac_addr[0] << 16) | (Adapter->mac_addr[1] << 24); ++ PHY_SetBBReg(Adapter, 0xb2c, bMaskDWord, u4bTmp); ++ ++ /* Address2 [5:2] */ ++ u4bTmp = Adapter->mac_addr[2] | (Adapter->mac_addr[3] << 8) | (Adapter->mac_addr[4] << 16) | (Adapter->mac_addr[5] << 24); ++ PHY_SetBBReg(Adapter, 0xb30, bMaskDWord, u4bTmp); ++ ++ /* Sequence Control & Address3 [5:4]*/ ++ u4bTmp = PMacTxInfo.MacAddress[4] | (PMacTxInfo.MacAddress[5] << 8); ++ PHY_SetBBReg(Adapter, 0xb38, bMaskDWord, u4bTmp); ++ } ++ ++ PHY_SetBBReg(Adapter, 0xb48, bMaskByte3, PMacTxInfo.TX_RATE_HEX); ++ ++ /* 0xb4c 3:0 TXSC 5:4 BW 7:6 m_STBC 8 NDP_Sound*/ ++ u4bTmp = (PMacTxInfo.TX_SC) | ((PMacTxInfo.BandWidth) << 4) | ((PMacTxInfo.m_STBC - 1) << 6) | ((PMacTxInfo.NDP_sound) << 8); ++ PHY_SetBBReg(Adapter, 0xb4c, 0x1ff, u4bTmp); ++ ++ if (IS_HARDWARE_TYPE_8814A(Adapter) || IS_HARDWARE_TYPE_8822B(Adapter)) { ++ u4Byte offset = 0xb44; ++ ++ if (IS_MPT_OFDM_RATE(PMacTxInfo.TX_RATE)) ++ PHY_SetBBReg(Adapter, offset, 0xc0000000, 0); ++ else if (IS_MPT_HT_RATE(PMacTxInfo.TX_RATE)) ++ PHY_SetBBReg(Adapter, offset, 0xc0000000, 1); ++ else if (IS_MPT_VHT_RATE(PMacTxInfo.TX_RATE)) ++ PHY_SetBBReg(Adapter, offset, 0xc0000000, 2); ++ } ++ ++ PHY_SetBBReg(Adapter, 0xb00, BIT8, 1); /* Turn on PMAC*/ ++ /* PHY_SetBBReg(Adapter, 0xb04, 0xf, 2); */ /* TX Stop */ ++ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) { ++ PHY_SetBBReg(Adapter, 0xb04, 0xf, 8); /*TX CCK ON*/ ++ PHY_SetBBReg(Adapter, 0xA84, BIT31, 0); ++ } else ++ PHY_SetBBReg(Adapter, 0xb04, 0xf, 4); /* TX Ofdm ON */ ++ ++ if (PMacTxInfo.Mode == OFDM_Single_Tone_TX) ++ mpt_SetSingleTone_8814A(Adapter, TRUE, TRUE); ++ ++} ++#endif ++ ++#endif /* CONFIG_MP_INCLUDE*/ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_phy.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_phy.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/hal_phy.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_phy.c 2018-02-11 21:44:27.152146162 +0200 +@@ -0,0 +1,260 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _HAL_PHY_C_ ++ ++#include ++ ++/* ******************************************************************************** ++ * Constant. ++ * ******************************************************************************** ++ * 2008/11/20 MH For Debug only, RF */ ++static RF_SHADOW_T RF_Shadow[RF6052_MAX_PATH][RF6052_MAX_REG]; ++ ++/** ++* Function: PHY_CalculateBitShift ++* ++* OverView: Get shifted position of the BitMask ++* ++* Input: ++* u4Byte BitMask, ++* ++* Output: none ++* Return: u4Byte Return the shift bit bit position of the mask ++*/ ++u32 ++PHY_CalculateBitShift( ++ u32 BitMask ++) ++{ ++ u32 i; ++ ++ for (i = 0; i <= 31; i++) { ++ if (((BitMask >> i) & 0x1) == 1) ++ break; ++ } ++ ++ return i; ++} ++ ++ ++/* ++ * ==> RF shadow Operation API Code Section!!! ++ * ++ *----------------------------------------------------------------------------- ++ * Function: PHY_RFShadowRead ++ * PHY_RFShadowWrite ++ * PHY_RFShadowCompare ++ * PHY_RFShadowRecorver ++ * PHY_RFShadowCompareAll ++ * PHY_RFShadowRecorverAll ++ * PHY_RFShadowCompareFlagSet ++ * PHY_RFShadowRecorverFlagSet ++ * ++ * Overview: When we set RF register, we must write shadow at first. ++ * When we are running, we must compare shadow abd locate error addr. ++ * Decide to recorver or not. ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 11/20/2008 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++u32 ++PHY_RFShadowRead( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 Offset) ++{ ++ return RF_Shadow[eRFPath][Offset].Value; ++ ++} /* PHY_RFShadowRead */ ++ ++ ++VOID ++PHY_RFShadowWrite( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 Offset, ++ IN u32 Data) ++{ ++ RF_Shadow[eRFPath][Offset].Value = (Data & bRFRegOffsetMask); ++ RF_Shadow[eRFPath][Offset].Driver_Write = _TRUE; ++ ++} /* PHY_RFShadowWrite */ ++ ++ ++BOOLEAN ++PHY_RFShadowCompare( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 Offset) ++{ ++ u32 reg; ++ /* Check if we need to check the register */ ++ if (RF_Shadow[eRFPath][Offset].Compare == _TRUE) { ++ reg = rtw_hal_read_rfreg(Adapter, eRFPath, Offset, bRFRegOffsetMask); ++ /* Compare shadow and real rf register for 20bits!! */ ++ if (RF_Shadow[eRFPath][Offset].Value != reg) { ++ /* Locate error position. */ ++ RF_Shadow[eRFPath][Offset].ErrorOrNot = _TRUE; ++ } ++ return RF_Shadow[eRFPath][Offset].ErrorOrNot ; ++ } ++ return _FALSE; ++} /* PHY_RFShadowCompare */ ++ ++ ++VOID ++PHY_RFShadowRecorver( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 Offset) ++{ ++ /* Check if the address is error */ ++ if (RF_Shadow[eRFPath][Offset].ErrorOrNot == _TRUE) { ++ /* Check if we need to recorver the register. */ ++ if (RF_Shadow[eRFPath][Offset].Recorver == _TRUE) { ++ rtw_hal_write_rfreg(Adapter, eRFPath, Offset, bRFRegOffsetMask, ++ RF_Shadow[eRFPath][Offset].Value); ++ } ++ } ++ ++} /* PHY_RFShadowRecorver */ ++ ++ ++VOID ++PHY_RFShadowCompareAll( ++ IN PADAPTER Adapter) ++{ ++ u8 eRFPath = 0 ; ++ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); ++ ++ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { ++ for (Offset = 0; Offset < maxReg; Offset++) ++ PHY_RFShadowCompare(Adapter, eRFPath, Offset); ++ } ++ ++} /* PHY_RFShadowCompareAll */ ++ ++ ++VOID ++PHY_RFShadowRecorverAll( ++ IN PADAPTER Adapter) ++{ ++ u8 eRFPath = 0; ++ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); ++ ++ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { ++ for (Offset = 0; Offset < maxReg; Offset++) ++ PHY_RFShadowRecorver(Adapter, eRFPath, Offset); ++ } ++ ++} /* PHY_RFShadowRecorverAll */ ++ ++ ++VOID ++PHY_RFShadowCompareFlagSet( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 Offset, ++ IN u8 Type) ++{ ++ /* Set True or False!!! */ ++ RF_Shadow[eRFPath][Offset].Compare = Type; ++ ++} /* PHY_RFShadowCompareFlagSet */ ++ ++ ++VOID ++PHY_RFShadowRecorverFlagSet( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 Offset, ++ IN u8 Type) ++{ ++ /* Set True or False!!! */ ++ RF_Shadow[eRFPath][Offset].Recorver = Type; ++ ++} /* PHY_RFShadowRecorverFlagSet */ ++ ++ ++VOID ++PHY_RFShadowCompareFlagSetAll( ++ IN PADAPTER Adapter) ++{ ++ u8 eRFPath = 0; ++ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); ++ ++ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { ++ for (Offset = 0; Offset < maxReg; Offset++) { ++ /* 2008/11/20 MH For S3S4 test, we only check reg 26/27 now!!!! */ ++ if (Offset != 0x26 && Offset != 0x27) ++ PHY_RFShadowCompareFlagSet(Adapter, eRFPath, Offset, _FALSE); ++ else ++ PHY_RFShadowCompareFlagSet(Adapter, eRFPath, Offset, _TRUE); ++ } ++ } ++ ++} /* PHY_RFShadowCompareFlagSetAll */ ++ ++ ++VOID ++PHY_RFShadowRecorverFlagSetAll( ++ IN PADAPTER Adapter) ++{ ++ u8 eRFPath = 0; ++ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); ++ ++ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { ++ for (Offset = 0; Offset < maxReg; Offset++) { ++ /* 2008/11/20 MH For S3S4 test, we only check reg 26/27 now!!!! */ ++ if (Offset != 0x26 && Offset != 0x27) ++ PHY_RFShadowRecorverFlagSet(Adapter, eRFPath, Offset, _FALSE); ++ else ++ PHY_RFShadowRecorverFlagSet(Adapter, eRFPath, Offset, _TRUE); ++ } ++ } ++ ++} /* PHY_RFShadowCompareFlagSetAll */ ++ ++VOID ++PHY_RFShadowRefresh( ++ IN PADAPTER Adapter) ++{ ++ u8 eRFPath = 0; ++ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); ++ ++ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { ++ for (Offset = 0; Offset < maxReg; Offset++) { ++ RF_Shadow[eRFPath][Offset].Value = 0; ++ RF_Shadow[eRFPath][Offset].Compare = _FALSE; ++ RF_Shadow[eRFPath][Offset].Recorver = _FALSE; ++ RF_Shadow[eRFPath][Offset].ErrorOrNot = _FALSE; ++ RF_Shadow[eRFPath][Offset].Driver_Write = _FALSE; ++ } ++ } ++ ++} /* PHY_RFShadowRead */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/HalPwrSeqCmd.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/HalPwrSeqCmd.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/HalPwrSeqCmd.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/HalPwrSeqCmd.c 2018-02-11 21:44:27.143146025 +0200 +@@ -0,0 +1,188 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++/*++ ++Copyright (c) Realtek Semiconductor Corp. All rights reserved. ++ ++Module Name: ++ HalPwrSeqCmd.c ++ ++Abstract: ++ Implement HW Power sequence configuration CMD handling routine for Realtek devices. ++ ++Major Change History: ++ When Who What ++ ---------- --------------- ------------------------------- ++ 2011-10-26 Lucas Modify to be compatible with SD4-CE driver. ++ 2011-07-07 Roger Create. ++ ++--*/ ++#include ++ ++ ++/* ++ * Description: ++ * This routine deal with the Power Configuration CMDs parsing for RTL8723/RTL8188E Series IC. ++ * ++ * Assumption: ++ * We should follow specific format which was released from HW SD. ++ * ++ * 2011.07.07, added by Roger. ++ * */ ++u8 HalPwrSeqCmdParsing( ++ PADAPTER padapter, ++ u8 CutVersion, ++ u8 FabVersion, ++ u8 InterfaceType, ++ WLAN_PWR_CFG PwrSeqCmd[]) ++{ ++ WLAN_PWR_CFG PwrCfgCmd = {0}; ++ u8 bPollingBit = _FALSE; ++ u32 AryIdx = 0; ++ u8 value = 0; ++ u32 offset = 0; ++ u8 flag = 0; ++ u32 pollingCount = 0; /* polling autoload done. */ ++ u32 maxPollingCnt = 5000; ++ ++ do { ++ PwrCfgCmd = PwrSeqCmd[AryIdx]; ++ ++ ++ /* 2 Only Handle the command whose FAB, CUT, and Interface are matched */ ++ if ((GET_PWR_CFG_FAB_MASK(PwrCfgCmd) & FabVersion) && ++ (GET_PWR_CFG_CUT_MASK(PwrCfgCmd) & CutVersion) && ++ (GET_PWR_CFG_INTF_MASK(PwrCfgCmd) & InterfaceType)) { ++ switch (GET_PWR_CFG_CMD(PwrCfgCmd)) { ++ case PWR_CMD_READ: ++ break; ++ ++ case PWR_CMD_WRITE: ++ offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); ++ ++#ifdef CONFIG_SDIO_HCI ++ /* */ ++ /* We should deal with interface specific address mapping for some interfaces, e.g., SDIO interface */ ++ /* 2011.07.07. */ ++ /* */ ++ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) { ++ /* Read Back SDIO Local value */ ++ value = SdioLocalCmd52Read1Byte(padapter, offset); ++ ++ value &= ~(GET_PWR_CFG_MASK(PwrCfgCmd)); ++ value |= (GET_PWR_CFG_VALUE(PwrCfgCmd) & GET_PWR_CFG_MASK(PwrCfgCmd)); ++ ++ /* Write Back SDIO Local value */ ++ SdioLocalCmd52Write1Byte(padapter, offset, value); ++ } else ++#endif ++ { ++#ifdef CONFIG_GSPI_HCI ++ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) ++ offset = SPI_LOCAL_OFFSET | offset; ++#endif ++ /* Read the value from system register */ ++ value = rtw_read8(padapter, offset); ++ ++ value = value & (~(GET_PWR_CFG_MASK(PwrCfgCmd))); ++ value = value | (GET_PWR_CFG_VALUE(PwrCfgCmd) & GET_PWR_CFG_MASK(PwrCfgCmd)); ++ ++ /* Write the value back to sytem register */ ++ rtw_write8(padapter, offset, value); ++ } ++ break; ++ ++ case PWR_CMD_POLLING: ++ ++ bPollingBit = _FALSE; ++ offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); ++ ++ if (/*bHWICSpport &&*/ offset == 0x06) { ++ flag = 0; ++ maxPollingCnt = 100000; ++ } else ++ maxPollingCnt = 5000; ++ ++#ifdef CONFIG_GSPI_HCI ++ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) ++ offset = SPI_LOCAL_OFFSET | offset; ++#endif ++ do { ++#ifdef CONFIG_SDIO_HCI ++ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) ++ value = SdioLocalCmd52Read1Byte(padapter, offset); ++ else ++#endif ++ value = rtw_read8(padapter, offset); ++ ++ value = value & GET_PWR_CFG_MASK(PwrCfgCmd); ++ if (value == (GET_PWR_CFG_VALUE(PwrCfgCmd) & GET_PWR_CFG_MASK(PwrCfgCmd))) ++ bPollingBit = _TRUE; ++ else ++ rtw_udelay_os(10); ++ ++ if (pollingCount++ > maxPollingCnt) { ++ RTW_ERR("HalPwrSeqCmdParsing: Fail to polling Offset[%#x]=%02x\n", offset, value); ++ ++ /* For PCIE + USB package poll power bit timeout issue only modify 8821AE and 8723BE */ ++ if (/*bHWICSpport &&*/ offset == 0x06 && flag == 0) { ++ ++ RTW_ERR("[WARNING] PCIE polling(0x%X) timeout(%d), Toggle 0x04[3] and try again.\n", offset, maxPollingCnt); ++ if (IS_HARDWARE_TYPE_8723DE(padapter)) ++ PlatformEFIOWrite1Byte(padapter, 0x40, (PlatformEFIORead1Byte(padapter, 0x40)) & (~BIT3)); ++ ++ PlatformEFIOWrite1Byte(padapter, 0x04, PlatformEFIORead1Byte(padapter, 0x04) | BIT3); ++ PlatformEFIOWrite1Byte(padapter, 0x04, PlatformEFIORead1Byte(padapter, 0x04) & ~BIT3); ++ ++ if (IS_HARDWARE_TYPE_8723DE(padapter)) ++ PlatformEFIOWrite1Byte(padapter, 0x40, PlatformEFIORead1Byte(padapter, 0x40)|BIT3); ++ ++ /* Retry Polling Process one more time */ ++ pollingCount = 0; ++ flag = 1; ++ } else { ++ return _FALSE; ++ } ++ } ++ } while (!bPollingBit); ++ ++ break; ++ ++ case PWR_CMD_DELAY: ++ if (GET_PWR_CFG_VALUE(PwrCfgCmd) == PWRSEQ_DELAY_US) ++ rtw_udelay_os(GET_PWR_CFG_OFFSET(PwrCfgCmd)); ++ else ++ rtw_udelay_os(GET_PWR_CFG_OFFSET(PwrCfgCmd) * 1000); ++ break; ++ ++ case PWR_CMD_END: ++ /* When this command is parsed, end the process */ ++ return _TRUE; ++ break; ++ ++ default: ++ break; ++ } ++ } ++ ++ AryIdx++;/* Add Array Index */ ++ } while (1); ++ ++ return _TRUE; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/led/hal_pci_led.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/led/hal_pci_led.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/led/hal_pci_led.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/led/hal_pci_led.c 2018-02-11 21:44:27.152146162 +0200 +@@ -0,0 +1,2166 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#include ++#include ++ ++/* ++ * Description: ++ * Turn on LED according to LedPin specified. ++ * */ ++VOID ++HwLedBlink( ++ IN PADAPTER Adapter, ++ IN PLED_PCIE pLed ++) ++{ ++ ++ ++ switch (pLed->LedPin) { ++ case LED_PIN_GPIO0: ++ break; ++ ++ case LED_PIN_LED0: ++ /* rtw_write8(Adapter, LED0Cfg, 0x2); */ ++ break; ++ ++ case LED_PIN_LED1: ++ /* rtw_write8(Adapter, LED1Cfg, 0x2); */ ++ break; ++ ++ default: ++ break; ++ } ++ ++ pLed->bLedOn = _TRUE; ++} ++ ++/* ++ * Description: ++ * Implement LED blinking behavior for SW_LED_MODE0. ++ * It toggle off LED and schedule corresponding timer if necessary. ++ * */ ++VOID ++SwLedBlink( ++ IN PLED_PCIE pLed ++) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ BOOLEAN bStopBlinking = _FALSE; ++ ++ /* Change LED according to BlinkingLedState specified. */ ++ if (pLed->BlinkingLedState == RTW_LED_ON) { ++ SwLedOn(Adapter, pLed); ++ } else { ++ SwLedOff(Adapter, pLed); ++ } ++ ++ /* Determine if we shall change LED state again. */ ++ pLed->BlinkTimes--; ++ switch (pLed->CurrLedState) { ++ case LED_BLINK_NORMAL: ++ case LED_BLINK_TXRX: ++ case LED_BLINK_RUNTOP: ++ if (pLed->BlinkTimes == 0) ++ bStopBlinking = _TRUE; ++ break; ++ ++ case LED_BLINK_SCAN: ++ if (((check_fwstate(pmlmepriv, WIFI_STATION_STATE) && check_fwstate(pmlmepriv, _FW_LINKED)) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) && /* Linked. */ ++ (!check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) && /* Not in scan stage. */ ++ (pLed->BlinkTimes % 2 == 0)) /* Even */ ++ bStopBlinking = _TRUE; ++ break; ++ ++ case LED_BLINK_NO_LINK: ++ case LED_BLINK_StartToBlink: ++ if (check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE)) ++ bStopBlinking = _TRUE; ++ else if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) && ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) ++ bStopBlinking = _TRUE; ++ else if (pLed->BlinkTimes == 0) ++ bStopBlinking = _TRUE; ++ break; ++ ++ case LED_BLINK_CAMEO: ++ if (check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE)) ++ bStopBlinking = _TRUE; ++ else if (check_fwstate(pmlmepriv, _FW_LINKED) && ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) ++ bStopBlinking = _TRUE; ++ break; ++ ++ default: ++ bStopBlinking = _TRUE; ++ break; ++ } ++ ++ if (bStopBlinking) { ++ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on) ++ SwLedOff(Adapter, pLed); ++ else if (pLed->CurrLedState == LED_BLINK_TXRX) ++ SwLedOff(Adapter, pLed); ++ else if (pLed->CurrLedState == LED_BLINK_RUNTOP) ++ SwLedOff(Adapter, pLed); ++ else if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) && pLed->bLedOn == _FALSE) ++ SwLedOn(Adapter, pLed); ++ else if ((check_fwstate(pmlmepriv, _FW_LINKED) == _FALSE) && pLed->bLedOn == _TRUE) ++ SwLedOff(Adapter, pLed); ++ ++ pLed->BlinkTimes = 0; ++ pLed->bLedBlinkInProgress = _FALSE; ++ } else { ++ /* Assign LED state to toggle. */ ++ if (pLed->BlinkingLedState == RTW_LED_ON) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ /* Schedule a timer to toggle LED state. */ ++ switch (pLed->CurrLedState) { ++ case LED_BLINK_NORMAL: ++ case LED_BLINK_TXRX: ++ case LED_BLINK_StartToBlink: ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ break; ++ ++ case LED_BLINK_SLOWLY: ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); ++ break; ++ ++ case LED_BLINK_SCAN: ++ case LED_BLINK_NO_LINK: ++ if (pLed->bLedOn) ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); ++ else ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_OFF_INTERVAL); ++ break; ++ ++ case LED_BLINK_RUNTOP: ++ _set_timer(&(pLed->BlinkTimer), LED_RunTop_BLINK_INTERVAL); ++ break; ++ ++ case LED_BLINK_CAMEO: ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_PORNET); ++ break; ++ ++ default: ++ /* RTW_INFO("SwLedCm2Blink(): unexpected state!\n"); */ ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); ++ break; ++ } ++ } ++} ++ ++VOID ++SwLedBlink5( ++ IN PLED_PCIE pLed ++) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ BOOLEAN bStopBlinking = _FALSE; ++ ++ /* Change LED according to BlinkingLedState specified. */ ++ if (pLed->BlinkingLedState == RTW_LED_ON) { ++ SwLedOn(Adapter, pLed); ++ } else { ++ SwLedOff(Adapter, pLed); ++ } ++ ++ switch (pLed->CurrLedState) { ++ case RTW_LED_OFF: ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ case LED_BLINK_SLOWLY: ++ if (pLed->bLedOn) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_NETTRONIX); ++ break; ++ ++ case LED_BLINK_NORMAL: ++ pLed->BlinkTimes--; ++ if (pLed->BlinkTimes == 0) ++ bStopBlinking = _TRUE; ++ if (bStopBlinking) { ++ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on) ++ SwLedOff(Adapter, pLed); ++ else { ++ pLed->bLedSlowBlinkInProgress = _TRUE; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if (pLed->bLedOn) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_NETTRONIX); ++ } ++ pLed->BlinkTimes = 0; ++ pLed->bLedBlinkInProgress = _FALSE; ++ } else { ++ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on) ++ SwLedOff(Adapter, pLed); ++ else { ++ if (pLed->bLedOn) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL_NETTRONIX); ++ } ++ } ++ break; ++ ++ default: ++ break; ++ } ++ ++} ++ ++ ++VOID ++SwLedBlink6( ++ IN PLED_PCIE pLed ++) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ BOOLEAN bStopBlinking = _FALSE; ++ ++ /* Change LED according to BlinkingLedState specified. */ ++ if (pLed->BlinkingLedState == RTW_LED_ON) { ++ SwLedOn(Adapter, pLed); ++ } else { ++ SwLedOff(Adapter, pLed); ++ } ++ ++ switch (pLed->CurrLedState) { ++ case RTW_LED_OFF: ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ case LED_BLINK_SLOWLY: ++ if (pLed->bLedOn) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_PORNET); ++ break; ++ ++ case LED_BLINK_NORMAL: ++ pLed->BlinkTimes--; ++ if (pLed->BlinkTimes == 0) ++ bStopBlinking = _TRUE; ++ if (bStopBlinking) { ++ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on) ++ SwLedOff(Adapter, pLed); ++ else { ++ pLed->bLedSlowBlinkInProgress = _TRUE; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if (pLed->bLedOn) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_PORNET); ++ } ++ pLed->BlinkTimes = 0; ++ pLed->bLedBlinkInProgress = _FALSE; ++ } else { ++ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on) ++ SwLedOff(Adapter, pLed); ++ else { ++ if (pLed->bLedOn) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL_PORNET); ++ } ++ } ++ break; ++ ++ default: ++ break; ++ } ++ ++} ++ ++VOID ++SwLedBlink7( ++ IN PLED_PCIE pLed ++) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ ++ SwLedOn(Adapter, pLed); ++} ++ ++ ++ ++/* ++ * Description: ++ * Implement LED blinking behavior for SW_LED_MODE8. ++ * It toggle off LED and schedule corresponding timer if necessary. ++ * */ ++VOID ++SwLedBlink8( ++ IN PLED_PCIE pLed ++) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ BOOLEAN bStopBlinking = _FALSE; ++ ++ /* Change LED according to BlinkingLedState specified. */ ++ if (pLed->BlinkingLedState == RTW_LED_ON) { ++ SwLedOn(Adapter, pLed); ++ } else { ++ SwLedOff(Adapter, pLed); ++ } ++ ++ ++ /* Determine if we shall change LED state again. */ ++ if (pLed->CurrLedState != LED_BLINK_NO_LINK) ++ pLed->BlinkTimes--; ++ ++ switch (pLed->CurrLedState) { ++ case LED_BLINK_NORMAL: ++ case LED_BLINK_SCAN: ++ if (pLed->BlinkTimes == 0) ++ bStopBlinking = _TRUE; ++ break; ++ ++ default: ++ break; ++ } ++ ++ if (bStopBlinking) { ++ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) { ++ pLed->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed); ++ } else { ++ pLed->CurrLedState = RTW_LED_ON; ++ SwLedOn(Adapter, pLed); ++ } ++ ++ pLed->BlinkTimes = 0; ++ pLed->bLedBlinkInProgress = _FALSE; ++ } else { ++ /* Assign LED state to toggle. */ ++ if (pLed->BlinkingLedState == RTW_LED_ON) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ /* Schedule a timer to toggle LED state. */ ++ switch (pLed->CurrLedState) { ++ case LED_BLINK_NORMAL: ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ break; ++ ++ default: ++ /* RTW_INFO("SwLedCm8Blink(): unexpected state!\n"); */ ++ break; ++ } ++ } ++} ++ ++VOID ++SwLedBlink9( ++ IN PLED_PCIE pLed ++) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ BOOLEAN bStopBlinking = _FALSE; ++ ++ /* Change LED according to BlinkingLedState specified. */ ++ if (pLed->BlinkingLedState == RTW_LED_ON) { ++ SwLedOn(Adapter, pLed); ++ } else { ++ SwLedOff(Adapter, pLed); ++ } ++ ++ /* Determine if we shall change LED state again. */ ++ if (pLed->CurrLedState != LED_BLINK_NO_LINK) ++ pLed->BlinkTimes--; ++ ++ switch (pLed->CurrLedState) { ++ case LED_BLINK_NORMAL: ++ case LED_BLINK_SCAN: ++ if (pLed->BlinkTimes == 0) ++ bStopBlinking = _TRUE; ++ break; ++ ++ case LED_BLINK_NO_LINK: ++ if (check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE)) ++ bStopBlinking = _TRUE; ++ else if (check_fwstate(pmlmepriv, _FW_LINKED) && ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) ++ bStopBlinking = _TRUE; ++ break; ++ ++ default: ++ break; ++ } ++ ++ if (bStopBlinking) { ++ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) { ++ pLed->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed); ++ } else if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ pLed->CurrLedState = RTW_LED_ON; ++ SwLedOn(Adapter, pLed); ++ } else if (check_fwstate(pmlmepriv, _FW_LINKED) == _FALSE) { ++ pLed->CurrLedState = LED_BLINK_NO_LINK; ++ if (pLed->bLedOn) ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); ++ else ++ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); ++ } ++ ++ pLed->BlinkTimes = 0; ++ if (pLed->CurrLedState != LED_BLINK_NO_LINK) ++ pLed->bLedBlinkInProgress = _FALSE; ++ } else { ++ /* Assign LED state to toggle. */ ++ if (pLed->BlinkingLedState == RTW_LED_ON) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ /* Schedule a timer to toggle LED state. */ ++ switch (pLed->CurrLedState) { ++ case LED_BLINK_NORMAL: ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FAST_INTERVAL_BITLAND); ++ break; ++ ++ case LED_BLINK_SCAN: ++ case LED_BLINK_NO_LINK: ++ if (pLed->bLedOn) ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); ++ else ++ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); ++ break; ++ ++ default: ++ /* RTW_INFO("SwLedCm2Blink(): unexpected state!\n"); */ ++ break; ++ } ++ } ++ ++ ++} ++ ++ ++VOID ++SwLedBlink10( ++ IN PLED_PCIE pLed ++) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ BOOLEAN bStopBlinking = _FALSE; ++ ++ /* Change LED according to BlinkingLedState specified. */ ++ if (pLed->BlinkingLedState == RTW_LED_ON) { ++ SwLedOn(Adapter, pLed); ++ } else { ++ SwLedOff(Adapter, pLed); ++ } ++ ++ /* Determine if we shall change LED state again. */ ++ if (pLed->CurrLedState != LED_BLINK_NO_LINK) ++ pLed->BlinkTimes--; ++ ++ switch (pLed->CurrLedState) { ++ case LED_BLINK_NORMAL: ++ case LED_BLINK_SCAN: ++ if (pLed->BlinkTimes == 0) ++ bStopBlinking = _TRUE; ++ break; ++ default: ++ break; ++ } ++ ++ if (bStopBlinking) { ++ pLed->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed); ++ ++ pLed->BlinkTimes = 0; ++ pLed->bLedBlinkInProgress = _FALSE; ++ } else { ++ /* Assign LED state to toggle. */ ++ if (pLed->BlinkingLedState == RTW_LED_ON) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ /* Schedule a timer to toggle LED state. */ ++ switch (pLed->CurrLedState) { ++ case LED_BLINK_NORMAL: ++ case LED_BLINK_SCAN: ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FAST_INTERVAL_BITLAND); ++ break; ++ ++ default: ++ /* RT_ASSERT(_FALSE, ("SwLedCm2Blink(): unexpected state!\n")); */ ++ break; ++ } ++ } ++ ++ ++} ++ ++ ++VOID ++SwLedBlink11( ++ IN PLED_PCIE pLed ++) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ BOOLEAN bStopBlinking = _FALSE; ++ ++ /* Change LED according to BlinkingLedState specified. */ ++ if (pLed->bLedBlinkInProgress == _TRUE) { ++ if (pLed->BlinkingLedState == RTW_LED_ON) { ++ SwLedOn(Adapter, pLed); ++ } else { ++ SwLedOff(Adapter, pLed); ++ } ++ } ++ ++ /* Determine if we shall change LED state again. */ ++ if (pLed->CurrLedState != LED_BLINK_NO_LINK) ++ pLed->BlinkTimes--; ++ ++ switch (pLed->CurrLedState) { ++ case RTW_LED_ON: ++ bStopBlinking = _TRUE; /* LED on for 3 seconds */ ++ default: ++ break; ++ } ++ ++ if (bStopBlinking) { ++ pLed->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed); ++ ++ pLed->BlinkTimes = 0; ++ pLed->bLedBlinkInProgress = _FALSE; ++ } else { ++ /* Assign LED state to toggle. */ ++ if (pLed->BlinkingLedState == RTW_LED_ON) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ /* Schedule a timer to toggle LED state. */ ++ switch (pLed->CurrLedState) { ++ case LED_BLINK_XAVI: ++ _set_timer(&(pLed->BlinkTimer), LED_CM11_BLINK_INTERVAL); ++ break; ++ ++ default: ++ /* RT_ASSERT(_FALSE, ("SwLedCm11Blink(): unexpected state!\n")); */ ++ break; ++ } ++ } ++ ++ ++} ++ ++ ++VOID ++SwLedBlink12( ++ IN PLED_PCIE pLed ++) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ BOOLEAN bStopBlinking = _FALSE; ++ ++ /* Change LED according to BlinkingLedState specified. */ ++ if (pLed->BlinkingLedState == RTW_LED_ON) { ++ SwLedOn(Adapter, pLed); ++ } else { ++ SwLedOff(Adapter, pLed); ++ } ++ ++ /* Determine if we shall change LED state again. */ ++ if (pLed->CurrLedState != LED_BLINK_NO_LINK && pLed->CurrLedState != LED_BLINK_Azurewave_5Mbps ++ && pLed->CurrLedState != LED_BLINK_Azurewave_10Mbps && pLed->CurrLedState != LED_BLINK_Azurewave_20Mbps ++ && pLed->CurrLedState != LED_BLINK_Azurewave_40Mbps && pLed->CurrLedState != LED_BLINK_Azurewave_80Mbps ++ && pLed->CurrLedState != LED_BLINK_Azurewave_MAXMbps) ++ pLed->BlinkTimes--; ++ ++ switch (pLed->CurrLedState) { ++ case LED_BLINK_NORMAL: ++ case LED_BLINK_SCAN: ++ if (pLed->BlinkTimes == 0) ++ bStopBlinking = _TRUE; ++ break; ++ ++ case LED_BLINK_NO_LINK: ++ if (check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE)) ++ bStopBlinking = _TRUE; ++ else if (check_fwstate(pmlmepriv, _FW_LINKED) && ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) ++ bStopBlinking = _TRUE; ++ break; ++ ++ case LED_BLINK_Azurewave_5Mbps: ++ case LED_BLINK_Azurewave_10Mbps: ++ case LED_BLINK_Azurewave_20Mbps: ++ case LED_BLINK_Azurewave_40Mbps: ++ case LED_BLINK_Azurewave_80Mbps: ++ case LED_BLINK_Azurewave_MAXMbps: ++ /* if(pTurboCa->TxThroughput + pTurboCa->RxThroughput == 0) */ ++ /* bStopBlinking = _TRUE; */ ++ ++ default: ++ break; ++ } ++ ++ if (bStopBlinking) { ++ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed); ++ } else if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ SwLedOn(Adapter, pLed); ++ } else if (check_fwstate(pmlmepriv, _FW_LINKED) == _FALSE) { ++ pLed->CurrLedState = LED_BLINK_NO_LINK; ++ if (pLed->bLedOn) { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); ++ } else { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); ++ } ++ } ++ ++ pLed->BlinkTimes = 0; ++ if (pLed->CurrLedState != LED_BLINK_NO_LINK) ++ pLed->bLedBlinkInProgress = _FALSE; ++ } else { ++ /* Assign LED state to toggle. */ ++ if (pLed->BlinkingLedState == RTW_LED_ON) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ /* Schedule a timer to toggle LED state. */ ++ switch (pLed->CurrLedState) { ++ case LED_BLINK_Azurewave_5Mbps: ++ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_5Mbps); ++ break; ++ ++ case LED_BLINK_Azurewave_10Mbps: ++ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_10Mbps); ++ break; ++ ++ case LED_BLINK_Azurewave_20Mbps: ++ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_20Mbps); ++ break; ++ ++ case LED_BLINK_Azurewave_40Mbps: ++ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_40Mbps); ++ break; ++ ++ case LED_BLINK_Azurewave_80Mbps: ++ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_80Mbps); ++ break; ++ ++ case LED_BLINK_Azurewave_MAXMbps: ++ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_MAXMbps); ++ break; ++ ++ case LED_BLINK_SCAN: ++ case LED_BLINK_NO_LINK: ++ if (pLed->bLedOn) ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); ++ else ++ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); ++ break; ++ ++ default: ++ /* RT_ASSERT(_FALSE, ("SwLedCm12Blink(): unexpected state!\n")); */ ++ break; ++ } ++ } ++ ++ ++} ++ ++/* ++ * Description: ++ * Handler function of LED Blinking. ++ * We dispatch acture LED blink action according to LedStrategy. ++ * */ ++void BlinkHandler(PLED_PCIE pLed) ++{ ++ _adapter *padapter = pLed->padapter; ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ ++ if (RTW_CANNOT_RUN(padapter)) ++ return; ++ ++ if (IS_HARDWARE_TYPE_8188E(padapter) || ++ IS_HARDWARE_TYPE_JAGUAR(padapter) || ++ IS_HARDWARE_TYPE_8723B(padapter) || ++ IS_HARDWARE_TYPE_8192E(padapter)) ++ return; ++ ++ switch (ledpriv->LedStrategy) { ++ case SW_LED_MODE1: ++ /* SwLedBlink(pLed); */ ++ break; ++ case SW_LED_MODE2: ++ /* SwLedBlink(pLed); */ ++ break; ++ case SW_LED_MODE3: ++ /* SwLedBlink(pLed); */ ++ break; ++ case SW_LED_MODE5: ++ /* SwLedBlink5(pLed); */ ++ break; ++ case SW_LED_MODE6: ++ /* SwLedBlink6(pLed); */ ++ break; ++ case SW_LED_MODE7: ++ SwLedBlink7(pLed); ++ break; ++ case SW_LED_MODE8: ++ SwLedBlink8(pLed); ++ break; ++ ++ case SW_LED_MODE9: ++ SwLedBlink9(pLed); ++ break; ++ ++ case SW_LED_MODE10: ++ SwLedBlink10(pLed); ++ break; ++ ++ case SW_LED_MODE11: ++ SwLedBlink11(pLed); ++ break; ++ ++ case SW_LED_MODE12: ++ SwLedBlink12(pLed); ++ break; ++ ++ default: ++ /* SwLedBlink(pLed); */ ++ break; ++ } ++} ++ ++/* ++ * Description: ++ * Callback function of LED BlinkTimer, ++ * it just schedules to corresponding BlinkWorkItem/led_blink_hdl ++ * */ ++void BlinkTimerCallback(void *data) ++{ ++ PLED_PCIE pLed = (PLED_PCIE)data; ++ _adapter *padapter = pLed->padapter; ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ if (RTW_CANNOT_RUN(padapter) || (!rtw_is_hw_init_completed(padapter))) { ++ /*RTW_INFO("%s bDriverStopped:%s, bSurpriseRemoved:%s\n" ++ , __func__ ++ , rtw_is_drv_stopped(padapter)?"True":"False" ++ , rtw_is_surprise_removed(padapter)?"True":"False" ); ++ */ ++ return; ++ } ++ ++#ifdef CONFIG_LED_HANDLED_BY_CMD_THREAD ++ rtw_led_blink_cmd(padapter, pLed); ++#else ++ BlinkHandler(pLed); ++#endif ++} ++ ++/* ++ * Description: ++ * Implement each led action for SW_LED_MODE0. */ ++VOID ++SwLedControlMode0( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ PLED_PCIE pLed0 = &(ledpriv->SwLed0); ++ PLED_PCIE pLed1 = &(ledpriv->SwLed1); ++ ++ switch (LedAction) { ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ break; ++ ++ case LED_CTL_LINK: ++ pLed0->CurrLedState = RTW_LED_ON; ++ SwLedOn(Adapter, pLed0); ++ ++ pLed1->CurrLedState = LED_BLINK_NORMAL; ++ HwLedBlink(Adapter, pLed1); ++ break; ++ ++ case LED_CTL_POWER_ON: ++ pLed0->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed0); ++ ++ pLed1->CurrLedState = LED_BLINK_NORMAL; ++ HwLedBlink(Adapter, pLed1); ++ ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed0->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed0); ++ ++ pLed1->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed1); ++ break; ++ ++ case LED_CTL_SITE_SURVEY: ++ break; ++ ++ case LED_CTL_NO_LINK: ++ pLed0->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed0); ++ ++ pLed1->CurrLedState = LED_BLINK_NORMAL; ++ HwLedBlink(Adapter, pLed1); ++ break; ++ ++ default: ++ break; ++ } ++ ++} ++ ++ ++VOID ++SwLedControlMode1( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ PLED_PCIE pLed = &(ledpriv->SwLed1); ++ ++ /* Decide led state */ ++ switch (LedAction) { ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if (pLed->bLedBlinkInProgress == _FALSE) { ++ pLed->bLedBlinkInProgress = _TRUE; ++ ++ pLed->CurrLedState = LED_BLINK_NORMAL; ++ pLed->BlinkTimes = 2; ++ ++ if (pLed->bLedOn) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ break; ++ ++ case LED_CTL_SITE_SURVEY: ++ if (pLed->bLedBlinkInProgress == _FALSE) { ++ pLed->bLedBlinkInProgress = _TRUE; ++ ++ if ((check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE)) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) { ++ pLed->CurrLedState = LED_BLINK_SCAN; ++ pLed->BlinkTimes = 4; ++ } else { ++ pLed->CurrLedState = LED_BLINK_NO_LINK; ++ pLed->BlinkTimes = 24; ++ } ++ ++ if (pLed->bLedOn) { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); ++ } else { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_OFF_INTERVAL); ++ } ++ } else { ++ if (pLed->CurrLedState != LED_BLINK_NO_LINK) { ++ if ((check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE)) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) ++ pLed->CurrLedState = LED_BLINK_SCAN; ++ else ++ pLed->CurrLedState = LED_BLINK_NO_LINK; ++ } ++ } ++ break; ++ ++ case LED_CTL_NO_LINK: ++ if (pLed->bLedBlinkInProgress == _FALSE) { ++ pLed->bLedBlinkInProgress = _TRUE; ++ ++ pLed->CurrLedState = LED_BLINK_NO_LINK; ++ pLed->BlinkTimes = 24; ++ ++ if (pLed->bLedOn) { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); ++ } else { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_OFF_INTERVAL); ++ } ++ } else ++ pLed->CurrLedState = LED_BLINK_NO_LINK; ++ break; ++ ++ case LED_CTL_LINK: ++ pLed->CurrLedState = RTW_LED_ON; ++ if (pLed->bLedBlinkInProgress == _FALSE) ++ SwLedOn(Adapter, pLed); ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed->CurrLedState = RTW_LED_OFF; ++ if (pLed->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ default: ++ break; ++ } ++ ++} ++ ++VOID ++SwLedControlMode2( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ PLED_PCIE pLed0 = &(ledpriv->SwLed0); ++ PLED_PCIE pLed1 = &(ledpriv->SwLed1); ++ ++ /* Decide led state */ ++ switch (LedAction) { ++ case LED_CTL_POWER_ON: ++ pLed0->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed0); ++ ++ pLed1->CurrLedState = LED_BLINK_CAMEO; ++ if (pLed1->bLedBlinkInProgress == _FALSE) { ++ pLed1->bLedBlinkInProgress = _TRUE; ++ ++ pLed1->BlinkTimes = 6; ++ ++ if (pLed1->bLedOn) ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_PORNET); ++ } ++ break; ++ ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if (pLed0->bLedBlinkInProgress == _FALSE) { ++ pLed0->bLedBlinkInProgress = _TRUE; ++ ++ pLed0->CurrLedState = LED_BLINK_TXRX; ++ pLed0->BlinkTimes = 2; ++ ++ if (pLed0->bLedOn) ++ pLed0->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed0->BlinkingLedState = RTW_LED_ON; ++ ++ _set_timer(&(pLed0->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ break; ++ ++ case LED_CTL_NO_LINK: ++ pLed1->CurrLedState = LED_BLINK_CAMEO; ++ if (pLed1->bLedBlinkInProgress == _FALSE) { ++ pLed1->bLedBlinkInProgress = _TRUE; ++ ++ pLed1->BlinkTimes = 6; ++ ++ if (pLed1->bLedOn) ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_PORNET); ++ } ++ break; ++ ++ case LED_CTL_LINK: ++ pLed1->CurrLedState = RTW_LED_ON; ++ if (pLed1->bLedBlinkInProgress == _FALSE) ++ SwLedOn(Adapter, pLed1); ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed0->CurrLedState = RTW_LED_OFF; ++ pLed1->CurrLedState = RTW_LED_OFF; ++ if (pLed0->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedBlinkInProgress = _FALSE; ++ } ++ if (pLed1->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed0); ++ SwLedOff(Adapter, pLed1); ++ break; ++ ++ default: ++ break; ++ } ++ ++} ++ ++ ++ ++VOID ++SwLedControlMode3( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ PLED_PCIE pLed0 = &(ledpriv->SwLed0); ++ PLED_PCIE pLed1 = &(ledpriv->SwLed1); ++ ++ /* Decide led state */ ++ switch (LedAction) { ++ case LED_CTL_POWER_ON: ++ pLed0->CurrLedState = RTW_LED_ON; ++ SwLedOn(Adapter, pLed0); ++ pLed1->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed1); ++ break; ++ ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if (pLed1->bLedBlinkInProgress == _FALSE) { ++ pLed1->bLedBlinkInProgress = _TRUE; ++ ++ pLed1->CurrLedState = LED_BLINK_RUNTOP; ++ pLed1->BlinkTimes = 2; ++ ++ if (pLed1->bLedOn) ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ ++ _set_timer(&(pLed1->BlinkTimer), LED_RunTop_BLINK_INTERVAL); ++ } ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed0->CurrLedState = RTW_LED_OFF; ++ pLed1->CurrLedState = RTW_LED_OFF; ++ if (pLed0->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedBlinkInProgress = _FALSE; ++ } ++ if (pLed1->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed0); ++ SwLedOff(Adapter, pLed1); ++ break; ++ ++ default: ++ break; ++ } ++ ++} ++ ++ ++VOID ++SwLedControlMode4( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ PLED_PCIE pLed0 = &(ledpriv->SwLed0); ++ PLED_PCIE pLed1 = &(ledpriv->SwLed1); ++ ++ /* Decide led state */ ++ switch (LedAction) { ++ case LED_CTL_POWER_ON: ++ pLed1->CurrLedState = RTW_LED_ON; ++ SwLedOn(Adapter, pLed1); ++ pLed0->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed0); ++ break; ++ ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if (pLed0->bLedBlinkInProgress == _FALSE) { ++ pLed0->bLedBlinkInProgress = _TRUE; ++ ++ pLed0->CurrLedState = LED_BLINK_RUNTOP; ++ pLed0->BlinkTimes = 2; ++ ++ if (pLed0->bLedOn) ++ pLed0->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed0->BlinkingLedState = RTW_LED_ON; ++ ++ _set_timer(&(pLed0->BlinkTimer), LED_RunTop_BLINK_INTERVAL); ++ } ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed0->CurrLedState = RTW_LED_OFF; ++ pLed1->CurrLedState = RTW_LED_OFF; ++ if (pLed0->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedBlinkInProgress = _FALSE; ++ } ++ if (pLed1->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed0); ++ SwLedOff(Adapter, pLed1); ++ break; ++ ++ default: ++ break; ++ } ++ ++} ++ ++/* added by vivi, for led new mode */ ++VOID ++SwLedControlMode5( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ PLED_PCIE pLed0 = &(ledpriv->SwLed0); ++ PLED_PCIE pLed1 = &(ledpriv->SwLed1); ++ /* Decide led state */ ++ switch (LedAction) { ++ case LED_CTL_POWER_ON: ++ case LED_CTL_START_TO_LINK: ++ case LED_CTL_NO_LINK: ++ pLed1->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed1); ++ ++ ++ if (pLed0->bLedSlowBlinkInProgress == _FALSE) { ++ pLed0->bLedSlowBlinkInProgress = _TRUE; ++ pLed0->CurrLedState = LED_BLINK_SLOWLY; ++ if (pLed0->bLedOn) ++ pLed0->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed0->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed0->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_NETTRONIX); ++ } ++ ++ break; ++ ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ pLed1->CurrLedState = RTW_LED_ON; ++ SwLedOn(Adapter, pLed1); ++ ++ if (pLed0->bLedBlinkInProgress == _FALSE) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedSlowBlinkInProgress = _FALSE; ++ pLed0->bLedBlinkInProgress = _TRUE; ++ pLed0->CurrLedState = LED_BLINK_NORMAL; ++ pLed0->BlinkTimes = 2; ++ ++ if (pLed0->bLedOn) ++ pLed0->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed0->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed0->BlinkTimer), LED_BLINK_NORMAL_INTERVAL_NETTRONIX); ++ } ++ break; ++ ++ case LED_CTL_LINK: ++ pLed1->CurrLedState = RTW_LED_ON; ++ SwLedOn(Adapter, pLed1); ++ ++ if (pLed0->bLedSlowBlinkInProgress == _FALSE) { ++ pLed0->bLedSlowBlinkInProgress = _TRUE; ++ pLed0->CurrLedState = LED_BLINK_SLOWLY; ++ if (pLed0->bLedOn) ++ pLed0->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed0->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed0->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_NETTRONIX); ++ } ++ break; ++ ++ ++ case LED_CTL_POWER_OFF: ++ pLed0->CurrLedState = RTW_LED_OFF; ++ pLed1->CurrLedState = RTW_LED_OFF; ++ if (pLed0->bLedSlowBlinkInProgress == _TRUE) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedSlowBlinkInProgress = _FALSE; ++ } ++ if (pLed0->bLedBlinkInProgress == _TRUE) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed0); ++ SwLedOff(Adapter, pLed1); ++ break; ++ ++ default: ++ break; ++ } ++ ++ ++} ++ ++/* added by vivi, for led new mode */ ++VOID ++SwLedControlMode6( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ PLED_PCIE pLed0 = &(ledpriv->SwLed0); ++ PLED_PCIE pLed1 = &(ledpriv->SwLed1); ++ ++ ++ switch (LedAction) { ++ case LED_CTL_POWER_ON: ++ case LED_CTL_START_TO_LINK: ++ case LED_CTL_NO_LINK: ++ case LED_CTL_LINK: ++ case LED_CTL_SITE_SURVEY: ++ pLed1->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed1); ++ ++ if (pLed0->bLedSlowBlinkInProgress == _FALSE) { ++ pLed0->bLedSlowBlinkInProgress = _TRUE; ++ pLed0->CurrLedState = LED_BLINK_SLOWLY; ++ if (pLed0->bLedOn) ++ pLed0->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed0->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed0->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_PORNET); ++ } ++ break; ++ ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ pLed1->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed1); ++ if (pLed0->bLedBlinkInProgress == _FALSE) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedSlowBlinkInProgress = _FALSE; ++ pLed0->bLedBlinkInProgress = _TRUE; ++ pLed0->CurrLedState = LED_BLINK_NORMAL; ++ pLed0->BlinkTimes = 2; ++ if (pLed0->bLedOn) ++ pLed0->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed0->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed0->BlinkTimer), LED_BLINK_NORMAL_INTERVAL_PORNET); ++ } ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed1->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed1); ++ ++ pLed0->CurrLedState = RTW_LED_OFF; ++ if (pLed0->bLedSlowBlinkInProgress == _TRUE) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedSlowBlinkInProgress = _FALSE; ++ } ++ if (pLed0->bLedBlinkInProgress == _TRUE) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed0); ++ break; ++ ++ default: ++ break; ++ ++ } ++} ++ ++ ++/* added by chiyokolin, for Lenovo */ ++VOID ++SwLedControlMode7( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ PLED_PCIE pLed0 = &(ledpriv->SwLed0); ++ ++ switch (LedAction) { ++ case LED_CTL_POWER_ON: ++ case LED_CTL_LINK: ++ case LED_CTL_NO_LINK: ++ SwLedOn(Adapter, pLed0); ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ SwLedOff(Adapter, pLed0); ++ break; ++ ++ default: ++ break; ++ } ++} ++ ++/* added by chiyokolin, for QMI */ ++VOID ++SwLedControlMode8( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ PLED_PCIE pLed = &(ledpriv->SwLed0); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ ++ /* Decide led state */ ++ switch (LedAction) { ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if (pLed->bLedBlinkInProgress == _FALSE && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { ++ pLed->bLedBlinkInProgress = _TRUE; ++ ++ pLed->CurrLedState = LED_BLINK_NORMAL; ++ pLed->BlinkTimes = 2; ++ ++ if (pLed->bLedOn) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ break; ++ ++ case LED_CTL_SITE_SURVEY: ++ case LED_CTL_POWER_ON: ++ case LED_CTL_NO_LINK: ++ case LED_CTL_LINK: ++ pLed->CurrLedState = RTW_LED_ON; ++ if (pLed->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOn(Adapter, pLed); ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed->CurrLedState = RTW_LED_OFF; ++ if (pLed->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ default: ++ break; ++ } ++} ++ ++/* added by chiyokolin, for MSI */ ++VOID ++SwLedControlMode9( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ PLED_PCIE pLed = &(ledpriv->SwLed0); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ ++ /* Decide led state */ ++ switch (LedAction) { ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if (pLed->bLedBlinkInProgress == _FALSE && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { ++ pLed->bLedBlinkInProgress = _TRUE; ++ ++ pLed->CurrLedState = LED_BLINK_NORMAL; ++ pLed->BlinkTimes = 2; ++ ++ if (pLed->bLedOn) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FAST_INTERVAL_BITLAND); ++ } ++ break; ++ ++ case LED_CTL_SITE_SURVEY: ++ if (pLed->bLedBlinkInProgress == _FALSE) { ++ pLed->bLedBlinkInProgress = _TRUE; ++ pLed->CurrLedState = LED_BLINK_SCAN; ++ pLed->BlinkTimes = 2; ++ ++ if (pLed->bLedOn) { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); ++ } else { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); ++ } ++ } else if (pLed->CurrLedState != LED_BLINK_SCAN) { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->CurrLedState = LED_BLINK_SCAN; ++ pLed->BlinkTimes = 2; ++ ++ if (pLed->bLedOn) { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); ++ } else { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); ++ } ++ } ++ break; ++ ++ case LED_CTL_POWER_ON: ++ case LED_CTL_NO_LINK: ++ if (pLed->bLedBlinkInProgress == _FALSE) { ++ pLed->bLedBlinkInProgress = _TRUE; ++ ++ pLed->CurrLedState = LED_BLINK_NO_LINK; ++ pLed->BlinkTimes = 24; ++ ++ if (pLed->bLedOn) { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); ++ } else { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); ++ } ++ } else if (pLed->CurrLedState != LED_BLINK_SCAN && pLed->CurrLedState != LED_BLINK_NO_LINK) { ++ pLed->CurrLedState = LED_BLINK_NO_LINK; ++ pLed->BlinkTimes = 24; ++ ++ if (pLed->bLedOn) { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); ++ } else { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); ++ } ++ } ++ break; ++ ++ case LED_CTL_LINK: ++ pLed->CurrLedState = RTW_LED_ON; ++ if (pLed->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOn(Adapter, pLed); ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed->CurrLedState = RTW_LED_OFF; ++ if (pLed->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ default: ++ break; ++ } ++ ++ ++} ++ ++ ++/* added by chiyokolin, for Edimax-ASUS */ ++VOID ++SwLedControlMode10( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ PLED_PCIE pLed0 = &(ledpriv->SwLed0); ++ PLED_PCIE pLed1 = &(ledpriv->SwLed1); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ ++ /* Decide led state */ ++ switch (LedAction) { ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if (pLed1->bLedBlinkInProgress == _FALSE && pLed1->bLedWPSBlinkInProgress == _FALSE && ++ (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { ++ pLed1->bLedBlinkInProgress = _TRUE; ++ ++ pLed1->CurrLedState = LED_BLINK_NORMAL; ++ pLed1->BlinkTimes = 2; ++ ++ if (pLed1->bLedOn) ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ break; ++ ++ case LED_CTL_SITE_SURVEY: ++ if (pLed1->bLedBlinkInProgress == _FALSE && pLed1->bLedWPSBlinkInProgress == _FALSE) { ++ pLed1->bLedBlinkInProgress = _TRUE; ++ pLed1->CurrLedState = LED_BLINK_SCAN; ++ pLed1->BlinkTimes = 12; ++ ++ if (pLed1->bLedOn) { ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } else { ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ } else if (pLed1->CurrLedState != LED_BLINK_SCAN && pLed1->bLedWPSBlinkInProgress == _FALSE) { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->CurrLedState = LED_BLINK_SCAN; ++ pLed1->BlinkTimes = 24; ++ ++ if (pLed1->bLedOn) { ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } else { ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ } ++ break; ++ ++ case LED_CTL_START_WPS: ++ case LED_CTL_START_WPS_BOTTON: ++ pLed1->CurrLedState = RTW_LED_ON; ++ if (pLed1->bLedBlinkInProgress == _TRUE) { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->bLedBlinkInProgress = _FALSE; ++ } ++ ++ if (pLed1->bLedWPSBlinkInProgress == _FALSE) { ++ pLed1->bLedWPSBlinkInProgress = _TRUE; ++ SwLedOn(Adapter, pLed1); ++ } ++ break; ++ ++ case LED_CTL_STOP_WPS: ++ case LED_CTL_STOP_WPS_FAIL: ++ case LED_CTL_STOP_WPS_FAIL_OVERLAP: ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ pLed0->CurrLedState = RTW_LED_ON; ++ if (pLed0->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOn(Adapter, pLed0); ++ } else { ++ pLed0->CurrLedState = RTW_LED_OFF; ++ if (pLed0->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed0); ++ } ++ ++ pLed1->CurrLedState = RTW_LED_OFF; ++ if (pLed1->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed1); ++ ++ pLed1->bLedWPSBlinkInProgress = _FALSE; ++ ++ break; ++ ++ case LED_CTL_LINK: ++ pLed0->CurrLedState = RTW_LED_ON; ++ if (pLed0->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOn(Adapter, pLed0); ++ break; ++ ++ case LED_CTL_NO_LINK: ++ if (pLed1->bLedWPSBlinkInProgress == _TRUE) { ++ SwLedOn(Adapter, pLed1); ++ break; ++ } ++ ++ if (pLed1->CurrLedState == LED_BLINK_SCAN) ++ break; ++ ++ pLed0->CurrLedState = RTW_LED_OFF; ++ if (pLed0->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed0); ++ ++ pLed1->CurrLedState = RTW_LED_OFF; ++ if (pLed1->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed1); ++ ++ break; ++ ++ ++ case LED_CTL_POWER_ON: ++ case LED_CTL_POWER_OFF: ++ if (pLed1->bLedWPSBlinkInProgress == _TRUE) { ++ SwLedOn(Adapter, pLed1); ++ break; ++ } ++ pLed0->CurrLedState = RTW_LED_OFF; ++ if (pLed0->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed0); ++ ++ pLed1->CurrLedState = RTW_LED_OFF; ++ if (pLed1->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed1); ++ ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++ ++} ++ ++ ++/* added by hpfan, for Xavi */ ++VOID ++SwLedControlMode11( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ PLED_PCIE pLed = &(ledpriv->SwLed0); ++ ++ /* Decide led state */ ++ switch (LedAction) { ++ case LED_CTL_START_WPS: ++ case LED_CTL_START_WPS_BOTTON: ++ pLed->bLedWPSBlinkInProgress = _TRUE; ++ if (pLed->bLedBlinkInProgress == _FALSE) { ++ pLed->bLedBlinkInProgress = _TRUE; ++ pLed->CurrLedState = LED_BLINK_XAVI; ++ ++ if (pLed->bLedOn) { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_CM11_BLINK_INTERVAL); ++ } else { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_CM11_BLINK_INTERVAL); ++ } ++ } ++ break; ++ ++ case LED_CTL_STOP_WPS: ++ case LED_CTL_STOP_WPS_FAIL: ++ case LED_CTL_STOP_WPS_FAIL_OVERLAP: ++ pLed->bLedWPSBlinkInProgress = _FALSE; ++ if (pLed->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = _FALSE; ++ pLed->CurrLedState = RTW_LED_OFF; ++ } ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ case LED_CTL_LINK: ++ if (pLed->bLedWPSBlinkInProgress) ++ break; ++ ++ if (pLed->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = _FALSE; ++ pLed->CurrLedState = RTW_LED_ON; ++ ++ if (!pLed->bLedOn) ++ SwLedOn(Adapter, pLed); ++ } else { ++ pLed->CurrLedState = RTW_LED_ON; ++ SwLedOn(Adapter, pLed); ++ } ++ ++ _set_timer(&(pLed->BlinkTimer), LED_CM11_LINK_ON_INTERVEL); ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ break; ++ ++ case LED_CTL_NO_LINK: ++ if (pLed->bLedWPSBlinkInProgress) ++ break; ++ ++ if (pLed->bLedBlinkInProgress == _TRUE) { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = _FALSE; ++ } ++ pLed->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ case LED_CTL_POWER_ON: ++ case LED_CTL_POWER_OFF: ++ if (pLed->bLedBlinkInProgress == _TRUE) { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = _FALSE; ++ } ++ ++ pLed->CurrLedState = RTW_LED_OFF; ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++ ++} ++ ++/* added by chiyokolin, for Azurewave */ ++VOID ++SwLedControlMode12( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ PLED_PCIE pLed = &(ledpriv->SwLed0); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ LED_STATE LedState = LED_UNKNOWN; ++ ++ ++ /* Decide led state */ ++ switch (LedAction) { ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ if (pLed->CurrLedState == LED_BLINK_SCAN) ++ break; ++ ++ pLed->BlinkTimes = 0; ++ ++ if (pLed->bLedOn) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ /*if(pTurboCa->TotalThroughput <= 5) ++ LedState = LED_BLINK_Azurewave_5Mbps; ++ else if(pTurboCa->TotalThroughput <= 10) ++ LedState = LED_BLINK_Azurewave_10Mbps; ++ else if(pTurboCa->TotalThroughput <=20) ++ LedState = LED_BLINK_Azurewave_20Mbps; ++ else if(pTurboCa->TotalThroughput <=40) ++ LedState = LED_BLINK_Azurewave_40Mbps; ++ else if(pTurboCa->TotalThroughput <=80) ++ LedState = LED_BLINK_Azurewave_80Mbps; ++ else*/ ++ LedState = LED_BLINK_Azurewave_MAXMbps; ++ ++ if (pLed->bLedBlinkInProgress == _FALSE || pLed->CurrLedState != LedState) { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->CurrLedState = LedState; ++ pLed->bLedBlinkInProgress = _TRUE; ++ ++ switch (LedState) { ++ case LED_BLINK_Azurewave_5Mbps: ++ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_5Mbps); ++ break; ++ ++ case LED_BLINK_Azurewave_10Mbps: ++ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_10Mbps); ++ break; ++ ++ case LED_BLINK_Azurewave_20Mbps: ++ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_20Mbps); ++ break; ++ ++ case LED_BLINK_Azurewave_40Mbps: ++ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_40Mbps); ++ break; ++ ++ case LED_BLINK_Azurewave_80Mbps: ++ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_80Mbps); ++ break; ++ ++ case LED_BLINK_Azurewave_MAXMbps: ++ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_MAXMbps); ++ break; ++ ++ default: ++ break; ++ } ++ } ++ } ++ ++ break; ++ ++ case LED_CTL_SITE_SURVEY: ++ case LED_CTL_START_WPS: ++ case LED_CTL_START_WPS_BOTTON: ++ if (pLed->bLedBlinkInProgress == _FALSE) ++ pLed->bLedBlinkInProgress = _TRUE; ++ else if (pLed->CurrLedState != LED_BLINK_SCAN) ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ ++ pLed->CurrLedState = LED_BLINK_SCAN; ++ pLed->BlinkTimes = 2; ++ ++ if (pLed->bLedOn) { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); ++ } else { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); ++ } ++ break; ++ ++ case LED_CTL_LINK: ++ pLed->CurrLedState = RTW_LED_ON; ++ if (pLed->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOn(Adapter, pLed); ++ break; ++ ++ case LED_CTL_NO_LINK: ++ case LED_CTL_POWER_ON: ++ if (pLed->CurrLedState == LED_BLINK_SCAN) ++ break; ++ ++ pLed->CurrLedState = LED_BLINK_NO_LINK; ++ pLed->bLedBlinkInProgress = _TRUE; ++ ++ if (pLed->bLedOn) { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); ++ } else { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); ++ } ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed->CurrLedState = RTW_LED_OFF; ++ if (pLed->bLedBlinkInProgress) { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = _FALSE; ++ } ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++ ++} ++ ++void ++LedControlPCIE( ++ _adapter *padapter, ++ LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ ++#if (MP_DRIVER == 1) ++ if (padapter->registrypriv.mp_mode == 1) ++ return; ++#endif ++ ++ if (RTW_CANNOT_RUN(padapter) || (!rtw_is_hw_init_completed(padapter))) ++ return; ++ ++ /* if(priv->bInHctTest) */ ++ /* return; */ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ /* Only do led action for PRIMARY_ADAPTER */ ++ if (padapter->adapter_type != PRIMARY_ADAPTER) ++ return; ++#endif ++ ++ if ((adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) && ++ (LedAction == LED_CTL_TX || ++ LedAction == LED_CTL_RX || ++ LedAction == LED_CTL_SITE_SURVEY || ++ LedAction == LED_CTL_LINK || ++ LedAction == LED_CTL_NO_LINK || ++ LedAction == LED_CTL_START_TO_LINK || ++ LedAction == LED_CTL_POWER_ON)) { ++ return; ++ } ++ ++ switch (ledpriv->LedStrategy) { ++ case SW_LED_MODE0: ++ /* SwLedControlMode0(padapter, LedAction); */ ++ break; ++ ++ case SW_LED_MODE1: ++ /* SwLedControlMode1(padapter, LedAction); */ ++ break; ++ ++ case SW_LED_MODE2: ++ /* SwLedControlMode2(padapter, LedAction); */ ++ break; ++ ++ case SW_LED_MODE3: ++ /* SwLedControlMode3(padapter, LedAction); */ ++ break; ++ ++ case SW_LED_MODE4: ++ /* SwLedControlMode4(padapter, LedAction); */ ++ break; ++ ++ case SW_LED_MODE5: ++ /* SwLedControlMode5(padapter, LedAction); */ ++ break; ++ ++ case SW_LED_MODE6: ++ /* SwLedControlMode6(padapter, LedAction); */ ++ break; ++ ++ case SW_LED_MODE7: ++ SwLedControlMode7(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE8: ++ SwLedControlMode8(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE9: ++ SwLedControlMode9(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE10: ++ SwLedControlMode10(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE11: ++ SwLedControlMode11(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE12: ++ SwLedControlMode12(padapter, LedAction); ++ break; ++ ++ default: ++ break; ++ } ++} ++ ++/*----------------------------------------------------------------------------- ++ * Function: gen_RefreshLedState() ++ * ++ * Overview: When we call the function, media status is no link. It must be in SW/HW ++ * radio off. Or IPS state. If IPS no link we will turn on LED, otherwise, we must turn off. ++ * After MAC IO reset, we must write LED control 0x2f2 again. ++ * ++ * Input: IN PADAPTER Adapter) ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 03/27/2009 MHC Create for LED judge only~!! ++ * ++ *---------------------------------------------------------------------------*/ ++VOID ++gen_RefreshLedState( ++ IN PADAPTER Adapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(Adapter); ++ struct led_priv *pledpriv = &(Adapter->ledpriv); ++ PLED_PCIE pLed0 = &(Adapter->ledpriv.SwLed0); ++ ++ RTW_INFO("gen_RefreshLedState:() pwrctrlpriv->rfoff_reason=%x\n", pwrctrlpriv->rfoff_reason); ++ ++ if (Adapter->bDriverIsGoingToUnload) { ++ switch (pledpriv->LedStrategy) { ++ case SW_LED_MODE9: ++ case SW_LED_MODE10: ++ rtw_led_control(Adapter, LED_CTL_POWER_OFF); ++ break; ++ ++ default: ++ /* Turn off LED if RF is not ON. */ ++ SwLedOff(Adapter, pLed0); ++ break; ++ } ++ } else if (pwrctrlpriv->rfoff_reason == RF_CHANGE_BY_IPS) { ++ switch (pledpriv->LedStrategy) { ++ case SW_LED_MODE7: ++ SwLedOn(Adapter, pLed0); ++ break; ++ ++ case SW_LED_MODE8: ++ case SW_LED_MODE9: ++ rtw_led_control(Adapter, LED_CTL_NO_LINK); ++ break; ++ ++ default: ++ SwLedOn(Adapter, pLed0); ++ break; ++ } ++ } else if (pwrctrlpriv->rfoff_reason == RF_CHANGE_BY_INIT) { ++ switch (pledpriv->LedStrategy) { ++ case SW_LED_MODE7: ++ SwLedOn(Adapter, pLed0); ++ break; ++ ++ case SW_LED_MODE9: ++ rtw_led_control(Adapter, LED_CTL_NO_LINK); ++ break; ++ ++ default: ++ SwLedOn(Adapter, pLed0); ++ break; ++ ++ } ++ } else { /* SW/HW radio off */ ++ ++ switch (pledpriv->LedStrategy) { ++ case SW_LED_MODE9: ++ rtw_led_control(Adapter, LED_CTL_POWER_OFF); ++ break; ++ ++ default: ++ /* Turn off LED if RF is not ON. */ ++ SwLedOff(Adapter, pLed0); ++ break; ++ } ++ } ++ ++} ++ ++/* ++ * Description: ++ * Reset status of LED_871x object. ++ * */ ++void ResetLedStatus(PLED_PCIE pLed) ++{ ++ ++ pLed->CurrLedState = RTW_LED_OFF; /* Current LED state. */ ++ pLed->bLedOn = _FALSE; /* true if LED is ON, false if LED is OFF. */ ++ ++ pLed->bLedBlinkInProgress = _FALSE; /* true if it is blinking, false o.w.. */ ++ pLed->bLedWPSBlinkInProgress = _FALSE; ++ pLed->bLedSlowBlinkInProgress = _FALSE; ++ ++ pLed->BlinkTimes = 0; /* Number of times to toggle led state for blinking. */ ++ pLed->BlinkingLedState = LED_UNKNOWN; /* Next state for blinking, either RTW_LED_ON or RTW_LED_OFF are. */ ++} ++ ++/* ++* Description: ++* Initialize an LED_871x object. ++* */ ++void ++InitLed( ++ _adapter *padapter, ++ PLED_PCIE pLed, ++ LED_PIN LedPin ++) ++{ ++ pLed->padapter = padapter; ++ pLed->LedPin = LedPin; ++ ++ ResetLedStatus(pLed); ++ ++ _init_timer(&(pLed->BlinkTimer), padapter->pnetdev, BlinkTimerCallback, pLed); ++} ++ ++ ++/* ++ * Description: ++ * DeInitialize an LED_871x object. ++ * */ ++void ++DeInitLed( ++ PLED_PCIE pLed ++) ++{ ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ ResetLedStatus(pLed); ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halhwimg.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halhwimg.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halhwimg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halhwimg.h 2018-02-11 21:44:27.153146177 +0200 +@@ -0,0 +1,123 @@ ++#pragma once ++#ifndef __INC_HW_IMG_H ++#define __INC_HW_IMG_H ++ ++// ++// 2011/03/15 MH Add for different IC HW image file selection. code size consideration. ++// ++#if RT_PLATFORM == PLATFORM_LINUX ++ ++ #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++ // For 92C ++ #define RTL8192CE_HWIMG_SUPPORT 1 ++ #define RTL8192CE_TEST_HWIMG_SUPPORT 0 ++ #define RTL8192CU_HWIMG_SUPPORT 0 ++ #define RTL8192CU_TEST_HWIMG_SUPPORT 0 ++ ++ // For 92D ++ #define RTL8192DE_HWIMG_SUPPORT 1 ++ #define RTL8192DE_TEST_HWIMG_SUPPORT 0 ++ #define RTL8192DU_HWIMG_SUPPORT 0 ++ #define RTL8192DU_TEST_HWIMG_SUPPORT 0 ++ ++ // For 8723 ++ #define RTL8723E_HWIMG_SUPPORT 1 ++ #define RTL8723U_HWIMG_SUPPORT 0 ++ #define RTL8723S_HWIMG_SUPPORT 0 ++ ++ //For 88E ++ #define RTL8188EE_HWIMG_SUPPORT 0 ++ #define RTL8188EU_HWIMG_SUPPORT 0 ++ #define RTL8188ES_HWIMG_SUPPORT 0 ++ ++ #elif (DEV_BUS_TYPE == RT_USB_INTERFACE) ++ // For 92C ++ #define RTL8192CE_HWIMG_SUPPORT 0 ++ #define RTL8192CE_TEST_HWIMG_SUPPORT 0 ++ #define RTL8192CU_HWIMG_SUPPORT 1 ++ #define RTL8192CU_TEST_HWIMG_SUPPORT 0 ++ ++ //For 92D ++ #define RTL8192DE_HWIMG_SUPPORT 0 ++ #define RTL8192DE_TEST_HWIMG_SUPPORT 0 ++ #define RTL8192DU_HWIMG_SUPPORT 1 ++ #define RTL8192DU_TEST_HWIMG_SUPPORT 0 ++ ++ // For 8723 ++ #define RTL8723E_HWIMG_SUPPORT 0 ++ #define RTL8723U_HWIMG_SUPPORT 1 ++ #define RTL8723S_HWIMG_SUPPORT 0 ++ ++ //For 88E ++ #define RTL8188EE_HWIMG_SUPPORT 0 ++ #define RTL8188EU_HWIMG_SUPPORT 0 ++ #define RTL8188ES_HWIMG_SUPPORT 0 ++ ++ #elif (DEV_BUS_TYPE == RT_SDIO_INTERFACE) ++ // For 92C ++ #define RTL8192CE_HWIMG_SUPPORT 0 ++ #define RTL8192CE_TEST_HWIMG_SUPPORT 0 ++ #define RTL8192CU_HWIMG_SUPPORT 1 ++ #define RTL8192CU_TEST_HWIMG_SUPPORT 0 ++ ++ //For 92D ++ #define RTL8192DE_HWIMG_SUPPORT 0 ++ #define RTL8192DE_TEST_HWIMG_SUPPORT 0 ++ #define RTL8192DU_HWIMG_SUPPORT 1 ++ #define RTL8192DU_TEST_HWIMG_SUPPORT 0 ++ ++ // For 8723 ++ #define RTL8723E_HWIMG_SUPPORT 0 ++ #define RTL8723U_HWIMG_SUPPORT 0 ++ #define RTL8723S_HWIMG_SUPPORT 1 ++ ++ //For 88E ++ #define RTL8188EE_HWIMG_SUPPORT 0 ++ #define RTL8188EU_HWIMG_SUPPORT 0 ++ #define RTL8188ES_HWIMG_SUPPORT 0 ++ #endif ++ ++#else // PLATFORM_WINDOWS & MacOSX ++ ++//For 92C ++#define RTL8192CE_HWIMG_SUPPORT 1 ++#define RTL8192CE_TEST_HWIMG_SUPPORT 1 ++#define RTL8192CU_HWIMG_SUPPORT 1 ++#define RTL8192CU_TEST_HWIMG_SUPPORT 1 ++ ++// For 92D ++#define RTL8192DE_HWIMG_SUPPORT 1 ++#define RTL8192DE_TEST_HWIMG_SUPPORT 1 ++#define RTL8192DU_HWIMG_SUPPORT 1 ++#define RTL8192DU_TEST_HWIMG_SUPPORT 1 ++ ++ #if defined(UNDER_CE) ++ // For 8723 ++ #define RTL8723E_HWIMG_SUPPORT 0 ++ #define RTL8723U_HWIMG_SUPPORT 0 ++ #define RTL8723S_HWIMG_SUPPORT 1 ++ ++ // For 88E ++ #define RTL8188EE_HWIMG_SUPPORT 0 ++ #define RTL8188EU_HWIMG_SUPPORT 0 ++ #define RTL8188ES_HWIMG_SUPPORT 0 ++ ++ #else ++ ++ // For 8723 ++ #define RTL8723E_HWIMG_SUPPORT 1 ++ //#define RTL_8723E_TEST_HWIMG_SUPPORT 1 ++ #define RTL8723U_HWIMG_SUPPORT 1 ++ //#define RTL_8723U_TEST_HWIMG_SUPPORT 1 ++ #define RTL8723S_HWIMG_SUPPORT 1 ++ //#define RTL_8723S_TEST_HWIMG_SUPPORT 1 ++ ++ //For 88E ++ #define RTL8188EE_HWIMG_SUPPORT 1 ++ #define RTL8188EU_HWIMG_SUPPORT 1 ++ #define RTL8188ES_HWIMG_SUPPORT 1 ++ #endif ++ ++#endif ++ ++#endif //__INC_HW_IMG_H +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.c 2018-02-11 21:44:27.153146177 +0200 +@@ -0,0 +1,2790 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ #include "mp_precomp.h" ++ #include "phydm_precomp.h" ++ ++#ifndef index_mapping_NUM_88E ++ #define index_mapping_NUM_88E 15 ++#endif ++ ++//#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ ++#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ ++ do {\ ++ for(_offset = 0; _offset < _size; _offset++)\ ++ {\ ++ if(_deltaThermal < thermalThreshold[_direction][_offset])\ ++ {\ ++ if(_offset != 0)\ ++ _offset--;\ ++ break;\ ++ }\ ++ } \ ++ if(_offset >= _size)\ ++ _offset = _size-1;\ ++ } while(0) ++ ++ ++void ConfigureTxpowerTrack( ++ IN PVOID pDM_VOID, ++ OUT PTXPWRTRACK_CFG pConfig ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if RTL8812A_SUPPORT ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ //if (IS_HARDWARE_TYPE_8812(pDM_Odm->Adapter)) ++ if(pDM_Odm->SupportICType==ODM_RTL8812) ++ ConfigureTxpowerTrack_8812A(pConfig); ++ //else ++#endif ++#endif ++ ++#if RTL8814A_SUPPORT ++ if(pDM_Odm->SupportICType== ODM_RTL8814A) ++ ConfigureTxpowerTrack_8814A(pConfig); ++#endif ++ ++ ++#if RTL8188E_SUPPORT ++ if(pDM_Odm->SupportICType==ODM_RTL8188E) ++ ConfigureTxpowerTrack_8188E(pConfig); ++#endif ++ ++#if RTL8197F_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8197F) ++ ConfigureTxpowerTrack_8197F(pConfig); ++#endif ++ ++#if RTL8822B_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) ++ ConfigureTxpowerTrack_8822B(pConfig); ++#endif ++ ++ ++} ++ ++#if (RTL8192E_SUPPORT==1) ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter_92E( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PVOID pDM_VOID ++#else ++ IN PADAPTER Adapter ++#endif ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte ThermalValue = 0, delta, delta_IQK, delta_LCK, channel, is_decrease, rf_mimo_mode; ++ u1Byte ThermalValue_AVG_count = 0; ++ u1Byte OFDM_min_index = 10; //OFDM BB Swing should be less than +2.5dB, which is required by Arthur ++ s1Byte OFDM_index[2], index ; ++ u4Byte ThermalValue_AVG = 0, Reg0x18; ++ u4Byte i = 0, j = 0, rf; ++ s4Byte value32, CCK_index = 0, ele_A, ele_D, ele_C, X, Y; ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ ++ rf_mimo_mode = pDM_Odm->RFType; ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("%s:%d rf_mimo_mode:%d\n", __FUNCTION__, __LINE__, rf_mimo_mode)); ++ ++#ifdef MP_TEST ++ if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { ++ channel = priv->pshare->working_channel; ++ if (priv->pshare->mp_txpwr_tracking == FALSE) ++ return; ++ } else ++#endif ++ { ++ channel = (priv->pmib->dot11RFEntry.dot11channel); ++ } ++ ++ ThermalValue = (unsigned char)ODM_GetRFReg(pDM_Odm, RF_PATH_A, ODM_RF_T_METER_92E, 0xfc00); //0x42: RF Reg[15:10] 88E ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); ++ ++ ++ switch (rf_mimo_mode) { ++ case MIMO_1T1R: ++ rf = 1; ++ break; ++ case MIMO_2T2R: ++ rf = 2; ++ break; ++ default: ++ rf = 2; ++ break; ++ } ++ ++ //Query OFDM path A default setting Bit[31:21] ++ ele_D = PHY_QueryBBReg(priv, rOFDM0_XATxIQImbalance, bMaskOFDM_D); ++ for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) { ++ if (ele_D == (OFDMSwingTable_92E[i] >> 22)) { ++ OFDM_index[0] = (unsigned char)i; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("PathA 0xC80[31:22] = 0x%x, OFDM_index=%d\n", ele_D, OFDM_index[0])); ++ break; ++ } ++ } ++ ++ //Query OFDM path B default setting ++ if (rf_mimo_mode == MIMO_2T2R) { ++ ele_D = PHY_QueryBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskOFDM_D); ++ for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) { ++ if (ele_D == (OFDMSwingTable_92E[i] >> 22)) { ++ OFDM_index[1] = (unsigned char)i; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("PathB 0xC88[31:22] = 0x%x, OFDM_index=%d\n", ele_D, OFDM_index[1])); ++ break; ++ } ++ } ++ } ++ ++ /* calculate average thermal meter */ ++ { ++ priv->pshare->ThermalValue_AVG_88XX[priv->pshare->ThermalValue_AVG_index_88XX] = ThermalValue; ++ priv->pshare->ThermalValue_AVG_index_88XX++; ++ if (priv->pshare->ThermalValue_AVG_index_88XX == AVG_THERMAL_NUM_88XX) ++ priv->pshare->ThermalValue_AVG_index_88XX = 0; ++ ++ for (i = 0; i < AVG_THERMAL_NUM_88XX; i++) { ++ if (priv->pshare->ThermalValue_AVG_88XX[i]) { ++ ThermalValue_AVG += priv->pshare->ThermalValue_AVG_88XX[i]; ++ ThermalValue_AVG_count++; ++ } ++ } ++ ++ if (ThermalValue_AVG_count) { ++ ThermalValue = (unsigned char)(ThermalValue_AVG / ThermalValue_AVG_count); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("AVG Thermal Meter = 0x%x \n", ThermalValue)); ++ } ++ } ++ ++ /* Initialize */ ++ if (!priv->pshare->ThermalValue) { ++ priv->pshare->ThermalValue = priv->pmib->dot11RFEntry.ther; ++ priv->pshare->ThermalValue_IQK = ThermalValue; ++ priv->pshare->ThermalValue_LCK = ThermalValue; ++ } ++ ++ if (ThermalValue != priv->pshare->ThermalValue) { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** START POWER TRACKING ********\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); ++ ++ delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); ++ delta_IQK = RTL_ABS(ThermalValue, priv->pshare->ThermalValue_IQK); ++ delta_LCK = RTL_ABS(ThermalValue, priv->pshare->ThermalValue_LCK); ++ is_decrease = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 1 : 0); ++ ++#ifdef _TRACKING_TABLE_FILE ++ if (priv->pshare->rf_ft_var.pwr_track_file) { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Diff: (%s)%d ==> get index from table : %d)\n", (is_decrease?"-":"+"), delta, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); ++ ++ if (is_decrease) { ++ for (i = 0; i < rf; i++) { ++ OFDM_index[i] = priv->pshare->OFDM_index0[i] + get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0); ++ OFDM_index[i] = ((OFDM_index[i] > (OFDM_TABLE_SIZE_92E- 1)) ? (OFDM_TABLE_SIZE_92E - 1) : OFDM_index[i]); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> decrese power ---> new OFDM_INDEX:%d (%d + %d)\n", OFDM_index[i], priv->pshare->OFDM_index0[i], get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); ++ CCK_index = priv->pshare->CCK_index0 + get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1); ++ CCK_index = ((CCK_index > (CCK_TABLE_SIZE_92E - 1)) ? (CCK_TABLE_SIZE_92E - 1) : CCK_index); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> Decrese power ---> new CCK_INDEX:%d (%d + %d)\n", CCK_index, priv->pshare->CCK_index0, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1))); ++ } ++ } else { ++ for (i = 0; i < rf; i++) { ++ OFDM_index[i] = priv->pshare->OFDM_index0[i] - get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0); ++ OFDM_index[i] = ((OFDM_index[i] < OFDM_min_index) ? OFDM_min_index : OFDM_index[i]); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> Increse power ---> new OFDM_INDEX:%d (%d - %d)\n", OFDM_index[i], priv->pshare->OFDM_index0[i], get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); ++ CCK_index = priv->pshare->CCK_index0 - get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1); ++ CCK_index = ((CCK_index < 0 )? 0 : CCK_index); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> Increse power ---> new CCK_INDEX:%d (%d - %d)\n", CCK_index, priv->pshare->CCK_index0, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1))); ++ } ++ } ++ } ++#endif //CFG_TRACKING_TABLE_FILE ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDMSwingTable_92E[(unsigned int)OFDM_index[0]] = %x \n",OFDMSwingTable_92E[(unsigned int)OFDM_index[0]])); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDMSwingTable_92E[(unsigned int)OFDM_index[1]] = %x \n",OFDMSwingTable_92E[(unsigned int)OFDM_index[1]])); ++ ++ //Adujst OFDM Ant_A according to IQK result ++ ele_D = (OFDMSwingTable_92E[(unsigned int)OFDM_index[0]] & 0xFFC00000) >> 22; ++ X = priv->pshare->RegE94; ++ Y = priv->pshare->RegE9C; ++ ++ if (X != 0) { ++ if ((X & 0x00000200) != 0) ++ X = X | 0xFFFFFC00; ++ ele_A = ((X * ele_D) >> 8) & 0x000003FF; ++ ++ //new element C = element D x Y ++ if ((Y & 0x00000200) != 0) ++ Y = Y | 0xFFFFFC00; ++ ele_C = ((Y * ele_D) >> 8) & 0x000003FF; ++ ++ //wirte new elements A, C, D to regC80 and regC94, element B is always 0 ++ value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; ++ PHY_SetBBReg(priv, rOFDM0_XATxIQImbalance, bMaskDWord, value32); ++ ++ value32 = (ele_C&0x000003C0)>>6; ++ PHY_SetBBReg(priv, rOFDM0_XCTxAFE, bMaskH4Bits, value32); ++ ++ value32 = ((X * ele_D)>>7)&0x01; ++ PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(24), value32); ++ } else { ++ PHY_SetBBReg(priv, rOFDM0_XATxIQImbalance, bMaskDWord, OFDMSwingTable_92E[(unsigned int)OFDM_index[0]]); ++ PHY_SetBBReg(priv, rOFDM0_XCTxAFE, bMaskH4Bits, 0x00); ++ PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(24), 0x00); ++ } ++ ++ set_CCK_swing_index(priv, CCK_index); ++ ++ if (rf == 2) { ++ ele_D = (OFDMSwingTable_92E[(unsigned int)OFDM_index[1]] & 0xFFC00000) >> 22; ++ X = priv->pshare->RegEB4; ++ Y = priv->pshare->RegEBC; ++ ++ if (X != 0) { ++ if ((X & 0x00000200) != 0) //consider minus ++ X = X | 0xFFFFFC00; ++ ele_A = ((X * ele_D) >> 8) & 0x000003FF; ++ ++ //new element C = element D x Y ++ if ((Y & 0x00000200) != 0) ++ Y = Y | 0xFFFFFC00; ++ ele_C = ((Y * ele_D) >> 8) & 0x00003FF; ++ ++ //wirte new elements A, C, D to regC88 and regC9C, element B is always 0 ++ value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; ++ PHY_SetBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskDWord, value32); ++ ++ value32 = (ele_C & 0x000003C0) >> 6; ++ PHY_SetBBReg(priv, rOFDM0_XDTxAFE, bMaskH4Bits, value32); ++ ++ value32 = ((X * ele_D) >> 7) & 0x01; ++ PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(28), value32); ++ } else { ++ PHY_SetBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskDWord, OFDMSwingTable_92E[(unsigned int)OFDM_index[1]]); ++ PHY_SetBBReg(priv, rOFDM0_XDTxAFE, bMaskH4Bits, 0x00); ++ PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(28), 0x00); ++ } ++ ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("0xc80 = 0x%x \n", PHY_QueryBBReg(priv, rOFDM0_XATxIQImbalance, bMaskDWord))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("0xc88 = 0x%x \n", PHY_QueryBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskDWord))); ++ ++ if (delta_IQK > 3) { ++ priv->pshare->ThermalValue_IQK = ThermalValue; ++#ifdef MP_TEST ++ if (!(priv->pshare->rf_ft_var.mp_specific && (OPMODE & (WIFI_MP_CTX_BACKGROUND | WIFI_MP_CTX_PACKET)))) ++#endif ++ PHY_IQCalibrate_8192E(pDM_Odm,false); ++ } ++ ++ if (delta_LCK > 8) { ++ RTL_W8(0x522, 0xff); ++ Reg0x18 = PHY_QueryRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, 1); ++ PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 1); ++ PHY_SetRFReg(priv, RF_PATH_A, 0x18, BIT(15), 1); ++ delay_ms(1); ++ PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 0); ++ PHY_SetRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, Reg0x18); ++ RTL_W8(0x522, 0x0); ++ priv->pshare->ThermalValue_LCK = ThermalValue; ++ } ++ } ++ ++ //update thermal meter value ++ priv->pshare->ThermalValue = ThermalValue; ++ for (i = 0 ; i < rf ; i++) ++ priv->pshare->OFDM_index[i] = OFDM_index[i]; ++ priv->pshare->CCK_index = CCK_index; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n", __FUNCTION__)); ++} ++#endif ++ ++ ++ ++#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries3( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PVOID pDM_VOID ++#else ++ IN PADAPTER Adapter ++#endif ++ ) ++{ ++#if 1 ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, channel, is_increase; ++ u1Byte ThermalValue_AVG_count = 0, p = 0, i = 0; ++ u4Byte ThermalValue_AVG = 0; ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ TXPWRTRACK_CFG c; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ /*4 1. The following TWO tables decide the final index of OFDM/CCK swing table.*/ ++ pu1Byte deltaSwingTableIdx_TUP_A = NULL, deltaSwingTableIdx_TDOWN_A = NULL; ++ pu1Byte deltaSwingTableIdx_TUP_B = NULL, deltaSwingTableIdx_TDOWN_B = NULL; ++ pu1Byte deltaSwingTableIdx_TUP_CCK_A = NULL, deltaSwingTableIdx_TDOWN_CCK_A = NULL; ++ pu1Byte deltaSwingTableIdx_TUP_CCK_B = NULL, deltaSwingTableIdx_TDOWN_CCK_B = NULL; ++ /*for 8814 add by Yu Chen*/ ++ pu1Byte deltaSwingTableIdx_TUP_C = NULL, deltaSwingTableIdx_TDOWN_C = NULL; ++ pu1Byte deltaSwingTableIdx_TUP_D = NULL, deltaSwingTableIdx_TDOWN_D = NULL; ++ pu1Byte deltaSwingTableIdx_TUP_CCK_C = NULL, deltaSwingTableIdx_TDOWN_CCK_C = NULL; ++ pu1Byte deltaSwingTableIdx_TUP_CCK_D = NULL, deltaSwingTableIdx_TDOWN_CCK_D = NULL; ++ ++#ifdef MP_TEST ++ if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { ++ channel = priv->pshare->working_channel; ++ if (priv->pshare->mp_txpwr_tracking == FALSE) ++ return; ++ } else ++#endif ++ { ++ channel = (priv->pmib->dot11RFEntry.dot11channel); ++ } ++ ++ ConfigureTxpowerTrack(pDM_Odm, &c); ++ ++ (*c.GetDeltaAllSwingTable)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_A, (pu1Byte *)&deltaSwingTableIdx_TDOWN_A, ++ (pu1Byte *)&deltaSwingTableIdx_TUP_B, (pu1Byte *)&deltaSwingTableIdx_TDOWN_B, ++ (pu1Byte *)&deltaSwingTableIdx_TUP_CCK_A, (pu1Byte *)&deltaSwingTableIdx_TDOWN_CCK_A, ++ (pu1Byte *)&deltaSwingTableIdx_TUP_CCK_B, (pu1Byte *)&deltaSwingTableIdx_TDOWN_CCK_B); ++ ++ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); /*0x42: RF Reg[15:10] 88E*/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Readback Thermal Meter = 0x%x(%d) EEPROMthermalmeter 0x%x(%d)\n" ++ , ThermalValue, ThermalValue, priv->pmib->dot11RFEntry.ther, priv->pmib->dot11RFEntry.ther)); ++ ++ /* Initialize */ ++ if (!pDM_Odm->RFCalibrateInfo.ThermalValue) ++ pDM_Odm->RFCalibrateInfo.ThermalValue = priv->pmib->dot11RFEntry.ther; ++ ++ if (!pDM_Odm->RFCalibrateInfo.ThermalValue_LCK) ++ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = priv->pmib->dot11RFEntry.ther; ++ ++ if (!pDM_Odm->RFCalibrateInfo.ThermalValue_IQK) ++ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = priv->pmib->dot11RFEntry.ther; ++ ++ /* calculate average thermal meter */ ++ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; ++ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; ++ ++ if (pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) /*Average times = c.AverageThermalNum*/ ++ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; ++ ++ for (i = 0; i < c.AverageThermalNum; i++) { ++ if (pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) { ++ ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; ++ ThermalValue_AVG_count++; ++ } ++ } ++ ++ if (ThermalValue_AVG_count) {/*Calculate Average ThermalValue after average enough times*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("ThermalValue_AVG=0x%x(%d) ThermalValue_AVG_count = %d\n" ++ , ThermalValue_AVG, ThermalValue_AVG, ThermalValue_AVG_count)); ++ ++ ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("AVG Thermal Meter = 0x%X(%d), EEPROMthermalmeter = 0x%X(%d)\n", ThermalValue, ThermalValue, priv->pmib->dot11RFEntry.ther, priv->pmib->dot11RFEntry.ther)); ++ } ++ ++ /*4 Calculate delta, delta_LCK, delta_IQK.*/ ++ delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); ++ delta_LCK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_LCK); ++ delta_IQK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_IQK); ++ is_increase = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 0 : 1); ++ ++ if (delta > 29) { /* power track table index(thermal diff.) upper bound*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta(%d) > 29, set delta to 29\n", delta)); ++ delta = 29; ++ } ++ ++ ++ /*4 if necessary, do LCK.*/ ++ ++ if (delta_LCK > c.Threshold_IQK) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); ++ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; ++ if (c.PHY_LCCalibrate) ++ (*c.PHY_LCCalibrate)(pDM_Odm); ++ } ++ ++ if (delta_IQK > c.Threshold_IQK) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= Threshold_IQK(%d)\n", delta_IQK, c.Threshold_IQK)); ++ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = ThermalValue; ++ if (c.DoIQK) ++ (*c.DoIQK)(pDM_Odm, TRUE, 0, 0); ++ } ++ ++ if (!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ ++ return; ++ ++ /*4 Do Power Tracking*/ ++ ++ if (ThermalValue != pDM_Odm->RFCalibrateInfo.ThermalValue) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("\n\n******** START POWER TRACKING ********\n")); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Readback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ++ ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue, priv->pmib->dot11RFEntry.ther)); ++ ++#ifdef _TRACKING_TABLE_FILE ++ if (priv->pshare->rf_ft_var.pwr_track_file) { ++ if (is_increase) { /*thermal is higher than base*/ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ switch (p) { ++ case ODM_RF_PATH_B: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_B[%d] = %d deltaSwingTableIdx_TUP_CCK_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta], delta, deltaSwingTableIdx_TUP_CCK_B[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; ++ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = deltaSwingTableIdx_TUP_CCK_B[delta]; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_C: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_C[%d] = %d deltaSwingTableIdx_TUP_CCK_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta], delta, deltaSwingTableIdx_TUP_CCK_C[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; ++ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = deltaSwingTableIdx_TUP_CCK_C[delta]; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_D: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_D[%d] = %d deltaSwingTableIdx_TUP_CCK_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta], delta, deltaSwingTableIdx_TUP_CCK_D[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; ++ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = deltaSwingTableIdx_TUP_CCK_D[delta]; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); ++ break; ++ default: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_A[%d] = %d deltaSwingTableIdx_TUP_CCK_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta], delta, deltaSwingTableIdx_TUP_CCK_A[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; ++ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = deltaSwingTableIdx_TUP_CCK_A[delta]; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); ++ break; ++ } ++ } ++ } else { /* thermal is lower than base*/ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ switch (p) { ++ case ODM_RF_PATH_B: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_B[%d] = %d deltaSwingTableIdx_TDOWN_CCK_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta], delta, deltaSwingTableIdx_TDOWN_CCK_B[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; ++ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_CCK_B[delta]; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_C: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_C[%d] = %d deltaSwingTableIdx_TDOWN_CCK_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta], delta, deltaSwingTableIdx_TDOWN_CCK_C[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; ++ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_CCK_C[delta]; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_D: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_D[%d] = %d deltaSwingTableIdx_TDOWN_CCK_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta], delta, deltaSwingTableIdx_TDOWN_CCK_D[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; ++ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_CCK_D[delta]; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); ++ break; ++ ++ default: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_A[%d] = %d deltaSwingTableIdx_TDOWN_CCK_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta], delta, deltaSwingTableIdx_TDOWN_CCK_A[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; ++ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_CCK_A[delta]; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); ++ break; ++ } ++ } ++ } ++ ++ if (is_increase) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> increse power --->\n")); ++ if (GET_CHIP_VER(priv) == VERSION_8197F) { ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, 0); ++ } else if (GET_CHIP_VER(priv) == VERSION_8822B) { ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); ++ } ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> decrese power --->\n")); ++ if (GET_CHIP_VER(priv) == VERSION_8197F) { ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, 0); ++ } else if (GET_CHIP_VER(priv) == VERSION_8822B) { ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); ++ } ++ } ++ } ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n\n", __func__)); ++ /*update thermal meter value*/ ++ pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; ++ ++ } ++ ++#endif ++} ++#endif ++ ++/*#if (RTL8814A_SUPPORT == 1)*/ ++#if (RTL8814A_SUPPORT == 1) ++ ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries2( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PVOID pDM_VOID ++#else ++ IN PADAPTER Adapter ++#endif ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, channel, is_increase; ++ u1Byte ThermalValue_AVG_count = 0, p = 0, i = 0; ++ u4Byte ThermalValue_AVG = 0, Reg0x18; ++ u4Byte BBSwingReg[4] = {rA_TxScale_Jaguar,rB_TxScale_Jaguar,rC_TxScale_Jaguar2,rD_TxScale_Jaguar2}; ++ s4Byte ele_D; ++ u4Byte BBswingIdx; ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ TXPWRTRACK_CFG c; ++ BOOLEAN bTSSIenable = FALSE; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. ++ pu1Byte deltaSwingTableIdx_TUP_A = NULL, deltaSwingTableIdx_TDOWN_A = NULL; ++ pu1Byte deltaSwingTableIdx_TUP_B = NULL, deltaSwingTableIdx_TDOWN_B = NULL; ++ //for 8814 add by Yu Chen ++ pu1Byte deltaSwingTableIdx_TUP_C = NULL, deltaSwingTableIdx_TDOWN_C = NULL; ++ pu1Byte deltaSwingTableIdx_TUP_D = NULL, deltaSwingTableIdx_TDOWN_D = NULL; ++ ++#ifdef MP_TEST ++ if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { ++ channel = priv->pshare->working_channel; ++ if (priv->pshare->mp_txpwr_tracking == FALSE) ++ return; ++ } else ++#endif ++ { ++ channel = (priv->pmib->dot11RFEntry.dot11channel); ++ } ++ ++ ConfigureTxpowerTrack(pDM_Odm, &c); ++ pRFCalibrateInfo->DefaultOfdmIndex = priv->pshare->OFDM_index0[ODM_RF_PATH_A]; ++ ++ (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte*)&deltaSwingTableIdx_TUP_A, (pu1Byte*)&deltaSwingTableIdx_TDOWN_A, ++ (pu1Byte*)&deltaSwingTableIdx_TUP_B, (pu1Byte*)&deltaSwingTableIdx_TDOWN_B); ++ ++ if(pDM_Odm->SupportICType & ODM_RTL8814A) // for 8814 path C & D ++ (*c.GetDeltaSwingTable8814only)(pDM_Odm, (pu1Byte*)&deltaSwingTableIdx_TUP_C, (pu1Byte*)&deltaSwingTableIdx_TDOWN_C, ++ (pu1Byte*)&deltaSwingTableIdx_TUP_D, (pu1Byte*)&deltaSwingTableIdx_TDOWN_D); ++ ++ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("\nReadback Thermal Meter = 0x%x, pre thermal meter 0x%x, EEPROMthermalmeter 0x%x\n", ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue, priv->pmib->dot11RFEntry.ther)); ++ ++ /* Initialize */ ++ if (!pDM_Odm->RFCalibrateInfo.ThermalValue) { ++ pDM_Odm->RFCalibrateInfo.ThermalValue = priv->pmib->dot11RFEntry.ther; ++ } ++ ++ if (!pDM_Odm->RFCalibrateInfo.ThermalValue_LCK) { ++ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = priv->pmib->dot11RFEntry.ther; ++ } ++ ++ if (!pDM_Odm->RFCalibrateInfo.ThermalValue_IQK) { ++ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = priv->pmib->dot11RFEntry.ther; ++ } ++ ++ bTSSIenable = (BOOLEAN)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, rRF_TxGainOffset, BIT7); // check TSSI enable ++ ++ //4 Query OFDM BB swing default setting Bit[31:21] ++ for(p = ODM_RF_PATH_A ; p < c.RfPathCount ; p++) ++ { ++ ele_D = ODM_GetBBReg(pDM_Odm, BBSwingReg[p], 0xffe00000); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("0x%x:0x%x ([31:21] = 0x%x)\n", BBSwingReg[p], ODM_GetBBReg(pDM_Odm, BBSwingReg[p], bMaskDWord), ele_D)); ++ ++ for (BBswingIdx = 0; BBswingIdx < TXSCALE_TABLE_SIZE; BBswingIdx++) {//4 ++ if (ele_D == TxScalingTable_Jaguar[BBswingIdx]) { ++ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = (u1Byte)BBswingIdx; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("OFDM_index[%d]=%d\n",p, pDM_Odm->RFCalibrateInfo.OFDM_index[p])); ++ break; ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("KfreeOffset[%d]=%d\n",p, pRFCalibrateInfo->KfreeOffset[p])); ++ ++ } ++ ++ /* calculate average thermal meter */ ++ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; ++ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; ++ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) //Average times = c.AverageThermalNum ++ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; ++ ++ for(i = 0; i < c.AverageThermalNum; i++) ++ { ++ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) ++ { ++ ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; ++ ThermalValue_AVG_count++; ++ } ++ } ++ ++ if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times ++ { ++ ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("AVG Thermal Meter = 0x%X, EEPROMthermalmeter = 0x%X\n", ThermalValue, priv->pmib->dot11RFEntry.ther)); ++ } ++ ++ //4 Calculate delta, delta_LCK, delta_IQK. ++ delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); ++ delta_LCK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_LCK); ++ delta_IQK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_IQK); ++ is_increase = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 0 : 1); ++ ++ //4 if necessary, do LCK. ++ if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { ++ if (delta_LCK > c.Threshold_IQK) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); ++ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; ++ ++ /*Use RTLCK, so close power tracking driver LCK*/ ++ #if (RTL8814A_SUPPORT != 1) ++ if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { ++ if (c.PHY_LCCalibrate) ++ (*c.PHY_LCCalibrate)(pDM_Odm); ++ } ++ #endif ++ } ++ } ++ ++ if (delta_IQK > c.Threshold_IQK) ++ { ++ panic_printk("%s(%d)\n", __FUNCTION__, __LINE__); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= Threshold_IQK(%d)\n", delta_IQK, c.Threshold_IQK)); ++ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = ThermalValue; ++ if(c.DoIQK) ++ (*c.DoIQK)(pDM_Odm, TRUE, 0, 0); ++ } ++ ++ if(!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ ++ return; ++ ++ //4 Do Power Tracking ++ ++ if(bTSSIenable == TRUE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("**********Enter PURE TSSI MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TSSI_MODE, p, 0); ++ } ++ else if (ThermalValue != pDM_Odm->RFCalibrateInfo.ThermalValue) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("\n******** START POWER TRACKING ********\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue, priv->pmib->dot11RFEntry.ther)); ++ ++#ifdef _TRACKING_TABLE_FILE ++ if (priv->pshare->rf_ft_var.pwr_track_file) ++ { ++ if (is_increase) // thermal is higher than base ++ { ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ { ++ switch(p) ++ { ++ case ODM_RF_PATH_B: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; // Record delta swing for mix mode power tracking ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_C: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; // Record delta swing for mix mode power tracking ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_D: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; // Record delta swing for mix mode power tracking ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ default: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; // Record delta swing for mix mode power tracking ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ } ++ } ++ } ++ else // thermal is lower than base ++ { ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ { ++ switch(p) ++ { ++ case ODM_RF_PATH_B: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; // Record delta swing for mix mode power tracking ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_C: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; // Record delta swing for mix mode power tracking ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_D: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; // Record delta swing for mix mode power tracking ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ default: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; // Record delta swing for mix mode power tracking ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ } ++ } ++ } ++ ++ if (is_increase) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> increse power ---> \n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> decrese power --->\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); ++ } ++ } ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** END:%s() ********\n", __FUNCTION__)); ++ //update thermal meter value ++ pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; ++ ++ } ++} ++#endif ++ ++#if (RTL8812A_SUPPORT == 1 || RTL8881A_SUPPORT == 1) ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PVOID pDM_VOID ++#else ++ IN PADAPTER Adapter ++#endif ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ unsigned char ThermalValue = 0, delta, delta_LCK, channel, is_decrease; ++ unsigned char ThermalValue_AVG_count = 0; ++ unsigned int ThermalValue_AVG = 0, Reg0x18; ++ unsigned int BBSwingReg[4]={0xc1c,0xe1c,0x181c,0x1a1c}; ++ int ele_D, value32; ++ char OFDM_index[2], index; ++ unsigned int i = 0, j = 0, rf_path, max_rf_path =2 ,rf; ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ unsigned char OFDM_min_index = 7; //OFDM BB Swing should be less than +2.5dB, which is required by Arthur and Mimic ++ ++ ++ ++#ifdef MP_TEST ++ if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { ++ channel = priv->pshare->working_channel; ++ if (priv->pshare->mp_txpwr_tracking == FALSE) ++ return; ++ } else ++#endif ++ { ++ channel = (priv->pmib->dot11RFEntry.dot11channel); ++ } ++ ++#if RTL8881A_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8881A) { ++ max_rf_path = 1; ++ if ((get_bonding_type_8881A() == BOND_8881AM ||get_bonding_type_8881A() == BOND_8881AN) ++ && priv->pshare->rf_ft_var.use_intpa8881A && (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G)) ++ OFDM_min_index = 6; // intPA - upper bond set to +3 dB (base: -2 dB)ot11RFEntry.phyBandSelect == PHY_BAND_2G)) ++ else ++ OFDM_min_index = 10; //OFDM BB Swing should be less than +1dB, which is required by Arthur and Mimic ++ } ++#endif ++ ++ ++ ThermalValue = (unsigned char)PHY_QueryRFReg(priv, RF_PATH_A, 0x42, 0xfc00, 1); //0x42: RF Reg[15:10] 88E ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); ++ ++ ++ //4 Query OFDM BB swing default setting Bit[31:21] ++ for(rf_path = 0 ; rf_path < max_rf_path ; rf_path++){ ++ ele_D = PHY_QueryBBReg(priv, BBSwingReg[rf_path], 0xffe00000); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("0x%x:0x%x ([31:21] = 0x%x)\n",BBSwingReg[rf_path], PHY_QueryBBReg(priv, BBSwingReg[rf_path], bMaskDWord),ele_D)); ++ for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {//4 ++ if (ele_D == OFDMSwingTable_8812[i]) { ++ OFDM_index[rf_path] = (unsigned char)i; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDM_index[%d]=%d\n",rf_path, OFDM_index[rf_path])); ++ break; ++ } ++ } ++ } ++#if 0 ++ //Query OFDM path A default setting Bit[31:21] ++ ele_D = PHY_QueryBBReg(priv, 0xc1c, 0xffe00000); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("0xc1c:0x%x ([31:21] = 0x%x)\n", PHY_QueryBBReg(priv, 0xc1c, bMaskDWord),ele_D)); ++ for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {//4 ++ if (ele_D == OFDMSwingTable_8812[i]) { ++ OFDM_index[0] = (unsigned char)i; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDM_index[0]=%d\n", OFDM_index[0])); ++ break; ++ } ++ } ++ //Query OFDM path B default setting ++ if (rf == 2) { ++ ele_D = PHY_QueryBBReg(priv, 0xe1c, 0xffe00000); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("0xe1c:0x%x ([32:21] = 0x%x)\n", PHY_QueryBBReg(priv, 0xe1c, bMaskDWord),ele_D)); ++ for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) { ++ if (ele_D == OFDMSwingTable_8812[i]) { ++ OFDM_index[1] = (unsigned char)i; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDM_index[1]=%d\n", OFDM_index[1])); ++ break; ++ } ++ } ++ } ++#endif ++ /* Initialize */ ++ if (!priv->pshare->ThermalValue) { ++ priv->pshare->ThermalValue = priv->pmib->dot11RFEntry.ther; ++ priv->pshare->ThermalValue_LCK = ThermalValue; ++ } ++ ++ /* calculate average thermal meter */ ++ { ++ priv->pshare->ThermalValue_AVG_8812[priv->pshare->ThermalValue_AVG_index_8812] = ThermalValue; ++ priv->pshare->ThermalValue_AVG_index_8812++; ++ if (priv->pshare->ThermalValue_AVG_index_8812 == AVG_THERMAL_NUM_8812) ++ priv->pshare->ThermalValue_AVG_index_8812 = 0; ++ ++ for (i = 0; i < AVG_THERMAL_NUM_8812; i++) { ++ if (priv->pshare->ThermalValue_AVG_8812[i]) { ++ ThermalValue_AVG += priv->pshare->ThermalValue_AVG_8812[i]; ++ ThermalValue_AVG_count++; ++ } ++ } ++ ++ if (ThermalValue_AVG_count) { ++ ThermalValue = (unsigned char)(ThermalValue_AVG / ThermalValue_AVG_count); ++ //printk("AVG Thermal Meter = 0x%x \n", ThermalValue); ++ } ++ } ++ ++ ++ //4 If necessary, do power tracking ++ ++ if(!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ ++ return; ++ ++ if (ThermalValue != priv->pshare->ThermalValue) { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** START POWER TRACKING ********\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); ++ delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); ++ delta_LCK = RTL_ABS(ThermalValue, priv->pshare->ThermalValue_LCK); ++ is_decrease = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 1 : 0); ++ //if (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) ++ { ++#ifdef _TRACKING_TABLE_FILE ++ if (priv->pshare->rf_ft_var.pwr_track_file) { ++ for (rf_path = 0; rf_path < max_rf_path; rf_path++) { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Diff: (%s)%d ==> get index from table : %d)\n", (is_decrease?"-":"+"), delta, get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); ++ if (is_decrease) { ++ OFDM_index[rf_path] = priv->pshare->OFDM_index0[rf_path] + get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0); ++ OFDM_index[rf_path] = ((OFDM_index[rf_path] > (OFDM_TABLE_SIZE_8812 - 1)) ? (OFDM_TABLE_SIZE_8812 - 1) : OFDM_index[rf_path]); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> decrese power ---> new OFDM_INDEX:%d (%d + %d)\n", OFDM_index[rf_path], priv->pshare->OFDM_index0[rf_path], get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); ++#if 0// RTL8881A_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8881A){ ++ if(priv->pshare->rf_ft_var.pwrtrk_TxAGC_enable){ ++ if(priv->pshare->AddTxAGC){//TxAGC has been added ++ AddTxPower88XX_AC(priv,0); ++ priv->pshare->AddTxAGC = 0; ++ priv->pshare->AddTxAGC_index = 0; ++ } ++ } ++ } ++#endif ++ } else { ++ ++ OFDM_index[rf_path] = priv->pshare->OFDM_index0[rf_path] - get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0); ++#if 0// RTL8881A_SUPPORT ++ if(pDM_Odm->SupportICType == ODM_RTL8881A){ ++ if(priv->pshare->rf_ft_var.pwrtrk_TxAGC_enable){ ++ if(OFDM_index[i] < OFDM_min_index){ ++ priv->pshare->AddTxAGC_index = (OFDM_min_index - OFDM_index[i])/2; // Calculate Remnant TxAGC Value, 2 index for 1 TxAGC ++ AddTxPower88XX_AC(priv,priv->pshare->AddTxAGC_index); ++ priv->pshare->AddTxAGC = 1; //AddTxAGC Flag = 1 ++ OFDM_index[i] = OFDM_min_index; ++ } ++ else{ ++ if(priv->pshare->AddTxAGC){// TxAGC been added ++ priv->pshare->AddTxAGC = 0; ++ priv->pshare->AddTxAGC_index = 0; ++ AddTxPower88XX_AC(priv,0); //minus the added TPI ++ } ++ } ++ } ++ } ++#else ++ OFDM_index[rf_path] = ((OFDM_index[rf_path] < OFDM_min_index) ? OFDM_min_index : OFDM_index[rf_path]); ++#endif ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> increse power ---> new OFDM_INDEX:%d (%d - %d)\n", OFDM_index[rf_path], priv->pshare->OFDM_index0[rf_path], get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); ++ } ++ } ++ } ++#endif ++ //4 Set new BB swing index ++ for (rf_path = 0; rf_path < max_rf_path; rf_path++) { ++ PHY_SetBBReg(priv, BBSwingReg[rf_path], 0xffe00000, OFDMSwingTable_8812[(unsigned int)OFDM_index[rf_path]]); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Readback 0x%x[31:21] = 0x%x, OFDM_index:%d\n",BBSwingReg[rf_path], PHY_QueryBBReg(priv, BBSwingReg[rf_path], 0xffe00000), OFDM_index[rf_path])); ++ } ++ ++ } ++ if (delta_LCK > 8) { ++ RTL_W8(0x522, 0xff); ++ Reg0x18 = PHY_QueryRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, 1); ++ PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 1); ++ PHY_SetRFReg(priv, RF_PATH_A, 0x18, BIT(15), 1); ++ delay_ms(200); // frequency deviation ++ PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 0); ++ PHY_SetRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, Reg0x18); ++ #ifdef CONFIG_RTL_8812_SUPPORT ++ if (GET_CHIP_VER(priv)== VERSION_8812E) ++ UpdateBBRFVal8812(priv, priv->pmib->dot11RFEntry.dot11channel); ++ #endif ++ RTL_W8(0x522, 0x0); ++ priv->pshare->ThermalValue_LCK = ThermalValue; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** END:%s() ********\n", __FUNCTION__)); ++ ++ //update thermal meter value ++ priv->pshare->ThermalValue = ThermalValue; ++ for (rf_path = 0; rf_path < max_rf_path; rf_path++) ++ priv->pshare->OFDM_index[rf_path] = OFDM_index[rf_path]; ++ } ++} ++ ++#endif ++ ++ ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PVOID pDM_VOID ++#else ++ IN PADAPTER Adapter ++#endif ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ++#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8197F || pDM_Odm->SupportICType == ODM_RTL8822B) { ++ ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries3(pDM_Odm); ++ return; ++ } ++#endif ++#if (RTL8814A_SUPPORT == 1) /*use this function to do power tracking after 8814 by YuChen*/ ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) { ++ ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries2(pDM_Odm); ++ return; ++ } ++#endif ++#if (RTL8881A_SUPPORT || RTL8812A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8812 || pDM_Odm->SupportICType & ODM_RTL8881A) { ++ ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries(pDM_Odm); ++ return; ++ } ++#endif ++ ++#if (RTL8192E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType==ODM_RTL8192E) { ++ ODM_TXPowerTrackingCallback_ThermalMeter_92E(pDM_Odm); ++ return; ++ } ++#endif ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ //PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++#endif ++ ++ ++ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, offset; ++ u1Byte ThermalValue_AVG_count = 0; ++ u4Byte ThermalValue_AVG = 0; ++// s4Byte ele_A=0, ele_D, TempCCk, X, value32; ++// s4Byte Y, ele_C=0; ++// s1Byte OFDM_index[2], CCK_index=0, OFDM_index_old[2]={0,0}, CCK_index_old=0, index; ++// s1Byte deltaPowerIndex = 0; ++ u4Byte i = 0;//, j = 0; ++ BOOLEAN is2T = FALSE; ++// BOOLEAN bInteralPA = FALSE; ++ ++ u1Byte OFDM_max_index = 34, rf = (is2T) ? 2 : 1; //OFDM BB Swing should be less than +3.0dB, which is required by Arthur ++ u1Byte Indexforchannel = 0;/*GetRightChnlPlaceforIQK(pHalData->CurrentChannel)*/ ++ enum _POWER_DEC_INC { POWER_DEC, POWER_INC }; ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++ ++ TXPWRTRACK_CFG c; ++ ++ ++ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. ++ s1Byte deltaSwingTableIdx[2][index_mapping_NUM_88E] = { ++ // {{Power decreasing(lower temperature)}, {Power increasing(higher temperature)}} ++ {0,0,2,3,4,4,5,6,7,7,8,9,10,10,11}, {0,0,1,2,3,4,4,4,4,5,7,8,9,9,10} ++ }; ++ u1Byte thermalThreshold[2][index_mapping_NUM_88E]={ ++ // {{Power decreasing(lower temperature)}, {Power increasing(higher temperature)}} ++ {0,2,4,6,8,10,12,14,16,18,20,22,24,26,27}, {0,2,4,6,8,10,12,14,16,18,20,22,25,25,25} ++ }; ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++#endif ++ ++ //4 2. Initilization ( 7 steps in total ) ++ ++ ConfigureTxpowerTrack(pDM_Odm, &c); ++ ++ pDM_Odm->RFCalibrateInfo.TXPowerTrackingCallbackCnt++; //cosa add for debug ++ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = TRUE; ++ ++#if (MP_DRIVER == 1) ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = pHalData->TxPowerTrackControl; // We should keep updating the control variable according to HalData. ++ // RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. ++ pDM_Odm->RFCalibrateInfo.RegA24 = 0x090e1317; ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && defined(MP_TEST) ++ if ((OPMODE & WIFI_MP_STATE) || pDM_Odm->priv->pshare->rf_ft_var.mp_specific) { ++ if(pDM_Odm->priv->pshare->mp_txpwr_tracking == FALSE) ++ return; ++ } ++#endif ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>odm_TXPowerTrackingCallback_ThermalMeter_8188E, pDM_Odm->BbSwingIdxCckBase: %d, pDM_Odm->BbSwingIdxOfdmBase: %d \n", pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->BbSwingIdxOfdmBase)); ++/* ++ if (!pDM_Odm->RFCalibrateInfo.TM_Trigger) { ++ ODM_SetRFReg(pDM_Odm, RF_PATH_A, c.ThermalRegAddr, BIT17 | BIT16, 0x3); ++ pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; ++ return; ++ } ++*/ ++ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ if( ! ThermalValue || ! pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) ++#else ++ if( ! pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) ++#endif ++ return; ++ ++ //4 3. Initialize ThermalValues of RFCalibrateInfo ++ ++ if( ! pDM_Odm->RFCalibrateInfo.ThermalValue) ++ { ++ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; ++ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = ThermalValue; ++ } ++ ++ if(pDM_Odm->RFCalibrateInfo.bReloadtxpowerindex) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); ++ } ++ ++ //4 4. Calculate average thermal meter ++ ++ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; ++ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; ++ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) ++ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; ++ ++ for(i = 0; i < c.AverageThermalNum; i++) ++ { ++ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) ++ { ++ ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; ++ ThermalValue_AVG_count++; ++ } ++ } ++ ++ if(ThermalValue_AVG_count) ++ { ++ // Give the new thermo value a weighting ++ ThermalValue_AVG += (ThermalValue*4); ++ ++ ThermalValue = (u1Byte)(ThermalValue_AVG / (ThermalValue_AVG_count+4)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("AVG Thermal Meter = 0x%x \n", ThermalValue)); ++ } ++ ++ //4 5. Calculate delta, delta_LCK, delta_IQK. ++ ++ delta = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue):(pDM_Odm->RFCalibrateInfo.ThermalValue - ThermalValue); ++ delta_LCK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_LCK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK):(pDM_Odm->RFCalibrateInfo.ThermalValue_LCK - ThermalValue); ++ delta_IQK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_IQK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK):(pDM_Odm->RFCalibrateInfo.ThermalValue_IQK - ThermalValue); ++ ++ //4 6. If necessary, do LCK. ++ if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { ++ /*if((delta_LCK > pHalData->Delta_LCK) && (pHalData->Delta_LCK != 0))*/ ++ if (delta_LCK >= c.Threshold_IQK) { ++ /*Delta temperature is equal to or larger than 20 centigrade.*/ ++ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; ++ (*c.PHY_LCCalibrate)(pDM_Odm); ++ } ++ } ++ ++ //3 7. If necessary, move the index of swing table to adjust Tx power. ++ ++ if (delta > 0 && pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) ++ { ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); ++#else ++ delta = (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther)?(ThermalValue - pDM_Odm->priv->pmib->dot11RFEntry.ther):(pDM_Odm->priv->pmib->dot11RFEntry.ther - ThermalValue); ++#endif ++ ++ ++ //4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ if(ThermalValue > pHalData->EEPROMThermalMeter) { ++#else ++ if(ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { ++#endif ++ CALCULATE_SWINGTALBE_OFFSET(offset, POWER_INC, index_mapping_NUM_88E, delta); ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex; ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex = deltaSwingTableIdx[POWER_INC][offset]; ++ ++ } else { ++ ++ CALCULATE_SWINGTALBE_OFFSET(offset, POWER_DEC, index_mapping_NUM_88E, delta); ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex; ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex = (-1)*deltaSwingTableIdx[POWER_DEC][offset]; ++ } ++ ++ if (pDM_Odm->RFCalibrateInfo.DeltaPowerIndex == pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast) ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset = 0; ++ else ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex - pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast; ++ ++ for(i = 0; i < rf; i++) ++ pDM_Odm->RFCalibrateInfo.OFDM_index[i] = pRFCalibrateInfo->BbSwingIdxOfdmBase + pDM_Odm->RFCalibrateInfo.PowerIndexOffset; ++ pDM_Odm->RFCalibrateInfo.CCK_index = pRFCalibrateInfo->BbSwingIdxCckBase + pDM_Odm->RFCalibrateInfo.PowerIndexOffset; ++ ++ pRFCalibrateInfo->BbSwingIdxCck = pDM_Odm->RFCalibrateInfo.CCK_index; ++ pRFCalibrateInfo->BbSwingIdxOfdm[RF_PATH_A] = pDM_Odm->RFCalibrateInfo.OFDM_index[RF_PATH_A]; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxCck, pRFCalibrateInfo->BbSwingIdxCckBase, pDM_Odm->RFCalibrateInfo.PowerIndexOffset)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("The 'OFDM' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxOfdm[RF_PATH_A], pRFCalibrateInfo->BbSwingIdxOfdmBase, pDM_Odm->RFCalibrateInfo.PowerIndexOffset)); ++ ++ //4 7.1 Handle boundary conditions of index. ++ ++ ++ for(i = 0; i < rf; i++) ++ { ++ if(pDM_Odm->RFCalibrateInfo.OFDM_index[i] > OFDM_max_index) ++ { ++ pDM_Odm->RFCalibrateInfo.OFDM_index[i] = OFDM_max_index; ++ } ++ else if (pDM_Odm->RFCalibrateInfo.OFDM_index[i] < 0) ++ { ++ pDM_Odm->RFCalibrateInfo.OFDM_index[i] = 0; ++ } ++ } ++ ++ if(pDM_Odm->RFCalibrateInfo.CCK_index > c.SwingTableSize_CCK-1) ++ pDM_Odm->RFCalibrateInfo.CCK_index = c.SwingTableSize_CCK-1; ++ else if (pDM_Odm->RFCalibrateInfo.CCK_index < 0) ++ pDM_Odm->RFCalibrateInfo.CCK_index = 0; ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("The thermal meter is unchanged or TxPowerTracking OFF: ThermalValue: %d , pDM_Odm->RFCalibrateInfo.ThermalValue: %d)\n", ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue)); ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset = 0; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", pDM_Odm->RFCalibrateInfo.CCK_index, pRFCalibrateInfo->BbSwingIdxCckBase)); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index: %d\n", pDM_Odm->RFCalibrateInfo.OFDM_index[RF_PATH_A], pRFCalibrateInfo->BbSwingIdxOfdmBase)); ++ ++ if (pDM_Odm->RFCalibrateInfo.PowerIndexOffset != 0 && pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) ++ { ++ //4 7.2 Configure the Swing Table to adjust Tx Power. ++ ++ pDM_Odm->RFCalibrateInfo.bTxPowerChanged = TRUE; // Always TRUE after Tx Power is adjusted by power tracking. ++ // ++ // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital ++ // to increase TX power. Otherwise, EVM will be bad. ++ // ++ // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. ++ if (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue) ++ { ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ // ("Temperature Increasing: delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", ++ // pDM_Odm->RFCalibrateInfo.PowerIndexOffset, delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); ++ } ++ else if (ThermalValue < pDM_Odm->RFCalibrateInfo.ThermalValue)// Low temperature ++ { ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ // ("Temperature Decreasing: delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", ++ // pDM_Odm->RFCalibrateInfo.PowerIndexOffset, delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); ++ } ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ if (ThermalValue > pHalData->EEPROMThermalMeter) ++#else ++ if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) ++#endif ++ { ++// ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Temperature(%d) hugher than PG value(%d), increases the power by TxAGC\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TXAGC, 0, 0); ++ } ++ else ++ { ++ // ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Temperature(%d) lower than PG value(%d), increases the power by TxAGC\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, RF_PATH_A, Indexforchannel); ++ if(is2T) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, RF_PATH_B, Indexforchannel); ++ } ++ ++ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->BbSwingIdxCck; ++ pRFCalibrateInfo->BbSwingIdxOfdmBase = pRFCalibrateInfo->BbSwingIdxOfdm[RF_PATH_A]; ++ pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; ++ ++ } ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ // if((delta_IQK > pHalData->Delta_IQK) && (pHalData->Delta_IQK != 0)) ++ if ((delta_IQK >= 8)) // Delta temperature is equal to or larger than 20 centigrade. ++ (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("<===dm_TXPowerTrackingCallback_ThermalMeter_8188E\n")); ++ ++ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; ++} ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ ++ ++VOID ++phy_PathAStandBy( ++ IN PADAPTER pAdapter ++ ) ++{ ++ RTPRINT(FINIT, INIT_IQK, ("Path-A standby mode!\n")); ++ ++ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x0); ++ PHY_SetBBReg(pAdapter, 0x840, bMaskDWord, 0x00010000); ++ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x808000); ++} ++ ++//1 7. IQK ++//#define MAX_TOLERANCE 5 ++//#define IQK_DELAY_TIME 1 //ms ++ ++u1Byte //bit0 = 1 => Tx OK, bit1 = 1 => Rx OK ++phy_PathA_IQK_8192C( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN configPathB ++ ) ++{ ++ ++ u4Byte regEAC, regE94, regE9C, regEA4; ++ u1Byte result = 0x00; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ RTPRINT(FINIT, INIT_IQK, ("Path A IQK!\n")); ++ ++ //path-A IQK setting ++ RTPRINT(FINIT, INIT_IQK, ("Path-A IQK setting!\n")); ++ if(pAdapter->interfaceIndex == 0) ++ { ++ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x10008c1f); ++ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x10008c1f); ++ } ++ else ++ { ++ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x10008c22); ++ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x10008c22); ++ } ++ ++ PHY_SetBBReg(pAdapter, rTx_IQK_PI_A, bMaskDWord, 0x82140102); ++ ++ PHY_SetBBReg(pAdapter, rRx_IQK_PI_A, bMaskDWord, configPathB ? 0x28160202 : ++ IS_81xxC_VENDOR_UMC_B_CUT(pHalData->VersionID)?0x28160202:0x28160502); ++ ++ //path-B IQK setting ++ if(configPathB) ++ { ++ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_B, bMaskDWord, 0x10008c22); ++ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_B, bMaskDWord, 0x10008c22); ++ PHY_SetBBReg(pAdapter, rTx_IQK_PI_B, bMaskDWord, 0x82140102); ++ PHY_SetBBReg(pAdapter, rRx_IQK_PI_B, bMaskDWord, 0x28160202); ++ } ++ ++ //LO calibration setting ++ RTPRINT(FINIT, INIT_IQK, ("LO calibration setting!\n")); ++ PHY_SetBBReg(pAdapter, rIQK_AGC_Rsp, bMaskDWord, 0x001028d1); ++ ++ //One shot, path A LOK & IQK ++ RTPRINT(FINIT, INIT_IQK, ("One shot, path A LOK & IQK!\n")); ++ PHY_SetBBReg(pAdapter, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); ++ PHY_SetBBReg(pAdapter, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); ++ ++ // delay x ms ++ RTPRINT(FINIT, INIT_IQK, ("Delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME)); ++ PlatformStallExecution(IQK_DELAY_TIME*1000); ++ ++ // Check failed ++ regEAC = PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_A_2, bMaskDWord); ++ RTPRINT(FINIT, INIT_IQK, ("0xeac = 0x%x\n", regEAC)); ++ regE94 = PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_A, bMaskDWord); ++ RTPRINT(FINIT, INIT_IQK, ("0xe94 = 0x%x\n", regE94)); ++ regE9C= PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_A, bMaskDWord); ++ RTPRINT(FINIT, INIT_IQK, ("0xe9c = 0x%x\n", regE9C)); ++ regEA4= PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_A_2, bMaskDWord); ++ RTPRINT(FINIT, INIT_IQK, ("0xea4 = 0x%x\n", regEA4)); ++ ++ if(!(regEAC & BIT28) && ++ (((regE94 & 0x03FF0000)>>16) != 0x142) && ++ (((regE9C & 0x03FF0000)>>16) != 0x42) ) ++ result |= 0x01; ++ else //if Tx not OK, ignore Rx ++ return result; ++ ++ if(!(regEAC & BIT27) && //if Tx is OK, check whether Rx is OK ++ (((regEA4 & 0x03FF0000)>>16) != 0x132) && ++ (((regEAC & 0x03FF0000)>>16) != 0x36)) ++ result |= 0x02; ++ else ++ RTPRINT(FINIT, INIT_IQK, ("Path A Rx IQK fail!!\n")); ++ ++ return result; ++ ++ ++} ++ ++u1Byte //bit0 = 1 => Tx OK, bit1 = 1 => Rx OK ++phy_PathB_IQK_8192C( ++ IN PADAPTER pAdapter ++ ) ++{ ++ u4Byte regEAC, regEB4, regEBC, regEC4, regECC; ++ u1Byte result = 0x00; ++ RTPRINT(FINIT, INIT_IQK, ("Path B IQK!\n")); ++ ++ //One shot, path B LOK & IQK ++ RTPRINT(FINIT, INIT_IQK, ("One shot, path A LOK & IQK!\n")); ++ PHY_SetBBReg(pAdapter, rIQK_AGC_Cont, bMaskDWord, 0x00000002); ++ PHY_SetBBReg(pAdapter, rIQK_AGC_Cont, bMaskDWord, 0x00000000); ++ ++ // delay x ms ++ RTPRINT(FINIT, INIT_IQK, ("Delay %d ms for One shot, path B LOK & IQK.\n", IQK_DELAY_TIME)); ++ PlatformStallExecution(IQK_DELAY_TIME*1000); ++ ++ // Check failed ++ regEAC = PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_A_2, bMaskDWord); ++ RTPRINT(FINIT, INIT_IQK, ("0xeac = 0x%x\n", regEAC)); ++ regEB4 = PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_B, bMaskDWord); ++ RTPRINT(FINIT, INIT_IQK, ("0xeb4 = 0x%x\n", regEB4)); ++ regEBC= PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_B, bMaskDWord); ++ RTPRINT(FINIT, INIT_IQK, ("0xebc = 0x%x\n", regEBC)); ++ regEC4= PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_B_2, bMaskDWord); ++ RTPRINT(FINIT, INIT_IQK, ("0xec4 = 0x%x\n", regEC4)); ++ regECC= PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_B_2, bMaskDWord); ++ RTPRINT(FINIT, INIT_IQK, ("0xecc = 0x%x\n", regECC)); ++ ++ if(!(regEAC & BIT31) && ++ (((regEB4 & 0x03FF0000)>>16) != 0x142) && ++ (((regEBC & 0x03FF0000)>>16) != 0x42)) ++ result |= 0x01; ++ else ++ return result; ++ ++ if(!(regEAC & BIT30) && ++ (((regEC4 & 0x03FF0000)>>16) != 0x132) && ++ (((regECC & 0x03FF0000)>>16) != 0x36)) ++ result |= 0x02; ++ else ++ RTPRINT(FINIT, INIT_IQK, ("Path B Rx IQK fail!!\n")); ++ ++ ++ return result; ++ ++} ++ ++VOID ++phy_PathAFillIQKMatrix( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bIQKOK, ++ IN s4Byte result[][8], ++ IN u1Byte final_candidate, ++ IN BOOLEAN bTxOnly ++ ) ++{ ++ u4Byte Oldval_0, X, TX0_A, reg; ++ s4Byte Y, TX0_C; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ RTPRINT(FINIT, INIT_IQK, ("Path A IQ Calibration %s !\n",(bIQKOK)?"Success":"Failed")); ++ ++ if(final_candidate == 0xFF) ++ return; ++ ++ else if(bIQKOK) ++ { ++ Oldval_0 = (PHY_QueryBBReg(pAdapter, rOFDM0_XATxIQImbalance, bMaskDWord) >> 22) & 0x3FF; ++ ++ X = result[final_candidate][0]; ++ if ((X & 0x00000200) != 0) ++ X = X | 0xFFFFFC00; ++ TX0_A = (X * Oldval_0) >> 8; ++ RTPRINT(FINIT, INIT_IQK, ("X = 0x%x, TX0_A = 0x%x, Oldval_0 0x%x\n", X, TX0_A, Oldval_0)); ++ PHY_SetBBReg(pAdapter, rOFDM0_XATxIQImbalance, 0x3FF, TX0_A); ++ PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(31), ((X * Oldval_0>>7) & 0x1)); ++ ++ Y = result[final_candidate][1]; ++ if ((Y & 0x00000200) != 0) ++ Y = Y | 0xFFFFFC00; ++ ++ //path B IQK result + 3 ++ if(pAdapter->interfaceIndex == 1 && pHalData->CurrentBandType == BAND_ON_5G) ++ Y += 3; ++ ++ TX0_C = (Y * Oldval_0) >> 8; ++ RTPRINT(FINIT, INIT_IQK, ("Y = 0x%x, TX = 0x%x\n", Y, TX0_C)); ++ PHY_SetBBReg(pAdapter, rOFDM0_XCTxAFE, 0xF0000000, ((TX0_C&0x3C0)>>6)); ++ PHY_SetBBReg(pAdapter, rOFDM0_XATxIQImbalance, 0x003F0000, (TX0_C&0x3F)); ++ PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(29), ((Y * Oldval_0>>7) & 0x1)); ++ ++ if(bTxOnly) ++ { ++ RTPRINT(FINIT, INIT_IQK, ("phy_PathAFillIQKMatrix only Tx OK\n")); ++ return; ++ } ++ ++ reg = result[final_candidate][2]; ++ PHY_SetBBReg(pAdapter, rOFDM0_XARxIQImbalance, 0x3FF, reg); ++ ++ reg = result[final_candidate][3] & 0x3F; ++ PHY_SetBBReg(pAdapter, rOFDM0_XARxIQImbalance, 0xFC00, reg); ++ ++ reg = (result[final_candidate][3] >> 6) & 0xF; ++ PHY_SetBBReg(pAdapter, rOFDM0_RxIQExtAnta, 0xF0000000, reg); ++ } ++} ++ ++VOID ++phy_PathBFillIQKMatrix( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bIQKOK, ++ IN s4Byte result[][8], ++ IN u1Byte final_candidate, ++ IN BOOLEAN bTxOnly //do Tx only ++ ) ++{ ++ u4Byte Oldval_1, X, TX1_A, reg; ++ s4Byte Y, TX1_C; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ RTPRINT(FINIT, INIT_IQK, ("Path B IQ Calibration %s !\n",(bIQKOK)?"Success":"Failed")); ++ ++ if(final_candidate == 0xFF) ++ return; ++ ++ else if(bIQKOK) ++ { ++ Oldval_1 = (PHY_QueryBBReg(pAdapter, rOFDM0_XBTxIQImbalance, bMaskDWord) >> 22) & 0x3FF; ++ ++ X = result[final_candidate][4]; ++ if ((X & 0x00000200) != 0) ++ X = X | 0xFFFFFC00; ++ TX1_A = (X * Oldval_1) >> 8; ++ RTPRINT(FINIT, INIT_IQK, ("X = 0x%x, TX1_A = 0x%x\n", X, TX1_A)); ++ PHY_SetBBReg(pAdapter, rOFDM0_XBTxIQImbalance, 0x3FF, TX1_A); ++ PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(27), ((X * Oldval_1>>7) & 0x1)); ++ ++ Y = result[final_candidate][5]; ++ if ((Y & 0x00000200) != 0) ++ Y = Y | 0xFFFFFC00; ++ if(pHalData->CurrentBandType == BAND_ON_5G) ++ Y += 3; //temp modify for preformance ++ TX1_C = (Y * Oldval_1) >> 8; ++ RTPRINT(FINIT, INIT_IQK, ("Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C)); ++ PHY_SetBBReg(pAdapter, rOFDM0_XDTxAFE, 0xF0000000, ((TX1_C&0x3C0)>>6)); ++ PHY_SetBBReg(pAdapter, rOFDM0_XBTxIQImbalance, 0x003F0000, (TX1_C&0x3F)); ++ PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(25), ((Y * Oldval_1>>7) & 0x1)); ++ ++ if(bTxOnly) ++ return; ++ ++ reg = result[final_candidate][6]; ++ PHY_SetBBReg(pAdapter, rOFDM0_XBRxIQImbalance, 0x3FF, reg); ++ ++ reg = result[final_candidate][7] & 0x3F; ++ PHY_SetBBReg(pAdapter, rOFDM0_XBRxIQImbalance, 0xFC00, reg); ++ ++ reg = (result[final_candidate][7] >> 6) & 0xF; ++ PHY_SetBBReg(pAdapter, rOFDM0_AGCRSSITable, 0x0000F000, reg); ++ } ++} ++ ++ ++BOOLEAN ++phy_SimularityCompare_92C( ++ IN PADAPTER pAdapter, ++ IN s4Byte result[][8], ++ IN u1Byte c1, ++ IN u1Byte c2 ++ ) ++{ ++ u4Byte i, j, diff, SimularityBitMap, bound = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u1Byte final_candidate[2] = {0xFF, 0xFF}; //for path A and path B ++ BOOLEAN bResult = TRUE, is2T = IS_92C_SERIAL( pHalData->VersionID); ++ ++ if(is2T) ++ bound = 8; ++ else ++ bound = 4; ++ ++ SimularityBitMap = 0; ++ ++ for( i = 0; i < bound; i++ ) ++ { ++ diff = (result[c1][i] > result[c2][i]) ? (result[c1][i] - result[c2][i]) : (result[c2][i] - result[c1][i]); ++ if (diff > MAX_TOLERANCE) ++ { ++ if((i == 2 || i == 6) && !SimularityBitMap) ++ { ++ if(result[c1][i]+result[c1][i+1] == 0) ++ final_candidate[(i/4)] = c2; ++ else if (result[c2][i]+result[c2][i+1] == 0) ++ final_candidate[(i/4)] = c1; ++ else ++ SimularityBitMap = SimularityBitMap|(1< do IQK again ++*/ ++BOOLEAN ++phy_SimularityCompare( ++ IN PADAPTER pAdapter, ++ IN s4Byte result[][8], ++ IN u1Byte c1, ++ IN u1Byte c2 ++ ) ++{ ++ return phy_SimularityCompare_92C(pAdapter, result, c1, c2); ++ ++} ++ ++VOID ++phy_IQCalibrate_8192C( ++ IN PADAPTER pAdapter, ++ IN s4Byte result[][8], ++ IN u1Byte t, ++ IN BOOLEAN is2T ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u4Byte i; ++ u1Byte PathAOK, PathBOK; ++ u4Byte ADDA_REG[IQK_ADDA_REG_NUM] = { ++ rFPGA0_XCD_SwitchControl, rBlue_Tooth, ++ rRx_Wait_CCA, rTx_CCK_RFON, ++ rTx_CCK_BBON, rTx_OFDM_RFON, ++ rTx_OFDM_BBON, rTx_To_Rx, ++ rTx_To_Tx, rRx_CCK, ++ rRx_OFDM, rRx_Wait_RIFS, ++ rRx_TO_Rx, rStandby, ++ rSleep, rPMPD_ANAEN }; ++ u4Byte IQK_MAC_REG[IQK_MAC_REG_NUM] = { ++ REG_TXPAUSE, REG_BCN_CTRL, ++ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; ++ ++ //since 92C & 92D have the different define in IQK_BB_REG ++ u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { ++ rOFDM0_TRxPathEnable, rOFDM0_TRMuxPar, ++ rFPGA0_XCD_RFInterfaceSW, rConfig_AntA, rConfig_AntB, ++ rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, ++ rFPGA0_XB_RFInterfaceOE, /*rFPGA0_RFMOD*/ rCCK0_AFESetting ++ }; ++ ++ u4Byte IQK_BB_REG_92D[IQK_BB_REG_NUM_92D] = { //for normal ++ rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, ++ rFPGA0_XB_RFInterfaceOE, rOFDM0_TRMuxPar, ++ rFPGA0_XCD_RFInterfaceSW, rOFDM0_TRxPathEnable, ++ /*rFPGA0_RFMOD*/ rCCK0_AFESetting, rFPGA0_AnalogParameter4, ++ rOFDM0_XAAGCCore1, rOFDM0_XBAGCCore1 ++ }; ++#if MP_DRIVER ++ const u4Byte retryCount = 9; ++#else ++ const u4Byte retryCount = 2; ++#endif ++ //Neil Chen--2011--05--19-- ++ //3 Path Div ++ u1Byte rfPathSwitch=0x0; ++ ++ // Note: IQ calibration must be performed after loading ++ // PHY_REG.txt , and radio_a, radio_b.txt ++ ++ u4Byte bbvalue; ++ ++ if(t==0) ++ { ++ //bbvalue = PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bMaskDWord); ++ // RTPRINT(FINIT, INIT_IQK, ("phy_IQCalibrate_8192C()==>0x%08x\n",bbvalue)); ++ ++ RTPRINT(FINIT, INIT_IQK, ("IQ Calibration for %s\n", (is2T ? "2T2R" : "1T1R"))); ++ ++ // Save ADDA parameters, turn Path A ADDA on ++ phy_SaveADDARegisters(pAdapter, ADDA_REG, pHalData->ADDA_backup, IQK_ADDA_REG_NUM); ++ phy_SaveMACRegisters(pAdapter, IQK_MAC_REG, pHalData->IQK_MAC_backup); ++ phy_SaveADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup, IQK_BB_REG_NUM); ++ } ++ ++ phy_PathADDAOn(pAdapter, ADDA_REG, TRUE, is2T); ++ ++ if(t==0) ++ { ++ pHalData->bRfPiEnable = (u1Byte)PHY_QueryBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, BIT(8)); ++ } ++ ++ if(!pHalData->bRfPiEnable){ ++ // Switch BB to PI mode to do IQ Calibration. ++ phy_PIModeSwitch(pAdapter, TRUE); ++ } ++ ++ //MAC settings ++ phy_MACSettingCalibration(pAdapter, IQK_MAC_REG, pHalData->IQK_MAC_backup); ++ ++ //PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, BIT24, 0x00); ++ PHY_SetBBReg(pAdapter, rCCK0_AFESetting, bMaskDWord, (0x0f000000 | (PHY_QueryBBReg(pAdapter, rCCK0_AFESetting, bMaskDWord))) ); ++ PHY_SetBBReg(pAdapter, rOFDM0_TRxPathEnable, bMaskDWord, 0x03a05600); ++ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, bMaskDWord, 0x000800e4); ++ PHY_SetBBReg(pAdapter, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x22204000); ++ { ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0x01); ++ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0x01); ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_RFInterfaceOE, BIT10, 0x00); ++ PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0x00); ++ } ++ ++ if(is2T) ++ { ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_LSSIParameter, bMaskDWord, 0x00010000); ++ PHY_SetBBReg(pAdapter, rFPGA0_XB_LSSIParameter, bMaskDWord, 0x00010000); ++ } ++ ++ { ++ //Page B init ++ PHY_SetBBReg(pAdapter, rConfig_AntA, bMaskDWord, 0x00080000); ++ ++ if(is2T) ++ { ++ PHY_SetBBReg(pAdapter, rConfig_AntB, bMaskDWord, 0x00080000); ++ } ++ } ++ // IQ calibration setting ++ RTPRINT(FINIT, INIT_IQK, ("IQK setting!\n")); ++ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x808000); ++ PHY_SetBBReg(pAdapter, rTx_IQK, bMaskDWord, 0x01007c00); ++ PHY_SetBBReg(pAdapter, rRx_IQK, bMaskDWord, 0x01004800); ++ ++ for(i = 0 ; i < retryCount ; i++){ ++ PathAOK = phy_PathA_IQK_8192C(pAdapter, is2T); ++ if(PathAOK == 0x03){ ++ RTPRINT(FINIT, INIT_IQK, ("Path A IQK Success!!\n")); ++ result[t][0] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; ++ result[t][1] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; ++ result[t][2] = (PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; ++ result[t][3] = (PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; ++ break; ++ } ++ else if (i == (retryCount-1) && PathAOK == 0x01) //Tx IQK OK ++ { ++ RTPRINT(FINIT, INIT_IQK, ("Path A IQK Only Tx Success!!\n")); ++ ++ result[t][0] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; ++ result[t][1] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; ++ } ++ } ++ ++ if(0x00 == PathAOK){ ++ RTPRINT(FINIT, INIT_IQK, ("Path A IQK failed!!\n")); ++ } ++ ++ if(is2T){ ++ phy_PathAStandBy(pAdapter); ++ ++ // Turn Path B ADDA on ++ phy_PathADDAOn(pAdapter, ADDA_REG, FALSE, is2T); ++ ++ for(i = 0 ; i < retryCount ; i++){ ++ PathBOK = phy_PathB_IQK_8192C(pAdapter); ++ if(PathBOK == 0x03){ ++ RTPRINT(FINIT, INIT_IQK, ("Path B IQK Success!!\n")); ++ result[t][4] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_B, bMaskDWord)&0x3FF0000)>>16; ++ result[t][5] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_B, bMaskDWord)&0x3FF0000)>>16; ++ result[t][6] = (PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_B_2, bMaskDWord)&0x3FF0000)>>16; ++ result[t][7] = (PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_B_2, bMaskDWord)&0x3FF0000)>>16; ++ break; ++ } ++ else if (i == (retryCount - 1) && PathBOK == 0x01) //Tx IQK OK ++ { ++ RTPRINT(FINIT, INIT_IQK, ("Path B Only Tx IQK Success!!\n")); ++ result[t][4] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_B, bMaskDWord)&0x3FF0000)>>16; ++ result[t][5] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_B, bMaskDWord)&0x3FF0000)>>16; ++ } ++ } ++ ++ if(0x00 == PathBOK){ ++ RTPRINT(FINIT, INIT_IQK, ("Path B IQK failed!!\n")); ++ } ++ } ++ ++ //Back to BB mode, load original value ++ RTPRINT(FINIT, INIT_IQK, ("IQK:Back to BB mode, load original value!\n")); ++ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); ++ ++ if(t!=0) ++ { ++ if(!pHalData->bRfPiEnable){ ++ // Switch back BB to SI mode after finish IQ Calibration. ++ phy_PIModeSwitch(pAdapter, FALSE); ++ } ++ ++ // Reload ADDA power saving parameters ++ phy_ReloadADDARegisters(pAdapter, ADDA_REG, pHalData->ADDA_backup, IQK_ADDA_REG_NUM); ++ ++ // Reload MAC parameters ++ phy_ReloadMACRegisters(pAdapter, IQK_MAC_REG, pHalData->IQK_MAC_backup); ++ ++ // Reload BB parameters ++ phy_ReloadADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup, IQK_BB_REG_NUM); ++ ++ /*Restore RX initial gain*/ ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_LSSIParameter, bMaskDWord, 0x00032ed3); ++ if (is2T) ++ PHY_SetBBReg(pAdapter, rFPGA0_XB_LSSIParameter, bMaskDWord, 0x00032ed3); ++ //load 0xe30 IQC default value ++ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); ++ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); ++ ++ } ++ RTPRINT(FINIT, INIT_IQK, ("phy_IQCalibrate_8192C() <==\n")); ++ ++} ++ ++ ++VOID ++phy_LCCalibrate92C( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN is2T ++ ) ++{ ++ u1Byte tmpReg; ++ u4Byte RF_Amode=0, RF_Bmode=0, LC_Cal; ++// HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ //Check continuous TX and Packet TX ++ tmpReg = PlatformEFIORead1Byte(pAdapter, 0xd03); ++ ++ if((tmpReg&0x70) != 0) //Deal with contisuous TX case ++ PlatformEFIOWrite1Byte(pAdapter, 0xd03, tmpReg&0x8F); //disable all continuous TX ++ else // Deal with Packet TX case ++ PlatformEFIOWrite1Byte(pAdapter, REG_TXPAUSE, 0xFF); // block all queues ++ ++ if((tmpReg&0x70) != 0) ++ { ++ //1. Read original RF mode ++ //Path-A ++ RF_Amode = PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_AC, bMask12Bits); ++ ++ //Path-B ++ if(is2T) ++ RF_Bmode = PHY_QueryRFReg(pAdapter, RF_PATH_B, RF_AC, bMask12Bits); ++ ++ //2. Set RF mode = standby mode ++ //Path-A ++ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_AC, bMask12Bits, (RF_Amode&0x8FFFF)|0x10000); ++ ++ //Path-B ++ if(is2T) ++ PHY_SetRFReg(pAdapter, RF_PATH_B, RF_AC, bMask12Bits, (RF_Bmode&0x8FFFF)|0x10000); ++ } ++ ++ //3. Read RF reg18 ++ LC_Cal = PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_CHNLBW, bMask12Bits); ++ ++ //4. Set LC calibration begin bit15 ++ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_CHNLBW, bMask12Bits, LC_Cal|0x08000); ++ ++ delay_ms(100); ++ ++ ++ //Restore original situation ++ if((tmpReg&0x70) != 0) //Deal with contisuous TX case ++ { ++ //Path-A ++ PlatformEFIOWrite1Byte(pAdapter, 0xd03, tmpReg); ++ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_AC, bMask12Bits, RF_Amode); ++ ++ //Path-B ++ if(is2T) ++ PHY_SetRFReg(pAdapter, RF_PATH_B, RF_AC, bMask12Bits, RF_Bmode); ++ } ++ else // Deal with Packet TX case ++ { ++ PlatformEFIOWrite1Byte(pAdapter, REG_TXPAUSE, 0x00); ++ } ++} ++ ++ ++VOID ++phy_LCCalibrate( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN is2T ++ ) ++{ ++ phy_LCCalibrate92C(pAdapter, is2T); ++} ++ ++ ++ ++//Analog Pre-distortion calibration ++#define APK_BB_REG_NUM 8 ++#define APK_CURVE_REG_NUM 4 ++#define PATH_NUM 2 ++ ++VOID ++phy_APCalibrate_8192C( ++ IN PADAPTER pAdapter, ++ IN s1Byte delta, ++ IN BOOLEAN is2T ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ u4Byte regD[PATH_NUM]; ++ u4Byte tmpReg, index, offset, i, apkbound; ++ u1Byte path, pathbound = PATH_NUM; ++ u4Byte BB_backup[APK_BB_REG_NUM]; ++ u4Byte BB_REG[APK_BB_REG_NUM] = { ++ rFPGA1_TxBlock, rOFDM0_TRxPathEnable, ++ rFPGA0_RFMOD, rOFDM0_TRMuxPar, ++ rFPGA0_XCD_RFInterfaceSW, rFPGA0_XAB_RFInterfaceSW, ++ rFPGA0_XA_RFInterfaceOE, rFPGA0_XB_RFInterfaceOE }; ++ u4Byte BB_AP_MODE[APK_BB_REG_NUM] = { ++ 0x00000020, 0x00a05430, 0x02040000, ++ 0x000800e4, 0x00204000 }; ++ u4Byte BB_normal_AP_MODE[APK_BB_REG_NUM] = { ++ 0x00000020, 0x00a05430, 0x02040000, ++ 0x000800e4, 0x22204000 }; ++ ++ u4Byte AFE_backup[IQK_ADDA_REG_NUM]; ++ u4Byte AFE_REG[IQK_ADDA_REG_NUM] = { ++ rFPGA0_XCD_SwitchControl, rBlue_Tooth, ++ rRx_Wait_CCA, rTx_CCK_RFON, ++ rTx_CCK_BBON, rTx_OFDM_RFON, ++ rTx_OFDM_BBON, rTx_To_Rx, ++ rTx_To_Tx, rRx_CCK, ++ rRx_OFDM, rRx_Wait_RIFS, ++ rRx_TO_Rx, rStandby, ++ rSleep, rPMPD_ANAEN }; ++ ++ u4Byte MAC_backup[IQK_MAC_REG_NUM]; ++ u4Byte MAC_REG[IQK_MAC_REG_NUM] = { ++ REG_TXPAUSE, REG_BCN_CTRL, ++ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; ++ ++ u4Byte APK_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { ++ {0x0852c, 0x1852c, 0x5852c, 0x1852c, 0x5852c}, ++ {0x2852e, 0x0852e, 0x3852e, 0x0852e, 0x0852e} ++ }; ++ ++ u4Byte APK_normal_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { ++ {0x0852c, 0x0a52c, 0x3a52c, 0x5a52c, 0x5a52c}, //path settings equal to path b settings ++ {0x0852c, 0x0a52c, 0x5a52c, 0x5a52c, 0x5a52c} ++ }; ++ ++ u4Byte APK_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { ++ {0x52019, 0x52014, 0x52013, 0x5200f, 0x5208d}, ++ {0x5201a, 0x52019, 0x52016, 0x52033, 0x52050} ++ }; ++ ++ u4Byte APK_normal_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { ++ {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a}, //path settings equal to path b settings ++ {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a} ++ }; ++#if 0 ++ u4Byte APK_RF_value_A[PATH_NUM][APK_BB_REG_NUM] = { ++ {0x1adb0, 0x1adb0, 0x1ada0, 0x1ad90, 0x1ad80}, ++ {0x00fb0, 0x00fb0, 0x00fa0, 0x00f90, 0x00f80} ++ }; ++#endif ++ u4Byte AFE_on_off[PATH_NUM] = { ++ 0x04db25a4, 0x0b1b25a4}; //path A on path B off / path A off path B on ++ ++ u4Byte APK_offset[PATH_NUM] = { ++ rConfig_AntA, rConfig_AntB}; ++ ++ u4Byte APK_normal_offset[PATH_NUM] = { ++ rConfig_Pmpd_AntA, rConfig_Pmpd_AntB}; ++ ++ u4Byte APK_value[PATH_NUM] = { ++ 0x92fc0000, 0x12fc0000}; ++ ++ u4Byte APK_normal_value[PATH_NUM] = { ++ 0x92680000, 0x12680000}; ++ ++ s1Byte APK_delta_mapping[APK_BB_REG_NUM][13] = { ++ {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, ++ {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, ++ {-6, -4, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, ++ {-1, -1, -1, -1, -1, -1, 0, 1, 2, 3, 4, 5, 6}, ++ {-11, -9, -7, -5, -3, -1, 0, 0, 0, 0, 0, 0, 0} ++ }; ++ ++ u4Byte APK_normal_setting_value_1[13] = { ++ 0x01017018, 0xf7ed8f84, 0x1b1a1816, 0x2522201e, 0x322e2b28, ++ 0x433f3a36, 0x5b544e49, 0x7b726a62, 0xa69a8f84, 0xdfcfc0b3, ++ 0x12680000, 0x00880000, 0x00880000 ++ }; ++ ++ u4Byte APK_normal_setting_value_2[16] = { ++ 0x01c7021d, 0x01670183, 0x01000123, 0x00bf00e2, 0x008d00a3, ++ 0x0068007b, 0x004d0059, 0x003a0042, 0x002b0031, 0x001f0025, ++ 0x0017001b, 0x00110014, 0x000c000f, 0x0009000b, 0x00070008, ++ 0x00050006 ++ }; ++ ++ u4Byte APK_result[PATH_NUM][APK_BB_REG_NUM]; //val_1_1a, val_1_2a, val_2a, val_3a, val_4a ++// u4Byte AP_curve[PATH_NUM][APK_CURVE_REG_NUM]; ++ ++ s4Byte BB_offset, delta_V, delta_offset; ++ ++#if MP_DRIVER == 1 ++ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); ++ ++ pMptCtx->APK_bound[0] = 45; ++ pMptCtx->APK_bound[1] = 52; ++#endif ++ ++ RTPRINT(FINIT, INIT_IQK, ("==>phy_APCalibrate_8192C() delta %d\n", delta)); ++ RTPRINT(FINIT, INIT_IQK, ("AP Calibration for %s\n", (is2T ? "2T2R" : "1T1R"))); ++ if(!is2T) ++ pathbound = 1; ++ ++ //2 FOR NORMAL CHIP SETTINGS ++ ++// Temporarily do not allow normal driver to do the following settings because these offset ++// and value will cause RF internal PA to be unpredictably disabled by HW, such that RF Tx signal ++// will disappear after disable/enable card many times on 88CU. RF SD and DD have not find the ++// root cause, so we remove these actions temporarily. Added by tynli and SD3 Allen. 2010.05.31. ++#if MP_DRIVER != 1 ++ return; ++#endif ++ //settings adjust for normal chip ++ for(index = 0; index < PATH_NUM; index ++) ++ { ++ APK_offset[index] = APK_normal_offset[index]; ++ APK_value[index] = APK_normal_value[index]; ++ AFE_on_off[index] = 0x6fdb25a4; ++ } ++ ++ for(index = 0; index < APK_BB_REG_NUM; index ++) ++ { ++ for(path = 0; path < pathbound; path++) ++ { ++ APK_RF_init_value[path][index] = APK_normal_RF_init_value[path][index]; ++ APK_RF_value_0[path][index] = APK_normal_RF_value_0[path][index]; ++ } ++ BB_AP_MODE[index] = BB_normal_AP_MODE[index]; ++ } ++ ++ apkbound = 6; ++ ++ //save BB default value ++ for(index = 0; index < APK_BB_REG_NUM ; index++) ++ { ++ if(index == 0) //skip ++ continue; ++ BB_backup[index] = PHY_QueryBBReg(pAdapter, BB_REG[index], bMaskDWord); ++ } ++ ++ //save MAC default value ++ phy_SaveMACRegisters(pAdapter, MAC_REG, MAC_backup); ++ ++ //save AFE default value ++ phy_SaveADDARegisters(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); ++ ++ for(path = 0; path < pathbound; path++) ++ { ++ ++ ++ if(path == RF_PATH_A) ++ { ++ //path A APK ++ //load APK setting ++ //path-A ++ offset = rPdp_AntA; ++ for(index = 0; index < 11; index ++) ++ { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); ++ ++ offset += 0x04; ++ } ++ ++ PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); ++ ++ offset = rConfig_AntA; ++ for(; index < 13; index ++) ++ { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); ++ ++ offset += 0x04; ++ } ++ ++ //page-B1 ++ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x400000); ++ ++ //path A ++ offset = rPdp_AntA; ++ for(index = 0; index < 16; index++) ++ { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_2[index]); ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); ++ ++ offset += 0x04; ++ } ++ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); ++ } ++ else if(path == RF_PATH_B) ++ { ++ //path B APK ++ //load APK setting ++ //path-B ++ offset = rPdp_AntB; ++ for(index = 0; index < 10; index ++) ++ { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); ++ ++ offset += 0x04; ++ } ++ PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntA, bMaskDWord, 0x12680000); ++ ++ PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); ++ ++ offset = rConfig_AntA; ++ index = 11; ++ for(; index < 13; index ++) //offset 0xb68, 0xb6c ++ { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); ++ ++ offset += 0x04; ++ } ++ ++ //page-B1 ++ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x400000); ++ ++ //path B ++ offset = 0xb60; ++ for(index = 0; index < 16; index++) ++ { ++ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_2[index]); ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); ++ ++ offset += 0x04; ++ } ++ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); ++ } ++ ++ //save RF default value ++ regD[path] = PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask); ++ ++ //Path A AFE all on, path B AFE All off or vise versa ++ for(index = 0; index < IQK_ADDA_REG_NUM ; index++) ++ PHY_SetBBReg(pAdapter, AFE_REG[index], bMaskDWord, AFE_on_off[path]); ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xe70 %x\n", PHY_QueryBBReg(pAdapter, rRx_Wait_CCA, bMaskDWord))); ++ ++ //BB to AP mode ++ if(path == 0) ++ { ++ for(index = 0; index < APK_BB_REG_NUM ; index++) ++ { ++ ++ if(index == 0) //skip ++ continue; ++ else if (index < 5) ++ PHY_SetBBReg(pAdapter, BB_REG[index], bMaskDWord, BB_AP_MODE[index]); ++ else if (BB_REG[index] == 0x870) ++ PHY_SetBBReg(pAdapter, BB_REG[index], bMaskDWord, BB_backup[index]|BIT10|BIT26); ++ else ++ PHY_SetBBReg(pAdapter, BB_REG[index], BIT10, 0x0); ++ } ++ ++ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); ++ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); ++ } ++ else //path B ++ { ++ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_B, bMaskDWord, 0x01008c00); ++ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_B, bMaskDWord, 0x01008c00); ++ ++ } ++ ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x800 %x\n", PHY_QueryBBReg(pAdapter, 0x800, bMaskDWord))); ++ ++ //MAC settings ++ phy_MACSettingCalibration(pAdapter, MAC_REG, MAC_backup); ++ ++ if(path == RF_PATH_A) //Path B to standby mode ++ { ++ PHY_SetRFReg(pAdapter, RF_PATH_B, RF_AC, bRFRegOffsetMask, 0x10000); ++ } ++ else //Path A to standby mode ++ { ++ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_AC, bRFRegOffsetMask, 0x10000); ++ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE1, bRFRegOffsetMask, 0x1000f); ++ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE2, bRFRegOffsetMask, 0x20103); ++ } ++ ++ delta_offset = ((delta+14)/2); ++ if(delta_offset < 0) ++ delta_offset = 0; ++ else if (delta_offset > 12) ++ delta_offset = 12; ++ ++ //AP calibration ++ for(index = 0; index < APK_BB_REG_NUM; index++) ++ { ++ if(index != 1) //only DO PA11+PAD01001, AP RF setting ++ continue; ++ ++ tmpReg = APK_RF_init_value[path][index]; ++#if 1 ++ if(!pHalData->bAPKThermalMeterIgnore) ++ { ++ BB_offset = (tmpReg & 0xF0000) >> 16; ++ ++ if(!(tmpReg & BIT15)) //sign bit 0 ++ { ++ BB_offset = -BB_offset; ++ } ++ ++ delta_V = APK_delta_mapping[index][delta_offset]; ++ ++ BB_offset += delta_V; ++ ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() APK index %d tmpReg 0x%x delta_V %d delta_offset %d\n", index, tmpReg, delta_V, delta_offset)); ++ ++ if(BB_offset < 0) ++ { ++ tmpReg = tmpReg & (~BIT15); ++ BB_offset = -BB_offset; ++ } ++ else ++ { ++ tmpReg = tmpReg | BIT15; ++ } ++ tmpReg = (tmpReg & 0xFFF0FFFF) | (BB_offset << 16); ++ } ++#endif ++ ++#if DEV_BUS_TYPE==RT_PCI_INTERFACE ++ if(IS_81xxC_VENDOR_UMC_B_CUT(pHalData->VersionID)) ++ PHY_SetRFReg(pAdapter, path, RF_IPA_A, bRFRegOffsetMask, 0x894ae); ++ else ++#endif ++ PHY_SetRFReg(pAdapter, path, RF_IPA_A, bRFRegOffsetMask, 0x8992e); ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xc %x\n", PHY_QueryRFReg(pAdapter, path, RF_IPA_A, bRFRegOffsetMask))); ++ PHY_SetRFReg(pAdapter, path, RF_AC, bRFRegOffsetMask, APK_RF_value_0[path][index]); ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x0 %x\n", PHY_QueryRFReg(pAdapter, path, RF_AC, bRFRegOffsetMask))); ++ PHY_SetRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask, tmpReg); ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xd %x\n", PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask))); ++ ++ // PA11+PAD01111, one shot ++ i = 0; ++ do ++ { ++ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x800000); ++ { ++ PHY_SetBBReg(pAdapter, APK_offset[path], bMaskDWord, APK_value[0]); ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", APK_offset[path], PHY_QueryBBReg(pAdapter, APK_offset[path], bMaskDWord))); ++ delay_ms(3); ++ PHY_SetBBReg(pAdapter, APK_offset[path], bMaskDWord, APK_value[1]); ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", APK_offset[path], PHY_QueryBBReg(pAdapter, APK_offset[path], bMaskDWord))); ++ ++ delay_ms(20); ++ } ++ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); ++ ++ if(path == RF_PATH_A) ++ tmpReg = PHY_QueryBBReg(pAdapter, rAPK, 0x03E00000); ++ else ++ tmpReg = PHY_QueryBBReg(pAdapter, rAPK, 0xF8000000); ++ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xbd8[25:21] %x\n", tmpReg)); ++ ++ ++ i++; ++ } ++ while(tmpReg > apkbound && i < 4); ++ ++ APK_result[path][index] = tmpReg; ++ } ++ } ++ ++ //reload MAC default value ++ phy_ReloadMACRegisters(pAdapter, MAC_REG, MAC_backup); ++ ++ //reload BB default value ++ for(index = 0; index < APK_BB_REG_NUM ; index++) ++ { ++ ++ if(index == 0) //skip ++ continue; ++ PHY_SetBBReg(pAdapter, BB_REG[index], bMaskDWord, BB_backup[index]); ++ } ++ ++ //reload AFE default value ++ phy_ReloadADDARegisters(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); ++ ++ //reload RF path default value ++ for(path = 0; path < pathbound; path++) ++ { ++ PHY_SetRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask, regD[path]); ++ if(path == RF_PATH_B) ++ { ++ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE1, bRFRegOffsetMask, 0x1000f); ++ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE2, bRFRegOffsetMask, 0x20101); ++ } ++ ++ //note no index == 0 ++ if (APK_result[path][1] > 6) ++ APK_result[path][1] = 6; ++ RTPRINT(FINIT, INIT_IQK, ("apk path %d result %d 0x%x \t", path, 1, APK_result[path][1])); ++ } ++ ++ RTPRINT(FINIT, INIT_IQK, ("\n")); ++ ++ ++ for(path = 0; path < pathbound; path++) ++ { ++ PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G1_G4, bRFRegOffsetMask, ++ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (APK_result[path][1] << 5) | APK_result[path][1])); ++ if(path == RF_PATH_A) ++ PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G5_G8, bRFRegOffsetMask, ++ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x00 << 5) | 0x05)); ++ else ++ PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G5_G8, bRFRegOffsetMask, ++ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x02 << 5) | 0x05)); ++ ++ PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G9_G11, bRFRegOffsetMask, ((0x08 << 15) | (0x08 << 10) | (0x08 << 5) | 0x08)); ++ } ++ ++ pHalData->bAPKdone = TRUE; ++ ++ RTPRINT(FINIT, INIT_IQK, ("<==phy_APCalibrate_8192C()\n")); ++} ++ ++ ++VOID ++PHY_IQCalibrate_8192C( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bReCovery ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ s4Byte result[4][8]; //last is final result ++ u1Byte i, final_candidate, Indexforchannel; ++ BOOLEAN bPathAOK, bPathBOK; ++ s4Byte RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC, RegTmp = 0; ++ BOOLEAN is12simular, is13simular, is23simular; ++ BOOLEAN bStartContTx = FALSE, bSingleTone = FALSE, bCarrierSuppression = FALSE; ++ u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { ++ rOFDM0_XARxIQImbalance, rOFDM0_XBRxIQImbalance, ++ rOFDM0_ECCAThreshold, rOFDM0_AGCRSSITable, ++ rOFDM0_XATxIQImbalance, rOFDM0_XBTxIQImbalance, ++ rOFDM0_XCTxAFE, rOFDM0_XDTxAFE, ++ rOFDM0_RxIQExtAnta}; ++ ++ if (ODM_CheckPowerStatus(pAdapter) == FALSE) ++ return; ++ ++#if MP_DRIVER == 1 ++ bStartContTx = pAdapter->MptCtx.bStartContTx; ++ bSingleTone = pAdapter->MptCtx.bSingleTone; ++ bCarrierSuppression = pAdapter->MptCtx.bCarrierSuppression; ++#endif ++ ++ //ignore IQK when continuous Tx ++ if(bStartContTx || bSingleTone || bCarrierSuppression) ++ return; ++ ++#ifdef DISABLE_BB_RF ++ return; ++#endif ++ if(pAdapter->bSlaveOfDMSP) ++ return; ++ ++ if (bReCovery) ++ { ++ phy_ReloadADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup_recover, 9); ++ return; ++ ++ } ++ ++ RTPRINT(FINIT, INIT_IQK, ("IQK:Start!!!\n")); ++ ++ for(i = 0; i < 8; i++) ++ { ++ result[0][i] = 0; ++ result[1][i] = 0; ++ result[2][i] = 0; ++ result[3][i] = 0; ++ } ++ final_candidate = 0xff; ++ bPathAOK = FALSE; ++ bPathBOK = FALSE; ++ is12simular = FALSE; ++ is23simular = FALSE; ++ is13simular = FALSE; ++ ++ AcquireCCKAndRWPageAControl(pAdapter); ++ /*RT_TRACE(COMP_INIT,DBG_LOUD,("Acquire Mutex in IQCalibrate\n"));*/ ++ for (i=0; i<3; i++) ++ { ++ /*For 88C 1T1R*/ ++ phy_IQCalibrate_8192C(pAdapter, result, i, FALSE); ++ ++ if(i == 1) ++ { ++ is12simular = phy_SimularityCompare(pAdapter, result, 0, 1); ++ if(is12simular) ++ { ++ final_candidate = 0; ++ break; ++ } ++ } ++ ++ if(i == 2) ++ { ++ is13simular = phy_SimularityCompare(pAdapter, result, 0, 2); ++ if(is13simular) ++ { ++ final_candidate = 0; ++ break; ++ } ++ ++ is23simular = phy_SimularityCompare(pAdapter, result, 1, 2); ++ if(is23simular) ++ final_candidate = 1; ++ else ++ { ++ for(i = 0; i < 8; i++) ++ RegTmp += result[3][i]; ++ ++ if(RegTmp != 0) ++ final_candidate = 3; ++ else ++ final_candidate = 0xFF; ++ } ++ } ++ } ++// RT_TRACE(COMP_INIT,DBG_LOUD,("Release Mutex in IQCalibrate \n")); ++ ReleaseCCKAndRWPageAControl(pAdapter); ++ ++ for (i=0; i<4; i++) ++ { ++ RegE94 = result[i][0]; ++ RegE9C = result[i][1]; ++ RegEA4 = result[i][2]; ++ RegEAC = result[i][3]; ++ RegEB4 = result[i][4]; ++ RegEBC = result[i][5]; ++ RegEC4 = result[i][6]; ++ RegECC = result[i][7]; ++ RTPRINT(FINIT, INIT_IQK, ("IQK: RegE94=%x RegE9C=%x RegEA4=%x RegEAC=%x RegEB4=%x RegEBC=%x RegEC4=%x RegECC=%x\n ", RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC)); ++ } ++ ++ if(final_candidate != 0xff) ++ { ++ pHalData->RegE94 = RegE94 = result[final_candidate][0]; ++ pHalData->RegE9C = RegE9C = result[final_candidate][1]; ++ RegEA4 = result[final_candidate][2]; ++ RegEAC = result[final_candidate][3]; ++ pHalData->RegEB4 = RegEB4 = result[final_candidate][4]; ++ pHalData->RegEBC = RegEBC = result[final_candidate][5]; ++ RegEC4 = result[final_candidate][6]; ++ RegECC = result[final_candidate][7]; ++ RTPRINT(FINIT, INIT_IQK, ("IQK: final_candidate is %x\n",final_candidate)); ++ RTPRINT(FINIT, INIT_IQK, ("IQK: RegE94=%x RegE9C=%x RegEA4=%x RegEAC=%x RegEB4=%x RegEBC=%x RegEC4=%x RegECC=%x\n ", RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC)); ++ bPathAOK = bPathBOK = TRUE; ++ } ++ else ++ { ++ RegE94 = RegEB4 = pHalData->RegE94 = pHalData->RegEB4 = 0x100; //X default value ++ RegE9C = RegEBC = pHalData->RegE9C = pHalData->RegEBC = 0x0; //Y default value ++ } ++ ++ if((RegE94 != 0)/*&&(RegEA4 != 0)*/) ++ { ++ if(pHalData->CurrentBandType == BAND_ON_5G) ++ phy_PathAFillIQKMatrix_5G_Normal(pAdapter, bPathAOK, result, final_candidate, (RegEA4 == 0)); ++ else ++ phy_PathAFillIQKMatrix(pAdapter, bPathAOK, result, final_candidate, (RegEA4 == 0)); ++ ++ } ++ ++ if (IS_92C_SERIAL(pHalData->VersionID) || IS_92D_SINGLEPHY(pHalData->VersionID)) ++ { ++ if((RegEB4 != 0)/*&&(RegEC4 != 0)*/) ++ { ++ if(pHalData->CurrentBandType == BAND_ON_5G) ++ phy_PathBFillIQKMatrix_5G_Normal(pAdapter, bPathBOK, result, final_candidate, (RegEC4 == 0)); ++ else ++ phy_PathBFillIQKMatrix(pAdapter, bPathBOK, result, final_candidate, (RegEC4 == 0)); ++ } ++ } ++ ++ phy_SaveADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup_recover, 9); ++ ++} ++ ++ ++VOID ++PHY_LCCalibrate_8192C( ++ IN PADAPTER pAdapter ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ BOOLEAN bStartContTx = FALSE, bSingleTone = FALSE, bCarrierSuppression = FALSE; ++ PMGNT_INFO pMgntInfo=&pAdapter->MgntInfo; ++ PMGNT_INFO pMgntInfoBuddyAdapter; ++ u4Byte timeout = 2000, timecount = 0; ++ PADAPTER BuddyAdapter = pAdapter->BuddyAdapter; ++ ++#if MP_DRIVER == 1 ++ bStartContTx = pAdapter->MptCtx.bStartContTx; ++ bSingleTone = pAdapter->MptCtx.bSingleTone; ++ bCarrierSuppression = pAdapter->MptCtx.bCarrierSuppression; ++#endif ++ ++#ifdef DISABLE_BB_RF ++ return; ++#endif ++ ++ //ignore LCK when continuous Tx ++ if(bStartContTx || bSingleTone || bCarrierSuppression) ++ return; ++ ++ if(BuddyAdapter != NULL && ++ ((pAdapter->interfaceIndex == 0 && pHalData->CurrentBandType == BAND_ON_2_4G) || ++ (pAdapter->interfaceIndex == 1 && pHalData->CurrentBandType == BAND_ON_5G))) ++ { ++ pMgntInfoBuddyAdapter=&BuddyAdapter->MgntInfo; ++ while(pMgntInfoBuddyAdapter->bScanInProgress && timecount < timeout) ++ { ++ delay_ms(50); ++ timecount += 50; ++ } ++ } ++ ++ while(pMgntInfo->bScanInProgress && timecount < timeout) ++ { ++ delay_ms(50); ++ timecount += 50; ++ } ++ ++ pHalData->bLCKInProgress = TRUE; ++ ++ RTPRINT(FINIT, INIT_IQK, ("LCK:Start!!!interface %d currentband %x delay %d ms\n", pAdapter->interfaceIndex, pHalData->CurrentBandType, timecount)); ++ ++ //if(IS_92C_SERIAL(pHalData->VersionID) || IS_92D_SINGLEPHY(pHalData->VersionID)) ++ if(IS_2T2R(pHalData->VersionID)) ++ { ++ phy_LCCalibrate(pAdapter, TRUE); ++ } ++ else{ ++ // For 88C 1T1R ++ phy_LCCalibrate(pAdapter, FALSE); ++ } ++ ++ pHalData->bLCKInProgress = FALSE; ++ ++ RTPRINT(FINIT, INIT_IQK, ("LCK:Finish!!!interface %d\n", pAdapter->interfaceIndex)); ++ ++ ++} ++ ++VOID ++PHY_APCalibrate_8192C( ++ IN PADAPTER pAdapter, ++ IN s1Byte delta ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ //default disable APK, because Tx NG issue, suggest by Jenyu, 2011.11.25 ++ return; ++ ++#ifdef DISABLE_BB_RF ++ return; ++#endif ++ ++#if FOR_BRAZIL_PRETEST != 1 ++ if(pHalData->bAPKdone) ++#endif ++ return; ++ ++ if(IS_92C_SERIAL( pHalData->VersionID)){ ++ phy_APCalibrate_8192C(pAdapter, delta, TRUE); ++ } ++ else{ ++ // For 88C 1T1R ++ phy_APCalibrate_8192C(pAdapter, delta, FALSE); ++ } ++} ++ ++ ++#endif ++ ++ ++//3============================================================ ++//3 IQ Calibration ++//3============================================================ ++ ++VOID ++ODM_ResetIQKResult( ++ IN PVOID pDM_VOID ++) ++{ ++ return; ++} ++#if 1//!(DM_ODM_SUPPORT_TYPE & ODM_AP) ++u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) ++{ ++ u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = ++ {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; ++ u1Byte place = chnl; ++ ++ ++ if(chnl > 14) ++ { ++ for(place = 14; placeAdapter; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if (*pDM_Odm->pIsFcsModeEnable) ++ return; ++#endif ++ ++ ++ ++ if (pDM_Odm->bLinked) { ++ if ((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) { ++ pDM_Odm->preChannel = *pDM_Odm->pChannel; ++ pDM_Odm->LinkedInterval = 0; ++ } ++ ++ if (pDM_Odm->LinkedInterval < 3) ++ pDM_Odm->LinkedInterval++; ++ ++ if (pDM_Odm->LinkedInterval == 2) { ++ ++ #if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8814A) ++ PHY_IQCalibrate_8814A(pDM_Odm, FALSE); ++ #endif ++ ++ #if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) ++ PHY_IQCalibrate_8822B(pDM_Odm, FALSE); ++ #endif ++ ++ #if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ PHY_IQCalibrate_8821C(pDM_Odm, FALSE); ++ #endif ++ ++ #if (RTL8821A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821) ++ PHY_IQCalibrate_8821A(pDM_Odm, FALSE); ++ #endif ++ ++ #if (RTL8812A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ phy_IQCalibrate_8812A(pDM_Odm, FALSE); ++ #endif ++ } ++ } else ++ pDM_Odm->LinkedInterval = 0; ++ ++} ++ ++void phydm_rf_init(IN PVOID pDM_VOID) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ odm_TXPowerTrackingInit(pDM_Odm); ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ ODM_ClearTxPowerTrackingState(pDM_Odm); ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++#if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ PHY_IQCalibrate_8814A_Init(pDM_Odm); ++#endif ++#endif ++ ++} ++ ++void phydm_rf_watchdog(IN PVOID pDM_VOID) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ ODM_TXPowerTrackingCheck(pDM_Odm); ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ odm_IQCalibrate(pDM_Odm); ++#endif ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.h 2018-02-11 21:44:27.153146177 +0200 +@@ -0,0 +1,179 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ #ifndef __HAL_PHY_RF_H__ ++ #define __HAL_PHY_RF_H__ ++ ++#include "phydm_powertracking_ap.h" ++#if (RTL8814A_SUPPORT == 1) ++#include "rtl8814a/phydm_iqk_8814a.h" ++#endif ++ ++#if (RTL8822B_SUPPORT == 1) ++#include "rtl8822b/phydm_iqk_8822b.h" ++#endif ++ ++#if (RTL8821C_SUPPORT == 1) ++#include "rtl8822b/phydm_iqk_8821c.h" ++#endif ++ ++typedef enum _PWRTRACK_CONTROL_METHOD { ++ BBSWING, ++ TXAGC, ++ MIX_MODE, ++ TSSI_MODE ++} PWRTRACK_METHOD; ++ ++typedef VOID (*FuncSetPwr)(PVOID, PWRTRACK_METHOD, u1Byte, u1Byte); ++typedef VOID(*FuncIQK)(PVOID, u1Byte, u1Byte, u1Byte); ++typedef VOID (*FuncLCK)(PVOID); ++ //refine by YuChen for 8814A ++typedef VOID (*FuncSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); ++typedef VOID (*FuncSwing8814only)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); ++typedef VOID (*FuncAllSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); ++ ++ ++typedef struct _TXPWRTRACK_CFG { ++ u1Byte SwingTableSize_CCK; ++ u1Byte SwingTableSize_OFDM; ++ u1Byte Threshold_IQK; ++ u1Byte Threshold_DPK; ++ u1Byte AverageThermalNum; ++ u1Byte RfPathCount; ++ u4Byte ThermalRegAddr; ++ FuncSetPwr ODM_TxPwrTrackSetPwr; ++ FuncIQK DoIQK; ++ FuncLCK PHY_LCCalibrate; ++ FuncSwing GetDeltaSwingTable; ++ FuncSwing8814only GetDeltaSwingTable8814only; ++ FuncAllSwing GetDeltaAllSwingTable; ++} TXPWRTRACK_CFG, *PTXPWRTRACK_CFG; ++ ++VOID ++ConfigureTxpowerTrack( ++ IN PVOID pDM_VOID, ++ OUT PTXPWRTRACK_CFG pConfig ++ ); ++ ++ ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PVOID pDM_VOID ++#else ++ IN PADAPTER Adapter ++#endif ++ ); ++ ++#if (RTL8192E_SUPPORT==1) ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter_92E( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PVOID pDM_VOID ++#else ++ IN PADAPTER Adapter ++#endif ++ ); ++#endif ++ ++#if (RTL8814A_SUPPORT == 1) ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries2( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PVOID pDM_VOID ++#else ++ IN PADAPTER Adapter ++#endif ++ ); ++ ++#elif ODM_IC_11AC_SERIES_SUPPORT ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PVOID pDM_VOID ++#else ++ IN PADAPTER Adapter ++#endif ++ ); ++ ++#elif (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries3( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PVOID pDM_VOID ++#else ++ IN PADAPTER Adapter ++#endif ++ ); ++ ++#endif ++ ++#define IS_CCK_RATE(_rate) (ODM_MGN_1M == _rate || _rate == ODM_MGN_2M || _rate == ODM_MGN_5_5M || _rate == ODM_MGN_11M ) ++ ++ ++#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++#define MAX_TOLERANCE 5 ++#define IQK_DELAY_TIME 1 //ms ++ ++ // ++// BB/MAC/RF other monitor API ++// ++ ++void PHY_SetMonitorMode8192C(IN PADAPTER pAdapter, ++ IN BOOLEAN bEnableMonitorMode ); ++ ++// ++// IQ calibrate ++// ++void ++PHY_IQCalibrate_8192C( IN PADAPTER pAdapter, ++ IN BOOLEAN bReCovery); ++ ++// ++// LC calibrate ++// ++void ++PHY_LCCalibrate_8192C( IN PADAPTER pAdapter); ++ ++// ++// AP calibrate ++// ++void ++PHY_APCalibrate_8192C( IN PADAPTER pAdapter, ++ IN s1Byte delta); ++#endif ++ ++#define ODM_TARGET_CHNL_NUM_2G_5G 59 ++ ++ ++VOID ++ODM_ResetIQKResult( ++ IN PVOID pDM_VOID ++); ++u1Byte ++ODM_GetRightChnlPlaceforIQK( ++ IN u1Byte chnl ++); ++ ++void phydm_rf_init(IN PVOID pDM_VOID); ++void phydm_rf_watchdog(IN PVOID pDM_VOID); ++ ++#endif // #ifndef __HAL_PHY_RF_H__ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.c 2018-02-11 21:44:27.153146177 +0200 +@@ -0,0 +1,807 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ ++ do {\ ++ for(_offset = 0; _offset < _size; _offset++)\ ++ {\ ++ if(_deltaThermal < thermalThreshold[_direction][_offset])\ ++ {\ ++ if(_offset != 0)\ ++ _offset--;\ ++ break;\ ++ }\ ++ } \ ++ if(_offset >= _size)\ ++ _offset = _size-1;\ ++ } while(0) ++ ++void ConfigureTxpowerTrack( ++ IN PVOID pDM_VOID, ++ OUT PTXPWRTRACK_CFG pConfig ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++#if RTL8192E_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8192E) ++ ConfigureTxpowerTrack_8192E(pConfig); ++#endif ++#if RTL8821A_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8821) ++ ConfigureTxpowerTrack_8821A(pConfig); ++#endif ++#if RTL8812A_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ ConfigureTxpowerTrack_8812A(pConfig); ++#endif ++#if RTL8188E_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) ++ ConfigureTxpowerTrack_8188E(pConfig); ++#endif ++ ++#if RTL8723B_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8723B) ++ ConfigureTxpowerTrack_8723B(pConfig); ++#endif ++ ++#if RTL8814A_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8814A) ++ ConfigureTxpowerTrack_8814A(pConfig); ++#endif ++ ++#if RTL8703B_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8703B) ++ ConfigureTxpowerTrack_8703B(pConfig); ++#endif ++ ++#if RTL8188F_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8188F) ++ ConfigureTxpowerTrack_8188F(pConfig); ++#endif ++#if RTL8723D_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8723D) ++ ConfigureTxpowerTrack_8723D(pConfig); ++#endif ++#if RTL8822B_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) ++ ConfigureTxpowerTrack_8822B(pConfig); ++#endif ++#if RTL8821C_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ ConfigureTxpowerTrack_8821C(pConfig); ++#endif ++ ++} ++ ++//====================================================================== ++// <20121113, Kordan> This function should be called when TxAGC changed. ++// Otherwise the previous compensation is gone, because we record the ++// delta of temperature between two TxPowerTracking watch dogs. ++// ++// NOTE: If Tx BB swing or Tx scaling is varified during run-time, still ++// need to call this function. ++//====================================================================== ++VOID ++ODM_ClearTxPowerTrackingState( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDM_Odm->Adapter); ++ u1Byte p = 0; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; ++ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->DefaultCckIndex; ++ pDM_Odm->RFCalibrateInfo.CCK_index = 0; ++ ++ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) ++ { ++ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; ++ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->DefaultOfdmIndex; ++ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; ++ ++ pRFCalibrateInfo->PowerIndexOffset[p] = 0; ++ pRFCalibrateInfo->DeltaPowerIndex[p] = 0; ++ pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; ++ ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = 0; /* Initial Mix mode power tracking*/ ++ pRFCalibrateInfo->Remnant_OFDMSwingIdx[p] = 0; ++ pRFCalibrateInfo->KfreeOffset[p] = 0; ++ } ++ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; /*Initial at Modify Tx Scaling Mode*/ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = FALSE; /*Initial at Modify Tx Scaling Mode*/ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathC = FALSE; /*Initial at Modify Tx Scaling Mode*/ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathD = FALSE; /*Initial at Modify Tx Scaling Mode*/ ++ pRFCalibrateInfo->Remnant_CCKSwingIdx = 0; ++ pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; ++ ++ pRFCalibrateInfo->Modify_TxAGC_Value_CCK=0; //modify by Mingzhi.Guo ++ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM=0; //modify by Mingzhi.Guo ++ ++} ++ ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm ++#else ++ IN PADAPTER Adapter ++#endif ++ ) ++{ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++#endif ++ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; ++ s1Byte diff_DPK[4] = {0}; ++ u1Byte ThermalValue_AVG_count = 0; ++ u4Byte ThermalValue_AVG = 0, RegC80, RegCd0, RegCd4, Regab4; ++ ++ u1Byte OFDM_min_index = 0; // OFDM BB Swing should be less than +3.0dB, which is required by Arthur ++ u1Byte Indexforchannel = 0; // GetRightChnlPlaceforIQK(pHalData->CurrentChannel) ++ u1Byte PowerTrackingType = pHalData->RfPowerTrackingType; ++ u1Byte XtalOffsetEanble = 0; ++ ++ TXPWRTRACK_CFG c; ++ ++ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. ++ pu1Byte deltaSwingTableIdx_TUP_A = NULL; ++ pu1Byte deltaSwingTableIdx_TDOWN_A = NULL; ++ pu1Byte deltaSwingTableIdx_TUP_B = NULL; ++ pu1Byte deltaSwingTableIdx_TDOWN_B = NULL; ++ /*for 8814 add by Yu Chen*/ ++ pu1Byte deltaSwingTableIdx_TUP_C = NULL; ++ pu1Byte deltaSwingTableIdx_TDOWN_C = NULL; ++ pu1Byte deltaSwingTableIdx_TUP_D = NULL; ++ pu1Byte deltaSwingTableIdx_TDOWN_D = NULL; ++ /*for Xtal Offset by James.Tung*/ ++ ps1Byte deltaSwingTableXtal_UP = NULL; ++ ps1Byte deltaSwingTableXtal_DOWN = NULL; ++ ++ //4 2. Initilization ( 7 steps in total ) ++ ++ ConfigureTxpowerTrack(pDM_Odm, &c); ++ ++ (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_A, (pu1Byte *)&deltaSwingTableIdx_TDOWN_A, ++ (pu1Byte *)&deltaSwingTableIdx_TUP_B, (pu1Byte *)&deltaSwingTableIdx_TDOWN_B); ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) /*for 8814 path C & D*/ ++ (*c.GetDeltaSwingTable8814only)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_C, (pu1Byte *)&deltaSwingTableIdx_TDOWN_C, ++ (pu1Byte *)&deltaSwingTableIdx_TUP_D, (pu1Byte *)&deltaSwingTableIdx_TDOWN_D); ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) /*for Xtal Offset*/ ++ (*c.GetDeltaSwingXtalTable)(pDM_Odm, (ps1Byte *)&deltaSwingTableXtal_UP, (ps1Byte *)&deltaSwingTableXtal_DOWN); ++ ++ pRFCalibrateInfo->TXPowerTrackingCallbackCnt++; /*cosa add for debug*/ ++ pRFCalibrateInfo->bTXPowerTrackingInit = TRUE; ++ ++ /*pRFCalibrateInfo->TxPowerTrackControl = pHalData->TxPowerTrackControl; ++ We should keep updating the control variable according to HalData. ++ RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. */ ++ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ #if (MP_DRIVER == 1) ++ pRFCalibrateInfo->RegA24 = 0x090e1317; ++ #endif ++ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ if (pDM_Odm->mp_mode == TRUE) ++ pRFCalibrateInfo->RegA24 = 0x090e1317; ++ #endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("===>ODM_TXPowerTrackingCallback_ThermalMeter\n pRFCalibrateInfo->BbSwingIdxCckBase: %d, pRFCalibrateInfo->BbSwingIdxOfdmBase[A]: %d, pRFCalibrateInfo->DefaultOfdmIndex: %d\n", ++ pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_A], pRFCalibrateInfo->DefaultOfdmIndex)); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("pRFCalibrateInfo->TxPowerTrackControl=%d, pHalData->EEPROMThermalMeter %d\n", pRFCalibrateInfo->TxPowerTrackControl, pHalData->EEPROMThermalMeter)); ++ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E ++ ++ /*add log by zhao he, check c80/c94/c14/ca0 value*/ ++ if (pDM_Odm->SupportICType == ODM_RTL8723D) { ++ RegC80 = ODM_GetBBReg(pDM_Odm, 0xc80, bMaskDWord); ++ RegCd0 = ODM_GetBBReg(pDM_Odm, 0xcd0, bMaskDWord); ++ RegCd4 = ODM_GetBBReg(pDM_Odm, 0xcd4, bMaskDWord); ++ Regab4 = ODM_GetBBReg(pDM_Odm, 0xab4, 0x000007FF); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", RegC80, RegCd0, RegCd4, Regab4)); ++ } ++ ++ if (!pRFCalibrateInfo->TxPowerTrackControl) ++ return; ++ ++ ++ /*4 3. Initialize ThermalValues of RFCalibrateInfo*/ ++ ++ if (pRFCalibrateInfo->bReloadtxpowerindex) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); ++ ++ /*4 4. Calculate average thermal meter*/ ++ ++ pRFCalibrateInfo->ThermalValue_AVG[pRFCalibrateInfo->ThermalValue_AVG_index] = ThermalValue; ++ pRFCalibrateInfo->ThermalValue_AVG_index++; ++ if (pRFCalibrateInfo->ThermalValue_AVG_index == c.AverageThermalNum) /*Average times = c.AverageThermalNum*/ ++ pRFCalibrateInfo->ThermalValue_AVG_index = 0; ++ ++ for(i = 0; i < c.AverageThermalNum; i++) ++ { ++ if (pRFCalibrateInfo->ThermalValue_AVG[i]) { ++ ThermalValue_AVG += pRFCalibrateInfo->ThermalValue_AVG[i]; ++ ThermalValue_AVG_count++; ++ } ++ } ++ ++ if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times ++ { ++ ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("AVG Thermal Meter = 0x%X, EFUSE Thermal Base = 0x%X\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ } ++ ++ //4 5. Calculate delta, delta_LCK, delta_IQK. ++ ++ //"delta" here is used to determine whether thermal value changes or not. ++ delta = (ThermalValue > pRFCalibrateInfo->ThermalValue)?(ThermalValue - pRFCalibrateInfo->ThermalValue):(pRFCalibrateInfo->ThermalValue - ThermalValue); ++ delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); ++ delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); ++ ++ if (pRFCalibrateInfo->ThermalValue_IQK == 0xff) { /*no PG, use thermal value for IQK*/ ++ pRFCalibrateInfo->ThermalValue_IQK = ThermalValue; ++ delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, use ThermalValue for IQK\n")); ++ } ++ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ diff_DPK[p] = (s1Byte)ThermalValue - (s1Byte)pRFCalibrateInfo->DpkThermal[p]; ++ ++ /*4 6. If necessary, do LCK.*/ ++ ++ if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { /*no PG , do LCK at initial status*/ ++ if (pRFCalibrateInfo->ThermalValue_LCK == 0xff) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, do LCK\n")); ++ pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; ++ ++ /*Use RTLCK, so close power tracking driver LCK*/ ++ if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { ++ if (c.PHY_LCCalibrate) ++ (*c.PHY_LCCalibrate)(pDM_Odm); ++ } ++ ++ delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK)); ++ ++ /* Delta temperature is equal to or larger than 20 centigrade.*/ ++ if (delta_LCK >= c.Threshold_IQK) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); ++ pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; ++ ++ /*Use RTLCK, so close power tracking driver LCK*/ ++ if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { ++ if (c.PHY_LCCalibrate) ++ (*c.PHY_LCCalibrate)(pDM_Odm); ++ } ++ } ++ } ++ ++ /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ ++ ++ if (delta > 0 && pRFCalibrateInfo->TxPowerTrackControl) ++ { ++ //"delta" here is used to record the absolute value of differrence. ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); ++#else ++ delta = (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther)?(ThermalValue - pDM_Odm->priv->pmib->dot11RFEntry.ther):(pDM_Odm->priv->pmib->dot11RFEntry.ther - ThermalValue); ++#endif ++ if (delta >= TXPWR_TRACK_TABLE_SIZE) ++ delta = TXPWR_TRACK_TABLE_SIZE - 1; ++ ++ /*4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset*/ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ if(ThermalValue > pHalData->EEPROMThermalMeter) { ++#else ++ if(ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { ++#endif ++ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; /*recording poer index offset*/ ++ switch (p) { ++ case ODM_RF_PATH_B: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); ++ ++ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_B[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_C: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta])); ++ ++ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_C[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_D: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta])); ++ ++ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_D[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ default: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); ++ ++ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_A[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ } ++ } ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) { ++ /*Save XtalOffset from Xtal table*/ ++ pRFCalibrateInfo->XtalOffsetLast = pRFCalibrateInfo->XtalOffset; /*recording last Xtal offset*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("[Xtal] deltaSwingTableXtal_UP[%d] = %d\n", delta, deltaSwingTableXtal_UP[delta])); ++ pRFCalibrateInfo->XtalOffset = deltaSwingTableXtal_UP[delta]; ++ ++ if (pRFCalibrateInfo->XtalOffsetLast == pRFCalibrateInfo->XtalOffset) ++ XtalOffsetEanble = 0; ++ else ++ XtalOffsetEanble = 1; ++ } ++ ++ } else { ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; /*recording poer index offset*/ ++ ++ switch (p) { ++ case ODM_RF_PATH_B: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); ++ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_C: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta])); ++ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_D: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta])); ++ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ default: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); ++ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ } ++ } ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) { ++ /*Save XtalOffset from Xtal table*/ ++ pRFCalibrateInfo->XtalOffsetLast = pRFCalibrateInfo->XtalOffset; /*recording last Xtal offset*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("[Xtal] deltaSwingTableXtal_DOWN[%d] = %d\n", delta, deltaSwingTableXtal_DOWN[delta])); ++ pRFCalibrateInfo->XtalOffset = deltaSwingTableXtal_DOWN[delta]; ++ ++ if (pRFCalibrateInfo->XtalOffsetLast == pRFCalibrateInfo->XtalOffset) ++ XtalOffsetEanble = 0; ++ else ++ XtalOffsetEanble = 1; ++ } ++ ++ } ++ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("\n\n=========================== [Path-%d] Calculating PowerIndexOffset===========================\n", p)); ++ ++ if (pRFCalibrateInfo->DeltaPowerIndex[p] == pRFCalibrateInfo->DeltaPowerIndexLast[p]) /*If Thermal value changes but lookup table value still the same*/ ++ pRFCalibrateInfo->PowerIndexOffset[p] = 0; ++ else ++ pRFCalibrateInfo->PowerIndexOffset[p] = pRFCalibrateInfo->DeltaPowerIndex[p] - pRFCalibrateInfo->DeltaPowerIndexLast[p]; /*Power Index Diff between 2 times Power Tracking*/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("[Path-%d] PowerIndexOffset(%d) = DeltaPowerIndex(%d) - DeltaPowerIndexLast(%d)\n", p, pRFCalibrateInfo->PowerIndexOffset[p], pRFCalibrateInfo->DeltaPowerIndex[p], pRFCalibrateInfo->DeltaPowerIndexLast[p])); ++ ++ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->BbSwingIdxOfdmBase[p] + pRFCalibrateInfo->PowerIndexOffset[p]; ++ pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->BbSwingIdxCckBase + pRFCalibrateInfo->PowerIndexOffset[p]; ++ ++ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->CCK_index; ++ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->OFDM_index[p]; ++ ++ /*************Print BB Swing Base and Index Offset*************/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxCck, pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->PowerIndexOffset[p])); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("The 'OFDM' final index(%d) = BaseIndex[%d](%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxOfdm[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p], pRFCalibrateInfo->PowerIndexOffset[p])); ++ ++ /*4 7.1 Handle boundary conditions of index.*/ ++ ++ if (pRFCalibrateInfo->OFDM_index[p] > c.SwingTableSize_OFDM-1) ++ pRFCalibrateInfo->OFDM_index[p] = c.SwingTableSize_OFDM-1; ++ else if (pRFCalibrateInfo->OFDM_index[p] <= OFDM_min_index) ++ pRFCalibrateInfo->OFDM_index[p] = OFDM_min_index; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("\n\n========================================================================================================\n")); ++ ++ if (pRFCalibrateInfo->CCK_index > c.SwingTableSize_CCK-1) ++ pRFCalibrateInfo->CCK_index = c.SwingTableSize_CCK-1; ++ else if (pRFCalibrateInfo->CCK_index <= 0) ++ pRFCalibrateInfo->CCK_index = 0; ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("The thermal meter is unchanged or TxPowerTracking OFF(%d): ThermalValue: %d , pRFCalibrateInfo->ThermalValue: %d\n", ++ pRFCalibrateInfo->TxPowerTrackControl, ThermalValue, pRFCalibrateInfo->ThermalValue)); ++ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ pRFCalibrateInfo->PowerIndexOffset[p] = 0; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", ++ pRFCalibrateInfo->CCK_index, pRFCalibrateInfo->BbSwingIdxCckBase)); /*Print Swing base & current*/ ++ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index[%d]: %d\n", ++ pRFCalibrateInfo->OFDM_index[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p])); ++ } ++ ++ if ((pDM_Odm->SupportICType & ODM_RTL8814A)) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("PowerTrackingType=%d\n", PowerTrackingType)); ++ ++ if (PowerTrackingType == 0) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); ++ } else if (PowerTrackingType == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(2G) TSSI(5G) MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_2G_TSSI_5G_MODE, p, 0); ++ } else if (PowerTrackingType == 2) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(5G) TSSI(2G)MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_5G_TSSI_2G_MODE, p, 0); ++ } else if (PowerTrackingType == 3) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking TSSI MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TSSI_MODE, p, 0); ++ } ++ pRFCalibrateInfo->ThermalValue = ThermalValue; /*Record last Power Tracking Thermal Value*/ ++ ++ } else if ((pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_A] != 0 || ++ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_B] != 0 || ++ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_C] != 0 || ++ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_D] != 0) && ++ pRFCalibrateInfo->TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) { ++ //4 7.2 Configure the Swing Table to adjust Tx Power. ++ ++ pRFCalibrateInfo->bTxPowerChanged = TRUE; /*Always TRUE after Tx Power is adjusted by power tracking.*/ ++ // ++ // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital ++ // to increase TX power. Otherwise, EVM will be bad. ++ // ++ // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. ++ if (ThermalValue > pRFCalibrateInfo->ThermalValue) { ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature Increasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", ++ p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); ++ } ++ } else if (ThermalValue < pRFCalibrateInfo->ThermalValue) { /*Low temperature*/ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature Decreasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", ++ p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); ++ } ++ } ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ if (ThermalValue > pHalData->EEPROMThermalMeter) ++#else ++ if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) ++#endif ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || ++ pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || ++ pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8822B || ++ pDM_Odm->SupportICType == ODM_RTL8723D || pDM_Odm->SupportICType == ODM_RTL8821C) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); ++ } ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || ++ pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || ++ pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8822B || ++ pDM_Odm->SupportICType == ODM_RTL8723D || pDM_Odm->SupportICType == ODM_RTL8821C) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); ++ } ++ ++ } ++ ++ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->BbSwingIdxCck; /*Record last time Power Tracking result as base.*/ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->BbSwingIdxOfdm[p]; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("pRFCalibrateInfo->ThermalValue = %d ThermalValue= %d\n", pRFCalibrateInfo->ThermalValue, ThermalValue)); ++ ++ pRFCalibrateInfo->ThermalValue = ThermalValue; /*Record last Power Tracking Thermal Value*/ ++ ++ } ++ ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8723D) { ++ ++ if (XtalOffsetEanble != 0 && pRFCalibrateInfo->TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter Xtal Tracking**********\n")); ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ if (ThermalValue > pHalData->EEPROMThermalMeter) { ++#else ++ if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { ++#endif ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ (*c.ODM_TxXtalTrackSetXtal)(pDM_Odm); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ (*c.ODM_TxXtalTrackSetXtal)(pDM_Odm); ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********End Xtal Tracking**********\n")); ++ } ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ ++ if (!IS_HARDWARE_TYPE_8723B(Adapter)) { ++ /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ ++ if (delta_IQK >= c.Threshold_IQK) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= Threshold_IQK(%d)\n", delta_IQK, c.Threshold_IQK)); ++ if (!pRFCalibrateInfo->bIQKInProgress) ++ (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); ++ } ++ } ++ if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_A] != 0) { ++ if (diff_DPK[ODM_RF_PATH_A] >= c.Threshold_DPK) { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK)); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); ++ } else if ((diff_DPK[ODM_RF_PATH_A] <= -1 * c.Threshold_DPK)) { ++ s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK); ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, value); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); ++ } else { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); ++ } ++ } ++ if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_B] != 0) { ++ if (diff_DPK[ODM_RF_PATH_B] >= c.Threshold_DPK) { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK)); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); ++ } else if ((diff_DPK[ODM_RF_PATH_B] <= -1 * c.Threshold_DPK)) { ++ s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK); ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, value); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); ++ } else { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); ++ } ++ } ++ ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("<===ODM_TXPowerTrackingCallback_ThermalMeter\n")); ++ ++ pRFCalibrateInfo->TXPowercount = 0; ++} ++ ++ ++ ++//3============================================================ ++//3 IQ Calibration ++//3============================================================ ++ ++VOID ++ODM_ResetIQKResult( ++ IN PVOID pDM_VOID ++) ++{ ++ return; ++} ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) ++{ ++ u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = ++ {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; ++ u1Byte place = chnl; ++ ++ ++ if(chnl > 14) ++ { ++ for(place = 14; placeAdapter; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if (*pDM_Odm->pIsFcsModeEnable) ++ return; ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++ if (IS_HARDWARE_TYPE_8812AU(Adapter)) ++ return; ++#endif ++ ++ if (pDM_Odm->bLinked) { ++ if ((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) { ++ pDM_Odm->preChannel = *pDM_Odm->pChannel; ++ pDM_Odm->LinkedInterval = 0; ++ } ++ ++ if (pDM_Odm->LinkedInterval < 3) ++ pDM_Odm->LinkedInterval++; ++ ++ if (pDM_Odm->LinkedInterval == 2) { ++ if (IS_HARDWARE_TYPE_8814A(Adapter)) { ++ #if (RTL8814A_SUPPORT == 1) ++ PHY_IQCalibrate_8814A(pDM_Odm, FALSE); ++ #endif ++ } ++ ++ #if (RTL8822B_SUPPORT == 1) ++ else if (IS_HARDWARE_TYPE_8822B(Adapter)) ++ PHY_IQCalibrate_8822B(pDM_Odm, FALSE); ++ #endif ++ ++ #if (RTL8821C_SUPPORT == 1) ++ else if (IS_HARDWARE_TYPE_8821C(Adapter)) ++ PHY_IQCalibrate_8821C(pDM_Odm, FALSE); ++ #endif ++ ++ #if (RTL8821A_SUPPORT == 1) ++ else if (IS_HARDWARE_TYPE_8821(Adapter)) ++ PHY_IQCalibrate_8821A(pDM_Odm, FALSE); ++ #endif ++ } ++ } else ++ pDM_Odm->LinkedInterval = 0; ++} ++ ++void phydm_rf_init(IN PVOID pDM_VOID) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ odm_TXPowerTrackingInit(pDM_Odm); ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ ODM_ClearTxPowerTrackingState(pDM_Odm); ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++#if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ PHY_IQCalibrate_8814A_Init(pDM_Odm); ++#endif ++#endif ++ ++} ++ ++void phydm_rf_watchdog(IN PVOID pDM_VOID) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ ODM_TXPowerTrackingCheck(pDM_Odm); ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ odm_IQCalibrate(pDM_Odm); ++#endif ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.h 2018-02-11 21:44:27.153146177 +0200 +@@ -0,0 +1,118 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ #ifndef __HAL_PHY_RF_H__ ++ #define __HAL_PHY_RF_H__ ++ ++#include "phydm_kfree.h" ++#if (RTL8814A_SUPPORT == 1) ++#include "rtl8814a/phydm_iqk_8814a.h" ++#endif ++ ++#if (RTL8822B_SUPPORT == 1) ++#include "rtl8822b/phydm_iqk_8822b.h" ++#endif ++ ++#if (RTL8821C_SUPPORT == 1) ++#include "rtl8821c/phydm_iqk_8821c.h" ++#endif ++ ++#include "phydm_powertracking_ce.h" ++ ++ ++typedef enum _SPUR_CAL_METHOD { ++ PLL_RESET, ++ AFE_PHASE_SEL ++} SPUR_CAL_METHOD; ++ ++typedef enum _PWRTRACK_CONTROL_METHOD { ++ BBSWING, ++ TXAGC, ++ MIX_MODE, ++ TSSI_MODE, ++ MIX_2G_TSSI_5G_MODE, ++ MIX_5G_TSSI_2G_MODE ++} PWRTRACK_METHOD; ++ ++typedef VOID (*FuncSetPwr)(PVOID, PWRTRACK_METHOD, u1Byte, u1Byte); ++typedef VOID(*FuncIQK)(PVOID, u1Byte, u1Byte, u1Byte); ++typedef VOID (*FuncLCK)(PVOID); ++typedef VOID (*FuncSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); ++typedef VOID (*FuncSwing8814only)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); ++typedef VOID(*FuncSwingXtal)(PVOID, ps1Byte*, ps1Byte*); ++typedef VOID(*FuncSetXtal)(PVOID); ++ ++typedef struct _TXPWRTRACK_CFG { ++ u1Byte SwingTableSize_CCK; ++ u1Byte SwingTableSize_OFDM; ++ u1Byte Threshold_IQK; ++ u1Byte Threshold_DPK; ++ u1Byte AverageThermalNum; ++ u1Byte RfPathCount; ++ u4Byte ThermalRegAddr; ++ FuncSetPwr ODM_TxPwrTrackSetPwr; ++ FuncIQK DoIQK; ++ FuncLCK PHY_LCCalibrate; ++ FuncSwing GetDeltaSwingTable; ++ FuncSwing8814only GetDeltaSwingTable8814only; ++ FuncSwingXtal GetDeltaSwingXtalTable; ++ FuncSetXtal ODM_TxXtalTrackSetXtal; ++} TXPWRTRACK_CFG, *PTXPWRTRACK_CFG; ++ ++VOID ++ConfigureTxpowerTrack( ++ IN PVOID pDM_VOID, ++ OUT PTXPWRTRACK_CFG pConfig ++ ); ++ ++ ++VOID ++ODM_ClearTxPowerTrackingState( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PVOID pDM_VOID ++#else ++ IN PADAPTER Adapter ++#endif ++ ); ++ ++ ++ ++#define ODM_TARGET_CHNL_NUM_2G_5G 59 ++ ++ ++VOID ++ODM_ResetIQKResult( ++ IN PVOID pDM_VOID ++); ++u1Byte ++ODM_GetRightChnlPlaceforIQK( ++ IN u1Byte chnl ++); ++ ++void phydm_rf_init( IN PVOID pDM_VOID); ++void phydm_rf_watchdog( IN PVOID pDM_VOID); ++ ++#endif // #ifndef __HAL_PHY_RF_H__ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_win.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_win.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_win.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_win.c 2018-02-11 21:44:27.153146177 +0200 +@@ -0,0 +1,792 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ ++ do {\ ++ for(_offset = 0; _offset < _size; _offset++)\ ++ {\ ++ if(_deltaThermal < thermalThreshold[_direction][_offset])\ ++ {\ ++ if(_offset != 0)\ ++ _offset--;\ ++ break;\ ++ }\ ++ } \ ++ if(_offset >= _size)\ ++ _offset = _size-1;\ ++ } while(0) ++ ++void ConfigureTxpowerTrack( ++ IN PDM_ODM_T pDM_Odm, ++ OUT PTXPWRTRACK_CFG pConfig ++ ) ++{ ++#if RTL8192E_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8192E) ++ ConfigureTxpowerTrack_8192E(pConfig); ++#endif ++#if RTL8821A_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8821) ++ ConfigureTxpowerTrack_8821A(pConfig); ++#endif ++#if RTL8812A_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ ConfigureTxpowerTrack_8812A(pConfig); ++#endif ++#if RTL8188E_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) ++ ConfigureTxpowerTrack_8188E(pConfig); ++#endif ++ ++#if RTL8188F_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8188F) ++ ConfigureTxpowerTrack_8188F(pConfig); ++#endif ++ ++#if RTL8723B_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8723B) ++ ConfigureTxpowerTrack_8723B(pConfig); ++#endif ++ ++#if RTL8814A_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8814A) ++ ConfigureTxpowerTrack_8814A(pConfig); ++#endif ++ ++#if RTL8703B_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8703B) ++ ConfigureTxpowerTrack_8703B(pConfig); ++#endif ++ ++#if RTL8822B_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) ++ ConfigureTxpowerTrack_8822B(pConfig); ++#endif ++ ++#if RTL8723D_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8723D) ++ ConfigureTxpowerTrack_8723D(pConfig); ++#endif ++ ++#if RTL8821C_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ ConfigureTxpowerTrack_8821C(pConfig); ++#endif ++ ++} ++ ++//====================================================================== ++// <20121113, Kordan> This function should be called when TxAGC changed. ++// Otherwise the previous compensation is gone, because we record the ++// delta of temperature between two TxPowerTracking watch dogs. ++// ++// NOTE: If Tx BB swing or Tx scaling is varified during run-time, still ++// need to call this function. ++//====================================================================== ++VOID ++ODM_ClearTxPowerTrackingState( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDM_Odm->Adapter); ++ u1Byte p = 0; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; ++ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->DefaultCckIndex; ++ pRFCalibrateInfo->CCK_index = 0; ++ ++ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) ++ { ++ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; ++ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->DefaultOfdmIndex; ++ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; ++ ++ pRFCalibrateInfo->PowerIndexOffset[p] = 0; ++ pRFCalibrateInfo->DeltaPowerIndex[p] = 0; ++ pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; ++ ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = 0; /* Initial Mix mode power tracking*/ ++ pRFCalibrateInfo->Remnant_OFDMSwingIdx[p] = 0; ++ pRFCalibrateInfo->KfreeOffset[p] = 0; ++ } ++ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; /*Initial at Modify Tx Scaling Mode*/ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = FALSE; /*Initial at Modify Tx Scaling Mode*/ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathC = FALSE; /*Initial at Modify Tx Scaling Mode*/ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathD = FALSE; /*Initial at Modify Tx Scaling Mode*/ ++ pRFCalibrateInfo->Remnant_CCKSwingIdx = 0; ++ pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; ++ ++ pRFCalibrateInfo->Modify_TxAGC_Value_CCK=0; //modify by Mingzhi.Guo ++ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM=0; //modify by Mingzhi.Guo ++ ++} ++ ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm ++#else ++ IN PADAPTER Adapter ++#endif ++ ) ++{ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++#endif ++#endif ++ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; ++ s1Byte diff_DPK[4] = {0}; ++ u1Byte ThermalValue_AVG_count = 0; ++ u4Byte ThermalValue_AVG = 0, RegC80, RegCd0, RegCd4, Regab4; ++ ++ u1Byte OFDM_min_index = 0; // OFDM BB Swing should be less than +3.0dB, which is required by Arthur ++ u1Byte Indexforchannel = 0; // GetRightChnlPlaceforIQK(pHalData->CurrentChannel) ++ u1Byte PowerTrackingType = pHalData->RfPowerTrackingType; ++ u1Byte XtalOffsetEanble = 0; ++ ++ TXPWRTRACK_CFG c; ++ ++ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. ++ pu1Byte deltaSwingTableIdx_TUP_A = NULL; ++ pu1Byte deltaSwingTableIdx_TDOWN_A = NULL; ++ pu1Byte deltaSwingTableIdx_TUP_B = NULL; ++ pu1Byte deltaSwingTableIdx_TDOWN_B = NULL; ++ /*for 8814 add by Yu Chen*/ ++ pu1Byte deltaSwingTableIdx_TUP_C = NULL; ++ pu1Byte deltaSwingTableIdx_TDOWN_C = NULL; ++ pu1Byte deltaSwingTableIdx_TUP_D = NULL; ++ pu1Byte deltaSwingTableIdx_TDOWN_D = NULL; ++ /*for Xtal Offset by James.Tung*/ ++ ps1Byte deltaSwingTableXtal_UP = NULL; ++ ps1Byte deltaSwingTableXtal_DOWN = NULL; ++ ++ //4 2. Initilization ( 7 steps in total ) ++ ++ ConfigureTxpowerTrack(pDM_Odm, &c); ++ ++ (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_A, (pu1Byte *)&deltaSwingTableIdx_TDOWN_A, ++ (pu1Byte *)&deltaSwingTableIdx_TUP_B, (pu1Byte *)&deltaSwingTableIdx_TDOWN_B); ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) /*for 8814 path C & D*/ ++ (*c.GetDeltaSwingTable8814only)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_C, (pu1Byte *)&deltaSwingTableIdx_TDOWN_C, ++ (pu1Byte *)&deltaSwingTableIdx_TUP_D, (pu1Byte *)&deltaSwingTableIdx_TDOWN_D); ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) /*for Xtal Offset*/ ++ (*c.GetDeltaSwingXtalTable)(pDM_Odm, (ps1Byte *)&deltaSwingTableXtal_UP, (ps1Byte *)&deltaSwingTableXtal_DOWN); ++ ++ ++ pRFCalibrateInfo->TXPowerTrackingCallbackCnt++; /*cosa add for debug*/ ++ pRFCalibrateInfo->bTXPowerTrackingInit = TRUE; ++ ++ /*pRFCalibrateInfo->TxPowerTrackControl = pHalData->TxPowerTrackControl; ++ We should keep updating the control variable according to HalData. ++ RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. */ ++ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ #if (MP_DRIVER == 1) ++ pRFCalibrateInfo->RegA24 = 0x090e1317; ++ #endif ++ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ if (pDM_Odm->mp_mode == TRUE) ++ pRFCalibrateInfo->RegA24 = 0x090e1317; ++ #endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("===>ODM_TXPowerTrackingCallback_ThermalMeter\n pRFCalibrateInfo->BbSwingIdxCckBase: %d, pRFCalibrateInfo->BbSwingIdxOfdmBase[A]: %d, pRFCalibrateInfo->DefaultOfdmIndex: %d\n", ++ pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_A], pRFCalibrateInfo->DefaultOfdmIndex)); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("pRFCalibrateInfo->TxPowerTrackControl=%d, pHalData->EEPROMThermalMeter %d\n", pRFCalibrateInfo->TxPowerTrackControl, pHalData->EEPROMThermalMeter)); ++ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E ++ ++ /*add log by zhao he, check c80/c94/c14/ca0 value*/ ++ if (pDM_Odm->SupportICType == ODM_RTL8723D) { ++ RegC80 = ODM_GetBBReg(pDM_Odm, 0xc80, bMaskDWord); ++ RegCd0 = ODM_GetBBReg(pDM_Odm, 0xcd0, bMaskDWord); ++ RegCd4 = ODM_GetBBReg(pDM_Odm, 0xcd4, bMaskDWord); ++ Regab4 = ODM_GetBBReg(pDM_Odm, 0xab4, 0x000007FF); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", RegC80, RegCd0, RegCd4, Regab4)); ++ } ++ ++ if (!pRFCalibrateInfo->TxPowerTrackControl) ++ return; ++ ++ ++ /*4 3. Initialize ThermalValues of RFCalibrateInfo*/ ++ ++ if (pRFCalibrateInfo->bReloadtxpowerindex) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); ++ ++ /*4 4. Calculate average thermal meter*/ ++ ++ pRFCalibrateInfo->ThermalValue_AVG[pRFCalibrateInfo->ThermalValue_AVG_index] = ThermalValue; ++ pRFCalibrateInfo->ThermalValue_AVG_index++; ++ if (pRFCalibrateInfo->ThermalValue_AVG_index == c.AverageThermalNum) /*Average times = c.AverageThermalNum*/ ++ pRFCalibrateInfo->ThermalValue_AVG_index = 0; ++ ++ for(i = 0; i < c.AverageThermalNum; i++) ++ { ++ if (pRFCalibrateInfo->ThermalValue_AVG[i]) { ++ ThermalValue_AVG += pRFCalibrateInfo->ThermalValue_AVG[i]; ++ ThermalValue_AVG_count++; ++ } ++ } ++ ++ if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times ++ { ++ ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("AVG Thermal Meter = 0x%X, EFUSE Thermal Base = 0x%X\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ } ++ ++ //4 5. Calculate delta, delta_LCK, delta_IQK. ++ ++ //"delta" here is used to determine whether thermal value changes or not. ++ delta = (ThermalValue > pRFCalibrateInfo->ThermalValue)?(ThermalValue - pRFCalibrateInfo->ThermalValue):(pRFCalibrateInfo->ThermalValue - ThermalValue); ++ delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); ++ delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); ++ ++ if (pRFCalibrateInfo->ThermalValue_IQK == 0xff) { /*no PG, use thermal value for IQK*/ ++ pRFCalibrateInfo->ThermalValue_IQK = ThermalValue; ++ delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, use ThermalValue for IQK\n")); ++ } ++ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ diff_DPK[p] = (s1Byte)ThermalValue - (s1Byte)pRFCalibrateInfo->DpkThermal[p]; ++ ++ /*4 6. If necessary, do LCK.*/ ++ ++ if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { /*no PG , do LCK at initial status*/ ++ if (pRFCalibrateInfo->ThermalValue_LCK == 0xff) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, do LCK\n")); ++ pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; ++ ++ /*Use RTLCK, so close power tracking driver LCK*/ ++ if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { ++ if (c.PHY_LCCalibrate) ++ (*c.PHY_LCCalibrate)(pDM_Odm); ++ } ++ ++ delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK)); ++ ++ /* Delta temperature is equal to or larger than 20 centigrade.*/ ++ if (delta_LCK >= c.Threshold_IQK) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); ++ pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; ++ ++ /*Use RTLCK, so close power tracking driver LCK*/ ++ if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { ++ if (c.PHY_LCCalibrate) ++ (*c.PHY_LCCalibrate)(pDM_Odm); ++ } ++ } ++ } ++ ++ /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ ++ ++ if (delta > 0 && pRFCalibrateInfo->TxPowerTrackControl) ++ { ++ //"delta" here is used to record the absolute value of differrence. ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); ++#else ++ delta = (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther)?(ThermalValue - pDM_Odm->priv->pmib->dot11RFEntry.ther):(pDM_Odm->priv->pmib->dot11RFEntry.ther - ThermalValue); ++#endif ++ if (delta >= TXPWR_TRACK_TABLE_SIZE) ++ delta = TXPWR_TRACK_TABLE_SIZE - 1; ++ ++ /*4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset*/ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ if(ThermalValue > pHalData->EEPROMThermalMeter) { ++#else ++ if(ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { ++#endif ++ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; /*recording poer index offset*/ ++ switch (p) { ++ case ODM_RF_PATH_B: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); ++ ++ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_B[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_C: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta])); ++ ++ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_C[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_D: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta])); ++ ++ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_D[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ default: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); ++ ++ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_A[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ } ++ } ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) { ++ /*Save XtalOffset from Xtal table*/ ++ pRFCalibrateInfo->XtalOffsetLast = pRFCalibrateInfo->XtalOffset; /*recording last Xtal offset*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("[Xtal] deltaSwingTableXtal_UP[%d] = %d\n", delta, deltaSwingTableXtal_UP[delta])); ++ pRFCalibrateInfo->XtalOffset = deltaSwingTableXtal_UP[delta]; ++ ++ if (pRFCalibrateInfo->XtalOffsetLast == pRFCalibrateInfo->XtalOffset) ++ XtalOffsetEanble = 0; ++ else ++ XtalOffsetEanble = 1; ++ } ++ ++ } else { ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; /*recording poer index offset*/ ++ ++ switch (p) { ++ case ODM_RF_PATH_B: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); ++ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_C: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta])); ++ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ case ODM_RF_PATH_D: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta])); ++ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ ++ default: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); ++ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; ++ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; /*Record delta swing for mix mode power tracking*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); ++ break; ++ } ++ } ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) { ++ /*Save XtalOffset from Xtal table*/ ++ pRFCalibrateInfo->XtalOffsetLast = pRFCalibrateInfo->XtalOffset; /*recording last Xtal offset*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("[Xtal] deltaSwingTableXtal_DOWN[%d] = %d\n", delta, deltaSwingTableXtal_DOWN[delta])); ++ pRFCalibrateInfo->XtalOffset = deltaSwingTableXtal_DOWN[delta]; ++ ++ if (pRFCalibrateInfo->XtalOffsetLast == pRFCalibrateInfo->XtalOffset) ++ XtalOffsetEanble = 0; ++ else ++ XtalOffsetEanble = 1; ++ } ++ ++ } ++ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("\n\n=========================== [Path-%d] Calculating PowerIndexOffset===========================\n", p)); ++ ++ if (pRFCalibrateInfo->DeltaPowerIndex[p] == pRFCalibrateInfo->DeltaPowerIndexLast[p]) /*If Thermal value changes but lookup table value still the same*/ ++ pRFCalibrateInfo->PowerIndexOffset[p] = 0; ++ else ++ pRFCalibrateInfo->PowerIndexOffset[p] = pRFCalibrateInfo->DeltaPowerIndex[p] - pRFCalibrateInfo->DeltaPowerIndexLast[p]; /*Power Index Diff between 2 times Power Tracking*/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("[Path-%d] PowerIndexOffset(%d) = DeltaPowerIndex(%d) - DeltaPowerIndexLast(%d)\n", p, pRFCalibrateInfo->PowerIndexOffset[p], pRFCalibrateInfo->DeltaPowerIndex[p], pRFCalibrateInfo->DeltaPowerIndexLast[p])); ++ ++ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->BbSwingIdxOfdmBase[p] + pRFCalibrateInfo->PowerIndexOffset[p]; ++ pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->BbSwingIdxCckBase + pRFCalibrateInfo->PowerIndexOffset[p]; ++ ++ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->CCK_index; ++ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->OFDM_index[p]; ++ ++ /*************Print BB Swing Base and Index Offset*************/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxCck, pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->PowerIndexOffset[p])); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("The 'OFDM' final index(%d) = BaseIndex[%d](%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxOfdm[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p], pRFCalibrateInfo->PowerIndexOffset[p])); ++ ++ /*4 7.1 Handle boundary conditions of index.*/ ++ ++ if (pRFCalibrateInfo->OFDM_index[p] > c.SwingTableSize_OFDM-1) ++ pRFCalibrateInfo->OFDM_index[p] = c.SwingTableSize_OFDM-1; ++ else if (pRFCalibrateInfo->OFDM_index[p] <= OFDM_min_index) ++ pRFCalibrateInfo->OFDM_index[p] = OFDM_min_index; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("\n\n========================================================================================================\n")); ++ ++ if (pRFCalibrateInfo->CCK_index > c.SwingTableSize_CCK-1) ++ pRFCalibrateInfo->CCK_index = c.SwingTableSize_CCK-1; ++ else if (pRFCalibrateInfo->CCK_index <= 0) ++ pRFCalibrateInfo->CCK_index = 0; ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("The thermal meter is unchanged or TxPowerTracking OFF(%d): ThermalValue: %d , pRFCalibrateInfo->ThermalValue: %d\n", ++ pRFCalibrateInfo->TxPowerTrackControl, ThermalValue, pRFCalibrateInfo->ThermalValue)); ++ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ pRFCalibrateInfo->PowerIndexOffset[p] = 0; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", ++ pRFCalibrateInfo->CCK_index, pRFCalibrateInfo->BbSwingIdxCckBase)); /*Print Swing base & current*/ ++ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index[%d]: %d\n", ++ pRFCalibrateInfo->OFDM_index[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p])); ++ } ++ ++ if ((pDM_Odm->SupportICType & ODM_RTL8814A)) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("PowerTrackingType=%d\n", PowerTrackingType)); ++ ++ if (PowerTrackingType == 0) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); ++ } else if (PowerTrackingType == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(2G) TSSI(5G) MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_2G_TSSI_5G_MODE, p, 0); ++ } else if (PowerTrackingType == 2) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(5G) TSSI(2G)MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_5G_TSSI_2G_MODE, p, 0); ++ } else if (PowerTrackingType == 3) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking TSSI MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TSSI_MODE, p, 0); ++ } ++ pRFCalibrateInfo->ThermalValue = ThermalValue; /*Record last Power Tracking Thermal Value*/ ++ ++ } else if ((pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_A] != 0 || ++ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_B] != 0 || ++ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_C] != 0 || ++ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_D] != 0) && ++ pRFCalibrateInfo->TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) { ++ //4 7.2 Configure the Swing Table to adjust Tx Power. ++ ++ pRFCalibrateInfo->bTxPowerChanged = TRUE; /*Always TRUE after Tx Power is adjusted by power tracking.*/ ++ // ++ // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital ++ // to increase TX power. Otherwise, EVM will be bad. ++ // ++ // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. ++ if (ThermalValue > pRFCalibrateInfo->ThermalValue) { ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature Increasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", ++ p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); ++ } ++ } else if (ThermalValue < pRFCalibrateInfo->ThermalValue) { /*Low temperature*/ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature Decreasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", ++ p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); ++ } ++ } ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ if (ThermalValue > pHalData->EEPROMThermalMeter) ++#else ++ if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) ++#endif ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || ++ pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || ++ pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8822B || ++ pDM_Odm->SupportICType == ODM_RTL8723D || pDM_Odm->SupportICType == ODM_RTL8821C) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); ++ } ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || ++ pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || ++ pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8822B || ++ pDM_Odm->SupportICType == ODM_RTL8723D || pDM_Odm->SupportICType == ODM_RTL8821C) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); ++ } ++ ++ } ++ ++ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->BbSwingIdxCck; /*Record last time Power Tracking result as base.*/ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->BbSwingIdxOfdm[p]; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("pRFCalibrateInfo->ThermalValue = %d ThermalValue= %d\n", pRFCalibrateInfo->ThermalValue, ThermalValue)); ++ ++ pRFCalibrateInfo->ThermalValue = ThermalValue; /*Record last Power Tracking Thermal Value*/ ++ ++ } ++ ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8723D) { ++ ++ if (XtalOffsetEanble != 0 && pRFCalibrateInfo->TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter Xtal Tracking**********\n")); ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ if (ThermalValue > pHalData->EEPROMThermalMeter) { ++#else ++ if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { ++#endif ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ (*c.ODM_TxXtalTrackSetXtal)(pDM_Odm); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ (*c.ODM_TxXtalTrackSetXtal)(pDM_Odm); ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********End Xtal Tracking**********\n")); ++ } ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ ++ if (!IS_HARDWARE_TYPE_8723B(Adapter)) { ++ /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ ++ if (delta_IQK >= c.Threshold_IQK) { ++ pRFCalibrateInfo->ThermalValue_IQK = ThermalValue; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= Threshold_IQK(%d)\n", delta_IQK, c.Threshold_IQK)); ++ if (!pRFCalibrateInfo->bIQKInProgress) ++ (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); ++ } ++ } ++ if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_A] != 0) { ++ if (diff_DPK[ODM_RF_PATH_A] >= c.Threshold_DPK) { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK)); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); ++ } else if ((diff_DPK[ODM_RF_PATH_A] <= -1 * c.Threshold_DPK)) { ++ s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK); ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, value); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); ++ } else { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); ++ } ++ } ++ if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_B] != 0) { ++ if (diff_DPK[ODM_RF_PATH_B] >= c.Threshold_DPK) { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK)); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); ++ } else if ((diff_DPK[ODM_RF_PATH_B] <= -1 * c.Threshold_DPK)) { ++ s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK); ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, value); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); ++ } else { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); ++ } ++ } ++ ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("<===ODM_TXPowerTrackingCallback_ThermalMeter\n")); ++ ++ pRFCalibrateInfo->TXPowercount = 0; ++} ++ ++ ++ ++//3============================================================ ++//3 IQ Calibration ++//3============================================================ ++ ++VOID ++ODM_ResetIQKResult( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ return; ++} ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) ++{ ++ u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = ++ {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; ++ u1Byte place = chnl; ++ ++ ++ if(chnl > 14) ++ { ++ for(place = 14; placeAdapter; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if (*pDM_Odm->pIsFcsModeEnable) ++ return; ++#endif ++ ++ if (pDM_Odm->bLinked) { ++ ++ if ((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) { ++ pDM_Odm->preChannel = *pDM_Odm->pChannel; ++ pDM_Odm->LinkedInterval = 0; ++ } ++ ++ if (pDM_Odm->LinkedInterval < 3) ++ pDM_Odm->LinkedInterval++; ++ ++ if (pDM_Odm->LinkedInterval == 2) { ++ PHY_IQCalibrate(Adapter, FALSE); ++ } ++ } else ++ pDM_Odm->LinkedInterval = 0; ++ ++} ++ ++void phydm_rf_init(IN PDM_ODM_T pDM_Odm) ++{ ++ ++ odm_TXPowerTrackingInit(pDM_Odm); ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ ODM_ClearTxPowerTrackingState(pDM_Odm); ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++#if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ PHY_IQCalibrate_8814A_Init(pDM_Odm); ++#endif ++#endif ++ ++} ++ ++void phydm_rf_watchdog(IN PDM_ODM_T pDM_Odm) ++{ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ ++ if(!pMgntInfo->IQKBeforeConnection) ++ { ++ ODM_TXPowerTrackingCheck(pDM_Odm); ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ odm_IQCalibrate(pDM_Odm); ++ } ++#endif ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_win.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_win.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_win.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_win.h 2018-02-11 21:44:27.153146177 +0200 +@@ -0,0 +1,120 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ #ifndef __HAL_PHY_RF_H__ ++ #define __HAL_PHY_RF_H__ ++ ++#include "phydm_kfree.h" ++#if (RTL8814A_SUPPORT == 1) ++#include "rtl8814a/phydm_iqk_8814a.h" ++#endif ++ ++#if (RTL8822B_SUPPORT == 1) ++#include "rtl8822b/phydm_iqk_8822b.h" ++#include "../mac/Halmac_type.h" ++#endif ++#include "phydm_powertracking_win.h" ++ ++#if (RTL8821C_SUPPORT == 1) ++#include "rtl8821c/phydm_iqk_8821c.h" ++#endif ++ ++typedef enum _SPUR_CAL_METHOD { ++ PLL_RESET, ++ AFE_PHASE_SEL ++} SPUR_CAL_METHOD; ++ ++typedef enum _PWRTRACK_CONTROL_METHOD { ++ BBSWING, ++ TXAGC, ++ MIX_MODE, ++ TSSI_MODE, ++ MIX_2G_TSSI_5G_MODE, ++ MIX_5G_TSSI_2G_MODE ++} PWRTRACK_METHOD; ++ ++typedef VOID(*FuncSetPwr)(PVOID, PWRTRACK_METHOD, u1Byte, u1Byte); ++typedef VOID(*FuncIQK)(PVOID, u1Byte, u1Byte, u1Byte); ++typedef VOID(*FuncLCK)(PVOID); ++typedef VOID(*FuncSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); ++typedef VOID(*FuncSwing8814only)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); ++typedef VOID (*FuncSwingXtal)(PVOID, ps1Byte*, ps1Byte*); ++typedef VOID (*FuncSetXtal)(PVOID); ++typedef VOID(*FuncAllSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); ++ ++typedef struct _TXPWRTRACK_CFG { ++ u1Byte SwingTableSize_CCK; ++ u1Byte SwingTableSize_OFDM; ++ u1Byte Threshold_IQK; ++ u1Byte Threshold_DPK; ++ u1Byte AverageThermalNum; ++ u1Byte RfPathCount; ++ u4Byte ThermalRegAddr; ++ FuncSetPwr ODM_TxPwrTrackSetPwr; ++ FuncIQK DoIQK; ++ FuncLCK PHY_LCCalibrate; ++ FuncSwing GetDeltaSwingTable; ++ FuncSwing8814only GetDeltaSwingTable8814only; ++ FuncSwingXtal GetDeltaSwingXtalTable; ++ FuncSetXtal ODM_TxXtalTrackSetXtal; ++ FuncAllSwing GetDeltaAllSwingTable; ++} TXPWRTRACK_CFG, *PTXPWRTRACK_CFG; ++ ++VOID ++ConfigureTxpowerTrack( ++ IN PDM_ODM_T pDM_Odm, ++ OUT PTXPWRTRACK_CFG pConfig ++ ); ++ ++ ++VOID ++ODM_ClearTxPowerTrackingState( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++VOID ++ODM_TXPowerTrackingCallback_ThermalMeter( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm ++#else ++ IN PADAPTER Adapter ++#endif ++ ); ++ ++ ++ ++#define ODM_TARGET_CHNL_NUM_2G_5G 59 ++ ++ ++VOID ++ODM_ResetIQKResult( ++ IN PDM_ODM_T pDM_Odm ++); ++u1Byte ++ODM_GetRightChnlPlaceforIQK( ++ IN u1Byte chnl ++); ++ ++VOID odm_IQCalibrate(IN PDM_ODM_T pDM_Odm); ++VOID phydm_rf_init( IN PDM_ODM_T pDM_Odm); ++VOID phydm_rf_watchdog( IN PDM_ODM_T pDM_Odm); ++ ++#endif // #ifndef __HAL_PHY_RF_H__ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/mp_precomp.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/mp_precomp.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/mp_precomp.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/mp_precomp.h 2018-02-11 21:44:27.153146177 +0200 +@@ -0,0 +1,20 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_acs.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_acs.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_acs.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_acs.c 2018-02-11 21:44:27.154146193 +0200 +@@ -0,0 +1,1226 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++ ++u1Byte ++ODM_GetAutoChannelSelectResult( ++ IN PVOID pDM_VOID, ++ IN u1Byte Band ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PACS pACS = &pDM_Odm->DM_ACS; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ if(Band == ODM_BAND_2_4G) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("[ACS] ODM_GetAutoChannelSelectResult(): CleanChannel_2G(%d)\n", pACS->CleanChannel_2G)); ++ return (u1Byte)pACS->CleanChannel_2G; ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("[ACS] ODM_GetAutoChannelSelectResult(): CleanChannel_5G(%d)\n", pACS->CleanChannel_5G)); ++ return (u1Byte)pACS->CleanChannel_5G; ++ } ++#else ++ return (u1Byte)pACS->CleanChannel_2G; ++#endif ++ ++} ++ ++VOID ++odm_AutoChannelSelectSetting( ++ IN PVOID pDM_VOID, ++ IN BOOLEAN IsEnable ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u2Byte period = 0x2710;// 40ms in default ++ u2Byte NHMType = 0x7; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectSetting()=========> \n")); ++ ++ if(IsEnable) ++ {//20 ms ++ period = 0x1388; ++ NHMType = 0x1; ++ } ++ ++ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ { ++ //PHY parameters initialize for ac series ++ ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC+2, period); //0x990[31:16]=0x2710 Time duration for NHM unit: 4us, 0x2710=40ms ++ //ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT8|BIT9|BIT10, NHMType); //0x994[9:8]=3 enable CCX ++ } ++ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ { ++ //PHY parameters initialize for n series ++ ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11N+2, period); //0x894[31:16]=0x2710 Time duration for NHM unit: 4us, 0x2710=40ms ++ //ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10|BIT9|BIT8, NHMType); //0x890[9:8]=3 enable CCX ++ } ++#endif ++} ++ ++VOID ++odm_AutoChannelSelectInit( ++ IN PVOID pDM_VOID ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PACS pACS = &pDM_Odm->DM_ACS; ++ u1Byte i; ++ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) ++ return; ++ ++ if(pACS->bForceACSResult) ++ return; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectInit()=========> \n")); ++ ++ pACS->CleanChannel_2G = 1; ++ pACS->CleanChannel_5G = 36; ++ ++ for (i = 0; i < ODM_MAX_CHANNEL_2G; ++i) ++ { ++ pACS->Channel_Info_2G[0][i] = 0; ++ pACS->Channel_Info_2G[1][i] = 0; ++ } ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ { ++ for (i = 0; i < ODM_MAX_CHANNEL_5G; ++i) ++ { ++ pACS->Channel_Info_5G[0][i] = 0; ++ pACS->Channel_Info_5G[1][i] = 0; ++ } ++ } ++#endif ++} ++ ++VOID ++odm_AutoChannelSelectReset( ++ IN PVOID pDM_VOID ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PACS pACS = &pDM_Odm->DM_ACS; ++ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) ++ return; ++ ++ if(pACS->bForceACSResult) ++ return; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectReset()=========> \n")); ++ ++ odm_AutoChannelSelectSetting(pDM_Odm,TRUE);// for 20ms measurement ++ Phydm_NHMCounterStatisticsReset(pDM_Odm); ++#endif ++} ++ ++VOID ++odm_AutoChannelSelect( ++ IN PVOID pDM_VOID, ++ IN u1Byte Channel ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PACS pACS = &pDM_Odm->DM_ACS; ++ u1Byte ChannelIDX = 0, SearchIDX = 0; ++ u2Byte MaxScore=0; ++ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Return: SupportAbility ODM_BB_NHM_CNT is disabled\n")); ++ return; ++ } ++ ++ if(pACS->bForceACSResult) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Force 2G clean channel = %d, 5G clean channel = %d\n", ++ pACS->CleanChannel_2G, pACS->CleanChannel_5G)); ++ return; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Channel = %d=========> \n", Channel)); ++ ++ Phydm_GetNHMCounterStatistics(pDM_Odm); ++ odm_AutoChannelSelectSetting(pDM_Odm,FALSE); ++ ++ if(Channel >=1 && Channel <=14) ++ { ++ ChannelIDX = Channel - 1; ++ pACS->Channel_Info_2G[1][ChannelIDX]++; ++ ++ if(pACS->Channel_Info_2G[1][ChannelIDX] >= 2) ++ pACS->Channel_Info_2G[0][ChannelIDX] = (pACS->Channel_Info_2G[0][ChannelIDX] >> 1) + ++ (pACS->Channel_Info_2G[0][ChannelIDX] >> 2) + (pDM_Odm->NHM_cnt_0>>2); ++ else ++ pACS->Channel_Info_2G[0][ChannelIDX] = pDM_Odm->NHM_cnt_0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): NHM_cnt_0 = %d \n", pDM_Odm->NHM_cnt_0)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Channel_Info[0][%d] = %d, Channel_Info[1][%d] = %d\n", ChannelIDX, pACS->Channel_Info_2G[0][ChannelIDX], ChannelIDX, pACS->Channel_Info_2G[1][ChannelIDX])); ++ ++ for(SearchIDX = 0; SearchIDX < ODM_MAX_CHANNEL_2G; SearchIDX++) ++ { ++ if(pACS->Channel_Info_2G[1][SearchIDX] != 0) ++ { ++ if(pACS->Channel_Info_2G[0][SearchIDX] >= MaxScore) ++ { ++ MaxScore = pACS->Channel_Info_2G[0][SearchIDX]; ++ pACS->CleanChannel_2G = SearchIDX+1; ++ } ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("(1)odm_AutoChannelSelect(): 2G: CleanChannel_2G = %d, MaxScore = %d \n", ++ pACS->CleanChannel_2G, MaxScore)); ++ ++ } ++ else if(Channel >= 36) ++ { ++ // Need to do ++ pACS->CleanChannel_5G = Channel; ++ } ++#endif ++} ++ ++#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) ++ ++VOID ++phydm_AutoChannelSelectSettingAP( ++ IN PVOID pDM_VOID, ++ IN u4Byte setting, // 0: STORE_DEFAULT_NHM_SETTING; 1: RESTORE_DEFAULT_NHM_SETTING, 2: ACS_NHM_SETTING ++ IN u4Byte acs_step ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ PACS pACS = &pDM_Odm->DM_ACS; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectSettingAP()=========> \n")); ++ ++ //3 Store Default Setting ++ if(setting == STORE_DEFAULT_NHM_SETTING) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("STORE_DEFAULT_NHM_SETTING\n")); ++ ++ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) // store Reg0x990, Reg0x994, Reg0x998, Reg0x99C, Reg0x9a0 ++ { ++ pACS->Reg0x990 = ODM_Read4Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC); // Reg0x990 ++ pACS->Reg0x994 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC); // Reg0x994 ++ pACS->Reg0x998 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC); // Reg0x998 ++ pACS->Reg0x99C = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC); // Reg0x99c ++ pACS->Reg0x9A0 = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_TH8_11AC); // Reg0x9a0, u1Byte ++ } ++ else if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ { ++ pACS->Reg0x890 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N); // Reg0x890 ++ pACS->Reg0x894 = ODM_Read4Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11N); // Reg0x894 ++ pACS->Reg0x898 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N); // Reg0x898 ++ pACS->Reg0x89C = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N); // Reg0x89c ++ pACS->Reg0xE28 = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_TH8_11N); // Reg0xe28, u1Byte ++ } ++ } ++ ++ //3 Restore Default Setting ++ else if(setting == RESTORE_DEFAULT_NHM_SETTING) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("RESTORE_DEFAULT_NHM_SETTING\n")); ++ ++ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) // store Reg0x990, Reg0x994, Reg0x998, Reg0x99C, Reg0x9a0 ++ { ++ ODM_Write4Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, pACS->Reg0x990); ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, pACS->Reg0x994); ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, pACS->Reg0x998); ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, pACS->Reg0x99C); ++ ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11AC, pACS->Reg0x9A0); ++ } ++ else if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ { ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, pACS->Reg0x890); ++ ODM_Write4Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, pACS->Reg0x894); ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, pACS->Reg0x898); ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, pACS->Reg0x89C); ++ ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11N, pACS->Reg0xE28); ++ } ++ } ++ ++ //3 ACS Setting ++ else if(setting == ACS_NHM_SETTING) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("ACS_NHM_SETTING\n")); ++ u2Byte period; ++ period = 0x61a8; ++ pACS->ACS_Step = acs_step; ++ ++ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ { ++ //4 Set NHM period, 0x990[31:16]=0x61a8, Time duration for NHM unit: 4us, 0x61a8=100ms ++ ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC+2, period); ++ //4 Set NHM ignore_cca=1, ignore_txon=1, ccx_en=0 ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC,BIT8|BIT9|BIT10, 3); ++ ++ if(pACS->ACS_Step == 0) ++ { ++ //4 Set IGI ++ ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); ++ if (get_rf_mimo_mode(priv) != MIMO_1T1R) ++ ODM_SetBBReg(pDM_Odm,0xe50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); ++ ++ //4 Set ACS NHM threshold ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0x82786e64); ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffff8c); ++ ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11AC, 0xff); ++ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC+2, 0xffff); ++ ++ } ++ else if(pACS->ACS_Step == 1) ++ { ++ //4 Set IGI ++ ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); ++ if (get_rf_mimo_mode(priv) != MIMO_1T1R) ++ ODM_SetBBReg(pDM_Odm,0xe50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); ++ ++ //4 Set ACS NHM threshold ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0x5a50463c); ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffff64); ++ ++ } ++ ++ } ++ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ { ++ //4 Set NHM period, 0x894[31:16]=0x61a8, Time duration for NHM unit: 4us, 0x61a8=100ms ++ ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC+2, period); ++ //4 Set NHM ignore_cca=1, ignore_txon=1, ccx_en=0 ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N,BIT8|BIT9|BIT10, 3); ++ ++ if(pACS->ACS_Step == 0) ++ { ++ //4 Set IGI ++ ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); ++ if (get_rf_mimo_mode(priv) != MIMO_1T1R) ++ ODM_SetBBReg(pDM_Odm,0xc58,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); ++ ++ //4 Set ACS NHM threshold ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0x82786e64); ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffff8c); ++ ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11N, 0xff); ++ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N+2, 0xffff); ++ ++ } ++ else if(pACS->ACS_Step == 1) ++ { ++ //4 Set IGI ++ ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); ++ if (get_rf_mimo_mode(priv) != MIMO_1T1R) ++ ODM_SetBBReg(pDM_Odm,0xc58,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); ++ ++ //4 Set ACS NHM threshold ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0x5a50463c); ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffff64); ++ ++ } ++ } ++ } ++ ++} ++ ++VOID ++phydm_GetNHMStatisticsAP( ++ IN PVOID pDM_VOID, ++ IN u4Byte idx, // @ 2G, Real channel number = idx+1 ++ IN u4Byte acs_step ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ PACS pACS = &pDM_Odm->DM_ACS; ++ u4Byte value32 = 0; ++ u1Byte i; ++ ++ pACS->ACS_Step = acs_step; ++ ++ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ { ++ //4 Check if NHM result is ready ++ for (i=0; i<20; i++) { ++ ++ ODM_delay_ms(1); ++ if ( ODM_GetBBReg(pDM_Odm,rFPGA0_PSDReport,BIT17) ) ++ break; ++ } ++ ++ //4 Get NHM Statistics ++ if ( pACS->ACS_Step==1 ) { ++ ++ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT7_TO_CNT4_11N); ++ ++ pACS->NHM_Cnt[idx][9] = (value32 & bMaskByte1) >> 8; ++ pACS->NHM_Cnt[idx][8] = (value32 & bMaskByte0); ++ ++ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11N); // ODM_REG_NHM_CNT3_TO_CNT0_11N ++ ++ pACS->NHM_Cnt[idx][7] = (value32 & bMaskByte3) >> 24; ++ pACS->NHM_Cnt[idx][6] = (value32 & bMaskByte2) >> 16; ++ pACS->NHM_Cnt[idx][5] = (value32 & bMaskByte1) >> 8; ++ ++ } else if (pACS->ACS_Step==2) { ++ ++ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11N); // ODM_REG_NHM_CNT3_TO_CNT0_11N ++ ++ pACS->NHM_Cnt[idx][4] = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11N); ++ pACS->NHM_Cnt[idx][3] = (value32 & bMaskByte3) >> 24; ++ pACS->NHM_Cnt[idx][2] = (value32 & bMaskByte2) >> 16; ++ pACS->NHM_Cnt[idx][1] = (value32 & bMaskByte1) >> 8; ++ pACS->NHM_Cnt[idx][0] = (value32 & bMaskByte0); ++ } ++ } ++ else if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ { ++ //4 Check if NHM result is ready ++ for (i=0; i<20; i++) { ++ ++ ODM_delay_ms(1); ++ if (ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_DUR_READY_11AC, BIT16)) ++ break; ++ } ++ ++ if ( pACS->ACS_Step==1 ) { ++ ++ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT7_TO_CNT4_11AC); ++ ++ pACS->NHM_Cnt[idx][9] = (value32 & bMaskByte1) >> 8; ++ pACS->NHM_Cnt[idx][8] = (value32 & bMaskByte0); ++ ++ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11AC); // ODM_REG_NHM_CNT3_TO_CNT0_11AC ++ ++ pACS->NHM_Cnt[idx][7] = (value32 & bMaskByte3) >> 24; ++ pACS->NHM_Cnt[idx][6] = (value32 & bMaskByte2) >> 16; ++ pACS->NHM_Cnt[idx][5] = (value32 & bMaskByte1) >> 8; ++ ++ } else if (pACS->ACS_Step==2) { ++ ++ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11AC); // ODM_REG_NHM_CNT3_TO_CNT0_11AC ++ ++ pACS->NHM_Cnt[idx][4] = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11AC); ++ pACS->NHM_Cnt[idx][3] = (value32 & bMaskByte3) >> 24; ++ pACS->NHM_Cnt[idx][2] = (value32 & bMaskByte2) >> 16; ++ pACS->NHM_Cnt[idx][1] = (value32 & bMaskByte1) >> 8; ++ pACS->NHM_Cnt[idx][0] = (value32 & bMaskByte0); ++ } ++ } ++ ++} ++ ++ ++//#define ACS_DEBUG_INFO //acs debug default off ++/* ++int phydm_AutoChannelSelectAP( ++ IN PVOID pDM_VOID, ++ IN u4Byte ACS_Type, // 0: RXCount_Type, 1:NHM_Type ++ IN u4Byte available_chnl_num // amount of all channels ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PACS pACS = &pDM_Odm->DM_ACS; ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ ++ static u4Byte score2G[MAX_2G_CHANNEL_NUM], score5G[MAX_5G_CHANNEL_NUM]; ++ u4Byte score[MAX_BSS_NUM], use_nhm = 0; ++ u4Byte minScore=0xffffffff; ++ u4Byte tmpScore, tmpIdx=0; ++ u4Byte traffic_check = 0; ++ u4Byte fa_count_weighting = 1; ++ int i, j, idx=0, idx_2G_end=-1, idx_5G_begin=-1, minChan=0; ++ struct bss_desc *pBss=NULL; ++ ++#ifdef _DEBUG_RTL8192CD_ ++ char tmpbuf[400]; ++ int len=0; ++#endif ++ ++ memset(score2G, '\0', sizeof(score2G)); ++ memset(score5G, '\0', sizeof(score5G)); ++ ++ for (i=0; iavailable_chnl_num; i++) { ++ if (priv->available_chnl[i] <= 14) ++ idx_2G_end = i; ++ else ++ break; ++ } ++ ++ for (i=0; iavailable_chnl_num; i++) { ++ if (priv->available_chnl[i] > 14) { ++ idx_5G_begin = i; ++ break; ++ } ++ } ++ ++// DELETE ++#ifndef CONFIG_RTL_NEW_AUTOCH ++ for (i=0; isite_survey->count; i++) { ++ pBss = &priv->site_survey->bss[i]; ++ for (idx=0; idxavailable_chnl_num; idx++) { ++ if (pBss->channel == priv->available_chnl[idx]) { ++ if (pBss->channel <= 14) ++ setChannelScore(idx, score2G, 0, MAX_2G_CHANNEL_NUM-1); ++ else ++ score5G[idx - idx_5G_begin] += 5; ++ break; ++ } ++ } ++ } ++#endif ++ ++ if (idx_2G_end >= 0) ++ for (i=0; i<=idx_2G_end; i++) ++ score[i] = score2G[i]; ++ if (idx_5G_begin >= 0) ++ for (i=idx_5G_begin; iavailable_chnl_num; i++) ++ score[i] = score5G[i - idx_5G_begin]; ++ ++#ifdef CONFIG_RTL_NEW_AUTOCH ++ { ++ u4Byte y, ch_begin=0, ch_end= priv->available_chnl_num; ++ ++ u4Byte do_ap_check = 1, ap_ratio = 0; ++ ++ if (idx_2G_end >= 0) ++ ch_end = idx_2G_end+1; ++ if (idx_5G_begin >= 0) ++ ch_begin = idx_5G_begin; ++ ++#ifdef ACS_DEBUG_INFO//for debug ++ printk("\n"); ++ for (y=ch_begin; yavailable_chnl[y], ++ priv->chnl_ss_mac_rx_count[y], ++ priv->chnl_ss_mac_rx_count_40M[y], ++ priv->chnl_ss_fa_count[y], ++ score[y]); ++ printk("\n"); ++#endif ++ ++#if defined(CONFIG_RTL_88E_SUPPORT) || defined(CONFIG_WLAN_HAL_8192EE) ++ if( pDM_Odm->SupportICType&(ODM_RTL8188E|ODM_RTL8192E)&& priv->pmib->dot11RFEntry.acs_type ) ++ { ++ u4Byte tmp_score[MAX_BSS_NUM]; ++ memcpy(tmp_score, score, sizeof(score)); ++ if (find_clean_channel(priv, ch_begin, ch_end, tmp_score)) { ++ //memcpy(score, tmp_score, sizeof(score)); ++#ifdef _DEBUG_RTL8192CD_ ++ printk("!! Found clean channel, select minimum FA channel\n"); ++#endif ++ goto USE_CLN_CH; ++ } ++#ifdef _DEBUG_RTL8192CD_ ++ printk("!! Not found clean channel, use NHM algorithm\n"); ++#endif ++ use_nhm = 1; ++USE_CLN_CH: ++ for (y=ch_begin; ynhm_cnt[y][i]; ++ for (j=0; jL, score: %d\n", ++ y+1, priv->nhm_cnt[y][9], priv->nhm_cnt[y][8], priv->nhm_cnt[y][7], ++ priv->nhm_cnt[y][6], priv->nhm_cnt[y][5], priv->nhm_cnt[y][4], ++ priv->nhm_cnt[y][3], priv->nhm_cnt[y][2], priv->nhm_cnt[y][1], ++ priv->nhm_cnt[y][0], score[y]); ++#endif ++ } ++ ++ if (!use_nhm) ++ memcpy(score, tmp_score, sizeof(score)); ++ ++ goto choose_ch; ++ } ++#endif ++ ++ // For each channel, weighting behind channels with MAC RX counter ++ //For each channel, weighting the channel with FA counter ++ ++ for (y=ch_begin; ychnl_ss_mac_rx_count[y]; ++ if (priv->chnl_ss_mac_rx_count[y] > 30) ++ do_ap_check = 0; ++ if( priv->chnl_ss_mac_rx_count[y] > MAC_RX_COUNT_THRESHOLD ) ++ traffic_check = 1; ++ ++#ifdef RTK_5G_SUPPORT ++ if (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G) ++#endif ++ { ++ if ((int)(y-4) >= (int)ch_begin) ++ score[y-4] += 2 * priv->chnl_ss_mac_rx_count[y]; ++ if ((int)(y-3) >= (int)ch_begin) ++ score[y-3] += 8 * priv->chnl_ss_mac_rx_count[y]; ++ if ((int)(y-2) >= (int)ch_begin) ++ score[y-2] += 8 * priv->chnl_ss_mac_rx_count[y]; ++ if ((int)(y-1) >= (int)ch_begin) ++ score[y-1] += 10 * priv->chnl_ss_mac_rx_count[y]; ++ if ((int)(y+1) < (int)ch_end) ++ score[y+1] += 10 * priv->chnl_ss_mac_rx_count[y]; ++ if ((int)(y+2) < (int)ch_end) ++ score[y+2] += 8 * priv->chnl_ss_mac_rx_count[y]; ++ if ((int)(y+3) < (int)ch_end) ++ score[y+3] += 8 * priv->chnl_ss_mac_rx_count[y]; ++ if ((int)(y+4) < (int)ch_end) ++ score[y+4] += 2 * priv->chnl_ss_mac_rx_count[y]; ++ } ++ ++ //this is for CH_LOAD caculation ++ if( priv->chnl_ss_cca_count[y] > priv->chnl_ss_fa_count[y]) ++ priv->chnl_ss_cca_count[y]-= priv->chnl_ss_fa_count[y]; ++ else ++ priv->chnl_ss_cca_count[y] = 0; ++ } ++ ++#ifdef ACS_DEBUG_INFO//for debug ++ printk("\n"); ++ for (y=ch_begin; yavailable_chnl[y], score[y]); ++ printk("\n"); ++#endif ++ ++ for (y=ch_begin; ychnl_ss_mac_rx_count_40M[y]) { ++ score[y] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; ++ if (priv->chnl_ss_mac_rx_count_40M[y] > 30) ++ do_ap_check = 0; ++ if( priv->chnl_ss_mac_rx_count_40M[y] > MAC_RX_COUNT_THRESHOLD ) ++ traffic_check = 1; ++ ++#ifdef RTK_5G_SUPPORT ++ if (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G) ++#endif ++ { ++ if ((int)(y-6) >= (int)ch_begin) ++ score[y-6] += 1 * priv->chnl_ss_mac_rx_count_40M[y]; ++ if ((int)(y-5) >= (int)ch_begin) ++ score[y-5] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; ++ if ((int)(y-4) >= (int)ch_begin) ++ score[y-4] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; ++ if ((int)(y-3) >= (int)ch_begin) ++ score[y-3] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; ++ if ((int)(y-2) >= (int)ch_begin) ++ score[y-2] += (5 * priv->chnl_ss_mac_rx_count_40M[y])/2; ++ if ((int)(y-1) >= (int)ch_begin) ++ score[y-1] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; ++ if ((int)(y+1) < (int)ch_end) ++ score[y+1] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; ++ if ((int)(y+2) < (int)ch_end) ++ score[y+2] += (5 * priv->chnl_ss_mac_rx_count_40M[y])/2; ++ if ((int)(y+3) < (int)ch_end) ++ score[y+3] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; ++ if ((int)(y+4) < (int)ch_end) ++ score[y+4] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; ++ if ((int)(y+5) < (int)ch_end) ++ score[y+5] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; ++ if ((int)(y+6) < (int)ch_end) ++ score[y+6] += 1 * priv->chnl_ss_mac_rx_count_40M[y]; ++ } ++ } ++ } ++ ++#ifdef ACS_DEBUG_INFO//for debug ++ printk("\n"); ++ for (y=ch_begin; yavailable_chnl[y], score[y]); ++ printk("\n"); ++ printk("4. do_ap_check=%d traffic_check=%d\n", do_ap_check, traffic_check); ++ printk("\n"); ++#endif ++ ++ if( traffic_check == 0) ++ fa_count_weighting = 5; ++ else ++ fa_count_weighting = 1; ++ ++ for (y=ch_begin; ychnl_ss_fa_count[y]; ++ } ++ ++#ifdef ACS_DEBUG_INFO//for debug ++ printk("\n"); ++ for (y=ch_begin; yavailable_chnl[y], score[y]); ++ printk("\n"); ++#endif ++ ++ if (do_ap_check) { ++ for (i=0; isite_survey->count; i++) { ++ pBss = &priv->site_survey->bss[i]; ++ for (y=ch_begin; ychannel == priv->available_chnl[y]) { ++ if (pBss->channel <= 14) { ++#ifdef ACS_DEBUG_INFO//for debug ++ printk("\n"); ++ printk("chnl[%d] has ap rssi=%d bw[0x%02x]\n", ++ pBss->channel, pBss->rssi, pBss->t_stamp[1]); ++ printk("\n"); ++#endif ++ if (pBss->rssi > 60) ++ ap_ratio = 4; ++ else if (pBss->rssi > 35) ++ ap_ratio = 2; ++ else ++ ap_ratio = 1; ++ ++ if ((pBss->t_stamp[1] & 0x6) == 0) { ++ score[y] += 50 * ap_ratio; ++ if ((int)(y-4) >= (int)ch_begin) ++ score[y-4] += 10 * ap_ratio; ++ if ((int)(y-3) >= (int)ch_begin) ++ score[y-3] += 20 * ap_ratio; ++ if ((int)(y-2) >= (int)ch_begin) ++ score[y-2] += 30 * ap_ratio; ++ if ((int)(y-1) >= (int)ch_begin) ++ score[y-1] += 40 * ap_ratio; ++ if ((int)(y+1) < (int)ch_end) ++ score[y+1] += 40 * ap_ratio; ++ if ((int)(y+2) < (int)ch_end) ++ score[y+2] += 30 * ap_ratio; ++ if ((int)(y+3) < (int)ch_end) ++ score[y+3] += 20 * ap_ratio; ++ if ((int)(y+4) < (int)ch_end) ++ score[y+4] += 10 * ap_ratio; ++ } ++ else if ((pBss->t_stamp[1] & 0x4) == 0) { ++ score[y] += 50 * ap_ratio; ++ if ((int)(y-3) >= (int)ch_begin) ++ score[y-3] += 20 * ap_ratio; ++ if ((int)(y-2) >= (int)ch_begin) ++ score[y-2] += 30 * ap_ratio; ++ if ((int)(y-1) >= (int)ch_begin) ++ score[y-1] += 40 * ap_ratio; ++ if ((int)(y+1) < (int)ch_end) ++ score[y+1] += 50 * ap_ratio; ++ if ((int)(y+2) < (int)ch_end) ++ score[y+2] += 50 * ap_ratio; ++ if ((int)(y+3) < (int)ch_end) ++ score[y+3] += 50 * ap_ratio; ++ if ((int)(y+4) < (int)ch_end) ++ score[y+4] += 50 * ap_ratio; ++ if ((int)(y+5) < (int)ch_end) ++ score[y+5] += 40 * ap_ratio; ++ if ((int)(y+6) < (int)ch_end) ++ score[y+6] += 30 * ap_ratio; ++ if ((int)(y+7) < (int)ch_end) ++ score[y+7] += 20 * ap_ratio; ++ } ++ else { ++ score[y] += 50 * ap_ratio; ++ if ((int)(y-7) >= (int)ch_begin) ++ score[y-7] += 20 * ap_ratio; ++ if ((int)(y-6) >= (int)ch_begin) ++ score[y-6] += 30 * ap_ratio; ++ if ((int)(y-5) >= (int)ch_begin) ++ score[y-5] += 40 * ap_ratio; ++ if ((int)(y-4) >= (int)ch_begin) ++ score[y-4] += 50 * ap_ratio; ++ if ((int)(y-3) >= (int)ch_begin) ++ score[y-3] += 50 * ap_ratio; ++ if ((int)(y-2) >= (int)ch_begin) ++ score[y-2] += 50 * ap_ratio; ++ if ((int)(y-1) >= (int)ch_begin) ++ score[y-1] += 50 * ap_ratio; ++ if ((int)(y+1) < (int)ch_end) ++ score[y+1] += 40 * ap_ratio; ++ if ((int)(y+2) < (int)ch_end) ++ score[y+2] += 30 * ap_ratio; ++ if ((int)(y+3) < (int)ch_end) ++ score[y+3] += 20 * ap_ratio; ++ } ++ } ++ else { ++ if ((pBss->t_stamp[1] & 0x6) == 0) { ++ score[y] += 500; ++ } ++ else if ((pBss->t_stamp[1] & 0x4) == 0) { ++ score[y] += 500; ++ if ((int)(y+1) < (int)ch_end) ++ score[y+1] += 500; ++ } ++ else { ++ score[y] += 500; ++ if ((int)(y-1) >= (int)ch_begin) ++ score[y-1] += 500; ++ } ++ } ++ break; ++ } ++ } ++ } ++ } ++ ++#ifdef ACS_DEBUG_INFO//for debug ++ printk("\n"); ++ for (y=ch_begin; yavailable_chnl[y],score[y]); ++ printk("\n"); ++#endif ++ ++#ifdef SS_CH_LOAD_PROC ++ ++ // caculate noise level -- suggested by wilson ++ for (y=ch_begin; ychnl_ss_fa_count[y]>1000) { ++ fa_lv = 100; ++ } else if (priv->chnl_ss_fa_count[y]>500) { ++ fa_lv = 34 * (priv->chnl_ss_fa_count[y]-500) / 500 + 66; ++ } else if (priv->chnl_ss_fa_count[y]>200) { ++ fa_lv = 33 * (priv->chnl_ss_fa_count[y] - 200) / 300 + 33; ++ } else if (priv->chnl_ss_fa_count[y]>100) { ++ fa_lv = 18 * (priv->chnl_ss_fa_count[y] - 100) / 100 + 15; ++ } else { ++ fa_lv = 15 * priv->chnl_ss_fa_count[y] / 100; ++ } ++ if (priv->chnl_ss_cca_count[y]>400) { ++ cca_lv = 100; ++ } else if (priv->chnl_ss_cca_count[y]>200) { ++ cca_lv = 34 * (priv->chnl_ss_cca_count[y] - 200) / 200 + 66; ++ } else if (priv->chnl_ss_cca_count[y]>80) { ++ cca_lv = 33 * (priv->chnl_ss_cca_count[y] - 80) / 120 + 33; ++ } else if (priv->chnl_ss_cca_count[y]>40) { ++ cca_lv = 18 * (priv->chnl_ss_cca_count[y] - 40) / 40 + 15; ++ } else { ++ cca_lv = 15 * priv->chnl_ss_cca_count[y] / 40; ++ } ++ ++ priv->chnl_ss_load[y] = (((fa_lv > cca_lv)? fa_lv : cca_lv)*75+((score[y]>100)?100:score[y])*25)/100; ++ ++ DEBUG_INFO("ch:%d f=%d (%d), c=%d (%d), fl=%d, cl=%d, sc=%d, cu=%d\n", ++ priv->available_chnl[y], ++ priv->chnl_ss_fa_count[y], fa_thd, ++ priv->chnl_ss_cca_count[y], cca_thd, ++ fa_lv, ++ cca_lv, ++ score[y], ++ priv->chnl_ss_load[y]); ++ ++ } ++#endif ++ } ++#endif ++ ++choose_ch: ++ ++#ifdef DFS ++ // heavy weighted DFS channel ++ if (idx_5G_begin >= 0){ ++ for (i=idx_5G_begin; iavailable_chnl_num; i++) { ++ if (!priv->pmib->dot11DFSEntry.disable_DFS && is_DFS_channel(priv->available_chnl[i]) ++ && (score[i]!= 0xffffffff)){ ++ score[i] += 1600; ++ } ++ } ++ } ++#endif ++ ++ ++//prevent Auto Channel selecting wrong channel in 40M mode----------------- ++ if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) ++ && priv->pshare->is_40m_bw) { ++#if 0 ++ if (GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset == 1) { ++ //Upper Primary Channel, cannot select the two lowest channels ++ if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) { ++ score[0] = 0xffffffff; ++ score[1] = 0xffffffff; ++ score[2] = 0xffffffff; ++ score[3] = 0xffffffff; ++ score[4] = 0xffffffff; ++ ++ score[13] = 0xffffffff; ++ score[12] = 0xffffffff; ++ score[11] = 0xffffffff; ++ } ++ ++// if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11A) { ++// score[idx_5G_begin] = 0xffffffff; ++// score[idx_5G_begin + 1] = 0xffffffff; ++// } ++ } ++ else if (GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset == 2) { ++ //Lower Primary Channel, cannot select the two highest channels ++ if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) { ++ score[0] = 0xffffffff; ++ score[1] = 0xffffffff; ++ score[2] = 0xffffffff; ++ ++ score[13] = 0xffffffff; ++ score[12] = 0xffffffff; ++ score[11] = 0xffffffff; ++ score[10] = 0xffffffff; ++ score[9] = 0xffffffff; ++ } ++ ++// if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11A) { ++// score[priv->available_chnl_num - 2] = 0xffffffff; ++// score[priv->available_chnl_num - 1] = 0xffffffff; ++// } ++ } ++#endif ++ for (i=0; i<=idx_2G_end; ++i) ++ if (priv->available_chnl[i] == 14) ++ score[i] = 0xffffffff; // mask chan14 ++ ++#ifdef RTK_5G_SUPPORT ++ if (idx_5G_begin >= 0) { ++ for (i=idx_5G_begin; iavailable_chnl_num; i++) { ++ int ch = priv->available_chnl[i]; ++ if(priv->available_chnl[i] > 144) ++ --ch; ++ if((ch%4) || ch==140 || ch == 164 ) //mask ch 140, ch 165, ch 184... ++ score[i] = 0xffffffff; ++ } ++ } ++#endif ++ ++ ++ } ++ ++ if (priv->pmib->dot11RFEntry.disable_ch1213) { ++ for (i=0; i<=idx_2G_end; ++i) { ++ int ch = priv->available_chnl[i]; ++ if ((ch == 12) || (ch == 13)) ++ score[i] = 0xffffffff; ++ } ++ } ++ ++ if (((priv->pmib->dot11StationConfigEntry.dot11RegDomain == DOMAIN_GLOBAL) || ++ (priv->pmib->dot11StationConfigEntry.dot11RegDomain == DOMAIN_WORLD_WIDE)) && ++ (idx_2G_end >= 11) && (idx_2G_end < 14)) { ++ score[13] = 0xffffffff; // mask chan14 ++ score[12] = 0xffffffff; // mask chan13 ++ score[11] = 0xffffffff; // mask chan12 ++ } ++ ++//------------------------------------------------------------------ ++ ++#ifdef _DEBUG_RTL8192CD_ ++ for (i=0; iavailable_chnl_num; i++) { ++ len += sprintf(tmpbuf+len, "ch%d:%u ", priv->available_chnl[i], score[i]); ++ } ++ strcat(tmpbuf, "\n"); ++ panic_printk("%s", tmpbuf); ++ ++#endif ++ ++ if ( (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) ++ && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_80)) ++ { ++ for (i=0; iavailable_chnl_num; i++) { ++ if (is80MChannel(priv->available_chnl, priv->available_chnl_num, priv->available_chnl[i])) { ++ tmpScore = 0; ++ for (j=0; j<4; j++) { ++ if ((tmpScore != 0xffffffff) && (score[i+j] != 0xffffffff)) ++ tmpScore += score[i+j]; ++ else ++ tmpScore = 0xffffffff; ++ } ++ tmpScore = tmpScore / 4; ++ if (minScore > tmpScore) { ++ minScore = tmpScore; ++ ++ tmpScore = 0xffffffff; ++ for (j=0; j<4; j++) { ++ if (score[i+j] < tmpScore) { ++ tmpScore = score[i+j]; ++ tmpIdx = i+j; ++ } ++ } ++ ++ idx = tmpIdx; ++ } ++ i += 3; ++ } ++ } ++ if (minScore == 0xffffffff) { ++ // there is no 80M channels ++ priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20; ++ for (i=0; iavailable_chnl_num; i++) { ++ if (score[i] < minScore) { ++ minScore = score[i]; ++ idx = i; ++ } ++ } ++ } ++ } ++ else if( (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) ++ && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_40)) ++ { ++ for (i=0; iavailable_chnl_num; i++) { ++ if(is40MChannel(priv->available_chnl,priv->available_chnl_num,priv->available_chnl[i])) { ++ tmpScore = 0; ++ for(j=0;j<2;j++) { ++ if ((tmpScore != 0xffffffff) && (score[i+j] != 0xffffffff)) ++ tmpScore += score[i+j]; ++ else ++ tmpScore = 0xffffffff; ++ } ++ tmpScore = tmpScore / 2; ++ if(minScore > tmpScore) { ++ minScore = tmpScore; ++ ++ tmpScore = 0xffffffff; ++ for (j=0; j<2; j++) { ++ if (score[i+j] < tmpScore) { ++ tmpScore = score[i+j]; ++ tmpIdx = i+j; ++ } ++ } ++ ++ idx = tmpIdx; ++ } ++ i += 1; ++ } ++ } ++ if (minScore == 0xffffffff) { ++ // there is no 40M channels ++ priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20; ++ for (i=0; iavailable_chnl_num; i++) { ++ if (score[i] < minScore) { ++ minScore = score[i]; ++ idx = i; ++ } ++ } ++ } ++ } ++ else if( (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G) ++ && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_40) ++ && (priv->available_chnl_num >= 8) ) ++ { ++ u4Byte groupScore[14]; ++ ++ memset(groupScore, 0xff , sizeof(groupScore)); ++ for (i=0; iavailable_chnl_num-4; i++) { ++ if (score[i] != 0xffffffff && score[i+4] != 0xffffffff) { ++ groupScore[i] = score[i] + score[i+4]; ++ DEBUG_INFO("groupScore, ch %d,%d: %d\n", i+1, i+5, groupScore[i]); ++ if (groupScore[i] < minScore) { ++#ifdef AUTOCH_SS_SPEEDUP ++ if(priv->pmib->miscEntry.autoch_1611_enable) ++ { ++ if(priv->available_chnl[i]==1 || priv->available_chnl[i]==6 || priv->available_chnl[i]==11) ++ { ++ minScore = groupScore[i]; ++ idx = i; ++ } ++ } ++ else ++#endif ++ { ++ minScore = groupScore[i]; ++ idx = i; ++ } ++ } ++ } ++ } ++ ++ if (score[idx] < score[idx+4]) { ++ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; ++ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; ++ } else { ++ idx = idx + 4; ++ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; ++ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; ++ } ++ } ++ else ++ { ++ for (i=0; iavailable_chnl_num; i++) { ++ if (score[i] < minScore) { ++#ifdef AUTOCH_SS_SPEEDUP ++ if(priv->pmib->miscEntry.autoch_1611_enable) ++ { ++ if(priv->available_chnl[i]==1 || priv->available_chnl[i]==6 || priv->available_chnl[i]==11) ++ { ++ minScore = score[i]; ++ idx = i; ++ } ++ } ++ else ++#endif ++ { ++ minScore = score[i]; ++ idx = i; ++ } ++ } ++ } ++ } ++ ++ if (IS_A_CUT_8881A(priv) && ++ (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_80)) { ++ if ((priv->available_chnl[idx] == 36) || ++ (priv->available_chnl[idx] == 52) || ++ (priv->available_chnl[idx] == 100) || ++ (priv->available_chnl[idx] == 116) || ++ (priv->available_chnl[idx] == 132) || ++ (priv->available_chnl[idx] == 149) || ++ (priv->available_chnl[idx] == 165)) ++ idx++; ++ else if ((priv->available_chnl[idx] == 48) || ++ (priv->available_chnl[idx] == 64) || ++ (priv->available_chnl[idx] == 112) || ++ (priv->available_chnl[idx] == 128) || ++ (priv->available_chnl[idx] == 144) || ++ (priv->available_chnl[idx] == 161) || ++ (priv->available_chnl[idx] == 177)) ++ idx--; ++ } ++ ++ minChan = priv->available_chnl[idx]; ++ ++ // skip channel 14 if don't support ofdm ++ if ((priv->pmib->dot11RFEntry.disable_ch14_ofdm) && ++ (minChan == 14)) { ++ score[idx] = 0xffffffff; ++ ++ minScore = 0xffffffff; ++ for (i=0; iavailable_chnl_num; i++) { ++ if (score[i] < minScore) { ++ minScore = score[i]; ++ idx = i; ++ } ++ } ++ minChan = priv->available_chnl[idx]; ++ } ++ ++#if 0 ++ //Check if selected channel available for 80M/40M BW or NOT ? ++ if(priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) ++ { ++ if(priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_80) ++ { ++ if(!is80MChannel(priv->available_chnl,priv->available_chnl_num,minChan)) ++ { ++ //printk("BW=80M, selected channel = %d is unavaliable! reduce to 40M\n", minChan); ++ //priv->pmib->dot11nConfigEntry.dot11nUse40M = HT_CHANNEL_WIDTH_20_40; ++ priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20_40; ++ } ++ } ++ ++ if(priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_40) ++ { ++ if(!is40MChannel(priv->available_chnl,priv->available_chnl_num,minChan)) ++ { ++ //printk("BW=40M, selected channel = %d is unavaliable! reduce to 20M\n", minChan); ++ //priv->pmib->dot11nConfigEntry.dot11nUse40M = HT_CHANNEL_WIDTH_20; ++ priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20; ++ } ++ } ++ } ++#endif ++ ++#ifdef CONFIG_RTL_NEW_AUTOCH ++ RTL_W32(RXERR_RPT, RXERR_RPT_RST); ++#endif ++ ++// auto adjust contro-sideband ++ if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) ++ && (priv->pshare->is_40m_bw ==1 || priv->pshare->is_40m_bw ==2)) { ++ ++#ifdef RTK_5G_SUPPORT ++ if (priv->pmib->dot11RFEntry.phyBandSelect & PHY_BAND_5G) { ++ if( (minChan>144) ? ((minChan-1)%8) : (minChan%8)) { ++ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; ++ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; ++ } else { ++ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; ++ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; ++ } ++ ++ } else ++#endif ++ { ++#if 0 ++#ifdef CONFIG_RTL_NEW_AUTOCH ++ unsigned int ch_max; ++ ++ if (priv->available_chnl[idx_2G_end] >= 13) ++ ch_max = 13; ++ else ++ ch_max = priv->available_chnl[idx_2G_end]; ++ ++ if ((minChan >= 5) && (minChan <= (ch_max-5))) { ++ if (score[minChan+4] > score[minChan-4]) { // what if some channels were cancelled? ++ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; ++ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; ++ } else { ++ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; ++ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; ++ } ++ } else ++#endif ++ { ++ if (minChan < 5) { ++ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; ++ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; ++ } ++ else if (minChan > 7) { ++ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; ++ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; ++ } ++ } ++#endif ++ } ++ } ++//----------------------- ++ ++#if defined(__ECOS) && defined(CONFIG_SDIO_HCI) ++ panic_printk("Auto channel choose ch:%d\n", minChan); ++#else ++#ifdef _DEBUG_RTL8192CD_ ++ panic_printk("Auto channel choose ch:%d\n", minChan); ++#endif ++#endif ++#ifdef ACS_DEBUG_INFO//for debug ++ printk("7. minChan:%d 2nd_offset:%d\n", minChan, priv->pshare->offset_2nd_chan); ++#endif ++ ++ return minChan; ++} ++*/ ++ ++#endif ++ ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_acs.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_acs.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_acs.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_acs.h 2018-02-11 21:44:27.154146193 +0200 +@@ -0,0 +1,106 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMACS_H__ ++#define __PHYDMACS_H__ ++ ++#define ACS_VERSION "1.1" /*20150729 by YuChen*/ ++#define CLM_VERSION "1.0" ++ ++#define ODM_MAX_CHANNEL_2G 14 ++#define ODM_MAX_CHANNEL_5G 24 ++ ++// For phydm_AutoChannelSelectSettingAP() ++#define STORE_DEFAULT_NHM_SETTING 0 ++#define RESTORE_DEFAULT_NHM_SETTING 1 ++#define ACS_NHM_SETTING 2 ++ ++typedef struct _ACS_ ++{ ++ BOOLEAN bForceACSResult; ++ u1Byte CleanChannel_2G; ++ u1Byte CleanChannel_5G; ++ u2Byte Channel_Info_2G[2][ODM_MAX_CHANNEL_2G]; //Channel_Info[1]: Channel Score, Channel_Info[2]:Channel_Scan_Times ++ u2Byte Channel_Info_5G[2][ODM_MAX_CHANNEL_5G]; ++ ++#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) ++ u1Byte ACS_Step; ++ // NHM Count 0-11 ++ u1Byte NHM_Cnt[14][11]; ++ ++ // AC-Series, for storing previous setting ++ u4Byte Reg0x990; ++ u4Byte Reg0x994; ++ u4Byte Reg0x998; ++ u4Byte Reg0x99C; ++ u1Byte Reg0x9A0; // u1Byte ++ ++ // N-Series, for storing previous setting ++ u4Byte Reg0x890; ++ u4Byte Reg0x894; ++ u4Byte Reg0x898; ++ u4Byte Reg0x89C; ++ u1Byte Reg0xE28; // u1Byte ++#endif ++ ++}ACS, *PACS; ++ ++ ++VOID ++odm_AutoChannelSelectInit( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++odm_AutoChannelSelectReset( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++odm_AutoChannelSelect( ++ IN PVOID pDM_VOID, ++ IN u1Byte Channel ++); ++ ++u1Byte ++ODM_GetAutoChannelSelectResult( ++ IN PVOID pDM_VOID, ++ IN u1Byte Band ++); ++ ++#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) ++ ++VOID ++phydm_AutoChannelSelectSettingAP( ++ IN PVOID pDM_VOID, ++ IN u4Byte Setting, // 0: STORE_DEFAULT_NHM_SETTING; 1: RESTORE_DEFAULT_NHM_SETTING, 2: ACS_NHM_SETTING ++ IN u4Byte acs_step ++); ++ ++VOID ++phydm_GetNHMStatisticsAP( ++ IN PVOID pDM_VOID, ++ IN u4Byte idx, // @ 2G, Real channel number = idx+1 ++ IN u4Byte acs_step ++); ++ ++#endif //#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) ++ ++#endif //#ifndef __PHYDMACS_H__ +\ Ingen nyrad vid filslut +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.c 2018-02-11 21:44:27.154146193 +0200 +@@ -0,0 +1,1101 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++#if WPP_SOFTWARE_TRACE ++#include "PhyDM_Adaptivity.tmh" ++#endif ++#endif ++ ++ ++VOID ++Phydm_CheckAdaptivity( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); ++ ++ if (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) { ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if (pDM_Odm->APTotalNum > Adaptivity->APNumTH) { ++ pDM_Odm->Adaptivity_enable = FALSE; ++ pDM_Odm->adaptivity_flag = FALSE; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("AP total num > %d!!, disable adaptivity\n", Adaptivity->APNumTH)); ++ } else ++#endif ++ { ++ if (Adaptivity->DynamicLinkAdaptivity || Adaptivity->AcsForAdaptivity) { ++ if (pDM_Odm->bLinked && Adaptivity->bCheck == FALSE) { ++ Phydm_NHMCounterStatistics(pDM_Odm); ++ Phydm_CheckEnvironment(pDM_Odm); ++ } else if (!pDM_Odm->bLinked) ++ Adaptivity->bCheck = FALSE; ++ } else { ++ pDM_Odm->Adaptivity_enable = TRUE; ++ ++ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) ++ pDM_Odm->adaptivity_flag = FALSE; ++ else ++ pDM_Odm->adaptivity_flag = TRUE; ++ } ++ } ++ } else { ++ pDM_Odm->Adaptivity_enable = FALSE; ++ pDM_Odm->adaptivity_flag = FALSE; ++ } ++ ++ ++ ++} ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++BOOLEAN ++Phydm_CheckChannelPlan( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); ++ ++ if (pMgntInfo->RegEnableAdaptivity == 2) { ++ if (pDM_Odm->Carrier_Sense_enable == FALSE) { /*check domain Code for Adaptivity or CarrierSense*/ ++ if ((*pDM_Odm->pBandType == ODM_BAND_5G) && ++ !(pDM_Odm->odm_Regulation5G == REGULATION_ETSI || pDM_Odm->odm_Regulation5G == REGULATION_WW)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity skip 5G domain code : %d\n", pDM_Odm->odm_Regulation5G)); ++ pDM_Odm->Adaptivity_enable = FALSE; ++ pDM_Odm->adaptivity_flag = FALSE; ++ return TRUE; ++ } else if ((*pDM_Odm->pBandType == ODM_BAND_2_4G) && ++ !(pDM_Odm->odm_Regulation2_4G == REGULATION_ETSI || pDM_Odm->odm_Regulation2_4G == REGULATION_WW)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity skip 2.4G domain code : %d\n", pDM_Odm->odm_Regulation2_4G)); ++ pDM_Odm->Adaptivity_enable = FALSE; ++ pDM_Odm->adaptivity_flag = FALSE; ++ return TRUE; ++ ++ } else if ((*pDM_Odm->pBandType != ODM_BAND_2_4G) && (*pDM_Odm->pBandType != ODM_BAND_5G)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity neither 2G nor 5G band, return\n")); ++ pDM_Odm->Adaptivity_enable = FALSE; ++ pDM_Odm->adaptivity_flag = FALSE; ++ return TRUE; ++ } ++ } else { ++ if ((*pDM_Odm->pBandType == ODM_BAND_5G) && ++ !(pDM_Odm->odm_Regulation5G == REGULATION_MKK || pDM_Odm->odm_Regulation5G == REGULATION_WW)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense skip 5G domain code : %d\n", pDM_Odm->odm_Regulation5G)); ++ pDM_Odm->Adaptivity_enable = FALSE; ++ pDM_Odm->adaptivity_flag = FALSE; ++ return TRUE; ++ } ++ ++ else if ((*pDM_Odm->pBandType == ODM_BAND_2_4G) && ++ !(pDM_Odm->odm_Regulation2_4G == REGULATION_MKK || pDM_Odm->odm_Regulation2_4G == REGULATION_WW)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense skip 2.4G domain code : %d\n", pDM_Odm->odm_Regulation2_4G)); ++ pDM_Odm->Adaptivity_enable = FALSE; ++ pDM_Odm->adaptivity_flag = FALSE; ++ return TRUE; ++ ++ } else if ((*pDM_Odm->pBandType != ODM_BAND_2_4G) && (*pDM_Odm->pBandType != ODM_BAND_5G)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense neither 2G nor 5G band, return\n")); ++ pDM_Odm->Adaptivity_enable = FALSE; ++ pDM_Odm->adaptivity_flag = FALSE; ++ return TRUE; ++ } ++ } ++ } ++ ++ return FALSE; ++ ++} ++#endif ++ ++VOID ++Phydm_NHMCounterStatisticsInit( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ /*PHY parameters initialize for n series*/ ++ ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11N+ 2, 0xC350); /*0x894[31:16]=0x0xC350 Time duration for NHM unit: us, 0xc350=200ms*/ ++ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N + 2, 0xffff); /*0x890[31:16]=0xffff th_9, th_10*/ ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0xffffff50); /*0x898=0xffffff52 th_3, th_2, th_1, th_0*/ ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffffff); /*0x89c=0xffffffff th_7, th_6, th_5, th_4*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_FPGA0_IQK_11N, bMaskByte0, 0xff); /*0xe28[7:0]=0xff th_8*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10 | BIT9 | BIT8, 0x1); /*0x890[10:8]=1 ignoreCCA ignore PHYTXON enable CCX*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT7, 0x1); /*0xc0c[7]=1 max power among all RX ants*/ ++ } ++#if (RTL8195A_SUPPORT == 0) ++ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ /*PHY parameters initialize for ac series*/ ++ ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC+ 2, 0xC350); /*0x990[31:16]=0xC350 Time duration for NHM unit: us, 0xc350=200ms*/ ++ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC + 2, 0xffff); /*0x994[31:16]=0xffff th_9, th_10*/ ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0xffffff50); /*0x998=0xffffff52 th_3, th_2, th_1, th_0*/ ++ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffffff); /*0x99c=0xffffffff th_7, th_6, th_5, th_4*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0, 0xff); /*0x9a0[7:0]=0xff th_8*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT8 | BIT9 | BIT10, 0x1); /*0x994[10:8]=1 ignoreCCA ignore PHYTXON enable CCX*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_9E8_11AC, BIT0, 0x1); /*0x9e8[7]=1 max power among all RX ants*/ ++ ++ } ++#endif ++} ++ ++VOID ++Phydm_NHMCounterStatistics( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) ++ return; ++ ++ /*Get NHM report*/ ++ Phydm_GetNHMCounterStatistics(pDM_Odm); ++ ++ /*Reset NHM counter*/ ++ Phydm_NHMCounterStatisticsReset(pDM_Odm); ++} ++ ++VOID ++Phydm_GetNHMCounterStatistics( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte value32 = 0; ++#if (RTL8195A_SUPPORT == 0) ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_CNT_11AC, bMaskDWord); ++ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++#endif ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_CNT_11N, bMaskDWord); ++ ++ pDM_Odm->NHM_cnt_0 = (u1Byte)(value32 & bMaskByte0); ++ pDM_Odm->NHM_cnt_1 = (u1Byte)((value32 & bMaskByte1) >> 8); ++ ++} ++ ++VOID ++Phydm_NHMCounterStatisticsReset( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 0); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 1); ++ } ++#if (RTL8195A_SUPPORT == 0) ++ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 0); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 1); ++ } ++ ++#endif ++ ++} ++ ++VOID ++Phydm_SetEDCCAThreshold( ++ IN PVOID pDM_VOID, ++ IN s1Byte H2L, ++ IN s1Byte L2H ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskByte2|bMaskByte0, (u4Byte)((u1Byte)L2H|(u1Byte)H2L<<16)); ++#if (RTL8195A_SUPPORT == 0) ++ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, bMaskLWord, (u2Byte)((u1Byte)L2H|(u1Byte)H2L<<8)); ++#endif ++ ++} ++ ++VOID ++Phydm_SetLNA( ++ IN PVOID pDM_VOID, ++ IN PhyDM_set_LNA type ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8188E | ODM_RTL8192E)) { ++ if (type == PhyDM_disable_LNA) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0000f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0x37f82); /*disable LNA*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); ++ if (pDM_Odm->RFType > ODM_1T1R) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x0000f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0x37f82); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); ++ } ++ } else if (type == PhyDM_enable_LNA) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0000f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0x77f82); /*back to normal*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); ++ if (pDM_Odm->RFType > ODM_1T1R) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x0000f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0x77f82); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); ++ } ++ } ++ } else if (pDM_Odm->SupportICType & ODM_RTL8723B) { ++ if (type == PhyDM_disable_LNA) { ++ /*S0*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0001f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xe6137); /*disable LNA*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); ++ /*S1*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x43, 0xfffff, 0x3008d); /*select Rx mode and disable LNA*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x0); ++ } else if (type == PhyDM_enable_LNA) { ++ /*S0*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0001f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xe6177); /*disable LNA*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); ++ /*S1*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x43, 0xfffff, 0x300bd); /*select Rx mode and disable LNA*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x0); ++ } ++ ++ } else if (pDM_Odm->SupportICType & ODM_RTL8812) { ++ if (type == PhyDM_disable_LNA) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x3f7ff); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xc22bf); /*disable LNA*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); ++ if (pDM_Odm->RFType > ODM_1T1R) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x3f7ff); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0xc22bf); /*disable LNA*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); ++ } ++ } else if (type == PhyDM_enable_LNA) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x3f7ff); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xc26bf); /*disable LNA*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); ++ if (pDM_Odm->RFType > ODM_1T1R) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x3f7ff); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0xc26bf); /*disable LNA*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); ++ } ++ } ++ } else if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8881A)) { ++ if (type == PhyDM_disable_LNA) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0002f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xfb09b); /*disable LNA*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); ++ } else if (type == PhyDM_enable_LNA) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0002f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xfb0bb); /*disable LNA*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); ++ } ++ } ++} ++ ++ ++ ++VOID ++Phydm_SetTRxMux( ++ IN PVOID pDM_VOID, ++ IN PhyDM_Trx_MUX_Type txMode, ++ IN PhyDM_Trx_MUX_Type rxMode ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N, BIT3 | BIT2 | BIT1, txMode); /*set TXmod to standby mode to remove outside noise affect*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N, BIT22 | BIT21 | BIT20, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ ++ if (pDM_Odm->RFType > ODM_1T1R) { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT3 | BIT2 | BIT1, txMode); /*set TXmod to standby mode to remove outside noise affect*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT22 | BIT21 | BIT20, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ ++ } ++ } ++#if (RTL8195A_SUPPORT == 0) ++ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC, BIT11 | BIT10 | BIT9 | BIT8, txMode); /*set TXmod to standby mode to remove outside noise affect*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC, BIT7 | BIT6 | BIT5 | BIT4, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ ++ if (pDM_Odm->RFType > ODM_1T1R) { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC_B, BIT11 | BIT10 | BIT9 | BIT8, txMode); /*set TXmod to standby mode to remove outside noise affect*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC_B, BIT7 | BIT6 | BIT5 | BIT4, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ ++ } ++ } ++#endif ++ ++} ++ ++VOID ++Phydm_MACEDCCAState( ++ IN PVOID pDM_VOID, ++ IN PhyDM_MACEDCCA_Type State ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ if (State == PhyDM_IGNORE_EDCCA) { ++ ODM_SetMACReg(pDM_Odm, REG_TX_PTCL_CTRL, BIT15, 1); /*ignore EDCCA reg520[15]=1*/ ++/* ODM_SetMACReg(pDM_Odm, REG_RD_CTRL, BIT11, 0); *//*reg524[11]=0*/ ++ } else { /*don't set MAC ignore EDCCA signal*/ ++ ODM_SetMACReg(pDM_Odm, REG_TX_PTCL_CTRL, BIT15, 0); /*don't ignore EDCCA reg520[15]=0*/ ++/* ODM_SetMACReg(pDM_Odm, REG_RD_CTRL, BIT11, 1); *//*reg524[11]=1 */ ++ } ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("EDCCA enable State = %d\n", State)); ++ ++} ++ ++BOOLEAN ++Phydm_CalNHMcnt( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u2Byte Base = 0; ++ ++ Base = pDM_Odm->NHM_cnt_0 + pDM_Odm->NHM_cnt_1; ++ ++ if (Base != 0) { ++ pDM_Odm->NHM_cnt_0 = ((pDM_Odm->NHM_cnt_0) << 8) / Base; ++ pDM_Odm->NHM_cnt_1 = ((pDM_Odm->NHM_cnt_1) << 8) / Base; ++ } ++ if ((pDM_Odm->NHM_cnt_0 - pDM_Odm->NHM_cnt_1) >= 100) ++ return TRUE; /*clean environment*/ ++ else ++ return FALSE; /*noisy environment*/ ++ ++} ++ ++ ++VOID ++Phydm_CheckEnvironment( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); ++ BOOLEAN isCleanEnvironment = FALSE; ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++#endif ++ ++ if (Adaptivity->bFirstLink == TRUE) { ++ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) ++ pDM_Odm->adaptivity_flag = FALSE; ++ else ++ pDM_Odm->adaptivity_flag = TRUE; ++ ++ Adaptivity->bFirstLink = FALSE; ++ return; ++ } else { ++ if (Adaptivity->NHMWait < 3) { /*Start enter NHM after 4 NHMWait*/ ++ Adaptivity->NHMWait++; ++ Phydm_NHMCounterStatistics(pDM_Odm); ++ return; ++ } else { ++ Phydm_NHMCounterStatistics(pDM_Odm); ++ isCleanEnvironment = Phydm_CalNHMcnt(pDM_Odm); ++ if (isCleanEnvironment == TRUE) { ++ pDM_Odm->TH_L2H_ini = Adaptivity->TH_L2H_ini_backup; /*adaptivity mode*/ ++ pDM_Odm->TH_EDCCA_HL_diff = Adaptivity->TH_EDCCA_HL_diff_backup; ++ ++ pDM_Odm->Adaptivity_enable = TRUE; ++ ++ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) ++ pDM_Odm->adaptivity_flag = FALSE; ++ else ++ pDM_Odm->adaptivity_flag = TRUE; ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ priv->pshare->rf_ft_var.isCleanEnvironment = TRUE; ++#endif ++ } else { ++ if (!Adaptivity->AcsForAdaptivity) { ++ pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2; /*mode2*/ ++ pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2; ++ ++ pDM_Odm->adaptivity_flag = FALSE; ++ pDM_Odm->Adaptivity_enable = FALSE; ++ } ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ priv->pshare->rf_ft_var.isCleanEnvironment = FALSE; ++#endif ++ } ++ Adaptivity->NHMWait = 0; ++ Adaptivity->bFirstLink = TRUE; ++ Adaptivity->bCheck = TRUE; ++ } ++ ++ } ++ ++ ++} ++ ++VOID ++Phydm_SearchPwdBLowerBound( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); ++ u4Byte value32 = 0; ++ u1Byte cnt; ++ u1Byte txEdcca1 = 0, txEdcca0 = 0; ++ BOOLEAN bAdjust = TRUE; ++ s1Byte TH_L2H_dmc, TH_H2L_dmc, IGI_target = 0x32; ++ s1Byte Diff; ++ u1Byte IGI = Adaptivity->IGI_Base + 30 + (u1Byte)pDM_Odm->TH_L2H_ini - (u1Byte)pDM_Odm->TH_EDCCA_HL_diff; ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) ++ Phydm_SetLNA(pDM_Odm, PhyDM_disable_LNA); ++ else { ++ Phydm_SetTRxMux(pDM_Odm, PhyDM_STANDBY_MODE, PhyDM_STANDBY_MODE); ++ odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_0, 0x7e); ++ } ++ ++ Diff = IGI_target - (s1Byte)IGI; ++ TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; ++ if (TH_L2H_dmc > 10) ++ TH_L2H_dmc = 10; ++ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; ++ ++ Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); ++ ODM_delay_ms(5); ++ ++ while (bAdjust) { ++ for (cnt = 0; cnt < 20; cnt++) { ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11N, bMaskDWord); ++#if (RTL8195A_SUPPORT == 0) ++ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC, bMaskDWord); ++#endif ++ if (value32 & BIT30 && (pDM_Odm->SupportICType & (ODM_RTL8723B | ODM_RTL8188E))) ++ txEdcca1 = txEdcca1 + 1; ++ else if (value32 & BIT29) ++ txEdcca1 = txEdcca1 + 1; ++ else ++ txEdcca0 = txEdcca0 + 1; ++ } ++ ++ if (txEdcca1 > 1) { ++ IGI = IGI - 1; ++ TH_L2H_dmc = TH_L2H_dmc + 1; ++ if (TH_L2H_dmc > 10) ++ TH_L2H_dmc = 10; ++ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; ++ ++ Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); ++ if (TH_L2H_dmc == 10) { ++ bAdjust = FALSE; ++ Adaptivity->H2L_lb = TH_H2L_dmc; ++ Adaptivity->L2H_lb = TH_L2H_dmc; ++ pDM_Odm->Adaptivity_IGI_upper = IGI; ++ } ++ ++ txEdcca1 = 0; ++ txEdcca0 = 0; ++ ++ } else { ++ bAdjust = FALSE; ++ Adaptivity->H2L_lb = TH_H2L_dmc; ++ Adaptivity->L2H_lb = TH_L2H_dmc; ++ pDM_Odm->Adaptivity_IGI_upper = IGI; ++ txEdcca1 = 0; ++ txEdcca0 = 0; ++ } ++ } ++ ++ pDM_Odm->Adaptivity_IGI_upper = pDM_Odm->Adaptivity_IGI_upper - pDM_Odm->DCbackoff; ++ Adaptivity->H2L_lb = Adaptivity->H2L_lb + pDM_Odm->DCbackoff; ++ Adaptivity->L2H_lb = Adaptivity->L2H_lb + pDM_Odm->DCbackoff; ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) ++ Phydm_SetLNA(pDM_Odm, PhyDM_enable_LNA); ++ else { ++ Phydm_SetTRxMux(pDM_Odm, PhyDM_TX_MODE, PhyDM_RX_MODE); ++ odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_0, NONE); ++ } ++ ++ Phydm_SetEDCCAThreshold(pDM_Odm, 0x7f, 0x7f); /*resume to no link state*/ ++} ++ ++BOOLEAN ++phydm_reSearchCondition( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ /*PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY);*/ ++ u1Byte Adaptivity_IGI_upper; ++ /*s1Byte TH_L2H_dmc, IGI_target = 0x32;*/ ++ /*s1Byte Diff;*/ ++ ++ Adaptivity_IGI_upper = pDM_Odm->Adaptivity_IGI_upper + pDM_Odm->DCbackoff; ++ ++ /*TH_L2H_dmc = 10;*/ ++ ++ /*Diff = TH_L2H_dmc - pDM_Odm->TH_L2H_ini;*/ ++ /*lowest_IGI_upper = IGI_target - Diff;*/ ++ ++ /*if ((Adaptivity_IGI_upper - lowest_IGI_upper) <= 5)*/ ++ if (Adaptivity_IGI_upper <= 0x26) ++ return TRUE; ++ else ++ return FALSE; ++ ++} ++ ++VOID ++phydm_adaptivityInfoInit( ++ IN PVOID pDM_VOID, ++ IN PHYDM_ADAPINFO_E CmnInfo, ++ IN u4Byte Value ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); ++ ++ switch (CmnInfo) { ++ case PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE: ++ pDM_Odm->Carrier_Sense_enable = (BOOLEAN)Value; ++ break; ++ ++ case PHYDM_ADAPINFO_DCBACKOFF: ++ pDM_Odm->DCbackoff = (u1Byte)Value; ++ break; ++ ++ case PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY: ++ Adaptivity->DynamicLinkAdaptivity = (BOOLEAN)Value; ++ break; ++ ++ case PHYDM_ADAPINFO_TH_L2H_INI: ++ pDM_Odm->TH_L2H_ini = (s1Byte)Value; ++ break; ++ ++ case PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF: ++ pDM_Odm->TH_EDCCA_HL_diff = (s1Byte)Value; ++ break; ++ ++ case PHYDM_ADAPINFO_AP_NUM_TH: ++ Adaptivity->APNumTH = (u1Byte)Value; ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++} ++ ++ ++ ++VOID ++Phydm_AdaptivityInit( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); ++ s1Byte IGItarget = 0x32; ++ /*pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable;*/ ++ ++#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) ++ ++ if (pDM_Odm->Carrier_Sense_enable == FALSE) { ++ if (pDM_Odm->TH_L2H_ini == 0) ++ pDM_Odm->TH_L2H_ini = 0xf5; ++ } else ++ pDM_Odm->TH_L2H_ini = 0xa; ++ ++ if (pDM_Odm->TH_EDCCA_HL_diff == 0) ++ pDM_Odm->TH_EDCCA_HL_diff = 7; ++#if(DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++ if (pDM_Odm->WIFITest == TRUE || pDM_Odm->mp_mode == TRUE) ++#else ++ if ((pDM_Odm->WIFITest & RT_WIFI_LOGO) == TRUE) ++#endif ++ pDM_Odm->EDCCA_enable = FALSE; /*even no adaptivity, we still enable EDCCA, AP side use mib control*/ ++ else ++ pDM_Odm->EDCCA_enable = TRUE; ++ ++#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ ++ if (pDM_Odm->Carrier_Sense_enable) { ++ pDM_Odm->TH_L2H_ini = 0xa; ++ pDM_Odm->TH_EDCCA_HL_diff = 7; ++ } else { ++ pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_default; /*set by mib*/ ++ pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_default; ++ } ++ ++ if (priv->pshare->rf_ft_var.adaptivity_enable == 3) ++ Adaptivity->AcsForAdaptivity = TRUE; ++ else ++ Adaptivity->AcsForAdaptivity = FALSE; ++ ++ if (priv->pshare->rf_ft_var.adaptivity_enable == 2) ++ Adaptivity->DynamicLinkAdaptivity = TRUE; ++ else ++ Adaptivity->DynamicLinkAdaptivity = FALSE; ++ ++ priv->pshare->rf_ft_var.isCleanEnvironment = FALSE; ++ ++#endif ++ ++ pDM_Odm->Adaptivity_IGI_upper = 0; ++ pDM_Odm->Adaptivity_enable = FALSE; /*use this flag to decide enable or disable*/ ++ ++ pDM_Odm->TH_L2H_ini_mode2 = 20; ++ pDM_Odm->TH_EDCCA_HL_diff_mode2 = 8; ++ Adaptivity->TH_L2H_ini_backup = pDM_Odm->TH_L2H_ini; ++ Adaptivity->TH_EDCCA_HL_diff_backup = pDM_Odm->TH_EDCCA_HL_diff; ++ ++ Adaptivity->IGI_Base = 0x32; ++ Adaptivity->IGI_target = 0x1c; ++ Adaptivity->H2L_lb = 0; ++ Adaptivity->L2H_lb = 0; ++ Adaptivity->NHMWait = 0; ++ Adaptivity->bCheck = FALSE; ++ Adaptivity->bFirstLink = TRUE; ++ Adaptivity->AdajustIGILevel = 0; ++ Adaptivity->bStopEDCCA = FALSE; ++ Adaptivity->backupH2L = 0; ++ Adaptivity->backupL2H = 0; ++ ++ Phydm_MACEDCCAState(pDM_Odm, PhyDM_DONT_IGNORE_EDCCA); ++ ++ /*Search pwdB lower bound*/ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11N, bMaskDWord, 0x208); ++#if (RTL8195A_SUPPORT == 0) ++ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC, bMaskDWord, 0x209); ++#endif ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_GAIN_IDX_EDCCA) { ++ /*ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DOWN_OPT_11N, BIT12 | BIT11 | BIT10, 0x7);*/ /*interfernce need > 2^x us, and then EDCCA will be 1*/ ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_PAGE_B1_97F, BIT30, 0x1); /*set to page B1*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DCNF_97F, BIT27 | BIT26, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_PAGE_B1_97F, BIT30, 0x0); ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ if (priv->pshare->rf_ft_var.adaptivity_enable == 1) ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT13, 0x1); /*0: mean, 1:max pwdB*/ ++#endif ++ } else ++ ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DCNF_11N, BIT21 | BIT20, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ ++ } ++#if (RTL8195A_SUPPORT == 0) ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_GAIN_IDX_EDCCA) { /*8814a no need to find pwdB lower bound, maybe*/ ++ /*ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DOWN_OPT, BIT30 | BIT29 | BIT28, 0x7);*/ /*interfernce need > 2^x us, and then EDCCA will be 1*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_ACBB_EDCCA_ENHANCE, BIT29 | BIT28, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ ++ } ++ ++ if (!(pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA))) { ++ Phydm_SearchPwdBLowerBound(pDM_Odm); ++ if (phydm_reSearchCondition(pDM_Odm)) ++ Phydm_SearchPwdBLowerBound(pDM_Odm); ++ } ++#endif ++ ++/*we need to consider PwdB upper bound for 8814 later IC*/ ++ Adaptivity->AdajustIGILevel = (u1Byte)((pDM_Odm->TH_L2H_ini + IGItarget) - PwdBUpperBound + DFIRloss); /*IGI = L2H - PwdB - DFIRloss*/ ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("TH_L2H_ini = 0x%x, TH_EDCCA_HL_diff = 0x%x, Adaptivity->AdajustIGILevel = 0x%x\n", pDM_Odm->TH_L2H_ini, pDM_Odm->TH_EDCCA_HL_diff, Adaptivity->AdajustIGILevel)); ++ ++ /*Check this later on Windows*/ ++ /*phydm_setEDCCAThresholdAPI(pDM_Odm, pDM_DigTable->CurIGValue);*/ ++ ++} ++ ++ ++VOID ++Phydm_Adaptivity( ++ IN PVOID pDM_VOID, ++ IN u1Byte IGI ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ s1Byte TH_L2H_dmc, TH_H2L_dmc; ++ s1Byte Diff = 0, IGI_target; ++ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ BOOLEAN bFwCurrentInPSMode = FALSE; ++ ++ pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_FW_PSMODE_STATUS, (pu1Byte)(&bFwCurrentInPSMode)); ++ ++ /*Disable EDCCA mode while under LPS mode, added by Roger, 2012.09.14.*/ ++ if (bFwCurrentInPSMode) ++ return; ++#endif ++ ++ if ((pDM_Odm->EDCCA_enable == FALSE) || (Adaptivity->bStopEDCCA == TRUE)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Disable EDCCA!!!\n")); ++ return; ++ } ++ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("adaptivity disable, enable EDCCA mode!!!\n")); ++ pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2; ++ pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2; ++ } ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ else{ ++ if (Phydm_CheckChannelPlan(pDM_Odm) || (pDM_Odm->APTotalNum > Adaptivity->APNumTH)) { ++ pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2; ++ pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2; ++ } else { ++ pDM_Odm->TH_L2H_ini = Adaptivity->TH_L2H_ini_backup; ++ pDM_Odm->TH_EDCCA_HL_diff = Adaptivity->TH_EDCCA_HL_diff_backup; ++ } ++ } ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("odm_Adaptivity() =====>\n")); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("IGI_Base=0x%x, TH_L2H_ini = %d, TH_EDCCA_HL_diff = %d\n", ++ Adaptivity->IGI_Base, pDM_Odm->TH_L2H_ini, pDM_Odm->TH_EDCCA_HL_diff)); ++#if (RTL8195A_SUPPORT == 0) ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ /*fix AC series when enable EDCCA hang issue*/ ++ ODM_SetBBReg(pDM_Odm, 0x800, BIT10, 1); /*ADC_mask disable*/ ++ ODM_SetBBReg(pDM_Odm, 0x800, BIT10, 0); /*ADC_mask enable*/ ++ } ++#endif ++ if (*pDM_Odm->pBandWidth == ODM_BW20M) /*CHANNEL_WIDTH_20*/ ++ IGI_target = Adaptivity->IGI_Base; ++ else if (*pDM_Odm->pBandWidth == ODM_BW40M) ++ IGI_target = Adaptivity->IGI_Base + 2; ++#if (RTL8195A_SUPPORT == 0) ++ else if (*pDM_Odm->pBandWidth == ODM_BW80M) ++ IGI_target = Adaptivity->IGI_Base + 2; ++#endif ++ else ++ IGI_target = Adaptivity->IGI_Base; ++ Adaptivity->IGI_target = (u1Byte) IGI_target; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("BandWidth=%s, IGI_target=0x%x, DynamicLinkAdaptivity = %d, AcsForAdaptivity = %d\n", ++ (*pDM_Odm->pBandWidth == ODM_BW80M) ? "80M" : ((*pDM_Odm->pBandWidth == ODM_BW40M) ? "40M" : "20M"), IGI_target, Adaptivity->DynamicLinkAdaptivity, Adaptivity->AcsForAdaptivity)); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("RSSI_min = %d, Adaptivity->AdajustIGILevel= 0x%x, adaptivity_flag = %d, Adaptivity_enable = %d\n", ++ pDM_Odm->RSSI_Min, Adaptivity->AdajustIGILevel, pDM_Odm->adaptivity_flag, pDM_Odm->Adaptivity_enable)); ++ ++ if ((Adaptivity->DynamicLinkAdaptivity == TRUE) && (!pDM_Odm->bLinked) && (pDM_Odm->Adaptivity_enable == FALSE)) { ++ Phydm_SetEDCCAThreshold(pDM_Odm, 0x7f, 0x7f); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("In DynamicLink mode(noisy) and No link, Turn off EDCCA!!\n")); ++ return; ++ } ++ ++ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { ++ if ((Adaptivity->AdajustIGILevel > IGI) && (pDM_Odm->Adaptivity_enable == TRUE)) ++ Diff = Adaptivity->AdajustIGILevel - IGI; ++ ++ TH_L2H_dmc = pDM_Odm->TH_L2H_ini - Diff + IGI_target; ++ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; ++ } ++#if (RTL8195A_SUPPORT == 0) ++ else { ++ Diff = IGI_target - (s1Byte)IGI; ++ TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; ++ if (TH_L2H_dmc > 10 && (pDM_Odm->Adaptivity_enable == TRUE)) ++ TH_L2H_dmc = 10; ++ ++ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; ++ ++ /*replace lower bound to prevent EDCCA always equal 1*/ ++ if (TH_H2L_dmc < Adaptivity->H2L_lb) ++ TH_H2L_dmc = Adaptivity->H2L_lb; ++ if (TH_L2H_dmc < Adaptivity->L2H_lb) ++ TH_L2H_dmc = Adaptivity->L2H_lb; ++ } ++#endif ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("IGI=0x%x, TH_L2H_dmc = %d, TH_H2L_dmc = %d\n", IGI, TH_L2H_dmc, TH_H2L_dmc)); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity_IGI_upper=0x%x, H2L_lb = 0x%x, L2H_lb = 0x%x\n", pDM_Odm->Adaptivity_IGI_upper, Adaptivity->H2L_lb, Adaptivity->L2H_lb)); ++ ++ Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); ++ ++ if (pDM_Odm->Adaptivity_enable == TRUE) ++ ODM_SetMACReg(pDM_Odm, REG_RD_CTRL, BIT11, 1); ++ ++ return; ++} ++ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++VOID ++Phydm_AdaptivityBSOD( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); ++ u1Byte count = 0; ++ u4Byte u4Value; ++ ++ /* ++ 1. turn off RF (TRX Mux in standby mode) ++ 2. H2C mac id drop ++ 3. ignore EDCCA ++ 4. wait for clear FIFO ++ 5. don't ignore EDCCA ++ 6. turn on RF (TRX Mux in TRx mdoe) ++ 7. H2C mac id resume ++ */ ++ ++ RT_TRACE(COMP_MLME, DBG_WARNING, ("MAC id drop packet!!!!!\n")); ++ ++ pAdapter->dropPktByMacIdCnt++; ++ pMgntInfo->bDropPktInProgress = TRUE; ++ ++ pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_MAX_Q_PAGE_NUM, (pu1Byte)(&u4Value)); ++ RT_TRACE(COMP_INIT, DBG_LOUD, ("Queue Reserved Page Number = 0x%08x\n", u4Value)); ++ pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_AVBL_Q_PAGE_NUM, (pu1Byte)(&u4Value)); ++ RT_TRACE(COMP_INIT, DBG_LOUD, ("Available Queue Page Number = 0x%08x\n", u4Value)); ++ ++ /*Standby mode*/ ++ Phydm_SetTRxMux(pDM_Odm, PhyDM_STANDBY_MODE, PhyDM_STANDBY_MODE); ++ ODM_Write_DIG(pDM_Odm, 0x20); ++ ++ /*H2C mac id drop*/ ++ MacIdIndicateDisconnect(pAdapter); ++ ++ /*Ignore EDCCA*/ ++ Phydm_MACEDCCAState(pDM_Odm, PhyDM_IGNORE_EDCCA); ++ ++ delay_ms(50); ++ count = 5; ++ ++ /*Resume EDCCA*/ ++ Phydm_MACEDCCAState(pDM_Odm, PhyDM_DONT_IGNORE_EDCCA); ++ ++ /*Turn on TRx mode*/ ++ Phydm_SetTRxMux(pDM_Odm, PhyDM_TX_MODE, PhyDM_RX_MODE); ++ ODM_Write_DIG(pDM_Odm, 0x20); ++ ++ /*Resume H2C macid*/ ++ MacIdRecoverMediaStatus(pAdapter); ++ ++ pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_AVBL_Q_PAGE_NUM, (pu1Byte)(&u4Value)); ++ RT_TRACE(COMP_INIT, DBG_LOUD, ("Available Queue Page Number = 0x%08x\n", u4Value)); ++ ++ pMgntInfo->bDropPktInProgress = FALSE; ++ RT_TRACE(COMP_MLME, DBG_WARNING, ("End of MAC id drop packet, spent %dms\n", count * 10)); ++ ++} ++ ++#endif ++ ++/*This API is for solving USB can't Tx problem due to USB3.0 interference in 2.4G*/ ++VOID ++phydm_pauseEDCCA( ++ IN PVOID pDM_VOID, ++ IN BOOLEAN bPasueEDCCA ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ u1Byte IGI = pDM_DigTable->CurIGValue; ++ s1Byte Diff = 0; ++ ++ if (bPasueEDCCA) { ++ Adaptivity->bStopEDCCA = TRUE; ++ ++ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { ++ if (Adaptivity->AdajustIGILevel > IGI) ++ Diff = Adaptivity->AdajustIGILevel - IGI; ++ ++ Adaptivity->backupL2H = pDM_Odm->TH_L2H_ini - Diff + Adaptivity->IGI_target; ++ Adaptivity->backupH2L = Adaptivity->backupL2H - pDM_Odm->TH_EDCCA_HL_diff; ++ } ++#if (RTL8195A_SUPPORT == 0) ++ else { ++ Diff = Adaptivity->IGI_target - (s1Byte)IGI; ++ Adaptivity->backupL2H = pDM_Odm->TH_L2H_ini + Diff; ++ if (Adaptivity->backupL2H > 10) ++ Adaptivity->backupL2H = 10; ++ ++ Adaptivity->backupH2L = Adaptivity->backupL2H - pDM_Odm->TH_EDCCA_HL_diff; ++ ++ /*replace lower bound to prevent EDCCA always equal 1*/ ++ if (Adaptivity->backupH2L < Adaptivity->H2L_lb) ++ Adaptivity->backupH2L = Adaptivity->H2L_lb; ++ if (Adaptivity->backupL2H < Adaptivity->L2H_lb) ++ Adaptivity->backupL2H = Adaptivity->L2H_lb; ++ } ++#endif ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("pauseEDCCA : L2Hbak = 0x%x, H2Lbak = 0x%x, IGI = 0x%x\n", Adaptivity->backupL2H, Adaptivity->backupH2L, IGI)); ++ ++ /*Disable EDCCA*/ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if (PlatformIsWorkItemScheduled(&(Adaptivity->phydm_pauseEDCCAWorkItem)) == FALSE) ++ PlatformScheduleWorkItem(&(Adaptivity->phydm_pauseEDCCAWorkItem)); ++#else ++ phydm_pauseEDCCA_WorkItemCallback(pDM_Odm); ++#endif ++ ++ } else { ++ ++ Adaptivity->bStopEDCCA = FALSE; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("resumeEDCCA : L2Hbak = 0x%x, H2Lbak = 0x%x, IGI = 0x%x\n", Adaptivity->backupL2H, Adaptivity->backupH2L, IGI)); ++ /*Resume EDCCA*/ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if (PlatformIsWorkItemScheduled(&(Adaptivity->phydm_resumeEDCCAWorkItem)) == FALSE) ++ PlatformScheduleWorkItem(&(Adaptivity->phydm_resumeEDCCAWorkItem)); ++#else ++ phydm_resumeEDCCA_WorkItemCallback(pDM_Odm); ++#endif ++ ++ } ++ ++} ++ ++ ++VOID ++phydm_pauseEDCCA_WorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#else ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#endif ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskByte2|bMaskByte0, (u4Byte)(0x7f|0x7f<<16)); ++#if (RTL8195A_SUPPORT == 0) ++ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, bMaskLWord, (u2Byte)(0x7f|0x7f<<8)); ++#endif ++ ++} ++ ++VOID ++phydm_resumeEDCCA_WorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#else ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#endif ++ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskByte2|bMaskByte0, (u4Byte)((u1Byte)Adaptivity->backupL2H|(u1Byte)Adaptivity->backupH2L<<16)); ++#if (RTL8195A_SUPPORT == 0) ++ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, bMaskLWord, (u2Byte)((u1Byte)Adaptivity->backupL2H|(u1Byte)Adaptivity->backupH2L<<8)); ++#endif ++ ++} ++ ++ ++VOID ++phydm_setEDCCAThresholdAPI( ++ IN PVOID pDM_VOID, ++ IN u1Byte IGI ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); ++ s1Byte TH_L2H_dmc, TH_H2L_dmc; ++ s1Byte Diff = 0, IGI_target = 0x32; ++ ++ if (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) { ++ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { ++ if (Adaptivity->AdajustIGILevel > IGI) ++ Diff = Adaptivity->AdajustIGILevel - IGI; ++ ++ TH_L2H_dmc = pDM_Odm->TH_L2H_ini - Diff + IGI_target; ++ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; ++ } ++#if (RTL8195A_SUPPORT == 0) ++ else { ++ Diff = IGI_target - (s1Byte)IGI; ++ TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; ++ if (TH_L2H_dmc > 10) ++ TH_L2H_dmc = 10; ++ ++ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; ++ ++ /*replace lower bound to prevent EDCCA always equal 1*/ ++ if (TH_H2L_dmc < Adaptivity->H2L_lb) ++ TH_H2L_dmc = Adaptivity->H2L_lb; ++ if (TH_L2H_dmc < Adaptivity->L2H_lb) ++ TH_L2H_dmc = Adaptivity->L2H_lb; ++ } ++#endif ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("API :IGI=0x%x, TH_L2H_dmc = %d, TH_H2L_dmc = %d\n", IGI, TH_L2H_dmc, TH_H2L_dmc)); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("API :Adaptivity_IGI_upper=0x%x, H2L_lb = 0x%x, L2H_lb = 0x%x\n", pDM_Odm->Adaptivity_IGI_upper, Adaptivity->H2L_lb, Adaptivity->L2H_lb)); ++ ++ Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); ++ } ++ ++} ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.h 2018-02-11 21:44:27.154146193 +0200 +@@ -0,0 +1,222 @@ ++ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMADAPTIVITY_H__ ++#define __PHYDMADAPTIVITY_H__ ++ ++#define ADAPTIVITY_VERSION "9.3.4" /*20160512 changed by Kevin, modify 0xce8[13]=1 for 8197F when adaptivity is enabled*/ ++ ++#define PwdBUpperBound 7 ++#define DFIRloss 5 ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++typedef enum _tag_PhyDM_REGULATION_Type { ++ REGULATION_FCC = 0, ++ REGULATION_MKK = 1, ++ REGULATION_ETSI = 2, ++ REGULATION_WW = 3, ++ ++ MAX_REGULATION_NUM = 4 ++} PhyDM_REGULATION_TYPE; ++#endif ++ ++typedef enum _PHYDM_ADAPTIVITY_Info_Definition { ++ PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE = 0, ++ PHYDM_ADAPINFO_DCBACKOFF, ++ PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY, ++ PHYDM_ADAPINFO_TH_L2H_INI, ++ PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, ++ PHYDM_ADAPINFO_AP_NUM_TH ++ ++} PHYDM_ADAPINFO_E; ++ ++ ++ ++typedef enum tag_PhyDM_set_LNA { ++ PhyDM_disable_LNA = 0, ++ PhyDM_enable_LNA = 1, ++} PhyDM_set_LNA; ++ ++ ++typedef enum tag_PhyDM_TRx_MUX_Type ++{ ++ PhyDM_SHUTDOWN = 0, ++ PhyDM_STANDBY_MODE = 1, ++ PhyDM_TX_MODE = 2, ++ PhyDM_RX_MODE = 3 ++}PhyDM_Trx_MUX_Type; ++ ++typedef enum tag_PhyDM_MACEDCCA_Type ++{ ++ PhyDM_IGNORE_EDCCA = 0, ++ PhyDM_DONT_IGNORE_EDCCA = 1 ++}PhyDM_MACEDCCA_Type; ++ ++typedef struct _ADAPTIVITY_STATISTICS { ++ s1Byte TH_L2H_ini_backup; ++ s1Byte TH_EDCCA_HL_diff_backup; ++ s1Byte IGI_Base; ++ u1Byte IGI_target; ++ u1Byte NHMWait; ++ s1Byte H2L_lb; ++ s1Byte L2H_lb; ++ BOOLEAN bFirstLink; ++ BOOLEAN bCheck; ++ BOOLEAN DynamicLinkAdaptivity; ++ u1Byte APNumTH; ++ u1Byte AdajustIGILevel; ++ BOOLEAN AcsForAdaptivity; ++ s1Byte backupL2H; ++ s1Byte backupH2L; ++ BOOLEAN bStopEDCCA; ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ RT_WORK_ITEM phydm_pauseEDCCAWorkItem; ++ RT_WORK_ITEM phydm_resumeEDCCAWorkItem; ++#endif ++} ADAPTIVITY_STATISTICS, *PADAPTIVITY_STATISTICS; ++ ++VOID ++phydm_pauseEDCCA( ++ IN PVOID pDM_VOID, ++ IN BOOLEAN bPasueEDCCA ++); ++ ++VOID ++Phydm_CheckAdaptivity( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++Phydm_CheckEnvironment( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++Phydm_NHMCounterStatisticsInit( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++Phydm_NHMCounterStatistics( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++Phydm_NHMCounterStatisticsReset( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++Phydm_GetNHMCounterStatistics( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++Phydm_MACEDCCAState( ++ IN PVOID pDM_VOID, ++ IN PhyDM_MACEDCCA_Type State ++); ++ ++VOID ++Phydm_SetEDCCAThreshold( ++ IN PVOID pDM_VOID, ++ IN s1Byte H2L, ++ IN s1Byte L2H ++); ++ ++VOID ++Phydm_SetTRxMux( ++ IN PVOID pDM_VOID, ++ IN PhyDM_Trx_MUX_Type txMode, ++ IN PhyDM_Trx_MUX_Type rxMode ++); ++ ++BOOLEAN ++Phydm_CalNHMcnt( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++Phydm_SearchPwdBLowerBound( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++phydm_adaptivityInfoInit( ++ IN PVOID pDM_VOID, ++ IN PHYDM_ADAPINFO_E CmnInfo, ++ IN u4Byte Value ++ ); ++ ++VOID ++Phydm_AdaptivityInit( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++Phydm_Adaptivity( ++ IN PVOID pDM_VOID, ++ IN u1Byte IGI ++ ); ++ ++VOID ++phydm_setEDCCAThresholdAPI( ++ IN PVOID pDM_VOID, ++ IN u1Byte IGI ++); ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++Phydm_DisableEDCCA( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++Phydm_DynamicEDCCA( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++Phydm_AdaptivityBSOD( ++ IN PVOID pDM_VOID ++); ++ ++#endif ++ ++VOID ++phydm_pauseEDCCA_WorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ); ++ ++VOID ++phydm_resumeEDCCA_WorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.c 2018-02-11 21:44:27.154146193 +0200 +@@ -0,0 +1,374 @@ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++#if ((RTL8197F_SUPPORT == 1)||(RTL8822B_SUPPORT == 1)) ++#include "rtl8197f/Hal8197FPhyReg.h" ++#include "WlanHAL/HalMac88XX/halmac_reg2.h" ++#else ++#include "WlanHAL/HalHeader/HalComReg.h" ++#endif ++#endif ++ ++#if (PHYDM_LA_MODE_SUPPORT == 1) ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++BOOLEAN ++ADCSmp_BufferAllocate( ++ IN PADAPTER Adapter, ++ IN PRT_ADCSMP AdcSmp ++ ) ++{ ++ PRT_ADCSMP_STRING ADCSmpBuf = &(AdcSmp->ADCSmpBuf); ++ ++ if (ADCSmpBuf->Length == 0) { ++ if (PlatformAllocateMemoryWithZero(Adapter, (void **)&(ADCSmpBuf->Octet), ADCSmpBuf->buffer_size) == RT_STATUS_SUCCESS) ++ ADCSmpBuf->Length = ADCSmpBuf->buffer_size; ++ else ++ return FALSE; ++ } ++ ++ return TRUE; ++} ++#endif ++ ++VOID ++ADCSmp_GetTxPktBuf( ++ IN PVOID pDM_VOID, ++ IN PRT_ADCSMP_STRING ADCSmpBuf ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte i = 0, value32, DataL = 0, DataH = 0; ++ u4Byte Addr, Finish_Addr; ++ u4Byte End_Addr = (ADCSmpBuf->start_pos + ADCSmpBuf->buffer_size)-1; /*End_Addr = 0x3ffff;*/ ++ BOOLEAN bRoundUp; ++ static u4Byte page = 0xFF; ++ u4Byte while_cnt = 0; ++ ++ ODM_Memory_Set(pDM_Odm, ADCSmpBuf->Octet, 0, ADCSmpBuf->Length); ++ ODM_Write1Byte(pDM_Odm, 0x0106, 0x69); ++ ++ DbgPrint("%s\n", __func__); ++ ++ value32 = ODM_Read4Byte(pDM_Odm, 0x7c0); ++ bRoundUp = (BOOLEAN)((value32 & BIT31) >> 31); ++ Finish_Addr = (value32 & 0x7FFF0000) >> 16; /*Reg7C0[30:16]: finish addr (unit: 8byte)*/ ++ ++ if (bRoundUp) ++ Addr = (Finish_Addr+1)<<3; ++ else ++ Addr = ADCSmpBuf->start_pos; ++ ++ DbgPrint("bRoundUp = %d, Finish_Addr=0x%x, value32=0x%x\n", bRoundUp, Finish_Addr, value32); ++ DbgPrint("End_Addr = %x, ADCSmpBuf->start_pos = 0x%x, ADCSmpBuf->buffer_size = 0x%x\n", End_Addr, ADCSmpBuf->start_pos, ADCSmpBuf->buffer_size); ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ watchdog_stop(pDM_Odm->priv); ++#endif ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) { ++ for (Addr = 0x0, i = 0; Addr < End_Addr; Addr += 8, i += 2) { /*64K byte*/ ++ if ((Addr&0xfff) == 0) ++ ODM_SetBBReg(pDM_Odm, 0x0140, bMaskLWord, 0x780+(Addr >> 12)); ++ DataL = ODM_GetBBReg(pDM_Odm, 0x8000+(Addr&0xfff), bMaskDWord); ++ DataH = ODM_GetBBReg(pDM_Odm, 0x8000+(Addr&0xfff)+4, bMaskDWord); ++ ++ DbgPrint("%08x%08x\n", DataH, DataL); ++ } ++ } else { ++ while (Addr != (Finish_Addr<<3)) { ++ if (page != (Addr >> 12)) { ++ /*Reg140=0x780+(Addr>>12), Addr=0x30~0x3F, total 16 pages*/ ++ page = (Addr >> 12); ++ } ++ ODM_SetBBReg(pDM_Odm, 0x0140, bMaskLWord, 0x780+page); ++ ++ /*pDataL = 0x8000+(Addr&0xfff);*/ ++ DataL = ODM_GetBBReg(pDM_Odm, 0x8000+(Addr&0xfff), bMaskDWord); ++ DataH = ODM_GetBBReg(pDM_Odm, 0x8000+(Addr&0xfff)+4, bMaskDWord); ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ ADCSmpBuf->Octet[i] = DataH; ++ ADCSmpBuf->Octet[i+1] = DataL; ++#endif ++ DbgPrint("%08x%08x\n", DataH, DataL); ++ i = i + 2; ++ ++ if ((Addr+8) >= End_Addr) ++ Addr = ADCSmpBuf->start_pos; ++ else ++ Addr = Addr + 8; ++ ++ while_cnt = while_cnt + 1; ++ if (while_cnt > ((ADCSmpBuf->buffer_size)>>3)) ++ break; ++ } ++ } ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ watchdog_resume(pDM_Odm->priv); ++#endif ++} ++ ++ ++VOID ++ADCSmp_Start( ++ IN PVOID pDM_VOID, ++ IN PRT_ADCSMP AdcSmp ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte tmpU1b; ++ PRT_ADCSMP_STRING Buffer = &(AdcSmp->ADCSmpBuf); ++ RT_ADCSMP_TRIG_SIG_SEL TrigSigSel = AdcSmp->ADCSmpTrigSigSel; ++ u1Byte backup_DMA, while_cnt = 0; ++ ++ DbgPrint("%s\n", __func__); ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) ++ ODM_SetBBReg(pDM_Odm, 0x9a0, 0xf00, AdcSmp->ADCSmpDmaDataSigSel); /*0x9A0[11:8]*/ ++ else ++ ODM_SetBBReg(pDM_Odm , ODM_ADC_TRIGGER_Jaguar2, 0xf00, AdcSmp->ADCSmpDmaDataSigSel); /*0x95C[11:8]*/ ++ ++ ODM_Write1Byte(pDM_Odm, 0x7c0+1, AdcSmp->ADCSmpTriggerTime); ++ ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) ++ ODM_SetBBReg(pDM_Odm, 0xd00, BIT26, 0x1); ++ else { /*for 8814A and 8822B?*/ ++ ODM_Write1Byte(pDM_Odm, 0x198c, 0x7); ++ ODM_Write1Byte(pDM_Odm, 0x8b4, 0x80); ++ } ++ ++ if (AdcSmp->ADCSmpTrigSel == ADCSMP_MAC_TRIG) { /* trigger by MAC*/ ++ if (TrigSigSel == ADCSMP_TRIG_REG) { /* manual trigger 0x7C0[5] = 0 -> 1*/ ++ ODM_Write1Byte(pDM_Odm, 0x7c0, 0xCB); /*0x7C0[7:0]=8'b1100_1011*/ ++ ODM_Write1Byte(pDM_Odm, 0x7c0, 0xEB); /*0x7C0[7:0]=8'b1110_1011*/ ++ } else if (TrigSigSel == ADCSMP_TRIG_CCA) ++ ODM_Write1Byte(pDM_Odm, 0x7c0, 0x8B); /*0x7C0[7:0]=8'b1000_1011*/ ++ else if (TrigSigSel == ADCSMP_TRIG_CRCFAIL) ++ ODM_Write1Byte(pDM_Odm, 0x7c0, 0x4B); /*0x7C0[7:0]=8'b0100_1011*/ ++ else if (TrigSigSel == ADCSMP_TRIG_CRCOK) ++ ODM_Write1Byte(pDM_Odm, 0x7c0, 0x0B); /*0x7C0[7:0]=8'b0000_1011*/ ++ } else { /*trigger by BB*/ ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) ++ ODM_SetBBReg(pDM_Odm, 0x9a0, 0x1f, TrigSigSel); /*0x9A0[4:0]*/ ++ else ++ ODM_SetBBReg(pDM_Odm , ODM_ADC_TRIGGER_Jaguar2, 0x1f, TrigSigSel); /*0x95C[4:0], 0x1F: trigger by CCA*/ ++ ODM_Write1Byte(pDM_Odm, 0x7c0, 0x03); /*0x7C0[7:0]=8'b0000_0011*/ ++ } ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ watchdog_stop(pDM_Odm->priv); ++#endif ++ ++ /*Polling time always use 100ms, when it exceed 2s, break while loop*/ ++ do { ++ tmpU1b = ODM_Read1Byte(pDM_Odm, 0x7c0); ++ ++ if (AdcSmp->ADCSmpState != ADCSMP_STATE_SET) { ++ DbgPrint("ADCSmpState != ADCSMP_STATE_SET\n"); ++ break; ++ ++ } else if (tmpU1b & BIT1) { ++ ODM_delay_ms(100); ++ while_cnt = while_cnt + 1; ++ continue; ++ } else { ++ DbgPrint("%s Query OK\n", __func__); ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) ++ ODM_SetBBReg(pDM_Odm, 0x7c0, BIT0, 0x0); ++ break; ++ } ++ } while (while_cnt < 20); ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ watchdog_resume(pDM_Odm->priv); ++#if (RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) { ++ /*Stop DMA*/ ++ backup_DMA = ODM_GetMACReg(pDM_Odm, 0x300, bMaskLWord); ++ ODM_SetMACReg(pDM_Odm, 0x300, 0x7fff, backup_DMA|0x7fff); ++ ++ /*move LA mode content from IMEM to TxPktBuffer ++ Src : OCPBASE_IMEM 0x00000000 ++ Dest : OCPBASE_TXBUF 0x18780000 ++ Len : 64K*/ ++ GET_HAL_INTERFACE(pDM_Odm->priv)->InitDDMAHandler(pDM_Odm->priv, OCPBASE_IMEM, OCPBASE_TXBUF, 0x10000); ++ } ++#endif ++#endif ++ ++ if (AdcSmp->ADCSmpState == ADCSMP_STATE_SET) ++ ADCSmp_GetTxPktBuf(pDM_Odm, Buffer); ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) ++ ODM_SetMACReg(pDM_Odm, 0x300, 0x7fff, backup_DMA); /*Resume DMA*/ ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ if (AdcSmp->ADCSmpState == ADCSMP_STATE_SET) ++ AdcSmp->ADCSmpState = ADCSMP_STATE_QUERY; ++#endif ++ ++ DbgPrint("%s Status %d\n", __func__, AdcSmp->ADCSmpState); ++} ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++VOID ++ADCSmpWorkItemCallback( ++ IN PVOID pContext ++ ) ++{ ++ PADAPTER Adapter = (PADAPTER)pContext; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); ++ ++ ADCSmp_Start(pDM_Odm, AdcSmp); ++ ADCSmp_Stop(pDM_Odm); ++} ++#endif ++ ++VOID ++ADCSmp_Set( ++ IN PVOID pDM_VOID, ++ IN RT_ADCSMP_TRIG_SEL TrigSel, ++ IN RT_ADCSMP_TRIG_SIG_SEL TrigSigSel, ++ IN u1Byte DmaDataSigSel, ++ IN u1Byte TriggerTime, ++ IN u2Byte PollingTime ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ BOOLEAN retValue = TRUE; ++ PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); ++ ++ AdcSmp->ADCSmpTrigSel = TrigSel; ++ AdcSmp->ADCSmpTrigSigSel = TrigSigSel; ++ AdcSmp->ADCSmpDmaDataSigSel = DmaDataSigSel; ++ AdcSmp->ADCSmpTriggerTime = TriggerTime; ++ AdcSmp->ADCSmpPollingTime = PollingTime; ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ if (AdcSmp->ADCSmpState != ADCSMP_STATE_IDLE) ++ retValue = FALSE; ++ else if (AdcSmp->ADCSmpBuf.Length == 0) ++ retValue = ADCSmp_BufferAllocate(pDM_Odm->Adapter, AdcSmp); ++#endif ++ ++ if (retValue) { ++ AdcSmp->ADCSmpState = ADCSMP_STATE_SET; ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ ODM_ScheduleWorkItem(&(AdcSmp->ADCSmpWorkItem)); ++#else ++ ADCSmp_Start(pDM_Odm, AdcSmp); ++#endif ++ } ++ ++ DbgPrint("ADCSmpState %d Return Status %d\n", AdcSmp->ADCSmpState, retValue); ++} ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++RT_STATUS ++ADCSmp_Query( ++ IN PVOID pDM_VOID, ++ IN ULONG InformationBufferLength, ++ OUT PVOID InformationBuffer, ++ OUT PULONG BytesWritten ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); ++ RT_STATUS retStatus = RT_STATUS_SUCCESS; ++ PRT_ADCSMP_STRING ADCSmpBuf = &(AdcSmp->ADCSmpBuf); ++ ++ DbgPrint("%s ADCSmpState %d", __func__, AdcSmp->ADCSmpState); ++ ++ if (InformationBufferLength != ADCSmpBuf->buffer_size) { ++ *BytesWritten = 0; ++ retStatus = RT_STATUS_RESOURCE; ++ } else if (ADCSmpBuf->Length != ADCSmpBuf->buffer_size) { ++ *BytesWritten = 0; ++ retStatus = RT_STATUS_RESOURCE; ++ } else if (AdcSmp->ADCSmpState != ADCSMP_STATE_QUERY) { ++ *BytesWritten = 0; ++ retStatus = RT_STATUS_PENDING; ++ } else { ++ ODM_MoveMemory(pDM_Odm, InformationBuffer, ADCSmpBuf->Octet, ADCSmpBuf->buffer_size); ++ *BytesWritten = ADCSmpBuf->buffer_size; ++ ++ AdcSmp->ADCSmpState = ADCSMP_STATE_IDLE; ++ } ++ ++ DbgPrint("Return Status %d\n", retStatus); ++ ++ return retStatus; ++} ++#endif ++ ++VOID ++ADCSmp_Stop( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); ++ ++ AdcSmp->ADCSmpState = ADCSMP_STATE_IDLE; ++ ++ DbgPrint("%s status %d\n", __func__, AdcSmp->ADCSmpState); ++} ++ ++VOID ++ADCSmp_Init( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); ++ PRT_ADCSMP_STRING ADCSmpBuf = &(AdcSmp->ADCSmpBuf); ++ ++ AdcSmp->ADCSmpState = ADCSMP_STATE_IDLE; ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) { ++ ADCSmpBuf->start_pos = 0x30000; ++ ADCSmpBuf->buffer_size = 0x10000; ++ } else if (pDM_Odm->SupportICType & ODM_RTL8822B) { ++ ADCSmpBuf->start_pos = 0x20000; ++ ADCSmpBuf->buffer_size = 0x20000; ++ } else if (pDM_Odm->SupportICType & ODM_RTL8197F) { ++ ADCSmpBuf->start_pos = 0x00000; ++ ADCSmpBuf->buffer_size = 0x10000; ++ } else if (pDM_Odm->SupportICType & ODM_RTL8821C) { ++ ADCSmpBuf->start_pos = 0x8000; ++ ADCSmpBuf->buffer_size = 0x8000; ++ } ++ ++} ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++VOID ++ADCSmp_DeInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); ++ PRT_ADCSMP_STRING ADCSmpBuf = &(AdcSmp->ADCSmpBuf); ++ ++ ADCSmp_Stop(pDM_Odm); ++ ++ if (ADCSmpBuf->Length != 0x0) { ++ ODM_FreeMemory(pDM_Odm, ADCSmpBuf->Octet, ADCSmpBuf->Length); ++ ADCSmpBuf->Length = 0x0; ++ } ++} ++ ++#endif ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.h 2018-02-11 21:44:27.154146193 +0200 +@@ -0,0 +1,91 @@ ++#ifndef __INC_ADCSMP_H ++#define __INC_ADCSMP_H ++ ++typedef struct _RT_ADCSMP_STRING { ++ pu4Byte Octet; ++ u4Byte Length; ++ u4Byte buffer_size; ++ u4Byte start_pos; ++} RT_ADCSMP_STRING, *PRT_ADCSMP_STRING; ++ ++ ++typedef enum _RT_ADCSMP_TRIG_SEL { ++ ADCSMP_BB_TRIG, ++ ADCSMP_MAC_TRIG, ++} RT_ADCSMP_TRIG_SEL, *PRT_ADCSMP_TRIG_SEL; ++ ++ ++typedef enum _RT_ADCSMP_TRIG_SIG_SEL { ++ ADCSMP_TRIG_CRCOK, ++ ADCSMP_TRIG_CRCFAIL, ++ ADCSMP_TRIG_CCA, ++ ADCSMP_TRIG_REG, ++} RT_ADCSMP_TRIG_SIG_SEL, *PRT_ADCSMP_TRIG_SIG_SEL; ++ ++ ++typedef enum _RT_ADCSMP_STATE { ++ ADCSMP_STATE_IDLE, ++ ADCSMP_STATE_SET, ++ ADCSMP_STATE_QUERY, ++} RT_ADCSMP_STATE, *PRT_ADCSMP_STATE; ++ ++ ++typedef struct _RT_ADCSMP { ++ RT_ADCSMP_STRING ADCSmpBuf; ++ RT_ADCSMP_STATE ADCSmpState; ++ RT_ADCSMP_TRIG_SEL ADCSmpTrigSel; ++ RT_ADCSMP_TRIG_SIG_SEL ADCSmpTrigSigSel; ++ u1Byte ADCSmpDmaDataSigSel; ++ u1Byte ADCSmpTriggerTime; ++ u2Byte ADCSmpPollingTime; ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ RT_WORK_ITEM ADCSmpWorkItem; ++ #endif ++} RT_ADCSMP, *PRT_ADCSMP; ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++VOID ++ADCSmpWorkItemCallback( ++ IN PVOID pContext ++); ++#endif ++ ++VOID ++ADCSmp_Set( ++ IN PVOID pDM_VOID, ++ IN RT_ADCSMP_TRIG_SEL TrigSel, ++ IN RT_ADCSMP_TRIG_SIG_SEL TrigSigSel, ++ IN u1Byte DmaDataSigSel, ++ IN u1Byte TriggerTime, ++ IN u2Byte PollingTime ++); ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++RT_STATUS ++ADCSmp_Query( ++ IN PVOID pDM_VOID, ++ IN ULONG InformationBufferLength, ++ OUT PVOID InformationBuffer, ++ OUT PULONG BytesWritten ++); ++#endif ++VOID ++ADCSmp_Stop( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++ADCSmp_Init( ++ IN PVOID pDM_VOID ++); ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++VOID ++ADCSmp_DeInit( ++ IN PVOID pDM_VOID ++); ++ ++#endif ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdect.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdect.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdect.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdect.c 2018-02-11 21:44:27.154146193 +0200 +@@ -0,0 +1,964 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++//#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN |ODM_CE)) ++#if(defined(CONFIG_ANT_DETECTION)) ++ ++//IS_ANT_DETECT_SUPPORT_SINGLE_TONE(Adapter) ++//IS_ANT_DETECT_SUPPORT_RSSI(Adapter) ++//IS_ANT_DETECT_SUPPORT_PSD(Adapter) ++ ++//1 [1. Single Tone Method] =================================================== ++ ++// ++// Description: ++// Set Single/Dual Antenna default setting for products that do not do detection in advance. ++// ++// Added by Joseph, 2012.03.22 ++// ++VOID ++ODM_SingleDualAntennaDefaultSetting( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ ++ u1Byte btAntNum=BT_GetPgAntNum(pAdapter); ++ // Set default antenna A and B status ++ if(btAntNum == 2) ++ { ++ pDM_SWAT_Table->ANTA_ON=TRUE; ++ pDM_SWAT_Table->ANTB_ON=TRUE; ++ ++ } ++ else if(btAntNum == 1) ++ {// Set antenna A as default ++ pDM_SWAT_Table->ANTA_ON=TRUE; ++ pDM_SWAT_Table->ANTB_ON=FALSE; ++ ++ } ++ else ++ { ++ RT_ASSERT(FALSE, ("Incorrect antenna number!!\n")); ++ } ++} ++ ++ ++//2 8723A ANT DETECT ++// ++// Description: ++// Implement IQK single tone for RF DPK loopback and BB PSD scanning. ++// This function is cooperated with BB team Neil. ++// ++// Added by Roger, 2011.12.15 ++// ++BOOLEAN ++ODM_SingleDualAntennaDetection( ++ IN PVOID pDM_VOID, ++ IN u1Byte mode ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ u4Byte CurrentChannel,RfLoopReg; ++ u1Byte n; ++ u4Byte Reg88c, Regc08, Reg874, Regc50, Reg948, Regb2c, Reg92c, Reg930, Reg064, AFE_rRx_Wait_CCA; ++ u1Byte initial_gain = 0x5a; ++ u4Byte PSD_report_tmp; ++ u4Byte AntA_report = 0x0, AntB_report = 0x0, AntO_report = 0x0; ++ BOOLEAN bResult = TRUE; ++ u4Byte AFE_Backup[16]; ++ u4Byte AFE_REG_8723A[16] = { ++ rRx_Wait_CCA, rTx_CCK_RFON, ++ rTx_CCK_BBON, rTx_OFDM_RFON, ++ rTx_OFDM_BBON, rTx_To_Rx, ++ rTx_To_Tx, rRx_CCK, ++ rRx_OFDM, rRx_Wait_RIFS, ++ rRx_TO_Rx, rStandby, ++ rSleep, rPMPD_ANAEN, ++ rFPGA0_XCD_SwitchControl, rBlue_Tooth}; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection()============>\n")); ++ ++ ++ if (!(pDM_Odm->SupportICType & ODM_RTL8723B)) ++ return bResult; ++ ++ // Retrieve antenna detection registry info, added by Roger, 2012.11.27. ++ if(!IS_ANT_DETECT_SUPPORT_SINGLE_TONE(pAdapter)) ++ return bResult; ++ ++ //1 Backup Current RF/BB Settings ++ ++ CurrentChannel = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask); ++ RfLoopReg = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask); ++ if (pDM_Odm->SupportICType & ODM_RTL8723B) { ++ Reg92c = ODM_GetBBReg(pDM_Odm, rDPDT_control, bMaskDWord); ++ Reg930 = ODM_GetBBReg(pDM_Odm, rfe_ctrl_anta_src, bMaskDWord); ++ Reg948 = ODM_GetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord); ++ Regb2c = ODM_GetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord); ++ Reg064 = ODM_GetMACReg(pDM_Odm, rSYM_WLBT_PAPE_SEL, BIT29); ++ ODM_SetBBReg(pDM_Odm, rDPDT_control, 0x3, 0x1); ++ ODM_SetBBReg(pDM_Odm, rfe_ctrl_anta_src, 0xff, 0x77); ++ ODM_SetMACReg(pDM_Odm, rSYM_WLBT_PAPE_SEL, BIT29, 0x1); //dbg 7 ++ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0x3c0, 0x0);//dbg 8 ++ ODM_SetBBReg(pDM_Odm, rAGC_table_select, BIT31, 0x0); ++ } ++ ++ ODM_StallExecution(10); ++ ++ //Store A Path Register 88c, c08, 874, c50 ++ Reg88c = ODM_GetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord); ++ Regc08 = ODM_GetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord); ++ Reg874 = ODM_GetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord); ++ Regc50 = ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord); ++ ++ // Store AFE Registers ++ if (pDM_Odm->SupportICType & ODM_RTL8723B) ++ AFE_rRx_Wait_CCA = ODM_GetBBReg(pDM_Odm, rRx_Wait_CCA,bMaskDWord); ++ ++ //Set PSD 128 pts ++ ODM_SetBBReg(pDM_Odm, rFPGA0_PSDFunction, BIT14|BIT15, 0x0); //128 pts ++ ++ // To SET CH1 to do ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask, 0x7401); //Channel 1 ++ ++ // AFE all on step ++ if (pDM_Odm->SupportICType & ODM_RTL8723B) ++ ODM_SetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord, 0x01c00016); ++ ++ // 3 wire Disable ++ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord, 0xCCF000C0); ++ ++ //BB IQK Setting ++ ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, 0x000800E4); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x22208000); ++ ++ //IQK setting tone@ 4.34Mhz ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x10008C1C); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); ++ ++ //Page B init ++ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00080000); ++ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x0f600000); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x10008c1f); ++ if (pDM_Odm->SupportICType & ODM_RTL8723B) { ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82150016); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28150016); ++ } ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x001028d0); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, 0x7f, initial_gain); ++ ++ //IQK Single tone start ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); ++ ++ ODM_StallExecution(10000); ++ ++ // PSD report of antenna A ++ PSD_report_tmp=0x0; ++ for (n=0;n<2;n++) ++ { ++ PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); ++ if(PSD_report_tmp >AntA_report) ++ AntA_report=PSD_report_tmp; ++ } ++ ++ // change to Antenna B ++ if (pDM_Odm->SupportICType & ODM_RTL8723B) { ++ //ODM_SetBBReg(pDM_Odm, rDPDT_control, 0x3, 0x2); ++ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0xfff, 0x280); ++ ODM_SetBBReg(pDM_Odm, rAGC_table_select, BIT31, 0x1); ++ } ++ ++ ODM_StallExecution(10); ++ ++ // PSD report of antenna B ++ PSD_report_tmp=0x0; ++ for (n=0;n<2;n++) ++ { ++ PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); ++ if(PSD_report_tmp > AntB_report) ++ AntB_report=PSD_report_tmp; ++ } ++ ++ //Close IQK Single Tone function ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ++ //1 Return to antanna A ++ if (pDM_Odm->SupportICType & ODM_RTL8723B) { ++ // external DPDT ++ ODM_SetBBReg(pDM_Odm, rDPDT_control, bMaskDWord, Reg92c); ++ ++ //internal S0/S1 ++ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord, Reg948); ++ ODM_SetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord, Regb2c); ++ ODM_SetBBReg(pDM_Odm, rfe_ctrl_anta_src, bMaskDWord, Reg930); ++ ODM_SetMACReg(pDM_Odm, rSYM_WLBT_PAPE_SEL, BIT29, Reg064); ++ } ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord, Reg88c); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, Regc08); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, Reg874); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, 0x7F, 0x40); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord, Regc50); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask,CurrentChannel); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask,RfLoopReg); ++ ++ //Reload AFE Registers ++ if (pDM_Odm->SupportICType & ODM_RTL8723B) ++ ODM_SetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord, AFE_rRx_Wait_CCA); ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8723B) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_A[%d]= %d\n", 2416, AntA_report)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_B[%d]= %d\n", 2416, AntB_report)); ++ ++ //2 Test Ant B based on Ant A is ON ++ if((AntA_report >= 100) && (AntB_report >= 100) && (AntA_report <= 135) && (AntB_report <= 135)) ++ { ++ u1Byte TH1=2, TH2=6; ++ ++ if((AntA_report - AntB_report < TH1) || (AntB_report - AntA_report < TH1)) ++ { ++ pDM_SWAT_Table->ANTA_ON=TRUE; ++ pDM_SWAT_Table->ANTB_ON=TRUE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SingleDualAntennaDetection(): Dual Antenna\n")); ++ } ++ else if(((AntA_report - AntB_report >= TH1) && (AntA_report - AntB_report <= TH2)) || ++ ((AntB_report - AntA_report >= TH1) && (AntB_report - AntA_report <= TH2))) ++ { ++ pDM_SWAT_Table->ANTA_ON=FALSE; ++ pDM_SWAT_Table->ANTB_ON=FALSE; ++ bResult = FALSE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Need to check again\n")); ++ } ++ else ++ { ++ pDM_SWAT_Table->ANTA_ON = TRUE; ++ pDM_SWAT_Table->ANTB_ON=FALSE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SingleDualAntennaDetection(): Single Antenna\n")); ++ } ++ pDM_Odm->AntDetectedInfo.bAntDetected= TRUE; ++ pDM_Odm->AntDetectedInfo.dBForAntA = AntA_report; ++ pDM_Odm->AntDetectedInfo.dBForAntB = AntB_report; ++ pDM_Odm->AntDetectedInfo.dBForAntO = AntO_report; ++ ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("return FALSE!!\n")); ++ bResult = FALSE; ++ } ++ } ++ return bResult; ++ ++} ++ ++ ++ ++//1 [2. Scan AP RSSI Method] ================================================== ++ ++ ++ ++ ++BOOLEAN ++ODM_SwAntDivCheckBeforeLink( ++ IN PVOID pDM_VOID ++ ) ++{ ++ ++#if (RT_MEM_SIZE_LEVEL != RT_MEM_SIZE_MINIMUM) ++ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE* pHalData = GET_HAL_DATA(Adapter); ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ s1Byte Score = 0; ++ PRT_WLAN_BSS pTmpBssDesc, pTestBssDesc; ++ u1Byte power_target_L = 9, power_target_H = 16; ++ u1Byte tmp_power_diff = 0,power_diff = 0,avg_power_diff = 0,max_power_diff = 0,min_power_diff = 0xff; ++ u2Byte index, counter = 0; ++ static u1Byte ScanChannel; ++ u4Byte tmp_SWAS_NoLink_BK_Reg948; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ANTA_ON = (( %d )) , ANTB_ON = (( %d ))\n", pDM_Odm->DM_SWAT_Table.ANTA_ON, pDM_Odm->DM_SWAT_Table.ANTB_ON)); ++ ++ //if(HP id) ++ { ++ if(pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult==TRUE && pDM_Odm->SupportICType == ODM_RTL8723B) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("8723B RSSI-based Antenna Detection is done\n")); ++ return FALSE; ++ } ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8723B) ++ { ++ if(pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 == 0xff) ++ pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 = ODM_Read4Byte(pDM_Odm, rS0S1_PathSwitch ); ++ } ++ } ++ ++ if (pDM_Odm->Adapter == NULL) //For BSOD when plug/unplug fast. //By YJ,120413 ++ { // The ODM structure is not initialized. ++ return FALSE; ++ } ++ ++ // Retrieve antenna detection registry info, added by Roger, 2012.11.27. ++ if(!IS_ANT_DETECT_SUPPORT_RSSI(Adapter)) ++ { ++ return FALSE; ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Antenna Detection: RSSI Method\n")); ++ } ++ ++ // Since driver is going to set BB register, it shall check if there is another thread controlling BB/RF. ++ PlatformAcquireSpinLock(Adapter, RT_RF_STATE_SPINLOCK); ++ if(pHalData->eRFPowerState!=eRfOn || pMgntInfo->RFChangeInProgress || pMgntInfo->bMediaConnect) ++ { ++ PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ++ ("ODM_SwAntDivCheckBeforeLink(): RFChangeInProgress(%x), eRFPowerState(%x)\n", ++ pMgntInfo->RFChangeInProgress, pHalData->eRFPowerState)); ++ ++ pDM_SWAT_Table->SWAS_NoLink_State = 0; ++ ++ return FALSE; ++ } ++ else ++ { ++ PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK); ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("pDM_SWAT_Table->SWAS_NoLink_State = %d\n", pDM_SWAT_Table->SWAS_NoLink_State)); ++ //1 Run AntDiv mechanism "Before Link" part. ++ if(pDM_SWAT_Table->SWAS_NoLink_State == 0) ++ { ++ //1 Prepare to do Scan again to check current antenna state. ++ ++ // Set check state to next step. ++ pDM_SWAT_Table->SWAS_NoLink_State = 1; ++ ++ // Copy Current Scan list. ++ pMgntInfo->tmpNumBssDesc = pMgntInfo->NumBssDesc; ++ PlatformMoveMemory((PVOID)Adapter->MgntInfo.tmpbssDesc, (PVOID)pMgntInfo->bssDesc, sizeof(RT_WLAN_BSS)*MAX_BSS_DESC); ++ ++ // Go back to scan function again. ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Scan one more time\n")); ++ pMgntInfo->ScanStep=0; ++ pMgntInfo->bScanAntDetect = TRUE; ++ ScanChannel = odm_SwAntDivSelectScanChnl(Adapter); ++ ++ ++ if(pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8821)) ++ { ++ if(pDM_FatTable->RxIdleAnt == MAIN_ANT) ++ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); ++ else ++ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); ++ if(ScanChannel == 0) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ++ ("ODM_SwAntDivCheckBeforeLink(): No AP List Avaiable, Using Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"AUX_ANT":"MAIN_ANT")); ++ ++ if(IS_5G_WIRELESS_MODE(pMgntInfo->dot11CurrentWirelessMode)) ++ { ++ pDM_SWAT_Table->Ant5G = pDM_FatTable->RxIdleAnt; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant5G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ } ++ else ++ { ++ pDM_SWAT_Table->Ant2G = pDM_FatTable->RxIdleAnt; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant2G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ } ++ return FALSE; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ++ ("ODM_SwAntDivCheckBeforeLink: Change to %s for testing.\n", ((pDM_FatTable->RxIdleAnt == MAIN_ANT)?"MAIN_ANT":"AUX_ANT"))); ++ } else if (pDM_Odm->SupportICType & (ODM_RTL8723B)) { ++ /*Switch Antenna to another one.*/ ++ ++ tmp_SWAS_NoLink_BK_Reg948 = ODM_Read4Byte(pDM_Odm, rS0S1_PathSwitch); ++ ++ if ((pDM_SWAT_Table->CurAntenna == MAIN_ANT) && (tmp_SWAS_NoLink_BK_Reg948 == 0x200)) { ++ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0xfff, 0x280); ++ ODM_SetBBReg(pDM_Odm, rAGC_table_select, BIT31, 0x1); ++ pDM_SWAT_Table->CurAntenna = AUX_ANT; ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Reg[948]= (( %x )) was in wrong state\n", tmp_SWAS_NoLink_BK_Reg948)); ++ return FALSE; ++ } ++ ODM_StallExecution(10); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Change to (( %s-ant)) for testing.\n", (pDM_SWAT_Table->CurAntenna == MAIN_ANT)?"MAIN":"AUX")); ++ } ++ ++ odm_SwAntDivConstructScanChnl(Adapter, ScanChannel); ++ PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5); ++ ++ return TRUE; ++ } ++ else //pDM_SWAT_Table->SWAS_NoLink_State == 1 ++ { ++ //1 ScanComple() is called after antenna swiched. ++ //1 Check scan result and determine which antenna is going ++ //1 to be used. ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,(" tmpNumBssDesc= (( %d )) \n",pMgntInfo->tmpNumBssDesc));// debug for Dino ++ ++ for(index = 0; index < pMgntInfo->tmpNumBssDesc; index++) ++ { ++ pTmpBssDesc = &(pMgntInfo->tmpbssDesc[index]); // Antenna 1 ++ pTestBssDesc = &(pMgntInfo->bssDesc[index]); // Antenna 2 ++ ++ if(PlatformCompareMemory(pTestBssDesc->bdBssIdBuf, pTmpBssDesc->bdBssIdBuf, 6)!=0) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): ERROR!! This shall not happen.\n")); ++ continue; ++ } ++ ++ if(pDM_Odm->SupportICType != ODM_RTL8723B) ++ { ++ if(pTmpBssDesc->ChannelNumber == ScanChannel) ++ { ++ if(pTmpBssDesc->RecvSignalPower > pTestBssDesc->RecvSignalPower) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Compare scan entry: Score++\n")); ++ RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", pTmpBssDesc->bdSsIdBuf, pTmpBssDesc->bdSsIdLen); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n\n", pTmpBssDesc->ChannelNumber, pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); ++ ++ Score++; ++ PlatformMoveMemory(pTestBssDesc, pTmpBssDesc, sizeof(RT_WLAN_BSS)); ++ } ++ else if(pTmpBssDesc->RecvSignalPower < pTestBssDesc->RecvSignalPower) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Compare scan entry: Score--\n")); ++ RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", pTmpBssDesc->bdSsIdBuf, pTmpBssDesc->bdSsIdLen); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n\n", pTmpBssDesc->ChannelNumber, pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); ++ Score--; ++ } ++ else ++ { ++ if(pTestBssDesc->bdTstamp - pTmpBssDesc->bdTstamp < 5000) ++ { ++ RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", pTmpBssDesc->bdSsIdBuf, pTmpBssDesc->bdSsIdLen); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n", pTmpBssDesc->ChannelNumber, pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("The 2nd Antenna didn't get this AP\n\n")); ++ } ++ } ++ } ++ } ++ else // 8723B ++ { ++ if(pTmpBssDesc->ChannelNumber == ScanChannel) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ChannelNumber == ScanChannel -> (( %d )) \n", pTmpBssDesc->ChannelNumber )); ++ ++ if(pTmpBssDesc->RecvSignalPower > pTestBssDesc->RecvSignalPower) // Pow(Ant1) > Pow(Ant2) ++ { ++ counter++; ++ tmp_power_diff=(u1Byte)(pTmpBssDesc->RecvSignalPower - pTestBssDesc->RecvSignalPower); ++ power_diff = power_diff + tmp_power_diff; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); ++ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), pTmpBssDesc->bdSsIdBuf); ++ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), pTmpBssDesc->bdBssIdBuf); ++ ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("tmp_power_diff: (( %d)),max_power_diff: (( %d)),min_power_diff: (( %d)) \n", tmp_power_diff,max_power_diff,min_power_diff)); ++ if(tmp_power_diff > max_power_diff) ++ max_power_diff=tmp_power_diff; ++ if(tmp_power_diff < min_power_diff) ++ min_power_diff=tmp_power_diff; ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("max_power_diff: (( %d)),min_power_diff: (( %d)) \n",max_power_diff,min_power_diff)); ++ ++ PlatformMoveMemory(pTestBssDesc, pTmpBssDesc, sizeof(RT_WLAN_BSS)); ++ } ++ else if(pTestBssDesc->RecvSignalPower > pTmpBssDesc->RecvSignalPower) // Pow(Ant1) < Pow(Ant2) ++ { ++ counter++; ++ tmp_power_diff=(u1Byte)(pTestBssDesc->RecvSignalPower - pTmpBssDesc->RecvSignalPower); ++ power_diff = power_diff + tmp_power_diff; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); ++ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), pTmpBssDesc->bdSsIdBuf); ++ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), pTmpBssDesc->bdBssIdBuf); ++ if(tmp_power_diff > max_power_diff) ++ max_power_diff=tmp_power_diff; ++ if(tmp_power_diff < min_power_diff) ++ min_power_diff=tmp_power_diff; ++ } ++ else // Pow(Ant1) = Pow(Ant2) ++ { ++ if(pTestBssDesc->bdTstamp > pTmpBssDesc->bdTstamp) // Stamp(Ant1) < Stamp(Ant2) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("time_diff: %lld\n", (pTestBssDesc->bdTstamp-pTmpBssDesc->bdTstamp)/1000)); ++ if(pTestBssDesc->bdTstamp - pTmpBssDesc->bdTstamp > 5000) ++ { ++ counter++; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); ++ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), pTmpBssDesc->bdSsIdBuf); ++ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), pTmpBssDesc->bdBssIdBuf); ++ min_power_diff = 0; ++ } ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Error !!!]: Time_diff: %lld\n", (pTestBssDesc->bdTstamp-pTmpBssDesc->bdTstamp)/1000)); ++ } ++ } ++ } ++ } ++ } ++ ++ if(pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8821)) ++ { ++ if(pMgntInfo->NumBssDesc!=0 && Score<0) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ++ ("ODM_SwAntDivCheckBeforeLink(): Using Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ++ ("ODM_SwAntDivCheckBeforeLink(): Remain Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"AUX_ANT":"MAIN_ANT")); ++ ++ if(pDM_FatTable->RxIdleAnt == MAIN_ANT) ++ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); ++ else ++ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); ++ } ++ ++ if(IS_5G_WIRELESS_MODE(pMgntInfo->dot11CurrentWirelessMode)) ++ { ++ pDM_SWAT_Table->Ant5G = pDM_FatTable->RxIdleAnt; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant5G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ } ++ else ++ { ++ pDM_SWAT_Table->Ant2G = pDM_FatTable->RxIdleAnt; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant2G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ } ++ } ++ else if(pDM_Odm->SupportICType == ODM_RTL8723B) ++ { ++ if(counter == 0) ++ { ++ if(pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec == FALSE) ++ { ++ pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec = TRUE; ++ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=FALSE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Counter=(( 0 )) , [[ Cannot find any AP with Aux-ant ]] -> Scan Target-channel again \n")); ++ ++ //3 [ Scan again ] ++ odm_SwAntDivConstructScanChnl(Adapter, ScanChannel); ++ PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5); ++ return TRUE; ++ } ++ else// Pre_Aux_FailDetec == TRUE ++ { ++ //2 [ Single Antenna ] ++ pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec = FALSE; ++ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Counter=(( 0 )) , [[ Still cannot find any AP ]] \n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); ++ } ++ pDM_Odm->DM_SWAT_Table.Aux_FailDetec_Counter++; ++ } ++ else ++ { ++ pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec = FALSE; ++ ++ if(counter==3) ++ { ++ avg_power_diff = ((power_diff-max_power_diff - min_power_diff)>>1)+ ((max_power_diff + min_power_diff)>>2); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("counter: (( %d )) , power_diff: (( %d )) \n", counter, power_diff)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ counter==3 ] Modified avg_power_diff: (( %d )) , max_power_diff: (( %d )) , min_power_diff: (( %d )) \n", avg_power_diff,max_power_diff, min_power_diff)); ++ } ++ else if(counter>=4) ++ { ++ avg_power_diff=(power_diff-max_power_diff - min_power_diff) / (counter - 2); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("counter: (( %d )) , power_diff: (( %d )) \n", counter, power_diff)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ counter>=4 ] Modified avg_power_diff: (( %d )) , max_power_diff: (( %d )) , min_power_diff: (( %d )) \n", avg_power_diff,max_power_diff, min_power_diff)); ++ ++ } ++ else//counter==1,2 ++ { ++ avg_power_diff=power_diff/counter; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("avg_power_diff: (( %d )) , counter: (( %d )) , power_diff: (( %d )) \n", avg_power_diff,counter, power_diff)); ++ } ++ ++ //2 [ Retry ] ++ if( (avg_power_diff >=power_target_L) && (avg_power_diff <=power_target_H) ) ++ { ++ pDM_Odm->DM_SWAT_Table.Retry_Counter++; ++ ++ if(pDM_Odm->DM_SWAT_Table.Retry_Counter<=3) ++ { ++ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=FALSE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[[ Low confidence result ]] avg_power_diff= (( %d )) -> Scan Target-channel again ]] \n", avg_power_diff)); ++ ++ //3 [ Scan again ] ++ odm_SwAntDivConstructScanChnl(Adapter, ScanChannel); ++ PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5); ++ return TRUE; ++ } ++ else ++ { ++ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[[ Still Low confidence result ]] (( Retry_Counter > 3 )) \n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); ++ } ++ ++ } ++ //2 [ Dual Antenna ] ++ else if( (pMgntInfo->NumBssDesc != 0) && (avg_power_diff < power_target_L) ) ++ { ++ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; ++ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == FALSE) ++ { ++ pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; ++ pDM_Odm->DM_SWAT_Table.ANTB_ON = TRUE; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SwAntDivCheckBeforeLink(): Dual antenna\n")); ++ pDM_Odm->DM_SWAT_Table.Dual_Ant_Counter++; ++ ++ // set bt coexDM from 1ant coexDM to 2ant coexDM ++ BT_SetBtCoexAntNum(Adapter, BT_COEX_ANT_TYPE_DETECTED, 2); ++ ++ //3 [ Init antenna diversity ] ++ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; ++ ODM_AntDivInit(pDM_Odm); ++ } ++ //2 [ Single Antenna ] ++ else if(avg_power_diff > power_target_H) ++ { ++ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; ++ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == TRUE) ++ { ++ pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; ++ pDM_Odm->DM_SWAT_Table.ANTB_ON = FALSE; ++ //BT_SetBtCoexAntNum(Adapter, BT_COEX_ANT_TYPE_DETECTED, 1); ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); ++ pDM_Odm->DM_SWAT_Table.Single_Ant_Counter++; ++ } ++ } ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("bResult=(( %d ))\n",pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Dual_Ant_Counter = (( %d )), Single_Ant_Counter = (( %d )) , Retry_Counter = (( %d )) , Aux_FailDetec_Counter = (( %d ))\n\n\n", ++ pDM_Odm->DM_SWAT_Table.Dual_Ant_Counter,pDM_Odm->DM_SWAT_Table.Single_Ant_Counter,pDM_Odm->DM_SWAT_Table.Retry_Counter,pDM_Odm->DM_SWAT_Table.Aux_FailDetec_Counter)); ++ ++ //2 recover the antenna setting ++ ++ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == FALSE) ++ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0xfff, (pDM_SWAT_Table->SWAS_NoLink_BK_Reg948)); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("bResult=(( %d )), Recover Reg[948]= (( %x )) \n\n",pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult, pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 )); ++ ++ ++ } ++ ++ // Check state reset to default and wait for next time. ++ pDM_SWAT_Table->SWAS_NoLink_State = 0; ++ pMgntInfo->bScanAntDetect = FALSE; ++ ++ return FALSE; ++ } ++ ++#else ++ return FALSE; ++#endif ++ ++return FALSE; ++} ++ ++ ++ ++ ++ ++ ++//1 [3. PSD Method] ========================================================== ++ ++ ++ ++ ++u4Byte ++odm_GetPSDData( ++ IN PVOID pDM_VOID, ++ IN u2Byte point, ++ IN u1Byte initial_gain) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte psd_report; ++ ++ ODM_SetBBReg(pDM_Odm, 0x808, 0x3FF, point); ++ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 1); //Start PSD calculation, Reg808[22]=0->1 ++ ODM_StallExecution(150);//Wait for HW PSD report ++ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 0);//Stop PSD calculation, Reg808[22]=1->0 ++ psd_report = ODM_GetBBReg(pDM_Odm,0x8B4, bMaskDWord) & 0x0000FFFF;//Read PSD report, Reg8B4[15:0] ++ ++ psd_report = (u4Byte) (odm_ConvertTo_dB(psd_report));//+(u4Byte)(initial_gain); ++ return psd_report; ++} ++ ++ ++ ++VOID ++ODM_SingleDualAntennaDetection_PSD( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte Channel_ori; ++ u1Byte initial_gain = 0x36; ++ u1Byte tone_idx; ++ u1Byte Tone_lenth_1=7, Tone_lenth_2=4; ++ u2Byte Tone_idx_1[7]={88, 104, 120, 8, 24, 40, 56}; ++ u2Byte Tone_idx_2[4]={8, 24, 40, 56}; ++ u4Byte PSD_report_Main[11]={0}, PSD_report_Aux[11]={0}; ++ //u1Byte Tone_lenth_1=4, Tone_lenth_2=2; ++ //u2Byte Tone_idx_1[4]={88, 120, 24, 56}; ++ //u2Byte Tone_idx_2[2]={ 24, 56}; ++ //u4Byte PSD_report_Main[6]={0}, PSD_report_Aux[6]={0}; ++ ++ u4Byte PSD_report_temp,MAX_PSD_report_Main=0,MAX_PSD_report_Aux=0; ++ u4Byte PSD_power_threshold; ++ u4Byte Main_psd_result=0, Aux_psd_result=0; ++ u4Byte Regc50, Reg948, Regb2c,Regc14,Reg908; ++ u4Byte i=0,test_num=8; ++ ++ ++ if(pDM_Odm->SupportICType != ODM_RTL8723B) ++ return; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection_PSD()============> \n")); ++ ++ //2 [ Backup Current RF/BB Settings ] ++ ++ Channel_ori = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask); ++ Reg948 = ODM_GetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord); ++ Regb2c = ODM_GetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord); ++ Regc50 = ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord); ++ Regc14 = ODM_GetBBReg(pDM_Odm, 0xc14, bMaskDWord); ++ Reg908 = ODM_GetBBReg(pDM_Odm, 0x908, bMaskDWord); ++ ++ //2 [ Setting for doing PSD function (CH4)] ++ ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 0); //disable whole CCK block ++ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0xFF); // Turn off TX -> Pause TX Queue ++ ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, 0x0); // [ Set IQK Matrix = 0 ] equivalent to [ Turn off CCA] ++ ++ // PHYTXON while loop ++ ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, 0x803); ++ while (ODM_GetBBReg(pDM_Odm, 0xdf4, BIT6)) ++ { ++ i++; ++ if (i > 1000000) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Wait in %s() more than %d times!\n", __FUNCTION__, i)); ++ break; ++ } ++ } ++ ++ ODM_SetBBReg(pDM_Odm, 0xc50, 0x7f, initial_gain); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); // Set RF to CH4 & 40M ++ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0xf); // 3 wire Disable 88c[23:20]=0xf ++ ODM_SetBBReg(pDM_Odm, rFPGA0_PSDFunction, BIT14|BIT15, 0x0); //128 pt //Set PSD 128 ptss ++ ODM_StallExecution(3000); ++ ++ ++ //2 [ Doing PSD Function in (CH4)] ++ ++ //Antenna A ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Main-ant (CH4)\n")); ++ ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x200); ++ ODM_StallExecution(10); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("dbg\n")); ++ for (i=0;iPSD_report_Main[tone_idx] ) ++ PSD_report_Main[tone_idx]+=PSD_report_temp; ++ } ++ } ++ //Antenna B ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Aux-ant (CH4)\n")); ++ ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x280); ++ ODM_StallExecution(10); ++ for (i=0;iPSD_report_Aux[tone_idx] ) ++ PSD_report_Aux[tone_idx]+=PSD_report_temp; ++ } ++ } ++ //2 [ Doing PSD Function in (CH8)] ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0x0); // 3 wire enable 88c[23:20]=0x0 ++ ODM_StallExecution(3000); ++ ++ ODM_SetBBReg(pDM_Odm, 0xc50, 0x7f, initial_gain); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); // Set RF to CH8 & 40M ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0xf); // 3 wire Disable 88c[23:20]=0xf ++ ODM_StallExecution(3000); ++ ++ //Antenna A ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Main-ant (CH8)\n")); ++ ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x200); ++ ODM_StallExecution(10); ++ ++ for (i=0;iPSD_report_Main[tone_idx] ) ++ PSD_report_Main[Tone_lenth_1+tone_idx]+=PSD_report_temp; ++ } ++ } ++ ++ //Antenna B ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Aux-ant (CH8)\n")); ++ ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x280); ++ ODM_StallExecution(10); ++ ++ for (i=0;iPSD_report_Aux[tone_idx] ) ++ PSD_report_Aux[Tone_lenth_1+tone_idx]+=PSD_report_temp; ++ } ++ } ++ ++ //2 [ Calculate Result ] ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\nMain PSD Result: (ALL) \n")); ++ for (tone_idx=0;tone_idx<(Tone_lenth_1+Tone_lenth_2);tone_idx++) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Tone-%d]: %d, \n",(tone_idx+1), PSD_report_Main[tone_idx] )); ++ Main_psd_result+= PSD_report_Main[tone_idx]; ++ if(PSD_report_Main[tone_idx]>MAX_PSD_report_Main) ++ MAX_PSD_report_Main=PSD_report_Main[tone_idx]; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("--------------------------- \nTotal_Main= (( %d ))\n", Main_psd_result)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("MAX_Main = (( %d ))\n", MAX_PSD_report_Main)); ++ ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\nAux PSD Result: (ALL) \n")); ++ for (tone_idx=0;tone_idx<(Tone_lenth_1+Tone_lenth_2);tone_idx++) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Tone-%d]: %d, \n",(tone_idx+1), PSD_report_Aux[tone_idx] )); ++ Aux_psd_result+= PSD_report_Aux[tone_idx]; ++ if(PSD_report_Aux[tone_idx]>MAX_PSD_report_Aux) ++ MAX_PSD_report_Aux=PSD_report_Aux[tone_idx]; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("--------------------------- \nTotal_Aux= (( %d ))\n", Aux_psd_result)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("MAX_Aux = (( %d ))\n\n", MAX_PSD_report_Aux)); ++ ++ //Main_psd_result=Main_psd_result-MAX_PSD_report_Main; ++ //Aux_psd_result=Aux_psd_result-MAX_PSD_report_Aux; ++ PSD_power_threshold=(Main_psd_result*7)>>3; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Main_result , Aux_result ] = [ %d , %d ], PSD_power_threshold=(( %d ))\n", Main_psd_result, Aux_psd_result,PSD_power_threshold)); ++ ++ //3 [ Dual Antenna ] ++ if(Aux_psd_result >= PSD_power_threshold ) ++ { ++ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == FALSE) ++ { ++ pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; ++ pDM_Odm->DM_SWAT_Table.ANTB_ON = TRUE; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SwAntDivCheckBeforeLink(): Dual antenna\n")); ++ ++ // set bt coexDM from 1ant coexDM to 2ant coexDM ++ //BT_SetBtCoexAntNum(pAdapter, BT_COEX_ANT_TYPE_DETECTED, 2); ++ ++ // Init antenna diversity ++ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; ++ ODM_AntDivInit(pDM_Odm); ++ } ++ //3 [ Single Antenna ] ++ else ++ { ++ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == TRUE) ++ { ++ pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; ++ pDM_Odm->DM_SWAT_Table.ANTB_ON = FALSE; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); ++ } ++ ++ //2 [ Recover all parameters ] ++ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask,Channel_ori); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0x0); // 3 wire enable 88c[23:20]=0x0 ++ ODM_SetBBReg(pDM_Odm, 0xc50, 0x7f, Regc50); ++ ++ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord, Reg948); ++ ODM_SetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord, Regb2c); ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 1); //enable whole CCK block ++ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0x0); //Turn on TX // Resume TX Queue ++ ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, Regc14); // [ Set IQK Matrix = 0 ] equivalent to [ Turn on CCA] ++ ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, Reg908); ++ ++ return; ++ ++} ++ ++#endif ++void ++odm_SwAntDetectInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++#if(defined(CONFIG_ANT_DETECTION)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ ++ //pDM_SWAT_Table->PreAntenna = MAIN_ANT; ++ //pDM_SWAT_Table->CurAntenna = MAIN_ANT; ++ pDM_SWAT_Table->SWAS_NoLink_State = 0; ++ pDM_SWAT_Table->Pre_Aux_FailDetec = FALSE; ++ pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 = 0xff; ++#endif ++} ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdect.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdect.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdect.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdect.h 2018-02-11 21:44:27.154146193 +0200 +@@ -0,0 +1,98 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMANTDECT_H__ ++#define __PHYDMANTDECT_H__ ++ ++#define ANTDECT_VERSION "2.1" /*2015.07.29 by YuChen*/ ++ ++#if(defined(CONFIG_ANT_DETECTION)) ++//#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN |ODM_CE)) ++//ANT Test ++#define ANTTESTALL 0x00 /*Ant A or B will be Testing*/ ++#define ANTTESTA 0x01 /*Ant A will be Testing*/ ++#define ANTTESTB 0x02 /*Ant B will be testing*/ ++ ++#define MAX_ANTENNA_DETECTION_CNT 10 ++ ++ ++typedef struct _ANT_DETECTED_INFO{ ++ BOOLEAN bAntDetected; ++ u4Byte dBForAntA; ++ u4Byte dBForAntB; ++ u4Byte dBForAntO; ++}ANT_DETECTED_INFO, *PANT_DETECTED_INFO; ++ ++ ++typedef enum tag_SW_Antenna_Switch_Definition ++{ ++ Antenna_A = 1, ++ Antenna_B = 2, ++ Antenna_MAX = 3, ++}DM_SWAS_E; ++ ++ ++ ++//1 [1. Single Tone Method] =================================================== ++ ++ ++ ++VOID ++ODM_SingleDualAntennaDefaultSetting( ++ IN PVOID pDM_VOID ++ ); ++ ++BOOLEAN ++ODM_SingleDualAntennaDetection( ++ IN PVOID pDM_VOID, ++ IN u1Byte mode ++ ); ++ ++//1 [2. Scan AP RSSI Method] ================================================== ++ ++#define SwAntDivCheckBeforeLink ODM_SwAntDivCheckBeforeLink ++ ++BOOLEAN ++ODM_SwAntDivCheckBeforeLink( ++ IN PVOID pDM_VOID ++ ); ++ ++ ++ ++ ++//1 [3. PSD Method] ========================================================== ++ ++ ++VOID ++ODM_SingleDualAntennaDetection_PSD( ++ IN PVOID pDM_VOID ++); ++ ++#endif ++ ++VOID ++odm_SwAntDetectInit( ++ IN PVOID pDM_VOID ++ ); ++ ++ ++#endif ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.c 2018-02-11 21:44:27.155146208 +0200 +@@ -0,0 +1,5431 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++//====================================================== ++// when antenna test utility is on or some testing need to disable antenna diversity ++// call this function to disable all ODM related mechanisms which will switch antenna. ++//====================================================== ++VOID ++ODM_StopAntennaSwitchDm( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ // disable ODM antenna diversity ++ pDM_Odm->SupportAbility &= ~ODM_BB_ANT_DIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("STOP Antenna Diversity \n")); ++} ++ ++VOID ++phydm_enable_antenna_diversity( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("AntDiv is enabled & Re-Init AntDiv\n")); ++ odm_AntennaDiversityInit(pDM_Odm); ++} ++ ++VOID ++ODM_SetAntConfig( ++ IN PVOID pDM_VOID, ++ IN u1Byte antSetting // 0=A, 1=B, 2=C, .... ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ if (pDM_Odm->SupportICType == ODM_RTL8723B) { ++ if (antSetting == 0) /* ant A*/ ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x00000000); ++ else if (antSetting == 1) ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x00000280); ++ } else if (pDM_Odm->SupportICType == ODM_RTL8723D) { ++ if (antSetting == 0) /* ant A*/ ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskLWord, 0x0000); ++ else if (antSetting == 1) ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskLWord, 0x0280); ++ } ++} ++ ++//====================================================== ++ ++ ++VOID ++ODM_SwAntDivRestAfterLink( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ u4Byte i; ++ ++ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { ++ ++ pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; ++ pDM_SWAT_Table->RSSI_Trying = 0; ++ pDM_SWAT_Table->Double_chk_flag= 0; ++ ++ pDM_FatTable->RxIdleAnt=MAIN_ANT; ++ ++ for (i=0; iMainAnt_Sum[i] = 0; ++ pDM_FatTable->AuxAnt_Sum[i] = 0; ++ pDM_FatTable->MainAnt_Cnt[i] = 0; ++ pDM_FatTable->AuxAnt_Cnt[i] = 0; ++ } ++ ++ } ++} ++ ++ ++#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++VOID ++odm_AntDiv_on_off( ++ IN PVOID pDM_VOID , ++ IN u1Byte swch ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ if(pDM_FatTable->AntDiv_OnOff != swch) ++ { ++ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) ++ return; ++ ++ if(pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) N-Series HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); ++ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT7, swch); ++ ODM_SetBBReg(pDM_Odm, 0xa00 , BIT15, swch); ++ ++ } ++ else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) AC-Series HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); ++ if (pDM_Odm->SupportICType == ODM_RTL8812) { ++ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT7, swch); //OFDM AntDiv function block enable ++ ODM_SetBBReg(pDM_Odm, 0xa00 , BIT15, swch); //CCK AntDiv function block enable ++ } else { ++ ODM_SetBBReg(pDM_Odm, 0x8D4 , BIT24, swch); //OFDM AntDiv function block enable ++ ++ if( (pDM_Odm->CutVersion >= ODM_CUT_C) && (pDM_Odm->SupportICType == ODM_RTL8821) && ( pDM_Odm->AntDivType != S0S1_SW_ANTDIV)) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) CCK HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); ++ ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, swch); ++ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, swch); //CCK AntDiv function block enable ++ } else if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) CCK HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); ++ ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, swch); ++ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, swch); //CCK AntDiv function block enable ++ } ++ } ++ } ++ } ++ pDM_FatTable->AntDiv_OnOff =swch; ++ ++} ++ ++VOID ++phydm_FastTraining_enable( ++ IN PVOID pDM_VOID, ++ IN u1Byte swch ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte enable; ++ ++ if (swch == FAT_ON) ++ enable=1; ++ else ++ enable=0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fast Ant Training_en = ((%d))\n", enable)); ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) { ++ ODM_SetBBReg(pDM_Odm, 0xe08 , BIT16, enable); /*enable fast training*/ ++ /**/ ++ } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { ++ ODM_SetBBReg(pDM_Odm, 0xB34 , BIT28, enable); /*enable fast training (path-A)*/ ++ /*ODM_SetBBReg(pDM_Odm, 0xB34 , BIT29, enable);*/ /*enable fast training (path-B)*/ ++ } else if (pDM_Odm->SupportICType == ODM_RTL8821) { ++ ODM_SetBBReg(pDM_Odm, 0x900 , BIT19, enable); /*enable fast training */ ++ /**/ ++ } ++} ++ ++phydm_keep_RxAckAnt_By_TxAnt_time( ++ IN PVOID pDM_VOID, ++ IN u4Byte time ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ /* Timming issue: keep Rx ant after tx for ACK ( time x 3.2 mu sec)*/ ++ if (pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) { ++ ++ ODM_SetBBReg(pDM_Odm, 0xE20, BIT23|BIT22|BIT21|BIT20, time); ++ /**/ ++ } else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) { ++ ++ ODM_SetBBReg(pDM_Odm, 0x818, BIT23|BIT22|BIT21|BIT20, time); ++ /**/ ++ } ++} ++ ++VOID ++odm_Tx_By_TxDesc_or_Reg( ++ IN PVOID pDM_VOID, ++ IN u1Byte swch ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ u1Byte enable; ++ ++ if (pDM_FatTable->b_fix_tx_ant == NO_FIX_TX_ANT) ++ enable = (swch == TX_BY_DESC) ? 1 : 0; ++ else ++ enable = 0;/*Force TX by Reg*/ ++ ++ if(pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) ++ { ++ if(pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) ++ { ++ ODM_SetBBReg(pDM_Odm, 0x80c , BIT21, enable); ++ } ++ else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) ++ { ++ ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, enable); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[AntDiv] TX_Ant_BY (( %s ))\n", (enable == TX_BY_DESC) ? "DESC":"REG")); ++ } ++} ++ ++VOID ++ODM_UpdateRxIdleAnt( ++ IN PVOID pDM_VOID, ++ IN u1Byte Ant ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ u4Byte DefaultAnt, OptionalAnt, value32, Default_tx_Ant; ++ ++ if(pDM_FatTable->RxIdleAnt != Ant) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] RxIdleAnt =%s\n",(Ant==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ ++ if(!(pDM_Odm->SupportICType & ODM_RTL8723B)) ++ pDM_FatTable->RxIdleAnt = Ant; ++ ++ if(Ant == MAIN_ANT) ++ { ++ DefaultAnt = ANT1_2G; ++ OptionalAnt = ANT2_2G; ++ } ++ else ++ { ++ DefaultAnt = ANT2_2G; ++ OptionalAnt = ANT1_2G; ++ } ++ ++ if (pDM_FatTable->b_fix_tx_ant != NO_FIX_TX_ANT) ++ Default_tx_Ant = (pDM_FatTable->b_fix_tx_ant == FIX_TX_AT_MAIN) ? 0 : 1; ++ else ++ Default_tx_Ant = DefaultAnt; ++ ++ if(pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) ++ { ++ if(pDM_Odm->SupportICType==ODM_RTL8192E) ++ { ++ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT5|BIT4|BIT3, DefaultAnt); //Default RX ++ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT8|BIT7|BIT6, OptionalAnt);//Optional RX ++ ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, DefaultAnt);//Default TX ++ } ++ #if (RTL8723B_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8723B) { ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0x948, 0xFFF); ++ ++ if(value32 !=0x280) ++ ODM_UpdateRxIdleAnt_8723B(pDM_Odm, Ant, DefaultAnt, OptionalAnt); ++ else ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to 0x948 = 0x280\n")); ++ } ++ #endif ++ else { /*8188E & 8188F*/ ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8723D) { ++ #if (RTL8723D_SUPPORT == 1) ++ phydm_set_tx_ant_pwr_8723d(pDM_Odm, Ant); ++ #endif ++ } ++ #if (RTL8188F_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8188F) { ++ phydm_update_rx_idle_antenna_8188F(pDM_Odm, DefaultAnt); ++ /**/ ++ } ++ #endif ++ ++ ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, DefaultAnt); /*Default RX*/ ++ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, OptionalAnt); /*Optional RX*/ ++ ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, Default_tx_Ant); /*Default TX*/ ++ } ++ } ++ else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) ++ { ++ u2Byte value16 = ODM_Read2Byte(pDM_Odm, ODM_REG_TRMUX_11AC+2); ++ // ++ // 2014/01/14 MH/Luke.Lee Add direct write for register 0xc0a to prevnt ++ // incorrect 0xc08 bit0-15 .We still not know why it is changed. ++ // ++ value16 &= ~(BIT11|BIT10|BIT9|BIT8|BIT7|BIT6|BIT5|BIT4|BIT3); ++ value16 |= ((u2Byte)DefaultAnt <<3); ++ value16 |= ((u2Byte)OptionalAnt <<6); ++ value16 |= ((u2Byte)DefaultAnt <<9); ++ ODM_Write2Byte(pDM_Odm, ODM_REG_TRMUX_11AC+2, value16); ++ /* ++ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC , BIT21|BIT20|BIT19, DefaultAnt); //Default RX ++ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC , BIT24|BIT23|BIT22, OptionalAnt);//Optional RX ++ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC , BIT27|BIT26|BIT25, DefaultAnt); //Default TX ++ */ ++ } ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) ++ { ++ ODM_SetMACReg(pDM_Odm, 0x6D8 , BIT7|BIT6, Default_tx_Ant); /*PathA Resp Tx*/ ++ /**/ ++ } ++ else ++ { ++ ODM_SetMACReg(pDM_Odm, 0x6D8 , BIT10|BIT9|BIT8, Default_tx_Ant); /*PathA Resp Tx*/ ++ /**/ ++ } ++ ++ } ++ else// pDM_FatTable->RxIdleAnt == Ant ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Stay in Ori-Ant ] RxIdleAnt =%s\n",(Ant==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ pDM_FatTable->RxIdleAnt = Ant; ++ } ++} ++ ++VOID ++odm_UpdateTxAnt( ++ IN PVOID pDM_VOID, ++ IN u1Byte Ant, ++ IN u4Byte MacId ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ u1Byte TxAnt; ++ ++ if (pDM_FatTable->b_fix_tx_ant != NO_FIX_TX_ANT) ++ Ant = (pDM_FatTable->b_fix_tx_ant == FIX_TX_AT_MAIN) ? MAIN_ANT : AUX_ANT; ++ ++ if (pDM_Odm->AntDivType==CG_TRX_SMART_ANTDIV) ++ { ++ TxAnt=Ant; ++ } ++ else ++ { ++ if(Ant == MAIN_ANT) ++ TxAnt = ANT1_2G; ++ else ++ TxAnt = ANT2_2G; ++ } ++ ++ pDM_FatTable->antsel_a[MacId] = TxAnt&BIT0; ++ pDM_FatTable->antsel_b[MacId] = (TxAnt&BIT1)>>1; ++ pDM_FatTable->antsel_c[MacId] = (TxAnt&BIT2)>>2; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Set TX-DESC value]: MacID:(( %d )), TxAnt = (( %s ))\n", MacId, (Ant == MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("antsel_tr_mux=(( 3'b%d%d%d ))\n",pDM_FatTable->antsel_c[MacId] , pDM_FatTable->antsel_b[MacId] , pDM_FatTable->antsel_a[MacId] )); ++ ++} ++ ++#ifdef BEAMFORMING_SUPPORT ++#if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++VOID ++odm_BDC_Init( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pBDC_T pDM_BdcTable=&pDM_Odm->DM_BdcTable; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n[ BDC Initialization......] \n")); ++ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; ++ pDM_BdcTable->BDC_Mode=BDC_MODE_NULL; ++ pDM_BdcTable->BDC_Try_flag=0; ++ pDM_BdcTable->BDCcoexType_wBfer=0; ++ pDM_Odm->bdc_holdstate=0xff; ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8192E) ++ { ++ ODM_SetBBReg(pDM_Odm, 0xd7c , 0x0FFFFFFF, 0x1081008); ++ ODM_SetBBReg(pDM_Odm, 0xd80 , 0x0FFFFFFF, 0); ++ } ++ else if(pDM_Odm->SupportICType == ODM_RTL8812) ++ { ++ ODM_SetBBReg(pDM_Odm, 0x9b0 , 0x0FFFFFFF, 0x1081008); //0x9b0[30:0] = 01081008 ++ ODM_SetBBReg(pDM_Odm, 0x9b4 , 0x0FFFFFFF, 0); //0x9b4[31:0] = 00000000 ++ } ++ ++} ++ ++ ++VOID ++odm_CSI_on_off( ++ IN PVOID pDM_VOID, ++ IN u1Byte CSI_en ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ if(CSI_en==CSI_ON) ++ { ++ if(pDM_Odm->SupportICType == ODM_RTL8192E) ++ { ++ ODM_SetMACReg(pDM_Odm, 0xd84 , BIT11, 1); //0xd84[11]=1 ++ } ++ else if(pDM_Odm->SupportICType == ODM_RTL8812) ++ { ++ ODM_SetMACReg(pDM_Odm, 0x9b0 , BIT31, 1); //0x9b0[31]=1 ++ } ++ ++ } ++ else if(CSI_en==CSI_OFF) ++ { ++ if(pDM_Odm->SupportICType == ODM_RTL8192E) ++ { ++ ODM_SetMACReg(pDM_Odm, 0xd84 , BIT11, 0); //0xd84[11]=0 ++ } ++ else if(pDM_Odm->SupportICType == ODM_RTL8812) ++ { ++ ODM_SetMACReg(pDM_Odm, 0x9b0 , BIT31, 0); //0x9b0[31]=0 ++ } ++ } ++} ++ ++VOID ++odm_BDCcoexType_withBferClient( ++ IN PVOID pDM_VOID, ++ IN u1Byte swch ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; ++ u1Byte BDCcoexType_wBfer; ++ ++ if(swch==DIVON_CSIOFF) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BDCcoexType: 1] {DIV,CSI} ={1,0} \n")); ++ BDCcoexType_wBfer=1; ++ ++ if(BDCcoexType_wBfer != pDM_BdcTable->BDCcoexType_wBfer) ++ { ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); ++ odm_CSI_on_off(pDM_Odm,CSI_OFF); ++ pDM_BdcTable->BDCcoexType_wBfer=1; ++ } ++ } ++ else if(swch==DIVOFF_CSION) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BDCcoexType: 2] {DIV,CSI} ={0,1}\n")); ++ BDCcoexType_wBfer=2; ++ ++ if(BDCcoexType_wBfer != pDM_BdcTable->BDCcoexType_wBfer) ++ { ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ odm_CSI_on_off(pDM_Odm,CSI_ON); ++ pDM_BdcTable->BDCcoexType_wBfer=2; ++ } ++ } ++} ++ ++VOID ++odm_BF_AntDiv_ModeArbitration( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; ++ u1Byte current_BDC_Mode; ++ ++ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n")); ++ ++ //2 Mode 1 ++ if((pDM_BdcTable->num_Txbfee_Client !=0) && (pDM_BdcTable->num_Txbfer_Client == 0)) ++ { ++ current_BDC_Mode=BDC_MODE_1; ++ ++ if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) ++ { ++ pDM_BdcTable->BDC_Mode=BDC_MODE_1; ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); ++ pDM_BdcTable->BDC_RxIdleUpdate_counter=1; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode1 ))\n")); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode1 ))\n")); ++ } ++ //2 Mode 2 ++ else if((pDM_BdcTable->num_Txbfee_Client ==0) && (pDM_BdcTable->num_Txbfer_Client != 0)) ++ { ++ current_BDC_Mode=BDC_MODE_2; ++ ++ if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) ++ { ++ pDM_BdcTable->BDC_Mode=BDC_MODE_2; ++ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; ++ pDM_BdcTable->BDC_Try_flag=0; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode2 ))\n")); ++ ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode2 ))\n")); ++ } ++ //2 Mode 3 ++ else if((pDM_BdcTable->num_Txbfee_Client !=0) && (pDM_BdcTable->num_Txbfer_Client != 0)) ++ { ++ current_BDC_Mode=BDC_MODE_3; ++ ++ if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) ++ { ++ pDM_BdcTable->BDC_Mode=BDC_MODE_3; ++ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; ++ pDM_BdcTable->BDC_Try_flag=0; ++ pDM_BdcTable->BDC_RxIdleUpdate_counter=1; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode3 ))\n")); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode3 ))\n")); ++ } ++ //2 Mode 4 ++ else if((pDM_BdcTable->num_Txbfee_Client ==0) && (pDM_BdcTable->num_Txbfer_Client == 0)) ++ { ++ current_BDC_Mode=BDC_MODE_4; ++ ++ if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) ++ { ++ pDM_BdcTable->BDC_Mode=BDC_MODE_4; ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode4 ))\n")); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode4 ))\n")); ++ } ++ #endif ++ ++} ++ ++VOID ++odm_DivTrainState_setting( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pBDC_T pDM_BdcTable=&pDM_Odm->DM_BdcTable; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n*****[S T A R T ]***** [2-0. DIV_TRAIN_STATE] \n")); ++ pDM_BdcTable->BDC_Try_counter =2; ++ pDM_BdcTable->BDC_Try_flag=1; ++ pDM_BdcTable->BDC_state=BDC_BFer_TRAIN_STATE; ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); ++} ++ ++VOID ++odm_BDCcoex_BFeeRxDiv_Arbitration( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; ++ BOOLEAN StopBF_flag; ++ u1Byte BDC_active_Mode; ++ ++ ++ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{ num_BFee, num_BFer , num_Client} = (( %d , %d , %d)) \n",pDM_BdcTable->num_Txbfee_Client,pDM_BdcTable->num_Txbfer_Client,pDM_BdcTable->num_Client)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{ num_BF_tars, num_DIV_tars } = (( %d , %d )) \n",pDM_BdcTable->num_BfTar , pDM_BdcTable->num_DivTar )); ++ ++ //2 [ MIB control ] ++ if (pDM_Odm->bdc_holdstate==2) ++ { ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); ++ pDM_BdcTable->BDC_state=BDC_BF_HOLD_STATE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ BF STATE] \n")); ++ return; ++ } ++ else if (pDM_Odm->bdc_holdstate==1) ++ { ++ pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ DIV STATE] \n")); ++ return; ++ } ++ ++ //------------------------------------------------------------ ++ ++ ++ ++ //2 Mode 2 & 3 ++ if(pDM_BdcTable->BDC_Mode==BDC_MODE_2 ||pDM_BdcTable->BDC_Mode==BDC_MODE_3) ++ { ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n{ Try_flag , Try_counter } = { %d , %d } \n",pDM_BdcTable->BDC_Try_flag,pDM_BdcTable->BDC_Try_counter)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BDCcoexType = (( %d )) \n\n", pDM_BdcTable->BDCcoexType_wBfer)); ++ ++ // All Client have Bfer-Cap------------------------------- ++ if(pDM_BdcTable->num_Txbfer_Client == pDM_BdcTable->num_Client) //BFer STA Only?: yes ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BFer STA only? (( Yes ))\n")); ++ pDM_BdcTable->BDC_Try_flag=0; ++ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); ++ return; ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BFer STA only? (( No ))\n")); ++ } ++ // ++ if(pDM_BdcTable->bAll_BFSta_Idle==FALSE && pDM_BdcTable->bAll_DivSta_Idle==TRUE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("All DIV-STA are idle, but BF-STA not\n")); ++ pDM_BdcTable->BDC_Try_flag=0; ++ pDM_BdcTable->BDC_state=BDC_BFer_TRAIN_STATE; ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); ++ return; ++ } ++ else if(pDM_BdcTable->bAll_BFSta_Idle==TRUE && pDM_BdcTable->bAll_DivSta_Idle==FALSE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("All BF-STA are idle, but DIV-STA not\n")); ++ pDM_BdcTable->BDC_Try_flag=0; ++ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); ++ return; ++ } ++ ++ //Select active mode-------------------------------------- ++ if(pDM_BdcTable->num_BfTar ==0) // Selsect_1, Selsect_2 ++ { ++ if(pDM_BdcTable->num_DivTar ==0) // Selsect_3 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 1 )) \n")); ++ pDM_BdcTable->BDC_active_Mode=1; ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 2 ))\n")); ++ pDM_BdcTable->BDC_active_Mode=2; ++ } ++ pDM_BdcTable->BDC_Try_flag=0; ++ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); ++ return; ++ } ++ else // num_BfTar > 0 ++ { ++ if(pDM_BdcTable->num_DivTar ==0) // Selsect_3 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 3 ))\n")); ++ pDM_BdcTable->BDC_active_Mode=3; ++ pDM_BdcTable->BDC_Try_flag=0; ++ pDM_BdcTable->BDC_state=BDC_BFer_TRAIN_STATE; ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); ++ return; ++ } ++ else // Selsect_4 ++ { ++ BDC_active_Mode=4; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 4 ))\n")); ++ ++ if(BDC_active_Mode!=pDM_BdcTable->BDC_active_Mode) ++ { ++ pDM_BdcTable->BDC_active_Mode=4; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to active mode (( 4 )) & return!!! \n")); ++ return; ++ } ++ } ++ } ++ ++#if 1 ++ if (pDM_Odm->bdc_holdstate==0xff) ++ { ++ pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ DIV STATE] \n")); ++ return; ++ } ++#endif ++ ++ // Does Client number changed ? ------------------------------- ++ if(pDM_BdcTable->num_Client !=pDM_BdcTable->pre_num_Client) ++ { ++ pDM_BdcTable->BDC_Try_flag=0; ++ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ The number of client has been changed !!!] return to (( BDC_DIV_TRAIN_STATE )) \n")); ++ } ++ pDM_BdcTable->pre_num_Client=pDM_BdcTable->num_Client; ++ ++ if( pDM_BdcTable->BDC_Try_flag==0) ++ { ++ //2 DIV_TRAIN_STATE (Mode 2-0) ++ if(pDM_BdcTable->BDC_state==BDC_DIV_TRAIN_STATE) ++ { ++ odm_DivTrainState_setting( pDM_Odm); ++ } ++ //2 BFer_TRAIN_STATE (Mode 2-1) ++ else if(pDM_BdcTable->BDC_state==BDC_BFer_TRAIN_STATE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-1. BFer_TRAIN_STATE ]***** \n")); ++ ++ //if(pDM_BdcTable->num_BfTar==0) ++ //{ ++ // ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( No )), [ BDC_BFer_TRAIN_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); ++ // odm_DivTrainState_setting( pDM_Odm); ++ //} ++ //else //num_BfTar != 0 ++ //{ ++ pDM_BdcTable->BDC_Try_counter=2; ++ pDM_BdcTable->BDC_Try_flag=1; ++ pDM_BdcTable->BDC_state=BDC_DECISION_STATE; ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes )), [ BDC_BFer_TRAIN_STATE ] >> [BDC_DECISION_STATE] \n")); ++ //} ++ } ++ //2 DECISION_STATE (Mode 2-2) ++ else if(pDM_BdcTable->BDC_state==BDC_DECISION_STATE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-2. DECISION_STATE]***** \n")); ++ //if(pDM_BdcTable->num_BfTar==0) ++ //{ ++ // ODM_AntDiv_Printk(("BF_tars exist? : (( No )), [ DECISION_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); ++ // odm_DivTrainState_setting( pDM_Odm); ++ //} ++ //else //num_BfTar != 0 ++ //{ ++ if(pDM_BdcTable->BF_pass==FALSE || pDM_BdcTable->DIV_pass == FALSE) ++ StopBF_flag=TRUE; ++ else ++ StopBF_flag=FALSE; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes )), {BF_pass, DIV_pass, StopBF_flag } = { %d, %d, %d } \n" ,pDM_BdcTable->BF_pass,pDM_BdcTable->DIV_pass,StopBF_flag)); ++ ++ if(StopBF_flag==TRUE) //DIV_en ++ { ++ pDM_BdcTable->BDC_Hold_counter=10; //20 ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); ++ pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ StopBF_flag= ((TRUE)), BDC_DECISION_STATE ] >> [BDC_DIV_HOLD_STATE] \n")); ++ } ++ else //BF_en ++ { ++ pDM_BdcTable->BDC_Hold_counter=10; //20 ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); ++ pDM_BdcTable->BDC_state=BDC_BF_HOLD_STATE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[StopBF_flag= ((FALSE)), BDC_DECISION_STATE ] >> [BDC_BF_HOLD_STATE] \n")); ++ } ++ //} ++ } ++ //2 BF-HOLD_STATE (Mode 2-3) ++ else if(pDM_BdcTable->BDC_state==BDC_BF_HOLD_STATE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-3. BF_HOLD_STATE ]*****\n")); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BDC_Hold_counter = (( %d )) \n",pDM_BdcTable->BDC_Hold_counter )); ++ ++ if(pDM_BdcTable->BDC_Hold_counter==1) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); ++ odm_DivTrainState_setting( pDM_Odm); ++ } ++ else ++ { ++ pDM_BdcTable->BDC_Hold_counter--; ++ ++ //if(pDM_BdcTable->num_BfTar==0) ++ //{ ++ // ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( No )), [ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); ++ // odm_DivTrainState_setting( pDM_Odm); ++ //} ++ //else //num_BfTar != 0 ++ //{ ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes ))\n")); ++ pDM_BdcTable->BDC_state=BDC_BF_HOLD_STATE; ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_BF_HOLD_STATE ] >> [BDC_BF_HOLD_STATE] \n")); ++ //} ++ } ++ ++ } ++ //2 DIV-HOLD_STATE (Mode 2-4) ++ else if(pDM_BdcTable->BDC_state==BDC_DIV_HOLD_STATE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-4. DIV_HOLD_STATE ]*****\n")); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BDC_Hold_counter = (( %d )) \n",pDM_BdcTable->BDC_Hold_counter )); ++ ++ if(pDM_BdcTable->BDC_Hold_counter==1) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); ++ odm_DivTrainState_setting( pDM_Odm); ++ } ++ else ++ { ++ pDM_BdcTable->BDC_Hold_counter--; ++ pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; ++ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_HOLD_STATE] \n")); ++ } ++ ++ } ++ ++ } ++ else if( pDM_BdcTable->BDC_Try_flag==1) ++ { ++ //2 Set Training Counter ++ if(pDM_BdcTable->BDC_Try_counter >1) ++ { ++ pDM_BdcTable->BDC_Try_counter--; ++ if(pDM_BdcTable->BDC_Try_counter ==1) ++ pDM_BdcTable->BDC_Try_flag=0; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training !!\n")); ++ //return ; ++ } ++ ++ } ++ ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n[end]\n")); ++ ++ #endif //#if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++ ++ ++ ++ ++ ++} ++ ++#endif ++#endif //#ifdef BEAMFORMING_SUPPORT ++ ++ ++#if (RTL8188E_SUPPORT == 1) ++ ++ ++VOID ++odm_RX_HWAntDiv_Init_88E( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte value32; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ #if 0 ++ if(pDM_Odm->mp_mode == TRUE) ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_IGI_A_11N , BIT7, 0); // disable HW AntDiv ++ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT31, 1); // 1:CG, 0:CS ++ return; ++ } ++ #endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => AntDivType=[CGCS_RX_HW_ANTDIV]\n")); ++ ++ //MAC Setting ++ value32 = ODM_GetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord); ++ ODM_SetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord, value32|(BIT23|BIT25)); //Reg4C[25]=1, Reg4C[23]=1 for pin output ++ //Pin Settings ++ ODM_SetBBReg(pDM_Odm, ODM_REG_PIN_CTRL_11N , BIT9|BIT8, 0);//Reg870[8]=1'b0, Reg870[9]=1'b0 //antsel antselb by HW ++ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_ANT_CTRL_11N , BIT10, 0); //Reg864[10]=1'b0 //antsel2 by HW ++ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT22, 1); //Regb2c[22]=1'b0 //disable CS/CG switch ++ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT31, 1); //Regb2c[31]=1'b1 //output at CG only ++ //OFDM Settings ++ ODM_SetBBReg(pDM_Odm, ODM_REG_ANTDIV_PARA1_11N , bMaskDWord, 0x000000a0); ++ //CCK Settings ++ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_PWR_SAV4_11N , BIT7, 1); //Fix CCK PHY status report issue ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_ANTDIV_PARA2_11N , BIT4, 1); //CCK complete HW AntDiv within 64 samples ++ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_ANT_MAPPING1_11N , 0xFFFF, 0x0001); //antenna mapping table ++ ++ pDM_FatTable->enable_ctrl_frame_antdiv = 1; ++} ++ ++VOID ++odm_TRX_HWAntDiv_Init_88E( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte value32; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ #if 0 ++ if(pDM_Odm->mp_mode == TRUE) ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_IGI_A_11N , BIT7, 0); // disable HW AntDiv ++ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_ANT_CTRL_11N , BIT5|BIT4|BIT3, 0); //Default RX (0/1) ++ return; ++ } ++ #endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => AntDivType=[CG_TRX_HW_ANTDIV (SPDT)]\n")); ++ ++ //MAC Setting ++ value32 = ODM_GetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord); ++ ODM_SetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord, value32|(BIT23|BIT25)); //Reg4C[25]=1, Reg4C[23]=1 for pin output ++ //Pin Settings ++ ODM_SetBBReg(pDM_Odm, ODM_REG_PIN_CTRL_11N , BIT9|BIT8, 0);//Reg870[8]=1'b0, Reg870[9]=1'b0 //antsel antselb by HW ++ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_ANT_CTRL_11N , BIT10, 0); //Reg864[10]=1'b0 //antsel2 by HW ++ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT22, 0); //Regb2c[22]=1'b0 //disable CS/CG switch ++ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT31, 1); //Regb2c[31]=1'b1 //output at CG only ++ //OFDM Settings ++ ODM_SetBBReg(pDM_Odm, ODM_REG_ANTDIV_PARA1_11N , bMaskDWord, 0x000000a0); ++ //CCK Settings ++ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_PWR_SAV4_11N , BIT7, 1); //Fix CCK PHY status report issue ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_ANTDIV_PARA2_11N , BIT4, 1); //CCK complete HW AntDiv within 64 samples ++ ++ //antenna mapping table ++ if(!pDM_Odm->bIsMPChip) //testchip ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_DEFUALT_A_11N , BIT10|BIT9|BIT8, 1); //Reg858[10:8]=3'b001 ++ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_DEFUALT_A_11N , BIT13|BIT12|BIT11, 2); //Reg858[13:11]=3'b010 ++ } ++ else //MPchip ++ ODM_SetBBReg(pDM_Odm, ODM_REG_ANT_MAPPING1_11N , bMaskDWord, 0x0201); /*Reg914=3'b010, Reg915=3'b001*/ ++ ++ pDM_FatTable->enable_ctrl_frame_antdiv = 1; ++} ++ ++ ++#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) ++VOID ++odm_Smart_HWAntDiv_Init_88E( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte value32, i; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => AntDivType=[CG_TRX_SMART_ANTDIV]\n")); ++ ++ #if 0 ++ if(pDM_Odm->mp_mode == TRUE) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("pDM_Odm->AntDivType: %d\n", pDM_Odm->AntDivType)); ++ return; ++ } ++ #endif ++ ++ pDM_FatTable->TrainIdx = 0; ++ pDM_FatTable->FAT_State = FAT_PREPARE_STATE; ++ ++ pDM_Odm->fat_comb_a=5; ++ pDM_Odm->antdiv_intvl = 0x64; // 100ms ++ ++ for(i=0; i<6; i++) ++ { ++ pDM_FatTable->Bssid[i] = 0; ++ } ++ for(i=0; i< (pDM_Odm->fat_comb_a) ; i++) ++ { ++ pDM_FatTable->antSumRSSI[i] = 0; ++ pDM_FatTable->antRSSIcnt[i] = 0; ++ pDM_FatTable->antAveRSSI[i] = 0; ++ } ++ ++ //MAC Setting ++ value32 = ODM_GetMACReg(pDM_Odm, 0x4c, bMaskDWord); ++ ODM_SetMACReg(pDM_Odm, 0x4c, bMaskDWord, value32|(BIT23|BIT25)); //Reg4C[25]=1, Reg4C[23]=1 for pin output ++ value32 = ODM_GetMACReg(pDM_Odm, 0x7B4, bMaskDWord); ++ ODM_SetMACReg(pDM_Odm, 0x7b4, bMaskDWord, value32|(BIT16|BIT17)); //Reg7B4[16]=1 enable antenna training, Reg7B4[17]=1 enable A2 match ++ //value32 = PlatformEFIORead4Byte(Adapter, 0x7B4); ++ //PlatformEFIOWrite4Byte(Adapter, 0x7b4, value32|BIT18); //append MACID in reponse packet ++ ++ //Match MAC ADDR ++ ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, 0); ++ ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, 0); ++ ++ ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0);//Reg870[8]=1'b0, Reg870[9]=1'b0 //antsel antselb by HW ++ ODM_SetBBReg(pDM_Odm, 0x864 , BIT10, 0); //Reg864[10]=1'b0 //antsel2 by HW ++ ODM_SetBBReg(pDM_Odm, 0xb2c , BIT22, 0); //Regb2c[22]=1'b0 //disable CS/CG switch ++ ODM_SetBBReg(pDM_Odm, 0xb2c , BIT31, 0); //Regb2c[31]=1'b1 //output at CS only ++ ODM_SetBBReg(pDM_Odm, 0xca4 , bMaskDWord, 0x000000a0); ++ ++ //antenna mapping table ++ if(pDM_Odm->fat_comb_a == 2) ++ { ++ if(!pDM_Odm->bIsMPChip) //testchip ++ { ++ ODM_SetBBReg(pDM_Odm, 0x858 , BIT10|BIT9|BIT8, 1); //Reg858[10:8]=3'b001 ++ ODM_SetBBReg(pDM_Odm, 0x858 , BIT13|BIT12|BIT11, 2); //Reg858[13:11]=3'b010 ++ } ++ else //MPchip ++ { ++ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 1); ++ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 2); ++ } ++ } ++ else ++ { ++ if(!pDM_Odm->bIsMPChip) //testchip ++ { ++ ODM_SetBBReg(pDM_Odm, 0x858 , BIT10|BIT9|BIT8, 0); //Reg858[10:8]=3'b000 ++ ODM_SetBBReg(pDM_Odm, 0x858 , BIT13|BIT12|BIT11, 1); //Reg858[13:11]=3'b001 ++ ODM_SetBBReg(pDM_Odm, 0x878 , BIT16, 0); ++ ODM_SetBBReg(pDM_Odm, 0x858 , BIT15|BIT14, 2); //(Reg878[0],Reg858[14:15])=3'b010 ++ ODM_SetBBReg(pDM_Odm, 0x878 , BIT19|BIT18|BIT17, 3);//Reg878[3:1]=3b'011 ++ ODM_SetBBReg(pDM_Odm, 0x878 , BIT22|BIT21|BIT20, 4);//Reg878[6:4]=3b'100 ++ ODM_SetBBReg(pDM_Odm, 0x878 , BIT25|BIT24|BIT23, 5);//Reg878[9:7]=3b'101 ++ ODM_SetBBReg(pDM_Odm, 0x878 , BIT28|BIT27|BIT26, 6);//Reg878[12:10]=3b'110 ++ ODM_SetBBReg(pDM_Odm, 0x878 , BIT31|BIT30|BIT29, 7);//Reg878[15:13]=3b'111 ++ } ++ else //MPchip ++ { ++ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 4); // 0: 3b'000 ++ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 2); // 1: 3b'001 ++ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte2, 0); // 2: 3b'010 ++ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte3, 1); // 3: 3b'011 ++ ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte0, 3); // 4: 3b'100 ++ ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte1, 5); // 5: 3b'101 ++ ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte2, 6); // 6: 3b'110 ++ ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte3, 255); // 7: 3b'111 ++ } ++ } ++ ++ //Default Ant Setting when no fast training ++ ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, 0); //Default RX ++ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, 1); //Optional RX ++ ODM_SetBBReg(pDM_Odm, 0x860 , BIT14|BIT13|BIT12, 0);//Default TX ++ ++ //Enter Traing state ++ ODM_SetBBReg(pDM_Odm, 0x864 , BIT2|BIT1|BIT0, (pDM_Odm->fat_comb_a-1)); //Reg864[2:0]=3'd6 //ant combination=reg864[2:0]+1 ++ ++ //SW Control ++ //PHY_SetBBReg(Adapter, 0x864 , BIT10, 1); ++ //PHY_SetBBReg(Adapter, 0x870 , BIT9, 1); ++ //PHY_SetBBReg(Adapter, 0x870 , BIT8, 1); ++ //PHY_SetBBReg(Adapter, 0x864 , BIT11, 1); ++ //PHY_SetBBReg(Adapter, 0x860 , BIT9, 0); ++ //PHY_SetBBReg(Adapter, 0x860 , BIT8, 0); ++} ++#endif ++ ++#endif //#if (RTL8188E_SUPPORT == 1) ++ ++ ++#if (RTL8192E_SUPPORT == 1) ++VOID ++odm_RX_HWAntDiv_Init_92E( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ #if 0 ++ if(pDM_Odm->mp_mode == TRUE) ++ { ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 0); //r_rxdiv_enable_anta Regc50[8]=1'b0 0: control by c50[9] ++ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT9, 1); // 1:CG, 0:CS ++ return; ++ } ++ #endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => AntDivType=[CGCS_RX_HW_ANTDIV]\n")); ++ ++ //Pin Settings ++ ODM_SetBBReg(pDM_Odm, 0x870 , BIT8, 0);//Reg870[8]=1'b0, // "antsel" is controled by HWs ++ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 1); //Regc50[8]=1'b1 //" CS/CG switching" is controled by HWs ++ ++ //Mapping table ++ ODM_SetBBReg(pDM_Odm, 0x914 , 0xFFFF, 0x0100); //antenna mapping table ++ ++ //OFDM Settings ++ ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF, 0xA0); //thershold ++ ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF000, 0x0); //bias ++ ++ //CCK Settings ++ ODM_SetBBReg(pDM_Odm, 0xa04 , 0xF000000, 0); //Select which path to receive for CCK_1 & CCK_2 ++ ODM_SetBBReg(pDM_Odm, 0xb34 , BIT30, 0); //(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 ++ ODM_SetBBReg(pDM_Odm, 0xa74 , BIT7, 1); //Fix CCK PHY status report issue ++ ODM_SetBBReg(pDM_Odm, 0xa0c , BIT4, 1); //CCK complete HW AntDiv within 64 samples ++ ++ #ifdef ODM_EVM_ENHANCE_ANTDIV ++ //EVM enhance AntDiv method init---------------------------------------------------------------------- ++ pDM_FatTable->EVM_method_enable=0; ++ pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; ++ pDM_Odm->antdiv_intvl = 0x64; ++ ODM_SetBBReg(pDM_Odm, 0x910 , 0x3f, 0xf ); ++ pDM_Odm->antdiv_evm_en=1; ++ //pDM_Odm->antdiv_period=1; ++ pDM_Odm->evm_antdiv_period = 3; ++ ++ #endif ++ ++} ++ ++VOID ++odm_TRX_HWAntDiv_Init_92E( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ #if 0 ++ if(pDM_Odm->mp_mode == TRUE) ++ { ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 0); //r_rxdiv_enable_anta Regc50[8]=1'b0 0: control by c50[9] ++ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT9, 1); // 1:CG, 0:CS ++ return; ++ } ++ #endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => AntDivType=[ Only for DIR605, CG_TRX_HW_ANTDIV]\n")); ++ ++ //3 --RFE pin setting--------- ++ //[MAC] ++ ODM_SetMACReg(pDM_Odm, 0x38, BIT11, 1); //DBG PAD Driving control (GPIO 8) ++ ODM_SetMACReg(pDM_Odm, 0x4c, BIT23, 0); //path-A , RFE_CTRL_3 ++ ODM_SetMACReg(pDM_Odm, 0x4c, BIT29, 1); //path-A , RFE_CTRL_8 ++ //[BB] ++ ODM_SetBBReg(pDM_Odm, 0x944 , BIT3, 1); //RFE_buffer ++ ODM_SetBBReg(pDM_Odm, 0x944 , BIT8, 1); ++ ODM_SetBBReg(pDM_Odm, 0x940 , BIT7|BIT6, 0x0); // r_rfe_path_sel_ (RFE_CTRL_3) ++ ODM_SetBBReg(pDM_Odm, 0x940 , BIT17|BIT16, 0x0); // r_rfe_path_sel_ (RFE_CTRL_8) ++ ODM_SetBBReg(pDM_Odm, 0x944 , BIT31, 0); //RFE_buffer ++ ODM_SetBBReg(pDM_Odm, 0x92C , BIT3, 0); //rfe_inv (RFE_CTRL_3) ++ ODM_SetBBReg(pDM_Odm, 0x92C , BIT8, 1); //rfe_inv (RFE_CTRL_8) ++ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF000, 0x8); //path-A , RFE_CTRL_3 ++ ODM_SetBBReg(pDM_Odm, 0x934 , 0xF, 0x8); //path-A , RFE_CTRL_8 ++ //3 ------------------------- ++ ++ //Pin Settings ++ ODM_SetBBReg(pDM_Odm, 0xC50 , BIT8, 0); //path-A //disable CS/CG switch ++ ++/* Let it follows PHY_REG for bit9 setting ++ if(pDM_Odm->priv->pshare->rf_ft_var.use_ext_pa || pDM_Odm->priv->pshare->rf_ft_var.use_ext_lna) ++ ODM_SetBBReg(pDM_Odm, 0xC50 , BIT9, 1);//path-A //output at CS ++ else ++ ODM_SetBBReg(pDM_Odm, 0xC50 , BIT9, 0); //path-A //output at CG ->normal power ++*/ ++ ++ ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0); //path-A //antsel antselb by HW ++ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT10, 0); //path-A //antsel2 by HW ++ ++ //Mapping table ++ ODM_SetBBReg(pDM_Odm, 0x914 , 0xFFFF, 0x0100); //antenna mapping table ++ ++ //OFDM Settings ++ ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF, 0xA0); //thershold ++ ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF000, 0x0); //bias ++ ++ //CCK Settings ++ ODM_SetBBReg(pDM_Odm, 0xa04 , 0xF000000, 0); //Select which path to receive for CCK_1 & CCK_2 ++ ODM_SetBBReg(pDM_Odm, 0xb34 , BIT30, 0); //(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 ++ ODM_SetBBReg(pDM_Odm, 0xa74 , BIT7, 1); //Fix CCK PHY status report issue ++ ODM_SetBBReg(pDM_Odm, 0xa0c , BIT4, 1); //CCK complete HW AntDiv within 64 samples ++ ++ #ifdef ODM_EVM_ENHANCE_ANTDIV ++ //EVM enhance AntDiv method init---------------------------------------------------------------------- ++ pDM_FatTable->EVM_method_enable=0; ++ pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; ++ pDM_Odm->antdiv_intvl = 0x64; ++ ODM_SetBBReg(pDM_Odm, 0x910 , 0x3f, 0xf ); ++ pDM_Odm->antdiv_evm_en=1; ++ //pDM_Odm->antdiv_period=1; ++ pDM_Odm->evm_antdiv_period = 3; ++ #endif ++} ++ ++#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) ++VOID ++odm_Smart_HWAntDiv_Init_92E( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => AntDivType=[CG_TRX_SMART_ANTDIV]\n")); ++} ++#endif ++ ++#endif //#if (RTL8192E_SUPPORT == 1) ++ ++#if (RTL8723D_SUPPORT == 1) ++VOID ++odm_TRX_HWAntDiv_Init_8723D( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8723D] AntDiv_Init => AntDivType=[S0S1_HW_TRX_AntDiv]\n")); ++ ++ /*BT Coexistence*/ ++ /*keep antsel_map when GNT_BT = 1*/ ++ ODM_SetBBReg(pDM_Odm, 0x864, BIT12, 1); ++ /* //Disable hw antsw & fast_train.antsw when GNT_BT=1*/ ++ ODM_SetBBReg(pDM_Odm, 0x874 , BIT23, 0); ++ /*//Disable hw antsw & fast_train.antsw when BT TX/RX*/ ++ ODM_SetBBReg(pDM_Odm, 0xE64 , 0xFFFF0000, 0x000c); ++ ++ ++ ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0); ++ /*PTA setting: WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL)*/ ++ /*ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0);*/ ++ /*ODM_SetBBReg(pDM_Odm, 0x948 , BIT8, 0);*/ ++ /*GNT_WL tx*/ ++ ODM_SetBBReg(pDM_Odm, 0x950 , BIT29, 0); ++ ++ ++ /*Mapping Table*/ ++ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 0); ++ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 3); ++ /*ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, 0);*/ ++ /*ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, 1);*/ ++ ++ /* //Set WLBB_SEL_RF_ON 1 if RXFIR_PWDB > 0xCcc[3:0]*/ ++ ODM_SetBBReg(pDM_Odm, 0xCcc, BIT12, 0); ++ /* //Low-to-High threshold for WLBB_SEL_RF_ON when OFDM enable*/ ++ ODM_SetBBReg(pDM_Odm, 0xCcc , 0x0F, 0x01); ++ /*//High-to-Low threshold for WLBB_SEL_RF_ON when OFDM enable*/ ++ ODM_SetBBReg(pDM_Odm, 0xCcc , 0xF0, 0x0); ++ /* //b Low-to-High threshold for WLBB_SEL_RF_ON when OFDM disable ( only CCK )*/ ++ ODM_SetBBReg(pDM_Odm, 0xAbc , 0xFF, 0x06); ++ /* //High-to-Low threshold for WLBB_SEL_RF_ON when OFDM disable ( only CCK )*/ ++ ODM_SetBBReg(pDM_Odm, 0xAbc , 0xFF00, 0x00); ++ ++ ++ /*OFDM HW AntDiv Parameters*/ ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF, 0xa0); ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF000, 0x00); ++ ODM_SetBBReg(pDM_Odm, 0xC5C , BIT20|BIT19|BIT18, 0x04); ++ ++ /*CCK HW AntDiv Parameters*/ ++ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); ++ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); ++ ODM_SetBBReg(pDM_Odm, 0xAA8 , BIT8, 0); ++ ++ ODM_SetBBReg(pDM_Odm, 0xA0C , 0x0F, 0xf); ++ ODM_SetBBReg(pDM_Odm, 0xA14 , 0x1F, 0x8); ++ ODM_SetBBReg(pDM_Odm, 0xA10 , BIT13, 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT8, 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xB34 , BIT30, 0x1); ++ ++ /*disable antenna training */ ++ ODM_SetBBReg(pDM_Odm, 0xE08 , BIT16, 0); ++ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 0); ++ ++} ++ ++VOID ++phydm_set_tx_ant_pwr_8723d( ++ IN PVOID pDM_VOID, ++ IN u1Byte Ant ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ pDM_FatTable->RxIdleAnt = Ant; ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ pAdapter->HalFunc.SetTxPowerLevelHandler(pAdapter, pHalData->CurrentChannel); ++ #elif(DM_ODM_SUPPORT_TYPE == ODM_CE) ++ rtw_hal_set_tx_power_level(pAdapter, pHalData->CurrentChannel); ++ #endif ++ ++} ++#endif ++ ++#if (RTL8723B_SUPPORT == 1) ++VOID ++odm_TRX_HWAntDiv_Init_8723B( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8723B AntDiv_Init => AntDivType=[CG_TRX_HW_ANTDIV(DPDT)]\n")); ++ ++ //Mapping Table ++ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 0); ++ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 1); ++ ++ //OFDM HW AntDiv Parameters ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF, 0xa0); //thershold ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF000, 0x00); //bias ++ ++ //CCK HW AntDiv Parameters ++ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M ++ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples ++ ++ //BT Coexistence ++ ODM_SetBBReg(pDM_Odm, 0x864, BIT12, 0); //keep antsel_map when GNT_BT = 1 ++ ODM_SetBBReg(pDM_Odm, 0x874 , BIT23, 0); //Disable hw antsw & fast_train.antsw when GNT_BT=1 ++ ++ //Output Pin Settings ++ ODM_SetBBReg(pDM_Odm, 0x870 , BIT8, 0); // ++ ++ ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0); //WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL) ++ ODM_SetBBReg(pDM_Odm, 0x948 , BIT7, 0); ++ ++ ODM_SetMACReg(pDM_Odm, 0x40 , BIT3, 1); ++ ODM_SetMACReg(pDM_Odm, 0x38 , BIT11, 1); ++ ODM_SetMACReg(pDM_Odm, 0x4C , BIT24|BIT23, 2); //select DPDT_P and DPDT_N as output pin ++ ++ ODM_SetBBReg(pDM_Odm, 0x944 , BIT0|BIT1, 3); //in/out ++ ODM_SetBBReg(pDM_Odm, 0x944 , BIT31, 0); // ++ ++ ODM_SetBBReg(pDM_Odm, 0x92C , BIT1, 0); //DPDT_P non-inverse ++ ODM_SetBBReg(pDM_Odm, 0x92C , BIT0, 1); //DPDT_N inverse ++ ++ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF0, 8); // DPDT_P = ANTSEL[0] ++ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF, 8); // DPDT_N = ANTSEL[0] ++ ++ //2 [--For HW Bug Setting] ++ if(pDM_Odm->AntType == ODM_AUTO_ANT) ++ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable ++ ++} ++ ++ ++ ++VOID ++odm_S0S1_SWAntDiv_Init_8723B( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8723B AntDiv_Init => AntDivType=[ S0S1_SW_AntDiv] \n")); ++ ++ //Mapping Table ++ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 0); ++ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 1); ++ ++ //Output Pin Settings ++ //ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0x1); ++ ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0); ++ ++ pDM_FatTable->bBecomeLinked =FALSE; ++ pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; ++ pDM_SWAT_Table->Double_chk_flag = 0; ++ ++ //2 [--For HW Bug Setting] ++ ODM_SetBBReg(pDM_Odm, 0x80C , BIT21, 0); //TX Ant by Reg ++ ++} ++ ++VOID ++ODM_UpdateRxIdleAnt_8723B( ++ IN PVOID pDM_VOID, ++ IN u1Byte Ant, ++ IN u4Byte DefaultAnt, ++ IN u4Byte OptionalAnt ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u1Byte count=0; ++ u1Byte u1Temp; ++ u1Byte H2C_Parameter; ++ ++ if ((!pDM_Odm->bLinked) && (pDM_Odm->AntType == ODM_AUTO_ANT)) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to no link\n")); ++ return; ++ } ++ ++#if 0 ++ // Send H2C command to FW ++ // Enable wifi calibration ++ H2C_Parameter = TRUE; ++ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_WIFI_CALIBRATION, 1, &H2C_Parameter); ++ ++ // Check if H2C command sucess or not (0x1e6) ++ u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e6); ++ while((u1Temp != 0x1) && (count < 100)) ++ { ++ ODM_delay_us(10); ++ u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e6); ++ count++; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: H2C command status = %d, count = %d\n", u1Temp, count)); ++ ++ if(u1Temp == 0x1) ++ { ++ // Check if BT is doing IQK (0x1e7) ++ count = 0; ++ u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e7); ++ while((!(u1Temp & BIT0)) && (count < 100)) ++ { ++ ODM_delay_us(50); ++ u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e7); ++ count++; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: BT IQK status = %d, count = %d\n", u1Temp, count)); ++ ++ if(u1Temp & BIT0) ++ { ++ ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0x1); ++ ODM_SetBBReg(pDM_Odm, 0x948 , BIT9, DefaultAnt); ++ ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, DefaultAnt); //Default RX ++ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, OptionalAnt); //Optional RX ++ ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, DefaultAnt); //Default TX ++ pDM_FatTable->RxIdleAnt = Ant; ++ ++ // Set TX AGC by S0/S1 ++ // Need to consider Linux driver ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ pAdapter->HalFunc.SetTxPowerLevelHandler(pAdapter, pHalData->CurrentChannel); ++#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) ++ rtw_hal_set_tx_power_level(pAdapter, pHalData->CurrentChannel); ++#endif ++ ++ // Set IQC by S0/S1 ++ ODM_SetIQCbyRFpath(pDM_Odm,DefaultAnt); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Sucess to set RX antenna\n")); ++ } ++ else ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to BT IQK\n")); ++ } ++ else ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to H2C command fail\n")); ++ ++ // Send H2C command to FW ++ // Disable wifi calibration ++ H2C_Parameter = FALSE; ++ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_WIFI_CALIBRATION, 1, &H2C_Parameter); ++#else ++ ++ ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0x1); ++ ODM_SetBBReg(pDM_Odm, 0x948 , BIT9, DefaultAnt); ++ ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, DefaultAnt); /*Default RX*/ ++ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, OptionalAnt); /*Optional RX*/ ++ ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, DefaultAnt); /*Default TX*/ ++ pDM_FatTable->RxIdleAnt = Ant; ++ ++ /* Set TX AGC by S0/S1 */ ++ /* Need to consider Linux driver */ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ pAdapter->HalFunc.SetTxPowerLevelHandler(pAdapter, pHalData->CurrentChannel); ++ #elif(DM_ODM_SUPPORT_TYPE == ODM_CE) ++ rtw_hal_set_tx_power_level(pAdapter, pHalData->CurrentChannel); ++ #endif ++ ++ /* Set IQC by S0/S1 */ ++ ODM_SetIQCbyRFpath(pDM_Odm, DefaultAnt); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Success to set RX antenna\n")); ++ ++#endif ++} ++ ++BOOLEAN ++phydm_IsBtEnable_8723b( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte bt_state; ++ /*u4Byte reg75;*/ ++ ++ /*reg75 = ODM_GetBBReg(pDM_Odm, 0x74 , BIT8);*/ ++ /*ODM_SetBBReg(pDM_Odm, 0x74 , BIT8, 0x0);*/ ++ ODM_SetBBReg(pDM_Odm, 0xa0 , BIT24|BIT25|BIT26, 0x5); ++ bt_state = ODM_GetBBReg(pDM_Odm, 0xa0 , (BIT3|BIT2|BIT1|BIT0)); ++ /*ODM_SetBBReg(pDM_Odm, 0x74 , BIT8, reg75);*/ ++ ++ if ((bt_state == 4) || (bt_state == 7) || (bt_state == 9) || (bt_state == 13)) ++ return TRUE; ++ else ++ return FALSE; ++} ++#endif //#if (RTL8723B_SUPPORT == 1) ++ ++#if (RTL8821A_SUPPORT == 1) ++#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 ++VOID ++phydm_hl_smart_ant_type1_init_8821a( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ u4Byte value32; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A SmartAnt_Init => AntDivType=[Hong-Lin Smart Ant Type1]\n")); ++ ++ /*---------------------------------------- ++ GPIO 2-3 for Beam control ++ reg0x66[2]=0 ++ reg0x44[27:26] = 0 ++ reg0x44[23:16] //enable_output for P_GPIO[7:0] ++ reg0x44[15:8] //output_value for P_GPIO[7:0] ++ reg0x40[1:0] = 0 //GPIO function ++ ------------------------------------------*/ ++ ++ /*GPIO Setting*/ ++ ODM_SetMACReg(pDM_Odm, 0x64 , BIT18, 0); ++ ODM_SetMACReg(pDM_Odm, 0x44 , BIT27|BIT26, 0); ++ ODM_SetMACReg(pDM_Odm, 0x44 , BIT19|BIT18, 0x3); /*enable_output for P_GPIO[3:2]*/ ++ /*ODM_SetMACReg(pDM_Odm, 0x44 , BIT11|BIT10, 0);*/ /*output value*/ ++ ODM_SetMACReg(pDM_Odm, 0x40 , BIT1|BIT0, 0); /*GPIO function*/ ++ ++ /*Hong_lin smart antenna HW Setting*/ ++ pdm_sat_table->data_codeword_bit_num = 24;/*max=32*/ ++ pdm_sat_table->beam_patten_num_each_ant = 4; ++ ++ #if DEV_BUS_TYPE == RT_SDIO_INTERFACE ++ pdm_sat_table->latch_time = 100; /*mu sec*/ ++ #elif DEV_BUS_TYPE == RT_USB_INTERFACE ++ pdm_sat_table->latch_time = 100; /*mu sec*/ ++ #endif ++ pdm_sat_table->pkt_skip_statistic_en = 0; ++ ++ pdm_sat_table->ant_num = 1;/*max=8*/ ++ pdm_sat_table->ant_num_total = NUM_ANTENNA_8821A; ++ pdm_sat_table->first_train_ant = MAIN_ANT; ++ ++ pdm_sat_table->rfu_codeword_table[0] = 0x0; ++ pdm_sat_table->rfu_codeword_table[1] = 0x4; ++ pdm_sat_table->rfu_codeword_table[2] = 0x8; ++ pdm_sat_table->rfu_codeword_table[3] = 0xc; ++ ++ pdm_sat_table->rfu_codeword_table_5g[0] = 0x1; ++ pdm_sat_table->rfu_codeword_table_5g[1] = 0x2; ++ pdm_sat_table->rfu_codeword_table_5g[2] = 0x4; ++ pdm_sat_table->rfu_codeword_table_5g[3] = 0x8; ++ ++ pdm_sat_table->fix_beam_pattern_en = 0; ++ pdm_sat_table->decision_holding_period = 0; ++ ++ /*beam training setting*/ ++ pdm_sat_table->pkt_counter = 0; ++ pdm_sat_table->per_beam_training_pkt_num = 10; ++ ++ /*set default beam*/ ++ pdm_sat_table->fast_training_beam_num = 0; ++ pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; ++ phydm_set_all_ant_same_beam_num(pDM_Odm); ++ ++ pDM_FatTable->FAT_State = FAT_BEFORE_LINK_STATE; ++ ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskDWord, 0x01000100); ++ ODM_SetBBReg(pDM_Odm, 0xCA8 , bMaskDWord, 0x01000100); ++ ++ /*[BB] FAT Setting*/ ++ ODM_SetBBReg(pDM_Odm, 0xc08 , BIT18|BIT17|BIT16, pdm_sat_table->ant_num); ++ ODM_SetBBReg(pDM_Odm, 0xc08 , BIT31, 0); /*increase ant num every FAT period 0:+1, 1+2*/ ++ ODM_SetBBReg(pDM_Odm, 0x8c4 , BIT2|BIT1, 1); /*change cca antenna timming threshold if no CCA occurred: 0:200ms / 1:100ms / 2:no use / 3: 300*/ ++ ODM_SetBBReg(pDM_Odm, 0x8c4 , BIT0, 1); /*FAT_watchdog_en*/ ++ ++ value32 = ODM_GetMACReg(pDM_Odm, 0x7B4, bMaskDWord); ++ ODM_SetMACReg(pDM_Odm, 0x7b4, bMaskDWord, value32|(BIT16|BIT17)); /*Reg7B4[16]=1 enable antenna training */ ++ /*Reg7B4[17]=1 enable match MAC Addr*/ ++ ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, 0);/*Match MAC ADDR*/ ++ ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, 0); ++ ++} ++#endif ++ ++VOID ++odm_TRX_HWAntDiv_Init_8821A( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (DPDT)] \n")); ++ ++ //Output Pin Settings ++ ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); ++ ++ ODM_SetMACReg(pDM_Odm, 0x64 , BIT29, 1); //PAPE by WLAN control ++ ODM_SetMACReg(pDM_Odm, 0x64 , BIT28, 1); //LNAON by WLAN control ++ ++ ODM_SetBBReg(pDM_Odm, 0xCB0 , bMaskDWord, 0x77775745); ++ ODM_SetBBReg(pDM_Odm, 0xCB8 , BIT16, 0); ++ ++ ODM_SetMACReg(pDM_Odm, 0x4C , BIT23, 0); //select DPDT_P and DPDT_N as output pin ++ ODM_SetMACReg(pDM_Odm, 0x4C , BIT24, 1); //by WLAN control ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF, 8); // DPDT_P = ANTSEL[0] ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF0, 8); // DPDT_N = ANTSEL[0] ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT29, 0); //DPDT_P non-inverse ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT28, 1); //DPDT_N inverse ++ ++ //Mapping Table ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); ++ ++ //OFDM HW AntDiv Parameters ++ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold ++ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x10); //bias ++ ++ //CCK HW AntDiv Parameters ++ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M ++ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples ++ ++ ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //ANTSEL_CCK sent to the smart_antenna circuit ++ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable ++ ++ //BT Coexistence ++ ODM_SetBBReg(pDM_Odm, 0xCAC , BIT9, 1); //keep antsel_map when GNT_BT = 1 ++ ODM_SetBBReg(pDM_Odm, 0x804 , BIT4, 1); //Disable hw antsw & fast_train.antsw when GNT_BT=1 ++ ++ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns ++ ++ //response TX ant by RX ant ++ ODM_SetMACReg(pDM_Odm, 0x668 , BIT3, 1); ++ ++} ++ ++VOID ++odm_S0S1_SWAntDiv_Init_8821A( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A AntDiv_Init => AntDivType=[ S0S1_SW_AntDiv]\n")); ++ ++ //Output Pin Settings ++ ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); ++ ++ ODM_SetMACReg(pDM_Odm, 0x64 , BIT29, 1); //PAPE by WLAN control ++ ODM_SetMACReg(pDM_Odm, 0x64 , BIT28, 1); //LNAON by WLAN control ++ ++ ODM_SetBBReg(pDM_Odm, 0xCB0 , bMaskDWord, 0x77775745); ++ ODM_SetBBReg(pDM_Odm, 0xCB8 , BIT16, 0); ++ ++ ODM_SetMACReg(pDM_Odm, 0x4C , BIT23, 0); //select DPDT_P and DPDT_N as output pin ++ ODM_SetMACReg(pDM_Odm, 0x4C , BIT24, 1); //by WLAN control ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF, 8); // DPDT_P = ANTSEL[0] ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF0, 8); // DPDT_N = ANTSEL[0] ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT29, 0); //DPDT_P non-inverse ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT28, 1); //DPDT_N inverse ++ ++ //Mapping Table ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); ++ ++ //OFDM HW AntDiv Parameters ++ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold ++ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x10); //bias ++ ++ //CCK HW AntDiv Parameters ++ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M ++ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples ++ ++ ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //ANTSEL_CCK sent to the smart_antenna circuit ++ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable ++ ++ //BT Coexistence ++ ODM_SetBBReg(pDM_Odm, 0xCAC , BIT9, 1); //keep antsel_map when GNT_BT = 1 ++ ODM_SetBBReg(pDM_Odm, 0x804 , BIT4, 1); //Disable hw antsw & fast_train.antsw when GNT_BT=1 ++ ++ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns ++ ++ //response TX ant by RX ant ++ ODM_SetMACReg(pDM_Odm, 0x668 , BIT3, 1); ++ ++ ++ ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, 0); ++ ++ pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; ++ pDM_SWAT_Table->Double_chk_flag = 0; ++ pDM_SWAT_Table->CurAntenna = MAIN_ANT; ++ pDM_SWAT_Table->PreAntenna = MAIN_ANT; ++ pDM_SWAT_Table->SWAS_NoLink_State = 0; ++ ++} ++#endif //#if (RTL8821A_SUPPORT == 1) ++ ++#if (RTL8821C_SUPPORT == 1) ++VOID ++odm_TRX_HWAntDiv_Init_8821C( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821C AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (DPDT)] \n")); ++ //Output Pin Settings ++ ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); ++ ++ ODM_SetMACReg(pDM_Odm, 0x64 , BIT29, 1); //PAPE by WLAN control ++ ODM_SetMACReg(pDM_Odm, 0x64 , BIT28, 1); //LNAON by WLAN control ++ ++ ODM_SetBBReg(pDM_Odm, 0xCB0 , bMaskDWord, 0x77775745); ++ ODM_SetBBReg(pDM_Odm, 0xCB8 , BIT16, 0); ++ ++ ODM_SetMACReg(pDM_Odm, 0x4C , BIT23, 0); //select DPDT_P and DPDT_N as output pin ++ ODM_SetMACReg(pDM_Odm, 0x4C , BIT24, 1); //by WLAN control ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF, 8); // DPDT_P = ANTSEL[0] ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF0, 8); // DPDT_N = ANTSEL[0] ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT29, 0); //DPDT_P non-inverse ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT28, 1); //DPDT_N inverse ++ ++ //Mapping Table ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); ++ ++ //OFDM HW AntDiv Parameters ++ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold ++ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x10); //bias ++ ++ //CCK HW AntDiv Parameters ++ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M ++ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples ++ ++ ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //ANTSEL_CCK sent to the smart_antenna circuit ++ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable ++ ++ //BT Coexistence ++ ODM_SetBBReg(pDM_Odm, 0xCAC , BIT9, 1); //keep antsel_map when GNT_BT = 1 ++ ODM_SetBBReg(pDM_Odm, 0x804 , BIT4, 1); //Disable hw antsw & fast_train.antsw when GNT_BT=1 ++ ++ //Timming issue ++ ODM_SetBBReg(pDM_Odm, 0x818 , BIT23|BIT22|BIT21|BIT20, 8); /*keep antidx after tx for ACK ( unit x 3.2 mu sec)*/ ++ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns ++ ++ //response TX ant by RX ant ++ ODM_SetMACReg(pDM_Odm, 0x668 , BIT3, 1); ++ ++} ++#endif //#if (RTL8821C_SUPPORT == 1) ++ ++ ++#if (RTL8881A_SUPPORT == 1) ++VOID ++odm_TRX_HWAntDiv_Init_8881A( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8881A AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (SPDT)] \n")); ++ ++ //Output Pin Settings ++ // [SPDT related] ++ ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); ++ ODM_SetMACReg(pDM_Odm, 0x4C , BIT26, 0); ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT31, 0); //delay buffer ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT22, 0); ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT24, 1); ++ ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF00, 8); // DPDT_P = ANTSEL[0] ++ ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF0000, 8); // DPDT_N = ANTSEL[0] ++ ++ //Mapping Table ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); ++ ++ //OFDM HW AntDiv Parameters ++ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold ++ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x0); //bias ++ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns ++ ++ //CCK HW AntDiv Parameters ++ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M ++ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples ++ ++ //2 [--For HW Bug Setting] ++ ++ ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, 0); //TX Ant by Reg // A-cut bug ++} ++ ++#endif //#if (RTL8881A_SUPPORT == 1) ++ ++ ++#if (RTL8812A_SUPPORT == 1) ++VOID ++odm_TRX_HWAntDiv_Init_8812A( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8812A AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (SPDT)] \n")); ++ ++ //3 //3 --RFE pin setting--------- ++ //[BB] ++ ODM_SetBBReg(pDM_Odm, 0x900 , BIT10|BIT9|BIT8, 0x0); //disable SW switch ++ ODM_SetBBReg(pDM_Odm, 0x900 , BIT17|BIT16, 0x0); ++ ODM_SetBBReg(pDM_Odm, 0x974 , BIT7|BIT6, 0x3); // in/out ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT31, 0); //delay buffer ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT26, 0); ++ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT27, 1); ++ ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF000000, 8); // DPDT_P = ANTSEL[0] ++ ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF0000000, 8); // DPDT_N = ANTSEL[0] ++ //3 ------------------------- ++ ++ //Mapping Table ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); ++ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); ++ ++ //OFDM HW AntDiv Parameters ++ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold ++ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x0); //bias ++ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns ++ ++ //CCK HW AntDiv Parameters ++ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M ++ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples ++ ++ //2 [--For HW Bug Setting] ++ ++ ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, 0); //TX Ant by Reg // A-cut bug ++ ++} ++ ++#endif //#if (RTL8812A_SUPPORT == 1) ++ ++#if (RTL8188F_SUPPORT == 1) ++VOID ++odm_S0S1_SWAntDiv_Init_8188F( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188F AntDiv_Init => AntDivType=[ S0S1_SW_AntDiv]\n")); ++ ++ ++ /*GPIO Setting*/ ++ /*ODM_SetMACReg(pDM_Odm, 0x64 , BIT18, 0); */ ++ /*ODM_SetMACReg(pDM_Odm, 0x44 , BIT28|BIT27, 0);*/ ++ ODM_SetMACReg(pDM_Odm, 0x44 , BIT20|BIT19, 0x3); /*enable_output for P_GPIO[4:3]*/ ++ /*ODM_SetMACReg(pDM_Odm, 0x44 , BIT12|BIT11, 0);*/ /*output value*/ ++ /*ODM_SetMACReg(pDM_Odm, 0x40 , BIT1|BIT0, 0);*/ /*GPIO function*/ ++ ++ pDM_FatTable->bBecomeLinked = FALSE; ++ pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; ++ pDM_SWAT_Table->Double_chk_flag = 0; ++} ++ ++VOID ++phydm_update_rx_idle_antenna_8188F( ++ IN PVOID pDM_VOID, ++ IN u4Byte default_ant ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte codeword; ++ ++ if (default_ant == ANT1_2G) ++ codeword = 1; /*2'b01*/ ++ else ++ codeword = 2;/*2'b10*/ ++ ++ ODM_SetMACReg(pDM_Odm, 0x44 , (BIT12|BIT11), codeword); /*GPIO[4:3] output value*/ ++} ++ ++#endif ++ ++ ++ ++#ifdef ODM_EVM_ENHANCE_ANTDIV ++ ++VOID ++odm_EVM_FastAnt_Reset( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ pDM_FatTable->EVM_method_enable=0; ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); ++ pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; ++ pDM_Odm->antdiv_period=0; ++ ODM_SetMACReg(pDM_Odm, 0x608, BIT8, 0); ++} ++ ++ ++VOID ++odm_EVM_Enhance_AntDiv( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte Main_RSSI, Aux_RSSI ; ++ u4Byte Main_CRC_utility=0,Aux_CRC_utility=0,utility_ratio=1; ++ u4Byte Main_EVM, Aux_EVM,Diff_RSSI=0,diff_EVM=0; ++ u1Byte score_EVM=0,score_CRC=0; ++ u1Byte rssi_larger_ant = 0; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ u4Byte value32, i; ++ BOOLEAN Main_above1=FALSE,Aux_above1=FALSE; ++ BOOLEAN Force_antenna=FALSE; ++ PSTA_INFO_T pEntry; ++ pDM_FatTable->TargetAnt_enhance=0xFF; ++ ++ ++ if((pDM_Odm->SupportICType & ODM_EVM_ENHANCE_ANTDIV_SUPPORT_IC)) ++ { ++ if(pDM_Odm->bOneEntryOnly) ++ { ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[One Client only] \n")); ++ i = pDM_Odm->OneEntry_MACID; ++ ++ Main_RSSI = (pDM_FatTable->MainAnt_Cnt[i]!=0)?(pDM_FatTable->MainAnt_Sum[i]/pDM_FatTable->MainAnt_Cnt[i]):0; ++ Aux_RSSI = (pDM_FatTable->AuxAnt_Cnt[i]!=0)?(pDM_FatTable->AuxAnt_Sum[i]/pDM_FatTable->AuxAnt_Cnt[i]):0; ++ ++ if((Main_RSSI==0 && Aux_RSSI !=0 && Aux_RSSI>=FORCE_RSSI_DIFF) || (Main_RSSI!=0 && Aux_RSSI==0 && Main_RSSI>=FORCE_RSSI_DIFF)) ++ { ++ Diff_RSSI=FORCE_RSSI_DIFF; ++ } ++ else if(Main_RSSI!=0 && Aux_RSSI !=0) ++ { ++ Diff_RSSI = (Main_RSSI>=Aux_RSSI)?(Main_RSSI-Aux_RSSI):(Aux_RSSI-Main_RSSI); ++ } ++ ++ if (Main_RSSI >= Aux_RSSI) ++ rssi_larger_ant = MAIN_ANT; ++ else ++ rssi_larger_ant = AUX_ANT; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Main_Cnt = (( %d )) , Main_RSSI= (( %d ))\n", pDM_FatTable->MainAnt_Cnt[i], Main_RSSI)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Aux_Cnt = (( %d )) , Aux_RSSI = (( %d ))\n", pDM_FatTable->AuxAnt_Cnt[i], Aux_RSSI)); ++ ++ if( ((Main_RSSI>=Evm_RSSI_TH_High||Aux_RSSI>=Evm_RSSI_TH_High )|| (pDM_FatTable->EVM_method_enable==1) ) ++ //&& (Diff_RSSI <= FORCE_RSSI_DIFF + 1) ++ ) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[> TH_H || EVM_method_enable==1] && ")); ++ ++ if(((Main_RSSI>=Evm_RSSI_TH_Low)||(Aux_RSSI>=Evm_RSSI_TH_Low) )) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[> TH_L ] \n")); ++ ++ //2 [ Normal state Main] ++ if(pDM_FatTable->FAT_State == NORMAL_STATE_MIAN) ++ { ++ ++ pDM_FatTable->EVM_method_enable=1; ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ pDM_Odm->antdiv_period = pDM_Odm->evm_antdiv_period; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ start training: MIAN] \n")); ++ pDM_FatTable->MainAntEVM_Sum[i] = 0; ++ pDM_FatTable->AuxAntEVM_Sum[i] = 0; ++ pDM_FatTable->MainAntEVM_Cnt[i] = 0; ++ pDM_FatTable->AuxAntEVM_Cnt[i] = 0; ++ ++ pDM_FatTable->FAT_State = NORMAL_STATE_AUX; ++ ODM_SetMACReg(pDM_Odm, 0x608, BIT8, 1); //Accept CRC32 Error packets. ++ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); ++ ++ pDM_FatTable->CRC32_Ok_Cnt=0; ++ pDM_FatTable->CRC32_Fail_Cnt=0; ++ ODM_SetTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer, pDM_Odm->antdiv_intvl ); //m ++ } ++ //2 [ Normal state Aux ] ++ else if(pDM_FatTable->FAT_State == NORMAL_STATE_AUX) ++ { ++ pDM_FatTable->MainCRC32_Ok_Cnt=pDM_FatTable->CRC32_Ok_Cnt; ++ pDM_FatTable->MainCRC32_Fail_Cnt=pDM_FatTable->CRC32_Fail_Cnt; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ start training: AUX] \n")); ++ pDM_FatTable->FAT_State = TRAINING_STATE; ++ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); ++ ++ pDM_FatTable->CRC32_Ok_Cnt=0; ++ pDM_FatTable->CRC32_Fail_Cnt=0; ++ ODM_SetTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer, pDM_Odm->antdiv_intvl ); //ms ++ } ++ else if(pDM_FatTable->FAT_State == TRAINING_STATE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Training state ] \n")); ++ pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; ++ ++ //3 [CRC32 statistic] ++ pDM_FatTable->AuxCRC32_Ok_Cnt=pDM_FatTable->CRC32_Ok_Cnt; ++ pDM_FatTable->AuxCRC32_Fail_Cnt=pDM_FatTable->CRC32_Fail_Cnt; ++ ++ if ((pDM_FatTable->MainCRC32_Ok_Cnt > ((pDM_FatTable->AuxCRC32_Ok_Cnt)<<1)) || ((Diff_RSSI >= 20) && (rssi_larger_ant == MAIN_ANT))) { ++ pDM_FatTable->TargetAnt_CRC32=MAIN_ANT; ++ Force_antenna=TRUE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CRC32 Force Main\n")); ++ } else if ((pDM_FatTable->AuxCRC32_Ok_Cnt > ((pDM_FatTable->MainCRC32_Ok_Cnt)<<1)) || ((Diff_RSSI >= 20) && (rssi_larger_ant == AUX_ANT))) { ++ pDM_FatTable->TargetAnt_CRC32=AUX_ANT; ++ Force_antenna=TRUE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CRC32 Force Aux\n")); ++ } ++ else ++ { ++ if(pDM_FatTable->MainCRC32_Fail_Cnt<=5) ++ pDM_FatTable->MainCRC32_Fail_Cnt=5; ++ ++ if(pDM_FatTable->AuxCRC32_Fail_Cnt<=5) ++ pDM_FatTable->AuxCRC32_Fail_Cnt=5; ++ ++ if(pDM_FatTable->MainCRC32_Ok_Cnt >pDM_FatTable->MainCRC32_Fail_Cnt ) ++ Main_above1=TRUE; ++ ++ if(pDM_FatTable->AuxCRC32_Ok_Cnt >pDM_FatTable->AuxCRC32_Fail_Cnt ) ++ Aux_above1=TRUE; ++ ++ if(Main_above1==TRUE && Aux_above1==FALSE) ++ { ++ Force_antenna=TRUE; ++ pDM_FatTable->TargetAnt_CRC32=MAIN_ANT; ++ } ++ else if(Main_above1==FALSE && Aux_above1==TRUE) ++ { ++ Force_antenna=TRUE; ++ pDM_FatTable->TargetAnt_CRC32=AUX_ANT; ++ } ++ else if(Main_above1==TRUE && Aux_above1==TRUE) ++ { ++ Main_CRC_utility=((pDM_FatTable->MainCRC32_Ok_Cnt)<<7)/pDM_FatTable->MainCRC32_Fail_Cnt; ++ Aux_CRC_utility=((pDM_FatTable->AuxCRC32_Ok_Cnt)<<7)/pDM_FatTable->AuxCRC32_Fail_Cnt; ++ pDM_FatTable->TargetAnt_CRC32 = (Main_CRC_utility==Aux_CRC_utility)?(pDM_FatTable->pre_TargetAnt_enhance):((Main_CRC_utility>=Aux_CRC_utility)?MAIN_ANT:AUX_ANT); ++ ++ if(Main_CRC_utility!=0 && Aux_CRC_utility!=0) ++ { ++ if(Main_CRC_utility>=Aux_CRC_utility) ++ utility_ratio=(Main_CRC_utility<<1)/Aux_CRC_utility; ++ else ++ utility_ratio=(Aux_CRC_utility<<1)/Main_CRC_utility; ++ } ++ } ++ else if(Main_above1==FALSE && Aux_above1==FALSE) ++ { ++ if(pDM_FatTable->MainCRC32_Ok_Cnt==0) ++ pDM_FatTable->MainCRC32_Ok_Cnt=1; ++ if(pDM_FatTable->AuxCRC32_Ok_Cnt==0) ++ pDM_FatTable->AuxCRC32_Ok_Cnt=1; ++ ++ Main_CRC_utility=((pDM_FatTable->MainCRC32_Fail_Cnt)<<7)/pDM_FatTable->MainCRC32_Ok_Cnt; ++ Aux_CRC_utility=((pDM_FatTable->AuxCRC32_Fail_Cnt)<<7)/pDM_FatTable->AuxCRC32_Ok_Cnt; ++ pDM_FatTable->TargetAnt_CRC32 = (Main_CRC_utility==Aux_CRC_utility)?(pDM_FatTable->pre_TargetAnt_enhance):((Main_CRC_utility<=Aux_CRC_utility)?MAIN_ANT:AUX_ANT); ++ ++ if(Main_CRC_utility!=0 && Aux_CRC_utility!=0) ++ { ++ if(Main_CRC_utility>=Aux_CRC_utility) ++ utility_ratio=(Main_CRC_utility<<1)/(Aux_CRC_utility); ++ else ++ utility_ratio=(Aux_CRC_utility<<1)/(Main_CRC_utility); ++ } ++ } ++ } ++ ODM_SetMACReg(pDM_Odm, 0x608, BIT8, 0);//NOT Accept CRC32 Error packets. ++ ++ //3 [EVM statistic] ++ Main_EVM = (pDM_FatTable->MainAntEVM_Cnt[i]!=0)?(pDM_FatTable->MainAntEVM_Sum[i]/pDM_FatTable->MainAntEVM_Cnt[i]):0; ++ Aux_EVM = (pDM_FatTable->AuxAntEVM_Cnt[i]!=0)?(pDM_FatTable->AuxAntEVM_Sum[i]/pDM_FatTable->AuxAntEVM_Cnt[i]):0; ++ pDM_FatTable->TargetAnt_EVM = (Main_EVM==Aux_EVM)?(pDM_FatTable->pre_TargetAnt_enhance):((Main_EVM>=Aux_EVM)?MAIN_ANT:AUX_ANT); ++ ++ if((Main_EVM==0 || Aux_EVM==0)) ++ diff_EVM=0; ++ else if(Main_EVM>=Aux_EVM) ++ diff_EVM=Main_EVM-Aux_EVM; ++ else ++ diff_EVM=Aux_EVM-Main_EVM; ++ ++ //2 [ Decision state ] ++ if (pDM_FatTable->TargetAnt_EVM == pDM_FatTable->TargetAnt_CRC32) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 1, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); ++ ++ if ((utility_ratio < 2 && Force_antenna == FALSE) && diff_EVM <= 30) ++ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->pre_TargetAnt_enhance; ++ else ++ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_EVM; ++ } else if ((diff_EVM <= 50 && (utility_ratio > 4 && Force_antenna == FALSE)) || (Force_antenna == TRUE)) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 2, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); ++ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_CRC32; ++ } else if (diff_EVM >= 100) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 3, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); ++ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_EVM; ++ } else if (utility_ratio >= 6 && Force_antenna == FALSE) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 4, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); ++ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_CRC32; ++ } else { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 5, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); ++ ++ if (Force_antenna == TRUE) ++ score_CRC = 3; ++ else if (utility_ratio >= 3) /*>0.5*/ ++ score_CRC = 2; ++ else if (utility_ratio >= 2) /*>1*/ ++ score_CRC = 1; ++ else ++ score_CRC = 0; ++ ++ if (diff_EVM >= 100) ++ score_EVM = 2; ++ else if (diff_EVM >= 50) ++ score_EVM = 1; ++ else ++ score_EVM = 0; ++ ++ if (score_CRC > score_EVM) ++ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_CRC32; ++ else if (score_CRC < score_EVM) ++ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_EVM; ++ else ++ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->pre_TargetAnt_enhance; ++ } ++ pDM_FatTable->pre_TargetAnt_enhance=pDM_FatTable->TargetAnt_enhance; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MainEVM_Cnt = (( %d )) , Main_EVM= (( %d )) \n",i, pDM_FatTable->MainAntEVM_Cnt[i], Main_EVM)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : AuxEVM_Cnt = (( %d )) , Aux_EVM = (( %d )) \n" ,i, pDM_FatTable->AuxAntEVM_Cnt[i] , Aux_EVM)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** TargetAnt_EVM = (( %s ))\n", ( pDM_FatTable->TargetAnt_EVM ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("M_CRC_Ok = (( %d )) , M_CRC_Fail = (( %d )), Main_CRC_utility = (( %d )) \n" , pDM_FatTable->MainCRC32_Ok_Cnt, pDM_FatTable->MainCRC32_Fail_Cnt,Main_CRC_utility)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("A_CRC_Ok = (( %d )) , A_CRC_Fail = (( %d )), Aux_CRC_utility = (( %d )) \n" , pDM_FatTable->AuxCRC32_Ok_Cnt, pDM_FatTable->AuxCRC32_Fail_Cnt,Aux_CRC_utility)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** TargetAnt_CRC32 = (( %s ))\n", ( pDM_FatTable->TargetAnt_CRC32 ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("****** TargetAnt_enhance = (( %s ))******\n", ( pDM_FatTable->TargetAnt_enhance ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ ++ ++ } ++ } ++ else // RSSI< = Evm_RSSI_TH_Low ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ TH_L ] \n")); ++ odm_EVM_FastAnt_Reset(pDM_Odm); ++ } ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[escape from> TH_H || EVM_method_enable==1] \n")); ++ odm_EVM_FastAnt_Reset(pDM_Odm); ++ } ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[multi-Client] \n")); ++ odm_EVM_FastAnt_Reset(pDM_Odm); ++ } ++ } ++} ++ ++VOID ++odm_EVM_FastAntTrainingCallback( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_EVM_FastAntTrainingCallback****** \n")); ++ odm_HW_AntDiv(pDM_Odm); ++} ++#endif ++ ++VOID ++odm_HW_AntDiv( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte i,MinMaxRSSI=0xFF, AntDivMaxRSSI=0, MaxRSSI=0, LocalMaxRSSI; ++ u4Byte Main_RSSI, Aux_RSSI, mian_cnt, aux_cnt; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ u1Byte RxIdleAnt = pDM_FatTable->RxIdleAnt, TargetAnt = 7; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ PSTA_INFO_T pEntry; ++ ++ #if (BEAMFORMING_SUPPORT == 1) ++ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; ++ u4Byte TH1=500000; ++ u4Byte TH2=10000000; ++ u4Byte MA_rx_Temp, degrade_TP_temp, improve_TP_temp; ++ u1Byte Monitor_RSSI_threshold=30; ++ ++ pDM_BdcTable->BF_pass=TRUE; ++ pDM_BdcTable->DIV_pass=TRUE; ++ pDM_BdcTable->bAll_DivSta_Idle=TRUE; ++ pDM_BdcTable->bAll_BFSta_Idle=TRUE; ++ pDM_BdcTable->num_BfTar=0 ; ++ pDM_BdcTable->num_DivTar=0; ++ pDM_BdcTable->num_Client=0; ++ #endif ++ #endif ++ ++ if(!pDM_Odm->bLinked) //bLinked==False ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); ++ ++ if(pDM_FatTable->bBecomeLinked == TRUE) ++ { ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); ++ pDM_Odm->antdiv_period=0; ++ ++ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; ++ } ++ return; ++ } ++ else ++ { ++ if(pDM_FatTable->bBecomeLinked ==FALSE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); ++ /*odm_Tx_By_TxDesc_or_Reg(pDM_Odm , TX_BY_DESC);*/ ++ ++ //if(pDM_Odm->SupportICType == ODM_RTL8821 ) ++ //ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //CCK AntDiv function disable ++ ++ //#if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ //else if(pDM_Odm->SupportICType == ODM_RTL8881A) ++ // ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //CCK AntDiv function disable ++ //#endif ++ ++ //else if(pDM_Odm->SupportICType == ODM_RTL8723B ||pDM_Odm->SupportICType == ODM_RTL8812) ++ //ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function disable ++ ++ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; ++ ++ if(pDM_Odm->SupportICType==ODM_RTL8723B && pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) ++ { ++ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF0, 8); // DPDT_P = ANTSEL[0] // for 8723B AntDiv function patch. BB Dino 130412 ++ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF, 8); // DPDT_N = ANTSEL[0] ++ } ++ ++ //2 BDC Init ++ #if (BEAMFORMING_SUPPORT == 1) ++ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ odm_BDC_Init(pDM_Odm); ++ #endif ++ #endif ++ ++ #ifdef ODM_EVM_ENHANCE_ANTDIV ++ odm_EVM_FastAnt_Reset(pDM_Odm); ++ #endif ++ } ++ } ++ ++ if (*(pDM_FatTable->pForceTxAntByDesc) == FALSE) { ++ if (pDM_Odm->bOneEntryOnly == TRUE) ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); ++ else ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); ++ } ++ ++ #ifdef ODM_EVM_ENHANCE_ANTDIV ++ if(pDM_Odm->antdiv_evm_en==1) ++ { ++ odm_EVM_Enhance_AntDiv(pDM_Odm); ++ if(pDM_FatTable->FAT_State !=NORMAL_STATE_MIAN) ++ return; ++ } ++ else ++ { ++ odm_EVM_FastAnt_Reset(pDM_Odm); ++ } ++ #endif ++ ++ //2 BDC Mode Arbitration ++ #if (BEAMFORMING_SUPPORT == 1) ++ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ if(pDM_Odm->antdiv_evm_en == 0 ||pDM_FatTable->EVM_method_enable==0) ++ { ++ odm_BF_AntDiv_ModeArbitration(pDM_Odm); ++ } ++ #endif ++ #endif ++ ++ for (i=0; ipODM_StaInfo[i]; ++ if(IS_STA_VALID(pEntry)) ++ { ++ //2 Caculate RSSI per Antenna ++ if ((pDM_FatTable->MainAnt_Cnt[i] != 0) || (pDM_FatTable->AuxAnt_Cnt[i] != 0)) { ++ mian_cnt = pDM_FatTable->MainAnt_Cnt[i]; ++ aux_cnt = pDM_FatTable->AuxAnt_Cnt[i]; ++ Main_RSSI = (mian_cnt != 0) ? (pDM_FatTable->MainAnt_Sum[i] / mian_cnt) : 0; ++ Aux_RSSI = (aux_cnt != 0) ? (pDM_FatTable->AuxAnt_Sum[i] / aux_cnt) : 0; ++ TargetAnt = (mian_cnt == aux_cnt) ? pDM_FatTable->RxIdleAnt : ((mian_cnt >= aux_cnt) ? MAIN_ANT : AUX_ANT); /*Use counter number for OFDM*/ ++ ++ } else { /*CCK only case*/ ++ mian_cnt = pDM_FatTable->MainAnt_Cnt_cck[i]; ++ aux_cnt = pDM_FatTable->AuxAnt_Cnt_cck[i]; ++ Main_RSSI = (mian_cnt != 0) ? (pDM_FatTable->MainAnt_Sum_cck[i] / mian_cnt) : 0; ++ Aux_RSSI = (aux_cnt != 0) ? (pDM_FatTable->AuxAnt_Sum_cck[i] / aux_cnt) : 0; ++ TargetAnt = (Main_RSSI == Aux_RSSI) ? pDM_FatTable->RxIdleAnt : ((Main_RSSI >= Aux_RSSI) ? MAIN_ANT : AUX_ANT); /*Use RSSI for CCK only case*/ ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : Main_Cnt = (( %d )) , CCK_Main_Cnt = (( %d )) , Main_RSSI= (( %d )) \n",i, pDM_FatTable->MainAnt_Cnt[i], pDM_FatTable->MainAnt_Cnt_cck[i], Main_RSSI)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : Aux_Cnt = (( %d )) , CCK_Aux_Cnt = (( %d )) , Aux_RSSI = (( %d )) \n" ,i, pDM_FatTable->AuxAnt_Cnt[i] ,pDM_FatTable->AuxAnt_Cnt_cck[i], Aux_RSSI)); ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** MAC ID:[ %d ] , TargetAnt = (( %s )) \n", i ,( TargetAnt ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ ++ LocalMaxRSSI = (Main_RSSI>Aux_RSSI)?Main_RSSI:Aux_RSSI; ++ //2 Select MaxRSSI for DIG ++ if((LocalMaxRSSI > AntDivMaxRSSI) && (LocalMaxRSSI < 40)) ++ AntDivMaxRSSI = LocalMaxRSSI; ++ if(LocalMaxRSSI > MaxRSSI) ++ MaxRSSI = LocalMaxRSSI; ++ ++ //2 Select RX Idle Antenna ++ if ( (LocalMaxRSSI != 0) && (LocalMaxRSSI < MinMaxRSSI) ) ++ { ++ RxIdleAnt = TargetAnt; ++ MinMaxRSSI = LocalMaxRSSI; ++ } ++ ++ #ifdef ODM_EVM_ENHANCE_ANTDIV ++ if(pDM_Odm->antdiv_evm_en==1) ++ { ++ if(pDM_FatTable->TargetAnt_enhance!=0xFF) ++ { ++ TargetAnt=pDM_FatTable->TargetAnt_enhance; ++ RxIdleAnt = pDM_FatTable->TargetAnt_enhance; ++ } ++ } ++ #endif ++ ++ //2 Select TX Antenna ++ if(pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) ++ { ++ #if (BEAMFORMING_SUPPORT == 1) ++ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ if(pDM_BdcTable->w_BFee_Client[i]==0) ++ #endif ++ #endif ++ { ++ odm_UpdateTxAnt(pDM_Odm, TargetAnt, i); ++ } ++ } ++ ++ //------------------------------------------------------------ ++ ++ #if (BEAMFORMING_SUPPORT == 1) ++ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++ pDM_BdcTable->num_Client++; ++ ++ if(pDM_BdcTable->BDC_Mode==BDC_MODE_2 ||pDM_BdcTable->BDC_Mode==BDC_MODE_3) ++ { ++ //2 Byte Counter ++ ++ MA_rx_Temp= (pEntry->rx_byte_cnt_LowMAW)<<3 ; // RX TP ( bit /sec) ++ ++ if(pDM_BdcTable->BDC_state==BDC_BFer_TRAIN_STATE) ++ { ++ pDM_BdcTable->MA_rx_TP_DIV[i]= MA_rx_Temp ; ++ } ++ else ++ { ++ pDM_BdcTable->MA_rx_TP[i] =MA_rx_Temp ; ++ } ++ ++ if( (MA_rx_Temp < TH2) && (MA_rx_Temp > TH1) && (LocalMaxRSSI<=Monitor_RSSI_threshold)) ++ { ++ if(pDM_BdcTable->w_BFer_Client[i]==1) // Bfer_Target ++ { ++ pDM_BdcTable->num_BfTar++; ++ ++ if(pDM_BdcTable->BDC_state==BDC_DECISION_STATE && pDM_BdcTable->BDC_Try_flag==0) ++ { ++ improve_TP_temp = (pDM_BdcTable->MA_rx_TP_DIV[i] * 9)>>3 ; //* 1.125 ++ pDM_BdcTable->BF_pass = (pDM_BdcTable->MA_rx_TP[i] > improve_TP_temp)?TRUE:FALSE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : { MA_rx_TP,improve_TP_temp , MA_rx_TP_DIV, BF_pass}={ %d, %d, %d , %d } \n" ,i,pDM_BdcTable->MA_rx_TP[i],improve_TP_temp,pDM_BdcTable->MA_rx_TP_DIV[i], pDM_BdcTable->BF_pass )); ++ } ++ } ++ else// DIV_Target ++ { ++ pDM_BdcTable->num_DivTar++; ++ ++ if(pDM_BdcTable->BDC_state==BDC_DECISION_STATE && pDM_BdcTable->BDC_Try_flag==0) ++ { ++ degrade_TP_temp=(pDM_BdcTable->MA_rx_TP_DIV[i]*5)>>3;//* 0.625 ++ pDM_BdcTable->DIV_pass = (pDM_BdcTable->MA_rx_TP[i] >degrade_TP_temp)?TRUE:FALSE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : { MA_rx_TP, degrade_TP_temp , MA_rx_TP_DIV, DIV_pass}=\n{ %d, %d, %d , %d } \n" ,i,pDM_BdcTable->MA_rx_TP[i],degrade_TP_temp,pDM_BdcTable->MA_rx_TP_DIV[i], pDM_BdcTable->DIV_pass )); ++ } ++ } ++ } ++ ++ if(MA_rx_Temp > TH1) ++ { ++ if(pDM_BdcTable->w_BFer_Client[i]==1) // Bfer_Target ++ { ++ pDM_BdcTable->bAll_BFSta_Idle=FALSE; ++ } ++ else// DIV_Target ++ { ++ pDM_BdcTable->bAll_DivSta_Idle=FALSE; ++ } ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : { BFmeeCap , BFmerCap} = { %d , %d } \n" ,i, pDM_BdcTable->w_BFee_Client[i] , pDM_BdcTable->w_BFer_Client[i])); ++ ++ if(pDM_BdcTable->BDC_state==BDC_BFer_TRAIN_STATE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MA_rx_TP_DIV = (( %d )) \n",i,pDM_BdcTable->MA_rx_TP_DIV[i] )); ++ ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MA_rx_TP = (( %d )) \n",i,pDM_BdcTable->MA_rx_TP[i] )); ++ } ++ ++ } ++ #endif ++ #endif ++ ++ } ++ ++ #if (BEAMFORMING_SUPPORT == 1) ++ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ if(pDM_BdcTable->BDC_Try_flag==0) ++ #endif ++ #endif ++ { ++ pDM_FatTable->MainAnt_Sum[i] = 0; ++ pDM_FatTable->AuxAnt_Sum[i] = 0; ++ pDM_FatTable->MainAnt_Cnt[i] = 0; ++ pDM_FatTable->AuxAnt_Cnt[i] = 0; ++ pDM_FatTable->MainAnt_Cnt_cck[i]= 0; ++ pDM_FatTable->AuxAnt_Cnt_cck[i]= 0; ++ } ++ } ++ ++ ++ ++ //2 Set RX Idle Antenna & TX Antenna(Because of HW Bug ) ++ #if(DM_ODM_SUPPORT_TYPE == ODM_AP ) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** RxIdleAnt = (( %s ))\n\n", ( RxIdleAnt ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ ++ #if (BEAMFORMING_SUPPORT == 1) ++ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ if(pDM_BdcTable->BDC_Mode==BDC_MODE_1 ||pDM_BdcTable->BDC_Mode==BDC_MODE_3) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** BDC_RxIdleUpdate_counter = (( %d ))\n", pDM_BdcTable->BDC_RxIdleUpdate_counter)); ++ ++ if(pDM_BdcTable->BDC_RxIdleUpdate_counter==1) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***Update RxIdle Antenna!!! \n")); ++ pDM_BdcTable->BDC_RxIdleUpdate_counter=30; ++ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); ++ } ++ else ++ { ++ pDM_BdcTable->BDC_RxIdleUpdate_counter--; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***NOT update RxIdle Antenna because of BF ( need to fix TX-ant)\n")); ++ } ++ } ++ else ++ #endif ++ #endif ++ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); ++ #else ++ ++ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); ++ ++ #endif//#if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++ ++ ++ //2 BDC Main Algorithm ++ #if (BEAMFORMING_SUPPORT == 1) ++ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ if(pDM_Odm->antdiv_evm_en ==0 ||pDM_FatTable->EVM_method_enable==0) ++ { ++ odm_BDCcoex_BFeeRxDiv_Arbitration(pDM_Odm); ++ } ++ #endif ++ #endif ++ ++ if(AntDivMaxRSSI == 0) ++ pDM_DigTable->AntDiv_RSSI_max = pDM_Odm->RSSI_Min; ++ else ++ pDM_DigTable->AntDiv_RSSI_max = AntDivMaxRSSI; ++ ++ pDM_DigTable->RSSI_max = MaxRSSI; ++} ++ ++ ++ ++#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ ++VOID ++odm_S0S1_SWAntDiv_Reset( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ pDM_FatTable->bBecomeLinked = FALSE; ++ pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; ++ pDM_SWAT_Table->Double_chk_flag = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_S0S1_SWAntDiv_Reset(): pDM_FatTable->bBecomeLinked = %d\n", pDM_FatTable->bBecomeLinked)); ++} ++ ++VOID ++odm_S0S1_SwAntDiv( ++ IN PVOID pDM_VOID, ++ IN u1Byte Step ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ u4Byte i, MinMaxRSSI = 0xFF, LocalMaxRSSI, LocalMinRSSI; ++ u4Byte Main_RSSI, Aux_RSSI; ++ u1Byte HighTraffic_TrainTime_U = 0x32, HighTraffic_TrainTime_L = 0, Train_time_temp; ++ u1Byte LowTraffic_TrainTime_U = 200, LowTraffic_TrainTime_L = 0; ++ u1Byte RxIdleAnt = pDM_SWAT_Table->PreAntenna, TargetAnt, nextAnt = 0; ++ PSTA_INFO_T pEntry = NULL; ++ u4Byte value32; ++ ++ ++ if(!pDM_Odm->bLinked) //bLinked==False ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); ++ if(pDM_FatTable->bBecomeLinked == TRUE) ++ { ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); ++ if (pDM_Odm->SupportICType == ODM_RTL8723B) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set REG 948[9:6]=0x0\n")); ++ ODM_SetBBReg(pDM_Odm, 0x948 , (BIT9|BIT8|BIT7|BIT6), 0x0); ++ } ++ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; ++ } ++ return; ++ } ++ else ++ { ++ if(pDM_FatTable->bBecomeLinked ==FALSE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8723B) ++ { ++ value32 = ODM_GetBBReg(pDM_Odm, 0x864, BIT5|BIT4|BIT3); ++ ++ #if (RTL8723B_SUPPORT == 1) ++ if (value32 == 0x0) ++ ODM_UpdateRxIdleAnt_8723B(pDM_Odm, MAIN_ANT, ANT1_2G, ANT2_2G); ++ else if (value32 == 0x1) ++ ODM_UpdateRxIdleAnt_8723B(pDM_Odm, AUX_ANT, ANT2_2G, ANT1_2G); ++ #endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("8723B: First link! Force antenna to %s\n",(value32 == 0x0?"MAIN":"AUX") )); ++ } ++ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; ++ } ++ } ++ ++ if (*(pDM_FatTable->pForceTxAntByDesc) == FALSE) { ++ if (pDM_Odm->bOneEntryOnly == TRUE) ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); ++ else ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[%d] { try_flag=(( %d )), Step=(( %d )), Double_chk_flag = (( %d )) }\n", ++ __LINE__,pDM_SWAT_Table->try_flag,Step,pDM_SWAT_Table->Double_chk_flag)); ++ ++ // Handling step mismatch condition. ++ // Peak step is not finished at last time. Recover the variable and check again. ++ if( Step != pDM_SWAT_Table->try_flag ) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Step != try_flag] Need to Reset After Link\n")); ++ ODM_SwAntDivRestAfterLink(pDM_Odm); ++ } ++ ++ if (pDM_SWAT_Table->try_flag == SWAW_STEP_INIT) { ++ ++ pDM_SWAT_Table->try_flag = SWAW_STEP_PEEK; ++ pDM_SWAT_Table->Train_time_flag=0; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[set try_flag = 0] Prepare for peek!\n\n")); ++ return; ++ ++ } else { ++ ++ //1 Normal State (Begin Trying) ++ if (pDM_SWAT_Table->try_flag == SWAW_STEP_PEEK) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("TxOkCnt=(( %llu )), RxOkCnt=(( %llu )), TrafficLoad = (%d))\n", pDM_Odm->curTxOkCnt, pDM_Odm->curRxOkCnt, pDM_Odm->TrafficLoad)); ++ ++ if (pDM_Odm->TrafficLoad == TRAFFIC_HIGH) ++ { ++ Train_time_temp = pDM_SWAT_Table->Train_time ; ++ ++ if(pDM_SWAT_Table->Train_time_flag==3) ++ { ++ HighTraffic_TrainTime_L=0xa; ++ ++ if(Train_time_temp<=16) ++ Train_time_temp=HighTraffic_TrainTime_L; ++ else ++ Train_time_temp-=16; ++ ++ } ++ else if(pDM_SWAT_Table->Train_time_flag==2) ++ { ++ Train_time_temp-=8; ++ HighTraffic_TrainTime_L=0xf; ++ } ++ else if(pDM_SWAT_Table->Train_time_flag==1) ++ { ++ Train_time_temp-=4; ++ HighTraffic_TrainTime_L=0x1e; ++ } ++ else if(pDM_SWAT_Table->Train_time_flag==0) ++ { ++ Train_time_temp+=8; ++ HighTraffic_TrainTime_L=0x28; ++ } ++ ++ ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Train_time_temp = ((%d))\n",Train_time_temp)); ++ ++ //-- ++ if(Train_time_temp > HighTraffic_TrainTime_U) ++ Train_time_temp=HighTraffic_TrainTime_U; ++ ++ else if(Train_time_temp < HighTraffic_TrainTime_L) ++ Train_time_temp=HighTraffic_TrainTime_L; ++ ++ pDM_SWAT_Table->Train_time = Train_time_temp; /*10ms~200ms*/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Train_time_flag=((%d)), Train_time=((%d))\n", pDM_SWAT_Table->Train_time_flag, pDM_SWAT_Table->Train_time)); ++ ++ } else if ((pDM_Odm->TrafficLoad == TRAFFIC_MID) || (pDM_Odm->TrafficLoad == TRAFFIC_LOW)) { ++ ++ Train_time_temp=pDM_SWAT_Table->Train_time ; ++ ++ if(pDM_SWAT_Table->Train_time_flag==3) ++ { ++ LowTraffic_TrainTime_L=10; ++ if(Train_time_temp<50) ++ Train_time_temp=LowTraffic_TrainTime_L; ++ else ++ Train_time_temp-=50; ++ } ++ else if(pDM_SWAT_Table->Train_time_flag==2) ++ { ++ Train_time_temp-=30; ++ LowTraffic_TrainTime_L=36; ++ } ++ else if(pDM_SWAT_Table->Train_time_flag==1) ++ { ++ Train_time_temp-=10; ++ LowTraffic_TrainTime_L=40; ++ } else { ++ ++ Train_time_temp += 10; ++ LowTraffic_TrainTime_L = 50; ++ } ++ ++ //-- ++ if(Train_time_temp >= LowTraffic_TrainTime_U) ++ Train_time_temp=LowTraffic_TrainTime_U; ++ ++ else if(Train_time_temp <= LowTraffic_TrainTime_L) ++ Train_time_temp=LowTraffic_TrainTime_L; ++ ++ pDM_SWAT_Table->Train_time = Train_time_temp; /*10ms~200ms*/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Train_time_flag=((%d)) , Train_time=((%d))\n", pDM_SWAT_Table->Train_time_flag, pDM_SWAT_Table->Train_time)); ++ ++ } else { ++ pDM_SWAT_Table->Train_time = 0xc8; /*200ms*/ ++ ++ } ++ ++ //----------------- ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Current MinMaxRSSI is ((%d))\n", pDM_FatTable->MinMaxRSSI)); ++ ++ //---reset index--- ++ if (pDM_SWAT_Table->reset_idx >= RSSI_CHECK_RESET_PERIOD) { ++ ++ pDM_FatTable->MinMaxRSSI = 0; ++ pDM_SWAT_Table->reset_idx = 0; ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("reset_idx = (( %d ))\n", pDM_SWAT_Table->reset_idx)); ++ ++ pDM_SWAT_Table->reset_idx++; ++ ++ //---double check flag--- ++ if ((pDM_FatTable->MinMaxRSSI > RSSI_CHECK_THRESHOLD) && (pDM_SWAT_Table->Double_chk_flag == 0)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" MinMaxRSSI is ((%d)), and > %d\n", ++ pDM_FatTable->MinMaxRSSI, RSSI_CHECK_THRESHOLD)); ++ ++ pDM_SWAT_Table->Double_chk_flag =1; ++ pDM_SWAT_Table->try_flag = SWAW_STEP_DETERMINE; ++ pDM_SWAT_Table->RSSI_Trying = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Test the current Ant for (( %d )) ms again\n", pDM_SWAT_Table->Train_time)); ++ ODM_UpdateRxIdleAnt(pDM_Odm, pDM_FatTable->RxIdleAnt); ++ ODM_SetTimer(pDM_Odm, &(pDM_SWAT_Table->phydm_SwAntennaSwitchTimer), pDM_SWAT_Table->Train_time); /*ms*/ ++ return; ++ } ++ ++ nextAnt = (pDM_FatTable->RxIdleAnt == MAIN_ANT)? AUX_ANT : MAIN_ANT; ++ ++ pDM_SWAT_Table->try_flag = SWAW_STEP_DETERMINE; ++ ++ if(pDM_SWAT_Table->reset_idx<=1) ++ pDM_SWAT_Table->RSSI_Trying = 2; ++ else ++ pDM_SWAT_Table->RSSI_Trying = 1; ++ ++ odm_S0S1_SwAntDivByCtrlFrame(pDM_Odm, SWAW_STEP_PEEK); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[set try_flag=1] Normal State: Begin Trying!!\n")); ++ ++ } else if ((pDM_SWAT_Table->try_flag == SWAW_STEP_DETERMINE) && (pDM_SWAT_Table->Double_chk_flag == 0)) { ++ ++ nextAnt = (pDM_FatTable->RxIdleAnt == MAIN_ANT)? AUX_ANT : MAIN_ANT; ++ pDM_SWAT_Table->RSSI_Trying--; ++ } ++ ++ //1 Decision State ++ if ((pDM_SWAT_Table->try_flag == SWAW_STEP_DETERMINE) && (pDM_SWAT_Table->RSSI_Trying == 0)) { ++ ++ BOOLEAN bByCtrlFrame = FALSE; ++ u8Byte pkt_cnt_total = 0; ++ ++ for (i=0; ipODM_StaInfo[i]; ++ if(IS_STA_VALID(pEntry)) ++ { ++ //2 Caculate RSSI per Antenna ++ Main_RSSI = (pDM_FatTable->MainAnt_Cnt[i]!=0)?(pDM_FatTable->MainAnt_Sum[i]/pDM_FatTable->MainAnt_Cnt[i]):0; ++ Aux_RSSI = (pDM_FatTable->AuxAnt_Cnt[i]!=0)?(pDM_FatTable->AuxAnt_Sum[i]/pDM_FatTable->AuxAnt_Cnt[i]):0; ++ ++ if(pDM_FatTable->MainAnt_Cnt[i]<=1 && pDM_FatTable->CCK_counter_main>=1) ++ Main_RSSI=0; ++ ++ if(pDM_FatTable->AuxAnt_Cnt[i]<=1 && pDM_FatTable->CCK_counter_aux>=1) ++ Aux_RSSI=0; ++ ++ TargetAnt = (Main_RSSI==Aux_RSSI)?pDM_SWAT_Table->PreAntenna:((Main_RSSI>=Aux_RSSI)?MAIN_ANT:AUX_ANT); ++ LocalMaxRSSI = (Main_RSSI>=Aux_RSSI) ? Main_RSSI : Aux_RSSI; ++ LocalMinRSSI = (Main_RSSI>=Aux_RSSI) ? Aux_RSSI : Main_RSSI; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** CCK_counter_main = (( %d )) , CCK_counter_aux= (( %d )) \n", pDM_FatTable->CCK_counter_main, pDM_FatTable->CCK_counter_aux)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** OFDM_counter_main = (( %d )) , OFDM_counter_aux= (( %d )) \n", pDM_FatTable->OFDM_counter_main, pDM_FatTable->OFDM_counter_aux)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Main_Cnt = (( %d )) , Main_RSSI= (( %d )) \n", pDM_FatTable->MainAnt_Cnt[i], Main_RSSI)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Aux_Cnt = (( %d )) , Aux_RSSI = (( %d )) \n", pDM_FatTable->AuxAnt_Cnt[i] , Aux_RSSI )); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** MAC ID:[ %d ] , TargetAnt = (( %s )) \n", i ,( TargetAnt ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); ++ ++ //2 Select RX Idle Antenna ++ ++ if (LocalMaxRSSI != 0 && LocalMaxRSSI < MinMaxRSSI) ++ { ++ RxIdleAnt = TargetAnt; ++ MinMaxRSSI = LocalMaxRSSI; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** LocalMaxRSSI-LocalMinRSSI = ((%d))\n",(LocalMaxRSSI-LocalMinRSSI))); ++ ++ if((LocalMaxRSSI-LocalMinRSSI)>8) ++ { ++ if(LocalMinRSSI != 0) ++ pDM_SWAT_Table->Train_time_flag=3; ++ else ++ { ++ if (MinMaxRSSI > RSSI_CHECK_THRESHOLD) ++ pDM_SWAT_Table->Train_time_flag=0; ++ else ++ pDM_SWAT_Table->Train_time_flag=3; ++ } ++ } ++ else if((LocalMaxRSSI-LocalMinRSSI)>5) ++ pDM_SWAT_Table->Train_time_flag=2; ++ else if((LocalMaxRSSI-LocalMinRSSI)>2) ++ pDM_SWAT_Table->Train_time_flag=1; ++ else ++ pDM_SWAT_Table->Train_time_flag=0; ++ ++ } ++ ++ //2 Select TX Antenna ++ if(TargetAnt == MAIN_ANT) ++ pDM_FatTable->antsel_a[i] = ANT1_2G; ++ else ++ pDM_FatTable->antsel_a[i] = ANT2_2G; ++ ++ } ++ pDM_FatTable->MainAnt_Sum[i] = 0; ++ pDM_FatTable->AuxAnt_Sum[i] = 0; ++ pDM_FatTable->MainAnt_Cnt[i] = 0; ++ pDM_FatTable->AuxAnt_Cnt[i] = 0; ++ } ++ ++ if(pDM_SWAT_Table->bSWAntDivByCtrlFrame) ++ { ++ odm_S0S1_SwAntDivByCtrlFrame(pDM_Odm, SWAW_STEP_DETERMINE); ++ bByCtrlFrame = TRUE; ++ } ++ ++ pkt_cnt_total = pDM_FatTable->CCK_counter_main + pDM_FatTable->CCK_counter_aux + ++ pDM_FatTable->OFDM_counter_main + pDM_FatTable->OFDM_counter_aux; ++ pDM_FatTable->CCK_counter_main=0; ++ pDM_FatTable->CCK_counter_aux=0; ++ pDM_FatTable->OFDM_counter_main=0; ++ pDM_FatTable->OFDM_counter_aux=0; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Control frame packet counter = %d, Data frame packet counter = %llu\n", ++ pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame, pkt_cnt_total)); ++ ++ if(MinMaxRSSI == 0xff || ((pkt_cnt_total < (pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame >> 1)) && pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 2)) ++ { ++ MinMaxRSSI = 0; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Check RSSI of control frame because MinMaxRSSI == 0xff\n")); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("bByCtrlFrame = %d\n", bByCtrlFrame)); ++ ++ if(bByCtrlFrame) ++ { ++ Main_RSSI = (pDM_FatTable->MainAnt_CtrlFrame_Cnt!=0)?(pDM_FatTable->MainAnt_CtrlFrame_Sum/pDM_FatTable->MainAnt_CtrlFrame_Cnt):0; ++ Aux_RSSI = (pDM_FatTable->AuxAnt_CtrlFrame_Cnt!=0)?(pDM_FatTable->AuxAnt_CtrlFrame_Sum/pDM_FatTable->AuxAnt_CtrlFrame_Cnt):0; ++ ++ if(pDM_FatTable->MainAnt_CtrlFrame_Cnt<=1 && pDM_FatTable->CCK_CtrlFrame_Cnt_main>=1) ++ Main_RSSI=0; ++ ++ if(pDM_FatTable->AuxAnt_CtrlFrame_Cnt<=1 && pDM_FatTable->CCK_CtrlFrame_Cnt_aux>=1) ++ Aux_RSSI=0; ++ ++ if (Main_RSSI != 0 || Aux_RSSI != 0) ++ { ++ RxIdleAnt = (Main_RSSI==Aux_RSSI)?pDM_SWAT_Table->PreAntenna:((Main_RSSI>=Aux_RSSI)?MAIN_ANT:AUX_ANT); ++ LocalMaxRSSI = (Main_RSSI>=Aux_RSSI) ? Main_RSSI : Aux_RSSI; ++ LocalMinRSSI = (Main_RSSI>=Aux_RSSI) ? Aux_RSSI : Main_RSSI; ++ ++ if((LocalMaxRSSI-LocalMinRSSI)>8) ++ pDM_SWAT_Table->Train_time_flag=3; ++ else if((LocalMaxRSSI-LocalMinRSSI)>5) ++ pDM_SWAT_Table->Train_time_flag=2; ++ else if((LocalMaxRSSI-LocalMinRSSI)>2) ++ pDM_SWAT_Table->Train_time_flag=1; ++ else ++ pDM_SWAT_Table->Train_time_flag=0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Control frame: Main_RSSI = %d, Aux_RSSI = %d\n", Main_RSSI, Aux_RSSI)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("RxIdleAnt decided by control frame = %s\n", (RxIdleAnt == MAIN_ANT?"MAIN":"AUX"))); ++ } ++ } ++ } ++ ++ pDM_FatTable->MinMaxRSSI = MinMaxRSSI; ++ pDM_SWAT_Table->try_flag = SWAW_STEP_PEEK; ++ ++ if( pDM_SWAT_Table->Double_chk_flag==1) ++ { ++ pDM_SWAT_Table->Double_chk_flag=0; ++ ++ if (pDM_FatTable->MinMaxRSSI > RSSI_CHECK_THRESHOLD) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [Double check] MinMaxRSSI ((%d)) > %d again!!\n", ++ pDM_FatTable->MinMaxRSSI, RSSI_CHECK_THRESHOLD)); ++ ++ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[reset try_flag = 0] Training accomplished !!!]\n\n\n")); ++ return; ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [Double check] MinMaxRSSI ((%d)) <= %d !!\n", ++ pDM_FatTable->MinMaxRSSI, RSSI_CHECK_THRESHOLD)); ++ ++ nextAnt = (pDM_FatTable->RxIdleAnt == MAIN_ANT)? AUX_ANT : MAIN_ANT; ++ pDM_SWAT_Table->try_flag = SWAW_STEP_PEEK; ++ pDM_SWAT_Table->reset_idx = RSSI_CHECK_RESET_PERIOD; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[set try_flag=0] Normal State: Need to tryg again!!\n\n\n")); ++ return; ++ } ++ } ++ else ++ { ++ if (pDM_FatTable->MinMaxRSSI < RSSI_CHECK_THRESHOLD) ++ pDM_SWAT_Table->reset_idx = RSSI_CHECK_RESET_PERIOD; ++ ++ pDM_SWAT_Table->PreAntenna =RxIdleAnt; ++ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt ); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("[reset try_flag = 0] Training accomplished !!!] \n\n\n")); ++ return; ++ } ++ ++ } ++ ++ } ++ ++ //1 4.Change TRX antenna ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("RSSI_Trying = (( %d )), Ant: (( %s )) >>> (( %s )) \n", ++ pDM_SWAT_Table->RSSI_Trying, (pDM_FatTable->RxIdleAnt == MAIN_ANT?"MAIN":"AUX"),(nextAnt == MAIN_ANT?"MAIN":"AUX"))); ++ ++ ODM_UpdateRxIdleAnt(pDM_Odm, nextAnt); ++ ++ //1 5.Reset Statistics ++ ++ pDM_FatTable->RxIdleAnt = nextAnt; ++ ++ //1 6.Set next timer (Trying State) ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Test ((%s)) Ant for (( %d )) ms\n", (nextAnt == MAIN_ANT?"MAIN":"AUX"), pDM_SWAT_Table->Train_time)); ++ ODM_SetTimer(pDM_Odm, &(pDM_SWAT_Table->phydm_SwAntennaSwitchTimer), pDM_SWAT_Table->Train_time); /*ms*/ ++} ++ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++ODM_SW_AntDiv_Callback( ++ PRT_TIMER pTimer ++) ++{ ++ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ pSWAT_T pDM_SWAT_Table = &pHalData->DM_OutSrc.DM_SWAT_Table; ++ ++ #if DEV_BUS_TYPE==RT_PCI_INTERFACE ++ #if USE_WORKITEM ++ ODM_ScheduleWorkItem(&pDM_SWAT_Table->phydm_SwAntennaSwitchWorkitem); ++ #else ++ { ++ //DbgPrint("SW_antdiv_Callback"); ++ odm_S0S1_SwAntDiv(&pHalData->DM_OutSrc, SWAW_STEP_DETERMINE); ++ } ++ #endif ++ #else ++ ODM_ScheduleWorkItem(&pDM_SWAT_Table->phydm_SwAntennaSwitchWorkitem); ++ #endif ++} ++VOID ++ODM_SW_AntDiv_WorkitemCallback( ++ IN PVOID pContext ++ ) ++{ ++ PADAPTER pAdapter = (PADAPTER)pContext; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ //DbgPrint("SW_antdiv_Workitem_Callback"); ++ odm_S0S1_SwAntDiv(&pHalData->DM_OutSrc, SWAW_STEP_DETERMINE); ++} ++ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ ++VOID ++ODM_SW_AntDiv_WorkitemCallback( ++ IN PVOID pContext ++) ++{ ++ PADAPTER ++ pAdapter = (PADAPTER)pContext; ++ HAL_DATA_TYPE ++ *pHalData = GET_HAL_DATA(pAdapter); ++ ++ /*DbgPrint("SW_antdiv_Workitem_Callback");*/ ++ odm_S0S1_SwAntDiv(&pHalData->odmpriv, SWAW_STEP_DETERMINE); ++} ++ ++VOID ++ODM_SW_AntDiv_Callback(void *FunctionContext) ++{ ++ PDM_ODM_T pDM_Odm= (PDM_ODM_T)FunctionContext; ++ PADAPTER padapter = pDM_Odm->Adapter; ++ if(padapter->net_closed == _TRUE) ++ return; ++ ++ #if 0 /* Can't do I/O in timer callback*/ ++ odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_DETERMINE); ++ #else ++ rtw_run_in_thread_cmd(padapter, ODM_SW_AntDiv_WorkitemCallback, padapter); ++ #endif ++} ++ ++ ++#endif ++ ++VOID ++odm_S0S1_SwAntDivByCtrlFrame( ++ IN PVOID pDM_VOID, ++ IN u1Byte Step ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ switch(Step) ++ { ++ case SWAW_STEP_PEEK: ++ pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame = 0; ++ pDM_SWAT_Table->bSWAntDivByCtrlFrame = TRUE; ++ pDM_FatTable->MainAnt_CtrlFrame_Cnt = 0; ++ pDM_FatTable->AuxAnt_CtrlFrame_Cnt = 0; ++ pDM_FatTable->MainAnt_CtrlFrame_Sum = 0; ++ pDM_FatTable->AuxAnt_CtrlFrame_Sum = 0; ++ pDM_FatTable->CCK_CtrlFrame_Cnt_main = 0; ++ pDM_FatTable->CCK_CtrlFrame_Cnt_aux = 0; ++ pDM_FatTable->OFDM_CtrlFrame_Cnt_main = 0; ++ pDM_FatTable->OFDM_CtrlFrame_Cnt_aux = 0; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_S0S1_SwAntDivForAPMode(): Start peek and reset counter\n")); ++ break; ++ case SWAW_STEP_DETERMINE: ++ pDM_SWAT_Table->bSWAntDivByCtrlFrame = FALSE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_S0S1_SwAntDivForAPMode(): Stop peek\n")); ++ break; ++ default: ++ pDM_SWAT_Table->bSWAntDivByCtrlFrame = FALSE; ++ break; ++ } ++} ++ ++VOID ++odm_AntselStatisticsOfCtrlFrame( ++ IN PVOID pDM_VOID, ++ IN u1Byte antsel_tr_mux, ++ IN u4Byte RxPWDBAll ++ ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ if(antsel_tr_mux == ANT1_2G) ++ { ++ pDM_FatTable->MainAnt_CtrlFrame_Sum+=RxPWDBAll; ++ pDM_FatTable->MainAnt_CtrlFrame_Cnt++; ++ } ++ else ++ { ++ pDM_FatTable->AuxAnt_CtrlFrame_Sum+=RxPWDBAll; ++ pDM_FatTable->AuxAnt_CtrlFrame_Cnt++; ++ } ++} ++ ++VOID ++odm_S0S1_SwAntDivByCtrlFrame_ProcessRSSI( ++ IN PVOID pDM_VOID, ++ IN PVOID p_phy_info_void, ++ IN PVOID p_pkt_info_void ++ //IN PODM_PHY_INFO_T pPhyInfo, ++ //IN PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PODM_PHY_INFO_T pPhyInfo=(PODM_PHY_INFO_T)p_phy_info_void; ++ PODM_PACKET_INFO_T pPktinfo=(PODM_PACKET_INFO_T)p_pkt_info_void; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ BOOLEAN isCCKrate; ++ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) ++ return; ++ ++ if(pDM_Odm->AntDivType != S0S1_SW_ANTDIV) ++ return; ++ ++ // In try state ++ if(!pDM_SWAT_Table->bSWAntDivByCtrlFrame) ++ return; ++ ++ // No HW error and match receiver address ++ if(!pPktinfo->bToSelf) ++ return; ++ ++ pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame++; ++ isCCKrate = ((pPktinfo->DataRate >= DESC_RATE1M ) && (pPktinfo->DataRate <= DESC_RATE11M ))?TRUE :FALSE; ++ ++ if(isCCKrate) ++ { ++ pDM_FatTable->antsel_rx_keep_0 = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? ANT1_2G : ANT2_2G; ++ ++ if(pDM_FatTable->antsel_rx_keep_0==ANT1_2G) ++ pDM_FatTable->CCK_CtrlFrame_Cnt_main++; ++ else ++ pDM_FatTable->CCK_CtrlFrame_Cnt_aux++; ++ ++ odm_AntselStatisticsOfCtrlFrame(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]); ++ } ++ else ++ { ++ if(pDM_FatTable->antsel_rx_keep_0==ANT1_2G) ++ pDM_FatTable->OFDM_CtrlFrame_Cnt_main++; ++ else ++ pDM_FatTable->OFDM_CtrlFrame_Cnt_aux++; ++ ++ odm_AntselStatisticsOfCtrlFrame(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPhyInfo->RxPWDBAll); ++ } ++} ++ ++#endif //#if (RTL8723B_SUPPORT == 1)||(RTL8821A_SUPPORT == 1) ++ ++ ++ ++ ++VOID ++odm_SetNextMACAddrTarget( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ PSTA_INFO_T pEntry; ++ u4Byte value32, i; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_SetNextMACAddrTarget() ==>\n")); ++ ++ if (pDM_Odm->bLinked) ++ { ++ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { ++ ++ if ((pDM_FatTable->TrainIdx+1) == ODM_ASSOCIATE_ENTRY_NUM) ++ pDM_FatTable->TrainIdx = 0; ++ else ++ pDM_FatTable->TrainIdx++; ++ ++ pEntry = pDM_Odm->pODM_StaInfo[pDM_FatTable->TrainIdx]; ++ ++ if (IS_STA_VALID(pEntry)) { ++ ++ /*Match MAC ADDR*/ ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) ++ value32 = (pEntry->hwaddr[5]<<8)|pEntry->hwaddr[4]; ++ #else ++ value32 = (pEntry->MacAddr[5]<<8)|pEntry->MacAddr[4]; ++ #endif ++ ++ ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, value32);/*0x7b4~0x7b5*/ ++ ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) ++ value32 = (pEntry->hwaddr[3]<<24)|(pEntry->hwaddr[2]<<16) |(pEntry->hwaddr[1]<<8) |pEntry->hwaddr[0]; ++ #else ++ value32 = (pEntry->MacAddr[3]<<24)|(pEntry->MacAddr[2]<<16) |(pEntry->MacAddr[1]<<8) |pEntry->MacAddr[0]; ++ #endif ++ ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, value32);/*0x7b0~0x7b3*/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_FatTable->TrainIdx=%d\n", pDM_FatTable->TrainIdx)); ++ ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training MAC Addr = %x:%x:%x:%x:%x:%x\n", ++ pEntry->hwaddr[5], pEntry->hwaddr[4], pEntry->hwaddr[3], pEntry->hwaddr[2], pEntry->hwaddr[1], pEntry->hwaddr[0])); ++ #else ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training MAC Addr = %x:%x:%x:%x:%x:%x\n", ++ pEntry->MacAddr[5], pEntry->MacAddr[4], pEntry->MacAddr[3], pEntry->MacAddr[2], pEntry->MacAddr[1], pEntry->MacAddr[0])); ++ #endif ++ ++ break; ++ } ++ } ++ } ++ ++#if 0 ++ // ++ //2012.03.26 LukeLee: This should be removed later, the MAC address is changed according to MACID in turn ++ // ++ #if( DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ { ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ ++ for (i=0; i<6; i++) ++ { ++ Bssid[i] = pMgntInfo->Bssid[i]; ++ //DbgPrint("Bssid[%d]=%x\n", i, Bssid[i]); ++ } ++ } ++ #endif ++ ++ //odm_SetNextMACAddrTarget(pDM_Odm); ++ ++ //1 Select MAC Address Filter ++ for (i=0; i<6; i++) ++ { ++ if(Bssid[i] != pDM_FatTable->Bssid[i]) ++ { ++ bMatchBSSID = FALSE; ++ break; ++ } ++ } ++ if(bMatchBSSID == FALSE) ++ { ++ //Match MAC ADDR ++ value32 = (Bssid[5]<<8)|Bssid[4]; ++ ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, value32); ++ value32 = (Bssid[3]<<24)|(Bssid[2]<<16) |(Bssid[1]<<8) |Bssid[0]; ++ ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, value32); ++ } ++ ++ return bMatchBSSID; ++#endif ++ ++} ++ ++#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) ++ ++VOID ++odm_FastAntTraining( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ u4Byte MaxRSSI_pathA=0, Pckcnt_pathA=0; ++ u1Byte i,TargetAnt_pathA=0; ++ BOOLEAN bPktFilterMacth_pathA = FALSE; ++ #if(RTL8192E_SUPPORT == 1) ++ u4Byte MaxRSSI_pathB=0, Pckcnt_pathB=0; ++ u1Byte TargetAnt_pathB=0; ++ BOOLEAN bPktFilterMacth_pathB = FALSE; ++ #endif ++ ++ ++ if(!pDM_Odm->bLinked) //bLinked==False ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); ++ ++ if(pDM_FatTable->bBecomeLinked == TRUE) ++ { ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ phydm_FastTraining_enable(pDM_Odm , FAT_OFF); ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); ++ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; ++ } ++ return; ++ } ++ else ++ { ++ if(pDM_FatTable->bBecomeLinked ==FALSE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked!!!]\n")); ++ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; ++ } ++ } ++ ++ if (*(pDM_FatTable->pForceTxAntByDesc) == FALSE) { ++ if (pDM_Odm->bOneEntryOnly == TRUE) ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); ++ else ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); ++ } ++ ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8188E) ++ { ++ ODM_SetBBReg(pDM_Odm, 0x864 , BIT2|BIT1|BIT0, ((pDM_Odm->fat_comb_a)-1)); ++ } ++ #if(RTL8192E_SUPPORT == 1) ++ else if(pDM_Odm->SupportICType == ODM_RTL8192E) ++ { ++ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT2|BIT1|BIT0, ((pDM_Odm->fat_comb_a)-1) ); //path-A // ant combination=regB38[2:0]+1 ++ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT18|BIT17|BIT16, ((pDM_Odm->fat_comb_b)-1) ); //path-B // ant combination=regB38[18:16]+1 ++ } ++ #endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("==>odm_FastAntTraining()\n")); ++ ++ //1 TRAINING STATE ++ if(pDM_FatTable->FAT_State == FAT_TRAINING_STATE) ++ { ++ //2 Caculate RSSI per Antenna ++ ++ //3 [path-A]--------------------------- ++ for (i=0; i<(pDM_Odm->fat_comb_a); i++) // i : antenna index ++ { ++ if(pDM_FatTable->antRSSIcnt[i] == 0) ++ pDM_FatTable->antAveRSSI[i] = 0; ++ else ++ { ++ pDM_FatTable->antAveRSSI[i] = pDM_FatTable->antSumRSSI[i] /pDM_FatTable->antRSSIcnt[i]; ++ bPktFilterMacth_pathA = TRUE; ++ } ++ ++ if(pDM_FatTable->antAveRSSI[i] > MaxRSSI_pathA) ++ { ++ MaxRSSI_pathA = pDM_FatTable->antAveRSSI[i]; ++ Pckcnt_pathA = pDM_FatTable ->antRSSIcnt[i]; ++ TargetAnt_pathA = i ; ++ } ++ else if(pDM_FatTable->antAveRSSI[i] == MaxRSSI_pathA) ++ { ++ if( (pDM_FatTable->antRSSIcnt[i] ) > Pckcnt_pathA) ++ { ++ MaxRSSI_pathA = pDM_FatTable->antAveRSSI[i]; ++ Pckcnt_pathA = pDM_FatTable ->antRSSIcnt[i]; ++ TargetAnt_pathA = i ; ++ } ++ } ++ ++ ODM_RT_TRACE("*** Ant-Index : [ %d ], Counter = (( %d )), Avg RSSI = (( %d )) \n", i, pDM_FatTable->antRSSIcnt[i], pDM_FatTable->antAveRSSI[i] ); ++ } ++ ++ ++ /* ++ #if(RTL8192E_SUPPORT == 1) ++ //3 [path-B]--------------------------- ++ for (i=0; i<(pDM_Odm->fat_comb_b); i++) ++ { ++ if(pDM_FatTable->antRSSIcnt_pathB[i] == 0) ++ pDM_FatTable->antAveRSSI_pathB[i] = 0; ++ else // (antRSSIcnt[i] != 0) ++ { ++ pDM_FatTable->antAveRSSI_pathB[i] = pDM_FatTable->antSumRSSI_pathB[i] /pDM_FatTable->antRSSIcnt_pathB[i]; ++ bPktFilterMacth_pathB = TRUE; ++ } ++ if(pDM_FatTable->antAveRSSI_pathB[i] > MaxRSSI_pathB) ++ { ++ MaxRSSI_pathB = pDM_FatTable->antAveRSSI_pathB[i]; ++ Pckcnt_pathB = pDM_FatTable ->antRSSIcnt_pathB[i]; ++ TargetAnt_pathB = (u1Byte) i; ++ } ++ if(pDM_FatTable->antAveRSSI_pathB[i] == MaxRSSI_pathB) ++ { ++ if(pDM_FatTable ->antRSSIcnt_pathB > Pckcnt_pathB) ++ { ++ MaxRSSI_pathB = pDM_FatTable->antAveRSSI_pathB[i]; ++ TargetAnt_pathB = (u1Byte) i; ++ } ++ } ++ if (pDM_Odm->fat_print_rssi==1) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{Path-B}: Sum RSSI[%d] = (( %d )), cnt RSSI [%d] = (( %d )), Avg RSSI[%d] = (( %d )) \n", ++ i, pDM_FatTable->antSumRSSI_pathB[i], i, pDM_FatTable->antRSSIcnt_pathB[i], i, pDM_FatTable->antAveRSSI_pathB[i])); ++ } ++ } ++ #endif ++ */ ++ ++ //1 DECISION STATE ++ ++ //2 Select TRX Antenna ++ ++ phydm_FastTraining_enable(pDM_Odm, FAT_OFF); ++ ++ //3 [path-A]--------------------------- ++ if(bPktFilterMacth_pathA == FALSE) ++ { ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("{Path-A}: None Packet is matched\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("{Path-A}: None Packet is matched\n")); ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ } ++ else ++ { ++ ODM_RT_TRACE("TargetAnt_pathA = (( %d )) , MaxRSSI_pathA = (( %d )) \n",TargetAnt_pathA,MaxRSSI_pathA); ++ ++ //3 [ update RX-optional ant ] Default RX is Omni, Optional RX is the best decision by FAT ++ if(pDM_Odm->SupportICType == ODM_RTL8188E) ++ { ++ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, TargetAnt_pathA); ++ } ++ else if(pDM_Odm->SupportICType == ODM_RTL8192E) ++ { ++ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT8|BIT7|BIT6, TargetAnt_pathA);//Optional RX [pth-A] ++ } ++ //3 [ update TX ant ] ++ odm_UpdateTxAnt(pDM_Odm, TargetAnt_pathA, (pDM_FatTable->TrainIdx)); ++ ++ if(TargetAnt_pathA == 0) ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ } ++ /* ++ #if(RTL8192E_SUPPORT == 1) ++ //3 [path-B]--------------------------- ++ if(bPktFilterMacth_pathB == FALSE) ++ { ++ if (pDM_Odm->fat_print_rssi==1) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***[%d]{Path-B}: None Packet is matched\n\n\n",__LINE__)); ++ } ++ } ++ else ++ { ++ if (pDM_Odm->fat_print_rssi==1) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ++ (" ***TargetAnt_pathB = (( %d )) *** MaxRSSI = (( %d ))***\n\n\n",TargetAnt_pathB,MaxRSSI_pathB)); ++ } ++ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT21|BIT20|BIT19, TargetAnt_pathB); //Default RX is Omni, Optional RX is the best decision by FAT ++ ODM_SetBBReg(pDM_Odm, 0x80c , BIT21, 1); //Reg80c[21]=1'b1 //from TX Info ++ ++ pDM_FatTable->antsel_pathB[pDM_FatTable->TrainIdx] = TargetAnt_pathB; ++ } ++ #endif ++ */ ++ ++ //2 Reset Counter ++ for(i=0; i<(pDM_Odm->fat_comb_a); i++) ++ { ++ pDM_FatTable->antSumRSSI[i] = 0; ++ pDM_FatTable->antRSSIcnt[i] = 0; ++ } ++ /* ++ #if(RTL8192E_SUPPORT == 1) ++ for(i=0; i<=(pDM_Odm->fat_comb_b); i++) ++ { ++ pDM_FatTable->antSumRSSI_pathB[i] = 0; ++ pDM_FatTable->antRSSIcnt_pathB[i] = 0; ++ } ++ #endif ++ */ ++ ++ pDM_FatTable->FAT_State = FAT_PREPARE_STATE; ++ return; ++ } ++ ++ //1 NORMAL STATE ++ if (pDM_FatTable->FAT_State == FAT_PREPARE_STATE) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Start Prepare State ]\n")); ++ ++ odm_SetNextMACAddrTarget(pDM_Odm); ++ ++ //2 Prepare Training ++ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; ++ phydm_FastTraining_enable(pDM_Odm , FAT_ON); ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); //enable HW AntDiv ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Start Training State]\n")); ++ ++ ODM_SetTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer, pDM_Odm->antdiv_intvl ); //ms ++ } ++ ++} ++ ++VOID ++odm_FastAntTrainingCallback( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PADAPTER padapter = pDM_Odm->Adapter; ++ if(padapter->net_closed == _TRUE) ++ return; ++ //if(*pDM_Odm->pbNet_closed == TRUE) ++ // return; ++#endif ++ ++#if USE_WORKITEM ++ ODM_ScheduleWorkItem(&pDM_Odm->FastAntTrainingWorkitem); ++#else ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_FastAntTrainingCallback****** \n")); ++ odm_FastAntTraining(pDM_Odm); ++#endif ++} ++ ++VOID ++odm_FastAntTrainingWorkItemCallback( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_FastAntTrainingWorkItemCallback****** \n")); ++ odm_FastAntTraining(pDM_Odm); ++} ++ ++#endif ++ ++#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 ++ ++u4Byte ++phydm_construct_hl_beam_codeword( ++ IN PVOID pDM_VOID, ++ IN u4Byte *beam_pattern_idx, ++ IN u4Byte ant_num ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); ++ u4Byte codeword = 0; ++ u4Byte data_tmp; ++ u4Byte i; ++ u4Byte break_counter = 0; ++ ++ if (ant_num < 8) { ++ for (i = 0; i < (pdm_sat_table->ant_num_total); i++) { ++ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("beam_pattern_num[%x] = %x\n",i,beam_pattern_num[i] ));*/ ++ if ((i < (pdm_sat_table->first_train_ant-1)) || (break_counter >= (pdm_sat_table->ant_num))) { ++ data_tmp = 0; ++ /**/ ++ } else { ++ ++ break_counter++; ++ ++ if (beam_pattern_idx[i] == 0) { ++ ++ if (*pDM_Odm->pBandType == ODM_BAND_5G) ++ data_tmp = pdm_sat_table->rfu_codeword_table_5g[0]; ++ else ++ data_tmp = pdm_sat_table->rfu_codeword_table[0]; ++ ++ } else if (beam_pattern_idx[i] == 1) { ++ ++ ++ if (*pDM_Odm->pBandType == ODM_BAND_5G) ++ data_tmp = pdm_sat_table->rfu_codeword_table_5g[1]; ++ else ++ data_tmp = pdm_sat_table->rfu_codeword_table[1]; ++ ++ } else if (beam_pattern_idx[i] == 2) { ++ ++ if (*pDM_Odm->pBandType == ODM_BAND_5G) ++ data_tmp = pdm_sat_table->rfu_codeword_table_5g[2]; ++ else ++ data_tmp = pdm_sat_table->rfu_codeword_table[2]; ++ ++ } else if (beam_pattern_idx[i] == 3) { ++ ++ if (*pDM_Odm->pBandType == ODM_BAND_5G) ++ data_tmp = pdm_sat_table->rfu_codeword_table_5g[3]; ++ else ++ data_tmp = pdm_sat_table->rfu_codeword_table[3]; ++ } ++ } ++ ++ ++ codeword |= (data_tmp<<(i*4)); ++ ++ } ++ } ++ ++ return codeword; ++} ++ ++VOID ++phydm_update_beam_pattern( ++ IN PVOID pDM_VOID, ++ IN u4Byte codeword, ++ IN u4Byte codeword_length ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); ++ u1Byte i; ++ BOOLEAN beam_ctrl_signal; ++ u4Byte one = 0x1; ++ u4Byte reg44_tmp_p, reg44_tmp_n, reg44_ori; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Set Beam Pattern =0x%x\n", codeword)); ++ ++ reg44_ori = ODM_GetMACReg(pDM_Odm, 0x44, bMaskDWord); ++ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("reg44_ori =0x%x\n", reg44_ori));*/ ++ ++ for (i = 0; i <= (codeword_length-1); i++) { ++ beam_ctrl_signal = (BOOLEAN)((codeword&BIT(i)) >> i); ++ ++ if (pDM_Odm->DebugComponents & ODM_COMP_ANT_DIV) { ++ ++ if (i == (codeword_length-1)) { ++ DbgPrint("%d ]\n", beam_ctrl_signal); ++ /**/ ++ } else if (i == 0) { ++ DbgPrint("Send codeword[1:24] ---> [ %d ", beam_ctrl_signal); ++ /**/ ++ } else if ((i % 4) == 3) { ++ DbgPrint("%d | ", beam_ctrl_signal); ++ /**/ ++ } else { ++ DbgPrint("%d ", beam_ctrl_signal); ++ /**/ ++ } ++ } ++ ++ #if 1 ++ reg44_tmp_p = reg44_ori & (~(BIT11|BIT10)); /*clean bit 10 & 11*/ ++ reg44_tmp_p |= ((1<<11) | (beam_ctrl_signal<<10)); ++ reg44_tmp_n = reg44_ori & (~(BIT11|BIT10)); ++ ++ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n));*/ ++ ODM_SetMACReg(pDM_Odm, 0x44 , bMaskDWord, reg44_tmp_p); ++ ODM_SetMACReg(pDM_Odm, 0x44 , bMaskDWord, reg44_tmp_n); ++ #else ++ ODM_SetMACReg(pDM_Odm, 0x44 , BIT11|BIT10, ((1<<1) | beam_ctrl_signal)); ++ ODM_SetMACReg(pDM_Odm, 0x44 , BIT11, 0); ++ #endif ++ ++ } ++} ++ ++VOID ++phydm_update_rx_idle_beam( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); ++ u4Byte i; ++ ++ pdm_sat_table->update_beam_codeword = phydm_construct_hl_beam_codeword(pDM_Odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set target beam_pattern codeword = (( 0x%x ))\n", pdm_sat_table->update_beam_codeword)); ++ ++ for (i = 0; i < (pdm_sat_table->ant_num); i++) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Beam ] RxIdleBeam[%d] =%d\n", i, pdm_sat_table->rx_idle_beam[i])); ++ /**/ ++ } ++ ++ #if DEV_BUS_TYPE == RT_PCI_INTERFACE ++ phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); ++ #else ++ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_workitem); ++ /*ODM_StallExecution(1);*/ ++ #endif ++ ++ pdm_sat_table->pre_codeword = pdm_sat_table->update_beam_codeword; ++} ++ ++VOID ++phydm_hl_smart_ant_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ u4Byte one = 0x1; ++ u4Byte codeword_length = pdm_sat_table->data_codeword_bit_num; ++ u4Byte beam_ctrl_signal, i; ++ ++ if (dm_value[0] == 1) { /*fix beam pattern*/ ++ ++ pdm_sat_table->fix_beam_pattern_en = dm_value[1]; ++ ++ if (pdm_sat_table->fix_beam_pattern_en == 1) { ++ ++ pdm_sat_table->fix_beam_pattern_codeword = dm_value[2]; ++ ++ if (pdm_sat_table->fix_beam_pattern_codeword > (one<fix_beam_pattern_codeword, codeword_length)); ++ (pdm_sat_table->fix_beam_pattern_codeword) &= 0xffffff; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Auto modify to (0x%x)\n", pdm_sat_table->fix_beam_pattern_codeword)); ++ } ++ ++ pdm_sat_table->update_beam_codeword = pdm_sat_table->fix_beam_pattern_codeword; ++ ++ /*---------------------------------------------------------*/ ++ PHYDM_SNPRINTF((output+used, out_len-used, "Fix Beam Pattern\n")); ++ for (i = 0; i <= (codeword_length-1); i++) { ++ beam_ctrl_signal = (BOOLEAN)((pdm_sat_table->update_beam_codeword&BIT(i)) >> i); ++ ++ if (i == (codeword_length-1)) { ++ PHYDM_SNPRINTF((output+used, out_len-used, "%d]\n", beam_ctrl_signal)); ++ /**/ ++ } else if (i == 0) { ++ PHYDM_SNPRINTF((output+used, out_len-used, "Send Codeword[1:24] to RFU -> [%d", beam_ctrl_signal)); ++ /**/ ++ } else if ((i % 4) == 3) { ++ PHYDM_SNPRINTF((output+used, out_len-used, "%d|", beam_ctrl_signal)); ++ /**/ ++ } else { ++ PHYDM_SNPRINTF((output+used, out_len-used, "%d", beam_ctrl_signal)); ++ /**/ ++ } ++ } ++ /*---------------------------------------------------------*/ ++ ++ ++ #if DEV_BUS_TYPE == RT_PCI_INTERFACE ++ phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); ++ #else ++ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_workitem); ++ /*ODM_StallExecution(1);*/ ++ #endif ++ } else if (pdm_sat_table->fix_beam_pattern_en == 0) { ++ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Smart Antenna: Enable\n")); ++ } ++ ++ } else if (dm_value[0] == 2) { /*set latch time*/ ++ ++ pdm_sat_table->latch_time = dm_value[1]; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] latch_time =0x%x\n", pdm_sat_table->latch_time)); ++ } else if (dm_value[0] == 3) { ++ ++ pdm_sat_table->fix_training_num_en = dm_value[1]; ++ ++ if (pdm_sat_table->fix_training_num_en == 1) { ++ pdm_sat_table->per_beam_training_pkt_num = (u1Byte)dm_value[2]; ++ pdm_sat_table->decision_holding_period = (u1Byte)dm_value[3]; ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "[SmartAnt][Dbg] Fix_train_en = (( %d )), train_pkt_num = (( %d )), holding_period = (( %d )),\n", ++ pdm_sat_table->fix_training_num_en, pdm_sat_table->per_beam_training_pkt_num, pdm_sat_table->decision_holding_period)); ++ ++ } else if (pdm_sat_table->fix_training_num_en == 0) { ++ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] AUTO per_beam_training_pkt_num\n")); ++ /**/ ++ } ++ } else if (dm_value[0] == 4) { ++ ++ if (dm_value[1] == 1) { ++ pdm_sat_table->ant_num = 1; ++ pdm_sat_table->first_train_ant = MAIN_ANT; ++ ++ } else if (dm_value[1] == 2) { ++ pdm_sat_table->ant_num = 1; ++ pdm_sat_table->first_train_ant = AUX_ANT; ++ ++ } else if (dm_value[1] == 3) { ++ pdm_sat_table->ant_num = 2; ++ pdm_sat_table->first_train_ant = MAIN_ANT; ++ } ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Set Ant Num = (( %d )), first_train_ant = (( %d ))\n", ++ pdm_sat_table->ant_num, (pdm_sat_table->first_train_ant-1))); ++ } else if (dm_value[0] == 5) { ++ ++ if (dm_value[1] <= 3) { ++ pdm_sat_table->rfu_codeword_table[dm_value[1]] = dm_value[2]; ++ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Set Beam_2G: (( %d )), RFU codeword table = (( 0x%x ))\n", ++ dm_value[1], dm_value[2])); ++ } else { ++ for (i = 0; i < 4; i++) { ++ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Show Beam_2G: (( %d )), RFU codeword table = (( 0x%x ))\n", ++ i, pdm_sat_table->rfu_codeword_table[i])); ++ } ++ } ++ } else if (dm_value[0] == 6) { ++ ++ if (dm_value[1] <= 3) { ++ pdm_sat_table->rfu_codeword_table_5g[dm_value[1]] = dm_value[2]; ++ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Set Beam_5G: (( %d )), RFU codeword table = (( 0x%x ))\n", ++ dm_value[1], dm_value[2])); ++ } else { ++ for (i = 0; i < 4; i++) { ++ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Show Beam_5G: (( %d )), RFU codeword table = (( 0x%x ))\n", ++ i, pdm_sat_table->rfu_codeword_table_5g[i])); ++ } ++ } ++ } else if (dm_value[0] == 7) { ++ ++ if (dm_value[1] <= 4) { ++ ++ pdm_sat_table->beam_patten_num_each_ant = dm_value[1]; ++ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Set Beam number = (( %d ))\n", ++ pdm_sat_table->beam_patten_num_each_ant)); ++ } else { ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Show Beam number = (( %d ))\n", ++ pdm_sat_table->beam_patten_num_each_ant)); ++ } ++ } ++ ++} ++ ++ ++void ++phydm_set_all_ant_same_beam_num( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); ++ ++ if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) { /*2Ant for 8821A*/ ++ ++ pdm_sat_table->rx_idle_beam[0] = pdm_sat_table->fast_training_beam_num; ++ pdm_sat_table->rx_idle_beam[1] = pdm_sat_table->fast_training_beam_num; ++ } ++ ++ pdm_sat_table->update_beam_codeword = phydm_construct_hl_beam_codeword(pDM_Odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Set all ant beam_pattern: codeword = (( 0x%x ))\n", pdm_sat_table->update_beam_codeword)); ++ ++ #if DEV_BUS_TYPE == RT_PCI_INTERFACE ++ phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); ++ #else ++ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_workitem); ++ /*ODM_StallExecution(1);*/ ++ #endif ++} ++ ++VOID ++odm_FastAntTraining_hl_smart_antenna_type1( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); ++ pFAT_T pDM_FatTable = &(pDM_Odm->DM_FatTable); ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ u4Byte codeword = 0, i, j; ++ u4Byte TargetAnt; ++ u4Byte avg_rssi_tmp, avg_rssi_tmp_ma; ++ u4Byte target_ant_beam_max_rssi[SUPPORT_RF_PATH_NUM] = {0}; ++ u4Byte max_beam_ant_rssi = 0; ++ u4Byte target_ant_beam[SUPPORT_RF_PATH_NUM] = {0}; ++ u4Byte beam_tmp; ++ u1Byte next_ant; ++ u4Byte rssi_sorting_seq[SUPPORT_BEAM_PATTERN_NUM] = {0}; ++ u4Byte rank_idx_seq[SUPPORT_BEAM_PATTERN_NUM] = {0}; ++ u4Byte rank_idx_out[SUPPORT_BEAM_PATTERN_NUM] = {0}; ++ u1Byte per_beam_rssi_diff_tmp = 0, training_pkt_num_offset; ++ u4Byte break_counter = 0; ++ u4Byte used_ant; ++ ++ ++ if (!pDM_Odm->bLinked) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); ++ ++ if (pDM_FatTable->bBecomeLinked == TRUE) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Link -> no Link\n")); ++ pDM_FatTable->FAT_State = FAT_BEFORE_LINK_STATE; ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("change to (( %d )) FAT_state\n", pDM_FatTable->FAT_State)); ++ ++ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; ++ } ++ return; ++ ++ } else { ++ if (pDM_FatTable->bBecomeLinked == FALSE) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); ++ ++ pDM_FatTable->FAT_State = FAT_PREPARE_STATE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("change to (( %d )) FAT_state\n", pDM_FatTable->FAT_State)); ++ ++ /*pdm_sat_table->fast_training_beam_num = 0;*/ ++ /*phydm_set_all_ant_same_beam_num(pDM_Odm);*/ ++ ++ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; ++ } ++ } ++ ++ if (*(pDM_FatTable->pForceTxAntByDesc) == FALSE) { ++ if (pDM_Odm->bOneEntryOnly == TRUE) ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); ++ else ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); ++ } ++ ++ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("HL Smart Ant Training: State (( %d ))\n", pDM_FatTable->FAT_State));*/ ++ ++ /* [DECISION STATE] */ ++ /*=======================================================================================*/ ++ if (pDM_FatTable->FAT_State == FAT_DECISION_STATE) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 3. In Decision State]\n")); ++ phydm_FastTraining_enable(pDM_Odm , FAT_OFF); ++ ++ break_counter = 0; ++ /*compute target beam in each antenna*/ ++ for (i = (pdm_sat_table->first_train_ant-1); i < pdm_sat_table->ant_num_total; i++) { ++ for (j = 0; j < (pdm_sat_table->beam_patten_num_each_ant); j++) { ++ ++ if (pdm_sat_table->pkt_rssi_cnt[i][j] == 0) { ++ avg_rssi_tmp = pdm_sat_table->pkt_rssi_pre[i][j]; ++ avg_rssi_tmp = (avg_rssi_tmp >= 2) ? (avg_rssi_tmp - 2) : avg_rssi_tmp; ++ avg_rssi_tmp_ma = avg_rssi_tmp; ++ } else { ++ avg_rssi_tmp = (pdm_sat_table->pkt_rssi_sum[i][j]) / (pdm_sat_table->pkt_rssi_cnt[i][j]); ++ avg_rssi_tmp_ma = (avg_rssi_tmp + pdm_sat_table->pkt_rssi_pre[i][j])>>1; ++ } ++ ++ rssi_sorting_seq[j] = avg_rssi_tmp; ++ pdm_sat_table->pkt_rssi_pre[i][j] = avg_rssi_tmp; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Ant[%d], Beam[%d]: pkt_cnt=(( %d )), avg_rssi_MA=(( %d )), avg_rssi=(( %d ))\n", ++ i, j, pdm_sat_table->pkt_rssi_cnt[i][j], avg_rssi_tmp_ma, avg_rssi_tmp)); ++ ++ if (avg_rssi_tmp > target_ant_beam_max_rssi[i]) { ++ target_ant_beam[i] = j; ++ target_ant_beam_max_rssi[i] = avg_rssi_tmp; ++ } ++ ++ /*reset counter value*/ ++ pdm_sat_table->pkt_rssi_sum[i][j] = 0; ++ pdm_sat_table->pkt_rssi_cnt[i][j] = 0; ++ ++ } ++ pdm_sat_table->rx_idle_beam[i] = target_ant_beam[i]; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("---------> Target of Ant[%d]: Beam_num-(( %d )) RSSI= ((%d))\n", ++ i, target_ant_beam[i], target_ant_beam_max_rssi[i])); ++ ++ /*sorting*/ ++ /* ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Pre]rssi_sorting_seq = [%d, %d, %d, %d]\n", rssi_sorting_seq[0], rssi_sorting_seq[1], rssi_sorting_seq[2], rssi_sorting_seq[3])); ++ */ ++ ++ /*phydm_seq_sorting(pDM_Odm, &rssi_sorting_seq[0], &rank_idx_seq[0], &rank_idx_out[0], SUPPORT_BEAM_PATTERN_NUM);*/ ++ ++ /* ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Post]rssi_sorting_seq = [%d, %d, %d, %d]\n", rssi_sorting_seq[0], rssi_sorting_seq[1], rssi_sorting_seq[2], rssi_sorting_seq[3])); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Post]rank_idx_seq = [%d, %d, %d, %d]\n", rank_idx_seq[0], rank_idx_seq[1], rank_idx_seq[2], rank_idx_seq[3])); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Post]rank_idx_out = [%d, %d, %d, %d]\n", rank_idx_out[0], rank_idx_out[1], rank_idx_out[2], rank_idx_out[3])); ++ */ ++ ++ if (target_ant_beam_max_rssi[i] > max_beam_ant_rssi) { ++ TargetAnt = i; ++ max_beam_ant_rssi = target_ant_beam_max_rssi[i]; ++ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Target of Ant = (( %d )) max_beam_ant_rssi = (( %d ))\n", ++ TargetAnt, max_beam_ant_rssi));*/ ++ } ++ break_counter++; ++ if (break_counter >= (pdm_sat_table->ant_num)) ++ break; ++ } ++ ++ #ifdef CONFIG_FAT_PATCH ++ break_counter = 0; ++ for (i = (pdm_sat_table->first_train_ant-1); i < pdm_sat_table->ant_num_total; i++) { ++ for (j = 0; j < (pdm_sat_table->beam_patten_num_each_ant); j++) { ++ ++ per_beam_rssi_diff_tmp = (u1Byte)(max_beam_ant_rssi - pdm_sat_table->pkt_rssi_pre[i][j]); ++ pdm_sat_table->beam_train_rssi_diff[i][j] = per_beam_rssi_diff_tmp; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Ant[%d], Beam[%d]: RSSI_diff= ((%d))\n", ++ i, j, per_beam_rssi_diff_tmp)); ++ } ++ break_counter++; ++ if (break_counter >= (pdm_sat_table->ant_num)) ++ break; ++ } ++ #endif ++ ++ if (TargetAnt == 0) ++ TargetAnt = MAIN_ANT; ++ else if (TargetAnt == 1) ++ TargetAnt = AUX_ANT; ++ ++ if (pdm_sat_table->ant_num > 1) { ++ /* [ update RX ant ]*/ ++ ODM_UpdateRxIdleAnt(pDM_Odm, (u1Byte)TargetAnt); ++ ++ /* [ update TX ant ]*/ ++ odm_UpdateTxAnt(pDM_Odm, (u1Byte)TargetAnt, (pDM_FatTable->TrainIdx)); ++ } ++ ++ /*set beam in each antenna*/ ++ phydm_update_rx_idle_beam(pDM_Odm); ++ ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); ++ pDM_FatTable->FAT_State = FAT_PREPARE_STATE; ++ ++ } ++ /* [TRAINING STATE] */ ++ else if (pDM_FatTable->FAT_State == FAT_TRAINING_STATE) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2. In Training State]\n")); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("fat_beam_n = (( %d )), pre_fat_beam_n = (( %d ))\n", ++ pdm_sat_table->fast_training_beam_num, pdm_sat_table->pre_fast_training_beam_num)); ++ ++ if (pdm_sat_table->fast_training_beam_num > pdm_sat_table->pre_fast_training_beam_num) { ++ ++ pdm_sat_table->force_update_beam_en = 0; ++ ++ } else { ++ ++ pdm_sat_table->force_update_beam_en = 1; ++ ++ pdm_sat_table->pkt_counter = 0; ++ beam_tmp = pdm_sat_table->fast_training_beam_num; ++ if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant-1)) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Timeout Update] Beam_num (( %d )) -> (( decision ))\n", pdm_sat_table->fast_training_beam_num)); ++ pDM_FatTable->FAT_State = FAT_DECISION_STATE; ++ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); ++ ++ } else { ++ pdm_sat_table->fast_training_beam_num++; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Timeout Update] Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); ++ phydm_set_all_ant_same_beam_num(pDM_Odm); ++ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; ++ ++ } ++ } ++ pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Update Pre_Beam =(( %d ))\n", pdm_sat_table->pre_fast_training_beam_num)); ++ } ++ /* [Prepare State] */ ++ /*=======================================================================================*/ ++ else if (pDM_FatTable->FAT_State == FAT_PREPARE_STATE) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n\n[ 1. In Prepare State]\n")); ++ ++ if (pDM_Odm->pre_TrafficLoad == (pDM_Odm->TrafficLoad)) { ++ if (pdm_sat_table->decision_holding_period != 0) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Holding_period = (( %d )), return!!!\n", pdm_sat_table->decision_holding_period)); ++ pdm_sat_table->decision_holding_period--; ++ return; ++ } ++ } ++ ++ ++ /* Set training packet number*/ ++ if (pdm_sat_table->fix_training_num_en == 0) { ++ ++ switch (pDM_Odm->TrafficLoad) { ++ ++ case TRAFFIC_HIGH: ++ pdm_sat_table->per_beam_training_pkt_num = 8; ++ pdm_sat_table->decision_holding_period = 2; ++ break; ++ case TRAFFIC_MID: ++ pdm_sat_table->per_beam_training_pkt_num = 6; ++ pdm_sat_table->decision_holding_period = 3; ++ break; ++ case TRAFFIC_LOW: ++ pdm_sat_table->per_beam_training_pkt_num = 3; /*ping 60000*/ ++ pdm_sat_table->decision_holding_period = 4; ++ break; ++ case TRAFFIC_ULTRA_LOW: ++ pdm_sat_table->per_beam_training_pkt_num = 1; ++ pdm_sat_table->decision_holding_period = 6; ++ break; ++ default: ++ break; ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fix_training_en = (( %d )), training_pkt_num_base = (( %d )), holding_period = ((%d))\n", ++ pdm_sat_table->fix_training_num_en , pdm_sat_table->per_beam_training_pkt_num, pdm_sat_table->decision_holding_period)); ++ ++ ++ #ifdef CONFIG_FAT_PATCH ++ break_counter = 0; ++ for (i = (pdm_sat_table->first_train_ant-1); i < pdm_sat_table->ant_num_total; i++) { ++ for (j = 0; j < (pdm_sat_table->beam_patten_num_each_ant); j++) { ++ ++ per_beam_rssi_diff_tmp = pdm_sat_table->beam_train_rssi_diff[i][j]; ++ training_pkt_num_offset = per_beam_rssi_diff_tmp; ++ ++ if ((pdm_sat_table->per_beam_training_pkt_num) > training_pkt_num_offset) ++ pdm_sat_table->beam_train_cnt[i][j] = pdm_sat_table->per_beam_training_pkt_num - training_pkt_num_offset; ++ else ++ pdm_sat_table->beam_train_cnt[i][j] = 1; ++ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Ant[%d]: Beam_num-(( %d )) training_pkt_num = ((%d))\n", ++ i, j, pdm_sat_table->beam_train_cnt[i][j])); ++ } ++ break_counter++; ++ if (break_counter >= (pdm_sat_table->ant_num)) ++ break; ++ } ++ ++ ++ phydm_FastTraining_enable(pDM_Odm , FAT_OFF); ++ pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; ++ pdm_sat_table->update_beam_idx = 0; ++ ++ if (*pDM_Odm->pBandType == ODM_BAND_5G) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set 5G ant\n")); ++ /*used_ant = (pdm_sat_table->first_train_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT;*/ ++ used_ant = pdm_sat_table->first_train_ant; ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set 2.4G ant\n")); ++ used_ant = pdm_sat_table->first_train_ant; ++ } ++ ++ ODM_UpdateRxIdleAnt(pDM_Odm, (u1Byte)used_ant); ++ ++ #else ++ /* Set training MAC Addr. of target */ ++ odm_SetNextMACAddrTarget(pDM_Odm); ++ phydm_FastTraining_enable(pDM_Odm , FAT_ON); ++ #endif ++ ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ pdm_sat_table->pkt_counter = 0; ++ pdm_sat_table->fast_training_beam_num = 0; ++ phydm_set_all_ant_same_beam_num(pDM_Odm); ++ pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; ++ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; ++ } ++ ++} ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++VOID ++phydm_beam_switch_workitem_callback( ++ IN PVOID pContext ++ ) ++{ ++ PADAPTER pAdapter = (PADAPTER)pContext; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); ++ ++ #if DEV_BUS_TYPE != RT_PCI_INTERFACE ++ pdm_sat_table->pkt_skip_statistic_en = 1; ++ #endif ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Beam Switch Workitem Callback, pkt_skip_statistic_en = (( %d ))\n", pdm_sat_table->pkt_skip_statistic_en)); ++ ++ phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); ++ ++ #if DEV_BUS_TYPE != RT_PCI_INTERFACE ++ /*ODM_StallExecution(pdm_sat_table->latch_time);*/ ++ pdm_sat_table->pkt_skip_statistic_en = 0; ++ #endif ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pkt_skip_statistic_en = (( %d )), latch_time = (( %d ))\n", pdm_sat_table->pkt_skip_statistic_en, pdm_sat_table->latch_time)); ++} ++ ++VOID ++phydm_beam_decision_workitem_callback( ++ IN PVOID pContext ++ ) ++{ ++ PADAPTER pAdapter = (PADAPTER)pContext; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Beam decision Workitem Callback\n")); ++ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); ++} ++#endif ++ ++#endif /*#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1*/ ++ ++VOID ++ODM_AntDivInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ ++ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] Not Support Antenna Diversity Function\n")); ++ return; ++ } ++ //--- ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_2G) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[2G AntDiv Init]: Only Support 2G Antenna Diversity Function\n")); ++ if(!(pDM_Odm->SupportICType & ODM_ANTDIV_2G_SUPPORT_IC)) ++ return; ++ } ++ else if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_5G) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[5G AntDiv Init]: Only Support 5G Antenna Diversity Function\n")); ++ if(!(pDM_Odm->SupportICType & ODM_ANTDIV_5G_SUPPORT_IC)) ++ return; ++ } ++ else if(pDM_FatTable->AntDiv_2G_5G == (ODM_ANTDIV_2G|ODM_ANTDIV_5G)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[2G & 5G AntDiv Init]:Support Both 2G & 5G Antenna Diversity Function\n")); ++ } ++ ++#endif ++ //--- ++ ++ //2 [--General---] ++ pDM_Odm->antdiv_period=0; ++ ++ pDM_FatTable->bBecomeLinked =FALSE; ++ pDM_FatTable->AntDiv_OnOff =0xff; ++ ++ //3 - AP - ++ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++ #if (BEAMFORMING_SUPPORT == 1) ++ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ odm_BDC_Init(pDM_Odm); ++ #endif ++ #endif ++ ++ //3 - WIN - ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ pDM_SWAT_Table->Ant5G = MAIN_ANT; ++ pDM_SWAT_Table->Ant2G = MAIN_ANT; ++ pDM_FatTable->CCK_counter_main=0; ++ pDM_FatTable->CCK_counter_aux=0; ++ pDM_FatTable->OFDM_counter_main=0; ++ pDM_FatTable->OFDM_counter_aux=0; ++ #endif ++ ++ //2 [---Set MAIN_ANT as default antenna if Auto-Ant enable---] ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ ++ pDM_Odm->AntType = ODM_AUTO_ANT; ++ ++ pDM_FatTable->RxIdleAnt = 0xff; /*to make RX-idle-antenna will be updated absolutly*/ ++ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); ++ phydm_keep_RxAckAnt_By_TxAnt_time( pDM_Odm, 5); /* Timming issue: keep Rx ant after tx for ACK ( 5 x 3.2 mu = 16mu sec)*/ ++ ++ //2 [---Set TX Antenna---] ++ pDM_FatTable->ForceTxAntByDesc = 0; ++ pDM_FatTable->pForceTxAntByDesc = &(pDM_FatTable->ForceTxAntByDesc); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("pForceTxAntByDesc = %d\n", *pDM_FatTable->pForceTxAntByDesc)); ++ ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); ++ ++ ++ //2 [--88E---] ++ if(pDM_Odm->SupportICType == ODM_RTL8188E) ++ { ++ #if (RTL8188E_SUPPORT == 1) ++ //pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; ++ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; ++ //pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; ++ ++ if( (pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_SMART_ANTDIV)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 88E Not Supprrt This AntDiv Type\n")); ++ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); ++ return; ++ } ++ ++ if(pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) ++ odm_RX_HWAntDiv_Init_88E(pDM_Odm); ++ else if(pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) ++ odm_TRX_HWAntDiv_Init_88E(pDM_Odm); ++ #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) ++ else if(pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) ++ odm_Smart_HWAntDiv_Init_88E(pDM_Odm); ++ #endif ++ #endif ++ } ++ ++ //2 [--92E---] ++ #if (RTL8192E_SUPPORT == 1) ++ else if(pDM_Odm->SupportICType == ODM_RTL8192E) ++ { ++ //pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; ++ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; ++ //pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; ++ ++ if( (pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_SMART_ANTDIV)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8192E Not Supprrt This AntDiv Type\n")); ++ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); ++ return; ++ } ++ ++ if(pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) ++ odm_RX_HWAntDiv_Init_92E(pDM_Odm); ++ else if(pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) ++ odm_TRX_HWAntDiv_Init_92E(pDM_Odm); ++ #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) ++ else if(pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) ++ odm_Smart_HWAntDiv_Init_92E(pDM_Odm); ++ #endif ++ ++ } ++ #endif ++ ++ //2 [--8723B---] ++ #if (RTL8723B_SUPPORT == 1) ++ else if(pDM_Odm->SupportICType == ODM_RTL8723B) ++ { ++ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; ++ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; ++ ++ if(pDM_Odm->AntDivType != S0S1_SW_ANTDIV && pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8723B Not Supprrt This AntDiv Type\n")); ++ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); ++ return; ++ } ++ ++ if( pDM_Odm->AntDivType==S0S1_SW_ANTDIV) ++ odm_S0S1_SWAntDiv_Init_8723B(pDM_Odm); ++ else if(pDM_Odm->AntDivType==CG_TRX_HW_ANTDIV) ++ odm_TRX_HWAntDiv_Init_8723B(pDM_Odm); ++ } ++ #endif ++ /*2 [--8723D---]*/ ++ #if (RTL8723D_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8723D) { ++ if (pDM_FatTable->pDefaultS0S1 == NULL) { ++ pDM_FatTable->DefaultS0S1 = 1; ++ pDM_FatTable->pDefaultS0S1 = &(pDM_FatTable->DefaultS0S1); ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("DefaultS0S1 = %d\n", *pDM_FatTable->pDefaultS0S1)); ++ ++ if (*(pDM_FatTable->pDefaultS0S1) == TRUE) ++ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); ++ else ++ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); ++ ++ if (pDM_Odm->AntDivType == S0S1_TRX_HW_ANTDIV) ++ odm_TRX_HWAntDiv_Init_8723D(pDM_Odm); ++ else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8723D Not Supprrt This AntDiv Type\n")); ++ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); ++ return; ++ } ++ ++ } ++ #endif ++ //2 [--8811A 8821A---] ++ #if (RTL8821A_SUPPORT == 1) ++ else if(pDM_Odm->SupportICType == ODM_RTL8821) ++ { ++ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 ++ pDM_Odm->AntDivType = HL_SW_SMART_ANT_TYPE1; ++ ++ if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) { ++ ++ odm_TRX_HWAntDiv_Init_8821A(pDM_Odm); ++ phydm_hl_smart_ant_type1_init_8821a(pDM_Odm); ++ } else ++ #endif ++ { ++ /*pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV;*/ ++ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; ++ ++ if (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV && pDM_Odm->AntDivType != S0S1_SW_ANTDIV) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8821A & 8811A Not Supprrt This AntDiv Type\n")); ++ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); ++ return; ++ } ++ if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) ++ odm_TRX_HWAntDiv_Init_8821A(pDM_Odm); ++ else if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) ++ odm_S0S1_SWAntDiv_Init_8821A(pDM_Odm); ++ } ++ } ++ #endif ++ ++ //2 [--8821C---] ++ #if (RTL8821C_SUPPORT == 1) ++ else if(pDM_Odm->SupportICType == ODM_RTL8821C) ++ { ++ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; ++ if (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV ) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8821C Not Supprrt This AntDiv Type\n")); ++ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); ++ return; ++ } ++ odm_TRX_HWAntDiv_Init_8821C(pDM_Odm); ++ } ++ #endif ++ ++ //2 [--8881A---] ++ #if (RTL8881A_SUPPORT == 1) ++ else if(pDM_Odm->SupportICType == ODM_RTL8881A) ++ { ++ //pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; ++ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; ++ ++ if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) { ++ ++ odm_TRX_HWAntDiv_Init_8881A(pDM_Odm); ++ /**/ ++ } else { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8881A Not Supprrt This AntDiv Type\n")); ++ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); ++ return; ++ } ++ ++ odm_TRX_HWAntDiv_Init_8881A(pDM_Odm); ++ } ++ #endif ++ ++ //2 [--8812---] ++ #if (RTL8812A_SUPPORT == 1) ++ else if(pDM_Odm->SupportICType == ODM_RTL8812) ++ { ++ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; ++ ++ if( pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8812A Not Supprrt This AntDiv Type\n")); ++ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); ++ return; ++ } ++ odm_TRX_HWAntDiv_Init_8812A(pDM_Odm); ++ } ++ #endif ++ ++ /*[--8188F---]*/ ++ #if (RTL8188F_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8188F) { ++ ++ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; ++ odm_S0S1_SWAntDiv_Init_8188F(pDM_Odm); ++ } ++ #endif ++ /* ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** SupportICType=[%lu]\n",pDM_Odm->SupportICType)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** AntDiv SupportAbility=[%lu]\n",(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)>>6)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** AntDiv Type=[%d]\n",pDM_Odm->AntDivType)); ++ */ ++} ++ ++VOID ++ODM_AntDiv( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 ++ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); ++ #endif ++ ++ if(*pDM_Odm->pBandType == ODM_BAND_5G ) ++ { ++ if(pDM_FatTable->idx_AntDiv_counter_5G < pDM_Odm->antdiv_period ) ++ { ++ pDM_FatTable->idx_AntDiv_counter_5G++; ++ return; ++ } ++ else ++ pDM_FatTable->idx_AntDiv_counter_5G=0; ++ } ++ else if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) ++ { ++ if(pDM_FatTable->idx_AntDiv_counter_2G < pDM_Odm->antdiv_period ) ++ { ++ pDM_FatTable->idx_AntDiv_counter_2G++; ++ return; ++ } ++ else ++ pDM_FatTable->idx_AntDiv_counter_2G=0; ++ } ++ ++ //---------- ++ if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] Not Support Antenna Diversity Function\n")); ++ return; ++ } ++ ++ //---------- ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++ if (pDM_FatTable->enable_ctrl_frame_antdiv) { ++ ++ if ((pDM_Odm->data_frame_num <= 10) && (pDM_Odm->bLinked)) ++ pDM_FatTable->use_ctrl_frame_antdiv = 1; ++ else ++ pDM_FatTable->use_ctrl_frame_antdiv = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("use_ctrl_frame_antdiv = (( %d )), data_frame_num = (( %d ))\n", pDM_FatTable->use_ctrl_frame_antdiv, pDM_Odm->data_frame_num)); ++ pDM_Odm->data_frame_num = 0; ++ } ++ ++ if(pAdapter->MgntInfo.AntennaTest) ++ return; ++ ++ { ++ #if (BEAMFORMING_SUPPORT == 1) ++ BEAMFORMING_CAP BeamformCap = (pDM_Odm->BeamformingInfo.BeamformCap); ++ ++ if( BeamformCap & BEAMFORMEE_CAP ) // BFmee On && Div On -> Div Off ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ AntDiv : OFF ] BFmee ==1 \n")); ++ if(pDM_FatTable->fix_ant_bfee == 0) ++ { ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ pDM_FatTable->fix_ant_bfee = 1; ++ } ++ return; ++ } ++ else // BFmee Off && Div Off -> Div On ++ { ++ if((pDM_FatTable->fix_ant_bfee == 1) && pDM_Odm->bLinked) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ AntDiv : ON ] BFmee ==0\n")); ++ if((pDM_Odm->AntDivType!=S0S1_SW_ANTDIV) ) ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); ++ ++ pDM_FatTable->fix_ant_bfee = 0; ++ } ++ } ++ #endif ++ } ++#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ //----------just for fool proof ++ ++ if(pDM_Odm->antdiv_rssi) ++ pDM_Odm->DebugComponents |= ODM_COMP_ANT_DIV; ++ else ++ pDM_Odm->DebugComponents &= ~ODM_COMP_ANT_DIV; ++ ++ if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_2G) ++ { ++ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 2G AntDiv Running ]\n")); ++ if(!(pDM_Odm->SupportICType & ODM_ANTDIV_2G_SUPPORT_IC)) ++ return; ++ } ++ else if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_5G) ++ { ++ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 5G AntDiv Running ]\n")); ++ if(!(pDM_Odm->SupportICType & ODM_ANTDIV_5G_SUPPORT_IC)) ++ return; ++ } ++ //else if(pDM_FatTable->AntDiv_2G_5G == (ODM_ANTDIV_2G|ODM_ANTDIV_5G)) ++ //{ ++ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 2G & 5G AntDiv Running ]\n")); ++ //} ++#endif ++ ++ //---------- ++ ++ if (pDM_Odm->antdiv_select==1) ++ pDM_Odm->AntType = ODM_FIX_MAIN_ANT; ++ else if (pDM_Odm->antdiv_select==2) ++ pDM_Odm->AntType = ODM_FIX_AUX_ANT; ++ else //if (pDM_Odm->antdiv_select==0) ++ pDM_Odm->AntType = ODM_AUTO_ANT; ++ ++ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("AntType= (( %d )) , pre_AntType= (( %d )) \n",pDM_Odm->AntType,pDM_Odm->pre_AntType)); ++ ++ if(pDM_Odm->AntType != ODM_AUTO_ANT) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fix Antenna at (( %s ))\n",(pDM_Odm->AntType == ODM_FIX_MAIN_ANT)?"MAIN":"AUX")); ++ ++ if(pDM_Odm->AntType != pDM_Odm->pre_AntType) ++ { ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); ++ ++ if(pDM_Odm->AntType == ODM_FIX_MAIN_ANT) ++ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); ++ else if(pDM_Odm->AntType == ODM_FIX_AUX_ANT) ++ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); ++ } ++ pDM_Odm->pre_AntType=pDM_Odm->AntType; ++ return; ++ } ++ else ++ { ++ if(pDM_Odm->AntType != pDM_Odm->pre_AntType) ++ { ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); ++ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); ++ } ++ pDM_Odm->pre_AntType=pDM_Odm->AntType; ++ } ++ ++ ++ //3 ----------------------------------------------------------------------------------------------------------- ++ //2 [--88E---] ++ if(pDM_Odm->SupportICType == ODM_RTL8188E) ++ { ++ #if (RTL8188E_SUPPORT == 1) ++ if(pDM_Odm->AntDivType==CG_TRX_HW_ANTDIV ||pDM_Odm->AntDivType==CGCS_RX_HW_ANTDIV) ++ odm_HW_AntDiv(pDM_Odm); ++ ++ #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) ++ else if (pDM_Odm->AntDivType==CG_TRX_SMART_ANTDIV) ++ odm_FastAntTraining(pDM_Odm); ++ #endif ++ ++ #endif ++ ++ } ++ //2 [--92E---] ++ #if (RTL8192E_SUPPORT == 1) ++ else if(pDM_Odm->SupportICType == ODM_RTL8192E) ++ { ++ if(pDM_Odm->AntDivType==CGCS_RX_HW_ANTDIV || pDM_Odm->AntDivType==CG_TRX_HW_ANTDIV) ++ odm_HW_AntDiv(pDM_Odm); ++ ++ #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) ++ else if (pDM_Odm->AntDivType==CG_TRX_SMART_ANTDIV) ++ odm_FastAntTraining(pDM_Odm); ++ #endif ++ ++ } ++ #endif ++ ++ #if (RTL8723B_SUPPORT == 1) ++ //2 [--8723B---] ++ else if(pDM_Odm->SupportICType == ODM_RTL8723B) ++ { ++ if (phydm_IsBtEnable_8723b(pDM_Odm)) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BT is enable!!!]\n")); ++ if (pDM_FatTable->bBecomeLinked == TRUE) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set REG 948[9:6]=0x0\n")); ++ if (pDM_Odm->SupportICType == ODM_RTL8723B) ++ ODM_SetBBReg(pDM_Odm, 0x948 , BIT9|BIT8|BIT7|BIT6, 0x0); ++ ++ pDM_FatTable->bBecomeLinked = FALSE; ++ } ++ } else { ++ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { ++ ++ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_PEEK); ++ #endif ++ } else if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) ++ odm_HW_AntDiv(pDM_Odm); ++ } ++ } ++ #endif ++ /*8723D*/ ++ #if (RTL8723D_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8723D) { ++ ++ odm_HW_AntDiv(pDM_Odm); ++ /**/ ++ } ++ #endif ++ ++ //2 [--8821A---] ++ #if (RTL8821A_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8821) ++ { ++ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 ++ if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) { ++ ++ if (pdm_sat_table->fix_beam_pattern_en != 0) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [ SmartAnt ] Fix SmartAnt Pattern = 0x%x\n", pdm_sat_table->fix_beam_pattern_codeword)); ++ /*return;*/ ++ } else { ++ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] AntDivType = HL_SW_SMART_ANT_TYPE1\n"));*/ ++ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); ++ } ++ ++ } else ++ #endif ++ { ++ ++ if (!pDM_Odm->bBtEnabled) /*BT disabled*/ ++ { ++ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { ++ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [S0S1_SW_ANTDIV] -> [CG_TRX_HW_ANTDIV]\n")); ++ /*ODM_SetBBReg(pDM_Odm, 0x8D4 , BIT24, 1); */ ++ if (pDM_FatTable->bBecomeLinked == TRUE) ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); ++ } ++ ++ } else { /*BT enabled*/ ++ ++ if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) { ++ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [CG_TRX_HW_ANTDIV] -> [S0S1_SW_ANTDIV]\n")); ++ /*ODM_SetBBReg(pDM_Odm, 0x8D4 , BIT24, 0);*/ ++ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); ++ } ++ } ++ ++ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { ++ ++ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_PEEK); ++ #endif ++ } else if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) ++ odm_HW_AntDiv(pDM_Odm); ++ } ++ } ++ #endif ++ ++ //2 [--8821C---] ++ #if (RTL8821C_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ { ++ odm_HW_AntDiv(pDM_Odm); ++ } ++ #endif ++ ++ //2 [--8881A---] ++ #if (RTL8881A_SUPPORT == 1) ++ else if(pDM_Odm->SupportICType == ODM_RTL8881A) ++ odm_HW_AntDiv(pDM_Odm); ++ #endif ++ ++ //2 [--8812A---] ++ #if (RTL8812A_SUPPORT == 1) ++ else if(pDM_Odm->SupportICType == ODM_RTL8812) ++ odm_HW_AntDiv(pDM_Odm); ++ #endif ++ ++ #if (RTL8188F_SUPPORT == 1) ++ /* [--8188F---]*/ ++ else if (pDM_Odm->SupportICType == ODM_RTL8188F) { ++ ++ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_PEEK); ++ #endif ++ } ++ #endif ++ ++} ++ ++ ++VOID ++odm_AntselStatistics( ++ IN PVOID pDM_VOID, ++ IN u1Byte antsel_tr_mux, ++ IN u4Byte MacId, ++ IN u4Byte utility, ++ IN u1Byte method, ++ IN u1Byte isCCKrate ++ ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ if (method == RSSI_METHOD) { ++ ++ if (isCCKrate) { ++ if (antsel_tr_mux == ANT1_2G) { ++ if (pDM_FatTable->MainAnt_Sum_cck[MacId] > 65435) /*to prevent u2Byte overflow, max(RSSI)=100, 65435+100 = 65535 (u2Byte)*/ ++ return; ++ ++ pDM_FatTable->MainAnt_Sum_cck[MacId] += (u2Byte)utility; ++ pDM_FatTable->MainAnt_Cnt_cck[MacId]++; ++ } else { ++ if (pDM_FatTable->AuxAnt_Sum_cck[MacId] > 65435) ++ return; ++ ++ pDM_FatTable->AuxAnt_Sum_cck[MacId] += (u2Byte)utility; ++ pDM_FatTable->AuxAnt_Cnt_cck[MacId]++; ++ } ++ ++ } else { /*ofdm rate*/ ++ ++ if (antsel_tr_mux == ANT1_2G) { ++ if (pDM_FatTable->MainAnt_Sum[MacId] > 65435) ++ return; ++ ++ pDM_FatTable->MainAnt_Sum[MacId] += (u2Byte)utility; ++ pDM_FatTable->MainAnt_Cnt[MacId]++; ++ } else { ++ if (pDM_FatTable->AuxAnt_Sum[MacId] > 65435) ++ return; ++ ++ pDM_FatTable->AuxAnt_Sum[MacId] += (u2Byte)utility; ++ pDM_FatTable->AuxAnt_Cnt[MacId]++; ++ } ++ } ++ } ++ #ifdef ODM_EVM_ENHANCE_ANTDIV ++ else if(method==EVM_METHOD) ++ { ++ if(antsel_tr_mux == ANT1_2G) ++ { ++ pDM_FatTable->MainAntEVM_Sum[MacId]+=(utility<<5); ++ pDM_FatTable->MainAntEVM_Cnt[MacId]++; ++ } ++ else ++ { ++ pDM_FatTable->AuxAntEVM_Sum[MacId]+=(utility<<5); ++ pDM_FatTable->AuxAntEVM_Cnt[MacId]++; ++ } ++ } ++ else if(method==CRC32_METHOD) ++ { ++ if(utility==0) ++ pDM_FatTable->CRC32_Fail_Cnt++; ++ else ++ pDM_FatTable->CRC32_Ok_Cnt+=utility; ++ } ++ #endif ++} ++ ++ ++VOID ++ODM_Process_RSSIForAntDiv( ++ IN OUT PVOID pDM_VOID, ++ IN PVOID p_phy_info_void, ++ IN PVOID p_pkt_info_void ++ //IN PODM_PHY_INFO_T pPhyInfo, ++ //IN PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PODM_PHY_INFO_T pPhyInfo=(PODM_PHY_INFO_T)p_phy_info_void; ++ PODM_PACKET_INFO_T pPktinfo=(PODM_PACKET_INFO_T)p_pkt_info_void; ++ u1Byte isCCKrate=0,CCKMaxRate=ODM_RATE11M; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 ++ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); ++ u4Byte beam_tmp; ++ u1Byte next_ant; ++ u1Byte train_pkt_number; ++ #endif ++ ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ u4Byte RxPower_Ant0, RxPower_Ant1; ++ u4Byte RxEVM_Ant0, RxEVM_Ant1; ++ #else ++ u1Byte RxPower_Ant0, RxPower_Ant1; ++ u1Byte RxEVM_Ant0, RxEVM_Ant1; ++ #endif ++ ++ CCKMaxRate=ODM_RATE11M; ++ isCCKrate = (pPktinfo->DataRate <= CCKMaxRate)?TRUE:FALSE; ++ ++ if ((pDM_Odm->SupportICType & (ODM_RTL8192E|ODM_RTL8812)) && (pPktinfo->DataRate > CCKMaxRate)) ++ { ++ RxPower_Ant0 = pPhyInfo->RxMIMOSignalStrength[0]; ++ RxPower_Ant1= pPhyInfo->RxMIMOSignalStrength[1]; ++ ++ RxEVM_Ant0 =pPhyInfo->RxMIMOSignalQuality[0]; ++ RxEVM_Ant1 =pPhyInfo->RxMIMOSignalQuality[1]; ++ } ++ else ++ RxPower_Ant0=pPhyInfo->RxPWDBAll; ++ ++ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 ++ #ifdef CONFIG_FAT_PATCH ++ if ((pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) && (pDM_FatTable->FAT_State == FAT_TRAINING_STATE)) { ++ ++ /*[Beacon]*/ ++ if (pPktinfo->bPacketBeacon) { ++ ++ pdm_sat_table->beacon_counter++; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("MatchBSSID_beacon_counter = ((%d))\n", pdm_sat_table->beacon_counter)); ++ ++ if (pdm_sat_table->beacon_counter >= pdm_sat_table->pre_beacon_counter + 2) { ++ ++ if (pdm_sat_table->ant_num > 1) { ++ next_ant = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? AUX_ANT : MAIN_ANT; ++ ODM_UpdateRxIdleAnt(pDM_Odm, next_ant); ++ } ++ ++ pdm_sat_table->update_beam_idx++; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pre_beacon_counter = ((%d)), pkt_counter = ((%d)), update_beam_idx = ((%d))\n", ++ pdm_sat_table->pre_beacon_counter, pdm_sat_table->pkt_counter, pdm_sat_table->update_beam_idx)); ++ ++ pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; ++ pdm_sat_table->pkt_counter = 0; ++ } ++ } ++ /*[Data]*/ ++ else if (pPktinfo->bPacketToSelf) { ++ ++ if (pdm_sat_table->pkt_skip_statistic_en == 0) { ++ /* ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("StaID[%d]: antsel_pathA = ((%d)), hw_antsw_occur = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", ++ pPktinfo->StationID, pDM_FatTable->antsel_rx_keep_0, pDM_FatTable->hw_antsw_occur, pdm_sat_table->fast_training_beam_num, RxPower_Ant0)); ++ */ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ID[%d][pkt_cnt = %d]: {ANT, Beam} = {%d, %d}, RSSI = ((%d))\n", ++ pPktinfo->StationID, pdm_sat_table->pkt_counter, pDM_FatTable->antsel_rx_keep_0, pdm_sat_table->fast_training_beam_num, RxPower_Ant0)); ++ ++ pdm_sat_table->pkt_rssi_sum[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num] += RxPower_Ant0; ++ pdm_sat_table->pkt_rssi_cnt[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num]++; ++ pdm_sat_table->pkt_counter++; ++ ++ #if 1 ++ train_pkt_number = pdm_sat_table->beam_train_cnt[pDM_FatTable->RxIdleAnt-1][pdm_sat_table->fast_training_beam_num]; ++ #else ++ train_pkt_number = pdm_sat_table->per_beam_training_pkt_num; ++ #endif ++ ++ /*Swich Antenna erery N pkts*/ ++ if (pdm_sat_table->pkt_counter == train_pkt_number) { ++ ++ if (pdm_sat_table->ant_num > 1) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("packet enugh ((%d ))pkts ---> Switch antenna\n", train_pkt_number)); ++ next_ant = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? AUX_ANT : MAIN_ANT; ++ ODM_UpdateRxIdleAnt(pDM_Odm, next_ant); ++ } ++ ++ pdm_sat_table->update_beam_idx++; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pre_beacon_counter = ((%d)), update_beam_idx_counter = ((%d))\n", ++ pdm_sat_table->pre_beacon_counter, pdm_sat_table->update_beam_idx)); ++ ++ pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; ++ pdm_sat_table->pkt_counter = 0; ++ } ++ } ++ } ++ ++ /*Swich Beam after switch "pdm_sat_table->ant_num" antennas*/ ++ if (pdm_sat_table->update_beam_idx == pdm_sat_table->ant_num) { ++ ++ pdm_sat_table->update_beam_idx = 0; ++ pdm_sat_table->pkt_counter = 0; ++ beam_tmp = pdm_sat_table->fast_training_beam_num; ++ ++ if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant-1)) { ++ ++ pDM_FatTable->FAT_State = FAT_DECISION_STATE; ++ ++ #if DEV_BUS_TYPE == RT_PCI_INTERFACE ++ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); ++ #else ++ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_decision_workitem); ++ #endif ++ ++ ++ } else { ++ pdm_sat_table->fast_training_beam_num++; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Update Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); ++ phydm_set_all_ant_same_beam_num(pDM_Odm); ++ ++ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; ++ } ++ } ++ ++ } ++ #else ++ ++ if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) ++ { ++ if ((pDM_Odm->SupportICType & ODM_HL_SMART_ANT_TYPE1_SUPPORT) && ++ (pPktinfo->bPacketToSelf) && ++ (pDM_FatTable->FAT_State == FAT_TRAINING_STATE) ++ ) { ++ ++ if (pdm_sat_table->pkt_skip_statistic_en == 0) { ++ /* ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("StaID[%d]: antsel_pathA = ((%d)), hw_antsw_occur = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", ++ pPktinfo->StationID, pDM_FatTable->antsel_rx_keep_0, pDM_FatTable->hw_antsw_occur, pdm_sat_table->fast_training_beam_num, RxPower_Ant0)); ++ */ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("StaID[%d]: antsel_pathA = ((%d)), bPacketToSelf = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", ++ pPktinfo->StationID, pDM_FatTable->antsel_rx_keep_0, pPktinfo->bPacketToSelf, pdm_sat_table->fast_training_beam_num, RxPower_Ant0)); ++ ++ ++ pdm_sat_table->pkt_rssi_sum[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num] += RxPower_Ant0; ++ pdm_sat_table->pkt_rssi_cnt[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num]++; ++ pdm_sat_table->pkt_counter++; ++ ++ /*swich beam every N pkt*/ ++ if ((pdm_sat_table->pkt_counter) >= (pdm_sat_table->per_beam_training_pkt_num)) { ++ ++ pdm_sat_table->pkt_counter = 0; ++ beam_tmp = pdm_sat_table->fast_training_beam_num; ++ ++ if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant-1)) { ++ ++ pDM_FatTable->FAT_State = FAT_DECISION_STATE; ++ ++ #if DEV_BUS_TYPE == RT_PCI_INTERFACE ++ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); ++ #else ++ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_decision_workitem); ++ #endif ++ ++ ++ } else { ++ pdm_sat_table->fast_training_beam_num++; ++ phydm_set_all_ant_same_beam_num(pDM_Odm); ++ ++ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Update Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); ++ } ++ } ++ } ++ } ++ } ++ #endif ++ else ++ #endif ++ if (pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) { ++ if( (pDM_Odm->SupportICType & ODM_SMART_ANT_SUPPORT) && (pPktinfo->bPacketToSelf) && (pDM_FatTable->FAT_State == FAT_TRAINING_STATE) )//(pPktinfo->bPacketMatchBSSID && (!pPktinfo->bPacketBeacon)) ++ { ++ u1Byte antsel_tr_mux; ++ antsel_tr_mux = (pDM_FatTable->antsel_rx_keep_2<<2) |(pDM_FatTable->antsel_rx_keep_1 <<1) |pDM_FatTable->antsel_rx_keep_0; ++ pDM_FatTable->antSumRSSI[antsel_tr_mux] += RxPower_Ant0; ++ pDM_FatTable->antRSSIcnt[antsel_tr_mux]++; ++ } ++ } ++ else //AntDivType != CG_TRX_SMART_ANTDIV ++ { ++ if ((pDM_Odm->SupportICType & ODM_ANTDIV_SUPPORT) && (pPktinfo->bPacketToSelf || pDM_FatTable->use_ctrl_frame_antdiv)) { ++ ++ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { ++ ++ if (isCCKrate) { ++ ++ pDM_FatTable->antsel_rx_keep_0 = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? ANT1_2G : ANT2_2G; ++ ++ if (pDM_FatTable->antsel_rx_keep_0 == ANT1_2G) ++ pDM_FatTable->CCK_counter_main++; ++ else ++ pDM_FatTable->CCK_counter_aux++; ++ ++ odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxPower_Ant0, RSSI_METHOD, isCCKrate); ++ ++ } else { ++ ++ if (pDM_FatTable->antsel_rx_keep_0 == ANT1_2G) ++ pDM_FatTable->OFDM_counter_main++; ++ else ++ pDM_FatTable->OFDM_counter_aux++; ++ ++ odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxPower_Ant0, RSSI_METHOD, isCCKrate); ++ } ++ } else { ++ ++ odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxPower_Ant0, RSSI_METHOD, isCCKrate); ++ ++ #ifdef ODM_EVM_ENHANCE_ANTDIV ++ if (pDM_Odm->SupportICType == ODM_RTL8192E) { ++ if (!isCCKrate) ++ odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxEVM_Ant0, EVM_METHOD, isCCKrate); ++ ++ } ++ #endif ++ } ++ } ++ } ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("isCCKrate=%d, PWDB_ALL=%d\n",isCCKrate, pPhyInfo->RxPWDBAll)); ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("antsel_tr_mux=3'b%d%d%d\n",pDM_FatTable->antsel_rx_keep_2, pDM_FatTable->antsel_rx_keep_1, pDM_FatTable->antsel_rx_keep_0)); ++} ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++VOID ++ODM_SetTxAntByTxInfo( ++ IN PVOID pDM_VOID, ++ IN pu1Byte pDesc, ++ IN u1Byte macId ++ ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) ++ return; ++ ++ if (pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) ++ return; ++ ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8723B) { ++#if (RTL8723B_SUPPORT == 1) ++ SET_TX_DESC_ANTSEL_A_8723B(pDesc, pDM_FatTable->antsel_a[macId]); ++ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8723B] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", ++ macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ ++#endif ++ } else if (pDM_Odm->SupportICType == ODM_RTL8821) { ++#if (RTL8821A_SUPPORT == 1) ++ SET_TX_DESC_ANTSEL_A_8812(pDesc, pDM_FatTable->antsel_a[macId]); ++ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8821A] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", ++ macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ ++#endif ++ } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { ++#if (RTL8188E_SUPPORT == 1) ++ SET_TX_DESC_ANTSEL_A_88E(pDesc, pDM_FatTable->antsel_a[macId]); ++ SET_TX_DESC_ANTSEL_B_88E(pDesc, pDM_FatTable->antsel_b[macId]); ++ SET_TX_DESC_ANTSEL_C_88E(pDesc, pDM_FatTable->antsel_c[macId]); ++ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8188E] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", ++ macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ ++#endif ++ } else if (pDM_Odm->SupportICType == ODM_RTL8821C) { ++#if (RTL8821C_SUPPORT == 1) ++ SET_TX_DESC_ANTSEL_A_8821C(pDesc, pDM_FatTable->antsel_a[macId]); ++ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8821C] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", ++ macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ ++#endif ++ } ++} ++#elif(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++VOID ++ODM_SetTxAntByTxInfo( ++ struct rtl8192cd_priv *priv, ++ struct tx_desc *pdesc, ++ unsigned short aid ++) ++{ ++ PDM_ODM_T pDM_Odm = &(priv->pshare->_dmODM); ++ pFAT_T pDM_FatTable = &priv->pshare->_dmODM.DM_FatTable; ++ u4Byte SupportICType = priv->pshare->_dmODM.SupportICType; ++ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) ++ return; ++ ++ if (pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) ++ return; ++ ++ if (SupportICType == ODM_RTL8881A) { ++ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8881E******\n",__FUNCTION__,__LINE__); */ ++ pdesc->Dword6 &= set_desc(~(BIT(18)|BIT(17)|BIT(16))); ++ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_a[aid]<<16); ++ } else if (SupportICType == ODM_RTL8192E) { ++ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8192E******\n",__FUNCTION__,__LINE__); */ ++ pdesc->Dword6 &= set_desc(~(BIT(18)|BIT(17)|BIT(16))); ++ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_a[aid]<<16); ++ } else if (SupportICType == ODM_RTL8188E) { ++ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8188E******\n",__FUNCTION__,__LINE__);*/ ++ pdesc->Dword2 &= set_desc(~BIT(24)); ++ pdesc->Dword2 &= set_desc(~BIT(25)); ++ pdesc->Dword7 &= set_desc(~BIT(29)); ++ ++ pdesc->Dword2 |= set_desc(pDM_FatTable->antsel_a[aid]<<24); ++ pdesc->Dword2 |= set_desc(pDM_FatTable->antsel_b[aid]<<25); ++ pdesc->Dword7 |= set_desc(pDM_FatTable->antsel_c[aid]<<29); ++ ++ ++ } else if (SupportICType == ODM_RTL8812) { ++ /*[path-A]*/ ++ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8881E******\n",__FUNCTION__,__LINE__);*/ ++ ++ pdesc->Dword6 &= set_desc(~BIT(16)); ++ pdesc->Dword6 &= set_desc(~BIT(17)); ++ pdesc->Dword6 &= set_desc(~BIT(18)); ++ ++ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_a[aid]<<16); ++ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_b[aid]<<17); ++ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_c[aid]<<18); ++ ++ } ++} ++ ++ ++#if 1 /*def CONFIG_WLAN_HAL*/ ++VOID ++ODM_SetTxAntByTxInfo_HAL( ++ struct rtl8192cd_priv *priv, ++ PVOID pdesc_data, ++ u2Byte aid ++) ++{ ++ PDM_ODM_T pDM_Odm = &(priv->pshare->_dmODM); ++ pFAT_T pDM_FatTable = &priv->pshare->_dmODM.DM_FatTable; ++ u4Byte SupportICType = priv->pshare->_dmODM.SupportICType; ++ PTX_DESC_DATA_88XX pdescdata = (PTX_DESC_DATA_88XX)pdesc_data; ++ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) ++ return; ++ ++ if (pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) ++ return; ++ ++ if (SupportICType == ODM_RTL8881A || SupportICType == ODM_RTL8192E || SupportICType == ODM_RTL8814A) { ++ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_HAL******\n",__FUNCTION__,__LINE__);*/ ++ pdescdata->antSel = 1; ++ pdescdata->antSel_A = pDM_FatTable->antsel_a[aid]; ++ } ++} ++#endif /*#ifdef CONFIG_WLAN_HAL*/ ++ ++#endif ++ ++ ++VOID ++ODM_AntDiv_Config( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ ODM_RT_TRACE (pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("WIN Config Antenna Diversity\n")); ++ /* ++ if(pDM_Odm->SupportICType==ODM_RTL8723B) ++ { ++ if((!pDM_Odm->DM_SWAT_Table.ANTA_ON || !pDM_Odm->DM_SWAT_Table.ANTB_ON)) ++ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); ++ } ++ */ ++ if (pDM_Odm->SupportICType == ODM_RTL8723D) { ++ ++ pDM_Odm->AntDivType = S0S1_TRX_HW_ANTDIV; ++ /**/ ++ } ++#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CE Config Antenna Diversity\n")); ++ ++ if(pDM_Odm->SupportICType==ODM_RTL8723B) ++ { ++ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; ++ ++ ++ } ++ ++#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("AP Config Antenna Diversity\n")); ++ ++ //2 [ NOT_SUPPORT_ANTDIV ] ++ #if(defined(CONFIG_NOT_SUPPORT_ANTDIV)) ++ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Disable AntDiv function] : Not Support 2.4G & 5G Antenna Diversity\n")); ++ ++ //2 [ 2G&5G_SUPPORT_ANTDIV ] ++ #elif(defined(CONFIG_2G5G_SUPPORT_ANTDIV)) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : 2.4G & 5G Support Antenna Diversity Simultaneously \n")); ++ pDM_FatTable->AntDiv_2G_5G = (ODM_ANTDIV_2G|ODM_ANTDIV_5G); ++ ++ if(pDM_Odm->SupportICType & ODM_ANTDIV_SUPPORT) ++ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; ++ if(*pDM_Odm->pBandType == ODM_BAND_5G ) ++ { ++ #if ( defined(CONFIG_5G_CGCS_RX_DIVERSITY) ) ++ pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); ++ panic_printk("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n"); ++ #elif( defined(CONFIG_5G_CG_TRX_DIVERSITY)||defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A)) ++ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); ++ panic_printk("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n"); ++ #elif( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ++ pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_SMART_ANTDIV\n")); ++ #elif( defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY) ) ++ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = S0S1_SW_ANTDIV\n")); ++ #endif ++ } ++ else if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) ++ { ++ #if ( defined(CONFIG_2G_CGCS_RX_DIVERSITY) ) ++ pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); ++ #elif( defined(CONFIG_2G_CG_TRX_DIVERSITY) || defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A)) ++ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); ++ #elif( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) ++ pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_SMART_ANTDIV\n")); ++ #elif( defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY) ) ++ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = S0S1_SW_ANTDIV\n")); ++ #endif ++ } ++ ++ //2 [ 5G_SUPPORT_ANTDIV ] ++ #elif(defined(CONFIG_5G_SUPPORT_ANTDIV)) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : Only 5G Support Antenna Diversity\n")); ++ panic_printk("[ Enable AntDiv function] : Only 5G Support Antenna Diversity\n"); ++ pDM_FatTable->AntDiv_2G_5G = (ODM_ANTDIV_5G); ++ if(*pDM_Odm->pBandType == ODM_BAND_5G ) ++ { ++ if(pDM_Odm->SupportICType & ODM_ANTDIV_5G_SUPPORT_IC) ++ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; ++ #if ( defined(CONFIG_5G_CGCS_RX_DIVERSITY) ) ++ pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); ++ panic_printk("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n"); ++ #elif( defined(CONFIG_5G_CG_TRX_DIVERSITY) ) ++ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; ++ panic_printk("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n"); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); ++ #elif( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ++ pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_SMART_ANTDIV\n")); ++ #elif( defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY) ) ++ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = S0S1_SW_ANTDIV\n")); ++ #endif ++ } ++ else if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Not Support 2G AntDivType\n")); ++ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); ++ } ++ ++ //2 [ 2G_SUPPORT_ANTDIV ] ++ #elif(defined(CONFIG_2G_SUPPORT_ANTDIV)) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : Only 2.4G Support Antenna Diversity\n")); ++ pDM_FatTable->AntDiv_2G_5G = (ODM_ANTDIV_2G); ++ if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) ++ { ++ if(pDM_Odm->SupportICType & ODM_ANTDIV_2G_SUPPORT_IC) ++ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; ++ #if ( defined(CONFIG_2G_CGCS_RX_DIVERSITY) ) ++ pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); ++ #elif( defined(CONFIG_2G_CG_TRX_DIVERSITY) ) ++ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); ++ #elif( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) ++ pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_SMART_ANTDIV\n")); ++ #elif( defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY) ) ++ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = S0S1_SW_ANTDIV\n")); ++ #endif ++ } ++ else if(*pDM_Odm->pBandType == ODM_BAND_5G ) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Not Support 5G AntDivType\n")); ++ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); ++ } ++ #endif ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[AntDiv Config Info] AntDiv_SupportAbility = (( %x ))\n", ((pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) ? 1 : 0))); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[AntDiv Config Info] be_fix_tx_ant = ((%d))\n", pDM_Odm->DM_FatTable.b_fix_tx_ant)); ++ ++} ++ ++ ++VOID ++ODM_AntDivTimers( ++ IN PVOID pDM_VOID, ++ IN u1Byte state ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ if(state==INIT_ANTDIV_TIMMER) ++ { ++ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ ODM_InitializeTimer(pDM_Odm, &(pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchTimer), ++ (RT_TIMER_CALL_BACK)ODM_SW_AntDiv_Callback, NULL, "phydm_SwAntennaSwitchTimer"); ++ #elif ( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) ++ ODM_InitializeTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer, ++ (RT_TIMER_CALL_BACK)odm_FastAntTrainingCallback, NULL, "FastAntTrainingTimer"); ++ #endif ++ ++ #ifdef ODM_EVM_ENHANCE_ANTDIV ++ ODM_InitializeTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer, ++ (RT_TIMER_CALL_BACK)odm_EVM_FastAntTrainingCallback, NULL, "EVM_FastAntTrainingTimer"); ++ #endif ++ } ++ else if(state==CANCEL_ANTDIV_TIMMER) ++ { ++ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ ODM_CancelTimer(pDM_Odm, &(pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchTimer)); ++ #elif ( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) ++ ODM_CancelTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer); ++ #endif ++ ++ #ifdef ODM_EVM_ENHANCE_ANTDIV ++ ODM_CancelTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer); ++ #endif ++ } ++ else if(state==RELEASE_ANTDIV_TIMMER) ++ { ++ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ ODM_ReleaseTimer(pDM_Odm, &(pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchTimer)); ++ #elif ( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) ++ ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer); ++ #endif ++ ++ #ifdef ODM_EVM_ENHANCE_ANTDIV ++ ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer); ++ #endif ++ } ++ ++} ++ ++VOID ++phydm_antdiv_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ /*pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable;*/ ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ if (dm_value[0] == 1) { /*fixed or auto antenna*/ ++ ++ if (dm_value[1] == 0) { ++ pDM_Odm->antdiv_select = 0; ++ PHYDM_SNPRINTF((output+used, out_len-used, "AntDiv: Auto\n")); ++ } else if (dm_value[1] == 1) { ++ pDM_Odm->antdiv_select = 1; ++ PHYDM_SNPRINTF((output+used, out_len-used, "AntDiv: Fix MAin\n")); ++ } else if (dm_value[1] == 2) { ++ pDM_Odm->antdiv_select = 2; ++ PHYDM_SNPRINTF((output+used, out_len-used, "AntDiv: Fix Aux\n")); ++ } ++ } else if (dm_value[0] == 2) { /*dynamic period for AntDiv*/ ++ ++ pDM_Odm->antdiv_period = (u1Byte)dm_value[1]; ++ PHYDM_SNPRINTF((output+used, out_len-used, "AntDiv_period = ((%d))\n", pDM_Odm->antdiv_period)); ++ } ++} ++ ++#endif /*#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY))*/ ++ ++VOID ++ODM_AntDivReset( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) ++ { ++ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ odm_S0S1_SWAntDiv_Reset(pDM_Odm); ++ #endif ++ } ++ ++} ++ ++VOID ++odm_AntennaDiversityInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ #if 0 ++ if(pDM_Odm->mp_mode == TRUE) ++ return; ++ #endif ++ ++ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++ ODM_AntDiv_Config(pDM_Odm); ++ ODM_AntDivInit(pDM_Odm); ++ #endif ++} ++ ++VOID ++odm_AntennaDiversity( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ if(pDM_Odm->mp_mode == TRUE) ++ return; ++ ++ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++ ODM_AntDiv(pDM_Odm); ++ #endif ++} ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.h 2018-02-11 21:44:27.155146208 +0200 +@@ -0,0 +1,634 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMANTDIV_H__ ++#define __PHYDMANTDIV_H__ ++ ++/*#define ANTDIV_VERSION "2.0" //2014.11.04*/ ++/*#define ANTDIV_VERSION "2.1" //2015.01.13 Dino*/ ++/*#define ANTDIV_VERSION "2.2" 2015.01.16 Dino*/ ++/*#define ANTDIV_VERSION "3.1" 2015.07.29 YuChen, remove 92c 92d 8723a*/ ++/*#define ANTDIV_VERSION "3.2" 2015.08.11 Stanley, disable antenna diversity when BT is enable for 8723B*/ ++/*#define ANTDIV_VERSION "3.3" 2015.08.12 Stanley. 8723B does not need to check the antenna is control by BT, ++ because antenna diversity only works when BT is disable or radio off*/ ++/*#define ANTDIV_VERSION "3.4" 2015.08.28 Dino 1.Add 8821A Smart Antenna 2. Add 8188F SW S0S1 Antenna Diversity*/ ++/*#define ANTDIV_VERSION "3.5" 2015.10.07 Stanley Always check antenna detection result from BT-coex. for 8723B, not from PHYDM*/ ++/*#define ANTDIV_VERSION "3.6"*/ /*2015.11.16 Stanley */ ++/*#define ANTDIV_VERSION "3.7"*/ /*2015.11.20 Dino Add SmartAnt FAT Patch */ ++/*#define ANTDIV_VERSION "3.8" 2015.12.21 Dino, Add SmartAnt dynamic training packet num */ ++#define ANTDIV_VERSION "3.9" /*2016.01.05 Dino, Add SmartAnt cmd for converting single & two smtant, and add cmd for adjust truth table */ ++ ++//1 ============================================================ ++//1 Definition ++//1 ============================================================ ++ ++#define ANTDIV_INIT 0xff ++#define MAIN_ANT 1 /*Ant A or Ant Main or S1*/ ++#define AUX_ANT 2 /*AntB or Ant Aux or S0*/ ++#define MAX_ANT 3 /* 3 for AP using*/ ++ ++#define ANT1_2G 0 /* = ANT2_5G for 8723D BTG S1 RX S0S1 diversity for 8723D, TX fixed at S1 */ ++#define ANT2_2G 1 /* = ANT1_5G for 8723D BTG S0 RX S0S1 diversity for 8723D, TX fixed at S1 */ ++/*smart antenna*/ ++#define SUPPORT_RF_PATH_NUM 4 ++#define SUPPORT_BEAM_PATTERN_NUM 4 ++#define NUM_ANTENNA_8821A 2 ++ ++#define NO_FIX_TX_ANT 0 ++#define FIX_TX_AT_MAIN 1 ++#define FIX_AUX_AT_MAIN 2 ++ ++//Antenna Diversty Control Type ++#define ODM_AUTO_ANT 0 ++#define ODM_FIX_MAIN_ANT 1 ++#define ODM_FIX_AUX_ANT 2 ++ ++#define ODM_N_ANTDIV_SUPPORT (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8188F|ODM_RTL8723D|ODM_RTL8195A) ++#define ODM_AC_ANTDIV_SUPPORT (ODM_RTL8821|ODM_RTL8881A|ODM_RTL8812|ODM_RTL8821C) ++#define ODM_ANTDIV_SUPPORT (ODM_N_ANTDIV_SUPPORT|ODM_AC_ANTDIV_SUPPORT) ++#define ODM_SMART_ANT_SUPPORT (ODM_RTL8188E|ODM_RTL8192E) ++#define ODM_HL_SMART_ANT_TYPE1_SUPPORT (ODM_RTL8821) ++ ++#define ODM_ANTDIV_2G_SUPPORT_IC (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8881A|ODM_RTL8188F|ODM_RTL8723D) ++#define ODM_ANTDIV_5G_SUPPORT_IC (ODM_RTL8821|ODM_RTL8881A|ODM_RTL8812|ODM_RTL8821C) ++ ++#define ODM_EVM_ENHANCE_ANTDIV_SUPPORT_IC (ODM_RTL8192E) ++ ++#define ODM_ANTDIV_2G BIT0 ++#define ODM_ANTDIV_5G BIT1 ++ ++#define ANTDIV_ON 1 ++#define ANTDIV_OFF 0 ++ ++#define FAT_ON 1 ++#define FAT_OFF 0 ++ ++#define TX_BY_DESC 1 ++#define TX_BY_REG 0 ++ ++#define RSSI_METHOD 0 ++#define EVM_METHOD 1 ++#define CRC32_METHOD 2 ++ ++#define INIT_ANTDIV_TIMMER 0 ++#define CANCEL_ANTDIV_TIMMER 1 ++#define RELEASE_ANTDIV_TIMMER 2 ++ ++#define CRC32_FAIL 1 ++#define CRC32_OK 0 ++ ++#define Evm_RSSI_TH_High 25 ++#define Evm_RSSI_TH_Low 20 ++ ++#define NORMAL_STATE_MIAN 1 ++#define NORMAL_STATE_AUX 2 ++#define TRAINING_STATE 3 ++ ++#define FORCE_RSSI_DIFF 10 ++ ++#define CSI_ON 1 ++#define CSI_OFF 0 ++ ++#define DIVON_CSIOFF 1 ++#define DIVOFF_CSION 2 ++ ++#define BDC_DIV_TRAIN_STATE 0 ++#define BDC_BFer_TRAIN_STATE 1 ++#define BDC_DECISION_STATE 2 ++#define BDC_BF_HOLD_STATE 3 ++#define BDC_DIV_HOLD_STATE 4 ++ ++#define BDC_MODE_1 1 ++#define BDC_MODE_2 2 ++#define BDC_MODE_3 3 ++#define BDC_MODE_4 4 ++#define BDC_MODE_NULL 0xff ++ ++/*SW S0S1 antenna diversity*/ ++#define SWAW_STEP_INIT 0xff ++#define SWAW_STEP_PEEK 0 ++#define SWAW_STEP_DETERMINE 1 ++ ++#define RSSI_CHECK_RESET_PERIOD 10 ++#define RSSI_CHECK_THRESHOLD 50 ++ ++/*Hong Lin Smart antenna*/ ++#define HL_SMTANT_2WIRE_DATA_LEN 24 ++ ++//1 ============================================================ ++//1 structure ++//1 ============================================================ ++ ++ ++typedef struct _SW_Antenna_Switch_ ++{ ++ u1Byte Double_chk_flag; /*If current antenna RSSI > "RSSI_CHECK_THRESHOLD", than check this antenna again*/ ++ u1Byte try_flag; ++ s4Byte PreRSSI; ++ u1Byte CurAntenna; ++ u1Byte PreAntenna; ++ u1Byte RSSI_Trying; ++ u1Byte reset_idx; ++ u1Byte Train_time; ++ u1Byte Train_time_flag; /*base on RSSI difference between two antennas*/ ++ RT_TIMER phydm_SwAntennaSwitchTimer; ++ u4Byte PktCnt_SWAntDivByCtrlFrame; ++ BOOLEAN bSWAntDivByCtrlFrame; ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #if USE_WORKITEM ++ RT_WORK_ITEM phydm_SwAntennaSwitchWorkitem; ++ #endif ++ #endif ++ ++ /* AntDect (Before link Antenna Switch check) need to be moved*/ ++ u2Byte Single_Ant_Counter; ++ u2Byte Dual_Ant_Counter; ++ u2Byte Aux_FailDetec_Counter; ++ u2Byte Retry_Counter; ++ u1Byte SWAS_NoLink_State; ++ u4Byte SWAS_NoLink_BK_Reg948; ++ BOOLEAN ANTA_ON; /*To indicate Ant A is or not*/ ++ BOOLEAN ANTB_ON; /*To indicate Ant B is on or not*/ ++ BOOLEAN Pre_Aux_FailDetec; ++ BOOLEAN RSSI_AntDect_bResult; ++ u1Byte Ant5G; ++ u1Byte Ant2G; ++ ++ ++}SWAT_T, *pSWAT_T; ++ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++typedef struct _BF_DIV_COEX_ ++{ ++ BOOLEAN w_BFer_Client[ODM_ASSOCIATE_ENTRY_NUM]; ++ BOOLEAN w_BFee_Client[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte MA_rx_TP[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte MA_rx_TP_DIV[ODM_ASSOCIATE_ENTRY_NUM]; ++ ++ u1Byte BDCcoexType_wBfer; ++ u1Byte num_Txbfee_Client; ++ u1Byte num_Txbfer_Client; ++ u1Byte BDC_Try_counter; ++ u1Byte BDC_Hold_counter; ++ u1Byte BDC_Mode; ++ u1Byte BDC_active_Mode; ++ u1Byte BDC_state; ++ u1Byte BDC_RxIdleUpdate_counter; ++ u1Byte num_Client; ++ u1Byte pre_num_Client; ++ u1Byte num_BfTar; ++ u1Byte num_DivTar; ++ ++ BOOLEAN bAll_DivSta_Idle; ++ BOOLEAN bAll_BFSta_Idle; ++ BOOLEAN BDC_Try_flag; ++ BOOLEAN BF_pass; ++ BOOLEAN DIV_pass; ++}BDC_T,*pBDC_T; ++#endif ++#endif ++ ++#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 ++typedef struct _SMART_ANTENNA_TRAINNING_ { ++ u4Byte latch_time; ++ BOOLEAN pkt_skip_statistic_en; ++ u4Byte fix_beam_pattern_en; ++ u4Byte fix_training_num_en; ++ u4Byte fix_beam_pattern_codeword; ++ u4Byte update_beam_codeword; ++ u4Byte ant_num; /*number of used smart beam antenna*/ ++ u4Byte ant_num_total;/*number of total smart beam antenna*/ ++ u4Byte first_train_ant; /*decide witch antenna to train first*/ ++ u4Byte rfu_codeword_table[4]; /*2G beam truth table*/ ++ u4Byte rfu_codeword_table_5g[4]; /*5G beam truth table*/ ++ u4Byte beam_patten_num_each_ant;/*number of beam can be switched in each antenna*/ ++ u4Byte data_codeword_bit_num; ++ u1Byte per_beam_training_pkt_num; ++ u1Byte decision_holding_period; ++ u1Byte pkt_counter; ++ u4Byte fast_training_beam_num; ++ u4Byte pre_fast_training_beam_num; ++ u4Byte pkt_rssi_pre[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; ++ u1Byte beam_train_cnt[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; ++ u1Byte beam_train_rssi_diff[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; ++ u4Byte pkt_rssi_sum[8][SUPPORT_BEAM_PATTERN_NUM]; ++ u4Byte pkt_rssi_cnt[8][SUPPORT_BEAM_PATTERN_NUM]; ++ u4Byte rx_idle_beam[SUPPORT_RF_PATH_NUM]; ++ u4Byte pre_codeword; ++ BOOLEAN force_update_beam_en; ++ u4Byte beacon_counter; ++ u4Byte pre_beacon_counter; ++ u1Byte update_beam_idx; ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ RT_WORK_ITEM hl_smart_antenna_workitem; ++ RT_WORK_ITEM hl_smart_antenna_decision_workitem; ++ #endif ++ ++} SAT_T, *pSAT_T; ++#endif ++ ++typedef struct _FAST_ANTENNA_TRAINNING_ ++{ ++ u1Byte Bssid[6]; ++ u1Byte antsel_rx_keep_0; ++ u1Byte antsel_rx_keep_1; ++ u1Byte antsel_rx_keep_2; ++ u1Byte antsel_rx_keep_3; ++ u4Byte antSumRSSI[7]; ++ u4Byte antRSSIcnt[7]; ++ u4Byte antAveRSSI[7]; ++ u1Byte FAT_State; ++ u4Byte TrainIdx; ++ u1Byte antsel_a[ODM_ASSOCIATE_ENTRY_NUM]; ++ u1Byte antsel_b[ODM_ASSOCIATE_ENTRY_NUM]; ++ u1Byte antsel_c[ODM_ASSOCIATE_ENTRY_NUM]; ++ u2Byte MainAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; ++ u2Byte AuxAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; ++ u2Byte MainAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; ++ u2Byte AuxAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; ++ u2Byte MainAnt_Sum_cck[ODM_ASSOCIATE_ENTRY_NUM]; ++ u2Byte AuxAnt_Sum_cck[ODM_ASSOCIATE_ENTRY_NUM]; ++ u2Byte MainAnt_Cnt_cck[ODM_ASSOCIATE_ENTRY_NUM]; ++ u2Byte AuxAnt_Cnt_cck[ODM_ASSOCIATE_ENTRY_NUM]; ++ u1Byte RxIdleAnt; ++ u1Byte AntDiv_OnOff; ++ BOOLEAN bBecomeLinked; ++ u4Byte MinMaxRSSI; ++ u1Byte idx_AntDiv_counter_2G; ++ u1Byte idx_AntDiv_counter_5G; ++ u1Byte AntDiv_2G_5G; ++ u4Byte CCK_counter_main; ++ u4Byte CCK_counter_aux; ++ u4Byte OFDM_counter_main; ++ u4Byte OFDM_counter_aux; ++ ++ #ifdef ODM_EVM_ENHANCE_ANTDIV ++ u4Byte MainAntEVM_Sum[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte AuxAntEVM_Sum[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte MainAntEVM_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte AuxAntEVM_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; ++ BOOLEAN EVM_method_enable; ++ u1Byte TargetAnt_EVM; ++ u1Byte TargetAnt_CRC32; ++ u1Byte TargetAnt_enhance; ++ u1Byte pre_TargetAnt_enhance; ++ u2Byte Main_MPDU_OK_cnt; ++ u2Byte Aux_MPDU_OK_cnt; ++ ++ u4Byte CRC32_Ok_Cnt; ++ u4Byte CRC32_Fail_Cnt; ++ u4Byte MainCRC32_Ok_Cnt; ++ u4Byte AuxCRC32_Ok_Cnt; ++ u4Byte MainCRC32_Fail_Cnt; ++ u4Byte AuxCRC32_Fail_Cnt; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ u4Byte CCK_CtrlFrame_Cnt_main; ++ u4Byte CCK_CtrlFrame_Cnt_aux; ++ u4Byte OFDM_CtrlFrame_Cnt_main; ++ u4Byte OFDM_CtrlFrame_Cnt_aux; ++ u4Byte MainAnt_CtrlFrame_Sum; ++ u4Byte AuxAnt_CtrlFrame_Sum; ++ u4Byte MainAnt_CtrlFrame_Cnt; ++ u4Byte AuxAnt_CtrlFrame_Cnt; ++ #endif ++ u1Byte b_fix_tx_ant; ++ BOOLEAN fix_ant_bfee; ++ BOOLEAN enable_ctrl_frame_antdiv; ++ BOOLEAN use_ctrl_frame_antdiv; ++ u1Byte hw_antsw_occur; ++ u1Byte *pForceTxAntByDesc; ++ u1Byte ForceTxAntByDesc; /*A temp value, will hook to driver team's outer parameter later*/ ++ u1Byte *pDefaultS0S1; ++ u1Byte DefaultS0S1; ++}FAT_T,*pFAT_T; ++ ++ ++//1 ============================================================ ++//1 enumeration ++//1 ============================================================ ++ ++ ++ ++typedef enum _FAT_STATE /*Fast antenna training*/ ++{ ++ FAT_BEFORE_LINK_STATE = 0, ++ FAT_PREPARE_STATE = 1, ++ FAT_TRAINING_STATE = 2, ++ FAT_DECISION_STATE = 3 ++}FAT_STATE_E, *PFAT_STATE_E; ++ ++typedef enum _ANT_DIV_TYPE ++{ ++ NO_ANTDIV = 0xFF, ++ CG_TRX_HW_ANTDIV = 0x01, ++ CGCS_RX_HW_ANTDIV = 0x02, ++ FIXED_HW_ANTDIV = 0x03, ++ CG_TRX_SMART_ANTDIV = 0x04, ++ CGCS_RX_SW_ANTDIV = 0x05, ++ S0S1_SW_ANTDIV = 0x06, /*8723B intrnal switch S0 S1*/ ++ S0S1_TRX_HW_ANTDIV = 0x07, /*TRX S0S1 diversity for 8723D*/ ++ HL_SW_SMART_ANT_TYPE1 = 0x10 /*Hong-Lin Smart antenna use for 8821AE which is a 2 Ant. entitys, and each Ant. is equipped with 4 antenna patterns*/ ++}ANT_DIV_TYPE_E, *PANT_DIV_TYPE_E; ++ ++ ++//1 ============================================================ ++//1 function prototype ++//1 ============================================================ ++ ++ ++VOID ++ODM_StopAntennaSwitchDm( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++phydm_enable_antenna_diversity( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++ODM_SetAntConfig( ++ IN PVOID pDM_VOID, ++ IN u1Byte antSetting // 0=A, 1=B, 2=C, .... ++ ); ++ ++ ++#define SwAntDivRestAfterLink ODM_SwAntDivRestAfterLink ++ ++VOID ODM_SwAntDivRestAfterLink( ++ IN PVOID pDM_VOID ++ ); ++ ++#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++ ++VOID ++ODM_UpdateRxIdleAnt( ++ IN PVOID pDM_VOID, ++ IN u1Byte Ant ++); ++ ++#if (RTL8723B_SUPPORT == 1) ++VOID ++ODM_UpdateRxIdleAnt_8723B( ++ IN PVOID pDM_VOID, ++ IN u1Byte Ant, ++ IN u4Byte DefaultAnt, ++ IN u4Byte OptionalAnt ++); ++#endif ++ ++#if (RTL8188F_SUPPORT == 1) ++VOID ++phydm_update_rx_idle_antenna_8188F( ++ IN PVOID pDM_VOID, ++ IN u4Byte default_ant ++); ++#endif ++ ++#if (RTL8723D_SUPPORT == 1) ++ ++VOID ++phydm_set_tx_ant_pwr_8723d( ++ IN PVOID pDM_VOID, ++ IN u1Byte Ant ++); ++ ++#endif ++ ++#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++ODM_SW_AntDiv_Callback( ++ IN PRT_TIMER pTimer ++ ); ++ ++VOID ++ODM_SW_AntDiv_WorkitemCallback( ++ IN PVOID pContext ++ ); ++ ++ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ ++VOID ++ODM_SW_AntDiv_WorkitemCallback( ++ IN PVOID pContext ++); ++ ++VOID ++ODM_SW_AntDiv_Callback( ++ void *FunctionContext ++ ); ++ ++#endif ++ ++VOID ++odm_S0S1_SwAntDivByCtrlFrame( ++ IN PVOID pDM_VOID, ++ IN u1Byte Step ++); ++ ++VOID ++odm_AntselStatisticsOfCtrlFrame( ++ IN PVOID pDM_VOID, ++ IN u1Byte antsel_tr_mux, ++ IN u4Byte RxPWDBAll ++); ++ ++VOID ++odm_S0S1_SwAntDivByCtrlFrame_ProcessRSSI( ++ IN PVOID pDM_VOID, ++ IN PVOID p_phy_info_void, ++ IN PVOID p_pkt_info_void ++); ++ ++#endif ++ ++#ifdef ODM_EVM_ENHANCE_ANTDIV ++VOID ++odm_EVM_FastAntTrainingCallback( ++ IN PVOID pDM_VOID ++); ++#endif ++ ++VOID ++odm_HW_AntDiv( ++ IN PVOID pDM_VOID ++); ++ ++#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) ++VOID ++odm_FastAntTraining( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++odm_FastAntTrainingCallback( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++odm_FastAntTrainingWorkItemCallback( ++ IN PVOID pDM_VOID ++); ++#endif ++ ++ ++#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++phydm_beam_switch_workitem_callback( ++ IN PVOID pContext ++ ); ++ ++VOID ++phydm_beam_decision_workitem_callback( ++ IN PVOID pContext ++ ); ++ ++#endif ++ ++VOID ++phydm_update_beam_pattern( ++ IN PVOID pDM_VOID, ++ IN u4Byte codeword, ++ IN u4Byte codeword_length ++ ); ++ ++void ++phydm_set_all_ant_same_beam_num( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++phydm_hl_smart_ant_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++); ++ ++#endif/*#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1*/ ++ ++VOID ++ODM_AntDivInit( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++ODM_AntDiv( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++odm_AntselStatistics( ++ IN PVOID pDM_VOID, ++ IN u1Byte antsel_tr_mux, ++ IN u4Byte MacId, ++ IN u4Byte utility, ++ IN u1Byte method, ++ IN u1Byte isCCKrate ++); ++ ++VOID ++ODM_Process_RSSIForAntDiv( ++ IN OUT PVOID pDM_VOID, ++ IN PVOID p_phy_info_void, ++ IN PVOID p_pkt_info_void ++); ++ ++ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++VOID ++ODM_SetTxAntByTxInfo( ++ IN PVOID pDM_VOID, ++ IN pu1Byte pDesc, ++ IN u1Byte macId ++); ++ ++#elif(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++struct tx_desc; /*declared tx_desc here or compile error happened when enabled 8822B*/ ++ ++VOID ++ODM_SetTxAntByTxInfo( ++ struct rtl8192cd_priv *priv, ++ struct tx_desc *pdesc, ++ unsigned short aid ++); ++ ++#if 1/*def def CONFIG_WLAN_HAL*/ ++VOID ++ODM_SetTxAntByTxInfo_HAL( ++ struct rtl8192cd_priv *priv, ++ PVOID pdesc_data, ++ u2Byte aid ++); ++#endif /*#ifdef CONFIG_WLAN_HAL*/ ++#endif ++ ++ ++VOID ++ODM_AntDiv_Config( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++ODM_AntDivTimers( ++ IN PVOID pDM_VOID, ++ IN u1Byte state ++); ++ ++VOID ++phydm_antdiv_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++); ++ ++#endif /*#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY))*/ ++ ++VOID ++ODM_AntDivReset( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++odm_AntennaDiversityInit( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++odm_AntennaDiversity( ++ IN PVOID pDM_VOID ++); ++ ++#endif /*#ifndef __ODMANTDIV_H__*/ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.c 2018-02-11 21:44:27.155146208 +0200 +@@ -0,0 +1,1882 @@ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++#if WPP_SOFTWARE_TRACE ++#include "phydm_beamforming.tmh" ++#endif ++#endif ++ ++#if (BEAMFORMING_SUPPORT == 1) ++ ++PRT_BEAMFORM_STAINFO ++phydm_staInfoInit( ++ IN PDM_ODM_T pDM_Odm, ++ IN u2Byte staIdx ++ ) ++{ ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORM_STAINFO pEntry = &(pBeamInfo->BeamformSTAinfo); ++ PSTA_INFO_T pSTA = pDM_Odm->pODM_StaInfo[staIdx]; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ PRT_HIGH_THROUGHPUT pHTInfo = GET_HT_INFO(pMgntInfo); ++ PRT_VERY_HIGH_THROUGHPUT pVHTInfo = GET_VHT_INFO(pMgntInfo); ++ ++ ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, Adapter->CurrentAddress, 6); ++ ++ pEntry->HtBeamformCap = pHTInfo->HtBeamformCap; ++ pEntry->VhtBeamformCap = pVHTInfo->VhtBeamformCap; ++ ++ /*IBSS, AP mode*/ ++ if (staIdx != 0) { ++ pEntry->AID = pSTA->AID; ++ pEntry->RA = pSTA->MacAddr; ++ pEntry->MacID = pSTA->AssociatedMacId; ++ pEntry->WirelessMode = pSTA->WirelessMode; ++ pEntry->BW = pSTA->BandWidth; ++ pEntry->CurBeamform = pSTA->HTInfo.HtCurBeamform; ++ } else {/*client mode*/ ++ pEntry->AID = pMgntInfo->mAId; ++ pEntry->RA = pMgntInfo->Bssid; ++ pEntry->MacID = pMgntInfo->mMacId; ++ pEntry->WirelessMode = pMgntInfo->dot11CurrentWirelessMode; ++ pEntry->BW = pMgntInfo->dot11CurrentChannelBandWidth; ++ pEntry->CurBeamform = pHTInfo->HtCurBeamform; ++ } ++ ++ if ((pEntry->WirelessMode & WIRELESS_MODE_AC_5G) || (pEntry->WirelessMode & WIRELESS_MODE_AC_24G)) { ++ if (staIdx != 0) ++ pEntry->CurBeamformVHT = pSTA->VHTInfo.VhtCurBeamform; ++ else ++ pEntry->CurBeamformVHT = pVHTInfo->VhtCurBeamform; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("pSTA->wireless_mode = 0x%x, staidx = %d\n", pSTA->WirelessMode, staIdx)); ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ ++ if (!IS_STA_VALID(pSTA)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s => sta_info(mac_id:%d) failed\n", __func__, staIdx)); ++ rtw_warn_on(1); ++ return pEntry; ++ } ++ ++ ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, adapter_mac_addr(pSTA->padapter), 6); ++ pEntry->HtBeamformCap = pSTA->htpriv.beamform_cap; ++ ++ pEntry->AID = pSTA->aid; ++ pEntry->RA = pSTA->hwaddr; ++ pEntry->MacID = pSTA->mac_id; ++ pEntry->WirelessMode = pSTA->wireless_mode; ++ pEntry->BW = pSTA->bw_mode; ++ ++ pEntry->CurBeamform = pSTA->htpriv.beamform_cap; ++#if ODM_IC_11AC_SERIES_SUPPORT ++ if ((pEntry->WirelessMode & WIRELESS_MODE_AC_5G) || (pEntry->WirelessMode & WIRELESS_MODE_AC_24G)) { ++ pEntry->CurBeamformVHT = pSTA->vhtpriv.beamform_cap; ++ pEntry->VhtBeamformCap = pSTA->vhtpriv.beamform_cap; ++ } ++#endif ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("pSTA->wireless_mode = 0x%x, staidx = %d\n", pSTA->wireless_mode, staIdx)); ++#endif ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("pEntry->CurBeamform = 0x%x, pEntry->CurBeamformVHT = 0x%x\n", pEntry->CurBeamform, pEntry->CurBeamformVHT)); ++ return pEntry; ++ ++} ++void phydm_staInfoUpdate( ++ IN PDM_ODM_T pDM_Odm, ++ IN u2Byte staIdx, ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry ++ ) ++{ ++ PSTA_INFO_T pSTA = pDM_Odm->pODM_StaInfo[staIdx]; ++ ++ if (!IS_STA_VALID(pSTA)) ++ return; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ pSTA->txbf_paid = pBeamformEntry->P_AID; ++ pSTA->txbf_gid = pBeamformEntry->G_ID; ++#endif ++} ++ ++PRT_BEAMFORMEE_ENTRY ++phydm_Beamforming_GetBFeeEntryByAddr( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ OUT pu1Byte Idx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ ++ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { ++ if (pBeamInfo->BeamformeeEntry[i].bUsed && (eqMacAddr(RA, pBeamInfo->BeamformeeEntry[i].MacAddr))) { ++ *Idx = i; ++ return &(pBeamInfo->BeamformeeEntry[i]); ++ } ++ } ++ ++ return NULL; ++} ++ ++PRT_BEAMFORMER_ENTRY ++phydm_Beamforming_GetBFerEntryByAddr( ++ IN PVOID pDM_VOID, ++ IN pu1Byte TA, ++ OUT pu1Byte Idx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ ++ for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { ++ if (pBeamInfo->BeamformerEntry[i].bUsed && (eqMacAddr(TA, pBeamInfo->BeamformerEntry[i].MacAddr))) { ++ *Idx = i; ++ return &(pBeamInfo->BeamformerEntry[i]); ++ } ++ } ++ ++ return NULL; ++} ++ ++ ++PRT_BEAMFORMEE_ENTRY ++phydm_Beamforming_GetEntryByMacId( ++ IN PVOID pDM_VOID, ++ IN u1Byte MacId, ++ OUT pu1Byte Idx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ ++ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { ++ if (pBeamInfo->BeamformeeEntry[i].bUsed && (MacId == pBeamInfo->BeamformeeEntry[i].MacId)) { ++ *Idx = i; ++ return &(pBeamInfo->BeamformeeEntry[i]); ++ } ++ } ++ ++ return NULL; ++} ++ ++ ++BEAMFORMING_CAP ++phydm_Beamforming_GetEntryBeamCapByMacId( ++ IN PVOID pDM_VOID, ++ IN u1Byte MacId ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ BEAMFORMING_CAP BeamformEntryCap = BEAMFORMING_CAP_NONE; ++ ++ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { ++ if (pBeamInfo->BeamformeeEntry[i].bUsed && (MacId == pBeamInfo->BeamformeeEntry[i].MacId)) { ++ BeamformEntryCap = pBeamInfo->BeamformeeEntry[i].BeamformEntryCap; ++ i = BEAMFORMEE_ENTRY_NUM; ++ } ++ } ++ ++ return BeamformEntryCap; ++} ++ ++ ++PRT_BEAMFORMEE_ENTRY ++phydm_Beamforming_GetFreeBFeeEntry( ++ IN PVOID pDM_VOID, ++ OUT pu1Byte Idx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ ++ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { ++ if (pBeamInfo->BeamformeeEntry[i].bUsed == FALSE) { ++ *Idx = i; ++ return &(pBeamInfo->BeamformeeEntry[i]); ++ } ++ } ++ return NULL; ++} ++ ++PRT_BEAMFORMER_ENTRY ++phydm_Beamforming_GetFreeBFerEntry( ++ IN PVOID pDM_VOID, ++ OUT pu1Byte Idx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s ===>\n", __func__)); ++ ++ for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { ++ if (pBeamInfo->BeamformerEntry[i].bUsed == FALSE) { ++ *Idx = i; ++ return &(pBeamInfo->BeamformerEntry[i]); ++ } ++ } ++ return NULL; ++} ++ ++/* ++// Description: Get the first entry index of MU Beamformee. ++// ++// Return Value: Index of the first MU sta. ++// ++// 2015.05.25. Created by tynli. ++// ++*/ ++u1Byte ++phydm_Beamforming_GetFirstMUBFeeEntryIdx( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte idx = 0xFF; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ BOOLEAN bFound = FALSE; ++ ++ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { ++ if (pBeamInfo->BeamformeeEntry[idx].bUsed && pBeamInfo->BeamformeeEntry[idx].is_mu_sta) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] idx=%d!\n", __func__, idx)); ++ bFound = TRUE; ++ break; ++ } ++ } ++ ++ if (!bFound) ++ idx = 0xFF; ++ ++ return idx; ++} ++ ++ ++/*Add SU BFee and MU BFee*/ ++PRT_BEAMFORMEE_ENTRY ++Beamforming_AddBFeeEntry( ++ IN PVOID pDM_VOID, ++ IN PRT_BEAMFORM_STAINFO pSTA, ++ IN BEAMFORMING_CAP BeamformCap, ++ IN u1Byte NumofSoundingDim, ++ IN u1Byte CompSteeringNumofBFer, ++ OUT pu1Byte Idx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMEE_ENTRY pEntry = phydm_Beamforming_GetFreeBFeeEntry(pDM_Odm, Idx); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ++ if (pEntry != NULL) { ++ pEntry->bUsed = TRUE; ++ pEntry->AID = pSTA->AID; ++ pEntry->MacId = pSTA->MacID; ++ pEntry->SoundBW = pSTA->BW; ++ ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, pSTA->MyMacAddr, 6); ++ ++ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) { ++ /*BSSID[44:47] xor BSSID[40:43]*/ ++ u2Byte BSSID = ((pSTA->MyMacAddr[5] & 0xf0) >> 4) ^ (pSTA->MyMacAddr[5] & 0xf); ++ /*(dec(A) + dec(B)*32) mod 512*/ ++ pEntry->P_AID = (pSTA->AID + BSSID * 32) & 0x1ff; ++ pEntry->G_ID = 63; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID addressed to STA=%d\n", __func__, pEntry->P_AID)); ++ } else if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) { ++ /*ad hoc mode*/ ++ pEntry->P_AID = 0; ++ pEntry->G_ID = 63; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID as IBSS=%d\n", __func__, pEntry->P_AID)); ++ } else { ++ /*client mode*/ ++ pEntry->P_AID = pSTA->RA[5]; ++ /*BSSID[39:47]*/ ++ pEntry->P_AID = (pEntry->P_AID << 1) | (pSTA->RA[4] >> 7); ++ pEntry->G_ID = 0; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID addressed to AP=0x%X\n", __func__, pEntry->P_AID)); ++ } ++ cpMacAddr(pEntry->MacAddr, pSTA->RA); ++ pEntry->bTxBF = FALSE; ++ pEntry->bSound = FALSE; ++ pEntry->SoundPeriod = 400; ++ pEntry->BeamformEntryCap = BeamformCap; ++ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; ++ ++/* pEntry->LogSeq = 0xff; Move to Beamforming_AddBFerEntry*/ ++/* pEntry->LogRetryCnt = 0; Move to Beamforming_AddBFerEntry*/ ++/* pEntry->LogSuccessCnt = 0; Move to Beamforming_AddBFerEntry*/ ++ ++ pEntry->LogStatusFailCnt = 0; ++ ++ pEntry->NumofSoundingDim = NumofSoundingDim; ++ pEntry->CompSteeringNumofBFer = CompSteeringNumofBFer; ++ ++ if (BeamformCap & BEAMFORMER_CAP_VHT_MU) { ++ pDM_Odm->BeamformingInfo.beamformee_mu_cnt += 1; ++ pEntry->is_mu_sta = TRUE; ++ pDM_Odm->BeamformingInfo.FirstMUBFeeIndex = phydm_Beamforming_GetFirstMUBFeeEntryIdx(pDM_Odm); ++ } else if (BeamformCap & (BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) { ++ pDM_Odm->BeamformingInfo.beamformee_su_cnt += 1; ++ pEntry->is_mu_sta = FALSE; ++ } ++ ++ return pEntry; ++ } ++ else ++ return NULL; ++} ++ ++/*Add SU BFee and MU BFer*/ ++PRT_BEAMFORMER_ENTRY ++Beamforming_AddBFerEntry( ++ IN PVOID pDM_VOID, ++ IN PRT_BEAMFORM_STAINFO pSTA, ++ IN BEAMFORMING_CAP BeamformCap, ++ IN u1Byte NumofSoundingDim, ++ OUT pu1Byte Idx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMER_ENTRY pEntry = phydm_Beamforming_GetFreeBFerEntry(pDM_Odm, Idx); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ++ if (pEntry != NULL) { ++ pEntry->bUsed = TRUE; ++ ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, pSTA->MyMacAddr, 6); ++ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) { ++ /*BSSID[44:47] xor BSSID[40:43]*/ ++ u2Byte BSSID = ((pSTA->MyMacAddr[5] & 0xf0) >> 4) ^ (pSTA->MyMacAddr[5] & 0xf); ++ ++ pEntry->P_AID = (pSTA->AID + BSSID * 32) & 0x1ff; ++ pEntry->G_ID = 63; ++ /*(dec(A) + dec(B)*32) mod 512*/ ++ } else if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) { ++ pEntry->P_AID = 0; ++ pEntry->G_ID = 63; ++ } else { ++ pEntry->P_AID = pSTA->RA[5]; ++ /*BSSID[39:47]*/ ++ pEntry->P_AID = (pEntry->P_AID << 1) | (pSTA->RA[4] >> 7); ++ pEntry->G_ID = 0; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: P_AID addressed to AP=0x%X\n", __func__, pEntry->P_AID)); ++ } ++ ++ cpMacAddr(pEntry->MacAddr, pSTA->RA); ++ pEntry->BeamformEntryCap = BeamformCap; ++ ++ pEntry->PreLogSeq = 0; /*Modified by Jeffery @2015-04-13*/ ++ pEntry->LogSeq = 0; /*Modified by Jeffery @2014-10-29*/ ++ pEntry->LogRetryCnt = 0; /*Modified by Jeffery @2014-10-29*/ ++ pEntry->LogSuccess = 0; /*LogSuccess is NOT needed to be accumulated, so LogSuccessCnt->LogSuccess, 2015-04-13, Jeffery*/ ++ pEntry->ClockResetTimes = 0; /*Modified by Jeffery @2015-04-13*/ ++ ++ pEntry->NumofSoundingDim = NumofSoundingDim; ++ ++ if (BeamformCap & BEAMFORMEE_CAP_VHT_MU) { ++ pDM_Odm->BeamformingInfo.beamformer_mu_cnt += 1; ++ pEntry->is_mu_ap = TRUE; ++ pEntry->AID = pSTA->AID; ++ } else if (BeamformCap & (BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { ++ pDM_Odm->BeamformingInfo.beamformer_su_cnt += 1; ++ pEntry->is_mu_ap = FALSE; ++ } ++ ++ return pEntry; ++ } ++ else ++ return NULL; ++} ++ ++#if 0 ++BOOLEAN ++Beamforming_RemoveEntry( ++ IN PADAPTER Adapter, ++ IN pu1Byte RA, ++ OUT pu1Byte Idx ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ ++ PRT_BEAMFORMER_ENTRY pBFerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, RA, Idx); ++ PRT_BEAMFORMEE_ENTRY pEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, Idx); ++ BOOLEAN ret = FALSE; ++ ++ RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s Start!\n", __func__)); ++ RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s, pBFerEntry=0x%x\n", __func__, pBFerEntry)); ++ RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s, pEntry=0x%x\n", __func__, pEntry)); ++ ++ if (pEntry != NULL) { ++ pEntry->bUsed = FALSE; ++ pEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; ++ /*pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE;*/ ++ pEntry->bBeamformingInProgress = FALSE; ++ ret = TRUE; ++ } ++ if (pBFerEntry != NULL) { ++ pBFerEntry->bUsed = FALSE; ++ pBFerEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; ++ ret = TRUE; ++ } ++ return ret; ++ ++} ++#endif ++ ++/* Used for BeamformingStart_V1 */ ++VOID ++phydm_Beamforming_NDPARate( ++ IN PVOID pDM_VOID, ++ CHANNEL_WIDTH BW, ++ u1Byte Rate ++) ++{ ++ u2Byte NDPARate = Rate; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ++ if (NDPARate == 0) { ++ if(pDM_Odm->RSSI_Min > 30) // link RSSI > 30% ++ NDPARate = ODM_RATE24M; ++ else ++ NDPARate = ODM_RATE6M; ++ } ++ ++ if (NDPARate < ODM_RATEMCS0) ++ BW = (CHANNEL_WIDTH)ODM_BW20M; ++ ++ NDPARate = (NDPARate << 8) | BW; ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_RATE, (pu1Byte)&NDPARate); ++ ++} ++ ++ ++/* Used for BeamformingStart_SW and BeamformingStart_FW */ ++VOID ++phydm_Beamforming_DymNDPARate( ++ IN PVOID pDM_VOID ++) ++{ ++ u2Byte NDPARate = ODM_RATE6M, BW; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ++ if (pDM_Odm->RSSI_Min > 30) /*link RSSI > 30%*/ ++ NDPARate = ODM_RATE24M; ++ else ++ NDPARate = ODM_RATE6M; ++ ++ BW = ODM_BW20M; ++ NDPARate = NDPARate << 8 | BW; ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_RATE, (pu1Byte)&NDPARate); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, NDPA Rate = 0x%X\n", __func__, NDPARate)); ++} ++ ++/* ++* SW Sounding : SW Timer unit 1ms ++* HW Timer unit (1/32000) s 32k is clock. ++* FW Sounding : FW Timer unit 10ms ++*/ ++VOID ++Beamforming_DymPeriod( ++ IN PVOID pDM_VOID, ++ IN u8 status ++) ++{ ++ u1Byte Idx; ++ BOOLEAN bChangePeriod = FALSE; ++ u2Byte SoundPeriod_SW, SoundPeriod_FW; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); ++ ++ PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ //3 TODO per-client throughput caculation. ++ ++ if ((*(pDM_Odm->pCurrentTxTP) + *(pDM_Odm->pCurrentRxTP) > 2) && ((pEntry->LogStatusFailCnt <= 20) || status)) { ++ SoundPeriod_SW = 40; /* 40ms */ ++ SoundPeriod_FW = 40; /* From H2C cmd, unit = 10ms */ ++ } else { ++ SoundPeriod_SW = 4000;/* 4s */ ++ SoundPeriod_FW = 400; ++ } ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]SoundPeriod_SW=%d, SoundPeriod_FW=%d\n", __func__, SoundPeriod_SW, SoundPeriod_FW)); ++ ++ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { ++ pBeamformEntry = pBeamInfo->BeamformeeEntry+Idx; ++ ++ if (pBeamformEntry->DefaultCSICnt > 20) { ++ /*Modified by David*/ ++ SoundPeriod_SW = 4000; ++ SoundPeriod_FW = 400; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Period = %d\n", __func__, SoundPeriod_SW)); ++ if (pBeamformEntry->BeamformEntryCap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { ++ if (pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER) { ++ if (pBeamformEntry->SoundPeriod != SoundPeriod_FW) { ++ pBeamformEntry->SoundPeriod = SoundPeriod_FW; ++ bChangePeriod = TRUE; /*Only FW sounding need to send H2C packet to change sound period. */ ++ } ++ } else if (pBeamformEntry->SoundPeriod != SoundPeriod_SW) { ++ pBeamformEntry->SoundPeriod = SoundPeriod_SW; ++ } ++ } ++ } ++ ++ if (bChangePeriod) ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_FW_NDPA, (pu1Byte)&Idx); ++} ++ ++ ++ ++ ++BOOLEAN ++Beamforming_SendHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN CHANNEL_WIDTH BW, ++ IN u1Byte QIdx ++ ) ++{ ++ BOOLEAN ret = TRUE; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (QIdx == BEACON_QUEUE) ++ ret = SendFWHTNDPAPacket(pDM_Odm, RA, BW); ++ else ++ ret = SendSWHTNDPAPacket(pDM_Odm, RA, BW); ++ ++ return ret; ++} ++ ++ ++ ++BOOLEAN ++Beamforming_SendVHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN u2Byte AID, ++ IN CHANNEL_WIDTH BW, ++ IN u1Byte QIdx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ BOOLEAN ret = TRUE; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_GET_TX_RATE, NULL); ++ ++ if ((pDM_Odm->TxBfDataRate >= ODM_RATEVHTSS3MCS7) && (pDM_Odm->TxBfDataRate <= ODM_RATEVHTSS3MCS9) && (pBeamInfo->snding3SS == FALSE)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s: 3SS VHT 789 don't sounding\n", __func__)); ++ ++ } else { ++ if (QIdx == BEACON_QUEUE) /* Send to reserved page => FW NDPA */ ++ ret = SendFWVHTNDPAPacket(pDM_Odm, RA, AID, BW); ++ else { ++#ifdef SUPPORT_MU_BF ++ #if (SUPPORT_MU_BF == 1) ++ pBeamInfo->is_mu_sounding = TRUE; ++ ret = SendSWVHTMUNDPAPacket(pDM_Odm, BW); ++ #else ++ pBeamInfo->is_mu_sounding = FALSE; ++ ret = SendSWVHTNDPAPacket(pDM_Odm, RA, AID, BW); ++ #endif ++#else ++ pBeamInfo->is_mu_sounding = FALSE; ++ ret = SendSWVHTNDPAPacket(pDM_Odm, RA, AID, BW); ++#endif ++ } ++ } ++ return ret; ++} ++ ++ ++BEAMFORMING_NOTIFY_STATE ++phydm_beamfomring_bSounding( ++ IN PVOID pDM_VOID, ++ PRT_BEAMFORMING_INFO pBeamInfo, ++ pu1Byte Idx ++ ) ++{ ++ BEAMFORMING_NOTIFY_STATE bSounding = BEAMFORMING_NOTIFY_NONE; ++ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ++ /*if(( Beamforming_GetBeamCap(pBeamInfo) & BEAMFORMER_CAP) == 0)*/ ++ /*bSounding = BEAMFORMING_NOTIFY_RESET;*/ ++ if (BeamOidInfo.SoundOidMode == SOUNDING_STOP_All_TIMER) ++ bSounding = BEAMFORMING_NOTIFY_RESET; ++ else { ++ u1Byte i; ++ ++ for (i = 0 ; i < BEAMFORMEE_ENTRY_NUM ; i++) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s: BFee Entry %d bUsed=%d, bSound=%d\n", __func__, i, pBeamInfo->BeamformeeEntry[i].bUsed, pBeamInfo->BeamformeeEntry[i].bSound)); ++ if (pBeamInfo->BeamformeeEntry[i].bUsed && (!pBeamInfo->BeamformeeEntry[i].bSound)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Add BFee entry %d\n", __func__, i)); ++ *Idx = i; ++ if (pBeamInfo->BeamformeeEntry[i].is_mu_sta) ++ bSounding = BEAMFORMEE_NOTIFY_ADD_MU; ++ else ++ bSounding = BEAMFORMEE_NOTIFY_ADD_SU; ++ } ++ ++ if ((!pBeamInfo->BeamformeeEntry[i].bUsed) && pBeamInfo->BeamformeeEntry[i].bSound) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Delete BFee entry %d\n", __func__, i)); ++ *Idx = i; ++ if (pBeamInfo->BeamformeeEntry[i].is_mu_sta) ++ bSounding = BEAMFORMEE_NOTIFY_DELETE_MU; ++ else ++ bSounding = BEAMFORMEE_NOTIFY_DELETE_SU; ++ } ++ } ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, bSounding = %d\n", __func__, bSounding)); ++ return bSounding; ++} ++ ++ ++//This function is unused ++u1Byte ++phydm_beamforming_SoundingIdx( ++ IN PVOID pDM_VOID, ++ PRT_BEAMFORMING_INFO pBeamInfo ++ ) ++{ ++ u1Byte Idx = 0; ++ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ++ if (BeamOidInfo.SoundOidMode == SOUNDING_SW_HT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_SW_VHT_TIMER || ++ BeamOidInfo.SoundOidMode == SOUNDING_HW_HT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_HW_VHT_TIMER) ++ Idx = BeamOidInfo.SoundOidIdx; ++ else { ++ u1Byte i; ++ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { ++ if (pBeamInfo->BeamformeeEntry[i].bUsed && (FALSE == pBeamInfo->BeamformeeEntry[i].bSound)) { ++ Idx = i; ++ break; ++ } ++ } ++ } ++ ++ return Idx; ++} ++ ++ ++SOUNDING_MODE ++phydm_beamforming_SoundingMode( ++ IN PVOID pDM_VOID, ++ PRT_BEAMFORMING_INFO pBeamInfo, ++ u1Byte Idx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte SupportInterface = pDM_Odm->SupportInterface; ++ ++ RT_BEAMFORMEE_ENTRY BeamEntry = pBeamInfo->BeamformeeEntry[Idx]; ++ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; ++ SOUNDING_MODE Mode = BeamOidInfo.SoundOidMode; ++ ++ if (BeamOidInfo.SoundOidMode == SOUNDING_SW_VHT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_HW_VHT_TIMER) { ++ if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) ++ Mode = BeamOidInfo.SoundOidMode; ++ else ++ Mode = SOUNDING_STOP_All_TIMER; ++ } else if (BeamOidInfo.SoundOidMode == SOUNDING_SW_HT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_HW_HT_TIMER) { ++ if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT) ++ Mode = BeamOidInfo.SoundOidMode; ++ else ++ Mode = SOUNDING_STOP_All_TIMER; ++ } else if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) { ++ if ((SupportInterface == ODM_ITRF_USB) && !(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B))) ++ Mode = SOUNDING_FW_VHT_TIMER; ++ else ++ Mode = SOUNDING_SW_VHT_TIMER; ++ } else if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT) { ++ if ((SupportInterface == ODM_ITRF_USB) && !(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B))) ++ Mode = SOUNDING_FW_HT_TIMER; ++ else ++ Mode = SOUNDING_SW_HT_TIMER; ++ } else ++ Mode = SOUNDING_STOP_All_TIMER; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SupportInterface=%d, Mode=%d\n", __func__, SupportInterface, Mode)); ++ ++ return Mode; ++} ++ ++ ++u2Byte ++phydm_beamforming_SoundingTime( ++ IN PVOID pDM_VOID, ++ PRT_BEAMFORMING_INFO pBeamInfo, ++ SOUNDING_MODE Mode, ++ u1Byte Idx ++ ) ++{ ++ u2Byte SoundingTime = 0xffff; ++ RT_BEAMFORMEE_ENTRY BeamEntry = pBeamInfo->BeamformeeEntry[Idx]; ++ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ++ if (Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_HW_VHT_TIMER) ++ SoundingTime = BeamOidInfo.SoundOidPeriod * 32; ++ else if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_SW_VHT_TIMER) ++ /*Modified by David*/ ++ SoundingTime = BeamEntry.SoundPeriod; /*BeamOidInfo.SoundOidPeriod;*/ ++ else ++ SoundingTime = BeamEntry.SoundPeriod; ++ ++ return SoundingTime; ++} ++ ++ ++CHANNEL_WIDTH ++phydm_beamforming_SoundingBW( ++ IN PVOID pDM_VOID, ++ PRT_BEAMFORMING_INFO pBeamInfo, ++ SOUNDING_MODE Mode, ++ u1Byte Idx ++ ) ++{ ++ CHANNEL_WIDTH SoundingBW = CHANNEL_WIDTH_20; ++ RT_BEAMFORMEE_ENTRY BeamEntry = pBeamInfo->BeamformeeEntry[Idx]; ++ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_HW_VHT_TIMER) ++ SoundingBW = BeamOidInfo.SoundOidBW; ++ else if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_SW_VHT_TIMER) ++ /*Modified by David*/ ++ SoundingBW = BeamEntry.SoundBW; /*BeamOidInfo.SoundOidBW;*/ ++ else ++ SoundingBW = BeamEntry.SoundBW; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, SoundingBW=0x%X\n", __func__, SoundingBW)); ++ ++ return SoundingBW; ++} ++ ++ ++BOOLEAN ++phydm_Beamforming_SelectBeamEntry( ++ IN PVOID pDM_VOID, ++ PRT_BEAMFORMING_INFO pBeamInfo ++ ) ++{ ++ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ /*pEntry.bSound is different between first and latter NDPA, and should not be used as BFee entry selection*/ ++ /*BTW, latter modification should sync to the selection mechanism of AP/ADSL instead of the fixed SoundIdx.*/ ++ pSoundInfo->SoundIdx = phydm_beamforming_SoundingIdx(pDM_Odm, pBeamInfo); ++ /*pSoundInfo->SoundIdx = 0;*/ ++ ++ if (pSoundInfo->SoundIdx < BEAMFORMEE_ENTRY_NUM) ++ pSoundInfo->SoundMode = phydm_beamforming_SoundingMode(pDM_Odm, pBeamInfo, pSoundInfo->SoundIdx); ++ else ++ pSoundInfo->SoundMode = SOUNDING_STOP_All_TIMER; ++ ++ if (SOUNDING_STOP_All_TIMER == pSoundInfo->SoundMode) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Return because of SOUNDING_STOP_All_TIMER\n", __func__)); ++ return FALSE; ++ } else { ++ pSoundInfo->SoundBW = phydm_beamforming_SoundingBW(pDM_Odm, pBeamInfo, pSoundInfo->SoundMode, pSoundInfo->SoundIdx ); ++ pSoundInfo->SoundPeriod = phydm_beamforming_SoundingTime(pDM_Odm, pBeamInfo, pSoundInfo->SoundMode, pSoundInfo->SoundIdx ); ++ return TRUE; ++ } ++} ++ ++/*SU BFee Entry Only*/ ++BOOLEAN ++phydm_beamforming_StartPeriod( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ BOOLEAN Ret = TRUE; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); ++ ++ phydm_Beamforming_DymNDPARate(pDM_Odm); ++ ++ phydm_Beamforming_SelectBeamEntry(pDM_Odm, pBeamInfo); // Modified ++ ++ if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) ++ ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, pSoundInfo->SoundPeriod); ++ else if (pSoundInfo->SoundMode == SOUNDING_HW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_HW_HT_TIMER || ++ pSoundInfo->SoundMode == SOUNDING_AUTO_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_AUTO_HT_TIMER) { ++ HAL_HW_TIMER_TYPE TimerType = HAL_TIMER_TXBF; ++ u4Byte val = (pSoundInfo->SoundPeriod | (TimerType<<16)); ++ ++ //HW timer stop: All IC has the same setting ++ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_STOP, (pu1Byte)(&TimerType)); ++ //ODM_Write1Byte(pDM_Odm, 0x15F, 0); ++ //HW timer init: All IC has the same setting, but 92E & 8812A only write 2 bytes ++ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_INIT, (pu1Byte)(&val)); ++ //ODM_Write1Byte(pDM_Odm, 0x164, 1); ++ //ODM_Write4Byte(pDM_Odm, 0x15C, val); ++ //HW timer start: All IC has the same setting ++ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_START, (pu1Byte)(&TimerType)); ++ //ODM_Write1Byte(pDM_Odm, 0x15F, 0x5); ++ } else if (pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER) ++ Ret = BeamformingStart_FW(pDM_Odm, pSoundInfo->SoundIdx); ++ else ++ Ret = FALSE; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SoundIdx=%d, SoundMode=%d, SoundBW=%d, SoundPeriod=%d\n", __func__, ++ pSoundInfo->SoundIdx, pSoundInfo->SoundMode, pSoundInfo->SoundBW, pSoundInfo->SoundPeriod)); ++ ++ return Ret; ++} ++ ++// Used after Beamforming_Leave, and will clear the setting of the "already deleted" entry ++/*SU BFee Entry Only*/ ++VOID ++phydm_beamforming_EndPeriod_SW( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); ++ ++ HAL_HW_TIMER_TYPE TimerType = HAL_TIMER_TXBF; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ++ if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) ++ ODM_CancelTimer(pDM_Odm, &pBeamInfo->BeamformingTimer); ++ else if (pSoundInfo->SoundMode == SOUNDING_HW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_HW_HT_TIMER || ++ pSoundInfo->SoundMode == SOUNDING_AUTO_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_AUTO_HT_TIMER) ++ /*HW timer stop: All IC has the same setting*/ ++ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_STOP, (pu1Byte)(&TimerType)); ++ /*ODM_Write1Byte(pDM_Odm, 0x15F, 0);*/ ++} ++ ++VOID ++phydm_beamforming_EndPeriod_FW( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte Idx = 0; ++ ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_FW_NDPA, (pu1Byte)&Idx); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]\n", __func__)); ++} ++ ++ ++/*SU BFee Entry Only*/ ++VOID ++phydm_beamforming_ClearEntry_SW( ++ IN PVOID pDM_VOID, ++ BOOLEAN IsDelete, ++ u1Byte DeleteIdx ++ ) ++{ ++ u1Byte Idx = 0; ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ ++ if (IsDelete) { ++ if (DeleteIdx < BEAMFORMEE_ENTRY_NUM) { ++ pBeamformEntry = pBeamInfo->BeamformeeEntry + DeleteIdx; ++ if (!((!pBeamformEntry->bUsed) && pBeamformEntry->bSound)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW DeleteIdx is wrong!!!!!\n", __func__)); ++ return; ++ } ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW delete BFee entry %d\n", __func__, DeleteIdx)); ++ if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) { ++ pBeamformEntry->bBeamformingInProgress = FALSE; ++ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; ++ } else if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { ++ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&DeleteIdx); ++ } ++ pBeamformEntry->bSound = FALSE; ++ } else { ++ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { ++ pBeamformEntry = pBeamInfo->BeamformeeEntry+Idx; ++ ++ /*Used after bSounding=RESET, and will clear the setting of "ever sounded" entry, which is not necessarily be deleted.*/ ++ /*This function is mainly used in case "BeamOidInfo.SoundOidMode == SOUNDING_STOP_All_TIMER".*/ ++ /*However, setting oid doesn't delete entries (bUsed is still TRUE), new entries may fail to be added in.*/ ++ ++ if (pBeamformEntry->bSound) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW reset BFee entry %d\n", __func__, Idx)); ++ /* ++ * If End procedure is ++ * 1. Between (Send NDPA, C2H packet return), reset state to initialized. ++ * After C2H packet return , status bit will be set to zero. ++ * ++ * 2. After C2H packet, then reset state to initialized and clear status bit. ++ */ ++ ++ if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) ++ phydm_Beamforming_End_SW(pDM_Odm, 0); ++ else if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { ++ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&Idx); ++ } ++ ++ pBeamformEntry->bSound = FALSE; ++ } ++ } ++ } ++} ++ ++VOID ++phydm_beamforming_ClearEntry_FW( ++ IN PVOID pDM_VOID, ++ BOOLEAN IsDelete, ++ u1Byte DeleteIdx ++ ) ++{ ++ u1Byte Idx = 0; ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ ++ if (IsDelete) { ++ if (DeleteIdx < BEAMFORMEE_ENTRY_NUM) { ++ pBeamformEntry = pBeamInfo->BeamformeeEntry + DeleteIdx; ++ ++ if (!((!pBeamformEntry->bUsed) && pBeamformEntry->bSound)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] FW DeleteIdx is wrong!!!!!\n", __func__)); ++ return; ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: FW delete BFee entry %d\n", __func__, DeleteIdx)); ++ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; ++ pBeamformEntry->bSound = FALSE; ++ } else { ++ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { ++ pBeamformEntry = pBeamInfo->BeamformeeEntry+Idx; ++ ++ /*Used after bSounding=RESET, and will clear the setting of "ever sounded" entry, which is not necessarily be deleted.*/ ++ /*This function is mainly used in case "BeamOidInfo.SoundOidMode == SOUNDING_STOP_All_TIMER".*/ ++ /*However, setting oid doesn't delete entries (bUsed is still TRUE), new entries may fail to be added in.*/ ++ ++ if (pBeamformEntry->bSound) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]FW reset BFee entry %d\n", __func__, Idx)); ++ /* ++ * If End procedure is ++ * 1. Between (Send NDPA, C2H packet return), reset state to initialized. ++ * After C2H packet return , status bit will be set to zero. ++ * ++ * 2. After C2H packet, then reset state to initialized and clear status bit. ++ */ ++ ++ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; ++ pBeamformEntry->bSound = FALSE; ++ } ++ } ++ } ++} ++ ++/* ++* Called : ++* 1. Add and delete entry : Beamforming_Enter/Beamforming_Leave ++* 2. FW trigger : Beamforming_SetTxBFen ++* 3. Set OID_RT_BEAMFORMING_PERIOD : BeamformingControl_V2 ++*/ ++VOID ++phydm_Beamforming_Notify( ++ IN PVOID pDM_VOID ++ ) ++{ ++ u1Byte Idx=BEAMFORMEE_ENTRY_NUM; ++ BEAMFORMING_NOTIFY_STATE bSounding = BEAMFORMING_NOTIFY_NONE; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ++ bSounding = phydm_beamfomring_bSounding(pDM_Odm, pBeamInfo, &Idx); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, Before notify, bSounding=%d, Idx=%d\n", __func__, bSounding, Idx)); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: pBeamInfo->beamformee_su_cnt = %d\n", __func__, pBeamInfo->beamformee_su_cnt)); ++ ++ ++ switch (bSounding) { ++ case BEAMFORMEE_NOTIFY_ADD_SU: ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_ADD_SU\n", __func__)); ++ phydm_beamforming_StartPeriod(pDM_Odm); ++ break; ++ ++ case BEAMFORMEE_NOTIFY_DELETE_SU: ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_DELETE_SU\n", __func__)); ++ if (pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER) { ++ phydm_beamforming_ClearEntry_FW(pDM_Odm, TRUE, Idx); ++ if (pBeamInfo->beamformee_su_cnt == 0) { /* For 2->1 entry, we should not cancel SW timer */ ++ phydm_beamforming_EndPeriod_FW(pDM_Odm); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: No BFee left\n", __func__)); ++ } ++ } else { ++ phydm_beamforming_ClearEntry_SW(pDM_Odm, TRUE, Idx); ++ if (pBeamInfo->beamformee_su_cnt == 0) { /* For 2->1 entry, we should not cancel SW timer */ ++ phydm_beamforming_EndPeriod_SW(pDM_Odm); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: No BFee left\n", __func__)); ++ } ++ } ++ break; ++ ++ case BEAMFORMEE_NOTIFY_ADD_MU: ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_ADD_MU\n", __func__)); ++ if (pBeamInfo->beamformee_mu_cnt == 2) { ++ /*if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) ++ ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, pSoundInfo->SoundPeriod);*/ ++ ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, 1000); /*Do MU sounding every 1sec*/ ++ } else ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Less or larger than 2 MU STAs, not to set timer\n", __func__)); ++ break; ++ ++ case BEAMFORMEE_NOTIFY_DELETE_MU: ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_DELETE_MU\n", __func__)); ++ if (pBeamInfo->beamformee_mu_cnt == 1) { ++ /*if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER)*/{ ++ ODM_CancelTimer(pDM_Odm, &pBeamInfo->BeamformingTimer); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Less than 2 MU STAs, stop sounding\n", __func__)); ++ } ++ } ++ break; ++ ++ case BEAMFORMING_NOTIFY_RESET: ++ if (pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER) { ++ phydm_beamforming_ClearEntry_FW(pDM_Odm, FALSE, Idx); ++ phydm_beamforming_EndPeriod_FW(pDM_Odm); ++ } else { ++ phydm_beamforming_ClearEntry_SW(pDM_Odm, FALSE, Idx); ++ phydm_beamforming_EndPeriod_SW(pDM_Odm); ++ } ++ ++ break; ++ ++ default: ++ break; ++ } ++ ++} ++ ++ ++ ++BOOLEAN ++Beamforming_InitEntry( ++ IN PVOID pDM_VOID, ++ IN u2Byte staIdx, ++ pu1Byte BFerBFeeIdx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; ++ PRT_BEAMFORMER_ENTRY pBeamformerEntry = NULL; ++ PRT_BEAMFORM_STAINFO pSTA = NULL; ++ BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; ++ u1Byte BFerIdx=0xF, BFeeIdx=0xF; ++ u1Byte NumofSoundingDim = 0, CompSteeringNumofBFer = 0; ++ ++ pSTA = phydm_staInfoInit(pDM_Odm, staIdx); ++ ++ /*The current setting does not support Beaforming*/ ++ if (BEAMFORMING_CAP_NONE == pSTA->HtBeamformCap && BEAMFORMING_CAP_NONE == pSTA->VhtBeamformCap) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("The configuration disabled Beamforming! Skip...\n")); ++ return FALSE; ++ } ++ ++ if (pSTA->WirelessMode < WIRELESS_MODE_N_24G) ++ return FALSE; ++ else { ++ if (pSTA->WirelessMode & WIRELESS_MODE_N_5G || pSTA->WirelessMode & WIRELESS_MODE_N_24G) {/*HT*/ ++ if (TEST_FLAG(pSTA->CurBeamform, BEAMFORMING_HT_BEAMFORMER_ENABLE)) {/*We are Beamformee because the STA is Beamformer*/ ++ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMEE_CAP_HT_EXPLICIT); ++ NumofSoundingDim = (pSTA->CurBeamform&BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP)>>6; ++ } ++ /*We are Beamformer because the STA is Beamformee*/ ++ if (TEST_FLAG(pSTA->CurBeamform, BEAMFORMING_HT_BEAMFORMEE_ENABLE) || ++ TEST_FLAG(pSTA->HtBeamformCap, BEAMFORMING_HT_BEAMFORMER_TEST)) { ++ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMER_CAP_HT_EXPLICIT); ++ CompSteeringNumofBFer = (pSTA->CurBeamform & BEAMFORMING_HT_BEAMFORMER_STEER_NUM)>>4; ++ } ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] HT CurBeamform=0x%X, BeamformCap=0x%X\n", __func__, pSTA->CurBeamform, BeamformCap)); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] HT NumofSoundingDim=%d, CompSteeringNumofBFer=%d\n", __func__, NumofSoundingDim, CompSteeringNumofBFer)); ++ } ++#if (ODM_IC_11AC_SERIES_SUPPORT == 1) ++ if (pSTA->WirelessMode & WIRELESS_MODE_AC_5G || pSTA->WirelessMode & WIRELESS_MODE_AC_24G) { /*VHT*/ ++ ++ /* We are Beamformee because the STA is SU Beamformer*/ ++ if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { ++ BeamformCap =(BEAMFORMING_CAP)(BeamformCap |BEAMFORMEE_CAP_VHT_SU); ++ NumofSoundingDim = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM)>>12; ++ } ++ /* We are Beamformer because the STA is SU Beamformee*/ ++ if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) || ++ TEST_FLAG(pSTA->VhtBeamformCap, BEAMFORMING_VHT_BEAMFORMER_TEST)) { ++ BeamformCap =(BEAMFORMING_CAP)(BeamformCap |BEAMFORMER_CAP_VHT_SU); ++ CompSteeringNumofBFer = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMER_STS_CAP)>>8; ++ } ++ /* We are Beamformee because the STA is MU Beamformer*/ ++ if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) { ++ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMEE_CAP_VHT_MU); ++ NumofSoundingDim = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM)>>12; ++ } ++ /* We are Beamformer because the STA is MU Beamformee*/ ++ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) { /* Only AP mode supports to act an MU beamformer */ ++ if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE) || ++ TEST_FLAG(pSTA->VhtBeamformCap, BEAMFORMING_VHT_BEAMFORMER_TEST)) { ++ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMER_CAP_VHT_MU); ++ CompSteeringNumofBFer = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMER_STS_CAP)>>8; ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]VHT CurBeamformVHT=0x%X, BeamformCap=0x%X\n", __func__, pSTA->CurBeamformVHT, BeamformCap)); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]VHT NumofSoundingDim=0x%X, CompSteeringNumofBFer=0x%X\n", __func__, NumofSoundingDim, CompSteeringNumofBFer)); ++ ++ } ++#endif ++ } ++ ++ ++ if(BeamformCap == BEAMFORMING_CAP_NONE) ++ return FALSE; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Self BF Entry Cap = 0x%02X\n", __func__, BeamformCap)); ++ ++ /*We are BFee, so the entry is BFer*/ ++ if (BeamformCap & (BEAMFORMEE_CAP_VHT_MU | BEAMFORMEE_CAP_VHT_SU | BEAMFORMEE_CAP_HT_EXPLICIT)) { ++ pBeamformerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, pSTA->RA, &BFerIdx); ++ ++ if (pBeamformerEntry == NULL) { ++ pBeamformerEntry = Beamforming_AddBFerEntry(pDM_Odm, pSTA, BeamformCap, NumofSoundingDim , &BFerIdx); ++ if (pBeamformerEntry == NULL) ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Not enough BFer entry!!!!!\n", __func__)); ++ } ++ } ++ ++ /*We are BFer, so the entry is BFee*/ ++ if (BeamformCap & (BEAMFORMER_CAP_VHT_MU | BEAMFORMER_CAP_VHT_SU | BEAMFORMER_CAP_HT_EXPLICIT)) { ++ pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, pSTA->RA, &BFeeIdx); ++ ++ /*pGBFeeIdx = 0xF hNثeentrySۦPMACIDb*/ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get BFee entry 0x%X by address\n", __func__, BFeeIdx)); ++ if (pBeamformEntry == NULL) { ++ pBeamformEntry = Beamforming_AddBFeeEntry(pDM_Odm, pSTA, BeamformCap, NumofSoundingDim, CompSteeringNumofBFer, &BFeeIdx); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: pSTA->AID=%d, pSTA->MacID=%d\n", __func__, pSTA->AID, pSTA->MacID)); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: Add BFee entry %d\n", __func__, BFeeIdx)); ++ ++ if (pBeamformEntry == NULL) ++ return FALSE; ++ else ++ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZEING; ++ } else { ++ /*Entry has been created. If entry is initialing or progressing then errors occur.*/ ++ if (pBeamformEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_INITIALIZED && ++ pBeamformEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSED) { ++ return FALSE; ++ } else ++ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZEING; ++ } ++ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; ++ phydm_staInfoUpdate(pDM_Odm, staIdx, pBeamformEntry); ++ } ++ ++ *BFerBFeeIdx = (BFerIdx<<4) | BFeeIdx; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End: BFerIdx=0x%X, BFeeIdx=0x%X, BFerBFeeIdx=0x%X\n", __func__, BFerIdx, BFeeIdx, *BFerBFeeIdx)); ++ ++ return TRUE; ++} ++ ++ ++VOID ++Beamforming_DeInitEntry( ++ IN PVOID pDM_VOID, ++ pu1Byte RA ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte Idx = 0; ++ ++ PRT_BEAMFORMER_ENTRY pBFerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, RA, &Idx); ++ PRT_BEAMFORMEE_ENTRY pBFeeEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); ++ BOOLEAN ret = FALSE; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ++ if (pBFeeEntry != NULL) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, pBFeeEntry\n", __func__)); ++ pBFeeEntry->bUsed = FALSE; ++ pBFeeEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; ++ pBFeeEntry->bBeamformingInProgress = FALSE; ++ if (pBFeeEntry->is_mu_sta) { ++ pDM_Odm->BeamformingInfo.beamformee_mu_cnt -= 1; ++ pDM_Odm->BeamformingInfo.FirstMUBFeeIndex = phydm_Beamforming_GetFirstMUBFeeEntryIdx(pDM_Odm); ++ } else { ++ pDM_Odm->BeamformingInfo.beamformee_su_cnt -= 1; ++ } ++ ret = TRUE; ++ } ++ ++ if (pBFerEntry != NULL) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, pBFerEntry\n", __func__)); ++ pBFerEntry->bUsed = FALSE; ++ pBFerEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; ++ if (pBFerEntry->is_mu_ap) ++ pDM_Odm->BeamformingInfo.beamformer_mu_cnt -= 1; ++ else ++ pDM_Odm->BeamformingInfo.beamformer_su_cnt -= 1; ++ ret = TRUE; ++ } ++ ++ if (ret == TRUE) ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_LEAVE, (pu1Byte)&Idx); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, Idx = 0x%X\n", __func__, Idx)); ++} ++ ++ ++BOOLEAN ++BeamformingStart_V1( ++ IN PVOID pDM_VOID, ++ pu1Byte RA, ++ BOOLEAN Mode, ++ CHANNEL_WIDTH BW, ++ u1Byte Rate ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte Idx = 0; ++ PRT_BEAMFORMEE_ENTRY pEntry; ++ BOOLEAN ret = TRUE; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ ++ pEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); ++ ++ if (pEntry->bUsed == FALSE) { ++ pEntry->bBeamformingInProgress = FALSE; ++ return FALSE; ++ } else { ++ if (pEntry->bBeamformingInProgress) ++ return FALSE; ++ ++ pEntry->bBeamformingInProgress = TRUE; ++ ++ if (Mode == 1) { ++ if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT)) { ++ pEntry->bBeamformingInProgress = FALSE; ++ return FALSE; ++ } ++ } else if (Mode == 0) { ++ if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU)) { ++ pEntry->bBeamformingInProgress = FALSE; ++ return FALSE; ++ } ++ } ++ ++ if (pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_INITIALIZED && pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSED) { ++ pEntry->bBeamformingInProgress = FALSE; ++ return FALSE; ++ } else { ++ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSING; ++ pEntry->bSound = TRUE; ++ } ++ } ++ ++ pEntry->SoundBW = BW; ++ pBeamInfo->BeamformeeCurIdx = Idx; ++ phydm_Beamforming_NDPARate(pDM_Odm, BW, Rate); ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&Idx); ++ ++ if (Mode == 1) ++ ret = Beamforming_SendHTNDPAPacket(pDM_Odm, RA, BW, NORMAL_QUEUE); ++ else ++ ret = Beamforming_SendVHTNDPAPacket(pDM_Odm, RA, pEntry->AID, BW, NORMAL_QUEUE); ++ ++ if (ret == FALSE) { ++ Beamforming_Leave(pDM_Odm, RA); ++ pEntry->bBeamformingInProgress = FALSE; ++ return FALSE; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Idx %d\n", __func__, Idx)); ++ return TRUE; ++} ++ ++ ++BOOLEAN ++BeamformingStart_SW( ++ IN PVOID pDM_VOID, ++ u1Byte Idx, ++ u1Byte Mode, ++ CHANNEL_WIDTH BW ++ ) ++{ ++ pu1Byte RA = NULL; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMEE_ENTRY pEntry; ++ BOOLEAN ret = TRUE; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ ++ if (pBeamInfo->is_mu_sounding) { ++ pBeamInfo->is_mu_sounding_in_progress = TRUE; ++ pEntry = &(pBeamInfo->BeamformeeEntry[Idx]); ++ RA = pEntry->MacAddr; ++ ++ } else { ++ pEntry = &(pBeamInfo->BeamformeeEntry[Idx]); ++ ++ if (pEntry->bUsed == FALSE) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Skip Beamforming, no entry for Idx =%d\n", Idx)); ++ pEntry->bBeamformingInProgress = FALSE; ++ return FALSE; ++ } else { ++ if (pEntry->bBeamformingInProgress) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("bBeamformingInProgress, skip...\n")); ++ return FALSE; ++ } ++ ++ pEntry->bBeamformingInProgress = TRUE; ++ RA = pEntry->MacAddr; ++ ++ if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_AUTO_HT_TIMER) { ++ if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT)) { ++ pEntry->bBeamformingInProgress = FALSE; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Return by not support BEAMFORMER_CAP_HT_EXPLICIT <==\n", __func__)); ++ return FALSE; ++ } ++ } else if (Mode == SOUNDING_SW_VHT_TIMER || Mode == SOUNDING_HW_VHT_TIMER || Mode == SOUNDING_AUTO_VHT_TIMER) { ++ if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU)) { ++ pEntry->bBeamformingInProgress = FALSE; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Return by not support BEAMFORMER_CAP_VHT_SU <==\n", __func__)); ++ return FALSE; ++ } ++ } ++ if (pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_INITIALIZED && pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSED) { ++ pEntry->bBeamformingInProgress = FALSE; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Return by incorrect BeamformEntryState(%d) <==\n", __func__, pEntry->BeamformEntryState)); ++ return FALSE; ++ } else { ++ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSING; ++ pEntry->bSound = TRUE; ++ } ++ } ++ ++ pBeamInfo->BeamformeeCurIdx = Idx; ++ } ++ ++ /*2014.12.22 Luke: Need to be checked*/ ++ /*GET_TXBF_INFO(Adapter)->fTxbfSet(Adapter, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&Idx);*/ ++ ++ if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_AUTO_HT_TIMER) ++ ret = Beamforming_SendHTNDPAPacket(pDM_Odm, RA , BW, NORMAL_QUEUE); ++ else ++ ret = Beamforming_SendVHTNDPAPacket(pDM_Odm, RA , pEntry->AID, BW, NORMAL_QUEUE); ++ ++ if (ret == FALSE) { ++ Beamforming_Leave(pDM_Odm, RA); ++ pEntry->bBeamformingInProgress = FALSE; ++ return FALSE; ++ } ++ ++ ++ /*-------------------------- ++ // Send BF Report Poll for MU BF ++ --------------------------*/ ++#ifdef SUPPORT_MU_BF ++#if (SUPPORT_MU_BF == 1) ++{ ++ u1Byte idx, PollSTACnt = 0; ++ BOOLEAN bGetFirstBFee = FALSE; ++ ++ if (pBeamInfo->beamformee_mu_cnt > 1) { /* More than 1 MU STA*/ ++ ++ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { ++ pEntry = &(pBeamInfo->BeamformeeEntry[idx]); ++ if (pEntry->is_mu_sta) { ++ if (bGetFirstBFee) { ++ PollSTACnt++; ++ if (PollSTACnt == (pBeamInfo->beamformee_mu_cnt - 1))/* The last STA*/ ++ SendSWVHTBFReportPoll(pDM_Odm, pEntry->MacAddr, TRUE); ++ else ++ SendSWVHTBFReportPoll(pDM_Odm, pEntry->MacAddr, FALSE); ++ } else { ++ bGetFirstBFee = TRUE; ++ } ++ } ++ } ++ } ++} ++#endif ++#endif ++ return TRUE; ++} ++ ++ ++BOOLEAN ++BeamformingStart_FW( ++ IN PVOID pDM_VOID, ++ u1Byte Idx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMEE_ENTRY pEntry; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ ++ pEntry = &(pBeamInfo->BeamformeeEntry[Idx]); ++ if (pEntry->bUsed == FALSE) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Skip Beamforming, no entry for Idx =%d\n", Idx)); ++ return FALSE; ++ } ++ ++ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSING; ++ pEntry->bSound = TRUE; ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_FW_NDPA, (pu1Byte)&Idx); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End, Idx=0x%X\n", __func__, Idx)); ++ return TRUE; ++} ++ ++VOID ++Beamforming_CheckSoundingSuccess( ++ IN PVOID pDM_VOID, ++ BOOLEAN Status ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[David]@%s Start!\n", __func__)); ++ ++ if (Status == 1) { ++ if (pEntry->LogStatusFailCnt == 21) ++ Beamforming_DymPeriod(pDM_Odm, Status); ++ pEntry->LogStatusFailCnt = 0; ++ } else if (pEntry->LogStatusFailCnt <= 20) { ++ pEntry->LogStatusFailCnt++; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s LogStatusFailCnt %d\n", __func__, pEntry->LogStatusFailCnt)); ++ } ++ if (pEntry->LogStatusFailCnt > 20) { ++ pEntry->LogStatusFailCnt = 21; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s LogStatusFailCnt > 20, Stop SOUNDING\n", __func__)); ++ Beamforming_DymPeriod(pDM_Odm, Status); ++ } ++} ++ ++VOID ++phydm_Beamforming_End_SW( ++ IN PVOID pDM_VOID, ++ BOOLEAN Status ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); ++ ++ if (pBeamInfo->is_mu_sounding) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: MU sounding done\n", __func__)); ++ pBeamInfo->is_mu_sounding_in_progress = FALSE; ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); ++ } else { ++ if (pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSING) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BeamformStatus %d\n", __func__, pEntry->BeamformEntryState)); ++ return; ++ } ++ ++ if ((pDM_Odm->TxBfDataRate >= ODM_RATEVHTSS3MCS7) && (pDM_Odm->TxBfDataRate <= ODM_RATEVHTSS3MCS9) && (pBeamInfo->snding3SS == FALSE)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] VHT3SS 7,8,9, do not apply V matrix.\n", __func__)); ++ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); ++ } else if (Status == 1) { ++ pEntry->LogStatusFailCnt = 0; ++ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); ++ } else { ++ pEntry->LogStatusFailCnt++; ++ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_TX_PATH_RESET, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] LogStatusFailCnt %d\n", __func__, pEntry->LogStatusFailCnt)); ++ } ++ ++ if (pEntry->LogStatusFailCnt > 50) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s LogStatusFailCnt > 50, Stop SOUNDING\n", __func__)); ++ pEntry->bSound = FALSE; ++ Beamforming_DeInitEntry(pDM_Odm, pEntry->MacAddr); ++ ++ /*Modified by David - Every action of deleting entry should follow by Notify*/ ++ phydm_Beamforming_Notify(pDM_Odm); ++ } ++ ++ pEntry->bBeamformingInProgress = FALSE; ++ } ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Status=%d\n", __func__, Status)); ++} ++ ++ ++VOID ++Beamforming_TimerCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PVOID pDM_VOID ++#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) ++ IN PVOID pContext ++#endif ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PADAPTER Adapter = (PADAPTER)pContext; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++#endif ++ BOOLEAN ret = FALSE; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); ++ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); ++ BOOLEAN bBeamformingInProgress; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ++ if (pBeamInfo->is_mu_sounding) ++ bBeamformingInProgress = pBeamInfo->is_mu_sounding_in_progress; ++ else ++ bBeamformingInProgress = pEntry->bBeamformingInProgress; ++ ++ if (bBeamformingInProgress) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("bBeamformingInProgress, reset it\n")); ++ phydm_Beamforming_End_SW(pDM_Odm, 0); ++ } ++ ++ ret = phydm_Beamforming_SelectBeamEntry(pDM_Odm, pBeamInfo); ++#if (SUPPORT_MU_BF == 1) ++ if (ret && pBeamInfo->beamformee_mu_cnt > 1) ++ ret = 1; ++ else ++ ret = 0; ++#endif ++ if (ret) ++ ret = BeamformingStart_SW(pDM_Odm, pSoundInfo->SoundIdx, pSoundInfo->SoundMode, pSoundInfo->SoundBW); ++ else ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, Error value return from BeamformingStart_V2\n", __func__)); ++ ++ if ((pBeamInfo->beamformee_su_cnt != 0) || (pBeamInfo->beamformee_mu_cnt > 1)) { ++ if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) ++ ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, pSoundInfo->SoundPeriod); ++ else { ++ u4Byte val = (pSoundInfo->SoundPeriod << 16) | HAL_TIMER_TXBF; ++ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_RESTART, (pu1Byte)(&val)); ++ } ++ } ++} ++ ++ ++VOID ++Beamforming_SWTimerCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PRT_TIMER pTimer ++#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) ++ void *FunctionContext ++#endif ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ Beamforming_TimerCallback(pDM_Odm); ++#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)FunctionContext; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ if (Adapter->net_closed == TRUE) ++ return; ++ rtw_run_in_thread_cmd(Adapter, Beamforming_TimerCallback, Adapter); ++#endif ++ ++} ++ ++ ++VOID ++phydm_Beamforming_Init( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMING_OID_INFO pBeamOidInfo = &(pBeamInfo->BeamformingOidInfo); ++ ++ pBeamOidInfo->SoundOidMode = SOUNDING_STOP_OID_TIMER; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Mode (%d)\n", __func__, pBeamOidInfo->SoundOidMode)); ++ ++ pBeamInfo->beamformee_su_cnt = 0; ++ pBeamInfo->beamformer_su_cnt = 0; ++ pBeamInfo->beamformee_mu_cnt = 0; ++ pBeamInfo->beamformer_mu_cnt = 0; ++ pBeamInfo->beamformee_mu_reg_maping = 0; ++ pBeamInfo->mu_ap_index = 0; ++ pBeamInfo->is_mu_sounding = FALSE; ++ pBeamInfo->FirstMUBFeeIndex = 0xFF; ++ pBeamInfo->applyVmatrix = TRUE; ++ pBeamInfo->snding3SS = FALSE; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ pBeamInfo->SourceAdapter = pDM_Odm->Adapter; ++#endif ++ halComTxbf_beamformInit(pDM_Odm); ++} ++ ++ ++BOOLEAN ++phydm_actingDetermine( ++ IN PVOID pDM_VOID, ++ IN PHYDM_ACTING_TYPE type ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ BOOLEAN ret = FALSE; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->BeamformingInfo.SourceAdapter; ++#else ++ PADAPTER Adapter = pDM_Odm->Adapter; ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ if (type == PhyDM_ACTING_AS_AP) ++ ret = ACTING_AS_AP(Adapter); ++ else if (type == PhyDM_ACTING_AS_IBSS) ++ ret = ACTING_AS_IBSS(Adapter); ++#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ ++ if (type == PhyDM_ACTING_AS_AP) ++ ret = check_fwstate(pmlmepriv, WIFI_AP_STATE); ++ else if (type == PhyDM_ACTING_AS_IBSS) ++ ret = check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); ++#endif ++ ++ return ret; ++ ++} ++ ++VOID ++Beamforming_Enter( ++ IN PVOID pDM_VOID, ++ IN u2Byte staIdx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte BFerBFeeIdx = 0xff; ++ ++ if (Beamforming_InitEntry(pDM_Odm, staIdx, &BFerBFeeIdx)) ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_ENTER, (pu1Byte)&BFerBFeeIdx); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End!\n", __func__)); ++} ++ ++ ++VOID ++Beamforming_Leave( ++ IN PVOID pDM_VOID, ++ pu1Byte RA ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (RA != NULL) { ++ Beamforming_DeInitEntry(pDM_Odm, RA); ++ phydm_Beamforming_Notify(pDM_Odm); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End!!\n", __func__)); ++} ++ ++#if 0 ++//Nobody calls this function ++VOID ++phydm_Beamforming_SetTxBFen( ++ IN PVOID pDM_VOID, ++ u1Byte MacId, ++ BOOLEAN bTxBF ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte Idx = 0; ++ PRT_BEAMFORMEE_ENTRY pEntry; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ++ pEntry = phydm_Beamforming_GetEntryByMacId(pDM_Odm, MacId, &Idx); ++ ++ if(pEntry == NULL) ++ return; ++ else ++ pEntry->bTxBF = bTxBF; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s MacId %d TxBF %d\n", __func__, pEntry->MacId, pEntry->bTxBF)); ++ ++ phydm_Beamforming_Notify(pDM_Odm); ++} ++#endif ++ ++BEAMFORMING_CAP ++phydm_Beamforming_GetBeamCap( ++ IN PVOID pDM_VOID, ++ IN PRT_BEAMFORMING_INFO pBeamInfo ++ ) ++{ ++ u1Byte i; ++ BOOLEAN bSelfBeamformer = FALSE; ++ BOOLEAN bSelfBeamformee = FALSE; ++ RT_BEAMFORMEE_ENTRY BeamformeeEntry; ++ RT_BEAMFORMER_ENTRY BeamformerEntry; ++ BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { ++ BeamformeeEntry = pBeamInfo->BeamformeeEntry[i]; ++ ++ if (BeamformeeEntry.bUsed) { ++ bSelfBeamformer = TRUE; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BFee entry %d bUsed=TRUE\n", __func__, i)); ++ break; ++ } ++ } ++ ++ for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { ++ BeamformerEntry = pBeamInfo->BeamformerEntry[i]; ++ ++ if (BeamformerEntry.bUsed) { ++ bSelfBeamformee = TRUE; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: BFer entry %d bUsed=TRUE\n", __func__, i)); ++ break; ++ } ++ } ++ ++ if (bSelfBeamformer) ++ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMER_CAP); ++ if (bSelfBeamformee) ++ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMEE_CAP); ++ ++ return BeamformCap; ++} ++ ++ ++BOOLEAN ++BeamformingControl_V1( ++ IN PVOID pDM_VOID, ++ pu1Byte RA, ++ u1Byte AID, ++ u1Byte Mode, ++ CHANNEL_WIDTH BW, ++ u1Byte Rate ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ BOOLEAN ret = TRUE; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("AID (%d), Mode (%d), BW (%d)\n", AID, Mode, BW)); ++ ++ switch (Mode) { ++ case 0: ++ ret = BeamformingStart_V1(pDM_Odm, RA, 0, BW, Rate); ++ break; ++ case 1: ++ ret = BeamformingStart_V1(pDM_Odm, RA, 1, BW, Rate); ++ break; ++ case 2: ++ phydm_Beamforming_NDPARate(pDM_Odm, BW, Rate); ++ ret = Beamforming_SendVHTNDPAPacket(pDM_Odm, RA, AID, BW, NORMAL_QUEUE); ++ break; ++ case 3: ++ phydm_Beamforming_NDPARate(pDM_Odm, BW, Rate); ++ ret = Beamforming_SendHTNDPAPacket(pDM_Odm, RA, BW, NORMAL_QUEUE); ++ break; ++ } ++ return ret; ++} ++ ++/*Only OID uses this function*/ ++BOOLEAN ++phydm_BeamformingControl_V2( ++ IN PVOID pDM_VOID, ++ u1Byte Idx, ++ u1Byte Mode, ++ CHANNEL_WIDTH BW, ++ u2Byte Period ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMING_OID_INFO pBeamOidInfo = &(pBeamInfo->BeamformingOidInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Idx (%d), Mode (%d), BW (%d), Period (%d)\n", Idx, Mode, BW, Period)); ++ ++ pBeamOidInfo->SoundOidIdx = Idx; ++ pBeamOidInfo->SoundOidMode = (SOUNDING_MODE) Mode; ++ pBeamOidInfo->SoundOidBW = BW; ++ pBeamOidInfo->SoundOidPeriod = Period; ++ ++ phydm_Beamforming_Notify(pDM_Odm); ++ ++ return TRUE; ++} ++ ++ ++VOID ++phydm_Beamforming_Watchdog( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("%s Start!\n", __func__)); ++ ++ if (pBeamInfo->beamformee_su_cnt == 0) ++ return; ++ ++ Beamforming_DymPeriod(pDM_Odm,0); ++ phydm_Beamforming_DymNDPARate(pDM_Odm); ++ ++} ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.h 2018-02-11 21:44:27.155146208 +0200 +@@ -0,0 +1,367 @@ ++#ifndef __INC_PHYDM_BEAMFORMING_H ++#define __INC_PHYDM_BEAMFORMING_H ++ ++#ifndef BEAMFORMING_SUPPORT ++#define BEAMFORMING_SUPPORT 0 ++#endif ++ ++/*Beamforming Related*/ ++#include "txbf/halcomtxbf.h" ++#include "txbf/haltxbfjaguar.h" ++#include "txbf/haltxbf8192e.h" ++#include "txbf/haltxbf8814a.h" ++#include "txbf/haltxbf8822b.h" ++#include "txbf/haltxbfinterface.h" ++ ++#if (BEAMFORMING_SUPPORT == 1) ++ ++#define MAX_BEAMFORMEE_SU 2 ++#define MAX_BEAMFORMER_SU 2 ++#if (RTL8822B_SUPPORT == 1) ++#define MAX_BEAMFORMEE_MU 6 ++#define MAX_BEAMFORMER_MU 1 ++#else ++#define MAX_BEAMFORMEE_MU 0 ++#define MAX_BEAMFORMER_MU 0 ++#endif ++ ++#define BEAMFORMEE_ENTRY_NUM (MAX_BEAMFORMEE_SU + MAX_BEAMFORMEE_MU) ++#define BEAMFORMER_ENTRY_NUM (MAX_BEAMFORMER_SU + MAX_BEAMFORMER_MU) ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++/*for different naming between WIN and CE*/ ++#define BEACON_QUEUE BCN_QUEUE_INX ++#define NORMAL_QUEUE MGT_QUEUE_INX ++#define RT_DISABLE_FUNC RTW_DISABLE_FUNC ++#define RT_ENABLE_FUNC RTW_ENABLE_FUNC ++#endif ++ ++typedef enum _BEAMFORMING_ENTRY_STATE { ++ BEAMFORMING_ENTRY_STATE_UNINITIALIZE, ++ BEAMFORMING_ENTRY_STATE_INITIALIZEING, ++ BEAMFORMING_ENTRY_STATE_INITIALIZED, ++ BEAMFORMING_ENTRY_STATE_PROGRESSING, ++ BEAMFORMING_ENTRY_STATE_PROGRESSED ++} BEAMFORMING_ENTRY_STATE, *PBEAMFORMING_ENTRY_STATE; ++ ++ ++typedef enum _BEAMFORMING_NOTIFY_STATE { ++ BEAMFORMING_NOTIFY_NONE, ++ BEAMFORMING_NOTIFY_ADD, ++ BEAMFORMING_NOTIFY_DELETE, ++ BEAMFORMEE_NOTIFY_ADD_SU, ++ BEAMFORMEE_NOTIFY_DELETE_SU, ++ BEAMFORMEE_NOTIFY_ADD_MU, ++ BEAMFORMEE_NOTIFY_DELETE_MU, ++ BEAMFORMING_NOTIFY_RESET ++} BEAMFORMING_NOTIFY_STATE, *PBEAMFORMING_NOTIFY_STATE; ++ ++typedef enum _BEAMFORMING_CAP { ++ BEAMFORMING_CAP_NONE = 0x0, ++ BEAMFORMER_CAP_HT_EXPLICIT = BIT1, ++ BEAMFORMEE_CAP_HT_EXPLICIT = BIT2, ++ BEAMFORMER_CAP_VHT_SU = BIT5, /* Self has er Cap, because Reg er & peer ee */ ++ BEAMFORMEE_CAP_VHT_SU = BIT6, /* Self has ee Cap, because Reg ee & peer er */ ++ BEAMFORMER_CAP_VHT_MU = BIT7, /* Self has er Cap, because Reg er & peer ee */ ++ BEAMFORMEE_CAP_VHT_MU = BIT8, /* Self has ee Cap, because Reg ee & peer er */ ++ BEAMFORMER_CAP = BIT9, ++ BEAMFORMEE_CAP = BIT10, ++}BEAMFORMING_CAP, *PBEAMFORMING_CAP; ++ ++ ++typedef enum _SOUNDING_MODE { ++ SOUNDING_SW_VHT_TIMER = 0x0, ++ SOUNDING_SW_HT_TIMER = 0x1, ++ SOUNDING_STOP_All_TIMER = 0x2, ++ SOUNDING_HW_VHT_TIMER = 0x3, ++ SOUNDING_HW_HT_TIMER = 0x4, ++ SOUNDING_STOP_OID_TIMER = 0x5, ++ SOUNDING_AUTO_VHT_TIMER = 0x6, ++ SOUNDING_AUTO_HT_TIMER = 0x7, ++ SOUNDING_FW_VHT_TIMER = 0x8, ++ SOUNDING_FW_HT_TIMER = 0x9, ++}SOUNDING_MODE, *PSOUNDING_MODE; ++ ++typedef struct _RT_BEAMFORM_STAINFO { ++ pu1Byte RA; ++ u2Byte AID; ++ u2Byte MacID; ++ u1Byte MyMacAddr[6]; ++ WIRELESS_MODE WirelessMode; ++ CHANNEL_WIDTH BW; ++ BEAMFORMING_CAP BeamformCap; ++ u1Byte HtBeamformCap; ++ u2Byte VhtBeamformCap; ++ u1Byte CurBeamform; ++ u2Byte CurBeamformVHT; ++} RT_BEAMFORM_STAINFO, *PRT_BEAMFORM_STAINFO; ++ ++ ++typedef struct _RT_BEAMFORMEE_ENTRY { ++ BOOLEAN bUsed; ++ BOOLEAN bTxBF; ++ BOOLEAN bSound; ++ u2Byte AID; /*Used to construct AID field of NDPA packet.*/ ++ u2Byte MacId; /*Used to Set Reg42C in IBSS mode. */ ++ u2Byte P_AID; /*Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ ++ u2Byte G_ID; /*Used to fill Tx DESC*/ ++ u1Byte MyMacAddr[6]; ++ u1Byte MacAddr[6]; /*Used to fill Reg6E4 to fill Mac address of CSI report frame.*/ ++ CHANNEL_WIDTH SoundBW; /*Sounding BandWidth*/ ++ u2Byte SoundPeriod; ++ BEAMFORMING_CAP BeamformEntryCap; ++ BEAMFORMING_ENTRY_STATE BeamformEntryState; ++ BOOLEAN bBeamformingInProgress; ++ /*u1Byte LogSeq; // Move to _RT_BEAMFORMER_ENTRY*/ ++ /*u2Byte LogRetryCnt:3; // 0~4 // Move to _RT_BEAMFORMER_ENTRY*/ ++ /*u2Byte LogSuccessCnt:2; // 0~2 // Move to _RT_BEAMFORMER_ENTRY*/ ++ u2Byte LogStatusFailCnt:5; // 0~21 ++ u2Byte DefaultCSICnt:5; // 0~21 ++ u1Byte CSIMatrix[327]; ++ u2Byte CSIMatrixLen; ++ u1Byte NumofSoundingDim; ++ u1Byte CompSteeringNumofBFer; ++ u1Byte su_reg_index; ++ /*For MU-MIMO*/ ++ BOOLEAN is_mu_sta; ++ u1Byte mu_reg_index; ++ u1Byte gid_valid[8]; ++ u1Byte user_position[16]; ++} RT_BEAMFORMEE_ENTRY, *PRT_BEAMFORMEE_ENTRY; ++ ++typedef struct _RT_BEAMFORMER_ENTRY { ++ BOOLEAN bUsed; ++ /*P_AID of BFer entry is probably not used*/ ++ u2Byte P_AID; /*Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ ++ u2Byte G_ID; ++ u1Byte MyMacAddr[6]; ++ u1Byte MacAddr[6]; ++ BEAMFORMING_CAP BeamformEntryCap; ++ u1Byte NumofSoundingDim; ++ u1Byte ClockResetTimes; /*Modified by Jeffery @2015-04-10*/ ++ u1Byte PreLogSeq; /*Modified by Jeffery @2015-03-30*/ ++ u1Byte LogSeq; /*Modified by Jeffery @2014-10-29*/ ++ u2Byte LogRetryCnt:3; /*Modified by Jeffery @2014-10-29*/ ++ u2Byte LogSuccess:2; /*Modified by Jeffery @2014-10-29*/ ++ u1Byte su_reg_index; ++ /*For MU-MIMO*/ ++ BOOLEAN is_mu_ap; ++ u1Byte gid_valid[8]; ++ u1Byte user_position[16]; ++ u2Byte AID; ++} RT_BEAMFORMER_ENTRY, *PRT_BEAMFORMER_ENTRY; ++ ++typedef struct _RT_SOUNDING_INFO { ++ u1Byte SoundIdx; ++ CHANNEL_WIDTH SoundBW; ++ SOUNDING_MODE SoundMode; ++ u2Byte SoundPeriod; ++} RT_SOUNDING_INFO, *PRT_SOUNDING_INFO; ++ ++ ++ ++typedef struct _RT_BEAMFORMING_OID_INFO { ++ u1Byte SoundOidIdx; ++ CHANNEL_WIDTH SoundOidBW; ++ SOUNDING_MODE SoundOidMode; ++ u2Byte SoundOidPeriod; ++} RT_BEAMFORMING_OID_INFO, *PRT_BEAMFORMING_OID_INFO; ++ ++ ++typedef struct _RT_BEAMFORMING_INFO { ++ BEAMFORMING_CAP BeamformCap; ++ RT_BEAMFORMEE_ENTRY BeamformeeEntry[BEAMFORMEE_ENTRY_NUM]; ++ RT_BEAMFORMER_ENTRY BeamformerEntry[BEAMFORMER_ENTRY_NUM]; ++ RT_BEAMFORM_STAINFO BeamformSTAinfo; ++ u1Byte BeamformeeCurIdx; ++ RT_TIMER BeamformingTimer; ++ RT_TIMER mu_timer; ++ RT_SOUNDING_INFO SoundingInfo; ++ RT_BEAMFORMING_OID_INFO BeamformingOidInfo; ++ HAL_TXBF_INFO TxbfInfo; ++ u1Byte SoundingSequence; ++ u1Byte beamformee_su_cnt; ++ u1Byte beamformer_su_cnt; ++ u4Byte beamformee_su_reg_maping; ++ u4Byte beamformer_su_reg_maping; ++ /*For MU-MINO*/ ++ u1Byte beamformee_mu_cnt; ++ u1Byte beamformer_mu_cnt; ++ u4Byte beamformee_mu_reg_maping; ++ u1Byte mu_ap_index; ++ BOOLEAN is_mu_sounding; ++ u1Byte FirstMUBFeeIndex; ++ BOOLEAN is_mu_sounding_in_progress; ++ BOOLEAN dbg_disable_mu_tx; ++ BOOLEAN applyVmatrix; ++ BOOLEAN snding3SS; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER SourceAdapter; ++#endif ++ /* Control register */ ++ u4Byte RegMUTxCtrl; /* For USB/SDIO interfaces aync I/O */ ++} RT_BEAMFORMING_INFO, *PRT_BEAMFORMING_INFO; ++ ++ ++typedef struct _RT_NDPA_STA_INFO { ++ u2Byte AID:12; ++ u2Byte FeedbackType:1; ++ u2Byte NcIndex:3; ++} RT_NDPA_STA_INFO, *PRT_NDPA_STA_INFO; ++ ++typedef enum _PHYDM_ACTING_TYPE { ++ PhyDM_ACTING_AS_IBSS = 0, ++ PhyDM_ACTING_AS_AP = 1 ++} PHYDM_ACTING_TYPE; ++ ++ ++BEAMFORMING_CAP ++phydm_Beamforming_GetEntryBeamCapByMacId( ++ IN PVOID pDM_VOID, ++ IN u1Byte MacId ++ ); ++ ++PRT_BEAMFORMEE_ENTRY ++phydm_Beamforming_GetBFeeEntryByAddr( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ OUT pu1Byte Idx ++ ); ++ ++PRT_BEAMFORMER_ENTRY ++phydm_Beamforming_GetBFerEntryByAddr( ++ IN PVOID pDM_VOID, ++ IN pu1Byte TA, ++ OUT pu1Byte Idx ++ ); ++ ++VOID ++phydm_Beamforming_Notify( ++ IN PVOID pDM_VOID ++ ); ++ ++BOOLEAN ++phydm_actingDetermine( ++ IN PVOID pDM_VOID, ++ IN PHYDM_ACTING_TYPE type ++ ); ++ ++VOID ++Beamforming_Enter( ++ IN PVOID pDM_VOID, ++ IN u2Byte staIdx ++ ); ++ ++VOID ++Beamforming_Leave( ++ IN PVOID pDM_VOID, ++ pu1Byte RA ++ ); ++ ++BOOLEAN ++BeamformingStart_FW( ++ IN PVOID pDM_VOID, ++ u1Byte Idx ++ ); ++ ++VOID ++Beamforming_CheckSoundingSuccess( ++ IN PVOID pDM_VOID, ++ BOOLEAN Status ++); ++ ++VOID ++phydm_Beamforming_End_SW( ++ IN PVOID pDM_VOID, ++ BOOLEAN Status ++ ); ++ ++VOID ++Beamforming_TimerCallback( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++phydm_Beamforming_Init( ++ IN PVOID pDM_VOID ++ ); ++ ++ ++ ++BEAMFORMING_CAP ++phydm_Beamforming_GetBeamCap( ++ IN PVOID pDM_VOID, ++ IN PRT_BEAMFORMING_INFO pBeamInfo ++ ); ++ ++ ++BOOLEAN ++BeamformingControl_V1( ++ IN PVOID pDM_VOID, ++ pu1Byte RA, ++ u1Byte AID, ++ u1Byte Mode, ++ CHANNEL_WIDTH BW, ++ u1Byte Rate ++ ); ++ ++ ++BOOLEAN ++phydm_BeamformingControl_V2( ++ IN PVOID pDM_VOID, ++ u1Byte Idx, ++ u1Byte Mode, ++ CHANNEL_WIDTH BW, ++ u2Byte Period ++ ); ++ ++VOID ++phydm_Beamforming_Watchdog( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++Beamforming_SWTimerCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PRT_TIMER pTimer ++#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) ++ void *FunctionContext ++#endif ++ ); ++ ++BOOLEAN ++Beamforming_SendHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN CHANNEL_WIDTH BW, ++ IN u1Byte QIdx ++ ); ++ ++ ++BOOLEAN ++Beamforming_SendVHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN u2Byte AID, ++ IN CHANNEL_WIDTH BW, ++ IN u1Byte QIdx ++ ); ++ ++#else ++#define Beamforming_GidPAid(Adapter, pTcb) ++#define phydm_actingDetermine(pDM_Odm, type) FALSE ++#define Beamforming_Enter(pDM_Odm, staIdx) ++#define Beamforming_Leave(pDM_Odm, RA) ++#define Beamforming_End_FW(pDMOdm) ++#define BeamformingControl_V1(pDM_Odm, RA, AID, Mode, BW, Rate) TRUE ++#define BeamformingControl_V2(pDM_Odm, Idx, Mode, BW, Period) TRUE ++#define phydm_Beamforming_End_SW(pDM_Odm, _Status) ++#define Beamforming_TimerCallback(pDM_Odm) ++#define phydm_Beamforming_Init(pDM_Odm) ++#define phydm_BeamformingControl_V2(pDM_Odm, _Idx, _Mode, _BW, _Period) FALSE ++#define Beamforming_Watchdog(pDM_Odm) ++#define phydm_Beamforming_Watchdog(pDM_Odm) ++ ++ ++#endif ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm.c 2018-02-11 21:44:27.153146177 +0200 +@@ -0,0 +1,3340 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++const u2Byte dB_Invert_Table[12][8] = { ++ { 1, 1, 1, 2, 2, 2, 2, 3}, ++ { 3, 3, 4, 4, 4, 5, 6, 6}, ++ { 7, 8, 9, 10, 11, 13, 14, 16}, ++ { 18, 20, 22, 25, 28, 32, 35, 40}, ++ { 45, 50, 56, 63, 71, 79, 89, 100}, ++ { 112, 126, 141, 158, 178, 200, 224, 251}, ++ { 282, 316, 355, 398, 447, 501, 562, 631}, ++ { 708, 794, 891, 1000, 1122, 1259, 1413, 1585}, ++ { 1778, 1995, 2239, 2512, 2818, 3162, 3548, 3981}, ++ { 4467, 5012, 5623, 6310, 7079, 7943, 8913, 10000}, ++ { 11220, 12589, 14125, 15849, 17783, 19953, 22387, 25119}, ++ { 28184, 31623, 35481, 39811, 44668, 50119, 56234, 65535} ++}; ++ ++ ++//============================================================ ++// Local Function predefine. ++//============================================================ ++ ++/* START------------COMMON INFO RELATED--------------- */ ++ ++VOID ++odm_GlobalAdapterCheck( ++ IN VOID ++ ); ++ ++//move to odm_PowerTacking.h by YuChen ++ ++ ++ ++VOID ++odm_UpdatePowerTrainingState( ++ IN PDM_ODM_T pDM_Odm ++); ++ ++//============================================================ ++//3 Export Interface ++//============================================================ ++ ++/*Y = 10*log(X)*/ ++s4Byte ++ODM_PWdB_Conversion( ++ IN s4Byte X, ++ IN u4Byte TotalBit, ++ IN u4Byte DecimalBit ++ ) ++{ ++ s4Byte Y, integer = 0, decimal = 0; ++ u4Byte i; ++ ++ if(X == 0) ++ X = 1; // log2(x), x can't be 0 ++ ++ for(i = (TotalBit-1); i > 0; i--) ++ { ++ if(X & BIT(i)) ++ { ++ integer = i; ++ if(i > 0) ++ decimal = (X & BIT(i-1))?2:0; //decimal is 0.5dB*3=1.5dB~=2dB ++ break; ++ } ++ } ++ ++ Y = 3*(integer-DecimalBit)+decimal; //10*log(x)=3*log2(x), ++ ++ return Y; ++} ++ ++s4Byte ++ODM_SignConversion( ++ IN s4Byte value, ++ IN u4Byte TotalBit ++ ) ++{ ++ if(value&BIT(TotalBit-1)) ++ value -= BIT(TotalBit); ++ return value; ++} ++ ++void ++phydm_seq_sorting( ++ IN PVOID pDM_VOID, ++ IN OUT u4Byte *p_value, ++ IN OUT u4Byte *rank_idx, ++ IN OUT u4Byte *p_idx_out, ++ IN u1Byte seq_length ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i = 0 , j = 0; ++ u4Byte tmp_a, tmp_b; ++ u4Byte tmp_idx_a, tmp_idx_b; ++ ++ for (i = 0; i < seq_length; i++) { ++ rank_idx[i] = i; ++ /**/ ++ } ++ ++ for (i = 0; i < (seq_length - 1); i++) { ++ ++ for (j = 0; j < (seq_length - 1 - i); j++) { ++ ++ tmp_a = p_value[j]; ++ tmp_b = p_value[j+1]; ++ ++ tmp_idx_a = rank_idx[j]; ++ tmp_idx_b = rank_idx[j+1]; ++ ++ if (tmp_a < tmp_b) { ++ p_value[j] = tmp_b; ++ p_value[j+1] = tmp_a; ++ ++ rank_idx[j] = tmp_idx_b; ++ rank_idx[j+1] = tmp_idx_a; ++ } ++ } ++ } ++ ++ for (i = 0; i < seq_length; i++) { ++ p_idx_out[rank_idx[i]] = i+1; ++ /**/ ++ } ++ ++ ++ ++} ++ ++VOID ++ODM_InitMpDriverStatus( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ ++ // Decide when compile time ++ #if(MP_DRIVER == 1) ++ pDM_Odm->mp_mode = TRUE; ++ #else ++ pDM_Odm->mp_mode = FALSE; ++ #endif ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ // Update information every period ++ pDM_Odm->mp_mode = (BOOLEAN)Adapter->registrypriv.mp_mode; ++ ++#else ++ ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ ++ pDM_Odm->mp_mode = (BOOLEAN)priv->pshare->rf_ft_var.mp_specific; ++ ++#endif ++} ++ ++VOID ++ODM_UpdateMpDriverStatus( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ ++ // Do nothing. ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ // Update information erery period ++ pDM_Odm->mp_mode = (BOOLEAN)Adapter->registrypriv.mp_mode; ++ ++#else ++ ++ // Do nothing. ++ ++#endif ++} ++ ++VOID ++PHYDM_InitTRXAntennaSetting( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++/*#if (RTL8814A_SUPPORT == 1)*/ ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8814A)) { ++ u1Byte RxAnt = 0, TxAnt = 0; ++ ++ RxAnt = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG(BB_RX_PATH, pDM_Odm), ODM_BIT(BB_RX_PATH, pDM_Odm)); ++ TxAnt = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG(BB_TX_PATH, pDM_Odm), ODM_BIT(BB_TX_PATH, pDM_Odm)); ++ pDM_Odm->TXAntStatus = (TxAnt & 0xf); ++ pDM_Odm->RXAntStatus = (RxAnt & 0xf); ++ } else if (pDM_Odm->SupportICType & (ODM_RTL8723D | ODM_RTL8821C)) { ++ pDM_Odm->TXAntStatus = 0x1; ++ pDM_Odm->RXAntStatus = 0x1; ++ ++ } ++/*#endif*/ ++} ++ ++void ++phydm_traffic_load_decision( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ ++ /*---TP & Trafic-load calculation---*/ ++ ++ if (pDM_Odm->lastTxOkCnt > (*(pDM_Odm->pNumTxBytesUnicast))) ++ pDM_Odm->lastTxOkCnt = (*(pDM_Odm->pNumTxBytesUnicast)); ++ ++ if (pDM_Odm->lastRxOkCnt > (*(pDM_Odm->pNumRxBytesUnicast))) ++ pDM_Odm->lastRxOkCnt = (*(pDM_Odm->pNumRxBytesUnicast)); ++ ++ pDM_Odm->curTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast) - pDM_Odm->lastTxOkCnt; ++ pDM_Odm->curRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast) - pDM_Odm->lastRxOkCnt; ++ pDM_Odm->lastTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast); ++ pDM_Odm->lastRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast); ++ ++ #if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ pDM_Odm->tx_tp = ((pDM_Odm->tx_tp)>>1) + (u4Byte)(((pDM_Odm->curTxOkCnt)>>17)>>1); /* <<3(8bit), >>20(10^6,M)*/ ++ pDM_Odm->rx_tp = ((pDM_Odm->rx_tp)>>1) + (u4Byte)(((pDM_Odm->curRxOkCnt)>>17)>>1); /* <<3(8bit), >>20(10^6,M)*/ ++ #else ++ pDM_Odm->tx_tp = ((pDM_Odm->tx_tp)>>1) + (u4Byte)(((pDM_Odm->curTxOkCnt)>>18)>>1); /* <<3(8bit), >>20(10^6,M), >>1(2sec)*/ ++ pDM_Odm->rx_tp = ((pDM_Odm->rx_tp)>>1) + (u4Byte)(((pDM_Odm->curRxOkCnt)>>18)>>1); /* <<3(8bit), >>20(10^6,M), >>1(2sec)*/ ++ #endif ++ pDM_Odm->total_tp = pDM_Odm->tx_tp + pDM_Odm->rx_tp; ++ ++ /* ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("curTxOkCnt = %d, curRxOkCnt = %d, lastTxOkCnt = %d, lastRxOkCnt = %d\n", ++ pDM_Odm->curTxOkCnt, pDM_Odm->curRxOkCnt, pDM_Odm->lastTxOkCnt, pDM_Odm->lastRxOkCnt)); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("tx_tp = %d, rx_tp = %d\n", ++ pDM_Odm->tx_tp, pDM_Odm->rx_tp)); ++ */ ++ ++ pDM_Odm->pre_TrafficLoad = pDM_Odm->TrafficLoad; ++ ++ if (pDM_Odm->curTxOkCnt > 1875000 || pDM_Odm->curRxOkCnt > 1875000) { /* ( 1.875M * 8bit ) / 2sec= 7.5M bits /sec )*/ ++ ++ pDM_Odm->TrafficLoad = TRAFFIC_HIGH; ++ /**/ ++ } else if (pDM_Odm->curTxOkCnt > 500000 || pDM_Odm->curRxOkCnt > 500000) { /*( 0.5M * 8bit ) / 2sec = 2M bits /sec )*/ ++ ++ pDM_Odm->TrafficLoad = TRAFFIC_MID; ++ /**/ ++ } else if (pDM_Odm->curTxOkCnt > 100000 || pDM_Odm->curRxOkCnt > 100000) { /*( 0.1M * 8bit ) / 2sec = 0.4M bits /sec )*/ ++ ++ pDM_Odm->TrafficLoad = TRAFFIC_LOW; ++ /**/ ++ } else { ++ ++ pDM_Odm->TrafficLoad = TRAFFIC_ULTRA_LOW; ++ /**/ ++ } ++} ++ ++VOID ++phydm_config_ofdm_tx_path( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte path ++) ++{ ++ u1Byte ofdm_rx_path; ++ ++ #if (RTL8192E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { ++ ++ if (path == PHYDM_A) { ++ ODM_SetBBReg(pDM_Odm, 0x90c , bMaskDWord, 0x81121111); ++ /**/ ++ } else if (path == PHYDM_B) { ++ ODM_SetBBReg(pDM_Odm, 0x90c , bMaskDWord, 0x82221222); ++ /**/ ++ } else if (path == PHYDM_AB) { ++ ODM_SetBBReg(pDM_Odm, 0x90c , bMaskDWord, 0x83321333); ++ /**/ ++ } ++ ++ ++ } ++ #endif ++} ++ ++VOID ++phydm_config_ofdm_rx_path( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte path ++) ++{ ++ u1Byte ofdm_rx_path = 0; ++ ++ #if (RTL8192E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { ++ ++ if (path == PHYDM_A) { ++ ofdm_rx_path = 1; ++ /**/ ++ } else if (path == PHYDM_B) { ++ ofdm_rx_path = 2; ++ /**/ ++ } else if (path == PHYDM_AB) { ++ ofdm_rx_path = 3; ++ /**/ ++ } ++ ++ ODM_SetBBReg(pDM_Odm, 0xC04 , 0xff, (((ofdm_rx_path)<<4)|ofdm_rx_path)); ++ ODM_SetBBReg(pDM_Odm, 0xD04 , 0xf, ofdm_rx_path); ++ } ++ #endif ++} ++ ++VOID ++phydm_config_cck_rx_antenna_init( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ #if (RTL8192E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { ++ ++ /*CCK 2R CCA parameters*/ ++ ODM_SetBBReg(pDM_Odm, 0xa2c , BIT18, 1); /*enable 2R Rx path*/ ++ ODM_SetBBReg(pDM_Odm, 0xa2c , BIT22, 1); /*enable 2R MRC*/ ++ ODM_SetBBReg(pDM_Odm, 0xa84 , BIT28, 1); /*1. pdx1[5:0] > 2*PD_lim 2. RXIQ_3 = 0 ( signed )*/ ++ ODM_SetBBReg(pDM_Odm, 0xa70 , BIT7, 0); /*Concurrent CCA at LSB & USB*/ ++ ODM_SetBBReg(pDM_Odm, 0xa74 , BIT8, 0); /*RX path diversity enable*/ ++ ODM_SetBBReg(pDM_Odm, 0xa08 , BIT28, 1); /* r_cck_2nd_sel_eco*/ ++ ODM_SetBBReg(pDM_Odm, 0xa14 , BIT7, 0); /* r_en_mrc_antsel*/ ++ } ++ #endif ++} ++ ++VOID ++phydm_config_cck_rx_path( ++ IN PDM_ODM_T pDM_Odm, ++ IN u1Byte path, ++ IN u1Byte path_div_en ++) ++{ ++ u1Byte path_div_select = 0; ++ u1Byte cck_1_path = 0, cck_2_path = 0; ++ ++ #if (RTL8192E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { ++ ++ if (path == PHYDM_A) { ++ path_div_select = 0; ++ cck_1_path = 0; ++ cck_2_path = 0; ++ } else if (path == PHYDM_B) { ++ path_div_select = 0; ++ cck_1_path = 1; ++ cck_2_path = 1; ++ } else if (path == PHYDM_AB) { ++ ++ if (path_div_en == CCA_PATHDIV_ENABLE) ++ path_div_select = 1; ++ ++ cck_1_path = 0; ++ cck_2_path = 1; ++ ++ } ++ ++ ODM_SetBBReg(pDM_Odm, 0xa04 , (BIT27|BIT26), cck_1_path); ++ ODM_SetBBReg(pDM_Odm, 0xa04 , (BIT25|BIT24), cck_2_path); ++ ODM_SetBBReg(pDM_Odm, 0xa74 , BIT8, path_div_select); ++ ++ } ++ #endif ++} ++ ++VOID ++phydm_config_trx_path( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte pre_support_ability; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ /* CCK */ ++ if (dm_value[0] == 0) { ++ ++ if (dm_value[1] == 1) { /*TX*/ ++ if (dm_value[2] == 1) ++ ODM_SetBBReg(pDM_Odm, 0xa04, 0xf0000000, 0x8); ++ else if (dm_value[2] == 2) ++ ODM_SetBBReg(pDM_Odm, 0xa04, 0xf0000000, 0x4); ++ else if (dm_value[2] == 3) ++ ODM_SetBBReg(pDM_Odm, 0xa04, 0xf0000000, 0xc); ++ } else if (dm_value[1] == 2) { /*RX*/ ++ ++ phydm_config_cck_rx_antenna_init(pDM_Odm); ++ ++ if (dm_value[2] == 1) { ++ phydm_config_cck_rx_path(pDM_Odm, PHYDM_A, CCA_PATHDIV_DISABLE); ++ } else if (dm_value[2] == 2) { ++ phydm_config_cck_rx_path(pDM_Odm, PHYDM_B, CCA_PATHDIV_DISABLE); ++ } else if (dm_value[2] == 3) { ++ if (dm_value[3] == 1) /*enable path diversity*/ ++ phydm_config_cck_rx_path(pDM_Odm, PHYDM_AB, CCA_PATHDIV_ENABLE); ++ else ++ phydm_config_cck_rx_path(pDM_Odm, PHYDM_B, CCA_PATHDIV_DISABLE); ++ } ++ } ++ } ++ /* OFDM */ ++ else if (dm_value[0] == 1) { ++ ++ if (dm_value[1] == 1) { /*TX*/ ++ phydm_config_ofdm_tx_path(pDM_Odm, dm_value[2]); ++ /**/ ++ } else if (dm_value[1] == 2) { /*RX*/ ++ phydm_config_ofdm_rx_path(pDM_Odm, dm_value[2]); ++ /**/ ++ } ++ } ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "PHYDM Set Path [%s] [%s] = [%s%s%s%s]\n", ++ (dm_value[0] == 1) ? "OFDM" : "CCK", ++ (dm_value[1] == 1) ? "TX" : "RX", ++ (dm_value[2] & 0x1)?"A":"", ++ (dm_value[2] & 0x2)?"B":"", ++ (dm_value[2] & 0x4)?"C":"", ++ (dm_value[2] & 0x8)?"D":"" ++ )); ++ ++} ++ ++VOID ++phydm_Init_cck_setting( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ u4Byte value_824,value_82c; ++ ++ pDM_Odm->bCckHighPower = (BOOLEAN) ODM_GetBBReg(pDM_Odm, ODM_REG(CCK_RPT_FORMAT,pDM_Odm), ODM_BIT(CCK_RPT_FORMAT,pDM_Odm)); ++ ++ #if (RTL8192E_SUPPORT == 1) ++ if(pDM_Odm->SupportICType & (ODM_RTL8192E)) ++ { ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ phydm_config_cck_rx_antenna_init(pDM_Odm); ++ phydm_config_cck_rx_path(pDM_Odm, PHYDM_A, CCA_PATHDIV_DISABLE); ++ #endif ++ ++ /* 0x824[9] = 0x82C[9] = 0xA80[7] those registers setting should be equal or CCK RSSI report may be incorrect */ ++ value_824 = ODM_GetBBReg(pDM_Odm, 0x824, BIT9); ++ value_82c = ODM_GetBBReg(pDM_Odm, 0x82c, BIT9); ++ ++ if(value_824 != value_82c) ++ { ++ ODM_SetBBReg(pDM_Odm, 0x82c , BIT9, value_824); ++ } ++ ODM_SetBBReg(pDM_Odm, 0xa80 , BIT7, value_824); ++ pDM_Odm->cck_agc_report_type = (BOOLEAN)value_824; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("cck_agc_report_type = (( %d )), ExtLNAGain = (( %d ))\n", pDM_Odm->cck_agc_report_type, pDM_Odm->ExtLNAGain)); ++ } ++ #endif ++ ++#if ((RTL8703B_SUPPORT == 1) || (RTL8723D_SUPPORT == 1)) ++ if (pDM_Odm->SupportICType & (ODM_RTL8703B|ODM_RTL8723D)) { ++ ++ pDM_Odm->cck_agc_report_type = ODM_GetBBReg(pDM_Odm, 0x950, BIT11) ? 1 : 0; /*1: 4bit LNA , 0: 3bit LNA */ ++ ++ if (pDM_Odm->cck_agc_report_type != 1) { ++ DbgPrint("[Warning] 8703B/8723D CCK should be 4bit LNA, ie. 0x950[11] = 1\n"); ++ /**/ ++ } ++ } ++#endif ++ ++#if ((RTL8723D_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8723D|ODM_RTL8822B|ODM_RTL8197F)) { ++ pDM_Odm->cck_new_agc = ODM_GetBBReg(pDM_Odm, 0xa9c, BIT17)?TRUE:FALSE; /*1: new agc 0: old agc*/ ++ } else ++#endif ++ pDM_Odm->cck_new_agc = FALSE; ++ ++} ++ ++VOID ++PHYDM_InitSoftMLSetting( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->mp_mode == FALSE) { ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ ODM_SetBBReg(pDM_Odm, 0x19a8, bMaskDWord, 0xc10a0000); ++ } ++#endif ++} ++ ++VOID ++PHYDM_InitHwInfoByRfe( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ phydm_init_hw_info_by_rfe_type_8822b(pDM_Odm); ++#endif ++} ++ ++VOID ++odm_CommonInfoSelfInit( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++ phydm_Init_cck_setting(pDM_Odm); ++ pDM_Odm->RFPathRxEnable = (u1Byte) ODM_GetBBReg(pDM_Odm, ODM_REG(BB_RX_PATH,pDM_Odm), ODM_BIT(BB_RX_PATH,pDM_Odm)); ++#if (DM_ODM_SUPPORT_TYPE != ODM_CE) ++ pDM_Odm->pbNet_closed = &pDM_Odm->BOOLEAN_temp; ++ ++ PHYDM_InitDebugSetting(pDM_Odm); ++#endif ++ ODM_InitMpDriverStatus(pDM_Odm); ++ PHYDM_InitTRXAntennaSetting(pDM_Odm); ++ PHYDM_InitSoftMLSetting(pDM_Odm); ++ ++ pDM_Odm->phydm_period = PHYDM_WATCH_DOG_PERIOD; ++ pDM_Odm->phydm_sys_up_time = 0; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_1SS) ++ pDM_Odm->num_rf_path = 1; ++ else if (pDM_Odm->SupportICType & ODM_IC_2SS) ++ pDM_Odm->num_rf_path = 2; ++ else if(pDM_Odm->SupportICType & ODM_IC_3SS ) ++ pDM_Odm->num_rf_path = 3; ++ else if(pDM_Odm->SupportICType & ODM_IC_4SS ) ++ pDM_Odm->num_rf_path = 4; ++ ++ pDM_Odm->TxRate = 0xFF; ++ ++ pDM_Odm->number_linked_client = 0; ++ pDM_Odm->pre_number_linked_client = 0; ++ pDM_Odm->number_active_client = 0; ++ pDM_Odm->pre_number_active_client = 0; ++ ++ pDM_Odm->lastTxOkCnt = 0; ++ pDM_Odm->lastRxOkCnt = 0; ++ pDM_Odm->tx_tp = 0; ++ pDM_Odm->rx_tp = 0; ++ pDM_Odm->total_tp = 0; ++ pDM_Odm->TrafficLoad = TRAFFIC_LOW; ++ ++ pDM_Odm->nbi_set_result = 0; ++ ++} ++ ++VOID ++odm_CommonInfoSelfUpdate( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++ u1Byte EntryCnt = 0, num_active_client = 0; ++ u4Byte i, OneEntry_MACID = 0, ma_rx_tp = 0; ++ PSTA_INFO_T pEntry; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ ++ pEntry = pDM_Odm->pODM_StaInfo[0]; ++ if (pMgntInfo->mAssoc) { ++ pEntry->bUsed = TRUE; ++ for (i = 0; i < 6; i++) ++ pEntry->MacAddr[i] = pMgntInfo->Bssid[i]; ++ } else if (GetFirstClientPort(Adapter)) { ++ PADAPTER pClientAdapter = GetFirstClientPort(Adapter); ++ ++ pEntry->bUsed = TRUE; ++ for (i = 0; i < 6; i++) ++ pEntry->MacAddr[i] = pClientAdapter->MgntInfo.Bssid[i]; ++ } else { ++ pEntry->bUsed = FALSE; ++ for (i = 0; i < 6; i++) ++ pEntry->MacAddr[i] = 0; ++ } ++ ++ //STA mode is linked to AP ++ if(IS_STA_VALID(pDM_Odm->pODM_StaInfo[0]) && !ACTING_AS_AP(Adapter)) ++ pDM_Odm->bsta_state = TRUE; ++ else ++ pDM_Odm->bsta_state = FALSE; ++#endif ++ ++/* THis variable cannot be used because it is wrong*/ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) ++ { ++ if (*(pDM_Odm->pSecChOffset) == 1) ++ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) + 2; ++ else if (*(pDM_Odm->pSecChOffset) == 2) ++ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) - 2; ++ } else if (*(pDM_Odm->pBandWidth) == ODM_BW80M) { ++ if (*(pDM_Odm->pSecChOffset) == 1) ++ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) + 6; ++ else if (*(pDM_Odm->pSecChOffset) == 2) ++ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) - 6; ++ } else ++ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel); ++#else ++ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) { ++ if (*(pDM_Odm->pSecChOffset) == 1) ++ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) - 2; ++ else if (*(pDM_Odm->pSecChOffset) == 2) ++ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) + 2; ++ } else ++ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel); ++#endif ++ ++ for (i=0; ipODM_StaInfo[i]; ++ if(IS_STA_VALID(pEntry)) ++ { ++ EntryCnt++; ++ if(EntryCnt==1) ++ { ++ OneEntry_MACID=i; ++ } ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ma_rx_tp = (pEntry->rx_byte_cnt_LowMAW)<<3; /* low moving average RX TP ( bit /sec)*/ ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("ClientTP[%d]: ((%d )) bit/sec\n", i, ma_rx_tp)); ++ ++ if (ma_rx_tp > ACTIVE_TP_THRESHOLD) ++ num_active_client++; ++ #endif ++ } ++ } ++ ++ if(EntryCnt == 1) ++ { ++ pDM_Odm->bOneEntryOnly = TRUE; ++ pDM_Odm->OneEntry_MACID=OneEntry_MACID; ++ } ++ else ++ pDM_Odm->bOneEntryOnly = FALSE; ++ ++ pDM_Odm->pre_number_linked_client = pDM_Odm->number_linked_client; ++ pDM_Odm->pre_number_active_client = pDM_Odm->number_active_client; ++ ++ pDM_Odm->number_linked_client = EntryCnt; ++ pDM_Odm->number_active_client = num_active_client; ++ ++ /* Update MP driver status*/ ++ ODM_UpdateMpDriverStatus(pDM_Odm); ++ ++ /*Traffic load information update*/ ++ phydm_traffic_load_decision(pDM_Odm); ++ ++ pDM_Odm->phydm_sys_up_time += pDM_Odm->phydm_period; ++} ++ ++VOID ++odm_CommonInfoSelfReset( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt = 0; ++#endif ++} ++ ++PVOID ++PhyDM_Get_Structure( ++ IN PDM_ODM_T pDM_Odm, ++ IN u1Byte Structure_Type ++) ++ ++{ ++ PVOID pStruct = NULL; ++#if RTL8195A_SUPPORT ++ switch (Structure_Type){ ++ case PHYDM_FALSEALMCNT: ++ pStruct = &FalseAlmCnt; ++ break; ++ ++ case PHYDM_CFOTRACK: ++ pStruct = &DM_CfoTrack; ++ break; ++ ++ case PHYDM_ADAPTIVITY: ++ pStruct = &(pDM_Odm->Adaptivity); ++ break; ++ ++ default: ++ break; ++ } ++ ++#else ++ switch (Structure_Type){ ++ case PHYDM_FALSEALMCNT: ++ pStruct = &(pDM_Odm->FalseAlmCnt); ++ break; ++ ++ case PHYDM_CFOTRACK: ++ pStruct = &(pDM_Odm->DM_CfoTrack); ++ break; ++ ++ case PHYDM_ADAPTIVITY: ++ pStruct = &(pDM_Odm->Adaptivity); ++ break; ++ ++ default: ++ break; ++ } ++ ++#endif ++ return pStruct; ++} ++ ++VOID ++odm_HWSetting( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++#if (RTL8821A_SUPPORT == 1) ++ if(pDM_Odm->SupportICType & ODM_RTL8821) ++ odm_HWSetting_8821A(pDM_Odm); ++#endif ++ ++#if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ phydm_hwsetting_8814a(pDM_Odm); ++#endif ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ phydm_hwsetting_8822b(pDM_Odm); ++#endif ++} ++#if SUPPORTABLITY_PHYDMLIZE ++VOID ++phydm_supportability_Init( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte support_ability = 0; ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ #endif ++ ++ if (pDM_Odm->SupportICType != ODM_RTL8821C) ++ return; ++ ++ switch (pDM_Odm->SupportICType) ++ { ++ ++ /*---------------N Series--------------------*/ ++ case ODM_RTL8188E: ++ support_ability |= ++ ODM_BB_DIG | ++ ODM_BB_RA_MASK | ++ ODM_BB_DYNAMIC_TXPWR | ++ ODM_BB_FA_CNT | ++ ODM_BB_RSSI_MONITOR | ++ ODM_BB_CCK_PD | ++ ODM_RF_TX_PWR_TRACK | ++ ODM_RF_RX_GAIN_TRACK | ++ ODM_RF_CALIBRATION | ++ ODM_MAC_EDCA_TURBO | ++ ODM_MAC_EARLY_MODE | ++ ODM_BB_CFO_TRACKING | ++ ODM_BB_NHM_CNT | ++ ODM_BB_PRIMARY_CCA; ++ break; ++ ++ case ODM_RTL8192E: ++ support_ability |= ++ ODM_BB_DIG | ++ ODM_RF_TX_PWR_TRACK | ++ ODM_BB_RA_MASK | ++ ODM_BB_FA_CNT | ++ ODM_BB_RSSI_MONITOR | ++ ODM_MAC_EDCA_TURBO | ++ ODM_BB_CFO_TRACKING | ++/* ODM_BB_PWR_TRAIN |*/ ++ ODM_BB_NHM_CNT | ++ ODM_BB_PRIMARY_CCA; ++ break; ++ ++ case ODM_RTL8723B: ++ support_ability |= ++ ODM_BB_DIG | ++ ODM_BB_RA_MASK | ++ ODM_BB_FA_CNT | ++ ODM_BB_RSSI_MONITOR | ++ ODM_BB_CCK_PD | ++ ODM_RF_TX_PWR_TRACK | ++ ODM_RF_RX_GAIN_TRACK | ++ ODM_RF_CALIBRATION | ++ ODM_MAC_EDCA_TURBO | ++ ODM_BB_CFO_TRACKING | ++/* ODM_BB_PWR_TRAIN |*/ ++ ODM_BB_NHM_CNT; ++ break; ++ ++ case ODM_RTL8703B: ++ support_ability |= ++ ODM_BB_DIG | ++ ODM_BB_RA_MASK | ++ ODM_BB_FA_CNT | ++ ODM_BB_RSSI_MONITOR | ++ ODM_BB_CCK_PD | ++ ODM_BB_CFO_TRACKING | ++ //ODM_BB_PWR_TRAIN | ++ ODM_BB_NHM_CNT | ++ ODM_RF_TX_PWR_TRACK | ++ //ODM_RF_RX_GAIN_TRACK | ++ ODM_RF_CALIBRATION | ++ ODM_MAC_EDCA_TURBO; ++ break; ++ ++ case ODM_RTL8723D: ++ support_ability |= ++ ODM_BB_DIG | ++ ODM_BB_RA_MASK | ++ ODM_BB_FA_CNT | ++ ODM_BB_RSSI_MONITOR | ++ ODM_BB_CCK_PD | ++ ODM_BB_CFO_TRACKING | ++ //ODM_BB_PWR_TRAIN | ++ ODM_BB_NHM_CNT | ++ ODM_RF_TX_PWR_TRACK | ++ //ODM_RF_RX_GAIN_TRACK | ++ //ODM_RF_CALIBRATION | ++ ODM_MAC_EDCA_TURBO; ++ break; ++ ++ case ODM_RTL8188F: ++ support_ability |= ++ ODM_BB_DIG | ++ ODM_BB_RA_MASK | ++ ODM_BB_FA_CNT | ++ ODM_BB_RSSI_MONITOR | ++ ODM_BB_CCK_PD | ++ ODM_MAC_EDCA_TURBO | ++ ODM_BB_CFO_TRACKING | ++ ODM_BB_NHM_CNT | ++ ODM_RF_TX_PWR_TRACK | ++ ODM_RF_CALIBRATION; ++ break; ++ /*---------------AC Series-------------------*/ ++ ++ case ODM_RTL8812: ++ case ODM_RTL8821: ++ support_ability |= ++ ODM_BB_DIG | ++ ODM_BB_FA_CNT | ++ ODM_BB_RSSI_MONITOR | ++ ODM_BB_RA_MASK | ++ ODM_RF_TX_PWR_TRACK | ++ ODM_MAC_EDCA_TURBO | ++ ODM_BB_CFO_TRACKING | ++/* ODM_BB_PWR_TRAIN |*/ ++ ODM_BB_DYNAMIC_TXPWR | ++ ODM_BB_NHM_CNT; ++ break; ++ ++ case ODM_RTL8814A: ++ support_ability |= ++ ODM_BB_DIG | ++ ODM_BB_FA_CNT | ++ ODM_BB_RSSI_MONITOR | ++ ODM_BB_RA_MASK | ++ ODM_RF_TX_PWR_TRACK | ++ ODM_BB_CCK_PD | ++ ODM_MAC_EDCA_TURBO | ++ ODM_BB_CFO_TRACKING | ++ ODM_BB_DYNAMIC_TXPWR | ++ ODM_BB_NHM_CNT; ++ break; ++ ++ case ODM_RTL8822B: ++ support_ability |= ++ ODM_BB_DIG | ++ ODM_BB_FA_CNT | ++ ODM_BB_CCK_PD | ++ ODM_BB_CFO_TRACKING | ++ ODM_BB_RATE_ADAPTIVE | ++ ODM_BB_RSSI_MONITOR | ++ ODM_BB_RA_MASK | ++ ODM_RF_TX_PWR_TRACK | ++ ODM_MAC_EDCA_TURBO; ++ break; ++ ++ case ODM_RTL8821C: ++ support_ability |= ++ ODM_BB_DIG | ++ ODM_BB_RA_MASK | ++ ODM_BB_CCK_PD | ++ ODM_BB_FA_CNT | ++ ODM_BB_RSSI_MONITOR | ++ ODM_BB_RATE_ADAPTIVE | ++ ODM_RF_TX_PWR_TRACK | ++ ODM_MAC_EDCA_TURBO | ++ ODM_BB_CFO_TRACKING; //| ++/* ODM_BB_DYNAMIC_TXPWR |*/ ++/* ODM_BB_NHM_CNT;*/ ++ break; ++ default: ++ DbgPrint("[Warning] Supportability Init error !!!\n"); ++ break; ++ ++ } ++ ++ if(*(pDM_Odm->p_enable_antdiv)) ++ support_ability |= ODM_BB_ANT_DIV; ++ ++ if (*(pDM_Odm->p_enable_adaptivity)) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM Adaptivity is set to Enabled!!!\n")); ++ ++ support_ability |= ODM_BB_ADAPTIVITY; ++ ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE, pMgntInfo->RegEnableCarrierSense); ++ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_DCBACKOFF, pMgntInfo->RegDCbackoff); ++ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY, pMgntInfo->RegDmLinkAdaptivity); ++ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_AP_NUM_TH, pMgntInfo->RegAPNumTH); ++ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_TH_L2H_INI, pMgntInfo->RegL2HForAdaptivity); ++ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, pMgntInfo->RegHLDiffForAdaptivity); ++ #endif ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM Adaptivity is set to disnabled!!!\n")); ++ /**/ ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("PHYDM support_ability = ((0x%x))\n", support_ability)); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_ABILITY, support_ability); ++} ++#endif ++ ++// ++// 2011/09/21 MH Add to describe different team necessary resource allocate?? ++// ++VOID ++ODM_DMInit( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++#endif ++ ++ #if SUPPORTABLITY_PHYDMLIZE ++ phydm_supportability_Init(pDM_Odm); ++ #endif ++ odm_CommonInfoSelfInit(pDM_Odm); ++ odm_DIGInit(pDM_Odm); ++ Phydm_NHMCounterStatisticsInit(pDM_Odm); ++ Phydm_AdaptivityInit(pDM_Odm); ++ phydm_ra_info_init(pDM_Odm); ++ odm_RateAdaptiveMaskInit(pDM_Odm); ++ ODM_CfoTrackingInit(pDM_Odm); ++ ODM_EdcaTurboInit(pDM_Odm); ++ odm_RSSIMonitorInit(pDM_Odm); ++ phydm_rf_init(pDM_Odm); ++ odm_TXPowerTrackingInit(pDM_Odm); ++ odm_AntennaDiversityInit(pDM_Odm); ++ odm_AutoChannelSelectInit(pDM_Odm); ++ odm_PathDiversityInit(pDM_Odm); ++ odm_DynamicTxPowerInit(pDM_Odm); ++ phydm_initRaInfo(pDM_Odm); ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) ++#if (PHYDM_LA_MODE_SUPPORT == 1) ++ ADCSmp_Init(pDM_Odm); ++#endif ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) ++#ifdef BEAMFORMING_VERSION_1 ++ if (pHalData->BeamformingVersion == BEAMFORMING_VERSION_1) ++#endif ++ { ++ phydm_Beamforming_Init(pDM_Odm); ++ } ++#endif ++ ++ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ { ++#if (defined(CONFIG_BB_POWER_SAVING)) ++ odm_DynamicBBPowerSavingInit(pDM_Odm); ++#endif ++ ++#if (RTL8188E_SUPPORT == 1) ++ if(pDM_Odm->SupportICType==ODM_RTL8188E) ++ { ++ ODM_PrimaryCCA_Init(pDM_Odm); ++ ODM_RAInfo_Init_all(pDM_Odm); ++ } ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ ++ #if (RTL8723B_SUPPORT == 1) ++ if(pDM_Odm->SupportICType == ODM_RTL8723B) ++ odm_SwAntDetectInit(pDM_Odm); ++ #endif ++ ++ #if (RTL8192E_SUPPORT == 1) ++ if(pDM_Odm->SupportICType==ODM_RTL8192E) ++ odm_PrimaryCCA_Check_Init(pDM_Odm); ++ #endif ++ ++#endif ++ ++ } ++ ++} ++ ++VOID ++ODM_DMReset( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++ ODM_AntDivReset(pDM_Odm); ++ phydm_setEDCCAThresholdAPI(pDM_Odm, pDM_DigTable->CurIGValue); ++} ++ ++ ++VOID ++phydm_support_ability_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte pre_support_ability; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ pre_support_ability = pDM_Odm->SupportAbility ; ++ PHYDM_SNPRINTF((output+used, out_len-used,"\n%s\n", "================================")); ++ if(dm_value[0] == 100) ++ { ++ PHYDM_SNPRINTF((output+used, out_len-used, "[Supportability] PhyDM Selection\n")); ++ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "================================")); ++ PHYDM_SNPRINTF((output+used, out_len-used, "00. (( %s ))DIG\n", ((pDM_Odm->SupportAbility & ODM_BB_DIG)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "01. (( %s ))RA_MASK\n", ((pDM_Odm->SupportAbility & ODM_BB_RA_MASK)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "02. (( %s ))DYNAMIC_TXPWR\n", ((pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "03. (( %s ))FA_CNT\n", ((pDM_Odm->SupportAbility & ODM_BB_FA_CNT)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "04. (( %s ))RSSI_MONITOR\n", ((pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "05. (( %s ))CCK_PD\n", ((pDM_Odm->SupportAbility & ODM_BB_CCK_PD)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "06. (( %s ))ANT_DIV\n", ((pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "08. (( %s ))PWR_TRAIN\n", ((pDM_Odm->SupportAbility & ODM_BB_PWR_TRAIN)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "09. (( %s ))RATE_ADAPTIVE\n", ((pDM_Odm->SupportAbility & ODM_BB_RATE_ADAPTIVE)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "10. (( %s ))PATH_DIV\n", ((pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "13. (( %s ))ADAPTIVITY\n", ((pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "14. (( %s ))CFO_TRACKING\n", ((pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "15. (( %s ))NHM_CNT\n", ((pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "16. (( %s ))PRIMARY_CCA\n", ((pDM_Odm->SupportAbility & ODM_BB_PRIMARY_CCA)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "17. (( %s ))TXBF\n", ((pDM_Odm->SupportAbility & ODM_BB_TXBF)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "18. (( %s ))DYNAMIC_ARFR\n", ((pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_ARFR)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "20. (( %s ))EDCA_TURBO\n", ((pDM_Odm->SupportAbility & ODM_MAC_EDCA_TURBO)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "21. (( %s ))EARLY_MODE\n", ((pDM_Odm->SupportAbility & ODM_MAC_EARLY_MODE)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "24. (( %s ))TX_PWR_TRACK\n", ((pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "25. (( %s ))RX_GAIN_TRACK\n", ((pDM_Odm->SupportAbility & ODM_RF_RX_GAIN_TRACK)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used, "26. (( %s ))RF_CALIBRATION\n", ((pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)?("V"):(".")))); ++ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "================================")); ++ } ++ /* ++ else if(dm_value[0] == 101) ++ { ++ pDM_Odm->SupportAbility = 0 ; ++ DbgPrint("Disable all SupportAbility components \n"); ++ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "Disable all SupportAbility components")); ++ } ++ */ ++ else ++ { ++ ++ if(dm_value[1] == 1) //enable ++ { ++ pDM_Odm->SupportAbility |= BIT(dm_value[0]) ; ++ if(BIT(dm_value[0]) & ODM_BB_PATH_DIV) ++ { ++ odm_PathDiversityInit(pDM_Odm); ++ } ++ } ++ else if(dm_value[1] == 2) //disable ++ { ++ pDM_Odm->SupportAbility &= ~(BIT(dm_value[0])) ; ++ } ++ else ++ { ++ //DbgPrint("\n[Warning!!!] 1:enable, 2:disable \n\n"); ++ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "[Warning!!!] 1:enable, 2:disable")); ++ } ++ } ++ PHYDM_SNPRINTF((output+used, out_len-used,"pre-SupportAbility = 0x%x\n", pre_support_ability )); ++ PHYDM_SNPRINTF((output+used, out_len-used,"Curr-SupportAbility = 0x%x\n", pDM_Odm->SupportAbility )); ++ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "================================")); ++} ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++// ++//tmp modify for LC Only ++// ++VOID ++ODM_DMWatchdog_LPS( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++ odm_CommonInfoSelfUpdate(pDM_Odm); ++ odm_FalseAlarmCounterStatistics(pDM_Odm); ++ odm_RSSIMonitorCheck(pDM_Odm); ++ odm_DIGbyRSSI_LPS(pDM_Odm); ++ odm_CCKPacketDetectionThresh(pDM_Odm); ++ odm_CommonInfoSelfReset(pDM_Odm); ++ ++ if(*(pDM_Odm->pbPowerSaving)==TRUE) ++ return; ++} ++#endif ++// ++// 2011/09/20 MH This is the entry pointer for all team to execute HW out source DM. ++// You can not add any dummy function here, be care, you can only use DM structure ++// to perform any new ODM_DM. ++// ++VOID ++ODM_DMWatchdog( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++ odm_CommonInfoSelfUpdate(pDM_Odm); ++ phydm_BasicDbgMessage(pDM_Odm); ++ odm_HWSetting(pDM_Odm); ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ { ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ if( (priv->auto_channel != 0) && (priv->auto_channel != 2) )//if ACS running, do not do FA/CCA counter read ++ return; ++ } ++#endif ++ odm_FalseAlarmCounterStatistics(pDM_Odm); ++ phydm_NoisyDetection(pDM_Odm); ++ ++ odm_RSSIMonitorCheck(pDM_Odm); ++ ++ if(*(pDM_Odm->pbPowerSaving) == TRUE) ++ { ++ odm_DIGbyRSSI_LPS(pDM_Odm); ++ { ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ Phydm_Adaptivity(pDM_Odm, pDM_DigTable->CurIGValue); ++ } ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++ odm_AntennaDiversity(pDM_Odm); /*enable AntDiv in PS mode, request from SD4 Jeff*/ ++ #endif ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("DMWatchdog in power saving mode\n")); ++ return; ++ } ++ ++ Phydm_CheckAdaptivity(pDM_Odm); ++ odm_UpdatePowerTrainingState(pDM_Odm); ++ odm_DIG(pDM_Odm); ++ { ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ Phydm_Adaptivity(pDM_Odm, pDM_DigTable->CurIGValue); ++ } ++ odm_CCKPacketDetectionThresh(pDM_Odm); ++ ++ phydm_ra_info_watchdog(pDM_Odm); ++ odm_EdcaTurboCheck(pDM_Odm); ++ odm_PathDiversity(pDM_Odm); ++ ODM_CfoTracking(pDM_Odm); ++ odm_DynamicTxPower(pDM_Odm); ++ odm_AntennaDiversity(pDM_Odm); ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) ++ phydm_Beamforming_Watchdog(pDM_Odm); ++#endif ++ ++ phydm_rf_watchdog(pDM_Odm); ++ ++ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ { ++ ++#if (RTL8188E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) ++ ODM_DynamicPrimaryCCA(pDM_Odm); ++#endif ++ ++#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ ++ #if (RTL8192E_SUPPORT == 1) ++ if(pDM_Odm->SupportICType==ODM_RTL8192E) ++ odm_DynamicPrimaryCCA_Check(pDM_Odm); ++ #endif ++#endif ++ } ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ odm_dtc(pDM_Odm); ++#endif ++ ++ odm_CommonInfoSelfReset(pDM_Odm); ++ ++} ++ ++ ++// ++// Init /.. Fixed HW value. Only init time. ++// ++VOID ++ODM_CmnInfoInit( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_CMNINFO_E CmnInfo, ++ IN u4Byte Value ++ ) ++{ ++ // ++ // This section is used for init value ++ // ++ switch (CmnInfo) ++ { ++ // ++ // Fixed ODM value. ++ // ++ case ODM_CMNINFO_ABILITY: ++ pDM_Odm->SupportAbility = (u4Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_RF_TYPE: ++ pDM_Odm->RFType = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_PLATFORM: ++ pDM_Odm->SupportPlatform = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_INTERFACE: ++ pDM_Odm->SupportInterface = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_MP_TEST_CHIP: ++ pDM_Odm->bIsMPChip= (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_IC_TYPE: ++ pDM_Odm->SupportICType = Value; ++ break; ++ ++ case ODM_CMNINFO_CUT_VER: ++ pDM_Odm->CutVersion = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_FAB_VER: ++ pDM_Odm->FabVersion = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_RFE_TYPE: ++ pDM_Odm->RFEType = (u1Byte)Value; ++ PHYDM_InitHwInfoByRfe(pDM_Odm); ++ break; ++ ++ case ODM_CMNINFO_RF_ANTENNA_TYPE: ++ pDM_Odm->AntDivType= (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH: ++ pDM_Odm->with_extenal_ant_switch = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_BE_FIX_TX_ANT: ++ pDM_Odm->DM_FatTable.b_fix_tx_ant = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_BOARD_TYPE: ++ if (!pDM_Odm->bInitHwInfoByRfe) ++ pDM_Odm->BoardType = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_PACKAGE_TYPE: ++ if (!pDM_Odm->bInitHwInfoByRfe) ++ pDM_Odm->PackageType = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_EXT_LNA: ++ if (!pDM_Odm->bInitHwInfoByRfe) ++ pDM_Odm->ExtLNA = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_5G_EXT_LNA: ++ if (!pDM_Odm->bInitHwInfoByRfe) ++ pDM_Odm->ExtLNA5G = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_EXT_PA: ++ if (!pDM_Odm->bInitHwInfoByRfe) ++ pDM_Odm->ExtPA = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_5G_EXT_PA: ++ if (!pDM_Odm->bInitHwInfoByRfe) ++ pDM_Odm->ExtPA5G = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_GPA: ++ if (!pDM_Odm->bInitHwInfoByRfe) ++ pDM_Odm->TypeGPA = (u2Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_APA: ++ if (!pDM_Odm->bInitHwInfoByRfe) ++ pDM_Odm->TypeAPA = (u2Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_GLNA: ++ if (!pDM_Odm->bInitHwInfoByRfe) ++ pDM_Odm->TypeGLNA = (u2Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_ALNA: ++ if (!pDM_Odm->bInitHwInfoByRfe) ++ pDM_Odm->TypeALNA = (u2Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_EXT_TRSW: ++ pDM_Odm->ExtTRSW = (u1Byte)Value; ++ break; ++ case ODM_CMNINFO_EXT_LNA_GAIN: ++ pDM_Odm->ExtLNAGain = (u1Byte)Value; ++ break; ++ case ODM_CMNINFO_PATCH_ID: ++ pDM_Odm->PatchID = (u1Byte)Value; ++ break; ++ case ODM_CMNINFO_BINHCT_TEST: ++ pDM_Odm->bInHctTest = (BOOLEAN)Value; ++ break; ++ case ODM_CMNINFO_BWIFI_TEST: ++ pDM_Odm->WIFITest = (u1Byte)Value; ++ break; ++ case ODM_CMNINFO_SMART_CONCURRENT: ++ pDM_Odm->bDualMacSmartConcurrent = (BOOLEAN )Value; ++ break; ++ case ODM_CMNINFO_DOMAIN_CODE_2G: ++ pDM_Odm->odm_Regulation2_4G = (u1Byte)Value; ++ break; ++ case ODM_CMNINFO_DOMAIN_CODE_5G: ++ pDM_Odm->odm_Regulation5G = (u1Byte)Value; ++ break; ++ case ODM_CMNINFO_CONFIG_BB_RF: ++ pDM_Odm->ConfigBBRF = (BOOLEAN)Value; ++ break; ++ case ODM_CMNINFO_IQKFWOFFLOAD: ++ pDM_Odm->IQKFWOffload = (u1Byte)Value; ++ break; ++ case ODM_CMNINFO_IQKPAOFF: ++ pDM_Odm->RFCalibrateInfo.bIQKPAoff = (BOOLEAN )Value; ++ break; ++ case ODM_CMNINFO_REGRFKFREEENABLE: ++ pDM_Odm->RFCalibrateInfo.RegRfKFreeEnable = (u1Byte)Value; ++ break; ++ case ODM_CMNINFO_RFKFREEENABLE: ++ pDM_Odm->RFCalibrateInfo.RfKFreeEnable = (u1Byte)Value; ++ break; ++ case ODM_CMNINFO_NORMAL_RX_PATH_CHANGE: ++ pDM_Odm->Normalrxpath = (u1Byte)Value; ++ break; ++#ifdef CONFIG_PHYDM_DFS_MASTER ++ case ODM_CMNINFO_DFS_REGION_DOMAIN: ++ pDM_Odm->DFS_RegionDomain = (u1Byte)Value; ++ break; ++#endif ++ //To remove the compiler warning, must add an empty default statement to handle the other values. ++ default: ++ //do nothing ++ break; ++ ++ } ++ ++} ++ ++ ++VOID ++ODM_CmnInfoHook( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_CMNINFO_E CmnInfo, ++ IN PVOID pValue ++ ) ++{ ++ // ++ // Hook call by reference pointer. ++ // ++ switch (CmnInfo) ++ { ++ // ++ // Dynamic call by reference pointer. ++ // ++ case ODM_CMNINFO_MAC_PHY_MODE: ++ pDM_Odm->pMacPhyMode = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_TX_UNI: ++ pDM_Odm->pNumTxBytesUnicast = (u8Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_RX_UNI: ++ pDM_Odm->pNumRxBytesUnicast = (u8Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_WM_MODE: ++ pDM_Odm->pWirelessMode = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_BAND: ++ pDM_Odm->pBandType = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_SEC_CHNL_OFFSET: ++ pDM_Odm->pSecChOffset = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_SEC_MODE: ++ pDM_Odm->pSecurity = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_BW: ++ pDM_Odm->pBandWidth = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_CHNL: ++ pDM_Odm->pChannel = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_DMSP_GET_VALUE: ++ pDM_Odm->pbGetValueFromOtherMac = (BOOLEAN *)pValue; ++ break; ++ ++ case ODM_CMNINFO_BUDDY_ADAPTOR: ++ pDM_Odm->pBuddyAdapter = (PADAPTER *)pValue; ++ break; ++ ++ case ODM_CMNINFO_DMSP_IS_MASTER: ++ pDM_Odm->pbMasterOfDMSP = (BOOLEAN *)pValue; ++ break; ++ ++ case ODM_CMNINFO_SCAN: ++ pDM_Odm->pbScanInProcess = (BOOLEAN *)pValue; ++ break; ++ ++ case ODM_CMNINFO_POWER_SAVING: ++ pDM_Odm->pbPowerSaving = (BOOLEAN *)pValue; ++ break; ++ ++ case ODM_CMNINFO_ONE_PATH_CCA: ++ pDM_Odm->pOnePathCCA = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_DRV_STOP: ++ pDM_Odm->pbDriverStopped = (BOOLEAN *)pValue; ++ break; ++ ++ case ODM_CMNINFO_PNP_IN: ++ pDM_Odm->pbDriverIsGoingToPnpSetPowerSleep = (BOOLEAN *)pValue; ++ break; ++ ++ case ODM_CMNINFO_INIT_ON: ++ pDM_Odm->pinit_adpt_in_progress = (BOOLEAN *)pValue; ++ break; ++ ++ case ODM_CMNINFO_ANT_TEST: ++ pDM_Odm->pAntennaTest = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_NET_CLOSED: ++ pDM_Odm->pbNet_closed = (BOOLEAN *)pValue; ++ break; ++ ++ case ODM_CMNINFO_FORCED_RATE: ++ pDM_Odm->pForcedDataRate = (pu2Byte)pValue; ++ break; ++ case ODM_CMNINFO_ANT_DIV: ++ pDM_Odm->p_enable_antdiv = (pu1Byte)pValue; ++ break; ++ case ODM_CMNINFO_ADAPTIVITY: ++ pDM_Odm->p_enable_adaptivity = (pu1Byte)pValue; ++ break; ++ case ODM_CMNINFO_FORCED_IGI_LB: ++ pDM_Odm->pu1ForcedIgiLb = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_P2P_LINK: ++ pDM_Odm->DM_DigTable.bP2PInProcess = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_IS1ANTENNA: ++ pDM_Odm->pIs1Antenna = (BOOLEAN *)pValue; ++ break; ++ ++ case ODM_CMNINFO_RFDEFAULTPATH: ++ pDM_Odm->pRFDefaultPath= (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_FCS_MODE: ++ pDM_Odm->pIsFcsModeEnable = (BOOLEAN *)pValue; ++ break; ++ /*add by YuChen for beamforming PhyDM*/ ++ case ODM_CMNINFO_HUBUSBMODE: ++ pDM_Odm->HubUsbMode = (u1Byte *)pValue; ++ break; ++ case ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS: ++ pDM_Odm->pbFwDwRsvdPageInProgress = (BOOLEAN *)pValue; ++ break; ++ case ODM_CMNINFO_TX_TP: ++ pDM_Odm->pCurrentTxTP = (u4Byte *)pValue; ++ break; ++ case ODM_CMNINFO_RX_TP: ++ pDM_Odm->pCurrentRxTP = (u4Byte *)pValue; ++ break; ++ case ODM_CMNINFO_SOUNDING_SEQ: ++ pDM_Odm->pSoundingSeq = (u1Byte *)pValue; ++ break; ++#ifdef CONFIG_PHYDM_DFS_MASTER ++ case ODM_CMNINFO_DFS_MASTER_ENABLE: ++ pDM_Odm->dfs_master_enabled = (u1Byte *)pValue; ++ break; ++#endif ++ case ODM_CMNINFO_FORCE_TX_ANT_BY_TXDESC: ++ pDM_Odm->DM_FatTable.pForceTxAntByDesc = (u1Byte *)pValue; ++ break; ++ case ODM_CMNINFO_SET_S0S1_DEFAULT_ANTENNA: ++ pDM_Odm->DM_FatTable.pDefaultS0S1 = (u1Byte *)pValue; ++ break; ++ ++ default: ++ /*do nothing*/ ++ break; ++ ++ } ++ ++} ++ ++ ++VOID ++ODM_CmnInfoPtrArrayHook( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_CMNINFO_E CmnInfo, ++ IN u2Byte Index, ++ IN PVOID pValue ++ ) ++{ ++ /*Hook call by reference pointer.*/ ++ switch (CmnInfo) ++ { ++ /*Dynamic call by reference pointer. */ ++ case ODM_CMNINFO_STA_STATUS: ++ pDM_Odm->pODM_StaInfo[Index] = (PSTA_INFO_T)pValue; ++ ++ if (IS_STA_VALID(pDM_Odm->pODM_StaInfo[Index])) ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ pDM_Odm->platform2phydm_macid_table[((PSTA_INFO_T)pValue)->AssociatedMacId] = Index; /*AssociatedMacId are unique bttween different Adapter*/ ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ pDM_Odm->platform2phydm_macid_table[((PSTA_INFO_T)pValue)->aid] = Index; ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ pDM_Odm->platform2phydm_macid_table[((PSTA_INFO_T)pValue)->mac_id] = Index; ++ #endif ++ ++ break; ++ //To remove the compiler warning, must add an empty default statement to handle the other values. ++ default: ++ //do nothing ++ break; ++ } ++ ++} ++ ++ ++// ++// Update Band/CHannel/.. The values are dynamic but non-per-packet. ++// ++VOID ++ODM_CmnInfoUpdate( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte CmnInfo, ++ IN u8Byte Value ++ ) ++{ ++ // ++ // This init variable may be changed in run time. ++ // ++ switch (CmnInfo) ++ { ++ case ODM_CMNINFO_LINK_IN_PROGRESS: ++ pDM_Odm->bLinkInProcess = (BOOLEAN)Value; ++ break; ++ ++ case ODM_CMNINFO_ABILITY: ++ pDM_Odm->SupportAbility = (u4Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_RF_TYPE: ++ pDM_Odm->RFType = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_WIFI_DIRECT: ++ pDM_Odm->bWIFI_Direct = (BOOLEAN)Value; ++ break; ++ ++ case ODM_CMNINFO_WIFI_DISPLAY: ++ pDM_Odm->bWIFI_Display = (BOOLEAN)Value; ++ break; ++ ++ case ODM_CMNINFO_LINK: ++ pDM_Odm->bLinked = (BOOLEAN)Value; ++ break; ++ ++ case ODM_CMNINFO_STATION_STATE: ++ pDM_Odm->bsta_state = (BOOLEAN)Value; ++ break; ++ ++ case ODM_CMNINFO_RSSI_MIN: ++ pDM_Odm->RSSI_Min= (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_DBG_COMP: ++ pDM_Odm->DebugComponents = (u4Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_DBG_LEVEL: ++ pDM_Odm->DebugLevel = (u4Byte)Value; ++ break; ++ case ODM_CMNINFO_RA_THRESHOLD_HIGH: ++ pDM_Odm->RateAdaptive.HighRSSIThresh = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_RA_THRESHOLD_LOW: ++ pDM_Odm->RateAdaptive.LowRSSIThresh = (u1Byte)Value; ++ break; ++#if defined(BT_SUPPORT) && (BT_SUPPORT == 1) ++ // The following is for BT HS mode and BT coexist mechanism. ++ case ODM_CMNINFO_BT_ENABLED: ++ pDM_Odm->bBtEnabled = (BOOLEAN)Value; ++ break; ++ ++ case ODM_CMNINFO_BT_HS_CONNECT_PROCESS: ++ pDM_Odm->bBtConnectProcess = (BOOLEAN)Value; ++ break; ++ ++ case ODM_CMNINFO_BT_HS_RSSI: ++ pDM_Odm->btHsRssi = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_BT_OPERATION: ++ pDM_Odm->bBtHsOperation = (BOOLEAN)Value; ++ break; ++ ++ case ODM_CMNINFO_BT_LIMITED_DIG: ++ pDM_Odm->bBtLimitedDig = (BOOLEAN)Value; ++ break; ++ ++ case ODM_CMNINFO_BT_DIG: ++ pDM_Odm->btHsDigVal = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_BT_BUSY: ++ pDM_Odm->bBtBusy = (BOOLEAN)Value; ++ break; ++ ++ case ODM_CMNINFO_BT_DISABLE_EDCA: ++ pDM_Odm->bBtDisableEdcaTurbo = (BOOLEAN)Value; ++ break; ++#endif ++ ++#if(DM_ODM_SUPPORT_TYPE & ODM_AP) // for repeater mode add by YuChen 2014.06.23 ++#ifdef UNIVERSAL_REPEATER ++ case ODM_CMNINFO_VXD_LINK: ++ pDM_Odm->VXD_bLinked= (BOOLEAN)Value; ++ break; ++#endif ++#endif ++ ++ case ODM_CMNINFO_AP_TOTAL_NUM: ++ pDM_Odm->APTotalNum = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_POWER_TRAINING: ++ pDM_Odm->bDisablePowerTraining = (BOOLEAN)Value; ++ break; ++ ++#ifdef CONFIG_PHYDM_DFS_MASTER ++ case ODM_CMNINFO_DFS_REGION_DOMAIN: ++ pDM_Odm->DFS_RegionDomain = (u1Byte)Value; ++ break; ++#endif ++ ++/* ++ case ODM_CMNINFO_OP_MODE: ++ pDM_Odm->OPMode = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_WM_MODE: ++ pDM_Odm->WirelessMode = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_BAND: ++ pDM_Odm->BandType = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_SEC_CHNL_OFFSET: ++ pDM_Odm->SecChOffset = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_SEC_MODE: ++ pDM_Odm->Security = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_BW: ++ pDM_Odm->BandWidth = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_CHNL: ++ pDM_Odm->Channel = (u1Byte)Value; ++ break; ++*/ ++ default: ++ //do nothing ++ break; ++ } ++ ++ ++} ++ ++u4Byte ++PHYDM_CmnInfoQuery( ++ IN PDM_ODM_T pDM_Odm, ++ IN PHYDM_INFO_QUERY_E info_type ++ ) ++{ ++ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_FALSEALMCNT); ++ ++ switch (info_type) { ++ case PHYDM_INFO_FA_OFDM: ++ return FalseAlmCnt->Cnt_Ofdm_fail; ++ ++ case PHYDM_INFO_FA_CCK: ++ return FalseAlmCnt->Cnt_Cck_fail; ++ ++ case PHYDM_INFO_FA_TOTAL: ++ return FalseAlmCnt->Cnt_all; ++ ++ case PHYDM_INFO_CCA_OFDM: ++ return FalseAlmCnt->Cnt_OFDM_CCA; ++ ++ case PHYDM_INFO_CCA_CCK: ++ return FalseAlmCnt->Cnt_CCK_CCA; ++ ++ case PHYDM_INFO_CCA_ALL: ++ return FalseAlmCnt->Cnt_CCA_all; ++ ++ case PHYDM_INFO_CRC32_OK_VHT: ++ return FalseAlmCnt->cnt_vht_crc32_ok; ++ ++ case PHYDM_INFO_CRC32_OK_HT: ++ return FalseAlmCnt->cnt_ht_crc32_ok; ++ ++ case PHYDM_INFO_CRC32_OK_LEGACY: ++ return FalseAlmCnt->cnt_ofdm_crc32_ok; ++ ++ case PHYDM_INFO_CRC32_OK_CCK: ++ return FalseAlmCnt->cnt_cck_crc32_ok; ++ ++ case PHYDM_INFO_CRC32_ERROR_VHT: ++ return FalseAlmCnt->cnt_vht_crc32_error; ++ ++ case PHYDM_INFO_CRC32_ERROR_HT: ++ return FalseAlmCnt->cnt_ht_crc32_error; ++ ++ case PHYDM_INFO_CRC32_ERROR_LEGACY: ++ return FalseAlmCnt->cnt_ofdm_crc32_error; ++ ++ case PHYDM_INFO_CRC32_ERROR_CCK: ++ return FalseAlmCnt->cnt_cck_crc32_error; ++ ++ case PHYDM_INFO_EDCCA_FLAG: ++ return FalseAlmCnt->edcca_flag; ++ ++ case PHYDM_INFO_OFDM_ENABLE: ++ return FalseAlmCnt->ofdm_block_enable; ++ ++ case PHYDM_INFO_CCK_ENABLE: ++ return FalseAlmCnt->cck_block_enable; ++ ++ case PHYDM_INFO_DBG_PORT_0: ++ return FalseAlmCnt->dbg_port0; ++ ++ default: ++ return 0xffffffff; ++ ++ } ++} ++ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++ODM_InitAllWorkItems(IN PDM_ODM_T pDM_Odm ) ++{ ++ ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++#if USE_WORKITEM ++ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ ODM_InitializeWorkItem( pDM_Odm, ++ &pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchWorkitem, ++ (RT_WORKITEM_CALL_BACK)ODM_SW_AntDiv_WorkitemCallback, ++ (PVOID)pAdapter, ++ "AntennaSwitchWorkitem"); ++ #endif ++ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 ++ ODM_InitializeWorkItem(pDM_Odm, ++ &pDM_Odm->dm_sat_table.hl_smart_antenna_workitem, ++ (RT_WORKITEM_CALL_BACK)phydm_beam_switch_workitem_callback, ++ (PVOID)pAdapter, ++ "hl_smart_ant_workitem"); ++ ++ ODM_InitializeWorkItem(pDM_Odm, ++ &pDM_Odm->dm_sat_table.hl_smart_antenna_decision_workitem, ++ (RT_WORKITEM_CALL_BACK)phydm_beam_decision_workitem_callback, ++ (PVOID)pAdapter, ++ "hl_smart_ant_decision_workitem"); ++ #endif ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->PathDivSwitchWorkitem), ++ (RT_WORKITEM_CALL_BACK)odm_PathDivChkAntSwitchWorkitemCallback, ++ (PVOID)pAdapter, ++ "SWAS_WorkItem"); ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->CCKPathDiversityWorkitem), ++ (RT_WORKITEM_CALL_BACK)odm_CCKTXPathDiversityWorkItemCallback, ++ (PVOID)pAdapter, ++ "CCKTXPathDiversityWorkItem"); ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->MPT_DIGWorkitem), ++ (RT_WORKITEM_CALL_BACK)odm_MPT_DIGWorkItemCallback, ++ (PVOID)pAdapter, ++ "MPT_DIGWorkitem"); ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->RaRptWorkitem), ++ (RT_WORKITEM_CALL_BACK)ODM_UpdateInitRateWorkItemCallback, ++ (PVOID)pAdapter, ++ "RaRptWorkitem"); ++ ++#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->FastAntTrainingWorkitem), ++ (RT_WORKITEM_CALL_BACK)odm_FastAntTrainingWorkItemCallback, ++ (PVOID)pAdapter, ++ "FastAntTrainingWorkitem"); ++#endif ++ ++#endif /*#if USE_WORKITEM*/ ++ ++#if (BEAMFORMING_SUPPORT == 1) ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_EnterWorkItem), ++ (RT_WORKITEM_CALL_BACK)halComTxbf_EnterWorkItemCallback, ++ (PVOID)pAdapter, ++ "Txbf_EnterWorkItem"); ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_LeaveWorkItem), ++ (RT_WORKITEM_CALL_BACK)halComTxbf_LeaveWorkItemCallback, ++ (PVOID)pAdapter, ++ "Txbf_LeaveWorkItem"); ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaWorkItem), ++ (RT_WORKITEM_CALL_BACK)halComTxbf_FwNdpaWorkItemCallback, ++ (PVOID)pAdapter, ++ "Txbf_FwNdpaWorkItem"); ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ClkWorkItem), ++ (RT_WORKITEM_CALL_BACK)halComTxbf_ClkWorkItemCallback, ++ (PVOID)pAdapter, ++ "Txbf_ClkWorkItem"); ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_RateWorkItem), ++ (RT_WORKITEM_CALL_BACK)halComTxbf_RateWorkItemCallback, ++ (PVOID)pAdapter, ++ "Txbf_RateWorkItem"); ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_StatusWorkItem), ++ (RT_WORKITEM_CALL_BACK)halComTxbf_StatusWorkItemCallback, ++ (PVOID)pAdapter, ++ "Txbf_StatusWorkItem"); ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ResetTxPathWorkItem), ++ (RT_WORKITEM_CALL_BACK)halComTxbf_ResetTxPathWorkItemCallback, ++ (PVOID)pAdapter, ++ "Txbf_ResetTxPathWorkItem"); ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_GetTxRateWorkItem), ++ (RT_WORKITEM_CALL_BACK)halComTxbf_GetTxRateWorkItemCallback, ++ (PVOID)pAdapter, ++ "Txbf_GetTxRateWorkItem"); ++#endif ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->Adaptivity.phydm_pauseEDCCAWorkItem), ++ (RT_WORKITEM_CALL_BACK)phydm_pauseEDCCA_WorkItemCallback, ++ (PVOID)pAdapter, ++ "phydm_pauseEDCCAWorkItem"); ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->Adaptivity.phydm_resumeEDCCAWorkItem), ++ (RT_WORKITEM_CALL_BACK)phydm_resumeEDCCA_WorkItemCallback, ++ (PVOID)pAdapter, ++ "phydm_resumeEDCCAWorkItem"); ++ ++ ODM_InitializeWorkItem( ++ pDM_Odm, ++ &(pDM_Odm->adcsmp.ADCSmpWorkItem), ++ (RT_WORKITEM_CALL_BACK)ADCSmpWorkItemCallback, ++ (PVOID)pAdapter, ++ "ADCSmpWorkItem"); ++ ++} ++ ++VOID ++ODM_FreeAllWorkItems(IN PDM_ODM_T pDM_Odm ) ++{ ++#if USE_WORKITEM ++ ++#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ ODM_FreeWorkItem(&(pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchWorkitem)); ++#endif ++ ++#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 ++ ODM_FreeWorkItem(&(pDM_Odm->dm_sat_table.hl_smart_antenna_workitem)); ++ ODM_FreeWorkItem(&(pDM_Odm->dm_sat_table.hl_smart_antenna_decision_workitem)); ++#endif ++ ++ ODM_FreeWorkItem(&(pDM_Odm->PathDivSwitchWorkitem)); ++ ODM_FreeWorkItem(&(pDM_Odm->CCKPathDiversityWorkitem)); ++#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) ++ ODM_FreeWorkItem(&(pDM_Odm->FastAntTrainingWorkitem)); ++#endif ++ ODM_FreeWorkItem(&(pDM_Odm->MPT_DIGWorkitem)); ++ ODM_FreeWorkItem(&(pDM_Odm->RaRptWorkitem)); ++ /*ODM_FreeWorkItem((&pDM_Odm->sbdcnt_workitem));*/ ++#endif ++ ++#if (BEAMFORMING_SUPPORT == 1) ++ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_EnterWorkItem)); ++ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_LeaveWorkItem)); ++ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaWorkItem)); ++ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ClkWorkItem)); ++ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_RateWorkItem)); ++ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_StatusWorkItem)); ++ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ResetTxPathWorkItem)); ++ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_GetTxRateWorkItem)); ++#endif ++ ++ ODM_FreeWorkItem((&pDM_Odm->Adaptivity.phydm_pauseEDCCAWorkItem)); ++ ODM_FreeWorkItem((&pDM_Odm->Adaptivity.phydm_resumeEDCCAWorkItem)); ++ ODM_FreeWorkItem((&pDM_Odm->adcsmp.ADCSmpWorkItem)); ++ ++} ++#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ ++ ++/* ++VOID ++odm_FindMinimumRSSI( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte i; ++ u1Byte RSSI_Min = 0xFF; ++ ++ for(i=0; ipODM_StaInfo[i] != NULL) ++ if(IS_STA_VALID(pDM_Odm->pODM_StaInfo[i]) ) ++ { ++ if(pDM_Odm->pODM_StaInfo[i]->RSSI_Ave < RSSI_Min) ++ { ++ RSSI_Min = pDM_Odm->pODM_StaInfo[i]->RSSI_Ave; ++ } ++ } ++ } ++ ++ pDM_Odm->RSSI_Min = RSSI_Min; ++ ++} ++ ++VOID ++odm_IsLinked( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte i; ++ BOOLEAN Linked = FALSE; ++ ++ for(i=0; ipODM_StaInfo[i]) ) ++ { ++ Linked = TRUE; ++ break; ++ } ++ ++ } ++ ++ pDM_Odm->bLinked = Linked; ++} ++*/ ++ ++VOID ++ODM_InitAllTimers( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++ ODM_AntDivTimers(pDM_Odm,INIT_ANTDIV_TIMMER); ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++#ifdef MP_TEST ++ if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) ++ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer, ++ (RT_TIMER_CALL_BACK)odm_MPT_DIGCallback, NULL, "MPT_DIGTimer"); ++#endif ++#elif(DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer, ++ (RT_TIMER_CALL_BACK)odm_MPT_DIGCallback, NULL, "MPT_DIGTimer"); ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer, ++ (RT_TIMER_CALL_BACK)odm_PathDivChkAntSwitchCallback, NULL, "PathDivTimer"); ++ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer, ++ (RT_TIMER_CALL_BACK)odm_CCKTXPathDiversityCallback, NULL, "CCKPathDiversityTimer"); ++ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer, ++ (RT_TIMER_CALL_BACK)phydm_sbd_callback, NULL, "SbdTimer"); ++#if (BEAMFORMING_SUPPORT == 1) ++ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaTimer, ++ (RT_TIMER_CALL_BACK)halComTxbf_FwNdpaTimerCallback, NULL, "Txbf_FwNdpaTimer"); ++#endif ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) ++#if (BEAMFORMING_SUPPORT == 1) ++ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.BeamformingTimer, ++ (RT_TIMER_CALL_BACK)Beamforming_SWTimerCallback, NULL, "BeamformingTimer"); ++#endif ++#endif ++} ++ ++VOID ++ODM_CancelAllTimers( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ // ++ // 2012/01/12 MH Temp BSOD fix. We need to find NIC allocate mem fail reason in ++ // win7 platform. ++ // ++ HAL_ADAPTER_STS_CHK(pDM_Odm) ++#endif ++ ++#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++ ODM_AntDivTimers(pDM_Odm,CANCEL_ANTDIV_TIMMER); ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++#ifdef MP_TEST ++ if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) ++ ODM_CancelTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); ++#endif ++#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ODM_CancelTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ODM_CancelTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer); ++ ODM_CancelTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer); ++ ODM_CancelTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); ++ ODM_CancelTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer); ++#if (BEAMFORMING_SUPPORT == 1) ++ ODM_CancelTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaTimer); ++#endif ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) ++#if (BEAMFORMING_SUPPORT == 1) ++ ODM_CancelTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.BeamformingTimer); ++#endif ++#endif ++ ++} ++ ++ ++VOID ++ODM_ReleaseAllTimers( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++ ODM_AntDivTimers(pDM_Odm,RELEASE_ANTDIV_TIMMER); ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ #ifdef MP_TEST ++ if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) ++ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); ++ #endif ++#elif(DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer); ++ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer); ++ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); ++ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer); ++#if (BEAMFORMING_SUPPORT == 1) ++ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaTimer); ++#endif ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) ++#if (BEAMFORMING_SUPPORT == 1) ++ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.BeamformingTimer); ++#endif ++#endif ++} ++ ++ ++//3============================================================ ++//3 Tx Power Tracking ++//3============================================================ ++ ++ ++ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++VOID ++ODM_InitAllThreads( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++ #ifdef TPT_THREAD ++ kTPT_task_init(pDM_Odm->priv); ++ #endif ++} ++ ++VOID ++ODM_StopAllThreads( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++ #ifdef TPT_THREAD ++ kTPT_task_stop(pDM_Odm->priv); ++ #endif ++} ++#endif ++ ++ ++#if( DM_ODM_SUPPORT_TYPE == ODM_WIN) ++// ++// 2011/07/26 MH Add an API for testing IQK fail case. ++// ++BOOLEAN ++ODM_CheckPowerStatus( ++ IN PADAPTER Adapter) ++{ ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ RT_RF_POWER_STATE rtState; ++ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); ++ ++ // 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. ++ if (pMgntInfo->init_adpt_in_progress == TRUE) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return TRUE, due to initadapter\n")); ++ return TRUE; ++ } ++ ++ // ++ // 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. ++ // ++ Adapter->HalFunc.GetHwRegHandler(Adapter, HW_VAR_RF_STATE, (pu1Byte)(&rtState)); ++ if(Adapter->bDriverStopped || Adapter->bDriverIsGoingToPnpSetPowerSleep || rtState == eRfOff) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return FALSE, due to %d/%d/%d\n", ++ Adapter->bDriverStopped, Adapter->bDriverIsGoingToPnpSetPowerSleep, rtState)); ++ return FALSE; ++ } ++ return TRUE; ++} ++#elif( DM_ODM_SUPPORT_TYPE == ODM_AP) ++BOOLEAN ++ODM_CheckPowerStatus( ++ IN PADAPTER Adapter) ++{ ++ /* ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ RT_RF_POWER_STATE rtState; ++ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); ++ ++ // 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. ++ if (pMgntInfo->init_adpt_in_progress == TRUE) ++ { ++ ODM_RT_TRACE(pDM_Odm,COMP_INIT, DBG_LOUD, ("ODM_CheckPowerStatus Return TRUE, due to initadapter")); ++ return TRUE; ++ } ++ ++ // ++ // 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. ++ // ++ Adapter->HalFunc.GetHwRegHandler(Adapter, HW_VAR_RF_STATE, (pu1Byte)(&rtState)); ++ if(Adapter->bDriverStopped || Adapter->bDriverIsGoingToPnpSetPowerSleep || rtState == eRfOff) ++ { ++ ODM_RT_TRACE(pDM_Odm,COMP_INIT, DBG_LOUD, ("ODM_CheckPowerStatus Return FALSE, due to %d/%d/%d\n", ++ Adapter->bDriverStopped, Adapter->bDriverIsGoingToPnpSetPowerSleep, rtState)); ++ return FALSE; ++ } ++ */ ++ return TRUE; ++} ++#endif ++ ++// need to ODM CE Platform ++//move to here for ANT detection mechanism using ++ ++#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN)||(DM_ODM_SUPPORT_TYPE == ODM_CE)) ++u4Byte ++GetPSDData( ++ IN PDM_ODM_T pDM_Odm, ++ unsigned int point, ++ u1Byte initial_gain_psd) ++{ ++ //unsigned int val, rfval; ++ //int psd_report; ++ u4Byte psd_report; ++ ++ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ //Debug Message ++ //val = PHY_QueryBBReg(Adapter,0x908, bMaskDWord); ++ //DbgPrint("Reg908 = 0x%x\n",val); ++ //val = PHY_QueryBBReg(Adapter,0xDF4, bMaskDWord); ++ //rfval = PHY_QueryRFReg(Adapter, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask); ++ //DbgPrint("RegDF4 = 0x%x, RFReg00 = 0x%x\n",val, rfval); ++ //DbgPrint("PHYTXON = %x, OFDMCCA_PP = %x, CCKCCA_PP = %x, RFReg00 = %x\n", ++ //(val&BIT25)>>25, (val&BIT14)>>14, (val&BIT15)>>15, rfval); ++ ++ //Set DCO frequency index, offset=(40MHz/SamplePts)*point ++ ODM_SetBBReg(pDM_Odm, 0x808, 0x3FF, point); ++ ++ //Start PSD calculation, Reg808[22]=0->1 ++ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 1); ++ //Need to wait for HW PSD report ++ ODM_StallExecution(1000); ++ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 0); ++ //Read PSD report, Reg8B4[15:0] ++ psd_report = ODM_GetBBReg(pDM_Odm,0x8B4, bMaskDWord) & 0x0000FFFF; ++ ++#if 1//(DEV_BUS_TYPE == RT_PCI_INTERFACE) && ( (RT_PLATFORM == PLATFORM_LINUX) || (RT_PLATFORM == PLATFORM_MACOSX)) ++ psd_report = (u4Byte) (odm_ConvertTo_dB(psd_report))+(u4Byte)(initial_gain_psd-0x1c); ++#else ++ psd_report = (int) (20*log10((double)psd_report))+(int)(initial_gain_psd-0x1c); ++#endif ++ ++ return psd_report; ++ ++} ++#endif ++ ++u4Byte ++odm_ConvertTo_dB( ++ u4Byte Value) ++{ ++ u1Byte i; ++ u1Byte j; ++ u4Byte dB; ++ ++ Value = Value & 0xFFFF; ++ ++ for (i = 0; i < 12; i++) ++ { ++ if (Value <= dB_Invert_Table[i][7]) ++ { ++ break; ++ } ++ } ++ ++ if (i >= 12) ++ { ++ return (96); // maximum 96 dB ++ } ++ ++ for (j = 0; j < 8; j++) ++ { ++ if (Value <= dB_Invert_Table[i][j]) ++ { ++ break; ++ } ++ } ++ ++ dB = (i << 3) + j + 1; ++ ++ return (dB); ++} ++ ++u4Byte ++odm_ConvertTo_linear( ++ u4Byte Value) ++{ ++ u1Byte i; ++ u1Byte j; ++ u4Byte linear; ++ ++ /* 1dB~96dB */ ++ ++ Value = Value & 0xFF; ++ ++ i = (u1Byte)((Value - 1) >> 3); ++ j = (u1Byte)(Value - 1) - (i << 3); ++ ++ linear = dB_Invert_Table[i][j]; ++ ++ return (linear); ++} ++ ++// ++// ODM multi-port consideration, added by Roger, 2013.10.01. ++// ++VOID ++ODM_AsocEntry_Init( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER pLoopAdapter = GetDefaultAdapter(pDM_Odm->Adapter); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pLoopAdapter); ++ PDM_ODM_T pDM_OutSrc = &pHalData->DM_OutSrc; ++ u1Byte TotalAssocEntryNum = 0; ++ u1Byte index = 0; ++ u1Byte adaptercount = 0; ++ ++ ODM_CmnInfoPtrArrayHook(pDM_OutSrc, ODM_CMNINFO_STA_STATUS, 0, &pLoopAdapter->MgntInfo.DefaultPort[0]); ++ pLoopAdapter->MgntInfo.DefaultPort[0].MultiPortStationIdx = TotalAssocEntryNum; ++ ++ adaptercount += 1; ++ RT_TRACE(COMP_INIT, DBG_LOUD, ("adaptercount=%d\n", adaptercount)); ++ pLoopAdapter = GetNextExtAdapter(pLoopAdapter); ++ TotalAssocEntryNum +=1; ++ ++ while(pLoopAdapter) ++ { ++ for (index = 0; index MgntInfo.AsocEntry[index]); ++ pLoopAdapter->MgntInfo.AsocEntry[index].MultiPortStationIdx = TotalAssocEntryNum+index; ++ } ++ ++ TotalAssocEntryNum+= index; ++ if(IS_HARDWARE_TYPE_8188E((pDM_Odm->Adapter))) ++ pLoopAdapter->RASupport = TRUE; ++ adaptercount += 1; ++ RT_TRACE(COMP_INIT, DBG_LOUD, ("adaptercount=%d\n", adaptercount)); ++ pLoopAdapter = GetNextExtAdapter(pLoopAdapter); ++ } ++ ++ RT_TRACE(COMP_INIT, DBG_LOUD, ("TotalAssocEntryNum = %d\n", TotalAssocEntryNum)); ++ if (TotalAssocEntryNum < (ODM_ASSOCIATE_ENTRY_NUM-1)) { ++ ++ RT_TRACE(COMP_INIT, DBG_LOUD, ("In hook null\n")); ++ for (index = TotalAssocEntryNum; index < ODM_ASSOCIATE_ENTRY_NUM; index++) ++ ODM_CmnInfoPtrArrayHook(pDM_OutSrc, ODM_CMNINFO_STA_STATUS, index, NULL); ++ } ++#endif ++} ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++/* Justin: According to the current RRSI to adjust Response Frame TX power, 2012/11/05 */ ++void odm_dtc(PDM_ODM_T pDM_Odm) ++{ ++#ifdef CONFIG_DM_RESP_TXAGC ++ #define DTC_BASE 35 /* RSSI higher than this value, start to decade TX power */ ++ #define DTC_DWN_BASE (DTC_BASE-5) /* RSSI lower than this value, start to increase TX power */ ++ ++ /* RSSI vs TX power step mapping: decade TX power */ ++ static const u8 dtc_table_down[]={ ++ DTC_BASE, ++ (DTC_BASE+5), ++ (DTC_BASE+10), ++ (DTC_BASE+15), ++ (DTC_BASE+20), ++ (DTC_BASE+25) ++ }; ++ ++ /* RSSI vs TX power step mapping: increase TX power */ ++ static const u8 dtc_table_up[]={ ++ DTC_DWN_BASE, ++ (DTC_DWN_BASE-5), ++ (DTC_DWN_BASE-10), ++ (DTC_DWN_BASE-15), ++ (DTC_DWN_BASE-15), ++ (DTC_DWN_BASE-20), ++ (DTC_DWN_BASE-20), ++ (DTC_DWN_BASE-25), ++ (DTC_DWN_BASE-25), ++ (DTC_DWN_BASE-30), ++ (DTC_DWN_BASE-35) ++ }; ++ ++ u8 i; ++ u8 dtc_steps=0; ++ u8 sign; ++ u8 resp_txagc=0; ++ ++ #if 0 ++ /* As DIG is disabled, DTC is also disable */ ++ if(!(pDM_Odm->SupportAbility & ODM_XXXXXX)) ++ return; ++ #endif ++ ++ if (DTC_BASE < pDM_Odm->RSSI_Min) { ++ /* need to decade the CTS TX power */ ++ sign = 1; ++ for (i=0;i= pDM_Odm->RSSI_Min) || (dtc_steps >= 6)) ++ break; ++ else ++ dtc_steps++; ++ } ++ } ++#if 0 ++ else if (DTC_DWN_BASE > pDM_Odm->RSSI_Min) ++ { ++ /* needs to increase the CTS TX power */ ++ sign = 0; ++ dtc_steps = 1; ++ for (i=0;iRSSI_Min) || (dtc_steps>=10)) ++ break; ++ else ++ dtc_steps++; ++ } ++ } ++#endif ++ else ++ { ++ sign = 0; ++ dtc_steps = 0; ++ } ++ ++ resp_txagc = dtc_steps | (sign << 4); ++ resp_txagc = resp_txagc | (resp_txagc << 5); ++ ODM_Write1Byte(pDM_Odm, 0x06d9, resp_txagc); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PWR_TRAIN, ODM_DBG_LOUD, ("%s RSSI_Min:%u, set RESP_TXAGC to %s %u\n", ++ __func__, pDM_Odm->RSSI_Min, sign ? "minus" : "plus", dtc_steps)); ++#endif /* CONFIG_RESP_TXAGC_ADJUST */ ++} ++ ++#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ ++ ++VOID ++odm_UpdatePowerTrainingState( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm , PHYDM_FALSEALMCNT); ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ u4Byte score = 0; ++ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_PWR_TRAIN)) ++ return; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState()============>\n")); ++ pDM_Odm->bChangeState = FALSE; ++ ++ // Debug command ++ if(pDM_Odm->ForcePowerTrainingState) ++ { ++ if(pDM_Odm->ForcePowerTrainingState == 1 && !pDM_Odm->bDisablePowerTraining) ++ { ++ pDM_Odm->bChangeState = TRUE; ++ pDM_Odm->bDisablePowerTraining = TRUE; ++ } ++ else if(pDM_Odm->ForcePowerTrainingState == 2 && pDM_Odm->bDisablePowerTraining) ++ { ++ pDM_Odm->bChangeState = TRUE; ++ pDM_Odm->bDisablePowerTraining = FALSE; ++ } ++ ++ pDM_Odm->PT_score = 0; ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): ForcePowerTrainingState = %d\n", ++ pDM_Odm->ForcePowerTrainingState)); ++ return; ++ } ++ ++ if(!pDM_Odm->bLinked) ++ return; ++ ++ // First connect ++ if((pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == FALSE)) ++ { ++ pDM_Odm->PT_score = 0; ++ pDM_Odm->bChangeState = TRUE; ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): First Connect\n")); ++ return; ++ } ++ ++ // Compute score ++ if(pDM_Odm->NHM_cnt_0 >= 215) ++ score = 2; ++ else if(pDM_Odm->NHM_cnt_0 >= 190) ++ score = 1; // unknow state ++ else ++ { ++ u4Byte RX_Pkt_Cnt; ++ ++ RX_Pkt_Cnt = (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM) + (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK); ++ ++ if((FalseAlmCnt->Cnt_CCA_all > 31 && RX_Pkt_Cnt > 31) && (FalseAlmCnt->Cnt_CCA_all >= RX_Pkt_Cnt)) ++ { ++ if((RX_Pkt_Cnt + (RX_Pkt_Cnt >> 1)) <= FalseAlmCnt->Cnt_CCA_all) ++ score = 0; ++ else if((RX_Pkt_Cnt + (RX_Pkt_Cnt >> 2)) <= FalseAlmCnt->Cnt_CCA_all) ++ score = 1; ++ else ++ score = 2; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): RX_Pkt_Cnt = %d, Cnt_CCA_all = %d\n", ++ RX_Pkt_Cnt, FalseAlmCnt->Cnt_CCA_all)); ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): NumQryPhyStatusOFDM = %d, NumQryPhyStatusCCK = %d\n", ++ (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM), (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): NHM_cnt_0 = %d, score = %d\n", ++ pDM_Odm->NHM_cnt_0, score)); ++ ++ // smoothing ++ pDM_Odm->PT_score = (score << 4) + (pDM_Odm->PT_score>>1) + (pDM_Odm->PT_score>>2); ++ score = (pDM_Odm->PT_score + 32) >> 6; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): PT_score = %d, score after smoothing = %d\n", ++ pDM_Odm->PT_score, score)); ++ ++ // Mode decision ++ if(score == 2) ++ { ++ if(pDM_Odm->bDisablePowerTraining) ++ { ++ pDM_Odm->bChangeState = TRUE; ++ pDM_Odm->bDisablePowerTraining = FALSE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Change state\n")); ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Enable Power Training\n")); ++ } ++ else if(score == 0) ++ { ++ if(!pDM_Odm->bDisablePowerTraining) ++ { ++ pDM_Odm->bChangeState = TRUE; ++ pDM_Odm->bDisablePowerTraining = TRUE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Change state\n")); ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Disable Power Training\n")); ++ } ++ ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; ++#endif ++} ++ ++ ++ ++/*===========================================================*/ ++/* The following is for compile only*/ ++/*===========================================================*/ ++/*#define TARGET_CHNL_NUM_2G_5G 59*/ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++u1Byte GetRightChnlPlaceforIQK(u1Byte chnl) ++{ ++ u1Byte channel_all[TARGET_CHNL_NUM_2G_5G] = {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, 60, 62, 64, 100, ++ 102, 104, 106, 108, 110, 112, 114, 116, 118, 120, 122, 124, 126, 128, 130, 132, 134, 136, 138, 140, 149, 151, 153, 155, 157, 159, 161, 163, 165}; ++ u1Byte place = chnl; ++ ++ ++ if (chnl > 14) { ++ for (place = 14; place < sizeof(channel_all); place++) { ++ if (channel_all[place] == chnl) ++ return place-13; ++ } ++ } ++ ++ return 0; ++} ++ ++#endif ++/*===========================================================*/ ++ ++VOID ++phydm_NoisyDetection( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte Total_FA_Cnt, Total_CCA_Cnt; ++ u4Byte Score = 0, i, Score_Smooth; ++ ++ Total_CCA_Cnt = pDM_Odm->FalseAlmCnt.Cnt_CCA_all; ++ Total_FA_Cnt = pDM_Odm->FalseAlmCnt.Cnt_all; ++ ++/* ++ if( Total_FA_Cnt*16>=Total_CCA_Cnt*14 ) // 87.5 ++ ++ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*12 ) // 75 ++ ++ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*10 ) // 56.25 ++ ++ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*8 ) // 50 ++ ++ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*7 ) // 43.75 ++ ++ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*6 ) // 37.5 ++ ++ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*5 ) // 31.25% ++ ++ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*4 ) // 25% ++ ++ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*3 ) // 18.75% ++ ++ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*2 ) // 12.5% ++ ++ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*1 ) // 6.25% ++*/ ++ for(i=0;i<=16;i++) ++ { ++ if( Total_FA_Cnt*16>=Total_CCA_Cnt*(16-i) ) ++ { ++ Score = 16-i; ++ break; ++ } ++ } ++ ++ // NoisyDecision_Smooth = NoisyDecision_Smooth>>1 + (Score<<3)>>1; ++ pDM_Odm->NoisyDecision_Smooth = (pDM_Odm->NoisyDecision_Smooth>>1) + (Score<<2); ++ ++ // Round the NoisyDecision_Smooth: +"3" comes from (2^3)/2-1 ++ Score_Smooth = (Total_CCA_Cnt>=300)?((pDM_Odm->NoisyDecision_Smooth+3)>>3):0; ++ ++ pDM_Odm->NoisyDecision = (Score_Smooth>=3)?1:0; ++/* ++ switch(Score_Smooth) ++ { ++ case 0: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=0%%\n")); ++ break; ++ case 1: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=6.25%%\n")); ++ break; ++ case 2: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=12.5%%\n")); ++ break; ++ case 3: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=18.75%%\n")); ++ break; ++ case 4: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=25%%\n")); ++ break; ++ case 5: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=31.25%%\n")); ++ break; ++ case 6: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=37.5%%\n")); ++ break; ++ case 7: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=43.75%%\n")); ++ break; ++ case 8: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=50%%\n")); ++ break; ++ case 9: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=56.25%%\n")); ++ break; ++ case 10: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=62.5%%\n")); ++ break; ++ case 11: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=68.75%%\n")); ++ break; ++ case 12: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=75%%\n")); ++ break; ++ case 13: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=81.25%%\n")); ++ break; ++ case 14: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=87.5%%\n")); ++ break; ++ case 15: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=93.75%%\n")); ++ break; ++ case 16: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=100%%\n")); ++ break; ++ default: ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ++ ("[NoisyDetection] Unknown Value!! Need Check!!\n")); ++ } ++*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, ++ ("[NoisyDetection] Total_CCA_Cnt=%d, Total_FA_Cnt=%d, NoisyDecision_Smooth=%d, Score=%d, Score_Smooth=%d, pDM_Odm->NoisyDecision=%d\n", ++ Total_CCA_Cnt, Total_FA_Cnt, pDM_Odm->NoisyDecision_Smooth, Score, Score_Smooth, pDM_Odm->NoisyDecision)); ++ ++} ++ ++VOID ++phydm_set_ext_switch( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ u4Byte ext_ant_switch = dm_value[0]; ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8821|ODM_RTL8881A)) { ++ ++ /*Output Pin Settings*/ ++ ODM_SetMACReg(pDM_Odm, 0x4C, BIT23, 0); /*select DPDT_P and DPDT_N as output pin*/ ++ ODM_SetMACReg(pDM_Odm, 0x4C, BIT24, 1); /*by WLAN control*/ ++ ++ ODM_SetBBReg(pDM_Odm, 0xCB4, 0xF, 7); /*DPDT_P = 1b'0*/ ++ ODM_SetBBReg(pDM_Odm, 0xCB4, 0xF0, 7); /*DPDT_N = 1b'0*/ ++ ++ if (ext_ant_switch == MAIN_ANT) { ++ ODM_SetBBReg(pDM_Odm, 0xCB4, (BIT29|BIT28), 1); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("***8821A set Ant switch = 2b'01 (Main)\n")); ++ } else if (ext_ant_switch == AUX_ANT){ ++ ODM_SetBBReg(pDM_Odm, 0xCB4, BIT29|BIT28, 2); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("***8821A set Ant switch = 2b'10 (Aux)\n")); ++ } ++ } ++} ++ ++VOID ++phydm_csi_mask_enable( ++ IN PVOID pDM_VOID, ++ IN u4Byte enable ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte reg_value = 0; ++ ++ reg_value = (enable == CSI_MASK_ENABLE) ? 1 : 0; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ++ ODM_SetBBReg(pDM_Odm, 0xD2C, BIT28, reg_value); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable CSI Mask: Reg 0xD2C[28] = ((0x%x))\n", reg_value)); ++ ++ } else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ++ ODM_SetBBReg(pDM_Odm, 0x874, BIT0, reg_value); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable CSI Mask: Reg 0x874[0] = ((0x%x))\n", reg_value)); ++ } ++ ++} ++ ++VOID ++phydm_clean_all_csi_mask( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ++ ODM_SetBBReg(pDM_Odm, 0xD40, bMaskDWord, 0); ++ ODM_SetBBReg(pDM_Odm, 0xD44, bMaskDWord, 0); ++ ODM_SetBBReg(pDM_Odm, 0xD48, bMaskDWord, 0); ++ ODM_SetBBReg(pDM_Odm, 0xD4c, bMaskDWord, 0); ++ ++ } else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ++ ODM_SetBBReg(pDM_Odm, 0x880, bMaskDWord, 0); ++ ODM_SetBBReg(pDM_Odm, 0x884, bMaskDWord, 0); ++ ODM_SetBBReg(pDM_Odm, 0x888, bMaskDWord, 0); ++ ODM_SetBBReg(pDM_Odm, 0x88c, bMaskDWord, 0); ++ ODM_SetBBReg(pDM_Odm, 0x890, bMaskDWord, 0); ++ ODM_SetBBReg(pDM_Odm, 0x894, bMaskDWord, 0); ++ ODM_SetBBReg(pDM_Odm, 0x898, bMaskDWord, 0); ++ ODM_SetBBReg(pDM_Odm, 0x89c, bMaskDWord, 0); ++ } ++} ++ ++VOID ++phydm_set_csi_mask_reg( ++ IN PVOID pDM_VOID, ++ IN u4Byte tone_idx_tmp, ++ IN u1Byte tone_direction ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte byte_offset, bit_offset; ++ u4Byte target_reg; ++ u1Byte reg_tmp_value; ++ u4Byte tone_num = 64; ++ u4Byte tone_num_shift = 0; ++ u4Byte csi_mask_reg_p = 0, csi_mask_reg_n = 0; ++ ++ /* calculate real tone idx*/ ++ if ((tone_idx_tmp % 10) >= 5) ++ tone_idx_tmp += 10; ++ ++ tone_idx_tmp = (tone_idx_tmp/10); ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ++ tone_num = 64; ++ csi_mask_reg_p = 0xD40; ++ csi_mask_reg_n = 0xD48; ++ ++ } else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ++ tone_num = 128; ++ csi_mask_reg_p = 0x880; ++ csi_mask_reg_n = 0x890; ++ } ++ ++ if (tone_direction == FREQ_POSITIVE) { ++ ++ if (tone_idx_tmp >= (tone_num - 1)) ++ tone_idx_tmp = (tone_num - 1); ++ ++ byte_offset = (u1Byte)(tone_idx_tmp >> 3); ++ bit_offset = (u1Byte)(tone_idx_tmp & 0x7); ++ target_reg = csi_mask_reg_p + byte_offset; ++ ++ } else { ++ tone_num_shift = tone_num; ++ ++ if (tone_idx_tmp >= tone_num) ++ tone_idx_tmp = tone_num; ++ ++ tone_idx_tmp = tone_num - tone_idx_tmp; ++ ++ byte_offset = (u1Byte)(tone_idx_tmp >> 3); ++ bit_offset = (u1Byte)(tone_idx_tmp & 0x7); ++ target_reg = csi_mask_reg_n + byte_offset; ++ } ++ ++ reg_tmp_value = ODM_Read1Byte(pDM_Odm, target_reg); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Pre Mask tone idx[%d]: Reg0x%x = ((0x%x))\n", (tone_idx_tmp + tone_num_shift), target_reg, reg_tmp_value)); ++ reg_tmp_value |= BIT(bit_offset); ++ ODM_Write1Byte(pDM_Odm, target_reg, reg_tmp_value); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("New Mask tone idx[%d]: Reg0x%x = ((0x%x))\n", (tone_idx_tmp + tone_num_shift), target_reg, reg_tmp_value)); ++} ++ ++VOID ++phydm_set_nbi_reg( ++ IN PVOID pDM_VOID, ++ IN u4Byte tone_idx_tmp, ++ IN u4Byte bw ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte nbi_table_128[NBI_TABLE_SIZE_128] = {25, 55, 85, 115, 135, 155, 185, 205, 225, 245, /*1~10*/ /*tone_idx X 10*/ ++ 265, 285, 305, 335, 355, 375, 395, 415, 435, 455, /*11~20*/ ++ 485, 505, 525, 555, 585, 615, 635}; /*21~27*/ ++ ++ u4Byte nbi_table_256[NBI_TABLE_SIZE_256] = { 25, 55, 85, 115, 135, 155, 175, 195, 225, 245, /*1~10*/ ++ 265, 285, 305, 325, 345, 365, 385, 405, 425, 445, /*11~20*/ ++ 465, 485, 505, 525, 545, 565, 585, 605, 625, 645, /*21~30*/ ++ 665, 695, 715, 735, 755, 775, 795, 815, 835, 855, /*31~40*/ ++ 875, 895, 915, 935, 955, 975, 995, 1015, 1035, 1055, /*41~50*/ ++ 1085, 1105, 1125, 1145, 1175, 1195, 1225, 1255, 1275}; /*51~59*/ ++ ++ u4Byte reg_idx = 0; ++ u4Byte i; ++ u1Byte nbi_table_idx = FFT_128_TYPE; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ++ nbi_table_idx = FFT_128_TYPE; ++ } else if (pDM_Odm->SupportICType & ODM_IC_11AC_1_SERIES) { ++ ++ nbi_table_idx = FFT_256_TYPE; ++ } else if (pDM_Odm->SupportICType & ODM_IC_11AC_2_SERIES) { ++ ++ if (bw == 80) ++ nbi_table_idx = FFT_256_TYPE; ++ else /*20M, 40M*/ ++ nbi_table_idx = FFT_128_TYPE; ++ } ++ ++ if (nbi_table_idx == FFT_128_TYPE) { ++ ++ for (i = 0; i < NBI_TABLE_SIZE_128; i++) { ++ if (tone_idx_tmp < nbi_table_128[i]) { ++ reg_idx = i+1; ++ break; ++ } ++ } ++ ++ } else if (nbi_table_idx == FFT_256_TYPE) { ++ ++ for (i = 0; i < NBI_TABLE_SIZE_256; i++) { ++ if (tone_idx_tmp < nbi_table_256[i]) { ++ reg_idx = i+1; ++ break; ++ } ++ } ++ } ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ODM_SetBBReg(pDM_Odm, 0xc40, 0x1f000000, reg_idx); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Set tone idx: Reg0xC40[28:24] = ((0x%x))\n", reg_idx)); ++ /**/ ++ } else { ++ ODM_SetBBReg(pDM_Odm, 0x87c, 0xfc000, reg_idx); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Set tone idx: Reg0x87C[19:14] = ((0x%x))\n", reg_idx)); ++ /**/ ++ } ++} ++ ++ ++VOID ++phydm_nbi_enable( ++ IN PVOID pDM_VOID, ++ IN u4Byte enable ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte reg_value = 0; ++ ++ reg_value = (enable == NBI_ENABLE) ? 1 : 0; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ++ ODM_SetBBReg(pDM_Odm, 0xc40, BIT9, reg_value); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable NBI Reg0xC40[9] = ((0x%x))\n", reg_value)); ++ ++ } else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ++ ODM_SetBBReg(pDM_Odm, 0x87c, BIT13, reg_value); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable NBI Reg0x87C[13] = ((0x%x))\n", reg_value)); ++ } ++} ++ ++u1Byte ++phydm_calculate_fc( ++ IN PVOID pDM_VOID, ++ IN u4Byte channel, ++ IN u4Byte bw, ++ IN u4Byte Second_ch, ++ IN OUT u4Byte *fc_in ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte fc = *fc_in; ++ u4Byte start_ch_per_40m[NUM_START_CH_40M] = {36, 44, 52, 60, 100, 108, 116, 124, 132, 140, 149, 157, 165, 173}; ++ u4Byte start_ch_per_80m[NUM_START_CH_80M] = {36, 52, 100, 116, 132, 149, 165}; ++ pu4Byte p_start_ch = &(start_ch_per_40m[0]); ++ u4Byte num_start_channel = NUM_START_CH_40M; ++ u4Byte channel_offset = 0; ++ u4Byte i; ++ ++ /*2.4G*/ ++ if (channel <= 14 && channel > 0) { ++ ++ if (bw == 80) { ++ return SET_ERROR; ++ } ++ ++ fc = 2412 + (channel - 1)*5; ++ ++ if (bw == 40 && (Second_ch == PHYDM_ABOVE)) { ++ ++ if (channel >= 10) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("CH = ((%d)), Scnd_CH = ((%d)) Error Setting\n", channel, Second_ch)); ++ return SET_ERROR; ++ } ++ fc += 10; ++ } else if (bw == 40 && (Second_ch == PHYDM_BELOW)) { ++ ++ if (channel <= 2) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("CH = ((%d)), Scnd_CH = ((%d)) Error Setting\n", channel, Second_ch)); ++ return SET_ERROR; ++ } ++ fc -= 10; ++ } ++ } ++ /*5G*/ ++ else if (channel >= 36 && channel <= 177) { ++ ++ if (bw != 20) { ++ ++ if (bw == 40) { ++ num_start_channel = NUM_START_CH_40M; ++ p_start_ch = &(start_ch_per_40m[0]); ++ channel_offset = CH_OFFSET_40M; ++ } else if (bw == 80) { ++ num_start_channel = NUM_START_CH_80M; ++ p_start_ch = &(start_ch_per_80m[0]); ++ channel_offset = CH_OFFSET_80M; ++ } ++ ++ for (i = 0; i < num_start_channel; i++) { ++ ++ if (channel < p_start_ch[i+1]) { ++ channel = p_start_ch[i] + channel_offset; ++ break; ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Mod_CH = ((%d))\n", channel)); ++ } ++ ++ fc = 5180 + (channel-36)*5; ++ ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("CH = ((%d)) Error Setting\n", channel)); ++ return SET_ERROR; ++ } ++ ++ *fc_in = fc; ++ ++ return SET_SUCCESS; ++} ++ ++ ++u1Byte ++phydm_calculate_intf_distance( ++ IN PVOID pDM_VOID, ++ IN u4Byte bw, ++ IN u4Byte fc, ++ IN u4Byte f_interference, ++ IN OUT u4Byte *p_tone_idx_tmp_in ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte bw_up, bw_low; ++ u4Byte int_distance; ++ u4Byte tone_idx_tmp; ++ u1Byte set_result = SET_NO_NEED; ++ ++ bw_up = fc + bw/2; ++ bw_low = fc - bw/2; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("[f_l, fc, fh] = [ %d, %d, %d ], f_int = ((%d))\n", bw_low, fc, bw_up, f_interference)); ++ ++ if ((f_interference >= bw_low) && (f_interference <= bw_up)) { ++ ++ int_distance = (fc >= f_interference) ? (fc - f_interference) : (f_interference - fc); ++ tone_idx_tmp = (int_distance<<5); /* =10*(int_distance /0.3125) */ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("int_distance = ((%d MHz)) Mhz, tone_idx_tmp = ((%d.%d))\n", int_distance, (tone_idx_tmp/10), (tone_idx_tmp%10))); ++ *p_tone_idx_tmp_in = tone_idx_tmp; ++ set_result = SET_SUCCESS; ++ } ++ ++ return set_result; ++ ++} ++ ++ ++u1Byte ++phydm_csi_mask_setting( ++ IN PVOID pDM_VOID, ++ IN u4Byte enable, ++ IN u4Byte channel, ++ IN u4Byte bw, ++ IN u4Byte f_interference, ++ IN u4Byte Second_ch ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte fc; ++ u4Byte int_distance; ++ u1Byte tone_direction; ++ u4Byte tone_idx_tmp; ++ u1Byte set_result = SET_SUCCESS; ++ ++ if (enable == CSI_MASK_DISABLE) { ++ set_result = SET_SUCCESS; ++ phydm_clean_all_csi_mask(pDM_Odm); ++ ++ } else { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("[Set CSI MASK_] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", ++ channel, bw, f_interference, (((bw == 20) || (channel > 14)) ? "Don't care" : (Second_ch == PHYDM_ABOVE) ? "H" : "L"))); ++ ++ /*calculate fc*/ ++ if (phydm_calculate_fc(pDM_Odm, channel, bw, Second_ch, &fc) == SET_ERROR) ++ set_result = SET_ERROR; ++ ++ else { ++ /*calculate interference distance*/ ++ if (phydm_calculate_intf_distance(pDM_Odm, bw, fc, f_interference, &tone_idx_tmp) == SET_SUCCESS) { ++ ++ tone_direction = (f_interference >= fc) ? FREQ_POSITIVE : FREQ_NEGATIVE; ++ phydm_set_csi_mask_reg(pDM_Odm, tone_idx_tmp, tone_direction); ++ set_result = SET_SUCCESS; ++ } else ++ set_result = SET_NO_NEED; ++ } ++ } ++ ++ if (set_result == SET_SUCCESS) ++ phydm_csi_mask_enable(pDM_Odm, enable); ++ else ++ phydm_csi_mask_enable(pDM_Odm, CSI_MASK_DISABLE); ++ ++ return set_result; ++} ++ ++u1Byte ++phydm_nbi_setting( ++ IN PVOID pDM_VOID, ++ IN u4Byte enable, ++ IN u4Byte channel, ++ IN u4Byte bw, ++ IN u4Byte f_interference, ++ IN u4Byte Second_ch ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte fc; ++ u4Byte int_distance; ++ u4Byte tone_idx_tmp; ++ u1Byte set_result = SET_SUCCESS; ++ u4Byte bw_max = 40; ++ ++ if (enable == NBI_DISABLE) ++ set_result = SET_SUCCESS; ++ ++ else { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("[Set NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", ++ channel, bw, f_interference, (((Second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "Don't care" : (Second_ch == PHYDM_ABOVE) ? "H" : "L"))); ++ ++ /*calculate fc*/ ++ if (phydm_calculate_fc(pDM_Odm, channel, bw, Second_ch, &fc) == SET_ERROR) ++ set_result = SET_ERROR; ++ ++ else { ++ /*calculate interference distance*/ ++ if (phydm_calculate_intf_distance(pDM_Odm, bw, fc, f_interference, &tone_idx_tmp) == SET_SUCCESS) { ++ ++ phydm_set_nbi_reg(pDM_Odm, tone_idx_tmp, bw); ++ set_result = SET_SUCCESS; ++ } else ++ set_result = SET_NO_NEED; ++ } ++ } ++ ++ if (set_result == SET_SUCCESS) ++ phydm_nbi_enable(pDM_Odm, enable); ++ else ++ phydm_nbi_enable(pDM_Odm, NBI_DISABLE); ++ ++ return set_result; ++} ++ ++VOID ++phydm_api_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte function_map, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ u4Byte channel = dm_value[1]; ++ u4Byte bw = dm_value[2]; ++ u4Byte f_interference = dm_value[3]; ++ u4Byte Second_ch = dm_value[4]; ++ u1Byte set_result = 0; ++ ++ /*PHYDM_API_NBI*/ ++ /*-------------------------------------------------------------------------------------------------------------------------------*/ ++ if (function_map == PHYDM_API_NBI) { ++ ++ if (dm_value[0] == 100) { ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "[HELP-NBI] EN(on=1, off=2) CH BW(20/40/80) f_intf(Mhz) Scnd_CH(L=1, H=2)\n")); ++ return; ++ ++ } else if (dm_value[0] == NBI_ENABLE) { ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "[Enable NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", ++ channel, bw, f_interference, ((Second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "Don't care" : ((Second_ch == PHYDM_ABOVE) ? "H" : "L"))); ++ set_result = phydm_nbi_setting(pDM_Odm, NBI_ENABLE, channel, bw, f_interference, Second_ch); ++ ++ } else if (dm_value[0] == NBI_DISABLE) { ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "[Disable NBI]\n")); ++ set_result = phydm_nbi_setting(pDM_Odm, NBI_DISABLE, channel, bw, f_interference, Second_ch); ++ ++ } else { ++ ++ set_result = SET_ERROR; ++ } ++ PHYDM_SNPRINTF((output+used, out_len-used, "[NBI set result: %s]\n", (set_result == SET_SUCCESS) ? "Success" : ((set_result == SET_NO_NEED) ? "No need" : "Error"))); ++ ++ } ++ ++ /*PHYDM_CSI_MASK*/ ++ /*-------------------------------------------------------------------------------------------------------------------------------*/ ++ else if (function_map == PHYDM_API_CSI_MASK) { ++ ++ if (dm_value[0] == 100) { ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "[HELP-CSI MASK] EN(on=1, off=2) CH BW(20/40/80) f_intf(Mhz) Scnd_CH(L=1, H=2)\n")); ++ return; ++ ++ } else if (dm_value[0] == CSI_MASK_ENABLE) { ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "[Enable CSI MASK] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", ++ channel, bw, f_interference, (channel > 14)?"Don't care":(((Second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "H" : "L"))); ++ set_result = phydm_csi_mask_setting(pDM_Odm, CSI_MASK_ENABLE, channel, bw, f_interference, Second_ch); ++ ++ } else if (dm_value[0] == CSI_MASK_DISABLE) { ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "[Disable CSI MASK]\n")); ++ set_result = phydm_csi_mask_setting(pDM_Odm, CSI_MASK_DISABLE, channel, bw, f_interference, Second_ch); ++ ++ } else { ++ ++ set_result = SET_ERROR; ++ } ++ PHYDM_SNPRINTF((output+used, out_len-used, "[CSI MASK set result: %s]\n", (set_result == SET_SUCCESS) ? "Success" : ((set_result == SET_NO_NEED) ? "No need" : "Error"))); ++ } ++} ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_ccx.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_ccx.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_ccx.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_ccx.c 2018-02-11 21:44:27.155146208 +0200 +@@ -0,0 +1,400 @@ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++/*Set NHM period, threshold, disable ignore cca or not, disable ignore txon or not*/ ++VOID ++phydm_NHMsetting( ++ IN PVOID pDM_VOID, ++ u1Byte NHMsetting ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ++ if (NHMsetting == SET_NHM_SETTING){ ++ ++ /*Set inexclude_cca, inexclude_txon*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT9, CCX_INFO->NHM_inexclude_cca); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT10, CCX_INFO->NHM_inexclude_txon); ++ ++ /*Set NHM period*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, bMaskHWord, CCX_INFO->NHM_period); ++ ++ /*Set NHM threshold*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte0, CCX_INFO->NHM_th[0]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte1, CCX_INFO->NHM_th[1]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte2, CCX_INFO->NHM_th[2]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte3, CCX_INFO->NHM_th[3]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte0, CCX_INFO->NHM_th[4]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte1, CCX_INFO->NHM_th[5]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte2, CCX_INFO->NHM_th[6]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte3, CCX_INFO->NHM_th[7]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0, CCX_INFO->NHM_th[8]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte2, CCX_INFO->NHM_th[9]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte3, CCX_INFO->NHM_th[10]); ++ ++ /*CCX EN*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT8, CCX_EN); ++ ++ } ++ else if (NHMsetting == STORE_NHM_SETTING) { ++ ++ /*Store pervious disable_ignore_cca, disable_ignore_txon*/ ++ CCX_INFO->NHM_inexclude_cca_restore = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT9); ++ CCX_INFO->NHM_inexclude_txon_restore = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT10); ++ ++ /*Store pervious NHM period*/ ++ CCX_INFO->NHM_period_restore = (u2Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, bMaskHWord); ++ ++ /*Store NHM threshold*/ ++ CCX_INFO->NHM_th_restore[0] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte0); ++ CCX_INFO->NHM_th_restore[1] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte1); ++ CCX_INFO->NHM_th_restore[2] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte2); ++ CCX_INFO->NHM_th_restore[3] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte3); ++ CCX_INFO->NHM_th_restore[4] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte0); ++ CCX_INFO->NHM_th_restore[5] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte1); ++ CCX_INFO->NHM_th_restore[6] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte2); ++ CCX_INFO->NHM_th_restore[7] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte3); ++ CCX_INFO->NHM_th_restore[8] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0); ++ CCX_INFO->NHM_th_restore[9] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte2); ++ CCX_INFO->NHM_th_restore[10] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte3); ++ } ++ else if (NHMsetting == RESTORE_NHM_SETTING) { ++ ++ /*Set disable_ignore_cca, disable_ignore_txon*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT9, CCX_INFO->NHM_inexclude_cca_restore); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT10, CCX_INFO->NHM_inexclude_txon_restore); ++ ++ /*Set NHM period*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, bMaskHWord, CCX_INFO->NHM_period); ++ ++ /*Set NHM threshold*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte0, CCX_INFO->NHM_th_restore[0]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte1, CCX_INFO->NHM_th_restore[1]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte2, CCX_INFO->NHM_th_restore[2]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte3, CCX_INFO->NHM_th_restore[3]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte0, CCX_INFO->NHM_th_restore[4]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte1, CCX_INFO->NHM_th_restore[5]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte2, CCX_INFO->NHM_th_restore[6]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte3, CCX_INFO->NHM_th_restore[7]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0, CCX_INFO->NHM_th_restore[8]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte2, CCX_INFO->NHM_th_restore[9]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte3, CCX_INFO->NHM_th_restore[10]); ++ } ++ else ++ return; ++ } ++ ++ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ++ if (NHMsetting == SET_NHM_SETTING){ ++ ++ /*Set disable_ignore_cca, disable_ignore_txon*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT9, CCX_INFO->NHM_inexclude_cca); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10, CCX_INFO->NHM_inexclude_txon); ++ ++ /*Set NHM period*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11N, bMaskHWord, CCX_INFO->NHM_period); ++ ++ /*Set NHM threshold*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte0, CCX_INFO->NHM_th[0]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte1, CCX_INFO->NHM_th[1]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte2, CCX_INFO->NHM_th[2]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte3, CCX_INFO->NHM_th[3]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte0, CCX_INFO->NHM_th[4]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte1, CCX_INFO->NHM_th[5]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte2, CCX_INFO->NHM_th[6]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte3, CCX_INFO->NHM_th[7]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11N, bMaskByte0, CCX_INFO->NHM_th[8]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte2, CCX_INFO->NHM_th[9]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte3, CCX_INFO->NHM_th[10]); ++ ++ /*CCX EN*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT8, CCX_EN); ++ } ++ else if (NHMsetting == STORE_NHM_SETTING) { ++ ++ /*Store pervious disable_ignore_cca, disable_ignore_txon*/ ++ CCX_INFO->NHM_inexclude_cca_restore = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT9); ++ CCX_INFO->NHM_inexclude_txon_restore= (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10); ++ ++ /*Store pervious NHM period*/ ++ CCX_INFO->NHM_period_restore= (u2Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11N, bMaskHWord); ++ ++ /*Store NHM threshold*/ ++ CCX_INFO->NHM_th_restore[0] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte0); ++ CCX_INFO->NHM_th_restore[1] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte1); ++ CCX_INFO->NHM_th_restore[2] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte2); ++ CCX_INFO->NHM_th_restore[3] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte3); ++ CCX_INFO->NHM_th_restore[4] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte0); ++ CCX_INFO->NHM_th_restore[5] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte1); ++ CCX_INFO->NHM_th_restore[6] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte2); ++ CCX_INFO->NHM_th_restore[7] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte3); ++ CCX_INFO->NHM_th_restore[8] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11N, bMaskByte0); ++ CCX_INFO->NHM_th_restore[9] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte2); ++ CCX_INFO->NHM_th_restore[10] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte3); ++ ++ } ++ else if (NHMsetting == RESTORE_NHM_SETTING) { ++ ++ /*Set disable_ignore_cca, disable_ignore_txon*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT9, CCX_INFO->NHM_inexclude_cca_restore); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10, CCX_INFO->NHM_inexclude_txon_restore); ++ ++ /*Set NHM period*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11N, bMaskHWord, CCX_INFO->NHM_period_restore); ++ ++ /*Set NHM threshold*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte0, CCX_INFO->NHM_th_restore[0]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte1, CCX_INFO->NHM_th_restore[1]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte2, CCX_INFO->NHM_th_restore[2]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte3, CCX_INFO->NHM_th_restore[3]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte0, CCX_INFO->NHM_th_restore[4]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte1, CCX_INFO->NHM_th_restore[5]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte2, CCX_INFO->NHM_th_restore[6]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte3, CCX_INFO->NHM_th_restore[7]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11N, bMaskByte0, CCX_INFO->NHM_th_restore[8]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte2, CCX_INFO->NHM_th_restore[9]); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte3, CCX_INFO->NHM_th_restore[10]); ++ } ++ else ++ return; ++ ++ } ++} ++ ++VOID ++phydm_NHMtrigger( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ++ /*Trigger NHM*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 0); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 1); ++ } ++ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ++ /*Trigger NHM*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 0); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 1); ++ } ++} ++ ++VOID ++phydm_getNHMresult( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte value32; ++ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ++ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT_11AC); ++ CCX_INFO->NHM_result[0] = (u1Byte)(value32 & bMaskByte0); ++ CCX_INFO->NHM_result[1] = (u1Byte)((value32 & bMaskByte1) >> 8); ++ CCX_INFO->NHM_result[2] = (u1Byte)((value32 & bMaskByte2) >> 16); ++ CCX_INFO->NHM_result[3] = (u1Byte)((value32 & bMaskByte3) >> 24); ++ ++ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11AC); ++ CCX_INFO->NHM_result[4] = (u1Byte)(value32 & bMaskByte0); ++ CCX_INFO->NHM_result[5] = (u1Byte)((value32 & bMaskByte1) >> 8); ++ CCX_INFO->NHM_result[6] = (u1Byte)((value32 & bMaskByte2) >> 16); ++ CCX_INFO->NHM_result[7] = (u1Byte)((value32 & bMaskByte3) >> 24); ++ ++ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT11_TO_CNT8_11AC); ++ CCX_INFO->NHM_result[8] = (u1Byte)(value32 & bMaskByte0); ++ CCX_INFO->NHM_result[9] = (u1Byte)((value32 & bMaskByte1) >> 8); ++ CCX_INFO->NHM_result[10] = (u1Byte)((value32 & bMaskByte2) >> 16); ++ CCX_INFO->NHM_result[11] = (u1Byte)((value32 & bMaskByte3) >> 24); ++ ++ /*Get NHM duration*/ ++ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_DUR_READY_11AC); ++ CCX_INFO->NHM_duration = (u2Byte)(value32 & bMaskLWord); ++ ++ } ++ ++ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ++ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT_11N); ++ CCX_INFO->NHM_result[0] = (u1Byte)(value32 & bMaskByte0); ++ CCX_INFO->NHM_result[1] = (u1Byte)((value32 & bMaskByte1) >> 8); ++ CCX_INFO->NHM_result[2] = (u1Byte)((value32 & bMaskByte2) >> 16); ++ CCX_INFO->NHM_result[3] = (u1Byte)((value32 & bMaskByte3) >> 24); ++ ++ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11N); ++ CCX_INFO->NHM_result[4] = (u1Byte)(value32 & bMaskByte0); ++ CCX_INFO->NHM_result[5] = (u1Byte)((value32 & bMaskByte1) >> 8); ++ CCX_INFO->NHM_result[6] = (u1Byte)((value32 & bMaskByte2) >> 16); ++ CCX_INFO->NHM_result[7] = (u1Byte)((value32 & bMaskByte3) >> 24); ++ ++ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT9_TO_CNT8_11N); ++ CCX_INFO->NHM_result[8] = (u1Byte)((value32 & bMaskByte2) >> 16); ++ CCX_INFO->NHM_result[9] = (u1Byte)((value32 & bMaskByte3) >> 24); ++ ++ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT10_TO_CNT11_11N); ++ CCX_INFO->NHM_result[10] = (u1Byte)((value32 & bMaskByte2) >> 16); ++ CCX_INFO->NHM_result[11] = (u1Byte)((value32 & bMaskByte3) >> 24); ++ ++ /*Get NHM duration*/ ++ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT10_TO_CNT11_11N); ++ CCX_INFO->NHM_duration = (u2Byte)(value32 & bMaskLWord); ++ ++ } ++ ++} ++ ++BOOLEAN ++phydm_checkNHMready( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte value32 = 0; ++ u1Byte i; ++ BOOLEAN ret = FALSE; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11AC, bMaskDWord); ++ ++ for (i = 0; i < 200; i ++) { ++ ++ ODM_delay_ms(1); ++ if (ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_DUR_READY_11AC, BIT17)) { ++ ret = 1; ++ break; ++ } ++ } ++ } ++ ++ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_READY_11N, bMaskDWord); ++ ++ for (i = 0; i < 200; i ++) { ++ ++ ODM_delay_ms(1); ++ if (ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_DUR_READY_11AC, BIT17) ) { ++ ret = 1; ++ break; ++ } ++ } ++ } ++ return ret; ++} ++ ++VOID ++phydm_storeNHMsetting( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ++ ++ } ++ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ++ ++ ++ } ++} ++ ++VOID ++phydm_CLMsetting( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; ++ ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, bMaskLWord, CCX_INFO->CLM_period); /*4us sample 1 time*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11AC, BIT8, 0x1); /*Enable CCX for CLM*/ ++ ++ } else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11N, bMaskLWord, CCX_INFO->CLM_period); /*4us sample 1 time*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11N, BIT8, 0x1); /*Enable CCX for CLM*/ ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCX, ODM_DBG_LOUD, ("[%s] : CLM period = %dus\n", __func__, CCX_INFO->CLM_period*4)); ++ ++} ++ ++VOID ++phydm_CLMtrigger( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11AC, BIT0, 0x0); /*Trigger CLM*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11AC, BIT0, 0x1); ++ } else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11N, BIT0, 0x0); /*Trigger CLM*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11N, BIT0, 0x1); ++ } ++} ++ ++BOOLEAN ++phydm_checkCLMready( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte value32 = 0; ++ BOOLEAN ret = FALSE; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11AC, bMaskDWord); /*make sure CLM calc is ready*/ ++ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_READY_11N, bMaskDWord); /*make sure CLM calc is ready*/ ++ ++ if ((pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) && (value32 & BIT16)) ++ ret = TRUE; ++ else if ((pDM_Odm->SupportICType & ODM_IC_11N_SERIES) && (value32 & BIT17)) ++ ret = TRUE; ++ else ++ ret = FALSE; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCX, ODM_DBG_LOUD, ("[%s] : CLM ready = %d\n", __func__, ret)); ++ ++ return ret; ++} ++ ++void ++phydm_getCLMresult( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; ++ ++ u4Byte value32 = 0; ++ u2Byte results = 0; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11AC, bMaskDWord); /*read CLM calc result*/ ++ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11N, bMaskDWord); /*read CLM calc result*/ ++ ++ CCX_INFO->CLM_result = (u2Byte)(value32 & bMaskLWord); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCX, ODM_DBG_LOUD, ("[%s] : CLM result = %dus\n", __func__, CCX_INFO->CLM_result*4)); ++ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_ccx.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_ccx.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_ccx.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_ccx.h 2018-02-11 21:44:27.155146208 +0200 +@@ -0,0 +1,102 @@ ++#ifndef __PHYDMCCX_H__ ++#define __PHYDMCCX_H__ ++ ++#define CCX_EN 1 ++ ++#define SET_NHM_SETTING 0 ++#define STORE_NHM_SETTING 1 ++#define RESTORE_NHM_SETTING 2 ++ ++/* ++#define NHM_EXCLUDE_CCA 0 ++#define NHM_INCLUDE_CCA 1 ++#define NHM_EXCLUDE_TXON 0 ++#define NHM_INCLUDE_TXON 1 ++*/ ++ ++typedef enum NHM_inexclude_cca { ++ NHM_EXCLUDE_CCA, ++ NHM_INCLUDE_CCA ++}NHM_INEXCLUDE_CCA; ++ ++typedef enum NHM_inexclude_txon { ++ NHM_EXCLUDE_TXON, ++ NHM_INCLUDE_TXON ++}NHM_INEXCLUDE_TXON; ++ ++ ++typedef struct _CCX_INFO{ ++ ++ /*Settings*/ ++ u1Byte NHM_th[11]; ++ u2Byte NHM_period; /* 4us per unit */ ++ u2Byte CLM_period; /* 4us per unit */ ++ NHM_INEXCLUDE_TXON NHM_inexclude_txon; ++ NHM_INEXCLUDE_CCA NHM_inexclude_cca; ++ ++ /*Previous Settings*/ ++ u1Byte NHM_th_restore[11]; ++ u2Byte NHM_period_restore; /* 4us per unit */ ++ u2Byte CLM_period_restore; /* 4us per unit */ ++ NHM_INEXCLUDE_TXON NHM_inexclude_txon_restore; ++ NHM_INEXCLUDE_CCA NHM_inexclude_cca_restore; ++ ++ /*Report*/ ++ u1Byte NHM_result[12]; ++ u2Byte NHM_duration; ++ u2Byte CLM_result; ++ ++ ++ BOOLEAN echo_NHM_en; ++ BOOLEAN echo_CLM_en; ++ u1Byte echo_IGI; ++ ++}CCX_INFO, *PCCX_INFO; ++ ++/*NHM*/ ++ ++VOID ++phydm_NHMsetting( ++ IN PVOID pDM_VOID, ++ u1Byte NHMsetting ++); ++ ++VOID ++phydm_NHMtrigger( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++phydm_getNHMresult( ++ IN PVOID pDM_VOID ++); ++ ++BOOLEAN ++phydm_checkNHMready( ++ IN PVOID pDM_VOID ++); ++ ++/*CLM*/ ++ ++VOID ++phydm_CLMsetting( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++phydm_CLMtrigger( ++ IN PVOID pDM_VOID ++); ++ ++BOOLEAN ++phydm_checkCLMready( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++phydm_getCLMresult( ++ IN PVOID pDM_VOID ++); ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.c 2018-02-11 21:44:27.155146208 +0200 +@@ -0,0 +1,381 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++VOID ++odm_SetCrystalCap( ++ IN PVOID pDM_VOID, ++ IN u1Byte CrystalCap ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); ++ ++ if(pCfoTrack->CrystalCap == CrystalCap) ++ return; ++ ++ pCfoTrack->CrystalCap = CrystalCap; ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8188E | ODM_RTL8188F)) { ++ /* write 0x24[22:17] = 0x24[16:11] = CrystalCap */ ++ CrystalCap = CrystalCap & 0x3F; ++ ODM_SetBBReg(pDM_Odm, REG_AFE_XTAL_CTRL, 0x007ff800, (CrystalCap|(CrystalCap << 6))); ++ } else if (pDM_Odm->SupportICType & ODM_RTL8812) { ++ /* write 0x2C[30:25] = 0x2C[24:19] = CrystalCap */ ++ CrystalCap = CrystalCap & 0x3F; ++ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0x7FF80000, (CrystalCap|(CrystalCap << 6))); ++ } else if ((pDM_Odm->SupportICType & (ODM_RTL8703B|ODM_RTL8723B|ODM_RTL8192E|ODM_RTL8821))) { ++ /* 0x2C[23:18] = 0x2C[17:12] = CrystalCap */ ++ CrystalCap = CrystalCap & 0x3F; ++ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0x00FFF000, (CrystalCap|(CrystalCap << 6))); ++ } else if (pDM_Odm->SupportICType & ODM_RTL8814A) { ++ /* write 0x2C[26:21] = 0x2C[20:15] = CrystalCap */ ++ CrystalCap = CrystalCap & 0x3F; ++ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0x07FF8000, (CrystalCap|(CrystalCap << 6))); ++ } else if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8821C)) { ++ /* write 0x24[30:25] = 0x28[6:1] = CrystalCap */ ++ CrystalCap = CrystalCap & 0x3F; ++ ODM_SetBBReg(pDM_Odm, REG_AFE_XTAL_CTRL, 0x7e000000, CrystalCap); ++ ODM_SetBBReg(pDM_Odm, REG_AFE_PLL_CTRL, 0x7e, CrystalCap); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_SetCrystalCap(): Use default setting.\n")); ++ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCap|(CrystalCap << 6))); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_SetCrystalCap(): CrystalCap = 0x%x\n", CrystalCap)); ++#endif ++} ++ ++u1Byte ++odm_GetDefaultCrytaltalCap( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte CrystalCap = 0x20; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ CrystalCap = pHalData->CrystalCap; ++#else ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ ++ if(priv->pmib->dot11RFEntry.xcap > 0) ++ CrystalCap = priv->pmib->dot11RFEntry.xcap; ++#endif ++ ++ CrystalCap = CrystalCap & 0x3f; ++ ++ return CrystalCap; ++} ++ ++VOID ++odm_SetATCStatus( ++ IN PVOID pDM_VOID, ++ IN BOOLEAN ATCStatus ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); ++ ++ if(pCfoTrack->bATCStatus == ATCStatus) ++ return; ++ ++ ODM_SetBBReg(pDM_Odm, ODM_REG(BB_ATC,pDM_Odm), ODM_BIT(BB_ATC,pDM_Odm), ATCStatus); ++ pCfoTrack->bATCStatus = ATCStatus; ++} ++ ++BOOLEAN ++odm_GetATCStatus( ++ IN PVOID pDM_VOID ++) ++{ ++ BOOLEAN ATCStatus; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ATCStatus = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG(BB_ATC,pDM_Odm), ODM_BIT(BB_ATC,pDM_Odm)); ++ return ATCStatus; ++} ++ ++VOID ++ODM_CfoTrackingReset( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); ++ ++ pCfoTrack->DefXCap = odm_GetDefaultCrytaltalCap(pDM_Odm); ++ pCfoTrack->bAdjust = TRUE; ++ ++ if(pCfoTrack->CrystalCap > pCfoTrack->DefXCap) ++ { ++ odm_SetCrystalCap(pDM_Odm, pCfoTrack->CrystalCap - 1); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ++ ("ODM_CfoTrackingReset(): approch default value (0x%x)\n", pCfoTrack->CrystalCap)); ++ } else if (pCfoTrack->CrystalCap < pCfoTrack->DefXCap) ++ { ++ odm_SetCrystalCap(pDM_Odm, pCfoTrack->CrystalCap + 1); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ++ ("ODM_CfoTrackingReset(): approch default value (0x%x)\n", pCfoTrack->CrystalCap)); ++ } ++ ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ odm_SetATCStatus(pDM_Odm, TRUE); ++ #endif ++} ++ ++VOID ++ODM_CfoTrackingInit( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); ++ ++ pCfoTrack->DefXCap = pCfoTrack->CrystalCap = odm_GetDefaultCrytaltalCap(pDM_Odm); ++ pCfoTrack->bATCStatus = odm_GetATCStatus(pDM_Odm); ++ pCfoTrack->bAdjust = TRUE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking_init()=========>\n")); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking_init(): bATCStatus = %d, CrystalCap = 0x%x\n", pCfoTrack->bATCStatus, pCfoTrack->DefXCap)); ++ ++#if RTL8822B_SUPPORT ++ /* Crystal cap. control by WiFi */ ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ ODM_SetBBReg(pDM_Odm, 0x10, 0x40, 0x1); ++#endif ++ ++#if RTL8821C_SUPPORT ++ /* Crystal cap. control by WiFi */ ++ if (pDM_Odm->SupportICType & ODM_RTL8821C) ++ ODM_SetBBReg(pDM_Odm, 0x10, 0x40, 0x1); ++#endif ++} ++ ++VOID ++ODM_CfoTracking( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); ++ s4Byte CFO_ave = 0; ++ u4Byte CFO_rpt_sum, CFO_kHz_avg[4] = {0}; ++ s4Byte CFO_ave_diff; ++ s1Byte CrystalCap = pCfoTrack->CrystalCap; ++ u1Byte Adjust_Xtal = 1, i, valid_path_cnt = 0; ++ ++ //4 Support ability ++ if(!(pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Return: SupportAbility ODM_BB_CFO_TRACKING is disabled\n")); ++ return; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking()=========> \n")); ++ ++ if(!pDM_Odm->bLinked || !pDM_Odm->bOneEntryOnly) ++ { ++ //4 No link or more than one entry ++ ODM_CfoTrackingReset(pDM_Odm); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Reset: bLinked = %d, bOneEntryOnly = %d\n", ++ pDM_Odm->bLinked, pDM_Odm->bOneEntryOnly)); ++ } ++ else ++ { ++ //3 1. CFO Tracking ++ //4 1.1 No new packet ++ if(pCfoTrack->packetCount == pCfoTrack->packetCount_pre) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): packet counter doesn't change\n")); ++ return; ++ } ++ pCfoTrack->packetCount_pre = pCfoTrack->packetCount; ++ ++ //4 1.2 Calculate CFO ++ for (i = 0; i < pDM_Odm->num_rf_path; i++) { ++ ++ if (pCfoTrack->CFO_cnt[i] == 0) ++ continue; ++ ++ valid_path_cnt++; ++ CFO_rpt_sum = (u4Byte)((pCfoTrack->CFO_tail[i] < 0) ? (0 - pCfoTrack->CFO_tail[i]) : pCfoTrack->CFO_tail[i]); ++ CFO_kHz_avg[i] = CFO_HW_RPT_2_MHZ(CFO_rpt_sum) / pCfoTrack->CFO_cnt[i]; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("[Path %d] CFO_rpt_sum = (( %d )), CFO_cnt = (( %d )) , CFO_avg= (( %s%d )) kHz\n", ++ i, CFO_rpt_sum, pCfoTrack->CFO_cnt[i],((pCfoTrack->CFO_tail[i] < 0) ? "-" : " ") ,CFO_kHz_avg[i])); ++ } ++ ++ for (i = 0; i < valid_path_cnt; i++) { ++ ++ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("path [%d], pCfoTrack->CFO_tail = %d\n", i, pCfoTrack->CFO_tail[i])); ++ if (pCfoTrack->CFO_tail[i] < 0) { ++ CFO_ave += (0-(s4Byte)CFO_kHz_avg[i]); ++ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("CFO_ave = %d\n", CFO_ave)); ++ } ++ else ++ CFO_ave += (s4Byte)CFO_kHz_avg[i]; ++ } ++ ++ if (valid_path_cnt >= 2) ++ CFO_ave = CFO_ave / valid_path_cnt; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("valid_path_cnt = ((%d)), CFO_ave = ((%d kHz))\n", valid_path_cnt, CFO_ave)); ++ ++ /*reset counter*/ ++ for (i = 0; i < pDM_Odm->num_rf_path; i++) { ++ pCfoTrack->CFO_tail[i] = 0; ++ pCfoTrack->CFO_cnt[i] = 0; ++ } ++ ++ //4 1.3 Avoid abnormal large CFO ++ CFO_ave_diff = (pCfoTrack->CFO_ave_pre >= CFO_ave)?(pCfoTrack->CFO_ave_pre - CFO_ave):(CFO_ave - pCfoTrack->CFO_ave_pre); ++ if(CFO_ave_diff > 20 && pCfoTrack->largeCFOHit == 0 && !pCfoTrack->bAdjust) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): first large CFO hit\n")); ++ pCfoTrack->largeCFOHit = 1; ++ return; ++ } ++ else ++ pCfoTrack->largeCFOHit = 0; ++ pCfoTrack->CFO_ave_pre = CFO_ave; ++ ++ //4 1.4 Dynamic Xtal threshold ++ if(pCfoTrack->bAdjust == FALSE) ++ { ++ if(CFO_ave > CFO_TH_XTAL_HIGH || CFO_ave < (-CFO_TH_XTAL_HIGH)) ++ pCfoTrack->bAdjust = TRUE; ++ } ++ else ++ { ++ if(CFO_ave < CFO_TH_XTAL_LOW && CFO_ave > (-CFO_TH_XTAL_LOW)) ++ pCfoTrack->bAdjust = FALSE; ++ } ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ //4 1.5 BT case: Disable CFO tracking ++ if(pDM_Odm->bBtEnabled) ++ { ++ pCfoTrack->bAdjust = FALSE; ++ odm_SetCrystalCap(pDM_Odm, pCfoTrack->DefXCap); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Disable CFO tracking for BT!!\n")); ++ } ++/* ++ //4 1.6 Big jump ++ if(pCfoTrack->bAdjust) ++ { ++ if(CFO_ave > CFO_TH_XTAL_LOW) ++ Adjust_Xtal = Adjust_Xtal + ((CFO_ave - CFO_TH_XTAL_LOW) >> 2); ++ else if(CFO_ave < (-CFO_TH_XTAL_LOW)) ++ Adjust_Xtal = Adjust_Xtal + ((CFO_TH_XTAL_LOW - CFO_ave) >> 2); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Crystal cap offset = %d\n", Adjust_Xtal)); ++ } ++*/ ++#endif ++ ++ //4 1.7 Adjust Crystal Cap. ++ if(pCfoTrack->bAdjust) ++ { ++ if(CFO_ave > CFO_TH_XTAL_LOW) ++ CrystalCap = CrystalCap + Adjust_Xtal; ++ else if(CFO_ave < (-CFO_TH_XTAL_LOW)) ++ CrystalCap = CrystalCap - Adjust_Xtal; ++ ++ if(CrystalCap > 0x3f) ++ CrystalCap = 0x3f; ++ else if (CrystalCap < 0) ++ CrystalCap = 0; ++ ++ odm_SetCrystalCap(pDM_Odm, (u1Byte)CrystalCap); ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Crystal cap = 0x%x, Default Crystal cap = 0x%x\n", ++ pCfoTrack->CrystalCap, pCfoTrack->DefXCap)); ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ return; ++ ++ //3 2. Dynamic ATC switch ++ if(CFO_ave < CFO_TH_ATC && CFO_ave > -CFO_TH_ATC) ++ { ++ odm_SetATCStatus(pDM_Odm, FALSE); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Disable ATC!!\n")); ++ } ++ else ++ { ++ odm_SetATCStatus(pDM_Odm, TRUE); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Enable ATC!!\n")); ++ } ++#endif ++ } ++} ++ ++VOID ++ODM_ParsingCFO( ++ IN PVOID pDM_VOID, ++ IN PVOID pPktinfo_VOID, ++ IN s1Byte* pcfotail, ++ IN u1Byte num_ss ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PODM_PACKET_INFO_T pPktinfo = (PODM_PACKET_INFO_T)pPktinfo_VOID; ++ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); ++ u1Byte i; ++ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)) ++ return; ++ ++#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ if(pPktinfo->bPacketMatchBSSID) ++#else ++ if(pPktinfo->StationID != 0) ++#endif ++ { ++ if (num_ss > pDM_Odm->num_rf_path) /*For fool proof*/ ++ num_ss = pDM_Odm->num_rf_path; ++ ++ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("num_ss = ((%d)), pDM_Odm->num_rf_path = ((%d))\n", num_ss, pDM_Odm->num_rf_path));*/ ++ ++ ++ //3 Update CFO report for path-A & path-B ++ // Only paht-A and path-B have CFO tail and short CFO ++ for(i = 0; i < num_ss; i++) ++ { ++ pCfoTrack->CFO_tail[i] += pcfotail[i]; ++ pCfoTrack->CFO_cnt[i] ++; ++ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("[ID %d][path %d][Rate 0x%x] CFO_tail = ((%d)), CFO_tail_sum = ((%d)), CFO_cnt = ((%d))\n", ++ pPktinfo->StationID, i, pPktinfo->DataRate, pcfotail[i], pCfoTrack->CFO_tail[i], pCfoTrack->CFO_cnt[i])); ++ */ ++ } ++ ++ //3 Update packet counter ++ if(pCfoTrack->packetCount == 0xffffffff) ++ pCfoTrack->packetCount = 0; ++ else ++ pCfoTrack->packetCount++; ++ } ++} ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.h 2018-02-11 21:44:27.155146208 +0200 +@@ -0,0 +1,70 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMCFOTRACK_H__ ++#define __PHYDMCFOTRACK_H__ ++ ++#define CFO_TRACKING_VERSION "1.4" /*2015.10.01 Stanley, Modify for 8822B*/ ++ ++#define CFO_TH_XTAL_HIGH 20 // kHz ++#define CFO_TH_XTAL_LOW 10 // kHz ++#define CFO_TH_ATC 80 // kHz ++ ++typedef struct _CFO_TRACKING_ ++{ ++ BOOLEAN bATCStatus; ++ BOOLEAN largeCFOHit; ++ BOOLEAN bAdjust; ++ u1Byte CrystalCap; ++ u1Byte DefXCap; ++ s4Byte CFO_tail[4]; ++ u4Byte CFO_cnt[4]; ++ s4Byte CFO_ave_pre; ++ u4Byte packetCount; ++ u4Byte packetCount_pre; ++ ++ BOOLEAN bForceXtalCap; ++ BOOLEAN bReset; ++}CFO_TRACKING, *PCFO_TRACKING; ++ ++VOID ++ODM_CfoTrackingReset( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++ODM_CfoTrackingInit( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++ODM_CfoTracking( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++ODM_ParsingCFO( ++ IN PVOID pDM_VOID, ++ IN PVOID pPktinfo_VOID, ++ IN s1Byte* pcfotail, ++ IN u1Byte num_ss ++); ++ ++#endif +\ Ingen nyrad vid filslut +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_debug.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_debug.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_debug.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_debug.c 2018-02-11 21:44:27.155146208 +0200 +@@ -0,0 +1,3015 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++VOID ++PHYDM_InitDebugSetting( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ pDM_Odm->DebugLevel = ODM_DBG_TRACE; ++ ++ pDM_Odm->fw_DebugComponents = 0; ++ pDM_Odm->DebugComponents = ++ \ ++#if DBG ++/*BB Functions*/ ++/* ODM_COMP_DIG |*/ ++/* ODM_COMP_RA_MASK |*/ ++/* ODM_COMP_DYNAMIC_TXPWR |*/ ++/* ODM_COMP_FA_CNT |*/ ++/* ODM_COMP_RSSI_MONITOR |*/ ++/* ODM_COMP_SNIFFER |*/ ++/* ODM_COMP_ANT_DIV |*/ ++/* ODM_COMP_NOISY_DETECT |*/ ++/* ODM_COMP_RATE_ADAPTIVE |*/ ++/* ODM_COMP_PATH_DIV |*/ ++/* ODM_COMP_DYNAMIC_PRICCA |*/ ++/* ODM_COMP_MP |*/ ++/* ODM_COMP_CFO_TRACKING |*/ ++/* ODM_COMP_ACS |*/ ++/* PHYDM_COMP_ADAPTIVITY |*/ ++/* PHYDM_COMP_RA_DBG |*/ ++/* PHYDM_COMP_TXBF |*/ ++ ++/*MAC Functions*/ ++/* ODM_COMP_EDCA_TURBO |*/ ++/* ODM_FW_DEBUG_TRACE |*/ ++ ++/*RF Functions*/ ++/* ODM_COMP_TX_PWR_TRACK |*/ ++/* ODM_COMP_CALIBRATION |*/ ++ ++/*Common*/ ++/* ODM_PHY_CONFIG |*/ ++/* ODM_COMP_INIT |*/ ++/* ODM_COMP_COMMON |*/ ++/* ODM_COMP_API |*/ ++ ++ ++#endif ++ 0; ++ ++ pDM_Odm->fw_buff_is_enpty = TRUE; ++ pDM_Odm->pre_c2h_seq = 0; ++} ++ ++VOID ++phydm_BB_RxHang_Info( ++ IN PVOID pDM_VOID, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++) ++{ ++ u4Byte value32 = 0; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ return; ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xF80 , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rptreg of sc/bw/ht/...", value32)); ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ ODM_SetBBReg(pDM_Odm, 0x198c , BIT2|BIT1|BIT0, 7); ++ ++ /* dbg_port = basic state machine */ ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x000); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "basic state machine", value32)); ++ } ++ ++ /* dbg_port = state machine */ ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x007); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "state machine", value32)); ++ } ++ ++ /* dbg_port = CCA-related*/ ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x204); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "CCA-related", value32)); ++ } ++ ++ ++ /* dbg_port = edcca/rxd*/ ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x278); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "edcca/rxd", value32)); ++ } ++ ++ /* dbg_port = rx_state/mux_state/ADC_MASK_OFDM*/ ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x290); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx_state/mux_state/ADC_MASK_OFDM", value32)); ++ } ++ ++ /* dbg_port = bf-related*/ ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x2B2); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "bf-related", value32)); ++ } ++ ++ /* dbg_port = bf-related*/ ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x2B8); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "bf-related", value32)); ++ } ++ ++ /* dbg_port = txon/rxd*/ ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xA03); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "txon/rxd", value32)); ++ } ++ ++ /* dbg_port = l_rate/l_length*/ ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xA0B); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "l_rate/l_length", value32)); ++ } ++ ++ /* dbg_port = rxd/rxd_hit*/ ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xA0D); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rxd/rxd_hit", value32)); ++ } ++ ++ /* dbg_port = dis_cca*/ ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAA0); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "dis_cca", value32)); ++ } ++ ++ ++ /* dbg_port = tx*/ ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAB0); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "tx", value32)); ++ } ++ ++ /* dbg_port = rx plcp*/ ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD0); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); ++ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD1); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); ++ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD2); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); ++ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD3); ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); ++ } ++ ++} ++ ++VOID ++phydm_BB_Debug_Info( ++ IN PVOID pDM_VOID, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ char *tmp_string = NULL; ++ ++ u1Byte RX_HT_BW, RX_VHT_BW, RXSC, RX_HT, RX_BW; ++ static u1Byte vRX_BW ; ++ u4Byte value32, value32_1, value32_2, value32_3; ++ s4Byte SFO_A, SFO_B, SFO_C, SFO_D; ++ s4Byte LFO_A, LFO_B, LFO_C, LFO_D; ++ static u1Byte MCSS, Tail, Parity, rsv, vrsv, idx, smooth, htsound, agg, stbc, vstbc, fec, fecext, sgi, sgiext, htltf, vgid, vNsts, vtxops, vrsv2, vbrsv, bf, vbcrc; ++ static u2Byte HLength, htcrc8, Length; ++ static u2Byte vpaid; ++ static u2Byte vLength, vhtcrc8, vMCSS, vTail, vbTail; ++ static u1Byte HMCSS, HRX_BW; ++ ++ u1Byte pwDB; ++ s1Byte RXEVM_0, RXEVM_1, RXEVM_2 ; ++ u1Byte RF_gain_pathA, RF_gain_pathB, RF_gain_pathC, RF_gain_pathD; ++ u1Byte RX_SNR_pathA, RX_SNR_pathB, RX_SNR_pathC, RX_SNR_pathD; ++ s4Byte sig_power; ++ ++ const char *L_rate[8] = {"6M", "9M", "12M", "18M", "24M", "36M", "48M", "54M"}; ++ ++ /* ++ const double evm_comp_20M = 0.579919469776867; //10*log10(64.0/56.0) ++ const double evm_comp_40M = 0.503051183113957; //10*log10(128.0/114.0) ++ const double evm_comp_80M = 0.244245993314183; //10*log10(256.0/242.0) ++ const double evm_comp_160M = 0.244245993314183; //10*log10(512.0/484.0) ++ */ ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ return; ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s\n", "BB Report Info")); ++ ++ /*BW & Mode Detection*/ ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xf80 , bMaskDWord); ++ value32_2 = value32; ++ RX_HT_BW = (u1Byte)(value32 & 0x1); ++ RX_VHT_BW = (u1Byte)((value32 >> 1) & 0x3); ++ RXSC = (u1Byte)(value32 & 0x78); ++ value32_1 = (value32 & 0x180) >> 7; ++ RX_HT = (u1Byte)(value32_1); ++ ++ RX_BW = 0; ++ ++ if (RX_HT == 2) { ++ if (RX_VHT_BW == 0) { ++ tmp_string = "20M"; ++ } else if (RX_VHT_BW == 1) { ++ tmp_string = "40M"; ++ } else { ++ tmp_string = "80M"; ++ } ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s %s %s", "Mode", "VHT", tmp_string)); ++ RX_BW = RX_VHT_BW; ++ } else if (RX_HT == 1) { ++ if (RX_HT_BW == 0) { ++ tmp_string = "20M"; ++ } else if (RX_HT_BW == 1) { ++ tmp_string = "40M"; ++ } ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s %s %s", "Mode", "HT", tmp_string)); ++ RX_BW = RX_HT_BW; ++ } else { ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s %s", "Mode", "Legacy")); ++ } ++ ++ if (RX_HT != 0) { ++ if (RXSC == 0) ++ tmp_string = "duplicate/full bw"; ++ else if (RXSC == 1) ++ tmp_string = "usc20-1"; ++ else if (RXSC == 2) ++ tmp_string = "lsc20-1"; ++ else if (RXSC == 3) ++ tmp_string = "usc20-2"; ++ else if (RXSC == 4) ++ tmp_string = "lsc20-2"; ++ else if (RXSC == 9) ++ tmp_string = "usc40"; ++ else if (RXSC == 10) ++ tmp_string = "lsc40"; ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s", tmp_string)); ++ } ++ ++ /* RX signal power and AGC related info*/ ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xF90 , bMaskDWord); ++ pwDB = (u1Byte)((value32 & bMaskByte1) >> 8); ++ pwDB = pwDB >> 1; ++ sig_power = -110 + pwDB; ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "OFDM RX Signal Power(dB)", sig_power)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xd14 , bMaskDWord); ++ RX_SNR_pathA = (u1Byte)(value32 & 0xFF) >> 1; ++ RF_gain_pathA = (s1Byte)((value32 & bMaskByte1) >> 8); ++ RF_gain_pathA *= 2; ++ value32 = ODM_GetBBReg(pDM_Odm, 0xd54 , bMaskDWord); ++ RX_SNR_pathB = (u1Byte)(value32 & 0xFF) >> 1; ++ RF_gain_pathB = (s1Byte)((value32 & bMaskByte1) >> 8); ++ RF_gain_pathB *= 2; ++ value32 = ODM_GetBBReg(pDM_Odm, 0xd94 , bMaskDWord); ++ RX_SNR_pathC = (u1Byte)(value32 & 0xFF) >> 1; ++ RF_gain_pathC = (s1Byte)((value32 & bMaskByte1) >> 8); ++ RF_gain_pathC *= 2; ++ value32 = ODM_GetBBReg(pDM_Odm, 0xdd4 , bMaskDWord); ++ RX_SNR_pathD = (u1Byte)(value32 & 0xFF) >> 1; ++ RF_gain_pathD = (s1Byte)((value32 & bMaskByte1) >> 8); ++ RF_gain_pathD *= 2; ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d / %d", "OFDM RX RF Gain(A/B/C/D)", RF_gain_pathA, RF_gain_pathB, RF_gain_pathC, RF_gain_pathD)); ++ ++ ++ /* RX Counter related info*/ ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xF08, bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "OFDM CCA Counter", ((value32&0xFFFF0000)>>16))); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xFD0, bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "OFDM SBD Fail Counter", value32&0xFFFF)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xFC4, bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "VHT SIGA/SIGB CRC8 Fail Counter", value32&0xFFFF, ((value32&0xFFFF0000)>>16))); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xFCC, bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "CCK CCA Counter", value32&0xFFFF)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xFBC, bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "LSIG (Parity Fail/Rate Illegal) Counter", value32&0xFFFF, ((value32&0xFFFF0000)>>16))); ++ ++ value32_1 = ODM_GetBBReg(pDM_Odm, 0xFC8, bMaskDWord); ++ value32_2 = ODM_GetBBReg(pDM_Odm, 0xFC0, bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "HT/VHT MCS NOT SUPPORT counter", ((value32_2&0xFFFF0000)>>16), value32_1&0xFFFF)); ++ ++ /* PostFFT related info*/ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xF8c , bMaskDWord); ++ RXEVM_0 = (s1Byte)((value32 & bMaskByte2) >> 16); ++ RXEVM_0 /= 2; ++ if (RXEVM_0 < -63) ++ RXEVM_0 = 0; ++ ++ RXEVM_1 = (s1Byte)((value32 & bMaskByte3) >> 24); ++ RXEVM_1 /= 2; ++ value32 = ODM_GetBBReg(pDM_Odm, 0xF88 , bMaskDWord); ++ RXEVM_2 = (s1Byte)((value32 & bMaskByte2) >> 16); ++ RXEVM_2 /= 2; ++ ++ if (RXEVM_1 < -63) ++ RXEVM_1 = 0; ++ if (RXEVM_2 < -63) ++ RXEVM_2 = 0; ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d", "RXEVM (1ss/2ss/3ss)", RXEVM_0, RXEVM_1, RXEVM_2)); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d / %d", "RXSNR(A/B/C/D, dB)", RX_SNR_pathA, RX_SNR_pathB, RX_SNR_pathC, RX_SNR_pathD)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xF8C , bMaskDWord); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "CSI_1st /CSI_2nd", value32&0xFFFF, ((value32&0xFFFF0000)>>16))); ++ ++ /*BW & Mode Detection*/ ++ ++ /*Reset Page F Counter*/ ++ ODM_SetBBReg(pDM_Odm, 0xB58 , BIT0, 1); ++ ODM_SetBBReg(pDM_Odm, 0xB58 , BIT0, 0); ++ ++ /*CFO Report Info*/ ++ /*Short CFO*/ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xd0c , bMaskDWord); ++ value32_1 = ODM_GetBBReg(pDM_Odm, 0xd4c , bMaskDWord); ++ value32_2 = ODM_GetBBReg(pDM_Odm, 0xd8c , bMaskDWord); ++ value32_3 = ODM_GetBBReg(pDM_Odm, 0xdcc , bMaskDWord); ++ ++ SFO_A = (s4Byte)(value32 & 0xfff); ++ SFO_B = (s4Byte)(value32_1 & 0xfff); ++ SFO_C = (s4Byte)(value32_2 & 0xfff); ++ SFO_D = (s4Byte)(value32_3 & 0xfff); ++ ++ LFO_A = (s4Byte)(value32 >> 16); ++ LFO_B = (s4Byte)(value32_1 >> 16); ++ LFO_C = (s4Byte)(value32_2 >> 16); ++ LFO_D = (s4Byte)(value32_3 >> 16); ++ ++ /*SFO 2's to dec*/ ++ if (SFO_A > 2047) ++ SFO_A = SFO_A - 4096; ++ SFO_A = (SFO_A * 312500) / 2048; ++ if (SFO_B > 2047) ++ SFO_B = SFO_B - 4096; ++ SFO_B = (SFO_B * 312500) / 2048; ++ if (SFO_C > 2047) ++ SFO_C = SFO_C - 4096; ++ SFO_C = (SFO_C * 312500) / 2048; ++ if (SFO_D > 2047) ++ SFO_D = SFO_D - 4096; ++ SFO_D = (SFO_D * 312500) / 2048; ++ ++ /*LFO 2's to dec*/ ++ ++ if (LFO_A > 4095) ++ LFO_A = LFO_A - 8192; ++ ++ if (LFO_B > 4095) ++ LFO_B = LFO_B - 8192; ++ ++ if (LFO_C > 4095) ++ LFO_C = LFO_C - 8192; ++ ++ if (LFO_D > 4095) ++ LFO_D = LFO_D - 8192; ++ LFO_A = LFO_A * 312500 / 4096; ++ LFO_B = LFO_B * 312500 / 4096; ++ LFO_C = LFO_C * 312500 / 4096; ++ LFO_D = LFO_D * 312500 / 4096; ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "CFO Report Info")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "Short CFO(Hz) ", SFO_A, SFO_B, SFO_C, SFO_D)); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "Long CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D)); ++ ++ /*SCFO*/ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xd10 , bMaskDWord); ++ value32_1 = ODM_GetBBReg(pDM_Odm, 0xd50 , bMaskDWord); ++ value32_2 = ODM_GetBBReg(pDM_Odm, 0xd90 , bMaskDWord); ++ value32_3 = ODM_GetBBReg(pDM_Odm, 0xdd0 , bMaskDWord); ++ ++ SFO_A = (s4Byte)(value32 & 0x7ff); ++ SFO_B = (s4Byte)(value32_1 & 0x7ff); ++ SFO_C = (s4Byte)(value32_2 & 0x7ff); ++ SFO_D = (s4Byte)(value32_3 & 0x7ff); ++ ++ if (SFO_A > 1023) ++ SFO_A = SFO_A - 2048; ++ ++ if (SFO_B > 2047) ++ SFO_B = SFO_B - 4096; ++ ++ if (SFO_C > 2047) ++ SFO_C = SFO_C - 4096; ++ ++ if (SFO_D > 2047) ++ SFO_D = SFO_D - 4096; ++ ++ SFO_A = SFO_A * 312500 / 1024; ++ SFO_B = SFO_B * 312500 / 1024; ++ SFO_C = SFO_C * 312500 / 1024; ++ SFO_D = SFO_D * 312500 / 1024; ++ ++ LFO_A = (s4Byte)(value32 >> 16); ++ LFO_B = (s4Byte)(value32_1 >> 16); ++ LFO_C = (s4Byte)(value32_2 >> 16); ++ LFO_D = (s4Byte)(value32_3 >> 16); ++ ++ if (LFO_A > 4095) ++ LFO_A = LFO_A - 8192; ++ ++ if (LFO_B > 4095) ++ LFO_B = LFO_B - 8192; ++ ++ if (LFO_C > 4095) ++ LFO_C = LFO_C - 8192; ++ ++ if (LFO_D > 4095) ++ LFO_D = LFO_D - 8192; ++ LFO_A = LFO_A * 312500 / 4096; ++ LFO_B = LFO_B * 312500 / 4096; ++ LFO_C = LFO_C * 312500 / 4096; ++ LFO_D = LFO_D * 312500 / 4096; ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "Value SCFO(Hz) ", SFO_A, SFO_B, SFO_C, SFO_D)); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "ACQ CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xd14 , bMaskDWord); ++ value32_1 = ODM_GetBBReg(pDM_Odm, 0xd54 , bMaskDWord); ++ value32_2 = ODM_GetBBReg(pDM_Odm, 0xd94 , bMaskDWord); ++ value32_3 = ODM_GetBBReg(pDM_Odm, 0xdd4 , bMaskDWord); ++ ++ LFO_A = (s4Byte)(value32 >> 16); ++ LFO_B = (s4Byte)(value32_1 >> 16); ++ LFO_C = (s4Byte)(value32_2 >> 16); ++ LFO_D = (s4Byte)(value32_3 >> 16); ++ ++ if (LFO_A > 4095) ++ LFO_A = LFO_A - 8192; ++ ++ if (LFO_B > 4095) ++ LFO_B = LFO_B - 8192; ++ ++ if (LFO_C > 4095) ++ LFO_C = LFO_C - 8192; ++ ++ if (LFO_D > 4095) ++ LFO_D = LFO_D - 8192; ++ ++ LFO_A = LFO_A * 312500 / 4096; ++ LFO_B = LFO_B * 312500 / 4096; ++ LFO_C = LFO_C * 312500 / 4096; ++ LFO_D = LFO_D * 312500 / 4096; ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "End CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xf20 , bMaskDWord); /*L SIG*/ ++ ++ Tail = (u1Byte)((value32 & 0xfc0000) >> 16); ++ Parity = (u1Byte)((value32 & 0x20000) >> 16); ++ Length = (u2Byte)((value32 & 0x1ffe00) >> 8); ++ rsv = (u1Byte)(value32 & 0x10); ++ MCSS = (u1Byte)(value32 & 0x0f); ++ ++ switch (MCSS) { ++ case 0x0b: ++ idx = 0; ++ break; ++ case 0x0f: ++ idx = 1; ++ break; ++ case 0x0a: ++ idx = 2; ++ break; ++ case 0x0e: ++ idx = 3; ++ break; ++ case 0x09: ++ idx = 4; ++ break; ++ case 0x08: ++ idx = 5; ++ break; ++ case 0x0c: ++ idx = 6; ++ break; ++ default: ++ idx = 6; ++ break; ++ ++ } ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "L-SIG")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s : %s", "Rate", L_rate[idx])); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x", "Rsv/Length/Parity", rsv, RX_BW, Length)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xf2c , bMaskDWord); /*HT SIG*/ ++ if (RX_HT == 1) { ++ ++ HMCSS = (u1Byte)(value32 & 0x7F); ++ HRX_BW = (u1Byte)(value32 & 0x80); ++ HLength = (u2Byte)((value32 >> 8) & 0xffff); ++ } ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "HT-SIG1")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x", "MCS/BW/Length", HMCSS, HRX_BW, HLength)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xf30 , bMaskDWord); /*HT SIG*/ ++ ++ if (RX_HT == 1) { ++ smooth = (u1Byte)(value32 & 0x01); ++ htsound = (u1Byte)(value32 & 0x02); ++ rsv = (u1Byte)(value32 & 0x04); ++ agg = (u1Byte)(value32 & 0x08); ++ stbc = (u1Byte)(value32 & 0x30); ++ fec = (u1Byte)(value32 & 0x40); ++ sgi = (u1Byte)(value32 & 0x80); ++ htltf = (u1Byte)((value32 & 0x300) >> 8); ++ htcrc8 = (u2Byte)((value32 & 0x3fc00) >> 8); ++ Tail = (u1Byte)((value32 & 0xfc0000) >> 16); ++ } ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "HT-SIG2")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x / %x / %x", "Smooth/NoSound/Rsv/Aggregate/STBC/LDPC", smooth, htsound, rsv, agg, stbc, fec)); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x", "SGI/E-HT-LTFs/CRC/Tail", sgi, htltf, htcrc8, Tail)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xf2c , bMaskDWord); /*VHT SIG A1*/ ++ if (RX_HT == 2) { ++ /* value32 = ODM_GetBBReg(pDM_Odm, 0xf2c ,bMaskDWord);*/ ++ vRX_BW = (u1Byte)(value32 & 0x03); ++ vrsv = (u1Byte)(value32 & 0x04); ++ vstbc = (u1Byte)(value32 & 0x08); ++ vgid = (u1Byte)((value32 & 0x3f0) >> 4); ++ vNsts = (u1Byte)(((value32 & 0x1c00) >> 8) + 1); ++ vpaid = (u2Byte)(value32 & 0x3fe); ++ vtxops = (u1Byte)((value32 & 0x400000) >> 20); ++ vrsv2 = (u1Byte)((value32 & 0x800000) >> 20); ++ } ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "VHT-SIG-A1")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x / %x / %x / %x / %x", "BW/Rsv1/STBC/GID/Nsts/PAID/TXOPPS/Rsv2", vRX_BW, vrsv, vstbc, vgid, vNsts, vpaid, vtxops, vrsv2)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xf30 , bMaskDWord); /*VHT SIG*/ ++ ++ if (RX_HT == 2) { ++ /*value32 = ODM_GetBBReg(pDM_Odm, 0xf30 ,bMaskDWord); */ /*VHT SIG*/ ++ ++ //sgi=(u1Byte)(value32&0x01); ++ sgiext = (u1Byte)(value32 & 0x03); ++ //fec = (u1Byte)(value32&0x04); ++ fecext = (u1Byte)(value32 & 0x0C); ++ ++ vMCSS = (u1Byte)(value32 & 0xf0); ++ bf = (u1Byte)((value32 & 0x100) >> 8); ++ vrsv = (u1Byte)((value32 & 0x200) >> 8); ++ vhtcrc8 = (u2Byte)((value32 & 0x3fc00) >> 8); ++ vTail = (u1Byte)((value32 & 0xfc0000) >> 16); ++ } ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "VHT-SIG-A2")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x / %x / %x / %x", "SGI/FEC/MCS/BF/Rsv/CRC/Tail", sgiext, fecext, vMCSS, bf, vrsv, vhtcrc8, vTail)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xf34 , bMaskDWord); /*VHT SIG*/ ++ { ++ vLength = (u2Byte)(value32 & 0x1fffff); ++ vbrsv = (u1Byte)((value32 & 0x600000) >> 20); ++ vbTail = (u2Byte)((value32 & 0x1f800000) >> 20); ++ vbcrc = (u1Byte)((value32 & 0x80000000) >> 28); ++ ++ } ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "VHT-SIG-B")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x", "Length/Rsv/Tail/CRC", vLength, vbrsv, vbTail, vbcrc)); ++ ++ /*for Condition number*/ ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) { ++ s4Byte condition_num = 0; ++ char *factor = NULL; ++ ++ ODM_SetBBReg(pDM_Odm, 0x1988 , BIT22, 0x1); /*enable report condition number*/ ++ ++ condition_num = ODM_GetBBReg(pDM_Odm, 0xf84, bMaskDWord); ++ condition_num = (condition_num & 0x3ffff) >> 4; ++ ++ if (*pDM_Odm->pBandWidth == ODM_BW80M) ++ factor = "256/234"; ++ else if (*pDM_Odm->pBandWidth == ODM_BW40M) ++ factor = "128/108"; ++ else if (*pDM_Odm->pBandWidth == ODM_BW20M) { ++ if (RX_HT != 2 || RX_HT != 1) ++ factor = "64/52"; /*HT or VHT*/ ++ else ++ factor = "64/48"; /*legacy*/ ++ } ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d (factor = %s)", "Condition Number", condition_num, factor)); ++ ++ } ++ ++} ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++void phydm_sbd_check( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ static u4Byte pkt_cnt = 0; ++ static BOOLEAN sbd_state = 0; ++ u4Byte sym_count, count, value32; ++ ++ if (sbd_state == 0) { ++ pkt_cnt++; ++ if (pkt_cnt % 5 == 0) { /*read SBD conter once every 5 packets*/ ++ ODM_SetTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer, 0); /*ms*/ ++ sbd_state = 1; ++ } ++ } else { /*read counter*/ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xF98, bMaskDWord); ++ sym_count = (value32 & 0x7C000000) >> 26; ++ count = (value32 & 0x3F00000) >> 20; ++ DbgPrint("#SBD# sym_count %d count %d\n", sym_count, count); ++ sbd_state = 0; ++ } ++} ++ ++void phydm_sbd_callback( ++ PRT_TIMER pTimer ++) ++{ ++ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ ++#if USE_WORKITEM ++ ODM_ScheduleWorkItem(&pDM_Odm->sbdcnt_workitem); ++#else ++ phydm_sbd_check(pDM_Odm); ++#endif ++} ++ ++void phydm_sbd_workitem_callback( ++ IN PVOID pContext ++) ++{ ++ PADAPTER pAdapter = (PADAPTER)pContext; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ ++ phydm_sbd_check(pDM_Odm); ++} ++#endif ++VOID ++phydm_BasicDbgMessage ++( ++ IN PVOID pDM_VOID ++) ++{ ++#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure(pDM_Odm , PHYDM_FALSEALMCNT); ++ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u2Byte macid, phydm_macid, client_cnt = 0; ++ PSTA_INFO_T pEntry; ++ s4Byte tmp_val = 0; ++ u1Byte tmp_val_u1 = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[PHYDM Common MSG] System up time: ((%d sec))----->\n", pDM_Odm->phydm_sys_up_time)); ++ ++ if (pDM_Odm->bLinked) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Curr_STA_ID = 0x%x\n", pDM_Odm->curr_station_id)); ++ ++ /*Print RX Rate*/ ++ if (pDM_Odm->RxRate <= ODM_RATE11M) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[CCK AGC Report] LNA_idx = 0x%x, VGA_idx = 0x%x\n", ++ pDM_Odm->cck_lna_idx, pDM_Odm->cck_vga_idx)); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[OFDM AGC Report] { 0x%x, 0x%x, 0x%x, 0x%x }\n", ++ pDM_Odm->ofdm_agc_idx[0], pDM_Odm->ofdm_agc_idx[1], pDM_Odm->ofdm_agc_idx[2], pDM_Odm->ofdm_agc_idx[3])); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("RSSI: { %d, %d, %d, %d }, RxRate:", ++ (pDM_Odm->RSSI_A == 0xff) ? 0 : pDM_Odm->RSSI_A , ++ (pDM_Odm->RSSI_B == 0xff) ? 0 : pDM_Odm->RSSI_B , ++ (pDM_Odm->RSSI_C == 0xff) ? 0 : pDM_Odm->RSSI_C, ++ (pDM_Odm->RSSI_D == 0xff) ? 0 : pDM_Odm->RSSI_D)); ++ ++ phydm_print_rate(pDM_Odm, pDM_Odm->RxRate, ODM_COMP_COMMON); ++ ++ /*Print TX Rate*/ ++ for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { ++ ++ pEntry = pDM_Odm->pODM_StaInfo[macid]; ++ if (IS_STA_VALID(pEntry)) { ++ ++ phydm_macid = (pDM_Odm->platform2phydm_macid_table[macid]); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("TXRate [%d]:", macid)); ++ phydm_print_rate(pDM_Odm, pRA_Table->link_tx_rate[macid], ODM_COMP_COMMON); ++ ++ client_cnt++; ++ ++ if (client_cnt == pDM_Odm->number_linked_client) ++ break; ++ } ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("TP { TX, RX, total} = {%d, %d, %d }Mbps, TrafficLoad = (%d))\n", ++ pDM_Odm->tx_tp, pDM_Odm->rx_tp, pDM_Odm->total_tp, pDM_Odm->TrafficLoad)); ++ ++ tmp_val_u1 = (pCfoTrack->CrystalCap > pCfoTrack->DefXCap) ? (pCfoTrack->CrystalCap - pCfoTrack->DefXCap) : (pCfoTrack->DefXCap - pCfoTrack->CrystalCap); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("CFO_avg = ((%d kHz)) , CrystalCap_tracking = ((%s%d))\n", ++ pCfoTrack->CFO_ave_pre, ((pCfoTrack->CrystalCap > pCfoTrack->DefXCap)?"+":"-"),tmp_val_u1)); ++ ++ /* Condition number */ ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) { ++ tmp_val = phydm_get_condition_number_8822B(pDM_Odm); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Condition number = ((%d))\n", tmp_val)); ++ } ++#endif ++ ++#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) ++ /*STBC or LDPC pkt*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("LDPC = %s, STBC = %s\n", (pDM_Odm->PhyDbgInfo.bLdpcPkt)?"Y":"N", (pDM_Odm->PhyDbgInfo.bStbcPkt)?"Y":"N")); ++#endif ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("No Link !!!\n")); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", ++ FalseAlmCnt->Cnt_CCK_CCA, FalseAlmCnt->Cnt_OFDM_CCA, FalseAlmCnt->Cnt_CCA_all)); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", ++ FalseAlmCnt->Cnt_Cck_fail, FalseAlmCnt->Cnt_Ofdm_fail, FalseAlmCnt->Cnt_all)); ++ ++ #if (ODM_IC_11N_SERIES_SUPPORT == 1) ++ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[OFDM FA Detail] Parity_Fail = (( %d )), Rate_Illegal = (( %d )), CRC8_fail = (( %d )), Mcs_fail = (( %d )), Fast_Fsync = (( %d )), SB_Search_fail = (( %d ))\n", ++ FalseAlmCnt->Cnt_Parity_Fail, FalseAlmCnt->Cnt_Rate_Illegal, FalseAlmCnt->Cnt_Crc8_fail, FalseAlmCnt->Cnt_Mcs_fail, FalseAlmCnt->Cnt_Fast_Fsync, FalseAlmCnt->Cnt_SB_Search_fail)); ++ } ++ #endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("bLinked = %d, Num_client = %d, RSSI_Min = %d, CurrentIGI = 0x%x, bNoisy=%d\n\n", ++ pDM_Odm->bLinked, pDM_Odm->number_linked_client, pDM_Odm->RSSI_Min, pDM_DigTable->CurIGValue, pDM_Odm->NoisyDecision)); ++ ++/* ++ temp_reg = ODM_GetBBReg(pDM_Odm, 0xDD0, bMaskByte0); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xDD0 = 0x%x\n",temp_reg)); ++ ++ temp_reg = ODM_GetBBReg(pDM_Odm, 0xDDc, bMaskByte1); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xDDD = 0x%x\n",temp_reg)); ++ ++ temp_reg = ODM_GetBBReg(pDM_Odm, 0xc50, bMaskByte0); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xC50 = 0x%x\n",temp_reg)); ++ ++ temp_reg = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x0, 0x3fe0); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("RF 0x0[13:5] = 0x%x\n\n",temp_reg)); ++*/ ++ ++#endif ++} ++ ++ ++VOID phydm_BasicProfile( ++ IN PVOID pDM_VOID, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ char *Cut = NULL; ++ char *ICType = NULL; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ u4Byte commit_ver = 0; ++ u4Byte date = 0; ++ char *commit_by = NULL; ++ u4Byte release_ver = 0; ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "% Basic Profile %")); ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) { ++ #if (RTL8188E_SUPPORT == 1) ++ ICType = "RTL8188E"; ++ date = RELEASE_DATE_8188E; ++ commit_by = COMMIT_BY_8188E; ++ release_ver = RELEASE_VERSION_8188E; ++ #endif ++ } ++ #if (RTL8812A_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8812) { ++ ICType = "RTL8812A"; ++ date = RELEASE_DATE_8812A; ++ commit_by = COMMIT_BY_8812A; ++ release_ver = RELEASE_VERSION_8812A; ++ } ++ #endif ++ #if (RTL8821A_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8821) { ++ ICType = "RTL8821A"; ++ date = RELEASE_DATE_8821A; ++ commit_by = COMMIT_BY_8821A; ++ release_ver = RELEASE_VERSION_8821A; ++ } ++ #endif ++ #if (RTL8192E_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8192E) { ++ ICType = "RTL8192E"; ++ date = RELEASE_DATE_8192E; ++ commit_by = COMMIT_BY_8192E; ++ release_ver = RELEASE_VERSION_8192E; ++ } ++ #endif ++ #if (RTL8723B_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8723B) { ++ ICType = "RTL8723B"; ++ date = RELEASE_DATE_8723B; ++ commit_by = COMMIT_BY_8723B; ++ release_ver = RELEASE_VERSION_8723B; ++ } ++ #endif ++ #if (RTL8814A_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8814A) { ++ ICType = "RTL8814A"; ++ date = RELEASE_DATE_8814A; ++ commit_by = COMMIT_BY_8814A; ++ release_ver = RELEASE_VERSION_8814A; ++ } ++ #endif ++ #if (RTL8881A_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8881A) { ++ ICType = "RTL8881A"; ++ /**/ ++ } ++ #endif ++ #if (RTL8822B_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8822B) { ++ ICType = "RTL8822B"; ++ date = RELEASE_DATE_8822B; ++ commit_by = COMMIT_BY_8822B; ++ release_ver = RELEASE_VERSION_8822B; ++ } ++ #endif ++ #if (RTL8197F_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8197F) { ++ ICType = "RTL8197F"; ++ date = RELEASE_DATE_8197F; ++ commit_by = COMMIT_BY_8197F; ++ release_ver = RELEASE_VERSION_8197F; ++ } ++ #endif ++ ++ #if (RTL8703B_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8703B) { ++ ++ ICType = "RTL8703B"; ++ date = RELEASE_DATE_8703B; ++ commit_by = COMMIT_BY_8703B; ++ release_ver = RELEASE_VERSION_8703B; ++ ++ } ++ #endif ++ #if (RTL8195A_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8195A) { ++ ICType = "RTL8195A"; ++ /**/ ++ } ++ #endif ++ #if (RTL8188F_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8188F) { ++ ICType = "RTL8188F"; ++ date = RELEASE_DATE_8188F; ++ commit_by = COMMIT_BY_8188F; ++ release_ver = RELEASE_VERSION_8188F; ++ } ++ #endif ++ #if (RTL8723D_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8723D) { ++ ICType = "RTL8723D"; ++ date = RELEASE_DATE_8723D; ++ commit_by = COMMIT_BY_8723D; ++ release_ver = RELEASE_VERSION_8723D; ++ /**/ ++ } ++ #endif ++ #if (RTL8821C_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType == ODM_RTL8821C) { ++ ICType = "RTL8821C"; ++ date = RELEASE_DATE_8821C; ++ commit_by = COMMIT_BY_8821C; ++ release_ver = RELEASE_VERSION_8821C; ++ } ++ #endif ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s (MP Chip: %s)\n", "IC Type", ICType, pDM_Odm->bIsMPChip ? "Yes" : "No")); ++ ++ if (pDM_Odm->CutVersion == ODM_CUT_A) ++ Cut = "A"; ++ else if (pDM_Odm->CutVersion == ODM_CUT_B) ++ Cut = "B"; ++ else if (pDM_Odm->CutVersion == ODM_CUT_C) ++ Cut = "C"; ++ else if (pDM_Odm->CutVersion == ODM_CUT_D) ++ Cut = "D"; ++ else if (pDM_Odm->CutVersion == ODM_CUT_E) ++ Cut = "E"; ++ else if (pDM_Odm->CutVersion == ODM_CUT_F) ++ Cut = "F"; ++ else if (pDM_Odm->CutVersion == ODM_CUT_I) ++ Cut = "I"; ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Cut Version", Cut)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Parameter Version", ODM_GetHWImgVersion(pDM_Odm))); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Parameter Commit date", date)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY Parameter Commit by", commit_by)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Parameter Release Version", release_ver)); ++ ++#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ { ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Version", Adapter->MgntInfo.FirmwareVersion, Adapter->MgntInfo.FirmwareSubVersion)); ++ } ++#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ { ++ struct rtl8192cd_priv *priv = pDM_Odm->priv; ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Version", priv->pshare->fw_version, priv->pshare->fw_sub_version)); ++ } ++#else ++ { ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Version", pHalData->FirmwareVersion, pHalData->FirmwareSubVersion)); ++ } ++#endif ++ //1 PHY DM Version List ++ PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "% PHYDM Version %")); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Code Base", PHYDM_CODE_BASE)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Release Date", PHYDM_RELEASE_DATE)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Adaptivity", ADAPTIVITY_VERSION)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "DIG", DIG_VERSION)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Dynamic BB PowerSaving", DYNAMIC_BBPWRSAV_VERSION)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "CFO Tracking", CFO_TRACKING_VERSION)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Antenna Diversity", ANTDIV_VERSION)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Power Tracking", POWRTRACKING_VERSION)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Dynamic TxPower", DYNAMIC_TXPWR_VERSION)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "RA Info", RAINFO_VERSION)); ++#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Antenna Detection", ANTDECT_VERSION)); ++#endif ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Auto Channel Selection", ACS_VERSION)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "EDCA Turbo", EDCATURBO_VERSION)); ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Path Diversity", PATHDIV_VERSION)); ++ ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY config 8822B", PHY_CONFIG_VERSION_8822B)); ++ ++#endif ++#if (RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY config 8197F", PHY_CONFIG_VERSION_8197F)); ++#endif ++ *_used = used; ++ *_out_len = out_len; ++ ++} ++ ++VOID ++phydm_fw_trace_en_h2c( ++ IN PVOID pDM_VOID, ++ IN BOOLEAN enable, ++ IN u4Byte fw_debug_component, ++ IN u4Byte monitor_mode, ++ IN u4Byte macid ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte H2C_Parameter[7] = {0}; ++ u1Byte cmd_length; ++ ++ if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES){ ++ ++ H2C_Parameter[0] = enable; ++ H2C_Parameter[1] = (u1Byte)(fw_debug_component & bMaskByte0); ++ H2C_Parameter[2] = (u1Byte)((fw_debug_component & bMaskByte1)>>8); ++ H2C_Parameter[3] = (u1Byte)((fw_debug_component & bMaskByte2)>>16); ++ H2C_Parameter[4] = (u1Byte)((fw_debug_component & bMaskByte3)>>24); ++ H2C_Parameter[5] = (u1Byte)monitor_mode; ++ H2C_Parameter[6] = (u1Byte)macid; ++ cmd_length = 7; ++ ++ } else { ++ ++ H2C_Parameter[0] = enable; ++ H2C_Parameter[1] = (u1Byte)monitor_mode; ++ H2C_Parameter[2] = (u1Byte)macid; ++ cmd_length = 3; ++ } ++ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("---->\n")); ++ if (monitor_mode == 0){ ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[H2C] FW_debug_en: (( %d ))\n", enable)); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[H2C] FW_debug_en: (( %d )), mode: (( %d )), macid: (( %d ))\n", enable, monitor_mode, macid)); ++ } ++ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_FW_TRACE_EN, cmd_length, H2C_Parameter); ++} ++ ++ ++#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) ++BOOLEAN ++phydm_api_set_txagc( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte PowerIndex, ++ IN ODM_RF_RADIO_PATH_E Path, ++ IN u1Byte HwRate, ++ IN BOOLEAN bSingleRate ++ ) ++{ ++ BOOLEAN ret = FALSE; ++ ++#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) ++ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8821C)) { ++ if (bSingleRate) { ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) ++ ret = phydm_write_txagc_1byte_8822b(pDM_Odm, PowerIndex, Path, HwRate); ++#endif ++#if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ ret = phydm_write_txagc_1byte_8821c(pDM_Odm, PowerIndex, Path, HwRate); ++#endif ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ SetCurrentTxAGC(pDM_Odm->priv, Path, HwRate, (u1Byte)PowerIndex); ++#endif ++ ++ } else { ++ u1Byte i; ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) ++ ret = config_phydm_write_txagc_8822b(pDM_Odm, PowerIndex, Path, HwRate); ++#endif ++#if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ ret = config_phydm_write_txagc_8821c(pDM_Odm, PowerIndex, Path, HwRate); ++#endif ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ for (i = 0; i < 4; i++) ++ SetCurrentTxAGC(pDM_Odm->priv, Path, (HwRate + i), (u1Byte)PowerIndex); ++#endif ++ } ++ } ++#endif ++ ++ ++#if (RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) ++ ret = config_phydm_write_txagc_8197f(pDM_Odm, PowerIndex, Path, HwRate); ++#endif ++ ++ return ret; ++} ++ ++u1Byte ++phydm_api_get_txagc( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_RF_RADIO_PATH_E Path, ++ IN u1Byte HwRate ++ ) ++{ ++ u1Byte ret = 0; ++ ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ ret = config_phydm_read_txagc_8822b(pDM_Odm, Path, HwRate); ++#endif ++ ++#if (RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) ++ ret = config_phydm_read_txagc_8197f(pDM_Odm, Path, HwRate); ++#endif ++ ++#if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8821C) ++ ret = config_phydm_read_txagc_8821c(pDM_Odm, Path, HwRate); ++#endif ++ ++ return ret; ++} ++ ++ ++BOOLEAN ++phydm_api_switch_bw_channel( ++ IN PDM_ODM_T pDM_Odm, ++ IN u1Byte central_ch, ++ IN u1Byte primary_ch_idx, ++ IN ODM_BW_E bandwidth ++ ) ++{ ++ BOOLEAN ret = FALSE; ++ ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ ret = config_phydm_switch_channel_bw_8822b(pDM_Odm, central_ch, primary_ch_idx, bandwidth); ++#endif ++ ++#if (RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) ++ ret = config_phydm_switch_channel_bw_8197f(pDM_Odm, central_ch, primary_ch_idx, bandwidth); ++#endif ++ ++#if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8821C) ++ ret = config_phydm_switch_channel_bw_8821c(pDM_Odm, central_ch, primary_ch_idx, bandwidth); ++#endif ++ ++ return ret; ++} ++ ++BOOLEAN ++phydm_api_trx_mode( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_RF_PATH_E TxPath, ++ IN ODM_RF_PATH_E RxPath, ++ IN BOOLEAN bTx2Path ++ ) ++{ ++ BOOLEAN ret = FALSE; ++ ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ ret = config_phydm_trx_mode_8822b(pDM_Odm, TxPath, RxPath, bTx2Path); ++#endif ++ ++#if (RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) ++ ret = config_phydm_trx_mode_8197f(pDM_Odm, TxPath, RxPath, bTx2Path); ++#endif ++ ++ return ret; ++} ++#endif ++ ++VOID ++phydm_get_per_path_txagc( ++ IN PVOID pDM_VOID, ++ IN u1Byte path, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte rate_idx; ++ u1Byte txagc; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++#if ((RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) ++ if (((pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F)) && (path <= ODM_RF_PATH_B)) || ++ ((pDM_Odm->SupportICType & (ODM_RTL8821C)) && (path <= ODM_RF_PATH_A))) { ++ for (rate_idx = 0; rate_idx <= 0x53; rate_idx++) { ++ if (rate_idx == ODM_RATE1M) ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s\n", "CCK====>")); ++ else if (rate_idx == ODM_RATE6M) ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "OFDM====>")); ++ else if (rate_idx == ODM_RATEMCS0) ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 1ss====>")); ++ else if (rate_idx == ODM_RATEMCS8) ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 2ss====>")); ++ else if (rate_idx == ODM_RATEMCS16) ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 3ss====>")); ++ else if (rate_idx == ODM_RATEMCS24) ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 4ss====>")); ++ else if (rate_idx == ODM_RATEVHTSS1MCS0) ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 1ss====>")); ++ else if (rate_idx == ODM_RATEVHTSS2MCS0) ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 2ss====>")); ++ else if (rate_idx == ODM_RATEVHTSS3MCS0) ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 3ss====>")); ++ else if (rate_idx == ODM_RATEVHTSS4MCS0) ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 4ss====>")); ++ ++ txagc = phydm_api_get_txagc(pDM_Odm, (ODM_RF_RADIO_PATH_E) path, rate_idx); ++ if (config_phydm_read_txagc_check(txagc)) ++ PHYDM_SNPRINTF((output + used, out_len - used, " 0x%02x ", txagc)); ++ else ++ PHYDM_SNPRINTF((output + used, out_len - used, " 0x%s ", "xx")); ++ } ++ } ++#endif ++} ++ ++ ++VOID ++phydm_get_txagc( ++ IN PVOID pDM_VOID, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ /* Path-A */ ++ PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "Path-A====================")); ++ phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_A, _used, output, _out_len); ++ ++ /* Path-B */ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "Path-B====================")); ++ phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_B, _used, output, _out_len); ++ ++ /* Path-C */ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "Path-C====================")); ++ phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_C, _used, output, _out_len); ++ ++ /* Path-D */ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "Path-D====================")); ++ phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_D, _used, output, _out_len); ++ ++} ++ ++VOID ++phydm_set_txagc( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++/*dm_value[1] = Path*/ ++/*dm_value[2] = HwRate*/ ++/*dm_value[3] = PowerIndex*/ ++ ++#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F|ODM_RTL8821C)) { ++ if (dm_value[1] <= 1) { ++ if ((u1Byte)dm_value[2] != 0xff) { ++ if (phydm_api_set_txagc(pDM_Odm, dm_value[3], (ODM_RF_RADIO_PATH_E) dm_value[1], (u1Byte)dm_value[2], TRUE)) ++ PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s%x\n", "Write path-", dm_value[1], "rate index-0x", dm_value[2], " = 0x", dm_value[3])); ++ else ++ PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s\n", "Write path-", (dm_value[1] & 0x1), "rate index-0x", (dm_value[2] & 0x7f), " fail")); ++ } else { ++ u1Byte i; ++ u4Byte power_index; ++ BOOLEAN status = TRUE; ++ ++ power_index = (dm_value[3] & 0x3f); ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8821C)) { ++ power_index = (power_index << 24)|(power_index << 16)|(power_index << 8)|(power_index); ++ ++ for (i = 0; i < ODM_RATEVHTSS2MCS9; i += 4) ++ status = (status & phydm_api_set_txagc(pDM_Odm, power_index, (ODM_RF_RADIO_PATH_E) dm_value[1], i, FALSE)); ++ } else if (pDM_Odm->SupportICType & ODM_RTL8197F) { ++ for (i = 0; i <= ODM_RATEMCS15; i++) ++ status = (status & phydm_api_set_txagc(pDM_Odm, power_index, (ODM_RF_RADIO_PATH_E) dm_value[1], i, FALSE)); ++ } ++ ++ if (status) ++ PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x\n", "Write all TXAGC of path-", dm_value[1], " = 0x", dm_value[3])); ++ else ++ PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s\n", "Write all TXAGC of path-", dm_value[1], " fail")); ++ } ++ } else { ++ PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s\n", "Write path-", (dm_value[1] & 0x1), "rate index-0x", (dm_value[2] & 0x7f), " fail")); ++ } ++ } ++#endif ++} ++ ++VOID ++phydm_debug_trace( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte pre_debug_components, one = 1; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ pre_debug_components = pDM_Odm->DebugComponents; ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n%s\n", "================================")); ++ if (dm_value[0] == 100) { ++ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Debug Message] PhyDM Selection")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "00. (( %s ))DIG\n", ((pDM_Odm->DebugComponents & ODM_COMP_DIG) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))RA_MASK\n", ((pDM_Odm->DebugComponents & ODM_COMP_RA_MASK) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))DYNAMIC_TXPWR\n", ((pDM_Odm->DebugComponents & ODM_COMP_DYNAMIC_TXPWR) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))FA_CNT\n", ((pDM_Odm->DebugComponents & ODM_COMP_FA_CNT) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "04. (( %s ))RSSI_MONITOR\n", ((pDM_Odm->DebugComponents & ODM_COMP_RSSI_MONITOR) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "05. (( %s ))SNIFFER\n", ((pDM_Odm->DebugComponents & ODM_COMP_SNIFFER) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "06. (( %s ))ANT_DIV\n", ((pDM_Odm->DebugComponents & ODM_COMP_ANT_DIV) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "07. (( %s ))DFS\n", ((pDM_Odm->DebugComponents & ODM_COMP_DFS) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "08. (( %s ))NOISY_DETECT\n", ((pDM_Odm->DebugComponents & ODM_COMP_NOISY_DETECT) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "09. (( %s ))RATE_ADAPTIVE\n", ((pDM_Odm->DebugComponents & ODM_COMP_RATE_ADAPTIVE) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "10. (( %s ))PATH_DIV\n", ((pDM_Odm->DebugComponents & ODM_COMP_PATH_DIV) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "12. (( %s ))DYNAMIC_PRICCA\n", ((pDM_Odm->DebugComponents & ODM_COMP_DYNAMIC_PRICCA) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "14. (( %s ))MP\n", ((pDM_Odm->DebugComponents & ODM_COMP_MP) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "15. (( %s ))CFO_TRACKING\n", ((pDM_Odm->DebugComponents & ODM_COMP_CFO_TRACKING) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "16. (( %s ))ACS\n", ((pDM_Odm->DebugComponents & ODM_COMP_ACS) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "17. (( %s ))ADAPTIVITY\n", ((pDM_Odm->DebugComponents & PHYDM_COMP_ADAPTIVITY) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "18. (( %s ))RA_DBG\n", ((pDM_Odm->DebugComponents & PHYDM_COMP_RA_DBG) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "19. (( %s ))TXBF\n", ((pDM_Odm->DebugComponents & PHYDM_COMP_TXBF) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "20. (( %s ))EDCA_TURBO\n", ((pDM_Odm->DebugComponents & ODM_COMP_EDCA_TURBO) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "22. (( %s ))FW_DEBUG_TRACE\n", ((pDM_Odm->DebugComponents & ODM_FW_DEBUG_TRACE) ? ("V") : (".")))); ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "24. (( %s ))TX_PWR_TRACK\n", ((pDM_Odm->DebugComponents & ODM_COMP_TX_PWR_TRACK) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "26. (( %s ))CALIBRATION\n", ((pDM_Odm->DebugComponents & ODM_COMP_CALIBRATION) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "28. (( %s ))PHY_CONFIG\n", ((pDM_Odm->DebugComponents & ODM_PHY_CONFIG) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "29. (( %s ))INIT\n", ((pDM_Odm->DebugComponents & ODM_COMP_INIT) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "30. (( %s ))COMMON\n", ((pDM_Odm->DebugComponents & ODM_COMP_COMMON) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "31. (( %s ))API\n", ((pDM_Odm->DebugComponents & ODM_COMP_API) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); ++ ++ } else if (dm_value[0] == 101) { ++ pDM_Odm->DebugComponents = 0; ++ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "Disable all debug components")); ++ } else { ++ if (dm_value[1] == 1) { /*enable*/ ++ pDM_Odm->DebugComponents |= (one << dm_value[0]); ++ } else if (dm_value[1] == 2) { /*disable*/ ++ pDM_Odm->DebugComponents &= ~(one << dm_value[0]); ++ } else ++ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Warning!!!] 1:enable, 2:disable")); ++ } ++ PHYDM_SNPRINTF((output + used, out_len - used, "pre-DbgComponents = 0x%x\n", pre_debug_components)); ++ PHYDM_SNPRINTF((output + used, out_len - used, "Curr-DbgComponents = 0x%x\n", pDM_Odm->DebugComponents)); ++ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); ++} ++ ++VOID ++phydm_fw_debug_trace( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte pre_fw_debug_components, one = 1; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ pre_fw_debug_components = pDM_Odm->fw_DebugComponents; ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n%s\n", "================================")); ++ if (dm_value[0] == 100) { ++ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[FW Debug Component]")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "00. (( %s ))RA\n", ((pDM_Odm->fw_DebugComponents & PHYDM_FW_COMP_RA) ? ("V") : (".")))); ++ ++ if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES){ ++ PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))MU\n", ((pDM_Odm->fw_DebugComponents & PHYDM_FW_COMP_MU) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))Path Div\n", ((pDM_Odm->fw_DebugComponents & PHYDM_FW_COMP_PHY_CONFIG) ? ("V") : (".")))); ++ PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))Phy Config\n", ((pDM_Odm->fw_DebugComponents & PHYDM_FW_COMP_PHY_CONFIG) ? ("V") : (".")))); ++ } ++ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); ++ ++ } else { ++ if (dm_value[0] == 101) { ++ pDM_Odm->fw_DebugComponents = 0; ++ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "Clear all fw debug components")); ++ } else { ++ if (dm_value[1] == 1) { /*enable*/ ++ pDM_Odm->fw_DebugComponents |= (one << dm_value[0]); ++ } else if (dm_value[1] == 2) { /*disable*/ ++ pDM_Odm->fw_DebugComponents &= ~(one << dm_value[0]); ++ } else ++ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Warning!!!] 1:enable, 2:disable")); ++ } ++ ++ if (pDM_Odm->fw_DebugComponents == 0) { ++ pDM_Odm->DebugComponents &= ~ODM_FW_DEBUG_TRACE; ++ phydm_fw_trace_en_h2c(pDM_Odm, FALSE, pDM_Odm->fw_DebugComponents, dm_value[2], dm_value[3]); /*H2C to enable C2H Msg*/ ++ } else { ++ pDM_Odm->DebugComponents |= ODM_FW_DEBUG_TRACE; ++ phydm_fw_trace_en_h2c(pDM_Odm, TRUE, pDM_Odm->fw_DebugComponents, dm_value[2], dm_value[3]); /*H2C to enable C2H Msg*/ ++ } ++ } ++} ++ ++VOID ++phydm_DumpBbReg( ++ IN PVOID pDM_VOID, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte Addr = 0; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ ++ /* BB Reg, For Nseries IC we only need to dump page8 to pageF using 3 digits*/ ++ for (Addr = 0x800; Addr < 0xfff; Addr += 4) { ++ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%03x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); ++ else ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); ++ } ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8822B | ODM_RTL8814A | ODM_RTL8821C)) { ++ ++ if (pDM_Odm->RFType > ODM_2T2R) { ++ for (Addr = 0x1800; Addr < 0x18ff; Addr += 4) ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); ++ } ++ ++ if (pDM_Odm->RFType > ODM_3T3R) { ++ for (Addr = 0x1a00; Addr < 0x1aff; Addr += 4) ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); ++ } ++ ++ for (Addr = 0x1900; Addr < 0x19ff; Addr += 4) ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); ++ ++ for (Addr = 0x1c00; Addr < 0x1cff; Addr += 4) ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); ++ ++ for (Addr = 0x1f00; Addr < 0x1fff; Addr += 4) ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); ++ } ++} ++ ++VOID ++phydm_DumpAllReg( ++ IN PVOID pDM_VOID, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte Addr = 0; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ /* dump MAC register */ ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "MAC==========\n")); ++ for (Addr = 0; Addr < 0x7ff; Addr += 4) ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); ++ ++ for (Addr = 0x1000; Addr < 0x17ff; Addr += 4) ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); ++ ++ /* dump BB register */ ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "BB==========\n")); ++ phydm_DumpBbReg(pDM_Odm, &used, output, &out_len); ++ ++ /* dump RF register */ ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "RF-A==========\n")); ++ for (Addr = 0; Addr < 0xFF; Addr++) ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%02x 0x%05x,\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Addr, bRFRegOffsetMask))); ++ ++ if (pDM_Odm->RFType > ODM_1T1R) { ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "RF-B==========\n")); ++ for (Addr = 0; Addr < 0xFF; Addr++) ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%02x 0x%05x,\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, Addr, bRFRegOffsetMask))); ++ } ++ ++ if (pDM_Odm->RFType > ODM_2T2R) { ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "RF-C==========\n")); ++ for (Addr = 0; Addr < 0xFF; Addr++) ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%02x 0x%05x,\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_C, Addr, bRFRegOffsetMask))); ++ } ++ ++ if (pDM_Odm->RFType > ODM_3T3R) { ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "RF-D==========\n")); ++ for (Addr = 0; Addr < 0xFF; Addr++) ++ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%02x 0x%05x,\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_D, Addr, bRFRegOffsetMask))); ++ } ++} ++ ++VOID ++phydm_EnableBigJump( ++ IN PDM_ODM_T pDM_Odm, ++ IN BOOLEAN state ++ ) ++{ ++#if (RTL8822B_SUPPORT == 1) ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++ if (state == FALSE) { ++ pDM_Odm->DM_DigTable.enableAdjustBigJump = FALSE; ++ ODM_SetBBReg(pDM_Odm, 0x8c8, 0xfe, ((pDM_DigTable->bigJumpStep3<<5)|(pDM_DigTable->bigJumpStep2<<3)|pDM_DigTable->bigJumpStep1)); ++ } else ++ pDM_Odm->DM_DigTable.enableAdjustBigJump = TRUE; ++#endif ++} ++ ++#if (RTL8822B_SUPPORT == 1) ++ ++VOID ++phydm_showRxRate( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ) ++{ ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "=====Rx SU Rate Statistics=====\n")); ++ PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS0 = %d, 1SS MCS1 = %d, 1SS MCS2 = %d, 1SS MCS 3 = %d\n", ++ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[0], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[1], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[2], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[3])); ++ PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS4 = %d, 1SS MCS5 = %d, 1SS MCS6 = %d, 1SS MCS 7 = %d\n", ++ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[4], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[5], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[6], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[7])); ++ PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS8 = %d, 1SS MCS9 = %d\n", ++ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[8], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[9])); ++ PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS0 = %d, 2SS MCS1 = %d, 2SS MCS2 = %d, 2SS MCS 3 = %d\n", ++ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[10], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[11], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[12], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[13])); ++ PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS4 = %d, 2SS MCS5 = %d, 2SS MCS6 = %d, 2SS MCS 7 = %d\n", ++ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[14], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[15], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[16], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[17])); ++ PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS8 = %d, 2SS MCS9 = %d\n", ++ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[18], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[19])); ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "=====Rx MU Rate Statistics=====\n")); ++ PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS0 = %d, 1SS MCS1 = %d, 1SS MCS2 = %d, 1SS MCS 3 = %d\n", ++ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[0], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[1], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[2], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[3])); ++ PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS4 = %d, 1SS MCS5 = %d, 1SS MCS6 = %d, 1SS MCS 7 = %d\n", ++ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[4], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[5], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[6], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[7])); ++ PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS8 = %d, 1SS MCS9 = %d\n", ++ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[8], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[9])); ++ PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS0 = %d, 2SS MCS1 = %d, 2SS MCS2 = %d, 2SS MCS 3 = %d\n", ++ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[10], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[11], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[12], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[13])); ++ PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS4 = %d, 2SS MCS5 = %d, 2SS MCS6 = %d, 2SS MCS 7 = %d\n", ++ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[14], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[15], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[16], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[17])); ++ PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS8 = %d, 2SS MCS9 = %d\n", ++ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[18], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[19])); ++ ++} ++ ++#endif ++ ++ ++struct _PHYDM_COMMAND { ++ char name[16]; ++ u1Byte id; ++}; ++ ++enum PHYDM_CMD_ID { ++ PHYDM_HELP, ++ PHYDM_DEMO, ++ PHYDM_RA, ++ PHYDM_PROFILE, ++ PHYDM_ANTDIV, ++ PHYDM_PATHDIV, ++ PHYDM_DEBUG, ++ PHYDM_FW_DEBUG, ++ PHYDM_SUPPORT_ABILITY, ++ PHYDM_GET_TXAGC, ++ PHYDM_SET_TXAGC, ++ PHYDM_SMART_ANT, ++ PHYDM_API, ++ PHYDM_TRX_PATH, ++ PHYDM_LA_MODE, ++ PHYDM_DUMP_REG, ++ PHYDM_MU_MIMO, ++ PHYDM_HANG, ++ PHYDM_BIG_JUMP, ++ PHYDM_SHOW_RXRATE, ++ PHYDM_NBI_EN, ++ PHYDM_CSI_MASK_EN, ++ PHYDM_DFS, ++ PHYDM_IQK, ++ PHYDM_NHM, ++ PHYDM_CLM, ++ PHYDM_BB_INFO, ++ PHYDM_TXBF, ++ PHYDM_PAUSE_DIG_EN, ++ PHYDM_H2C, ++ PHYDM_ANT_SWITCH ++}; ++ ++struct _PHYDM_COMMAND phy_dm_ary[] = { ++ {"-h", PHYDM_HELP}, /*do not move this element to other position*/ ++ {"demo", PHYDM_DEMO}, /*do not move this element to other position*/ ++ {"ra", PHYDM_RA}, ++ {"profile", PHYDM_PROFILE}, ++ {"antdiv", PHYDM_ANTDIV}, ++ {"pathdiv", PHYDM_PATHDIV}, ++ {"dbg", PHYDM_DEBUG}, ++ {"fw_dbg", PHYDM_FW_DEBUG}, ++ {"ability", PHYDM_SUPPORT_ABILITY}, ++ {"get_txagc", PHYDM_GET_TXAGC}, ++ {"set_txagc", PHYDM_SET_TXAGC}, ++ {"smtant", PHYDM_SMART_ANT}, ++ {"api", PHYDM_API}, ++ {"trxpath", PHYDM_TRX_PATH}, ++ {"lamode", PHYDM_LA_MODE}, ++ {"dumpreg", PHYDM_DUMP_REG}, ++ {"mu", PHYDM_MU_MIMO}, ++ {"hang", PHYDM_HANG}, ++ {"bigjump", PHYDM_BIG_JUMP}, ++ {"rxrate", PHYDM_SHOW_RXRATE}, ++ {"nbi", PHYDM_NBI_EN}, ++ {"csi_mask", PHYDM_CSI_MASK_EN}, ++ {"dfs", PHYDM_DFS}, ++ {"iqk", PHYDM_IQK}, ++ {"nhm", PHYDM_NHM}, ++ {"clm", PHYDM_CLM}, ++ {"bbinfo", PHYDM_BB_INFO}, ++ {"txbf", PHYDM_TXBF}, ++ {"pause_dig", PHYDM_PAUSE_DIG_EN}, ++ {"h2c", PHYDM_H2C}, ++ {"ant_switch", PHYDM_ANT_SWITCH} ++}; ++ ++VOID ++phydm_cmd_parser( ++ IN PDM_ODM_T pDM_Odm, ++ IN char input[][MAX_ARGV], ++ IN u4Byte input_num, ++ IN u1Byte flag, ++ OUT char *output, ++ IN u4Byte out_len ++) ++{ ++ u4Byte used = 0; ++ u1Byte id = 0; ++ int var1[10] = {0}; ++ int i, input_idx = 0, phydm_ary_size; ++ char help[] = "-h"; ++ ++ if (flag == 0) { ++ PHYDM_SNPRINTF((output + used, out_len - used, "GET, nothing to print\n")); ++ return; ++ } ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n")); ++ ++ //Parsing Cmd ID ++ if (input_num) { ++ ++ phydm_ary_size = sizeof(phy_dm_ary) / sizeof(struct _PHYDM_COMMAND); ++ for (i = 0; i < phydm_ary_size; i++) { ++ if (strcmp(phy_dm_ary[i].name, input[0]) == 0) { ++ id = phy_dm_ary[i].id; ++ break; ++ } ++ } ++ if (i == phydm_ary_size) { ++ PHYDM_SNPRINTF((output + used, out_len - used, "SET, command not found!\n")); ++ return; ++ } ++ } ++ ++ switch (id) { ++ ++ case PHYDM_HELP: ++ { ++ PHYDM_SNPRINTF((output + used, out_len - used, "BB cmd ==>\n")); ++ for (i=0; i < phydm_ary_size-2; i++) { ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, " %-5d: %s\n", i, phy_dm_ary[i+2].name)); ++ /**/ ++ } ++ } ++ break; ++ ++ case PHYDM_DEMO: /*echo demo 10 0x3a z abcde >cmd*/ ++ { ++ u4Byte directory = 0; ++ ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) ++ char char_temp; ++ #else ++ u4Byte char_temp = ' '; ++ #endif ++ ++ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &directory); ++ PHYDM_SNPRINTF((output + used, out_len - used, "Decimal Value = %d\n", directory)); ++ PHYDM_SSCANF(input[2], DCMD_HEX, &directory); ++ PHYDM_SNPRINTF((output + used, out_len - used, "Hex Value = 0x%x\n", directory)); ++ PHYDM_SSCANF(input[3], DCMD_CHAR, &char_temp); ++ PHYDM_SNPRINTF((output + used, out_len - used, "Char = %c\n", char_temp)); ++ PHYDM_SNPRINTF((output + used, out_len - used, "String = %s\n", input[4])); ++ } ++ break; ++ ++ case PHYDM_RA: ++ ++ for (i = 0; i < 5; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); ++ ++ /*PHYDM_SNPRINTF((output + used, out_len - used, "new SET, RA_var[%d]= (( %d ))\n", i , var1[i]));*/ ++ input_idx++; ++ } ++ } ++ ++ if (input_idx >= 1) { ++ /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_RA_debug\n"));*/ ++ #if (defined(CONFIG_RA_DBG_CMD)) ++ odm_RA_debug((PVOID)pDM_Odm, (pu4Byte) var1); ++ #else ++ phydm_RA_debug_PCR(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); ++ #endif ++ } ++ ++ ++ break; ++ ++ case PHYDM_ANTDIV: ++ ++ for (i = 0; i < 5; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); ++ ++ /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, PATHDIV_var[%d]= (( %d ))\n", i , var1[i]));*/ ++ input_idx++; ++ } ++ } ++ ++ if (input_idx >= 1) { ++ /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_PATHDIV_debug\n"));*/ ++ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++ phydm_antdiv_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); ++ #endif ++ } ++ ++ break; ++ ++ case PHYDM_PATHDIV: ++ ++ for (i = 0; i < 5; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); ++ ++ /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, PATHDIV_var[%d]= (( %d ))\n", i , var1[i]));*/ ++ input_idx++; ++ } ++ } ++ ++ if (input_idx >= 1) { ++ /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_PATHDIV_debug\n"));*/ ++#if (defined(CONFIG_PATH_DIVERSITY)) ++ odm_pathdiv_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); ++#endif ++ } ++ ++ break; ++ ++ case PHYDM_DEBUG: ++ ++ for (i = 0; i < 5; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); ++ ++ /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, Debug_var[%d]= (( %d ))\n", i , var1[i]));*/ ++ input_idx++; ++ } ++ } ++ ++ if (input_idx >= 1) { ++ /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_debug_comp\n"));*/ ++ phydm_debug_trace(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); ++ } ++ ++ ++ break; ++ ++ case PHYDM_FW_DEBUG: ++ ++ for (i = 0; i < 5; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); ++ input_idx++; ++ } ++ } ++ ++ if (input_idx >= 1) ++ phydm_fw_debug_trace(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); ++ ++ break; ++ ++ case PHYDM_SUPPORT_ABILITY: ++ ++ for (i = 0; i < 5; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); ++ ++ /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, support ablity_var[%d]= (( %d ))\n", i , var1[i]));*/ ++ input_idx++; ++ } ++ } ++ ++ if (input_idx >= 1) { ++ /*PHYDM_SNPRINTF((output+used, out_len-used, "support ablity\n"));*/ ++ phydm_support_ability_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); ++ } ++ ++ break; ++ ++ case PHYDM_SMART_ANT: ++ ++ for (i = 0; i < 5; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); ++ input_idx++; ++ } ++ } ++ ++ if (input_idx >= 1) { ++ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 ++ phydm_hl_smart_ant_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); ++ #endif ++ #endif ++ } ++ ++ break; ++ ++ case PHYDM_API: ++#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) ++ { ++ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F | ODM_RTL8821C)) { ++ BOOLEAN bEnableDbgMode; ++ u1Byte central_ch, primary_ch_idx, bandwidth; ++ ++ for (i = 0; i < 4; i++) { ++ if (input[i + 1]) ++ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); ++ } ++ ++ bEnableDbgMode = (BOOLEAN)var1[0]; ++ central_ch = (u1Byte) var1[1]; ++ primary_ch_idx = (u1Byte) var1[2]; ++ bandwidth = (ODM_BW_E) var1[3]; ++ ++ if (bEnableDbgMode) { ++ pDM_Odm->bDisablePhyApi = FALSE; ++ phydm_api_switch_bw_channel(pDM_Odm, central_ch, primary_ch_idx, (ODM_BW_E) bandwidth); ++ pDM_Odm->bDisablePhyApi = TRUE; ++ PHYDM_SNPRINTF((output+used, out_len-used, "central_ch = %d, primary_ch_idx = %d, bandwidth = %d\n", central_ch, primary_ch_idx, bandwidth)); ++ } else { ++ pDM_Odm->bDisablePhyApi = FALSE; ++ PHYDM_SNPRINTF((output+used, out_len-used, "Disable API debug mode\n")); ++ } ++ } else ++ PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support PHYDM API function\n")); ++ } ++#else ++ PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support PHYDM API function\n")); ++#endif ++ break; ++ ++ case PHYDM_PROFILE: /*echo profile, >cmd*/ ++ phydm_BasicProfile(pDM_Odm, &used, output, &out_len); ++ break; ++ ++ case PHYDM_GET_TXAGC: ++ phydm_get_txagc(pDM_Odm, &used, output, &out_len); ++ break; ++ ++ case PHYDM_SET_TXAGC: ++ { ++ BOOLEAN bEnableDbgMode; ++ ++ for (i = 0; i < 5; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); ++ input_idx++; ++ } ++ } ++ ++ if ((strcmp(input[1], help) == 0)) { ++ PHYDM_SNPRINTF((output+used, out_len-used, "{En} {pathA~D(0~3)} {rate_idx(Hex), All_rate:0xff} {txagc_idx (Hex)}\n")); ++ /**/ ++ ++ } else { ++ ++ bEnableDbgMode = (BOOLEAN)var1[0]; ++ if (bEnableDbgMode) { ++ pDM_Odm->bDisablePhyApi = FALSE; ++ phydm_set_txagc(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); ++ pDM_Odm->bDisablePhyApi = TRUE; ++ } else { ++ pDM_Odm->bDisablePhyApi = FALSE; ++ PHYDM_SNPRINTF((output+used, out_len-used, "Disable API debug mode\n")); ++ } ++ } ++ } ++ break; ++ ++ case PHYDM_TRX_PATH: ++ ++ for (i = 0; i < 4; i++) { ++ if (input[i + 1]) ++ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); ++ } ++ #if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F)) { ++ u1Byte TxPath, RxPath; ++ BOOLEAN bEnableDbgMode, bTx2Path; ++ ++ bEnableDbgMode = (BOOLEAN)var1[0]; ++ TxPath = (u1Byte) var1[1]; ++ RxPath = (u1Byte) var1[2]; ++ bTx2Path = (BOOLEAN) var1[3]; ++ ++ if (bEnableDbgMode) { ++ pDM_Odm->bDisablePhyApi = FALSE; ++ phydm_api_trx_mode(pDM_Odm, (ODM_RF_PATH_E) TxPath, (ODM_RF_PATH_E) RxPath, bTx2Path); ++ pDM_Odm->bDisablePhyApi = TRUE; ++ PHYDM_SNPRINTF((output+used, out_len-used, "TxPath = 0x%x, RxPath = 0x%x, bTx2Path = %d\n", TxPath, RxPath, bTx2Path)); ++ } else { ++ pDM_Odm->bDisablePhyApi = FALSE; ++ PHYDM_SNPRINTF((output+used, out_len-used, "Disable API debug mode\n")); ++ } ++ } else ++ #endif ++ phydm_config_trx_path(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); ++ ++ break; ++ ++ case PHYDM_LA_MODE: ++#if (PHYDM_LA_MODE_SUPPORT == 1) ++ ++ if (pDM_Odm->SupportICType & PHYDM_IC_SUPPORT_LA_MODE) { ++ u2Byte PollingTime; ++ u1Byte TrigSel, TrigSigSel, DmaDataSigSel, TriggerTime_unit_num; ++ BOOLEAN bEnableLaMode, bTriggerEdge; ++ u4Byte DbgPort, TriggerTime_mu_sec; ++ u1Byte sampling_rate = 0; ++ ++ for (i = 0; i < 6; i++) { ++ if (input[i + 1]) ++ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); ++ } ++ ++ bEnableLaMode = (BOOLEAN)var1[0]; ++ DbgPrint("echo cmd input_num = %d\n", input_num); ++ /* if ((strcmp(input[1], help) == 0) && (input_num == 2)) {*/ ++ if ((strcmp(input[1], help) == 0)) { ++ PHYDM_SNPRINTF((output+used, out_len-used, "{En} {0:BB,1:MAC} {BB:DbgPort[bit],MAC:0-ok/1-fail/2-cca} {RptFormat} {TrigTime} \n {PollingTime} {DbgPort} {0:P_Edge, 1:N_Edge} {SpRate:0-80M,1-40M,2-20M} {Capture num}\n")); ++ /**/ ++ /*} else if ((bEnableLaMode == 1) && (input_num == 10)) {*/ ++ } else if ((bEnableLaMode == 1)) { ++ TrigSel = (u1Byte)var1[1]; /*0: BB, 1: MAC*/ ++ TrigSigSel = (u1Byte)var1[2]; ++ DmaDataSigSel = (u1Byte)var1[3]; ++ TriggerTime_mu_sec = var1[4]; /*unit: us*/ ++ PollingTime = (((u1Byte)var1[5]) << 6); /*unit: ms*/ ++ ++ PHYDM_SSCANF(input[7], DCMD_HEX, &var1[6]); ++ PHYDM_SSCANF(input[8], DCMD_DECIMAL, &var1[7]); ++ PHYDM_SSCANF(input[9], DCMD_DECIMAL, &var1[8]); ++ PHYDM_SSCANF(input[10], DCMD_DECIMAL, &var1[9]); ++ ++ DbgPort = (u4Byte)var1[6]; ++ bTriggerEdge = (BOOLEAN) var1[7]; ++ sampling_rate = var1[8] & 0x7; ++ ++ #if 1 ++ TriggerTime_unit_num = phydm_la_mode_mac_setting(pDM_Odm, TriggerTime_mu_sec); ++ phydm_la_mode_bb_setting(pDM_Odm, DbgPort, bTriggerEdge, sampling_rate); ++ #else ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ODM_SetBBReg(pDM_Odm, 0x198C , BIT2|BIT1|BIT0, 7); /*disable dbg clk gating*/ ++ ODM_SetBBReg(pDM_Odm, 0x8FC, bMaskDWord, DbgPort); ++ ODM_SetBBReg(pDM_Odm, 0x95C , BIT31, bTriggerEdge); /*0: posedge, 1: negedge*/ ++ ODM_SetBBReg(pDM_Odm, 0x95c, 0xe0, sampling_rate); ++ } else { ++ ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, DbgPort); ++ ODM_SetBBReg(pDM_Odm, 0x9A0 , BIT31, bTriggerEdge); /*0: posedge, 1: negedge*/ ++ ODM_SetBBReg(pDM_Odm, 0x9A0, 0xe0, sampling_rate); ++ } ++ #endif ++ ++ pDM_Odm->ADCSmp_dbg_port = DbgPort; ++ pDM_Odm->ADCSmp_trigger_edge = bTriggerEdge; ++ pDM_Odm->ADCsmp_smp_rate = sampling_rate; ++ pDM_Odm->ADCSmp_count = var1[9]; ++ ++ DbgPrint("echo lamode %d %d %d %d %d %d %x %d %d %d\n", var1[0], var1[1], var1[2], var1[3], var1[4], var1[5], var1[6], var1[7], var1[8], var1[9]); ++ ++ ADCSmp_Set(pDM_Odm, (RT_ADCSMP_TRIG_SEL) TrigSel, (RT_ADCSMP_TRIG_SIG_SEL) TrigSigSel, DmaDataSigSel, TriggerTime_unit_num, PollingTime); ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "TrigSel = ((%s)), TrigSigSel = ((%d)), DmaDataSigSel = ((%d))\n", ((TrigSel)?"MAC":"BB"), TrigSigSel, DmaDataSigSel)); ++ PHYDM_SNPRINTF((output+used, out_len-used, "TriggerTime = ((%d * %d us)), PollingTime = ((%d)), sampling rate = ((%d MHz))\n", ++ TriggerTime_unit_num, ((pDM_Odm->ADCsmp_time_unit == 0) ? 1 : (2<<(pDM_Odm->ADCsmp_time_unit-1))), PollingTime, (80>>sampling_rate))); ++ } else { ++ ADCSmp_Stop(pDM_Odm); ++ PHYDM_SNPRINTF((output+used, out_len-used, "Disable LA mode\n")); ++ } ++ } else ++ #endif ++ PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support LA mode\n")); ++ break; ++ ++ case PHYDM_DUMP_REG: ++ { ++ u1Byte type = 0; ++ ++ if (input[1]) { ++ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); ++ type = (u1Byte)var1[0]; ++ } ++ ++ if (type == 0) ++ phydm_DumpBbReg(pDM_Odm, &used, output, &out_len); ++ else if (type == 1) ++ phydm_DumpAllReg(pDM_Odm, &used, output, &out_len); ++ } ++ break; ++ ++ case PHYDM_MU_MIMO: ++#if (RTL8822B_SUPPORT == 1) ++ ++ if (input[1]) ++ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); ++ else ++ var1[0] = 0; ++ ++ if (var1[0] == 1) { ++ int index, ptr; ++ u4Byte Dword_H, Dword_L; ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "Get MU BFee CSI\n")); ++ ODM_SetBBReg(pDM_Odm, 0x9e8, BIT17|BIT16, 2); /*Read BFee*/ ++ ODM_SetBBReg(pDM_Odm, 0x1910, BIT15, 1); /*Select BFee's CSI report*/ ++ ODM_SetBBReg(pDM_Odm, 0x19b8, BIT6, 1); /*set as CSI report*/ ++ ODM_SetBBReg(pDM_Odm, 0x19a8, 0xFFFF, 0xFFFF); /*disable gated_clk*/ ++ ++ for (index = 0; index < 80; index++) { ++ ptr = index + 256; ++ if (ptr > 311) ++ ptr -= 312; ++ ODM_SetBBReg(pDM_Odm, 0x1910, 0x03FF0000, ptr); /*Select Address*/ ++ Dword_H = ODM_GetBBReg(pDM_Odm, 0xF74, bMaskDWord); ++ Dword_L = ODM_GetBBReg(pDM_Odm, 0xF5C, bMaskDWord); ++ if (index % 2 == 0) ++ PHYDM_SNPRINTF((output+used, out_len-used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", ++ Dword_L & bMaskByte0, (Dword_L & bMaskByte1) >> 8, (Dword_L & bMaskByte2) >> 16, (Dword_L & bMaskByte3) >> 24, ++ Dword_H & bMaskByte0, (Dword_H & bMaskByte1) >> 8, (Dword_H & bMaskByte2) >> 16, (Dword_H & bMaskByte3) >> 24)); ++ else ++ PHYDM_SNPRINTF((output+used, out_len-used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", ++ Dword_L & bMaskByte0, (Dword_L & bMaskByte1) >> 8, (Dword_L & bMaskByte2) >> 16, (Dword_L & bMaskByte3) >> 24, ++ Dword_H & bMaskByte0, (Dword_H & bMaskByte1) >> 8, (Dword_H & bMaskByte2) >> 16, (Dword_H & bMaskByte3) >> 24)); ++ } ++ } else if (var1[0] == 2) { ++ int index, ptr; ++ u4Byte Dword_H, Dword_L; ++ ++ PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var1[1]); ++ PHYDM_SNPRINTF((output+used, out_len-used, "Get MU BFer's STA%d CSI\n", var1[1])); ++ ODM_SetBBReg(pDM_Odm, 0x9e8, BIT24, 0); /*Read BFer*/ ++ ODM_SetBBReg(pDM_Odm, 0x9e8, BIT25, 1); /*enable Read/Write RAM*/ ++ ODM_SetBBReg(pDM_Odm, 0x9e8, BIT30|BIT29|BIT28, var1[1]); /*read which STA's CSI report*/ ++ ODM_SetBBReg(pDM_Odm, 0x1910, BIT15, 0); /*select BFer's CSI*/ ++ ODM_SetBBReg(pDM_Odm, 0x19e0, 0x00003FC0, 0xFF); /*disable gated_clk*/ ++ ++ for (index = 0; index < 80; index++) { ++ ptr = index + 256; ++ if (ptr > 311) ++ ptr -= 312; ++ ODM_SetBBReg(pDM_Odm, 0x1910, 0x03FF0000, ptr); /*Select Address*/ ++ Dword_H = ODM_GetBBReg(pDM_Odm, 0xF74, bMaskDWord); ++ Dword_L = ODM_GetBBReg(pDM_Odm, 0xF5C, bMaskDWord); ++ if (index % 2 == 0) ++ PHYDM_SNPRINTF((output+used, out_len-used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", ++ Dword_L & bMaskByte0, (Dword_L & bMaskByte1) >> 8, (Dword_L & bMaskByte2) >> 16, (Dword_L & bMaskByte3) >> 24, ++ Dword_H & bMaskByte0, (Dword_H & bMaskByte1) >> 8, (Dword_H & bMaskByte2) >> 16, (Dword_H & bMaskByte3) >> 24)); ++ else ++ PHYDM_SNPRINTF((output+used, out_len-used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", ++ Dword_L & bMaskByte0, (Dword_L & bMaskByte1) >> 8, (Dword_L & bMaskByte2) >> 16, (Dword_L & bMaskByte3) >> 24, ++ Dword_H & bMaskByte0, (Dword_H & bMaskByte1) >> 8, (Dword_H & bMaskByte2) >> 16, (Dword_H & bMaskByte3) >> 24)); ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "ptr=%d : 0x%8x %8x\n", ptr, Dword_H, Dword_L)); ++ } ++ ++ } ++#endif ++ break; ++ ++ case PHYDM_BIG_JUMP: ++ { ++#if (RTL8822B_SUPPORT == 1) ++ if (input[1]) { ++ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); ++ phydm_EnableBigJump(pDM_Odm, (BOOLEAN)(var1[0])); ++ } else ++ PHYDM_SNPRINTF((output + used, out_len - used, "unknown command!\n")); ++#else ++ PHYDM_SNPRINTF((output + used, out_len - used, "The command is only for 8822B!\n")); ++#endif ++ break; ++ } ++ ++ case PHYDM_HANG: ++ phydm_BB_RxHang_Info(pDM_Odm, &used, output, &out_len); ++ break; ++ ++ case PHYDM_SHOW_RXRATE: ++#if (RTL8822B_SUPPORT == 1) ++ { ++ u1Byte rate_idx; ++ ++ if (input[1]) ++ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); ++ ++ if (var1[0] == 1) ++ phydm_showRxRate(pDM_Odm, &used, output, &out_len); ++ else { ++ PHYDM_SNPRINTF((output+used, out_len-used, "Reset Rx rate counter\n")); ++ ++ for (rate_idx = 0; rate_idx < 40; rate_idx++) { ++ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[rate_idx] = 0; ++ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[rate_idx] = 0; ++ } ++ } ++ } ++#endif ++ break; ++ ++ case PHYDM_NBI_EN: ++ ++ for (i = 0; i < 5; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); ++ input_idx++; ++ } ++ } ++ ++ if (input_idx >= 1) { ++ ++ phydm_api_debug(pDM_Odm, PHYDM_API_NBI, (u4Byte *)var1, &used, output, &out_len); ++ /**/ ++ } ++ ++ ++ break; ++ ++ case PHYDM_CSI_MASK_EN: ++ ++ for (i = 0; i < 5; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); ++ input_idx++; ++ } ++ } ++ ++ if (input_idx >= 1) { ++ ++ phydm_api_debug(pDM_Odm, PHYDM_API_CSI_MASK, (u4Byte *)var1, &used, output, &out_len); ++ /**/ ++ } ++ ++ ++ break; ++ ++ case PHYDM_DFS: ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ { ++ u4Byte var[6] = {0}; ++ ++ for (i = 0; i < 6; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var[i]); ++ input_idx++; ++ } ++ } ++ ++ if (input_idx >= 1) ++ phydm_dfs_debug(pDM_Odm, var, &used, output, &out_len); ++ } ++#endif ++ break; ++ ++ case PHYDM_IQK: ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ PHY_IQCalibrate(pDM_Odm->priv); ++ PHYDM_SNPRINTF((output + used, out_len - used, "IQK !!\n")); ++#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PHY_IQCalibrate(pDM_Odm->Adapter, FALSE); ++ PHYDM_SNPRINTF((output + used, out_len - used, "IQK !!\n")); ++#endif ++ break; ++ ++ case PHYDM_NHM: ++ { ++ u1Byte target_rssi; ++ u4Byte value32; ++ u2Byte nhm_period = 0xC350; //200ms ++ u1Byte IGI; ++ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; ++ ++ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); ++ ++ if(input_num == 1) { ++ ++ CCX_INFO->echo_NHM_en = FALSE; ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Trigger NHM: echo nhm 1\n")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r (Exclude CCA)\n")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r Trigger NHM: echo nhm 2\n")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r (Include CCA)\n")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r Get NHM results: echo nhm 3\n")); ++ ++ return; ++ } ++ ++ /* NMH trigger */ ++ if ((var1[0] <= 2) && (var1[0] != 0)) { ++ ++ CCX_INFO->echo_NHM_en = TRUE; ++ CCX_INFO->echo_IGI = (u1Byte)ODM_GetBBReg(pDM_Odm, 0xC50, bMaskByte0); ++ ++ target_rssi = CCX_INFO->echo_IGI - 10; ++ ++ CCX_INFO->NHM_th[0] = (target_rssi -15 + 10) * 2; ++ ++ for(i = 1; i <= 10; i ++) { ++ CCX_INFO->NHM_th[i] = CCX_INFO->NHM_th[0] + 6 * i; ++ } ++ ++ //4 1. store previous NHM setting ++ phydm_NHMsetting(pDM_Odm, STORE_NHM_SETTING); ++ ++ //4 2. Set NHM period, 0x990[31:16]=0xC350, Time duration for NHM unit: 4us, 0xC350=200ms ++ CCX_INFO->NHM_period = nhm_period; ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Monitor NHM for %d us", nhm_period*4)); ++ ++ //4 3. Set NHM inexclude_txon, inexclude_cca, ccx_en ++ ++ ++ CCX_INFO->NHM_inexclude_cca = (var1[0] == 1) ? NHM_EXCLUDE_CCA : NHM_INCLUDE_CCA; ++ CCX_INFO->NHM_inexclude_txon = NHM_EXCLUDE_TXON; ++ ++ phydm_NHMsetting(pDM_Odm, SET_NHM_SETTING); ++ ++ for(i = 0; i <= 10; i ++) { ++ ++ if (i == 5) { ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n NHM_th[%d] = 0x%x, echo_IGI = 0x%x", i, CCX_INFO->NHM_th[i], CCX_INFO->echo_IGI)); ++ } ++ else if (i == 10) ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n NHM_th[%d] = 0x%x\n", i, CCX_INFO->NHM_th[i])); ++ else ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n NHM_th[%d] = 0x%x", i, CCX_INFO->NHM_th[i])); ++ } ++ ++ //4 4. Trigger NHM ++ phydm_NHMtrigger(pDM_Odm); ++ ++ } ++ ++ /*Get NHM results*/ ++ else if (var1[0] == 3) { ++ ++ IGI = (u1Byte)ODM_GetBBReg(pDM_Odm, 0xC50, bMaskByte0); ++ ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Cur_IGI = 0x%x", IGI)); ++ ++ phydm_getNHMresult(pDM_Odm); ++ ++ //4 Resotre NHM setting ++ phydm_NHMsetting(pDM_Odm, RESTORE_NHM_SETTING); ++ ++ for(i = 0; i <= 11; i++) { ++ ++ if (i == 5) ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n nhm_result[%d] = %d, echo_IGI = 0x%x", i, CCX_INFO->NHM_result[i], CCX_INFO->echo_IGI)); ++ else if (i == 11) ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n nhm_result[%d] = %d\n", i, CCX_INFO->NHM_result[i])); ++ else ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n nhm_result[%d] = %d", i, CCX_INFO->NHM_result[i])); ++ } ++ ++ CCX_INFO->echo_NHM_en = FALSE; ++ } ++ else { ++ ++ CCX_INFO->echo_NHM_en = FALSE; ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Trigger NHM: echo nhm 1\n")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r (Exclude CCA)\n")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r Trigger NHM: echo nhm 2\n")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r (Include CCA)\n")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r Get NHM results: echo nhm 3\n")); ++ ++ return; ++ } ++ } ++ break; ++ ++ case PHYDM_CLM: ++ { ++ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; ++ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); ++ ++ //PHYDM_SNPRINTF((output + used, out_len - used, "\r\n input_num = %d\n", input_num)); ++ ++ if (input_num == 1) { ++ ++ CCX_INFO->echo_CLM_en = FALSE; ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Trigger CLM: echo clm 1\n")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r Get CLM results: echo clm 2\n")); ++ return; ++ } ++ ++ /* Set & trigger CLM */ ++ if (var1[0] == 1) { ++ ++ CCX_INFO->echo_CLM_en = TRUE; ++ CCX_INFO->CLM_period = 0xC350; /*100ms*/ ++ phydm_CLMsetting(pDM_Odm); ++ phydm_CLMtrigger(pDM_Odm); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Monitor CLM for 200ms\n")); ++ } ++ ++ /* Get CLM results */ ++ else if (var1[0] == 2) { ++ ++ CCX_INFO->echo_CLM_en = FALSE; ++ phydm_getCLMresult(pDM_Odm); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n CLM_result = %d us\n", CCX_INFO->CLM_result*4)); ++ ++ } else { ++ ++ CCX_INFO->echo_CLM_en = FALSE; ++ PHYDM_SNPRINTF((output + used, out_len - used, "\n\r Error command !\n")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r Trigger CLM: echo clm 1\n")); ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r Get CLM results: echo clm 2\n")); ++ } ++ } ++ break; ++ ++ case PHYDM_BB_INFO: ++ { ++ s4Byte value32 = 0; ++ ++ phydm_BB_Debug_Info(pDM_Odm, &used, output, &out_len); ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8822B && input[1]) { ++ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); ++ ODM_SetBBReg(pDM_Odm, 0x1988, 0x003fff00, var1[0]); ++ value32 = ODM_GetBBReg(pDM_Odm, 0xf84, bMaskDWord); ++ value32 = (value32 & 0xff000000)>>24; ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = condition num = %d, subcarriers = %d\n", "Over condition num subcarrier", var1[0], value32)); ++ ODM_SetBBReg(pDM_Odm, 0x1988 , BIT22, 0x0); /*disable report condition number*/ ++ } ++ } ++ break; ++ ++ case PHYDM_TXBF: ++ { ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++#if (BEAMFORMING_SUPPORT == 1) ++ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; ++ ++ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); ++ if (var1[0] == 1) { ++ pBeamformingInfo->applyVmatrix = TRUE; ++ pBeamformingInfo->snding3SS = FALSE; ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n apply V matrix and 3SS 789 dont snding\n")); ++ } else if (var1[0] == 0) { ++ pBeamformingInfo->applyVmatrix = FALSE; ++ pBeamformingInfo->snding3SS = TRUE; ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n dont apply V matrix and 3SS 789 snding\n")); ++ } else ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n unknown cmd!!\n")); ++#else ++ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n no TxBF !!\n")); ++#endif ++#endif ++ } ++ break; ++ ++ case PHYDM_PAUSE_DIG_EN: ++ ++ ++ for (i = 0; i < 5; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); ++ input_idx++; ++ } ++ } ++ ++ if (input_idx >= 1) { ++ if (var1[0] == 0) { ++ odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_7, (u1Byte)var1[1]); ++ PHYDM_SNPRINTF((output + used, out_len - used, "Set IGI_value = ((%x))\n", var1[1])); ++ } else if (var1[0] == 1) { ++ odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_7, (u1Byte)var1[1]); ++ PHYDM_SNPRINTF((output + used, out_len - used, "Resume IGI_value\n")); ++ } else ++ PHYDM_SNPRINTF((output + used, out_len - used, "echo (1:pause, 2resume) (IGI_value)\n")); ++ } ++ ++ break; ++ ++ case PHYDM_H2C: ++ ++ for (i = 0; i < 8; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); ++ input_idx++; ++ } ++ } ++ ++ if (input_idx >= 1) ++ phydm_h2C_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); ++ ++ ++ break; ++ ++ case PHYDM_ANT_SWITCH: ++ ++ for (i = 0; i < 8; i++) { ++ if (input[i + 1]) { ++ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); ++ input_idx++; ++ } ++ } ++ ++ if (input_idx >= 1) { ++ ++ #if (RTL8821A_SUPPORT == 1) ++ phydm_set_ext_switch(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); ++ #else ++ PHYDM_SNPRINTF((output + used, out_len - used, "Not Support IC")); ++ #endif ++ } ++ ++ ++ break; ++ ++ default: ++ PHYDM_SNPRINTF((output + used, out_len - used, "SET, unknown command!\n")); ++ break; ++ ++ } ++} ++ ++ ++VOID ++phydm_la_mode_bb_setting( ++ IN PVOID pDM_VOID, ++ IN u4Byte DbgPort, ++ IN BOOLEAN bTriggerEdge, ++ IN u1Byte sampling_rate ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ /*u4Byte dword;*/ ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ODM_SetBBReg(pDM_Odm, 0x198C , BIT2|BIT1|BIT0, 7); /*disable dbg clk gating*/ ++ ++ /*dword= ODM_GetBBReg(pDM_Odm, 0x8FC, bMaskDWord);*/ ++ /*DbgPrint("dbg_port = ((0x%x))\n", dword);*/ ++ ODM_SetBBReg(pDM_Odm, 0x8FC, bMaskDWord, DbgPort); ++ ODM_SetBBReg(pDM_Odm, 0x95C , BIT31, bTriggerEdge); /*0: posedge, 1: negedge*/ ++ ODM_SetBBReg(pDM_Odm, 0x95c, 0xe0, sampling_rate); ++ /* (0:) '80MHz' ++ (1:) '40MHz' ++ (2:) '20MHz' ++ (3:) '10MHz' ++ (4:) '5MHz' ++ (5:) '2.5MHz' ++ (6:) '1.25MHz' ++ (7:) '160MHz (for BW160 ic)' ++ */ ++ } else { ++ ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, DbgPort); ++ ODM_SetBBReg(pDM_Odm, 0x9A0 , BIT31, bTriggerEdge); /*0: posedge, 1: negedge*/ ++ ODM_SetBBReg(pDM_Odm, 0x9A0, 0xe0, sampling_rate); ++ /* (0:) '80MHz' ++ (1:) '40MHz' ++ (2:) '20MHz' ++ (3:) '10MHz' ++ (4:) '5MHz' ++ (5:) '2.5MHz' ++ (6:) '1.25MHz' ++ (7:) '160MHz (for BW160 ic)' ++ */ ++ } ++} ++ ++u1Byte ++phydm_la_mode_mac_setting( ++ IN PVOID pDM_VOID, ++ IN u4Byte TriggerTime_mu_sec ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte TriggerTime_unit_num; ++ u4Byte time_unit = 0; ++ ++ if (TriggerTime_mu_sec < 128) { ++ time_unit = 0; /*unit: 1mu sec*/ ++ } else if (TriggerTime_mu_sec < 256) { ++ time_unit = 1; /*unit: 2mu sec*/ ++ } else if (TriggerTime_mu_sec < 512) { ++ time_unit = 2; /*unit: 4mu sec*/ ++ } else if (TriggerTime_mu_sec < 1024) { ++ time_unit = 3; /*unit: 8mu sec*/ ++ } else if (TriggerTime_mu_sec < 2048) { ++ time_unit = 4; /*unit: 16mu sec*/ ++ } else if (TriggerTime_mu_sec < 4096) { ++ time_unit = 5; /*unit: 32mu sec*/ ++ } else if (TriggerTime_mu_sec < 8192) { ++ time_unit = 6; /*unit: 64mu sec*/ ++ } ++ ++ TriggerTime_unit_num = (u1Byte)(TriggerTime_mu_sec>>time_unit); ++ pDM_Odm->ADCsmp_time_unit = time_unit; ++ DbgPrint("time_unit = ((0x%x))\n", time_unit); ++ ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ ODM_SetMACReg(pDM_Odm, 0x7cc , BIT20|BIT19|BIT18, time_unit); ++ } else { ++ ++ } ++ return (TriggerTime_unit_num & 0x7f); ++ ++} ++ ++#ifdef __ECOS ++char *strsep(char **s, const char *ct) ++{ ++ char *sbegin = *s; ++ char *end; ++ ++ if (sbegin == NULL) ++ return NULL; ++ ++ end = strpbrk(sbegin, ct); ++ if (end) ++ *end++ = '\0'; ++ *s = end; ++ return sbegin; ++} ++#endif ++ ++#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) ++s4Byte ++phydm_cmd( ++ IN PDM_ODM_T pDM_Odm, ++ IN char *input, ++ IN u4Byte in_len, ++ IN u1Byte flag, ++ OUT char *output, ++ IN u4Byte out_len ++) ++{ ++ char *token; ++ u4Byte Argc = 0; ++ char Argv[MAX_ARGC][MAX_ARGV]; ++ ++ do { ++ token = strsep(&input, ", "); ++ if (token) { ++ strcpy(Argv[Argc], token); ++ Argc++; ++ } else ++ break; ++ } while (Argc < MAX_ARGC); ++ ++ if (Argc == 1) ++ Argv[0][strlen(Argv[0]) - 1] = '\0'; ++ ++ phydm_cmd_parser(pDM_Odm, Argv, Argc, flag, output, out_len); ++ ++ return 0; ++} ++#endif ++ ++ ++VOID ++phydm_fw_trace_handler( ++ IN PVOID pDM_VOID, ++ IN pu1Byte CmdBuf, ++ IN u1Byte CmdLen ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ /*u1Byte debug_trace_11byte[60];*/ ++ u1Byte freg_num, c2h_seq, buf_0 = 0; ++ ++ if (!(pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES)) ++ return; ++ ++ if (CmdLen > 12) ++ return; ++ ++ buf_0 = CmdBuf[0]; ++ freg_num = (buf_0 & 0xf); ++ c2h_seq = (buf_0 & 0xf0) >> 4; ++ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] freg_num = (( %d )), c2h_seq = (( %d ))\n", freg_num,c2h_seq ));*/ ++ ++ /*strncpy(debug_trace_11byte,&CmdBuf[1],(CmdLen-1));*/ ++ /*debug_trace_11byte[CmdLen-1] = '\0';*/ ++ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] %s\n", debug_trace_11byte));*/ ++ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] CmdLen = (( %d ))\n", CmdLen));*/ ++ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] c2h_cmd_start = (( %d ))\n", pDM_Odm->c2h_cmd_start));*/ ++ ++ ++ ++ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("pre_seq = (( %d )), current_seq = (( %d ))\n", pDM_Odm->pre_c2h_seq, c2h_seq));*/ ++ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("fw_buff_is_enpty = (( %d ))\n", pDM_Odm->fw_buff_is_enpty));*/ ++ ++ if ((c2h_seq != pDM_Odm->pre_c2h_seq) && pDM_Odm->fw_buff_is_enpty == FALSE) { ++ pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start] = '\0'; ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW Dbg Queue Overflow] %s\n", pDM_Odm->fw_debug_trace)); ++ pDM_Odm->c2h_cmd_start = 0; ++ } ++ ++ if ((CmdLen - 1) > (60 - pDM_Odm->c2h_cmd_start)) { ++ pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start] = '\0'; ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW Dbg Queue error: wrong C2H length] %s\n", pDM_Odm->fw_debug_trace)); ++ pDM_Odm->c2h_cmd_start = 0; ++ return; ++ } ++ ++ strncpy((char *)&(pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start]), (char *)&CmdBuf[1], (CmdLen-1)); ++ pDM_Odm->c2h_cmd_start += (CmdLen - 1); ++ pDM_Odm->fw_buff_is_enpty = FALSE; ++ ++ if (freg_num == 0 || pDM_Odm->c2h_cmd_start >= 60) { ++ if (pDM_Odm->c2h_cmd_start < 60) ++ pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start] = '\0'; ++ else ++ pDM_Odm->fw_debug_trace[59] = '\0'; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s\n", pDM_Odm->fw_debug_trace)); ++ /*DbgPrint("[FW DBG Msg] %s\n", pDM_Odm->fw_debug_trace);*/ ++ pDM_Odm->c2h_cmd_start = 0; ++ pDM_Odm->fw_buff_is_enpty = TRUE; ++ } ++ ++ pDM_Odm->pre_c2h_seq = c2h_seq; ++} ++ ++VOID ++phydm_fw_trace_handler_code( ++ IN PVOID pDM_VOID, ++ IN pu1Byte Buffer, ++ IN u1Byte CmdLen ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte function = Buffer[0]; ++ u1Byte dbg_num = Buffer[1]; ++ u2Byte content_0 = (((u2Byte)Buffer[3])<<8)|((u2Byte)Buffer[2]); ++ u2Byte content_1 = (((u2Byte)Buffer[5])<<8)|((u2Byte)Buffer[4]); ++ u2Byte content_2 = (((u2Byte)Buffer[7])<<8)|((u2Byte)Buffer[6]); ++ u2Byte content_3 = (((u2Byte)Buffer[9])<<8)|((u2Byte)Buffer[8]); ++ u2Byte content_4 = (((u2Byte)Buffer[11])<<8)|((u2Byte)Buffer[10]); ++ ++ if(CmdLen >12) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW Msg] Invalid cmd length (( %d )) >12 \n", CmdLen)); ++ } ++ ++ //ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW Msg] Func=((%d)), num=((%d)), ct_0=((%d)), ct_1=((%d)), ct_2=((%d)), ct_3=((%d)), ct_4=((%d))\n", ++ // function, dbg_num, content_0, content_1, content_2, content_3, content_4)); ++ ++ /*--------------------------------------------*/ ++#if (CONFIG_RA_FW_DBG_CODE) ++ if(function == RATE_DECISION) { ++ if(dbg_num == 0) { ++ if(content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RA_CNT=((%d)) Max_device=((%d))--------------------------->\n", content_1, content_2)); ++ } else if(content_0 == 2) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Check RA macid= ((%d)), MediaStatus=((%d)), Dis_RA=((%d)), try_bit=((0x%x))\n", content_1, content_2, content_3, content_4)); ++ } else if(content_0 == 3) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Check RA total=((%d)), drop=((0x%x)), TXRPT_TRY_bit=((%x)), bNoisy=((%x))\n", content_1, content_2, content_3, content_4)); ++ } ++ } else if(dbg_num == 1) { ++ if (content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RTY[0,1,2,3]=[ %d , %d , %d , %d ]\n", content_1, content_2, content_3, content_4)); ++ } else if (content_0 == 2) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RTY[4]=[ %d ], drop=(( %d )), total=(( %d )), current_rate=((0x %x ))", content_1, content_2, content_3, content_4)); ++ phydm_print_rate(pDM_Odm, (u1Byte)content_4, ODM_FW_DEBUG_TRACE); ++ } else if (content_0 == 3) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] penality_idx=(( %d ))\n", content_1)); ++ } else if (content_0 == 4) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RSSI=(( %d )), ra_stage = (( %d ))\n", content_1, content_2)); ++ } ++ } ++ ++ else if(dbg_num == 3) { ++ if (content_0 == 1) ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( DOWN )) total=((%d)), total>>1=((%d)), R4+R3+R2 = ((%d)), RateDownHold = ((%d))\n", content_1, content_2, content_3, content_4)); ++ else if (content_0 == 2) ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( UP )) total_acc=((%d)), total_acc>>1=((%d)), R4+R3+R2 = ((%d)), RateDownHold = ((%d))\n", content_1, content_2, content_3, content_4)); ++ else if (content_0 == 3) ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( UP )) ((Rate Down Hold)) RA_CNT=((%d))\n", content_1)); ++ else if (content_0 == 4) ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( UP )) ((tota_accl<5 skip)) RA_CNT=((%d))\n", content_1)); ++ else if (content_0 == 8) ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( Reset Tx Rpt )) RA_CNT=((%d))\n", content_1)); ++ } ++ ++ else if (dbg_num == 4) { ++ if (content_0 == 3) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RER_CNT PCR_ori =(( %d )), ratio_ori =(( %d )), pcr_updown_bitmap =(( 0x%x )), pcr_var_diff =(( %d ))\n", content_1, content_2, content_3, content_4)); ++ /**/ ++ } else if (content_0 == 4) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] pcr_shift_value =(( %s%d )), rate_down_threshold =(( %d )), rate_up_threshold =(( %d ))\n", ((content_1) ? "+" : "-"), content_2, content_3, content_4)); ++ /**/ ++ } else if (content_0 == 5) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] pcr_mean =(( %d )), PCR_VAR =(( %d )), offset =(( %d )), decision_offset_p =(( %d ))\n", content_1, content_2, content_3, content_4)); ++ /**/ ++ } ++ } ++ ++ else if(dbg_num == 5) { ++ if(content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] (( UP)) Nsc=(( %d )), N_High=(( %d )), RateUp_Waiting=(( %d )), RateUp_Fail=(( %d ))\n", content_1, content_2, content_3, content_4)); ++ } else if(content_0 == 2) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((DOWN)) Nsc=(( %d )), N_Low=(( %d ))\n", content_1, content_2)); ++ } else if(content_0 == 3) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((HOLD)) Nsc=((%d)), N_High=((%d)), N_Low=((%d)), Reset_CNT=((%d))\n", content_1, content_2, content_3, content_4)); ++ } ++ } ++ else if(dbg_num == 0x60) { ++ if(content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((AP RPT)) macid=((%d)), BUPDATE[macid]=((%d))\n", content_1, content_2)); ++ } else if(content_0 == 4) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((AP RPT)) pass=((%d)), rty_num=((%d)), drop=((%d)), total=((%d))\n", content_1, content_2, content_3, content_4)); ++ } else if(content_0 == 5) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((AP RPT)) PASS=((%d)), RTY_NUM=((%d)), DROP=((%d)), TOTAL=((%d))\n", content_1, content_2, content_3, content_4)); ++ } ++ } ++ } ++ /*--------------------------------------------*/ ++ else if (function == INIT_RA_TABLE){ ++ if(dbg_num == 3) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][INIT_RA_INFO] Ra_init, RA_SKIP_CNT = (( %d ))\n", content_0)); ++ } ++ ++ } ++ /*--------------------------------------------*/ ++ else if (function == RATE_UP) { ++ if(dbg_num == 2) { ++ if(content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateUp] ((Highest rate -> return)), macid=((%d)) Nsc=((%d))\n", content_1, content_2)); ++ } ++ } else if(dbg_num == 5) { ++ if (content_0 == 0) ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateUp] ((Rate UP)), up_rate_tmp=((0x%x)), rate_idx=((0x%x)), SGI_en=((%d)), SGI=((%d))\n", content_1, content_2, content_3, content_4)); ++ else if (content_0 == 1) ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateUp] ((Rate UP)), rate_1=((0x%x)), rate_2=((0x%x)), BW=((%d)), Try_Bit=((%d))\n", content_1, content_2, content_3, content_4)); ++ } ++ ++ } ++ /*--------------------------------------------*/ ++ else if (function == RATE_DOWN) { ++ if(dbg_num == 5) { ++ if(content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateDownStep] ((Rate Down)), macid=((%d)), rate1=((0x%x)), rate2=((0x%x)), BW=((%d))\n", content_1, content_2, content_3, content_4)); ++ } ++ } ++ } else if (function == TRY_DONE) { ++ if (dbg_num == 1) { ++ if (content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][Try Done] ((try succsess )) macid=((%d)), Try_Done_cnt=((%d))\n", content_1, content_2)); ++ /**/ ++ } ++ } else if (dbg_num == 2) { ++ if (content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][Try Done] ((try)) macid=((%d)), Try_Done_cnt=((%d)), rate_2=((%d)), try_succes=((%d))\n", content_1, content_2, content_3, content_4)); ++ /**/ ++ } ++ } ++ } ++ /*--------------------------------------------*/ ++ else if (function == RA_H2C) { ++ if (dbg_num == 1) { ++ if (content_0 == 0) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][H2C=0x49] fw_trace_en=((%d)), mode =((%d)), macid=((%d))\n", content_1, content_2, content_3)); ++ /**/ ++ /*C2H_RA_Dbg_code(F_RA_H2C,1,0, SysMib.ODM.DEBUG.fw_trace_en, mode, macid , 0); //RA MASK*/ ++ } ++ #if 0 ++ else if (dbg_num == 2) { ++ ++ if (content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][H2C=0x40] MACID=((%d)), Rate ID=((%d)), SGI=((%d)), BW=((%d))\n", content_1, content_2, content_3, content_4)); ++ /**/ ++ } else if (content_0 == 2) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][H2C=0x40] VHT_en=((%d)), Disable_PowerTraining=((%d)), Disable_RA=((%d)), No_Update=((%d))\n", content_1, content_2, content_3, content_4)); ++ /**/ ++ } else if (content_0 == 3) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][H2C=0x40] RA_MSK=[%x | %x | %x | %x ]\n", content_1, content_2, content_3, content_4)); ++ /**/ ++ } ++ } ++ #endif ++ } ++ } ++ /*--------------------------------------------*/ ++ else if (function == F_RATE_AP_RPT) { ++ if(dbg_num == 1) { ++ if(content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] ((1)), SPE_STATIS=((0x%x))---------->\n", content_3)); ++ } ++ } else if(dbg_num == 2) { ++ if(content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] RTY_all=((%d))\n", content_1)); ++ } ++ } else if(dbg_num == 3) { ++ if(content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID1[%d], TOTAL=((%d)), RTY=((%d))\n", content_3, content_1, content_2)); ++ } ++ } else if(dbg_num == 4) { ++ if(content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID2[%d], TOTAL=((%d)), RTY=((%d))\n", content_3, content_1, content_2)); ++ } ++ } else if(dbg_num == 5) { ++ if(content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID1[%d], PASS=((%d)), DROP=((%d))\n", content_3, content_1, content_2)); ++ } ++ } else if(dbg_num == 6) { ++ if(content_0 == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID2[%d],, PASS=((%d)), DROP=((%d))\n", content_3, content_1, content_2)); ++ } ++ } ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][general][%d, %d, %d] = {%d, %d, %d, %d}\n", function, dbg_num, content_0, content_1, content_2, content_3, content_4)); ++ /**/ ++ } ++#else ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][general][%d, %d, %d] = {%d, %d, %d, %d}\n", function, dbg_num, content_0, content_1, content_2, content_3, content_4)); ++#endif ++ /*--------------------------------------------*/ ++ ++ ++} ++ ++VOID ++phydm_fw_trace_handler_8051( ++ IN PVOID pDM_VOID, ++ IN pu1Byte Buffer, ++ IN u1Byte CmdLen ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if 0 ++ if (CmdLen >= 3) ++ CmdBuf[CmdLen - 1] = '\0'; ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s\n", &(CmdBuf[3]))); ++#else ++ ++ int i = 0; ++ u1Byte Extend_c2hSubID = 0, Extend_c2hDbgLen = 0, Extend_c2hDbgSeq = 0; ++ u1Byte fw_debug_trace[128]; ++ pu1Byte Extend_c2hDbgContent = 0; ++ ++ if (CmdLen > 127) ++ return; ++ ++ Extend_c2hSubID = Buffer[0]; ++ Extend_c2hDbgLen = Buffer[1]; ++ Extend_c2hDbgContent = Buffer + 2; /*DbgSeq+DbgContent for show HEX*/ ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ RT_DISP(FC2H, C2H_Summary, ("[Extend C2H packet], Extend_c2hSubId=0x%x, Extend_c2hDbgLen=%d\n", ++ Extend_c2hSubID, Extend_c2hDbgLen)); ++ ++ RT_DISP_DATA(FC2H, C2H_Summary, "[Extend C2H packet], Content Hex:", Extend_c2hDbgContent, CmdLen-2); ++ #endif ++ ++GoBackforAggreDbgPkt: ++ i = 0; ++ Extend_c2hDbgSeq = Buffer[2]; ++ Extend_c2hDbgContent = Buffer + 3; ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ RT_DISP(FC2H, C2H_Summary, ("[RTKFW, SEQ= %d] :", Extend_c2hDbgSeq)); ++ #endif ++ ++ for (; ; i++) { ++ fw_debug_trace[i] = Extend_c2hDbgContent[i]; ++ if (Extend_c2hDbgContent[i + 1] == '\0') { ++ fw_debug_trace[i + 1] = '\0'; ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s", &(fw_debug_trace[0]))); ++ break; ++ } else if (Extend_c2hDbgContent[i] == '\n') { ++ fw_debug_trace[i + 1] = '\0'; ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s", &(fw_debug_trace[0]))); ++ Buffer = Extend_c2hDbgContent + i + 3; ++ goto GoBackforAggreDbgPkt; ++ } ++ } ++ ++ ++#endif ++} ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_debug.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_debug.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_debug.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_debug.h 2018-02-11 21:44:27.155146208 +0200 +@@ -0,0 +1,357 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ ++#ifndef __ODM_DBG_H__ ++#define __ODM_DBG_H__ ++ ++/*#define DEBUG_VERSION "1.1"*/ /*2015.07.29 YuChen*/ ++/*#define DEBUG_VERSION "1.2"*/ /*2015.08.28 Dino*/ ++#define DEBUG_VERSION "1.3" /*2016.04.28 YuChen*/ ++//----------------------------------------------------------------------------- ++// Define the debug levels ++// ++// 1. DBG_TRACE and DBG_LOUD are used for normal cases. ++// So that, they can help SW engineer to develope or trace states changed ++// and also help HW enginner to trace every operation to and from HW, ++// e.g IO, Tx, Rx. ++// ++// 2. DBG_WARNNING and DBG_SERIOUS are used for unusual or error cases, ++// which help us to debug SW or HW. ++// ++//----------------------------------------------------------------------------- ++// ++// Never used in a call to ODM_RT_TRACE()! ++// ++#define ODM_DBG_OFF 1 ++ ++// ++// Fatal bug. ++// For example, Tx/Rx/IO locked up, OS hangs, memory access violation, ++// resource allocation failed, unexpected HW behavior, HW BUG and so on. ++// ++#define ODM_DBG_SERIOUS 2 ++ ++// ++// Abnormal, rare, or unexpeted cases. ++// For example, IRP/Packet/OID canceled, device suprisely unremoved and so on. ++// ++#define ODM_DBG_WARNING 3 ++ ++// ++// Normal case with useful information about current SW or HW state. ++// For example, Tx/Rx descriptor to fill, Tx/Rx descriptor completed status, ++// SW protocol state change, dynamic mechanism state change and so on. ++// ++#define ODM_DBG_LOUD 4 ++ ++// ++// Normal case with detail execution flow or information. ++// ++#define ODM_DBG_TRACE 5 ++ ++/*FW DBG MSG*/ ++#define RATE_DECISION BIT0 ++#define INIT_RA_TABLE BIT1 ++#define RATE_UP BIT2 ++#define RATE_DOWN BIT3 ++#define TRY_DONE BIT4 ++#define RA_H2C BIT5 ++#define F_RATE_AP_RPT BIT7 ++ ++//----------------------------------------------------------------------------- ++// Define the tracing components ++// ++//----------------------------------------------------------------------------- ++/*BB FW Functions*/ ++#define PHYDM_FW_COMP_RA BIT0 ++#define PHYDM_FW_COMP_MU BIT1 ++#define PHYDM_FW_COMP_PATH_DIV BIT2 ++#define PHYDM_FW_COMP_PHY_CONFIG BIT3 ++ ++ ++/*BB Driver Functions*/ ++#define ODM_COMP_DIG BIT0 ++#define ODM_COMP_RA_MASK BIT1 ++#define ODM_COMP_DYNAMIC_TXPWR BIT2 ++#define ODM_COMP_FA_CNT BIT3 ++#define ODM_COMP_RSSI_MONITOR BIT4 ++#define ODM_COMP_SNIFFER BIT5 ++#define ODM_COMP_ANT_DIV BIT6 ++#define ODM_COMP_DFS BIT7 ++#define ODM_COMP_NOISY_DETECT BIT8 ++#define ODM_COMP_RATE_ADAPTIVE BIT9 ++#define ODM_COMP_PATH_DIV BIT10 ++#define ODM_COMP_CCX BIT11 ++ ++#define ODM_COMP_DYNAMIC_PRICCA BIT12 ++ /*BIT13 TBD*/ ++#define ODM_COMP_MP BIT14 ++#define ODM_COMP_CFO_TRACKING BIT15 ++#define ODM_COMP_ACS BIT16 ++#define PHYDM_COMP_ADAPTIVITY BIT17 ++#define PHYDM_COMP_RA_DBG BIT18 ++#define PHYDM_COMP_TXBF BIT19 ++//MAC Functions ++#define ODM_COMP_EDCA_TURBO BIT20 ++ /*BIT21 TBD*/ ++#define ODM_FW_DEBUG_TRACE BIT22 ++//RF Functions ++ /*BIT23 TBD*/ ++#define ODM_COMP_TX_PWR_TRACK BIT24 ++ /*BIT25 TBD*/ ++#define ODM_COMP_CALIBRATION BIT26 ++//Common Functions ++ /*BIT27 TBD*/ ++#define ODM_PHY_CONFIG BIT28 ++#define ODM_COMP_INIT BIT29 ++#define ODM_COMP_COMMON BIT30 ++#define ODM_COMP_API BIT31 ++ ++ ++/*------------------------Export Marco Definition---------------------------*/ ++ ++#define config_phydm_read_txagc_check(data) (data != INVALID_TXAGC_DATA) ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #define RT_PRINTK DbgPrint ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #define DbgPrint printk ++ #define RT_PRINTK(fmt, args...) DbgPrint( "%s(): " fmt, __FUNCTION__, ## args); ++ #define RT_DISP(dbgtype, dbgflag, printstr) ++#else ++ #define DbgPrint panic_printk ++ #define RT_PRINTK(fmt, args...) DbgPrint( "%s(): " fmt, __FUNCTION__, ## args); ++#endif ++ ++#ifndef ASSERT ++ #define ASSERT(expr) ++#endif ++ ++#if DBG ++#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt) \ ++ do { \ ++ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel || level == ODM_DBG_SERIOUS)) \ ++ { \ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) \ ++ DbgPrint("[PhyDM-8188E] "); \ ++ else if(pDM_Odm->SupportICType == ODM_RTL8192E) \ ++ DbgPrint("[PhyDM-8192E] "); \ ++ else if(pDM_Odm->SupportICType == ODM_RTL8812) \ ++ DbgPrint("[PhyDM-8812A] "); \ ++ else if(pDM_Odm->SupportICType == ODM_RTL8821) \ ++ DbgPrint("[PhyDM-8821A] "); \ ++ else if(pDM_Odm->SupportICType == ODM_RTL8814A) \ ++ DbgPrint("[PhyDM-8814A] "); \ ++ else if(pDM_Odm->SupportICType == ODM_RTL8703B) \ ++ DbgPrint("[PhyDM-8703B] "); \ ++ else if(pDM_Odm->SupportICType == ODM_RTL8822B) \ ++ DbgPrint("[PhyDM-8822B] "); \ ++ else if (pDM_Odm->SupportICType == ODM_RTL8188F) \ ++ DbgPrint("[PhyDM-8188F] "); \ ++ RT_PRINTK fmt; \ ++ } \ ++ } while (0) ++ ++#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt) \ ++ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel)) \ ++ { \ ++ RT_PRINTK fmt; \ ++ } ++ ++#define ODM_RT_ASSERT(pDM_Odm, expr, fmt) \ ++ if(!(expr)) { \ ++ DbgPrint( "Assertion failed! %s at ......\n", #expr); \ ++ DbgPrint( " ......%s,%s,line=%d\n",__FILE__,__FUNCTION__,__LINE__); \ ++ RT_PRINTK fmt; \ ++ ASSERT(FALSE); \ ++ } ++#define ODM_dbg_enter() { DbgPrint("==> %s\n", __FUNCTION__); } ++#define ODM_dbg_exit() { DbgPrint("<== %s\n", __FUNCTION__); } ++#define ODM_dbg_trace(str) { DbgPrint("%s:%s\n", __FUNCTION__, str); } ++ ++#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr) \ ++ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel)) \ ++ { \ ++ int __i; \ ++ pu1Byte __ptr = (pu1Byte)ptr; \ ++ DbgPrint("[ODM] "); \ ++ DbgPrint(title_str); \ ++ DbgPrint(" "); \ ++ for( __i=0; __i<6; __i++ ) \ ++ DbgPrint("%02X%s", __ptr[__i], (__i==5)?"":"-"); \ ++ DbgPrint("\n"); \ ++ } ++#else ++#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt) ++#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt) ++#define ODM_RT_ASSERT(pDM_Odm, expr, fmt) ++#define ODM_dbg_enter() ++#define ODM_dbg_exit() ++#define ODM_dbg_trace(str) ++#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr) ++#endif ++ ++ ++VOID ++PHYDM_InitDebugSetting(IN PDM_ODM_T pDM_Odm); ++ ++VOID phydm_BasicDbgMessage( IN PVOID pDM_VOID); ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++#define PHYDM_DBGPRINT 0 ++#define PHYDM_SSCANF(x, y, z) DCMD_Scanf(x, y, z) ++#define PHYDM_VAST_INFO_SNPRINTF PHYDM_SNPRINTF ++#if (PHYDM_DBGPRINT == 1) ++#define PHYDM_SNPRINTF(msg) \ ++ do {\ ++ rsprintf msg;\ ++ DbgPrint(output);\ ++ } while (0) ++#else ++#define PHYDM_SNPRINTF(msg) \ ++ do {\ ++ rsprintf msg;\ ++ DCMD_Printf(output);\ ++ } while (0) ++#endif ++#else ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) || defined(__OSK__) ++#define PHYDM_DBGPRINT 0 ++#else ++#define PHYDM_DBGPRINT 1 ++#endif ++#define MAX_ARGC 20 ++#define MAX_ARGV 16 ++#define DCMD_DECIMAL "%d" ++#define DCMD_CHAR "%c" ++#define DCMD_HEX "%x" ++ ++#define PHYDM_SSCANF(x, y, z) sscanf(x, y, z) ++ ++#define PHYDM_VAST_INFO_SNPRINTF(msg)\ ++ do {\ ++ snprintf msg;\ ++ DbgPrint(output);\ ++ } while (0) ++ ++#if (PHYDM_DBGPRINT == 1) ++#define PHYDM_SNPRINTF(msg)\ ++ do {\ ++ snprintf msg;\ ++ DbgPrint(output);\ ++ } while (0) ++#else ++#define PHYDM_SNPRINTF(msg)\ ++ do {\ ++ if(out_len > used)\ ++ used+=snprintf msg;\ ++ } while (0) ++#endif ++#endif ++ ++ ++VOID phydm_BasicProfile( ++ IN PVOID pDM_VOID, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ); ++#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) ++s4Byte ++phydm_cmd( ++ IN PDM_ODM_T pDM_Odm, ++ IN char *input, ++ IN u4Byte in_len, ++ IN u1Byte flag, ++ OUT char *output, ++ IN u4Byte out_len ++); ++#endif ++VOID ++phydm_cmd_parser( ++ IN PDM_ODM_T pDM_Odm, ++ IN char input[][16], ++ IN u4Byte input_num, ++ IN u1Byte flag, ++ OUT char *output, ++ IN u4Byte out_len ++); ++ ++VOID ++phydm_la_mode_bb_setting( ++ IN PVOID pDM_VOID, ++ IN u4Byte DbgPort, ++ IN BOOLEAN bTriggerEdge, ++ IN u1Byte sampling_rate ++); ++ ++u1Byte ++phydm_la_mode_mac_setting( ++ IN PVOID pDM_VOID, ++ IN u4Byte TriggerTime_mu_sec ++); ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++void phydm_sbd_check( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++void phydm_sbd_callback( ++ PRT_TIMER pTimer ++ ); ++ ++void phydm_sbd_workitem_callback( ++ IN PVOID pContext ++ ); ++#endif ++ ++VOID ++phydm_fw_trace_en_h2c( ++ IN PVOID pDM_VOID, ++ IN BOOLEAN enable, ++ IN u4Byte fw_debug_component, ++ IN u4Byte monitor_mode, ++ IN u4Byte macid ++); ++ ++VOID ++phydm_fw_trace_handler( ++ IN PVOID pDM_VOID, ++ IN pu1Byte CmdBuf, ++ IN u1Byte CmdLen ++); ++ ++VOID ++phydm_fw_trace_handler_code( ++ IN PVOID pDM_VOID, ++ IN pu1Byte Buffer, ++ IN u1Byte CmdLen ++); ++ ++VOID ++phydm_fw_trace_handler_8051( ++ IN PVOID pDM_VOID, ++ IN pu1Byte CmdBuf, ++ IN u1Byte CmdLen ++); ++ ++#endif // __ODM_DBG_H__ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dfs.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dfs.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dfs.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dfs.c 2018-02-11 21:44:27.155146208 +0200 +@@ -0,0 +1,258 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++/* ++============================================================ ++ include files ++============================================================ ++*/ ++ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++#if defined(CONFIG_PHYDM_DFS_MASTER) ++VOID phydm_radar_detect_reset(PVOID pDM_VOID) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 0); ++ ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 1); ++} ++ ++VOID phydm_radar_detect_disable(PVOID pDM_VOID) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 0); ++} ++ ++static VOID phydm_radar_detect_with_dbg_parm(PVOID pDM_VOID) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, pDM_Odm->radar_detect_reg_918); ++ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, pDM_Odm->radar_detect_reg_91c); ++ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, pDM_Odm->radar_detect_reg_920); ++ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, pDM_Odm->radar_detect_reg_924); ++} ++ ++/* Init radar detection parameters, called after ch, bw is set */ ++VOID phydm_radar_detect_enable(PVOID pDM_VOID) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte region_domain = pDM_Odm->DFS_RegionDomain; ++ u1Byte c_channel = *(pDM_Odm->pChannel); ++ ++ if (region_domain == PHYDM_DFS_DOMAIN_UNKNOWN) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("PHYDM_DFS_DOMAIN_UNKNOWN\n")); ++ return; ++ } ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8812 | ODM_RTL8881A)) { ++ ++ ODM_SetBBReg(pDM_Odm, 0x814, 0x3fffffff, 0x04cc4d10); ++ ODM_SetBBReg(pDM_Odm, 0x834, bMaskByte0, 0x06); ++ ++ if (pDM_Odm->radar_detect_dbg_parm_en) { ++ phydm_radar_detect_with_dbg_parm(pDM_Odm); ++ goto exit; ++ } ++ ++ if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { ++ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c17ecdf); ++ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x01528500); ++ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0fa21a20); ++ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0f69204); ++ ++ } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { ++ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x01528500); ++ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0d67234); ++ ++ if (c_channel >= 52 && c_channel <= 64) { ++ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16ecdf); ++ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0f141a20); ++ } else { ++ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16acdf); ++ if (pDM_Odm->pBandWidth == ODM_BW20M) ++ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x64721a20); ++ else ++ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x68721a20); ++ } ++ ++ } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { ++ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16acdf); ++ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x01528500); ++ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0d67231); ++ if (pDM_Odm->pBandWidth == ODM_BW20M) ++ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x64741a20); ++ else ++ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x68741a20); ++ } else { ++ /* not supported */ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("Unsupported DFS_RegionDomain:%d\n", region_domain)); ++ } ++ ++ } else if (pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B)) { ++ ++ ODM_SetBBReg(pDM_Odm, 0x814, 0x3fffffff, 0x04cc4d10); ++ ODM_SetBBReg(pDM_Odm, 0x834, bMaskByte0, 0x06); ++ ++ /* 8822B only, when BW = 20M, DFIR output is 40Mhz, but DFS input is 80MMHz, so it need to upgrade to 80MHz */ ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) { ++ if (pDM_Odm->pBandWidth == ODM_BW20M) ++ ODM_SetBBReg(pDM_Odm, 0x1984, BIT26, 1); ++ else ++ ODM_SetBBReg(pDM_Odm, 0x1984, BIT26, 0); ++ } ++ ++ if (pDM_Odm->radar_detect_dbg_parm_en) { ++ phydm_radar_detect_with_dbg_parm(pDM_Odm); ++ goto exit; ++ } ++ ++ if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { ++ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16acdf); ++ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x095a8500); ++ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0fa21a20); ++ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0f57204); ++ ++ } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { ++ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x095a8500); ++ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0d67234); ++ ++ if (c_channel >= 52 && c_channel <= 64) { ++ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16ecdf); ++ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0f141a20); ++ } else { ++ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c166cdf); ++ if (pDM_Odm->pBandWidth == ODM_BW20M) ++ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x64721a20); ++ else ++ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x68721a20); ++ } ++ } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { ++ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c166cdf); ++ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x095a8500); ++ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0d67231); ++ if (pDM_Odm->pBandWidth == ODM_BW20M) ++ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x64741a20); ++ else ++ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x68741a20); ++ } else { ++ /* not supported */ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("Unsupported DFS_RegionDomain:%d\n", region_domain)); ++ } ++ } else { ++ /* not supported IC type*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("Unsupported IC Type:%d\n", pDM_Odm->SupportICType)); ++ } ++ ++exit: ++ phydm_radar_detect_reset(pDM_Odm); ++} ++ ++BOOLEAN phydm_radar_detect(PVOID pDM_VOID) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ BOOLEAN enable_DFS = FALSE; ++ BOOLEAN radar_detected = FALSE; ++ u1Byte region_domain = pDM_Odm->DFS_RegionDomain; ++ ++ if (region_domain == PHYDM_DFS_DOMAIN_UNKNOWN) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("PHYDM_DFS_DOMAIN_UNKNOWN\n")); ++ return FALSE; ++ } ++ ++ if (ODM_GetBBReg(pDM_Odm , 0x924, BIT15)) ++ enable_DFS = TRUE; ++ ++ if ((ODM_GetBBReg(pDM_Odm , 0xf98, BIT17)) ++ || (!(region_domain == PHYDM_DFS_DOMAIN_ETSI) && (ODM_GetBBReg(pDM_Odm , 0xf98, BIT19)))) ++ radar_detected = TRUE; ++ ++ if (enable_DFS && radar_detected) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD ++ , ("Radar detect: enable_DFS:%d, radar_detected:%d\n" ++ , enable_DFS, radar_detected)); ++ ++ phydm_radar_detect_reset(pDM_Odm); ++ } ++ ++exit: ++ return (enable_DFS && radar_detected); ++} ++#endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ ++ ++BOOLEAN ++phydm_dfs_master_enabled( ++ IN PVOID pDM_VOID ++ ) ++{ ++#ifdef CONFIG_PHYDM_DFS_MASTER ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ return *pDM_Odm->dfs_master_enabled ? TRUE : FALSE; ++#else ++ return FALSE; ++#endif ++} ++ ++VOID ++phydm_dfs_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const argv, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ switch (argv[0]) { ++ case 1: ++ #if defined(CONFIG_PHYDM_DFS_MASTER) ++ /* set dbg parameters for radar detection instead of the default value */ ++ if (argv[1] == 1) { ++ pDM_Odm->radar_detect_reg_918 = argv[2]; ++ pDM_Odm->radar_detect_reg_91c = argv[3]; ++ pDM_Odm->radar_detect_reg_920 = argv[4]; ++ pDM_Odm->radar_detect_reg_924 = argv[5]; ++ pDM_Odm->radar_detect_dbg_parm_en = 1; ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "Radar detection with dbg parameter\n")); ++ PHYDM_SNPRINTF((output+used, out_len-used, "reg918:0x%08X\n", pDM_Odm->radar_detect_reg_918)); ++ PHYDM_SNPRINTF((output+used, out_len-used, "reg91c:0x%08X\n", pDM_Odm->radar_detect_reg_91c)); ++ PHYDM_SNPRINTF((output+used, out_len-used, "reg920:0x%08X\n", pDM_Odm->radar_detect_reg_920)); ++ PHYDM_SNPRINTF((output+used, out_len-used, "reg924:0x%08X\n", pDM_Odm->radar_detect_reg_924)); ++ } else { ++ pDM_Odm->radar_detect_dbg_parm_en = 0; ++ PHYDM_SNPRINTF((output+used, out_len-used, "Radar detection with default parameter\n")); ++ } ++ phydm_radar_detect_enable(pDM_Odm); ++ #endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ ++ ++ break; ++ default: ++ break; ++ } ++} ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dfs.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dfs.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dfs.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dfs.h 2018-02-11 21:44:27.155146208 +0200 +@@ -0,0 +1,76 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDM_DFS_H__ ++#define __PHYDM_DFS_H__ ++ ++#define DFS_VERSION "0.0" ++ ++/* ============================================================ ++ Definition ++ ============================================================ ++*/ ++ ++/* ++============================================================ ++1 structure ++ ============================================================ ++*/ ++ ++/* ============================================================ ++ enumeration ++ ============================================================ ++*/ ++ ++typedef enum _tag_PhyDM_DFS_REGION_DOMAIN { ++ PHYDM_DFS_DOMAIN_UNKNOWN = 0, ++ PHYDM_DFS_DOMAIN_FCC = 1, ++ PHYDM_DFS_DOMAIN_MKK = 2, ++ PHYDM_DFS_DOMAIN_ETSI = 3, ++} PHYDM_DFS_REGION_DOMAIN; ++ ++/* ++============================================================ ++ function prototype ++============================================================ ++*/ ++#if defined(CONFIG_PHYDM_DFS_MASTER) ++VOID phydm_radar_detect_reset(PVOID pDM_VOID); ++VOID phydm_radar_detect_disable(PVOID pDM_VOID); ++VOID phydm_radar_detect_enable(PVOID pDM_VOID); ++BOOLEAN phydm_radar_detect(PVOID pDM_VOID); ++#endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ ++ ++BOOLEAN ++phydm_dfs_master_enabled( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++phydm_dfs_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const argv, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ); ++ ++#endif /*#ifndef __PHYDM_DFS_H__ */ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dig.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dig.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dig.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dig.c 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,2285 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++ ++VOID ++ODM_ChangeDynamicInitGainThresh( ++ IN PVOID pDM_VOID, ++ IN u4Byte DM_Type, ++ IN u4Byte DM_Value ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++ if (DM_Type == DIG_TYPE_THRESH_HIGH) ++ { ++ pDM_DigTable->RssiHighThresh = DM_Value; ++ } ++ else if (DM_Type == DIG_TYPE_THRESH_LOW) ++ { ++ pDM_DigTable->RssiLowThresh = DM_Value; ++ } ++ else if (DM_Type == DIG_TYPE_ENABLE) ++ { ++ pDM_DigTable->Dig_Enable_Flag = TRUE; ++ } ++ else if (DM_Type == DIG_TYPE_DISABLE) ++ { ++ pDM_DigTable->Dig_Enable_Flag = FALSE; ++ } ++ else if (DM_Type == DIG_TYPE_BACKOFF) ++ { ++ if(DM_Value > 30) ++ DM_Value = 30; ++ pDM_DigTable->BackoffVal = (u1Byte)DM_Value; ++ } ++ else if(DM_Type == DIG_TYPE_RX_GAIN_MIN) ++ { ++ if(DM_Value == 0) ++ DM_Value = 0x1; ++ pDM_DigTable->rx_gain_range_min = (u1Byte)DM_Value; ++ } ++ else if(DM_Type == DIG_TYPE_RX_GAIN_MAX) ++ { ++ if(DM_Value > 0x50) ++ DM_Value = 0x50; ++ pDM_DigTable->rx_gain_range_max = (u1Byte)DM_Value; ++ } ++} // DM_ChangeDynamicInitGainThresh // ++ ++int ++getIGIForDiff(int value_IGI) ++{ ++ #define ONERCCA_LOW_TH 0x30 ++ #define ONERCCA_LOW_DIFF 8 ++ ++ if (value_IGI < ONERCCA_LOW_TH) { ++ if ((ONERCCA_LOW_TH - value_IGI) < ONERCCA_LOW_DIFF) ++ return ONERCCA_LOW_TH; ++ else ++ return value_IGI + ONERCCA_LOW_DIFF; ++ } else { ++ return value_IGI; ++ } ++} ++ ++VOID ++odm_FAThresholdCheck( ++ IN PVOID pDM_VOID, ++ IN BOOLEAN bDFSBand, ++ IN BOOLEAN bPerformance, ++ IN u4Byte RxTp, ++ IN u4Byte TxTp, ++ OUT u4Byte* dm_FA_thres ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if(pDM_Odm->bLinked && (bPerformance||bDFSBand)) ++ { ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ /*For AP*/ ++ if ((RxTp>>2) > TxTp && RxTp < 10000 && RxTp > 500) { /*10Mbps & 0.5Mbps*/ ++ dm_FA_thres[0] = 0x080; ++ dm_FA_thres[1] = 0x100; ++ dm_FA_thres[2] = 0x200; ++ } else { ++ dm_FA_thres[0] = 0x100; ++ dm_FA_thres[1] = 0x200; ++ dm_FA_thres[2] = 0x300; ++ } ++#else ++ /*For NIC*/ ++ dm_FA_thres[0] = DM_DIG_FA_TH0; ++ dm_FA_thres[1] = DM_DIG_FA_TH1; ++ dm_FA_thres[2] = DM_DIG_FA_TH2; ++#endif ++ } else { ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) ++ if(bDFSBand) ++ { ++ // For DFS band and no link ++ dm_FA_thres[0] = 250; ++ dm_FA_thres[1] = 1000; ++ dm_FA_thres[2] = 2000; ++ } ++ else ++#endif ++ { ++ dm_FA_thres[0] = 2000; ++ dm_FA_thres[1] = 4000; ++ dm_FA_thres[2] = 5000; ++ } ++ } ++ return; ++} ++ ++u1Byte ++odm_ForbiddenIGICheck( ++ IN PVOID pDM_VOID, ++ IN u1Byte DIG_Dynamic_MIN, ++ IN u1Byte CurrentIGI ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); ++ u1Byte rx_gain_range_min = pDM_DigTable->rx_gain_range_min; ++ ++ if (pDM_DigTable->LargeFA_Timeout) { ++ if (--pDM_DigTable->LargeFA_Timeout == 0) ++ pDM_DigTable->LargeFAHit = 0; ++ } ++ ++ if (pFalseAlmCnt->Cnt_all > 10000) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormally false alarm case.\n")); ++ ++ if(pDM_DigTable->LargeFAHit != 3) ++ pDM_DigTable->LargeFAHit++; ++ ++ if(pDM_DigTable->ForbiddenIGI < CurrentIGI)//if(pDM_DigTable->ForbiddenIGI < pDM_DigTable->CurIGValue) ++ { ++ pDM_DigTable->ForbiddenIGI = CurrentIGI;//pDM_DigTable->ForbiddenIGI = pDM_DigTable->CurIGValue; ++ pDM_DigTable->LargeFAHit = 1; ++ pDM_DigTable->LargeFA_Timeout = LARGE_FA_TIMEOUT; ++ } ++ ++ if(pDM_DigTable->LargeFAHit >= 3) ++ { ++ if((pDM_DigTable->ForbiddenIGI + 2) > pDM_DigTable->rx_gain_range_max) ++ rx_gain_range_min = pDM_DigTable->rx_gain_range_max; ++ else ++ rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 2); ++ pDM_DigTable->Recover_cnt = 1800; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormally false alarm case: Recover_cnt = %d\n", pDM_DigTable->Recover_cnt)); ++ } ++ } ++ ++ else if (pFalseAlmCnt->Cnt_all > 2000) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Abnormally false alarm case.\n")); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Cnt_all=%d, Cnt_all_pre=%d, CurrentIGI=0x%x, PreIGValue=0x%x\n", ++ pFalseAlmCnt->Cnt_all, pFalseAlmCnt->Cnt_all_pre, CurrentIGI, pDM_DigTable->PreIGValue)); ++ ++ /* pFalseAlmCnt->Cnt_all = 1.1875*pFalseAlmCnt->Cnt_all_pre */ ++ if ((pFalseAlmCnt->Cnt_all > (pFalseAlmCnt->Cnt_all_pre + (pFalseAlmCnt->Cnt_all_pre >> 3) + (pFalseAlmCnt->Cnt_all_pre >> 4))) && (CurrentIGI < pDM_DigTable->PreIGValue)) { ++ if (pDM_DigTable->LargeFAHit != 3) ++ pDM_DigTable->LargeFAHit++; ++ ++ if (pDM_DigTable->ForbiddenIGI < CurrentIGI) { /*if(pDM_DigTable->ForbiddenIGI < pDM_DigTable->CurIGValue)*/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Updating ForbiddenIGI by CurrentIGI, ForbiddenIGI=0x%x, CurrentIGI=0x%x\n", ++ pDM_DigTable->ForbiddenIGI, CurrentIGI)); ++ ++ pDM_DigTable->ForbiddenIGI = CurrentIGI; /*pDM_DigTable->ForbiddenIGI = pDM_DigTable->CurIGValue;*/ ++ pDM_DigTable->LargeFAHit = 1; ++ pDM_DigTable->LargeFA_Timeout = LARGE_FA_TIMEOUT; ++ } ++ ++ } ++ ++ if (pDM_DigTable->LargeFAHit >= 3) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("FaHit is greater than 3, rx_gain_range_max=0x%x, rx_gain_range_min=0x%x, ForbiddenIGI=0x%x\n", ++ pDM_DigTable->rx_gain_range_max, rx_gain_range_min, pDM_DigTable->ForbiddenIGI)); ++ ++ if ((pDM_DigTable->ForbiddenIGI + 1) > pDM_DigTable->rx_gain_range_max) ++ rx_gain_range_min = pDM_DigTable->rx_gain_range_max; ++ else ++ rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 1); ++ ++ pDM_DigTable->Recover_cnt = 1200; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Abnormally false alarm case: Recover_cnt = %d, rx_gain_range_min = 0x%x\n", pDM_DigTable->Recover_cnt, rx_gain_range_min)); ++ } ++ } ++ ++ else ++ { ++ if (pDM_DigTable->Recover_cnt != 0) { ++ ++ pDM_DigTable->Recover_cnt --; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: Recover_cnt = %d\n", pDM_DigTable->Recover_cnt)); ++ } ++ else ++ { ++ if(pDM_DigTable->LargeFAHit < 3) ++ { ++ if((pDM_DigTable->ForbiddenIGI - 2) < DIG_Dynamic_MIN) //DM_DIG_MIN) ++ { ++ pDM_DigTable->ForbiddenIGI = DIG_Dynamic_MIN; //DM_DIG_MIN; ++ rx_gain_range_min = DIG_Dynamic_MIN; //DM_DIG_MIN; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: At Lower Bound\n")); ++ } ++ else ++ { ++ if (pDM_DigTable->LargeFAHit == 0) { ++ pDM_DigTable->ForbiddenIGI -= 2; ++ rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 2); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: Approach Lower Bound\n")); ++ } ++ } ++ } ++ else ++ { ++ pDM_DigTable->LargeFAHit = 0; ++ } ++ } ++ } ++ ++ return rx_gain_range_min; ++ ++} ++ ++VOID ++odm_InbandNoiseCalculate ( ++ IN PVOID pDM_VOID ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ u1Byte IGIBackup, TimeCnt = 0, ValidCnt = 0; ++ BOOLEAN bTimeout = TRUE; ++ s1Byte sNoise_A, sNoise_B; ++ s4Byte NoiseRpt_A = 0,NoiseRpt_B = 0; ++ u4Byte tmp = 0; ++ static u1Byte failCnt = 0; ++ ++ if(!(pDM_Odm->SupportICType & (ODM_RTL8192E))) ++ return; ++ ++ if(pDM_Odm->RFType == ODM_1T1R || *(pDM_Odm->pOnePathCCA) != ODM_CCA_2R) ++ return; ++ ++ if(!pDM_DigTable->bNoiseEst) ++ return; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_InbandNoiseEstimate()========>\n")); ++ ++ //1 Set initial gain. ++ IGIBackup = pDM_DigTable->CurIGValue; ++ pDM_DigTable->IGIOffset_A = 0; ++ pDM_DigTable->IGIOffset_B = 0; ++ ODM_Write_DIG(pDM_Odm, 0x24); ++ ++ //1 Update idle time power report ++ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ ODM_SetBBReg(pDM_Odm, ODM_REG_TX_ANT_CTRL_11N, BIT25, 0x0); ++ ++ delay_ms(2); ++ ++ //1 Get noise power level ++ while(1) ++ { ++ //2 Read Noise Floor Report ++ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ tmp = ODM_GetBBReg(pDM_Odm, 0x8f8, bMaskLWord); ++ ++ sNoise_A = (s1Byte)(tmp & 0xff); ++ sNoise_B = (s1Byte)((tmp & 0xff00)>>8); ++ ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("sNoise_A = %d, sNoise_B = %d\n",sNoise_A, sNoise_B)); ++ ++ if((sNoise_A < 20 && sNoise_A >= -70) && (sNoise_B < 20 && sNoise_B >= -70)) ++ { ++ ValidCnt++; ++ NoiseRpt_A += sNoise_A; ++ NoiseRpt_B += sNoise_B; ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("sNoise_A = %d, sNoise_B = %d\n",sNoise_A, sNoise_B)); ++ } ++ ++ TimeCnt++; ++ bTimeout = (TimeCnt >= 150)?TRUE:FALSE; ++ ++ if(ValidCnt == 20 || bTimeout) ++ break; ++ ++ delay_ms(2); ++ ++ } ++ ++ //1 Keep idle time power report ++ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ ODM_SetBBReg(pDM_Odm, ODM_REG_TX_ANT_CTRL_11N, BIT25, 0x1); ++ ++ //1 Recover IGI ++ ODM_Write_DIG(pDM_Odm, IGIBackup); ++ ++ //1 Calculate Noise Floor ++ if(ValidCnt != 0) ++ { ++ NoiseRpt_A /= (ValidCnt<<1); ++ NoiseRpt_B /= (ValidCnt<<1); ++ } ++ ++ if(bTimeout) ++ { ++ NoiseRpt_A = 0; ++ NoiseRpt_B = 0; ++ ++ failCnt ++; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("Noise estimate fail time = %d\n", failCnt)); ++ ++ if(failCnt == 3) ++ { ++ failCnt = 0; ++ pDM_DigTable->bNoiseEst = FALSE; ++ } ++ } ++ else ++ { ++ NoiseRpt_A = -110 + 0x24 + NoiseRpt_A -6; ++ NoiseRpt_B = -110 + 0x24 + NoiseRpt_B -6; ++ pDM_DigTable->bNoiseEst = FALSE; ++ failCnt = 0; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("NoiseRpt_A = %d, NoiseRpt_B = %d\n", NoiseRpt_A, NoiseRpt_B)); ++ } ++ ++ //1 Calculate IGI Offset ++ if(NoiseRpt_A > NoiseRpt_B) ++ { ++ pDM_DigTable->IGIOffset_A = NoiseRpt_A - NoiseRpt_B; ++ pDM_DigTable->IGIOffset_B = 0; ++ } ++ else ++ { ++ pDM_DigTable->IGIOffset_A = 0; ++ pDM_DigTable->IGIOffset_B = NoiseRpt_B - NoiseRpt_A; ++ } ++ ++#endif ++ return; ++} ++ ++VOID ++odm_DigForBtHsMode( ++ IN PVOID pDM_VOID ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable=&pDM_Odm->DM_DigTable; ++ u1Byte digForBtHs=0; ++ u1Byte digUpBound=0x5a; ++ ++ if (pDM_Odm->bBtConnectProcess) { ++ digForBtHs = 0x22; ++ } else { ++ // ++ // Decide DIG value by BT HS RSSI. ++ // ++ digForBtHs = pDM_Odm->btHsRssi+4; ++ ++ //DIG Bound ++ if(digForBtHs > digUpBound) ++ digForBtHs = digUpBound; ++ if(digForBtHs < 0x1c) ++ digForBtHs = 0x1c; ++ ++ // update Current IGI ++ pDM_DigTable->BT30_CurIGI = digForBtHs; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DigForBtHsMode() : set DigValue=0x%x\n", digForBtHs)); ++#endif ++} ++ ++VOID ++phydm_setBigJumpStep( ++ IN PVOID pDM_VOID, ++ IN u1Byte CurrentIGI ++) ++{ ++#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ u1Byte step1[8] = {24, 30, 40, 50, 60, 70, 80, 90}; ++ u1Byte i; ++ ++ if (pDM_DigTable->enableAdjustBigJump == 0) ++ return; ++ ++ for (i = 0; i <= pDM_DigTable->bigJumpStep1; i++) { ++ if ((CurrentIGI + step1[i]) > pDM_DigTable->bigJumpLmt[pDM_DigTable->agcTableIdx]) { ++ if (i != 0) ++ i = i - 1; ++ break; ++ } else if (i == pDM_DigTable->bigJumpStep1) ++ break; ++ } ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ ODM_SetBBReg(pDM_Odm, 0x8c8, 0xe, i); ++ else if (pDM_Odm->SupportICType & ODM_RTL8197F) ++ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_AGC_SET_2_11N, 0xe, i); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_setBigJumpStep(): bigjump = %d (ori = 0x%d), LMT=0x%x\n", i, pDM_DigTable->bigJumpStep1, pDM_DigTable->bigJumpLmt[pDM_DigTable->agcTableIdx])); ++#endif ++} ++ ++VOID ++ODM_Write_DIG( ++ IN PVOID pDM_VOID, ++ IN u1Byte CurrentIGI ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++ if (pDM_DigTable->bStopDIG) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("ODM_Write_DIG(): Stop Writing IGI\n")); ++ return; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("ODM_Write_DIG(): ODM_REG(IGI_A,pDM_Odm)=0x%x, ODM_BIT(IGI,pDM_Odm)=0x%x\n", ++ ODM_REG(IGI_A,pDM_Odm),ODM_BIT(IGI,pDM_Odm))); ++ ++ //1 Check initial gain by upper bound ++ if ((!pDM_DigTable->bPSDInProgress) && pDM_Odm->bLinked) ++ { ++ if (CurrentIGI > pDM_DigTable->rx_gain_range_max) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("ODM_Write_DIG(): CurrentIGI(0x%02x) is larger than upper bound !!\n", CurrentIGI)); ++ CurrentIGI = pDM_DigTable->rx_gain_range_max; ++ } ++ if (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY && pDM_Odm->adaptivity_flag == TRUE) ++ { ++ if(CurrentIGI > pDM_Odm->Adaptivity_IGI_upper) ++ CurrentIGI = pDM_Odm->Adaptivity_IGI_upper; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("ODM_Write_DIG(): Adaptivity case: Force upper bound to 0x%x !!!!!!\n", CurrentIGI)); ++ } ++ } ++ ++ if(pDM_DigTable->CurIGValue != CurrentIGI) ++ { ++ ++#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) ++ /* Modify big jump step for 8822B and 8197F */ ++ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F)) ++ phydm_setBigJumpStep(pDM_Odm, CurrentIGI); ++#endif ++ ++#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) ++ /* Set IGI value of CCK for new CCK AGC */ ++ if (pDM_Odm->cck_new_agc) { ++ if (pDM_Odm->SupportICType & ODM_IC_PHY_STATUE_NEW_TYPE) ++ ODM_SetBBReg(pDM_Odm, 0xa0c, 0x00003f00, (CurrentIGI>>1)); ++ } ++#endif ++ ++ /*Add by YuChen for USB IO too slow issue*/ ++ if ((pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) && (CurrentIGI > pDM_DigTable->CurIGValue)) ++ Phydm_Adaptivity(pDM_Odm, CurrentIGI); ++ ++ //1 Set IGI value ++ if (pDM_Odm->SupportPlatform & (ODM_WIN|ODM_CE)) { ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ ++ if(pDM_Odm->RFType > ODM_1T1R) ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ ++#if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) { ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_C,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_D,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ } ++#endif ++ } else if (pDM_Odm->SupportPlatform & (ODM_AP)) { ++ switch(*(pDM_Odm->pOnePathCCA)) ++ { ++ case ODM_CCA_2R: ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ ++ if(pDM_Odm->RFType > ODM_1T1R) ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++#if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) { ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_C,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_D,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ } ++#endif ++ break; ++ case ODM_CCA_1R_A: ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ if(pDM_Odm->RFType != ODM_1T1R) ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), getIGIForDiff(CurrentIGI)); ++ break; ++ case ODM_CCA_1R_B: ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B, pDM_Odm), ODM_BIT(IGI, pDM_Odm), getIGIForDiff(CurrentIGI)); ++ if (pDM_Odm->RFType != ODM_1T1R) ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A, pDM_Odm), ODM_BIT(IGI, pDM_Odm), CurrentIGI); ++ break; ++ } ++ } ++ ++ pDM_DigTable->CurIGValue = CurrentIGI; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("ODM_Write_DIG(): CurrentIGI(0x%02x).\n", CurrentIGI)); ++ ++} ++ ++VOID ++odm_PauseDIG( ++ IN PVOID pDM_VOID, ++ IN PHYDM_PAUSE_TYPE PauseType, ++ IN PHYDM_PAUSE_LEVEL pause_level, ++ IN u1Byte IGIValue ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG()=========> level = %d\n", pause_level)); ++ ++ if ((pDM_DigTable->pause_dig_level == 0) && (!(pDM_Odm->SupportAbility & ODM_BB_DIG) || !(pDM_Odm->SupportAbility & ODM_BB_FA_CNT))) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ++ ("odm_PauseDIG(): Return: SupportAbility DIG or FA is disabled !!\n")); ++ return; ++ } ++ ++ if (pause_level > DM_DIG_MAX_PAUSE_TYPE) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ++ ("odm_PauseDIG(): Return: Wrong pause level !!\n")); ++ return; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_dig_level, IGIValue)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", ++ pDM_DigTable->pause_dig_value[7], pDM_DigTable->pause_dig_value[6], pDM_DigTable->pause_dig_value[5], pDM_DigTable->pause_dig_value[4], ++ pDM_DigTable->pause_dig_value[3], pDM_DigTable->pause_dig_value[2], pDM_DigTable->pause_dig_value[1], pDM_DigTable->pause_dig_value[0])); ++ ++ switch (PauseType) { ++ /* Pause DIG */ ++ case PHYDM_PAUSE: ++ { ++ /* Disable DIG */ ++ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility & (~ODM_BB_DIG)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Pause DIG !!\n")); ++ ++ /* Backup IGI value */ ++ if (pDM_DigTable->pause_dig_level == 0) { ++ pDM_DigTable->IGIBackup = pDM_DigTable->CurIGValue; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Backup IGI = 0x%x, new IGI = 0x%x\n", pDM_DigTable->IGIBackup, IGIValue)); ++ } ++ ++ /* Record IGI value */ ++ pDM_DigTable->pause_dig_value[pause_level] = IGIValue; ++ ++ /* Update pause level */ ++ pDM_DigTable->pause_dig_level = (pDM_DigTable->pause_dig_level | BIT(pause_level)); ++ ++ /* Write new IGI value */ ++ if (BIT(pause_level + 1) > pDM_DigTable->pause_dig_level) { ++ ODM_Write_DIG(pDM_Odm, IGIValue); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): IGI of higher level = 0x%x\n", IGIValue)); ++ } ++ break; ++ } ++ /* Resume DIG */ ++ case PHYDM_RESUME: ++ { ++ /* check if the level is illegal or not */ ++ if ((pDM_DigTable->pause_dig_level & (BIT(pause_level))) != 0) { ++ pDM_DigTable->pause_dig_level = pDM_DigTable->pause_dig_level & (~(BIT(pause_level))); ++ pDM_DigTable->pause_dig_value[pause_level] = 0; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Resume DIG !!\n")); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Wrong resume level !!\n")); ++ break; ++ } ++ ++ /* Resume DIG */ ++ if (pDM_DigTable->pause_dig_level == 0) { ++ /* Write backup IGI value */ ++ ODM_Write_DIG(pDM_Odm, pDM_DigTable->IGIBackup); ++ pDM_DigTable->bIgnoreDIG = TRUE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Write original IGI = 0x%x\n", pDM_DigTable->IGIBackup)); ++ ++ /* Enable DIG */ ++ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility | ODM_BB_DIG); ++ break; ++ } ++ ++ if (BIT(pause_level) > pDM_DigTable->pause_dig_level) { ++ s1Byte max_level; ++ ++ /* Calculate the maximum level now */ ++ for (max_level = (pause_level - 1); max_level >= 0; max_level--) { ++ if ((pDM_DigTable->pause_dig_level & BIT(max_level)) > 0) ++ break; ++ } ++ ++ /* write IGI of lower level */ ++ ODM_Write_DIG(pDM_Odm, pDM_DigTable->pause_dig_value[max_level]); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Write IGI (0x%x) of level (%d)\n", ++ pDM_DigTable->pause_dig_value[max_level], max_level)); ++ break; ++ } ++ break; ++ } ++ default: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Wrong type !!\n")); ++ break; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_dig_level, IGIValue)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", ++ pDM_DigTable->pause_dig_value[7], pDM_DigTable->pause_dig_value[6], pDM_DigTable->pause_dig_value[5], pDM_DigTable->pause_dig_value[4], ++ pDM_DigTable->pause_dig_value[3], pDM_DigTable->pause_dig_value[2], pDM_DigTable->pause_dig_value[1], pDM_DigTable->pause_dig_value[0])); ++ ++} ++ ++BOOLEAN ++odm_DigAbort( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++#endif ++ ++ //SupportAbility ++ if(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT)) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: SupportAbility ODM_BB_FA_CNT is disabled\n")); ++ return TRUE; ++ } ++ ++ //SupportAbility ++ if(!(pDM_Odm->SupportAbility & ODM_BB_DIG)) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: SupportAbility ODM_BB_DIG is disabled\n")); ++ return TRUE; ++ } ++ ++ //ScanInProcess ++ if(*(pDM_Odm->pbScanInProcess)) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: In Scan Progress \n")); ++ return TRUE; ++ } ++ ++ if(pDM_DigTable->bIgnoreDIG) ++ { ++ pDM_DigTable->bIgnoreDIG = FALSE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Ignore DIG \n")); ++ return TRUE; ++ } ++ ++ //add by Neil Chen to avoid PSD is processing ++ if(pDM_Odm->bDMInitialGainEnable == FALSE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: PSD is Processing \n")); ++ return TRUE; ++ } ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #if OS_WIN_FROM_WIN7(OS_VERSION) ++ if(IsAPModeExist( pAdapter) && pAdapter->bInHctTest) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Is AP mode or In HCT Test \n")); ++ return TRUE; ++ } ++ #endif ++ ++ if(pDM_Odm->bBtHsOperation) ++ { ++ odm_DigForBtHsMode(pDM_Odm); ++ } ++ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV ++ if((pDM_Odm->bLinked) && (pDM_Odm->Adapter->registrypriv.force_igi !=0)) ++ { ++ printk("pDM_Odm->RSSI_Min=%d \n",pDM_Odm->RSSI_Min); ++ ODM_Write_DIG(pDM_Odm,pDM_Odm->Adapter->registrypriv.force_igi); ++ return TRUE; ++ } ++ #endif ++#else ++ if (!(priv->up_time > 5)) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Not In DIG Operation Period \n")); ++ return TRUE; ++ } ++#endif ++ ++ return FALSE; ++} ++ ++VOID ++odm_DIGInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); ++#endif ++ u4Byte ret_value; ++ u1Byte i; ++ ++ pDM_DigTable->bStopDIG = FALSE; ++ pDM_DigTable->bIgnoreDIG = FALSE; ++ pDM_DigTable->bPSDInProgress = FALSE; ++ pDM_DigTable->CurIGValue = (u1Byte) ODM_GetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm)); ++ pDM_DigTable->PreIGValue = 0; ++ pDM_DigTable->RssiLowThresh = DM_DIG_THRESH_LOW; ++ pDM_DigTable->RssiHighThresh = DM_DIG_THRESH_HIGH; ++ pDM_DigTable->FALowThresh = DM_FALSEALARM_THRESH_LOW; ++ pDM_DigTable->FAHighThresh = DM_FALSEALARM_THRESH_HIGH; ++ pDM_DigTable->BackoffVal = DM_DIG_BACKOFF_DEFAULT; ++ pDM_DigTable->BackoffVal_range_max = DM_DIG_BACKOFF_MAX; ++ pDM_DigTable->BackoffVal_range_min = DM_DIG_BACKOFF_MIN; ++ pDM_DigTable->PreCCK_CCAThres = 0xFF; ++ pDM_DigTable->CurCCK_CCAThres = 0x83; ++ pDM_DigTable->ForbiddenIGI = DM_DIG_MIN_NIC; ++ pDM_DigTable->LargeFAHit = 0; ++ pDM_DigTable->LargeFA_Timeout = 0; ++ pDM_DigTable->Recover_cnt = 0; ++ pDM_DigTable->bMediaConnect_0 = FALSE; ++ pDM_DigTable->bMediaConnect_1 = FALSE; ++ ++ //To Initialize pDM_Odm->bDMInitialGainEnable == FALSE to avoid DIG error ++ pDM_Odm->bDMInitialGainEnable = TRUE; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ pDM_DigTable->DIG_Dynamic_MIN_0 = 0x25; ++ pDM_DigTable->DIG_Dynamic_MIN_1 = 0x25; ++ ++ // For AP\ ADSL modified DIG ++ pDM_DigTable->bTpTarget = FALSE; ++ pDM_DigTable->bNoiseEst = TRUE; ++ pDM_DigTable->IGIOffset_A = 0; ++ pDM_DigTable->IGIOffset_B = 0; ++ pDM_DigTable->TpTrainTH_min = 0; ++ ++ // For RTL8881A ++ FalseAlmCnt->Cnt_Ofdm_fail_pre = 0; ++ ++ //Dyanmic EDCCA ++ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ { ++ ODM_SetBBReg(pDM_Odm, 0xC50, 0xFFFF0000, 0xfafd); ++ } ++#else ++ pDM_DigTable->DIG_Dynamic_MIN_0 = DM_DIG_MIN_NIC; ++ pDM_DigTable->DIG_Dynamic_MIN_1 = DM_DIG_MIN_NIC; ++ ++ //To Initi BT30 IGI ++ pDM_DigTable->BT30_CurIGI=0x32; ++ ++ ODM_Memory_Set(pDM_Odm, pDM_DigTable->pause_dig_value, 0, (DM_DIG_MAX_PAUSE_TYPE + 1)); ++ pDM_DigTable->pause_dig_level = 0; ++ ODM_Memory_Set(pDM_Odm, pDM_DigTable->pause_cckpd_value, 0, (DM_DIG_MAX_PAUSE_TYPE + 1)); ++ pDM_DigTable->pause_cckpd_level = 0; ++#endif ++ ++ if(pDM_Odm->BoardType & (ODM_BOARD_EXT_PA|ODM_BOARD_EXT_LNA)) ++ { ++ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; ++ pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; ++ } ++ else ++ { ++ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; ++ pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; ++ } ++ ++#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) ++ pDM_DigTable->enableAdjustBigJump = 1; ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) { ++ ret_value = ODM_GetBBReg(pDM_Odm, 0x8c8, bMaskLWord); ++ pDM_DigTable->bigJumpStep1 = (u1Byte)(ret_value & 0xe) >> 1; ++ pDM_DigTable->bigJumpStep2 = (u1Byte)(ret_value & 0x30)>>4; ++ pDM_DigTable->bigJumpStep3 = (u1Byte)(ret_value & 0xc0)>>6; ++ ++ } else if (pDM_Odm->SupportICType & ODM_RTL8197F) { ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_BB_AGC_SET_2_11N, bMaskLWord); ++ pDM_DigTable->bigJumpStep1 = (u1Byte)(ret_value & 0xe) >> 1; ++ pDM_DigTable->bigJumpStep2 = (u1Byte)(ret_value & 0x30)>>4; ++ pDM_DigTable->bigJumpStep3 = (u1Byte)(ret_value & 0xc0)>>6; ++ } ++ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F)) { ++ for (i = 0; i < sizeof(pDM_DigTable->bigJumpLmt); i++) { ++ if (pDM_DigTable->bigJumpLmt[i] == 0) ++ pDM_DigTable->bigJumpLmt[i] = 0x64; /* Set -10dBm as default value */ ++ } ++ } ++#endif ++} ++ ++ ++VOID ++odm_DIG( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pDM_Odm->Adapter); ++#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ PSTA_INFO_T pEntry; ++#endif ++ ++ // Common parameters ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); ++ BOOLEAN FirstConnect,FirstDisConnect; ++ u1Byte DIG_MaxOfMin, DIG_Dynamic_MIN; ++ u1Byte dm_dig_max, dm_dig_min; ++ u1Byte CurrentIGI = pDM_DigTable->CurIGValue; ++ u1Byte offset; ++ u4Byte dm_FA_thres[3]; ++ u4Byte TxTp = 0, RxTp = 0; ++ BOOLEAN DIG_GoUpCheck = TRUE; ++ BOOLEAN bDFSBand = FALSE; ++ BOOLEAN bPerformance = TRUE, bFirstTpTarget = FALSE, bFirstCoverage = FALSE; ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ u4Byte TpTrainTH_MIN = DM_DIG_TP_Target_TH0; ++ static u1Byte TimeCnt = 0; ++ u1Byte i; ++#endif ++ ++ if(odm_DigAbort(pDM_Odm) == TRUE) ++ return; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG()===========================>\n\n")); ++ ++ ++ //1 Update status ++ { ++ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_0; ++ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == FALSE); ++ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == TRUE); ++ } ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ //1 Noise Floor Estimate ++ //pDM_DigTable->bNoiseEst = (FirstConnect)?TRUE:pDM_DigTable->bNoiseEst; ++ //odm_InbandNoiseCalculate (pDM_Odm); ++ ++ //1 Mode decision ++ if(pDM_Odm->bLinked) ++ { ++ //2 Calculate total TP ++ for (i=0; ipODM_StaInfo[i]; ++ if(IS_STA_VALID(pEntry)) ++ { ++ RxTp += (u4Byte)(pEntry->rx_byte_cnt_LowMAW>>7); ++ TxTp += (u4Byte)(pEntry->tx_byte_cnt_LowMAW>>7); //Kbps ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): TX TP = %dkbps, RX TP = %dkbps\n", TxTp, RxTp)); ++ } ++ ++ switch(pDM_Odm->priv->pshare->rf_ft_var.dig_cov_enable) ++ { ++ case 0: ++ { ++ bPerformance = TRUE; ++ break; ++ } ++ case 1: ++ { ++ bPerformance = FALSE; ++ break; ++ } ++ case 2: ++ { ++ if(pDM_Odm->bLinked) ++ { ++ if(pDM_DigTable->TpTrainTH_min > DM_DIG_TP_Target_TH0) ++ TpTrainTH_MIN = pDM_DigTable->TpTrainTH_min; ++ ++ if(pDM_DigTable->TpTrainTH_min > DM_DIG_TP_Target_TH1) ++ TpTrainTH_MIN = DM_DIG_TP_Target_TH1; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): TP training mode lower bound = %dkbps\n", TpTrainTH_MIN)); ++ ++ //2 Decide DIG mode by total TP ++ if((TxTp + RxTp) > DM_DIG_TP_Target_TH1) // change to performance mode ++ { ++ bFirstTpTarget = (!pDM_DigTable->bTpTarget)?TRUE:FALSE; ++ pDM_DigTable->bTpTarget = TRUE; ++ bPerformance = TRUE; ++ } ++ else if((TxTp + RxTp) < TpTrainTH_MIN) // change to coverage mode ++ { ++ bFirstCoverage = (pDM_DigTable->bTpTarget)?TRUE:FALSE; ++ ++ if(TimeCnt < DM_DIG_TP_Training_Period) ++ { ++ pDM_DigTable->bTpTarget = FALSE; ++ bPerformance = FALSE; ++ TimeCnt++; ++ } ++ else ++ { ++ pDM_DigTable->bTpTarget = TRUE; ++ bPerformance = TRUE; ++ bFirstTpTarget = TRUE; ++ TimeCnt = 0; ++ } ++ } ++ else // remain previous mode ++ { ++ bPerformance = pDM_DigTable->bTpTarget; ++ ++ if(!bPerformance) ++ { ++ if(TimeCnt < DM_DIG_TP_Training_Period) ++ TimeCnt++; ++ else ++ { ++ pDM_DigTable->bTpTarget = TRUE; ++ bPerformance = TRUE; ++ bFirstTpTarget = TRUE; ++ TimeCnt = 0; ++ } ++ } ++ } ++ ++ if(!bPerformance) ++ pDM_DigTable->TpTrainTH_min = RxTp + TxTp; ++ ++ } ++ else ++ { ++ bPerformance = FALSE; ++ pDM_DigTable->TpTrainTH_min = 0; ++ } ++ break; ++ } ++ default: ++ bPerformance = TRUE; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("====== DIG mode = %d ======\n", pDM_Odm->priv->pshare->rf_ft_var.dig_cov_enable)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("====== bPerformance = %d ======\n", bPerformance)); ++#endif ++ ++ //1 Boundary Decision ++ { ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ //2 For AP\ADSL ++ if(!bPerformance) ++ { ++ dm_dig_max = DM_DIG_MAX_AP_COVERAGR; ++ dm_dig_min = DM_DIG_MIN_AP_COVERAGE; ++ DIG_MaxOfMin = DM_DIG_MAX_OF_MIN_COVERAGE; ++ } ++ else ++ { ++ if (pDM_Odm->RFType == ODM_1T1R) ++ dm_dig_max = DM_DIG_MAX_AP - 6; ++ else ++ dm_dig_max = DM_DIG_MAX_AP; ++ ++ if ((*pDM_Odm->pBandType == ODM_BAND_2_4G) && (pDM_Odm->SupportICType & ODM_RTL8814A)) /* for 2G 8814 */ ++ dm_dig_min = 0x1c; ++ else ++ dm_dig_min = DM_DIG_MIN_AP; ++ DIG_MaxOfMin = DM_DIG_MAX_OF_MIN; ++ } ++ ++ //4 TX2path ++ if (priv->pmib->dot11RFEntry.tx2path && !bDFSBand && (*(pDM_Odm->pWirelessMode) == ODM_WM_B)) ++ dm_dig_max = 0x2A; ++ ++#if RTL8192E_SUPPORT ++#ifdef HIGH_POWER_EXT_LNA ++ if ((pDM_Odm->SupportICType & (ODM_RTL8192E)) && (pDM_Odm->ExtLNA)) ++ dm_dig_max = 0x42; ++#endif ++#endif ++ if (pDM_Odm->IGI_LowerBound) { ++ if (dm_dig_min < pDM_Odm->IGI_LowerBound) ++ dm_dig_min = pDM_Odm->IGI_LowerBound; ++ if (DIG_MaxOfMin < pDM_Odm->IGI_LowerBound) ++ DIG_MaxOfMin = pDM_Odm->IGI_LowerBound; ++ } ++ if (pDM_Odm->IGI_UpperBound) { ++ if (dm_dig_max > pDM_Odm->IGI_UpperBound) ++ dm_dig_max = pDM_Odm->IGI_UpperBound; ++ if (DIG_MaxOfMin > pDM_Odm->IGI_UpperBound) ++ DIG_MaxOfMin = pDM_Odm->IGI_UpperBound; ++ } ++#else ++ //2 For WIN\CE ++ if(pDM_Odm->SupportICType >= ODM_RTL8188E) ++ dm_dig_max = 0x5A; ++ else ++ dm_dig_max = DM_DIG_MAX_NIC; ++ ++ if(pDM_Odm->SupportICType != ODM_RTL8821) ++ dm_dig_min = DM_DIG_MIN_NIC; ++ else ++ dm_dig_min = 0x1C; ++ ++ DIG_MaxOfMin = DM_DIG_MAX_AP; ++#endif ++ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) ++ /* Modify lower bound for DFS band */ ++ if ((((*pDM_Odm->pChannel >= 52) && (*pDM_Odm->pChannel <= 64)) || ++ ((*pDM_Odm->pChannel >= 100) && (*pDM_Odm->pChannel <= 140))) ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++ && phydm_dfs_master_enabled(pDM_Odm) == TRUE ++ #endif ++ ) { ++ bDFSBand = TRUE; ++ if (*pDM_Odm->pBandWidth == ODM_BW20M) ++ dm_dig_min = DM_DIG_MIN_AP_DFS+2; ++ else ++ dm_dig_min = DM_DIG_MIN_AP_DFS; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): ====== In DFS band ======\n")); ++ } ++#endif ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Absolutly upper bound = 0x%x, lower bound = 0x%x\n",dm_dig_max, dm_dig_min)); ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ if (pDM_Odm->pu1ForcedIgiLb && (0 < *pDM_Odm->pu1ForcedIgiLb)) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Force IGI lb to: 0x%02x !!!!!!\n", *pDM_Odm->pu1ForcedIgiLb)); ++ dm_dig_min = *pDM_Odm->pu1ForcedIgiLb; ++ dm_dig_max = (dm_dig_min <= dm_dig_max) ? (dm_dig_max) : (dm_dig_min + 1); ++ } ++#endif ++ ++ //1 Adjust boundary by RSSI ++ if(pDM_Odm->bLinked && bPerformance) ++ { ++ //2 Modify DIG upper bound ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ offset = 15; ++#else ++ //4 Modify DIG upper bound for 92E, 8723A\B, 8821 & 8812 BT ++ if ((pDM_Odm->SupportICType & (ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8812|ODM_RTL8821)) && (pDM_Odm->bBtLimitedDig == 1)) ++ { ++ offset = 10; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Coex. case: Force upper bound to RSSI + %d !!!!!!\n", offset)); ++ } ++ else ++ offset = 15; ++#endif ++ ++ if((pDM_Odm->RSSI_Min + offset) > dm_dig_max ) ++ pDM_DigTable->rx_gain_range_max = dm_dig_max; ++ else if((pDM_Odm->RSSI_Min + offset) < dm_dig_min ) ++ pDM_DigTable->rx_gain_range_max = dm_dig_min; ++ else ++ pDM_DigTable->rx_gain_range_max = pDM_Odm->RSSI_Min + offset; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ //2 Modify DIG lower bound ++ //if(pDM_Odm->bOneEntryOnly) ++ { ++ if(pDM_Odm->RSSI_Min < dm_dig_min) ++ DIG_Dynamic_MIN = dm_dig_min; ++ else if (pDM_Odm->RSSI_Min > DIG_MaxOfMin) ++ DIG_Dynamic_MIN = DIG_MaxOfMin; ++ else ++ DIG_Dynamic_MIN = pDM_Odm->RSSI_Min; ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ if (bDFSBand) { ++ DIG_Dynamic_MIN = dm_dig_min; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: Force lower bound to 0x%x after link !!!!!!\n", dm_dig_min)); ++ } ++#endif ++ } ++#else ++ { ++ //4 For AP ++#ifdef __ECOS ++ HAL_REORDER_BARRIER(); ++#else ++ rmb(); ++#endif ++ if (bDFSBand) ++ { ++ DIG_Dynamic_MIN = dm_dig_min; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: Force lower bound to 0x%x after link !!!!!!\n", dm_dig_min)); ++ } ++ else ++ { ++ if(pDM_Odm->RSSI_Min < dm_dig_min) ++ DIG_Dynamic_MIN = dm_dig_min; ++ else if (pDM_Odm->RSSI_Min > DIG_MaxOfMin) ++ DIG_Dynamic_MIN = DIG_MaxOfMin; ++ else ++ DIG_Dynamic_MIN = pDM_Odm->RSSI_Min; ++ } ++ } ++#endif ++ } ++ else ++ { ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) ++ if(bPerformance && bDFSBand) ++ { ++ pDM_DigTable->rx_gain_range_max = 0x28; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: Force upper bound to 0x%x before link !!!!!!\n", pDM_DigTable->rx_gain_range_max)); ++ } ++ else ++#endif ++ { ++ if (bPerformance) ++ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_OF_MIN; ++ else ++ pDM_DigTable->rx_gain_range_max = dm_dig_max; ++ } ++ DIG_Dynamic_MIN = dm_dig_min; ++ } ++ ++ //1 Force Lower Bound for AntDiv ++ if(pDM_Odm->bLinked && !pDM_Odm->bOneEntryOnly) ++ { ++ if((pDM_Odm->SupportICType & ODM_ANTDIV_SUPPORT) && (pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) ++ { ++ if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV || pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) { ++ if (pDM_DigTable->AntDiv_RSSI_max > DIG_MaxOfMin) ++ DIG_Dynamic_MIN = DIG_MaxOfMin; ++ else ++ DIG_Dynamic_MIN = (u1Byte) pDM_DigTable->AntDiv_RSSI_max; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Antenna diversity case: Force lower bound to 0x%x !!!!!!\n", DIG_Dynamic_MIN)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Antenna diversity case: RSSI_max = 0x%x !!!!!!\n", pDM_DigTable->AntDiv_RSSI_max)); ++ } ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust boundary by RSSI Upper bound = 0x%x, Lower bound = 0x%x\n", ++ pDM_DigTable->rx_gain_range_max, DIG_Dynamic_MIN)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Link status: bLinked = %d, RSSI = %d, bFirstConnect = %d, bFirsrDisConnect = %d\n\n", ++ pDM_Odm->bLinked, pDM_Odm->RSSI_Min, FirstConnect, FirstDisConnect)); ++ ++ //1 Modify DIG lower bound, deal with abnormal case ++ //2 Abnormal false alarm case ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) ++ if(bDFSBand) ++ { ++ pDM_DigTable->rx_gain_range_min = DIG_Dynamic_MIN; ++ } ++ else ++#endif ++ { ++ if(!pDM_Odm->bLinked) ++ { ++ pDM_DigTable->rx_gain_range_min = DIG_Dynamic_MIN; ++ ++ if (FirstDisConnect) ++ pDM_DigTable->ForbiddenIGI = DIG_Dynamic_MIN; ++ } ++ else ++ pDM_DigTable->rx_gain_range_min = odm_ForbiddenIGICheck(pDM_Odm, DIG_Dynamic_MIN, CurrentIGI); ++ } ++ ++ //2 Abnormal # beacon case ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ if(pDM_Odm->bLinked && !FirstConnect) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Beacon Num (%d)\n", pDM_Odm->PhyDbgInfo.NumQryBeaconPkt)); ++ if((pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 5) && (pDM_Odm->bsta_state)) ++ { ++ pDM_DigTable->rx_gain_range_min = 0x1c; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnrormal #beacon (%d) case in STA mode: Force lower bound to 0x%x !!!!!!\n\n", ++ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt, pDM_DigTable->rx_gain_range_min)); ++ } ++ } ++#endif ++ ++ //2 Abnormal lower bound case ++ if(pDM_DigTable->rx_gain_range_min > pDM_DigTable->rx_gain_range_max) ++ { ++ pDM_DigTable->rx_gain_range_min = pDM_DigTable->rx_gain_range_max; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnrormal lower bound case: Force lower bound to 0x%x !!!!!!\n\n",pDM_DigTable->rx_gain_range_min)); ++ } ++ ++ ++ //1 False alarm threshold decision ++ odm_FAThresholdCheck(pDM_Odm, bDFSBand, bPerformance, RxTp, TxTp, dm_FA_thres); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): False alarm threshold = %d, %d, %d \n\n", dm_FA_thres[0], dm_FA_thres[1], dm_FA_thres[2])); ++ ++ //1 Adjust initial gain by false alarm ++ if(pDM_Odm->bLinked && bPerformance) ++ { ++ //2 After link ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust IGI after link\n")); ++ ++ if(bFirstTpTarget || (FirstConnect && bPerformance)) ++ { ++ pDM_DigTable->LargeFAHit = 0; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) ++ if(bDFSBand) ++ { ++ if(pDM_Odm->RSSI_Min > 0x28) ++ CurrentIGI = 0x28; ++ else ++ CurrentIGI = pDM_Odm->RSSI_Min; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: One-shot to 0x28 upmost!!!!!!\n")); ++ } ++ else ++#endif ++ { ++ if(pDM_Odm->RSSI_Min < DIG_MaxOfMin) ++ { ++ if(CurrentIGI < pDM_Odm->RSSI_Min) ++ CurrentIGI = pDM_Odm->RSSI_Min; ++ } ++ else ++ { ++ if(CurrentIGI < DIG_MaxOfMin) ++ CurrentIGI = DIG_MaxOfMin; ++ } ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++#if (RTL8812A_SUPPORT==1) ++ if(pDM_Odm->SupportICType == ODM_RTL8812) ++ ODM_ConfigBBWithHeaderFile(pDM_Odm, CONFIG_BB_AGC_TAB_DIFF); ++#endif ++#endif ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): First connect case: IGI does on-shot to 0x%x\n", CurrentIGI)); ++ ++ } ++ else ++ { ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++ if (priv->pshare->rf_ft_var.dig_upcheck_enable) ++ DIG_GoUpCheck = phydm_DIG_GoUpCheck(pDM_Odm); ++#endif ++ ++ if((pFalseAlmCnt->Cnt_all > dm_FA_thres[2]) && DIG_GoUpCheck) ++ CurrentIGI = CurrentIGI + 4; ++ else if ((pFalseAlmCnt->Cnt_all > dm_FA_thres[1]) && DIG_GoUpCheck) ++ CurrentIGI = CurrentIGI + 2; ++ else if(pFalseAlmCnt->Cnt_all < dm_FA_thres[0]) ++ CurrentIGI = CurrentIGI - 2; ++ ++ //4 Abnormal # beacon case ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ if((pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 5) && (pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH1) && (pDM_Odm->bsta_state)) ++ { ++ CurrentIGI = pDM_DigTable->rx_gain_range_min; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormal #beacon (%d) case: IGI does one-shot to 0x%x\n", ++ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt, CurrentIGI)); ++ } ++#endif ++ } ++ } ++ else ++ { ++ //2 Before link ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust IGI before link\n")); ++ ++ if(FirstDisConnect || bFirstCoverage) ++ { ++ CurrentIGI = dm_dig_min; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): First disconnect case: IGI does on-shot to lower bound\n")); ++ } ++ else ++ { ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ if (priv->pshare->rf_ft_var.dig_upcheck_enable) ++ DIG_GoUpCheck = phydm_DIG_GoUpCheck(pDM_Odm); ++#endif ++ ++ if((pFalseAlmCnt->Cnt_all > dm_FA_thres[2]) && DIG_GoUpCheck) ++ CurrentIGI = CurrentIGI + 4; ++ else if ((pFalseAlmCnt->Cnt_all > dm_FA_thres[1]) && DIG_GoUpCheck) ++ CurrentIGI = CurrentIGI + 2; ++ else if(pFalseAlmCnt->Cnt_all < dm_FA_thres[0]) ++ CurrentIGI = CurrentIGI - 2; ++ } ++ } ++ ++ //1 Check initial gain by upper/lower bound ++ if(CurrentIGI < pDM_DigTable->rx_gain_range_min) ++ CurrentIGI = pDM_DigTable->rx_gain_range_min; ++ ++ if(CurrentIGI > pDM_DigTable->rx_gain_range_max) ++ CurrentIGI = pDM_DigTable->rx_gain_range_max; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): CurIGValue=0x%x, TotalFA = %d\n\n", CurrentIGI, pFalseAlmCnt->Cnt_all)); ++ ++ //1 Update status ++ { ++#if ((DM_ODM_SUPPORT_TYPE & ODM_WIN) || ((DM_ODM_SUPPORT_TYPE & ODM_CE) && (ODM_CONFIG_BT_COEXIST == 1))) ++ if(pDM_Odm->bBtHsOperation) ++ { ++ if(pDM_Odm->bLinked) ++ { ++ if(pDM_DigTable->BT30_CurIGI > (CurrentIGI)) ++ ODM_Write_DIG(pDM_Odm, CurrentIGI); ++ else ++ ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI); ++ ++ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; ++ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; ++ } ++ else ++ { ++ if(pDM_Odm->bLinkInProcess) ++ ODM_Write_DIG(pDM_Odm, 0x1c); ++ else if(pDM_Odm->bBtConnectProcess) ++ ODM_Write_DIG(pDM_Odm, 0x28); ++ else ++ ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); ++ } ++ } ++ else // BT is not using ++#endif ++ { ++ ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); ++ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; ++ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; ++ } ++ } ++} ++ ++VOID ++odm_DIGbyRSSI_LPS( ++ IN PVOID pDM_VOID ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); ++ ++ u1Byte RSSI_Lower=DM_DIG_MIN_NIC; //0x1E or 0x1C ++ u1Byte CurrentIGI=pDM_Odm->RSSI_Min; ++ ++ if(odm_DigAbort(pDM_Odm) == TRUE) ++ return; ++ ++ CurrentIGI=CurrentIGI+RSSI_OFFSET_DIG; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS()==>\n")); ++ ++ // Using FW PS mode to make IGI ++ //Adjust by FA in LPS MODE ++ if(pFalseAlmCnt->Cnt_all> DM_DIG_FA_TH2_LPS) ++ CurrentIGI = CurrentIGI+4; ++ else if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH1_LPS) ++ CurrentIGI = CurrentIGI+2; ++ else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0_LPS) ++ CurrentIGI = CurrentIGI-2; ++ ++ ++ //Lower bound checking ++ ++ //RSSI Lower bound check ++ if((pDM_Odm->RSSI_Min-10) > DM_DIG_MIN_NIC) ++ RSSI_Lower =(pDM_Odm->RSSI_Min-10); ++ else ++ RSSI_Lower =DM_DIG_MIN_NIC; ++ ++ //Upper and Lower Bound checking ++ if(CurrentIGI > DM_DIG_MAX_NIC) ++ CurrentIGI = DM_DIG_MAX_NIC; ++ else if(CurrentIGI < RSSI_Lower) ++ CurrentIGI = RSSI_Lower; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS(): pFalseAlmCnt->Cnt_all = %d\n",pFalseAlmCnt->Cnt_all)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS(): pDM_Odm->RSSI_Min = %d\n",pDM_Odm->RSSI_Min)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS(): CurrentIGI = 0x%x\n",CurrentIGI)); ++ ++ ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); ++#endif ++} ++ ++//3============================================================ ++//3 FASLE ALARM CHECK ++//3============================================================ ++ ++VOID ++odm_FalseAlarmCounterStatistics( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); ++ u4Byte ret_value; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++//Mark there, and check this in odm_DMWatchDog ++#if 0 //(DM_ODM_SUPPORT_TYPE == ODM_AP) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ if( (priv->auto_channel != 0) && (priv->auto_channel != 2) ) ++ return; ++#endif ++#endif ++ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT)) ++ return; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics()======>\n")); ++ ++#if (ODM_IC_11N_SERIES_SUPPORT == 1) ++ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ { ++ ++ //hold ofdm counter ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT31, 1); //hold page C counter ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT31, 1); //hold page D counter ++ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE1_11N, bMaskDWord); ++ FalseAlmCnt->Cnt_Fast_Fsync = (ret_value&0xffff); ++ FalseAlmCnt->Cnt_SB_Search_fail = ((ret_value&0xffff0000)>>16); ++ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE2_11N, bMaskDWord); ++ FalseAlmCnt->Cnt_OFDM_CCA = (ret_value&0xffff); ++ FalseAlmCnt->Cnt_Parity_Fail = ((ret_value&0xffff0000)>>16); ++ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE3_11N, bMaskDWord); ++ FalseAlmCnt->Cnt_Rate_Illegal = (ret_value&0xffff); ++ FalseAlmCnt->Cnt_Crc8_fail = ((ret_value&0xffff0000)>>16); ++ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE4_11N, bMaskDWord); ++ FalseAlmCnt->Cnt_Mcs_fail = (ret_value&0xffff); ++ ++ FalseAlmCnt->Cnt_Ofdm_fail = FalseAlmCnt->Cnt_Parity_Fail + FalseAlmCnt->Cnt_Rate_Illegal + ++ FalseAlmCnt->Cnt_Crc8_fail + FalseAlmCnt->Cnt_Mcs_fail + ++ FalseAlmCnt->Cnt_Fast_Fsync + FalseAlmCnt->Cnt_SB_Search_fail; ++ ++ /* read CCK CRC32 counter */ ++ FalseAlmCnt->cnt_cck_crc32_error = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CRC32_ERROR_CNT_11N, bMaskDWord); ++ FalseAlmCnt->cnt_cck_crc32_ok= ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CRC32_OK_CNT_11N, bMaskDWord); ++ ++ /* read OFDM CRC32 counter */ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_CRC32_CNT_11N, bMaskDWord); ++ FalseAlmCnt->cnt_ofdm_crc32_error = (ret_value & 0xffff0000) >> 16; ++ FalseAlmCnt->cnt_ofdm_crc32_ok= ret_value & 0xffff; ++ ++ /* read HT CRC32 counter */ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_HT_CRC32_CNT_11N, bMaskDWord); ++ FalseAlmCnt->cnt_ht_crc32_error = (ret_value & 0xffff0000) >> 16; ++ FalseAlmCnt->cnt_ht_crc32_ok= ret_value & 0xffff; ++ ++ /* read VHT CRC32 counter */ ++ FalseAlmCnt->cnt_vht_crc32_error = 0; ++ FalseAlmCnt->cnt_vht_crc32_ok= 0; ++ ++#if (RTL8188E_SUPPORT==1) ++ if(pDM_Odm->SupportICType == ODM_RTL8188E) ++ { ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_SC_CNT_11N, bMaskDWord); ++ FalseAlmCnt->Cnt_BW_LSC = (ret_value&0xffff); ++ FalseAlmCnt->Cnt_BW_USC = ((ret_value&0xffff0000)>>16); ++ } ++#endif ++ ++ { ++ //hold cck counter ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT12, 1); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT14, 1); ++ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_LSB_11N, bMaskByte0); ++ FalseAlmCnt->Cnt_Cck_fail = ret_value; ++ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_MSB_11N, bMaskByte3); ++ FalseAlmCnt->Cnt_Cck_fail += (ret_value& 0xff)<<8; ++ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CCA_CNT_11N, bMaskDWord); ++ FalseAlmCnt->Cnt_CCK_CCA = ((ret_value&0xFF)<<8) |((ret_value&0xFF00)>>8); ++ } ++ ++ FalseAlmCnt->Cnt_all_pre = FalseAlmCnt->Cnt_all; ++ ++ FalseAlmCnt->Cnt_all = ( FalseAlmCnt->Cnt_Fast_Fsync + ++ FalseAlmCnt->Cnt_SB_Search_fail + ++ FalseAlmCnt->Cnt_Parity_Fail + ++ FalseAlmCnt->Cnt_Rate_Illegal + ++ FalseAlmCnt->Cnt_Crc8_fail + ++ FalseAlmCnt->Cnt_Mcs_fail + ++ FalseAlmCnt->Cnt_Cck_fail); ++ ++ FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_OFDM_CCA + FalseAlmCnt->Cnt_CCK_CCA; ++ ++ if (pDM_Odm->SupportICType >= ODM_RTL8188E) { ++ /*reset false alarm counter registers*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT31, 1); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT31, 0); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT27, 1); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT27, 0); ++ ++ /*update ofdm counter*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT31, 0); /*update page C counter*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT31, 0); /*update page D counter*/ ++ ++ /*reset CCK CCA counter*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT13|BIT12, 0); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT13|BIT12, 2); ++ ++ /*reset CCK FA counter*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT15|BIT14, 0); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT15|BIT14, 2); ++ ++ /*reset CRC32 counter*/ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_PAGE_F_RST_11N, BIT16, 1); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_PAGE_F_RST_11N, BIT16, 0); ++ } ++ ++ /* Get debug port 0 */ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11N, bMaskDWord, 0x0); ++ FalseAlmCnt->dbg_port0 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11N, bMaskDWord); ++ ++ /* Get EDCCA flag */ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11N, bMaskDWord, 0x208); ++ FalseAlmCnt->edcca_flag = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11N, BIT30); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Fast_Fsync=%d, Cnt_SB_Search_fail=%d\n", ++ FalseAlmCnt->Cnt_Fast_Fsync, FalseAlmCnt->Cnt_SB_Search_fail)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Parity_Fail=%d, Cnt_Rate_Illegal=%d\n", ++ FalseAlmCnt->Cnt_Parity_Fail, FalseAlmCnt->Cnt_Rate_Illegal)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Crc8_fail=%d, Cnt_Mcs_fail=%d\n", ++ FalseAlmCnt->Cnt_Crc8_fail, FalseAlmCnt->Cnt_Mcs_fail)); ++ } ++#endif ++ ++#if (ODM_IC_11AC_SERIES_SUPPORT == 1) ++ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ { ++ u4Byte CCKenable; ++ ++ /* read OFDM FA counter */ ++ FalseAlmCnt->Cnt_Ofdm_fail = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_11AC, bMaskLWord); ++ ++ /* Read CCK FA counter */ ++ FalseAlmCnt->Cnt_Cck_fail = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_11AC, bMaskLWord); ++ ++ /* read CCK/OFDM CCA counter */ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CCA_CNT_11AC, bMaskDWord); ++ FalseAlmCnt->Cnt_OFDM_CCA = (ret_value & 0xffff0000) >> 16; ++ FalseAlmCnt->Cnt_CCK_CCA = ret_value & 0xffff; ++ ++ /* read CCK CRC32 counter */ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CRC32_CNT_11AC, bMaskDWord); ++ FalseAlmCnt->cnt_cck_crc32_error = (ret_value & 0xffff0000) >> 16; ++ FalseAlmCnt->cnt_cck_crc32_ok= ret_value & 0xffff; ++ ++ /* read OFDM CRC32 counter */ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_CRC32_CNT_11AC, bMaskDWord); ++ FalseAlmCnt->cnt_ofdm_crc32_error = (ret_value & 0xffff0000) >> 16; ++ FalseAlmCnt->cnt_ofdm_crc32_ok= ret_value & 0xffff; ++ ++ /* read HT CRC32 counter */ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_HT_CRC32_CNT_11AC, bMaskDWord); ++ FalseAlmCnt->cnt_ht_crc32_error = (ret_value & 0xffff0000) >> 16; ++ FalseAlmCnt->cnt_ht_crc32_ok= ret_value & 0xffff; ++ ++ /* read VHT CRC32 counter */ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_VHT_CRC32_CNT_11AC, bMaskDWord); ++ FalseAlmCnt->cnt_vht_crc32_error = (ret_value & 0xffff0000) >> 16; ++ FalseAlmCnt->cnt_vht_crc32_ok= ret_value & 0xffff; ++ ++#if (RTL8881A_SUPPORT==1) ++ /* For 8881A */ ++ if(pDM_Odm->SupportICType == ODM_RTL8881A) ++ { ++ u4Byte Cnt_Ofdm_fail_temp = 0; ++ ++ if(FalseAlmCnt->Cnt_Ofdm_fail >= FalseAlmCnt->Cnt_Ofdm_fail_pre) ++ { ++ Cnt_Ofdm_fail_temp = FalseAlmCnt->Cnt_Ofdm_fail_pre; ++ FalseAlmCnt->Cnt_Ofdm_fail_pre = FalseAlmCnt->Cnt_Ofdm_fail; ++ FalseAlmCnt->Cnt_Ofdm_fail = FalseAlmCnt->Cnt_Ofdm_fail - Cnt_Ofdm_fail_temp; ++ } ++ else ++ FalseAlmCnt->Cnt_Ofdm_fail_pre = FalseAlmCnt->Cnt_Ofdm_fail; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail_pre)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail_pre=%d\n", Cnt_Ofdm_fail_temp)); ++ ++ /* Reset FA counter by enable/disable OFDM */ ++ if(FalseAlmCnt->Cnt_Ofdm_fail_pre >= 0x7fff) ++ { ++ // reset OFDM ++ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT29,0); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT29,1); ++ FalseAlmCnt->Cnt_Ofdm_fail_pre = 0; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Reset false alarm counter\n")); ++ } ++ } ++#endif ++ ++ /* reset OFDM FA coutner */ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RST_11AC, BIT17, 1); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RST_11AC, BIT17, 0); ++ ++ /* reset CCK FA counter */ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11AC, BIT15, 0); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11AC, BIT15, 1); ++ ++ /* reset CCA counter */ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_RST_RPT_11AC, BIT0, 1); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_RST_RPT_11AC, BIT0, 0); ++ ++ CCKenable = ODM_GetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT28); ++ if(CCKenable)//if(*pDM_Odm->pBandType == ODM_BAND_2_4G) ++ { ++ FalseAlmCnt->Cnt_all = FalseAlmCnt->Cnt_Ofdm_fail + FalseAlmCnt->Cnt_Cck_fail; ++ FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_CCK_CCA + FalseAlmCnt->Cnt_OFDM_CCA; ++ } ++ else ++ { ++ FalseAlmCnt->Cnt_all = FalseAlmCnt->Cnt_Ofdm_fail; ++ FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_OFDM_CCA; ++ } ++ if (pDM_Odm->ADCSmp_count == 0) { ++ /* Get debug port 0 */ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC, bMaskDWord, 0x0); ++ FalseAlmCnt->dbg_port0 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC, bMaskDWord); ++ ++ /* Get EDCCA flag */ ++ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC, bMaskDWord, 0x209); ++ FalseAlmCnt->edcca_flag = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC, BIT30); ++ } ++ ++ } ++#endif ++ ++ ++ FalseAlmCnt->cnt_crc32_error_all = FalseAlmCnt->cnt_vht_crc32_error + FalseAlmCnt->cnt_ht_crc32_error + FalseAlmCnt->cnt_ofdm_crc32_error + FalseAlmCnt->cnt_cck_crc32_error; ++ FalseAlmCnt->cnt_crc32_ok_all = FalseAlmCnt->cnt_vht_crc32_ok + FalseAlmCnt->cnt_ht_crc32_ok + FalseAlmCnt->cnt_ofdm_crc32_ok + FalseAlmCnt->cnt_cck_crc32_ok; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_OFDM_CCA=%d\n", FalseAlmCnt->Cnt_OFDM_CCA)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_CCK_CCA=%d\n", FalseAlmCnt->Cnt_CCK_CCA)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_CCA_all=%d\n", FalseAlmCnt->Cnt_CCA_all)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Cck_fail=%d\n", FalseAlmCnt->Cnt_Cck_fail)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Total False Alarm=%d\n", FalseAlmCnt->Cnt_all)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): CCK CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_cck_crc32_error, FalseAlmCnt->cnt_cck_crc32_ok)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): OFDM CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_ofdm_crc32_error, FalseAlmCnt->cnt_ofdm_crc32_ok)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): HT CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_ht_crc32_error, FalseAlmCnt->cnt_ht_crc32_ok)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): VHT CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_vht_crc32_error, FalseAlmCnt->cnt_vht_crc32_ok)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Total CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_crc32_error_all, FalseAlmCnt->cnt_crc32_ok_all)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): dbg port 0x0 = 0x%x, EDCCA = %d\n\n", FalseAlmCnt->dbg_port0, FalseAlmCnt->edcca_flag)); ++} ++ ++//3============================================================ ++//3 CCK Packet Detect Threshold ++//3============================================================ ++ ++VOID ++odm_PauseCCKPacketDetection( ++ IN PVOID pDM_VOID, ++ IN PHYDM_PAUSE_TYPE PauseType, ++ IN PHYDM_PAUSE_LEVEL pause_level, ++ IN u1Byte CCKPDThreshold ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection()=========> level = %d\n", pause_level)); ++ ++ if ((pDM_DigTable->pause_cckpd_level == 0) && (!(pDM_Odm->SupportAbility & ODM_BB_CCK_PD) || !(pDM_Odm->SupportAbility & ODM_BB_FA_CNT))) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Return: SupportAbility ODM_BB_CCK_PD or ODM_BB_FA_CNT is disabled\n")); ++ return; ++ } ++ ++ if (pause_level > DM_DIG_MAX_PAUSE_TYPE) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ++ ("odm_PauseCCKPacketDetection(): Return: Wrong pause level !!\n")); ++ return; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_cckpd_level, CCKPDThreshold)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", ++ pDM_DigTable->pause_cckpd_value[7], pDM_DigTable->pause_cckpd_value[6], pDM_DigTable->pause_cckpd_value[5], pDM_DigTable->pause_cckpd_value[4], ++ pDM_DigTable->pause_cckpd_value[3], pDM_DigTable->pause_cckpd_value[2], pDM_DigTable->pause_cckpd_value[1], pDM_DigTable->pause_cckpd_value[0])); ++ ++ switch (PauseType) { ++ /* Pause CCK Packet Detection Threshold */ ++ case PHYDM_PAUSE: ++ { ++ /* Disable CCK PD */ ++ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility & (~ODM_BB_CCK_PD)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Pause CCK packet detection threshold !!\n")); ++ ++ /* Backup original CCK PD threshold decided by CCK PD mechanism */ ++ if (pDM_DigTable->pause_cckpd_level == 0) { ++ pDM_DigTable->CCKPDBackup = pDM_DigTable->CurCCK_CCAThres; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ++ ("odm_PauseCCKPacketDetection(): Backup CCKPD = 0x%x, new CCKPD = 0x%x\n", pDM_DigTable->CCKPDBackup, CCKPDThreshold)); ++ } ++ ++ /* Update pause level */ ++ pDM_DigTable->pause_cckpd_level = (pDM_DigTable->pause_cckpd_level | BIT(pause_level)); ++ ++ /* Record CCK PD threshold */ ++ pDM_DigTable->pause_cckpd_value[pause_level] = CCKPDThreshold; ++ ++ /* Write new CCK PD threshold */ ++ if (BIT(pause_level + 1) > pDM_DigTable->pause_cckpd_level) { ++ ODM_Write_CCK_CCA_Thres(pDM_Odm, CCKPDThreshold); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): CCKPD of higher level = 0x%x\n", CCKPDThreshold)); ++ } ++ break; ++ } ++ /* Resume CCK Packet Detection Threshold */ ++ case PHYDM_RESUME: ++ { ++ /* check if the level is illegal or not */ ++ if ((pDM_DigTable->pause_cckpd_level & (BIT(pause_level))) != 0) { ++ pDM_DigTable->pause_cckpd_level = pDM_DigTable->pause_cckpd_level & (~(BIT(pause_level))); ++ pDM_DigTable->pause_cckpd_value[pause_level] = 0; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Resume CCK PD !!\n")); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Wrong resume level !!\n")); ++ break; ++ } ++ ++ /* Resume DIG */ ++ if (pDM_DigTable->pause_cckpd_level == 0) { ++ /* Write backup IGI value */ ++ ODM_Write_CCK_CCA_Thres(pDM_Odm, pDM_DigTable->CCKPDBackup); ++ /* pDM_DigTable->bIgnoreDIG = TRUE; */ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Write original CCKPD = 0x%x\n", pDM_DigTable->CCKPDBackup)); ++ ++ /* Enable DIG */ ++ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility | ODM_BB_CCK_PD); ++ break; ++ } ++ ++ if (BIT(pause_level) > pDM_DigTable->pause_cckpd_level) { ++ s1Byte max_level; ++ ++ /* Calculate the maximum level now */ ++ for (max_level = (pause_level - 1); max_level >= 0; max_level--) { ++ if ((pDM_DigTable->pause_cckpd_level & BIT(max_level)) > 0) ++ break; ++ } ++ ++ /* write CCKPD of lower level */ ++ ODM_Write_CCK_CCA_Thres(pDM_Odm, pDM_DigTable->pause_cckpd_value[max_level]); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Write CCKPD (0x%x) of level (%d)\n", ++ pDM_DigTable->pause_cckpd_value[max_level], max_level)); ++ break; ++ } ++ break; ++ } ++ default: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Wrong type !!\n")); ++ break; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_cckpd_level, CCKPDThreshold)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", ++ pDM_DigTable->pause_cckpd_value[7], pDM_DigTable->pause_cckpd_value[6], pDM_DigTable->pause_cckpd_value[5], pDM_DigTable->pause_cckpd_value[4], ++ pDM_DigTable->pause_cckpd_value[3], pDM_DigTable->pause_cckpd_value[2], pDM_DigTable->pause_cckpd_value[1], pDM_DigTable->pause_cckpd_value[0])); ++} ++ ++ ++VOID ++odm_CCKPacketDetectionThresh( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); ++ u1Byte CurCCK_CCAThres = pDM_DigTable->CurCCK_CCAThres, RSSI_thd = 35; ++ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++//modify by Guo.Mingzhi 2011-12-29 ++ if (pDM_Odm->bDualMacSmartConcurrent == TRUE) ++// if (pDM_Odm->bDualMacSmartConcurrent == FALSE) ++ return; ++ if(pDM_Odm->bBtHsOperation) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() write 0xcd for BT HS mode!!\n")); ++ ODM_Write_CCK_CCA_Thres(pDM_Odm, 0xcd); ++ return; ++ } ++#endif ++ ++ if((!(pDM_Odm->SupportAbility & ODM_BB_CCK_PD)) ||(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT))) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() return==========\n")); ++#ifdef MCR_WIRELESS_EXTEND ++ ODM_Write_CCK_CCA_Thres(pDM_Odm, 0x43); ++#endif ++ return; ++ } ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ if(pDM_Odm->ExtLNA) ++ return; ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() ==========>\n")); ++ ++ if (pDM_DigTable->cckFaMa == 0xffffffff) ++ pDM_DigTable->cckFaMa = FalseAlmCnt->Cnt_Cck_fail; ++ else ++ pDM_DigTable->cckFaMa = ((pDM_DigTable->cckFaMa<<1) + pDM_DigTable->cckFaMa + FalseAlmCnt->Cnt_Cck_fail) >> 2; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh(): CCK FA moving average = %d\n", pDM_DigTable->cckFaMa)); ++ ++ if (pDM_Odm->bLinked) { ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ #if 0 /*for [PCIE-1596]*/ ++ if (pDM_Odm->RSSI_Min > (RSSI_thd + 14)) ++ CurCCK_CCAThres = 0xed; ++ else if (pDM_Odm->RSSI_Min > (RSSI_thd + 6)) ++ CurCCK_CCAThres = 0xdd; ++ else ++ #endif ++ if (pDM_Odm->RSSI_Min > RSSI_thd) ++ CurCCK_CCAThres = 0xcd; ++ else if (pDM_Odm->RSSI_Min > 20) { ++ if (pDM_DigTable->cckFaMa > ((DM_DIG_FA_TH1>>1) + (DM_DIG_FA_TH1>>3))) ++ CurCCK_CCAThres = 0xcd; ++ else if (pDM_DigTable->cckFaMa < (DM_DIG_FA_TH0>>1)) ++ CurCCK_CCAThres = 0x83; ++ } else if (pDM_Odm->RSSI_Min > 7) ++ CurCCK_CCAThres = 0x83; ++ else ++ CurCCK_CCAThres = 0x40; ++#else ++ if (pDM_DigTable->CurIGValue > (0x24 + 14)) ++ CurCCK_CCAThres = 0xed; ++ else if (pDM_DigTable->CurIGValue > (0x24 + 6)) ++ CurCCK_CCAThres = 0xdd; ++ else if (pDM_DigTable->CurIGValue > 0x24) ++ CurCCK_CCAThres = 0xcd; ++ else { ++ if (pDM_DigTable->cckFaMa > 0x400) ++ CurCCK_CCAThres = 0x83; ++ else if (pDM_DigTable->cckFaMa < 0x200) ++ CurCCK_CCAThres = 0x40; ++ } ++ ++#endif ++ } else { ++ if (pDM_DigTable->cckFaMa > 0x400) ++ CurCCK_CCAThres = 0x83; ++ else if (pDM_DigTable->cckFaMa < 0x200) ++ CurCCK_CCAThres = 0x40; ++ } ++ ++ ODM_Write_CCK_CCA_Thres(pDM_Odm, CurCCK_CCAThres); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() CurCCK_CCAThres = 0x%x\n", CurCCK_CCAThres)); ++} ++ ++VOID ++ODM_Write_CCK_CCA_Thres( ++ IN PVOID pDM_VOID, ++ IN u1Byte CurCCK_CCAThres ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++ if(pDM_DigTable->CurCCK_CCAThres!=CurCCK_CCAThres) //modify by Guo.Mingzhi 2012-01-03 ++ { ++ ODM_Write1Byte(pDM_Odm, ODM_REG(CCK_CCA,pDM_Odm), CurCCK_CCAThres); ++ pDM_DigTable->cckFaMa = 0xffffffff; ++ } ++ pDM_DigTable->PreCCK_CCAThres = pDM_DigTable->CurCCK_CCAThres; ++ pDM_DigTable->CurCCK_CCAThres = CurCCK_CCAThres; ++} ++ ++BOOLEAN ++phydm_DIG_GoUpCheck( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ u1Byte CurIGValue = pDM_DigTable->CurIGValue; ++ u1Byte max_DIG_cover_bond; ++ u1Byte current_IGI_MaxUp_resolution; ++ u1Byte rx_gain_range_max; ++ u1Byte i = 0; ++ ++ u4Byte total_NHM_cnt; ++ u4Byte DIG_cover_cnt; ++ u4Byte over_DIG_cover_cnt; ++ BOOLEAN ret = TRUE; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ ++ max_DIG_cover_bond = DM_DIG_MAX_AP - priv->pshare->rf_ft_var.dig_upcheck_initial_value; ++ current_IGI_MaxUp_resolution = CurIGValue + 6; ++ rx_gain_range_max = pDM_DigTable->rx_gain_range_max; ++ ++ phydm_getNHMresult(pDM_Odm); ++ ++ total_NHM_cnt = CCX_INFO->NHM_result[0] + CCX_INFO->NHM_result[1]; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): *****Get NHM results*****\n")); ++ ++ if (total_NHM_cnt != 0) { ++ ++ /* CurIGValue < max_DIG_cover_bond - 6 */ ++ if (pDM_DigTable->DIG_GoUpCheck_Level == DIG_GOUPCHECK_LEVEL_0) { ++ DIG_cover_cnt = CCX_INFO->NHM_result[1]; ++ ret = ((priv->pshare->rf_ft_var.dig_level0_ratio_reciprocal * DIG_cover_cnt) >= total_NHM_cnt) ? TRUE : FALSE; ++ } ++ ++ /* (max_DIG_cover_bond - 6) <= CurIGValue < DM_DIG_MAX_AP */ ++ else if (pDM_DigTable->DIG_GoUpCheck_Level == DIG_GOUPCHECK_LEVEL_1) { ++ over_DIG_cover_cnt = CCX_INFO->NHM_result[1]; ++ ret = (priv->pshare->rf_ft_var.dig_level1_ratio_reciprocal * over_DIG_cover_cnt < total_NHM_cnt) ? TRUE : FALSE; ++ ++ if (!ret) { ++ /* update pDM_DigTable->rx_gain_range_max */ ++ pDM_DigTable->rx_gain_range_max = (rx_gain_range_max >= max_DIG_cover_bond - 6) ? (max_DIG_cover_bond - 6) : rx_gain_range_max; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): Noise power is beyond DIG can filter, lock rx_gain_range_max to 0x%x\n", ++ pDM_DigTable->rx_gain_range_max)); ++ } ++ } ++ ++ /* CurIGValue > DM_DIG_MAX_AP, foolproof */ ++ else if (pDM_DigTable->DIG_GoUpCheck_Level == DIG_GOUPCHECK_LEVEL_2) { ++ ret = TRUE; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): DIG_GoUpCheck_level = %d\n, current_IGI_MaxUp_resolution = 0x%x\n, max_DIG_cover_bond = 0x%x\n, rx_gain_range_max = 0x%x, ret = %d\n", ++ pDM_DigTable->DIG_GoUpCheck_Level, ++ current_IGI_MaxUp_resolution, ++ max_DIG_cover_bond, ++ pDM_DigTable->rx_gain_range_max, ++ ret)); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): NHM_result = %d, %d, %d, %d\n", ++ CCX_INFO->NHM_result[0], CCX_INFO->NHM_result[1], CCX_INFO->NHM_result[2], CCX_INFO->NHM_result[3])); ++ ++ } ++ else ++ ret = TRUE; ++ ++ for (i = 0 ; i <= 10 ; i ++) { ++ CCX_INFO->NHM_th[i] = 0xFF; ++ } ++ ++ if (CurIGValue < max_DIG_cover_bond - 6){ ++ CCX_INFO->NHM_th[0] = 2 * (CurIGValue - priv->pshare->rf_ft_var.dig_upcheck_initial_value); ++ pDM_DigTable->DIG_GoUpCheck_Level = DIG_GOUPCHECK_LEVEL_0; ++ } ++ else if (CurIGValue <= DM_DIG_MAX_AP) { ++ CCX_INFO->NHM_th[0] = 2 * max_DIG_cover_bond; ++ pDM_DigTable->DIG_GoUpCheck_Level = DIG_GOUPCHECK_LEVEL_1; ++ } ++ /* CurIGValue > DM_DIG_MAX_AP, foolproof */ ++ else { ++ pDM_DigTable->DIG_GoUpCheck_Level = DIG_GOUPCHECK_LEVEL_2; ++ ret = TRUE; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): *****Set NHM settings*****\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): DIG_GoUpCheck_level = %d\n", ++ pDM_DigTable->DIG_GoUpCheck_Level)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): NHM_th = 0x%x, 0x%x, 0x%x\n", ++ CCX_INFO->NHM_th[0], CCX_INFO->NHM_th[1], CCX_INFO->NHM_th[2])); ++ ++ CCX_INFO->NHM_inexclude_cca = NHM_EXCLUDE_CCA; ++ CCX_INFO->NHM_inexclude_txon = NHM_EXCLUDE_TXON; ++ CCX_INFO->NHM_period = 0xC350; ++ ++ phydm_NHMsetting(pDM_Odm, SET_NHM_SETTING); ++ phydm_NHMtrigger(pDM_Odm); ++#endif ++ ++ return ret; ++} ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++// <20130108, Kordan> E.g., With LNA used, we make the Rx power smaller to have a better EVM. (Asked by Willis) ++VOID ++odm_RFEControl( ++ IN PDM_ODM_T pDM_Odm, ++ IN u8Byte RSSIVal ++ ) ++{ ++ PADAPTER Adapter = (PADAPTER)pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ static u1Byte TRSW_HighPwr = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("===> odm_RFEControl, RSSI = %d, TRSW_HighPwr = 0x%X, pHalData->RFEType = %d\n", ++ RSSIVal, TRSW_HighPwr, pHalData->RFEType )); ++ ++ if (pHalData->RFEType == 3) { ++ ++ pDM_Odm->RSSI_TRSW = RSSIVal; ++ ++ if (pDM_Odm->RSSI_TRSW >= pDM_Odm->RSSI_TRSW_H) ++ { ++ TRSW_HighPwr = 1; // Switch to ++ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x1); // Set ANTSW=1/ANTSWB=0 for SW control ++ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); // Set ANTSW=1/ANTSWB=0 for SW control ++ ++ } ++ else if (pDM_Odm->RSSI_TRSW <= pDM_Odm->RSSI_TRSW_L) ++ { ++ TRSW_HighPwr = 0; // Switched back ++ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x1); // Set ANTSW=1/ANTSWB=0 for SW control ++ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x0); // Set ANTSW=1/ANTSWB=0 for SW control ++ ++ } ++ } ++ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("(pDM_Odm->RSSI_TRSW_H, pDM_Odm->RSSI_TRSW_L) = (%d, %d)\n", pDM_Odm->RSSI_TRSW_H, pDM_Odm->RSSI_TRSW_L)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("(RSSIVal, RSSIVal, pDM_Odm->RSSI_TRSW_iso) = (%d, %d, %d)\n", ++ RSSIVal, pDM_Odm->RSSI_TRSW_iso, pDM_Odm->RSSI_TRSW)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("<=== odm_RFEControl, RSSI = %d, TRSW_HighPwr = 0x%X\n", RSSIVal, TRSW_HighPwr)); ++} ++ ++VOID ++odm_MPT_DIGWorkItemCallback( ++ IN PVOID pContext ++ ) ++{ ++ PADAPTER Adapter = (PADAPTER)pContext; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ ++ ODM_MPT_DIG(pDM_Odm); ++} ++ ++VOID ++odm_MPT_DIGCallback( ++ PRT_TIMER pTimer ++) ++{ ++ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ ++ ++ #if DEV_BUS_TYPE==RT_PCI_INTERFACE ++ #if USE_WORKITEM ++ PlatformScheduleWorkItem(&pDM_Odm->MPT_DIGWorkitem); ++ #else ++ ODM_MPT_DIG(pDM_Odm); ++ #endif ++ #else ++ PlatformScheduleWorkItem(&pDM_Odm->MPT_DIGWorkitem); ++ #endif ++ ++} ++ ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++VOID ++odm_MPT_DIGCallback( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if USE_WORKITEM ++ PlatformScheduleWorkItem(&pDM_Odm->MPT_DIGWorkitem); ++#else ++ ODM_MPT_DIG(pDM_Odm); ++#endif ++} ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE != ODM_CE) ++VOID ++odm_MPT_Write_DIG( ++ IN PVOID pDM_VOID, ++ IN u1Byte CurIGValue ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_A,pDM_Odm), CurIGValue); ++ ++#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) ++ /* Set IGI value of CCK for new CCK AGC */ ++ if (pDM_Odm->cck_new_agc) { ++ if (pDM_Odm->SupportICType & ODM_IC_PHY_STATUE_NEW_TYPE) ++ ODM_SetBBReg(pDM_Odm, 0xa0c, 0x00003f00, (CurIGValue>>1)); ++ } ++ ++#endif ++ ++ if(pDM_Odm->RFType > ODM_1T1R) ++ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_B,pDM_Odm), CurIGValue); ++ ++ if((pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) && (pDM_Odm->RFType > ODM_2T2R)) ++ { ++ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_C,pDM_Odm), CurIGValue); ++ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_D,pDM_Odm), CurIGValue); ++ } ++ ++ pDM_DigTable->CurIGValue = CurIGValue; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("CurIGValue = 0x%x\n", CurIGValue)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("pDM_Odm->RFType = 0x%x\n", pDM_Odm->RFType)); ++} ++ ++VOID ++ODM_MPT_DIG( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); ++ u1Byte CurrentIGI = pDM_DigTable->CurIGValue; ++ u1Byte DIG_Upper = 0x40, DIG_Lower = 0x20; ++ u4Byte RXOK_cal; ++ u4Byte RxPWDBAve_final; ++ u1Byte IGI_A = 0x20, IGI_B = 0x20; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++ #if ODM_FIX_2G_DIG ++ IGI_A = 0x22; ++ IGI_B = 0x24; ++ #endif ++ ++#else ++ if (!(pDM_Odm->priv->pshare->rf_ft_var.mp_specific && pDM_Odm->priv->pshare->mp_dig_on)) ++ return; ++ ++ if (*pDM_Odm->pBandType == ODM_BAND_5G) ++ DIG_Lower = 0x22; ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("===> ODM_MPT_DIG, pBandType = %d\n", *pDM_Odm->pBandType)); ++ ++#if (ODM_FIX_2G_DIG || (DM_ODM_SUPPORT_TYPE & ODM_AP)) ++ if (*pDM_Odm->pBandType == ODM_BAND_5G || (pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B))) // for 5G or 8814 ++#else ++ if (1) // for both 2G/5G ++#endif ++ { ++ odm_FalseAlarmCounterStatistics(pDM_Odm); ++ ++ RXOK_cal = pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK + pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM; ++ RxPWDBAve_final = (RXOK_cal != 0)?pDM_Odm->RxPWDBAve/RXOK_cal:0; ++ ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; ++ pDM_Odm->RxPWDBAve = 0; ++ pDM_Odm->MPDIG_2G = FALSE; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ pDM_Odm->Times_2G = 0; ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("RX OK = %d\n", RXOK_cal)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("RSSI = %d\n", RxPWDBAve_final)); ++ ++ if (RXOK_cal >= 70 && RxPWDBAve_final <= 40) ++ { ++ if (CurrentIGI > 0x24) ++ odm_MPT_Write_DIG(pDM_Odm, 0x24); ++ } ++ else ++ { ++ if(pFalseAlmCnt->Cnt_all > 1000){ ++ CurrentIGI = CurrentIGI + 8; ++ } ++ else if(pFalseAlmCnt->Cnt_all > 200){ ++ CurrentIGI = CurrentIGI + 4; ++ } ++ else if (pFalseAlmCnt->Cnt_all > 50){ ++ CurrentIGI = CurrentIGI + 2; ++ } ++ else if (pFalseAlmCnt->Cnt_all < 2){ ++ CurrentIGI = CurrentIGI - 2; ++ } ++ ++ if (CurrentIGI < DIG_Lower ){ ++ CurrentIGI = DIG_Lower; ++ } ++ ++ if(CurrentIGI > DIG_Upper){ ++ CurrentIGI = DIG_Upper; ++ } ++ ++ odm_MPT_Write_DIG(pDM_Odm, CurrentIGI); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("DIG = 0x%x, Cnt_all = %d, Cnt_Ofdm_fail = %d, Cnt_Cck_fail = %d\n", ++ CurrentIGI, pFalseAlmCnt->Cnt_all, pFalseAlmCnt->Cnt_Ofdm_fail, pFalseAlmCnt->Cnt_Cck_fail)); ++ } ++ } ++ else ++ { ++ if(pDM_Odm->MPDIG_2G == FALSE) ++ { ++ if((pDM_Odm->SupportPlatform & ODM_WIN) && !(pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B))) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("===> Fix IGI\n")); ++ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_A,pDM_Odm), IGI_A); ++ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_B,pDM_Odm), IGI_B); ++ pDM_DigTable->CurIGValue = IGI_B; ++ } ++ else ++ odm_MPT_Write_DIG(pDM_Odm, IGI_A); ++ } ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ pDM_Odm->Times_2G++; ++ ++ if (pDM_Odm->Times_2G == 3) ++#endif ++ { ++ pDM_Odm->MPDIG_2G = TRUE; ++ } ++ } ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ odm_RFEControl(pDM_Odm, RxPWDBAve_final); ++#endif ++ ++ ODM_SetTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer, 700); ++} ++#endif ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dig.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dig.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dig.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dig.h 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,370 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMDIG_H__ ++#define __PHYDMDIG_H__ ++ ++#define DIG_VERSION "1.24" /* 2016.06.01 Stanley. Modify IGI setting for 1R-CCA path-B */ ++ ++/* Pause DIG & CCKPD */ ++#define DM_DIG_MAX_PAUSE_TYPE 0x7 ++ ++typedef enum tag_DIG_GoUpCheck_Level { ++ ++ DIG_GOUPCHECK_LEVEL_0, ++ DIG_GOUPCHECK_LEVEL_1, ++ DIG_GOUPCHECK_LEVEL_2 ++ ++} DIG_GOUPCHECK_LEVEL; ++ ++typedef struct _Dynamic_Initial_Gain_Threshold_ ++{ ++ BOOLEAN bStopDIG; // for debug ++ BOOLEAN bIgnoreDIG; ++ BOOLEAN bPSDInProgress; ++ ++ u1Byte Dig_Enable_Flag; ++ u1Byte Dig_Ext_Port_Stage; ++ ++ int RssiLowThresh; ++ int RssiHighThresh; ++ ++ u4Byte FALowThresh; ++ u4Byte FAHighThresh; ++ ++ u1Byte CurSTAConnectState; ++ u1Byte PreSTAConnectState; ++ u1Byte CurMultiSTAConnectState; ++ ++ u1Byte PreIGValue; ++ u1Byte CurIGValue; ++ u1Byte BackupIGValue; //MP DIG ++ u1Byte BT30_CurIGI; ++ u1Byte IGIBackup; ++ ++ s1Byte BackoffVal; ++ s1Byte BackoffVal_range_max; ++ s1Byte BackoffVal_range_min; ++ u1Byte rx_gain_range_max; ++ u1Byte rx_gain_range_min; ++ u1Byte Rssi_val_min; ++ ++ u1Byte PreCCK_CCAThres; ++ u1Byte CurCCK_CCAThres; ++ u1Byte PreCCKPDState; ++ u1Byte CurCCKPDState; ++ u1Byte CCKPDBackup; ++ u1Byte pause_cckpd_level; ++ u1Byte pause_cckpd_value[DM_DIG_MAX_PAUSE_TYPE + 1]; ++ ++ u1Byte LargeFAHit; ++ u1Byte LargeFA_Timeout; /*if (LargeFAHit), monitor "LargeFA_Timeout" sec, if timeout, LargeFAHit=0*/ ++ u1Byte ForbiddenIGI; ++ u4Byte Recover_cnt; ++ ++ u1Byte DIG_Dynamic_MIN_0; ++ u1Byte DIG_Dynamic_MIN_1; ++ BOOLEAN bMediaConnect_0; ++ BOOLEAN bMediaConnect_1; ++ ++ u4Byte AntDiv_RSSI_max; ++ u4Byte RSSI_max; ++ ++ u1Byte *bP2PInProcess; ++ ++ u1Byte pause_dig_level; ++ u1Byte pause_dig_value[DM_DIG_MAX_PAUSE_TYPE + 1]; ++ ++ u4Byte cckFaMa; ++ DIG_GOUPCHECK_LEVEL DIG_GoUpCheck_Level; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ BOOLEAN bTpTarget; ++ BOOLEAN bNoiseEst; ++ u4Byte TpTrainTH_min; ++ u1Byte IGIOffset_A; ++ u1Byte IGIOffset_B; ++#endif ++ ++#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) ++ u1Byte rfGainIdx; ++ u1Byte agcTableIdx; ++ u1Byte bigJumpLmt[16]; ++ u1Byte enableAdjustBigJump:1; ++ u1Byte bigJumpStep1:3; ++ u1Byte bigJumpStep2:2; ++ u1Byte bigJumpStep3:2; ++#endif ++}DIG_T,*pDIG_T; ++ ++typedef struct _FALSE_ALARM_STATISTICS{ ++ u4Byte Cnt_Parity_Fail; ++ u4Byte Cnt_Rate_Illegal; ++ u4Byte Cnt_Crc8_fail; ++ u4Byte Cnt_Mcs_fail; ++ u4Byte Cnt_Ofdm_fail; ++ u4Byte Cnt_Ofdm_fail_pre; //For RTL8881A ++ u4Byte Cnt_Cck_fail; ++ u4Byte Cnt_all; ++ u4Byte Cnt_all_pre; ++ u4Byte Cnt_Fast_Fsync; ++ u4Byte Cnt_SB_Search_fail; ++ u4Byte Cnt_OFDM_CCA; ++ u4Byte Cnt_CCK_CCA; ++ u4Byte Cnt_CCA_all; ++ u4Byte Cnt_BW_USC; //Gary ++ u4Byte Cnt_BW_LSC; //Gary ++ u4Byte cnt_cck_crc32_error; ++ u4Byte cnt_cck_crc32_ok; ++ u4Byte cnt_ofdm_crc32_error; ++ u4Byte cnt_ofdm_crc32_ok; ++ u4Byte cnt_ht_crc32_error; ++ u4Byte cnt_ht_crc32_ok; ++ u4Byte cnt_vht_crc32_error; ++ u4Byte cnt_vht_crc32_ok; ++ u4Byte cnt_crc32_error_all; ++ u4Byte cnt_crc32_ok_all; ++ BOOLEAN cck_block_enable; ++ BOOLEAN ofdm_block_enable; ++ u4Byte dbg_port0; ++ BOOLEAN edcca_flag; ++}FALSE_ALARM_STATISTICS, *PFALSE_ALARM_STATISTICS; ++ ++typedef enum tag_Dynamic_Init_Gain_Operation_Type_Definition ++{ ++ DIG_TYPE_THRESH_HIGH = 0, ++ DIG_TYPE_THRESH_LOW = 1, ++ DIG_TYPE_BACKOFF = 2, ++ DIG_TYPE_RX_GAIN_MIN = 3, ++ DIG_TYPE_RX_GAIN_MAX = 4, ++ DIG_TYPE_ENABLE = 5, ++ DIG_TYPE_DISABLE = 6, ++ DIG_OP_TYPE_MAX ++}DM_DIG_OP_E; ++ ++/* ++typedef enum tag_CCK_Packet_Detection_Threshold_Type_Definition ++{ ++ CCK_PD_STAGE_LowRssi = 0, ++ CCK_PD_STAGE_HighRssi = 1, ++ CCK_PD_STAGE_MAX = 3, ++}DM_CCK_PDTH_E; ++ ++typedef enum tag_DIG_EXT_PORT_ALGO_Definition ++{ ++ DIG_EXT_PORT_STAGE_0 = 0, ++ DIG_EXT_PORT_STAGE_1 = 1, ++ DIG_EXT_PORT_STAGE_2 = 2, ++ DIG_EXT_PORT_STAGE_3 = 3, ++ DIG_EXT_PORT_STAGE_MAX = 4, ++}DM_DIG_EXT_PORT_ALG_E; ++ ++typedef enum tag_DIG_Connect_Definition ++{ ++ DIG_STA_DISCONNECT = 0, ++ DIG_STA_CONNECT = 1, ++ DIG_STA_BEFORE_CONNECT = 2, ++ DIG_MultiSTA_DISCONNECT = 3, ++ DIG_MultiSTA_CONNECT = 4, ++ DIG_CONNECT_MAX ++}DM_DIG_CONNECT_E; ++ ++ ++#define DM_MultiSTA_InitGainChangeNotify(Event) {DM_DigTable.CurMultiSTAConnectState = Event;} ++ ++#define DM_MultiSTA_InitGainChangeNotify_CONNECT(_ADAPTER) \ ++ DM_MultiSTA_InitGainChangeNotify(DIG_MultiSTA_CONNECT) ++ ++#define DM_MultiSTA_InitGainChangeNotify_DISCONNECT(_ADAPTER) \ ++ DM_MultiSTA_InitGainChangeNotify(DIG_MultiSTA_DISCONNECT) ++*/ ++ ++typedef enum tag_PHYDM_Pause_Type { ++ PHYDM_PAUSE = BIT0, ++ PHYDM_RESUME = BIT1 ++} PHYDM_PAUSE_TYPE; ++ ++typedef enum tag_PHYDM_Pause_Level { ++/* number of pause level can't exceed DM_DIG_MAX_PAUSE_TYPE */ ++ PHYDM_PAUSE_LEVEL_0 = 0, ++ PHYDM_PAUSE_LEVEL_1 = 1, ++ PHYDM_PAUSE_LEVEL_2 = 2, ++ PHYDM_PAUSE_LEVEL_3 = 3, ++ PHYDM_PAUSE_LEVEL_4 = 4, ++ PHYDM_PAUSE_LEVEL_5 = 5, ++ PHYDM_PAUSE_LEVEL_6 = 6, ++ PHYDM_PAUSE_LEVEL_7 = DM_DIG_MAX_PAUSE_TYPE /* maximum level */ ++} PHYDM_PAUSE_LEVEL; ++ ++#define DM_DIG_THRESH_HIGH 40 ++#define DM_DIG_THRESH_LOW 35 ++ ++#define DM_FALSEALARM_THRESH_LOW 400 ++#define DM_FALSEALARM_THRESH_HIGH 1000 ++ ++#define DM_DIG_MAX_NIC 0x3e ++#define DM_DIG_MIN_NIC 0x20 ++#define DM_DIG_MAX_OF_MIN_NIC 0x3e ++ ++#define DM_DIG_MAX_AP 0x3e ++#define DM_DIG_MIN_AP 0x20 ++#define DM_DIG_MAX_OF_MIN 0x2A //0x32 ++#define DM_DIG_MIN_AP_DFS 0x20 ++ ++#define DM_DIG_MAX_NIC_HP 0x46 ++#define DM_DIG_MIN_NIC_HP 0x2e ++ ++#define DM_DIG_MAX_AP_HP 0x42 ++#define DM_DIG_MIN_AP_HP 0x30 ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++#define DM_DIG_MAX_AP_COVERAGR 0x26 ++#define DM_DIG_MIN_AP_COVERAGE 0x1c ++#define DM_DIG_MAX_OF_MIN_COVERAGE 0x22 ++ ++#define DM_DIG_TP_Target_TH0 500 ++#define DM_DIG_TP_Target_TH1 1000 ++#define DM_DIG_TP_Training_Period 10 ++#endif ++ ++//vivi 92c&92d has different definition, 20110504 ++//this is for 92c ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ #ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV ++ #define DM_DIG_FA_TH0 0x80//0x20 ++ #else ++ #define DM_DIG_FA_TH0 0x200//0x20 ++ #endif ++#else ++ #define DM_DIG_FA_TH0 0x200//0x20 ++#endif ++ ++#define DM_DIG_FA_TH1 0x300 ++#define DM_DIG_FA_TH2 0x400 ++//this is for 92d ++#define DM_DIG_FA_TH0_92D 0x100 ++#define DM_DIG_FA_TH1_92D 0x400 ++#define DM_DIG_FA_TH2_92D 0x600 ++ ++#define DM_DIG_BACKOFF_MAX 12 ++#define DM_DIG_BACKOFF_MIN -4 ++#define DM_DIG_BACKOFF_DEFAULT 10 ++ ++#define DM_DIG_FA_TH0_LPS 4 //-> 4 in lps ++#define DM_DIG_FA_TH1_LPS 15 //-> 15 lps ++#define DM_DIG_FA_TH2_LPS 30 //-> 30 lps ++#define RSSI_OFFSET_DIG 0x05 ++#define LARGE_FA_TIMEOUT 60 ++ ++ ++VOID ++ODM_ChangeDynamicInitGainThresh( ++ IN PVOID pDM_VOID, ++ IN u4Byte DM_Type, ++ IN u4Byte DM_Value ++ ); ++ ++VOID ++ODM_Write_DIG( ++ IN PVOID pDM_VOID, ++ IN u1Byte CurrentIGI ++ ); ++ ++VOID ++odm_PauseDIG( ++ IN PVOID pDM_VOID, ++ IN PHYDM_PAUSE_TYPE PauseType, ++ IN PHYDM_PAUSE_LEVEL pause_level, ++ IN u1Byte IGIValue ++ ); ++ ++VOID ++odm_DIGInit( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_DIG( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_DIGbyRSSI_LPS( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_FalseAlarmCounterStatistics( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_PauseCCKPacketDetection( ++ IN PVOID pDM_VOID, ++ IN PHYDM_PAUSE_TYPE PauseType, ++ IN PHYDM_PAUSE_LEVEL pause_level, ++ IN u1Byte CCKPDThreshold ++ ); ++ ++VOID ++odm_CCKPacketDetectionThresh( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++ODM_Write_CCK_CCA_Thres( ++ IN PVOID pDM_VOID, ++ IN u1Byte CurCCK_CCAThres ++ ); ++ ++BOOLEAN ++phydm_DIG_GoUpCheck( ++ IN PVOID pDM_VOID ++ ); ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++odm_MPT_DIGCallback( ++ PRT_TIMER pTimer ++); ++ ++VOID ++odm_MPT_DIGWorkItemCallback( ++ IN PVOID pContext ++ ); ++ ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++VOID ++odm_MPT_DIGCallback( ++ IN PVOID pDM_VOID ++); ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE != ODM_CE) ++VOID ++ODM_MPT_DIG( ++ IN PVOID pDM_VOID ++); ++#endif ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.c 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,124 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++#if (defined(CONFIG_BB_POWER_SAVING)) ++ ++VOID ++odm_DynamicBBPowerSavingInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; ++ ++ pDM_PSTable->PreCCAState = CCA_MAX; ++ pDM_PSTable->CurCCAState = CCA_MAX; ++ pDM_PSTable->PreRFState = RF_MAX; ++ pDM_PSTable->CurRFState = RF_MAX; ++ pDM_PSTable->Rssi_val_min = 0; ++ pDM_PSTable->initialize = 0; ++} ++ ++void ++ODM_RF_Saving( ++ IN PVOID pDM_VOID, ++ IN u1Byte bForceInNormal ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; ++ u1Byte Rssi_Up_bound = 30 ; ++ u1Byte Rssi_Low_bound = 25; ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ if(pDM_Odm->PatchID == 40 ) //RT_CID_819x_FUNAI_TV ++ { ++ Rssi_Up_bound = 50 ; ++ Rssi_Low_bound = 45; ++ } ++#endif ++ if(pDM_PSTable->initialize == 0){ ++ ++ pDM_PSTable->Reg874 = (ODM_GetBBReg(pDM_Odm, 0x874, bMaskDWord)&0x1CC000)>>14; ++ pDM_PSTable->RegC70 = (ODM_GetBBReg(pDM_Odm, 0xc70, bMaskDWord)&BIT3)>>3; ++ pDM_PSTable->Reg85C = (ODM_GetBBReg(pDM_Odm, 0x85c, bMaskDWord)&0xFF000000)>>24; ++ pDM_PSTable->RegA74 = (ODM_GetBBReg(pDM_Odm, 0xa74, bMaskDWord)&0xF000)>>12; ++ //Reg818 = PHY_QueryBBReg(pAdapter, 0x818, bMaskDWord); ++ pDM_PSTable->initialize = 1; ++ } ++ ++ if(!bForceInNormal) ++ { ++ if(pDM_Odm->RSSI_Min != 0xFF) ++ { ++ if(pDM_PSTable->PreRFState == RF_Normal) ++ { ++ if(pDM_Odm->RSSI_Min >= Rssi_Up_bound) ++ pDM_PSTable->CurRFState = RF_Save; ++ else ++ pDM_PSTable->CurRFState = RF_Normal; ++ } ++ else{ ++ if(pDM_Odm->RSSI_Min <= Rssi_Low_bound) ++ pDM_PSTable->CurRFState = RF_Normal; ++ else ++ pDM_PSTable->CurRFState = RF_Save; ++ } ++ } ++ else ++ pDM_PSTable->CurRFState=RF_MAX; ++ } ++ else ++ { ++ pDM_PSTable->CurRFState = RF_Normal; ++ } ++ ++ if(pDM_PSTable->PreRFState != pDM_PSTable->CurRFState) ++ { ++ if(pDM_PSTable->CurRFState == RF_Save) ++ { ++ ODM_SetBBReg(pDM_Odm, 0x874 , 0x1C0000, 0x2); //Reg874[20:18]=3'b010 ++ ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, 0); //RegC70[3]=1'b0 ++ ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, 0x63); //Reg85C[31:24]=0x63 ++ ODM_SetBBReg(pDM_Odm, 0x874, 0xC000, 0x2); //Reg874[15:14]=2'b10 ++ ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, 0x3); //RegA75[7:4]=0x3 ++ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x0); //Reg818[28]=1'b0 ++ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x1); //Reg818[28]=1'b1 ++ } ++ else ++ { ++ ODM_SetBBReg(pDM_Odm, 0x874 , 0x1CC000, pDM_PSTable->Reg874); ++ ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, pDM_PSTable->RegC70); ++ ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, pDM_PSTable->Reg85C); ++ ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, pDM_PSTable->RegA74); ++ ODM_SetBBReg(pDM_Odm,0x818, BIT28, 0x0); ++ } ++ pDM_PSTable->PreRFState =pDM_PSTable->CurRFState; ++ } ++#endif ++} ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.h 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,58 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMDYNAMICBBPOWERSAVING_H__ ++#define __PHYDMDYNAMICBBPOWERSAVING_H__ ++ ++#define DYNAMIC_BBPWRSAV_VERSION "1.1" ++ ++#if (defined(CONFIG_BB_POWER_SAVING)) ++ ++typedef struct _Dynamic_Power_Saving_ ++{ ++ u1Byte PreCCAState; ++ u1Byte CurCCAState; ++ ++ u1Byte PreRFState; ++ u1Byte CurRFState; ++ ++ int Rssi_val_min; ++ ++ u1Byte initialize; ++ u4Byte Reg874,RegC70,Reg85C,RegA74; ++ ++}PS_T,*pPS_T; ++ ++#define dm_RF_Saving ODM_RF_Saving ++ ++void ODM_RF_Saving( ++ IN PVOID pDM_VOID, ++ IN u1Byte bForceInNormal ++); ++ ++VOID ++odm_DynamicBBPowerSavingInit( ++ IN PVOID pDM_VOID ++ ); ++#else ++#define dm_RF_Saving(pDM_VOID, bForceInNormal) ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.c 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,542 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++VOID ++odm_DynamicTxPowerInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ /*if (!IS_HARDWARE_TYPE_8814A(Adapter)) {*/ ++ /* ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, */ ++ /* ("odm_DynamicTxPowerInit DynamicTxPowerEnable=%d\n", pMgntInfo->bDynamicTxPowerEnable));*/ ++ /* return;*/ ++ /*} else*/ ++ { ++ pMgntInfo->bDynamicTxPowerEnable = TRUE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ++ ("odm_DynamicTxPowerInit DynamicTxPowerEnable=%d\n", pMgntInfo->bDynamicTxPowerEnable)); ++ } ++ ++ #if DEV_BUS_TYPE==RT_USB_INTERFACE ++ if(RT_GetInterfaceSelection(Adapter) == INTF_SEL1_USB_High_Power) ++ { ++ odm_DynamicTxPowerSavePowerIndex(pDM_Odm); ++ pMgntInfo->bDynamicTxPowerEnable = TRUE; ++ } ++ else ++ #else ++ //so 92c pci do not need dynamic tx power? vivi check it later ++ pMgntInfo->bDynamicTxPowerEnable = FALSE; ++ #endif ++ ++ ++ pHalData->LastDTPLvl = TxHighPwrLevel_Normal; ++ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; ++ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ ++ pDM_Odm->LastDTPLvl = TxHighPwrLevel_Normal; ++ pDM_Odm->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; ++ pDM_Odm->tx_agc_ofdm_18_6 = ODM_GetBBReg(pDM_Odm, 0xC24, bMaskDWord); /*TXAGC {18M 12M 9M 6M}*/ ++ ++#endif ++ ++} ++ ++VOID ++odm_DynamicTxPowerSavePowerIndex( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) ++ u1Byte index; ++ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ for(index = 0; index< 6; index++) ++ pHalData->PowerIndex_backup[index] = PlatformEFIORead1Byte(Adapter, Power_Index_REG[index]); ++ ++ ++#endif ++#endif ++} ++ ++VOID ++odm_DynamicTxPowerRestorePowerIndex( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) ++ u1Byte index; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ for(index = 0; index< 6; index++) ++ PlatformEFIOWrite1Byte(Adapter, Power_Index_REG[index], pHalData->PowerIndex_backup[index]); ++ ++ ++#endif ++#endif ++} ++ ++VOID ++odm_DynamicTxPowerWritePowerIndex( ++ IN PVOID pDM_VOID, ++ IN u1Byte Value) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte index; ++ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; ++ ++ for(index = 0; index< 6; index++) ++ //PlatformEFIOWrite1Byte(Adapter, Power_Index_REG[index], Value); ++ ODM_Write1Byte(pDM_Odm, Power_Index_REG[index], Value); ++ ++} ++ ++VOID ++odm_DynamicTxPowerNIC_CE( ++ IN PVOID pDM_VOID ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++#if (RTL8821A_SUPPORT == 1) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte val; ++ u1Byte rssi_tmp = pDM_Odm->RSSI_Min; ++ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) ++ return; ++ ++ if (rssi_tmp >= TX_POWER_NEAR_FIELD_THRESH_LVL2) { ++ pDM_Odm->DynamicTxHighPowerLvl = TxHighPwrLevel_Level2; ++ /**/ ++ } else if (rssi_tmp >= TX_POWER_NEAR_FIELD_THRESH_LVL1) { ++ pDM_Odm->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1; ++ /**/ ++ } else if (rssi_tmp < (TX_POWER_NEAR_FIELD_THRESH_LVL1-5)) { ++ pDM_Odm->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; ++ /**/ ++ } ++ ++ if (pDM_Odm->LastDTPLvl != pDM_Odm->DynamicTxHighPowerLvl) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("update_DTP_lv: ((%d)) -> ((%d))\n", pDM_Odm->LastDTPLvl, pDM_Odm->DynamicTxHighPowerLvl)); ++ ++ pDM_Odm->LastDTPLvl = pDM_Odm->DynamicTxHighPowerLvl; ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8821)) { ++ ++ if (pDM_Odm->DynamicTxHighPowerLvl == TxHighPwrLevel_Level2) { ++ ++ ODM_SetMACReg(pDM_Odm, 0x6D8, BIT20|BIT19|BIT18, 1); /* Resp TXAGC offset = -3dB*/ ++ ++ val = pDM_Odm->tx_agc_ofdm_18_6 & 0xff; ++ if (val >= 0x20) ++ val -= 0x16; ++ ++ ODM_SetBBReg(pDM_Odm, 0xC24, 0xff, val); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("Set TX power: level 2\n")); ++ } else if (pDM_Odm->DynamicTxHighPowerLvl == TxHighPwrLevel_Level1) { ++ ++ ODM_SetMACReg(pDM_Odm, 0x6D8, BIT20|BIT19|BIT18, 1); /* Resp TXAGC offset = -3dB*/ ++ ++ val = pDM_Odm->tx_agc_ofdm_18_6 & 0xff; ++ if (val >= 0x20) ++ val -= 0x10; ++ ++ ODM_SetBBReg(pDM_Odm, 0xC24, 0xff, val); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("Set TX power: level 1\n")); ++ } else if (pDM_Odm->DynamicTxHighPowerLvl == TxHighPwrLevel_Normal) { ++ ++ ODM_SetMACReg(pDM_Odm, 0x6D8, BIT20|BIT19|BIT18, 0); /* Resp TXAGC offset = 0dB*/ ++ ODM_SetBBReg(pDM_Odm, 0xC24, bMaskDWord, pDM_Odm->tx_agc_ofdm_18_6); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("Set TX power: normal\n")); ++ } ++ } ++ } ++ ++#endif ++#endif ++} ++ ++ ++VOID ++odm_DynamicTxPower( ++ IN PVOID pDM_VOID ++ ) ++{ ++ // ++ // For AP/ADSL use prtl8192cd_priv ++ // For CE/NIC use PADAPTER ++ // ++ //PADAPTER pAdapter = pDM_Odm->Adapter; ++// prtl8192cd_priv priv = pDM_Odm->priv; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) ++ return; ++ // ++ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate ++ // at the same time. In the stage2/3, we need to prive universal interface and merge all ++ // HW dynamic mechanism. ++ // ++ switch (pDM_Odm->SupportPlatform) ++ { ++ case ODM_WIN: ++ odm_DynamicTxPowerNIC(pDM_Odm); ++ break; ++ case ODM_CE: ++ odm_DynamicTxPowerNIC_CE(pDM_Odm); ++ break; ++ case ODM_AP: ++ odm_DynamicTxPowerAP(pDM_Odm); ++ break; ++ default: ++ break; ++ } ++ ++ ++} ++ ++ ++VOID ++odm_DynamicTxPowerNIC( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) ++ return; ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8814A) { ++ odm_DynamicTxPower_8814A(pDM_Odm); ++ } else if (pDM_Odm->SupportICType & ODM_RTL8821) { ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PMGNT_INFO pMgntInfo = GetDefaultMgntInfo(Adapter); ++ ++ if (pMgntInfo->RegRspPwr == 1) { ++ if (pDM_Odm->RSSI_Min > 60) ++ ODM_SetMACReg(pDM_Odm, ODM_REG_RESP_TX_11AC, BIT20|BIT19|BIT18, 1); /*Resp TXAGC offset = -3dB*/ ++ else if (pDM_Odm->RSSI_Min < 55) ++ ODM_SetMACReg(pDM_Odm, ODM_REG_RESP_TX_11AC, BIT20|BIT19|BIT18, 0); /*Resp TXAGC offset = 0dB*/ ++ } ++ } ++#endif ++} ++ ++VOID ++odm_DynamicTxPowerAP( ++ IN PVOID pDM_VOID ++ ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++//#if ((RTL8192C_SUPPORT==1) || (RTL8192D_SUPPORT==1) || (RTL8188E_SUPPORT==1) || (RTL8812E_SUPPORT==1)) ++ ++ ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ s4Byte i; ++ s2Byte pwr_thd = 63; ++ ++ if(!priv->pshare->rf_ft_var.tx_pwr_ctrl) ++ return; ++ ++#if ((RTL8812A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) || (RTL8814A_SUPPORT == 1)) ++ if (pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8881A | ODM_RTL8814A)) ++ pwr_thd = TX_POWER_NEAR_FIELD_THRESH_LVL1; ++#endif ++ ++ /* ++ * Check if station is near by to use lower tx power ++ */ ++ ++ if ((priv->up_time % 3) == 0 ) { ++ int disable_pwr_ctrl = ((pDM_Odm->FalseAlmCnt.Cnt_all > 1000 ) || ((pDM_Odm->FalseAlmCnt.Cnt_all > 300 ) && ((RTL_R8(0xc50) & 0x7f) >= 0x32))) ? 1 : 0; ++ ++ for(i=0; ipODM_StaInfo[i]; ++ if(IS_STA_VALID(pstat) ) { ++ if(disable_pwr_ctrl) ++ pstat->hp_level = 0; ++ else if ((pstat->hp_level == 0) && (pstat->rssi > pwr_thd)) ++ pstat->hp_level = 1; ++ else if ((pstat->hp_level == 1) && (pstat->rssi < (pwr_thd-8))) ++ pstat->hp_level = 0; ++ } ++ } ++ ++#if defined(CONFIG_WLAN_HAL_8192EE) ++ if (GET_CHIP_VER(priv) == VERSION_8192E) { ++ if( !disable_pwr_ctrl && (pDM_Odm->RSSI_Min != 0xff) ) { ++ if(pDM_Odm->RSSI_Min > pwr_thd) ++ RRSR_power_control_11n(priv, 1 ); ++ else if(pDM_Odm->RSSI_Min < (pwr_thd-8)) ++ RRSR_power_control_11n(priv, 0 ); ++ } else { ++ RRSR_power_control_11n(priv, 0 ); ++ } ++ } ++#endif ++ ++#ifdef CONFIG_WLAN_HAL_8814AE ++ if (GET_CHIP_VER(priv) == VERSION_8814A) { ++ if (!disable_pwr_ctrl && (pDM_Odm->RSSI_Min != 0xff)) { ++ if (pDM_Odm->RSSI_Min > pwr_thd) ++ RRSR_power_control_14(priv, 1); ++ else if (pDM_Odm->RSSI_Min < (pwr_thd-8)) ++ RRSR_power_control_14(priv, 0); ++ } else { ++ RRSR_power_control_14(priv, 0); ++ } ++ } ++#endif ++ ++ } ++//#endif ++ ++#endif ++} ++ ++VOID ++odm_DynamicTxPower_8821( ++ IN PVOID pDM_VOID, ++ IN pu1Byte pDesc, ++ IN u1Byte macId ++ ) ++{ ++#if (RTL8821A_SUPPORT == 1) ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PSTA_INFO_T pEntry; ++ u1Byte reg0xc56_byte; ++ u1Byte txpwr_offset = 0; ++ ++ pEntry = pDM_Odm->pODM_StaInfo[macId]; ++ ++ reg0xc56_byte = ODM_Read1Byte(pDM_Odm, 0xc56); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("reg0xc56_byte=%d\n", reg0xc56_byte)); ++ ++ if (pEntry[macId].rssi_stat.UndecoratedSmoothedPWDB > 85) { ++ ++ /* Avoid TXAGC error after TX power offset is applied. ++ For example: Reg0xc56=0x6, if txpwr_offset=3( reduce 11dB ) ++ Total power = 6-11= -5( overflow!! ), PA may be burned ! ++ so txpwr_offset should be adjusted by Reg0xc56*/ ++ ++ if (reg0xc56_byte < 7) ++ txpwr_offset = 1; ++ else if (reg0xc56_byte < 11) ++ txpwr_offset = 2; ++ else ++ txpwr_offset = 3; ++ ++ SET_TX_DESC_TX_POWER_OFFSET_8812(pDesc, txpwr_offset); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("odm_DynamicTxPower_8821: RSSI=%d, txpwr_offset=%d\n", pEntry[macId].rssi_stat.UndecoratedSmoothedPWDB, txpwr_offset)); ++ ++ } else{ ++ SET_TX_DESC_TX_POWER_OFFSET_8812(pDesc, txpwr_offset); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("odm_DynamicTxPower_8821: RSSI=%d, txpwr_offset=%d\n", pEntry[macId].rssi_stat.UndecoratedSmoothedPWDB, txpwr_offset)); ++ ++ } ++#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ ++#endif /*#if (RTL8821A_SUPPORT==1)*/ ++} ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++odm_DynamicTxPower_8814A( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ s4Byte UndecoratedSmoothedPWDB; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ++ ("TxLevel=%d pMgntInfo->IOTAction=%x pMgntInfo->bDynamicTxPowerEnable=%d\n", ++ pHalData->DynamicTxHighPowerLvl, pMgntInfo->IOTAction, pMgntInfo->bDynamicTxPowerEnable)); ++ ++ /*STA not connected and AP not connected*/ ++ if ((!pMgntInfo->bMediaConnect) && (pHalData->EntryMinUndecoratedSmoothedPWDB == 0)) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("Not connected to any reset power lvl\n")); ++ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; ++ return; ++ } ++ ++ ++ if ((pMgntInfo->bDynamicTxPowerEnable != TRUE) || pMgntInfo->IOTAction & HT_IOT_ACT_DISABLE_HIGH_POWER) { ++ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; ++ } else { ++ if (pMgntInfo->bMediaConnect) { /*Default port*/ ++ if (ACTING_AS_AP(Adapter) || ACTING_AS_IBSS(Adapter)) { ++ UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("AP Client PWDB = 0x%x\n", UndecoratedSmoothedPWDB)); ++ } else { ++ UndecoratedSmoothedPWDB = pHalData->UndecoratedSmoothedPWDB; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("STA Default Port PWDB = 0x%x\n", UndecoratedSmoothedPWDB)); ++ } ++ } else {/*associated entry pwdb*/ ++ UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("AP Ext Port PWDB = 0x%x\n", UndecoratedSmoothedPWDB)); ++ } ++ ++ /*Should we separate as 2.4G/5G band?*/ ++ ++ if (UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL2) { ++ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level2; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x0)\n")); ++ } else if ((UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL2-3)) && ++ (UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL1)) { ++ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x10)\n")); ++ } else if (UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL1-5)) { ++ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Normal\n")); ++ } ++ } ++ ++ ++ if (pHalData->DynamicTxHighPowerLvl != pHalData->LastDTPLvl) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("odm_DynamicTxPower_8814A() Channel = %d\n" , pHalData->CurrentChannel)); ++ odm_SetTxPowerLevel8814(Adapter, pHalData->CurrentChannel, pHalData->DynamicTxHighPowerLvl); ++ } ++ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ++ ("odm_DynamicTxPower_8814A() Channel = %d TXpower lvl=%d/%d\n" , ++ pHalData->CurrentChannel, pHalData->LastDTPLvl, pHalData->DynamicTxHighPowerLvl)); ++ ++ pHalData->LastDTPLvl = pHalData->DynamicTxHighPowerLvl; ++ ++} ++ ++ ++ ++/**/ ++/*For normal driver we always use the FW method to configure TX power index to reduce I/O transaction.*/ ++/**/ ++/**/ ++VOID ++odm_SetTxPowerLevel8814( ++ IN PADAPTER Adapter, ++ IN u1Byte Channel, ++ IN u1Byte PwrLvl ++ ) ++{ ++#if (DEV_BUS_TYPE == RT_USB_INTERFACE) ++ u4Byte i, j, k = 0; ++ u4Byte value[264] = {0}; ++ u4Byte path = 0, PowerIndex, txagc_table_wd = 0x00801000; ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ u1Byte jaguar2Rates[][4] = { {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}, ++ {MGN_6M, MGN_9M, MGN_12M, MGN_18M}, ++ {MGN_24M, MGN_36M, MGN_48M, MGN_54M}, ++ {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3}, ++ {MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}, ++ {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11}, ++ {MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}, ++ {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19}, ++ {MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23}, ++ {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3}, ++ {MGN_VHT1SS_MCS4, MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7}, ++ {MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9, MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1}, ++ {MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, MGN_VHT2SS_MCS5}, ++ {MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9}, ++ {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3}, ++ {MGN_VHT3SS_MCS4, MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7}, ++ {MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9, 0, 0} }; ++ ++ for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_D; ++path) { ++ ++ u1Byte usb_host = UsbModeQueryHubUsbType(Adapter); ++ u1Byte usb_rfset = UsbModeQueryRfSet(Adapter); ++ u1Byte usb_rf_type = RT_GetRFType(Adapter); ++ ++ for (i = 0; i <= 16; i++) { ++ for (j = 0; j <= 3; j++) { ++ if (jaguar2Rates[i][j] == 0) ++ continue; ++ ++ txagc_table_wd = 0x00801000; ++ PowerIndex = (u4Byte) PHY_GetTxPowerIndex(Adapter, (u1Byte)path, jaguar2Rates[i][j], pHalData->CurrentChannelBW, Channel); ++ ++ /*for Query bus type to recude tx power.*/ ++ if (usb_host != USB_MODE_U3 && usb_rfset == 1 && IS_HARDWARE_TYPE_8814AU(Adapter) && usb_rf_type == RF_3T3R) { ++ if (Channel <= 14) { ++ if (PowerIndex >= 16) ++ PowerIndex -= 16; ++ else ++ PowerIndex = 0; ++ } else ++ PowerIndex = 0; ++ } ++ ++ if (PwrLvl == TxHighPwrLevel_Level1) { ++ if (PowerIndex >= 0x10) ++ PowerIndex -= 0x10; ++ else ++ PowerIndex = 0; ++ } else if (PwrLvl == TxHighPwrLevel_Level2) { ++ PowerIndex = 0; ++ } ++ ++ txagc_table_wd |= (path << 8) | MRateToHwRate(jaguar2Rates[i][j]) | (PowerIndex << 24); ++ ++ PHY_SetTxPowerIndexShadow(Adapter, (u1Byte)PowerIndex, (u1Byte)path, jaguar2Rates[i][j]); ++ ++ value[k++] = txagc_table_wd; ++ } ++ } ++ } ++ ++ if (Adapter->MgntInfo.bScanInProgress == FALSE && Adapter->MgntInfo.RegFWOffload == 2) ++ HalDownloadTxPowerLevel8814(Adapter, value); ++#endif ++} ++#endif ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.h 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,110 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMDYNAMICTXPOWER_H__ ++#define __PHYDMDYNAMICTXPOWER_H__ ++ ++/*#define DYNAMIC_TXPWR_VERSION "1.0"*/ ++/*#define DYNAMIC_TXPWR_VERSION "1.3" */ /*2015.08.26, Add 8814 Dynamic TX power*/ ++#define DYNAMIC_TXPWR_VERSION "1.4" /*2015.11.06, Add CE 8821A Dynamic TX power*/ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ #define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 ++ #define TX_POWER_NEAR_FIELD_THRESH_LVL1 60 ++ #define TX_POWER_NEAR_FIELD_THRESH_AP 0x3F ++#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 ++ #define TX_POWER_NEAR_FIELD_THRESH_LVL1 67 ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 ++ #define TX_POWER_NEAR_FIELD_THRESH_LVL1 60 ++#endif ++ ++#define TxHighPwrLevel_Normal 0 ++#define TxHighPwrLevel_Level1 1 ++#define TxHighPwrLevel_Level2 2 ++ ++#define TxHighPwrLevel_BT1 3 ++#define TxHighPwrLevel_BT2 4 ++#define TxHighPwrLevel_15 5 ++#define TxHighPwrLevel_35 6 ++#define TxHighPwrLevel_50 7 ++#define TxHighPwrLevel_70 8 ++#define TxHighPwrLevel_100 9 ++ ++VOID ++odm_DynamicTxPowerInit( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_DynamicTxPowerRestorePowerIndex( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_DynamicTxPowerNIC( ++ IN PVOID pDM_VOID ++ ); ++ ++#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++VOID ++odm_DynamicTxPowerSavePowerIndex( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_DynamicTxPowerWritePowerIndex( ++ IN PVOID pDM_VOID, ++ IN u1Byte Value); ++ ++VOID ++odm_DynamicTxPower_8821( ++ IN PVOID pDM_VOID, ++ IN pu1Byte pDesc, ++ IN u1Byte macId ++ ); ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++odm_DynamicTxPower_8814A( ++ IN PVOID pDM_VOID ++ ); ++ ++ ++VOID ++odm_SetTxPowerLevel8814( ++ IN PADAPTER Adapter, ++ IN u1Byte Channel, ++ IN u1Byte PwrLvl ++ ); ++#endif ++#endif ++ ++VOID ++odm_DynamicTxPower( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_DynamicTxPowerAP( ++ IN PVOID pDM_VOID ++ ); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.c 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,766 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++VOID ++ODM_EdcaTurboInit( ++ IN PVOID pDM_VOID) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++#if (DM_ODM_SUPPORT_TYPE==ODM_WIN) ++ PADAPTER Adapter = NULL; ++ HAL_DATA_TYPE *pHalData = NULL; ++ ++ if(pDM_Odm->Adapter==NULL) { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EdcaTurboInit fail!!!\n")); ++ return; ++ } ++ ++ Adapter=pDM_Odm->Adapter; ++ pHalData=GET_HAL_DATA(Adapter); ++ ++ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE; ++ pDM_Odm->DM_EDCA_Table.bIsCurRDLState = FALSE; ++ pHalData->bIsAnyNonBEPkts = FALSE; ++ ++#elif(DM_ODM_SUPPORT_TYPE==ODM_CE) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE; ++ pDM_Odm->DM_EDCA_Table.bIsCurRDLState = FALSE; ++ Adapter->recvpriv.bIsAnyNonBEPkts =FALSE; ++ ++#endif ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VO PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VO_PARAM))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VI PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VI_PARAM))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BE PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BE_PARAM))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BK PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BK_PARAM))); ++ ++ ++} // ODM_InitEdcaTurbo ++ ++VOID ++odm_EdcaTurboCheck( ++ IN PVOID pDM_VOID ++ ) ++{ ++ // ++ // For AP/ADSL use prtl8192cd_priv ++ // For CE/NIC use PADAPTER ++ // ++ ++ // ++ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate ++ // at the same time. In the stage2/3, we need to prive universal interface and merge all ++ // HW dynamic mechanism. ++ // ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("odm_EdcaTurboCheck========================>\n")); ++ ++ if(!(pDM_Odm->SupportAbility& ODM_MAC_EDCA_TURBO )) ++ return; ++ ++ switch (pDM_Odm->SupportPlatform) ++ { ++ case ODM_WIN: ++ ++#if(DM_ODM_SUPPORT_TYPE==ODM_WIN) ++ odm_EdcaTurboCheckMP(pDM_Odm); ++#endif ++ break; ++ ++ case ODM_CE: ++#if(DM_ODM_SUPPORT_TYPE==ODM_CE) ++ odm_EdcaTurboCheckCE(pDM_Odm); ++#endif ++ break; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("<========================odm_EdcaTurboCheck\n")); ++ ++} // odm_CheckEdcaTurbo ++ ++#if(DM_ODM_SUPPORT_TYPE==ODM_CE) ++ ++ ++VOID ++odm_EdcaTurboCheckCE( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ u32 EDCA_BE_UL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[pMgntInfo->IOTPeer]; ++ u32 EDCA_BE_DL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[pMgntInfo->IOTPeer]; ++ u32 ICType=pDM_Odm->SupportICType; ++ u32 IOTPeer=0; ++ u8 WirelessMode=0xFF; //invalid value ++ u32 trafficIndex; ++ u32 edca_param; ++ u64 cur_tx_bytes = 0; ++ u64 cur_rx_bytes = 0; ++ u8 bbtchange = _FALSE; ++ u8 bBiasOnRx = _FALSE; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); ++ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); ++ struct recv_priv *precvpriv = &(Adapter->recvpriv); ++ struct registry_priv *pregpriv = &Adapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &(Adapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if(pDM_Odm->bLinked != _TRUE) ++ { ++ precvpriv->bIsAnyNonBEPkts = _FALSE; ++ return; ++ } ++ ++ if ((pregpriv->wifi_spec == 1) )//|| (pmlmeinfo->HT_enable == 0)) ++ { ++ precvpriv->bIsAnyNonBEPkts = _FALSE; ++ return; ++ } ++ ++ if(pDM_Odm->pWirelessMode!=NULL) ++ WirelessMode=*(pDM_Odm->pWirelessMode); ++ ++ IOTPeer = pmlmeinfo->assoc_AP_vendor; ++ ++ if (IOTPeer >= HT_IOT_PEER_MAX) ++ { ++ precvpriv->bIsAnyNonBEPkts = _FALSE; ++ return; ++ } ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8188E) { ++ if((IOTPeer == HT_IOT_PEER_RALINK)||(IOTPeer == HT_IOT_PEER_ATHEROS)) ++ bBiasOnRx = _TRUE; ++ } ++ ++ // Check if the status needs to be changed. ++ if((bbtchange) || (!precvpriv->bIsAnyNonBEPkts) ) ++ { ++ cur_tx_bytes = pdvobjpriv->traffic_stat.cur_tx_bytes; ++ cur_rx_bytes = pdvobjpriv->traffic_stat.cur_rx_bytes; ++ ++ //traffic, TX or RX ++ if(bBiasOnRx) ++ { ++ if (cur_tx_bytes > (cur_rx_bytes << 2)) ++ { // Uplink TP is present. ++ trafficIndex = UP_LINK; ++ } ++ else ++ { // Balance TP is present. ++ trafficIndex = DOWN_LINK; ++ } ++ } ++ else ++ { ++ if (cur_rx_bytes > (cur_tx_bytes << 2)) ++ { // Downlink TP is present. ++ trafficIndex = DOWN_LINK; ++ } ++ else ++ { // Balance TP is present. ++ trafficIndex = UP_LINK; ++ } ++ } ++ ++ //if ((pDM_Odm->DM_EDCA_Table.prv_traffic_idx != trafficIndex) || (!pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA)) ++ { ++ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) { ++ EDCA_BE_UL = 0x6ea42b; ++ EDCA_BE_DL = 0x6ea42b; ++ } ++ ++ //92D txop can't be set to 0x3e for cisco1250 ++ if ((IOTPeer == HT_IOT_PEER_CISCO) && (WirelessMode == ODM_WM_N24G)) ++ { ++ EDCA_BE_DL = edca_setting_DL[IOTPeer]; ++ EDCA_BE_UL = edca_setting_UL[IOTPeer]; ++ } ++ //merge from 92s_92c_merge temp brunch v2445 20120215 ++ else if((IOTPeer == HT_IOT_PEER_CISCO) &&((WirelessMode==ODM_WM_G)||(WirelessMode==(ODM_WM_B|ODM_WM_G))||(WirelessMode==ODM_WM_A)||(WirelessMode==ODM_WM_B))) ++ { ++ EDCA_BE_DL = edca_setting_DL_GMode[IOTPeer]; ++ } ++ else if((IOTPeer== HT_IOT_PEER_AIRGO )&& ((WirelessMode==ODM_WM_G)||(WirelessMode==ODM_WM_A))) ++ { ++ EDCA_BE_DL = 0xa630; ++ } ++ else if(IOTPeer == HT_IOT_PEER_MARVELL) ++ { ++ EDCA_BE_DL = edca_setting_DL[IOTPeer]; ++ EDCA_BE_UL = edca_setting_UL[IOTPeer]; ++ } ++ else if(IOTPeer == HT_IOT_PEER_ATHEROS) ++ { ++ // Set DL EDCA for Atheros peer to 0x3ea42b. Suggested by SD3 Wilson for ASUS TP issue. ++ EDCA_BE_DL = edca_setting_DL[IOTPeer]; ++ } ++ ++ if((ICType==ODM_RTL8812)||(ICType==ODM_RTL8821)||(ICType==ODM_RTL8192E)) //add 8812AU/8812AE ++ { ++ EDCA_BE_UL = 0x5ea42b; ++ EDCA_BE_DL = 0x5ea42b; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8812A: EDCA_BE_UL=0x%x EDCA_BE_DL =0x%x",EDCA_BE_UL,EDCA_BE_DL)); ++ } ++ ++ if (trafficIndex == DOWN_LINK) ++ edca_param = EDCA_BE_DL; ++ else ++ edca_param = EDCA_BE_UL; ++ ++ rtw_write32(Adapter, REG_EDCA_BE_PARAM, edca_param); ++ ++ pDM_Odm->DM_EDCA_Table.prv_traffic_idx = trafficIndex; ++ } ++ ++ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = _TRUE; ++ } ++ else ++ { ++ // ++ // Turn Off EDCA turbo here. ++ // Restore original EDCA according to the declaration of AP. ++ // ++ if(pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA) ++ { ++ rtw_write32(Adapter, REG_EDCA_BE_PARAM, pHalData->AcParam_BE); ++ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = _FALSE; ++ } ++ } ++ ++} ++ ++ ++#elif(DM_ODM_SUPPORT_TYPE==ODM_WIN) ++VOID ++odm_EdcaTurboCheckMP( ++ IN PVOID pDM_VOID ++ ) ++{ ++ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ PADAPTER pDefaultAdapter = GetDefaultAdapter(Adapter); ++ PADAPTER pExtAdapter = GetFirstExtAdapter(Adapter);//NULL; ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ PSTA_QOS pStaQos = Adapter->MgntInfo.pStaQos; ++ //[Win7 Count Tx/Rx statistic for Extension Port] odm_CheckEdcaTurbo's Adapter is always Default. 2009.08.20, by Bohn ++ u8Byte Ext_curTxOkCnt = 0; ++ u8Byte Ext_curRxOkCnt = 0; ++ //For future Win7 Enable Default Port to modify AMPDU size dynamically, 2009.08.20, Bohn. ++ u1Byte TwoPortStatus = (u1Byte)TWO_PORT_STATUS__WITHOUT_ANY_ASSOCIATE; ++ ++ // Keep past Tx/Rx packet count for RT-to-RT EDCA turbo. ++ u8Byte curTxOkCnt = 0; ++ u8Byte curRxOkCnt = 0; ++ u4Byte EDCA_BE_UL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[pMgntInfo->IOTPeer]; ++ u4Byte EDCA_BE_DL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[pMgntInfo->IOTPeer]; ++ u4Byte EDCA_BE = 0x5ea42b; ++ u1Byte IOTPeer=0; ++ BOOLEAN *pbIsCurRDLState=NULL; ++ BOOLEAN bLastIsCurRDLState=FALSE; ++ BOOLEAN bBiasOnRx=FALSE; ++ BOOLEAN bEdcaTurboOn=FALSE; ++ u1Byte TxRate = 0xFF; ++ u8Byte value64; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("odm_EdcaTurboCheckMP========================>")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BE PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BE_PARAM))); ++ ++////=============================== ++////list paramter for different platform ++////=============================== ++ bLastIsCurRDLState=pDM_Odm->DM_EDCA_Table.bIsCurRDLState; ++ pbIsCurRDLState=&(pDM_Odm->DM_EDCA_Table.bIsCurRDLState); ++ ++ //2012/09/14 MH Add ++ if (pMgntInfo->NumNonBePkt > pMgntInfo->RegEdcaThresh && !(Adapter->MgntInfo.bWiFiConfg & RT_WIFI_LOGO)) ++ pHalData->bIsAnyNonBEPkts = TRUE; ++ ++ pMgntInfo->NumNonBePkt = 0; ++ ++ // Caculate TX/RX TP: ++ curTxOkCnt = pDM_Odm->curTxOkCnt; ++ curRxOkCnt = pDM_Odm->curRxOkCnt; ++ ++ ++ if(pExtAdapter == NULL) ++ pExtAdapter = pDefaultAdapter; ++ ++ Ext_curTxOkCnt = pExtAdapter->TxStats.NumTxBytesUnicast - pMgntInfo->Ext_lastTxOkCnt; ++ Ext_curRxOkCnt = pExtAdapter->RxStats.NumRxBytesUnicast - pMgntInfo->Ext_lastRxOkCnt; ++ GetTwoPortSharedResource(Adapter,TWO_PORT_SHARED_OBJECT__STATUS,NULL,&TwoPortStatus); ++ //For future Win7 Enable Default Port to modify AMPDU size dynamically, 2009.08.20, Bohn. ++ if(TwoPortStatus == TWO_PORT_STATUS__EXTENSION_ONLY) ++ { ++ curTxOkCnt = Ext_curTxOkCnt ; ++ curRxOkCnt = Ext_curRxOkCnt ; ++ } ++ // ++ IOTPeer=pMgntInfo->IOTPeer; ++ bBiasOnRx=(pMgntInfo->IOTAction & HT_IOT_ACT_EDCA_BIAS_ON_RX)?TRUE:FALSE; ++ bEdcaTurboOn=((!pHalData->bIsAnyNonBEPkts))?TRUE:FALSE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("bIsAnyNonBEPkts : 0x%lx \n",pHalData->bIsAnyNonBEPkts)); ++ ++ ++////=============================== ++////check if edca turbo is disabled ++////=============================== ++ if(odm_IsEdcaTurboDisable(pDM_Odm)) ++ { ++ pHalData->bIsAnyNonBEPkts = FALSE; ++ pMgntInfo->lastTxOkCnt = Adapter->TxStats.NumTxBytesUnicast; ++ pMgntInfo->lastRxOkCnt = Adapter->RxStats.NumRxBytesUnicast; ++ pMgntInfo->Ext_lastTxOkCnt = pExtAdapter->TxStats.NumTxBytesUnicast; ++ pMgntInfo->Ext_lastRxOkCnt = pExtAdapter->RxStats.NumRxBytesUnicast; ++ ++ } ++ ++////=============================== ++////remove iot case out ++////=============================== ++ ODM_EdcaParaSelByIot(pDM_Odm, &EDCA_BE_UL, &EDCA_BE_DL); ++ ++ ++////=============================== ++////Check if the status needs to be changed. ++////=============================== ++ if(bEdcaTurboOn) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("bEdcaTurboOn : 0x%x bBiasOnRx : 0x%x\n",bEdcaTurboOn,bBiasOnRx)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("curTxOkCnt : 0x%lx \n",curTxOkCnt)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("curRxOkCnt : 0x%lx \n",curRxOkCnt)); ++ if(bBiasOnRx) ++ odm_EdcaChooseTrafficIdx(pDM_Odm,curTxOkCnt, curRxOkCnt, TRUE, pbIsCurRDLState); ++ else ++ odm_EdcaChooseTrafficIdx(pDM_Odm,curTxOkCnt, curRxOkCnt, FALSE, pbIsCurRDLState); ++ ++//modify by Guo.Mingzhi 2011-12-29 ++ if( Adapter->AP_EDCA_PARAM[0] != EDCA_BE ) ++ EDCA_BE = Adapter->AP_EDCA_PARAM[0]; ++ else ++ EDCA_BE=((*pbIsCurRDLState)==TRUE)?EDCA_BE_DL:EDCA_BE_UL; ++ if(IS_HARDWARE_TYPE_8821U(Adapter)) ++ { ++ if(pMgntInfo->RegTxDutyEnable) ++ { ++ //2013.01.23 LukeLee: debug for 8811AU thermal issue (reduce Tx duty cycle) ++ if(!pMgntInfo->ForcedDataRate) //auto rate ++ { ++ if(pDM_Odm->TxRate != 0xFF) ++ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); ++ } ++ else //force rate ++ { ++ TxRate = (u1Byte) pMgntInfo->ForcedDataRate; ++ } ++ ++ value64 = (curRxOkCnt<<2); ++ if(curTxOkCnt < value64) //Downlink ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); ++ else //Uplink ++ { ++ /*DbgPrint("pRFCalibrateInfo->ThermalValue = 0x%X\n", pRFCalibrateInfo->ThermalValue);*/ ++ /*if(pRFCalibrateInfo->ThermalValue < pHalData->EEPROMThermalMeter)*/ ++ if((pDM_Odm->RFCalibrateInfo.ThermalValue < 0x2c) || (*pDM_Odm->pBandType == BAND_ON_2_4G)) ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); ++ else ++ { ++ switch (TxRate) ++ { ++ case MGN_VHT1SS_MCS6: ++ case MGN_VHT1SS_MCS5: ++ case MGN_MCS6: ++ case MGN_MCS5: ++ case MGN_48M: ++ case MGN_54M: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0x1ea42b); ++ break; ++ case MGN_VHT1SS_MCS4: ++ case MGN_MCS4: ++ case MGN_36M: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa42b); ++ break; ++ case MGN_VHT1SS_MCS3: ++ case MGN_MCS3: ++ case MGN_24M: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa47f); ++ break; ++ case MGN_VHT1SS_MCS2: ++ case MGN_MCS2: ++ case MGN_18M: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa57f); ++ break; ++ case MGN_VHT1SS_MCS1: ++ case MGN_MCS1: ++ case MGN_9M: ++ case MGN_12M: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa77f); ++ break; ++ case MGN_VHT1SS_MCS0: ++ case MGN_MCS0: ++ case MGN_6M: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa87f); ++ break; ++ default: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); ++ break; ++ } ++ } ++ } ++ } ++ else ++ { ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); ++ } ++ ++ } ++ else if (IS_HARDWARE_TYPE_8812AU(Adapter)){ ++ if(pMgntInfo->RegTxDutyEnable) ++ { ++ //2013.07.26 Wilson: debug for 8812AU thermal issue (reduce Tx duty cycle) ++ // it;s the same issue as 8811AU ++ if(!pMgntInfo->ForcedDataRate) //auto rate ++ { ++ if(pDM_Odm->TxRate != 0xFF) ++ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); ++ } ++ else //force rate ++ { ++ TxRate = (u1Byte) pMgntInfo->ForcedDataRate; ++ } ++ ++ value64 = (curRxOkCnt<<2); ++ if(curTxOkCnt < value64) //Downlink ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); ++ else //Uplink ++ { ++ /*DbgPrint("pRFCalibrateInfo->ThermalValue = 0x%X\n", pRFCalibrateInfo->ThermalValue);*/ ++ /*if(pRFCalibrateInfo->ThermalValue < pHalData->EEPROMThermalMeter)*/ ++ if((pDM_Odm->RFCalibrateInfo.ThermalValue < 0x2c) || (*pDM_Odm->pBandType == BAND_ON_2_4G)) ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); ++ else ++ { ++ switch (TxRate) ++ { ++ case MGN_VHT2SS_MCS9: ++ case MGN_VHT1SS_MCS9: ++ case MGN_VHT1SS_MCS8: ++ case MGN_MCS15: ++ case MGN_MCS7: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0x1ea44f); ++ case MGN_VHT2SS_MCS8: ++ case MGN_VHT1SS_MCS7: ++ case MGN_MCS14: ++ case MGN_MCS6: ++ case MGN_54M: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa44f); ++ case MGN_VHT2SS_MCS7: ++ case MGN_VHT2SS_MCS6: ++ case MGN_VHT1SS_MCS6: ++ case MGN_VHT1SS_MCS5: ++ case MGN_MCS13: ++ case MGN_MCS5: ++ case MGN_48M: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa630); ++ break; ++ case MGN_VHT2SS_MCS5: ++ case MGN_VHT2SS_MCS4: ++ case MGN_VHT1SS_MCS4: ++ case MGN_VHT1SS_MCS3: ++ case MGN_MCS12: ++ case MGN_MCS4: ++ case MGN_MCS3: ++ case MGN_36M: ++ case MGN_24M: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa730); ++ break; ++ case MGN_VHT2SS_MCS3: ++ case MGN_VHT2SS_MCS2: ++ case MGN_VHT2SS_MCS1: ++ case MGN_VHT1SS_MCS2: ++ case MGN_VHT1SS_MCS1: ++ case MGN_MCS11: ++ case MGN_MCS10: ++ case MGN_MCS9: ++ case MGN_MCS2: ++ case MGN_MCS1: ++ case MGN_18M: ++ case MGN_12M: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa830); ++ break; ++ case MGN_VHT2SS_MCS0: ++ case MGN_VHT1SS_MCS0: ++ case MGN_MCS0: ++ case MGN_MCS8: ++ case MGN_9M: ++ case MGN_6M: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa87f); ++ break; ++ default: ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); ++ break; ++ } ++ } ++ } ++ } ++ else ++ { ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); ++ } ++ } ++ else ++ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EDCA Turbo on: EDCA_BE:0x%lx\n",EDCA_BE)); ++ ++ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = TRUE; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EDCA_BE_DL : 0x%lx EDCA_BE_UL : 0x%lx EDCA_BE : 0x%lx \n",EDCA_BE_DL,EDCA_BE_UL,EDCA_BE)); ++ ++ } ++ else ++ { ++ // Turn Off EDCA turbo here. ++ // Restore original EDCA according to the declaration of AP. ++ if(pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA) ++ { ++ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_AC_PARAM, GET_WMM_PARAM_ELE_SINGLE_AC_PARAM(pStaQos->WMMParamEle, AC0_BE) ); ++ ++ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Restore EDCA BE: 0x%lx \n",pDM_Odm->WMMEDCA_BE)); ++ ++ } ++ } ++ ++} ++ ++ ++//check if edca turbo is disabled ++BOOLEAN ++odm_IsEdcaTurboDisable( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ u4Byte IOTPeer=pMgntInfo->IOTPeer; ++ ++ if(pDM_Odm->bBtDisableEdcaTurbo) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("EdcaTurboDisable for BT!!\n")); ++ return TRUE; ++ } ++ ++ if((!(pDM_Odm->SupportAbility& ODM_MAC_EDCA_TURBO ))|| ++ (pDM_Odm->WIFITest & RT_WIFI_LOGO)|| ++ (IOTPeer>= HT_IOT_PEER_MAX)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("EdcaTurboDisable\n")); ++ return TRUE; ++ } ++ ++ ++ // 1. We do not turn on EDCA turbo mode for some AP that has IOT issue ++ // 2. User may disable EDCA Turbo mode with OID settings. ++ if(pMgntInfo->IOTAction & HT_IOT_ACT_DISABLE_EDCA_TURBO){ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("IOTAction:EdcaTurboDisable\n")); ++ return TRUE; ++ } ++ ++ return FALSE; ++ ++ ++} ++ ++//add iot case here: for MP/CE ++VOID ++ODM_EdcaParaSelByIot( ++ IN PVOID pDM_VOID, ++ OUT u4Byte *EDCA_BE_UL, ++ OUT u4Byte *EDCA_BE_DL ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ u4Byte IOTPeer=0; ++ u4Byte ICType=pDM_Odm->SupportICType; ++ u1Byte WirelessMode=0xFF; //invalid value ++ u4Byte IOTPeerSubType = 0; ++ ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ u1Byte TwoPortStatus = (u1Byte)TWO_PORT_STATUS__WITHOUT_ANY_ASSOCIATE; ++ ++ if(pDM_Odm->pWirelessMode!=NULL) ++ WirelessMode=*(pDM_Odm->pWirelessMode); ++ ++/////////////////////////////////////////////////////////// ++////list paramter for different platform ++ ++ IOTPeer=pMgntInfo->IOTPeer; ++ IOTPeerSubType=pMgntInfo->IOTPeerSubtype; ++ GetTwoPortSharedResource(Adapter,TWO_PORT_SHARED_OBJECT__STATUS,NULL,&TwoPortStatus); ++ ++////============================ ++/// IOT case for MP ++////============================ ++ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) { ++ (*EDCA_BE_UL) = 0x6ea42b; ++ (*EDCA_BE_DL) = 0x6ea42b; ++ } ++ ++ if(TwoPortStatus == TWO_PORT_STATUS__EXTENSION_ONLY) ++ { ++ (*EDCA_BE_UL) = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[ExtAdapter->MgntInfo.IOTPeer]; ++ (*EDCA_BE_DL) = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[ExtAdapter->MgntInfo.IOTPeer]; ++ } ++ ++ #if (INTEL_PROXIMITY_SUPPORT == 1) ++ if(pMgntInfo->IntelClassModeInfo.bEnableCA == TRUE) ++ { ++ (*EDCA_BE_UL) = (*EDCA_BE_DL) = 0xa44f; ++ } ++ else ++ #endif ++ { ++ if((pMgntInfo->IOTAction & (HT_IOT_ACT_FORCED_ENABLE_BE_TXOP|HT_IOT_ACT_AMSDU_ENABLE))) ++ {// To check whether we shall force turn on TXOP configuration. ++ if(!((*EDCA_BE_UL) & 0xffff0000)) ++ (*EDCA_BE_UL) |= 0x005e0000; // Force TxOP limit to 0x005e for UL. ++ if(!((*EDCA_BE_DL) & 0xffff0000)) ++ (*EDCA_BE_DL) |= 0x005e0000; // Force TxOP limit to 0x005e for DL. ++ } ++ ++ //92D txop can't be set to 0x3e for cisco1250 ++ if ((IOTPeer == HT_IOT_PEER_CISCO) && (WirelessMode == ODM_WM_N24G)) ++ { ++ (*EDCA_BE_DL) = edca_setting_DL[IOTPeer]; ++ (*EDCA_BE_UL) = edca_setting_UL[IOTPeer]; ++ } ++ //merge from 92s_92c_merge temp brunch v2445 20120215 ++ else if((IOTPeer == HT_IOT_PEER_CISCO) &&((WirelessMode==ODM_WM_G)||(WirelessMode==(ODM_WM_B|ODM_WM_G))||(WirelessMode==ODM_WM_A)||(WirelessMode==ODM_WM_B))) ++ { ++ (*EDCA_BE_DL) = edca_setting_DL_GMode[IOTPeer]; ++ } ++ else if((IOTPeer== HT_IOT_PEER_AIRGO )&& ((WirelessMode==ODM_WM_G)||(WirelessMode==ODM_WM_A))) ++ { ++ (*EDCA_BE_DL) = 0xa630; ++ } ++ ++ else if(IOTPeer == HT_IOT_PEER_MARVELL) ++ { ++ (*EDCA_BE_DL) = edca_setting_DL[IOTPeer]; ++ (*EDCA_BE_UL) = edca_setting_UL[IOTPeer]; ++ } ++ else if(IOTPeer == HT_IOT_PEER_ATHEROS && IOTPeerSubType != HT_IOT_PEER_TPLINK_AC1750) ++ { ++ // Set DL EDCA for Atheros peer to 0x3ea42b. Suggested by SD3 Wilson for ASUS TP issue. ++ if(WirelessMode==ODM_WM_G) ++ (*EDCA_BE_DL) = edca_setting_DL_GMode[IOTPeer]; ++ else ++ (*EDCA_BE_DL) = edca_setting_DL[IOTPeer]; ++ ++ if(ICType == ODM_RTL8821) ++ (*EDCA_BE_DL) = 0x5ea630; ++ ++ } ++ } ++ ++ if((ICType==ODM_RTL8812)||(ICType==ODM_RTL8192E)) //add 8812AU/8812AE ++ { ++ (*EDCA_BE_UL) = 0x5ea42b; ++ (*EDCA_BE_DL) = 0x5ea42b; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8812A: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx\n",(*EDCA_BE_UL),(*EDCA_BE_DL))); ++ } ++ ++ if((ICType==ODM_RTL8814A) && (IOTPeer == HT_IOT_PEER_REALTEK)) /*8814AU and 8814AR*/ ++ { ++ (*EDCA_BE_UL) = 0x5ea42b; ++ (*EDCA_BE_DL) = 0xa42b; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8814A: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx\n",(*EDCA_BE_UL),(*EDCA_BE_DL))); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Special: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx, IOTPeer = %d\n",(*EDCA_BE_UL),(*EDCA_BE_DL), IOTPeer)); ++ ++} ++ ++ ++VOID ++odm_EdcaChooseTrafficIdx( ++ IN PVOID pDM_VOID, ++ IN u8Byte cur_tx_bytes, ++ IN u8Byte cur_rx_bytes, ++ IN BOOLEAN bBiasOnRx, ++ OUT BOOLEAN *pbIsCurRDLState ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if(bBiasOnRx) ++ { ++ ++ if(cur_tx_bytes>(cur_rx_bytes*4)) ++ { ++ *pbIsCurRDLState=FALSE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Uplink Traffic\n ")); ++ ++ } ++ else ++ { ++ *pbIsCurRDLState=TRUE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Balance Traffic\n")); ++ ++ } ++ } ++ else ++ { ++ if(cur_rx_bytes>(cur_tx_bytes*4)) ++ { ++ *pbIsCurRDLState=TRUE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Downlink Traffic\n")); ++ ++ } ++ else ++ { ++ *pbIsCurRDLState=FALSE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Balance Traffic\n")); ++ } ++ } ++ ++ return ; ++} ++ ++#endif ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.h 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,100 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMEDCATURBOCHECK_H__ ++#define __PHYDMEDCATURBOCHECK_H__ ++ ++/*#define EDCATURBO_VERSION "2.1"*/ ++#define EDCATURBO_VERSION "2.3" /*2015.07.29 by YuChen*/ ++ ++typedef struct _EDCA_TURBO_ ++{ ++ BOOLEAN bCurrentTurboEDCA; ++ BOOLEAN bIsCurRDLState; ++ ++ #if(DM_ODM_SUPPORT_TYPE == ODM_CE ) ++ u4Byte prv_traffic_idx; // edca turbo ++ #endif ++ ++}EDCA_T,*pEDCA_T; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++static u4Byte edca_setting_UL[HT_IOT_PEER_MAX] = ++// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU MARVELL 92U_AP SELF_AP(DownLink/Tx) ++{ 0x5e4322, 0xa44f, 0x5e4322, 0x5ea32b, 0x5ea422, 0x5ea322, 0x3ea430, 0x5ea42b, 0x5ea44f, 0x5e4322, 0x5e4322}; ++ ++ ++static u4Byte edca_setting_DL[HT_IOT_PEER_MAX] = ++// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU, MARVELL 92U_AP SELF_AP(UpLink/Rx) ++{ 0xa44f, 0x5ea44f, 0x5e4322, 0x5ea42b, 0xa44f, 0xa630, 0x5ea630, 0x5ea42b, 0xa44f, 0xa42b, 0xa42b}; ++ ++static u4Byte edca_setting_DL_GMode[HT_IOT_PEER_MAX] = ++// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU, MARVELL 92U_AP SELF_AP ++{ 0x4322, 0xa44f, 0x5e4322, 0xa42b, 0x5e4322, 0x4322, 0xa42b, 0x5ea42b, 0xa44f, 0x5e4322, 0x5ea42b}; ++ ++#endif ++ ++ ++ ++VOID ++odm_EdcaTurboCheck( ++ IN PVOID pDM_VOID ++ ); ++VOID ++ODM_EdcaTurboInit( ++ IN PVOID pDM_VOID ++); ++ ++#if(DM_ODM_SUPPORT_TYPE==ODM_WIN) ++VOID ++odm_EdcaTurboCheckMP( ++ IN PVOID pDM_VOID ++ ); ++ ++//check if edca turbo is disabled ++BOOLEAN ++odm_IsEdcaTurboDisable( ++ IN PVOID pDM_VOID ++); ++//choose edca paramter for special IOT case ++VOID ++ODM_EdcaParaSelByIot( ++ IN PVOID pDM_VOID, ++ OUT u4Byte *EDCA_BE_UL, ++ OUT u4Byte *EDCA_BE_DL ++ ); ++//check if it is UL or DL ++VOID ++odm_EdcaChooseTrafficIdx( ++ IN PVOID pDM_VOID, ++ IN u8Byte cur_tx_bytes, ++ IN u8Byte cur_rx_bytes, ++ IN BOOLEAN bBiasOnRx, ++ OUT BOOLEAN *pbIsCurRDLState ++ ); ++ ++#elif (DM_ODM_SUPPORT_TYPE==ODM_CE) ++VOID ++odm_EdcaTurboCheckCE( ++ IN PVOID pDM_VOID ++ ); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_features.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_features.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_features.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_features.h 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,142 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDM_FEATURES_H__ ++#define __PHYDM_FEATURES ++ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ /*Antenna Diversity*/ ++ #define CONFIG_PHYDM_ANTENNA_DIVERSITY ++ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY ++ ++ #if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) ++ #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ #endif ++ ++ #if (RTL8821A_SUPPORT == 1) ++ /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ ++ #define CONFIG_FAT_PATCH ++ #endif ++ #endif ++ ++ #define SUPPORTABLITY_PHYDMLIZE 1 ++ #define RA_MASK_PHYDMLIZE_WIN 1 ++ /*#define CONFIG_PATH_DIVERSITY*/ ++ /*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ ++ #define CONFIG_ANT_DETECTION ++ /*#define CONFIG_RA_DBG_CMD*/ ++ #define CONFIG_RA_FW_DBG_CODE 1 ++ /*#define CONFIG_PHYDM_RX_SNIFFER_PARSING*/ ++ #define CONFIG_BB_POWER_SAVING ++ #define CONFIG_BB_TXBF_API ++ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++ #define SUPPORTABLITY_PHYDMLIZE 0 ++ #define RA_MASK_PHYDMLIZE_AP 1 ++ ++ /* #define CONFIG_RA_DBG_CMD*/ ++ #define CONFIG_RA_FW_DBG_CODE 0 ++ ++ /*#define CONFIG_PATH_DIVERSITY*/ ++ /*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ ++ #define CONFIG_RA_DYNAMIC_RATE_ID ++ /*#define CONFIG_BB_POWER_SAVING*/ ++ #define CONFIG_BB_TXBF_API ++ ++ /* [ Configure Antenna Diversity ] */ ++ #if defined(CONFIG_RTL_8881A_ANT_SWITCH) || defined(CONFIG_SLOT_0_ANT_SWITCH) || defined(CONFIG_SLOT_1_ANT_SWITCH) ++ #define CONFIG_PHYDM_ANTENNA_DIVERSITY ++ #define ODM_EVM_ENHANCE_ANTDIV ++ ++ /*----------*/ ++ ++ #if (!defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A) && !defined(CONFIG_2G_CGCS_RX_DIVERSITY) && !defined(CONFIG_2G_CG_TRX_DIVERSITY) && !defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) ++ #define CONFIG_NO_2G_DIVERSITY ++ #endif ++ ++ #ifdef CONFIG_NO_5G_DIVERSITY_8881A ++ #define CONFIG_NO_5G_DIVERSITY ++ #elif defined(CONFIG_5G_CGCS_RX_DIVERSITY_8881A) ++ #define CONFIG_5G_CGCS_RX_DIVERSITY ++ #elif defined(CONFIG_5G_CG_TRX_DIVERSITY_8881A) ++ #define CONFIG_5G_CG_TRX_DIVERSITY ++ #elif defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A) ++ #define CONFIG_2G5G_CG_TRX_DIVERSITY ++ #endif ++ #if (!defined(CONFIG_NO_5G_DIVERSITY) && !defined(CONFIG_5G_CGCS_RX_DIVERSITY) && !defined(CONFIG_5G_CG_TRX_DIVERSITY) && !defined(CONFIG_2G5G_CG_TRX_DIVERSITY) && !defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) ++ #define CONFIG_NO_5G_DIVERSITY ++ #endif ++ /*----------*/ ++ #if (defined(CONFIG_NO_2G_DIVERSITY) && defined(CONFIG_NO_5G_DIVERSITY)) ++ #define CONFIG_NOT_SUPPORT_ANTDIV ++ #elif (!defined(CONFIG_NO_2G_DIVERSITY) && defined(CONFIG_NO_5G_DIVERSITY)) ++ #define CONFIG_2G_SUPPORT_ANTDIV ++ #elif (defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_NO_5G_DIVERSITY)) ++ #define CONFIG_5G_SUPPORT_ANTDIV ++ #elif ((!defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_NO_5G_DIVERSITY)) || defined(CONFIG_2G5G_CG_TRX_DIVERSITY)) ++ #define CONFIG_2G5G_SUPPORT_ANTDIV ++ #endif ++ /*----------*/ ++ #endif ++ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ ++ #define SUPPORTABLITY_PHYDMLIZE 0 ++ #define RA_MASK_PHYDMLIZE_CE 1 ++ ++ /*Antenna Diversity*/ ++ #ifdef CONFIG_ANTENNA_DIVERSITY ++ #define CONFIG_PHYDM_ANTENNA_DIVERSITY ++ ++ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY ++ ++ #if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) ++ #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ #endif ++ ++ #if (RTL8821A_SUPPORT == 1) ++ /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ ++ #endif ++ #endif ++ #endif ++ ++ #ifdef CONFIG_DFS_MASTER ++ #define CONFIG_PHYDM_DFS_MASTER ++ #endif ++ ++ /*#define CONFIG_RA_DBG_CMD*/ ++ #define CONFIG_RA_FW_DBG_CODE 0 ++ /*#define CONFIG_ANT_DETECTION*/ ++ /*#define CONFIG_PATH_DIVERSITY*/ ++ /*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ ++ #define CONFIG_BB_POWER_SAVING ++ #define CONFIG_BB_TXBF_API ++ ++ #ifdef CONFIG_BT_COEXIST ++ #define BT_SUPPORT 1 ++ #endif ++ ++ ++#endif ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm.h 2018-02-11 21:44:27.154146193 +0200 +@@ -0,0 +1,1299 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ ++#ifndef __HALDMOUTSRC_H__ ++#define __HALDMOUTSRC_H__ ++ ++/*============================================================*/ ++/*include files*/ ++/*============================================================*/ ++#include "phydm_pre_define.h" ++#include "phydm_dig.h" ++#include "phydm_edcaturbocheck.h" ++#include "phydm_pathdiv.h" ++#include "phydm_antdiv.h" ++#include "phydm_antdect.h" ++#include "phydm_dynamicbbpowersaving.h" ++#include "phydm_rainfo.h" ++#include "phydm_dynamictxpower.h" ++#include "phydm_cfotracking.h" ++#include "phydm_acs.h" ++#include "phydm_adaptivity.h" ++#include "phydm_iqk.h" ++#include "phydm_dfs.h" ++#include "phydm_ccx.h" ++#include "txbf/phydm_hal_txbf_api.h" ++ ++#include "phydm_adc_sampling.h" ++ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) ++#include "phydm_beamforming.h" ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++#include "halphyrf_ap.h" ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++#include "phydm_noisemonitor.h" ++#include "halphyrf_ce.h" ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++#include "halphyrf_win.h" ++#include "phydm_noisemonitor.h" ++#endif ++ ++/*============================================================*/ ++/*Definition */ ++/*============================================================*/ ++ ++/* Traffic load decision */ ++#define TRAFFIC_ULTRA_LOW 1 ++#define TRAFFIC_LOW 2 ++#define TRAFFIC_MID 3 ++#define TRAFFIC_HIGH 4 ++ ++#define NONE 0 ++ ++/*NBI API------------------------------------*/ ++#define NBI_ENABLE 1 ++#define NBI_DISABLE 2 ++ ++#define NBI_TABLE_SIZE_128 27 ++#define NBI_TABLE_SIZE_256 59 ++ ++#define NUM_START_CH_80M 7 ++#define NUM_START_CH_40M 14 ++ ++#define CH_OFFSET_40M 2 ++#define CH_OFFSET_80M 6 ++ ++/*CSI MASK API------------------------------------*/ ++#define CSI_MASK_ENABLE 1 ++#define CSI_MASK_DISABLE 2 ++ ++/*------------------------------------------------*/ ++ ++#define FFT_128_TYPE 1 ++#define FFT_256_TYPE 2 ++ ++#define SET_SUCCESS 1 ++#define SET_ERROR 2 ++#define SET_NO_NEED 3 ++ ++#define FREQ_POSITIVE 1 ++#define FREQ_NEGATIVE 2 ++ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++#define PHYDM_WATCH_DOG_PERIOD 1 ++#else ++#define PHYDM_WATCH_DOG_PERIOD 2 ++#endif ++ ++/*============================================================*/ ++/*structure and define*/ ++/*============================================================*/ ++ ++/*2011/09/20 MH Add for AP/ADSLpseudo DM structuer requirement.*/ ++/*We need to remove to other position???*/ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) ++typedef struct rtl8192cd_priv { ++ u1Byte temp; ++ ++} rtl8192cd_priv, *prtl8192cd_priv; ++#endif ++ ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++typedef struct _ADAPTER { ++ u1Byte temp; ++ #ifdef AP_BUILD_WORKAROUND ++ HAL_DATA_TYPE* temp2; ++ prtl8192cd_priv priv; ++ #endif ++} ADAPTER, *PADAPTER; ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++typedef struct _WLAN_STA { ++ u1Byte temp; ++} WLAN_STA, *PRT_WLAN_STA; ++ ++#endif ++ ++typedef struct _Dynamic_Primary_CCA { ++ u1Byte PriCCA_flag; ++ u1Byte intf_flag; ++ u1Byte intf_type; ++ u1Byte DupRTS_flag; ++ u1Byte Monitor_flag; ++ u1Byte CH_offset; ++ u1Byte MF_state; ++} Pri_CCA_T, *pPri_CCA_T; ++ ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ #ifdef ADSL_AP_BUILD_WORKAROUND ++ #define MAX_TOLERANCE 5 ++ #define IQK_DELAY_TIME 1 /*ms*/ ++ #endif ++#endif /*#if(DM_ODM_SUPPORT_TYPE & (ODM_AP))*/ ++ ++#define DM_Type_ByFW 0 ++#define DM_Type_ByDriver 1 ++ ++/*Declare for common info*/ ++ ++#define IQK_THRESHOLD 8 ++#define DPK_THRESHOLD 4 ++ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++__PACK typedef struct _ODM_Phy_Status_Info_ ++{ ++ u1Byte RxPWDBAll; ++ u1Byte SignalQuality; /* in 0-100 index. */ ++ u1Byte RxMIMOSignalStrength[4]; /* in 0~100 index */ ++ s1Byte RxMIMOSignalQuality[4]; /* EVM */ ++ s1Byte RxSNR[4]; /* per-path's SNR */ ++#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) ++ u1Byte RxCount:2; /* RX path counter---*/ ++ u1Byte BandWidth:2; ++ u1Byte rxsc:4; /* sub-channel---*/ ++#else ++ u1Byte BandWidth; ++#endif ++#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) ++ u1Byte channel; /* channel number---*/ ++ BOOLEAN bMuPacket; /* is MU packet or not---*/ ++ BOOLEAN bBeamformed; /* BF packet---*/ ++#endif ++} __WLAN_ATTRIB_PACK__ ODM_PHY_INFO_T, *PODM_PHY_INFO_T; ++ ++typedef struct _ODM_Phy_Status_Info_Append_ { ++ u1Byte MAC_CRC32; ++ ++}ODM_PHY_INFO_Append_T,*PODM_PHY_INFO_Append_T; ++ ++#else ++ ++typedef struct _ODM_Phy_Status_Info_ { ++ // ++ // Be care, if you want to add any element please insert between ++ // RxPWDBAll & SignalStrength. ++ // ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ u4Byte RxPWDBAll; ++#else ++ u1Byte RxPWDBAll; ++#endif ++ u1Byte SignalQuality; /* in 0-100 index. */ ++ s1Byte RxMIMOSignalQuality[4]; /* per-path's EVM */ ++ u1Byte RxMIMOEVMdbm[4]; /* per-path's EVM dbm */ ++ u1Byte RxMIMOSignalStrength[4]; /* in 0~100 index */ ++ s2Byte Cfo_short[4]; /* per-path's Cfo_short */ ++ s2Byte Cfo_tail[4]; /* per-path's Cfo_tail */ ++ s1Byte RxPower; /* in dBm Translate from PWdB */ ++ s1Byte RecvSignalPower; /* Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. */ ++ u1Byte BTRxRSSIPercentage; ++ u1Byte SignalStrength; /* in 0-100 index. */ ++ s1Byte RxPwr[4]; /* per-path's pwdb */ ++ s1Byte RxSNR[4]; /* per-path's SNR */ ++#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) ++ u1Byte RxCount:2; /* RX path counter---*/ ++ u1Byte BandWidth:2; ++ u1Byte rxsc:4; /* sub-channel---*/ ++#else ++ u1Byte BandWidth; ++#endif ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ u1Byte btCoexPwrAdjust; ++#endif ++#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) ++ u1Byte channel; /* channel number---*/ ++ BOOLEAN bMuPacket; /* is MU packet or not---*/ ++ BOOLEAN bBeamformed; /* BF packet---*/ ++#endif ++} ODM_PHY_INFO_T, *PODM_PHY_INFO_T; ++#endif ++ ++typedef struct _ODM_Per_Pkt_Info_ { ++ u1Byte DataRate; ++ u1Byte StationID; ++ BOOLEAN bPacketMatchBSSID; ++ BOOLEAN bPacketToSelf; ++ BOOLEAN bPacketBeacon; ++ BOOLEAN bToSelf; ++} ODM_PACKET_INFO_T, *PODM_PACKET_INFO_T; ++ ++ ++typedef struct _ODM_Phy_Dbg_Info_ { ++ /*ODM Write,debug info*/ ++ s1Byte RxSNRdB[4]; ++ u4Byte NumQryPhyStatus; ++ u4Byte NumQryPhyStatusCCK; ++ u4Byte NumQryPhyStatusOFDM; ++#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) ++ u4Byte NumQryMuPkt; ++ u4Byte NumQryBfPkt; ++ u4Byte NumQryMuVhtPkt[40]; ++ u4Byte NumQryVhtPkt[40]; ++ BOOLEAN bLdpcPkt; ++ BOOLEAN bStbcPkt; ++#endif ++ u1Byte NumQryBeaconPkt; ++ //Others ++ s4Byte RxEVM[4]; ++ ++} ODM_PHY_DBG_INFO_T; ++ ++ ++/*2011/20/20 MH For MP driver RT_WLAN_STA = STA_INFO_T*/ ++/*Please declare below ODM relative info in your STA info structure.*/ ++ ++#if 1 ++typedef struct _ODM_STA_INFO { ++ /*Driver Write*/ ++ BOOLEAN bUsed; /*record the sta status link or not?*/ ++ u1Byte IOTPeer; /*Enum value. HT_IOT_PEER_E*/ ++ ++ /*ODM Write*/ ++ /*PHY_STATUS_INFO*/ ++ u1Byte RSSI_Path[4]; ++ u1Byte RSSI_Ave; ++ u1Byte RXEVM[4]; ++ u1Byte RXSNR[4]; ++ ++} ODM_STA_INFO_T, *PODM_STA_INFO_T; ++#endif ++ ++typedef enum _ODM_Common_Info_Definition { ++ /*Fixed value*/ ++ /*-----------HOOK BEFORE REG INIT-----------*/ ++ ODM_CMNINFO_PLATFORM = 0, ++ ODM_CMNINFO_ABILITY, ++ ODM_CMNINFO_INTERFACE, ++ ODM_CMNINFO_MP_TEST_CHIP, ++ ODM_CMNINFO_IC_TYPE, ++ ODM_CMNINFO_CUT_VER, ++ ODM_CMNINFO_FAB_VER, ++ ODM_CMNINFO_RF_TYPE, ++ ODM_CMNINFO_RFE_TYPE, ++ ODM_CMNINFO_BOARD_TYPE, ++ ODM_CMNINFO_PACKAGE_TYPE, ++ ODM_CMNINFO_EXT_LNA, ++ ODM_CMNINFO_5G_EXT_LNA, ++ ODM_CMNINFO_EXT_PA, ++ ODM_CMNINFO_5G_EXT_PA, ++ ODM_CMNINFO_GPA, ++ ODM_CMNINFO_APA, ++ ODM_CMNINFO_GLNA, ++ ODM_CMNINFO_ALNA, ++ ODM_CMNINFO_EXT_TRSW, ++ ODM_CMNINFO_EXT_LNA_GAIN, ++ ODM_CMNINFO_PATCH_ID, ++ ODM_CMNINFO_BINHCT_TEST, ++ ODM_CMNINFO_BWIFI_TEST, ++ ODM_CMNINFO_SMART_CONCURRENT, ++ ODM_CMNINFO_CONFIG_BB_RF, ++ ODM_CMNINFO_DOMAIN_CODE_2G, ++ ODM_CMNINFO_DOMAIN_CODE_5G, ++ ODM_CMNINFO_IQKFWOFFLOAD, ++ ODM_CMNINFO_IQKPAOFF, ++ ODM_CMNINFO_HUBUSBMODE, ++ ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS, ++ ODM_CMNINFO_TX_TP, ++ ODM_CMNINFO_RX_TP, ++ ODM_CMNINFO_SOUNDING_SEQ, ++ ODM_CMNINFO_REGRFKFREEENABLE, ++ ODM_CMNINFO_RFKFREEENABLE, ++ ODM_CMNINFO_NORMAL_RX_PATH_CHANGE, ++ /*-----------HOOK BEFORE REG INIT-----------*/ ++ ++ /*Dynamic value:*/ ++ ++ /*--------- POINTER REFERENCE-----------*/ ++ ODM_CMNINFO_MAC_PHY_MODE, ++ ODM_CMNINFO_TX_UNI, ++ ODM_CMNINFO_RX_UNI, ++ ODM_CMNINFO_WM_MODE, ++ ODM_CMNINFO_BAND, ++ ODM_CMNINFO_SEC_CHNL_OFFSET, ++ ODM_CMNINFO_SEC_MODE, ++ ODM_CMNINFO_BW, ++ ODM_CMNINFO_CHNL, ++ ODM_CMNINFO_FORCED_RATE, ++ ODM_CMNINFO_ANT_DIV, ++ ODM_CMNINFO_ADAPTIVITY, ++ ODM_CMNINFO_DMSP_GET_VALUE, ++ ODM_CMNINFO_BUDDY_ADAPTOR, ++ ODM_CMNINFO_DMSP_IS_MASTER, ++ ODM_CMNINFO_SCAN, ++ ODM_CMNINFO_POWER_SAVING, ++ ODM_CMNINFO_ONE_PATH_CCA, ++ ODM_CMNINFO_DRV_STOP, ++ ODM_CMNINFO_PNP_IN, ++ ODM_CMNINFO_INIT_ON, ++ ODM_CMNINFO_ANT_TEST, ++ ODM_CMNINFO_NET_CLOSED, ++ ODM_CMNINFO_FORCED_IGI_LB, ++ ODM_CMNINFO_P2P_LINK, ++ ODM_CMNINFO_FCS_MODE, ++ ODM_CMNINFO_IS1ANTENNA, ++ ODM_CMNINFO_RFDEFAULTPATH, ++ ODM_CMNINFO_DFS_MASTER_ENABLE, ++ ODM_CMNINFO_FORCE_TX_ANT_BY_TXDESC, ++ ODM_CMNINFO_SET_S0S1_DEFAULT_ANTENNA, ++ /*--------- POINTER REFERENCE-----------*/ ++ ++ /*------------CALL BY VALUE-------------*/ ++ ODM_CMNINFO_WIFI_DIRECT, ++ ODM_CMNINFO_WIFI_DISPLAY, ++ ODM_CMNINFO_LINK_IN_PROGRESS, ++ ODM_CMNINFO_LINK, ++ ODM_CMNINFO_STATION_STATE, ++ ODM_CMNINFO_RSSI_MIN, ++ ODM_CMNINFO_DBG_COMP, ++ ODM_CMNINFO_DBG_LEVEL, ++ ODM_CMNINFO_RA_THRESHOLD_HIGH, ++ ODM_CMNINFO_RA_THRESHOLD_LOW, ++ ODM_CMNINFO_RF_ANTENNA_TYPE, ++ ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH, ++ ODM_CMNINFO_BE_FIX_TX_ANT, ++ ODM_CMNINFO_BT_ENABLED, ++ ODM_CMNINFO_BT_HS_CONNECT_PROCESS, ++ ODM_CMNINFO_BT_HS_RSSI, ++ ODM_CMNINFO_BT_OPERATION, ++ ODM_CMNINFO_BT_LIMITED_DIG, ++ ODM_CMNINFO_BT_DIG, ++ ODM_CMNINFO_BT_BUSY, ++ ODM_CMNINFO_BT_DISABLE_EDCA, ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) /*for repeater mode add by YuChen 2014.06.23*/ ++#ifdef UNIVERSAL_REPEATER ++ ODM_CMNINFO_VXD_LINK, ++#endif ++#endif ++ ODM_CMNINFO_AP_TOTAL_NUM, ++ ODM_CMNINFO_POWER_TRAINING, ++ ODM_CMNINFO_DFS_REGION_DOMAIN, ++ /*------------CALL BY VALUE-------------*/ ++ ++ /*Dynamic ptr array hook itms.*/ ++ ODM_CMNINFO_STA_STATUS, ++ ODM_CMNINFO_MAX, ++ ++}ODM_CMNINFO_E; ++ ++ ++typedef enum _PHYDM_Info_query_type { ++ PHYDM_INFO_FA_OFDM, ++ PHYDM_INFO_FA_CCK, ++ PHYDM_INFO_FA_TOTAL, ++ PHYDM_INFO_CCA_OFDM, ++ PHYDM_INFO_CCA_CCK, ++ PHYDM_INFO_CCA_ALL, ++ PHYDM_INFO_CRC32_OK_VHT, ++ PHYDM_INFO_CRC32_OK_HT, ++ PHYDM_INFO_CRC32_OK_LEGACY, ++ PHYDM_INFO_CRC32_OK_CCK, ++ PHYDM_INFO_CRC32_ERROR_VHT, ++ PHYDM_INFO_CRC32_ERROR_HT, ++ PHYDM_INFO_CRC32_ERROR_LEGACY, ++ PHYDM_INFO_CRC32_ERROR_CCK, ++ PHYDM_INFO_EDCCA_FLAG, ++ PHYDM_INFO_OFDM_ENABLE, ++ PHYDM_INFO_CCK_ENABLE, ++ PHYDM_INFO_DBG_PORT_0 ++} PHYDM_INFO_QUERY_E; ++ ++typedef enum _PHYDM_API_Definition { ++ ++ PHYDM_API_NBI = 1, ++ PHYDM_API_CSI_MASK, ++ ++} PHYDM_API_E; ++ ++ ++/*2011/10/20 MH Define ODM support ability. ODM_CMNINFO_ABILITY*/ ++typedef enum _ODM_Support_Ability_Definition { ++ ++ /*BB ODM section BIT 0-19*/ ++ ODM_BB_DIG = BIT0, ++ ODM_BB_RA_MASK = BIT1, ++ ODM_BB_DYNAMIC_TXPWR = BIT2, ++ ODM_BB_FA_CNT = BIT3, ++ ODM_BB_RSSI_MONITOR = BIT4, ++ ODM_BB_CCK_PD = BIT5, ++ ODM_BB_ANT_DIV = BIT6, ++ ODM_BB_PWR_TRAIN = BIT8, ++ ODM_BB_RATE_ADAPTIVE = BIT9, ++ ODM_BB_PATH_DIV = BIT10, ++ ODM_BB_ADAPTIVITY = BIT13, ++ ODM_BB_CFO_TRACKING = BIT14, ++ ODM_BB_NHM_CNT = BIT15, ++ ODM_BB_PRIMARY_CCA = BIT16, ++ ODM_BB_TXBF = BIT17, ++ ODM_BB_DYNAMIC_ARFR = BIT18, ++ ++ /*MAC DM section BIT 20-23*/ ++ ODM_MAC_EDCA_TURBO = BIT20, ++ ODM_MAC_EARLY_MODE = BIT21, ++ ++ /*RF ODM section BIT 24-31*/ ++ ODM_RF_TX_PWR_TRACK = BIT24, ++ ODM_RF_RX_GAIN_TRACK = BIT25, ++ ODM_RF_CALIBRATION = BIT26, ++ ++}ODM_ABILITY_E; ++ ++ ++/*ODM_CMNINFO_ONE_PATH_CCA*/ ++typedef enum tag_CCA_Path { ++ ODM_CCA_2R = 0, ++ ODM_CCA_1R_A = 1, ++ ODM_CCA_1R_B = 2, ++} ODM_CCA_PATH_E; ++ ++typedef enum CCA_PATHDIV_EN { ++ CCA_PATHDIV_DISABLE = 0, ++ CCA_PATHDIV_ENABLE = 1, ++ ++} CCA_PATHDIV_EN_E; ++ ++ ++typedef enum _BASEBAND_CONFIG_PHY_REG_PG_VALUE_TYPE { ++ PHY_REG_PG_RELATIVE_VALUE = 0, ++ PHY_REG_PG_EXACT_VALUE = 1 ++} PHY_REG_PG_TYPE; ++ ++/*2011/09/22 MH Copy from SD4 defined structure. We use to support PHY DM integration.*/ ++ ++#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++#if (RT_PLATFORM != PLATFORM_LINUX) ++typedef ++#endif ++ ++struct DM_Out_Source_Dynamic_Mechanism_Structure ++#else/*for AP,ADSL,CE Team*/ ++typedef struct DM_Out_Source_Dynamic_Mechanism_Structure ++#endif ++{ ++ /*Add for different team use temporarily*/ ++ PADAPTER Adapter; /*For CE/NIC team*/ ++ prtl8192cd_priv priv; /*For AP/ADSL team*/ ++ /*WHen you use Adapter or priv pointer, you must make sure the pointer is ready.*/ ++ BOOLEAN odm_ready; ++ ++#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) ++ rtl8192cd_priv fake_priv; ++#endif ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ // ADSL_AP_BUILD_WORKAROUND ++ ADAPTER fake_adapter; ++#endif ++ ++ PHY_REG_PG_TYPE PhyRegPgValueType; ++ u1Byte PhyRegPgVersion; ++ ++ u4Byte DebugComponents; ++ u4Byte fw_DebugComponents; ++ u4Byte DebugLevel; ++ ++ u4Byte NumQryPhyStatusAll; /*CCK + OFDM*/ ++ u4Byte LastNumQryPhyStatusAll; ++ u4Byte RxPWDBAve; ++ BOOLEAN MPDIG_2G; /*off MPDIG*/ ++ u1Byte Times_2G; ++ BOOLEAN bInitHwInfoByRfe; ++ ++/*------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ ++ BOOLEAN bCckHighPower; ++ u1Byte RFPathRxEnable; ++ u1Byte ControlChannel; ++/*------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ ++ ++ ++//1 COMMON INFORMATION ++ ++ /*Init Value*/ ++ /*-----------HOOK BEFORE REG INIT-----------*/ ++ /*ODM Platform info AP/ADSL/CE/MP = 1/2/3/4*/ ++ u1Byte SupportPlatform; ++ // ODM Platform info WIN/AP/CE = 1/2/3 ++ u1Byte Normalrxpath; ++ // ODM Support Ability DIG/RATR/TX_PWR_TRACK/ KK = 1/2/3/K ++ u4Byte SupportAbility; ++ /*ODM PCIE/USB/SDIO = 1/2/3*/ ++ u1Byte SupportInterface; ++ /*ODM composite or independent. Bit oriented/ 92C+92D+ .... or any other type = 1/2/3/...*/ ++ u4Byte SupportICType; ++ /*Cut Version TestChip/A-cut/B-cut... = 0/1/2/3/...*/ ++ u1Byte CutVersion; ++ /*Fab Version TSMC/UMC = 0/1*/ ++ u1Byte FabVersion; ++ /*RF Type 4T4R/3T3R/2T2R/1T2R/1T1R/...*/ ++ u1Byte RFType; ++ u1Byte RFEType; ++ /*Board Type Normal/HighPower/MiniCard/SLIM/Combo/... = 0/1/2/3/4/...*/ ++ u1Byte BoardType; ++ u1Byte PackageType; ++ u2Byte TypeGLNA; ++ u2Byte TypeGPA; ++ u2Byte TypeALNA; ++ u2Byte TypeAPA; ++ /*with external LNA NO/Yes = 0/1*/ ++ u1Byte ExtLNA; /*2G*/ ++ u1Byte ExtLNA5G; /*5G*/ ++ /*with external PA NO/Yes = 0/1*/ ++ u1Byte ExtPA; /*2G*/ ++ u1Byte ExtPA5G; /*5G*/ ++ /*with external TRSW NO/Yes = 0/1*/ ++ u1Byte ExtTRSW; ++ u1Byte ExtLNAGain; /*2G*/ ++ u1Byte PatchID; /*Customer ID*/ ++ BOOLEAN bInHctTest; ++ u1Byte WIFITest; ++ ++ BOOLEAN bDualMacSmartConcurrent; ++ u4Byte BK_SupportAbility; ++ u1Byte AntDivType; ++ u1Byte with_extenal_ant_switch; ++ BOOLEAN ConfigBBRF; ++ u1Byte odm_Regulation2_4G; ++ u1Byte odm_Regulation5G; ++ u1Byte IQKFWOffload; ++ BOOLEAN cck_new_agc; ++ u1Byte phydm_period; ++ u4Byte phydm_sys_up_time; ++ u1Byte num_rf_path; ++ /*-----------HOOK BEFORE REG INIT-----------*/ ++ ++ /*Dynamic Value*/ ++ ++ /*--------- POINTER REFERENCE-----------*/ ++ ++ u1Byte u1Byte_temp; ++ BOOLEAN BOOLEAN_temp; ++ PADAPTER PADAPTER_temp; ++ ++ /*MAC PHY Mode SMSP/DMSP/DMDP = 0/1/2*/ ++ u1Byte *pMacPhyMode; ++ /*TX Unicast byte count*/ ++ u8Byte *pNumTxBytesUnicast; ++ /*RX Unicast byte count*/ ++ u8Byte *pNumRxBytesUnicast; ++ /*Wireless mode B/G/A/N = BIT0/BIT1/BIT2/BIT3*/ ++ u1Byte *pWirelessMode; ++ /*Frequence band 2.4G/5G = 0/1*/ ++ u1Byte *pBandType; ++ /*Secondary channel offset don't_care/below/above = 0/1/2*/ ++ u1Byte *pSecChOffset; ++ /*Security mode Open/WEP/AES/TKIP = 0/1/2/3*/ ++ u1Byte *pSecurity; ++ /*BW info 20M/40M/80M = 0/1/2*/ ++ u1Byte *pBandWidth; ++ /*Central channel location Ch1/Ch2/....*/ ++ u1Byte *pChannel; /*central channel number*/ ++ BOOLEAN DPK_Done; ++ /*Common info for 92D DMSP*/ ++ ++ BOOLEAN *pbGetValueFromOtherMac; ++ PADAPTER *pBuddyAdapter; ++ BOOLEAN *pbMasterOfDMSP; //MAC0: master, MAC1: slave ++ /*Common info for Status*/ ++ BOOLEAN *pbScanInProcess; ++ BOOLEAN *pbPowerSaving; ++ /*CCA Path 2-path/path-A/path-B = 0/1/2; using ODM_CCA_PATH_E.*/ ++ u1Byte *pOnePathCCA; ++ u1Byte *pAntennaTest; ++ BOOLEAN *pbNet_closed; ++ u1Byte *pu1ForcedIgiLb; ++ BOOLEAN *pIsFcsModeEnable; ++ /*--------- For 8723B IQK-----------*/ ++ BOOLEAN *pIs1Antenna; ++ u1Byte *pRFDefaultPath; ++ // 0:S1, 1:S0 ++ ++ /*--------- POINTER REFERENCE-----------*/ ++ pu2Byte pForcedDataRate; ++ pu1Byte p_enable_antdiv; ++ pu1Byte p_enable_adaptivity; ++ pu1Byte HubUsbMode; ++ BOOLEAN *pbFwDwRsvdPageInProgress; ++ u4Byte *pCurrentTxTP; ++ u4Byte *pCurrentRxTP; ++ u1Byte *pSoundingSeq; ++ /*------------CALL BY VALUE-------------*/ ++ BOOLEAN bLinkInProcess; ++ BOOLEAN bWIFI_Direct; ++ BOOLEAN bWIFI_Display; ++ BOOLEAN bLinked; ++ BOOLEAN bsta_state; ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) /*for repeater mode add by YuChen 2014.06.23*/ ++#ifdef UNIVERSAL_REPEATER ++ BOOLEAN VXD_bLinked; ++#endif ++#endif ++ u1Byte RSSI_Min; ++ u1Byte InterfaceIndex; /*Add for 92D dual MAC: 0--Mac0 1--Mac1*/ ++ BOOLEAN bIsMPChip; ++ BOOLEAN bOneEntryOnly; ++ BOOLEAN mp_mode; ++ u4Byte OneEntry_MACID; ++ u1Byte pre_number_linked_client; ++ u1Byte number_linked_client; ++ u1Byte pre_number_active_client; ++ u1Byte number_active_client; ++ /*Common info for BTDM*/ ++ BOOLEAN bBtEnabled; /*BT is enabled*/ ++ BOOLEAN bBtConnectProcess; /*BT HS is under connection progress.*/ ++ u1Byte btHsRssi; /*BT HS mode wifi rssi value.*/ ++ BOOLEAN bBtHsOperation; /*BT HS mode is under progress*/ ++ u1Byte btHsDigVal; /*use BT rssi to decide the DIG value*/ ++ BOOLEAN bBtDisableEdcaTurbo; /*Under some condition, don't enable the EDCA Turbo*/ ++ BOOLEAN bBtBusy; /*BT is busy.*/ ++ BOOLEAN bBtLimitedDig; /*BT is busy.*/ ++ BOOLEAN bDisablePhyApi; ++ /*------------CALL BY VALUE-------------*/ ++ u1Byte RSSI_A; ++ u1Byte RSSI_B; ++ u1Byte RSSI_C; ++ u1Byte RSSI_D; ++ u8Byte RSSI_TRSW; ++ u8Byte RSSI_TRSW_H; ++ u8Byte RSSI_TRSW_L; ++ u8Byte RSSI_TRSW_iso; ++ u1Byte TXAntStatus; ++ u1Byte RXAntStatus; ++ u1Byte cck_lna_idx; ++ u1Byte cck_vga_idx; ++ u1Byte curr_station_id; ++ u1Byte ofdm_agc_idx[4]; ++ ++ u1Byte RxRate; ++ BOOLEAN bNoisyState; ++ u1Byte TxRate; ++ u1Byte LinkedInterval; ++ u1Byte preChannel; ++ u4Byte TxagcOffsetValueA; ++ BOOLEAN IsTxagcOffsetPositiveA; ++ u4Byte TxagcOffsetValueB; ++ BOOLEAN IsTxagcOffsetPositiveB; ++ u4Byte tx_tp; ++ u4Byte rx_tp; ++ u4Byte total_tp; ++ u8Byte curTxOkCnt; ++ u8Byte curRxOkCnt; ++ u8Byte lastTxOkCnt; ++ u8Byte lastRxOkCnt; ++ u4Byte BbSwingOffsetA; ++ BOOLEAN IsBbSwingOffsetPositiveA; ++ u4Byte BbSwingOffsetB; ++ BOOLEAN IsBbSwingOffsetPositiveB; ++ u1Byte IGI_LowerBound; ++ u1Byte IGI_UpperBound; ++ u1Byte antdiv_rssi; ++ u1Byte fat_comb_a; ++ u1Byte fat_comb_b; ++ u1Byte antdiv_intvl; ++ u1Byte AntType; ++ u1Byte pre_AntType; ++ u1Byte antdiv_period; ++ u1Byte evm_antdiv_period; ++ u1Byte antdiv_select; ++ u1Byte path_select; ++ u1Byte antdiv_evm_en; ++ u1Byte bdc_holdstate; ++ u1Byte NdpaPeriod; ++ BOOLEAN H2C_RARpt_connect; ++ BOOLEAN cck_agc_report_type; ++ ++ u1Byte dm_dig_max_TH; ++ u1Byte dm_dig_min_TH; ++ u1Byte print_agc; ++ u1Byte TrafficLoad; ++ u1Byte pre_TrafficLoad; ++ ++ /*For Adaptivtiy*/ ++ u2Byte NHM_cnt_0; ++ u2Byte NHM_cnt_1; ++ s1Byte TH_L2H_default; ++ s1Byte TH_EDCCA_HL_diff_default; ++ s1Byte TH_L2H_ini; ++ s1Byte TH_EDCCA_HL_diff; ++ s1Byte TH_L2H_ini_mode2; ++ s1Byte TH_EDCCA_HL_diff_mode2; ++ BOOLEAN Carrier_Sense_enable; ++ u1Byte Adaptivity_IGI_upper; ++ BOOLEAN adaptivity_flag; ++ u1Byte DCbackoff; ++ BOOLEAN Adaptivity_enable; ++ u1Byte APTotalNum; ++ BOOLEAN EDCCA_enable; ++ ADAPTIVITY_STATISTICS Adaptivity; ++ /*For Adaptivtiy*/ ++ u1Byte LastUSBHub; ++ u1Byte TxBfDataRate; ++ ++ u1Byte nbi_set_result; ++ ++ u1Byte c2h_cmd_start; ++ u1Byte fw_debug_trace[60]; ++ u1Byte pre_c2h_seq; ++ BOOLEAN fw_buff_is_enpty; ++ u4Byte data_frame_num; ++ u4Byte ADCSmp_count; ++ u4Byte ADCSmp_dbg_port; ++ BOOLEAN ADCSmp_trigger_edge; ++ u1Byte ADCsmp_smp_rate; ++ u4Byte ADCsmp_time_unit; ++ ++ /*for noise detection*/ ++ BOOLEAN NoisyDecision; /*b_noisy*/ ++ BOOLEAN pre_b_noisy; ++ u4Byte NoisyDecision_Smooth; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) ++ ODM_NOISE_MONITOR noise_level; ++#endif ++ /*Define STA info.*/ ++ /*_ODM_STA_INFO*/ ++ /*2012/01/12 MH For MP, we need to reduce one array pointer for default port.??*/ ++ PSTA_INFO_T pODM_StaInfo[ODM_ASSOCIATE_ENTRY_NUM]; ++ u2Byte platform2phydm_macid_table[ODM_ASSOCIATE_ENTRY_NUM]; ++ /* platform_macid_table[platform_macid] = phydm_macid */ ++#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) ++ s4Byte AccumulatePWDB[ODM_ASSOCIATE_ENTRY_NUM]; ++#endif ++ ++#if (RATE_ADAPTIVE_SUPPORT == 1) ++ u2Byte CurrminRptTime; ++ ODM_RA_INFO_T RAInfo[ODM_ASSOCIATE_ENTRY_NUM]; ++ /*Use MacID as array index. STA MacID=0, VWiFi Client MacID={1, ODM_ASSOCIATE_ENTRY_NUM-1} //YJ,add,120119*/ ++#endif ++ ++ /*2012/02/14 MH Add to share 88E ra with other SW team.*/ ++ /*We need to colelct all support abilit to a proper area.*/ ++ ++ BOOLEAN RaSupport88E; ++ ++ ODM_PHY_DBG_INFO_T PhyDbgInfo; ++ ++ /*ODM Structure*/ ++#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ BDC_T DM_BdcTable; ++ #endif ++ ++ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 ++ SAT_T dm_sat_table; ++ #endif ++ ++#endif ++ FAT_T DM_FatTable; ++ DIG_T DM_DigTable; ++#if (defined(CONFIG_BB_POWER_SAVING)) ++ PS_T DM_PSTable; ++#endif ++ Pri_CCA_T DM_PriCCA; ++ RA_T DM_RA_Table; ++ FALSE_ALARM_STATISTICS FalseAlmCnt; ++ FALSE_ALARM_STATISTICS FlaseAlmCntBuddyAdapter; ++ SWAT_T DM_SWAT_Table; ++ CFO_TRACKING DM_CfoTrack; ++ ACS DM_ACS; ++ CCX_INFO DM_CCX_INFO; ++ ++ RT_ADCSMP adcsmp; ++ ++#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) ++ IQK_INFO IQK_info; ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ /*Path Div Struct*/ ++ PATHDIV_PARA pathIQK; ++#endif ++#if(defined(CONFIG_PATH_DIVERSITY)) ++ PATHDIV_T DM_PathDiv; ++#endif ++ ++ EDCA_T DM_EDCA_Table; ++ u4Byte WMMEDCA_BE; ++ ++ BOOLEAN *pbDriverStopped; ++ BOOLEAN *pbDriverIsGoingToPnpSetPowerSleep; ++ BOOLEAN *pinit_adpt_in_progress; ++ ++ /*PSD*/ ++ BOOLEAN bUserAssignLevel; ++ u1Byte RSSI_BT; /*come from BT*/ ++ BOOLEAN bPSDinProcess; ++ BOOLEAN bPSDactive; ++ BOOLEAN bDMInitialGainEnable; ++ ++ /*MPT DIG*/ ++ RT_TIMER MPT_DIGTimer; ++ ++ /*for rate adaptive, in fact, 88c/92c fw will handle this*/ ++ u1Byte bUseRAMask; ++ ++ ODM_RATE_ADAPTIVE RateAdaptive; ++ #if (defined(CONFIG_ANT_DETECTION)) ++ ANT_DETECTED_INFO AntDetectedInfo; /* Antenna detected information for RSSI tool*/ ++ #endif ++ ODM_RF_CAL_T RFCalibrateInfo; ++ u4Byte nIQK_Cnt; ++ u4Byte nIQK_OK_Cnt; ++ u4Byte nIQK_Fail_Cnt; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ /*Power Training*/ ++ u1Byte ForcePowerTrainingState; ++ BOOLEAN bChangeState; ++ u4Byte PT_score; ++ u8Byte OFDM_RX_Cnt; ++ u8Byte CCK_RX_Cnt; ++#endif ++ BOOLEAN bDisablePowerTraining; ++ u1Byte DynamicTxHighPowerLvl; ++ u1Byte LastDTPLvl; ++ u4Byte tx_agc_ofdm_18_6; ++ u1Byte rx_pkt_type; ++ ++ /*ODM relative time.*/ ++ RT_TIMER PathDivSwitchTimer; ++ /*2011.09.27 add for Path Diversity*/ ++ RT_TIMER CCKPathDiversityTimer; ++ RT_TIMER FastAntTrainingTimer; ++ #ifdef ODM_EVM_ENHANCE_ANTDIV ++ RT_TIMER EVM_FastAntTrainingTimer; ++ #endif ++ RT_TIMER sbdcnt_timer; ++ ++ /*ODM relative workitem.*/ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++#if USE_WORKITEM ++ RT_WORK_ITEM PathDivSwitchWorkitem; ++ RT_WORK_ITEM CCKPathDiversityWorkitem; ++ RT_WORK_ITEM FastAntTrainingWorkitem; ++ RT_WORK_ITEM MPT_DIGWorkitem; ++ RT_WORK_ITEM RaRptWorkitem; ++ RT_WORK_ITEM sbdcnt_workitem; ++#endif ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) ++#if (BEAMFORMING_SUPPORT == 1) ++ RT_BEAMFORMING_INFO BeamformingInfo; ++#endif ++#endif ++ ++#ifdef CONFIG_PHYDM_DFS_MASTER ++ u1Byte DFS_RegionDomain; ++ pu1Byte dfs_master_enabled; ++ ++ /*====== phydm_radar_detect_with_dbg_parm start ======*/ ++ u1Byte radar_detect_dbg_parm_en; ++ u4Byte radar_detect_reg_918; ++ u4Byte radar_detect_reg_91c; ++ u4Byte radar_detect_reg_920; ++ u4Byte radar_detect_reg_924; ++ /*====== phydm_radar_detect_with_dbg_parm end ======*/ ++#endif ++ ++#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ ++#if (RT_PLATFORM != PLATFORM_LINUX) ++} DM_ODM_T, *PDM_ODM_T; /*DM_Dynamic_Mechanism_Structure*/ ++#else ++}; ++#endif ++ ++#else /*for AP,ADSL,CE Team*/ ++} DM_ODM_T, *PDM_ODM_T; /*DM_Dynamic_Mechanism_Structure*/ ++#endif ++ ++ ++typedef enum _PHYDM_STRUCTURE_TYPE{ ++ PHYDM_FALSEALMCNT, ++ PHYDM_CFOTRACK, ++ PHYDM_ADAPTIVITY, ++ PHYDM_ROMINFO, ++ ++}PHYDM_STRUCTURE_TYPE; ++ ++ ++ ++ typedef enum _ODM_RF_CONTENT{ ++ odm_radioa_txt = 0x1000, ++ odm_radiob_txt = 0x1001, ++ odm_radioc_txt = 0x1002, ++ odm_radiod_txt = 0x1003 ++} ODM_RF_CONTENT; ++ ++typedef enum _ODM_BB_Config_Type{ ++ CONFIG_BB_PHY_REG, ++ CONFIG_BB_AGC_TAB, ++ CONFIG_BB_AGC_TAB_2G, ++ CONFIG_BB_AGC_TAB_5G, ++ CONFIG_BB_PHY_REG_PG, ++ CONFIG_BB_PHY_REG_MP, ++ CONFIG_BB_AGC_TAB_DIFF, ++} ODM_BB_Config_Type, *PODM_BB_Config_Type; ++ ++typedef enum _ODM_RF_Config_Type { ++ CONFIG_RF_RADIO, ++ CONFIG_RF_TXPWR_LMT, ++} ODM_RF_Config_Type, *PODM_RF_Config_Type; ++ ++typedef enum _ODM_FW_Config_Type { ++ CONFIG_FW_NIC, ++ CONFIG_FW_NIC_2, ++ CONFIG_FW_AP, ++ CONFIG_FW_AP_2, ++ CONFIG_FW_MP, ++ CONFIG_FW_WoWLAN, ++ CONFIG_FW_WoWLAN_2, ++ CONFIG_FW_AP_WoWLAN, ++ CONFIG_FW_BT, ++} ODM_FW_Config_Type; ++ ++/*Status code*/ ++#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) ++typedef enum _RT_STATUS{ ++ RT_STATUS_SUCCESS, ++ RT_STATUS_FAILURE, ++ RT_STATUS_PENDING, ++ RT_STATUS_RESOURCE, ++ RT_STATUS_INVALID_CONTEXT, ++ RT_STATUS_INVALID_PARAMETER, ++ RT_STATUS_NOT_SUPPORT, ++ RT_STATUS_OS_API_FAILED, ++}RT_STATUS,*PRT_STATUS; ++#endif /*end of RT_STATUS definition*/ ++ ++#ifdef REMOVE_PACK ++#pragma pack() ++#endif ++ ++/*===========================================================*/ ++/*AGC RX High Power Mode*/ ++/*===========================================================*/ ++#define LNA_Low_Gain_1 0x64 ++#define LNA_Low_Gain_2 0x5A ++#define LNA_Low_Gain_3 0x58 ++ ++#define FA_RXHP_TH1 5000 ++#define FA_RXHP_TH2 1500 ++#define FA_RXHP_TH3 800 ++#define FA_RXHP_TH4 600 ++#define FA_RXHP_TH5 500 ++ ++typedef enum tag_1R_CCA_Type_Definition { ++ CCA_1R =0, ++ CCA_2R = 1, ++ CCA_MAX = 2, ++} DM_1R_CCA_E; ++ ++typedef enum tag_RF_Type_Definition { ++ RF_Save =0, ++ RF_Normal = 1, ++ RF_MAX = 2, ++} DM_RF_E; ++ ++/*check Sta pointer valid or not*/ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++#define IS_STA_VALID(pSta) (pSta && pSta->expire_to) ++#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++#define IS_STA_VALID(pSta) (pSta && pSta->bUsed) ++#else ++#define IS_STA_VALID(pSta) (pSta) ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_AP)) ++ ++BOOLEAN ++ODM_CheckPowerStatus( ++ IN PADAPTER Adapter ++ ); ++ ++#endif ++ ++u4Byte odm_ConvertTo_dB(u4Byte Value); ++ ++u4Byte odm_ConvertTo_linear(u4Byte Value); ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ ++u4Byte ++GetPSDData( ++ PDM_ODM_T pDM_Odm, ++ unsigned int point, ++ u1Byte initial_gain_psd); ++ ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++VOID ++ODM_DMWatchdog_LPS( ++ IN PDM_ODM_T pDM_Odm ++); ++#endif ++ ++ ++s4Byte ++ODM_PWdB_Conversion( ++ IN s4Byte X, ++ IN u4Byte TotalBit, ++ IN u4Byte DecimalBit ++ ); ++ ++s4Byte ++ODM_SignConversion( ++ IN s4Byte value, ++ IN u4Byte TotalBit ++ ); ++ ++VOID ++ODM_InitMpDriverStatus( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++void ++phydm_seq_sorting( ++ IN PVOID pDM_VOID, ++ IN OUT u4Byte *p_value, ++ IN OUT u4Byte *rank_idx, ++ IN OUT u4Byte *p_idx_out, ++ IN u1Byte seq_length ++); ++ ++VOID ++ODM_DMInit( ++ IN PDM_ODM_T pDM_Odm ++); ++ ++VOID ++ODM_DMReset( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++VOID ++phydm_support_ability_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ); ++ ++VOID ++phydm_config_trx_path( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ); ++ ++VOID ++ODM_DMWatchdog( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++VOID ++ODM_CmnInfoInit( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_CMNINFO_E CmnInfo, ++ IN u4Byte Value ++ ); ++ ++VOID ++ODM_CmnInfoHook( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_CMNINFO_E CmnInfo, ++ IN PVOID pValue ++ ); ++ ++VOID ++ODM_CmnInfoPtrArrayHook( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_CMNINFO_E CmnInfo, ++ IN u2Byte Index, ++ IN PVOID pValue ++ ); ++ ++VOID ++ODM_CmnInfoUpdate( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte CmnInfo, ++ IN u8Byte Value ++ ); ++ ++u4Byte ++PHYDM_CmnInfoQuery( ++ IN PDM_ODM_T pDM_Odm, ++ IN PHYDM_INFO_QUERY_E info_type ++ ); ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++VOID ++ODM_InitAllThreads( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++VOID ++ODM_StopAllThreads( ++ IN PDM_ODM_T pDM_Odm ++ ); ++#endif ++ ++VOID ++ODM_InitAllTimers( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++VOID ++ODM_CancelAllTimers( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++VOID ++ODM_ReleaseAllTimers( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ODM_InitAllWorkItems(IN PDM_ODM_T pDM_Odm ); ++VOID ODM_FreeAllWorkItems(IN PDM_ODM_T pDM_Odm ); ++ ++u8Byte ++PlatformDivision64( ++ IN u8Byte x, ++ IN u8Byte y ++); ++ ++#define DM_ChangeDynamicInitGainThresh ODM_ChangeDynamicInitGainThresh ++ ++typedef enum tag_DIG_Connect_Definition ++{ ++ DIG_STA_DISCONNECT = 0, ++ DIG_STA_CONNECT = 1, ++ DIG_STA_BEFORE_CONNECT = 2, ++ DIG_MultiSTA_DISCONNECT = 3, ++ DIG_MultiSTA_CONNECT = 4, ++ DIG_CONNECT_MAX ++} DM_DIG_CONNECT_E; ++ ++/*2012/01/12 MH Check afapter status. Temp fix BSOD.*/ ++ ++#define HAL_ADAPTER_STS_CHK(pDM_Odm)\ ++ if (pDM_Odm->Adapter == NULL)\ ++ {\ ++ return;\ ++ }\ ++ ++#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ ++ ++VOID ++ODM_AsocEntry_Init( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++ ++PVOID ++PhyDM_Get_Structure( ++ IN PDM_ODM_T pDM_Odm, ++ IN u1Byte Structure_Type ++); ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ||(DM_ODM_SUPPORT_TYPE == ODM_CE) ++/*===========================================================*/ ++/* The following is for compile only*/ ++/*===========================================================*/ ++ ++#define IS_HARDWARE_TYPE_8723A(_Adapter) FALSE ++#define IS_HARDWARE_TYPE_8723AE(_Adapter) FALSE ++#define IS_HARDWARE_TYPE_8192C(_Adapter) FALSE ++#define IS_HARDWARE_TYPE_8192D(_Adapter) FALSE ++#define RF_T_METER_92D 0x42 ++ ++ ++#define GET_RX_STATUS_DESC_RX_MCS(__pRxStatusDesc) LE_BITS_TO_1BYTE(__pRxStatusDesc+12, 0, 6) ++ ++#define rConfig_ram64x16 0xb2c ++ ++#define TARGET_CHNL_NUM_2G_5G 59 ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++u1Byte GetRightChnlPlaceforIQK(u1Byte chnl); ++#endif ++ ++//=========================================================== ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++void odm_dtc(PDM_ODM_T pDM_Odm); ++#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ ++ ++ ++VOID phydm_NoisyDetection(IN PDM_ODM_T pDM_Odm ); ++ ++ ++#endif ++ ++VOID ++phydm_set_ext_switch( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++); ++ ++VOID ++phydm_api_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte function_map, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++); ++ ++u1Byte ++phydm_nbi_setting( ++ IN PVOID pDM_VOID, ++ IN u4Byte enable, ++ IN u4Byte channel, ++ IN u4Byte bw, ++ IN u4Byte f_interference, ++ IN u4Byte Second_ch ++); ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.c 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,3652 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++#define READ_AND_CONFIG_MP(ic, txt) (ODM_ReadAndConfig_MP_##ic##txt(pDM_Odm)) ++#define READ_AND_CONFIG_TC(ic, txt) (ODM_ReadAndConfig_TC_##ic##txt(pDM_Odm)) ++ ++ ++#if (PHYDM_TESTCHIP_SUPPORT == 1) ++#define READ_AND_CONFIG(ic, txt) do {\ ++ if (pDM_Odm->bIsMPChip)\ ++ READ_AND_CONFIG_MP(ic,txt);\ ++ else\ ++ READ_AND_CONFIG_TC(ic,txt);\ ++ } while(0) ++#else ++ #define READ_AND_CONFIG READ_AND_CONFIG_MP ++#endif ++ ++ ++#define READ_FIRMWARE_MP(ic, txt) (ODM_ReadFirmware_MP_##ic##txt(pDM_Odm, pFirmware, pSize)) ++#define READ_FIRMWARE_TC(ic, txt) (ODM_ReadFirmware_TC_##ic##txt(pDM_Odm, pFirmware, pSize)) ++ ++#if (PHYDM_TESTCHIP_SUPPORT == 1) ++#define READ_FIRMWARE(ic, txt) do {\ ++ if (pDM_Odm->bIsMPChip)\ ++ READ_FIRMWARE_MP(ic,txt);\ ++ else\ ++ READ_FIRMWARE_TC(ic,txt);\ ++ } while(0) ++#else ++#define READ_FIRMWARE READ_FIRMWARE_MP ++#endif ++ ++#define GET_VERSION_MP(ic, txt) (ODM_GetVersion_MP_##ic##txt()) ++#define GET_VERSION_TC(ic, txt) (ODM_GetVersion_TC_##ic##txt()) ++ ++#if (PHYDM_TESTCHIP_SUPPORT == 1) ++#define GET_VERSION(ic, txt) (pDM_Odm->bIsMPChip?GET_VERSION_MP(ic,txt):GET_VERSION_TC(ic,txt)) ++#else ++#define GET_VERSION(ic, txt) GET_VERSION_MP(ic, txt) ++#endif ++ ++u1Byte ++odm_QueryRxPwrPercentage( ++ IN s1Byte AntPower ++ ) ++{ ++ if ((AntPower <= -100) || (AntPower >= 20)) ++ return 0; ++ else if (AntPower >= 0) ++ return 100; ++ else ++ return (100 + AntPower); ++} ++ ++ ++// ++// 2012/01/12 MH MOve some signal strength smooth method to MP HAL layer. ++// IF other SW team do not support the feature, remove this section.?? ++// ++s4Byte ++odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Lenovo( ++ IN OUT PDM_ODM_T pDM_Odm, ++ s4Byte CurrSig ++) ++{ ++ s4Byte RetSig = 0; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ //if(pDM_Odm->SupportInterface == ODM_ITRF_PCIE) ++ { ++ // Step 1. Scale mapping. ++ // 20100611 Joseph: Re-tunning RSSI presentation for Lenovo. ++ // 20100426 Joseph: Modify Signal strength mapping. ++ // This modification makes the RSSI indication similar to Intel solution. ++ // 20100414 Joseph: Tunning RSSI for Lenovo according to RTL8191SE. ++ if (CurrSig >= 54 && CurrSig <= 100) ++ RetSig = 100; ++ else if (CurrSig >= 42 && CurrSig <= 53) ++ RetSig = 95; ++ else if (CurrSig >= 36 && CurrSig <= 41) ++ RetSig = 74 + ((CurrSig - 36) * 20) / 6; ++ else if (CurrSig >= 33 && CurrSig <= 35) ++ RetSig = 65 + ((CurrSig - 33) * 8) / 2; ++ else if (CurrSig >= 18 && CurrSig <= 32) ++ RetSig = 62 + ((CurrSig - 18) * 2) / 15; ++ else if (CurrSig >= 15 && CurrSig <= 17) ++ RetSig = 33 + ((CurrSig - 15) * 28) / 2; ++ else if (CurrSig >= 10 && CurrSig <= 14) ++ RetSig = 39; ++ else if (CurrSig >= 8 && CurrSig <= 9) ++ RetSig = 33; ++ else if (CurrSig <= 8) ++ RetSig = 19; ++ } ++#endif //ENDIF (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ return RetSig; ++} ++ ++s4Byte ++odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Netcore( ++ IN OUT PDM_ODM_T pDM_Odm, ++ s4Byte CurrSig ++) ++{ ++ s4Byte RetSig = 0; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ //if(pDM_Odm->SupportInterface == ODM_ITRF_USB) ++ { ++ // Netcore request this modification because 2009.04.13 SU driver use it. ++ if (CurrSig >= 31 && CurrSig <= 100) ++ RetSig = 100; ++ else if (CurrSig >= 21 && CurrSig <= 30) ++ RetSig = 90 + ((CurrSig - 20) / 1); ++ else if (CurrSig >= 11 && CurrSig <= 20) ++ RetSig = 80 + ((CurrSig - 10) / 1); ++ else if (CurrSig >= 7 && CurrSig <= 10) ++ RetSig = 69 + (CurrSig - 7); ++ else if (CurrSig == 6) ++ RetSig = 54; ++ else if (CurrSig == 5) ++ RetSig = 45; ++ else if (CurrSig == 4) ++ RetSig = 36; ++ else if (CurrSig == 3) ++ RetSig = 27; ++ else if (CurrSig == 2) ++ RetSig = 18; ++ else if (CurrSig == 1) ++ RetSig = 9; ++ else ++ RetSig = CurrSig; ++ } ++#endif //ENDIF (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ return RetSig; ++} ++ ++ ++s4Byte ++odm_SignalScaleMapping_92CSeries( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN s4Byte CurrSig ++) ++{ ++ s4Byte RetSig = 0; ++#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) ++ { ++ // Step 1. Scale mapping. ++ if(CurrSig >= 61 && CurrSig <= 100) ++ { ++ RetSig = 90 + ((CurrSig - 60) / 4); ++ } ++ else if(CurrSig >= 41 && CurrSig <= 60) ++ { ++ RetSig = 78 + ((CurrSig - 40) / 2); ++ } ++ else if(CurrSig >= 31 && CurrSig <= 40) ++ { ++ RetSig = 66 + (CurrSig - 30); ++ } ++ else if(CurrSig >= 21 && CurrSig <= 30) ++ { ++ RetSig = 54 + (CurrSig - 20); ++ } ++ else if(CurrSig >= 5 && CurrSig <= 20) ++ { ++ RetSig = 42 + (((CurrSig - 5) * 2) / 3); ++ } ++ else if(CurrSig == 4) ++ { ++ RetSig = 36; ++ } ++ else if(CurrSig == 3) ++ { ++ RetSig = 27; ++ } ++ else if(CurrSig == 2) ++ { ++ RetSig = 18; ++ } ++ else if(CurrSig == 1) ++ { ++ RetSig = 9; ++ } ++ else ++ { ++ RetSig = CurrSig; ++ } ++ } ++#endif ++ ++#if ((DEV_BUS_TYPE == RT_USB_INTERFACE) ||(DEV_BUS_TYPE == RT_SDIO_INTERFACE)) ++ if((pDM_Odm->SupportInterface == ODM_ITRF_USB) || (pDM_Odm->SupportInterface == ODM_ITRF_SDIO)) ++ { ++ if(CurrSig >= 51 && CurrSig <= 100) ++ { ++ RetSig = 100; ++ } ++ else if(CurrSig >= 41 && CurrSig <= 50) ++ { ++ RetSig = 80 + ((CurrSig - 40)*2); ++ } ++ else if(CurrSig >= 31 && CurrSig <= 40) ++ { ++ RetSig = 66 + (CurrSig - 30); ++ } ++ else if(CurrSig >= 21 && CurrSig <= 30) ++ { ++ RetSig = 54 + (CurrSig - 20); ++ } ++ else if(CurrSig >= 10 && CurrSig <= 20) ++ { ++ RetSig = 42 + (((CurrSig - 10) * 2) / 3); ++ } ++ else if(CurrSig >= 5 && CurrSig <= 9) ++ { ++ RetSig = 22 + (((CurrSig - 5) * 3) / 2); ++ } ++ else if(CurrSig >= 1 && CurrSig <= 4) ++ { ++ RetSig = 6 + (((CurrSig - 1) * 3) / 2); ++ } ++ else ++ { ++ RetSig = CurrSig; ++ } ++ } ++ ++#endif ++ return RetSig; ++} ++s4Byte ++odm_SignalScaleMapping( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN s4Byte CurrSig ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if( (pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->SupportInterface != ODM_ITRF_PCIE) && //USB & SDIO ++ (pDM_Odm->PatchID==10))//pMgntInfo->CustomerID == RT_CID_819x_Netcore ++ { ++ return odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Netcore(pDM_Odm,CurrSig); ++ } ++ else if( (pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) && ++ (pDM_Odm->PatchID==19))//pMgntInfo->CustomerID == RT_CID_819x_Lenovo) ++ { ++ return odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Lenovo(pDM_Odm, CurrSig); ++ }else ++#endif ++ { ++#ifdef CONFIG_SIGNAL_SCALE_MAPPING ++ return odm_SignalScaleMapping_92CSeries(pDM_Odm,CurrSig); ++#else ++ return CurrSig; ++#endif ++ } ++ ++} ++ ++ ++ ++static u1Byte odm_SQ_process_patch_RT_CID_819x_Lenovo( ++ IN PDM_ODM_T pDM_Odm, ++ IN u1Byte isCCKrate, ++ IN u1Byte PWDB_ALL, ++ IN u1Byte path, ++ IN u1Byte RSSI ++) ++{ ++ u1Byte SQ = 0; ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ ++ if(isCCKrate){ ++ ++ if (IS_HARDWARE_TYPE_8192E(pDM_Odm->Adapter)) { ++ ++ // ++ // Expected signal strength and bars indication at Lenovo lab. 2013.04.11 ++ // 802.11n, 802.11b, 802.11g only at channel 6 ++ // ++ // Attenuation (dB) OS Signal Bars RSSI by Xirrus (dBm) ++ // 50 5 -49 ++ // 55 5 -49 ++ // 60 5 -50 ++ // 65 5 -51 ++ // 70 5 -52 ++ // 75 5 -54 ++ // 80 5 -55 ++ // 85 4 -60 ++ // 90 3 -63 ++ // 95 3 -65 ++ // 100 2 -67 ++ // 102 2 -67 ++ // 104 1 -70 ++ // ++ ++ if(PWDB_ALL >= 50) ++ SQ = 100; ++ else if(PWDB_ALL >= 35 && PWDB_ALL < 50) ++ SQ = 80; ++ else if(PWDB_ALL >= 31 && PWDB_ALL < 35) ++ SQ = 60; ++ else if(PWDB_ALL >= 22 && PWDB_ALL < 31) ++ SQ = 40; ++ else if(PWDB_ALL >= 18 && PWDB_ALL < 22) ++ SQ = 20; ++ else ++ SQ = 10; ++ } else { ++ if (PWDB_ALL >= 50) ++ SQ = 100; ++ else if (PWDB_ALL >= 35 && PWDB_ALL < 50) ++ SQ = 80; ++ else if (PWDB_ALL >= 22 && PWDB_ALL < 35) ++ SQ = 60; ++ else if (PWDB_ALL >= 18 && PWDB_ALL < 22) ++ SQ = 40; ++ else ++ SQ = 10; ++ } ++ ++ } ++ else ++ {//OFDM rate ++ ++ if (IS_HARDWARE_TYPE_8192E(pDM_Odm->Adapter)) { ++ if(RSSI >= 45) ++ SQ = 100; ++ else if(RSSI >= 22 && RSSI < 45) ++ SQ = 80; ++ else if(RSSI >= 18 && RSSI < 22) ++ SQ = 40; ++ else ++ SQ = 20; ++ } else { ++ if(RSSI >= 45) ++ SQ = 100; ++ else if(RSSI >= 22 && RSSI < 45) ++ SQ = 80; ++ else if(RSSI >= 18 && RSSI < 22) ++ SQ = 40; ++ else ++ SQ = 20; ++ } ++ } ++ ++ RT_TRACE(COMP_DBG, DBG_TRACE, ("isCCKrate(%#d), PWDB_ALL(%#d), RSSI(%#d), SQ(%#d)\n", isCCKrate, PWDB_ALL, RSSI, SQ)); ++ ++#endif ++ return SQ; ++} ++ ++static u1Byte odm_SQ_process_patch_RT_CID_819x_Acer( ++ IN PDM_ODM_T pDM_Odm, ++ IN u1Byte isCCKrate, ++ IN u1Byte PWDB_ALL, ++ IN u1Byte path, ++ IN u1Byte RSSI ++) ++{ ++ u1Byte SQ = 0; ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ ++ if(isCCKrate){ ++ ++ RT_TRACE(COMP_DBG, DBG_WARNING, ("odm_SQ_process_patch_RT_Acer\n")); ++ ++#if OS_WIN_FROM_WIN8(OS_VERSION) ++ ++ if(PWDB_ALL >= 50) ++ SQ = 100; ++ else if(PWDB_ALL >= 35 && PWDB_ALL < 50) ++ SQ = 80; ++ else if(PWDB_ALL >= 30 && PWDB_ALL < 35) ++ SQ = 60; ++ else if(PWDB_ALL >= 25 && PWDB_ALL < 30) ++ SQ = 40; ++ else if(PWDB_ALL >= 20 && PWDB_ALL < 25) ++ SQ = 20; ++ else ++ SQ = 10; ++#else ++ if(PWDB_ALL >= 50) ++ SQ = 100; ++ else if(PWDB_ALL >= 35 && PWDB_ALL < 50) ++ SQ = 80; ++ else if(PWDB_ALL >= 30 && PWDB_ALL < 35) ++ SQ = 60; ++ else if(PWDB_ALL >= 25 && PWDB_ALL < 30) ++ SQ = 40; ++ else if(PWDB_ALL >= 20 && PWDB_ALL < 25) ++ SQ = 20; ++ else ++ SQ = 10; ++ ++ if(PWDB_ALL == 0)// Abnormal case, do not indicate the value above 20 on Win7 ++ SQ = 20; ++#endif ++ ++ ++ ++ } ++ else ++ {//OFDM rate ++ ++ if (IS_HARDWARE_TYPE_8192E(pDM_Odm->Adapter)) { ++ if(RSSI >= 45) ++ SQ = 100; ++ else if(RSSI >= 22 && RSSI < 45) ++ SQ = 80; ++ else if(RSSI >= 18 && RSSI < 22) ++ SQ = 40; ++ else ++ SQ = 20; ++ } ++ else ++ { ++ if(RSSI >= 35) ++ SQ = 100; ++ else if(RSSI >= 30 && RSSI < 35) ++ SQ = 80; ++ else if(RSSI >= 25 && RSSI < 30) ++ SQ = 40; ++ else ++ SQ = 20; ++ } ++ } ++ ++ RT_TRACE(COMP_DBG, DBG_LOUD, ("isCCKrate(%#d), PWDB_ALL(%#d), RSSI(%#d), SQ(%#d)\n", isCCKrate, PWDB_ALL, RSSI, SQ)); ++ ++#endif ++ return SQ; ++} ++ ++static u1Byte ++odm_EVMdbToPercentage( ++ IN s1Byte Value ++ ) ++{ ++ // ++ // -33dB~0dB to 0%~99% ++ // ++ s1Byte ret_val; ++ ++ ret_val = Value; ++ ret_val /= 2; ++ ++ /*DbgPrint("Value=%d\n", Value);*/ ++ /*ODM_RT_DISP(FRX, RX_PHY_SQ, ("EVMdbToPercentage92C Value=%d / %x\n", ret_val, ret_val));*/ ++#ifdef ODM_EVM_ENHANCE_ANTDIV ++ if (ret_val >= 0) ++ ret_val = 0; ++ ++ if (ret_val <= -40) ++ ret_val = -40; ++ ++ ret_val = 0 - ret_val; ++ ret_val *= 3; ++#else ++ if (ret_val >= 0) ++ ret_val = 0; ++ ++ if (ret_val <= -33) ++ ret_val = -33; ++ ++ ret_val = 0 - ret_val; ++ ret_val *= 3; ++ ++ if (ret_val == 99) ++ ret_val = 100; ++#endif ++ ++ return (u1Byte)ret_val; ++} ++ ++static u1Byte ++odm_EVMdbm_JaguarSeries( ++ IN s1Byte Value ++ ) ++{ ++ s1Byte ret_val = Value; ++ ++ // -33dB~0dB to 33dB ~ 0dB ++ if(ret_val == -128) ++ ret_val = 127; ++ else if (ret_val < 0) ++ ret_val = 0 - ret_val; ++ ++ ret_val = ret_val >> 1; ++ return (u1Byte)ret_val; ++} ++ ++static s2Byte ++odm_Cfo( ++ IN s1Byte Value ++) ++{ ++ s2Byte ret_val; ++ ++ if (Value < 0) ++ { ++ ret_val = 0 - Value; ++ ret_val = (ret_val << 1) + (ret_val >> 1) ; // *2.5~=312.5/2^7 ++ ret_val = ret_val | BIT12; // set bit12 as 1 for negative cfo ++ } ++ else ++ { ++ ret_val = Value; ++ ret_val = (ret_val << 1) + (ret_val>>1) ; // *2.5~=312.5/2^7 ++ } ++ return ret_val; ++} ++ ++u1Byte ++phydm_rate_to_num_ss( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN u1Byte DataRate ++) ++{ ++ u1Byte num_ss = 1; ++ ++ if (DataRate <= ODM_RATE54M) ++ num_ss = 1; ++ else if (DataRate <= ODM_RATEMCS31) ++ num_ss = ((DataRate - ODM_RATEMCS0) >> 3)+1; ++ else if (DataRate <= ODM_RATEVHTSS1MCS9) ++ num_ss = 1; ++ else if (DataRate <= ODM_RATEVHTSS2MCS9) ++ num_ss = 2; ++ else if (DataRate <= ODM_RATEVHTSS3MCS9) ++ num_ss = 3; ++ else if (DataRate <= ODM_RATEVHTSS4MCS9) ++ num_ss = 4; ++ ++ return num_ss; ++} ++ ++#if(ODM_IC_11N_SERIES_SUPPORT == 1) ++ ++#if (RTL8703B_SUPPORT == 1) ++s1Byte ++odm_CCKRSSI_8703B( ++ IN u2Byte LNA_idx, ++ IN u1Byte VGA_idx ++ ) ++{ ++ s1Byte rx_pwr_all = 0x00; ++ ++ switch (LNA_idx) { ++ case 0xf: ++ rx_pwr_all = -48 - (2 * VGA_idx); ++ break; ++ case 0xb: ++ rx_pwr_all = -42 - (2 * VGA_idx); /*TBD*/ ++ break; ++ case 0xa: ++ rx_pwr_all = -36 - (2 * VGA_idx); ++ break; ++ case 8: ++ rx_pwr_all = -32 - (2 * VGA_idx); ++ break; ++ case 7: ++ rx_pwr_all = -19 - (2 * VGA_idx); ++ break; ++ case 4: ++ rx_pwr_all = -6 - (2 * VGA_idx); ++ break; ++ case 0: ++ rx_pwr_all = -2 - (2 * VGA_idx); ++ break; ++ default: ++ /*rx_pwr_all = -53+(2*(31-VGA_idx));*/ ++ /*DbgPrint("wrong LNA index\n");*/ ++ break; ++ ++ } ++ return rx_pwr_all; ++} ++#endif ++ ++#if (RTL8195A_SUPPORT == 1) ++s1Byte ++odm_CCKRSSI_8195A( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN u2Byte LNA_idx, ++ IN u1Byte VGA_idx ++ ) ++{ ++ s1Byte rx_pwr_all = 0; ++ s1Byte lna_gain = 0; ++ s1Byte lna_gain_table_0[8] = {0, -8, -15, -22, -29, -36, -45, -54}; ++ s1Byte lna_gain_table_1[8] = {0, -8, -15, -22, -29, -36, -45, -54};/*use 8195A to calibrate this table. 2016.06.24, Dino*/ ++ ++ if (pDM_Odm->cck_agc_report_type == 0) ++ lna_gain = lna_gain_table_0[LNA_idx]; ++ else ++ lna_gain = lna_gain_table_1[LNA_idx]; ++ ++ rx_pwr_all = lna_gain - (2 * VGA_idx); ++ ++ return rx_pwr_all; ++} ++#endif ++ ++#if (RTL8192E_SUPPORT == 1) ++s1Byte ++odm_CCKRSSI_8192E( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN u2Byte LNA_idx, ++ IN u1Byte VGA_idx ++ ) ++{ ++ s1Byte rx_pwr_all = 0; ++ s1Byte lna_gain = 0; ++ s1Byte lna_gain_table_0[8] = {15, 9, -10, -21, -23, -27, -43, -44}; ++ s1Byte lna_gain_table_1[8] = {24, 18, 13, -4, -11, -18, -31, -36};/*use 8192EU to calibrate this table. 2015.12.15, Dino*/ ++ ++ if (pDM_Odm->cck_agc_report_type == 0) ++ lna_gain = lna_gain_table_0[LNA_idx]; ++ else ++ lna_gain = lna_gain_table_1[LNA_idx]; ++ ++ rx_pwr_all = lna_gain - (2 * VGA_idx); ++ ++ return rx_pwr_all; ++} ++#endif ++ ++#if (RTL8188E_SUPPORT == 1) ++s1Byte ++odm_CCKRSSI_8188E( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN u2Byte LNA_idx, ++ IN u1Byte VGA_idx ++ ) ++{ ++ s1Byte rx_pwr_all = 0; ++ s1Byte lna_gain = 0; ++ s1Byte lna_gain_table_0[8] = {17, -1, -13, -29, -32, -35, -38, -41};/*only use lna0/1/2/3/7*/ ++ s1Byte lna_gain_table_1[8] = {29, 20, 12, 3, -6, -15, -24, -33}; /*only use lna3 /7*/ ++ ++ if (pDM_Odm->CutVersion >= ODM_CUT_I) /*SMIC*/ ++ lna_gain = lna_gain_table_0[LNA_idx]; ++ else /*TSMC*/ ++ lna_gain = lna_gain_table_1[LNA_idx]; ++ ++ rx_pwr_all = lna_gain - (2 * VGA_idx); ++ ++ return rx_pwr_all; ++} ++#endif ++ ++VOID ++odm_RxPhyStatus92CSeries_Parsing( ++ IN OUT PDM_ODM_T pDM_Odm, ++ OUT PODM_PHY_INFO_T pPhyInfo, ++ IN pu1Byte pPhyStatus, ++ IN PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ u1Byte i, Max_spatial_stream; ++ s1Byte rx_pwr[4], rx_pwr_all=0; ++ u1Byte EVM, PWDB_ALL = 0, PWDB_ALL_BT; ++ u1Byte RSSI, total_rssi=0; ++ BOOLEAN isCCKrate=FALSE; ++ u1Byte rf_rx_num = 0; ++ u1Byte cck_highpwr = 0; ++ u1Byte LNA_idx = 0; ++ u1Byte VGA_idx = 0; ++ u1Byte cck_agc_rpt; ++ u1Byte num_ss; ++ PPHY_STATUS_RPT_8192CD_T pPhyStaRpt = (PPHY_STATUS_RPT_8192CD_T)pPhyStatus; ++ ++ isCCKrate = (pPktinfo->DataRate <= ODM_RATE11M) ? TRUE : FALSE; ++ ++ if (pPktinfo->bToSelf) ++ pDM_Odm->curr_station_id = pPktinfo->StationID; ++ ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = -1; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; ++ ++ ++ if(isCCKrate) ++ { ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; ++ cck_agc_rpt = pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a ; ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8703B)) { ++ ++ #if (RTL8703B_SUPPORT == 1) ++ if (pDM_Odm->cck_agc_report_type == 1) { /*4 bit LNA*/ ++ ++ u1Byte cck_agc_rpt_b = (pPhyStaRpt->cck_rpt_b_ofdm_cfosho_b & BIT7) ? 1 : 0; ++ ++ LNA_idx = (cck_agc_rpt_b << 3) | ((cck_agc_rpt & 0xE0) >> 5); ++ VGA_idx = (cck_agc_rpt & 0x1F); ++ ++ rx_pwr_all = odm_CCKRSSI_8703B(LNA_idx, VGA_idx); ++ } ++ #endif ++ } else { /*3 bit LNA*/ ++ ++ LNA_idx = ((cck_agc_rpt & 0xE0) >>5); ++ VGA_idx = (cck_agc_rpt & 0x1F); ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8188E)) { ++ ++ #if (RTL8188E_SUPPORT == 1) ++ rx_pwr_all = odm_CCKRSSI_8188E(pDM_Odm, LNA_idx, VGA_idx); ++ /**/ ++ #endif ++ } ++ #if (RTL8192E_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { ++ ++ rx_pwr_all = odm_CCKRSSI_8192E(pDM_Odm, LNA_idx, VGA_idx); ++ /**/ ++ } ++ #endif ++ #if (RTL8723B_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType & (ODM_RTL8723B)) { ++ ++ rx_pwr_all = odm_CCKRSSI_8723B(LNA_idx,VGA_idx); ++ /**/ ++ } ++ #endif ++ #if (RTL8188F_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType & (ODM_RTL8188F)) { ++ ++ rx_pwr_all = odm_CCKRSSI_8188F(LNA_idx, VGA_idx); ++ /**/ ++ } ++ #endif ++ #if (RTL8195A_SUPPORT == 1) ++ else if (pDM_Odm->SupportICType & (ODM_RTL8195A)) { ++ ++ rx_pwr_all = odm_CCKRSSI_8195A(LNA_idx, VGA_idx); ++ /**/ ++ } ++ #endif ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("ExtLNAGain (( %d )), LNA_idx: (( 0x%x )), VGA_idx: (( 0x%x )), rx_pwr_all: (( %d ))\n", ++ pDM_Odm->ExtLNAGain, LNA_idx, VGA_idx, rx_pwr_all)); ++ ++ if (pDM_Odm->BoardType & ODM_BOARD_EXT_LNA) ++ rx_pwr_all -= pDM_Odm->ExtLNAGain; ++ ++ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); ++ ++ if (pPktinfo->bToSelf) { ++ pDM_Odm->cck_lna_idx = LNA_idx; ++ pDM_Odm->cck_vga_idx = VGA_idx; ++ } ++ pPhyInfo->RxPWDBAll = PWDB_ALL; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL; ++ pPhyInfo->RecvSignalPower = rx_pwr_all; ++#endif ++ // ++ // (3) Get Signal Quality (EVM) ++ // ++ //if(pPktinfo->bPacketMatchBSSID) ++ { ++ u1Byte SQ,SQ_rpt; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if((pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)){ ++ SQ = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,0,0); ++ }else if((pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->PatchID==RT_CID_819x_Acer)) ++ { ++ SQ = odm_SQ_process_patch_RT_CID_819x_Acer(pDM_Odm,isCCKrate,PWDB_ALL,0,0); ++ }else ++#endif ++ if(pPhyInfo->RxPWDBAll > 40 && !pDM_Odm->bInHctTest){ ++ SQ = 100; ++ } ++ else{ ++ SQ_rpt = pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all; ++ ++ if(SQ_rpt > 64) ++ SQ = 0; ++ else if (SQ_rpt < 20) ++ SQ = 100; ++ else ++ SQ = ((64-SQ_rpt) * 100) / 44; ++ ++ } ++ ++ //DbgPrint("cck SQ = %d\n", SQ); ++ pPhyInfo->SignalQuality = SQ; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = SQ; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; ++ } ++ ++ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) { ++ if (i == 0) ++ pPhyInfo->RxMIMOSignalStrength[0] = PWDB_ALL; ++ else ++ pPhyInfo->RxMIMOSignalStrength[1] = 0; ++ } ++ } ++ else //2 is OFDM rate ++ { ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; ++ ++ // ++ // (1)Get RSSI for HT rate ++ // ++ ++ for(i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) ++ { ++ // 2008/01/30 MH we will judge RF RX path now. ++ if (pDM_Odm->RFPathRxEnable & BIT(i)) ++ rf_rx_num++; ++ //else ++ //continue; ++ ++ rx_pwr[i] = ((pPhyStaRpt->path_agc[i].gain& 0x3F)*2) - 110; ++ ++ if (pPktinfo->bToSelf) { ++ pDM_Odm->ofdm_agc_idx[i] = (pPhyStaRpt->path_agc[i].gain & 0x3F); ++ /**/ ++ } ++ ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ pPhyInfo->RxPwr[i] = rx_pwr[i]; ++ #endif ++ ++ /* Translate DBM to percentage. */ ++ RSSI = odm_QueryRxPwrPercentage(rx_pwr[i]); ++ total_rssi += RSSI; ++ //RT_DISP(FRX, RX_PHY_SS, ("RF-%d RXPWR=%x RSSI=%d\n", i, rx_pwr[i], RSSI)); ++ ++ pPhyInfo->RxMIMOSignalStrength[i] =(u1Byte) RSSI; ++ ++ #if (DM_ODM_SUPPORT_TYPE & (/*ODM_WIN|*/ODM_CE|ODM_AP)) ++ //Get Rx snr value in DB ++ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = (s4Byte)(pPhyStaRpt->path_rxsnr[i]/2); ++ #endif ++ ++ /* Record Signal Strength for next packet */ ++ //if(pPktinfo->bPacketMatchBSSID) ++ { ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if((pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)) ++ { ++ if(i==ODM_RF_PATH_A) ++ pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,i,RSSI); ++ ++ } ++ else if((pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->PatchID==RT_CID_819x_Acer)) ++ { ++ pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Acer(pDM_Odm,isCCKrate,PWDB_ALL,0,RSSI); ++ } ++#endif ++ } ++ } ++ ++ ++ // ++ // (2)PWDB, Average PWDB cacluated by hardware (for rate adaptive) ++ // ++ rx_pwr_all = (((pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all) >> 1 )& 0x7f) -110; ++ ++ PWDB_ALL_BT = PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); ++ ++ ++ pPhyInfo->RxPWDBAll = PWDB_ALL; ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("ODM OFDM RSSI=%d\n",pPhyInfo->RxPWDBAll)); ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL_BT; ++ pPhyInfo->RxPower = rx_pwr_all; ++ pPhyInfo->RecvSignalPower = rx_pwr_all; ++ #endif ++ ++ if((pDM_Odm->SupportPlatform == ODM_WIN) &&(pDM_Odm->PatchID==19)){ ++ //do nothing ++ }else if((pDM_Odm->SupportPlatform == ODM_WIN) &&(pDM_Odm->PatchID==25)){ ++ //do nothing ++ } ++ else{//pMgntInfo->CustomerID != RT_CID_819x_Lenovo ++ // ++ // (3)EVM of HT rate ++ // ++ if(pPktinfo->DataRate >=ODM_RATEMCS8 && pPktinfo->DataRate <=ODM_RATEMCS15) ++ Max_spatial_stream = 2; //both spatial stream make sense ++ else ++ Max_spatial_stream = 1; //only spatial stream 1 makes sense ++ ++ for(i=0; i>= 1" because the compilor of free build environment ++ // fill most significant bit to "zero" when doing shifting operation which may change a negative ++ // value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore. ++ EVM = odm_EVMdbToPercentage( (pPhyStaRpt->stream_rxevm[i] )); //dbm ++ ++ //GET_RX_STATUS_DESC_RX_MCS(pDesc), pDrvInfo->rxevm[i], "%", EVM)); ++ ++ //if(pPktinfo->bPacketMatchBSSID) ++ { ++ if(i==ODM_RF_PATH_A) // Fill value in RFD, Get the first spatial stream only ++ { ++ pPhyInfo->SignalQuality = (u1Byte)(EVM & 0xff); ++ } ++ pPhyInfo->RxMIMOSignalQuality[i] = (u1Byte)(EVM & 0xff); ++ } ++ } ++ } ++ ++ num_ss =phydm_rate_to_num_ss(pDM_Odm, pPktinfo->DataRate ); ++ ODM_ParsingCFO(pDM_Odm, pPktinfo, pPhyStaRpt->path_cfotail, num_ss); ++ ++ } ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ //UI BSS List signal strength(in percentage), make it good looking, from 0~100. ++ //It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp(). ++ if(isCCKrate) ++ { ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ // 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/ ++ pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, PWDB_ALL, TRUE, TRUE); ++#else ++ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, PWDB_ALL));/*PWDB_ALL;*/ ++#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ ++ } ++ else ++ { ++ if (rf_rx_num != 0) ++ { ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ // 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/ ++ pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, (total_rssi /= rf_rx_num), TRUE, FALSE); ++ #else ++ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, total_rssi /= rf_rx_num)); ++ #endif ++ } ++ } ++#endif /*#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE))*/ ++ ++ //DbgPrint("isCCKrate = %d, pPhyInfo->RxPWDBAll = %d, pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a = 0x%x\n", ++ //isCCKrate, pPhyInfo->RxPWDBAll, pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a); ++ ++ //For 92C/92D HW (Hybrid) Antenna Diversity ++#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++ //For 88E HW Antenna Diversity ++ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->ant_sel; ++ pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->ant_sel_b; ++ pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antsel_rx_keep_2; ++#endif ++} ++#endif ++ ++#if ODM_IC_11AC_SERIES_SUPPORT ++ ++VOID ++odm_RxPhyBWJaguarSeries_Parsing( ++ OUT PODM_PHY_INFO_T pPhyInfo, ++ IN PODM_PACKET_INFO_T pPktinfo, ++ IN PPHY_STATUS_RPT_8812_T pPhyStaRpt ++) ++{ ++ ++ if(pPktinfo->DataRate <= ODM_RATE54M) { ++ switch (pPhyStaRpt->r_RFMOD) { ++ case 1: ++ if (pPhyStaRpt->sub_chnl == 0) ++ pPhyInfo->BandWidth = 1; ++ else ++ pPhyInfo->BandWidth = 0; ++ break; ++ ++ case 2: ++ if (pPhyStaRpt->sub_chnl == 0) ++ pPhyInfo->BandWidth = 2; ++ else if (pPhyStaRpt->sub_chnl == 9 || pPhyStaRpt->sub_chnl == 10) ++ pPhyInfo->BandWidth = 1; ++ else ++ pPhyInfo->BandWidth = 0; ++ break; ++ ++ default: ++ case 0: ++ pPhyInfo->BandWidth = 0; ++ break; ++ } ++ } ++ ++} ++ ++VOID ++odm_RxPhyStatusJaguarSeries_Parsing( ++ IN OUT PDM_ODM_T pDM_Odm, ++ OUT PODM_PHY_INFO_T pPhyInfo, ++ IN pu1Byte pPhyStatus, ++ IN PODM_PACKET_INFO_T pPktinfo ++) ++{ ++ u1Byte i, Max_spatial_stream; ++ s1Byte rx_pwr[4], rx_pwr_all = 0; ++ u1Byte EVM, EVMdbm, PWDB_ALL = 0, PWDB_ALL_BT; ++ u1Byte RSSI, avg_rssi = 0, best_rssi = 0, second_rssi = 0; ++ u1Byte isCCKrate = 0; ++ u1Byte rf_rx_num = 0; ++ u1Byte cck_highpwr = 0; ++ u1Byte LNA_idx, VGA_idx; ++ PPHY_STATUS_RPT_8812_T pPhyStaRpt = (PPHY_STATUS_RPT_8812_T)pPhyStatus; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ u1Byte num_ss; ++ ++ odm_RxPhyBWJaguarSeries_Parsing(pPhyInfo, pPktinfo, pPhyStaRpt); ++ ++ if (pPktinfo->DataRate <= ODM_RATE11M) ++ isCCKrate = TRUE; ++ else ++ isCCKrate = FALSE; ++ ++ if (pPktinfo->bToSelf) ++ pDM_Odm->curr_station_id = pPktinfo->StationID; ++ else ++ pDM_Odm->curr_station_id = 0xff; ++ ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = -1; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_C] = -1; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_D] = -1; ++ ++ if (isCCKrate) { ++ u1Byte cck_agc_rpt; ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; ++ ++ /*(1)Hardware does not provide RSSI for CCK*/ ++ /*(2)PWDB, Average PWDB calculated by hardware (for rate adaptive)*/ ++ ++ /*if(pHalData->eRFPowerState == eRfOn)*/ ++ cck_highpwr = pDM_Odm->bCckHighPower; ++ /*else*/ ++ /*cck_highpwr = FALSE;*/ ++ ++ cck_agc_rpt = pPhyStaRpt->cfosho[0] ; ++ LNA_idx = ((cck_agc_rpt & 0xE0) >> 5); ++ VGA_idx = (cck_agc_rpt & 0x1F); ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8812) { ++ switch (LNA_idx) { ++ case 7: ++ if (VGA_idx <= 27) ++ rx_pwr_all = -100 + 2 * (27 - VGA_idx); /*VGA_idx = 27~2*/ ++ else ++ rx_pwr_all = -100; ++ break; ++ case 6: ++ rx_pwr_all = -48 + 2 * (2 - VGA_idx); /*VGA_idx = 2~0*/ ++ break; ++ case 5: ++ rx_pwr_all = -42 + 2 * (7 - VGA_idx); /*VGA_idx = 7~5*/ ++ break; ++ case 4: ++ rx_pwr_all = -36 + 2 * (7 - VGA_idx); /*VGA_idx = 7~4*/ ++ break; ++ case 3: ++ /*rx_pwr_all = -28 + 2*(7-VGA_idx); VGA_idx = 7~0*/ ++ rx_pwr_all = -24 + 2 * (7 - VGA_idx); /*VGA_idx = 7~0*/ ++ break; ++ case 2: ++ if (cck_highpwr) ++ rx_pwr_all = -12 + 2 * (5 - VGA_idx); /*VGA_idx = 5~0*/ ++ else ++ rx_pwr_all = -6 + 2 * (5 - VGA_idx); ++ break; ++ case 1: ++ rx_pwr_all = 8 - 2 * VGA_idx; ++ break; ++ case 0: ++ rx_pwr_all = 14 - 2 * VGA_idx; ++ break; ++ default: ++ /*DbgPrint("CCK Exception default\n");*/ ++ break; ++ } ++ rx_pwr_all += 6; ++ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); ++ ++ if (cck_highpwr == FALSE) { ++ if (PWDB_ALL >= 80) ++ PWDB_ALL = ((PWDB_ALL - 80) << 1) + ((PWDB_ALL - 80) >> 1) + 80; ++ else if ((PWDB_ALL <= 78) && (PWDB_ALL >= 20)) ++ PWDB_ALL += 3; ++ if (PWDB_ALL > 100) ++ PWDB_ALL = 100; ++ } ++ } else if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8881A)) { ++ s1Byte Pout = -6; ++ ++ switch (LNA_idx) { ++ case 5: ++ rx_pwr_all = Pout - 32 - (2 * VGA_idx); ++ break; ++ case 4: ++ rx_pwr_all = Pout - 24 - (2 * VGA_idx); ++ break; ++ case 2: ++ rx_pwr_all = Pout - 11 - (2 * VGA_idx); ++ break; ++ case 1: ++ rx_pwr_all = Pout + 5 - (2 * VGA_idx); ++ break; ++ case 0: ++ rx_pwr_all = Pout + 21 - (2 * VGA_idx); ++ break; ++ } ++ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); ++ } else if (pDM_Odm->SupportICType == ODM_RTL8814A || pDM_Odm->SupportICType == ODM_RTL8822B) { ++ s1Byte Pout = -6; ++ ++ switch (LNA_idx) { ++ /*CCK only use LNA: 2, 3, 5, 7*/ ++ case 7: ++ rx_pwr_all = Pout - 32 - (2 * VGA_idx); ++ break; ++ case 5: ++ rx_pwr_all = Pout - 22 - (2 * VGA_idx); ++ break; ++ case 3: ++ rx_pwr_all = Pout - 2 - (2 * VGA_idx); ++ break; ++ case 2: ++ rx_pwr_all = Pout + 5 - (2 * VGA_idx); ++ break; ++ /*case 6:*/ ++ /*rx_pwr_all = Pout -26 - (2*VGA_idx);*/ ++ /*break;*/ ++ /*case 4:*/ ++ /*rx_pwr_all = Pout - 8 - (2*VGA_idx);*/ ++ /*break;*/ ++ /*case 1:*/ ++ /*rx_pwr_all = Pout + 21 - (2*VGA_idx);*/ ++ /*break;*/ ++ /*case 0:*/ ++ /*rx_pwr_all = Pout + 10 - (2*VGA_idx);*/ ++/* // break;*/ ++ default: ++/* //DbgPrint("CCK Exception default\n");*/ ++ break; ++ } ++ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); ++ } ++ ++ pDM_Odm->cck_lna_idx = LNA_idx; ++ pDM_Odm->cck_vga_idx = VGA_idx; ++ pPhyInfo->RxPWDBAll = PWDB_ALL; ++/* //if(pPktinfo->StationID == 0)*/ ++/* //{*/ ++/* // DbgPrint("CCK: LNA_idx = %d, VGA_idx = %d, pPhyInfo->RxPWDBAll = %d\n",*/ ++/* // LNA_idx, VGA_idx, pPhyInfo->RxPWDBAll);*/ ++/* //}*/ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL; ++ pPhyInfo->RecvSignalPower = rx_pwr_all; ++#endif ++ /*(3) Get Signal Quality (EVM)*/ ++ /*if (pPktinfo->bPacketMatchBSSID)*/ ++ { ++ u1Byte SQ, SQ_rpt; ++ ++ if ((pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->PatchID == RT_CID_819x_Lenovo)) { ++ SQ = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm, isCCKrate, PWDB_ALL, 0, 0); ++ } else if (pPhyInfo->RxPWDBAll > 40 && !pDM_Odm->bInHctTest) { ++ SQ = 100; ++ } else { ++ SQ_rpt = pPhyStaRpt->pwdb_all; ++ ++ if (SQ_rpt > 64) ++ SQ = 0; ++ else if (SQ_rpt < 20) ++ SQ = 100; ++ else ++ SQ = ((64 - SQ_rpt) * 100) / 44; ++ } ++ ++/* //DbgPrint("cck SQ = %d\n", SQ);*/ ++ pPhyInfo->SignalQuality = SQ; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = SQ; ++ } ++ ++ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { ++ if (i == 0) ++ pPhyInfo->RxMIMOSignalStrength[0] = PWDB_ALL; ++ else ++ pPhyInfo->RxMIMOSignalStrength[i] = 0; ++ } ++ } else { ++ /*is OFDM rate*/ ++ pDM_FatTable->hw_antsw_occur = pPhyStaRpt->hw_antsw_occur; ++ ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; ++ ++ /*(1)Get RSSI for OFDM rate*/ ++ ++ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { ++ /*2008/01/30 MH we will judge RF RX path now.*/ ++/* //DbgPrint("pDM_Odm->RFPathRxEnable = %x\n", pDM_Odm->RFPathRxEnable);*/ ++ if (pDM_Odm->RFPathRxEnable & BIT(i)) ++ rf_rx_num++; ++/* //else*/ ++/* //continue;*/ ++ /*2012.05.25 LukeLee: Testchip AGC report is wrong, it should be restored back to old formula in MP chip*/ ++/* //if((pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) && (!pDM_Odm->bIsMPChip))*/ ++ if (i < ODM_RF_PATH_C) ++ rx_pwr[i] = (pPhyStaRpt->gain_trsw[i] & 0x7F) - 110; ++ else ++ rx_pwr[i] = (pPhyStaRpt->gain_trsw_cd[i - 2] & 0x7F) - 110; ++/* //else*/ ++ /*rx_pwr[i] = ((pPhyStaRpt->gain_trsw[i]& 0x3F)*2) - 110; OLD FORMULA*/ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ pPhyInfo->RxPwr[i] = rx_pwr[i]; ++#endif ++ ++ /* Translate DBM to percentage. */ ++ RSSI = odm_QueryRxPwrPercentage(rx_pwr[i]); ++ ++ /*total_rssi += RSSI;*/ ++ /*Get the best two RSSI*/ ++ if (RSSI > best_rssi && RSSI > second_rssi) { ++ second_rssi = best_rssi; ++ best_rssi = RSSI; ++ } else if (RSSI > second_rssi && RSSI <= best_rssi) ++ second_rssi = RSSI; ++ ++ /*RT_DISP(FRX, RX_PHY_SS, ("RF-%d RXPWR=%x RSSI=%d\n", i, rx_pwr[i], RSSI));*/ ++ ++ pPhyInfo->RxMIMOSignalStrength[i] = (u1Byte) RSSI; ++ ++ ++ /*Get Rx snr value in DB*/ ++ if (i < ODM_RF_PATH_C) ++ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = pPhyStaRpt->rxsnr[i] / 2; ++ else if (pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B)) ++ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = pPhyStaRpt->csi_current[i - 2] / 2; ++ ++#if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++ /*(2) CFO_short & CFO_tail*/ ++ if (i < ODM_RF_PATH_C) { ++ pPhyInfo->Cfo_short[i] = odm_Cfo((pPhyStaRpt->cfosho[i])); ++ pPhyInfo->Cfo_tail[i] = odm_Cfo((pPhyStaRpt->cfotail[i])); ++ } ++#endif ++ /* Record Signal Strength for next packet */ ++ if (pPktinfo->bPacketMatchBSSID) { ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if ((pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->PatchID == RT_CID_819x_Lenovo)) { ++ if (i == ODM_RF_PATH_A) ++ pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm, isCCKrate, PWDB_ALL, i, RSSI); ++ ++ } ++#endif ++ } ++ } ++ ++ /*(3)PWDB, Average PWDB calculated by hardware (for rate adaptive)*/ ++ ++ /*2012.05.25 LukeLee: Testchip AGC report is wrong, it should be restored back to old formula in MP chip*/ ++ if ((pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) && (!pDM_Odm->bIsMPChip)) ++ rx_pwr_all = (pPhyStaRpt->pwdb_all & 0x7f) - 110; ++ else ++ rx_pwr_all = (((pPhyStaRpt->pwdb_all) >> 1) & 0x7f) - 110; /*OLD FORMULA*/ ++ ++ PWDB_ALL_BT = PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); ++ ++ pPhyInfo->RxPWDBAll = PWDB_ALL; ++ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("ODM OFDM RSSI=%d\n",pPhyInfo->RxPWDBAll));*/ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL_BT; ++ pPhyInfo->RxPower = rx_pwr_all; ++ pPhyInfo->RecvSignalPower = rx_pwr_all; ++#endif ++ ++ if ((pDM_Odm->SupportPlatform == ODM_WIN) && (pDM_Odm->PatchID == 19)) { ++ /*do nothing*/ ++ } else { ++ /*pMgntInfo->CustomerID != RT_CID_819x_Lenovo*/ ++ ++ /*(4)EVM of OFDM rate*/ ++ ++ if ((pPktinfo->DataRate >= ODM_RATEMCS8) && ++ (pPktinfo->DataRate <= ODM_RATEMCS15)) ++ Max_spatial_stream = 2; ++ else if ((pPktinfo->DataRate >= ODM_RATEVHTSS2MCS0) && ++ (pPktinfo->DataRate <= ODM_RATEVHTSS2MCS9)) ++ Max_spatial_stream = 2; ++ else if ((pPktinfo->DataRate >= ODM_RATEMCS16) && ++ (pPktinfo->DataRate <= ODM_RATEMCS23)) ++ Max_spatial_stream = 3; ++ else if ((pPktinfo->DataRate >= ODM_RATEVHTSS3MCS0) && ++ (pPktinfo->DataRate <= ODM_RATEVHTSS3MCS9)) ++ Max_spatial_stream = 3; ++ else ++ Max_spatial_stream = 1; ++ ++ /*if (pPktinfo->bPacketMatchBSSID) */ ++ { ++ /*DbgPrint("pPktinfo->DataRate = %d\n", pPktinfo->DataRate);*/ ++ ++ for (i = 0; i < Max_spatial_stream; i++) { ++ /*Do not use shift operation like "rx_evmX >>= 1" because the compilor of free build environment*/ ++ /*fill most significant bit to "zero" when doing shifting operation which may change a negative*/ ++ /*value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore.*/ ++ ++ if (pPktinfo->DataRate >= ODM_RATE6M && pPktinfo->DataRate <= ODM_RATE54M) { ++ if (i == ODM_RF_PATH_A) { ++ EVM = odm_EVMdbToPercentage((pPhyStaRpt->sigevm)); /*dbm*/ ++ EVM += 20; ++ if (EVM > 100) ++ EVM = 100; ++ } ++ } else { ++ if (i < ODM_RF_PATH_C) { ++ if (pPhyStaRpt->rxevm[i] == -128) ++ pPhyStaRpt->rxevm[i] = -25; ++ EVM = odm_EVMdbToPercentage((pPhyStaRpt->rxevm[i])); /*dbm*/ ++ } else { ++ if (pPhyStaRpt->rxevm_cd[i - 2] == -128){ ++ pPhyStaRpt->rxevm_cd[i - 2] = -25; ++ } ++ EVM = odm_EVMdbToPercentage((pPhyStaRpt->rxevm_cd[i - 2])); /*dbm*/ ++ } ++ } ++ ++ if (i < ODM_RF_PATH_C) ++ EVMdbm = odm_EVMdbm_JaguarSeries(pPhyStaRpt->rxevm[i]); ++ else ++ EVMdbm = odm_EVMdbm_JaguarSeries(pPhyStaRpt->rxevm_cd[i - 2]); ++ /*RT_DISP(FRX, RX_PHY_SQ, ("RXRATE=%x RXEVM=%x EVM=%s%d\n",*/ ++ /*pPktinfo->DataRate, pPhyStaRpt->rxevm[i], "%", EVM));*/ ++ ++ { ++ if (i == ODM_RF_PATH_A) { ++ /*Fill value in RFD, Get the first spatial stream only*/ ++ pPhyInfo->SignalQuality = EVM; ++ } ++ pPhyInfo->RxMIMOSignalQuality[i] = EVM; ++#if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++ pPhyInfo->RxMIMOEVMdbm[i] = EVMdbm; ++#endif ++ } ++ } ++ } ++ } ++ ++ num_ss =phydm_rate_to_num_ss(pDM_Odm, pPktinfo->DataRate ); ++ ODM_ParsingCFO(pDM_Odm, pPktinfo, pPhyStaRpt->cfotail, num_ss); ++ ++ } ++/* //DbgPrint("isCCKrate= %d, pPhyInfo->SignalStrength=%d % PWDB_AL=%d rf_rx_num=%d\n", isCCKrate, pPhyInfo->SignalStrength, PWDB_ALL, rf_rx_num);*/ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ /*UI BSS List signal strength(in percentage), make it good looking, from 0~100.*/ ++ /*It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp().*/ ++ if (isCCKrate) { ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ /*2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/*/ ++ pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, PWDB_ALL, FALSE, TRUE); ++#else ++ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, PWDB_ALL));/*PWDB_ALL;*/ ++#endif ++ } else { ++ if (rf_rx_num != 0) { ++ /* 2015/01 Sean, use the best two RSSI only, suggested by Ynlin and ChenYu.*/ ++ if (rf_rx_num == 1) ++ avg_rssi = best_rssi; ++ else ++ avg_rssi = (best_rssi + second_rssi)/2; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ /* 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/*/ ++ pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, avg_rssi, FALSE, FALSE); ++#else ++ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, avg_rssi)); ++#endif ++ } ++ } ++#endif ++ pDM_Odm->RxPWDBAve = pDM_Odm->RxPWDBAve + pPhyInfo->RxPWDBAll; ++ ++ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->antidx_anta; ++ pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->antidx_antb; ++ pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antidx_antc; ++ pDM_Odm->DM_FatTable.antsel_rx_keep_3 = pPhyStaRpt->antidx_antd; ++ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("StaID[%d]: antidx_anta = ((%d)), MatchBSSID = ((%d))\n", pPktinfo->StationID, pPhyStaRpt->antidx_anta, pPktinfo->bPacketMatchBSSID));*/ ++ ++ ++/* DbgPrint("pPhyStaRpt->antidx_anta = %d, pPhyStaRpt->antidx_antb = %d\n",*/ ++/* pPhyStaRpt->antidx_anta, pPhyStaRpt->antidx_antb);*/ ++/* DbgPrint("----------------------------\n");*/ ++/* DbgPrint("pPktinfo->StationID=%d, pPktinfo->DataRate=0x%x\n",pPktinfo->StationID, pPktinfo->DataRate);*/ ++/* DbgPrint("pPhyStaRpt->r_RFMOD = %d\n", pPhyStaRpt->r_RFMOD);*/ ++/* DbgPrint("pPhyStaRpt->gain_trsw[0]=0x%x, pPhyStaRpt->gain_trsw[1]=0x%x\n",*/ ++/* pPhyStaRpt->gain_trsw[0],pPhyStaRpt->gain_trsw[1]);*/ ++/* DbgPrint("pPhyStaRpt->gain_trsw[2]=0x%x, pPhyStaRpt->gain_trsw[3]=0x%x\n",*/ ++/* pPhyStaRpt->gain_trsw_cd[0],pPhyStaRpt->gain_trsw_cd[1]);*/ ++/* DbgPrint("pPhyStaRpt->pwdb_all = 0x%x, pPhyInfo->RxPWDBAll = %d\n", pPhyStaRpt->pwdb_all, pPhyInfo->RxPWDBAll);*/ ++/* DbgPrint("pPhyStaRpt->cfotail[i] = 0x%x, pPhyStaRpt->CFO_tail[i] = 0x%x\n", pPhyStaRpt->cfotail[0], pPhyStaRpt->cfotail[1]);*/ ++/* DbgPrint("pPhyStaRpt->rxevm[0] = %d, pPhyStaRpt->rxevm[1] = %d\n", pPhyStaRpt->rxevm[0], pPhyStaRpt->rxevm[1]);*/ ++/* DbgPrint("pPhyStaRpt->rxevm[2] = %d, pPhyStaRpt->rxevm[3] = %d\n", pPhyStaRpt->rxevm_cd[0], pPhyStaRpt->rxevm_cd[1]);*/ ++/* DbgPrint("pPhyInfo->RxMIMOSignalStrength[0]=%d, pPhyInfo->RxMIMOSignalStrength[1]=%d, RxPWDBAll=%d\n",*/ ++/* pPhyInfo->RxMIMOSignalStrength[0], pPhyInfo->RxMIMOSignalStrength[1], pPhyInfo->RxPWDBAll);*/ ++/* DbgPrint("pPhyInfo->RxMIMOSignalStrength[2]=%d, pPhyInfo->RxMIMOSignalStrength[3]=%d\n",*/ ++/* pPhyInfo->RxMIMOSignalStrength[2], pPhyInfo->RxMIMOSignalStrength[3]);*/ ++/* DbgPrint("ppPhyInfo->RxMIMOSignalQuality[0]=%d, pPhyInfo->RxMIMOSignalQuality[1]=%d\n",*/ ++/* pPhyInfo->RxMIMOSignalQuality[0], pPhyInfo->RxMIMOSignalQuality[1]);*/ ++/* DbgPrint("ppPhyInfo->RxMIMOSignalQuality[2]=%d, pPhyInfo->RxMIMOSignalQuality[3]=%d\n",*/ ++/* pPhyInfo->RxMIMOSignalQuality[2], pPhyInfo->RxMIMOSignalQuality[3]);*/ ++ ++} ++ ++#endif ++ ++VOID ++phydm_reset_rssi_for_dm( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN u1Byte station_id ++ ) ++{ ++ PSTA_INFO_T pEntry; ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ #endif ++ ++ pEntry = pDM_Odm->pODM_StaInfo[station_id]; ++ ++ if (!IS_STA_VALID(pEntry)) { ++ /**/ ++ return; ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("Reset RSSI for macid = (( %d ))\n", station_id)); ++ ++ ++ pEntry->rssi_stat.UndecoratedSmoothedCCK = -1; ++ pEntry->rssi_stat.UndecoratedSmoothedOFDM = -1; ++ pEntry->rssi_stat.UndecoratedSmoothedPWDB = -1; ++ pEntry->rssi_stat.OFDM_pkt = 0; ++ pEntry->rssi_stat.CCK_pkt = 0; ++ pEntry->rssi_stat.CCK_sum_power = 0; ++ pEntry->rssi_stat.bsend_rssi = RA_RSSI_STATE_INIT; ++ pEntry->rssi_stat.PacketMap = 0; ++ pEntry->rssi_stat.ValidBit = 0; ++ ++ /*in WIN Driver: sta_ID==0 -> pEntry==NULL -> default port HAL_Data*/ ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ pEntry->bUsed = 0; ++ if (station_id == 0) { ++ ++ pHalData->UndecoratedSmoothedPWDB = -1; ++ /**/ ++ } ++ #endif ++ ++} ++ ++VOID ++odm_Init_RSSIForDM( ++ IN OUT PDM_ODM_T pDM_Odm ++ ) ++{ ++ ++} ++ ++VOID ++odm_Process_RSSIForDM( ++ IN OUT PDM_ODM_T pDM_Odm, ++ OUT PODM_PHY_INFO_T pPhyInfo, ++ IN PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++ ++ s4Byte UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK, UndecoratedSmoothedOFDM, RSSI_Ave, CCK_pkt; ++ u1Byte i, isCCKrate=0; ++ u1Byte RSSI_max, RSSI_min; ++ u4Byte Weighting=0; ++ u1Byte send_rssi_2_fw = 0; ++ PSTA_INFO_T pEntry; ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ #endif ++ ++ if (pPktinfo->StationID >= ODM_ASSOCIATE_ENTRY_NUM) ++ return; ++ ++ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY ++ odm_S0S1_SwAntDivByCtrlFrame_ProcessRSSI(pDM_Odm, pPhyInfo, pPktinfo); ++ #endif ++ ++ // ++ // 2012/05/30 MH/Luke.Lee Add some description ++ // In windows driver: AP/IBSS mode STA ++ // ++ //if (pDM_Odm->SupportPlatform == ODM_WIN) ++ //{ ++ // pEntry = pDM_Odm->pODM_StaInfo[pDM_Odm->pAidMap[pPktinfo->StationID-1]]; ++ //} ++ //else ++ pEntry = pDM_Odm->pODM_StaInfo[pPktinfo->StationID]; ++ ++ if (!IS_STA_VALID(pEntry)) { ++ return; ++ /**/ ++ } ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ if ((pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) && ++ (pDM_FatTable->enable_ctrl_frame_antdiv) ++ ) ++ { ++ if (pPktinfo->bPacketMatchBSSID) ++ pDM_Odm->data_frame_num++; ++ ++ if ((pDM_FatTable->use_ctrl_frame_antdiv)) { ++ if (!pPktinfo->bToSelf)/*data frame + CTRL frame*/ ++ return; ++ } else { ++ if ((!pPktinfo->bPacketMatchBSSID))/*data frame only*/ ++ return; ++ } ++ } else ++#endif ++ { ++ if ((!pPktinfo->bPacketMatchBSSID))/*data frame only*/ ++ return; ++ } ++ ++ if(pPktinfo->bPacketBeacon) ++ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt++; ++ ++ isCCKrate = (pPktinfo->DataRate <= ODM_RATE11M )?TRUE :FALSE; ++ pDM_Odm->RxRate = pPktinfo->DataRate; ++ ++ //--------------Statistic for antenna/path diversity------------------ ++ if(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) ++ { ++ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++ ODM_Process_RSSIForAntDiv(pDM_Odm,pPhyInfo,pPktinfo); ++ #endif ++ } ++ #if(defined(CONFIG_PATH_DIVERSITY)) ++ else if(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV) ++ { ++ phydm_process_rssi_for_path_div(pDM_Odm,pPhyInfo,pPktinfo); ++ } ++ #endif ++ //-----------------Smart Antenna Debug Message------------------// ++ ++ UndecoratedSmoothedCCK = pEntry->rssi_stat.UndecoratedSmoothedCCK; ++ UndecoratedSmoothedOFDM = pEntry->rssi_stat.UndecoratedSmoothedOFDM; ++ UndecoratedSmoothedPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; ++ ++ if(pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon) ++ { ++ ++ if(!isCCKrate)//ofdm rate ++ { ++#if (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B)) { ++ u1Byte RX_count = 0; ++ u4Byte RSSI_linear = 0; ++ ++ if (pDM_Odm->RXAntStatus & ODM_RF_A) { ++ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; ++ RX_count++; ++ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]); ++ } else ++ pDM_Odm->RSSI_A = 0; ++ ++ if (pDM_Odm->RXAntStatus & ODM_RF_B) { ++ pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; ++ RX_count++; ++ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]); ++ } else ++ pDM_Odm->RSSI_B = 0; ++ ++ if (pDM_Odm->RXAntStatus & ODM_RF_C) { ++ pDM_Odm->RSSI_C = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_C]; ++ RX_count++; ++ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_C]); ++ } else ++ pDM_Odm->RSSI_C = 0; ++ ++ if (pDM_Odm->RXAntStatus & ODM_RF_D) { ++ pDM_Odm->RSSI_D = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_D]; ++ RX_count++; ++ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_D]); ++ } else ++ pDM_Odm->RSSI_D = 0; ++ ++ /* Calculate average RSSI */ ++ switch (RX_count) { ++ case 2: ++ RSSI_linear = (RSSI_linear >> 1); ++ break; ++ case 3: ++ RSSI_linear = ((RSSI_linear) + (RSSI_linear << 1) + (RSSI_linear << 3)) >> 5; /* RSSI_linear/3 ~ RSSI_linear*11/32 */ ++ break; ++ case 4: ++ RSSI_linear = (RSSI_linear >> 2); ++ break; ++ } ++ RSSI_Ave = odm_ConvertTo_dB(RSSI_linear); ++ } else ++#endif ++ { ++ if (pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B] == 0) { ++ RSSI_Ave = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; ++ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; ++ pDM_Odm->RSSI_B = 0; ++ } else { ++ /*DbgPrint("pRfd->Status.RxMIMOSignalStrength[0] = %d, pRfd->Status.RxMIMOSignalStrength[1] = %d\n",*/ ++ /*pRfd->Status.RxMIMOSignalStrength[0], pRfd->Status.RxMIMOSignalStrength[1]);*/ ++ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; ++ pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; ++ ++ if (pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A] > pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]) { ++ RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; ++ RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; ++ } else { ++ RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; ++ RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; ++ } ++ if ((RSSI_max - RSSI_min) < 3) ++ RSSI_Ave = RSSI_max; ++ else if ((RSSI_max - RSSI_min) < 6) ++ RSSI_Ave = RSSI_max - 1; ++ else if ((RSSI_max - RSSI_min) < 10) ++ RSSI_Ave = RSSI_max - 2; ++ else ++ RSSI_Ave = RSSI_max - 3; ++ } ++ } ++ ++ //1 Process OFDM RSSI ++ if(UndecoratedSmoothedOFDM <= 0) // initialize ++ { ++ UndecoratedSmoothedOFDM = pPhyInfo->RxPWDBAll; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("OFDM_INIT: (( %d ))\n", UndecoratedSmoothedOFDM)); ++ } ++ else ++ { ++ if(pPhyInfo->RxPWDBAll > (u4Byte)UndecoratedSmoothedOFDM) ++ { ++ UndecoratedSmoothedOFDM = ++ ( ((UndecoratedSmoothedOFDM)*(Rx_Smooth_Factor-1)) + ++ (RSSI_Ave)) /(Rx_Smooth_Factor); ++ UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM + 1; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("OFDM_1: (( %d ))\n", UndecoratedSmoothedOFDM)); ++ } ++ else ++ { ++ UndecoratedSmoothedOFDM = ++ ( ((UndecoratedSmoothedOFDM)*(Rx_Smooth_Factor-1)) + ++ (RSSI_Ave)) /(Rx_Smooth_Factor); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("OFDM_2: (( %d ))\n", UndecoratedSmoothedOFDM)); ++ } ++ } ++ if (pEntry->rssi_stat.OFDM_pkt != 64) { ++ i = 63; ++ pEntry->rssi_stat.OFDM_pkt -= (u1Byte)(((pEntry->rssi_stat.PacketMap>>i)&BIT0)-1); ++ } ++ pEntry->rssi_stat.PacketMap = (pEntry->rssi_stat.PacketMap<<1) | BIT0; ++ ++ } ++ else ++ { ++ RSSI_Ave = pPhyInfo->RxPWDBAll; ++ pDM_Odm->RSSI_A = (u1Byte) pPhyInfo->RxPWDBAll; ++ pDM_Odm->RSSI_B = 0xFF; ++ pDM_Odm->RSSI_C = 0xFF; ++ pDM_Odm->RSSI_D = 0xFF; ++ ++ if (pEntry->rssi_stat.CCK_pkt <= 63) ++ pEntry->rssi_stat.CCK_pkt++; ++ ++ //1 Process CCK RSSI ++ if(UndecoratedSmoothedCCK <= 0) // initialize ++ { ++ UndecoratedSmoothedCCK = pPhyInfo->RxPWDBAll; ++ pEntry->rssi_stat.CCK_sum_power = (u2Byte)pPhyInfo->RxPWDBAll ; /*reset*/ ++ pEntry->rssi_stat.CCK_pkt = 1; /*reset*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_INIT: (( %d ))\n", UndecoratedSmoothedCCK)); ++ } else if (pEntry->rssi_stat.CCK_pkt <= CCK_RSSI_INIT_COUNT) { ++ ++ pEntry->rssi_stat.CCK_sum_power = pEntry->rssi_stat.CCK_sum_power + (u2Byte)pPhyInfo->RxPWDBAll; ++ UndecoratedSmoothedCCK = pEntry->rssi_stat.CCK_sum_power/pEntry->rssi_stat.CCK_pkt; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_0: (( %d )), SumPow = (( %d )), CCK_pkt = (( %d ))\n", ++ UndecoratedSmoothedCCK, pEntry->rssi_stat.CCK_sum_power, pEntry->rssi_stat.CCK_pkt)); ++ } ++ else ++ { ++ if(pPhyInfo->RxPWDBAll > (u4Byte)UndecoratedSmoothedCCK) ++ { ++ UndecoratedSmoothedCCK = ++ ( ((UndecoratedSmoothedCCK)*(Rx_Smooth_Factor-1)) + ++ (pPhyInfo->RxPWDBAll)) /(Rx_Smooth_Factor); ++ UndecoratedSmoothedCCK = UndecoratedSmoothedCCK + 1; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_1: (( %d ))\n", UndecoratedSmoothedCCK)); ++ } ++ else ++ { ++ UndecoratedSmoothedCCK = ++ ( ((UndecoratedSmoothedCCK)*(Rx_Smooth_Factor-1)) + ++ (pPhyInfo->RxPWDBAll)) /(Rx_Smooth_Factor); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_2: (( %d ))\n", UndecoratedSmoothedCCK)); ++ } ++ } ++ i = 63; ++ pEntry->rssi_stat.OFDM_pkt -= (u1Byte)((pEntry->rssi_stat.PacketMap>>i)&BIT0); ++ pEntry->rssi_stat.PacketMap = pEntry->rssi_stat.PacketMap<<1; ++ } ++ ++ //if(pEntry) ++ { ++ //2011.07.28 LukeLee: modified to prevent unstable CCK RSSI ++ if (pEntry->rssi_stat.OFDM_pkt == 64) { /* speed up when all packets are OFDM*/ ++ UndecoratedSmoothedPWDB = UndecoratedSmoothedOFDM; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("PWDB_0[%d] = (( %d ))\n", pPktinfo->StationID, UndecoratedSmoothedCCK)); ++ } else { ++ if (pEntry->rssi_stat.ValidBit < 64) ++ pEntry->rssi_stat.ValidBit++; ++ ++ if (pEntry->rssi_stat.ValidBit == 64) { ++ Weighting = ((pEntry->rssi_stat.OFDM_pkt) > 4) ? 64 : (pEntry->rssi_stat.OFDM_pkt<<4); ++ UndecoratedSmoothedPWDB = (Weighting*UndecoratedSmoothedOFDM+(64-Weighting)*UndecoratedSmoothedCCK)>>6; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("PWDB_1[%d] = (( %d )), W = (( %d ))\n", pPktinfo->StationID, UndecoratedSmoothedCCK, Weighting)); ++ } else { ++ if (pEntry->rssi_stat.ValidBit != 0) ++ UndecoratedSmoothedPWDB = (pEntry->rssi_stat.OFDM_pkt*UndecoratedSmoothedOFDM+(pEntry->rssi_stat.ValidBit-pEntry->rssi_stat.OFDM_pkt)*UndecoratedSmoothedCCK)/pEntry->rssi_stat.ValidBit; ++ else ++ UndecoratedSmoothedPWDB = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("PWDB_2[%d] = (( %d )), OFDM_pkt = (( %d )), Valid_Bit = (( %d ))\n", pPktinfo->StationID, UndecoratedSmoothedCCK, pEntry->rssi_stat.OFDM_pkt, pEntry->rssi_stat.ValidBit)); ++ } ++ } ++ ++ ++ if ((pEntry->rssi_stat.OFDM_pkt >= 1 || pEntry->rssi_stat.CCK_pkt >= 5) && (pEntry->rssi_stat.bsend_rssi == RA_RSSI_STATE_INIT)) { ++ ++ send_rssi_2_fw = 1; ++ pEntry->rssi_stat.bsend_rssi = RA_RSSI_STATE_SEND; ++ } ++ ++ pEntry->rssi_stat.UndecoratedSmoothedCCK = UndecoratedSmoothedCCK; ++ pEntry->rssi_stat.UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM; ++ pEntry->rssi_stat.UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; ++ ++ ++ ++ if (send_rssi_2_fw) /* Trigger init rate by RSSI */ { ++ ++ if (pEntry->rssi_stat.OFDM_pkt != 0) ++ pEntry->rssi_stat.UndecoratedSmoothedPWDB = UndecoratedSmoothedOFDM; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("[Send to FW] PWDB = (( %d )), OFDM_pkt = (( %d )), CCK_pkt = (( %d ))\n", ++ UndecoratedSmoothedPWDB, pEntry->rssi_stat.OFDM_pkt, pEntry->rssi_stat.CCK_pkt)); ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ phydm_ra_rssi_rpt_wk(pDM_Odm); ++ #endif ++ } ++ ++ ++ /*in WIN Driver: sta_ID==0 -> pEntry==NULL -> default port HAL_Data*/ ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ ++ if (pPktinfo->StationID == 0) { ++ /**/ ++ pHalData->UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; ++ } ++ #endif ++ ++ //DbgPrint("OFDM_pkt=%d, Weighting=%d\n", OFDM_pkt, Weighting); ++ //DbgPrint("UndecoratedSmoothedOFDM=%d, UndecoratedSmoothedPWDB=%d, UndecoratedSmoothedCCK=%d\n", ++ // UndecoratedSmoothedOFDM, UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK); ++ ++ } ++ ++ } ++} ++ ++ ++#if(ODM_IC_11N_SERIES_SUPPORT ==1) ++// ++// Endianness before calling this API ++// ++VOID ++ODM_PhyStatusQuery_92CSeries( ++ IN OUT PDM_ODM_T pDM_Odm, ++ OUT PODM_PHY_INFO_T pPhyInfo, ++ IN pu1Byte pPhyStatus, ++ IN PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++ odm_RxPhyStatus92CSeries_Parsing(pDM_Odm, pPhyInfo, pPhyStatus, pPktinfo); ++ odm_Process_RSSIForDM(pDM_Odm, pPhyInfo, pPktinfo); ++} ++#endif ++ ++ ++// ++// Endianness before calling this API ++// ++#if ODM_IC_11AC_SERIES_SUPPORT ++ ++VOID ++ODM_PhyStatusQuery_JaguarSeries( ++ IN OUT PDM_ODM_T pDM_Odm, ++ OUT PODM_PHY_INFO_T pPhyInfo, ++ IN pu1Byte pPhyStatus, ++ IN PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++ odm_RxPhyStatusJaguarSeries_Parsing(pDM_Odm, pPhyInfo, pPhyStatus, pPktinfo); ++ odm_Process_RSSIForDM(pDM_Odm, pPhyInfo, pPktinfo); ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ /*phydm_sbd_check(pDM_Odm);*/ ++ #endif ++} ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++phydm_normal_driver_rx_sniffer( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN pu1Byte pDesc, ++ IN PRT_RFD_STATUS pRtRfdStatus, ++ IN pu1Byte pDrvInfo, ++ IN u1Byte PHYStatus ++ ) ++{ ++ #if (defined(CONFIG_PHYDM_RX_SNIFFER_PARSING)) ++ u4Byte *pMsg; ++ u2Byte seq_num; ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ ++ if (pRtRfdStatus->PacketReportType != NORMAL_RX) ++ return; ++ ++ if (!pDM_Odm->bLinked) { ++ if (pRtRfdStatus->bHwError) ++ return; ++ } ++ ++ if (!(pDM_FatTable->FAT_State == FAT_TRAINING_STATE)) ++ return; ++ ++ if (PHYStatus == TRUE) { ++ ++ if ((pDM_Odm->rx_pkt_type == Type_BlockAck) || (pDM_Odm->rx_pkt_type == Type_RTS) || (pDM_Odm->rx_pkt_type == Type_CTS)) ++ seq_num = 0; ++ else ++ seq_num = pRtRfdStatus->Seq_Num; ++ ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, ("%04d , %01s , Rate=0x%02x , L=%04d , %s , %s", ++ seq_num, ++ /*pRtRfdStatus->MacID,*/ ++ ((pRtRfdStatus->bCRC) ? "C" : (pRtRfdStatus->bIsAMPDU) ? "A" : "_"), ++ pRtRfdStatus->DataRate, ++ pRtRfdStatus->Length, ++ ((pRtRfdStatus->BandWidth == 0) ? "20M":((pRtRfdStatus->BandWidth == 1) ? "40M" : "80M")), ++ ((pRtRfdStatus->bLDPC) ? "LDP" : "BCC") ++ )); ++ ++ if (pDM_Odm->rx_pkt_type == Type_Asoc_Req) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "AS_REQ")); ++ /**/ ++ } else if (pDM_Odm->rx_pkt_type == Type_Asoc_Rsp) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "AS_RSP")); ++ /**/ ++ } else if (pDM_Odm->rx_pkt_type == Type_Probe_Req) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "PR_REQ")); ++ /**/ ++ } else if (pDM_Odm->rx_pkt_type == Type_Probe_Rsp) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "PR_RSP")); ++ /**/ ++ } else if (pDM_Odm->rx_pkt_type == Type_Deauth) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "DEAUTH")); ++ /**/ ++ } else if (pDM_Odm->rx_pkt_type == Type_Beacon) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "BEACON")); ++ /**/ ++ } else if (pDM_Odm->rx_pkt_type == Type_BlockAckReq) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "BA_REQ")); ++ /**/ ++ } else if (pDM_Odm->rx_pkt_type == Type_RTS) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__RTS_")); ++ /**/ ++ } else if (pDM_Odm->rx_pkt_type == Type_CTS) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__CTS_")); ++ /**/ ++ } else if (pDM_Odm->rx_pkt_type == Type_Ack) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__ACK_")); ++ /**/ ++ } else if (pDM_Odm->rx_pkt_type == Type_BlockAck) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__BA__")); ++ /**/ ++ } else if (pDM_Odm->rx_pkt_type == Type_Data) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "_DATA_")); ++ /**/ ++ } else if (pDM_Odm->rx_pkt_type == Type_Data_Ack) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "Data_Ack")); ++ /**/ ++ } else if (pDM_Odm->rx_pkt_type == Type_QosData) { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "QoS_Data")); ++ /**/ ++ } else { ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [0x%x]", pDM_Odm->rx_pkt_type)); ++ /**/ ++ } ++ ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [RSSI=%d,%d,%d,%d ]", ++ pDM_Odm->RSSI_A, ++ pDM_Odm->RSSI_B, ++ pDM_Odm->RSSI_C, ++ pDM_Odm->RSSI_D ++ )); ++ ++ pMsg = (pu4Byte)pDrvInfo; ++ ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , P-STS[28:0]=%08x-%08x-%08x-%08x-%08x-%08x-%08x\n", ++ pMsg[6], pMsg[5], pMsg[4], pMsg[3], pMsg[2], pMsg[1], pMsg[1])); ++ } else { ++ ++ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, ("%04d , %01s , Rate=0x%02x , L=%04d , %s , %s\n", ++ pRtRfdStatus->Seq_Num, ++ /*pRtRfdStatus->MacID,*/ ++ ((pRtRfdStatus->bCRC) ? "C" : (pRtRfdStatus->bIsAMPDU) ? "A" : "_"), ++ pRtRfdStatus->DataRate, ++ pRtRfdStatus->Length, ++ ((pRtRfdStatus->BandWidth == 0) ? "20M" : ((pRtRfdStatus->BandWidth == 1) ? "40M" : "80M")), ++ ((pRtRfdStatus->bLDPC) ? "LDP" : "BCC") ++ )); ++ } ++ ++ ++ #endif ++} ++#endif ++ ++VOID ++ODM_PhyStatusQuery( ++ IN OUT PDM_ODM_T pDM_Odm, ++ OUT PODM_PHY_INFO_T pPhyInfo, ++ IN pu1Byte pPhyStatus, ++ IN PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_IC_PHY_STATUE_NEW_TYPE) { ++ phydm_RxPhyStatusNewType(pDM_Odm, pPhyStatus, pPktinfo, pPhyInfo); ++ return; ++ } ++#endif ++ ++#if ODM_IC_11AC_SERIES_SUPPORT ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ ODM_PhyStatusQuery_JaguarSeries(pDM_Odm, pPhyInfo, pPhyStatus, pPktinfo); ++#endif ++ ++#if ODM_IC_11N_SERIES_SUPPORT ++ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES ) ++ ODM_PhyStatusQuery_92CSeries(pDM_Odm,pPhyInfo,pPhyStatus,pPktinfo); ++#endif ++} ++ ++// For future use. ++VOID ++ODM_MacStatusQuery( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN pu1Byte pMacStatus, ++ IN u1Byte MacID, ++ IN BOOLEAN bPacketMatchBSSID, ++ IN BOOLEAN bPacketToSelf, ++ IN BOOLEAN bPacketBeacon ++ ) ++{ ++ // 2011/10/19 Driver team will handle in the future. ++ ++} ++ ++ ++// ++// If you want to add a new IC, Please follow below template and generate a new one. ++// ++// ++ ++HAL_STATUS ++ODM_ConfigRFWithHeaderFile( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_RF_Config_Type ConfigType, ++ IN ODM_RF_RADIO_PATH_E eRFPath ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("===>ODM_ConfigRFWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", ++ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); ++ ++//1 AP doesn't use PHYDM power tracking table in these ICs ++#if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++#if (RTL8812A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ { ++ if(ConfigType == CONFIG_RF_RADIO) { ++ if(eRFPath == ODM_RF_PATH_A){ ++ READ_AND_CONFIG_MP(8812A,_RadioA); ++ } ++ else if(eRFPath == ODM_RF_PATH_B){ ++ READ_AND_CONFIG_MP(8812A,_RadioB); ++ } ++ } ++ else if(ConfigType == CONFIG_RF_TXPWR_LMT) { ++ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) && (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ if ((pHalData->EEPROMSVID == 0x17AA && pHalData->EEPROMSMID == 0xA811) || ++ (pHalData->EEPROMSVID == 0x10EC && pHalData->EEPROMSMID == 0xA812) || ++ (pHalData->EEPROMSVID == 0x10EC && pHalData->EEPROMSMID == 0x8812)) ++ READ_AND_CONFIG_MP(8812A,_TXPWR_LMT_HM812A03); ++ else ++ #endif ++ READ_AND_CONFIG_MP(8812A,_TXPWR_LMT); ++ } ++ } ++#endif ++#if (RTL8821A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821) ++ { ++ if(ConfigType == CONFIG_RF_RADIO) { ++ if(eRFPath == ODM_RF_PATH_A){ ++ READ_AND_CONFIG_MP(8821A,_RadioA); ++ } ++ } ++ else if(ConfigType == CONFIG_RF_TXPWR_LMT) { ++ if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { ++ if (pDM_Odm->ExtPA5G || pDM_Odm->ExtLNA5G) ++ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8811AU_FEM); ++ else ++ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8811AU_IPA); ++ } ++ else { ++ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ if (pMgntInfo->CustomerID == RT_CID_8821AE_ASUS_MB) ++ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8821A_SAR_8mm); ++ else if (pMgntInfo->CustomerID == RT_CID_ASUS_NB) ++ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8821A_SAR_5mm); ++ else ++ #endif ++ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8821A); ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigRFWithHeaderFile\n")); ++ } ++#endif ++#if (RTL8192E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8192E) ++ { ++ if(ConfigType == CONFIG_RF_RADIO) { ++ if(eRFPath == ODM_RF_PATH_A) ++ READ_AND_CONFIG_MP(8192E,_RadioA); ++ else if(eRFPath == ODM_RF_PATH_B) ++ READ_AND_CONFIG_MP(8192E,_RadioB); ++ } else if (ConfigType == CONFIG_RF_TXPWR_LMT) { ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) && (DEV_BUS_TYPE == RT_PCI_INTERFACE) /*Refine by Vincent Lan for 5mm SAR pwr limit*/ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ if ((pHalData->EEPROMSVID == 0x11AD && pHalData->EEPROMSMID == 0x8192) || ++ (pHalData->EEPROMSVID == 0x11AD && pHalData->EEPROMSMID == 0x8193)) ++ READ_AND_CONFIG_MP(8192E, _TXPWR_LMT_8192E_SAR_5mm); ++ else ++#endif ++ READ_AND_CONFIG_MP(8192E, _TXPWR_LMT); ++ } ++ } ++#endif ++#if (RTL8723D_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8723D) { ++ if (ConfigType == CONFIG_RF_RADIO) { ++ if (eRFPath == ODM_RF_PATH_A) ++ READ_AND_CONFIG_MP(8723D, _RadioA); ++ } else if (ConfigType == CONFIG_RF_TXPWR_LMT) ++ READ_AND_CONFIG_MP(8723D, _TXPWR_LMT); ++ } ++#endif ++#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) ++ ++//1 All platforms support ++#if (RTL8188E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) ++ { ++ if(ConfigType == CONFIG_RF_RADIO) { ++ if(eRFPath == ODM_RF_PATH_A) ++ READ_AND_CONFIG_MP(8188E,_RadioA); ++ } ++ else if(ConfigType == CONFIG_RF_TXPWR_LMT) ++ READ_AND_CONFIG_MP(8188E,_TXPWR_LMT); ++ } ++#endif ++#if (RTL8723B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8723B) { ++ if (ConfigType == CONFIG_RF_RADIO) ++ READ_AND_CONFIG_MP(8723B, _RadioA); ++ else if (ConfigType == CONFIG_RF_TXPWR_LMT) ++ READ_AND_CONFIG_MP(8723B, _TXPWR_LMT); ++ } ++#endif ++#if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8814A) ++ { ++ if(ConfigType == CONFIG_RF_RADIO) { ++ if(eRFPath == ODM_RF_PATH_A) ++ READ_AND_CONFIG_MP(8814A,_RadioA); ++ else if(eRFPath == ODM_RF_PATH_B) ++ READ_AND_CONFIG_MP(8814A,_RadioB); ++ else if(eRFPath == ODM_RF_PATH_C) ++ READ_AND_CONFIG_MP(8814A,_RadioC); ++ else if(eRFPath == ODM_RF_PATH_D) ++ READ_AND_CONFIG_MP(8814A,_RadioD); ++ } ++ else if(ConfigType == CONFIG_RF_TXPWR_LMT) ++ READ_AND_CONFIG_MP(8814A,_TXPWR_LMT); ++ } ++#endif ++#if (RTL8703B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8703B) { ++ if (ConfigType == CONFIG_RF_RADIO) { ++ if (eRFPath == ODM_RF_PATH_A) ++ READ_AND_CONFIG_MP(8703B, _RadioA); ++ } ++ } ++#endif ++#if (RTL8188F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8188F) { ++ if (ConfigType == CONFIG_RF_RADIO) { ++ if (eRFPath == ODM_RF_PATH_A) ++ READ_AND_CONFIG_MP(8188F, _RadioA); ++ } else if (ConfigType == CONFIG_RF_TXPWR_LMT) ++ READ_AND_CONFIG_MP(8188F, _TXPWR_LMT); ++ } ++#endif ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) { ++ if (ConfigType == CONFIG_RF_RADIO) { ++ if (eRFPath == ODM_RF_PATH_A) ++ READ_AND_CONFIG_MP(8822B, _RadioA); ++ else if (eRFPath == ODM_RF_PATH_B) ++ READ_AND_CONFIG_MP(8822B, _RadioB); ++ } else if(ConfigType == CONFIG_RF_TXPWR_LMT) ++ if (pDM_Odm->RFEType == 5) ++ READ_AND_CONFIG_MP(8822B, _TXPWR_LMT_type5); ++ else ++ READ_AND_CONFIG_MP(8822B, _TXPWR_LMT); ++ } ++#endif ++ ++#if (RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8197F) { ++ if (ConfigType == CONFIG_RF_RADIO) { ++ if (eRFPath == ODM_RF_PATH_A) ++ READ_AND_CONFIG_MP(8197F, _RadioA); ++ else if (eRFPath == ODM_RF_PATH_B) ++ READ_AND_CONFIG_MP(8197F, _RadioB); ++ } ++ } ++#endif ++ ++#if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) { ++ if (ConfigType == CONFIG_RF_RADIO) { ++ if (eRFPath == ODM_RF_PATH_A) ++ READ_AND_CONFIG(8821C, _RadioA); ++ } else if (ConfigType == CONFIG_RF_TXPWR_LMT) ++ READ_AND_CONFIG(8821C, _TXPWR_LMT); ++ } ++#endif ++ ++ return HAL_STATUS_SUCCESS; ++} ++ ++HAL_STATUS ++ODM_ConfigRFWithTxPwrTrackHeaderFile( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("===>ODM_ConfigRFWithTxPwrTrackHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", ++ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); ++ ++ ++//1 AP doesn't use PHYDM power tracking table in these ICs ++#if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++#if RTL8821A_SUPPORT ++ if(pDM_Odm->SupportICType == ODM_RTL8821) ++ { ++ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) ++ READ_AND_CONFIG_MP(8821A,_TxPowerTrack_PCIE); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) ++ READ_AND_CONFIG_MP(8821A,_TxPowerTrack_USB); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) ++ READ_AND_CONFIG_MP(8821A,_TxPowerTrack_SDIO); ++ } ++#endif ++#if RTL8812A_SUPPORT ++ if(pDM_Odm->SupportICType == ODM_RTL8812) ++ { ++ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) ++ READ_AND_CONFIG_MP(8812A,_TxPowerTrack_PCIE); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { ++ if (pDM_Odm->RFEType == 3 && pDM_Odm->bIsMPChip) ++ READ_AND_CONFIG_MP(8812A,_TxPowerTrack_RFE3); ++ else ++ READ_AND_CONFIG_MP(8812A,_TxPowerTrack_USB); ++ } ++ ++ } ++#endif ++#if RTL8192E_SUPPORT ++ if(pDM_Odm->SupportICType == ODM_RTL8192E) ++ { ++ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) ++ READ_AND_CONFIG_MP(8192E,_TxPowerTrack_PCIE); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) ++ READ_AND_CONFIG_MP(8192E,_TxPowerTrack_USB); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) ++ READ_AND_CONFIG_MP(8192E,_TxPowerTrack_SDIO); ++ } ++#endif ++#if RTL8723D_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8723D) { ++ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) ++ READ_AND_CONFIG_MP(8723D, _TxPowerTrack_PCIE); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) ++ READ_AND_CONFIG_MP(8723D, _TxPowerTrack_USB); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) ++ READ_AND_CONFIG_MP(8723D, _TxPowerTrack_SDIO); ++ ++ READ_AND_CONFIG_MP(8723D, _TxXtalTrack); ++ } ++#endif ++#if RTL8188E_SUPPORT ++ if(pDM_Odm->SupportICType == ODM_RTL8188E) ++ { ++ if (PHY_QueryMacReg(pDM_Odm->Adapter, 0xF0, 0xF000) >= 8) { /*if 0xF0[15:12] >= 8, SMIC*/ ++ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) ++ READ_AND_CONFIG_MP(8188E, _TxPowerTrack_PCIE_ICUT); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) ++ READ_AND_CONFIG_MP(8188E, _TxPowerTrack_USB_ICUT); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) ++ READ_AND_CONFIG_MP(8188E, _TxPowerTrack_SDIO_ICUT); ++ } else { /*else 0xF0[15:12] < 8, TSMC*/ ++ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) ++ READ_AND_CONFIG_MP(8188E, _TxPowerTrack_PCIE); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) ++ READ_AND_CONFIG_MP(8188E, _TxPowerTrack_USB); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) ++ READ_AND_CONFIG_MP(8188E, _TxPowerTrack_SDIO); ++ } ++ ++ } ++#endif ++#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) ++ ++//1 All platforms support ++#if RTL8723B_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8723B) { ++ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) ++ READ_AND_CONFIG_MP(8723B, _TxPowerTrack_PCIE); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) ++ READ_AND_CONFIG_MP(8723B, _TxPowerTrack_USB); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) ++ READ_AND_CONFIG_MP(8723B, _TxPowerTrack_SDIO); ++ } ++#endif ++#if RTL8814A_SUPPORT ++ if(pDM_Odm->SupportICType == ODM_RTL8814A) ++ { ++ if(pDM_Odm->RFEType == 0) ++ READ_AND_CONFIG_MP(8814A,_TxPowerTrack_Type0); ++ else if(pDM_Odm->RFEType == 2) ++ READ_AND_CONFIG_MP(8814A,_TxPowerTrack_Type2); ++ else if (pDM_Odm->RFEType == 5) ++ READ_AND_CONFIG_MP(8814A, _TxPowerTrack_Type5); ++ else ++ READ_AND_CONFIG_MP(8814A,_TxPowerTrack); ++ ++ READ_AND_CONFIG_MP(8814A, _TxPowerTSSI); ++ } ++#endif ++#if RTL8703B_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8703B) { ++ if (pDM_Odm->SupportInterface == ODM_ITRF_USB) ++ READ_AND_CONFIG_MP(8703B, _TxPowerTrack_USB); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) ++ READ_AND_CONFIG_MP(8703B, _TxPowerTrack_SDIO); ++ ++ READ_AND_CONFIG_MP(8703B, _TxXtalTrack); ++ } ++#endif ++ ++#if RTL8188F_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8188F) { ++ if (pDM_Odm->SupportInterface == ODM_ITRF_USB) ++ READ_AND_CONFIG_MP(8188F, _TxPowerTrack_USB); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) ++ READ_AND_CONFIG_MP(8188F, _TxPowerTrack_SDIO); ++ } ++#endif ++ ++#if RTL8822B_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) { ++ if (pDM_Odm->RFEType == 0) ++ READ_AND_CONFIG_MP(8822B, _TxPowerTrack_type0); ++ else if (pDM_Odm->RFEType == 1) ++ READ_AND_CONFIG_MP(8822B, _TxPowerTrack_type1); ++ else if ((pDM_Odm->RFEType == 3) || (pDM_Odm->RFEType == 5)) ++ READ_AND_CONFIG_MP(8822B, _TxPowerTrack_Type3_Type5); ++ else if (pDM_Odm->RFEType == 6) ++ READ_AND_CONFIG_MP(8822B, _TxPowerTrack_type6); ++ else if (pDM_Odm->RFEType == 7) ++ READ_AND_CONFIG_MP(8822B, _TxPowerTrack_type7); ++ else ++ READ_AND_CONFIG_MP(8822B, _TxPowerTrack); ++ } ++#endif ++ ++#if RTL8197F_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8197F) { ++ if (pDM_Odm->RFEType == 0) ++ READ_AND_CONFIG_MP(8197F, _TxPowerTrack_Type0); ++ else if (pDM_Odm->RFEType == 1) ++ READ_AND_CONFIG_MP(8197F, _TxPowerTrack_Type1); ++ else ++ READ_AND_CONFIG_MP(8197F, _TxPowerTrack); ++ } ++#endif ++ ++#if RTL8821C_SUPPORT ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ READ_AND_CONFIG(8821C, _TxPowerTrack); ++#endif ++ ++ return HAL_STATUS_SUCCESS; ++} ++ ++HAL_STATUS ++ODM_ConfigBBWithHeaderFile( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_BB_Config_Type ConfigType ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); ++#endif ++ ++//1 AP doesn't use PHYDM initialization in these ICs ++#if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++#if (RTL8812A_SUPPORT == 1) ++ if(pDM_Odm->SupportICType == ODM_RTL8812) ++ { ++ if (ConfigType == CONFIG_BB_PHY_REG) { ++ READ_AND_CONFIG_MP(8812A, _PHY_REG); ++ } else if (ConfigType == CONFIG_BB_AGC_TAB) { ++ READ_AND_CONFIG_MP(8812A, _AGC_TAB); ++ } else if (ConfigType == CONFIG_BB_PHY_REG_PG) { ++ if (pDM_Odm->RFEType == 3 && pDM_Odm->bIsMPChip) ++ READ_AND_CONFIG_MP(8812A, _PHY_REG_PG_ASUS); ++ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ else if (pMgntInfo->CustomerID == RT_CID_WNC_NEC && pDM_Odm->bIsMPChip) ++ READ_AND_CONFIG_MP(8812A, _PHY_REG_PG_NEC); ++ #if RT_PLATFORM == PLATFORM_MACOSX ++ /*{1827}{1024} for BUFFALO power by rate table. Isaiah 2013-11-29*/ ++ else if (pMgntInfo->CustomerID == RT_CID_DNI_BUFFALO) ++ READ_AND_CONFIG_MP(8812A, _PHY_REG_PG_DNI); ++ /* TP-Link T4UH, Isaiah 2015-03-16*/ ++ else if (pMgntInfo->CustomerID == RT_CID_TPLINK_HPWR) { ++ DbgPrint("RT_CID_TPLINK_HPWR:: _PHY_REG_PG_TPLINK\n"); ++ READ_AND_CONFIG_MP(8812A, _PHY_REG_PG_TPLINK); ++ } ++ #endif ++ #endif ++ else ++ READ_AND_CONFIG_MP(8812A, _PHY_REG_PG); ++ } ++ else if(ConfigType == CONFIG_BB_PHY_REG_MP){ ++ READ_AND_CONFIG_MP(8812A,_PHY_REG_MP); ++ } ++ else if(ConfigType == CONFIG_BB_AGC_TAB_DIFF) ++ { ++ if ((36 <= *pDM_Odm->pChannel) && (*pDM_Odm->pChannel <= 64)) ++ AGC_DIFF_CONFIG_MP(8812A,LB); ++ else if (100 <= *pDM_Odm->pChannel) ++ AGC_DIFF_CONFIG_MP(8812A,HB); ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8812AGCTABArray\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8812PHY_REGArray\n")); ++ } ++#endif ++#if (RTL8821A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821) { ++ if (ConfigType == CONFIG_BB_PHY_REG) { ++ READ_AND_CONFIG_MP(8821A, _PHY_REG); ++ } else if (ConfigType == CONFIG_BB_AGC_TAB) { ++ READ_AND_CONFIG_MP(8821A, _AGC_TAB); ++ } else if (ConfigType == CONFIG_BB_PHY_REG_PG) { ++ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ if ((pHalData->EEPROMSVID == 0x1043 && pHalData->EEPROMSMID == 0x207F)) ++ READ_AND_CONFIG_MP(8821A, _PHY_REG_PG_E202SA); ++ else ++ #endif ++ #if (RT_PLATFORM == PLATFORM_MACOSX) ++ /*{1827}{1022} for BUFFALO power by rate table. Isaiah 2013-10-18*/ ++ if (pMgntInfo->CustomerID == RT_CID_DNI_BUFFALO) { ++ /*{1024} for BUFFALO power by rate table. (JP/US)*/ ++ if (pMgntInfo->ChannelPlan == RT_CHANNEL_DOMAIN_US_2G_CANADA_5G) ++ READ_AND_CONFIG_MP(8821A, _PHY_REG_PG_DNI_US); ++ else ++ READ_AND_CONFIG_MP(8821A, _PHY_REG_PG_DNI_JP); ++ } else ++ #endif ++ #endif ++ READ_AND_CONFIG_MP(8821A,_PHY_REG_PG); ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8821AGCTABArray\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8821PHY_REGArray\n")); ++ } ++#endif ++#if (RTL8192E_SUPPORT == 1) ++ if(pDM_Odm->SupportICType == ODM_RTL8192E) ++ { ++ if(ConfigType == CONFIG_BB_PHY_REG){ ++ READ_AND_CONFIG_MP(8192E,_PHY_REG); ++ }else if(ConfigType == CONFIG_BB_AGC_TAB){ ++ READ_AND_CONFIG_MP(8192E,_AGC_TAB); ++ }else if(ConfigType == CONFIG_BB_PHY_REG_PG){ ++ READ_AND_CONFIG_MP(8192E,_PHY_REG_PG); ++ } ++ } ++#endif ++#if (RTL8723D_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8723D) { ++ if (ConfigType == CONFIG_BB_PHY_REG) ++ READ_AND_CONFIG_MP(8723D, _PHY_REG); ++ else if (ConfigType == CONFIG_BB_AGC_TAB) ++ READ_AND_CONFIG_MP(8723D, _AGC_TAB); ++ else if (ConfigType == CONFIG_BB_PHY_REG_PG) ++ READ_AND_CONFIG_MP(8723D, _PHY_REG_PG); ++ } ++#endif ++#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) ++ ++ ++//1 All platforms support ++#if (RTL8188E_SUPPORT == 1) ++ if(pDM_Odm->SupportICType == ODM_RTL8188E) ++ { ++ if(ConfigType == CONFIG_BB_PHY_REG) ++ READ_AND_CONFIG_MP(8188E,_PHY_REG); ++ else if(ConfigType == CONFIG_BB_AGC_TAB) ++ READ_AND_CONFIG_MP(8188E,_AGC_TAB); ++ else if(ConfigType == CONFIG_BB_PHY_REG_PG) ++ READ_AND_CONFIG_MP(8188E,_PHY_REG_PG); ++ } ++#endif ++#if (RTL8723B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8723B) { ++ if (ConfigType == CONFIG_BB_PHY_REG) { ++ READ_AND_CONFIG_MP(8723B, _PHY_REG); ++ } else if (ConfigType == CONFIG_BB_AGC_TAB) { ++ READ_AND_CONFIG_MP(8723B, _AGC_TAB); ++ } else if (ConfigType == CONFIG_BB_PHY_REG_PG) { ++ READ_AND_CONFIG_MP(8723B, _PHY_REG_PG); ++ } ++ } ++#endif ++#if (RTL8814A_SUPPORT == 1) ++ if(pDM_Odm->SupportICType == ODM_RTL8814A) ++ { ++ if(ConfigType == CONFIG_BB_PHY_REG){ ++ READ_AND_CONFIG_MP(8814A,_PHY_REG); ++ }else if(ConfigType == CONFIG_BB_AGC_TAB){ ++ READ_AND_CONFIG_MP(8814A,_AGC_TAB); ++ }else if(ConfigType == CONFIG_BB_PHY_REG_PG){ ++ READ_AND_CONFIG_MP(8814A,_PHY_REG_PG); ++ }else if(ConfigType == CONFIG_BB_PHY_REG_MP){ ++ READ_AND_CONFIG_MP(8814A,_PHY_REG_MP); ++ } ++ } ++#endif ++#if (RTL8703B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8703B) { ++ if (ConfigType == CONFIG_BB_PHY_REG) ++ READ_AND_CONFIG_MP(8703B, _PHY_REG); ++ else if (ConfigType == CONFIG_BB_AGC_TAB) ++ READ_AND_CONFIG_MP(8703B, _AGC_TAB); ++ else if (ConfigType == CONFIG_BB_PHY_REG_PG) ++ READ_AND_CONFIG_MP(8703B, _PHY_REG_PG); ++ } ++#endif ++#if (RTL8188F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8188F) { ++ if (ConfigType == CONFIG_BB_PHY_REG) ++ READ_AND_CONFIG_MP(8188F, _PHY_REG); ++ else if (ConfigType == CONFIG_BB_AGC_TAB) ++ READ_AND_CONFIG_MP(8188F, _AGC_TAB); ++ else if (ConfigType == CONFIG_BB_PHY_REG_PG) ++ READ_AND_CONFIG_MP(8188F, _PHY_REG_PG); ++ } ++#endif ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) { ++ if (ConfigType == CONFIG_BB_PHY_REG) ++ READ_AND_CONFIG_MP(8822B, _PHY_REG); ++ else if (ConfigType == CONFIG_BB_AGC_TAB) ++ READ_AND_CONFIG_MP(8822B, _AGC_TAB); ++ else if (ConfigType == CONFIG_BB_PHY_REG_PG) ++ READ_AND_CONFIG_MP(8822B, _PHY_REG_PG); ++ /*else if (ConfigType == CONFIG_BB_PHY_REG_MP)*/ ++ /*READ_AND_CONFIG_MP(8822B, _PHY_REG_MP);*/ ++ } ++#endif ++ ++#if (RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8197F) { ++ if (ConfigType == CONFIG_BB_PHY_REG) { ++ READ_AND_CONFIG_MP(8197F, _PHY_REG); ++ if (pDM_Odm->CutVersion == ODM_CUT_A) ++ phydm_phypara_a_cut(pDM_Odm); ++ } else if (ConfigType == CONFIG_BB_AGC_TAB) ++ READ_AND_CONFIG_MP(8197F, _AGC_TAB); ++/* else if(ConfigType == CONFIG_BB_PHY_REG_PG) ++ READ_AND_CONFIG_MP(8197F, _PHY_REG_PG); ++ else if(ConfigType == CONFIG_BB_PHY_REG_MP) ++ READ_AND_CONFIG_MP(8197F, _PHY_REG_MP); */ ++ } ++#endif ++ ++#if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ { ++ if (ConfigType == CONFIG_BB_PHY_REG) { ++ READ_AND_CONFIG(8821C, _PHY_REG); ++ } else if (ConfigType == CONFIG_BB_AGC_TAB) { ++ READ_AND_CONFIG(8821C, _AGC_TAB); ++ /* According to RFEtype, choosing correct AGC table*/ ++ if (pDM_Odm->RFEType == 2 || pDM_Odm->RFEType == 4 || pDM_Odm->RFEType == 7) ++ AGC_DIFF_CONFIG_MP(8821C, BTG); ++ } else if (ConfigType == CONFIG_BB_PHY_REG_PG) { ++ READ_AND_CONFIG(8821C, _PHY_REG_PG); ++ } ++ } ++#endif ++ ++#if (RTL8195A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8195A) ++ { ++ if(ConfigType == CONFIG_BB_PHY_REG) ++ READ_AND_CONFIG(8195A, _PHY_REG); ++ else if(ConfigType == CONFIG_BB_AGC_TAB) ++ READ_AND_CONFIG(8195A, _AGC_TAB); ++ else if(ConfigType == CONFIG_BB_PHY_REG_PG) ++ READ_AND_CONFIG(8195A, _PHY_REG_PG); ++ } ++#endif ++ ++ return HAL_STATUS_SUCCESS; ++} ++ ++HAL_STATUS ++ODM_ConfigMACWithHeaderFile( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("===>ODM_ConfigMACWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", ++ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); ++ ++//1 AP doesn't use PHYDM initialization in these ICs ++#if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++#if (RTL8812A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8812){ ++ READ_AND_CONFIG_MP(8812A, _MAC_REG); ++ } ++#endif ++#if (RTL8821A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821){ ++ READ_AND_CONFIG_MP(8821A, _MAC_REG); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigMACwithHeaderFile\n")); ++ } ++#endif ++#if (RTL8192E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8192E){ ++ READ_AND_CONFIG_MP(8192E, _MAC_REG); ++ } ++#endif ++#if (RTL8723D_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8723D) ++ READ_AND_CONFIG_MP(8723D, _MAC_REG); ++#endif ++#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) ++ ++//1 All platforms support ++#if (RTL8188E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8188E){ ++ READ_AND_CONFIG_MP(8188E, _MAC_REG); ++ } ++#endif ++#if (RTL8723B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8723B) { ++ READ_AND_CONFIG_MP(8723B, _MAC_REG); ++ } ++#endif ++#if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8814A){ ++ READ_AND_CONFIG_MP(8814A, _MAC_REG); ++ } ++#endif ++#if (RTL8703B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8703B) ++ READ_AND_CONFIG_MP(8703B, _MAC_REG); ++#endif ++#if (RTL8188F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8188F) ++ READ_AND_CONFIG_MP(8188F, _MAC_REG); ++#endif ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) ++ READ_AND_CONFIG_MP(8822B, _MAC_REG); ++#endif ++ ++#if (RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8197F) ++ READ_AND_CONFIG_MP(8197F, _MAC_REG); ++#endif ++ ++#if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ READ_AND_CONFIG(8821C, _MAC_REG); ++#endif ++ ++#if (RTL8195A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8195A) ++ READ_AND_CONFIG_MP(8195A, _MAC_REG); ++#endif ++ ++ return HAL_STATUS_SUCCESS; ++} ++ ++HAL_STATUS ++ODM_ConfigFWWithHeaderFile( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_FW_Config_Type ConfigType, ++ OUT u1Byte *pFirmware, ++ OUT u4Byte *pSize ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++ ++#if (RTL8188E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) ++ { ++ #ifdef CONFIG_SFW_SUPPORTED ++ if (ConfigType == CONFIG_FW_NIC) ++ READ_FIRMWARE_MP(8188E_T,_FW_NIC); ++ else if (ConfigType == CONFIG_FW_WoWLAN) ++ READ_FIRMWARE_MP(8188E_T,_FW_WoWLAN); ++ else if(ConfigType == CONFIG_FW_NIC_2) ++ READ_FIRMWARE_MP(8188E_S,_FW_NIC); ++ else if (ConfigType == CONFIG_FW_WoWLAN_2) ++ READ_FIRMWARE_MP(8188E_S,_FW_WoWLAN); ++ #ifdef CONFIG_AP_WOWLAN ++ if (ConfigType == CONFIG_FW_AP) ++ READ_FIRMWARE_MP(8188E_T,_FW_AP); ++ else if (ConfigType == CONFIG_FW_AP_2) ++ READ_FIRMWARE_MP(8188E_S,_FW_AP); ++ #endif //CONFIG_AP_WOWLAN ++ #else ++ if (ConfigType == CONFIG_FW_NIC) ++ READ_FIRMWARE_MP(8188E_T,_FW_NIC); ++ else if (ConfigType == CONFIG_FW_WoWLAN) ++ READ_FIRMWARE_MP(8188E_T,_FW_WoWLAN); ++ #ifdef CONFIG_AP_WOWLAN ++ else if (ConfigType == CONFIG_FW_AP) ++ READ_FIRMWARE_MP(8188E_T,_FW_AP); ++ #endif //CONFIG_AP_WOWLAN ++ #endif ++ } ++#endif ++#if (RTL8723B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8723B) ++ { ++ if (ConfigType == CONFIG_FW_NIC) ++ READ_FIRMWARE_MP(8723B,_FW_NIC); ++ else if (ConfigType == CONFIG_FW_WoWLAN) ++ READ_FIRMWARE_MP(8723B,_FW_WoWLAN); ++ #ifdef CONFIG_AP_WOWLAN ++ else if (ConfigType == CONFIG_FW_AP_WoWLAN) ++ READ_FIRMWARE(8723B,_FW_AP_WoWLAN); ++ #endif ++ ++ } ++#endif //#if (RTL8723B_SUPPORT == 1) ++#if (RTL8812A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ { ++ if (ConfigType == CONFIG_FW_NIC) ++ READ_FIRMWARE_MP(8812A,_FW_NIC); ++ else if (ConfigType == CONFIG_FW_WoWLAN) ++ READ_FIRMWARE_MP(8812A,_FW_WoWLAN); ++ else if (ConfigType == CONFIG_FW_BT) ++ READ_FIRMWARE_MP(8812A,_FW_NIC_BT); ++ #ifdef CONFIG_AP_WOWLAN ++ else if (ConfigType == CONFIG_FW_AP_WoWLAN) ++ READ_FIRMWARE(8812A,_FW_AP); ++ #endif ++ } ++#endif ++#if (RTL8821A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821){ ++ if (ConfigType == CONFIG_FW_NIC) ++ READ_FIRMWARE_MP(8821A,_FW_NIC); ++ else if (ConfigType == CONFIG_FW_WoWLAN) ++ READ_FIRMWARE_MP(8821A,_FW_WoWLAN); ++ #ifdef CONFIG_AP_WOWLAN ++ else if (ConfigType == CONFIG_FW_AP_WoWLAN) ++ READ_FIRMWARE_MP(8821A , _FW_AP); ++ #endif /*CONFIG_AP_WOWLAN*/ ++ else if (ConfigType == CONFIG_FW_BT) ++ READ_FIRMWARE_MP(8821A,_FW_NIC_BT); ++ } ++#endif ++#if (RTL8192E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8192E) ++ { ++ if (ConfigType == CONFIG_FW_NIC) ++ READ_FIRMWARE_MP(8192E,_FW_NIC); ++ else if (ConfigType == CONFIG_FW_WoWLAN) ++ READ_FIRMWARE_MP(8192E,_FW_WoWLAN); ++ #ifdef CONFIG_AP_WOWLAN ++ else if (ConfigType == CONFIG_FW_AP_WoWLAN) ++ READ_FIRMWARE_MP(8192E,_FW_AP); ++ #endif ++ } ++#endif ++#if (RTL8723D_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8723D) { ++ if (ConfigType == CONFIG_FW_NIC) { ++ READ_FIRMWARE_MP(8723D, _FW_NIC); ++ } else if (ConfigType == CONFIG_FW_WoWLAN) { ++ READ_FIRMWARE_MP(8723D, _FW_WoWLAN); ++ } ++ } ++#endif ++/*#if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8814A) ++ { ++ if (ConfigType == CONFIG_FW_NIC) ++ READ_FIRMWARE_MP(8814A, _FW_NIC); ++ else if (ConfigType == CONFIG_FW_WoWLAN) ++ READ_FIRMWARE_MP(8814A, _FW_WoWLAN); ++ #ifdef CONFIG_AP_WOWLAN ++ else if (ConfigType == CONFIG_FW_AP_WoWLAN) ++ READ_FIRMWARE_MP(8814A, _FW_AP); ++ #endif ++ } ++#endif */ ++ ++#if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8814A) ++ { ++ if (ConfigType == CONFIG_FW_NIC) ++ READ_FIRMWARE_MP(8814A,_FW_NIC); ++ #ifdef CONFIG_AP_WOWLAN ++ else if (ConfigType == CONFIG_FW_AP_WoWLAN) ++ READ_FIRMWARE_MP(8814A,_FW_AP); ++ #endif ++ } ++#endif ++ ++#if (RTL8703B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8703B) { ++ if (ConfigType == CONFIG_FW_NIC) ++ READ_FIRMWARE_MP(8703B, _FW_NIC); ++ else if (ConfigType == CONFIG_FW_WoWLAN) ++ READ_FIRMWARE_MP(8703B, _FW_WoWLAN); ++ #ifdef CONFIG_AP_WOWLAN ++ else if (ConfigType == CONFIG_FW_AP_WoWLAN) ++ READ_FIRMWARE(8703B, _FW_AP_WoWLAN); ++ #endif ++ } ++#endif ++ ++#if (RTL8188F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8188F) { ++ if (ConfigType == CONFIG_FW_NIC) ++ READ_FIRMWARE_MP(8188F, _FW_NIC); ++ else if (ConfigType == CONFIG_FW_WoWLAN) ++ READ_FIRMWARE_MP(8188F, _FW_WoWLAN); ++ #ifdef CONFIG_AP_WOWLAN ++ else if (ConfigType == CONFIG_FW_AP) ++ READ_FIRMWARE_MP(8188F, _FW_AP); ++ #endif ++ } ++#endif ++ ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) { ++ ++ if (ConfigType == CONFIG_FW_NIC) ++ READ_FIRMWARE_MP(8822B,_FW_NIC); ++ else if (ConfigType == CONFIG_FW_WoWLAN) ++ READ_FIRMWARE_MP(8822B, _FW_WoWLAN); ++ #ifdef CONFIG_AP_WOWLAN ++ else if (ConfigType == CONFIG_FW_AP_WoWLAN) ++ READ_FIRMWARE(8822B,_FW_AP); ++ #endif ++ } ++#endif ++ ++#if (RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8197F) { ++ if (ConfigType == CONFIG_FW_NIC) ++ READ_FIRMWARE_MP(8197F, _FW_NIC); ++ #ifdef CONFIG_AP_WOWLAN ++ else if (ConfigType == CONFIG_FW_AP_WoWLAN) ++ READ_FIRMWARE(8197F , _FW_AP); ++ #endif ++ } ++#endif ++ ++#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN)) ++#if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821C){ ++ if (ConfigType == CONFIG_FW_NIC) ++ READ_FIRMWARE_MP(8821C,_FW_NIC); ++ else if (ConfigType == CONFIG_FW_WoWLAN) ++ READ_FIRMWARE_MP(8821C,_FW_WoWLAN); ++ #ifdef CONFIG_AP_WOWLAN ++ else if (ConfigType == CONFIG_FW_AP_WoWLAN) ++ READ_FIRMWARE_MP(8821C , _FW_AP); ++ #endif /*CONFIG_AP_WOWLAN*/ ++ } ++#endif ++#endif ++ ++#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) ++ return HAL_STATUS_SUCCESS; ++} ++ ++u4Byte ++ODM_GetHWImgVersion( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte Version=0; ++ ++//1 AP doesn't use PHYDM initialization in these ICs ++#if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++#if (RTL8821A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821) ++ Version = GET_VERSION_MP(8821A,_MAC_REG); ++#endif ++#if (RTL8192E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8192E) ++ Version = GET_VERSION_MP(8192E,_MAC_REG); ++#endif ++#if (RTL8812A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ Version = GET_VERSION_MP(8812A,_MAC_REG); ++#endif ++#if (RTL8723D_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8723D) ++ Version = GET_VERSION_MP(8723D, _MAC_REG); ++#endif ++#endif //(DM_ODM_SUPPORT_TYPE != ODM_AP) ++ ++/*1 All platforms support*/ ++#if (RTL8188E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) ++ Version = GET_VERSION_MP(8188E,_MAC_REG); ++#endif ++#if (RTL8723B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8723B) ++ Version = GET_VERSION_MP(8723B, _MAC_REG); ++#endif ++#if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8814A) ++ Version = GET_VERSION_MP(8814A,_MAC_REG); ++#endif ++#if (RTL8703B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8703B) ++ Version = GET_VERSION_MP(8703B, _MAC_REG); ++#endif ++#if (RTL8188F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8188F) ++ Version = GET_VERSION_MP(8188F, _MAC_REG); ++#endif ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) ++ Version = GET_VERSION_MP(8822B, _MAC_REG); ++#endif ++ ++#if (RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8197F) ++ Version = GET_VERSION_MP(8197F, _MAC_REG); ++#endif ++ ++#if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ Version = GET_VERSION(8821C, _MAC_REG); ++#endif ++ ++ return Version; ++} ++ ++#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) ++/* For 8822B only!! need to move to FW finally */ ++/*==============================================*/ ++ ++VOID ++phydm_ResetPhyInfo( ++ IN PDM_ODM_T pPhydm, ++ OUT PODM_PHY_INFO_T pPhyInfo ++) ++{ ++ pPhyInfo->RxPWDBAll = 0; ++ pPhyInfo->SignalQuality = 0; ++ pPhyInfo->BandWidth = 0; ++ pPhyInfo->RxCount = 0; ++ ODM_Memory_Set(pPhydm, pPhyInfo->RxMIMOSignalQuality, 0 , 4); ++ ODM_Memory_Set(pPhydm, pPhyInfo->RxMIMOSignalStrength, 0, 4); ++ ODM_Memory_Set(pPhydm, pPhyInfo->RxSNR, 0, 4); ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ pPhyInfo->RxPower = -110; ++ pPhyInfo->RecvSignalPower = -110; ++ pPhyInfo->BTRxRSSIPercentage = 0; ++ pPhyInfo->SignalStrength = 0; ++ pPhyInfo->btCoexPwrAdjust = 0; ++ pPhyInfo->channel = 0; ++ pPhyInfo->bMuPacket = 0; ++ pPhyInfo->bBeamformed = 0; ++ pPhyInfo->rxsc = 0; ++ ODM_Memory_Set(pPhydm, pPhyInfo->RxPwr, -110, 4); ++ ODM_Memory_Set(pPhydm, pPhyInfo->RxMIMOEVMdbm, 0, 4); ++ ODM_Memory_Set(pPhydm, pPhyInfo->Cfo_short, 0, 8); ++ ODM_Memory_Set(pPhydm, pPhyInfo->Cfo_tail, 0, 8); ++#endif ++} ++ ++VOID ++phydm_SetPerPathPhyInfo( ++ IN u1Byte RxPath, ++ IN s1Byte RxPwr, ++ IN s1Byte RxEVM, ++ IN s1Byte Cfo_tail, ++ IN s1Byte RxSNR, ++ OUT PODM_PHY_INFO_T pPhyInfo ++) ++{ ++ u1Byte EVMdBm = 0; ++ u1Byte EVMPercentage = 0; ++ ++ /* SNR is S(8,1), EVM is S(8,1), CFO is S(8,7) */ ++ ++ if (RxEVM < 0) { ++ /* Calculate EVM in dBm */ ++ EVMdBm = ((u1Byte)(0 - RxEVM) >> 1); ++ ++ /* Calculate EVM in percentage */ ++ if (EVMdBm >= 33) ++ EVMPercentage = 100; ++ else ++ EVMPercentage = (EVMdBm << 1) + (EVMdBm); ++ } ++ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ pPhyInfo->RxPwr[RxPath] = RxPwr; ++ pPhyInfo->RxMIMOEVMdbm[RxPath] = EVMdBm; ++ ++ /* CFO = CFO_tail * 312.5 / 2^7 ~= CFO tail * 39/512 (kHz)*/ ++ pPhyInfo->Cfo_tail[RxPath] = Cfo_tail; ++ pPhyInfo->Cfo_tail[RxPath] = ((pPhyInfo->Cfo_tail[RxPath] << 5) + (pPhyInfo->Cfo_tail[RxPath] << 2) + ++ (pPhyInfo->Cfo_tail[RxPath] << 1) + (pPhyInfo->Cfo_tail[RxPath])) >> 9; ++#endif ++ ++ pPhyInfo->RxMIMOSignalStrength[RxPath] = odm_QueryRxPwrPercentage(RxPwr); ++ pPhyInfo->RxMIMOSignalQuality[RxPath] = EVMPercentage; ++ pPhyInfo->RxSNR[RxPath] = RxSNR >> 1; ++ ++/* ++ //if (pPktinfo->bPacketMatchBSSID) ++ { ++ DbgPrint("Path (%d)--------\n", RxPath); ++ DbgPrint("RxPwr = %d, Signal strength = %d\n", pPhyInfo->RxPwr[RxPath], pPhyInfo->RxMIMOSignalStrength[RxPath]); ++ DbgPrint("EVMdBm = %d, Signal quality = %d\n", pPhyInfo->RxMIMOEVMdbm[RxPath], pPhyInfo->RxMIMOSignalQuality[RxPath]); ++ DbgPrint("CFO = %d, SNR = %d\n", pPhyInfo->Cfo_tail[RxPath], pPhyInfo->RxSNR[RxPath]); ++ } ++*/ ++} ++ ++VOID ++phydm_SetCommonPhyInfo( ++ IN s1Byte RxPower, ++ IN u1Byte channel, ++ IN BOOLEAN bBeamformed, ++ IN BOOLEAN bMuPacket, ++ IN u1Byte bandwidth, ++ IN u1Byte signalQuality, ++ IN u1Byte rxsc, ++ OUT PODM_PHY_INFO_T pPhyInfo ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ pPhyInfo->RxPower = RxPower; /* RSSI in dB */ ++ pPhyInfo->RecvSignalPower = RxPower; /* RSSI in dB */ ++ pPhyInfo->channel = channel; /* channel number */ ++ pPhyInfo->bBeamformed = bBeamformed; /* apply BF */ ++ pPhyInfo->bMuPacket = bMuPacket; /* MU packet */ ++ pPhyInfo->rxsc = rxsc; ++#endif ++ pPhyInfo->RxPWDBAll = odm_QueryRxPwrPercentage(RxPower); /* RSSI in percentage */ ++ pPhyInfo->SignalQuality = signalQuality; /* signal quality */ ++ pPhyInfo->BandWidth = bandwidth; /* bandwidth */ ++ ++/* ++ //if (pPktinfo->bPacketMatchBSSID) ++ { ++ DbgPrint("RxPWDBAll = %d, RxPower = %d, RecvSignalPower = %d\n", pPhyInfo->RxPWDBAll, pPhyInfo->RxPower, pPhyInfo->RecvSignalPower); ++ DbgPrint("SignalQuality = %d\n", pPhyInfo->SignalQuality); ++ DbgPrint("bBeamformed = %d, bMuPacket = %d, RxCount = %d\n", pPhyInfo->bBeamformed, pPhyInfo->bMuPacket, pPhyInfo->RxCount + 1); ++ DbgPrint("channel = %d, rxsc = %d, BandWidth = %d\n", channel, rxsc, bandwidth); ++ } ++*/ ++} ++ ++VOID ++phydm_GetRxPhyStatusType0( ++ IN PDM_ODM_T pDM_Odm, ++ IN pu1Byte pPhyStatus, ++ IN PODM_PACKET_INFO_T pPktinfo, ++ OUT PODM_PHY_INFO_T pPhyInfo ++) ++{ ++ /* Type 0 is used for cck packet */ ++ ++ PPHY_STATUS_RPT_JAGUAR2_TYPE0 pPhyStaRpt = (PPHY_STATUS_RPT_JAGUAR2_TYPE0)pPhyStatus; ++ u1Byte i, SQ = 0; ++ s1Byte RxPower = pPhyStaRpt->pwdb - 110; ++ ++ ++#if (RTL8723D_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8723D) ++ RxPower = pPhyStaRpt->pwdb - 97; ++#endif ++ ++ /* Calculate Signal Quality*/ ++ if (pPktinfo->bPacketMatchBSSID) { ++ if (pPhyStaRpt->signal_quality >= 64) ++ SQ = 0; ++ else if (pPhyStaRpt->signal_quality <= 20) ++ SQ = 100; ++ else { ++ /* mapping to 2~99% */ ++ SQ = 64 - pPhyStaRpt->signal_quality; ++ SQ = ((SQ << 3) + SQ) >> 2; ++ } ++ } ++ ++ /* Modify CCK PWDB if old AGC */ ++ if (pDM_Odm->cck_new_agc == FALSE) { ++ u1Byte LNA_idx, VGA_idx; ++ ++#if (RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) ++ LNA_idx = pPhyStaRpt->lna_l; ++ else ++#endif ++ LNA_idx = ((pPhyStaRpt->lna_h << 3) | pPhyStaRpt->lna_l); ++ VGA_idx = pPhyStaRpt->vga; ++ ++#if (RTL8723D_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8723D) ++ RxPower = odm_CCKRSSI_8723D(LNA_idx, VGA_idx); ++#endif ++#if (RTL8822B_SUPPORT == 1) ++ /* Need to do !! */ ++ /*if (pDM_Odm->SupportICType & ODM_RTL8822B) */ ++ /*RxPower = odm_CCKRSSI_8822B(LNA_idx, VGA_idx);*/ ++#endif ++#if (RTL8197F_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8197F) ++ RxPower = odm_CCKRSSI_8197F(pDM_Odm, LNA_idx, VGA_idx); ++#endif ++ } ++ ++ /* Update CCK packet counter */ ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; ++ ++ /*CCK no STBC and LDPC*/ ++ pDM_Odm->PhyDbgInfo.bLdpcPkt = FALSE; ++ pDM_Odm->PhyDbgInfo.bStbcPkt = FALSE; ++ ++ /* Update Common information */ ++ phydm_SetCommonPhyInfo(RxPower, pPhyStaRpt->channel, FALSE, ++ FALSE, ODM_BW20M, SQ, pPhyStaRpt->rxsc, pPhyInfo); ++ ++ /* Update CCK pwdb */ ++ phydm_SetPerPathPhyInfo(ODM_RF_PATH_A, RxPower, 0, 0, 0, pPhyInfo); /* Update per-path information */ ++ ++ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->antidx_a; ++ pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->antidx_b; ++ pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antidx_c; ++ pDM_Odm->DM_FatTable.antsel_rx_keep_3 = pPhyStaRpt->antidx_d; ++/* ++ //if (pPktinfo->bPacketMatchBSSID) ++ { ++ DbgPrint("pwdb = 0x%x, MP gain index = 0x%x, TRSW = 0x%x\n", pPhyStaRpt->pwdb, pPhyStaRpt->gain, pPhyStaRpt->trsw); ++ DbgPrint("channel = %d, band = %d, rxsc = %d\n", pPhyStaRpt->channel, pPhyStaRpt->band, pPhyStaRpt->rxsc); ++ DbgPrint("agc_table = 0x%x, agc_rpt 0x%x, bb_power = 0x%x\n", pPhyStaRpt->agc_table, pPhyStaRpt->agc_rpt, pPhyStaRpt->bb_power); ++ DbgPrint("length = %d, SQ = %d\n", pPhyStaRpt->length, pPhyStaRpt->signal_quality); ++ DbgPrint("antidx a = 0x%x, b = 0x%x, c = 0x%x, d = 0x%x\n", pPhyStaRpt->antidx_a, pPhyStaRpt->antidx_b, pPhyStaRpt->antidx_c, pPhyStaRpt->antidx_d); ++ DbgPrint("rsvd_0 = 0x%x, rsvd_1 = 0x%x, rsvd_2 = 0x%x\n", pPhyStaRpt->rsvd_0, pPhyStaRpt->rsvd_1, pPhyStaRpt->rsvd_2); ++ DbgPrint("rsvd_3 = 0x%x, rsvd_4 = 0x%x, rsvd_5 = 0x%x\n", pPhyStaRpt->rsvd_3, pPhyStaRpt->rsvd_4, pPhyStaRpt->rsvd_5); ++ DbgPrint("rsvd_6 = 0x%x, rsvd_7 = 0x%x, rsvd_8 = 0x%x\n", pPhyStaRpt->rsvd_6, pPhyStaRpt->rsvd_7, pPhyStaRpt->rsvd_8); ++ } ++*/ ++} ++ ++VOID ++phydm_GetRxPhyStatusType1( ++ IN PDM_ODM_T pDM_Odm, ++ IN pu1Byte pPhyStatus, ++ IN PODM_PACKET_INFO_T pPktinfo, ++ OUT PODM_PHY_INFO_T pPhyInfo ++) ++{ ++ /* Type 1 is used for ofdm packet */ ++ ++ PPHY_STATUS_RPT_JAGUAR2_TYPE1 pPhyStaRpt = (PPHY_STATUS_RPT_JAGUAR2_TYPE1)pPhyStatus; ++ s1Byte rx_pwr_db = -120; ++ u1Byte i, rxsc, bw = ODM_BW20M, RxCount = 0; ++ BOOLEAN bMU; ++ u1Byte num_ss; ++ ++ /* Update OFDM packet counter */ ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; ++ ++ /* Update per-path information */ ++ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { ++ if (pDM_Odm->RXAntStatus & BIT(i)) { ++ s1Byte rx_path_pwr_db; ++ ++ /* RX path counter */ ++ RxCount++; ++ ++ /* Update per-path information (RSSI_dB RSSI_percentage EVM SNR CFO SQ) */ ++ /* EVM report is reported by stream, not path */ ++ rx_path_pwr_db = pPhyStaRpt->pwdb[i] - 110; /* per-path pwdb in dB domain */ ++ phydm_SetPerPathPhyInfo(i, rx_path_pwr_db, pPhyStaRpt->rxevm[RxCount - 1], ++ pPhyStaRpt->cfo_tail[i], pPhyStaRpt->rxsnr[i], pPhyInfo); ++ ++ /* search maximum pwdb */ ++ if (rx_path_pwr_db > rx_pwr_db) ++ rx_pwr_db = rx_path_pwr_db; ++ } ++ } ++ ++ /* mapping RX counter from 1~4 to 0~3 */ ++ if (RxCount > 0) ++ pPhyInfo->RxCount = RxCount - 1; ++ ++ /* Check if MU packet or not */ ++ if ((pPhyStaRpt->gid != 0) && (pPhyStaRpt->gid != 63)) { ++ bMU = TRUE; ++ pDM_Odm->PhyDbgInfo.NumQryMuPkt++; ++ } else ++ bMU = FALSE; ++ ++ /* Count BF packet */ ++ pDM_Odm->PhyDbgInfo.NumQryBfPkt = pDM_Odm->PhyDbgInfo.NumQryBfPkt + pPhyStaRpt->beamformed; ++ ++ /*STBC or LDPC pkt*/ ++ pDM_Odm->PhyDbgInfo.bLdpcPkt = pPhyStaRpt->ldpc; ++ pDM_Odm->PhyDbgInfo.bStbcPkt = pPhyStaRpt->stbc; ++ ++ /* Check sub-channel */ ++ if ((pPktinfo->DataRate > ODM_RATE11M) && (pPktinfo->DataRate < ODM_RATEMCS0)) ++ rxsc = pPhyStaRpt->l_rxsc; ++ else ++ rxsc = pPhyStaRpt->ht_rxsc; ++ ++ /* Check RX bandwidth */ ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) { ++ if ((rxsc >= 1) && (rxsc <= 8)) ++ bw = ODM_BW20M; ++ else if ((rxsc >= 9) && (rxsc <= 12)) ++ bw = ODM_BW40M; ++ else if (rxsc >= 13) ++ bw = ODM_BW80M; ++ else ++ bw = pPhyStaRpt->rf_mode; ++ } else if (pDM_Odm->SupportICType & (ODM_RTL8197F|ODM_RTL8723D)) { ++ if (pPhyStaRpt->rf_mode == 0) ++ bw = ODM_BW20M; ++ else if ((rxsc == 1) || (rxsc == 2)) ++ bw = ODM_BW20M; ++ else ++ bw = ODM_BW40M; ++ } ++ ++ /* Update packet information */ ++ phydm_SetCommonPhyInfo(rx_pwr_db, pPhyStaRpt->channel, (BOOLEAN)pPhyStaRpt->beamformed, ++ bMU, bw, odm_EVMdbToPercentage(pPhyStaRpt->rxevm[0]), rxsc, pPhyInfo); ++ ++ num_ss =phydm_rate_to_num_ss(pDM_Odm, pPktinfo->DataRate ); ++ ++ ODM_ParsingCFO(pDM_Odm, pPktinfo, pPhyStaRpt->cfo_tail, num_ss); ++ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->antidx_a; ++ pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->antidx_b; ++ pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antidx_c; ++ pDM_Odm->DM_FatTable.antsel_rx_keep_3 = pPhyStaRpt->antidx_d; ++ ++ if (pPktinfo->bPacketMatchBSSID) { ++/* ++ DbgPrint("channel = %d, band = %d, l_rxsc = %d, ht_rxsc = %d, rf_mode = %d\n", pPhyStaRpt->channel, pPhyStaRpt->band, pPhyStaRpt->l_rxsc, pPhyStaRpt->ht_rxsc, pPhyStaRpt->rf_mode); ++ DbgPrint("Antidx A = %d, B = %d, C = %d, D = %d\n", pPhyStaRpt->antidx_a, pPhyStaRpt->antidx_b, pPhyStaRpt->antidx_c, pPhyStaRpt->antidx_d); ++ DbgPrint("pwdb A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->pwdb[0], pPhyStaRpt->pwdb[1], pPhyStaRpt->pwdb[2], pPhyStaRpt->pwdb[3]); ++ DbgPrint("EVM A: %d, B: %d, C: %d, D: %d\n", pPhyStaRpt->rxevm[0], pPhyStaRpt->rxevm[1], pPhyStaRpt->rxevm[2], pPhyStaRpt->rxevm[3]); ++ DbgPrint("SNR A: %d, B: %d, C: %d, D: %d\n", pPhyStaRpt->rxsnr[0], pPhyStaRpt->rxsnr[1], pPhyStaRpt->rxsnr[2], pPhyStaRpt->rxsnr[3]); ++ DbgPrint("CFO A: %d, B: %d, C: %d, D: %d\n", pPhyStaRpt->cfo_tail[0], pPhyStaRpt->cfo_tail[1], pPhyStaRpt->cfo_tail[2], pPhyStaRpt->cfo_tail[3]); ++ DbgPrint("paid = %d, gid = %d, length = %d\n", (pPhyStaRpt->paid + (pPhyStaRpt->paid_msb<<8)), pPhyStaRpt->gid, pPhyStaRpt->lsig_length); ++ DbgPrint("ldpc: %d, stbc: %d, bf: %d, gnt_bt: %d, antsw: %d\n", pPhyStaRpt->ldpc, pPhyStaRpt->stbc, pPhyStaRpt->beamformed, pPhyStaRpt->gnt_bt, pPhyStaRpt->hw_antsw_occu); ++ DbgPrint("NBI: %d, pos: %d\n", pPhyStaRpt->nb_intf_flag, (pPhyStaRpt->intf_pos + (pPhyStaRpt->intf_pos_msb<<8))); ++ DbgPrint("rsvd_0 = %d, rsvd_1 = %d, rsvd_2 = %d, rsvd_3 = %d, rsvd_4 = %d, rsvd_5 = %d\n", pPhyStaRpt->rsvd_0, pPhyStaRpt->rsvd_1, pPhyStaRpt->rsvd_2, pPhyStaRpt->rsvd_3, pPhyStaRpt->rsvd_4, pPhyStaRpt->rsvd_5); ++*/ ++ if ((pPhyStaRpt->gid != 0) && (pPhyStaRpt->gid != 63)) { ++ if (pPktinfo->DataRate >= ODM_RATEVHTSS1MCS0) ++ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[pPktinfo->DataRate - 0x2C]++; ++ } else { ++ if (pPktinfo->DataRate >= ODM_RATEVHTSS1MCS0) ++ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[pPktinfo->DataRate - 0x2C]++; ++ } ++ } ++/* ++ DbgPrint("phydm_GetRxPhyStatusType1 pPktinfo->bPacketMatchBSSID = %d\n", pPktinfo->bPacketMatchBSSID); ++ DbgPrint("pPktinfo->DataRate = 0x%x\n", pPktinfo->DataRate); ++*/ ++} ++ ++VOID ++phydm_GetRxPhyStatusType2( ++ IN PDM_ODM_T pDM_Odm, ++ IN pu1Byte pPhyStatus, ++ IN PODM_PACKET_INFO_T pPktinfo, ++ OUT PODM_PHY_INFO_T pPhyInfo ++) ++{ ++ PPHY_STATUS_RPT_JAGUAR2_TYPE2 pPhyStaRpt = (PPHY_STATUS_RPT_JAGUAR2_TYPE2)pPhyStatus; ++ s1Byte rx_pwr_db = -120; ++ u1Byte i, rxsc, bw = ODM_BW20M, RxCount = 0; ++ ++ /* Update OFDM packet counter */ ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; ++ ++ /* Update per-path information */ ++ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { ++ if (pDM_Odm->RXAntStatus & BIT(i)) { ++ s1Byte rx_path_pwr_db; ++ ++ /* RX path counter */ ++ RxCount++; ++ ++ /* Update per-path information (RSSI_dB RSSI_percentage EVM SNR CFO SQ) */ ++#if (RTL8197F_SUPPORT == 1) ++ if ((pDM_Odm->SupportICType & ODM_RTL8197F) && (pPhyStaRpt->pwdb[i] == 0x7f)) { /*for 97f workaround*/ ++ ++ if (i == ODM_RF_PATH_A) { ++ rx_path_pwr_db = (pPhyStaRpt->gain_a)<<1; ++ rx_path_pwr_db = rx_path_pwr_db - 110; ++ } else if (i == ODM_RF_PATH_B) { ++ rx_path_pwr_db = (pPhyStaRpt->gain_b)<<1; ++ rx_path_pwr_db = rx_path_pwr_db - 110; ++ } else ++ rx_path_pwr_db = 0; ++ } else ++#endif ++ rx_path_pwr_db = pPhyStaRpt->pwdb[i] - 110; /* per-path pwdb in dB domain */ ++ ++ phydm_SetPerPathPhyInfo(i, rx_path_pwr_db, 0, 0, 0, pPhyInfo); ++ ++ /* search maximum pwdb */ ++ if (rx_path_pwr_db > rx_pwr_db) ++ rx_pwr_db = rx_path_pwr_db; ++ } ++ } ++ ++ /* mapping RX counter from 1~4 to 0~3 */ ++ if (RxCount > 0) ++ pPhyInfo->RxCount = RxCount - 1; ++ ++ /* Check RX sub-channel */ ++ if ((pPktinfo->DataRate > ODM_RATE11M) && (pPktinfo->DataRate < ODM_RATEMCS0)) ++ rxsc = pPhyStaRpt->l_rxsc; ++ else ++ rxsc = pPhyStaRpt->ht_rxsc; ++ ++ /*STBC or LDPC pkt*/ ++ pDM_Odm->PhyDbgInfo.bLdpcPkt = pPhyStaRpt->ldpc; ++ pDM_Odm->PhyDbgInfo.bStbcPkt = pPhyStaRpt->stbc; ++ ++ /* Check RX bandwidth */ ++ /* the BW information of sc=0 is useless, because there is no information of RF mode*/ ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) { ++ if ((rxsc >= 1) && (rxsc <= 8)) ++ bw = ODM_BW20M; ++ else if ((rxsc >= 9) && (rxsc <= 12)) ++ bw = ODM_BW40M; ++ else if (rxsc >= 13) ++ bw = ODM_BW80M; ++ else ++ bw = ODM_BW20M; ++ } else if (pDM_Odm->SupportICType & (ODM_RTL8197F|ODM_RTL8723D)) { ++ if (rxsc == 3) ++ bw = ODM_BW40M; ++ else if ((rxsc == 1) || (rxsc == 2)) ++ bw = ODM_BW20M; ++ else ++ bw = ODM_BW20M; ++ } ++ ++ /* Update packet information */ ++ phydm_SetCommonPhyInfo(rx_pwr_db, pPhyStaRpt->channel, (BOOLEAN)pPhyStaRpt->beamformed, ++ FALSE, bw, 0, rxsc, pPhyInfo); ++ ++/* ++ //if (pPktinfo->bPacketMatchBSSID) ++ { ++ DbgPrint("channel = %d, band = %d, l_rxsc = %d, ht_rxsc = %d\n", pPhyStaRpt->channel, pPhyStaRpt->band, pPhyStaRpt->l_rxsc, pPhyStaRpt->ht_rxsc); ++ DbgPrint("pwdb A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->pwdb[0], pPhyStaRpt->pwdb[1], pPhyStaRpt->pwdb[2], pPhyStaRpt->pwdb[3]); ++ DbgPrint("Agc table A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->agc_table_a, pPhyStaRpt->agc_table_b, pPhyStaRpt->agc_table_c, pPhyStaRpt->agc_table_d); ++ DbgPrint("Gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->gain_a, pPhyStaRpt->gain_b, pPhyStaRpt->gain_c, pPhyStaRpt->gain_d); ++ DbgPrint("TRSW A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->trsw_a, pPhyStaRpt->trsw_b, pPhyStaRpt->trsw_c, pPhyStaRpt->trsw_d); ++ DbgPrint("AAGC step A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->aagc_step_a, pPhyStaRpt->aagc_step_b, pPhyStaRpt->aagc_step_c, pPhyStaRpt->aagc_step_d); ++ DbgPrint("HT AAGC gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->ht_aagc_gain[0], pPhyStaRpt->ht_aagc_gain[1], pPhyStaRpt->ht_aagc_gain[2], pPhyStaRpt->ht_aagc_gain[3]); ++ DbgPrint("DAGC gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->dagc_gain[0], pPhyStaRpt->dagc_gain[1], pPhyStaRpt->dagc_gain[2], pPhyStaRpt->dagc_gain[3]); ++ DbgPrint("ldpc: %d, stbc: %d, bf: %d, gnt_bt: %d, antsw: %d\n", pPhyStaRpt->ldpc, pPhyStaRpt->stbc, pPhyStaRpt->beamformed, pPhyStaRpt->gnt_bt, pPhyStaRpt->hw_antsw_occu); ++ DbgPrint("counter: %d, syn_count: %d\n", pPhyStaRpt->counter, pPhyStaRpt->syn_count); ++ DbgPrint("cnt_cca2agc_rdy: %d, cnt_pw2cca: %d, shift_l_map\n", pPhyStaRpt->cnt_cca2agc_rdy, pPhyStaRpt->cnt_pw2cca, pPhyStaRpt->shift_l_map); ++ DbgPrint("rsvd_0 = %d, rsvd_1 = %d, rsvd_2 = %d, rsvd_3 = %d, rsvd_4 = %d, rsvd_5 = %d\n", pPhyStaRpt->rsvd_0, pPhyStaRpt->rsvd_1, pPhyStaRpt->rsvd_2, pPhyStaRpt->rsvd_3, pPhyStaRpt->rsvd_4); ++ DbgPrint("rsvd_5 = %d, rsvd_6 = %d, rsvd_6 = %d\n", pPhyStaRpt->rsvd_5, pPhyStaRpt->rsvd_6, pPhyStaRpt->rsvd_7); ++ } ++*/ ++} ++ ++VOID ++phydm_GetRxPhyStatusType5( ++ IN pu1Byte pPhyStatus ++) ++{ ++/* ++ DbgPrint("DW0: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 3), *(pPhyStatus + 2), *(pPhyStatus + 1), *(pPhyStatus + 0)); ++ DbgPrint("DW1: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 7), *(pPhyStatus + 6), *(pPhyStatus + 5), *(pPhyStatus + 4)); ++ DbgPrint("DW2: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 11), *(pPhyStatus + 10), *(pPhyStatus + 9), *(pPhyStatus + 8)); ++ DbgPrint("DW3: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 15), *(pPhyStatus + 14), *(pPhyStatus + 13), *(pPhyStatus + 12)); ++ DbgPrint("DW4: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 19), *(pPhyStatus + 18), *(pPhyStatus + 17), *(pPhyStatus + 16)); ++ DbgPrint("DW5: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 23), *(pPhyStatus + 22), *(pPhyStatus + 21), *(pPhyStatus + 20)); ++ DbgPrint("DW6: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 27), *(pPhyStatus + 26), *(pPhyStatus + 25), *(pPhyStatus + 24)); ++*/ ++} ++ ++VOID ++phydm_Process_RSSIForDMNewType( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN PODM_PHY_INFO_T pPhyInfo, ++ IN PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++ s4Byte UndecoratedSmoothedPWDB, AccumulatePWDB; ++ u4Byte RSSI_Ave; ++ u1Byte i; ++ PSTA_INFO_T pEntry; ++ u1Byte scaling_factor = 4; ++ ++ if (pPktinfo->StationID >= ODM_ASSOCIATE_ENTRY_NUM) ++ return; ++ ++ pEntry = pDM_Odm->pODM_StaInfo[pPktinfo->StationID]; ++ ++ if (!IS_STA_VALID(pEntry)) ++ return; ++ ++ if ((!pPktinfo->bPacketMatchBSSID))/*data frame only*/ ++ return; ++ ++ if (pPktinfo->bPacketBeacon) ++ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt++; ++ ++ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++ if (pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) ++ ODM_Process_RSSIForAntDiv(pDM_Odm,pPhyInfo,pPktinfo); ++ #endif ++ ++ if (pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon) { ++ u4Byte RSSI_linear = 0; ++ ++ pDM_Odm->RxRate = pPktinfo->DataRate; ++ UndecoratedSmoothedPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; ++ AccumulatePWDB = pDM_Odm->AccumulatePWDB[pPktinfo->StationID]; ++ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; ++ pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; ++ pDM_Odm->RSSI_C = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_C]; ++ pDM_Odm->RSSI_D = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_D]; ++ ++ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { ++ if (pPhyInfo->RxMIMOSignalStrength[i] != 0) ++ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[i]); ++ } ++ ++ switch (pPhyInfo->RxCount + 1) { ++ case 2: ++ RSSI_linear = (RSSI_linear >> 1); ++ break; ++ case 3: ++ RSSI_linear = ((RSSI_linear) + (RSSI_linear << 1) + (RSSI_linear << 3)) >> 5; /* RSSI_linear/3 ~ RSSI_linear*11/32 */ ++ break; ++ case 4: ++ RSSI_linear = (RSSI_linear >> 2); ++ break; ++ } ++ RSSI_Ave = odm_ConvertTo_dB(RSSI_linear); ++ ++ if (UndecoratedSmoothedPWDB <= 0) { ++ AccumulatePWDB = (pPhyInfo->RxPWDBAll << scaling_factor); ++ UndecoratedSmoothedPWDB = pPhyInfo->RxPWDBAll; ++ } else { ++ AccumulatePWDB = AccumulatePWDB - (AccumulatePWDB>>scaling_factor) + RSSI_Ave; ++ UndecoratedSmoothedPWDB = (AccumulatePWDB + (1<<(scaling_factor - 1)))>>scaling_factor; ++ } ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB == -1) ++ phydm_ra_rssi_rpt_wk(pDM_Odm); ++#endif ++ pEntry->rssi_stat.UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; ++ pDM_Odm->AccumulatePWDB[pPktinfo->StationID] = AccumulatePWDB; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ if (pPktinfo->StationID == 0) { ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pDM_Odm->Adapter); ++ ++ pHalData->UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; ++ } ++#endif ++ } ++} ++ ++VOID ++phydm_RxPhyStatusNewType( ++ IN PDM_ODM_T pPhydm, ++ IN pu1Byte pPhyStatus, ++ IN PODM_PACKET_INFO_T pPktinfo, ++ OUT PODM_PHY_INFO_T pPhyInfo ++) ++{ ++ u1Byte phy_status_type = (*pPhyStatus & 0xf); ++ ++ /*DbgPrint("phydm_RxPhyStatusNewType================> (page: %d)\n", phy_status_type);*/ ++ ++ /* Memory reset */ ++ phydm_ResetPhyInfo(pPhydm, pPhyInfo); ++ ++ /* Phy status parsing */ ++ switch (phy_status_type) { ++ case 0: ++ { ++ phydm_GetRxPhyStatusType0(pPhydm, pPhyStatus, pPktinfo, pPhyInfo); ++ break; ++ } ++ case 1: ++ { ++ phydm_GetRxPhyStatusType1(pPhydm, pPhyStatus, pPktinfo, pPhyInfo); ++ break; ++ } ++ case 2: ++ { ++ phydm_GetRxPhyStatusType2(pPhydm, pPhyStatus, pPktinfo, pPhyInfo); ++ break; ++ } ++/* ++ case 5: ++ { ++ phydm_GetRxPhyStatusType5(pPhyStatus); ++ return; ++ } ++*/ ++ default: ++ return; ++ } ++ ++ /* Update signal strength to UI, and pPhyInfo->RxPWDBAll is the maximum RSSI of all path */ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ pPhyInfo->SignalStrength = SignalScaleProc(pPhydm->Adapter, pPhyInfo->RxPWDBAll, FALSE, FALSE); ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pPhydm, pPhyInfo->RxPWDBAll)); ++#endif ++ ++ /* Calculate average RSSI and smoothed RSSI */ ++ phydm_Process_RSSIForDMNewType(pPhydm, pPhyInfo, pPktinfo); ++ ++} ++/*==============================================*/ ++#endif ++ ++u4Byte ++query_phydm_trx_capability( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ u4Byte value32 = 0xFFFFFFFF; ++ ++ #if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ value32 = query_phydm_trx_capability_8821c(pDM_Odm); ++ #endif ++ ++ return value32; ++} ++ ++u4Byte ++query_phydm_stbc_capability( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ u4Byte value32 = 0xFFFFFFFF; ++ ++ #if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ value32 = query_phydm_stbc_capability_8821c(pDM_Odm); ++ #endif ++ ++ return value32; ++} ++ ++u4Byte ++query_phydm_ldpc_capability( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ u4Byte value32 = 0xFFFFFFFF; ++ ++ #if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ value32 = query_phydm_ldpc_capability_8821c(pDM_Odm); ++ #endif ++ ++ return value32; ++} ++ ++u4Byte ++query_phydm_txbf_parameters( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ u4Byte value32 = 0xFFFFFFFF; ++ ++ #if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ value32 = query_phydm_txbf_parameters_8821c(pDM_Odm); ++ #endif ++ ++ return value32; ++} ++ ++u4Byte ++query_phydm_txbf_capability( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ u4Byte value32 = 0xFFFFFFFF; ++ ++ #if (RTL8821C_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8821C) ++ value32 = query_phydm_txbf_capability_8821c(pDM_Odm); ++ #endif ++ ++ return value32; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.h 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,568 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ ++#ifndef __HALHWOUTSRC_H__ ++#define __HALHWOUTSRC_H__ ++ ++ ++/*--------------------------Define -------------------------------------------*/ ++#define CCK_RSSI_INIT_COUNT 5 ++ ++#define RA_RSSI_STATE_INIT 0 ++#define RA_RSSI_STATE_SEND 1 ++#define RA_RSSI_STATE_HOLD 2 ++ ++#define CFO_HW_RPT_2_MHZ(val) ((val<<1) + (val>>1)) ++/* ((X* 3125) / 10)>>7 = (X*10)>>2 = X*2.5 = X<<1 + X>>1 */ ++ ++#define AGC_DIFF_CONFIG_MP(ic, band) (ODM_ReadAndConfig_MP_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_MP_##ic##_AGC_TAB_DIFF_##band, \ ++ sizeof(Array_MP_##ic##_AGC_TAB_DIFF_##band)/sizeof(u4Byte))) ++#define AGC_DIFF_CONFIG_TC(ic, band) (ODM_ReadAndConfig_TC_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_TC_##ic##_AGC_TAB_DIFF_##band, \ ++ sizeof(Array_TC_##ic##_AGC_TAB_DIFF_##band)/sizeof(u4Byte))) ++ ++#define AGC_DIFF_CONFIG(ic, band) do {\ ++ if (pDM_Odm->bIsMPChip)\ ++ AGC_DIFF_CONFIG_MP(ic,band);\ ++ else\ ++ AGC_DIFF_CONFIG_TC(ic,band);\ ++ } while(0) ++ ++ ++//============================================================ ++// structure and define ++//============================================================ ++ ++__PACK typedef struct _Phy_Rx_AGC_Info ++{ ++ #if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte gain:7,trsw:1; ++ #else ++ u1Byte trsw:1,gain:7; ++ #endif ++} __WLAN_ATTRIB_PACK__ PHY_RX_AGC_INFO_T, *pPHY_RX_AGC_INFO_T; ++ ++__PACK typedef struct _Phy_Status_Rpt_8192cd { ++ PHY_RX_AGC_INFO_T path_agc[2]; ++ u1Byte ch_corr[2]; ++ u1Byte cck_sig_qual_ofdm_pwdb_all; ++ u1Byte cck_agc_rpt_ofdm_cfosho_a; ++ u1Byte cck_rpt_b_ofdm_cfosho_b; ++ u1Byte rsvd_1;/*ch_corr_msb;*/ ++ u1Byte noise_power_db_msb; ++ s1Byte path_cfotail[2]; ++ u1Byte pcts_mask[2]; ++ s1Byte stream_rxevm[2]; ++ u1Byte path_rxsnr[2]; ++ u1Byte noise_power_db_lsb; ++ u1Byte rsvd_2[3]; ++ u1Byte stream_csi[2]; ++ u1Byte stream_target_csi[2]; ++ s1Byte sig_evm; ++ u1Byte rsvd_3; ++ ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte antsel_rx_keep_2: 1; /*ex_intf_flg:1;*/ ++ u1Byte sgi_en: 1; ++ u1Byte rxsc: 2; ++ u1Byte idle_long: 1; ++ u1Byte r_ant_train_en: 1; ++ u1Byte ant_sel_b: 1; ++ u1Byte ant_sel: 1; ++#else /*_BIG_ENDIAN_ */ ++ u1Byte ant_sel: 1; ++ u1Byte ant_sel_b: 1; ++ u1Byte r_ant_train_en: 1; ++ u1Byte idle_long: 1; ++ u1Byte rxsc: 2; ++ u1Byte sgi_en: 1; ++ u1Byte antsel_rx_keep_2: 1;/*ex_intf_flg:1;*/ ++#endif ++} __WLAN_ATTRIB_PACK__ PHY_STATUS_RPT_8192CD_T, *PPHY_STATUS_RPT_8192CD_T; ++ ++ ++typedef struct _Phy_Status_Rpt_8812 { ++/* DWORD 0*/ ++ u1Byte gain_trsw[2]; /*path-A and path-B {TRSW, gain[6:0] }*/ ++ u1Byte chl_num_LSB; /*channel number[7:0]*/ ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte chl_num_MSB: 2; /*channel number[9:8]*/ ++ u1Byte sub_chnl: 4; /*sub-channel location[3:0]*/ ++ u1Byte r_RFMOD: 2; /*RF mode[1:0]*/ ++#else /*_BIG_ENDIAN_ */ ++ u1Byte r_RFMOD: 2; ++ u1Byte sub_chnl: 4; ++ u1Byte chl_num_MSB: 2; ++#endif ++ ++/* DWORD 1*/ ++ u1Byte pwdb_all; /*CCK signal quality / OFDM pwdb all*/ ++ s1Byte cfosho[2]; /*DW1 byte 1 DW1 byte2 CCK AGC report and CCK_BB_Power / OFDM Path-A and Path-B short CFO*/ ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ /*this should be checked again because the definition of 8812 and 8814 is different*/ ++/* u1Byte r_cck_rx_enable_pathc:2; cck rx enable pathc[1:0]*/ ++/* u1Byte cck_rx_path:4; cck rx path[3:0]*/ ++ u1Byte resvd_0: 6; ++ u1Byte bt_RF_ch_MSB: 2; /*8812A:2'b0 8814A: bt rf channel keep[7:6]*/ ++#else /*_BIG_ENDIAN_*/ ++ u1Byte bt_RF_ch_MSB: 2; ++ u1Byte resvd_0: 6; ++#endif ++ ++/* DWORD 2*/ ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte ant_div_sw_a: 1; /*8812A: ant_div_sw_a 8814A: 1'b0*/ ++ u1Byte ant_div_sw_b: 1; /*8812A: ant_div_sw_b 8814A: 1'b0*/ ++ u1Byte bt_RF_ch_LSB: 6; /*8812A: 6'b0 8814A: bt rf channel keep[5:0]*/ ++#else /*_BIG_ENDIAN_ */ ++ u1Byte bt_RF_ch_LSB: 6; ++ u1Byte ant_div_sw_b: 1; ++ u1Byte ant_div_sw_a: 1; ++#endif ++ s1Byte cfotail[2]; /*DW2 byte 1 DW2 byte 2 path-A and path-B CFO tail*/ ++ u1Byte PCTS_MSK_RPT_0; /*PCTS mask report[7:0]*/ ++ u1Byte PCTS_MSK_RPT_1; /*PCTS mask report[15:8]*/ ++ ++/* DWORD 3*/ ++ s1Byte rxevm[2]; /*DW3 byte 1 DW3 byte 2 stream 1 and stream 2 RX EVM*/ ++ s1Byte rxsnr[2]; /*DW3 byte 3 DW4 byte 0 path-A and path-B RX SNR*/ ++ ++/* DWORD 4*/ ++ u1Byte PCTS_MSK_RPT_2; /*PCTS mask report[23:16]*/ ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte PCTS_MSK_RPT_3: 6; /*PCTS mask report[29:24]*/ ++ u1Byte pcts_rpt_valid: 1; /*pcts_rpt_valid*/ ++ u1Byte resvd_1: 1; /*1'b0*/ ++#else /*_BIG_ENDIAN_*/ ++ u1Byte resvd_1: 1; ++ u1Byte pcts_rpt_valid: 1; ++ u1Byte PCTS_MSK_RPT_3: 6; ++#endif ++ s1Byte rxevm_cd[2]; /*DW 4 byte 3 DW5 byte 0 8812A: 16'b0 8814A: stream 3 and stream 4 RX EVM*/ ++ ++/* DWORD 5*/ ++ u1Byte csi_current[2]; /*DW5 byte 1 DW5 byte 2 8812A: stream 1 and 2 CSI 8814A: path-C and path-D RX SNR*/ ++ u1Byte gain_trsw_cd[2]; /*DW5 byte 3 DW6 byte 0 path-C and path-D {TRSW, gain[6:0] }*/ ++ ++/* DWORD 6*/ ++ s1Byte sigevm; /*signal field EVM*/ ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte antidx_antc: 3; /*8812A: 3'b0 8814A: antidx_antc[2:0]*/ ++ u1Byte antidx_antd: 3; /*8812A: 3'b0 8814A: antidx_antd[2:0]*/ ++ u1Byte dpdt_ctrl_keep: 1; /*8812A: 1'b0 8814A: dpdt_ctrl_keep*/ ++ u1Byte GNT_BT_keep: 1; /*8812A: 1'b0 8814A: GNT_BT_keep*/ ++#else /*_BIG_ENDIAN_*/ ++ u1Byte GNT_BT_keep: 1; ++ u1Byte dpdt_ctrl_keep: 1; ++ u1Byte antidx_antd: 3; ++ u1Byte antidx_antc: 3; ++#endif ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte antidx_anta: 3; /*antidx_anta[2:0]*/ ++ u1Byte antidx_antb: 3; /*antidx_antb[2:0]*/ ++ u1Byte hw_antsw_occur: 2; /*1'b0*/ ++#else /*_BIG_ENDIAN_*/ ++ u1Byte hw_antsw_occur: 2; ++ u1Byte antidx_antb: 3; ++ u1Byte antidx_anta: 3; ++#endif ++} PHY_STATUS_RPT_8812_T, *PPHY_STATUS_RPT_8812_T; ++ ++VOID ++phydm_reset_rssi_for_dm( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN u1Byte station_id ++); ++ ++VOID ++odm_Init_RSSIForDM( ++ IN OUT PDM_ODM_T pDM_Odm ++); ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++phydm_normal_driver_rx_sniffer( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN pu1Byte pDesc, ++ IN PRT_RFD_STATUS pRtRfdStatus, ++ IN pu1Byte pDrvInfo, ++ IN u1Byte PHYStatus ++ ); ++#endif ++ ++VOID ++ODM_PhyStatusQuery( ++ IN OUT PDM_ODM_T pDM_Odm, ++ OUT PODM_PHY_INFO_T pPhyInfo, ++ IN pu1Byte pPhyStatus, ++ IN PODM_PACKET_INFO_T pPktinfo ++ ); ++ ++VOID ++ODM_MacStatusQuery( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN pu1Byte pMacStatus, ++ IN u1Byte MacID, ++ IN BOOLEAN bPacketMatchBSSID, ++ IN BOOLEAN bPacketToSelf, ++ IN BOOLEAN bPacketBeacon ++ ); ++ ++HAL_STATUS ++ODM_ConfigRFWithTxPwrTrackHeaderFile( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++HAL_STATUS ++ODM_ConfigRFWithHeaderFile( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_RF_Config_Type ConfigType, ++ IN ODM_RF_RADIO_PATH_E eRFPath ++ ); ++ ++HAL_STATUS ++ODM_ConfigBBWithHeaderFile( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_BB_Config_Type ConfigType ++ ); ++ ++HAL_STATUS ++ODM_ConfigMACWithHeaderFile( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++HAL_STATUS ++ODM_ConfigFWWithHeaderFile( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_FW_Config_Type ConfigType, ++ OUT u1Byte *pFirmware, ++ OUT u4Byte *pSize ++ ); ++ ++u4Byte ++ODM_GetHWImgVersion( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++s4Byte ++odm_SignalScaleMapping( ++ IN OUT PDM_ODM_T pDM_Odm, ++ IN s4Byte CurrSig ++ ); ++ ++#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) ++/*For 8822B only!! need to move to FW finally */ ++/*==============================================*/ ++VOID ++phydm_RxPhyStatusNewType( ++ IN PDM_ODM_T pPhydm, ++ IN pu1Byte pPhyStatus, ++ IN PODM_PACKET_INFO_T pPktinfo, ++ OUT PODM_PHY_INFO_T pPhyInfo ++); ++ ++typedef struct _Phy_Status_Rpt_Jaguar2_Type0 { ++ /* DW0 */ ++ u1Byte page_num; ++ u1Byte pwdb; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte gain: 6; ++ u1Byte rsvd_0: 1; ++ u1Byte trsw: 1; ++#else ++ u1Byte trsw: 1; ++ u1Byte rsvd_0: 1; ++ u1Byte gain: 6; ++#endif ++ u1Byte rsvd_1; ++ ++ /* DW1 */ ++ u1Byte rsvd_2; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte rxsc: 4; ++ u1Byte agc_table: 4; ++#else ++ u1Byte agc_table: 4; ++ u1Byte rxsc: 4; ++#endif ++ u1Byte channel; ++ u1Byte band; ++ ++ /* DW2 */ ++ u2Byte length; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte antidx_a: 3; ++ u1Byte antidx_b: 3; ++ u1Byte rsvd_3: 2; ++ u1Byte antidx_c: 3; ++ u1Byte antidx_d: 3; ++ u1Byte rsvd_4:2; ++#else ++ u1Byte rsvd_3: 2; ++ u1Byte antidx_b: 3; ++ u1Byte antidx_a: 3; ++ u1Byte rsvd_4:2; ++ u1Byte antidx_d: 3; ++ u1Byte antidx_c: 3; ++#endif ++ ++ /* DW3 */ ++ u1Byte signal_quality; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte vga:5; ++ u1Byte lna_l:3; ++ u1Byte bb_power:6; ++ u1Byte rsvd_9:1; ++ u1Byte lna_h:1; ++#else ++ u1Byte lna_l:3; ++ u1Byte vga:5; ++ u1Byte lna_h:1; ++ u1Byte rsvd_9:1; ++ u1Byte bb_power:6; ++#endif ++ u1Byte rsvd_5; ++ ++ /* DW4 */ ++ u4Byte rsvd_6; ++ ++ /* DW5 */ ++ u4Byte rsvd_7; ++ ++ /* DW6 */ ++ u4Byte rsvd_8; ++} PHY_STATUS_RPT_JAGUAR2_TYPE0, *PPHY_STATUS_RPT_JAGUAR2_TYPE0; ++ ++typedef struct _Phy_Status_Rpt_Jaguar2_Type1 { ++ /* DW0 and DW1 */ ++ u1Byte page_num; ++ u1Byte pwdb[4]; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte l_rxsc: 4; ++ u1Byte ht_rxsc: 4; ++#else ++ u1Byte ht_rxsc: 4; ++ u1Byte l_rxsc: 4; ++#endif ++ u1Byte channel; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte band: 2; ++ u1Byte rsvd_0: 1; ++ u1Byte hw_antsw_occu: 1; ++ u1Byte gnt_bt: 1; ++ u1Byte ldpc: 1; ++ u1Byte stbc: 1; ++ u1Byte beamformed: 1; ++#else ++ u1Byte beamformed: 1; ++ u1Byte stbc: 1; ++ u1Byte ldpc: 1; ++ u1Byte gnt_bt: 1; ++ u1Byte hw_antsw_occu: 1; ++ u1Byte rsvd_0: 1; ++ u1Byte band: 2; ++#endif ++ ++ /* DW2 */ ++ u2Byte lsig_length; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte antidx_a: 3; ++ u1Byte antidx_b: 3; ++ u1Byte rsvd_1: 2; ++ u1Byte antidx_c: 3; ++ u1Byte antidx_d: 3; ++ u1Byte rsvd_2: 2; ++#else ++ u1Byte rsvd_1: 2; ++ u1Byte antidx_b: 3; ++ u1Byte antidx_a: 3; ++ u1Byte rsvd_2: 2; ++ u1Byte antidx_d: 3; ++ u1Byte antidx_c: 3; ++#endif ++ ++ /* DW3 */ ++ u1Byte paid; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte paid_msb: 1; ++ u1Byte gid: 6; ++ u1Byte rsvd_3: 1; ++#else ++ u1Byte rsvd_3: 1; ++ u1Byte gid: 6; ++ u1Byte paid_msb: 1; ++#endif ++ u1Byte intf_pos; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte intf_pos_msb: 1; ++ u1Byte rsvd_4: 2; ++ u1Byte nb_intf_flag: 1; ++ u1Byte rf_mode: 2; ++ u1Byte rsvd_5: 2; ++#else ++ u1Byte rsvd_5: 2; ++ u1Byte rf_mode: 2; ++ u1Byte nb_intf_flag: 1; ++ u1Byte rsvd_4: 2; ++ u1Byte intf_pos_msb: 1; ++#endif ++ ++ /* DW4 */ ++ s1Byte rxevm[4]; /* s(8,1) */ ++ ++ /* DW5 */ ++ s1Byte cfo_tail[4]; /* s(8,7) */ ++ ++ /* DW6 */ ++ s1Byte rxsnr[4]; /* s(8,1) */ ++} PHY_STATUS_RPT_JAGUAR2_TYPE1, *PPHY_STATUS_RPT_JAGUAR2_TYPE1; ++ ++typedef struct _Phy_Status_Rpt_Jaguar2_Type2 { ++ /* DW0 ane DW1 */ ++ u1Byte page_num; ++ u1Byte pwdb[4]; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte l_rxsc: 4; ++ u1Byte ht_rxsc: 4; ++#else ++ u1Byte ht_rxsc: 4; ++ u1Byte l_rxsc: 4; ++#endif ++ u1Byte channel; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte band: 2; ++ u1Byte rsvd_0: 1; ++ u1Byte hw_antsw_occu: 1; ++ u1Byte gnt_bt: 1; ++ u1Byte ldpc: 1; ++ u1Byte stbc: 1; ++ u1Byte beamformed: 1; ++#else ++ u1Byte beamformed: 1; ++ u1Byte stbc: 1; ++ u1Byte ldpc: 1; ++ u1Byte gnt_bt: 1; ++ u1Byte hw_antsw_occu: 1; ++ u1Byte rsvd_0: 1; ++ u1Byte band: 2; ++#endif ++ ++ /* DW2 */ ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte shift_l_map: 6; ++ u1Byte rsvd_1: 2; ++#else ++ u1Byte rsvd_1: 2; ++ u1Byte shift_l_map: 6; ++#endif ++ u1Byte cnt_pw2cca; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte agc_table_a: 4; ++ u1Byte agc_table_b: 4; ++ u1Byte agc_table_c: 4; ++ u1Byte agc_table_d: 4; ++#else ++ u1Byte agc_table_b: 4; ++ u1Byte agc_table_a: 4; ++ u1Byte agc_table_d: 4; ++ u1Byte agc_table_c: 4; ++#endif ++ ++ /* DW3 ~ DW6*/ ++ u1Byte cnt_cca2agc_rdy; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte gain_a: 6; ++ u1Byte rsvd_2: 1; ++ u1Byte trsw_a: 1; ++ u1Byte gain_b: 6; ++ u1Byte rsvd_3: 1; ++ u1Byte trsw_b: 1; ++ u1Byte gain_c: 6; ++ u1Byte rsvd_4: 1; ++ u1Byte trsw_c: 1; ++ u1Byte gain_d: 6; ++ u1Byte rsvd_5: 1; ++ u1Byte trsw_d: 1; ++ u1Byte aagc_step_a: 2; ++ u1Byte aagc_step_b: 2; ++ u1Byte aagc_step_c: 2; ++ u1Byte aagc_step_d: 2; ++#else ++ u1Byte trsw_a: 1; ++ u1Byte rsvd_2: 1; ++ u1Byte gain_a: 6; ++ u1Byte trsw_b: 1; ++ u1Byte rsvd_3: 1; ++ u1Byte gain_b: 6; ++ u1Byte trsw_c: 1; ++ u1Byte rsvd_4: 1; ++ u1Byte gain_c: 6; ++ u1Byte trsw_d: 1; ++ u1Byte rsvd_5: 1; ++ u1Byte gain_d: 6; ++ u1Byte aagc_step_d: 2; ++ u1Byte aagc_step_c: 2; ++ u1Byte aagc_step_b: 2; ++ u1Byte aagc_step_a: 2; ++#endif ++ u1Byte ht_aagc_gain[4]; ++ u1Byte dagc_gain[4]; ++#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) ++ u1Byte counter: 6; ++ u1Byte rsvd_6: 2; ++ u1Byte syn_count: 5; ++ u1Byte rsvd_7:3; ++#else ++ u1Byte rsvd_6: 2; ++ u1Byte counter: 6; ++ u1Byte rsvd_7:3; ++ u1Byte syn_count: 5; ++#endif ++} PHY_STATUS_RPT_JAGUAR2_TYPE2, *PPHY_STATUS_RPT_JAGUAR2_TYPE2; ++/*==============================================*/ ++#endif /*#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1)*/ ++ ++u4Byte ++query_phydm_trx_capability( ++ IN PDM_ODM_T pDM_Odm ++); ++ ++u4Byte ++query_phydm_stbc_capability( ++ IN PDM_ODM_T pDM_Odm ++); ++ ++u4Byte ++query_phydm_ldpc_capability( ++ IN PDM_ODM_T pDM_Odm ++); ++ ++u4Byte ++query_phydm_txbf_parameters( ++ IN PDM_ODM_T pDM_Odm ++); ++ ++u4Byte ++query_phydm_txbf_capability( ++ IN PDM_ODM_T pDM_Odm ++); ++ ++#endif /*#ifndef __HALHWOUTSRC_H__*/ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_interface.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_interface.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_interface.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_interface.c 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,958 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++// ++// ODM IO Relative API. ++// ++ ++u1Byte ++ODM_Read1Byte( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ return RTL_R8(RegAddr); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ return rtw_read8(Adapter,RegAddr); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ return PlatformEFIORead1Byte(Adapter, RegAddr); ++#endif ++ ++} ++ ++ ++u2Byte ++ODM_Read2Byte( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ return RTL_R16(RegAddr); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ return rtw_read16(Adapter,RegAddr); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ return PlatformEFIORead2Byte(Adapter, RegAddr); ++#endif ++ ++} ++ ++ ++u4Byte ++ODM_Read4Byte( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ return RTL_R32(RegAddr); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ return rtw_read32(Adapter,RegAddr); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ return PlatformEFIORead4Byte(Adapter, RegAddr); ++#endif ++ ++} ++ ++ ++VOID ++ODM_Write1Byte( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u1Byte Data ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ RTL_W8(RegAddr, Data); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ rtw_write8(Adapter,RegAddr, Data); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PlatformEFIOWrite1Byte(Adapter, RegAddr, Data); ++#endif ++ ++} ++ ++ ++VOID ++ODM_Write2Byte( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u2Byte Data ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ RTL_W16(RegAddr, Data); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ rtw_write16(Adapter,RegAddr, Data); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PlatformEFIOWrite2Byte(Adapter, RegAddr, Data); ++#endif ++ ++} ++ ++ ++VOID ++ODM_Write4Byte( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u4Byte Data ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ RTL_W32(RegAddr, Data); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ rtw_write32(Adapter,RegAddr, Data); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PlatformEFIOWrite4Byte(Adapter, RegAddr, Data); ++#endif ++ ++} ++ ++ ++VOID ++ODM_SetMACReg( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask, ++ IN u4Byte Data ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ PHY_SetBBReg(pDM_Odm->priv, RegAddr, BitMask, Data); ++#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PHY_SetBBReg(Adapter, RegAddr, BitMask, Data); ++#endif ++} ++ ++ ++u4Byte ++ODM_GetMACReg( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ return PHY_QueryBBReg(pDM_Odm->priv, RegAddr, BitMask); ++#elif(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ return PHY_QueryMacReg(pDM_Odm->Adapter, RegAddr, BitMask); ++#endif ++} ++ ++ ++VOID ++ODM_SetBBReg( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask, ++ IN u4Byte Data ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ PHY_SetBBReg(pDM_Odm->priv, RegAddr, BitMask, Data); ++#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PHY_SetBBReg(Adapter, RegAddr, BitMask, Data); ++#endif ++} ++ ++ ++u4Byte ++ODM_GetBBReg( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ return PHY_QueryBBReg(pDM_Odm->priv, RegAddr, BitMask); ++#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ return PHY_QueryBBReg(Adapter, RegAddr, BitMask); ++#endif ++} ++ ++ ++VOID ++ODM_SetRFReg( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_RF_RADIO_PATH_E eRFPath, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask, ++ IN u4Byte Data ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ PHY_SetRFReg(pDM_Odm->priv, eRFPath, RegAddr, BitMask, Data); ++#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PHY_SetRFReg(Adapter, eRFPath, RegAddr, BitMask, Data); ++ ODM_delay_us(2); ++ ++#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PHY_SetRFReg(pDM_Odm->Adapter, eRFPath, RegAddr, BitMask, Data); ++#endif ++} ++ ++u4Byte ++ODM_GetRFReg( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_RF_RADIO_PATH_E eRFPath, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ return PHY_QueryRFReg(pDM_Odm->priv, eRFPath, RegAddr, BitMask, 1); ++#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ return PHY_QueryRFReg(Adapter, eRFPath, RegAddr, BitMask); ++#endif ++} ++ ++ ++ ++ ++// ++// ODM Memory relative API. ++// ++VOID ++ODM_AllocateMemory( ++ IN PDM_ODM_T pDM_Odm, ++ OUT PVOID *pPtr, ++ IN u4Byte length ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ *pPtr = kmalloc(length, GFP_ATOMIC); ++#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) ++ *pPtr = rtw_zvmalloc(length); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PlatformAllocateMemory(Adapter, pPtr, length); ++#endif ++} ++ ++// length could be ignored, used to detect memory leakage. ++VOID ++ODM_FreeMemory( ++ IN PDM_ODM_T pDM_Odm, ++ OUT PVOID pPtr, ++ IN u4Byte length ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ kfree(pPtr); ++#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) ++ rtw_vmfree(pPtr, length); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ //PADAPTER Adapter = pDM_Odm->Adapter; ++ PlatformFreeMemory(pPtr, length); ++#endif ++} ++ ++VOID ++ODM_MoveMemory( ++ IN PDM_ODM_T pDM_Odm, ++ OUT PVOID pDest, ++ IN PVOID pSrc, ++ IN u4Byte Length ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ memcpy(pDest, pSrc, Length); ++#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) ++ _rtw_memcpy(pDest, pSrc, Length); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PlatformMoveMemory(pDest, pSrc, Length); ++#endif ++} ++ ++void ODM_Memory_Set( ++ IN PDM_ODM_T pDM_Odm, ++ IN PVOID pbuf, ++ IN s1Byte value, ++ IN u4Byte length ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ memset(pbuf, value, length); ++#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) ++ _rtw_memset(pbuf,value, length); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PlatformFillMemory(pbuf,length,value); ++#endif ++} ++s4Byte ODM_CompareMemory( ++ IN PDM_ODM_T pDM_Odm, ++ IN PVOID pBuf1, ++ IN PVOID pBuf2, ++ IN u4Byte length ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ return memcmp(pBuf1,pBuf2,length); ++#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) ++ return _rtw_memcmp(pBuf1,pBuf2,length); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ return PlatformCompareMemory(pBuf1,pBuf2,length); ++#endif ++} ++ ++ ++ ++// ++// ODM MISC relative API. ++// ++VOID ++ODM_AcquireSpinLock( ++ IN PDM_ODM_T pDM_Odm, ++ IN RT_SPINLOCK_TYPE type ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ rtw_odm_acquirespinlock(Adapter, type); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PlatformAcquireSpinLock(Adapter, type); ++#endif ++} ++VOID ++ODM_ReleaseSpinLock( ++ IN PDM_ODM_T pDM_Odm, ++ IN RT_SPINLOCK_TYPE type ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ rtw_odm_releasespinlock(Adapter, type); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PlatformReleaseSpinLock(Adapter, type); ++#endif ++} ++ ++// ++// Work item relative API. FOr MP driver only~! ++// ++VOID ++ODM_InitializeWorkItem( ++ IN PDM_ODM_T pDM_Odm, ++ IN PRT_WORK_ITEM pRtWorkItem, ++ IN RT_WORKITEM_CALL_BACK RtWorkItemCallback, ++ IN PVOID pContext, ++ IN const char* szID ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PlatformInitializeWorkItem(Adapter, pRtWorkItem, RtWorkItemCallback, pContext, szID); ++#endif ++} ++ ++ ++VOID ++ODM_StartWorkItem( ++ IN PRT_WORK_ITEM pRtWorkItem ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PlatformStartWorkItem(pRtWorkItem); ++#endif ++} ++ ++ ++VOID ++ODM_StopWorkItem( ++ IN PRT_WORK_ITEM pRtWorkItem ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PlatformStopWorkItem(pRtWorkItem); ++#endif ++} ++ ++ ++VOID ++ODM_FreeWorkItem( ++ IN PRT_WORK_ITEM pRtWorkItem ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PlatformFreeWorkItem(pRtWorkItem); ++#endif ++} ++ ++ ++VOID ++ODM_ScheduleWorkItem( ++ IN PRT_WORK_ITEM pRtWorkItem ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PlatformScheduleWorkItem(pRtWorkItem); ++#endif ++} ++ ++ ++VOID ++ODM_IsWorkItemScheduled( ++ IN PRT_WORK_ITEM pRtWorkItem ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PlatformIsWorkItemScheduled(pRtWorkItem); ++#endif ++} ++ ++ ++ ++// ++// ODM Timer relative API. ++// ++VOID ++ODM_StallExecution( ++ IN u4Byte usDelay ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ rtw_udelay_os(usDelay); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PlatformStallExecution(usDelay); ++#endif ++} ++ ++VOID ++ODM_delay_ms(IN u4Byte ms) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ delay_ms(ms); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ rtw_mdelay_os(ms); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ delay_ms(ms); ++#endif ++} ++ ++VOID ++ODM_delay_us(IN u4Byte us) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ delay_us(us); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ rtw_udelay_os(us); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PlatformStallExecution(us); ++#endif ++} ++ ++VOID ++ODM_sleep_ms(IN u4Byte ms) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ rtw_msleep_os(ms); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++#endif ++} ++ ++VOID ++ODM_sleep_us(IN u4Byte us) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ rtw_usleep_os(us); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++#endif ++} ++ ++VOID ++ODM_SetTimer( ++ IN PDM_ODM_T pDM_Odm, ++ IN PRT_TIMER pTimer, ++ IN u4Byte msDelay ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ mod_timer(pTimer, jiffies + RTL_MILISECONDS_TO_JIFFIES(msDelay)); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ _set_timer(pTimer,msDelay ); //ms ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PlatformSetTimer(Adapter, pTimer, msDelay); ++#endif ++ ++} ++ ++VOID ++ODM_InitializeTimer( ++ IN PDM_ODM_T pDM_Odm, ++ IN PRT_TIMER pTimer, ++ IN RT_TIMER_CALL_BACK CallBackFunc, ++ IN PVOID pContext, ++ IN const char* szID ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ init_timer(pTimer); ++ pTimer->function = CallBackFunc; ++ pTimer->data = (unsigned long)pDM_Odm; ++ /*mod_timer(pTimer, jiffies+RTL_MILISECONDS_TO_JIFFIES(10)); */ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ _init_timer(pTimer,Adapter->pnetdev,CallBackFunc,pDM_Odm); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PlatformInitializeTimer(Adapter, pTimer, CallBackFunc,pContext,szID); ++#endif ++} ++ ++ ++VOID ++ODM_CancelTimer( ++ IN PDM_ODM_T pDM_Odm, ++ IN PRT_TIMER pTimer ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ del_timer(pTimer); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ _cancel_timer_ex(pTimer); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PlatformCancelTimer(Adapter, pTimer); ++#endif ++} ++ ++ ++VOID ++ODM_ReleaseTimer( ++ IN PDM_ODM_T pDM_Odm, ++ IN PRT_TIMER pTimer ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ // <20120301, Kordan> If the initilization fails, InitializeAdapterXxx will return regardless of InitHalDm. ++ // Hence, uninitialized timers cause BSOD when the driver releases resources since the init fail. ++ if (pTimer == 0) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_SERIOUS, ("=====>ODM_ReleaseTimer(), The timer is NULL! Please check it!\n")); ++ return; ++ } ++ ++ PlatformReleaseTimer(Adapter, pTimer); ++#endif ++} ++ ++ ++u1Byte ++phydm_trans_h2c_id( ++ IN PDM_ODM_T pDM_Odm, ++ IN u1Byte phydm_h2c_id ++) ++{ ++ u1Byte platform_h2c_id = phydm_h2c_id; ++ ++ switch (phydm_h2c_id) ++ { ++ //1 [0] ++ case ODM_H2C_RSSI_REPORT: ++ ++ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ if(pDM_Odm->SupportICType == ODM_RTL8188E) ++ platform_h2c_id = H2C_88E_RSSI_REPORT; ++ else if(pDM_Odm->SupportICType == ODM_RTL8814A) ++ platform_h2c_id =H2C_8814A_RSSI_REPORT; ++ else ++ platform_h2c_id = H2C_RSSI_REPORT; ++ ++ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ platform_h2c_id = H2C_RSSI_SETTING; ++ ++ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ #if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) ++ if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) ++ platform_h2c_id = H2C_88XX_RSSI_REPORT; ++ else ++ #endif ++ #if (RTL8812A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ platform_h2c_id = H2C_8812_RSSI_REPORT; ++ else ++ #endif ++ {} ++ #endif ++ ++ break; ++ ++ //1 [3] ++ case ODM_H2C_WIFI_CALIBRATION: ++ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ platform_h2c_id =H2C_WIFI_CALIBRATION; ++ ++ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ #if (RTL8723B_SUPPORT == 1) ++ platform_h2c_id = H2C_8723B_BT_WLAN_CALIBRATION; ++ #endif ++ ++ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ #endif ++ break; ++ ++ ++ //1 [4] ++ case ODM_H2C_IQ_CALIBRATION: ++ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ platform_h2c_id =H2C_IQ_CALIBRATION; ++ ++ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ #if((RTL8812A_SUPPORT==1) ||(RTL8821A_SUPPORT==1)) ++ platform_h2c_id = H2C_8812_IQ_CALIBRATION; ++ #endif ++ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ #endif ++ ++ break; ++ //1 [5] ++ case ODM_H2C_RA_PARA_ADJUST: ++ ++ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ if (pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B)) ++ platform_h2c_id =H2C_8814A_RA_PARA_ADJUST; ++ else ++ platform_h2c_id = H2C_RA_PARA_ADJUST; ++ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ #if((RTL8812A_SUPPORT==1) ||(RTL8821A_SUPPORT==1)) ++ platform_h2c_id = H2C_8812_RA_PARA_ADJUST; ++ #elif ((RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1)) ++ platform_h2c_id = H2C_RA_PARA_ADJUST; ++ #elif(RTL8192E_SUPPORT==1) ++ platform_h2c_id =H2C_8192E_RA_PARA_ADJUST; ++ #elif(RTL8723B_SUPPORT==1) ++ platform_h2c_id =H2C_8723B_RA_PARA_ADJUST; ++ #endif ++ ++ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ #if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) ++ if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) ++ platform_h2c_id = H2C_88XX_RA_PARA_ADJUST; ++ else ++ #endif ++ #if(RTL8812A_SUPPORT==1) ++ if(pDM_Odm->SupportICType == ODM_RTL8812) ++ platform_h2c_id = H2C_8812_RA_PARA_ADJUST; ++ else ++ #endif ++ {} ++ #endif ++ ++ break; ++ ++ ++ //1 [6] ++ case PHYDM_H2C_DYNAMIC_TX_PATH: ++ ++ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ if(pDM_Odm->SupportICType == ODM_RTL8814A) ++ { ++ platform_h2c_id =H2C_8814A_DYNAMIC_TX_PATH; ++ } ++ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ #if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8814A) ++ platform_h2c_id = H2C_DYNAMIC_TX_PATH; ++ #endif ++ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ #if(RTL8814A_SUPPORT==1) ++ if( pDM_Odm->SupportICType == ODM_RTL8814A) ++ { ++ platform_h2c_id = H2C_88XX_DYNAMIC_TX_PATH; ++ } ++ #endif ++ ++ #endif ++ ++ break; ++ ++ /* [7]*/ ++ case PHYDM_H2C_FW_TRACE_EN: ++ ++ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ if (pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B)) ++ platform_h2c_id = H2C_8814A_FW_TRACE_EN; ++ else ++ platform_h2c_id = H2C_FW_TRACE_EN; ++ ++ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ ++ platform_h2c_id = 0x49; ++ ++ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ #if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) ++ if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) ++ platform_h2c_id = H2C_88XX_FW_TRACE_EN; ++ else ++ #endif ++ #if (RTL8812A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ platform_h2c_id = H2C_8812_FW_TRACE_EN; ++ else ++ #endif ++ {} ++ ++ #endif ++ ++ break; ++ ++ case PHYDM_H2C_TXBF: ++ #if ((RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1)) ++ platform_h2c_id = 0x41; /*H2C_TxBF*/ ++ #endif ++ break; ++ ++ case PHYDM_H2C_MU: ++ #if (RTL8822B_SUPPORT == 1) ++ platform_h2c_id = 0x4a; /*H2C_MU*/ ++ #endif ++ break; ++ ++ default: ++ platform_h2c_id = phydm_h2c_id; ++ break; ++ } ++ ++ return platform_h2c_id; ++ ++} ++ ++/*ODM FW relative API.*/ ++ ++VOID ++ODM_FillH2CCmd( ++ IN PDM_ODM_T pDM_Odm, ++ IN u1Byte phydm_h2c_id, ++ IN u4Byte CmdLen, ++ IN pu1Byte pCmdBuffer ++) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ u1Byte platform_h2c_id; ++ ++ platform_h2c_id=phydm_trans_h2c_id(pDM_Odm, phydm_h2c_id); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] platform_h2c_id = ((0x%x))\n", platform_h2c_id)); ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) { ++ if (!pDM_Odm->RaSupport88E) ++ FillH2CCmd88E(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); ++ } else if (pDM_Odm->SupportICType == ODM_RTL8814A) ++ FillH2CCmd8814A(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); ++ else if (pDM_Odm->SupportICType == ODM_RTL8822B) ++#if (RTL8822B_SUPPORT == 1) ++ FillH2CCmd8822B(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); ++#endif ++ else ++ FillH2CCmd(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ rtw_hal_fill_h2c_cmd(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_AP) ++#if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) ++ if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) ++ GET_HAL_INTERFACE(pDM_Odm->priv)->FillH2CCmdHandler(pDM_Odm->priv, platform_h2c_id, CmdLen, pCmdBuffer); ++ else ++#endif ++#if (RTL8812A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ FillH2CCmd8812(pDM_Odm->priv, platform_h2c_id, CmdLen, pCmdBuffer); ++ else ++#endif ++ {} ++#endif ++} ++ ++u1Byte ++phydm_c2H_content_parsing( ++ IN PVOID pDM_VOID, ++ IN u1Byte c2hCmdId, ++ IN u1Byte c2hCmdLen, ++ IN pu1Byte tmpBuf ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ #endif ++ u1Byte Extend_c2hSubID = 0; ++ u1Byte find_c2h_cmd = TRUE; ++ ++ switch (c2hCmdId) { ++ case PHYDM_C2H_DBG: ++ phydm_fw_trace_handler(pDM_Odm, tmpBuf, c2hCmdLen); ++ break; ++ ++ case PHYDM_C2H_RA_RPT: ++ phydm_c2h_ra_report_handler(pDM_Odm, tmpBuf, c2hCmdLen); ++ break; ++ ++ case PHYDM_C2H_RA_PARA_RPT: ++ ODM_C2HRaParaReportHandler(pDM_Odm, tmpBuf, c2hCmdLen); ++ break; ++ ++ case PHYDM_C2H_DYNAMIC_TX_PATH_RPT: ++ if (pDM_Odm->SupportICType & (ODM_RTL8814A)) ++ phydm_c2h_dtp_handler(pDM_Odm, tmpBuf, c2hCmdLen); ++ break; ++ ++ case PHYDM_C2H_IQK_FINISH: ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) { ++ ++ RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK Finish ==\n")); ++ PlatformAcquireSpinLock(Adapter, RT_IQK_SPINLOCK); ++ pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; ++ PlatformReleaseSpinLock(Adapter, RT_IQK_SPINLOCK); ++ pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime = 0; ++ pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime = ODM_GetProgressingTime(pDM_Odm, pDM_Odm->RFCalibrateInfo.IQK_StartTime); ++ } ++ ++ #endif ++ break; ++ ++ case PHYDM_C2H_DBG_CODE: ++ phydm_fw_trace_handler_code(pDM_Odm, tmpBuf, c2hCmdLen); ++ break; ++ ++ case PHYDM_C2H_EXTEND: ++ Extend_c2hSubID= tmpBuf[0]; ++ if (Extend_c2hSubID == PHYDM_EXTEND_C2H_DBG_PRINT) ++ phydm_fw_trace_handler_8051(pDM_Odm, tmpBuf, c2hCmdLen); ++ ++ break; ++ ++ default: ++ find_c2h_cmd = FALSE; ++ break; ++ } ++ ++ return find_c2h_cmd; ++ ++} ++ ++u8Byte ++ODM_GetCurrentTime( ++ IN PDM_ODM_T pDM_Odm ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ return 0; ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ return (u8Byte)rtw_get_current_time(); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ return PlatformGetCurrentTime(); ++#endif ++} ++ ++u8Byte ++ODM_GetProgressingTime( ++ IN PDM_ODM_T pDM_Odm, ++ IN u8Byte Start_Time ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ return 0; ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ return rtw_get_passing_time_ms((u4Byte)Start_Time); ++#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ return ((PlatformGetCurrentTime() - Start_Time)>>10); ++#endif ++} ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_interface.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_interface.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_interface.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_interface.h 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,426 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ ++#ifndef __ODM_INTERFACE_H__ ++#define __ODM_INTERFACE_H__ ++ ++#define INTERFACE_VERSION "1.1" /*2015.07.29 YuChen*/ ++ ++// ++// =========== Constant/Structure/Enum/... Define ++// ++ ++ ++ ++// ++// =========== Macro Define ++// ++ ++#define _reg_all(_name) ODM_##_name ++#define _reg_ic(_name, _ic) ODM_##_name##_ic ++#define _bit_all(_name) BIT_##_name ++#define _bit_ic(_name, _ic) BIT_##_name##_ic ++ ++// _cat: implemented by Token-Pasting Operator. ++#if 0 ++#define _cat(_name, _ic_type, _func) \ ++ ( \ ++ _func##_all(_name) \ ++ ) ++#endif ++ ++/*=================================== ++ ++#define ODM_REG_DIG_11N 0xC50 ++#define ODM_REG_DIG_11AC 0xDDD ++ ++ODM_REG(DIG,_pDM_Odm) ++=====================================*/ ++ ++#define _reg_11N(_name) ODM_REG_##_name##_11N ++#define _reg_11AC(_name) ODM_REG_##_name##_11AC ++#define _bit_11N(_name) ODM_BIT_##_name##_11N ++#define _bit_11AC(_name) ODM_BIT_##_name##_11AC ++ ++#ifdef __ECOS ++#define _rtk_cat(_name, _ic_type, _func) \ ++ ( \ ++ ((_ic_type) & ODM_IC_11N_SERIES)? _func##_11N(_name): \ ++ _func##_11AC(_name) \ ++ ) ++#else ++ ++#define _cat(_name, _ic_type, _func) \ ++ ( \ ++ ((_ic_type) & ODM_IC_11N_SERIES)? _func##_11N(_name): \ ++ _func##_11AC(_name) \ ++ ) ++#endif ++/* ++// only sample code ++//#define _cat(_name, _ic_type, _func) \ ++// ( \ ++// ((_ic_type) & ODM_RTL8188E)? _func##_ic(_name, _8188E): \ ++// _func##_ic(_name, _8195) \ ++// ) ++*/ ++ ++// _name: name of register or bit. ++// Example: "ODM_REG(R_A_AGC_CORE1, pDM_Odm)" ++// gets "ODM_R_A_AGC_CORE1" or "ODM_R_A_AGC_CORE1_8192C", depends on SupportICType. ++#ifdef __ECOS ++#define ODM_REG(_name, _pDM_Odm) _rtk_cat(_name, _pDM_Odm->SupportICType, _reg) ++#define ODM_BIT(_name, _pDM_Odm) _rtk_cat(_name, _pDM_Odm->SupportICType, _bit) ++#else ++#define ODM_REG(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _reg) ++#define ODM_BIT(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _bit) ++#endif ++typedef enum _PHYDM_H2C_CMD { ++ PHYDM_H2C_TXBF = 0x41, ++ ODM_H2C_RSSI_REPORT = 0x42, ++ ODM_H2C_IQ_CALIBRATION = 0x45, ++ ODM_H2C_RA_PARA_ADJUST = 0x47, ++ PHYDM_H2C_DYNAMIC_TX_PATH = 0x48, ++ PHYDM_H2C_FW_TRACE_EN = 0x49, ++ ODM_H2C_WIFI_CALIBRATION = 0x6d, ++ PHYDM_H2C_MU = 0x4a, ++ ODM_MAX_H2CCMD ++}PHYDM_H2C_CMD; ++ ++typedef enum _PHYDM_C2H_EVT { ++ PHYDM_C2H_DBG = 0, ++ PHYDM_C2H_LB = 1, ++ PHYDM_C2H_XBF = 2, ++ PHYDM_C2H_TX_REPORT = 3, ++ PHYDM_C2H_INFO = 9, ++ PHYDM_C2H_BT_MP = 11, ++ PHYDM_C2H_RA_RPT = 12, ++ PHYDM_C2H_RA_PARA_RPT=14, ++ PHYDM_C2H_DYNAMIC_TX_PATH_RPT = 15, ++ PHYDM_C2H_IQK_FINISH = 17, /*0x11*/ ++ PHYDM_C2H_DBG_CODE = 0xFE, ++ PHYDM_C2H_EXTEND = 0xFF, ++}PHYDM_C2H_EVT; ++ ++typedef enum _PHYDM_EXTEND_C2H_EVT { ++ PHYDM_EXTEND_C2H_DBG_PRINT = 0 ++ ++}PHYDM_EXTEND_C2H_EVT; ++ ++ ++// ++// 2012/02/17 MH For non-MP compile pass only. Linux does not support workitem. ++// Suggest HW team to use thread instead of workitem. Windows also support the feature. ++// ++#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) ++typedef void *PRT_WORK_ITEM ; ++typedef void RT_WORKITEM_HANDLE,*PRT_WORKITEM_HANDLE; ++typedef VOID (*RT_WORKITEM_CALL_BACK)(PVOID pContext); ++ ++#if 0 ++typedef struct tasklet_struct RT_WORKITEM_HANDLE, *PRT_WORKITEM_HANDLE; ++ ++typedef struct _RT_WORK_ITEM ++{ ++ ++ RT_WORKITEM_HANDLE Handle; // Platform-dependent handle for this workitem, e.g. Ndis Workitem object. ++ PVOID Adapter; // Pointer to Adapter object. ++ PVOID pContext; // Parameter to passed to CallBackFunc(). ++ RT_WORKITEM_CALL_BACK CallbackFunc; // Callback function of the workitem. ++ u1Byte RefCount; // 0: driver is going to unload, 1: No such workitem scheduled, 2: one workitem is schedueled. ++ PVOID pPlatformExt; // Pointer to platform-dependent extension. ++ BOOLEAN bFree; ++ char szID[36]; // An identity string of this workitem. ++}RT_WORK_ITEM, *PRT_WORK_ITEM; ++ ++#endif ++ ++ ++#endif ++ ++// ++// =========== Extern Variable ??? It should be forbidden. ++// ++ ++ ++// ++// =========== EXtern Function Prototype ++// ++ ++ ++u1Byte ++ODM_Read1Byte( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr ++ ); ++ ++u2Byte ++ODM_Read2Byte( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr ++ ); ++ ++u4Byte ++ODM_Read4Byte( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr ++ ); ++ ++VOID ++ODM_Write1Byte( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u1Byte Data ++ ); ++ ++VOID ++ODM_Write2Byte( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u2Byte Data ++ ); ++ ++VOID ++ODM_Write4Byte( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u4Byte Data ++ ); ++ ++VOID ++ODM_SetMACReg( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask, ++ IN u4Byte Data ++ ); ++ ++u4Byte ++ODM_GetMACReg( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask ++ ); ++ ++VOID ++ODM_SetBBReg( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask, ++ IN u4Byte Data ++ ); ++ ++u4Byte ++ODM_GetBBReg( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask ++ ); ++ ++VOID ++ODM_SetRFReg( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_RF_RADIO_PATH_E eRFPath, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask, ++ IN u4Byte Data ++ ); ++ ++u4Byte ++ODM_GetRFReg( ++ IN PDM_ODM_T pDM_Odm, ++ IN ODM_RF_RADIO_PATH_E eRFPath, ++ IN u4Byte RegAddr, ++ IN u4Byte BitMask ++ ); ++ ++ ++// ++// Memory Relative Function. ++// ++VOID ++ODM_AllocateMemory( ++ IN PDM_ODM_T pDM_Odm, ++ OUT PVOID *pPtr, ++ IN u4Byte length ++ ); ++VOID ++ODM_FreeMemory( ++ IN PDM_ODM_T pDM_Odm, ++ OUT PVOID pPtr, ++ IN u4Byte length ++ ); ++ ++VOID ++ODM_MoveMemory( ++ IN PDM_ODM_T pDM_Odm, ++ OUT PVOID pDest, ++ IN PVOID pSrc, ++ IN u4Byte Length ++ ); ++ ++s4Byte ODM_CompareMemory( ++ IN PDM_ODM_T pDM_Odm, ++ IN PVOID pBuf1, ++ IN PVOID pBuf2, ++ IN u4Byte length ++ ); ++ ++void ODM_Memory_Set ++ (IN PDM_ODM_T pDM_Odm, ++ IN PVOID pbuf, ++ IN s1Byte value, ++ IN u4Byte length); ++ ++// ++// ODM MISC-spin lock relative API. ++// ++VOID ++ODM_AcquireSpinLock( ++ IN PDM_ODM_T pDM_Odm, ++ IN RT_SPINLOCK_TYPE type ++ ); ++ ++VOID ++ODM_ReleaseSpinLock( ++ IN PDM_ODM_T pDM_Odm, ++ IN RT_SPINLOCK_TYPE type ++ ); ++ ++ ++// ++// ODM MISC-workitem relative API. ++// ++VOID ++ODM_InitializeWorkItem( ++ IN PDM_ODM_T pDM_Odm, ++ IN PRT_WORK_ITEM pRtWorkItem, ++ IN RT_WORKITEM_CALL_BACK RtWorkItemCallback, ++ IN PVOID pContext, ++ IN const char* szID ++ ); ++ ++VOID ++ODM_StartWorkItem( ++ IN PRT_WORK_ITEM pRtWorkItem ++ ); ++ ++VOID ++ODM_StopWorkItem( ++ IN PRT_WORK_ITEM pRtWorkItem ++ ); ++ ++VOID ++ODM_FreeWorkItem( ++ IN PRT_WORK_ITEM pRtWorkItem ++ ); ++ ++VOID ++ODM_ScheduleWorkItem( ++ IN PRT_WORK_ITEM pRtWorkItem ++ ); ++ ++VOID ++ODM_IsWorkItemScheduled( ++ IN PRT_WORK_ITEM pRtWorkItem ++ ); ++ ++// ++// ODM Timer relative API. ++// ++VOID ++ODM_StallExecution( ++ IN u4Byte usDelay ++ ); ++ ++VOID ++ODM_delay_ms(IN u4Byte ms); ++ ++ ++ ++VOID ++ODM_delay_us(IN u4Byte us); ++ ++VOID ++ODM_sleep_ms(IN u4Byte ms); ++ ++VOID ++ODM_sleep_us(IN u4Byte us); ++ ++VOID ++ODM_SetTimer( ++ IN PDM_ODM_T pDM_Odm, ++ IN PRT_TIMER pTimer, ++ IN u4Byte msDelay ++ ); ++ ++VOID ++ODM_InitializeTimer( ++ IN PDM_ODM_T pDM_Odm, ++ IN PRT_TIMER pTimer, ++ IN RT_TIMER_CALL_BACK CallBackFunc, ++ IN PVOID pContext, ++ IN const char* szID ++ ); ++ ++VOID ++ODM_CancelTimer( ++ IN PDM_ODM_T pDM_Odm, ++ IN PRT_TIMER pTimer ++ ); ++ ++VOID ++ODM_ReleaseTimer( ++ IN PDM_ODM_T pDM_Odm, ++ IN PRT_TIMER pTimer ++ ); ++ ++// ++// ODM FW relative API. ++// ++VOID ++ODM_FillH2CCmd( ++ IN PDM_ODM_T pDM_Odm, ++ IN u1Byte ElementID, ++ IN u4Byte CmdLen, ++ IN pu1Byte pCmdBuffer ++); ++ ++u1Byte ++phydm_c2H_content_parsing( ++ IN PVOID pDM_VOID, ++ IN u1Byte c2hCmdId, ++ IN u1Byte c2hCmdLen, ++ IN pu1Byte tmpBuf ++); ++ ++u8Byte ++ODM_GetCurrentTime( ++ IN PDM_ODM_T pDM_Odm ++ ); ++u8Byte ++ODM_GetProgressingTime( ++ IN PDM_ODM_T pDM_Odm, ++ IN u8Byte Start_Time ++ ); ++ ++#endif // __ODM_INTERFACE_H__ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_iqk.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_iqk.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_iqk.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_iqk.h 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,61 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMIQK_H__ ++#define __PHYDMIQK_H__ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++#define LOK_delay 1 ++#define WBIQK_delay 10 ++#define TX_IQK 0 ++#define RX_IQK 1 ++#define TXIQK 0 ++#define RXIQK1 1 ++#define RXIQK2 2 ++ ++#define NUM 4 ++/*---------------------------End Define Parameters-------------------------------*/ ++ ++typedef struct _IQK_INFORMATION { ++ BOOLEAN LOK_fail[NUM]; ++ BOOLEAN IQK_fail[2][NUM]; ++ u4Byte IQC_Matrix[2][NUM]; ++ u1Byte IQKtimes; ++ u4Byte RFReg18; ++ u4Byte lna_idx; ++ u1Byte rxiqk_step; ++ u1Byte tmp1bcc; ++ ++ u4Byte IQK_Channel[2]; ++ BOOLEAN IQK_fail_report[2][4][2]; /*channel/path/TRX(TX:0, RX:1)*/ ++ u4Byte IQK_CFIR_real[2][4][2][8]; /*channel / path / TRX(TX:0, RX:1) / CFIR_real*/ ++ u4Byte IQK_CFIR_imag[2][4][2][8]; /*channel / path / TRX(TX:0, RX:1) / CFIR_imag*/ ++ u1Byte retry_count[2][4][3]; /*channel / path / (TXK:0, RXK1:1, RXK2:2)*/ ++ u1Byte gs_retry_count[2][4][2]; /*channel / path / (GSRXK1:0, GSRXK2:1)*/ ++ u1Byte RXIQK_fail_code[2][4]; /*channel / path 0:SRXK1 fail, 1:RXK1 fail 2:RXK2 fail*/ ++ u4Byte LOK_IDAC[2][4]; /*channel / path*/ ++ u4Byte RXIQK_AGC[2][4]; /*channel / path*/ ++ u4Byte bypassIQK[2][4]; /*channel / 0xc94/0xe94*/ ++ u4Byte tmp_GNTWL; ++ BOOLEAN is_BTG; ++ ++} IQK_INFO, *PIQK_INFO; ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_kfree.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_kfree.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_kfree.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_kfree.c 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,191 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++/*============================================================*/ ++/*include files*/ ++/*============================================================*/ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++ ++/* Add for KFree Feature Requested by RF David.*/ ++/*This is a phydm API*/ ++ ++VOID ++phydm_SetKfreeToRF_8814A( ++ IN PVOID pDM_VOID, ++ IN u1Byte eRFPath, ++ IN u1Byte Data ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ BOOLEAN bOdd; ++ ++ if ((Data%2) != 0) { /*odd -> positive*/ ++ Data = Data - 1; ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT19, 1); ++ bOdd = TRUE; ++ } else { /*even -> negative*/ ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT19, 0); ++ bOdd = FALSE; ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): RF_0x55[19]= %d\n", bOdd)); ++ switch (Data) { ++ case 0: ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 0); ++ pRFCalibrateInfo->KfreeOffset[eRFPath] = 0; ++ break; ++ case 2: ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 0); ++ pRFCalibrateInfo->KfreeOffset[eRFPath] = 0; ++ break; ++ case 4: ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 1); ++ pRFCalibrateInfo->KfreeOffset[eRFPath] = 1; ++ break; ++ case 6: ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 1); ++ pRFCalibrateInfo->KfreeOffset[eRFPath] = 1; ++ break; ++ case 8: ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 2); ++ pRFCalibrateInfo->KfreeOffset[eRFPath] = 2; ++ break; ++ case 10: ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 2); ++ pRFCalibrateInfo->KfreeOffset[eRFPath] = 2; ++ break; ++ case 12: ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 3); ++ pRFCalibrateInfo->KfreeOffset[eRFPath] = 3; ++ break; ++ case 14: ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 3); ++ pRFCalibrateInfo->KfreeOffset[eRFPath] = 3; ++ break; ++ case 16: ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 4); ++ pRFCalibrateInfo->KfreeOffset[eRFPath] = 4; ++ break; ++ case 18: ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 4); ++ pRFCalibrateInfo->KfreeOffset[eRFPath] = 4; ++ break; ++ case 20: ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); ++ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 5); ++ pRFCalibrateInfo->KfreeOffset[eRFPath] = 5; ++ break; ++ ++ default: ++ break; ++ } ++ ++ if (bOdd == FALSE) { ++ /*that means Kfree offset is negative, we need to record it.*/ ++ pRFCalibrateInfo->KfreeOffset[eRFPath] = (-1)*pRFCalibrateInfo->KfreeOffset[eRFPath]; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): KfreeOffset = %d\n", pRFCalibrateInfo->KfreeOffset[eRFPath])); ++ } else ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): KfreeOffset = %d\n", pRFCalibrateInfo->KfreeOffset[eRFPath])); ++ ++} ++ ++ ++VOID ++phydm_SetKfreeToRF( ++ IN PVOID pDM_VOID, ++ IN u1Byte eRFPath, ++ IN u1Byte Data ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ phydm_SetKfreeToRF_8814A(pDM_Odm, eRFPath, Data); ++} ++ ++VOID ++phydm_ConfigKFree( ++ IN PVOID pDM_VOID, ++ IN u1Byte channelToSW, ++ IN pu1Byte kfreeTable ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ u1Byte rfpath = 0, maxRFpath = 0; ++ u1Byte channelIdx = 0; ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ maxRFpath = 4; /*0~3*/ ++ else if (pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8192E | ODM_RTL8822B)) ++ maxRFpath = 2; /*0~1*/ ++ else ++ maxRFpath = 1; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("===>phy_ConfigKFree8814A()\n")); ++ ++ if (pRFCalibrateInfo->RegRfKFreeEnable == 2) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): RegRfKFreeEnable == 2, Disable\n")); ++ return; ++ } else if (pRFCalibrateInfo->RegRfKFreeEnable == 1 || pRFCalibrateInfo->RegRfKFreeEnable == 0) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): RegRfKFreeEnable == TRUE\n")); ++ /*Make sure the targetval is defined*/ ++ if (((pRFCalibrateInfo->RegRfKFreeEnable == 1) && (kfreeTable[0] != 0xFF)) || (pRFCalibrateInfo->RfKFreeEnable == TRUE)) { ++ /*if kfreeTable[0] == 0xff, means no Kfree*/ ++ if (*pDM_Odm->pBandType == ODM_BAND_2_4G) { ++ if (channelToSW <= 14 && channelToSW >= 1) ++ channelIdx = PHYDM_2G; ++ } else if (*pDM_Odm->pBandType == ODM_BAND_5G) { ++ if (channelToSW >= 36 && channelToSW <= 48) ++ channelIdx = PHYDM_5GLB1; ++ if (channelToSW >= 52 && channelToSW <= 64) ++ channelIdx = PHYDM_5GLB2; ++ if (channelToSW >= 100 && channelToSW <= 120) ++ channelIdx = PHYDM_5GMB1; ++ if (channelToSW >= 124 && channelToSW <= 144) ++ channelIdx = PHYDM_5GMB2; ++ if (channelToSW >= 149 && channelToSW <= 177) ++ channelIdx = PHYDM_5GHB; ++ } ++ ++ for (rfpath = ODM_RF_PATH_A; rfpath < maxRFpath; rfpath++) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phydm_kfree(): PATH_%d: %#x\n", rfpath, kfreeTable[channelIdx*maxRFpath + rfpath])); ++ phydm_SetKfreeToRF(pDM_Odm, rfpath, kfreeTable[channelIdx*maxRFpath + rfpath]); ++ } ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): targetval not defined, Don't execute KFree Process.\n")); ++ return; ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("<===phy_ConfigKFree8814A()\n")); ++} ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_kfree.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_kfree.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_kfree.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_kfree.h 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,45 @@ ++ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMKFREE_H__ ++#define __PHYDKFREE_H__ ++ ++#define KFREE_VERSION "1.0" ++ ++typedef enum tag_phydm_kfree_channeltosw { ++ PHYDM_2G = 0, ++ PHYDM_5GLB1 = 1, ++ PHYDM_5GLB2 = 2, ++ PHYDM_5GMB1 = 3, ++ PHYDM_5GMB2 = 4, ++ PHYDM_5GHB = 5, ++} PHYDM_KFREE_CHANNELTOSW; ++ ++ ++VOID ++phydm_ConfigKFree( ++ IN PVOID pDM_VOID, ++ IN u1Byte channelToSW, ++ IN pu1Byte kfreeTable ++); ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.c 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,305 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++#include "phydm_noisemonitor.h" ++ ++//================================================= ++// This function is for inband noise test utility only ++// To obtain the inband noise level(dbm), do the following. ++// 1. disable DIG and Power Saving ++// 2. Set initial gain = 0x1a ++// 3. Stop updating idle time pwer report (for driver read) ++// - 0x80c[25] ++// ++//================================================= ++ ++#define Valid_Min -35 ++#define Valid_Max 10 ++#define ValidCnt 5 ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) ++ ++s2Byte odm_InbandNoise_Monitor_NSeries(PDM_ODM_T pDM_Odm,u8 bPauseDIG,u8 IGIValue,u32 max_time) ++{ ++ u4Byte tmp4b; ++ u1Byte max_rf_path=0,rf_path; ++ u1Byte reg_c50, reg_c58,valid_done=0; ++ struct noise_level noise_data; ++ u8Byte start = 0, func_start = 0, func_end = 0; ++ ++ func_start = ODM_GetCurrentTime(pDM_Odm); ++ pDM_Odm->noise_level.noise_all = 0; ++ ++ if((pDM_Odm->RFType == ODM_1T2R) ||(pDM_Odm->RFType == ODM_2T2R)) ++ max_rf_path = 2; ++ else ++ max_rf_path = 1; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("odm_DebugControlInbandNoise_Nseries() ==> \n")); ++ ++ ODM_Memory_Set(pDM_Odm,&noise_data,0,sizeof(struct noise_level)); ++ ++ // ++ // Step 1. Disable DIG && Set initial gain. ++ // ++ ++ if(bPauseDIG) ++ { ++ odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, IGIValue); ++ } ++ // ++ // Step 2. Disable all power save for read registers ++ // ++ //dcmd_DebugControlPowerSave(pAdapter, PSDisable); ++ ++ // ++ // Step 3. Get noise power level ++ // ++ start = ODM_GetCurrentTime(pDM_Odm); ++ while(1) ++ { ++ ++ //Stop updating idle time pwer report (for driver read) ++ ODM_SetBBReg(pDM_Odm, rFPGA0_TxGainStage, BIT25, 1); ++ ++ //Read Noise Floor Report ++ tmp4b = ODM_GetBBReg(pDM_Odm, 0x8f8,bMaskDWord ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("Noise Floor Report (0x8f8) = 0x%08x\n", tmp4b)); ++ ++ //ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0, TestInitialGain); ++ //if(max_rf_path == 2) ++ // ODM_SetBBReg(pDM_Odm, rOFDM0_XBAGCCore1, bMaskByte0, TestInitialGain); ++ ++ //update idle time pwer report per 5us ++ ODM_SetBBReg(pDM_Odm, rFPGA0_TxGainStage, BIT25, 0); ++ ++ noise_data.value[ODM_RF_PATH_A] = (u1Byte)(tmp4b&0xff); ++ noise_data.value[ODM_RF_PATH_B] = (u1Byte)((tmp4b&0xff00)>>8); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("value_a = 0x%x(%d), value_b = 0x%x(%d)\n", ++ noise_data.value[ODM_RF_PATH_A], noise_data.value[ODM_RF_PATH_A], noise_data.value[ODM_RF_PATH_B], noise_data.value[ODM_RF_PATH_B])); ++ ++ for(rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) ++ { ++ noise_data.sval[rf_path] = (s1Byte)noise_data.value[rf_path]; ++ noise_data.sval[rf_path] /= 2; ++ } ++ ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("sval_a = %d, sval_b = %d\n", ++ noise_data.sval[ODM_RF_PATH_A], noise_data.sval[ODM_RF_PATH_B])); ++ //ODM_delay_ms(10); ++ //ODM_sleep_ms(10); ++ ++ for(rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) ++ { ++ if( (noise_data.valid_cnt[rf_path] < ValidCnt) && (noise_data.sval[rf_path] < Valid_Max && noise_data.sval[rf_path] >= Valid_Min)) ++ { ++ noise_data.valid_cnt[rf_path]++; ++ noise_data.sum[rf_path] += noise_data.sval[rf_path]; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("RF_Path:%d Valid sval = %d\n", rf_path,noise_data.sval[rf_path])); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("Sum of sval = %d, \n", noise_data.sum[rf_path])); ++ if(noise_data.valid_cnt[rf_path] == ValidCnt) ++ { ++ valid_done++; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("After divided, RF_Path:%d ,sum = %d \n", rf_path,noise_data.sum[rf_path])); ++ } ++ ++ } ++ ++ } ++ ++ //printk("####### valid_done:%d #############\n",valid_done); ++ if ((valid_done==max_rf_path) || (ODM_GetProgressingTime(pDM_Odm,start) > max_time)) ++ { ++ for(rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) ++ { ++ //printk("%s PATH_%d - sum = %d, valid_cnt = %d \n",__FUNCTION__,rf_path,noise_data.sum[rf_path], noise_data.valid_cnt[rf_path]); ++ if(noise_data.valid_cnt[rf_path]) ++ noise_data.sum[rf_path] /= noise_data.valid_cnt[rf_path]; ++ else ++ noise_data.sum[rf_path] = 0; ++ } ++ break; ++ } ++ } ++ reg_c50 = (u1Byte)ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0); ++ reg_c50 &= ~BIT7; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("0x%x = 0x%02x(%d)\n", rOFDM0_XAAGCCore1, reg_c50, reg_c50)); ++ pDM_Odm->noise_level.noise[ODM_RF_PATH_A] = (u1Byte)(-110 + reg_c50 + noise_data.sum[ODM_RF_PATH_A]); ++ pDM_Odm->noise_level.noise_all += pDM_Odm->noise_level.noise[ODM_RF_PATH_A]; ++ ++ if(max_rf_path == 2){ ++ reg_c58 = (u1Byte)ODM_GetBBReg(pDM_Odm, rOFDM0_XBAGCCore1, bMaskByte0); ++ reg_c58 &= ~BIT7; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("0x%x = 0x%02x(%d)\n", rOFDM0_XBAGCCore1, reg_c58, reg_c58)); ++ pDM_Odm->noise_level.noise[ODM_RF_PATH_B] = (u1Byte)(-110 + reg_c58 + noise_data.sum[ODM_RF_PATH_B]); ++ pDM_Odm->noise_level.noise_all += pDM_Odm->noise_level.noise[ODM_RF_PATH_B]; ++ } ++ pDM_Odm->noise_level.noise_all /= max_rf_path; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("noise_a = %d, noise_b = %d\n", ++ pDM_Odm->noise_level.noise[ODM_RF_PATH_A], ++ pDM_Odm->noise_level.noise[ODM_RF_PATH_B])); ++ ++ // ++ // Step 4. Recover the Dig ++ // ++ if(bPauseDIG) ++ { ++ odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, IGIValue); ++ } ++ func_end = ODM_GetProgressingTime(pDM_Odm,func_start) ; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_DebugControlInbandNoise_Nseries() <==\n")); ++ return pDM_Odm->noise_level.noise_all; ++ ++} ++ ++s2Byte ++odm_InbandNoise_Monitor_ACSeries(PDM_ODM_T pDM_Odm, u8 bPauseDIG, u8 IGIValue, u32 max_time ++ ) ++{ ++ s4Byte rxi_buf_anta, rxq_buf_anta; /*rxi_buf_antb, rxq_buf_antb;*/ ++ s4Byte value32, pwdb_A = 0, sval, noise, sum; ++ BOOLEAN pd_flag; ++ u1Byte i, valid_cnt; ++ u8Byte start = 0, func_start = 0, func_end = 0; ++ ++ ++ if (!(pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8814A))) ++ return 0; ++ ++ func_start = ODM_GetCurrentTime(pDM_Odm); ++ pDM_Odm->noise_level.noise_all = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_InbandNoise_Monitor_ACSeries() ==>\n")); ++ ++ /* Step 1. Disable DIG && Set initial gain. */ ++ if (bPauseDIG) ++ odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, IGIValue); ++ ++ /* Step 2. Disable all power save for read registers */ ++ /*dcmd_DebugControlPowerSave(pAdapter, PSDisable); */ ++ ++ /* Step 3. Get noise power level */ ++ start = ODM_GetCurrentTime(pDM_Odm); ++ ++ /* reset counters */ ++ sum = 0; ++ valid_cnt = 0; ++ ++ /* Step 3. Get noise power level */ ++ while (1) { ++ /*Set IGI=0x1C */ ++ ODM_Write_DIG(pDM_Odm, 0x1C); ++ /*stop CK320&CK88 */ ++ ODM_SetBBReg(pDM_Odm, 0x8B4, BIT6, 1); ++ /*Read Path-A */ ++ ODM_SetBBReg(pDM_Odm, 0x8FC, bMaskDWord, 0x200); /*set debug port*/ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xFA0, bMaskDWord); /*read debug port*/ ++ ++ rxi_buf_anta = (value32 & 0xFFC00) >> 10; /*rxi_buf_anta=RegFA0[19:10]*/ ++ rxq_buf_anta = value32 & 0x3FF; /*rxq_buf_anta=RegFA0[19:10]*/ ++ ++ pd_flag = (BOOLEAN) ((value32 & BIT31) >> 31); ++ ++ /*Not in packet detection period or Tx state */ ++ if ((!pd_flag) || (rxi_buf_anta != 0x200)) { ++ /*sign conversion*/ ++ rxi_buf_anta = ODM_SignConversion(rxi_buf_anta, 10); ++ rxq_buf_anta = ODM_SignConversion(rxq_buf_anta, 10); ++ ++ pwdb_A = ODM_PWdB_Conversion(rxi_buf_anta * rxi_buf_anta + rxq_buf_anta * rxq_buf_anta, 20, 18); /*S(10,9)*S(10,9)=S(20,18)*/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("pwdb_A= %d dB, rxi_buf_anta= 0x%x, rxq_buf_anta= 0x%x\n", pwdb_A, rxi_buf_anta & 0x3FF, rxq_buf_anta & 0x3FF)); ++ } ++ /*Start CK320&CK88*/ ++ ODM_SetBBReg(pDM_Odm, 0x8B4, BIT6, 0); ++ /*BB Reset*/ ++ ODM_Write1Byte(pDM_Odm, 0x02, ODM_Read1Byte(pDM_Odm, 0x02) & (~BIT0)); ++ ODM_Write1Byte(pDM_Odm, 0x02, ODM_Read1Byte(pDM_Odm, 0x02) | BIT0); ++ /*PMAC Reset*/ ++ ODM_Write1Byte(pDM_Odm, 0xB03, ODM_Read1Byte(pDM_Odm, 0xB03) & (~BIT0)); ++ ODM_Write1Byte(pDM_Odm, 0xB03, ODM_Read1Byte(pDM_Odm, 0xB03) | BIT0); ++ /*CCK Reset*/ ++ if (ODM_Read1Byte(pDM_Odm, 0x80B) & BIT4) { ++ ODM_Write1Byte(pDM_Odm, 0x80B, ODM_Read1Byte(pDM_Odm, 0x80B) & (~BIT4)); ++ ODM_Write1Byte(pDM_Odm, 0x80B, ODM_Read1Byte(pDM_Odm, 0x80B) | BIT4); ++ } ++ ++ sval = pwdb_A; ++ ++ if (sval < 0 && sval >= -27) { ++ if (valid_cnt < ValidCnt) { ++ valid_cnt++; ++ sum += sval; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Valid sval = %d\n", sval)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Sum of sval = %d,\n", sum)); ++ if ((valid_cnt >= ValidCnt) || (ODM_GetProgressingTime(pDM_Odm, start) > max_time)) { ++ sum /= valid_cnt; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("After divided, sum = %d\n", sum)); ++ break; ++ } ++ } ++ } ++ } ++ ++ /*ADC backoff is 12dB,*/ ++ /*Ptarget=0x1C-110=-82dBm*/ ++ noise = sum + 12 + 0x1C - 110; ++ ++ /*Offset*/ ++ noise = noise - 3; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("noise = %d\n", noise)); ++ pDM_Odm->noise_level.noise_all = (s2Byte)noise; ++ ++ /* Step 4. Recover the Dig*/ ++ if (bPauseDIG) ++ odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, IGIValue); ++ ++ func_end = ODM_GetProgressingTime(pDM_Odm, func_start); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_InbandNoise_Monitor_ACSeries() <==\n")); ++ ++ return pDM_Odm->noise_level.noise_all; ++} ++ ++ ++ ++s2Byte ++ODM_InbandNoise_Monitor(PVOID pDM_VOID, u8 bPauseDIG, u8 IGIValue, u32 max_time) ++{ ++ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ return odm_InbandNoise_Monitor_ACSeries(pDM_Odm, bPauseDIG, IGIValue, max_time); ++ else ++ return odm_InbandNoise_Monitor_NSeries(pDM_Odm, bPauseDIG, IGIValue, max_time); ++} ++ ++#endif ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.h 2018-02-11 21:44:27.156146223 +0200 +@@ -0,0 +1,49 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ *****************************************************************************/ ++#ifndef __ODMNOISEMONITOR_H__ ++#define __ODMNOISEMONITOR_H__ ++ ++#define ODM_MAX_CHANNEL_NUM 38//14+24 ++struct noise_level ++{ ++ //u1Byte value_a, value_b; ++ u1Byte value[MAX_RF_PATH]; ++ //s1Byte sval_a, sval_b; ++ s1Byte sval[MAX_RF_PATH]; ++ ++ //s4Byte noise_a=0, noise_b=0,sum_a=0, sum_b=0; ++ //s4Byte noise[ODM_RF_PATH_MAX]; ++ s4Byte sum[MAX_RF_PATH]; ++ //u1Byte valid_cnt_a=0, valid_cnt_b=0, ++ u1Byte valid[MAX_RF_PATH]; ++ u1Byte valid_cnt[MAX_RF_PATH]; ++ ++}; ++ ++ ++typedef struct _ODM_NOISE_MONITOR_ ++{ ++ s1Byte noise[MAX_RF_PATH]; ++ s2Byte noise_all; ++}ODM_NOISE_MONITOR; ++ ++s2Byte ODM_InbandNoise_Monitor(PVOID pDM_VOID,u8 bPauseDIG,u8 IGIValue,u32 max_time); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.c 2018-02-11 21:44:27.157146238 +0200 +@@ -0,0 +1,810 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++#if(defined(CONFIG_PATH_DIVERSITY)) ++#if RTL8814A_SUPPORT ++ ++VOID ++phydm_dtp_fix_tx_path( ++ IN PVOID pDM_VOID, ++ IN u1Byte path ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; ++ u1Byte i,num_enable_path=0; ++ ++ if(path==pDM_PathDiv->pre_tx_path) ++ { ++ return; ++ } ++ else ++ { ++ pDM_PathDiv->pre_tx_path=path; ++ } ++ ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT18|BIT19, 3); ++ ++ for(i=0; i<4; i++) ++ { ++ if(path&BIT(i)) ++ num_enable_path++; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Number of trun-on path : (( %d ))\n", num_enable_path)); ++ ++ if(num_enable_path == 1) ++ { ++ ODM_SetBBReg( pDM_Odm, 0x93c, 0xf00000, path); ++ ++ if(path==PHYDM_A)//1-1 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A ))\n")); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); ++ } ++ else if(path==PHYDM_B)//1-2 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B ))\n")); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); ++ } ++ else if(path==PHYDM_C)//1-3 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( C ))\n")); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 0); ++ ++ } ++ else if(path==PHYDM_D)//1-4 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( D ))\n")); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 0); ++ } ++ ++ } ++ else if(num_enable_path == 2) ++ { ++ ODM_SetBBReg( pDM_Odm, 0x93c, 0xf00000, path); ++ ODM_SetBBReg( pDM_Odm, 0x940, 0xf0, path); ++ ++ if(path==PHYDM_AB)//2-1 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B ))\n")); ++ //set for 1ss ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 1); ++ //set for 2ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 1); ++ } ++ else if(path==PHYDM_AC)//2-2 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A C ))\n")); ++ //set for 1ss ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); ++ //set for 2ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); ++ } ++ else if(path==PHYDM_AD)//2-3 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A D ))\n")); ++ //set for 1ss ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 1); ++ //set for 2ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 1); ++ } ++ else if(path==PHYDM_BC)//2-4 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B C ))\n")); ++ //set for 1ss ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); ++ //set for 2ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); ++ } ++ else if(path==PHYDM_BD)//2-5 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B D ))\n")); ++ //set for 1ss ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 1); ++ //set for 2ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 1); ++ } ++ else if(path==PHYDM_CD)//2-6 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( C D ))\n")); ++ //set for 1ss ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 0); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 1); ++ //set for 2ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 1); ++ } ++ ++ } ++ else if(num_enable_path == 3) ++ { ++ ODM_SetBBReg( pDM_Odm, 0x93c, 0xf00000, path); ++ ODM_SetBBReg( pDM_Odm, 0x940, 0xf0, path); ++ ODM_SetBBReg( pDM_Odm, 0x940, 0xf0000, path); ++ ++ if(path==PHYDM_ABC)//3-1 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B C))\n")); ++ //set for 1ss ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 1); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 2); ++ //set for 2ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 1); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 2); ++ //set for 3ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT21|BIT20, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT23|BIT22, 1); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT25|BIT24, 2); ++ } ++ else if(path==PHYDM_ABD)//3-2 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B D ))\n")); ++ //set for 1ss ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 1); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 2); ++ //set for 2ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 1); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 2); ++ //set for 3ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT21|BIT20, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT23|BIT22, 1); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT27|BIT26, 2); ++ ++ } ++ else if(path==PHYDM_ACD)//3-3 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A C D ))\n")); ++ //set for 1ss ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 2); ++ //set for 2ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 2); ++ //set for 3ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT21|BIT20, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT25|BIT24, 1); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT27|BIT26, 2); ++ } ++ else if(path==PHYDM_BCD)//3-4 ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B C D))\n")); ++ //set for 1ss ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); ++ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 2); ++ //set for 2ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 2); ++ //set for 3ss ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT23|BIT22, 0); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT25|BIT24, 1); ++ ODM_SetBBReg( pDM_Odm, 0x940, BIT27|BIT26, 2); ++ } ++ } ++ else if(num_enable_path == 4) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path ((A B C D))\n")); ++ } ++ ++} ++ ++VOID ++phydm_find_default_path( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; ++ u4Byte rssi_avg_a=0, rssi_avg_b=0, rssi_avg_c=0, rssi_avg_d=0, rssi_avg_bcd=0; ++ u4Byte rssi_total_a=0, rssi_total_b=0, rssi_total_c=0, rssi_total_d=0; ++ ++ //2 Default Path Selection By RSSI ++ ++ rssi_avg_a = (pDM_PathDiv->path_a_cnt_all > 0)? (pDM_PathDiv->path_a_sum_all / pDM_PathDiv->path_a_cnt_all) :0 ; ++ rssi_avg_b = (pDM_PathDiv->path_b_cnt_all > 0)? (pDM_PathDiv->path_b_sum_all / pDM_PathDiv->path_b_cnt_all) :0 ; ++ rssi_avg_c = (pDM_PathDiv->path_c_cnt_all > 0)? (pDM_PathDiv->path_c_sum_all / pDM_PathDiv->path_c_cnt_all) :0 ; ++ rssi_avg_d = (pDM_PathDiv->path_d_cnt_all > 0)? (pDM_PathDiv->path_d_sum_all / pDM_PathDiv->path_d_cnt_all) :0 ; ++ ++ ++ pDM_PathDiv->path_a_sum_all = 0; ++ pDM_PathDiv->path_a_cnt_all = 0; ++ pDM_PathDiv->path_b_sum_all = 0; ++ pDM_PathDiv->path_b_cnt_all = 0; ++ pDM_PathDiv->path_c_sum_all = 0; ++ pDM_PathDiv->path_c_cnt_all = 0; ++ pDM_PathDiv->path_d_sum_all = 0; ++ pDM_PathDiv->path_d_cnt_all = 0; ++ ++ if(pDM_PathDiv->use_path_a_as_default_ant == 1) ++ { ++ rssi_avg_bcd=(rssi_avg_b+rssi_avg_c+rssi_avg_d)/3; ++ ++ if( (rssi_avg_a + ANT_DECT_RSSI_TH) > rssi_avg_bcd ) ++ { ++ pDM_PathDiv->is_pathA_exist=TRUE; ++ pDM_PathDiv->default_path=PATH_A; ++ } ++ else ++ { ++ pDM_PathDiv->is_pathA_exist=FALSE; ++ } ++ } ++ else ++ { ++ if( (rssi_avg_a >=rssi_avg_b) && (rssi_avg_a >=rssi_avg_c)&&(rssi_avg_a >=rssi_avg_d)) ++ pDM_PathDiv->default_path=PATH_A; ++ else if( (rssi_avg_b >=rssi_avg_c)&&(rssi_avg_b >=rssi_avg_d)) ++ pDM_PathDiv->default_path=PATH_B; ++ else if( rssi_avg_c >=rssi_avg_d) ++ pDM_PathDiv->default_path=PATH_C; ++ else ++ pDM_PathDiv->default_path=PATH_D; ++ } ++ ++ ++} ++ ++ ++VOID ++phydm_candidate_dtp_update( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; ++ ++ pDM_PathDiv->num_candidate=3; ++ ++ if(pDM_PathDiv->use_path_a_as_default_ant == 1) ++ { ++ if(pDM_PathDiv->num_tx_path==3) ++ { ++ if(pDM_PathDiv->is_pathA_exist) ++ { ++ pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; ++ pDM_PathDiv->ant_candidate_2 = PHYDM_ABD; ++ pDM_PathDiv->ant_candidate_3 = PHYDM_ACD; ++ } ++ else // use path BCD ++ { ++ pDM_PathDiv->num_candidate=1; ++ phydm_dtp_fix_tx_path(pDM_Odm, PHYDM_BCD); ++ return; ++ } ++ } ++ else if(pDM_PathDiv->num_tx_path==2) ++ { ++ if(pDM_PathDiv->is_pathA_exist) ++ { ++ pDM_PathDiv->ant_candidate_1 = PHYDM_AB; ++ pDM_PathDiv->ant_candidate_2 = PHYDM_AC; ++ pDM_PathDiv->ant_candidate_3 = PHYDM_AD; ++ } ++ else ++ { ++ pDM_PathDiv->ant_candidate_1 = PHYDM_BC; ++ pDM_PathDiv->ant_candidate_2 = PHYDM_BD; ++ pDM_PathDiv->ant_candidate_3 = PHYDM_CD; ++ } ++ } ++ } ++ else ++ { ++ //2 3 TX Mode ++ if(pDM_PathDiv->num_tx_path==3)//choose 3 ant form 4 ++ { ++ if(pDM_PathDiv->default_path == PATH_A) //choose 2 ant form 3 ++ { ++ pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; ++ pDM_PathDiv->ant_candidate_2 = PHYDM_ABD; ++ pDM_PathDiv->ant_candidate_3 = PHYDM_ACD; ++ } ++ else if(pDM_PathDiv->default_path==PATH_B) ++ { ++ pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; ++ pDM_PathDiv->ant_candidate_2 = PHYDM_ABD; ++ pDM_PathDiv->ant_candidate_3 = PHYDM_BCD; ++ } ++ else if(pDM_PathDiv->default_path == PATH_C) ++ { ++ pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; ++ pDM_PathDiv->ant_candidate_2 = PHYDM_ACD; ++ pDM_PathDiv->ant_candidate_3 = PHYDM_BCD; ++ } ++ else if(pDM_PathDiv->default_path == PATH_D) ++ { ++ pDM_PathDiv->ant_candidate_1 = PHYDM_ABD; ++ pDM_PathDiv->ant_candidate_2 = PHYDM_ACD; ++ pDM_PathDiv->ant_candidate_3 = PHYDM_BCD; ++ } ++ } ++ ++ //2 2 TX Mode ++ else if(pDM_PathDiv->num_tx_path==2)//choose 2 ant form 4 ++ { ++ if(pDM_PathDiv->default_path == PATH_A) //choose 2 ant form 3 ++ { ++ pDM_PathDiv->ant_candidate_1 = PHYDM_AB; ++ pDM_PathDiv->ant_candidate_2 = PHYDM_AC; ++ pDM_PathDiv->ant_candidate_3 = PHYDM_AD; ++ } ++ else if(pDM_PathDiv->default_path==PATH_B) ++ { ++ pDM_PathDiv->ant_candidate_1 = PHYDM_AB; ++ pDM_PathDiv->ant_candidate_2 = PHYDM_BC; ++ pDM_PathDiv->ant_candidate_3 = PHYDM_BD; ++ } ++ else if(pDM_PathDiv->default_path == PATH_C) ++ { ++ pDM_PathDiv->ant_candidate_1 = PHYDM_AC; ++ pDM_PathDiv->ant_candidate_2 = PHYDM_BC; ++ pDM_PathDiv->ant_candidate_3 = PHYDM_CD; ++ } ++ else if(pDM_PathDiv->default_path == PATH_D) ++ { ++ pDM_PathDiv->ant_candidate_1= PHYDM_AD; ++ pDM_PathDiv->ant_candidate_2 = PHYDM_BD; ++ pDM_PathDiv->ant_candidate_3= PHYDM_CD; ++ } ++ } ++ } ++} ++ ++ ++VOID ++phydm_dynamic_tx_path( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; ++ ++ PSTA_INFO_T pEntry; ++ u4Byte i; ++ u1Byte num_client=0; ++ u1Byte H2C_Parameter[6] ={0}; ++ ++ ++ if(!pDM_Odm->bLinked) //bLinked==False ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("DTP_8814 [No Link!!!]\n")); ++ ++ if(pDM_PathDiv->bBecomeLinked == TRUE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" [Be disconnected]----->\n")); ++ pDM_PathDiv->bBecomeLinked = pDM_Odm->bLinked; ++ } ++ return; ++ } ++ else ++ { ++ if(pDM_PathDiv->bBecomeLinked ==FALSE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" [Be Linked !!!]----->\n")); ++ pDM_PathDiv->bBecomeLinked = pDM_Odm->bLinked; ++ } ++ } ++ ++ //2 [Period CTRL] ++ if(pDM_PathDiv->dtp_period >=2) ++ { ++ pDM_PathDiv->dtp_period=0; ++ } ++ else ++ { ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Phydm_Dynamic_Tx_Path_8814A() Stay = (( %d ))\n",pDM_PathDiv->dtp_period)); ++ pDM_PathDiv->dtp_period++; ++ return; ++ } ++ ++ ++ //2 [Fix Path] ++ if (pDM_Odm->path_select != PHYDM_AUTO_PATH) ++ { ++ return; ++ } ++ ++ //2 [Check Bfer] ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #if (BEAMFORMING_SUPPORT == 1) ++ { ++ BEAMFORMING_CAP BeamformCap = (pDM_Odm->BeamformingInfo.BeamformCap); ++ ++ if( BeamformCap & BEAMFORMER_CAP ) // BFmer On && Div On -> Div Off ++ { ++ if( pDM_PathDiv->fix_path_bfer == 0) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("[ PathDiv : OFF ] BFmer ==1 \n")); ++ pDM_PathDiv->fix_path_bfer = 1 ; ++ } ++ return; ++ } ++ else // BFmer Off && Div Off -> Div On ++ { ++ if( pDM_PathDiv->fix_path_bfer == 1 ) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("[ PathDiv : ON ] BFmer ==0 \n")); ++ pDM_PathDiv->fix_path_bfer = 0; ++ } ++ } ++ } ++ #endif ++ #endif ++ ++ if(pDM_PathDiv->use_path_a_as_default_ant ==1) ++ { ++ phydm_find_default_path(pDM_Odm); ++ phydm_candidate_dtp_update(pDM_Odm); ++ } ++ else ++ { ++ if( pDM_PathDiv->dtp_state == PHYDM_DTP_INIT) ++ { ++ phydm_find_default_path(pDM_Odm); ++ phydm_candidate_dtp_update(pDM_Odm); ++ pDM_PathDiv->dtp_state = PHYDM_DTP_RUNNING_1; ++ } ++ ++ else if( pDM_PathDiv->dtp_state == PHYDM_DTP_RUNNING_1) ++ { ++ pDM_PathDiv->dtp_check_patha_counter++; ++ ++ if(pDM_PathDiv->dtp_check_patha_counter>=NUM_RESET_DTP_PERIOD) ++ { ++ pDM_PathDiv->dtp_check_patha_counter=0; ++ pDM_PathDiv->dtp_state = PHYDM_DTP_INIT; ++ } ++ //2 Search space update ++ else ++ { ++ // 1. find the worst candidate ++ ++ ++ // 2. repalce the worst candidate ++ } ++ } ++ } ++ ++ //2 Dynamic Path Selection H2C ++ ++ if(pDM_PathDiv->num_candidate == 1) ++ { ++ return; ++ } ++ else ++ { ++ H2C_Parameter[0] = pDM_PathDiv->num_candidate; ++ H2C_Parameter[1] = pDM_PathDiv->num_tx_path; ++ H2C_Parameter[2] = pDM_PathDiv->ant_candidate_1; ++ H2C_Parameter[3] = pDM_PathDiv->ant_candidate_2; ++ H2C_Parameter[4] = pDM_PathDiv->ant_candidate_3; ++ ++ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_DYNAMIC_TX_PATH, 6, H2C_Parameter); ++ } ++ ++} ++ ++ ++ ++VOID ++phydm_dynamic_tx_path_init( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ #if ((DM_ODM_SUPPORT_TYPE == ODM_WIN) && USB_SWITCH_SUPPORT) ++ USB_MODE_MECH *pUsbModeMech = &pAdapter->UsbModeMechanism; ++ #endif ++ u1Byte search_space_2[NUM_CHOOSE2_FROM4]= {PHYDM_AB, PHYDM_AC, PHYDM_AD, PHYDM_BC, PHYDM_BD, PHYDM_CD }; ++ u1Byte search_space_3[NUM_CHOOSE3_FROM4]= {PHYDM_BCD, PHYDM_ACD, PHYDM_ABD, PHYDM_ABC}; ++ ++ #if ((DM_ODM_SUPPORT_TYPE == ODM_WIN) && USB_SWITCH_SUPPORT) ++ pDM_PathDiv->is_u3_mode = (pUsbModeMech->CurUsbMode==USB_MODE_U3)? 1 : 0 ; ++ #else ++ pDM_PathDiv->is_u3_mode = 1; ++ #endif ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Dynamic TX Path Init 8814\n")); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("is_u3_mode = (( %d ))\n", pDM_PathDiv->is_u3_mode)); ++ ++ memcpy(&(pDM_PathDiv->search_space_2[0]), &(search_space_2[0]), NUM_CHOOSE2_FROM4); ++ memcpy(&(pDM_PathDiv->search_space_3[0]), &(search_space_3[0]), NUM_CHOOSE3_FROM4); ++ ++ pDM_PathDiv->use_path_a_as_default_ant= 1; ++ pDM_PathDiv->dtp_state = PHYDM_DTP_INIT; ++ pDM_Odm->path_select = PHYDM_AUTO_PATH; ++ pDM_PathDiv->path_div_type = PHYDM_4R_PATH_DIV; ++ ++ ++ if(pDM_PathDiv->is_u3_mode ) ++ { ++ pDM_PathDiv->num_tx_path=3; ++ phydm_dtp_fix_tx_path(pDM_Odm, PHYDM_BCD);/* 3TX Set Init TX Path*/ ++ ++ } ++ else ++ { ++ pDM_PathDiv->num_tx_path=2; ++ phydm_dtp_fix_tx_path(pDM_Odm, PHYDM_BC);/* 2TX // Set Init TX Path*/ ++ } ++ ++} ++ ++ ++VOID ++phydm_process_rssi_for_path_div( ++ IN OUT PVOID pDM_VOID, ++ IN PVOID p_phy_info_void, ++ IN PVOID p_pkt_info_void ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PODM_PHY_INFO_T pPhyInfo=(PODM_PHY_INFO_T)p_phy_info_void; ++ PODM_PACKET_INFO_T pPktinfo=(PODM_PACKET_INFO_T)p_pkt_info_void; ++ pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); ++ ++ if(pPktinfo->bPacketToSelf || pPktinfo->bPacketMatchBSSID) ++ { ++ if(pPktinfo->DataRate > ODM_RATE11M) ++ { ++ if(pDM_PathDiv->path_div_type == PHYDM_4R_PATH_DIV) ++ { ++ #if RTL8814A_SUPPORT ++ if(pDM_Odm->SupportICType & ODM_RTL8814A) ++ { ++ pDM_PathDiv->path_a_sum_all+=pPhyInfo->RxMIMOSignalStrength[0]; ++ pDM_PathDiv->path_a_cnt_all++; ++ ++ pDM_PathDiv->path_b_sum_all+=pPhyInfo->RxMIMOSignalStrength[1]; ++ pDM_PathDiv->path_b_cnt_all++; ++ ++ pDM_PathDiv->path_c_sum_all+=pPhyInfo->RxMIMOSignalStrength[2]; ++ pDM_PathDiv->path_c_cnt_all++; ++ ++ pDM_PathDiv->path_d_sum_all+=pPhyInfo->RxMIMOSignalStrength[3]; ++ pDM_PathDiv->path_d_cnt_all++; ++ } ++ #endif ++ } ++ else ++ { ++ pDM_PathDiv->PathA_Sum[pPktinfo->StationID]+=pPhyInfo->RxMIMOSignalStrength[0]; ++ pDM_PathDiv->PathA_Cnt[pPktinfo->StationID]++; ++ ++ pDM_PathDiv->PathB_Sum[pPktinfo->StationID]+=pPhyInfo->RxMIMOSignalStrength[1]; ++ pDM_PathDiv->PathB_Cnt[pPktinfo->StationID]++; ++ } ++ } ++ } ++ ++ ++} ++ ++#endif //#if RTL8814A_SUPPORT ++ ++VOID ++odm_pathdiv_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ pDM_Odm->path_select = (dm_value[0] & 0xf); ++ PHYDM_SNPRINTF((output+used, out_len-used,"Path_select = (( 0x%x ))\n",pDM_Odm->path_select )); ++ ++ //2 [Fix Path] ++ if (pDM_Odm->path_select != PHYDM_AUTO_PATH) ++ { ++ PHYDM_SNPRINTF((output+used, out_len-used,"Trun on path [%s%s%s%s]\n", ++ ((pDM_Odm->path_select) & 0x1)?"A":"", ++ ((pDM_Odm->path_select) & 0x2)?"B":"", ++ ((pDM_Odm->path_select) & 0x4)?"C":"", ++ ((pDM_Odm->path_select) & 0x8)?"D":"" )); ++ ++ phydm_dtp_fix_tx_path( pDM_Odm, pDM_Odm->path_select ); ++ } ++ else ++ { ++ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n","Auto Path")); ++ } ++} ++ ++#endif // #if(defined(CONFIG_PATH_DIVERSITY)) ++ ++VOID ++phydm_c2h_dtp_handler( ++ IN PVOID pDM_VOID, ++ IN pu1Byte CmdBuf, ++ IN u1Byte CmdLen ++) ++{ ++#if(defined(CONFIG_PATH_DIVERSITY)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); ++ ++ u1Byte macid = CmdBuf[0]; ++ u1Byte target = CmdBuf[1]; ++ u1Byte nsc_1 = CmdBuf[2]; ++ u1Byte nsc_2 = CmdBuf[3]; ++ u1Byte nsc_3 = CmdBuf[4]; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Target_candidate = (( %d ))\n", target)); ++ /* ++ if( (nsc_1 >= nsc_2) && (nsc_1 >= nsc_3)) ++ { ++ phydm_dtp_fix_tx_path(pDM_Odm, pDM_PathDiv->ant_candidate_1); ++ } ++ else if( nsc_2 >= nsc_3) ++ { ++ phydm_dtp_fix_tx_path(pDM_Odm, pDM_PathDiv->ant_candidate_2); ++ } ++ else ++ { ++ phydm_dtp_fix_tx_path(pDM_Odm, pDM_PathDiv->ant_candidate_3); ++ } ++ */ ++#endif ++} ++ ++VOID ++odm_PathDiversity( ++ IN PVOID pDM_VOID ++) ++{ ++#if(defined(CONFIG_PATH_DIVERSITY)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ if(!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Return: Not Support PathDiv\n")); ++ return; ++ } ++ ++ #if RTL8812A_SUPPORT ++ ++ if(pDM_Odm->SupportICType & ODM_RTL8812) ++ ODM_PathDiversity_8812A(pDM_Odm); ++ else ++ #endif ++ ++ #if RTL8814A_SUPPORT ++ if(pDM_Odm->SupportICType & ODM_RTL8814A) ++ phydm_dynamic_tx_path(pDM_Odm); ++ else ++ #endif ++ {} ++#endif ++} ++ ++VOID ++odm_PathDiversityInit( ++ IN PVOID pDM_VOID ++) ++{ ++#if(defined(CONFIG_PATH_DIVERSITY)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ /*pDM_Odm->SupportAbility |= ODM_BB_PATH_DIV;*/ ++ ++ if(pDM_Odm->mp_mode == TRUE) ++ return; ++ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Return: Not Support PathDiv\n")); ++ return; ++ } ++ ++#if RTL8812A_SUPPORT ++ if(pDM_Odm->SupportICType & ODM_RTL8812) ++ ODM_PathDiversityInit_8812A(pDM_Odm); ++ else ++ #endif ++ ++ #if RTL8814A_SUPPORT ++ if(pDM_Odm->SupportICType & ODM_RTL8814A) ++ phydm_dynamic_tx_path_init(pDM_Odm); ++ else ++ #endif ++ {} ++#endif ++} ++ ++ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++// ++// 2011/12/02 MH Copy from MP oursrc for temporarily test. ++// ++ ++VOID ++odm_PathDivChkAntSwitchCallback( ++ PRT_TIMER pTimer ++) ++{ ++} ++ ++VOID ++odm_PathDivChkAntSwitchWorkitemCallback( ++ IN PVOID pContext ++ ) ++{ ++} ++ ++VOID ++odm_CCKTXPathDiversityCallback( ++ PRT_TIMER pTimer ++) ++{ ++} ++ ++VOID ++odm_CCKTXPathDiversityWorkItemCallback( ++ IN PVOID pContext ++ ) ++{ ++} ++u1Byte ++odm_SwAntDivSelectScanChnl( ++ IN PADAPTER Adapter ++ ) ++{ ++ return 0; ++} ++VOID ++odm_SwAntDivConstructScanChnl( ++ IN PADAPTER Adapter, ++ IN u1Byte ScanChnl ++ ) ++{ ++} ++ ++#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.h 2018-02-11 21:44:27.157146238 +0200 +@@ -0,0 +1,324 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMPATHDIV_H__ ++#define __PHYDMPATHDIV_H__ ++/*#define PATHDIV_VERSION "2.0" //2014.11.04*/ ++#define PATHDIV_VERSION "3.1" /*2015.07.29 by YuChen*/ ++ ++#if(defined(CONFIG_PATH_DIVERSITY)) ++#define USE_PATH_A_AS_DEFAULT_ANT //for 8814 dynamic TX path selection ++ ++#define NUM_RESET_DTP_PERIOD 5 ++#define ANT_DECT_RSSI_TH 3 ++ ++#define PATH_A 1 ++#define PATH_B 2 ++#define PATH_C 3 ++#define PATH_D 4 ++ ++#define PHYDM_AUTO_PATH 0 ++#define PHYDM_FIX_PATH 1 ++ ++#define NUM_CHOOSE2_FROM4 6 ++#define NUM_CHOOSE3_FROM4 4 ++ ++ ++#define PHYDM_A BIT0 ++#define PHYDM_B BIT1 ++#define PHYDM_C BIT2 ++#define PHYDM_D BIT3 ++#define PHYDM_AB (BIT0 | BIT1) // 0 ++#define PHYDM_AC (BIT0 | BIT2) // 1 ++#define PHYDM_AD (BIT0 | BIT3) // 2 ++#define PHYDM_BC (BIT1 | BIT2) // 3 ++#define PHYDM_BD (BIT1 | BIT3) // 4 ++#define PHYDM_CD (BIT2 | BIT3) // 5 ++ ++#define PHYDM_ABC (BIT0 | BIT1 | BIT2) /* 0*/ ++#define PHYDM_ABD (BIT0 | BIT1 | BIT3) /* 1*/ ++#define PHYDM_ACD (BIT0 | BIT2 | BIT3) /* 2*/ ++#define PHYDM_BCD (BIT1 | BIT2 | BIT3) /* 3*/ ++ ++#define PHYDM_ABCD (BIT0 | BIT1 | BIT2 | BIT3) ++ ++ ++typedef enum dtp_state ++{ ++ PHYDM_DTP_INIT=1, ++ PHYDM_DTP_RUNNING_1 ++ ++}PHYDM_DTP_STATE; ++ ++typedef enum path_div_type ++{ ++ PHYDM_2R_PATH_DIV = 1, ++ PHYDM_4R_PATH_DIV = 2 ++}PHYDM_PATH_DIV_TYPE; ++ ++VOID ++phydm_process_rssi_for_path_div( ++ IN OUT PVOID pDM_VOID, ++ IN PVOID p_phy_info_void, ++ IN PVOID p_pkt_info_void ++ ); ++ ++typedef struct _ODM_PATH_DIVERSITY_ ++{ ++ u1Byte RespTxPath; ++ u1Byte PathSel[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte PathA_Sum[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte PathB_Sum[ODM_ASSOCIATE_ENTRY_NUM]; ++ u2Byte PathA_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; ++ u2Byte PathB_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; ++ u1Byte path_div_type; ++ #if RTL8814A_SUPPORT ++ ++ u4Byte path_a_sum_all; ++ u4Byte path_b_sum_all; ++ u4Byte path_c_sum_all; ++ u4Byte path_d_sum_all; ++ ++ u4Byte path_a_cnt_all; ++ u4Byte path_b_cnt_all; ++ u4Byte path_c_cnt_all; ++ u4Byte path_d_cnt_all; ++ ++ u1Byte dtp_period; ++ BOOLEAN bBecomeLinked; ++ BOOLEAN is_u3_mode; ++ u1Byte num_tx_path; ++ u1Byte default_path; ++ u1Byte num_candidate; ++ u1Byte ant_candidate_1; ++ u1Byte ant_candidate_2; ++ u1Byte ant_candidate_3; ++ u1Byte dtp_state; ++ u1Byte dtp_check_patha_counter; ++ BOOLEAN fix_path_bfer; ++ u1Byte search_space_2[NUM_CHOOSE2_FROM4]; ++ u1Byte search_space_3[NUM_CHOOSE3_FROM4]; ++ ++ u1Byte pre_tx_path; ++ u1Byte use_path_a_as_default_ant; ++ BOOLEAN is_pathA_exist; ++ ++ #endif ++}PATHDIV_T, *pPATHDIV_T; ++ ++ ++#endif //#if(defined(CONFIG_PATH_DIVERSITY)) ++ ++VOID ++phydm_c2h_dtp_handler( ++ IN PVOID pDM_VOID, ++ IN pu1Byte CmdBuf, ++ IN u1Byte CmdLen ++ ); ++ ++VOID ++odm_PathDiversityInit( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_PathDiversity( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_pathdiv_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++ ); ++ ++ ++ ++//1 [OLD IC]-------------------------------------------------------------------------------- ++ ++ ++ ++ ++ ++ ++#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ ++//#define PATHDIV_ENABLE 1 ++#define dm_PathDiv_RSSI_Check ODM_PathDivChkPerPktRssi ++#define PathDivCheckBeforeLink8192C ODM_PathDiversityBeforeLink92C ++ ++ ++ ++ ++typedef struct _PathDiv_Parameter_define_ ++{ ++ u4Byte org_5g_RegE30; ++ u4Byte org_5g_RegC14; ++ u4Byte org_5g_RegCA0; ++ u4Byte swt_5g_RegE30; ++ u4Byte swt_5g_RegC14; ++ u4Byte swt_5g_RegCA0; ++ //for 2G IQK information ++ u4Byte org_2g_RegC80; ++ u4Byte org_2g_RegC4C; ++ u4Byte org_2g_RegC94; ++ u4Byte org_2g_RegC14; ++ u4Byte org_2g_RegCA0; ++ ++ u4Byte swt_2g_RegC80; ++ u4Byte swt_2g_RegC4C; ++ u4Byte swt_2g_RegC94; ++ u4Byte swt_2g_RegC14; ++ u4Byte swt_2g_RegCA0; ++}PATHDIV_PARA,*pPATHDIV_PARA; ++ ++VOID ++odm_PathDiversityInit_92C( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_2TPathDiversityInit_92C( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_1TPathDiversityInit_92C( ++ IN PADAPTER Adapter ++ ); ++ ++BOOLEAN ++odm_IsConnected_92C( ++ IN PADAPTER Adapter ++ ); ++ ++BOOLEAN ++ODM_PathDiversityBeforeLink92C( ++ //IN PADAPTER Adapter ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++VOID ++odm_PathDiversityAfterLink_92C( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_SetRespPath_92C( ++ IN PADAPTER Adapter, ++ IN u1Byte DefaultRespPath ++ ); ++ ++VOID ++odm_OFDMTXPathDiversity_92C( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_CCKTXPathDiversity_92C( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_ResetPathDiversity_92C( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_CCKTXPathDiversityCallback( ++ PRT_TIMER pTimer ++ ); ++ ++VOID ++odm_CCKTXPathDiversityWorkItemCallback( ++ IN PVOID pContext ++ ); ++ ++VOID ++odm_PathDivChkAntSwitchCallback( ++ PRT_TIMER pTimer ++ ); ++ ++VOID ++odm_PathDivChkAntSwitchWorkitemCallback( ++ IN PVOID pContext ++ ); ++ ++ ++VOID ++odm_PathDivChkAntSwitch( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++VOID ++ODM_CCKPathDiversityChkPerPktRssi( ++ PADAPTER Adapter, ++ BOOLEAN bIsDefPort, ++ BOOLEAN bMatchBSSID, ++ PRT_WLAN_STA pEntry, ++ PRT_RFD pRfd, ++ pu1Byte pDesc ++ ); ++ ++VOID ++ODM_PathDivChkPerPktRssi( ++ PADAPTER Adapter, ++ BOOLEAN bIsDefPort, ++ BOOLEAN bMatchBSSID, ++ PRT_WLAN_STA pEntry, ++ PRT_RFD pRfd ++ ); ++ ++VOID ++ODM_PathDivRestAfterLink( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++VOID ++ODM_FillTXPathInTXDESC( ++ IN PADAPTER Adapter, ++ IN PRT_TCB pTcb, ++ IN pu1Byte pDesc ++ ); ++ ++VOID ++odm_PathDivInit_92D( ++ IN PDM_ODM_T pDM_Odm ++ ); ++ ++u1Byte ++odm_SwAntDivSelectScanChnl( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_SwAntDivConstructScanChnl( ++ IN PADAPTER Adapter, ++ IN u1Byte ScanChnl ++ ); ++ ++ #endif //#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ ++ ++ #endif //#ifndef __ODMPATHDIV_H__ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.c 2018-02-11 21:44:27.157146238 +0200 +@@ -0,0 +1,1216 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++#if !defined(_OUTSRC_COEXIST) ++//============================================================ ++// Global var ++//============================================================ ++ ++ ++u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE_92D] = { ++ 0x0b40002d, // 0, -15.0dB ++ 0x0c000030, // 1, -14.5dB ++ 0x0cc00033, // 2, -14.0dB ++ 0x0d800036, // 3, -13.5dB ++ 0x0e400039, // 4, -13.0dB ++ 0x0f00003c, // 5, -12.5dB ++ 0x10000040, // 6, -12.0dB ++ 0x11000044, // 7, -11.5dB ++ 0x12000048, // 8, -11.0dB ++ 0x1300004c, // 9, -10.5dB ++ 0x14400051, // 10, -10.0dB ++ 0x15800056, // 11, -9.5dB ++ 0x16c0005b, // 12, -9.0dB ++ 0x18000060, // 13, -8.5dB ++ 0x19800066, // 14, -8.0dB ++ 0x1b00006c, // 15, -7.5dB ++ 0x1c800072, // 16, -7.0dB ++ 0x1e400079, // 17, -6.5dB ++ 0x20000080, // 18, -6.0dB ++ 0x22000088, // 19, -5.5dB ++ 0x24000090, // 20, -5.0dB ++ 0x26000098, // 21, -4.5dB ++ 0x288000a2, // 22, -4.0dB ++ 0x2ac000ab, // 23, -3.5dB ++ 0x2d4000b5, // 24, -3.0dB ++ 0x300000c0, // 25, -2.5dB ++ 0x32c000cb, // 26, -2.0dB ++ 0x35c000d7, // 27, -1.5dB ++ 0x390000e4, // 28, -1.0dB ++ 0x3c8000f2, // 29, -0.5dB ++ 0x40000100, // 30, +0dB ++ 0x43c0010f, // 31, +0.5dB ++ 0x47c0011f, // 32, +1.0dB ++ 0x4c000130, // 33, +1.5dB ++ 0x50800142, // 34, +2.0dB ++ 0x55400155, // 35, +2.5dB ++ 0x5a400169, // 36, +3.0dB ++ 0x5fc0017f, // 37, +3.5dB ++ 0x65400195, // 38, +4.0dB ++ 0x6b8001ae, // 39, +4.5dB ++ 0x71c001c7, // 40, +5.0dB ++ 0x788001e2, // 41, +5.5dB ++ 0x7f8001fe // 42, +6.0dB ++}; ++ ++u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { ++ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB ++ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB ++ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB ++ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB ++ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB ++ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB ++ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB ++ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB ++ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB ++ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB ++ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB ++ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB ++ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB ++ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB ++ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB ++ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB ++ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB ++ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB ++ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB ++ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB ++ {0x1c, 0x1a, 0x18, 0x12, 0x0e, 0x08, 0x04, 0x02}, // 20, -6.0dB ++ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB ++ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB ++ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB ++ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB ++ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB ++ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB ++ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB ++ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB ++ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB ++ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB ++ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB ++ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB ++}; ++ ++ ++u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { ++ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB ++ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB ++ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB ++ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB ++ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB ++ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB ++ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB ++ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB ++ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB ++ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB ++ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB ++ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB ++ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB ++ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB ++ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB ++ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB ++ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB ++ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB ++ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB ++ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB ++ {0x1c, 0x1a, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB ++ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB ++ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB ++ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB ++ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB ++ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB ++ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB ++ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB ++ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB ++ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB ++ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB ++ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB ++ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB ++}; ++ ++u4Byte OFDMSwingTable[OFDM_TABLE_SIZE_92D] = { ++ 0x0b40002d, // 0, -15.0dB ++ 0x0c000030, // 1, -14.5dB ++ 0x0cc00033, // 2, -14.0dB ++ 0x0d800036, // 3, -13.5dB ++ 0x0e400039, // 4, -13.0dB ++ 0x0f00003c, // 5, -12.5dB ++ 0x10000040, // 6, -12.0dB ++ 0x11000044, // 7, -11.5dB ++ 0x12000048, // 8, -11.0dB ++ 0x1300004c, // 9, -10.5dB ++ 0x14400051, // 10, -10.0dB ++ 0x15800056, // 11, -9.5dB ++ 0x16c0005b, // 12, -9.0dB ++ 0x18000060, // 13, -8.5dB ++ 0x19800066, // 14, -8.0dB ++ 0x1b00006c, // 15, -7.5dB ++ 0x1c800072, // 16, -7.0dB ++ 0x1e400079, // 17, -6.5dB ++ 0x20000080, // 18, -6.0dB ++ 0x22000088, // 19, -5.5dB ++ 0x24000090, // 20, -5.0dB ++ 0x26000098, // 21, -4.5dB ++ 0x288000a2, // 22, -4.0dB ++ 0x2ac000ab, // 23, -3.5dB ++ 0x2d4000b5, // 24, -3.0dB ++ 0x300000c0, // 25, -2.5dB ++ 0x32c000cb, // 26, -2.0dB ++ 0x35c000d7, // 27, -1.5dB ++ 0x390000e4, // 28, -1.0dB ++ 0x3c8000f2, // 29, -0.5dB ++ 0x40000100, // 30, +0dB ++ 0x43c0010f, // 31, +0.5dB ++ 0x47c0011f, // 32, +1.0dB ++ 0x4c000130, // 33, +1.5dB ++ 0x50800142, // 34, +2.0dB ++ 0x55400155, // 35, +2.5dB ++ 0x5a400169, // 36, +3.0dB ++ 0x5fc0017f, // 37, +3.5dB ++ 0x65400195, // 38, +4.0dB ++ 0x6b8001ae, // 39, +4.5dB ++ 0x71c001c7, // 40, +5.0dB ++ 0x788001e2, // 41, +5.5dB ++ 0x7f8001fe // 42, +6.0dB ++}; ++ ++ ++u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { ++ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB ++ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB ++ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB ++ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB ++ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB ++ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB ++ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB ++ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB ++ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB ++ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB ++ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB ++ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB ++ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB ++ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB ++ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB ++ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB ++ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB ++ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB ++ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB ++ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB ++ {0x1c, 0x1a, 0x18, 0x12, 0x0e, 0x08, 0x04, 0x02}, // 20, -6.0dB ++ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB ++ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB ++ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB ++ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB ++ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB ++ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB ++ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB ++ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB ++ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB ++ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB ++ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB ++ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB ++}; ++ ++ ++u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]= { ++ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB ++ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB ++ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB ++ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB ++ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB ++ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB ++ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB ++ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB ++ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB ++ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB ++ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB ++ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB ++ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB ++ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB ++ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB ++ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB ++ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB ++ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB ++ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB ++ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB ++ {0x1c, 0x1a, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB ++ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB ++ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB ++ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB ++ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB ++ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB ++ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB ++ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB ++ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB ++ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB ++ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB ++ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB ++ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB ++}; ++ ++u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { ++{0x16, 0x15, 0x13, 0x10, 0xD, 0x9, 0x6, 0x3, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 0 -16dB */ ++{0x18, 0x17, 0x15, 0x12, 0xE, 0xA, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 1 -15.5dB */ ++{0x1B, 0x1A, 0x18, 0x14, 0x10, 0xB, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 2 -15dB */ ++{0x1F, 0x1E, 0x1B, 0x17, 0x12, 0xD, 0x8, 0x5, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 3 -14.5dB */ ++{0x22, 0x21, 0x1E, 0x19, 0x14, 0xE, 0x9, 0x5, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 4 -14dB */ ++{0x26, 0x25, 0x22, 0x1C, 0x16, 0x10, 0xA, 0x6, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 5 -13.5dB */ ++{0x2B, 0x2A, 0x26, 0x20, 0x19, 0x12, 0xC, 0x7, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 6 -13dB */ ++{0x30, 0x2F, 0x2A, 0x24, 0x1C, 0x14, 0xD, 0x8, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 7 -12.5dB */ ++{0x36, 0x34, 0x2F, 0x28, 0x1F, 0x17, 0xF, 0x9, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 8 -12dB */ ++{0x3D, 0x3B, 0x35, 0x2D, 0x23, 0x19, 0x11, 0xA, 0x5, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 9 -11.5dB */ ++{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0xB, 0x5, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 10 -11dB */ ++{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0xC, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 11 -10.5dB */ ++{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0xE, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 12 -10dB */ ++{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0xF, 0x7, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 13 -9.5dB */ ++{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x8, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 14 -9dB */ ++{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x9, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 15 -8.5dB */ ++{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0xA, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 16 -8dB */ ++{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0xB, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 17 -7.5dB */ ++{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0xD, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 18 -7dB */ ++{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0xE, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 19 -6.5dB */ ++{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x5, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0} /* 20 -6dB */ ++}; ++ ++ ++u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16] = { ++{0x16, 0x15, 0x13, 0x10, 0xD, 0x9, 0x6, 0x3, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 0 -16dB */ ++{0x18, 0x17, 0x15, 0x12, 0xE, 0xA, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 1 -15.5dB */ ++{0x1B, 0x1A, 0x18, 0x14, 0x10, 0xB, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 2 -15dB */ ++{0x1F, 0x1E, 0x1B, 0x17, 0x12, 0xD, 0x8, 0x5, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 3 -14.5dB */ ++{0x22, 0x21, 0x1E, 0x19, 0x14, 0xE, 0x9, 0x5, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 4 -14dB */ ++{0x26, 0x25, 0x22, 0x1C, 0x16, 0x10, 0xA, 0x6, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 5 -13.5dB */ ++{0x2B, 0x2A, 0x26, 0x20, 0x19, 0x12, 0xC, 0x7, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 6 -13dB */ ++{0x30, 0x2F, 0x2A, 0x24, 0x1C, 0x14, 0xD, 0x8, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 7 -12.5dB */ ++{0x36, 0x34, 0x2F, 0x28, 0x1F, 0x17, 0xF, 0x9, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 8 -12dB */ ++{0x3D, 0x3B, 0x35, 0x2D, 0x23, 0x19, 0x11, 0xA, 0x5, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 9 -11.5dB */ ++{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0xB, 0x5, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 10 -11dB */ ++{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0xC, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 11 -10.5dB */ ++{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0xE, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 12 -10dB */ ++{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0xF, 0x7, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 13 -9.5dB */ ++{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x8, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 14 -9dB */ ++{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x9, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 15 -8.5dB */ ++{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0xA, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 16 -8dB */ ++{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0xB, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 17 -7.5dB */ ++{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0xD, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 18 -7dB */ ++{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0xE, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 19 -6.5dB */ ++{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x5, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0} /* 20 -6dB */ ++}; ++ ++ ++u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { ++{0x44, 0x42, 0x3C, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ ++{0x48, 0x46, 0x3F, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ ++{0x4D, 0x4A, 0x43, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ ++{0x51, 0x4F, 0x47, 0x2F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ ++{0x56, 0x53, 0x4B, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ ++{0x5B, 0x58, 0x50, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ ++{0x60, 0x5D, 0x54, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ ++{0x66, 0x63, 0x59, 0x3B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ ++{0x6C, 0x69, 0x5F, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ ++{0x73, 0x6F, 0x64, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ ++{0x79, 0x76, 0x6A, 0x46, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ ++{0x81, 0x7C, 0x71, 0x4A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ ++{0x88, 0x84, 0x77, 0x4F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ ++{0x90, 0x8C, 0x7E, 0x54, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ ++{0x99, 0x94, 0x86, 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ ++{0xA2, 0x9D, 0x8E, 0x5E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ ++{0xAC, 0xA6, 0x96, 0x63, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ ++{0xB6, 0xB0, 0x9F, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ ++{0xC1, 0xBA, 0xA8, 0x6F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ ++{0xCC, 0xC5, 0xB2, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ ++{0xD8, 0xD1, 0xBD, 0x7D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ ++}; ++ ++ ++ ++#if 0 ++u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E] = { ++ /* Index0 6 dB */ 0x7fc001ff, ++ /* Index1 5.7dB */ 0x7b4001ed, ++ /* Index2 5.4dB */ 0x774001dd, ++ /* Index3 5.1dB */ 0x734001cd, ++ /* Index4 4.8dB */ 0x6f4001bd, ++ /* Index5 4.5dB */ 0x6b8001ae, ++ /* Index6 4.2dB */ 0x67c0019f, ++ /* Index7 3.9dB */ 0x64400191, ++ /* Index8 3.6dB */ 0x60c00183, ++ /* Index9 3.3dB */ 0x5d800176, ++ /* Index10 3 dB */ 0x5a80016a, ++ /* Index11 2.7dB */ 0x5740015d, ++ /* Index12 2.4dB */ 0x54400151, ++ /* Index13 2.1dB */ 0x51800146, ++ /* Index14 1.8dB */ 0x4ec0013b, ++ /* Index15 1.5dB */ 0x4c000130, ++ /* Index16 1.2dB */ 0x49800126, ++ /* Index17 0.9dB */ 0x4700011c, ++ /* Index18 0.6dB */ 0x44800112, ++ /* Index19 0.3dB */ 0x42000108, ++ /* Index20 0 dB */ 0x40000100, // 20 This is OFDM base index ++ /* Index21 -0.3dB */ 0x3dc000f7, ++ /* Index22 -0.6dB */ 0x3bc000ef, ++ /* Index23 -0.9dB */ 0x39c000e7, ++ /* Index24 -1.2dB */ 0x37c000df, ++ /* Index25 -1.5dB */ 0x35c000d7, ++ /* Index26 -1.8dB */ 0x340000d0, ++ /* Index27 -2.1dB */ 0x324000c9, ++ /* Index28 -2.4dB */ 0x308000c2, ++ /* Index29 -2.7dB */ 0x2f0000bc, ++ /* Index30 -3 dB */ 0x2d4000b5, ++ /* Index31 -3.3dB */ 0x2bc000af, ++ /* Index32 -3.6dB */ 0x2a4000a9, ++ /* Index33 -3.9dB */ 0x28c000a3, ++ /* Index34 -4.2dB */ 0x2780009e, ++ /* Index35 -4.5dB */ 0x26000098, ++ /* Index36 -4.8dB */ 0x24c00093, ++ /* Index37 -5.1dB */ 0x2380008e, ++ /* Index38 -5.4dB */ 0x22400089, ++ /* Index39 -5.7dB */ 0x21400085, ++ /* Index40 -6 dB */ 0x20000080, ++ /* Index41 -6.3dB */ 0x1f00007c, ++ /* Index42 -6.6dB */ 0x1e000078, ++ /* Index43 -6.9dB */ 0x1d000074, ++ /* Index44 -7.2dB */ 0x1c000070, ++ /* Index45 -7.5dB */ 0x1b00006c, ++ /* Index46 -7.8dB */ 0x1a000068, ++ /* Index47 -8.1dB */ 0x19400065, ++ /* Index48 -8.4dB */ 0x18400061, ++ /* Index49 -8.7dB */ 0x1780005e, ++ /* Index50 -9 dB */ 0x16c0005b, ++ /* Index51 -9.3dB */ 0x16000058, ++ /* Index52 -9.6dB */ 0x15400055, ++ /* Index53 -9.9dB */ 0x14800052 ++}; ++u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8] = { ++ /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x1C , 0x12 , 0x08 , 0x04}, ++ /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x1B , 0x11 , 0x08 , 0x04}, ++ /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x1A , 0x11 , 0x07 , 0x04}, ++ /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x19 , 0x10 , 0x07 , 0x04}, ++ /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x18 , 0x10 , 0x07 , 0x03}, ++ /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x18 , 0x0F , 0x07 , 0x03}, ++ /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x17 , 0x0F , 0x06 , 0x03}, ++ /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x16 , 0x0E , 0x06 , 0x03}, ++ /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x15 , 0x0E , 0x06 , 0x03}, ++ /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x14 , 0x0D , 0x06 , 0x03}, ++ /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x14 , 0x0D , 0x06 , 0x03}, ++ /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x13 , 0x0C , 0x05 , 0x03}, ++ /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x12 , 0x0C , 0x05 , 0x03}, ++ /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x12 , 0x0B , 0x05 , 0x03}, ++ /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, ++ /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, ++ /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x10 , 0x0A , 0x05 , 0x02}, ++ /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x10 , 0x0A , 0x04 , 0x02}, ++ /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x0F , 0x0A , 0x04 , 0x02}, ++ /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x0E , 0x09 , 0x04 , 0x02}, ++ /* Index20 -6.0dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x0E , 0x09 , 0x04 , 0x02}, // 20 This is CCK base index ++ /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x0E , 0x09 , 0x04 , 0x02}, ++ /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x0D , 0x08 , 0x04 , 0x02}, ++ /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x0D , 0x08 , 0x04 , 0x02}, ++ /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x0C , 0x08 , 0x03 , 0x02}, ++ /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x0C , 0x08 , 0x03 , 0x02}, ++ /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, ++ /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, ++ /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x0B , 0x07 , 0x03 , 0x02}, ++ /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x0A , 0x07 , 0x03 , 0x01}, ++ /* Index30 -9.0dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, // 30 This is hp CCK base index ++ /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, ++ /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x09 , 0x06 , 0x03 , 0x01}, ++ /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x09 , 0x06 , 0x03 , 0x01}, ++ /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x09 , 0x06 , 0x02 , 0x01}, ++ /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, ++ /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, ++ /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x08 , 0x05 , 0x02 , 0x01}, ++ /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, ++ /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, ++ /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, ++ /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, ++ /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, ++ /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x06 , 0x04 , 0x02 , 0x01}, ++ /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, ++ /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, ++ /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, ++ /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x06 , 0x04 , 0x02 , 0x01}, ++ /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x05 , 0x03 , 0x02 , 0x01}, ++ /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, ++ /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, ++ /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, ++ /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, ++ /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x04 , 0x03 , 0x01 , 0x01} ++}; ++u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8] = { ++ /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index20 -6 dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index30 -9 dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00} ++}; ++#endif ++ ++#ifdef AP_BUILD_WORKAROUND ++ ++unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { ++ /* +6.0dB */ 0x7f8001fe, ++ /* +5.5dB */ 0x788001e2, ++ /* +5.0dB */ 0x71c001c7, ++ /* +4.5dB */ 0x6b8001ae, ++ /* +4.0dB */ 0x65400195, ++ /* +3.5dB */ 0x5fc0017f, ++ /* +3.0dB */ 0x5a400169, ++ /* +2.5dB */ 0x55400155, ++ /* +2.0dB */ 0x50800142, ++ /* +1.5dB */ 0x4c000130, ++ /* +1.0dB */ 0x47c0011f, ++ /* +0.5dB */ 0x43c0010f, ++ /* 0.0dB */ 0x40000100, ++ /* -0.5dB */ 0x3c8000f2, ++ /* -1.0dB */ 0x390000e4, ++ /* -1.5dB */ 0x35c000d7, ++ /* -2.0dB */ 0x32c000cb, ++ /* -2.5dB */ 0x300000c0, ++ /* -3.0dB */ 0x2d4000b5, ++ /* -3.5dB */ 0x2ac000ab, ++ /* -4.0dB */ 0x288000a2, ++ /* -4.5dB */ 0x26000098, ++ /* -5.0dB */ 0x24000090, ++ /* -5.5dB */ 0x22000088, ++ /* -6.0dB */ 0x20000080, ++ /* -6.5dB */ 0x1a00006c, ++ /* -7.0dB */ 0x1c800072, ++ /* -7.5dB */ 0x18000060, ++ /* -8.0dB */ 0x19800066, ++ /* -8.5dB */ 0x15800056, ++ /* -9.0dB */ 0x26c0005b, ++ /* -9.5dB */ 0x14400051, ++ /* -10.0dB */ 0x24400051, ++ /* -10.5dB */ 0x1300004c, ++ /* -11.0dB */ 0x12000048, ++ /* -11.5dB */ 0x11000044, ++ /* -12.0dB */ 0x10000040 ++}; ++#endif ++ ++#endif ++ ++ ++u1Byte DeltaSwingTableIdx_2GA_P_DEFAULT[DELTA_SWINGIDX_SIZE] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3 ++, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; ++u1Byte DeltaSwingTableIdx_2GA_N_DEFAULT[DELTA_SWINGIDX_SIZE] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4 ++, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; ++ ++ ++#ifdef CONFIG_WLAN_HAL_8192EE ++u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E] = { ++ /* Index0 6 dB */ 0x7fc001ff, ++ /* Index1 5.7dB */ 0x7b4001ed, ++ /* Index2 5.4dB */ 0x774001dd, ++ /* Index3 5.1dB */ 0x734001cd, ++ /* Index4 4.8dB */ 0x6f4001bd, ++ /* Index5 4.5dB */ 0x6b8001ae, ++ /* Index6 4.2dB */ 0x67c0019f, ++ /* Index7 3.9dB */ 0x64400191, ++ /* Index8 3.6dB */ 0x60c00183, ++ /* Index9 3.3dB */ 0x5d800176, ++ /* Index10 3 dB */ 0x5a80016a, ++ /* Index11 2.7dB */ 0x5740015d, ++ /* Index12 2.4dB */ 0x54400151, ++ /* Index13 2.1dB */ 0x51800146, ++ /* Index14 1.8dB */ 0x4ec0013b, ++ /* Index15 1.5dB */ 0x4c000130, ++ /* Index16 1.2dB */ 0x49800126, ++ /* Index17 0.9dB */ 0x4700011c, ++ /* Index18 0.6dB */ 0x44800112, ++ /* Index19 0.3dB */ 0x42000108, ++ /* Index20 0 dB */ 0x40000100, // 20 This is OFDM base index ++ /* Index21 -0.3dB */ 0x3dc000f7, ++ /* Index22 -0.6dB */ 0x3bc000ef, ++ /* Index23 -0.9dB */ 0x39c000e7, ++ /* Index24 -1.2dB */ 0x37c000df, ++ /* Index25 -1.5dB */ 0x35c000d7, ++ /* Index26 -1.8dB */ 0x340000d0, ++ /* Index27 -2.1dB */ 0x324000c9, ++ /* Index28 -2.4dB */ 0x308000c2, ++ /* Index29 -2.7dB */ 0x2f0000bc, ++ /* Index30 -3 dB */ 0x2d4000b5, ++ /* Index31 -3.3dB */ 0x2bc000af, ++ /* Index32 -3.6dB */ 0x2a4000a9, ++ /* Index33 -3.9dB */ 0x28c000a3, ++ /* Index34 -4.2dB */ 0x2780009e, ++ /* Index35 -4.5dB */ 0x26000098, ++ /* Index36 -4.8dB */ 0x24c00093, ++ /* Index37 -5.1dB */ 0x2380008e, ++ /* Index38 -5.4dB */ 0x22400089, ++ /* Index39 -5.7dB */ 0x21400085, ++ /* Index40 -6 dB */ 0x20000080, ++ /* Index41 -6.3dB */ 0x1f00007c, ++ /* Index42 -6.6dB */ 0x1e000078, ++ /* Index43 -6.9dB */ 0x1d000074, ++ /* Index44 -7.2dB */ 0x1c000070, ++ /* Index45 -7.5dB */ 0x1b00006c, ++ /* Index46 -7.8dB */ 0x1a000068, ++ /* Index47 -8.1dB */ 0x19400065, ++ /* Index48 -8.4dB */ 0x18400061, ++ /* Index49 -8.7dB */ 0x1780005e, ++ /* Index50 -9 dB */ 0x16c0005b, ++ /* Index51 -9.3dB */ 0x16000058, ++ /* Index52 -9.6dB */ 0x15400055, ++ /* Index53 -9.9dB */ 0x14800052 ++}; ++u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8] = { ++ /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x1C , 0x12 , 0x08 , 0x04}, ++ /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x1B , 0x11 , 0x08 , 0x04}, ++ /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x1A , 0x11 , 0x07 , 0x04}, ++ /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x19 , 0x10 , 0x07 , 0x04}, ++ /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x18 , 0x10 , 0x07 , 0x03}, ++ /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x18 , 0x0F , 0x07 , 0x03}, ++ /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x17 , 0x0F , 0x06 , 0x03}, ++ /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x16 , 0x0E , 0x06 , 0x03}, ++ /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x15 , 0x0E , 0x06 , 0x03}, ++ /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x14 , 0x0D , 0x06 , 0x03}, ++ /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x14 , 0x0D , 0x06 , 0x03}, ++ /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x13 , 0x0C , 0x05 , 0x03}, ++ /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x12 , 0x0C , 0x05 , 0x03}, ++ /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x12 , 0x0B , 0x05 , 0x03}, ++ /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, ++ /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, ++ /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x10 , 0x0A , 0x05 , 0x02}, ++ /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x10 , 0x0A , 0x04 , 0x02}, ++ /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x0F , 0x0A , 0x04 , 0x02}, ++ /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x0E , 0x09 , 0x04 , 0x02}, ++ /* Index20 -6.0dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x0E , 0x09 , 0x04 , 0x02}, // 20 This is CCK base index ++ /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x0E , 0x09 , 0x04 , 0x02}, ++ /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x0D , 0x08 , 0x04 , 0x02}, ++ /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x0D , 0x08 , 0x04 , 0x02}, ++ /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x0C , 0x08 , 0x03 , 0x02}, ++ /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x0C , 0x08 , 0x03 , 0x02}, ++ /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, ++ /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, ++ /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x0B , 0x07 , 0x03 , 0x02}, ++ /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x0A , 0x07 , 0x03 , 0x01}, ++ /* Index30 -9.0dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, // 30 This is hp CCK base index ++ /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, ++ /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x09 , 0x06 , 0x03 , 0x01}, ++ /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x09 , 0x06 , 0x03 , 0x01}, ++ /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x09 , 0x06 , 0x02 , 0x01}, ++ /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, ++ /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, ++ /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x08 , 0x05 , 0x02 , 0x01}, ++ /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, ++ /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, ++ /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, ++ /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, ++ /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, ++ /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x06 , 0x04 , 0x02 , 0x01}, ++ /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, ++ /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, ++ /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, ++ /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x06 , 0x04 , 0x02 , 0x01}, ++ /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x05 , 0x03 , 0x02 , 0x01}, ++ /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, ++ /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, ++ /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, ++ /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, ++ /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x04 , 0x03 , 0x01 , 0x01} ++}; ++u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8] = { ++ /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index20 -6 dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index30 -9 dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, ++ /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00} ++}; ++#endif ++ ++#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1) ++u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = ++{ ++ 0x081, // 0, -12.0dB ++ 0x088, // 1, -11.5dB ++ 0x090, // 2, -11.0dB ++ 0x099, // 3, -10.5dB ++ 0x0A2, // 4, -10.0dB ++ 0x0AC, // 5, -9.5dB ++ 0x0B6, // 6, -9.0dB ++ 0x0C0, // 7, -8.5dB ++ 0x0CC, // 8, -8.0dB ++ 0x0D8, // 9, -7.5dB ++ 0x0E5, // 10, -7.0dB ++ 0x0F2, // 11, -6.5dB ++ 0x101, // 12, -6.0dB ++ 0x110, // 13, -5.5dB ++ 0x120, // 14, -5.0dB ++ 0x131, // 15, -4.5dB ++ 0x143, // 16, -4.0dB ++ 0x156, // 17, -3.5dB ++ 0x16A, // 18, -3.0dB ++ 0x180, // 19, -2.5dB ++ 0x197, // 20, -2.0dB ++ 0x1AF, // 21, -1.5dB ++ 0x1C8, // 22, -1.0dB ++ 0x1E3, // 23, -0.5dB ++ 0x200, // 24, +0 dB ++ 0x21E, // 25, +0.5dB ++ 0x23E, // 26, +1.0dB ++ 0x261, // 27, +1.5dB ++ 0x285, // 28, +2.0dB ++ 0x2AB, // 29, +2.5dB ++ 0x2D3, // 30, +3.0dB ++ 0x2FE, // 31, +3.5dB ++ 0x32B, // 32, +4.0dB ++ 0x35C, // 33, +4.5dB ++ 0x38E, // 34, +5.0dB ++ 0x3C4, // 35, +5.5dB ++ 0x3FE // 36, +6.0dB ++}; ++#elif(ODM_IC_11AC_SERIES_SUPPORT) ++u4Byte OFDMSwingTable_8812[OFDM_TABLE_SIZE_8812] = { ++ 0x3FE, // 0, (6dB) ++ 0x3C4, // 1, (5.5dB) ++ 0x38E, // 2, (5dB) ++ 0x35C, // 3, (4.5dB) ++ 0x32B, // 4, (4dB) ++ 0x2FE, // 5, (3.5dB) ++ 0x2D3, // 6, (3dB) ++ 0x2AB, // 7, (2.5dB) ++ 0x285, // 8, (2dB) ++ 0x261, // 9, (1.5dB ++ 0x23E, // 10, (1dB) ++ 0x21E, // 11, (0.5dB) ++ 0x200, // 12, (0dB) 8814 int PA 2G default ++ 0x1E3, // 13, (-0.5dB) ++ 0x1C8, // 14, (-1dB) ++ 0x1AF, // 15, (-1.5dB) ++ 0x197, // 16, (-2dB) ++ 0x180, // 17, (-2.5dB) ++ 0x16A, // 18, (-3dB) 8812 / 8814 int PA 5G / 8814 ext PA 2G5G default ++ 0x156, // 19, (-3.5dB) ++ 0x143, // 20, (-4dB) 8812 HP default ++ 0x131, // 21, (-4.5dB) ++ 0x120, // 22, (-5dB) ++ 0x110, // 23, (-5.5dB) ++ 0x101, // 24, (-6dB) ++ 0x0F2, // 25, (-6.5dB) ++ 0x0E5, // 26, (-7dB) ++ 0x0D8, // 27, (-7.5dB) ++ 0x0CC, // 28, (-8dB) ++ 0x0C0, // 29, (-8.5dB) ++ 0x0B6, // 30, (-9dB) ++ 0x0AC, // 31, (-9.5dB) ++ 0x0A2, // 32, (-10dB) ++ 0x099, // 33, (-10.5dB) ++ 0x090, // 34, (-11dB) ++ 0x088, // 35, (-11.5dB) ++ 0x081, // 36, (-12dB) ++ 0x079, // 37, (-12.5dB) ++ 0x072, // 38, (-13dB) ++ 0x06c, // 39, (-13.5dB) ++ 0x066, // 40, (-14dB) ++ 0x060, // 41, (-14.5dB) ++ 0x05B // 42, (-15dB) ++}; ++#endif ++ ++u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D] = { ++ 0x0CD, ++ 0x0D9, ++ 0x0E6, ++ 0x0F3, ++ 0x102, ++ 0x111, ++ 0x121, ++ 0x132, ++ 0x144, ++ 0x158, ++ 0x16C, ++ 0x182, ++ 0x198, ++ 0x1B1, ++ 0x1CA, ++ 0x1E5, ++ 0x202, ++ 0x221, ++ 0x241, ++ 0x263, ++ 0x287, ++ 0x2AE, ++ 0x2D6, ++ 0x301, ++ 0x32F, ++ 0x35F, ++ 0x392, ++ 0x3C9, ++ 0x402, ++ 0x43F, ++ 0x47F, ++ 0x4C3, ++ 0x50C, ++ 0x558, ++ 0x5A9, ++ 0x5FF, ++ 0x65A, ++ 0x6BA, ++ 0x720, ++ 0x78C, ++ 0x7FF, ++}; ++ ++ ++//#endif ++//3============================================================ ++//3 Tx Power Tracking ++//3============================================================ ++ ++VOID ++odm_TXPowerTrackingInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ if (!(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B | ODM_IC_11N_SERIES))) ++ return; ++#endif ++ ++ odm_TXPowerTrackingThermalMeterInit(pDM_Odm); ++} ++ ++ ++u1Byte ++getSwingIndex( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i = 0, BBswingMask = 0; ++ u4Byte bbSwing = 0; ++ u4Byte swingTableSize = 0; ++ pu4Byte pSwingTable = 0; ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ ++#if (RTL8197F_SUPPORT == 1) ++ if (GET_CHIP_VER(priv) == VERSION_8197F) { ++ bbSwing = PHY_QueryBBReg(priv, rOFDM0_XATxIQImbalance, bMaskOFDM_D); ++ pSwingTable = OFDMSwingTable_New; ++ swingTableSize = OFDM_TABLE_SIZE_92D; ++ BBswingMask = 22; ++ } ++#endif ++ ++#if (RTL8822B_SUPPORT == 1) ++ if (GET_CHIP_VER(priv) == VERSION_8822B) { ++ bbSwing = PHY_QueryBBReg(priv, rA_TxScale_Jaguar, 0xFFE00000); ++ pSwingTable = TxScalingTable_Jaguar; ++ swingTableSize = TXSCALE_TABLE_SIZE; ++ BBswingMask = 0; ++ } ++#endif ++ ++ for (i = 0; i < swingTableSize-1; i++) { ++ u4Byte tableValue = pSwingTable[i] >> BBswingMask; ++ ++ if (bbSwing == tableValue) ++ break; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("bbSwing=0x%x bbswing_index=%d\n", bbSwing, i)); ++ ++ ++ return i; ++} ++ ++ ++VOID ++odm_TXPowerTrackingThermalMeterInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ u1Byte p; ++ u1Byte defaultSwingIndex; ++#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) ++ if ((GET_CHIP_VER(priv) == VERSION_8197F) || (GET_CHIP_VER(priv) == VERSION_8822B)) ++ defaultSwingIndex = getSwingIndex(pDM_Odm); ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ pMgntInfo->bTXPowerTracking = TRUE; ++ pHalData->TXPowercount = 0; ++ pHalData->bTXPowerTrackingInit = FALSE; ++ ++ if(pDM_Odm->mp_mode == FALSE) ++ pHalData->TxPowerTrackControl = TRUE; ++ ODM_RT_TRACE(pDM_Odm,COMP_POWER_TRACKING, DBG_LOUD, ("pMgntInfo->bTXPowerTracking = %d\n", pMgntInfo->bTXPowerTracking)); ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #ifdef CONFIG_RTL8188E ++ { ++ pDM_Odm->RFCalibrateInfo.bTXPowerTracking = _TRUE; ++ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; ++ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = _FALSE; ++ ++ if(pDM_Odm->mp_mode == FALSE) ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; ++ ++ MSG_8192C("pDM_Odm TxPowerTrackControl = %d\n", pDM_Odm->RFCalibrateInfo.TxPowerTrackControl); ++ } ++ #else ++ { ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ ++ //if(IS_HARDWARE_TYPE_8192C(pHalData)) ++ { ++ pdmpriv->bTXPowerTracking = _TRUE; ++ pdmpriv->TXPowercount = 0; ++ pdmpriv->bTXPowerTrackingInit = _FALSE; ++ ++ if(pDM_Odm->mp_mode == FALSE) //for mp driver, turn off txpwrtracking as default ++ pdmpriv->TxPowerTrackControl = _TRUE; ++ ++ } ++ MSG_8192C("pdmpriv->TxPowerTrackControl = %d\n", pdmpriv->TxPowerTrackControl); ++ ++ } ++ #endif//endif (CONFIG_RTL8188E==1) ++#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++ #ifdef RTL8188E_SUPPORT ++ { ++ pDM_Odm->RFCalibrateInfo.bTXPowerTracking = _TRUE; ++ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; ++ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = _FALSE; ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; ++ pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; ++ } ++ #endif ++#endif ++ ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = TRUE; ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex = 0; ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast = 0; ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset = 0; ++ pDM_Odm->RFCalibrateInfo.ThermalValue = 0; ++ pRFCalibrateInfo->DefaultOfdmIndex = 28; ++ ++#if (RTL8197F_SUPPORT == 1) ++ if (GET_CHIP_VER(priv) == VERSION_8197F) { ++ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= (OFDM_TABLE_SIZE_92D - 1)) ? 30 : defaultSwingIndex; ++ pRFCalibrateInfo->DefaultCckIndex = 28; ++ } ++#endif ++ ++#if (RTL8822B_SUPPORT == 1) ++ if (GET_CHIP_VER(priv) == VERSION_8822B) { ++ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= (TXSCALE_TABLE_SIZE - 1)) ? 24 : defaultSwingIndex; ++ pRFCalibrateInfo->DefaultCckIndex = 20; ++ } ++#endif ++ ++ ++#if RTL8188E_SUPPORT ++ pRFCalibrateInfo->DefaultCckIndex = 20; // -6 dB ++#elif RTL8192E_SUPPORT ++ pRFCalibrateInfo->DefaultCckIndex = 8; // -12 dB ++#endif ++ pRFCalibrateInfo->BbSwingIdxOfdmBase = pRFCalibrateInfo->DefaultOfdmIndex; ++ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; ++ pDM_Odm->RFCalibrateInfo.CCK_index = pRFCalibrateInfo->DefaultCckIndex; ++ ++ for (p = 0; p < MAX_RF_PATH; p++) { ++ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; ++ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->DefaultOfdmIndex; ++ pRFCalibrateInfo->KfreeOffset[p] = 0; /* for 8814 kfree*/ ++ } ++ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->DefaultCckIndex; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("pRFCalibrateInfo->DefaultOfdmIndex=%d pRFCalibrateInfo->DefaultCckIndex=%d\n", pRFCalibrateInfo->DefaultOfdmIndex , pRFCalibrateInfo->DefaultCckIndex)); ++ ++ ++} ++ ++ ++VOID ++ODM_TXPowerTrackingCheck( ++ IN PVOID pDM_VOID ++ ) ++{ ++ // ++ // For AP/ADSL use prtl8192cd_priv ++ // For CE/NIC use PADAPTER ++ // ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ++ ++ if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) ++ return; ++ ++ // ++ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate ++ // at the same time. In the stage2/3, we need to prive universal interface and merge all ++ // HW dynamic mechanism. ++ // ++ switch (pDM_Odm->SupportPlatform) ++ { ++ case ODM_WIN: ++ odm_TXPowerTrackingCheckMP(pDM_Odm); ++ break; ++ ++ case ODM_CE: ++ odm_TXPowerTrackingCheckCE(pDM_Odm); ++ break; ++ ++ case ODM_AP: ++ odm_TXPowerTrackingCheckAP(pDM_Odm); ++ break; ++ ++ case ODM_ADSL: ++ /*odm_DIGAP(pDM_Odm);*/ ++ break; ++ } ++ ++} ++ ++VOID ++odm_TXPowerTrackingCheckCE( ++ IN PVOID pDM_VOID ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ #if(RTL8188E_SUPPORT==1) ++ ++ //if(!pMgntInfo->bTXPowerTracking /*|| (!pdmpriv->TxPowerTrackControl && pdmpriv->bAPKdone)*/) ++ if(!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) ++ { ++ return; ++ } ++ ++ if(!pDM_Odm->RFCalibrateInfo.TM_Trigger) //at least delay 1 sec ++ { ++ //pHalData->TxPowerCheckCnt++; //cosa add for debug ++ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); ++ //DBG_8192C("Trigger 92C Thermal Meter!!\n"); ++ ++ pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; ++ return; ++ ++ } ++ else ++ { ++ //DBG_8192C("Schedule TxPowerTracking direct call!!\n"); ++ odm_TXPowerTrackingCallback_ThermalMeter_8188E(Adapter); ++ pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; ++ } ++ #endif ++ ++#endif ++} ++ ++VOID ++odm_TXPowerTrackingCheckMP( ++ IN PVOID pDM_VOID ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ if (ODM_CheckPowerStatus(Adapter) == FALSE) ++ return; ++ ++ if(!Adapter->bSlaveOfDMSP || Adapter->DualMacSmartConcurrent == FALSE) ++ odm_TXPowerTrackingThermalMeterCheck(Adapter); ++#endif ++ ++} ++ ++ ++VOID ++odm_TXPowerTrackingCheckAP( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ ++#if ((RTL8188E_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) ++ if (pDM_Odm->SupportICType & (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8881A | ODM_RTL8814A | ODM_RTL8197F | ODM_RTL8822B)) ++ ODM_TXPowerTrackingCallback_ThermalMeter(pDM_Odm); ++ else ++#endif ++ { ++ } ++#endif ++ ++} ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++VOID ++odm_TXPowerTrackingThermalMeterCheck( ++ IN PADAPTER Adapter ++ ) ++{ ++#ifndef AP_BUILD_WORKAROUND ++#if (HAL_CODE_BASE==RTL8192_C) ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ static u1Byte TM_Trigger = 0; ++ //u1Byte TxPowerCheckCnt = 5; //10 sec ++ ++ if(!pMgntInfo->bTXPowerTracking /*|| (!pHalData->TxPowerTrackControl && pHalData->bAPKdone)*/) ++ { ++ return; ++ } ++ ++ if(!TM_Trigger) //at least delay 1 sec ++ { ++ if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_8812(Adapter)) ++ PHY_SetRFReg(Adapter, RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03); ++ else ++ PHY_SetRFReg(Adapter, RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); ++ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger 92C Thermal Meter!!\n")); ++ ++ TM_Trigger = 1; ++ return; ++ } ++ else ++ { ++ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n")); ++ odm_TXPowerTrackingDirectCall(Adapter); //Using direct call is instead, added by Roger, 2009.06.18. ++ TM_Trigger = 0; ++ } ++#endif ++#endif ++} ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.h 2018-02-11 21:44:27.157146238 +0200 +@@ -0,0 +1,351 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMPOWERTRACKING_H__ ++#define __PHYDMPOWERTRACKING_H__ ++ ++#define POWRTRACKING_VERSION "1.1" ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++#ifdef RTK_AC_SUPPORT ++#define ODM_IC_11AC_SERIES_SUPPORT 1 ++#else ++#define ODM_IC_11AC_SERIES_SUPPORT 0 ++#endif ++#else ++#define ODM_IC_11AC_SERIES_SUPPORT 1 ++#endif ++ ++#define DPK_DELTA_MAPPING_NUM 13 ++#define index_mapping_HP_NUM 15 ++#define DELTA_SWINGIDX_SIZE 30 ++#define DELTA_SWINTSSI_SIZE 61 ++#define BAND_NUM 3 ++#define MAX_RF_PATH 4 ++#define TXSCALE_TABLE_SIZE 37 ++#define CCK_TABLE_SIZE_8723D 41 ++ ++#define IQK_MAC_REG_NUM 4 ++#define IQK_ADDA_REG_NUM 16 ++#define IQK_BB_REG_NUM_MAX 10 ++ ++#define IQK_BB_REG_NUM 9 ++ ++#define HP_THERMAL_NUM 8 ++ ++#define AVG_THERMAL_NUM 8 ++#define IQK_Matrix_REG_NUM 8 ++//#define IQK_Matrix_Settings_NUM 1+24+21 ++#define IQK_Matrix_Settings_NUM (14+24+21) // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G ++ ++#if !defined(_OUTSRC_COEXIST) ++#define OFDM_TABLE_SIZE_92D 43 ++#define OFDM_TABLE_SIZE 37 ++#define CCK_TABLE_SIZE 33 ++#define CCK_TABLE_SIZE_88F 21 ++ ++ ++ ++//#define OFDM_TABLE_SIZE_92E 54 ++//#define CCK_TABLE_SIZE_92E 54 ++extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE_92D]; ++extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; ++extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; ++ ++ ++extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE_92D]; ++extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; ++extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; ++extern u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16]; ++extern u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16]; ++extern u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16]; ++ ++#endif ++ ++#define ODM_OFDM_TABLE_SIZE 37 ++#define ODM_CCK_TABLE_SIZE 33 ++// <20140613, YuChen> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. ++extern u1Byte DeltaSwingTableIdx_2GA_P_DEFAULT[DELTA_SWINGIDX_SIZE]; ++extern u1Byte DeltaSwingTableIdx_2GA_N_DEFAULT[DELTA_SWINGIDX_SIZE]; ++ ++static u1Byte DeltaSwingTableIdx_2GA_P_8188E[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; ++static u1Byte DeltaSwingTableIdx_2GA_N_8188E[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; ++ ++//extern u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E]; ++//extern u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8]; ++//extern u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8]; ++ ++#ifdef CONFIG_WLAN_HAL_8192EE ++#define OFDM_TABLE_SIZE_92E 54 ++#define CCK_TABLE_SIZE_92E 54 ++extern u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E]; ++extern u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8]; ++extern u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8]; ++#endif ++ ++#define OFDM_TABLE_SIZE_8812 43 ++#define AVG_THERMAL_NUM_8812 4 ++ ++#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1) ++extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; ++#elif(ODM_IC_11AC_SERIES_SUPPORT) ++extern unsigned int OFDMSwingTable_8812[OFDM_TABLE_SIZE_8812]; ++#endif ++ ++extern u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D]; ++ ++#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck ++ ++typedef struct _IQK_MATRIX_REGS_SETTING{ ++ BOOLEAN bIQKDone; ++ s4Byte Value[1][IQK_Matrix_REG_NUM]; ++}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; ++ ++typedef struct ODM_RF_Calibration_Structure ++{ ++ //for tx power tracking ++ ++ u4Byte RegA24; // for TempCCK ++ s4Byte RegE94; ++ s4Byte RegE9C; ++ s4Byte RegEB4; ++ s4Byte RegEBC; ++ ++ //u1Byte bTXPowerTracking; ++ u1Byte TXPowercount; ++ BOOLEAN bTXPowerTrackingInit; ++ BOOLEAN bTXPowerTracking; ++ u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default ++ u1Byte TM_Trigger; ++ u1Byte InternalPA5G[2]; //pathA / pathB ++ ++ u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 ++ u1Byte ThermalValue; ++ u1Byte ThermalValue_LCK; ++ u1Byte ThermalValue_IQK; ++ u1Byte ThermalValue_DPK; ++ u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; ++ u1Byte ThermalValue_AVG_index; ++ u1Byte ThermalValue_RxGain; ++ u1Byte ThermalValue_Crystal; ++ u1Byte ThermalValue_DPKstore; ++ u1Byte ThermalValue_DPKtrack; ++ BOOLEAN TxPowerTrackingInProgress; ++ BOOLEAN bDPKenable; ++ ++ BOOLEAN bReloadtxpowerindex; ++ u1Byte bRfPiEnable; ++ u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug ++ ++ u1Byte bCCKinCH14; ++ u1Byte CCK_index; ++ u1Byte OFDM_index[MAX_RF_PATH]; ++ s1Byte PowerIndexOffset; ++ s1Byte DeltaPowerIndex; ++ s1Byte DeltaPowerIndexLast; ++ BOOLEAN bTxPowerChanged; ++ ++ u1Byte ThermalValue_HP[HP_THERMAL_NUM]; ++ u1Byte ThermalValue_HP_index; ++ IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; ++ u1Byte Delta_LCK; ++ u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKC_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKC_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKD_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKD_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GC_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GC_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GD_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GD_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GC_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GC_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GD_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GD_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GCCKA[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GCCKB[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GCCKC[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GCCKD[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GA[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GB[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GC[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GD[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_5GA[BAND_NUM][DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_5GB[BAND_NUM][DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_5GC[BAND_NUM][DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_5GD[BAND_NUM][DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; ++ ++ u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; ++ u1Byte BbSwingIdxOfdmCurrent; ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; ++#else ++ u1Byte BbSwingIdxOfdmBase; ++#endif ++ BOOLEAN BbSwingFlagOfdm; ++ u1Byte BbSwingIdxCck; ++ u1Byte BbSwingIdxCckCurrent; ++ u1Byte BbSwingIdxCckBase; ++ u1Byte DefaultOfdmIndex; ++ u1Byte DefaultCckIndex; ++ BOOLEAN BbSwingFlagCck; ++ ++ s1Byte Absolute_OFDMSwingIdx[MAX_RF_PATH]; ++ s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; ++ s1Byte Absolute_CCKSwingIdx[MAX_RF_PATH]; ++ s1Byte Remnant_CCKSwingIdx; ++ s1Byte Modify_TxAGC_Value; /*Remnat compensate value at TxAGC */ ++ BOOLEAN Modify_TxAGC_Flag_PathA; ++ BOOLEAN Modify_TxAGC_Flag_PathB; ++ BOOLEAN Modify_TxAGC_Flag_PathC; ++ BOOLEAN Modify_TxAGC_Flag_PathD; ++ BOOLEAN Modify_TxAGC_Flag_PathA_CCK; ++ ++ s1Byte KfreeOffset[MAX_RF_PATH]; ++ ++ //--------------------------------------------------------------------// ++ ++ //for IQK ++ u4Byte RegC04; ++ u4Byte Reg874; ++ u4Byte RegC08; ++ u4Byte RegB68; ++ u4Byte RegB6C; ++ u4Byte Reg870; ++ u4Byte Reg860; ++ u4Byte Reg864; ++ ++ BOOLEAN bIQKInitialized; ++ BOOLEAN bLCKInProgress; ++ BOOLEAN bAntennaDetected; ++ BOOLEAN bNeedIQK; ++ BOOLEAN bIQKInProgress; ++ BOOLEAN bIQKPAoff; ++ u1Byte Delta_IQK; ++ u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; ++ u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; ++ u4Byte IQK_BB_backup_recover[9]; ++ u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; ++ u4Byte TxIQC_8723B[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ ++ u4Byte RxIQC_8723B[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ ++ u4Byte TxIQC_8703B[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ ++ u4Byte RxIQC_8703B[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ ++ ++ u8Byte IQK_StartTime; ++ u8Byte IQK_TotalProgressingTime; ++ u8Byte IQK_ProgressingTime; ++ u4Byte LOK_Result; ++ u1Byte IQKstep; ++ u1Byte Kcount; ++ u1Byte retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ ++ BOOLEAN isMPmode; ++ ++ //for APK ++ u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a ++ u1Byte bAPKdone; ++ u1Byte bAPKThermalMeterIgnore; ++ u1Byte bDPdone; ++ u1Byte bDPPathAOK; ++ u1Byte bDPPathBOK; ++ ++ /*Add by Yuchen for Kfree Phydm*/ ++ u1Byte RegRfKFreeEnable; /*for registry*/ ++ u1Byte RfKFreeEnable; /*for efuse enable check*/ ++ u4Byte TxLOK[2]; ++}ODM_RF_CAL_T,*PODM_RF_CAL_T; ++ ++VOID ++odm_TXPowerTrackingCheckAP( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++ODM_TXPowerTrackingCheck( ++ IN PVOID pDM_VOID ++ ); ++ ++ ++VOID ++odm_TXPowerTrackingThermalMeterInit( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_TXPowerTrackingInit( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_TXPowerTrackingCheckMP( ++ IN PVOID pDM_VOID ++ ); ++ ++ ++VOID ++odm_TXPowerTrackingCheckCE( ++ IN PVOID pDM_VOID ++ ); ++ ++ ++#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ ++VOID ++odm_TXPowerTrackingCallbackThermalMeter92C( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_TXPowerTrackingCallbackRXGainThermalMeter92D( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_TXPowerTrackingCallbackThermalMeter92D( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_TXPowerTrackingDirectCall92C( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_TXPowerTrackingThermalMeterCheck( ++ IN PADAPTER Adapter ++ ); ++ ++#endif ++ ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.c 2018-02-11 21:44:27.157146238 +0200 +@@ -0,0 +1,756 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++/*============================================================ */ ++/* include files */ ++/*============================================================ */ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++//============================================================ ++// Global var ++//============================================================ ++ ++u4Byte OFDMSwingTable[OFDM_TABLE_SIZE] = { ++ 0x7f8001fe, /* 0, +6.0dB */ ++ 0x788001e2, /* 1, +5.5dB */ ++ 0x71c001c7, /* 2, +5.0dB*/ ++ 0x6b8001ae, /* 3, +4.5dB*/ ++ 0x65400195, /* 4, +4.0dB*/ ++ 0x5fc0017f, /* 5, +3.5dB*/ ++ 0x5a400169, /* 6, +3.0dB*/ ++ 0x55400155, /* 7, +2.5dB*/ ++ 0x50800142, /* 8, +2.0dB*/ ++ 0x4c000130, /* 9, +1.5dB*/ ++ 0x47c0011f, /* 10, +1.0dB*/ ++ 0x43c0010f, /* 11, +0.5dB*/ ++ 0x40000100, /* 12, +0dB*/ ++ 0x3c8000f2, /* 13, -0.5dB*/ ++ 0x390000e4, /* 14, -1.0dB*/ ++ 0x35c000d7, /* 15, -1.5dB*/ ++ 0x32c000cb, /* 16, -2.0dB*/ ++ 0x300000c0, /* 17, -2.5dB*/ ++ 0x2d4000b5, /* 18, -3.0dB*/ ++ 0x2ac000ab, /* 19, -3.5dB*/ ++ 0x288000a2, /* 20, -4.0dB*/ ++ 0x26000098, /* 21, -4.5dB*/ ++ 0x24000090, /* 22, -5.0dB*/ ++ 0x22000088, /* 23, -5.5dB*/ ++ 0x20000080, /* 24, -6.0dB*/ ++ 0x1e400079, /* 25, -6.5dB*/ ++ 0x1c800072, /* 26, -7.0dB*/ ++ 0x1b00006c, /* 27. -7.5dB*/ ++ 0x19800066, /* 28, -8.0dB*/ ++ 0x18000060, /* 29, -8.5dB*/ ++ 0x16c0005b, /* 30, -9.0dB*/ ++ 0x15800056, /* 31, -9.5dB*/ ++ 0x14400051, /* 32, -10.0dB*/ ++ 0x1300004c, /* 33, -10.5dB*/ ++ 0x12000048, /* 34, -11.0dB*/ ++ 0x11000044, /* 35, -11.5dB*/ ++ 0x10000040, /* 36, -12.0dB*/ ++}; ++ ++u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { ++ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, /* 0, +0dB */ ++ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 1, -0.5dB */ ++ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 2, -1.0dB*/ ++ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 3, -1.5dB*/ ++ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 4, -2.0dB */ ++ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 5, -2.5dB*/ ++ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 6, -3.0dB*/ ++ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 7, -3.5dB*/ ++ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 8, -4.0dB */ ++ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 9, -4.5dB*/ ++ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 10, -5.0dB */ ++ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 11, -5.5dB*/ ++ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /* 12, -6.0dB <== default */ ++ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 13, -6.5dB*/ ++ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 14, -7.0dB */ ++ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 15, -7.5dB*/ ++ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ ++ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 17, -8.5dB*/ ++ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 18, -9.0dB */ ++ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 19, -9.5dB*/ ++ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 20, -10.0dB*/ ++ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 21, -10.5dB*/ ++ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 22, -11.0dB*/ ++ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 23, -11.5dB*/ ++ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 24, -12.0dB*/ ++ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 25, -12.5dB*/ ++ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 26, -13.0dB*/ ++ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 27, -13.5dB*/ ++ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 28, -14.0dB*/ ++ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 29, -14.5dB*/ ++ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 30, -15.0dB*/ ++ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 31, -15.5dB*/ ++ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} /* 32, -16.0dB*/ ++}; ++ ++ ++u1Byte CCKSwingTable_Ch14[CCK_TABLE_SIZE][8] = { ++ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, /* 0, +0dB */ ++ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 1, -0.5dB */ ++ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 2, -1.0dB */ ++ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /* 3, -1.5dB*/ ++ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 4, -2.0dB */ ++ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /* 5, -2.5dB*/ ++ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 6, -3.0dB */ ++ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 7, -3.5dB */ ++ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 8, -4.0dB */ ++ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /* 9, -4.5dB*/ ++ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 10, -5.0dB */ ++ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 11, -5.5dB*/ ++ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 12, -6.0dB <== default*/ ++ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 13, -6.5dB */ ++ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 14, -7.0dB */ ++ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 15, -7.5dB*/ ++ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ ++ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 17, -8.5dB*/ ++ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 18, -9.0dB */ ++ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 19, -9.5dB*/ ++ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 20, -10.0dB*/ ++ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 21, -10.5dB*/ ++ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 22, -11.0dB*/ ++ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 23, -11.5dB*/ ++ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 24, -12.0dB*/ ++ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 25, -12.5dB*/ ++ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 26, -13.0dB*/ ++ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 27, -13.5dB*/ ++ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 28, -14.0dB*/ ++ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 29, -14.5dB*/ ++ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 30, -15.0dB*/ ++ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 31, -15.5dB*/ ++ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00} /* 32, -16.0dB*/ ++}; ++ ++ ++u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE] = { ++ 0x0b40002d, /* 0, -15.0dB */ ++ 0x0c000030, /* 1, -14.5dB*/ ++ 0x0cc00033, /* 2, -14.0dB*/ ++ 0x0d800036, /* 3, -13.5dB*/ ++ 0x0e400039, /* 4, -13.0dB */ ++ 0x0f00003c, /* 5, -12.5dB*/ ++ 0x10000040, /* 6, -12.0dB*/ ++ 0x11000044, /* 7, -11.5dB*/ ++ 0x12000048, /* 8, -11.0dB*/ ++ 0x1300004c, /* 9, -10.5dB*/ ++ 0x14400051, /* 10, -10.0dB*/ ++ 0x15800056, /* 11, -9.5dB*/ ++ 0x16c0005b, /* 12, -9.0dB*/ ++ 0x18000060, /* 13, -8.5dB*/ ++ 0x19800066, /* 14, -8.0dB*/ ++ 0x1b00006c, /* 15, -7.5dB*/ ++ 0x1c800072, /* 16, -7.0dB*/ ++ 0x1e400079, /* 17, -6.5dB*/ ++ 0x20000080, /* 18, -6.0dB*/ ++ 0x22000088, /* 19, -5.5dB*/ ++ 0x24000090, /* 20, -5.0dB*/ ++ 0x26000098, /* 21, -4.5dB*/ ++ 0x288000a2, /* 22, -4.0dB*/ ++ 0x2ac000ab, /* 23, -3.5dB*/ ++ 0x2d4000b5, /* 24, -3.0dB*/ ++ 0x300000c0, /* 25, -2.5dB*/ ++ 0x32c000cb, /* 26, -2.0dB*/ ++ 0x35c000d7, /* 27, -1.5dB*/ ++ 0x390000e4, /* 28, -1.0dB*/ ++ 0x3c8000f2, /* 29, -0.5dB*/ ++ 0x40000100, /* 30, +0dB*/ ++ 0x43c0010f, /* 31, +0.5dB*/ ++ 0x47c0011f, /* 32, +1.0dB*/ ++ 0x4c000130, /* 33, +1.5dB*/ ++ 0x50800142, /* 34, +2.0dB*/ ++ 0x55400155, /* 35, +2.5dB*/ ++ 0x5a400169, /* 36, +3.0dB*/ ++ 0x5fc0017f, /* 37, +3.5dB*/ ++ 0x65400195, /* 38, +4.0dB*/ ++ 0x6b8001ae, /* 39, +4.5dB*/ ++ 0x71c001c7, /* 40, +5.0dB*/ ++ 0x788001e2, /* 41, +5.5dB*/ ++ 0x7f8001fe /* 42, +6.0dB*/ ++}; ++ ++ ++u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { ++{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ ++{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ ++{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ ++{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ ++{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ ++{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ ++{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ ++{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ ++{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ ++{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ ++{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ ++{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ ++{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ ++{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ ++{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ ++{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ ++{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ ++{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ ++{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ ++{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ ++{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ ++}; ++ ++ ++u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16] = { ++{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ ++{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ ++{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ ++{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ ++{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ ++{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ ++{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ ++{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ ++{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ ++{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ ++{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ ++{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ ++{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ ++{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ ++{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ ++{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ ++{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ ++{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ ++{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ ++{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ ++{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ ++}; ++ ++ ++u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { ++{0x44, 0x42, 0x3C, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ ++{0x48, 0x46, 0x3F, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ ++{0x4D, 0x4A, 0x43, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ ++{0x51, 0x4F, 0x47, 0x2F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ ++{0x56, 0x53, 0x4B, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ ++{0x5B, 0x58, 0x50, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ ++{0x60, 0x5D, 0x54, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ ++{0x66, 0x63, 0x59, 0x3B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ ++{0x6C, 0x69, 0x5F, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ ++{0x73, 0x6F, 0x64, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ ++{0x79, 0x76, 0x6A, 0x46, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ ++{0x81, 0x7C, 0x71, 0x4A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ ++{0x88, 0x84, 0x77, 0x4F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ ++{0x90, 0x8C, 0x7E, 0x54, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ ++{0x99, 0x94, 0x86, 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ ++{0xA2, 0x9D, 0x8E, 0x5E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ ++{0xAC, 0xA6, 0x96, 0x63, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ ++{0xB6, 0xB0, 0x9F, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ ++{0xC1, 0xBA, 0xA8, 0x6F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ ++{0xCC, 0xC5, 0xB2, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ ++{0xD8, 0xD1, 0xBD, 0x7D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ ++}; ++ ++ ++u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { ++ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, /* 0, -16.0dB*/ ++ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 1, -15.5dB*/ ++ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 2, -15.0dB*/ ++ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 3, -14.5dB*/ ++ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 4, -14.0dB*/ ++ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 5, -13.5dB*/ ++ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 6, -13.0dB*/ ++ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 7, -12.5dB*/ ++ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 8, -12.0dB*/ ++ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 9, -11.5dB*/ ++ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 10, -11.0dB*/ ++ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 11, -10.5dB*/ ++ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 12, -10.0dB*/ ++ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 13, -9.5dB*/ ++ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 14, -9.0dB */ ++ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 15, -8.5dB*/ ++ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ ++ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 17, -7.5dB*/ ++ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 18, -7.0dB */ ++ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 19, -6.5dB*/ ++ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /*20, -6.0dB */ ++ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 21, -5.5dB*/ ++ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 22, -5.0dB */ ++ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 23, -4.5dB*/ ++ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 24, -4.0dB */ ++ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 25, -3.5dB*/ ++ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 26, -3.0dB*/ ++ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 27, -2.5dB*/ ++ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 28, -2.0dB */ ++ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 29, -1.5dB*/ ++ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 30, -1.0dB*/ ++ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 31, -0.5dB*/ ++ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} /* 32, +0dB*/ ++}; ++ ++ ++u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { ++ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, /* 0, -16.0dB*/ ++ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 1, -15.5dB*/ ++ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 2, -15.0dB*/ ++ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 3, -14.5dB*/ ++ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 4, -14.0dB*/ ++ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /*5, -13.5dB*/ ++ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 6, -13.0dB*/ ++ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 7, -12.5dB*/ ++ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 8, -12.0dB*/ ++ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 9, -11.5dB*/ ++ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 10, -11.0dB*/ ++ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /*11, -10.5dB*/ ++ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 12, -10.0dB*/ ++ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 13, -9.5dB*/ ++ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /*14, -9.0dB */ ++ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 15, -8.5dB*/ ++ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ ++ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 17, -7.5dB*/ ++ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 18, -7.0dB */ ++ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 19, -6.5dB */ ++ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 20, -6.0dB */ ++ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 21, -5.5dB*/ ++ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 22, -5.0dB */ ++ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /*23, -4.5dB*/ ++ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 24, -4.0dB */ ++ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 25, -3.5dB */ ++ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 26, -3.0dB */ ++ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /*27, -2.5dB*/ ++ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 28, -2.0dB */ ++ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /*29, -1.5dB*/ ++ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 30, -1.0dB */ ++ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 31, -0.5dB */ ++ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} /* 32, +0dB */ ++}; ++u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D] = { ++ 0x0CD, /*0 , -20dB*/ ++ 0x0D9, ++ 0x0E6, ++ 0x0F3, ++ 0x102, ++ 0x111, ++ 0x121, ++ 0x132, ++ 0x144, ++ 0x158, ++ 0x16C, ++ 0x182, ++ 0x198, ++ 0x1B1, ++ 0x1CA, ++ 0x1E5, ++ 0x202, ++ 0x221, ++ 0x241, ++ 0x263, ++ 0x287, ++ 0x2AE, ++ 0x2D6, ++ 0x301, ++ 0x32F, ++ 0x35F, ++ 0x392, ++ 0x3C9, ++ 0x402, ++ 0x43F, ++ 0x47F, ++ 0x4C3, ++ 0x50C, ++ 0x558, ++ 0x5A9, ++ 0x5FF, ++ 0x65A, ++ 0x6BA, ++ 0x720, ++ 0x78C, ++ 0x7FF, ++}; ++ ++ ++u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = ++{ ++ 0x081, /* 0, -12.0dB*/ ++ 0x088, /* 1, -11.5dB*/ ++ 0x090, /* 2, -11.0dB*/ ++ 0x099, /* 3, -10.5dB*/ ++ 0x0A2, /* 4, -10.0dB*/ ++ 0x0AC, /* 5, -9.5dB*/ ++ 0x0B6, /* 6, -9.0dB*/ ++ 0x0C0, /*7, -8.5dB*/ ++ 0x0CC, /* 8, -8.0dB*/ ++ 0x0D8, /* 9, -7.5dB*/ ++ 0x0E5, /* 10, -7.0dB*/ ++ 0x0F2, /* 11, -6.5dB*/ ++ 0x101, /* 12, -6.0dB*/ ++ 0x110, /* 13, -5.5dB*/ ++ 0x120, /* 14, -5.0dB*/ ++ 0x131, /* 15, -4.5dB*/ ++ 0x143, /* 16, -4.0dB*/ ++ 0x156, /* 17, -3.5dB*/ ++ 0x16A, /* 18, -3.0dB*/ ++ 0x180, /* 19, -2.5dB*/ ++ 0x197, /* 20, -2.0dB*/ ++ 0x1AF, /* 21, -1.5dB*/ ++ 0x1C8, /* 22, -1.0dB*/ ++ 0x1E3, /* 23, -0.5dB*/ ++ 0x200, /* 24, +0 dB*/ ++ 0x21E, /* 25, +0.5dB*/ ++ 0x23E, /* 26, +1.0dB*/ ++ 0x261, /* 27, +1.5dB*/ ++ 0x285,/* 28, +2.0dB*/ ++ 0x2AB, /* 29, +2.5dB*/ ++ 0x2D3, /*30, +3.0dB*/ ++ 0x2FE, /* 31, +3.5dB*/ ++ 0x32B, /* 32, +4.0dB*/ ++ 0x35C, /* 33, +4.5dB*/ ++ 0x38E, /* 34, +5.0dB*/ ++ 0x3C4, /* 35, +5.5dB*/ ++ 0x3FE /* 36, +6.0dB */ ++}; ++ ++#ifdef AP_BUILD_WORKAROUND ++ ++unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { ++ /* +6.0dB */ 0x7f8001fe, ++ /* +5.5dB */ 0x788001e2, ++ /* +5.0dB */ 0x71c001c7, ++ /* +4.5dB */ 0x6b8001ae, ++ /* +4.0dB */ 0x65400195, ++ /* +3.5dB */ 0x5fc0017f, ++ /* +3.0dB */ 0x5a400169, ++ /* +2.5dB */ 0x55400155, ++ /* +2.0dB */ 0x50800142, ++ /* +1.5dB */ 0x4c000130, ++ /* +1.0dB */ 0x47c0011f, ++ /* +0.5dB */ 0x43c0010f, ++ /* 0.0dB */ 0x40000100, ++ /* -0.5dB */ 0x3c8000f2, ++ /* -1.0dB */ 0x390000e4, ++ /* -1.5dB */ 0x35c000d7, ++ /* -2.0dB */ 0x32c000cb, ++ /* -2.5dB */ 0x300000c0, ++ /* -3.0dB */ 0x2d4000b5, ++ /* -3.5dB */ 0x2ac000ab, ++ /* -4.0dB */ 0x288000a2, ++ /* -4.5dB */ 0x26000098, ++ /* -5.0dB */ 0x24000090, ++ /* -5.5dB */ 0x22000088, ++ /* -6.0dB */ 0x20000080, ++ /* -6.5dB */ 0x1a00006c, ++ /* -7.0dB */ 0x1c800072, ++ /* -7.5dB */ 0x18000060, ++ /* -8.0dB */ 0x19800066, ++ /* -8.5dB */ 0x15800056, ++ /* -9.0dB */ 0x26c0005b, ++ /* -9.5dB */ 0x14400051, ++ /* -10.0dB */ 0x24400051, ++ /* -10.5dB */ 0x1300004c, ++ /* -11.0dB */ 0x12000048, ++ /* -11.5dB */ 0x11000044, ++ /* -12.0dB */ 0x10000040 ++}; ++#endif ++ ++ ++ ++VOID ++odm_TXPowerTrackingInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ if (!(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_IC_11N_SERIES | ODM_RTL8822B))) ++ return; ++#endif ++ ++ odm_TXPowerTrackingThermalMeterInit(pDM_Odm); ++} ++ ++u1Byte ++getSwingIndex( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u1Byte i = 0; ++ u4Byte bbSwing; ++ u4Byte swingTableSize; ++ pu4Byte pSwingTable; ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B ++ || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8703B ++ ) { ++ bbSwing = PHY_QueryBBReg(Adapter, rOFDM0_XATxIQImbalance, 0xFFC00000); ++ ++ pSwingTable = OFDMSwingTable_New; ++ swingTableSize = OFDM_TABLE_SIZE; ++ } else { ++#if ((RTL8812A_SUPPORT==1)||(RTL8821A_SUPPORT==1)) ++ if (pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8821) ++ { ++ bbSwing = PHY_GetTxBBSwing_8812A(Adapter, pHalData->CurrentBandType, ODM_RF_PATH_A); ++ pSwingTable = TxScalingTable_Jaguar; ++ swingTableSize = TXSCALE_TABLE_SIZE; ++ } ++ else ++#endif ++ { ++ bbSwing = 0; ++ pSwingTable = OFDMSwingTable; ++ swingTableSize = OFDM_TABLE_SIZE; ++ } ++ } ++ ++ for (i = 0; i < swingTableSize; ++i) { ++ u4Byte tableValue = pSwingTable[i]; ++ ++ if (tableValue >= 0x100000 ) ++ tableValue >>= 22; ++ if (bbSwing == tableValue) ++ break; ++ } ++ return i; ++} ++ ++VOID ++odm_TXPowerTrackingThermalMeterInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte defaultSwingIndex = getSwingIndex(pDM_Odm); ++ u1Byte p = 0; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ if(pDM_Odm->mp_mode == FALSE) ++ pHalData->TxPowerTrackControl = TRUE; ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ pRFCalibrateInfo->bTXPowerTracking = _TRUE; ++ pRFCalibrateInfo->TXPowercount = 0; ++ pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; ++ ++ if(pDM_Odm->mp_mode == FALSE) ++ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; ++ else ++ pRFCalibrateInfo->TxPowerTrackControl = _FALSE; ++ ++ if(pDM_Odm->mp_mode == FALSE) ++ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("pDM_Odm TxPowerTrackControl = %d\n", pRFCalibrateInfo->TxPowerTrackControl)); ++ ++#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ #ifdef RTL8188E_SUPPORT ++ { ++ pRFCalibrateInfo->bTXPowerTracking = _TRUE; ++ pRFCalibrateInfo->TXPowercount = 0; ++ pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; ++ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; ++ } ++ #endif ++#endif ++ ++ //pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = TRUE; ++ pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; ++ pRFCalibrateInfo->ThermalValue_IQK = pHalData->EEPROMThermalMeter; ++ pRFCalibrateInfo->ThermalValue_LCK = pHalData->EEPROMThermalMeter; ++ ++ if (pRFCalibrateInfo->DefaultBbSwingIndexFlag != TRUE) { ++ /*The index of "0 dB" in SwingTable.*/ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || ++ pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8703B) { ++ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= OFDM_TABLE_SIZE) ? 30 : defaultSwingIndex; ++ pRFCalibrateInfo->DefaultCckIndex = 20; ++ } else if (pDM_Odm->SupportICType == ODM_RTL8188F) { /*add by Mingzhi.Guo 2015-03-23*/ ++ pRFCalibrateInfo->DefaultOfdmIndex = 28; /*OFDM: -1dB*/ ++ pRFCalibrateInfo->DefaultCckIndex = 20; /*CCK:-6dB*/ ++ } else if (pDM_Odm->SupportICType == ODM_RTL8723D) { /*add by zhaohe 2015-10-27*/ ++ pRFCalibrateInfo->DefaultOfdmIndex = 28; /*OFDM: -1dB*/ ++ pRFCalibrateInfo->DefaultCckIndex = 28; /*CCK: -6dB*/ ++ } else { ++ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= TXSCALE_TABLE_SIZE) ? 24 : defaultSwingIndex; ++ pRFCalibrateInfo->DefaultCckIndex = 24; ++ } ++ pRFCalibrateInfo->DefaultBbSwingIndexFlag = TRUE; ++ } ++ ++ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; ++ pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->DefaultCckIndex; ++ ++ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) ++ { ++ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; ++ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; ++ pRFCalibrateInfo->DeltaPowerIndex[p] = 0; ++ pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; ++ pRFCalibrateInfo->PowerIndexOffset[p] = 0; ++ } ++ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM = 0; ++ pRFCalibrateInfo->Modify_TxAGC_Value_CCK = 0; ++ ++} ++ ++ ++VOID ++ODM_TXPowerTrackingCheck( ++ IN PVOID pDM_VOID ++ ) ++{ ++ /* 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate ++ at the same time. In the stage2/3, we need to prive universal interface and merge all ++ HW dynamic mechanism. */ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ switch (pDM_Odm->SupportPlatform) ++ { ++ case ODM_WIN: ++ odm_TXPowerTrackingCheckMP(pDM_Odm); ++ break; ++ ++ case ODM_CE: ++ odm_TXPowerTrackingCheckCE(pDM_Odm); ++ break; ++ ++ case ODM_AP: ++ odm_TXPowerTrackingCheckAP(pDM_Odm); ++ break; ++ ++ default: ++ break; ++ } ++ ++} ++ ++VOID ++odm_TXPowerTrackingCheckCE( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) ++ return; ++ ++ if (!pDM_Odm->RFCalibrateInfo.TM_Trigger) { ++ ++ if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_8188F(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) ++ || IS_HARDWARE_TYPE_8723B(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter) ++ || IS_HARDWARE_TYPE_8703B(Adapter) || IS_HARDWARE_TYPE_8723D(Adapter) || IS_HARDWARE_TYPE_8822B(Adapter) ++ || IS_HARDWARE_TYPE_8821C(Adapter) ++ ) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_NEW, (BIT17 | BIT16), 0x03); ++ } else { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_OLD, bRFRegOffsetMask, 0x60); ++ } ++ ++ ++ ++ pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; ++ return; ++ } ++ else ++ { ++ ++ ODM_TXPowerTrackingCallback_ThermalMeter(Adapter); ++ pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; ++ } ++ ++#endif ++} ++ ++VOID ++odm_TXPowerTrackingCheckMP( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ if (ODM_CheckPowerStatus(Adapter) == FALSE) ++ { ++ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("===>ODM_CheckPowerStatus() return FALSE\n")); ++ return; ++ } ++ ++ odm_TXPowerTrackingThermalMeterCheck(Adapter); ++#endif ++ ++} ++ ++ ++VOID ++odm_TXPowerTrackingCheckAP( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ ++ return; ++ ++#endif ++} ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++odm_TXPowerTrackingThermalMeterCheck( ++ IN PADAPTER Adapter ++ ) ++{ ++#ifndef AP_BUILD_WORKAROUND ++ static u1Byte TM_Trigger = 0; ++ ++ if (!(GET_HAL_DATA(Adapter)->DM_OutSrc.SupportAbility & ODM_RF_TX_PWR_TRACK)) { ++ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ++ ("===>odm_TXPowerTrackingThermalMeterCheck(),pMgntInfo->bTXPowerTracking is FALSE, return!!\n")); ++ return; ++ } ++ ++ if (!TM_Trigger) { ++ if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) || ++ IS_HARDWARE_TYPE_8723B(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter) || IS_HARDWARE_TYPE_8188F(Adapter) ++ || IS_HARDWARE_TYPE_8703B(Adapter) || IS_HARDWARE_TYPE_8723D(Adapter)) ++ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03); ++ else ++ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); ++ ++ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger Thermal Meter!!\n")); ++ ++ TM_Trigger = 1; ++ return; ++ } else { ++ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n")); ++ odm_TXPowerTrackingDirectCall(Adapter); ++ TM_Trigger = 0; ++ } ++#endif ++} ++#endif ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.h 2018-02-11 21:44:27.157146238 +0200 +@@ -0,0 +1,334 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMPOWERTRACKING_H__ ++#define __PHYDMPOWERTRACKING_H__ ++ ++#define POWRTRACKING_VERSION "1.1" ++ ++#define DPK_DELTA_MAPPING_NUM 13 ++#define index_mapping_HP_NUM 15 ++#define OFDM_TABLE_SIZE 43 ++#define CCK_TABLE_SIZE 33 ++#define CCK_TABLE_SIZE_88F 21 ++#define TXSCALE_TABLE_SIZE 37 ++#define CCK_TABLE_SIZE_8723D 41 ++ ++#define TXPWR_TRACK_TABLE_SIZE 30 ++#define DELTA_SWINGIDX_SIZE 30 ++#define DELTA_SWINTSSI_SIZE 61 ++#define BAND_NUM 4 ++ ++#define AVG_THERMAL_NUM 8 ++#define HP_THERMAL_NUM 8 ++#define IQK_MAC_REG_NUM 4 ++#define IQK_ADDA_REG_NUM 16 ++#define IQK_BB_REG_NUM_MAX 10 ++ ++#define IQK_BB_REG_NUM 9 ++ ++ ++ ++#define IQK_Matrix_REG_NUM 8 ++#define IQK_Matrix_Settings_NUM 14+24+21 // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G ++ ++extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE]; ++extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; ++extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; ++ ++extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE]; ++extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; ++extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; ++extern u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16]; ++extern u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16]; ++extern u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16]; ++extern u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D]; ++ ++extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; ++ ++// <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. ++static u1Byte DeltaSwingTableIdx_2GA_P_8188E[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; ++static u1Byte DeltaSwingTableIdx_2GA_N_8188E[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; ++ ++#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck ++ ++typedef struct _IQK_MATRIX_REGS_SETTING{ ++ BOOLEAN bIQKDone; ++ s4Byte Value[3][IQK_Matrix_REG_NUM]; ++ BOOLEAN bBWIqkResultSaved[3]; ++}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; ++ ++typedef struct ODM_RF_Calibration_Structure ++{ ++ //for tx power tracking ++ ++ u4Byte RegA24; // for TempCCK ++ s4Byte RegE94; ++ s4Byte RegE9C; ++ s4Byte RegEB4; ++ s4Byte RegEBC; ++ ++ u1Byte TXPowercount; ++ BOOLEAN bTXPowerTrackingInit; ++ BOOLEAN bTXPowerTracking; ++ u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default ++ u1Byte TM_Trigger; ++ u1Byte InternalPA5G[2]; //pathA / pathB ++ ++ u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 ++ u1Byte ThermalValue; ++ u1Byte ThermalValue_LCK; ++ u1Byte ThermalValue_IQK; ++ u1Byte ThermalValue_DPK; ++ u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; ++ u1Byte ThermalValue_AVG_index; ++ u1Byte ThermalValue_RxGain; ++ u1Byte ThermalValue_Crystal; ++ u1Byte ThermalValue_DPKstore; ++ u1Byte ThermalValue_DPKtrack; ++ BOOLEAN TxPowerTrackingInProgress; ++ ++ BOOLEAN bReloadtxpowerindex; ++ u1Byte bRfPiEnable; ++ u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug ++ ++ ++ //------------------------- Tx power Tracking -------------------------// ++ u1Byte bCCKinCH14; ++ u1Byte CCK_index; ++ u1Byte OFDM_index[MAX_RF_PATH]; ++ s1Byte PowerIndexOffset[MAX_RF_PATH]; ++ s1Byte DeltaPowerIndex[MAX_RF_PATH]; ++ s1Byte DeltaPowerIndexLast[MAX_RF_PATH]; ++ BOOLEAN bTxPowerChanged; ++ s1Byte XtalOffset; ++ s1Byte XtalOffsetLast; ++ ++ u1Byte ThermalValue_HP[HP_THERMAL_NUM]; ++ u1Byte ThermalValue_HP_index; ++ IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; ++ u1Byte Delta_LCK; ++ s1Byte BBSwingDiff2G, BBSwingDiff5G; // Unit: dB ++ u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKC_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKC_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKD_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKD_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GC_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GC_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GD_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GD_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GC_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GC_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GD_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GD_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GCCKA[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GCCKB[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GCCKC[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GCCKD[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GA[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GB[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GC[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GD[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_5GA[BAND_NUM][DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_5GB[BAND_NUM][DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_5GC[BAND_NUM][DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_5GD[BAND_NUM][DELTA_SWINTSSI_SIZE]; ++ s1Byte DeltaSwingTableXtal_P[DELTA_SWINGIDX_SIZE]; ++ s1Byte DeltaSwingTableXtal_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; ++ ++ u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; ++ u1Byte BbSwingIdxOfdmCurrent; ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; ++#else ++ u1Byte BbSwingIdxOfdmBase; ++#endif ++ BOOLEAN DefaultBbSwingIndexFlag; ++ BOOLEAN BbSwingFlagOfdm; ++ u1Byte BbSwingIdxCck; ++ u1Byte BbSwingIdxCckCurrent; ++ u1Byte BbSwingIdxCckBase; ++ u1Byte DefaultOfdmIndex; ++ u1Byte DefaultCckIndex; ++ BOOLEAN BbSwingFlagCck; ++ ++ s1Byte Absolute_OFDMSwingIdx[MAX_RF_PATH]; ++ s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; ++ s1Byte Absolute_CCKSwingIdx[MAX_RF_PATH]; ++ s1Byte Remnant_CCKSwingIdx; ++ s1Byte Modify_TxAGC_Value; /*Remnat compensate value at TxAGC */ ++ BOOLEAN Modify_TxAGC_Flag_PathA; ++ BOOLEAN Modify_TxAGC_Flag_PathB; ++ BOOLEAN Modify_TxAGC_Flag_PathC; ++ BOOLEAN Modify_TxAGC_Flag_PathD; ++ BOOLEAN Modify_TxAGC_Flag_PathA_CCK; ++ ++ s1Byte KfreeOffset[MAX_RF_PATH]; ++ ++ //--------------------------------------------------------------------// ++ ++ //for IQK ++ u4Byte RegC04; ++ u4Byte Reg874; ++ u4Byte RegC08; ++ u4Byte RegB68; ++ u4Byte RegB6C; ++ u4Byte Reg870; ++ u4Byte Reg860; ++ u4Byte Reg864; ++ ++ BOOLEAN bIQKInitialized; ++ BOOLEAN bLCKInProgress; ++ BOOLEAN bAntennaDetected; ++ BOOLEAN bNeedIQK; ++ BOOLEAN bIQKInProgress; ++ BOOLEAN bIQKPAoff; ++ u1Byte Delta_IQK; ++ u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; ++ u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; ++ u4Byte IQK_BB_backup_recover[9]; ++ u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; ++ u4Byte TxIQC_8723B[2][3][2]; // { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} ++ u4Byte RxIQC_8723B[2][2][2]; // { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} ++ u4Byte TxIQC_8703B[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ ++ u4Byte RxIQC_8703B[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ ++ u4Byte TxIQC_8723D[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ ++ u4Byte RxIQC_8723D[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ ++ ++ u1Byte IQKstep; ++ u1Byte Kcount; ++ u1Byte retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ ++ BOOLEAN isMPmode; ++ ++ ++ ++ // IQK time measurement ++ u8Byte IQK_StartTime; ++ u8Byte IQK_ProgressingTime; ++ u8Byte IQK_TotalProgressingTime; ++ ++ u4Byte LOK_Result; ++ ++ //for APK ++ u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a ++ u1Byte bAPKdone; ++ u1Byte bAPKThermalMeterIgnore; ++ ++ // DPK ++ BOOLEAN bDPKFail; ++ u1Byte bDPdone; ++ u1Byte bDPPathAOK; ++ u1Byte bDPPathBOK; ++ ++ u4Byte TxLOK[2]; ++ u4Byte DpkTxAGC; ++ s4Byte DpkGain; ++ u4Byte DpkThermal[4]; ++ s1Byte Modify_TxAGC_Value_OFDM; ++ s1Byte Modify_TxAGC_Value_CCK; ++ ++ /*Add by Yuchen for Kfree Phydm*/ ++ u1Byte RegRfKFreeEnable; /*for registry*/ ++ u1Byte RfKFreeEnable; /*for efuse enable check*/ ++ ++}ODM_RF_CAL_T,*PODM_RF_CAL_T; ++ ++ ++VOID ++ODM_TXPowerTrackingCheck( ++ IN PVOID pDM_VOID ++ ); ++ ++ ++VOID ++odm_TXPowerTrackingInit( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_TXPowerTrackingCheckAP( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_TXPowerTrackingThermalMeterInit( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_TXPowerTrackingInit( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_TXPowerTrackingCheckMP( ++ IN PVOID pDM_VOID ++ ); ++ ++ ++VOID ++odm_TXPowerTrackingCheckCE( ++ IN PVOID pDM_VOID ++ ); ++ ++#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ ++VOID ++odm_TXPowerTrackingCallbackThermalMeter92C( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_TXPowerTrackingCallbackRXGainThermalMeter92D( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_TXPowerTrackingCallbackThermalMeter92D( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_TXPowerTrackingDirectCall92C( ++ IN PADAPTER Adapter ++ ); ++ ++VOID ++odm_TXPowerTrackingThermalMeterCheck( ++ IN PADAPTER Adapter ++ ); ++ ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.c 2018-02-11 21:44:27.157146238 +0200 +@@ -0,0 +1,784 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++//============================================================ ++// Global var ++//============================================================ ++ ++u4Byte OFDMSwingTable[OFDM_TABLE_SIZE] = { ++ 0x7f8001fe, // 0, +6.0dB ++ 0x788001e2, // 1, +5.5dB ++ 0x71c001c7, // 2, +5.0dB ++ 0x6b8001ae, // 3, +4.5dB ++ 0x65400195, // 4, +4.0dB ++ 0x5fc0017f, // 5, +3.5dB ++ 0x5a400169, // 6, +3.0dB ++ 0x55400155, // 7, +2.5dB ++ 0x50800142, // 8, +2.0dB ++ 0x4c000130, // 9, +1.5dB ++ 0x47c0011f, // 10, +1.0dB ++ 0x43c0010f, // 11, +0.5dB ++ 0x40000100, // 12, +0dB ++ 0x3c8000f2, // 13, -0.5dB ++ 0x390000e4, // 14, -1.0dB ++ 0x35c000d7, // 15, -1.5dB ++ 0x32c000cb, // 16, -2.0dB ++ 0x300000c0, // 17, -2.5dB ++ 0x2d4000b5, // 18, -3.0dB ++ 0x2ac000ab, // 19, -3.5dB ++ 0x288000a2, // 20, -4.0dB ++ 0x26000098, // 21, -4.5dB ++ 0x24000090, // 22, -5.0dB ++ 0x22000088, // 23, -5.5dB ++ 0x20000080, // 24, -6.0dB ++ 0x1e400079, // 25, -6.5dB ++ 0x1c800072, // 26, -7.0dB ++ 0x1b00006c, // 27. -7.5dB ++ 0x19800066, // 28, -8.0dB ++ 0x18000060, // 29, -8.5dB ++ 0x16c0005b, // 30, -9.0dB ++ 0x15800056, // 31, -9.5dB ++ 0x14400051, // 32, -10.0dB ++ 0x1300004c, // 33, -10.5dB ++ 0x12000048, // 34, -11.0dB ++ 0x11000044, // 35, -11.5dB ++ 0x10000040, // 36, -12.0dB ++}; ++ ++u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { ++ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, // 0, +0dB ++ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 1, -0.5dB ++ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 2, -1.0dB ++ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 3, -1.5dB ++ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 4, -2.0dB ++ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 5, -2.5dB ++ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 6, -3.0dB ++ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 7, -3.5dB ++ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 8, -4.0dB ++ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 9, -4.5dB ++ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 10, -5.0dB ++ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 11, -5.5dB ++ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 12, -6.0dB <== default ++ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 13, -6.5dB ++ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 14, -7.0dB ++ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 15, -7.5dB ++ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB ++ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 17, -8.5dB ++ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 18, -9.0dB ++ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 19, -9.5dB ++ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 20, -10.0dB ++ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 21, -10.5dB ++ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 22, -11.0dB ++ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 23, -11.5dB ++ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 24, -12.0dB ++ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 25, -12.5dB ++ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 26, -13.0dB ++ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 27, -13.5dB ++ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 28, -14.0dB ++ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 29, -14.5dB ++ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 30, -15.0dB ++ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 31, -15.5dB ++ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} // 32, -16.0dB ++}; ++ ++ ++u1Byte CCKSwingTable_Ch14[CCK_TABLE_SIZE][8] = { ++ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, // 0, +0dB ++ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 1, -0.5dB ++ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 2, -1.0dB ++ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 3, -1.5dB ++ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 4, -2.0dB ++ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 5, -2.5dB ++ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 6, -3.0dB ++ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 7, -3.5dB ++ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 8, -4.0dB ++ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 9, -4.5dB ++ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 10, -5.0dB ++ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 11, -5.5dB ++ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 12, -6.0dB <== default ++ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 13, -6.5dB ++ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 14, -7.0dB ++ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 15, -7.5dB ++ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB ++ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 17, -8.5dB ++ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 18, -9.0dB ++ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 19, -9.5dB ++ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 20, -10.0dB ++ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 21, -10.5dB ++ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 22, -11.0dB ++ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 23, -11.5dB ++ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 24, -12.0dB ++ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 25, -12.5dB ++ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 26, -13.0dB ++ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 27, -13.5dB ++ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 28, -14.0dB ++ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 29, -14.5dB ++ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 30, -15.0dB ++ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 31, -15.5dB ++ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00} // 32, -16.0dB ++}; ++ ++ ++u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE] = { ++ 0x0b40002d, // 0, -15.0dB ++ 0x0c000030, // 1, -14.5dB ++ 0x0cc00033, // 2, -14.0dB ++ 0x0d800036, // 3, -13.5dB ++ 0x0e400039, // 4, -13.0dB ++ 0x0f00003c, // 5, -12.5dB ++ 0x10000040, // 6, -12.0dB ++ 0x11000044, // 7, -11.5dB ++ 0x12000048, // 8, -11.0dB ++ 0x1300004c, // 9, -10.5dB ++ 0x14400051, // 10, -10.0dB ++ 0x15800056, // 11, -9.5dB ++ 0x16c0005b, // 12, -9.0dB ++ 0x18000060, // 13, -8.5dB ++ 0x19800066, // 14, -8.0dB ++ 0x1b00006c, // 15, -7.5dB ++ 0x1c800072, // 16, -7.0dB ++ 0x1e400079, // 17, -6.5dB ++ 0x20000080, // 18, -6.0dB ++ 0x22000088, // 19, -5.5dB ++ 0x24000090, // 20, -5.0dB ++ 0x26000098, // 21, -4.5dB ++ 0x288000a2, // 22, -4.0dB ++ 0x2ac000ab, // 23, -3.5dB ++ 0x2d4000b5, // 24, -3.0dB ++ 0x300000c0, // 25, -2.5dB ++ 0x32c000cb, // 26, -2.0dB ++ 0x35c000d7, // 27, -1.5dB ++ 0x390000e4, // 28, -1.0dB ++ 0x3c8000f2, // 29, -0.5dB ++ 0x40000100, // 30, +0dB ++ 0x43c0010f, // 31, +0.5dB ++ 0x47c0011f, // 32, +1.0dB ++ 0x4c000130, // 33, +1.5dB ++ 0x50800142, // 34, +2.0dB ++ 0x55400155, // 35, +2.5dB ++ 0x5a400169, // 36, +3.0dB ++ 0x5fc0017f, // 37, +3.5dB ++ 0x65400195, // 38, +4.0dB ++ 0x6b8001ae, // 39, +4.5dB ++ 0x71c001c7, // 40, +5.0dB ++ 0x788001e2, // 41, +5.5dB ++ 0x7f8001fe // 42, +6.0dB ++}; ++ ++ ++u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { ++{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ ++{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ ++{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ ++{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ ++{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ ++{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ ++{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ ++{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ ++{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ ++{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ ++{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ ++{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ ++{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ ++{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ ++{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ ++{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ ++{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ ++{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ ++{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ ++{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ ++{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ ++}; ++ ++ ++u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16] = { ++{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ ++{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ ++{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ ++{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ ++{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ ++{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ ++{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ ++{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ ++{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ ++{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ ++{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ ++{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ ++{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ ++{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ ++{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ ++{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ ++{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ ++{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ ++{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ ++{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ ++{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ ++}; ++ ++ ++u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { ++{0x44, 0x42, 0x3C, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ ++{0x48, 0x46, 0x3F, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ ++{0x4D, 0x4A, 0x43, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ ++{0x51, 0x4F, 0x47, 0x2F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ ++{0x56, 0x53, 0x4B, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ ++{0x5B, 0x58, 0x50, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ ++{0x60, 0x5D, 0x54, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ ++{0x66, 0x63, 0x59, 0x3B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ ++{0x6C, 0x69, 0x5F, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ ++{0x73, 0x6F, 0x64, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ ++{0x79, 0x76, 0x6A, 0x46, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ ++{0x81, 0x7C, 0x71, 0x4A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ ++{0x88, 0x84, 0x77, 0x4F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ ++{0x90, 0x8C, 0x7E, 0x54, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ ++{0x99, 0x94, 0x86, 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ ++{0xA2, 0x9D, 0x8E, 0x5E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ ++{0xAC, 0xA6, 0x96, 0x63, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ ++{0xB6, 0xB0, 0x9F, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ ++{0xC1, 0xBA, 0xA8, 0x6F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ ++{0xCC, 0xC5, 0xB2, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ ++{0xD8, 0xD1, 0xBD, 0x7D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ ++}; ++ ++ ++ ++ ++u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { ++ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB ++ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB ++ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB ++ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB ++ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB ++ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB ++ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB ++ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB ++ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB ++ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB ++ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB ++ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB ++ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB ++ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB ++ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB ++ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB ++ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB ++ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB ++ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB ++ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB ++ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 20, -6.0dB ++ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB ++ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB ++ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB ++ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB ++ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB ++ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB ++ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB ++ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB ++ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB ++ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB ++ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB ++ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB ++}; ++ ++ ++u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { ++ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB ++ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB ++ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB ++ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB ++ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB ++ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB ++ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB ++ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB ++ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB ++ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB ++ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB ++ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB ++ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB ++ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB ++ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB ++ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB ++ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB ++ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB ++ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB ++ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB ++ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB ++ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB ++ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB ++ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB ++ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB ++ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB ++ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB ++ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB ++ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB ++ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB ++ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB ++ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB ++ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB ++}; ++u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D] = { ++ 0x0CD, ++ 0x0D9, ++ 0x0E6, ++ 0x0F3, ++ 0x102, ++ 0x111, ++ 0x121, ++ 0x132, ++ 0x144, ++ 0x158, ++ 0x16C, ++ 0x182, ++ 0x198, ++ 0x1B1, ++ 0x1CA, ++ 0x1E5, ++ 0x202, ++ 0x221, ++ 0x241, ++ 0x263, ++ 0x287, ++ 0x2AE, ++ 0x2D6, ++ 0x301, ++ 0x32F, ++ 0x35F, ++ 0x392, ++ 0x3C9, ++ 0x402, ++ 0x43F, ++ 0x47F, ++ 0x4C3, ++ 0x50C, ++ 0x558, ++ 0x5A9, ++ 0x5FF, ++ 0x65A, ++ 0x6BA, ++ 0x720, ++ 0x78C, ++ 0x7FF, ++}; ++ ++ ++u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = ++{ ++ 0x081, // 0, -12.0dB ++ 0x088, // 1, -11.5dB ++ 0x090, // 2, -11.0dB ++ 0x099, // 3, -10.5dB ++ 0x0A2, // 4, -10.0dB ++ 0x0AC, // 5, -9.5dB ++ 0x0B6, // 6, -9.0dB ++ 0x0C0, // 7, -8.5dB ++ 0x0CC, // 8, -8.0dB ++ 0x0D8, // 9, -7.5dB ++ 0x0E5, // 10, -7.0dB ++ 0x0F2, // 11, -6.5dB ++ 0x101, // 12, -6.0dB ++ 0x110, // 13, -5.5dB ++ 0x120, // 14, -5.0dB ++ 0x131, // 15, -4.5dB ++ 0x143, // 16, -4.0dB ++ 0x156, // 17, -3.5dB ++ 0x16A, // 18, -3.0dB ++ 0x180, // 19, -2.5dB ++ 0x197, // 20, -2.0dB ++ 0x1AF, // 21, -1.5dB ++ 0x1C8, // 22, -1.0dB ++ 0x1E3, // 23, -0.5dB ++ 0x200, // 24, +0 dB ++ 0x21E, // 25, +0.5dB ++ 0x23E, // 26, +1.0dB ++ 0x261, // 27, +1.5dB ++ 0x285, // 28, +2.0dB ++ 0x2AB, // 29, +2.5dB ++ 0x2D3, // 30, +3.0dB ++ 0x2FE, // 31, +3.5dB ++ 0x32B, // 32, +4.0dB ++ 0x35C, // 33, +4.5dB ++ 0x38E, // 34, +5.0dB ++ 0x3C4, // 35, +5.5dB ++ 0x3FE // 36, +6.0dB ++}; ++ ++ ++#ifdef AP_BUILD_WORKAROUND ++ ++unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { ++ /* +6.0dB */ 0x7f8001fe, ++ /* +5.5dB */ 0x788001e2, ++ /* +5.0dB */ 0x71c001c7, ++ /* +4.5dB */ 0x6b8001ae, ++ /* +4.0dB */ 0x65400195, ++ /* +3.5dB */ 0x5fc0017f, ++ /* +3.0dB */ 0x5a400169, ++ /* +2.5dB */ 0x55400155, ++ /* +2.0dB */ 0x50800142, ++ /* +1.5dB */ 0x4c000130, ++ /* +1.0dB */ 0x47c0011f, ++ /* +0.5dB */ 0x43c0010f, ++ /* 0.0dB */ 0x40000100, ++ /* -0.5dB */ 0x3c8000f2, ++ /* -1.0dB */ 0x390000e4, ++ /* -1.5dB */ 0x35c000d7, ++ /* -2.0dB */ 0x32c000cb, ++ /* -2.5dB */ 0x300000c0, ++ /* -3.0dB */ 0x2d4000b5, ++ /* -3.5dB */ 0x2ac000ab, ++ /* -4.0dB */ 0x288000a2, ++ /* -4.5dB */ 0x26000098, ++ /* -5.0dB */ 0x24000090, ++ /* -5.5dB */ 0x22000088, ++ /* -6.0dB */ 0x20000080, ++ /* -6.5dB */ 0x1a00006c, ++ /* -7.0dB */ 0x1c800072, ++ /* -7.5dB */ 0x18000060, ++ /* -8.0dB */ 0x19800066, ++ /* -8.5dB */ 0x15800056, ++ /* -9.0dB */ 0x26c0005b, ++ /* -9.5dB */ 0x14400051, ++ /* -10.0dB */ 0x24400051, ++ /* -10.5dB */ 0x1300004c, ++ /* -11.0dB */ 0x12000048, ++ /* -11.5dB */ 0x11000044, ++ /* -12.0dB */ 0x10000040 ++}; ++ ++#endif ++ ++VOID ++odm_TXPowerTrackingInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ if (!(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_IC_11N_SERIES | ODM_RTL8822B))) ++ return; ++#endif ++ ++ odm_TXPowerTrackingThermalMeterInit(pDM_Odm); ++} ++ ++u1Byte ++getSwingIndex( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u1Byte i = 0; ++ u4Byte bbSwing; ++ u4Byte swingTableSize; ++ pu4Byte pSwingTable; ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || ++ pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8703B) ++ { ++ bbSwing = PHY_QueryBBReg(Adapter, rOFDM0_XATxIQImbalance, 0xFFC00000); ++ ++ pSwingTable = OFDMSwingTable_New; ++ swingTableSize = OFDM_TABLE_SIZE; ++ } else { ++ bbSwing = PHY_GetTxBBSwing_8812A(Adapter, pHalData->CurrentBandType, ODM_RF_PATH_A); ++ pSwingTable = TxScalingTable_Jaguar; ++ swingTableSize = TXSCALE_TABLE_SIZE; ++ } ++ ++ for (i = 0; i < swingTableSize; ++i) { ++ u4Byte tableValue = pSwingTable[i]; ++ ++ if (tableValue >= 0x100000 ) ++ tableValue >>= 22; ++ if (bbSwing == tableValue) ++ break; ++ } ++ return i; ++} ++ ++VOID ++odm_TXPowerTrackingThermalMeterInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte defaultSwingIndex = getSwingIndex(pDM_Odm); ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u1Byte p = 0; ++ ++ if(pDM_Odm->mp_mode == FALSE) ++ pRFCalibrateInfo->TxPowerTrackControl = TRUE; ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #ifdef CONFIG_RTL8188E ++ { ++ pRFCalibrateInfo->bTXPowerTracking = _TRUE; ++ pRFCalibrateInfo->TXPowercount = 0; ++ pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; ++ ++ if(pDM_Odm->mp_mode == FALSE) ++ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; ++ ++ MSG_8192C("pDM_Odm TxPowerTrackControl = %d\n", pRFCalibrateInfo->TxPowerTrackControl); ++ } ++ #else ++ { ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ ++ pdmpriv->bTXPowerTracking = _TRUE; ++ pdmpriv->TXPowercount = 0; ++ pdmpriv->bTXPowerTrackingInit = _FALSE; ++ ++ if(pDM_Odm->mp_mode == FALSE) ++ pdmpriv->TxPowerTrackControl = _TRUE; ++ ++ MSG_8192C("pdmpriv->TxPowerTrackControl = %d\n", pdmpriv->TxPowerTrackControl); ++ ++ } ++ #endif ++#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ #ifdef RTL8188E_SUPPORT ++ { ++ pRFCalibrateInfo->bTXPowerTracking = _TRUE; ++ pRFCalibrateInfo->TXPowercount = 0; ++ pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; ++ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; ++ } ++ #endif ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #if (MP_DRIVER == 1) ++ pRFCalibrateInfo->TxPowerTrackControl = FALSE; ++ #else ++ pRFCalibrateInfo->TxPowerTrackControl = TRUE; ++ #endif ++#else ++ pRFCalibrateInfo->TxPowerTrackControl = TRUE; ++#endif ++ ++ pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; ++ pRFCalibrateInfo->ThermalValue_IQK = pHalData->EEPROMThermalMeter; ++ pRFCalibrateInfo->ThermalValue_LCK = pHalData->EEPROMThermalMeter; ++ ++ if (pRFCalibrateInfo->DefaultBbSwingIndexFlag != TRUE) { ++ /*The index of "0 dB" in SwingTable.*/ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || ++ pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8703B) { ++ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= OFDM_TABLE_SIZE) ? 30 : defaultSwingIndex; ++ pRFCalibrateInfo->DefaultCckIndex = 20; ++ } else if (pDM_Odm->SupportICType == ODM_RTL8188F) { /*add by Mingzhi.Guo 2015-03-23*/ ++ pRFCalibrateInfo->DefaultOfdmIndex = 28; /*OFDM: -1dB*/ ++ pRFCalibrateInfo->DefaultCckIndex = 20; /*CCK:-6dB*/ ++ } else if (pDM_Odm->SupportICType == ODM_RTL8723D) { /*add by zhaohe 2015-10-27*/ ++ pRFCalibrateInfo->DefaultOfdmIndex = 28; /*OFDM: -1dB*/ ++ pRFCalibrateInfo->DefaultCckIndex = 28; /*CCK: -6dB*/ ++ } else { ++ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= TXSCALE_TABLE_SIZE) ? 24 : defaultSwingIndex; ++ pRFCalibrateInfo->DefaultCckIndex = 24; ++ } ++ pRFCalibrateInfo->DefaultBbSwingIndexFlag = TRUE; ++ } ++ ++ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; ++ pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->DefaultCckIndex; ++ ++ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) ++ { ++ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; ++ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; ++ pRFCalibrateInfo->DeltaPowerIndex[p] = 0; ++ pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; ++ pRFCalibrateInfo->PowerIndexOffset[p] = 0; ++ pRFCalibrateInfo->KfreeOffset[p] = 0; ++ } ++ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM = 0; ++ pRFCalibrateInfo->Modify_TxAGC_Value_CCK = 0; ++ ++} ++ ++ ++VOID ++ODM_TXPowerTrackingCheck( ++ IN PVOID pDM_VOID ++ ) ++{ ++ ++ /* 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate ++ // at the same time. In the stage2/3, we need to prive universal interface and merge all ++ // HW dynamic mechanism.*/ ++ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ switch (pDM_Odm->SupportPlatform) ++ { ++ case ODM_WIN: ++ odm_TXPowerTrackingCheckMP(pDM_Odm); ++ break; ++ ++ case ODM_CE: ++ odm_TXPowerTrackingCheckCE(pDM_Odm); ++ break; ++ ++ case ODM_AP: ++ odm_TXPowerTrackingCheckAP(pDM_Odm); ++ break; ++ ++ default: ++ break; ++ } ++ ++} ++ ++VOID ++odm_TXPowerTrackingCheckCE( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ #if ((RTL8188F_SUPPORT == 1)) ++ rtl8192c_odm_CheckTXPowerTracking(Adapter); ++ #endif ++ ++ #if(RTL8188E_SUPPORT==1) ++ ++ if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) { ++ return; ++ } ++ ++ if (!pRFCalibrateInfo->TM_Trigger) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); ++ /*DBG_8192C("Trigger 92C Thermal Meter!!\n");*/ ++ ++ pRFCalibrateInfo->TM_Trigger = 1; ++ return; ++ ++ } else { ++ /*DBG_8192C("Schedule TxPowerTracking direct call!!\n");*/ ++ odm_TXPowerTrackingCallback_ThermalMeter_8188E(Adapter); ++ pRFCalibrateInfo->TM_Trigger = 0; ++ } ++ #endif ++#endif ++} ++ ++VOID ++odm_TXPowerTrackingCheckMP( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ if (*pDM_Odm->pIsFcsModeEnable) ++ return; ++ ++ if (ODM_CheckPowerStatus(Adapter) == FALSE) ++ { ++ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("===>ODM_CheckPowerStatus() return FALSE\n")); ++ return; ++ } ++ ++ if (IS_HARDWARE_TYPE_8821B(Adapter)) /* TODO: Don't Do PowerTracking*/ ++ return; ++ ++ odm_TXPowerTrackingThermalMeterCheck(Adapter); ++ ++ ++#endif ++ ++} ++ ++ ++VOID ++odm_TXPowerTrackingCheckAP( ++ IN PVOID pDM_VOID ++ ) ++{ ++return; ++ ++} ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++VOID ++odm_TXPowerTrackingDirectCall( ++ IN PADAPTER Adapter ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ ++ ODM_TXPowerTrackingCallback_ThermalMeter(Adapter); ++} ++ ++VOID ++odm_TXPowerTrackingThermalMeterCheck( ++ IN PADAPTER Adapter ++ ) ++{ ++#ifndef AP_BUILD_WORKAROUND ++ static u1Byte TM_Trigger = 0; ++ ++ if (!(GET_HAL_DATA(Adapter)->DM_OutSrc.SupportAbility & ODM_RF_TX_PWR_TRACK)) ++ { ++ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ++ ("===>odm_TXPowerTrackingThermalMeterCheck(),pMgntInfo->bTXPowerTracking is FALSE, return!!\n")); ++ return; ++ } ++ ++ if (!TM_Trigger) ++ { ++ if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) || ++ IS_HARDWARE_TYPE_8723B(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter) || IS_HARDWARE_TYPE_8188F(Adapter) || IS_HARDWARE_TYPE_8703B(Adapter) ++ || IS_HARDWARE_TYPE_8822B(Adapter) || IS_HARDWARE_TYPE_8723D(Adapter) || IS_HARDWARE_TYPE_8821C(Adapter)) ++ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03); ++ else ++ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); ++ ++ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger Thermal Meter!!\n")); ++ ++ TM_Trigger = 1; ++ return; ++ } else { ++ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n")); ++ odm_TXPowerTrackingDirectCall(Adapter); ++ TM_Trigger = 0; ++ } ++#endif ++} ++ ++#endif ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.h 2018-02-11 21:44:27.157146238 +0200 +@@ -0,0 +1,299 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMPOWERTRACKING_H__ ++#define __PHYDMPOWERTRACKING_H__ ++ ++#define POWRTRACKING_VERSION "1.1" ++ ++#define DPK_DELTA_MAPPING_NUM 13 ++#define index_mapping_HP_NUM 15 ++#define TXSCALE_TABLE_SIZE 37 ++#define CCK_TABLE_SIZE_8723D 41 ++#define TXPWR_TRACK_TABLE_SIZE 30 ++#define DELTA_SWINGIDX_SIZE 30 ++#define DELTA_SWINTSSI_SIZE 61 ++#define BAND_NUM 3 ++#define MAX_RF_PATH 4 ++#define CCK_TABLE_SIZE_88F 21 ++ ++ ++#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck ++ ++#define IQK_Matrix_Settings_NUM 14+24+21 // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G ++#define AVG_THERMAL_NUM 8 ++#define HP_THERMAL_NUM 8 ++#define IQK_Matrix_REG_NUM 8 ++#define IQK_MAC_REG_NUM 4 ++#define IQK_ADDA_REG_NUM 16 ++ ++#define IQK_BB_REG_NUM 9 ++ ++ ++extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE]; ++extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; ++extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; ++ ++extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE]; ++extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; ++extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; ++extern u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16]; ++extern u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16]; ++extern u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16]; ++extern u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D]; ++ ++extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; ++ ++// <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. ++static u1Byte DeltaSwingTableIdx_2GA_P_8188E[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; ++static u1Byte DeltaSwingTableIdx_2GA_N_8188E[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; ++ ++VOID ++ODM_TXPowerTrackingCheck( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_TXPowerTrackingCheckAP( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_TXPowerTrackingThermalMeterInit( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_TXPowerTrackingInit( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++odm_TXPowerTrackingCheckMP( ++ IN PVOID pDM_VOID ++ ); ++ ++ ++VOID ++odm_TXPowerTrackingCheckCE( ++ IN PVOID pDM_VOID ++ ); ++ ++#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ ++ ++VOID ++odm_TXPowerTrackingThermalMeterCheck( ++ IN PADAPTER Adapter ++ ); ++ ++#endif ++ ++typedef struct _IQK_MATRIX_REGS_SETTING{ ++ BOOLEAN bIQKDone; ++ s4Byte Value[3][IQK_Matrix_REG_NUM]; ++ BOOLEAN bBWIqkResultSaved[3]; ++}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; ++ ++typedef struct ODM_RF_Calibration_Structure ++{ ++ //for tx power tracking ++ ++ u4Byte RegA24; // for TempCCK ++ s4Byte RegE94; ++ s4Byte RegE9C; ++ s4Byte RegEB4; ++ s4Byte RegEBC; ++ //u1Byte bTXPowerTracking; ++ u1Byte TXPowercount; ++ BOOLEAN bTXPowerTrackingInit; ++ BOOLEAN bTXPowerTracking; ++ u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default ++ u1Byte TM_Trigger; ++ u1Byte InternalPA5G[2]; //pathA / pathB ++ ++ u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 ++ u1Byte ThermalValue; ++ u1Byte ThermalValue_LCK; ++ u1Byte ThermalValue_IQK; ++ u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; ++ u1Byte ThermalValue_AVG_index; ++ u1Byte ThermalValue_RxGain; ++ ++ BOOLEAN bReloadtxpowerindex; ++ u1Byte bRfPiEnable; ++ u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug ++ ++ ++ //------------------------- Tx power Tracking -------------------------// ++ u1Byte bCCKinCH14; ++ u1Byte CCK_index; ++ u1Byte OFDM_index[MAX_RF_PATH]; ++ s1Byte PowerIndexOffset[MAX_RF_PATH]; ++ s1Byte DeltaPowerIndex[MAX_RF_PATH]; ++ s1Byte DeltaPowerIndexLast[MAX_RF_PATH]; ++ BOOLEAN bTxPowerChanged; ++ s1Byte XtalOffset; ++ s1Byte XtalOffsetLast; ++ ++ u1Byte ThermalValue_HP[HP_THERMAL_NUM]; ++ u1Byte ThermalValue_HP_index; ++ IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; ++ u1Byte Delta_LCK; ++ s1Byte BBSwingDiff2G, BBSwingDiff5G; // Unit: dB ++ u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKC_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKC_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKD_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKD_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GC_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GC_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GD_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GD_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GC_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GC_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GD_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GD_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GCCKA[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GCCKB[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GCCKC[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GCCKD[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GA[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GB[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GC[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_2GD[DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_5GA[BAND_NUM][DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_5GB[BAND_NUM][DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_5GC[BAND_NUM][DELTA_SWINTSSI_SIZE]; ++ u1Byte DeltaSwingTSSITable_5GD[BAND_NUM][DELTA_SWINTSSI_SIZE]; ++ s1Byte DeltaSwingTableXtal_P[DELTA_SWINGIDX_SIZE]; ++ s1Byte DeltaSwingTableXtal_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; ++ ++ u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; ++ u1Byte BbSwingIdxOfdmCurrent; ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; ++#else ++ u1Byte BbSwingIdxOfdmBase; ++#endif ++ BOOLEAN DefaultBbSwingIndexFlag; ++ BOOLEAN BbSwingFlagOfdm; ++ u1Byte BbSwingIdxCck; ++ u1Byte BbSwingIdxCckCurrent; ++ u1Byte BbSwingIdxCckBase; ++ u1Byte DefaultOfdmIndex; ++ u1Byte DefaultCckIndex; ++ BOOLEAN BbSwingFlagCck; ++ ++ s1Byte Absolute_OFDMSwingIdx[MAX_RF_PATH]; ++ s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; ++ s1Byte Absolute_CCKSwingIdx[MAX_RF_PATH]; ++ s1Byte Remnant_CCKSwingIdx; ++ s1Byte Modify_TxAGC_Value; /*Remnat compensate value at TxAGC */ ++ BOOLEAN Modify_TxAGC_Flag_PathA; ++ BOOLEAN Modify_TxAGC_Flag_PathB; ++ BOOLEAN Modify_TxAGC_Flag_PathC; ++ BOOLEAN Modify_TxAGC_Flag_PathD; ++ BOOLEAN Modify_TxAGC_Flag_PathA_CCK; ++ ++ s1Byte KfreeOffset[MAX_RF_PATH]; ++ ++ //--------------------------------------------------------------------// ++ ++ //for IQK ++ u4Byte RegC04; ++ u4Byte Reg874; ++ u4Byte RegC08; ++ u4Byte RegB68; ++ u4Byte RegB6C; ++ u4Byte Reg870; ++ u4Byte Reg860; ++ u4Byte Reg864; ++ ++ BOOLEAN bIQKInitialized; ++ BOOLEAN bLCKInProgress; ++ BOOLEAN bAntennaDetected; ++ BOOLEAN bNeedIQK; ++ BOOLEAN bIQKInProgress; ++ BOOLEAN bIQKPAoff; ++ u1Byte Delta_IQK; ++ u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; ++ u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; ++ u4Byte IQK_BB_backup_recover[9]; ++ u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; ++ u4Byte TxIQC_8723B[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ ++ u4Byte RxIQC_8723B[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ ++ u4Byte TxIQC_8703B[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ ++ u4Byte RxIQC_8703B[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ ++ u4Byte TxIQC_8723D[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ ++ u4Byte RxIQC_8723D[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ ++ ++ u8Byte IQK_StartTime; ++ u8Byte IQK_TotalProgressingTime; ++ u8Byte IQK_ProgressingTime; ++ u4Byte LOK_Result; ++ u1Byte IQKstep; ++ u1Byte Kcount; ++ u1Byte retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ ++ BOOLEAN isMPmode; ++ ++ //for APK ++ u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a ++ u1Byte bAPKdone; ++ u1Byte bAPKThermalMeterIgnore; ++ ++ // DPK ++ BOOLEAN bDPKFail; ++ u1Byte bDPdone; ++ u1Byte bDPPathAOK; ++ u1Byte bDPPathBOK; ++ ++ u4Byte TxLOK[2]; ++ u4Byte DpkTxAGC; ++ s4Byte DpkGain; ++ u4Byte DpkThermal[4]; ++ ++ s1Byte Modify_TxAGC_Value_OFDM; ++ s1Byte Modify_TxAGC_Value_CCK; ++ ++ /*Add by Yuchen for Kfree Phydm*/ ++ u1Byte RegRfKFreeEnable; /*for registry*/ ++ u1Byte RfKFreeEnable; /*for efuse enable check*/ ++ ++ HALMAC_PWR_TRACKING_OPTION HALMAC_PWR_TRACKING_INFO; ++}ODM_RF_CAL_T,*PODM_RF_CAL_T; ++ ++ ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_precomp.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_precomp.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_precomp.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_precomp.h 2018-02-11 21:44:27.157146238 +0200 +@@ -0,0 +1,351 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __ODM_PRECOMP_H__ ++#define __ODM_PRECOMP_H__ ++ ++#include "phydm_types.h" ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++#include "Precomp.h" // We need to include mp_precomp.h due to batch file setting. ++#else ++#define TEST_FALG___ 1 ++#endif ++ ++//2 Config Flags and Structs - defined by each ODM Type ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ #include "../8192cd_cfg.h" ++ #include "../odm_inc.h" ++ ++ #include "../8192cd.h" ++ #include "../8192cd_util.h" ++ #ifdef _BIG_ENDIAN_ ++ #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG ++ #else ++ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE ++ #endif ++ ++ #ifdef AP_BUILD_WORKAROUND ++ #include "../8192cd_headers.h" ++ #include "../8192cd_debug.h" ++ #endif ++ ++#elif (DM_ODM_SUPPORT_TYPE ==ODM_CE) ++ #define __PACK ++ #define __WLAN_ATTRIB_PACK__ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #include "mp_precomp.h" ++ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE ++ #define __PACK ++ #define __WLAN_ATTRIB_PACK__ ++#endif ++ ++//2 OutSrc Header Files ++ ++#include "phydm.h" ++#include "phydm_hwconfig.h" ++#include "phydm_debug.h" ++#include "phydm_regdefine11ac.h" ++#include "phydm_regdefine11n.h" ++#include "phydm_interface.h" ++#include "phydm_reg.h" ++ ++#include "phydm_adc_sampling.h" ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++VOID ++PHY_SetTxPowerLimit( ++ IN PDM_ODM_T pDM_Odm, ++ IN u8 *Regulation, ++ IN u8 *Band, ++ IN u8 *Bandwidth, ++ IN u8 *RateSection, ++ IN u8 *RfPath, ++ IN u8 *Channel, ++ IN u8 *PowerLimit ++); ++ ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++#define RTL8703B_SUPPORT 0 ++#define RTL8188F_SUPPORT 0 ++#define RTL8723D_SUPPORT 0 ++#endif ++ ++#if RTL8188E_SUPPORT == 1 ++#define RTL8188E_T_SUPPORT 1 ++#ifdef CONFIG_SFW_SUPPORTED ++#define RTL8188E_S_SUPPORT 1 ++#else ++#define RTL8188E_S_SUPPORT 0 ++#endif ++#endif ++ ++#if (RTL8188E_SUPPORT==1) ++#include "rtl8188e/hal8188erateadaptive.h"//for RA,Power training ++#include "rtl8188e/halhwimg8188e_mac.h" ++#include "rtl8188e/halhwimg8188e_rf.h" ++#include "rtl8188e/halhwimg8188e_bb.h" ++#include "rtl8188e/halhwimg8188e_t_fw.h" ++#include "rtl8188e/halhwimg8188e_s_fw.h" ++#include "rtl8188e/phydm_regconfig8188e.h" ++#include "rtl8188e/phydm_rtl8188e.h" ++#include "rtl8188e/hal8188ereg.h" ++#include "rtl8188e/version_rtl8188e.h" ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #include "rtl8188e_hal.h" ++ #include "rtl8188e/halphyrf_8188e_ce.h" ++#endif ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #include "rtl8188e/halphyrf_8188e_win.h" ++#endif ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ #include "rtl8188e/halphyrf_8188e_ap.h" ++#endif ++#endif //88E END ++ ++#if (RTL8192E_SUPPORT==1) ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #include "rtl8192e/halphyrf_8192e_win.h" /*FOR_8192E_IQK*/ ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ #include "rtl8192e/halphyrf_8192e_ap.h" /*FOR_8192E_IQK*/ ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #include "rtl8192e/halphyrf_8192e_ce.h" /*FOR_8192E_IQK*/ ++ #endif ++ ++#include "rtl8192e/phydm_rtl8192e.h" //FOR_8192E_IQK ++#include "rtl8192e/version_rtl8192e.h" ++#if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++ #include "rtl8192e/halhwimg8192e_bb.h" ++ #include "rtl8192e/halhwimg8192e_mac.h" ++ #include "rtl8192e/halhwimg8192e_rf.h" ++ #include "rtl8192e/phydm_regconfig8192e.h" ++ #include "rtl8192e/halhwimg8192e_fw.h" ++ #include "rtl8192e/hal8192ereg.h" ++#endif ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #include "rtl8192e_hal.h" ++#endif ++#endif //92E END ++ ++#if (RTL8812A_SUPPORT==1) ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #include "rtl8812a/halphyrf_8812a_win.h" ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ #include "rtl8812a/halphyrf_8812a_ap.h" ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #include "rtl8812a/halphyrf_8812a_ce.h" ++ #endif ++ ++ //#include "rtl8812a/HalPhyRf_8812A.h" //FOR_8812_IQK ++ #if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++ #include "rtl8812a/halhwimg8812a_bb.h" ++ #include "rtl8812a/halhwimg8812a_mac.h" ++ #include "rtl8812a/halhwimg8812a_rf.h" ++ #include "rtl8812a/phydm_regconfig8812a.h" ++ #include "rtl8812a/halhwimg8812a_fw.h" ++ #include "rtl8812a/phydm_rtl8812a.h" ++ #endif ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #include "rtl8812a_hal.h" ++ #endif ++ #include "rtl8812a/version_rtl8812a.h" ++ ++#endif //8812 END ++ ++#if (RTL8814A_SUPPORT==1) ++ ++#include "rtl8814a/halhwimg8814a_mac.h" ++#include "rtl8814a/halhwimg8814a_rf.h" ++#include "rtl8814a/halhwimg8814a_bb.h" ++#include "rtl8814a/version_rtl8814a.h" ++#include "rtl8814a/phydm_rtl8814a.h" ++#if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++ #include "rtl8814a/halhwimg8814a_fw.h" ++#endif ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #include "rtl8814a/halphyrf_8814a_win.h" ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #include "rtl8814a/halphyrf_8814a_ce.h" ++#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ #include "rtl8814a/halphyrf_8814a_ap.h" ++#endif ++ #include "rtl8814a/phydm_regconfig8814a.h" ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #include "rtl8814a_hal.h" ++ #include "rtl8814a/phydm_iqk_8814a.h" ++#endif ++#endif //8814 END ++ ++#if (RTL8881A_SUPPORT==1)//FOR_8881_IQK ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++#include "rtl8821a/phydm_iqk_8821a_win.h" ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++#include "rtl8821a/phydm_iqk_8821a_ce.h" ++#else ++#include "rtl8821a/phydm_iqk_8821a_ap.h" ++#endif ++//#include "rtl8881a/HalHWImg8881A_BB.h" ++//#include "rtl8881a/HalHWImg8881A_MAC.h" ++//#include "rtl8881a/HalHWImg8881A_RF.h" ++//#include "rtl8881a/odm_RegConfig8881A.h" ++#endif ++ ++#if (RTL8723B_SUPPORT==1) ++#include "rtl8723b/halhwimg8723b_mac.h" ++#include "rtl8723b/halhwimg8723b_rf.h" ++#include "rtl8723b/halhwimg8723b_bb.h" ++#include "rtl8723b/halhwimg8723b_fw.h" ++#include "rtl8723b/phydm_regconfig8723b.h" ++#include "rtl8723b/phydm_rtl8723b.h" ++#include "rtl8723b/hal8723breg.h" ++#include "rtl8723b/version_rtl8723b.h" ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #include "rtl8723b/halphyrf_8723b_win.h" ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #include "rtl8723b/halphyrf_8723b_ce.h" ++ #include "rtl8723b/halhwimg8723b_mp.h" ++ #include "rtl8723b_hal.h" ++#else ++ #include "rtl8723b/halphyrf_8723b_ap.h" ++#endif ++#endif ++ ++#if (RTL8821A_SUPPORT==1) ++#include "rtl8821a/halhwimg8821a_mac.h" ++#include "rtl8821a/halhwimg8821a_rf.h" ++#include "rtl8821a/halhwimg8821a_bb.h" ++#include "rtl8821a/halhwimg8821a_fw.h" ++#include "rtl8821a/phydm_regconfig8821a.h" ++#include "rtl8821a/phydm_rtl8821a.h" ++#include "rtl8821a/version_rtl8821a.h" ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #include "rtl8821a/halphyrf_8821a_win.h" ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #include "rtl8821a/halphyrf_8821a_ce.h" ++ #include "rtl8821a/phydm_iqk_8821a_ce.h"/*for IQK*/ ++ #include "rtl8812a/halphyrf_8812a_ce.h"/*for IQK,LCK,Power-tracking*/ ++ #include "rtl8812a_hal.h" ++#else ++#endif ++#endif ++ ++#if (RTL8822B_SUPPORT==1) ++#include "rtl8822b/halhwimg8822b_mac.h" ++#include "rtl8822b/halhwimg8822b_rf.h" ++#include "rtl8822b/halhwimg8822b_bb.h" ++#include "rtl8822b/halhwimg8822b_fw.h" ++#include "rtl8822b/phydm_regconfig8822b.h" ++#include "rtl8822b/halphyrf_8822b.h" ++#include "rtl8822b/phydm_rtl8822b.h" ++#include "rtl8822b/phydm_hal_api8822b.h" ++#include "rtl8822b/version_rtl8822b.h" ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++#include /* struct HAL_DATA_TYPE */ ++#include /* Rx_Smooth_Factor, reg definition and etc.*/ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) ++#endif ++ ++#endif ++ ++#if (RTL8703B_SUPPORT==1) ++#include "rtl8703b/phydm_regconfig8703b.h" ++#include "rtl8703b/halhwimg8703b_mac.h" ++#include "rtl8703b/halhwimg8703b_rf.h" ++#include "rtl8703b/halhwimg8703b_bb.h" ++#include "rtl8703b/halhwimg8703b_fw.h" ++#include "rtl8703b/halphyrf_8703b.h" ++#include "rtl8703b/version_rtl8703b.h" ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++#include "rtl8703b_hal.h" ++#endif ++#endif ++ ++#if (RTL8188F_SUPPORT == 1) ++#include "rtl8188f/halhwimg8188f_mac.h" ++#include "rtl8188f/halhwimg8188f_rf.h" ++#include "rtl8188f/halhwimg8188f_bb.h" ++#include "rtl8188f/halhwimg8188f_fw.h" ++#include "rtl8188f/hal8188freg.h" ++#include "rtl8188f/phydm_rtl8188f.h" ++#include "rtl8188f/phydm_regconfig8188f.h" ++#include "rtl8188f/halphyrf_8188f.h" /* for IQK,LCK,Power-tracking */ ++#include "rtl8188f/version_rtl8188f.h" ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++#include "rtl8188f_hal.h" ++#endif ++#endif ++ ++#if (RTL8723D_SUPPORT==1) ++ #if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++ ++ #include "rtl8723d/halhwimg8723d_bb.h" ++ #include "rtl8723d/halhwimg8723d_mac.h" ++ #include "rtl8723d/halhwimg8723d_rf.h" ++ #include "rtl8723d/phydm_regconfig8723d.h" ++ #include "rtl8723d/halhwimg8723d_fw.h" ++ #include "rtl8723d/hal8723dreg.h" ++ #include "rtl8723d/phydm_rtl8723d.h" ++ #include "rtl8723d/halphyrf_8723d.h" ++ #include "rtl8723d/version_rtl8723d.h" ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #include "rtl8723d_hal.h" ++ #endif ++#endif //8723D End ++ ++#if (RTL8197F_SUPPORT == 1) ++#include "rtl8197f/halhwimg8197f_mac.h" ++#include "rtl8197f/halhwimg8197f_rf.h" ++#include "rtl8197f/halhwimg8197f_bb.h" ++#include "rtl8197f/phydm_hal_api8197f.h" ++#include "rtl8197f/version_rtl8197f.h" ++#include "rtl8197f/phydm_rtl8197f.h" ++#include "rtl8197f/phydm_regconfig8197f.h" ++#include "rtl8197f/halphyrf_8197f.h" ++#include "rtl8197f/phydm_iqk_8197f.h" ++#endif ++ ++#if (RTL8821C_SUPPORT==1) ++#include "rtl8821c/phydm_hal_api8821c.h" ++#include "rtl8821c/halhwimg8821c_testchip_mac.h" ++#include "rtl8821c/halhwimg8821c_testchip_rf.h" ++#include "rtl8821c/halhwimg8821c_testchip_bb.h" ++#include "rtl8821c/halhwimg8821c_mac.h" ++#include "rtl8821c/halhwimg8821c_rf.h" ++#include "rtl8821c/halhwimg8821c_bb.h" ++#include "rtl8821c/halhwimg8821c_fw.h" ++#include "rtl8821c/phydm_regconfig8821c.h" ++#include "rtl8821c/halphyrf_8821c.h" ++#include "rtl8821c/version_rtl8821c.h" ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #include "rtl8821c_hal.h" ++#endif ++#endif ++ ++#endif // __ODM_PRECOMP_H__ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_pre_define.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_pre_define.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_pre_define.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_pre_define.h 2018-02-11 21:44:27.157146238 +0200 +@@ -0,0 +1,697 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ ++#ifndef __PHYDMPREDEFINE_H__ ++#define __PHYDMPREDEFINE_H__ ++ ++//1 ============================================================ ++//1 Definition ++//1 ============================================================ ++ ++#define PHYDM_CODE_BASE "PHYDM_010" ++#define PHYDM_RELEASE_DATE "00000000" ++ ++//Max path of IC ++#define MAX_PATH_NUM_8188E 1 ++#define MAX_PATH_NUM_8192E 2 ++#define MAX_PATH_NUM_8723B 1 ++#define MAX_PATH_NUM_8812A 2 ++#define MAX_PATH_NUM_8821A 1 ++#define MAX_PATH_NUM_8814A 4 ++#define MAX_PATH_NUM_8822B 2 ++#define MAX_PATH_NUM_8821B 2 ++#define MAX_PATH_NUM_8703B 1 ++#define MAX_PATH_NUM_8188F 1 ++#define MAX_PATH_NUM_8723D 1 ++#define MAX_PATH_NUM_8197F 2 ++#define MAX_PATH_NUM_8821C 1 ++ ++//Max RF path ++#define ODM_RF_PATH_MAX 2 ++#define ODM_RF_PATH_MAX_JAGUAR 4 ++ ++/*Bit define path*/ ++#define PHYDM_A BIT0 ++#define PHYDM_B BIT1 ++#define PHYDM_C BIT2 ++#define PHYDM_D BIT3 ++#define PHYDM_AB (BIT0 | BIT1) ++#define PHYDM_AC (BIT0 | BIT2) ++#define PHYDM_AD (BIT0 | BIT3) ++#define PHYDM_BC (BIT1 | BIT2) ++#define PHYDM_BD (BIT1 | BIT3) ++#define PHYDM_CD (BIT2 | BIT3) ++#define PHYDM_ABC (BIT0 | BIT1 | BIT2) ++#define PHYDM_ABD (BIT0 | BIT1 | BIT3) ++#define PHYDM_ACD (BIT0 | BIT2 | BIT3) ++#define PHYDM_BCD (BIT1 | BIT2 | BIT3) ++#define PHYDM_ABCD (BIT0 | BIT1 | BIT2 | BIT3) ++ ++//number of entry ++#if(DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++ #define ASSOCIATE_ENTRY_NUM MACID_NUM_SW_LIMIT /* Max size of AsocEntry[].*/ ++ #define ODM_ASSOCIATE_ENTRY_NUM ASSOCIATE_ENTRY_NUM ++#elif(DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ #define ASSOCIATE_ENTRY_NUM NUM_STAT ++ #define ODM_ASSOCIATE_ENTRY_NUM (ASSOCIATE_ENTRY_NUM+1) ++#else ++ #define ODM_ASSOCIATE_ENTRY_NUM ((ASSOCIATE_ENTRY_NUM*3)+1) ++#endif ++ ++/* -----MGN rate--------------------------------- */ ++ ++enum ODM_MGN_RATE { ++ ODM_MGN_1M = 0x02, ++ ODM_MGN_2M = 0x04, ++ ODM_MGN_5_5M = 0x0B, ++ ODM_MGN_6M = 0x0C, ++ ODM_MGN_9M = 0x12, ++ ODM_MGN_11M = 0x16, ++ ODM_MGN_12M = 0x18, ++ ODM_MGN_18M = 0x24, ++ ODM_MGN_24M = 0x30, ++ ODM_MGN_36M = 0x48, ++ ODM_MGN_48M = 0x60, ++ ODM_MGN_54M = 0x6C, ++ ODM_MGN_MCS32 = 0x7F, ++ ODM_MGN_MCS0, ++ ODM_MGN_MCS1, ++ ODM_MGN_MCS2, ++ ODM_MGN_MCS3, ++ ODM_MGN_MCS4, ++ ODM_MGN_MCS5, ++ ODM_MGN_MCS6, ++ ODM_MGN_MCS7, ++ ODM_MGN_MCS8, ++ ODM_MGN_MCS9, ++ ODM_MGN_MCS10, ++ ODM_MGN_MCS11, ++ ODM_MGN_MCS12, ++ ODM_MGN_MCS13, ++ ODM_MGN_MCS14, ++ ODM_MGN_MCS15, ++ ODM_MGN_MCS16, ++ ODM_MGN_MCS17, ++ ODM_MGN_MCS18, ++ ODM_MGN_MCS19, ++ ODM_MGN_MCS20, ++ ODM_MGN_MCS21, ++ ODM_MGN_MCS22, ++ ODM_MGN_MCS23, ++ ODM_MGN_MCS24, ++ ODM_MGN_MCS25, ++ ODM_MGN_MCS26, ++ ODM_MGN_MCS27, ++ ODM_MGN_MCS28, ++ ODM_MGN_MCS29, ++ ODM_MGN_MCS30, ++ ODM_MGN_MCS31, ++ ODM_MGN_VHT1SS_MCS0, ++ ODM_MGN_VHT1SS_MCS1, ++ ODM_MGN_VHT1SS_MCS2, ++ ODM_MGN_VHT1SS_MCS3, ++ ODM_MGN_VHT1SS_MCS4, ++ ODM_MGN_VHT1SS_MCS5, ++ ODM_MGN_VHT1SS_MCS6, ++ ODM_MGN_VHT1SS_MCS7, ++ ODM_MGN_VHT1SS_MCS8, ++ ODM_MGN_VHT1SS_MCS9, ++ ODM_MGN_VHT2SS_MCS0, ++ ODM_MGN_VHT2SS_MCS1, ++ ODM_MGN_VHT2SS_MCS2, ++ ODM_MGN_VHT2SS_MCS3, ++ ODM_MGN_VHT2SS_MCS4, ++ ODM_MGN_VHT2SS_MCS5, ++ ODM_MGN_VHT2SS_MCS6, ++ ODM_MGN_VHT2SS_MCS7, ++ ODM_MGN_VHT2SS_MCS8, ++ ODM_MGN_VHT2SS_MCS9, ++ ODM_MGN_VHT3SS_MCS0, ++ ODM_MGN_VHT3SS_MCS1, ++ ODM_MGN_VHT3SS_MCS2, ++ ODM_MGN_VHT3SS_MCS3, ++ ODM_MGN_VHT3SS_MCS4, ++ ODM_MGN_VHT3SS_MCS5, ++ ODM_MGN_VHT3SS_MCS6, ++ ODM_MGN_VHT3SS_MCS7, ++ ODM_MGN_VHT3SS_MCS8, ++ ODM_MGN_VHT3SS_MCS9, ++ ODM_MGN_VHT4SS_MCS0, ++ ODM_MGN_VHT4SS_MCS1, ++ ODM_MGN_VHT4SS_MCS2, ++ ODM_MGN_VHT4SS_MCS3, ++ ODM_MGN_VHT4SS_MCS4, ++ ODM_MGN_VHT4SS_MCS5, ++ ODM_MGN_VHT4SS_MCS6, ++ ODM_MGN_VHT4SS_MCS7, ++ ODM_MGN_VHT4SS_MCS8, ++ ODM_MGN_VHT4SS_MCS9, ++ ODM_MGN_UNKNOWN ++}; ++ ++#define ODM_MGN_MCS0_SG 0xc0 ++#define ODM_MGN_MCS1_SG 0xc1 ++#define ODM_MGN_MCS2_SG 0xc2 ++#define ODM_MGN_MCS3_SG 0xc3 ++#define ODM_MGN_MCS4_SG 0xc4 ++#define ODM_MGN_MCS5_SG 0xc5 ++#define ODM_MGN_MCS6_SG 0xc6 ++#define ODM_MGN_MCS7_SG 0xc7 ++#define ODM_MGN_MCS8_SG 0xc8 ++#define ODM_MGN_MCS9_SG 0xc9 ++#define ODM_MGN_MCS10_SG 0xca ++#define ODM_MGN_MCS11_SG 0xcb ++#define ODM_MGN_MCS12_SG 0xcc ++#define ODM_MGN_MCS13_SG 0xcd ++#define ODM_MGN_MCS14_SG 0xce ++#define ODM_MGN_MCS15_SG 0xcf ++ ++/* -----DESC rate--------------------------------- */ ++ ++#define ODM_RATEMCS15_SG 0x1c ++#define ODM_RATEMCS32 0x20 ++ ++ ++// CCK Rates, TxHT = 0 ++#define ODM_RATE1M 0x00 ++#define ODM_RATE2M 0x01 ++#define ODM_RATE5_5M 0x02 ++#define ODM_RATE11M 0x03 ++// OFDM Rates, TxHT = 0 ++#define ODM_RATE6M 0x04 ++#define ODM_RATE9M 0x05 ++#define ODM_RATE12M 0x06 ++#define ODM_RATE18M 0x07 ++#define ODM_RATE24M 0x08 ++#define ODM_RATE36M 0x09 ++#define ODM_RATE48M 0x0A ++#define ODM_RATE54M 0x0B ++// MCS Rates, TxHT = 1 ++#define ODM_RATEMCS0 0x0C ++#define ODM_RATEMCS1 0x0D ++#define ODM_RATEMCS2 0x0E ++#define ODM_RATEMCS3 0x0F ++#define ODM_RATEMCS4 0x10 ++#define ODM_RATEMCS5 0x11 ++#define ODM_RATEMCS6 0x12 ++#define ODM_RATEMCS7 0x13 ++#define ODM_RATEMCS8 0x14 ++#define ODM_RATEMCS9 0x15 ++#define ODM_RATEMCS10 0x16 ++#define ODM_RATEMCS11 0x17 ++#define ODM_RATEMCS12 0x18 ++#define ODM_RATEMCS13 0x19 ++#define ODM_RATEMCS14 0x1A ++#define ODM_RATEMCS15 0x1B ++#define ODM_RATEMCS16 0x1C ++#define ODM_RATEMCS17 0x1D ++#define ODM_RATEMCS18 0x1E ++#define ODM_RATEMCS19 0x1F ++#define ODM_RATEMCS20 0x20 ++#define ODM_RATEMCS21 0x21 ++#define ODM_RATEMCS22 0x22 ++#define ODM_RATEMCS23 0x23 ++#define ODM_RATEMCS24 0x24 ++#define ODM_RATEMCS25 0x25 ++#define ODM_RATEMCS26 0x26 ++#define ODM_RATEMCS27 0x27 ++#define ODM_RATEMCS28 0x28 ++#define ODM_RATEMCS29 0x29 ++#define ODM_RATEMCS30 0x2A ++#define ODM_RATEMCS31 0x2B ++#define ODM_RATEVHTSS1MCS0 0x2C ++#define ODM_RATEVHTSS1MCS1 0x2D ++#define ODM_RATEVHTSS1MCS2 0x2E ++#define ODM_RATEVHTSS1MCS3 0x2F ++#define ODM_RATEVHTSS1MCS4 0x30 ++#define ODM_RATEVHTSS1MCS5 0x31 ++#define ODM_RATEVHTSS1MCS6 0x32 ++#define ODM_RATEVHTSS1MCS7 0x33 ++#define ODM_RATEVHTSS1MCS8 0x34 ++#define ODM_RATEVHTSS1MCS9 0x35 ++#define ODM_RATEVHTSS2MCS0 0x36 ++#define ODM_RATEVHTSS2MCS1 0x37 ++#define ODM_RATEVHTSS2MCS2 0x38 ++#define ODM_RATEVHTSS2MCS3 0x39 ++#define ODM_RATEVHTSS2MCS4 0x3A ++#define ODM_RATEVHTSS2MCS5 0x3B ++#define ODM_RATEVHTSS2MCS6 0x3C ++#define ODM_RATEVHTSS2MCS7 0x3D ++#define ODM_RATEVHTSS2MCS8 0x3E ++#define ODM_RATEVHTSS2MCS9 0x3F ++#define ODM_RATEVHTSS3MCS0 0x40 ++#define ODM_RATEVHTSS3MCS1 0x41 ++#define ODM_RATEVHTSS3MCS2 0x42 ++#define ODM_RATEVHTSS3MCS3 0x43 ++#define ODM_RATEVHTSS3MCS4 0x44 ++#define ODM_RATEVHTSS3MCS5 0x45 ++#define ODM_RATEVHTSS3MCS6 0x46 ++#define ODM_RATEVHTSS3MCS7 0x47 ++#define ODM_RATEVHTSS3MCS8 0x48 ++#define ODM_RATEVHTSS3MCS9 0x49 ++#define ODM_RATEVHTSS4MCS0 0x4A ++#define ODM_RATEVHTSS4MCS1 0x4B ++#define ODM_RATEVHTSS4MCS2 0x4C ++#define ODM_RATEVHTSS4MCS3 0x4D ++#define ODM_RATEVHTSS4MCS4 0x4E ++#define ODM_RATEVHTSS4MCS5 0x4F ++#define ODM_RATEVHTSS4MCS6 0x50 ++#define ODM_RATEVHTSS4MCS7 0x51 ++#define ODM_RATEVHTSS4MCS8 0x52 ++#define ODM_RATEVHTSS4MCS9 0x53 ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS4MCS9+1) ++#else ++ #if (RTL8192E_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) ++ #define ODM_NUM_RATE_IDX (ODM_RATEMCS15+1) ++ #elif (RTL8723B_SUPPORT == 1) || (RTL8188E_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) ++ #define ODM_NUM_RATE_IDX (ODM_RATEMCS7+1) ++ #elif (RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) ++ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS1MCS9+1) ++ #elif (RTL8812A_SUPPORT == 1) ++ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS2MCS9+1) ++ #elif(RTL8814A_SUPPORT == 1) ++ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS3MCS9+1) ++ #else ++ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS4MCS9+1) ++ #endif ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++#define CONFIG_SFW_SUPPORTED ++#endif ++ ++//1 ============================================================ ++//1 enumeration ++//1 ============================================================ ++ ++ ++// ODM_CMNINFO_INTERFACE ++typedef enum tag_ODM_Support_Interface_Definition ++{ ++ ODM_ITRF_PCIE = 0x1, ++ ODM_ITRF_USB = 0x2, ++ ODM_ITRF_SDIO = 0x4, ++ ODM_ITRF_ALL = 0x7, ++}ODM_INTERFACE_E; ++ ++// ODM_CMNINFO_IC_TYPE ++typedef enum tag_ODM_Support_IC_Type_Definition ++{ ++ ODM_RTL8188E = BIT0, ++ ODM_RTL8812 = BIT1, ++ ODM_RTL8821 = BIT2, ++ ODM_RTL8192E = BIT3, ++ ODM_RTL8723B = BIT4, ++ ODM_RTL8814A = BIT5, ++ ODM_RTL8881A = BIT6, ++ ODM_RTL8822B = BIT7, ++ ODM_RTL8703B = BIT8, ++ ODM_RTL8195A = BIT9, ++ ODM_RTL8188F = BIT10, ++ ODM_RTL8723D = BIT11, ++ ODM_RTL8197F = BIT12, ++ ODM_RTL8821C = BIT13, ++ ODM_RTL8814B = BIT14, ++ ODM_RTL8198F = BIT15 ++}ODM_IC_TYPE_E; ++ ++ ++#define ODM_IC_1SS (ODM_RTL8188E | ODM_RTL8188F | ODM_RTL8723B | ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8881A | ODM_RTL8821 | ODM_RTL8821C | ODM_RTL8195A) ++#define ODM_IC_2SS (ODM_RTL8192E | ODM_RTL8197F | ODM_RTL8812 | ODM_RTL8822B) ++#define ODM_IC_3SS (ODM_RTL8814A) ++#define ODM_IC_4SS (ODM_RTL8814B | ODM_RTL8198F) ++ ++ ++#define ODM_IC_11N_SERIES (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8703B|ODM_RTL8188F|ODM_RTL8723D|ODM_RTL8197F) ++#define ODM_IC_11AC_SERIES (ODM_RTL8812|ODM_RTL8821|ODM_RTL8814A|ODM_RTL8881A|ODM_RTL8822B|ODM_RTL8821C) ++#define ODM_IC_11AC_1_SERIES (ODM_RTL8812|ODM_RTL8821|ODM_RTL8881A) ++#define ODM_IC_11AC_2_SERIES (ODM_RTL8814A|ODM_RTL8822B|ODM_RTL8821C) ++#define ODM_IC_TXBF_SUPPORT (ODM_RTL8192E|ODM_RTL8812|ODM_RTL8821|ODM_RTL8814A|ODM_RTL8881A|ODM_RTL8822B|ODM_RTL8197F|ODM_RTL8821C) ++#define ODM_IC_11N_GAIN_IDX_EDCCA (ODM_RTL8195A|ODM_RTL8703B|ODM_RTL8188F|ODM_RTL8723D|ODM_RTL8197F) ++#define ODM_IC_11AC_GAIN_IDX_EDCCA (ODM_RTL8814A|ODM_RTL8822B|ODM_RTL8821C) ++#define ODM_IC_PHY_STATUE_NEW_TYPE (ODM_RTL8197F|ODM_RTL8822B|ODM_RTL8723D|ODM_RTL8821C) ++ ++#define PHYDM_IC_8051_SERIES (ODM_RTL8881A|ODM_RTL8812|ODM_RTL8821|ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8703B|ODM_RTL8188F) ++#define PHYDM_IC_3081_SERIES (ODM_RTL8814A|ODM_RTL8822B|ODM_RTL8197F|ODM_RTL8821C) ++ ++#define PHYDM_IC_SUPPORT_LA_MODE (ODM_RTL8814A|ODM_RTL8822B|ODM_RTL8197F|ODM_RTL8821C) ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++#ifdef RTK_AC_SUPPORT ++#define ODM_IC_11AC_SERIES_SUPPORT 1 ++#else ++#define ODM_IC_11AC_SERIES_SUPPORT 0 ++#endif ++ ++#define ODM_IC_11N_SERIES_SUPPORT 1 ++#define ODM_CONFIG_BT_COEXIST 0 ++ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++#define ODM_IC_11AC_SERIES_SUPPORT 1 ++#define ODM_IC_11N_SERIES_SUPPORT 1 ++#define ODM_CONFIG_BT_COEXIST 1 ++ ++#else ++ ++#if ((RTL8188E_SUPPORT == 1) || \ ++(RTL8723B_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8195A_SUPPORT == 1) || (RTL8703B_SUPPORT == 1) || \ ++(RTL8188F_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) ++#define ODM_IC_11N_SERIES_SUPPORT 1 ++#define ODM_IC_11AC_SERIES_SUPPORT 0 ++#else ++#define ODM_IC_11N_SERIES_SUPPORT 0 ++#define ODM_IC_11AC_SERIES_SUPPORT 1 ++#endif ++ ++#ifdef CONFIG_BT_COEXIST ++#define ODM_CONFIG_BT_COEXIST 1 ++#else ++#define ODM_CONFIG_BT_COEXIST 0 ++#endif ++ ++#endif ++ ++#if ((RTL8814A_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) ++#define PHYDM_LA_MODE_SUPPORT 1 ++#else ++#define PHYDM_LA_MODE_SUPPORT 0 ++#endif ++ ++#if ((RTL8197F_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) ++#define ODM_PHY_STATUS_NEW_TYPE_SUPPORT 1 ++#else ++#define ODM_PHY_STATUS_NEW_TYPE_SUPPORT 0 ++#endif ++ ++//ODM_CMNINFO_CUT_VER ++typedef enum tag_ODM_Cut_Version_Definition ++{ ++ ODM_CUT_A = 0, ++ ODM_CUT_B = 1, ++ ODM_CUT_C = 2, ++ ODM_CUT_D = 3, ++ ODM_CUT_E = 4, ++ ODM_CUT_F = 5, ++ ++ ODM_CUT_I = 8, ++ ODM_CUT_J = 9, ++ ODM_CUT_K = 10, ++ ODM_CUT_TEST = 15, ++}ODM_CUT_VERSION_E; ++ ++// ODM_CMNINFO_FAB_VER ++typedef enum tag_ODM_Fab_Version_Definition ++{ ++ ODM_TSMC = 0, ++ ODM_UMC = 1, ++}ODM_FAB_E; ++ ++// ODM_CMNINFO_RF_TYPE ++// ++// For example 1T2R (A+AB = BIT0|BIT4|BIT5) ++// ++typedef enum tag_ODM_RF_Path_Bit_Definition ++{ ++ ODM_RF_A = BIT0, ++ ODM_RF_B = BIT1, ++ ODM_RF_C = BIT2, ++ ODM_RF_D = BIT3, ++}ODM_RF_PATH_E; ++ ++typedef enum tag_PHYDM_RF_TX_NUM { ++ ODM_1T = 1, ++ ODM_2T = 2, ++ ODM_3T = 3, ++ ODM_4T = 4, ++} ODM_RF_TX_NUM_E; ++ ++typedef enum tag_ODM_RF_Type_Definition { ++ ODM_1T1R, ++ ODM_1T2R, ++ ODM_2T2R, ++ ODM_2T2R_GREEN, ++ ODM_2T3R, ++ ODM_2T4R, ++ ODM_3T3R, ++ ODM_3T4R, ++ ODM_4T4R, ++ ODM_XTXR ++}ODM_RF_TYPE_E; ++ ++ ++typedef enum tag_ODM_MAC_PHY_Mode_Definition ++{ ++ ODM_SMSP = 0, ++ ODM_DMSP = 1, ++ ODM_DMDP = 2, ++}ODM_MAC_PHY_MODE_E; ++ ++ ++typedef enum tag_BT_Coexist_Definition ++{ ++ ODM_BT_BUSY = 1, ++ ODM_BT_ON = 2, ++ ODM_BT_OFF = 3, ++ ODM_BT_NONE = 4, ++}ODM_BT_COEXIST_E; ++ ++// ODM_CMNINFO_OP_MODE ++typedef enum tag_Operation_Mode_Definition ++{ ++ ODM_NO_LINK = BIT0, ++ ODM_LINK = BIT1, ++ ODM_SCAN = BIT2, ++ ODM_POWERSAVE = BIT3, ++ ODM_AP_MODE = BIT4, ++ ODM_CLIENT_MODE = BIT5, ++ ODM_AD_HOC = BIT6, ++ ODM_WIFI_DIRECT = BIT7, ++ ODM_WIFI_DISPLAY = BIT8, ++}ODM_OPERATION_MODE_E; ++ ++// ODM_CMNINFO_WM_MODE ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++typedef enum tag_Wireless_Mode_Definition ++{ ++ ODM_WM_UNKNOW = 0x0, ++ ODM_WM_B = BIT0, ++ ODM_WM_G = BIT1, ++ ODM_WM_A = BIT2, ++ ODM_WM_N24G = BIT3, ++ ODM_WM_N5G = BIT4, ++ ODM_WM_AUTO = BIT5, ++ ODM_WM_AC = BIT6, ++}ODM_WIRELESS_MODE_E; ++#else ++typedef enum tag_Wireless_Mode_Definition ++{ ++ ODM_WM_UNKNOWN = 0x00,/*0x0*/ ++ ODM_WM_A = BIT0, /* 0x1*/ ++ ODM_WM_B = BIT1, /* 0x2*/ ++ ODM_WM_G = BIT2,/* 0x4*/ ++ ODM_WM_AUTO = BIT3,/* 0x8*/ ++ ODM_WM_N24G = BIT4,/* 0x10*/ ++ ODM_WM_N5G = BIT5,/* 0x20*/ ++ ODM_WM_AC_5G = BIT6,/* 0x40*/ ++ ODM_WM_AC_24G = BIT7,/* 0x80*/ ++ ODM_WM_AC_ONLY = BIT8,/* 0x100*/ ++ ODM_WM_MAX = BIT11/* 0x800*/ ++ ++}ODM_WIRELESS_MODE_E; ++#endif ++ ++// ODM_CMNINFO_BAND ++typedef enum tag_Band_Type_Definition ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ODM_BAND_2_4G = BIT0, ++ ODM_BAND_5G = BIT1, ++#else ++ ODM_BAND_2_4G = 0, ++ ODM_BAND_5G, ++ ODM_BAND_ON_BOTH, ++ ODM_BANDMAX ++#endif ++}ODM_BAND_TYPE_E; ++ ++ ++// ODM_CMNINFO_SEC_CHNL_OFFSET ++typedef enum tag_Secondary_Channel_Offset_Definition { ++ ++ PHYDM_DONT_CARE = 0, ++ PHYDM_BELOW = 1, ++ PHYDM_ABOVE = 2 ++} PHYDM_SEC_CHNL_OFFSET_E; ++ ++// ODM_CMNINFO_SEC_MODE ++typedef enum tag_Security_Definition ++{ ++ ODM_SEC_OPEN = 0, ++ ODM_SEC_WEP40 = 1, ++ ODM_SEC_TKIP = 2, ++ ODM_SEC_RESERVE = 3, ++ ODM_SEC_AESCCMP = 4, ++ ODM_SEC_WEP104 = 5, ++ ODM_WEP_WPA_MIXED = 6, // WEP + WPA ++ ODM_SEC_SMS4 = 7, ++}ODM_SECURITY_E; ++ ++// ODM_CMNINFO_BW ++typedef enum tag_Bandwidth_Definition ++{ ++ ODM_BW20M = 0, ++ ODM_BW40M = 1, ++ ODM_BW80M = 2, ++ ODM_BW160M = 3, ++ ODM_BW5M = 4, ++ ODM_BW10M = 5, ++ ODM_BW_MAX = 6 ++}ODM_BW_E; ++ ++// ODM_CMNINFO_CHNL ++ ++// ODM_CMNINFO_BOARD_TYPE ++typedef enum tag_Board_Definition ++{ ++ ODM_BOARD_DEFAULT = 0, // The DEFAULT case. ++ ODM_BOARD_MINICARD = BIT(0), // 0 = non-mini card, 1= mini card. ++ ODM_BOARD_SLIM = BIT(1), // 0 = non-slim card, 1 = slim card ++ ODM_BOARD_BT = BIT(2), // 0 = without BT card, 1 = with BT ++ ODM_BOARD_EXT_PA = BIT(3), // 0 = no 2G ext-PA, 1 = existing 2G ext-PA ++ ODM_BOARD_EXT_LNA = BIT(4), // 0 = no 2G ext-LNA, 1 = existing 2G ext-LNA ++ ODM_BOARD_EXT_TRSW = BIT(5), // 0 = no ext-TRSW, 1 = existing ext-TRSW ++ ODM_BOARD_EXT_PA_5G = BIT(6), // 0 = no 5G ext-PA, 1 = existing 5G ext-PA ++ ODM_BOARD_EXT_LNA_5G= BIT(7), // 0 = no 5G ext-LNA, 1 = existing 5G ext-LNA ++}ODM_BOARD_TYPE_E; ++ ++typedef enum tag_ODM_Package_Definition ++{ ++ ODM_PACKAGE_DEFAULT = 0, ++ ODM_PACKAGE_QFN68 = BIT(0), ++ ODM_PACKAGE_TFBGA90 = BIT(1), ++ ODM_PACKAGE_TFBGA79 = BIT(2), ++}ODM_Package_TYPE_E; ++ ++typedef enum tag_ODM_TYPE_GPA_Definition { ++ TYPE_GPA0 = 0x0000, ++ TYPE_GPA1 = 0x0055, ++ TYPE_GPA2 = 0x00AA, ++ TYPE_GPA3 = 0x00FF, ++ TYPE_GPA4 = 0x5500, ++ TYPE_GPA5 = 0x5555, ++ TYPE_GPA6 = 0x55AA, ++ TYPE_GPA7 = 0x55FF, ++ TYPE_GPA8 = 0xAA00, ++ TYPE_GPA9 = 0xAA55, ++ TYPE_GPA10 = 0xAAAA, ++ TYPE_GPA11 = 0xAAFF, ++ TYPE_GPA12 = 0xFF00, ++ TYPE_GPA13 = 0xFF55, ++ TYPE_GPA14 = 0xFFAA, ++ TYPE_GPA15 = 0xFFFF, ++}ODM_TYPE_GPA_E; ++ ++typedef enum tag_ODM_TYPE_APA_Definition { ++ TYPE_APA0 = 0x0000, ++ TYPE_APA1 = 0x0055, ++ TYPE_APA2 = 0x00AA, ++ TYPE_APA3 = 0x00FF, ++ TYPE_APA4 = 0x5500, ++ TYPE_APA5 = 0x5555, ++ TYPE_APA6 = 0x55AA, ++ TYPE_APA7 = 0x55FF, ++ TYPE_APA8 = 0xAA00, ++ TYPE_APA9 = 0xAA55, ++ TYPE_APA10 = 0xAAAA, ++ TYPE_APA11 = 0xAAFF, ++ TYPE_APA12 = 0xFF00, ++ TYPE_APA13 = 0xFF55, ++ TYPE_APA14 = 0xFFAA, ++ TYPE_APA15 = 0xFFFF, ++}ODM_TYPE_APA_E; ++ ++typedef enum tag_ODM_TYPE_GLNA_Definition { ++ TYPE_GLNA0 = 0x0000, ++ TYPE_GLNA1 = 0x0055, ++ TYPE_GLNA2 = 0x00AA, ++ TYPE_GLNA3 = 0x00FF, ++ TYPE_GLNA4 = 0x5500, ++ TYPE_GLNA5 = 0x5555, ++ TYPE_GLNA6 = 0x55AA, ++ TYPE_GLNA7 = 0x55FF, ++ TYPE_GLNA8 = 0xAA00, ++ TYPE_GLNA9 = 0xAA55, ++ TYPE_GLNA10 = 0xAAAA, ++ TYPE_GLNA11 = 0xAAFF, ++ TYPE_GLNA12 = 0xFF00, ++ TYPE_GLNA13 = 0xFF55, ++ TYPE_GLNA14 = 0xFFAA, ++ TYPE_GLNA15 = 0xFFFF, ++}ODM_TYPE_GLNA_E; ++ ++typedef enum tag_ODM_TYPE_ALNA_Definition { ++ TYPE_ALNA0 = 0x0000, ++ TYPE_ALNA1 = 0x0055, ++ TYPE_ALNA2 = 0x00AA, ++ TYPE_ALNA3 = 0x00FF, ++ TYPE_ALNA4 = 0x5500, ++ TYPE_ALNA5 = 0x5555, ++ TYPE_ALNA6 = 0x55AA, ++ TYPE_ALNA7 = 0x55FF, ++ TYPE_ALNA8 = 0xAA00, ++ TYPE_ALNA9 = 0xAA55, ++ TYPE_ALNA10 = 0xAAAA, ++ TYPE_ALNA11 = 0xAAFF, ++ TYPE_ALNA12 = 0xFF00, ++ TYPE_ALNA13 = 0xFF55, ++ TYPE_ALNA14 = 0xFFAA, ++ TYPE_ALNA15 = 0xFFFF, ++}ODM_TYPE_ALNA_E; ++ ++ ++typedef enum _ODM_RF_RADIO_PATH { ++ ODM_RF_PATH_A = 0, //Radio Path A ++ ODM_RF_PATH_B = 1, //Radio Path B ++ ODM_RF_PATH_C = 2, //Radio Path C ++ ODM_RF_PATH_D = 3, //Radio Path D ++ ODM_RF_PATH_AB, ++ ODM_RF_PATH_AC, ++ ODM_RF_PATH_AD, ++ ODM_RF_PATH_BC, ++ ODM_RF_PATH_BD, ++ ODM_RF_PATH_CD, ++ ODM_RF_PATH_ABC, ++ ODM_RF_PATH_ACD, ++ ODM_RF_PATH_BCD, ++ ODM_RF_PATH_ABCD, ++ // ODM_RF_PATH_MAX, //Max RF number 90 support ++} ODM_RF_RADIO_PATH_E, *PODM_RF_RADIO_PATH_E; ++ ++typedef enum _ODM_PARAMETER_INIT { ++ ODM_PRE_SETTING = 0, ++ ODM_POST_SETTING = 1, ++} ODM_PARAMETER_INIT_E; ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.c 2018-02-11 21:44:27.157146238 +0200 +@@ -0,0 +1,3420 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++VOID ++phydm_h2C_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte H2C_Parameter[H2C_MAX_LENGTH] = {0}; ++ u1Byte phydm_h2c_id = (u1Byte)dm_value[0]; ++ u1Byte i; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ PHYDM_SNPRINTF((output+used, out_len-used, "Phydm Send H2C_ID (( 0x%x))\n", phydm_h2c_id)); ++ for (i = 0; i < H2C_MAX_LENGTH; i++) { ++ ++ H2C_Parameter[i] = (u1Byte)dm_value[i+1]; ++ PHYDM_SNPRINTF((output+used, out_len-used, "H2C: Byte[%d] = ((0x%x))\n", i, H2C_Parameter[i])); ++ } ++ ++ ODM_FillH2CCmd(pDM_Odm, phydm_h2c_id, H2C_MAX_LENGTH, H2C_Parameter); ++ ++} ++ ++#if (defined(CONFIG_RA_DBG_CMD)) ++VOID ++odm_RA_ParaAdjust_Send_H2C( ++ IN PVOID pDM_VOID ++) ++{ ++ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u1Byte H2C_Parameter[6] = {0}; ++ ++ H2C_Parameter[0] = RA_FIRST_MACID; ++ ++ if (pRA_Table->RA_Para_feedback_req) { /*H2C_Parameter[5]=1 ; ask FW for all RA parameters*/ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] Ask FW for RA parameter\n")); ++ H2C_Parameter[5] |= BIT1; /*ask FW to report RA parameters*/ ++ H2C_Parameter[1] = pRA_Table->para_idx; /*pRA_Table->para_idx;*/ ++ pRA_Table->RA_Para_feedback_req = 0; ++ } else { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] Send H2C to FW for modifying RA parameter\n")); ++ ++ H2C_Parameter[1] = pRA_Table->para_idx; ++ H2C_Parameter[2] = pRA_Table->rate_idx; ++ /* [8 bit]*/ ++ if (pRA_Table->para_idx == RADBG_RTY_PENALTY || pRA_Table->para_idx == RADBG_RATE_UP_RTY_RATIO || pRA_Table->para_idx == RADBG_RATE_DOWN_RTY_RATIO) { ++ H2C_Parameter[3] = pRA_Table->value; ++ H2C_Parameter[4] = 0; ++ } ++ /* [16 bit]*/ ++ else { ++ H2C_Parameter[3] = (u1Byte)(((pRA_Table->value_16) & 0xf0) >> 4); /*byte1*/ ++ H2C_Parameter[4] = (u1Byte)((pRA_Table->value_16) & 0x0f); /*byte0*/ ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[1] = 0x%x\n", H2C_Parameter[1])); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[2] = 0x%x\n", H2C_Parameter[2])); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[3] = 0x%x\n", H2C_Parameter[3])); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[4] = 0x%x\n", H2C_Parameter[4])); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[5] = 0x%x\n", H2C_Parameter[5])); ++ ++ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RA_PARA_ADJUST, 6, H2C_Parameter); ++ ++} ++ ++ ++VOID ++odm_RA_ParaAdjust( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u1Byte rate_idx = pRA_Table->rate_idx; ++ u1Byte value = pRA_Table->value; ++ u1Byte Pre_value = 0xff; ++ ++ if (pRA_Table->para_idx == RADBG_RTY_PENALTY) { ++ Pre_value = pRA_Table->RTY_P[rate_idx]; ++ pRA_Table->RTY_P[rate_idx] = value; ++ pRA_Table->RTY_P_modify_note[rate_idx] = 1; ++ } else if (pRA_Table->para_idx == RADBG_N_HIGH) { ++ ++ } else if (pRA_Table->para_idx == RADBG_N_LOW) { ++ ++ } else if (pRA_Table->para_idx == RADBG_RATE_UP_RTY_RATIO) { ++ Pre_value = pRA_Table->RATE_UP_RTY_RATIO[rate_idx]; ++ pRA_Table->RATE_UP_RTY_RATIO[rate_idx] = value; ++ pRA_Table->RATE_UP_RTY_RATIO_modify_note[rate_idx] = 1; ++ } else if (pRA_Table->para_idx == RADBG_RATE_DOWN_RTY_RATIO) { ++ Pre_value = pRA_Table->RATE_DOWN_RTY_RATIO[rate_idx]; ++ pRA_Table->RATE_DOWN_RTY_RATIO[rate_idx] = value; ++ pRA_Table->RATE_DOWN_RTY_RATIO_modify_note[rate_idx] = 1; ++ } ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("Change RA Papa[%d], Rate[ %d ], ((%d)) -> ((%d))\n", pRA_Table->para_idx, rate_idx, Pre_value, value)); ++ odm_RA_ParaAdjust_Send_H2C(pDM_Odm); ++} ++ ++VOID ++phydm_ra_print_msg( ++ IN PVOID pDM_VOID, ++ IN u1Byte *value, ++ IN u1Byte *value_default, ++ IN u1Byte *modify_note ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u4Byte i; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate index| |Current-value| |Default-value| |Modify?|\n")); ++ for (i = 0 ; i <= (pRA_Table->rate_length); i++) { ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [ %d ] %20d %25d %20s\n", i, value[i], value_default[i], ((modify_note[i] == 1) ? "V" : " . "))); ++#else ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [ %d ] %10d %14d %14s\n", i, value[i], value_default[i], ((modify_note[i] == 1) ? "V" : " . "))); ++#endif ++ } ++ ++} ++ ++VOID ++odm_RA_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ ++ pRA_Table->is_ra_dbg_init = FALSE; ++ ++ if (dm_value[0] == 100) { /*1 Print RA Parameters*/ ++ u1Byte default_pointer_value; ++ u1Byte *pvalue; ++ u1Byte *pvalue_default; ++ u1Byte *pmodify_note; ++ ++ pvalue = pvalue_default = pmodify_note = &default_pointer_value; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("\n------------------------------------------------------------------------------------\n")); ++ ++ if (dm_value[1] == RADBG_RTY_PENALTY) { /* [1]*/ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [1] RTY_PENALTY\n")); ++ pvalue = &(pRA_Table->RTY_P[0]); ++ pvalue_default = &(pRA_Table->RTY_P_default[0]); ++ pmodify_note = (u1Byte *)&(pRA_Table->RTY_P_modify_note[0]); ++ } else if (dm_value[1] == RADBG_N_HIGH) { /* [2]*/ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [2] N_HIGH\n")); ++ ++ } else if (dm_value[1] == RADBG_N_LOW) { /*[3]*/ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [3] N_LOW\n")); ++ ++ } else if (dm_value[1] == RADBG_RATE_UP_RTY_RATIO) { /* [8]*/ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [8] RATE_UP_RTY_RATIO\n")); ++ pvalue = &(pRA_Table->RATE_UP_RTY_RATIO[0]); ++ pvalue_default = &(pRA_Table->RATE_UP_RTY_RATIO_default[0]); ++ pmodify_note = (u1Byte *)&(pRA_Table->RATE_UP_RTY_RATIO_modify_note[0]); ++ } else if (dm_value[1] == RADBG_RATE_DOWN_RTY_RATIO) { /* [9]*/ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [9] RATE_DOWN_RTY_RATIO\n")); ++ pvalue = &(pRA_Table->RATE_DOWN_RTY_RATIO[0]); ++ pvalue_default = &(pRA_Table->RATE_DOWN_RTY_RATIO_default[0]); ++ pmodify_note = (u1Byte *)&(pRA_Table->RATE_DOWN_RTY_RATIO_modify_note[0]); ++ } ++ ++ phydm_ra_print_msg(pDM_Odm, pvalue, pvalue_default, pmodify_note); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("\n------------------------------------------------------------------------------------\n\n")); ++ ++ } else if (dm_value[0] == 101) { ++ pRA_Table->para_idx = (u1Byte)dm_value[1]; ++ ++ pRA_Table->RA_Para_feedback_req = 1; ++ odm_RA_ParaAdjust_Send_H2C(pDM_Odm); ++ } else { ++ pRA_Table->para_idx = (u1Byte)dm_value[0]; ++ pRA_Table->rate_idx = (u1Byte)dm_value[1]; ++ pRA_Table->value = (u1Byte)dm_value[2]; ++ ++ odm_RA_ParaAdjust(pDM_Odm); ++ } ++} ++ ++VOID ++odm_RA_ParaAdjust_init( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u1Byte i; ++ u1Byte ra_para_pool_u8[3] = { RADBG_RTY_PENALTY, RADBG_RATE_UP_RTY_RATIO, RADBG_RATE_DOWN_RTY_RATIO}; ++ u1Byte RateSize_HT_1ss = 20, RateSize_HT_2ss = 28, RateSize_HT_3ss = 36; /*4+8+8+8+8 =36*/ ++ u1Byte RateSize_VHT_1ss = 10, RateSize_VHT_2ss = 20, RateSize_VHT_3ss = 30; /*10 + 10 +10 =30*/ ++ /* ++ RTY_PENALTY = 1, //u8 ++ N_HIGH = 2, ++ N_LOW = 3, ++ RATE_UP_TABLE = 4, ++ RATE_DOWN_TABLE = 5, ++ TRYING_NECESSARY = 6, ++ DROPING_NECESSARY = 7, ++ RATE_UP_RTY_RATIO = 8, //u8 ++ RATE_DOWN_RTY_RATIO= 9, //u8 ++ ALL_PARA = 0xff ++ ++ */ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("odm_RA_ParaAdjust_init\n")); ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8188F | ODM_RTL8195A | ODM_RTL8703B | ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8723D)) ++ pRA_Table->rate_length = RateSize_HT_1ss; ++ else if (pDM_Odm->SupportICType & (ODM_RTL8192E | ODM_RTL8197F)) ++ pRA_Table->rate_length = RateSize_HT_2ss; ++ else if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8881A | ODM_RTL8821C)) ++ pRA_Table->rate_length = RateSize_HT_1ss + RateSize_VHT_1ss; ++ else if (pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8822B)) ++ pRA_Table->rate_length = RateSize_HT_2ss + RateSize_VHT_2ss; ++ else if (pDM_Odm->SupportICType == ODM_RTL8814A) ++ pRA_Table->rate_length = RateSize_HT_3ss + RateSize_VHT_3ss; ++ else ++ pRA_Table->rate_length = RateSize_HT_1ss; ++ ++ pRA_Table->is_ra_dbg_init = TRUE; ++ for (i = 0; i < 3; i++) { ++ pRA_Table->RA_Para_feedback_req = 1; ++ pRA_Table->para_idx = ra_para_pool_u8[i]; ++ odm_RA_ParaAdjust_Send_H2C(pDM_Odm); ++ } ++} ++ ++#else ++ ++VOID ++phydm_RA_debug_PCR( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u4Byte used = *_used; ++ u4Byte out_len = *_out_len; ++ ++ if (dm_value[0] == 100) { ++ PHYDM_SNPRINTF((output+used, out_len-used, "[Get] PCR RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")), pRA_Table->RA_threshold_offset)); ++ /**/ ++ } else if (dm_value[0] == 0) { ++ pRA_Table->RA_offset_direction = 0; ++ pRA_Table->RA_threshold_offset = (u1Byte)dm_value[1]; ++ PHYDM_SNPRINTF((output+used, out_len-used, "[Set] PCR RA_threshold_offset = (( -%d ))\n", pRA_Table->RA_threshold_offset)); ++ } else if (dm_value[0] == 1) { ++ pRA_Table->RA_offset_direction = 1; ++ pRA_Table->RA_threshold_offset = (u1Byte)dm_value[1]; ++ PHYDM_SNPRINTF((output+used, out_len-used, "[Set] PCR RA_threshold_offset = (( +%d ))\n", pRA_Table->RA_threshold_offset)); ++ } else { ++ PHYDM_SNPRINTF((output+used, out_len-used, "[Set] Error\n")); ++ /**/ ++ } ++ ++} ++ ++#endif /*#if (defined(CONFIG_RA_DBG_CMD))*/ ++ ++VOID ++ODM_C2HRaParaReportHandler( ++ IN PVOID pDM_VOID, ++ IN pu1Byte CmdBuf, ++ IN u1Byte CmdLen ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ ++ u1Byte para_idx = CmdBuf[0]; /*Retry Penalty, NH, NL*/ ++ u1Byte RateTypeStart = CmdBuf[1]; ++ u1Byte RateTypeLength = CmdLen - 2; ++ u1Byte i; ++ ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[ From FW C2H RA Para ] CmdBuf[0]= (( %d ))\n", CmdBuf[0])); ++ ++#if (defined(CONFIG_RA_DBG_CMD)) ++ if (para_idx == RADBG_RTY_PENALTY) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |RTY Penality Index|\n")); ++ ++ for (i = 0 ; i < (RateTypeLength) ; i++) { ++ if (pRA_Table->is_ra_dbg_init) ++ pRA_Table->RTY_P_default[RateTypeStart + i] = CmdBuf[2 + i]; ++ ++ pRA_Table->RTY_P[RateTypeStart + i] = CmdBuf[2 + i]; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%8d %15d \n", (RateTypeStart + i), pRA_Table->RTY_P[RateTypeStart + i])); ++ } ++ ++ } else if (para_idx == RADBG_N_HIGH) { ++ /**/ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |N-High|\n")); ++ ++ ++ } else if (para_idx == RADBG_N_LOW) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |N-Low|\n")); ++ /**/ ++ } ++ else if (para_idx == RADBG_RATE_UP_RTY_RATIO) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |Rate Up RTY Ratio|\n")); ++ ++ for (i = 0; i < (RateTypeLength); i++) { ++ if (pRA_Table->is_ra_dbg_init) ++ pRA_Table->RATE_UP_RTY_RATIO_default[RateTypeStart + i] = CmdBuf[2 + i]; ++ ++ pRA_Table->RATE_UP_RTY_RATIO[RateTypeStart + i] = CmdBuf[2 + i]; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%8d %15d\n", (RateTypeStart + i), pRA_Table->RATE_UP_RTY_RATIO[RateTypeStart + i])); ++ } ++ } else if (para_idx == RADBG_RATE_DOWN_RTY_RATIO) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |Rate Down RTY Ratio|\n")); ++ ++ for (i = 0; i < (RateTypeLength); i++) { ++ if (pRA_Table->is_ra_dbg_init) ++ pRA_Table->RATE_DOWN_RTY_RATIO_default[RateTypeStart + i] = CmdBuf[2 + i]; ++ ++ pRA_Table->RATE_DOWN_RTY_RATIO[RateTypeStart + i] = CmdBuf[2 + i]; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%8d %15d\n", (RateTypeStart + i), pRA_Table->RATE_DOWN_RTY_RATIO[RateTypeStart + i])); ++ } ++ } else ++#endif ++ if (para_idx == RADBG_DEBUG_MONITOR1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); ++ if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "RSSI =", CmdBuf[1])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "Rate =", CmdBuf[2] & 0x7f)); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "SGI =", (CmdBuf[2] & 0x80) >> 7)); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "BW =", CmdBuf[3])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "BW_max =", CmdBuf[4])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "multi_rate0 =", CmdBuf[5])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "multi_rate1 =", CmdBuf[6])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "DISRA =", CmdBuf[7])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "VHT_EN =", CmdBuf[8])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "SGI_support =", CmdBuf[9])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "try_ness =", CmdBuf[10])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "pre_rate =", CmdBuf[11])); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "RSSI =", CmdBuf[1])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %x\n", "BW =", CmdBuf[2])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "DISRA =", CmdBuf[3])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "VHT_EN =", CmdBuf[4])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Hightest Rate =", CmdBuf[5])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "Lowest Rate =", CmdBuf[6])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "SGI_support =", CmdBuf[7])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Rate_ID =", CmdBuf[8]));; ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); ++ } else if (para_idx == RADBG_DEBUG_MONITOR2) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); ++ if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "RateID =", CmdBuf[1])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "highest_rate =", CmdBuf[2])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "lowest_rate =", CmdBuf[3])); ++ ++ for (i = 4; i <= 11; i++) ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("RAMASK = 0x%x\n", CmdBuf[i])); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %x%x %x%x %x%x %x%x\n", "RA Mask:", ++ CmdBuf[8], CmdBuf[7], CmdBuf[6], CmdBuf[5], CmdBuf[4], CmdBuf[3], CmdBuf[2], CmdBuf[1])); ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); ++ } else if (para_idx == RADBG_DEBUG_MONITOR3) { ++ ++ for (i = 0; i < (CmdLen - 1); i++) ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("content[%d] = %d\n", i, CmdBuf[1 + i])); ++ } else if (para_idx == RADBG_DEBUG_MONITOR4) ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s {%d.%d}\n", "RA Version =", CmdBuf[1], CmdBuf[2])); ++ else if (para_idx == RADBG_DEBUG_MONITOR5) { ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "Current rate =", CmdBuf[1])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Retry ratio =", CmdBuf[2])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Rate down ratio =", CmdBuf[3])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "highest rate =", CmdBuf[4])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s {0x%x 0x%x}\n", "Muti-try =", CmdBuf[5], CmdBuf[6])); ++ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x%x%x%x%x\n", "RA mask =", CmdBuf[11], CmdBuf[10], CmdBuf[9], CmdBuf[8], CmdBuf[7])); ++ } ++} ++ ++VOID ++phydm_ra_dynamic_retry_count( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ PSTA_INFO_T pEntry; ++ u1Byte i, retry_offset; ++ u4Byte ma_rx_tp; ++ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_ARFR)) { ++ return; ++ } ++ ++ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("pDM_Odm->pre_b_noisy = %d\n", pDM_Odm->pre_b_noisy ));*/ ++ if (pDM_Odm->pre_b_noisy != pDM_Odm->NoisyDecision) { ++ ++ if (pDM_Odm->NoisyDecision) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("->Noisy Env. RA fallback value\n")); ++ ODM_SetMACReg(pDM_Odm, 0x430, bMaskDWord, 0x0); ++ ODM_SetMACReg(pDM_Odm, 0x434, bMaskDWord, 0x04030201); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("->Clean Env. RA fallback value\n")); ++ ODM_SetMACReg(pDM_Odm, 0x430, bMaskDWord, 0x01000000); ++ ODM_SetMACReg(pDM_Odm, 0x434, bMaskDWord, 0x06050402); ++ } ++ pDM_Odm->pre_b_noisy = pDM_Odm->NoisyDecision; ++ } ++} ++ ++#if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) ++ ++VOID ++phydm_retry_limit_table_bound( ++ IN PVOID pDM_VOID, ++ IN u1Byte *retry_limit, ++ IN u1Byte offset ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ ++ if (*retry_limit > offset) { ++ ++ *retry_limit -= offset; ++ ++ if (*retry_limit < pRA_Table->retrylimit_low) ++ *retry_limit = pRA_Table->retrylimit_low; ++ else if (*retry_limit > pRA_Table->retrylimit_high) ++ *retry_limit = pRA_Table->retrylimit_high; ++ } else ++ *retry_limit = pRA_Table->retrylimit_low; ++} ++ ++VOID ++phydm_reset_retry_limit_table( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u1Byte i; ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) /*support all IC platform*/ ++ ++ #else ++ #if ((RTL8192E_SUPPORT == 1) || (RTL8723B_SUPPORT == 1) || (RTL8188E_SUPPORT == 1)) ++ u1Byte per_rate_retrylimit_table_20M[ODM_RATEMCS15+1] = { ++ 1, 1, 2, 4, /*CCK*/ ++ 2, 2, 4, 6, 8, 12, 16, 18, /*OFDM*/ ++ 2, 4, 6, 8, 12, 18, 20, 22, /*20M HT-1SS*/ ++ 2, 4, 6, 8, 12, 18, 20, 22 /*20M HT-2SS*/ ++ }; ++ u1Byte per_rate_retrylimit_table_40M[ODM_RATEMCS15+1] = { ++ 1, 1, 2, 4, /*CCK*/ ++ 2, 2, 4, 6, 8, 12, 16, 18, /*OFDM*/ ++ 4, 8, 12, 16, 24, 32, 32, 32, /*40M HT-1SS*/ ++ 4, 8, 12, 16, 24, 32, 32, 32 /*40M HT-2SS*/ ++ }; ++ ++ #elif (RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) ++ ++ #elif (RTL8812A_SUPPORT == 1) ++ ++ #elif(RTL8814A_SUPPORT == 1) ++ ++ #else ++ ++ #endif ++ #endif ++ ++ memcpy(&(pRA_Table->per_rate_retrylimit_20M[0]), &(per_rate_retrylimit_table_20M[0]), ODM_NUM_RATE_IDX); ++ memcpy(&(pRA_Table->per_rate_retrylimit_40M[0]), &(per_rate_retrylimit_table_40M[0]), ODM_NUM_RATE_IDX); ++ ++ for (i = 0; i < ODM_NUM_RATE_IDX; i++) { ++ phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_20M[i]), 0); ++ phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_40M[i]), 0); ++ } ++} ++ ++VOID ++phydm_ra_dynamic_retry_limit_init( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ ++ pRA_Table->retry_descend_num = RA_RETRY_DESCEND_NUM; ++ pRA_Table->retrylimit_low = RA_RETRY_LIMIT_LOW; ++ pRA_Table->retrylimit_high = RA_RETRY_LIMIT_HIGH; ++ ++ phydm_reset_retry_limit_table(pDM_Odm); ++ ++} ++ ++#endif ++ ++VOID ++phydm_ra_dynamic_retry_limit( ++ IN PVOID pDM_VOID ++) ++{ ++#if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ PSTA_INFO_T pEntry; ++ u1Byte i, retry_offset; ++ u4Byte ma_rx_tp; ++ ++ ++ if (pDM_Odm->pre_number_active_client == pDM_Odm->number_active_client) { ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" pre_number_active_client == number_active_client\n")); ++ return; ++ ++ } else { ++ if (pDM_Odm->number_active_client == 1) { ++ phydm_reset_retry_limit_table(pDM_Odm); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("one client only->reset to default value\n")); ++ } else { ++ ++ retry_offset = pDM_Odm->number_active_client * pRA_Table->retry_descend_num; ++ ++ for (i = 0; i < ODM_NUM_RATE_IDX; i++) { ++ ++ phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_20M[i]), retry_offset); ++ phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_40M[i]), retry_offset); ++ } ++ } ++ } ++#endif ++} ++ ++#if (defined(CONFIG_RA_DYNAMIC_RATE_ID)) ++VOID ++phydm_ra_dynamic_rate_id_on_assoc( ++ IN PVOID pDM_VOID, ++ IN u1Byte wireless_mode, ++ IN u1Byte init_rate_id ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] rf_mode = ((0x%x)), wireless_mode = ((0x%x)), init_rate_id = ((0x%x))\n", pDM_Odm->RFType, wireless_mode, init_rate_id)); ++ ++ if ((pDM_Odm->RFType == ODM_2T2R) | (pDM_Odm->RFType == ODM_2T2R_GREEN) | (pDM_Odm->RFType == ODM_2T3R) | (pDM_Odm->RFType == ODM_2T4R)) { ++ ++ if ((pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8192E)) && ++ (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G)) ++ ){ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] set N-2SS ARFR5 table\n")); ++ ODM_SetMACReg(pDM_Odm, 0x4a4, bMaskDWord, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ ++ ODM_SetMACReg(pDM_Odm, 0x4a8, bMaskDWord, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ ++ } else if ((pDM_Odm->SupportICType & (ODM_RTL8812)) && ++ (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY)) ++ ){ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] set AC-2SS ARFR0 table\n")); ++ ODM_SetMACReg(pDM_Odm, 0x444, bMaskDWord, 0x0fff); /*AC-2SS, ARFR0, rate_id = 0x9*/ ++ ODM_SetMACReg(pDM_Odm, 0x448, bMaskDWord, 0xff01f000); /*AC-2SS, ARFR0, rate_id = 0x9*/ ++ } ++ } ++ ++} ++ ++VOID ++phydm_ra_dynamic_rate_id_init( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8192E)) { ++ ++ ODM_SetMACReg(pDM_Odm, 0x4a4, bMaskDWord, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ ++ ODM_SetMACReg(pDM_Odm, 0x4a8, bMaskDWord, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ ++ ++ ODM_SetMACReg(pDM_Odm, 0x444, bMaskDWord, 0x0fff); /*AC-2SS, ARFR0, rate_id = 0x9*/ ++ ODM_SetMACReg(pDM_Odm, 0x448, bMaskDWord, 0xff01f000); /*AC-2SS, ARFR0, rate_id = 0x9*/ ++ } ++} ++ ++VOID ++phydm_update_rate_id( ++ IN PVOID pDM_VOID, ++ IN u1Byte rate, ++ IN u1Byte platform_macid ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u1Byte current_tx_ss; ++ u1Byte rate_idx = rate & 0x7f; /*remove bit7 SGI*/ ++ u1Byte wireless_mode; ++ u1Byte phydm_macid; ++ PSTA_INFO_T pEntry; ++ ++ ++#if 0 ++ if (rate_idx >= ODM_RATEVHTSS2MCS0) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( VHT2SS-MCS%d ))\n", platform_macid, (rate_idx-ODM_RATEVHTSS2MCS0))); ++ /*dummy for SD4 check patch*/ ++ } else if (rate_idx >= ODM_RATEVHTSS1MCS0) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( VHT1SS-MCS%d ))\n", platform_macid, (rate_idx-ODM_RATEVHTSS1MCS0))); ++ /*dummy for SD4 check patch*/ ++ } else if (rate_idx >= ODM_RATEMCS0) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( HT-MCS%d ))\n", platform_macid, (rate_idx-ODM_RATEMCS0))); ++ /*dummy for SD4 check patch*/ ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( HT-MCS%d ))\n", platform_macid, rate_idx)); ++ /*dummy for SD4 check patch*/ ++ } ++#endif ++ ++ phydm_macid = pDM_Odm->platform2phydm_macid_table[platform_macid]; ++ pEntry = pDM_Odm->pODM_StaInfo[phydm_macid]; ++ ++ if (IS_STA_VALID(pEntry)) { ++ wireless_mode = pEntry->WirelessMode; ++ ++ if ((pDM_Odm->RFType == ODM_2T2R) | (pDM_Odm->RFType == ODM_2T2R_GREEN) | (pDM_Odm->RFType == ODM_2T3R) | (pDM_Odm->RFType == ODM_2T4R)) { ++ ++ pEntry->ratr_idx = pEntry->ratr_idx_init; ++ if (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G)) { /*N mode*/ ++ if (rate_idx >= ODM_RATEMCS8 && rate_idx <= ODM_RATEMCS15) { /*2SS mode*/ ++ ++ pEntry->ratr_idx = ARFR_5_RATE_ID; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("ARFR_5\n")); ++ } ++ } else if (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY)) {/*AC mode*/ ++ if (rate_idx >= ODM_RATEVHTSS2MCS0 && rate_idx <= ODM_RATEVHTSS2MCS9) {/*2SS mode*/ ++ ++ pEntry->ratr_idx = ARFR_0_RATE_ID; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("ARFR_0\n")); ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("UPdate_RateID[%d]: (( 0x%x ))\n", platform_macid, pEntry->ratr_idx)); ++ } ++ } ++ ++} ++#endif ++ ++VOID ++phydm_print_rate( ++ IN PVOID pDM_VOID, ++ IN u1Byte rate, ++ IN u4Byte dbg_component ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte legacy_table[12] = {1, 2, 5, 11, 6, 9, 12, 18, 24, 36, 48, 54}; ++ u1Byte rate_idx = rate & 0x7f; /*remove bit7 SGI*/ ++ u1Byte vht_en = (rate_idx >= ODM_RATEVHTSS1MCS0) ? 1 : 0; ++ u1Byte b_sgi = (rate & 0x80)>>7; ++ ++ ODM_RT_TRACE_F(pDM_Odm, dbg_component, ODM_DBG_LOUD, ("( %s%s%s%s%d%s%s)\n", ++ ((rate_idx >= ODM_RATEVHTSS1MCS0) && (rate_idx <= ODM_RATEVHTSS1MCS9)) ? "VHT 1ss " : "", ++ ((rate_idx >= ODM_RATEVHTSS2MCS0) && (rate_idx <= ODM_RATEVHTSS2MCS9)) ? "VHT 2ss " : "", ++ ((rate_idx >= ODM_RATEVHTSS3MCS0) && (rate_idx <= ODM_RATEVHTSS3MCS9)) ? "VHT 3ss " : "", ++ (rate_idx >= ODM_RATEMCS0) ? "MCS " : "", ++ (vht_en) ? ((rate_idx - ODM_RATEVHTSS1MCS0)%10) : ((rate_idx >= ODM_RATEMCS0) ? (rate_idx - ODM_RATEMCS0) : ((rate_idx <= ODM_RATE54M)?legacy_table[rate_idx]:0)), ++ (b_sgi) ? "-S" : " ", ++ (rate_idx >= ODM_RATEMCS0) ? "" : "M")); ++} ++ ++VOID ++phydm_c2h_ra_report_handler( ++ IN PVOID pDM_VOID, ++ IN pu1Byte CmdBuf, ++ IN u1Byte CmdLen ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u1Byte legacy_table[12] = {1,2,5,11,6,9,12,18,24,36,48,54}; ++ u1Byte macid = CmdBuf[1]; ++ u1Byte rate = CmdBuf[0]; ++ u1Byte rate_idx = rate & 0x7f; /*remove bit7 SGI*/ ++ u1Byte pre_rate = pRA_Table->link_tx_rate[macid]; ++ u1Byte rate_order; ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ GET_HAL_DATA(Adapter)->CurrentRARate = HwRateToMRate(rate_idx); ++ #endif ++ ++ ++ if (CmdLen >= 4) { ++ if (CmdBuf[3] == 0) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("TX Init-Rate Update[%d]:", macid)); ++ /**/ ++ } else if (CmdBuf[3] == 0xff) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("FW Level: Fix rate[%d]:", macid)); ++ /**/ ++ } else if (CmdBuf[3] == 1) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Try Success[%d]:", macid)); ++ /**/ ++ } else if (CmdBuf[3] == 2) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Try Fail & Try Again[%d]:", macid)); ++ /**/ ++ } else if (CmdBuf[3] == 3) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate Back[%d]:", macid)); ++ /**/ ++ } else if (CmdBuf[3] == 4) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("start rate by RSSI[%d]:", macid)); ++ /**/ ++ } else if (CmdBuf[3] == 5) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Try rate[%d]:", macid)); ++ /**/ ++ } ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Tx Rate Update[%d]:", macid)); ++ /**/ ++ } ++ ++ /*phydm_print_rate(pDM_Odm, pre_rate_idx, ODM_COMP_RATE_ADAPTIVE);*/ ++ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, (">\n",macid );*/ ++ phydm_print_rate(pDM_Odm, rate, ODM_COMP_RATE_ADAPTIVE); ++ ++ pRA_Table->link_tx_rate[macid] = rate; ++ ++ /*trigger power training*/ ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) ++ ++ rate_order = phydm_rate_order_compute(pDM_Odm, rate_idx); ++ ++ if ((pDM_Odm->bOneEntryOnly) || ++ ((rate_order > pRA_Table->highest_client_tx_order) && (pRA_Table->power_tracking_flag == 1)) ++ ) { ++ phydm_update_pwr_track(pDM_Odm, rate_idx); ++ pRA_Table->power_tracking_flag = 0; ++ } ++ ++ #endif ++ ++ /*trigger dynamic rate ID*/ ++ #if (defined(CONFIG_RA_DYNAMIC_RATE_ID)) ++ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8192E)) ++ phydm_update_rate_id(pDM_Odm, rate, macid); ++ #endif ++ ++} ++ ++VOID ++odm_RSSIMonitorInit( ++ IN PVOID pDM_VOID ++) ++{ ++#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ pRA_Table->PT_collision_pre = TRUE; /*used in ODM_DynamicARFBSelect(WIN only)*/ ++ ++ pHalData->UndecoratedSmoothedPWDB = -1; ++ pHalData->ra_rpt_linked = FALSE; ++ #endif ++ ++ pRA_Table->firstconnect = FALSE; ++ ++ ++#endif ++} ++ ++VOID ++ODM_RAPostActionOnAssoc( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++/* ++ pDM_Odm->H2C_RARpt_connect = 1; ++ odm_RSSIMonitorCheck(pDM_Odm); ++ pDM_Odm->H2C_RARpt_connect = 0; ++*/ ++} ++ ++VOID ++phydm_initRaInfo( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++#if (RTL8822B_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8822B) { ++ u4Byte ret_value; ++ ++ ret_value = ODM_GetBBReg(pDM_Odm, 0x4c8, bMaskByte2); ++ ODM_SetBBReg(pDM_Odm, 0x4cc, bMaskByte3, (ret_value - 1)); ++ } ++#endif ++} ++ ++VOID ++phydm_modify_RA_PCR_threshold( ++ IN PVOID pDM_VOID, ++ IN u1Byte RA_offset_direction, ++ IN u1Byte RA_threshold_offset ++ ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ ++ pRA_Table->RA_offset_direction = RA_offset_direction; ++ pRA_Table->RA_threshold_offset = RA_threshold_offset; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Set RA_threshold_offset = (( %s%d ))\n", ((RA_threshold_offset == 0) ? " " : ((RA_offset_direction) ? "+" : "-")), RA_threshold_offset)); ++} ++ ++VOID ++odm_RSSIMonitorCheckMP( ++ IN PVOID pDM_VOID ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u1Byte H2C_Parameter[H2C_0X42_LENGTH] = {0}; ++ u4Byte i; ++ BOOLEAN bExtRAInfo = TRUE; ++ u1Byte cmdlen = H2C_0X42_LENGTH; ++ u1Byte TxBF_EN = 0, stbc_en = 0; ++ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PSTA_INFO_T pEntry = NULL; ++ s4Byte tmpEntryMaxPWDB = 0, tmpEntryMinPWDB = 0xff; ++ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; ++ PMGNT_INFO pDefaultMgntInfo = &Adapter->MgntInfo; ++ u8Byte curTxOkCnt = 0, curRxOkCnt = 0; ++#if (BEAMFORMING_SUPPORT == 1) ++#ifndef BEAMFORMING_VERSION_1 ++ BEAMFORMING_CAP Beamform_cap = BEAMFORMING_CAP_NONE; ++#endif ++#endif ++ PADAPTER pLoopAdapter = GetDefaultAdapter(Adapter); ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) { ++ bExtRAInfo = FALSE; ++ cmdlen = 3; ++ } ++ ++ while (pLoopAdapter) { ++ ++ if (pLoopAdapter != NULL) { ++ pMgntInfo = &pLoopAdapter->MgntInfo; ++ curTxOkCnt = pLoopAdapter->TxStats.NumTxBytesUnicast - pMgntInfo->lastTxOkCnt; ++ curRxOkCnt = pLoopAdapter->RxStats.NumRxBytesUnicast - pMgntInfo->lastRxOkCnt; ++ pMgntInfo->lastTxOkCnt = curTxOkCnt; ++ pMgntInfo->lastRxOkCnt = curRxOkCnt; ++ } ++ ++ for (i = 0; i < ASSOCIATE_ENTRY_NUM; i++) { ++ ++ if (IsAPModeExist(pLoopAdapter)) { ++ if (GetFirstExtAdapter(pLoopAdapter) != NULL && ++ GetFirstExtAdapter(pLoopAdapter) == pLoopAdapter) ++ pEntry = AsocEntry_EnumStation(pLoopAdapter, i); ++ else if (GetFirstGOPort(pLoopAdapter) != NULL && ++ IsFirstGoAdapter(pLoopAdapter)) ++ pEntry = AsocEntry_EnumStation(pLoopAdapter, i); ++ } else { ++ if (GetDefaultAdapter(pLoopAdapter) == pLoopAdapter) ++ pEntry = AsocEntry_EnumStation(pLoopAdapter, i); ++ } ++ ++ if (pEntry != NULL) { ++ if (pEntry->bAssociated) { ++ ++ RT_DISP_ADDR(FDM, DM_PWDB, ("pEntry->MacAddr ="), pEntry->MacAddr); ++ RT_DISP(FDM, DM_PWDB, ("pEntry->rssi = 0x%x(%d)\n", ++ pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->rssi_stat.UndecoratedSmoothedPWDB)); ++ ++ //2 BF_en ++#if (BEAMFORMING_SUPPORT == 1) ++#ifndef BEAMFORMING_VERSION_1 ++ Beamform_cap = phydm_Beamforming_GetEntryBeamCapByMacId(pDM_Odm, pEntry->AssociatedMacId); ++ if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) ++ TxBF_EN = 1; ++#else ++ if(Beamform_GetSupportBeamformerCap(GetDefaultAdapter(Adapter), pEntry)) ++ TxBF_EN = 1; ++#endif ++#endif ++ //2 STBC_en ++ if ((IS_WIRELESS_MODE_AC(Adapter) && TEST_FLAG(pEntry->VHTInfo.STBC, STBC_VHT_ENABLE_TX)) || ++ TEST_FLAG(pEntry->HTInfo.STBC, STBC_HT_ENABLE_TX)) ++ stbc_en = 1; ++ ++ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB) ++ tmpEntryMinPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; ++ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB) ++ tmpEntryMaxPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; ++ ++ H2C_Parameter[4] = (pRA_Table->RA_threshold_offset & 0x7f) | (pRA_Table->RA_offset_direction<<7); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")),pRA_Table->RA_threshold_offset)); ++ ++ if (bExtRAInfo) { ++ if (curRxOkCnt > (curTxOkCnt * 6)) ++ H2C_Parameter[3] |= RAINFO_BE_RX_STATE; ++ ++ if (TxBF_EN) ++ H2C_Parameter[3] |= RAINFO_BF_STATE; ++ else { ++ if (stbc_en) ++ H2C_Parameter[3] |= RAINFO_STBC_STATE; ++ } ++ ++ if (pDM_Odm->NoisyDecision) ++ H2C_Parameter[3] |= RAINFO_NOISY_STATE; ++ else ++ H2C_Parameter[3] &= (~RAINFO_NOISY_STATE); ++ #if 1 ++ if (pDM_Odm->H2C_RARpt_connect) { ++ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("H2C_RARpt_connect = (( %d ))\n", pDM_Odm->H2C_RARpt_connect)); ++ } ++ #else ++ ++ if (pEntry->rssi_stat.ra_rpt_linked == FALSE) { ++ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; ++ pEntry->rssi_stat.ra_rpt_linked = TRUE; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("RA First Link, RSSI[%d] = ((%d))\n", ++ pEntry->AssociatedMacId, pEntry->rssi_stat.UndecoratedSmoothedPWDB)); ++ } ++ #endif ++ } ++ ++ H2C_Parameter[2] = (u1Byte)(pEntry->rssi_stat.UndecoratedSmoothedPWDB & 0xFF); ++ //H2C_Parameter[1] = 0x20; // fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1 ++ H2C_Parameter[0] = (pEntry->AssociatedMacId); ++ ++ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); ++ } ++ } else ++ break; ++ } ++ ++ pLoopAdapter = GetNextExtAdapter(pLoopAdapter); ++ } ++ ++ ++ /*Default port*/ ++ if (tmpEntryMaxPWDB != 0) { // If associated entry is found ++ pHalData->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB; ++ RT_DISP(FDM, DM_PWDB, ("EntryMaxPWDB = 0x%x(%d)\n", tmpEntryMaxPWDB, tmpEntryMaxPWDB)); ++ } else ++ pHalData->EntryMaxUndecoratedSmoothedPWDB = 0; ++ ++ if (tmpEntryMinPWDB != 0xff) { // If associated entry is found ++ pHalData->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB; ++ RT_DISP(FDM, DM_PWDB, ("EntryMinPWDB = 0x%x(%d)\n", tmpEntryMinPWDB, tmpEntryMinPWDB)); ++ ++ } else ++ pHalData->EntryMinUndecoratedSmoothedPWDB = 0; ++ ++ /* Default porti sent RSSI to FW */ ++ if (pHalData->bUseRAMask) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("1 RA First Link, RSSI[%d] = ((%d)) , ra_rpt_linked = ((%d))\n", ++ WIN_DEFAULT_PORT_MACID, pHalData->UndecoratedSmoothedPWDB, pHalData->ra_rpt_linked)); ++ if (pHalData->UndecoratedSmoothedPWDB > 0) { ++ ++ PRT_HIGH_THROUGHPUT pHTInfo = GET_HT_INFO(pDefaultMgntInfo); ++ PRT_VERY_HIGH_THROUGHPUT pVHTInfo = GET_VHT_INFO(pDefaultMgntInfo); ++ ++ /* BF_en*/ ++ #if (BEAMFORMING_SUPPORT == 1) ++ #ifndef BEAMFORMING_VERSION_1 ++ Beamform_cap = phydm_Beamforming_GetEntryBeamCapByMacId(pDM_Odm, pDefaultMgntInfo->mMacId); ++ ++ if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) ++ TxBF_EN = 1; ++ #else ++ if(Beamform_GetSupportBeamformerCap(GetDefaultAdapter(Adapter), NULL)) ++ TxBF_EN = 1; ++ #endif ++ #endif ++ ++ /* STBC_en*/ ++ if ((IS_WIRELESS_MODE_AC(Adapter) && TEST_FLAG(pVHTInfo->VhtCurStbc, STBC_VHT_ENABLE_TX)) || ++ TEST_FLAG(pHTInfo->HtCurStbc, STBC_HT_ENABLE_TX)) ++ stbc_en = 1; ++ ++ H2C_Parameter[4] = (pRA_Table->RA_threshold_offset & 0x7f) | (pRA_Table->RA_offset_direction<<7); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")), pRA_Table->RA_threshold_offset)); ++ ++ if (bExtRAInfo) { ++ if (TxBF_EN) ++ H2C_Parameter[3] |= RAINFO_BF_STATE; ++ else { ++ if (stbc_en) ++ H2C_Parameter[3] |= RAINFO_STBC_STATE; ++ } ++ ++ #if 1 ++ if (pDM_Odm->H2C_RARpt_connect) { ++ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("H2C_RARpt_connect = (( %d ))\n", pDM_Odm->H2C_RARpt_connect)); ++ } ++ #else ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("2 RA First Link, RSSI[%d] = ((%d)) , ra_rpt_linked = ((%d))\n", ++ WIN_DEFAULT_PORT_MACID, pHalData->UndecoratedSmoothedPWDB, pHalData->ra_rpt_linked)); ++ ++ if (pHalData->ra_rpt_linked == FALSE) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("3 RA First Link, RSSI[%d] = ((%d)) , ra_rpt_linked = ((%d))\n", ++ WIN_DEFAULT_PORT_MACID, pHalData->UndecoratedSmoothedPWDB, pHalData->ra_rpt_linked)); ++ ++ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; ++ pHalData->ra_rpt_linked = TRUE; ++ ++ ++ } ++ #endif ++ ++ if (pDM_Odm->NoisyDecision == 1) { ++ H2C_Parameter[3] |= RAINFO_NOISY_STATE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, ("[RSSIMonitorCheckMP] Send H2C to FW\n")); ++ } else ++ H2C_Parameter[3] &= (~RAINFO_NOISY_STATE); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, ("[RSSIMonitorCheckMP] H2C_Parameter=%x\n", H2C_Parameter[3])); ++ } ++ ++ H2C_Parameter[2] = (u1Byte)(pHalData->UndecoratedSmoothedPWDB & 0xFF); ++ /*H2C_Parameter[1] = 0x20;*/ /* fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1*/ ++ H2C_Parameter[0] = WIN_DEFAULT_PORT_MACID; /* fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1*/ ++ ++ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); ++ } ++ ++ // BT 3.0 HS mode Rssi ++ if (pDM_Odm->bBtHsOperation) { ++ H2C_Parameter[2] = pDM_Odm->btHsRssi; ++ //H2C_Parameter[1] = 0x0; ++ H2C_Parameter[0] = WIN_BT_PORT_MACID; ++ ++ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); ++ } ++ } else ++ PlatformEFIOWrite1Byte(Adapter, 0x4fe, (u1Byte)pHalData->UndecoratedSmoothedPWDB); ++ ++ if ((pDM_Odm->SupportICType == ODM_RTL8812) || (pDM_Odm->SupportICType == ODM_RTL8192E)) ++ odm_RSSIDumpToRegister(pDM_Odm); ++ ++ ++ { ++ PADAPTER pLoopAdapter = GetDefaultAdapter(Adapter); ++ BOOLEAN default_pointer_value, *pbLink_temp = &default_pointer_value; ++ s4Byte GlobalRSSI_min = 0xFF, LocalRSSI_Min; ++ BOOLEAN bLink = FALSE; ++ ++ while (pLoopAdapter) { ++ LocalRSSI_Min = phydm_FindMinimumRSSI(pDM_Odm, pLoopAdapter, pbLink_temp); ++ //DbgPrint("pHalData->bLinked=%d, LocalRSSI_Min=%d\n", pHalData->bLinked, LocalRSSI_Min); ++ ++ if (*pbLink_temp) ++ bLink = TRUE; ++ ++ if ((LocalRSSI_Min < GlobalRSSI_min) && (*pbLink_temp)) ++ GlobalRSSI_min = LocalRSSI_Min; ++ ++ pLoopAdapter = GetNextExtAdapter(pLoopAdapter); ++ } ++ ++ pHalData->bLinked = bLink; ++ ODM_CmnInfoUpdate(&pHalData->DM_OutSrc , ODM_CMNINFO_LINK, (u8Byte)bLink); ++ ++ if (bLink) ++ ODM_CmnInfoUpdate(&pHalData->DM_OutSrc, ODM_CMNINFO_RSSI_MIN, (u8Byte)GlobalRSSI_min); ++ else ++ ODM_CmnInfoUpdate(&pHalData->DM_OutSrc, ODM_CMNINFO_RSSI_MIN, 0); ++ ++ } ++ ++#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++} ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++/*H2C_RSSI_REPORT*/ ++s8 phydm_rssi_report(PDM_ODM_T pDM_Odm, u8 mac_id) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 H2C_Parameter[H2C_0X42_LENGTH] = {0}; ++ u8 UL_DL_STATE = 0, STBC_TX = 0, TxBF_EN = 0; ++ u8 cmdlen = H2C_0X42_LENGTH, first_connect = _FALSE; ++ u64 curTxOkCnt = 0, curRxOkCnt = 0; ++ PSTA_INFO_T pEntry = pDM_Odm->pODM_StaInfo[mac_id]; ++ ++ if (!IS_STA_VALID(pEntry)) ++ return _FAIL; ++ ++ if (mac_id != pEntry->mac_id) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s mac_id:%u:%u invalid\n", __func__, mac_id, pEntry->mac_id)); ++ rtw_warn_on(1); ++ return _FAIL; ++ } ++ ++ if (IS_MCAST(pEntry->hwaddr)) /*if(psta->mac_id ==1)*/ ++ return _FAIL; ++ ++ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB == (-1)) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s mac_id:%u, mac:"MAC_FMT", rssi == -1\n", __func__, pEntry->mac_id, MAC_ARG(pEntry->hwaddr))); ++ return _FAIL; ++ } ++ ++ curTxOkCnt = pdvobjpriv->traffic_stat.cur_tx_bytes; ++ curRxOkCnt = pdvobjpriv->traffic_stat.cur_rx_bytes; ++ if (curRxOkCnt > (curTxOkCnt * 6)) ++ UL_DL_STATE = 1; ++ else ++ UL_DL_STATE = 0; ++ ++ #ifdef CONFIG_BEAMFORMING ++ { ++ #if (BEAMFORMING_SUPPORT == 1) ++ BEAMFORMING_CAP Beamform_cap = phydm_Beamforming_GetEntryBeamCapByMacId(pDM_Odm, pEntry->mac_id); ++ #else/*for drv beamforming*/ ++ BEAMFORMING_CAP Beamform_cap = beamforming_get_entry_beam_cap_by_mac_id(&Adapter->mlmepriv, pEntry->mac_id); ++ #endif ++ ++ if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) ++ TxBF_EN = 1; ++ else ++ TxBF_EN = 0; ++ } ++ #endif /*#ifdef CONFIG_BEAMFORMING*/ ++ ++ if (TxBF_EN) ++ STBC_TX = 0; ++ else { ++ #ifdef CONFIG_80211AC_VHT ++ if (IsSupportedVHT(pEntry->wireless_mode)) ++ STBC_TX = TEST_FLAG(pEntry->vhtpriv.stbc_cap, STBC_VHT_ENABLE_TX); ++ else ++ #endif ++ #ifdef CONFIG_80211N_HT ++ STBC_TX = TEST_FLAG(pEntry->htpriv.stbc_cap, STBC_HT_ENABLE_TX); ++ #endif ++ } ++ ++ H2C_Parameter[0] = (u8)(pEntry->mac_id & 0xFF); ++ H2C_Parameter[2] = pEntry->rssi_stat.UndecoratedSmoothedPWDB & 0x7F; ++ ++ if (UL_DL_STATE) ++ H2C_Parameter[3] |= RAINFO_BE_RX_STATE; ++ ++ if (TxBF_EN) ++ H2C_Parameter[3] |= RAINFO_BF_STATE; ++ if (STBC_TX) ++ H2C_Parameter[3] |= RAINFO_STBC_STATE; ++ if (pDM_Odm->NoisyDecision) ++ H2C_Parameter[3] |= RAINFO_NOISY_STATE; ++ ++ if ((pEntry->ra_rpt_linked == _FALSE) && (pEntry->rssi_stat.bsend_rssi == RA_RSSI_STATE_SEND)) { ++ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; ++ pEntry->ra_rpt_linked = _TRUE; ++ pEntry->rssi_stat.bsend_rssi = RA_RSSI_STATE_HOLD; ++ first_connect = _TRUE; ++ } ++ ++ H2C_Parameter[4] = (pRA_Table->RA_threshold_offset & 0x7f) | (pRA_Table->RA_offset_direction<<7); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")), pRA_Table->RA_threshold_offset)); ++ ++ #if 1 ++ if (first_connect) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s mac_id:%u, mac:"MAC_FMT", rssi:%d\n", __func__, ++ pEntry->mac_id, MAC_ARG(pEntry->hwaddr), pEntry->rssi_stat.UndecoratedSmoothedPWDB)); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s RAINFO - TP:%s, TxBF:%s, STBC:%s, Noisy:%s, Firstcont:%s\n", __func__, ++ (UL_DL_STATE) ? "DL" : "UL", (TxBF_EN) ? "EN" : "DIS", (STBC_TX) ? "EN" : "DIS", ++ (pDM_Odm->NoisyDecision) ? "True" : "False", (first_connect) ? "True" : "False")); ++ } ++ #endif ++ ++ if (pHalData->fw_ractrl == _TRUE) { ++ #if (RTL8188E_SUPPORT == 1) ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) ++ cmdlen = 3; ++ #endif ++ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); ++ } else { ++ #if ((RTL8188E_SUPPORT == 1) && (RATE_ADAPTIVE_SUPPORT == 1)) ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) ++ ODM_RA_SetRSSI_8188E(pDM_Odm, (u8)(pEntry->mac_id & 0xFF), pEntry->rssi_stat.UndecoratedSmoothedPWDB & 0x7F); ++ #endif ++ } ++ return _SUCCESS; ++} ++ ++void phydm_ra_rssi_rpt_wk_hdl(PVOID pContext) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pContext; ++ int i; ++ u8 mac_id = 0xFF; ++ PSTA_INFO_T pEntry = NULL; ++ ++ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { ++ pEntry = pDM_Odm->pODM_StaInfo[i]; ++ if (IS_STA_VALID(pEntry)) { ++ if (IS_MCAST(pEntry->hwaddr)) /*if(psta->mac_id ==1)*/ ++ continue; ++ if (pEntry->ra_rpt_linked == _FALSE) { ++ mac_id = i; ++ break; ++ } ++ } ++ } ++ if (mac_id != 0xFF) ++ phydm_rssi_report(pDM_Odm, mac_id); ++} ++void phydm_ra_rssi_rpt_wk(PVOID pContext) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pContext; ++ ++ rtw_run_in_thread_cmd(pDM_Odm->Adapter, phydm_ra_rssi_rpt_wk_hdl, pDM_Odm); ++} ++#endif ++ ++VOID ++odm_RSSIMonitorCheckCE( ++ IN PVOID pDM_VOID ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PSTA_INFO_T pEntry; ++ int i; ++ int tmpEntryMaxPWDB = 0, tmpEntryMinPWDB = 0xff; ++ u8 sta_cnt = 0; ++ ++ if (pDM_Odm->bLinked != _TRUE) ++ return; ++ ++ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { ++ pEntry = pDM_Odm->pODM_StaInfo[i]; ++ if (IS_STA_VALID(pEntry)) { ++ if (IS_MCAST(pEntry->hwaddr)) /*if(psta->mac_id ==1)*/ ++ continue; ++ ++ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB == (-1)) ++ continue; ++ ++ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB) ++ tmpEntryMinPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; ++ ++ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB) ++ tmpEntryMaxPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; ++ ++ if (phydm_rssi_report(pDM_Odm, i)) ++ sta_cnt++; ++ } ++ } ++ ++ if (tmpEntryMaxPWDB != 0) // If associated entry is found ++ pHalData->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB; ++ else ++ pHalData->EntryMaxUndecoratedSmoothedPWDB = 0; ++ ++ if (tmpEntryMinPWDB != 0xff) // If associated entry is found ++ pHalData->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB; ++ else ++ pHalData->EntryMinUndecoratedSmoothedPWDB = 0; ++ ++ FindMinimumRSSI(Adapter);//get pdmpriv->MinUndecoratedPWDBForDM ++ ++ pDM_Odm->RSSI_Min = pHalData->MinUndecoratedPWDBForDM; ++ //ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM); ++#endif//if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++} ++ ++ ++VOID ++odm_RSSIMonitorCheckAP( ++ IN PVOID pDM_VOID ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++#if (RTL8812A_SUPPORT || RTL8881A_SUPPORT || RTL8192E_SUPPORT || RTL8814A_SUPPORT || RTL8197F_SUPPORT) ++ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u1Byte H2C_Parameter[H2C_0X42_LENGTH] = {0}; ++ u4Byte i; ++ BOOLEAN bExtRAInfo = TRUE; ++ u1Byte cmdlen = H2C_0X42_LENGTH; ++ u1Byte TxBF_EN = 0, stbc_en = 0; ++ ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ PSTA_INFO_T pstat; ++ BOOLEAN act_bfer = FALSE; ++ ++#if (BEAMFORMING_SUPPORT == 1) ++ u1Byte Idx=0xff; ++#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) ++ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; ++ pDM_BdcTable->num_Txbfee_Client = 0; ++ pDM_BdcTable->num_Txbfer_Client = 0; ++#endif ++#endif ++ if (!pDM_Odm->H2C_RARpt_connect && (priv->up_time % 2)) ++ return; ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E) { ++ bExtRAInfo = FALSE; ++ cmdlen = 3; ++ } ++ ++ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { ++ pstat = pDM_Odm->pODM_StaInfo[i]; ++ ++ if (IS_STA_VALID(pstat)) { ++ if (pstat->sta_in_firmware != 1) ++ continue; ++ ++ //2 BF_en ++ #if (BEAMFORMING_SUPPORT == 1) ++ BEAMFORMING_CAP Beamform_cap = Beamforming_GetEntryBeamCapByMacId(priv, pstat->aid); ++ PRT_BEAMFORMING_ENTRY pEntry = Beamforming_GetEntryByMacId(priv, pstat->aid, &Idx); ++ ++ if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { ++ ++ if (pEntry->Sounding_En) ++ TxBF_EN = 1; ++ else ++ TxBF_EN = 0; ++ ++ act_bfer = TRUE; ++ } ++ ++ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) /*BDC*/ ++ if (act_bfer == TRUE) { ++ pDM_BdcTable->w_BFee_Client[i] = 1; //AP act as BFer ++ pDM_BdcTable->num_Txbfee_Client++; ++ } else { ++ pDM_BdcTable->w_BFee_Client[i] = 0; //AP act as BFer ++ } ++ ++ if ((Beamform_cap & BEAMFORMEE_CAP_HT_EXPLICIT) || (Beamform_cap & BEAMFORMEE_CAP_VHT_SU)) { ++ pDM_BdcTable->w_BFer_Client[i] = 1; //AP act as BFee ++ pDM_BdcTable->num_Txbfer_Client++; ++ } else { ++ pDM_BdcTable->w_BFer_Client[i] = 0; //AP act as BFer ++ } ++ #endif ++ #endif ++ ++ //2 STBC_en ++ if ((priv->pmib->dot11nConfigEntry.dot11nSTBC) && ++ ((pstat->ht_cap_buf.ht_cap_info & cpu_to_le16(_HTCAP_RX_STBC_CAP_)) ++ #ifdef RTK_AC_SUPPORT ++ || (pstat->vht_cap_buf.vht_cap_info & cpu_to_le32(_VHTCAP_RX_STBC_CAP_)) ++ #endif ++ )) ++ stbc_en = 1; ++ ++ //2 RAINFO ++ ++ H2C_Parameter[4] = (pRA_Table->RA_threshold_offset & 0x7f) | (pRA_Table->RA_offset_direction<<7); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")), pRA_Table->RA_threshold_offset)); ++ ++ if (bExtRAInfo) { ++ if ((pstat->rx_avarage) > ((pstat->tx_avarage) * 6)) ++ H2C_Parameter[3] |= RAINFO_BE_RX_STATE; ++ ++ if (TxBF_EN) ++ H2C_Parameter[3] |= RAINFO_BF_STATE; ++ else { ++ if (stbc_en) ++ H2C_Parameter[3] |= RAINFO_STBC_STATE; ++ } ++ ++ if (pDM_Odm->NoisyDecision) ++ H2C_Parameter[3] |= RAINFO_NOISY_STATE; ++ else ++ H2C_Parameter[3] &= (~RAINFO_NOISY_STATE); ++ ++ if (pstat->H2C_rssi_rpt) { ++ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[RA Init] set Init rate by RSSI, STA %d\n", pstat->aid)); ++ } ++ ++ /*ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[RAINFO] H2C_Para[3] = %x\n",H2C_Parameter[3]));*/ ++ } ++ ++ H2C_Parameter[2] = (u1Byte)(pstat->rssi & 0xFF); ++ H2C_Parameter[0] = REMAP_AID(pstat); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("H2C_Parameter[3]=%d\n", H2C_Parameter[3])); ++ ++ //ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[RSSI] H2C_Para[2] = %x, \n",H2C_Parameter[2])); ++ //ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[MACID] H2C_Para[0] = %x, \n",H2C_Parameter[0])); ++ ++ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); ++ ++ } ++ } ++ ++#endif ++#endif ++ ++} ++ ++VOID ++odm_RSSIMonitorCheck( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)) ++ return; ++ ++ switch (pDM_Odm->SupportPlatform) { ++ case ODM_WIN: ++ odm_RSSIMonitorCheckMP(pDM_Odm); ++ break; ++ ++ case ODM_CE: ++ odm_RSSIMonitorCheckCE(pDM_Odm); ++ break; ++ ++ case ODM_AP: ++ odm_RSSIMonitorCheckAP(pDM_Odm); ++ break; ++ ++ default: ++ break; ++ } ++ ++} ++ ++VOID ++odm_RateAdaptiveMaskInit( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PODM_RATE_ADAPTIVE pOdmRA = &pDM_Odm->RateAdaptive; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PMGNT_INFO pMgntInfo = &pDM_Odm->Adapter->MgntInfo; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pDM_Odm->Adapter); ++ ++ pMgntInfo->Ratr_State = DM_RATR_STA_INIT; ++ ++ if (pMgntInfo->DM_Type == DM_Type_ByDriver) ++ pHalData->bUseRAMask = TRUE; ++ else ++ pHalData->bUseRAMask = FALSE; ++ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ pOdmRA->Type = DM_Type_ByDriver; ++ if (pOdmRA->Type == DM_Type_ByDriver) ++ pDM_Odm->bUseRAMask = _TRUE; ++ else ++ pDM_Odm->bUseRAMask = _FALSE; ++#endif ++ ++ pOdmRA->RATRState = DM_RATR_STA_INIT; ++ ++#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ pOdmRA->LdpcThres = 50; ++ else ++ pOdmRA->LdpcThres = 35; ++ ++ pOdmRA->RtsThres = 35; ++ ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ pOdmRA->LdpcThres = 35; ++ pOdmRA->bUseLdpc = FALSE; ++ ++#else ++ pOdmRA->UltraLowRSSIThresh = 9; ++ ++#endif ++ ++ pOdmRA->HighRSSIThresh = 50; ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && \ ++ ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) ++ pOdmRA->LowRSSIThresh = 23; ++#else ++ pOdmRA->LowRSSIThresh = 20; ++#endif ++} ++/*----------------------------------------------------------------------------- ++ * Function: odm_RefreshRateAdaptiveMask() ++ * ++ * Overview: Update rate table mask according to rssi ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 05/27/2009 hpfan Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++VOID ++odm_RefreshRateAdaptiveMask( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (!pDM_Odm->bLinked) ++ return; ++ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_RA_MASK)) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("odm_RefreshRateAdaptiveMask(): Return cos not supported\n")); ++ return; ++ } ++ // ++ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate ++ // at the same time. In the stage2/3, we need to prive universal interface and merge all ++ // HW dynamic mechanism. ++ // ++ switch (pDM_Odm->SupportPlatform) { ++ case ODM_WIN: ++ odm_RefreshRateAdaptiveMaskMP(pDM_Odm); ++ break; ++ ++ case ODM_CE: ++ odm_RefreshRateAdaptiveMaskCE(pDM_Odm); ++ break; ++ ++ case ODM_AP: ++ odm_RefreshRateAdaptiveMaskAPADSL(pDM_Odm); ++ break; ++ } ++ ++} ++ ++u1Byte ++phydm_trans_platform_bw( ++ IN PVOID pDM_VOID, ++ IN u1Byte BW ++) ++{ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if (BW == CHANNEL_WIDTH_20) ++ BW = PHYDM_BW_20; ++ ++ else if (BW == CHANNEL_WIDTH_40) ++ BW = PHYDM_BW_40; ++ ++ else if (BW == CHANNEL_WIDTH_80) ++ BW = PHYDM_BW_80; ++ ++ else if (BW == CHANNEL_WIDTH_160) ++ BW = PHYDM_BW_160; ++ ++ else if (BW == CHANNEL_WIDTH_80_80) ++ BW = PHYDM_BW_80_80; ++ ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++ if (BW == HT_CHANNEL_WIDTH_20) ++ BW = PHYDM_BW_20; ++ ++ else if (BW == HT_CHANNEL_WIDTH_20_40) ++ BW = PHYDM_BW_40; ++ ++ else if (BW == HT_CHANNEL_WIDTH_80) ++ BW = PHYDM_BW_80; ++ ++ else if (BW == HT_CHANNEL_WIDTH_160) ++ BW = PHYDM_BW_160; ++ ++ else if (BW == HT_CHANNEL_WIDTH_10) ++ BW = PHYDM_BW_10; ++ ++ else if (BW == HT_CHANNEL_WIDTH_5) ++ BW = PHYDM_BW_5; ++ ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ ++ if (BW == CHANNEL_WIDTH_20) ++ BW = PHYDM_BW_20; ++ ++ else if (BW == CHANNEL_WIDTH_40) ++ BW = PHYDM_BW_40; ++ ++ else if (BW == CHANNEL_WIDTH_80) ++ BW = PHYDM_BW_80; ++ ++ else if (BW == CHANNEL_WIDTH_160) ++ BW = PHYDM_BW_160; ++ ++ else if (BW == CHANNEL_WIDTH_80_80) ++ BW = PHYDM_BW_80_80; ++ #endif ++ ++ return BW; ++ ++} ++ ++u1Byte ++phydm_trans_platform_rf_type( ++ IN PVOID pDM_VOID, ++ IN u1Byte RfType ++) ++{ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if (RfType == RF_1T2R) ++ RfType = PHYDM_RF_1T2R; ++ ++ else if (RfType == RF_2T4R) ++ RfType = PHYDM_RF_2T4R; ++ ++ else if (RfType == RF_2T2R) ++ RfType = PHYDM_RF_2T2R; ++ ++ else if (RfType == RF_1T1R) ++ RfType = PHYDM_RF_1T1R; ++ ++ else if (RfType == RF_2T2R_GREEN) ++ RfType = PHYDM_RF_2T2R_GREEN; ++ ++ else if (RfType == RF_3T3R) ++ RfType = PHYDM_RF_3T3R; ++ ++ else if (RfType == RF_4T4R) ++ RfType = PHYDM_RF_4T4R; ++ ++ else if (RfType == RF_2T3R) ++ RfType = PHYDM_RF_1T2R; ++ ++ else if (RfType == RF_3T4R) ++ RfType = PHYDM_RF_3T4R; ++ ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++ if (RfType == MIMO_1T2R) ++ RfType = PHYDM_RF_1T2R; ++ ++ else if (RfType == MIMO_2T4R) ++ RfType = PHYDM_RF_2T4R; ++ ++ else if (RfType == MIMO_2T2R) ++ RfType = PHYDM_RF_2T2R; ++ ++ else if (RfType == MIMO_1T1R) ++ RfType = PHYDM_RF_1T1R; ++ ++ else if (RfType == MIMO_3T3R) ++ RfType = PHYDM_RF_3T3R; ++ ++ else if (RfType == MIMO_4T4R) ++ RfType = PHYDM_RF_4T4R; ++ ++ else if (RfType == MIMO_2T3R) ++ RfType = PHYDM_RF_1T2R; ++ ++ else if (RfType == MIMO_3T4R) ++ RfType = PHYDM_RF_3T4R; ++ ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ ++ if (RfType == RF_1T2R) ++ RfType = PHYDM_RF_1T2R; ++ ++ else if (RfType == RF_2T4R) ++ RfType = PHYDM_RF_2T4R; ++ ++ else if (RfType == RF_2T2R) ++ RfType = PHYDM_RF_2T2R; ++ ++ else if (RfType == RF_1T1R) ++ RfType = PHYDM_RF_1T1R; ++ ++ else if (RfType == RF_2T2R_GREEN) ++ RfType = PHYDM_RF_2T2R_GREEN; ++ ++ else if (RfType == RF_3T3R) ++ RfType = PHYDM_RF_3T3R; ++ ++ else if (RfType == RF_4T4R) ++ RfType = PHYDM_RF_4T4R; ++ ++ else if (RfType == RF_2T3R) ++ RfType = PHYDM_RF_1T2R; ++ ++ else if (RfType == RF_3T4R) ++ RfType = PHYDM_RF_3T4R; ++ ++ #endif ++ ++ return RfType; ++ ++} ++ ++u4Byte ++phydm_trans_platform_wireless_mode( ++ IN PVOID pDM_VOID, ++ IN u4Byte wireless_mode ++) ++{ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ ++ if (wireless_mode == WIRELESS_11A) ++ wireless_mode = PHYDM_WIRELESS_MODE_A; ++ ++ else if (wireless_mode == WIRELESS_11B) ++ wireless_mode = PHYDM_WIRELESS_MODE_B; ++ ++ else if ((wireless_mode == WIRELESS_11G) || (wireless_mode == WIRELESS_11BG)) ++ wireless_mode = PHYDM_WIRELESS_MODE_G; ++ ++ else if (wireless_mode == WIRELESS_AUTO) ++ wireless_mode = PHYDM_WIRELESS_MODE_AUTO; ++ ++ else if ((wireless_mode == WIRELESS_11_24N) || (wireless_mode == WIRELESS_11G_24N) || (wireless_mode == WIRELESS_11B_24N) || ++ (wireless_mode == WIRELESS_11BG_24N) || (wireless_mode == WIRELESS_MODE_24G) || (wireless_mode == WIRELESS_11ABGN) || (wireless_mode == WIRELESS_11AGN)) ++ wireless_mode = PHYDM_WIRELESS_MODE_N_24G; ++ ++ else if ((wireless_mode == WIRELESS_11_5N) || (wireless_mode == WIRELESS_11A_5N)) ++ wireless_mode = PHYDM_WIRELESS_MODE_N_5G; ++ ++ else if ((wireless_mode == WIRELESS_11AC) || (wireless_mode == WIRELESS_11_5AC) || (wireless_mode == WIRELESS_MODE_5G)) ++ wireless_mode = PHYDM_WIRELESS_MODE_AC_5G; ++ ++ else if (wireless_mode == WIRELESS_11_24AC) ++ wireless_mode = PHYDM_WIRELESS_MODE_AC_24G; ++ ++ else if (wireless_mode == WIRELESS_11AC) ++ wireless_mode = PHYDM_WIRELESS_MODE_AC_ONLY; ++ ++ else if (wireless_mode == WIRELESS_MODE_MAX) ++ wireless_mode = PHYDM_WIRELESS_MODE_MAX; ++ else ++ wireless_mode = PHYDM_WIRELESS_MODE_UNKNOWN; ++ #endif ++ ++ return wireless_mode; ++ ++} ++ ++u1Byte ++phydm_vht_en_mapping( ++ IN PVOID pDM_VOID, ++ IN u4Byte WirelessMode ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte vht_en_out = 0; ++ ++ if ((WirelessMode == PHYDM_WIRELESS_MODE_AC_5G) || ++ (WirelessMode == PHYDM_WIRELESS_MODE_AC_24G) || ++ (WirelessMode == PHYDM_WIRELESS_MODE_AC_ONLY) ++ ) { ++ vht_en_out = 1; ++ /**/ ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("WirelessMode= (( 0x%x )), VHT_EN= (( %d ))\n", WirelessMode, vht_en_out)); ++ return vht_en_out; ++} ++ ++u1Byte ++phydm_rate_id_mapping( ++ IN PVOID pDM_VOID, ++ IN u4Byte WirelessMode, ++ IN u1Byte RfType, ++ IN u1Byte bw ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte rate_id_idx = 0; ++ u1Byte phydm_BW; ++ u1Byte phydm_RfType; ++ ++ phydm_BW = phydm_trans_platform_bw(pDM_Odm, bw); ++ phydm_RfType = phydm_trans_platform_rf_type(pDM_Odm, RfType); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ WirelessMode = phydm_trans_platform_wireless_mode(pDM_Odm, WirelessMode); ++ #endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("wirelessMode= (( 0x%x )), RfType = (( 0x%x )), BW = (( 0x%x ))\n", ++ WirelessMode, phydm_RfType, phydm_BW)); ++ ++ ++ switch (WirelessMode) { ++ ++ case PHYDM_WIRELESS_MODE_N_24G: ++ { ++ ++ if (phydm_BW == PHYDM_BW_40) { ++ ++ if (phydm_RfType == PHYDM_RF_1T1R) ++ rate_id_idx = PHYDM_BGN_40M_1SS; ++ else if (phydm_RfType == PHYDM_RF_2T2R) ++ rate_id_idx = PHYDM_BGN_40M_2SS; ++ else ++ rate_id_idx = PHYDM_ARFR5_N_3SS; ++ ++ } else { ++ ++ if (phydm_RfType == PHYDM_RF_1T1R) ++ rate_id_idx = PHYDM_BGN_20M_1SS; ++ else if (phydm_RfType == PHYDM_RF_2T2R) ++ rate_id_idx = PHYDM_BGN_20M_2SS; ++ else ++ rate_id_idx = PHYDM_ARFR5_N_3SS; ++ } ++ } ++ break; ++ ++ case PHYDM_WIRELESS_MODE_N_5G: ++ { ++ if (phydm_RfType == PHYDM_RF_1T1R) ++ rate_id_idx = PHYDM_GN_N1SS; ++ else if (phydm_RfType == PHYDM_RF_2T2R) ++ rate_id_idx = PHYDM_GN_N2SS; ++ else ++ rate_id_idx = PHYDM_ARFR5_N_3SS; ++ } ++ ++ break; ++ ++ case PHYDM_WIRELESS_MODE_G: ++ rate_id_idx = PHYDM_BG; ++ break; ++ ++ case PHYDM_WIRELESS_MODE_A: ++ rate_id_idx = PHYDM_G; ++ break; ++ ++ case PHYDM_WIRELESS_MODE_B: ++ rate_id_idx = PHYDM_B_20M; ++ break; ++ ++ ++ case PHYDM_WIRELESS_MODE_AC_5G: ++ case PHYDM_WIRELESS_MODE_AC_ONLY: ++ { ++ if (phydm_RfType == PHYDM_RF_1T1R) ++ rate_id_idx = PHYDM_ARFR1_AC_1SS; ++ else if (phydm_RfType == PHYDM_RF_2T2R) ++ rate_id_idx = PHYDM_ARFR0_AC_2SS; ++ else ++ rate_id_idx = PHYDM_ARFR4_AC_3SS; ++ } ++ break; ++ ++ case PHYDM_WIRELESS_MODE_AC_24G: ++ { ++ /*Becareful to set "Lowest rate" while using PHYDM_ARFR4_AC_3SS in 2.4G/5G*/ ++ if (phydm_BW >= PHYDM_BW_80) { ++ if (phydm_RfType == PHYDM_RF_1T1R) ++ rate_id_idx = PHYDM_ARFR1_AC_1SS; ++ else if (phydm_RfType == PHYDM_RF_2T2R) ++ rate_id_idx = PHYDM_ARFR0_AC_2SS; ++ else ++ rate_id_idx = PHYDM_ARFR4_AC_3SS; ++ } else { ++ ++ if (phydm_RfType == PHYDM_RF_1T1R) ++ rate_id_idx = PHYDM_ARFR2_AC_2G_1SS; ++ else if (phydm_RfType == PHYDM_RF_2T2R) ++ rate_id_idx = PHYDM_ARFR3_AC_2G_2SS; ++ else ++ rate_id_idx = PHYDM_ARFR4_AC_3SS; ++ } ++ } ++ break; ++ ++ default: ++ rate_id_idx = 0; ++ break; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA Rate ID = (( 0x%d ))\n", rate_id_idx)); ++ ++ return rate_id_idx; ++} ++ ++VOID ++phydm_UpdateHalRAMask( ++ IN PVOID pDM_VOID, ++ IN u4Byte wirelessMode, ++ IN u1Byte RfType, ++ IN u1Byte BW, ++ IN u1Byte MimoPs_enable, ++ IN u1Byte disable_cck_rate, ++ IN u4Byte *ratr_bitmap_msb_in, ++ IN u4Byte *ratr_bitmap_lsb_in, ++ IN u1Byte tx_rate_level ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte mask_rate_threshold; ++ u1Byte phydm_RfType; ++ u1Byte phydm_BW; ++ u4Byte ratr_bitmap = *ratr_bitmap_lsb_in, ratr_bitmap_msb = *ratr_bitmap_msb_in; ++ /*PODM_RATE_ADAPTIVE pRA = &(pDM_Odm->RateAdaptive);*/ ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ wirelessMode = phydm_trans_platform_wireless_mode(pDM_Odm, wirelessMode); ++ #endif ++ ++ phydm_RfType = phydm_trans_platform_rf_type(pDM_Odm, RfType); ++ phydm_BW = phydm_trans_platform_bw(pDM_Odm, BW); ++ ++ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("phydm_RfType = (( %x )), RfType = (( %x ))\n", phydm_RfType, RfType));*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Platfoem original RA Mask = (( 0x %x | %x ))\n", ratr_bitmap_msb, ratr_bitmap)); ++ ++ switch (wirelessMode) { ++ ++ case PHYDM_WIRELESS_MODE_B: ++ { ++ ratr_bitmap &= 0x0000000f; ++ } ++ break; ++ ++ case PHYDM_WIRELESS_MODE_G: ++ { ++ ratr_bitmap &= 0x00000ff5; ++ } ++ break; ++ ++ case PHYDM_WIRELESS_MODE_A: ++ { ++ ratr_bitmap &= 0x00000ff0; ++ } ++ break; ++ ++ case PHYDM_WIRELESS_MODE_N_24G: ++ case PHYDM_WIRELESS_MODE_N_5G: ++ { ++ if (MimoPs_enable) ++ phydm_RfType = PHYDM_RF_1T1R; ++ ++ if (phydm_RfType == PHYDM_RF_1T1R) { ++ ++ if (phydm_BW == PHYDM_BW_40) ++ ratr_bitmap &= 0x000ff015; ++ else ++ ratr_bitmap &= 0x000ff005; ++ } else if (phydm_RfType == PHYDM_RF_2T2R || phydm_RfType == PHYDM_RF_2T4R || phydm_RfType == PHYDM_RF_2T3R) { ++ ++ if (phydm_BW == PHYDM_BW_40) ++ ratr_bitmap &= 0x0ffff015; ++ else ++ ratr_bitmap &= 0x0ffff005; ++ } else { /*3T*/ ++ ++ ratr_bitmap &= 0xfffff015; ++ ratr_bitmap_msb &= 0xf; ++ } ++ } ++ break; ++ ++ case PHYDM_WIRELESS_MODE_AC_24G: ++ { ++ if (phydm_RfType == PHYDM_RF_1T1R) ++ ratr_bitmap &= 0x003ff015; ++ else if (phydm_RfType == PHYDM_RF_2T2R || phydm_RfType == PHYDM_RF_2T4R || phydm_RfType == PHYDM_RF_2T3R) ++ ratr_bitmap &= 0xfffff015; ++ else {/*3T*/ ++ ++ ratr_bitmap &= 0xfffff010; ++ ratr_bitmap_msb &= 0x3ff; ++ } ++ ++ if (phydm_BW == PHYDM_BW_20) {/* AC 20MHz doesn't support MCS9 */ ++ ratr_bitmap &= 0x7fdfffff; ++ ratr_bitmap_msb &= 0x1ff; ++ } ++ } ++ break; ++ ++ case PHYDM_WIRELESS_MODE_AC_5G: ++ { ++ if (phydm_RfType == PHYDM_RF_1T1R) ++ ratr_bitmap &= 0x003ff010; ++ else if (phydm_RfType == PHYDM_RF_2T2R || phydm_RfType == PHYDM_RF_2T4R || phydm_RfType == PHYDM_RF_2T3R) ++ ratr_bitmap &= 0xfffff010; ++ else {/*3T*/ ++ ++ ratr_bitmap &= 0xfffff010; ++ ratr_bitmap_msb &= 0x3ff; ++ } ++ ++ if (phydm_BW == PHYDM_BW_20) {/* AC 20MHz doesn't support MCS9 */ ++ ratr_bitmap &= 0x7fdfffff; ++ ratr_bitmap_msb &= 0x1ff; ++ } ++ } ++ break; ++ ++ default: ++ break; ++ } ++ ++ if (wirelessMode != PHYDM_WIRELESS_MODE_B) { ++ ++ if (tx_rate_level == 0) ++ ratr_bitmap &= 0xffffffff; ++ else if (tx_rate_level == 1) ++ ratr_bitmap &= 0xfffffff0; ++ else if (tx_rate_level == 2) ++ ratr_bitmap &= 0xffffefe0; ++ else if (tx_rate_level == 3) ++ ratr_bitmap &= 0xffffcfc0; ++ else if (tx_rate_level == 4) ++ ratr_bitmap &= 0xffff8f80; ++ else if (tx_rate_level >= 5) ++ ratr_bitmap &= 0xffff0f00; ++ ++ } ++ ++ if (disable_cck_rate) ++ ratr_bitmap &= 0xfffffff0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("wirelessMode= (( 0x%x )), RfType = (( 0x%x )), BW = (( 0x%x )), MimoPs_en = (( %d )), tx_rate_level= (( 0x%d ))\n", ++ wirelessMode, phydm_RfType, phydm_BW, MimoPs_enable, tx_rate_level)); ++ ++ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("111 Phydm modified RA Mask = (( 0x %x | %x ))\n", ratr_bitmap_msb, ratr_bitmap));*/ ++ ++ *ratr_bitmap_lsb_in = ratr_bitmap; ++ *ratr_bitmap_msb_in = ratr_bitmap_msb; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Phydm modified RA Mask = (( 0x %x | %x ))\n", *ratr_bitmap_msb_in, *ratr_bitmap_lsb_in)); ++ ++} ++ ++u1Byte ++phydm_RA_level_decision( ++ IN PVOID pDM_VOID, ++ IN u4Byte rssi, ++ IN u1Byte Ratr_State ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte ra_lowest_rate; ++ u1Byte ra_rate_floor_table[RA_FLOOR_TABLE_SIZE] = {20, 34, 38, 42, 46, 50, 100}; /*MCS0 ~ MCS4 , VHT1SS MCS0 ~ MCS4 , G 6M~24M*/ ++ u1Byte new_Ratr_State = 0; ++ u1Byte i; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("curr RA level = ((%d)), Rate_floor_table ori [ %d , %d, %d , %d, %d, %d]\n", Ratr_State, ++ ra_rate_floor_table[0], ra_rate_floor_table[1], ra_rate_floor_table[2], ra_rate_floor_table[3], ra_rate_floor_table[4], ra_rate_floor_table[5])); ++ ++ for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) { ++ ++ if (i >= (Ratr_State)) ++ ra_rate_floor_table[i] += RA_FLOOR_UP_GAP; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI = ((%d)), Rate_floor_table_mod [ %d , %d, %d , %d, %d, %d]\n", ++ rssi, ra_rate_floor_table[0], ra_rate_floor_table[1], ra_rate_floor_table[2], ra_rate_floor_table[3], ra_rate_floor_table[4], ra_rate_floor_table[5])); ++ ++ for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) { ++ ++ if (rssi < ra_rate_floor_table[i]) { ++ new_Ratr_State = i; ++ break; ++ } ++ } ++ ++ ++ ++ return new_Ratr_State; ++ ++} ++ ++VOID ++odm_RefreshRateAdaptiveMaskMP( ++ IN PVOID pDM_VOID ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ PADAPTER pTargetAdapter = NULL; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMGNT_INFO pMgntInfo = GetDefaultMgntInfo(pAdapter); ++ u4Byte i; ++ PSTA_INFO_T pEntry; ++ u1Byte Ratr_State_new; ++ ++ if (pAdapter->bDriverStopped) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_RefreshRateAdaptiveMask(): driver is going to unload\n")); ++ return; ++ } ++ ++ if (!pHalData->bUseRAMask) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_RefreshRateAdaptiveMask(): driver does not control rate adaptive mask\n")); ++ return; ++ } ++ ++ // if default port is connected, update RA table for default port (infrastructure mode only) ++ if (pMgntInfo->mAssoc && (!ACTING_AS_AP(pAdapter))) { ++ odm_RefreshLdpcRtsMP(pAdapter, pDM_Odm, pMgntInfo->mMacId, pMgntInfo->IOTPeer, pHalData->UndecoratedSmoothedPWDB); ++ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Infrasture Mode\n"));*/ ++ ++ #if RA_MASK_PHYDMLIZE_WIN ++ Ratr_State_new = phydm_RA_level_decision(pDM_Odm, pHalData->UndecoratedSmoothedPWDB, pMgntInfo->Ratr_State); ++ ++ if (pMgntInfo->Ratr_State != Ratr_State_new) { ++ ++ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), pMgntInfo->Bssid); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n\n", ++ pMgntInfo->Ratr_State, Ratr_State_new, pHalData->UndecoratedSmoothedPWDB)); ++ ++ pMgntInfo->Ratr_State = Ratr_State_new; ++ pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, Ratr_State_new); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", Ratr_State_new)); ++ /**/ ++ } ++ ++ #else ++ if (ODM_RAStateCheck(pDM_Odm, pHalData->UndecoratedSmoothedPWDB, pMgntInfo->bSetTXPowerTrainingByOid, &pMgntInfo->Ratr_State)) { ++ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr : "), pMgntInfo->Bssid); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pHalData->UndecoratedSmoothedPWDB, pMgntInfo->Ratr_State)); ++ pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, pMgntInfo->Ratr_State); ++ } else if (pDM_Odm->bChangeState) { ++ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr : "), pMgntInfo->Bssid); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training State, bDisablePowerTraining = %d\n", pDM_Odm->bDisablePowerTraining)); ++ pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, pMgntInfo->Ratr_State); ++ } ++ #endif ++ } ++ ++ // ++ // The following part configure AP/VWifi/IBSS rate adaptive mask. ++ // ++ ++ if (pMgntInfo->mIbss) // Target: AP/IBSS peer. ++ pTargetAdapter = GetDefaultAdapter(pAdapter); ++ else ++ pTargetAdapter = GetFirstAPAdapter(pAdapter); ++ ++ // if extension port (softap) is started, updaet RA table for more than one clients associate ++ if (pTargetAdapter != NULL) { ++ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { ++ ++ pEntry = AsocEntry_EnumStation(pTargetAdapter, i); ++ ++ if (IS_STA_VALID(pEntry)) { ++ ++ odm_RefreshLdpcRtsMP(pAdapter, pDM_Odm, pEntry->AssociatedMacId, pEntry->IOTPeer, pEntry->rssi_stat.UndecoratedSmoothedPWDB); ++ ++ #if RA_MASK_PHYDMLIZE_WIN ++ Ratr_State_new = phydm_RA_level_decision(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->Ratr_State); ++ ++ if (pEntry->Ratr_State != Ratr_State_new) { ++ ++ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), pEntry->MacAddr); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", ++ pEntry->Ratr_State, Ratr_State_new, pEntry->rssi_stat.UndecoratedSmoothedPWDB)); ++ ++ pEntry->Ratr_State = Ratr_State_new; ++ pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pEntry->AssociatedMacId, NULL, Ratr_State_new); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", Ratr_State_new)); ++ /**/ ++ } ++ ++ ++ #else ++ ++ if (ODM_RAStateCheck(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, pMgntInfo->bSetTXPowerTrainingByOid, &pEntry->Ratr_State)) { ++ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target STA addr : "), pEntry->MacAddr); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->Ratr_State)); ++ pAdapter->HalFunc.UpdateHalRAMaskHandler(pTargetAdapter, pEntry->AssociatedMacId, pEntry, pEntry->Ratr_State); ++ } else if (pDM_Odm->bChangeState) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training State, bDisablePowerTraining = %d\n", pDM_Odm->bDisablePowerTraining)); ++ pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, pMgntInfo->Ratr_State); ++ } ++ #endif ++ ++ } ++ } ++ } ++ ++ #if RA_MASK_PHYDMLIZE_WIN ++ ++ #else ++ if (pMgntInfo->bSetTXPowerTrainingByOid) ++ pMgntInfo->bSetTXPowerTrainingByOid = FALSE; ++ #endif ++#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++} ++ ++ ++VOID ++odm_RefreshRateAdaptiveMaskCE( ++ IN PVOID pDM_VOID ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; ++ u4Byte i; ++ PSTA_INFO_T pEntry; ++ u1Byte Ratr_State_new; ++ ++ if (RTW_CANNOT_RUN(pAdapter)) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_RefreshRateAdaptiveMask(): driver is going to unload\n")); ++ return; ++ } ++ ++ if (!pDM_Odm->bUseRAMask) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_RefreshRateAdaptiveMask(): driver does not control rate adaptive mask\n")); ++ return; ++ } ++ ++ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { ++ ++ pEntry = pDM_Odm->pODM_StaInfo[i]; ++ ++ if (IS_STA_VALID(pEntry)) { ++ ++ if (IS_MCAST(pEntry->hwaddr)) ++ continue; ++ ++ #if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) ++ if ((pDM_Odm->SupportICType == ODM_RTL8812) || (pDM_Odm->SupportICType == ODM_RTL8821)) { ++ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB < pRA->LdpcThres) { ++ pRA->bUseLdpc = TRUE; ++ pRA->bLowerRtsRate = TRUE; ++ if ((pDM_Odm->SupportICType == ODM_RTL8821) && (pDM_Odm->CutVersion == ODM_CUT_A)) ++ Set_RA_LDPC_8812(pEntry, TRUE); ++ //DbgPrint("RSSI=%d, bUseLdpc = TRUE\n", pHalData->UndecoratedSmoothedPWDB); ++ } else if (pEntry->rssi_stat.UndecoratedSmoothedPWDB > (pRA->LdpcThres - 5)) { ++ pRA->bUseLdpc = FALSE; ++ pRA->bLowerRtsRate = FALSE; ++ if ((pDM_Odm->SupportICType == ODM_RTL8821) && (pDM_Odm->CutVersion == ODM_CUT_A)) ++ Set_RA_LDPC_8812(pEntry, FALSE); ++ //DbgPrint("RSSI=%d, bUseLdpc = FALSE\n", pHalData->UndecoratedSmoothedPWDB); ++ } ++ } ++ #endif ++ ++ #if RA_MASK_PHYDMLIZE_CE ++ Ratr_State_new = phydm_RA_level_decision(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->rssi_level); ++ ++ if (pEntry->rssi_level != Ratr_State_new) { ++ ++ /*ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), pstat->hwaddr);*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", ++ pEntry->rssi_level, Ratr_State_new, pEntry->rssi_stat.UndecoratedSmoothedPWDB)); ++ ++ pEntry->rssi_level = Ratr_State_new; ++ rtw_hal_update_ra_mask(pEntry, pEntry->rssi_level); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", Ratr_State_new)); ++ /**/ ++ } ++ #else ++ if (TRUE == ODM_RAStateCheck(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, FALSE , &pEntry->rssi_level)) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->rssi_level)); ++ //printk("RSSI:%d, RSSI_LEVEL:%d\n", pstat->rssi_stat.UndecoratedSmoothedPWDB, pstat->rssi_level); ++ rtw_hal_update_ra_mask(pEntry, pEntry->rssi_level); ++ } else if (pDM_Odm->bChangeState) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training State, bDisablePowerTraining = %d\n", pDM_Odm->bDisablePowerTraining)); ++ rtw_hal_update_ra_mask(pEntry, pEntry->rssi_level); ++ } ++ #endif ++ ++ } ++ } ++ ++#endif ++} ++ ++VOID ++odm_RefreshRateAdaptiveMaskAPADSL( ++ IN PVOID pDM_VOID ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ struct rtl8192cd_priv *priv = pDM_Odm->priv; ++ struct aid_obj *aidarray; ++ u4Byte i; ++ PSTA_INFO_T pEntry; ++ u1Byte Ratr_State_new; ++ ++ if (priv->up_time % 2) ++ return; ++ ++ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { ++ pEntry = pDM_Odm->pODM_StaInfo[i]; ++ ++ if (IS_STA_VALID(pEntry)) { ++ ++ #if defined(UNIVERSAL_REPEATER) || defined(MBSSID) ++ aidarray = container_of(pEntry, struct aid_obj, station); ++ priv = aidarray->priv; ++ #endif ++ ++ if (!priv->pmib->dot11StationConfigEntry.autoRate) ++ continue; ++ ++#if RA_MASK_PHYDMLIZE_AP ++ Ratr_State_new = phydm_RA_level_decision(pDM_Odm, (u4Byte)pEntry->rssi, pEntry->rssi_level); ++ ++ if (pEntry->rssi_level != Ratr_State_new) { ++ ++ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), pEntry->hwaddr); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", pEntry->rssi_level, Ratr_State_new, pEntry->rssi)); ++ ++ pEntry->rssi_level = Ratr_State_new; ++ phydm_gen_ramask_h2c_AP(pDM_Odm, priv, pEntry, pEntry->rssi_level); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", Ratr_State_new)); ++ /**/ ++ } ++ ++#else ++ if (ODM_RAStateCheck(pDM_Odm, (s4Byte)pEntry->rssi, FALSE, &pEntry->rssi_level)) { ++ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target STA addr : "), pEntry->hwaddr); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pEntry->rssi, pEntry->rssi_level)); ++ ++ #ifdef CONFIG_WLAN_HAL ++ if (IS_HAL_CHIP(priv)) { ++ #ifdef WDS ++ /*if(!(pstat->state & WIFI_WDS))*/ /*if WDS donot setting*/ ++ #endif ++ GET_HAL_INTERFACE(priv)->UpdateHalRAMaskHandler(priv, pEntry, pEntry->rssi_level); ++ } else ++ #endif ++ ++ #ifdef CONFIG_RTL_8812_SUPPORT ++ if (GET_CHIP_VER(priv) == VERSION_8812E) ++ UpdateHalRAMask8812(priv, pEntry, 3); ++ else ++ #endif ++ { ++ #ifdef CONFIG_RTL_88E_SUPPORT ++ if (GET_CHIP_VER(priv) == VERSION_8188E) { ++ #ifdef TXREPORT ++ add_RATid(priv, pEntry); ++ #endif ++ } ++ #endif ++ ++ ++ } ++ } ++#endif /*#ifdef RA_MASK_PHYDMLIZE*/ ++ ++ } ++ } ++#endif /*#if (DM_ODM_SUPPORT_TYPE & ODM_AP)*/ ++} ++ ++VOID ++odm_RefreshBasicRateMask( ++ IN PVOID pDM_VOID ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ static u1Byte Stage = 0; ++ u1Byte CurStage = 0; ++ OCTET_STRING osRateSet; ++ PMGNT_INFO pMgntInfo = GetDefaultMgntInfo(Adapter); ++ u1Byte RateSet[5] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M, MGN_6M}; ++ ++ if (pDM_Odm->SupportICType != ODM_RTL8812 && pDM_Odm->SupportICType != ODM_RTL8821) ++ return; ++ ++ if (pDM_Odm->bLinked == FALSE) // unlink Default port information ++ CurStage = 0; ++ else if (pDM_Odm->RSSI_Min < 40) // link RSSI < 40% ++ CurStage = 1; ++ else if (pDM_Odm->RSSI_Min > 45) // link RSSI > 45% ++ CurStage = 3; ++ else ++ CurStage = 2; // link 25% <= RSSI <= 30% ++ ++ if (CurStage != Stage) { ++ if (CurStage == 1) { ++ FillOctetString(osRateSet, RateSet, 5); ++ FilterSupportRate(pMgntInfo->mBrates, &osRateSet, FALSE); ++ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_BASIC_RATE, (pu1Byte)&osRateSet); ++ } else if (CurStage == 3 && (Stage == 1 || Stage == 2)) ++ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_BASIC_RATE, (pu1Byte)(&pMgntInfo->mBrates)); ++ } ++ ++ Stage = CurStage; ++#endif ++} ++ ++u1Byte ++phydm_rate_order_compute( ++ IN PVOID pDM_VOID, ++ IN u1Byte rate_idx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte rate_order = 0; ++ ++ if (rate_idx >= ODM_RATEVHTSS4MCS0) { ++ ++ rate_idx -= ODM_RATEVHTSS4MCS0; ++ /**/ ++ } else if (rate_idx >= ODM_RATEVHTSS3MCS0) { ++ ++ rate_idx -= ODM_RATEVHTSS3MCS0; ++ /**/ ++ } else if (rate_idx >= ODM_RATEVHTSS2MCS0) { ++ ++ rate_idx -= ODM_RATEVHTSS2MCS0; ++ /**/ ++ } else if (rate_idx >= ODM_RATEVHTSS1MCS0) { ++ ++ rate_idx -= ODM_RATEVHTSS1MCS0; ++ /**/ ++ } else if (rate_idx >= ODM_RATEMCS24) { ++ ++ rate_idx -= ODM_RATEMCS24; ++ /**/ ++ } else if (rate_idx >= ODM_RATEMCS16) { ++ ++ rate_idx -= ODM_RATEMCS16; ++ /**/ ++ } else if (rate_idx >= ODM_RATEMCS8) { ++ ++ rate_idx -= ODM_RATEMCS8; ++ /**/ ++ } ++ rate_order = rate_idx; ++ ++ return rate_order; ++ ++} ++ ++VOID ++phydm_ra_common_info_update( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ u2Byte macid; ++ u1Byte rate_order_tmp; ++ u1Byte cnt = 0; ++ ++ pRA_Table->highest_client_tx_order = 0; ++ pRA_Table->power_tracking_flag = 1; ++ ++ if (pDM_Odm->number_linked_client != 0) { ++ for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { ++ ++ rate_order_tmp = phydm_rate_order_compute(pDM_Odm, ((pRA_Table->link_tx_rate[macid]) & 0x7f)); ++ ++ if (rate_order_tmp >= (pRA_Table->highest_client_tx_order)) { ++ pRA_Table->highest_client_tx_order = rate_order_tmp; ++ pRA_Table->highest_client_tx_rate_order = macid; ++ } ++ ++ cnt++; ++ ++ if (cnt == pDM_Odm->number_linked_client) ++ break; ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("MACID[%d], Highest Tx order Update for power traking: %d\n", (pRA_Table->highest_client_tx_rate_order), (pRA_Table->highest_client_tx_order))); ++ } ++} ++ ++VOID ++phydm_ra_info_watchdog( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ phydm_ra_common_info_update(pDM_Odm); ++ phydm_ra_dynamic_retry_limit(pDM_Odm); ++ phydm_ra_dynamic_retry_count(pDM_Odm); ++ odm_RefreshRateAdaptiveMask(pDM_Odm); ++ odm_RefreshBasicRateMask(pDM_Odm); ++} ++ ++VOID ++phydm_ra_info_init( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ ++ pRA_Table->highest_client_tx_rate_order = 0; ++ pRA_Table->highest_client_tx_order = 0; ++ pRA_Table->RA_threshold_offset = 0; ++ pRA_Table->RA_offset_direction = 0; ++ ++ #if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) ++ phydm_ra_dynamic_retry_limit_init(pDM_Odm); ++ #endif ++ ++ #if (defined(CONFIG_RA_DYNAMIC_RATE_ID)) ++ phydm_ra_dynamic_rate_id_init(pDM_Odm); ++ #endif ++ #if (defined(CONFIG_RA_DBG_CMD)) ++ odm_RA_ParaAdjust_init(pDM_Odm); ++ #endif ++ ++} ++ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) ++u1Byte ++odm_Find_RTS_Rate( ++ IN PVOID pDM_VOID, ++ IN u1Byte Tx_Rate, ++ IN BOOLEAN bErpProtect ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte RTS_Ini_Rate = ODM_RATE6M; ++ ++ if (bErpProtect) /* use CCK rate as RTS*/ ++ RTS_Ini_Rate = ODM_RATE1M; ++ else { ++ switch (Tx_Rate) { ++ case ODM_RATEVHTSS3MCS9: ++ case ODM_RATEVHTSS3MCS8: ++ case ODM_RATEVHTSS3MCS7: ++ case ODM_RATEVHTSS3MCS6: ++ case ODM_RATEVHTSS3MCS5: ++ case ODM_RATEVHTSS3MCS4: ++ case ODM_RATEVHTSS3MCS3: ++ case ODM_RATEVHTSS2MCS9: ++ case ODM_RATEVHTSS2MCS8: ++ case ODM_RATEVHTSS2MCS7: ++ case ODM_RATEVHTSS2MCS6: ++ case ODM_RATEVHTSS2MCS5: ++ case ODM_RATEVHTSS2MCS4: ++ case ODM_RATEVHTSS2MCS3: ++ case ODM_RATEVHTSS1MCS9: ++ case ODM_RATEVHTSS1MCS8: ++ case ODM_RATEVHTSS1MCS7: ++ case ODM_RATEVHTSS1MCS6: ++ case ODM_RATEVHTSS1MCS5: ++ case ODM_RATEVHTSS1MCS4: ++ case ODM_RATEVHTSS1MCS3: ++ case ODM_RATEMCS15: ++ case ODM_RATEMCS14: ++ case ODM_RATEMCS13: ++ case ODM_RATEMCS12: ++ case ODM_RATEMCS11: ++ case ODM_RATEMCS7: ++ case ODM_RATEMCS6: ++ case ODM_RATEMCS5: ++ case ODM_RATEMCS4: ++ case ODM_RATEMCS3: ++ case ODM_RATE54M: ++ case ODM_RATE48M: ++ case ODM_RATE36M: ++ case ODM_RATE24M: ++ RTS_Ini_Rate = ODM_RATE24M; ++ break; ++ case ODM_RATEVHTSS3MCS2: ++ case ODM_RATEVHTSS3MCS1: ++ case ODM_RATEVHTSS2MCS2: ++ case ODM_RATEVHTSS2MCS1: ++ case ODM_RATEVHTSS1MCS2: ++ case ODM_RATEVHTSS1MCS1: ++ case ODM_RATEMCS10: ++ case ODM_RATEMCS9: ++ case ODM_RATEMCS2: ++ case ODM_RATEMCS1: ++ case ODM_RATE18M: ++ case ODM_RATE12M: ++ RTS_Ini_Rate = ODM_RATE12M; ++ break; ++ case ODM_RATEVHTSS3MCS0: ++ case ODM_RATEVHTSS2MCS0: ++ case ODM_RATEVHTSS1MCS0: ++ case ODM_RATEMCS8: ++ case ODM_RATEMCS0: ++ case ODM_RATE9M: ++ case ODM_RATE6M: ++ RTS_Ini_Rate = ODM_RATE6M; ++ break; ++ case ODM_RATE11M: ++ case ODM_RATE5_5M: ++ case ODM_RATE2M: ++ case ODM_RATE1M: ++ RTS_Ini_Rate = ODM_RATE1M; ++ break; ++ default: ++ RTS_Ini_Rate = ODM_RATE6M; ++ break; ++ } ++ } ++ ++ if (*pDM_Odm->pBandType == 1) { ++ if (RTS_Ini_Rate < ODM_RATE6M) ++ RTS_Ini_Rate = ODM_RATE6M; ++ } ++ return RTS_Ini_Rate; ++ ++} ++ ++VOID ++odm_Set_RA_DM_ARFB_by_Noisy( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++#if 0 ++ ++ /*DbgPrint("DM_ARFB ====>\n");*/ ++ if (pDM_Odm->bNoisyState) { ++ ODM_Write4Byte(pDM_Odm, 0x430, 0x00000000); ++ ODM_Write4Byte(pDM_Odm, 0x434, 0x05040200); ++ /*DbgPrint("DM_ARFB ====> Noisy State\n");*/ ++ } else { ++ ODM_Write4Byte(pDM_Odm, 0x430, 0x02010000); ++ ODM_Write4Byte(pDM_Odm, 0x434, 0x07050403); ++ /*DbgPrint("DM_ARFB ====> Clean State\n");*/ ++ } ++#endif ++} ++ ++VOID ++ODM_UpdateNoisyState( ++ IN PVOID pDM_VOID, ++ IN BOOLEAN bNoisyStateFromC2H ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ /*DbgPrint("Get C2H Command! NoisyState=0x%x\n ", bNoisyStateFromC2H);*/ ++ if (pDM_Odm->SupportICType == ODM_RTL8821 || pDM_Odm->SupportICType == ODM_RTL8812 || ++ pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723D) ++ pDM_Odm->bNoisyState = bNoisyStateFromC2H; ++ odm_Set_RA_DM_ARFB_by_Noisy(pDM_Odm); ++}; ++ ++VOID ++phydm_update_pwr_track( ++ IN PVOID pDM_VOID, ++ IN u1Byte Rate ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte pathIdx = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Pwr Track Get Rate=0x%x\n", Rate)); ++ ++ pDM_Odm->TxRate = Rate; ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #if DEV_BUS_TYPE == RT_PCI_INTERFACE ++ #if USE_WORKITEM ++ PlatformScheduleWorkItem(&pDM_Odm->RaRptWorkitem); ++ #else ++ if (pDM_Odm->SupportICType == ODM_RTL8821) { ++ #if (RTL8821A_SUPPORT == 1) ++ ODM_TxPwrTrackSetPwr8821A(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); ++ #endif ++ } else if (pDM_Odm->SupportICType == ODM_RTL8812) { ++ for (pathIdx = ODM_RF_PATH_A; pathIdx < MAX_PATH_NUM_8812A; pathIdx++) { ++ #if (RTL8812A_SUPPORT == 1) ++ ODM_TxPwrTrackSetPwr8812A(pDM_Odm, MIX_MODE, pathIdx, 0); ++ #endif ++ } ++ } else if (pDM_Odm->SupportICType == ODM_RTL8723B) { ++ #if (RTL8723B_SUPPORT == 1) ++ ODM_TxPwrTrackSetPwr_8723B(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); ++ #endif ++ } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { ++ for (pathIdx = ODM_RF_PATH_A; pathIdx < MAX_PATH_NUM_8192E; pathIdx++) { ++ #if (RTL8192E_SUPPORT == 1) ++ ODM_TxPwrTrackSetPwr92E(pDM_Odm, MIX_MODE, pathIdx, 0); ++ #endif ++ } ++ } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { ++ #if (RTL8188E_SUPPORT == 1) ++ ODM_TxPwrTrackSetPwr88E(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); ++ #endif ++ } ++ #endif ++ #else ++ PlatformScheduleWorkItem(&pDM_Odm->RaRptWorkitem); ++ #endif ++ #endif ++ ++} ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++s4Byte ++phydm_FindMinimumRSSI( ++IN PDM_ODM_T pDM_Odm, ++IN PADAPTER pAdapter, ++IN OUT BOOLEAN *pbLink_temp ++ ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); ++ BOOLEAN act_as_ap = ACTING_AS_AP(pAdapter); ++ ++ /* 1.Determine the minimum RSSI */ ++ if ((!pMgntInfo->bMediaConnect) || ++ (act_as_ap && (pHalData->EntryMinUndecoratedSmoothedPWDB == 0))) {/* We should check AP mode and Entry info.into consideration, revised by Roger, 2013.10.18*/ ++ ++ pHalData->MinUndecoratedPWDBForDM = 0; ++ *pbLink_temp = FALSE; ++ ++ } else ++ *pbLink_temp = TRUE; ++ ++ ++ if (pMgntInfo->bMediaConnect) { /* Default port*/ ++ ++ if (act_as_ap || pMgntInfo->mIbss) { ++ pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; ++ /**/ ++ } else { ++ pHalData->MinUndecoratedPWDBForDM = pHalData->UndecoratedSmoothedPWDB; ++ /**/ ++ } ++ } else { /* associated entry pwdb*/ ++ pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; ++ /**/ ++ } ++ ++ return pHalData->MinUndecoratedPWDBForDM; ++} ++ ++VOID ++ODM_UpdateInitRateWorkItemCallback( ++ IN PVOID pContext ++) ++{ ++ PADAPTER Adapter = (PADAPTER)pContext; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ u1Byte p = 0; ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8821) { ++ ODM_TxPwrTrackSetPwr8821A(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); ++ /**/ ++ } else if (pDM_Odm->SupportICType == ODM_RTL8812) { ++ for (p = ODM_RF_PATH_A; p < MAX_PATH_NUM_8812A; p++) { /*DOn't know how to include &c*/ ++ ++ ODM_TxPwrTrackSetPwr8812A(pDM_Odm, MIX_MODE, p, 0); ++ /**/ ++ } ++ } else if (pDM_Odm->SupportICType == ODM_RTL8723B) { ++ ODM_TxPwrTrackSetPwr_8723B(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); ++ /**/ ++ } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { ++ for (p = ODM_RF_PATH_A; p < MAX_PATH_NUM_8192E; p++) { /*DOn't know how to include &c*/ ++ ODM_TxPwrTrackSetPwr92E(pDM_Odm, MIX_MODE, p, 0); ++ /**/ ++ } ++ } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { ++ ODM_TxPwrTrackSetPwr88E(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); ++ /**/ ++ } ++} ++ ++VOID ++odm_RSSIDumpToRegister( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8812) { ++ PlatformEFIOWrite1Byte(Adapter, rA_RSSIDump_Jaguar, Adapter->RxStats.RxRSSIPercentage[0]); ++ PlatformEFIOWrite1Byte(Adapter, rB_RSSIDump_Jaguar, Adapter->RxStats.RxRSSIPercentage[1]); ++ ++ /* Rx EVM*/ ++ PlatformEFIOWrite1Byte(Adapter, rS1_RXevmDump_Jaguar, Adapter->RxStats.RxEVMdbm[0]); ++ PlatformEFIOWrite1Byte(Adapter, rS2_RXevmDump_Jaguar, Adapter->RxStats.RxEVMdbm[1]); ++ ++ /* Rx SNR*/ ++ PlatformEFIOWrite1Byte(Adapter, rA_RXsnrDump_Jaguar, (u1Byte)(Adapter->RxStats.RxSNRdB[0])); ++ PlatformEFIOWrite1Byte(Adapter, rB_RXsnrDump_Jaguar, (u1Byte)(Adapter->RxStats.RxSNRdB[1])); ++ ++ /* Rx Cfo_Short*/ ++ PlatformEFIOWrite2Byte(Adapter, rA_CfoShortDump_Jaguar, Adapter->RxStats.RxCfoShort[0]); ++ PlatformEFIOWrite2Byte(Adapter, rB_CfoShortDump_Jaguar, Adapter->RxStats.RxCfoShort[1]); ++ ++ /* Rx Cfo_Tail*/ ++ PlatformEFIOWrite2Byte(Adapter, rA_CfoLongDump_Jaguar, Adapter->RxStats.RxCfoTail[0]); ++ PlatformEFIOWrite2Byte(Adapter, rB_CfoLongDump_Jaguar, Adapter->RxStats.RxCfoTail[1]); ++ } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { ++ PlatformEFIOWrite1Byte(Adapter, rA_RSSIDump_92E, Adapter->RxStats.RxRSSIPercentage[0]); ++ PlatformEFIOWrite1Byte(Adapter, rB_RSSIDump_92E, Adapter->RxStats.RxRSSIPercentage[1]); ++ /* Rx EVM*/ ++ PlatformEFIOWrite1Byte(Adapter, rS1_RXevmDump_92E, Adapter->RxStats.RxEVMdbm[0]); ++ PlatformEFIOWrite1Byte(Adapter, rS2_RXevmDump_92E, Adapter->RxStats.RxEVMdbm[1]); ++ /* Rx SNR*/ ++ PlatformEFIOWrite1Byte(Adapter, rA_RXsnrDump_92E, (u1Byte)(Adapter->RxStats.RxSNRdB[0])); ++ PlatformEFIOWrite1Byte(Adapter, rB_RXsnrDump_92E, (u1Byte)(Adapter->RxStats.RxSNRdB[1])); ++ /* Rx Cfo_Short*/ ++ PlatformEFIOWrite2Byte(Adapter, rA_CfoShortDump_92E, Adapter->RxStats.RxCfoShort[0]); ++ PlatformEFIOWrite2Byte(Adapter, rB_CfoShortDump_92E, Adapter->RxStats.RxCfoShort[1]); ++ /* Rx Cfo_Tail*/ ++ PlatformEFIOWrite2Byte(Adapter, rA_CfoLongDump_92E, Adapter->RxStats.RxCfoTail[0]); ++ PlatformEFIOWrite2Byte(Adapter, rB_CfoLongDump_92E, Adapter->RxStats.RxCfoTail[1]); ++ } ++} ++ ++VOID ++odm_RefreshLdpcRtsMP( ++ IN PADAPTER pAdapter, ++ IN PDM_ODM_T pDM_Odm, ++ IN u1Byte mMacId, ++ IN u1Byte IOTPeer, ++ IN s4Byte UndecoratedSmoothedPWDB ++) ++{ ++ BOOLEAN bCtlLdpc = FALSE; ++ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; ++ ++ if (pDM_Odm->SupportICType != ODM_RTL8821 && pDM_Odm->SupportICType != ODM_RTL8812) ++ return; ++ ++ if ((pDM_Odm->SupportICType == ODM_RTL8821) && (pDM_Odm->CutVersion == ODM_CUT_A)) ++ bCtlLdpc = TRUE; ++ else if (pDM_Odm->SupportICType == ODM_RTL8812 && ++ IOTPeer == HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP) ++ bCtlLdpc = TRUE; ++ ++ if (bCtlLdpc) { ++ if (UndecoratedSmoothedPWDB < (pRA->LdpcThres - 5)) ++ MgntSet_TX_LDPC(pAdapter, mMacId, TRUE); ++ else if (UndecoratedSmoothedPWDB > pRA->LdpcThres) ++ MgntSet_TX_LDPC(pAdapter, mMacId, FALSE); ++ } ++ ++ if (UndecoratedSmoothedPWDB < (pRA->RtsThres - 5)) ++ pRA->bLowerRtsRate = TRUE; ++ else if (UndecoratedSmoothedPWDB > pRA->RtsThres) ++ pRA->bLowerRtsRate = FALSE; ++} ++ ++#if 0 ++VOID ++ODM_DynamicARFBSelect( ++ IN PVOID pDM_VOID, ++ IN u1Byte rate, ++ IN BOOLEAN Collision_State ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; ++ ++ if (pDM_Odm->SupportICType != ODM_RTL8192E) ++ return; ++ ++ if (Collision_State == pRA_Table->PT_collision_pre) ++ return; ++ ++ if (rate >= DESC_RATEMCS8 && rate <= DESC_RATEMCS12) { ++ if (Collision_State == 1) { ++ if (rate == DESC_RATEMCS12) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07060501); ++ } else if (rate == DESC_RATEMCS11) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07070605); ++ } else if (rate == DESC_RATEMCS10) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08080706); ++ } else if (rate == DESC_RATEMCS9) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08080707); ++ } else { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09090808); ++ } ++ } else { /* Collision_State == 0*/ ++ if (rate == DESC_RATEMCS12) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x05010000); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09080706); ++ } else if (rate == DESC_RATEMCS11) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x06050000); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09080807); ++ } else if (rate == DESC_RATEMCS10) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x07060000); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x0a090908); ++ } else if (rate == DESC_RATEMCS9) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x07070000); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x0a090808); ++ } else { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x08080000); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x0b0a0909); ++ } ++ } ++ } else { /* MCS13~MCS15, 1SS, G-mode*/ ++ if (Collision_State == 1) { ++ if (rate == DESC_RATEMCS15) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x05040302); ++ } else if (rate == DESC_RATEMCS14) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x06050302); ++ } else if (rate == DESC_RATEMCS13) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07060502); ++ } else { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x06050402); ++ } ++ } else { // Collision_State == 0 ++ if (rate == DESC_RATEMCS15) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x03020000); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07060504); ++ } else if (rate == DESC_RATEMCS14) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x03020000); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08070605); ++ } else if (rate == DESC_RATEMCS13) { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x05020000); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09080706); ++ } else { ++ ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x04020000); ++ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08070605); ++ } ++ } ++ } ++ pRA_Table->PT_collision_pre = Collision_State; ++} ++#endif ++ ++VOID ++ODM_RateAdaptiveStateApInit( ++ IN PVOID PADAPTER_VOID, ++ IN PRT_WLAN_STA pEntry ++) ++{ ++ PADAPTER Adapter = (PADAPTER)PADAPTER_VOID; ++ pEntry->Ratr_State = DM_RATR_STA_INIT; ++} ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ ++ ++static void ++FindMinimumRSSI( ++ IN PADAPTER pAdapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ ++ /*Determine the minimum RSSI*/ ++ ++ if ((pDM_Odm->bLinked != _TRUE) && ++ (pHalData->EntryMinUndecoratedSmoothedPWDB == 0)) { ++ pHalData->MinUndecoratedPWDBForDM = 0; ++ /*ODM_RT_TRACE(pDM_Odm,COMP_BB_POWERSAVING, DBG_LOUD, ("Not connected to any\n"));*/ ++ } else ++ pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; ++ ++ /*DBG_8192C("%s=>MinUndecoratedPWDBForDM(%d)\n",__FUNCTION__,pdmpriv->MinUndecoratedPWDBForDM);*/ ++ /*ODM_RT_TRACE(pDM_Odm,COMP_DIG, DBG_LOUD, ("MinUndecoratedPWDBForDM =%d\n",pHalData->MinUndecoratedPWDBForDM));*/ ++} ++ ++u8Byte ++PhyDM_Get_Rate_Bitmap_Ex( ++ IN PVOID pDM_VOID, ++ IN u4Byte macid, ++ IN u8Byte ra_mask, ++ IN u1Byte rssi_level, ++ OUT u8Byte *dm_RA_Mask, ++ OUT u1Byte *dm_RteID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PSTA_INFO_T pEntry; ++ u8Byte rate_bitmap = 0; ++ u1Byte WirelessMode; ++ ++ pEntry = pDM_Odm->pODM_StaInfo[macid]; ++ if (!IS_STA_VALID(pEntry)) ++ return ra_mask; ++ WirelessMode = pEntry->wireless_mode; ++ switch (WirelessMode) { ++ case ODM_WM_B: ++ if (ra_mask & 0x000000000000000c) /* 11M or 5.5M enable */ ++ rate_bitmap = 0x000000000000000d; ++ else ++ rate_bitmap = 0x000000000000000f; ++ break; ++ ++ case (ODM_WM_G): ++ case (ODM_WM_A): ++ if (rssi_level == DM_RATR_STA_HIGH) ++ rate_bitmap = 0x0000000000000f00; ++ else ++ rate_bitmap = 0x0000000000000ff0; ++ break; ++ ++ case (ODM_WM_B|ODM_WM_G): ++ if (rssi_level == DM_RATR_STA_HIGH) ++ rate_bitmap = 0x0000000000000f00; ++ else if (rssi_level == DM_RATR_STA_MIDDLE) ++ rate_bitmap = 0x0000000000000ff0; ++ else ++ rate_bitmap = 0x0000000000000ff5; ++ break; ++ ++ case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G): ++ case (ODM_WM_B|ODM_WM_N24G): ++ case (ODM_WM_G|ODM_WM_N24G): ++ case (ODM_WM_A|ODM_WM_N5G): { ++ if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) { ++ if (rssi_level == DM_RATR_STA_HIGH) ++ rate_bitmap = 0x00000000000f0000; ++ else if (rssi_level == DM_RATR_STA_MIDDLE) ++ rate_bitmap = 0x00000000000ff000; ++ else { ++ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) ++ rate_bitmap = 0x00000000000ff015; ++ else ++ rate_bitmap = 0x00000000000ff005; ++ } ++ } else if (pDM_Odm->RFType == ODM_2T2R || pDM_Odm->RFType == ODM_2T3R || pDM_Odm->RFType == ODM_2T4R) { ++ if (rssi_level == DM_RATR_STA_HIGH) ++ rate_bitmap = 0x000000000f8f0000; ++ else if (rssi_level == DM_RATR_STA_MIDDLE) ++ rate_bitmap = 0x000000000f8ff000; ++ else { ++ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) ++ rate_bitmap = 0x000000000f8ff015; ++ else ++ rate_bitmap = 0x000000000f8ff005; ++ } ++ } else { ++ if (rssi_level == DM_RATR_STA_HIGH) ++ rate_bitmap = 0x0000000f0f0f0000; ++ else if (rssi_level == DM_RATR_STA_MIDDLE) ++ rate_bitmap = 0x0000000fcfcfe000; ++ else { ++ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) ++ rate_bitmap = 0x0000000ffffff015; ++ else ++ rate_bitmap = 0x0000000ffffff005; ++ } ++ } ++ } ++ break; ++ ++ case (ODM_WM_AC|ODM_WM_G): ++ if (rssi_level == 1) ++ rate_bitmap = 0x00000000fc3f0000; ++ else if (rssi_level == 2) ++ rate_bitmap = 0x00000000fffff000; ++ else ++ rate_bitmap = 0x00000000ffffffff; ++ break; ++ ++ case (ODM_WM_AC|ODM_WM_A): ++ ++ if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) { ++ if (rssi_level == 1) /* add by Gary for ac-series */ ++ rate_bitmap = 0x00000000003f8000; ++ else if (rssi_level == 2) ++ rate_bitmap = 0x00000000003fe000; ++ else ++ rate_bitmap = 0x00000000003ff010; ++ } else if (pDM_Odm->RFType == ODM_2T2R || pDM_Odm->RFType == ODM_2T3R || pDM_Odm->RFType == ODM_2T4R) { ++ if (rssi_level == 1) /* add by Gary for ac-series */ ++ rate_bitmap = 0x00000000fe3f8000; /* VHT 2SS MCS3~9 */ ++ else if (rssi_level == 2) ++ rate_bitmap = 0x00000000fffff000; /* VHT 2SS MCS0~9 */ ++ else ++ rate_bitmap = 0x00000000fffff010; /* All */ ++ } else { ++ if (rssi_level == 1) /* add by Gary for ac-series */ ++ rate_bitmap = 0x000003f8fe3f8000ULL; /* VHT 3SS MCS3~9 */ ++ else if (rssi_level == 2) ++ rate_bitmap = 0x000003fffffff000ULL; /* VHT3SS MCS0~9 */ ++ else ++ rate_bitmap = 0x000003fffffff010ULL; /* All */ ++ } ++ break; ++ ++ default: ++ if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) ++ rate_bitmap = 0x00000000000fffff; ++ else if (pDM_Odm->RFType == ODM_2T2R || pDM_Odm->RFType == ODM_2T3R || pDM_Odm->RFType == ODM_2T4R) ++ rate_bitmap = 0x000000000fffffff; ++ else ++ rate_bitmap = 0x0000003fffffffffULL; ++ break; ++ ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, (" ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%016llx\n", rssi_level, WirelessMode, rate_bitmap)); ++ ++ return (ra_mask & rate_bitmap); ++} ++ ++ ++u4Byte ++ODM_Get_Rate_Bitmap( ++ IN PVOID pDM_VOID, ++ IN u4Byte macid, ++ IN u4Byte ra_mask, ++ IN u1Byte rssi_level ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PSTA_INFO_T pEntry; ++ u4Byte rate_bitmap = 0; ++ u1Byte WirelessMode; ++ //u1Byte WirelessMode =*(pDM_Odm->pWirelessMode); ++ ++ ++ pEntry = pDM_Odm->pODM_StaInfo[macid]; ++ if (!IS_STA_VALID(pEntry)) ++ return ra_mask; ++ ++ WirelessMode = pEntry->wireless_mode; ++ ++ switch (WirelessMode) { ++ case ODM_WM_B: ++ if (ra_mask & 0x0000000c) //11M or 5.5M enable ++ rate_bitmap = 0x0000000d; ++ else ++ rate_bitmap = 0x0000000f; ++ break; ++ ++ case (ODM_WM_G): ++ case (ODM_WM_A): ++ if (rssi_level == DM_RATR_STA_HIGH) ++ rate_bitmap = 0x00000f00; ++ else ++ rate_bitmap = 0x00000ff0; ++ break; ++ ++ case (ODM_WM_B|ODM_WM_G): ++ if (rssi_level == DM_RATR_STA_HIGH) ++ rate_bitmap = 0x00000f00; ++ else if (rssi_level == DM_RATR_STA_MIDDLE) ++ rate_bitmap = 0x00000ff0; ++ else ++ rate_bitmap = 0x00000ff5; ++ break; ++ ++ case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G) : ++ case (ODM_WM_B|ODM_WM_N24G) : ++ case (ODM_WM_G|ODM_WM_N24G) : ++ case (ODM_WM_A|ODM_WM_N5G) : { ++ if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) { ++ if (rssi_level == DM_RATR_STA_HIGH) ++ rate_bitmap = 0x000f0000; ++ else if (rssi_level == DM_RATR_STA_MIDDLE) ++ rate_bitmap = 0x000ff000; ++ else { ++ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) ++ rate_bitmap = 0x000ff015; ++ else ++ rate_bitmap = 0x000ff005; ++ } ++ } else { ++ if (rssi_level == DM_RATR_STA_HIGH) ++ rate_bitmap = 0x0f8f0000; ++ else if (rssi_level == DM_RATR_STA_MIDDLE) ++ rate_bitmap = 0x0f8ff000; ++ else { ++ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) ++ rate_bitmap = 0x0f8ff015; ++ else ++ rate_bitmap = 0x0f8ff005; ++ } ++ } ++ } ++ break; ++ ++ case (ODM_WM_AC|ODM_WM_G): ++ if (rssi_level == 1) ++ rate_bitmap = 0xfc3f0000; ++ else if (rssi_level == 2) ++ rate_bitmap = 0xfffff000; ++ else ++ rate_bitmap = 0xffffffff; ++ break; ++ ++ case (ODM_WM_AC|ODM_WM_A): ++ ++ if (pDM_Odm->RFType == RF_1T1R) { ++ if (rssi_level == 1) // add by Gary for ac-series ++ rate_bitmap = 0x003f8000; ++ else if (rssi_level == 2) ++ rate_bitmap = 0x003ff000; ++ else ++ rate_bitmap = 0x003ff010; ++ } else { ++ if (rssi_level == 1) // add by Gary for ac-series ++ rate_bitmap = 0xfe3f8000; // VHT 2SS MCS3~9 ++ else if (rssi_level == 2) ++ rate_bitmap = 0xfffff000; // VHT 2SS MCS0~9 ++ else ++ rate_bitmap = 0xfffff010; // All ++ } ++ break; ++ ++ default: ++ if (pDM_Odm->RFType == RF_1T2R) ++ rate_bitmap = 0x000fffff; ++ else ++ rate_bitmap = 0x0fffffff; ++ break; ++ ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x\n", __func__, rssi_level, WirelessMode, rate_bitmap)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, (" ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x\n", rssi_level, WirelessMode, rate_bitmap)); ++ ++ return (ra_mask & rate_bitmap); ++ ++} ++ ++#endif //#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ ++#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++VOID ++phydm_gen_ramask_h2c_AP( ++ IN PVOID pDM_VOID, ++ IN struct rtl8192cd_priv *priv, ++ IN PSTA_INFO_T *pEntry, ++ IN u1Byte rssi_level ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8192E | ODM_RTL8881A)) { ++ ++ #ifdef CONFIG_WLAN_HAL ++ GET_HAL_INTERFACE(priv)->UpdateHalRAMaskHandler(priv, pEntry, rssi_level); ++ #endif ++ ++ } else if (pDM_Odm->SupportICType == ODM_RTL8812) { ++ ++ #if (RTL8812A_SUPPORT == 1) ++ UpdateHalRAMask8812(priv, pEntry, rssi_level); ++ /**/ ++ #endif ++ } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { ++ ++ #if (RTL8188E_SUPPORT == 1) ++ #ifdef TXREPORT ++ add_RATid(priv, pEntry); ++ /**/ ++ #endif ++ #endif ++ } ++} ++ ++ ++#endif /*#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN| ODM_CE))*/ ++ ++ ++/* RA_MASK_PHYDMLIZE, will delete it later*/ ++ ++#if (RA_MASK_PHYDMLIZE_CE || RA_MASK_PHYDMLIZE_AP || RA_MASK_PHYDMLIZE_WIN) ++ ++BOOLEAN ++ODM_RAStateCheck( ++ IN PVOID pDM_VOID, ++ IN s4Byte RSSI, ++ IN BOOLEAN bForceUpdate, ++ OUT pu1Byte pRATRState ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; ++ const u1Byte GoUpGap = 5; ++ u1Byte HighRSSIThreshForRA = pRA->HighRSSIThresh; ++ u1Byte LowRSSIThreshForRA = pRA->LowRSSIThresh; ++ u1Byte RATRState; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI= (( %d )), Current_RSSI_level = (( %d ))\n", RSSI, *pRATRState)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[Ori RA RSSI Thresh] High= (( %d )), Low = (( %d ))\n", HighRSSIThreshForRA, LowRSSIThreshForRA)); ++ /* Threshold Adjustment:*/ ++ /* when RSSI state trends to go up one or two levels, make sure RSSI is high enough.*/ ++ /* Here GoUpGap is added to solve the boundary's level alternation issue.*/ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ u1Byte UltraLowRSSIThreshForRA = pRA->UltraLowRSSIThresh; ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8881A) ++ LowRSSIThreshForRA = 30; /* for LDPC / BCC switch*/ ++#endif ++ ++ switch (*pRATRState) { ++ case DM_RATR_STA_INIT: ++ case DM_RATR_STA_HIGH: ++ break; ++ ++ case DM_RATR_STA_MIDDLE: ++ HighRSSIThreshForRA += GoUpGap; ++ break; ++ ++ case DM_RATR_STA_LOW: ++ HighRSSIThreshForRA += GoUpGap; ++ LowRSSIThreshForRA += GoUpGap; ++ break; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ case DM_RATR_STA_ULTRA_LOW: ++ HighRSSIThreshForRA += GoUpGap; ++ LowRSSIThreshForRA += GoUpGap; ++ UltraLowRSSIThreshForRA += GoUpGap; ++ break; ++#endif ++ ++ default: ++ ODM_RT_ASSERT(pDM_Odm, FALSE, ("wrong rssi level setting %d !", *pRATRState)); ++ break; ++ } ++ ++ /* Decide RATRState by RSSI.*/ ++ if (RSSI > HighRSSIThreshForRA) ++ RATRState = DM_RATR_STA_HIGH; ++ else if (RSSI > LowRSSIThreshForRA) ++ RATRState = DM_RATR_STA_MIDDLE; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ else if (RSSI > UltraLowRSSIThreshForRA) ++ RATRState = DM_RATR_STA_LOW; ++ else ++ RATRState = DM_RATR_STA_ULTRA_LOW; ++#else ++ else ++ RATRState = DM_RATR_STA_LOW; ++#endif ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[Mod RA RSSI Thresh] High= (( %d )), Low = (( %d ))\n", HighRSSIThreshForRA, LowRSSIThreshForRA)); ++ /*printk("==>%s,RATRState:0x%02x ,RSSI:%d\n",__FUNCTION__,RATRState,RSSI);*/ ++ ++ if (*pRATRState != RATRState || bForceUpdate) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[RSSI Level Update] %d -> %d\n", *pRATRState, RATRState)); ++ *pRATRState = RATRState; ++ return TRUE; ++ } ++ ++ return FALSE; ++} ++ ++#endif ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.h 2018-02-11 21:44:27.158146254 +0200 +@@ -0,0 +1,583 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __PHYDMRAINFO_H__ ++#define __PHYDMRAINFO_H__ ++ ++/*#define RAINFO_VERSION "2.0" //2014.11.04*/ ++/*#define RAINFO_VERSION "3.0" //2015.01.13 Dino*/ ++/*#define RAINFO_VERSION "3.1" //2015.01.14 Dino*/ ++/*#define RAINFO_VERSION "3.3" 2015.07.29 YuChen*/ ++/*#define RAINFO_VERSION "3.4"*/ /*2015.12.15 Stanley*/ ++/*#define RAINFO_VERSION "4.0"*/ /*2016.03.24 Dino, Add more RA mask state and Phydm-lize partial ra mask function */ ++/*#define RAINFO_VERSION "4.1"*/ /*2016.04.20 Dino, Add new function to adjust PCR RA threshold */ ++#define RAINFO_VERSION "4.2" /*2016.05.17 Dino, Add H2C debug cmd */ ++ ++#define H2C_0X42_LENGTH 5 ++#define H2C_MAX_LENGTH 7 ++ ++#define RA_FLOOR_UP_GAP 3 ++#define RA_FLOOR_TABLE_SIZE 7 ++ ++#define ACTIVE_TP_THRESHOLD 150 ++#define RA_RETRY_DESCEND_NUM 2 ++#define RA_RETRY_LIMIT_LOW 4 ++#define RA_RETRY_LIMIT_HIGH 32 ++ ++#define RAINFO_BE_RX_STATE BIT0 // 1:RX //ULDL ++#define RAINFO_STBC_STATE BIT1 ++//#define RAINFO_LDPC_STATE BIT2 ++#define RAINFO_NOISY_STATE BIT2 // set by Noisy_Detection ++#define RAINFO_SHURTCUT_STATE BIT3 ++#define RAINFO_SHURTCUT_FLAG BIT4 ++#define RAINFO_INIT_RSSI_RATE_STATE BIT5 ++#define RAINFO_BF_STATE BIT6 ++#define RAINFO_BE_TX_STATE BIT7 // 1:TX ++ ++#define RA_MASK_CCK 0xf ++#define RA_MASK_OFDM 0xff0 ++#define RA_MASK_HT1SS 0xff000 ++#define RA_MASK_HT2SS 0xff00000 ++/*#define RA_MASK_MCS3SS */ ++#define RA_MASK_HT4SS 0xff0 ++#define RA_MASK_VHT1SS 0x3ff000 ++#define RA_MASK_VHT2SS 0xffc00000 ++ ++#if(DM_ODM_SUPPORT_TYPE == ODM_AP) ++#define RA_FIRST_MACID 1 ++#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++#define RA_FIRST_MACID 0 ++#define WIN_DEFAULT_PORT_MACID 0 ++#define WIN_BT_PORT_MACID 2 ++#else /*if (DM_ODM_SUPPORT_TYPE == ODM_CE)*/ ++#define RA_FIRST_MACID 0 ++#endif ++ ++#define AP_InitRateAdaptiveState ODM_RateAdaptiveStateApInit ++ ++#if (RA_MASK_PHYDMLIZE_CE || RA_MASK_PHYDMLIZE_AP || RA_MASK_PHYDMLIZE_WIN) ++#define DM_RATR_STA_INIT 0 ++#define DM_RATR_STA_HIGH 1 ++#define DM_RATR_STA_MIDDLE 2 ++#define DM_RATR_STA_LOW 3 ++#define DM_RATR_STA_ULTRA_LOW 4 ++#endif ++ ++typedef enum _phydm_arfr_num { ++ ARFR_0_RATE_ID = 0x9, ++ ARFR_1_RATE_ID = 0xa, ++ ARFR_2_RATE_ID = 0xb, ++ ARFR_3_RATE_ID = 0xc, ++ ARFR_4_RATE_ID = 0xd, ++ ARFR_5_RATE_ID = 0xe ++} PHYDM_RA_ARFR_NUM_E; ++ ++typedef enum _Phydm_ra_dbg_para { ++ RADBG_PCR_TH_OFFSET = 0, ++ RADBG_RTY_PENALTY = 1, ++ RADBG_N_HIGH = 2, ++ RADBG_N_LOW = 3, ++ RADBG_TRATE_UP_TABLE = 4, ++ RADBG_TRATE_DOWN_TABLE = 5, ++ RADBG_TRYING_NECESSARY = 6, ++ RADBG_TDROPING_NECESSARY = 7, ++ RADBG_RATE_UP_RTY_RATIO = 8, ++ RADBG_RATE_DOWN_RTY_RATIO = 9, //u8 ++ ++ RADBG_DEBUG_MONITOR1 = 0xc, ++ RADBG_DEBUG_MONITOR2 = 0xd, ++ RADBG_DEBUG_MONITOR3 = 0xe, ++ RADBG_DEBUG_MONITOR4 = 0xf, ++ RADBG_DEBUG_MONITOR5 = 0x10, ++ NUM_RA_PARA ++} PHYDM_RA_DBG_PARA_E; ++ ++typedef enum PHYDM_WIRELESS_MODE { ++ ++ PHYDM_WIRELESS_MODE_UNKNOWN = 0x00, ++ PHYDM_WIRELESS_MODE_A = 0x01, ++ PHYDM_WIRELESS_MODE_B = 0x02, ++ PHYDM_WIRELESS_MODE_G = 0x04, ++ PHYDM_WIRELESS_MODE_AUTO = 0x08, ++ PHYDM_WIRELESS_MODE_N_24G = 0x10, ++ PHYDM_WIRELESS_MODE_N_5G = 0x20, ++ PHYDM_WIRELESS_MODE_AC_5G = 0x40, ++ PHYDM_WIRELESS_MODE_AC_24G = 0x80, ++ PHYDM_WIRELESS_MODE_AC_ONLY = 0x100, ++ PHYDM_WIRELESS_MODE_MAX = 0x800, ++ PHYDM_WIRELESS_MODE_ALL = 0xFFFF ++} PHYDM_WIRELESS_MODE_E; ++ ++typedef enum PHYDM_RATEID_IDX_ { ++ ++ PHYDM_BGN_40M_2SS = 0, ++ PHYDM_BGN_40M_1SS = 1, ++ PHYDM_BGN_20M_2SS = 2, ++ PHYDM_BGN_20M_1SS = 3, ++ PHYDM_GN_N2SS = 4, ++ PHYDM_GN_N1SS = 5, ++ PHYDM_BG = 6, ++ PHYDM_G = 7, ++ PHYDM_B_20M = 8, ++ PHYDM_ARFR0_AC_2SS = 9, ++ PHYDM_ARFR1_AC_1SS = 10, ++ PHYDM_ARFR2_AC_2G_1SS = 11, ++ PHYDM_ARFR3_AC_2G_2SS = 12, ++ PHYDM_ARFR4_AC_3SS = 13, ++ PHYDM_ARFR5_N_3SS = 14 ++} PHYDM_RATEID_IDX_E; ++ ++typedef enum _PHYDM_RF_TYPE_DEFINITION { ++ PHYDM_RF_1T1R = 0, ++ PHYDM_RF_1T2R, ++ PHYDM_RF_2T2R, ++ PHYDM_RF_2T2R_GREEN, ++ PHYDM_RF_2T3R, ++ PHYDM_RF_2T4R, ++ PHYDM_RF_3T3R, ++ PHYDM_RF_3T4R, ++ PHYDM_RF_4T4R, ++ PHYDM_RF_MAX_TYPE ++} PHYDM_RF_TYPE_DEF_E; ++ ++typedef enum _PHYDM_BW { ++ PHYDM_BW_20 = 0, ++ PHYDM_BW_40, ++ PHYDM_BW_80, ++ PHYDM_BW_80_80, ++ PHYDM_BW_160, ++ PHYDM_BW_10, ++ PHYDM_BW_5 ++} PHYDM_BW_E; ++ ++ ++#if (RATE_ADAPTIVE_SUPPORT == 1)//88E RA ++typedef struct _ODM_RA_Info_ { ++ u1Byte RateID; ++ u4Byte RateMask; ++ u4Byte RAUseRate; ++ u1Byte RateSGI; ++ u1Byte RssiStaRA; ++ u1Byte PreRssiStaRA; ++ u1Byte SGIEnable; ++ u1Byte DecisionRate; ++ u1Byte PreRate; ++ u1Byte HighestRate; ++ u1Byte LowestRate; ++ u4Byte NscUp; ++ u4Byte NscDown; ++ u2Byte RTY[5]; ++ u4Byte TOTAL; ++ u2Byte DROP; ++ u1Byte Active; ++ u2Byte RptTime; ++ u1Byte RAWaitingCounter; ++ u1Byte RAPendingCounter; ++ u1Byte RADropAfterDown; ++#if 1 //POWER_TRAINING_ACTIVE == 1 // For compile pass only~! ++ u1Byte PTActive; // on or off ++ u1Byte PTTryState; // 0 trying state, 1 for decision state ++ u1Byte PTStage; // 0~6 ++ u1Byte PTStopCount; //Stop PT counter ++ u1Byte PTPreRate; // if rate change do PT ++ u1Byte PTPreRssi; // if RSSI change 5% do PT ++ u1Byte PTModeSS; // decide whitch rate should do PT ++ u1Byte RAstage; // StageRA, decide how many times RA will be done between PT ++ u1Byte PTSmoothFactor; ++#endif ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) ++ u1Byte RateDownCounter; ++ u1Byte RateUpCounter; ++ u1Byte RateDirection; ++ u1Byte BoundingType; ++ u1Byte BoundingCounter; ++ u1Byte BoundingLearningTime; ++ u1Byte RateDownStartTime; ++#endif ++} ODM_RA_INFO_T, *PODM_RA_INFO_T; ++#endif ++ ++ ++typedef struct _Rate_Adaptive_Table_ { ++ u1Byte firstconnect; ++#if(DM_ODM_SUPPORT_TYPE==ODM_WIN) ++ BOOLEAN PT_collision_pre; ++#endif ++ ++#if (defined(CONFIG_RA_DBG_CMD)) ++ BOOLEAN is_ra_dbg_init; ++ ++ u1Byte RTY_P[ODM_NUM_RATE_IDX]; ++ u1Byte RTY_P_default[ODM_NUM_RATE_IDX]; ++ BOOLEAN RTY_P_modify_note[ODM_NUM_RATE_IDX]; ++ ++ u1Byte RATE_UP_RTY_RATIO[ODM_NUM_RATE_IDX]; ++ u1Byte RATE_UP_RTY_RATIO_default[ODM_NUM_RATE_IDX]; ++ BOOLEAN RATE_UP_RTY_RATIO_modify_note[ODM_NUM_RATE_IDX]; ++ ++ u1Byte RATE_DOWN_RTY_RATIO[ODM_NUM_RATE_IDX]; ++ u1Byte RATE_DOWN_RTY_RATIO_default[ODM_NUM_RATE_IDX]; ++ BOOLEAN RATE_DOWN_RTY_RATIO_modify_note[ODM_NUM_RATE_IDX]; ++ ++ BOOLEAN RA_Para_feedback_req; ++ ++ u1Byte para_idx; ++ u1Byte rate_idx; ++ u1Byte value; ++ u2Byte value_16; ++ u1Byte rate_length; ++#endif ++ u1Byte link_tx_rate[ODM_ASSOCIATE_ENTRY_NUM]; ++ u1Byte highest_client_tx_order; ++ u2Byte highest_client_tx_rate_order; ++ u1Byte power_tracking_flag; ++ u1Byte RA_threshold_offset; ++ u1Byte RA_offset_direction; ++ ++ #if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) ++ u1Byte per_rate_retrylimit_20M[ODM_NUM_RATE_IDX]; ++ u1Byte per_rate_retrylimit_40M[ODM_NUM_RATE_IDX]; ++ u1Byte retry_descend_num; ++ u1Byte retrylimit_low; ++ u1Byte retrylimit_high; ++ #endif ++ ++ ++} RA_T, *pRA_T; ++ ++typedef struct _ODM_RATE_ADAPTIVE { ++ u1Byte Type; // DM_Type_ByFW/DM_Type_ByDriver ++ u1Byte HighRSSIThresh; // if RSSI > HighRSSIThresh => RATRState is DM_RATR_STA_HIGH ++ u1Byte LowRSSIThresh; // if RSSI <= LowRSSIThresh => RATRState is DM_RATR_STA_LOW ++ u1Byte RATRState; // Current RSSI level, DM_RATR_STA_HIGH/DM_RATR_STA_MIDDLE/DM_RATR_STA_LOW ++ ++#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ u1Byte LdpcThres; // if RSSI > LdpcThres => switch from LPDC to BCC ++ BOOLEAN bLowerRtsRate; ++#endif ++ ++#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ u1Byte RtsThres; ++#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) ++ BOOLEAN bUseLdpc; ++#else ++ u1Byte UltraLowRSSIThresh; ++ u4Byte LastRATR; // RATR Register Content ++#endif ++ ++} ODM_RATE_ADAPTIVE, *PODM_RATE_ADAPTIVE; ++ ++VOID ++phydm_h2C_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++); ++ ++#if (defined(CONFIG_RA_DBG_CMD)) ++ ++VOID ++odm_RA_debug( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value ++); ++ ++VOID ++odm_RA_ParaAdjust_init( ++ IN PVOID pDM_VOID ++); ++ ++#else ++ ++VOID ++phydm_RA_debug_PCR( ++ IN PVOID pDM_VOID, ++ IN u4Byte *const dm_value, ++ IN u4Byte *_used, ++ OUT char *output, ++ IN u4Byte *_out_len ++); ++ ++#endif ++ ++VOID ++ODM_C2HRaParaReportHandler( ++ IN PVOID pDM_VOID, ++ IN pu1Byte CmdBuf, ++ IN u1Byte CmdLen ++); ++ ++VOID ++odm_RA_ParaAdjust( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++phydm_ra_dynamic_retry_count( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++phydm_ra_dynamic_retry_limit( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++phydm_ra_dynamic_rate_id_on_assoc( ++ IN PVOID pDM_VOID, ++ IN u1Byte wireless_mode, ++ IN u1Byte init_rate_id ++); ++ ++VOID ++phydm_print_rate( ++ IN PVOID pDM_VOID, ++ IN u1Byte rate, ++ IN u4Byte dbg_component ++); ++ ++VOID ++phydm_c2h_ra_report_handler( ++ IN PVOID pDM_VOID, ++ IN pu1Byte CmdBuf, ++ IN u1Byte CmdLen ++); ++ ++u1Byte ++phydm_rate_order_compute( ++ IN PVOID pDM_VOID, ++ IN u1Byte rate_idx ++ ); ++ ++VOID ++phydm_ra_info_watchdog( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++phydm_ra_info_init( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++odm_RSSIMonitorInit( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++phydm_modify_RA_PCR_threshold( ++ IN PVOID pDM_VOID, ++ IN u1Byte RA_offset_direction, ++ IN u1Byte RA_threshold_offset ++); ++ ++VOID ++odm_RSSIMonitorCheck( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++phydm_initRaInfo( ++ IN PVOID pDM_VOID ++); ++ ++u1Byte ++phydm_vht_en_mapping( ++ IN PVOID pDM_VOID, ++ IN u4Byte WirelessMode ++); ++ ++u1Byte ++phydm_rate_id_mapping( ++ IN PVOID pDM_VOID, ++ IN u4Byte WirelessMode, ++ IN u1Byte RfType, ++ IN u1Byte bw ++); ++ ++VOID ++phydm_UpdateHalRAMask( ++ IN PVOID pDM_VOID, ++ IN u4Byte wirelessMode, ++ IN u1Byte RfType, ++ IN u1Byte BW, ++ IN u1Byte MimoPs_enable, ++ IN u1Byte disable_cck_rate, ++ IN u4Byte *ratr_bitmap_msb_in, ++ IN u4Byte *ratr_bitmap_in, ++ IN u1Byte tx_rate_level ++); ++ ++VOID ++odm_RateAdaptiveMaskInit( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++odm_RefreshRateAdaptiveMask( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++odm_RefreshRateAdaptiveMaskMP( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++odm_RefreshRateAdaptiveMaskCE( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++odm_RefreshRateAdaptiveMaskAPADSL( ++ IN PVOID pDM_VOID ++); ++ ++u1Byte ++phydm_RA_level_decision( ++ IN PVOID pDM_VOID, ++ IN u4Byte rssi, ++ IN u1Byte Ratr_State ++); ++ ++BOOLEAN ++ODM_RAStateCheck( ++ IN PVOID pDM_VOID, ++ IN s4Byte RSSI, ++ IN BOOLEAN bForceUpdate, ++ OUT pu1Byte pRATRState ++); ++ ++VOID ++odm_RefreshBasicRateMask( ++ IN PVOID pDM_VOID ++); ++VOID ++ODM_RAPostActionOnAssoc( ++ IN PVOID pDM_Odm ++); ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) ++ ++u1Byte ++odm_Find_RTS_Rate( ++ IN PVOID pDM_VOID, ++ IN u1Byte Tx_Rate, ++ IN BOOLEAN bErpProtect ++); ++ ++VOID ++ODM_UpdateNoisyState( ++ IN PVOID pDM_VOID, ++ IN BOOLEAN bNoisyStateFromC2H ++); ++ ++VOID ++phydm_update_pwr_track( ++ IN PVOID pDM_VOID, ++ IN u1Byte Rate ++); ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++s4Byte ++phydm_FindMinimumRSSI( ++IN PDM_ODM_T pDM_Odm, ++IN PADAPTER pAdapter, ++IN OUT BOOLEAN *pbLink_temp ++); ++ ++VOID ++ODM_UpdateInitRateWorkItemCallback( ++ IN PVOID pContext ++); ++ ++VOID ++odm_RSSIDumpToRegister( ++ IN PVOID pDM_VOID ++); ++ ++VOID ++odm_RefreshLdpcRtsMP( ++ IN PADAPTER pAdapter, ++ IN PDM_ODM_T pDM_Odm, ++ IN u1Byte mMacId, ++ IN u1Byte IOTPeer, ++ IN s4Byte UndecoratedSmoothedPWDB ++); ++ ++#if 0 ++VOID ++ODM_DynamicARFBSelect( ++ IN PVOID pDM_VOID, ++ IN u1Byte rate, ++ IN BOOLEAN Collision_State ++); ++#endif ++ ++VOID ++ODM_RateAdaptiveStateApInit( ++ IN PVOID PADAPTER_VOID, ++ IN PRT_WLAN_STA pEntry ++); ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ ++static void ++FindMinimumRSSI( ++ IN PADAPTER pAdapter ++); ++ ++u8Byte ++PhyDM_Get_Rate_Bitmap_Ex( ++ IN PVOID pDM_VOID, ++ IN u4Byte macid, ++ IN u8Byte ra_mask, ++ IN u1Byte rssi_level, ++ OUT u8Byte *dm_RA_Mask, ++ OUT u1Byte *dm_RteID ++); ++u4Byte ++ODM_Get_Rate_Bitmap( ++ IN PVOID pDM_VOID, ++ IN u4Byte macid, ++ IN u4Byte ra_mask, ++ IN u1Byte rssi_level ++); ++ ++void phydm_ra_rssi_rpt_wk(PVOID pContext); ++#endif/*#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)*/ ++ ++#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++ ++VOID ++phydm_gen_ramask_h2c_AP( ++ IN PVOID pDM_VOID, ++ IN struct rtl8192cd_priv *priv, ++ IN PSTA_INFO_T *pEntry, ++ IN u1Byte rssi_level ++); ++ ++#endif/*#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN| ODM_CE))*/ ++ ++#endif /*#ifndef __ODMRAINFO_H__*/ ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11ac.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11ac.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11ac.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11ac.h 2018-02-11 21:44:27.158146254 +0200 +@@ -0,0 +1,94 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __ODM_REGDEFINE11AC_H__ ++#define __ODM_REGDEFINE11AC_H__ ++ ++//2 RF REG LIST ++ ++ ++ ++//2 BB REG LIST ++//PAGE 8 ++#define ODM_REG_CCK_RPT_FORMAT_11AC 0x804 ++#define ODM_REG_BB_RX_PATH_11AC 0x808 ++#define ODM_REG_BB_TX_PATH_11AC 0x80c ++#define ODM_REG_BB_ATC_11AC 0x860 ++#define ODM_REG_EDCCA_POWER_CAL 0x8dc ++#define ODM_REG_DBG_RPT_11AC 0x8fc ++//PAGE 9 ++#define ODM_REG_EDCCA_DOWN_OPT 0x900 ++#define ODM_REG_ACBB_EDCCA_ENHANCE 0x944 ++#define ODM_ADC_TRIGGER_Jaguar2 0x95C /*ADC sample mode*/ ++#define ODM_REG_OFDM_FA_RST_11AC 0x9A4 ++#define ODM_REG_CCX_PERIOD_11AC 0x990 ++#define ODM_REG_NHM_TH9_TH10_11AC 0x994 ++#define ODM_REG_CLM_11AC 0x994 ++#define ODM_REG_NHM_TH3_TO_TH0_11AC 0x998 ++#define ODM_REG_NHM_TH7_TO_TH4_11AC 0x99c ++#define ODM_REG_NHM_TH8_11AC 0x9a0 ++#define ODM_REG_NHM_9E8_11AC 0x9e8 ++#define ODM_REG_CSI_CONTENT_VALUE 0x9b4 ++//PAGE A ++#define ODM_REG_CCK_CCA_11AC 0xA0A ++#define ODM_REG_CCK_FA_RST_11AC 0xA2C ++#define ODM_REG_CCK_FA_11AC 0xA5C ++//PAGE B ++#define ODM_REG_RST_RPT_11AC 0xB58 ++//PAGE C ++#define ODM_REG_TRMUX_11AC 0xC08 ++#define ODM_REG_IGI_A_11AC 0xC50 ++//PAGE E ++#define ODM_REG_IGI_B_11AC 0xE50 ++#define ODM_REG_TRMUX_11AC_B 0xE08 ++//PAGE F ++#define ODM_REG_CCK_CRC32_CNT_11AC 0xF04 ++#define ODM_REG_CCK_CCA_CNT_11AC 0xF08 ++#define ODM_REG_VHT_CRC32_CNT_11AC 0xF0c ++#define ODM_REG_HT_CRC32_CNT_11AC 0xF10 ++#define ODM_REG_OFDM_CRC32_CNT_11AC 0xF14 ++#define ODM_REG_OFDM_FA_11AC 0xF48 ++#define ODM_REG_RPT_11AC 0xfa0 ++#define ODM_REG_CLM_RESULT_11AC 0xfa4 ++#define ODM_REG_NHM_CNT_11AC 0xfa8 ++#define ODM_REG_NHM_DUR_READY_11AC 0xfb4 ++ ++#define ODM_REG_NHM_CNT7_TO_CNT4_11AC 0xfac ++#define ODM_REG_NHM_CNT11_TO_CNT8_11AC 0xfb0 ++#define ODM_REG_OFDM_FA_TYPE2_11AC 0xFD0 ++//PAGE 18 ++#define ODM_REG_IGI_C_11AC 0x1850 ++//PAGE 1A ++#define ODM_REG_IGI_D_11AC 0x1A50 ++ ++//2 MAC REG LIST ++#define ODM_REG_RESP_TX_11AC 0x6D8 ++ ++ ++ ++//DIG Related ++#define ODM_BIT_IGI_11AC 0xFFFFFFFF ++#define ODM_BIT_CCK_RPT_FORMAT_11AC BIT16 ++#define ODM_BIT_BB_RX_PATH_11AC 0xF ++#define ODM_BIT_BB_TX_PATH_11AC 0xF ++#define ODM_BIT_BB_ATC_11AC BIT14 ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11n.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11n.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11n.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11n.h 2018-02-11 21:44:27.158146254 +0200 +@@ -0,0 +1,213 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __ODM_REGDEFINE11N_H__ ++#define __ODM_REGDEFINE11N_H__ ++ ++ ++//2 RF REG LIST ++#define ODM_REG_RF_MODE_11N 0x00 ++#define ODM_REG_RF_0B_11N 0x0B ++#define ODM_REG_CHNBW_11N 0x18 ++#define ODM_REG_T_METER_11N 0x24 ++#define ODM_REG_RF_25_11N 0x25 ++#define ODM_REG_RF_26_11N 0x26 ++#define ODM_REG_RF_27_11N 0x27 ++#define ODM_REG_RF_2B_11N 0x2B ++#define ODM_REG_RF_2C_11N 0x2C ++#define ODM_REG_RXRF_A3_11N 0x3C ++#define ODM_REG_T_METER_92D_11N 0x42 ++#define ODM_REG_T_METER_88E_11N 0x42 ++ ++ ++ ++//2 BB REG LIST ++//PAGE 8 ++#define ODM_REG_BB_CTRL_11N 0x800 ++#define ODM_REG_RF_PIN_11N 0x804 ++#define ODM_REG_PSD_CTRL_11N 0x808 ++#define ODM_REG_TX_ANT_CTRL_11N 0x80C ++#define ODM_REG_BB_PWR_SAV5_11N 0x818 ++#define ODM_REG_CCK_RPT_FORMAT_11N 0x824 ++#define ODM_REG_CCK_RPT_FORMAT_11N_B 0x82C ++#define ODM_REG_RX_DEFUALT_A_11N 0x858 ++#define ODM_REG_RX_DEFUALT_B_11N 0x85A ++#define ODM_REG_BB_PWR_SAV3_11N 0x85C ++#define ODM_REG_ANTSEL_CTRL_11N 0x860 ++#define ODM_REG_RX_ANT_CTRL_11N 0x864 ++#define ODM_REG_PIN_CTRL_11N 0x870 ++#define ODM_REG_BB_PWR_SAV1_11N 0x874 ++#define ODM_REG_ANTSEL_PATH_11N 0x878 ++#define ODM_REG_BB_3WIRE_11N 0x88C ++#define ODM_REG_SC_CNT_11N 0x8C4 ++#define ODM_REG_PSD_DATA_11N 0x8B4 ++#define ODM_REG_CCX_PERIOD_11N 0x894 ++#define ODM_REG_NHM_TH9_TH10_11N 0x890 ++#define ODM_REG_CLM_11N 0x890 ++#define ODM_REG_NHM_TH3_TO_TH0_11N 0x898 ++#define ODM_REG_NHM_TH7_TO_TH4_11N 0x89c ++#define ODM_REG_NHM_TH8_11N 0xe28 ++#define ODM_REG_CLM_READY_11N 0x8b4 ++#define ODM_REG_CLM_RESULT_11N 0x8d0 ++#define ODM_REG_NHM_CNT_11N 0x8d8 ++ ++// For ACS, Jeffery, 2014-12-26 ++#define ODM_REG_NHM_CNT7_TO_CNT4_11N 0x8dc ++#define ODM_REG_NHM_CNT9_TO_CNT8_11N 0x8d0 ++#define ODM_REG_NHM_CNT10_TO_CNT11_11N 0x8d4 ++ ++//PAGE 9 ++#define ODM_REG_BB_CTRL_PAGE9_11N 0x900 ++#define ODM_REG_DBG_RPT_11N 0x908 ++#define ODM_REG_BB_TX_PATH_11N 0x90c ++#define ODM_REG_ANT_MAPPING1_11N 0x914 ++#define ODM_REG_ANT_MAPPING2_11N 0x918 ++#define ODM_REG_EDCCA_DOWN_OPT_11N 0x948 ++#define ODM_REG_RX_DFIR_MOD_97F 0x948 ++ ++//PAGE A ++#define ODM_REG_CCK_ANTDIV_PARA1_11N 0xA00 ++#define ODM_REG_CCK_ANT_SEL_11N 0xA04 ++#define ODM_REG_CCK_CCA_11N 0xA0A ++#define ODM_REG_CCK_ANTDIV_PARA2_11N 0xA0C ++#define ODM_REG_CCK_ANTDIV_PARA3_11N 0xA10 ++#define ODM_REG_CCK_ANTDIV_PARA4_11N 0xA14 ++#define ODM_REG_CCK_FILTER_PARA1_11N 0xA22 ++#define ODM_REG_CCK_FILTER_PARA2_11N 0xA23 ++#define ODM_REG_CCK_FILTER_PARA3_11N 0xA24 ++#define ODM_REG_CCK_FILTER_PARA4_11N 0xA25 ++#define ODM_REG_CCK_FILTER_PARA5_11N 0xA26 ++#define ODM_REG_CCK_FILTER_PARA6_11N 0xA27 ++#define ODM_REG_CCK_FILTER_PARA7_11N 0xA28 ++#define ODM_REG_CCK_FILTER_PARA8_11N 0xA29 ++#define ODM_REG_CCK_FA_RST_11N 0xA2C ++#define ODM_REG_CCK_FA_MSB_11N 0xA58 ++#define ODM_REG_CCK_FA_LSB_11N 0xA5C ++#define ODM_REG_CCK_CCA_CNT_11N 0xA60 ++#define ODM_REG_BB_PWR_SAV4_11N 0xA74 ++//PAGE B ++#define ODM_REG_LNA_SWITCH_11N 0xB2C ++#define ODM_REG_PATH_SWITCH_11N 0xB30 ++#define ODM_REG_RSSI_CTRL_11N 0xB38 ++#define ODM_REG_CONFIG_ANTA_11N 0xB68 ++#define ODM_REG_RSSI_BT_11N 0xB9C ++#define ODM_REG_RXCK_RFMOD 0xBB0 ++#define ODM_REG_EDCCA_DCNF_97F 0xBC0 ++ ++//PAGE C ++#define ODM_REG_OFDM_FA_HOLDC_11N 0xC00 ++#define ODM_REG_BB_RX_PATH_11N 0xC04 ++#define ODM_REG_TRMUX_11N 0xC08 ++#define ODM_REG_OFDM_FA_RSTC_11N 0xC0C ++#define ODM_REG_DOWNSAM_FACTOR_11N 0xC10 ++#define ODM_REG_RXIQI_MATRIX_11N 0xC14 ++#define ODM_REG_TXIQK_MATRIX_LSB1_11N 0xC4C ++#define ODM_REG_IGI_A_11N 0xC50 ++#define ODM_REG_ANTDIV_PARA2_11N 0xC54 ++#define ODM_REG_IGI_B_11N 0xC58 ++#define ODM_REG_ANTDIV_PARA3_11N 0xC5C ++#define ODM_REG_L1SBD_PD_CH_11N 0XC6C ++#define ODM_REG_BB_PWR_SAV2_11N 0xC70 ++#define ODM_REG_BB_AGC_SET_2_11N 0xc74 ++#define ODM_REG_RX_OFF_11N 0xC7C ++#define ODM_REG_TXIQK_MATRIXA_11N 0xC80 ++#define ODM_REG_TXIQK_MATRIXB_11N 0xC88 ++#define ODM_REG_TXIQK_MATRIXA_LSB2_11N 0xC94 ++#define ODM_REG_TXIQK_MATRIXB_LSB2_11N 0xC9C ++#define ODM_REG_RXIQK_MATRIX_LSB_11N 0xCA0 ++#define ODM_REG_ANTDIV_PARA1_11N 0xCA4 ++#define ODM_REG_SMALL_BANDWIDTH_11N 0xCE4 ++#define ODM_REG_OFDM_FA_TYPE1_11N 0xCF0 ++//PAGE D ++#define ODM_REG_OFDM_FA_RSTD_11N 0xD00 ++#define ODM_REG_BB_RX_ANT_11N 0xD04 ++#define ODM_REG_BB_ATC_11N 0xD2C ++#define ODM_REG_OFDM_FA_TYPE2_11N 0xDA0 ++#define ODM_REG_OFDM_FA_TYPE3_11N 0xDA4 ++#define ODM_REG_OFDM_FA_TYPE4_11N 0xDA8 ++#define ODM_REG_RPT_11N 0xDF4 ++//PAGE E ++#define ODM_REG_TXAGC_A_6_18_11N 0xE00 ++#define ODM_REG_TXAGC_A_24_54_11N 0xE04 ++#define ODM_REG_TXAGC_A_1_MCS32_11N 0xE08 ++#define ODM_REG_TXAGC_A_MCS0_3_11N 0xE10 ++#define ODM_REG_TXAGC_A_MCS4_7_11N 0xE14 ++#define ODM_REG_TXAGC_A_MCS8_11_11N 0xE18 ++#define ODM_REG_TXAGC_A_MCS12_15_11N 0xE1C ++#define ODM_REG_EDCCA_DCNF_11N 0xE24 ++#define ODM_REG_TAP_UPD_97F 0xE24 ++#define ODM_REG_FPGA0_IQK_11N 0xE28 ++#define ODM_REG_PAGE_B1_97F 0xE28 ++#define ODM_REG_TXIQK_TONE_A_11N 0xE30 ++#define ODM_REG_RXIQK_TONE_A_11N 0xE34 ++#define ODM_REG_TXIQK_PI_A_11N 0xE38 ++#define ODM_REG_RXIQK_PI_A_11N 0xE3C ++#define ODM_REG_TXIQK_11N 0xE40 ++#define ODM_REG_RXIQK_11N 0xE44 ++#define ODM_REG_IQK_AGC_PTS_11N 0xE48 ++#define ODM_REG_IQK_AGC_RSP_11N 0xE4C ++#define ODM_REG_BLUETOOTH_11N 0xE6C ++#define ODM_REG_RX_WAIT_CCA_11N 0xE70 ++#define ODM_REG_TX_CCK_RFON_11N 0xE74 ++#define ODM_REG_TX_CCK_BBON_11N 0xE78 ++#define ODM_REG_OFDM_RFON_11N 0xE7C ++#define ODM_REG_OFDM_BBON_11N 0xE80 ++#define ODM_REG_TX2RX_11N 0xE84 ++#define ODM_REG_TX2TX_11N 0xE88 ++#define ODM_REG_RX_CCK_11N 0xE8C ++#define ODM_REG_RX_OFDM_11N 0xED0 ++#define ODM_REG_RX_WAIT_RIFS_11N 0xED4 ++#define ODM_REG_RX2RX_11N 0xED8 ++#define ODM_REG_STANDBY_11N 0xEDC ++#define ODM_REG_SLEEP_11N 0xEE0 ++#define ODM_REG_PMPD_ANAEN_11N 0xEEC ++/* PAGE F */ ++#define ODM_REG_PAGE_F_RST_11N 0xF14 ++#define ODM_REG_IGI_C_11N 0xF84 ++#define ODM_REG_IGI_D_11N 0xF88 ++#define ODM_REG_CCK_CRC32_ERROR_CNT_11N 0xF84 ++#define ODM_REG_CCK_CRC32_OK_CNT_11N 0xF88 ++#define ODM_REG_HT_CRC32_CNT_11N 0xF90 ++#define ODM_REG_OFDM_CRC32_CNT_11N 0xF94 ++ ++//2 MAC REG LIST ++#define ODM_REG_BB_RST_11N 0x02 ++#define ODM_REG_ANTSEL_PIN_11N 0x4C ++#define ODM_REG_EARLY_MODE_11N 0x4D0 ++#define ODM_REG_RSSI_MONITOR_11N 0x4FE ++#define ODM_REG_EDCA_VO_11N 0x500 ++#define ODM_REG_EDCA_VI_11N 0x504 ++#define ODM_REG_EDCA_BE_11N 0x508 ++#define ODM_REG_EDCA_BK_11N 0x50C ++#define ODM_REG_TXPAUSE_11N 0x522 ++#define ODM_REG_RESP_TX_11N 0x6D8 ++#define ODM_REG_ANT_TRAIN_PARA1_11N 0x7b0 ++#define ODM_REG_ANT_TRAIN_PARA2_11N 0x7b4 ++ ++ ++//DIG Related ++#define ODM_BIT_IGI_11N 0x0000007F ++#define ODM_BIT_CCK_RPT_FORMAT_11N BIT9 ++#define ODM_BIT_BB_RX_PATH_11N 0xF ++#define ODM_BIT_BB_TX_PATH_11N 0xF ++#define ODM_BIT_BB_ATC_11N BIT11 ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_reg.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_reg.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_reg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_reg.h 2018-02-11 21:44:27.158146254 +0200 +@@ -0,0 +1,215 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++//============================================================ ++// File Name: odm_reg.h ++// ++// Description: ++// ++// This file is for general register definition. ++// ++// ++//============================================================ ++#ifndef __HAL_ODM_REG_H__ ++#define __HAL_ODM_REG_H__ ++ ++// ++// Register Definition ++// ++ ++//MAC REG ++#define ODM_BB_RESET 0x002 ++#define ODM_DUMMY 0x4fe ++#define RF_T_METER_OLD 0x24 ++#define RF_T_METER_NEW 0x42 ++ ++#define ODM_EDCA_VO_PARAM 0x500 ++#define ODM_EDCA_VI_PARAM 0x504 ++#define ODM_EDCA_BE_PARAM 0x508 ++#define ODM_EDCA_BK_PARAM 0x50C ++#define ODM_TXPAUSE 0x522 ++ ++/* LTE_COEX */ ++#define REG_LTECOEX_CTRL 0x07C0 ++#define REG_LTECOEX_WRITE_DATA 0x07C4 ++#define REG_LTECOEX_READ_DATA 0x07C8 ++#define REG_LTECOEX_PATH_CONTROL 0x70 ++ ++//BB REG ++#define ODM_FPGA_PHY0_PAGE8 0x800 ++#define ODM_PSD_SETTING 0x808 ++#define ODM_AFE_SETTING 0x818 ++#define ODM_TXAGC_B_6_18 0x830 ++#define ODM_TXAGC_B_24_54 0x834 ++#define ODM_TXAGC_B_MCS32_5 0x838 ++#define ODM_TXAGC_B_MCS0_MCS3 0x83c ++#define ODM_TXAGC_B_MCS4_MCS7 0x848 ++#define ODM_TXAGC_B_MCS8_MCS11 0x84c ++#define ODM_ANALOG_REGISTER 0x85c ++#define ODM_RF_INTERFACE_OUTPUT 0x860 ++#define ODM_TXAGC_B_MCS12_MCS15 0x868 ++#define ODM_TXAGC_B_11_A_2_11 0x86c ++#define ODM_AD_DA_LSB_MASK 0x874 ++#define ODM_ENABLE_3_WIRE 0x88c ++#define ODM_PSD_REPORT 0x8b4 ++#define ODM_R_ANT_SELECT 0x90c ++#define ODM_CCK_ANT_SELECT 0xa07 ++#define ODM_CCK_PD_THRESH 0xa0a ++#define ODM_CCK_RF_REG1 0xa11 ++#define ODM_CCK_MATCH_FILTER 0xa20 ++#define ODM_CCK_RAKE_MAC 0xa2e ++#define ODM_CCK_CNT_RESET 0xa2d ++#define ODM_CCK_TX_DIVERSITY 0xa2f ++#define ODM_CCK_FA_CNT_MSB 0xa5b ++#define ODM_CCK_FA_CNT_LSB 0xa5c ++#define ODM_CCK_NEW_FUNCTION 0xa75 ++#define ODM_OFDM_PHY0_PAGE_C 0xc00 ++#define ODM_OFDM_RX_ANT 0xc04 ++#define ODM_R_A_RXIQI 0xc14 ++#define ODM_R_A_AGC_CORE1 0xc50 ++#define ODM_R_A_AGC_CORE2 0xc54 ++#define ODM_R_B_AGC_CORE1 0xc58 ++#define ODM_R_AGC_PAR 0xc70 ++#define ODM_R_HTSTF_AGC_PAR 0xc7c ++#define ODM_TX_PWR_TRAINING_A 0xc90 ++#define ODM_TX_PWR_TRAINING_B 0xc98 ++#define ODM_OFDM_FA_CNT1 0xcf0 ++#define ODM_OFDM_PHY0_PAGE_D 0xd00 ++#define ODM_OFDM_FA_CNT2 0xda0 ++#define ODM_OFDM_FA_CNT3 0xda4 ++#define ODM_OFDM_FA_CNT4 0xda8 ++#define ODM_TXAGC_A_6_18 0xe00 ++#define ODM_TXAGC_A_24_54 0xe04 ++#define ODM_TXAGC_A_1_MCS32 0xe08 ++#define ODM_TXAGC_A_MCS0_MCS3 0xe10 ++#define ODM_TXAGC_A_MCS4_MCS7 0xe14 ++#define ODM_TXAGC_A_MCS8_MCS11 0xe18 ++#define ODM_TXAGC_A_MCS12_MCS15 0xe1c ++ ++//RF REG ++#define ODM_GAIN_SETTING 0x00 ++#define ODM_CHANNEL 0x18 ++#define ODM_RF_T_METER 0x24 ++#define ODM_RF_T_METER_92D 0x42 ++#define ODM_RF_T_METER_88E 0x42 ++#define ODM_RF_T_METER_92E 0x42 ++#define ODM_RF_T_METER_8812 0x42 ++#define rRF_TxGainOffset 0x55 ++ ++//Ant Detect Reg ++#define ODM_DPDT 0x300 ++ ++//PSD Init ++#define ODM_PSDREG 0x808 ++ ++//92D Path Div ++#define PATHDIV_REG 0xB30 ++#define PATHDIV_TRI 0xBA0 ++ ++ ++// ++// Bitmap Definition ++// ++#if(DM_ODM_SUPPORT_TYPE & (ODM_AP)) ++// TX AGC ++#define rTxAGC_A_CCK11_CCK1_JAguar 0xc20 ++#define rTxAGC_A_Ofdm18_Ofdm6_JAguar 0xc24 ++#define rTxAGC_A_Ofdm54_Ofdm24_JAguar 0xc28 ++#define rTxAGC_A_MCS3_MCS0_JAguar 0xc2c ++#define rTxAGC_A_MCS7_MCS4_JAguar 0xc30 ++#define rTxAGC_A_MCS11_MCS8_JAguar 0xc34 ++#define rTxAGC_A_MCS15_MCS12_JAguar 0xc38 ++#define rTxAGC_A_Nss1Index3_Nss1Index0_JAguar 0xc3c ++#define rTxAGC_A_Nss1Index7_Nss1Index4_JAguar 0xc40 ++#define rTxAGC_A_Nss2Index1_Nss1Index8_JAguar 0xc44 ++#define rTxAGC_A_Nss2Index5_Nss2Index2_JAguar 0xc48 ++#define rTxAGC_A_Nss2Index9_Nss2Index6_JAguar 0xc4c ++#if defined(CONFIG_WLAN_HAL_8814AE) ++#define rTxAGC_A_MCS19_MCS16_JAguar 0xcd8 ++#define rTxAGC_A_MCS23_MCS20_JAguar 0xcdc ++#define rTxAGC_A_Nss3Index3_Nss3Index0_JAguar 0xce0 ++#define rTxAGC_A_Nss3Index7_Nss3Index4_JAguar 0xce4 ++#define rTxAGC_A_Nss3Index9_Nss3Index8_JAguar 0xce8 ++#endif ++#define rTxAGC_B_CCK11_CCK1_JAguar 0xe20 ++#define rTxAGC_B_Ofdm18_Ofdm6_JAguar 0xe24 ++#define rTxAGC_B_Ofdm54_Ofdm24_JAguar 0xe28 ++#define rTxAGC_B_MCS3_MCS0_JAguar 0xe2c ++#define rTxAGC_B_MCS7_MCS4_JAguar 0xe30 ++#define rTxAGC_B_MCS11_MCS8_JAguar 0xe34 ++#define rTxAGC_B_MCS15_MCS12_JAguar 0xe38 ++#define rTxAGC_B_Nss1Index3_Nss1Index0_JAguar 0xe3c ++#define rTxAGC_B_Nss1Index7_Nss1Index4_JAguar 0xe40 ++#define rTxAGC_B_Nss2Index1_Nss1Index8_JAguar 0xe44 ++#define rTxAGC_B_Nss2Index5_Nss2Index2_JAguar 0xe48 ++#define rTxAGC_B_Nss2Index9_Nss2Index6_JAguar 0xe4c ++#if defined(CONFIG_WLAN_HAL_8814AE) ++#define rTxAGC_B_MCS19_MCS16_JAguar 0xed8 ++#define rTxAGC_B_MCS23_MCS20_JAguar 0xedc ++#define rTxAGC_B_Nss3Index3_Nss3Index0_JAguar 0xee0 ++#define rTxAGC_B_Nss3Index7_Nss3Index4_JAguar 0xee4 ++#define rTxAGC_B_Nss3Index9_Nss3Index8_JAguar 0xee8 ++#define rTxAGC_C_CCK11_CCK1_JAguar 0x1820 ++#define rTxAGC_C_Ofdm18_Ofdm6_JAguar 0x1824 ++#define rTxAGC_C_Ofdm54_Ofdm24_JAguar 0x1828 ++#define rTxAGC_C_MCS3_MCS0_JAguar 0x182c ++#define rTxAGC_C_MCS7_MCS4_JAguar 0x1830 ++#define rTxAGC_C_MCS11_MCS8_JAguar 0x1834 ++#define rTxAGC_C_MCS15_MCS12_JAguar 0x1838 ++#define rTxAGC_C_Nss1Index3_Nss1Index0_JAguar 0x183c ++#define rTxAGC_C_Nss1Index7_Nss1Index4_JAguar 0x1840 ++#define rTxAGC_C_Nss2Index1_Nss1Index8_JAguar 0x1844 ++#define rTxAGC_C_Nss2Index5_Nss2Index2_JAguar 0x1848 ++#define rTxAGC_C_Nss2Index9_Nss2Index6_JAguar 0x184c ++#define rTxAGC_C_MCS19_MCS16_JAguar 0x18d8 ++#define rTxAGC_C_MCS23_MCS20_JAguar 0x18dc ++#define rTxAGC_C_Nss3Index3_Nss3Index0_JAguar 0x18e0 ++#define rTxAGC_C_Nss3Index7_Nss3Index4_JAguar 0x18e4 ++#define rTxAGC_C_Nss3Index9_Nss3Index8_JAguar 0x18e8 ++#define rTxAGC_D_CCK11_CCK1_JAguar 0x1a20 ++#define rTxAGC_D_Ofdm18_Ofdm6_JAguar 0x1a24 ++#define rTxAGC_D_Ofdm54_Ofdm24_JAguar 0x1a28 ++#define rTxAGC_D_MCS3_MCS0_JAguar 0x1a2c ++#define rTxAGC_D_MCS7_MCS4_JAguar 0x1a30 ++#define rTxAGC_D_MCS11_MCS8_JAguar 0x1a34 ++#define rTxAGC_D_MCS15_MCS12_JAguar 0x1a38 ++#define rTxAGC_D_Nss1Index3_Nss1Index0_JAguar 0x1a3c ++#define rTxAGC_D_Nss1Index7_Nss1Index4_JAguar 0x1a40 ++#define rTxAGC_D_Nss2Index1_Nss1Index8_JAguar 0x1a44 ++#define rTxAGC_D_Nss2Index5_Nss2Index2_JAguar 0x1a48 ++#define rTxAGC_D_Nss2Index9_Nss2Index6_JAguar 0x1a4c ++#define rTxAGC_D_MCS19_MCS16_JAguar 0x1ad8 ++#define rTxAGC_D_MCS23_MCS20_JAguar 0x1adc ++#define rTxAGC_D_Nss3Index3_Nss3Index0_JAguar 0x1ae0 ++#define rTxAGC_D_Nss3Index7_Nss3Index4_JAguar 0x1ae4 ++#define rTxAGC_D_Nss3Index9_Nss3Index8_JAguar 0x1ae8 ++#endif ++ ++#define bTxAGC_byte0_Jaguar 0xff ++#define bTxAGC_byte1_Jaguar 0xff00 ++#define bTxAGC_byte2_Jaguar 0xff0000 ++#define bTxAGC_byte3_Jaguar 0xff000000 ++#endif ++ ++#define BIT_FA_RESET BIT0 ++ ++ ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_types.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_types.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_types.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_types.h 2018-02-11 21:44:27.158146254 +0200 +@@ -0,0 +1,261 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __ODM_TYPES_H__ ++#define __ODM_TYPES_H__ ++ ++ ++/*Define Different SW team support*/ ++#define ODM_AP 0x01 /*BIT0*/ ++#define ODM_CE 0x04 /*BIT2*/ ++#define ODM_WIN 0x08 /*BIT3*/ ++#define ODM_ADSL 0x10 /*BIT4*/ ++#define ODM_IOT 0x20 /*BIT5*/ ++ ++/*Deifne HW endian support*/ ++#define ODM_ENDIAN_BIG 0 ++#define ODM_ENDIAN_LITTLE 1 ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++#define GET_PDM_ODM(__pAdapter) ((PDM_ODM_T)(&((GET_HAL_DATA(__pAdapter))->DM_OutSrc))) ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++#define GET_PDM_ODM(__pAdapter) ((PDM_ODM_T)(&((GET_HAL_DATA(__pAdapter))->odmpriv))) ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) ++#define RT_PCI_INTERFACE 1 ++#define RT_USB_INTERFACE 2 ++#define RT_SDIO_INTERFACE 3 ++#endif ++ ++typedef enum _HAL_STATUS{ ++ HAL_STATUS_SUCCESS, ++ HAL_STATUS_FAILURE, ++ /*RT_STATUS_PENDING, ++ RT_STATUS_RESOURCE, ++ RT_STATUS_INVALID_CONTEXT, ++ RT_STATUS_INVALID_PARAMETER, ++ RT_STATUS_NOT_SUPPORT, ++ RT_STATUS_OS_API_FAILED,*/ ++}HAL_STATUS,*PHAL_STATUS; ++ ++#if( DM_ODM_SUPPORT_TYPE == ODM_AP) ++#define MP_DRIVER 0 ++#endif ++#if(DM_ODM_SUPPORT_TYPE != ODM_WIN) ++ ++#define VISTA_USB_RX_REVISE 0 ++ ++// ++// Declare for ODM spin lock defintion temporarily fro compile pass. ++// ++typedef enum _RT_SPINLOCK_TYPE{ ++ RT_TX_SPINLOCK = 1, ++ RT_RX_SPINLOCK = 2, ++ RT_RM_SPINLOCK = 3, ++ RT_CAM_SPINLOCK = 4, ++ RT_SCAN_SPINLOCK = 5, ++ RT_LOG_SPINLOCK = 7, ++ RT_BW_SPINLOCK = 8, ++ RT_CHNLOP_SPINLOCK = 9, ++ RT_RF_OPERATE_SPINLOCK = 10, ++ RT_INITIAL_SPINLOCK = 11, ++ RT_RF_STATE_SPINLOCK = 12, // For RF state. Added by Bruce, 2007-10-30. ++#if VISTA_USB_RX_REVISE ++ RT_USBRX_CONTEXT_SPINLOCK = 13, ++ RT_USBRX_POSTPROC_SPINLOCK = 14, // protect data of Adapter->IndicateW/ IndicateR ++#endif ++ //Shall we define Ndis 6.2 SpinLock Here ? ++ RT_PORT_SPINLOCK=16, ++ RT_VNIC_SPINLOCK=17, ++ RT_HVL_SPINLOCK=18, ++ RT_H2C_SPINLOCK = 20, // For H2C cmd. Added by tynli. 2009.11.09. ++ ++ RT_BTData_SPINLOCK=25, ++ ++ RT_WAPI_OPTION_SPINLOCK=26, ++ RT_WAPI_RX_SPINLOCK=27, ++ ++ // add for 92D CCK control issue ++ RT_CCK_PAGEA_SPINLOCK = 28, ++ RT_BUFFER_SPINLOCK = 29, ++ RT_CHANNEL_AND_BANDWIDTH_SPINLOCK = 30, ++ RT_GEN_TEMP_BUF_SPINLOCK = 31, ++ RT_AWB_SPINLOCK = 32, ++ RT_FW_PS_SPINLOCK = 33, ++ RT_HW_TIMER_SPIN_LOCK = 34, ++ RT_MPT_WI_SPINLOCK = 35, ++ RT_P2P_SPIN_LOCK = 36, // Protect P2P context ++ RT_DBG_SPIN_LOCK = 37, ++ RT_IQK_SPINLOCK = 38, ++ RT_PENDED_OID_SPINLOCK = 39, ++ RT_CHNLLIST_SPINLOCK = 40, ++ RT_INDIC_SPINLOCK = 41, //protect indication ++ RT_RFD_SPINLOCK = 42, ++ RT_SYNC_IO_CNT_SPINLOCK = 43, ++ RT_LAST_SPINLOCK, ++}RT_SPINLOCK_TYPE; ++ ++#endif ++ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ #define STA_INFO_T RT_WLAN_STA ++ #define PSTA_INFO_T PRT_WLAN_STA ++ #define __func__ __FUNCTION__ ++ #define PHYDM_TESTCHIP_SUPPORT TESTCHIP_SUPPORT ++ #define bMaskH3Bytes 0xffffff00 ++ #define SUCCESS 0 ++ #define FAIL (-1) ++ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ ++ // To let ADSL/AP project compile ok; it should be removed after all conflict are solved. Added by Annie, 2011-10-07. ++ #define ADSL_AP_BUILD_WORKAROUND ++ #define AP_BUILD_WORKAROUND ++ ++ #ifdef AP_BUILD_WORKAROUND ++ #include "../typedef.h" ++ #else ++ typedef void VOID,*PVOID; ++ typedef unsigned char BOOLEAN,*PBOOLEAN; ++ typedef unsigned char u1Byte,*pu1Byte; ++ typedef unsigned short u2Byte,*pu2Byte; ++ typedef unsigned int u4Byte,*pu4Byte; ++ typedef unsigned long long u8Byte,*pu8Byte; ++#if 1 ++/* In ARM platform, system would use the type -- "char" as "unsigned char" ++ * And we only use s1Byte/ps1Byte as INT8 now, so changes the type of s1Byte.*/ ++ typedef signed char s1Byte,*ps1Byte; ++#else ++ typedef char s1Byte,*ps1Byte; ++#endif ++ typedef short s2Byte,*ps2Byte; ++ typedef long s4Byte,*ps4Byte; ++ typedef long long s8Byte,*ps8Byte; ++ #endif ++ ++ typedef struct rtl8192cd_priv *prtl8192cd_priv; ++ typedef struct stat_info STA_INFO_T,*PSTA_INFO_T; ++ typedef struct timer_list RT_TIMER, *PRT_TIMER; ++ typedef void * RT_TIMER_CALL_BACK; ++ ++#ifdef CONFIG_PCI_HCI ++ #define DEV_BUS_TYPE RT_PCI_INTERFACE ++#endif ++ ++ #define _TRUE 1 ++ #define _FALSE 0 ++ ++ #if (defined(TESTCHIP_SUPPORT)) ++ #define PHYDM_TESTCHIP_SUPPORT 1 ++ #else ++ #define PHYDM_TESTCHIP_SUPPORT 0 ++ #endif ++ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ #include ++#if 0 ++ typedef u8 u1Byte, *pu1Byte; ++ typedef u16 u2Byte,*pu2Byte; ++ typedef u32 u4Byte,*pu4Byte; ++ typedef u64 u8Byte,*pu8Byte; ++ typedef s8 s1Byte,*ps1Byte; ++ typedef s16 s2Byte,*ps2Byte; ++ typedef s32 s4Byte,*ps4Byte; ++ typedef s64 s8Byte,*ps8Byte; ++#else ++ #define u1Byte u8 ++ #define pu1Byte u8* ++ ++ #define u2Byte u16 ++ #define pu2Byte u16* ++ ++ #define u4Byte u32 ++ #define pu4Byte u32* ++ ++ #define u8Byte u64 ++ #define pu8Byte u64* ++ ++ #define s1Byte s8 ++ #define ps1Byte s8* ++ ++ #define s2Byte s16 ++ #define ps2Byte s16* ++ ++ #define s4Byte s32 ++ #define ps4Byte s32* ++ ++ #define s8Byte s64 ++ #define ps8Byte s64* ++ ++#endif ++ #ifdef CONFIG_USB_HCI ++ #define DEV_BUS_TYPE RT_USB_INTERFACE ++ #elif defined(CONFIG_PCI_HCI) ++ #define DEV_BUS_TYPE RT_PCI_INTERFACE ++ #elif defined(CONFIG_SDIO_HCI) ++ #define DEV_BUS_TYPE RT_SDIO_INTERFACE ++ #elif defined(CONFIG_GSPI_HCI) ++ #define DEV_BUS_TYPE RT_SDIO_INTERFACE ++ #endif ++ ++ ++ #if defined(CONFIG_LITTLE_ENDIAN) ++ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE ++ #elif defined (CONFIG_BIG_ENDIAN) ++ #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG ++ #endif ++ ++ typedef struct timer_list RT_TIMER, *PRT_TIMER; ++ typedef void * RT_TIMER_CALL_BACK; ++ #define STA_INFO_T struct sta_info ++ #define PSTA_INFO_T struct sta_info * ++ ++ ++ ++ #define TRUE _TRUE ++ #define FALSE _FALSE ++ ++ ++ #define SET_TX_DESC_ANTSEL_A_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 1, __Value) ++ #define SET_TX_DESC_ANTSEL_B_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 25, 1, __Value) ++ #define SET_TX_DESC_ANTSEL_C_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 29, 1, __Value) ++ ++ //define useless flag to avoid compile warning ++ #define USE_WORKITEM 0 ++ #define FOR_BRAZIL_PRETEST 0 ++ #define FPGA_TWO_MAC_VERIFICATION 0 ++ #define RTL8881A_SUPPORT 0 ++ ++ #if (defined(TESTCHIP_SUPPORT)) ++ #define PHYDM_TESTCHIP_SUPPORT 1 ++ #else ++ #define PHYDM_TESTCHIP_SUPPORT 0 ++ #endif ++#endif ++ ++#define READ_NEXT_PAIR(v1, v2, i) do { if (i+2 >= ArrayLen) break; i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++#define COND_ELSE 2 ++#define COND_ENDIF 3 ++ ++#include "phydm_features.h" ++ ++#endif // __ODM_TYPES_H__ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtchnlplan.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtchnlplan.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtchnlplan.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtchnlplan.c 2018-02-11 21:44:27.158146254 +0200 +@@ -0,0 +1,481 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++/****************************************************************************** ++ ++ History: ++ Data Who Remark (Internal History) ++ ++ 05/14/2012 MH Collect RTK inernal infromation and generate channel plan draft. ++ ++******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++#include "rtchnlplan.h" ++ ++ ++ ++// ++// Channel Plan Domain Code ++// ++ ++/* ++ Channel Plan Contents ++ Domain Code EEPROM Countries in Specific Domain ++ 2G RD 5G RD Bit[6:0] 2G 5G ++ Case Old Define 00h~1Fh Old Define Old Define ++ 1 2G_WORLD 5G_NULL 20h Worldwird 13 NA ++ 2 2G_ETSI1 5G_NULL 21h Europe 2G NA ++ 3 2G_FCC1 5G_NULL 22h US 2G NA ++ 4 2G_MKK1 5G_NULL 23h Japan 2G NA ++ 5 2G_ETSI2 5G_NULL 24h France 2G NA ++ 6 2G_FCC1 5G_FCC1 25h US 2G US 5G Kj{ ++ 7 2G_WORLD 5G_ETSI1 26h Worldwird 13 Europe Kj{ ++ 8 2G_MKK1 5G_MKK1 27h Japan 2G Japan 5G Kj{ ++ 9 2G_WORLD 5G_KCC1 28h Worldwird 13 Korea Kj{ ++ 10 2G_WORLD 5G_FCC2 29h Worldwird 13 US o/w DFS Channels ++ 11 2G_WORLD 5G_FCC3 30h Worldwird 13 India, Mexico ++ 12 2G_WORLD 5G_FCC4 31h Worldwird 13 Venezuela ++ 13 2G_WORLD 5G_FCC5 32h Worldwird 13 China ++ 14 2G_WORLD 5G_FCC6 33h Worldwird 13 Israel ++ 15 2G_FCC1 5G_FCC7 34h US 2G US/Canada Kj{ ++ 16 2G_WORLD 5G_ETSI2 35h Worldwird 13 Australia, New Zealand Kj{ ++ 17 2G_WORLD 5G_ETSI3 36h Worldwird 13 Russia ++ 18 2G_MKK1 5G_MKK2 37h Japan 2G Japan (W52, W53) ++ 19 2G_MKK1 5G_MKK3 38h Japan 2G Japan (W56) ++ 20 2G_FCC1 5G_NCC1 39h US 2G Taiwan Kj{ ++ ++ NA 2G_WORLD 5G_FCC1 7F FCC FCC DFS Channels Realtek Define ++ ++ ++ ++ ++ ++ 2.4G Regulatory Domains ++ Case 2G RD Regulation Channels Frequencyes Note Countries in Specific Domain ++ 1 2G_WORLD ETSI 1~13 2412~2472 Passive scan CH 12, 13 Worldwird 13 ++ 2 2G_ETSI1 ETSI 1~13 2412~2472 Europe ++ 3 2G_FCC1 FCC 1~11 2412~2462 US ++ 4 2G_MKK1 MKK 1~13, 14 2412~2472, 2484 Japan ++ 5 2G_ETSI2 ETSI 10~13 2457~2472 France ++ ++ ++ ++ ++ 5G Regulatory Domains ++ Case 5G RD Regulation Channels Frequencyes Note Countries in Specific Domain ++ 1 5G_NULL NA NA NA Do not support 5GHz ++ 2 5G_ETSI1 ETSI "36~48, 52~64, ++ 100~140" "5180~5240, 5260~5230 ++ 5500~5700" Band1, Ban2, Band3 Europe ++ 3 5G_ETSI2 ETSI "36~48, 52~64, ++ 100~140, 149~165" "5180~5240, 5260~5230 ++ 5500~5700, 5745~5825" Band1, Ban2, Band3, Band4 Australia, New Zealand ++ 4 5G_ETSI3 ETSI "36~48, 52~64, ++ 100~132, 149~165" ++ "5180~5240, 5260~5230 ++ 5500~5660, 5745~5825" Band1, Ban2, Band3(except CH 136, 140), Band4" Russia ++ 5 5G_FCC1 FCC "36~48, 52~64, ++ 100~140, 149~165" ++ "5180~5240, 5260~5230 ++ 5500~5700, 5745~5825" Band1(5150~5250MHz), ++ Band2(5250~5350MHz), ++ Band3(5470~5725MHz), ++ Band4(5725~5850MHz)" US ++ 6 5G_FCC2 FCC 36~48, 149~165 5180~5240, 5745~5825 Band1, Band4 FCC o/w DFS Channels ++ 7 5G_FCC3 FCC "36~48, 52~64, ++ 149~165" "5180~5240, 5260~5230 ++ 5745~5825" Band1, Ban2, Band4 India, Mexico ++ 8 5G_FCC4 FCC "36~48, 52~64, ++ 149~161" "5180~5240, 5260~5230 ++ 5745~5805" Band1, Ban2, ++ Band4(except CH 165)" Venezuela ++ 9 5G_FCC5 FCC 149~165 5745~5825 Band4 China ++ 10 5G_FCC6 FCC 36~48, 52~64 5180~5240, 5260~5230 Band1, Band2 Israel ++ 11 5G_FCC7 ++ 5G_IC1 FCC ++ IC" "36~48, 52~64, ++ 100~116, 136, 140, ++ 149~165" "5180~5240, 5260~5230 ++ 5500~5580, 5680, 5700, ++ 5745~5825" "Band1, Band2, ++ Band3(except 5600~5650MHz), ++ Band4" "US ++ Canada" ++ 12 5G_KCC1 KCC "36~48, 52~64, ++ 100~124, 149~165" "5180~5240, 5260~5230 ++ 5500~5620, 5745~5825" "Band1, Ban2, ++ Band3(5470~5650MHz), ++ Band4" Korea ++ 13 5G_MKK1 MKK "36~48, 52~64, ++ 100~140" "5180~5240, 5260~5230 ++ 5500~5700" W52, W53, W56 Japan ++ 14 5G_MKK2 MKK 36~48, 52~64 5180~5240, 5260~5230 W52, W53 Japan (W52, W53) ++ 15 5G_MKK3 MKK 100~140 5500~5700 W56 Japan (W56) ++ 16 5G_NCC1 NCC "56~64, ++ 100~116, 136, 140, ++ 149~165" "5260~5320 ++ 5500~5580, 5680, 5700, ++ 5745~5825" "Band2(except CH 52), ++ Band3(except 5600~5650MHz), ++ Band4" Taiwan ++ ++ ++*/ ++ ++// ++// 2.4G CHannel ++// ++/* ++ ++ 2.4G Band Regulatory Domains RTL8192D ++ Channel Number Channel Frequency US Canada Europe Spain France Japan Japan 20M 40M ++ (MHz) (FCC) (IC) (ETSI) (MPHPT) ++ 1 2412 v v v v v ++ 2 2417 v v v v v ++ 3 2422 v v v v v v ++ 4 2427 v v v v v v ++ 5 2432 v v v v v v ++ 6 2437 v v v v v v ++ 7 2442 v v v v v v ++ 8 2447 v v v v v v ++ 9 2452 v v v v v v ++ 10 2457 v v v v v v v v ++ 11 2462 v v v v v v v v ++ 12 2467 v v v v v ++ 13 2472 v v v v ++ 14 2484 v v ++ ++ ++*/ ++ ++ ++// ++// 5G Operating Channel ++// ++/* ++ ++ 5G Band RTL8192D RTL8195 (Jaguar) Jaguar 2 Regulatory Domains ++ Channel Number Channel Frequency Global Global Global "US ++(FCC 15.407)" "Canada ++(FCC, except 5.6~5.65GHz)" Argentina, Australia, New Zealand, Brazil, S. Africa (FCC/ETSI) "Europe ++(CE 301 893)" China India, Mexico, Singapore Israel, Turkey "Japan ++(MIC Item 19-3, 19-3-2)" Korea Russia, Ukraine "Taiwan ++(NCC)" Venezuela ++ (MHz) (20MHz) (20MHz) (40MHz) (80MHz) (160MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) ++"Band 1 ++5.15GHz ++~ ++5.25GHz" 36 5180 v v v v v Indoor Indoor v Indoor v Indoor Indoor v v v ++ 40 5200 v v v Indoor Indoor v Indoor v Indoor Indoor v v v ++ 44 5220 v v v v Indoor Indoor v Indoor v Indoor Indoor v v v ++ 48 5240 v v v Indoor Indoor v Indoor v Indoor Indoor v v v ++"Band 2 ++5.25GHz ++~ ++5.35GHz ++(DFS)" 52 5260 v v v v v v v v Indoor v Indoor Indoor v v v ++ 56 5280 v v v v v v Indoor v Indoor Indoor v v Indoor v ++ 60 5300 v v v v v v v Indoor v Indoor Indoor v v Indoor v ++ 64 5320 v v v v v v Indoor v Indoor Indoor v v Indoor v ++ ++"Band 3 ++5.47GHz ++~ ++5.725GHz ++(DFS)" 100 5500 v v v v v v v v v v v v v ++ 104 5520 v v v v v v v v v v v ++ 108 5540 v v v v v v v v v v v v ++ 112 5560 v v v v v v v v v v v ++ 116 5580 v v v v v v v v v v v v v ++ 120 5600 v v v Indoor v Indoor v v v ++ 124 5620 v v v v Indoor v Indoor v v v ++ 128 5640 v v v Indoor v Indoor v v ++ 132 5660 v v v E v Indoor v Indoor v v ++ 136 5680 v v v v v v v v v ++ 140 5700 v v E v v v v v v v ++ 144 5720 E E E ++"Band 4 ++5.725GHz ++~ ++5.85GHz ++(~5.9GHz)" 149 5745 v v v v v v v v v v v v v v ++ 153 5765 v v v v v v v v v v v v ++ 157 5785 v v v v v v v v v v v v v ++ 161 5805 v v v v v v v v v v v v ++ 165 5825 v v P P v v v v v v v v v ++ 169 5845 P P P ++ 173 5865 P P P P ++ 177 5885 P P P ++Channel Count 28 28 14 7 0 28 24 20 24 19 5 13 8 19 20 22 15 12 ++ E: FCC accepted the ask for CH144 from Accord. PS: 160MHz 80MHz+80MHz{H Argentina Belgium (Q) India Israel Russia ++ P: Customer's requirement from James. Australia The Netherlands () Mexico Turkey Ukraine ++ New Zealand UK (^) Singapore ++ Brazil Switzerland (h) ++ ++ ++*/ ++ ++/*---------------------------Define Local Constant---------------------------*/ ++ ++ ++// define Maximum Power v.s each band for each region ++// ISRAEL ++// Format: ++// RT_CHANNEL_DOMAIN_Region ={{{Chnl_Start, Chnl_end, Pwr_dB_Max}, {Chn2_Start, Chn2_end, Pwr_dB_Max}, {Chn3_Start, Chn3_end, Pwr_dB_Max}, {Chn4_Start, Chn4_end, Pwr_dB_Max}, {Chn5_Start, Chn5_end, Pwr_dB_Max}}, Limit_Num} */ ++// RT_CHANNEL_DOMAIN_FCC ={{{01,11,30}, {36,48,17}, {52,64,24}, {100,140,24}, {149,165,30}}, 5} ++// "NR" is non-release channle. ++// Issue--- Israel--Russia--New Zealand ++// DOMAIN_01= (2G_WORLD, 5G_NULL) ++// DOMAIN_02= (2G_ETSI1, 5G_NULL) ++// DOMAIN_03= (2G_FCC1, 5G_NULL) ++// DOMAIN_04= (2G_MKK1, 5G_NULL) ++// DOMAIN_05= (2G_ETSI2, 5G_NULL) ++// DOMAIN_06= (2G_FCC1, 5G_FCC1) ++// DOMAIN_07= (2G_WORLD, 5G_ETSI1) ++// DOMAIN_08= (2G_MKK1, 5G_MKK1) ++// DOMAIN_09= (2G_WORLD, 5G_KCC1) ++// DOMAIN_10= (2G_WORLD, 5G_FCC2) ++// DOMAIN_11= (2G_WORLD, 5G_FCC3)----india ++// DOMAIN_12= (2G_WORLD, 5G_FCC4)----Venezuela ++// DOMAIN_13= (2G_WORLD, 5G_FCC5)----China ++// DOMAIN_14= (2G_WORLD, 5G_FCC6)----Israel ++// DOMAIN_15= (2G_FCC1, 5G_FCC7)-----Canada ++// DOMAIN_16= (2G_WORLD, 5G_ETSI2)---Australia ++// DOMAIN_17= (2G_WORLD, 5G_ETSI3)---Russia ++// DOMAIN_18= (2G_MKK1, 5G_MKK2)-----Japan ++// DOMAIN_19= (2G_MKK1, 5G_MKK3)-----Japan ++// DOMAIN_20= (2G_FCC1, 5G_NCC1)-----Taiwan ++// DOMAIN_21= (2G_FCC1, 5G_NCC1)-----Taiwan ++ ++ ++static RT_CHANNEL_PLAN_MAXPWR ChnlPlanPwrMax_2G[] = { ++ ++ // 2G_WORLD, ++ {{1, 13, 20}, 1}, ++ ++ // 2G_ETSI1 ++ {{1, 13, 20}, 1}, ++ ++ /* RT_CHANNEL_DOMAIN_ETSI */ ++ {{{1, 11, 17}, {40, 56, 17}, {60, 128, 17}, {0, 0, 0}, {149, 165, 17}}, 4}, ++ ++ // RT_CHANNEL_DOMAIN_MKK ++ {{{1, 11, 17}, {0, 0, 0}, {0, 0, 0}, {0, 0, 0}, {0, 0, 0}}, 1}, ++ ++ // Add new channel plan mex power table. ++ // ...... ++ }; ++ ++ ++/* ++//===========================================1:(2G_WORLD, 5G_NULL) ++ ++RT_CHANNEL_PLAN_MAXPWR RT_DOMAIN_01 ={{{01,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} ++ ++//===========================================2:(2G_ETSI1, 5G_NULL) ++ ++RT_DOMAIN_02 ={{{01,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} ++ ++//===========================================3:(2G_FCC1, 5G_NULL) ++ ++RT_DOMAIN_03 ={{{01,11,30}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} ++ ++//===========================================4:(2G_MKK1, 5G_NULL) ++ ++RT_DOMAIN_04 ={{{01,14,23}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} ++ ++//===========================================5:(2G_ETSI2, 5G_NULL) ++ ++RT_DOMAIN_05 ={{{10,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} ++ ++//===========================================6:(2G_FCC1, 5G_FCC1) ++ ++RT_DOMAIN_06 ={{{01,13,30}, {36,48,17}, {52,64,24}, {100,140,24}, {149,165,30}}, 5} ++ ++//===========================================7:(2G_WORLD, 5G_ETSI1) ++ ++RT_DOMAIN_07 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,140,30}, {NR,NR,0}}, 4} ++ ++//===========================================8:(2G_MKK1, 5G_MKK1) ++ ++RT_DOMAIN_08 ={{{01,14,23}, {36,48,23}, {52,64,23}, {100,140,23}, {NR,NR,0}}, 4} ++ ++//===========================================9:(2G_WORLD, 5G_KCC1) ++ ++RT_DOMAIN_09 ={{{01,13,20}, {36,48,17}, {52,64,23}, {100,124,23}, {149,165,23}}, 5} ++ ++//===========================================10:(2G_WORLD, 5G_FCC2) ++ ++RT_DOMAIN_10 ={{{01,13,20}, {36,48,17}, {NR,NR,0}, {NR,NR,0}, {149,165,30}}, 3} ++ ++//===========================================11:(2G_WORLD, 5G_FCC3) ++RT_DOMAIN_11 ={{{01,13,20}, {36,48,23}, {52,64,23}, {NR,NR,0}, {149,165,23}}, 4} ++ ++//===========================================12:(2G_WORLD, 5G_FCC4) ++RT_DOMAIN_12 ={{{01,13,20}, {36,48,24}, {52,64,24}, {NR,NR,0}, {149,161,27}}, 4} ++ ++//===========================================13:(2G_WORLD, 5G_FCC5) ++RT_DOMAIN_13 ={{{01,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {149,165,27}}, 2} ++ ++//===========================================14:(2G_WORLD, 5G_FCC6) ++RT_DOMAIN_14 ={{{01,13,20}, {36,48,17}, {52,64,17}, {NR,NR,0}, {NR,NR,0}}, 3} ++ ++//===========================================15:(2G_FCC1, 5G_FCC7) ++RT_DOMAIN_15 ={{{01,11,30}, {36,48,23}, {52,64,24}, {100,140,24}, {149,165,30}}, 5} ++ ++//===========================================16:(2G_WORLD, 5G_ETSI2) ++RT_DOMAIN_16 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,140,30}, {149,165,30}}, 5} ++ ++//===========================================17:(2G_WORLD, 5G_ETSI3) ++RT_DOMAIN_17 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,132,30}, {149,165,20}}, 5} ++ ++//===========================================18:(2G_MKK1, 5G_MKK2) ++RT_DOMAIN_18 ={{{01,14,23}, {36,48,23}, {52,64,23}, {NR,NR,0}, {NR,NR,0}}, 3} ++ ++//===========================================19:(2G_MKK1, 5G_MKK3) ++RT_DOMAIN_19 ={{{01,14,23}, {NR,NR,0}, {NR,NR,0}, {100,140,23}, {NR,NR,0}}, 2} ++ ++//===========================================20:(2G_FCC1, 5G_NCC1) ++RT_DOMAIN_20 ={{{01,11,30}, {NR,NR,0}, {56,64,23}, {100,140,24}, {149,165,30}}, 4} ++ ++//===========================================21:(2G_FCC1, 5G_NCC2) ++RT_DOMAIN_21 ={{{01,11,30}, {NR,NR,0}, {56,64,23}, {NR,NR,0}, {149,165,30}}, 3} ++ ++//===========================================22:(2G_WORLD, 5G_FCC3) ++RT_DOMAIN_22 ={{{01,13,24}, {36,48,20}, {52,64,24}, {NR,NR,0}, {149,165,30}}, 4} ++ ++//===========================================23:(2G_WORLD, 5G_ETSI2) ++RT_DOMAIN_23 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,140,30}, {149,165,30}}, 5} ++ ++*/ ++ ++// ++// Counter & Realtek Channel plan transfer table. ++// ++RT_CHNL_CTRY_TBL RtCtryChnlTbl[] = ++{ ++ ++ { ++ RT_CTRY_AL, // "Albaniaڥ" ++ "AL", ++ RT_2G_WORLD, ++ RT_5G_WORLD, ++ RT_CHANNEL_DOMAIN_UNDEFINED // 2G/5G world. ++ }, ++#if 0 ++ { ++ RT_CTRY_BB, // "Barbadosڤڦh" ++ "BB", ++ RT_2G_WORLD, ++ RT_5G_NULL, ++ RT_CHANNEL_DOMAIN_EFUSE_0x20 // 2G world. 5G_NULL ++ }, ++ ++ { ++ RT_CTRY_DE, // "Germanyw" ++ "DE", ++ RT_2G_WORLD, ++ RT_5G_ETSI1, ++ RT_CHANNEL_DOMAIN_EFUSE_0x26 ++ }, ++ ++ { ++ RT_CTRY_US, // "Germanyw" ++ "US", ++ RT_2G_FCC1, ++ RT_5G_FCC7, ++ RT_CHANNEL_DOMAIN_EFUSE_0x34 ++ }, ++ ++ { ++ RT_CTRY_JP, // "Germanyw" ++ "JP", ++ RT_2G_MKK1, ++ RT_5G_MKK1, ++ RT_CHANNEL_DOMAIN_EFUSE_0x34 ++ }, ++ ++ { ++ RT_CTRY_TW, // "Germanyw" ++ "TW", ++ RT_2G_FCC1, ++ RT_5G_NCC1, ++ RT_CHANNEL_DOMAIN_EFUSE_0x39 ++ }, ++#endif ++ ++}; // RtCtryChnlTbl ++ ++// ++// Realtek Defined Channel plan. ++// ++#if 0 ++ ++static RT_CHANNEL_PLAN_NEW RtChnlPlan[] = ++{ ++ // Channel Plan 0x20. ++ { ++ &RtCtryChnlTbl[1], // RT_CHNL_CTRY_TBL Country & channel plan transfer table. ++ RT_CHANNEL_DOMAIN_EFUSE_0x20, // RT_CHANNEL_DOMAIN RT Channel Plan Define ++ RT_2G_WORLD, // RT_REGULATION_2G ++ RT_5G_NULL, // RT_REGULATION_5G ++ RT_WORLD, // RT_REGULATION_CMN RT Regulatory domain definition. ++ RT_SREQ_NA, // RT Channel plan special & customerize requirement. ++ ++ CHNL_RT_2G_WORLD, ++ CHNL_RT_2G_WORLD_SCAN_TYPE, ++ &ChnlPlanPwrMax_2G[0], ++ ++ CHNL_RT_5G_NULL, ++ CHNL_RT_5G_NULL_SCAN_TYPE, ++ ++ ++ }, ++ ++ // Channel Plan 0x26. ++ { ++ &RtCtryChnlTbl[1], // RT_CHNL_CTRY_TBL Country & channel plan transfer table. ++ RT_CHANNEL_DOMAIN_EFUSE_0x26, // RT_CHANNEL_DOMAIN RT Channel Plan Define ++ RT_2G_WORLD, // RT_REGULATION_2G ++ RT_5G_ETSI1, // RT_REGULATION_5G ++ RT_WORLD, // RT_REGULATION_CMN RT Regulatory domain definition. ++ RT_SREQ_NA, // RT Channel plan special & customerize requirement. ++ ++ CHNL_RT_2G_WORLD, // 2G workd cannel ++ CHNL_RT_2G_WORLD_SCAN_TYPE, ++ &ChnlPlanPwrMax_2G[1], ++ ++ CHNL_RT_5G_ETSI1, ++ CHNL_RT_5G_ETSI1_SCAN_TYPE, ++ ++ } ++ ++ ++}; ++#endif ++ ++ ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtchnlplan.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtchnlplan.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtchnlplan.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtchnlplan.h 2018-02-11 21:44:27.158146254 +0200 +@@ -0,0 +1,699 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ ++#ifndef __RT_CHANNELPLAN_H__ ++#define __RT_CHANNELPLAN_H__ ++ ++typedef enum _RT_CHANNEL_DOMAIN_NEW ++{ ++ ++ //===== Add new channel plan above this line ===============// ++ ++ // For new architecture we define different 2G/5G CH area for all country. ++ // 2.4 G only ++ RT_CHANNEL_DOMAIN_2G_WORLD_5G_NULL = 0x20, ++ RT_CHANNEL_DOMAIN_2G_ETSI1_5G_NULL = 0x21, ++ RT_CHANNEL_DOMAIN_2G_FCC1_5G_NULL = 0x22, ++ RT_CHANNEL_DOMAIN_2G_MKK1_5G_NULL = 0x23, ++ RT_CHANNEL_DOMAIN_2G_ETSI2_5G_NULL = 0x24, ++ // 2.4 G + 5G type 1 ++ RT_CHANNEL_DOMAIN_2G_FCC1_5G_FCC1 = 0x25, ++ RT_CHANNEL_DOMAIN_2G_WORLD_5G_ETSI1 = 0x26, ++ //RT_CHANNEL_DOMAIN_2G_WORLD_5G_ETSI1 = 0x27, ++ // ..... ++ ++ RT_CHANNEL_DOMAIN_MAX_NEW, ++ ++}RT_CHANNEL_DOMAIN_NEW, *PRT_CHANNEL_DOMAIN_NEW; ++ ++ ++#if 0 ++#define DOMAIN_CODE_2G_WORLD \ ++ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 ++#define DOMAIN_CODE_2G_ETSI1 \ ++ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 ++#define DOMAIN_CODE_2G_ETSI2 \ ++ {1,2,3,4,5,6,7,8,9,10,11}, 11 ++#define DOMAIN_CODE_2G_FCC1 \ ++ {1,2,3,4,5,6,7,8,9,10,11,12,13,14}, 14 ++#define DOMAIN_CODE_2G_MKK1 \ ++ {10,11,12,13}, 4 ++ ++#define DOMAIN_CODE_5G_ETSI1 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 ++#define DOMAIN_CODE_5G_ETSI2 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 ++#define DOMAIN_CODE_5G_ETSI3 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165}, 22 ++#define DOMAIN_CODE_5G_FCC1 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 ++#define DOMAIN_CODE_5G_FCC2 \ ++ {36,40,44,48,149,153,157,161,165}, 9 ++#define DOMAIN_CODE_5G_FCC3 \ ++ {36,40,44,48,52,56,60,64,149,153,157,161,165}, 13 ++#define DOMAIN_CODE_5G_FCC4 \ ++ {36,40,44,48,52,56,60,64,149,153,157,161}, 12 ++#define DOMAIN_CODE_5G_FCC5 \ ++ {149,153,157,161,165}, 5 ++#define DOMAIN_CODE_5G_FCC6 \ ++ {36,40,44,48,52,56,60,64}, 8 ++#define DOMAIN_CODE_5G_FCC7 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 ++#define DOMAIN_CODE_5G_IC1 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 ++#define DOMAIN_CODE_5G_KCC1 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165}, 20 ++#define DOMAIN_CODE_5G_MKK1 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 ++#define DOMAIN_CODE_5G_MKK2 \ ++ {36,40,44,48,52,56,60,64}, 8 ++#define DOMAIN_CODE_5G_MKK3 \ ++ {100,104,108,112,116,120,124,128,132,136,140}, 11 ++#define DOMAIN_CODE_5G_NCC1 \ ++ {56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 24 ++#define DOMAIN_CODE_5G_NCC2 \ ++ {56,60,64,149,153,157,161,165}, 8 ++#define UNDEFINED \ ++ {0}, 0 ++#endif ++ ++// ++// ++// ++/* ++ ++Countries "Country Abbreviation" Domain Code SKU's Ch# of 20MHz ++ 2G 5G Ch# of 40MHz ++"Albaniaڥ" AL Local Test ++ ++"AlgeriaΧQ" DZ CE TCF ++ ++"Antigua & Barbudawʮq&ڥF" AG 2G_WORLD FCC TCF ++ ++"Argentinaڧ" AR 2G_WORLD Local Test ++ ++"ArmeniaȬ" AM 2G_WORLD ETSI ++ ++"Aruba|ڮq" AW 2G_WORLD FCC TCF ++ ++"AustraliaDw" AU 2G_WORLD 5G_ETSI2 ++ ++"AustriaaQ" AT 2G_WORLD 5G_ETSI1 CE ++ ++"Azerbaijan" AZ 2G_WORLD CE TCF ++ ++"Bahamasګ" BS 2G_WORLD ++ ++"Barbadosڤڦh" BB 2G_WORLD FCC TCF ++ ++"BelgiumQ" BE 2G_WORLD 5G_ETSI1 CE ++ ++"Bermudaʼ}F" BM 2G_WORLD FCC TCF ++ ++"Brazilڦ" BR 2G_WORLD Local Test ++ ++"BulgariaO[Q" BG 2G_WORLD 5G_ETSI1 CE ++ ++"Canada[j" CA 2G_FCC1 5G_FCC7 IC / FCC IC / FCC ++ ++"Cayman Islands}Ҹsq" KY 2G_WORLD 5G_ETSI1 CE ++ ++"ChileQ" CL 2G_WORLD FCC TCF ++ ++"China" CN 2G_WORLD 5G_FCC5 H?i2002j353? ++ ++"Columbiaۤ" CO 2G_WORLD Voluntary ++ ++"Costa RicaF[" CR 2G_WORLD FCC TCF ++ ++"Cyprus" CY 2G_WORLD 5G_ETSI1 CE ++ ++"Czech J" CZ 2G_WORLD 5G_ETSI1 CE ++ ++"Denmark" DK 2G_WORLD 5G_ETSI1 CE ++ ++"Dominican Republich[@M" DO 2G_WORLD FCC TCF ++ ++"EgyptJ" EG 2G_WORLD CE T CF ++ ++"El Salvadorĺ˦h" SV 2G_WORLD Voluntary ++ ++"EstoniaRF" EE 2G_WORLD 5G_ETSI1 CE ++ ++"Finland" FI 2G_WORLD 5G_ETSI1 CE ++ ++"Francek" FR 5G_E TSI1 CE ++ ++"Germanyw" DE 2G_WORLD 5G_ETSI1 CE ++ ++"Greece þ" GR 2G_WORLD 5G_ETSI1 CE ++ ++"Guamq" GU 2G_WORLD ++ ++"Guatemalaʦa" GT 2G_WORLD ++ ++"Haitia" HT 2G_WORLD FCC TCF ++ ++"HondurasԴ" HN 2G_WORLD FCC TCF ++ ++"HungaryIQ" HU 2G_WORLD 5G_ETSI1 CE ++ ++"IcelandBq" IS 2G_WORLD 5G_ETSI1 CE ++ ++"IndiaL" IN 2G_WORLD 5G_FCC3 FCC/CE TCF ++ ++"IrelandR" IE 2G_WORLD 5G_ETSI1 CE ++ ++"IsraelHC" IL 5G_F CC6 CE TCF ++ ++"ItalyqjQ" IT 2G_WORLD 5G_ETSI1 CE ++ ++"Japan饻" JP 2G_MKK1 5G_MKK1 MKK MKK ++ ++"Korea" KR 2G_WORLD 5G_KCC1 KCC KCC ++ ++"LatviaԲ" LV 2G_WORLD 5G_ETSI1 CE ++ ++"Lithuania߳{" LT 2G_WORLD 5G_ETSI1 CE ++ ++"Luxembourgc˳" LU 2G_WORLD 5G_ETSI1 CE ++ ++"MalaysiaӦ" MY 2G_WORLD Local Test ++ ++"MaltaL" MT 2G_WORLD 5G_ETSI1 CE ++ ++"Mexico" MX 2G_WORLD 5G_FCC3 Local Test ++ ++"Morocco" MA CE TCF ++ ++"Netherlands" NL 2G_WORLD 5G_ETSI1 CE ++ ++"New Zealandæ" NZ 2G_WORLD 5G_ETSI2 ++ ++"Norway" NO 2G_WORLD 5G_ETSI1 CE ++ ++"Panamaڮ " PA 2G_FCC1 Voluntary ++ ++"Philippines߻" PH 2G_WORLD FCC TCF ++ ++"Polandi" PL 2G_WORLD 5G_ETSI1 CE ++ ++"Portugal" PT 2G_WORLD 5G_ETSI1 CE ++ ++"Romaniaù" RO 2G_WORLD 5G_ETSI1 CE ++ ++"RussiaXù" RU 2G_WORLD 5G_ETSI3 CE TCF ++ ++"Saudi ArabiaFaԧB" SA 2G_WORLD CE TCF ++ ++"Singapores[Y" SG 2G_WORLD ++ ++"SlovakiaJ" SK 2G_WORLD 5G_ETSI1 CE ++ ++"Slovenia" SI 2G_WORLD 5G_ETSI1 CE ++ ++"South AfricanD" ZA 2G_WORLD CE TCF ++ ++"SpainZ" ES 5G_ETSI1 CE ++ ++"Sweden" SE 2G_WORLD 5G_ETSI1 CE ++ ++"Switzerlandh" CH 2G_WORLD 5G_ETSI1 CE ++ ++"TaiwanOW" TW 2G_FCC1 5G_NCC1 NCC ++ ++"Thailand" TH 2G_WORLD FCC/CE TCF ++ ++"Turkeygը" TR 2G_WORLD ++ ++"UkraineQJ" UA 2G_WORLD Local Test ++ ++"United Kingdom^" GB 2G_WORLD 5G_ETSI1 CE ETSI ++ ++"United States" US 2G_FCC1 5G_FCC7 FCC FCC ++ ++"Venezuelae" VE 2G_WORLD 5G_FCC4 FCC TCF ++ ++"VietnamVn" VN 2G_WORLD FCC/CE TCF ++ ++ ++ ++*/ ++ ++// Counter abbervation. ++typedef enum _RT_COUNTRY_DEFINE_NUM ++{ ++ RT_CTRY_AL, // "Albaniaڥ" ++ RT_CTRY_DZ, // "AlgeriaΧQ" ++ RT_CTRY_AG, // "Antigua & Barbudawʮq&ڥF" ++ RT_CTRY_AR, // "Argentinaڧ" ++ RT_CTRY_AM, // "ArmeniaȬ" ++ RT_CTRY_AW, // "Aruba|ڮq" ++ RT_CTRY_AU, // "AustraliaDw" ++ RT_CTRY_AT, // "AustriaaQ" ++ RT_CTRY_AZ, // "Azerbaijan" ++ RT_CTRY_BS, // "Bahamasګ" ++ RT_CTRY_BB, // "Barbadosڤڦh" ++ RT_CTRY_BE, // "BelgiumQ" ++ RT_CTRY_BM, // "Bermudaʼ}F" ++ RT_CTRY_BR, // "Brazilڦ" ++ RT_CTRY_BG, // "BulgariaO[Q" ++ RT_CTRY_CA, // "Canada[j" ++ RT_CTRY_KY, // "Cayman Islands}Ҹsq" ++ RT_CTRY_CL, // "ChileQ" ++ RT_CTRY_CN, // "China" ++ RT_CTRY_CO, // "Columbiaۤ" ++ RT_CTRY_CR, // "Costa RicaF[" ++ RT_CTRY_CY, // "Cyprus" ++ RT_CTRY_CZ, // "Czech J" ++ RT_CTRY_DK, // "Denmark" ++ RT_CTRY_DO, // "Dominican Republich[@M" ++ RT_CTRY_CE, // "EgyptJ" EG 2G_WORLD ++ RT_CTRY_SV, // "El Salvadorĺ˦h" ++ RT_CTRY_EE, // "EstoniaRF" ++ RT_CTRY_FI, // "Finland" ++ RT_CTRY_FR, // "Francek" ++ RT_CTRY_DE, // "Germanyw" ++ RT_CTRY_GR, // "Greece þ" ++ RT_CTRY_GU, // "Guamq" ++ RT_CTRY_GT, // "Guatemalaʦa" ++ RT_CTRY_HT, // "Haitia" ++ RT_CTRY_HN, // "HondurasԴ" ++ RT_CTRY_HU, // "HungaryIQ" ++ RT_CTRY_IS, // "IcelandBq" ++ RT_CTRY_IN, // "IndiaL" ++ RT_CTRY_IE, // "IrelandR" ++ RT_CTRY_IL, // "IsraelHC" ++ RT_CTRY_IT, // "ItalyqjQ" ++ RT_CTRY_JP, // "Japan饻" ++ RT_CTRY_KR, // "Korea" ++ RT_CTRY_LV, // "LatviaԲ" ++ RT_CTRY_LT, // "Lithuania߳{" ++ RT_CTRY_LU, // "Luxembourgc˳" ++ RT_CTRY_MY, // "MalaysiaӦ" ++ RT_CTRY_MT, // "MaltaL" ++ RT_CTRY_MX, // "Mexico" ++ RT_CTRY_MA, // "Morocco" ++ RT_CTRY_NL, // "Netherlands" ++ RT_CTRY_NZ, // "New Zealandæ" ++ RT_CTRY_NO, // "Norway" ++ RT_CTRY_PA, // "Panamaڮ " ++ RT_CTRY_PH, // "Philippines߻" ++ RT_CTRY_PL, // "Polandi" ++ RT_CTRY_PT, // "Portugal" ++ RT_CTRY_RO, // "Romaniaù" ++ RT_CTRY_RU, // "RussiaXù" ++ RT_CTRY_SA, // "Saudi ArabiaFaԧB" ++ RT_CTRY_SG, // "Singapores[Y" ++ RT_CTRY_SK, // "SlovakiaJ" ++ RT_CTRY_SI, // "Slovenia" ++ RT_CTRY_ZA, // "South AfricanD" ++ RT_CTRY_ES, // "SpainZ" ++ RT_CTRY_SE, // "Sweden" ++ RT_CTRY_CH, // "Switzerlandh" ++ RT_CTRY_TW, // "TaiwanOW" ++ RT_CTRY_TH, // "Thailand" ++ RT_CTRY_TR, // "Turkeygը" ++ RT_CTRY_UA, // "UkraineQJ" ++ RT_CTRY_GB, // "United Kingdom^" ++ RT_CTRY_US, // "United States" ++ RT_CTRY_VE, // "Venezuelae" ++ RT_CTRY_VN, // "VietnamVn" ++ RT_CTRY_MAX, // ++ ++}RT_COUNTRY_NAME, *PRT_COUNTRY_NAME; ++ ++// Scan type including active and passive scan. ++typedef enum _RT_SCAN_TYPE_NEW ++{ ++ SCAN_NULL, ++ SCAN_ACT, ++ SCAN_PAS, ++ SCAN_BOTH, ++}RT_SCAN_TYPE_NEW, *PRT_SCAN_TYPE_NEW; ++ ++ ++// Power table sample. ++ ++typedef struct _RT_CHNL_PLAN_LIMIT ++{ ++ u2Byte Chnl_Start; ++ u2Byte Chnl_end; ++ ++ u2Byte Freq_Start; ++ u2Byte Freq_end; ++}RT_CHNL_PLAN_LIMIT, *PRT_CHNL_PLAN_LIMIT; ++ ++ ++// ++// 2.4G Regulatory Domains ++// ++typedef enum _RT_REGULATION_DOMAIN_2G ++{ ++ RT_2G_NULL, ++ RT_2G_WORLD, ++ RT_2G_ETSI1, ++ RT_2G_FCC1, ++ RT_2G_MKK1, ++ RT_2G_ETSI2 ++ ++}RT_REGULATION_2G, *PRT_REGULATION_2G; ++ ++ ++//typedef struct _RT_CHANNEL_BEHAVIOR ++//{ ++// u1Byte Chnl; ++// RT_SCAN_TYPE_NEW ++// ++//}RT_CHANNEL_BEHAVIOR, *PRT_CHANNEL_BEHAVIOR; ++ ++//typedef struct _RT_CHANNEL_PLAN_TYPE ++//{ ++// RT_CHANNEL_BEHAVIOR ++// u1Byte Chnl_num; ++//}RT_CHNL_PLAN_TYPE, *PRT_CHNL_PLAN_TYPE; ++ ++// ++// 2.4G Channel Number ++// Channel definition & number ++// ++#define CHNL_RT_2G_NULL \ ++ {0}, 0 ++#define CHNL_RT_2G_WORLD \ ++ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 ++#define CHNL_RT_2G_WORLD_TEST \ ++ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 ++ ++#define CHNL_RT_2G_EFSI1 \ ++ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 ++#define CHNL_RT_2G_FCC1 \ ++ {1,2,3,4,5,6,7,8,9,10,11}, 11 ++#define CHNL_RT_2G_MKK1 \ ++ {1,2,3,4,5,6,7,8,9,10,11,12,13,14}, 14 ++#define CHNL_RT_2G_ETSI2 \ ++ {10,11,12,13}, 4 ++ ++// ++// 2.4G Channel Active or passive scan. ++// ++#define CHNL_RT_2G_NULL_SCAN_TYPE \ ++ {SCAN_NULL} ++#define CHNL_RT_2G_WORLD_SCAN_TYPE \ ++ {1,1,1,1,1,1,1,1,1,1,1,0,0} ++#define CHNL_RT_2G_EFSI1_SCAN_TYPE \ ++ {1,1,1,1,1,1,1,1,1,1,1,1,1} ++#define CHNL_RT_2G_FCC1_SCAN_TYPE \ ++ {1,1,1,1,1,1,1,1,1,1,1} ++#define CHNL_RT_2G_MKK1_SCAN_TYPE \ ++ {1,1,1,1,1,1,1,1,1,1,1,1,1,1} ++#define CHNL_RT_2G_ETSI2_SCAN_TYPE \ ++ {1,1,1,1} ++ ++ ++// ++// 2.4G Band & Frequency Section ++// Freqency start & end / band number ++// ++#define FREQ_RT_2G_NULL \ ++ {0}, 0 ++ // Passive scan CH 12, 13 ++#define FREQ_RT_2G_WORLD \ ++ {2412, 2472}, 1 ++#define FREQ_RT_2G_EFSI1 \ ++ {2412, 2472}, 1 ++#define FREQ_RT_2G_FCC1 \ ++ {2412, 2462}, 1 ++#define FREQ_RT_2G_MKK1 \ ++ {2412, 2484}, 1 ++#define FREQ_RT_2G_ETSI2 \ ++ {2457, 2472}, 1 ++ ++ ++// ++// 5G Regulatory Domains ++// ++typedef enum _RT_REGULATION_DOMAIN_5G ++{ ++ RT_5G_NULL, ++ RT_5G_WORLD, ++ RT_5G_ETSI1, ++ RT_5G_ETSI2, ++ RT_5G_ETSI3, ++ RT_5G_FCC1, ++ RT_5G_FCC2, ++ RT_5G_FCC3, ++ RT_5G_FCC4, ++ RT_5G_FCC5, ++ RT_5G_FCC6, ++ RT_5G_FCC7, ++ RT_5G_IC1, ++ RT_5G_KCC1, ++ RT_5G_MKK1, ++ RT_5G_MKK2, ++ RT_5G_MKK3, ++ RT_5G_NCC1, ++ ++}RT_REGULATION_5G, *PRT_REGULATION_5G; ++ ++// ++// 5G Channel Number ++// ++#define CHNL_RT_5G_NULL \ ++ {0}, 0 ++#define CHNL_RT_5G_WORLD \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 ++#define CHNL_RT_5G_ETSI1 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 ++#define CHNL_RT_5G_ETSI2 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165}, 22 ++#define CHNL_RT_5G_ETSI3 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 ++#define CHNL_RT_5G_FCC1 \ ++ {36,40,44,48,149,153,157,161,165}, 9 ++#define CHNL_RT_5G_FCC2 \ ++ {36,40,44,48,52,56,60,64,149,153,157,161,165}, 13 ++#define CHNL_RT_5G_FCC3 \ ++ {36,40,44,48,52,56,60,64,149,153,157,161}, 12 ++#define CHNL_RT_5G_FCC4 \ ++ {149,153,157,161,165}, 5 ++#define CHNL_RT_5G_FCC5 \ ++ {36,40,44,48,52,56,60,64}, 8 ++#define CHNL_RT_5G_FCC6 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 ++#define CHNL_RT_5G_FCC7 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 ++#define CHNL_RT_5G_IC1 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165}, 20 ++#define CHNL_RT_5G_KCC1 \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 ++#define CHNL_RT_5G_MKK1 \ ++ {36,40,44,48,52,56,60,64}, 8 ++#define CHNL_RT_5G_MKK2 \ ++ {100,104,108,112,116,120,124,128,132,136,140}, 11 ++#define CHNL_RT_5G_MKK3 \ ++ {56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 24 ++#define CHNL_RT_5G_NCC1 \ ++ {56,60,64,149,153,157,161,165}, 8 ++ ++// ++// 5G Channel Active or passive scan. ++// ++#define CHNL_RT_5G_NULL_SCAN_TYPE \ ++ {SCAN_NULL} ++#define CHNL_RT_5G_WORLD_SCAN_TYPE \ ++ {1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1} ++#define CHNL_RT_5G_ETSI1_SCAN_TYPE \ ++ {1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1} ++#define CHNL_RT_5G_ETSI2_SCAN_TYPE \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165}, 22 ++#define CHNL_RT_5G_ETSI3_SCAN_TYPE \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 ++#define CHNL_RT_5G_FCC1_SCAN_TYPE \ ++ {36,40,44,48,149,153,157,161,165}, 9 ++#define CHNL_RT_5G_FCC2_SCAN_TYPE \ ++ {36,40,44,48,52,56,60,64,149,153,157,161,165}, 13 ++#define CHNL_RT_5G_FCC3_SCAN_TYPE \ ++ {36,40,44,48,52,56,60,64,149,153,157,161}, 12 ++#define CHNL_RT_5G_FCC4_SCAN_TYPE \ ++ {149,153,157,161,165}, 5 ++#define CHNL_RT_5G_FCC5_SCAN_TYPE \ ++ {36,40,44,48,52,56,60,64}, 8 ++#define CHNL_RT_5G_FCC6_SCAN_TYPE \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 ++#define CHNL_RT_5G_FCC7_SCAN_TYPE \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 ++#define CHNL_RT_5G_IC1_SCAN_TYPE \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165}, 20 ++#define CHNL_RT_5G_KCC1_SCAN_TYPE \ ++ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 ++#define CHNL_RT_5G_MKK1_SCAN_TYPE \ ++ {36,40,44,48,52,56,60,64}, 8 ++#define CHNL_RT_5G_MKK2_SCAN_TYPE \ ++ {100,104,108,112,116,120,124,128,132,136,140}, 11 ++#define CHNL_RT_5G_MKK3_SCAN_TYPE \ ++ {56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 24 ++#define CHNL_RT_5G_NCC1_SCAN_TYPE \ ++ {56,60,64,149,153,157,161,165}, 8 ++ ++// ++// Global Regulation ++// ++typedef enum _RT_REGULATION_COMMON ++{ ++ RT_WORLD, ++ RT_FCC, ++ RT_MKK, ++ RT_ETSI, ++ RT_IC, ++ RT_CE, ++ RT_NCC, ++ ++}RT_REGULATION_CMN, *PRT_REGULATION_CMN; ++ ++ ++ ++// ++// Special requirement for different regulation domain. ++// For internal test or customerize special request. ++// ++typedef enum _RT_CHNLPLAN_SREQ ++{ ++ RT_SREQ_NA = 0x0, ++ RT_SREQ_2G_ADHOC_11N = 0x00000001, ++ RT_SREQ_2G_ADHOC_11B = 0x00000002, ++ RT_SREQ_2G_ALL_PASS = 0x00000004, ++ RT_SREQ_2G_ALL_ACT = 0x00000008, ++ RT_SREQ_5G_ADHOC_11N = 0x00000010, ++ RT_SREQ_5G_ADHOC_11AC = 0x00000020, ++ RT_SREQ_5G_ALL_PASS = 0x00000040, ++ RT_SREQ_5G_ALL_ACT = 0x00000080, ++ RT_SREQ_C1_PLAN = 0x00000100, ++ RT_SREQ_C2_PLAN = 0x00000200, ++ RT_SREQ_C3_PLAN = 0x00000400, ++ RT_SREQ_C4_PLAN = 0x00000800, ++ RT_SREQ_NFC_ON = 0x00001000, ++ RT_SREQ_MASK = 0x0000FFFF, /* Requirements bit mask */ ++ ++}RT_CHNLPLAN_SREQ, *PRT_CHNLPLAN_SREQ; ++ ++ ++// ++// RT_COUNTRY_NAME & RT_REGULATION_2G & RT_REGULATION_5G transfer table ++// ++// ++typedef struct _RT_CHANNEL_PLAN_COUNTRY_TRANSFER_TABLE ++{ ++ // ++ // Define countery domain and corresponding ++ // ++ RT_COUNTRY_NAME Country_Enum; ++ char Country_Name[3]; ++ ++ //char Domain_Name[12]; ++ RT_REGULATION_2G Domain_2G; ++ ++ RT_REGULATION_5G Domain_5G; ++ ++ RT_CHANNEL_DOMAIN RtChDomain; ++ //u1Byte Country_Area; ++ ++}RT_CHNL_CTRY_TBL, *PRT_CHNL_CTRY_TBL; ++ ++ ++#define RT_MAX_CHNL_NUM_2G 13 ++#define RT_MAX_CHNL_NUM_5G 44 ++ ++// Power table sample. ++ ++typedef struct _RT_CHNL_PLAN_PWR_LIMIT ++{ ++ u2Byte Chnl_Start; ++ u2Byte Chnl_end; ++ u1Byte dB_Max; ++ u2Byte mW_Max; ++}RT_CHNL_PWR_LIMIT, *PRT_CHNL_PWR_LIMIT; ++ ++ ++#define RT_MAX_BAND_NUM 5 ++ ++typedef struct _RT_CHANNEL_PLAN_MAXPWR ++{ ++// STRING_T ++ RT_CHNL_PWR_LIMIT Chnl[RT_MAX_BAND_NUM]; ++ u1Byte Band_Useful_Num; ++ ++ ++}RT_CHANNEL_PLAN_MAXPWR, *PRT_CHANNEL_PLAN_MAXPWR; ++ ++ ++// ++// Power By Rate Table. ++// ++ ++ ++ ++typedef struct _RT_CHANNEL_PLAN_NEW ++{ ++ // ++ // Define countery domain and corresponding ++ // ++ //char Country_Name[36]; ++ //u1Byte Country_Enum; ++ ++ //char Domain_Name[12]; ++ ++ ++ PRT_CHNL_CTRY_TBL pCtryTransfer; ++ ++ RT_CHANNEL_DOMAIN RtChDomain; ++ ++ RT_REGULATION_2G Domain_2G; ++ ++ RT_REGULATION_5G Domain_5G; ++ ++ RT_REGULATION_CMN Regulator; ++ ++ RT_CHNLPLAN_SREQ ChnlSreq; ++ ++ //RT_CHNL_PLAN_LIMIT RtChnl; ++ ++ u1Byte Chnl2G[MAX_CHANNEL_NUM]; // CHNL_RT_2G_WORLD ++ u1Byte Len2G; ++ u1Byte Chnl2GScanTp[MAX_CHANNEL_NUM]; // CHNL_RT_2G_WORLD_SCAN_TYPE ++ //u1Byte Freq2G[2]; // FREQ_RT_2G_WORLD ++ ++ u1Byte Chnl5G[MAX_CHANNEL_NUM]; ++ u1Byte Len5G; ++ u1Byte Chnl5GScanTp[MAX_CHANNEL_NUM]; ++ //u1Byte Freq2G[2]; // FREQ_RT_2G_WORLD ++ ++ RT_CHANNEL_PLAN_MAXPWR ChnlMaxPwr; ++ ++ ++}RT_CHANNEL_PLAN_NEW, *PRT_CHANNEL_PLAN_NEW; ++ ++ ++#endif // __RT_CHANNELPLAN_H__ ++ ++ ++ ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/hal8723dreg.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/hal8723dreg.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/hal8723dreg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/hal8723dreg.h 2018-02-11 21:44:27.158146254 +0200 +@@ -0,0 +1,932 @@ ++/***************************************************************************** ++ * Copyright(c) 2009, RealTEK Technology Inc. All Right Reserved. ++ * ++ * Module: __INC_HAL8723DREG_H ++ * ++ * ++ * Note: 1. Define Mac register address and corresponding bit mask map ++ * ++ * ++ * Export: Constants, macro, functions(API), global variables(None). ++ * ++ * Abbrev: ++ * ++ * History: ++ * Data Who Remark ++ * ++ *****************************************************************************/ ++#ifndef __INC_HAL8723DREG_H ++#define __INC_HAL8723DREG_H ++ ++ ++ ++//============================================================ ++// ++//============================================================ ++ ++//----------------------------------------------------- ++// ++// 0x0000h ~ 0x00FFh System Configuration ++// ++//----------------------------------------------------- ++#define REG_SYS_ISO_CTRL_8723D 0x0000 // 2 Byte ++#define REG_SYS_FUNC_EN_8723D 0x0002 // 2 Byte ++#define REG_SYS_PW_CTRL_8723D 0x0004 // 4 Byte ++#define REG_SYS_CLKR_8723D 0x0008 // 2 Byte ++#define REG_SYS_EEPROM_CTRL_8723D 0x000A // 2 Byte ++#define REG_EE_VPD_8723D 0x000C // 2 Byte ++#define REG_SYS_SWR_CTRL1_8723D 0x0010 // 1 Byte ++#define REG_SYS_SWR_CTRL2_8723D 0x0014 // 1 Byte ++#define REG_SYS_SWR_CTRL3_8723D 0x0018 // 4 Byte ++#define REG_RSV_CTRL_8723D 0x001C // 3 Byte ++#define REG_RF_CTRL_8723D 0x001F // 1 Byte ++#define REG_AFE_CTRL1_8723D 0x0024 // 4 Byte ++#define REG_AFE_CTRL2_8723D 0x0028 // 4 Byte ++#define REG_AFE_CTRL3_8723D 0x002c // 4 Byte ++#define REG_EFUSE_CTRL_8723D 0x0030 ++#define REG_LDO_EFUSE_CTRL_8723D 0x0034 ++#define REG_PWR_DATA_8723D 0x0038 ++#define REG_CAL_TIMER_8723D 0x003C ++#define REG_ACLK_MON_8723D 0x003E ++#define REG_GPIO_MUXCFG_8723D 0x0040 ++#define REG_GPIO_IO_SEL_8723D 0x0042 ++#define REG_MAC_PINMUX_CFG_8723D 0x0043 // ?????? ++#define REG_GPIO_PIN_CTRL_8723D 0x0044 ++#define REG_GPIO_INTM_8723D 0x0048 ++#define BIT_REG_LED_CFG_8723D 0x004C ++#define REG_LEDCFG2_8723D 0x004E // ?????? ++#define REG_FSIMR_8723D 0x0050 ++#define REG_FSISR_8723D 0x0054 ++#define REG_HSIMR_8723D 0x0058 ++#define REG_HSISR_8723D 0x005c ++#define REG_GPIO_EXT_CTRL_8723D 0x0060 ++#define REG_MULTI_FUNC_CTRL_8723D 0x0068 ++#define REG_GPIO_STATUS_8723D 0x006C ++#define REG_SDIO_CTRL_8723D 0x0070 ++#define REG_HCI_OPT_CTRL_8723D 0x0074 ++#define REG_AFE_CTRL4_8723D 0x0078 ++#define REG_LDO_SWR_CTRL_8723D 0x007C ++#define REG_8051FW_CTRL_8723D 0x0080 ++#define REG_FW_DBG_STATUS_8723D 0x0088 ++#define REG_FW_DBG_CTRL_8723D 0x008F ++#define REG_WLLPS_CTRL_8723D 0x0090 ++#define REG_HIMR0_8723D 0x00B0 ++#define REG_HISR0_8723D 0x00B4 ++#define REG_HIMR1_8723D 0x00B8 ++#define REG_HISR1_8723D 0x00BC ++#define REG_PMC_DBG_CTRL2_8723D 0x00CC ++#define REG_EFUSE_BURN_GNT_8723D 0x00CF ++#define REG_XTAL_AAC_8723D 0x00EC ++#define REG_SYS_CFG1_8723D 0x00F0 ++#define REG_SYS_CFG2_8723D 0x00FC ++#define REG_ROM_VERSION 0x00FD ++ ++//----------------------------------------------------- ++// ++// 0x0100h ~ 0x01FFh MACTOP General Configuration ++// ++//----------------------------------------------------- ++#define REG_CR_8723D 0x0100 ++#define REG_PBP_8723D 0x0104 // ?????? ++#define REG_PKT_BUFF_ACCESS_CTRL_8723D 0x0106 // ?????? ++#define REG_TRXDMA_CTRL_8723D 0x010C ++#define REG_TRXFF_BNDY_8723D 0x0114 ++#define REG_RXFF_PTR_8723D 0x011C ++#define REG_CPWM_8723D 0x012C ++#define REG_FWIMR_8723D 0x0130 ++#define REG_FWISR_8723D 0x0134 ++#define REG_FTIMR_8723D 0x0138 ++#define REG_PKTBUF_DBG_CTRL_8723D 0x0140 ++#define REG_RXPKTBUF_CTRL_8723D 0x0142 // ?????? ++#define REG_PKTBUF_DBG_DATA_L_8723D 0x0144 ++#define REG_PKTBUF_DBG_DATA_H_8723D 0x0148 ++ ++#define REG_TC0_CTRL_8723D 0x0150 ++#define REG_TC1_CTRL_8723D 0x0154 ++#define REG_TC2_CTRL_8723D 0x0158 ++#define REG_TC3_CTRL_8723D 0x015C ++#define REG_TC4_CTRL_8723D 0x0160 ++#define REG_TCUNIT_BASE_8723D 0x0164 ++#define REG_RSVD3_8723D 0x0168 // ????? ++ ++#define REG_C2HEVT_MSG_NORMAL_8723D 0x01A0 // ?????? ++#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 // ?????? ++#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 // ?????? ++#define REG_C2HEVT_CMD_LEN_88XX 0x01AE // ?????? ++#define REG_C2HEVT_CLEAR_8723D 0x01AF // ?????? ++#define REG_MCUTST_1_8723D 0x01C0 ++#define REG_MCUTST_2_8723D 0x01C4 ++#define REG_MCUTST_WOWLAN_8723D 0x01C7 // ?????? ++#define REG_FMETHR_8723D 0x01C8 ++#define REG_HMETFR_8723D 0x01CC ++#define REG_HMEBOX_0_8723D 0x01D0 ++#define REG_HMEBOX_1_8723D 0x01D4 ++#define REG_HMEBOX_2_8723D 0x01D8 ++#define REG_HMEBOX_3_8723D 0x01DC ++#define REG_LLT_INIT_8723D 0x01E0 ++#define REG_HMEBOX_EXT0_8723D 0x01F0 // ?????? ++#define REG_HMEBOX_EXT1_8723D 0x01F4 // ?????? ++#define REG_HMEBOX_EXT2_8723D 0x01F8 // ?????? ++#define REG_HMEBOX_EXT3_8723D 0x01FC // ?????? ++ ++//----------------------------------------------------- ++// ++// 0x0200h ~ 0x027Fh TXDMA Configuration ++// ++//----------------------------------------------------- ++#define REG_RQPN_8723D 0x0200 ++#define REG_FIFOPAGE_8723D 0x0204 ++#define REG_TDECTRL_8723D 0x0208 ++#define REG_TXDMA_OFFSET_CHK_8723D 0x020C ++#define REG_TXDMA_STATUS_8723D 0x0210 ++#define REG_RQPN_NPQ_8723D 0x0214 ++#define REG_AUTO_LLT_8723D 0x0224 ++#define REG_DWBCN1_CTRL_8723D 0x0228 ++ ++ ++//----------------------------------------------------- ++// ++// 0x0280h ~ 0x02FFh RXDMA Configuration ++// ++//----------------------------------------------------- ++#define REG_RXDMA_AGG_PG_TH_8723D 0x0280 ++#define REG_RXPKT_NUM_8723D 0x0284 // The number of packets in RXPKTBUF. ++#define REG_RXDMA_CONTROL_8723D 0x0286 // ?????? Control the RX DMA. ++#define REG_RXDMA_STATUS_8723D 0x0288 ++#define REG_RXDMA_PRO_8723D 0x0290 // ?????? ++#define REG_EARLY_MODE_CONTROL_8723D 0x02BC // ?????? ++#define REG_RSVD5_8723D 0x02F0 // ?????? ++ ++ ++//----------------------------------------------------- ++// ++// 0x0300h ~ 0x03FFh PCIe ++// ++//----------------------------------------------------- ++#define REG_PCIE_CTRL_REG_8723D 0x0300 ++#define REG_INT_MIG_8723D 0x0304 // Interrupt Migration ++#define REG_BCNQ_TXBD_DESA_8723D 0x0308 // TX Beacon Descriptor Address ++#define REG_MGQ_TXBD_DESA_8723D 0x0310 // TX Manage Queue Descriptor Address ++#define REG_VOQ_TXBD_DESA_8723D 0x0318 // TX VO Queue Descriptor Address ++#define REG_VIQ_TXBD_DESA_8723D 0x0320 // TX VI Queue Descriptor Address ++#define REG_BEQ_TXBD_DESA_8723D 0x0328 // TX BE Queue Descriptor Address ++#define REG_BKQ_TXBD_DESA_8723D 0x0330 // TX BK Queue Descriptor Address ++#define REG_RXQ_RXBD_DESA_8723D 0x0338 // RX Queue Descriptor Address ++#define REG_HI0Q_TXBD_DESA_8723D 0x0340 ++#define REG_HI1Q_TXBD_DESA_8723D 0x0348 ++#define REG_HI2Q_TXBD_DESA_8723D 0x0350 ++#define REG_HI3Q_TXBD_DESA_8723D 0x0358 ++#define REG_HI4Q_TXBD_DESA_8723D 0x0360 ++#define REG_HI5Q_TXBD_DESA_8723D 0x0368 ++#define REG_HI6Q_TXBD_DESA_8723D 0x0370 ++#define REG_HI7Q_TXBD_DESA_8723D 0x0378 ++#define REG_MGQ_TXBD_NUM_8723D 0x0380 ++#define REG_RX_RXBD_NUM_8723D 0x0382 ++#define REG_VOQ_TXBD_NUM_8723D 0x0384 ++#define REG_VIQ_TXBD_NUM_8723D 0x0386 ++#define REG_BEQ_TXBD_NUM_8723D 0x0388 ++#define REG_BKQ_TXBD_NUM_8723D 0x038A ++#define REG_HI0Q_TXBD_NUM_8723D 0x038C ++#define REG_HI1Q_TXBD_NUM_8723D 0x038E ++#define REG_HI2Q_TXBD_NUM_8723D 0x0390 ++#define REG_HI3Q_TXBD_NUM_8723D 0x0392 ++#define REG_HI4Q_TXBD_NUM_8723D 0x0394 ++#define REG_HI5Q_TXBD_NUM_8723D 0x0396 ++#define REG_HI6Q_TXBD_NUM_8723D 0x0398 ++#define REG_HI7Q_TXBD_NUM_8723D 0x039A ++#define REG_TSFTIMER_HCI_8723D 0x039C ++ ++//Read Write Point ++#define REG_VOQ_TXBD_IDX_8723D 0x03A0 ++#define REG_VIQ_TXBD_IDX_8723D 0x03A4 ++#define REG_BEQ_TXBD_IDX_8723D 0x03A8 ++#define REG_BKQ_TXBD_IDX_8723D 0x03AC ++#define REG_MGQ_TXBD_IDX_8723D 0x03B0 ++#define REG_RXQ_TXBD_IDX_8723D 0x03B4 ++#define REG_HI0Q_TXBD_IDX_8723D 0x03B8 ++#define REG_HI1Q_TXBD_IDX_8723D 0x03BC ++#define REG_HI2Q_TXBD_IDX_8723D 0x03C0 ++#define REG_HI3Q_TXBD_IDX_8723D 0x03C4 ++#define REG_HI4Q_TXBD_IDX_8723D 0x03C8 ++#define REG_HI5Q_TXBD_IDX_8723D 0x03CC ++#define REG_HI6Q_TXBD_IDX_8723D 0x03D0 ++#define REG_HI7Q_TXBD_IDX_8723D 0x03D4 ++ ++#define REG_PCIE_HCPWM_8723DE 0x03D8 // ?????? ++#define REG_PCIE_HRPWM_8723DE 0x03DC //PCIe RPWM // ?????? ++#define REG_DBI_WDATA_V1_8723D 0x03E8 ++#define REG_DBI_RDATA_V1_8723D 0x03EC ++#define REG_DBI_FLAG_V1_8723D 0x03F0 ++#define REG_MDIO_V1_8723D 0x03F4 ++#define REG_PCIE_MIX_CFG_8723D 0x03F8 ++#define REG_HCI_MIX_CFG_8723D 0x03FC ++ ++//----------------------------------------------------- ++// ++// 0x0400h ~ 0x047Fh Protocol Configuration ++// ++//----------------------------------------------------- ++#define REG_TXPKT_EMPTY_8723D 0x041A ++#define REG_PTCL_POLL_MGN_8723D 0x041F ++#define REG_FWHW_TXQ_CTRL_8723D 0x0420 ++#define REG_HWSEQ_CTRL_8723D 0x0423 ++#define REG_BCNQ_BDNY_8723D 0x0424 ++#define REG_MGQ_BDNY_8723D 0x0425 ++#define REG_LIFETIME_EN_8723D 0x0426 ++#define REG_FW_FREE_TAIL_8723D 0x0427 ++#define REG_SPEC_SIFS_8723D 0x0428 ++#define REG_RETRY_LIMIT_8723D 0x042A ++#define REG_TXBF_CTRL_8723D 0x042C ++#define REG_DARFRC_8723D 0x0430 ++#define REG_RARFRC_8723D 0x0438 ++#define REG_RRSR_8723D 0x0440 ++#define REG_ARFR0_8723D 0x0444 ++#define REG_ARFR1_8723D 0x044C ++#define REG_CCK_CHECK_8723D 0x0454 ++#define REG_BCNQ2_BDNY_8723D 0x0455 ++#define REG_AMPDU_MAX_TIME_8723D 0x0456 ++#define REG_BCNQ1_BDNY_8723D 0x0457 ++#define REG_AMPDU_MAX_LENGTH_8723D 0x0458 ++#define REG_WMAC_LBK_BUF_HD_8723D 0x045D ++#define REG_NDPA_OPT_CTRL_8723D 0x045F ++#define REG_FAST_EDCA_CTRL_8723D 0x0460 ++#define REG_RD_RESP_PKT_TH_8723D 0x0463 ++#define REG_DATA_SC_8723D 0x0483 ++#define REG_TXRPT_START_OFFSET 0x04AC ++#define REG_POWER_STAGE1_8723D 0x04B4 ++#define REG_PTCL_SDF_STATUS_8723D 0x04BB ++#define REG_SW_AMPDU_BURST_MODE_CTRL_8723D 0x04BC ++#define REG_EVTQ_BNDY_8723D 0x04BF ++#define REG_PKT_LIFE_TIME_8723D 0x04C0 ++#define REG_PKT_BE_BK_LIFE_TIME_8723D 0x04C2 // ?????? ++ ++#define REG_STBC_SETTING_8723D 0x04C4 ++#define REG_HT_SINGLE_AMPDU_8723D 0x04C7 ++#define REG_PROT_MODE_CTRL_8723D 0x04C8 ++#define REG_MAX_AGGR_NUM_8723D 0x04CA ++#define REG_RTS_MAX_AGGR_NUM_8723D 0x04CB ++#define REG_BAR_MODE_CTRL_8723D 0x04CC ++#define REG_RA_TRY_RATE_AGG_LMT_8723D 0x04CF ++#define REG_MACID_SLEEP2_8723D 0x04D0 ++#define REG_PTCL_HWSSN0_8723D 0x04D8 ++#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8723D 0x045D // ?????? ++ ++ ++/************* 0x1480~0x14A7 is for NAN ***************/ ++//Own Master Rank, 8Bytes ++#define REG_NAN_INTERFACE_ADDR_8723D 0x2480 // 6 bytes ++#define REG_NAN_RANDOM_FACTOR_8723D 0x2486 // 1 byte ++#define REG_NAN_MASTER_PREF_8723D 0x2487 // 1 byte ++ ++//0x5dc[25:24] NAN role ++ ++//Current Anchor Master Record ++#define REG_NAN_CAMR_L_8723D 0x2488 // 4 bytes ++#define REG_NAN_CAMR_H_8723D 0x248C // 4 byte ++//#define REG_HOP_CNT_8723D 0x05DC ++#define REG_NAN_CAMR_AMBTT_8723D 0x2490 // 4 bytes ++ ++//Last Anchor Master Record ++#define REG_NAN_LAMR_L_8723D 0x2494 // 4 bytes ++#define REG_NAN_LAMR_H_8723D 0x2498 // 4 byte ++#define REG_NAN_LAMR_AMBTT_8723D 0x249C // 4 bytes ++ ++//TSF Synced:bit 0 ++//Anchor Master: bit 7 ++#define REG_NAN_STATUS_8723D 0x24A0 //BIT0 ++/***************************************************/ ++ ++ ++//----------------------------------------------------- ++// ++// 0x0500h ~ 0x05FFh EDCA Configuration ++// ++//----------------------------------------------------- ++// gogogo ++#define REG_EDCA_VO_PARAM_8723D 0x0500 ++#define REG_EDCA_VI_PARAM_8723D 0x0504 ++#define REG_EDCA_BE_PARAM_8723D 0x0508 ++#define REG_EDCA_BK_PARAM_8723D 0x050C ++#define REG_BCNTCFG_8723D 0x0510 ++#define REG_PIFS_8723D 0x0512 ++#define REG_RDG_PIFS_8723D 0x0513 ++#define REG_SIFS_CTX_8723D 0x0514 ++#define REG_SIFS_TRX_8723D 0x0516 ++#define REG_AGGR_BREAK_TIME_8723D 0x051A ++#define REG_SLOT_8723D 0x051B ++#define REG_TX_PTCL_CTRL_8723D 0x0520 ++#define REG_TXPAUSE_8723D 0x0522 ++#define REG_DIS_TXREQ_CLR_8723D 0x0523 ++#define REG_RD_CTRL_8723D 0x0524 ++// ++// Format for offset 540h-542h: ++// [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. ++// [7:4]: Reserved. ++// [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. ++// [23:20]: Reserved ++// Description: ++// | ++// |<--Setup--|--Hold------------>| ++// --------------|---------------------- ++// | ++// TBTT ++// Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. ++// Described by Designer Tim and Bruce, 2011-01-14. ++// ++#define REG_TBTT_PROHIBIT_8723D 0x0540 ++#define REG_RD_NAV_NXT_8723D 0x0544 ++#define REG_NAV_PROT_LEN_8723D 0x0546 ++#define REG_BCN_CTRL_8723D 0x0550 ++#define REG_EDCA_BCNCTRL1_IOREG_8723D 0x0551 ++#define REG_MBID_NUM_8723D 0x0552 ++#define REG_DUAL_TSF_RST_8723D 0x0553 ++#define REG_BCN_INTERVAL_8723D 0x0554 ++#define REG_DRVERLYINT_8723D 0x0558 ++#define REG_BCNDMATIM_8723D 0x0559 ++#define REG_ATIMWND_8723D 0x055A ++#define REG_USTIME_TSF_8723D 0x055C ++#define REG_BCN_MAX_ERR_8723D 0x055D ++#define REG_RXTSF_OFFSET_CCK_8723D 0x055E ++#define REG_RXTSF_OFFSET_OFDM_8723D 0x055F ++#define REG_TSFTR_8723D 0x0560 ++#define REG_CTWND_8723D 0x0572 ++#define REG_SECONDARY_CCA_CTRL_8723D 0x0577 // ?????? ++#define REG_TSFTR2_8723D 0x0578 ++#define REG_PSTIMER_8723D 0x0580 ++#define REG_TIMER0_8723D 0x0584 ++#define REG_TIMER1_8723D 0x0588 ++#define REG_SCH_MULTI_BCN_8723D 0x05B2 ++#define REG_SCH_CURRENT_BCN_8723D 0x05B3 ++#define REG_ACMHWCTRL_8723D 0x05C0 ++#define REG_SCH_SDFX_EARLY_8723D 0x05CF ++#define REG_SCH_PORT2_EARLY_8723D 0x05D0 ++#define REG_SCH_TSFT_DIFF_8723D 0x05D2 ++#define REG_EDCA_BCNCTRL2_IOREG_8723D 0x05D4 ++#define REG_EDCA_DRVERLYINT1_IOREG_8723D 0x05D4 ++#define REG_EDCA_BCNSPACE3_IOREG_8723D 0x05D8 ++#define REG_EDCA_BCNSPACE4_IOREG_8723D 0x05DA ++#define REG_HOP_CNT_8723D 0x05DC ++#define REG_SCH_M_DW_8723D 0x05DD ++#define REG_SCH_M_SLOT_8723D 0x05DE ++#define REG_SCH_EARLY_DWEND_8723D 0x05DF ++#define REG_SCH_TXCMD_8723D 0x05F8 ++ ++//----------------------------------------------------- ++// ++// 0x0600h ~ 0x07FFh WMAC Configuration ++// ++//----------------------------------------------------- ++// gogogo ++#define REG_MAC_CR_8723D 0x0600 ++#define REG_TCR_8723D 0x0604 ++#define REG_RCR_8723D 0x0608 ++#define REG_RX_PKT_LIMIT_8723D 0x060C ++#define REG_RX_DLK_TIME_8723D 0x060D ++#define REG_RX_DRVINFO_SZ_8723D 0x060F ++ ++#define REG_MACID_8723D 0x0610 ++#define REG_BSSID_8723D 0x0618 ++#define REG_MAR_8723D 0x0620 ++#define REG_MBIDCAMCFG_8723D 0x0628 ++ ++#define REG_USTIME_EDCA_8723D 0x0638 ++#define REG_MAC_SPEC_SIFS_8723D 0x063A ++#define REG_RESP_SIFP_CCK_8723D 0x063C ++#define REG_RESP_SIFS_OFDM_8723D 0x063E ++#define REG_ACKTO_8723D 0x0640 ++#define REG_CTS2TO_8723D 0x0641 ++#define REG_EIFS_8723D 0x0642 ++ ++#define REG_NAV_UPPER_8723D 0x0652 // ?????? ++#define REG_TRXPTCL_CTL_8723D 0x0668 ++ ++// Security ++#define REG_CAMCMD_8723D 0x0670 ++#define REG_CAMWRITE_8723D 0x0674 ++#define REG_CAMREAD_8723D 0x0678 ++#define REG_CAMDBG_8723D 0x067C ++#define REG_SECCFG_8723D 0x0680 ++ ++// Power ++#define REG_WOW_CTRL_8723D 0x0690 ++#define REG_PS_RX_INFO_8723D 0x0692 ++#define REG_UAPSD_TID_8723D 0x0693 ++#define REG_WKFMCAM_NUM_8723D 0x0698 ++#define REG_RXFLTMAP0_8723D 0x06A0 ++#define REG_RXFLTMAP1_8723D 0x06A2 ++#define REG_RXFLTMAP2_8723D 0x06A4 ++#define REG_BCN_PSR_RPT_8723D 0x06A8 ++#define REG_BT_COEX_TABLE_8723D 0x06C0 ++#define REG_ASSOCIATED_BFMER0_INFO_8723D 0x06E4 ++#define REG_ASSOCIATED_BFMER1_INFO_8723D 0x06EC ++#define REG_CSI_RPT_PARAM_BW20_8723D 0x06F4 ++#define REG_CSI_RPT_PARAM_BW40_8723D 0x06F8 ++#define REG_CSI_RPT_PARAM_BW80_8723D 0x06FC ++ ++// Hardware Port 2 ++#define REG_MACID1_8723D 0x0700 ++#define REG_BSSID1_8723D 0x0708 ++#define REG_ASSOCIATED_BFMEE_SEL_8723D 0x0714 ++#define REG_SND_PTCL_CTRL_8723D 0x0718 ++ ++#define REG_LTR_CTRL_BASIC_8723D 0x07A4 ++#define REG_LTR_IDLE_LATENCY_V1_8723D 0x0798 ++#define REG_LTR_ACTIVE_LATENCY_V1_8723D 0x079C ++ ++ ++//----------------------------------------------------- ++// ++// Redifine 8192C register definition for compatibility ++// ++//----------------------------------------------------- ++ ++// TODO: use these definition when using REG_xxx naming rule. ++// NOTE: DO NOT Remove these definition. Use later. ++#define EFUSE_CTRL_8723D REG_EFUSE_CTRL_8723D // E-Fuse Control. ++#define EFUSE_TEST_8723D REG_LDO_EFUSE_CTRL_8723D // E-Fuse Test. ++#define MSR_8723D (REG_CR_8723D + 2) // Media Status register ++#define ISR_8723D REG_HISR0_8723D ++#define TSFR_8723D REG_TSFTR_8723D // Timing Sync Function Timer Register. ++ ++// Redifine MACID register, to compatible prior ICs. ++#define IDR0_8723D REG_MACID_8723D // MAC ID Register, Offset 0x0050-0x0053 ++#define IDR4_8723D (REG_MACID_8723D + 4) // MAC ID Register, Offset 0x0054-0x0055 ++ ++ ++// ++// 9. Security Control Registers (Offset: ) ++// ++#define RWCAM_8723D REG_CAMCMD_8723D //IN 8190 Data Sheet is called CAMcmd ++#define WCAMI_8723D REG_CAMWRITE_8723D // Software write CAM input content ++#define RCAMO_8723D REG_CAMREAD_8723D // Software read/write CAM config ++#define CAMDBG_8723D REG_CAMDBG_8723D ++#define SECR_8723D REG_SECCFG_8723D //Security Configuration Register ++ ++ ++//---------------------------------------------------------------------------- ++// 8195 IMR/ISR bits (offset 0xB0, 8bits) ++//---------------------------------------------------------------------------- ++#define IMR_DISABLED_8723D 0 ++// IMR DW0(0x00B0-00B3) Bit 0-31 ++#define IMR_TIMER2_8723D BIT31 // Timeout interrupt 2 ++#define IMR_TIMER1_8723D BIT30 // Timeout interrupt 1 ++#define IMR_PSTIMEOUT_8723D BIT29 // Power Save Time Out Interrupt ++#define IMR_GTINT4_8723D BIT28 // When GTIMER4 expires, this bit is set to 1 ++#define IMR_GTINT3_8723D BIT27 // When GTIMER3 expires, this bit is set to 1 ++#define IMR_TXBCN0ERR_8723D BIT26 // Transmit Beacon0 Error ++#define IMR_TXBCN0OK_8723D BIT25 // Transmit Beacon0 OK ++#define IMR_TSF_BIT32_TOGGLE_8723D BIT24 // TSF Timer BIT32 toggle indication interrupt ++#define IMR_BCNDMAINT0_8723D BIT20 // Beacon DMA Interrupt 0 ++#define IMR_BCNDERR0_8723D BIT16 // Beacon Queue DMA OK0 ++#define IMR_HSISR_IND_ON_INT_8723D BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) ++#define IMR_BCNDMAINT_E_8723D BIT14 // Beacon DMA Interrupt Extension for Win7 ++#define IMR_ATIMEND_8723D BIT12 // CTWidnow End or ATIM Window End ++#define IMR_C2HCMD_8723D BIT10 // CPU to Host Command INT Status, Write 1 clear ++#define IMR_CPWM2_8723D BIT9 // CPU power Mode exchange INT Status, Write 1 clear ++#define IMR_CPWM_8723D BIT8 // CPU power Mode exchange INT Status, Write 1 clear ++#define IMR_HIGHDOK_8723D BIT7 // High Queue DMA OK ++#define IMR_MGNTDOK_8723D BIT6 // Management Queue DMA OK ++#define IMR_BKDOK_8723D BIT5 // AC_BK DMA OK ++#define IMR_BEDOK_8723D BIT4 // AC_BE DMA OK ++#define IMR_VIDOK_8723D BIT3 // AC_VI DMA OK ++#define IMR_VODOK_8723D BIT2 // AC_VO DMA OK ++#define IMR_RDU_8723D BIT1 // Rx Descriptor Unavailable ++#define IMR_ROK_8723D BIT0 // Receive DMA OK ++ ++// IMR DW1(0x00B4-00B7) Bit 0-31 ++#define IMR_BCNDMAINT7_8723D BIT27 // Beacon DMA Interrupt 7 ++#define IMR_BCNDMAINT6_8723D BIT26 // Beacon DMA Interrupt 6 ++#define IMR_BCNDMAINT5_8723D BIT25 // Beacon DMA Interrupt 5 ++#define IMR_BCNDMAINT4_8723D BIT24 // Beacon DMA Interrupt 4 ++#define IMR_BCNDMAINT3_8723D BIT23 // Beacon DMA Interrupt 3 ++#define IMR_BCNDMAINT2_8723D BIT22 // Beacon DMA Interrupt 2 ++#define IMR_BCNDMAINT1_8723D BIT21 // Beacon DMA Interrupt 1 ++#define IMR_BCNDOK7_8723D BIT20 // Beacon Queue DMA OK Interrup 7 ++#define IMR_BCNDOK6_8723D BIT19 // Beacon Queue DMA OK Interrup 6 ++#define IMR_BCNDOK5_8723D BIT18 // Beacon Queue DMA OK Interrup 5 ++#define IMR_BCNDOK4_8723D BIT17 // Beacon Queue DMA OK Interrup 4 ++#define IMR_BCNDOK3_8723D BIT16 // Beacon Queue DMA OK Interrup 3 ++#define IMR_BCNDOK2_8723D BIT15 // Beacon Queue DMA OK Interrup 2 ++#define IMR_BCNDOK1_8723D BIT14 // Beacon Queue DMA OK Interrup 1 ++#define IMR_ATIMEND_E_8723D BIT13 // ATIM Window End Extension for Win7 ++#define IMR_TXERR_8723D BIT11 // Tx Error Flag Interrupt Status, write 1 clear. ++#define IMR_RXERR_8723D BIT10 // Rx Error Flag INT Status, Write 1 clear ++#define IMR_TXFOVW_8723D BIT9 // Transmit FIFO Overflow ++#define IMR_RXFOVW_8723D BIT8 // Receive FIFO Overflow ++ ++ ++ ++#define IMR_MCUERR_8723D BIT28 // Beacon DMA Interrupt 7 ++ ++ ++/*=================================================================== ++===================================================================== ++Here the register defines are for 92C. When the define is as same with 92C, ++we will use the 92C's define for the consistency ++So the following defines for 92C is not entire!!!!!! ++===================================================================== ++=====================================================================*/ ++/* ++Based on Datasheet V33---090401 ++Register Summary ++Current IOREG MAP ++0x0000h ~ 0x00FFh System Configuration (256 Bytes) ++0x0100h ~ 0x01FFh MACTOP General Configuration (256 Bytes) ++0x0200h ~ 0x027Fh TXDMA Configuration (128 Bytes) ++0x0280h ~ 0x02FFh RXDMA Configuration (128 Bytes) ++0x0300h ~ 0x03FFh PCIE EMAC Reserved Region (256 Bytes) ++0x0400h ~ 0x04FFh Protocol Configuration (256 Bytes) ++0x0500h ~ 0x05FFh EDCA Configuration (256 Bytes) ++0x0600h ~ 0x07FFh WMAC Configuration (512 Bytes) ++0x2000h ~ 0x3FFFh 8051 FW Download Region (8196 Bytes) ++*/ ++//---------------------------------------------------------------------------- ++// 8195 (TXPAUSE) transmission pause (Offset 0x522, 8 bits) ++//---------------------------------------------------------------------------- ++/* ++#define StopBecon BIT6 ++#define StopHigh BIT5 ++#define StopMgt BIT4 ++#define StopVO BIT3 ++#define StopVI BIT2 ++#define StopBE BIT1 ++#define StopBK BIT0 ++*/ ++ ++ ++ ++//============================================================================ ++// 8192C Regsiter Bit and Content definition ++//============================================================================ ++//----------------------------------------------------- ++// ++// 0x0000h ~ 0x00FFh System Configuration ++// ++//----------------------------------------------------- ++/* ++//2 SYS_ISO_CTRL ++#define ISO_MD2PP BIT(0) ++#define ISO_UA2USB BIT(1) ++#define ISO_UD2CORE BIT(2) ++#define ISO_PA2PCIE BIT(3) ++#define ISO_PD2CORE BIT(4) ++#define ISO_IP2MAC BIT(5) ++#define ISO_DIOP BIT(6) ++#define ISO_DIOE BIT(7) ++#define ISO_EB2CORE BIT(8) ++#define ISO_DIOR BIT(9) ++#define PWC_EV12V BIT(15) ++ ++ ++//2 SYS_FUNC_EN ++#define FEN_BBRSTB BIT(0) ++#define FEN_BB_GLB_RSTn BIT(1) ++#define FEN_USBA BIT(2) ++#define FEN_UPLL BIT(3) ++#define FEN_USBD BIT(4) ++#define FEN_DIO_PCIE BIT(5) ++#define FEN_PCIEA BIT(6) ++#define FEN_PPLL BIT(7) ++#define FEN_PCIED BIT(8) ++#define FEN_DIOE BIT(9) ++#define FEN_CPUEN BIT(10) ++#define FEN_DCORE BIT(11) ++#define FEN_ELDR BIT(12) ++#define FEN_DIO_RF BIT(13) ++#define FEN_HWPDN BIT(14) ++#define FEN_MREGEN BIT(15) ++ ++//2 APS_FSMCO ++#define PFM_LDALL BIT(0) ++#define PFM_ALDN BIT(1) ++#define PFM_LDKP BIT(2) ++#define PFM_WOWL BIT(3) ++#define EnPDN BIT(4) ++#define PDN_PL BIT(5) ++#define APFM_ONMAC BIT(8) ++#define APFM_OFF BIT(9) ++#define APFM_RSM BIT(10) ++#define AFSM_HSUS BIT(11) ++#define AFSM_PCIE BIT(12) ++#define APDM_MAC BIT(13) ++#define APDM_HOST BIT(14) ++#define APDM_HPDN BIT(15) ++#define RDY_MACON BIT(16) ++#define SUS_HOST BIT(17) ++#define ROP_ALD BIT(20) ++#define ROP_PWR BIT(21) ++#define ROP_SPS BIT(22) ++#define SOP_MRST BIT(25) ++#define SOP_FUSE BIT(26) ++#define SOP_ABG BIT(27) ++#define SOP_AMB BIT(28) ++#define SOP_RCK BIT(29) ++#define SOP_A8M BIT(30) ++#define XOP_BTCK BIT(31) ++ ++//2 SYS_CLKR ++#define ANAD16V_EN BIT(0) ++#define ANA8M BIT(1) ++#define MACSLP BIT(4) ++#define LOADER_CLK_EN BIT(5) ++ ++ ++//2 9346CR ++ ++#define BOOT_FROM_EEPROM BIT(4) ++#define EEPROM_EN BIT(5) ++ ++ ++//2 RF_CTRL ++#define RF_EN BIT(0) ++#define RF_RSTB BIT(1) ++#define RF_SDMRSTB BIT(2) ++ ++//2 LDOV12D_CTRL ++#define LDV12_EN BIT(0) ++#define LDV12_SDBY BIT(1) ++#define LPLDO_HSM BIT(2) ++#define LPLDO_LSM_DIS BIT(3) ++#define _LDV12_VADJ(x) (((x) & 0xF) << 4) ++ ++ ++//2 EFUSE_TEST (For RTL8723 partially) ++#define EF_TRPT BIT(7) ++#define EF_CELL_SEL (BIT(8)|BIT(9)) // 00: Wifi Efuse, 01: BT Efuse0, 10: BT Efuse1, 11: BT Efuse2 ++#define LDOE25_EN BIT(31) ++#define EFUSE_SEL(x) (((x) & 0x3) << 8) ++#define EFUSE_SEL_MASK 0x300 ++#define EFUSE_WIFI_SEL_0 0x0 ++#define EFUSE_BT_SEL_0 0x1 ++#define EFUSE_BT_SEL_1 0x2 ++#define EFUSE_BT_SEL_2 0x3 ++ ++ ++//2 8051FWDL ++//2 MCUFWDL ++#define MCUFWDL_EN BIT(0) ++#define MCUFWDL_RDY BIT(1) ++#define FWDL_ChkSum_rpt BIT(2) ++#define MACINI_RDY BIT(3) ++#define BBINI_RDY BIT(4) ++#define RFINI_RDY BIT(5) ++#define WINTINI_RDY BIT(6) ++#define RAM_DL_SEL BIT(7) ++#define ROM_DLEN BIT(19) ++#define CPRST BIT(23) ++ ++ ++ ++//2 REG_SYS_CFG ++#define XCLK_VLD BIT(0) ++#define ACLK_VLD BIT(1) ++#define UCLK_VLD BIT(2) ++#define PCLK_VLD BIT(3) ++#define PCIRSTB BIT(4) ++#define V15_VLD BIT(5) ++#define TRP_B15V_EN BIT(7) ++#define SIC_IDLE BIT(8) ++#define BD_MAC2 BIT(9) ++#define BD_MAC1 BIT(10) ++#define IC_MACPHY_MODE BIT(11) ++#define CHIP_VER (BIT(12)|BIT(13)|BIT(14)|BIT(15)) ++#define BT_FUNC BIT(16) ++#define VENDOR_ID BIT(19) ++#define PAD_HWPD_IDN BIT(22) ++#define TRP_VAUX_EN BIT(23) // RTL ID ++#define TRP_BT_EN BIT(24) ++#define BD_PKG_SEL BIT(25) ++#define BD_HCI_SEL BIT(26) ++#define TYPE_ID BIT(27) ++ ++#define CHIP_VER_RTL_MASK 0xF000 //Bit 12 ~ 15 ++#define CHIP_VER_RTL_SHIFT 12 ++ ++*/ ++//----------------------------------------------------- ++// ++// 0x0100h ~ 0x01FFh MACTOP General Configuration ++// ++//----------------------------------------------------- ++/* ++ ++//2 Function Enable Registers ++//2 CR 0x0100-0x0103 ++ ++ ++#define HCI_TXDMA_EN BIT(0) ++#define HCI_RXDMA_EN BIT(1) ++#define TXDMA_EN BIT(2) ++#define RXDMA_EN BIT(3) ++#define PROTOCOL_EN BIT(4) ++#define SCHEDULE_EN BIT(5) ++#define MACTXEN BIT(6) ++#define MACRXEN BIT(7) ++#define ENSWBCN BIT(8) ++#define ENSEC BIT(9) ++#define CALTMR_EN BIT(10) // 32k CAL TMR enable ++ ++// Network type ++#define _NETTYPE(x) (((x) & 0x3) << 16) ++#define MASK_NETTYPE 0x30000 ++#define NT_NO_LINK 0x0 ++#define NT_LINK_AD_HOC 0x1 ++#define NT_LINK_AP 0x2 ++#define NT_AS_AP 0x3 ++ ++ ++//2 PBP - Page Size Register 0x0104 ++#define GET_RX_PAGE_SIZE(value) ((value) & 0xF) ++#define GET_TX_PAGE_SIZE(value) (((value) & 0xF0) >> 4) ++#define _PSRX_MASK 0xF ++#define _PSTX_MASK 0xF0 ++#define _PSRX(x) (x) ++#define _PSTX(x) ((x) << 4) ++ ++#define PBP_64 0x0 ++#define PBP_128 0x1 ++#define PBP_256 0x2 ++#define PBP_512 0x3 ++#define PBP_1024 0x4 ++ ++ ++//2 TX/RXDMA 0x010C ++#define RXDMA_ARBBW_EN BIT(0) ++#define RXSHFT_EN BIT(1) ++#define RXDMA_AGG_EN BIT(2) ++#define QS_VO_QUEUE BIT(8) ++#define QS_VI_QUEUE BIT(9) ++#define QS_BE_QUEUE BIT(10) ++#define QS_BK_QUEUE BIT(11) ++#define QS_MANAGER_QUEUE BIT(12) ++#define QS_HIGH_QUEUE BIT(13) ++ ++#define HQSEL_VOQ BIT(0) ++#define HQSEL_VIQ BIT(1) ++#define HQSEL_BEQ BIT(2) ++#define HQSEL_BKQ BIT(3) ++#define HQSEL_MGTQ BIT(4) ++#define HQSEL_HIQ BIT(5) ++ ++// For normal driver, 0x10C ++#define _TXDMA_HIQ_MAP(x) (((x)&0x3) << 14) ++#define _TXDMA_MGQ_MAP(x) (((x)&0x3) << 12) ++#define _TXDMA_BKQ_MAP(x) (((x)&0x3) << 10) ++#define _TXDMA_BEQ_MAP(x) (((x)&0x3) << 8 ) ++#define _TXDMA_VIQ_MAP(x) (((x)&0x3) << 6 ) ++#define _TXDMA_VOQ_MAP(x) (((x)&0x3) << 4 ) ++ ++#define QUEUE_LOW 1 ++#define QUEUE_NORMAL 2 ++#define QUEUE_HIGH 3 ++ ++ ++//2 REG_C2HEVT_CLEAR 0x01AF ++#define C2H_EVT_HOST_CLOSE 0x00 // Set by driver and notify FW that the driver has read the C2H command message ++#define C2H_EVT_FW_CLOSE 0xFF // Set by FW indicating that FW had set the C2H command message and it's not yet read by driver. ++ ++ ++ ++//2 LLT_INIT 0x01E0 ++#define _LLT_NO_ACTIVE 0x0 ++#define _LLT_WRITE_ACCESS 0x1 ++#define _LLT_READ_ACCESS 0x2 ++ ++#define _LLT_INIT_DATA(x) ((x) & 0xFF) ++#define _LLT_INIT_ADDR(x) (((x) & 0xFF) << 8) ++#define _LLT_OP(x) (((x) & 0x3) << 30) ++#define _LLT_OP_VALUE(x) (((x) >> 30) & 0x3) ++ ++*/ ++//----------------------------------------------------- ++// ++// 0x0200h ~ 0x027Fh TXDMA Configuration ++// ++//----------------------------------------------------- ++/* ++//2 TDECTL 0x0208 ++#define BLK_DESC_NUM_SHIFT 4 ++#define BLK_DESC_NUM_MASK 0xF ++ ++ ++//2 TXDMA_OFFSET_CHK 0x020C ++#define DROP_DATA_EN BIT(9) ++*/ ++//----------------------------------------------------- ++// ++// 0x0280h ~ 0x028Bh RX DMA Configuration ++// ++//----------------------------------------------------- ++/* ++//2 REG_RXDMA_CONTROL, 0x0286h ++ ++// Write only. When this bit is set, RXDMA will decrease RX PKT counter by one. Before ++// this bit is polled, FW shall update RXFF_RD_PTR first. This register is write pulse and auto clear. ++#define RXPKT_RELEASE_POLL BIT(0) ++// Read only. When RXMA finishes on-going DMA operation, RXMDA will report idle state in ++// this bit. FW can start releasing packets after RXDMA entering idle mode. ++#define RXDMA_IDLE BIT(1) ++// When this bit is set, RXDMA will enter this mode after on-going RXDMA packet to host ++// completed, and stop DMA packet to host. RXDMA will then report Default: 0; ++#define RW_RELEASE_EN BIT(2) ++*/ ++//----------------------------------------------------- ++// ++// 0x0400h ~ 0x047Fh Protocol Configuration ++// ++//----------------------------------------------------- ++/* ++//2 FWHW_TXQ_CTRL 0x0420 ++#define EN_AMPDU_RTY_NEW BIT(7) ++ ++ ++//2 REG_LIFECTRL_CTRL 0x0426 ++#define HAL92C_EN_PKT_LIFE_TIME_BK BIT3 ++#define HAL92C_EN_PKT_LIFE_TIME_BE BIT2 ++#define HAL92C_EN_PKT_LIFE_TIME_VI BIT1 ++#define HAL92C_EN_PKT_LIFE_TIME_VO BIT0 ++ ++#define HAL92C_MSDU_LIFE_TIME_UNIT 128 // in us, said by Tim. ++ ++ ++//2 SPEC SIFS 0x0428 ++#define _SPEC_SIFS_CCK(x) ((x) & 0xFF) ++#define _SPEC_SIFS_OFDM(x) (((x) & 0xFF) << 8) ++ ++//2 RL 0x042A ++#define RETRY_LIMIT_SHORT_SHIFT 8 ++#define RETRY_LIMIT_LONG_SHIFT 0 ++ ++#define _LRL(x) ((x) & 0x3F) ++#define _SRL(x) (((x) & 0x3F) << 8) ++*/ ++ ++//----------------------------------------------------- ++// ++// 0x0500h ~ 0x05FFh EDCA Configuration ++// ++//----------------------------------------------------- ++/* ++//2 EDCA setting 0x050C ++#define AC_PARAM_TXOP_LIMIT_OFFSET 16 ++#define AC_PARAM_ECW_MAX_OFFSET 12 ++#define AC_PARAM_ECW_MIN_OFFSET 8 ++#define AC_PARAM_AIFS_OFFSET 0 ++ ++ ++//2 BCN_CTRL 0x0550 ++#define EN_TXBCN_RPT BIT(2) ++#define EN_BCN_FUNCTION BIT(3) ++ ++//2 TxPause 0x0522 ++#define STOP_BCNQ BIT(6) ++*/ ++ ++ ++//2 ACMHWCTRL 0x05C0 ++#define AcmHw_HwEn_8723D BIT(0) ++#define AcmHw_VoqEn_8723D BIT(1) ++#define AcmHw_ViqEn_8723D BIT(2) ++#define AcmHw_BeqEn_8723D BIT(3) ++#define AcmHw_VoqStatus_8723D BIT(5) ++#define AcmHw_ViqStatus_8723D BIT(6) ++#define AcmHw_BeqStatus_8723D BIT(7) ++ ++ ++ ++//----------------------------------------------------- ++// ++// 0x0600h ~ 0x07FFh WMAC Configuration ++// ++//----------------------------------------------------- ++/* ++ ++//2 TCR 0x0604 ++#define DIS_GCLK BIT(1) ++#define PAD_SEL BIT(2) ++#define PWR_ST BIT(6) ++#define PWRBIT_OW_EN BIT(7) ++#define ACRC BIT(8) ++#define CFENDFORM BIT(9) ++#define ICV BIT(10) ++*/ ++ ++//---------------------------------------------------------------------------- ++// 8195 (RCR) Receive Configuration Register (Offset 0x608, 32 bits) ++//---------------------------------------------------------------------------- ++/* ++#define RCR_APPFCS BIT31 // WMAC append FCS after pauload ++#define RCR_APP_MIC BIT30 // MACRX will retain the MIC at the bottom of the packet. ++#define RCR_APP_ICV BIT29 // MACRX will retain the ICV at the bottom of the packet. ++#define RCR_APP_PHYST_RXFF BIT28 // HY Status is appended before RX packet in RXFF ++#define RCR_APP_BA_SSN BIT27 // SSN of previous TXBA is appended as after original RXDESC as the 4-th DW of RXDESC. ++#define RCR_RSVD_BIT26 BIT26 // Reserved ++*/ ++#define RCR_TCPOFLD_EN BIT25 // Enable TCP checksum offload ++/*#define RCR_ENMBID BIT24 // Enable Multiple BssId. Only response ACK to the packets whose DID(A1) matching to the addresses in the MBSSID CAM Entries. ++#define RCR_LSIGEN BIT23 // Enable LSIG TXOP Protection function. Search KEYCAM for each rx packet to check if LSIGEN bit is set. ++#define RCR_MFBEN BIT22 // Enable immediate MCS Feedback function. When Rx packet with MRQ = 1'b1, then search KEYCAM to find sender's MCS Feedback function and send response. ++*/ ++ ++ ++#endif // #ifndef __INC_HAL8723DREG_H +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.c 2018-02-11 21:44:27.158146254 +0200 +@@ -0,0 +1,923 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++/*Image2HeaderVersion: 2.26*/ ++#include "mp_precomp.h" ++#include "../phydm_precomp.h" ++ ++#if (RTL8723D_SUPPORT == 1) ++static BOOLEAN ++CheckPositive( ++ IN PDM_ODM_T pDM_Odm, ++ IN const u4Byte Condition1, ++ IN const u4Byte Condition2, ++ IN const u4Byte Condition3, ++ IN const u4Byte Condition4 ++) ++{ ++ u1Byte _BoardType = ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA*/ ++ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA*/ ++ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA*/ ++ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ ++ ((pDM_Odm->BoardType & BIT2) >> 2) << 4 | /* _BT*/ ++ ((pDM_Odm->BoardType & BIT1) >> 1) << 5; /* _NGFF*/ ++ ++ u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; ++ ++ u1Byte cut_version_for_para = (pDM_Odm->CutVersion == ODM_CUT_A) ? 15 : pDM_Odm->CutVersion; ++ u1Byte pkg_type_for_para = (pDM_Odm->PackageType == 0) ? 15 : pDM_Odm->PackageType; ++ ++ u4Byte driver1 = cut_version_for_para << 24 | ++ (pDM_Odm->SupportInterface & 0xF0) << 16 | ++ pDM_Odm->SupportPlatform << 16 | ++ pkg_type_for_para << 12 | ++ (pDM_Odm->SupportInterface & 0x0F) << 8 | ++ _BoardType; ++ ++ u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | ++ (pDM_Odm->TypeGPA & 0xFF) << 8 | ++ (pDM_Odm->TypeALNA & 0xFF) << 16 | ++ (pDM_Odm->TypeAPA & 0xFF) << 24; ++ ++u4Byte driver3 = 0; ++ ++ u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | ++ (pDM_Odm->TypeGPA & 0xFF00) | ++ (pDM_Odm->TypeALNA & 0xFF00) << 8 | ++ (pDM_Odm->TypeAPA & 0xFF00) << 16; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ++ ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ++ ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ++ (" (Platform, Interface) = (0x%X, 0x%X)\n", pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ++ (" (Board, Package) = (0x%X, 0x%X)\n", pDM_Odm->BoardType, pDM_Odm->PackageType)); ++ ++ ++ /*============== Value Defined Check ===============*/ ++ /*QFN Type [15:12] and Cut Version [27:24] need to do value check*/ ++ ++ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) ++ return FALSE; ++ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) ++ return FALSE; ++ ++ /*=============== Bit Defined Check ================*/ ++ /* We don't care [31:28] */ ++ ++ cond1 &= 0x00FF0FFF; ++ driver1 &= 0x00FF0FFF; ++ ++ if ((cond1 & driver1) == cond1) { ++ u4Byte bitMask = 0; ++ ++ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE*/ ++ return TRUE; ++ ++ if ((cond1 & BIT0) != 0) /*GLNA*/ ++ bitMask |= 0x000000FF; ++ if ((cond1 & BIT1) != 0) /*GPA*/ ++ bitMask |= 0x0000FF00; ++ if ((cond1 & BIT2) != 0) /*ALNA*/ ++ bitMask |= 0x00FF0000; ++ if ((cond1 & BIT3) != 0) /*APA*/ ++ bitMask |= 0xFF000000; ++ ++ if (((cond2 & bitMask) == (driver2 & bitMask)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ ++ return TRUE; ++ else ++ return FALSE; ++ } else ++ return FALSE; ++} ++static BOOLEAN ++CheckNegative( ++ IN PDM_ODM_T pDM_Odm, ++ IN const u4Byte Condition1, ++ IN const u4Byte Condition2 ++) ++{ ++ return TRUE; ++} ++ ++/****************************************************************************** ++* AGC_TAB.TXT ++******************************************************************************/ ++ ++u4Byte Array_MP_8723D_AGC_TAB[] = { ++ 0xC78, 0xFE000101, ++ 0xC78, 0xFD010101, ++ 0xC78, 0xFC020101, ++ 0xC78, 0xFB030101, ++ 0xC78, 0xFA040101, ++ 0xC78, 0xF9050101, ++ 0xC78, 0xF8060101, ++ 0xC78, 0xF7070101, ++ 0xC78, 0xF6080101, ++ 0xC78, 0xF5090101, ++ 0xC78, 0xF40A0101, ++ 0xC78, 0xF30B0101, ++ 0xC78, 0xF20C0101, ++ 0xC78, 0xF10D0101, ++ 0xC78, 0xF00E0101, ++ 0xC78, 0xEF0F0101, ++ 0xC78, 0xEE100101, ++ 0xC78, 0xED110101, ++ 0xC78, 0xEC120101, ++ 0xC78, 0xEB130101, ++ 0xC78, 0xEA140101, ++ 0xC78, 0xE9150101, ++ 0xC78, 0xE8160101, ++ 0xC78, 0xE7170101, ++ 0xC78, 0xE6180101, ++ 0xC78, 0xE5190101, ++ 0xC78, 0xE41A0101, ++ 0xC78, 0xE31B0101, ++ 0xC78, 0xE21C0101, ++ 0xC78, 0xE11D0101, ++ 0xC78, 0xE01E0101, ++ 0xC78, 0x861F0101, ++ 0xC78, 0x85200101, ++ 0xC78, 0x84210101, ++ 0xC78, 0x83220101, ++ 0xC78, 0x82230101, ++ 0xC78, 0x81240101, ++ 0xC78, 0x80250101, ++ 0xC78, 0x44260101, ++ 0xC78, 0x43270101, ++ 0xC78, 0x42280101, ++ 0xC78, 0x41290101, ++ 0xC78, 0x402A0101, ++ 0xC78, 0x022B0101, ++ 0xC78, 0x012C0101, ++ 0xC78, 0x002D0101, ++ 0xC78, 0xC52E0001, ++ 0xC78, 0xC42F0001, ++ 0xC78, 0xC3300001, ++ 0xC78, 0xC2310001, ++ 0xC78, 0xC1320001, ++ 0xC78, 0xC0330001, ++ 0xC78, 0x04340001, ++ 0xC78, 0x03350001, ++ 0xC78, 0x02360001, ++ 0xC78, 0x01370001, ++ 0xC78, 0x00380001, ++ 0xC78, 0x00390001, ++ 0xC78, 0x003A0001, ++ 0xC78, 0x003B0001, ++ 0xC78, 0x003C0001, ++ 0xC78, 0x003D0001, ++ 0xC78, 0x003E0001, ++ 0xC78, 0x003F0001, ++ 0xC78, 0x6F002001, ++ 0xC78, 0x6F012001, ++ 0xC78, 0x6F022001, ++ 0xC78, 0x6F032001, ++ 0xC78, 0x6F042001, ++ 0xC78, 0x6F052001, ++ 0xC78, 0x6F062001, ++ 0xC78, 0x6F072001, ++ 0xC78, 0x6F082001, ++ 0xC78, 0x6F092001, ++ 0xC78, 0x6F0A2001, ++ 0xC78, 0x6F0B2001, ++ 0xC78, 0x6F0C2001, ++ 0xC78, 0x6F0D2001, ++ 0xC78, 0x6F0E2001, ++ 0xC78, 0x6F0F2001, ++ 0xC78, 0x6F102001, ++ 0xC78, 0x6F112001, ++ 0xC78, 0x6F122001, ++ 0xC78, 0x6F132001, ++ 0xC78, 0x6F142001, ++ 0xC78, 0x6F152001, ++ 0xC78, 0x6F162001, ++ 0xC78, 0x6F172001, ++ 0xC78, 0x6F182001, ++ 0xC78, 0x6F192001, ++ 0xC78, 0x6F1A2001, ++ 0xC78, 0x6F1B2001, ++ 0xC78, 0x6F1C2001, ++ 0xC78, 0x6F1D2001, ++ 0xC78, 0x6F1E2001, ++ 0xC78, 0x6F1F2001, ++ 0xC78, 0x6F202001, ++ 0xC78, 0x6F212001, ++ 0xC78, 0x6F222001, ++ 0xC78, 0x6F232001, ++ 0xC78, 0x6E242001, ++ 0xC78, 0x6D252001, ++ 0xC78, 0x6C262001, ++ 0xC78, 0x6B272001, ++ 0xC78, 0x6A282001, ++ 0xC78, 0x69292001, ++ 0xC78, 0x4B2A2001, ++ 0xC78, 0x4A2B2001, ++ 0xC78, 0x492C2001, ++ 0xC78, 0x482D2001, ++ 0xC78, 0x472E2001, ++ 0xC78, 0x462F2001, ++ 0xC78, 0x45302001, ++ 0xC78, 0x44312001, ++ 0xC78, 0x43322001, ++ 0xC78, 0x42332001, ++ 0xC78, 0x41342001, ++ 0xC78, 0x40352001, ++ 0xC78, 0x02362001, ++ 0xC78, 0x01372001, ++ 0xC78, 0x00382001, ++ 0xC78, 0x00392001, ++ 0xC78, 0x003A2001, ++ 0xC78, 0x003B2001, ++ 0xC78, 0x003C2001, ++ 0xC78, 0x003D2001, ++ 0xC78, 0x003E2001, ++ 0xC78, 0x003F2001, ++ 0xC78, 0x7F003101, ++ 0xC78, 0x7F013101, ++ 0xC78, 0x7F023101, ++ 0xC78, 0x7F033101, ++ 0xC78, 0x7F043101, ++ 0xC78, 0x7F053101, ++ 0xC78, 0x7F063101, ++ 0xC78, 0x7F073101, ++ 0xC78, 0x7E083101, ++ 0xC78, 0x7D093101, ++ 0xC78, 0x7C0A3101, ++ 0xC78, 0x7B0B3101, ++ 0xC78, 0x7A0C3101, ++ 0xC78, 0x790D3101, ++ 0xC78, 0x780E3101, ++ 0xC78, 0x770F3101, ++ 0xC78, 0x76103101, ++ 0xC78, 0x75113101, ++ 0xC78, 0x74123101, ++ 0xC78, 0x73133101, ++ 0xC78, 0x72143101, ++ 0xC78, 0x71153101, ++ 0xC78, 0x70163101, ++ 0xC78, 0x6F173101, ++ 0xC78, 0x6E183101, ++ 0xC78, 0x6D193101, ++ 0xC78, 0x6C1A3101, ++ 0xC78, 0x6B1B3101, ++ 0xC78, 0x6A1C3101, ++ 0xC78, 0x691D3101, ++ 0xC78, 0x681E3101, ++ 0xC78, 0x4B1F3101, ++ 0xC78, 0x4A203101, ++ 0xC78, 0x49213101, ++ 0xC78, 0x48223101, ++ 0xC78, 0x47233101, ++ 0xC78, 0x46243101, ++ 0xC78, 0x45253101, ++ 0xC78, 0x44263101, ++ 0xC78, 0x43273101, ++ 0xC78, 0x42283101, ++ 0xC78, 0x41293101, ++ 0xC78, 0x402A3101, ++ 0xC78, 0x022B3101, ++ 0xC78, 0x012C3101, ++ 0xC78, 0x002D3101, ++ 0xC78, 0x002E3101, ++ 0xC78, 0x002F3101, ++ 0xC78, 0x00303101, ++ 0xC78, 0x00313101, ++ 0xC78, 0x00323101, ++ 0xC78, 0x00333101, ++ 0xC78, 0x00343101, ++ 0xC78, 0x00353101, ++ 0xC78, 0x00363101, ++ 0xC78, 0x00373101, ++ 0xC78, 0x00383101, ++ 0xC78, 0x00393101, ++ 0xC78, 0x003A3101, ++ 0xC78, 0x003B3101, ++ 0xC78, 0x003C3101, ++ 0xC78, 0x003D3101, ++ 0xC78, 0x003E3101, ++ 0xC78, 0x003F3101, ++ 0xC78, 0xFE403101, ++ 0xC78, 0xFD413101, ++ 0xC78, 0xFC423101, ++ 0xC78, 0xFB433101, ++ 0xC78, 0xFA443101, ++ 0xC78, 0xF9453101, ++ 0xC78, 0xF8463101, ++ 0xC78, 0xF7473101, ++ 0xC78, 0xF6483101, ++ 0xC78, 0xF5493101, ++ 0xC78, 0xF44A3101, ++ 0xC78, 0xF34B3101, ++ 0xC78, 0xF24C3101, ++ 0xC78, 0xF14D3101, ++ 0xC78, 0xF04E3101, ++ 0xC78, 0xEF4F3101, ++ 0xC78, 0xEE503101, ++ 0xC78, 0xED513101, ++ 0xC78, 0xEC523101, ++ 0xC78, 0xEB533101, ++ 0xC78, 0xEA543101, ++ 0xC78, 0xE9553101, ++ 0xC78, 0xE8563101, ++ 0xC78, 0xE7573101, ++ 0xC78, 0xE6583101, ++ 0xC78, 0xE5593101, ++ 0xC78, 0xE45A3101, ++ 0xC78, 0xE35B3101, ++ 0xC78, 0xE25C3101, ++ 0xC78, 0xE15D3101, ++ 0xC78, 0xE05E3101, ++ 0xC78, 0x865F3101, ++ 0xC78, 0x85603101, ++ 0xC78, 0x84613101, ++ 0xC78, 0x83623101, ++ 0xC78, 0x82633101, ++ 0xC78, 0x81643101, ++ 0xC78, 0x80653101, ++ 0xC78, 0x80663101, ++ 0xC78, 0x80673101, ++ 0xC78, 0x80683101, ++ 0xC78, 0x80693101, ++ 0xC78, 0x806A3101, ++ 0xC78, 0x806B3101, ++ 0xC78, 0x806C3101, ++ 0xC78, 0x806D3101, ++ 0xC78, 0x806E3101, ++ 0xC78, 0x806F3101, ++ 0xC78, 0x80703101, ++ 0xC78, 0x80713101, ++ 0xC78, 0x80723101, ++ 0xC78, 0x80733101, ++ 0xC78, 0x80743101, ++ 0xC78, 0x80753101, ++ 0xC78, 0x80763101, ++ 0xC78, 0x80773101, ++ 0xC78, 0x80783101, ++ 0xC78, 0x80793101, ++ 0xC78, 0x807A3101, ++ 0xC78, 0x807B3101, ++ 0xC78, 0x807C3101, ++ 0xC78, 0x807D3101, ++ 0xC78, 0x807E3101, ++ 0xC78, 0x807F3101, ++ 0xC78, 0xEF402001, ++ 0xC78, 0xEF412001, ++ 0xC78, 0xEF422001, ++ 0xC78, 0xEF432001, ++ 0xC78, 0xEF442001, ++ 0xC78, 0xEF452001, ++ 0xC78, 0xEF462001, ++ 0xC78, 0xEF472001, ++ 0xC78, 0xEF482001, ++ 0xC78, 0xEF492001, ++ 0xC78, 0xEF4A2001, ++ 0xC78, 0xEF4B2001, ++ 0xC78, 0xEF4C2001, ++ 0xC78, 0xEF4D2001, ++ 0xC78, 0xEF4E2001, ++ 0xC78, 0xEF4F2001, ++ 0xC78, 0xEF502001, ++ 0xC78, 0xEF512001, ++ 0xC78, 0xEF522001, ++ 0xC78, 0xEF532001, ++ 0xC78, 0xEF542001, ++ 0xC78, 0xEF552001, ++ 0xC78, 0xEF562001, ++ 0xC78, 0xEF572001, ++ 0xC78, 0xEF582001, ++ 0xC78, 0xEF592001, ++ 0xC78, 0xEF5A2001, ++ 0xC78, 0xEF5B2001, ++ 0xC78, 0xEF5C2001, ++ 0xC78, 0xEF5D2001, ++ 0xC78, 0xEF5E2001, ++ 0xC78, 0xEF5F2001, ++ 0xC78, 0xEF602001, ++ 0xC78, 0xEE612001, ++ 0xC78, 0xED622001, ++ 0xC78, 0xEC632001, ++ 0xC78, 0xEB642001, ++ 0xC78, 0xEA652001, ++ 0xC78, 0xE9662001, ++ 0xC78, 0xE8672001, ++ 0xC78, 0xCB682001, ++ 0xC78, 0xCA692001, ++ 0xC78, 0xC96A2001, ++ 0xC78, 0xC86B2001, ++ 0xC78, 0xC76C2001, ++ 0xC78, 0xC66D2001, ++ 0xC78, 0xC56E2001, ++ 0xC78, 0xC46F2001, ++ 0xC78, 0xC3702001, ++ 0xC78, 0xC2712001, ++ 0xC78, 0xC1722001, ++ 0xC78, 0xC0732001, ++ 0xC78, 0x82742001, ++ 0xC78, 0x81752001, ++ 0xC78, 0x80762001, ++ 0xC78, 0x80772001, ++ 0xC78, 0x80782001, ++ 0xC78, 0x80792001, ++ 0xC78, 0x807A2001, ++ 0xC78, 0x807B2001, ++ 0xC78, 0x807C2001, ++ 0xC78, 0x807D2001, ++ 0xC78, 0x807E2001, ++ 0xC78, 0x807F2001, ++ 0xC78, 0xFA001101, ++ 0xC78, 0xF9011101, ++ 0xC78, 0xF8021101, ++ 0xC78, 0xF7031101, ++ 0xC78, 0xF6041101, ++ 0xC78, 0xF5051101, ++ 0xC78, 0xF4061101, ++ 0xC78, 0xD7071101, ++ 0xC78, 0xD6081101, ++ 0xC78, 0xD5091101, ++ 0xC78, 0xD40A1101, ++ 0xC78, 0x970B1101, ++ 0xC78, 0x960C1101, ++ 0xC78, 0x950D1101, ++ 0xC78, 0x940E1101, ++ 0xC78, 0x930F1101, ++ 0xC78, 0x92101101, ++ 0xC78, 0x91111101, ++ 0xC78, 0x90121101, ++ 0xC78, 0x8F131101, ++ 0xC78, 0x8E141101, ++ 0xC78, 0x8D151101, ++ 0xC78, 0x8C161101, ++ 0xC78, 0x8B171101, ++ 0xC78, 0x8A181101, ++ 0xC78, 0x89191101, ++ 0xC78, 0x881A1101, ++ 0xC78, 0x871B1101, ++ 0xC78, 0x861C1101, ++ 0xC78, 0x851D1101, ++ 0xC78, 0x841E1101, ++ 0xC78, 0x831F1101, ++ 0xC78, 0x82201101, ++ 0xC78, 0x81211101, ++ 0xC78, 0x80221101, ++ 0xC78, 0x43231101, ++ 0xC78, 0x42241101, ++ 0xC78, 0x41251101, ++ 0xC78, 0x04261101, ++ 0xC78, 0x03271101, ++ 0xC78, 0x02281101, ++ 0xC78, 0x01291101, ++ 0xC78, 0x002A1101, ++ 0xC78, 0xC42B1001, ++ 0xC78, 0xC32C1001, ++ 0xC78, 0xC22D1001, ++ 0xC78, 0xC12E1001, ++ 0xC78, 0xC02F1001, ++ 0xC78, 0x85301001, ++ 0xC78, 0x84311001, ++ 0xC78, 0x83321001, ++ 0xC78, 0x82331001, ++ 0xC78, 0x81341001, ++ 0xC78, 0x80351001, ++ 0xC78, 0x05361001, ++ 0xC78, 0x04371001, ++ 0xC78, 0x03381001, ++ 0xC78, 0x02391001, ++ 0xC78, 0x013A1001, ++ 0xC78, 0x003B1001, ++ 0xC78, 0x003C1001, ++ 0xC78, 0x003D1001, ++ 0xC78, 0x003E1001, ++ 0xC78, 0x003F1001, ++ 0xC50, 0x69553422, ++ 0xC50, 0x69553420, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8723D_AGC_TAB( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ u4Byte i = 0; ++ u1Byte cCond; ++ BOOLEAN bMatched = TRUE, bSkipped = FALSE; ++ u4Byte ArrayLen = sizeof(Array_MP_8723D_AGC_TAB)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8723D_AGC_TAB; ++ ++ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_AGC_TAB\n")); ++ ++ while ((i + 1) < ArrayLen) { ++ v1 = Array[i]; ++ v2 = Array[i + 1]; ++ ++ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ ++ if (v1 & BIT31) {/* positive condition*/ ++ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); ++ if (cCond == COND_ENDIF) {/*end*/ ++ bMatched = TRUE; ++ bSkipped = FALSE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); ++ } else if (cCond == COND_ELSE) { /*else*/ ++ bMatched = bSkipped?FALSE:TRUE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); ++ } else {/*if , else if*/ ++ pre_v1 = v1; ++ pre_v2 = v2; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); ++ } ++ } else if (v1 & BIT30) { /*negative condition*/ ++ if (bSkipped == FALSE) { ++ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { ++ bMatched = TRUE; ++ bSkipped = TRUE; ++ } else { ++ bMatched = FALSE; ++ bSkipped = FALSE; ++ } ++ } else ++ bMatched = FALSE; ++ } ++ } else { ++ if (bMatched) ++ odm_ConfigBB_AGC_8723D(pDM_Odm, v1, bMaskDWord, v2); ++ } ++ i = i + 2; ++ } ++} ++ ++u4Byte ++ODM_GetVersion_MP_8723D_AGC_TAB(void) ++{ ++ return 31; ++} ++ ++/****************************************************************************** ++* PHY_REG.TXT ++******************************************************************************/ ++ ++u4Byte Array_MP_8723D_PHY_REG[] = { ++ 0x800, 0x80046C00, ++ 0x804, 0x00000003, ++ 0x808, 0x0000FC00, ++ 0x80C, 0x0000000A, ++ 0x810, 0x10001331, ++ 0x814, 0x020C3D10, ++ 0x818, 0x00200385, ++ 0x81C, 0x00000000, ++ 0x820, 0x01000100, ++ 0x824, 0x00390204, ++ 0x828, 0x00000000, ++ 0x82C, 0x00000000, ++ 0x830, 0x00000000, ++ 0x834, 0x00000000, ++ 0x838, 0x00000000, ++ 0x83C, 0x00000000, ++ 0x840, 0x00010000, ++ 0x844, 0x00000000, ++ 0x848, 0x00000000, ++ 0x84C, 0x00000000, ++ 0x850, 0x00000000, ++ 0x854, 0x00000000, ++ 0x858, 0x569A11A9, ++ 0x85C, 0x01000014, ++ 0x860, 0x66F60110, ++ 0x864, 0x461F0641, ++ 0x868, 0x00000000, ++ 0x86C, 0x27272700, ++ 0x870, 0x07000460, ++ 0x874, 0x25004000, ++ 0x878, 0x00000808, ++ 0x87C, 0x004F0201, ++ 0x880, 0xB2002E12, ++ 0x884, 0x00000007, ++ 0x888, 0x00000000, ++ 0x88C, 0xCCC000C0, ++ 0x890, 0x00000800, ++ 0x894, 0xFFFFFFFE, ++ 0x898, 0x40302010, ++ 0x89C, 0x00706050, ++ 0x900, 0x00000000, ++ 0x904, 0x00000023, ++ 0x908, 0x00000000, ++ 0x90C, 0x81121111, ++ 0x910, 0x00000402, ++ 0x914, 0x00000300, ++ 0x920, 0x18C6318C, ++ 0x924, 0x0000018C, ++ 0x948, 0x99000000, ++ 0x94C, 0x00000010, ++ 0x950, 0x00003800, ++ 0x954, 0x5A380000, ++ 0x958, 0x4BC6D87A, ++ 0x95C, 0x04EB9B79, ++ 0x96C, 0x00000003, ++ 0x970, 0x00000000, ++ 0x974, 0x00000000, ++ 0x978, 0x00000000, ++ 0x97C, 0x13000000, ++ 0x980, 0x00000000, ++ 0xA00, 0x00D047C8, ++ 0xA04, 0x80FF800C, ++ 0xA08, 0x8C838300, ++ 0xA0C, 0x2E20100F, ++ 0xA10, 0x9500BB78, ++ 0xA14, 0x1114D028, ++ 0xA18, 0x00881117, ++ 0xA1C, 0x89140F00, ++ 0xA20, 0xE82C0001, ++ 0xA24, 0x64B80C1C, ++ 0xA28, 0x00008810, ++ 0xA2C, 0x00D30000, ++ 0xA70, 0x101FBF00, ++ 0xA74, 0x00000007, ++ 0xA78, 0x00008900, ++ 0xA7C, 0x225B0606, ++ 0xA80, 0x2180FA74, ++ 0xA84, 0x00200000, ++ 0xA88, 0x040C0000, ++ 0xA8C, 0x12345678, ++ 0xA90, 0xABCDEF00, ++ 0xA94, 0x001B1B89, ++ 0xA98, 0x00000000, ++ 0xA9C, 0x00020000, ++ 0xAA0, 0x00000000, ++ 0xAA4, 0x0000000C, ++ 0xAA8, 0xCA100008, ++ 0xAAC, 0x01235667, ++ 0xAB0, 0x00000000, ++ 0xAB4, 0x20201402, ++ 0xB2C, 0x00000000, ++ 0xC00, 0x48071D40, ++ 0xC04, 0x03A05611, ++ 0xC08, 0x000000E4, ++ 0xC0C, 0x6C6C6C6C, ++ 0xC10, 0x28800000, ++ 0xC14, 0x40000100, ++ 0xC18, 0x08800000, ++ 0xC1C, 0x40000100, ++ 0xC20, 0x00000000, ++ 0xC24, 0x00000000, ++ 0xC28, 0x00000000, ++ 0xC2C, 0x00000000, ++ 0xC30, 0x69E9AC48, ++ 0xC34, 0x31000040, ++ 0xC38, 0x21688080, ++ 0xC3C, 0x000016D4, ++ 0xC40, 0x1F78403F, ++ 0xC44, 0x00010036, ++ 0xC48, 0xEC020107, ++ 0xC4C, 0x007F037F, ++ 0xC50, 0x69553420, ++ 0xC54, 0x43BC0094, ++ 0xC58, 0x00015969, ++ 0xC5C, 0x00310492, ++ 0xC60, 0x00280A00, ++ 0xC64, 0x7112848B, ++ 0xC68, 0x47C074FF, ++ 0xC6C, 0x00000036, ++ 0xC70, 0x2C7F000D, ++ 0xC74, 0x020600DB, ++ 0xC78, 0x0000001F, ++ 0xC7C, 0x00B91612, ++ 0xC80, 0x390000E4, ++ 0xC84, 0x11F60000, ++ 0xC88, 0x40000100, ++ 0xC8C, 0x20200000, ++ 0xC90, 0x00091521, ++ 0xC94, 0x00000000, ++ 0xC98, 0x00121820, ++ 0xC9C, 0x00007F7F, ++ 0xCA0, 0x00012000, ++ 0xCA4, 0xA00000A0, ++ 0xCA8, 0x85E7C606, ++ 0xCAC, 0x00000060, ++ 0xCB0, 0x00000000, ++ 0xCB4, 0x00000000, ++ 0xCB8, 0x00000000, ++ 0xCBC, 0x28000000, ++ 0xCC0, 0x0010A3D0, ++ 0xCC4, 0x00000F7D, ++ 0xCC8, 0x000442D6, ++ 0xCCC, 0x00000000, ++ 0xCD0, 0x000001C8, ++ 0xCD4, 0x001C8000, ++ 0xCD8, 0x00000100, ++ 0xCDC, 0x40100000, ++ 0xCE0, 0x00222220, ++ 0xCE4, 0x20000000, ++ 0xCE8, 0x37644302, ++ 0xCEC, 0x2F97D40C, ++ 0xD00, 0x00030740, ++ 0xD04, 0x40020401, ++ 0xD08, 0x0000907F, ++ 0xD0C, 0x20010201, ++ 0xD10, 0xA0633333, ++ 0xD14, 0x3333BC53, ++ 0xD18, 0x7A8F5B6F, ++ 0xD2C, 0xCC979975, ++ 0xD30, 0x00000000, ++ 0xD34, 0x80608000, ++ 0xD38, 0x88000000, ++ 0xD3C, 0xC0127343, ++ 0xD40, 0x00000000, ++ 0xD44, 0x00000000, ++ 0xD48, 0x00000000, ++ 0xD4C, 0x00000000, ++ 0xD50, 0x00000038, ++ 0xD54, 0x00000000, ++ 0xD58, 0x00000282, ++ 0xD5C, 0x30032064, ++ 0xD60, 0x4653DE68, ++ 0xD64, 0x04518A3C, ++ 0xD68, 0x00002101, ++ 0xE00, 0x2D2D2D2D, ++ 0xE04, 0x2D2D2D2D, ++ 0xE08, 0x0390272D, ++ 0xE10, 0x2D2D2D2D, ++ 0xE14, 0x2D2D2D2D, ++ 0xE18, 0x2D2D2D2D, ++ 0xE1C, 0x2D2D2D2D, ++ 0xE28, 0x00000000, ++ 0xE30, 0x1000DC1F, ++ 0xE34, 0x10008C1F, ++ 0xE38, 0x02140102, ++ 0xE3C, 0x681604C2, ++ 0xE40, 0x01007C00, ++ 0xE44, 0x01004800, ++ 0xE48, 0xFB000000, ++ 0xE4C, 0x000028D1, ++ 0xE50, 0x1000DC1F, ++ 0xE54, 0x10008C1F, ++ 0xE58, 0x02140102, ++ 0xE5C, 0x28160D05, ++ 0xE60, 0x00000008, ++ 0xE68, 0x001B25A4, ++ 0xE6C, 0x01C00014, ++ 0xE70, 0x01C00016, ++ 0xE74, 0x02000014, ++ 0xE78, 0x02000014, ++ 0xE7C, 0x02000014, ++ 0xE80, 0x02000014, ++ 0xE84, 0x01C00014, ++ 0xE88, 0x02000014, ++ 0xE8C, 0x01C00014, ++ 0xED0, 0x01C00014, ++ 0xED4, 0x01C00014, ++ 0xED8, 0x01C00014, ++ 0xEDC, 0x00000014, ++ 0xEE0, 0x00000014, ++ 0xEE8, 0x21555448, ++ 0xEEC, 0x03C00014, ++ 0xF14, 0x00000003, ++ 0xF00, 0x00100300, ++ 0xF08, 0x0000800B, ++ 0xF0C, 0x0000F007, ++ 0xF10, 0x0000A487, ++ 0xF1C, 0x80000064, ++ 0xF38, 0x00030155, ++ 0xF3C, 0x0000003A, ++ 0xF4C, 0x13000000, ++ 0xF50, 0x00000000, ++ 0xF18, 0x00000000, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8723D_PHY_REG( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ u4Byte i = 0; ++ u1Byte cCond; ++ BOOLEAN bMatched = TRUE, bSkipped = FALSE; ++ u4Byte ArrayLen = sizeof(Array_MP_8723D_PHY_REG)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8723D_PHY_REG; ++ ++ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_PHY_REG\n")); ++ ++ while ((i + 1) < ArrayLen) { ++ v1 = Array[i]; ++ v2 = Array[i + 1]; ++ ++ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ ++ if (v1 & BIT31) {/* positive condition*/ ++ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); ++ if (cCond == COND_ENDIF) {/*end*/ ++ bMatched = TRUE; ++ bSkipped = FALSE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); ++ } else if (cCond == COND_ELSE) { /*else*/ ++ bMatched = bSkipped?FALSE:TRUE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); ++ } else {/*if , else if*/ ++ pre_v1 = v1; ++ pre_v2 = v2; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); ++ } ++ } else if (v1 & BIT30) { /*negative condition*/ ++ if (bSkipped == FALSE) { ++ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { ++ bMatched = TRUE; ++ bSkipped = TRUE; ++ } else { ++ bMatched = FALSE; ++ bSkipped = FALSE; ++ } ++ } else ++ bMatched = FALSE; ++ } ++ } else { ++ if (bMatched) ++ odm_ConfigBB_PHY_8723D(pDM_Odm, v1, bMaskDWord, v2); ++ } ++ i = i + 2; ++ } ++} ++ ++u4Byte ++ODM_GetVersion_MP_8723D_PHY_REG(void) ++{ ++ return 31; ++} ++ ++/****************************************************************************** ++* PHY_REG_PG.TXT ++******************************************************************************/ ++ ++u4Byte Array_MP_8723D_PHY_REG_PG[] = { ++ 0, 0, 0, 0x00000e08, 0x0000ff00, 0x00003200, ++ 0, 0, 0, 0x0000086c, 0xffffff00, 0x32323200, ++ 0, 0, 0, 0x00000e00, 0xffffffff, 0x32343434, ++ 0, 0, 0, 0x00000e04, 0xffffffff, 0x28303032, ++ 0, 0, 0, 0x00000e10, 0xffffffff, 0x30323234, ++ 0, 0, 0, 0x00000e14, 0xffffffff, 0x26282830 ++}; ++ ++void ++ODM_ReadAndConfig_MP_8723D_PHY_REG_PG( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ u4Byte i = 0; ++ u4Byte ArrayLen = sizeof(Array_MP_8723D_PHY_REG_PG)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8723D_PHY_REG_PG; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ PlatformZeroMemory(pHalData->BufOfLinesPwrByRate, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); ++ pHalData->nLinesReadPwrByRate = ArrayLen/6; ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_PHY_REG_PG\n")); ++ ++ pDM_Odm->PhyRegPgVersion = 1; ++ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; ++ ++ for (i = 0; i < ArrayLen; i += 6) { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ u4Byte v3 = Array[i+2]; ++ u4Byte v4 = Array[i+3]; ++ u4Byte v5 = Array[i+4]; ++ u4Byte v6 = Array[i+5]; ++ ++ odm_ConfigBB_PHY_REG_PG_8723D(pDM_Odm, v1, v2, v3, v4, v5, v6); ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ rsprintf((char *)pHalData->BufOfLinesPwrByRate[i/6], 100, "%s, %s, %s, 0x%X, 0x%08X, 0x%08X,", ++ (v1 == 0?"2.4G":" 5G"), (v2 == 0?"A":"B"), (v3 == 0?"1Tx":"2Tx"), v4, v5, v6); ++#endif ++ } ++} ++ ++ ++ ++#endif /* end of HWIMG_SUPPORT*/ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.h 2018-02-11 21:44:27.158146254 +0200 +@@ -0,0 +1,59 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++/*Image2HeaderVersion: 2.26*/ ++#if (RTL8723D_SUPPORT == 1) ++#ifndef __INC_MP_BB_HW_IMG_8723D_H ++#define __INC_MP_BB_HW_IMG_8723D_H ++ ++ ++/****************************************************************************** ++* AGC_TAB.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8723D_AGC_TAB(/* TC: Test Chip, MP: MP Chip*/ ++ IN PDM_ODM_T pDM_Odm ++); ++u4Byte ODM_GetVersion_MP_8723D_AGC_TAB(void); ++ ++/****************************************************************************** ++* PHY_REG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8723D_PHY_REG(/* TC: Test Chip, MP: MP Chip*/ ++ IN PDM_ODM_T pDM_Odm ++); ++u4Byte ODM_GetVersion_MP_8723D_PHY_REG(void); ++ ++/****************************************************************************** ++* PHY_REG_PG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8723D_PHY_REG_PG(/* TC: Test Chip, MP: MP Chip*/ ++ IN PDM_ODM_T pDM_Odm ++); ++u4Byte ODM_GetVersion_MP_8723D_PHY_REG_PG(void); ++ ++#endif ++#endif /* end of HWIMG_SUPPORT*/ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.c 2018-02-11 21:44:27.161146299 +0200 +@@ -0,0 +1,4840 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++/*Image2HeaderVersion: 2.16*/ ++#include "mp_precomp.h" ++#include "../phydm_precomp.h" ++ ++#ifdef LOAD_FW_HEADER_FROM_DRIVER ++#include "../../rtl8723d/hal8723d_fw.h" ++#endif ++ ++ ++#if (RTL8723D_SUPPORT == 1) ++#if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) ++ ++ ++#ifndef LOAD_FW_HEADER_FROM_DRIVER ++u8 array_mp_8723d_fw_ap[] = { ++0xD1, 0x23, 0x20, 0x00, 0x10, 0x00, 0x00, 0x00, 0x05, 0x16, 0x18, 0x17, 0xA0, 0x52, 0x02, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x02, 0x85, 0xAD, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xA5, 0x97, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xBE, 0x67, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xBA, 0x86, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0xBA, 0xD6, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xBE, 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, ++0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, ++0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, ++0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0A, ++0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, ++0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, ++0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, ++0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, ++0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, ++0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, ++0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, ++0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, ++0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, ++0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, ++0x30, 0x04, 0x04, 0x04, 0x05, 0x08, 0x08, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x06, 0x0B, 0x0D, ++0x0E, 0x0F, 0x11, 0x12, 0x14, 0x00, 0x04, 0x00, 0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x23, 0x00, ++0x2D, 0x00, 0x50, 0x00, 0x91, 0x00, 0xC3, 0x01, 0x27, 0x01, 0x31, 0x01, 0x5E, 0x00, 0xC8, 0x00, ++0xF0, 0x00, 0xDC, 0x01, 0x5E, 0x01, 0x68, 0x01, 0x9A, 0x01, 0xCC, 0x01, 0xEA, 0x02, 0x02, 0x04, ++0x08, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C, 0x14, 0x28, 0x32, 0x50, 0x78, 0xA0, 0xC8, ++0xE6, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x02, 0x04, 0x06, ++0x07, 0x07, 0x08, 0x08, 0x08, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, ++0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x02, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, ++0x02, 0x03, 0x03, 0x04, 0x05, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x03, 0x03, 0x03, ++0x02, 0x03, 0x03, 0x03, 0x03, 0x03, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, ++0x02, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x83, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, ++0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, ++0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, ++0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, ++0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, ++0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, ++0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, ++0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, ++0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, ++0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, ++0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, ++0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, ++0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, ++0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, ++0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, ++0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x86, 0xC0, 0x74, 0x01, 0x93, ++0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, ++0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, ++0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, ++0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, ++0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, ++0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, ++0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, ++0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, ++0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, ++0x04, 0x90, 0x86, 0xC0, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, ++0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, ++0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, ++0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x83, 0x4D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, ++0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, ++0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, ++0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, ++0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, ++0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, ++0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, ++0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, ++0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x83, 0x4C, 0x8F, 0xF0, ++0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, ++0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, ++0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, ++0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, ++0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x83, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, ++0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0x02, 0x85, 0xEB, ++0x02, 0x83, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, ++0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, ++0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, ++0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x86, 0xA9, 0xE4, 0x7E, ++0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, ++0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, ++0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, ++0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, ++0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, ++0xFF, 0xEE, 0x9A, 0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, ++0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, ++0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, ++0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, ++0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, ++0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, ++0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x41, 0x96, 0x84, 0x00, 0x44, 0x96, 0x43, ++0x41, 0x4E, 0x59, 0x00, 0x44, 0x96, 0x3F, 0x61, 0x6E, 0x79, 0x00, 0x41, 0x96, 0x86, 0x00, 0x00, ++0x9B, 0xD7, 0xB6, 0x2A, 0x96, 0x8F, 0x90, 0x96, 0x81, 0xEF, 0xF0, 0x7F, 0x02, 0xB1, 0x27, 0x90, ++0x86, 0xAF, 0xE0, 0xFF, 0x90, 0x96, 0x81, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, 0x22, ++0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x86, 0xB4, ++0xF1, 0x3C, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB5, 0xF1, 0x35, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB6, ++0x12, 0x8F, 0xBF, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB7, 0x12, 0xA1, 0x04, 0xFF, 0xED, 0x2F, 0x90, ++0x86, 0xB8, 0xF1, 0x2D, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB9, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x02, ++0x1F, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x86, 0xBA, 0xF0, 0x22, 0x4E, 0xFF, 0xF0, 0x90, 0x00, ++0x05, 0x02, 0x02, 0x1F, 0x4F, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x02, 0x1F, 0xF0, 0x90, 0x00, 0x01, ++0x02, 0x02, 0x1F, 0x12, 0x02, 0x06, 0x90, 0x93, 0x25, 0xF1, 0x3C, 0x90, 0x93, 0x26, 0xF1, 0x35, ++0x90, 0x93, 0x27, 0xF0, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x80, 0xFE, 0x90, 0x93, 0x56, 0xE0, ++0x54, 0x7F, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x40, 0xFF, 0xEE, 0x54, 0xBF, 0x4F, 0xFF, 0xF0, 0x12, ++0x02, 0x06, 0xFE, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0x90, 0x93, 0x56, 0xF0, 0xEE, ++0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, 0x12, 0x02, 0x06, 0x54, 0x0F, 0xFE, 0xEF, ++0x54, 0xF0, 0x4E, 0x90, 0x93, 0x56, 0xF1, 0x3C, 0xFF, 0x54, 0x7F, 0x90, 0x93, 0x58, 0xF0, 0xEF, ++0x12, 0x8F, 0xC8, 0xFF, 0x90, 0x93, 0x57, 0xE0, 0x54, 0xFE, 0xF1, 0x34, 0x90, 0x93, 0x59, 0x12, ++0x8F, 0xBF, 0x54, 0x01, 0x25, 0xE0, 0xFF, 0x90, 0x93, 0x57, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0x12, ++0xBB, 0xFD, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, ++0x7A, 0xED, 0xF0, 0x90, 0x96, 0x79, 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x44, 0x7F, 0x47, 0x12, ++0x88, 0x73, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, 0x12, 0x7B, 0x2E, ++0x7F, 0x46, 0x12, 0x88, 0x73, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x46, 0x11, ++0x81, 0x60, 0x0D, 0x7F, 0x45, 0x11, 0x73, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x80, 0x0C, ++0x7F, 0x45, 0x11, 0x73, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x45, 0x80, ++0x4A, 0x90, 0x96, 0x79, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0x11, 0x73, 0x80, 0x02, 0xC3, 0x33, ++0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x12, 0x7B, 0x2E, 0x7F, 0x62, 0x11, 0x73, 0x80, 0x02, ++0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0x11, 0x81, 0x60, 0x10, 0x7F, 0x61, 0x11, 0x73, ++0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x0F, 0x7F, 0x61, 0x11, 0x73, ++0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x12, 0x7B, 0x2E, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x12, 0x7B, 0x41, 0x90, 0x96, 0x79, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, ++0x22, 0x12, 0x7B, 0x2E, 0x90, 0x96, 0x7A, 0xE0, 0x22, 0x90, 0x93, 0x30, 0xE0, 0x20, 0xE0, 0x02, ++0x21, 0x55, 0xE4, 0x90, 0x94, 0xA2, 0xF0, 0x90, 0x94, 0xA2, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x40, ++0x02, 0x21, 0x55, 0x12, 0xB3, 0xED, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, ++0x90, 0x93, 0x31, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x02, 0x21, 0x4D, 0x12, 0x02, 0x06, 0xFF, 0x30, ++0xE0, 0x1A, 0x90, 0x93, 0x32, 0xE0, 0xFE, 0x90, 0x94, 0xA2, 0xE0, 0xFD, 0x74, 0x01, 0xA8, 0x05, ++0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, 0x32, 0xF0, 0xEF, 0xC3, 0x13, 0x30, ++0xE0, 0x15, 0x90, 0x93, 0x33, 0xE0, 0xFF, 0x90, 0x94, 0xA2, 0x11, 0x79, 0x80, 0x02, 0xC3, 0x33, ++0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x33, 0xF0, 0x12, 0x87, 0x3D, 0xFF, 0x90, 0x94, 0xA2, 0xE0, 0xFE, ++0x24, 0x34, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0x87, 0x35, 0xFF, 0x74, 0x39, ++0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF1, 0xBF, 0xFF, 0x74, 0x3E, 0x2E, 0xF5, ++0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0xA1, 0x04, 0xFF, 0x74, 0x43, 0x2E, 0xF5, 0x82, ++0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0x31, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x06, ++0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x31, 0xF0, 0x22, 0x90, 0x94, 0xA2, ++0xE0, 0x04, 0xF0, 0x01, 0x97, 0x22, 0x90, 0x94, 0x9F, 0x12, 0x86, 0x7A, 0x90, 0x94, 0x9E, 0xEF, ++0xF0, 0x12, 0x86, 0x83, 0x89, 0xDA, 0x00, 0x89, 0xDF, 0x01, 0x89, 0xE3, 0x08, 0x89, 0xE8, 0x09, ++0x89, 0xED, 0x0A, 0x89, 0xF2, 0x12, 0x89, 0xF7, 0x13, 0x89, 0xFC, 0x14, 0x8A, 0x01, 0x20, 0x8A, ++0x06, 0x25, 0x8A, 0x0B, 0x26, 0x8A, 0x10, 0x29, 0x8A, 0x15, 0x2A, 0x8A, 0x19, 0x40, 0x8A, 0x20, ++0x42, 0x8A, 0x2B, 0x43, 0x8A, 0x30, 0x44, 0x8A, 0xA2, 0x47, 0x8A, 0xA2, 0x49, 0x8A, 0x35, 0x60, ++0x8A, 0x39, 0x61, 0x8A, 0x3E, 0x62, 0x8A, 0x43, 0x63, 0x8A, 0x48, 0x64, 0x8A, 0x4D, 0x65, 0x8A, ++0x52, 0x66, 0x8A, 0x57, 0x67, 0x8A, 0x5C, 0x68, 0x8A, 0x61, 0x69, 0x8A, 0x66, 0x6B, 0x8A, 0x6B, ++0x6C, 0x8A, 0x70, 0x6D, 0x8A, 0x75, 0x6E, 0x8A, 0x7A, 0x6F, 0x8A, 0x7F, 0x70, 0x8A, 0x84, 0xC2, ++0x8A, 0x89, 0xC3, 0x8A, 0x8E, 0xC4, 0x00, 0x00, 0x8A, 0x93, 0x51, 0xA3, 0x02, 0x86, 0xE0, 0x51, ++0xA3, 0x41, 0xA9, 0x51, 0xA3, 0x02, 0x90, 0x02, 0x51, 0xA3, 0x02, 0x97, 0xFB, 0x51, 0xA3, 0x02, ++0x98, 0x16, 0x51, 0xA3, 0x02, 0x98, 0x25, 0x51, 0xA3, 0x02, 0x87, 0x55, 0x51, 0xA3, 0x02, 0x9F, ++0xF3, 0x51, 0xA3, 0x02, 0xA0, 0x02, 0x51, 0xA3, 0x02, 0xAF, 0xF1, 0x51, 0xA3, 0x02, 0xB7, 0xEF, ++0x51, 0xA3, 0x02, 0xB8, 0xEF, 0x51, 0xA3, 0x01, 0x89, 0x51, 0xA3, 0x90, 0x8A, 0xA5, 0x80, 0x05, ++0x51, 0xA3, 0x90, 0x8A, 0xB5, 0x12, 0x9F, 0xE9, 0x02, 0x04, 0x7E, 0x51, 0xA3, 0x02, 0x25, 0xEC, ++0x51, 0xA3, 0x02, 0x5B, 0xF3, 0x51, 0xA3, 0x61, 0x74, 0x51, 0xA3, 0x02, 0x77, 0x4F, 0x51, 0xA3, ++0x02, 0x7C, 0x60, 0x51, 0xA3, 0x02, 0x7A, 0xC6, 0x51, 0xA3, 0x02, 0x5D, 0x36, 0x51, 0xA3, 0x02, ++0x7B, 0xE9, 0x51, 0xA3, 0x02, 0x70, 0x33, 0x51, 0xA3, 0x02, 0x48, 0xC9, 0x51, 0xA3, 0x02, 0x79, ++0xF3, 0x51, 0xA3, 0x02, 0x3F, 0xD4, 0x51, 0xA3, 0x02, 0x51, 0x7B, 0x51, 0xA3, 0x02, 0x79, 0x30, ++0x51, 0xA3, 0x02, 0x57, 0xF2, 0x51, 0xA3, 0x02, 0x74, 0x8D, 0x51, 0xA3, 0x02, 0x78, 0x9A, 0x51, ++0xA3, 0x02, 0x5E, 0x0B, 0x51, 0xA3, 0x02, 0xB9, 0x05, 0x51, 0xA3, 0x02, 0xB9, 0x0D, 0x51, 0xA3, ++0x02, 0x87, 0x43, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x94, 0x9E, 0xE0, 0x90, 0x01, ++0xC2, 0xF0, 0x22, 0x90, 0x94, 0x9F, 0x02, 0x86, 0x71, 0xF1, 0xF5, 0x90, 0x93, 0x4B, 0xE0, 0x70, ++0x12, 0x71, 0x6E, 0x12, 0x02, 0x06, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x06, 0x90, 0x93, 0x51, ++0x74, 0x01, 0xF0, 0x90, 0x93, 0x4D, 0xE0, 0x70, 0x12, 0x71, 0x6E, 0x12, 0x02, 0x06, 0xC4, 0x54, ++0x0F, 0xFF, 0xBF, 0x05, 0x06, 0x90, 0x93, 0x52, 0x74, 0x01, 0xF0, 0x71, 0x6E, 0x12, 0x87, 0x3D, ++0xFF, 0x90, 0x94, 0xA6, 0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, 0x0B, 0x71, 0x6E, 0x12, ++0x87, 0x36, 0x90, 0x94, 0xA7, 0xF0, 0x80, 0x05, 0x90, 0x94, 0xA7, 0xEF, 0xF0, 0x90, 0x94, 0xA6, ++0xE0, 0x90, 0x94, 0xA5, 0xF0, 0x90, 0x94, 0xA7, 0xE0, 0xFE, 0x90, 0x94, 0xA5, 0xE0, 0xFF, 0xD3, ++0x9E, 0x50, 0x38, 0x71, 0x6E, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, 0x94, ++0xA5, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x90, 0x94, 0xA5, 0x70, 0x07, 0xE0, 0xFF, 0x12, 0xAF, ++0xD0, 0x80, 0x05, 0xE0, 0xFF, 0x12, 0xAF, 0xCC, 0x90, 0x93, 0x52, 0xE0, 0x60, 0x08, 0x90, 0x94, ++0xA5, 0xE0, 0xFF, 0x12, 0xAF, 0xD0, 0x12, 0xAE, 0x7E, 0x80, 0xBA, 0x90, 0x05, 0x5E, 0xE4, 0xF0, ++0x90, 0x94, 0xA6, 0xE0, 0x70, 0x17, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x10, 0xB1, 0xD7, 0x90, ++0x8A, 0xED, 0xB1, 0xDA, 0x12, 0xBD, 0x69, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x94, ++0xA2, 0x02, 0x86, 0x71, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0xF5, 0x71, 0x6E, 0x12, ++0x98, 0x0A, 0x7A, 0x88, 0x79, 0x9D, 0x12, 0x69, 0xF5, 0x71, 0x6E, 0x12, 0x02, 0x06, 0x20, 0xE0, ++0x02, 0xA1, 0x05, 0x90, 0x05, 0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, 0x13, 0x90, 0x88, ++0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x15, 0x12, 0x87, 0x3D, 0x90, ++0x88, 0x9E, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0x12, 0x87, 0x35, 0x90, 0x88, 0x9F, 0xF0, 0x80, ++0x4B, 0x12, 0x87, 0x3D, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x15, 0xEF, 0xC3, 0x94, 0x03, 0x50, 0x07, ++0x90, 0x88, 0x9E, 0x74, 0x03, 0x80, 0x0D, 0x12, 0x87, 0x3D, 0x90, 0x88, 0x9E, 0x80, 0x05, 0x90, ++0x88, 0x9E, 0x74, 0x2A, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0x12, 0x87, 0x36, 0xFF, 0xC3, ++0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, 0x74, 0x03, 0xF0, ++0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, 0x97, 0xDD, 0x30, ++0xE0, 0x3D, 0x90, 0x88, 0x9E, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA6, 0xF0, 0xE0, 0xC3, ++0x13, 0xA3, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA8, 0xF0, 0x90, ++0x88, 0x9E, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0xC3, 0x13, 0x90, ++0x88, 0xAA, 0xF0, 0x90, 0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, 0x12, 0x7C, 0x05, 0xE4, ++0x90, 0x88, 0xDD, 0xF0, 0x71, 0x6E, 0xF1, 0xC0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x37, ++0x90, 0x88, 0x9D, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x06, 0xE0, 0xF1, 0xCA, 0x30, 0xE0, 0x28, 0x12, ++0xD2, 0x7C, 0x30, 0xE0, 0x08, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x80, 0x0B, 0x90, 0x88, 0xDF, ++0xE0, 0x60, 0x05, 0x75, 0x61, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x61, 0x90, 0x8A, 0xF3, 0xB1, 0xC8, ++0x7D, 0x02, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, ++0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0xB1, ++0xC8, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0xD2, 0x95, 0x74, 0x11, 0xF0, 0x90, 0x05, ++0x58, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x01, ++0xF0, 0x80, 0x2B, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x04, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x04, 0xF0, ++0x80, 0x1C, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x02, 0xF0, 0x80, ++0x0D, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x07, 0x06, 0x90, 0x88, 0xB0, 0x74, 0x05, 0xF0, 0xE4, 0x90, ++0x88, 0xA5, 0xF0, 0x80, 0x65, 0x71, 0x6E, 0xF1, 0xC0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, ++0x05, 0x75, 0x62, 0x02, 0x80, 0x0E, 0x12, 0xD2, 0x7C, 0x30, 0xE0, 0x05, 0x75, 0x62, 0x01, 0x80, ++0x03, 0xE4, 0xF5, 0x62, 0x90, 0x8A, 0xF1, 0xB1, 0xDA, 0x90, 0x89, 0x04, 0xE0, 0x30, 0xE0, 0x04, ++0x7D, 0xAC, 0x80, 0x02, 0x7D, 0x2C, 0x7F, 0x40, 0x12, 0x7B, 0x2E, 0x71, 0x6E, 0xF1, 0xC0, 0x13, ++0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, ++0x90, 0x8A, 0xF3, 0xB1, 0xC8, 0xAD, 0x62, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0xB1, ++0xC8, 0x12, 0x9F, 0x30, 0x12, 0xD2, 0x95, 0x74, 0x43, 0xF0, 0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, ++0xF0, 0xE4, 0x90, 0x88, 0xAF, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xF1, 0xCA, 0x30, 0xE0, 0x09, 0x90, ++0x88, 0xD0, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x11, 0x90, 0x8A, 0x97, 0xB1, 0xC8, 0x7F, 0x01, 0x12, ++0x04, 0x7E, 0x90, 0x88, 0xD0, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, 0xB1, 0xC8, 0x7F, 0x03, ++0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, 0xA1, 0xE0, 0x54, 0xBF, ++0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, ++0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x79, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, ++0x22, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x86, 0x0C, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, ++0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x85, 0xED, 0xF0, ++0x90, 0x88, 0x31, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xE1, 0x55, 0xEE, ++0xF1, 0xCA, 0x30, 0xE0, 0x02, 0xE1, 0x55, 0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0xE1, ++0x55, 0xEF, 0x70, 0x02, 0xC1, 0xB1, 0x24, 0xFE, 0x70, 0x02, 0xC1, 0xF6, 0x24, 0xFE, 0x60, 0x4F, ++0x24, 0xFC, 0x70, 0x02, 0xE1, 0x3B, 0x24, 0xFC, 0x60, 0x02, 0xE1, 0x4B, 0xEE, 0xB4, 0x0E, 0x03, ++0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, ++0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x11, 0x90, ++0x96, 0x85, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x67, 0x80, 0x80, 0x05, 0x90, 0x8A, 0xED, 0xB1, 0xDA, ++0x90, 0x88, 0x39, 0xE0, 0x64, 0x08, 0x60, 0x02, 0xE1, 0x4B, 0x12, 0x7B, 0xCC, 0xE1, 0x4B, 0x90, ++0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, ++0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0xB1, 0xDA, ++0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xE1, 0x4B, ++0x90, 0x86, 0x00, 0xB1, 0xDA, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xE1, 0x4B, 0x12, 0x68, 0xC2, 0xE1, ++0x4B, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0xB1, 0xDA, 0xBF, 0x01, 0x03, ++0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, ++0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0xB1, 0xDA, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, ++0x88, 0x39, 0xE0, 0x64, 0x04, 0x70, 0x64, 0x90, 0x86, 0x02, 0xB1, 0xDA, 0xEF, 0x64, 0x01, 0x70, ++0x5A, 0x12, 0x73, 0x5A, 0x80, 0x55, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, ++0xB1, 0xDA, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, ++0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0xB1, 0xDA, 0xBF, 0x01, ++0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, ++0x88, 0x39, 0xE0, 0xB4, 0x04, 0x15, 0x12, 0x7A, 0x49, 0x80, 0x10, 0x90, 0x88, 0x39, 0xE0, 0xB4, ++0x0C, 0x09, 0x12, 0xCD, 0x4B, 0x30, 0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, 0x88, 0x39, 0x12, 0xD2, ++0x4E, 0x90, 0x01, 0xBB, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, ++0x5D, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x1D, 0x12, 0xD2, 0x58, 0x12, 0xA2, 0x78, 0x90, 0x8A, 0xF9, ++0xB1, 0xC8, 0xB1, 0xD1, 0x12, 0xB8, 0xB6, 0x30, 0xE0, 0x07, 0x90, 0x8A, 0x89, 0xB1, 0xC8, 0xF1, ++0xFB, 0x02, 0xB8, 0xBD, 0x90, 0x93, 0x29, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x30, 0xE4, 0x90, ++0x92, 0x20, 0xF0, 0x90, 0x93, 0x2C, 0x12, 0xA2, 0x78, 0x90, 0x93, 0x29, 0xE0, 0x54, 0xEF, 0xF0, ++0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0xB1, 0xC8, 0x7D, 0x04, 0x7F, 0x01, 0x02, ++0x04, 0x7E, 0x90, 0x8A, 0xF9, 0xB1, 0xC8, 0x7D, 0x31, 0x12, 0xCD, 0x42, 0xB1, 0xDA, 0x22, 0xF0, ++0x90, 0x00, 0x03, 0x02, 0x02, 0x1F, 0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, ++0x22, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, 0x1C, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x8A, 0xF9, ++0xB1, 0xC8, 0xB1, 0xD1, 0x12, 0xB8, 0xB6, 0x30, 0xE0, 0x07, 0x90, 0x8A, 0x89, 0xB1, 0xC8, 0xF1, ++0xFB, 0x12, 0xB8, 0xBD, 0x22, 0x90, 0x94, 0xA2, 0x02, 0x86, 0x7A, 0x7D, 0x0C, 0x7F, 0x01, 0x02, ++0x04, 0x7E, 0x12, 0x8F, 0xF5, 0x12, 0x02, 0x06, 0x30, 0xE0, 0x14, 0x12, 0xB5, 0xE0, 0x90, 0x86, ++0xB3, 0xE0, 0x64, 0x01, 0x70, 0x27, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x1E, 0x90, ++0x93, 0x25, 0xE0, 0x60, 0x16, 0x7D, 0x10, 0xE4, 0xFF, 0x12, 0x7C, 0x3B, 0x90, 0x01, 0x3C, 0xE0, ++0x30, 0xE4, 0x03, 0x74, 0x10, 0xF0, 0x90, 0x01, 0x63, 0xE4, 0xF0, 0x11, 0xB2, 0x12, 0x8B, 0x6E, ++0x12, 0x87, 0x3D, 0x90, 0x93, 0x04, 0x12, 0x87, 0x35, 0x90, 0x93, 0x05, 0xF0, 0x90, 0x93, 0x04, ++0xE0, 0x54, 0x01, 0x90, 0x93, 0x11, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x02, 0x90, 0x93, 0x12, ++0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x04, 0x90, 0x93, 0x13, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, ++0x08, 0x90, 0x93, 0x14, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x10, 0x90, 0x93, 0x15, 0xF0, 0x90, ++0x93, 0x05, 0xE0, 0x54, 0x01, 0x90, 0x93, 0x16, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x02, 0x90, ++0x93, 0x17, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x04, 0x90, 0x93, 0x18, 0xF0, 0x90, 0x93, 0x05, ++0xE0, 0x54, 0x08, 0x90, 0x93, 0x19, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x10, 0x90, 0x93, 0x1A, ++0xF0, 0x22, 0xC2, 0xAF, 0xF1, 0xF3, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0xE4, 0x90, 0x93, ++0x0F, 0xF0, 0xA3, 0xF0, 0xD2, 0xAF, 0x22, 0x90, 0x93, 0x20, 0xE0, 0x90, 0x95, 0x86, 0xF0, 0x90, ++0x93, 0x21, 0xE0, 0x90, 0x95, 0x87, 0xF0, 0x90, 0x93, 0x22, 0xE0, 0x90, 0x95, 0x88, 0xF0, 0x90, ++0x93, 0x23, 0xE0, 0x90, 0x95, 0x89, 0xF0, 0x90, 0x93, 0x24, 0xE0, 0x90, 0x95, 0x8A, 0xF0, 0x90, ++0x93, 0x11, 0xE0, 0x90, 0x95, 0x8B, 0xF0, 0x90, 0x93, 0x12, 0xE0, 0x90, 0x95, 0x8C, 0xF0, 0x90, ++0x93, 0x13, 0xE0, 0x90, 0x95, 0x8D, 0xF0, 0x90, 0x93, 0x14, 0xE0, 0x90, 0x95, 0x8E, 0xF0, 0x90, ++0x93, 0x15, 0xE0, 0x90, 0x95, 0x8F, 0xF0, 0x90, 0x93, 0x16, 0xE0, 0x90, 0x95, 0x90, 0xF0, 0x90, ++0x93, 0x17, 0xE0, 0x90, 0x95, 0x91, 0xF0, 0x90, 0x93, 0x18, 0xE0, 0x90, 0x95, 0x92, 0xF0, 0x90, ++0x93, 0x19, 0xE0, 0x90, 0x95, 0x93, 0xF0, 0x90, 0x93, 0x1A, 0xE0, 0x90, 0x95, 0x94, 0xF0, 0xF1, ++0xCB, 0xD1, 0x51, 0x90, 0x95, 0x2E, 0xF0, 0xB1, 0xD1, 0x50, 0x09, 0xD1, 0x0F, 0x74, 0x01, 0xF0, ++0xB1, 0xCA, 0x80, 0xF3, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x12, 0xB6, 0x17, 0x90, ++0x95, 0x23, 0xF0, 0xA3, 0xF1, 0xAA, 0xB1, 0xD1, 0x50, 0x4C, 0xB1, 0xF9, 0x90, 0x95, 0x2E, 0xE0, ++0xFE, 0x24, 0x95, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xD1, 0x31, 0xE0, 0x24, 0x4D, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x30, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xD1, 0x31, ++0xE0, 0x24, 0x4E, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xEE, 0x12, 0xD2, 0x36, 0x12, 0x86, ++0x7A, 0xD1, 0x35, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0xEE, 0x12, 0xD2, 0x28, 0x12, ++0x86, 0x7A, 0xB1, 0xCA, 0x80, 0xB0, 0x90, 0x02, 0x87, 0xE0, 0x70, 0x02, 0xA1, 0x96, 0x90, 0x93, ++0x03, 0xE0, 0x20, 0xE0, 0x02, 0xA1, 0x96, 0xE4, 0x90, 0x95, 0x9F, 0xD1, 0x51, 0x90, 0x95, 0x23, ++0xE0, 0xFF, 0xA3, 0xE0, 0xA3, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0x25, 0xE0, 0xFC, 0xA3, ++0xE0, 0xFD, 0xEC, 0x90, 0xFD, 0x11, 0xF0, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, ++0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, ++0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0x90, 0x95, 0x27, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x02, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, ++0x90, 0x95, 0x2A, 0xF0, 0xFC, 0x74, 0x07, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, ++0x54, 0xC0, 0x90, 0x95, 0x2C, 0xF0, 0xEC, 0x24, 0x18, 0x90, 0x95, 0x29, 0xF0, 0xFD, 0x90, 0x95, ++0x25, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0xEF, 0x54, 0xFC, 0x90, 0x95, ++0x2B, 0xF0, 0x90, 0x95, 0x2A, 0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0x90, 0x95, 0x27, 0x8F, 0xF0, ++0x12, 0x02, 0xE7, 0x90, 0x95, 0x27, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0xCE, 0x68, 0x90, 0x95, ++0x23, 0xEE, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x88, 0x27, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, ++0x95, 0x23, 0x12, 0xC6, 0xDE, 0x40, 0x1B, 0x90, 0x88, 0x28, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x88, ++0x27, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xED, 0x9F, 0xFF, 0xEC, 0x9E, 0x90, 0x95, 0x23, 0xF0, 0xA3, ++0xEF, 0xF0, 0x90, 0x95, 0x2B, 0xE0, 0x24, 0xC0, 0x60, 0x02, 0x81, 0x9A, 0xB1, 0xDE, 0x24, 0x18, ++0xFD, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0xEF, 0x60, 0x02, 0x81, 0x8F, 0xB1, 0xDE, 0x24, 0x19, 0xFD, ++0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0x90, 0x95, 0x44, 0xF1, 0xBA, 0x90, 0x95, 0x44, 0xE0, 0xFF, 0xD1, ++0x08, 0x9F, 0x50, 0x17, 0xB1, 0xDE, 0x24, 0x1A, 0xF1, 0xB2, 0xB1, 0xBE, 0x90, 0x95, 0x2D, 0xE0, ++0x24, 0x45, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xD1, 0x1A, 0x80, 0xDF, 0x90, 0x95, 0x44, 0xE0, 0x70, ++0x02, 0x61, 0xBC, 0xE4, 0x90, 0x95, 0x2E, 0xF0, 0xB1, 0xD1, 0x40, 0x02, 0x61, 0xA4, 0xB1, 0xF9, ++0x90, 0x95, 0x2E, 0xE0, 0xFF, 0x24, 0x30, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFE, ++0x90, 0x95, 0x44, 0xE0, 0xFD, 0xEE, 0x6D, 0x70, 0x21, 0xEF, 0x12, 0xD2, 0x36, 0x12, 0x86, 0x71, ++0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xD1, 0x25, 0x90, 0x95, 0xAA, 0xED, 0xF0, 0xD0, 0x01, 0xD0, ++0x02, 0xD0, 0x03, 0xD1, 0x5B, 0xEF, 0x60, 0x02, 0x80, 0x4D, 0x90, 0x95, 0x44, 0xE0, 0x64, 0x03, ++0x70, 0x54, 0xD1, 0x25, 0x90, 0x95, 0xAA, 0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x43, 0xD1, 0x5B, ++0xEF, 0x70, 0x11, 0xD1, 0x25, 0x90, 0x95, 0xAA, 0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x3F, 0xD1, ++0x5B, 0xEF, 0x60, 0x2A, 0x90, 0x95, 0x2E, 0xE0, 0xFF, 0x24, 0x90, 0xF5, 0x82, 0xE4, 0x34, 0x95, ++0xF5, 0x83, 0xE0, 0x60, 0x02, 0x80, 0x0B, 0x90, 0x95, 0x2E, 0xE0, 0xFF, 0x24, 0x8B, 0xF1, 0xD4, ++0x60, 0x05, 0x74, 0x9F, 0x2F, 0x80, 0x15, 0xB1, 0xEB, 0x74, 0x01, 0xF0, 0x80, 0x12, 0x90, 0x95, ++0x2E, 0xE0, 0x24, 0x9F, 0x80, 0x06, 0x90, 0x95, 0x2E, 0xE0, 0x24, 0x9F, 0xB1, 0xF1, 0xE4, 0xF0, ++0xB1, 0xCA, 0x41, 0xF8, 0x90, 0x95, 0x9F, 0xE0, 0x70, 0x4F, 0xA3, 0xE0, 0x70, 0x4B, 0xA3, 0xE0, ++0x70, 0x47, 0xA3, 0xE0, 0x70, 0x43, 0xA3, 0xE0, 0x70, 0x3F, 0x81, 0x8F, 0xE4, 0x90, 0x95, 0x2E, ++0xF0, 0xB1, 0xD1, 0x50, 0x1C, 0x74, 0x8B, 0x2E, 0xF1, 0xD4, 0x60, 0x09, 0x74, 0x9F, 0x2E, 0xB1, ++0xF1, 0xE4, 0xF0, 0x80, 0x08, 0x74, 0x9F, 0x2E, 0xB1, 0xF1, 0x74, 0x01, 0xF0, 0xB1, 0xCA, 0x80, ++0xE0, 0x90, 0x95, 0x9F, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0xA3, 0xE0, 0x70, 0x0A, 0xA3, ++0xE0, 0x70, 0x06, 0xA3, 0xE0, 0x70, 0x02, 0x81, 0x8F, 0xE4, 0x90, 0x95, 0x2E, 0xF0, 0xB1, 0xD1, ++0x40, 0x02, 0x81, 0x8F, 0xB1, 0xF9, 0xB1, 0xEB, 0xE0, 0x70, 0x02, 0x81, 0x8B, 0x90, 0x93, 0x29, ++0xE0, 0x30, 0xE0, 0x06, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x71, 0xE4, 0xFF, 0xFE, 0x90, 0x04, 0x1D, ++0xE0, 0x60, 0x10, 0xD3, 0xEF, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x50, 0x07, 0x0F, 0xBF, 0x00, 0x01, ++0x0E, 0x80, 0xEA, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x52, 0x90, 0x95, 0x2E, 0xE0, 0x24, 0x86, 0xF5, ++0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x06, 0xF0, 0x7B, 0x08, ++0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x95, 0x27, 0xEE, 0xF0, 0xA3, 0xF1, 0xBA, 0xD1, 0x08, 0x94, ++0x06, 0x50, 0x1E, 0xB1, 0xDE, 0x24, 0x0A, 0xF1, 0xB2, 0xB1, 0xBE, 0x90, 0x95, 0x27, 0xA3, 0xE0, ++0xFE, 0x90, 0x95, 0x2D, 0xE0, 0x2E, 0x24, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xD1, 0x1A, 0x80, ++0xDC, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x90, 0x06, 0x35, 0xF0, 0xB1, 0xCA, 0x61, 0xFE, 0x12, ++0xCE, 0x52, 0x90, 0x06, 0x36, 0x74, 0xDD, 0xF0, 0x21, 0xB6, 0x90, 0x95, 0x2C, 0xE0, 0x60, 0x02, ++0xA1, 0x91, 0xB1, 0xDE, 0x24, 0x16, 0xFD, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0x90, 0x06, 0x34, 0xEF, ++0xF0, 0xB1, 0xDE, 0x24, 0x17, 0xFD, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0x90, 0x06, 0x37, 0xF1, 0xAA, ++0xB1, 0xD1, 0x50, 0x3C, 0xB1, 0xF9, 0xE4, 0x90, 0x95, 0x2D, 0xF0, 0xD1, 0x08, 0x94, 0x06, 0x50, ++0x2B, 0xB1, 0xDE, 0x24, 0x04, 0x2D, 0xFD, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0x90, 0x95, 0x2E, 0xE0, ++0xFE, 0x12, 0xD2, 0x28, 0x12, 0x86, 0x71, 0x90, 0x95, 0x2D, 0xE0, 0xF5, 0x82, 0xD1, 0x89, 0x6F, ++0x60, 0x06, 0xD1, 0x0F, 0xE4, 0xF0, 0x80, 0x04, 0xD1, 0x1E, 0x80, 0xCF, 0xB1, 0xCA, 0x80, 0xC0, ++0x90, 0x95, 0x9A, 0xE0, 0x64, 0x01, 0x60, 0x17, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x11, 0xA3, 0xE0, ++0x64, 0x01, 0x60, 0x0B, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x05, 0xA3, 0xE0, 0xB4, 0x01, 0x06, 0x90, ++0x95, 0x2F, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x2F, 0xE0, 0x64, 0x01, 0x70, 0x4F, 0x11, 0xB2, 0x12, ++0xBD, 0x71, 0x12, 0xBB, 0x83, 0x90, 0x93, 0x25, 0xE0, 0x70, 0x02, 0x21, 0xB6, 0x90, 0x01, 0x3C, ++0xE0, 0x30, 0xE4, 0x03, 0x74, 0x10, 0xF0, 0x7D, 0x10, 0xE4, 0xFF, 0x12, 0x7C, 0x05, 0x90, 0x93, ++0x26, 0xE0, 0x60, 0x08, 0xF5, 0x4D, 0xE4, 0xF5, 0x4E, 0xFB, 0x80, 0x15, 0x90, 0x93, 0x27, 0xE0, ++0x60, 0x08, 0xFB, 0xE4, 0xF5, 0x4D, 0xF5, 0x4E, 0x80, 0x07, 0x75, 0x4D, 0x20, 0xE4, 0xF5, 0x4E, ++0xFB, 0x7D, 0x01, 0x7F, 0x60, 0x7E, 0x01, 0x12, 0x72, 0xB7, 0x21, 0xB6, 0xF1, 0xCB, 0xD1, 0x51, ++0x90, 0x95, 0x2E, 0xF0, 0xB1, 0xD1, 0x50, 0x09, 0xD1, 0x0F, 0x74, 0x01, 0xF0, 0xB1, 0xCA, 0x80, ++0xF3, 0x12, 0xCE, 0x52, 0x21, 0xB6, 0x22, 0x90, 0x86, 0xB6, 0xE0, 0xFF, 0x90, 0x96, 0x65, 0xE0, ++0xFB, 0x90, 0x92, 0x13, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x96, 0x66, 0xEE, ++0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x96, 0x64, 0xE0, 0xFF, 0x90, 0x8A, 0x95, 0xE0, 0xFA, ++0xA3, 0xE0, 0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, 0x90, 0x95, 0x2E, 0xE0, 0x04, 0xF0, ++0x22, 0x90, 0x93, 0x0E, 0xE0, 0xFF, 0x90, 0x95, 0x2E, 0xE0, 0xFE, 0xC3, 0x9F, 0x22, 0x90, 0x95, ++0x25, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x29, 0xE0, 0x22, 0x90, 0x95, 0x2E, 0xE0, 0x24, ++0x9F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0x74, 0x86, 0x2E, 0xF5, 0x82, 0xE4, 0x34, ++0x95, 0xF5, 0x83, 0xE0, 0xFF, 0x02, 0x7B, 0x07, 0x90, 0x95, 0x2D, 0xE0, 0xFD, 0xC3, 0x22, 0x74, ++0x9A, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x95, ++0x2D, 0xE0, 0x04, 0xF0, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x45, 0x90, 0x95, 0xA7, 0x02, 0x86, ++0x7A, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x95, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, ++0x90, 0x96, 0x17, 0xE0, 0xFF, 0x90, 0x95, 0x35, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, ++0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x95, 0xA4, 0x12, 0x86, ++0x7A, 0xE4, 0xFF, 0x90, 0x95, 0xAA, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x14, 0x90, 0x95, 0xA7, ++0xD1, 0x84, 0xFE, 0x90, 0x95, 0xA4, 0xD1, 0x84, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x0F, 0x80, ++0xE2, 0x7F, 0x01, 0x22, 0x12, 0x86, 0x71, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x02, 0x02, 0x1F, 0xE4, ++0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x85, 0x4E, 0x90, 0x95, 0x22, 0xEF, 0xF0, 0x60, 0xF0, 0x90, ++0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE0, 0x0F, ++0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x35, 0xBE, 0x12, 0xC0, 0x91, 0xD1, ++0xFE, 0x30, 0xE1, 0x09, 0x54, 0xFD, 0xF0, 0x90, 0x86, 0x08, 0x12, 0x8D, 0xDA, 0xD1, 0xFE, 0x30, ++0xE2, 0x09, 0x54, 0xFB, 0xF0, 0x90, 0x86, 0x0A, 0x12, 0x8D, 0xDA, 0xD1, 0xFE, 0xFF, 0x30, 0xE5, ++0x0B, 0x54, 0xDF, 0xF0, 0x12, 0xB6, 0xF0, 0xBF, 0x01, 0x02, 0x11, 0xC7, 0xD1, 0xFE, 0x30, 0xE6, ++0x09, 0x54, 0xBF, 0xF0, 0x90, 0x8A, 0x7D, 0x12, 0x8D, 0xDA, 0xD2, 0xAF, 0x80, 0xA1, 0xD2, 0xAF, ++0xC2, 0xAF, 0x90, 0x86, 0xAF, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, ++0x64, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x9D, 0xE0, ++0x30, 0xE0, 0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x3D, ++0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0x68, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x7D, 0x26, ++0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xFD, 0x12, 0x8D, 0xDA, 0xEF, 0x64, 0x01, 0x70, 0x02, ++0x80, 0x05, 0xF1, 0xDD, 0x30, 0xE0, 0x06, 0xB1, 0x97, 0xF1, 0xE7, 0xF1, 0x9E, 0x90, 0x96, 0x68, ++0xE0, 0x12, 0xCD, 0x09, 0x7D, 0x27, 0x12, 0x04, 0x7E, 0xF1, 0xC2, 0x80, 0x08, 0xF1, 0xC2, 0xF1, ++0x9E, 0xB1, 0x97, 0xF1, 0xE7, 0xF1, 0x9E, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x13, 0xF1, 0xDD, ++0x30, 0xE0, 0x0E, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x6F, 0x12, 0xCD, 0x09, 0x7D, 0x28, 0x12, 0x04, ++0x7E, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFC, ++0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x02, 0x04, 0x7E, 0xEF, 0xF0, 0xE4, 0x90, 0x95, 0x2E, ++0xF0, 0x22, 0xFC, 0xED, 0x2C, 0xFD, 0x90, 0x8A, 0xE9, 0x22, 0xEF, 0xF0, 0xE4, 0x90, 0x95, 0x2D, ++0xF0, 0x22, 0x90, 0x96, 0x64, 0xE0, 0xFF, 0x90, 0x8A, 0xC7, 0x22, 0xE4, 0x90, 0x95, 0x2F, 0xF0, ++0x90, 0x95, 0x9A, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x88, 0xA1, ++0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x96, 0x66, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, ++0x8A, 0x9B, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x12, 0x8F, 0xF5, 0x12, 0x8B, ++0x6E, 0x11, 0x0A, 0x7A, 0x93, 0x79, 0x1B, 0x02, 0x69, 0xF5, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, ++0x75, 0x48, 0x05, 0x7B, 0x01, 0x22, 0x12, 0x8F, 0xF5, 0x12, 0x8B, 0x6E, 0x11, 0x0A, 0x7A, 0x93, ++0x79, 0x20, 0x02, 0x69, 0xF5, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0x28, 0xF0, 0xBF, 0x01, 0x07, ++0x11, 0x38, 0xE4, 0x90, 0x93, 0x28, 0xF0, 0x22, 0x11, 0xCF, 0x71, 0xC9, 0xBF, 0x01, 0x06, 0x90, ++0x94, 0xA2, 0xE0, 0xA3, 0xF0, 0x11, 0xCF, 0x71, 0xC2, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xA2, 0xE0, ++0x90, 0x94, 0xA4, 0xF0, 0x11, 0xCF, 0x71, 0xD0, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xA2, 0xE0, 0x90, ++0x94, 0xA5, 0xF0, 0x11, 0xCF, 0x11, 0xD6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xA2, 0xE0, 0x90, 0x94, ++0xA6, 0xF0, 0x11, 0xCF, 0x71, 0xBB, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xA2, 0xE0, 0x90, 0x94, 0xA7, ++0xF0, 0x90, 0x94, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x94, ++0xAB, 0xF0, 0x90, 0x94, 0xA7, 0xE0, 0x90, 0x94, 0xAC, 0xF0, 0x90, 0x94, 0xAD, 0x74, 0x12, 0xF0, ++0x90, 0x94, 0xCF, 0x74, 0x05, 0xF0, 0x90, 0x94, 0xAF, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, ++0xF0, 0x90, 0x94, 0xAB, 0xE0, 0x90, 0x94, 0xB2, 0xF0, 0x90, 0x94, 0xAC, 0xE0, 0x90, 0x94, 0xB3, ++0xF0, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xAD, 0x12, 0x8D, 0xB6, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x7B, ++0x01, 0x7A, 0x94, 0x79, 0xA2, 0x22, 0x7F, 0xF3, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x90, 0x94, 0xA2, ++0xEF, 0xF0, 0x71, 0x13, 0x71, 0xD0, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, 0xEB, ++0xF0, 0x71, 0x13, 0x71, 0xC9, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, 0xEC, 0xF0, ++0x71, 0x13, 0x71, 0xC2, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, 0xED, 0xF0, 0x71, ++0x13, 0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, ++0x94, 0xEE, 0xF0, 0x71, 0x13, 0x7F, 0xF8, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, ++0x94, 0xE9, 0xE0, 0x90, 0x94, 0xEF, 0xF0, 0x71, 0x13, 0x71, 0xB4, 0xBF, 0x01, 0x08, 0x90, 0x94, ++0xE9, 0xE0, 0x90, 0x94, 0xF0, 0xF0, 0x71, 0x13, 0x71, 0x1A, 0x70, 0x52, 0x90, 0x94, 0xE9, 0xE0, ++0x90, 0x94, 0xF1, 0xF0, 0x54, 0x07, 0x60, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x54, 0xE0, 0x70, 0x3E, ++0x7B, 0x01, 0x7A, 0x94, 0x79, 0xEA, 0x7F, 0xFA, 0x71, 0x1C, 0x70, 0x32, 0x90, 0x94, 0xE9, 0xE0, ++0xFC, 0x54, 0x07, 0x70, 0x12, 0x90, 0x94, 0xF1, 0xE0, 0xFE, 0x90, 0x94, 0xEA, 0xE0, 0x54, 0x07, ++0xFD, 0xEE, 0x4D, 0x90, 0x94, 0xF1, 0xF0, 0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, 0x94, 0xF1, 0xE0, ++0xFF, 0x90, 0x94, 0xEA, 0xE0, 0x54, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x94, 0xF1, 0xF0, 0x71, 0x13, ++0x7F, 0xFD, 0x71, 0x1C, 0x70, 0x46, 0x90, 0x94, 0xE9, 0xE0, 0xFE, 0x54, 0xCC, 0x90, 0x94, 0xF2, ++0xF0, 0xEE, 0x54, 0x0C, 0xFF, 0x60, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x54, 0xC0, 0x70, 0x2D, 0xEF, ++0x70, 0x11, 0x90, 0x94, 0xF2, 0xE0, 0xFF, 0x90, 0x94, 0xE9, 0xE0, 0x54, 0x03, 0xF1, 0xCF, 0x90, ++0x94, 0xF2, 0xF0, 0x90, 0x94, 0xE9, 0xE0, 0xFF, 0x54, 0xC0, 0x70, 0x10, 0x90, 0x94, 0xF2, 0xE0, ++0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0xEE, 0x4F, 0xF0, 0x71, 0x13, 0x7F, 0xF0, ++0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, 0xF3, 0xF0, ++0x71, 0x13, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, ++0x90, 0x94, 0xF4, 0xF0, 0x71, 0x13, 0x71, 0xBB, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, ++0x94, 0xF5, 0xF0, 0x71, 0x13, 0x11, 0xD6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, ++0xF6, 0xF0, 0x71, 0x13, 0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, ++0xE9, 0xE0, 0x90, 0x94, 0xF7, 0xF0, 0x90, 0x94, 0xA3, 0x74, 0x19, 0xF0, 0x90, 0x94, 0xC5, 0x74, ++0x08, 0xF0, 0x90, 0x94, 0xEB, 0xE0, 0x90, 0x94, 0xA5, 0xF0, 0x90, 0x94, 0xEC, 0xE0, 0x90, 0x94, ++0xA6, 0xF0, 0x90, 0x94, 0xED, 0xE0, 0x90, 0x94, 0xA7, 0xF0, 0x90, 0x94, 0xEE, 0xE0, 0x90, 0x94, ++0xA8, 0xF0, 0x90, 0x94, 0xEF, 0xE0, 0x90, 0x94, 0xA9, 0xF0, 0x90, 0x94, 0xF0, 0xE0, 0x90, 0x94, ++0xAA, 0xF0, 0x90, 0x94, 0xF1, 0xE0, 0x90, 0x94, 0xAB, 0xF0, 0x90, 0x94, 0xF2, 0xE0, 0x90, 0x94, ++0xAC, 0xF0, 0x90, 0x94, 0xC6, 0x74, 0x1A, 0xF0, 0x90, 0x94, 0xE8, 0x74, 0x05, 0xF0, 0x90, 0x94, ++0xF3, 0xE0, 0x90, 0x94, 0xC8, 0xF0, 0x90, 0x94, 0xF4, 0xE0, 0x90, 0x94, 0xC9, 0xF0, 0x90, 0x94, ++0xF5, 0xE0, 0x90, 0x94, 0xCA, 0xF0, 0x90, 0x94, 0xF6, 0xE0, 0x90, 0x94, 0xCB, 0xF0, 0x90, 0x94, ++0xF7, 0xE0, 0x90, 0x94, 0xCC, 0xF0, 0x90, 0x94, 0xA2, 0xE0, 0xB4, 0x01, 0x1C, 0x7B, 0x01, 0x7A, ++0x94, 0x79, 0xA3, 0x90, 0x8A, 0x77, 0xF1, 0xE9, 0x12, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x94, 0x79, ++0xC6, 0x12, 0x8D, 0xB6, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, 0x46, 0x94, 0x75, ++0x47, 0xA3, 0x75, 0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x69, 0xF5, 0x75, 0x45, ++0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0xC8, 0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xAA, ++0x02, 0x69, 0xF5, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xE9, 0x22, 0x7F, 0xFB, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xEF, 0x64, 0x01, 0x22, 0x7E, 0x00, 0x7F, 0x0B, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, ++0x4B, 0x12, 0x04, 0x80, 0x71, 0xAD, 0x71, 0xB4, 0xBF, 0x01, 0x1C, 0x90, 0x94, 0x9E, 0xE0, 0xFE, ++0x54, 0x01, 0x90, 0x93, 0x4B, 0xF0, 0xEE, 0x54, 0x04, 0x90, 0x93, 0x4D, 0xF0, 0x90, 0x94, 0x9E, ++0xE0, 0x54, 0x08, 0x90, 0x93, 0x4C, 0xF0, 0x71, 0xAD, 0x71, 0x1A, 0x70, 0x35, 0x90, 0x94, 0x9E, ++0xE0, 0x54, 0x07, 0x70, 0x15, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0x9F, 0x7F, 0xFA, 0x7E, 0x01, 0x12, ++0x5F, 0xA6, 0xBF, 0x01, 0x0F, 0x90, 0x94, 0x9F, 0x80, 0x03, 0x90, 0x94, 0x9E, 0xE0, 0x54, 0x07, ++0x90, 0x93, 0x4F, 0xF0, 0x90, 0x94, 0x9E, 0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, ++0x4E, 0xF0, 0x71, 0xAD, 0x7F, 0xFD, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, 0x94, ++0x9E, 0xE0, 0x54, 0x0C, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x93, 0x50, 0xF0, 0x22, 0x7B, 0x01, 0x7A, ++0x94, 0x79, 0x9E, 0x22, 0x7F, 0xF9, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF2, 0x7E, 0x01, 0x02, ++0x5F, 0xA6, 0x7F, 0xF6, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF5, 0x7E, 0x01, 0x02, 0x5F, 0xA6, ++0x7F, 0xF4, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, ++0x12, 0x7B, 0x2E, 0x12, 0xB9, 0x90, 0x12, 0xC8, 0x7B, 0x12, 0x7B, 0x79, 0x12, 0xC8, 0x88, 0x12, ++0xB9, 0x23, 0x7F, 0x01, 0x12, 0x84, 0x15, 0x90, 0x93, 0x48, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x84, ++0x15, 0x90, 0x93, 0x48, 0xE0, 0x04, 0xF0, 0x91, 0x4B, 0x91, 0x97, 0x90, 0x00, 0x80, 0xE0, 0x44, ++0x40, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x75, 0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, 0x01, 0xA0, ++0xE0, 0xB4, 0xFD, 0x04, 0xE4, 0xFF, 0x11, 0xDD, 0xB1, 0x63, 0x90, 0x00, 0x81, 0xE0, 0x44, 0x04, ++0xFD, 0x7F, 0x81, 0x12, 0x7B, 0x2E, 0xF1, 0xDF, 0x71, 0x25, 0x90, 0x00, 0xAA, 0xE0, 0x44, 0x02, ++0xF0, 0xA3, 0xE0, 0x44, 0x80, 0xF0, 0xE4, 0xFF, 0x02, 0x84, 0x9E, 0x12, 0x7B, 0x1B, 0x90, 0x86, ++0xB3, 0xEF, 0xF0, 0x91, 0x65, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, ++0x80, 0xF0, 0x02, 0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, 0x75, 0xE0, 0x12, 0xB9, 0x2F, 0x12, 0xB9, ++0x68, 0xE4, 0xF5, 0x21, 0xF5, 0x22, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, 0x21, 0x7F, 0x50, 0x12, ++0x7B, 0x2E, 0xAD, 0x22, 0x7F, 0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, 0x52, 0x12, 0x7B, 0x2E, ++0xAD, 0x24, 0x7F, 0x53, 0x02, 0x7B, 0x2E, 0xF1, 0x2A, 0x12, 0x7B, 0xDB, 0x90, 0x8A, 0xC5, 0x12, ++0x8D, 0xDA, 0xB1, 0xB4, 0xD1, 0x31, 0x91, 0xBB, 0x12, 0xCE, 0x8B, 0x90, 0x8A, 0x73, 0x12, 0x8D, ++0xDA, 0x12, 0xC8, 0x5E, 0x90, 0x93, 0x49, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x93, 0x29, 0xE0, 0x54, ++0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xEF, 0xF0, 0x44, 0x08, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0xFF, ++0x64, 0x02, 0x70, 0x29, 0xB1, 0x5C, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x2F, 0xB1, 0x5A, ++0x30, 0xE1, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x2D, 0xB1, 0x5A, 0x30, 0xE2, 0x02, 0x7E, 0x01, 0x90, ++0x93, 0x2E, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, 0x90, 0x02, 0xFB, 0xF0, 0x22, 0xEF, 0x64, 0x01, ++0x70, 0x1D, 0xB1, 0x53, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2F, 0xB1, 0x51, 0x30, 0xE1, ++0x02, 0x7F, 0x01, 0x90, 0x93, 0x2D, 0xB1, 0x51, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, 0x23, 0x90, ++0x86, 0xB3, 0xE0, 0x64, 0x03, 0x70, 0x20, 0xB1, 0x4A, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, ++0x2F, 0xB1, 0x48, 0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2D, 0xB1, 0x48, 0x30, 0xE2, 0x02, ++0x7F, 0x01, 0x90, 0x93, 0x2E, 0xEF, 0xF0, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, ++0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x70, 0xE0, 0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, ++0x7E, 0x00, 0x22, 0xE4, 0x90, 0x94, 0x9E, 0xF0, 0xA3, 0xF0, 0x12, 0xC8, 0xA8, 0xEF, 0x64, 0x01, ++0x60, 0x3B, 0xC3, 0x90, 0x94, 0x9F, 0xE0, 0x94, 0x88, 0x90, 0x94, 0x9E, 0xE0, 0x94, 0x13, 0x40, ++0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1D, ++0x90, 0x94, 0x9E, 0xF1, 0xC0, 0xF1, 0xC8, 0xD3, 0x90, 0x94, 0x9F, 0xE0, 0x94, 0x32, 0x90, 0x94, ++0x9E, 0xE0, 0x94, 0x00, 0x40, 0xC4, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xBD, 0x90, 0x01, 0xC7, ++0x74, 0xFE, 0xF0, 0x22, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, 0x90, 0x89, 0x2E, 0x12, 0x86, 0x7A, ++0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x80, 0x90, 0x89, 0x31, 0x12, 0x86, 0x7A, 0x7A, 0x80, 0x79, 0xBF, ++0x90, 0x89, 0x34, 0x12, 0x86, 0x7A, 0x7A, 0x81, 0x79, 0x61, 0x90, 0x89, 0x3A, 0x12, 0x86, 0x7A, ++0x7A, 0x81, 0x79, 0x75, 0x90, 0x89, 0x3D, 0x12, 0x86, 0x7A, 0x7A, 0x81, 0x79, 0x9D, 0x90, 0x89, ++0x40, 0x12, 0x86, 0x7A, 0xF1, 0xD7, 0x12, 0x86, 0x7A, 0x7A, 0x81, 0x79, 0xD9, 0x90, 0x89, 0x49, ++0x12, 0x86, 0x7A, 0x7A, 0x82, 0x79, 0x01, 0x90, 0x89, 0x4C, 0x12, 0x86, 0x7A, 0xE4, 0x90, 0x96, ++0x17, 0xF0, 0x90, 0x94, 0x9E, 0xF0, 0x90, 0x94, 0x9E, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x10, ++0x74, 0x28, 0x2F, 0x12, 0xC6, 0x87, 0xE4, 0xF0, 0x90, 0x94, 0x9E, 0xE0, 0x04, 0xF0, 0x80, 0xE6, ++0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x31, 0x12, 0x04, 0x80, ++0x90, 0x88, 0x35, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x50, ++0xF0, 0x90, 0x88, 0x42, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF1, 0x14, 0xFF, 0xF1, 0x1C, 0x12, 0xD0, ++0x29, 0x90, 0x8A, 0x89, 0x12, 0x8D, 0xC8, 0xF1, 0x30, 0x90, 0x8A, 0x89, 0x12, 0x8D, 0xC8, 0x7D, ++0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0x12, 0x8D, 0xC8, 0x12, 0x8F, 0xFB, 0x90, ++0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x80, 0x11, 0xEF, ++0xB4, 0x03, 0x08, 0x90, 0x88, 0x41, 0x74, 0x14, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0x41, 0xF0, ++0x7F, 0x79, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, 0x28, 0x12, 0x7B, ++0x41, 0xEF, 0x30, 0xE2, 0x06, 0x90, 0x88, 0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, 0x74, 0x02, ++0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0xF1, ++0x14, 0xF1, 0x1C, 0x7E, 0x00, 0x7F, 0x18, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x30, 0x12, ++0x04, 0x80, 0x90, 0x8A, 0xA3, 0x12, 0x8D, 0xC8, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x7E, 0x00, 0x7F, ++0x02, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, ++0x54, 0x7F, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, ++0x88, 0x9C, 0xF0, 0x22, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, 0x22, 0x33, 0x33, 0x33, 0x54, ++0xF8, 0x90, 0x88, 0x4E, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x22, 0xE4, 0xFD, 0xFF, 0x02, 0x6E, 0x71, ++0xE4, 0xFD, 0xFF, 0x02, 0x04, 0x7E, 0xF1, 0x7C, 0x90, 0x95, 0xD0, 0xEF, 0xF0, 0x90, 0x8A, 0x89, ++0x30, 0xE0, 0x13, 0x12, 0x8D, 0xC8, 0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x33, ++0xE0, 0x44, 0x04, 0xF0, 0x80, 0x05, 0x12, 0x8D, 0xC8, 0xF1, 0x30, 0x90, 0x95, 0xD0, 0xE0, 0x30, ++0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, ++0x74, 0x80, 0xF0, 0x12, 0xCD, 0x55, 0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0xE4, 0x90, 0x95, 0xD2, ++0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, 0x90, 0x95, 0xD1, 0xEF, 0xF0, 0x7F, 0x83, 0x12, ++0x7B, 0x41, 0xAE, 0x07, 0x90, 0x95, 0xD1, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x95, ++0xD3, 0xE0, 0x94, 0x64, 0x90, 0x95, 0xD2, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, ++0x44, 0x40, 0xF0, 0x90, 0x95, 0xD1, 0xE0, 0xFF, 0x22, 0x90, 0x95, 0xD2, 0xF1, 0xC0, 0x80, 0xC3, ++0xE4, 0x75, 0xF0, 0x01, 0x02, 0x02, 0xE7, 0xF0, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x25, ++0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0x22, 0x7A, 0x81, 0x79, 0xB1, 0x90, 0x89, 0x46, 0x22, 0x90, ++0x01, 0xE4, 0x74, 0x10, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, ++0x8E, 0x83, 0x22, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x5B, 0xE0, 0x54, 0xFE, 0x4F, ++0xF0, 0x22, 0x12, 0x8F, 0xF5, 0x12, 0x8B, 0x6E, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x7F, 0x90, 0x88, ++0x36, 0xF0, 0xEF, 0x12, 0x8F, 0xCA, 0xA3, 0x12, 0x87, 0x3C, 0xFD, 0x54, 0xF0, 0xC4, 0x54, 0x0F, ++0xFF, 0x90, 0x88, 0x34, 0xE0, 0x54, 0xF0, 0x4F, 0x12, 0x8F, 0xBF, 0xFC, 0x54, 0x01, 0x25, 0xE0, ++0xFF, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, 0x04, 0xC3, 0x13, 0xFF, 0x90, ++0x88, 0x33, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xA3, 0xE0, ++0x54, 0x0F, 0x12, 0x87, 0x34, 0x90, 0x88, 0x35, 0x31, 0x04, 0xFD, 0x90, 0x8A, 0x89, 0x12, 0x8D, ++0xC8, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x8B, 0x6E, 0x12, 0x87, 0x2E, 0xFF, 0x54, 0x01, 0xFE, ++0x90, 0x88, 0x9B, 0x12, 0xB8, 0xE0, 0x12, 0x87, 0x2C, 0x12, 0xB8, 0xD6, 0x90, 0x88, 0x9B, 0x12, ++0xB8, 0xCD, 0x12, 0x87, 0x2B, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x90, 0x88, ++0x9B, 0xF0, 0xEE, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x12, 0x87, 0x2B, 0x54, 0x40, 0xFE, 0xEF, ++0x54, 0xBF, 0x4E, 0x90, 0x88, 0x9B, 0xF0, 0x12, 0xBD, 0x61, 0x20, 0xE0, 0x2F, 0xEF, 0xC3, 0x13, ++0x20, 0xE0, 0x0B, 0x75, 0x62, 0x01, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x0B, 0x80, 0x0E, 0xE4, 0xF5, ++0x62, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x05, 0xE4, 0xF5, 0x61, 0x80, 0x03, 0x75, 0x61, 0x01, 0x90, ++0x8A, 0xF3, 0x12, 0x8D, 0xC8, 0xAD, 0x62, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x12, 0x8B, 0x6E, 0x12, ++0x5C, 0x5F, 0x90, 0x88, 0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFB, 0xF0, ++0x12, 0xBD, 0x57, 0xF0, 0x90, 0x88, 0x36, 0x12, 0xD2, 0x4E, 0x90, 0x01, 0xBB, 0x31, 0x0B, 0x90, ++0x01, 0xBE, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x02, 0x1F, 0xF0, 0x90, 0x88, 0x34, 0xE0, ++0x54, 0x0F, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x17, 0x90, 0x88, 0x36, 0xE0, 0x60, ++0x11, 0x31, 0x0C, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x31, 0x83, 0x02, 0x04, 0x7A, 0x12, ++0x73, 0x8F, 0x22, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xB1, 0x6E, 0x90, 0x88, 0x9D, ++0xE0, 0x20, 0xE0, 0x3E, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x36, 0x90, 0x8A, 0xD7, 0x12, ++0x8D, 0xDA, 0x31, 0x0C, 0x60, 0x1E, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0xC8, 0xE4, 0xFD, 0x7F, 0x0C, ++0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x12, 0x9F, 0x30, 0x90, 0x8B, 0x01, 0x31, ++0x83, 0x02, 0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0xC8, ++0x51, 0x87, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x22, 0x31, 0x9C, 0xF1, 0xDA, 0x7F, ++0x01, 0x12, 0xD1, 0x76, 0x90, 0x8B, 0x07, 0x31, 0x83, 0x02, 0x04, 0x7A, 0xE4, 0x90, 0x95, 0xD0, ++0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x34, 0x91, 0xDB, 0x70, 0x30, 0x12, 0xD2, 0x8D, 0xF0, 0x12, ++0xD1, 0xF2, 0x90, 0x95, 0xD0, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x88, 0x3D, 0xF0, 0x04, 0x60, 0x1B, ++0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0xC8, 0x51, 0x87, 0x91, ++0xD3, 0x31, 0xDC, 0x51, 0x79, 0x90, 0x8A, 0xD7, 0x12, 0x8D, 0xDA, 0x22, 0xE4, 0x90, 0x92, 0x20, ++0xF0, 0x90, 0x88, 0x3E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xE4, 0xF5, 0x7B, 0x90, 0x88, ++0x36, 0xE0, 0x60, 0x7A, 0x91, 0xDB, 0x70, 0x76, 0x12, 0xD1, 0xF2, 0x12, 0xD2, 0x85, 0x60, 0x22, ++0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, ++0x06, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xA3, 0xF0, ++0x80, 0x00, 0x75, 0x7B, 0x01, 0xE5, 0x7B, 0x60, 0x45, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, ++0x90, 0x8A, 0xB9, 0x12, 0x8D, 0xC8, 0x51, 0x87, 0x91, 0xD3, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x04, ++0x64, 0x01, 0x70, 0x0F, 0x31, 0xDC, 0xFF, 0xA3, 0xE0, 0x2F, 0x51, 0x79, 0x31, 0xE1, 0xFF, 0xA3, ++0xE0, 0x80, 0x0B, 0x31, 0xDC, 0x51, 0x8E, 0x2F, 0x51, 0x79, 0x31, 0xE1, 0x51, 0x8E, 0x2F, 0x33, ++0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4F, 0xF0, 0x90, 0x8A, 0xD7, 0x12, 0x8D, 0xDA, 0x22, 0xF0, ++0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, ++0x7F, 0x54, 0x7E, 0x01, 0x02, 0x66, 0x33, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0xFF, 0xA3, ++0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, 0xE4, 0xF5, 0x7B, 0x90, 0x06, 0xA9, 0xE0, 0xF5, ++0x7B, 0x54, 0xC0, 0x70, 0x17, 0x51, 0xFE, 0x54, 0xFD, 0xF0, 0xB1, 0x6B, 0x90, 0x88, 0x39, 0xE0, ++0x60, 0x4B, 0xF1, 0xD3, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE5, 0x7B, 0x30, 0xE6, ++0x21, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x1B, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0x31, ++0x0B, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x12, 0x8D, 0xDA, 0x80, 0x07, 0x12, 0x73, 0x8F, ++0x80, 0x02, 0x51, 0xFE, 0xE5, 0x7B, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0D, 0xE0, 0x44, 0x02, 0x51, ++0x6F, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x88, ++0x3A, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0x8F, ++0x80, 0x03, 0x90, 0x8A, 0x87, 0x12, 0x8D, 0xDA, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x04, 0xA3, ++0xE0, 0x04, 0xF0, 0x90, 0x88, 0xE7, 0xE0, 0x64, 0x08, 0x70, 0x20, 0x90, 0x88, 0xE6, 0xE0, 0x30, ++0xE0, 0x14, 0x12, 0xB3, 0xF5, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0xE6, 0xE0, 0x54, 0xFE, ++0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, 0x12, 0x97, 0xDD, 0x30, 0xE0, ++0x13, 0x90, 0x88, 0xE8, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, 0xF0, ++0x90, 0x88, 0xE8, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0x61, 0xEA, 0x90, 0x88, 0x4D, 0xE0, ++0x04, 0xF0, 0x90, 0x05, 0x61, 0x91, 0x37, 0x12, 0xD2, 0x1A, 0x90, 0x05, 0x60, 0x91, 0x37, 0x12, ++0x86, 0x58, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x91, 0x37, 0x78, ++0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x58, 0xC0, ++0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x91, 0x36, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, ++0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x58, 0x90, 0x88, 0x81, 0x12, 0x04, 0x31, 0x90, ++0x88, 0x32, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0C, 0x12, 0xCD, 0x55, 0x74, 0x05, ++0xF0, 0x12, 0x6E, 0x2F, 0x12, 0xD1, 0x6E, 0x90, 0x88, 0x32, 0x31, 0xE4, 0x30, 0xE0, 0x0B, 0x90, ++0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x04, 0xF1, 0xB6, 0xF1, 0xE1, 0x12, 0xC9, 0x23, 0xBF, 0x03, 0x14, ++0x90, 0x93, 0x49, 0xE0, 0xB4, 0x01, 0x0D, 0x90, 0x01, 0xB8, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x21, ++0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0xC8, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, ++0x93, 0x29, 0xE0, 0x30, 0xE0, 0x08, 0x12, 0xD2, 0x58, 0x51, 0x78, 0x12, 0xB8, 0xBD, 0x90, 0x86, ++0xB3, 0xE0, 0xB4, 0x01, 0x10, 0xF1, 0xBD, 0x20, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, ++0xE0, 0x03, 0x12, 0xD1, 0xB6, 0x22, 0xA3, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, 0x08, ++0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, 0x6E, 0x12, 0xCD, 0xB1, 0x12, 0xCD, 0xAA, 0x90, 0x07, ++0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, 0x2F, 0x91, 0xCB, 0xE0, 0xFE, 0x74, 0x69, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x04, 0xE8, 0x90, ++0x96, 0x6A, 0x91, 0x37, 0x12, 0xD2, 0x1A, 0x90, 0x96, 0x69, 0x91, 0x37, 0x12, 0x86, 0x58, 0xC0, ++0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0x6B, 0x91, 0x37, 0x78, 0x10, 0x12, 0x03, ++0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x58, 0xC0, 0x04, 0xC0, 0x05, ++0xC0, 0x06, 0xC0, 0x07, 0x91, 0x36, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, ++0x01, 0xD0, 0x00, 0x12, 0x86, 0x58, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x07, ++0xF5, 0x83, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, ++0xEF, 0x64, 0x01, 0x22, 0x91, 0xDB, 0x70, 0x0A, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x04, 0xF1, 0xC8, ++0x51, 0x6F, 0x22, 0x90, 0x88, 0x32, 0xF1, 0xC0, 0x30, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x13, 0x54, ++0x03, 0x30, 0xE0, 0x02, 0xF1, 0xB6, 0x90, 0x88, 0x31, 0x12, 0xCD, 0x4E, 0x30, 0xE0, 0x0B, 0xEF, ++0x12, 0xD2, 0x44, 0xF0, 0x54, 0x07, 0x70, 0x4A, 0x80, 0x46, 0x90, 0x88, 0x3F, 0xE0, 0x04, 0xF0, ++0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEF, 0xF0, 0x12, 0xD0, 0x84, 0x40, 0x34, 0x91, 0xDB, 0x70, 0x32, ++0x31, 0x0C, 0x70, 0x08, 0x90, 0x8A, 0xF5, 0x12, 0x8D, 0xDA, 0x80, 0x27, 0x90, 0x8A, 0xF5, 0x12, ++0x8D, 0xDA, 0x90, 0x88, 0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x09, 0xB1, 0x63, ++0xE4, 0x90, 0x88, 0x40, 0xF0, 0x80, 0x03, 0x12, 0x73, 0x8F, 0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x22, ++0xB1, 0x6B, 0x22, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x88, 0x38, 0xE0, 0xFF, ++0x90, 0x8A, 0xB9, 0x12, 0xCD, 0x0D, 0x7D, 0x01, 0x02, 0x04, 0x7E, 0x91, 0xDB, 0x70, 0x17, 0x90, ++0x88, 0x36, 0xE0, 0x60, 0x11, 0xF1, 0xC8, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x12, 0xD2, 0x44, 0xF0, ++0x54, 0x07, 0x70, 0x02, 0xB1, 0x6B, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, ++0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, ++0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x97, 0xF0, 0x74, 0xA5, 0xA3, 0xF0, 0x12, 0x64, ++0x7F, 0xE5, 0x30, 0x30, 0xE1, 0x03, 0x12, 0xBE, 0xA4, 0xE5, 0x2D, 0x30, 0xE1, 0x02, 0xF1, 0xF0, ++0xE5, 0x2D, 0x30, 0xE3, 0x03, 0x12, 0xC8, 0xB4, 0xE5, 0x2D, 0x30, 0xE4, 0x03, 0x12, 0xC8, 0xC7, ++0xE5, 0x2D, 0x30, 0xE5, 0x03, 0x12, 0xC8, 0xD8, 0xE5, 0x2F, 0x30, 0xE0, 0x02, 0xD1, 0x77, 0xE5, ++0x2F, 0x30, 0xE1, 0x02, 0x71, 0x06, 0xE5, 0x2F, 0x30, 0xE2, 0x03, 0x12, 0xBE, 0x98, 0xE5, 0x2F, ++0x30, 0xE3, 0x02, 0x91, 0xE4, 0xE5, 0x2F, 0x30, 0xE4, 0x02, 0xB1, 0x7B, 0xE5, 0x2F, 0x30, 0xE5, ++0x02, 0x31, 0x13, 0xE5, 0x2F, 0x30, 0xE6, 0x02, 0xD1, 0x60, 0xE5, 0x2F, 0x30, 0xE7, 0x03, 0x12, ++0xC9, 0x14, 0xE5, 0x30, 0x30, 0xE0, 0x03, 0x12, 0xC9, 0x2B, 0xE5, 0x30, 0x30, 0xE4, 0x03, 0x12, ++0xC9, 0x3B, 0xE5, 0x30, 0x30, 0xE5, 0x03, 0x12, 0xC9, 0x40, 0x74, 0x97, 0x04, 0x90, 0x01, 0xC4, ++0xF0, 0x74, 0xA5, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, ++0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, ++0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x0E, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x08, 0x51, 0xFE, ++0x54, 0x07, 0x70, 0x02, 0xB1, 0x6B, 0x22, 0x31, 0xEB, 0xE4, 0xFF, 0x12, 0xD1, 0x76, 0x90, 0x93, ++0x03, 0xE0, 0x30, 0xE0, 0x03, 0x12, 0xCE, 0xAC, 0x90, 0x8B, 0x07, 0x12, 0x8D, 0xDA, 0x02, 0x8F, ++0xD1, 0x91, 0xDB, 0x60, 0x02, 0xE1, 0xB5, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0xE1, 0xB5, 0x90, ++0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x32, 0x90, 0x06, 0xA9, 0xE0, 0x54, 0xC0, 0x70, 0x2A, 0x90, 0x88, ++0x9C, 0xE0, 0x70, 0x24, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x70, 0x1D, 0xE0, 0x54, 0x07, 0x64, 0x07, ++0x70, 0x16, 0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, 0x70, 0x0E, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, ++0x07, 0xF1, 0xD3, 0x54, 0xFE, 0x12, 0xB1, 0x76, 0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, ++0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, ++0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, 0x90, 0x07, 0xF1, 0xE0, 0x90, 0x94, 0x9C, 0xF0, ++0x90, 0x07, 0xF0, 0xE0, 0x90, 0x94, 0x9D, 0xF0, 0xF1, 0xC8, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, ++0xEC, 0xF0, 0x12, 0xD2, 0x6A, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x02, 0x51, 0x98, 0x12, 0xD2, 0x6A, ++0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, 0x3D, 0xF0, 0x90, 0x06, 0xAA, 0xE0, ++0x90, 0x88, 0x3C, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xFE, 0xFF, 0x80, ++0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, 0x12, 0xCA, 0xCE, 0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x90, 0x88, ++0x32, 0xF1, 0xC0, 0x30, 0xE0, 0x5C, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x23, 0xF1, ++0xE8, 0x6F, 0x70, 0x4E, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0xD2, 0x8D, 0x12, 0xD2, ++0x61, 0x7F, 0x03, 0x12, 0x7C, 0x05, 0xF1, 0xE1, 0xF1, 0xB6, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, ++0x80, 0x30, 0x12, 0xD2, 0x85, 0x64, 0x01, 0x70, 0x29, 0xF1, 0xE8, 0xFE, 0x6F, 0x60, 0x23, 0x90, ++0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x1A, 0x12, 0xCD, 0x4B, 0x30, 0xE0, 0x14, 0xEF, 0x54, ++0xBF, 0x12, 0xD2, 0x61, 0x7F, 0x03, 0x12, 0x7C, 0x3B, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x7C, 0x74, ++0xF1, 0xDA, 0x12, 0xB8, 0xC5, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x90, 0x93, 0x29, ++0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, ++0x74, 0x02, 0x22, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, ++0x74, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, ++0xE4, 0xFF, 0x90, 0x95, 0xAB, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x95, ++0xCF, 0xF0, 0xE0, 0xFE, 0x6F, 0x60, 0x74, 0x90, 0x95, 0xAC, 0x74, 0x03, 0xF0, 0x90, 0x95, 0xCE, ++0x74, 0x08, 0xF0, 0xEE, 0x04, 0x54, 0x0F, 0xFF, 0xE4, 0xFE, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, ++0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2E, 0x11, 0x7C, 0xE0, 0xFD, 0x74, ++0xAE, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x08, 0xDA, ++0x7B, 0x01, 0x7A, 0x95, 0x79, 0xAC, 0x90, 0x8A, 0x77, 0x12, 0x9F, 0xE9, 0x12, 0x04, 0x7E, 0x90, ++0x95, 0xCF, 0xE0, 0x04, 0x54, 0x0F, 0xFF, 0xF0, 0xBF, 0x0F, 0x02, 0xE4, 0xF0, 0x90, 0x95, 0xCF, ++0xE0, 0x90, 0x04, 0x7F, 0xF0, 0x90, 0x95, 0xAB, 0xE0, 0x70, 0x05, 0x90, 0x8A, 0xE5, 0x80, 0x03, ++0x90, 0x8A, 0x79, 0x12, 0x8D, 0xC8, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xF5, 0x82, 0xE4, 0x35, ++0x83, 0xF5, 0x83, 0x22, 0x90, 0x94, 0x9E, 0x12, 0x86, 0x7A, 0x71, 0x4F, 0x12, 0x02, 0x06, 0x54, ++0x7F, 0xFD, 0x12, 0x87, 0x3D, 0xFE, 0x54, 0x1F, 0x90, 0x94, 0xA2, 0x12, 0x8F, 0xC6, 0x90, 0x94, ++0xA1, 0x12, 0x87, 0x35, 0xFE, 0x54, 0x03, 0xFC, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0x94, ++0xA4, 0x12, 0x87, 0x35, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0x94, 0xA3, 0x12, ++0x8F, 0xC6, 0xFF, 0x12, 0x87, 0x36, 0xFB, 0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0x94, ++0xA6, 0xF0, 0xFA, 0xEB, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEF, 0x54, 0x01, 0xC4, ++0x33, 0x33, 0x33, 0x54, 0x80, 0x31, 0xDB, 0x54, 0x7F, 0x4F, 0xF0, 0x90, 0x94, 0xA3, 0xE0, 0x54, ++0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0x31, 0xDB, 0x54, 0xBF, 0x4F, 0xF0, 0xEA, 0x60, 0x02, 0x21, ++0xDA, 0x90, 0x94, 0xA2, 0xE0, 0x54, 0x1F, 0xFF, 0x75, 0xF0, 0x12, 0xED, 0x71, 0x5A, 0x54, 0xE0, ++0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x31, 0xDB, 0x54, 0xFC, 0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x25, 0xE0, ++0x25, 0xE0, 0x31, 0xDB, 0x54, 0xF3, 0x4F, 0xF0, 0x90, 0x94, 0xA1, 0xE0, 0x54, 0x01, 0xC4, 0x33, ++0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x12, 0xED, 0x71, 0x5A, 0x54, 0xDF, 0x4F, 0xF0, 0x90, 0x94, 0xA4, ++0xE0, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0x31, 0xDB, 0x54, 0xCF, 0x4F, 0xD1, 0x9F, 0xE0, 0x54, 0xFB, ++0xD1, 0x9F, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0x94, 0xA7, 0xE0, 0x12, 0x9F, 0xCF, 0xD0, ++0x82, 0xD0, 0x83, 0xF0, 0x90, 0x93, 0x51, 0xE0, 0x60, 0x30, 0x71, 0x4F, 0xE9, 0x24, 0x03, 0xF9, ++0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x54, 0x1F, 0x12, 0x02, 0x4C, 0x90, 0x94, 0xA5, 0x74, 0x01, ++0xF0, 0x90, 0x94, 0xA5, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x0F, 0xEF, 0x71, 0x49, 0x8F, 0x82, ++0x8E, 0x83, 0xE4, 0x12, 0x02, 0x5E, 0xD1, 0x7E, 0x80, 0xE7, 0x90, 0x93, 0x4F, 0xE0, 0x54, 0x07, ++0xFF, 0xBF, 0x05, 0x0A, 0xEC, 0xB4, 0x01, 0x06, 0x90, 0x93, 0x54, 0x74, 0x01, 0xF0, 0xE4, 0x90, ++0x94, 0xA5, 0xF0, 0x90, 0x94, 0xA5, 0xE0, 0xFC, 0x71, 0x49, 0x8F, 0x82, 0x8E, 0x83, 0x12, 0x02, ++0x1F, 0xFF, 0xED, 0xF1, 0x4C, 0xE5, 0x82, 0x2C, 0x11, 0x7C, 0xEF, 0xF0, 0xD1, 0x7E, 0xE0, 0xB4, ++0x04, 0xE1, 0xAF, 0x05, 0x90, 0x8A, 0xFF, 0x12, 0x97, 0x9E, 0x22, 0xFF, 0x75, 0xF0, 0x12, 0xED, ++0x90, 0x89, 0x52, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, ++0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE6, 0x02, 0x61, 0x10, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x96, ++0x6D, 0xF0, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, 0x96, 0x6E, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, ++0x90, 0x96, 0x6F, 0xF0, 0x90, 0x96, 0x6E, 0xE0, 0x24, 0xFC, 0x60, 0x0F, 0x24, 0x03, 0x60, 0x02, ++0x61, 0x05, 0x90, 0x96, 0x6D, 0xE0, 0xFF, 0x71, 0x62, 0x61, 0x05, 0x90, 0x96, 0x6D, 0xE0, 0x24, ++0xD6, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x71, 0x42, 0x75, ++0xF0, 0x12, 0x31, 0xE0, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x42, 0x75, 0xF0, ++0x12, 0x31, 0xE0, 0x12, 0x8F, 0xCA, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x42, 0x75, 0xF0, 0x12, 0x31, ++0xE0, 0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x42, 0xD1, 0x94, 0xFB, 0xE4, 0xFD, 0x0F, ++0x71, 0x42, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x50, 0x12, 0x04, 0x6E, 0x71, 0x3F, 0x75, 0xF0, 0x12, ++0x71, 0x5A, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0x71, 0x42, 0x75, 0xF0, 0x12, 0x71, ++0x5A, 0x54, 0x1F, 0x71, 0x40, 0xF1, 0x4C, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x42, 0x75, 0xF0, ++0x08, 0xA4, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, ++0x02, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0xF5, 0x82, ++0xE4, 0x34, 0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x82, ++0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x42, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x05, 0xF5, ++0x82, 0xE4, 0x34, 0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, ++0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, ++0xE0, 0xFB, 0x0D, 0x71, 0x15, 0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x02, 0xF1, 0x28, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, ++0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, ++0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xF5, 0x83, 0xE0, ++0xFB, 0x0D, 0x71, 0x15, 0x90, 0x96, 0x6D, 0xE0, 0x22, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, ++0x94, 0x9E, 0x02, 0x86, 0x71, 0x75, 0xF0, 0x12, 0xE5, 0x72, 0x90, 0x89, 0x51, 0x12, 0x04, 0x6E, ++0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x77, 0xEF, 0xF0, 0x7F, 0x8F, ++0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, 0x3B, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0xEF, 0x64, 0x01, 0x70, ++0x31, 0x90, 0x96, 0x78, 0xF0, 0x90, 0x96, 0x78, 0xE0, 0xFD, 0x90, 0x96, 0x77, 0xE0, 0x71, 0xC6, ++0xE5, 0x82, 0x2D, 0x11, 0x7C, 0xE0, 0xFB, 0xE4, 0xFF, 0x71, 0x15, 0x90, 0x96, 0x78, 0xE0, 0x04, ++0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xDE, 0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x02, ++0xF1, 0x28, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0xB6, 0x25, 0x61, 0xF5, 0x82, 0xE4, 0x34, 0x8E, ++0xF5, 0x83, 0xE4, 0xF0, 0xE5, 0x61, 0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x81, ++0xF5, 0x83, 0x22, 0x8D, 0x61, 0xEF, 0x30, 0xE6, 0x1E, 0x71, 0xC4, 0xB1, 0x77, 0xE0, 0x54, 0x03, ++0x90, 0x92, 0x80, 0xF0, 0xE4, 0xFB, 0xAF, 0x61, 0x12, 0x75, 0x80, 0x71, 0xB7, 0xE0, 0x90, 0x92, ++0x5E, 0xF0, 0xA3, 0x74, 0x01, 0x80, 0x4D, 0xB1, 0x94, 0x04, 0xF0, 0xB1, 0x94, 0x64, 0x02, 0x70, ++0x1B, 0x74, 0x18, 0x25, 0x61, 0xB1, 0x6F, 0xE0, 0xFD, 0xF4, 0x60, 0x02, 0x80, 0x04, 0x71, 0xC4, ++0xE0, 0xFD, 0xB1, 0x79, 0xD1, 0xAB, 0x71, 0xC4, 0xD1, 0x8B, 0x80, 0x28, 0xB1, 0x94, 0xD3, 0x94, ++0x03, 0x40, 0x17, 0x90, 0x8A, 0xB3, 0x12, 0x8D, 0xC8, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x71, 0xB7, ++0xE0, 0x90, 0x92, 0x5E, 0xF0, 0xA3, 0x74, 0x03, 0x80, 0x0A, 0x71, 0xC4, 0xB1, 0x77, 0xD1, 0xAB, ++0x71, 0xC4, 0xD1, 0x8B, 0xF0, 0xAB, 0x61, 0xE4, 0xFD, 0xFF, 0x02, 0x6F, 0x75, 0x8F, 0x72, 0x8D, ++0x73, 0xEF, 0x71, 0xC6, 0xE0, 0xF5, 0x74, 0x54, 0x7F, 0xF5, 0x75, 0xE5, 0x74, 0x54, 0x80, 0xF5, ++0x77, 0x75, 0xF0, 0x12, 0xEF, 0xD1, 0x97, 0xF5, 0x79, 0x75, 0xF0, 0x12, 0xEF, 0x31, 0xE0, 0xC4, ++0x54, 0x03, 0xF5, 0x7A, 0xB1, 0x6B, 0x74, 0xFF, 0xF0, 0xF1, 0x5A, 0xF0, 0xE5, 0x74, 0x45, 0x77, ++0xFF, 0xD1, 0x72, 0xEF, 0xF0, 0xE5, 0x72, 0xB1, 0x7B, 0xE0, 0x54, 0x03, 0xF5, 0x78, 0x74, 0x46, ++0x25, 0x72, 0xF1, 0x2F, 0xE5, 0x78, 0xF0, 0xE5, 0x75, 0x65, 0x79, 0x70, 0x40, 0x71, 0x55, 0xC4, ++0x13, 0x54, 0x07, 0x30, 0xE0, 0x0C, 0xE5, 0x77, 0x70, 0x08, 0xE5, 0x75, 0x44, 0x80, 0xF5, 0x74, ++0xA1, 0x41, 0xF1, 0x5A, 0xF0, 0xE5, 0x72, 0xF1, 0x40, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x95, 0x37, ++0xCF, 0xB1, 0x89, 0xE5, 0x72, 0xF0, 0xE4, 0x90, 0x95, 0x39, 0x12, 0x96, 0x53, 0x7B, 0x01, 0xFA, ++0x7D, 0x02, 0x7F, 0x04, 0xD1, 0xBF, 0x7D, 0x07, 0xAF, 0x72, 0x02, 0xC0, 0x40, 0xE5, 0x75, 0xC3, ++0x95, 0x79, 0x50, 0x56, 0xAB, 0x72, 0xAD, 0x79, 0xAF, 0x75, 0x12, 0x72, 0x7F, 0x8F, 0x76, 0x85, ++0x76, 0x74, 0x71, 0x55, 0xC4, 0x13, 0x54, 0x01, 0xFF, 0x90, 0x95, 0x39, 0xB1, 0x88, 0xE5, 0x76, ++0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x75, 0xF0, 0xE5, 0x77, 0x12, 0x8F, 0xCA, 0x12, 0xC6, 0xBC, ++0xE4, 0xFB, 0xFA, 0xD1, 0x85, 0xE5, 0x75, 0xC3, 0x94, 0x0C, 0x40, 0x25, 0x71, 0x55, 0xC4, 0x13, ++0x54, 0x07, 0x30, 0xE0, 0x1C, 0xE5, 0x73, 0x60, 0x18, 0xE5, 0x77, 0x70, 0x14, 0xE5, 0x75, 0x44, ++0x80, 0xF5, 0x74, 0xB1, 0x6B, 0xE5, 0x76, 0xF0, 0x80, 0x07, 0xD1, 0x72, 0xE5, 0x79, 0xF0, 0xF5, ++0x74, 0xB1, 0x8D, 0xE5, 0x74, 0xF0, 0xB1, 0x6B, 0xE0, 0xFF, 0xF1, 0xD4, 0xEF, 0xF0, 0xA3, 0xE4, ++0xF0, 0xA3, 0xE5, 0x78, 0xF1, 0x37, 0x7B, 0x01, 0x7A, 0x00, 0xD1, 0x85, 0x90, 0x92, 0x80, 0xE5, ++0x78, 0xF0, 0xAB, 0x73, 0xAD, 0x74, 0xAF, 0x72, 0x02, 0x75, 0x80, 0x74, 0x18, 0x25, 0x72, 0xF5, ++0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0xE0, 0xFD, 0xE5, 0x61, 0xC4, 0x54, 0xF0, 0x24, 0x05, ++0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0x35, ++0xE4, 0xF0, 0xA3, 0x22, 0x74, 0xB6, 0x25, 0x61, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, ++0x22, 0x7D, 0x01, 0xAF, 0x64, 0xAC, 0x05, 0x90, 0x95, 0x2F, 0xEF, 0xF0, 0xFD, 0xE0, 0xFF, 0x71, ++0xC6, 0xE0, 0xF5, 0x72, 0x54, 0x7F, 0xF5, 0x74, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x50, 0x12, ++0x04, 0x6E, 0xE0, 0xF9, 0x90, 0x95, 0x2F, 0xE0, 0xD1, 0x94, 0xFE, 0xEF, 0xB1, 0x7B, 0xE0, 0x54, ++0x03, 0xF5, 0x73, 0xE5, 0x74, 0x90, 0x81, 0x9D, 0x93, 0xFB, 0xED, 0xF1, 0x40, 0xE4, 0xF0, 0xA3, ++0xEB, 0xF0, 0x31, 0xDC, 0xC4, 0x54, 0x03, 0x90, 0x95, 0x30, 0xF0, 0x74, 0xC6, 0x2D, 0xD1, 0x76, ++0xE5, 0x74, 0xF0, 0x74, 0x46, 0x2D, 0xF1, 0x2F, 0xE5, 0x73, 0xF0, 0xE5, 0x74, 0xD3, 0x9E, 0x40, ++0x06, 0x8E, 0x74, 0xAF, 0x06, 0x8F, 0x72, 0x8C, 0x75, 0xE4, 0xFF, 0xEF, 0xC3, 0x95, 0x75, 0x50, ++0x30, 0xE5, 0x72, 0x30, 0xE7, 0x09, 0x85, 0x74, 0x72, 0x1C, 0xEC, 0x70, 0x21, 0x80, 0x22, 0xE5, ++0x74, 0xD3, 0x99, 0x40, 0x15, 0xAD, 0x01, 0x90, 0x95, 0x2F, 0xE0, 0xFB, 0x90, 0x95, 0x34, 0xEC, ++0xF0, 0xAF, 0x74, 0x12, 0xC7, 0xB8, 0x8F, 0x72, 0x80, 0x07, 0x89, 0x72, 0x80, 0x03, 0x0F, 0x80, ++0xCA, 0x90, 0x95, 0x2F, 0xE0, 0xFF, 0xB1, 0x8D, 0xEF, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x72, ++0xF1, 0x37, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0xFA, 0x7D, 0x05, 0x7F, 0x08, 0xD1, 0xBF, ++0x90, 0x95, 0x2F, 0xE0, 0xFF, 0x90, 0x92, 0x80, 0xE5, 0x73, 0xF0, 0xE4, 0xFB, 0xAD, 0x72, 0x02, ++0x75, 0x80, 0x74, 0xC6, 0x25, 0x72, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x90, 0x94, ++0xA5, 0xE0, 0x04, 0xF0, 0x22, 0x7D, 0x05, 0x7F, 0x04, 0x80, 0x34, 0xE0, 0x90, 0x92, 0x5E, 0xF0, ++0xA3, 0x74, 0x02, 0x22, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x4F, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0xF0, ++0x74, 0xC6, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0xE0, 0x54, 0x03, 0x90, 0x92, ++0x80, 0xF0, 0x7B, 0x01, 0xAF, 0x61, 0x02, 0x75, 0x80, 0x7A, 0x00, 0x7D, 0x03, 0x7F, 0x01, 0x90, ++0x01, 0xC6, 0xE0, 0x64, 0x80, 0x70, 0x60, 0x90, 0x95, 0x3F, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xEB, ++0xA3, 0xF0, 0xEA, 0xA3, 0xF0, 0x90, 0x95, 0x35, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0x43, 0xF0, ++0xEC, 0xA3, 0xF0, 0x90, 0x95, 0x37, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0x45, 0xF0, 0xEC, 0xA3, ++0xF0, 0x90, 0x95, 0x39, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0x47, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, ++0x95, 0x3B, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0x49, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0x95, 0x3D, ++0x74, 0xFE, 0xF0, 0x90, 0x95, 0x5F, 0x74, 0x0C, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x3D, 0x12, ++0x8D, 0xB6, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xE4, 0xFD, 0x7F, 0x8D, 0x02, 0x7B, 0x2E, 0xF5, ++0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x73, 0xF0, 0x22, ++0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x08, 0xA4, ++0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0xE5, 0x75, 0x25, 0xE0, 0x24, 0x75, ++0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE5, 0x72, ++0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x73, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, ++0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x7D, 0x44, 0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xFD, 0x12, ++0x8D, 0xDA, 0x90, 0x96, 0x74, 0xE0, 0x90, 0x96, 0x73, 0xB4, 0x01, 0x09, 0xE0, 0xB1, 0x7B, 0xE0, ++0x44, 0x04, 0xF0, 0x80, 0x07, 0xE0, 0xB1, 0x7B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8A, 0xF9, 0x12, ++0x8D, 0xC8, 0x12, 0x9F, 0x30, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x21, 0xE8, 0xE4, 0xFD, 0x80, 0xB0, ++0x7D, 0x01, 0x80, 0xAC, 0x90, 0x95, 0x37, 0xE4, 0xF0, 0xA3, 0x22, 0x7D, 0x05, 0x7F, 0x01, 0xC1, ++0xBF, 0x7A, 0x00, 0x7D, 0x01, 0x7F, 0x01, 0xC1, 0xBF, 0x7A, 0x00, 0xE4, 0xFD, 0x7F, 0x01, 0xC1, ++0xBF, 0x12, 0x02, 0x06, 0x90, 0x88, 0x9C, 0xF0, 0x60, 0x34, 0xA3, 0xE0, 0x20, 0xE0, 0x2F, 0x90, ++0x8A, 0xB9, 0x12, 0x8D, 0xC8, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x11, 0x2F, 0x30, 0xE0, ++0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, 0x13, ++0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, 0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, 0x90, ++0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0x62, ++0xEC, 0x90, 0x96, 0x49, 0x12, 0x04, 0x31, 0x90, 0x96, 0x49, 0x31, 0x50, 0x11, 0xB6, 0x90, 0x01, ++0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, ++0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0xA1, 0xE4, 0x30, 0xE0, 0x05, ++0x7F, 0x03, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xB8, 0xE0, 0x20, 0xE0, 0x33, 0x11, 0x2F, 0x30, 0xE0, ++0x2E, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0x96, 0x47, 0xF0, 0x80, 0x06, 0x90, 0x96, ++0x47, 0x74, 0x01, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x96, 0x48, 0x30, 0xE0, 0x05, 0x74, ++0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0x96, 0x47, 0x31, 0x59, 0x12, 0x95, 0xBE, 0x31, ++0x6E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x02, 0x70, 0xAD, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x31, 0x62, 0xEC, 0x90, 0x96, 0x4F, 0x12, 0x04, 0x31, 0x90, 0x96, 0x4F, ++0x31, 0x50, 0x11, 0xB6, 0x90, 0x8A, 0xFD, 0x12, 0x8D, 0xDA, 0x12, 0xA7, 0xD3, 0x54, 0xFE, 0x31, ++0x76, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0x90, 0x01, 0x01, ++0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0xA1, ++0xE4, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x11, 0x2F, 0x30, 0xE0, 0x35, 0x90, 0x88, ++0xDF, 0xE0, 0x60, 0x08, 0x90, 0x96, 0x4D, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x96, 0x4D, ++0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0x96, 0x4E, 0xF0, 0x80, 0x06, ++0x90, 0x96, 0x4E, 0x74, 0x02, 0xF0, 0x90, 0x96, 0x4D, 0x31, 0x59, 0x12, 0x95, 0xBE, 0x7F, 0x01, ++0x12, 0x71, 0x9A, 0x90, 0x88, 0x9A, 0xE0, 0x60, 0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x12, 0x04, 0xB8, 0x90, 0x92, 0x18, 0x02, 0x04, 0x31, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8A, ++0xF3, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, 0x70, 0xED, 0x44, 0x80, 0xFD, 0x22, 0x7F, 0x02, ++0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE4, 0x90, 0x94, 0xFB, ++0xF0, 0xD1, 0xA4, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x7B, ++0x2E, 0xE4, 0xFF, 0x91, 0x65, 0x90, 0x93, 0x30, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0x75, 0x12, 0xA7, ++0xD3, 0x44, 0x02, 0x31, 0x76, 0xE4, 0x90, 0x94, 0xFC, 0xF0, 0x90, 0x94, 0xFC, 0xE0, 0xFF, 0xC3, ++0x94, 0x05, 0x50, 0x2D, 0x71, 0xED, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, ++0x90, 0x93, 0x33, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x10, 0x90, 0x94, 0xFC, 0x91, 0x25, 0xF0, 0x90, ++0x94, 0xFC, 0x91, 0x44, 0x44, 0x40, 0x12, 0x9F, 0xC7, 0x90, 0x94, 0xFC, 0xE0, 0x04, 0xF0, 0x80, ++0xC9, 0x90, 0x07, 0xC7, 0xE4, 0xF0, 0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, 0x77, 0xF0, ++0x90, 0x07, 0xC4, 0xE4, 0xF0, 0x90, 0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xB1, ++0xCF, 0x90, 0x02, 0x26, 0xE0, 0x44, 0x01, 0xF0, 0xE0, 0x90, 0x94, 0xFD, 0xF0, 0x90, 0x94, 0xFD, ++0xE0, 0x30, 0xE0, 0x19, 0x90, 0x94, 0xFB, 0xE0, 0x04, 0xF0, 0xB1, 0xC0, 0x90, 0x02, 0x26, 0xE0, ++0x90, 0x94, 0xFD, 0xF0, 0x90, 0x94, 0xFB, 0xE0, 0xD3, 0x94, 0xFA, 0x40, 0xE0, 0x90, 0x02, 0x03, ++0x74, 0x80, 0xF0, 0x90, 0x04, 0x24, 0xE0, 0x90, 0x94, 0xFE, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x44, ++0x10, 0xF0, 0x90, 0x02, 0x00, 0xE0, 0x90, 0x94, 0xFD, 0xF0, 0x90, 0x02, 0x01, 0x51, 0x84, 0x90, ++0x02, 0x02, 0x51, 0x84, 0x90, 0x02, 0x14, 0x51, 0x84, 0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x04, 0x24, ++0xB1, 0xD7, 0x90, 0x94, 0xFE, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0xFD, 0x09, 0x74, 0xFF, 0xF0, ++0x90, 0xFD, 0x08, 0xE4, 0xF0, 0x71, 0xF5, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x32, 0xE0, ++0x54, 0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x94, 0xFD, 0xE0, 0x2F, 0xF0, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x51, 0x9D, 0x31, 0x7C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0x63, 0x14, ++0x90, 0x88, 0x32, 0xE0, 0x44, 0x10, 0xF0, 0x71, 0xF5, 0x7D, 0x01, 0x12, 0x76, 0xF7, 0x90, 0x88, ++0x41, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, ++0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, ++0x90, 0x93, 0x30, 0xE0, 0x30, 0xE0, 0x6A, 0x90, 0xFD, 0x09, 0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, ++0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, 0x94, 0xFB, 0xF0, 0x90, 0x94, 0xFB, 0xE0, ++0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2D, 0x71, 0xED, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, ++0xF9, 0xFF, 0x90, 0x93, 0x32, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x10, 0x90, 0x94, 0xFB, 0x91, 0x25, ++0xF0, 0x90, 0x94, 0xFB, 0x91, 0x44, 0x44, 0x20, 0x12, 0x9F, 0xC7, 0x90, 0x94, 0xFB, 0xE0, 0x04, ++0xF0, 0x80, 0xC9, 0x71, 0xCF, 0x54, 0xFE, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x71, 0xCF, 0x44, ++0x08, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x12, 0xA7, 0xD3, 0x54, 0xFD, 0xFD, 0x7F, 0x02, 0x80, ++0x07, 0x71, 0xCF, 0x44, 0x01, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x7F, 0x08, 0x12, 0x7B, 0x41, ++0xEF, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0x7F, 0x01, 0x91, 0x65, 0x90, 0x00, 0x90, ++0xE0, 0x44, 0x01, 0xF0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x7F, ++0x92, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x24, 0x6F, 0xF5, 0x82, 0xE4, ++0x34, 0x8D, 0xF5, 0x83, 0xE0, 0xFD, 0x7C, 0x00, 0xE5, 0x64, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, ++0x00, 0xA8, 0x07, 0x08, 0x22, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x90, ++0x88, 0xE0, 0xE0, 0xFB, 0x90, 0x88, 0xDF, 0xE0, 0x90, 0x92, 0x90, 0xF0, 0x22, 0x90, 0x88, 0x39, ++0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0D, 0x91, 0xB8, 0xBF, 0x01, 0x08, 0x51, 0x8D, 0x90, 0x01, ++0xE5, 0xE0, 0x04, 0xF0, 0x22, 0xE0, 0xFF, 0x24, 0x3E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, ++0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, 0x43, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, ++0x90, 0x01, 0xB1, 0x22, 0xE0, 0xFF, 0x24, 0x34, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, ++0x90, 0x01, 0xB2, 0xF0, 0x74, 0x39, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, ++0x01, 0xB3, 0xF0, 0xE0, 0x22, 0x90, 0x96, 0x70, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, ++0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x96, 0x70, 0xE0, 0x6F, 0x60, ++0x36, 0xC3, 0x90, 0x96, 0x72, 0xE0, 0x94, 0x88, 0x90, 0x96, 0x71, 0xE0, 0x94, 0x13, 0x40, 0x08, ++0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x96, 0x71, 0x12, 0x9F, 0xC0, 0x12, 0x9F, ++0xC8, 0xD3, 0x90, 0x96, 0x72, 0xE0, 0x94, 0x32, 0x90, 0x96, 0x71, 0xE0, 0x94, 0x00, 0x40, 0xBF, ++0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB8, 0x22, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, ++0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, 0x63, 0x01, 0x80, 0x2E, 0x90, 0x02, 0x96, ++0xE0, 0x60, 0x05, 0x75, 0x63, 0x10, 0x80, 0x23, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, ++0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x63, 0x04, 0x80, 0x0E, 0x90, 0x88, 0xE6, ++0xE0, 0x30, 0xE0, 0x05, 0x75, 0x63, 0x20, 0x80, 0x02, 0xA1, 0xC7, 0x90, 0x01, 0xB9, 0x74, 0x08, ++0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x63, 0xF0, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x93, 0x51, 0xE0, 0x60, 0x24, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xB1, 0xB6, ++0x12, 0x04, 0xB8, 0xEF, 0x44, 0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, ++0xB1, 0xB6, 0x31, 0x50, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, 0x90, 0x93, 0x4C, 0xE0, 0x70, ++0x29, 0x90, 0x07, 0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, 0xF0, 0x90, 0x94, 0xFF, 0x74, 0x22, 0xF0, ++0x90, 0x95, 0x21, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x01, 0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x94, ++0x79, 0xFF, 0x12, 0x8D, 0xB6, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x93, 0x54, 0xE0, 0xFF, 0x70, ++0x0A, 0x90, 0x93, 0x51, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, ++0xF0, 0xF0, 0x90, 0x01, 0xC5, 0x74, 0xEA, 0xF0, 0xA3, 0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, ++0xEF, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, 0x90, 0x93, 0x51, 0xE0, 0x60, 0x06, 0x90, ++0x01, 0xC4, 0x74, 0x01, 0xF0, 0x90, 0x93, 0x52, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, ++0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x94, 0xFB, 0x12, 0x04, 0x31, 0x90, 0x94, 0xFB, 0x22, ++0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x74, ++0x0F, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x22, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x54, 0xEF, 0xF0, 0x22, ++0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xD1, 0x17, 0x90, 0x88, 0x27, 0xF0, 0xA3, 0xEF, ++0xF0, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x93, 0x03, 0xE0, 0x44, 0x01, 0xF0, 0x7D, ++0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x90, 0x05, 0x52, 0xE0, 0x54, 0x07, 0x04, 0x90, 0x93, 0x0E, ++0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0x80, 0xC0, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, ++0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x02, 0x91, 0x0D, 0x22, 0xE4, 0x90, 0x94, 0xF8, 0xF0, 0xA3, ++0xF0, 0xA3, 0xF0, 0x90, 0x94, 0xF8, 0xE0, 0x64, 0x01, 0xF0, 0x90, 0x93, 0x54, 0xE0, 0x70, 0x18, ++0x90, 0x93, 0x51, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0x90, 0x94, 0xF8, 0xE0, 0x24, 0x2A, ++0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB6, 0xA3, 0xF0, 0x12, 0x7C, 0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, ++0x9F, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xFF, 0x90, 0x88, 0x38, 0xE0, ++0x6F, 0x60, 0x03, 0x12, 0xA5, 0x6B, 0xC2, 0xAF, 0xF1, 0x24, 0xBF, 0x01, 0x02, 0xD1, 0x20, 0xD2, ++0xAF, 0xB1, 0x0A, 0x12, 0xAF, 0xCA, 0x12, 0x83, 0x4D, 0x80, 0xA8, 0x90, 0x01, 0x9A, 0xE0, 0x54, ++0xC0, 0x44, 0x0B, 0xF0, 0xB1, 0xC0, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, ++0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC4, 0x74, 0xA4, 0xF0, 0x74, 0xB6, 0xA3, 0xF0, 0x7F, 0x90, ++0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0xA4, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB6, ++0xA3, 0xF0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, 0x90, 0x88, 0xBD, ++0xE0, 0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xBE, 0x31, 0x59, 0x12, 0x95, 0xBE, 0x90, 0x88, 0x36, ++0xE0, 0x70, 0x0C, 0x12, 0x8D, 0xD7, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x12, 0x9F, 0x30, 0x22, ++0xE4, 0x90, 0x96, 0x7F, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x23, 0xC3, 0x90, ++0x96, 0x80, 0xE0, 0x94, 0xD0, 0x90, 0x96, 0x7F, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, ++0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x96, 0x7F, 0x12, 0x9F, 0xC0, 0xB1, 0xC0, 0x80, ++0xD6, 0x7F, 0x01, 0x22, 0x7D, 0x02, 0x90, 0x01, 0xC4, 0x74, 0x24, 0xF0, 0x74, 0xB7, 0xA3, 0xF0, ++0x90, 0x93, 0x48, 0xE0, 0xFF, 0xED, 0xC3, 0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, 0x81, 0xF8, ++0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0D, ++0x80, 0xDE, 0x74, 0x24, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB7, 0xA3, 0xF0, 0x7F, 0x01, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, 0xFC, 0xFF, 0xF1, 0xA4, 0xE4, 0xFB, 0x90, ++0x96, 0x5B, 0x12, 0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, 0xF8, 0x12, 0x03, 0xEB, 0x74, ++0xC4, 0x2B, 0x12, 0xA4, 0xCB, 0xEF, 0xF0, 0x0B, 0xEB, 0xB4, 0x04, 0xE3, 0x90, 0x07, 0xC2, 0xB1, ++0xCF, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0x54, 0xFC, 0x90, 0x07, 0xC0, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x7B, 0xF1, 0x9D, 0x7A, 0x00, 0x90, 0x96, 0x7C, 0xE0, 0x54, 0x03, ++0xFB, 0x70, 0x0B, 0x90, 0x07, 0xC4, 0x12, 0xD2, 0x73, 0x74, 0x03, 0xF0, 0x80, 0x0F, 0xEB, 0x64, ++0x02, 0x4A, 0x70, 0x16, 0x90, 0x07, 0xC6, 0x12, 0xD2, 0x73, 0x74, 0x0C, 0xF0, 0x90, 0x07, 0xC3, ++0x74, 0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, ++0x8F, 0xF5, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x29, 0x12, 0xB8, 0xE0, 0xFF, ++0xF0, 0x12, 0x02, 0x06, 0x11, 0xD6, 0x90, 0x93, 0x29, 0x11, 0xCD, 0x4E, 0xF0, 0x90, 0x05, 0x52, ++0xE0, 0x54, 0x07, 0x90, 0x94, 0xA2, 0x60, 0x16, 0x12, 0x86, 0x71, 0x12, 0x87, 0x3D, 0xFD, 0x90, ++0x05, 0x56, 0xE0, 0xC3, 0x9D, 0x90, 0x93, 0x2B, 0xF0, 0xA3, 0xED, 0xF0, 0x80, 0x26, 0x12, 0x86, ++0x71, 0x12, 0x87, 0x3D, 0xFB, 0xFF, 0x90, 0x05, 0x54, 0xE0, 0xC3, 0x9F, 0xFF, 0xE4, 0x94, 0x00, ++0xFE, 0x7C, 0x00, 0x7D, 0x05, 0x12, 0x02, 0x92, 0x90, 0x93, 0x2B, 0xEF, 0xF0, 0xEB, 0x75, 0xF0, ++0x05, 0x84, 0xA3, 0xF0, 0x12, 0x8B, 0x6E, 0x12, 0x02, 0x06, 0x20, 0xE0, 0x13, 0x12, 0x8D, 0xD7, ++0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x12, 0x9F, 0x30, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x80, 0x0B, ++0x90, 0x8A, 0x89, 0x12, 0x8D, 0xC8, 0x12, 0x8F, 0xFB, 0x11, 0xBD, 0x12, 0xA7, 0xBD, 0x20, 0xE0, ++0x04, 0xEF, 0x44, 0x20, 0xF0, 0x11, 0xB6, 0x30, 0xE0, 0x14, 0x90, 0x88, 0x36, 0x74, 0x01, 0xF0, ++0xE4, 0x90, 0x88, 0x38, 0xF0, 0x11, 0xC5, 0x90, 0x05, 0x58, 0x74, 0x05, 0xF0, 0x22, 0xE4, 0x90, ++0x88, 0x36, 0xF0, 0x90, 0x88, 0x38, 0x74, 0x0C, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFE, 0xF0, ++0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x93, 0x29, 0xE0, 0xC3, 0x13, 0x22, 0x90, 0x93, 0x29, ++0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xF0, 0xEE, 0x54, ++0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x22, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x22, ++0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0x22, 0x12, ++0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x30, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x30, 0xE0, 0x04, ++0xE4, 0x12, 0x96, 0x54, 0x22, 0x12, 0x02, 0x06, 0x90, 0x93, 0x49, 0xF0, 0x22, 0x12, 0x02, 0x06, ++0xFF, 0x90, 0x93, 0x4A, 0xF0, 0xBF, 0x01, 0x0A, 0x7F, 0x01, 0x12, 0x98, 0xDD, 0xE4, 0x90, 0x93, ++0x4A, 0xF0, 0x22, 0xE4, 0x90, 0x86, 0xAF, 0x12, 0x96, 0x53, 0x90, 0x93, 0x01, 0xF0, 0x22, 0x75, ++0x29, 0x12, 0xE4, 0xF5, 0x2A, 0x75, 0x2B, 0x87, 0x75, 0x2C, 0x33, 0xF5, 0x31, 0xF5, 0x32, 0xF5, ++0x33, 0xF5, 0x34, 0x90, 0x01, 0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, ++0xF0, 0xA3, 0xE5, 0x2C, 0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, ++0xE5, 0x33, 0xF0, 0xA3, 0xE5, 0x34, 0xF0, 0x22, 0x75, 0x39, 0x06, 0x43, 0x39, 0x10, 0x75, 0x3A, ++0x01, 0x75, 0x3B, 0x03, 0x75, 0x3C, 0x62, 0x43, 0x3C, 0x80, 0x43, 0x3B, 0x04, 0x90, 0x01, 0x38, ++0xE5, 0x39, 0xF0, 0xA3, 0xE5, 0x3A, 0xF0, 0xA3, 0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, 0xF0, 0x22, ++0x90, 0x8A, 0x79, 0x74, 0x86, 0xF0, 0xA3, 0x74, 0xC6, 0xF0, 0x90, 0x8A, 0xE5, 0x74, 0xBA, 0xF0, ++0xA3, 0x74, 0x77, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0x89, 0xF0, 0xA3, 0x74, 0x56, 0xF0, 0x90, 0x8A, ++0xB9, 0x74, 0x8D, 0xF0, 0xA3, 0x74, 0xE4, 0xF0, 0x90, 0x8A, 0xFB, 0x74, 0xAB, 0xF0, 0xA3, 0x74, ++0xD3, 0xF0, 0x90, 0x8A, 0xA5, 0x74, 0xA8, 0xF0, 0xA3, 0x74, 0x84, 0xF0, 0x90, 0x8A, 0xC3, 0x74, ++0xBF, 0xF0, 0xA3, 0x74, 0x96, 0xF0, 0x90, 0x8A, 0xF3, 0x74, 0xC9, 0xF0, 0xA3, 0x74, 0xB1, 0xF0, ++0x90, 0x8A, 0x85, 0x74, 0xC9, 0xF0, 0xA3, 0x74, 0xBD, 0xF0, 0x90, 0x86, 0x04, 0x74, 0xCD, 0xF0, ++0xA3, 0x74, 0x66, 0xF0, 0x90, 0x8A, 0xA9, 0x74, 0xB6, 0xF0, 0xA3, 0x74, 0xC3, 0xF0, 0x90, 0x86, ++0x0C, 0x74, 0xB0, 0xF0, 0xA3, 0x74, 0x37, 0xF0, 0x90, 0x8A, 0xEF, 0x74, 0xB0, 0xF0, 0xA3, 0x74, ++0xBD, 0xF0, 0x90, 0x86, 0x00, 0x74, 0xCE, 0xF0, 0xA3, 0x74, 0xFA, 0xF0, 0x90, 0x86, 0x02, 0x74, ++0xCF, 0xF0, 0xA3, 0x74, 0x6B, 0xF0, 0x90, 0x8A, 0xFD, 0x74, 0xBF, 0xF0, 0xA3, 0x74, 0xC7, 0xF0, ++0x90, 0x8A, 0xF9, 0x74, 0xC0, 0xF0, 0xA3, 0x74, 0x26, 0xF0, 0x90, 0x8A, 0xDB, 0x74, 0xC8, 0xF0, ++0xA3, 0x74, 0x2B, 0xF0, 0x90, 0x8A, 0xAF, 0x74, 0x97, 0xF0, 0xA3, 0x74, 0x07, 0xF0, 0x90, 0x8A, ++0xD3, 0x74, 0xD0, 0xF0, 0xA3, 0x74, 0x90, 0xF0, 0x90, 0x8A, 0xF5, 0x74, 0xD0, 0xF0, 0xA3, 0x74, ++0x3F, 0xF0, 0x90, 0x8A, 0xA3, 0x74, 0xCD, 0xF0, 0xA3, 0x74, 0x16, 0xF0, 0x90, 0x86, 0x06, 0x74, ++0xBE, 0xF0, 0xA3, 0x74, 0xAE, 0xF0, 0x22, 0x8F, 0x0D, 0x7F, 0x02, 0x12, 0x85, 0x27, 0x90, 0x86, ++0xAF, 0xE0, 0x45, 0x0D, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, ++0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, ++0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x86, 0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0x12, 0x6C, 0xD6, ++0x74, 0x86, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, ++0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, ++0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, ++0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, ++0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xD6, 0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0x12, 0x75, 0x50, ++0xE5, 0x3D, 0x30, 0xE1, 0x02, 0xB1, 0x85, 0xE5, 0x3D, 0x30, 0xE2, 0x02, 0x71, 0xBD, 0xE5, 0x3D, ++0x30, 0xE4, 0x02, 0x71, 0x7E, 0xE5, 0x3E, 0x30, 0xE0, 0x03, 0x12, 0x9F, 0x36, 0xE5, 0x3F, 0x30, ++0xE2, 0x09, 0xB1, 0xCF, 0x90, 0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, 0x40, 0x30, 0xE1, 0x0B, ++0x90, 0x8A, 0xE5, 0x12, 0x8D, 0xC8, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, 0x40, 0x30, 0xE4, 0x03, ++0x12, 0xA1, 0x8B, 0xE5, 0x40, 0x30, 0xE5, 0x02, 0x91, 0xC1, 0xE5, 0x40, 0x30, 0xE6, 0x02, 0x91, ++0xFC, 0xE5, 0x40, 0x30, 0xE7, 0x02, 0xB1, 0xAF, 0x74, 0xD6, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, ++0xBA, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, ++0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x12, 0x34, ++0x78, 0xB1, 0x71, 0x90, 0x96, 0x83, 0xEF, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x02, 0x12, 0x90, ++0x96, 0x83, 0xE0, 0xFF, 0x64, 0x01, 0x60, 0x24, 0x90, 0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, ++0x19, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x7F, 0x64, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0x90, 0x06, ++0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x96, 0x83, 0xE0, 0xFF, 0x91, 0x0E, 0x22, 0x90, 0x88, 0x36, ++0xE0, 0x60, 0x14, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x08, 0x90, 0x8B, 0x01, 0x12, 0x8D, 0xDA, ++0x80, 0x05, 0xB1, 0x69, 0x12, 0xA5, 0x6B, 0x90, 0x93, 0x56, 0xE0, 0xFF, 0x12, 0x8F, 0xCA, 0x30, ++0xE0, 0x1A, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x02, 0xB1, 0x91, 0x90, 0x93, 0x57, 0xE0, 0x30, ++0xE0, 0x0A, 0x71, 0xFD, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0x87, 0xC7, 0x22, 0x90, 0x93, 0x56, ++0xE0, 0xFE, 0x54, 0x0F, 0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x7D, 0x00, 0x22, 0xAD, 0x07, ++0x90, 0x93, 0x58, 0xE0, 0x75, 0xF0, 0x20, 0xA4, 0xFF, 0x90, 0x96, 0x53, 0xB1, 0x7E, 0x90, 0x93, ++0x59, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0xAE, 0xF0, 0x90, 0x96, 0x55, 0xF0, 0xEE, 0xA3, 0xF0, 0x91, ++0xA2, 0x90, 0x96, 0x57, 0xF0, 0xEE, 0xA3, 0xF0, 0xED, 0x64, 0x01, 0x60, 0x64, 0x90, 0x93, 0x56, ++0xE0, 0xFE, 0x12, 0x8F, 0xCA, 0x30, 0xE0, 0x59, 0xEE, 0x91, 0x02, 0x20, 0xE0, 0x02, 0x7D, 0x01, ++0x91, 0xAA, 0xFE, 0x54, 0x0F, 0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFD, 0x91, 0xAA, 0xC4, ++0x13, 0x54, 0x07, 0x30, 0xE0, 0x24, 0xA3, 0xE0, 0x30, 0xE0, 0x0F, 0x90, 0x96, 0x58, 0xE0, 0x90, ++0x92, 0x20, 0xF0, 0x90, 0x96, 0x57, 0x91, 0xB2, 0x80, 0x10, 0x91, 0xA2, 0xFF, 0x12, 0x7C, 0x6A, ++0x71, 0xFD, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0x87, 0xC7, 0x90, 0x93, 0x56, 0xE0, 0xC4, 0x54, ++0x0F, 0x30, 0xE0, 0x0D, 0x90, 0x96, 0x56, 0xE0, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x96, 0x55, 0x91, ++0xB2, 0x22, 0x90, 0x96, 0x53, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x12, 0x87, 0xC7, 0x90, 0x93, 0x56, ++0xE0, 0x22, 0xE0, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x02, 0x66, ++0x33, 0x90, 0x88, 0x31, 0xB1, 0x61, 0x30, 0xE0, 0x32, 0xEF, 0x54, 0xBF, 0xB1, 0x4D, 0x30, 0xE0, ++0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFE, 0xB1, 0x56, 0x74, 0x04, 0xF0, 0x90, ++0x88, 0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8D, ++0xC8, 0x7D, 0x01, 0x7F, 0x0C, 0x02, 0x04, 0x7E, 0x12, 0xA5, 0x6B, 0x22, 0x90, 0x88, 0x31, 0xE0, ++0xFF, 0x12, 0x8F, 0xCA, 0x30, 0xE0, 0x1E, 0xEF, 0x54, 0x7F, 0xB1, 0x4D, 0x30, 0xE1, 0x06, 0xE0, ++0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, 0x54, 0xFD, 0xB1, 0x56, 0x04, 0xF0, 0x90, 0x88, 0x36, 0xE0, ++0x60, 0x03, 0x12, 0xA5, 0x6B, 0x12, 0x97, 0xDD, 0x30, 0xE0, 0x21, 0x90, 0x88, 0xA4, 0xE0, 0xFF, ++0xC3, 0x13, 0x30, 0xE0, 0x17, 0xEF, 0x54, 0xFD, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0xA4, ++0x30, 0xE1, 0x05, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0xF0, 0x90, 0x04, ++0xE0, 0xE0, 0x90, 0x88, 0x32, 0x22, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, ++0x22, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, ++0x22, 0x90, 0x01, 0xC7, 0x74, 0x66, 0xF0, 0xE4, 0xFF, 0x22, 0xFF, 0x90, 0x95, 0x35, 0xE5, 0xF0, ++0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0xA4, 0xF3, 0x02, 0x8F, ++0x5A, 0xE4, 0x90, 0x95, 0xD2, 0xF0, 0x90, 0x95, 0xD0, 0x74, 0x14, 0xF0, 0x90, 0x95, 0xF2, 0x74, ++0x01, 0xF0, 0xFB, 0x7A, 0x95, 0x79, 0xD0, 0x12, 0x8D, 0xB6, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x90, ++0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, 0x12, 0x8D, ++0xDA, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, 0x8D, 0xDA, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x2F, 0x90, 0x88, 0xF7, ++0xE0, 0xB4, 0x01, 0x18, 0xA3, 0xE0, 0xB4, 0x01, 0x23, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, 0x97, 0x9E, 0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, ++0xB4, 0x02, 0x09, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE7, 0x12, 0x8D, 0xDA, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, ++0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, ++0xC4, 0x74, 0x11, 0xF0, 0x74, 0xBE, 0xA3, 0xF0, 0x90, 0x8A, 0x9D, 0x12, 0x8D, 0xDA, 0x53, 0x91, ++0xBF, 0x74, 0x11, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBE, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, ++0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, ++0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, ++0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x67, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0xBE, 0xFF, ++0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, ++0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, 0x03, ++0x12, 0xA6, 0x91, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0xA1, 0x33, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x94, 0x9F, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x94, 0x9E, ++0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0xF1, 0x87, 0xE0, 0x90, 0x94, 0xA1, 0xF0, 0x12, 0x7B, 0x07, 0x7C, ++0x00, 0xAD, 0x07, 0x90, 0x94, 0x9E, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x94, 0x9F, 0xE0, 0x60, ++0x05, 0xF1, 0x7B, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0xF1, 0x7B, 0x54, 0xC0, 0xF0, 0x90, 0x94, 0xA1, 0xE0, 0xFF, ++0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, ++0x8B, 0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, ++0x04, 0xF0, 0xAF, 0x05, 0xF1, 0x72, 0xF5, 0x83, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x94, 0xA0, 0xE0, ++0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xFE, 0xF1, 0x72, 0xF5, 0x83, 0xEE, 0xF0, ++0x74, 0x11, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x74, 0x29, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0x74, 0x0D, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x86, 0xAD, 0xA3, 0xE0, 0x24, 0x7F, 0xF5, 0x82, ++0xE4, 0x34, 0x84, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0x87, 0xE0, ++0x90, 0x96, 0x82, 0xF0, 0xED, 0x90, 0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x00, ++0x67, 0xE0, 0x44, 0x80, 0xF0, 0x80, 0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, 0x67, 0xE0, 0x54, ++0x7F, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x96, 0x75, 0xF0, 0xA3, 0xF0, 0x90, 0x05, ++0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, ++0x7F, 0x01, 0x22, 0x12, 0x97, 0xDD, 0x30, 0xE0, 0x15, 0xD3, 0x90, 0x96, 0x76, 0xE0, 0x94, 0x03, ++0x90, 0x96, 0x75, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x80, 0x13, 0x7F, 0x01, 0x80, 0x1B, 0xD3, 0x90, ++0x96, 0x76, 0xE0, 0x94, 0xE8, 0x90, 0x96, 0x75, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, ++0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0x90, 0x96, ++0x75, 0x12, 0x9F, 0xC0, 0x80, 0xA8, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x93, 0x01, 0xED, 0xF0, ++0x22, 0x90, 0x05, 0x22, 0xED, 0xF0, 0x90, 0x93, 0x01, 0xEB, 0xF0, 0x22, 0x7D, 0x07, 0xAF, 0x64, ++0xED, 0x30, 0xE0, 0x26, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x57, 0xD1, 0x8F, 0xEF, 0x90, 0x89, ++0x59, 0xD1, 0x8F, 0xEF, 0x90, 0x89, 0x5B, 0xD1, 0x8F, 0xEF, 0x90, 0x89, 0x5D, 0xD1, 0x8F, 0xEF, ++0x90, 0x89, 0x5F, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, 0x30, 0xE1, 0x0A, 0x75, 0xF0, ++0x12, 0xEF, 0xD1, 0xD6, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, 0x30, 0xE2, 0x08, 0x75, 0xF0, 0x12, 0xEF, ++0xD1, 0xCB, 0xE4, 0xF0, 0xF1, 0x3C, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0xF1, 0x3C, 0xEE, 0xF0, ++0x22, 0x90, 0x04, 0x85, 0xE0, 0xF5, 0x6D, 0x90, 0x96, 0x17, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x64, ++0x90, 0x88, 0x2B, 0xE0, 0xFF, 0xE5, 0x64, 0xC3, 0x9F, 0x40, 0x02, 0xC1, 0x54, 0xE5, 0x64, 0x12, ++0xAB, 0xC6, 0xE0, 0xF5, 0x6F, 0xF1, 0xA1, 0xE0, 0x65, 0x6F, 0x60, 0x15, 0x90, 0x92, 0x5E, 0xE5, ++0x6F, 0xF0, 0xE4, 0xA3, 0xF0, 0xAB, 0x64, 0xFD, 0xFF, 0x12, 0x6F, 0x75, 0xF1, 0xA1, 0xE5, 0x6F, ++0xF0, 0x90, 0x04, 0xA0, 0xE0, 0x64, 0x01, 0x70, 0x50, 0xA3, 0xE0, 0x65, 0x64, 0x70, 0x4A, 0xA3, ++0xE0, 0xF5, 0x65, 0xA3, 0xE0, 0x90, 0x95, 0x2E, 0xF0, 0xE5, 0x64, 0x12, 0xAB, 0xC6, 0xE0, 0x65, ++0x65, 0x70, 0x02, 0xC1, 0x50, 0xE5, 0x64, 0x12, 0xAB, 0xC6, 0xE5, 0x65, 0xF0, 0xE5, 0x64, 0x12, ++0xAD, 0x7B, 0xE0, 0x54, 0xFC, 0xFF, 0x90, 0x95, 0x2E, 0xE0, 0x54, 0x03, 0x4F, 0xFF, 0xE5, 0x64, ++0x12, 0xAD, 0x7B, 0xEF, 0xF0, 0x90, 0x92, 0x5E, 0xE5, 0x65, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0xAB, ++0x64, 0xE4, 0xFD, 0xFF, 0x12, 0x6F, 0x75, 0xC1, 0x50, 0xAF, 0x64, 0x12, 0x78, 0x4A, 0x75, 0xF0, ++0x12, 0xE5, 0x64, 0x12, 0xA9, 0xE0, 0x12, 0x8F, 0xCA, 0xFD, 0xF1, 0x21, 0xED, 0xF0, 0x90, 0x95, ++0x37, 0x12, 0xAD, 0x88, 0xE5, 0x64, 0xF0, 0x12, 0xB3, 0xD6, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, ++0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0xFF, 0x90, 0x95, 0x3B, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0x7B, 0x02, 0x12, 0xAF, 0xE9, 0xD1, 0xD1, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD1, 0xC6, ++0xE0, 0xFD, 0xE5, 0x64, 0xC4, 0x54, 0xF0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, ++0xE0, 0x54, 0x80, 0xFB, 0xF1, 0x21, 0xEB, 0xF0, 0x12, 0xAF, 0xD4, 0xED, 0xF0, 0x90, 0x95, 0x35, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x96, 0x16, 0xD1, 0xBB, 0x7B, 0x03, 0x12, 0xAF, 0xE9, 0xAF, ++0x64, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x02, 0xC1, 0x50, 0x75, 0xF0, 0x12, 0xE5, 0x64, 0x12, 0xA9, ++0xE0, 0x12, 0x8F, 0xCA, 0x30, 0xE0, 0x02, 0xC1, 0x50, 0xE5, 0x64, 0x12, 0xB3, 0xD6, 0x80, 0x05, ++0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x60, 0x02, ++0xC1, 0x50, 0xD1, 0xD1, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x70, 0x07, 0xD1, 0xC6, 0xE0, 0x70, 0x02, ++0xC1, 0x50, 0xE5, 0x64, 0x75, 0xF0, 0x12, 0xA4, 0x24, 0x57, 0xF9, 0x74, 0x89, 0x35, 0xF0, 0xFA, ++0x7B, 0x01, 0x90, 0x95, 0x23, 0x12, 0x86, 0x7A, 0xF1, 0x28, 0x12, 0x03, 0x13, 0x2F, 0xFF, 0xD1, ++0xA7, 0x2F, 0xFF, 0xF1, 0x15, 0x2F, 0xFF, 0xD1, 0xEE, 0x2F, 0xF5, 0x6E, 0xD1, 0xD1, 0xE0, 0xF5, ++0x6A, 0xA3, 0xE0, 0xF5, 0x6B, 0xD1, 0xC6, 0xE0, 0xFF, 0x90, 0x95, 0x26, 0xE4, 0xF0, 0xA3, 0xEF, ++0xF0, 0xE5, 0x64, 0x12, 0xAB, 0xC6, 0xE0, 0xF5, 0x65, 0x54, 0x80, 0xF5, 0x67, 0xE5, 0x65, 0x54, ++0x7F, 0xF5, 0x66, 0x90, 0x96, 0x16, 0xE0, 0x60, 0x11, 0x75, 0x70, 0x0A, 0xD1, 0xAD, 0xE4, 0x93, ++0xC3, 0x13, 0x74, 0x01, 0x93, 0x13, 0xF5, 0x71, 0x80, 0x0D, 0x7B, 0xFF, 0x12, 0x9F, 0xD7, 0x12, ++0x86, 0x7A, 0xE4, 0xF5, 0x70, 0xF5, 0x71, 0xF1, 0x1B, 0x12, 0x03, 0x13, 0x12, 0xBD, 0x7A, 0xF1, ++0x28, 0x90, 0x95, 0x37, 0x12, 0xBD, 0x7E, 0xD1, 0xA7, 0xFF, 0x90, 0x95, 0x39, 0x12, 0xBD, 0x7E, ++0xF1, 0x15, 0xFF, 0x90, 0x95, 0x3B, 0x12, 0xBD, 0x7E, 0x7B, 0x01, 0x12, 0xAF, 0xE1, 0xD1, 0xE8, ++0x12, 0xBD, 0x7A, 0x90, 0x95, 0x26, 0xE0, 0xFF, 0xA3, 0xE0, 0xF1, 0x8C, 0xA3, 0xF1, 0x84, 0xA3, ++0xE4, 0xF0, 0xA3, 0xE5, 0x65, 0xF0, 0x7B, 0x02, 0x12, 0xAF, 0xE1, 0x75, 0xF0, 0x12, 0xE5, 0x64, ++0x12, 0xAE, 0x97, 0xFF, 0xE5, 0x66, 0xD3, 0x9F, 0x40, 0x08, 0x8F, 0x66, 0xE5, 0x66, 0x45, 0x67, ++0xF5, 0x65, 0x74, 0x76, 0x25, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, 0xC3, 0x94, ++0x05, 0x40, 0x02, 0x81, 0xED, 0xE5, 0x66, 0x90, 0x81, 0x61, 0x93, 0xF5, 0x6C, 0xFD, 0xAF, 0x66, ++0x12, 0x60, 0x6F, 0x8F, 0x6C, 0xE5, 0x67, 0x60, 0x04, 0x05, 0x6C, 0x05, 0x6C, 0x90, 0x04, 0x8C, ++0xE0, 0x64, 0x01, 0x70, 0x28, 0xE5, 0x66, 0xC3, 0x94, 0x0C, 0x40, 0x21, 0x74, 0x84, 0x25, 0x66, ++0xF5, 0x82, 0xE4, 0x34, 0x04, 0xF5, 0x83, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xEF, 0x30, 0xE7, 0x06, ++0xE5, 0x6C, 0x2E, 0xFF, 0x80, 0x05, 0xC3, 0xE5, 0x6C, 0x9E, 0xFF, 0x8F, 0x6C, 0xE5, 0x6C, 0xD3, ++0x94, 0x1A, 0xAF, 0x6C, 0x40, 0x02, 0x7F, 0x1A, 0x8F, 0x6C, 0x12, 0x96, 0x45, 0x7B, 0x03, 0xFA, ++0x12, 0xAF, 0xE3, 0xE5, 0x65, 0x90, 0x81, 0xD9, 0x93, 0xFF, 0xD3, 0x90, 0x95, 0x27, 0xE0, 0x9F, ++0x90, 0x95, 0x26, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x80, 0x64, 0xC3, 0xE5, 0x6B, 0x94, 0x0A, 0xE5, ++0x6A, 0x94, 0x00, 0x40, 0x02, 0x81, 0x0F, 0xD1, 0x83, 0xE0, 0xC3, 0x94, 0x01, 0x40, 0x05, 0xD1, ++0x83, 0xE0, 0x14, 0xF0, 0xD1, 0xE8, 0xFF, 0x90, 0x95, 0x27, 0xE0, 0x2F, 0xFF, 0x90, 0x95, 0x26, ++0xE0, 0xD1, 0xF4, 0xD1, 0xA6, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0xFC, 0xE5, 0x6A, 0xC3, 0x13, 0xFE, ++0xE5, 0x6B, 0x13, 0xFF, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x28, 0xE5, 0x64, 0x94, 0x05, 0x50, ++0x05, 0xD1, 0x83, 0x74, 0x03, 0xF0, 0x90, 0x95, 0x35, 0xF1, 0x84, 0xE5, 0x6A, 0xC3, 0x13, 0xA3, ++0xF0, 0xE5, 0x6B, 0x13, 0xA3, 0xD1, 0x55, 0xD1, 0xBB, 0x7B, 0x01, 0x12, 0xAE, 0xB9, 0x12, 0xAD, ++0xA1, 0x81, 0xED, 0xF1, 0x1B, 0x12, 0x03, 0x13, 0x65, 0x6E, 0x70, 0x02, 0xE5, 0xF0, 0x70, 0x52, ++0x90, 0x95, 0x35, 0xF0, 0xA3, 0xE5, 0x6E, 0xF0, 0xC3, 0x13, 0xFF, 0xA3, 0xE4, 0xF0, 0xA3, 0xEF, ++0xD1, 0x55, 0xD1, 0xBB, 0x7B, 0x02, 0x12, 0xAE, 0xB9, 0xE5, 0x64, 0xC3, 0x94, 0x05, 0x50, 0x0F, ++0xD1, 0x83, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x07, 0x12, 0x96, 0x40, 0x7B, 0x03, 0x80, 0x0C, 0xE5, ++0x6E, 0xC3, 0x94, 0x03, 0x50, 0x11, 0x12, 0x96, 0x40, 0x7B, 0x04, 0xFA, 0x12, 0xAE, 0xBB, 0x7D, ++0x06, 0xAF, 0x64, 0x11, 0x40, 0xC1, 0x50, 0xE4, 0xFD, 0xAF, 0x64, 0x12, 0xAC, 0x4D, 0x11, 0x3C, ++0x81, 0xED, 0x12, 0x96, 0x40, 0x7B, 0x08, 0xFA, 0x12, 0xAE, 0xBB, 0xF1, 0x5D, 0x81, 0xED, 0xD1, ++0x83, 0xE4, 0xF0, 0x90, 0x91, 0x6C, 0x74, 0x02, 0xF0, 0xAB, 0x6C, 0xAD, 0x64, 0xAF, 0x6B, 0xAE, ++0x6A, 0x12, 0x41, 0x9C, 0x8E, 0x68, 0x8F, 0x69, 0xD1, 0xAD, 0xC3, 0x74, 0x01, 0x93, 0x95, 0x71, ++0xFF, 0xE4, 0x93, 0x94, 0x00, 0xFE, 0xD3, 0xE5, 0x69, 0x9F, 0xE5, 0x68, 0x9E, 0x40, 0x34, 0xD1, ++0x9A, 0xE4, 0xF0, 0x7D, 0x01, 0xAF, 0x64, 0x12, 0xAC, 0x4D, 0xD1, 0xAD, 0xC3, 0x74, 0x01, 0x93, ++0x95, 0x71, 0xFE, 0xE4, 0x93, 0x94, 0x00, 0x90, 0x95, 0x37, 0xF0, 0xA3, 0xCE, 0xF0, 0x90, 0x95, ++0x35, 0xE5, 0x68, 0xF0, 0xA3, 0xE5, 0x69, 0xF0, 0xE4, 0x90, 0x95, 0x39, 0x12, 0x96, 0x53, 0x7B, ++0x01, 0x80, 0x20, 0xF1, 0x0D, 0xC3, 0xE5, 0x69, 0x9F, 0xE5, 0x68, 0x94, 0x00, 0x50, 0x1A, 0xD1, ++0x9A, 0xE4, 0xF0, 0x12, 0xAD, 0xA1, 0xF1, 0x03, 0x12, 0xAF, 0xD4, 0xEF, 0xF0, 0xE4, 0x12, 0x96, ++0x52, 0x7B, 0x02, 0xFA, 0x12, 0xAF, 0xDB, 0x80, 0x54, 0x11, 0x3C, 0xD1, 0xAD, 0xE4, 0x93, 0xFF, ++0x74, 0x01, 0x93, 0xF1, 0x8C, 0xF1, 0x03, 0xF1, 0x21, 0xEF, 0xF0, 0xD1, 0x9A, 0xD1, 0xBB, 0x7B, ++0x03, 0x7A, 0x00, 0x12, 0xAF, 0xDB, 0xD1, 0x9A, 0xE0, 0x04, 0xF0, 0xE5, 0x66, 0x90, 0x81, 0xED, ++0x93, 0x25, 0x70, 0xFF, 0xE4, 0x33, 0xFE, 0xD1, 0x9A, 0xE0, 0xC3, 0x9F, 0xEE, 0xF1, 0xB1, 0x40, ++0x1C, 0xD1, 0x9A, 0xE4, 0xF1, 0x0C, 0xD1, 0xAD, 0x74, 0x01, 0x93, 0x2F, 0xFF, 0xE4, 0x93, 0x34, ++0x00, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x64, 0x12, 0xAF, 0x70, 0xF0, 0x75, 0xF0, 0x12, ++0xE5, 0x64, 0x90, 0x89, 0x56, 0x12, 0x04, 0x6E, 0xE0, 0x64, 0x01, 0x60, 0x02, 0xC1, 0x3A, 0xF1, ++0x1B, 0xF1, 0x28, 0xAE, 0xF0, 0x12, 0x03, 0x13, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xD1, 0xA6, 0x2F, ++0xFF, 0xEE, 0xD1, 0xF4, 0xFE, 0x90, 0x00, 0x08, 0xD1, 0xFA, 0x90, 0x95, 0x28, 0xF0, 0xA3, 0xEF, ++0xF0, 0x12, 0x03, 0x13, 0xFF, 0xC3, 0x90, 0x95, 0x29, 0xE0, 0x9F, 0xFE, 0x90, 0x95, 0x28, 0xE0, ++0x95, 0xF0, 0x90, 0x95, 0x2A, 0xF0, 0xA3, 0xCE, 0xF0, 0xF1, 0x15, 0xFD, 0xAC, 0xF0, 0x25, 0xE0, ++0xFF, 0xEC, 0x33, 0xFE, 0xEF, 0x2D, 0xFD, 0xEE, 0x3C, 0xFC, 0xD1, 0xA7, 0x25, 0xE0, 0xFF, 0xE5, ++0xF0, 0x33, 0xFE, 0x90, 0x00, 0x02, 0xD1, 0xFA, 0xCF, 0x2D, 0xFD, 0xEF, 0x3C, 0xFC, 0xD1, 0xE8, ++0xAE, 0xF0, 0x78, 0x02, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x2D, 0xFF, 0xEC, 0x3E, 0x90, ++0x95, 0x2C, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0x26, 0xF1, 0x4A, 0xF1, 0x64, 0xD1, 0xDC, 0x50, ++0x07, 0x90, 0x95, 0x26, 0xF1, 0x30, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xE5, 0x64, 0x25, 0xE0, ++0xF1, 0x64, 0x12, 0xAF, 0x79, 0xF0, 0x90, 0x95, 0x28, 0xF1, 0x4A, 0xF1, 0x6C, 0xD1, 0xDC, 0x50, ++0x07, 0x90, 0x95, 0x28, 0xF1, 0x30, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xE5, 0x64, 0x25, 0xE0, ++0xF1, 0x6C, 0x12, 0xAF, 0x79, 0xF0, 0x90, 0x95, 0x2C, 0xF1, 0x4A, 0xF1, 0x74, 0xD1, 0xDC, 0x50, ++0x07, 0x90, 0x95, 0x2C, 0xF1, 0x30, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xE5, 0x64, 0x25, 0xE0, ++0xF1, 0x74, 0x12, 0xAF, 0x79, 0xF0, 0xC3, 0x74, 0xFF, 0x95, 0x6B, 0xFF, 0x74, 0xFF, 0x95, 0x6A, ++0xFE, 0xF1, 0x95, 0xD1, 0xDC, 0x50, 0x0A, 0xE5, 0x6B, 0x2D, 0xFF, 0xE5, 0x6A, 0x3C, 0xFE, 0x80, ++0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xF1, 0x95, 0x12, 0xAF, 0x79, 0xF0, 0xF1, 0x7C, 0xFB, 0xC3, 0x74, ++0xFF, 0x9B, 0xFF, 0x74, 0xFF, 0x9E, 0xFE, 0x74, 0xFF, 0x94, 0x00, 0xFD, 0x74, 0xFF, 0x94, 0x00, ++0xFC, 0x90, 0x8D, 0x71, 0x12, 0x86, 0x65, 0xD3, 0x12, 0x03, 0xDA, 0x50, 0x11, 0xF1, 0x7C, 0xFF, ++0xE4, 0xFC, 0xFD, 0x90, 0x8D, 0x71, 0x12, 0x86, 0x65, 0x12, 0x86, 0x30, 0x80, 0x06, 0x74, 0xFF, ++0xFF, 0xFE, 0xFD, 0xFC, 0x90, 0x8D, 0x71, 0x12, 0x04, 0x31, 0xF1, 0x5D, 0xE4, 0x90, 0x95, 0x35, ++0xF0, 0x12, 0x96, 0x4E, 0xA3, 0xF0, 0x7B, 0x01, 0xFA, 0x7D, 0xFF, 0x7F, 0x01, 0x12, 0xAE, 0xBF, ++0x05, 0x64, 0x01, 0xA0, 0x22, 0xF0, 0x90, 0x95, 0x23, 0x12, 0x86, 0x71, 0x90, 0x00, 0x06, 0x12, ++0x03, 0x3E, 0xFF, 0xAE, 0xF0, 0x90, 0x00, 0x08, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, ++0xFE, 0x90, 0x00, 0x04, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0x90, 0x95, 0x39, 0xF0, ++0xA3, 0xEF, 0xF0, 0x74, 0x28, 0x25, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0x12, ++0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, 0x22, 0x74, 0xA6, 0x25, 0x64, 0xF5, 0x82, ++0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0xFE, 0x90, 0x00, 0x04, 0x02, 0x03, 0x3E, 0xE5, 0x66, 0x25, ++0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xE0, 0xFF, 0x90, 0x95, 0x3B, ++0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x75, 0xF0, 0x12, 0xE5, 0x64, 0x90, 0x89, 0x55, 0x02, 0x04, ++0x6E, 0x75, 0xF0, 0x12, 0xE5, 0x64, 0x90, 0x89, 0x53, 0x02, 0x04, 0x6E, 0xF5, 0x83, 0xE0, 0xFC, ++0xA3, 0xE0, 0xFD, 0xD3, 0x9F, 0xEC, 0x9E, 0x22, 0x90, 0x95, 0x23, 0x12, 0x86, 0x71, 0x90, 0x00, ++0x08, 0x02, 0x03, 0x3E, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x06, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xEE, ++0x35, 0xF0, 0x22, 0x90, 0x95, 0x35, 0xE5, 0x68, 0xF0, 0xA3, 0xE5, 0x69, 0xF0, 0xE5, 0x66, 0x90, ++0x81, 0x9D, 0x93, 0xFF, 0x22, 0x90, 0x00, 0x06, 0x02, 0x03, 0x3E, 0x90, 0x95, 0x23, 0x02, 0x86, ++0x71, 0x90, 0x95, 0x39, 0xE4, 0xF0, 0xA3, 0x22, 0x90, 0x00, 0x02, 0x12, 0x03, 0x3E, 0xFF, 0x22, ++0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xED, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0x22, 0xEF, 0xC4, 0x54, 0xF0, ++0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, ++0x74, 0xFF, 0x9F, 0xFF, 0x74, 0xFF, 0x9E, 0xFE, 0xE5, 0x64, 0x25, 0xE0, 0x22, 0x7D, 0x01, 0xAF, ++0x64, 0x02, 0x61, 0xF7, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0x22, 0x24, 0x26, 0xF5, 0x82, ++0xE4, 0x34, 0x8E, 0x22, 0x24, 0x56, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0x22, 0x90, 0x95, 0x2A, 0xE0, ++0xFE, 0xA3, 0xE0, 0x22, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, 0x6B, 0xF0, 0x22, 0x90, 0x95, 0x37, 0xCF, ++0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xE5, 0x64, 0x25, 0xE0, 0x24, 0x86, 0xF5, 0x82, 0xE4, 0x34, 0x8E, ++0x22, 0x74, 0xB6, 0x25, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0xE0, 0xD3, 0x9D, ++0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0xE4, 0xF5, 0x77, 0xEF, 0x14, 0xF5, 0x76, 0xED, ++0xFF, 0xE5, 0x76, 0xF5, 0x82, 0x33, 0x95, 0xE0, 0xF5, 0x83, 0xC3, 0xE5, 0x82, 0x9F, 0x74, 0x80, ++0xF8, 0x65, 0x83, 0x98, 0x40, 0x52, 0xE5, 0x76, 0x78, 0x03, 0xA2, 0xE7, 0x13, 0xD8, 0xFB, 0xFF, ++0x33, 0x95, 0xE0, 0xFE, 0xEB, 0x12, 0xAF, 0x4C, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE5, 0x83, 0x3E, ++0xF5, 0x83, 0xE0, 0xF5, 0x82, 0x75, 0x83, 0x00, 0xE5, 0x76, 0x12, 0xB3, 0xEA, 0x80, 0x05, 0xC3, ++0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, 0x60, ++0x13, 0x85, 0x76, 0x78, 0x05, 0x77, 0x90, 0x95, 0x34, 0xE0, 0x65, 0x77, 0x60, 0x0A, 0xE5, 0x78, ++0xD3, 0x9D, 0x40, 0x04, 0x15, 0x76, 0x80, 0x97, 0xAF, 0x78, 0x22, 0xEF, 0x64, 0x13, 0x60, 0x04, ++0xEF, 0xB4, 0x0B, 0x05, 0x90, 0x88, 0xE3, 0x80, 0x1F, 0xEF, 0x64, 0x12, 0x60, 0x04, 0xEF, 0xB4, ++0x0A, 0x05, 0x90, 0x88, 0xE4, 0x80, 0x11, 0xEF, 0x64, 0x11, 0x60, 0x04, 0xEF, 0xB4, 0x09, 0x05, ++0x90, 0x88, 0xE5, 0x80, 0x03, 0x90, 0x88, 0xE2, 0xE0, 0xF5, 0x61, 0xAF, 0x61, 0x22, 0x90, 0x93, ++0x56, 0xE0, 0x54, 0x7F, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, 0xE4, 0x90, ++0x93, 0x58, 0xF0, 0x90, 0x93, 0x56, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, ++0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x8C, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, ++0x74, 0x71, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, 0x54, 0xF0, 0x44, 0x07, 0xF0, ++0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, 0xE4, ++0x02, 0x7F, 0x01, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x8A, 0xE5, 0x12, 0x8D, ++0xC8, 0x7F, 0x20, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x8A, 0x75, 0x12, 0x8D, 0xDA, 0x90, 0x8A, 0xE5, ++0x12, 0x8D, 0xC8, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x95, 0xAB, 0xF0, ++0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, 0x23, ++0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, 0xA8, ++0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x7B, ++0x2E, 0x80, 0xFE, 0x22, 0xE4, 0xF5, 0x7B, 0xF5, 0x7C, 0xF5, 0x7D, 0x31, 0x23, 0xBF, 0x03, 0x02, ++0x31, 0x33, 0x22, 0x90, 0x01, 0x02, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0x31, 0x23, 0xBF, 0x03, 0x02, ++0x31, 0x33, 0x22, 0x90, 0x05, 0x21, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0xE4, 0xFF, 0x02, 0x35, 0xBE, ++0x90, 0x8A, 0xDF, 0x12, 0xA1, 0x83, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x90, 0x96, 0x2D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, 0x90, 0x96, 0x37, 0x12, 0x04, ++0x31, 0x90, 0x96, 0x2F, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x96, 0x37, 0x12, 0x86, 0x65, ++0x12, 0x86, 0x4B, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0x2F, 0x12, 0x04, ++0xB8, 0x90, 0x96, 0x33, 0x12, 0x86, 0x65, 0x12, 0x86, 0x4B, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, ++0xD0, 0x00, 0x12, 0x86, 0x58, 0x90, 0x96, 0x3B, 0x12, 0x04, 0x31, 0x90, 0x96, 0x3B, 0x12, 0xB1, ++0x50, 0x90, 0x96, 0x2D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x96, 0x5F, ++0xEF, 0xF0, 0x90, 0x88, 0xE0, 0xE0, 0x70, 0x51, 0x7F, 0x48, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEE, ++0x54, 0x0F, 0xFE, 0xE4, 0xFD, 0xFC, 0x90, 0x96, 0x60, 0x12, 0x04, 0x31, 0xE4, 0x7F, 0x80, 0x51, ++0xA3, 0x70, 0x05, 0x90, 0x88, 0xBE, 0x80, 0x1B, 0xE4, 0xFF, 0xFE, 0x51, 0xA5, 0x70, 0x0A, 0x90, ++0x88, 0xBE, 0x04, 0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x56, 0xE4, 0xFF, 0x51, 0xA3, 0x70, 0x09, 0x90, ++0x88, 0xBE, 0x04, 0xF0, 0xA3, 0xF0, 0x80, 0x47, 0xE4, 0x7F, 0x80, 0xFE, 0x51, 0xA5, 0x70, 0x3F, ++0x90, 0x88, 0xBE, 0xF0, 0xA3, 0x04, 0xF0, 0x80, 0x36, 0x7F, 0x2C, 0x7E, 0x09, 0x12, 0x70, 0x70, ++0xEF, 0x54, 0x02, 0x51, 0xB8, 0x60, 0x08, 0x90, 0x88, 0xBE, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, ++0x90, 0x88, 0xBE, 0xF0, 0x7F, 0x30, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x01, 0x51, 0xB8, ++0x60, 0x07, 0xE4, 0x90, 0x88, 0xBF, 0xF0, 0x80, 0x06, 0x90, 0x88, 0xBF, 0x74, 0x01, 0xF0, 0x90, ++0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x7D, 0x11, 0xB1, 0x42, ++0x12, 0x8D, 0xDA, 0x90, 0x07, 0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x88, 0xDF, 0xE0, 0xFF, ++0x90, 0x8A, 0xF3, 0xB1, 0x0D, 0xE4, 0xFD, 0x12, 0x04, 0x7E, 0x90, 0x96, 0x5F, 0xE0, 0xFD, 0x70, ++0x02, 0x80, 0x1C, 0xED, 0xB4, 0x01, 0x06, 0x51, 0xB1, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x96, 0x5F, ++0xE0, 0xFD, 0xB4, 0x02, 0x06, 0x51, 0xB1, 0x44, 0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x03, 0x51, ++0xB1, 0xF0, 0x22, 0x7E, 0x02, 0xFD, 0xFC, 0x90, 0x96, 0x60, 0x12, 0x86, 0x65, 0xC3, 0x02, 0x03, ++0xDA, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xFF, 0xE4, 0xFE, 0xFD, 0xFC, 0x90, 0x96, 0x60, ++0x12, 0x04, 0x31, 0x90, 0x96, 0x60, 0x12, 0x04, 0xB8, 0xEC, 0x4D, 0x4E, 0x4F, 0x22, 0x90, 0x88, ++0x85, 0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x94, 0x9D, 0xE0, 0x24, 0x46, 0xFF, 0x90, ++0x94, 0x9C, 0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, 0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, 0x12, ++0x86, 0x3D, 0x90, 0x88, 0x85, 0x91, 0xDC, 0xEF, 0x24, 0x46, 0xFF, 0xE4, 0x3E, 0xFE, 0xE4, 0x3D, ++0xFD, 0xE4, 0x3C, 0xFC, 0x90, 0x88, 0x89, 0x91, 0xDC, 0x90, 0x88, 0x85, 0x51, 0xAA, 0x50, 0x02, ++0x61, 0xC4, 0x90, 0x88, 0x89, 0x12, 0x86, 0x65, 0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, 0x86, ++0x3D, 0x90, 0x95, 0xAF, 0x12, 0x04, 0x31, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x2C, 0x12, 0x9F, ++0x15, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, ++0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, ++0x00, 0xFA, 0x91, 0xE5, 0xEB, 0x2F, 0xFF, 0xEA, 0x80, 0x1D, 0x90, 0x88, 0x33, 0xB1, 0x4E, 0x30, ++0xE0, 0x02, 0x81, 0xC1, 0x91, 0xE5, 0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, 0xCD, ++0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, 0xED, 0x3E, 0x90, 0x95, 0xAB, 0xF0, 0xA3, 0xEF, 0xF0, 0xC3, ++0x90, 0x95, 0xAC, 0xE0, 0x94, 0xA0, 0x90, 0x95, 0xAB, 0xE0, 0x94, 0x00, 0x50, 0x36, 0xA3, 0xE0, ++0xFB, 0x24, 0x5C, 0x91, 0xD4, 0xE0, 0x04, 0xF0, 0x90, 0x95, 0xAF, 0x12, 0x04, 0xB8, 0xEF, 0x54, ++0x7F, 0xFF, 0x74, 0xFC, 0x2B, 0x91, 0xC9, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, 0x95, ++0xAB, 0xA3, 0xE0, 0x91, 0xC7, 0xEF, 0xF0, 0x90, 0x88, 0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, 0x7F, ++0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, 0xE0, 0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, ++0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x81, 0xC1, 0xE4, 0xFF, 0xFE, 0x91, 0xD1, 0xE0, 0x2F, ++0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, 0x40, 0x07, 0x90, 0x95, 0xAD, 0xEE, 0xF0, ++0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE5, 0x91, 0xF0, 0x40, 0x02, 0x80, 0x15, 0x90, 0x95, 0xAD, ++0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, 0x50, 0x13, 0x91, 0xD1, 0xE0, 0x2F, 0xFF, 0x91, 0xF0, ++0x40, 0x07, 0x90, 0x95, 0xAE, 0xEE, 0xF0, 0x80, 0x03, 0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, 0xE0, ++0xFF, 0x91, 0xC2, 0xE0, 0xFD, 0xEF, 0xC3, 0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, 0xF0, ++0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x95, 0xAE, 0xE0, 0x80, 0x18, 0x91, 0xC2, 0xE0, 0xFD, 0xC3, ++0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, 0xF0, 0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, 0x95, ++0xAE, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, ++0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, 0xF0, 0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, 0xF0, ++0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, 0x50, 0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, 0x51, ++0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, 0x88, ++0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, 0x4F, 0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, ++0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0xB1, 0x55, ++0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, 0x8A, 0xA3, 0x12, 0x8D, 0xC8, 0xE4, 0xFF, 0x12, 0x04, ++0x7E, 0x22, 0x90, 0x95, 0xAD, 0xE0, 0xFE, 0x24, 0xFC, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, ++0x22, 0x74, 0x5C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0x12, 0x04, 0x31, 0x90, ++0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, 0x95, 0xAF, 0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, 0x03, 0xEB, ++0x90, 0x88, 0x91, 0xE0, 0xFD, 0xC3, 0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, ++0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, 0x22, 0xFF, 0x90, 0x8A, 0xF9, 0xE0, 0xFC, 0xA3, ++0xE0, 0xF5, 0x82, 0x8C, 0x83, 0x22, 0xE4, 0xFE, 0x91, 0xD1, 0xE4, 0xF0, 0x74, 0xFC, 0x2E, 0x91, ++0xC9, 0x74, 0xFF, 0xF0, 0x0E, 0xEE, 0xB4, 0xA0, 0xEF, 0xE4, 0x90, 0x88, 0x4D, 0xF0, 0x90, 0x88, ++0x4C, 0xF0, 0x90, 0x88, 0x50, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0xA0, 0xF0, 0xE4, 0xA3, ++0xF0, 0x22, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x22, 0x90, 0x88, 0x32, 0xE0, 0xFF, ++0x13, 0x13, 0x54, 0x3F, 0x22, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x88, 0x4F, ++0xE0, 0xFB, 0x90, 0x92, 0x98, 0x22, 0x90, 0x94, 0x9E, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, 0x7E, ++0xFF, 0x7F, 0xFF, 0x80, 0x20, 0xB1, 0xB1, 0xB1, 0xAA, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, ++0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, 0x12, 0xA4, 0xCB, 0xE0, 0xFE, 0x74, 0xC8, 0x2D, 0x12, 0xA4, ++0xCB, 0x12, 0xB6, 0x17, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x07, 0xC0, 0x74, 0x80, 0xF0, ++0x22, 0x90, 0x07, 0xC0, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, 0x12, 0xB7, 0xA2, 0xB1, 0xAA, 0x90, 0x07, 0xC3, 0xE0, 0x30, ++0xE5, 0xF9, 0xED, 0x54, 0x03, 0x24, 0xC8, 0x12, 0xA4, 0xCB, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x7D, 0x12, 0xB7, 0x9D, 0xD1, 0x48, ++0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x01, 0xF0, 0x80, 0x37, 0xEF, ++0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, 0x07, 0xC5, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x02, 0xF0, ++0x80, 0x24, 0xD1, 0x48, 0x64, 0x02, 0x70, 0x0D, 0x90, 0x07, 0xC6, 0xED, 0xF0, 0x90, 0x07, 0xC2, ++0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, 0x64, 0x03, 0x4E, 0x70, 0x0B, 0x90, 0x07, 0xC7, 0xED, 0xF0, ++0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, ++0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7E, 0x00, 0x90, 0x96, 0x7E, 0xE0, 0x54, 0x03, ++0xFF, 0x22, 0x90, 0x95, 0x23, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, ++0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x7D, 0x07, 0xEF, 0x5D, 0xC3, 0x60, 0x0B, 0xD1, ++0x7F, 0x5F, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x04, 0xD1, 0x7F, 0x5F, 0xFF, 0x22, 0x74, ++0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x22, 0x12, 0x97, 0xF3, 0xE4, 0xA3, ++0xF0, 0xA3, 0xF0, 0x90, 0x93, 0x0A, 0x12, 0x96, 0x53, 0x90, 0x93, 0x25, 0xF0, 0xA3, 0xF0, 0xA3, ++0xF0, 0x22, 0x90, 0x04, 0x24, 0xEF, 0xF0, 0x90, 0x04, 0x57, 0xF0, 0x22, 0x90, 0x93, 0x0E, 0xE0, ++0xFD, 0x7C, 0x00, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x02, 0x92, 0xED, 0x4C, 0x70, 0x05, ++0x90, 0x93, 0x1B, 0x80, 0x2A, 0xED, 0x64, 0x01, 0x4C, 0x70, 0x05, 0x90, 0x93, 0x1C, 0x80, 0x1F, ++0xED, 0x64, 0x02, 0x4C, 0x70, 0x05, 0x90, 0x93, 0x1D, 0x80, 0x14, 0xED, 0x64, 0x03, 0x4C, 0x70, ++0x05, 0x90, 0x93, 0x1E, 0x80, 0x09, 0xED, 0x64, 0x04, 0x4C, 0x70, 0x0D, 0x90, 0x93, 0x1F, 0xE0, ++0xFF, 0xD1, 0xA2, 0x90, 0x93, 0x0F, 0x12, 0x9F, 0xC0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x10, 0x90, 0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, 0x07, ++0x30, 0xE0, 0x12, 0x75, 0x0E, 0x10, 0x80, 0x40, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, ++0x75, 0x0E, 0x01, 0x80, 0x33, 0x90, 0x88, 0x31, 0x12, 0xA1, 0xE4, 0x30, 0xE0, 0x05, 0x75, 0x0E, ++0x02, 0x80, 0x25, 0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x0E, 0x08, 0x80, ++0x17, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, 0x0B, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x05, 0x75, 0x0E, ++0x11, 0x80, 0x05, 0x12, 0xB5, 0xC7, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, ++0xB8, 0xE5, 0x0E, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x1F, 0x90, 0x88, 0xAF, 0xE0, 0x60, 0x06, 0x75, ++0x0F, 0x40, 0x02, 0xD0, 0x16, 0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x2D, ++0x90, 0x88, 0x9C, 0xE0, 0x60, 0x7B, 0x80, 0x55, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, ++0x75, 0x0F, 0x01, 0x80, 0x71, 0x90, 0x88, 0x3A, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x0F, ++0x02, 0x80, 0x63, 0x90, 0x88, 0x38, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, 0x0F, 0x04, ++0x80, 0x54, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x0F, 0x08, 0x80, 0x4B, 0x90, 0x88, 0x3A, 0xE0, 0x30, ++0xE4, 0x05, 0x75, 0x0F, 0x10, 0x80, 0x3F, 0x90, 0x88, 0x32, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, ++0xE0, 0x05, 0x75, 0x0F, 0x20, 0x80, 0x2F, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x05, 0x75, 0x0F, 0x80, ++0x80, 0x24, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, 0x05, 0x75, 0x0F, 0x11, 0x80, 0x18, 0x90, 0x06, ++0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, 0x05, 0x75, 0x0F, 0x12, 0x80, ++0x05, 0x12, 0xB5, 0xC7, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, ++0x0F, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, 0xF0, 0xA3, ++0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x11, ++0x84, 0x40, 0x40, 0x90, 0x88, 0x50, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, 0x90, 0x88, ++0x50, 0xE0, 0xD3, 0x9F, 0x50, 0x2D, 0x90, 0x88, 0x48, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3F, 0x12, ++0xA2, 0x90, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0x88, 0x3E, 0xE0, 0x2F, 0x90, 0x88, 0x4F, ++0xF0, 0xFB, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x92, 0x98, 0x74, 0x03, 0xF0, ++0x12, 0x6E, 0x2F, 0x22, 0x90, 0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, 0x3F, 0xE0, 0xD3, 0x9F, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xBF, 0x87, 0xE0, 0x90, 0x94, 0x9E, 0xF0, 0x90, ++0x88, 0x32, 0xE0, 0x12, 0x8F, 0xCA, 0x30, 0xE0, 0x02, 0x21, 0x59, 0x90, 0x88, 0x31, 0xE0, 0x30, ++0xE0, 0x1D, 0x12, 0x9F, 0x15, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, ++0x53, 0xE0, 0x24, 0x03, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, ++0x88, 0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, 0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, ++0x88, 0x4A, 0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, 0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, ++0xF0, 0x90, 0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, 0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, ++0x3E, 0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, ++0x88, 0x4B, 0x31, 0x65, 0x90, 0x88, 0x4E, 0x12, 0xC7, 0xAD, 0x40, 0x04, 0xEF, 0x24, 0x50, 0xF0, ++0x90, 0x88, 0x4E, 0x31, 0x65, 0x90, 0x88, 0x3E, 0x12, 0xC7, 0xAD, 0x40, 0x04, 0xEF, 0x24, 0x50, ++0xF0, 0x90, 0x88, 0x4E, 0x12, 0xA1, 0xE4, 0xFF, 0x7E, 0x00, 0x90, 0x88, 0x42, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x05, 0xB1, ++0xE0, 0x54, 0xF8, 0x4F, 0xF0, 0x31, 0x6E, 0x80, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x01, 0xF0, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, 0x33, 0xFC, 0x22, 0x90, 0x88, ++0x33, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, ++0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x2B, 0x90, 0x95, 0xF3, 0x74, 0x1E, 0xF0, 0x90, 0x96, 0x15, 0x74, ++0x01, 0xF0, 0x90, 0x95, 0xF5, 0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xF3, 0x90, 0x8A, 0x77, ++0x12, 0x9F, 0xE9, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0xC8, 0x7F, 0x04, 0x12, 0x04, ++0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, 0x34, 0xC4, 0x13, 0x54, ++0x07, 0x30, 0xE0, 0x2D, 0x90, 0x96, 0x86, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0xC8, 0x40, 0x21, ++0x90, 0x93, 0x29, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0x96, 0x86, 0xF0, 0x90, 0x93, 0x29, 0xE0, ++0x13, 0x30, 0xE0, 0x0D, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x88, 0x41, 0x74, 0xD0, ++0xF0, 0x22, 0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x89, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, ++0x8A, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x8B, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, ++0x8C, 0xF0, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, ++0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x77, 0xF5, 0x82, ++0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x35, 0xF5, 0x82, 0xE4, 0x34, ++0x95, 0xF5, 0x83, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, 0x22, 0xE0, 0x90, ++0x01, 0xBA, 0xF0, 0x90, 0x88, 0x38, 0xE0, 0x22, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x93, 0x2B, ++0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x22, 0x90, 0x88, 0x34, 0xE0, 0xFF, 0xC4, ++0x54, 0x0F, 0x22, 0xED, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0x07, 0xC2, 0x22, 0x12, 0x02, 0x06, 0x13, ++0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x88, 0x3C, ++0xE0, 0x90, 0x05, 0x73, 0x22, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0x00, 0x82, 0xDC, ++ ++}; ++u4Byte ArrayLength_MP_8723D_FW_AP = 21184; ++ ++#endif ++ ++void ++ODM_ReadFirmware_MP_8723D_FW_AP( ++ IN PDM_ODM_T pDM_Odm, ++ OUT u1Byte *pFirmware, ++ OUT u4Byte *pFirmwareSize ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)array_mp_8723d_fw_ap; ++#else ++ ODM_MoveMemory(pDM_Odm, pFirmware, array_mp_8723d_fw_ap, array_length_mp_8723d_fw_ap); ++#endif ++ *pFirmwareSize = array_length_mp_8723d_fw_ap; ++} ++ ++ ++#endif /* #if (defined(CONFIG_AP_WOWLAN)||(DM_ODM_SUPPORT_TYPE & (ODM_AP)) */ ++ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) || (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++ ++#ifndef LOAD_FW_HEADER_FROM_DRIVER ++u8 array_mp_8723d_fw_nic[] = { ++0xD1, 0x23, 0x10, 0x00, 0x10, 0x00, 0x00, 0x00, 0x05, 0x16, 0x18, 0x16, 0x12, 0x64, 0x02, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x02, 0x86, 0x75, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xBC, 0x29, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xC8, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xC6, 0x90, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0xC6, 0xE0, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xC7, 0xD1, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, ++0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, ++0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, ++0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0A, ++0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, ++0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, ++0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, ++0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, ++0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, ++0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, ++0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, ++0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, ++0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, ++0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, ++0x30, 0x04, 0x04, 0x04, 0x05, 0x08, 0x08, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x06, 0x0B, 0x0D, ++0x0E, 0x0F, 0x11, 0x12, 0x14, 0x00, 0x04, 0x00, 0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x23, 0x00, ++0x2D, 0x00, 0x50, 0x00, 0x91, 0x00, 0xC3, 0x01, 0x27, 0x01, 0x31, 0x01, 0x5E, 0x00, 0xC8, 0x00, ++0xF0, 0x00, 0xDC, 0x01, 0x5E, 0x01, 0x68, 0x01, 0x9A, 0x01, 0xCC, 0x01, 0xEA, 0x02, 0x02, 0x04, ++0x08, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C, 0x14, 0x28, 0x32, 0x50, 0x78, 0xA0, 0xC8, ++0xE6, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x02, 0x04, 0x06, ++0x07, 0x07, 0x08, 0x08, 0x08, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, ++0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x02, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, ++0x02, 0x03, 0x03, 0x04, 0x05, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x03, 0x03, 0x03, ++0x02, 0x03, 0x03, 0x03, 0x03, 0x03, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, ++0x02, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x83, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, ++0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, ++0xEC, 0x24, 0x8B, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, ++0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, ++0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, ++0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, ++0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x8A, 0x25, 0x0C, 0xF8, ++0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, ++0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, ++0x0C, 0x24, 0x8B, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, ++0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x8A, ++0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, ++0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, ++0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x8A, 0xA6, ++0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, ++0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x86, 0xF8, 0x74, 0x01, 0x93, ++0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, ++0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, ++0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, ++0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x8A, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, ++0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, ++0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, ++0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x8A, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, ++0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, ++0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x8A, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, ++0x04, 0x90, 0x86, 0xF8, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, ++0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, ++0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x8A, 0x2F, ++0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x83, 0x4D, 0x50, 0x2E, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, ++0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x8A, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, ++0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, ++0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, ++0x0F, 0x74, 0x8A, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, ++0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, ++0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, ++0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, ++0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x83, 0x4C, 0x8F, 0xF0, ++0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, ++0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, ++0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, ++0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, ++0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x83, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, ++0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xEF, 0x2B, 0xFF, ++0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, ++0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xE8, 0x8F, 0xF0, 0xA4, 0xCC, 0x8B, 0xF0, 0xA4, ++0x2C, 0xFC, 0xE9, 0x8E, 0xF0, 0xA4, 0x2C, 0xFC, 0x8A, 0xF0, 0xED, 0xA4, 0x2C, 0xFC, 0xEA, 0x8E, ++0xF0, 0xA4, 0xCD, 0xA8, 0xF0, 0x8B, 0xF0, 0xA4, 0x2D, 0xCC, 0x38, 0x25, 0xF0, 0xFD, 0xE9, 0x8F, ++0xF0, 0xA4, 0x2C, 0xCD, 0x35, 0xF0, 0xFC, 0xEB, 0x8E, 0xF0, 0xA4, 0xFE, 0xA9, 0xF0, 0xEB, 0x8F, ++0xF0, 0xA4, 0xCF, 0xC5, 0xF0, 0x2E, 0xCD, 0x39, 0xFE, 0xE4, 0x3C, 0xFC, 0xEA, 0xA4, 0x2D, 0xCE, ++0x35, 0xF0, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, ++0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, ++0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE0, 0xFB, 0xA3, ++0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, ++0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, ++0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, ++0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x02, 0x86, 0xB3, 0x02, 0x83, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, ++0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, ++0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, ++0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, ++0x20, 0x40, 0x80, 0x90, 0x86, 0xFE, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, ++0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, ++0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, ++0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, ++0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0xC1, 0x5D, 0xC5, 0x66, 0x8A, 0x51, 0x41, 0x96, ++0xFD, 0x00, 0x00, 0x90, 0x96, 0xFB, 0xEF, 0xF0, 0x7F, 0x02, 0xB1, 0x27, 0x90, 0x86, 0xAF, 0xE0, ++0xFF, 0x90, 0x96, 0xFB, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, 0x22, 0x90, 0x02, 0x09, ++0xE0, 0xFD, 0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x86, 0xB4, 0xF1, 0xA0, 0xFF, ++0xED, 0x2F, 0x90, 0x86, 0xB5, 0xF1, 0x6B, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB6, 0x12, 0xB8, 0x9D, ++0xED, 0x2F, 0x90, 0x86, 0xB7, 0xF1, 0x98, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB8, 0xF1, 0x64, 0xFF, ++0xED, 0x2F, 0x90, 0x86, 0xB9, 0x12, 0x9F, 0xEE, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x86, 0xBA, ++0xF0, 0x22, 0x4E, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, 0x02, 0x1F, 0xF0, 0x90, 0x00, 0x02, 0x02, ++0x02, 0x1F, 0x12, 0xA0, 0xC2, 0x90, 0x93, 0x60, 0xF1, 0xA0, 0x90, 0x93, 0x61, 0xF1, 0x6B, 0x90, ++0x93, 0x7B, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x02, 0x1F, 0x90, 0x93, 0x7C, 0xF1, 0x98, 0x90, 0x93, ++0x96, 0xF1, 0x64, 0x90, 0x93, 0x97, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x02, 0x1F, 0x4F, ++0xF0, 0x90, 0x00, 0x01, 0x02, 0x02, 0x1F, 0x12, 0x9F, 0xE1, 0x12, 0x02, 0x06, 0xFF, 0xF1, 0xA1, ++0xFE, 0x54, 0x03, 0xFD, 0xEE, 0x13, 0x13, 0x54, 0x07, 0xFB, 0xC0, 0x03, 0xF1, 0xF5, 0xF1, 0x6C, ++0x12, 0xE2, 0xB7, 0xD0, 0x03, 0x12, 0x8F, 0x42, 0xF1, 0xF5, 0xF1, 0xA1, 0xFE, 0x54, 0x03, 0x12, ++0x8B, 0x8E, 0x90, 0x95, 0x36, 0x74, 0x10, 0xF0, 0x90, 0x95, 0x58, 0x74, 0x07, 0xF1, 0xF4, 0x12, ++0x02, 0x06, 0x90, 0x95, 0x38, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x36, 0x12, 0x90, 0x2E, 0x7F, ++0x04, 0x02, 0x04, 0x7E, 0xF0, 0x90, 0x95, 0x33, 0xC1, 0x3D, 0x12, 0x9F, 0xE1, 0x90, 0x93, 0xE1, ++0xE0, 0x70, 0x13, 0x12, 0x87, 0xF5, 0x12, 0x02, 0x06, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x06, ++0x90, 0x93, 0xE7, 0x74, 0x01, 0xF0, 0x90, 0x93, 0xE3, 0xE0, 0x70, 0x13, 0x12, 0x87, 0xF5, 0x12, ++0x02, 0x06, 0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x06, 0x90, 0x93, 0xE8, 0x74, 0x01, 0xF0, 0x12, ++0x87, 0xF5, 0x12, 0x87, 0xA1, 0xFF, 0x90, 0x95, 0x37, 0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, ++0xE0, 0x0C, 0x12, 0x87, 0xF5, 0x12, 0x87, 0x6C, 0x90, 0x95, 0x38, 0xF0, 0x80, 0x05, 0x90, 0x95, ++0x38, 0xEF, 0xF0, 0x90, 0x95, 0x37, 0xE0, 0x90, 0x95, 0x36, 0xF0, 0x90, 0x95, 0x38, 0xE0, 0xFE, ++0x90, 0x95, 0x36, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x37, 0x12, 0x87, 0xF5, 0x12, 0x02, 0x06, 0x54, ++0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, 0x95, 0x36, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x90, 0x95, ++0x36, 0x70, 0x06, 0xE0, 0xFF, 0xF1, 0xE5, 0x80, 0x05, 0xE0, 0xFF, 0x12, 0xB8, 0xBC, 0x90, 0x93, ++0xE8, 0xE0, 0x60, 0x07, 0x90, 0x95, 0x36, 0xE0, 0xFF, 0xF1, 0xE5, 0x12, 0xE3, 0x7B, 0x80, 0xBB, ++0x90, 0x05, 0x5E, 0xE4, 0xF0, 0x90, 0x95, 0x37, 0xE0, 0x70, 0x1A, 0xFF, 0x12, 0x78, 0x4A, 0xEF, ++0x70, 0x13, 0x90, 0x86, 0x0C, 0x11, 0xD0, 0x90, 0x8A, 0xED, 0x11, 0xD0, 0x12, 0xE3, 0xD6, 0x54, ++0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x7D, 0xFF, 0x7F, 0xFF, 0x12, 0x9A, 0x2E, 0x90, 0x8A, 0xFD, ++0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x96, 0xFF, 0xED, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, ++0x30, 0xE0, 0x02, 0x41, 0x4C, 0xEE, 0x12, 0xA9, 0xA5, 0x30, 0xE0, 0x02, 0x41, 0x4C, 0x90, 0x88, ++0x39, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x41, 0x4C, 0xEF, 0x70, 0x02, 0x21, 0xA8, 0x24, 0xFE, 0x70, ++0x02, 0x21, 0xED, 0x24, 0xFE, 0x60, 0x4F, 0x24, 0xFC, 0x70, 0x02, 0x41, 0x32, 0x24, 0xFC, 0x60, ++0x02, 0x41, 0x45, 0xEE, 0xB4, 0x0E, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, ++0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, ++0x88, 0x39, 0xE0, 0xB4, 0x04, 0x11, 0x90, 0x96, 0xFF, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x67, 0x80, ++0x80, 0x05, 0x90, 0x8A, 0xED, 0x11, 0xD0, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x41, ++0x45, 0x12, 0x7B, 0xCC, 0x41, 0x45, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, ++0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, ++0x0E, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xD0, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, ++0xE0, 0x64, 0x0C, 0x60, 0x02, 0x41, 0x45, 0x90, 0x86, 0x00, 0x11, 0xD0, 0xEF, 0x64, 0x01, 0x60, ++0x02, 0x41, 0x45, 0x12, 0x68, 0xC2, 0x41, 0x45, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, ++0x86, 0x00, 0x11, 0xD0, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, ++0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xD0, ++0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x04, 0x70, 0x67, 0x90, 0x86, ++0x02, 0x11, 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x5D, 0x12, 0x73, 0x5A, 0x80, 0x58, 0x90, 0x88, 0x39, ++0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xD0, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, ++0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, ++0x90, 0x86, 0x00, 0x11, 0xD0, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x70, ++0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x18, 0x12, 0x7A, 0x49, ++0x80, 0x13, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, 0x88, 0x32, 0x12, 0x9F, 0xE7, 0x30, ++0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, 0x88, 0x39, 0x12, 0xE3, 0x2C, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x85, 0x4E, 0x90, 0x95, 0xB3, 0xEF, 0xF0, 0x60, ++0xF0, 0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, ++0xE0, 0x0F, 0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x35, 0xBE, 0x12, 0xD5, ++0x7A, 0x51, 0xAC, 0x30, 0xE1, 0x08, 0x54, 0xFD, 0xF0, 0x90, 0x86, 0x08, 0x11, 0xD0, 0x51, 0xAC, ++0x30, 0xE2, 0x08, 0x54, 0xFB, 0xF0, 0x90, 0x86, 0x0A, 0x11, 0xD0, 0x51, 0xAC, 0x30, 0xE6, 0x08, ++0x54, 0xBF, 0xF0, 0x90, 0x8A, 0x7D, 0x11, 0xD0, 0xD2, 0xAF, 0x80, 0xB5, 0xD2, 0xAF, 0xC2, 0xAF, ++0x90, 0x86, 0xAF, 0xE0, 0x22, 0x11, 0xCD, 0xEF, 0x70, 0x02, 0xFF, 0x22, 0xF1, 0x18, 0x90, 0x93, ++0xAC, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, 0xEF, 0x54, 0xF1, 0xFF, 0xEE, 0x04, ++0x54, 0x07, 0x25, 0xE0, 0x4F, 0xF0, 0xA3, 0xE0, 0xFF, 0x12, 0xE3, 0x71, 0xB5, 0x07, 0x04, 0xEE, ++0x54, 0xF1, 0xF0, 0xF1, 0x18, 0xF5, 0x7F, 0xE4, 0x90, 0x93, 0x5A, 0xF0, 0xE5, 0x7F, 0x75, 0xF0, ++0x1B, 0xA4, 0x24, 0x5F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x30, 0xE0, 0x28, 0x71, ++0x82, 0xE0, 0x24, 0xAF, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFF, 0xE5, 0x7F, 0xF1, ++0x34, 0xEF, 0x71, 0x81, 0xE0, 0x04, 0x71, 0x81, 0xE0, 0xFF, 0x90, 0x93, 0xAE, 0xE0, 0xFE, 0xEF, ++0xB5, 0x06, 0x04, 0x71, 0x82, 0xE4, 0xF0, 0xE5, 0x7F, 0xF1, 0x34, 0xE0, 0xFC, 0x90, 0x93, 0xAC, ++0xE0, 0xF1, 0x34, 0xE0, 0x6C, 0x60, 0x13, 0xE5, 0x7F, 0x12, 0x9B, 0x7C, 0x12, 0xE2, 0xAA, 0xAF, ++0x04, 0xF1, 0x42, 0xE5, 0x7F, 0x12, 0x9B, 0x7C, 0x71, 0x8E, 0xE5, 0x7F, 0xF1, 0xD6, 0x54, 0x07, ++0xFF, 0x60, 0x03, 0xBF, 0x02, 0x10, 0xE5, 0x7F, 0x12, 0x98, 0x24, 0xE0, 0xFF, 0x7E, 0x00, 0x7B, ++0x04, 0xE4, 0xFD, 0x12, 0x9A, 0x39, 0xAD, 0x7F, 0x7F, 0x01, 0x12, 0x9A, 0xDE, 0x90, 0x93, 0xAD, ++0xE0, 0xC3, 0x13, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x05, 0xE4, 0xFF, 0x12, 0x9F, 0xF5, 0x7F, 0x01, ++0x22, 0xF0, 0x74, 0xD2, 0x25, 0x7F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0xFF, 0xEE, ++0x13, 0x13, 0x54, 0x07, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xF5, 0xED, ++0xF0, 0xE4, 0xA3, 0xF0, 0xEF, 0x14, 0x60, 0x02, 0x81, 0x79, 0x90, 0x06, 0x03, 0xE0, 0x54, 0xFB, ++0xF0, 0x90, 0x96, 0xF5, 0xE0, 0xFB, 0xC4, 0x33, 0x54, 0xE0, 0xFE, 0x90, 0x04, 0x42, 0xE0, 0x54, ++0x9F, 0x4E, 0xFE, 0xF0, 0xE4, 0xFD, 0x12, 0xDE, 0x54, 0x90, 0x96, 0xF6, 0xEF, 0xF0, 0x90, 0x04, ++0x83, 0xF0, 0x90, 0x96, 0xA1, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xA5, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0xB1, 0x45, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, ++0x96, 0xA5, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x09, 0xB1, 0x49, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x00, 0x10, 0x90, 0x96, 0xF5, 0xB1, 0x68, 0xEF, 0x54, 0x03, 0xFF, 0xE4, ++0x78, 0x01, 0x12, 0x03, 0xEB, 0x78, 0x04, 0xF1, 0x21, 0x7F, 0x00, 0x7E, 0x0A, 0xB1, 0x49, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0xF5, 0xB1, 0x68, 0xEF, 0x54, 0x03, 0xFF, 0xE4, ++0x78, 0x0A, 0xF1, 0x21, 0x7F, 0x00, 0x7E, 0x0D, 0xB1, 0x49, 0x12, 0x04, 0x3D, 0x0C, 0x00, 0x00, ++0x00, 0x90, 0x96, 0xF6, 0xB1, 0x68, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, 0x1A, 0xF1, 0x21, 0x7F, ++0x18, 0xB1, 0x47, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0xA5, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x00, 0x00, 0xF1, 0x2A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0x93, ++0x12, 0x04, 0x3D, 0x00, 0x00, 0x04, 0x00, 0x80, 0x58, 0x90, 0x06, 0x03, 0xE0, 0x44, 0x04, 0xF0, ++0x90, 0x96, 0xA1, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xA5, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x00, 0x00, 0xB1, 0x45, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xA5, ++0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, 0x09, 0xB1, 0x49, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0xA5, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0xF1, 0x2A, ++0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0x93, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, ++0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0xDD, 0xCA, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x9F, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x70, ++0x70, 0x90, 0x96, 0xA9, 0x12, 0x04, 0x31, 0x90, 0x96, 0xA1, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, ++0x90, 0x96, 0xA9, 0xF1, 0xBA, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0xA1, ++0x12, 0x04, 0xB8, 0x90, 0x96, 0xA5, 0xF1, 0xBA, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, ++0x12, 0x86, 0x24, 0x90, 0x96, 0xAD, 0x12, 0x04, 0x31, 0x90, 0x96, 0xAD, 0x12, 0x04, 0xB8, 0x90, ++0x92, 0x18, 0x12, 0x04, 0x31, 0x90, 0x96, 0x9F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x00, 0x7E, 0x08, 0x91, 0xDF, 0x90, 0x96, 0xA1, 0x22, 0x90, ++0x05, 0x61, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, 0x04, 0xA9, ++0x05, 0xAA, 0x06, 0xAB, 0x07, 0x90, 0x05, 0x60, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0x90, ++0x93, 0x58, 0xE0, 0x20, 0xE0, 0x02, 0xE1, 0x17, 0x90, 0x93, 0xDA, 0xE0, 0x04, 0xF0, 0xF1, 0x18, ++0x04, 0xFF, 0x90, 0x96, 0x1B, 0xF0, 0x90, 0x93, 0x59, 0xE0, 0xB5, 0x07, 0x05, 0xE4, 0x90, 0x96, ++0x1B, 0xF0, 0x90, 0x93, 0xD8, 0xE0, 0xFF, 0x60, 0x1A, 0x90, 0x96, 0x1B, 0xF1, 0xC3, 0xE0, 0xC3, ++0x9F, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, ++0x12, 0x66, 0x33, 0x90, 0x96, 0x1B, 0xE0, 0xFF, 0xF1, 0xD6, 0x54, 0x07, 0xFE, 0x64, 0x02, 0x60, ++0x03, 0xEE, 0x70, 0x11, 0xEF, 0xF1, 0xC4, 0xE0, 0x24, 0xFC, 0xFF, 0xE4, 0x90, 0x92, 0x20, 0xF0, ++0xA3, 0xEF, 0x12, 0xA6, 0x13, 0x90, 0x93, 0x58, 0xE0, 0xF1, 0xD2, 0x54, 0x07, 0xFF, 0x14, 0x60, ++0x0F, 0x14, 0x60, 0x07, 0x14, 0x60, 0x09, 0x24, 0x03, 0x70, 0x0B, 0x12, 0x9B, 0x8E, 0x80, 0x03, ++0x12, 0x9A, 0x23, 0x12, 0x98, 0x32, 0x90, 0x93, 0xD7, 0xE0, 0xFF, 0x90, 0x93, 0xDA, 0xE0, 0xD3, ++0x9F, 0x40, 0x02, 0xE1, 0x17, 0xB1, 0x4F, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, ++0xC0, 0x07, 0x90, 0x05, 0x62, 0xB1, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, ++0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, ++0xB1, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, ++0x86, 0x24, 0x90, 0x96, 0x1C, 0x12, 0x04, 0x31, 0x90, 0x05, 0x65, 0xB1, 0x68, 0x12, 0xCF, 0xCA, ++0x90, 0x05, 0x64, 0xB1, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, ++0x90, 0x05, 0x66, 0xB1, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, ++0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0xB1, 0x68, ++0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, ++0x90, 0x96, 0x20, 0x12, 0x04, 0x31, 0x90, 0x96, 0x1B, 0xF1, 0xC3, 0xB1, 0x68, 0x12, 0xE3, 0x82, ++0x90, 0x96, 0x1C, 0x12, 0x86, 0x31, 0x12, 0x85, 0xAD, 0x90, 0x96, 0x24, 0x12, 0x04, 0x31, 0x90, ++0x96, 0x1C, 0x12, 0x04, 0xB8, 0x90, 0x96, 0x24, 0x12, 0xCF, 0xD8, 0x50, 0x0C, 0x90, 0x96, 0x20, ++0x12, 0xCC, 0xA6, 0x90, 0x96, 0x20, 0x12, 0x04, 0x31, 0x90, 0x96, 0x20, 0x12, 0xCF, 0xC2, 0x90, ++0x05, 0x8B, 0xEF, 0xF0, 0x90, 0x96, 0x20, 0x12, 0xCF, 0xAE, 0x90, 0x05, 0x8A, 0xEF, 0xF0, 0x90, ++0x96, 0x20, 0x12, 0xCF, 0xA6, 0x90, 0x05, 0x89, 0xEF, 0xF0, 0x90, 0x96, 0x20, 0x12, 0xE3, 0x8A, ++0x90, 0x96, 0x24, 0x12, 0xCF, 0xC2, 0x90, 0x05, 0x87, 0xEF, 0xF0, 0x90, 0x96, 0x24, 0x12, 0xCF, ++0xAE, 0x90, 0x05, 0x86, 0xEF, 0xF0, 0x90, 0x96, 0x24, 0x12, 0xCF, 0xA6, 0x90, 0x05, 0x85, 0xEF, ++0xF0, 0x90, 0x96, 0x24, 0x12, 0xE2, 0xD4, 0x22, 0x90, 0x93, 0x58, 0xE0, 0xC3, 0x13, 0x54, 0x07, ++0x22, 0x12, 0x03, 0xFE, 0x90, 0x96, 0xA5, 0x02, 0x04, 0x31, 0x7F, 0x84, 0x7E, 0x08, 0x91, 0xDF, ++0x90, 0x96, 0x8F, 0x22, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5B, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, ++0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xE1, 0xEF, 0xF0, 0xED, 0x64, ++0x01, 0x70, 0x31, 0xEB, 0xB4, 0x01, 0x07, 0xE0, 0x24, 0x02, 0xF5, 0x0E, 0x80, 0x08, 0x90, 0x96, ++0xE1, 0xE0, 0x24, 0xFE, 0xF5, 0x0E, 0x90, 0x96, 0x8F, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, ++0xAF, 0x0E, 0xE4, 0xFC, 0xFD, 0xFE, 0x12, 0xDE, 0x42, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, ++0xAF, 0x0E, 0x80, 0x1E, 0x90, 0x96, 0x8F, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x96, ++0xE1, 0xB1, 0x68, 0x12, 0xDE, 0x42, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x96, 0xE1, ++0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x96, 0x93, 0x12, 0x04, 0x31, 0x7D, 0x18, 0x7C, 0x00, ++0x7F, 0x01, 0x12, 0xDD, 0xCA, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x86, 0x31, 0x02, 0x86, 0x17, ++0x90, 0x96, 0x2A, 0xE0, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5D, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, ++0x83, 0x22, 0xC3, 0x13, 0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5E, 0xF5, 0x82, 0xE4, 0x34, ++0x93, 0xF5, 0x83, 0xE0, 0x22, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, ++0xEF, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x44, 0x7F, 0x6F, ++0x12, 0x04, 0x7E, 0x12, 0x88, 0xCD, 0x90, 0x96, 0xF0, 0xE0, 0x90, 0x96, 0xEF, 0xB4, 0x01, 0x0A, ++0xE0, 0x12, 0xAE, 0x93, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x08, 0xE0, 0x12, 0xAE, 0x93, 0xE0, 0x54, ++0xFB, 0xF0, 0x90, 0x8A, 0xF9, 0x11, 0x40, 0xF1, 0x91, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8A, ++0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x79, ++0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x90, 0x95, 0x33, 0xEF, 0xF0, 0x51, 0x85, ++0x12, 0xE3, 0xFA, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, 0x7C, 0xF0, 0x51, 0x85, ++0x12, 0xE3, 0xF3, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, 0x7D, 0xF0, 0x51, 0x85, ++0x12, 0xE3, 0xEC, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, 0x7E, 0xF0, 0x51, 0x85, ++0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, ++0x7F, 0xF0, 0x51, 0x85, 0x7F, 0xF8, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, ++0x7A, 0xE0, 0x90, 0x95, 0x80, 0xF0, 0x51, 0x85, 0x12, 0xC3, 0x5A, 0xBF, 0x01, 0x08, 0x90, 0x95, ++0x7A, 0xE0, 0x90, 0x95, 0x81, 0xF0, 0x51, 0x85, 0x7F, 0xFB, 0xF1, 0x97, 0x70, 0x52, 0x90, 0x95, ++0x7A, 0xE0, 0x90, 0x95, 0x82, 0xF0, 0x54, 0x07, 0x60, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x54, 0xE0, ++0x70, 0x3E, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x7B, 0x7F, 0xFA, 0xF1, 0x97, 0x70, 0x32, 0x90, 0x95, ++0x7A, 0xE0, 0xFC, 0x54, 0x07, 0x70, 0x12, 0x90, 0x95, 0x82, 0xE0, 0xFE, 0x90, 0x95, 0x7B, 0xE0, ++0x54, 0x07, 0xFD, 0xEE, 0x4D, 0x90, 0x95, 0x82, 0xF0, 0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, 0x95, ++0x82, 0xE0, 0xFF, 0x90, 0x95, 0x7B, 0xE0, 0x54, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x95, 0x82, 0xF0, ++0x51, 0x85, 0x7F, 0xFD, 0xF1, 0x97, 0x70, 0x47, 0x90, 0x95, 0x7A, 0xE0, 0xFE, 0x54, 0xCC, 0x90, ++0x95, 0x83, 0xF0, 0xEE, 0x54, 0x0C, 0xFF, 0x60, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x54, 0xC0, 0x70, ++0x2E, 0xEF, 0x70, 0x12, 0x90, 0x95, 0x83, 0xE0, 0xFF, 0x90, 0x95, 0x7A, 0xE0, 0x54, 0x03, 0x12, ++0xE3, 0xBE, 0x90, 0x95, 0x83, 0xF0, 0x90, 0x95, 0x7A, 0xE0, 0xFF, 0x54, 0xC0, 0x70, 0x10, 0x90, ++0x95, 0x83, 0xE0, 0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0xEE, 0x4F, 0xF0, 0x51, ++0x85, 0x7F, 0xF0, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, ++0x95, 0x84, 0xF0, 0x51, 0x85, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, ++0x95, 0x7A, 0xE0, 0x90, 0x95, 0x85, 0xF0, 0x51, 0x85, 0x12, 0xE3, 0xE5, 0xBF, 0x01, 0x08, 0x90, ++0x95, 0x7A, 0xE0, 0x90, 0x95, 0x86, 0xF0, 0x51, 0x85, 0x12, 0xE3, 0xDE, 0xBF, 0x01, 0x08, 0x90, ++0x95, 0x7A, 0xE0, 0x90, 0x95, 0x87, 0xF0, 0x51, 0x85, 0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, ++0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, 0x88, 0xF0, 0x90, 0x95, 0x34, 0x74, 0x19, ++0xF0, 0x90, 0x95, 0x56, 0x74, 0x08, 0xF0, 0x90, 0x95, 0x7C, 0xE0, 0x90, 0x95, 0x36, 0xF0, 0x90, ++0x95, 0x7D, 0xE0, 0x90, 0x95, 0x37, 0xF0, 0x90, 0x95, 0x7E, 0xE0, 0x90, 0x95, 0x38, 0xF0, 0x90, ++0x95, 0x7F, 0xE0, 0x90, 0x95, 0x39, 0xF0, 0x90, 0x95, 0x80, 0xE0, 0x90, 0x95, 0x3A, 0xF0, 0x90, ++0x95, 0x81, 0xE0, 0x90, 0x95, 0x3B, 0xF0, 0x90, 0x95, 0x82, 0xE0, 0x90, 0x95, 0x3C, 0xF0, 0x90, ++0x95, 0x83, 0xE0, 0x90, 0x95, 0x3D, 0xF0, 0x90, 0x95, 0x57, 0x74, 0x1A, 0xF0, 0x90, 0x95, 0x79, ++0x74, 0x05, 0xF0, 0x90, 0x95, 0x84, 0xE0, 0x90, 0x95, 0x59, 0xF0, 0x90, 0x95, 0x85, 0xE0, 0x90, ++0x95, 0x5A, 0xF0, 0x90, 0x95, 0x86, 0xE0, 0x90, 0x95, 0x5B, 0xF0, 0x90, 0x95, 0x87, 0xE0, 0x90, ++0x95, 0x5C, 0xF0, 0x90, 0x95, 0x88, 0xE0, 0x90, 0x95, 0x5D, 0xF0, 0x90, 0x95, 0x33, 0xE0, 0xB4, ++0x01, 0x19, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x34, 0x12, 0xB9, 0x53, 0x12, 0x04, 0x7E, 0x7B, 0x01, ++0x7A, 0x95, 0x79, 0x57, 0x11, 0x2E, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, 0x46, ++0x95, 0x75, 0x47, 0x34, 0x75, 0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x69, 0xF5, ++0x75, 0x45, 0x01, 0x75, 0x46, 0x95, 0x75, 0x47, 0x59, 0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, 0x01, ++0x79, 0xAA, 0x02, 0x69, 0xF5, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x7A, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x12, 0x9F, 0xE1, 0x12, 0x87, 0xF5, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, 0x75, ++0x48, 0x05, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9D, 0x12, 0x69, 0xF5, 0x12, 0x87, 0xF5, 0x12, 0x02, ++0x06, 0x20, 0xE0, 0x02, 0x81, 0x22, 0x90, 0x05, 0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, ++0x13, 0x90, 0x88, 0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x15, 0x12, ++0x87, 0xA1, 0x90, 0x88, 0x9E, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0x12, 0x87, 0x6B, 0x90, 0x88, ++0x9F, 0xF0, 0x80, 0x4B, 0x12, 0x87, 0xA1, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x15, 0xEF, 0xC3, 0x94, ++0x03, 0x50, 0x07, 0x90, 0x88, 0x9E, 0x74, 0x03, 0x80, 0x0D, 0x12, 0x87, 0xA1, 0x90, 0x88, 0x9E, ++0x80, 0x05, 0x90, 0x88, 0x9E, 0x74, 0x2A, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0x12, 0x87, ++0x6C, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, ++0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, ++0x9C, 0xD1, 0x54, 0x03, 0x30, 0xE0, 0x3D, 0x90, 0x88, 0x9E, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, ++0x88, 0xA6, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, ++0x90, 0x88, 0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, ++0x9F, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, 0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, ++0x02, 0x12, 0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0x12, 0x87, 0xF4, 0x12, 0xE3, 0x46, 0x20, 0xE0, ++0x37, 0x90, 0x88, 0x9D, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x06, 0x12, 0xA9, 0xA4, 0x30, 0xE0, 0x28, ++0x12, 0xE3, 0xA5, 0x30, 0xE0, 0x08, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x80, 0x0B, 0x90, 0x88, ++0xDF, 0xE0, 0x60, 0x05, 0x75, 0x61, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x61, 0x90, 0x8A, 0xF3, 0x11, ++0x40, 0x7D, 0x02, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, ++0xE0, 0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, ++0x11, 0x40, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0xE4, 0x01, 0x74, 0x11, 0xF0, 0xF1, ++0xED, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x01, 0xF0, 0x80, 0x2B, ++0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x04, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x04, 0xF0, 0x80, 0x1C, 0x90, ++0x88, 0xA5, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x02, 0xF0, 0x80, 0x0D, 0x90, 0x88, ++0xA5, 0xE0, 0xB4, 0x07, 0x06, 0x90, 0x88, 0xB0, 0x74, 0x05, 0xF0, 0xE4, 0x90, 0x88, 0xA5, 0xF0, ++0x80, 0x67, 0x12, 0x87, 0xF5, 0x12, 0xE3, 0x46, 0x30, 0xE0, 0x05, 0x75, 0x62, 0x02, 0x80, 0x0E, ++0x12, 0xE3, 0xA5, 0x30, 0xE0, 0x05, 0x75, 0x62, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x62, 0x90, 0x8A, ++0xF1, 0x12, 0x88, 0xD0, 0x90, 0x89, 0x04, 0xE0, 0x30, 0xE0, 0x04, 0x7D, 0xAC, 0x80, 0x02, 0x7D, ++0x2C, 0x7F, 0x40, 0x12, 0x7B, 0x2E, 0x12, 0x87, 0xF5, 0x90, 0x00, 0x03, 0x12, 0x02, 0x1F, 0x13, ++0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, ++0x90, 0x8A, 0xF3, 0x11, 0x40, 0xAD, 0x62, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x11, ++0x40, 0xF1, 0x91, 0x12, 0xE4, 0x01, 0x74, 0x43, 0xF0, 0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, 0xF0, ++0xE4, 0x90, 0x88, 0xAF, 0xF0, 0x90, 0x88, 0xA0, 0x12, 0xA9, 0xA4, 0x30, 0xE0, 0x09, 0x90, 0x88, ++0xD0, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x11, 0x90, 0x8A, 0x97, 0x11, 0x40, 0x7F, 0x01, 0x12, 0x04, ++0x7E, 0x90, 0x88, 0xD0, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, 0x11, 0x40, 0x7F, 0x03, 0x12, ++0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, 0xA1, 0xE0, 0x54, 0xBF, 0xF0, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8B, 0x61, 0x8A, 0x62, ++0x89, 0x63, 0x90, 0x05, 0x27, 0xE0, 0xF5, 0x64, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, 0x75, 0x48, ++0x01, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x2C, 0x12, 0x69, 0xF5, 0x12, 0x9D, 0xEE, 0xFF, 0xC3, 0x13, ++0x20, 0xE0, 0x02, 0xA1, 0x91, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x73, 0x12, 0xE4, 0x09, 0x75, ++0x64, 0x21, 0x12, 0xE3, 0xAE, 0x30, 0xE0, 0x05, 0x12, 0xE2, 0xE3, 0x80, 0x0D, 0xE4, 0x90, 0x88, ++0x2D, 0xF0, 0xA3, 0xF0, 0x7D, 0x40, 0xFF, 0x12, 0x7C, 0x7E, 0x90, 0x88, 0x2C, 0x12, 0xE2, 0xCC, ++0x30, 0xE0, 0x03, 0x43, 0x64, 0x12, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x14, ++0x12, 0xE3, 0x6A, 0x54, 0x07, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x80, 0x12, 0xE3, 0x6A, 0x13, 0x54, ++0x03, 0x20, 0xE0, 0x03, 0x43, 0x64, 0x40, 0xD1, 0x4D, 0x90, 0x88, 0x2F, 0xE0, 0x70, 0x05, 0x7F, ++0x01, 0x12, 0xB9, 0xDC, 0x12, 0xD2, 0xAB, 0x30, 0xE0, 0x04, 0x7F, 0x04, 0x80, 0x0C, 0x12, 0xA7, ++0x8F, 0xEF, 0x60, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x12, 0xB9, 0xDC, 0xC1, 0x08, 0xD1, ++0x4A, 0x90, 0x88, 0x2F, 0xE0, 0x64, 0x04, 0x60, 0x02, 0xC1, 0x45, 0xFF, 0x12, 0xB9, 0xDC, 0xC1, ++0x45, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x78, 0x12, 0xE4, 0x09, 0x43, 0x64, 0x31, 0x12, 0xE3, ++0xAE, 0x30, 0xE0, 0x05, 0x12, 0xE2, 0xE3, 0x80, 0x07, 0x7D, 0x40, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, ++0x90, 0x88, 0x2C, 0x12, 0xE2, 0xCC, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x02, 0xEF, 0xC4, 0x54, 0x0F, ++0x30, 0xE0, 0x03, 0x43, 0x64, 0x04, 0xD1, 0x4D, 0x12, 0xD2, 0xAB, 0x30, 0xE0, 0x0F, 0xF1, 0xC8, ++0x60, 0x36, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0xE4, 0xFD, 0x7F, 0x02, 0x80, 0x1E, 0xF1, 0xF6, 0xF1, ++0xC8, 0x70, 0x1D, 0x12, 0x7B, 0xAD, 0x12, 0xA7, 0x8F, 0xBF, 0x01, 0x07, 0x12, 0x9C, 0xC0, 0x7D, ++0x01, 0x80, 0x08, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x80, 0x08, ++0x90, 0x88, 0x39, 0xE0, 0x90, 0x88, 0x30, 0xF0, 0x90, 0x05, 0x40, 0x74, 0x22, 0xF0, 0x80, 0x35, ++0xD1, 0x4A, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, 0x0B, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0x7D, 0x01, ++0x7F, 0x04, 0x80, 0x10, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x08, 0x0C, 0x90, 0x8A, 0xB9, 0x11, 0x40, ++0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x12, 0xE0, 0xDB, 0x12, 0x9C, 0xC0, 0x7D, 0x01, 0x12, ++0x04, 0x7E, 0x12, 0xC3, 0x9E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0x64, 0x01, 0x90, 0x05, 0x27, ++0xE5, 0x64, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x31, ++0x12, 0x04, 0x80, 0x12, 0xC3, 0x82, 0x12, 0x04, 0x80, 0x90, 0x88, 0x35, 0x74, 0x02, 0xF0, 0x90, ++0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x90, 0x88, 0x42, 0xE4, 0xF0, 0xA3, ++0x74, 0x02, 0x12, 0xCA, 0x57, 0xFF, 0x12, 0xE3, 0x10, 0x12, 0xE2, 0x01, 0x90, 0x8A, 0x89, 0x11, ++0x40, 0xF1, 0x91, 0x90, 0x8A, 0x89, 0x11, 0x40, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, ++0x8A, 0x89, 0x11, 0x40, 0x7D, 0x0C, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x86, 0xB3, 0xE0, 0xFF, ++0xB4, 0x01, 0x08, 0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x80, 0x11, 0xEF, 0xB4, 0x03, 0x08, 0x90, ++0x88, 0x41, 0x74, 0x14, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0x41, 0xF0, 0x7F, 0x79, 0x12, 0x7B, ++0x41, 0xEF, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, 0x28, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE2, ++0x06, 0x90, 0x88, 0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, ++0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0x12, 0xCA, 0x57, 0x12, 0xE3, ++0x10, 0x7E, 0x00, 0x7F, 0x18, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x3F, 0x12, 0x04, 0x80, ++0x90, 0x8A, 0xA3, 0x11, 0x40, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0xF1, 0xED, 0x7E, 0x00, 0xFF, 0x7D, ++0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, ++0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x88, 0x9C, ++0xF0, 0x22, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xB1, 0x57, 0x90, 0x88, 0x9D, 0xE0, ++0x20, 0xE0, 0x3D, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x35, 0x90, 0x8A, 0xD7, 0x12, 0x88, ++0xD0, 0x12, 0xA6, 0xFF, 0x60, 0x18, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0x12, 0xD0, 0xC0, 0x90, 0x8A, ++0xF9, 0x11, 0x40, 0xF1, 0x91, 0x90, 0x8B, 0x01, 0x12, 0xBD, 0x11, 0x02, 0x04, 0x7A, 0x90, 0x88, ++0x39, 0xE0, 0x70, 0x0C, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0x7D, 0x01, 0x7F, 0x04, 0x12, 0x04, 0x7E, ++0x22, 0xE4, 0xFD, 0xFF, 0x02, 0x04, 0x7E, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xEF, 0x64, 0x01, 0x22, ++0x90, 0x8A, 0xF9, 0x11, 0x40, 0xF1, 0x91, 0x90, 0x88, 0x2F, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x8A, ++0xF9, 0x11, 0x40, 0xF1, 0x91, 0xF1, 0xF6, 0x80, 0xEE, 0x90, 0x86, 0x0C, 0x12, 0x88, 0xD0, 0x90, ++0x8A, 0xF9, 0x11, 0x40, 0xF1, 0x91, 0x80, 0xDF, 0x90, 0x88, 0x30, 0xE0, 0x64, 0x02, 0x22, 0x12, ++0xD2, 0xAB, 0x30, 0xE0, 0x10, 0xF1, 0xC8, 0x60, 0x0C, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0x7D, 0x01, ++0x7F, 0x02, 0x12, 0x04, 0x7E, 0xF1, 0xC8, 0x60, 0x03, 0x12, 0xD0, 0xA4, 0x22, 0x90, 0x05, 0x58, ++0x74, 0x02, 0xF0, 0x22, 0x80, 0xB1, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0xF1, 0xE1, ++0x90, 0x04, 0x24, 0xE0, 0xFF, 0xE4, 0xFE, 0x12, 0x87, 0xF5, 0x8E, 0x82, 0x12, 0xBF, 0xF7, 0x2F, ++0xFD, 0xEE, 0x11, 0x24, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x03, 0xEC, 0x22, 0x90, 0x93, 0x58, 0xE0, ++0xC3, 0x13, 0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, ++0x83, 0x22, 0xE4, 0x90, 0x96, 0x2B, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFF, 0x20, 0xE0, 0x02, 0x21, ++0xA7, 0x12, 0x8F, 0xD2, 0x54, 0x07, 0x90, 0x96, 0x28, 0xF0, 0x60, 0x07, 0xE0, 0x64, 0x02, 0x60, ++0x02, 0x21, 0x3B, 0x90, 0x93, 0x5A, 0xE0, 0x70, 0x2A, 0x71, 0x63, 0x7B, 0x4E, 0x51, 0x2A, 0x11, ++0x1C, 0xE0, 0xFF, 0x7E, 0x00, 0x7B, 0x04, 0x7D, 0x01, 0x51, 0x39, 0xBF, 0x01, 0x0C, 0x31, 0xA8, ++0x44, 0x01, 0xF0, 0x90, 0x93, 0x5A, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x96, 0x29, 0xE0, 0xFD, 0x7B, ++0x4F, 0x21, 0x12, 0x90, 0x93, 0x5A, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x21, 0x2B, 0x12, 0x8F, 0x18, ++0xFF, 0x12, 0x8F, 0xD6, 0xFE, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x02, 0x21, 0x29, 0xEF, 0x31, 0xB0, ++0xFF, 0x30, 0xE0, 0x08, 0x90, 0x96, 0x2B, 0x74, 0x01, 0xF0, 0x80, 0x12, 0xEF, 0xC3, 0x13, 0x20, ++0xE0, 0x0C, 0x90, 0x96, 0x2B, 0x74, 0x01, 0xF0, 0x71, 0x63, 0x7B, 0x50, 0x51, 0x2A, 0x90, 0x96, ++0x2B, 0xE0, 0x60, 0x67, 0x90, 0x93, 0xDF, 0xE0, 0xFF, 0x90, 0x93, 0xDE, 0xE0, 0x6F, 0x60, 0x46, ++0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x01, 0x40, 0x08, 0x90, 0x96, 0x2C, 0x74, 0x04, 0xF0, 0x80, ++0x05, 0xE4, 0x90, 0x96, 0x2C, 0xF0, 0x11, 0x1C, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0x96, 0x2C, 0xE0, ++0xFB, 0x7D, 0x01, 0x51, 0x39, 0xBF, 0x01, 0x13, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0xA3, 0x74, 0x03, ++0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x02, 0x66, 0x33, 0x90, 0x96, 0x29, 0xE0, 0xFD, ++0x7B, 0x51, 0xE4, 0xFF, 0x41, 0x2E, 0xE4, 0x90, 0x93, 0xDE, 0xF0, 0x51, 0x23, 0x90, 0x93, 0x58, ++0xE0, 0xFF, 0x31, 0xAC, 0x54, 0xFB, 0xF0, 0x80, 0x02, 0x51, 0x23, 0x90, 0x93, 0x5A, 0xE0, 0x64, ++0x05, 0x70, 0x74, 0x12, 0x8A, 0xB5, 0xEF, 0x70, 0x6E, 0x80, 0x68, 0x90, 0x96, 0x28, 0xE0, 0xFF, ++0x64, 0x03, 0x60, 0x05, 0xEF, 0x64, 0x01, 0x70, 0x5E, 0x90, 0x93, 0x5A, 0xE0, 0x64, 0x05, 0x70, ++0x56, 0x90, 0x96, 0x28, 0xE0, 0x64, 0x01, 0x70, 0x3C, 0x12, 0x8F, 0xC0, 0xE0, 0xD3, 0x94, 0x1F, ++0x90, 0x93, 0x58, 0xE0, 0x40, 0x0F, 0x11, 0x21, 0xE0, 0xFF, 0x90, 0x8A, 0xBF, 0x91, 0xC8, 0x7D, ++0x00, 0x7C, 0x7C, 0x80, 0x1D, 0x11, 0x20, 0xE0, 0xFB, 0x12, 0x8F, 0xC0, 0xE0, 0x7D, 0x00, 0x25, ++0xE0, 0x25, 0xE0, 0xFC, 0xAF, 0x03, 0x90, 0x8A, 0xBF, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xF5, 0x82, ++0x8A, 0x83, 0x12, 0x04, 0x7E, 0x12, 0x8F, 0x18, 0xFD, 0x7F, 0x02, 0x51, 0xDE, 0x12, 0x8A, 0xB5, ++0xEF, 0x70, 0x04, 0x7F, 0x06, 0xF1, 0xF5, 0x22, 0x90, 0x93, 0x58, 0xE0, 0xC3, 0x13, 0x54, 0x07, ++0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x22, 0xE4, ++0x90, 0x96, 0x1B, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0x30, 0xE0, 0x57, 0xC3, 0x13, 0x54, 0x07, 0xFF, ++0x31, 0xB0, 0xFE, 0x30, 0xE0, 0x4C, 0xEF, 0x71, 0x6C, 0xEE, 0x54, 0xFE, 0xF0, 0xEF, 0x31, 0xB0, ++0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0F, 0x12, 0xE3, 0x71, 0x71, 0x6C, 0xEF, 0x54, 0xFB, ++0xF0, 0x90, 0x96, 0x1B, 0x74, 0x01, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, 0x1C, 0x51, 0x23, ++0x31, 0xA8, 0x44, 0x02, 0xF0, 0xE4, 0x90, 0x93, 0xDE, 0xF0, 0x12, 0x8F, 0x18, 0xFD, 0x7F, 0x02, ++0x51, 0xDE, 0x90, 0x96, 0x1B, 0xE0, 0x60, 0x0A, 0x01, 0x32, 0x31, 0xA8, 0x54, 0xFD, 0xF0, 0xE4, ++0x71, 0x5D, 0x22, 0x90, 0x93, 0x5A, 0x74, 0x05, 0xF0, 0x22, 0x7D, 0x6F, 0x7F, 0xFF, 0x90, 0x05, ++0x22, 0xED, 0xF0, 0x90, 0x93, 0x01, 0xEB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x90, 0x96, 0xBE, 0xEE, 0xF0, 0xA3, 0x12, 0xE3, 0x93, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x29, 0x90, ++0x05, 0x22, 0xE0, 0x90, 0x96, 0xC4, 0xF0, 0x7B, 0x14, 0x12, 0x88, 0xC6, 0xEF, 0x64, 0x01, 0x70, ++0x06, 0x71, 0xA0, 0x71, 0xF4, 0x80, 0x04, 0x7F, 0x00, 0x80, 0x13, 0x90, 0x96, 0xC4, 0xE0, 0xFD, ++0x7B, 0x15, 0xE4, 0xFF, 0x51, 0x2E, 0x80, 0x04, 0x71, 0xA0, 0x71, 0xF4, 0xF1, 0x0C, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x8F, 0x65, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x95, 0x33, 0xF0, 0x7B, 0x17, 0x12, ++0x88, 0xC6, 0xEF, 0x64, 0x01, 0x70, 0x39, 0xE5, 0x65, 0x12, 0x8F, 0x34, 0xE0, 0xFC, 0x71, 0x7A, ++0x12, 0xE2, 0xAA, 0xAF, 0x04, 0x12, 0x8F, 0x42, 0x71, 0x7A, 0x12, 0x8B, 0x8E, 0xE5, 0x65, 0x12, ++0x8F, 0xD6, 0x54, 0x07, 0xFF, 0x60, 0x03, 0xBF, 0x02, 0x0D, 0xE5, 0x65, 0x11, 0x24, 0xE0, 0xFF, ++0x7E, 0x00, 0xE4, 0xFB, 0xFD, 0x51, 0x39, 0xAD, 0x65, 0x7F, 0x01, 0x51, 0xDE, 0x7F, 0x01, 0x22, ++0x90, 0x95, 0x33, 0xE0, 0xFD, 0x7B, 0x49, 0xE4, 0xFF, 0x51, 0x2E, 0x7F, 0x00, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x2E, 0xED, 0xF0, 0x90, 0x96, 0x2D, 0xEF, 0xF0, 0x64, ++0x02, 0x70, 0x24, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0x2F, 0xF0, 0x7B, 0x4A, 0x7D, 0x6F, 0x12, ++0x88, 0xC8, 0xBF, 0x01, 0x07, 0x90, 0x04, 0xD4, 0x74, 0xFF, 0x80, 0x47, 0x90, 0x96, 0x2F, 0xE0, ++0xFD, 0x7B, 0x46, 0x51, 0xD7, 0x80, 0x41, 0x90, 0x96, 0x2D, 0xE0, 0x64, 0x01, 0x70, 0x30, 0x71, ++0x5D, 0x90, 0x96, 0x2E, 0xE0, 0xFF, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x60, 0xF5, 0x82, 0xE4, 0x34, ++0x93, 0xF5, 0x83, 0xE0, 0xF4, 0x90, 0x04, 0xD4, 0xF0, 0xEF, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x61, ++0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xF4, 0x90, 0x04, 0xD5, 0xF0, 0x80, 0x07, 0x90, ++0x04, 0xD4, 0xE4, 0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFB, 0xFD, 0x7F, ++0xFF, 0x41, 0x2E, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0x29, 0xF0, 0x22, 0x75, 0xF0, 0x1B, 0xA4, ++0x24, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0xE5, 0x65, 0x75, 0xF0, 0x1B, 0xA4, ++0x24, 0x5C, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFE, 0x54, 0x03, 0x22, 0x31, 0xA8, ++0x20, 0xE0, 0x07, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0x41, 0x23, 0x31, 0xA8, 0x44, 0x04, 0xF0, 0x22, ++0x90, 0x96, 0xBE, 0xA3, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x03, 0xF0, 0x7B, 0x06, 0x7D, 0x01, ++0x12, 0x66, 0xDB, 0x90, 0x96, 0xC2, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x96, 0xC1, ++0xE0, 0xFF, 0x74, 0x10, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x96, ++0xC0, 0x22, 0x90, 0x86, 0xB6, 0xE0, 0xFF, 0x90, 0x96, 0xDD, 0xE0, 0xFB, 0x90, 0x92, 0x13, 0x74, ++0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x96, 0xDE, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, ++0xFD, 0x90, 0x96, 0xDC, 0xE0, 0xFF, 0x90, 0x8A, 0x95, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xF5, 0x82, ++0x8A, 0x83, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xDC, 0xEF, ++0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, ++0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x4F, 0x90, 0x05, ++0x22, 0xE0, 0x90, 0x96, 0xE0, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x26, 0x7F, 0xFF, ++0x12, 0x04, 0x7E, 0x12, 0x88, 0xCD, 0xEF, 0x64, 0x01, 0x70, 0x0B, 0x71, 0xD2, 0x90, 0x93, 0x58, ++0xE0, 0x20, 0xE0, 0x16, 0x80, 0x10, 0x91, 0xD1, 0x54, 0x03, 0x30, 0xE0, 0x0D, 0x71, 0xD2, 0x90, ++0x93, 0x58, 0xE0, 0x20, 0xE0, 0x04, 0x91, 0xE2, 0x91, 0xB4, 0x90, 0x96, 0xE0, 0xE0, 0xFF, 0x90, ++0x8A, 0xF9, 0x91, 0xC8, 0x7D, 0x27, 0x12, 0x04, 0x7E, 0x91, 0xD9, 0x80, 0x0F, 0x91, 0xD9, 0x91, ++0xB4, 0x71, 0xD2, 0x90, 0x93, 0x58, 0xE0, 0x20, 0xE0, 0x04, 0x91, 0xE2, 0x91, 0xB4, 0x90, 0x88, ++0x9D, 0xE0, 0x30, 0xE0, 0x18, 0x91, 0xD1, 0x54, 0x03, 0x30, 0xE0, 0x11, 0x90, 0x05, 0x22, 0xE0, ++0x54, 0x6F, 0xFF, 0x90, 0x8A, 0xF9, 0x91, 0xC8, 0x7D, 0x28, 0x12, 0x04, 0x7E, 0xF1, 0x0C, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x02, 0x04, 0x7E, ++0x90, 0x88, 0x38, 0xE0, 0xFF, 0x90, 0x8A, 0xB9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, 0x82, 0x8C, 0x83, ++0x22, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x13, 0x22, 0x90, 0x96, 0xDC, 0xE0, 0xFF, 0x90, 0x8A, ++0xC7, 0x22, 0x90, 0x96, 0xDE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x9B, 0x22, 0x12, 0xA0, ++0xC2, 0xFF, 0x54, 0x0F, 0xF5, 0x64, 0xEF, 0xC4, 0x54, 0x0F, 0x64, 0x0F, 0x70, 0x3F, 0x90, 0x93, ++0x58, 0xE0, 0x54, 0xFE, 0xFF, 0xF0, 0xE5, 0x64, 0x54, 0x07, 0x25, 0xE0, 0xFE, 0xEF, 0x54, 0xF1, ++0x4E, 0x12, 0x87, 0x98, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, 0xDF, 0x20, 0xE0, 0x05, 0x74, 0x06, ++0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x7D, 0x20, 0xE4, 0xFF, 0x12, 0x7C, 0x3B, 0xAF, 0x64, 0x51, ++0x83, 0xBF, 0x01, 0x05, 0xE4, 0xFD, 0xFF, 0x51, 0xDE, 0x7F, 0x02, 0xA1, 0xEB, 0xE5, 0x64, 0x75, ++0xF0, 0x1B, 0xA4, 0x24, 0x5B, 0xF9, 0x74, 0x93, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xC0, 0x02, 0xC0, ++0x01, 0xE5, 0x63, 0x24, 0x01, 0xF9, 0xE4, 0x35, 0x62, 0x85, 0x61, 0x45, 0xF5, 0x46, 0x89, 0x47, ++0x75, 0x48, 0x04, 0xD0, 0x01, 0xD0, 0x02, 0x12, 0x69, 0xF5, 0xE5, 0x64, 0x12, 0x8F, 0xD6, 0x54, ++0xF7, 0xF0, 0xB1, 0xEE, 0xC4, 0x54, 0x0F, 0x14, 0x65, 0x64, 0x70, 0x71, 0x90, 0x88, 0x36, 0xE0, ++0x70, 0x07, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x05, 0x80, 0x5E, 0xB1, 0xEE, 0xC4, ++0x54, 0x0F, 0x90, 0x93, 0x59, 0xF1, 0xEE, 0xFC, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFE, 0x90, 0x93, ++0x58, 0xE0, 0x54, 0x0F, 0x4E, 0xF0, 0xEC, 0x54, 0x60, 0xC4, 0x54, 0x0F, 0xFF, 0x90, 0x93, 0xAD, ++0xE0, 0x54, 0xF9, 0x4F, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0x54, 0xF1, 0xF0, 0x12, 0x97, 0xED, 0x90, ++0x93, 0xD5, 0xE0, 0x90, 0x93, 0xD9, 0x30, 0xE0, 0x0B, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xC1, 0x44, ++0x02, 0xF0, 0x80, 0x07, 0xE0, 0x44, 0x01, 0xF0, 0x54, 0xC1, 0xF0, 0x90, 0x93, 0xD9, 0xE0, 0x54, ++0xBF, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x03, 0xF1, 0xF5, 0x22, 0xAB, 0x61, ++0xAA, 0x62, 0xA9, 0x63, 0x02, 0x02, 0x06, 0x90, 0x96, 0xD7, 0xEF, 0xF0, 0x90, 0x88, 0xE0, 0xE0, ++0x70, 0x53, 0x7F, 0x48, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEE, 0x54, 0x0F, 0xFE, 0xE4, 0xFD, 0xFC, ++0x90, 0x96, 0xD8, 0x12, 0x04, 0x31, 0xE4, 0x7F, 0x80, 0x7E, 0x02, 0xD1, 0xE5, 0x70, 0x05, 0x90, ++0x88, 0xBE, 0x80, 0x1C, 0xE4, 0xFF, 0xD1, 0xE4, 0x70, 0x0A, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xE4, ++0xA3, 0xF0, 0x80, 0x5B, 0xE4, 0xFF, 0x7E, 0x02, 0xD1, 0xE5, 0x70, 0x09, 0x90, 0x88, 0xBE, 0x04, ++0xF0, 0xA3, 0xF0, 0x80, 0x4A, 0xE4, 0x7F, 0x80, 0xD1, 0xE4, 0x70, 0x43, 0x90, 0x88, 0xBE, 0xF0, ++0xA3, 0x04, 0xF0, 0x80, 0x3A, 0x7F, 0x2C, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x02, 0xD1, ++0xF8, 0x4E, 0x4F, 0x60, 0x08, 0x90, 0x88, 0xBE, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, ++0xBE, 0xF0, 0x7F, 0x30, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x01, 0xD1, 0xF8, 0x4E, 0x4F, ++0x60, 0x07, 0xE4, 0x90, 0x88, 0xBF, 0xF0, 0x80, 0x06, 0x90, 0x88, 0xBF, 0x74, 0x01, 0xF0, 0x90, ++0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x11, 0x12, 0xBB, ++0x64, 0x12, 0x88, 0xD0, 0x90, 0x07, 0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x88, 0xDF, 0xE0, ++0xFF, 0x90, 0x8A, 0xF3, 0x91, 0xC8, 0xE4, 0xFD, 0x12, 0x04, 0x7E, 0x90, 0x96, 0xD7, 0xE0, 0xFD, ++0x70, 0x02, 0x80, 0x1C, 0xED, 0xB4, 0x01, 0x06, 0xD1, 0xF1, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x96, ++0xD7, 0xE0, 0xFD, 0xB4, 0x02, 0x06, 0xD1, 0xF1, 0x44, 0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x03, ++0xD1, 0xF1, 0xF0, 0x22, 0xFE, 0xFD, 0xFC, 0x90, 0x96, 0xD8, 0x12, 0x86, 0x31, 0xC3, 0x02, 0x03, ++0xDA, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xFF, 0xE4, 0xFE, 0xFD, 0xFC, 0x90, 0x96, 0xD8, ++0x12, 0x04, 0x31, 0x90, 0x96, 0xD8, 0x12, 0x04, 0xB8, 0xEC, 0x4D, 0x22, 0x90, 0x04, 0x1F, 0x74, ++0x20, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x02, 0xF1, 0x78, 0x01, 0x32, 0x90, ++0x88, 0x2C, 0xE0, 0x90, 0x88, 0x38, 0x30, 0xE0, 0x04, 0xE0, 0xFF, 0x80, 0x07, 0x91, 0xC3, 0x7D, ++0x01, 0x02, 0x04, 0x7E, 0xAE, 0x07, 0x12, 0xA7, 0x8F, 0xBF, 0x01, 0x15, 0x12, 0xE3, 0x6A, 0x13, ++0x54, 0x03, 0x20, 0xE0, 0x0C, 0xAF, 0x06, 0x91, 0xC5, 0x7D, 0x01, 0x12, 0x04, 0x7E, 0x7F, 0x01, ++0x22, 0x7F, 0x00, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x14, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, ++0x08, 0x90, 0x8B, 0x01, 0x12, 0x88, 0xD0, 0x80, 0x05, 0x12, 0xE3, 0xD6, 0xF1, 0x1F, 0x90, 0x93, ++0x5A, 0xE0, 0xB4, 0x01, 0x02, 0x11, 0x32, 0x22, 0x12, 0xE2, 0xC9, 0x30, 0xE0, 0x0C, 0xEF, 0xC4, ++0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x03, 0x12, 0xE3, 0xB7, 0x90, 0x88, 0x31, 0xF1, 0xE7, 0x30, ++0xE0, 0x09, 0x12, 0xD0, 0x3D, 0x54, 0x07, 0x70, 0x3F, 0x80, 0x3B, 0x12, 0xE2, 0x5C, 0x40, 0x36, ++0x12, 0xA7, 0x68, 0x70, 0x33, 0x12, 0xA6, 0xFF, 0x70, 0x08, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xD0, ++0x80, 0x27, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xD0, 0x90, 0x88, 0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, ++0x94, 0x02, 0x40, 0x09, 0xF1, 0xD9, 0xE4, 0x90, 0x88, 0x40, 0xF0, 0x80, 0x03, 0x12, 0x73, 0x8F, ++0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x22, 0xF1, 0x1F, 0x22, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xFB, 0xF0, ++0x22, 0x90, 0x95, 0x33, 0x02, 0x86, 0x46, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, 0xF0, 0x90, ++0x00, 0x06, 0x02, 0x02, 0x1F, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0x90, 0x05, ++0x63, 0xE0, 0xFE, 0x90, 0x05, 0x62, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x96, ++0x50, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0xFE, 0x90, 0x05, 0x60, 0xE0, 0x24, 0x00, ++0xFF, 0xEA, 0x3E, 0xFE, 0xED, 0xB4, 0x08, 0x0A, 0x90, 0x05, 0x58, 0xE0, 0xFC, 0x2F, 0xFF, 0xEA, ++0x3E, 0xFE, 0x90, 0x96, 0x2D, 0x74, 0x17, 0xF0, 0x90, 0x96, 0x4F, 0x74, 0x06, 0xF0, 0x90, 0x96, ++0x2F, 0xED, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFD, 0xC3, 0x13, 0x54, 0x07, 0x12, 0x8F, 0x34, 0xE0, ++0x90, 0x96, 0x30, 0xF0, 0xA3, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x90, 0x96, 0x50, 0xE0, 0xFE, 0xA3, ++0xE0, 0x90, 0x96, 0x33, 0xF0, 0xEE, 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0x96, 0x79, 0x2D, 0x12, 0x90, ++0x2E, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x11, 0xC2, 0xFF, 0x54, 0x01, ++0xFE, 0x90, 0x93, 0xD5, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xEE, 0x54, ++0x01, 0x12, 0x87, 0x9F, 0x90, 0x93, 0xD6, 0x12, 0x87, 0x6B, 0x90, 0x93, 0xD7, 0xF0, 0xE4, 0xA3, ++0xF0, 0x90, 0x93, 0xD7, 0xE0, 0xFF, 0xB4, 0x64, 0x05, 0x74, 0x01, 0xF0, 0x80, 0x0A, 0xEF, 0xB4, ++0x96, 0x06, 0x90, 0x93, 0xD7, 0x74, 0x03, 0xF0, 0x90, 0x93, 0xD7, 0xE0, 0x04, 0x90, 0x93, 0xDA, ++0xF0, 0x22, 0x8B, 0x61, 0x8A, 0x62, 0x89, 0x63, 0x02, 0x02, 0x06, 0x90, 0x95, 0x30, 0x12, 0x86, ++0x46, 0x90, 0x95, 0x2F, 0xEF, 0xF0, 0x12, 0x86, 0x4F, 0xA1, 0x4F, 0x00, 0xA1, 0x58, 0x01, 0xA1, ++0x61, 0x10, 0xA1, 0x6A, 0x12, 0xA1, 0x72, 0x14, 0xA2, 0x9D, 0x15, 0xA1, 0x7B, 0x16, 0xA1, 0x84, ++0x18, 0xA1, 0x8D, 0x19, 0xA1, 0x95, 0x1B, 0xA1, 0x9E, 0x1C, 0xA1, 0xA7, 0x20, 0xA1, 0xB0, 0x24, ++0xA1, 0xB9, 0x25, 0xA1, 0xC2, 0x27, 0xA1, 0xCA, 0x29, 0xA1, 0xD2, 0x2A, 0xA1, 0xDB, 0x40, 0xA1, ++0xE6, 0x42, 0xA2, 0x9D, 0x47, 0xA2, 0x9D, 0x49, 0xA1, 0xF5, 0x60, 0xA1, 0xFE, 0x61, 0xA2, 0x07, ++0x62, 0xA2, 0x10, 0x63, 0xA2, 0x19, 0x64, 0xA2, 0x22, 0x65, 0xA2, 0x2B, 0x66, 0xA2, 0x34, 0x67, ++0xA2, 0x3D, 0x68, 0xA2, 0x46, 0x69, 0xA2, 0x4F, 0x6B, 0xA2, 0x58, 0x6C, 0xA2, 0x61, 0x6D, 0xA2, ++0x6A, 0x6E, 0xA2, 0x73, 0x6F, 0xA2, 0x7C, 0x70, 0xA2, 0x85, 0xC3, 0x00, 0x00, 0xA2, 0x8E, 0x90, ++0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x87, 0x1D, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x87, ++0xFA, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x97, 0xFE, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, ++0x41, 0x9E, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xA8, 0x86, 0x90, 0x95, 0x30, 0x12, 0x86, ++0x3D, 0x02, 0x87, 0x72, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x9C, 0xEE, 0x90, 0x95, 0x30, ++0x12, 0x86, 0x3D, 0x01, 0x7B, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xA8, 0x15, 0x90, 0x95, ++0x30, 0x12, 0x86, 0x3D, 0x02, 0x87, 0xA7, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xA8, 0x95, ++0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x94, 0xD5, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, ++0xAF, 0xF5, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x61, 0x7F, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, ++0x61, 0x4F, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xB7, 0xC9, 0x90, 0x95, 0x30, 0x12, 0x86, ++0x3D, 0x90, 0x8A, 0xA5, 0x80, 0x09, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x90, 0x8A, 0xB5, 0x12, ++0xB9, 0x56, 0x02, 0x04, 0x7E, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x92, 0x8C, 0x90, 0x95, ++0x30, 0x12, 0x86, 0x3D, 0x02, 0x77, 0x4F, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x7C, 0x60, ++0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x7A, 0xC6, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, ++0x5D, 0x36, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x7B, 0xE9, 0x90, 0x95, 0x30, 0x12, 0x86, ++0x3D, 0x02, 0x70, 0x33, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x48, 0xC9, 0x90, 0x95, 0x30, ++0x12, 0x86, 0x3D, 0x02, 0x79, 0xF3, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x3F, 0xD4, 0x90, ++0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x51, 0x7B, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x79, ++0x30, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x57, 0xF2, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, ++0x02, 0x74, 0x8D, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x78, 0x9A, 0x90, 0x95, 0x30, 0x12, ++0x86, 0x3D, 0x02, 0x5E, 0x0B, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xB8, 0xA6, 0x90, 0x01, ++0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x95, 0x2F, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x12, 0x02, ++0x06, 0xFF, 0x90, 0x93, 0x3A, 0xF0, 0xBF, 0x01, 0x07, 0x51, 0xB1, 0xE4, 0x90, 0x93, 0x3A, 0xF0, ++0x22, 0x71, 0x48, 0x12, 0xE3, 0xF3, 0xBF, 0x01, 0x06, 0x90, 0x95, 0x33, 0xE0, 0xA3, 0xF0, 0x71, ++0x48, 0x12, 0xE3, 0xEC, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x33, 0xE0, 0x90, 0x95, 0x35, 0xF0, 0x71, ++0x48, 0x12, 0xE3, 0xFA, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x33, 0xE0, 0x90, 0x95, 0x36, 0xF0, 0x71, ++0x48, 0x12, 0xE3, 0xDE, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x33, 0xE0, 0x90, 0x95, 0x37, 0xF0, 0x71, ++0x48, 0x12, 0xE3, 0xE5, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x33, 0xE0, 0x90, 0x95, 0x38, 0xF0, 0x90, ++0x95, 0x34, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x95, 0x3C, 0xF0, ++0x90, 0x95, 0x38, 0xE0, 0x90, 0x95, 0x3D, 0xF0, 0x90, 0x95, 0x3E, 0x74, 0x12, 0xF0, 0x90, 0x95, ++0x60, 0x74, 0x05, 0xF0, 0x90, 0x95, 0x40, 0x12, 0xE3, 0x93, 0x90, 0x95, 0x3C, 0xE0, 0x90, 0x95, ++0x43, 0xF0, 0x90, 0x95, 0x3D, 0xE0, 0x90, 0x95, 0x44, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x3E, ++0x12, 0x90, 0x2E, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x33, 0x22, 0x12, ++0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x3F, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x30, 0xE0, 0x03, ++0xE4, 0x71, 0x78, 0x22, 0x90, 0x96, 0x76, 0xE0, 0xFF, 0x90, 0x95, 0xC2, 0xE4, 0xF0, 0xA3, 0xEF, ++0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, ++0xA8, 0x7E, 0x90, 0x93, 0x3B, 0x12, 0xE3, 0x1E, 0x12, 0x87, 0x9F, 0x90, 0x93, 0x3C, 0x12, 0x87, ++0x6B, 0x90, 0x93, 0x3D, 0xF0, 0xF1, 0xDC, 0x90, 0x93, 0x3B, 0xE0, 0x54, 0x01, 0xFF, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x19, 0x71, 0xEA, 0x60, 0x09, 0x71, 0xE3, ++0x12, 0x7C, 0x05, 0xF1, 0xD3, 0x80, 0x07, 0x71, 0xE3, 0x12, 0x7C, 0x3B, 0xF1, 0x9B, 0x12, 0x79, ++0xD4, 0x80, 0x17, 0x71, 0xEA, 0x60, 0x07, 0x71, 0xE3, 0x12, 0x7C, 0x05, 0x80, 0x05, 0x71, 0xE3, ++0x12, 0x7C, 0x3B, 0xF1, 0x71, 0xF1, 0x78, 0x12, 0x7B, 0xCC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, ++0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x90, 0x93, 0x3D, 0xE0, 0x90, 0x01, ++0x3F, 0x22, 0xF1, 0x68, 0x60, 0x02, 0xA1, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0xA1, 0x22, ++0x90, 0x88, 0x2C, 0xE0, 0x20, 0xE0, 0x38, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x31, 0x90, 0x06, ++0xA9, 0xE0, 0x54, 0xC0, 0x70, 0x29, 0x90, 0x88, 0x9C, 0xE0, 0x70, 0x23, 0x90, 0x04, 0x1A, 0xE0, ++0xF4, 0x70, 0x1C, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x70, 0x15, 0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, ++0x70, 0x0D, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x06, 0x12, 0xB4, 0x68, 0x12, 0xB1, 0x5F, 0x90, ++0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, 0x90, ++0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, 0x90, ++0x07, 0xF1, 0xE0, 0x90, 0x95, 0x2D, 0xF0, 0x90, 0x07, 0xF0, 0xE0, 0x90, 0x95, 0x2E, 0xF0, 0x90, ++0x01, 0x57, 0x12, 0xD0, 0x16, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEC, 0xF0, 0xB1, 0x3E, 0x24, ++0xFD, 0x50, 0x02, 0x80, 0x0D, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x04, 0xD1, 0x84, 0x80, 0x02, ++0xD1, 0x1E, 0xB1, 0x3E, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, 0x3D, 0xF0, ++0x90, 0x06, 0xAA, 0xE0, 0x90, 0x88, 0x3C, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, ++0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, 0x12, 0xCA, 0x5F, 0xE4, 0x90, 0x88, ++0x3F, 0xF0, 0x12, 0xE2, 0xC9, 0x30, 0xE0, 0x58, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, ++0x20, 0xB1, 0x36, 0x6F, 0x70, 0x4A, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0xF1, 0x7F, 0x71, ++0xDF, 0x12, 0x7C, 0x05, 0xF1, 0xA2, 0x12, 0xE3, 0xB7, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0x80, ++0x2F, 0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x24, 0xB1, 0x36, 0xFE, 0x6F, ++0x60, 0x1E, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x15, 0x90, 0x88, 0x32, 0x12, 0x9F, ++0xE7, 0x30, 0xE0, 0x0C, 0xEF, 0x54, 0xBF, 0x71, 0xDF, 0x12, 0x7C, 0x3B, 0xF1, 0x78, 0xF1, 0x71, ++0xB1, 0x2E, 0x90, 0x88, 0x2C, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x02, 0xB1, 0x2E, 0x22, 0x90, 0x88, ++0x32, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0x90, 0x88, ++0x34, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x22, 0xE4, 0xF5, 0x7E, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, ++0xA1, 0xE9, 0xF1, 0x68, 0x60, 0x02, 0xA1, 0xE9, 0xF1, 0xED, 0xB1, 0x3E, 0x60, 0x22, 0x24, 0xFE, ++0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, ++0x88, 0x3F, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xA3, 0xF0, 0x80, 0x00, ++0x75, 0x7E, 0x01, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x11, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, ++0x03, 0xE4, 0xF5, 0x7E, 0xF1, 0x8F, 0xEF, 0x70, 0x02, 0xF5, 0x7E, 0xE5, 0x7E, 0x60, 0x4A, 0x90, ++0x88, 0x39, 0xE0, 0x20, 0xE2, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0x7D, 0x01, 0x7F, 0x04, ++0x12, 0x04, 0x7E, 0xF1, 0x87, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x0F, 0xB1, ++0xEA, 0xFF, 0xA3, 0xE0, 0x2F, 0xD1, 0x10, 0xB1, 0xEF, 0xFF, 0xA3, 0xE0, 0x80, 0x0B, 0xB1, 0xEA, ++0xB1, 0xF9, 0x2F, 0xD1, 0x10, 0xB1, 0xEF, 0xB1, 0xF9, 0x2F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, ++0x88, 0x4F, 0xF0, 0x90, 0x8A, 0xD7, 0x12, 0x88, 0xD0, 0x22, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, ++0x88, 0x3E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xFF, 0xA3, 0xE0, 0x75, 0xF0, 0x03, 0xA4, ++0x24, 0xFE, 0x22, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, ++0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x02, 0x66, 0x33, 0xE4, 0xF5, ++0x7E, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x7E, 0x54, 0xC0, 0x70, 0x18, 0xD1, 0x7C, 0x54, 0xFD, 0xF0, ++0x12, 0x9F, 0x1F, 0x90, 0x88, 0x39, 0xE0, 0x60, 0x42, 0x7F, 0x02, 0x12, 0xB7, 0x47, 0x7F, 0x02, ++0x02, 0x7B, 0x2E, 0xE5, 0x7E, 0x30, 0xE6, 0x1B, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x15, ++0xD1, 0xF8, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x12, 0x88, 0xD0, 0x80, 0x07, 0x12, 0x73, ++0x8F, 0x80, 0x02, 0xD1, 0x7C, 0xE5, 0x7E, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0A, 0xD1, 0x03, 0x90, ++0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x88, 0x3A, 0xE0, ++0x54, 0xFE, 0xF0, 0x22, 0x90, 0x06, 0xA9, 0xF1, 0xE6, 0xFD, 0x54, 0xC0, 0x70, 0x04, 0xD1, 0x7C, ++0x80, 0x62, 0xED, 0x30, 0xE6, 0x47, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x02, 0x70, 0x2C, 0x90, 0x88, ++0x31, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x09, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x20, ++0xD1, 0xFF, 0x64, 0x01, 0x70, 0x29, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x8A, 0x71, ++0x12, 0x90, 0x40, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x80, 0x15, 0xD1, 0xF8, 0x64, 0x02, 0x60, 0x08, ++0x90, 0x8A, 0xE1, 0x12, 0x88, 0xD0, 0x80, 0x07, 0x12, 0x73, 0x8F, 0x80, 0x02, 0xD1, 0x7C, 0x90, ++0x95, 0xED, 0xE0, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0A, 0xD1, 0x03, 0x90, 0x88, 0x31, 0xE0, 0x44, ++0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0xF0, 0x90, ++0x88, 0x34, 0xE0, 0x54, 0x0F, 0x22, 0xE4, 0x90, 0x96, 0x1B, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, ++0x56, 0xF1, 0x68, 0x70, 0x52, 0xF1, 0x7F, 0xF0, 0xF1, 0xED, 0x90, 0x96, 0x1B, 0x74, 0x01, 0xF0, ++0xE4, 0x90, 0x88, 0x3D, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x15, 0x90, 0x88, 0x30, 0xE0, ++0xB4, 0x02, 0x05, 0xE4, 0x90, 0x96, 0x1B, 0xF0, 0xF1, 0x8F, 0xEF, 0x70, 0x04, 0x90, 0x96, 0x1B, ++0xF0, 0x90, 0x96, 0x1B, 0xE0, 0x60, 0x20, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x0D, 0x90, 0x8A, ++0xB9, 0x12, 0x90, 0x40, 0x7D, 0x01, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xF1, 0x87, 0xB1, 0xEA, 0xD1, ++0x10, 0x90, 0x8A, 0xD7, 0x12, 0x88, 0xD0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x64, 0x01, ++0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x74, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x74, 0x90, ++0x88, 0x3C, 0xE0, 0x90, 0x05, 0x73, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, ++0x05, 0x43, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x12, ++0x7C, 0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0xF1, 0x06, 0xF1, 0x71, 0x7F, 0x01, 0x12, ++0xB9, 0x60, 0x90, 0x8B, 0x07, 0x12, 0x88, 0xD0, 0x90, 0x93, 0x3B, 0xE0, 0x30, 0xE0, 0x13, 0xF1, ++0xD3, 0x90, 0x93, 0x3E, 0xE0, 0x60, 0x05, 0x14, 0xF0, 0x02, 0x79, 0xD4, 0xF1, 0xDC, 0xE4, 0xFF, ++0x71, 0x9E, 0x22, 0x90, 0x93, 0x3D, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x90, 0x93, 0x3C, 0xE0, ++0x14, 0x90, 0x93, 0x3E, 0xF0, 0x22, 0xE0, 0x90, 0x95, 0xED, 0xF0, 0xE0, 0x22, 0x90, 0x05, 0x63, ++0xE0, 0x90, 0x88, 0x89, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, 0x90, 0x05, 0x61, ++0xE0, 0x90, 0x88, 0x8B, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, 0x90, 0x88, 0x32, ++0xE0, 0x44, 0x80, 0xF0, 0x22, 0x11, 0x7E, 0x90, 0x93, 0x03, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0x30, ++0xE0, 0x27, 0xEF, 0x54, 0x04, 0x25, 0xE0, 0xFE, 0xE0, 0x54, 0xF7, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, ++0x02, 0x25, 0xE0, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x90, 0x04, 0x57, 0xE0, 0x90, 0x93, 0x05, ++0xF0, 0x90, 0x04, 0x55, 0xE0, 0x90, 0x93, 0x04, 0xF0, 0x90, 0x93, 0x03, 0xE0, 0x54, 0x01, 0xFF, ++0xEF, 0x90, 0x07, 0xDC, 0x60, 0x25, 0xE4, 0xF0, 0xF0, 0x90, 0x07, 0xDE, 0xF0, 0xA3, 0x04, 0xF0, ++0x90, 0x07, 0xDD, 0x74, 0x03, 0xF0, 0x90, 0x07, 0xE3, 0xE0, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0xA3, ++0x74, 0x10, 0xF0, 0x90, 0x07, 0xDC, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xE4, 0xF0, 0x22, 0x12, 0x02, ++0x06, 0xFF, 0x54, 0x01, 0xFE, 0x22, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0xEC, 0xE0, ++0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x9F, 0xE1, 0x12, 0x87, 0xF5, 0x12, 0x02, 0x06, 0xFF, 0x54, ++0x7F, 0x90, 0x88, 0x36, 0xF0, 0xEF, 0x31, 0xA5, 0xA3, 0x12, 0x87, 0xA0, 0xFD, 0x54, 0xF0, 0xC4, ++0x54, 0x0F, 0xFF, 0x90, 0x88, 0x34, 0xE0, 0x54, 0xF0, 0x4F, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x02, ++0x1F, 0xFC, 0x54, 0x01, 0x25, 0xE0, 0xFF, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xEC, ++0x54, 0x04, 0xC3, 0x13, 0xFF, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xED, 0x54, 0x0F, ++0xC4, 0x54, 0xF0, 0xFF, 0xA3, 0xE0, 0x54, 0x0F, 0x4F, 0x12, 0x87, 0x6B, 0x90, 0x88, 0x35, 0x12, ++0x87, 0x98, 0xFD, 0x90, 0x8A, 0x89, 0x12, 0x90, 0x40, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x87, ++0xF5, 0x12, 0x87, 0x65, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x88, 0x9B, 0x12, 0xE3, 0x1E, 0x4F, 0x12, ++0x87, 0x63, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x31, 0x9C, 0x54, 0x08, 0xFE, 0xEF, 0x54, ++0xF7, 0x12, 0x87, 0x62, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x31, 0x9C, 0x54, 0x20, 0xFE, ++0xEF, 0x54, 0xDF, 0x12, 0x87, 0x62, 0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0x90, 0x88, 0x9B, ++0xF0, 0x12, 0xD2, 0xAE, 0x20, 0xE0, 0x2F, 0xEF, 0xC3, 0x13, 0x20, 0xE0, 0x0B, 0x75, 0x62, 0x01, ++0x90, 0x88, 0xDF, 0xE0, 0x60, 0x0B, 0x80, 0x0E, 0xE4, 0xF5, 0x62, 0x90, 0x88, 0xDF, 0xE0, 0x60, ++0x05, 0xE4, 0xF5, 0x61, 0x80, 0x03, 0x75, 0x61, 0x01, 0x90, 0x8A, 0xF3, 0x12, 0x90, 0x40, 0xAD, ++0x62, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x12, 0x87, 0xF5, 0x12, 0x5C, 0x5F, 0x90, 0x88, 0x36, 0xE0, ++0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFB, 0xF0, 0x12, 0xD3, 0x1E, 0xF0, 0x90, 0x88, ++0x36, 0x12, 0xE3, 0x2C, 0x12, 0xA6, 0xFE, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x4D, 0xFF, 0x90, 0x88, ++0x9B, 0xF0, 0xEE, 0x22, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0xF1, 0x80, 0x20, 0xE6, 0x02, 0x41, 0xC7, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x96, ++0xE9, 0xF0, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, 0x96, 0xEA, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, ++0x90, 0x96, 0xEB, 0xF0, 0x90, 0x96, 0xEA, 0xE0, 0x24, 0xFC, 0x60, 0x0F, 0x24, 0x03, 0x60, 0x02, ++0x41, 0xC0, 0x90, 0x96, 0xE9, 0xE0, 0xFF, 0xF1, 0x87, 0x41, 0xC0, 0x90, 0x96, 0xE9, 0xE0, 0x24, ++0xD6, 0x12, 0xDC, 0x81, 0xFB, 0xE4, 0xFD, 0xFF, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x71, 0x05, 0x13, ++0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x71, 0x05, 0x31, 0xA5, ++0xFB, 0x0D, 0xE4, 0xFF, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x71, 0x05, 0xC4, 0x54, 0x03, 0xFB, 0x0D, ++0xE4, 0xFF, 0x51, 0xF9, 0xF1, 0xD5, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x90, ++0x89, 0x50, 0x12, 0x04, 0x6E, 0x51, 0xF6, 0x75, 0xF0, 0x12, 0x91, 0x74, 0xC4, 0x13, 0x54, 0x01, ++0xFB, 0x0D, 0x7F, 0x01, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x91, 0x74, 0x54, 0x1F, 0x51, 0xF7, 0x12, ++0xB7, 0x70, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xF9, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x01, 0xF5, ++0x82, 0xE4, 0x34, 0x82, 0x51, 0xF4, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x02, 0xF5, 0x82, 0xE4, 0x34, ++0x82, 0x51, 0xF4, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x51, 0xF4, ++0x75, 0xF0, 0x08, 0xA4, 0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, ++0xFD, 0x0F, 0x51, 0xF9, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x51, ++0xF4, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x51, 0xF4, 0x75, 0xF0, ++0x08, 0xA4, 0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x51, 0xCC, ++0xF1, 0x80, 0x30, 0xE0, 0x02, 0xF1, 0xEE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, ++0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, ++0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, ++0x83, 0xEB, 0xF0, 0x22, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x51, 0xCC, 0x90, 0x96, 0xE9, 0xE0, 0x22, ++0xFF, 0x75, 0xF0, 0x12, 0xED, 0x90, 0x89, 0x52, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0x90, 0x95, 0x2F, ++0x12, 0x86, 0x46, 0xB1, 0xBF, 0x12, 0x02, 0x06, 0x54, 0x7F, 0xFD, 0x12, 0x87, 0xA1, 0xFE, 0x54, ++0x1F, 0x90, 0x95, 0x33, 0xF0, 0xEE, 0x54, 0x80, 0x31, 0xA5, 0x90, 0x95, 0x32, 0x12, 0x87, 0x6B, ++0xFE, 0x54, 0x03, 0xFC, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0x95, 0x35, 0x12, 0x87, 0x6B, ++0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0x95, 0x34, 0xF0, 0xEE, 0x54, 0x80, 0x31, ++0xA5, 0xFF, 0x12, 0x87, 0x6C, 0xFB, 0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0x95, 0x37, ++0xF0, 0xFA, 0xEB, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEF, 0x54, 0x01, 0xC4, 0x33, ++0x33, 0x33, 0x54, 0x80, 0x71, 0x00, 0x54, 0x7F, 0x4F, 0xF0, 0x90, 0x95, 0x34, 0xE0, 0x54, 0x01, ++0xC4, 0x33, 0x33, 0x54, 0xC0, 0x71, 0x00, 0x54, 0xBF, 0x4F, 0xF0, 0xEA, 0x60, 0x02, 0x81, 0x6E, ++0x90, 0x95, 0x33, 0xE0, 0x54, 0x1F, 0x91, 0x6F, 0x54, 0xE0, 0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x71, ++0x00, 0x54, 0xFC, 0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0x71, 0x00, 0x54, 0xF3, ++0x4F, 0xF0, 0x90, 0x95, 0x32, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0x91, 0x6F, 0x54, 0xDF, ++0x4F, 0xF0, 0x90, 0x95, 0x35, 0xE0, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0x71, 0x00, 0x54, 0xCF, 0x4F, ++0x12, 0xE3, 0x52, 0xE0, 0x54, 0xFB, 0x12, 0xE3, 0x52, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, ++0x95, 0x38, 0xE0, 0x12, 0xE3, 0xBE, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0x93, 0xE7, 0xE0, 0x60, ++0x37, 0xB1, 0xBF, 0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x54, 0x1F, 0x12, ++0x02, 0x4C, 0x90, 0x95, 0x36, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x36, 0xE0, 0xFF, 0xC3, 0x94, 0x04, ++0x50, 0x16, 0xEF, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0xB1, 0xBF, 0x8F, 0x82, 0x8E, 0x83, 0xE4, ++0x12, 0x02, 0x5E, 0x12, 0xE3, 0x7B, 0x80, 0xE0, 0x90, 0x93, 0xE5, 0xE0, 0x54, 0x07, 0xFF, 0xBF, ++0x05, 0x0A, 0xEC, 0xB4, 0x01, 0x06, 0x90, 0x93, 0xEA, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x95, 0x36, ++0xF0, 0x90, 0x95, 0x36, 0xE0, 0xFC, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x95, 0x2F, 0x12, ++0xC1, 0x37, 0xFF, 0xED, 0x12, 0xB7, 0x70, 0xE5, 0x82, 0x2C, 0x12, 0xB9, 0x4B, 0xEF, 0xF0, 0x12, ++0xE3, 0x7B, 0xE0, 0xB4, 0x04, 0xDB, 0xAF, 0x05, 0x90, 0x8A, 0xFF, 0x12, 0x9C, 0xB4, 0x22, 0xFF, ++0x75, 0xF0, 0x12, 0xED, 0x90, 0x89, 0x51, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0x8F, 0x75, 0x8D, 0x76, ++0xEF, 0xD1, 0x00, 0xE0, 0xF5, 0x77, 0x54, 0x7F, 0xF5, 0x78, 0xE5, 0x77, 0x54, 0x80, 0xF5, 0x7A, ++0x75, 0xF0, 0x12, 0xEF, 0xF1, 0xD8, 0xF5, 0x7C, 0x75, 0xF0, 0x12, 0xEF, 0x71, 0x05, 0xC4, 0x54, ++0x03, 0xF5, 0x7D, 0xB1, 0xD0, 0x74, 0xFF, 0xF0, 0xE5, 0x78, 0x12, 0xDC, 0x5F, 0xB1, 0xDC, 0xEE, ++0xF0, 0xA3, 0xEF, 0xF0, 0xE5, 0x77, 0x45, 0x7A, 0xFF, 0xF1, 0xE0, 0xEF, 0xF0, 0xE5, 0x75, 0xD1, ++0x93, 0xE0, 0x54, 0x03, 0xF5, 0x7B, 0x74, 0x46, 0x25, 0x75, 0x12, 0xE3, 0xCE, 0xE5, 0x7B, 0xF0, ++0xE5, 0x78, 0x65, 0x7C, 0x70, 0x4D, 0x75, 0xF0, 0x12, 0xE5, 0x75, 0x91, 0x74, 0xC4, 0x13, 0x54, ++0x07, 0x30, 0xE0, 0x0C, 0xE5, 0x7A, 0x70, 0x08, 0xE5, 0x78, 0x44, 0x80, 0xF5, 0x77, 0xA1, 0x92, ++0xE5, 0x78, 0x12, 0xDC, 0x5F, 0xB1, 0xDC, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xB1, 0xE3, 0xE0, 0xFF, ++0xA3, 0xE0, 0x90, 0x95, 0xC4, 0xCF, 0xB1, 0xC5, 0xE5, 0x75, 0xF0, 0xE4, 0x90, 0x95, 0xC6, 0x12, ++0xA3, 0x77, 0x7B, 0x01, 0xFA, 0x7D, 0x02, 0x7F, 0x04, 0x12, 0xD4, 0x4F, 0x7D, 0x07, 0xAF, 0x75, ++0x02, 0xD4, 0xFD, 0xE5, 0x78, 0xC3, 0x95, 0x7C, 0x50, 0x61, 0xAB, 0x75, 0xAD, 0x7C, 0xAF, 0x78, ++0x12, 0x72, 0x7F, 0x8F, 0x79, 0x85, 0x79, 0x77, 0x75, 0xF0, 0x12, 0xE5, 0x75, 0x91, 0x74, 0xC4, ++0x13, 0x54, 0x01, 0xFF, 0x90, 0x95, 0xC6, 0xE4, 0xB1, 0xC5, 0xE5, 0x79, 0xF0, 0xA3, 0xE4, 0xF0, ++0xA3, 0xE5, 0x78, 0xF0, 0xE5, 0x7A, 0x31, 0xA5, 0x12, 0xDC, 0xC4, 0xE4, 0xFB, 0xFA, 0x12, 0xD4, ++0xB8, 0xE5, 0x78, 0xC3, 0x94, 0x0C, 0x40, 0x2A, 0x75, 0xF0, 0x12, 0xE5, 0x75, 0x91, 0x74, 0xC4, ++0x13, 0x54, 0x07, 0x30, 0xE0, 0x1C, 0xE5, 0x76, 0x60, 0x18, 0xE5, 0x7A, 0x70, 0x14, 0xE5, 0x78, ++0x44, 0x80, 0xF5, 0x77, 0xB1, 0xD0, 0xE5, 0x79, 0xF0, 0x80, 0x07, 0xF1, 0xE0, 0xE5, 0x7C, 0xF0, ++0xF5, 0x77, 0xB1, 0xC9, 0xE5, 0x77, 0xF0, 0xB1, 0xD0, 0xE0, 0xFF, 0x12, 0xDD, 0x19, 0xEF, 0xF0, ++0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x7B, 0x12, 0xE3, 0x9C, 0x7B, 0x01, 0x7A, 0x00, 0x12, 0xD4, 0xB8, ++0x90, 0x92, 0x80, 0xE5, 0x7B, 0xF0, 0xAB, 0x76, 0xAD, 0x77, 0xAF, 0x75, 0x02, 0x75, 0x80, 0x90, ++0x95, 0x2F, 0x02, 0x86, 0x3D, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0xC2, 0xE4, 0xF0, 0xA3, 0x22, ++0x74, 0x77, 0x25, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0xE4, 0x93, 0xFE, 0x74, ++0x01, 0x93, 0xFF, 0xE5, 0x75, 0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, ++0x22, 0x74, 0xB6, 0x25, 0x61, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE4, 0xF0, 0xE5, 0x61, ++0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0x8D, 0x61, 0xEF, ++0x30, 0xE6, 0x1A, 0xB1, 0xFE, 0xD1, 0x8F, 0xE0, 0x54, 0x03, 0x90, 0x92, 0x80, 0xF0, 0xE4, 0xFB, ++0xAF, 0x61, 0x12, 0x75, 0x80, 0xB1, 0xF1, 0xD1, 0x88, 0x74, 0x01, 0x80, 0x52, 0xF1, 0x74, 0xE0, ++0x04, 0xF0, 0xF1, 0x74, 0xE0, 0x64, 0x02, 0x70, 0x1E, 0x74, 0x77, 0x25, 0x61, 0xB1, 0xD4, 0xE0, ++0xFD, 0xF4, 0x60, 0x02, 0x80, 0x04, 0xB1, 0xFE, 0xE0, 0xFD, 0xD1, 0x91, 0x12, 0xE2, 0xF3, 0xB1, ++0xFE, 0xD1, 0x88, 0x74, 0x02, 0x80, 0x28, 0xF1, 0x74, 0xE0, 0xD3, 0x94, 0x03, 0x40, 0x13, 0x90, ++0x8A, 0xB3, 0x12, 0x90, 0x40, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0xB1, 0xF1, 0xD1, 0x88, 0x74, 0x03, ++0x80, 0x0D, 0xB1, 0xFE, 0xD1, 0x8F, 0x12, 0xE2, 0xF3, 0xB1, 0xFE, 0xD1, 0x88, 0x74, 0x02, 0xF0, ++0xAB, 0x61, 0xE4, 0xFD, 0xFF, 0x02, 0x6F, 0x75, 0xE0, 0x90, 0x92, 0x5E, 0xF0, 0xA3, 0x22, 0xE0, ++0xFD, 0xE5, 0x61, 0xC4, 0x54, 0xF0, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, ++0x7D, 0x01, 0xAF, 0x67, 0xAC, 0x05, 0x90, 0x95, 0xBC, 0xEF, 0xF0, 0xFD, 0xE0, 0xFF, 0xD1, 0x00, ++0xE0, 0xF5, 0x75, 0x54, 0x7F, 0xF5, 0x77, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x50, 0x12, 0x04, ++0x6E, 0xE0, 0xF9, 0x90, 0x95, 0xBC, 0xE0, 0xF1, 0xD5, 0xFE, 0xEF, 0xD1, 0x93, 0xE0, 0x54, 0x03, ++0xF5, 0x76, 0xE5, 0x77, 0x90, 0x81, 0x9D, 0x93, 0xFB, 0xED, 0xB1, 0xE5, 0xE4, 0xF0, 0xA3, 0xEB, ++0xF0, 0x71, 0x01, 0xC4, 0x54, 0x03, 0x90, 0x95, 0xBD, 0xF0, 0x74, 0xC6, 0x2D, 0xF1, 0xE4, 0xE5, ++0x77, 0xF0, 0x74, 0x46, 0x2D, 0x12, 0xE3, 0xCE, 0xE5, 0x76, 0xF0, 0xE5, 0x77, 0xD3, 0x9E, 0x40, ++0x06, 0x8E, 0x77, 0xAF, 0x06, 0x8F, 0x75, 0x8C, 0x78, 0xE4, 0xFF, 0xEF, 0xC3, 0x95, 0x78, 0x50, ++0x30, 0xE5, 0x75, 0x30, 0xE7, 0x09, 0x85, 0x77, 0x75, 0x1C, 0xEC, 0x70, 0x21, 0x80, 0x22, 0xE5, ++0x77, 0xD3, 0x99, 0x40, 0x15, 0xAD, 0x01, 0x90, 0x95, 0xBC, 0xE0, 0xFB, 0x90, 0x95, 0xC1, 0xEC, ++0xF0, 0xAF, 0x77, 0x12, 0xB5, 0x93, 0x8F, 0x75, 0x80, 0x07, 0x89, 0x75, 0x80, 0x03, 0x0F, 0x80, ++0xCA, 0x90, 0x95, 0xBC, 0xE0, 0xFF, 0xB1, 0xC9, 0xEF, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x75, ++0x12, 0xE3, 0x9C, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0xFA, 0x7D, 0x05, 0x7F, 0x08, 0x12, ++0xD4, 0x4F, 0x90, 0x95, 0xBC, 0xE0, 0xFF, 0x90, 0x92, 0x80, 0xE5, 0x76, 0xF0, 0xE4, 0xFB, 0xAD, ++0x75, 0x02, 0x75, 0x80, 0x74, 0xB6, 0x25, 0x61, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, ++0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, ++0xF3, 0xEF, 0xF0, 0xF1, 0x80, 0x30, 0xE6, 0x38, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0xEF, 0x64, 0x01, ++0x70, 0x2E, 0x90, 0x96, 0xF4, 0xF0, 0x90, 0x96, 0xF4, 0xE0, 0xFD, 0x90, 0x96, 0xF3, 0xE0, 0xD1, ++0x00, 0xE5, 0x82, 0x2D, 0x12, 0xB9, 0x4B, 0xE0, 0xFB, 0xE4, 0xFF, 0x51, 0xCC, 0x90, 0x96, 0xF4, ++0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xDD, 0xF1, 0x80, 0x30, 0xE0, 0x02, 0xF1, 0xEE, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x4F, 0x12, 0x04, 0x6E, 0xE0, 0x22, ++0x74, 0xC6, 0x25, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x21, 0xAC, 0xE4, 0xFD, ++0x7F, 0x8D, 0x02, 0x7B, 0x2E, 0x12, 0x02, 0x06, 0x90, 0x88, 0x9C, 0xF0, 0x60, 0x34, 0xA3, 0xE0, ++0x20, 0xE0, 0x2F, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, ++0x11, 0x33, 0x30, 0xE0, 0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x14, 0x90, 0x88, ++0x9B, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, 0x7F, 0x09, 0x12, ++0x71, 0x9A, 0x22, 0x90, 0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x31, 0x4A, 0x90, 0x96, 0xC7, 0x12, 0x04, 0x31, 0x90, 0x96, 0xC7, 0x51, 0x7D, 0x90, ++0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, ++0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0xA5, 0xF2, 0x30, 0xE0, ++0x05, 0x7F, 0x03, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xB8, 0xE0, 0x20, 0xE0, 0x33, 0x11, 0x33, 0x30, ++0xE0, 0x2E, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0x96, 0xC5, 0xF0, 0x80, 0x06, 0x90, ++0x96, 0xC5, 0x74, 0x01, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x96, 0xC6, 0x30, 0xE0, 0x05, ++0x74, 0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0x96, 0xC5, 0x11, 0xB7, 0x12, 0x9B, 0xF9, ++0x31, 0x57, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8A, 0xF3, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0x4A, 0x90, 0x96, 0xCD, 0x12, 0x04, 0x31, 0x90, ++0x96, 0xCD, 0x51, 0x7D, 0x12, 0x88, 0xCD, 0x91, 0x68, 0x31, 0x5F, 0x90, 0x01, 0x00, 0x74, 0x3F, ++0xF0, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0x90, 0x01, 0x01, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, ++0x53, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0xA5, 0xF2, 0x30, 0xE0, 0x05, 0x7F, 0x01, ++0x12, 0x71, 0x9A, 0x11, 0x33, 0x30, 0xE0, 0x35, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x90, 0x96, ++0xCB, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x96, 0xCB, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, ++0x30, 0xE0, 0x07, 0xE4, 0x90, 0x96, 0xCC, 0xF0, 0x80, 0x06, 0x90, 0x96, 0xCC, 0x74, 0x02, 0xF0, ++0x90, 0x96, 0xCB, 0x11, 0xB7, 0x12, 0x9B, 0xF9, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x90, 0x88, 0x9A, ++0xE0, 0x60, 0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, ++0x70, 0xED, 0x44, 0x80, 0xFD, 0xEC, 0x22, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, ++0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE4, 0x90, 0x95, 0x8C, 0xF0, 0xF1, 0xAA, 0x7F, 0x08, 0x12, 0x7B, ++0x41, 0xEF, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0xE4, 0xFF, 0x91, 0x0B, 0x90, 0x93, ++0x3F, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0x65, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x02, 0x31, ++0x5F, 0xE4, 0x90, 0x95, 0x8D, 0xF0, 0x90, 0x95, 0x8D, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2C, ++0x51, 0xCC, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x42, 0xE0, ++0xFD, 0xEF, 0x5D, 0x60, 0x0F, 0x90, 0x95, 0x8D, 0x91, 0x89, 0x90, 0x95, 0x8D, 0x91, 0xA9, 0x44, ++0x40, 0xF0, 0x91, 0x61, 0x90, 0x95, 0x8D, 0xE0, 0x04, 0xF0, 0x80, 0xCA, 0x90, 0x07, 0xC7, 0xE4, ++0xF0, 0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, 0x77, 0xF0, 0x90, 0x07, 0xC4, 0xE4, 0xF0, ++0x90, 0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xF1, 0x4F, 0x90, 0x02, 0x26, 0xE0, ++0x44, 0x01, 0xF0, 0xE0, 0x90, 0x95, 0x8E, 0xF0, 0x90, 0x95, 0x8E, 0xE0, 0x30, 0xE0, 0x18, 0x90, ++0x95, 0x8C, 0xE0, 0x04, 0xF1, 0x3F, 0x90, 0x02, 0x26, 0xE0, 0x90, 0x95, 0x8E, 0xF0, 0x90, 0x95, ++0x8C, 0xE0, 0xD3, 0x94, 0xFA, 0x40, 0xE1, 0x90, 0x02, 0x03, 0x74, 0x80, 0xF0, 0x90, 0x04, 0x24, ++0xE0, 0x90, 0x95, 0x8F, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x02, 0x00, 0xE0, ++0x90, 0x95, 0x8E, 0xF0, 0x90, 0x02, 0x01, 0x51, 0x74, 0x90, 0x02, 0x02, 0x51, 0x74, 0x90, 0x02, ++0x14, 0x51, 0x74, 0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x54, ++0xEF, 0xF0, 0x90, 0x95, 0x8F, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0xFD, 0x09, 0x74, 0xFF, 0xF0, ++0x90, 0xFD, 0x08, 0xE4, 0xF0, 0x91, 0x71, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x32, 0xE0, ++0x54, 0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x95, 0x8E, 0xE0, 0x2F, 0xF0, 0x22, 0x12, 0x04, 0xB8, ++0x90, 0x92, 0x18, 0x12, 0x04, 0x31, 0x7F, 0x30, 0x7E, 0x08, 0x02, 0x70, 0xAD, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x51, 0xD4, 0x31, 0x65, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x39, ++0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0D, 0xB1, 0x38, 0xBF, 0x01, 0x08, 0x51, 0x8D, 0x90, 0x01, ++0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, ++0x8D, 0xF5, 0x83, 0xE0, 0xFD, 0x7C, 0x00, 0xE5, 0x67, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, ++0xA8, 0x07, 0x08, 0x22, 0x75, 0x66, 0x14, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x10, 0xF0, 0x91, 0x71, ++0x7D, 0x01, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x41, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, 0x90, ++0x88, 0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, ++0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x93, 0x3F, 0xE0, 0x30, 0xE0, 0x70, 0x90, 0xFD, ++0x09, 0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, 0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, ++0x95, 0x8C, 0xF0, 0x90, 0x95, 0x8C, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2C, 0x51, 0xCC, 0x80, ++0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x41, 0xE0, 0xFD, 0xEF, 0x5D, ++0x60, 0x0F, 0x90, 0x95, 0x8C, 0x91, 0x89, 0x90, 0x95, 0x8C, 0x91, 0xA9, 0x44, 0x20, 0xF0, 0x91, ++0x61, 0x90, 0x95, 0x8C, 0xE0, 0x04, 0xF0, 0x80, 0xCA, 0x7F, 0x92, 0x91, 0x6A, 0xFD, 0x7F, 0x92, ++0x12, 0x7B, 0x2E, 0x7F, 0x92, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x08, 0xFD, 0x7F, 0x92, 0x12, 0x7B, ++0x2E, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFD, 0xFD, 0x7F, 0x02, 0x80, 0x06, 0x7F, 0x92, ++0xF1, 0x47, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x10, 0xFD, ++0x7F, 0x08, 0x12, 0x7B, 0x2E, 0x7F, 0x01, 0x91, 0x0B, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xF0, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x90, 0x96, 0xEC, 0xEF, 0xF0, ++0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, ++0x90, 0x96, 0xEC, 0xE0, 0x6F, 0x60, 0x32, 0xC3, 0x90, 0x96, 0xEE, 0xE0, 0x94, 0x88, 0x90, 0x96, ++0xED, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x96, ++0xED, 0x91, 0x5A, 0xD3, 0x90, 0x96, 0xEE, 0xE0, 0x94, 0x32, 0x90, 0x96, 0xED, 0xE0, 0x94, 0x00, ++0x40, 0xC3, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xBC, 0x22, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x02, ++0xE7, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFE, ++0x22, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x90, 0x88, 0xE0, 0xE0, 0xFB, ++0x90, 0x88, 0xDF, 0xE0, 0x90, 0x92, 0x90, 0xF0, 0x22, 0xE0, 0xFF, 0x24, 0x4D, 0xF5, 0x82, 0xE4, ++0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, 0x52, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB1, 0xF0, 0x22, 0xE0, 0xFF, 0x24, 0x43, 0xF5, 0x82, 0xE4, ++0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB2, 0xF0, 0x74, 0x48, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB3, 0xF0, 0xE0, 0x22, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, ++0x18, 0x90, 0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x0E, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xF1, 0x63, ++0xBF, 0x01, 0x06, 0x80, 0x02, 0x80, 0x00, 0x51, 0x9D, 0x22, 0xE4, 0x90, 0x95, 0x2F, 0xF0, 0xA3, ++0xF0, 0xF1, 0x57, 0xEF, 0x64, 0x01, 0x60, 0x39, 0xC3, 0x90, 0x95, 0x30, 0xE0, 0x94, 0x88, 0x90, ++0x95, 0x2F, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, ++0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1B, 0x90, 0x95, 0x2F, 0x91, 0x5A, 0xD3, 0x90, 0x95, 0x30, 0xE0, ++0x94, 0x32, 0x90, 0x95, 0x2F, 0xE0, 0x94, 0x00, 0x40, 0xC7, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, ++0xC0, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0x90, 0x93, 0x3B, 0xE0, 0xC3, 0x13, 0x20, 0xE0, ++0x35, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, ++0x05, 0x75, 0x66, 0x01, 0x80, 0x2E, 0x90, 0x02, 0x96, 0xE0, 0x60, 0x05, 0x75, 0x66, 0x10, 0x80, ++0x23, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, ++0x05, 0x75, 0x66, 0x04, 0x80, 0x0E, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x66, 0x20, ++0x80, 0x02, 0xE1, 0x37, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x66, 0xF0, ++0x7F, 0x00, 0x22, 0xE4, 0xF5, 0x7A, 0xEF, 0x14, 0xF5, 0x79, 0xED, 0xFF, 0xE5, 0x79, 0xF5, 0x82, ++0x33, 0x95, 0xE0, 0xF5, 0x83, 0xC3, 0xE5, 0x82, 0x9F, 0x74, 0x80, 0xF8, 0x65, 0x83, 0x98, 0x40, ++0x50, 0xE5, 0x79, 0x78, 0x03, 0xA2, 0xE7, 0x13, 0xD8, 0xFB, 0xFF, 0x33, 0x95, 0xE0, 0xFE, 0xEB, ++0xF1, 0x70, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE5, 0x83, 0x3E, 0xF5, 0x83, 0xE0, 0xF5, 0x82, 0x75, ++0x83, 0x00, 0xE5, 0x79, 0x51, 0xC9, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, ++0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, 0x60, 0x13, 0x85, 0x79, 0x7B, 0x05, 0x7A, 0x90, ++0x95, 0xC1, 0xE0, 0x65, 0x7A, 0x60, 0x0A, 0xE5, 0x7B, 0xD3, 0x9D, 0x40, 0x04, 0x15, 0x79, 0x80, ++0x99, 0xAF, 0x7B, 0x22, 0xE4, 0x90, 0x95, 0xEE, 0xF0, 0xF1, 0x7E, 0xD1, 0xBB, 0xF1, 0x0A, 0xD1, ++0xD6, 0x90, 0x07, 0xE3, 0x12, 0xA7, 0xE6, 0x60, 0x59, 0xE4, 0x90, 0x95, 0xEF, 0xF0, 0x90, 0x96, ++0x11, 0x74, 0x08, 0xF0, 0x90, 0x05, 0x68, 0xE0, 0x90, 0x95, 0xF1, 0xF0, 0x90, 0x05, 0x69, 0xE0, ++0x90, 0x95, 0xF2, 0xF0, 0x90, 0x05, 0x6A, 0xE0, 0x90, 0x95, 0xF3, 0xF0, 0x90, 0x05, 0x6B, 0xE0, ++0x90, 0x95, 0xF4, 0xF0, 0x90, 0x05, 0x78, 0xE0, 0x90, 0x95, 0xF5, 0xF0, 0x90, 0x05, 0x79, 0xE0, ++0x90, 0x95, 0xF6, 0xF0, 0x90, 0x05, 0x7A, 0xE0, 0x90, 0x95, 0xF7, 0xF0, 0x90, 0x05, 0x7B, 0xE0, ++0x90, 0x95, 0xF8, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xEF, 0x12, 0x90, 0x2E, 0x7F, 0x04, 0x12, ++0x04, 0x7E, 0x90, 0x95, 0xED, 0xE0, 0xFD, 0x60, 0x41, 0xA3, 0xE0, 0x51, 0xCB, 0x80, 0x05, 0xC3, ++0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x60, 0xE7, 0x90, 0x95, 0xEE, 0xE0, 0xFB, ++0x74, 0x01, 0xA8, 0x03, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFE, 0xF4, 0xFD, 0x90, 0x95, ++0xED, 0xE0, 0x5D, 0xF0, 0x90, 0x07, 0xE3, 0xE0, 0x4E, 0xF0, 0xAF, 0x03, 0x12, 0xBF, 0xFD, 0x12, ++0xBE, 0x94, 0x90, 0x95, 0xEE, 0xE0, 0x04, 0xF0, 0x80, 0xB8, 0x22, 0xE4, 0xFF, 0x74, 0x80, 0xD1, ++0xFF, 0x74, 0x2D, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xD1, 0xCF, 0xB4, 0x08, 0xEF, 0x22, 0xF5, ++0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0x22, 0xE4, 0xFF, 0x74, 0x94, 0xD1, 0xFF, 0x74, 0x13, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0x93, 0xD1, 0xCF, 0xB4, 0x08, 0xEF, 0xE4, 0xFF, 0x74, 0x9C, 0xD1, 0xFF, 0x74, ++0x1C, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xD1, 0xCF, 0xB4, 0x04, 0xEF, 0x22, 0x74, 0x90, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x24, 0xF5, 0x83, 0xE0, 0xFE, 0x22, 0xE4, 0xFF, 0x74, 0x88, 0xD1, 0xFF, ++0x74, 0x06, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xD1, 0xCF, 0xB4, 0x08, 0xEF, 0x90, 0x05, 0xDC, ++0xE0, 0x90, 0x93, 0x0E, 0xF0, 0xE4, 0xFF, 0xD1, 0xFD, 0x74, 0x0F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x93, 0xD1, 0xCF, 0xB4, 0x04, 0xF1, 0x22, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0xF0, ++0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, 0x22, 0x74, ++0x0F, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, ++0x7F, 0x01, 0x22, 0x90, 0x88, 0x2F, 0xE0, 0x64, 0x02, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, ++0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0x90, 0x24, ++0xA0, 0xE0, 0x90, 0x93, 0x03, 0x30, 0xE7, 0x05, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0xE0, 0x54, 0xFD, ++0xF0, 0x22, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, 0xF1, 0x3F, 0x90, 0x01, 0x98, 0xE0, ++0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC4, 0x74, 0xAA, 0xF0, ++0x74, 0xB7, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0xAA, 0x04, ++0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB7, 0xA3, 0xF0, 0x22, 0x90, 0x93, 0x3F, 0xE0, 0x20, 0xE0, 0x03, ++0x02, 0xB8, 0x9C, 0xE4, 0x90, 0x95, 0x33, 0xF0, 0x90, 0x95, 0x33, 0xE0, 0xFF, 0xC3, 0x94, 0x05, ++0x40, 0x03, 0x02, 0xB8, 0x9C, 0x51, 0xCC, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, ++0xFF, 0x90, 0x93, 0x40, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x03, 0x02, 0xB8, 0x93, 0x12, 0x02, 0x06, ++0xFF, 0x30, 0xE0, 0x1A, 0x90, 0x93, 0x41, 0xE0, 0xFE, 0x90, 0x95, 0x33, 0xE0, 0xFD, 0x74, 0x01, ++0xA8, 0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, 0x41, 0xF0, 0xEF, 0xC3, ++0x13, 0x30, 0xE0, 0x1A, 0x90, 0x93, 0x42, 0xE0, 0xFF, 0x90, 0x95, 0x33, 0xE0, 0xFE, 0x74, 0x01, ++0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x42, 0xF0, 0x12, 0x87, ++0xA1, 0xFF, 0x90, 0x95, 0x33, 0xE0, 0xFE, 0x24, 0x43, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, ++0xEF, 0x12, 0x87, 0x6B, 0xFF, 0x74, 0x48, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, ++0x11, 0x9D, 0x74, 0x4D, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0x87, 0x98, ++0xFF, 0x74, 0x52, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0x40, ++0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, ++0x40, 0xF0, 0x22, 0x90, 0x95, 0x33, 0xE0, 0x04, 0xF0, 0x02, 0xB7, 0xD8, 0x22, 0xF0, 0x90, 0x00, ++0x03, 0x12, 0x02, 0x1F, 0xFF, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0xE0, 0xF0, 0xBF, 0x01, ++0x0A, 0x7F, 0x01, 0x12, 0x90, 0x49, 0xE4, 0x90, 0x93, 0xE0, 0xF0, 0x22, 0xE4, 0xFD, 0x02, 0x8F, ++0xE7, 0x90, 0x95, 0xED, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x96, 0x11, ++0xF0, 0xE0, 0xFE, 0x6F, 0x60, 0x70, 0x90, 0x95, 0xEE, 0x74, 0x03, 0xF0, 0x90, 0x96, 0x10, 0x74, ++0x08, 0xF0, 0xEE, 0x04, 0x54, 0x0F, 0xFF, 0xE4, 0xFE, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, ++0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2E, 0x31, 0x4B, 0xE0, 0xFD, 0x74, 0xF0, ++0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x08, 0xDA, 0x7B, ++0x01, 0x7A, 0x95, 0x79, 0xEE, 0x31, 0x53, 0x12, 0x04, 0x7E, 0x90, 0x96, 0x11, 0xE0, 0x04, 0x54, ++0x0F, 0xFF, 0xF0, 0xBF, 0x0F, 0x02, 0xE4, 0xF0, 0x90, 0x96, 0x11, 0xE0, 0x90, 0x04, 0x7F, 0xF0, ++0x90, 0x95, 0xED, 0xE0, 0x70, 0x05, 0x90, 0x8A, 0xE5, 0x80, 0x03, 0x90, 0x8A, 0x79, 0x12, 0x90, ++0x40, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xE4, 0xFF, 0x01, 0xC1, 0xF5, 0x82, 0xE4, 0x35, 0x83, ++0xF5, 0x83, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x27, ++0x90, 0x96, 0x52, 0x74, 0x1E, 0xF0, 0x90, 0x96, 0x74, 0x74, 0x01, 0xF0, 0x90, 0x96, 0x54, 0xEF, ++0xF0, 0x7B, 0x01, 0x7A, 0x96, 0x79, 0x52, 0x31, 0x53, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xE5, 0x12, ++0x90, 0x40, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x2C, 0xE0, ++0x30, 0xE0, 0x10, 0xA3, 0x74, 0x01, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, ++0x02, 0x31, 0xC2, 0x12, 0xA5, 0x47, 0xE4, 0xFF, 0x31, 0x60, 0x90, 0x8B, 0x07, 0xB1, 0x11, 0x02, ++0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xA7, 0x8F, 0xBF, 0x01, 0x04, 0x7F, ++0x01, 0x80, 0x02, 0x7F, 0x02, 0x31, 0xDC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x2F, 0xE0, 0x90, 0x96, 0xFE, 0xF0, 0x6F, 0x70, 0x02, 0x41, 0xE6, ++0xEF, 0x14, 0x60, 0x42, 0x14, 0x60, 0x70, 0x14, 0x70, 0x02, 0x41, 0x92, 0x14, 0x70, 0x02, 0x41, ++0xBD, 0x24, 0x04, 0x60, 0x02, 0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x04, 0x04, 0x71, 0x3A, ++0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x02, 0x04, 0x71, 0x4A, 0x41, 0xE6, 0x90, 0x96, 0xFE, ++0xE0, 0xB4, 0x03, 0x04, 0x71, 0x4F, 0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0x64, 0x01, 0x60, 0x02, ++0x41, 0xE6, 0x71, 0x3D, 0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x04, 0x05, 0x12, 0x97, 0xAE, ++0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x02, 0x05, 0x12, 0x97, 0xB9, 0x41, 0xE6, 0x90, 0x96, ++0xFE, 0xE0, 0xB4, 0x03, 0x05, 0x12, 0x97, 0xA0, 0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0x60, 0x02, ++0x41, 0xE6, 0x12, 0x97, 0xF4, 0x80, 0x7F, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x04, 0x04, 0x71, 0x11, ++0x80, 0x74, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x01, 0x04, 0x51, 0xFD, 0x80, 0x69, 0x90, 0x96, 0xFE, ++0xE0, 0xB4, 0x03, 0x04, 0x71, 0x5C, 0x80, 0x5E, 0x90, 0x96, 0xFE, 0xE0, 0x70, 0x58, 0x51, 0xFA, ++0x80, 0x54, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x04, 0x04, 0x71, 0x8B, 0x80, 0x49, 0x90, 0x96, 0xFE, ++0xE0, 0xB4, 0x01, 0x04, 0x71, 0x26, 0x80, 0x3E, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x02, 0x04, 0x71, ++0x54, 0x80, 0x33, 0x90, 0x96, 0xFE, 0xE0, 0x70, 0x2D, 0x71, 0x23, 0x80, 0x29, 0x90, 0x96, 0xFE, ++0xE0, 0xB4, 0x03, 0x04, 0x71, 0x6D, 0x80, 0x1E, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x01, 0x04, 0x51, ++0xEE, 0x80, 0x13, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x02, 0x04, 0x71, 0x9D, 0x80, 0x08, 0x90, 0x96, ++0xFE, 0xE0, 0x70, 0x02, 0x51, 0xEB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x97, 0xF4, 0x90, 0x8A, ++0xF9, 0x12, 0x90, 0x40, 0x7D, 0x1F, 0x71, 0x79, 0xF0, 0x22, 0x12, 0x97, 0xF4, 0x90, 0x8A, 0xF9, ++0x12, 0x90, 0x40, 0x7D, 0x20, 0x71, 0x64, 0x12, 0x88, 0xD0, 0x90, 0x88, 0x2F, 0x74, 0x02, 0xF0, ++0x22, 0x12, 0x97, 0xF6, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x23, 0x71, 0x64, 0x12, 0x88, ++0xD0, 0x80, 0xE7, 0x12, 0x97, 0xF4, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x21, 0x7F, 0xFF, ++0x12, 0x04, 0x7E, 0x90, 0x88, 0x2F, 0x74, 0x03, 0xF0, 0x22, 0x12, 0x97, 0xAE, 0x90, 0x05, 0x27, ++0xE0, 0x54, 0xBF, 0xF0, 0xE4, 0x90, 0x88, 0x2F, 0xF0, 0x22, 0x12, 0x97, 0xB9, 0x80, 0xEE, 0x12, ++0x97, 0xA0, 0x80, 0xE9, 0x90, 0x86, 0x0C, 0x12, 0x88, 0xD0, 0x80, 0xD7, 0x90, 0x8A, 0xEF, 0x12, ++0x88, 0xD0, 0x80, 0xA6, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x22, 0x90, 0x8A, 0xF9, ++0x12, 0x90, 0x40, 0x7D, 0x25, 0x71, 0x79, 0xF0, 0x22, 0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x90, 0x05, ++0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0x88, 0x2F, 0x74, 0x04, 0x22, 0x90, 0x8A, 0xF9, 0x12, 0x90, ++0x40, 0x7D, 0x22, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x12, 0x97, 0xF6, 0x80, 0x96, 0x90, 0x86, 0x0C, ++0x12, 0x88, 0xD0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x24, 0x71, 0x79, 0xF0, 0x22, 0x90, ++0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x4A, 0x90, 0x88, 0x30, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, ++0x7E, 0x01, 0x90, 0x88, 0x2F, 0xE0, 0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, ++0x30, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x21, 0xC2, 0x91, 0x02, 0x90, 0x88, 0x30, 0xE0, 0xB4, ++0x0C, 0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0x7F, 0x08, 0x80, 0x10, 0x90, 0x88, ++0x30, 0xE0, 0xB4, 0x04, 0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0xFF, 0x12, 0x04, ++0x7E, 0x22, 0x90, 0x01, 0x57, 0xE0, 0x60, 0x20, 0x12, 0xD0, 0x16, 0xF0, 0x90, 0x88, 0x31, 0x12, ++0x9F, 0xE7, 0x30, 0xE0, 0x03, 0x02, 0xD0, 0x3D, 0x12, 0xE2, 0x5C, 0x40, 0x0B, 0xE4, 0xFF, 0x12, ++0x78, 0x4A, 0xBF, 0x01, 0x03, 0x12, 0x9F, 0xD9, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, ++0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, ++0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x29, 0xF0, 0x74, 0xBC, 0xA3, 0xF0, ++0x12, 0x64, 0x7F, 0xE5, 0x30, 0x30, 0xE1, 0x03, 0x12, 0xD0, 0x84, 0xE5, 0x2D, 0x30, 0xE1, 0x02, ++0x31, 0x47, 0xE5, 0x2D, 0x30, 0xE4, 0x03, 0x12, 0xDD, 0x6D, 0xE5, 0x2D, 0x30, 0xE5, 0x03, 0x12, ++0xDD, 0x7E, 0xE5, 0x2D, 0x30, 0xE6, 0x03, 0x12, 0xC8, 0x58, 0xE5, 0x2F, 0x30, 0xE0, 0x02, 0x31, ++0x9C, 0xE5, 0x2F, 0x30, 0xE1, 0x03, 0x12, 0xC8, 0x65, 0xE5, 0x2F, 0x30, 0xE2, 0x03, 0x12, 0xCF, ++0xDF, 0xE5, 0x2F, 0x30, 0xE3, 0x03, 0x12, 0xD0, 0x02, 0xE5, 0x2F, 0x30, 0xE4, 0x03, 0x12, 0xD0, ++0x1E, 0xE5, 0x2F, 0x30, 0xE5, 0x03, 0x12, 0xD0, 0x49, 0xE5, 0x2F, 0x30, 0xE6, 0x03, 0x12, 0xD0, ++0x6B, 0xE5, 0x30, 0x30, 0xE4, 0x02, 0xF1, 0xDB, 0xE5, 0x30, 0x30, 0xE5, 0x02, 0xB1, 0x09, 0xE5, ++0x36, 0x30, 0xE0, 0x03, 0x12, 0xB6, 0x04, 0xE5, 0x36, 0x30, 0xE6, 0x02, 0xB1, 0x5B, 0xE5, 0x36, ++0x30, 0xE7, 0x02, 0xB1, 0x19, 0xE5, 0x37, 0x30, 0xE2, 0x02, 0xB1, 0x25, 0xE5, 0x37, 0x30, 0xE3, ++0x02, 0xB1, 0x31, 0x74, 0x29, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBC, 0xA3, 0xF0, 0xD0, 0x07, ++0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, ++0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x8A, 0xDF, 0xB1, 0x11, 0x02, 0x04, ++0x7A, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, ++0x7F, 0x01, 0xB1, 0x3D, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x02, 0xB1, 0x3D, ++0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0xB1, 0x3D, 0x22, 0x90, 0x95, 0xEF, ++0xEF, 0xF0, 0x90, 0x95, 0xED, 0x74, 0x18, 0xF0, 0x90, 0x96, 0x0F, 0x74, 0x01, 0xF0, 0xFB, 0x7A, ++0x95, 0x79, 0xED, 0x12, 0x90, 0x2E, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x90, 0x93, 0x03, 0xE0, 0x30, ++0xE0, 0x1E, 0xE4, 0xFF, 0xB1, 0x3D, 0xE4, 0xFF, 0xB1, 0x81, 0x7F, 0x01, 0xB1, 0x81, 0x90, 0x93, ++0x03, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, 0x90, 0x04, 0x1F, 0xE0, 0x44, 0x80, 0xF0, ++0x22, 0xEF, 0x70, 0x05, 0x90, 0x93, 0x05, 0x80, 0x03, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x12, 0x7B, ++0x07, 0x90, 0x95, 0xED, 0xEF, 0xF0, 0x90, 0x95, 0xED, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, ++0xD1, 0x34, 0xE4, 0xFF, 0x74, 0x08, 0x2F, 0xF1, 0x84, 0xE0, 0xFE, 0xD1, 0x27, 0x8F, 0x82, 0x75, ++0x83, 0x00, 0xD1, 0x2D, 0xB4, 0x06, 0xED, 0x90, 0x95, 0xED, 0xE0, 0x24, 0x52, 0xF9, 0xE4, 0x34, ++0xFC, 0xD1, 0x34, 0x12, 0x02, 0x06, 0x70, 0x5E, 0xD1, 0x27, 0x12, 0x87, 0xA1, 0x64, 0x02, 0x70, ++0x55, 0x90, 0x24, 0x87, 0xE0, 0x90, 0x00, 0x03, 0x12, 0x02, 0x5E, 0x90, 0x24, 0x86, 0xE0, 0x90, ++0x00, 0x04, 0x12, 0x02, 0x5E, 0xD1, 0x27, 0x12, 0x87, 0x65, 0x64, 0x01, 0x70, 0x38, 0x12, 0x9F, ++0xEF, 0x64, 0x0D, 0x70, 0x31, 0xFF, 0x74, 0x88, 0x12, 0xB6, 0xFF, 0xEF, 0x24, 0x08, 0xD1, 0x3B, ++0xD1, 0x50, 0xD1, 0x2D, 0xB4, 0x08, 0xEF, 0x90, 0x05, 0xDC, 0xE0, 0xFF, 0xD1, 0x27, 0x90, 0x00, ++0x10, 0xEF, 0x12, 0x02, 0x5E, 0xE4, 0xFF, 0x12, 0xB6, 0xFD, 0xEF, 0x24, 0x11, 0xD1, 0x3B, 0xD1, ++0x50, 0xD1, 0x2D, 0xB4, 0x04, 0xF1, 0x22, 0x90, 0x95, 0xEE, 0x02, 0x86, 0x3D, 0xEE, 0x12, 0x02, ++0x5E, 0x0F, 0xEF, 0x22, 0xFA, 0x7B, 0x01, 0xA3, 0x02, 0x86, 0x46, 0xFD, 0xE4, 0x33, 0xFC, 0x90, ++0x95, 0xEE, 0x22, 0x7E, 0x00, 0xC3, 0x74, 0x07, 0x9F, 0xFD, 0xE4, 0x9E, 0xFC, 0x90, 0x96, 0x16, ++0x12, 0x86, 0x3D, 0x8D, 0x82, 0x8C, 0x83, 0x22, 0xF1, 0x8C, 0x90, 0x96, 0x19, 0xF0, 0x90, 0x96, ++0x19, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x29, 0xD1, 0x43, 0xF1, 0x7C, 0x12, 0xC1, 0x2F, 0xC3, ++0x9D, 0x50, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x96, 0x19, 0xE0, 0xFF, 0xD1, 0x43, 0xF1, 0x7C, 0x12, ++0xC1, 0x2F, 0xD3, 0x9D, 0x40, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x96, 0x19, 0xE0, 0x04, 0xF0, 0x80, ++0xCD, 0x7F, 0x00, 0x22, 0xE4, 0x90, 0x96, 0x12, 0xF0, 0x90, 0x93, 0x03, 0xE0, 0xFF, 0xC3, 0x13, ++0x20, 0xE0, 0x78, 0xF1, 0x62, 0xF1, 0x57, 0xD1, 0x58, 0xEF, 0x60, 0x0D, 0x7B, 0x01, 0x7A, 0x93, ++0x79, 0x13, 0xF1, 0x57, 0xF1, 0x69, 0xEF, 0x60, 0x5A, 0xF1, 0x62, 0xF1, 0x57, 0xD1, 0x58, 0xEF, ++0x60, 0x18, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x13, 0xF1, 0x57, 0xF1, 0x69, 0xEF, 0x60, 0x0B, 0x7B, ++0x01, 0x7A, 0x93, 0x79, 0x1C, 0x12, 0xE3, 0x01, 0x70, 0x39, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x20, ++0x90, 0x96, 0x16, 0x12, 0x86, 0x46, 0x7A, 0x93, 0x79, 0x06, 0xD1, 0x58, 0xEF, 0x60, 0x10, 0xF1, ++0x51, 0xD1, 0x58, 0xEF, 0x60, 0x09, 0xF1, 0x62, 0xF1, 0x57, 0xF1, 0x94, 0xEF, 0x70, 0x14, 0xF1, ++0x62, 0xF1, 0x57, 0xF1, 0x69, 0xEF, 0x60, 0x26, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x0F, 0x12, 0xE3, ++0x01, 0x60, 0x1B, 0x90, 0x96, 0x12, 0x74, 0x01, 0xF0, 0x80, 0x13, 0xF1, 0x51, 0xD1, 0x58, 0xEF, ++0x60, 0x0C, 0xF1, 0x51, 0xF1, 0x94, 0xEF, 0x70, 0x05, 0x90, 0x96, 0x12, 0x04, 0xF0, 0x90, 0x96, ++0x12, 0xE0, 0xFF, 0x90, 0x05, 0x18, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x90, 0x05, 0xB3, 0x60, 0x0C, ++0xE0, 0x44, 0x80, 0xF0, 0x90, 0x24, 0xA0, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xE0, 0x44, 0x20, 0xF0, ++0x22, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x2D, 0x90, 0x96, 0x16, 0x12, 0x86, 0x46, 0x7A, 0x93, 0x79, ++0x20, 0x22, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x06, 0x22, 0xF1, 0x8C, 0xFF, 0xF1, 0xE0, 0x6E, 0x60, ++0x03, 0x7F, 0x00, 0x22, 0x0F, 0xEF, 0xB4, 0x08, 0xF3, 0x7F, 0x01, 0x22, 0x12, 0x02, 0x1F, 0xFD, ++0xC3, 0x74, 0x07, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0x22, 0x90, 0x96, 0x13, 0x12, ++0x86, 0x46, 0xE4, 0x22, 0xF1, 0x8C, 0xFF, 0xF1, 0xE0, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x0F, ++0xEF, 0xB4, 0x06, 0xF3, 0x7F, 0x01, 0x22, 0xF1, 0x8C, 0x90, 0x96, 0x19, 0xF0, 0x90, 0x96, 0x19, ++0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x21, 0x12, 0xC1, 0x14, 0xC3, 0x9D, 0x50, 0x03, 0x7F, 0x00, ++0x22, 0x90, 0x96, 0x19, 0xE0, 0xFF, 0x12, 0xC1, 0x14, 0xD3, 0x9D, 0x40, 0x03, 0x7F, 0x01, 0x22, ++0x90, 0x96, 0x19, 0xE0, 0x04, 0xF0, 0x80, 0xD5, 0x7F, 0x00, 0x22, 0xE4, 0xFF, 0x02, 0x35, 0xBE, ++0x90, 0x96, 0x16, 0x12, 0x86, 0x3D, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x12, 0x02, 0x1F, 0xFE, 0x90, ++0x96, 0x13, 0x12, 0x86, 0x3D, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x02, 0x02, 0x1F, 0xE4, 0x90, 0x96, ++0x16, 0xF0, 0xEF, 0x75, 0xF0, 0x40, 0xA4, 0x24, 0x80, 0xF9, 0x74, 0x82, 0x35, 0xF0, 0xFA, 0x7B, ++0x01, 0x90, 0x96, 0x12, 0x12, 0x86, 0x46, 0x12, 0x02, 0x06, 0x90, 0x96, 0x15, 0xF0, 0xA3, 0x74, ++0x1C, 0xF0, 0x90, 0x96, 0x15, 0xE0, 0xFF, 0xA3, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0x21, 0x08, ++0x90, 0x96, 0x12, 0x12, 0x86, 0x3D, 0x8E, 0x82, 0x12, 0xBF, 0xF7, 0x90, 0x96, 0x17, 0xF0, 0xEE, ++0xFD, 0x7C, 0x00, 0xF5, 0x82, 0x8C, 0x83, 0xA3, 0xA3, 0x12, 0x02, 0x1F, 0xFE, 0x8D, 0x82, 0x8C, ++0x83, 0xA3, 0x12, 0x02, 0x1F, 0xFD, 0xED, 0xFF, 0x90, 0x96, 0x18, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, ++0x90, 0x96, 0x17, 0xE0, 0x64, 0x01, 0x60, 0x0E, 0xA3, 0xA3, 0xE0, 0x24, 0x03, 0xFF, 0x90, 0x96, ++0x16, 0xE0, 0x2F, 0xF0, 0x80, 0xAC, 0xE4, 0x90, 0x96, 0x1A, 0xF0, 0x90, 0x96, 0x1A, 0xE0, 0xFF, ++0xC3, 0x94, 0x08, 0x50, 0x1A, 0x90, 0x96, 0x16, 0xE0, 0x24, 0x03, 0x31, 0x41, 0x31, 0x37, 0xFF, ++0x90, 0x96, 0x1A, 0xE0, 0x24, 0x20, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0x31, 0x09, 0x80, 0xDC, 0x90, ++0x96, 0x16, 0xE0, 0x24, 0x0B, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x96, 0x12, 0x31, 0x37, 0x90, 0x93, ++0x28, 0xF0, 0x70, 0x2B, 0x90, 0x96, 0x1A, 0xF0, 0x90, 0x96, 0x1A, 0xE0, 0xFF, 0x24, 0x10, 0xFD, ++0xE4, 0x33, 0xFC, 0x90, 0x96, 0x12, 0x12, 0xBE, 0x50, 0x12, 0x02, 0x1F, 0xFE, 0x74, 0x29, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEE, 0x31, 0x0C, 0xE0, 0xB4, 0x04, 0xDA, 0x22, 0xE4, ++0x90, 0x96, 0x1A, 0xF0, 0x90, 0x96, 0x1A, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x1A, 0x90, 0x96, ++0x16, 0xE0, 0x24, 0x0C, 0x31, 0x41, 0x31, 0x37, 0xFF, 0x90, 0x96, 0x1A, 0xE0, 0x24, 0x29, 0xF5, ++0x82, 0xE4, 0x34, 0x93, 0x31, 0x09, 0x80, 0xDC, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x96, 0x1A, ++0xE0, 0x04, 0xF0, 0x22, 0x7E, 0x00, 0xC3, 0x74, 0x03, 0x9F, 0xFD, 0xE4, 0x9E, 0xFC, 0x90, 0x96, ++0x16, 0x12, 0x86, 0x3D, 0x8D, 0x82, 0x8C, 0x83, 0x12, 0x02, 0x1F, 0xFD, 0xC3, 0x74, 0x03, 0x9F, ++0xFF, 0xE4, 0x9E, 0xFE, 0x90, 0x96, 0x13, 0x12, 0x86, 0x3D, 0x8F, 0x82, 0x8E, 0x83, 0x02, 0x02, ++0x1F, 0xFD, 0xE4, 0x33, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0x90, 0x96, 0x12, ++0x22, 0xE4, 0x90, 0x86, 0xAF, 0x12, 0xA3, 0x77, 0x90, 0x93, 0x01, 0xF0, 0x22, 0x90, 0x00, 0x80, ++0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x91, 0x43, 0x71, 0x75, 0x12, 0x7B, 0x79, ++0x71, 0xBD, 0x31, 0x51, 0x7F, 0x01, 0x12, 0x84, 0x15, 0x90, 0x93, 0x57, 0x74, 0x02, 0xF0, 0xFF, ++0x12, 0x84, 0x15, 0x90, 0x93, 0x57, 0xE0, 0x04, 0xF0, 0x51, 0x61, 0x51, 0xAB, 0x90, 0x00, 0x80, ++0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x75, 0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, ++0x01, 0xA0, 0xE0, 0xB4, 0xFD, 0x05, 0xE4, 0xFF, 0x12, 0x90, 0x49, 0x12, 0xB4, 0xEA, 0x90, 0x00, ++0x81, 0xE0, 0x44, 0x04, 0xFD, 0x7F, 0x81, 0x12, 0x7B, 0x2E, 0x71, 0x61, 0x31, 0xCF, 0x90, 0x00, ++0xAA, 0xE0, 0x44, 0x02, 0xF0, 0xA3, 0xE0, 0x44, 0x80, 0xF0, 0xE4, 0xFF, 0x02, 0x84, 0x9E, 0x7E, ++0x00, 0x7F, 0x0B, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xE1, 0x12, 0x04, 0x80, 0x51, 0x5A, ++0x71, 0x5A, 0xBF, 0x01, 0x1C, 0x90, 0x95, 0x2F, 0xE0, 0xFE, 0x54, 0x01, 0x90, 0x93, 0xE1, 0xF0, ++0xEE, 0x54, 0x04, 0x90, 0x93, 0xE3, 0xF0, 0x90, 0x95, 0x2F, 0xE0, 0x54, 0x08, 0x90, 0x93, 0xE2, ++0xF0, 0x51, 0x5A, 0x7F, 0xFB, 0x12, 0x97, 0x97, 0x70, 0x35, 0x90, 0x95, 0x2F, 0xE0, 0x54, 0x07, ++0x70, 0x15, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x30, 0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, ++0x01, 0x0F, 0x90, 0x95, 0x30, 0x80, 0x03, 0x90, 0x95, 0x2F, 0xE0, 0x54, 0x07, 0x90, 0x93, 0xE5, ++0xF0, 0x90, 0x95, 0x2F, 0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, 0xE4, 0xF0, 0x51, ++0x5A, 0x7F, 0xFD, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, 0x95, 0x2F, 0xE0, 0x54, ++0x0C, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x93, 0xE6, 0xF0, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x2F, ++0x22, 0x12, 0x7B, 0x1B, 0x90, 0x86, 0xB3, 0xEF, 0xF0, 0x51, 0x7B, 0x90, 0x01, 0x64, 0x74, 0x01, ++0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, 0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, 0x75, ++0xE0, 0x91, 0x08, 0x71, 0xDD, 0xE4, 0xF5, 0x21, 0xF5, 0x22, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, ++0x21, 0x7F, 0x50, 0x12, 0x7B, 0x2E, 0xAD, 0x22, 0x7F, 0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, ++0x52, 0x12, 0x7B, 0x2E, 0xAD, 0x24, 0x7F, 0x53, 0x02, 0x7B, 0x2E, 0x71, 0x54, 0x12, 0x7B, 0xDB, ++0x90, 0x8A, 0xC5, 0x12, 0x88, 0xD0, 0x51, 0xCF, 0x71, 0x9E, 0x12, 0x96, 0x54, 0x51, 0xCA, 0x71, ++0x8F, 0x90, 0x8A, 0x73, 0x12, 0xBD, 0x11, 0x02, 0x04, 0x7A, 0x71, 0x82, 0x02, 0x04, 0x80, 0x7B, ++0x00, 0x7A, 0x00, 0x79, 0x00, 0x90, 0x89, 0x2E, 0x12, 0x86, 0x46, 0x7B, 0xFF, 0x7A, 0x80, 0x79, ++0x80, 0x90, 0x89, 0x31, 0x12, 0x86, 0x46, 0x7A, 0x80, 0x79, 0xBF, 0x90, 0x89, 0x34, 0x12, 0x86, ++0x46, 0x7A, 0x81, 0x79, 0x61, 0x90, 0x89, 0x3A, 0x12, 0x86, 0x46, 0x7A, 0x81, 0x79, 0x75, 0x90, ++0x89, 0x3D, 0x12, 0x86, 0x46, 0x7A, 0x81, 0x79, 0x9D, 0x90, 0x89, 0x40, 0x12, 0x86, 0x46, 0x71, ++0x6B, 0x7A, 0x81, 0x79, 0xD9, 0x90, 0x89, 0x49, 0x12, 0x86, 0x46, 0x7A, 0x82, 0x79, 0x01, 0x90, ++0x89, 0x4C, 0x12, 0x86, 0x46, 0xE4, 0x90, 0x96, 0x76, 0xF0, 0x90, 0x95, 0x2F, 0xF0, 0x90, 0x95, ++0x2F, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x0F, 0x74, 0x87, 0x2F, 0x71, 0x4C, 0xE4, 0xF0, 0x90, ++0x95, 0x2F, 0xE0, 0x04, 0xF0, 0x80, 0xE7, 0x22, 0x74, 0x87, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, ++0x96, 0xF5, 0x83, 0x22, 0xE4, 0xFD, 0xFF, 0x02, 0x6E, 0x71, 0x7F, 0xF9, 0x7E, 0x01, 0x02, 0x5F, ++0xA6, 0x90, 0x01, 0xE4, 0x74, 0x10, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x7A, 0x81, 0x79, 0xB1, 0x90, ++0x89, 0x46, 0x02, 0x86, 0x46, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, ++0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x3B, 0x22, 0x7E, ++0x00, 0x7F, 0x88, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x58, 0x02, 0x04, 0x80, 0x7E, 0x00, ++0x7F, 0x01, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x2C, 0x12, 0x04, 0x80, 0x90, 0x88, 0x2C, ++0xE0, 0x54, 0xFD, 0xF0, 0xE4, 0x12, 0xA3, 0x78, 0xA3, 0x74, 0x0C, 0xF0, 0x22, 0x90, 0x01, 0x8C, ++0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, ++0x54, 0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x75, 0x39, 0x06, ++0x43, 0x39, 0x10, 0x75, 0x3A, 0x01, 0x43, 0x3A, 0x10, 0x75, 0x3B, 0x03, 0x75, 0x3C, 0x62, 0x43, ++0x3C, 0x80, 0x43, 0x3B, 0x04, 0x90, 0x01, 0x38, 0xE5, 0x39, 0xF0, 0xA3, 0xE5, 0x3A, 0xF0, 0xA3, ++0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, 0xF0, 0x22, 0x75, 0x29, 0x12, 0xE4, 0xF5, 0x2A, 0x75, 0x2B, ++0x07, 0x75, 0x2C, 0x32, 0xF5, 0x31, 0x75, 0x32, 0xC1, 0x75, 0x33, 0x0C, 0xF5, 0x34, 0x90, 0x01, ++0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, 0xF0, 0xA3, 0xE5, 0x2C, 0xF0, ++0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, 0xF0, 0xA3, 0xE5, ++0x34, 0xF0, 0x22, 0x90, 0x8A, 0x79, 0x74, 0x87, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE5, ++0x74, 0xC6, 0xF0, 0xA3, 0x74, 0x81, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0xCB, ++0xF0, 0x90, 0x8A, 0xB9, 0x74, 0x88, 0xF0, 0xA3, 0x74, 0xDA, 0xF0, 0x90, 0x8A, 0xFB, 0x74, 0xAE, ++0xF0, 0xA3, 0x74, 0x0D, 0xF0, 0x90, 0x8A, 0xA5, 0x74, 0xAB, 0xF0, 0xA3, 0x74, 0x0D, 0xF0, 0x90, ++0x8A, 0xC3, 0x74, 0xD4, 0xF0, 0xA3, 0x74, 0x0E, 0xF0, 0x90, 0x8A, 0xF3, 0x74, 0xDE, 0xF0, 0xA3, ++0x74, 0x7C, 0xF0, 0x90, 0x8A, 0x85, 0x74, 0x9D, 0xF0, 0xA3, 0x74, 0xF7, 0xF0, 0x90, 0x86, 0x04, ++0x74, 0xDE, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x90, 0x8A, 0xA9, 0x74, 0xDE, 0xF0, 0xA3, 0x74, 0x88, ++0xF0, 0x90, 0x86, 0x0C, 0x74, 0xB0, 0xF0, 0xA3, 0x74, 0x3B, 0xF0, 0x90, 0x8A, 0xEF, 0x74, 0xB0, ++0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x90, 0x86, 0x00, 0x74, 0xE0, 0xF0, 0xA3, 0x74, 0xE5, 0xF0, 0x90, ++0x86, 0x02, 0x74, 0xE1, 0xF0, 0xA3, 0x74, 0x44, 0xF0, 0x90, 0x8A, 0xFD, 0x74, 0xD1, 0xF0, 0xA3, ++0x74, 0x59, 0xF0, 0x90, 0x8A, 0xF9, 0x74, 0xD4, 0xF0, 0xA3, 0x74, 0x3E, 0xF0, 0x90, 0x8A, 0xDB, ++0x74, 0xDD, 0xF0, 0xA3, 0x74, 0x3A, 0xF0, 0x90, 0x8A, 0xAF, 0x74, 0x9C, 0xF0, 0xA3, 0x74, 0x05, ++0xF0, 0x90, 0x8A, 0xD3, 0x74, 0xC9, 0xF0, 0xA3, 0x74, 0x72, 0xF0, 0x90, 0x8A, 0xF5, 0x74, 0xE2, ++0xF0, 0xA3, 0x74, 0x17, 0xF0, 0x90, 0x8A, 0xA3, 0x74, 0xE2, 0xF0, 0xA3, 0x74, 0x75, 0xF0, 0x90, ++0x86, 0x06, 0x74, 0xD3, 0xF0, 0xA3, 0x74, 0x28, 0xF0, 0x22, 0x7D, 0x02, 0x90, 0x01, 0xC4, 0x74, ++0x2A, 0xF0, 0x74, 0xC5, 0xA3, 0xF0, 0x90, 0x93, 0x57, 0xE0, 0xFF, 0xED, 0xC3, 0x9F, 0x50, 0x18, ++0xED, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, ++0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0D, 0x80, 0xDE, 0x74, 0x2A, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, ++0xC5, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x95, 0x89, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, ++0x95, 0x89, 0xE0, 0x64, 0x01, 0xF0, 0x90, 0x93, 0xEA, 0xE0, 0x70, 0x18, 0x90, 0x93, 0xE7, 0xE0, ++0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0x90, 0x95, 0x89, 0xE0, 0x24, 0x66, 0x90, 0x01, 0xC4, 0xF0, ++0x74, 0xC5, 0xA3, 0xF0, 0x12, 0x7C, 0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, 0x9F, 0x90, 0x88, 0x36, ++0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xFF, 0x90, 0x88, 0x38, 0xE0, 0x6F, 0x60, 0x03, 0x12, ++0x9F, 0x1F, 0xC2, 0xAF, 0xB1, 0x2A, 0xBF, 0x01, 0x03, 0x12, 0xB4, 0xCA, 0xD2, 0xAF, 0xB1, 0xC8, ++0x12, 0xAF, 0xEC, 0x12, 0x83, 0x4D, 0x80, 0xA7, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0x93, 0xE7, 0xE0, 0x60, 0x25, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xD1, 0x75, 0xEF, 0x44, ++0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, 0xD1, 0x75, 0x90, 0x92, 0x18, ++0x12, 0x04, 0x31, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, 0x90, 0x93, 0xE2, 0xE0, 0x70, 0x29, ++0x90, 0x07, 0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, 0xF0, 0x90, 0x95, 0x90, 0x74, 0x22, 0xF0, 0x90, ++0x95, 0xB2, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x92, 0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x90, 0x12, 0x90, 0x2E, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x93, 0xEA, 0xE0, 0xFF, 0x70, 0x0A, ++0x90, 0x93, 0xE7, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, ++0xF0, 0x90, 0x01, 0xC5, 0x74, 0xEA, 0xF0, 0xA3, 0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, 0xEF, ++0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, 0x90, 0x93, 0xE7, 0xE0, 0x60, 0x06, 0x90, 0x01, ++0xC4, 0x74, 0x01, 0xF0, 0x90, 0x93, 0xE8, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, 0x8C, 0x12, 0x04, 0x31, 0x90, 0x95, 0x8C, 0x02, 0x04, ++0xB8, 0x8F, 0x0D, 0x7F, 0x02, 0x12, 0x85, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0x45, 0x0D, 0xF0, 0x22, ++0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, ++0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, ++0x74, 0x90, 0xF0, 0x74, 0xC6, 0xA3, 0xF0, 0x12, 0x6C, 0xD6, 0x74, 0x90, 0x04, 0x90, 0x01, 0xC4, ++0xF0, 0x74, 0xC6, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, ++0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, ++0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, ++0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, ++0x74, 0xE0, 0xF0, 0x74, 0xC6, 0xA3, 0xF0, 0x12, 0x75, 0x50, 0xE5, 0x3D, 0x30, 0xE1, 0x03, 0x12, ++0x9F, 0x15, 0xE5, 0x3D, 0x30, 0xE2, 0x03, 0x12, 0x9F, 0x54, 0xE5, 0x3D, 0x30, 0xE4, 0x02, 0xF1, ++0xB4, 0xE5, 0x3D, 0x30, 0xE5, 0x02, 0xF1, 0xB7, 0xE5, 0x3E, 0x30, 0xE0, 0x03, 0x12, 0xD0, 0xC7, ++0xE5, 0x3E, 0x30, 0xE4, 0x02, 0xF1, 0xBA, 0xE5, 0x3F, 0x30, 0xE1, 0x03, 0x12, 0xBB, 0xAF, 0xE5, ++0x3F, 0x30, 0xE0, 0x03, 0x12, 0xD1, 0xB9, 0xE5, 0x3F, 0x30, 0xE4, 0x02, 0xF1, 0xB3, 0xE5, 0x3F, ++0x30, 0xE2, 0x0A, 0x12, 0xD2, 0x0E, 0x90, 0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, 0x40, 0x30, ++0xE1, 0x0B, 0x90, 0x8A, 0xE5, 0x12, 0x90, 0x40, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, 0x40, 0x30, ++0xE4, 0x03, 0x12, 0xA7, 0xA9, 0xE5, 0x40, 0x30, 0xE5, 0x03, 0x12, 0xD2, 0x70, 0xE5, 0x40, 0x30, ++0xE6, 0x03, 0x12, 0xD2, 0xB6, 0xE5, 0x40, 0x30, 0xE7, 0x03, 0x12, 0xD2, 0x50, 0x74, 0xE0, 0x04, ++0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC6, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, ++0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, ++0xD0, 0xE0, 0x32, 0x22, 0x02, 0x34, 0x78, 0x02, 0x8D, 0x6F, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, ++0x0F, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, 0x04, 0x1F, 0xE0, 0x44, 0x40, 0xF0, ++0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, ++0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, ++0xC4, 0x74, 0xD1, 0xF0, 0x74, 0xC7, 0xA3, 0xF0, 0x90, 0x8A, 0x9D, 0x12, 0x88, 0xD0, 0x53, 0x91, ++0xBF, 0x74, 0xD1, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC7, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, ++0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, ++0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, ++0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x27, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0xC8, 0xFF, ++0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, ++0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x05, 0xE4, ++0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0x8F, 0x80, ++0x03, 0x90, 0x8A, 0x87, 0x12, 0x88, 0xD0, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x04, 0xA3, 0xE0, ++0x04, 0xF0, 0x90, 0x88, 0xE7, 0xE0, 0x64, 0x08, 0x70, 0x20, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, ++0x14, 0x12, 0xB4, 0x71, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0xE6, 0xE0, 0x54, 0xFE, 0xF0, ++0xE4, 0xA3, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, 0x12, 0x9C, 0xD1, 0x54, 0x03, 0x30, ++0xE0, 0x13, 0x90, 0x88, 0xE8, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, ++0xF0, 0x90, 0x88, 0xE8, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x88, 0x2E, 0x74, ++0x01, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x75, 0x90, 0x88, 0x4D, 0xE0, 0x04, 0xF0, 0x12, 0x8D, ++0x4F, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, ++0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, ++0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x8D, 0x68, 0x78, 0x18, ++0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0x90, 0x88, ++0x81, 0x12, 0x04, 0x31, 0x90, 0x88, 0x32, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0A, ++0x91, 0x92, 0x74, 0x05, 0xF0, 0x12, 0x6E, 0x2F, 0x31, 0x6A, 0x90, 0x88, 0x32, 0x12, 0xA5, 0xF2, ++0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0xA7, 0x9B, 0x90, 0x8A, 0xE5, ++0x12, 0x90, 0x40, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x93, 0x3B, 0xE0, 0x30, 0xE0, 0x0A, 0x90, ++0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0xA7, 0x9B, 0x22, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFE, ++0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xD3, 0xFE, 0x90, 0x95, 0x2F, 0xF0, ++0x90, 0x88, 0x32, 0x12, 0xA9, 0xA4, 0x30, 0xE0, 0x02, 0x41, 0x38, 0x90, 0x88, 0x31, 0xE0, 0x30, ++0xE0, 0x1C, 0x51, 0x58, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, 0x53, ++0xE0, 0x24, 0x03, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, 0x88, ++0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, 0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, 0x88, ++0x4A, 0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, 0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, 0xF0, ++0x90, 0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, 0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, 0x3E, ++0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, 0x88, ++0x4B, 0x51, 0x44, 0x90, 0x88, 0x4E, 0x51, 0x4D, 0x98, 0x40, 0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, ++0x88, 0x4E, 0x51, 0x44, 0x90, 0x88, 0x3E, 0x51, 0x4D, 0x98, 0x40, 0x04, 0xEF, 0x24, 0x50, 0xF0, ++0x90, 0x88, 0x4E, 0x12, 0xA5, 0xF2, 0xFF, 0x7E, 0x00, 0x90, 0x88, 0x42, 0xEE, 0xF0, 0xA3, 0xEF, ++0xF0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x05, 0xB1, 0xE0, ++0x54, 0xF8, 0x4F, 0xF0, 0x31, 0x6A, 0x80, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x01, 0xF0, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, 0x33, 0xFC, 0x22, 0xE0, 0xD3, 0x9D, ++0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x22, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, 0x22, 0x90, ++0x88, 0x85, 0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x95, 0x2E, 0xE0, 0x24, 0x46, 0xFF, ++0x90, 0x95, 0x2D, 0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, 0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, ++0x12, 0x85, 0xBA, 0x90, 0x88, 0x85, 0x91, 0x66, 0xEF, 0x24, 0x46, 0x91, 0xAC, 0x90, 0x88, 0x89, ++0x91, 0x66, 0x90, 0x88, 0x85, 0x12, 0x9E, 0xEA, 0x50, 0x02, 0x61, 0x4D, 0x90, 0x88, 0x89, 0x12, ++0x86, 0x31, 0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, 0x85, 0xBA, 0x90, 0x95, 0xF1, 0x12, 0x04, ++0x31, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x2B, 0x51, 0x58, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, ++0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, ++0x4E, 0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, 0x00, 0xFA, 0x91, 0x6F, 0xEB, 0x2F, 0xFF, ++0xEA, 0x80, 0x1E, 0x90, 0x88, 0x33, 0x12, 0x9F, 0xE7, 0x30, 0xE0, 0x02, 0x81, 0x4A, 0x91, 0x6F, ++0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, 0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, ++0xED, 0x3E, 0x90, 0x95, 0xED, 0xF0, 0xA3, 0xEF, 0xF0, 0xC3, 0x90, 0x95, 0xEE, 0xE0, 0x94, 0xA0, ++0x90, 0x95, 0xED, 0xE0, 0x94, 0x00, 0x50, 0x35, 0xA3, 0xE0, 0xFB, 0x24, 0xED, 0x91, 0x5D, 0x04, ++0xF0, 0x90, 0x95, 0xF1, 0x12, 0x04, 0xB8, 0xEF, 0x54, 0x7F, 0xFF, 0x74, 0x8D, 0x2B, 0x91, 0x52, ++0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, 0x95, 0xED, 0xA3, 0xE0, 0x91, 0x50, 0xEF, 0xF0, ++0x90, 0x88, 0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, 0x7F, 0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, ++0xE0, 0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, ++0x81, 0x4A, 0xE4, 0xFF, 0xFE, 0x91, 0x5A, 0x2F, 0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, ++0x9D, 0x40, 0x07, 0x90, 0x95, 0xEF, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE6, 0x91, ++0x7A, 0x9C, 0x40, 0x02, 0x80, 0x15, 0x90, 0x95, 0xEF, 0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, ++0x50, 0x13, 0x91, 0x5A, 0x2F, 0xFF, 0x91, 0x7A, 0x9C, 0x40, 0x07, 0x90, 0x95, 0xF0, 0xEE, 0xF0, ++0x80, 0x03, 0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, 0xE0, 0xFF, 0x91, 0x4B, 0xE0, 0xFD, 0xEF, 0xC3, ++0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, 0xF0, 0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x95, ++0xF0, 0xE0, 0x80, 0x18, 0x91, 0x4B, 0xE0, 0xFD, 0xC3, 0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, ++0xF0, 0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, 0x95, 0xF0, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, ++0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, 0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, ++0xF0, 0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, ++0x50, 0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, ++0x88, 0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, 0x88, 0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, ++0x4F, 0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, 0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, ++0x90, 0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0x91, 0x92, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, ++0x8A, 0xA3, 0x12, 0x90, 0x40, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x95, 0xEF, 0xE0, 0xFE, ++0x24, 0x8D, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0x74, 0xED, 0x2E, 0xF5, 0x82, 0xE4, ++0x34, 0x93, 0xF5, 0x83, 0xE0, 0x22, 0x12, 0x04, 0x31, 0x90, 0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, ++0x95, 0xF1, 0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, 0x03, 0xEB, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xC3, ++0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, ++0xE4, 0x22, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x88, 0x4F, 0xE0, 0xFB, 0x90, ++0x92, 0x98, 0x22, 0x90, 0x96, 0xB5, 0x12, 0x04, 0xB8, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, 0xFE, ++0xE4, 0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, 0x90, 0x93, 0x58, 0xE0, 0xFF, 0x20, 0xE0, 0x02, 0xE1, ++0xA5, 0x90, 0x93, 0xD9, 0xE0, 0xFE, 0x20, 0xE0, 0x02, 0xC1, 0x1E, 0x90, 0x93, 0xD7, 0xE0, 0xFD, ++0x90, 0x93, 0xDA, 0xE0, 0xD3, 0x9D, 0x50, 0x02, 0xC1, 0x1E, 0x90, 0x05, 0x58, 0xE0, 0x90, 0x96, ++0xBD, 0xF0, 0xEF, 0x12, 0x8F, 0xD3, 0x54, 0x07, 0xFF, 0x64, 0x02, 0x60, 0x03, 0xEF, 0x70, 0x24, ++0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x1B, 0x90, 0x93, 0xD9, 0xE0, 0x44, 0x40, 0xF0, ++0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x96, 0xBD, 0xE0, 0xFF, 0x90, 0x93, 0xD6, 0xE0, 0x2F, 0x24, ++0xFD, 0x12, 0xA6, 0x10, 0x12, 0x8D, 0x4F, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, ++0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, ++0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, ++0xA3, 0x12, 0x8D, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0x12, 0x86, 0x24, 0x90, 0x96, 0xB1, 0x12, 0x04, 0x31, 0x90, 0x05, 0x65, 0x12, 0x8D, 0x68, ++0xF1, 0xCA, 0x90, 0x05, 0x64, 0x12, 0x8D, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, ++0x06, 0xC0, 0x07, 0x90, 0x05, 0x66, 0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, ++0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, ++0x07, 0xA3, 0x12, 0x8D, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, ++0xD0, 0x00, 0xF1, 0xB6, 0x90, 0x93, 0xD6, 0xE0, 0xFB, 0xE4, 0xFA, 0xF9, 0xF8, 0x90, 0x96, 0xBD, ++0x12, 0x8D, 0x68, 0x12, 0x85, 0xAD, 0xE4, 0xFB, 0x7A, 0x04, 0x12, 0x85, 0xC8, 0x90, 0x96, 0xB1, ++0x12, 0x86, 0x31, 0x12, 0x85, 0xAD, 0x90, 0x96, 0xB9, 0x12, 0xE3, 0x39, 0xF1, 0xD8, 0x50, 0x04, ++0x91, 0xA3, 0xF1, 0xB9, 0xF1, 0xBF, 0x90, 0x05, 0x8B, 0xEF, 0xF0, 0x90, 0x96, 0xB5, 0xF1, 0xAE, ++0x90, 0x05, 0x8A, 0xEF, 0xF0, 0x90, 0x96, 0xB5, 0xF1, 0xA6, 0x90, 0x05, 0x89, 0xEF, 0xF0, 0x90, ++0x96, 0xB5, 0x12, 0xE3, 0x8A, 0x90, 0x96, 0xB9, 0xF1, 0xC2, 0x90, 0x05, 0x87, 0xEF, 0xF0, 0x90, ++0x96, 0xB9, 0xF1, 0xAE, 0x90, 0x05, 0x86, 0xEF, 0xF0, 0x90, 0x96, 0xB9, 0xF1, 0xA6, 0x90, 0x05, ++0x85, 0xEF, 0xF0, 0x90, 0x96, 0xB9, 0x12, 0xE2, 0xD4, 0xE4, 0x90, 0x93, 0xDA, 0xF0, 0x90, 0x93, ++0xD5, 0xE0, 0x20, 0xE0, 0x02, 0xE1, 0xA5, 0x90, 0x93, 0xD9, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, 0x54, ++0x1F, 0x70, 0x02, 0xE1, 0xA5, 0xEF, 0x54, 0xC1, 0xFF, 0xEE, 0x14, 0x54, 0x1F, 0x25, 0xE0, 0x4F, ++0xF0, 0xE0, 0xC3, 0x13, 0x54, 0x1F, 0x60, 0x02, 0xE1, 0xA5, 0x90, 0x05, 0x22, 0xE0, 0x44, 0x40, ++0xF0, 0x90, 0x05, 0x50, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0x05, 0x69, 0x12, 0x8D, 0x68, 0xF1, 0xCA, ++0x90, 0x05, 0x68, 0x12, 0x8D, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, ++0x07, 0x90, 0x05, 0x6A, 0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, ++0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, ++0x12, 0x8D, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, ++0x12, 0x86, 0x24, 0x90, 0x96, 0xB1, 0x12, 0xE3, 0x39, 0x12, 0x04, 0x31, 0x90, 0x05, 0x6D, 0x12, ++0x8D, 0x68, 0xF1, 0xCA, 0x90, 0x05, 0x6C, 0x12, 0x8D, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, ++0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x6E, 0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, ++0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, ++0x06, 0xC0, 0x07, 0xA3, 0x12, 0x8D, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, ++0xD0, 0x01, 0xD0, 0x00, 0xF1, 0xB6, 0x90, 0x96, 0xB1, 0x12, 0x86, 0x31, 0xC0, 0x00, 0xC0, 0x01, ++0xC0, 0x02, 0xC0, 0x03, 0x90, 0x93, 0xD5, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xFF, 0xE4, 0xFC, 0xFD, ++0xFE, 0x12, 0xE3, 0x82, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xAD, 0x90, ++0x96, 0xB1, 0x12, 0x04, 0x31, 0x90, 0x96, 0xB9, 0x12, 0x04, 0xB8, 0x90, 0x96, 0xB1, 0x12, 0x9E, ++0xEA, 0x50, 0x04, 0x91, 0xA3, 0xF1, 0xB9, 0xF1, 0xBF, 0x90, 0x05, 0x67, 0xEF, 0xF0, 0x90, 0x96, ++0xB5, 0xF1, 0xAE, 0x90, 0x05, 0x66, 0xEF, 0xF0, 0x90, 0x96, 0xB5, 0xF1, 0xA6, 0x90, 0x05, 0x65, ++0xEF, 0xF0, 0x90, 0x96, 0xB5, 0x12, 0x04, 0xB8, 0x90, 0x05, 0x64, 0xEF, 0xF0, 0x90, 0x96, 0xB1, ++0xF1, 0xC2, 0x90, 0x05, 0x63, 0xEF, 0xF0, 0x90, 0x96, 0xB1, 0xF1, 0xAE, 0x90, 0x05, 0x62, 0xEF, ++0xF0, 0x90, 0x96, 0xB1, 0xF1, 0xA6, 0x90, 0x05, 0x61, 0xEF, 0xF0, 0x90, 0x96, 0xB1, 0x12, 0x04, ++0xB8, 0x90, 0x05, 0x60, 0xEF, 0xF0, 0x90, 0x05, 0x50, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x05, 0x22, ++0xE0, 0x54, 0xBF, 0xF0, 0x7F, 0x08, 0x12, 0x9F, 0xF5, 0x90, 0x93, 0xD9, 0xE0, 0x54, 0xC1, 0x44, ++0x28, 0xF0, 0x44, 0x01, 0xF0, 0x22, 0x12, 0x04, 0xB8, 0x78, 0x08, 0x02, 0x03, 0xEB, 0x12, 0x04, ++0xB8, 0x78, 0x10, 0x02, 0x03, 0xEB, 0x12, 0x86, 0x24, 0x90, 0x96, 0xB5, 0x02, 0x04, 0x31, 0x90, ++0x96, 0xB5, 0x12, 0x04, 0xB8, 0x78, 0x18, 0x02, 0x03, 0xEB, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, ++0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, 0x12, 0x86, 0x31, 0xD3, 0x02, 0x03, 0xDA, 0x90, ++0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x05, 0x12, 0x97, 0xC8, 0x60, 0x15, 0x90, 0x88, 0x36, 0xE0, ++0x70, 0x04, 0xEF, 0x30, 0xE0, 0x0B, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, 0x03, 0x12, 0xA3, ++0xF2, 0x22, 0x12, 0xA7, 0x68, 0x70, 0x0E, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x08, 0x90, 0x01, 0x57, ++0x11, 0x16, 0x12, 0xA6, 0x06, 0x22, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0x12, 0xA7, ++0x68, 0x70, 0x19, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x13, 0x90, 0x01, 0x57, 0x11, 0x16, 0xF0, 0x90, ++0x88, 0x31, 0xE0, 0x11, 0x3E, 0x54, 0x07, 0x70, 0x03, 0x12, 0x9F, 0x1F, 0x22, 0xEF, 0x54, 0xFB, ++0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, ++0x19, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x13, 0x12, 0xA6, 0xFF, 0x64, 0x02, 0x60, 0x09, 0x90, 0x8A, ++0xE1, 0x12, 0xBD, 0x11, 0x02, 0x04, 0x7A, 0x12, 0x73, 0x8F, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, ++0xBF, 0x01, 0x10, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0A, 0x12, 0xA6, 0x7C, 0x54, 0x07, 0x70, 0x03, ++0x12, 0x9F, 0x1F, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x07, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, ++0x12, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x08, 0x12, 0xA7, 0x8F, 0xBF, 0x01, 0x05, 0x80, 0x04, ++0x12, 0x97, 0x42, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x02, 0x60, 0x13, 0x12, 0xA6, 0xFF, 0x60, ++0x0E, 0x12, 0x7A, 0x65, 0xEF, 0x70, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0x11, 0xC0, 0x22, ++0xE4, 0xFD, 0x7F, 0x0C, 0x02, 0x04, 0x7E, 0x31, 0x0E, 0x90, 0x96, 0x1B, 0xEF, 0xF0, 0x90, 0x8A, ++0x89, 0x30, 0xE0, 0x13, 0x12, 0x90, 0x40, 0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, ++0x33, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x06, 0x12, 0x90, 0x40, 0x12, 0x97, 0x91, 0x90, 0x96, 0x1B, ++0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, ++0x01, 0x2F, 0x74, 0x80, 0xF0, 0x12, 0xCC, 0x92, 0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0xE4, 0x90, ++0x96, 0x1D, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, 0x90, 0x96, 0x1C, 0xEF, 0xF0, 0x7F, ++0x83, 0x12, 0x7B, 0x41, 0xAE, 0x07, 0x90, 0x96, 0x1C, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, ++0x90, 0x96, 0x1E, 0xE0, 0x94, 0x64, 0x90, 0x96, 0x1D, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, ++0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x96, 0x1C, 0xE0, 0xFF, 0x22, 0x90, 0x96, 0x1D, 0x31, 0x52, ++0x80, 0xC3, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x02, 0xE7, 0xE4, 0x90, 0x96, 0xF1, 0xF0, 0xA3, 0xF0, ++0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, 0xE0, ++0x70, 0x03, 0x7F, 0x01, 0x22, 0x12, 0x9C, 0xD1, 0x54, 0x03, 0x30, 0xE0, 0x15, 0xD3, 0x90, 0x96, ++0xF2, 0xE0, 0x94, 0x03, 0x90, 0x96, 0xF1, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x80, 0x13, 0x7F, 0x01, ++0x80, 0x1B, 0xD3, 0x90, 0x96, 0xF2, 0xE0, 0x94, 0xE8, 0x90, 0x96, 0xF1, 0xE0, 0x94, 0x03, 0x40, ++0x0A, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, ++0x7C, 0x6A, 0x90, 0x96, 0xF1, 0x31, 0x52, 0x80, 0xA7, 0x90, 0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, ++0x4C, 0x90, 0x88, 0x30, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0x88, 0x2F, 0xE0, ++0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x32, 0xEF, 0xC3, 0x13, 0x30, 0xE0, ++0x03, 0x02, 0xB9, 0xC2, 0x12, 0x97, 0xCF, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x08, 0x0C, 0x90, 0x8A, ++0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0x7F, 0x0C, 0x80, 0x10, 0x90, 0x88, 0x30, 0xE0, 0x70, 0x0D, ++0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x2F, 0x90, 0x88, 0xF7, 0xE0, ++0xB4, 0x01, 0x18, 0xA3, 0xE0, 0xB4, 0x01, 0x23, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, 0xFE, ++0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, 0x9C, 0xB4, 0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, 0xB4, ++0x02, 0x09, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE7, 0x12, 0x88, 0xD0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, 0x12, ++0x88, 0xD0, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, 0x88, 0xD0, 0x22, ++0x90, 0x88, 0x31, 0x51, 0xAE, 0x30, 0xE0, 0x32, 0xEF, 0x54, 0xBF, 0x71, 0x14, 0x30, 0xE0, 0x06, ++0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFE, 0x71, 0x1D, 0x74, 0x04, 0xF0, 0x90, 0x88, ++0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, ++0x7D, 0x01, 0x7F, 0x0C, 0x02, 0x04, 0x7E, 0x12, 0x9F, 0x1F, 0x22, 0x90, 0x88, 0x2C, 0xE0, 0xFF, ++0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0x12, 0xA9, 0xA5, 0x30, 0xE0, ++0x1E, 0xEF, 0x54, 0x7F, 0x71, 0x14, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, ++0x54, 0xFD, 0x71, 0x1D, 0x04, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0x9F, 0x1F, 0x90, ++0x88, 0xA1, 0x51, 0xAE, 0x30, 0xE0, 0x22, 0x90, 0x88, 0xA4, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, ++0x18, 0xEF, 0x54, 0xFD, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0xA4, 0x30, 0xE1, 0x06, 0xE0, ++0x44, 0x04, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, 0x03, ++0x12, 0x99, 0xBF, 0x22, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0x32, 0x22, 0xF0, 0x90, 0x01, ++0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0x95, 0x30, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x95, 0x2F, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x71, ++0xFE, 0x90, 0x95, 0x32, 0xF0, 0x12, 0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x95, 0x2F, 0xE0, ++0x90, 0x04, 0x25, 0xF0, 0x90, 0x95, 0x30, 0xE0, 0x60, 0x05, 0x71, 0xF2, 0x44, 0x80, 0xF0, 0xAF, ++0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x71, ++0xF2, 0x54, 0xC0, 0xF0, 0x90, 0x95, 0x32, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x8B, 0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, ++0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x04, 0xF0, 0xAF, 0x05, 0x71, 0xE7, 0xE0, ++0x54, 0x01, 0xFE, 0x90, 0x95, 0x31, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, ++0xFE, 0x71, 0xE7, 0xEE, 0xF0, 0x74, 0x11, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, ++0xFF, 0xF0, 0x74, 0x29, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, ++0x74, 0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, 0x04, ++0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x86, ++0xAD, 0xA3, 0xE0, 0x24, 0x7F, 0xF5, 0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, 0xE0, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x71, 0xFE, 0x90, 0x96, 0xFC, 0xF0, 0xED, 0x90, 0x00, 0x73, 0x70, ++0x0D, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, 0x80, 0x0B, 0xE0, 0x54, ++0xFB, 0xF0, 0x90, 0x00, 0x67, 0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, ++0x22, 0xEF, 0xF0, 0x90, 0x93, 0x01, 0xED, 0xF0, 0x22, 0x7A, 0x00, 0x7D, 0x03, 0x7F, 0x01, 0x90, ++0x01, 0xC6, 0xE0, 0x64, 0x80, 0x70, 0x60, 0x90, 0x95, 0xCC, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xEB, ++0xA3, 0xF0, 0xEA, 0xA3, 0xF0, 0x90, 0x95, 0xC2, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0xD0, 0xF0, ++0xEC, 0xA3, 0xF0, 0x90, 0x95, 0xC4, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0xD2, 0xF0, 0xEC, 0xA3, ++0xF0, 0x90, 0x95, 0xC6, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0xD4, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, ++0x95, 0xC8, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0xD6, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0x95, 0xCA, ++0x74, 0xFE, 0xF0, 0x90, 0x95, 0xEC, 0x74, 0x0C, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xCA, 0x12, ++0x90, 0x2E, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0x7D, 0x05, 0x7F, 0x04, 0x80, 0x91, 0x7D, 0x05, ++0x7F, 0x01, 0x80, 0x8B, 0x7A, 0x00, 0x7D, 0x01, 0x7F, 0x01, 0x80, 0x83, 0x7A, 0x00, 0xE4, 0xFD, ++0x7F, 0x01, 0x81, 0x4F, 0xE6, 0xFD, 0xAF, 0x67, 0xEF, 0x91, 0xEC, 0xE0, 0x54, 0xF8, 0xF5, 0x75, ++0xED, 0x42, 0x75, 0xEF, 0x91, 0xEC, 0xE5, 0x75, 0xF0, 0x22, 0xE5, 0x67, 0xC4, 0x54, 0xF0, 0x24, ++0x01, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0x7D, 0x07, 0xAF, 0x67, 0xED, 0x30, 0xE0, ++0x22, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x57, 0xB1, 0x4A, 0x90, 0x89, 0x59, 0xB1, 0x4A, 0x90, ++0x89, 0x5B, 0xB1, 0x4A, 0x90, 0x89, 0x5D, 0xB1, 0x4A, 0x90, 0x89, 0x5F, 0x12, 0x04, 0x6E, 0xE4, ++0xF0, 0xA3, 0xF0, 0xED, 0x30, 0xE1, 0x0A, 0x75, 0xF0, 0x12, 0xEF, 0xB1, 0x74, 0xE4, 0xF0, 0xA3, ++0xF0, 0xED, 0x30, 0xE2, 0x08, 0x75, 0xF0, 0x12, 0xEF, 0xB1, 0x69, 0xE4, 0xF0, 0xB1, 0x56, 0xE0, ++0x54, 0xBF, 0x44, 0x80, 0xFE, 0xB1, 0x56, 0xEE, 0xF0, 0x22, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, ++0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x22, 0xEF, 0xC4, 0x54, 0xF0, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, ++0x81, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x12, 0xE5, 0x67, 0x90, 0x89, 0x55, 0x02, 0x04, 0x6E, 0x75, ++0xF0, 0x12, 0xE5, 0x67, 0x90, 0x89, 0x53, 0x02, 0x04, 0x6E, 0x90, 0x04, 0x85, 0xE0, 0xF5, 0x70, ++0x90, 0x96, 0x76, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x67, 0x90, 0x88, 0x2B, 0xE0, 0xFF, 0xE5, 0x67, ++0xC3, 0x9F, 0x40, 0x03, 0x02, 0xDC, 0x1F, 0xE5, 0x67, 0x12, 0xAE, 0x00, 0xE0, 0xF5, 0x72, 0x12, ++0xE3, 0x5E, 0xE0, 0x65, 0x72, 0x60, 0x16, 0x90, 0x92, 0x5E, 0xE5, 0x72, 0xF0, 0xE4, 0xA3, 0xF0, ++0xAB, 0x67, 0xFD, 0xFF, 0x12, 0x6F, 0x75, 0x12, 0xE3, 0x5E, 0xE5, 0x72, 0xF0, 0x90, 0x04, 0xA0, ++0xE0, 0x64, 0x01, 0x70, 0x52, 0xA3, 0xE0, 0x65, 0x67, 0x70, 0x4C, 0xA3, 0xE0, 0xF5, 0x68, 0xA3, ++0xE0, 0x90, 0x95, 0xB9, 0xF0, 0xE5, 0x67, 0x12, 0xAE, 0x00, 0xE0, 0x65, 0x68, 0x70, 0x03, 0x02, ++0xDC, 0x1A, 0xE5, 0x67, 0x12, 0xAE, 0x00, 0xE5, 0x68, 0xF0, 0xE5, 0x67, 0x12, 0xAE, 0x93, 0xE0, ++0x54, 0xFC, 0xFF, 0x90, 0x95, 0xB9, 0xE0, 0x54, 0x03, 0x4F, 0xFF, 0xE5, 0x67, 0x12, 0xAE, 0x93, ++0xEF, 0xF0, 0x90, 0x92, 0x5E, 0xE5, 0x68, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0xAB, 0x67, 0xE4, 0xFD, ++0xFF, 0x12, 0x6F, 0x75, 0x02, 0xDC, 0x1A, 0xAF, 0x67, 0x12, 0x78, 0x4A, 0x75, 0xF0, 0x12, 0xE5, ++0x67, 0x12, 0xAB, 0x05, 0x12, 0xA9, 0xA5, 0xFD, 0x12, 0xDD, 0x12, 0xED, 0xF0, 0x90, 0x95, 0xC4, ++0xE4, 0x12, 0xAD, 0xC5, 0xE5, 0x67, 0xF0, 0x12, 0xB2, 0xB5, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, ++0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0xFF, 0x90, 0x95, 0xC8, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0x7B, 0x02, 0x91, 0xCC, 0xB1, 0x6F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xB1, 0x64, 0xE0, ++0xFD, 0x91, 0xEA, 0xE0, 0x54, 0x80, 0xFB, 0x12, 0xDD, 0x12, 0xEB, 0xF0, 0x12, 0xDD, 0x19, 0xED, ++0xF0, 0x90, 0x95, 0xC2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x96, 0x75, 0x12, 0xDC, 0xC3, 0x7B, ++0x03, 0x91, 0xCC, 0xAF, 0x67, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x03, 0x02, 0xDC, 0x1A, 0x75, 0xF0, ++0x12, 0xE5, 0x67, 0x12, 0xAB, 0x05, 0x12, 0xA9, 0xA5, 0x30, 0xE0, 0x03, 0x02, 0xDC, 0x1A, 0xE5, ++0x67, 0x12, 0xB2, 0xB5, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, ++0xFE, 0xEF, 0x5D, 0x4E, 0x60, 0x03, 0x02, 0xDC, 0x1A, 0xB1, 0x6F, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, ++0x70, 0x08, 0xB1, 0x64, 0xE0, 0x70, 0x03, 0x02, 0xDC, 0x1A, 0xE5, 0x67, 0x75, 0xF0, 0x12, 0xA4, ++0x24, 0x57, 0xF9, 0x74, 0x89, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x90, 0x95, 0xB4, 0x12, 0x86, 0x46, ++0x12, 0xE3, 0xC6, 0x12, 0x03, 0x13, 0x2F, 0xFF, 0x12, 0xDD, 0x00, 0x2F, 0xFF, 0x12, 0xDD, 0x06, ++0x2F, 0xFF, 0x12, 0xDD, 0x0C, 0x2F, 0xF5, 0x71, 0xB1, 0x6F, 0xE0, 0xF5, 0x6D, 0xA3, 0xE0, 0xF5, ++0x6E, 0xB1, 0x64, 0xE0, 0xFF, 0x90, 0x95, 0xB7, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xE5, 0x67, 0x12, ++0xAE, 0x00, 0xE0, 0xF5, 0x68, 0x54, 0x80, 0xF5, 0x6A, 0xE5, 0x68, 0x54, 0x7F, 0xF5, 0x69, 0x90, ++0x96, 0x75, 0xE0, 0x60, 0x12, 0x75, 0x73, 0x0A, 0x12, 0xDC, 0x5D, 0xE4, 0x93, 0xC3, 0x13, 0x74, ++0x01, 0x93, 0x13, 0xF5, 0x74, 0x80, 0x0A, 0x7B, 0xFF, 0x12, 0xC3, 0x6B, 0xE4, 0xF5, 0x73, 0xF5, ++0x74, 0x12, 0xDD, 0x28, 0x12, 0xE2, 0xBE, 0x12, 0xE3, 0xC6, 0x90, 0x95, 0xC4, 0x12, 0xE2, 0xC2, ++0x12, 0xDD, 0x00, 0xFF, 0x90, 0x95, 0xC6, 0x12, 0xE2, 0xC2, 0x12, 0xDD, 0x06, 0xFF, 0x90, 0x95, ++0xC8, 0x12, 0xE2, 0xC2, 0x7B, 0x01, 0x91, 0xC4, 0x90, 0x95, 0xB4, 0x12, 0x86, 0x3D, 0x12, 0xDD, ++0x0C, 0x12, 0xE2, 0xBE, 0x90, 0x95, 0xB7, 0xE0, 0xFF, 0xA3, 0xE0, 0x12, 0xDD, 0x31, 0xA3, 0x12, ++0xDD, 0x20, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x7B, 0x02, 0x91, 0xC4, 0x75, 0xF0, 0x12, ++0xE5, 0x67, 0x12, 0xAF, 0xD8, 0xFF, 0xE5, 0x69, 0xD3, 0x9F, 0x40, 0x08, 0x8F, 0x69, 0xE5, 0x69, ++0x45, 0x6A, 0xF5, 0x68, 0x12, 0xDC, 0x51, 0xE0, 0xC3, 0x94, 0x05, 0x40, 0x03, 0x02, 0xD9, 0xFA, ++0xE5, 0x69, 0x90, 0x81, 0x61, 0x93, 0xF5, 0x6F, 0xFD, 0xAF, 0x69, 0x12, 0x60, 0x6F, 0x8F, 0x6F, ++0xE5, 0x6A, 0x60, 0x04, 0x05, 0x6F, 0x05, 0x6F, 0x90, 0x04, 0x8C, 0xE0, 0x64, 0x01, 0x70, 0x28, ++0xE5, 0x69, 0xC3, 0x94, 0x0C, 0x40, 0x21, 0x74, 0x84, 0x25, 0x69, 0xF5, 0x82, 0xE4, 0x34, 0x04, ++0xF5, 0x83, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xEF, 0x30, 0xE7, 0x06, 0xE5, 0x6F, 0x2E, 0xFF, 0x80, ++0x05, 0xC3, 0xE5, 0x6F, 0x9E, 0xFF, 0x8F, 0x6F, 0xE5, 0x6F, 0xD3, 0x94, 0x1A, 0xAF, 0x6F, 0x40, ++0x02, 0x7F, 0x1A, 0x8F, 0x6F, 0x12, 0xA3, 0x69, 0x7B, 0x03, 0xFA, 0x12, 0xD4, 0xC6, 0xE5, 0x68, ++0x90, 0x81, 0xD9, 0x93, 0xFF, 0xD3, 0x90, 0x95, 0xB8, 0xE0, 0x9F, 0x90, 0x95, 0xB7, 0xE0, 0x94, ++0x00, 0x40, 0x02, 0x80, 0x74, 0xC3, 0xE5, 0x6E, 0x94, 0x0A, 0xE5, 0x6D, 0x94, 0x00, 0x40, 0x02, ++0x21, 0x08, 0x12, 0xC3, 0x48, 0xE0, 0xC3, 0x94, 0x01, 0x40, 0x06, 0x12, 0xC3, 0x48, 0xE0, 0x14, ++0xF0, 0x90, 0x95, 0xB4, 0x12, 0x86, 0x3D, 0xB1, 0x0C, 0xFF, 0x90, 0x95, 0xB8, 0xE0, 0x2F, 0xFF, ++0x90, 0x95, 0xB7, 0xE0, 0x35, 0xF0, 0xFE, 0xB1, 0x06, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0xB1, ++0x00, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0xFC, 0xE5, 0x6D, 0xC3, 0x13, 0xFE, 0xE5, 0x6E, 0x13, 0xFF, ++0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x27, 0xE5, 0x67, 0x94, 0x05, 0x50, 0x06, 0x12, 0xC3, 0x48, ++0x74, 0x03, 0xF0, 0x90, 0x95, 0xC2, 0xB1, 0x20, 0xE5, 0x6D, 0xC3, 0x13, 0xA3, 0xF0, 0xE5, 0x6E, ++0x13, 0xA3, 0x91, 0x8A, 0x7B, 0x01, 0x12, 0xD4, 0x49, 0x12, 0xAE, 0xA0, 0x61, 0xEB, 0xB1, 0x28, ++0x65, 0x71, 0x70, 0x02, 0xE5, 0xF0, 0x70, 0x53, 0x90, 0x95, 0xC2, 0xF0, 0xA3, 0xE5, 0x71, 0xF0, ++0xC3, 0x13, 0xFF, 0xA3, 0xE4, 0xF0, 0xA3, 0xEF, 0x91, 0x8A, 0x7B, 0x02, 0x12, 0xD4, 0x49, 0xE5, ++0x67, 0xC3, 0x94, 0x05, 0x50, 0x10, 0x12, 0xC3, 0x48, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x07, 0x12, ++0xA3, 0x64, 0x7B, 0x03, 0x80, 0x0C, 0xE5, 0x71, 0xC3, 0x94, 0x03, 0x50, 0x12, 0x12, 0xA3, 0x64, ++0x7B, 0x04, 0xFA, 0x12, 0xD4, 0x4B, 0x7D, 0x06, 0xAF, 0x67, 0x12, 0xD4, 0xFD, 0x81, 0x1A, 0xE4, ++0xFD, 0xAF, 0x67, 0x12, 0xAC, 0x7C, 0x12, 0xD4, 0xF9, 0x61, 0xEB, 0x12, 0xA3, 0x64, 0x7B, 0x08, ++0xFA, 0x12, 0xD4, 0x4B, 0x91, 0xCE, 0x61, 0xEB, 0x12, 0xC3, 0x48, 0xE4, 0xF0, 0x90, 0x91, 0x6C, ++0x74, 0x02, 0xF0, 0xAB, 0x6F, 0xAD, 0x67, 0xAF, 0x6E, 0xAE, 0x6D, 0x12, 0x41, 0x9C, 0x8E, 0x6B, ++0x8F, 0x6C, 0x91, 0x5D, 0xC3, 0x74, 0x01, 0x93, 0x95, 0x74, 0xFF, 0xE4, 0x93, 0x94, 0x00, 0xFE, ++0xD3, 0xE5, 0x6C, 0x9F, 0xE5, 0x6B, 0x9E, 0x40, 0x34, 0x91, 0x20, 0xE4, 0xF0, 0x7D, 0x01, 0xAF, ++0x67, 0x12, 0xAC, 0x7C, 0x91, 0x5D, 0xC3, 0x74, 0x01, 0x93, 0x95, 0x74, 0xFE, 0xE4, 0x93, 0x94, ++0x00, 0x90, 0x95, 0xC4, 0xF0, 0xA3, 0xCE, 0xF0, 0x90, 0x95, 0xC2, 0xE5, 0x6B, 0xF0, 0xA3, 0xE5, ++0x6C, 0xF0, 0xE4, 0x90, 0x95, 0xC6, 0x12, 0xA3, 0x77, 0x7B, 0x01, 0x80, 0x1F, 0x91, 0x75, 0xC3, ++0xE5, 0x6C, 0x9F, 0xE5, 0x6B, 0x94, 0x00, 0x50, 0x19, 0x91, 0x20, 0xE4, 0xF0, 0x12, 0xAE, 0xA0, ++0x91, 0x6B, 0xB1, 0x19, 0xEF, 0xF0, 0xE4, 0x12, 0xA3, 0x76, 0x7B, 0x02, 0xFA, 0x12, 0xD4, 0xBE, ++0x61, 0xEB, 0x12, 0xD4, 0xF9, 0x91, 0x5D, 0xE4, 0x93, 0xFF, 0x74, 0x01, 0x93, 0xB1, 0x31, 0x91, ++0x6B, 0xB1, 0x12, 0xEF, 0xF0, 0x74, 0xA6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0x91, 0xC1, ++0x7B, 0x03, 0x7A, 0x00, 0x12, 0xD4, 0xBE, 0x91, 0x20, 0xE0, 0x04, 0xF0, 0xE5, 0x69, 0x90, 0x81, ++0xED, 0x93, 0x25, 0x73, 0xFF, 0xE4, 0x33, 0xFE, 0x91, 0x20, 0xE0, 0xC3, 0x9F, 0xEE, 0x64, 0x80, ++0xF8, 0x74, 0x80, 0x98, 0x50, 0x02, 0x61, 0xEB, 0x91, 0x20, 0xE4, 0x91, 0x74, 0x91, 0x5D, 0x74, ++0x01, 0x93, 0x2F, 0xFF, 0xE4, 0x93, 0x34, 0x00, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x67, ++0x12, 0xAD, 0xE5, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x61, 0xEB, 0x91, 0x51, 0xE0, 0x64, 0x05, 0x60, ++0x02, 0x41, 0xBA, 0x90, 0x04, 0xA0, 0xE0, 0x64, 0x02, 0x70, 0x10, 0x91, 0x38, 0xE4, 0xF0, 0x90, ++0x04, 0xA1, 0xE0, 0x78, 0x88, 0xF6, 0x12, 0xD4, 0xD4, 0x61, 0xFF, 0xAD, 0x69, 0xAF, 0x67, 0x12, ++0x72, 0xEE, 0x91, 0xF4, 0xEF, 0xF0, 0x12, 0xD4, 0xEA, 0xE0, 0x54, 0x07, 0x78, 0x88, 0xF6, 0x91, ++0x7D, 0xFF, 0xC3, 0x94, 0x30, 0x40, 0x1C, 0x75, 0xF0, 0x12, 0xE5, 0x67, 0x12, 0xAB, 0x05, 0xFE, ++0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x0B, 0x91, 0xF4, 0xE0, 0x60, 0x06, 0x90, 0x96, 0x75, ++0xE0, 0x60, 0x0A, 0xE4, 0x78, 0x88, 0xF6, 0x91, 0x38, 0xE4, 0xF0, 0x80, 0x56, 0x91, 0xE8, 0xE0, ++0xFE, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEF, 0x12, 0xCA, 0x4E, 0x98, 0x50, 0x1D, 0x91, 0x7D, ++0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEE, 0x12, 0xCA, 0x4E, 0x98, 0x50, 0x0E, 0x91, 0xDC, 0xE0, ++0xB5, 0x69, 0x08, 0x91, 0x45, 0xE0, 0xC3, 0x94, 0x0A, 0x40, 0x23, 0x78, 0x88, 0xE6, 0xFF, 0x70, ++0x04, 0x76, 0x01, 0x80, 0x0C, 0xEF, 0x78, 0x88, 0xB4, 0x01, 0x04, 0x76, 0x03, 0x80, 0x02, 0x76, ++0x05, 0x91, 0x45, 0xE4, 0xF0, 0x91, 0x7D, 0xFF, 0x91, 0xE8, 0xEF, 0xF0, 0x80, 0x05, 0x91, 0x38, ++0xE0, 0x04, 0xF0, 0x91, 0xDC, 0xE5, 0x69, 0xF0, 0x61, 0xE6, 0x91, 0x51, 0xE0, 0x64, 0x06, 0x60, ++0x02, 0x61, 0xEB, 0xF5, 0x6B, 0xF5, 0x6C, 0x12, 0xD4, 0xEA, 0xE0, 0x54, 0x07, 0x78, 0x88, 0xF6, ++0xD3, 0xE5, 0x6E, 0x94, 0xE8, 0xE5, 0x6D, 0x94, 0x03, 0x40, 0x06, 0x78, 0x86, 0x76, 0x05, 0x80, ++0x15, 0xD3, 0xE5, 0x6E, 0x94, 0xFA, 0xE5, 0x6D, 0x94, 0x00, 0x40, 0x06, 0x78, 0x86, 0x76, 0x02, ++0x80, 0x04, 0xE4, 0x78, 0x86, 0xF6, 0xE5, 0x6E, 0xAE, 0x6D, 0x78, 0x86, 0x86, 0x00, 0x08, 0x80, ++0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x82, 0x06, 0xE4, 0x91, 0xD5, 0x90, ++0x95, 0xBA, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x78, 0x87, 0xF6, 0x90, 0x95, 0xB4, 0x12, 0x86, ++0x3D, 0x78, 0x87, 0xE6, 0xFD, 0x75, 0xF0, 0x02, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x03, ++0x3E, 0xAE, 0xF0, 0x78, 0x86, 0x86, 0x00, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, ++0xF9, 0xFF, 0xED, 0x90, 0x82, 0x01, 0x91, 0xD5, 0xEF, 0x25, 0x6C, 0xF5, 0x6C, 0xEE, 0x35, 0x6B, ++0xF5, 0x6B, 0xC3, 0x90, 0x95, 0xBB, 0xE0, 0x95, 0x6C, 0x90, 0x95, 0xBA, 0xE0, 0x95, 0x6B, 0x40, ++0x07, 0x78, 0x87, 0x06, 0xE6, 0xB4, 0x05, 0xB3, 0x78, 0x87, 0xE6, 0xC3, 0x13, 0xF6, 0xFD, 0x08, ++0xE6, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x08, 0xF6, 0xD3, 0x9D, 0x40, ++0x07, 0xE6, 0x79, 0x87, 0x97, 0xF6, 0x80, 0x04, 0xE4, 0x78, 0x89, 0xF6, 0x91, 0x2C, 0xE0, 0xC3, ++0x13, 0xFF, 0x78, 0x89, 0xE6, 0xC4, 0x33, 0x54, 0xE0, 0x2F, 0xFF, 0x91, 0x2C, 0xEF, 0xF0, 0x91, ++0x2C, 0xE0, 0xC3, 0x94, 0xC0, 0x40, 0x05, 0x91, 0x2C, 0x74, 0xC0, 0xF0, 0x91, 0x2C, 0xE0, 0x24, ++0x1F, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x06, 0xCE, 0xA2, 0xE7, 0x13, 0xCE, 0x13, 0xD8, 0xF8, ++0x78, 0x89, 0xF6, 0xE6, 0x25, 0xE0, 0xF6, 0x70, 0x03, 0xFF, 0x80, 0x05, 0x78, 0x89, 0xE6, 0x14, ++0xFF, 0x78, 0x88, 0xA6, 0x07, 0xD3, 0x90, 0x95, 0xB8, 0xE0, 0x94, 0x03, 0x90, 0x95, 0xB7, 0xE0, ++0x94, 0x00, 0x40, 0x02, 0xE4, 0xF6, 0x78, 0x88, 0x12, 0xD4, 0xD4, 0x91, 0x51, 0xE0, 0xFF, 0xD3, ++0x94, 0x05, 0x50, 0x05, 0xEF, 0x04, 0xFF, 0x80, 0x02, 0x7F, 0x00, 0x91, 0x51, 0xEF, 0xF0, 0xE4, ++0xF5, 0x6B, 0xF5, 0x6C, 0x91, 0xCE, 0xE4, 0x90, 0x95, 0xC2, 0xF0, 0x12, 0xA3, 0x72, 0xA3, 0xF0, ++0x7B, 0x01, 0xFA, 0x7D, 0xFF, 0x7F, 0x01, 0x12, 0xD4, 0x4F, 0x05, 0x67, 0x02, 0xD5, 0x89, 0x22, ++0x74, 0xA6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0x4F, 0x25, 0x67, ++0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0x76, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, ++0x8E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0xF6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, ++0x22, 0x74, 0x76, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0xE5, 0x69, 0x25, ++0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0x90, 0x95, 0xC2, 0xE5, 0x6B, ++0xF0, 0xA3, 0xE5, 0x6C, 0xF0, 0xE5, 0x69, 0x90, 0x81, 0x9D, 0x93, 0xFF, 0x22, 0x74, 0xD6, 0x25, ++0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xE0, 0x22, 0xF0, 0x90, 0x95, 0xB4, 0x12, 0x86, ++0x3D, 0x90, 0x00, 0x06, 0x12, 0x03, 0x3E, 0xFF, 0xAE, 0xF0, 0x90, 0x00, 0x08, 0x12, 0x03, 0x3E, ++0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xFE, 0x90, 0x00, 0x04, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xEE, 0x35, ++0xF0, 0x90, 0x95, 0xC6, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x87, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, ++0x96, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x95, 0xC8, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x7D, 0x01, ++0xAF, 0x67, 0x02, 0x61, 0xF7, 0x93, 0xFD, 0x7C, 0x00, 0x02, 0x02, 0x80, 0x74, 0xA6, 0x25, 0x67, ++0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x74, 0x5F, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, ++0x8D, 0xF5, 0x83, 0x22, 0x74, 0xE6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, ++0x90, 0x00, 0x04, 0x02, 0x03, 0x3E, 0x90, 0x00, 0x06, 0x02, 0x03, 0x3E, 0x90, 0x00, 0x08, 0x02, ++0x03, 0x3E, 0x90, 0x95, 0xC6, 0xE4, 0xF0, 0xA3, 0x22, 0x90, 0x95, 0xC4, 0xE4, 0xF0, 0xA3, 0x22, ++0xE5, 0x6D, 0xF0, 0xA3, 0xE5, 0x6E, 0xF0, 0x22, 0x90, 0x95, 0xB4, 0x12, 0x86, 0x3D, 0x02, 0x03, ++0x13, 0x90, 0x95, 0xC4, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xEF, 0x64, 0x13, 0x60, 0x04, 0xEF, ++0xB4, 0x0B, 0x05, 0x90, 0x88, 0xE3, 0x80, 0x1F, 0xEF, 0x64, 0x12, 0x60, 0x04, 0xEF, 0xB4, 0x0A, ++0x05, 0x90, 0x88, 0xE4, 0x80, 0x11, 0xEF, 0x64, 0x11, 0x60, 0x04, 0xEF, 0xB4, 0x09, 0x05, 0x90, ++0x88, 0xE5, 0x80, 0x03, 0x90, 0x88, 0xE2, 0xE0, 0xF5, 0x61, 0xAF, 0x61, 0x22, 0x90, 0x8A, 0x75, ++0x12, 0x88, 0xD0, 0x90, 0x8A, 0xE5, 0x12, 0x90, 0x40, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x01, ++0xCF, 0x12, 0xA7, 0xE6, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, ++0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, ++0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, ++0x03, 0x12, 0x7B, 0x2E, 0x80, 0xFE, 0x22, 0x90, 0x93, 0x58, 0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x93, ++0xD8, 0xE0, 0x60, 0x05, 0x7F, 0x07, 0x12, 0x9F, 0xF5, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x96, 0x8D, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x96, 0x8C, 0xEF, 0xF0, 0xA3, 0xA3, ++0xE0, 0xFD, 0x12, 0x7B, 0xBD, 0x90, 0x96, 0x97, 0x12, 0x04, 0x31, 0x90, 0x96, 0x8F, 0x12, 0x04, ++0xB8, 0x12, 0x03, 0xCD, 0x90, 0x96, 0x97, 0x12, 0x8F, 0xBA, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, ++0xC0, 0x07, 0x90, 0x96, 0x8F, 0x12, 0x04, 0xB8, 0x90, 0x96, 0x93, 0x12, 0x8F, 0xBA, 0xD0, 0x03, ++0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0x90, 0x96, 0x9B, 0x12, 0x04, 0x31, 0x90, ++0x96, 0x8D, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x96, 0x9B, 0x12, 0x04, 0xB8, 0x90, 0x8B, 0x9F, ++0x12, 0x04, 0x31, 0x90, 0x96, 0x8C, 0xE0, 0xFF, 0xD0, 0x05, 0x12, 0x79, 0x53, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0x96, 0x93, 0x12, 0x04, 0x31, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0xB1, 0xCA, ++0x90, 0x96, 0x8F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFE, 0xFD, 0xEF, 0xB4, ++0x01, 0x0D, 0xEB, 0xB4, 0x02, 0x03, 0x0D, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7D, 0x02, 0xAF, ++0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4D, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0xFE, 0xF0, 0x54, ++0xE1, 0xF0, 0x90, 0x88, 0xBD, 0xE0, 0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xBE, 0x12, 0xB0, 0xB7, ++0x12, 0x9B, 0xF9, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x16, 0x90, 0x93, 0x3B, 0xE0, 0x20, 0xE0, 0x0F, ++0x90, 0x86, 0x0C, 0x12, 0x88, 0xD0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x12, 0x97, 0x91, 0x22, ++0x90, 0x95, 0x2F, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xEF, ++0x54, 0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, 0x08, 0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, 0x6F, ++0xF1, 0x5B, 0xF1, 0x54, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, 0x2F, ++0x12, 0xBF, 0x84, 0xE0, 0xFE, 0x74, 0xE5, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0x12, 0xB6, 0xCF, ++0xB4, 0x04, 0xEA, 0x90, 0x96, 0xE6, 0x12, 0x8D, 0x68, 0x12, 0xCF, 0xCA, 0x90, 0x96, 0xE5, 0x12, ++0x8D, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0xE7, ++0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, ++0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x8D, 0x68, 0x78, ++0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0x90, 0x07, 0xC0, 0x74, 0x80, 0xF0, 0x22, 0x90, 0x07, 0xC0, 0xEF, 0xF0, ++0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, ++0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, 0x7E, 0xFF, 0x7F, 0xFF, 0x80, 0x25, 0xF1, 0x5B, 0xF1, ++0x54, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, 0x12, 0xBF, ++0x84, 0xE0, 0xFE, 0x74, 0xC8, 0x2D, 0x12, 0xBF, 0x84, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, ++0x3E, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, ++0xAC, 0x06, 0xEF, 0xF1, 0xCD, 0xF1, 0x54, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, 0x54, ++0x03, 0x24, 0xC8, 0x12, 0xBF, 0x84, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x54, 0xFC, 0x90, ++0x07, 0xC0, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, ++0xFC, 0xFF, 0xF1, 0xCF, 0xE4, 0xFB, 0x90, 0x96, 0xD3, 0x12, 0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, ++0xA4, 0xF9, 0xF8, 0x12, 0x03, 0xEB, 0x74, 0xC4, 0x2B, 0x12, 0xBF, 0x84, 0xEF, 0xF0, 0x0B, 0xEB, ++0xB4, 0x04, 0xE3, 0x90, 0x07, 0xC2, 0x12, 0xB7, 0x4F, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xF7, 0xEE, ++0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xDF, 0xCD, 0x7A, 0x00, 0x90, 0x96, 0xF8, 0xE0, 0x54, 0x03, 0xFB, ++0x70, 0x0A, 0x90, 0x07, 0xC4, 0x11, 0x5C, 0x74, 0x03, 0xF0, 0x80, 0x0E, 0xEB, 0x64, 0x02, 0x4A, ++0x70, 0x15, 0x90, 0x07, 0xC6, 0x11, 0x5C, 0x74, 0x0C, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, ++0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xED, 0xF0, 0xEC, 0xA3, ++0xF0, 0x90, 0x07, 0xC2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xF9, 0xEE, ++0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xDF, 0xCD, 0x11, 0xD1, 0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, 0xF0, ++0x90, 0x07, 0xC2, 0x74, 0x01, 0xF0, 0x80, 0x37, 0xEF, 0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, 0x07, ++0xC5, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x02, 0xF0, 0x80, 0x24, 0x11, 0xD1, 0x64, 0x02, 0x70, ++0x0D, 0x90, 0x07, 0xC6, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, 0x64, ++0x03, 0x4E, 0x70, 0x0B, 0x90, 0x07, 0xC7, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, 0x90, ++0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x7E, 0x00, 0x90, 0x96, 0xFA, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0x12, 0x7A, 0x65, 0xEF, 0x70, ++0x03, 0x12, 0x97, 0x42, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, ++0x30, 0xE0, 0x10, 0x90, 0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x12, 0x75, 0x0F, ++0x10, 0x80, 0x2E, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x0F, 0x01, 0x80, 0x21, ++0x90, 0x88, 0x31, 0x12, 0xA5, 0xF2, 0x30, 0xE0, 0x05, 0x75, 0x0F, 0x02, 0x80, 0x13, 0x90, 0x88, ++0x38, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x0F, 0x08, 0x80, 0x05, 0x12, 0xB7, 0x37, 0x80, ++0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x0F, 0xF0, 0x7F, 0x00, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, ++0xE0, 0x1E, 0x90, 0x88, 0xAF, 0xE0, 0x60, 0x05, 0x75, 0x10, 0x40, 0x21, 0xEE, 0x90, 0x88, 0x38, ++0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x2D, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x7B, 0x80, 0x55, ++0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x10, 0x01, 0x80, 0x71, 0x90, 0x88, 0x3A, ++0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x10, 0x02, 0x80, 0x63, 0x90, 0x88, 0x38, 0xE0, 0xFE, ++0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, 0x10, 0x04, 0x80, 0x54, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x10, ++0x08, 0x80, 0x4B, 0x90, 0x88, 0x3A, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x10, 0x10, 0x80, 0x3F, 0x90, ++0x88, 0x32, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x10, 0x20, 0x80, 0x2F, 0x90, ++0x88, 0x9C, 0xE0, 0x60, 0x05, 0x75, 0x10, 0x80, 0x80, 0x24, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, ++0x05, 0x75, 0x10, 0x11, 0x80, 0x18, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, ++0xFF, 0xBF, 0x80, 0x05, 0x75, 0x10, 0x12, 0x80, 0x05, 0x12, 0xB7, 0x37, 0x80, 0x0E, 0x90, 0x01, ++0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x10, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, 0xF0, 0xA3, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, ++0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x51, 0x69, 0x40, 0x40, 0x90, 0x88, 0x50, 0xE0, 0x04, ++0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, 0x90, 0x88, 0x50, 0xE0, 0xD3, 0x9F, 0x50, 0x2D, 0x90, 0x88, ++0x48, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3F, 0x12, 0xA5, 0xFB, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, ++0x90, 0x88, 0x3E, 0xE0, 0x2F, 0x90, 0x88, 0x4F, 0xF0, 0xFB, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, ++0xE0, 0xFD, 0x90, 0x92, 0x98, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x22, 0x90, 0x88, 0x3F, 0xE0, ++0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, ++0x3F, 0xE0, 0xD3, 0x9F, 0x22, 0xE4, 0xFE, 0x74, 0xED, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, ++0x83, 0xE4, 0xF0, 0x74, 0x8D, 0x2E, 0x12, 0xCC, 0x52, 0x74, 0xFF, 0xF0, 0x0E, 0xEE, 0xB4, 0xA0, ++0xE6, 0xE4, 0x90, 0x88, 0x4D, 0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, 0x88, 0x50, 0xF0, 0xEF, 0xB4, ++0x01, 0x07, 0xA3, 0x74, 0xA0, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xFD, 0xEE, 0x13, 0x13, 0x54, 0x07, ++0xFB, 0x90, 0x93, 0x58, 0xE0, 0xFE, 0xC4, 0x54, 0x0F, 0x90, 0x96, 0xE4, 0xF0, 0x22, 0xFF, 0x90, ++0x95, 0xC2, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x88, 0x32, 0xE0, 0xFF, 0x13, 0x13, ++0x13, 0x54, 0x1F, 0x22, 0x12, 0x04, 0xB8, 0x90, 0x05, 0x84, 0xEF, 0xF0, 0x7D, 0x20, 0xE4, 0xFF, ++0x02, 0x7C, 0x05, 0x90, 0x01, 0x34, 0x74, 0x40, 0xF0, 0xFD, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x43, ++0x64, 0x08, 0x22, 0xE0, 0x54, 0x03, 0x90, 0x92, 0x80, 0xF0, 0x7B, 0x01, 0xAF, 0x61, 0x02, 0x75, ++0x80, 0x90, 0x96, 0x16, 0x12, 0x86, 0x46, 0x7A, 0x93, 0x79, 0x29, 0x12, 0xBF, 0xA7, 0xEF, 0x22, ++0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4E, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x22, 0xE0, 0x54, ++0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x22, 0xE0, 0x90, 0x01, 0xBA, ++0xF0, 0x90, 0x88, 0x38, 0xE0, 0x90, 0x01, 0xBB, 0x22, 0x12, 0x04, 0x31, 0x90, 0x96, 0xB1, 0x12, ++0x04, 0xB8, 0x90, 0x96, 0xB9, 0x22, 0x90, 0x00, 0x03, 0x12, 0x02, 0x1F, 0xC4, 0x13, 0x13, 0x54, ++0x03, 0x22, 0xF0, 0x74, 0xC6, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xB6, ++0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x90, 0x88, 0x2C, 0xE0, 0xC4, 0x13, ++0x22, 0x90, 0x93, 0x58, 0xE0, 0xFE, 0xC3, 0x13, 0x54, 0x07, 0x22, 0x90, 0x95, 0x36, 0xE0, 0x04, ++0xF0, 0x22, 0xFB, 0x7A, 0x04, 0xF9, 0xF8, 0x02, 0x85, 0xC8, 0x12, 0x04, 0xB8, 0x90, 0x05, 0x88, ++0xEF, 0xF0, 0x22, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x22, 0xF0, 0xA3, 0xE4, 0xF0, ++0xA3, 0xE5, 0x76, 0xF0, 0x22, 0x12, 0x02, 0x06, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x88, ++0x2C, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x25, 0xE0, ++0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0x22, 0x90, 0x00, 0x02, 0x12, 0x03, 0x3E, 0xFF, 0x22, 0xF5, 0x82, ++0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x7F, 0xF3, ++0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF2, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF6, 0x7E, 0x01, ++0x02, 0x5F, 0xA6, 0x7F, 0xF5, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF4, 0x7E, 0x01, 0x02, 0x5F, ++0xA6, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0x7D, 0x03, 0x7F, 0x02, 0x02, 0x7C, 0x05, ++0xFC, 0x2A, ++}; ++u32 array_length_mp_8723d_fw_nic = 25650; ++ ++ ++#endif ++ ++void ++ODM_ReadFirmware_MP_8723D_FW_NIC( ++ IN PDM_ODM_T pDM_Odm, ++ OUT u1Byte *pFirmware, ++ OUT u4Byte *pFirmwareSize ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)array_mp_8723d_fw_nic; ++#else ++ ODM_MoveMemory(pDM_Odm, pFirmware, array_mp_8723d_fw_nic, array_length_mp_8723d_fw_nic); ++#endif ++ *pFirmwareSize = array_length_mp_8723d_fw_nic; ++} ++ ++#ifndef LOAD_FW_HEADER_FROM_DRIVER ++u8 array_mp_8723d_fw_wowlan[] = { ++0xD1, 0x23, 0x30, 0x00, 0x10, 0x00, 0x00, 0x00, 0x05, 0x16, 0x18, 0x17, 0x4A, 0x70, 0x02, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x02, 0x87, 0xD0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xBA, 0x0E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xC8, 0x4C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xB9, 0x82, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0xBF, 0xE7, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xC7, 0xF6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, ++0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x83, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, ++0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, ++0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, ++0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, ++0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, ++0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, ++0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, ++0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, ++0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, ++0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, ++0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, ++0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, ++0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, ++0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, ++0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, ++0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x88, 0x60, 0x74, 0x01, 0x93, ++0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, ++0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, ++0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, ++0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, ++0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, ++0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, ++0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, ++0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, ++0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, ++0x04, 0x90, 0x88, 0x60, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, ++0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, ++0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, ++0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x83, 0x4D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, ++0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, ++0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, ++0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, ++0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, ++0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, ++0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, ++0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, ++0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x83, 0x4C, 0x8F, 0xF0, ++0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, ++0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, ++0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, ++0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, ++0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x83, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, ++0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xEF, 0x2B, 0xFF, ++0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, ++0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, ++0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, ++0xFC, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE0, 0xFB, ++0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, ++0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, ++0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, ++0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0xE3, 0xF5, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x6B, 0xDF, ++0xF5, 0x80, 0x67, 0xE3, 0xF5, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x5E, 0xDF, 0xF5, 0x80, 0x5A, ++0x87, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x52, 0xDF, 0xF6, 0x80, 0x4E, 0x87, 0xF0, 0x09, 0xE2, ++0x08, 0xB5, 0xF0, 0x46, 0xDF, 0xF6, 0x80, 0x42, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE0, ++0xA3, 0xB5, 0xF0, 0x36, 0xDF, 0xF6, 0x80, 0x32, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE4, ++0x93, 0xA3, 0xB5, 0xF0, 0x25, 0xDF, 0xF5, 0x80, 0x21, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, ++0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x14, 0xDF, 0xF5, 0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, ++0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x02, 0xDF, 0xF4, 0x02, 0x87, 0x55, 0x80, 0x87, 0x80, ++0xE9, 0x80, 0x90, 0x80, 0xD4, 0x80, 0x3E, 0x80, 0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, 0x80, ++0xB7, 0x80, 0x8D, 0x80, 0xA3, 0x80, 0x51, 0x80, 0x74, 0x80, 0x3C, 0x02, 0x87, 0x61, 0x89, 0x82, ++0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, ++0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x76, 0xDF, ++0xE3, 0xDE, 0xE1, 0x80, 0x70, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, ++0xB5, 0xF0, 0x62, 0xDF, 0xF4, 0x80, 0x5E, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE6, ++0x08, 0xB5, 0xF0, 0x51, 0xDF, 0xF5, 0x80, 0x4D, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, ++0xE2, 0x08, 0xB5, 0xF0, 0x40, 0xDF, 0xF5, 0x80, 0x3C, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, ++0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, 0x2E, 0xDF, 0xF4, 0x80, 0x2A, 0x80, 0x02, 0x80, 0x57, 0x89, ++0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, ++0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x06, 0xDF, ++0xE4, 0xDE, 0xE2, 0x80, 0x00, 0x7F, 0xFF, 0xB5, 0xF0, 0x02, 0x0F, 0x22, 0x40, 0x02, 0x7F, 0x01, ++0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, ++0xC5, 0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xD5, ++0xDF, 0xE5, 0xDE, 0xE3, 0x80, 0xCF, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, ++0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, ++0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xAF, 0xDF, 0xE4, 0xDE, 0xE2, 0x80, 0xA9, 0x88, 0xF0, 0xEF, 0x60, ++0x01, 0x0E, 0x4E, 0x60, 0xAB, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, 0xEB, ++0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x8E, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x86, 0x9D, 0x73, ++0x02, 0x88, 0x0E, 0x02, 0x83, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, ++0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, ++0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, ++0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x88, ++0x53, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, ++0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, ++0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, ++0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, ++0xE7, 0x80, 0xBE, 0x41, 0x9A, 0x49, 0x00, 0x41, 0x99, 0x07, 0x00, 0x41, 0x98, 0x86, 0x00, 0x00, ++0x93, 0xB0, 0xB0, 0xEE, 0xAF, 0x59, 0x90, 0x9A, 0x46, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x85, 0x27, ++0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x90, 0x9A, 0x46, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, ++0x22, 0x12, 0xE5, 0x6B, 0x2E, 0x90, 0x86, 0xB4, 0xD1, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB5, ++0xF1, 0x1A, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB6, 0xF0, 0xF1, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x86, ++0xB7, 0xF0, 0xF1, 0xE2, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB8, 0xD1, 0x1B, 0xFF, 0xED, 0x2F, 0x90, ++0x86, 0xB9, 0x12, 0xE5, 0xB4, 0x90, 0x86, 0xBA, 0xF0, 0x22, 0x90, 0x97, 0x2F, 0x12, 0x85, 0xF7, ++0x90, 0x97, 0x2E, 0xEF, 0xF0, 0x12, 0x86, 0x00, 0x89, 0x35, 0x00, 0x89, 0x39, 0x01, 0x89, 0x3D, ++0x03, 0x89, 0x42, 0x04, 0x89, 0x47, 0x12, 0x89, 0x4C, 0x14, 0x89, 0x51, 0x20, 0x89, 0x55, 0x25, ++0x89, 0x5A, 0x27, 0x89, 0x5F, 0x29, 0x89, 0x64, 0x2A, 0x89, 0x69, 0x60, 0x89, 0x6D, 0x61, 0x89, ++0x72, 0x62, 0x89, 0x77, 0x63, 0x89, 0x7C, 0x64, 0x89, 0x81, 0x65, 0x89, 0x86, 0x66, 0x89, 0x8B, ++0x67, 0x89, 0x90, 0x68, 0x89, 0x95, 0x69, 0x89, 0x9A, 0x6B, 0x89, 0x9F, 0x6C, 0x89, 0xA4, 0x6D, ++0x89, 0xA9, 0x6E, 0x89, 0xAE, 0x6F, 0x89, 0xB3, 0x70, 0x89, 0xBD, 0x80, 0x89, 0xB8, 0x81, 0x89, ++0xC1, 0x82, 0x89, 0xC6, 0x83, 0x89, 0xCB, 0x84, 0x89, 0xD5, 0x86, 0x89, 0xD0, 0x88, 0x89, 0xDA, ++0xC3, 0x00, 0x00, 0x89, 0xDF, 0x31, 0xEF, 0x01, 0x81, 0x31, 0xEF, 0x21, 0xF5, 0x31, 0xEF, 0x02, ++0xE0, 0x29, 0x31, 0xEF, 0x02, 0x95, 0xF2, 0x31, 0xEF, 0x02, 0x90, 0x01, 0x31, 0xEF, 0x02, 0x97, ++0xEA, 0x31, 0xEF, 0xA1, 0x1B, 0x31, 0xEF, 0x02, 0x97, 0xF9, 0x31, 0xEF, 0x02, 0x9F, 0xF1, 0x31, ++0xEF, 0x02, 0xAF, 0xF1, 0x31, 0xEF, 0x02, 0xA7, 0xFB, 0x31, 0xEF, 0x41, 0xC3, 0x31, 0xEF, 0x02, ++0x77, 0x4F, 0x31, 0xEF, 0x02, 0x7C, 0x60, 0x31, 0xEF, 0x02, 0x7A, 0xC6, 0x31, 0xEF, 0x02, 0x5D, ++0x36, 0x31, 0xEF, 0x02, 0x7B, 0xE9, 0x31, 0xEF, 0x02, 0x70, 0x33, 0x31, 0xEF, 0x02, 0x48, 0xC9, ++0x31, 0xEF, 0x02, 0x79, 0xF3, 0x31, 0xEF, 0x02, 0x3F, 0xD4, 0x31, 0xEF, 0x02, 0x51, 0x7B, 0x31, ++0xEF, 0x02, 0x79, 0x30, 0x31, 0xEF, 0x02, 0x57, 0xF2, 0x31, 0xEF, 0x02, 0x74, 0x8D, 0x31, 0xEF, ++0x02, 0x78, 0x9A, 0x31, 0xEF, 0x02, 0x5E, 0x0B, 0x31, 0xEF, 0x02, 0xA6, 0x0B, 0x31, 0xEF, 0xC1, ++0x36, 0x31, 0xEF, 0x02, 0xE5, 0x19, 0x31, 0xEF, 0x02, 0xE5, 0x2F, 0x31, 0xEF, 0x02, 0xE5, 0x78, ++0x31, 0xEF, 0x02, 0xE5, 0xC1, 0x31, 0xEF, 0x02, 0xD4, 0x06, 0x31, 0xEF, 0x02, 0xB0, 0x07, 0x90, ++0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x97, 0x2E, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, ++0x97, 0x2F, 0x02, 0x85, 0xEE, 0x90, 0x97, 0x32, 0x12, 0x85, 0xF7, 0x90, 0x95, 0xD9, 0xE0, 0x70, ++0x0D, 0x51, 0xBD, 0xF1, 0xF9, 0x30, 0xE0, 0x06, 0x90, 0x95, 0xDF, 0x74, 0x01, 0xF0, 0x90, 0x95, ++0xDB, 0xE0, 0x70, 0x12, 0x51, 0xBD, 0x12, 0x02, 0x06, 0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x06, ++0x90, 0x95, 0xE0, 0x74, 0x01, 0xF0, 0x51, 0xBD, 0xD1, 0x14, 0xFF, 0x90, 0x97, 0x36, 0xF0, 0x12, ++0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x51, 0xBD, 0xF1, 0x1B, 0x90, 0x97, 0x37, 0xF0, 0x80, ++0x05, 0x90, 0x97, 0x37, 0xEF, 0xF0, 0x90, 0x97, 0x36, 0xE0, 0x90, 0x97, 0x35, 0xF0, 0x90, 0x97, ++0x37, 0xE0, 0xFE, 0x90, 0x97, 0x35, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x3B, 0x51, 0xBD, 0x12, 0x02, ++0x06, 0x54, 0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, 0x97, 0x35, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, ++0x90, 0x97, 0x35, 0x70, 0x07, 0xE0, 0xFF, 0x12, 0x96, 0xC7, 0x80, 0x05, 0xE0, 0xFF, 0x12, 0x97, ++0x82, 0x90, 0x95, 0xE0, 0xE0, 0x60, 0x08, 0x90, 0x97, 0x35, 0xE0, 0xFF, 0x12, 0x96, 0xC7, 0x90, ++0x97, 0x35, 0xE0, 0x04, 0xF0, 0x80, 0xB7, 0x90, 0x05, 0x5E, 0xE4, 0xF0, 0x90, 0x97, 0x36, 0xE0, ++0x70, 0x1A, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x13, 0x90, 0x86, 0x0C, 0xD1, 0x2C, 0x90, 0x8A, ++0xED, 0xD1, 0x2C, 0x12, 0xBF, 0xC3, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x97, 0x32, ++0x02, 0x85, 0xEE, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xC3, 0x9D, 0x75, 0x48, 0x05, ++0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9D, 0x12, 0x69, 0xF5, 0x51, 0xBD, 0x12, 0x02, 0x06, 0x20, 0xE0, ++0x02, 0x81, 0x4E, 0x90, 0x05, 0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, 0x13, 0x90, 0x88, ++0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x13, 0xD1, 0x14, 0x90, 0x88, ++0x9E, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF1, 0x1A, 0x90, 0x88, 0x9F, 0xF0, 0x80, 0x48, 0xD1, ++0x14, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x14, 0xEF, 0xC3, 0x94, 0x03, 0x50, 0x07, 0x90, 0x88, 0x9E, ++0x74, 0x03, 0x80, 0x0C, 0xD1, 0x14, 0x90, 0x88, 0x9E, 0x80, 0x05, 0x90, 0x88, 0x9E, 0x74, 0x2A, ++0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0xF1, 0x1B, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, ++0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, ++0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, 0xC1, 0x8B, 0x30, 0xE0, 0x3D, 0x90, 0x88, 0x9E, ++0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA6, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0x88, ++0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, 0x13, ++0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, 0x01, ++0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, 0x12, 0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0xF0, 0x51, ++0xBD, 0xF1, 0x13, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x35, 0x90, 0x88, 0x9D, 0xE0, 0xC3, ++0x13, 0x20, 0xE0, 0x05, 0xF1, 0xDA, 0x30, 0xE0, 0x27, 0xF1, 0xF0, 0x30, 0xE0, 0x08, 0x90, 0x88, ++0xDF, 0xE0, 0x60, 0x08, 0x80, 0x0B, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x05, 0x75, 0x0D, 0x01, 0x80, ++0x03, 0xE4, 0xF5, 0x0D, 0x90, 0x8A, 0xF3, 0xB1, 0x12, 0x7D, 0x02, 0xAF, 0x0D, 0x12, 0x04, 0x7E, ++0x90, 0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, ++0x54, 0x07, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0xB1, 0x12, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, ++0x7E, 0x12, 0xF0, 0x40, 0x74, 0x11, 0xF0, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xA5, ++0xE0, 0xB4, 0x01, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x01, 0xF0, 0x80, 0x2B, 0x90, 0x88, 0xA5, 0xE0, ++0xB4, 0x04, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x04, 0xF0, 0x80, 0x1C, 0x90, 0x88, 0xA5, 0xE0, 0xB4, ++0x06, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x02, 0xF0, 0x80, 0x0D, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x07, ++0x06, 0x90, 0x88, 0xB0, 0x74, 0x05, 0xF0, 0xE4, 0x90, 0x88, 0xA5, 0xF0, 0x80, 0x67, 0x51, 0xBD, ++0xF1, 0x13, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x02, 0x80, 0x0D, 0xF1, ++0xF0, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x0E, 0x90, 0x8A, 0xF1, 0xD1, ++0x2C, 0x90, 0x89, 0x04, 0xE0, 0x30, 0xE0, 0x04, 0x7D, 0xAC, 0x80, 0x02, 0x7D, 0x2C, 0x7F, 0x40, ++0x12, 0x7B, 0x2E, 0x51, 0xBD, 0xF1, 0x13, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, ++0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x90, 0x8A, 0xF3, 0xB1, 0x12, 0xAD, 0x0E, 0x7F, ++0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0xB1, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x12, ++0xF0, 0x40, 0x74, 0x43, 0xF0, 0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0x88, 0xAF, ++0xF0, 0x90, 0x88, 0xA0, 0xF1, 0xDA, 0x30, 0xE0, 0x09, 0x90, 0x88, 0xD0, 0xE0, 0x44, 0x02, 0xF0, ++0x80, 0x11, 0x90, 0x8A, 0x97, 0xB1, 0x12, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x88, 0xD0, 0xE0, ++0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, 0xB1, 0x12, 0x7F, 0x03, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, ++0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, 0xA1, 0xE0, 0x54, 0xBF, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, ++0x8A, 0x79, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x12, 0xEF, 0xFA, 0xFF, 0x54, ++0x7F, 0x90, 0x88, 0x36, 0xF0, 0xEF, 0xF1, 0xDB, 0xA3, 0xD1, 0x13, 0xFD, 0x54, 0xF0, 0xC4, 0x54, ++0x0F, 0xFF, 0x90, 0x88, 0x34, 0xE0, 0x54, 0xF0, 0x4F, 0xF0, 0xF1, 0x13, 0xFC, 0x54, 0x01, 0x25, ++0xE0, 0xFF, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, 0x04, 0xC3, 0x13, 0xFF, ++0x90, 0x88, 0x33, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xA3, ++0xE0, 0x54, 0x0F, 0xF1, 0x19, 0x90, 0x88, 0x35, 0xF0, 0xF1, 0xE2, 0xFD, 0x90, 0x8A, 0x89, 0xB1, ++0x12, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x99, 0x07, 0xE0, 0x60, 0x08, 0x12, 0xEF, 0xD8, 0xB1, ++0x12, 0x12, 0xBF, 0xA4, 0x51, 0xBD, 0xD1, 0x1C, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x88, 0x9B, 0x12, ++0xD7, 0xBD, 0xD1, 0x1A, 0xFE, 0x12, 0xEF, 0xC6, 0x90, 0x88, 0x9B, 0x12, 0xD7, 0xA9, 0xD1, 0x1A, ++0xFE, 0x12, 0xEF, 0xCF, 0x90, 0x88, 0x9B, 0xF0, 0xEE, 0x12, 0xF0, 0x30, 0xD1, 0x1A, 0x54, 0x40, ++0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0x90, 0x88, 0x9B, 0xF0, 0x12, 0x97, 0xA2, 0x20, 0xE0, 0x2E, 0xEF, ++0xC3, 0x13, 0x20, 0xE0, 0x0B, 0x75, 0x0E, 0x01, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x0B, 0x80, 0x0E, ++0xE4, 0xF5, 0x0E, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x05, 0xE4, 0xF5, 0x0D, 0x80, 0x03, 0x75, 0x0D, ++0x01, 0x90, 0x8A, 0xF3, 0xB1, 0x12, 0xAD, 0x0E, 0xAF, 0x0D, 0x12, 0x04, 0x7E, 0x51, 0xBD, 0x12, ++0x5C, 0x5F, 0x90, 0x88, 0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFB, 0xF0, ++0x12, 0xD0, 0x4B, 0xF0, 0x90, 0x88, 0x36, 0x12, 0xEE, 0x59, 0x12, 0xBC, 0x46, 0x90, 0x01, 0xBE, ++0xF0, 0x22, 0x4E, 0xF0, 0x90, 0x00, 0x01, 0x02, 0x02, 0x1F, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, ++0x02, 0x1F, 0x7D, 0xFF, 0x7F, 0xFF, 0x12, 0xC4, 0xCF, 0x90, 0x8A, 0xFD, 0xE0, 0xFE, 0xA3, 0xE0, ++0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xEF, 0xFA, ++0x20, 0xE0, 0x05, 0x12, 0xE0, 0x8D, 0xE1, 0x0E, 0x51, 0xBD, 0x12, 0x97, 0x9A, 0x90, 0x93, 0x27, ++0x12, 0xD7, 0xBD, 0x12, 0xA7, 0x17, 0x12, 0xEF, 0xC6, 0x90, 0x93, 0x27, 0xF0, 0xEE, 0x54, 0x08, ++0xFE, 0xEF, 0x54, 0xF7, 0x12, 0xA7, 0x16, 0x12, 0xEF, 0xCF, 0x90, 0x93, 0x27, 0x12, 0xA7, 0x0E, ++0x12, 0xF0, 0x03, 0x90, 0x93, 0x27, 0x12, 0xF0, 0x0C, 0xD1, 0x12, 0x54, 0x80, 0xFF, 0x90, 0x93, ++0x28, 0xE0, 0x54, 0x7F, 0x4F, 0xF0, 0xF1, 0xF9, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, ++0x04, 0xF0, 0x51, 0xBD, 0xF1, 0xF0, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, ++0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x02, 0x08, 0x90, 0x93, 0x28, 0xF1, 0xDA, 0x20, 0xE0, 0x41, 0xD1, ++0x14, 0x54, 0x7F, 0xFF, 0x90, 0x93, 0x28, 0xE0, 0x54, 0x80, 0xF1, 0x19, 0x90, 0x93, 0x29, 0xF0, ++0xF1, 0x13, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x2A, 0x12, 0xE0, 0x49, 0x54, 0xFE, 0xFF, 0xEE, ++0x54, 0x01, 0x4F, 0xF0, 0xF1, 0xE2, 0x54, 0x04, 0xFF, 0x90, 0x93, 0x2B, 0xE0, 0x54, 0xFB, 0x4F, ++0xF0, 0x12, 0xAA, 0x33, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0xA8, 0xDB, ++0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x01, 0x17, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x95, ++0x5F, 0x74, 0x05, 0xF0, 0x12, 0x97, 0xC2, 0x7A, 0x94, 0x79, 0x3E, 0x12, 0x04, 0x80, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x90, 0x00, 0x03, 0x02, 0x02, 0x1F, 0x4F, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x02, ++0x1F, 0x12, 0x02, 0x06, 0x90, 0x06, 0x74, 0xD1, 0x13, 0x90, 0x06, 0x75, 0xF1, 0x1A, 0x90, 0x06, ++0x76, 0xF0, 0xF1, 0x13, 0x90, 0x06, 0x77, 0xF0, 0x90, 0x06, 0x70, 0xEF, 0xF0, 0xA3, 0xE4, 0xF0, ++0xA3, 0x04, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x90, 0x98, ++0x70, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x85, 0xF7, 0x90, 0x98, 0x72, 0x12, 0xC3, 0xA6, ++0x12, 0xEF, 0x17, 0x24, 0x02, 0x12, 0xEF, 0x54, 0x24, 0x04, 0x12, 0xEF, 0x0E, 0x24, 0x03, 0x12, ++0xEF, 0x54, 0x24, 0x08, 0x12, 0xEF, 0x0E, 0x24, 0x04, 0x12, 0xEF, 0x54, 0x24, 0x0C, 0x12, 0xEF, ++0x0E, 0x24, 0x05, 0xF1, 0xE8, 0x7A, 0x98, 0x79, 0x76, 0xF1, 0x21, 0x90, 0x98, 0x71, 0xE0, 0xFD, ++0xB4, 0x02, 0x08, 0x90, 0x98, 0x70, 0xE0, 0x44, 0x48, 0x80, 0x0A, 0xED, 0xB4, 0x04, 0x0A, 0x90, ++0x98, 0x70, 0xE0, 0x44, 0x50, 0x90, 0x98, 0x76, 0xF0, 0x90, 0x98, 0x77, 0x74, 0x80, 0xF0, 0xA3, ++0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0x12, 0xEF, 0x23, 0xF1, 0xE8, 0x7A, 0x98, 0x79, 0x76, 0xF1, 0x21, ++0x90, 0x98, 0x76, 0x74, 0xFF, 0x12, 0x94, 0x38, 0x12, 0xEF, 0x23, 0x04, 0xF1, 0xE8, 0x7A, 0x98, ++0x79, 0x76, 0xF1, 0x21, 0x90, 0x06, 0x72, 0xE4, 0xF0, 0x22, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, ++0x01, 0x22, 0x90, 0x00, 0x04, 0x02, 0x02, 0x1F, 0xFF, 0x90, 0x98, 0x75, 0xF0, 0x7B, 0x01, 0x22, ++0x12, 0x02, 0x06, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x12, 0x02, 0x06, 0x13, 0x13, 0x54, 0x3F, ++0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0x03, 0xF0, 0xBF, 0x01, 0x07, 0x11, 0x14, 0xE4, 0x90, ++0x93, 0x03, 0xF0, 0x22, 0x11, 0xA6, 0x71, 0xA2, 0xBF, 0x01, 0x06, 0x90, 0x97, 0x32, 0xE0, 0xA3, ++0xF0, 0x11, 0xA6, 0x71, 0x9B, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x32, 0xE0, 0x90, 0x97, 0x34, 0xF0, ++0x11, 0xA6, 0x71, 0xA9, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x32, 0xE0, 0x90, 0x97, 0x35, 0xF0, 0x11, ++0xA6, 0x11, 0xAD, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x32, 0xE0, 0x90, 0x97, 0x36, 0xF0, 0x11, 0xA6, ++0x71, 0x94, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x32, 0xE0, 0x90, 0x97, 0x37, 0xF0, 0x90, 0x97, 0x33, ++0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x97, 0x3B, 0xF0, 0x90, 0x97, ++0x37, 0xE0, 0x90, 0x97, 0x3C, 0xF0, 0x90, 0x97, 0x3D, 0x74, 0x12, 0xF0, 0x90, 0x97, 0x5F, 0x74, ++0x05, 0xF0, 0x90, 0x97, 0x3F, 0xEF, 0xF1, 0xBA, 0x90, 0x97, 0x3B, 0xE0, 0x90, 0x97, 0x42, 0xF0, ++0x90, 0x97, 0x3C, 0xE0, 0x90, 0x97, 0x43, 0xF0, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x3D, 0x12, 0x8D, ++0x00, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x32, 0x22, 0x7F, 0xF3, 0x7E, ++0x01, 0x02, 0x5F, 0xA6, 0x90, 0x97, 0x32, 0xEF, 0xF0, 0x51, 0xEC, 0x71, 0xA9, 0xBF, 0x01, 0x08, ++0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x7B, 0xF0, 0x51, 0xEC, 0x71, 0xA2, 0xBF, 0x01, 0x08, 0x90, ++0x97, 0x79, 0xE0, 0x90, 0x97, 0x7C, 0xF0, 0x51, 0xEC, 0x71, 0x9B, 0xBF, 0x01, 0x08, 0x90, 0x97, ++0x79, 0xE0, 0x90, 0x97, 0x7D, 0xF0, 0x51, 0xEC, 0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, ++0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x7E, 0xF0, 0x51, 0xEC, 0x7F, 0xF8, 0x7E, 0x01, ++0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x7F, 0xF0, 0x51, 0xEC, ++0x71, 0x8D, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x80, 0xF0, 0x51, 0xEC, 0x51, ++0xF3, 0x64, 0x01, 0x70, 0x54, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x81, 0xF0, 0x54, 0x07, 0x60, ++0x08, 0x90, 0x97, 0x79, 0xE0, 0x54, 0xE0, 0x70, 0x40, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x7A, 0x7F, ++0xFA, 0x51, 0xF5, 0x64, 0x01, 0x70, 0x32, 0x90, 0x97, 0x79, 0xE0, 0xFC, 0x54, 0x07, 0x70, 0x12, ++0x90, 0x97, 0x81, 0xE0, 0xFE, 0x90, 0x97, 0x7A, 0xE0, 0x54, 0x07, 0xFD, 0xEE, 0x4D, 0x90, 0x97, ++0x81, 0xF0, 0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, 0x97, 0x81, 0xE0, 0xFF, 0x90, 0x97, 0x7A, 0xE0, ++0x54, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x97, 0x81, 0xF0, 0x51, 0xEC, 0x7F, 0xFD, 0x51, 0xF5, 0x64, ++0x01, 0x70, 0x4B, 0x90, 0x97, 0x79, 0xE0, 0xFE, 0x54, 0xCC, 0x90, 0x97, 0x82, 0xF0, 0xEE, 0x54, ++0x0C, 0xFF, 0x60, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x54, 0xC0, 0x70, 0x32, 0xEF, 0x70, 0x16, 0x90, ++0x97, 0x82, 0xE0, 0xFF, 0x90, 0x97, 0x79, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, ++0x4E, 0x90, 0x97, 0x82, 0xF0, 0x90, 0x97, 0x79, 0xE0, 0xFF, 0x54, 0xC0, 0x70, 0x10, 0x90, 0x97, ++0x82, 0xE0, 0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0xEE, 0x4F, 0xF0, 0x51, 0xEC, ++0x7F, 0xF0, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, ++0x83, 0xF0, 0x51, 0xEC, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x97, ++0x79, 0xE0, 0x90, 0x97, 0x84, 0xF0, 0x51, 0xEC, 0x71, 0x94, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, ++0xE0, 0x90, 0x97, 0x85, 0xF0, 0x51, 0xEC, 0x11, 0xAD, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, ++0x90, 0x97, 0x86, 0xF0, 0x51, 0xEC, 0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, ++0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x87, 0xF0, 0x90, 0x97, 0x33, 0x74, 0x19, 0xF0, 0x90, 0x97, ++0x55, 0x74, 0x08, 0xF0, 0x90, 0x97, 0x7B, 0xE0, 0x90, 0x97, 0x35, 0xF0, 0x90, 0x97, 0x7C, 0xE0, ++0x90, 0x97, 0x36, 0xF0, 0x90, 0x97, 0x7D, 0xE0, 0x90, 0x97, 0x37, 0xF0, 0x90, 0x97, 0x7E, 0xE0, ++0x90, 0x97, 0x38, 0xF0, 0x90, 0x97, 0x7F, 0xE0, 0x90, 0x97, 0x39, 0xF0, 0x90, 0x97, 0x80, 0xE0, ++0x90, 0x97, 0x3A, 0xF0, 0x90, 0x97, 0x81, 0xE0, 0x90, 0x97, 0x3B, 0xF0, 0x90, 0x97, 0x82, 0xE0, ++0x90, 0x97, 0x3C, 0xF0, 0x90, 0x97, 0x56, 0x74, 0x1A, 0xF0, 0x90, 0x97, 0x78, 0x74, 0x05, 0xF0, ++0x90, 0x97, 0x83, 0xE0, 0x90, 0x97, 0x58, 0xF0, 0x90, 0x97, 0x84, 0xE0, 0x90, 0x97, 0x59, 0xF0, ++0x90, 0x97, 0x85, 0xE0, 0x90, 0x97, 0x5A, 0xF0, 0x90, 0x97, 0x86, 0xE0, 0x90, 0x97, 0x5B, 0xF0, ++0x90, 0x97, 0x87, 0xE0, 0x90, 0x97, 0x5C, 0xF0, 0x90, 0x97, 0x32, 0xE0, 0xB4, 0x01, 0x17, 0x7B, ++0x01, 0x7A, 0x97, 0x79, 0x33, 0x12, 0xEF, 0xA7, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x56, 0x12, 0x8D, ++0x00, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, 0x46, 0x97, 0x75, 0x47, 0x33, 0x75, ++0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0xF1, 0x8C, 0x75, 0x46, 0x97, 0x75, 0x47, 0x58, ++0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xAA, 0x02, 0x69, 0xF5, 0x7B, 0x01, 0x7A, 0x97, ++0x79, 0x79, 0x22, 0x7F, 0xFB, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xEF, 0x22, 0x7E, 0x00, 0x7F, 0x0B, ++0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xD9, 0x12, 0x04, 0x80, 0x71, 0x86, 0x71, 0x8D, 0xBF, ++0x01, 0x1C, 0x90, 0x97, 0x2E, 0xE0, 0xFE, 0x54, 0x01, 0x90, 0x95, 0xD9, 0xF0, 0xEE, 0x54, 0x04, ++0x90, 0x95, 0xDB, 0xF0, 0x90, 0x97, 0x2E, 0xE0, 0x54, 0x08, 0x90, 0x95, 0xDA, 0xF0, 0x71, 0x86, ++0x51, 0xF3, 0x64, 0x01, 0x70, 0x35, 0x90, 0x97, 0x2E, 0xE0, 0x54, 0x07, 0x70, 0x15, 0x7B, 0x01, ++0x7A, 0x97, 0x79, 0x2F, 0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0F, 0x90, 0x97, ++0x2F, 0x80, 0x03, 0x90, 0x97, 0x2E, 0xE0, 0x54, 0x07, 0x90, 0x95, 0xDD, 0xF0, 0x90, 0x97, 0x2E, ++0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x95, 0xDC, 0xF0, 0x71, 0x86, 0x7F, 0xFD, 0x7E, ++0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, 0x97, 0x2E, 0xE0, 0x54, 0x0C, 0x13, 0x13, 0x54, ++0x3F, 0x90, 0x95, 0xDE, 0xF0, 0x22, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x2E, 0x22, 0x7F, 0xF9, 0x7E, ++0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF2, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF6, 0x7E, 0x01, 0x02, ++0x5F, 0xA6, 0x7F, 0xF5, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF4, 0x7E, 0x01, 0x02, 0x5F, 0xA6, ++0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x12, 0xB8, 0xAA, 0x12, ++0xD8, 0x54, 0x12, 0x7B, 0x79, 0x12, 0xD8, 0x61, 0x91, 0x2D, 0x7F, 0x01, 0x12, 0x84, 0x15, 0x90, ++0x95, 0xCB, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x84, 0x15, 0x90, 0x95, 0xCB, 0xE0, 0x04, 0xF0, 0xB1, ++0x98, 0xB1, 0x10, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x75, ++0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, 0x01, 0xA0, 0xE0, 0xB4, 0xFD, 0x04, 0xE4, 0xFF, 0x11, 0xB4, ++0x12, 0xD8, 0xA7, 0xB1, 0x80, 0x90, 0x00, 0x81, 0xE0, 0x44, 0x04, 0xFD, 0x7F, 0x81, 0x12, 0x7B, ++0x2E, 0xF1, 0xCB, 0x51, 0xFC, 0x90, 0x00, 0xAA, 0xE0, 0x44, 0x02, 0xF0, 0xA3, 0xE0, 0x44, 0x80, ++0xF0, 0x90, 0x97, 0x2D, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x02, 0x84, 0x9E, 0xE4, 0x90, 0x86, ++0xAF, 0x91, 0x38, 0x90, 0x93, 0x01, 0xF0, 0x22, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, ++0xF1, 0xB2, 0xE4, 0x90, 0x95, 0xC5, 0x91, 0x38, 0x90, 0x95, 0x63, 0x91, 0x38, 0xA3, 0x91, 0x38, ++0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x95, 0x75, 0xF0, 0xA3, 0xF0, 0x90, 0x95, 0xB7, 0xF0, 0xA3, 0xF0, ++0x22, 0x7E, 0x00, 0x7F, 0x25, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x24, 0x12, 0x04, 0x80, ++0x90, 0x06, 0x90, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0xE0, 0x7A, 0x91, 0x40, 0x90, 0x86, 0xB3, 0xE0, ++0xFF, 0x64, 0x02, 0x70, 0x29, 0xB1, 0x09, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x43, 0xB1, ++0x07, 0x30, 0xE1, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x41, 0xB1, 0x07, 0x30, 0xE2, 0x02, 0x7E, 0x01, ++0x90, 0x93, 0x42, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, 0x90, 0x02, 0xFB, 0xF0, 0x22, 0xEF, 0x64, ++0x01, 0x70, 0x1D, 0xB1, 0x00, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x43, 0x91, 0xFE, 0x30, ++0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x41, 0x91, 0xFE, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, 0x1F, ++0xF1, 0x93, 0x70, 0x20, 0x91, 0xF7, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x43, 0x91, 0xF5, ++0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x41, 0x91, 0xF5, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x90, ++0x93, 0x42, 0xEF, 0xF0, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, 0x22, 0xEF, 0xF0, ++0x90, 0xFD, 0x70, 0xE0, 0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, 0x7E, 0x00, 0x22, ++0xF1, 0x86, 0x12, 0x7B, 0xDB, 0x12, 0xA4, 0xFA, 0xB1, 0x43, 0x91, 0x61, 0xB1, 0x55, 0xB1, 0x6C, ++0x90, 0x8A, 0x73, 0x12, 0x8E, 0x2C, 0x90, 0x95, 0xE4, 0xE0, 0x54, 0x7F, 0xF0, 0x54, 0xBF, 0xF0, ++0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, 0xE4, 0x90, 0x95, 0xE6, 0xF0, 0x90, 0x95, 0xE4, 0xE0, 0x54, ++0xEF, 0xF0, 0x22, 0xF1, 0xDF, 0x79, 0x08, 0x02, 0x04, 0x80, 0x90, 0x93, 0x24, 0xF1, 0xA2, 0x30, ++0xE0, 0x02, 0x91, 0x40, 0x22, 0x90, 0x95, 0xCC, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0x54, ++0xFB, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xF1, 0xC2, 0x7A, 0x95, ++0x79, 0xD0, 0x12, 0x04, 0x80, 0x90, 0x95, 0xD1, 0x74, 0x08, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x12, 0xBF, 0x48, 0xE4, 0xF0, 0x0F, 0xEF, ++0xB4, 0x08, 0xF6, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x7B, 0x1B, 0x90, 0x86, 0xB3, 0xEF, 0xF0, ++0xB1, 0xB2, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, ++0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, 0x75, 0xE0, 0x12, 0xB8, 0x0D, 0x12, 0xB8, 0x46, 0xE4, 0xF5, ++0x21, 0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x03, 0x05, 0x75, 0x22, 0x08, 0x80, 0x03, 0xE4, 0xF5, 0x22, ++0xE4, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, 0x21, 0x7F, 0x50, 0x12, 0x7B, 0x2E, 0xAD, 0x22, 0x7F, ++0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, 0x52, 0x12, 0x7B, 0x2E, 0xAD, 0x24, 0x7F, 0x53, 0x02, ++0x7B, 0x2E, 0x90, 0x97, 0x32, 0x12, 0x85, 0xF7, 0xB1, 0x6C, 0x12, 0x8A, 0xBD, 0xF1, 0x9A, 0xD1, ++0x39, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x2F, 0x12, 0x8E, 0x14, 0x90, 0x95, 0xD1, 0x12, ++0x8F, 0x1A, 0x90, 0x95, 0xD2, 0xF0, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x04, 0xFE, 0x90, 0x95, 0xD0, ++0xE0, 0x54, 0xFB, 0x4E, 0xF0, 0x12, 0x8F, 0x13, 0x90, 0x95, 0xD3, 0xF0, 0xEF, 0x54, 0x08, 0xFF, ++0x90, 0x95, 0xD0, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x22, 0x90, 0x95, 0xD0, 0xE0, 0x54, 0xFE, 0x22, ++0x90, 0x95, 0xD0, 0xE0, 0x30, 0xE0, 0x77, 0x90, 0x95, 0xD4, 0xE0, 0x04, 0xF0, 0x90, 0x95, 0xD7, ++0xE0, 0x64, 0x01, 0x70, 0x30, 0x90, 0x95, 0xD0, 0xF1, 0xD8, 0x30, 0xE0, 0x28, 0x90, 0x95, 0xD6, ++0xE0, 0x70, 0x22, 0x90, 0x95, 0xD3, 0xE0, 0xFE, 0xA3, 0xE0, 0xC3, 0x9E, 0x40, 0x17, 0xEF, 0x13, ++0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0xD1, 0xBF, 0xD1, 0x39, 0xF0, 0x80, 0x07, 0x12, 0xAA, ++0x79, 0xD1, 0x39, 0xF0, 0x22, 0x90, 0x95, 0xD4, 0xE0, 0xFF, 0x90, 0x95, 0xD1, 0xE0, 0xD3, 0x9F, ++0x50, 0x2C, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x16, 0x90, 0x95, 0xD6, 0xE0, 0x70, 0x10, 0x90, ++0x8A, 0xAF, 0x12, 0x8D, 0x12, 0xF1, 0x72, 0x90, 0x95, 0xCF, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, ++0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0x95, 0xD4, 0xF0, 0x90, 0x95, 0xD6, 0xF0, 0x22, 0xE4, ++0xFD, 0xFF, 0x12, 0x6E, 0x71, 0xE4, 0xFF, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x90, 0x9A, 0x36, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0x12, 0x7D, 0x44, ++0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x12, 0x8E, 0x29, 0x90, 0x9A, 0x37, 0xE0, 0x90, 0x9A, 0x36, 0xB4, ++0x01, 0x07, 0xF1, 0x0F, 0x44, 0x04, 0xF0, 0x80, 0x05, 0xF1, 0x0F, 0x54, 0xFB, 0xF0, 0x90, 0x8A, ++0xF9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, ++0xC4, 0x54, 0xF0, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x95, ++0xD0, 0xE0, 0xFD, 0x30, 0xE0, 0x4B, 0x90, 0x95, 0xD5, 0xE0, 0xFC, 0x60, 0x44, 0xF1, 0xAA, 0x80, ++0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, ++0x60, 0x0B, 0xE4, 0x90, 0x95, 0xD5, 0xF0, 0x90, 0x95, 0xD7, 0x04, 0xF0, 0x22, 0x90, 0x95, 0xD2, ++0xE0, 0xD3, 0x9C, 0x50, 0x14, 0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0xD1, 0xBF, ++0x80, 0x03, 0x12, 0xAA, 0x79, 0xD1, 0x39, 0xF0, 0x22, 0x90, 0x8A, 0xAF, 0x12, 0x8D, 0x12, 0xF1, ++0x72, 0x22, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x95, 0xD5, 0xE0, 0x04, 0xF0, 0x22, ++0xA1, 0x4A, 0xE4, 0xFD, 0xC1, 0xC9, 0xE4, 0xFD, 0xFF, 0x02, 0x6E, 0x71, 0x12, 0x69, 0xF5, 0x75, ++0x45, 0x01, 0x22, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x01, ++0xFE, 0x22, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, ++0x08, 0x22, 0x90, 0x93, 0x24, 0xE0, 0x54, 0xBF, 0xF0, 0x22, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, ++0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x08, 0x7D, 0x00, 0x7B, 0x01, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x10, ++0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x88, 0x32, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x7E, ++0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x22, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, ++0x90, 0x95, 0xE9, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x02, 0x06, 0x90, 0x88, 0x9C, 0xF0, ++0x60, 0x34, 0xA3, 0xE0, 0x20, 0xE0, 0x2F, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0x7F, ++0x04, 0x12, 0x04, 0x7E, 0x11, 0x37, 0x30, 0xE0, 0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, ++0xE0, 0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, ++0x02, 0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, 0x90, 0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xD1, 0xBB, 0xEC, 0x90, 0x99, 0xF9, 0x12, 0x04, 0x31, ++0x90, 0x99, 0xF9, 0x12, 0xD1, 0x0B, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, 0xAD, 0x90, 0x01, 0x01, ++0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, ++0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x12, 0xD1, 0xD5, 0xF0, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, ++0x88, 0x9B, 0x11, 0xE0, 0x30, 0xE0, 0x05, 0x7F, 0x03, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xB8, 0xE0, ++0x20, 0xE0, 0x33, 0x11, 0x37, 0x30, 0xE0, 0x2E, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x07, 0xE4, 0x90, ++0x99, 0xF7, 0xF0, 0x80, 0x06, 0x90, 0x99, 0xF7, 0x74, 0x01, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, ++0x90, 0x99, 0xF8, 0x30, 0xE0, 0x05, 0x74, 0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0x99, ++0xF7, 0x12, 0xD1, 0xB2, 0x51, 0x4F, 0x12, 0xD1, 0xC7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x2F, 0x90, ++0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x66, 0x33, 0x90, 0x88, 0x3E, ++0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xE4, 0xF5, 0x10, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, ++0x21, 0x75, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x7C, 0x12, 0xEF, 0x2C, 0x12, 0xF0, 0x38, 0x60, ++0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, ++0x60, 0x06, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xA3, ++0xF0, 0x80, 0x00, 0x75, 0x10, 0x01, 0xE5, 0x10, 0x60, 0x4B, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, ++0x09, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0x12, 0xBE, 0xAD, 0x12, 0xBF, 0xB3, 0x90, 0x88, 0x3F, ++0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x11, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x11, 0xDD, 0xFF, 0xA3, ++0xE0, 0x11, 0xCE, 0xFF, 0xA3, 0xE0, 0x80, 0x0D, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x11, 0xDD, 0xF1, ++0x5D, 0x11, 0xCE, 0xF1, 0x5D, 0x2F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4F, 0xF0, 0x90, ++0x8A, 0xD7, 0x12, 0x8E, 0x2C, 0x22, 0x90, 0x97, 0xB5, 0xED, 0xF0, 0xA3, 0xEB, 0xF1, 0x53, 0xE4, ++0x90, 0x97, 0xB8, 0xF0, 0x51, 0x7B, 0xEF, 0x54, 0x0C, 0x64, 0x08, 0x60, 0x02, 0x41, 0x19, 0x51, ++0x1F, 0xA3, 0xE0, 0x24, 0x06, 0xFD, 0x90, 0x8A, 0xE9, 0x51, 0x4F, 0xEF, 0x64, 0x88, 0x70, 0x79, ++0x51, 0x1F, 0xA3, 0xE0, 0x24, 0x07, 0xFD, 0x90, 0x8A, 0xE9, 0x51, 0x4F, 0xEF, 0x64, 0x8E, 0x70, ++0x68, 0x90, 0x97, 0xB8, 0x04, 0xF0, 0x51, 0x1F, 0xF1, 0x67, 0x2D, 0x04, 0xFD, 0x90, 0x8A, 0xE9, ++0x51, 0x4F, 0xEF, 0x64, 0x03, 0x70, 0x52, 0x51, 0x1F, 0xF1, 0x67, 0x2D, 0x24, 0x06, 0xFD, 0x90, ++0x8A, 0xE9, 0x51, 0x4F, 0xEF, 0x30, 0xE3, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x01, 0x80, 0x38, 0x90, ++0x93, 0x24, 0x11, 0xE0, 0x30, 0xE0, 0x22, 0x90, 0x95, 0xB9, 0xE0, 0x64, 0x02, 0x70, 0x11, 0x90, ++0x93, 0x25, 0x11, 0xE0, 0x30, 0xE0, 0x02, 0x80, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x02, 0x80, 0x17, ++0x51, 0x1F, 0xA3, 0xE0, 0xFD, 0x51, 0x8B, 0x80, 0x10, 0x90, 0x93, 0x27, 0x12, 0xC1, 0x8E, 0x30, ++0xE0, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x02, 0xF1, 0x4A, 0x90, 0x97, 0xB8, 0xE0, 0xFF, 0x22, 0x90, ++0x97, 0xB3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x86, 0xB6, 0xE0, 0xFF, 0x90, 0x9A, 0x20, ++0xE0, 0xFB, 0x90, 0x92, 0x13, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x9A, 0x21, ++0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x9A, 0x1F, 0xE0, 0xFF, 0x90, 0x8A, 0x95, 0xE0, ++0xFA, 0xA3, 0xE0, 0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, 0x90, 0x97, 0xB5, 0xE0, 0xFD, ++0x90, 0x97, 0xB4, 0xE0, 0x2D, 0xFD, 0x90, 0x97, 0xB3, 0xE0, 0x34, 0x00, 0xCD, 0x24, 0x10, 0xCD, ++0x34, 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0x90, 0x8A, 0xE9, 0xE0, 0xFC, ++0xA3, 0xE0, 0xF5, 0x82, 0x8C, 0x83, 0xE4, 0xFD, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xEF, 0x44, 0x08, 0xF0, 0xED, 0x2F, 0xFF, 0xE4, 0x3E, ++0xFE, 0x7C, 0x00, 0xEF, 0x24, 0x08, 0xFF, 0xEC, 0x3E, 0x90, 0x97, 0xBC, 0xF0, 0xA3, 0xEF, 0xF0, ++0x7E, 0x00, 0x7F, 0xE3, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0x35, 0x12, 0x04, 0x80, 0x90, ++0x97, 0xBD, 0xE0, 0x24, 0x01, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x36, 0xEF, 0xF0, 0x90, 0x97, ++0xBD, 0xE0, 0x24, 0x04, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x39, 0xEF, 0xF0, 0x90, 0x97, 0xBD, ++0xE0, 0x24, 0x05, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x3A, 0xEF, 0xF0, 0x90, 0x97, 0xBD, 0xE0, ++0x24, 0x06, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x3B, 0xEF, 0xF0, 0x90, 0x97, 0xBD, 0xE0, 0x24, ++0x07, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x3C, 0xEF, 0xF0, 0x90, 0x97, 0xBD, 0xE0, 0x24, 0x08, ++0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x3D, 0xEF, 0xF0, 0xE4, 0x90, 0x97, 0xBB, 0xF0, 0xF1, 0x3C, ++0x94, 0x08, 0x50, 0x1C, 0x90, 0x97, 0xBD, 0xE0, 0x24, 0x09, 0xFD, 0x90, 0x97, 0xBC, 0xE0, 0x51, ++0x70, 0x90, 0x97, 0xBB, 0xE0, 0x24, 0x3E, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x44, 0x80, 0xDE, ++0xE4, 0x90, 0x97, 0xBB, 0xF0, 0xF1, 0x3C, 0x94, 0x02, 0x50, 0x1C, 0x90, 0x97, 0xBD, 0xE0, 0x24, ++0x61, 0xFD, 0x90, 0x97, 0xBC, 0xE0, 0x51, 0x70, 0x90, 0x97, 0xBB, 0xE0, 0x24, 0x96, 0xF5, 0x82, ++0xE4, 0x34, 0x94, 0xB1, 0x44, 0x80, 0xDE, 0xE4, 0x90, 0x97, 0xBB, 0xF0, 0xF1, 0x3C, 0x94, 0x10, ++0x50, 0x1C, 0x90, 0x97, 0xBD, 0xE0, 0x24, 0x31, 0xFD, 0x90, 0x97, 0xBC, 0xE0, 0x51, 0x70, 0x90, ++0x97, 0xBB, 0xE0, 0x24, 0x66, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x44, 0x80, 0xDE, 0xE4, 0x90, ++0x97, 0xBB, 0xF0, 0x90, 0x94, 0x97, 0xE0, 0xFF, 0x90, 0x97, 0xBB, 0xE0, 0xFE, 0xC3, 0x9F, 0x50, ++0x1F, 0x90, 0x97, 0xBD, 0xE0, 0x24, 0x63, 0xFD, 0x91, 0x06, 0xFC, 0xEE, 0x7E, 0x00, 0x2D, 0x51, ++0x77, 0x90, 0x97, 0xBB, 0xE0, 0x24, 0x98, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x44, 0x80, 0xD3, ++0x90, 0x94, 0x3A, 0x12, 0xE7, 0xB1, 0x90, 0x97, 0xB9, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x30, 0xE3, ++0x0D, 0x7F, 0x01, 0x12, 0xAA, 0x81, 0x90, 0x01, 0xC7, 0x74, 0x03, 0xF0, 0x80, 0x20, 0x7E, 0x00, ++0x90, 0x97, 0xBA, 0xE0, 0x54, 0x07, 0xFF, 0x64, 0x01, 0x60, 0x05, 0xEF, 0x64, 0x02, 0x70, 0x0E, ++0xE4, 0xFD, 0x12, 0xCE, 0x5F, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xF7, 0x44, 0x10, 0xF0, 0x7F, 0x00, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFF, 0x90, 0x97, 0xBC, 0xE0, 0x34, 0x00, 0x22, 0xF1, 0x54, 0xA3, ++0xED, 0xF0, 0xF1, 0xE8, 0x7A, 0x80, 0x79, 0x80, 0xF1, 0xB7, 0x78, 0xC2, 0x7C, 0x97, 0x7D, 0x01, ++0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x86, 0xF1, 0xB0, 0x78, 0xC6, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, ++0x7A, 0x80, 0x79, 0x8A, 0xF1, 0xB0, 0xE4, 0x90, 0x97, 0xCB, 0xF0, 0xB1, 0x5A, 0xCF, 0x24, 0x06, ++0xCF, 0x34, 0x00, 0x51, 0x7A, 0xEF, 0x64, 0x08, 0x60, 0x02, 0xA1, 0x3E, 0xB1, 0x5A, 0xCF, 0x24, ++0x07, 0xCF, 0x34, 0x00, 0x51, 0x7A, 0xEF, 0x64, 0x06, 0x60, 0x02, 0xA1, 0x3E, 0x90, 0x97, 0xCB, ++0x04, 0xF0, 0xE4, 0x90, 0x97, 0xCA, 0xF0, 0x12, 0xF0, 0x1E, 0x50, 0x16, 0x90, 0x97, 0xB4, 0xE0, ++0x24, 0x0A, 0xFD, 0x90, 0x97, 0xB3, 0xE0, 0x51, 0x70, 0x90, 0x97, 0xCA, 0xF1, 0xDF, 0xB1, 0x4F, ++0x80, 0xE5, 0x78, 0xB6, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x34, 0x12, 0xF0, ++0x27, 0x60, 0x02, 0xA1, 0x3E, 0x90, 0x97, 0xCA, 0xF0, 0x12, 0xF0, 0x15, 0x50, 0x18, 0xF1, 0x30, ++0xB1, 0x65, 0xCD, 0x24, 0x20, 0x51, 0x6F, 0x90, 0x97, 0xCA, 0xE0, 0x24, 0xC6, 0xF5, 0x82, 0xE4, ++0x34, 0x97, 0xB1, 0x4F, 0x80, 0xE3, 0x78, 0xC6, 0x7C, 0x97, 0x12, 0xE4, 0xC8, 0xEF, 0x70, 0x75, ++0x90, 0x06, 0x30, 0xE0, 0x44, 0x01, 0x54, 0xDF, 0xF0, 0x90, 0x93, 0x26, 0xE0, 0x30, 0xE0, 0x02, ++0x80, 0x0F, 0x90, 0x95, 0xB9, 0xE0, 0xB4, 0x02, 0x11, 0x90, 0x93, 0x25, 0x11, 0xE0, 0x20, 0xE0, ++0x09, 0x90, 0x01, 0xC7, 0x74, 0x09, 0xF1, 0x4A, 0x80, 0x54, 0xE4, 0x90, 0x97, 0xCA, 0xF0, 0x12, ++0xF0, 0x1E, 0x50, 0x0B, 0x51, 0x5B, 0x90, 0x97, 0xCA, 0xF1, 0xCD, 0xB1, 0x4F, 0x80, 0xF0, 0xE4, ++0x90, 0x97, 0xCA, 0xF0, 0x12, 0xF0, 0x15, 0x50, 0x18, 0xF1, 0x30, 0xB1, 0x65, 0xCD, 0x24, 0x16, ++0x51, 0x6F, 0x90, 0x97, 0xCA, 0xE0, 0x24, 0xC2, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xB1, 0x4F, 0x80, ++0xE3, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xBC, 0x12, 0xCF, 0xC2, 0xA3, 0xF0, 0x7A, 0x97, 0x79, 0xC2, ++0x12, 0xC3, 0xB0, 0x80, 0x09, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x21, 0x54, 0xEF, 0xF0, 0x90, 0x97, ++0xCB, 0xE0, 0xFF, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xBB, 0xE0, 0x04, 0xF0, 0x22, 0xF5, ++0x83, 0xEF, 0xF0, 0x90, 0x97, 0xCA, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x97, 0xB5, 0xE0, 0xFF, 0x90, ++0x97, 0xB4, 0xE0, 0x2F, 0xFF, 0x90, 0x97, 0xB3, 0xE0, 0x34, 0x00, 0x22, 0xF1, 0x54, 0xA3, 0xED, ++0xF0, 0x78, 0xB6, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x94, 0xF1, 0xB7, 0xF1, ++0xE8, 0x7A, 0x80, 0x79, 0x9A, 0xF1, 0xBE, 0x78, 0xCC, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, ++0x80, 0x79, 0xAA, 0xF1, 0xBE, 0xE4, 0x90, 0x97, 0xDF, 0xF0, 0x51, 0x1F, 0xA3, 0xE0, 0xFD, 0xF1, ++0x7C, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xE1, 0x2A, 0xB1, 0x5A, 0xCF, 0x24, 0x0E, 0xCF, 0x34, 0x00, ++0x51, 0x7A, 0xEF, 0x64, 0x3A, 0x60, 0x02, 0xE1, 0x2A, 0xB1, 0x5A, 0xCF, 0x24, 0x30, 0xCF, 0x34, ++0x00, 0x51, 0x7A, 0xEF, 0x64, 0x87, 0x60, 0x02, 0xE1, 0x2A, 0x90, 0x97, 0xDF, 0x04, 0xF0, 0xE4, ++0x90, 0x97, 0xDC, 0xF0, 0xF1, 0x43, 0x94, 0x10, 0x50, 0x18, 0xF1, 0x30, 0xB1, 0x65, 0xCD, 0x24, ++0x38, 0x51, 0x6F, 0x90, 0x97, 0xDC, 0xE0, 0x24, 0xCC, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF1, 0x71, ++0x80, 0xE2, 0xE4, 0x90, 0x97, 0xDD, 0xF0, 0x90, 0x97, 0xDD, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, ++0x02, 0xE1, 0x2A, 0x75, 0xF0, 0x38, 0xEF, 0xF1, 0xC5, 0x20, 0xE0, 0x02, 0xE1, 0x2A, 0xE4, 0x90, ++0x97, 0xDE, 0xF0, 0xF1, 0xD6, 0x90, 0x93, 0x5E, 0x12, 0x04, 0x6E, 0xE0, 0xFE, 0x90, 0x97, 0xDE, ++0xE0, 0xC3, 0x9E, 0x40, 0x02, 0xE1, 0x22, 0xEF, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x75, 0xF9, 0x74, ++0x93, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xE0, 0x75, 0xF0, 0x10, 0xA4, 0x29, 0xF9, 0xEA, 0x35, 0xF0, ++0xFA, 0x78, 0xCC, 0x7C, 0x97, 0x12, 0xEF, 0xE4, 0x60, 0x02, 0xE1, 0x13, 0x90, 0x06, 0x33, 0xE0, ++0x44, 0x01, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x97, 0xDC, 0xF0, 0xF1, 0x43, 0x94, 0x06, 0x50, 0x12, ++0xF1, 0x30, 0xB1, 0x65, 0xCD, 0x24, 0x4A, 0x51, 0x6F, 0x90, 0x97, 0xDC, 0xF1, 0xDF, 0xF1, 0x71, ++0x80, 0xE8, 0xE4, 0x90, 0x97, 0xDC, 0xF0, 0xF1, 0x43, 0x94, 0x10, 0x50, 0x0B, 0x51, 0x5B, 0x90, ++0x97, 0xDC, 0xF1, 0xCD, 0xF1, 0x71, 0x80, 0xEF, 0xF1, 0xD6, 0xF1, 0xC5, 0xFE, 0xC3, 0x13, 0x30, ++0xE0, 0x2C, 0xEF, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x65, 0xF9, 0x74, 0x93, 0x35, 0xF0, 0xFA, 0x7B, ++0x01, 0x78, 0xBC, 0x7C, 0x97, 0x12, 0xEF, 0xE4, 0x70, 0x70, 0x90, 0x95, 0xB9, 0xE0, 0xB4, 0x02, ++0x0B, 0x90, 0x93, 0x25, 0x12, 0xA6, 0x03, 0x20, 0xE0, 0x1D, 0x80, 0x12, 0x80, 0x19, 0x90, 0x95, ++0xB9, 0xE0, 0xB4, 0x02, 0x12, 0x90, 0x93, 0x25, 0x12, 0xA6, 0x03, 0x20, 0xE0, 0x09, 0x90, 0x01, ++0xC7, 0x74, 0x0A, 0xF1, 0x4A, 0x80, 0x53, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xB6, 0x90, 0x97, 0xE3, ++0x12, 0x85, 0xF7, 0x7A, 0x97, 0x79, 0xCC, 0x90, 0x97, 0xE6, 0x12, 0x85, 0xF7, 0x90, 0x97, 0xDD, ++0xE0, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x5F, 0xF9, 0x74, 0x93, 0x35, 0xF0, 0xFA, 0x90, 0x97, 0xE9, ++0x12, 0x85, 0xF7, 0xE4, 0x90, 0x97, 0xEC, 0xF0, 0xA3, 0xF0, 0x7A, 0x97, 0x79, 0xBC, 0x12, 0xC2, ++0x04, 0x80, 0x07, 0x90, 0x06, 0x33, 0xE0, 0x44, 0x05, 0xF0, 0x90, 0x97, 0xDE, 0xE0, 0x04, 0xF0, ++0xC1, 0x13, 0x90, 0x97, 0xDD, 0xE0, 0x04, 0xF0, 0xA1, 0xF7, 0x90, 0x97, 0xDF, 0xE0, 0xFF, 0x22, ++0x90, 0x97, 0xB5, 0xE0, 0xFD, 0x90, 0x97, 0xB4, 0xE0, 0x2D, 0xFD, 0x22, 0x90, 0x97, 0xBB, 0xE0, ++0xFF, 0xC3, 0x22, 0x90, 0x97, 0xDC, 0xE0, 0xFF, 0xC3, 0x22, 0xF0, 0x90, 0x93, 0x2D, 0xE0, 0x44, ++0x01, 0xF0, 0x22, 0xF0, 0x90, 0x97, 0xB3, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xFF, 0xA3, 0xE0, ++0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, 0x90, 0x97, 0xB6, 0xE0, 0xFD, 0x90, 0x97, 0xB5, 0xE0, ++0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xDC, 0xE0, 0x04, 0xF0, 0x22, 0x12, 0xCF, 0xA1, 0xED, ++0xF0, 0x2F, 0xFF, 0xE4, 0x3E, 0xCF, 0x24, 0x06, 0xCF, 0x34, 0x00, 0x51, 0x7A, 0xEF, 0x64, 0x86, ++0x70, 0x1B, 0x90, 0x97, 0xE2, 0xE0, 0xFF, 0x90, 0x97, 0xE1, 0xE0, 0x2F, 0x12, 0xE9, 0xF4, 0xCF, ++0x24, 0x07, 0xCF, 0x34, 0x00, 0x51, 0x7A, 0xBF, 0xDD, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, ++0x7E, 0x00, 0x7F, 0x04, 0x02, 0x01, 0xE0, 0x7E, 0x00, 0x7F, 0x06, 0x02, 0x01, 0xE0, 0x7E, 0x00, ++0x7F, 0x10, 0x02, 0x01, 0xE0, 0x90, 0x93, 0x5D, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0xE0, 0x24, 0xBC, ++0xF5, 0x82, 0xE4, 0x34, 0x97, 0x22, 0x90, 0x97, 0xDD, 0xE0, 0xFF, 0x75, 0xF0, 0x38, 0x22, 0xE0, ++0x24, 0xB6, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0x22, 0x78, 0xBC, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, ++0x22, 0x12, 0x97, 0x9A, 0x90, 0x93, 0x08, 0x12, 0xD7, 0xBD, 0x12, 0x8E, 0x13, 0x90, 0x93, 0x09, ++0x12, 0x8F, 0x1A, 0x90, 0x93, 0x0A, 0xF0, 0x12, 0xBF, 0xDD, 0x90, 0x93, 0x08, 0xE0, 0x54, 0x01, ++0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x1A, 0x11, 0x5E, 0x60, ++0x0A, 0x11, 0x57, 0x12, 0x7C, 0x05, 0x12, 0xBF, 0xCB, 0x80, 0x07, 0x11, 0x57, 0x12, 0x7C, 0x3B, ++0xF1, 0xED, 0x12, 0x79, 0xD4, 0x80, 0x17, 0x11, 0x5E, 0x60, 0x07, 0x11, 0x57, 0x12, 0x7C, 0x05, ++0x80, 0x05, 0x11, 0x57, 0x12, 0x7C, 0x3B, 0x91, 0xE4, 0x91, 0xEB, 0x12, 0x7B, 0xCC, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x90, 0x93, ++0x0A, 0xE0, 0x90, 0x01, 0x3F, 0x22, 0xF1, 0xE6, 0x64, 0x01, 0x60, 0x02, 0x21, 0x83, 0x90, 0x88, ++0x36, 0xE0, 0x70, 0x02, 0x21, 0x83, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x33, 0x90, 0x06, 0xA9, ++0xE0, 0x54, 0xC0, 0x70, 0x2B, 0x90, 0x88, 0x9C, 0xE0, 0x70, 0x25, 0x90, 0x04, 0x1A, 0xE0, 0xF4, ++0x70, 0x1E, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x70, 0x17, 0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, 0x70, ++0x0F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x08, 0x12, 0xB4, 0x41, 0x54, 0xFE, 0x12, 0xD1, 0xCF, ++0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, ++0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, ++0x90, 0x07, 0xF1, 0xE0, 0x90, 0x97, 0x2B, 0xF0, 0x90, 0x07, 0xF0, 0xE0, 0x90, 0x97, 0x2C, 0xF0, ++0x12, 0xBB, 0x8F, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEC, 0xF0, 0x31, 0x8C, 0x24, 0xFD, 0x50, ++0x02, 0x80, 0x03, 0x12, 0xBA, 0xFA, 0x31, 0x8C, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, ++0x90, 0x88, 0x3D, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0x88, 0x3C, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, ++0x08, 0x90, 0x88, 0x3C, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, 0x31, 0x95, ++0xE4, 0x90, 0x88, 0x3F, 0xF0, 0xD1, 0x00, 0x30, 0xE0, 0x52, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, ++0x20, 0xE0, 0x21, 0x31, 0x84, 0x6F, 0x70, 0x44, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0x12, ++0xBF, 0xAB, 0x11, 0x53, 0x12, 0x7C, 0x05, 0xF1, 0xF4, 0x12, 0xBF, 0x9D, 0x90, 0x88, 0x3D, 0xE0, ++0x14, 0xF0, 0x80, 0x28, 0x12, 0xF0, 0x38, 0x64, 0x01, 0x70, 0x21, 0x31, 0x84, 0xFE, 0x6F, 0x60, ++0x1B, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x12, 0x12, 0x97, 0xD5, 0x30, 0xE0, 0x0C, ++0xEF, 0x54, 0xBF, 0x11, 0x53, 0x12, 0x7C, 0x3B, 0x91, 0xEB, 0x91, 0xE4, 0x90, 0x88, 0x32, 0xE0, ++0x44, 0x04, 0xF0, 0x22, 0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0x90, 0x88, 0x34, 0xE0, ++0xFF, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0x97, 0x2C, 0xE0, 0x24, 0x46, 0xFF, 0x90, 0x97, 0x2B, 0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, ++0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x85, 0xBA, 0x90, 0x88, 0x85, 0x71, 0xA4, 0xEF, 0x24, ++0x46, 0xFF, 0xE4, 0x3E, 0xFE, 0xE4, 0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x90, 0x88, 0x89, 0x71, 0xA4, ++0x90, 0x88, 0x85, 0x71, 0xBF, 0x50, 0x02, 0x41, 0x8B, 0x90, 0x88, 0x89, 0x12, 0x85, 0xE2, 0x90, ++0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, 0x85, 0xBA, 0x90, 0x98, 0x7E, 0x12, 0x04, 0x31, 0x90, 0x88, ++0x31, 0xE0, 0x30, 0xE0, 0x2B, 0x91, 0xF3, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x03, 0xC3, 0x33, ++0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, 0x4E, 0xE0, 0xFD, ++0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, 0x00, 0xFA, 0x71, 0xAD, 0xEB, 0x2F, 0xFF, 0xEA, 0x80, 0x1E, ++0x90, 0x88, 0x33, 0x12, 0x97, 0xD8, 0x30, 0xE0, 0x02, 0x61, 0x89, 0x71, 0xAD, 0x90, 0x88, 0x4E, ++0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, 0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, 0xED, 0x3E, 0x90, ++0x98, 0x7A, 0xF0, 0xA3, 0xEF, 0xF0, 0xC3, 0x90, 0x98, 0x7B, 0xE0, 0x94, 0xA0, 0x90, 0x98, 0x7A, ++0xE0, 0x94, 0x00, 0x50, 0x36, 0xA3, 0xE0, 0xFB, 0x24, 0xEB, 0x71, 0x9C, 0xE0, 0x04, 0xF0, 0x90, ++0x98, 0x7E, 0x12, 0x04, 0xB8, 0xEF, 0x54, 0x7F, 0xFF, 0x74, 0x8B, 0x2B, 0x71, 0x91, 0xE0, 0xFE, ++0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, 0x98, 0x7A, 0xA3, 0xE0, 0x71, 0x8F, 0xEF, 0xF0, 0x90, 0x88, ++0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, 0x7F, 0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, 0xE0, 0xFF, ++0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x61, 0x89, ++0xE4, 0xFF, 0xFE, 0x71, 0x99, 0xE0, 0x2F, 0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, ++0x40, 0x07, 0x90, 0x98, 0x7C, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE5, 0x91, 0xCB, ++0x40, 0x02, 0x80, 0x15, 0x90, 0x98, 0x7C, 0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, 0x50, 0x13, ++0x71, 0x99, 0xE0, 0x2F, 0xFF, 0x91, 0xCB, 0x40, 0x07, 0x90, 0x98, 0x7D, 0xEE, 0xF0, 0x80, 0x03, ++0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, 0xE0, 0xFF, 0x71, 0x8A, 0xE0, 0xFD, 0xEF, 0xC3, 0x9D, 0x40, ++0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, 0xF0, 0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x98, 0x7D, 0xE0, ++0x80, 0x18, 0x71, 0x8A, 0xE0, 0xFD, 0xC3, 0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, 0xF0, 0xEE, ++0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, 0x98, 0x7D, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, 0x90, 0x88, ++0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, 0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, 0xF0, 0xE4, ++0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, 0x50, 0x9F, ++0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4F, ++0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, 0x88, 0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, 0x4F, 0xE0, ++0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, 0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, 0x90, 0x88, ++0x4F, 0xE0, 0x24, 0x10, 0xF0, 0x12, 0xCF, 0xCE, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, 0x8A, ++0xA3, 0x12, 0x8D, 0x12, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x98, 0x7C, 0xE0, 0xFE, 0x24, ++0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0x74, 0xEB, 0x2E, 0xF5, 0x82, 0xE4, 0x34, ++0x95, 0xF5, 0x83, 0x22, 0x12, 0x04, 0x31, 0x90, 0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, 0x98, 0x7E, ++0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, 0x03, 0xEB, 0x7E, 0x02, 0xFD, 0xFC, 0x90, 0x9A, 0x1B, 0x12, ++0x85, 0xE2, 0xC3, 0x02, 0x03, 0xDA, 0x90, 0x9A, 0x1A, 0xEF, 0xF0, 0x90, 0x88, 0xE0, 0xE0, 0x70, ++0x51, 0x7F, 0x48, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEE, 0x54, 0x0F, 0xFE, 0xE4, 0xFD, 0xFC, 0x90, ++0x9A, 0x1B, 0x12, 0x04, 0x31, 0xE4, 0x7F, 0x80, 0x71, 0xB8, 0x70, 0x05, 0x90, 0x88, 0xBE, 0x80, ++0x1B, 0xE4, 0xFF, 0xFE, 0x71, 0xBA, 0x70, 0x0A, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xE4, 0xA3, 0xF0, ++0x80, 0x56, 0xE4, 0xFF, 0x71, 0xB8, 0x70, 0x09, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xA3, 0xF0, 0x80, ++0x47, 0xE4, 0x7F, 0x80, 0xFE, 0x71, 0xBA, 0x70, 0x3F, 0x90, 0x88, 0xBE, 0xF0, 0xA3, 0x04, 0xF0, ++0x80, 0x36, 0x7F, 0x2C, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x02, 0x91, 0xB5, 0x60, 0x08, ++0x90, 0x88, 0xBE, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xBE, 0xF0, 0x7F, 0x30, 0x7E, ++0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x01, 0x91, 0xB5, 0x60, 0x07, 0xE4, 0x90, 0x88, 0xBF, 0xF0, ++0x80, 0x06, 0x90, 0x88, 0xBF, 0x74, 0x01, 0xF0, 0x90, 0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, 0x90, ++0x8A, 0xF9, 0x12, 0x8D, 0x12, 0x7D, 0x11, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x12, ++0x8E, 0x2C, 0x90, 0x07, 0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x88, 0xDF, 0xE0, 0xFF, 0x90, ++0x8A, 0xF3, 0x12, 0x9A, 0x7E, 0x90, 0x9A, 0x1A, 0xE0, 0xFD, 0x70, 0x02, 0x80, 0x1C, 0xED, 0xB4, ++0x01, 0x06, 0x91, 0xAE, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x9A, 0x1A, 0xE0, 0xFD, 0xB4, 0x02, 0x06, ++0x91, 0xAE, 0x44, 0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x03, 0x91, 0xAE, 0xF0, 0x22, 0x90, 0x88, ++0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xFF, 0xE4, 0xFE, 0xFD, 0xFC, 0x90, 0x9A, 0x1B, 0x12, 0x04, 0x31, ++0x90, 0x9A, 0x1B, 0x12, 0x04, 0xB8, 0xEC, 0x4D, 0x4E, 0x4F, 0x22, 0x90, 0x88, 0x91, 0xE0, 0xFD, ++0xC3, 0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, ++0x9D, 0xE4, 0x9C, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x74, 0x7D, 0x01, 0x7F, 0x02, 0x02, ++0x7C, 0x74, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, ++0x7B, 0x01, 0x7A, 0x88, 0x79, 0x31, 0x12, 0x04, 0x80, 0x12, 0x97, 0xDF, 0x79, 0x08, 0x12, 0x04, ++0x80, 0x90, 0x88, 0x35, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, ++0x50, 0xF0, 0x90, 0x88, 0x42, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0x91, 0xF2, 0xFF, 0xB1, 0xF2, 0x12, ++0xEE, 0x67, 0x90, 0x8A, 0x89, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, ++0x89, 0x12, 0x8D, 0x12, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0x12, 0x8D, ++0x12, 0x7D, 0x0C, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x01, 0x08, ++0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x80, 0x11, 0xEF, 0xB4, 0x03, 0x08, 0x90, 0x88, 0x41, 0x74, ++0x14, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0x41, 0xF0, 0x7F, 0x79, 0x12, 0x7B, 0x41, 0xEF, 0x54, ++0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, 0x28, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE2, 0x06, 0x90, 0x88, ++0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, ++0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0x91, 0xF2, 0xB1, 0xF2, 0x7E, 0x00, 0x7F, 0x18, ++0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x0C, 0x12, 0x04, 0x80, 0x90, 0x8A, 0xA3, 0x12, 0x8D, ++0x12, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, 0x7D, ++0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, ++0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x88, 0x9C, ++0xF0, 0x22, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4E, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x22, ++0x90, 0x88, 0x32, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x12, 0x97, 0x9A, 0x90, 0x93, 0x24, 0x12, 0xD7, 0xBD, 0xF1, 0x17, 0x12, 0xEF, 0xC6, ++0x90, 0x93, 0x24, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0xF1, 0x16, 0x12, 0xEF, 0xCF, ++0x90, 0x93, 0x24, 0xF1, 0x0E, 0x12, 0xF0, 0x03, 0x90, 0x93, 0x24, 0x12, 0xF0, 0x0C, 0x4E, 0x12, ++0x8F, 0x1A, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x26, 0xE0, 0x54, 0xFE, 0x12, 0x8E, 0x12, 0xFE, ++0x54, 0x01, 0xFD, 0x90, 0x93, 0x25, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEE, 0x54, 0x04, 0xFE, ++0xED, 0x54, 0xFB, 0x4E, 0xFE, 0x12, 0x8E, 0x13, 0xFD, 0x54, 0x08, 0xFC, 0xEE, 0x54, 0xF7, 0x4C, ++0xFE, 0x90, 0x93, 0x25, 0xF0, 0xED, 0x54, 0x10, 0xFD, 0xEE, 0x54, 0xEF, 0x4D, 0xF0, 0xEF, 0x54, ++0x10, 0xFF, 0xA3, 0xE0, 0x54, 0xEF, 0x4F, 0xFF, 0x12, 0x8F, 0x1A, 0x12, 0xF0, 0x30, 0x90, 0x93, ++0x26, 0x12, 0x8E, 0x13, 0x54, 0x02, 0xFF, 0x90, 0x93, 0x25, 0xE0, 0x54, 0xFD, 0x4F, 0x12, 0xD7, ++0xB3, 0x12, 0xCE, 0x56, 0x12, 0xD7, 0x75, 0x90, 0x93, 0x24, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, ++0x12, 0xE3, 0xEE, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x12, 0xE4, 0x0B, 0x90, ++0x93, 0x25, 0x12, 0x98, 0xE0, 0x30, 0xE0, 0x1E, 0x90, 0x93, 0x24, 0xD1, 0x03, 0x20, 0xE0, 0x0E, ++0xEF, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x01, ++0x80, 0x0E, 0x7F, 0x00, 0x80, 0x0A, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFF, ++0x12, 0xE5, 0xD4, 0x90, 0x93, 0x24, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, 0xF1, 0x1E, 0x90, ++0x93, 0x24, 0xE0, 0x54, 0x01, 0xFF, 0x12, 0xD6, 0x8F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0xEE, ++0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xFF, 0xF0, 0x12, 0x02, 0x06, 0xFE, 0x22, 0xEF, 0x60, ++0x05, 0x12, 0xD2, 0xF9, 0xF1, 0x27, 0x22, 0x90, 0x95, 0xC6, 0xF1, 0xDB, 0xE0, 0xFE, 0x24, 0x28, ++0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x29, 0x2E, 0x12, 0xCF, 0x99, 0xE0, ++0xFD, 0x90, 0x97, 0x32, 0xE0, 0x24, 0x2C, 0x12, 0xE3, 0x45, 0x90, 0x97, 0x32, 0xE0, 0x2F, 0x24, ++0x30, 0xA3, 0xF0, 0xE0, 0xFD, 0x24, 0x04, 0x12, 0xCF, 0xBA, 0xE0, 0xFE, 0x74, 0x05, 0x2D, 0x12, ++0xCE, 0x4F, 0x90, 0x95, 0x6D, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x97, 0x33, 0xE0, 0x24, 0x0C, 0xF9, ++0xE4, 0x34, 0xFC, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x6F, 0x12, ++0x69, 0xF5, 0x90, 0x97, 0x33, 0xE0, 0x24, 0x14, 0xF0, 0xE0, 0xFD, 0x24, 0x01, 0x12, 0xC6, 0xAD, ++0xE0, 0xFE, 0x74, 0x00, 0x2D, 0x12, 0xC6, 0xF8, 0x12, 0xCE, 0x56, 0x90, 0x95, 0x73, 0xF0, 0xA3, ++0xEF, 0xF0, 0x90, 0x95, 0xC7, 0xF1, 0xDB, 0x90, 0x95, 0x69, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x4E, ++0x60, 0x11, 0x90, 0x97, 0x32, 0x12, 0xC7, 0x80, 0x8F, 0x48, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x77, ++0x12, 0x69, 0xF5, 0x90, 0x95, 0xC8, 0xF1, 0xDB, 0x12, 0xC7, 0x81, 0x90, 0x95, 0x6B, 0xA3, 0xE0, ++0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x97, 0x02, 0x69, 0xF5, 0xE0, 0xFF, 0x12, 0x7B, 0x07, ++0x90, 0x97, 0x32, 0xEF, 0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x22, 0x7D, 0x02, 0x7F, ++0x02, 0x12, 0x7C, 0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x90, 0x93, 0x0C, 0xE0, 0x20, ++0xE0, 0x02, 0x01, 0xCA, 0xE4, 0x90, 0x97, 0x32, 0xF0, 0x90, 0x97, 0x32, 0xE0, 0xFF, 0xC3, 0x94, ++0x05, 0x40, 0x02, 0x01, 0xCA, 0x12, 0x97, 0xAA, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, ++0xF9, 0xFF, 0x90, 0x93, 0x0D, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x02, 0x01, 0xC2, 0x12, 0x02, 0x06, ++0xFF, 0x30, 0xE0, 0x1A, 0x90, 0x93, 0x0E, 0xE0, 0xFE, 0x90, 0x97, 0x32, 0xE0, 0xFD, 0x74, 0x01, ++0xA8, 0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, 0x0E, 0xF0, 0xEF, 0xC3, ++0x13, 0x30, 0xE0, 0x15, 0x90, 0x93, 0x0F, 0xE0, 0xFF, 0x90, 0x97, 0x32, 0x11, 0xD3, 0x80, 0x02, ++0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x0F, 0xF0, 0x12, 0x8E, 0x14, 0xFF, 0x90, 0x97, 0x32, ++0xE0, 0xFE, 0x24, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0x8F, 0x1A, 0xFF, ++0x74, 0x15, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x12, 0x8F, 0x13, 0xFF, ++0x74, 0x1A, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x12, 0x8F, 0xE2, 0xFF, ++0x74, 0x1F, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0x0D, 0xE0, ++0xFF, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x0D, ++0xF0, 0x22, 0x90, 0x97, 0x32, 0xE0, 0x04, 0xF0, 0x01, 0x09, 0x22, 0x7F, 0x61, 0x12, 0x7B, 0x41, ++0x90, 0x9A, 0x3C, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0x9A, 0x3D, 0xED, 0xF0, 0x90, 0x9A, 0x3C, 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, ++0x42, 0x7F, 0x47, 0x11, 0xCD, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, ++0x12, 0x7B, 0x2E, 0x7F, 0x46, 0x11, 0xCD, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, ++0x46, 0x51, 0x71, 0x60, 0x0D, 0x7F, 0x45, 0x11, 0xCD, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, ++0x80, 0x0C, 0x7F, 0x45, 0x11, 0xCD, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, ++0x45, 0x80, 0x46, 0x90, 0x9A, 0x3C, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0x11, 0xCD, 0x80, 0x02, ++0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x12, 0x7B, 0x2E, 0x7F, 0x62, 0x11, 0xCD, ++0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0x51, 0x71, 0x60, 0x0E, 0x11, 0xCB, ++0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x0D, 0x11, 0xCB, 0x80, 0x02, ++0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x12, 0x7B, 0x2E, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xAD, 0x07, 0x90, 0x93, 0x29, 0xE0, 0x75, 0xF0, 0x40, 0xA4, 0xFF, 0x90, 0x9A, 0x15, 0xE5, ++0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x93, 0x2A, 0xE0, 0xC3, 0x13, 0x54, 0x7F, ++0x90, 0x9A, 0x18, 0xF0, 0x90, 0x93, 0x2B, 0xE0, 0x13, 0x13, 0x54, 0x01, 0x90, 0x9A, 0x19, 0xF0, ++0xED, 0x64, 0x01, 0x70, 0x6E, 0xE0, 0x70, 0x15, 0x90, 0x9A, 0x15, 0xE0, 0x70, 0x02, 0xA3, 0xE0, ++0x60, 0x0B, 0x90, 0x9A, 0x15, 0x74, 0xFF, 0x75, 0xF0, 0xD0, 0x12, 0x02, 0xE7, 0x51, 0x33, 0x54, ++0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x11, 0xDB, 0x51, 0x33, 0x54, 0x01, 0xFD, 0x11, ++0xDB, 0x90, 0x93, 0x2A, 0xE0, 0x30, 0xE0, 0x3B, 0x51, 0x24, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, ++0x02, 0x7D, 0x01, 0x11, 0xDB, 0xE4, 0x90, 0x9A, 0x17, 0xF0, 0x90, 0x9A, 0x18, 0xE0, 0xFF, 0x90, ++0x9A, 0x17, 0xE0, 0xC3, 0x9F, 0x50, 0x1C, 0x51, 0x24, 0x54, 0x01, 0xFD, 0x11, 0xDB, 0x51, 0x24, ++0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x11, 0xDB, 0x90, 0x9A, 0x17, 0xE0, 0x04, ++0xF0, 0x80, 0xD7, 0x22, 0x90, 0x9A, 0x15, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x9A, 0x19, 0xE0, ++0xFD, 0x51, 0x42, 0x90, 0x93, 0x28, 0xE0, 0x54, 0x7F, 0xFF, 0x90, 0x93, 0x27, 0xE0, 0xFE, 0xC4, ++0x13, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x11, 0x8F, 0x12, 0xBD, 0x01, 0x15, ++0xE5, 0x12, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xEE, 0x54, 0x1F, 0xFE, ++0x12, 0x7A, 0xAE, 0x80, 0x07, 0xAF, 0x12, 0xAE, 0x11, 0x12, 0x7C, 0x6A, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x12, 0x7B, 0x2E, 0x90, 0x9A, 0x3D, 0xE0, 0x22, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0x7F, ++0x01, 0x90, 0x9A, 0x48, 0xEF, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x02, 0x70, 0x22, 0x90, 0x9A, ++0x48, 0xE0, 0xFD, 0x64, 0x01, 0x70, 0x66, 0x12, 0x9F, 0x4B, 0x90, 0x93, 0x28, 0x12, 0x8F, 0xDA, ++0x30, 0xE0, 0x09, 0x90, 0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, 0x51, 0xAF, 0x05, 0x80, 0x4B, ++0x12, 0x97, 0x93, 0x70, 0x32, 0x90, 0x97, 0x2D, 0xE0, 0xFF, 0x30, 0xE0, 0x2A, 0x90, 0x00, 0xD4, ++0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x00, 0xC6, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x00, 0x01, 0xE0, 0x44, ++0x30, 0xF0, 0x90, 0x00, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x00, 0xCC, 0xE0, 0x54, 0xFB, 0xF0, ++0xEF, 0x54, 0xFE, 0x90, 0x97, 0x2D, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0xF1, 0xEA, 0x90, ++0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x9A, 0x48, 0xE0, 0xFF, 0x31, 0x81, 0x12, 0x96, 0x39, ++0xF0, 0x02, 0x97, 0xB2, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x99, 0x84, 0xF0, ++0xA3, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, 0x12, 0x95, 0x65, 0x90, 0x99, 0x8C, 0xF0, 0xA3, 0xF0, ++0xA3, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0x04, 0xF0, 0x74, 0xAB, 0xA3, 0x12, 0xD6, 0x15, 0x12, 0xCE, ++0x56, 0x90, 0x99, 0x7B, 0x12, 0xD7, 0xA0, 0x90, 0x99, 0x83, 0xF0, 0x90, 0x93, 0x24, 0xE0, 0x20, ++0xE0, 0x02, 0xC1, 0x1F, 0xE4, 0x90, 0x99, 0x82, 0xF0, 0x90, 0x99, 0x83, 0xE0, 0xFF, 0x90, 0x99, ++0x82, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0xC1, 0x1F, 0xF1, 0xD8, 0xEC, 0xFF, 0x90, 0xFD, 0x11, 0xF0, ++0x90, 0x99, 0x8C, 0xEF, 0xF0, 0x12, 0xD5, 0x69, 0x54, 0x3F, 0xFE, 0x90, 0x99, 0x7D, 0xF0, 0xA3, ++0xEF, 0xF0, 0x90, 0x99, 0x88, 0xEE, 0x12, 0xEF, 0x8B, 0x30, 0xE0, 0x0A, 0xC3, 0x13, 0x20, 0xE0, ++0x05, 0x12, 0xD7, 0xDB, 0x80, 0x02, 0x7E, 0x00, 0xEF, 0x24, 0x18, 0x2E, 0xFF, 0x90, 0x99, 0x8D, ++0xF0, 0x90, 0x99, 0x7C, 0xE0, 0x2F, 0xFF, 0x90, 0x99, 0x7B, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x99, ++0x7F, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x9A, 0x7B, 0xC0, 0x07, 0x90, 0x99, 0x7F, 0xD1, 0x3B, 0x7D, ++0x01, 0x12, 0x04, 0x7E, 0xC0, 0x07, 0x90, 0x99, 0x7F, 0xD1, 0x3B, 0x7D, 0x04, 0x12, 0x04, 0x7E, ++0xAB, 0x07, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0xE3, 0x4E, 0x90, 0x99, 0x84, 0xEF, 0xF0, 0xD1, 0x2F, ++0x12, 0x9A, 0x7B, 0xEF, 0x54, 0xFC, 0x90, 0x99, 0x81, 0xF0, 0x90, 0x99, 0x8D, 0xE0, 0xFF, 0x90, ++0x99, 0x7D, 0xE4, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0xF1, 0xE1, 0x12, 0xD6, 0x1F, 0x90, 0x99, 0x7D, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0x7B, 0xD1, 0x3B, 0x7D, 0x0F, 0x12, 0x04, 0x7E, 0x7D, ++0x01, 0x12, 0xE4, 0xD7, 0xEF, 0x60, 0x12, 0x12, 0x9F, 0x4B, 0x90, 0x99, 0x7B, 0xD1, 0x3B, 0x7D, ++0x10, 0x12, 0x04, 0x7E, 0x90, 0x95, 0x61, 0xEF, 0xF0, 0xF1, 0xE1, 0x90, 0x99, 0x7B, 0x12, 0xD7, ++0xCC, 0xF1, 0xD8, 0xD3, 0x9F, 0xEC, 0x9E, 0x40, 0x0F, 0x12, 0xEF, 0xB6, 0xED, 0x9F, 0xFF, 0xEC, ++0x9E, 0x90, 0x99, 0x7B, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0x07, 0xE0, 0x60, 0x3F, 0x90, 0x99, ++0x81, 0xE0, 0x24, 0xB0, 0x60, 0x18, 0x24, 0xD0, 0x60, 0x02, 0xA1, 0xB9, 0xF1, 0xD0, 0x20, 0xE0, ++0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x02, 0xA1, 0xB9, 0x80, 0x10, 0xF1, 0xD0, ++0x20, 0xE0, 0x0B, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x02, 0xA1, 0xB9, 0xD1, 0x2F, ++0x90, 0x99, 0x88, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x12, 0xE8, 0x28, 0xA1, 0xB9, 0x90, 0x99, 0x81, ++0xE0, 0x24, 0xF8, 0x60, 0x3A, 0x24, 0x80, 0x60, 0x36, 0x24, 0xC8, 0x60, 0x06, 0x24, 0x20, 0x60, ++0x02, 0xA1, 0xB9, 0x90, 0x93, 0x27, 0xE0, 0xFF, 0x12, 0x8F, 0xDB, 0x20, 0xE0, 0x02, 0xA1, 0xB9, ++0x90, 0x93, 0x3A, 0xE0, 0x04, 0xF0, 0xD1, 0x2F, 0xF1, 0x0B, 0xEF, 0x70, 0x02, 0xA1, 0xB9, 0x90, ++0x99, 0x81, 0xE0, 0xFF, 0x12, 0xE0, 0xCF, 0x90, 0x93, 0x3B, 0xE0, 0x04, 0xF0, 0xA1, 0xB9, 0x90, ++0x93, 0x24, 0x12, 0xC1, 0x8E, 0x30, 0xE0, 0x5F, 0x90, 0x99, 0x84, 0xE0, 0xFF, 0x90, 0x99, 0x80, ++0xE0, 0x2F, 0xFF, 0x90, 0x99, 0x7F, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, 0xFE, ++0x90, 0x99, 0x8A, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x9A, 0x7B, 0xEF, 0x64, 0x45, 0x70, 0x38, 0xD1, ++0xFB, 0x12, 0xEA, 0xCE, 0xEF, 0x64, 0x01, 0x70, 0x2E, 0xD1, 0xFB, 0x12, 0xEB, 0x0D, 0xEF, 0x64, ++0x01, 0x70, 0x24, 0x90, 0x99, 0x8E, 0x04, 0xD1, 0xFA, 0xA3, 0xE0, 0xFD, 0x12, 0xEA, 0x26, 0xEF, ++0x70, 0x0D, 0x90, 0x99, 0x8C, 0xE0, 0xFD, 0x90, 0xFD, 0x11, 0xD1, 0xFA, 0x12, 0xEA, 0x7F, 0x90, ++0x99, 0x8C, 0xE0, 0x90, 0xFD, 0x11, 0xF0, 0xD1, 0x2F, 0xF1, 0x0B, 0xEF, 0x60, 0x1C, 0xD1, 0x2F, ++0x90, 0x99, 0x84, 0xE0, 0xFD, 0x90, 0x99, 0x87, 0xE0, 0xFB, 0x90, 0x99, 0x8C, 0xE0, 0x90, 0x97, ++0xB7, 0xF0, 0x12, 0x99, 0x76, 0xEF, 0x60, 0x02, 0xF1, 0x04, 0x90, 0x93, 0x24, 0xE0, 0xC3, 0x13, ++0x30, 0xE0, 0x0F, 0xD1, 0x2F, 0x90, 0x99, 0x84, 0xE0, 0xFD, 0x12, 0x9C, 0x0D, 0xEF, 0x60, 0x02, ++0xF1, 0x04, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0F, 0xD1, 0x2F, 0x90, ++0x99, 0x84, 0xE0, 0xFD, 0x12, 0x9D, 0x6C, 0xEF, 0x60, 0x02, 0xF1, 0x04, 0x90, 0x93, 0x24, 0x12, ++0x8F, 0xDA, 0x30, 0xE0, 0x1C, 0x90, 0x99, 0x8E, 0xE0, 0x70, 0x16, 0xD1, 0x2F, 0x90, 0x99, 0x84, ++0xE0, 0xFD, 0x12, 0xE4, 0xA1, 0xEF, 0x60, 0x09, 0x12, 0x9F, 0x4B, 0x90, 0x01, 0xC7, 0x74, 0x22, ++0xF0, 0xD1, 0x2F, 0x90, 0x99, 0x84, 0xE0, 0xFD, 0xD1, 0x4C, 0xEF, 0x60, 0x0C, 0x90, 0x93, 0x2D, ++0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x90, 0x93, 0x2D, 0xE0, 0x30, 0xE0, 0x04, ++0x7F, 0x01, 0x51, 0x81, 0x12, 0xE0, 0xB8, 0xEF, 0x64, 0x01, 0x70, 0x37, 0x90, 0x93, 0x3C, 0xE0, ++0x04, 0xF0, 0x12, 0xE0, 0x64, 0xAD, 0x07, 0xEF, 0x64, 0x01, 0x60, 0x1F, 0x12, 0x9F, 0x4B, 0xED, ++0xB4, 0x02, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x42, 0xF0, 0x80, 0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, ++0x01, 0xC7, 0x74, 0x43, 0xF0, 0x7F, 0x01, 0x51, 0x81, 0x80, 0x24, 0x90, 0x99, 0x7B, 0x12, 0xE0, ++0x51, 0x80, 0x14, 0x90, 0x93, 0x26, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x11, 0x90, 0x93, ++0x24, 0xE0, 0x54, 0xFE, 0xF0, 0x80, 0x08, 0x90, 0x99, 0x82, 0xE0, 0x04, 0xF0, 0x61, 0x49, 0x74, ++0x04, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xAB, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, ++0x99, 0x7F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x97, 0xB8, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0x90, 0x8A, 0xE9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, 0x82, 0x8C, 0x83, 0x22, 0x90, 0x97, 0xB5, 0xED, ++0x12, 0x9F, 0x53, 0xF1, 0x0B, 0xEF, 0x70, 0x02, 0xC1, 0xF7, 0x12, 0x9A, 0x1F, 0x12, 0xE4, 0xB8, ++0x70, 0x02, 0xC1, 0xF7, 0x12, 0x9D, 0x5A, 0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, 0x90, 0x97, 0xB8, ++0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x93, 0x25, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x33, 0xD1, 0x38, ++0x7D, 0x09, 0x12, 0x04, 0x7E, 0xEF, 0x64, 0x06, 0x70, 0x27, 0xD1, 0x38, 0x7D, 0x14, 0x12, 0x04, ++0x7E, 0xEF, 0x70, 0x1D, 0xD1, 0x38, 0x7D, 0x15, 0x12, 0x04, 0x7E, 0xEF, 0x64, 0x50, 0x70, 0x11, ++0xD1, 0x38, 0x7D, 0x21, 0x12, 0x04, 0x7E, 0xEF, 0x20, 0xE0, 0x03, 0x30, 0xE2, 0x03, 0x7F, 0x01, ++0x22, 0x90, 0x93, 0x25, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x3B, 0xD1, 0x38, 0x7D, 0x09, ++0x12, 0x04, 0x7E, 0xEF, 0x64, 0x11, 0x70, 0x2F, 0x90, 0x97, 0xB9, 0xE0, 0x24, 0x14, 0xFF, 0x90, ++0x97, 0xB8, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x97, 0xB6, 0xF0, 0xA3, 0xEF, 0xF0, 0xD1, 0x40, 0x7D, ++0x02, 0x12, 0x04, 0x7E, 0xEF, 0x70, 0x10, 0x90, 0x97, 0xB6, 0xD1, 0x3B, 0x7D, 0x03, 0x12, 0x04, ++0x7E, 0xBF, 0x89, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0xF0, 0x90, 0x99, 0x8A, 0xE0, 0xFE, ++0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x99, 0x8E, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x97, 0xBA, 0xEE, 0xF0, ++0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0x97, 0xC2, 0xF0, 0x90, 0x97, 0xC2, 0xE0, 0xFD, 0xC3, 0x94, 0x06, ++0x50, 0x21, 0x90, 0x97, 0xBB, 0xE0, 0x24, 0x04, 0x12, 0xE4, 0xBF, 0x90, 0x8A, 0xE9, 0x12, 0x9A, ++0x4F, 0x90, 0x97, 0xC2, 0x12, 0x9F, 0xCD, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xC2, 0xE0, 0x04, ++0xF0, 0x80, 0xD5, 0x78, 0x2E, 0x7C, 0x93, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xBC, 0x12, ++0xF0, 0x27, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, ++0x85, 0x4E, 0x90, 0x97, 0xB2, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, ++0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE1, 0x0D, 0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFD, ++0xF0, 0x90, 0x86, 0x08, 0x12, 0x8E, 0x2C, 0xF1, 0xC8, 0xE0, 0x30, 0xE2, 0x09, 0x54, 0xFB, 0xF0, ++0x90, 0x86, 0x0A, 0x12, 0x8E, 0x2C, 0xF1, 0xC8, 0xE0, 0xFF, 0x30, 0xE4, 0x0B, 0x54, 0xEF, 0xF0, ++0x12, 0xCF, 0x30, 0xBF, 0x01, 0x02, 0x71, 0x04, 0xF1, 0xC8, 0xE0, 0x30, 0xE6, 0x09, 0x54, 0xBF, ++0xF0, 0x90, 0x8A, 0x7D, 0x12, 0x8E, 0x2C, 0xF1, 0xC8, 0xE0, 0xFF, 0x30, 0xE7, 0x06, 0x54, 0x7F, ++0xF0, 0x12, 0xBE, 0x11, 0xD2, 0xAF, 0x80, 0xA1, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x86, 0xAF, 0x22, ++0x90, 0x93, 0x04, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0x90, 0x99, 0x7B, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, ++0x22, 0x90, 0x99, 0x7D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x7F, 0x64, 0x7E, 0x00, 0x02, 0x7C, ++0x6A, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x0C, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x30, ++0xE0, 0x04, 0xE4, 0x12, 0x94, 0x39, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x95, 0xD8, 0xF0, 0xBF, ++0x01, 0x0A, 0x7F, 0x01, 0x12, 0x90, 0xB4, 0xE4, 0x90, 0x95, 0xD8, 0xF0, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, 0x29, 0x90, 0x00, 0x8C, ++0xE0, 0x90, 0x9A, 0x30, 0xF0, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, 0x9A, 0x31, 0xEF, 0xF0, 0x90, ++0x00, 0x8E, 0xE0, 0x90, 0x9A, 0x32, 0xF0, 0x90, 0x9A, 0x31, 0xE0, 0x7F, 0x8F, 0x12, 0x7B, 0x41, ++0xEF, 0x30, 0xE0, 0x02, 0x11, 0x5B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFD, 0x7F, 0x8D, 0x02, ++0x7B, 0x2E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x3A, 0xEF, 0xF0, 0x7F, 0x8F, ++0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, 0x4A, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0xEF, 0x64, 0x01, 0x70, ++0x40, 0x90, 0x9A, 0x3B, 0xF0, 0x90, 0x9A, 0x3B, 0xE0, 0xFD, 0x90, 0x9A, 0x3A, 0xE0, 0xC4, 0x54, ++0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE5, 0x82, 0x2D, 0xF5, 0x82, 0xE4, ++0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x11, 0xC6, 0x90, 0x9A, 0x3B, 0xE0, 0x04, 0xF0, ++0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCF, 0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x02, 0x11, ++0x5B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, ++0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, ++0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xE4, 0x90, ++0x97, 0x88, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x97, 0x88, 0xE0, 0x64, 0x01, 0xF0, 0x90, 0x95, ++0xE2, 0xE0, 0x70, 0x18, 0x90, 0x95, 0xDF, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0x90, 0x97, ++0x88, 0xE0, 0x24, 0xEE, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB0, 0xA3, 0xF0, 0x12, 0x7C, 0x54, 0xBF, ++0x01, 0x03, 0x12, 0x54, 0x9F, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xFF, ++0x90, 0x88, 0x38, 0xE0, 0x6F, 0x60, 0x03, 0x12, 0xBB, 0x62, 0xC2, 0xAF, 0x12, 0xB8, 0x6E, 0xBF, ++0x01, 0x16, 0x90, 0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x03, 0x07, 0x90, 0x97, 0x2D, 0xE0, 0x20, 0xE0, ++0x05, 0xEF, 0x64, 0x03, 0x60, 0x02, 0x31, 0x64, 0xD2, 0xAF, 0x12, 0xD0, 0x55, 0x11, 0x1D, 0x12, ++0x83, 0x4D, 0x80, 0x93, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x02, 0x31, 0x6E, 0x22, 0x90, 0x88, ++0x39, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0E, 0x12, 0xEB, 0xAA, 0xBF, 0x01, 0x08, 0x31, 0x87, ++0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x51, 0xB2, ++0x31, 0x97, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x97, 0x8B, 0xF0, 0x12, 0xDB, 0xCA, 0x7F, ++0x08, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0xE4, 0xFF, 0x71, ++0xEB, 0x90, 0x93, 0x0C, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0x9A, 0x91, 0x41, 0x44, 0x02, 0x12, 0xD1, ++0xCF, 0xE4, 0x90, 0x97, 0x8C, 0xF0, 0x90, 0x97, 0x8C, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2E, ++0x12, 0x97, 0xAA, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x0F, ++0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x10, 0x90, 0x97, 0x8C, 0xF1, 0xED, 0x90, 0x97, 0x8C, 0x12, 0xEF, ++0x6A, 0x44, 0x40, 0xF0, 0x91, 0x3A, 0x90, 0x97, 0x8C, 0xE0, 0x04, 0xF0, 0x80, 0xC8, 0x90, 0x07, ++0xC7, 0xE4, 0xF0, 0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, 0x77, 0xF0, 0x90, 0x07, 0xC4, ++0xE4, 0xF0, 0x90, 0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x12, 0xDF, 0x77, 0x90, ++0x02, 0x26, 0xE0, 0x44, 0x01, 0xF0, 0xE0, 0x90, 0x97, 0x8D, 0xF0, 0x90, 0x97, 0x8D, 0xE0, 0x30, ++0xE0, 0x1A, 0x90, 0x97, 0x8B, 0xE0, 0x04, 0xF0, 0x12, 0xCF, 0x63, 0x90, 0x02, 0x26, 0xE0, 0x90, ++0x97, 0x8D, 0xF0, 0x90, 0x97, 0x8B, 0xE0, 0xD3, 0x94, 0xFA, 0x40, 0xDF, 0x90, 0x02, 0x03, 0x74, ++0x80, 0xF0, 0x90, 0x04, 0x24, 0xE0, 0x90, 0x97, 0x8E, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x44, 0x10, ++0xF0, 0x90, 0x02, 0x00, 0xE0, 0x90, 0x97, 0x8D, 0xF0, 0x90, 0x02, 0x01, 0x51, 0xA9, 0x90, 0x02, ++0x02, 0x51, 0xA9, 0x90, 0x02, 0x14, 0x51, 0xA9, 0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x04, 0x24, 0xF0, ++0x90, 0x04, 0x22, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x97, 0x8E, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, ++0xFD, 0x09, 0x74, 0xFF, 0xF0, 0x90, 0xFD, 0x08, 0xE4, 0xF0, 0x91, 0x48, 0xE4, 0xFD, 0x12, 0x76, ++0xF7, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x97, 0x8D, 0xE0, 0x2F, ++0xF0, 0x22, 0x75, 0x0F, 0x14, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x10, 0xF0, 0x91, 0x48, 0x7D, 0x01, ++0x12, 0x76, 0xF7, 0x90, 0x88, 0x41, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x37, ++0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, ++0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x93, 0x0C, 0xE0, 0x30, 0xE0, 0x6A, 0x90, 0xFD, 0x09, 0xE4, ++0xF0, 0x90, 0xFD, 0x08, 0xF0, 0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, 0x97, 0x8B, ++0xF0, 0x90, 0x97, 0x8B, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2E, 0x12, 0x97, 0xAA, 0x80, 0x05, ++0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x0E, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, ++0x10, 0x90, 0x97, 0x8B, 0xF1, 0xED, 0x90, 0x97, 0x8B, 0x12, 0xEF, 0x6A, 0x44, 0x20, 0xF0, 0x91, ++0x3A, 0x90, 0x97, 0x8B, 0xE0, 0x04, 0xF0, 0x80, 0xC8, 0x71, 0xE4, 0x54, 0xFE, 0xFD, 0x7F, 0x92, ++0x12, 0x7B, 0x2E, 0x71, 0xE4, 0x44, 0x08, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x91, 0x41, 0x54, ++0xFD, 0xFD, 0x7F, 0x02, 0x80, 0x07, 0x71, 0xE4, 0x44, 0x01, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, ++0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0x7F, 0x01, ++0x71, 0xEB, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x14, 0x7E, ++0x00, 0x02, 0x7C, 0x6A, 0x7F, 0x92, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0x90, 0x9A, 0x33, 0xEF, 0x12, ++0x95, 0x65, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x9A, 0x33, ++0xE0, 0x6F, 0x60, 0x35, 0xC3, 0x90, 0x9A, 0x35, 0xE0, 0x94, 0x88, 0x90, 0x9A, 0x34, 0xE0, 0x94, ++0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x9A, 0x34, 0x12, 0xC9, ++0x1C, 0x91, 0x3A, 0xD3, 0x90, 0x9A, 0x35, 0xE0, 0x94, 0x32, 0x90, 0x9A, 0x34, 0xE0, 0x94, 0x00, ++0x40, 0xC0, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB9, 0x22, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, ++0x6A, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, ++0x01, 0xFF, 0x90, 0x88, 0xE0, 0xE0, 0xFB, 0x90, 0x88, 0xDF, 0xE0, 0x90, 0x92, 0x90, 0xF0, 0x22, ++0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0x8F, 0x80, 0x03, 0x90, 0x8A, 0x87, 0x12, ++0x8E, 0x2C, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x04, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0xE7, ++0xE0, 0x64, 0x08, 0x70, 0x1F, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x13, 0x91, 0x48, 0xE4, 0xFD, ++0x12, 0x76, 0xF7, 0x90, 0x88, 0xE6, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x05, 0xE4, ++0x90, 0x88, 0xE7, 0xF0, 0x90, 0x88, 0xA1, 0x12, 0x97, 0xA2, 0x30, 0xE0, 0x13, 0x90, 0x88, 0xE8, ++0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, 0xF0, 0x90, 0x88, 0xE8, 0xF0, ++0x90, 0x88, 0x36, 0xE0, 0x60, 0x7C, 0x90, 0x88, 0x4D, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x61, 0xB1, ++0xAF, 0x12, 0xDE, 0x64, 0x90, 0x05, 0x60, 0xB1, 0xAF, 0x12, 0x85, 0xD5, 0xC0, 0x04, 0xC0, 0x05, ++0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0xB1, 0xAF, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, ++0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xD5, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, ++0x07, 0xA3, 0xB1, 0xAF, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0x12, 0x85, 0xD5, 0x90, 0x88, 0x81, 0x12, 0x04, 0x31, 0x90, 0x88, 0x32, 0xE0, 0x54, 0x7F, ++0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0C, 0x12, 0xCF, 0xCE, 0x74, 0x05, 0xF0, 0x12, 0x6E, 0x2F, 0x12, ++0xDD, 0x0D, 0x12, 0xA6, 0x00, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, ++0xA7, 0xED, 0x12, 0x96, 0x40, 0x12, 0xDF, 0xEA, 0xE4, 0x90, 0x95, 0xCF, 0xF0, 0x12, 0xEE, 0xFC, ++0x90, 0x93, 0x24, 0x12, 0xC1, 0x8E, 0x30, 0xE0, 0x52, 0x90, 0x95, 0x63, 0xE0, 0xFE, 0xA3, 0xE0, ++0xFF, 0x7C, 0x00, 0x7D, 0x64, 0x12, 0x02, 0x92, 0x90, 0x95, 0xB7, 0xE0, 0x6E, 0x70, 0x03, 0xA3, ++0xE0, 0x6F, 0x60, 0x0A, 0x90, 0x95, 0xB7, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x02, 0xE7, 0x90, 0x95, ++0x67, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x75, 0xE0, 0xB5, 0x06, 0x14, 0xA3, 0xE0, 0xB5, ++0x07, 0x0F, 0xEF, 0x4E, 0x60, 0x0B, 0x90, 0x01, 0xC7, 0x74, 0x31, 0xF0, 0x7F, 0x01, 0x02, 0xAA, ++0x81, 0x12, 0xCE, 0x9F, 0xE4, 0x90, 0x95, 0xB7, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x9A, 0x3E, 0xE0, ++0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x3E, ++0xED, 0xF0, 0xE4, 0xA3, 0xF0, 0xEF, 0x14, 0x60, 0x02, 0xC1, 0x9B, 0x90, 0x06, 0x03, 0xE0, 0x54, ++0xFB, 0xF0, 0x90, 0x9A, 0x3E, 0xE0, 0xFB, 0xC4, 0x33, 0x54, 0xE0, 0xFE, 0x90, 0x04, 0x42, 0xE0, ++0x54, 0x9F, 0x4E, 0xFE, 0xF0, 0xE4, 0xFD, 0x12, 0xDB, 0xA2, 0x90, 0x9A, 0x3F, 0xEF, 0xF0, 0x90, ++0x04, 0x83, 0xF0, 0x90, 0x99, 0xA4, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x99, 0xA8, ++0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x08, 0xF1, 0x0A, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x00, 0x01, 0x90, 0x99, 0xA8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, ++0x7E, 0x09, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x10, 0xB1, 0xAC, 0xEF, 0x54, 0x03, ++0xFF, 0xE4, 0x78, 0x01, 0x12, 0x03, 0xEB, 0x78, 0x04, 0xF1, 0xE4, 0x7F, 0x00, 0x7E, 0x0A, 0xF1, ++0x0A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0xB1, 0xAC, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, ++0x0A, 0xF1, 0xE4, 0x7F, 0x00, 0x7E, 0x0D, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x0C, 0x00, 0x00, 0x00, ++0x90, 0x9A, 0x3F, 0xB1, 0xAF, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, 0x1A, 0xF1, 0xE4, 0x7F, 0x18, ++0x7E, 0x08, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x99, 0xA8, 0x12, 0x04, ++0x3D, 0x00, 0x00, 0x00, 0x00, 0x12, 0xEF, 0xEF, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, ++0x99, 0x96, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x04, 0x00, 0x80, 0x5D, 0x90, 0x06, 0x03, 0xE0, 0x44, ++0x04, 0xF0, 0x90, 0x99, 0xA4, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x99, 0xA8, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, 0x08, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, ++0x00, 0x00, 0x01, 0x90, 0x99, 0xA8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, ++0x09, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x99, 0xA8, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x0C, 0x00, 0x12, 0xEF, 0xEF, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x99, ++0x96, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0xD9, ++0x64, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x50, 0x7E, 0x0C, 0xF1, 0x14, 0x90, 0x99, 0xA4, 0x22, ++0x7F, 0x58, 0x7E, 0x0C, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x99, 0xA2, 0xEE, 0xF0, ++0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, 0x90, 0x99, 0xAC, 0x12, 0x04, 0x31, 0x90, 0x99, 0xA4, 0x12, ++0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x99, 0xAC, 0x12, 0x85, 0xE2, 0x12, 0x85, 0xC8, 0xC0, 0x04, ++0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x99, 0xA4, 0x12, 0x04, 0xB8, 0x90, 0x99, 0xA8, 0x12, ++0x85, 0xE2, 0x12, 0x85, 0xC8, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xD5, ++0x90, 0x99, 0xB0, 0x12, 0x04, 0x31, 0x90, 0x99, 0xB0, 0x12, 0xD1, 0x0B, 0x90, 0x99, 0xA2, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0x04, 0x12, ++0x97, 0xD8, 0x30, 0xE0, 0x08, 0x12, 0xD7, 0x5C, 0xE4, 0x90, 0x98, 0xA3, 0xF0, 0x90, 0x99, 0xA4, ++0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x98, 0x89, 0xB1, 0xAF, 0xF1, 0xE7, 0xF1, 0x06, ++0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x98, 0x8A, 0xB1, 0xAF, 0xF1, 0xE7, 0xF1, 0x10, ++0x90, 0x98, 0x9F, 0xE0, 0x90, 0x06, 0x08, 0xF0, 0x90, 0x98, 0xA1, 0xA3, 0xE0, 0x90, 0x06, 0xA0, ++0xF0, 0xA3, 0xE4, 0xF0, 0x90, 0x98, 0x8D, 0xE0, 0xFF, 0x60, 0x05, 0xA3, 0xE0, 0xFD, 0xB1, 0xB6, ++0x90, 0x98, 0x8C, 0xE0, 0xFF, 0x60, 0x0C, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0x12, 0xDB, 0x29, ++0x12, 0xD9, 0xE2, 0x22, 0x12, 0x03, 0xFE, 0x90, 0x99, 0xA8, 0x02, 0x04, 0x31, 0xE0, 0xFF, 0x24, ++0x1A, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, 0x1F, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB1, 0xF0, 0x22, 0x75, 0x29, 0x10, ++0xE4, 0xF5, 0x2A, 0x75, 0x2B, 0x07, 0x75, 0x2C, 0x02, 0xF5, 0x31, 0xF5, 0x32, 0xF5, 0x33, 0xF5, ++0x34, 0x90, 0x01, 0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, 0xF0, 0xA3, ++0xE5, 0x2C, 0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, ++0xF0, 0xA3, 0xE5, 0x34, 0xF0, 0x22, 0x75, 0x39, 0x07, 0x43, 0x39, 0x10, 0x75, 0x3A, 0x01, 0x75, ++0x3B, 0x03, 0x75, 0x3C, 0x62, 0x43, 0x3C, 0x80, 0x43, 0x3B, 0x04, 0x90, 0x01, 0x38, 0xE5, 0x39, ++0xF0, 0xA3, 0xE5, 0x3A, 0xF0, 0xA3, 0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, 0xF0, 0x22, 0x7D, 0x02, ++0x90, 0x01, 0xC4, 0x74, 0x6E, 0xF0, 0x74, 0xB8, 0xA3, 0xF0, 0x90, 0x95, 0xCB, 0xE0, 0xFF, 0xED, ++0xC3, 0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, ++0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0D, 0x80, 0xDE, 0x74, 0x6E, 0x04, 0x90, ++0x01, 0xC4, 0xF0, 0x74, 0xB8, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x8A, 0x79, 0x74, 0x88, 0xF0, ++0xA3, 0x74, 0x66, 0xF0, 0x90, 0x8A, 0xE5, 0x74, 0xB9, 0xF0, 0xA3, 0x74, 0x73, 0xF0, 0x90, 0x8B, ++0x03, 0x74, 0x88, 0xF0, 0xA3, 0x74, 0xBA, 0xF0, 0x90, 0x8A, 0xB9, 0x74, 0xEC, 0xF0, 0xA3, 0x74, ++0xDF, 0xF0, 0x90, 0x8A, 0xC3, 0x74, 0xDB, 0xF0, 0xA3, 0x74, 0xE9, 0xF0, 0x90, 0x8A, 0xF3, 0x74, ++0xDD, 0xF0, 0xA3, 0x74, 0x15, 0xF0, 0x90, 0x8A, 0x85, 0x74, 0xA3, 0xF0, 0xA3, 0x74, 0xC6, 0xF0, ++0x90, 0x86, 0x04, 0x74, 0xDD, 0xF0, 0xA3, 0x74, 0x21, 0xF0, 0x90, 0x8A, 0xA9, 0x74, 0xD1, 0xF0, ++0xA3, 0x74, 0xE7, 0xF0, 0x90, 0x86, 0x0C, 0x74, 0x98, 0xF0, 0xA3, 0x74, 0x3F, 0xF0, 0x90, 0x8A, ++0xEF, 0x74, 0xD1, 0xF0, 0xA3, 0x74, 0x14, 0xF0, 0x90, 0x86, 0x00, 0x74, 0xEB, 0xF0, 0xA3, 0x74, ++0x44, 0xF0, 0x90, 0x86, 0x02, 0x74, 0xEC, 0xF0, 0xA3, 0x74, 0x23, 0xF0, 0x90, 0x8A, 0xFD, 0x74, ++0xD7, 0xF0, 0xA3, 0x74, 0xEA, 0xF0, 0x90, 0x8A, 0xF9, 0x74, 0xD8, 0xF0, 0xA3, 0x74, 0x49, 0xF0, ++0x90, 0x8A, 0xAF, 0x74, 0xC0, 0xF0, 0xA3, 0x74, 0xE8, 0xF0, 0x90, 0x8A, 0xD3, 0x74, 0xDC, 0xF0, ++0xA3, 0x74, 0x29, 0xF0, 0x90, 0x8A, 0xF5, 0x74, 0xEE, 0xF0, 0xA3, 0x74, 0x7D, 0xF0, 0x90, 0x8A, ++0xA3, 0x74, 0xEE, 0xF0, 0xA3, 0x74, 0xCE, 0xF0, 0x90, 0x86, 0x06, 0x74, 0xD2, 0xF0, 0xA3, 0x74, ++0x21, 0xF0, 0x22, 0x8F, 0x13, 0x7F, 0x02, 0x12, 0x85, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0x45, 0x13, ++0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, ++0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0x01, 0xC4, 0x74, 0x82, 0xF0, 0x74, 0xB9, 0xA3, 0xF0, 0x12, 0x6C, 0xD6, 0x12, 0x97, 0x93, 0x70, ++0x37, 0x90, 0x97, 0x2D, 0xE0, 0xFF, 0x20, 0xE0, 0x2F, 0xE5, 0x26, 0x30, 0xE3, 0x2A, 0x90, 0x00, ++0xCC, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x00, 0xD4, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x00, 0xC6, 0xE0, ++0x44, 0x02, 0xF0, 0x90, 0x00, 0x01, 0xE0, 0x54, 0xCF, 0xF0, 0x90, 0x00, 0x23, 0xE0, 0x54, 0x7F, ++0xF0, 0xEF, 0x44, 0x01, 0x90, 0x97, 0x2D, 0xF0, 0x74, 0x82, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, ++0xB9, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, ++0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, ++0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, ++0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x0E, ++0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0x12, 0x64, 0x7F, 0xE5, 0x30, 0x30, 0xE1, 0x02, 0x51, 0xB0, 0xE5, ++0x2D, 0x30, 0xE3, 0x03, 0x12, 0xD8, 0xF9, 0xE5, 0x2D, 0x30, 0xE4, 0x03, 0x12, 0xD9, 0x0C, 0xE5, ++0x2D, 0x30, 0xE5, 0x03, 0x12, 0xD9, 0x1D, 0xE5, 0x2F, 0x30, 0xE0, 0x02, 0x51, 0xB9, 0xE5, 0x2F, ++0x30, 0xE1, 0x03, 0x12, 0xB4, 0x60, 0xE5, 0x2F, 0x30, 0xE2, 0x03, 0x12, 0xC8, 0x7D, 0xE5, 0x2F, ++0x30, 0xE3, 0x02, 0x51, 0xC9, 0xE5, 0x2F, 0x30, 0xE4, 0x02, 0x71, 0x72, 0xE5, 0x2F, 0x30, 0xE5, ++0x02, 0x71, 0xD4, 0xE5, 0x2F, 0x30, 0xE6, 0x02, 0x51, 0xDB, 0x74, 0x0E, 0x04, 0x90, 0x01, 0xC4, ++0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, ++0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, ++0x90, 0x88, 0x36, 0xE0, 0x60, 0x02, 0x71, 0xF5, 0x22, 0x12, 0x98, 0xE7, 0xE4, 0xFF, 0x91, 0xCF, ++0x90, 0x8B, 0x07, 0x71, 0xCD, 0xF9, 0x02, 0x04, 0x7A, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x0A, ++0x90, 0x88, 0x36, 0xE0, 0x60, 0x04, 0x71, 0x8F, 0x71, 0x9A, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, ++0xBF, 0x01, 0x0E, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x08, 0x51, 0xF2, 0x54, 0x07, 0x70, 0x02, 0x71, ++0x62, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xE4, 0xF5, 0x10, 0x90, 0x06, 0xA9, ++0xE0, 0xF5, 0x10, 0x54, 0xC0, 0x70, 0x18, 0x51, 0xF2, 0x54, 0xFD, 0xF0, 0x71, 0x62, 0x90, 0x88, ++0x39, 0xE0, 0x60, 0x4D, 0x12, 0xB4, 0x41, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE5, ++0x10, 0x30, 0xE6, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x1C, 0x90, 0x88, 0x3A, 0xE0, ++0x44, 0x01, 0xF0, 0x91, 0x46, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x12, 0x8E, 0x2C, 0x80, ++0x07, 0x12, 0x73, 0x8F, 0x80, 0x02, 0x51, 0xF2, 0xE5, 0x10, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0D, ++0xE0, 0x44, 0x02, 0x71, 0x9A, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, ++0xF0, 0x22, 0x90, 0x88, 0x38, 0xE0, 0xFF, 0x90, 0x8A, 0xB9, 0x12, 0xAE, 0x43, 0x7D, 0x01, 0x02, ++0x04, 0x7E, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x15, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x71, ++0x8F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x91, 0xC4, 0x54, 0x07, 0x70, 0x02, 0x71, 0x62, 0x22, 0x90, ++0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, ++0x90, 0x88, 0x94, 0xE0, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x02, ++0x66, 0x33, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x11, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x06, 0x71, ++0xCA, 0xF9, 0x02, 0x04, 0x7A, 0xF1, 0xC3, 0x71, 0x62, 0x22, 0x90, 0x8B, 0x01, 0xE0, 0xFE, 0xA3, ++0xE0, 0xAA, 0x06, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x18, 0x90, 0x88, 0x36, 0xE0, ++0x60, 0x12, 0x91, 0x46, 0x64, 0x02, 0x60, 0x09, 0x90, 0x8A, 0xE1, 0x71, 0xCD, 0xF9, 0x02, 0x04, ++0x7A, 0x12, 0x73, 0x8F, 0x22, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xD1, 0xC7, 0x90, ++0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x3F, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x37, 0x90, 0x8A, ++0xD7, 0x12, 0x8E, 0x2C, 0x91, 0x46, 0x60, 0x1F, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, ++0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, ++0x7E, 0x71, 0xCA, 0xF9, 0x02, 0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x08, 0x90, 0x8A, 0xB9, ++0x12, 0x8D, 0x12, 0xD1, 0xAD, 0x22, 0x90, 0x88, 0x34, 0xE0, 0x54, 0x0F, 0x22, 0x12, 0xA6, 0x00, ++0x30, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xF1, 0x9D, 0x90, 0x88, ++0x31, 0x12, 0x97, 0xD8, 0x30, 0xE0, 0x09, 0xEF, 0x91, 0xC4, 0x54, 0x07, 0x70, 0x4D, 0x80, 0x49, ++0x90, 0x88, 0x3F, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEF, 0xF0, 0x12, 0xEE, 0xC2, ++0x40, 0x37, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x32, 0x91, 0x46, 0x70, 0x08, 0x90, 0x8A, 0xF5, ++0x12, 0x8E, 0x2C, 0x80, 0x27, 0x90, 0x8A, 0xF5, 0x12, 0x8E, 0x2C, 0x90, 0x88, 0x40, 0xE0, 0x04, ++0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x09, 0x91, 0xBC, 0xE4, 0x90, 0x88, 0x40, 0xF0, 0x80, 0x03, ++0x12, 0x73, 0x8F, 0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x22, 0x71, 0x62, 0x22, 0x90, 0x88, 0x32, 0xE0, ++0x54, 0xFB, 0xF0, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x25, 0x90, ++0x99, 0x58, 0x74, 0x1E, 0xF0, 0x90, 0x99, 0x7A, 0x74, 0x01, 0xF0, 0x90, 0x99, 0x5A, 0xEF, 0xF0, ++0x7B, 0x01, 0x7A, 0x99, 0x79, 0x58, 0x12, 0xEF, 0xA7, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0x12, 0x7F, ++0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xB1, 0x50, 0x12, 0xA4, 0xE4, 0x7F, 0x01, ++0x91, 0xCF, 0x90, 0x8B, 0x07, 0x12, 0x8E, 0x2C, 0x90, 0x93, 0x08, 0xE0, 0x30, 0xE0, 0x30, 0xF1, ++0xCB, 0x90, 0x93, 0x0B, 0xE0, 0x60, 0x05, 0x14, 0xF0, 0x02, 0x79, 0xD4, 0xF1, 0xDD, 0xE4, 0xFF, ++0x12, 0xA0, 0x11, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x20, 0xE0, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, ++0x30, 0xE0, 0x0C, 0x90, 0x9A, 0x04, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0xB1, 0x98, 0x22, ++0xE4, 0x90, 0x98, 0x82, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x3C, 0x12, 0xA7, 0xE6, 0x64, 0x01, ++0x70, 0x35, 0xF1, 0xAB, 0xF0, 0x12, 0xEF, 0x2C, 0x90, 0x98, 0x82, 0x74, 0x01, 0xF0, 0xE4, 0x90, ++0x88, 0x3D, 0xF0, 0x04, 0x60, 0x21, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, 0x90, 0x8A, 0xB9, ++0x12, 0x8D, 0x12, 0xD1, 0xAD, 0xF1, 0xB3, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x12, 0x98, 0xDD, 0x71, ++0xA4, 0x90, 0x8A, 0xD7, 0x12, 0x8E, 0x2C, 0x22, 0xE4, 0x90, 0x9A, 0x08, 0xF0, 0x7F, 0x03, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x03, 0xEF, 0xF0, 0xF1, 0x57, 0x90, 0x9A, 0x03, ++0xE0, 0xFF, 0xF1, 0x49, 0x74, 0x01, 0xF0, 0x90, 0x9A, 0x08, 0xE0, 0xFE, 0xEF, 0xD1, 0xB4, 0xEE, ++0xF0, 0x90, 0x9A, 0x03, 0xE0, 0xD1, 0x03, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0xB1, 0xF8, ++0x78, 0x10, 0x12, 0x03, 0xEB, 0xAB, 0x07, 0xB1, 0xF8, 0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, 0x92, ++0x20, 0xEF, 0xF0, 0xB1, 0xF8, 0x90, 0x92, 0x21, 0xEF, 0xF0, 0x7D, 0x01, 0x7F, 0x50, 0x7E, 0x01, ++0x12, 0x66, 0x33, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9A, 0x04, 0x02, 0x04, 0xB8, 0x90, 0x97, ++0xB3, 0xE0, 0xFB, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x08, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, ++0x22, 0xE4, 0x90, 0x97, 0xB3, 0xF0, 0x90, 0x97, 0xB3, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x40, 0x02, ++0xC1, 0xA5, 0xF1, 0x48, 0xE0, 0x64, 0x01, 0x70, 0x74, 0x90, 0x97, 0xB3, 0xE0, 0xD1, 0x03, 0x12, ++0x04, 0xB8, 0xE4, 0x7B, 0x01, 0xD1, 0xA6, 0x70, 0x3A, 0x90, 0x97, 0xB3, 0xE0, 0xFB, 0xD1, 0xB4, ++0xE0, 0x60, 0x21, 0x14, 0x70, 0x57, 0xEB, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x0C, 0xF5, 0x82, 0xE4, ++0x34, 0x99, 0xF5, 0x83, 0x12, 0x04, 0xB8, 0xEB, 0xD1, 0x03, 0x12, 0x04, 0x31, 0x90, 0x97, 0xB3, ++0xE0, 0xFF, 0x80, 0x0B, 0xB1, 0xFE, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0xAF, 0x03, 0xD1, ++0xC2, 0x80, 0x2A, 0x90, 0x97, 0xB3, 0xE0, 0xD1, 0x03, 0x12, 0x04, 0xB8, 0xE4, 0xFB, 0xD1, 0xA6, ++0x50, 0x1B, 0xB1, 0xFE, 0x12, 0x04, 0xB8, 0xEF, 0x24, 0xFF, 0xFF, 0xEE, 0x34, 0xFF, 0xFE, 0xED, ++0x34, 0xFF, 0xFD, 0xEC, 0x34, 0xFF, 0xFC, 0xEB, 0xD1, 0x03, 0x12, 0x04, 0x31, 0x90, 0x97, 0xB3, ++0xE0, 0x04, 0xF0, 0xC1, 0x16, 0x22, 0xFA, 0xF9, 0xF8, 0xC3, 0x02, 0x03, 0xDA, 0x7D, 0x01, 0x7F, ++0x04, 0x02, 0x04, 0x7E, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, ++0x83, 0x22, 0xEF, 0x24, 0xFC, 0x60, 0x05, 0x04, 0x70, 0x05, 0x80, 0x04, 0x12, 0xDA, 0x63, 0x22, ++0xE4, 0x90, 0x97, 0xB4, 0xF0, 0x90, 0x99, 0x07, 0x04, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x04, ++0xF0, 0x12, 0xE7, 0xB9, 0xE4, 0x90, 0x98, 0x88, 0xF0, 0xFF, 0xF1, 0x67, 0x12, 0xA7, 0xE6, 0x64, ++0x01, 0x70, 0x47, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x04, 0x7E, ++0x7F, 0x05, 0x7E, 0x00, 0x12, 0x7A, 0xAE, 0x12, 0xEF, 0xD8, 0x12, 0x8D, 0x12, 0xF1, 0xA4, 0x90, ++0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, 0x23, 0x90, 0x97, 0xB4, 0xE0, 0x04, 0xF0, 0x7F, 0x01, 0x7E, ++0x00, 0x12, 0x7A, 0xAE, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x04, ++0x7E, 0x90, 0x97, 0xB4, 0xE0, 0xD3, 0x94, 0x0A, 0x40, 0xD5, 0x90, 0x9A, 0x04, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x00, 0x0A, 0xF1, 0xBB, 0xA1, 0x9F, 0xEF, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x11, 0xF5, ++0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x22, 0x90, 0x01, 0x53, 0xE4, 0xF0, 0xFF, 0xF1, 0x48, 0xE4, ++0xF0, 0x0F, 0xEF, 0xB4, 0x08, 0xF7, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, ++0xD9, 0xEF, 0xF0, 0x90, 0x93, 0x06, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x74, 0x10, 0x2F, 0xFF, 0x90, ++0x97, 0xD9, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x2F, 0xFF, 0x12, 0xC7, 0x81, 0x75, 0x48, 0x04, 0x7B, ++0x01, 0x7A, 0x98, 0x79, 0x9B, 0x12, 0x69, 0xF5, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x02, 0x7F, ++0x02, 0x02, 0x7C, 0x7E, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x88, 0x3C, 0xE0, 0x90, ++0x05, 0x73, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xE4, 0x90, 0x9A, 0x08, 0xF0, ++0x7F, 0x04, 0x22, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x90, 0x93, 0x0A, 0xE0, 0x90, ++0x05, 0x73, 0xF0, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x02, 0x91, 0x4D, 0x22, 0x90, 0x93, 0x09, ++0xE0, 0x14, 0x90, 0x93, 0x0B, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, ++0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, ++0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xE7, 0xF0, 0x74, 0xBF, 0xA3, 0xF0, 0x12, 0x75, ++0x50, 0xE5, 0x3D, 0x30, 0xE0, 0x03, 0x12, 0xD9, 0x59, 0xE5, 0x3D, 0x30, 0xE1, 0x03, 0x12, 0xBF, ++0xD4, 0xE5, 0x3D, 0x30, 0xE2, 0x03, 0x12, 0xBB, 0xB2, 0xE5, 0x3D, 0x30, 0xE4, 0x02, 0xF1, 0xE7, ++0xE5, 0x3E, 0x30, 0xE0, 0x03, 0x12, 0xC8, 0x8F, 0xE5, 0x3F, 0x30, 0xE2, 0x09, 0x11, 0x9B, 0x90, ++0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, 0x40, 0x30, 0xE1, 0x0B, 0x90, 0x8A, 0xE5, 0x12, 0x8D, ++0x12, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, 0x40, 0x30, 0xE4, 0x03, 0x12, 0xBD, 0x09, 0xE5, 0x40, ++0x30, 0xE5, 0x03, 0x12, 0xCF, 0xFF, 0xE5, 0x40, 0x30, 0xE6, 0x02, 0x31, 0xA1, 0xE5, 0x40, 0x30, ++0xE7, 0x03, 0x12, 0xCF, 0xDF, 0x74, 0xE7, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBF, 0xA3, 0xF0, ++0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, ++0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x2E, 0x90, 0x88, 0xF7, 0xE0, 0xB4, 0x01, 0x17, ++0xA3, 0xE0, 0xB4, 0x01, 0x22, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0x90, 0x8A, 0x7F, 0x11, 0xDC, 0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, 0xB4, 0x02, 0x09, 0x74, 0x03, ++0xF0, 0x90, 0x8A, 0xE7, 0x12, 0x8E, 0x2C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, ++0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0x9A, 0x1F, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x9D, ++0xE0, 0x30, 0xE0, 0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, ++0x3F, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x9A, 0x23, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0x12, 0x7D, ++0x26, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x12, 0x8E, 0x29, 0xEF, 0x64, 0x01, 0x70, 0x02, 0x80, 0x05, ++0x31, 0x8B, 0x30, 0xE0, 0x07, 0x12, 0x9A, 0x28, 0x31, 0x95, 0x11, 0xDC, 0x90, 0x9A, 0x23, 0xE0, ++0xFF, 0x90, 0x8A, 0xF9, 0x12, 0xAE, 0x43, 0x7D, 0x27, 0x12, 0x04, 0x7E, 0x31, 0x82, 0x80, 0x09, ++0x31, 0x82, 0x11, 0xDC, 0x12, 0x9A, 0x28, 0x31, 0x95, 0x11, 0xDC, 0x90, 0x88, 0x9D, 0xE0, 0x30, ++0xE0, 0x17, 0x31, 0x8B, 0x30, 0xE0, 0x12, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x6F, 0xFF, 0x90, 0x8A, ++0xF9, 0x12, 0xAE, 0x43, 0x7D, 0x28, 0x12, 0x04, 0x7E, 0x31, 0xFD, 0x7F, 0x01, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0x9A, 0x1F, 0xE0, 0xFF, 0x90, 0x8A, 0xC7, 0x22, 0x90, 0x88, 0xA1, 0xE0, 0xC4, ++0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x9A, 0x21, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x9B, ++0x22, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0x12, 0x8F, 0xDB, 0x30, 0xE0, 0x21, 0xEF, 0x54, 0x7F, 0x12, ++0xD0, 0x42, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFD, 0xF0, 0x12, ++0xD0, 0x4B, 0x04, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0xBB, 0x62, 0x31, 0x8B, 0x30, ++0xE0, 0x22, 0x90, 0x88, 0xA4, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x18, 0xEF, 0x54, 0xFD, 0xF0, ++0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0xA4, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x04, ++0xE0, 0x54, 0xFB, 0xF0, 0x7F, 0x01, 0x02, 0x97, 0x1E, 0xE4, 0xFF, 0x91, 0xCF, 0x90, 0x04, 0x1F, ++0x74, 0x20, 0xF0, 0x22, 0x90, 0x97, 0xE0, 0x12, 0x85, 0xF7, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x97, ++0xF1, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0C, 0x7B, 0x39, 0x12, 0x8E, 0x22, 0xEF, 0x64, 0x01, ++0x70, 0x16, 0x80, 0x00, 0x90, 0x95, 0xBD, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x11, 0xF1, 0xCC, ++0x90, 0x97, 0xEE, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x97, 0xEE, 0x12, 0xE3, 0x28, 0x90, 0x97, ++0xF0, 0xEF, 0xF0, 0x90, 0x97, 0xEE, 0xF1, 0xEA, 0x90, 0x97, 0xEC, 0xE0, 0xFD, 0x12, 0xE1, 0x20, ++0x90, 0x97, 0xED, 0xE0, 0x60, 0x02, 0x41, 0xE8, 0x91, 0xDA, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, ++0x90, 0x97, 0xE3, 0x71, 0xA6, 0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x71, 0x92, ++0xD1, 0xE2, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x97, 0xE0, 0x71, 0xA6, ++0x75, 0x48, 0x10, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x71, 0x92, 0xE0, 0x2F, 0x91, 0xDD, 0xC0, ++0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x97, 0xE6, 0x71, 0xA6, 0x75, 0x48, 0x10, 0xD0, 0x01, 0xD0, ++0x02, 0xD0, 0x03, 0x71, 0x92, 0xE0, 0x2F, 0x24, 0x60, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, ++0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x97, 0xE6, 0x71, 0xA6, 0x75, 0x48, 0x10, 0xD0, 0x01, ++0xD0, 0x02, 0xD0, 0x03, 0x71, 0x92, 0xE0, 0x2F, 0x24, 0x72, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, ++0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x97, 0xE9, 0x71, 0xA6, 0x75, 0x48, 0x06, 0xD0, ++0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x97, 0xE6, 0x12, 0x85, 0xEE, 0x90, 0x98, ++0x1D, 0x12, 0x85, 0xF7, 0x90, 0x98, 0x20, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x20, 0x90, 0x98, ++0x24, 0x74, 0x3A, 0xF0, 0x90, 0x97, 0xE0, 0x12, 0x85, 0xEE, 0xF1, 0x8F, 0x71, 0x95, 0xD1, 0xC4, ++0xF1, 0x87, 0x75, 0x48, 0x28, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xF2, 0x71, 0x92, 0xD1, 0xC4, 0xFA, ++0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, 0x47, 0xCD, 0x75, 0x48, 0x28, 0xD0, ++0x03, 0x12, 0x69, 0xF5, 0x90, 0x97, 0xF0, 0xE0, 0xFF, 0x90, 0x97, 0xEF, 0xE0, 0x2F, 0xFF, 0x90, ++0x97, 0xEE, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x30, 0xFD, 0xE4, 0x3F, 0xFC, 0x90, 0x95, 0xBD, 0xE0, ++0xFB, 0x7F, 0x3A, 0x91, 0xE7, 0x71, 0x95, 0xD1, 0xC4, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x45, ++0x75, 0x46, 0x97, 0x75, 0x47, 0xF2, 0x75, 0x48, 0x28, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x95, ++0xB9, 0xE0, 0xB4, 0x02, 0x0D, 0x90, 0x95, 0xBD, 0xE0, 0xFF, 0x90, 0x97, 0xF0, 0xE0, 0xFD, 0x12, ++0xCC, 0xBA, 0x90, 0x06, 0x33, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x97, 0xF1, 0xE0, 0xFD, 0x7B, 0x3A, ++0x21, 0xF9, 0x12, 0x69, 0xF5, 0x90, 0x97, 0xEE, 0xA3, 0xE0, 0xFF, 0xA3, 0x22, 0x90, 0x97, 0x32, ++0x12, 0x85, 0xF7, 0x90, 0x97, 0x32, 0x12, 0x85, 0xEE, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x99, 0xB4, 0x12, 0x85, 0xF7, 0x78, 0xC0, 0x7C, ++0x99, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x8E, 0x12, 0x9F, 0xB7, 0x90, 0x05, 0x22, 0xE0, ++0x90, 0x99, 0xBF, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0C, 0x7B, 0x33, 0x12, 0x8E, 0x22, 0xEF, ++0x64, 0x01, 0x70, 0x16, 0x80, 0x00, 0x90, 0x95, 0xBC, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x10, ++0xF1, 0xCC, 0x90, 0x99, 0xBC, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0xBC, 0x12, 0xE3, 0x28, ++0x90, 0x99, 0xBE, 0xEF, 0xF0, 0x90, 0x99, 0xBC, 0xF1, 0xEA, 0x90, 0x99, 0xBA, 0xE0, 0xFD, 0x12, ++0xE1, 0x20, 0x90, 0x99, 0xBB, 0xE0, 0x70, 0x49, 0x91, 0xDA, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, ++0x90, 0x99, 0xB7, 0x71, 0xA6, 0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0xE3, ++0xDB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x99, 0xB7, 0x71, 0xA6, 0x75, ++0x48, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0xD1, 0xD8, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, ++0x02, 0xC0, 0x01, 0x90, 0x99, 0xB4, 0x71, 0xA6, 0x75, 0x48, 0x04, 0xD0, 0x01, 0xD0, 0x02, 0x80, ++0x40, 0x90, 0x99, 0xBB, 0xE0, 0x64, 0x01, 0x70, 0x3D, 0x91, 0xDA, 0xC0, 0x03, 0x8B, 0x45, 0x75, ++0x46, 0x93, 0x75, 0x47, 0x49, 0x75, 0x48, 0x06, 0xD0, 0x03, 0x12, 0xE3, 0xDB, 0xFA, 0x7B, 0x01, ++0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, 0x47, 0x53, 0x75, 0x48, 0x06, 0xD0, 0x03, 0xD1, ++0xD8, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, 0x47, 0x59, 0x75, 0x48, ++0x04, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x95, 0xB9, 0xE0, 0xB4, 0x02, 0x0D, 0x90, 0x95, 0xBC, ++0xE0, 0xFF, 0x90, 0x99, 0xBE, 0xE0, 0xFD, 0x12, 0xCC, 0xBA, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x10, ++0xF0, 0x90, 0x99, 0xBF, 0xE0, 0xFD, 0x7B, 0x34, 0x31, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, ++0x05, 0x22, 0xED, 0xF0, 0x90, 0x93, 0x01, 0xEB, 0xF0, 0x22, 0xA3, 0xA3, 0xE0, 0x24, 0x38, 0xF9, ++0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x99, ++0xD5, 0xEC, 0x12, 0x97, 0xBA, 0xAA, 0x07, 0x90, 0x99, 0xDC, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, ++0x00, 0xF1, 0xDC, 0xEA, 0x24, 0xEF, 0x60, 0x34, 0x24, 0xD7, 0x70, 0x02, 0xC1, 0x41, 0x24, 0x3A, ++0x60, 0x02, 0xC1, 0x75, 0xD1, 0xB5, 0x24, 0x0A, 0xD1, 0xEB, 0xE4, 0xD1, 0xA9, 0xE4, 0xF0, 0xFE, ++0x74, 0x00, 0x2F, 0xF1, 0xD4, 0x7D, 0x14, 0xD1, 0x90, 0x12, 0xCF, 0x6A, 0xD1, 0x9B, 0x90, 0x90, ++0xBE, 0x12, 0x04, 0x31, 0x7D, 0x14, 0x7C, 0x00, 0xE4, 0xFF, 0xC1, 0x3C, 0x90, 0x99, 0xD5, 0xE4, ++0x75, 0xF0, 0x14, 0x12, 0x02, 0xE7, 0x90, 0x99, 0xD5, 0xA3, 0xE0, 0xFB, 0xFF, 0x24, 0x06, 0xFC, ++0xE4, 0x33, 0x90, 0x99, 0xE0, 0xF0, 0xA3, 0xCC, 0xF0, 0x90, 0x99, 0xE0, 0xA3, 0xE0, 0xD1, 0xF5, ++0xE4, 0xD1, 0xA9, 0xE4, 0x12, 0xCF, 0xB6, 0xE0, 0xFE, 0xA9, 0x03, 0x74, 0x05, 0x29, 0x12, 0xCE, ++0x4F, 0xFE, 0x90, 0x99, 0xDA, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0xD5, 0xE0, 0xFC, 0xA3, 0xE0, ++0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0xD3, 0xEF, 0x94, 0x00, 0xEE, 0x94, 0x01, 0x90, 0x99, 0xD5, 0x40, ++0x69, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xE9, 0x7C, 0x00, 0x24, 0x00, 0xF9, 0xEC, 0x34, 0xFC, 0xFA, ++0x7B, 0x01, 0xC3, 0xE4, 0x9F, 0xFD, 0x74, 0x01, 0x9E, 0xFC, 0xD1, 0x92, 0x90, 0x99, 0xD7, 0xE0, ++0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xD1, 0xD2, ++0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0x7B, 0x01, 0x7A, 0xFC, 0x79, 0x00, 0x90, 0x99, ++0xD5, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0xE4, 0x9F, 0xFF, 0x74, 0x01, 0x9E, 0xFE, 0xD1, 0xBC, ++0xC3, 0x9F, 0xFD, 0xEC, 0x9E, 0xFC, 0x12, 0x45, 0xC2, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0x12, 0x85, 0xAD, 0xD1, 0x95, 0xF1, 0xDC, 0x80, 0x0D, 0xA3, 0xE0, 0x7E, 0x00, 0x24, 0x00, ++0xF1, 0xD4, 0xD1, 0xBC, 0xFD, 0xD1, 0x92, 0x90, 0x99, 0xD5, 0x74, 0xFF, 0x75, 0xF0, 0xEC, 0x12, ++0x02, 0xE7, 0xD1, 0xB5, 0x7E, 0x00, 0x24, 0x0C, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, ++0x02, 0xC0, 0x01, 0x74, 0x10, 0x2F, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0xD1, 0x9B, 0x90, 0x90, 0xBE, ++0x12, 0x04, 0x31, 0xD1, 0xBC, 0xFD, 0xD0, 0x01, 0xD0, 0x02, 0x7F, 0x11, 0x12, 0x3C, 0xD9, 0x80, ++0x2C, 0xD1, 0xB5, 0x24, 0x2A, 0xD1, 0xEB, 0xE4, 0xD1, 0xA9, 0xE4, 0xF0, 0x12, 0xCF, 0xAB, 0x7D, ++0x48, 0xD1, 0x90, 0xD1, 0xA1, 0xD1, 0xCD, 0x12, 0x85, 0xAD, 0xE4, 0xFD, 0xFC, 0xD1, 0x95, 0xD1, ++0xA1, 0xD1, 0xCD, 0x12, 0x85, 0xAD, 0xD1, 0x95, 0xD1, 0xA1, 0x12, 0x03, 0xCD, 0x90, 0x99, 0xD8, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0xD8, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, 0xFF, 0x90, ++0x99, 0xE0, 0xA3, 0xE0, 0xD1, 0xF5, 0xEF, 0xD1, 0xA9, 0xED, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x7C, 0x00, 0x12, 0x45, 0xC2, 0x90, 0x99, 0xDC, 0x02, 0x04, 0x31, 0x90, 0x90, 0xBB, 0x12, 0x85, ++0xF7, 0x90, 0x99, 0xDC, 0x02, 0x04, 0xB8, 0x74, 0x03, 0xF0, 0x74, 0x01, 0x2E, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x99, 0xD5, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x99, 0xDA, 0xE0, ++0xFC, 0xA3, 0xE0, 0x22, 0xE0, 0x2F, 0x24, 0x30, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0x78, 0x10, 0x12, ++0x03, 0xEB, 0x90, 0x99, 0xDC, 0x02, 0x85, 0xE2, 0x12, 0x69, 0xF5, 0x90, 0x99, 0xBC, 0xA3, 0xE0, ++0xFF, 0xA3, 0xE0, 0x2F, 0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0xFD, 0xE4, 0x33, 0x90, 0x99, ++0xE0, 0xF0, 0xA3, 0xED, 0xF0, 0xFE, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x07, 0x12, 0xD7, 0x8E, 0xD1, 0xF8, 0xE0, ++0x90, 0x98, 0xA4, 0xF0, 0x74, 0x01, 0x2F, 0xD1, 0xAD, 0xE0, 0x90, 0x98, 0xC5, 0x12, 0xD3, 0xF9, ++0x90, 0x98, 0xE6, 0xF0, 0xEF, 0x24, 0x20, 0x90, 0x97, 0x32, 0xF0, 0xF1, 0x81, 0x90, 0x98, 0xA4, ++0xE0, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0xA5, 0x12, 0x69, 0xF5, 0x90, 0x98, 0xA4, 0xF1, ++0x78, 0x90, 0x98, 0xC5, 0xE0, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0xC6, 0x12, 0x69, 0xF5, ++0x90, 0x98, 0xC5, 0xF1, 0x78, 0x90, 0x98, 0xE6, 0xE0, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x98, 0x79, ++0xE7, 0x12, 0x69, 0xF5, 0xE4, 0xFF, 0x90, 0x98, 0xA4, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x03, ++0x0F, 0x80, 0xF3, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x90, 0x97, 0x32, 0xE0, 0x2F, 0xF0, ++0xE0, 0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x45, 0x01, 0xF5, 0x46, 0x89, 0x47, 0x22, 0x90, ++0x98, 0x1A, 0x12, 0x85, 0xF7, 0x90, 0x98, 0x1D, 0x71, 0xA6, 0x75, 0x48, 0x10, 0x7B, 0x01, 0x7A, ++0x93, 0x79, 0xCD, 0x12, 0x69, 0xF5, 0x90, 0x98, 0x1A, 0x71, 0xA6, 0x75, 0x48, 0x10, 0x7B, 0x01, ++0x7A, 0x93, 0x79, 0xDD, 0x12, 0x69, 0xF5, 0x90, 0x98, 0x20, 0x12, 0x04, 0xB8, 0x90, 0x93, 0xED, ++0x12, 0x04, 0x31, 0x90, 0x98, 0x24, 0xE0, 0x90, 0x93, 0xF4, 0xF0, 0x22, 0xF0, 0x7B, 0x18, 0x7D, ++0x01, 0x02, 0x66, 0xDB, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0x90, 0x99, 0xD7, 0xE0, ++0xC3, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0x22, 0x02, 0x34, 0x78, 0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, ++0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, ++0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, ++0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xF6, 0xF0, 0x74, 0xC7, 0xA3, 0xF0, 0x90, 0x8A, 0x9D, ++0x12, 0x8E, 0x2C, 0x53, 0x91, 0xBF, 0x74, 0xF6, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC7, 0xA3, ++0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, ++0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x4C, 0x90, 0x01, 0xC4, ++0xED, 0xF0, 0x74, 0xC8, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, ++0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x95, 0xD6, ++0xE0, 0x04, 0xF0, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, 0x03, 0x12, 0xA0, 0x66, 0x22, 0x11, ++0xD8, 0x90, 0x98, 0x82, 0xEF, 0xF0, 0x90, 0x8A, 0x89, 0x30, 0xE0, 0x13, 0x12, 0x8D, 0x12, 0x7D, ++0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x09, 0x12, ++0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x98, 0x82, 0xE0, 0x30, 0xE6, 0x11, 0x90, ++0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, ++0xF1, 0xCE, 0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0xE4, 0x90, 0x98, 0x84, 0xF0, 0xA3, 0xF0, 0x7F, ++0x83, 0x12, 0x7B, 0x41, 0x90, 0x98, 0x83, 0xEF, 0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, 0xAE, 0x07, ++0x90, 0x98, 0x83, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x98, 0x85, 0xE0, 0x94, 0x64, ++0x90, 0x98, 0x84, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, ++0x98, 0x83, 0xE0, 0xFF, 0x22, 0x90, 0x98, 0x84, 0x31, 0x1C, 0x80, 0xC3, 0xE4, 0x75, 0xF0, 0x01, ++0x02, 0x02, 0xE7, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, 0xC1, 0xF1, 0xA4, 0xED, ++0xF0, 0x90, 0x97, 0xD9, 0x74, 0x18, 0xF0, 0x7E, 0x00, 0x7F, 0x80, 0x7D, 0x00, 0x7B, 0x01, 0x7A, ++0x97, 0x79, 0xE1, 0x12, 0x04, 0x80, 0x90, 0x01, 0xC4, 0x74, 0x23, 0xF0, 0x74, 0xC9, 0xA3, 0xF0, ++0x90, 0x95, 0xBE, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, 0x97, 0xD8, 0xEF, 0xF0, 0xF9, 0xE0, 0xFE, ++0x24, 0x29, 0xF1, 0x99, 0x74, 0x41, 0xF0, 0xEE, 0x24, 0x28, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x97, ++0xD9, 0xE0, 0x7A, 0x00, 0x2D, 0xFE, 0xEA, 0x3C, 0x90, 0x97, 0xDD, 0xF0, 0xA3, 0xCE, 0xF0, 0x74, ++0x28, 0x29, 0x12, 0xC7, 0xEE, 0x90, 0x97, 0xC3, 0xE0, 0xFD, 0x12, 0xE1, 0x20, 0x91, 0x17, 0x90, ++0x97, 0xDD, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x97, 0xDB, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x97, ++0xE1, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0x74, 0x5F, 0xF0, 0x90, ++0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x04, 0x12, 0x02, 0xE7, 0x90, 0x94, 0x39, 0xE0, 0xFF, 0x7E, 0x02, ++0xB4, 0xFE, 0x02, 0x7E, 0xFE, 0x90, 0x97, 0xDD, 0xA3, 0xE0, 0xFD, 0x12, 0xC6, 0xF6, 0xEE, 0xF0, ++0x74, 0x00, 0x2D, 0x12, 0xC6, 0xF8, 0xE0, 0x90, 0x97, 0xE5, 0xF0, 0x90, 0x97, 0xDD, 0x31, 0x1C, ++0x90, 0x95, 0x2E, 0xE0, 0x90, 0x97, 0xC1, 0xB4, 0x01, 0x0B, 0xE0, 0x44, 0x03, 0xFC, 0xA3, 0xE0, ++0x44, 0x10, 0xFD, 0x80, 0x09, 0xE0, 0x44, 0x03, 0xFC, 0xA3, 0xE0, 0x44, 0x20, 0xFD, 0x90, 0x97, ++0xDF, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x97, 0xC1, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, ++0x90, 0x97, 0xDD, 0x70, 0x17, 0xA3, 0xE0, 0x12, 0xC6, 0xF5, 0x12, 0xC6, 0xA7, 0x74, 0x01, 0xF0, ++0x90, 0x97, 0xE6, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x01, 0xF0, 0x80, 0x13, 0xA3, 0xE0, 0x12, 0xC6, ++0xF5, 0x12, 0xC6, 0xA7, 0x74, 0x02, 0xF0, 0x90, 0x97, 0xE6, 0x04, 0xF0, 0xA3, 0x14, 0xF0, 0x91, ++0x4C, 0xEF, 0x64, 0xFE, 0x90, 0x97, 0xDD, 0x70, 0x1E, 0xA3, 0xE0, 0x24, 0x00, 0xF1, 0xAE, 0xC0, ++0x03, 0x8B, 0x45, 0x91, 0x56, 0xD0, 0x03, 0x12, 0x97, 0x8C, 0x91, 0x56, 0x7B, 0x01, 0x7A, 0x97, ++0x79, 0xE8, 0x12, 0x69, 0xF5, 0x80, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x24, 0x00, 0xF5, 0x82, ++0x74, 0xFC, 0x3E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2F, 0xF5, 0x82, 0x74, 0xFC, 0x3E, 0xF5, ++0x83, 0xE4, 0xF0, 0x90, 0x97, 0xE8, 0xF0, 0xA3, 0xF0, 0x91, 0x4C, 0xE4, 0x90, 0x97, 0xDA, 0xF0, ++0x91, 0x60, 0xFE, 0x90, 0x97, 0xDD, 0xA3, 0xE0, 0xFD, 0xEF, 0x2D, 0x12, 0xC6, 0xF6, 0xEE, 0xF0, ++0x91, 0x60, 0xFE, 0x74, 0xEA, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xEE, 0x91, 0x0F, ++0xE0, 0xB4, 0x08, 0xDC, 0x91, 0x21, 0x90, 0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x20, 0x12, 0x02, 0xE7, ++0x90, 0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x10, 0x12, 0x02, 0xE7, 0x91, 0x17, 0xE4, 0x90, 0x98, 0x64, ++0xF0, 0xE4, 0x90, 0x97, 0xDA, 0xF0, 0x91, 0x43, 0x50, 0x0C, 0x91, 0x90, 0xF0, 0xE0, 0x12, 0xC6, ++0xF6, 0xE4, 0x91, 0x0F, 0x80, 0xF0, 0x12, 0xAF, 0xEA, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xFB, 0xF0, ++0x90, 0x95, 0xBF, 0x91, 0xB1, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xB1, 0xEB, ++0xED, 0xFF, 0x90, 0x95, 0xBE, 0xB1, 0xF5, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, ++0x97, 0xD9, 0xE0, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x3E, 0xCF, 0x24, 0x38, 0xCF, 0x34, 0x00, 0xFE, ++0x90, 0x92, 0x06, 0x74, 0x10, 0xF0, 0x7B, 0x63, 0xE4, 0xFD, 0x12, 0x71, 0xD4, 0x90, 0x97, 0xC1, ++0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xE1, 0x70, 0x15, 0x90, ++0x91, 0xA0, 0x91, 0x3B, 0x90, 0x91, 0xA3, 0x12, 0x85, 0xF7, 0x90, 0x91, 0xA6, 0x91, 0x33, 0x12, ++0x6F, 0x34, 0x80, 0x13, 0x90, 0x91, 0x96, 0x91, 0x3B, 0x90, 0x91, 0x99, 0x12, 0x85, 0xF7, 0x90, ++0x91, 0x9C, 0x91, 0x33, 0x12, 0x6E, 0xF3, 0x90, 0x98, 0x64, 0xE0, 0x04, 0xF0, 0x90, 0x06, 0x31, ++0xE0, 0x30, 0xE2, 0x06, 0x91, 0x2B, 0x50, 0x02, 0x41, 0xD1, 0x91, 0x2B, 0x40, 0x0A, 0x90, 0x06, ++0x35, 0xE0, 0x44, 0x20, 0x90, 0x06, 0x34, 0xF0, 0xE4, 0x90, 0x97, 0xDA, 0xF0, 0x91, 0x43, 0x50, ++0x1E, 0x91, 0x90, 0xF0, 0x90, 0x97, 0xDA, 0xE0, 0x24, 0xC4, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, ++0x83, 0xE0, 0xFF, 0x90, 0x97, 0xD8, 0xE0, 0x12, 0xC6, 0xF6, 0xEF, 0x91, 0x0F, 0x80, 0xDE, 0x90, ++0x97, 0xC1, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x0E, 0x90, 0x95, 0xBE, 0xE0, 0xFF, ++0x90, 0x97, 0xD9, 0xE0, 0x24, 0x08, 0xFD, 0x91, 0xBA, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x20, 0x90, ++0x05, 0x22, 0xE0, 0x90, 0x98, 0x63, 0xF0, 0x7B, 0x1D, 0x12, 0x8E, 0x22, 0xBF, 0x01, 0x02, 0x91, ++0x70, 0x90, 0x98, 0x63, 0xE0, 0xFD, 0x7B, 0x1E, 0xE4, 0xFF, 0x12, 0xC4, 0xCF, 0x80, 0x02, 0x91, ++0x70, 0x12, 0xC1, 0xFD, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x74, ++0x23, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC9, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, ++0x90, 0x97, 0xDA, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x02, ++0xE7, 0x90, 0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x08, 0x02, 0x02, 0xE7, 0x90, 0x98, 0x64, 0xE0, 0xC3, ++0x94, 0x0A, 0x22, 0x74, 0x10, 0xF0, 0x7A, 0x93, 0x79, 0xF5, 0x22, 0x12, 0x85, 0xF7, 0x7A, 0x97, ++0x79, 0xC4, 0x22, 0x90, 0x97, 0xDA, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x22, 0x90, 0x97, 0xDD, 0xE4, ++0x75, 0xF0, 0x02, 0x02, 0x02, 0xE7, 0x75, 0x46, 0x94, 0x75, 0x47, 0x3C, 0x75, 0x48, 0x02, 0x22, ++0x90, 0x97, 0xDA, 0xE0, 0xFF, 0x24, 0x3E, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0x22, ++0x90, 0x95, 0xBE, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x08, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0x12, ++0x66, 0xDB, 0x90, 0x97, 0xD8, 0xEF, 0xF0, 0x90, 0x95, 0xBE, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x22, ++0x90, 0x97, 0xDE, 0xE0, 0x2F, 0xFF, 0x90, 0x97, 0xDD, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x98, 0x61, ++0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0xBE, 0xE0, 0xFD, 0x12, 0x7B, 0x8B, 0x90, 0x97, 0xD8, 0xEF, ++0x22, 0xE0, 0xFD, 0x75, 0xF0, 0x80, 0xA4, 0xAE, 0xF0, 0x22, 0x90, 0x99, 0xC7, 0xED, 0xF0, 0x90, ++0x99, 0xC6, 0xEF, 0xF0, 0x12, 0x7B, 0x07, 0x90, 0x99, 0xD4, 0xEF, 0xF0, 0xE0, 0xFD, 0x24, 0x01, ++0x12, 0xC6, 0xAD, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0x12, 0xC6, 0xF8, 0xD1, 0x56, 0x54, 0x3F, 0x90, ++0x99, 0xD1, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0x99, 0xD0, 0xF0, 0xD1, 0x19, 0x50, 0x0C, 0xD1, ++0x22, 0xF0, 0xE0, 0x12, 0xC6, 0xF6, 0xE4, 0xD1, 0x01, 0x80, 0xF0, 0x90, 0x99, 0xD2, 0xE0, 0x24, ++0xF8, 0xFB, 0x90, 0x99, 0xD1, 0xE0, 0x34, 0xFF, 0xFA, 0x90, 0x99, 0xC7, 0xE0, 0xFF, 0x90, 0x91, ++0xDC, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0x74, 0x01, 0xF0, 0x7D, 0x0A, 0x7C, 0x00, 0x7F, 0x10, ++0x7E, 0x00, 0x12, 0x6D, 0xED, 0x90, 0x95, 0xBF, 0xE0, 0xFF, 0x90, 0x99, 0xC6, 0xE0, 0xFD, 0xD3, ++0x9F, 0x40, 0x38, 0x90, 0x95, 0xBF, 0xE0, 0xFC, 0x91, 0xB3, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, ++0x13, 0xD8, 0xF9, 0xB1, 0xEB, 0xEC, 0xFF, 0xC3, 0xED, 0xB1, 0xF7, 0xC3, 0x33, 0xCE, 0x33, 0xCE, ++0xD8, 0xF9, 0x24, 0x28, 0xFF, 0xE4, 0x3E, 0xFE, 0xD1, 0x11, 0xFD, 0x90, 0x99, 0xC7, 0xE0, 0xFC, ++0xC3, 0xED, 0x9C, 0xD1, 0x09, 0x7D, 0x38, 0x7C, 0x00, 0x80, 0x35, 0x90, 0x99, 0xC6, 0x91, 0xB1, ++0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xB1, 0xEB, 0xED, 0xFF, 0x90, 0x95, 0xBF, ++0xB1, 0xF5, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x38, 0xFD, 0xE4, 0x3E, 0xFC, 0xD1, ++0x11, 0xFF, 0x90, 0x99, 0xC7, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, 0xD1, 0x09, 0x7F, 0x28, 0x7E, 0x00, ++0x12, 0x71, 0xD4, 0xF1, 0x6A, 0x90, 0x91, 0x45, 0x12, 0x85, 0xF7, 0x0B, 0x7A, 0x99, 0x79, 0xC8, ++0x90, 0x91, 0x48, 0x12, 0x85, 0xF7, 0x90, 0x91, 0x4B, 0x74, 0x08, 0xF0, 0x7A, 0x94, 0x79, 0x2D, ++0x12, 0x4E, 0xA5, 0xE4, 0x90, 0x99, 0xD0, 0xF0, 0xD1, 0x19, 0x50, 0x1E, 0xD1, 0x22, 0xF0, 0x90, ++0x99, 0xD0, 0xE0, 0x24, 0xC8, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x99, ++0xD3, 0xE0, 0x12, 0xC6, 0xF6, 0xEF, 0xD1, 0x01, 0x80, 0xDE, 0x22, 0xFF, 0x90, 0x92, 0x07, 0xEE, ++0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xE0, 0xC3, 0x9F, 0xFF, 0xE4, 0x94, 0x00, 0xFE, 0xEF, 0x78, 0x07, ++0x22, 0xF0, 0x90, 0x99, 0xD0, 0xE0, 0x04, 0xF0, 0x22, 0xFB, 0x90, 0x92, 0x06, 0x74, 0x08, 0xF0, ++0x22, 0x90, 0x99, 0xD1, 0xA3, 0xE0, 0x24, 0xF8, 0x22, 0x90, 0x99, 0xD0, 0xE0, 0xFF, 0xC3, 0x94, ++0x08, 0x22, 0x90, 0x99, 0xD4, 0xE0, 0xFD, 0x90, 0x99, 0xD2, 0xE0, 0x2D, 0xFD, 0x90, 0x99, 0xD1, ++0xE0, 0x34, 0x00, 0xCD, 0x24, 0x20, 0xCD, 0x34, 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, ++0x3C, 0xFE, 0x90, 0x99, 0xC6, 0xE0, 0xFD, 0x12, 0x7B, 0x8B, 0x90, 0x99, 0xD3, 0xEF, 0x22, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0x90, ++0x97, 0xC0, 0xED, 0xF0, 0x90, 0x97, 0xBE, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xE6, 0x15, 0x90, ++0x97, 0xBE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x21, 0x23, 0xAD, 0x07, 0x90, 0x95, ++0x6D, 0x31, 0x1C, 0x90, 0x95, 0x6D, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x04, 0x2E, 0xF1, 0xBA, 0xEF, ++0xF0, 0x90, 0x95, 0x6D, 0xA3, 0xE0, 0xFF, 0x74, 0x05, 0x2E, 0xF1, 0x91, 0xEF, 0xF0, 0x22, 0xE4, ++0x90, 0x98, 0x7D, 0xF0, 0xA3, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0x76, 0x9B, ++0xEF, 0x64, 0x01, 0x70, 0x71, 0x90, 0x95, 0xC6, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x0D, 0xF0, ++0x7B, 0x08, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x98, 0x7A, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, ++0x98, 0x7A, 0x12, 0xE3, 0x28, 0x90, 0x98, 0x7C, 0xEF, 0xF0, 0x90, 0x98, 0x7A, 0x12, 0xC7, 0xEA, ++0xE4, 0xFD, 0x12, 0xE1, 0x20, 0x90, 0x98, 0x7C, 0xE0, 0xFF, 0x90, 0x98, 0x7B, 0xE0, 0x2F, 0xFF, ++0x90, 0x98, 0x7A, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x30, 0xCF, 0x34, 0x00, 0xFE, 0x90, 0x98, 0x7D, ++0xF0, 0xA3, 0xEF, 0xF0, 0xD1, 0x7C, 0xF1, 0x27, 0x90, 0x95, 0xC6, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, ++0xC4, 0xE7, 0xF1, 0x27, 0x90, 0x95, 0xC2, 0xE0, 0xFB, 0x7F, 0x11, 0x12, 0xC4, 0xE7, 0x12, 0xC1, ++0xFD, 0x90, 0x95, 0x75, 0x31, 0x1C, 0x22, 0x90, 0x98, 0x7D, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x22, ++0xE4, 0x90, 0x9A, 0x44, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x22, 0xC3, 0x90, ++0x9A, 0x45, 0xE0, 0x94, 0xD0, 0x90, 0x9A, 0x44, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, ++0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x9A, 0x44, 0x31, 0x1C, 0xF1, 0x63, 0x80, 0xD7, ++0x7F, 0x01, 0x22, 0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, ++0x22, 0x90, 0x95, 0xCC, 0x12, 0x97, 0xD8, 0x30, 0xE0, 0x0A, 0xF1, 0x6A, 0xF1, 0xC2, 0xA3, 0x04, ++0xF0, 0x02, 0xC3, 0xB0, 0x90, 0x8A, 0xAF, 0x12, 0x8D, 0x12, 0x7D, 0x08, 0xE4, 0xFF, 0x02, 0x04, ++0x7E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0x22, 0x90, 0x97, 0xE0, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0x22, 0x74, 0x00, 0x2F, 0xF9, 0xE4, ++0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xF0, 0x74, 0x04, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0x22, 0x90, 0x99, 0xB7, 0x12, 0x85, 0xF7, 0xE4, 0x90, 0x99, 0xBA, 0xF0, 0x22, 0x90, 0x88, ++0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x88, 0x4F, 0xE0, 0xFB, 0x90, 0x92, 0x98, 0x22, 0x90, ++0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, 0x12, 0x8E, ++0x2C, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, 0x8E, 0x2C, 0x22, 0x90, ++0x88, 0x31, 0x12, 0x97, 0xA2, 0x30, 0xE0, 0x35, 0xEF, 0x54, 0xBF, 0x11, 0x42, 0x30, 0xE0, 0x06, ++0xE0, 0x44, 0x01, 0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFE, 0xF0, 0x11, 0x4B, 0x74, 0x04, 0xF0, 0x90, ++0x88, 0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0F, 0x90, 0x8A, 0xB9, 0x12, 0x8D, ++0x12, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x80, 0x03, 0x12, 0xBB, 0x62, 0xE4, 0xFF, 0x02, ++0x97, 0x1E, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0x32, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, ++0xF0, 0x90, 0x01, 0xB8, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0xDF, 0xE0, ++0x60, 0x24, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0x70, 0x31, 0x01, 0x12, 0x04, 0xB8, 0xEF, 0x44, ++0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, 0x31, 0x01, 0x31, 0x0B, 0x7F, ++0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, 0x90, 0x95, 0xDA, 0xE0, 0x70, 0x29, 0x90, 0x07, 0xCC, 0xE0, ++0x30, 0xE0, 0x22, 0xE4, 0xF0, 0x90, 0x97, 0x8F, 0x74, 0x22, 0xF0, 0x90, 0x97, 0xB1, 0x74, 0x01, ++0xF0, 0x90, 0x97, 0x91, 0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x8F, 0x12, 0x8D, 0x00, ++0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x95, 0xE2, 0xE0, 0xFF, 0x70, 0x0A, 0x90, 0x95, 0xDF, 0xE0, ++0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, 0xF0, 0x90, 0x01, 0xC5, ++0x74, 0xEA, 0xF0, 0xA3, 0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, 0xEF, 0x60, 0x06, 0x90, 0x01, ++0xC4, 0x74, 0x07, 0xF0, 0x90, 0x95, 0xDF, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x01, 0xF0, ++0x90, 0x95, 0xE0, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x90, 0x97, 0x8B, 0x12, 0x04, 0x31, 0x90, 0x97, 0x8B, 0x22, 0x12, 0x04, 0xB8, 0x90, 0x92, ++0x18, 0x02, 0x04, 0x31, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0xBB, 0xEC, 0x90, 0x99, ++0xFF, 0x12, 0x04, 0x31, 0x90, 0x99, 0xFF, 0x31, 0x0B, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, 0xAD, ++0x31, 0xD5, 0xF0, 0x7D, 0x01, 0x12, 0x76, 0xF7, 0x12, 0x8E, 0x29, 0x12, 0xB4, 0x41, 0x54, 0xFE, ++0x31, 0xCF, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0x90, 0x01, ++0x01, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x88, 0x9B, 0x12, ++0x98, 0xE0, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x12, 0x98, 0x37, 0x30, 0xE0, 0x35, ++0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x90, 0x99, 0xFD, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, ++0x99, 0xFD, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0x99, 0xFE, 0xF0, ++0x80, 0x06, 0x90, 0x99, 0xFE, 0x74, 0x02, 0xF0, 0x90, 0x99, 0xFD, 0x31, 0xB2, 0x12, 0x9A, 0x4F, ++0x7F, 0x01, 0x12, 0x71, 0x9A, 0x90, 0x88, 0x9A, 0xE0, 0x60, 0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8A, 0xF3, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x12, ++0x70, 0x70, 0xED, 0x44, 0x80, 0xFD, 0x22, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, ++0x7F, 0x02, 0x02, 0x7B, 0x2E, 0x90, 0x93, 0x42, 0xE0, 0xFF, 0x90, 0x93, 0x41, 0xE0, 0xFB, 0x90, ++0x93, 0x43, 0xE0, 0x90, 0x92, 0x90, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, ++0xF0, 0x90, 0x88, 0xBD, 0xE0, 0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xBE, 0x31, 0xB2, 0x12, 0x9A, ++0x4F, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x19, 0x90, 0x93, 0x08, 0xE0, 0x20, 0xE0, 0x12, 0x90, 0x86, ++0x0C, 0x12, 0x8E, 0x2C, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, 0x2F, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, ++0x90, 0x97, 0x2E, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xDC, 0x19, 0x90, 0x97, 0x31, 0xF0, 0x51, ++0xF1, 0x90, 0x97, 0x2E, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x97, 0x2F, 0xE0, 0x60, 0x05, 0x51, ++0xE3, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x54, 0xC0, 0xF0, 0x51, 0xE3, 0x54, 0xC0, 0xF0, 0x90, 0x97, 0x31, 0xE0, 0xFF, 0xAE, 0x05, ++0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x8B, 0xE0, ++0xD3, 0x94, 0x03, 0x74, 0x10, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x04, 0xF0, ++0xAF, 0x05, 0x51, 0xD8, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x97, 0x30, 0xE0, 0x25, 0xE0, 0x25, 0xE0, ++0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xFE, 0x51, 0xD8, 0xEE, 0xF0, 0x74, 0x11, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x74, 0x29, 0x2F, 0x12, 0xCF, 0x99, 0xE0, 0x54, 0xF7, ++0xF0, 0x74, 0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, ++0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xE0, ++0xFF, 0x12, 0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, 0x22, 0xE4, 0xFD, 0xFC, 0x90, 0x95, 0xC5, 0x51, ++0xEF, 0xAB, 0x05, 0x74, 0x01, 0x2B, 0x12, 0xC6, 0xAD, 0xE0, 0xFE, 0x74, 0x00, 0x2B, 0x12, 0xC6, ++0xF8, 0xB1, 0x7F, 0x90, 0x95, 0x63, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x03, 0x2B, 0x71, 0xF0, 0xFE, ++0x74, 0x02, 0x2B, 0x71, 0xFD, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x65, 0xF0, 0xA3, 0xEF, ++0xF0, 0x74, 0x05, 0x2B, 0x12, 0xCF, 0x91, 0xE0, 0xFE, 0x74, 0x04, 0x2B, 0x12, 0xCF, 0xBA, 0xE0, ++0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x67, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x07, 0x2B, 0x71, ++0xE7, 0xFE, 0x74, 0x06, 0x2B, 0x71, 0xDE, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x69, 0xF0, ++0xA3, 0xEF, 0xF0, 0x74, 0x09, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFE, 0x74, ++0x08, 0x2B, 0x71, 0x81, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x95, 0x6B, 0xF0, 0xA3, 0xEF, 0xF0, ++0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x93, 0x06, 0xF1, 0x8E, 0x12, ++0xC6, 0xF8, 0xE0, 0x90, 0x98, 0x8B, 0xF0, 0x74, 0x01, 0x2F, 0x12, 0xC6, 0xAD, 0xE0, 0x90, 0x98, ++0x8C, 0x71, 0xF9, 0x90, 0x98, 0x8D, 0xF0, 0x74, 0x03, 0x2F, 0x71, 0xF0, 0x90, 0x98, 0x8E, 0x12, ++0xCF, 0xB6, 0xE0, 0x90, 0x98, 0x8F, 0xF0, 0x74, 0x05, 0x2F, 0x12, 0xCF, 0x91, 0xE0, 0x90, 0x98, ++0x90, 0xF0, 0x74, 0x06, 0x2F, 0x71, 0xDE, 0x90, 0x98, 0x91, 0xF0, 0x74, 0x07, 0x2F, 0x71, 0xE7, ++0x90, 0x98, 0x92, 0xF0, 0x74, 0x08, 0x2F, 0x71, 0x81, 0x90, 0x98, 0x93, 0xF0, 0x22, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, ++0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF0, 0x74, 0x02, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x02, 0x09, ++0xE0, 0xFD, 0x12, 0x97, 0x9A, 0x90, 0x93, 0x04, 0xF1, 0xBD, 0x12, 0xA7, 0x17, 0x54, 0x04, 0xFC, ++0xEF, 0x54, 0xFB, 0x4C, 0xFF, 0x90, 0x93, 0x04, 0xF1, 0xA9, 0xFF, 0xF0, 0x12, 0x02, 0x06, 0x54, ++0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0x90, 0x93, 0x04, 0x12, 0x8E, 0x13, 0xFF, 0xED, 0x2F, 0x90, ++0x93, 0x05, 0x12, 0x8F, 0x1A, 0xFF, 0xED, 0x2F, 0x90, 0x93, 0x06, 0xF0, 0x12, 0x8F, 0x13, 0xFF, ++0xAE, 0x05, 0xED, 0x2F, 0x90, 0x93, 0x07, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x20, 0xE0, 0x08, ++0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x09, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x40, 0xF0, 0x71, ++0x8A, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x30, 0xE0, 0x39, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x01, 0xF0, ++0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF1, 0x97, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x08, ++0x91, 0xC7, 0x90, 0x98, 0xA3, 0x74, 0x01, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x12, ++0xAF, 0xD0, 0x20, 0xE0, 0x0D, 0x90, 0x9A, 0x04, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x27, 0x10, 0x12, ++0xBD, 0x98, 0x12, 0xAF, 0xD0, 0x30, 0xE0, 0x0A, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x02, 0xF0, 0x12, ++0xC7, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE4, ++0xFD, 0xFC, 0x90, 0x01, 0x1D, 0xE0, 0xFE, 0x90, 0x01, 0x1C, 0xB1, 0x7F, 0x90, 0x9A, 0x2C, 0xF0, ++0xA3, 0xEF, 0xD1, 0x15, 0xE0, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x9A, 0x2E, 0xF0, 0xA3, 0xEF, ++0xF0, 0xB1, 0x60, 0x90, 0x9A, 0x2C, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xB5, 0x07, 0x06, 0xEA, 0xB5, ++0x06, 0x02, 0x80, 0x40, 0xB1, 0x60, 0xD3, 0xEB, 0x9F, 0xEA, 0x9E, 0x40, 0x0E, 0x90, 0x9A, 0x2D, ++0xE0, 0x9F, 0xFD, 0x90, 0x9A, 0x2C, 0xE0, 0x9E, 0xFC, 0x80, 0x29, 0xB1, 0x60, 0xC3, 0x90, 0x9A, ++0x2D, 0xE0, 0x9F, 0x90, 0x9A, 0x2C, 0xE0, 0x9E, 0x50, 0x1A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, ++0x90, 0x9A, 0x2F, 0xE0, 0x9F, 0xFF, 0x90, 0x9A, 0x2E, 0xE0, 0x9E, 0xFE, 0xC3, 0xE4, 0x9F, 0xFD, ++0x74, 0x40, 0x9E, 0xFC, 0xD3, 0xED, 0x94, 0x00, 0xEC, 0x94, 0x38, 0x40, 0x02, 0xE1, 0x5C, 0xC3, ++0xEC, 0x94, 0x08, 0x50, 0x0A, 0xED, 0x94, 0x00, 0xEC, 0x94, 0x00, 0x40, 0x02, 0x91, 0xC7, 0x22, ++0x90, 0x9A, 0x2E, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, ++0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, ++0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x22, 0xD1, 0x16, 0x12, 0xCE, 0x56, 0x90, 0x97, 0x32, ++0xF1, 0xA0, 0xF9, 0x90, 0x93, 0x24, 0xE0, 0x30, 0xE0, 0x7A, 0xEC, 0xC3, 0x99, 0x50, 0x75, 0x90, ++0x97, 0x32, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, 0xAD, 0x07, ++0xB1, 0x69, 0x54, 0x3F, 0x90, 0x97, 0x34, 0x12, 0xEF, 0x8B, 0x30, 0xE0, 0x09, 0xC3, 0x13, 0x20, ++0xE0, 0x04, 0xF1, 0xDB, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0xFB, 0xEF, 0x24, 0x18, 0xFF, 0xE4, 0x33, ++0xCF, 0x2B, 0xCF, 0x34, 0x00, 0x90, 0x97, 0x34, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x97, 0x34, ++0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD1, 0x1F, 0x90, 0x97, 0x34, 0xEE, 0xF1, 0x7D, 0xF1, 0xCC, 0xD3, ++0x90, 0x97, 0x33, 0xE0, 0x9F, 0x90, 0x97, 0x32, 0xE0, 0x9E, 0x40, 0x0F, 0x12, 0xEF, 0xB6, 0x90, ++0x97, 0x33, 0xE0, 0x9F, 0xF0, 0x90, 0x97, 0x32, 0xE0, 0x9E, 0xF0, 0x90, 0x97, 0x32, 0x12, 0xE0, ++0x51, 0x0C, 0x80, 0x86, 0x22, 0xF0, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x22, 0x7D, ++0x07, 0xEF, 0x5D, 0xC3, 0x60, 0x0B, 0xD1, 0x36, 0x5F, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, ++0x04, 0xD1, 0x36, 0x5F, 0xFF, 0x22, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, ++0xED, 0x22, 0x12, 0xE0, 0x64, 0xAD, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x42, 0xF0, 0x74, 0xD6, 0xA3, ++0xF0, 0xED, 0x64, 0x01, 0x60, 0x1E, 0x12, 0x9F, 0x4B, 0xED, 0xB4, 0x02, 0x08, 0x90, 0x01, 0xC7, ++0x74, 0x40, 0xF0, 0x80, 0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x41, 0xF0, 0x7F, ++0x01, 0x02, 0xAA, 0x81, 0xB1, 0x88, 0x90, 0x02, 0x87, 0xE0, 0x70, 0xF8, 0x90, 0x06, 0x90, 0xE0, ++0x44, 0x02, 0xF0, 0x74, 0x42, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xD6, 0xA3, 0xF0, 0x22, 0xEF, ++0x70, 0x02, 0xE1, 0x42, 0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE6, 0x1D, 0x90, 0x95, 0xEA, 0xE0, 0x54, ++0xFE, 0xF0, 0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE5, 0x07, 0x90, 0x01, 0x0C, 0xE0, 0x30, 0xE1, 0x45, ++0x90, 0x01, 0xC7, 0x74, 0x44, 0xF0, 0x80, 0xFE, 0x90, 0x95, 0xEA, 0xE0, 0x44, 0x01, 0xF0, 0x90, ++0x06, 0x0F, 0xE0, 0x30, 0xE5, 0x10, 0x90, 0x01, 0x0C, 0xE0, 0x20, 0xE1, 0x09, 0x90, 0x95, 0xEA, ++0xE0, 0x54, 0xFD, 0xF0, 0x80, 0x1F, 0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE5, 0x10, 0x90, 0x01, 0x0C, ++0xE0, 0x30, 0xE1, 0x09, 0x90, 0x95, 0xEA, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xC7, ++0x74, 0x44, 0xF0, 0x80, 0xFE, 0x90, 0x95, 0xBB, 0xE0, 0xFF, 0x60, 0x02, 0xF1, 0x64, 0x90, 0x01, ++0xC7, 0xE4, 0xF1, 0xB3, 0x12, 0xCE, 0x56, 0xF1, 0x75, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF0, ++0x7B, 0x35, 0x7D, 0xFF, 0x7F, 0xFF, 0x12, 0xC4, 0xCF, 0x90, 0x8A, 0xEF, 0x12, 0x8E, 0x2C, 0x91, ++0xC7, 0xD1, 0x42, 0xF1, 0x5B, 0x90, 0x86, 0x0C, 0x12, 0x8E, 0x2C, 0xE4, 0xFB, 0xFD, 0x7F, 0xFF, ++0x12, 0xC4, 0xCF, 0x12, 0xDD, 0xB9, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, 0xFF, 0x02, ++0x7C, 0x74, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0x90, 0x06, 0x90, 0xE0, 0x54, 0xF0, 0xF0, ++0xF1, 0x5C, 0x12, 0xE0, 0x8D, 0x12, 0x97, 0x80, 0x02, 0x94, 0x61, 0x22, 0x90, 0x02, 0x86, 0xE0, ++0x54, 0xFB, 0xF0, 0x22, 0xF1, 0x85, 0x12, 0xC7, 0x83, 0x75, 0x48, 0x08, 0x7B, 0x01, 0x7A, 0x95, ++0x79, 0x2F, 0x02, 0x69, 0xF5, 0x90, 0x88, 0x27, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xF0, 0xA3, 0xEF, ++0xF0, 0x90, 0x97, 0x32, 0x22, 0x12, 0x7B, 0x07, 0x7E, 0x00, 0x74, 0x00, 0x2F, 0x22, 0xE0, 0xFF, ++0x12, 0x7B, 0x07, 0x74, 0x00, 0x2F, 0x22, 0xF0, 0x90, 0x06, 0x08, 0xE0, 0x54, 0x7F, 0xF0, 0x22, ++0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x87, 0xE0, 0x22, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, ++0xF7, 0x4E, 0x22, 0xF0, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0x22, 0xE0, 0x54, 0xFE, ++0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0x22, 0xEE, 0x8F, 0xF0, 0x12, ++0x02, 0xE7, 0x90, 0x88, 0x27, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x74, 0x03, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x03, 0xFE, 0x22, 0xE4, 0x90, 0x9A, 0x38, 0xF0, 0xA3, ++0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, ++0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0x12, 0xC1, 0x8B, 0x30, 0xE0, 0x15, 0xD3, 0x90, 0x9A, 0x39, ++0xE0, 0x94, 0x03, 0x90, 0x9A, 0x38, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x80, 0x13, 0x7F, 0x01, 0x80, ++0x1B, 0xD3, 0x90, 0x9A, 0x39, 0xE0, 0x94, 0xE8, 0x90, 0x9A, 0x38, 0xE0, 0x94, 0x03, 0x40, 0x0A, ++0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x7C, ++0x6A, 0x90, 0x9A, 0x38, 0x12, 0xC9, 0x1C, 0x80, 0xA8, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x93, ++0x01, 0xED, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, ++0x22, 0x90, 0x01, 0x8C, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, 0xA3, 0x74, 0x02, 0xF0, ++0x90, 0x01, 0x95, 0xE0, 0x54, 0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, ++0x22, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, 0xF0, 0x12, 0xCF, 0x63, 0x90, 0x01, 0x98, ++0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, ++0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x97, 0x2E, 0xF0, 0xA3, 0xF0, 0x11, 0x9B, ++0xEF, 0x64, 0x01, 0x60, 0x3D, 0xC3, 0x90, 0x97, 0x2F, 0xE0, 0x94, 0x88, 0x90, 0x97, 0x2E, 0xE0, ++0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, ++0xF0, 0x80, 0x1F, 0x90, 0x97, 0x2E, 0x12, 0xC9, 0x1C, 0x12, 0xB4, 0x3A, 0xD3, 0x90, 0x97, 0x2F, ++0xE0, 0x94, 0x32, 0x90, 0x97, 0x2E, 0xE0, 0x94, 0x00, 0x40, 0xC3, 0x90, 0x01, 0xC6, 0xE0, 0x30, ++0xE3, 0xBC, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0x90, 0x93, 0x24, 0xE0, 0x30, 0xE0, 0x0B, ++0x90, 0x8A, 0xE5, 0x12, 0x8D, 0x12, 0x7F, 0x10, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x8A, 0x75, 0x12, ++0x8E, 0x2C, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0x12, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x01, 0xCF, ++0xE0, 0x90, 0x98, 0x7A, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, ++0xF0, 0xEF, 0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, ++0x20, 0xF0, 0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, ++0xFD, 0x7F, 0x03, 0x12, 0x7B, 0x2E, 0x80, 0xFE, 0x22, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0x12, 0x7F, ++0x80, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x99, 0x90, 0xEC, 0xF0, ++0xA3, 0xED, 0xF0, 0x90, 0x99, 0x8F, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x7B, 0xBD, 0x90, ++0x99, 0x9A, 0x12, 0x04, 0x31, 0x90, 0x99, 0x92, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x99, ++0x9A, 0x12, 0x85, 0xE2, 0x12, 0x85, 0xC8, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0x99, 0x92, 0x12, 0x04, 0xB8, 0x90, 0x99, 0x96, 0x12, 0x85, 0xE2, 0x12, 0x85, 0xC8, 0xD0, 0x03, ++0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xD5, 0x90, 0x99, 0x9E, 0x12, 0x04, 0x31, 0x90, ++0x99, 0x90, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x99, 0x9E, 0x12, 0x04, 0xB8, 0x90, 0x8B, 0x9F, ++0x12, 0x04, 0x31, 0x90, 0x99, 0x8F, 0xE0, 0xFF, 0xD0, 0x05, 0x12, 0x79, 0x53, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x24, 0xEF, 0xF0, 0xED, 0x64, ++0x01, 0x70, 0x2E, 0xEB, 0xB4, 0x01, 0x07, 0xE0, 0x24, 0x02, 0xF5, 0x14, 0x80, 0x08, 0x90, 0x9A, ++0x24, 0xE0, 0x24, 0xFE, 0xF5, 0x14, 0x90, 0x99, 0x92, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, ++0xAF, 0x14, 0x51, 0x54, 0x51, 0x4C, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x14, 0x80, ++0x20, 0x90, 0x99, 0x92, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x9A, 0x24, 0x12, 0xB5, ++0xAF, 0x51, 0x58, 0x51, 0x4C, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x9A, 0x24, 0xE0, ++0xFF, 0x51, 0x54, 0x7F, 0x01, 0x31, 0x64, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFF, 0x31, 0x64, ++0x90, 0x99, 0x92, 0x22, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x99, 0x96, 0x12, 0x04, 0x31, 0x7D, 0x18, ++0x7C, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x98, 0x9B, 0xE0, 0xFF, 0x71, ++0x41, 0xEF, 0x60, 0x68, 0x90, 0x98, 0x9C, 0xE0, 0xFB, 0xD3, 0x94, 0x00, 0x40, 0x1A, 0x90, 0x99, ++0xA4, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x0F, 0xAF, 0x03, 0xE4, 0xFC, 0xFD, 0xFE, 0x12, 0xB7, ++0xE7, 0x7F, 0x08, 0x7E, 0x0E, 0x12, 0xB7, 0x14, 0x90, 0x98, 0x9B, 0xE0, 0xFF, 0x90, 0x06, 0x33, ++0xF0, 0x71, 0x29, 0xE4, 0xFB, 0xFD, 0x31, 0xE2, 0x90, 0x98, 0x9E, 0xE0, 0x60, 0x07, 0x90, 0x93, ++0x05, 0xE0, 0xFF, 0x71, 0x6C, 0x90, 0x98, 0x9D, 0xE0, 0x90, 0x97, 0xB4, 0xF0, 0x90, 0x98, 0x88, ++0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x12, 0xBF, 0x67, 0x90, 0x97, 0xB4, 0x12, 0xB5, 0xAF, 0x90, 0x9A, ++0x04, 0x12, 0x04, 0x31, 0x12, 0xBF, 0xBB, 0x12, 0xBD, 0x9F, 0x80, 0x48, 0xE4, 0x90, 0x98, 0x88, ++0xF0, 0x90, 0x99, 0x07, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x12, 0xB7, 0x7C, 0xE4, ++0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x13, 0x90, 0x98, 0xA0, 0xE0, 0xFD, 0x90, 0x8A, 0x89, 0x12, ++0x8D, 0x12, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x7B, 0xAD, 0x90, 0x97, 0xB6, 0x74, 0x07, 0xF0, ++0x90, 0x97, 0xD8, 0xF0, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xB6, 0x12, 0x8D, 0x00, 0x7F, 0x04, 0x12, ++0x04, 0x7E, 0x71, 0x32, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x98, 0x93, 0xE0, 0x90, 0x9A, 0x27, ++0xF0, 0x22, 0x90, 0x93, 0x04, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0xA0, 0x11, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x98, 0x8B, 0xE0, 0xFE, 0x90, 0x98, 0x88, ++0xE0, 0xC3, 0x9E, 0x40, 0x04, 0x7F, 0x00, 0x80, 0x0E, 0xEF, 0x60, 0x05, 0xD3, 0x94, 0x0E, 0x40, ++0x04, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0x97, 0xD9, 0xEF, 0xF0, 0x12, 0x76, 0x9B, 0xBF, 0x01, 0x1F, 0x90, 0x06, ++0x32, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x97, 0xD9, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x07, 0x12, ++0xC7, 0xCC, 0x90, 0x97, 0xDA, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xC1, 0xFD, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFE, 0xFD, 0xEF, 0xB4, 0x01, 0x0D, ++0xEB, 0xB4, 0x02, 0x03, 0x0D, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7D, 0x02, 0xAF, 0x06, 0xEF, ++0xC4, 0x54, 0xF0, 0x4D, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0xC4, 0x74, 0xCA, 0xF0, ++0x74, 0xDB, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0xCA, 0x04, ++0x90, 0x01, 0xC4, 0xF0, 0x74, 0xDB, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x91, 0x19, 0x90, 0x9A, 0x47, 0xF0, 0xED, 0x90, 0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, 0xF0, ++0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, 0x80, 0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, 0x67, ++0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x86, 0xAD, 0xA3, 0xE0, 0x24, 0x7F, ++0xF5, 0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x91, 0x19, 0x90, 0x97, 0x2E, 0xF0, 0x90, 0x88, 0x32, 0x12, 0x8F, 0xDA, 0x30, 0xE0, 0x02, 0x81, ++0xED, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x1D, 0x12, 0xA4, 0xF3, 0x33, 0x33, 0x33, 0x54, 0xF8, ++0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x03, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, ++0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, 0x88, 0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, ++0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, 0x88, 0x4A, 0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, ++0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, 0xF0, 0x90, 0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, ++0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, 0x3E, 0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, ++0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, 0x88, 0x4B, 0x91, 0xF9, 0x90, 0x88, 0x4E, 0xB1, 0x02, 0x40, ++0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, 0x91, 0xF9, 0x90, 0x88, 0x3E, 0xB1, 0x02, 0x40, ++0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, 0x12, 0x98, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0x88, ++0x42, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, ++0xFF, 0x90, 0x05, 0xB1, 0xE0, 0x54, 0xF8, 0x4F, 0xF0, 0xB1, 0x0D, 0x80, 0x07, 0x90, 0x88, 0x33, ++0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, 0x33, ++0xFC, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0x90, 0x88, 0x33, ++0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x90, 0x97, 0x2E, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, ++0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, 0x08, 0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, ++0x6C, 0xD1, 0x5B, 0xB1, 0xE8, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, ++0x2F, 0xB1, 0xEF, 0xE0, 0xFE, 0x74, 0x28, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xB1, 0xB2, 0xB4, ++0x04, 0xEC, 0x90, 0x9A, 0x29, 0x12, 0xB5, 0xAF, 0xD1, 0x64, 0x90, 0x9A, 0x28, 0x12, 0xB5, 0xAF, ++0x12, 0x85, 0xD5, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x9A, 0x2A, 0x12, 0xB5, ++0xAF, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, ++0xD5, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0xB5, 0xAF, 0x78, 0x18, 0x12, ++0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xD5, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0x22, 0xE4, 0xFF, 0x74, 0x18, 0xB1, 0xDD, 0x74, ++0x34, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x10, 0xB1, 0xDD, 0x74, ++0x2E, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xB1, 0xB2, 0xB4, 0x06, 0xDF, 0x22, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x22, 0x90, 0x07, 0xC0, 0x74, 0x80, 0xF0, 0x22, 0xF5, ++0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, ++0xAC, 0x06, 0xEF, 0xD1, 0x77, 0xB1, 0xE8, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, 0x54, ++0x03, 0x24, 0xC8, 0xB1, 0xEF, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, 0x7E, ++0xFF, 0x7F, 0xFF, 0x80, 0x21, 0xD1, 0x5B, 0xB1, 0xE8, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, ++0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, 0xB1, 0xEF, 0xE0, 0xFE, 0x74, 0xC8, 0x2D, 0xF5, 0x82, 0xE4, ++0x34, 0x07, 0x12, 0xCE, 0x54, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x07, 0xC0, 0xEF, 0xF0, ++0xEE, 0xA3, 0xF0, 0x22, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, ++0x07, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x54, 0xFC, 0x90, 0x07, 0xC0, 0xF0, 0xEE, 0xA3, 0xF0, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, 0xFC, 0xFF, 0xD1, 0x79, 0xE4, 0xFB, ++0x90, 0x9A, 0x0B, 0x12, 0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, 0xF8, 0x12, 0x03, 0xEB, ++0x74, 0xC4, 0x2B, 0xB1, 0xEF, 0xEF, 0xF0, 0x0B, 0xEB, 0xB4, 0x04, 0xE4, 0x90, 0x07, 0xC2, 0xF1, ++0x77, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x40, 0xD1, 0x72, 0x7A, 0x00, 0x90, 0x9A, 0x41, 0xE0, 0x54, ++0x03, 0xFB, 0x70, 0x0A, 0x90, 0x07, 0xC4, 0xD1, 0xFE, 0x74, 0x03, 0xF0, 0x80, 0x0E, 0xEB, 0x64, ++0x02, 0x4A, 0x70, 0x15, 0x90, 0x07, 0xC6, 0xD1, 0xFE, 0x74, 0x0C, 0xF0, 0x90, 0x07, 0xC3, 0x74, ++0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xED, 0xF0, ++0xEC, 0xA3, 0xF0, 0x90, 0x07, 0xC2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, ++0x42, 0xD1, 0x72, 0xF1, 0x6D, 0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, ++0x01, 0xF0, 0x80, 0x37, 0xEF, 0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, 0x07, 0xC5, 0xED, 0xF0, 0x90, ++0x07, 0xC2, 0x74, 0x02, 0xF0, 0x80, 0x24, 0xF1, 0x6D, 0x64, 0x02, 0x70, 0x0D, 0x90, 0x07, 0xC6, ++0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, 0x64, 0x03, 0x4E, 0x70, 0x0B, ++0x90, 0x07, 0xC7, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, ++0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7E, 0x00, 0x90, ++0x9A, 0x43, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0x74, 0x0F, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x22, 0x90, ++0x97, 0x35, 0xEF, 0xF0, 0xE4, 0xFF, 0x74, 0x2F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, ++0xE0, 0xFE, 0x74, 0x84, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x04, 0xB1, 0xB2, 0xB4, 0x08, 0xE7, 0x90, ++0x95, 0x5F, 0xE0, 0x90, 0x04, 0x8C, 0xF0, 0x90, 0x95, 0x61, 0xE0, 0x90, 0x04, 0x8D, 0xF0, 0x75, ++0x45, 0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0x3E, 0x75, 0x48, 0x08, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x37, 0x12, 0x69, 0xF5, 0x90, 0x95, 0xCA, 0xE0, 0x60, 0x1F, 0x90, 0x97, 0x35, 0xE0, 0xFF, 0x12, ++0x7B, 0x07, 0x7E, 0x00, 0x12, 0xCF, 0xAB, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x95, 0x75, 0x47, ++0x2F, 0x75, 0x48, 0x34, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x22, 0x90, 0x95, 0xCC, 0xE0, 0x30, 0xE0, ++0x37, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x30, 0x90, 0x9A, 0x49, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, ++0x0A, 0x0B, 0x90, 0x95, 0xCE, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x9A, 0x49, 0xF0, 0x90, 0x95, 0xCE, ++0xE0, 0xFF, 0x90, 0x95, 0xCD, 0xE0, 0xD3, 0x9F, 0x50, 0x0E, 0x90, 0x95, 0xCF, 0xE0, 0x70, 0x08, ++0xE4, 0x90, 0x95, 0xCE, 0xF0, 0x12, 0xCF, 0x71, 0x22, 0x12, 0x97, 0x9A, 0x90, 0x95, 0xCC, 0x11, ++0x49, 0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, ++0x07, 0x12, 0x8E, 0x14, 0x90, 0x95, 0xCD, 0xF0, 0x22, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, ++0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0xA3, 0xE0, ++0x44, 0x01, 0xF0, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE2, 0x03, 0x7F, 0x04, 0x22, 0x90, 0x02, ++0x86, 0xE0, 0x7F, 0x01, 0x20, 0xE1, 0x02, 0x7F, 0x02, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0xE4, 0xFD, 0x7F, 0x8F, 0x12, 0x7B, 0x2E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x11, 0x7A, 0x90, ++0x95, 0xCA, 0xE0, 0xFF, 0x12, 0xDF, 0x7F, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x90, 0x86, 0xB3, ++0xE0, 0xFF, 0xB4, 0x01, 0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, ++0x90, 0xFE, 0x10, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x93, 0x2D, 0xE0, 0x30, 0xE0, 0x0D, 0x90, ++0x93, 0x27, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x03, 0x7F, 0x00, 0x22, 0x7F, 0x01, 0x22, 0xEF, ++0x90, 0x01, 0xC7, 0xB4, 0xA0, 0x05, 0x74, 0x04, 0xF0, 0x80, 0x03, 0x74, 0x08, 0xF0, 0x02, 0x9F, ++0x4B, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x20, 0xE0, 0x05, 0x90, 0x95, 0xB9, 0x80, ++0x03, 0x90, 0x95, 0xBA, 0xE0, 0x90, 0x95, 0x60, 0xF0, 0x90, 0x95, 0x60, 0xE0, 0x14, 0x60, 0x13, ++0x14, 0x60, 0x14, 0x24, 0xFE, 0x60, 0x10, 0x14, 0x60, 0x09, 0x14, 0x60, 0x06, 0x24, 0x06, 0xE4, ++0xFE, 0x80, 0x06, 0x7E, 0x04, 0x80, 0x02, 0x7E, 0x08, 0xAF, 0x06, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x90, 0x9A, 0x12, 0xED, 0xF0, 0x90, 0x9A, 0x0F, 0x12, 0x85, 0xF7, 0xE4, 0x90, 0x9A, 0x13, 0xF0, ++0xA3, 0xF0, 0x12, 0x02, 0x06, 0xFF, 0x12, 0x8E, 0x14, 0xFD, 0x12, 0x8F, 0xE2, 0xFB, 0x71, 0x4E, ++0x90, 0x9A, 0x13, 0xEF, 0xF0, 0x90, 0x9A, 0x0F, 0x12, 0x85, 0xEE, 0x12, 0x8F, 0xE2, 0xFF, 0x11, ++0xE1, 0x90, 0x9A, 0x14, 0xEF, 0xF0, 0x90, 0x95, 0x60, 0xE0, 0x24, 0xFE, 0x60, 0x14, 0x24, 0xFE, ++0x60, 0x10, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x05, 0x70, 0x40, 0x51, 0xB8, 0x51, 0xC4, ++0x80, 0x0C, 0x51, 0xB8, 0x90, 0x95, 0x60, 0xE0, 0x90, 0x99, 0xE6, 0xF0, 0x31, 0xAD, 0x90, 0x9A, ++0x14, 0xE0, 0xFF, 0x90, 0x9A, 0x0F, 0x12, 0x85, 0xEE, 0x90, 0x9A, 0x13, 0xE0, 0x7C, 0x00, 0x29, ++0xF9, 0xEC, 0x3A, 0xFA, 0xC3, 0xE9, 0x9F, 0xF9, 0xEA, 0x94, 0x00, 0xFA, 0x75, 0x45, 0x01, 0x75, ++0x46, 0x95, 0x75, 0x47, 0x2F, 0xA3, 0xE0, 0xF5, 0x48, 0x12, 0x69, 0xF5, 0x22, 0x90, 0x99, 0xE2, ++0x12, 0x85, 0xF7, 0x90, 0x99, 0xE6, 0xE0, 0xFE, 0x64, 0x04, 0x70, 0x0D, 0x51, 0x9F, 0x12, 0x02, ++0x06, 0x90, 0x99, 0xE7, 0x12, 0x8E, 0x13, 0x80, 0x11, 0xEE, 0x64, 0x02, 0x70, 0x35, 0x51, 0x9F, ++0x12, 0x8F, 0x1B, 0x90, 0x99, 0xE7, 0xF0, 0x12, 0x02, 0x06, 0x90, 0x99, 0xE8, 0xF0, 0x12, 0x8F, ++0xE2, 0x90, 0x99, 0xE9, 0x12, 0x8E, 0x1B, 0x90, 0x99, 0xEA, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x02, ++0x1F, 0x90, 0x99, 0xEB, 0xF0, 0x90, 0x00, 0x07, 0x12, 0x02, 0x1F, 0x90, 0x99, 0xEC, 0xF0, 0x12, ++0x8F, 0x13, 0xFF, 0xED, 0x70, 0x19, 0xFE, 0x51, 0xA5, 0xE0, 0xB4, 0xFF, 0x06, 0x51, 0xA5, 0xE4, ++0xF0, 0x80, 0x07, 0x51, 0xA5, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x06, 0xE8, 0x90, ++0x99, 0xE6, 0xE0, 0xFE, 0xB4, 0x04, 0x18, 0xA3, 0xE0, 0xFD, 0x51, 0x9F, 0xED, 0x51, 0xB0, 0xFD, ++0x51, 0x9F, 0x90, 0x00, 0x01, 0xED, 0x12, 0x02, 0x5E, 0x90, 0x00, 0x02, 0xE4, 0x80, 0x20, 0xEE, ++0xB4, 0x02, 0x1F, 0x90, 0x99, 0xE8, 0x51, 0x9D, 0xEE, 0x51, 0xB0, 0x44, 0x20, 0x54, 0x7F, 0x51, ++0x9E, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x02, 0x5E, 0x90, 0x99, 0xE7, 0xE0, 0x90, 0x00, 0x02, 0x12, ++0x02, 0x5E, 0x51, 0x9F, 0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x44, 0x20, ++0x12, 0x02, 0x4C, 0x90, 0x99, 0xE9, 0x51, 0x9D, 0x90, 0x00, 0x04, 0xEE, 0x12, 0x02, 0x5E, 0x90, ++0x99, 0xEA, 0xE0, 0x90, 0x00, 0x05, 0x12, 0x02, 0x5E, 0x90, 0x99, 0xEB, 0xE0, 0x90, 0x00, 0x06, ++0x12, 0x02, 0x5E, 0x90, 0x99, 0xEC, 0xE0, 0x90, 0x00, 0x07, 0x02, 0x02, 0x5E, 0xE0, 0xFE, 0x90, ++0x99, 0xE2, 0x02, 0x85, 0xEE, 0x74, 0xE7, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x22, ++0x12, 0x02, 0x4C, 0x90, 0x99, 0xE8, 0xE0, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x2F, 0x90, 0x9A, ++0x12, 0xE0, 0xFD, 0x22, 0x90, 0x99, 0xF2, 0xED, 0xF0, 0x90, 0x99, 0xEF, 0x12, 0x85, 0xF7, 0x12, ++0x8F, 0x13, 0x90, 0x99, 0xF6, 0xF0, 0x90, 0x99, 0xEF, 0x12, 0xC3, 0xA6, 0x75, 0x48, 0x03, 0x7B, ++0x01, 0x7A, 0x99, 0x79, 0xF3, 0x12, 0x69, 0xF5, 0x90, 0x99, 0xF2, 0xE0, 0x70, 0x2E, 0xFF, 0x71, ++0x1D, 0xE0, 0xB4, 0xFF, 0x06, 0x71, 0x1D, 0xE4, 0xF0, 0x80, 0x07, 0x71, 0x1D, 0xE0, 0x04, 0xF0, ++0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x03, 0xE8, 0x75, 0x45, 0x01, 0x75, 0x46, 0x99, 0x75, 0x47, 0xF3, ++0x75, 0x48, 0x03, 0x90, 0x99, 0xEF, 0x12, 0x85, 0xEE, 0x12, 0x69, 0xF5, 0x22, 0x74, 0xF3, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x22, 0xA3, 0xE0, 0xFE, 0x24, 0x28, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x29, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0xFD, 0x74, 0x2C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFE, ++0xEF, 0x30, 0xE7, 0x04, 0x7C, 0x02, 0x80, 0x02, 0xE4, 0xFC, 0xED, 0x30, 0xE6, 0x08, 0xAF, 0x03, ++0x11, 0xE1, 0xAE, 0x07, 0x80, 0x02, 0xE4, 0xFE, 0xEC, 0x24, 0x18, 0x2E, 0xFF, 0x22, 0x12, 0x7B, ++0x07, 0x90, 0x97, 0x32, 0xE4, 0x12, 0xD7, 0x7D, 0x71, 0x28, 0x90, 0x97, 0x34, 0xEF, 0xF0, 0x90, ++0x97, 0x32, 0xA3, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x06, ++0x7B, 0x01, 0x7A, 0x93, 0x79, 0x49, 0x71, 0xD4, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, 0x24, 0x3E, ++0xF9, 0xE4, 0x34, 0xFC, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x4F, ++0x71, 0xD4, 0x71, 0xE1, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x06, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x53, ++0x71, 0xD4, 0x12, 0xC6, 0xDE, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x93, 0x79, ++0x59, 0x02, 0x69, 0xF5, 0x12, 0x69, 0xF5, 0x90, 0x97, 0x32, 0x22, 0x12, 0x69, 0xF5, 0x90, 0x99, ++0xBC, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, 0x24, 0x42, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0xEF, 0x60, ++0x07, 0x90, 0x95, 0xBC, 0xE0, 0xFF, 0x71, 0x6E, 0x22, 0x12, 0xD7, 0x85, 0x12, 0xC7, 0x83, 0x75, ++0x48, 0x70, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x5D, 0x02, 0x69, 0xF5, 0xEF, 0x60, 0x07, 0x90, 0x95, ++0xC1, 0xE0, 0xFF, 0x71, 0xF9, 0x22, 0x90, 0x97, 0xBA, 0x12, 0xCF, 0xA4, 0xED, 0xF0, 0x78, 0xBE, ++0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x80, 0x79, 0xBA, 0x12, 0x9F, 0xB0, 0x90, 0x97, 0xBC, ++0xE0, 0xFF, 0x90, 0x97, 0xBB, 0xE0, 0x2F, 0x91, 0xBF, 0x90, 0x97, 0xC2, 0xF0, 0xA3, 0xEF, 0xF0, ++0x24, 0x06, 0xFF, 0xE4, 0x3E, 0x12, 0x9A, 0x7A, 0xEF, 0x64, 0x08, 0x70, 0x53, 0x90, 0x97, 0xC3, ++0xE0, 0x24, 0x07, 0xFF, 0x90, 0x97, 0xC2, 0xE0, 0x34, 0x00, 0x12, 0x9A, 0x7A, 0xEF, 0x70, 0x40, ++0x90, 0x97, 0xBD, 0xF0, 0x90, 0x97, 0xBD, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x25, 0x90, 0x97, ++0xC3, 0xE0, 0x24, 0x18, 0xFD, 0x90, 0x97, 0xC2, 0xE0, 0x12, 0x9A, 0x70, 0x90, 0x97, 0xBD, 0xE0, ++0x24, 0xBE, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xBD, 0xE0, 0x04, ++0xF0, 0x80, 0xD1, 0x78, 0xBE, 0x7C, 0x97, 0x91, 0xC8, 0xEF, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, ++0x22, 0x90, 0x97, 0xB5, 0xED, 0x12, 0x9F, 0x53, 0x12, 0xAF, 0x0B, 0xEF, 0x60, 0x09, 0x12, 0x9A, ++0x1F, 0x91, 0xB8, 0x60, 0x02, 0x7F, 0x01, 0x22, 0xA3, 0xE0, 0xFD, 0x91, 0x16, 0xEF, 0x22, 0xFF, ++0x90, 0x97, 0xBA, 0xE0, 0x34, 0x00, 0xFE, 0x22, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x4F, ++0x7E, 0x00, 0x7F, 0x04, 0x02, 0x87, 0xAC, 0xE4, 0xFE, 0xED, 0x30, 0xE1, 0x11, 0x90, 0x01, 0x3F, ++0xE0, 0x30, 0xE2, 0x0A, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x23, 0xF0, 0x0E, 0xED, 0x30, ++0xE0, 0x24, 0xEF, 0x30, 0xE6, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x22, 0xF0, 0x7E, 0x01, 0xEF, 0x30, ++0xE7, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x21, 0xF0, 0x7E, 0x01, 0xEF, 0x30, 0xE5, 0x08, 0x90, 0x01, ++0xC7, 0x74, 0x23, 0xF0, 0x7E, 0x01, 0xAF, 0x06, 0x22, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x97, 0x32, ++0xF0, 0x12, 0x02, 0x06, 0x90, 0x95, 0xB9, 0x12, 0x8E, 0x13, 0x90, 0x95, 0xBA, 0xF0, 0x22, 0xB1, ++0x6B, 0x2E, 0x90, 0x95, 0xBB, 0x12, 0x8E, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xBC, 0x12, 0x8F, ++0x1A, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xBD, 0xF0, 0x12, 0x8F, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x95, ++0xBE, 0xF0, 0x12, 0x8F, 0xE2, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xBF, 0x12, 0x8E, 0x1B, 0xFF, 0xED, ++0x2F, 0x90, 0x95, 0xC0, 0xB1, 0xB4, 0x90, 0x95, 0xC1, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, ++0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, 0xED, 0x22, 0xB1, 0x6B, 0x2E, 0x90, 0x95, 0xC2, 0x12, 0x8E, ++0x13, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xC3, 0x12, 0x8F, 0x1A, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xC4, ++0xF0, 0x12, 0x8F, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xC5, 0xF0, 0x12, 0x8F, 0xE2, 0xFF, 0xED, ++0x2F, 0x90, 0x95, 0xC6, 0x12, 0x8E, 0x1B, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xC7, 0xB1, 0xB4, 0x90, ++0x95, 0xC8, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x02, 0x1F, 0xFF, 0xAE, 0x05, 0xED, 0x2F, ++0x22, 0xB1, 0x6B, 0x2E, 0x90, 0x95, 0xC9, 0x12, 0x8E, 0x13, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, ++0x95, 0xCA, 0xF0, 0x22, 0xE4, 0xFD, 0xFC, 0xEF, 0x60, 0x3A, 0x90, 0x95, 0xBF, 0x12, 0xD2, 0xEF, ++0x12, 0xCF, 0xAB, 0x12, 0xC3, 0x9D, 0x75, 0x48, 0x40, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xF5, 0x12, ++0x69, 0xF5, 0xE4, 0xFD, 0x7F, 0x03, 0x12, 0x54, 0x1E, 0x90, 0x95, 0xC0, 0xE0, 0x12, 0xCC, 0xB3, ++0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x77, 0xA4, 0x7D, 0x01, 0x7F, ++0x03, 0x12, 0x54, 0x1E, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, 0xC1, 0xEE, ++0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0xBA, 0xE0, 0xFF, 0xB4, 0x02, 0x07, 0xF1, 0x82, 0x74, 0x08, ++0xF0, 0x80, 0x09, 0xEF, 0xB4, 0x04, 0x05, 0xF1, 0x82, 0x74, 0x10, 0xF0, 0x90, 0x97, 0xC1, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0x64, 0x02, 0x4E, 0x60, 0x08, 0xEF, 0x64, 0x01, 0x4E, 0x60, 0x02, 0xE1, ++0x75, 0x90, 0x94, 0x36, 0xE0, 0xFF, 0x64, 0xFE, 0x70, 0x02, 0xE1, 0x75, 0xEF, 0x64, 0x02, 0x60, ++0x07, 0xEF, 0x64, 0x03, 0x60, 0x02, 0xE1, 0x75, 0x90, 0x94, 0x96, 0xF1, 0xB1, 0x90, 0x98, 0x4E, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, 0x00, 0x7F, 0x28, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x97, 0x79, ++0xE4, 0x12, 0x04, 0x80, 0x7E, 0x00, 0x7F, 0x40, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0x0C, ++0x12, 0x04, 0x80, 0x90, 0x97, 0xC1, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x4D, 0x75, ++0x45, 0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0x66, 0x75, 0x48, 0x10, 0x7B, 0x01, 0x7A, 0x98, 0x79, ++0x50, 0x12, 0x97, 0x8C, 0x75, 0x46, 0x94, 0x75, 0x47, 0x05, 0x75, 0x48, 0x10, 0x7B, 0x01, 0x7A, ++0x98, 0x79, 0x60, 0x12, 0x69, 0xF5, 0xF1, 0x93, 0x74, 0x20, 0xF1, 0x9D, 0x90, 0x8F, 0x3A, 0xF1, ++0x7A, 0x90, 0x8F, 0x3D, 0xF1, 0x8A, 0x90, 0x8F, 0x40, 0xF0, 0x7A, 0x98, 0x79, 0x50, 0x12, 0x4C, ++0x23, 0x75, 0x45, 0x01, 0x75, 0x46, 0x98, 0x75, 0x47, 0x0C, 0x80, 0x24, 0xF1, 0x93, 0x74, 0x10, ++0xF1, 0x9D, 0x90, 0x91, 0x8C, 0xF1, 0x7A, 0x90, 0x91, 0x8F, 0xF1, 0x8A, 0x90, 0x91, 0x92, 0xF0, ++0x7A, 0x94, 0x79, 0x05, 0x12, 0x61, 0x34, 0x75, 0x45, 0x01, 0x75, 0x46, 0x98, 0x75, 0x47, 0x14, ++0x75, 0x48, 0x28, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xE4, 0x12, 0x69, 0xF5, 0x75, 0x45, 0x01, 0x75, ++0x46, 0x97, 0x75, 0x47, 0xEC, 0x75, 0x48, 0x20, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xC3, 0x12, 0x69, ++0xF5, 0x90, 0x97, 0xEA, 0xE0, 0x54, 0x03, 0x90, 0x97, 0xE3, 0xF0, 0xC3, 0x94, 0x04, 0x50, 0x1C, ++0xE0, 0x90, 0x95, 0x5F, 0xF0, 0x75, 0x45, 0x01, 0x75, 0x46, 0x97, 0x75, 0x47, 0xC3, 0x75, 0x48, ++0x20, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x3F, 0x12, 0x69, 0xF5, 0x80, 0x06, 0x90, 0x95, 0x5F, 0x74, ++0x05, 0xF0, 0x90, 0x97, 0xE3, 0xE0, 0xFF, 0x90, 0x95, 0xBA, 0xE0, 0xFD, 0x7B, 0x01, 0x7A, 0x97, ++0x79, 0xC3, 0x12, 0x8F, 0x4E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x85, 0xF7, 0x7A, 0x98, 0x79, ++0x0C, 0x22, 0x90, 0x98, 0x4C, 0x74, 0x80, 0xF0, 0xA3, 0x22, 0x12, 0x85, 0xF7, 0x90, 0x98, 0x4E, ++0xA3, 0xE0, 0x22, 0x90, 0x98, 0x4E, 0xA3, 0xE0, 0xFB, 0x90, 0x92, 0x06, 0x22, 0xF0, 0xE4, 0xA3, ++0xF0, 0xA3, 0xF0, 0xFD, 0xFC, 0xFF, 0xFE, 0x12, 0x71, 0xD4, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0x98, ++0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFD, 0xED, 0xFF, 0x22, 0x7F, 0x50, 0x7E, 0x0C, 0x12, 0x70, 0x70, ++0x90, 0x98, 0x89, 0xEF, 0xF0, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x70, 0x70, 0x90, 0x98, 0x8A, 0xEF, ++0xF0, 0x90, 0x99, 0xA4, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x99, 0xA8, 0x12, 0x04, ++0x3D, 0x00, 0x00, 0x00, 0x17, 0x12, 0xB7, 0x06, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, ++0x99, 0xA8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x17, 0x12, 0xB7, 0x10, 0x90, 0x06, 0x08, 0xE0, ++0x90, 0x98, 0x9F, 0xF0, 0x90, 0x06, 0xA1, 0xE0, 0xFE, 0x90, 0x06, 0xA0, 0x12, 0xCE, 0x56, 0x90, ++0x98, 0xA1, 0xF0, 0xA3, 0xEF, 0x12, 0xD7, 0x97, 0x90, 0x06, 0xA0, 0x74, 0x20, 0xF0, 0xA3, 0x74, ++0x01, 0xF0, 0xE4, 0xFD, 0xFF, 0x02, 0xB5, 0xB6, 0x12, 0x9F, 0x54, 0x90, 0x98, 0x86, 0xE0, 0x64, ++0x01, 0xF0, 0xE0, 0x24, 0x28, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xE8, 0xA3, 0xF0, 0x12, 0x9A, 0x1F, ++0x90, 0x97, 0xB7, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x97, 0xB5, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, ++0xE4, 0x90, 0x97, 0xDB, 0xF0, 0xEF, 0x24, 0x24, 0xFF, 0xE4, 0x3E, 0xFE, 0xC0, 0x06, 0x51, 0x05, ++0xF0, 0xD0, 0x06, 0xE4, 0xFB, 0xFA, 0x31, 0xE9, 0xF0, 0x4E, 0x60, 0x51, 0xE0, 0x24, 0x01, 0xFF, ++0x90, 0x97, 0xDC, 0xE0, 0x34, 0x00, 0x12, 0x9A, 0x7A, 0x90, 0x97, 0xBA, 0xEF, 0xF0, 0xE4, 0x90, ++0x97, 0xB9, 0xF0, 0x90, 0x97, 0xBA, 0xE0, 0xFF, 0x90, 0x97, 0xB9, 0xE0, 0xFE, 0xC3, 0x9F, 0x50, ++0x2C, 0x90, 0x97, 0xDD, 0xE0, 0x24, 0x02, 0xFD, 0x90, 0x97, 0xDC, 0xE0, 0x34, 0x00, 0xFC, 0xEE, ++0x7E, 0x00, 0x2D, 0x12, 0x9A, 0x77, 0x90, 0x97, 0xB9, 0xE0, 0x24, 0xBB, 0xF5, 0x82, 0xE4, 0x34, ++0x97, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xB9, 0xE0, 0x04, 0xF0, 0x80, 0xC6, 0x90, 0x97, 0xB6, ++0xE0, 0x24, 0x24, 0xFF, 0x90, 0x97, 0xB5, 0xE0, 0x34, 0x00, 0xFE, 0xC0, 0x06, 0x51, 0x05, 0xF0, ++0xD0, 0x06, 0x7B, 0x03, 0x7A, 0x00, 0xE4, 0x31, 0xE9, 0xF0, 0xE4, 0x90, 0x97, 0xB9, 0xF0, 0x90, ++0x97, 0xB9, 0xE0, 0xFF, 0xC3, 0x94, 0x03, 0x50, 0x70, 0xA3, 0xE0, 0xFE, 0x60, 0x63, 0xEF, 0x75, ++0xF0, 0x21, 0xA4, 0x24, 0xA4, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xE0, 0xFF, 0xEE, 0x6F, ++0x70, 0x4F, 0x90, 0x04, 0xFC, 0xE0, 0x04, 0xF0, 0x90, 0x97, 0xBA, 0xE0, 0xFF, 0x7E, 0x00, 0xC0, ++0x06, 0xC0, 0x07, 0x90, 0x97, 0xB9, 0xE0, 0x75, 0xF0, 0x21, 0xA4, 0x24, 0xA5, 0xF9, 0x74, 0x98, ++0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x78, 0xBB, 0x7C, 0x97, 0x7D, 0x01, 0xD0, 0x07, 0xD0, 0x06, 0x12, ++0x87, 0xAC, 0xEF, 0x70, 0x1C, 0x90, 0x01, 0xC7, 0x74, 0x24, 0xF0, 0x7F, 0x01, 0x12, 0xAA, 0x81, ++0x12, 0xAF, 0xD0, 0x30, 0xE0, 0x03, 0x12, 0xBF, 0x57, 0x12, 0x95, 0x43, 0xE4, 0xFF, 0x12, 0xA0, ++0x11, 0x90, 0x97, 0xB9, 0xE0, 0x04, 0xF0, 0x80, 0x86, 0x22, 0x12, 0xCF, 0xA1, 0xED, 0xF0, 0xA3, ++0xEA, 0xF0, 0xA3, 0xEB, 0xF0, 0xC3, 0x90, 0x97, 0xE6, 0xE0, 0x94, 0x01, 0x90, 0x97, 0xE5, 0xE0, ++0x94, 0x00, 0x50, 0x02, 0x80, 0x6F, 0xE4, 0x90, 0x97, 0xE9, 0xF0, 0xA3, 0xF0, 0x31, 0xFC, 0x12, ++0x9A, 0x7B, 0x90, 0x97, 0xE3, 0xE0, 0x70, 0x03, 0xA3, 0xE0, 0x6F, 0x70, 0x17, 0x90, 0x97, 0xE1, ++0xE0, 0x24, 0x02, 0x31, 0xF4, 0xFE, 0x90, 0x97, 0xE2, 0xE0, 0xFD, 0x51, 0x19, 0xBF, 0x01, 0x02, ++0x80, 0x5A, 0x80, 0x00, 0x90, 0x97, 0xE1, 0xE0, 0x24, 0x01, 0x31, 0xF4, 0x12, 0x9A, 0x7A, 0x7E, ++0x00, 0x90, 0x97, 0xE7, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x24, 0x02, 0xFF, 0xEE, 0x33, 0xFE, 0x90, ++0x97, 0xE0, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x97, 0xE9, 0xEE, 0x8F, 0xF0, 0x12, 0x02, 0xE7, ++0x90, 0x97, 0xE5, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x90, 0x97, 0xEA, 0xE0, 0x9F, 0x90, 0x97, ++0xE9, 0xE0, 0x9E, 0x40, 0x98, 0xE4, 0xFE, 0xFF, 0x22, 0xFD, 0x31, 0x5A, 0x90, 0x97, 0xDC, 0xEE, ++0xF0, 0xA3, 0xEF, 0x22, 0xFF, 0x90, 0x97, 0xE0, 0xE0, 0x34, 0x00, 0x22, 0x90, 0x97, 0xE0, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x97, 0xB8, 0xE0, 0x24, 0xDC, 0xFE, 0x90, 0x97, 0xB7, 0xE0, ++0x34, 0xFF, 0x90, 0x97, 0xE5, 0xF0, 0xA3, 0xCE, 0x22, 0xED, 0x14, 0x60, 0x06, 0x04, 0x70, 0x03, ++0x7F, 0x01, 0x22, 0x7F, 0x01, 0x22, 0x12, 0x9F, 0x54, 0xA3, 0xED, 0xF0, 0x90, 0x95, 0x69, 0xE0, ++0x70, 0x02, 0xA3, 0xE0, 0x60, 0x2D, 0xE4, 0x90, 0x97, 0xB6, 0xF0, 0x51, 0xC5, 0x50, 0x27, 0x12, ++0x9A, 0x1F, 0x51, 0x77, 0x12, 0x9A, 0x4F, 0x90, 0x97, 0xB6, 0xE0, 0x24, 0x77, 0xF5, 0x82, 0xE4, ++0x34, 0x95, 0xF5, 0x83, 0xE0, 0x6F, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x97, 0xB6, 0xE0, 0x04, ++0xF0, 0x80, 0xD8, 0x7F, 0x00, 0x22, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0xE4, 0x90, 0x95, ++0x75, 0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0xED, 0x24, 0x1C, 0xFD, 0x90, 0x8A, 0xE9, 0x22, 0x12, ++0x9F, 0x54, 0xA3, 0xED, 0xF0, 0xE4, 0xA3, 0xF0, 0x51, 0xC5, 0x50, 0x21, 0x12, 0x9A, 0x1F, 0x51, ++0x77, 0x12, 0x9A, 0x4F, 0x90, 0x97, 0xB6, 0xE0, 0x24, 0x97, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, ++0x83, 0xE0, 0xB5, 0x07, 0x1D, 0x90, 0x97, 0xB6, 0xE0, 0x04, 0xF0, 0x80, 0xDB, 0x90, 0x06, 0x32, ++0xE0, 0x44, 0x80, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x30, 0xF0, 0x7F, 0x01, 0x12, 0xAA, 0x81, 0x7F, ++0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x97, 0xB6, 0xE0, 0xFD, 0xC3, 0x94, 0x02, 0x22, 0x12, 0x9F, ++0x54, 0xE4, 0xA3, 0xF0, 0x90, 0x97, 0xB5, 0xE0, 0xFD, 0xC3, 0x94, 0x04, 0x50, 0x2C, 0x90, 0x97, ++0xB4, 0xE0, 0x24, 0x10, 0x12, 0x9D, 0x64, 0xFE, 0x90, 0x8A, 0xE9, 0x12, 0x9A, 0x4F, 0x90, 0x97, ++0xB5, 0xE0, 0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0x6F, 0x60, 0x03, 0x7F, ++0x00, 0x22, 0x90, 0x97, 0xB5, 0xE0, 0x04, 0xF0, 0x80, 0xCA, 0x7F, 0x01, 0x22, 0x12, 0x9F, 0x54, ++0x24, 0x16, 0xFF, 0xE4, 0x3E, 0x12, 0x9A, 0x7A, 0x90, 0x95, 0x73, 0xA3, 0xE0, 0xB5, 0x07, 0x1E, ++0x90, 0x97, 0xB4, 0xE0, 0x24, 0x16, 0x12, 0x9D, 0x64, 0xFE, 0x12, 0xAE, 0x40, 0x7D, 0x01, 0x12, ++0x04, 0x7E, 0xEF, 0xFD, 0x90, 0x95, 0x73, 0xE0, 0x6D, 0x70, 0x01, 0xE4, 0x60, 0x03, 0x7F, 0x00, ++0x22, 0x7F, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, ++0xE0, 0x10, 0x90, 0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x12, 0x75, 0x15, 0x10, ++0x80, 0x2D, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x15, 0x01, 0x80, 0x20, 0x90, ++0x88, 0x31, 0x12, 0x98, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x15, 0x02, 0x80, 0x12, 0x90, 0x88, 0x38, ++0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x15, 0x08, 0x80, 0x04, 0x71, 0xA2, 0x80, 0x0E, 0x90, ++0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x15, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x93, 0x08, 0xE0, 0xC3, 0x13, ++0x20, 0xE0, 0x48, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, ++0x3F, 0x60, 0x05, 0x75, 0x0F, 0x01, 0x80, 0x4C, 0x90, 0x93, 0x24, 0xE0, 0x30, 0xE0, 0x0B, 0x90, ++0x02, 0x82, 0xE0, 0x60, 0x05, 0x75, 0x0F, 0x02, 0x80, 0x3A, 0x90, 0x93, 0x2D, 0xE0, 0x30, 0xE0, ++0x05, 0x75, 0x0F, 0x08, 0x80, 0x2E, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, ++0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x0F, 0x04, 0x80, 0x19, 0x90, 0x88, 0xE6, 0xE0, 0x30, ++0xE0, 0x05, 0x75, 0x0F, 0x20, 0x80, 0x0D, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x05, 0x75, 0x0F, 0x40, ++0x80, 0x02, 0x80, 0x8E, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x0F, 0xF0, ++0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, ++0x1E, 0x90, 0x88, 0xAF, 0xE0, 0x60, 0x05, 0x75, 0x16, 0x40, 0x81, 0xCC, 0x90, 0x88, 0x38, 0xE0, ++0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x2D, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x7B, 0x80, 0x55, 0x12, ++0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x16, 0x01, 0x80, 0x70, 0x90, 0x88, 0x3A, 0xE0, ++0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x16, 0x02, 0x80, 0x62, 0x90, 0x88, 0x38, 0xE0, 0xFE, 0xE4, ++0xC3, 0x9E, 0x50, 0x05, 0x75, 0x16, 0x04, 0x80, 0x53, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x16, 0x08, ++0x80, 0x4A, 0x90, 0x88, 0x3A, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x16, 0x10, 0x80, 0x3E, 0x90, 0x88, ++0x32, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x16, 0x20, 0x80, 0x2E, 0x90, 0x88, ++0x9C, 0xE0, 0x60, 0x05, 0x75, 0x16, 0x80, 0x80, 0x23, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, 0x05, ++0x75, 0x16, 0x11, 0x80, 0x17, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, 0xFF, ++0xBF, 0x80, 0x05, 0x75, 0x16, 0x12, 0x80, 0x04, 0x71, 0xA2, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, ++0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x16, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x4A, 0xED, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, ++0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xC1, 0x54, 0xEE, 0x12, 0x8F, 0xDB, 0x30, 0xE0, ++0x02, 0xC1, 0x54, 0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0xC1, 0x54, 0xEF, 0x70, 0x02, ++0xA1, 0xB0, 0x24, 0xFE, 0x70, 0x02, 0xA1, 0xF8, 0x24, 0xFE, 0x60, 0x50, 0x24, 0xFC, 0x70, 0x02, ++0xC1, 0x3F, 0x24, 0xFC, 0x60, 0x02, 0xC1, 0x4F, 0xEE, 0xB4, 0x0E, 0x03, 0x12, 0x71, 0x5F, 0x90, ++0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, ++0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x12, 0x90, 0x9A, 0x4A, 0xE0, 0xFF, ++0x60, 0x05, 0x12, 0x67, 0x80, 0x80, 0x06, 0x90, 0x8A, 0xED, 0x12, 0x8E, 0x2C, 0x90, 0x88, 0x39, ++0xE0, 0x64, 0x08, 0x60, 0x02, 0xC1, 0x4F, 0x12, 0x7B, 0xCC, 0xC1, 0x4F, 0x90, 0x88, 0x39, 0xE0, ++0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, ++0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0C, 0x90, 0x86, 0x00, 0x12, 0x8E, 0x2C, 0xBF, 0x01, ++0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xC1, 0x4F, 0x90, 0x86, ++0x00, 0x12, 0x8E, 0x2C, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xC1, 0x4F, 0x12, 0x68, 0xC2, 0xC1, 0x4F, ++0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0C, 0x90, 0x86, 0x00, 0x12, 0x8E, 0x2C, 0xBF, 0x01, 0x03, ++0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, ++0xE0, 0xB4, 0x0C, 0x0C, 0x90, 0x86, 0x00, 0x12, 0x8E, 0x2C, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, ++0x90, 0x88, 0x39, 0xE0, 0x64, 0x04, 0x70, 0x67, 0x90, 0x86, 0x02, 0x12, 0x8E, 0x2C, 0xEF, 0x64, ++0x01, 0x70, 0x5C, 0x12, 0x73, 0x5A, 0x80, 0x57, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0C, 0x90, ++0x86, 0x00, 0x12, 0x8E, 0x2C, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, ++0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, 0x86, 0x00, 0x12, ++0x8E, 0x2C, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, ++0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x15, 0x12, 0x7A, 0x49, 0x80, 0x10, 0x90, ++0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x09, 0x12, 0x97, 0xD5, 0x30, 0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, ++0x88, 0x39, 0xD1, 0x59, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x88, ++0x38, 0xE0, 0x90, 0x01, 0xBB, 0xF0, 0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, 0xF0, 0xA3, 0xF0, 0xA3, ++0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0xD1, 0xC2, 0x40, ++0x40, 0x90, 0x88, 0x50, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, 0x90, 0x88, 0x50, 0xE0, ++0xD3, 0x9F, 0x50, 0x2D, 0x90, 0x88, 0x48, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3F, 0x12, 0x9F, 0x5F, ++0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0x88, 0x3E, 0xE0, 0x2F, 0x90, 0x88, 0x4F, 0xF0, 0xFB, ++0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x92, 0x98, 0x74, 0x03, 0xF0, 0x12, 0x6E, ++0x2F, 0x22, 0x90, 0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, 0x3F, 0xE0, 0xD3, 0x9F, 0x22, 0xE4, 0xFE, ++0x12, 0xA3, 0x99, 0xE4, 0xF0, 0x74, 0x8B, 0x2E, 0x12, 0xA3, 0x91, 0x74, 0xFF, 0xF0, 0x0E, 0xEE, ++0xB4, 0xA0, 0xED, 0xE4, 0x90, 0x88, 0x4D, 0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, 0x88, 0x50, 0xF0, ++0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0xA0, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0x90, 0x93, 0x08, 0xE0, ++0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0xA7, 0xED, 0x22, 0xF9, 0xE4, ++0x3A, 0x8B, 0x45, 0xF5, 0x46, 0x89, 0x47, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0x76, ++0x12, 0x69, 0xF5, 0x90, 0x98, 0x70, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x22, 0x90, 0x05, 0x63, 0xE0, ++0x90, 0x88, 0x89, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, 0x90, 0x05, 0x61, 0xE0, ++0x90, 0x88, 0x8B, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, 0x90, 0x88, 0x32, 0xE0, ++0x44, 0x80, 0xF0, 0x22, 0xFF, 0x90, 0x98, 0x75, 0xF0, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0x76, 0x12, ++0x8F, 0x21, 0x90, 0x98, 0x72, 0x12, 0x85, 0xEE, 0xE9, 0x22, 0xE0, 0xFF, 0x24, 0x10, 0xF5, 0x82, ++0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB2, 0xF0, 0x74, 0x15, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB3, 0xF0, 0xE0, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, ++0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, ++0xF8, 0xFF, 0x90, 0x95, 0xEA, 0xE0, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, ++0x82, 0x8E, 0x83, 0x02, 0x04, 0x7E, 0x90, 0x88, 0x28, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x88, 0x27, ++0xE0, 0x34, 0x00, 0xFE, 0xC3, 0x22, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x22, 0x54, ++0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x22, 0x90, 0x88, 0x38, 0xE0, 0x90, 0x98, 0xA0, 0xF0, ++0x90, 0x8A, 0x89, 0x22, 0x7D, 0x01, 0x7E, 0x00, 0x7F, 0x10, 0x12, 0x87, 0xAC, 0xEF, 0x22, 0x7F, ++0x84, 0x7E, 0x08, 0x12, 0xB7, 0x14, 0x90, 0x99, 0x92, 0x22, 0x90, 0x97, 0x32, 0x12, 0x85, 0xF7, ++0x02, 0x02, 0x06, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, 0x4D, 0xFF, 0x22, 0xF0, 0xEE, 0x54, 0x80, ++0xFE, 0xEF, 0x54, 0x7F, 0x22, 0x90, 0x97, 0xCA, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x22, 0x90, 0x97, ++0xCA, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x22, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x87, 0xAC, 0xEF, 0x22, ++0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0x22, 0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x22, ++0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0x2C, 0xC0, ++}; ++u32 array_length_mp_8723d_fw_wowlan = 28778; ++ ++#endif ++ ++void ++ODM_ReadFirmware_MP_8723D_FW_WoWLAN( ++ IN PDM_ODM_T pDM_Odm, ++ OUT u1Byte *pFirmware, ++ OUT u4Byte *pFirmwareSize ++) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)array_mp_8723d_fw_wowlan; ++#else ++ ODM_MoveMemory(pDM_Odm, pFirmware, array_mp_8723d_fw_wowlan, array_length_mp_8723d_fw_wowlan); ++#endif ++ *pFirmwareSize = array_length_mp_8723d_fw_wowlan; ++} ++ ++ ++ ++#endif /* end of (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP)))*/ ++ ++#endif /* end of HWIMG_SUPPORT*/ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.h 2018-02-11 21:44:27.161146299 +0200 +@@ -0,0 +1,62 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++/*Image2HeaderVersion: 2.16*/ ++#if (RTL8723D_SUPPORT == 1) ++#ifndef __INC_MP_FW_HW_IMG_8723D_H ++#define __INC_MP_FW_HW_IMG_8723D_H ++ ++ ++/****************************************************************************** ++* FW_AP.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadFirmware_MP_8723D_FW_AP( ++ IN PDM_ODM_T pDM_Odm, ++ OUT u1Byte *pFirmware, ++ OUT u4Byte *pFirmwareSize ++); ++ ++/****************************************************************************** ++* FW_NIC.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadFirmware_MP_8723D_FW_NIC( ++ IN PDM_ODM_T pDM_Odm, ++ OUT u1Byte *pFirmware, ++ OUT u4Byte *pFirmwareSize ++); ++ ++/****************************************************************************** ++* FW_WoWLAN.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadFirmware_MP_8723D_FW_WoWLAN( ++ IN PDM_ODM_T pDM_Odm, ++ OUT u1Byte *pFirmware, ++ OUT u4Byte *pFirmwareSize ++); ++ ++#endif ++#endif /* end of HWIMG_SUPPORT*/ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.c 2018-02-11 21:44:27.161146299 +0200 +@@ -0,0 +1,301 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++/*Image2HeaderVersion: 2.26*/ ++#include "mp_precomp.h" ++#include "../phydm_precomp.h" ++ ++#if (RTL8723D_SUPPORT == 1) ++static BOOLEAN ++CheckPositive( ++ IN PDM_ODM_T pDM_Odm, ++ IN const u4Byte Condition1, ++ IN const u4Byte Condition2, ++ IN const u4Byte Condition3, ++ IN const u4Byte Condition4 ++) ++{ ++ u1Byte _BoardType = ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA*/ ++ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA*/ ++ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA*/ ++ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ ++ ((pDM_Odm->BoardType & BIT2) >> 2) << 4 | /* _BT*/ ++ ((pDM_Odm->BoardType & BIT1) >> 1) << 5; /* _NGFF*/ ++ ++ u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; ++ ++ u1Byte cut_version_for_para = (pDM_Odm->CutVersion == ODM_CUT_A) ? 15 : pDM_Odm->CutVersion; ++ u1Byte pkg_type_for_para = (pDM_Odm->PackageType == 0) ? 15 : pDM_Odm->PackageType; ++ ++ u4Byte driver1 = cut_version_for_para << 24 | ++ (pDM_Odm->SupportInterface & 0xF0) << 16 | ++ pDM_Odm->SupportPlatform << 16 | ++ pkg_type_for_para << 12 | ++ (pDM_Odm->SupportInterface & 0x0F) << 8 | ++ _BoardType; ++ ++ u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | ++ (pDM_Odm->TypeGPA & 0xFF) << 8 | ++ (pDM_Odm->TypeALNA & 0xFF) << 16 | ++ (pDM_Odm->TypeAPA & 0xFF) << 24; ++ ++u4Byte driver3 = 0; ++ ++ u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | ++ (pDM_Odm->TypeGPA & 0xFF00) | ++ (pDM_Odm->TypeALNA & 0xFF00) << 8 | ++ (pDM_Odm->TypeAPA & 0xFF00) << 16; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ++ ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ++ ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ++ (" (Platform, Interface) = (0x%X, 0x%X)\n", pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ++ (" (Board, Package) = (0x%X, 0x%X)\n", pDM_Odm->BoardType, pDM_Odm->PackageType)); ++ ++ ++ /*============== Value Defined Check ===============*/ ++ /*QFN Type [15:12] and Cut Version [27:24] need to do value check*/ ++ ++ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) ++ return FALSE; ++ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) ++ return FALSE; ++ ++ /*=============== Bit Defined Check ================*/ ++ /* We don't care [31:28] */ ++ ++ cond1 &= 0x00FF0FFF; ++ driver1 &= 0x00FF0FFF; ++ ++ if ((cond1 & driver1) == cond1) { ++ u4Byte bitMask = 0; ++ ++ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE*/ ++ return TRUE; ++ ++ if ((cond1 & BIT0) != 0) /*GLNA*/ ++ bitMask |= 0x000000FF; ++ if ((cond1 & BIT1) != 0) /*GPA*/ ++ bitMask |= 0x0000FF00; ++ if ((cond1 & BIT2) != 0) /*ALNA*/ ++ bitMask |= 0x00FF0000; ++ if ((cond1 & BIT3) != 0) /*APA*/ ++ bitMask |= 0xFF000000; ++ ++ if (((cond2 & bitMask) == (driver2 & bitMask)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ ++ return TRUE; ++ else ++ return FALSE; ++ } else ++ return FALSE; ++} ++static BOOLEAN ++CheckNegative( ++ IN PDM_ODM_T pDM_Odm, ++ IN const u4Byte Condition1, ++ IN const u4Byte Condition2 ++) ++{ ++ return TRUE; ++} ++ ++/****************************************************************************** ++* MAC_REG.TXT ++******************************************************************************/ ++ ++u4Byte Array_MP_8723D_MAC_REG[] = { ++ 0x020, 0x00000013, ++ 0x02F, 0x00000010, ++ 0x077, 0x00000007, ++ 0x421, 0x0000000F, ++ 0x428, 0x0000000A, ++ 0x429, 0x00000010, ++ 0x430, 0x00000000, ++ 0x431, 0x00000000, ++ 0x432, 0x00000000, ++ 0x433, 0x00000001, ++ 0x434, 0x00000004, ++ 0x435, 0x00000005, ++ 0x436, 0x00000007, ++ 0x437, 0x00000008, ++ 0x43C, 0x00000004, ++ 0x43D, 0x00000005, ++ 0x43E, 0x00000007, ++ 0x43F, 0x00000008, ++ 0x440, 0x0000005D, ++ 0x441, 0x00000001, ++ 0x442, 0x00000000, ++ 0x444, 0x00000010, ++ 0x445, 0x00000000, ++ 0x446, 0x00000000, ++ 0x447, 0x00000000, ++ 0x448, 0x00000000, ++ 0x449, 0x000000F0, ++ 0x44A, 0x0000000F, ++ 0x44B, 0x0000003E, ++ 0x44C, 0x00000010, ++ 0x44D, 0x00000000, ++ 0x44E, 0x00000000, ++ 0x44F, 0x00000000, ++ 0x450, 0x00000000, ++ 0x451, 0x000000F0, ++ 0x452, 0x0000000F, ++ 0x453, 0x00000000, ++ 0x456, 0x0000005E, ++ 0x460, 0x00000066, ++ 0x461, 0x00000066, ++ 0x4C8, 0x000000FF, ++ 0x4C9, 0x00000008, ++ 0x4CC, 0x000000FF, ++ 0x4CD, 0x000000FF, ++ 0x4CE, 0x00000001, ++ 0x500, 0x00000026, ++ 0x501, 0x000000A2, ++ 0x502, 0x0000002F, ++ 0x503, 0x00000000, ++ 0x504, 0x00000028, ++ 0x505, 0x000000A3, ++ 0x506, 0x0000005E, ++ 0x507, 0x00000000, ++ 0x508, 0x0000002B, ++ 0x509, 0x000000A4, ++ 0x50A, 0x0000005E, ++ 0x50B, 0x00000000, ++ 0x50C, 0x0000004F, ++ 0x50D, 0x000000A4, ++ 0x50E, 0x00000000, ++ 0x50F, 0x00000000, ++ 0x512, 0x0000001C, ++ 0x514, 0x0000000A, ++ 0x516, 0x0000000A, ++ 0x525, 0x0000004F, ++ 0x550, 0x00000010, ++ 0x551, 0x00000010, ++ 0x559, 0x00000002, ++ 0x55C, 0x00000028, ++ 0x55D, 0x000000FF, ++ 0x605, 0x00000030, ++ 0x608, 0x0000000E, ++ 0x609, 0x0000002A, ++ 0x620, 0x000000FF, ++ 0x621, 0x000000FF, ++ 0x622, 0x000000FF, ++ 0x623, 0x000000FF, ++ 0x624, 0x000000FF, ++ 0x625, 0x000000FF, ++ 0x626, 0x000000FF, ++ 0x627, 0x000000FF, ++ 0x638, 0x00000028, ++ 0x63C, 0x0000000A, ++ 0x63D, 0x0000000A, ++ 0x63E, 0x0000000C, ++ 0x63F, 0x0000000C, ++ 0x640, 0x00000040, ++ 0x642, 0x00000040, ++ 0x643, 0x00000000, ++ 0x652, 0x000000C8, ++ 0x66A, 0x000000B0, ++ 0x66E, 0x00000005, ++ 0x700, 0x00000021, ++ 0x701, 0x00000043, ++ 0x702, 0x00000065, ++ 0x703, 0x00000087, ++ 0x708, 0x00000021, ++ 0x709, 0x00000043, ++ 0x70A, 0x00000065, ++ 0x70B, 0x00000087, ++ 0x765, 0x00000018, ++ 0x76E, 0x00000004, ++ 0x7C0, 0x00000038, ++ 0x7C2, 0x0000000F, ++ 0x7C3, 0x000000C0, ++ 0x073, 0x00000004, ++ 0x7C4, 0x00000077, ++ 0x07C, 0x00000003, ++ 0x016, 0x000000B3, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8723D_MAC_REG( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ u4Byte i = 0; ++ u1Byte cCond; ++ BOOLEAN bMatched = TRUE, bSkipped = FALSE; ++ u4Byte ArrayLen = sizeof(Array_MP_8723D_MAC_REG)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8723D_MAC_REG; ++ ++ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_MAC_REG\n")); ++ ++ while ((i + 1) < ArrayLen) { ++ v1 = Array[i]; ++ v2 = Array[i + 1]; ++ ++ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ ++ if (v1 & BIT31) {/* positive condition*/ ++ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); ++ if (cCond == COND_ENDIF) {/*end*/ ++ bMatched = TRUE; ++ bSkipped = FALSE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); ++ } else if (cCond == COND_ELSE) { /*else*/ ++ bMatched = bSkipped?FALSE:TRUE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); ++ } else {/*if , else if*/ ++ pre_v1 = v1; ++ pre_v2 = v2; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); ++ } ++ } else if (v1 & BIT30) { /*negative condition*/ ++ if (bSkipped == FALSE) { ++ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { ++ bMatched = TRUE; ++ bSkipped = TRUE; ++ } else { ++ bMatched = FALSE; ++ bSkipped = FALSE; ++ } ++ } else ++ bMatched = FALSE; ++ } ++ } else { ++ if (bMatched) ++ odm_ConfigMAC_8723D(pDM_Odm, v1, (u1Byte)v2); ++ } ++ i = i + 2; ++ } ++} ++ ++u4Byte ++ODM_GetVersion_MP_8723D_MAC_REG(void) ++{ ++ return 31; ++} ++ ++#endif /* end of HWIMG_SUPPORT*/ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.h 2018-02-11 21:44:27.161146299 +0200 +@@ -0,0 +1,39 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++/*Image2HeaderVersion: 2.26*/ ++#if (RTL8723D_SUPPORT == 1) ++#ifndef __INC_MP_MAC_HW_IMG_8723D_H ++#define __INC_MP_MAC_HW_IMG_8723D_H ++ ++ ++/****************************************************************************** ++* MAC_REG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8723D_MAC_REG(/* TC: Test Chip, MP: MP Chip*/ ++ IN PDM_ODM_T pDM_Odm ++); ++u4Byte ODM_GetVersion_MP_8723D_MAC_REG(void); ++ ++#endif ++#endif /* end of HWIMG_SUPPORT*/ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.c 2018-02-11 21:44:27.161146299 +0200 +@@ -0,0 +1,1199 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++/*Image2HeaderVersion: 2.26*/ ++#include "mp_precomp.h" ++#include "../phydm_precomp.h" ++ ++#if (RTL8723D_SUPPORT == 1) ++static BOOLEAN ++CheckPositive( ++ IN PDM_ODM_T pDM_Odm, ++ IN const u4Byte Condition1, ++ IN const u4Byte Condition2, ++ IN const u4Byte Condition3, ++ IN const u4Byte Condition4 ++) ++{ ++ u1Byte _BoardType = ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA*/ ++ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA*/ ++ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA*/ ++ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ ++ ((pDM_Odm->BoardType & BIT2) >> 2) << 4 | /* _BT*/ ++ ((pDM_Odm->BoardType & BIT1) >> 1) << 5; /* _NGFF*/ ++ ++ u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; ++ ++ u1Byte cut_version_for_para = (pDM_Odm->CutVersion == ODM_CUT_A) ? 15 : pDM_Odm->CutVersion; ++ u1Byte pkg_type_for_para = (pDM_Odm->PackageType == 0) ? 15 : pDM_Odm->PackageType; ++ ++ u4Byte driver1 = cut_version_for_para << 24 | ++ (pDM_Odm->SupportInterface & 0xF0) << 16 | ++ pDM_Odm->SupportPlatform << 16 | ++ pkg_type_for_para << 12 | ++ (pDM_Odm->SupportInterface & 0x0F) << 8 | ++ _BoardType; ++ ++ u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | ++ (pDM_Odm->TypeGPA & 0xFF) << 8 | ++ (pDM_Odm->TypeALNA & 0xFF) << 16 | ++ (pDM_Odm->TypeAPA & 0xFF) << 24; ++ ++u4Byte driver3 = 0; ++ ++ u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | ++ (pDM_Odm->TypeGPA & 0xFF00) | ++ (pDM_Odm->TypeALNA & 0xFF00) << 8 | ++ (pDM_Odm->TypeAPA & 0xFF00) << 16; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ++ ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ++ ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ++ (" (Platform, Interface) = (0x%X, 0x%X)\n", pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ++ (" (Board, Package) = (0x%X, 0x%X)\n", pDM_Odm->BoardType, pDM_Odm->PackageType)); ++ ++ ++ /*============== Value Defined Check ===============*/ ++ /*QFN Type [15:12] and Cut Version [27:24] need to do value check*/ ++ ++ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) ++ return FALSE; ++ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) ++ return FALSE; ++ ++ /*=============== Bit Defined Check ================*/ ++ /* We don't care [31:28] */ ++ ++ cond1 &= 0x00FF0FFF; ++ driver1 &= 0x00FF0FFF; ++ ++ if ((cond1 & driver1) == cond1) { ++ u4Byte bitMask = 0; ++ ++ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE*/ ++ return TRUE; ++ ++ if ((cond1 & BIT0) != 0) /*GLNA*/ ++ bitMask |= 0x000000FF; ++ if ((cond1 & BIT1) != 0) /*GPA*/ ++ bitMask |= 0x0000FF00; ++ if ((cond1 & BIT2) != 0) /*ALNA*/ ++ bitMask |= 0x00FF0000; ++ if ((cond1 & BIT3) != 0) /*APA*/ ++ bitMask |= 0xFF000000; ++ ++ if (((cond2 & bitMask) == (driver2 & bitMask)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ ++ return TRUE; ++ else ++ return FALSE; ++ } else ++ return FALSE; ++} ++static BOOLEAN ++CheckNegative( ++ IN PDM_ODM_T pDM_Odm, ++ IN const u4Byte Condition1, ++ IN const u4Byte Condition2 ++) ++{ ++ return TRUE; ++} ++ ++/****************************************************************************** ++* RadioA.TXT ++******************************************************************************/ ++ ++u4Byte Array_MP_8723D_RadioA[] = { ++ 0x050, 0x00019000, ++ 0x000, 0x00010000, ++ 0x0B1, 0x00054573, ++ 0x0B4, 0x000508AB, ++ 0x0B7, 0x00014787, ++ 0x0B8, 0x000064CB, ++ 0x01B, 0x00073A40, ++ 0x051, 0x00038CAF, ++ 0x052, 0x000FCCA3, ++ 0x053, 0x00090F38, ++ 0x054, 0x00011083, ++ 0x057, 0x000D0000, ++ 0x08D, 0x00000A1A, ++ 0x082, 0x00082AAC, ++ 0x08E, 0x00076940, ++ 0x08F, 0x00088400, ++ 0x061, 0x00038CAF, ++ 0x062, 0x000FCCA3, ++ 0x063, 0x00090F38, ++ 0x064, 0x00011083, ++ 0x067, 0x000D0000, ++ 0x092, 0x00082AAC, ++ 0x0EF, 0x00000400, ++ 0x030, 0x000008CA, ++ 0x030, 0x000018CF, ++ 0x030, 0x000028CA, ++ 0x030, 0x000038CA, ++ 0x0EF, 0x00000000, ++ 0x0EE, 0x00000400, ++ 0x030, 0x000008CA, ++ 0x030, 0x000018CF, ++ 0x030, 0x000028CA, ++ 0x030, 0x000038CA, ++ 0x0EE, 0x00000000, ++ 0x0EF, 0x00000100, ++ 0x033, 0x00000000, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000001, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000002, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000003, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000004, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000005, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000006, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000007, ++ 0x03F, 0x0000CCA3, ++ 0x0EF, 0x00000000, ++ 0x0EE, 0x00000100, ++ 0x033, 0x00000000, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000001, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000002, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000003, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000004, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000005, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000006, ++ 0x03F, 0x0000CCA3, ++ 0x033, 0x00000007, ++ 0x03F, 0x0000CCA3, ++ 0x0EE, 0x00000000, ++ 0x0EF, 0x00000800, ++ 0x030, 0x0000002D, ++ 0x030, 0x0000122C, ++ 0x030, 0x0000222F, ++ 0x030, 0x0000326C, ++ 0x030, 0x0000466B, ++ 0x030, 0x0000566E, ++ 0x030, 0x000066EB, ++ 0x030, 0x000077EC, ++ 0x030, 0x000087EF, ++ 0x030, 0x000097F2, ++ 0x030, 0x0000A7F5, ++ 0x0EF, 0x00000000, ++ 0x0EE, 0x00000800, ++ 0x030, 0x00000001, ++ 0x030, 0x00001011, ++ 0x030, 0x00002011, ++ 0x030, 0x00003013, ++ 0x030, 0x00004033, ++ 0x030, 0x00005033, ++ 0x030, 0x00006037, ++ 0x030, 0x0000703F, ++ 0x030, 0x0000803F, ++ 0x030, 0x0000903F, ++ 0x030, 0x0000A03F, ++ 0x0EE, 0x00000000, ++ 0x082, 0x00083B8C, ++ 0x0ED, 0x00000008, ++ 0x030, 0x000030F6, ++ 0x030, 0x00002004, ++ 0x030, 0x000010F6, ++ 0x030, 0x000000F6, ++ 0x0ED, 0x00000000, ++ 0x092, 0x00083B8C, ++ 0x0EC, 0x00000008, ++ 0x030, 0x000030F6, ++ 0x030, 0x00002004, ++ 0x030, 0x000010F6, ++ 0x030, 0x000000F6, ++ 0x0EC, 0x00000000, ++ 0x0EF, 0x00010000, ++ 0x030, 0x0001C11C, ++ 0x030, 0x000181F4, ++ 0x030, 0x00014108, ++ 0x030, 0x000101E4, ++ 0x030, 0x0000C11C, ++ 0x030, 0x000081F4, ++ 0x030, 0x00004108, ++ 0x030, 0x000001E4, ++ 0x0EF, 0x00000000, ++ 0x0EE, 0x00010000, ++ 0x030, 0x0001C11C, ++ 0x030, 0x000181F4, ++ 0x030, 0x00014108, ++ 0x030, 0x000101E4, ++ 0x030, 0x0000C11C, ++ 0x030, 0x000081F4, ++ 0x030, 0x00004108, ++ 0x030, 0x000001E4, ++ 0x0EE, 0x00000000, ++ 0x0EF, 0x00080000, ++ 0x033, 0x00000007, ++ 0x03E, 0x0000005F, ++ 0x03F, 0x000B3FDB, ++ 0x033, 0x00000004, ++ 0x03E, 0x0000005D, ++ 0x03F, 0x000BFFE0, ++ 0x033, 0x00000005, ++ 0x03E, 0x0000005D, ++ 0x03F, 0x000FBFCE, ++ 0x033, 0x00000006, ++ 0x03E, 0x0000005F, ++ 0x03F, 0x000A7FFB, ++ 0x0EF, 0x00000000, ++ 0x0EE, 0x00000002, ++ 0x030, 0x00000001, ++ 0x030, 0x00002001, ++ 0x030, 0x00004001, ++ 0x030, 0x00007001, ++ 0x030, 0x00006001, ++ 0x030, 0x00020001, ++ 0x030, 0x00022001, ++ 0x030, 0x00024001, ++ 0x030, 0x00027001, ++ 0x030, 0x00026001, ++ 0x030, 0x00034001, ++ 0x030, 0x00037001, ++ 0x030, 0x00036001, ++ 0x030, 0x00008000, ++ 0x030, 0x0000A000, ++ 0x030, 0x0000C000, ++ 0x030, 0x0000E000, ++ 0x030, 0x0001C000, ++ 0x030, 0x0001E000, ++ 0x0EE, 0x00000000, ++ 0x0EE, 0x00020000, ++ 0x0EF, 0x00020000, ++ 0x030, 0x00000F75, ++ 0x030, 0x00002F55, ++ 0x030, 0x00003F75, ++ 0x0EE, 0x00000000, ++ 0x0EF, 0x00000000, ++ 0x018, 0x00008401, ++ 0xFFE, 0x00000000, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8723D_RadioA( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ u4Byte i = 0; ++ u1Byte cCond; ++ BOOLEAN bMatched = TRUE, bSkipped = FALSE; ++ u4Byte ArrayLen = sizeof(Array_MP_8723D_RadioA)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8723D_RadioA; ++ ++ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_RadioA\n")); ++ ++ while ((i + 1) < ArrayLen) { ++ v1 = Array[i]; ++ v2 = Array[i + 1]; ++ ++ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ ++ if (v1 & BIT31) {/* positive condition*/ ++ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); ++ if (cCond == COND_ENDIF) {/*end*/ ++ bMatched = TRUE; ++ bSkipped = FALSE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); ++ } else if (cCond == COND_ELSE) { /*else*/ ++ bMatched = bSkipped?FALSE:TRUE; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); ++ } else {/*if , else if*/ ++ pre_v1 = v1; ++ pre_v2 = v2; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); ++ } ++ } else if (v1 & BIT30) { /*negative condition*/ ++ if (bSkipped == FALSE) { ++ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { ++ bMatched = TRUE; ++ bSkipped = TRUE; ++ } else { ++ bMatched = FALSE; ++ bSkipped = FALSE; ++ } ++ } else ++ bMatched = FALSE; ++ } ++ } else { ++ if (bMatched) ++ odm_ConfigRF_RadioA_8723D(pDM_Odm, v1, v2); ++ } ++ i = i + 2; ++ } ++} ++ ++u4Byte ++ODM_GetVersion_MP_8723D_RadioA(void) ++{ ++ return 31; ++} ++ ++/****************************************************************************** ++* TxPowerTrack_PCIE.TXT ++******************************************************************************/ ++ ++#if DEV_BUS_TYPE == RT_PCI_INTERFACE ++u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8723D[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, ++}; ++u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8723D[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++}; ++u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8723D[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, ++}; ++u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8723D[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++}; ++u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; ++u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; ++u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; ++u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; ++u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; ++u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; ++u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; ++u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; ++#endif ++ ++void ++ODM_ReadAndConfig_MP_8723D_TxPowerTrack_PCIE( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++#if DEV_BUS_TYPE == RT_PCI_INTERFACE ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8723D\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE*3); ++#endif ++} ++ ++/****************************************************************************** ++* TxPowerTrack_SDIO.TXT ++******************************************************************************/ ++ ++#if DEV_BUS_TYPE == RT_SDIO_INTERFACE ++u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_SDIO_8723D[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, ++}; ++u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_SDIO_8723D[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++}; ++u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_SDIO_8723D[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, ++}; ++u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_SDIO_8723D[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++}; ++u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; ++u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; ++u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; ++u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; ++u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_SDIO_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; ++u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; ++u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_SDIO_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; ++u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; ++#endif ++ ++void ++ODM_ReadAndConfig_MP_8723D_TxPowerTrack_SDIO( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++#if DEV_BUS_TYPE == RT_SDIO_INTERFACE ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8723D\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE*3); ++#endif ++} ++ ++/****************************************************************************** ++* TxPowerTrack_USB.TXT ++******************************************************************************/ ++ ++#if DEV_BUS_TYPE == RT_USB_INTERFACE ++u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8723D[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, ++}; ++u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8723D[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++}; ++u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8723D[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, ++ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, ++}; ++u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8723D[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, ++}; ++u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; ++u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; ++u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; ++u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; ++u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; ++u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; ++u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; ++u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; ++#endif ++ ++void ++ODM_ReadAndConfig_MP_8723D_TxPowerTrack_USB( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++#if DEV_BUS_TYPE == RT_USB_INTERFACE ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8723D\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE*3); ++#endif ++} ++ ++/****************************************************************************** ++* TXPWR_LMT.TXT ++******************************************************************************/ ++ ++const char *Array_MP_8723D_TXPWR_LMT[] = { ++ "FCC", "2.4G", "20M", "CCK", "1T", "01", "30", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "30", ++ "MKK", "2.4G", "20M", "CCK", "1T", "01", "30", ++ "FCC", "2.4G", "20M", "CCK", "1T", "02", "30", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "30", ++ "MKK", "2.4G", "20M", "CCK", "1T", "02", "30", ++ "FCC", "2.4G", "20M", "CCK", "1T", "03", "30", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "30", ++ "MKK", "2.4G", "20M", "CCK", "1T", "03", "30", ++ "FCC", "2.4G", "20M", "CCK", "1T", "04", "30", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "30", ++ "MKK", "2.4G", "20M", "CCK", "1T", "04", "30", ++ "FCC", "2.4G", "20M", "CCK", "1T", "05", "30", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "30", ++ "MKK", "2.4G", "20M", "CCK", "1T", "05", "30", ++ "FCC", "2.4G", "20M", "CCK", "1T", "06", "30", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "30", ++ "MKK", "2.4G", "20M", "CCK", "1T", "06", "30", ++ "FCC", "2.4G", "20M", "CCK", "1T", "07", "30", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "30", ++ "MKK", "2.4G", "20M", "CCK", "1T", "07", "30", ++ "FCC", "2.4G", "20M", "CCK", "1T", "08", "30", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "30", ++ "MKK", "2.4G", "20M", "CCK", "1T", "08", "30", ++ "FCC", "2.4G", "20M", "CCK", "1T", "09", "30", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "30", ++ "MKK", "2.4G", "20M", "CCK", "1T", "09", "30", ++ "FCC", "2.4G", "20M", "CCK", "1T", "10", "30", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "30", ++ "MKK", "2.4G", "20M", "CCK", "1T", "10", "30", ++ "FCC", "2.4G", "20M", "CCK", "1T", "11", "30", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "30", ++ "MKK", "2.4G", "20M", "CCK", "1T", "11", "30", ++ "FCC", "2.4G", "20M", "CCK", "1T", "12", "30", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "30", ++ "MKK", "2.4G", "20M", "CCK", "1T", "12", "30", ++ "FCC", "2.4G", "20M", "CCK", "1T", "13", "17", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "30", ++ "MKK", "2.4G", "20M", "CCK", "1T", "13", "30", ++ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "CCK", "1T", "14", "30", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "26", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "31", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "31", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "28", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "31", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "31", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "30", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "31", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "31", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "30", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "31", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "31", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "30", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "31", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "31", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "30", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "31", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "31", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "30", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "31", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "31", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "30", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "31", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "31", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "30", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "31", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "31", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "28", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "31", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "31", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "26", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "31", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "31", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "24", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "31", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "31", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "14", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "31", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "31", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "FCC", "2.4G", "20M", "HT", "1T", "01", "24", ++ "ETSI", "2.4G", "20M", "HT", "1T", "01", "31", ++ "MKK", "2.4G", "20M", "HT", "1T", "01", "31", ++ "FCC", "2.4G", "20M", "HT", "1T", "02", "26", ++ "ETSI", "2.4G", "20M", "HT", "1T", "02", "31", ++ "MKK", "2.4G", "20M", "HT", "1T", "02", "31", ++ "FCC", "2.4G", "20M", "HT", "1T", "03", "30", ++ "ETSI", "2.4G", "20M", "HT", "1T", "03", "31", ++ "MKK", "2.4G", "20M", "HT", "1T", "03", "31", ++ "FCC", "2.4G", "20M", "HT", "1T", "04", "30", ++ "ETSI", "2.4G", "20M", "HT", "1T", "04", "31", ++ "MKK", "2.4G", "20M", "HT", "1T", "04", "31", ++ "FCC", "2.4G", "20M", "HT", "1T", "05", "30", ++ "ETSI", "2.4G", "20M", "HT", "1T", "05", "31", ++ "MKK", "2.4G", "20M", "HT", "1T", "05", "31", ++ "FCC", "2.4G", "20M", "HT", "1T", "06", "30", ++ "ETSI", "2.4G", "20M", "HT", "1T", "06", "31", ++ "MKK", "2.4G", "20M", "HT", "1T", "06", "31", ++ "FCC", "2.4G", "20M", "HT", "1T", "07", "30", ++ "ETSI", "2.4G", "20M", "HT", "1T", "07", "31", ++ "MKK", "2.4G", "20M", "HT", "1T", "07", "31", ++ "FCC", "2.4G", "20M", "HT", "1T", "08", "30", ++ "ETSI", "2.4G", "20M", "HT", "1T", "08", "31", ++ "MKK", "2.4G", "20M", "HT", "1T", "08", "31", ++ "FCC", "2.4G", "20M", "HT", "1T", "09", "30", ++ "ETSI", "2.4G", "20M", "HT", "1T", "09", "31", ++ "MKK", "2.4G", "20M", "HT", "1T", "09", "31", ++ "FCC", "2.4G", "20M", "HT", "1T", "10", "26", ++ "ETSI", "2.4G", "20M", "HT", "1T", "10", "31", ++ "MKK", "2.4G", "20M", "HT", "1T", "10", "31", ++ "FCC", "2.4G", "20M", "HT", "1T", "11", "24", ++ "ETSI", "2.4G", "20M", "HT", "1T", "11", "31", ++ "MKK", "2.4G", "20M", "HT", "1T", "11", "31", ++ "FCC", "2.4G", "20M", "HT", "1T", "12", "23", ++ "ETSI", "2.4G", "20M", "HT", "1T", "12", "31", ++ "MKK", "2.4G", "20M", "HT", "1T", "12", "31", ++ "FCC", "2.4G", "20M", "HT", "1T", "13", "13", ++ "ETSI", "2.4G", "20M", "HT", "1T", "13", "31", ++ "MKK", "2.4G", "20M", "HT", "1T", "13", "31", ++ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", ++ "FCC", "2.4G", "20M", "HT", "2T", "01", "28", ++ "ETSI", "2.4G", "20M", "HT", "2T", "01", "30", ++ "MKK", "2.4G", "20M", "HT", "2T", "01", "30", ++ "FCC", "2.4G", "20M", "HT", "2T", "02", "28", ++ "ETSI", "2.4G", "20M", "HT", "2T", "02", "30", ++ "MKK", "2.4G", "20M", "HT", "2T", "02", "30", ++ "FCC", "2.4G", "20M", "HT", "2T", "03", "30", ++ "ETSI", "2.4G", "20M", "HT", "2T", "03", "30", ++ "MKK", "2.4G", "20M", "HT", "2T", "03", "30", ++ "FCC", "2.4G", "20M", "HT", "2T", "04", "30", ++ "ETSI", "2.4G", "20M", "HT", "2T", "04", "30", ++ "MKK", "2.4G", "20M", "HT", "2T", "04", "30", ++ "FCC", "2.4G", "20M", "HT", "2T", "05", "30", ++ "ETSI", "2.4G", "20M", "HT", "2T", "05", "30", ++ "MKK", "2.4G", "20M", "HT", "2T", "05", "30", ++ "FCC", "2.4G", "20M", "HT", "2T", "06", "30", ++ "ETSI", "2.4G", "20M", "HT", "2T", "06", "30", ++ "MKK", "2.4G", "20M", "HT", "2T", "06", "30", ++ "FCC", "2.4G", "20M", "HT", "2T", "07", "30", ++ "ETSI", "2.4G", "20M", "HT", "2T", "07", "30", ++ "MKK", "2.4G", "20M", "HT", "2T", "07", "30", ++ "FCC", "2.4G", "20M", "HT", "2T", "08", "30", ++ "ETSI", "2.4G", "20M", "HT", "2T", "08", "30", ++ "MKK", "2.4G", "20M", "HT", "2T", "08", "30", ++ "FCC", "2.4G", "20M", "HT", "2T", "09", "28", ++ "ETSI", "2.4G", "20M", "HT", "2T", "09", "30", ++ "MKK", "2.4G", "20M", "HT", "2T", "09", "30", ++ "FCC", "2.4G", "20M", "HT", "2T", "10", "28", ++ "ETSI", "2.4G", "20M", "HT", "2T", "10", "30", ++ "MKK", "2.4G", "20M", "HT", "2T", "10", "30", ++ "FCC", "2.4G", "20M", "HT", "2T", "11", "28", ++ "ETSI", "2.4G", "20M", "HT", "2T", "11", "30", ++ "MKK", "2.4G", "20M", "HT", "2T", "11", "30", ++ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "12", "30", ++ "MKK", "2.4G", "20M", "HT", "2T", "12", "30", ++ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "13", "30", ++ "MKK", "2.4G", "20M", "HT", "2T", "13", "30", ++ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", ++ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "03", "24", ++ "ETSI", "2.4G", "40M", "HT", "1T", "03", "30", ++ "MKK", "2.4G", "40M", "HT", "1T", "03", "30", ++ "FCC", "2.4G", "40M", "HT", "1T", "04", "24", ++ "ETSI", "2.4G", "40M", "HT", "1T", "04", "30", ++ "MKK", "2.4G", "40M", "HT", "1T", "04", "30", ++ "FCC", "2.4G", "40M", "HT", "1T", "05", "24", ++ "ETSI", "2.4G", "40M", "HT", "1T", "05", "30", ++ "MKK", "2.4G", "40M", "HT", "1T", "05", "30", ++ "FCC", "2.4G", "40M", "HT", "1T", "06", "24", ++ "ETSI", "2.4G", "40M", "HT", "1T", "06", "30", ++ "MKK", "2.4G", "40M", "HT", "1T", "06", "30", ++ "FCC", "2.4G", "40M", "HT", "1T", "07", "24", ++ "ETSI", "2.4G", "40M", "HT", "1T", "07", "30", ++ "MKK", "2.4G", "40M", "HT", "1T", "07", "30", ++ "FCC", "2.4G", "40M", "HT", "1T", "08", "24", ++ "ETSI", "2.4G", "40M", "HT", "1T", "08", "30", ++ "MKK", "2.4G", "40M", "HT", "1T", "08", "30", ++ "FCC", "2.4G", "40M", "HT", "1T", "09", "24", ++ "ETSI", "2.4G", "40M", "HT", "1T", "09", "30", ++ "MKK", "2.4G", "40M", "HT", "1T", "09", "30", ++ "FCC", "2.4G", "40M", "HT", "1T", "10", "22", ++ "ETSI", "2.4G", "40M", "HT", "1T", "10", "30", ++ "MKK", "2.4G", "40M", "HT", "1T", "10", "30", ++ "FCC", "2.4G", "40M", "HT", "1T", "11", "20", ++ "ETSI", "2.4G", "40M", "HT", "1T", "11", "30", ++ "MKK", "2.4G", "40M", "HT", "1T", "11", "30", ++ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "12", "30", ++ "MKK", "2.4G", "40M", "HT", "1T", "12", "30", ++ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "13", "30", ++ "MKK", "2.4G", "40M", "HT", "1T", "13", "30", ++ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "03", "26", ++ "ETSI", "2.4G", "40M", "HT", "2T", "03", "26", ++ "MKK", "2.4G", "40M", "HT", "2T", "03", "26", ++ "FCC", "2.4G", "40M", "HT", "2T", "04", "26", ++ "ETSI", "2.4G", "40M", "HT", "2T", "04", "26", ++ "MKK", "2.4G", "40M", "HT", "2T", "04", "26", ++ "FCC", "2.4G", "40M", "HT", "2T", "05", "26", ++ "ETSI", "2.4G", "40M", "HT", "2T", "05", "26", ++ "MKK", "2.4G", "40M", "HT", "2T", "05", "26", ++ "FCC", "2.4G", "40M", "HT", "2T", "06", "26", ++ "ETSI", "2.4G", "40M", "HT", "2T", "06", "26", ++ "MKK", "2.4G", "40M", "HT", "2T", "06", "26", ++ "FCC", "2.4G", "40M", "HT", "2T", "07", "26", ++ "ETSI", "2.4G", "40M", "HT", "2T", "07", "26", ++ "MKK", "2.4G", "40M", "HT", "2T", "07", "26", ++ "FCC", "2.4G", "40M", "HT", "2T", "08", "26", ++ "ETSI", "2.4G", "40M", "HT", "2T", "08", "26", ++ "MKK", "2.4G", "40M", "HT", "2T", "08", "26", ++ "FCC", "2.4G", "40M", "HT", "2T", "09", "26", ++ "ETSI", "2.4G", "40M", "HT", "2T", "09", "26", ++ "MKK", "2.4G", "40M", "HT", "2T", "09", "26", ++ "FCC", "2.4G", "40M", "HT", "2T", "10", "26", ++ "ETSI", "2.4G", "40M", "HT", "2T", "10", "26", ++ "MKK", "2.4G", "40M", "HT", "2T", "10", "26", ++ "FCC", "2.4G", "40M", "HT", "2T", "11", "26", ++ "ETSI", "2.4G", "40M", "HT", "2T", "11", "26", ++ "MKK", "2.4G", "40M", "HT", "2T", "11", "26", ++ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "12", "26", ++ "MKK", "2.4G", "40M", "HT", "2T", "12", "26", ++ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "13", "26", ++ "MKK", "2.4G", "40M", "HT", "2T", "13", "26", ++ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "36", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "36", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "40", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "40", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "44", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "48", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "52", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "56", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "60", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "64", "28", ++ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "100", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "100", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "114", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "114", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "114", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "108", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "108", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "112", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "112", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "116", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "116", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "120", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "120", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "124", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "124", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "128", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "128", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "132", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "132", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "136", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "136", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "140", "28", ++ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "140", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "149", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "153", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "157", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "161", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "165", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", ++ "FCC", "5G", "20M", "HT", "1T", "36", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "36", "32", ++ "MKK", "5G", "20M", "HT", "1T", "36", "32", ++ "FCC", "5G", "20M", "HT", "1T", "40", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "40", "32", ++ "MKK", "5G", "20M", "HT", "1T", "40", "32", ++ "FCC", "5G", "20M", "HT", "1T", "44", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "44", "32", ++ "MKK", "5G", "20M", "HT", "1T", "44", "32", ++ "FCC", "5G", "20M", "HT", "1T", "48", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "48", "32", ++ "MKK", "5G", "20M", "HT", "1T", "48", "32", ++ "FCC", "5G", "20M", "HT", "1T", "52", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "52", "32", ++ "MKK", "5G", "20M", "HT", "1T", "52", "32", ++ "FCC", "5G", "20M", "HT", "1T", "56", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "56", "32", ++ "MKK", "5G", "20M", "HT", "1T", "56", "32", ++ "FCC", "5G", "20M", "HT", "1T", "60", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "60", "32", ++ "MKK", "5G", "20M", "HT", "1T", "60", "32", ++ "FCC", "5G", "20M", "HT", "1T", "64", "28", ++ "ETSI", "5G", "20M", "HT", "1T", "64", "32", ++ "MKK", "5G", "20M", "HT", "1T", "64", "32", ++ "FCC", "5G", "20M", "HT", "1T", "100", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "100", "32", ++ "MKK", "5G", "20M", "HT", "1T", "100", "32", ++ "FCC", "5G", "20M", "HT", "1T", "114", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "114", "32", ++ "MKK", "5G", "20M", "HT", "1T", "114", "32", ++ "FCC", "5G", "20M", "HT", "1T", "108", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "108", "32", ++ "MKK", "5G", "20M", "HT", "1T", "108", "32", ++ "FCC", "5G", "20M", "HT", "1T", "112", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "112", "32", ++ "MKK", "5G", "20M", "HT", "1T", "112", "32", ++ "FCC", "5G", "20M", "HT", "1T", "116", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "116", "32", ++ "MKK", "5G", "20M", "HT", "1T", "116", "32", ++ "FCC", "5G", "20M", "HT", "1T", "120", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "120", "32", ++ "MKK", "5G", "20M", "HT", "1T", "120", "32", ++ "FCC", "5G", "20M", "HT", "1T", "124", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "124", "32", ++ "MKK", "5G", "20M", "HT", "1T", "124", "32", ++ "FCC", "5G", "20M", "HT", "1T", "128", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "128", "32", ++ "MKK", "5G", "20M", "HT", "1T", "128", "32", ++ "FCC", "5G", "20M", "HT", "1T", "132", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "132", "32", ++ "MKK", "5G", "20M", "HT", "1T", "132", "32", ++ "FCC", "5G", "20M", "HT", "1T", "136", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "136", "32", ++ "MKK", "5G", "20M", "HT", "1T", "136", "32", ++ "FCC", "5G", "20M", "HT", "1T", "140", "28", ++ "ETSI", "5G", "20M", "HT", "1T", "140", "32", ++ "MKK", "5G", "20M", "HT", "1T", "140", "32", ++ "FCC", "5G", "20M", "HT", "1T", "149", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "149", "32", ++ "MKK", "5G", "20M", "HT", "1T", "149", "63", ++ "FCC", "5G", "20M", "HT", "1T", "153", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "153", "32", ++ "MKK", "5G", "20M", "HT", "1T", "153", "63", ++ "FCC", "5G", "20M", "HT", "1T", "157", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "157", "32", ++ "MKK", "5G", "20M", "HT", "1T", "157", "63", ++ "FCC", "5G", "20M", "HT", "1T", "161", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "161", "32", ++ "MKK", "5G", "20M", "HT", "1T", "161", "63", ++ "FCC", "5G", "20M", "HT", "1T", "165", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "165", "32", ++ "MKK", "5G", "20M", "HT", "1T", "165", "63", ++ "FCC", "5G", "20M", "HT", "2T", "36", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "36", "30", ++ "MKK", "5G", "20M", "HT", "2T", "36", "30", ++ "FCC", "5G", "20M", "HT", "2T", "40", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "40", "30", ++ "MKK", "5G", "20M", "HT", "2T", "40", "30", ++ "FCC", "5G", "20M", "HT", "2T", "44", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "44", "30", ++ "MKK", "5G", "20M", "HT", "2T", "44", "30", ++ "FCC", "5G", "20M", "HT", "2T", "48", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "48", "30", ++ "MKK", "5G", "20M", "HT", "2T", "48", "30", ++ "FCC", "5G", "20M", "HT", "2T", "52", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "52", "30", ++ "MKK", "5G", "20M", "HT", "2T", "52", "30", ++ "FCC", "5G", "20M", "HT", "2T", "56", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "56", "30", ++ "MKK", "5G", "20M", "HT", "2T", "56", "30", ++ "FCC", "5G", "20M", "HT", "2T", "60", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "60", "30", ++ "MKK", "5G", "20M", "HT", "2T", "60", "30", ++ "FCC", "5G", "20M", "HT", "2T", "64", "26", ++ "ETSI", "5G", "20M", "HT", "2T", "64", "30", ++ "MKK", "5G", "20M", "HT", "2T", "64", "30", ++ "FCC", "5G", "20M", "HT", "2T", "100", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "100", "30", ++ "MKK", "5G", "20M", "HT", "2T", "100", "30", ++ "FCC", "5G", "20M", "HT", "2T", "114", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "114", "30", ++ "MKK", "5G", "20M", "HT", "2T", "114", "30", ++ "FCC", "5G", "20M", "HT", "2T", "108", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "108", "30", ++ "MKK", "5G", "20M", "HT", "2T", "108", "30", ++ "FCC", "5G", "20M", "HT", "2T", "112", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "112", "30", ++ "MKK", "5G", "20M", "HT", "2T", "112", "30", ++ "FCC", "5G", "20M", "HT", "2T", "116", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "116", "30", ++ "MKK", "5G", "20M", "HT", "2T", "116", "30", ++ "FCC", "5G", "20M", "HT", "2T", "120", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "120", "30", ++ "MKK", "5G", "20M", "HT", "2T", "120", "30", ++ "FCC", "5G", "20M", "HT", "2T", "124", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "124", "30", ++ "MKK", "5G", "20M", "HT", "2T", "124", "30", ++ "FCC", "5G", "20M", "HT", "2T", "128", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "128", "30", ++ "MKK", "5G", "20M", "HT", "2T", "128", "30", ++ "FCC", "5G", "20M", "HT", "2T", "132", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "132", "30", ++ "MKK", "5G", "20M", "HT", "2T", "132", "30", ++ "FCC", "5G", "20M", "HT", "2T", "136", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "136", "30", ++ "MKK", "5G", "20M", "HT", "2T", "136", "30", ++ "FCC", "5G", "20M", "HT", "2T", "140", "26", ++ "ETSI", "5G", "20M", "HT", "2T", "140", "30", ++ "MKK", "5G", "20M", "HT", "2T", "140", "30", ++ "FCC", "5G", "20M", "HT", "2T", "149", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "149", "30", ++ "MKK", "5G", "20M", "HT", "2T", "149", "63", ++ "FCC", "5G", "20M", "HT", "2T", "153", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "153", "30", ++ "MKK", "5G", "20M", "HT", "2T", "153", "63", ++ "FCC", "5G", "20M", "HT", "2T", "157", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "157", "30", ++ "MKK", "5G", "20M", "HT", "2T", "157", "63", ++ "FCC", "5G", "20M", "HT", "2T", "161", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "161", "30", ++ "MKK", "5G", "20M", "HT", "2T", "161", "63", ++ "FCC", "5G", "20M", "HT", "2T", "165", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "165", "30", ++ "MKK", "5G", "20M", "HT", "2T", "165", "63", ++ "FCC", "5G", "40M", "HT", "1T", "38", "30", ++ "ETSI", "5G", "40M", "HT", "1T", "38", "32", ++ "MKK", "5G", "40M", "HT", "1T", "38", "32", ++ "FCC", "5G", "40M", "HT", "1T", "46", "30", ++ "ETSI", "5G", "40M", "HT", "1T", "46", "32", ++ "MKK", "5G", "40M", "HT", "1T", "46", "32", ++ "FCC", "5G", "40M", "HT", "1T", "54", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "54", "32", ++ "MKK", "5G", "40M", "HT", "1T", "54", "32", ++ "FCC", "5G", "40M", "HT", "1T", "62", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "62", "32", ++ "MKK", "5G", "40M", "HT", "1T", "62", "32", ++ "FCC", "5G", "40M", "HT", "1T", "102", "28", ++ "ETSI", "5G", "40M", "HT", "1T", "102", "32", ++ "MKK", "5G", "40M", "HT", "1T", "102", "32", ++ "FCC", "5G", "40M", "HT", "1T", "110", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "110", "32", ++ "MKK", "5G", "40M", "HT", "1T", "110", "32", ++ "FCC", "5G", "40M", "HT", "1T", "118", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "118", "32", ++ "MKK", "5G", "40M", "HT", "1T", "118", "32", ++ "FCC", "5G", "40M", "HT", "1T", "126", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "126", "32", ++ "MKK", "5G", "40M", "HT", "1T", "126", "32", ++ "FCC", "5G", "40M", "HT", "1T", "134", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "134", "32", ++ "MKK", "5G", "40M", "HT", "1T", "134", "32", ++ "FCC", "5G", "40M", "HT", "1T", "151", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "151", "32", ++ "MKK", "5G", "40M", "HT", "1T", "151", "63", ++ "FCC", "5G", "40M", "HT", "1T", "159", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "159", "32", ++ "MKK", "5G", "40M", "HT", "1T", "159", "63", ++ "FCC", "5G", "40M", "HT", "2T", "38", "28", ++ "ETSI", "5G", "40M", "HT", "2T", "38", "30", ++ "MKK", "5G", "40M", "HT", "2T", "38", "30", ++ "FCC", "5G", "40M", "HT", "2T", "46", "28", ++ "ETSI", "5G", "40M", "HT", "2T", "46", "30", ++ "MKK", "5G", "40M", "HT", "2T", "46", "30", ++ "FCC", "5G", "40M", "HT", "2T", "54", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "54", "30", ++ "MKK", "5G", "40M", "HT", "2T", "54", "30", ++ "FCC", "5G", "40M", "HT", "2T", "62", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "62", "30", ++ "MKK", "5G", "40M", "HT", "2T", "62", "30", ++ "FCC", "5G", "40M", "HT", "2T", "102", "26", ++ "ETSI", "5G", "40M", "HT", "2T", "102", "30", ++ "MKK", "5G", "40M", "HT", "2T", "102", "30", ++ "FCC", "5G", "40M", "HT", "2T", "110", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "110", "30", ++ "MKK", "5G", "40M", "HT", "2T", "110", "30", ++ "FCC", "5G", "40M", "HT", "2T", "118", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "118", "30", ++ "MKK", "5G", "40M", "HT", "2T", "118", "30", ++ "FCC", "5G", "40M", "HT", "2T", "126", "32", ++ "ETSI", "5G", "40M", "HT", "2T", "126", "30", ++ "MKK", "5G", "40M", "HT", "2T", "126", "30", ++ "FCC", "5G", "40M", "HT", "2T", "134", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "134", "30", ++ "MKK", "5G", "40M", "HT", "2T", "134", "30", ++ "FCC", "5G", "40M", "HT", "2T", "151", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "151", "30", ++ "MKK", "5G", "40M", "HT", "2T", "151", "63", ++ "FCC", "5G", "40M", "HT", "2T", "159", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "159", "30", ++ "MKK", "5G", "40M", "HT", "2T", "159", "63", ++ "FCC", "5G", "80M", "VHT", "1T", "42", "30", ++ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "42", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "58", "28", ++ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "58", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "106", "30", ++ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "106", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "122", "34", ++ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "122", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "155", "34", ++ "ETSI", "5G", "80M", "VHT", "1T", "155", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "155", "63", ++ "FCC", "5G", "80M", "VHT", "2T", "42", "28", ++ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "42", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "58", "26", ++ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "58", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "106", "28", ++ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "106", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "122", "32", ++ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "122", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "155", "34", ++ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "155", "63" ++}; ++ ++void ++ODM_ReadAndConfig_MP_8723D_TXPWR_LMT( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ u4Byte i = 0; ++#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) ++ u4Byte ArrayLen = sizeof(Array_MP_8723D_TXPWR_LMT)/sizeof(u1Byte); ++ pu1Byte Array = (pu1Byte)Array_MP_8723D_TXPWR_LMT; ++#else ++ u4Byte ArrayLen = sizeof(Array_MP_8723D_TXPWR_LMT)/sizeof(pu1Byte); ++ pu1Byte *Array = (pu1Byte *)Array_MP_8723D_TXPWR_LMT; ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ PlatformZeroMemory(pHalData->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); ++ pHalData->nLinesReadPwrLmt = ArrayLen/7; ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_TXPWR_LMT\n")); ++ ++ for (i = 0; i < ArrayLen; i += 7) { ++#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) ++ u1Byte regulation = Array[i]; ++ u1Byte band = Array[i+1]; ++ u1Byte bandwidth = Array[i+2]; ++ u1Byte rate = Array[i+3]; ++ u1Byte rfPath = Array[i+4]; ++ u1Byte chnl = Array[i+5]; ++ u1Byte val = Array[i+6]; ++#else ++ pu1Byte regulation = Array[i]; ++ pu1Byte band = Array[i+1]; ++ pu1Byte bandwidth = Array[i+2]; ++ pu1Byte rate = Array[i+3]; ++ pu1Byte rfPath = Array[i+4]; ++ pu1Byte chnl = Array[i+5]; ++ pu1Byte val = Array[i+6]; ++#endif ++ ++ odm_ConfigBB_TXPWR_LMT_8723D(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ rsprintf((char *)pHalData->BufOfLinesPwrLmt[i/7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", ++ regulation, band, bandwidth, rate, rfPath, chnl, val); ++#endif ++ } ++ ++} ++ ++/****************************************************************************** ++* TxXtalTrack.TXT ++******************************************************************************/ ++ ++s1Byte gDeltaSwingTableXtal_MP_N_TxXtalTrack_8723D[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; ++s1Byte gDeltaSwingTableXtal_MP_P_TxXtalTrack_8723D[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -10, -12, -14, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16}; ++ ++void ++ODM_ReadAndConfig_MP_8723D_TxXtalTrack( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8723D\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableXtal_P, gDeltaSwingTableXtal_MP_P_TxXtalTrack_8723D, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableXtal_N, gDeltaSwingTableXtal_MP_N_TxXtalTrack_8723D, DELTA_SWINGIDX_SIZE); ++} ++ ++#endif /* end of HWIMG_SUPPORT*/ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.h 2018-02-11 21:44:27.161146299 +0200 +@@ -0,0 +1,89 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++/*Image2HeaderVersion: 2.26*/ ++#if (RTL8723D_SUPPORT == 1) ++#ifndef __INC_MP_RF_HW_IMG_8723D_H ++#define __INC_MP_RF_HW_IMG_8723D_H ++ ++ ++/****************************************************************************** ++* RadioA.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8723D_RadioA(/* TC: Test Chip, MP: MP Chip*/ ++ IN PDM_ODM_T pDM_Odm ++); ++u4Byte ODM_GetVersion_MP_8723D_RadioA(void); ++ ++/****************************************************************************** ++* TxPowerTrack_PCIE.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8723D_TxPowerTrack_PCIE(/* TC: Test Chip, MP: MP Chip*/ ++ IN PDM_ODM_T pDM_Odm ++); ++u4Byte ODM_GetVersion_MP_8723D_TxPowerTrack_PCIE(void); ++ ++/****************************************************************************** ++* TxPowerTrack_SDIO.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8723D_TxPowerTrack_SDIO(/* TC: Test Chip, MP: MP Chip*/ ++ IN PDM_ODM_T pDM_Odm ++); ++u4Byte ODM_GetVersion_MP_8723D_TxPowerTrack_SDIO(void); ++ ++/****************************************************************************** ++* TxPowerTrack_USB.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8723D_TxPowerTrack_USB(/* TC: Test Chip, MP: MP Chip*/ ++ IN PDM_ODM_T pDM_Odm ++); ++u4Byte ODM_GetVersion_MP_8723D_TxPowerTrack_USB(void); ++ ++/****************************************************************************** ++* TXPWR_LMT.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8723D_TXPWR_LMT(/* TC: Test Chip, MP: MP Chip*/ ++ IN PDM_ODM_T pDM_Odm ++); ++u4Byte ODM_GetVersion_MP_8723D_TXPWR_LMT(void); ++ ++/****************************************************************************** ++* TxXtalTrack.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8723D_TxXtalTrack(/* TC: Test Chip, MP: MP Chip*/ ++ IN PDM_ODM_T pDM_Odm ++); ++u4Byte ODM_GetVersion_MP_8723D_TxXtalTrack(void); ++ ++#endif ++#endif /* end of HWIMG_SUPPORT*/ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.c 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,4101 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#include "Mp_Precomp.h" ++#include "../phydm_precomp.h" ++ ++ ++#if (RTL8723D_SUPPORT == 1) ++ ++/*---------------------------Define Local Constant---------------------------*/ ++/*IQK*/ ++#define IQK_DELAY_TIME_8723D 10 ++ ++/* 2010/04/25 MH Define the max tx power tracking tx agc power.*/ ++#define ODM_TXPWRTRACK_MAX_IDX_8723D 6 ++ ++#define PATH_S1 0 ++#define IDX_0xC94 0 ++#define IDX_0xC80 1 ++#define IDX_0xC4C 2 ++ ++#define IDX_0xC14 0 ++#define IDX_0xCA0 1 ++ ++ ++#define PATH_S0 1 ++#define IDX_0xCD0 0 ++#define IDX_0xCD4 1 ++ ++#define IDX_0xCD8 0 ++#define IDX_0xCDC 1 ++ ++#define KEY 0 ++#define VAL 1 ++ ++ ++ ++/*---------------------------Define Local Constant---------------------------*/ ++ ++ ++/* Tx Power Tracking*/ ++ ++ ++void setIqkMatrix_8723D( ++ PDM_ODM_T pDM_Odm, ++ u1Byte OFDM_index, ++ u1Byte RFPath, ++ s4Byte IqkResult_X, ++ s4Byte IqkResult_Y ++ ) ++ { ++ s4Byte ele_A = 0, ele_D = 0, ele_C = 0, value32, tmp; ++ s4Byte ele_A_ext = 0, ele_C_ext = 0, ele_D_ext = 0; ++ ++ if (OFDM_index >= OFDM_TABLE_SIZE) ++ OFDM_index = OFDM_TABLE_SIZE-1; ++ else if (OFDM_index < 0) ++ OFDM_index = 0; ++ ++ if ((IqkResult_X != 0) && (*(pDM_Odm->pBandType) == ODM_BAND_2_4G)) { ++ ++ /* new element D */ ++ ele_D = (OFDMSwingTable_New[OFDM_index] & 0xFFC00000)>>22; ++ ele_D_ext = (((IqkResult_X * ele_D)>>7)&0x01); ++ /* new element A */ ++ if ((IqkResult_X & 0x00000200) != 0) /* consider minus */ ++ IqkResult_X = IqkResult_X | 0xFFFFFC00; ++ ele_A = ((IqkResult_X * ele_D)>>8)&0x000003FF; ++ ele_A_ext = ((IqkResult_X * ele_D)>>7) & 0x1; ++ /* new element C */ ++ if ((IqkResult_Y & 0x00000200) != 0) ++ IqkResult_Y = IqkResult_Y | 0xFFFFFC00; ++ ele_C = ((IqkResult_Y * ele_D)>>8)&0x000003FF; ++ ele_C_ext = ((IqkResult_Y * ele_D)>>7) & 0x1; ++ ++ switch (RFPath) { ++ case ODM_RF_PATH_A: ++ /* write new elements A, C, D to regC80, regC94, reg0xc4c, and element B is always 0 */ ++ /* write 0xc80 */ ++ value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord, value32); ++ /* write 0xc94 */ ++ value32 = (ele_C & 0x000003C0) >> 6; ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, bMaskH4Bits, value32); ++ /* write 0xc4c */ ++ value32 = (ele_D_ext << 28) | (ele_A_ext << 31) | (ele_C_ext << 29); ++ value32 = (ODM_GetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskDWord)&(~(BIT31|BIT29|BIT28))) | value32; ++ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskDWord, value32); ++ break; ++ ++ case ODM_RF_PATH_B: ++ /*wirte new elements A, C, D to regCd0 and regCd4, element B is always 0*/ ++ value32 = ele_D; ++ ODM_SetBBReg(pDM_Odm, 0xCd4, 0x007FE000, value32); ++ ++ value32 = ele_C; ++ ODM_SetBBReg(pDM_Odm, 0xCd4, 0x000007FE, value32); ++ ++ value32 = ele_A; ++ ODM_SetBBReg(pDM_Odm, 0xCd0, 0x000007FE, value32); ++ ++ ODM_SetBBReg(pDM_Odm, 0xCd4, BIT12, ele_D_ext); ++ ODM_SetBBReg(pDM_Odm, 0xCd0, BIT0, ele_A_ext); ++ ODM_SetBBReg(pDM_Odm, 0xCd4, BIT0, ele_C_ext); ++ break; ++ default: ++ break; ++ } ++ } else { ++ switch (RFPath) { ++ case ODM_RF_PATH_A: ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord, OFDMSwingTable_New[OFDM_index]); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, bMaskH4Bits, 0x00); ++ value32 = ODM_GetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskDWord)&(~(BIT31|BIT29|BIT28)); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskDWord, value32); ++ break; ++ ++ case ODM_RF_PATH_B: ++ /*image S1:c80 to S0:Cd0 and Cd4*/ ++ ODM_SetBBReg(pDM_Odm, 0xcd0, 0x000007FE, OFDMSwingTable_New[OFDM_index]&0x000003FF); ++ ODM_SetBBReg(pDM_Odm, 0xcd0, 0x0007E000, (OFDMSwingTable_New[OFDM_index]&0x0000FC00)>>10); ++ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x0000007E, (OFDMSwingTable_New[OFDM_index]&0x003F0000)>>16); ++ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x007FE000, (OFDMSwingTable_New[OFDM_index]&0xFFC00000)>>22); ++ ++ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x00000780, 0x00); ++ ++ ODM_SetBBReg(pDM_Odm, 0xcd4, BIT12, 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xcd4, BIT0, 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xcd0, BIT0, 0x0); ++ break; ++ default: ++ break; ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("TxPwrTracking path %c: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x ele_A_ext = 0x%x ele_C_ext = 0x%x ele_D_ext = 0x%x\n", ++ (RFPath == ODM_RF_PATH_A ? 'A' : 'B'), (u4Byte)IqkResult_X, (u4Byte)IqkResult_Y, (u4Byte)ele_A, (u4Byte)ele_C, (u4Byte)ele_D, (u4Byte)ele_A_ext, (u4Byte)ele_C_ext, (u4Byte)ele_D_ext)); ++ } ++ ++VOID ++setCCKFilterCoefficient_8723D( ++ PDM_ODM_T pDM_Odm, ++ u1Byte CCKSwingIndex ++) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ODM_SetBBReg(pDM_Odm, 0xab4, 0x000007FF, CCKSwingTable_Ch1_Ch14_8723D[CCKSwingIndex]); ++} ++ ++void DoIQK_8723D( ++ PVOID pDM_VOID, ++ u1Byte DeltaThermalIndex, ++ u1Byte ThermalValue, ++ u1Byte Threshold ++ ) ++{ ++ u4Byte bIsBtEnable = 0; ++ ++ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ PADAPTER Adapter = pDM_Odm->Adapter; ++#endif ++ ++ ++ if (pDM_Odm->mp_mode == FALSE) ++ bIsBtEnable = ODM_GetMACReg(pDM_Odm, 0xa8, bMaskDWord) & BIT17; ++ ++ if (bIsBtEnable) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Skip IQK because BT is enable\n")); ++ return; ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Do IQK because BT is disable\n")); ++ } ++ ++ ODM_ResetIQKResult(pDM_Odm); ++ ++ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ PHY_IQCalibrate_8723D(pDM_Odm, FALSE); ++#else ++ PHY_IQCalibrate_8723D(Adapter, FALSE); ++#endif ++ ++} ++ ++/*----------------------------------------------------------------------------- ++ * Function: ODM_TxPwrTrackSetPwr_8723D() ++ * ++ * Overview: 8723D change all channel tx power accordign to flag. ++ * OFDM & CCK are all different. ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 04/23/2012 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++VOID ++ODM_TxPwrTrackSetPwr_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PVOID pDM_VOID, ++#else ++ IN PDM_ODM_T pDM_VOID, ++#endif ++ PWRTRACK_METHOD Method, ++ u1Byte RFPath, ++ u1Byte ChannelMappedIndex ++ ) ++{ ++ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ u1Byte PwrTrackingLimit_OFDM = 30; ++ u1Byte PwrTrackingLimit_CCK = 40; ++ u1Byte TxRate = 0xFF; ++ u1Byte Final_OFDM_Swing_Index = 0; ++ u1Byte Final_CCK_Swing_Index = 0; ++ u1Byte i = 0; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++#if (MP_DRIVER == 1) ++ PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); ++ ++ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); ++#else ++ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); ++ if (!pMgntInfo->ForcedDataRate) { ++ if (pDM_Odm->TxRate != 0xFF) ++ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); ++ } else { ++ TxRate = (u1Byte) pMgntInfo->ForcedDataRate; ++ } ++#endif ++#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++ if (pDM_Odm->mp_mode == TRUE) { /*CE MP*/ ++ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); ++ ++ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); ++ } else { /*CE normal*/ ++ u2Byte rate = *(pDM_Odm->pForcedDataRate); ++ ++ if (!rate) { /*auto rate*/ ++ if (pDM_Odm->TxRate != 0xFF) ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) ++ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); ++#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++ if (pDM_Odm->number_linked_client != 0) ++ TxRate = HwRateToMRate(pDM_Odm->TxRate); ++#endif ++ } else { /*force rate*/ ++ TxRate = (u1Byte)rate; ++ } ++ } ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8723DA\n")); ++ ++ if (TxRate != 0xFF) { ++ /*CCK*/ ++ if (((TxRate >= MGN_1M) && (TxRate <= MGN_5_5M)) || TxRate == MGN_11M) ++ PwrTrackingLimit_CCK = 40; ++ /*OFDM*/ ++ else if ((TxRate >= MGN_6M) && (TxRate <= MGN_48M)) ++ PwrTrackingLimit_OFDM = 36; ++ else if (TxRate == MGN_54M) ++ PwrTrackingLimit_OFDM = 34; ++ ++ /* HT*/ ++ else if ((TxRate >= MGN_MCS0) && (TxRate <= MGN_MCS2)) ++ PwrTrackingLimit_OFDM = 38; ++ else if ((TxRate >= MGN_MCS3) && (TxRate <= MGN_MCS4)) ++ PwrTrackingLimit_OFDM = 36; ++ else if ((TxRate >= MGN_MCS5) && (TxRate <= MGN_MCS7)) ++ PwrTrackingLimit_OFDM = 34; ++ ++ else if ((TxRate >= MGN_MCS8) && (TxRate <= MGN_MCS10)) ++ PwrTrackingLimit_OFDM = 38; ++ else if ((TxRate >= MGN_MCS11) && (TxRate <= MGN_MCS12)) ++ PwrTrackingLimit_OFDM = 36; ++ else if ((TxRate >= MGN_MCS13) && (TxRate <= MGN_MCS15)) ++ PwrTrackingLimit_OFDM = 34; ++ ++ else ++ PwrTrackingLimit_OFDM = pRFCalibrateInfo->DefaultOfdmIndex; /*Default OFDM index = 30 */ ++ } ++ ++ if (Method == TXAGC) { ++ u1Byte rf = 0; ++ u4Byte pwr = 0, TxAGC = 0; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("odm_TxPwrTrackSetPwr_8723D CH=%d\n", *(pDM_Odm->pChannel))); ++ ++ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; //Remnant index equal to aboslute compensate value. ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE )) ++ ++#if (MP_DRIVER != 1) ++ /*PHY_SetTxPowerLevelByPath8723D(Adapter, pHalData->CurrentChannel, RFPath); //Using new set power function ++ //PHY_SetTxPowerLevel8723D(pDM_Odm->Adapter, *pDM_Odm->pChannel);*/ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = TRUE; ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK = TRUE; ++ if (RFPath == ODM_RF_PATH_A) { ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK ); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM ); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7 ); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS8_MCS15 ); ++ } else { ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, CCK ); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM ); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7 ); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS8_MCS15 ); ++ } ++#else ++ ++ if (RFPath == ODM_RF_PATH_A) { ++ /*CCK Path S1*/ ++ pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); ++ pwr += pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_A]; ++ PHY_SetBBReg(Adapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, pwr); ++ TxAGC = (pwr<<16)|(pwr<<8)|(pwr); ++ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, 0x00ffffff, TxAGC); ++ RT_DISP(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr_8723D: CCK Tx-rf(A) Power = 0x%x\n", TxAGC)); ++ ++ /*OFDM Path S1*/ ++ pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); ++ pwr += (pRFCalibrateInfo->BbSwingIdxOfdm[ODM_RF_PATH_A] - pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_A]); ++ TxAGC = ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs11_Mcs08, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs15_Mcs12, bMaskDWord, TxAGC); ++ RT_DISP(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr_8723D: OFDM Tx-rf(A) Power = 0x%x\n", TxAGC)); ++ } else if (RFPath == ODM_RF_PATH_B) { ++ ++ pwr = PHY_QueryBBReg(Adapter, rTxAGC_B_Rate18_06, 0xFF); ++ pwr += pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_B]; ++ PHY_SetBBReg(Adapter, rTxAGC_B_CCK1_55_Mcs32, bMaskByte3, pwr); ++ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, 0xff000000, pwr); ++ RT_DISP(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr_8723D: CCK Tx-rf(B) Power = 0x%x\n", pwr)); ++ ++ ++ pwr = PHY_QueryBBReg(Adapter, rTxAGC_B_Rate18_06, 0xFF); ++ pwr += (pRFCalibrateInfo->BbSwingIdxOfdm[ODM_RF_PATH_B] - pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_B]); ++ TxAGC = ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); ++ PHY_SetBBReg(Adapter, rTxAGC_B_Rate18_06, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_B_Rate54_24, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_B_Mcs03_Mcs00, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_B_Mcs07_Mcs04, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_B_Mcs11_Mcs08, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_B_Mcs15_Mcs12, bMaskDWord, TxAGC); ++ RT_DISP(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr_8723D: OFDM Tx-rf(B) Power = 0x%x\n", TxAGC)); ++ } ++#endif ++ ++#endif ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ /*PHY_RF6052SetCCKTxPower(pDM_Odm->priv, *(pDM_Odm->pChannel)); ++ //PHY_RF6052SetOFDMTxPower(pDM_Odm->priv, *(pDM_Odm->pChannel));*/ ++#endif ++ ++ } else if (Method == BBSWING) { ++ Final_OFDM_Swing_Index = pRFCalibrateInfo->DefaultOfdmIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; ++ Final_CCK_Swing_Index = pRFCalibrateInfo->DefaultCckIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ (" pRFCalibrateInfo->DefaultOfdmIndex=%d, pRFCalibrateInfo->DefaultCCKIndex=%d, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]=%d, pRFCalibrateInfo->Remnant_CCKSwingIdx=%d RF_Path = %d\n", ++ pRFCalibrateInfo->DefaultOfdmIndex, pRFCalibrateInfo->DefaultCckIndex, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath], pRFCalibrateInfo->Remnant_CCKSwingIdx, RFPath)); ++ ++ /* Adjust BB swing by OFDM IQ matrix */ ++ if (Final_OFDM_Swing_Index >= PwrTrackingLimit_OFDM) ++ Final_OFDM_Swing_Index = PwrTrackingLimit_OFDM; ++ else if (Final_OFDM_Swing_Index < 0) ++ Final_OFDM_Swing_Index = 0; ++ ++ if (Final_CCK_Swing_Index >= CCK_TABLE_SIZE_8723D) ++ Final_CCK_Swing_Index = CCK_TABLE_SIZE_8723D-1; ++ else if (pRFCalibrateInfo->BbSwingIdxCck < 0) ++ Final_CCK_Swing_Index = 0; ++ ++ setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_A, ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); ++ ++ setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_B, ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); ++ ++ setCCKFilterCoefficient_8723D(pDM_Odm, Final_CCK_Swing_Index); ++ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; ++ ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Final_CCK_Swing_Index=%d\n", Final_CCK_Swing_Index)); ++ ++ } else if (Method == MIX_MODE) { ++ #if (MP_DRIVER == 1) ++ u4Byte TxAGC = 0; /*add by Mingzhi.Guo 2015-04-10*/ ++ s4Byte pwr = 0; ++ #endif ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("pDM_Odm->DefaultOfdmIndex=%d, pDM_Odm->DefaultCCKIndex=%d, pDM_Odm->Absolute_OFDMSwingIdx[RFPath]=%d, RF_Path = %d\n", ++ pRFCalibrateInfo->DefaultOfdmIndex, pRFCalibrateInfo->DefaultCckIndex, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath], RFPath)); ++ ++ Final_OFDM_Swing_Index = pRFCalibrateInfo->DefaultOfdmIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; ++ ++ if (RFPath == ODM_RF_PATH_A) { ++ Final_CCK_Swing_Index = pRFCalibrateInfo->DefaultCckIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; /*CCK Follow Path-A and lower CCK index means higher power.*/ ++ ++ if (Final_OFDM_Swing_Index > PwrTrackingLimit_OFDM) { ++ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit_OFDM; ++ ++ setIqkMatrix_8723D(pDM_Odm, PwrTrackingLimit_OFDM, ODM_RF_PATH_A, ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); ++ setIqkMatrix_8723D(pDM_Odm, PwrTrackingLimit_OFDM, ODM_RF_PATH_B, ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); ++ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; ++ ++ /*Set TxAGC Page C{};*/ ++ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM);*/ ++ /* PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit_OFDM, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); ++ } else if (Final_OFDM_Swing_Index < 0) { ++ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index ; ++ ++ setIqkMatrix_8723D(pDM_Odm, 0, ODM_RF_PATH_A, ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); ++ setIqkMatrix_8723D(pDM_Odm, 0, ODM_RF_PATH_B, ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); ++ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; ++ ++ /*Set TxAGC Page C{};*/ ++ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM);*/ ++ /* PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); ++ } else { ++ setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_A, ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); ++ setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_B, ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); ++ ++ if (pRFCalibrateInfo->Modify_TxAGC_Flag_PathA) { ++ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = 0; ++ ++ /*Set TxAGC Page C{};*/ ++ /* PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM ); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7 ); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS8_MCS15 );*/ ++ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A pDM_Odm->Modify_TxAGC_Flag = FALSE \n")); ++ } ++ } ++#if (MP_DRIVER == 1) ++ if ((pDM_Odm->mp_mode) == 1) { ++ pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); ++ pwr += (pRFCalibrateInfo->Remnant_OFDMSwingIdx[ODM_RF_PATH_A] - pRFCalibrateInfo->Modify_TxAGC_Value_OFDM); ++ ++ if (pwr > 0x3F) ++ pwr = 0x3F; ++ else if (pwr < 0) ++ pwr = 0; ++ ++ TxAGC |= ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ODM_TxPwrTrackSetPwr8188F: OFDM Tx-rf(A) Power = 0x%x\n", TxAGC)); ++ ++ } else ++#endif ++ { ++ ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7); ++ } ++ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM = pRFCalibrateInfo->Remnant_OFDMSwingIdx[ODM_RF_PATH_A] ; ++ ++ if (Final_CCK_Swing_Index > PwrTrackingLimit_CCK) { ++ pRFCalibrateInfo->Remnant_CCKSwingIdx = Final_CCK_Swing_Index - PwrTrackingLimit_CCK; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Over Limit , PwrTrackingLimit_CCK = %d , pDM_Odm->Remnant_CCKSwingIdx = %d \n", PwrTrackingLimit_CCK, pRFCalibrateInfo->Remnant_CCKSwingIdx)); ++ ++ /* Adjust BB swing by CCK filter coefficient*/ ++ ODM_SetBBReg(pDM_Odm, 0xab4, 0x000007FF, CCKSwingTable_Ch1_Ch14_8723D[PwrTrackingLimit_CCK]); ++ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK = TRUE; ++ ++ /*Set TxAGC Page C{};*/ ++ /* PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, CCK);*/ ++ ++ } else if (Final_CCK_Swing_Index < 0) { ++ pRFCalibrateInfo->Remnant_CCKSwingIdx = Final_CCK_Swing_Index; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Under Limit , PwrTrackingLimit_CCK = %d , pDM_Odm->Remnant_CCKSwingIdx = %d \n", 0, pRFCalibrateInfo->Remnant_CCKSwingIdx)); ++ ++ ODM_SetBBReg(pDM_Odm, 0xab4, 0x000007FF, CCKSwingTable_Ch1_Ch14_8723D[0]); ++ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK = TRUE; ++ ++ ++ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, CCK);*/ ++ ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Compensate with BBSwing , Final_CCK_Swing_Index = %d \n", Final_CCK_Swing_Index)); ++ ++ ODM_SetBBReg(pDM_Odm, 0xab4, 0x000007FF, CCKSwingTable_Ch1_Ch14_8723D[Final_CCK_Swing_Index]); ++ ++ /* if (pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK) {*/ ++ pRFCalibrateInfo->Remnant_CCKSwingIdx = 0; ++ ++ ++ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK ); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, CCK );*/ ++ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK = FALSE; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A pDM_Odm->Modify_TxAGC_Flag_CCK = FALSE \n")); ++ } ++#if (MP_DRIVER == 1) ++ if ((pDM_Odm->mp_mode) == 1) { ++ pwr = PHY_QueryBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte1); ++ pwr += pRFCalibrateInfo->Remnant_CCKSwingIdx-pRFCalibrateInfo->Modify_TxAGC_Value_CCK; ++ ++ if (pwr > 0x3F) ++ pwr = 0x3F; ++ else if (pwr < 0) ++ pwr = 0; ++ ++ PHY_SetBBReg(Adapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, pwr); ++ TxAGC = (pwr<<16)|(pwr<<8)|(pwr); ++ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, 0xffffff00, TxAGC); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ODM_TxPwrTrackSetPwr8723D: CCK Tx-rf(A) Power = 0x%x\n", TxAGC)); ++ } else ++#endif ++ ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK); ++ ++ pRFCalibrateInfo->Modify_TxAGC_Value_CCK = pRFCalibrateInfo->Remnant_CCKSwingIdx; ++ } ++#if 0 ++ if (RFPath == ODM_RF_PATH_B) { ++ if (Final_OFDM_Swing_Index > PwrTrackingLimit_OFDM) { ++ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit_OFDM; ++ ++ setIqkMatrix_8723D(pDM_Odm, PwrTrackingLimit_OFDM, ODM_RF_PATH_B, ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); ++ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; ++ ++ ++ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit_OFDM, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); ++ } else if (Final_OFDM_Swing_Index < 0) { ++ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index ; ++ ++ setIqkMatrix_8723D(pDM_Odm, 0, ODM_RF_PATH_B, ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); ++ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; ++ ++ ++ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); ++ } else { ++ setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_B, ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], ++ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); ++ ++ if (pRFCalibrateInfo->Modify_TxAGC_Flag_PathB) { ++ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = 0; ++ ++ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ ++ ++ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B pDM_Odm->Modify_TxAGC_Flag = FALSE \n")); ++ } ++ } ++#if (MP_DRIVER == 1) ++ if ((pDM_Odm->mp_mode) == 1) { ++ pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); ++ pwr += (pRFCalibrateInfo->Remnant_OFDMSwingIdx[ODM_RF_PATH_B] - pRFCalibrateInfo->Modify_TxAGC_Value_OFDM); ++ ++ if (pwr > 0x3F) ++ pwr = 0x3F; ++ else if (pwr < 0) ++ pwr = 0; ++ ++ TxAGC |= ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ODM_TxPwrTrackSetPwr8723D: OFDM Tx-rf(A) Power = 0x%x\n", TxAGC)); ++ ++ } else ++#endif ++ { ++ ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM); ++ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7); ++ } ++ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM = pRFCalibrateInfo->Remnant_OFDMSwingIdx[ODM_RF_PATH_B] ; ++ } ++#endif ++} else { ++ return; ++ } ++} ++ ++VOID ++GetDeltaSwingTable_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PVOID pDM_VOID, ++#else ++ IN PDM_ODM_T pDM_Odm, ++#endif ++ OUT pu1Byte *TemperatureUP_A, ++ OUT pu1Byte *TemperatureDOWN_A, ++ OUT pu1Byte *TemperatureUP_B, ++ OUT pu1Byte *TemperatureDOWN_B ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#endif ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u1Byte TxRate = 0xFF; ++ u1Byte channel = pHalData->CurrentChannel; ++ ++ if (pDM_Odm->mp_mode == TRUE) { ++ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) ++ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ #if (MP_DRIVER == 1) ++ PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); ++ ++ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); ++ #endif ++ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); ++ ++ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); ++ #endif ++ #endif ++ } else { ++ u2Byte rate = *(pDM_Odm->pForcedDataRate); ++ ++ if (!rate) { /*auto rate*/ ++ if (rate != 0xFF) { ++ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) ++ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); ++ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ if (pDM_Odm->number_linked_client != 0) ++ TxRate = HwRateToMRate(pDM_Odm->TxRate); ++ #endif ++ } ++ } else { /*force rate*/ ++ TxRate = (u1Byte)rate; ++ } ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Power Tracking TxRate=0x%X\n", TxRate)); ++ ++ if ( 1 <= channel && channel <= 14) { ++ if (IS_CCK_RATE(TxRate)) { ++ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P; ++ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N; ++ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P; ++ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N; ++ } else { ++ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P; ++ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N; ++ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P; ++ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N; ++ } ++ } else { ++ *TemperatureUP_A = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; ++ *TemperatureDOWN_A = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; ++ *TemperatureUP_B = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; ++ *TemperatureDOWN_B = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; ++ } ++ ++ return; ++} ++ ++VOID ++GetDeltaSwingXtalTable_8723D( ++ PVOID pDM_VOID, ++ ps1Byte *TemperatureUP_Xtal, ++ ps1Byte *TemperatureDOWN_Xtal ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ *TemperatureUP_Xtal = pRFCalibrateInfo->DeltaSwingTableXtal_P; ++ *TemperatureDOWN_Xtal = pRFCalibrateInfo->DeltaSwingTableXtal_N; ++} ++ ++ ++ ++VOID ++ODM_TxXtalTrackSetXtal_8723D( ++ PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ s1Byte CrystalCap; ++ ++ ++ CrystalCap = pHalData->CrystalCap & 0x3F; ++ CrystalCap = CrystalCap + pRFCalibrateInfo->XtalOffset; ++ ++ if (CrystalCap < 0) ++ CrystalCap = 0; ++ else if (CrystalCap > 63) ++ CrystalCap = 63; ++ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("CrystalCap(%d)= pHalData->CrystalCap(%d) + pRFCalibrateInfo->XtalOffset(%d)\n", CrystalCap, pHalData->CrystalCap, pRFCalibrateInfo->XtalOffset)); ++ ++ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCap | (CrystalCap << 6))); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("CrystalCap(0x2c) 0x%X\n", ODM_GetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0xFFF000))); ++ ++} ++ ++void ConfigureTxpowerTrack_8723D( ++ PTXPWRTRACK_CFG pConfig ++ ) ++{ ++ pConfig->SwingTableSize_CCK = CCK_TABLE_SIZE_8723D; ++ pConfig->SwingTableSize_OFDM = OFDM_TABLE_SIZE; ++ pConfig->Threshold_IQK = IQK_THRESHOLD; ++ pConfig->AverageThermalNum = AVG_THERMAL_NUM_8723D; ++ pConfig->RfPathCount = MAX_PATH_NUM_8723D; ++ pConfig->ThermalRegAddr = RF_T_METER_88E; ++ ++ pConfig->ODM_TxPwrTrackSetPwr = ODM_TxPwrTrackSetPwr_8723D; ++ pConfig->DoIQK = DoIQK_8723D; ++ pConfig->PHY_LCCalibrate = PHY_LCCalibrate_8723D; ++ pConfig->GetDeltaSwingTable = GetDeltaSwingTable_8723D; ++ pConfig->GetDeltaSwingXtalTable = GetDeltaSwingXtalTable_8723D; ++ pConfig->ODM_TxXtalTrackSetXtal = ODM_TxXtalTrackSetXtal_8723D; ++} ++ ++ ++#define MAX_TOLERANCE 5 ++#define IQK_DELAY_TIME 1 ++ ++u1Byte ++phy_PathS1_IQK_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN BOOLEAN configPathS0 ++ ) ++{ ++ u4Byte regEAC, regE94, regE9C, tmp, Path_SEL_BB/*, regEA4*/; ++ u1Byte result = 0x00, Ktime; ++ u4Byte originalPath, originalGNT; ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++#endif ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#endif ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Path S1 TXIQK!!\n")); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S1 TXIQK = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); ++ /*save RF path*/ ++ Path_SEL_BB = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); ++ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x1e6@S1 TXIQK = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6)));*/ ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x99000000); ++ ++ /*IQK setting*/ ++ /*leave IQK mode*/ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ /* --- \A7\EF\BCgTXIQK mode table ---//*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, bRFRegOffsetMask, 0x80000); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00004); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005d); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xBFFE0); ++ ++ /*path-A IQK setting*/ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x08008c0c); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x38008c1c); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x8214019f); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28160200); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); ++ ++ /*LO calibration setting*/ ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x00462911); ++ ++ /*PA, PAD setting*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x56, 0x600, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x56, 0x1E0, 0x3); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8d, 0x1F, 0xf); ++ ++ /*LOK setting added for 8723D*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x10, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x54, 0x1, 0x1); ++#if 1 ++ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask, 0xe0d); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask, 0x60d); ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S1 TXIQK = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S1 TXIQK = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); ++ ++ /*enter IQK mode*/ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); ++ ++#if 1 ++ /*backup Path & GNT value */ ++ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); ++ ODM_delay_ms(1); ++ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); ++ ++ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); ++#endif ++ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); ++ ODM_delay_ms(1); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S1 TXIQK = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S1 TXIQK = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); ++ ++ /*One shot, Path S1 LOK & IQK*/ ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xfa000000); ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); ++ ++ /* delay x ms */ ++ /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ ++ ++ Ktime = 0; ++ while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { ++ ODM_delay_ms(1); ++ Ktime++; ++ } ++ ++#if 1 ++ /*Restore GNT_WL/GNT_BT and Path owner*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); ++#endif ++ ++ ++ /*reload RF path*/ ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); ++ ++ /*leave IQK mode*/ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ /*PA/PAD controlled by 0x0*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); ++ ++ /* Check failed*/ ++ regEAC = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); ++ regE94 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); ++ regE9C = ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac = 0x%x\n", regEAC)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94 = 0x%x, 0xe9c = 0x%x\n", regE94, regE9C)); ++ /*monitor image power before & after IQK*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90(before IQK)= 0x%x, 0xe98(afer IQK) = 0x%x\n", ++ ODM_GetBBReg(pDM_Odm, 0xe90, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xe98, bMaskDWord))); ++ ++ if (!(regEAC & BIT28) && ++ (((regE94 & 0x03FF0000)>>16) != 0x142) && ++ (((regE9C & 0x03FF0000)>>16) != 0x42)) ++ ++ result |= 0x01; ++ else ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S1 TXIQK FAIL\n")); ++ ++ ++ return result; ++ ++ } ++ ++u1Byte ++phy_PathS1_RxIQK_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN BOOLEAN configPathS0 ++ ) ++{ ++ u4Byte regEAC, regE94, regE9C, regEA4, u4tmp, tmp, Path_SEL_BB; ++ u1Byte result = 0x00, Ktime; ++ u4Byte originalPath, originalGNT; ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++#endif ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#endif ++#endif ++ ++ Path_SEL_BB = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Path S1 RXIQK Step1!!\n")); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S1 RXIQK1 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x99000000); ++ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S1 RXIQK1 = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6))); */ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ++ /*IQK setting*/ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); ++ ++ /*path-A IQK setting*/ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x18008c1c); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x38008c1c); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); ++ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82160000); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28160000); ++ ++ /*LO calibration setting*/ ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a911); ++ ++ /*modify RXIQK mode table*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, bRFRegOffsetMask, 0x80000); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00006); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xa7ffb); ++ ++ /*---------PA/PAD=0----------*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x56, 0x600, 0x0); ++#if 1 ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask, 0xe0d); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask, 0x60d); ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1@ Path S1 RXIQK1 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2@ Path S1 RXIQK1 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); ++ ++ /*enter IQK mode*/ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); ++ ++#if 1 ++ /*backup Path & GNT value */ ++ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); ++ ODM_delay_ms(1); ++ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); ++ ++ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); ++#endif ++ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); ++ ODM_delay_ms(1); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S1 RXIQK1 = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S1 RXIQK1 = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); ++ ++ /*One shot, Path S1 LOK & IQK*/ ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); ++ ++ /*delay x ms*/ ++ /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ ++ ++ Ktime = 0; ++ while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { ++ ODM_delay_ms(1); ++ Ktime++; ++ } ++ ++ ++ regEAC = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); ++ regE94 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); ++ regE9C = ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac = 0x%x\n", regEAC)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94 = 0x%x, 0xe9c = 0x%x\n", regE94, regE9C)); ++ /*monitor image power before & after IQK*/ ++ ODM_RT_TRACE(pDM_Odm , ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90(before IQK)= 0x%x, 0xe98(afer IQK) = 0x%x\n", ++ ODM_GetBBReg(pDM_Odm, 0xe90, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xe98, bMaskDWord))); ++ ++ ++ tmp = (regE9C & 0x03FF0000)>>16; ++ if ((tmp & 0x200) > 0) ++ tmp = 0x400 - tmp; ++ ++ if (!(regEAC & BIT28) && ++ (((regE94 & 0x03FF0000)>>16) != 0x142) && ++ (((regE9C & 0x03FF0000)>>16) != 0x42)) ++ ++ result |= 0x01; ++ else { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S1 RXIQK STEP1 FAIL\n")); ++#if 1 ++ /*Restore GNT_WL/GNT_BT and Path owner*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); ++#endif ++ /*reload RF path*/ ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); ++ return result; ++ } ++ ++ u4tmp = 0x80007C00 | (regE94&0x3FF0000) | ((regE9C&0x3FF0000) >> 16); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, u4tmp); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe40 = 0x%x u4tmp = 0x%x\n", ODM_GetBBReg(pDM_Odm, rTx_IQK, bMaskDWord), u4tmp)); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Path S1 RXIQK STEP2!!\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S1 RXIQK2 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); ++ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S1 RXIQK2 = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6))); */ ++ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); ++ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x38008c1c); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x18008c1c); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); ++ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82170000); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28171400); ++ ++ /*LO calibration setting*/ ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a8d1); ++ ++ ++ /*modify RXIQK mode table*/ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00007); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xb3fdb); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S1 RXIQK2 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S1 RXIQK2 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); ++ ++ /*enter IQK mode*/ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); ++ ++#if 1 ++ /*backup Path & GNT value */ ++ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); ++ ODM_delay_ms(1); ++ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); ++ ++ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); ++#endif ++ ++ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); ++ ODM_delay_ms(1); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S1 RXIQK2 = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S1 RXIQK2 = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); ++ ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); ++ ++ ++ /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ ++ ++ Ktime = 0; ++ while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { ++ ODM_delay_ms(1); ++ Ktime++; ++ } ++ ++#if 1 ++ /*Restore GNT_WL/GNT_BT and Path owner*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); ++#endif ++ ++ ++ /*reload RF path*/ ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); ++ ++ /*leave IQK mode*/ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ /* PA/PAD controlled by 0x0*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); ++ ++ regEAC = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); ++ regEA4 = ODM_GetBBReg(pDM_Odm, rRx_Power_Before_IQK_A_2, bMaskDWord); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac = 0x%x\n", regEAC)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea4 = 0x%x, 0xeac = 0x%x\n", regEA4, regEAC)); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea0(before IQK)= 0x%x, 0xea8(afer IQK) = 0x%x\n", ++ ODM_GetBBReg(pDM_Odm, 0xea0, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xea8, bMaskDWord))); ++ ++ ++ tmp = (regEAC & 0x03FF0000)>>16; ++ if ((tmp & 0x200) > 0) ++ tmp = 0x400 - tmp; ++ ++ if (!(regEAC & BIT27) && /*if Tx is OK, check whether Rx is OK*/ ++ (((regEA4 & 0x03FF0000)>>16) != 0x132) && ++ (((regEAC & 0x03FF0000)>>16) != 0x36) && ++ (((regEA4 & 0x03FF0000)>>16) < 0x11a) && ++ (((regEA4 & 0x03FF0000)>>16) > 0xe6) && ++ (tmp < 0x1a)) ++ result |= 0x02; ++ else ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S1 RXIQK STEP2 FAIL\n")); ++ ++ ++ return result; ++} ++ ++ ++u1Byte ++phy_PathS0_IQK_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm ++#else ++ IN PADAPTER pAdapter ++#endif ++ ) ++{ ++ u4Byte regEA4, regEAC, regE94, regE9C, regE94_S0, regE9C_S0, regEA4_S0, regEAC_S0, tmp, Path_SEL_BB; ++ u1Byte result = 0x00, Ktime; ++ u4Byte originalPath, originalGNT; ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 TXIQK!\n")); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S0 TXIQK = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); ++ Path_SEL_BB = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); ++ ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x99000280); /*10 od 0x948 0x1 [7] ; WL:S1 to S0;BT:S0 to S1;*/ ++ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S0 TXIQK = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6)));*/ ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ /*modify TXIQK mode table*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xee, bRFRegOffsetMask, 0x80000); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00004); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005d); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xBFFE0); ++ ++ /*path-A IQK setting*/ ++ ODM_SetBBReg(pDM_Odm, 0xe30, bMaskDWord, 0x08008c0c); ++ ODM_SetBBReg(pDM_Odm, 0xe34, bMaskDWord, 0x38008c1c); ++ ODM_SetBBReg(pDM_Odm, 0xe38, bMaskDWord, 0x8214018a); ++ ODM_SetBBReg(pDM_Odm, 0xe3c, bMaskDWord, 0x28160200); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); ++ ++ /*LO calibration setting*/ ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x00462911); ++ ++ /*PA, PAD setting*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x66, 0x600, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x66, 0x1E0, 0x3); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8d, 0x1F, 0xf); ++ ++ /*LOK setting added for 8723D*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xee, 0x10, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x64, 0x1, 0x1); ++ ++#if 1 ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask, 0xe6d); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask, 0x66d); ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S0 TXIQK = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S0 TXIQK = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); ++ ++ ++ /*enter IQK mode*/ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); ++ ++#if 1 ++ /*backup Path & GNT value */ ++ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); ++ ODM_delay_ms(1); ++ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); ++ ++ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); ++#endif ++ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); ++ ODM_delay_ms(1); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S0 TXIQK = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S0 TXIQK = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); ++ ++ /*One shot, Path S1 LOK & IQK*/ ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); ++ ++ /*delay x ms*/ ++ /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ ++ ++ Ktime = 0; ++ while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { ++ ODM_delay_ms(1); ++ Ktime++; ++ } ++ ++#if 1 ++ /*Restore GNT_WL/GNT_BT and Path owner*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); ++#endif ++ ++ ++ /*reload RF path*/ ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); ++ ++ /*leave IQK mode*/ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ /*PA/PAD controlled by 0x0*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); ++ ++ /* Check failed*/ ++ regEAC_S0 = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); ++ regE94_S0 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); ++ regE9C_S0 = ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac_s0 = 0x%x\n", regEAC_S0)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94_s0 = 0x%x, 0xe9c_s0 = 0x%x\n", regE94_S0, regE9C_S0)); ++ /*monitor image power before & after IQK*/ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90_s0(before IQK)= 0x%x, 0xe98_s0(afer IQK) = 0x%x\n", ++ ODM_GetBBReg(pDM_Odm, 0xe90, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xe98, bMaskDWord))); ++ ++ if (!(regEAC_S0 & BIT28) && ++ (((regE94_S0 & 0x03FF0000)>>16) != 0x142) && ++ (((regE9C_S0 & 0x03FF0000)>>16) != 0x42)) ++ ++ result |= 0x01; ++ else ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S0 TXIQK FAIL\n")); ++ ++ return result; ++} ++ ++ ++ ++u1Byte ++phy_PathS0_RxIQK_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN BOOLEAN configPathS0 ++ ) ++{ ++ u4Byte regE94, regE9C, regEA4, regEAC, regE94_S0, regE9C_S0, regEA4_S0, regEAC_S0, tmp, u4tmp, Path_SEL_BB; ++ u1Byte result = 0x00, Ktime; ++ u4Byte originalPath, originalGNT; ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ ++ Path_SEL_BB = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 RxIQK Step1!!\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S0 RXIQK1 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x99000280); ++ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S0 RXIQK1 = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6)));*/ ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); ++ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x18008c1c); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x38008c1c); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); ++ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82160000); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28160000); ++ ++ ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a911); ++ ++ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xee, bRFRegOffsetMask, 0x80000); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00006); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xa7ffb); ++ ++ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x66, 0x600, 0x0); ++ ++#if 1 ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask, 0xe6d); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask, 0x66d); ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S0 RXIQK1 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S0 RXIQK1 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); ++ ++#if 1 ++ /*backup Path & GNT value */ ++ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); ++ ODM_delay_ms(1); ++ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); ++ ++ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); ++#endif ++ ++ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); ++ ODM_delay_ms(1); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S0 RXIQK1 = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S0 RXIQK1 = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); ++ ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); ++ ++ ++ /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ ++ ++ Ktime = 0; ++ while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { ++ ODM_delay_ms(1); ++ Ktime++; ++ } ++ ++ regEAC_S0 = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); ++ regE94_S0 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); ++ regE9C_S0 = ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac_s0 = 0x%x\n", regEAC_S0)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94_s0 = 0x%x, 0xe9c_s0 = 0x%x\n", regE94_S0, regE9C_S0)); ++ /*monitor image power before & after IQK*/ ++ ODM_RT_TRACE(pDM_Odm , ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90_s0(before IQK)= 0x%x, 0xe98_s0(afer IQK) = 0x%x\n", ++ ODM_GetBBReg(pDM_Odm, 0xe90, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xe98, bMaskDWord))); ++ ++ ++ tmp = (regE9C_S0 & 0x03FF0000)>>16; ++ if ((tmp & 0x200) > 0) ++ tmp = 0x400 - tmp; ++ ++ if (!(regEAC_S0 & BIT28) && ++ (((regE94_S0 & 0x03FF0000)>>16) != 0x142) && ++ (((regE9C_S0 & 0x03FF0000)>>16) != 0x42)) ++ ++ result |= 0x01; ++ else { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S0 RXIQK STEP1 FAIL\n")); ++#if 1 ++ /*Restore GNT_WL/GNT_BT and Path owner*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); ++#endif ++ ++ /*reload RF path*/ ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); ++ return result; ++ } ++ ++ u4tmp = 0x80007C00 | (regE94_S0&0x3FF0000) | ((regE9C_S0&0x3FF0000) >> 16); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, u4tmp); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe40_s0 = 0x%x u4tmp = 0x%x\n", ODM_GetBBReg(pDM_Odm, rTx_IQK, bMaskDWord), u4tmp)); ++ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Path S0 RXIQK STEP2!!\n\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S0 RXIQK2 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); ++ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S0 RXIQK2 = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6)));*/ ++ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); ++ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x38008c1c); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x18008c1c); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); ++ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82170000); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28171400); ++ ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a8d1); ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xee, 0x80000, 0x1); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00007); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xb3fdb); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S0 RXIQK2 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S0 RXIQK2 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); ++ /*enter IQK mode*/ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); ++ ++#if 1 ++ /*backup Path & GNT value */ ++ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); ++ ODM_delay_ms(1); ++ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); ++ ++ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); ++#endif ++ ++ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); ++ ODM_delay_ms(1); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S0 RXIQK2 = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S0 RXIQK2 = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); ++ ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); ++ ++ ++ /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ ++ Ktime = 0; ++ while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { ++ ODM_delay_ms(1); ++ Ktime++; ++ } ++ ++#if 1 ++ /*Restore GNT_WL/GNT_BT and Path owner*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); ++#endif ++ ++ /*reload RF path*/ ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); ++ ++ /*leave IQK mode*/ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); ++ ++ regEAC_S0 = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); ++ regEA4_S0 = ODM_GetBBReg(pDM_Odm, rRx_Power_Before_IQK_A_2, bMaskDWord); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac_s0 = 0x%x\n", regEAC_S0)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea4_s0 = 0x%x, 0xeac_s0 = 0x%x\n", regEA4_S0, regEAC_S0)); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea0_s0(before IQK)= 0x%x, 0xea8_s0(afer IQK) = 0x%x\n", ++ ODM_GetBBReg(pDM_Odm, 0xea0, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xea8, bMaskDWord))); ++ ++ ++ tmp = (regEAC_S0 & 0x03FF0000)>>16; ++ if ((tmp & 0x200) > 0) ++ tmp = 0x400 - tmp; ++ ++ if (!(regEAC_S0 & BIT27) && /*if Tx is OK, check whether Rx is OK*/ ++ (((regEA4_S0 & 0x03FF0000)>>16) != 0x132) && ++ (((regEAC_S0 & 0x03FF0000)>>16) != 0x36) && ++ (((regEA4_S0 & 0x03FF0000)>>16) < 0x11a) && ++ (((regEA4_S0 & 0x03FF0000)>>16) > 0xe6) && ++ (tmp < 0x1a)) ++ result |= 0x02; ++ else ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S0 RXIQK STEP2 FAIL\n")); ++ ++ ++ return result; ++} ++ ++ ++VOID ++_PHY_PathS1FillIQKMatrix_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN BOOLEAN bIQKOK, ++ IN s4Byte result[][8], ++ IN u1Byte final_candidate, ++ IN BOOLEAN bTxOnly ++ ) ++ { ++ u4Byte Oldval_1, X, TX1_A, reg; ++ s4Byte Y, TX1_C; ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++#endif ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#endif ++#endif ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 IQ Calibration %s !\n", (bIQKOK) ? "Success" : "Failed")); ++ ++ if (final_candidate == 0xFF) ++ return; ++ ++ else if (bIQKOK) { ++ Oldval_1 = (ODM_GetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord) >> 22) & 0x3FF; ++ ++ X = result[final_candidate][0]; ++ ++ if ((X & 0x00000200) != 0) ++ X = X | 0xFFFFFC00; ++ TX1_A = (X * Oldval_1) >> 8; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX1_A = 0x%x, Oldval_1 0x%x\n", X, TX1_A, Oldval_1)); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, 0x3FF, TX1_A); ++ ++ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT(31), ((X * Oldval_1 >> 7) & 0x1)); ++ ++ Y = result[final_candidate][1]; ++ if ((Y & 0x00000200) != 0) ++ Y = Y | 0xFFFFFC00; ++ ++ TX1_C = (Y * Oldval_1) >> 8; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C)); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, 0xF0000000, ((TX1_C & 0x3C0) >> 6)); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, 0x003F0000, (TX1_C & 0x3F)); ++ ++ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT(29), ((Y * Oldval_1 >> 7) & 0x1)); ++ ++ if (bTxOnly) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_PHY_PathS1FillIQKMatrix_8723D only Tx OK\n")); ++ return; ++ } ++ reg = result[final_candidate][2]; ++#if (DM_ODM_SUPPORT_TYPE == ODM_AP) ++ if (RTL_ABS(reg , 0x100) >= 16) ++ reg = 0x100; ++#endif ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XARxIQImbalance, 0x3FF, reg); ++ ++ reg = result[final_candidate][3] & 0x3F; ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XARxIQImbalance, 0xFC00, reg); ++ ++ reg = (result[final_candidate][3] >> 6) & 0xF; ++ ODM_SetBBReg(pDM_Odm, rOFDM0_RxIQExtAnta, 0xF0000000, reg); ++/* ++10 os 7201 10 ++10 id ea4 [25:16] p ++10 os 7202 10 ++10 od c14 VarFromTmp [9:0] p ++ ++10 os 7201 11 ++10 id eac [25:22] p ++10 os 7202 11 ++10 od ca0 VarFromTmp [31:28] p ++ ++10 os 7201 12 ++10 id eac [21:16] p ++10 os 7202 12 ++10 od c14 VarFromTmp [15:10] p ++*/ ++ } ++ } ++ ++VOID ++_PHY_PathS0FillIQKMatrix_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN BOOLEAN bIQKOK, ++ IN s4Byte result[][8], ++ IN u1Byte final_candidate, ++ IN BOOLEAN bTxOnly ++ ) ++{ ++ u4Byte Oldval_0, X, TX0_A, reg; ++ s4Byte Y, TX0_C; ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 IQ Calibration %s !\n", (bIQKOK)?"Success":"Failed")); ++ ++ if (final_candidate == 0xFF) ++ return; ++ ++ else if (bIQKOK) { ++ Oldval_0 = (ODM_GetBBReg(pDM_Odm, 0xcd4, bMaskDWord) >> 13) & 0x3FF; ++ ++ X = result[final_candidate][4]; ++ if ((X & 0x00000200) != 0) ++ X = X | 0xFFFFFC00; ++ TX0_A = (X * Oldval_0) >> 8; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX0_A = 0x%x, Oldval_0 0x%x\n", X, TX0_A, Oldval_0)); ++ ODM_SetBBReg(pDM_Odm, 0xcd0, 0x7FE, TX0_A); ++ ++ ODM_SetBBReg(pDM_Odm, 0xcd0, BIT(0), ((X * Oldval_0>>7) & 0x1)); ++ ++ Y = result[final_candidate][5]; ++ if ((Y & 0x00000200) != 0) ++ Y = Y | 0xFFFFFC00; ++ ++ TX0_C = (Y * Oldval_0) >> 8; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX0_C = 0x%x\n", Y, TX0_C)); ++ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x7FE, (TX0_C & 0x3FF)); ++ ++ ODM_SetBBReg(pDM_Odm, 0xcd4, BIT(0), ((Y * Oldval_0>>7) & 0x1)); ++ ++ if (bTxOnly) ++ return; ++ ++ reg = result[final_candidate][6]; ++ ODM_SetBBReg(pDM_Odm, 0xcd8, 0x3FF, reg); ++ ++ reg = result[final_candidate][7]; ++ ODM_SetBBReg(pDM_Odm, 0xcd8, 0x003FF000, reg); ++/* ++10 os 7201 10 ++10 id ea4 [25:16] p ++10 os 7202 10 ++10 od cd8 VarFromTmp [9:0] p ++ ++10 os 7201 11 ++10 id eac [25:16] p ++10 os 7202 11 ++10 od cd8 VarFromTmp [21:12] p ++ RegE94_S1 = result[i][0]; ++ RegE9C_S1 = result[i][1]; ++ RegEA4_S1 = result[i][2]; ++ RegEAC_S1 = result[i][3]; ++ RegE94_S0 = result[i][4]; ++ RegE9C_S0 = result[i][5]; ++ RegEA4_S0 = result[i][6]; ++ RegEAC_S0 = result[i][7]; ++*/ ++ } ++} ++// 2011/07/26 MH Add an API for testing IQK fail case. ++// ++// MP Already declare in odm.c ++#if !(DM_ODM_SUPPORT_TYPE & ODM_WIN) ++BOOLEAN ++ODM_CheckPowerStatus( ++ IN PADAPTER Adapter) ++{ ++/* ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ RT_RF_POWER_STATE rtState; ++ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); ++ ++ // 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. ++ if (pMgntInfo->init_adpt_in_progress == TRUE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return TRUE, due to initadapter")); ++ return TRUE; ++ } ++ ++ // ++ // 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. ++ // ++ Adapter->HalFunc.GetHwRegHandler(Adapter, HW_VAR_RF_STATE, (pu1Byte)(&rtState)); ++ if(Adapter->bDriverStopped || Adapter->bDriverIsGoingToPnpSetPowerSleep || rtState == eRfOff) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return FALSE, due to %d/%d/%d\n", ++ Adapter->bDriverStopped, Adapter->bDriverIsGoingToPnpSetPowerSleep, rtState)); ++ return FALSE; ++ } ++*/ ++ return TRUE; ++} ++#endif ++ ++VOID ++_PHY_SaveADDARegisters_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN pu4Byte ADDAReg, ++ IN pu4Byte ADDABackup, ++ IN u4Byte RegisterNum ++ ) ++{ ++ u4Byte i; ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++ ++ if (ODM_CheckPowerStatus(pAdapter) == FALSE) ++ return; ++#endif ++ ++ ++ for (i = 0 ; i < RegisterNum ; i++) { ++ ADDABackup[i] = ODM_GetBBReg(pDM_Odm, ADDAReg[i], bMaskDWord); ++ } ++} ++ ++ ++VOID ++_PHY_SaveMACRegisters_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN pu4Byte MACReg, ++ IN pu4Byte MACBackup ++ ) ++{ ++ u4Byte i; ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ ++ for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) { ++ MACBackup[i] = ODM_Read1Byte(pDM_Odm, MACReg[i]); ++ } ++ MACBackup[i] = ODM_Read4Byte(pDM_Odm, MACReg[i]); ++ ++} ++ ++ ++VOID ++_PHY_ReloadADDARegisters_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN pu4Byte ADDAReg, ++ IN pu4Byte ADDABackup, ++ IN u4Byte RegiesterNum ++ ) ++{ ++ u4Byte i; ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Reload ADDA power saving parameters !\n")); ++ for (i = 0 ; i < RegiesterNum; i++) { ++ ODM_SetBBReg(pDM_Odm, ADDAReg[i], bMaskDWord, ADDABackup[i]); ++ } ++} ++ ++VOID ++_PHY_ReloadMACRegisters_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN pu4Byte MACReg, ++ IN pu4Byte MACBackup ++ ) ++{ ++ u4Byte i; ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Reload MAC parameters !\n")); ++ for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) { ++ ODM_Write1Byte(pDM_Odm, MACReg[i], (u1Byte)MACBackup[i]); ++ } ++ ODM_Write4Byte(pDM_Odm, MACReg[i], MACBackup[i]); ++} ++ ++ ++VOID ++_PHY_PathADDAOn_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN pu4Byte ADDAReg, ++ IN BOOLEAN isPathAOn, ++ IN BOOLEAN is2T ++ ) ++{ ++ u4Byte pathOn; ++ u4Byte i; ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ ++ ++ pathOn = isPathAOn ? 0x03c00016 : 0x03c00016; ++ ++ if (FALSE == is2T) { ++ pathOn = 0x03c00016; ++ ODM_SetBBReg(pDM_Odm, ADDAReg[0], bMaskDWord, 0x03c00016); ++ } else { ++ ODM_SetBBReg(pDM_Odm, ADDAReg[0], bMaskDWord, pathOn); ++ } ++ ++ for (i = 1 ; i < IQK_ADDA_REG_NUM ; i++) { ++ ODM_SetBBReg(pDM_Odm,ADDAReg[i], bMaskDWord, pathOn); ++ } ++ ++} ++ ++VOID ++_PHY_MACSettingCalibration_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN pu4Byte MACReg, ++ IN pu4Byte MACBackup ++ ) ++{ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ ++/* ++ ODM_Write1Byte(pDM_Odm, MACReg[i], 0x3F); ++ ++ for(i = 1 ; i < (IQK_MAC_REG_NUM - 1); i++){ ++ ODM_Write1Byte(pDM_Odm, MACReg[i], (u1Byte)(MACBackup[i]&(~BIT3))); ++ } ++ ODM_Write1Byte(pDM_Odm, MACReg[i], (u1Byte)(MACBackup[i]&(~BIT5))); ++*/ ++ ++ /*ODM_SetBBReg(pDM_Odm, 0x522, bMaskByte0, 0x7f);*/ ++ /*ODM_SetBBReg(pDM_Odm, 0x550, bMaskByte0, 0x15);*/ ++ /*ODM_SetBBReg(pDM_Odm, 0x551, bMaskByte0, 0x00);*/ ++ ++ ODM_SetBBReg(pDM_Odm, 0x520, 0x00ff0000, 0xff); ++ ++ ++ ++} ++ ++VOID ++_PHY_PathAStandBy_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm ++#else ++ IN PADAPTER pAdapter ++#endif ++ ) ++{ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-S1 standby mode!\n")); ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++/* ODM_SetBBReg(pDM_Odm, 0x840, bMaskDWord, 0x00010000);*/ ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)0x0, 0x0, bRFRegOffsetMask, 0x10000); ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); ++} ++ ++VOID ++_PHY_PathBStandBy_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm ++#else ++ IN PADAPTER pAdapter ++#endif ++ ) ++{ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-S0 standby mode!\n")); ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)0x1, 0x0, bRFRegOffsetMask, 0x10000); ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); ++} ++ ++ ++VOID ++_PHY_PIModeSwitch_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN BOOLEAN PIMode ++ ) ++{ ++ u4Byte mode; ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ ++ ++ mode = PIMode ? 0x01000100 : 0x01000000; ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_HSSIParameter1, bMaskDWord, mode); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_HSSIParameter1, bMaskDWord, mode); ++} ++ ++BOOLEAN ++phy_SimularityCompare_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN s4Byte result[][8], ++ IN u1Byte c1, ++ IN u1Byte c2 ++ ) ++{ ++ u4Byte i, j, diff, SimularityBitMap, bound = 0; ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ u1Byte final_candidate[2] = {0xFF, 0xFF}; ++ BOOLEAN bResult = TRUE; ++/*#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++// BOOLEAN is2T = IS_92C_SERIAL( pHalData->VersionID); ++//#else*/ ++ BOOLEAN is2T = TRUE; ++/*#endif*/ ++ ++ s4Byte tmp1 = 0,tmp2 = 0; ++ ++ if (is2T) ++ bound = 8; ++ else ++ bound = 4; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> IQK:phy_SimularityCompare_8723D c1 %d c2 %d!!!\n", c1, c2)); ++ ++ ++ SimularityBitMap = 0; ++ ++ for (i = 0; i < bound; i++) { ++ ++ if ((i == 1) || (i == 3) || (i == 5) || (i == 7)) { ++ if ((result[c1][i] & 0x00000200) != 0) ++ tmp1 = result[c1][i] | 0xFFFFFC00; ++ else ++ tmp1 = result[c1][i]; ++ ++ if ((result[c2][i] & 0x00000200) != 0) ++ tmp2 = result[c2][i] | 0xFFFFFC00; ++ else ++ tmp2 = result[c2][i]; ++ } else { ++ tmp1 = result[c1][i]; ++ tmp2 = result[c2][i]; ++ } ++ ++ diff = (tmp1 > tmp2) ? (tmp1 - tmp2) : (tmp2 - tmp1); ++ ++ if (diff > MAX_TOLERANCE) { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:differnece overflow %d index %d compare1 0x%x compare2 0x%x!!!\n", diff, i, result[c1][i], result[c2][i])); ++ ++ if ((i == 2 || i == 6) && !SimularityBitMap) { ++ if (result[c1][i]+result[c1][i+1] == 0) ++ final_candidate[(i/4)] = c2; ++ else if (result[c2][i]+result[c2][i+1] == 0) ++ final_candidate[(i/4)] = c1; ++ else ++ SimularityBitMap = SimularityBitMap|(1<odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ u4Byte i; ++ u1Byte PathS1_OK, PathS0_OK; ++ u1Byte tmp0xc50 = (u1Byte)ODM_GetBBReg(pDM_Odm, 0xC50, bMaskByte0); ++ u1Byte tmp0xc58 = (u1Byte)ODM_GetBBReg(pDM_Odm, 0xC58, bMaskByte0); ++ u4Byte ADDA_REG[IQK_ADDA_REG_NUM] = { ++ rFPGA0_XCD_SwitchControl, rBlue_Tooth, ++ rRx_Wait_CCA, rTx_CCK_RFON, ++ rTx_CCK_BBON, rTx_OFDM_RFON, ++ rTx_OFDM_BBON, rTx_To_Rx, ++ rTx_To_Tx, rRx_CCK, ++ rRx_OFDM, rRx_Wait_RIFS, ++ rRx_TO_Rx, rStandby, ++ rSleep, rPMPD_ANAEN }; ++ u4Byte IQK_MAC_REG[IQK_MAC_REG_NUM] = { ++ REG_TXPAUSE, REG_BCN_CTRL, ++ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; ++ ++ ++ u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { ++ rOFDM0_TRxPathEnable, rOFDM0_TRMuxPar, ++ rFPGA0_XCD_RFInterfaceSW, rConfig_AntA, rConfig_AntB, ++ rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, ++ rFPGA0_XB_RFInterfaceOE, rCCK0_AFESetting ++ }; ++ u4Byte cnt_IQKFail = 0; ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) ++ u4Byte retryCount = 2; ++#else ++#if MP_DRIVER ++ const u4Byte retryCount = 9; ++#else ++ const u4Byte retryCount = 2; ++#endif ++#endif ++ ++ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) ++#ifdef MP_TEST ++ if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) ++ retryCount = 9; ++#endif ++#endif ++ ++ ++ if (t == 0) { ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_SaveADDARegisters_8723D(pAdapter, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); ++ _PHY_SaveMACRegisters_8723D(pAdapter, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); ++ _PHY_SaveADDARegisters_8723D(pAdapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); ++#else ++ _PHY_SaveADDARegisters_8723D(pDM_Odm, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); ++ _PHY_SaveMACRegisters_8723D(pDM_Odm, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); ++ _PHY_SaveADDARegisters_8723D(pDM_Odm, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); ++#endif ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQ Calibration for 1T1R_S0/S1 for %d times\n", t)); ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ ++ _PHY_PathADDAOn_8723D(pAdapter, ADDA_REG, TRUE, is2T); ++#else ++ _PHY_PathADDAOn_8723D(pDM_Odm, ADDA_REG, TRUE, is2T); ++#endif ++ ++ ++/* ++ if(t==0) ++ { ++ pDM_Odm->RFCalibrateInfo.bRfPiEnable = (u1Byte)ODM_GetBBReg(pDM_Odm, rFPGA0_XA_HSSIParameter1, BIT(8)); ++ } ++ ++ if(!pDM_Odm->RFCalibrateInfo.bRfPiEnable){ ++ // Switch BB to PI mode to do IQ Calibration. ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_PIModeSwitch_8723D(pAdapter, TRUE); ++#else ++ _PHY_PIModeSwitch_8723D(pDM_Odm, TRUE); ++#endif ++ } ++*/ ++ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_MACSettingCalibration_8723D(pAdapter, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); ++#else ++ _PHY_MACSettingCalibration_8723D(pDM_Odm, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); ++#endif ++ ++ /*BB setting*/ ++ /*ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 0x00);*/ ++ ODM_SetBBReg(pDM_Odm, rCCK0_AFESetting, 0x0f000000, 0xf); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_TRxPathEnable, bMaskDWord, 0x03a05611); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, 0x000800e4); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x25204200); ++ ++ /*IQ calibration setting*/ ++ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK setting!\n")); */ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); ++ ++if (is2T) { ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_PathBStandBy_8723D(pAdapter); ++ ++ ++ _PHY_PathADDAOn_8723D(pAdapter, ADDA_REG, FALSE, is2T); ++#else ++ _PHY_PathBStandBy_8723D(pDM_Odm); ++ ++ ++ _PHY_PathADDAOn_8723D(pDM_Odm, ADDA_REG, FALSE, is2T); ++#endif ++ } ++ ++ ++#if 1 ++ for (i = 0 ; i < retryCount ; i++) { ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ PathS1_OK = phy_PathS1_IQK_8723D(pAdapter, is2T); ++#else ++ PathS1_OK = phy_PathS1_IQK_8723D(pDM_Odm, is2T); ++#endif ++ ++ if (PathS1_OK == 0x01) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 Tx IQK Success!!\n")); ++ result[t][0] = (ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; ++ result[t][1] = (ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; ++ break; ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 Tx IQK Fail!!\n")); ++ result[t][0] = 0x100; ++ result[t][1] = 0x0; ++ cnt_IQKFail++; ++ } ++#if 0 ++ else if (i == (retryCount-1) && PathS1_OK == 0x01) ++ { ++ RT_DISP(FINIT, INIT_IQK, ("Path S1 IQK Only Tx Success!!\n")); ++ ++ result[t][0] = (ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; ++ result[t][1] = (ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; ++ } ++#endif ++ } ++#endif ++ ++ ++#if 1 ++ for (i = 0 ; i < retryCount ; i++) { ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ PathS1_OK = phy_PathS1_RxIQK_8723D(pAdapter, is2T); ++#else ++ PathS1_OK = phy_PathS1_RxIQK_8723D(pDM_Odm, is2T); ++#endif ++ if (PathS1_OK == 0x03) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 Rx IQK Success!!\n")); ++ result[t][2] = (ODM_GetBBReg(pDM_Odm, rRx_Power_Before_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; ++ result[t][3] = (ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; ++ break; ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 Rx IQK Fail!!\n")); ++ result[t][2] = 0x100; ++ result[t][3] = 0x0; ++ cnt_IQKFail++; ++ } ++ } ++ ++ if (0x00 == PathS1_OK) { ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 IQK failed!!\n")); ++ } ++ ++#endif ++ ++ if (is2T) { ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_PathAStandBy_8723D(pAdapter); ++ ++ ++ _PHY_PathADDAOn_8723D(pAdapter, ADDA_REG, FALSE, is2T); ++#else ++ _PHY_PathAStandBy_8723D(pDM_Odm); ++ ++ ++ _PHY_PathADDAOn_8723D(pDM_Odm, ADDA_REG, FALSE, is2T); ++#endif ++ ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); ++ ++ ++#if 1 ++ for (i = 0 ; i < retryCount ; i++) { ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ PathS0_OK = phy_PathS0_IQK_8723D(pAdapter); ++#else ++ PathS0_OK = phy_PathS0_IQK_8723D(pDM_Odm); ++#endif ++ ++ if (PathS0_OK == 0x01) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 Tx IQK Success!!\n")); ++ result[t][4] = (ODM_GetBBReg(pDM_Odm, 0xe94, bMaskDWord)&0x3FF0000)>>16; ++ result[t][5] = (ODM_GetBBReg(pDM_Odm, 0xe9c, bMaskDWord)&0x3FF0000)>>16; ++ break; ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 Tx IQK Fail!!\n")); ++ result[t][4] = 0x100; ++ result[t][5] = 0x0; ++ cnt_IQKFail++; ++ } ++#if 0 ++ else if (i == (retryCount-1) && PathS1_OK == 0x01) ++ { ++ RT_DISP(FINIT, INIT_IQK, ("Path S0 IQK Only Tx Success!!\n")); ++ ++ result[t][0] = (ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_B, bMaskDWord)&0x3FF0000)>>16; ++ result[t][1] = (ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_B, bMaskDWord)&0x3FF0000)>>16; ++ } ++#endif ++ } ++#endif ++ ++ ++#if 1 ++ ++for (i = 0 ; i < retryCount ; i++) { ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ PathS0_OK = phy_PathS0_RxIQK_8723D(pAdapter, is2T); ++#else ++ PathS0_OK = phy_PathS0_RxIQK_8723D(pDM_Odm, is2T); ++#endif ++ if (PathS0_OK == 0x03) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 Rx IQK Success!!\n")); ++/* result[t][0] = (ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16;*/ ++/* result[t][1] = (ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16;*/ ++ result[t][6] = (ODM_GetBBReg(pDM_Odm, 0xea4, bMaskDWord)&0x3FF0000)>>16; ++ result[t][7] = (ODM_GetBBReg(pDM_Odm, 0xeac, bMaskDWord)&0x3FF0000)>>16; ++ break; ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 Rx IQK Fail!!\n")); ++ result[t][6] = 0x100; ++ result[t][7] = 0x0; ++ cnt_IQKFail++; ++ } ++ } ++ ++ ++ ++ if (0x00 == PathS0_OK) ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 IQK failed!!\n")); ++ ++#endif ++ } ++ ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Back to BB mode, load original value!\n")); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ++ if (t != 0) { ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ ++ ++ _PHY_ReloadADDARegisters_8723D(pAdapter, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); ++ ++ /* Reload MAC parameters*/ ++ _PHY_ReloadMACRegisters_8723D(pAdapter, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); ++ ++ _PHY_ReloadADDARegisters_8723D(pAdapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); ++#else ++ ++ _PHY_ReloadADDARegisters_8723D(pDM_Odm, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); ++ ++ /* Reload MAC parameters*/ ++ _PHY_ReloadMACRegisters_8723D(pDM_Odm, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); ++ ++ _PHY_ReloadADDARegisters_8723D(pDM_Odm, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); ++#endif ++ ++ ++ ODM_SetBBReg(pDM_Odm, 0xc50, bMaskByte0, 0x50); ++ ODM_SetBBReg(pDM_Odm, 0xc50, bMaskByte0, tmp0xc50); ++ if (is2T) { ++ ODM_SetBBReg(pDM_Odm, 0xc58, bMaskByte0, 0x50); ++ ODM_SetBBReg(pDM_Odm, 0xc58, bMaskByte0, tmp0xc58); ++ } ++ ++ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); ++ ++ ++ } ++ ++ pDM_Odm->nIQK_Cnt++; ++ ++ if (cnt_IQKFail == 0) ++ pDM_Odm->nIQK_OK_Cnt++; ++ else ++ pDM_Odm->nIQK_Fail_Cnt = pDM_Odm->nIQK_Fail_Cnt + cnt_IQKFail; ++ ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_IQCalibrate_8723D() <==\n")); ++ ++} ++ ++ ++VOID ++phy_LCCalibrate_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PVOID pDM_VOID, ++#else ++ IN PDM_ODM_T pDM_Odm, ++#endif ++ IN BOOLEAN is2T ++ ) ++{ ++ u1Byte tmpReg; ++ u4Byte RF_Amode=0, RF_Bmode=0, LC_Cal, cnt; ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#endif ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++#endif ++ ++ ++ tmpReg = ODM_Read1Byte(pDM_Odm, 0xd03); ++ ++ if ((tmpReg & 0x70) != 0) ++ ODM_Write1Byte(pDM_Odm, 0xd03, tmpReg & 0x8F); ++ else ++ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0xFF); ++ ++ /*backup RF0x18*/ ++ ++ LC_Cal = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); ++ ++ ++ /*Start LCK*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal | 0x08000); ++ ++ for (cnt = 0; cnt < 100; cnt++) { ++ if (ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, 0x8000) != 0x1) ++ break; ++ ODM_delay_ms(10); ++ } ++ ++ /* Recover channel number*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal); ++ ++ /*Restore original situation*/ ++ if ((tmpReg & 0x70) != 0) ++ ODM_Write1Byte(pDM_Odm, 0xd03, tmpReg); ++ else ++ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0x00); ++} ++ ++ ++#define APK_BB_REG_NUM 8 ++#define APK_CURVE_REG_NUM 4 ++#define PATH_NUM 2 ++ ++VOID ++phy_APCalibrate_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN s1Byte delta, ++ IN BOOLEAN is2T ++ ) ++{ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ u4Byte regD[PATH_NUM]; ++ u4Byte tmpReg, index, offset, apkbound; ++ u1Byte path, i, pathbound = PATH_NUM; ++ u4Byte BB_backup[APK_BB_REG_NUM]; ++ u4Byte BB_REG[APK_BB_REG_NUM] = { ++ rFPGA1_TxBlock, rOFDM0_TRxPathEnable, ++ rFPGA0_RFMOD, rOFDM0_TRMuxPar, ++ rFPGA0_XCD_RFInterfaceSW, rFPGA0_XAB_RFInterfaceSW, ++ rFPGA0_XA_RFInterfaceOE, rFPGA0_XB_RFInterfaceOE }; ++ u4Byte BB_AP_MODE[APK_BB_REG_NUM] = { ++ 0x00000020, 0x00a05430, 0x02040000, ++ 0x000800e4, 0x00204000 }; ++ u4Byte BB_normal_AP_MODE[APK_BB_REG_NUM] = { ++ 0x00000020, 0x00a05430, 0x02040000, ++ 0x000800e4, 0x22204000 }; ++ ++ u4Byte AFE_backup[IQK_ADDA_REG_NUM]; ++ u4Byte AFE_REG[IQK_ADDA_REG_NUM] = { ++ rFPGA0_XCD_SwitchControl, rBlue_Tooth, ++ rRx_Wait_CCA, rTx_CCK_RFON, ++ rTx_CCK_BBON, rTx_OFDM_RFON, ++ rTx_OFDM_BBON, rTx_To_Rx, ++ rTx_To_Tx, rRx_CCK, ++ rRx_OFDM, rRx_Wait_RIFS, ++ rRx_TO_Rx, rStandby, ++ rSleep, rPMPD_ANAEN }; ++ ++ u4Byte MAC_backup[IQK_MAC_REG_NUM]; ++ u4Byte MAC_REG[IQK_MAC_REG_NUM] = { ++ REG_TXPAUSE, REG_BCN_CTRL, ++ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; ++ ++ u4Byte APK_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { ++ {0x0852c, 0x1852c, 0x5852c, 0x1852c, 0x5852c}, ++ {0x2852e, 0x0852e, 0x3852e, 0x0852e, 0x0852e} ++ }; ++ ++ u4Byte APK_normal_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { ++ {0x0852c, 0x0a52c, 0x3a52c, 0x5a52c, 0x5a52c}, ++ {0x0852c, 0x0a52c, 0x5a52c, 0x5a52c, 0x5a52c} ++ }; ++ ++ u4Byte APK_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { ++ {0x52019, 0x52014, 0x52013, 0x5200f, 0x5208d}, ++ {0x5201a, 0x52019, 0x52016, 0x52033, 0x52050} ++ }; ++ ++ u4Byte APK_normal_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { ++ {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a}, ++ {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a} ++ }; ++ ++ u4Byte AFE_on_off[PATH_NUM] = { ++ 0x04db25a4, 0x0b1b25a4}; ++ ++ u4Byte APK_offset[PATH_NUM] = { ++ rConfig_AntA, rConfig_AntB}; ++ ++ u4Byte APK_normal_offset[PATH_NUM] = { ++ rConfig_Pmpd_AntA, rConfig_Pmpd_AntB}; ++ ++ u4Byte APK_value[PATH_NUM] = { ++ 0x92fc0000, 0x12fc0000}; ++ ++ u4Byte APK_normal_value[PATH_NUM] = { ++ 0x92680000, 0x12680000}; ++ ++ s1Byte APK_delta_mapping[APK_BB_REG_NUM][13] = { ++ {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, ++ {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, ++ {-6, -4, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, ++ {-1, -1, -1, -1, -1, -1, 0, 1, 2, 3, 4, 5, 6}, ++ {-11, -9, -7, -5, -3, -1, 0, 0, 0, 0, 0, 0, 0} ++ }; ++ ++ u4Byte APK_normal_setting_value_1[13] = { ++ 0x01017018, 0xf7ed8f84, 0x1b1a1816, 0x2522201e, 0x322e2b28, ++ 0x433f3a36, 0x5b544e49, 0x7b726a62, 0xa69a8f84, 0xdfcfc0b3, ++ 0x12680000, 0x00880000, 0x00880000 ++ }; ++ ++ u4Byte APK_normal_setting_value_2[16] = { ++ 0x01c7021d, 0x01670183, 0x01000123, 0x00bf00e2, 0x008d00a3, ++ 0x0068007b, 0x004d0059, 0x003a0042, 0x002b0031, 0x001f0025, ++ 0x0017001b, 0x00110014, 0x000c000f, 0x0009000b, 0x00070008, ++ 0x00050006 ++ }; ++ ++ u4Byte APK_result[PATH_NUM][APK_BB_REG_NUM]; ++/* u4Byte AP_curve[PATH_NUM][APK_CURVE_REG_NUM];*/ ++ ++ s4Byte BB_offset, delta_V, delta_offset; ++ ++#if MP_DRIVER == 1 ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++#else ++ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); ++#endif ++ pMptCtx->APK_bound[0] = 45; ++ pMptCtx->APK_bound[1] = 52; ++ ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>phy_APCalibrate_8723D() delta %d\n", delta)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("AP Calibration for %s\n", (is2T ? "2T2R" : "1T1R"))); ++ if (!is2T) ++ pathbound = 1; ++ ++ ++ ++/* Temporarily do not allow normal driver to do the following settings because these offset ++// and value will cause RF internal PA to be unpredictably disabled by HW, such that RF Tx signal ++// will disappear after disable/enable card many times on 88CU. RF SD and DD have not find the ++// root cause, so we remove these actions temporarily. Added by tynli and SD3 Allen. 2010.05.31.*/ ++#if MP_DRIVER != 1 ++ return; ++#endif ++ ++ for (index = 0; index < PATH_NUM; index++) { ++ APK_offset[index] = APK_normal_offset[index]; ++ APK_value[index] = APK_normal_value[index]; ++ AFE_on_off[index] = 0x6fdb25a4; ++ } ++ ++ for (index = 0; index < APK_BB_REG_NUM; index++) { ++ for (path = 0; path < pathbound; path++) { ++ APK_RF_init_value[path][index] = APK_normal_RF_init_value[path][index]; ++ APK_RF_value_0[path][index] = APK_normal_RF_value_0[path][index]; ++ } ++ BB_AP_MODE[index] = BB_normal_AP_MODE[index]; ++ } ++ ++ apkbound = 6; ++ ++ ++ for (index = 0; index < APK_BB_REG_NUM ; index++) { ++ if (index == 0) ++ continue; ++ BB_backup[index] = ODM_GetBBReg(pDM_Odm, BB_REG[index], bMaskDWord); ++ } ++ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_SaveMACRegisters_8723D(pAdapter, MAC_REG, MAC_backup); ++ ++ ++ _PHY_SaveADDARegisters_8723D(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); ++#else ++ _PHY_SaveMACRegisters_8723D(pDM_Odm, MAC_REG, MAC_backup); ++ ++ ++ _PHY_SaveADDARegisters_8723D(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); ++#endif ++ ++ for (path = 0; path < pathbound; path++) { ++ ++ ++ if (path == ODM_RF_PATH_A) { ++ ++ offset = rPdp_AntA; ++ for (index = 0; index < 11; index++) { ++ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); ++ ++ offset += 0x04; ++ } ++ ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); ++ ++ offset = rConfig_AntA; ++ for (; index < 13; index++) { ++ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); ++ ++ offset += 0x04; ++ } ++ ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); ++ ++ ++ offset = rPdp_AntA; ++ for (index = 0; index < 16; index++) { ++ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_2[index]); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); ++ ++ offset += 0x04; ++ } ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ } else if (path == ODM_RF_PATH_B) { ++ ++ offset = rPdp_AntB; ++ for (index = 0; index < 10; index++) { ++ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); ++ ++ offset += 0x04; ++ } ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x12680000); ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); ++#else ++ PHY_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); ++#endif ++ ++ offset = rConfig_AntA; ++ index = 11; ++ for (; index < 13; index++) { ++ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); ++ ++ offset += 0x04; ++ } ++ ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); ++ ++ ++ offset = 0xb60; ++ for (index = 0; index < 16; index++) { ++ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_2[index]); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); ++ ++ offset += 0x04; ++ } ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ } ++ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ regD[path] = PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bMaskDWord); ++#else ++ regD[path] = ODM_GetRFReg(pDM_Odm, path, RF_TXBIAS_A, bMaskDWord); ++#endif ++ ++ ++ for (index = 0; index < IQK_ADDA_REG_NUM ; index++) ++ ODM_SetBBReg(pDM_Odm, AFE_REG[index], bMaskDWord, AFE_on_off[path]); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xe70 %x\n", ODM_GetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord))); ++ ++ ++ if (path == 0) { ++ for (index = 0; index < APK_BB_REG_NUM ; index++) { ++ ++ if (index == 0) ++ continue; ++ else if (index < 5) ++ ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_AP_MODE[index]); ++ else if (BB_REG[index] == 0x870) ++ ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_backup[index]|BIT10|BIT26); ++ else ++ ODM_SetBBReg(pDM_Odm, BB_REG[index], BIT10, 0x0); ++ } ++ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); ++ } else { ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x01008c00); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x01008c00); ++ ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x800 %x\n", ODM_GetBBReg(pDM_Odm, 0x800, bMaskDWord))); ++ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_MACSettingCalibration_8723D(pAdapter, MAC_REG, MAC_backup); ++#else ++ _PHY_MACSettingCalibration_8723D(pDM_Odm, MAC_REG, MAC_backup); ++#endif ++ ++ if (path == ODM_RF_PATH_A) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bMaskDWord, 0x10000); ++ } else { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bMaskDWord, 0x10000); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE1, bMaskDWord, 0x1000f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE2, bMaskDWord, 0x20103); ++ } ++ ++ delta_offset = ((delta+14)/2); ++ if (delta_offset < 0) ++ delta_offset = 0; ++ else if (delta_offset > 12) ++ delta_offset = 12; ++ ++ ++ for (index = 0; index < APK_BB_REG_NUM; index++) { ++ if (index != 1) ++ continue; ++ ++ tmpReg = APK_RF_init_value[path][index]; ++#if 1 ++ if (!pDM_Odm->RFCalibrateInfo.bAPKThermalMeterIgnore) { ++ BB_offset = (tmpReg & 0xF0000) >> 16; ++ ++ if (!(tmpReg & BIT15)) { ++ BB_offset = -BB_offset; ++ } ++ ++ delta_V = APK_delta_mapping[index][delta_offset]; ++ ++ BB_offset += delta_V; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() APK index %d tmpReg 0x%x delta_V %d delta_offset %d\n", index, tmpReg, delta_V, delta_offset)); ++ ++ if (BB_offset < 0) { ++ tmpReg = tmpReg & (~BIT15); ++ BB_offset = -BB_offset; ++ } else { ++ tmpReg = tmpReg | BIT15; ++ } ++ tmpReg = (tmpReg & 0xFFF0FFFF) | (BB_offset << 16); ++ } ++#endif ++ ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, RF_IPA_A, bMaskDWord, 0x8992e); ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xc %x\n", PHY_QueryRFReg(pAdapter, path, RF_IPA_A, bMaskDWord))); ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, RF_AC, bMaskDWord, APK_RF_value_0[path][index]); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x0 %x\n", PHY_QueryRFReg(pAdapter, path, RF_AC, bMaskDWord))); ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, RF_TXBIAS_A, bMaskDWord, tmpReg); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xd %x\n", PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bMaskDWord))); ++#else ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xc %x\n", ODM_GetRFReg(pDM_Odm, path, RF_IPA_A, bMaskDWord))); ++ ODM_SetRFReg(pDM_Odm, path, RF_AC, bMaskDWord, APK_RF_value_0[path][index]); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x0 %x\n", ODM_GetRFReg(pDM_Odm, path, RF_AC, bMaskDWord))); ++ ODM_SetRFReg(pDM_Odm, path, RF_TXBIAS_A, bMaskDWord, tmpReg); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xd %x\n", ODM_GetRFReg(pDM_Odm, path, RF_TXBIAS_A, bMaskDWord))); ++#endif ++ ++ ++ i = 0; ++ do ++ { ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x800000); ++ { ++ ODM_SetBBReg(pDM_Odm, APK_offset[path], bMaskDWord, APK_value[0]); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", APK_offset[path], ODM_GetBBReg(pDM_Odm, APK_offset[path], bMaskDWord))); ++ ODM_delay_ms(3); ++ ODM_SetBBReg(pDM_Odm, APK_offset[path], bMaskDWord, APK_value[1]); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", APK_offset[path], ODM_GetBBReg(pDM_Odm, APK_offset[path], bMaskDWord))); ++ ++ ODM_delay_ms(20); ++ } ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ++ if (path == ODM_RF_PATH_A) ++ tmpReg = ODM_GetBBReg(pDM_Odm, rAPK, 0x03E00000); ++ else ++ tmpReg = ODM_GetBBReg(pDM_Odm, rAPK, 0xF8000000); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xbd8[25:21] %x\n", tmpReg)); ++ ++ ++ i++; ++ } ++ while(tmpReg > apkbound && i < 4); ++ ++ APK_result[path][index] = tmpReg; ++ } ++ } ++ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_ReloadMACRegisters_8723D(pAdapter, MAC_REG, MAC_backup); ++#else ++ _PHY_ReloadMACRegisters_8723D(pDM_Odm, MAC_REG, MAC_backup); ++#endif ++ ++ ++ for (index = 0; index < APK_BB_REG_NUM ; index++) { ++ ++ if (index == 0) ++ continue; ++ ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_backup[index]); ++ } ++ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_ReloadADDARegisters_8723D(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); ++#else ++ _PHY_ReloadADDARegisters_8723D(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); ++#endif ++ ++ ++ for (path = 0; path < pathbound; path++) ++ { ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, 0xd, bMaskDWord, regD[path]); ++ if (path == ODM_RF_PATH_B) { ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE1, bMaskDWord, 0x1000f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE2, bMaskDWord, 0x20101); ++ } ++ ++ ++ if (APK_result[path][1] > 6) ++ APK_result[path][1] = 6; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("apk path %d result %d 0x%x \t", path, 1, APK_result[path][1])); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\n")); ++ ++ ++ for (path = 0; path < pathbound; path++) { ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, 0x3, bMaskDWord, ++ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (APK_result[path][1] << 5) | APK_result[path][1])); ++ if (path == ODM_RF_PATH_A) ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, 0x4, bMaskDWord, ++ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x00 << 5) | 0x05)); ++ else ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, 0x4, bMaskDWord, ++ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x02 << 5) | 0x05)); ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ if (!IS_HARDWARE_TYPE_8723A(pAdapter)) ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, RF_BS_PA_APSET_G9_G11, bMaskDWord, ++ ((0x08 << 15) | (0x08 << 10) | (0x08 << 5) | 0x08)); ++#endif ++ } ++ ++ pDM_Odm->RFCalibrateInfo.bAPKdone = TRUE; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==phy_APCalibrate_8723D()\n")); ++} ++ ++ ++ ++#define DP_BB_REG_NUM 7 ++#define DP_RF_REG_NUM 1 ++#define DP_RETRY_LIMIT 10 ++#define DP_PATH_NUM 2 ++#define DP_DPK_NUM 3 ++#define DP_DPK_VALUE_NUM 2 ++ ++ ++ ++ ++ ++VOID ++PHY_IQCalibrate_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN BOOLEAN bReCovery ++ ) ++{ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #else ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ ++ #if (MP_DRIVER == 1) ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); ++ #else ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ #endif ++ #endif ++#endif ++ ++ ++ u1Byte u1bTmp; ++ u2Byte count = 0; ++ s4Byte result[4][8]; ++ u1Byte i, final_candidate, Indexforchannel; ++ BOOLEAN bPathS1_OK, bPathS0_OK; ++ s4Byte RegE94_S1, RegE9C_S1, RegEA4_S1, RegEAC_S1, RegE94_S0, RegE9C_S0, RegEA4_S0, RegEAC_S0, RegTmp = 0; ++ s4Byte RegC80, RegC94, RegC14, RegCA0, RegCd0, RegCd4, RegCd8; ++ BOOLEAN is12simular, is13simular, is23simular; ++ BOOLEAN bSingleTone = FALSE, bCarrierSuppression = FALSE, bContinousTx = FALSE; ++ u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { ++ rOFDM0_XARxIQImbalance, rOFDM0_XBRxIQImbalance, ++ rOFDM0_ECCAThreshold, rOFDM0_AGCRSSITable, ++ rOFDM0_XATxIQImbalance, rOFDM0_XBTxIQImbalance, ++ rOFDM0_XCTxAFE, rOFDM0_XDTxAFE, ++ rOFDM0_RxIQExtAnta}; ++ u4Byte Path_SEL_BB_phyIQK; ++ u4Byte originalPath, originalGNT, oriPathCtrl; ++#if 1 ++ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("================ IQK Start ===================\n")); ++ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE) ) ++ if (ODM_CheckPowerStatus(pAdapter) == FALSE) ++ return; ++#else ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ ++#ifdef MP_TEST ++ if (priv->pshare->rf_ft_var.mp_specific) { ++ if ((OPMODE & WIFI_MP_CTX_PACKET) || (OPMODE & WIFI_MP_CTX_ST)) ++ return; ++ } ++#endif ++ ++ if (priv->pshare->IQK_88E_done) ++ bReCovery= 1; ++ priv->pshare->IQK_88E_done = 1; ++ ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ if (!(pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)) { ++ return; ++ } ++#endif ++ ++ ++#if MP_DRIVER == 1 ++ ++/*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ ++ /* Add to determine IQK ON/OFF in certain case, Suggested by Cheng.*/ ++ /* if (!pHalData->IQK_MP_Switch) ++ return;*/ ++/*#endif*/ ++ ++ bSingleTone = pMptCtx->bSingleTone; ++ bCarrierSuppression = pMptCtx->bCarrierSuppression; ++ bContinousTx = pMptCtx->bStartContTx; ++#endif ++ ++ /* 20120213 Turn on when continuous Tx to pass lab testing. (required by Edlu)*/ ++ if (bSingleTone || bCarrierSuppression || bContinousTx) ++ return; ++ ++ ++ ++#if DISABLE_BB_RF ++ return; ++#endif ++ ++ if (pDM_Odm->RFCalibrateInfo.bIQKInProgress) ++ return; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("=====>PHY_IQCalibrate_8723D\n")); ++ ++ ++ Path_SEL_BB_phyIQK = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) ++ if (bReCovery) ++#else ++ if (bReCovery && (!pAdapter->bInHctTest)) ++#endif ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("PHY_IQCalibrate_8723D: Return due to bReCovery!\n")); ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_ReloadADDARegisters_8723D(pAdapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, 9); ++#else ++ _PHY_ReloadADDARegisters_8723D(pDM_Odm, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, 9); ++#endif ++ return; ++ } ++ ++ /*Check & wait if BT is doing IQK*/ ++ ++ if (pDM_Odm->mp_mode == FALSE) { ++#if MP_DRIVER != 1 ++ SetFwWiFiCalibrationCmd_8723D(pAdapter, 1); ++ ++ ++ count = 0; ++ u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e6); ++ while (u1bTmp != 0x1 && count < 1000) { ++ PlatformStallExecution(10); ++ u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e6); ++ count++; ++ } ++ if (count >= 1000) { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]Polling 0x1e6 to 1 for WiFi calibration H2C cmd FAIL! count(%d)", count)); ++ } ++ ++ ++ u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e7); ++ while ((!(u1bTmp&BIT0)) && count < 6000) { ++ PlatformStallExecution(50); ++ u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e7); ++ count++; ++ } ++#endif ++ } ++ ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Start!!!\n")); ++ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); ++ pDM_Odm->RFCalibrateInfo.bIQKInProgress = TRUE; ++ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); ++ ++ for (i = 0; i < 8; i++) { ++ result[0][i] = 0; ++ result[1][i] = 0; ++ result[2][i] = 0; ++ result[3][i] = 0; ++ } ++ ++ final_candidate = 0xff; ++ bPathS1_OK = FALSE; ++ bPathS0_OK = FALSE; ++ is12simular = FALSE; ++ is23simular = FALSE; ++ is13simular = FALSE; ++ ++for (i = 0; i < 3; i++) { ++ ++#if 1 ++ /*set path control to WL*/ ++ oriPathCtrl = ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3); /*save 0x67*/ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]original 0x67 = 0x%x\n", oriPathCtrl)); ++ ODM_SetMACReg(pDM_Odm, 0x64, BIT31, 0x1); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]set 0x67 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); ++ ++ /*backup Path & GNT value */ ++ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); ++ ODM_delay_ms(1); ++ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); ++ ++ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); ++#endif ++ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ ++ phy_IQCalibrate_8723D(pAdapter, result, i, TRUE); ++#else ++ phy_IQCalibrate_8723D(pDM_Odm, result, i, TRUE); ++#endif ++ ++#if 1 ++ /*Restore GNT_WL/GNT_BT and Path owner*/ ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); ++ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); ++ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); ++ ++ /*Restore path control owner*/ ++ ODM_SetMACReg(pDM_Odm, 0x64, bMaskByte3, oriPathCtrl); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]restore 0x67 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); ++#endif ++ ++ if (i == 1) { ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ is12simular = phy_SimularityCompare_8723D(pAdapter, result, 0, 1); ++#else ++ is12simular = phy_SimularityCompare_8723D(pDM_Odm, result, 0, 1); ++#endif ++ ++ if (is12simular) { ++ final_candidate = 0; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is12simular final_candidate is %x\n",final_candidate)); ++ break; ++ } ++ } ++ ++ if (i == 2) { ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ is13simular = phy_SimularityCompare_8723D(pAdapter, result, 0, 2); ++#else ++ is13simular = phy_SimularityCompare_8723D(pDM_Odm, result, 0, 2); ++#endif ++ ++ if (is13simular) { ++ final_candidate = 0; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is13simular final_candidate is %x\n",final_candidate)); ++ ++ break; ++ } ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ is23simular = phy_SimularityCompare_8723D(pAdapter, result, 1, 2); ++#else ++ is23simular = phy_SimularityCompare_8723D(pDM_Odm, result, 1, 2); ++#endif ++ ++ if (is23simular) { ++ final_candidate = 1; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is23simular final_candidate is %x\n",final_candidate)); ++ } else { ++ for (i = 0; i < 8; i++) ++ RegTmp += result[3][i]; ++ ++ if (RegTmp != 0) ++ final_candidate = 3; ++ else ++ final_candidate = 0xFF; ++ ++ } ++ } ++ } ++ ++ ++ ++ for (i = 0; i < 4; i++) { ++ RegE94_S1 = result[i][0]; ++ RegE9C_S1 = result[i][1]; ++ RegEA4_S1 = result[i][2]; ++ RegEAC_S1 = result[i][3]; ++ RegE94_S0 = result[i][4]; ++ RegE9C_S0 = result[i][5]; ++ RegEA4_S0 = result[i][6]; ++ RegEAC_S0 = result[i][7]; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] RegE94_S1=%x RegE9C_S1=%x RegEA4_S1=%x RegEAC_S1=%x RegE94_S0=%x RegE9C_S0=%x RegEA4_S0=%x RegEAC_S0=%x\n ", RegE94_S1, RegE9C_S1, RegEA4_S1, RegEAC_S1, RegE94_S0, RegE9C_S0, RegEA4_S0, RegEAC_S0)); ++ } ++ ++ if (final_candidate != 0xff) { ++ pDM_Odm->RFCalibrateInfo.RegE94 = RegE94_S1 = result[final_candidate][0]; ++ pDM_Odm->RFCalibrateInfo.RegE9C = RegE9C_S1 = result[final_candidate][1]; ++ RegEA4_S1 = result[final_candidate][2]; ++ RegEAC_S1 = result[final_candidate][3]; ++ pDM_Odm->RFCalibrateInfo.RegEB4 = RegE94_S0 = result[final_candidate][4]; ++ pDM_Odm->RFCalibrateInfo.RegEBC = RegE9C_S0 = result[final_candidate][5]; ++ RegEA4_S0 = result[final_candidate][6]; ++ RegEAC_S0 = result[final_candidate][7]; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] final_candidate is %x\n", final_candidate)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] TX1_X=%x TX1_Y=%x RX1_X=%x RX1_Y=%x TX0_X=%x TX0_Y=%x RX0_X=%x RX0_Y=%x\n ", RegE94_S1, RegE9C_S1, RegEA4_S1, RegEAC_S1, RegE94_S0, RegE9C_S0, RegEA4_S0, RegEAC_S0)); ++ bPathS1_OK = bPathS0_OK = TRUE; ++ } else { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] FAIL use default value\n")); ++ ++ pDM_Odm->RFCalibrateInfo.RegE94 = pDM_Odm->RFCalibrateInfo.RegEB4 = 0x100; ++ pDM_Odm->RFCalibrateInfo.RegE9C = pDM_Odm->RFCalibrateInfo.RegEBC = 0x0; ++ } ++ ++ ++ if (RegE94_S1 != 0) ++ _PHY_PathS1FillIQKMatrix_8723D(pAdapter, bPathS1_OK, result, final_candidate, (RegEA4_S1 == 0)); ++ if (RegE94_S0 != 0) ++ _PHY_PathS0FillIQKMatrix_8723D(pAdapter, bPathS0_OK, result, final_candidate, (RegEA4_S0 == 0)); ++ ++ ++ RegC80 = ODM_GetBBReg(pDM_Odm, 0xc80, bMaskDWord); ++ RegC94 = ODM_GetBBReg(pDM_Odm, 0xc94, bMaskDWord); ++ RegC14 = ODM_GetBBReg(pDM_Odm, 0xc14, bMaskDWord); ++ RegCA0 = ODM_GetBBReg(pDM_Odm, 0xca0, bMaskDWord); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xc80 = 0x%x 0xc94 = 0x%x 0xc14 = 0x%x 0xca0 = 0x%x\n", RegC80, RegC94, RegC14, RegCA0)); ++ ++ ++ RegCd0 = ODM_GetBBReg(pDM_Odm, 0xcd0, bMaskDWord); ++ RegCd4 = ODM_GetBBReg(pDM_Odm, 0xcd4, bMaskDWord); ++ RegCd8 = ODM_GetBBReg(pDM_Odm, 0xcd8, bMaskDWord); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xcd0 = 0x%x 0xcd4 = 0x%x 0xcd8 = 0x%x\n", RegCd0, RegCd4, RegCd8)); ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ Indexforchannel = ODM_GetRightChnlPlaceforIQK(pHalData->CurrentChannel); ++#else ++ Indexforchannel = 0; ++#endif ++ ++ ++ if (final_candidate < 4) { ++ for (i = 0; i < IQK_Matrix_REG_NUM; i++) ++ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[Indexforchannel].Value[0][i] = result[final_candidate][i]; ++ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[Indexforchannel].bIQKDone = TRUE; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\nIQK OK Indexforchannel %d.\n", Indexforchannel)); ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ ++ _PHY_SaveADDARegisters_8723D(pAdapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, 9); ++#else ++ _PHY_SaveADDARegisters_8723D(pDM_Odm, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, IQK_BB_REG_NUM); ++#endif ++ ++ if (pDM_Odm->mp_mode == FALSE) { ++#if MP_DRIVER != 1 ++ SetFwWiFiCalibrationCmd_8723D(pAdapter, 0); ++ ++ ++ count = 0; ++ u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e6); ++ while (u1bTmp != 0 && count < 1000) { ++ PlatformStallExecution(10); ++ u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e6); ++ count++; ++ } ++ ++ if (count >= 1000) { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]Polling 0x1e6 to 0 for WiFi calibration H2C cmd FAIL! count(%d)", count)); ++ } ++#endif ++ } ++ ++ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); ++ pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; ++ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); ++ ++ ++ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB_phyIQK); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK finished\n")); ++#endif ++ ++} ++ ++ ++VOID ++PHY_LCCalibrate_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PVOID pDM_VOID ++#else ++ IN PDM_ODM_T pDM_Odm ++#endif ++ ) ++{ ++ BOOLEAN bSingleTone = FALSE, bCarrierSuppression = FALSE; ++ u4Byte timeout = 2000, timecount = 0; ++ ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#endif ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ #if (MP_DRIVER == 1) ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); ++ #else ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ #endif ++ #endif ++#endif ++ ++#if MP_DRIVER == 1 ++ bSingleTone = pMptCtx->bSingleTone; ++ bCarrierSuppression = pMptCtx->bCarrierSuppression; ++#endif ++ ++ ++#if DISABLE_BB_RF ++ return; ++#endif ++ ++ ++ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ if (!(pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)) { ++ return; ++ } ++#endif ++ ++ if (bSingleTone || bCarrierSuppression) ++ return; ++ ++ while(*(pDM_Odm->pbScanInProcess) && timecount < timeout) ++ { ++ ODM_delay_ms(50); ++ timecount += 50; ++ } ++ ++ pDM_Odm->RFCalibrateInfo.bLCKInProgress = TRUE; ++ ++ phy_LCCalibrate_8723D(pDM_Odm, FALSE); ++ ++ pDM_Odm->RFCalibrateInfo.bLCKInProgress = FALSE; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK:Finish!!!interface %d\n", pDM_Odm->InterfaceIndex)); ++ ++} ++ ++VOID ++PHY_APCalibrate_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN s1Byte delta ++ ) ++{ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++#if DISABLE_BB_RF ++ return; ++#endif ++ ++ return; ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ if (!(pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)) { ++ return; ++ } ++#endif ++ ++#if FOR_BRAZIL_PRETEST != 1 ++ if (pDM_Odm->RFCalibrateInfo.bAPKdone) ++#endif ++ return; ++ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ phy_APCalibrate_8723D(pAdapter, delta, FALSE); ++#else ++ phy_APCalibrate_8723D(pDM_Odm, delta, FALSE); ++#endif ++ } ++VOID phy_SetRFPathSwitch_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN BOOLEAN bMain, ++ IN BOOLEAN is2T ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++#endif ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#endif ++ ++ if (bMain) { ++ ODM_SetMACReg(pDM_Odm, 0x7C4, bMaskLWord, 0x7700); ++ } else { ++ ODM_SetMACReg(pDM_Odm, 0x7C4, bMaskLWord, 0xDD00); ++ } ++ ++ ODM_SetMACReg(pDM_Odm, 0x7C0, bMaskDWord, 0xC00F0038); ++ ODM_SetMACReg(pDM_Odm, 0x70, BIT26, 1); ++ ODM_SetMACReg(pDM_Odm, 0x64, BIT31, 1); ++} ++ ++VOID PHY_SetRFPathSwitch_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN BOOLEAN bMain ++ ) ++{ ++HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++#endif ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#endif ++ ++#if DISABLE_BB_RF ++ return; ++#endif ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ phy_SetRFPathSwitch_8723D(pAdapter, bMain, TRUE); ++#endif ++ ++} ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ ++VOID ++phy_DigitalPredistortion_8723D( ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PADAPTER pAdapter, ++#else ++ IN PDM_ODM_T pDM_Odm, ++#endif ++ IN BOOLEAN is2T ++ ) ++{ ++#if (RT_PLATFORM == PLATFORM_WINDOWS) ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ ++ u4Byte tmpReg, tmpReg2, index, i; ++ u1Byte path, pathbound = PATH_NUM; ++ u4Byte AFE_backup[IQK_ADDA_REG_NUM]; ++ u4Byte AFE_REG[IQK_ADDA_REG_NUM] = { ++ rFPGA0_XCD_SwitchControl, rBlue_Tooth, ++ rRx_Wait_CCA, rTx_CCK_RFON, ++ rTx_CCK_BBON, rTx_OFDM_RFON, ++ rTx_OFDM_BBON, rTx_To_Rx, ++ rTx_To_Tx, rRx_CCK, ++ rRx_OFDM, rRx_Wait_RIFS, ++ rRx_TO_Rx, rStandby, ++ rSleep, rPMPD_ANAEN }; ++ ++ u4Byte BB_backup[DP_BB_REG_NUM]; ++ u4Byte BB_REG[DP_BB_REG_NUM] = { ++ rOFDM0_TRxPathEnable, rFPGA0_RFMOD, ++ rOFDM0_TRMuxPar, rFPGA0_XCD_RFInterfaceSW, ++ rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, ++ rFPGA0_XB_RFInterfaceOE}; ++ u4Byte BB_settings[DP_BB_REG_NUM] = { ++ 0x00a05430, 0x02040000, 0x000800e4, 0x22208000, ++ 0x0, 0x0, 0x0}; ++ ++ u4Byte RF_backup[DP_PATH_NUM][DP_RF_REG_NUM]; ++ u4Byte RF_REG[DP_RF_REG_NUM] = { ++ RF_TXBIAS_A}; ++ ++ u4Byte MAC_backup[IQK_MAC_REG_NUM]; ++ u4Byte MAC_REG[IQK_MAC_REG_NUM] = { ++ REG_TXPAUSE, REG_BCN_CTRL, ++ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; ++ ++ u4Byte Tx_AGC[DP_DPK_NUM][DP_DPK_VALUE_NUM] = { ++ {0x1e1e1e1e, 0x03901e1e}, ++ {0x18181818, 0x03901818}, ++ {0x0e0e0e0e, 0x03900e0e} ++ }; ++ ++ u4Byte AFE_on_off[PATH_NUM] = { ++ 0x04db25a4, 0x0b1b25a4}; ++ ++ u1Byte RetryCount = 0; ++ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>phy_DigitalPredistortion_8723D()\n")); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_DigitalPredistortion_8723D for %s\n", (is2T ? "2T2R" : "1T1R"))); ++ ++ ++ for (index = 0; index < DP_BB_REG_NUM; index++) ++ BB_backup[index] = ODM_GetBBReg(pDM_Odm, BB_REG[index], bMaskDWord); ++ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_SaveMACRegisters_8723D(pAdapter, BB_REG, MAC_backup); ++#else ++ _PHY_SaveMACRegisters_8723D(pDM_Odm, BB_REG, MAC_backup); ++#endif ++ ++ ++ for (path = 0; path < DP_PATH_NUM; path++) { ++ for (index = 0; index < DP_RF_REG_NUM; index++) ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ RF_backup[path][index] = PHY_QueryRFReg(pAdapter, path, RF_REG[index], bMaskDWord); ++#else ++ RF_backup[path][index] = ODM_GetRFReg(pAdapter, path, RF_REG[index], bMaskDWord); ++#endif ++ } ++ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_SaveADDARegisters_8723D(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); ++#else ++ _PHY_SaveADDARegisters_8723D(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); ++#endif ++ ++ ++ for (index = 0; index < IQK_ADDA_REG_NUM ; index++) ++ ODM_SetBBReg(pDM_Odm, AFE_REG[index], bMaskDWord, 0x6fdb25a4); ++ ++ ++ for (index = 0; index < DP_BB_REG_NUM; index++) { ++ if (index < 4) ++ ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_settings[index]); ++ else if (index == 4) ++ ODM_SetBBReg(pDM_Odm,BB_REG[index], bMaskDWord, BB_backup[index]|BIT10|BIT26); ++ else ++ ODM_SetBBReg(pDM_Odm, BB_REG[index], BIT10, 0x00); ++ } ++ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_MACSettingCalibration_8723D(pAdapter, MAC_REG, MAC_backup); ++#else ++ _PHY_MACSettingCalibration_8723D(pDM_Odm, MAC_REG, MAC_backup); ++#endif ++ ++ ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x01008c00); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x01008c00); ++ ++ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bMaskDWord, 0x10000); ++ ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); ++ ODM_SetBBReg(pDM_Odm, 0xbc0, bMaskDWord, 0x0005361f); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ++ ++ for (i = 0; i < 3; i++) { ++ ++ for (index = 0; index < 3; index++) ++ ODM_SetBBReg(pDM_Odm, 0xe00+index*4, bMaskDWord, Tx_AGC[i][0]); ++ ODM_SetBBReg(pDM_Odm,0xe00+index*4, bMaskDWord, Tx_AGC[i][1]); ++ for (index = 0; index < 4; index++) ++ ODM_SetBBReg(pDM_Odm, 0xe10+index*4, bMaskDWord, Tx_AGC[i][0]); ++ ++ ++ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x02097098); ++ ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0xf76d9f84); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x0004ab87); ++ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00880000); ++ ++ ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x80047788); ++ ODM_delay_ms(1); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x00047788); ++ ODM_delay_ms(50); ++ } ++ ++ ++ for (index = 0; index < 3; index++) ++ ODM_SetBBReg(pDM_Odm, 0xe00+index*4, bMaskDWord, 0x34343434); ++ ODM_SetBBReg(pDM_Odm, 0xe08+index*4, bMaskDWord, 0x03903434); ++ for (index = 0; index < 4; index++) ++ ODM_SetBBReg(pDM_Odm, 0xe10+index*4, bMaskDWord, 0x34343434); ++ ++ ++ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x02017098); ++ ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0xf76d9f84); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x0004ab87); ++ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00880000); ++ ++ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x0c, bMaskDWord, 0x8992b); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x0d, bMaskDWord, 0x0e52c); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bMaskDWord, 0x5205a ); ++ ++ ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x800477c0); ++ ODM_delay_ms(1); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x000477c0); ++ ODM_delay_ms(50); ++ ++ while(RetryCount < DP_RETRY_LIMIT && !pDM_Odm->RFCalibrateInfo.bDPPathAOK) ++ { ++ ++ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x0c297018); ++ tmpReg = ODM_GetBBReg(pDM_Odm, 0xbe0, bMaskDWord); ++ ODM_delay_ms(10); ++ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x0c29701f); ++ tmpReg2 = ODM_GetBBReg(pDM_Odm, 0xbe8, bMaskDWord); ++ ODM_delay_ms(10); ++ ++ tmpReg = (tmpReg & bMaskHWord) >> 16; ++ tmpReg2 = (tmpReg2 & bMaskHWord) >> 16; ++ if (tmpReg < 0xf0 || tmpReg > 0x105 || tmpReg2 > 0xff) { ++ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x02017098); ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x800000); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ODM_delay_ms(1); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x800477c0); ++ ODM_delay_ms(1); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x000477c0); ++ ODM_delay_ms(50); ++ RetryCount++; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 DPK RetryCount %d 0xbe0[31:16] %x 0xbe8[31:16] %x\n", RetryCount, tmpReg, tmpReg2)); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 DPK Success\n")); ++ pDM_Odm->RFCalibrateInfo.bDPPathAOK = TRUE; ++ break; ++ } ++ } ++ RetryCount = 0; ++ ++ ++ if (pDM_Odm->RFCalibrateInfo.bDPPathAOK) { ++ ++ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x01017098); ++ ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0x776d9f84); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x0004ab87); ++ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00880000); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); ++ ++ for (i = rPdp_AntA; i <= 0xb3c; i += 4) { ++ ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x40004000); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 ofsset = 0x%x\n", i)); ++ } ++ ++ ++ ODM_SetBBReg(pDM_Odm, 0xb40, bMaskDWord, 0x40404040); ++ ODM_SetBBReg(pDM_Odm, 0xb44, bMaskDWord, 0x28324040); ++ ODM_SetBBReg(pDM_Odm, 0xb48, bMaskDWord, 0x10141920); ++ ++ for (i = 0xb4c; i <= 0xb5c; i += 4) { ++ ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x0c0c0c0c); ++ } ++ ++ ++ ODM_SetBBReg(pDM_Odm, 0xbc0, bMaskDWord, 0x0005361f); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ } else { ++ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x00000000); ++ ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0x00000000); ++ } ++ ++ ++ if (is2T) { ++ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bMaskDWord, 0x10000); ++ ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); ++ ODM_SetBBReg(pDM_Odm, 0xbc4, bMaskDWord, 0x0005361f); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ++ ++ for (i = 0; i < 3; i++) { ++ ++ for(index = 0; index < 4; index++) ++ ODM_SetBBReg(pDM_Odm, 0x830+index*4, bMaskDWord, Tx_AGC[i][0]); ++ for(index = 0; index < 2; index++) ++ ODM_SetBBReg(pDM_Odm, 0x848+index*4, bMaskDWord, Tx_AGC[i][0]); ++ for(index = 0; index < 2; index++) ++ ODM_SetBBReg(pDM_Odm, 0x868+index*4, bMaskDWord, Tx_AGC[i][0]); ++ ++ ++ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x02097098); ++ ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0xf76d9f84); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x0004ab87); ++ ODM_SetBBReg(pDM_Odm, rConfig_AntB, bMaskDWord, 0x00880000); ++ ++ ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x80047788); ++ ODM_delay_ms(1); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x00047788); ++ ODM_delay_ms(50); ++ } ++ ++ ++ for (index = 0; index < 4; index++) ++ ODM_SetBBReg(pDM_Odm, 0x830+index*4, bMaskDWord, 0x34343434); ++ for (index = 0; index < 2; index++) ++ ODM_SetBBReg(pDM_Odm, 0x848+index*4, bMaskDWord, 0x34343434); ++ for (index = 0; index < 2; index++) ++ ODM_SetBBReg(pDM_Odm, 0x868+index*4, bMaskDWord, 0x34343434); ++ ++ ++ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x02017098); ++ ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0xf76d9f84); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x0004ab87); ++ ODM_SetBBReg(pDM_Odm, rConfig_AntB, bMaskDWord, 0x00880000); ++ ++ ++ ODM_SetBBReg(pDM_Odm, 0x840, bMaskDWord, 0x0101000f); ++ ODM_SetBBReg(pDM_Odm, 0x840, bMaskDWord, 0x01120103); ++ ++ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x0c, bMaskDWord, 0x8992b); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x0d, bMaskDWord, 0x0e52c); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bMaskDWord, 0x5205a); ++ ++ ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x800477c0); ++ ODM_delay_ms(1); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x000477c0); ++ ODM_delay_ms(50); ++ ++ while(RetryCount < DP_RETRY_LIMIT && !pDM_Odm->RFCalibrateInfo.bDPPathBOK) ++ { ++ ++ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x0c297018); ++ tmpReg = ODM_GetBBReg(pDM_Odm, 0xbf0, bMaskDWord); ++ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x0c29701f); ++ tmpReg2 = ODM_GetBBReg(pDM_Odm, 0xbf8, bMaskDWord); ++ ++ tmpReg = (tmpReg & bMaskHWord) >> 16; ++ tmpReg2 = (tmpReg2 & bMaskHWord) >> 16; ++ ++ if (tmpReg < 0xf0 || tmpReg > 0x105 || tmpReg2 > 0xff) { ++ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x02017098); ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x800000); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ODM_delay_ms(1); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x800477c0); ++ ODM_delay_ms(1); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x000477c0); ++ ODM_delay_ms(50); ++ RetryCount++; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK RetryCount %d 0xbf0[31:16] %x, 0xbf8[31:16] %x\n", RetryCount , tmpReg, tmpReg2)); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK Success\n")); ++ pDM_Odm->RFCalibrateInfo.bDPPathBOK = TRUE; ++ break; ++ } ++ } ++ ++ ++ if (pDM_Odm->RFCalibrateInfo.bDPPathBOK) { ++ ++ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x01017098); ++ ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0x776d9f84); ++ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x0004ab87); ++ ODM_SetBBReg(pDM_Odm, rConfig_AntB, bMaskDWord, 0x00880000); ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); ++ for (i = 0xb60; i <= 0xb9c; i += 4) { ++ ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x40004000); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B ofsset = 0x%x\n", i)); ++ } ++ ++ ++ ODM_SetBBReg(pDM_Odm, 0xba0, bMaskDWord, 0x40404040); ++ ODM_SetBBReg(pDM_Odm, 0xba4, bMaskDWord, 0x28324050); ++ ODM_SetBBReg(pDM_Odm, 0xba8, bMaskDWord, 0x0c141920); ++ ++ for (i = 0xbac; i <= 0xbbc; i += 4) { ++ ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x0c0c0c0c); ++ } ++ ++ ++ ODM_SetBBReg(pDM_Odm, 0xbc4, bMaskDWord, 0x0005361f); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); ++ ++ } else { ++ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x00000000); ++ ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0x00000000); ++ } ++ } ++ ++ ++ for (index = 0; index < DP_BB_REG_NUM; index++) ++ ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_backup[index]); ++ ++ ++ for (path = 0; path < DP_PATH_NUM; path++) { ++ for (i = 0 ; i < DP_RF_REG_NUM ; i++) { ++ ODM_SetRFReg(pDM_Odm, path, RF_REG[i], bMaskDWord, RF_backup[path][i]); ++ } ++ } ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE1, bMaskDWord, 0x1000f); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE2, bMaskDWord, 0x20101); ++ ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ _PHY_ReloadADDARegisters_8723D(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); ++ ++ ++ _PHY_ReloadMACRegisters_8723D(pAdapter, MAC_REG, MAC_backup); ++#else ++ _PHY_ReloadADDARegisters_8723D(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); ++ ++ ++ _PHY_ReloadMACRegisters_8723D(pDM_Odm, MAC_REG, MAC_backup); ++#endif ++ ++ pDM_Odm->RFCalibrateInfo.bDPdone = TRUE; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==phy_DigitalPredistortion_8723D()\n")); ++#endif ++} ++ ++VOID ++PHY_DigitalPredistortion_8723D( ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PADAPTER pAdapter ++#else ++ IN PDM_ODM_T pDM_Odm ++#endif ++ ) ++{ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++#if DISABLE_BB_RF ++ return; ++#endif ++ ++ return; ++ ++ if (pDM_Odm->RFCalibrateInfo.bDPdone) ++ return; ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ ++ if (IS_92C_SERIAL(pHalData->VersionID)) { ++ phy_DigitalPredistortion_8723D(pAdapter, TRUE); ++ } ++ else ++#endif ++ { ++ ++ phy_DigitalPredistortion_8723D(pAdapter, FALSE); ++ } ++} ++ ++ ++ ++ ++ ++BOOLEAN phy_QueryRFPathSwitch_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN BOOLEAN is2T ++ ) ++{ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ #endif ++ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ #endif ++#endif ++ ++ ++ if (ODM_GetBBReg(pDM_Odm, 0x7C4, bMaskLWord) == 0x7700) ++ return TRUE; ++ else ++ return FALSE; ++ ++} ++ ++ ++ ++ ++BOOLEAN PHY_QueryRFPathSwitch_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm ++#else ++ IN PADAPTER pAdapter ++#endif ++ ) ++{ ++ ++#if DISABLE_BB_RF ++ return TRUE; ++#endif ++ ++#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) ++ return phy_QueryRFPathSwitch_8723D(pAdapter, FALSE); ++#else ++ return phy_QueryRFPathSwitch_8723D(pDM_Odm, FALSE); ++#endif ++ ++} ++#endif ++ ++ ++ ++#else ++ ++VOID ++PHY_IQCalibrate_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN BOOLEAN bReCovery ++ ){} ++VOID ++PHY_LCCalibrate_8723D( ++ IN PDM_ODM_T pDM_Odm ++ ){} ++ ++VOID ++ODM_TxPwrTrackSetPwr_8723D( ++ PDM_ODM_T pDM_Odm, ++ PWRTRACK_METHOD Method, ++ u1Byte RFPath, ++ u1Byte ChannelMappedIndex ++ ){} ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.h 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,153 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __HAL_PHY_RF_8723D_H__ ++#define __HAL_PHY_RF_8723D_H__ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++#define IQK_DELAY_TIME_8723D 10 //ms ++#define index_mapping_NUM_8723D 15 ++#define AVG_THERMAL_NUM_8723D 4 ++#define RF_T_METER_8723D 0x42 ++ ++void ConfigureTxpowerTrack_8723D( ++ PTXPWRTRACK_CFG pConfig ++ ); ++ ++VOID ++GetDeltaSwingTable_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PVOID pDM_VOID, ++#else ++ IN PDM_ODM_T pDM_Odm, ++#endif ++ OUT pu1Byte *TemperatureUP_A, ++ OUT pu1Byte *TemperatureDOWN_A, ++ OUT pu1Byte *TemperatureUP_B, ++ OUT pu1Byte *TemperatureDOWN_B ++ ); ++ ++VOID ++setCCKFilterCoefficient_8723D( ++ PDM_ODM_T pDM_Odm, ++ u1Byte CCKSwingIndex ++); ++ ++void DoIQK_8723D( ++ PVOID pDM_VOID, ++ u1Byte DeltaThermalIndex, ++ u1Byte ThermalValue, ++ u1Byte Threshold ++ ); ++ ++VOID ++ODM_TxPwrTrackSetPwr_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PVOID pDM_VOID, ++#else ++ IN PDM_ODM_T pDM_Odm, ++#endif ++ PWRTRACK_METHOD Method, ++ u1Byte RFPath, ++ u1Byte ChannelMappedIndex ++ ); ++ ++VOID ++ODM_TxXtalTrackSetXtal_8723D( ++ PVOID pDM_VOID ++); ++ ++//1 7. IQK ++ ++void ++PHY_IQCalibrate_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER Adapter, ++#endif ++ IN BOOLEAN bReCovery); ++ ++ ++// ++// LC calibrate ++// ++void ++PHY_LCCalibrate_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_CE) ++ PVOID pDM_VOID ++#else ++ IN PDM_ODM_T pDM_Odm ++#endif ++); ++ ++// ++// AP calibrate ++// ++void ++PHY_APCalibrate_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN s1Byte delta); ++void ++PHY_DigitalPredistortion_8723D( IN PADAPTER pAdapter); ++ ++ ++VOID ++_PHY_SaveADDARegisters_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN pu4Byte ADDAReg, ++ IN pu4Byte ADDABackup, ++ IN u4Byte RegisterNum ++ ); ++ ++VOID ++_PHY_PathADDAOn_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN pu4Byte ADDAReg, ++ IN BOOLEAN isPathAOn, ++ IN BOOLEAN is2T ++ ); ++ ++VOID ++_PHY_MACSettingCalibration_8723D( ++#if (DM_ODM_SUPPORT_TYPE & ODM_AP) ++ IN PDM_ODM_T pDM_Odm, ++#else ++ IN PADAPTER pAdapter, ++#endif ++ IN pu4Byte MACReg, ++ IN pu4Byte MACBackup ++ ); ++ ++ ++#endif // #ifndef __HAL_PHY_RF_8723D_H__ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.c 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,189 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#include "Mp_Precomp.h" ++#include "../phydm_precomp.h" ++ ++#if (RTL8723D_SUPPORT == 1) ++ ++void ++odm_ConfigRFReg_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Addr, ++ IN u4Byte Data, ++ IN ODM_RF_RADIO_PATH_E RF_PATH, ++ IN u4Byte RegAddr ++ ) ++{ ++ if(Addr == 0xfe || Addr == 0xffe) ++ { ++ #ifdef CONFIG_LONG_DELAY_ISSUE ++ ODM_sleep_ms(50); ++ #else ++ ODM_delay_ms(50); ++ #endif ++ } ++ else ++ { ++ ODM_SetRFReg(pDM_Odm, RF_PATH, RegAddr, bRFRegOffsetMask, Data); ++ // Add 1us delay between BB/RF register setting. ++ ODM_delay_us(1); ++ } ++} ++ ++ ++void ++odm_ConfigRF_RadioA_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Addr, ++ IN u4Byte Data ++ ) ++{ ++ u4Byte content = 0x1000; // RF_Content: radioa_txt ++ u4Byte maskforPhySet= (u4Byte)(content&0xE000); ++ ++ odm_ConfigRFReg_8723D(pDM_Odm, Addr, Data, ODM_RF_PATH_A, Addr|maskforPhySet); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioA] %08X %08X\n", Addr, Data)); ++} ++ ++void ++odm_ConfigRF_RadioB_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Addr, ++ IN u4Byte Data ++ ) ++{ ++ u4Byte content = 0x1001; // RF_Content: radiob_txt ++ u4Byte maskforPhySet= (u4Byte)(content&0xE000); ++ ++ odm_ConfigRFReg_8723D(pDM_Odm, Addr, Data, ODM_RF_PATH_B, Addr|maskforPhySet); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioB] %08X %08X\n", Addr, Data)); ++ ++} ++ ++void ++odm_ConfigMAC_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Addr, ++ IN u1Byte Data ++ ) ++{ ++ ODM_Write1Byte(pDM_Odm, Addr, Data); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigMACWithHeaderFile: [MAC_REG] %08X %08X\n", Addr, Data)); ++} ++ ++void ++odm_ConfigBB_AGC_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Addr, ++ IN u4Byte Bitmask, ++ IN u4Byte Data ++ ) ++{ ++ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); ++ // Add 1us delay between BB/RF register setting. ++ ODM_delay_us(1); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [AGC_TAB] %08X %08X\n", Addr, Data)); ++} ++ ++void ++odm_ConfigBB_PHY_REG_PG_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Band, ++ IN u4Byte RfPath, ++ IN u4Byte TxNum, ++ IN u4Byte Addr, ++ IN u4Byte Bitmask, ++ IN u4Byte Data ++ ) ++{ ++ if (Addr == 0xfe || Addr == 0xffe) ++ #ifdef CONFIG_LONG_DELAY_ISSUE ++ ODM_sleep_ms(50); ++ #else ++ ODM_delay_ms(50); ++ #endif ++ else ++ { ++#if !(DM_ODM_SUPPORT_TYPE&ODM_AP) ++ PHY_StoreTxPowerByRate(pDM_Odm->Adapter, Band, RfPath, TxNum, Addr, Bitmask, Data); ++#endif ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X %08X\n", Addr, Bitmask, Data)); ++} ++ ++void ++odm_ConfigBB_PHY_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Addr, ++ IN u4Byte Bitmask, ++ IN u4Byte Data ++ ) ++{ ++/*DbgPrint("odm_ConfigBB_PHY_8723D(), Addr = 0x%x, data = 0x%x\n", Addr, Data);*/ ++ if (Addr == 0xfe) ++ #ifdef CONFIG_LONG_DELAY_ISSUE ++ ODM_sleep_ms(50); ++ #else ++ ODM_delay_ms(50); ++ #endif ++ else if (Addr == 0xfd) ++ ODM_delay_ms(5); ++ else if (Addr == 0xfc) ++ ODM_delay_ms(1); ++ else if (Addr == 0xfb) ++ ODM_delay_us(50); ++ else if (Addr == 0xfa) ++ ODM_delay_us(5); ++ else if (Addr == 0xf9) ++ ODM_delay_us(1); ++ else ++ { ++ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); ++ } ++ ++ // Add 1us delay between BB/RF register setting. ++ ODM_delay_us(1); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X\n", Addr, Data)); ++} ++ ++void ++odm_ConfigBB_TXPWR_LMT_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN pu1Byte Regulation, ++ IN pu1Byte Band, ++ IN pu1Byte Bandwidth, ++ IN pu1Byte RateSection, ++ IN pu1Byte RfPath, ++ IN pu1Byte Channel, ++ IN pu1Byte PowerLimit ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) ++ PHY_SetTxPowerLimit(pDM_Odm, Regulation, Band, ++ Bandwidth, RateSection, RfPath, Channel, PowerLimit); ++#endif ++} ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.h 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,98 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_ODM_REGCONFIG_H_8723D ++#define __INC_ODM_REGCONFIG_H_8723D ++ ++#if (RTL8723D_SUPPORT == 1) ++ ++void ++odm_ConfigRFReg_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Addr, ++ IN u4Byte Data, ++ IN ODM_RF_RADIO_PATH_E RF_PATH, ++ IN u4Byte RegAddr ++ ); ++ ++void ++odm_ConfigRF_RadioA_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Addr, ++ IN u4Byte Data ++ ); ++ ++void ++odm_ConfigRF_RadioB_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Addr, ++ IN u4Byte Data ++ ); ++ ++void ++odm_ConfigMAC_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Addr, ++ IN u1Byte Data ++ ); ++ ++void ++odm_ConfigBB_AGC_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Addr, ++ IN u4Byte Bitmask, ++ IN u4Byte Data ++ ); ++ ++void ++odm_ConfigBB_PHY_REG_PG_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Band, ++ IN u4Byte RfPath, ++ IN u4Byte TxNum, ++ IN u4Byte Addr, ++ IN u4Byte Bitmask, ++ IN u4Byte Data ++ ); ++ ++void ++odm_ConfigBB_PHY_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Addr, ++ IN u4Byte Bitmask, ++ IN u4Byte Data ++ ); ++ ++void ++odm_ConfigBB_TXPWR_LMT_8723D( ++ IN PDM_ODM_T pDM_Odm, ++ IN pu1Byte Regulation, ++ IN pu1Byte Band, ++ IN pu1Byte Bandwidth, ++ IN pu1Byte RateSection, ++ IN pu1Byte RfPath, ++ IN pu1Byte Channel, ++ IN pu1Byte PowerLimit ++ ); ++ ++ ++#endif ++#endif // end of SUPPORT ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.c 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,68 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++/*============================================================ ++ include files ++============================================================*/ ++ ++#include "mp_precomp.h" ++#include "../phydm_precomp.h" ++ ++#if (RTL8723D_SUPPORT == 1) ++ ++s1Byte ++odm_CCKRSSI_8723D( ++ IN u1Byte LNA_idx, ++ IN u1Byte VGA_idx ++ ) ++{ ++ s1Byte rx_pwr_all = 0x00; ++ ++ switch (LNA_idx) { ++ ++ case 0xf: ++ rx_pwr_all = -46 - (2 * VGA_idx); ++ break; ++ case 0xa: ++ rx_pwr_all = -20 - (2 * VGA_idx); ++ break; ++ case 7: ++ rx_pwr_all = -10 - (2 * VGA_idx); ++ break; ++ case 4: ++ rx_pwr_all = 4 - (2 * VGA_idx); ++ break; ++ default: ++ break; ++ } ++ ++ return rx_pwr_all; ++ ++} ++ ++#endif ++ ++ ++ ++ ++ ++ ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.h 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,33 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __ODM_RTL8723D_H__ ++#define __ODM_RTL8723D_H__ ++ ++#if (RTL8723D_SUPPORT == 1) ++ ++s1Byte ++odm_CCKRSSI_8723D( ++ IN u1Byte LNA_idx, ++ IN u1Byte VGA_idx ++ ); ++ ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/version_rtl8723d.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/version_rtl8723d.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/version_rtl8723d.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/version_rtl8723d.h 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,5 @@ ++/*RTL8723D PHY Parameters*/ ++#define SVN_COMMIT_VERSION_8723D 22597 ++#define RELEASE_DATE_8723D 20161209 ++#define COMMIT_BY_8723D "BB_Jessica" ++#define RELEASE_VERSION_8723D 31 +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.c 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,536 @@ ++//============================================================ ++// Description: ++// ++// This file is for TXBF mechanism ++// ++//============================================================ ++#include "mp_precomp.h" ++#include "../phydm_precomp.h" ++ ++#if (BEAMFORMING_SUPPORT == 1) ++/*Beamforming halcomtxbf API create by YuChen 2015/05*/ ++ ++VOID ++halComTxbf_beamformInit( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ HalTxbf8822B_Init(pDM_Odm); ++} ++ ++/*Only used for MU BFer Entry when get GID management frame (self is as MU STA)*/ ++VOID ++halComTxbf_ConfigGtab( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ HalTxbf8822B_ConfigGtab(pDM_Odm); ++} ++ ++VOID ++phydm_beamformSetSoundingEnter( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ ++ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_EnterWorkItem)) == FALSE) ++ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_EnterWorkItem)); ++#else ++ halComTxbf_EnterWorkItemCallback(pDM_Odm); ++#endif ++} ++ ++VOID ++phydm_beamformSetSoundingLeave( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ ++ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_LeaveWorkItem)) == FALSE) ++ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_LeaveWorkItem)); ++#else ++ halComTxbf_LeaveWorkItemCallback(pDM_Odm); ++#endif ++} ++ ++VOID ++phydm_beamformSetSoundingRate( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ ++ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_RateWorkItem)) == FALSE) ++ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_RateWorkItem)); ++#else ++ halComTxbf_RateWorkItemCallback(pDM_Odm); ++#endif ++} ++ ++VOID ++phydm_beamformSetSoundingStatus( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ ++ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_StatusWorkItem)) == FALSE) ++ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_StatusWorkItem)); ++#else ++ halComTxbf_StatusWorkItemCallback(pDM_Odm); ++#endif ++} ++ ++VOID ++phydm_beamformSetSoundingFwNdpa( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ ++ if (*pDM_Odm->pbFwDwRsvdPageInProgress) ++ ODM_SetTimer(pDM_Odm, &(pTxbfInfo->Txbf_FwNdpaTimer), 5); ++ else ++ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_FwNdpaWorkItem)); ++#else ++ halComTxbf_FwNdpaWorkItemCallback(pDM_Odm); ++#endif ++} ++ ++VOID ++phydm_beamformSetSoundingClk( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ ++ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_ClkWorkItem)) == FALSE) ++ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_ClkWorkItem)); ++#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) ++ PADAPTER padapter = pDM_Odm->Adapter; ++ ++ rtw_run_in_thread_cmd(padapter, halComTxbf_ClkWorkItemCallback, padapter); ++#else ++ halComTxbf_ClkWorkItemCallback(pDM_Odm); ++#endif ++} ++ ++VOID ++phydm_beamformSetResetTxPath( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ ++ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_ResetTxPathWorkItem)) == FALSE) ++ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_ResetTxPathWorkItem)); ++#else ++ halComTxbf_ResetTxPathWorkItemCallback(pDM_Odm); ++#endif ++} ++ ++VOID ++phydm_beamformSetGetTxRate( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ ++ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_GetTxRateWorkItem)) == FALSE) ++ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_GetTxRateWorkItem)); ++#else ++ halComTxbf_GetTxRateWorkItemCallback(pDM_Odm); ++#endif ++} ++ ++VOID ++halComTxbf_EnterWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#else ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#endif ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ u1Byte Idx = pTxbfInfo->TXBFIdx; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) ++ HalTxbfJaguar_Enter(pDM_Odm, Idx); ++ else if (pDM_Odm->SupportICType & ODM_RTL8192E) ++ HalTxbf8192E_Enter(pDM_Odm, Idx); ++ else if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ HalTxbf8814A_Enter(pDM_Odm, Idx); ++ else if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ HalTxbf8822B_Enter(pDM_Odm, Idx); ++} ++ ++VOID ++halComTxbf_LeaveWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#else ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#endif ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ ++ u1Byte Idx = pTxbfInfo->TXBFIdx; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) ++ HalTxbfJaguar_Leave(pDM_Odm, Idx); ++ else if (pDM_Odm->SupportICType & ODM_RTL8192E) ++ HalTxbf8192E_Leave(pDM_Odm, Idx); ++ else if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ HalTxbf8814A_Leave(pDM_Odm, Idx); ++ else if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ HalTxbf8822B_Leave(pDM_Odm, Idx); ++} ++ ++ ++VOID ++halComTxbf_FwNdpaWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#else ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#endif ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ u1Byte Idx = pTxbfInfo->NdpaIdx; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) ++ HalTxbfJaguar_FwTxBF(pDM_Odm, Idx); ++ else if (pDM_Odm->SupportICType & ODM_RTL8192E) ++ HalTxbf8192E_FwTxBF(pDM_Odm, Idx); ++ else if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ HalTxbf8814A_FwTxBF(pDM_Odm, Idx); ++ else if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ HalTxbf8822B_FwTxBF(pDM_Odm, Idx); ++} ++ ++VOID ++halComTxbf_ClkWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#else ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8812) ++ HalTxbfJaguar_Clk_8812A(pDM_Odm); ++} ++ ++ ++ ++VOID ++halComTxbf_RateWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#else ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#endif ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ u1Byte BW = pTxbfInfo->BW; ++ u1Byte Rate = pTxbfInfo->Rate; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8812) ++ HalTxbf8812A_setNDPArate(pDM_Odm, BW, Rate); ++ else if (pDM_Odm->SupportICType & ODM_RTL8192E) ++ HalTxbf8192E_setNDPArate(pDM_Odm, BW, Rate); ++ else if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ HalTxbf8814A_setNDPArate(pDM_Odm, BW, Rate); ++ ++} ++ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++halComTxbf_FwNdpaTimerCallback( ++ IN PRT_TIMER pTimer ++ ) ++{ ++ ++ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (*pDM_Odm->pbFwDwRsvdPageInProgress) ++ ODM_SetTimer(pDM_Odm, &(pTxbfInfo->Txbf_FwNdpaTimer), 5); ++ else ++ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_FwNdpaWorkItem)); ++} ++#endif ++ ++ ++VOID ++halComTxbf_StatusWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#else ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#endif ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ ++ u1Byte Idx = pTxbfInfo->TXBFIdx; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) ++ HalTxbfJaguar_Status(pDM_Odm, Idx); ++ else if (pDM_Odm->SupportICType & ODM_RTL8192E) ++ HalTxbf8192E_Status(pDM_Odm, Idx); ++ else if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ HalTxbf8814A_Status(pDM_Odm, Idx); ++ else if (pDM_Odm->SupportICType & ODM_RTL8822B) ++ HalTxbf8822B_Status(pDM_Odm, Idx); ++} ++ ++VOID ++halComTxbf_ResetTxPathWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#else ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#endif ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ ++ u1Byte Idx = pTxbfInfo->TXBFIdx; ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ HalTxbf8814A_ResetTxPath(pDM_Odm, Idx); ++ ++} ++ ++VOID ++halComTxbf_GetTxRateWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ) ++{ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++#else ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#endif ++ ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ HalTxbf8814A_GetTxRate(pDM_Odm); ++} ++ ++ ++BOOLEAN ++HalComTxbf_Set( ++ IN PVOID pDM_VOID, ++ IN u1Byte setType, ++ IN PVOID pInBuf ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ pu1Byte pU1Tmp=(pu1Byte)pInBuf; ++ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] setType = 0x%X\n", __func__, setType)); ++ ++ switch(setType){ ++ case TXBF_SET_SOUNDING_ENTER: ++ pTxbfInfo->TXBFIdx = *pU1Tmp; ++ phydm_beamformSetSoundingEnter(pDM_Odm); ++ break; ++ ++ case TXBF_SET_SOUNDING_LEAVE: ++ pTxbfInfo->TXBFIdx = *pU1Tmp; ++ phydm_beamformSetSoundingLeave(pDM_Odm); ++ break; ++ ++ case TXBF_SET_SOUNDING_RATE: ++ pTxbfInfo->BW = pU1Tmp[0]; ++ pTxbfInfo->Rate = pU1Tmp[1]; ++ phydm_beamformSetSoundingRate(pDM_Odm); ++ break; ++ ++ case TXBF_SET_SOUNDING_STATUS: ++ pTxbfInfo->TXBFIdx = *pU1Tmp; ++ phydm_beamformSetSoundingStatus(pDM_Odm); ++ break; ++ ++ case TXBF_SET_SOUNDING_FW_NDPA: ++ pTxbfInfo->NdpaIdx = *pU1Tmp; ++ phydm_beamformSetSoundingFwNdpa(pDM_Odm); ++ break; ++ ++ case TXBF_SET_SOUNDING_CLK: ++ phydm_beamformSetSoundingClk(pDM_Odm); ++ break; ++ ++ case TXBF_SET_TX_PATH_RESET: ++ pTxbfInfo->TXBFIdx = *pU1Tmp; ++ phydm_beamformSetResetTxPath(pDM_Odm); ++ break; ++ ++ case TXBF_SET_GET_TX_RATE: ++ phydm_beamformSetGetTxRate(pDM_Odm); ++ break; ++ ++ } ++ ++ return TRUE; ++} ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++BOOLEAN ++HalComTxbf_Get( ++ IN PADAPTER Adapter, ++ IN u1Byte getType, ++ OUT PVOID pOutBuf ++ ) ++{ ++ PHAL_DATA_TYPE pHalData=GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ PBOOLEAN pBoolean=(PBOOLEAN)pOutBuf; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (getType == TXBF_GET_EXPLICIT_BEAMFORMEE) { ++ if (IS_HARDWARE_TYPE_OLDER_THAN_8812A(Adapter)) ++ *pBoolean = FALSE; ++ else if (/*IS_HARDWARE_TYPE_8822B(Adapter) ||*/ ++ IS_HARDWARE_TYPE_8821B(Adapter) || ++ IS_HARDWARE_TYPE_8192E(Adapter) || ++ IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(Adapter)) ++ *pBoolean = TRUE; ++ else ++ *pBoolean = FALSE; ++ } else if (getType == TXBF_GET_EXPLICIT_BEAMFORMER) { ++ if (IS_HARDWARE_TYPE_OLDER_THAN_8812A(Adapter)) ++ *pBoolean = FALSE; ++ else if (/*IS_HARDWARE_TYPE_8822B(Adapter) ||*/ ++ IS_HARDWARE_TYPE_8821B(Adapter) || ++ IS_HARDWARE_TYPE_8192E(Adapter) || ++ IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(Adapter)) { ++ if(pHalData->RF_Type == RF_2T2R || pHalData->RF_Type == RF_3T3R) ++ *pBoolean = TRUE; ++ else ++ *pBoolean = FALSE; ++ } else ++ *pBoolean = FALSE; ++ } else if (getType == TXBF_GET_MU_MIMO_STA) { ++#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) ++ if (IS_HARDWARE_TYPE_8822B(Adapter) || IS_HARDWARE_TYPE_8821C(Adapter)) ++ *pBoolean = TRUE; ++ else ++#endif ++ *pBoolean = FALSE; ++ ++ ++ } else if (getType == TXBF_GET_MU_MIMO_AP) { ++#if (RTL8822B_SUPPORT == 1) ++ if (IS_HARDWARE_TYPE_8822B(Adapter)) ++ *pBoolean = TRUE; ++ else ++#endif ++ *pBoolean = FALSE; ++ } ++ ++ return TRUE; ++} ++#endif ++ ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.h 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,180 @@ ++#ifndef __HAL_COM_TXBF_H__ ++#define __HAL_COM_TXBF_H__ ++ ++/* ++typedef BOOLEAN ++(*TXBF_GET)( ++ IN PVOID pAdapter, ++ IN u1Byte getType, ++ OUT PVOID pOutBuf ++ ); ++ ++typedef BOOLEAN ++(*TXBF_SET)( ++ IN PVOID pAdapter, ++ IN u1Byte setType, ++ OUT PVOID pInBuf ++ ); ++*/ ++ ++typedef enum _TXBF_SET_TYPE{ ++ TXBF_SET_SOUNDING_ENTER, ++ TXBF_SET_SOUNDING_LEAVE, ++ TXBF_SET_SOUNDING_RATE, ++ TXBF_SET_SOUNDING_STATUS, ++ TXBF_SET_SOUNDING_FW_NDPA, ++ TXBF_SET_SOUNDING_CLK, ++ TXBF_SET_TX_PATH_RESET, ++ TXBF_SET_GET_TX_RATE ++}TXBF_SET_TYPE,*PTXBF_SET_TYPE; ++ ++ ++typedef enum _TXBF_GET_TYPE{ ++ TXBF_GET_EXPLICIT_BEAMFORMEE, ++ TXBF_GET_EXPLICIT_BEAMFORMER, ++ TXBF_GET_MU_MIMO_STA, ++ TXBF_GET_MU_MIMO_AP ++}TXBF_GET_TYPE,*PTXBF_GET_TYPE; ++ ++ ++ ++//2 HAL TXBF related ++typedef struct _HAL_TXBF_INFO { ++ u1Byte TXBFIdx; ++ u1Byte NdpaIdx; ++ u1Byte BW; ++ u1Byte Rate; ++ ++ RT_TIMER Txbf_FwNdpaTimer; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ RT_WORK_ITEM Txbf_EnterWorkItem; ++ RT_WORK_ITEM Txbf_LeaveWorkItem; ++ RT_WORK_ITEM Txbf_FwNdpaWorkItem; ++ RT_WORK_ITEM Txbf_ClkWorkItem; ++ RT_WORK_ITEM Txbf_StatusWorkItem; ++ RT_WORK_ITEM Txbf_RateWorkItem; ++ RT_WORK_ITEM Txbf_ResetTxPathWorkItem; ++ RT_WORK_ITEM Txbf_GetTxRateWorkItem; ++#endif ++ ++} HAL_TXBF_INFO, *PHAL_TXBF_INFO; ++ ++#if (BEAMFORMING_SUPPORT == 1) ++ ++VOID ++halComTxbf_beamformInit( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++halComTxbf_ConfigGtab( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++halComTxbf_EnterWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ); ++ ++VOID ++halComTxbf_LeaveWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ); ++ ++VOID ++halComTxbf_FwNdpaWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ); ++ ++VOID ++halComTxbf_ClkWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ); ++ ++VOID ++halComTxbf_ResetTxPathWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ); ++ ++VOID ++halComTxbf_GetTxRateWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ); ++ ++VOID ++halComTxbf_RateWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ); ++ ++VOID ++halComTxbf_FwNdpaTimerCallback( ++ IN PRT_TIMER pTimer ++ ); ++ ++VOID ++halComTxbf_StatusWorkItemCallback( ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN PADAPTER Adapter ++#else ++ IN PVOID pDM_VOID ++#endif ++ ); ++ ++BOOLEAN ++HalComTxbf_Set( ++ IN PVOID pDM_VOID, ++ IN u1Byte setType, ++ IN PVOID pInBuf ++ ); ++ ++BOOLEAN ++HalComTxbf_Get( ++ IN PADAPTER Adapter, ++ IN u1Byte getType, ++ OUT PVOID pOutBuf ++ ); ++ ++#else ++#define halComTxbf_beamformInit(pDM_VOID) NULL ++#define halComTxbf_ConfigGtab(pDM_VOID) NULL ++#define halComTxbf_EnterWorkItemCallback(_Adapter) NULL ++#define halComTxbf_LeaveWorkItemCallback(_Adapter) NULL ++#define halComTxbf_FwNdpaWorkItemCallback(_Adapter) NULL ++#define halComTxbf_ClkWorkItemCallback(_Adapter) NULL ++#define halComTxbf_RateWorkItemCallback(_Adapter) NULL ++#define halComTxbf_FwNdpaTimerCallback(_Adapter) NULL ++#define halComTxbf_StatusWorkItemCallback(_Adapter) NULL ++#define HalComTxbf_Get(_Adapter, _getType, _pOutBuf) ++ ++#endif ++ ++#endif // #ifndef __HAL_COM_TXBF_H__ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.c 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,392 @@ ++//============================================================ ++// Description: ++// ++// This file is for 8192E TXBF mechanism ++// ++//============================================================ ++#include "mp_precomp.h" ++#include "../phydm_precomp.h" ++ ++#if (BEAMFORMING_SUPPORT == 1) ++#if (RTL8192E_SUPPORT == 1) ++ ++VOID ++HalTxbf8192E_setNDPArate( ++ IN PVOID pDM_VOID, ++ IN u1Byte BW, ++ IN u1Byte Rate ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8192E, (Rate << 2 | BW)); ++ ++} ++ ++VOID ++halTxbf8192E_RfMode( ++ IN PVOID pDM_VOID, ++ IN PRT_BEAMFORMING_INFO pBeamInfo ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ BOOLEAN bSelfBeamformer = FALSE; ++ BOOLEAN bSelfBeamformee = FALSE; ++ BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (pDM_Odm->RFType == ODM_1T1R) ++ return; ++ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); /*RF Mode table write enable*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WE_LUT, 0x80000, 0x1); /*RF Mode table write enable*/ ++ ++ if (pBeamInfo->beamformee_su_cnt > 0) { ++ /*Path_A*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode 0x30=0x18000*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0x77fc2); /*Enable TXIQGEN in RX mode*/ ++ /*Path_B*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0x77fc2); /*Enable TXIQGEN in RX mode*/ ++ } else { ++ /*Path_A*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0x77f82); /*Disable TXIQGEN in RX mode*/ ++ /*Path_B*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0x77f82); /*Disable TXIQGEN in RX mode*/ ++ } ++ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x0); /*RF Mode table write disable*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WE_LUT, 0x80000, 0x0); /*RF Mode table write disable*/ ++ ++ if (pBeamInfo->beamformee_su_cnt > 0) { ++ ODM_SetBBReg(pDM_Odm, rFPGA1_TxInfo, bMaskDWord, 0x83321333); ++ ODM_SetBBReg(pDM_Odm, rCCK0_AFESetting, bMaskByte3, 0xc1); ++ } else ++ ODM_SetBBReg(pDM_Odm, rFPGA1_TxInfo, bMaskDWord, 0x81121313); ++} ++ ++ ++ ++VOID ++halTxbf8192E_FwTxBFCmd( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte Idx, Period0 = 0, Period1 = 0; ++ u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; ++ u1Byte u1TxBFParm[3] = {0}; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ ++ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { ++ if (pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { ++ if (Idx == 0) { ++ if (pBeamInfo->BeamformeeEntry[Idx].bSound) ++ PageNum0 = 0xFE; ++ else ++ PageNum0 = 0xFF; //stop sounding ++ Period0 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); ++ } else if (Idx == 1) { ++ if (pBeamInfo->BeamformeeEntry[Idx].bSound) ++ PageNum1 = 0xFE; ++ else ++ PageNum1 = 0xFF; //stop sounding ++ Period1 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); ++ } ++ } ++ } ++ ++ u1TxBFParm[0] = PageNum0; ++ u1TxBFParm[1] = PageNum1; ++ u1TxBFParm[2] = (Period1 << 4) | Period0; ++ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_TXBF, 3, u1TxBFParm); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ++ ("[%s] PageNum0 = %d Period0 = %d, PageNum1 = %d Period1 %d\n", __func__, PageNum0, Period0, PageNum1, Period1)); ++} ++ ++ ++VOID ++halTxbf8192E_DownloadNDPA( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte u1bTmp = 0, tmpReg422 = 0, Head_Page; ++ u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; ++ BOOLEAN bSendBeacon = FALSE; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ u1Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; ++ /*default reseved 1 page for the IC type which is undefined.*/ ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ *pDM_Odm->pbFwDwRsvdPageInProgress = TRUE; ++#endif ++ if (Idx == 0) ++ Head_Page = 0xFE; ++ else ++ Head_Page = 0xFE; ++ ++ Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu1Byte)&TxPageBndy); ++ ++ /*Set REG_CR bit 8. DMA beacon by SW.*/ ++ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8192E+1); ++ ODM_Write1Byte(pDM_Odm, REG_CR_8192E+1, (u1bTmp | BIT0)); ++ ++ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ ++ tmpReg422 = ODM_Read1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8192E+2); ++ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8192E+2, tmpReg422 & (~BIT6)); ++ ++ if (tmpReg422 & BIT6) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_WARNING, ("%s There is an Adapter is sending beacon.\n", __func__)); ++ bSendBeacon = TRUE; ++ } ++ ++ /*TDECTRL[15:8] 0x209[7:0] = 0xFE/0xFD NDPA Head for TXDMA*/ ++ ODM_Write1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+1, Head_Page); ++ ++ do { ++ /*Clear beacon valid check bit.*/ ++ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2); ++ ODM_Write1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2, (BcnValidReg | BIT0)); ++ ++ // download NDPA rsvd page. ++ Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); ++ ++#if(DEV_BUS_TYPE == RT_PCI_INTERFACE) ++ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_MGQ_TXBD_NUM_8192E+3); ++ count = 0; ++ while ((count < 20) && (u1bTmp & BIT4)) { ++ count++; ++ ODM_delay_us(10); ++ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_MGQ_TXBD_NUM_8192E+3); ++ } ++ ODM_Write1Byte(pDM_Odm, REG_MGQ_TXBD_NUM_8192E+3, u1bTmp | BIT4); ++#endif ++ ++ /*check rsvd page download OK.*/ ++ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2); ++ count = 0; ++ while (!(BcnValidReg & BIT0) && count < 20) { ++ count++; ++ ODM_delay_us(10); ++ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2); ++ } ++ DLBcnCount++; ++ } while (!(BcnValidReg & BIT0) && DLBcnCount < 5); ++ ++ if (!(BcnValidReg & BIT0)) ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_WARNING, ("%s Download RSVD page failed!\n", __func__)); ++ ++ /*TDECTRL[15:8] 0x209[7:0] = 0xF9 Beacon Head for TXDMA*/ ++ ODM_Write1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+1, TxPageBndy); ++ ++ /*To make sure that if there exists an adapter which would like to send beacon.*/ ++ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ ++ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause*/ ++ /*the beacon cannot be sent by HW.*/ ++ /*2010.06.23. Added by tynli.*/ ++ if (bSendBeacon) ++ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8192E+2, tmpReg422); ++ ++ /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ ++ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ ++ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8192E+1); ++ ODM_Write1Byte(pDM_Odm, REG_CR_8192E+1, (u1bTmp & (~BIT0))); ++ ++ pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ *pDM_Odm->pbFwDwRsvdPageInProgress = FALSE; ++#endif ++} ++ ++ ++VOID ++HalTxbf8192E_Enter( ++ IN PVOID pDM_VOID, ++ IN u1Byte BFerBFeeIdx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i = 0; ++ u1Byte BFerIdx = (BFerBFeeIdx & 0xF0) >> 4; ++ u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); ++ u4Byte CSI_Param; ++ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; ++ RT_BEAMFORMEE_ENTRY BeamformeeEntry; ++ RT_BEAMFORMER_ENTRY BeamformerEntry; ++ u2Byte STAid = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ halTxbf8192E_RfMode(pDM_Odm, pBeamformingInfo); ++ ++ if (pDM_Odm->RFType == ODM_2T2R) ++ ODM_Write4Byte(pDM_Odm, 0xd80, 0x00000000); /*Nc =2*/ ++ ++ if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { ++ BeamformerEntry = pBeamformingInfo->BeamformerEntry[BFerIdx]; ++ ++ /*Sounding protocol control*/ ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8192E, 0xCB); ++ ++ /*MAC address/Partial AID of Beamformer*/ ++ if (BFerIdx == 0) { ++ for (i = 0; i < 6 ; i++) ++ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8192E+i), BeamformerEntry.MacAddr[i]); ++ } else { ++ for (i = 0; i < 6 ; i++) ++ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER1_INFO_8192E+i), BeamformerEntry.MacAddr[i]); ++ } ++ ++ /*CSI report parameters of Beamformer Default use Nc = 2*/ ++ CSI_Param = 0x03090309; ++ ++ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8192E, CSI_Param); ++ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8192E, CSI_Param); ++ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8192E, CSI_Param); ++ ++ /*Timeout value for MAC to leave NDP_RX_standby_state (60 us, Test chip) (80 us, MP chip)*/ ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8192E+3, 0x50); ++ ++ } ++ ++ if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { ++ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[BFeeIdx]; ++ ++ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) ++ STAid = BeamformeeEntry.MacId; ++ else ++ STAid = BeamformeeEntry.P_AID; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s], STAid=0x%X\n", __func__, STAid)); ++ ++ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ ++ if (BFeeIdx == 0) { ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E, STAid); ++ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8192E+3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8192E+3) | BIT4 | BIT6 | BIT7); ++ } else ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E+2, STAid | BIT12 | BIT14 | BIT15); ++ ++ /*CSI report parameters of Beamformee*/ ++ if (BFeeIdx == 0) { ++ /*Get BIT24 & BIT25*/ ++ u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+3) & 0x3; ++ ++ ODM_Write1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+3, tmp | 0x60); ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E, STAid | BIT9); ++ } else { ++ /*Set BIT25*/ ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2, STAid | 0xE200); ++ } ++ phydm_Beamforming_Notify(pDM_Odm); ++ ++ } ++} ++ ++ ++VOID ++HalTxbf8192E_Leave( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ ++ halTxbf8192E_RfMode(pDM_Odm, pBeamInfo); ++ ++ /* Clear P_AID of Beamformee ++ * Clear MAC addresss of Beamformer ++ * Clear Associated Bfmee Sel ++ */ ++ if (pBeamInfo->BeamformCap == BEAMFORMING_CAP_NONE) ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8192E, 0xC8); ++ ++ if (Idx == 0) { ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E, 0); ++ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8192E, 0); ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8192E+4, 0); ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E, 0); ++ } else { ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E+2, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8192E+2) & 0xF000); ++ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8192E, 0); ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8192E+4, 0); ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2, ODM_Read2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2) & 0x60); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Idx %d\n", __func__, Idx)); ++} ++ ++ ++VOID ++HalTxbf8192E_Status( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u2Byte BeamCtrlVal; ++ u4Byte BeamCtrlReg; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ RT_BEAMFORMEE_ENTRY BeamformEntry = pBeamInfo->BeamformeeEntry[Idx]; ++ ++ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) ++ BeamCtrlVal = BeamformEntry.MacId; ++ else ++ BeamCtrlVal = BeamformEntry.P_AID; ++ ++ if (Idx == 0) ++ BeamCtrlReg = REG_TXBF_CTRL_8192E; ++ else { ++ BeamCtrlReg = REG_TXBF_CTRL_8192E+2; ++ BeamCtrlVal |= BIT12 | BIT14 | BIT15; ++ } ++ ++ if ((BeamformEntry.BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) && (pBeamInfo->applyVmatrix == TRUE)) { ++ if (BeamformEntry.SoundBW == CHANNEL_WIDTH_20) ++ BeamCtrlVal |= BIT9; ++ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_40) ++ BeamCtrlVal |= BIT10; ++ } else ++ BeamCtrlVal &= ~(BIT9 | BIT10 | BIT11); ++ ++ ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Idx %d BeamCtrlReg %x BeamCtrlVal %x\n", __func__, Idx, BeamCtrlReg, BeamCtrlVal)); ++} ++ ++ ++VOID ++HalTxbf8192E_FwTxBF( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) ++ halTxbf8192E_DownloadNDPA(pDM_Odm, Idx); ++ ++ halTxbf8192E_FwTxBFCmd(pDM_Odm); ++} ++ ++#endif /* #if (RTL8192E_SUPPORT == 1)*/ ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.h 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,61 @@ ++#ifndef __HAL_TXBF_8192E_H__ ++#define __HAL_TXBF_8192E_H__ ++ ++#if (RTL8192E_SUPPORT == 1) ++#if (BEAMFORMING_SUPPORT == 1) ++ ++VOID ++HalTxbf8192E_setNDPArate( ++ IN PVOID pDM_VOID, ++ IN u1Byte BW, ++ IN u1Byte Rate ++); ++ ++VOID ++HalTxbf8192E_Enter( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++ ++VOID ++HalTxbf8192E_Leave( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++ ++VOID ++HalTxbf8192E_Status( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++ ++VOID ++HalTxbf8192E_FwTxBF( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++#else ++ ++#define HalTxbf8192E_setNDPArate(pDM_VOID, BW, Rate) ++#define HalTxbf8192E_Enter(pDM_VOID, Idx) ++#define HalTxbf8192E_Leave(pDM_VOID, Idx) ++#define HalTxbf8192E_Status(pDM_VOID, Idx) ++#define HalTxbf8192E_FwTxBF(pDM_VOID, Idx) ++ ++#endif ++ ++#else ++ ++#define HalTxbf8192E_setNDPArate(pDM_VOID, BW, Rate) ++#define HalTxbf8192E_Enter(pDM_VOID, Idx) ++#define HalTxbf8192E_Leave(pDM_VOID, Idx) ++#define HalTxbf8192E_Status(pDM_VOID, Idx) ++#define HalTxbf8192E_FwTxBF(pDM_VOID, Idx) ++ ++#endif ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.c 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,677 @@ ++//============================================================ ++// Description: ++// ++// This file is for 8814A TXBF mechanism ++// ++//============================================================ ++ ++#include "mp_precomp.h" ++#include "../phydm_precomp.h" ++ ++#if (BEAMFORMING_SUPPORT == 1) ++#if (RTL8814A_SUPPORT == 1) ++ ++VOID ++HalTxbf8814A_setNDPArate( ++ IN PVOID pDM_VOID, ++ IN u1Byte BW, ++ IN u1Byte Rate ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8814A, BW); ++ ODM_Write1Byte(pDM_Odm, REG_NDPA_RATE_8814A, (u1Byte) Rate); ++ ++} ++ ++#define PHYDM_MEMORY_MAP_BUF_READ 0x8000 ++#define PHYDM_CTRL_INFO_PAGE 0x660 ++ ++VOID ++phydm_DataRate_8814A( ++ IN PDM_ODM_T pDM_Odm, ++ IN u1Byte macId, ++ OUT pu4Byte data, ++ IN u1Byte dataLen ++ ) ++{ ++ u1Byte i = 0; ++ u2Byte XReadDataAddr = 0; ++ ++ ODM_Write2Byte(pDM_Odm, REG_PKTBUF_DBG_CTRL_8814A, PHYDM_CTRL_INFO_PAGE); ++ XReadDataAddr = PHYDM_MEMORY_MAP_BUF_READ + macId*32; /*Ctrl Info: 32Bytes for each macid(n)*/ ++ ++ if ((XReadDataAddr < PHYDM_MEMORY_MAP_BUF_READ) || (XReadDataAddr > 0x8FFF)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("XReadDataAddr(0x%x) is not correct!\n", XReadDataAddr)); ++ return; ++ } ++ ++ /* Read data */ ++ for (i = 0; i < dataLen; i++) ++ *(data+i) = ODM_Read2Byte(pDM_Odm, XReadDataAddr+i); ++ ++} ++ ++VOID ++HalTxbf8814A_GetTxRate( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMEE_ENTRY pEntry; ++ u4Byte TxRptData = 0; ++ u1Byte DataRate = 0xFF; ++ ++ pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); ++ ++ phydm_DataRate_8814A(pDM_Odm, (u1Byte)pEntry->MacId, &TxRptData, 1); ++ DataRate = (u1Byte)TxRptData; ++ DataRate &= bMask7bits; /*Bit7 indicates SGI*/ ++ ++ pDM_Odm->TxBfDataRate = DataRate; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] pDM_Odm->TxBfDataRate = 0x%x\n", __func__, pDM_Odm->TxBfDataRate)); ++} ++ ++VOID ++HalTxbf8814A_ResetTxPath( ++ IN PVOID pDM_VOID, ++ IN u1Byte idx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++#if DEV_BUS_TYPE == RT_USB_INTERFACE ++ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; ++ RT_BEAMFORMEE_ENTRY BeamformeeEntry; ++ u1Byte Nr_index = 0, txSS = 0; ++ ++ if (idx < BEAMFORMEE_ENTRY_NUM) ++ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[idx]; ++ else ++ return; ++ ++ if ((pDM_Odm->LastUSBHub) != (*pDM_Odm->HubUsbMode)) { ++ Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), BeamformeeEntry.CompSteeringNumofBFer); ++ ++ if (*pDM_Odm->HubUsbMode == 2) { ++ if (pDM_Odm->RFType == ODM_4T4R) ++ txSS = 0xf; ++ else if (pDM_Odm->RFType == ODM_3T3R) ++ txSS = 0xe; ++ else ++ txSS = 0x6; ++ } else if (*pDM_Odm->HubUsbMode == 1) /*USB 2.0 always 2Tx*/ ++ txSS = 0x6; ++ else ++ txSS = 0x6; ++ ++ if (txSS == 0xf) { ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x93f); ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskDWord, 0x93f93f0); ++ } else if (txSS == 0xe) { ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x93e); ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskDWord, 0x93e93e0); ++ } else if (txSS == 0x6) { ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x936); ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskLWord, 0x9360); ++ } ++ ++ if (idx == 0) { ++ switch (Nr_index) { ++ case 0: ++ break; ++ ++ case 1: /*Nsts = 2 BC*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ ++ break; ++ ++ case 2: /*Nsts = 3 BCD*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ ++ break; ++ ++ default: /*Nr>3, same as Case 3*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ ++ break; ++ } ++ } else { ++ switch (Nr_index) { ++ case 0: ++ break; ++ ++ case 1: /*Nsts = 2 BC*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ ++ break; ++ ++ case 2: /*Nsts = 3 BCD*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ ++ break; ++ ++ default: /*Nr>3, same as Case 3*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ ++ break; ++ } ++ } ++ ++ pDM_Odm->LastUSBHub = *pDM_Odm->HubUsbMode; ++ } else ++ return; ++#endif ++} ++ ++ ++u1Byte ++halTxbf8814A_GetNtx( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte Ntx = 0, txSS = 3; ++ ++#if DEV_BUS_TYPE == RT_USB_INTERFACE ++ txSS = *pDM_Odm->HubUsbMode; ++#endif ++ if (txSS == 3 || txSS == 2) { ++ if (pDM_Odm->RFType == ODM_4T4R) ++ Ntx = 3; ++ else if (pDM_Odm->RFType == ODM_3T3R) ++ Ntx = 2; ++ else ++ Ntx = 1; ++ } else if (txSS == 1) /*USB 2.0 always 2Tx*/ ++ Ntx = 1; ++ else ++ Ntx = 1; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Ntx = %d\n", __func__, Ntx)); ++ return Ntx; ++} ++ ++u1Byte ++halTxbf8814A_GetNrx( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte Nrx = 0; ++ ++ if (pDM_Odm->RFType == ODM_4T4R) ++ Nrx = 3; ++ else if (pDM_Odm->RFType == ODM_3T3R) ++ Nrx = 2; ++ else if (pDM_Odm->RFType == ODM_2T2R) ++ Nrx = 1; ++ else if (pDM_Odm->RFType == ODM_2T3R) ++ Nrx = 2; ++ else if (pDM_Odm->RFType == ODM_2T4R) ++ Nrx = 3; ++ else if (pDM_Odm->RFType == ODM_1T1R) ++ Nrx = 0; ++ else if (pDM_Odm->RFType == ODM_1T2R) ++ Nrx = 1; ++ else ++ Nrx = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Nrx = %d\n", __func__, Nrx)); ++ return Nrx; ++} ++ ++VOID ++halTxbf8814A_RfMode( ++ IN PVOID pDM_VOID, ++ IN PRT_BEAMFORMING_INFO pBeamformingInfo, ++ IN u1Byte idx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i, Nr_index = 0; ++ u1Byte txSS = 3; /*default use 3 Tx*/ ++ RT_BEAMFORMEE_ENTRY BeamformeeEntry; ++ ++ if (idx < BEAMFORMEE_ENTRY_NUM) ++ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[idx]; ++ else ++ return; ++ ++ Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), BeamformeeEntry.CompSteeringNumofBFer); ++ ++ if (pDM_Odm->RFType == ODM_1T1R) ++ return; ++ ++ for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) { ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_WeLut_Jaguar, 0x80000, 0x1); ++ /*RF Mode table write enable*/ ++ } ++ ++ if (pBeamformingInfo->beamformee_su_cnt > 0) { ++ for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) { ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableAddr, 0xfffff, 0x18000); ++ /*Select RX mode*/ ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableData0, 0xfffff, 0xBE77F); ++ /*Set Table data*/ ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableData1, 0xfffff, 0x226BF); ++ /*Enable TXIQGEN in RX mode*/ ++ } ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF); ++ /*Enable TXIQGEN in RX mode*/ ++ } ++ ++ for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) { ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_WeLut_Jaguar, 0x80000, 0x0); ++ /*RF Mode table write disable*/ ++ } ++ ++ if (pBeamformingInfo->beamformee_su_cnt > 0) { ++#if DEV_BUS_TYPE == RT_USB_INTERFACE ++ pDM_Odm->LastUSBHub = *pDM_Odm->HubUsbMode; ++ txSS = *pDM_Odm->HubUsbMode; ++#endif ++ if (txSS == 3 || txSS == 2) { ++ if (pDM_Odm->RFType == ODM_4T4R) ++ txSS = 0xf; ++ else if (pDM_Odm->RFType == ODM_3T3R) ++ txSS = 0xe; ++ else ++ txSS = 0x6; ++ } else if (txSS == 1) /*USB 2.0 always 2Tx*/ ++ txSS = 0x6; ++ else ++ txSS = 0x6; ++ ++ if (txSS == 0xf) { ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x93f); ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskDWord, 0x93f93f0); ++ } else if (txSS == 0xe) { ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x93e); ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskDWord, 0x93e93e0); ++ } else if (txSS == 0x6) { ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x936); ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskLWord, 0x9360); ++ } ++ ++ /*for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, BIT28 | BIT29, 0x2); /*enable BB TxBF ant mapping register*/ ++ ++ if (idx == 0) { ++ switch (Nr_index) { ++ case 0: ++ break; ++ ++ case 1: /*Nsts = 2 BC*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ ++ break; ++ ++ case 2: /*Nsts = 3 BCD*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ ++ break; ++ ++ default: /*Nr>3, same as Case 3*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ ++ ++ break; ++ } ++ } else { ++ switch (Nr_index) { ++ case 0: ++ break; ++ ++ case 1: /*Nsts = 2 BC*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ ++ break; ++ ++ case 2: /*Nsts = 3 BCD*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ ++ break; ++ ++ default: /*Nr>3, same as Case 3*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ ++ break; ++ } ++ } ++ } ++ ++ if ((pBeamformingInfo->beamformee_su_cnt == 0) && (pBeamformingInfo->beamformer_su_cnt == 0)) { ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x932); /*set TxPath selection for 8814a BFer bug refine*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskDWord, 0x93e9360); ++ } ++} ++#if 0 ++VOID ++halTxbf8814A_DownloadNDPA( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte u1bTmp = 0, tmpReg422 = 0; ++ u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; ++ u2Byte Head_Page = 0x7FE; ++ BOOLEAN bSendBeacon = FALSE; ++ u2Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8814A; /*default reseved 1 page for the IC type which is undefined.*/ ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ *pDM_Odm->pbFwDwRsvdPageInProgress = TRUE; ++#endif ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu2Byte)&TxPageBndy); ++ ++ /*Set REG_CR bit 8. DMA beacon by SW.*/ ++ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8814A + 1); ++ ODM_Write1Byte(pDM_Odm, REG_CR_8814A + 1, (u1bTmp | BIT0)); ++ ++ ++ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ ++ tmpReg422 = ODM_Read1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8814A + 2); ++ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8814A + 2, tmpReg422 & (~BIT6)); ++ ++ if (tmpReg422 & BIT6) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: There is an Adapter is sending beacon.\n", __func__)); ++ bSendBeacon = TRUE; ++ } ++ ++ /*0x204[11:0] Beacon Head for TXDMA*/ ++ ODM_Write2Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A, Head_Page); ++ ++ do { ++ /*Clear beacon valid check bit.*/ ++ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A + 1); ++ ODM_Write1Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A + 1, (BcnValidReg | BIT7)); ++ ++ /*download NDPA rsvd page.*/ ++ if (pBeamEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) ++ Beamforming_SendVHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->AID, pBeamEntry->SoundBW, BEACON_QUEUE); ++ else ++ Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); ++ ++ /*check rsvd page download OK.*/ ++ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A + 1); ++ count = 0; ++ while (!(BcnValidReg & BIT7) && count < 20) { ++ count++; ++ ODM_delay_ms(10); ++ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A + 2); ++ } ++ DLBcnCount++; ++ } while (!(BcnValidReg & BIT7) && DLBcnCount < 5); ++ ++ if (!(BcnValidReg & BIT7)) ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Download RSVD page failed!\n", __func__)); ++ ++ /*0x204[11:0] Beacon Head for TXDMA*/ ++ ODM_Write2Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A, TxPageBndy); ++ ++ /*To make sure that if there exists an adapter which would like to send beacon.*/ ++ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ ++ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ ++ /*the beacon cannot be sent by HW.*/ ++ /*2010.06.23. Added by tynli.*/ ++ if (bSendBeacon) ++ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8814A + 2, tmpReg422); ++ ++ /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ ++ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ ++ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8814A + 1); ++ ODM_Write1Byte(pDM_Odm, REG_CR_8814A + 1, (u1bTmp & (~BIT0))); ++ ++ pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ *pDM_Odm->pbFwDwRsvdPageInProgress = FALSE; ++#endif ++} ++ ++VOID ++halTxbf8814A_FwTxBFCmd( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte Idx, Period = 0; ++ u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; ++ u1Byte u1TxBFParm[3] = {0}; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ ++ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { ++ if (pBeamInfo->BeamformeeEntry[Idx].bUsed && pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { ++ if (pBeamInfo->BeamformeeEntry[Idx].bSound) { ++ PageNum0 = 0xFE; ++ PageNum1 = 0x07; ++ Period = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); ++ } else if (PageNum0 == 0xFF) { ++ PageNum0 = 0xFF; /*stop sounding*/ ++ PageNum1 = 0x0F; ++ } ++ } ++ } ++ ++ u1TxBFParm[0] = PageNum0; ++ u1TxBFParm[1] = PageNum1; ++ u1TxBFParm[2] = Period; ++ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_TXBF, 3, u1TxBFParm); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ++ ("[%s] PageNum0 = %d, PageNum1 = %d Period = %d\n", __func__, PageNum0, PageNum1, Period)); ++} ++#endif ++VOID ++HalTxbf8814A_Enter( ++ IN PVOID pDM_VOID, ++ IN u1Byte BFerBFeeIdx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i = 0; ++ u1Byte BFerIdx = (BFerBFeeIdx & 0xF0) >> 4; ++ u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); ++ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; ++ RT_BEAMFORMEE_ENTRY BeamformeeEntry; ++ RT_BEAMFORMER_ENTRY BeamformerEntry; ++ u2Byte STAid = 0, CSI_Param = 0; ++ u1Byte Nc_index = 0, Nr_index = 0, grouping = 0, codebookinfo = 0, coefficientsize = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BFerIdx=%d, BFeeIdx=%d\n", __func__, BFerIdx, BFeeIdx)); ++ ODM_SetMACReg(pDM_Odm, REG_SND_PTCL_CTRL_8814A, bMaskByte1 | bMaskByte2, 0x0202); ++ ++ if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { ++ BeamformerEntry = pBeamformingInfo->BeamformerEntry[BFerIdx]; ++ /*Sounding protocol control*/ ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8814A, 0xDB); ++ ++ /*MAC address/Partial AID of Beamformer*/ ++ if (BFerIdx == 0) { ++ for (i = 0; i < 6 ; i++) ++ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8814A + i), BeamformerEntry.MacAddr[i]); ++ } else { ++ for (i = 0; i < 6 ; i++) ++ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER1_INFO_8814A + i), BeamformerEntry.MacAddr[i]); ++ } ++ ++ /*CSI report parameters of Beamformer*/ ++ Nc_index = halTxbf8814A_GetNrx(pDM_Odm); /*for 8814A Nrx = 3(4 Ant), min=0(1 Ant)*/ ++ Nr_index = BeamformerEntry.NumofSoundingDim; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so Nr_index don't care*/ ++ ++ grouping = 0; ++ ++ /*for ac = 1, for n = 3*/ ++ if (BeamformerEntry.BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU) ++ codebookinfo = 1; ++ else if (BeamformerEntry.BeamformEntryCap & BEAMFORMEE_CAP_HT_EXPLICIT) ++ codebookinfo = 3; ++ ++ coefficientsize = 3; ++ ++ CSI_Param = (u2Byte)((coefficientsize << 10) | (codebookinfo << 8) | (grouping << 6) | (Nr_index << 3) | (Nc_index)); ++ ++ if (BFerIdx == 0) ++ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A, CSI_Param); ++ else ++ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A + 2, CSI_Param); ++ /*ndp_rx_standby_timer, 8814 need > 0x56, suggest from Dvaid*/ ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8814A + 3, 0x40); ++ ++ } ++ ++ if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { ++ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[BFeeIdx]; ++ ++ halTxbf8814A_RfMode(pDM_Odm, pBeamformingInfo, BFeeIdx); ++ ++ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) ++ STAid = BeamformeeEntry.MacId; ++ else ++ STAid = BeamformeeEntry.P_AID; ++ ++ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ ++ if (BFeeIdx == 0) { ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A, STAid); ++ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3) | BIT4 | BIT6 | BIT7); ++ } else ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 2, STAid | BIT14 | BIT15 | BIT12); ++ ++ /*CSI report parameters of Beamformee*/ ++ if (BFeeIdx == 0) { ++ /*Get BIT24 & BIT25*/ ++ u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3) & 0x3; ++ ++ ODM_Write1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3, tmp | 0x60); ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A, STAid | BIT9); ++ } else ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, STAid | 0xE200); /*Set BIT25*/ ++ ++ phydm_Beamforming_Notify(pDM_Odm); ++ } ++ ++} ++ ++ ++VOID ++HalTxbf8814A_Leave( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; ++ RT_BEAMFORMER_ENTRY BeamformerEntry; ++ RT_BEAMFORMEE_ENTRY BeamformeeEntry; ++ ++ if (Idx < BEAMFORMER_ENTRY_NUM) { ++ BeamformerEntry = pBeamformingInfo->BeamformerEntry[Idx]; ++ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[Idx]; ++ } else ++ return; ++ ++ /*Clear P_AID of Beamformee*/ ++ /*Clear MAC address of Beamformer*/ ++ /*Clear Associated Bfmee Sel*/ ++ ++ if (BeamformerEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8814A, 0xD8); ++ if (Idx == 0) { ++ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8814A, 0); ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8814A + 4, 0); ++ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A, 0); ++ } else { ++ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8814A, 0); ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8814A + 4, 0); ++ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A + 2, 0); ++ } ++ } ++ ++ if (BeamformeeEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { ++ halTxbf8814A_RfMode(pDM_Odm, pBeamformingInfo, Idx); ++ if (Idx == 0) { ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A, 0x0); ++ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3) | BIT4 | BIT6 | BIT7); ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A, 0); ++ } else { ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 2, 0x0 | BIT14 | BIT15 | BIT12); ++ ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, ODM_Read2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2) & 0x60); ++ } ++ } ++} ++ ++VOID ++HalTxbf8814A_Status( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u2Byte BeamCtrlVal, tmpVal; ++ u4Byte BeamCtrlReg; ++ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; ++ RT_BEAMFORMEE_ENTRY BeamformEntry; ++ ++ if (Idx < BEAMFORMEE_ENTRY_NUM) ++ BeamformEntry = pBeamformingInfo->BeamformeeEntry[Idx]; ++ else ++ return; ++ ++ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) ++ BeamCtrlVal = BeamformEntry.MacId; ++ else ++ BeamCtrlVal = BeamformEntry.P_AID; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, BeamformEntry.BeamformEntryState = %d", __func__, BeamformEntry.BeamformEntryState)); ++ ++ if (Idx == 0) ++ BeamCtrlReg = REG_TXBF_CTRL_8814A; ++ else { ++ BeamCtrlReg = REG_TXBF_CTRL_8814A + 2; ++ BeamCtrlVal |= BIT12 | BIT14 | BIT15; ++ } ++ ++ if ((BeamformEntry.BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) && (pBeamformingInfo->applyVmatrix == TRUE)) { ++ if (BeamformEntry.SoundBW == CHANNEL_WIDTH_20) ++ BeamCtrlVal |= BIT9; ++ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_40) ++ BeamCtrlVal |= (BIT9 | BIT10); ++ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_80) ++ BeamCtrlVal |= (BIT9 | BIT10 | BIT11); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, Don't apply Vmatrix", __func__)); ++ BeamCtrlVal &= ~(BIT9 | BIT10 | BIT11); ++ } ++ ++ ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); ++ /*disable NDP packet use beamforming */ ++ tmpVal = ODM_Read2Byte(pDM_Odm, REG_TXBF_CTRL_8814A); ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A, tmpVal | BIT15); ++ ++} ++ ++ ++ ++ ++ ++VOID ++HalTxbf8814A_FwTxBF( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++) ++{ ++#if 0 ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) ++ halTxbf8814A_DownloadNDPA(pDM_Odm, Idx); ++ ++ halTxbf8814A_FwTxBFCmd(pDM_Odm); ++#endif ++} ++ ++#endif /* (RTL8814A_SUPPORT == 1)*/ ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.h 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,83 @@ ++#ifndef __HAL_TXBF_8814A_H__ ++#define __HAL_TXBF_8814A_H__ ++ ++#if (RTL8814A_SUPPORT == 1) ++#if (BEAMFORMING_SUPPORT == 1) ++ ++VOID ++HalTxbf8814A_setNDPArate( ++ IN PVOID pDM_VOID, ++ IN u1Byte BW, ++ IN u1Byte Rate ++); ++ ++u1Byte ++halTxbf8814A_GetNtx( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++HalTxbf8814A_Enter( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++ ++VOID ++HalTxbf8814A_Leave( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++ ++VOID ++HalTxbf8814A_Status( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++VOID ++HalTxbf8814A_ResetTxPath( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++ ++VOID ++HalTxbf8814A_GetTxRate( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++HalTxbf8814A_FwTxBF( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++#else ++ ++#define HalTxbf8814A_setNDPArate(pDM_VOID, BW, Rate) ++#define halTxbf8814A_GetNtx(pDM_VOID) 0 ++#define HalTxbf8814A_Enter(pDM_VOID, Idx) ++#define HalTxbf8814A_Leave(pDM_VOID, Idx) ++#define HalTxbf8814A_Status(pDM_VOID, Idx) ++#define HalTxbf8814A_ResetTxPath(pDM_VOID, Idx) ++#define HalTxbf8814A_GetTxRate(pDM_VOID) ++#define HalTxbf8814A_FwTxBF(pDM_VOID, Idx) ++ ++#endif ++ ++#else ++ ++#define HalTxbf8814A_setNDPArate(pDM_VOID, BW, Rate) ++#define halTxbf8814A_GetNtx(pDM_VOID) 0 ++#define HalTxbf8814A_Enter(pDM_VOID, Idx) ++#define HalTxbf8814A_Leave(pDM_VOID, Idx) ++#define HalTxbf8814A_Status(pDM_VOID, Idx) ++#define HalTxbf8814A_ResetTxPath(pDM_VOID, Idx) ++#define HalTxbf8814A_GetTxRate(pDM_VOID) ++#define HalTxbf8814A_FwTxBF(pDM_VOID, Idx) ++#endif ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.c 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,1098 @@ ++/*============================================================*/ ++/* Description: */ ++/* */ ++/* This file is for 8814A TXBF mechanism */ ++/* */ ++/*============================================================*/ ++ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++#if (RTL8822B_SUPPORT == 1) ++#if (BEAMFORMING_SUPPORT == 1) ++ ++u1Byte ++halTxbf8822B_GetNtx( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte Ntx = 0; ++ ++#if DEV_BUS_TYPE == RT_USB_INTERFACE ++ if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { ++ if (*pDM_Odm->HubUsbMode == 2) {/*USB3.0*/ ++ if (pDM_Odm->RFType == ODM_4T4R) ++ Ntx = 3; ++ else if (pDM_Odm->RFType == ODM_3T3R) ++ Ntx = 2; ++ else ++ Ntx = 1; ++ } else if (*pDM_Odm->HubUsbMode == 1) /*USB 2.0 always 2Tx*/ ++ Ntx = 1; ++ else ++ Ntx = 1; ++ } else ++#endif ++ { ++ if (pDM_Odm->RFType == ODM_4T4R) ++ Ntx = 3; ++ else if (pDM_Odm->RFType == ODM_3T3R) ++ Ntx = 2; ++ else ++ Ntx = 1; ++ } ++ ++ return Ntx; ++ ++} ++ ++u1Byte ++halTxbf8822B_GetNrx( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte Nrx = 0; ++ ++ if (pDM_Odm->RFType == ODM_4T4R) ++ Nrx = 3; ++ else if (pDM_Odm->RFType == ODM_3T3R) ++ Nrx = 2; ++ else if (pDM_Odm->RFType == ODM_2T2R) ++ Nrx = 1; ++ else if (pDM_Odm->RFType == ODM_2T3R) ++ Nrx = 2; ++ else if (pDM_Odm->RFType == ODM_2T4R) ++ Nrx = 3; ++ else if (pDM_Odm->RFType == ODM_1T1R) ++ Nrx = 0; ++ else if (pDM_Odm->RFType == ODM_1T2R) ++ Nrx = 1; ++ else ++ Nrx = 0; ++ ++ return Nrx; ++ ++} ++ ++/***************SU & MU BFee Entry********************/ ++VOID ++halTxbf8822B_RfMode( ++ IN PVOID pDM_VOID, ++ IN PRT_BEAMFORMING_INFO pBeamformingInfo, ++ IN u1Byte idx ++ ) ++{ ++#if 0 ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i, Nr_index = 0; ++ BOOLEAN bSelfBeamformer = FALSE; ++ BOOLEAN bSelfBeamformee = FALSE; ++ RT_BEAMFORMEE_ENTRY BeamformeeEntry; ++ ++ if (idx < BEAMFORMEE_ENTRY_NUM) ++ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[idx]; ++ else ++ return; ++ ++ if (pDM_Odm->RFType == ODM_1T1R) ++ return; ++ ++ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_WeLut_Jaguar, 0x80000, 0x1); ++ /*RF Mode table write enable*/ ++ } ++ ++ if ((pBeamformingInfo->beamformee_su_cnt > 0) || (pBeamformingInfo->beamformee_mu_cnt > 0)) { ++ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableAddr, 0xfffff, 0x18000); ++ /*Select RX mode*/ ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableData0, 0xfffff, 0xBE77F); ++ /*Set Table data*/ ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableData1, 0xfffff, 0x226BF); ++ /*Enable TXIQGEN in RX mode*/ ++ } ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF); ++ /*Enable TXIQGEN in RX mode*/ ++ } ++ ++ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_WeLut_Jaguar, 0x80000, 0x0); ++ /*RF Mode table write disable*/ ++ } ++ ++ if (pBeamformingInfo->beamformee_su_cnt > 0) { ++ ++ /*for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT28|BIT29, 0x2); /*enable BB TxBF ant mapping register*/ ++ ++ if (idx == 0) { ++ /*Nsts = 2 AB*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8822B, 0xffff, 0x0433); ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); ++ /*ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x430);*/ ++ ++ } else {/*IDX =1*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); ++ /*ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x430;*/ ++ } ++ } else { ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*1SS by path-A*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8822B, bMaskLWord, 0x430); /*2SS by path-A,B*/ ++ } ++ ++ if (pBeamformingInfo->beamformee_mu_cnt > 0) { ++ /*MU STAs share the common setting*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT31, 1); ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); ++ } ++#endif ++} ++#if 0 ++VOID ++halTxbf8822B_DownloadNDPA( ++ IN PADAPTER Adapter, ++ IN u1Byte Idx ++ ) ++{ ++ u1Byte u1bTmp = 0, tmpReg422 = 0; ++ u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; ++ u2Byte Head_Page = 0x7FE; ++ BOOLEAN bSendBeacon = FALSE; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u2Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8814A; /*default reseved 1 page for the IC type which is undefined.*/ ++ PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); ++ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry+Idx; ++ ++ pHalData->bFwDwRsvdPageInProgress = TRUE; ++ Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu2Byte)&TxPageBndy); ++ ++ /*Set REG_CR bit 8. DMA beacon by SW.*/ ++ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR_8814A+1); ++ PlatformEFIOWrite1Byte(Adapter, REG_CR_8814A+1, (u1bTmp|BIT0)); ++ ++ ++ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ ++ tmpReg422 = PlatformEFIORead1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A+2); ++ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A+2, tmpReg422&(~BIT6)); ++ ++ if (tmpReg422 & BIT6) { ++ RT_TRACE(COMP_INIT, DBG_LOUD, ("SetBeamformDownloadNDPA_8814A(): There is an Adapter is sending beacon.\n")); ++ bSendBeacon = TRUE; ++ } ++ ++ /*0x204[11:0] Beacon Head for TXDMA*/ ++ PlatformEFIOWrite2Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A, Head_Page); ++ ++ do { ++ /*Clear beacon valid check bit.*/ ++ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A+1); ++ PlatformEFIOWrite1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A+1, (BcnValidReg|BIT7)); ++ ++ /*download NDPA rsvd page.*/ ++ if (pBeamEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) ++ Beamforming_SendVHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->AID, pBeamEntry->SoundBW, BEACON_QUEUE); ++ else ++ Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); ++ ++ /*check rsvd page download OK.*/ ++ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A + 1); ++ count = 0; ++ while (!(BcnValidReg & BIT7) && count < 20) { ++ count++; ++ delay_us(10); ++ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A+2); ++ } ++ DLBcnCount++; ++ } while (!(BcnValidReg & BIT7) && DLBcnCount < 5); ++ ++ if (!(BcnValidReg & BIT0)) ++ RT_DISP(FBEAM, FBEAM_ERROR, ("%s Download RSVD page failed!\n", __func__)); ++ ++ /*0x204[11:0] Beacon Head for TXDMA*/ ++ PlatformEFIOWrite2Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A, TxPageBndy); ++ ++ /*To make sure that if there exists an adapter which would like to send beacon.*/ ++ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ ++ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ ++ /*the beacon cannot be sent by HW.*/ ++ /*2010.06.23. Added by tynli.*/ ++ if (bSendBeacon) ++ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A+2, tmpReg422); ++ ++ /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ ++ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ ++ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR_8814A+1); ++ PlatformEFIOWrite1Byte(Adapter, REG_CR_8814A+1, (u1bTmp&(~BIT0))); ++ ++ pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; ++ ++ pHalData->bFwDwRsvdPageInProgress = FALSE; ++} ++ ++VOID ++halTxbf8822B_FwTxBFCmd( ++ IN PADAPTER Adapter ++ ) ++{ ++ u1Byte Idx, Period = 0; ++ u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; ++ u1Byte u1TxBFParm[3] = {0}; ++ ++ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); ++ PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); ++ ++ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { ++ if (pBeamInfo->BeamformeeEntry[Idx].bUsed && pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { ++ if (pBeamInfo->BeamformeeEntry[Idx].bSound) { ++ PageNum0 = 0xFE; ++ PageNum1 = 0x07; ++ Period = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); ++ } else if (PageNum0 == 0xFF) { ++ PageNum0 = 0xFF; /*stop sounding*/ ++ PageNum1 = 0x0F; ++ } ++ } ++ } ++ ++ u1TxBFParm[0] = PageNum0; ++ u1TxBFParm[1] = PageNum1; ++ u1TxBFParm[2] = Period; ++ FillH2CCmd(Adapter, PHYDM_H2C_TXBF, 3, u1TxBFParm); ++ ++ RT_DISP(FBEAM, FBEAM_FUN, ("@%s End, PageNum0 = 0x%x, PageNum1 = 0x%x Period = %d", __func__, PageNum0, PageNum1, Period)); ++} ++#endif ++ ++VOID ++HalTxbf8822B_Init( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte u1bTmp; ++ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ ODM_SetBBReg(pDM_Odm, 0x14c0 , BIT16, 1); /*Enable P1 aggr new packet according to P0 transfer time*/ ++ ODM_SetBBReg(pDM_Odm, 0x14c0 , BIT15|BIT14|BIT13|BIT12, 10); /*MU Retry Limit*/ ++ ODM_SetBBReg(pDM_Odm, 0x14c0 , BIT7, 0); /*Disable Tx MU-MIMO until sounding done*/ ++ ODM_SetBBReg(pDM_Odm, 0x14c0 , 0x3F, 0); /* Clear validity of MU STAs */ ++ ODM_Write1Byte(pDM_Odm, 0x167c , 0x70); /*MU-MIMO Option as default value*/ ++ ODM_Write2Byte(pDM_Odm, 0x1680 , 0); /*MU-MIMO Control as default value*/ ++ ++ /* Set MU NDPA rate & BW source */ ++ /* 0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ ++ u1bTmp = ODM_Read1Byte(pDM_Odm, 0x42C); ++ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B, (u1bTmp|BIT6)); ++ /* 0x45F[7:0] = 0x10 (Rate=OFDM_6M, BW20) */ ++ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8822B, 0x10); ++ ++ /*Temp Settings*/ ++ ODM_SetBBReg(pDM_Odm, 0x6DC , 0x3F000000, 4); /*STA2's CSI rate is fixed at 6M*/ ++ ODM_SetBBReg(pDM_Odm, 0x1C94 , bMaskDWord, 0xAFFFAFFF); /*Grouping bitmap parameters*/ ++ ++ /* Init HW variable */ ++ pBeamformingInfo->RegMUTxCtrl = ODM_Read4Byte(pDM_Odm, 0x14c0); ++ ++ if (pDM_Odm->RFType == ODM_2T2R) { /*2T2R*/ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: RFType is 2T2R\n", __func__)); ++ config_phydm_trx_mode_8822b(pDM_Odm, (ODM_RF_PATH_E)3, (ODM_RF_PATH_E)3, TRUE);/*Tx2path*/ ++ } ++ ++#if (OMNIPEEK_SNIFFER_ENABLED == 1) ++ /* Config HW to receive packet on the user position from registry for sniffer mode. */ ++ /* ODM_SetBBReg(pDM_Odm, 0xB00 , BIT9, 1);*/ /* For A-cut only. RegB00[9] = 1 (enable PMAC Rx) */ ++ ODM_SetBBReg(pDM_Odm, 0xB54 , BIT30, 1); /* RegB54[30] = 1 (force user position) */ ++ ODM_SetBBReg(pDM_Odm, 0xB54 , (BIT29|BIT28), Adapter->MgntInfo.SniffUserPosition); /* RegB54[29:28] = user position (0~3) */ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Set Adapter->MgntInfo.SniffUserPosition=%#X\n", Adapter->MgntInfo.SniffUserPosition)); ++#endif ++} ++ ++VOID ++HalTxbf8822B_Enter( ++ IN PVOID pDM_VOID, ++ IN u1Byte BFerBFeeIdx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i = 0; ++ u1Byte BFerIdx = (BFerBFeeIdx & 0xF0)>>4; ++ u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); ++ u2Byte CSI_Param = 0; ++ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMEE_ENTRY pBeamformeeEntry; ++ PRT_BEAMFORMER_ENTRY pBeamformerEntry; ++ u2Byte value16, STAid = 0; ++ u1Byte Nc_index = 0, Nr_index = 0, grouping = 0, codebookinfo = 0, coefficientsize = 0; ++ u4Byte gid_valid, user_position_l, user_position_h; ++ u4Byte mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e}; ++ u1Byte u1bTmp; ++ u4Byte u4bTmp; ++ ++ RT_DISP(FBEAM, FBEAM_FUN, ("%s: BFerBFeeIdx=%d, BFerIdx=%d, BFeeIdx=%d\n", __func__, BFerBFeeIdx, BFerIdx, BFeeIdx)); ++ ++ /*************SU BFer Entry Init*************/ ++ if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { ++ pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[BFerIdx]; ++ pBeamformerEntry->is_mu_ap = FALSE; ++ /*Sounding protocol control*/ ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xDB); ++ ++ ++ for (i = 0; i < MAX_BEAMFORMER_SU; i++) { ++ if ((pBeamformingInfo->beamformer_su_reg_maping & BIT(i)) == 0) { ++ pBeamformingInfo->beamformer_su_reg_maping |= BIT(i); ++ pBeamformerEntry->su_reg_index = i; ++ break; ++ } ++ } ++ ++ /*MAC address/Partial AID of Beamformer*/ ++ if (pBeamformerEntry->su_reg_index == 0) { ++ for (i = 0; i < 6 ; i++) ++ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8822B+i), pBeamformerEntry->MacAddr[i]); ++ } else { ++ for (i = 0; i < 6 ; i++) ++ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER1_INFO_8822B+i), pBeamformerEntry->MacAddr[i]); ++ } ++ ++ /*CSI report parameters of Beamformer*/ ++ Nc_index = halTxbf8822B_GetNrx(pDM_Odm); /*for 8814A Nrx = 3(4 Ant), min=0(1 Ant)*/ ++ Nr_index = pBeamformerEntry->NumofSoundingDim; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so Nr_index don't care*/ ++ ++ grouping = 0; ++ ++ /*for ac = 1, for n = 3*/ ++ if (pBeamformerEntry->BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU) ++ codebookinfo = 1; ++ else if (pBeamformerEntry->BeamformEntryCap & BEAMFORMEE_CAP_HT_EXPLICIT) ++ codebookinfo = 3; ++ ++ coefficientsize = 3; ++ ++ CSI_Param = (u2Byte)((coefficientsize<<10)|(codebookinfo<<8)|(grouping<<6)|(Nr_index<<3)|(Nc_index)); ++ ++ if (BFerIdx == 0) ++ ODM_Write2Byte(pDM_Odm, REG_TX_CSI_RPT_PARAM_BW20_8822B, CSI_Param); ++ else ++ ODM_Write2Byte(pDM_Odm, REG_TX_CSI_RPT_PARAM_BW20_8822B+2, CSI_Param); ++ /*ndp_rx_standby_timer, 8814 need > 0x56, suggest from Dvaid*/ ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B+3, 0x70); ++ ++ } ++ ++ /*************SU BFee Entry Init*************/ ++ if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { ++ pBeamformeeEntry = &pBeamformingInfo->BeamformeeEntry[BFeeIdx]; ++ pBeamformeeEntry->is_mu_sta = FALSE; ++ halTxbf8822B_RfMode(pDM_Odm, pBeamformingInfo, BFeeIdx); ++ ++ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) ++ STAid = pBeamformeeEntry->MacId; ++ else ++ STAid = pBeamformeeEntry->P_AID; ++ ++ for (i = 0; i < MAX_BEAMFORMEE_SU; i++) { ++ if ((pBeamformingInfo->beamformee_su_reg_maping & BIT(i)) == 0) { ++ pBeamformingInfo->beamformee_su_reg_maping |= BIT(i); ++ pBeamformeeEntry->su_reg_index = i; ++ break; ++ } ++ } ++ ++ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ ++ if (pBeamformeeEntry->su_reg_index == 0) { ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B, STAid); ++ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3)|BIT4|BIT6|BIT7); ++ } else { ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B+2, STAid | BIT14 | BIT15 | BIT12); ++ } ++ ++ /*CSI report parameters of Beamformee*/ ++ if (pBeamformeeEntry->su_reg_index == 0) { ++ /*Get BIT24 & BIT25*/ ++ u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+3) & 0x3; ++ ++ ODM_Write1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B + 3, tmp | 0x60); ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B, STAid | BIT9); ++ } else ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+2, STAid | 0xE200); /*Set BIT25*/ ++ ++ phydm_Beamforming_Notify(pDM_Odm); ++ } ++ ++ /*************MU BFer Entry Init*************/ ++ if ((pBeamformingInfo->beamformer_mu_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { ++ pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[BFerIdx]; ++ pBeamformingInfo->mu_ap_index = BFerIdx; ++ pBeamformerEntry->is_mu_ap = TRUE; ++ for (i = 0; i < 8; i++) ++ pBeamformerEntry->gid_valid[i] = 0; ++ for (i = 0; i < 16; i++) ++ pBeamformerEntry->user_position[i] = 0; ++ ++ /*Sounding protocol control*/ ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xDB); ++ ++ /* MAC address */ ++ for (i = 0; i < 6 ; i++) ++ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8822B+i), pBeamformerEntry->MacAddr[i]); ++ ++ /* Set partial AID */ ++ ODM_Write2Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8822B+6), pBeamformerEntry->P_AID); ++ ++ /* Fill our AID to 0x1680[11:0] and [13:12] = 2b'00, BF report segment select to 3895 bytes*/ ++ u1bTmp = ODM_Read1Byte(pDM_Odm, 0x1680); ++ u1bTmp = (pBeamformerEntry->AID)&0xFFF; ++ ODM_Write1Byte(pDM_Odm, 0x1680, u1bTmp); ++ ++ /* Set 80us for leaving ndp_rx_standby_state */ ++ ODM_Write1Byte(pDM_Odm, 0x71B, 0x50); ++ ++ /* Set 0x6A0[14] = 1 to accept action_no_ack */ ++ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1); ++ u1bTmp |= 0x40; ++ ODM_Write1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1, u1bTmp); ++ /* Set 0x6A2[5:4] = 1 to NDPA and BF report poll */ ++ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_RXFLTMAP1_8822B); ++ u1bTmp |= 0x30; ++ ODM_Write1Byte(pDM_Odm, REG_RXFLTMAP1_8822B, u1bTmp); ++ ++ /*CSI report parameters of Beamformer*/ ++ Nc_index = halTxbf8822B_GetNrx(pDM_Odm); /* Depend on RF type */ ++ Nr_index = 1; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so Nr_index don't care*/ ++ grouping = 0; /*no grouping*/ ++ codebookinfo = 1; /*7 bit for psi, 9 bit for phi*/ ++ coefficientsize = 0; /*This is nothing really matter*/ ++ CSI_Param = (u2Byte)((coefficientsize<<10)|(codebookinfo<<8)|(grouping<<6)|(Nr_index<<3)|(Nc_index)); ++ ODM_Write2Byte(pDM_Odm, 0x6F4, CSI_Param); ++ ++ /*for B-Cut*/ ++ ODM_SetBBReg(pDM_Odm, 0x6A0 , BIT20, 0); ++ ODM_SetBBReg(pDM_Odm, 0x688 , BIT20, 0); ++ ++ } ++ ++ /*************MU BFee Entry Init*************/ ++ if ((pBeamformingInfo->beamformee_mu_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { ++ pBeamformeeEntry = &pBeamformingInfo->BeamformeeEntry[BFeeIdx]; ++ pBeamformeeEntry->is_mu_sta = TRUE; ++ for (i = 0; i < MAX_BEAMFORMEE_MU; i++) { ++ if ((pBeamformingInfo->beamformee_mu_reg_maping & BIT(i)) == 0) { ++ pBeamformingInfo->beamformee_mu_reg_maping |= BIT(i); ++ pBeamformeeEntry->mu_reg_index = i; ++ break; ++ } ++ } ++ ++ if (pBeamformeeEntry->mu_reg_index == 0xFF) { ++ /* There is no valid bit in beamformee_mu_reg_maping */ ++ RT_DISP(FBEAM, FBEAM_FUN, ("%s: ERROR! There is no valid bit in beamformee_mu_reg_maping!\n", __func__)); ++ return; ++ } ++ ++ /*User position table*/ ++ switch (pBeamformeeEntry->mu_reg_index) { ++ case 0: ++ gid_valid = 0x7fe; ++ user_position_l = 0x111110; ++ user_position_h = 0x0; ++ break; ++ case 1: ++ gid_valid = 0x7f806; ++ user_position_l = 0x11000004; ++ user_position_h = 0x11; ++ break; ++ case 2: ++ gid_valid = 0x1f81818; ++ user_position_l = 0x400040; ++ user_position_h = 0x11100; ++ break; ++ case 3: ++ gid_valid = 0x1e186060; ++ user_position_l = 0x4000400; ++ user_position_h = 0x1100040; ++ break; ++ case 4: ++ gid_valid = 0x66618180; ++ user_position_l = 0x40004000; ++ user_position_h = 0x10040400; ++ break; ++ case 5: ++ gid_valid = 0x79860600; ++ user_position_l = 0x40000; ++ user_position_h = 0x4404004; ++ break; ++ } ++ ++ for (i = 0; i < 8; i++) { ++ if (i < 4) { ++ pBeamformeeEntry->gid_valid[i] = (u1Byte)(gid_valid & 0xFF); ++ gid_valid = (gid_valid >> 8); ++ } else ++ pBeamformeeEntry->gid_valid[i] = 0; ++ } ++ for (i = 0; i < 16; i++) { ++ if (i < 4) ++ pBeamformeeEntry->user_position[i] = (u1Byte)((user_position_l >>(i*8)) & 0xFF); ++ else if (i < 8) ++ pBeamformeeEntry->user_position[i] = (u1Byte)((user_position_h >>((i-4)*8)) & 0xFF); ++ else ++ pBeamformeeEntry->user_position[i] = 0; ++ } ++ ++ /*Sounding protocol control*/ ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xDB); ++ ++ /*select MU STA table*/ ++ pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); ++ pBeamformingInfo->RegMUTxCtrl |= (pBeamformeeEntry->mu_reg_index << 8)&(BIT8|BIT9|BIT10); ++ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); ++ ++ ODM_SetBBReg(pDM_Odm, 0x14c4 , bMaskDWord, 0); /*Reset gid_valid table*/ ++ ODM_SetBBReg(pDM_Odm, 0x14c8 , bMaskDWord, user_position_l); ++ ODM_SetBBReg(pDM_Odm, 0x14cc , bMaskDWord, user_position_h); ++ ++ /*set validity of MU STAs*/ ++ pBeamformingInfo->RegMUTxCtrl &= 0xFFFFFFC0; ++ pBeamformingInfo->RegMUTxCtrl |= pBeamformingInfo->beamformee_mu_reg_maping&0x3F; ++ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, RegMUTxCtrl = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", ++ __func__, pBeamformingInfo->RegMUTxCtrl, user_position_l, user_position_h)); ++ ++ value16 = ODM_Read2Byte(pDM_Odm, mu_reg[pBeamformeeEntry->mu_reg_index]); ++ value16 &= 0xFE00; /*Clear PAID*/ ++ value16 |= BIT9; /*Enable MU BFee*/ ++ value16 |= pBeamformeeEntry->P_AID; ++ ODM_Write2Byte(pDM_Odm, mu_reg[pBeamformeeEntry->mu_reg_index] , value16); ++ ++ /* 0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ ++ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3); ++ u1bTmp |= 0xD0; /* Set bit 28, 30, 31 to 3b'111*/ ++ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3, u1bTmp); ++ /* Set NDPA to 6M*/ ++ ODM_Write1Byte(pDM_Odm, REG_NDPA_RATE_8822B, 0x4); ++ ++ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8822B); ++ u1bTmp &= 0xFC; /* Clear bit 0, 1*/ ++ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8822B, u1bTmp); ++ ++ u4bTmp = ODM_Read4Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B); ++ u4bTmp = ((u4bTmp & 0xFF0000FF) | 0x020200); /* Set [23:8] to 0x0202*/ ++ ODM_Write4Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, u4bTmp); ++ ++ /* Set 0x6A0[14] = 1 to accept action_no_ack */ ++ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1); ++ u1bTmp |= 0x40; ++ ODM_Write1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1, u1bTmp); ++ /* End of MAC registers setting */ ++ ++ halTxbf8822B_RfMode(pDM_Odm, pBeamformingInfo, BFeeIdx); ++#if (SUPPORT_MU_BF == 1) ++ /*Special for plugfest*/ ++ delay_ms(50); /* wait for 4-way handshake ending*/ ++ SendSWVHTGIDMgntFrame(pDM_Odm, pBeamformeeEntry->MacAddr, BFeeIdx); ++#endif ++ ++ phydm_Beamforming_Notify(pDM_Odm); ++#if 1 ++ { ++ u4Byte ctrl_info_offset, index; ++ /*Set Ctrl Info*/ ++ ODM_Write2Byte(pDM_Odm, 0x140, 0x660); ++ ctrl_info_offset = 0x8000 + 32 * pBeamformeeEntry->MacId; ++ /*Reset Ctrl Info*/ ++ for (index = 0; index < 8; index++) ++ ODM_Write4Byte(pDM_Odm, ctrl_info_offset + index*4, 0); ++ ++ ODM_Write4Byte(pDM_Odm, ctrl_info_offset, (pBeamformeeEntry->mu_reg_index + 1) << 16); ++ ODM_Write1Byte(pDM_Odm, 0x81, 0x80); /*RPTBUF ready*/ ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, MacId = %d, ctrl_info_offset = 0x%x, mu_reg_index = %x\n", ++ __func__, pBeamformeeEntry->MacId, ctrl_info_offset, pBeamformeeEntry->mu_reg_index)); ++ } ++#endif ++ } ++ ++} ++ ++ ++VOID ++HalTxbf8822B_Leave( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMER_ENTRY pBeamformerEntry; ++ PRT_BEAMFORMEE_ENTRY pBeamformeeEntry; ++ u4Byte mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e}; ++ ++ if (Idx < BEAMFORMER_ENTRY_NUM) { ++ pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[Idx]; ++ pBeamformeeEntry = &pBeamformingInfo->BeamformeeEntry[Idx]; ++ } else ++ return; ++ ++ /*Clear P_AID of Beamformee*/ ++ /*Clear MAC address of Beamformer*/ ++ /*Clear Associated Bfmee Sel*/ ++ ++ if (pBeamformerEntry->BeamformEntryCap == BEAMFORMING_CAP_NONE) { ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xD8); ++ if (pBeamformerEntry->is_mu_ap == 0) { /*SU BFer */ ++ if (pBeamformerEntry->su_reg_index == 0) { ++ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8822B, 0); ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8822B+4, 0); ++ ODM_Write2Byte(pDM_Odm, REG_TX_CSI_RPT_PARAM_BW20_8822B, 0); ++ } else { ++ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8822B, 0); ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8822B+4, 0); ++ ODM_Write2Byte(pDM_Odm, REG_TX_CSI_RPT_PARAM_BW20_8822B+2, 0); ++ } ++ pBeamformingInfo->beamformer_su_reg_maping &= ~(BIT(pBeamformerEntry->su_reg_index)); ++ pBeamformerEntry->su_reg_index = 0xFF; ++ } else { /*MU BFer */ ++ /*set validity of MU STA0 and MU STA1*/ ++ pBeamformingInfo->RegMUTxCtrl &= 0xFFFFFFC0; ++ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); ++ ++ ODM_Memory_Set(pDM_Odm, pBeamformerEntry->gid_valid, 0, 8); ++ ODM_Memory_Set(pDM_Odm, pBeamformerEntry->user_position, 0, 16); ++ pBeamformerEntry->is_mu_ap = FALSE; ++ } ++ } ++ ++ if (pBeamformeeEntry->BeamformEntryCap == BEAMFORMING_CAP_NONE) { ++ halTxbf8822B_RfMode(pDM_Odm, pBeamformingInfo, Idx); ++ if (pBeamformeeEntry->is_mu_sta == 0) { /*SU BFee*/ ++ if (pBeamformeeEntry->su_reg_index == 0) { ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B, 0x0); ++ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3)|BIT4|BIT6|BIT7); ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B, 0); ++ } else { ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B+2, 0x0 | BIT14 | BIT15 | BIT12); ++ ++ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+2, ++ ODM_Read2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+2) & 0x60); ++ } ++ pBeamformingInfo->beamformee_su_reg_maping &= ~(BIT(pBeamformeeEntry->su_reg_index)); ++ pBeamformeeEntry->su_reg_index = 0xFF; ++ } else { /*MU BFee */ ++ /*Disable sending NDPA & BF-rpt-poll to this BFee*/ ++ ODM_Write2Byte(pDM_Odm, mu_reg[pBeamformeeEntry->mu_reg_index] , 0); ++ /*set validity of MU STA*/ ++ pBeamformingInfo->RegMUTxCtrl &= ~(BIT(pBeamformeeEntry->mu_reg_index)); ++ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); ++ ++ ++ pBeamformeeEntry->is_mu_sta = FALSE; ++ pBeamformingInfo->beamformee_mu_reg_maping &= ~(BIT(pBeamformeeEntry->mu_reg_index)); ++ pBeamformeeEntry->mu_reg_index = 0xFF; ++ } ++ } ++} ++ ++ ++/***********SU & MU BFee Entry Only when souding done****************/ ++VOID ++HalTxbf8822B_Status( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u2Byte BeamCtrlVal, tmpVal; ++ u4Byte BeamCtrlReg; ++ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry; ++ BOOLEAN is_mu_sounding = pBeamformingInfo->is_mu_sounding, is_bitmap_ready = FALSE; ++ u16 bitmap; ++ u8 idx, gid, i; ++ u8 id1, id0; ++ u32 gid_valid[6] = {0}; ++ u32 user_position_lsb[6] = {0}; ++ u32 user_position_msb[6] = {0}; ++ u32 value32; ++ BOOLEAN is_sounding_success[6] = {FALSE}; ++ ++ if (Idx < BEAMFORMEE_ENTRY_NUM) ++ pBeamformEntry = &pBeamformingInfo->BeamformeeEntry[Idx]; ++ else ++ return; ++ ++ /*SU sounding done */ ++ if (is_mu_sounding == FALSE) { ++ ++ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) ++ BeamCtrlVal = pBeamformEntry->MacId; ++ else ++ BeamCtrlVal = pBeamformEntry->P_AID; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, BeamformEntry.BeamformEntryState = %d", __func__, pBeamformEntry->BeamformEntryState)); ++ ++ if (pBeamformEntry->su_reg_index == 0) { ++ BeamCtrlReg = REG_TXBF_CTRL_8822B; ++ } else { ++ BeamCtrlReg = REG_TXBF_CTRL_8822B+2; ++ BeamCtrlVal |= BIT12|BIT14|BIT15; ++ } ++ ++ if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { ++ if (pBeamformEntry->SoundBW == CHANNEL_WIDTH_20) ++ BeamCtrlVal |= BIT9; ++ else if (pBeamformEntry->SoundBW == CHANNEL_WIDTH_40) ++ BeamCtrlVal |= (BIT9|BIT10); ++ else if (pBeamformEntry->SoundBW == CHANNEL_WIDTH_80) ++ BeamCtrlVal |= (BIT9|BIT10|BIT11); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, Don't apply Vmatrix", __func__)); ++ BeamCtrlVal &= ~(BIT9|BIT10|BIT11); ++ } ++ ++ ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); ++ /*disable NDP packet use beamforming */ ++ tmpVal = ODM_Read2Byte(pDM_Odm, REG_TXBF_CTRL_8822B); ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B, tmpVal|BIT15); ++ } else { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, MU Sounding Done\n", __func__)); ++ /*MU sounding done */ ++ if (1){//(pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, BEAMFORMING_ENTRY_STATE_PROGRESSED\n", __func__)); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0x1684, bMaskDWord); ++ is_sounding_success[0] = (value32 & BIT10)?1:0; ++ is_sounding_success[1] = (value32 & BIT26)?1:0; ++ value32 = ODM_GetBBReg(pDM_Odm, 0x1688, bMaskDWord); ++ is_sounding_success[2] = (value32 & BIT10)?1:0; ++ is_sounding_success[3] = (value32 & BIT26)?1:0; ++ value32 = ODM_GetBBReg(pDM_Odm, 0x168C, bMaskDWord); ++ is_sounding_success[4] = (value32 & BIT10)?1:0; ++ is_sounding_success[5] = (value32 & BIT26)?1:0; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, is_sounding_success STA1:%d, STA2:%d, STA3:%d, STA4:%d, STA5:%d, STA6:%d\n", ++ __func__, is_sounding_success[0], is_sounding_success[1] , is_sounding_success[2] , is_sounding_success[3] , is_sounding_success[4] , is_sounding_success[5] )); ++ ++ value32 = ODM_GetBBReg(pDM_Odm, 0xF4C, 0xFFFF0000); ++ //ODM_SetBBReg(pDM_Odm, 0x19E0, bMaskHWord, 0xFFFF);/*Let MAC ignore bitmap*/ ++ ++ is_bitmap_ready = (BOOLEAN)((value32 & BIT15) >> 15); ++ bitmap = (u16)(value32 & 0x3FFF); ++ ++ for (idx = 0; idx < 15; idx++) { ++ if (idx < 5) {/*bit0~4*/ ++ id0 = 0; ++ id1 = (u8)(idx + 1); ++ } else if (idx < 9) { /*bit5~8*/ ++ id0 = 1; ++ id1 = (u8)(idx - 3); ++ } else if (idx < 12) { /*bit9~11*/ ++ id0 = 2; ++ id1 = (u8)(idx - 6); ++ } else if (idx < 14) { /*bit12~13*/ ++ id0 = 3; ++ id1 = (u8)(idx - 8); ++ } else { /*bit14*/ ++ id0 = 4; ++ id1 = (u8)(idx - 9); ++ } ++ if (bitmap & BIT(idx)) { ++ /*Pair 1*/ ++ gid = (idx << 1) + 1; ++ gid_valid[id0] |= (BIT(gid)); ++ gid_valid[id1] |= (BIT(gid)); ++ /*Pair 2*/ ++ gid += 1; ++ gid_valid[id0] |= (BIT(gid)); ++ gid_valid[id1] |= (BIT(gid)); ++ } else { ++ /*Pair 1*/ ++ gid = (idx << 1) + 1; ++ gid_valid[id0] &= ~(BIT(gid)); ++ gid_valid[id1] &= ~(BIT(gid)); ++ /*Pair 2*/ ++ gid += 1; ++ gid_valid[id0] &= ~(BIT(gid)); ++ gid_valid[id1] &= ~(BIT(gid)); ++ } ++ } ++ ++ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { ++ pBeamformEntry = &pBeamformingInfo->BeamformeeEntry[i]; ++ if ((pBeamformEntry->is_mu_sta) && (pBeamformEntry->mu_reg_index < 6)) { ++ value32 = gid_valid[pBeamformEntry->mu_reg_index]; ++ for (idx = 0; idx < 4; idx++) { ++ pBeamformEntry->gid_valid[idx] = (u8)(value32 & 0xFF); ++ value32 = (value32 >> 8); ++ } ++ } ++ } ++ ++ for (idx = 0; idx < 6; idx++) { ++ pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); ++ pBeamformingInfo->RegMUTxCtrl |= ((idx<<8)&(BIT8|BIT9|BIT10)); ++ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); ++ ODM_SetMACReg(pDM_Odm, 0x14C4, bMaskDWord, gid_valid[idx]); /*set MU STA gid valid table*/ ++ } ++ ++ /*Enable TxMU PPDU*/ ++ if (pBeamformingInfo->dbg_disable_mu_tx == FALSE) ++ pBeamformingInfo->RegMUTxCtrl |= BIT7; ++ else ++ pBeamformingInfo->RegMUTxCtrl &= ~BIT7; ++ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); ++ } ++ } ++} ++ ++/*Only used for MU BFer Entry when get GID management frame (self is as MU STA)*/ ++VOID ++HalTxbf8822B_ConfigGtab( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMER_ENTRY pBeamformerEntry = NULL; ++ u4Byte gid_valid = 0, user_position_l = 0, user_position_h = 0, i; ++ ++ if (pBeamformingInfo->mu_ap_index < BEAMFORMER_ENTRY_NUM) ++ pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[pBeamformingInfo->mu_ap_index]; ++ else ++ return; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s==>\n", __func__)); ++ ++ /*For GID 0~31*/ ++ for (i = 0; i < 4; i++) ++ gid_valid |= (pBeamformerEntry->gid_valid[i] << (i<<3)); ++ for (i = 0; i < 8; i++) { ++ if (i < 4) ++ user_position_l |= (pBeamformerEntry->user_position[i] << (i << 3)); ++ else ++ user_position_h |= (pBeamformerEntry->user_position[i] << ((i - 4)<<3)); ++ } ++ /*select MU STA0 table*/ ++ pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); ++ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); ++ ODM_SetBBReg(pDM_Odm, 0x14c4, bMaskDWord, gid_valid); ++ ODM_SetBBReg(pDM_Odm, 0x14c8, bMaskDWord, user_position_l); ++ ODM_SetBBReg(pDM_Odm, 0x14cc, bMaskDWord, user_position_h); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: STA0: gid_valid = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", ++ __func__, gid_valid, user_position_l, user_position_h)); ++ ++ gid_valid = 0; ++ user_position_l = 0; ++ user_position_h = 0; ++ ++ /*For GID 32~64*/ ++ for (i = 4; i < 8; i++) ++ gid_valid |= (pBeamformerEntry->gid_valid[i] << ((i - 4)<<3)); ++ for (i = 8; i < 16; i++) { ++ if (i < 4) ++ user_position_l |= (pBeamformerEntry->user_position[i] << ((i - 8) << 3)); ++ else ++ user_position_h |= (pBeamformerEntry->user_position[i] << ((i - 12) << 3)); ++ } ++ /*select MU STA1 table*/ ++ pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); ++ pBeamformingInfo->RegMUTxCtrl |= BIT8; ++ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); ++ ODM_SetBBReg(pDM_Odm, 0x14c4, bMaskDWord, gid_valid); ++ ODM_SetBBReg(pDM_Odm, 0x14c8, bMaskDWord, user_position_l); ++ ODM_SetBBReg(pDM_Odm, 0x14cc, bMaskDWord, user_position_h); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: STA1: gid_valid = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", ++ __func__, gid_valid, user_position_l, user_position_h)); ++ ++ /* Set validity of MU STA0 and MU STA1*/ ++ pBeamformingInfo->RegMUTxCtrl &= 0xFFFFFFC0; ++ pBeamformingInfo->RegMUTxCtrl |= 0x3; /* STA0, STA1*/ ++ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); ++ ++} ++ ++ ++ ++#if 0 ++/*This function translate the bitmap to GTAB*/ ++VOID ++haltxbf8822b_gtab_translation( ++ IN PDM_ODM_T pDM_Odm ++) ++{ ++ u8 idx, gid; ++ u8 id1, id0; ++ u32 gid_valid[6] = {0}; ++ u32 user_position_lsb[6] = {0}; ++ u32 user_position_msb[6] = {0}; ++ ++ for (idx = 0; idx < 15; idx++) { ++ if (idx < 5) {/*bit0~4*/ ++ id0 = 0; ++ id1 = (u8)(idx + 1); ++ } else if (idx < 9) { /*bit5~8*/ ++ id0 = 1; ++ id1 = (u8)(idx - 3); ++ } else if (idx < 12) { /*bit9~11*/ ++ id0 = 2; ++ id1 = (u8)(idx - 6); ++ } else if (idx < 14) { /*bit12~13*/ ++ id0 = 3; ++ id1 = (u8)(idx - 8); ++ } else { /*bit14*/ ++ id0 = 4; ++ id1 = (u8)(idx - 9); ++ } ++ ++ /*Pair 1*/ ++ gid = (idx << 1) + 1; ++ gid_valid[id0] |= (1 << gid); ++ gid_valid[id1] |= (1 << gid); ++ if (gid < 16) { ++ /*user_position_lsb[id0] |= (0 << (gid << 1));*/ ++ user_position_lsb[id1] |= (1 << (gid << 1)); ++ } else { ++ /*user_position_msb[id0] |= (0 << ((gid - 16) << 1));*/ ++ user_position_msb[id1] |= (1 << ((gid - 16) << 1)); ++ } ++ ++ /*Pair 2*/ ++ gid += 1; ++ gid_valid[id0] |= (1 << gid); ++ gid_valid[id1] |= (1 << gid); ++ if (gid < 16) { ++ user_position_lsb[id0] |= (1 << (gid << 1)); ++ /*user_position_lsb[id1] |= (0 << (gid << 1));*/ ++ } else { ++ user_position_msb[id0] |= (1 << ((gid - 16) << 1)); ++ /*user_position_msb[id1] |= (0 << ((gid - 16) << 1));*/ ++ } ++ ++ } ++ ++ ++ for (idx = 0; idx < 6; idx++) { ++ /*DbgPrint("gid_valid[%d] = 0x%x\n", idx, gid_valid[idx]); ++ DbgPrint("user_position[%d] = 0x%x %x\n", idx, user_position_msb[idx], user_position_lsb[idx]);*/ ++ } ++} ++#endif ++ ++VOID ++HalTxbf8822B_FwTxBF( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ) ++{ ++#if 0 ++ PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); ++ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry+Idx; ++ ++ if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) ++ halTxbf8822B_DownloadNDPA(Adapter, Idx); ++ ++ halTxbf8822B_FwTxBFCmd(Adapter); ++#endif ++} ++ ++#endif ++ ++#if (defined(CONFIG_BB_TXBF_API)) ++/*this function is only used for BFer*/ ++VOID ++phydm_8822btxbf_rfmode( ++ IN PVOID pDM_VOID, ++ IN u1Byte SUBFeeCnt, ++ IN u1Byte MUBFeeCnt ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i, Nr_index = 0; ++ ++ if (pDM_Odm->RFType == ODM_1T1R) ++ return; ++ ++ if ((SUBFeeCnt > 0) || (MUBFeeCnt > 0)) { ++ for (i = ODM_RF_PATH_A; i <= ODM_RF_PATH_B; i++) { ++ ODM_SetRFReg(pDM_Odm, i, 0xEF, BIT19, 0x1); /*RF Mode table write enable*/ ++ ODM_SetRFReg(pDM_Odm, i, 0x33, 0xF, 3); /*Select RX mode*/ ++ ODM_SetRFReg(pDM_Odm, i, 0x3E, 0xfffff, 0x00036); /*Set Table data*/ ++ ODM_SetRFReg(pDM_Odm, i, 0x3F, 0xfffff, 0x5AFCE); /*Set Table data*/ ++ ODM_SetRFReg(pDM_Odm, i, 0xEF, BIT19, 0x0); /*RF Mode table write disable*/ ++ } ++ } ++ ++ if (SUBFeeCnt > 0 || MUBFeeCnt > 0) { ++ /*for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT28|BIT29, 0x2); /*enable BB TxBF ant mapping register*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT31, 1); /*ignore user since 8822B only 2Tx*/ ++ ++ /*Nsts = 2 AB*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); ++ ++ } else { ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT28|BIT29, 0x0); /*enable BB TxBF ant mapping register*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT31, 0); /*ignore user since 8822B only 2Tx*/ ++ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*1SS by path-A*/ ++ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8822B, bMaskLWord, 0x430); /*2SS by path-A,B*/ ++ } ++ ++} ++ ++ ++/*this function is for BFer bug workaround*/ ++VOID ++phydm_8822b_sutxbfer_workaroud( ++ IN PVOID pDM_VOID, ++ IN BOOLEAN EnableSUBfer, ++ IN u1Byte Nc, ++ IN u1Byte Nr, ++ IN u1Byte Ng, ++ IN u1Byte CB, ++ IN u1Byte BW, ++ IN BOOLEAN isVHT ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (EnableSUBfer) { ++ ODM_SetBBReg(pDM_Odm, 0x19f8, BIT22|BIT21|BIT20, 0x1); ++ ODM_SetBBReg(pDM_Odm, 0x19f8, BIT25|BIT24|BIT23, 0x0); ++ ODM_SetBBReg(pDM_Odm, 0x19f8, BIT16, 0x1); ++ ++ if (isVHT) ++ ODM_SetBBReg(pDM_Odm, 0x19f0, BIT5|BIT4|BIT3|BIT2|BIT1|BIT0, 0x1f); ++ else ++ ODM_SetBBReg(pDM_Odm, 0x19f0, BIT5|BIT4|BIT3|BIT2|BIT1|BIT0, 0x22); ++ ++ ODM_SetBBReg(pDM_Odm, 0x19f0, BIT7|BIT6, Nc); ++ ODM_SetBBReg(pDM_Odm, 0x19f0, BIT9|BIT8, Nr); ++ ODM_SetBBReg(pDM_Odm, 0x19f0, BIT11|BIT10, Ng); ++ ODM_SetBBReg(pDM_Odm, 0x19f0, BIT13|BIT12, CB); ++ ++ ODM_SetBBReg(pDM_Odm, 0xb58, BIT3|BIT2, BW); ++ ODM_SetBBReg(pDM_Odm, 0xb58, BIT7|BIT6|BIT5|BIT4, 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xb58, BIT9|BIT8, BW); ++ ODM_SetBBReg(pDM_Odm, 0xb58, BIT13|BIT12|BIT11|BIT10, 0x0); ++ } else ++ ODM_SetBBReg(pDM_Odm, 0x19f8, BIT16, 0x0); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] EnableSUBfer = %d, isVHT = %d\n", __func__, EnableSUBfer, isVHT)); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] Nc = %d, Nr = %d, Ng = %d, CB = %d, BW = %d\n", __func__, Nc, Nr, Ng, CB, BW)); ++ ++ ++} ++#endif ++#endif /* (RTL8822B_SUPPORT == 1)*/ ++ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.h 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,87 @@ ++#ifndef __HAL_TXBF_8822B_H__ ++#define __HAL_TXBF_8822B_H__ ++ ++#if (RTL8822B_SUPPORT == 1) ++#if (BEAMFORMING_SUPPORT == 1) ++ ++VOID ++HalTxbf8822B_Init( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++HalTxbf8822B_Enter( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++ ++VOID ++HalTxbf8822B_Leave( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++ ++VOID ++HalTxbf8822B_Status( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++VOID ++HalTxbf8822B_ConfigGtab( ++ IN PVOID pDM_VOID ++ ); ++ ++VOID ++HalTxbf8822B_FwTxBF( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++#else ++#define HalTxbf8822B_Init(pDM_VOID) ++#define HalTxbf8822B_Enter(pDM_VOID, Idx) ++#define HalTxbf8822B_Leave(pDM_VOID, Idx) ++#define HalTxbf8822B_Status(pDM_VOID, Idx) ++#define HalTxbf8822B_FwTxBF(pDM_VOID, Idx) ++#define HalTxbf8822B_ConfigGtab(pDM_VOID) ++ ++#endif ++ ++#if (defined(CONFIG_BB_TXBF_API)) ++VOID ++phydm_8822btxbf_rfmode( ++ IN PVOID pDM_VOID, ++ IN u1Byte SUBFeeCnt, ++ IN u1Byte MUBFeeCnt ++ ); ++ ++VOID ++phydm_8822b_sutxbfer_workaroud( ++ IN PVOID pDM_VOID, ++ IN BOOLEAN EnableSUBfer, ++ IN u1Byte Nc, ++ IN u1Byte Nr, ++ IN u1Byte Ng, ++ IN u1Byte CB, ++ IN u1Byte BW, ++ IN BOOLEAN isVHT ++ ); ++ ++#else ++#define phydm_8822btxbf_rfmode(pDM_VOID, SUBFeeCnt, MUBFeeCnt) ++#define phydm_8822b_sutxbfer_workaroud(pDM_VOID, EnableSUBfer, Nc, Nr, Ng, CB, BW, isVHT) ++#endif ++ ++#else ++#define HalTxbf8822B_Init(pDM_VOID) ++#define HalTxbf8822B_Enter(pDM_VOID, Idx) ++#define HalTxbf8822B_Leave(pDM_VOID, Idx) ++#define HalTxbf8822B_Status(pDM_VOID, Idx) ++#define HalTxbf8822B_FwTxBF(pDM_VOID, Idx) ++#define HalTxbf8822B_ConfigGtab(pDM_VOID) ++ ++#endif ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.c 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,1502 @@ ++//============================================================ ++// Description: ++// ++// This file is for TXBF interface mechanism ++// ++//============================================================ ++#include "mp_precomp.h" ++#include "../phydm_precomp.h" ++ ++#if (BEAMFORMING_SUPPORT == 1) ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++Beamforming_GidPAid( ++ PADAPTER Adapter, ++ PRT_TCB pTcb ++) ++{ ++ u1Byte Idx = 0; ++ u1Byte RA[6] ={0}; ++ pu1Byte pHeader = GET_FRAME_OF_FIRST_FRAG(Adapter, pTcb); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ ++ if (Adapter->HardwareType < HARDWARE_TYPE_RTL8192EE) ++ return; ++ else if (IS_WIRELESS_MODE_N(Adapter) == FALSE) ++ return; ++ ++#if (SUPPORT_MU_BF == 1) ++ if (pTcb->TxBFPktType == RT_BF_PKT_TYPE_BROADCAST_NDPA) { /* MU NDPA */ ++#else ++ if (0) { ++#endif ++ /* Fill G_ID and P_AID */ ++ pTcb->G_ID = 63; ++ if (pBeamInfo->FirstMUBFeeIndex < BEAMFORMEE_ENTRY_NUM) { ++ pTcb->P_AID = pBeamInfo->BeamformeeEntry[pBeamInfo->FirstMUBFeeIndex].P_AID; ++ RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, pTcb->G_ID, pTcb->P_AID)); ++ } ++ } else { ++ GET_80211_HDR_ADDRESS1(pHeader, &RA); ++ ++ // VHT SU PPDU carrying one or more group addressed MPDUs or ++ // Transmitting a VHT NDP intended for multiple recipients ++ if (MacAddr_isBcst(RA) || MacAddr_isMulticast(RA) || pTcb->macId == MAC_ID_STATIC_FOR_BROADCAST_MULTICAST) { ++ pTcb->G_ID = 63; ++ pTcb->P_AID = 0; ++ } else if (ACTING_AS_AP(Adapter)) { ++ u2Byte AID = (u2Byte) (MacIdGetOwnerAssociatedClientAID(Adapter, pTcb->macId) & 0x1ff); /*AID[0:8]*/ ++ ++ /*RT_DISP(FBEAM, FBEAM_FUN, ("@%s pTcb->macId=0x%X, AID=0x%X\n", __func__, pTcb->macId, AID));*/ ++ pTcb->G_ID = 63; ++ ++ if (AID == 0) /*A PPDU sent by an AP to a non associated STA*/ ++ pTcb->P_AID = 0; ++ else { /*Sent by an AP and addressed to a STA associated with that AP*/ ++ u2Byte BSSID = 0; ++ GET_80211_HDR_ADDRESS2(pHeader, &RA); ++ BSSID = ((RA[5] & 0xf0) >> 4) ^ (RA[5] & 0xf); /*BSSID[44:47] xor BSSID[40:43]*/ ++ pTcb->P_AID = (AID + BSSID *32) & 0x1ff; /*(dec(A) + dec(B)*32) mod 512*/ ++ } ++ } else if (ACTING_AS_IBSS(Adapter)) { ++ pTcb->G_ID = 63; ++ /*P_AID for infrasturcture mode; MACID for ad-hoc mode. */ ++ pTcb->P_AID = pTcb->macId; ++ } else if (MgntLinkStatusQuery(Adapter)) { /*Addressed to AP*/ ++ pTcb->G_ID = 0; ++ GET_80211_HDR_ADDRESS1(pHeader, &RA); ++ pTcb->P_AID = RA[5]; /*RA[39:47]*/ ++ pTcb->P_AID = (pTcb->P_AID << 1) | (RA[4] >> 7 ); ++ } else { ++ pTcb->G_ID = 63; ++ pTcb->P_AID = 0; ++ } ++ /*RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, pTcb->G_ID, pTcb->P_AID));*/ ++ } ++} ++ ++ ++RT_STATUS ++Beamforming_GetReportFrame( ++ IN PADAPTER Adapter, ++ IN PRT_RFD pRfd, ++ IN POCTET_STRING pPduOS ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; ++ pu1Byte pMIMOCtrlField, pCSIReport, pCSIMatrix; ++ u1Byte Idx, Nc, Nr, CH_W; ++ u2Byte CSIMatrixLen = 0; ++ ++ ACT_PKT_TYPE pktType = ACT_PKT_TYPE_UNKNOWN; ++ ++ //Memory comparison to see if CSI report is the same with previous one ++ pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, Frame_Addr2(*pPduOS), &Idx); ++ ++ if (pBeamformEntry == NULL) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Beamforming_GetReportFrame: Cannot find entry by addr\n")); ++ return RT_STATUS_FAILURE; ++ } ++ ++ pktType = PacketGetActionFrameType(pPduOS); ++ ++ //-@ Modified by David ++ if (pktType == ACT_PKT_VHT_COMPRESSED_BEAMFORMING) { ++ pMIMOCtrlField = pPduOS->Octet + 26; ++ Nc = ((*pMIMOCtrlField) & 0x7) + 1; ++ Nr = (((*pMIMOCtrlField) & 0x38) >> 3) + 1; ++ CH_W = (((*pMIMOCtrlField) & 0xC0) >> 6); ++ pCSIMatrix = pMIMOCtrlField + 3 + Nc; //24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(Nc=2) ++ CSIMatrixLen = pPduOS->Length - 26 -3 -Nc; ++ } else if (pktType == ACT_PKT_HT_COMPRESSED_BEAMFORMING) { ++ pMIMOCtrlField = pPduOS->Octet + 26; ++ Nc = ((*pMIMOCtrlField) & 0x3) + 1; ++ Nr = (((*pMIMOCtrlField) & 0xC) >> 2) + 1; ++ CH_W = (((*pMIMOCtrlField) & 0x10) >> 4); ++ pCSIMatrix = pMIMOCtrlField + 6 + Nr; //24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(Nc=2) ++ CSIMatrixLen = pPduOS->Length - 26 -6 -Nr; ++ } else ++ return RT_STATUS_SUCCESS; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] idx=%d, pkt type=%d, Nc=%d, Nr=%d, CH_W=%d\n", __func__, Idx, pktType, Nc, Nr, CH_W)); ++ ++ return RT_STATUS_SUCCESS; ++} ++ ++ ++VOID ++ConstructHTNDPAPacket( ++ PADAPTER Adapter, ++ pu1Byte RA, ++ pu1Byte Buffer, ++ pu4Byte pLength, ++ CHANNEL_WIDTH BW ++ ) ++{ ++ u2Byte Duration= 0; ++ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); ++ OCTET_STRING pNDPAFrame,ActionContent; ++ u1Byte ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; ++ ++ PlatformZeroMemory(Buffer, 32); ++ ++ SET_80211_HDR_FRAME_CONTROL(Buffer,0); ++ ++ SET_80211_HDR_ORDER(Buffer, 1); ++ SET_80211_HDR_TYPE_AND_SUBTYPE(Buffer,Type_Action_No_Ack); ++ ++ SET_80211_HDR_ADDRESS1(Buffer, RA); ++ SET_80211_HDR_ADDRESS2(Buffer, Adapter->CurrentAddress); ++ SET_80211_HDR_ADDRESS3(Buffer, pMgntInfo->Bssid); ++ ++ Duration = 2*aSifsTime + 40; ++ ++ if (BW == CHANNEL_WIDTH_40) ++ Duration+= 87; ++ else ++ Duration+= 180; ++ ++ SET_80211_HDR_DURATION(Buffer, Duration); ++ ++ //HT control field ++ SET_HT_CTRL_CSI_STEERING(Buffer+sMacHdrLng, 3); ++ SET_HT_CTRL_NDP_ANNOUNCEMENT(Buffer+sMacHdrLng, 1); ++ ++ FillOctetString(pNDPAFrame, Buffer, sMacHdrLng+sHTCLng); ++ ++ FillOctetString(ActionContent, ActionHdr, 4); ++ PacketAppendData(&pNDPAFrame, ActionContent); ++ ++ *pLength = 32; ++} ++ ++ ++ ++ ++BOOLEAN ++SendFWHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN CHANNEL_WIDTH BW ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PRT_TCB pTcb; ++ PRT_TX_LOCAL_BUFFER pBuf; ++ BOOLEAN ret = TRUE; ++ u4Byte BufLen; ++ pu1Byte BufAddr; ++ u1Byte DescLen = 0, Idx = 0, NDPTxRate; ++ PADAPTER pDefAdapter = GetDefaultAdapter(Adapter); ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (pBeamformEntry == NULL) ++ return FALSE; ++ ++ NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); ++ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (MgntGetFWBuffer(pDefAdapter, &pTcb, &pBuf)) { ++#if(DEV_BUS_TYPE != RT_PCI_INTERFACE) ++ DescLen = Adapter->HWDescHeadLength - pHalData->USBALLDummyLength; ++#endif ++ BufAddr = pBuf->Buffer.VirtualAddress + DescLen; ++ ++ ConstructHTNDPAPacket( ++ Adapter, ++ RA, ++ BufAddr, ++ &BufLen, ++ BW ++ ); ++ ++ pTcb->PacketLength = BufLen + DescLen; ++ ++ pTcb->bTxEnableSwCalcDur = TRUE; ++ ++ pTcb->BWOfPacket = BW; ++ ++ if(ACTING_AS_IBSS(Adapter) || ACTING_AS_AP(Adapter)) ++ pTcb->G_ID = 63; ++ ++ pTcb->P_AID = pBeamformEntry->P_AID; ++ pTcb->DataRate = NDPTxRate; /*rate of NDP decide by Nr*/ ++ ++ Adapter->HalFunc.CmdSendPacketHandler(Adapter, pTcb, pBuf, pTcb->PacketLength, DESC_PACKET_TYPE_NORMAL, FALSE); ++ } else ++ ret = FALSE; ++ ++ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (ret) ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); ++ ++ return ret; ++} ++ ++ ++BOOLEAN ++SendSWHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN CHANNEL_WIDTH BW ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PRT_TCB pTcb; ++ PRT_TX_LOCAL_BUFFER pBuf; ++ BOOLEAN ret = TRUE; ++ u1Byte Idx = 0, NDPTxRate = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); ++ ++ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { ++ ConstructHTNDPAPacket( ++ Adapter, ++ RA, ++ pBuf->Buffer.VirtualAddress, ++ &pTcb->PacketLength, ++ BW ++ ); ++ ++ pTcb->bTxEnableSwCalcDur = TRUE; ++ ++ pTcb->BWOfPacket = BW; ++ ++ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); ++ } else ++ ret = FALSE; ++ ++ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (ret) ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); ++ ++ return ret; ++} ++ ++ ++ ++VOID ++ConstructVHTNDPAPacket( ++ IN PDM_ODM_T pDM_Odm, ++ pu1Byte RA, ++ u2Byte AID, ++ pu1Byte Buffer, ++ pu4Byte pLength, ++ CHANNEL_WIDTH BW ++ ) ++{ ++ u2Byte Duration= 0; ++ u1Byte Sequence = 0; ++ pu1Byte pNDPAFrame = Buffer; ++ RT_NDPA_STA_INFO STAInfo; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ u1Byte Idx = 0; ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); ++ // Frame control. ++ SET_80211_HDR_FRAME_CONTROL(pNDPAFrame, 0); ++ SET_80211_HDR_TYPE_AND_SUBTYPE(pNDPAFrame, Type_NDPA); ++ ++ SET_80211_HDR_ADDRESS1(pNDPAFrame, RA); ++ SET_80211_HDR_ADDRESS2(pNDPAFrame, pBeamformEntry->MyMacAddr); ++ ++ Duration = 2*aSifsTime + 44; ++ ++ if (BW == CHANNEL_WIDTH_80) ++ Duration += 40; ++ else if(BW == CHANNEL_WIDTH_40) ++ Duration+= 87; ++ else ++ Duration+= 180; ++ ++ SET_80211_HDR_DURATION(pNDPAFrame, Duration); ++ ++ Sequence = *(pDM_Odm->pSoundingSeq) << 2; ++ ODM_MoveMemory(pDM_Odm, pNDPAFrame+16, &Sequence, 1); ++ ++ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS) || phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP) == FALSE) ++ AID = 0; ++ ++ STAInfo.AID = AID; ++ STAInfo.FeedbackType = 0; ++ STAInfo.NcIndex = 0; ++ ++ ODM_MoveMemory(pDM_Odm, pNDPAFrame+17, (pu1Byte)&STAInfo, 2); ++ ++ *pLength = 19; ++} ++ ++ ++BOOLEAN ++SendFWVHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN u2Byte AID, ++ IN CHANNEL_WIDTH BW ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PRT_TCB pTcb; ++ PRT_TX_LOCAL_BUFFER pBuf; ++ BOOLEAN ret = TRUE; ++ u4Byte BufLen; ++ pu1Byte BufAddr; ++ u1Byte DescLen = 0, Idx = 0, NDPTxRate = 0; ++ PADAPTER pDefAdapter = GetDefaultAdapter(Adapter); ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry =phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (pBeamformEntry == NULL) ++ return FALSE; ++ ++ NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); ++ ++ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (MgntGetFWBuffer(pDefAdapter, &pTcb, &pBuf)) { ++#if(DEV_BUS_TYPE != RT_PCI_INTERFACE) ++ DescLen = Adapter->HWDescHeadLength - pHalData->USBALLDummyLength; ++#endif ++ BufAddr = pBuf->Buffer.VirtualAddress + DescLen; ++ ++ ConstructVHTNDPAPacket( ++ pDM_Odm, ++ RA, ++ AID, ++ BufAddr, ++ &BufLen, ++ BW ++ ); ++ ++ pTcb->PacketLength = BufLen + DescLen; ++ ++ pTcb->bTxEnableSwCalcDur = TRUE; ++ ++ pTcb->BWOfPacket = BW; ++ ++ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS) || phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) ++ pTcb->G_ID = 63; ++ ++ pTcb->P_AID = pBeamformEntry->P_AID; ++ pTcb->DataRate = NDPTxRate; /*decide by Nr*/ ++ ++ Adapter->HalFunc.CmdSendPacketHandler(Adapter, pTcb, pBuf, pTcb->PacketLength, DESC_PACKET_TYPE_NORMAL, FALSE); ++ } else ++ ret = FALSE; ++ ++ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End, ret=%d\n", __func__, ret)); ++ ++ if (ret) ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); ++ ++ return ret; ++} ++ ++ ++ ++BOOLEAN ++SendSWVHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN u2Byte AID, ++ IN CHANNEL_WIDTH BW ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PRT_TCB pTcb; ++ PRT_TX_LOCAL_BUFFER pBuf; ++ BOOLEAN ret = TRUE; ++ u1Byte Idx = 0, NDPTxRate = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); ++ ++ NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); ++ ++ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { ++ ConstructVHTNDPAPacket( ++ pDM_Odm, ++ RA, ++ AID, ++ pBuf->Buffer.VirtualAddress, ++ &pTcb->PacketLength, ++ BW ++ ); ++ ++ pTcb->bTxEnableSwCalcDur = TRUE; ++ pTcb->BWOfPacket = BW; ++ ++ /*rate of NDP decide by Nr*/ ++ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); ++ } else ++ ret = FALSE; ++ ++ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (ret) ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); ++ ++ return ret; ++} ++ ++#ifdef SUPPORT_MU_BF ++#if (SUPPORT_MU_BF == 1) ++/* ++// Description: On VHT GID management frame by an MU beamformee. ++// ++// 2015.05.20. Created by tynli. ++*/ ++RT_STATUS ++Beamforming_GetVHTGIDMgntFrame( ++ IN PADAPTER Adapter, ++ IN PRT_RFD pRfd, ++ IN POCTET_STRING pPduOS ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; ++ RT_STATUS rtStatus = RT_STATUS_SUCCESS; ++ pu1Byte pBuffer = NULL; ++ pu1Byte pRaddr = NULL; ++ u1Byte MemStatus[8] = {0}, UserPos[16] = {0}; ++ u1Byte idx; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PRT_BEAMFORMER_ENTRY pBeamformEntry = &pBeamInfo->BeamformerEntry[pBeamInfo->mu_ap_index]; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] On VHT GID mgnt frame!\n", __func__)); ++ ++ /* Check length*/ ++ if (pPduOS->Length < (FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY+16)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Beamforming_GetVHTGIDMgntFrame(): Invalid length (%d)\n", pPduOS->Length)); ++ return RT_STATUS_INVALID_LENGTH; ++ } ++ ++ /* Check RA*/ ++ pRaddr = (pu1Byte)(pPduOS->Octet)+4; ++ if (!eqMacAddr(pRaddr, Adapter->CurrentAddress)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Beamforming_GetVHTGIDMgntFrame(): Drop because of RA error.\n")); ++ return RT_STATUS_PKT_DROP; ++ } ++ ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "On VHT GID Mgnt Frame ==>:\n", pPduOS->Octet, pPduOS->Length); ++ ++ /*Parsing Membership Status Array*/ ++ pBuffer = pPduOS->Octet + FRAME_OFFSET_VHT_GID_MGNT_MEMBERSHIP_STATUS_ARRAY; ++ for (idx = 0; idx < 8; idx++) { ++ MemStatus[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(pBuffer+idx); ++ pBeamformEntry->gid_valid[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(pBuffer+idx); ++ } ++ ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "MemStatus: ", MemStatus, 8); ++ ++ /* Parsing User Position Array*/ ++ pBuffer = pPduOS->Octet + FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY; ++ for (idx = 0; idx < 16; idx++) { ++ UserPos[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(pBuffer+idx); ++ pBeamformEntry->user_position[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(pBuffer+idx); ++ } ++ ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "UserPos: ", UserPos, 16); ++ ++ /* Group ID detail printed*/ ++ { ++ u1Byte i, j; ++ u1Byte tmpVal; ++ u2Byte tmpVal2; ++ ++ for (i = 0; i < 8; i++) { ++ tmpVal = MemStatus[i]; ++ tmpVal2 = ((UserPos[i*2 + 1] << 8) & 0xFF00) + (UserPos[i * 2] & 0xFF); ++ for (j = 0; j < 8; j++) { ++ if ((tmpVal >> j) & BIT0) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Use Group ID (%d), User Position (%d)\n", ++ (i*8+j), (tmpVal2 >> 2 * j)&0x3)); ++ } ++ } ++ } ++ } ++ ++ /* Indicate GID frame to IHV service. */ ++ { ++ u1Byte Indibuffer[24] = {0}; ++ u1Byte Indioffset = 0; ++ ++ PlatformMoveMemory(Indibuffer + Indioffset, pBeamformEntry->gid_valid, 8); ++ Indioffset += 8; ++ PlatformMoveMemory(Indibuffer + Indioffset, pBeamformEntry->user_position, 16); ++ Indioffset += 16; ++ ++ PlatformIndicateCustomStatus( ++ Adapter, ++ RT_CUSTOM_EVENT_VHT_RECV_GID_MGNT_FRAME, ++ RT_CUSTOM_INDI_TARGET_IHV, ++ Indibuffer, ++ Indioffset); ++ } ++ ++ /* Config HW GID table */ ++ halComTxbf_ConfigGtab(pDM_Odm); ++ ++ return rtStatus; ++} ++ ++/* ++// Description: Construct VHT Group ID (GID) management frame. ++// ++// 2015.05.20. Created by tynli. ++*/ ++VOID ++ConstructVHTGIDMgntFrame( ++ IN PDM_ODM_T pDM_Odm, ++ IN pu1Byte RA, ++ IN PRT_BEAMFORMEE_ENTRY pBeamformEntry, ++ OUT pu1Byte Buffer, ++ OUT pu4Byte pLength ++ ++) ++{ ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PADAPTER Adapter = pBeamInfo->SourceAdapter; ++ OCTET_STRING osFTMFrame, tmp; ++ ++ FillOctetString(osFTMFrame, Buffer, 0); ++ *pLength = 0; ++ ++ ConstructMaFrameHdr( ++ Adapter, ++ RA, ++ ACT_CAT_VHT, ++ ACT_VHT_GROUPID_MANAGEMENT, ++ &osFTMFrame); ++ ++ /* Membership Status Array*/ ++ FillOctetString(tmp, pBeamformEntry->gid_valid, 8); ++ PacketAppendData(&osFTMFrame, tmp); ++ ++ /* User Position Array*/ ++ FillOctetString(tmp, pBeamformEntry->user_position, 16); ++ PacketAppendData(&osFTMFrame, tmp); ++ ++ *pLength = osFTMFrame.Length; ++ ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "ConstructVHTGIDMgntFrame():\n", Buffer, *pLength); ++} ++ ++BOOLEAN ++SendSWVHTGIDMgntFrame( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN u1Byte Idx ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_TCB pTcb; ++ PRT_TX_LOCAL_BUFFER pBuf; ++ BOOLEAN ret = TRUE; ++ u1Byte DataRate = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = &pBeamInfo->BeamformeeEntry[Idx]; ++ PADAPTER Adapter = pBeamInfo->SourceAdapter; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { ++ ConstructVHTGIDMgntFrame( ++ pDM_Odm, ++ RA, ++ pBeamformEntry, ++ pBuf->Buffer.VirtualAddress, ++ &pTcb->PacketLength ++ ); ++ ++ pTcb->BWOfPacket = CHANNEL_WIDTH_20; ++ DataRate = MGN_6M; ++ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, DataRate); ++ } else ++ ret = FALSE; ++ ++ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (ret) ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); ++ ++ return ret; ++} ++ ++ ++/* ++// Description: Construct VHT beamforming report poll. ++// ++// 2015.05.20. Created by tynli. ++*/ ++VOID ++ConstructVHTBFReportPoll( ++ IN PDM_ODM_T pDM_Odm, ++ IN pu1Byte RA, ++ OUT pu1Byte Buffer, ++ OUT pu4Byte pLength ++) ++{ ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PADAPTER Adapter = pBeamInfo->SourceAdapter; ++ pu1Byte pBFRptPoll = Buffer; ++ ++ /* Frame control*/ ++ SET_80211_HDR_FRAME_CONTROL(pBFRptPoll, 0); ++ SET_80211_HDR_TYPE_AND_SUBTYPE(pBFRptPoll, Type_Beamforming_Report_Poll); ++ ++ /* Duration*/ ++ SET_80211_HDR_DURATION(pBFRptPoll, 100); ++ ++ /* RA*/ ++ SET_VHT_BF_REPORT_POLL_RA(pBFRptPoll, RA); ++ ++ /* TA*/ ++ SET_VHT_BF_REPORT_POLL_TA(pBFRptPoll, Adapter->CurrentAddress); ++ ++ /* Feedback Segment Retransmission Bitmap*/ ++ SET_VHT_BF_REPORT_POLL_FEEDBACK_SEG_RETRAN_BITMAP(pBFRptPoll, 0xFF); ++ ++ *pLength = 17; ++ ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "ConstructVHTBFReportPoll():\n", Buffer, *pLength); ++ ++} ++ ++BOOLEAN ++SendSWVHTBFReportPoll( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN BOOLEAN bFinalPoll ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_TCB pTcb; ++ PRT_TX_LOCAL_BUFFER pBuf; ++ BOOLEAN ret = TRUE; ++ u1Byte Idx = 0, DataRate = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); ++ PADAPTER Adapter = pBeamInfo->SourceAdapter; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { ++ ConstructVHTBFReportPoll( ++ pDM_Odm, ++ RA, ++ pBuf->Buffer.VirtualAddress, ++ &pTcb->PacketLength ++ ); ++ ++ pTcb->bTxEnableSwCalcDur = TRUE; /* need?*/ ++ pTcb->BWOfPacket = CHANNEL_WIDTH_20; ++ ++ if (bFinalPoll) ++ pTcb->TxBFPktType = RT_BF_PKT_TYPE_FINAL_BF_REPORT_POLL; ++ else ++ pTcb->TxBFPktType = RT_BF_PKT_TYPE_BF_REPORT_POLL; ++ ++ DataRate = MGN_6M; /* Legacy OFDM rate*/ ++ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, DataRate); ++ } else ++ ret = FALSE; ++ ++ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (ret) ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "SendSWVHTBFReportPoll():\n", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); ++ ++ return ret; ++ ++} ++ ++ ++/* ++// Description: Construct VHT MU NDPA packet. ++// We should combine this function with ConstructVHTNDPAPacket() in the future. ++// ++// 2015.05.21. Created by tynli. ++*/ ++VOID ++ConstructVHTMUNDPAPacket( ++ IN PDM_ODM_T pDM_Odm, ++ IN CHANNEL_WIDTH BW, ++ OUT pu1Byte Buffer, ++ OUT pu4Byte pLength ++ ) ++{ ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PADAPTER Adapter = pBeamInfo->SourceAdapter; ++ u2Byte Duration = 0; ++ u1Byte Sequence = 0; ++ pu1Byte pNDPAFrame = Buffer; ++ RT_NDPA_STA_INFO STAInfo; ++ u1Byte idx; ++ u1Byte DestAddr[6] = {0}; ++ PRT_BEAMFORMEE_ENTRY pEntry = NULL; ++ ++ /* Fill the first MU BFee entry (STA1) MAC addr to destination address then ++ HW will change A1 to broadcast addr. 2015.05.28. Suggested by SD1 Chunchu. */ ++ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { ++ pEntry = &(pBeamInfo->BeamformeeEntry[idx]); ++ if (pEntry->is_mu_sta) { ++ cpMacAddr(DestAddr, pEntry->MacAddr); ++ break; ++ } ++ } ++ if (pEntry == NULL) ++ return; ++ ++ /* Frame control.*/ ++ SET_80211_HDR_FRAME_CONTROL(pNDPAFrame, 0); ++ SET_80211_HDR_TYPE_AND_SUBTYPE(pNDPAFrame, Type_NDPA); ++ ++ SET_80211_HDR_ADDRESS1(pNDPAFrame, DestAddr); ++ SET_80211_HDR_ADDRESS2(pNDPAFrame, pEntry->MyMacAddr); ++ ++ /*--------------------------------------------*/ ++ /* Need to modify "Duration" to MU consideration. */ ++ Duration = 2*aSifsTime + 44; ++ ++ if (BW == CHANNEL_WIDTH_80) ++ Duration += 40; ++ else if(BW == CHANNEL_WIDTH_40) ++ Duration+= 87; ++ else ++ Duration+= 180; ++ /*--------------------------------------------*/ ++ ++ SET_80211_HDR_DURATION(pNDPAFrame, Duration); ++ ++ Sequence = *(pDM_Odm->pSoundingSeq) << 2; ++ ODM_MoveMemory(pDM_Odm, pNDPAFrame + 16, &Sequence, 1); ++ ++ *pLength = 17; ++ ++ /* Construct STA info. for multiple STAs*/ ++ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { ++ pEntry = &(pBeamInfo->BeamformeeEntry[idx]); ++ if (pEntry->is_mu_sta) { ++ STAInfo.AID = pEntry->AID; ++ STAInfo.FeedbackType = 1; /* 1'b1: MU*/ ++ STAInfo.NcIndex = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get BeamformeeEntry idx(%d), AID =%d\n", __func__, idx, pEntry->AID)); ++ ++ ODM_MoveMemory(pDM_Odm, pNDPAFrame+(*pLength), (pu1Byte)&STAInfo, 2); ++ *pLength += 2; ++ } ++ } ++ ++} ++ ++BOOLEAN ++SendSWVHTMUNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN CHANNEL_WIDTH BW ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_TCB pTcb; ++ PRT_TX_LOCAL_BUFFER pBuf; ++ BOOLEAN ret = TRUE; ++ u1Byte NDPTxRate = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PADAPTER Adapter = pBeamInfo->SourceAdapter; ++ ++ NDPTxRate = MGN_VHT2SS_MCS0; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); ++ ++ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { ++ ConstructVHTMUNDPAPacket( ++ pDM_Odm, ++ BW, ++ pBuf->Buffer.VirtualAddress, ++ &pTcb->PacketLength ++ ); ++ ++ pTcb->bTxEnableSwCalcDur = TRUE; ++ pTcb->BWOfPacket = BW; ++ pTcb->TxBFPktType = RT_BF_PKT_TYPE_BROADCAST_NDPA; ++ ++ /*rate of NDP decide by Nr*/ ++ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); ++ } else ++ ret = FALSE; ++ ++ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (ret) ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); ++ ++ return ret; ++} ++ ++ ++VOID ++DBG_ConstructVHTMUNDPAPacket( ++ IN PDM_ODM_T pDM_Odm, ++ IN CHANNEL_WIDTH BW, ++ OUT pu1Byte Buffer, ++ OUT pu4Byte pLength ++ ) ++{ ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PADAPTER Adapter = pBeamInfo->SourceAdapter; ++ u2Byte Duration = 0; ++ u1Byte Sequence = 0; ++ pu1Byte pNDPAFrame = Buffer; ++ RT_NDPA_STA_INFO STAInfo; ++ u1Byte idx; ++ u1Byte DestAddr[6] = {0}; ++ PRT_BEAMFORMEE_ENTRY pEntry = NULL; ++ ++ BOOLEAN is_STA1 = FALSE; ++ ++ ++ /* Fill the first MU BFee entry (STA1) MAC addr to destination address then ++ HW will change A1 to broadcast addr. 2015.05.28. Suggested by SD1 Chunchu. */ ++ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { ++ pEntry = &(pBeamInfo->BeamformeeEntry[idx]); ++ if (pEntry->is_mu_sta) { ++ if (is_STA1 == FALSE) { ++ is_STA1 = TRUE; ++ continue; ++ } else { ++ cpMacAddr(DestAddr, pEntry->MacAddr); ++ break; ++ } ++ } ++ } ++ ++ /* Frame control.*/ ++ SET_80211_HDR_FRAME_CONTROL(pNDPAFrame, 0); ++ SET_80211_HDR_TYPE_AND_SUBTYPE(pNDPAFrame, Type_NDPA); ++ ++ SET_80211_HDR_ADDRESS1(pNDPAFrame, DestAddr); ++ SET_80211_HDR_ADDRESS2(pNDPAFrame, pDM_Odm->CurrentAddress); ++ ++ /*--------------------------------------------*/ ++ /* Need to modify "Duration" to MU consideration. */ ++ Duration = 2*aSifsTime + 44; ++ ++ if (BW == CHANNEL_WIDTH_80) ++ Duration += 40; ++ else if (BW == CHANNEL_WIDTH_40) ++ Duration += 87; ++ else ++ Duration += 180; ++ /*--------------------------------------------*/ ++ ++ SET_80211_HDR_DURATION(pNDPAFrame, Duration); ++ ++ Sequence = *(pDM_Odm->pSoundingSeq) << 2; ++ ODM_MoveMemory(pDM_Odm, pNDPAFrame + 16, &Sequence, 1); ++ ++ *pLength = 17; ++ ++ /*STA2's STA Info*/ ++ STAInfo.AID = pEntry->AID; ++ STAInfo.FeedbackType = 1; /* 1'b1: MU */ ++ STAInfo.NcIndex = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get BeamformeeEntry idx(%d), AID =%d\n", __func__, idx, pEntry->AID)); ++ ++ ODM_MoveMemory(pDM_Odm, pNDPAFrame+(*pLength), (pu1Byte)&STAInfo, 2); ++ *pLength += 2; ++ ++} ++ ++BOOLEAN ++DBG_SendSWVHTMUNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN CHANNEL_WIDTH BW ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_TCB pTcb; ++ PRT_TX_LOCAL_BUFFER pBuf; ++ BOOLEAN ret = TRUE; ++ u1Byte NDPTxRate = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PADAPTER Adapter = pBeamInfo->SourceAdapter; ++ ++ NDPTxRate = MGN_VHT2SS_MCS0; ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); ++ ++ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { ++ DBG_ConstructVHTMUNDPAPacket( ++ pDM_Odm, ++ BW, ++ pBuf->Buffer.VirtualAddress, ++ &pTcb->PacketLength ++ ); ++ ++ pTcb->bTxEnableSwCalcDur = TRUE; ++ pTcb->BWOfPacket = BW; ++ pTcb->TxBFPktType = RT_BF_PKT_TYPE_UNICAST_NDPA; ++ ++ /*rate of NDP decide by Nr*/ ++ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); ++ } else ++ ret = FALSE; ++ ++ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (ret) ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); ++ ++ return ret; ++} ++ ++ ++#endif /*#if (SUPPORT_MU_BF == 1)*/ ++#endif /*#ifdef SUPPORT_MU_BF*/ ++ ++ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ ++u4Byte ++Beamforming_GetReportFrame( ++ IN PVOID pDM_VOID, ++ union recv_frame *precv_frame ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u4Byte ret = _SUCCESS; ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; ++ pu1Byte pframe = precv_frame->u.hdr.rx_data; ++ u4Byte frame_len = precv_frame->u.hdr.len; ++ pu1Byte TA; ++ u1Byte Idx, offset; ++ ++ ++ /*Memory comparison to see if CSI report is the same with previous one*/ ++ TA = GetAddr2Ptr(pframe); ++ pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, TA, &Idx); ++ if(pBeamformEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) ++ offset = 31; /*24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ ++ else if(pBeamformEntry->BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT) ++ offset = 34; /*24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ ++ else ++ return ret; ++ ++ ++ return ret; ++} ++ ++ ++BOOLEAN ++SendFWHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN CHANNEL_WIDTH BW ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u1Byte ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; ++ u1Byte *pframe; ++ u2Byte *fctrl; ++ u2Byte duration = 0; ++ u1Byte aSifsTime = 0, NDPTxRate = 0, Idx = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ ++ if (pmgntframe == NULL) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); ++ return _FALSE; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(Adapter, pattrib); ++ ++ pattrib->qsel = QSLT_BEACON; ++ NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); ++ pattrib->rate = NDPTxRate; ++ pattrib->bwmode = BW; ++ pattrib->order = 1; ++ pattrib->subtype = WIFI_ACTION_NOACK; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; ++ ++ fctrl = &pwlanhdr->frame_ctl; ++ *(fctrl) = 0; ++ ++ SetOrderBit(pframe); ++ SetFrameSubType(pframe, WIFI_ACTION_NOACK); ++ ++ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ if( pmlmeext->cur_wireless_mode == WIRELESS_11B) ++ aSifsTime = 10; ++ else ++ aSifsTime = 16; ++ ++ duration = 2*aSifsTime + 40; ++ ++ if(BW == CHANNEL_WIDTH_40) ++ duration+= 87; ++ else ++ duration+= 180; ++ ++ SetDuration(pframe, duration); ++ ++ //HT control field ++ SET_HT_CTRL_CSI_STEERING(pframe+24, 3); ++ SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe+24, 1); ++ ++ _rtw_memcpy(pframe+28, ActionHdr, 4); ++ ++ pattrib->pktlen = 32; ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(Adapter, pmgntframe); ++ ++ return _TRUE; ++} ++ ++ ++BOOLEAN ++SendSWHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN CHANNEL_WIDTH BW ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u1Byte ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; ++ pu1Byte pframe; ++ pu2Byte fctrl; ++ u2Byte duration = 0; ++ u1Byte aSifsTime = 0, NDPTxRate = 0, Idx = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); ++ ++ NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ ++ if (pmgntframe == NULL) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); ++ return _FALSE; ++ } ++ ++ /*update attribute*/ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(Adapter, pattrib); ++ pattrib->qsel = QSLT_MGNT; ++ pattrib->rate = NDPTxRate; ++ pattrib->bwmode = BW; ++ pattrib->order = 1; ++ pattrib->subtype = WIFI_ACTION_NOACK; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &pwlanhdr->frame_ctl; ++ *(fctrl) = 0; ++ ++ SetOrderBit(pframe); ++ SetFrameSubType(pframe, WIFI_ACTION_NOACK); ++ ++ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ if (pmlmeext->cur_wireless_mode == WIRELESS_11B) ++ aSifsTime = 10; ++ else ++ aSifsTime = 16; ++ ++ duration = 2*aSifsTime + 40; ++ ++ if (BW == CHANNEL_WIDTH_40) ++ duration += 87; ++ else ++ duration += 180; ++ ++ SetDuration(pframe, duration); ++ ++ /*HT control field*/ ++ SET_HT_CTRL_CSI_STEERING(pframe+24, 3); ++ SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe+24, 1); ++ ++ _rtw_memcpy(pframe+28, ActionHdr, 4); ++ ++ pattrib->pktlen = 32; ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(Adapter, pmgntframe); ++ ++ return _TRUE; ++} ++ ++ ++BOOLEAN ++SendFWVHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN u2Byte AID, ++ IN CHANNEL_WIDTH BW ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ pu1Byte pframe; ++ pu2Byte fctrl; ++ u2Byte duration = 0; ++ u1Byte sequence = 0, aSifsTime = 0, NDPTxRate= 0, Idx = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); ++ RT_NDPA_STA_INFO sta_info; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ ++ if (pmgntframe == NULL) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); ++ return _FALSE; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ _rtw_memcpy(pattrib->ra, RA, ETH_ALEN); ++ update_mgntframe_attrib(Adapter, pattrib); ++ ++ pattrib->qsel = QSLT_BEACON; ++ NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); ++ pattrib->rate = NDPTxRate; ++ pattrib->bwmode = BW; ++ pattrib->subtype = WIFI_NDPA; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; ++ ++ fctrl = &pwlanhdr->frame_ctl; ++ *(fctrl) = 0; ++ ++ SetFrameSubType(pframe, WIFI_NDPA); ++ ++ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); ++ ++ if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) ++ aSifsTime = 16; ++ else ++ aSifsTime = 10; ++ ++ duration = 2*aSifsTime + 44; ++ ++ if(BW == CHANNEL_WIDTH_80) ++ duration += 40; ++ else if(BW == CHANNEL_WIDTH_40) ++ duration+= 87; ++ else ++ duration+= 180; ++ ++ SetDuration(pframe, duration); ++ ++ sequence = pBeamInfo->SoundingSequence<< 2; ++ if (pBeamInfo->SoundingSequence >= 0x3f) ++ pBeamInfo->SoundingSequence = 0; ++ else ++ pBeamInfo->SoundingSequence++; ++ ++ _rtw_memcpy(pframe+16, &sequence,1); ++ ++ if (((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) ++ AID = 0; ++ ++ sta_info.AID = AID; ++ sta_info.FeedbackType = 0; ++ sta_info.NcIndex= 0; ++ ++ _rtw_memcpy(pframe+17, (u8 *)&sta_info, 2); ++ ++ pattrib->pktlen = 19; ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(Adapter, pmgntframe); ++ ++ return _TRUE; ++} ++ ++ ++ ++BOOLEAN ++SendSWVHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN u2Byte AID, ++ IN CHANNEL_WIDTH BW ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ RT_NDPA_STA_INFO ndpa_sta_info; ++ u1Byte NDPTxRate = 0, sequence = 0, aSifsTime = 0, Idx = 0; ++ pu1Byte pframe; ++ pu2Byte fctrl; ++ u2Byte duration = 0; ++ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); ++ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); ++ ++ NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ ++ if (pmgntframe == NULL) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); ++ return _FALSE; ++ } ++ ++ /*update attribute*/ ++ pattrib = &pmgntframe->attrib; ++ _rtw_memcpy(pattrib->ra, RA, ETH_ALEN); ++ update_mgntframe_attrib(Adapter, pattrib); ++ pattrib->qsel = QSLT_MGNT; ++ pattrib->rate = NDPTxRate; ++ pattrib->bwmode = BW; ++ pattrib->subtype = WIFI_NDPA; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &pwlanhdr->frame_ctl; ++ *(fctrl) = 0; ++ ++ SetFrameSubType(pframe, WIFI_NDPA); ++ ++ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); ++ ++ if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) ++ aSifsTime = 16; ++ else ++ aSifsTime = 10; ++ ++ duration = 2*aSifsTime + 44; ++ ++ if (BW == CHANNEL_WIDTH_80) ++ duration += 40; ++ else if (BW == CHANNEL_WIDTH_40) ++ duration += 87; ++ else ++ duration += 180; ++ ++ SetDuration(pframe, duration); ++ ++ sequence = pBeamInfo->SoundingSequence << 2; ++ if (pBeamInfo->SoundingSequence >= 0x3f) ++ pBeamInfo->SoundingSequence = 0; ++ else ++ pBeamInfo->SoundingSequence++; ++ ++ _rtw_memcpy(pframe+16, &sequence, 1); ++ if (((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) ++ AID = 0; ++ ++ ndpa_sta_info.AID = AID; ++ ndpa_sta_info.FeedbackType = 0; ++ ndpa_sta_info.NcIndex = 0; ++ ++ _rtw_memcpy(pframe+17, (u8 *)&ndpa_sta_info, 2); ++ ++ pattrib->pktlen = 19; ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(Adapter, pmgntframe); ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] [%d]\n", __func__, __LINE__)); ++ ++ return _TRUE; ++} ++ ++ ++#endif ++ ++ ++VOID ++Beamforming_GetNDPAFrame( ++ IN PVOID pDM_VOID, ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN OCTET_STRING pduOS ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ union recv_frame *precv_frame ++#endif ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ pu1Byte TA ; ++ u1Byte Idx, Sequence; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ pu1Byte pNDPAFrame = pduOS.Octet; ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ pu1Byte pNDPAFrame = precv_frame->u.hdr.rx_data; ++#endif ++ PRT_BEAMFORMER_ENTRY pBeamformerEntry = NULL; /*Modified By Jeffery @2014-10-29*/ ++ ++ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ RT_DISP_DATA(FBEAM, FBEAM_DATA, "Beamforming_GetNDPAFrame\n", pduOS.Octet, pduOS.Length); ++ if (IsCtrlNDPA(pNDPAFrame) == FALSE) ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ if (GetFrameSubType(pNDPAFrame) != WIFI_NDPA) ++#endif ++ return; ++ else if (!(pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8821))) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] not 8812 or 8821A, return\n", __func__)); ++ return; ++ } ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ TA = Frame_Addr2(pduOS); ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ TA = GetAddr2Ptr(pNDPAFrame); ++#endif ++ /*Remove signaling TA. */ ++ TA[0] = TA[0] & 0xFE; ++ ++ pBeamformerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, TA, &Idx); // Modified By Jeffery @2014-10-29 ++ ++ /*Break options for Clock Reset*/ ++ if (pBeamformerEntry == NULL) ++ return; ++ else if (!(pBeamformerEntry->BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU)) ++ return; ++ /*LogSuccess: As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is NO LONGER needed !2015-04-10, Jeffery*/ ++ /*ClockResetTimes: While BFer entry always doesn't receive our CSI, clock will reset again and again.So ClockResetTimes is limited to 5 times.2015-04-13, Jeffery*/ ++ else if ((pBeamformerEntry->LogSuccess == 1) || (pBeamformerEntry->ClockResetTimes == 5)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] LogSeq=%d, PreLogSeq=%d, LogRetryCnt=%d, LogSuccess=%d, ClockResetTimes=%d, clock reset is no longer needed.\n", ++ __func__, pBeamformerEntry->LogSeq, pBeamformerEntry->PreLogSeq, pBeamformerEntry->LogRetryCnt, pBeamformerEntry->LogSuccess, pBeamformerEntry->ClockResetTimes)); ++ ++ return; ++ } ++ ++ Sequence = (pNDPAFrame[16]) >> 2; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start, Sequence=%d, LogSeq=%d, PreLogSeq=%d, LogRetryCnt=%d, ClockResetTimes=%d, LogSuccess=%d\n", ++ __func__, Sequence, pBeamformerEntry->LogSeq, pBeamformerEntry->PreLogSeq, pBeamformerEntry->LogRetryCnt, pBeamformerEntry->ClockResetTimes, pBeamformerEntry->LogSuccess)); ++ ++ if ((pBeamformerEntry->LogSeq != 0) && (pBeamformerEntry->PreLogSeq != 0)) { ++ /*Success condition*/ ++ if ((pBeamformerEntry->LogSeq != Sequence) && (pBeamformerEntry->PreLogSeq != pBeamformerEntry->LogSeq)) { ++ /* break option for clcok reset, 2015-03-30, Jeffery */ ++ pBeamformerEntry->LogRetryCnt = 0; ++ /*As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is no longer needed.*/ ++ /*That is, LogSuccess is NOT needed to be reset to zero, 2015-04-13, Jeffery*/ ++ pBeamformerEntry->LogSuccess = 1; ++ ++ } else {/*Fail condition*/ ++ ++ if (pBeamformerEntry->LogRetryCnt == 5) { ++ pBeamformerEntry->ClockResetTimes++; ++ pBeamformerEntry->LogRetryCnt = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Clock Reset!!! ClockResetTimes=%d\n", ++ __func__, pBeamformerEntry->ClockResetTimes)); ++ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_CLK, NULL); ++ ++ } else ++ pBeamformerEntry->LogRetryCnt++; ++ } ++ } ++ ++ /*Update LogSeq & PreLogSeq*/ ++ pBeamformerEntry->PreLogSeq = pBeamformerEntry->LogSeq; ++ pBeamformerEntry->LogSeq = Sequence; ++ ++} ++ ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.h 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,162 @@ ++#ifndef __HAL_TXBF_INTERFACE_H__ ++#define __HAL_TXBF_INTERFACE_H__ ++ ++#if (BEAMFORMING_SUPPORT == 1) ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++VOID ++Beamforming_GidPAid( ++ PADAPTER Adapter, ++ PRT_TCB pTcb ++ ); ++ ++RT_STATUS ++Beamforming_GetReportFrame( ++ IN PADAPTER Adapter, ++ IN PRT_RFD pRfd, ++ IN POCTET_STRING pPduOS ++ ); ++ ++VOID ++Beamforming_GetNDPAFrame( ++ IN PVOID pDM_VOID, ++ IN OCTET_STRING pduOS ++ ); ++ ++BOOLEAN ++SendFWHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN CHANNEL_WIDTH BW ++ ); ++ ++BOOLEAN ++SendFWVHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN u2Byte AID, ++ IN CHANNEL_WIDTH BW ++ ); ++ ++BOOLEAN ++SendSWVHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN u2Byte AID, ++ IN CHANNEL_WIDTH BW ++ ); ++ ++BOOLEAN ++SendSWHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN CHANNEL_WIDTH BW ++ ); ++ ++#if (SUPPORT_MU_BF == 1) ++RT_STATUS ++Beamforming_GetVHTGIDMgntFrame( ++ IN PADAPTER Adapter, ++ IN PRT_RFD pRfd, ++ IN POCTET_STRING pPduOS ++ ); ++ ++BOOLEAN ++SendSWVHTGIDMgntFrame( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN u1Byte Idx ++ ); ++ ++BOOLEAN ++SendSWVHTBFReportPoll( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN BOOLEAN bFinalPoll ++ ); ++ ++BOOLEAN ++SendSWVHTMUNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN CHANNEL_WIDTH BW ++ ); ++#else ++#define Beamforming_GetVHTGIDMgntFrame(Adapter, pRfd, pPduOS) RT_STATUS_FAILURE ++#define SendSWVHTGIDMgntFrame(pDM_VOID, RA) ++#define SendSWVHTBFReportPoll(pDM_VOID, RA, bFinalPoll) ++#define SendSWVHTMUNDPAPacket(pDM_VOID, BW) ++#endif ++ ++ ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ ++u4Byte ++Beamforming_GetReportFrame( ++ IN PVOID pDM_VOID, ++ union recv_frame *precv_frame ++ ); ++ ++BOOLEAN ++SendFWHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN CHANNEL_WIDTH BW ++ ); ++ ++BOOLEAN ++SendSWHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN CHANNEL_WIDTH BW ++ ); ++ ++BOOLEAN ++SendFWVHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN u2Byte AID, ++ IN CHANNEL_WIDTH BW ++ ); ++ ++BOOLEAN ++SendSWVHTNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN pu1Byte RA, ++ IN u2Byte AID, ++ IN CHANNEL_WIDTH BW ++ ); ++#endif ++ ++VOID ++Beamforming_GetNDPAFrame( ++ IN PVOID pDM_VOID, ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ IN OCTET_STRING pduOS ++#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) ++ union recv_frame *precv_frame ++#endif ++); ++ ++BOOLEAN ++DBG_SendSWVHTMUNDPAPacket( ++ IN PVOID pDM_VOID, ++ IN CHANNEL_WIDTH BW ++ ); ++ ++#else ++#define Beamforming_GetNDPAFrame(pDM_Odm, _PduOS) ++#if (DM_ODM_SUPPORT_TYPE == ODM_CE) ++#define Beamforming_GetReportFrame(Adapter, precv_frame) RT_STATUS_FAILURE ++#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++#define Beamforming_GetReportFrame(Adapter, pRfd, pPduOS) RT_STATUS_FAILURE ++#define Beamforming_GetVHTGIDMgntFrame(Adapter, pRfd, pPduOS) RT_STATUS_FAILURE ++#endif ++#define SendFWHTNDPAPacket(pDM_VOID, RA, BW) ++#define SendSWHTNDPAPacket(pDM_VOID, RA, BW) ++#define SendFWVHTNDPAPacket(pDM_VOID, RA, AID, BW) ++#define SendSWVHTNDPAPacket(pDM_VOID, RA, AID, BW) ++#define SendSWVHTGIDMgntFrame(pDM_VOID, RA, idx) ++#define SendSWVHTBFReportPoll(pDM_VOID, RA, bFinalPoll) ++#define SendSWVHTMUNDPAPacket(pDM_VOID, BW) ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.c 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,527 @@ ++//============================================================ ++// Description: ++// ++// This file is for 8812/8821/8811 TXBF mechanism ++// ++//============================================================ ++#include "mp_precomp.h" ++#include "../phydm_precomp.h" ++ ++#if (BEAMFORMING_SUPPORT == 1) ++#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) ++VOID ++HalTxbf8812A_setNDPArate( ++ IN PVOID pDM_VOID, ++ IN u1Byte BW, ++ IN u1Byte Rate ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8812A, (Rate << 2 | BW)); ++ ++} ++ ++VOID ++halTxbfJaguar_RfMode( ++ IN PVOID pDM_VOID, ++ IN PRT_BEAMFORMING_INFO pBeamInfo ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ if (pDM_Odm->RFType == ODM_1T1R) ++ return; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] set TxIQGen\n", __func__)); ++ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000, 0x1); /*RF Mode table write enable*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000, 0x1); /*RF Mode table write enable*/ ++ ++ if (pBeamInfo->beamformee_su_cnt > 0) { ++ // Paath_A ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ ++ // Path_B ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ ++ } else { ++ // Paath_A ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ ++ // Path_B ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ ++ } ++ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000, 0x0); /*RF Mode table write disable*/ ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000, 0x0); /*RF Mode table write disable*/ ++ ++ if (pBeamInfo->beamformee_su_cnt > 0) ++ ODM_SetBBReg(pDM_Odm, rTxPath_Jaguar, bMaskByte1, 0x33); ++ else ++ ODM_SetBBReg(pDM_Odm, rTxPath_Jaguar, bMaskByte1, 0x11); ++} ++ ++ ++VOID ++halTxbfJaguar_DownloadNDPA( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte u1bTmp = 0, tmpReg422 = 0, Head_Page; ++ u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; ++ BOOLEAN bSendBeacon = FALSE; ++ u1Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; /*default reseved 1 page for the IC type which is undefined.*/ ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ *pDM_Odm->pbFwDwRsvdPageInProgress = TRUE; ++#endif ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (Idx == 0) ++ Head_Page = 0xFE; ++ else ++ Head_Page = 0xFE; ++ ++ Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu1Byte)&TxPageBndy); ++ ++ /*Set REG_CR bit 8. DMA beacon by SW.*/ ++ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8812A + 1); ++ ODM_Write1Byte(pDM_Odm, REG_CR_8812A + 1, (u1bTmp | BIT0)); ++ ++ ++ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ ++ tmpReg422 = ODM_Read1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8812A + 2); ++ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8812A + 2, tmpReg422 & (~BIT6)); ++ ++ if (tmpReg422 & BIT6) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("SetBeamformDownloadNDPA_8812(): There is an Adapter is sending beacon.\n")); ++ bSendBeacon = TRUE; ++ } ++ ++ /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ ++ ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 1, Head_Page); ++ ++ do { ++ /*Clear beacon valid check bit.*/ ++ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); ++ ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 2, (BcnValidReg | BIT0)); ++ ++ /*download NDPA rsvd page.*/ ++ if (pBeamEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) ++ Beamforming_SendVHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->AID, pBeamEntry->SoundBW, BEACON_QUEUE); ++ else ++ Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); ++ ++ /*check rsvd page download OK.*/ ++ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); ++ count = 0; ++ while (!(BcnValidReg & BIT0) && count < 20) { ++ count++; ++ ODM_delay_ms(10); ++ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); ++ } ++ DLBcnCount++; ++ } while (!(BcnValidReg & BIT0) && DLBcnCount < 5); ++ ++ if (!(BcnValidReg & BIT0)) ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Download RSVD page failed!\n", __func__)); ++ ++ /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ ++ ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 1, TxPageBndy); ++ ++ /*To make sure that if there exists an adapter which would like to send beacon.*/ ++ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ ++ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause*/ ++ /*the beacon cannot be sent by HW.*/ ++ /*2010.06.23. Added by tynli.*/ ++ if (bSendBeacon) ++ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8812A + 2, tmpReg422); ++ ++ /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ ++ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ ++ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8812A + 1); ++ ODM_Write1Byte(pDM_Odm, REG_CR_8812A + 1, (u1bTmp & (~BIT0))); ++ ++ pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ *pDM_Odm->pbFwDwRsvdPageInProgress = FALSE; ++#endif ++} ++ ++ ++VOID ++halTxbfJaguar_FwTxBFCmd( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte Idx, Period0 = 0, Period1 = 0; ++ u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; ++ u1Byte u1TxBFParm[3] = {0}; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ ++ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { ++ /*Modified by David*/ ++ if (pBeamInfo->BeamformeeEntry[Idx].bUsed && pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { ++ if (Idx == 0) { ++ if (pBeamInfo->BeamformeeEntry[Idx].bSound) ++ PageNum0 = 0xFE; ++ else ++ PageNum0 = 0xFF; /*stop sounding*/ ++ Period0 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); ++ } else if (Idx == 1) { ++ if (pBeamInfo->BeamformeeEntry[Idx].bSound) ++ PageNum1 = 0xFE; ++ else ++ PageNum1 = 0xFF; /*stop sounding*/ ++ Period1 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); ++ } ++ } ++ } ++ ++ u1TxBFParm[0] = PageNum0; ++ u1TxBFParm[1] = PageNum1; ++ u1TxBFParm[2] = (Period1 << 4) | Period0; ++ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_TXBF, 3, u1TxBFParm); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ++ ("[%s] PageNum0 = %d Period0 = %d, PageNum1 = %d Period1 %d\n", __func__, PageNum0, Period0, PageNum1, Period1)); ++} ++ ++ ++VOID ++HalTxbfJaguar_Enter( ++ IN PVOID pDM_VOID, ++ IN u1Byte BFerBFeeIdx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte i = 0; ++ u1Byte BFerIdx = (BFerBFeeIdx & 0xF0) >> 4; ++ u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); ++ u4Byte CSI_Param; ++ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; ++ RT_BEAMFORMEE_ENTRY BeamformeeEntry; ++ RT_BEAMFORMER_ENTRY BeamformerEntry; ++ u2Byte STAid = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Start!\n", __func__)); ++ ++ halTxbfJaguar_RfMode(pDM_Odm, pBeamformingInfo); ++ ++ if (pDM_Odm->RFType == ODM_2T2R) ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CSI_CONTENT_VALUE, bMaskDWord, 0x00000000); /*Nc =2*/ ++ else ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CSI_CONTENT_VALUE, bMaskDWord, 0x01081008); /*Nc =1*/ ++ ++ if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { ++ BeamformerEntry = pBeamformingInfo->BeamformerEntry[BFerIdx]; ++ ++ /*Sounding protocol control*/ ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xCB); ++ ++ /*MAC address/Partial AID of Beamformer*/ ++ if (BFerIdx == 0) { ++ for (i = 0; i < 6 ; i++) ++ ODM_Write1Byte(pDM_Odm, (REG_BFMER0_INFO_8812A + i), BeamformerEntry.MacAddr[i]); ++ /*CSI report use legacy ofdm so don't need to fill P_AID. */ ++ /*PlatformEFIOWrite2Byte(Adapter, REG_BFMER0_INFO_8812A+6, BeamformEntry.P_AID); */ ++ } else { ++ for (i = 0; i < 6 ; i++) ++ ODM_Write1Byte(pDM_Odm, (REG_BFMER1_INFO_8812A + i), BeamformerEntry.MacAddr[i]); ++ /*CSI report use legacy ofdm so don't need to fill P_AID.*/ ++ /*PlatformEFIOWrite2Byte(Adapter, REG_BFMER1_INFO_8812A+6, BeamformEntry.P_AID);*/ ++ } ++ ++ /*CSI report parameters of Beamformee*/ ++ if (BeamformerEntry.BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU) { ++ if (pDM_Odm->RFType == ODM_2T2R) ++ CSI_Param = 0x01090109; ++ else ++ CSI_Param = 0x01080108; ++ } else { ++ if (pDM_Odm->RFType == ODM_2T2R) ++ CSI_Param = 0x03090309; ++ else ++ CSI_Param = 0x03080308; ++ } ++ ++ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8812A, CSI_Param); ++ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8812A, CSI_Param); ++ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8812A, CSI_Param); ++ ++ /*Timeout value for MAC to leave NDP_RX_standby_state (60 us, Test chip) (80 us, MP chip)*/ ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A + 3, 0x50); ++ } ++ ++ ++ if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { ++ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[BFeeIdx]; ++ ++ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) ++ STAid = BeamformeeEntry.MacId; ++ else ++ STAid = BeamformeeEntry.P_AID; ++ ++ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ ++ if (BFeeIdx == 0) { ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A, STAid); ++ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 3) | BIT4 | BIT6 | BIT7); ++ } else ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 2, STAid | BIT12 | BIT14 | BIT15); ++ ++ /*CSI report parameters of Beamformee*/ ++ if (BFeeIdx == 0) { ++ /*Get BIT24 & BIT25*/ ++ u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 3) & 0x3; ++ ++ ODM_Write1Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 3, tmp | 0x60); ++ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A, STAid | BIT9); ++ } else { ++ /*Set BIT25*/ ++ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2, STAid | 0xE200); ++ } ++ phydm_Beamforming_Notify(pDM_Odm); ++ } ++} ++ ++ ++VOID ++HalTxbfJaguar_Leave( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; ++ RT_BEAMFORMER_ENTRY BeamformerEntry; ++ RT_BEAMFORMEE_ENTRY BeamformeeEntry; ++ ++ if (Idx < BEAMFORMER_ENTRY_NUM) { ++ BeamformerEntry = pBeamformingInfo->BeamformerEntry[Idx]; ++ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[Idx]; ++ } else ++ return; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Start!, IDx = %d\n", __func__, Idx)); ++ ++ /*Clear P_AID of Beamformee*/ ++ /*Clear MAC address of Beamformer*/ ++ /*Clear Associated Bfmee Sel*/ ++ ++ if (BeamformerEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xC8); ++ if (Idx == 0) { ++ ODM_Write4Byte(pDM_Odm, REG_BFMER0_INFO_8812A, 0); ++ ODM_Write2Byte(pDM_Odm, REG_BFMER0_INFO_8812A + 4, 0); ++ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8812A, 0); ++ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8812A, 0); ++ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8812A, 0); ++ } else { ++ ODM_Write4Byte(pDM_Odm, REG_BFMER1_INFO_8812A, 0); ++ ODM_Write2Byte(pDM_Odm, REG_BFMER1_INFO_8812A + 4, 0); ++ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8812A, 0); ++ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8812A, 0); ++ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8812A, 0); ++ } ++ } ++ ++ if (BeamformeeEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { ++ halTxbfJaguar_RfMode(pDM_Odm, pBeamformingInfo); ++ if (Idx == 0) { ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A, 0x0); ++ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A, 0); ++ } else { ++ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 2, ODM_Read2Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 2) & 0xF000); ++ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2, ODM_Read2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2) & 0x60); ++ } ++ } ++ ++} ++ ++ ++VOID ++HalTxbfJaguar_Status( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u2Byte BeamCtrlVal; ++ u4Byte BeamCtrlReg; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ RT_BEAMFORMEE_ENTRY BeamformEntry = pBeamInfo->BeamformeeEntry[Idx]; ++ ++ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) ++ BeamCtrlVal = BeamformEntry.MacId; ++ else ++ BeamCtrlVal = BeamformEntry.P_AID; ++ ++ if (Idx == 0) ++ BeamCtrlReg = REG_TXBF_CTRL_8812A; ++ else { ++ BeamCtrlReg = REG_TXBF_CTRL_8812A + 2; ++ BeamCtrlVal |= BIT12 | BIT14 | BIT15; ++ } ++ ++ if ((BeamformEntry.BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) && (pBeamInfo->applyVmatrix == TRUE)) { ++ if (BeamformEntry.SoundBW == CHANNEL_WIDTH_20) ++ BeamCtrlVal |= BIT9; ++ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_40) ++ BeamCtrlVal |= (BIT9 | BIT10); ++ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_80) ++ BeamCtrlVal |= (BIT9 | BIT10 | BIT11); ++ } else ++ BeamCtrlVal &= ~(BIT9 | BIT10 | BIT11); ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BeamCtrlVal = 0x%x!\n", __func__, BeamCtrlVal)); ++ ++ ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); ++} ++ ++ ++ ++VOID ++HalTxbfJaguar_FwTxBF( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) ++ halTxbfJaguar_DownloadNDPA(pDM_Odm, Idx); ++ ++ halTxbfJaguar_FwTxBFCmd(pDM_Odm); ++} ++ ++ ++VOID ++HalTxbfJaguar_Patch( ++ IN PVOID pDM_VOID, ++ IN u1Byte Operation ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (pBeamInfo->BeamformCap == BEAMFORMING_CAP_NONE) ++ return; ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ if (Operation == SCAN_OPT_BACKUP_BAND0) ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xC8); ++ else if (Operation == SCAN_OPT_RESTORE) ++ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xCB); ++#endif ++} ++ ++VOID ++HalTxbfJaguar_Clk_8812A( ++ IN PVOID pDM_VOID ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u2Byte u2btmp; ++ u1Byte Count = 0, u1btmp; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); ++ ++ if (*(pDM_Odm->pbScanInProcess)) { ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] return by Scan\n", __func__)); ++ return; ++ } ++#if DEV_BUS_TYPE == RT_PCI_INTERFACE ++ /*Stop PCIe TxDMA*/ ++ ODM_Write1Byte(pDM_Odm, REG_PCIE_CTRL_REG_8812A + 1, 0xFE); ++#endif ++ ++ /*Stop Usb TxDMA*/ ++#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ++ RT_DISABLE_FUNC(Adapter, DF_TX_BIT); ++ PlatformReturnAllPendingTxPackets(Adapter); ++#else ++ rtw_write_port_cancel(Adapter); ++#endif ++ ++ /*Wait TXFF empty*/ ++ for (Count = 0; Count < 100; Count++) { ++ u2btmp = ODM_Read2Byte(pDM_Odm, REG_TXPKT_EMPTY_8812A); ++ u2btmp = u2btmp & 0xfff; ++ if (u2btmp != 0xfff) { ++ ODM_delay_ms(10); ++ continue; ++ } else ++ break; ++ } ++ ++ /*TX pause*/ ++ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE_8812A, 0xFF); ++ ++ /*Wait TX State Machine OK*/ ++ for (Count = 0; Count < 100; Count++) { ++ if (ODM_Read4Byte(pDM_Odm, REG_SCH_TXCMD_8812A) != 0) ++ continue; ++ else ++ break; ++ } ++ ++ ++ /*Stop RX DMA path*/ ++ u1btmp = ODM_Read1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A); ++ ODM_Write1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A, u1btmp | BIT2); ++ ++ for (Count = 0; Count < 100; Count++) { ++ u1btmp = ODM_Read1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A); ++ if (u1btmp & BIT1) ++ break; ++ else ++ ODM_delay_ms(10); ++ } ++ ++ /*Disable clock*/ ++ ODM_Write1Byte(pDM_Odm, REG_SYS_CLKR_8812A + 1, 0xf0); ++ /*Disable 320M*/ ++ ODM_Write1Byte(pDM_Odm, REG_AFE_PLL_CTRL_8812A + 3, 0x8); ++ /*Enable 320M*/ ++ ODM_Write1Byte(pDM_Odm, REG_AFE_PLL_CTRL_8812A + 3, 0xa); ++ /*Enable clock*/ ++ ODM_Write1Byte(pDM_Odm, REG_SYS_CLKR_8812A + 1, 0xfc); ++ ++ ++ /*Release Tx pause*/ ++ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE_8812A, 0); ++ ++ /*Enable RX DMA path*/ ++ u1btmp = ODM_Read1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A); ++ ODM_Write1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A, u1btmp & (~BIT2)); ++#if DEV_BUS_TYPE == RT_PCI_INTERFACE ++ /*Enable PCIe TxDMA*/ ++ ODM_Write1Byte(pDM_Odm, REG_PCIE_CTRL_REG_8812A + 1, 0); ++#endif ++ /*Start Usb TxDMA*/ ++ RT_ENABLE_FUNC(Adapter, DF_TX_BIT); ++} ++ ++#endif ++ ++ ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.h 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,75 @@ ++#ifndef __HAL_TXBF_JAGUAR_H__ ++#define __HAL_TXBF_JAGUAR_H__ ++#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) ++#if (BEAMFORMING_SUPPORT == 1) ++ ++VOID ++HalTxbf8812A_setNDPArate( ++ IN PVOID pDM_VOID, ++ IN u1Byte BW, ++ IN u1Byte Rate ++); ++ ++ ++VOID ++HalTxbfJaguar_Enter( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++ ++VOID ++HalTxbfJaguar_Leave( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++ ++VOID ++HalTxbfJaguar_Status( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++ ++VOID ++HalTxbfJaguar_FwTxBF( ++ IN PVOID pDM_VOID, ++ IN u1Byte Idx ++ ); ++ ++ ++VOID ++HalTxbfJaguar_Patch( ++ IN PVOID pDM_VOID, ++ IN u1Byte Operation ++ ); ++ ++ ++VOID ++HalTxbfJaguar_Clk_8812A( ++ IN PVOID pDM_VOID ++ ); ++#else ++ ++#define HalTxbf8812A_setNDPArate(pDM_VOID, BW, Rate) ++#define HalTxbfJaguar_Enter(pDM_VOID, Idx) ++#define HalTxbfJaguar_Leave(pDM_VOID, Idx) ++#define HalTxbfJaguar_Status(pDM_VOID, Idx) ++#define HalTxbfJaguar_FwTxBF(pDM_VOID, Idx) ++#define HalTxbfJaguar_Patch(pDM_VOID, Operation) ++#define HalTxbfJaguar_Clk_8812A(pDM_VOID) ++#endif ++#else ++ ++#define HalTxbf8812A_setNDPArate(pDM_VOID, BW, Rate) ++#define HalTxbfJaguar_Enter(pDM_VOID, Idx) ++#define HalTxbfJaguar_Leave(pDM_VOID, Idx) ++#define HalTxbfJaguar_Status(pDM_VOID, Idx) ++#define HalTxbfJaguar_FwTxBF(pDM_VOID, Idx) ++#define HalTxbfJaguar_Patch(pDM_VOID, Operation) ++#define HalTxbfJaguar_Clk_8812A(pDM_VOID) ++#endif ++ ++#endif // #ifndef __HAL_TXBF_JAGUAR_H__ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.c 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,180 @@ ++#include "mp_precomp.h" ++#include "phydm_precomp.h" ++ ++#if (defined(CONFIG_BB_TXBF_API)) ++#if (RTL8822B_SUPPORT == 1) ++/*Add by YuChen for 8822B MU-MIMO API*/ ++ ++/*this function is only used for BFer*/ ++u1Byte ++phydm_get_ndpa_rate( ++ IN PVOID pDM_VOID ++ ) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte NDPARate = ODM_RATE6M; ++ ++ if (pDM_Odm->RSSI_Min >= 30) /*link RSSI > 30%*/ ++ NDPARate = ODM_RATE24M; ++ else if (pDM_Odm->RSSI_Min <= 25) ++ NDPARate = ODM_RATE6M; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] NDPARate = 0x%x\n", __func__, NDPARate)); ++ ++ return NDPARate; ++ ++} ++ ++/*this function is only used for BFer*/ ++u1Byte ++phydm_get_beamforming_sounding_info( ++ IN PVOID pDM_VOID, ++ IN pu2Byte Troughput, ++ IN u1Byte Total_BFee_Num, ++ IN pu1Byte TxRate ++ ) ++{ ++ u1Byte idx = 0; ++ u1Byte soundingdecision = 0xff; ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ ++ for (idx = 0; idx < Total_BFee_Num; idx++) { ++ if (((TxRate[idx] >= ODM_RATEVHTSS3MCS7) && (TxRate[idx] <= ODM_RATEVHTSS3MCS9))) ++ soundingdecision = soundingdecision & ~(1<= 500) ++ snding_score = 100; ++ else if (Throughput >= 450) ++ snding_score = 90; ++ else if (Throughput >= 400) ++ snding_score = 80; ++ else if (Throughput >= 350) ++ snding_score = 70; ++ else if (Throughput >= 300) ++ snding_score = 60; ++ else if (Throughput >= 250) ++ snding_score = 50; ++ else if (Throughput >= 200) ++ snding_score = 40; ++ else if (Throughput >= 150) ++ snding_score = 30; ++ else if (Throughput >= 100) ++ snding_score = 20; ++ else if (Throughput >= 50) ++ snding_score = 10; ++ else ++ snding_score = 0; ++ ++ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] snding_score = 0x%d\n", __func__, snding_score)); ++ ++ return snding_score; ++ ++} ++ ++ ++#endif ++#if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++u1Byte ++Beamforming_GetHTNDPTxRate( ++ IN PVOID pDM_VOID, ++ u1Byte CompSteeringNumofBFer ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte Nr_index = 0; ++ u1Byte NDPTxRate; ++ /*Find Nr*/ ++#if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), CompSteeringNumofBFer); ++ else ++#endif ++ Nr_index = TxBF_Nr(1, CompSteeringNumofBFer); ++ ++ switch (Nr_index) { ++ case 1: ++ NDPTxRate = ODM_MGN_MCS8; ++ break; ++ ++ case 2: ++ NDPTxRate = ODM_MGN_MCS16; ++ break; ++ ++ case 3: ++ NDPTxRate = ODM_MGN_MCS24; ++ break; ++ ++ default: ++ NDPTxRate = ODM_MGN_MCS8; ++ break; ++ } ++ ++return NDPTxRate; ++ ++} ++ ++u1Byte ++Beamforming_GetVHTNDPTxRate( ++ IN PVOID pDM_VOID, ++ u1Byte CompSteeringNumofBFer ++) ++{ ++ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; ++ u1Byte Nr_index = 0; ++ u1Byte NDPTxRate; ++ /*Find Nr*/ ++#if (RTL8814A_SUPPORT == 1) ++ if (pDM_Odm->SupportICType & ODM_RTL8814A) ++ Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), CompSteeringNumofBFer); ++ else ++#endif ++ Nr_index = TxBF_Nr(1, CompSteeringNumofBFer); ++ ++ switch (Nr_index) { ++ case 1: ++ NDPTxRate = ODM_MGN_VHT2SS_MCS0; ++ break; ++ ++ case 2: ++ NDPTxRate = ODM_MGN_VHT3SS_MCS0; ++ break; ++ ++ case 3: ++ NDPTxRate = ODM_MGN_VHT4SS_MCS0; ++ break; ++ ++ default: ++ NDPTxRate = ODM_MGN_VHT2SS_MCS0; ++ break; ++ } ++ ++return NDPTxRate; ++ ++} ++#endif ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.h 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,70 @@ ++/********************************************************************************/ ++/**/ ++/*Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.*/ ++/**/ ++/*This program is free software; you can redistribute it and/or modify it*/ ++/*under the terms of version 2 of the GNU General Public License as*/ ++/*published by the Free Software Foundation.*/ ++/**/ ++/*This program is distributed in the hope that it will be useful, but WITHOUT*/ ++/*ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or*/ ++/*FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for*/ ++/*more details.*/ ++/*You should have received a copy of the GNU General Public License along with*/ ++/*this program; if not, write to the Free Software Foundation, Inc.,*/ ++/*51 Franklin Street, Fifth Floor, Boston, MA 02110, USA*/ ++/**/ ++/**/ ++/********************************************************************************/ ++#ifndef __PHYDM_HAL_TXBF_API_H__ ++#define __PHYDM_HAL_TXBF_API_H__ ++ ++#if (defined(CONFIG_BB_TXBF_API)) ++ ++#if (DM_ODM_SUPPORT_TYPE != ODM_AP) ++#define TxBF_Nr(a, b) ((a > b) ? (b) : (a)) ++ ++u1Byte ++Beamforming_GetHTNDPTxRate( ++ IN PVOID pDM_VOID, ++ u1Byte CompSteeringNumofBFer ++); ++ ++u1Byte ++Beamforming_GetVHTNDPTxRate( ++ IN PVOID pDM_VOID, ++ u1Byte CompSteeringNumofBFer ++); ++ ++#endif ++ ++#if (RTL8822B_SUPPORT == 1) ++u1Byte ++phydm_get_beamforming_sounding_info( ++ IN PVOID pDM_VOID, ++ IN pu2Byte Troughput, ++ IN u1Byte Total_BFee_Num, ++ IN pu1Byte TxRate ++ ); ++ ++u1Byte ++phydm_get_ndpa_rate( ++ IN PVOID pDM_VOID ++ ); ++ ++u1Byte ++phydm_get_mu_bfee_snding_decision( ++ IN PVOID pDM_VOID, ++ IN u2Byte Throughput ++ ); ++ ++#else ++#define phydm_get_beamforming_sounding_info(pDM_VOID, Troughput, Total_BFee_Num, TxRate) ++#define phydm_get_ndpa_rate(pDM_VOID) ++#define phydm_get_mu_bfee_snding_decision(pDM_VOID, Troughput) ++ ++#endif ++ ++#endif ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.c 2018-02-11 21:44:27.163146330 +0200 +@@ -0,0 +1,10314 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2016 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++#ifdef CONFIG_RTL8723D ++ ++#include "drv_types.h" ++ ++#ifdef LOAD_FW_HEADER_FROM_DRIVER ++ ++#if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) ++ ++u1Byte array_mp_8723d_fw_ap[] = { ++0xD1, 0x23, 0x20, 0x00, 0x1D, 0x00, 0x02, 0x00, ++0x04, 0x14, 0x11, 0x14, 0xCC, 0x5B, 0x02, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x02, 0x85, 0xA9, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xC4, 0xBA, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xC8, 0x41, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xBC, 0x36, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xBC, 0x8D, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xC7, 0xEB, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, ++0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, ++0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, ++0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, ++0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, ++0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, ++0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0A, ++0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, ++0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, ++0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, ++0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, ++0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, ++0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, ++0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, ++0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, ++0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, ++0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, ++0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, ++0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, ++0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, ++0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, ++0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, ++0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, ++0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, ++0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, ++0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, ++0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, ++0x30, 0x02, 0x02, 0x03, 0x04, 0x04, 0x08, 0x09, ++0x09, 0x0C, 0x0E, 0x10, 0x12, 0x02, 0x09, 0x0B, ++0x0E, 0x0D, 0x0F, 0x10, 0x12, 0x00, 0x04, 0x00, ++0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x23, 0x00, ++0x2D, 0x00, 0x50, 0x00, 0x91, 0x00, 0xC3, 0x01, ++0x27, 0x01, 0x31, 0x01, 0x5E, 0x00, 0x8C, 0x00, ++0xC8, 0x00, 0xDC, 0x01, 0x5E, 0x01, 0x68, 0x01, ++0x9A, 0x01, 0xCC, 0x01, 0xEA, 0x02, 0x02, 0x04, ++0x08, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, ++0x6C, 0x14, 0x28, 0x32, 0x50, 0x78, 0xA0, 0xC8, ++0xE6, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x02, ++0x02, 0x03, 0x03, 0x04, 0x04, 0x02, 0x04, 0x06, ++0x07, 0x07, 0x08, 0x08, 0x08, 0x01, 0x01, 0x01, ++0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, ++0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x02, ++0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, ++0x02, 0x03, 0x03, 0x04, 0x05, 0x01, 0x02, 0x03, ++0x04, 0x05, 0x06, 0x07, 0x08, 0x03, 0x03, 0x03, ++0x02, 0x03, 0x03, 0x03, 0x03, 0x03, 0x02, 0x02, ++0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, ++0x02, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x83, 0x04, ++0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, ++0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, ++0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, ++0xEC, 0x24, 0x8B, 0xF8, 0xE6, 0xBC, 0x02, 0x02, ++0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, ++0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, ++0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, ++0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, ++0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, ++0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, ++0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, ++0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, ++0x20, 0x05, 0x0C, 0x74, 0x8A, 0x25, 0x0C, 0xF8, ++0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, ++0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, ++0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, ++0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, ++0x0C, 0x24, 0x8B, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, ++0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, ++0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, ++0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x8A, ++0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, ++0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, ++0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, ++0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, ++0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, ++0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x8A, 0xA6, ++0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, ++0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, ++0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, ++0x76, 0x30, 0x90, 0x86, 0xBC, 0x74, 0x01, 0x93, ++0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, ++0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, ++0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, ++0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, ++0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, ++0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, ++0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, ++0x8A, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, ++0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, ++0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, ++0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, ++0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, ++0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x8A, 0x2E, ++0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, ++0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, ++0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, ++0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, ++0x24, 0x8A, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, ++0x04, 0x90, 0x86, 0xBC, 0x93, 0xF6, 0x08, 0xEF, ++0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, ++0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, ++0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, ++0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, ++0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x8A, 0x2F, ++0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x83, 0x4D, 0x50, ++0x2E, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, ++0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, ++0x8A, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, ++0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, ++0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, ++0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, ++0x8B, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, ++0x0F, 0x74, 0x8A, 0x2F, 0xF8, 0xA6, 0x01, 0x08, ++0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, ++0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, ++0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, ++0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, ++0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, ++0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, ++0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, ++0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, ++0xE2, 0x01, 0x0F, 0x02, 0x83, 0x4C, 0x8F, 0xF0, ++0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, ++0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, ++0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, ++0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, ++0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, ++0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, ++0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, ++0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, ++0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x83, 0x4D, 0x7F, ++0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, ++0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, ++0x22, 0x02, 0x85, 0xE7, 0x02, 0x83, 0xDD, 0xE4, ++0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, ++0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, ++0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, ++0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, ++0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, ++0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, ++0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, ++0x86, 0xA5, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, ++0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, ++0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, ++0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, ++0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, ++0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, ++0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, ++0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, ++0xDE, 0xE7, 0x80, 0xBE, 0xEF, 0x2B, 0xFF, 0xEE, ++0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, ++0x22, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, 0xFE, ++0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xEF, ++0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, ++0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, ++0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, ++0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, ++0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE0, 0xFB, 0xA3, ++0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, ++0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, ++0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, ++0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, ++0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, ++0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, ++0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x41, 0x96, 0xD1, ++0x00, 0x44, 0x96, 0x89, 0x41, 0x4E, 0x59, 0x00, ++0x44, 0x96, 0x85, 0x61, 0x6E, 0x79, 0x00, 0x41, ++0x96, 0xD4, 0x00, 0x00, 0xBA, 0xAD, 0xC1, 0xEA, ++0x8E, 0x36, 0x90, 0x96, 0xCC, 0xEF, 0xF0, 0x7F, ++0x02, 0xB1, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0xFF, ++0x90, 0x96, 0xCC, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, ++0x86, 0xAF, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, ++0xFD, 0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, 0xED, ++0x2E, 0x90, 0x86, 0xB4, 0xF1, 0xDE, 0xFF, 0xED, ++0x2F, 0x90, 0x86, 0xB5, 0xF1, 0xE6, 0xFF, 0xED, ++0x2F, 0x90, 0x86, 0xB6, 0xF1, 0xF0, 0xFF, 0xED, ++0x2F, 0x90, 0x86, 0xB7, 0xF1, 0xFA, 0xFF, 0xED, ++0x2F, 0x90, 0x86, 0xB8, 0xF1, 0x23, 0xFF, 0xED, ++0x2F, 0x90, 0x86, 0xB9, 0x12, 0x9F, 0xBF, 0xFF, ++0xAE, 0x05, 0xED, 0x2F, 0x90, 0x86, 0xBA, 0xF0, ++0x22, 0x4E, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, ++0x02, 0x1F, 0x12, 0x88, 0xCA, 0x12, 0x02, 0x06, ++0xFF, 0x54, 0x7F, 0x90, 0x88, 0x36, 0xF0, 0xEF, ++0x12, 0xA1, 0xDD, 0xA3, 0xF1, 0xDE, 0xFD, 0x54, ++0xF0, 0xC4, 0x54, 0x0F, 0xFF, 0x90, 0x88, 0x34, ++0xE0, 0x54, 0xF0, 0x4F, 0xF1, 0xF0, 0xFC, 0x54, ++0x01, 0x25, 0xE0, 0xFF, 0x90, 0x88, 0x31, 0xE0, ++0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, 0x04, 0xC3, ++0x13, 0xFF, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFD, ++0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, 0x54, 0xF0, ++0xFF, 0xA3, 0xE0, 0x54, 0x0F, 0xF1, 0xE5, 0x90, ++0x88, 0x35, 0xF1, 0xFA, 0xFD, 0x90, 0x8A, 0x89, ++0x12, 0x8C, 0xE5, 0x7F, 0x02, 0x12, 0x04, 0x7E, ++0x12, 0x88, 0xD0, 0xF1, 0x24, 0xFF, 0x54, 0x01, ++0xFE, 0x90, 0x88, 0x9B, 0x12, 0xDB, 0x2C, 0xF1, ++0x22, 0xFE, 0x12, 0xDB, 0x8C, 0x90, 0x88, 0x9B, ++0x12, 0xDB, 0xB0, 0xF1, 0x21, 0x12, 0xDB, 0x82, ++0x90, 0x88, 0x9B, 0x12, 0xDB, 0xA7, 0xF1, 0x21, ++0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0x90, ++0x88, 0x9B, 0xF0, 0x12, 0x5C, 0x5F, 0x90, 0x88, ++0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, ++0xE0, 0x54, 0xFB, 0xF0, 0x12, 0xBE, 0x36, 0xF0, ++0x90, 0x88, 0x36, 0x12, 0xDB, 0x45, 0x12, 0xAF, ++0xCE, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0xF0, 0x90, ++0x00, 0x01, 0x02, 0x02, 0x1F, 0x4F, 0xF0, 0x90, ++0x00, 0x02, 0x02, 0x02, 0x1F, 0xF5, 0x83, 0xEF, ++0xF0, 0x90, 0x00, 0x03, 0x02, 0x02, 0x1F, 0xF5, ++0x83, 0xEF, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x02, ++0x1F, 0x90, 0x94, 0xBD, 0x12, 0x86, 0x76, 0x90, ++0x93, 0x4C, 0xE0, 0x70, 0x12, 0x11, 0xD0, 0x12, ++0x02, 0x06, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, ++0x06, 0x90, 0x93, 0x52, 0x74, 0x01, 0xF0, 0x90, ++0x93, 0x4E, 0xE0, 0x70, 0x12, 0x11, 0xD0, 0x12, ++0x02, 0x06, 0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x05, ++0x06, 0x90, 0x93, 0x53, 0x74, 0x01, 0xF0, 0x11, ++0xD0, 0x12, 0x87, 0xDF, 0xFF, 0x90, 0x94, 0xC1, ++0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, ++0x0B, 0x11, 0xD0, 0x12, 0x87, 0xE7, 0x90, 0x94, ++0xC2, 0xF0, 0x80, 0x05, 0x90, 0x94, 0xC2, 0xEF, ++0xF0, 0x90, 0x94, 0xC1, 0xE0, 0x90, 0x94, 0xC0, ++0xF0, 0x90, 0x94, 0xC2, 0xE0, 0xFE, 0x90, 0x94, ++0xC0, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x38, 0x11, ++0xD0, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFD, 0x12, ++0x6E, 0x71, 0x90, 0x94, 0xC0, 0xE0, 0xFF, 0x12, ++0x78, 0x4A, 0xEF, 0x90, 0x94, 0xC0, 0x70, 0x06, ++0xE0, 0xFF, 0xF1, 0x5C, 0x80, 0x04, 0xE0, 0xFF, ++0xF1, 0xE4, 0x90, 0x93, 0x53, 0xE0, 0x60, 0x07, ++0x90, 0x94, 0xC0, 0xE0, 0xFF, 0xF1, 0x5C, 0x90, ++0x94, 0xC0, 0xE0, 0x04, 0xF0, 0x80, 0xBA, 0x90, ++0x05, 0x5E, 0xE4, 0xF0, 0x90, 0x94, 0xC1, 0xE0, ++0x70, 0x17, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x70, ++0x10, 0x11, 0xDC, 0x90, 0x8A, 0xED, 0x11, 0xDF, ++0x12, 0xBE, 0x40, 0x54, 0xBF, 0xF0, 0x54, 0x7F, ++0xF0, 0x22, 0x90, 0x94, 0xBD, 0x12, 0x86, 0x76, ++0x90, 0x94, 0xBD, 0x02, 0x86, 0x6D, 0xE4, 0xFD, ++0xFF, 0x12, 0x04, 0x7E, 0x90, 0x86, 0x0C, 0xE0, ++0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x02, 0x04, ++0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x90, 0x96, 0xD2, 0xED, 0xF0, 0x90, 0x88, 0x31, ++0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, ++0xE0, 0x02, 0x41, 0x58, 0xEE, 0x12, 0xA1, 0xDD, ++0x30, 0xE0, 0x02, 0x41, 0x58, 0x90, 0x88, 0x39, ++0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x41, 0x58, 0xEF, ++0x70, 0x02, 0x21, 0xB7, 0x24, 0xFE, 0x70, 0x02, ++0x21, 0xFC, 0x24, 0xFE, 0x60, 0x4F, 0x24, 0xFC, ++0x70, 0x02, 0x41, 0x41, 0x24, 0xFC, 0x60, 0x02, ++0x41, 0x51, 0xEE, 0xB4, 0x0E, 0x03, 0x12, 0x71, ++0x5F, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, ++0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, ++0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, ++0x39, 0xE0, 0xB4, 0x04, 0x11, 0x90, 0x96, 0xD2, ++0xE0, 0xFF, 0x60, 0x05, 0x12, 0x67, 0x80, 0x80, ++0x05, 0x90, 0x8A, 0xED, 0x11, 0xDF, 0x90, 0x88, ++0x39, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x41, 0x51, ++0x12, 0x7B, 0xCC, 0x41, 0x51, 0x90, 0x88, 0x39, ++0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, ++0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, ++0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, ++0x0B, 0x90, 0x86, 0x00, 0x11, 0xDF, 0xBF, 0x01, ++0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, ++0x64, 0x0C, 0x60, 0x02, 0x41, 0x51, 0x90, 0x86, ++0x00, 0x11, 0xDF, 0xEF, 0x64, 0x01, 0x60, 0x02, ++0x41, 0x51, 0x12, 0x68, 0xC2, 0x41, 0x51, 0x90, ++0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, ++0x00, 0x11, 0xDF, 0xBF, 0x01, 0x03, 0x12, 0x71, ++0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, ++0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, ++0x0C, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xDF, 0xBF, ++0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, ++0xE0, 0x64, 0x04, 0x70, 0x64, 0x90, 0x86, 0x02, ++0x11, 0xDF, 0xEF, 0x64, 0x01, 0x70, 0x5A, 0x12, ++0x73, 0x5A, 0x80, 0x55, 0x90, 0x88, 0x39, 0xE0, ++0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xDF, ++0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, ++0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, ++0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, ++0x86, 0x00, 0x11, 0xDF, 0xBF, 0x01, 0x03, 0x12, ++0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, ++0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, ++0xE0, 0xB4, 0x04, 0x15, 0x12, 0x7A, 0x49, 0x80, ++0x10, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x09, ++0x12, 0xB5, 0x8D, 0x30, 0xE0, 0x03, 0x12, 0x79, ++0xD4, 0x90, 0x88, 0x39, 0x12, 0xDB, 0x45, 0xF0, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xC1, 0x9B, 0xFF, ++0x54, 0x01, 0xFE, 0x90, 0x88, 0x9D, 0x12, 0xDB, ++0x2C, 0xF0, 0xFC, 0x12, 0x02, 0x06, 0xFD, 0x54, ++0x04, 0x13, 0x13, 0x54, 0x3F, 0xFF, 0x90, 0x94, ++0xA1, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0xED, 0x54, ++0x08, 0xFF, 0xEC, 0x54, 0xF7, 0x4F, 0xFF, 0x90, ++0x88, 0x9D, 0xF0, 0x12, 0x02, 0x06, 0x12, 0xDB, ++0x82, 0x90, 0x88, 0x9D, 0x12, 0xDB, 0xA7, 0x4E, ++0x12, 0xA7, 0xE7, 0x54, 0x40, 0xFD, 0xEF, 0x54, ++0xBF, 0x4D, 0xFF, 0x90, 0x88, 0x9D, 0xF0, 0xEE, ++0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, 0x4E, 0xF0, ++0x11, 0xD0, 0xE9, 0x24, 0x01, 0xF9, 0xE4, 0x3A, ++0x8B, 0x45, 0xF5, 0x46, 0x89, 0x47, 0x75, 0x48, ++0x04, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9E, 0x12, ++0x69, 0xF5, 0x11, 0xD0, 0x12, 0x02, 0x06, 0x20, ++0xE0, 0x02, 0x81, 0x41, 0x90, 0x05, 0x54, 0xE0, ++0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, 0x13, 0x90, ++0x88, 0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xC4, ++0x54, 0x0F, 0x30, 0xE0, 0x15, 0x12, 0x87, 0xDF, ++0x90, 0x88, 0x9E, 0xF0, 0x24, 0x0A, 0x90, 0x88, ++0xCF, 0x12, 0x87, 0xE6, 0x90, 0x88, 0x9F, 0xF0, ++0x80, 0x4B, 0x12, 0x87, 0xDF, 0xFF, 0xC3, 0x94, ++0x2A, 0x50, 0x15, 0xEF, 0xC3, 0x94, 0x03, 0x50, ++0x07, 0x90, 0x88, 0x9E, 0x74, 0x03, 0x80, 0x0D, ++0x12, 0x87, 0xDF, 0x90, 0x88, 0x9E, 0x80, 0x05, ++0x90, 0x88, 0x9E, 0x74, 0x2A, 0xF0, 0x24, 0x0A, ++0x90, 0x88, 0xCF, 0xF0, 0x12, 0x87, 0xE7, 0xFF, ++0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, 0x94, ++0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, 0x74, 0x03, ++0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, 0x90, ++0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, 0x9F, 0x88, ++0x54, 0x03, 0x30, 0xE0, 0x3D, 0x90, 0x88, 0x9E, ++0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA6, ++0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0x88, ++0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, ++0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, 0x13, ++0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, 0xE0, ++0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, 0x01, ++0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, 0x12, ++0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0xF0, 0x90, ++0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, ++0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x54, ++0x07, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0x91, ++0xE5, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, 0x7E, ++0x12, 0xDB, 0xC1, 0x74, 0x11, 0xF0, 0x90, 0x94, ++0xA1, 0xE0, 0x30, 0xE0, 0x33, 0x90, 0x94, 0xAA, ++0x74, 0x01, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x06, ++0xC7, 0xE0, 0xFE, 0x90, 0x06, 0xC6, 0x12, 0x91, ++0xFD, 0xFE, 0xE4, 0xFD, 0x78, 0x10, 0x12, 0x9D, ++0xA0, 0x90, 0x06, 0xC5, 0xE0, 0xFE, 0x90, 0x06, ++0xC4, 0x12, 0x91, 0xFD, 0xFE, 0xE4, 0xFD, 0x12, ++0x86, 0x54, 0x90, 0x94, 0xA6, 0x12, 0x04, 0x31, ++0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x01, 0x08, 0x90, ++0x88, 0xB0, 0x74, 0x01, 0xF0, 0x80, 0x2B, 0x90, ++0x88, 0xA5, 0xE0, 0xB4, 0x04, 0x08, 0x90, 0x88, ++0xB0, 0x74, 0x04, 0xF0, 0x80, 0x1C, 0x90, 0x88, ++0xA5, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x88, 0xB0, ++0x74, 0x02, 0xF0, 0x80, 0x0D, 0x90, 0x88, 0xA5, ++0xE0, 0xB4, 0x07, 0x06, 0x90, 0x88, 0xB0, 0x74, ++0x05, 0xF0, 0xE4, 0x90, 0x88, 0xA5, 0xF0, 0x80, ++0x45, 0x90, 0x8A, 0xF1, 0x11, 0xDF, 0x90, 0x89, ++0x04, 0xE0, 0x90, 0x00, 0x40, 0x30, 0xE0, 0x07, ++0xE0, 0x54, 0x0F, 0x44, 0xA0, 0x80, 0x05, 0xE0, ++0x54, 0x0F, 0x44, 0x20, 0xFD, 0x7F, 0x40, 0x12, ++0x7B, 0x2E, 0x11, 0xD0, 0x12, 0x87, 0xF1, 0x13, ++0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, ++0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, ++0xE4, 0xFB, 0xFD, 0x7F, 0xFF, 0x12, 0xA8, 0x5B, ++0x12, 0xDB, 0xC1, 0x74, 0x43, 0xF0, 0x90, 0x88, ++0xA3, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0x88, ++0xAF, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0x12, 0xA1, ++0xDD, 0x30, 0xE0, 0x09, 0x90, 0x88, 0xD0, 0xE0, ++0x44, 0x02, 0xF0, 0x80, 0x11, 0x90, 0x8A, 0x97, ++0x91, 0xE5, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, ++0x88, 0xD0, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x8A, ++0xD9, 0x91, 0xE5, 0x7F, 0x03, 0x12, 0x04, 0x7E, ++0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x07, 0x90, ++0x88, 0xA1, 0xE0, 0x54, 0xBF, 0xF0, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, ++0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x12, ++0x04, 0x7E, 0x90, 0x8A, 0x79, 0xE0, 0xFE, 0xA3, ++0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x90, 0x93, ++0x29, 0xE0, 0x30, 0xE0, 0x59, 0xC4, 0x54, 0x0F, ++0x20, 0xE0, 0x1A, 0x12, 0xDB, 0x9E, 0xF1, 0x8F, ++0x90, 0x8A, 0xF9, 0x91, 0xE5, 0x11, 0xD6, 0xF1, ++0xEE, 0x30, 0xE0, 0x07, 0x90, 0x8A, 0x89, 0x91, ++0xE5, 0xF1, 0x60, 0xE1, 0xF5, 0x90, 0x93, 0x29, ++0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x2F, 0xE4, ++0x90, 0x92, 0x20, 0xF0, 0x90, 0x93, 0x2C, 0xF1, ++0x8F, 0x90, 0x93, 0x29, 0xE0, 0x54, 0xEF, 0xF0, ++0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x0C, 0x90, 0x8A, ++0x89, 0x91, 0xE5, 0x7D, 0x04, 0x7F, 0x01, 0x02, ++0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x91, 0xE5, 0x7D, ++0x31, 0x12, 0xDB, 0x95, 0x11, 0xDF, 0x22, 0x7E, ++0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, ++0x88, 0x79, 0x31, 0x12, 0x04, 0x80, 0x90, 0x88, ++0x35, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x3C, 0x14, ++0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x50, 0xD1, 0xAC, ++0xFE, 0xE4, 0x33, 0x90, 0x88, 0x42, 0xF0, 0xA3, ++0xCE, 0xD1, 0xAC, 0xFF, 0xF1, 0x67, 0x12, 0xD8, ++0xD7, 0x90, 0x8A, 0x89, 0x91, 0xE5, 0xF1, 0xE8, ++0x90, 0x8A, 0x89, 0x91, 0xE5, 0x7D, 0x0C, 0x7F, ++0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0x91, ++0xE5, 0xF1, 0x60, 0x90, 0x86, 0xB3, 0xE0, 0xFF, ++0xB4, 0x01, 0x08, 0x90, 0x88, 0x41, 0x74, 0xDD, ++0xF0, 0x80, 0x18, 0xEF, 0xB4, 0x03, 0x0F, 0x90, ++0x88, 0x41, 0x74, 0xF4, 0xF0, 0x90, 0x00, 0x92, ++0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x05, 0xE4, 0x90, ++0x88, 0x41, 0xF0, 0x7F, 0x79, 0x12, 0x7B, 0x41, ++0xEF, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, ++0x28, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE2, 0x06, ++0x90, 0x88, 0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, ++0x93, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, ++0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, ++0x74, 0x07, 0xD1, 0xAC, 0xF1, 0x67, 0x7E, 0x00, ++0x7F, 0x18, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, ++0x79, 0x31, 0x12, 0x04, 0x80, 0x90, 0x8A, 0xA3, ++0x91, 0xE5, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x7E, ++0x00, 0x7F, 0x02, 0x7D, 0x00, 0x7B, 0x01, 0x7A, ++0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, 0x06, ++0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x0A, ++0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, 0xE4, ++0xF0, 0x90, 0x88, 0x9C, 0xF0, 0x22, 0xE4, 0xFB, ++0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x85, 0x4E, 0x90, ++0x95, 0x3F, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x86, ++0xAF, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, ++0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE0, 0x0F, 0x90, ++0x86, 0xAF, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, ++0x12, 0xC5, 0x83, 0x12, 0xCB, 0x5A, 0xD1, 0xA3, ++0x30, 0xE1, 0x08, 0x54, 0xFD, 0xF0, 0x90, 0x86, ++0x08, 0x11, 0xDF, 0xD1, 0xA3, 0x30, 0xE2, 0x08, ++0x54, 0xFB, 0xF0, 0x90, 0x86, 0x0A, 0x11, 0xDF, ++0xD1, 0xA3, 0xFF, 0x30, 0xE5, 0x0C, 0x54, 0xDF, ++0xF0, 0x12, 0xAB, 0x23, 0xBF, 0x01, 0x03, 0x12, ++0x92, 0x06, 0xD1, 0xA3, 0x30, 0xE6, 0x08, 0x54, ++0xBF, 0xF0, 0x90, 0x8A, 0x7D, 0x11, 0xDF, 0xD2, ++0xAF, 0x80, 0xA3, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, ++0x86, 0xAF, 0xE0, 0x22, 0xF0, 0x90, 0x88, 0x53, ++0xE0, 0x24, 0x04, 0x22, 0x90, 0x93, 0x29, 0xE0, ++0x30, 0xE0, 0x1A, 0x90, 0x01, 0x57, 0xE4, 0xF0, ++0x90, 0x8A, 0xF9, 0x91, 0xE5, 0x11, 0xD6, 0xF1, ++0xEE, 0x30, 0xE0, 0x07, 0x90, 0x8A, 0x89, 0x91, ++0xE5, 0xF1, 0x60, 0xF1, 0xF5, 0x22, 0x12, 0xD8, ++0x97, 0x12, 0x7B, 0xDB, 0x90, 0x8A, 0xC5, 0x11, ++0xDF, 0x12, 0xAE, 0x94, 0xB1, 0x4F, 0x12, 0xD6, ++0x67, 0x12, 0xD8, 0xBF, 0x90, 0x8A, 0x73, 0x11, ++0xDF, 0x90, 0x00, 0x6A, 0xE0, 0x30, 0xE2, 0x14, ++0x90, 0x92, 0x20, 0x74, 0x01, 0xF0, 0xA3, 0x74, ++0xF4, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x68, 0x7E, ++0x01, 0x12, 0x66, 0x33, 0x12, 0xD3, 0x71, 0x90, ++0x93, 0x4A, 0x74, 0x01, 0xF0, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xC0, ++0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8A, 0xF9, ++0x91, 0xE5, 0x7D, 0x44, 0x7F, 0x6F, 0x12, 0x04, ++0x7E, 0x90, 0x8A, 0xFD, 0x11, 0xDF, 0x90, 0x96, ++0xC1, 0xE0, 0x90, 0x96, 0xC0, 0xB4, 0x01, 0x09, ++0xE0, 0xF1, 0x79, 0xE0, 0x44, 0x04, 0xF0, 0x80, ++0x07, 0xE0, 0xF1, 0x79, 0xE0, 0x54, 0xFB, 0xF0, ++0x90, 0x8A, 0xF9, 0x91, 0xE5, 0xF1, 0xE8, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x01, 0x80, 0xB6, ++0x7D, 0x0C, 0x7F, 0x01, 0x02, 0x04, 0x7E, 0x33, ++0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4E, 0xF0, ++0xA3, 0x74, 0x50, 0xF0, 0x22, 0xE0, 0xFD, 0xE5, ++0x0E, 0xC4, 0x54, 0xF0, 0x24, 0x05, 0xF5, 0x82, ++0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xF0, 0xE4, ++0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, ++0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, ++0x54, 0x7E, 0x01, 0x02, 0x66, 0x33, 0x90, 0x88, ++0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xB6, 0x81, ++0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x34, 0x90, ++0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x2C, 0x12, ++0xAF, 0xCF, 0x60, 0x15, 0x90, 0x8A, 0xB9, 0x91, ++0xE5, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x04, 0x7E, ++0x90, 0x8B, 0x01, 0x12, 0xB7, 0xE4, 0x02, 0x04, ++0x7A, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x0C, 0x90, ++0x8A, 0xB9, 0x91, 0xE5, 0x7D, 0x01, 0x7F, 0x04, ++0x12, 0x04, 0x7E, 0x22, 0xE4, 0xFD, 0xE1, 0x16, ++0xE4, 0xFD, 0xFF, 0x02, 0x04, 0x7E, 0x90, 0x93, ++0x29, 0xE0, 0xC3, 0x13, 0x22, 0x90, 0x93, 0x29, ++0xE0, 0x44, 0x10, 0xF0, 0x22, 0x12, 0xC1, 0x9B, ++0x30, 0xE0, 0x13, 0x11, 0xA9, 0x90, 0x86, 0xB3, ++0xE0, 0x64, 0x01, 0x70, 0x27, 0x90, 0xFE, 0x10, ++0xE0, 0x44, 0x04, 0xF0, 0x80, 0x1E, 0x90, 0x93, ++0x25, 0xE0, 0x60, 0x16, 0x7D, 0x10, 0xE4, 0xFF, ++0x12, 0x7C, 0x3B, 0x90, 0x01, 0x3C, 0xE0, 0x30, ++0xE4, 0x03, 0x74, 0x10, 0xF0, 0x90, 0x01, 0x63, ++0xE4, 0xF0, 0xF1, 0xDD, 0x12, 0x88, 0xD0, 0x12, ++0x87, 0xDF, 0x90, 0x93, 0x04, 0x12, 0x87, 0xE6, ++0x90, 0x93, 0x05, 0xF0, 0x90, 0x93, 0x04, 0xE0, ++0x54, 0x01, 0x90, 0x93, 0x11, 0xF0, 0x90, 0x93, ++0x04, 0xE0, 0x54, 0x02, 0x90, 0x93, 0x12, 0xF0, ++0x90, 0x93, 0x04, 0xE0, 0x54, 0x04, 0x90, 0x93, ++0x13, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x08, ++0x90, 0x93, 0x14, 0xF0, 0x90, 0x93, 0x04, 0xE0, ++0x54, 0x10, 0x90, 0x93, 0x15, 0xF0, 0x90, 0x93, ++0x05, 0xE0, 0x54, 0x01, 0x90, 0x93, 0x16, 0xF0, ++0x90, 0x93, 0x05, 0xE0, 0x54, 0x02, 0x90, 0x93, ++0x17, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x04, ++0x90, 0x93, 0x18, 0xF0, 0x90, 0x93, 0x05, 0xE0, ++0x54, 0x08, 0x90, 0x93, 0x19, 0xF0, 0x90, 0x93, ++0x05, 0xE0, 0x54, 0x10, 0x90, 0x93, 0x1A, 0xF0, ++0x22, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, ++0x16, 0x31, 0xFD, 0x90, 0x88, 0x27, 0xF0, 0xA3, ++0xEF, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, ++0xF0, 0x90, 0x93, 0x03, 0xE0, 0x44, 0x01, 0xF0, ++0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x90, ++0x05, 0x52, 0xE0, 0x54, 0x07, 0x04, 0x90, 0x93, ++0x0E, 0x12, 0xAD, 0x9C, 0x90, 0x04, 0x22, 0xE0, ++0x54, 0xEF, 0xF0, 0x22, 0xE4, 0x90, 0x95, 0x18, ++0xF0, 0x12, 0xD4, 0xC1, 0x7F, 0x08, 0x12, 0x7B, ++0x41, 0xEF, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, ++0x7B, 0x2E, 0xE4, 0xFF, 0x12, 0xAB, 0xBD, 0x90, ++0x93, 0x31, 0xE0, 0x20, 0xE0, 0x02, 0x21, 0xE3, ++0xF1, 0xF5, 0x44, 0x02, 0x12, 0xB6, 0x89, 0xE4, ++0x90, 0x95, 0x19, 0xF0, 0x90, 0x95, 0x19, 0xE0, ++0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2F, 0x12, 0xAD, ++0xC1, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, ++0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x34, 0xE0, 0xFD, ++0xEF, 0x5D, 0x60, 0x11, 0x90, 0x95, 0x19, 0x12, ++0xDB, 0x0C, 0x90, 0x95, 0x19, 0x12, 0xDA, 0xEB, ++0x44, 0x40, 0x12, 0xAD, 0x44, 0x90, 0x95, 0x19, ++0xE0, 0x04, 0xF0, 0x80, 0xC7, 0x90, 0x07, 0xC7, ++0xE4, 0xF0, 0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, ++0xC5, 0x74, 0x77, 0xF0, 0x90, 0x07, 0xC4, 0xE4, ++0xF0, 0x90, 0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, ++0xE4, 0xF0, 0xA3, 0x12, 0xD8, 0x1E, 0x90, 0x02, ++0x26, 0xE0, 0x44, 0x01, 0xF0, 0xE0, 0x90, 0x95, ++0x1A, 0xF0, 0x90, 0x95, 0x1A, 0xE0, 0x30, 0xE0, ++0x19, 0x90, 0x95, 0x18, 0xE0, 0x04, 0x12, 0xAD, ++0xA3, 0x90, 0x02, 0x26, 0xE0, 0x90, 0x95, 0x1A, ++0xF0, 0x90, 0x95, 0x18, 0xE0, 0xD3, 0x94, 0xFA, ++0x40, 0xE0, 0x90, 0x02, 0x03, 0x74, 0x80, 0xF0, ++0x90, 0x04, 0x24, 0xE0, 0x90, 0x95, 0x1B, 0xF0, ++0x90, 0x04, 0x22, 0xE0, 0x44, 0x10, 0xF0, 0x90, ++0x02, 0x00, 0xE0, 0x90, 0x95, 0x1A, 0xF0, 0x90, ++0x02, 0x01, 0x31, 0xF4, 0x90, 0x02, 0x02, 0x31, ++0xF4, 0x90, 0x02, 0x14, 0x31, 0xF4, 0xE0, 0x04, ++0xF0, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x11, 0xDC, ++0x90, 0x95, 0x1B, 0xE0, 0x90, 0x04, 0x24, 0xF0, ++0x90, 0xFD, 0x09, 0x74, 0xFF, 0xF0, 0x90, 0xFD, ++0x08, 0xE4, 0xF0, 0x12, 0xAF, 0xD6, 0xF0, 0xE4, ++0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x32, 0xE0, ++0x54, 0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x95, ++0x1A, 0xE0, 0x2F, 0xF0, 0x22, 0xE0, 0x7C, 0x00, ++0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0x90, 0x93, ++0x20, 0xE0, 0x90, 0x95, 0xA3, 0xF0, 0x90, 0x93, ++0x21, 0xE0, 0x90, 0x95, 0xA4, 0xF0, 0x90, 0x93, ++0x22, 0xE0, 0x90, 0x95, 0xA5, 0xF0, 0x90, 0x93, ++0x23, 0xE0, 0x90, 0x95, 0xA6, 0xF0, 0x90, 0x93, ++0x24, 0xE0, 0x90, 0x95, 0xA7, 0xF0, 0x90, 0x93, ++0x11, 0xE0, 0x90, 0x95, 0xA8, 0xF0, 0x90, 0x93, ++0x12, 0xE0, 0x90, 0x95, 0xA9, 0xF0, 0x90, 0x93, ++0x13, 0xE0, 0x90, 0x95, 0xAA, 0xF0, 0x90, 0x93, ++0x14, 0xE0, 0x90, 0x95, 0xAB, 0xF0, 0x90, 0x93, ++0x15, 0xE0, 0x90, 0x95, 0xAC, 0xF0, 0x90, 0x93, ++0x16, 0xE0, 0x90, 0x95, 0xAD, 0xF0, 0x90, 0x93, ++0x17, 0xE0, 0x90, 0x95, 0xAE, 0xF0, 0x90, 0x93, ++0x18, 0xE0, 0x90, 0x95, 0xAF, 0xF0, 0x90, 0x93, ++0x19, 0xE0, 0x90, 0x95, 0xB0, 0xF0, 0x90, 0x93, ++0x1A, 0xE0, 0x90, 0x95, 0xB1, 0xF0, 0xF1, 0x33, ++0x90, 0x95, 0x4B, 0xF0, 0xD1, 0xC6, 0x50, 0x09, ++0xF1, 0x02, 0x74, 0x01, 0xF0, 0xD1, 0xBF, 0x80, ++0xF3, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, ++0x1E, 0x31, 0xFD, 0x90, 0x95, 0x40, 0xF0, 0xA3, ++0xF1, 0x81, 0xD1, 0xC6, 0x50, 0x48, 0xD1, 0xE0, ++0xF1, 0x79, 0xFE, 0x24, 0xB2, 0xF5, 0x82, 0xE4, ++0x34, 0x95, 0xF1, 0x24, 0xE0, 0x24, 0x4D, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, ++0x74, 0x4D, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, ++0xF1, 0x24, 0xE0, 0x24, 0x4E, 0xF9, 0xE4, 0x34, ++0xFC, 0xFA, 0x7B, 0x01, 0xEE, 0xF1, 0xA8, 0x12, ++0x86, 0x76, 0xF1, 0x28, 0xE0, 0x24, 0x38, 0xF9, ++0xE4, 0x34, 0xFC, 0xFA, 0xEE, 0xF1, 0x9A, 0x12, ++0x86, 0x76, 0xD1, 0xBF, 0x80, 0xB4, 0x90, 0x02, ++0x87, 0xE0, 0x70, 0x02, 0xC1, 0xAB, 0x90, 0x93, ++0x03, 0xE0, 0x20, 0xE0, 0x02, 0xC1, 0xAB, 0xE4, ++0x90, 0x95, 0xBC, 0xF1, 0x3B, 0x90, 0x95, 0x40, ++0xE0, 0xFF, 0xA3, 0xE0, 0xA3, 0xCF, 0xF0, 0xA3, ++0xEF, 0xF0, 0x90, 0x95, 0x42, 0xE0, 0xFC, 0xA3, ++0xE0, 0xFD, 0xEC, 0x90, 0xFD, 0x11, 0xF0, 0x74, ++0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, ++0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, ++0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0x90, ++0x95, 0x44, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x02, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, ++0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, ++0x90, 0x95, 0x47, 0xF0, 0xFC, 0x74, 0x07, 0x2D, ++0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, ++0x54, 0xC0, 0x90, 0x95, 0x49, 0xF0, 0xEC, 0x24, ++0x18, 0x90, 0x95, 0x46, 0xF0, 0xFD, 0x90, 0x95, ++0x42, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD1, 0xB0, ++0xEF, 0x54, 0xFC, 0x90, 0x95, 0x48, 0xF0, 0x90, ++0x95, 0x47, 0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, ++0x90, 0x95, 0x44, 0x8F, 0xF0, 0x12, 0x02, 0xE7, ++0x90, 0x95, 0x44, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0x12, 0xD8, 0x9D, 0x90, 0x95, 0x40, 0xEE, 0x8F, ++0xF0, 0x12, 0x02, 0xE7, 0x90, 0x88, 0x27, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x40, 0x12, ++0xD2, 0x31, 0x9E, 0x40, 0x1B, 0x90, 0x88, 0x28, ++0xE0, 0x24, 0x01, 0xFF, 0x90, 0x88, 0x27, 0xE0, ++0x34, 0x00, 0xFE, 0xC3, 0xED, 0x9F, 0xFF, 0xEC, ++0x9E, 0x90, 0x95, 0x40, 0xF0, 0xA3, 0xEF, 0xF0, ++0x90, 0x95, 0x48, 0xE0, 0x24, 0xC0, 0x60, 0x02, ++0xA1, 0xBA, 0xD1, 0xD3, 0x24, 0x18, 0xD1, 0xAF, ++0xEF, 0x60, 0x02, 0xA1, 0xB0, 0xD1, 0xD3, 0x24, ++0x19, 0xD1, 0xAF, 0x90, 0x95, 0x61, 0xF1, 0x89, ++0x90, 0x95, 0x61, 0xE0, 0xFF, 0xD1, 0xFB, 0x9F, ++0x50, 0x15, 0xD1, 0xD3, 0x24, 0x1A, 0xD1, 0xAC, ++0x90, 0x95, 0x4A, 0xE0, 0x24, 0x62, 0xF5, 0x82, ++0xE4, 0x34, 0x95, 0xF1, 0x0D, 0x80, 0xE1, 0x90, ++0x95, 0x61, 0xE0, 0x70, 0x02, 0x81, 0xE5, 0xE4, ++0x90, 0x95, 0x4B, 0xF0, 0xD1, 0xC6, 0x40, 0x02, ++0x81, 0xCD, 0xD1, 0xE0, 0xF1, 0x79, 0xFF, 0x24, ++0x4D, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, ++0xE0, 0xFE, 0x90, 0x95, 0x61, 0xE0, 0xFD, 0xEE, ++0x6D, 0x70, 0x20, 0xEF, 0xF1, 0xA8, 0x12, 0x86, ++0x6D, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xF1, ++0x18, 0x90, 0x95, 0xC7, 0xED, 0xF0, 0xD0, 0x01, ++0xD0, 0x02, 0xD0, 0x03, 0xF1, 0x45, 0xEF, 0x60, ++0x02, 0x80, 0x4D, 0x90, 0x95, 0x61, 0xE0, 0x64, ++0x03, 0x70, 0x54, 0xF1, 0x18, 0x90, 0x95, 0xC7, ++0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x89, 0xF1, ++0x45, 0xEF, 0x70, 0x11, 0xF1, 0x18, 0x90, 0x95, ++0xC7, 0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x85, ++0xF1, 0x45, 0xEF, 0x60, 0x2A, 0x90, 0x95, 0x4B, ++0xE0, 0xFF, 0x24, 0xAD, 0xF5, 0x82, 0xE4, 0x34, ++0x95, 0xF5, 0x83, 0xE0, 0x60, 0x02, 0x80, 0x0B, ++0x90, 0x95, 0x4B, 0xE0, 0xFF, 0x24, 0xA8, 0xF1, ++0x91, 0x60, 0x05, 0x74, 0xBC, 0x2F, 0x80, 0x15, ++0xD1, 0xED, 0x74, 0x01, 0xF0, 0x80, 0x12, 0x90, ++0x95, 0x4B, 0xE0, 0x24, 0xBC, 0x80, 0x06, 0x90, ++0x95, 0x4B, 0xE0, 0x24, 0xBC, 0xD1, 0xF3, 0xE4, ++0xF0, 0xD1, 0xBF, 0x81, 0x24, 0x90, 0x95, 0xBC, ++0xE0, 0x70, 0x4F, 0xA3, 0xE0, 0x70, 0x4B, 0xA3, ++0xE0, 0x70, 0x47, 0xA3, 0xE0, 0x70, 0x43, 0xA3, ++0xE0, 0x70, 0x3F, 0xA1, 0xB0, 0xE4, 0x90, 0x95, ++0x4B, 0xF0, 0xD1, 0xC6, 0x50, 0x1C, 0x74, 0xA8, ++0x2E, 0xF1, 0x91, 0x60, 0x09, 0x74, 0xBC, 0x2E, ++0xD1, 0xF3, 0xE4, 0xF0, 0x80, 0x08, 0x74, 0xBC, ++0x2E, 0xD1, 0xF3, 0x74, 0x01, 0xF0, 0xD1, 0xBF, ++0x80, 0xE0, 0x90, 0x95, 0xBC, 0xE0, 0x70, 0x12, ++0xA3, 0xE0, 0x70, 0x0E, 0xA3, 0xE0, 0x70, 0x0A, ++0xA3, 0xE0, 0x70, 0x06, 0xA3, 0xE0, 0x70, 0x02, ++0xA1, 0xB0, 0xE4, 0x90, 0x95, 0x4B, 0xF0, 0xD1, ++0xC6, 0x40, 0x02, 0xA1, 0xB0, 0xD1, 0xE0, 0x12, ++0x7B, 0x07, 0xD1, 0xED, 0xE0, 0x60, 0x75, 0x90, ++0x93, 0x29, 0xE0, 0x30, 0xE0, 0x06, 0xC4, 0x54, ++0x0F, 0x30, 0xE0, 0x68, 0xE4, 0xFF, 0xFE, 0x90, ++0x04, 0x1D, 0xE0, 0x60, 0x10, 0xD3, 0xEF, 0x94, ++0xE8, 0xEE, 0x94, 0x03, 0x50, 0x07, 0x0F, 0xBF, ++0x00, 0x01, 0x0E, 0x80, 0xEA, 0x90, 0x04, 0x1D, ++0xE0, 0x70, 0x49, 0x90, 0x95, 0x4B, 0xE0, 0x24, ++0xA3, 0xD1, 0xE3, 0x90, 0x92, 0x13, 0x74, 0x06, ++0xF0, 0x7B, 0x08, 0x7D, 0x01, 0x12, 0x66, 0xDB, ++0x90, 0x95, 0x44, 0xEE, 0xF0, 0xA3, 0xF1, 0x89, ++0xD1, 0xFB, 0x94, 0x06, 0x50, 0x1C, 0xD1, 0xD3, ++0x24, 0x0A, 0xD1, 0xAC, 0x90, 0x95, 0x44, 0xA3, ++0xE0, 0xFE, 0x90, 0x95, 0x4A, 0xE0, 0x2E, 0x24, ++0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF1, 0x0D, ++0x80, 0xDE, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, ++0x90, 0x06, 0x35, 0xF0, 0xD1, 0xBF, 0xA1, 0x27, ++0xF1, 0xC7, 0x90, 0x06, 0x36, 0x74, 0xDD, 0xF0, ++0x41, 0xEE, 0x90, 0x95, 0x49, 0xE0, 0x60, 0x02, ++0xC1, 0xA7, 0xD1, 0xD3, 0x24, 0x16, 0xD1, 0xAF, ++0x90, 0x06, 0x34, 0xEF, 0xF0, 0xD1, 0xD3, 0x24, ++0x17, 0xD1, 0xAF, 0x90, 0x06, 0x37, 0xF1, 0x81, ++0xD1, 0xC6, 0x50, 0x3A, 0xD1, 0xE0, 0x12, 0x7B, ++0x07, 0xE4, 0x90, 0x95, 0x4A, 0xF0, 0xD1, 0xFB, ++0x94, 0x06, 0x50, 0x26, 0xD1, 0xD3, 0x24, 0x04, ++0x2D, 0xD1, 0xAF, 0x90, 0x95, 0x4B, 0xE0, 0xFE, ++0xF1, 0x9A, 0x12, 0x86, 0x6D, 0x90, 0x95, 0x4A, ++0xE0, 0xF5, 0x82, 0xF1, 0x73, 0x6F, 0x60, 0x06, ++0xF1, 0x02, 0xE4, 0xF0, 0x80, 0x04, 0xF1, 0x11, ++0x80, 0xD4, 0xD1, 0xBF, 0x80, 0xC2, 0x90, 0x95, ++0xB7, 0xE0, 0x64, 0x01, 0x60, 0x17, 0xA3, 0xE0, ++0x64, 0x01, 0x60, 0x11, 0xA3, 0xE0, 0x64, 0x01, ++0x60, 0x0B, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x05, ++0xA3, 0xE0, 0xB4, 0x01, 0x06, 0x90, 0x95, 0x4C, ++0x74, 0x01, 0xF0, 0x90, 0x95, 0x4C, 0xE0, 0x64, ++0x01, 0x70, 0x51, 0xF1, 0xDD, 0x12, 0xBE, 0x48, ++0x12, 0xBD, 0x41, 0x90, 0x93, 0x25, 0xE0, 0x70, ++0x02, 0x41, 0xEE, 0x90, 0x01, 0x3C, 0xE0, 0x30, ++0xE4, 0x03, 0x74, 0x10, 0xF0, 0x7D, 0x10, 0xE4, ++0xFF, 0x12, 0x7C, 0x05, 0x90, 0x93, 0x26, 0xE0, ++0x60, 0x07, 0xF5, 0x4D, 0xE4, 0xF5, 0x4E, 0x80, ++0x17, 0x90, 0x93, 0x27, 0xE0, 0x60, 0x08, 0xFB, ++0xE4, 0xF5, 0x4D, 0xF5, 0x4E, 0x80, 0x0A, 0x75, ++0x4D, 0x20, 0xE4, 0xF5, 0x4E, 0xFB, 0x80, 0x01, ++0xFB, 0x7D, 0x01, 0x7F, 0x60, 0x7E, 0x01, 0x12, ++0x72, 0xB7, 0x41, 0xEE, 0xF1, 0x33, 0x90, 0x95, ++0x4B, 0xF0, 0xD1, 0xC6, 0x50, 0x09, 0xF1, 0x02, ++0x74, 0x01, 0xF0, 0xD1, 0xBF, 0x80, 0xF3, 0xF1, ++0xC7, 0x41, 0xEE, 0x22, 0xFC, 0xED, 0x2C, 0xFD, ++0x90, 0x8A, 0xE9, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, ++0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, 0x90, ++0x95, 0x4B, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x93, ++0x0E, 0xE0, 0xFF, 0x90, 0x95, 0x4B, 0xE0, 0xFE, ++0xC3, 0x9F, 0x22, 0x90, 0x95, 0x42, 0xE0, 0xFE, ++0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x46, 0xE0, 0x22, ++0x74, 0xA3, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, ++0xF5, 0x83, 0xE0, 0xFF, 0x22, 0x90, 0x95, 0x4B, ++0xE0, 0x24, 0xBC, 0xF5, 0x82, 0xE4, 0x34, 0x95, ++0xF5, 0x83, 0x22, 0x90, 0x95, 0x4A, 0xE0, 0xFD, ++0xC3, 0x22, 0x74, 0xB7, 0x2E, 0xF5, 0x82, 0xE4, ++0x34, 0x95, 0xF5, 0x83, 0x22, 0xF5, 0x83, 0xEF, ++0xF0, 0x90, 0x95, 0x4A, 0xE0, 0x04, 0xF0, 0x22, ++0x7B, 0x01, 0x7A, 0x95, 0x79, 0x62, 0x90, 0x95, ++0xC4, 0x02, 0x86, 0x76, 0xF5, 0x83, 0xEF, 0xF0, ++0x74, 0xB2, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, ++0xF5, 0x83, 0x22, 0xE4, 0x90, 0x95, 0x4C, 0xF0, ++0x90, 0x95, 0xB7, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, ++0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x95, 0xC1, ++0x12, 0x86, 0x76, 0xE4, 0xFF, 0x90, 0x95, 0xC7, ++0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x14, 0x90, ++0x95, 0xC4, 0xF1, 0x6E, 0xFE, 0x90, 0x95, 0xC1, ++0xF1, 0x6E, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, ++0x0F, 0x80, 0xE2, 0x7F, 0x01, 0x22, 0x12, 0x86, ++0x6D, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x02, 0x02, ++0x1F, 0x12, 0x7B, 0x07, 0x90, 0x95, 0x4B, 0xE0, ++0x22, 0xEF, 0xF0, 0xE4, 0x90, 0x95, 0x4B, 0xF0, ++0x22, 0xEF, 0xF0, 0xE4, 0x90, 0x95, 0x4A, 0xF0, ++0x22, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, ++0xE0, 0x22, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x94, ++0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, ++0x75, 0xF0, 0x03, 0xA4, 0x24, 0x52, 0xF5, 0x82, ++0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xAC, 0x0A, ++0x11, 0xE4, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, ++0x95, 0x40, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, ++0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0xA3, ++0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x93, 0x03, ++0xE0, 0xFE, 0xEE, 0x54, 0xFE, 0xF0, 0x7D, 0x08, ++0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0xE4, 0x90, 0x93, ++0x0F, 0xF0, 0xA3, 0xF0, 0x22, 0x7F, 0x02, 0x12, ++0x7B, 0x41, 0xEF, 0x22, 0x12, 0x88, 0xCA, 0x11, ++0x08, 0x7A, 0x93, 0x79, 0x1B, 0x02, 0x69, 0xF5, ++0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, 0x75, 0x48, ++0x05, 0x7B, 0x01, 0x22, 0x12, 0x88, 0xCA, 0x11, ++0x08, 0x7A, 0x93, 0x79, 0x20, 0x02, 0x69, 0xF5, ++0x90, 0x96, 0xA4, 0x12, 0x86, 0x76, 0x90, 0x96, ++0xA3, 0xEF, 0xF0, 0x12, 0x86, 0x7F, 0x98, 0xB3, ++0x00, 0x98, 0xBC, 0x01, 0x98, 0xC5, 0x06, 0x98, ++0xD9, 0x08, 0x98, 0xE2, 0x09, 0x98, 0xEB, 0x0A, ++0x98, 0xF3, 0x12, 0x98, 0xFB, 0x13, 0x99, 0x03, ++0x14, 0x99, 0x0C, 0x1E, 0x99, 0x15, 0x20, 0x99, ++0x1E, 0x25, 0x99, 0x27, 0x26, 0x99, 0x30, 0x29, ++0x99, 0x39, 0x2A, 0x99, 0x42, 0x40, 0x99, 0x4D, ++0x42, 0x99, 0x5B, 0x43, 0x99, 0x64, 0x44, 0x9A, ++0x2D, 0x47, 0x99, 0x6D, 0x49, 0x99, 0x75, 0x60, ++0x99, 0x7E, 0x61, 0x99, 0x87, 0x62, 0x99, 0x90, ++0x63, 0x99, 0x99, 0x64, 0x99, 0xA2, 0x65, 0x99, ++0xAB, 0x66, 0x99, 0xB4, 0x67, 0x99, 0xBD, 0x68, ++0x99, 0xC6, 0x69, 0x99, 0xCE, 0x6B, 0x99, 0xD7, ++0x6C, 0x99, 0xE0, 0x6D, 0x99, 0xE9, 0x6E, 0x99, ++0xF2, 0x6F, 0x99, 0xFB, 0x70, 0x9A, 0x04, 0xC2, ++0x9A, 0x0C, 0xC3, 0x9A, 0x15, 0xC4, 0x98, 0xCD, ++0xC6, 0x98, 0xCD, 0xC7, 0x98, 0xCD, 0xC8, 0x00, ++0x00, 0x9A, 0x1E, 0x90, 0x96, 0xA4, 0x12, 0x86, ++0x6D, 0x02, 0x86, 0xDC, 0x90, 0x96, 0xA4, 0x12, ++0x86, 0x6D, 0x02, 0x88, 0x01, 0x90, 0x96, 0xA4, ++0x12, 0x86, 0x6D, 0xA1, 0xAC, 0x90, 0x96, 0xA3, ++0xE0, 0xFF, 0xA3, 0x12, 0x86, 0x6D, 0x02, 0xC0, ++0x6A, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, ++0x8F, 0xFD, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, ++0x02, 0x97, 0xFC, 0x90, 0x96, 0xA4, 0x12, 0x86, ++0x6D, 0x01, 0x14, 0x90, 0x96, 0xA4, 0x12, 0x86, ++0x6D, 0xE1, 0x90, 0x90, 0x96, 0xA4, 0x12, 0x86, ++0x6D, 0xE1, 0xF7, 0x90, 0x96, 0xA4, 0x12, 0x86, ++0x6D, 0x02, 0xA7, 0xF6, 0x90, 0x96, 0xA4, 0x12, ++0x86, 0x6D, 0x02, 0xA8, 0x05, 0x90, 0x96, 0xA4, ++0x12, 0x86, 0x6D, 0x02, 0x87, 0x2A, 0x90, 0x96, ++0xA4, 0x12, 0x86, 0x6D, 0x02, 0xAF, 0xED, 0x90, ++0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, 0xB0, 0x30, ++0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, 0xB7, ++0xF4, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, ++0xAD, 0xC9, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, ++0x90, 0x8A, 0xA5, 0x80, 0x09, 0x90, 0x96, 0xA4, ++0x12, 0x86, 0x6D, 0x90, 0x8A, 0xB5, 0xF1, 0x7E, ++0x02, 0x04, 0x7E, 0x90, 0x96, 0xA4, 0x12, 0x86, ++0x6D, 0x02, 0x25, 0xEC, 0x90, 0x96, 0xA4, 0x12, ++0x86, 0x6D, 0x02, 0x5B, 0xF3, 0x90, 0x96, 0xA4, ++0x12, 0x86, 0x6D, 0xE1, 0xCE, 0x90, 0x96, 0xA4, ++0x12, 0x86, 0x6D, 0x02, 0x8A, 0x5D, 0x90, 0x96, ++0xA4, 0x12, 0x86, 0x6D, 0x02, 0x77, 0x4F, 0x90, ++0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, 0x7C, 0x60, ++0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, 0x7A, ++0xC6, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, ++0x5D, 0x36, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, ++0x02, 0x7B, 0xE9, 0x90, 0x96, 0xA4, 0x12, 0x86, ++0x6D, 0x02, 0x70, 0x33, 0x90, 0x96, 0xA4, 0x12, ++0x86, 0x6D, 0x02, 0x48, 0xC9, 0x90, 0x96, 0xA4, ++0x12, 0x86, 0x6D, 0x02, 0x79, 0xF3, 0x90, 0x96, ++0xA4, 0x12, 0x86, 0x6D, 0x80, 0x60, 0x90, 0x96, ++0xA4, 0x12, 0x86, 0x6D, 0x02, 0x51, 0x7B, 0x90, ++0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, 0x79, 0x30, ++0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, 0x57, ++0xF2, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, ++0x74, 0x8D, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, ++0x02, 0x78, 0x9A, 0x90, 0x96, 0xA4, 0x12, 0x86, ++0x6D, 0x02, 0x5E, 0x0B, 0x90, 0x96, 0xA4, 0x12, ++0x86, 0x6D, 0xE1, 0xC6, 0x90, 0x96, 0xA4, 0x12, ++0x86, 0x6D, 0x02, 0xB8, 0x0A, 0x90, 0x96, 0xA4, ++0x12, 0x86, 0x6D, 0x02, 0xBF, 0xCE, 0x90, 0x01, ++0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x96, 0xA3, ++0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x12, 0x02, ++0x06, 0xFF, 0x12, 0x87, 0xDF, 0x90, 0x94, 0xBF, ++0x12, 0x87, 0xE6, 0x90, 0x94, 0xC0, 0x12, 0x87, ++0xF0, 0x90, 0x94, 0xC1, 0x12, 0x87, 0xFA, 0x90, ++0x94, 0xC2, 0x12, 0x87, 0x23, 0x90, 0x94, 0xC3, ++0xF1, 0xBF, 0x90, 0x94, 0xC4, 0xF0, 0xEF, 0x12, ++0x86, 0x7F, 0x9A, 0x76, 0x00, 0x9A, 0x82, 0x01, ++0x9A, 0x89, 0x02, 0x9A, 0x90, 0x03, 0x9A, 0x97, ++0x04, 0x9A, 0x9E, 0x05, 0x9A, 0xA7, 0x06, 0x9A, ++0xD0, 0x07, 0x00, 0x00, 0x9B, 0x29, 0x90, 0x94, ++0xBD, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x29, 0xF0, ++0x61, 0x2E, 0xB1, 0x19, 0x74, 0x2A, 0xF0, 0x61, ++0x2E, 0x91, 0x7F, 0x74, 0x31, 0xF0, 0x61, 0x2E, ++0x91, 0x7F, 0x74, 0x32, 0xF0, 0x61, 0x2E, 0xB1, ++0x19, 0x74, 0x33, 0xF0, 0x61, 0x2E, 0xB1, 0x12, ++0x90, 0x8A, 0x83, 0xF1, 0x7E, 0x61, 0x45, 0x90, ++0x94, 0xBF, 0xE0, 0x90, 0x88, 0xE1, 0xF0, 0x90, ++0x94, 0xC0, 0xE0, 0x90, 0x88, 0xE2, 0xF0, 0x90, ++0x94, 0xC1, 0xE0, 0x90, 0x88, 0xE3, 0xF0, 0x90, ++0x94, 0xC2, 0xE0, 0x90, 0x88, 0xE4, 0xF0, 0x90, ++0x94, 0xC3, 0xE0, 0x90, 0x88, 0xE5, 0xF0, 0x22, ++0x90, 0x94, 0xBF, 0xE0, 0x90, 0x94, 0xAC, 0xF0, ++0x90, 0x94, 0xC2, 0x71, 0x49, 0x78, 0x10, 0x12, ++0x03, 0xFE, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, ++0xC0, 0x07, 0x71, 0x48, 0x78, 0x18, 0x12, 0x03, ++0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0x12, 0x86, 0x54, 0xC0, 0x04, 0xC0, 0x05, ++0xC0, 0x06, 0xC0, 0x07, 0x90, 0x94, 0xC1, 0x71, ++0x49, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xD0, 0x03, ++0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, ++0x54, 0xB1, 0xA3, 0x90, 0x94, 0xC0, 0x71, 0x49, ++0x12, 0x86, 0x54, 0x90, 0x94, 0xA2, 0x02, 0x04, ++0x31, 0x91, 0x7F, 0x74, 0xFF, 0xF0, 0x90, 0x94, ++0xBE, 0xE0, 0xFF, 0x90, 0x94, 0xBD, 0xE0, 0xFD, ++0xB1, 0x12, 0x90, 0x8A, 0xCF, 0xE0, 0xF8, 0xA3, ++0xE0, 0xF5, 0x82, 0x88, 0x83, 0x02, 0x04, 0x7E, ++0xA3, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, ++0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, ++0x8A, 0x8F, 0x80, 0x03, 0x90, 0x8A, 0x87, 0x12, ++0x88, 0xDF, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, ++0x04, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0xE7, ++0xE0, 0x64, 0x08, 0x70, 0x21, 0x90, 0x88, 0xE6, ++0xE0, 0x30, 0xE0, 0x15, 0x12, 0xAF, 0xD6, 0xF0, ++0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0xE6, ++0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, 0x80, ++0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, 0xF1, 0x88, ++0x54, 0x03, 0x30, 0xE0, 0x13, 0x90, 0x88, 0xE8, ++0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, ++0x04, 0x9C, 0xE4, 0xF0, 0x90, 0x88, 0xE8, 0xF0, ++0x90, 0x88, 0x36, 0xE0, 0x60, 0x7C, 0x90, 0x88, ++0x4D, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x61, 0x71, ++0x49, 0xB1, 0x9E, 0x90, 0x05, 0x60, 0x71, 0x49, ++0x12, 0x86, 0x54, 0xC0, 0x04, 0xC0, 0x05, 0xC0, ++0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x71, 0x49, ++0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, ++0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x54, ++0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, ++0x71, 0x48, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, ++0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, ++0x86, 0x54, 0x90, 0x88, 0x81, 0x12, 0x04, 0x31, ++0x90, 0x88, 0x32, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, ++0xE0, 0x30, 0xE0, 0x0B, 0x12, 0xB6, 0x1A, 0x74, ++0x05, 0xF0, 0x12, 0x6E, 0x2F, 0xF1, 0xDE, 0x90, ++0x88, 0x32, 0xB1, 0x24, 0x30, 0xE0, 0x0B, 0x90, ++0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x04, 0xF1, 0xA3, ++0xF1, 0xB1, 0xF1, 0xD6, 0xBF, 0x03, 0x14, 0x90, ++0x93, 0x4A, 0xE0, 0xB4, 0x01, 0x0D, 0x90, 0x01, ++0xB8, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x21, 0xE0, ++0x44, 0x80, 0xF0, 0x90, 0x8A, 0xE5, 0x12, 0x8C, ++0xE5, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x93, ++0x29, 0xE0, 0x30, 0xE0, 0x09, 0x12, 0xDB, 0x9E, ++0x12, 0x8F, 0x8F, 0x12, 0x8F, 0xF5, 0x90, 0x86, ++0xB3, 0xE0, 0xB4, 0x01, 0x11, 0x12, 0xB5, 0x97, ++0x20, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x54, 0x07, ++0x30, 0xE0, 0x03, 0x12, 0xDA, 0x63, 0x22, 0x90, ++0x94, 0xBD, 0x74, 0x01, 0xF0, 0xA3, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, ++0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, ++0x08, 0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, ++0x6C, 0x12, 0xD7, 0x56, 0xF1, 0xAA, 0x90, 0x07, ++0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, ++0xC8, 0x2F, 0x12, 0xD7, 0x4D, 0xFE, 0x74, 0xB3, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, ++0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x04, 0xE8, 0x90, ++0x96, 0xB4, 0x71, 0x49, 0xB1, 0x9E, 0x90, 0x96, ++0xB3, 0x71, 0x49, 0x12, 0x86, 0x54, 0xC0, 0x04, ++0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, ++0xB5, 0x71, 0x49, 0x78, 0x10, 0x12, 0x03, 0xFE, ++0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, ++0x12, 0x86, 0x54, 0xC0, 0x04, 0xC0, 0x05, 0xC0, ++0x06, 0xC0, 0x07, 0x71, 0x48, 0x78, 0x18, 0x12, ++0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, ++0xD0, 0x00, 0x12, 0x86, 0x54, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xBF, ++0x22, 0x90, 0x94, 0xBD, 0x74, 0x06, 0xF0, 0xA3, ++0x22, 0x90, 0x88, 0x3E, 0xE0, 0x13, 0x13, 0x13, ++0x54, 0x1F, 0x22, 0xE4, 0xF5, 0x7A, 0x90, 0x88, ++0x36, 0xE0, 0x60, 0x5F, 0xF1, 0xEE, 0x70, 0x5B, ++0x12, 0xDA, 0xB8, 0xF0, 0x75, 0x7A, 0x01, 0xE5, ++0x7A, 0x60, 0x50, 0x90, 0x88, 0x39, 0xE0, 0x20, ++0xE2, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8C, 0xE5, ++0x7D, 0x01, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xF1, ++0xE6, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x04, 0x64, ++0x01, 0x70, 0x15, 0xE4, 0x90, 0x92, 0x20, 0xF0, ++0xB1, 0x21, 0xFF, 0xA3, 0xE0, 0x2F, 0x12, 0x8F, ++0x90, 0xB1, 0x21, 0xFF, 0xA3, 0xE0, 0x80, 0x11, ++0xE4, 0x90, 0x92, 0x20, 0xF0, 0xB1, 0x21, 0xB1, ++0x94, 0x2F, 0x12, 0x8F, 0x90, 0xB1, 0x21, 0xB1, ++0x94, 0x2F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, ++0x88, 0x4F, 0xF0, 0x22, 0xFF, 0xA3, 0xE0, 0x75, ++0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, 0x78, 0x08, ++0x12, 0x03, 0xFE, 0xA8, 0x04, 0xA9, 0x05, 0xAA, ++0x06, 0xAB, 0x07, 0x22, 0x12, 0x02, 0x06, 0x64, ++0x01, 0x60, 0x02, 0xC1, 0x3C, 0x90, 0x95, 0x04, ++0xF0, 0x90, 0x95, 0x04, 0xE0, 0xFF, 0xC3, 0x94, ++0x10, 0x50, 0x28, 0xEF, 0x12, 0xC1, 0xA4, 0x7A, ++0x95, 0x79, 0x03, 0x12, 0x5F, 0xA6, 0xBF, 0x01, ++0x12, 0x90, 0x95, 0x03, 0xE0, 0xFF, 0xA3, 0xE0, ++0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, ++0x83, 0xEF, 0xF0, 0x90, 0x95, 0x04, 0xE0, 0x04, ++0xF0, 0x80, 0xCE, 0x75, 0x45, 0x01, 0x75, 0x46, ++0x95, 0x75, 0x47, 0x05, 0x75, 0x48, 0x08, 0xB1, ++0x12, 0x12, 0x69, 0xF5, 0x90, 0x94, 0xBD, 0x74, ++0x24, 0xF0, 0x90, 0x94, 0xDF, 0x74, 0x08, 0xF0, ++0x75, 0x45, 0x01, 0x75, 0x46, 0x95, 0x75, 0x47, ++0x0D, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x94, 0x79, ++0xE2, 0x12, 0x69, 0xF5, 0x90, 0x94, 0xE0, 0x74, ++0x25, 0xF0, 0x90, 0x95, 0x02, 0x74, 0x08, 0xD1, ++0x3D, 0xF1, 0x7B, 0x12, 0x04, 0x7E, 0x7B, 0x01, ++0x7A, 0x94, 0x79, 0xE0, 0x12, 0x8C, 0xD3, 0x7F, ++0x04, 0x12, 0x04, 0x7E, 0x22, 0xF0, 0x7B, 0x01, ++0x7A, 0x94, 0x79, 0xBD, 0x22, 0xD1, 0x3E, 0x7F, ++0xEF, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, ++0x06, 0x90, 0x94, 0xBD, 0xE0, 0xA3, 0xF0, 0xD1, ++0x3E, 0x7F, 0xEE, 0x7E, 0x01, 0x12, 0x5F, 0xA6, ++0xBF, 0x01, 0x08, 0x90, 0x94, 0xBD, 0xE0, 0x90, ++0x94, 0xBF, 0xF0, 0xD1, 0x3E, 0x7F, 0xED, 0x7E, ++0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, ++0x94, 0xBD, 0xE0, 0x90, 0x94, 0xC0, 0xF0, 0xD1, ++0x3E, 0x7F, 0xEC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, ++0xBF, 0x01, 0x08, 0x90, 0x94, 0xBD, 0xE0, 0x90, ++0x94, 0xC1, 0xF0, 0xD1, 0x3E, 0x7F, 0xEB, 0x7E, ++0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, ++0x94, 0xBD, 0xE0, 0x90, 0x94, 0xC2, 0xF0, 0x90, ++0x94, 0xBE, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, ++0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x94, 0xC6, 0xF0, ++0x90, 0x94, 0xC2, 0xE0, 0x90, 0x94, 0xC7, 0xF0, ++0x90, 0x94, 0xC8, 0x74, 0x12, 0xF0, 0x90, 0x94, ++0xEA, 0x74, 0x05, 0xF0, 0x90, 0x94, 0xCA, 0x12, ++0xCA, 0x72, 0x90, 0x94, 0xC6, 0xE0, 0x90, 0x94, ++0xCD, 0xF0, 0x90, 0x94, 0xC7, 0xE0, 0x90, 0x94, ++0xCE, 0xF0, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xC8, ++0x12, 0x8C, 0xD3, 0x7F, 0x04, 0x02, 0x04, 0x7E, ++0x7E, 0x00, 0x7F, 0x0B, 0x7D, 0x00, 0x7B, 0x01, ++0x7A, 0x93, 0x79, 0x4C, 0x12, 0x04, 0x80, 0xD1, ++0x3E, 0xF1, 0xB8, 0xBF, 0x01, 0x1C, 0x90, 0x94, ++0xBD, 0xE0, 0xFE, 0x54, 0x01, 0x90, 0x93, 0x4C, ++0xF0, 0xEE, 0x54, 0x04, 0x90, 0x93, 0x4E, 0xF0, ++0x90, 0x94, 0xBD, 0xE0, 0x54, 0x08, 0x90, 0x93, ++0x4D, 0xF0, 0xD1, 0x3E, 0x7F, 0xFB, 0x12, 0xBA, ++0xA4, 0x70, 0x35, 0x90, 0x94, 0xBD, 0xE0, 0x54, ++0x07, 0x70, 0x15, 0x7B, 0x01, 0x7A, 0x94, 0x79, ++0xBE, 0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, 0xA6, ++0xBF, 0x01, 0x0F, 0x90, 0x94, 0xBE, 0x80, 0x03, ++0x90, 0x94, 0xBD, 0xE0, 0x54, 0x07, 0x90, 0x93, ++0x50, 0xF0, 0x90, 0x94, 0xBD, 0xE0, 0x54, 0xE0, ++0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, 0x4F, 0xF0, ++0xD1, 0x3E, 0x7F, 0xFD, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xBF, 0x01, 0x0E, 0x90, 0x94, 0xBD, 0xE0, ++0x54, 0x0C, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x93, ++0x51, 0xF0, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, ++0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x22, ++0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x13, 0x22, ++0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0x28, 0xF0, ++0xBF, 0x01, 0x07, 0xD1, 0x45, 0xE4, 0x90, 0x93, ++0x28, 0xF0, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, ++0x7C, 0x7E, 0x90, 0x07, 0xC0, 0x74, 0x80, 0xF0, ++0x22, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, ++0x7F, 0xF9, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0xF0, ++0x90, 0x00, 0x06, 0x02, 0x02, 0x1F, 0x12, 0x02, ++0x06, 0x90, 0x93, 0x4A, 0xF0, 0x22, 0x12, 0x02, ++0x06, 0x90, 0x96, 0x13, 0xF0, 0x22, 0x90, 0x01, ++0x02, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0x90, 0x88, ++0x33, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x88, ++0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xE4, 0xFF, ++0x12, 0x78, 0x4A, 0xEF, 0x64, 0x01, 0x22, 0x12, ++0x02, 0x06, 0xFF, 0x54, 0x80, 0xFE, 0x90, 0x93, ++0x57, 0xE0, 0x54, 0x7F, 0x4E, 0xFE, 0xF0, 0xEF, ++0x54, 0x40, 0xFF, 0xEE, 0x54, 0xBF, 0x4F, 0xF1, ++0xE7, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, ++0xFF, 0x90, 0x93, 0x57, 0xF0, 0xEE, 0x54, 0x10, ++0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, 0x12, ++0x02, 0x06, 0x54, 0x0F, 0xFE, 0xEF, 0x54, 0xF0, ++0x4E, 0x90, 0x93, 0x57, 0x12, 0x87, 0xDE, 0xFF, ++0x54, 0x7F, 0x90, 0x93, 0x59, 0xF0, 0xEF, 0x31, ++0xDB, 0xFF, 0x90, 0x93, 0x58, 0xE0, 0x54, 0xFE, ++0x12, 0x87, 0xE5, 0x90, 0x93, 0x5A, 0x12, 0x87, ++0xF0, 0x54, 0x01, 0x25, 0xE0, 0xFF, 0x90, 0x93, ++0x58, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0x31, 0xB8, ++0x20, 0xE0, 0x02, 0x7D, 0x01, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xC5, 0xED, ++0xF0, 0x90, 0x96, 0xC4, 0xEF, 0xF0, 0xD3, 0x94, ++0x07, 0x50, 0x42, 0x7F, 0x47, 0x31, 0x0D, 0x80, ++0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, ++0x7F, 0x47, 0x12, 0x7B, 0x2E, 0x7F, 0x46, 0x31, ++0x0D, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, ++0xFD, 0x7F, 0x46, 0x31, 0xD1, 0x60, 0x0D, 0x7F, ++0x45, 0x31, 0x0D, 0x80, 0x02, 0xC3, 0x33, 0xD8, ++0xFC, 0x4F, 0x80, 0x0C, 0x7F, 0x45, 0x31, 0x0D, ++0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, ++0xFD, 0x7F, 0x45, 0x80, 0x46, 0x90, 0x96, 0xC4, ++0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0x31, 0x0D, ++0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, ++0xFD, 0x7F, 0x63, 0x12, 0x7B, 0x2E, 0x7F, 0x62, ++0x31, 0x0D, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, ++0x4F, 0xFD, 0x7F, 0x62, 0x31, 0xD1, 0x60, 0x0E, ++0x31, 0x0B, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, ++0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x0D, 0x31, 0x0B, ++0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, ++0xFD, 0x7F, 0x61, 0x12, 0x7B, 0x2E, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x7F, 0x61, 0x12, 0x7B, 0x41, ++0x90, 0x96, 0xC4, 0xE0, 0xFE, 0x74, 0x01, 0xA8, ++0x06, 0x08, 0x22, 0xAD, 0x07, 0x90, 0x93, 0x59, ++0xE0, 0x75, 0xF0, 0x20, 0xA4, 0xFF, 0x90, 0x96, ++0x8D, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, ++0x93, 0x5A, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0xAE, ++0xF0, 0x90, 0x96, 0x8F, 0xF0, 0xEE, 0xA3, 0xF0, ++0x31, 0xC9, 0x90, 0x96, 0x91, 0xF0, 0xEE, 0xA3, ++0xF0, 0xED, 0x64, 0x01, 0x60, 0x62, 0x90, 0x93, ++0x57, 0xE0, 0xFE, 0x31, 0xDD, 0x30, 0xE0, 0x58, ++0xEE, 0x31, 0xBD, 0x20, 0xE0, 0x02, 0x7D, 0x01, ++0x31, 0xB1, 0xFE, 0x54, 0x0F, 0xFF, 0xEE, 0xC4, ++0x13, 0x13, 0x54, 0x01, 0xFD, 0x31, 0xB1, 0xC4, ++0x13, 0x54, 0x07, 0x30, 0xE0, 0x23, 0xA3, 0xE0, ++0x30, 0xE0, 0x0F, 0x90, 0x96, 0x92, 0xE0, 0x90, ++0x92, 0x20, 0xF0, 0x90, 0x96, 0x91, 0xD1, 0xB7, ++0x80, 0x0F, 0x31, 0xC9, 0xFF, 0x12, 0x7C, 0x6A, ++0x31, 0xB8, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x11, ++0x65, 0x90, 0x93, 0x57, 0xE0, 0xC4, 0x54, 0x0F, ++0x30, 0xE0, 0x0D, 0x90, 0x96, 0x90, 0xE0, 0x90, ++0x92, 0x20, 0xF0, 0x90, 0x96, 0x8F, 0xD1, 0xB7, ++0x22, 0x11, 0x65, 0x90, 0x93, 0x57, 0xE0, 0x22, ++0x90, 0x93, 0x57, 0xE0, 0xFE, 0x54, 0x0F, 0xFF, ++0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x7D, 0x00, ++0x22, 0x90, 0x96, 0x8D, 0xE0, 0xFE, 0xA3, 0xE0, ++0x22, 0x12, 0x7B, 0x2E, 0x90, 0x96, 0xC5, 0xE0, ++0x22, 0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, ++0x13, 0x54, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x91, 0xD3, 0x20, 0xE6, 0x02, ++0x41, 0xFA, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x96, ++0xBA, 0xF0, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, ++0x96, 0xBB, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, ++0x90, 0x96, 0xBC, 0xF0, 0x90, 0x96, 0xBB, 0xE0, ++0x24, 0xFC, 0x60, 0x0F, 0x24, 0x03, 0x60, 0x02, ++0x41, 0xF3, 0x90, 0x96, 0xBA, 0xE0, 0xFF, 0x91, ++0xDA, 0x41, 0xF3, 0x90, 0x96, 0xBA, 0xE0, 0x24, ++0xD6, 0x12, 0xCB, 0x49, 0xFB, 0xE4, 0xFD, 0xFF, ++0x71, 0x2C, 0x75, 0xF0, 0x12, 0x71, 0x38, 0x13, ++0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, ++0x2C, 0x75, 0xF0, 0x12, 0x71, 0x38, 0x31, 0xDD, ++0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x2C, 0x75, 0xF0, ++0x12, 0x71, 0x38, 0xC4, 0x54, 0x03, 0xFB, 0x0D, ++0xE4, 0xFF, 0x71, 0x2C, 0x75, 0xF0, 0x12, 0xF1, ++0x80, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x2C, 0xF1, ++0xA7, 0x71, 0x29, 0x75, 0xF0, 0x12, 0x91, 0xA6, ++0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, ++0x71, 0x2C, 0x75, 0xF0, 0x12, 0x91, 0xA6, 0x54, ++0x1F, 0x71, 0x2A, 0xF1, 0xB0, 0xE0, 0xFB, 0xE4, ++0xFD, 0x0F, 0x71, 0x2C, 0x75, 0xF0, 0x08, 0xA4, ++0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x71, ++0x27, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x02, 0xF5, ++0x82, 0xE4, 0x34, 0x82, 0x71, 0x27, 0x75, 0xF0, ++0x08, 0xA4, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, ++0x82, 0x71, 0x27, 0x75, 0xF0, 0x08, 0xA4, 0x24, ++0x04, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, ++0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x2C, 0x75, ++0xF0, 0x08, 0xA4, 0x24, 0x05, 0xF5, 0x82, 0xE4, ++0x34, 0x82, 0x71, 0x27, 0x75, 0xF0, 0x08, 0xA4, ++0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x71, ++0x27, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x07, 0xF5, ++0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFB, ++0x0D, 0x51, 0xFF, 0x91, 0xD3, 0x30, 0xE0, 0x02, ++0xF1, 0x88, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, ++0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, ++0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, ++0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, ++0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, ++0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xF5, ++0x83, 0xE0, 0xFB, 0x0D, 0x51, 0xFF, 0x90, 0x96, ++0xBA, 0xE0, 0x22, 0xFF, 0x75, 0xF0, 0x12, 0xED, ++0x90, 0x89, 0x52, 0x12, 0x04, 0x6E, 0xE0, 0x22, ++0x90, 0x96, 0x7B, 0x12, 0x86, 0x76, 0x91, 0x9B, ++0x12, 0x02, 0x06, 0x54, 0x7F, 0xFD, 0x12, 0x87, ++0xDF, 0xFE, 0x54, 0x1F, 0x90, 0x96, 0x7F, 0x31, ++0xD9, 0x90, 0x96, 0x7E, 0x12, 0x87, 0xE6, 0xFE, ++0x54, 0x03, 0xFC, 0xEE, 0x54, 0x30, 0xC4, 0x54, ++0x0F, 0x90, 0x96, 0x81, 0x12, 0x87, 0xE6, 0xFE, ++0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, ++0x96, 0x80, 0x31, 0xD9, 0xFF, 0x12, 0x87, 0xE7, ++0xFB, 0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, ++0x90, 0x96, 0x83, 0xF0, 0xFA, 0xEB, 0x54, 0x04, ++0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEF, 0x54, ++0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0x71, ++0x33, 0x54, 0x7F, 0x4F, 0xF0, 0x90, 0x96, 0x80, ++0xE0, 0xF1, 0x97, 0x71, 0x33, 0x54, 0xBF, 0x4F, ++0xF0, 0xEA, 0x60, 0x02, 0x81, 0x94, 0x90, 0x96, ++0x7F, 0xE0, 0x54, 0x1F, 0x91, 0xA1, 0x54, 0xE0, ++0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x71, 0x33, 0x54, ++0xFC, 0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x25, 0xE0, ++0x25, 0xE0, 0x71, 0x33, 0x54, 0xF3, 0x4F, 0xF0, ++0x90, 0x96, 0x7E, 0xE0, 0x54, 0x01, 0xC4, 0x33, ++0x54, 0xE0, 0x91, 0xA1, 0x54, 0xDF, 0x4F, 0xF0, ++0x90, 0x96, 0x81, 0xE0, 0x54, 0x03, 0xC4, 0x54, ++0xF0, 0x71, 0x33, 0x54, 0xCF, 0x4F, 0xF0, 0x74, ++0xC6, 0x2D, 0xD1, 0x95, 0xE0, 0x54, 0xFB, 0xF0, ++0x74, 0xC6, 0x2D, 0xD1, 0x95, 0xC0, 0x83, 0xC0, ++0x82, 0xE0, 0xFF, 0x90, 0x96, 0x84, 0xE0, 0xF1, ++0xEE, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0x93, ++0x52, 0xE0, 0x60, 0x34, 0x91, 0x9B, 0xE9, 0x24, ++0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, ++0x54, 0x1F, 0x12, 0x02, 0x4C, 0x90, 0x96, 0x82, ++0x74, 0x01, 0xF0, 0x90, 0x96, 0x82, 0xE0, 0xFF, ++0xC3, 0x94, 0x04, 0x50, 0x13, 0xEF, 0x91, 0x95, ++0x8F, 0x82, 0x8E, 0x83, 0xE4, 0x12, 0x02, 0x5E, ++0x90, 0x96, 0x82, 0xE0, 0x04, 0xF0, 0x80, 0xE3, ++0x90, 0x93, 0x50, 0xE0, 0x54, 0x07, 0xFF, 0xBF, ++0x05, 0x0A, 0xEC, 0xB4, 0x01, 0x06, 0x90, 0x93, ++0x55, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x96, 0x82, ++0xF0, 0x90, 0x96, 0x82, 0xE0, 0xFC, 0x91, 0x95, ++0x8F, 0x82, 0x8E, 0x83, 0x12, 0x02, 0x1F, 0xFF, ++0xED, 0xF1, 0xB0, 0xE5, 0x82, 0x2C, 0xF1, 0x8F, ++0xEF, 0xF0, 0x90, 0x96, 0x82, 0xE0, 0x04, 0xF0, ++0xE0, 0xB4, 0x04, 0xDD, 0xAF, 0x05, 0x90, 0x8A, ++0xFF, 0x12, 0xA9, 0xA7, 0x22, 0x24, 0x03, 0xFF, ++0xE4, 0x33, 0xFE, 0x90, 0x96, 0x7B, 0x02, 0x86, ++0x6D, 0xFF, 0x75, 0xF0, 0x12, 0xED, 0x90, 0x89, ++0x51, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0x90, 0x93, ++0x57, 0xE0, 0xFF, 0x31, 0xDD, 0x30, 0xE0, 0x1A, ++0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x12, ++0xD3, 0x8E, 0x90, 0x93, 0x58, 0xE0, 0x30, 0xE0, ++0x09, 0x31, 0xB8, 0x20, 0xE0, 0x02, 0x7D, 0x01, ++0x11, 0x65, 0x22, 0x7F, 0x8F, 0x12, 0x7B, 0x41, ++0xEF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x96, 0xC2, 0xEF, 0xF0, 0x91, 0xD3, ++0x30, 0xE6, 0x37, 0x7F, 0x8D, 0x12, 0x7B, 0x41, ++0xEF, 0x64, 0x01, 0x70, 0x2D, 0x90, 0x96, 0xC3, ++0xF0, 0x90, 0x96, 0xC3, 0xE0, 0xFD, 0x90, 0x96, ++0xC2, 0xE0, 0xB1, 0x36, 0xE5, 0x82, 0x2D, 0xF1, ++0x8F, 0xE0, 0xFB, 0xE4, 0xFF, 0x51, 0xFF, 0x90, ++0x96, 0xC3, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, ++0x10, 0x40, 0xDE, 0x91, 0xD3, 0x30, 0xE0, 0x02, ++0xF1, 0x88, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, ++0xB6, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x8E, ++0xF5, 0x83, 0xE4, 0xF0, 0xE5, 0x0E, 0xC4, 0x54, ++0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x81, ++0xF5, 0x83, 0x22, 0x8D, 0x0E, 0xEF, 0x30, 0xE6, ++0x1B, 0xB1, 0x34, 0x12, 0x8F, 0x75, 0xE0, 0x54, ++0x03, 0x90, 0x92, 0x80, 0xF0, 0xE4, 0xFB, 0xAF, ++0x0E, 0x12, 0x75, 0x80, 0xB1, 0x27, 0xB1, 0xBC, ++0x74, 0x01, 0x80, 0x4F, 0xB1, 0xC3, 0x04, 0xF0, ++0xB1, 0xC3, 0x64, 0x02, 0x70, 0x1E, 0x74, 0x25, ++0x25, 0x0E, 0xD1, 0x8D, 0xE0, 0xFD, 0xF4, 0x60, ++0x02, 0x80, 0x04, 0xB1, 0x34, 0xE0, 0xFD, 0x12, ++0x8F, 0x77, 0xD1, 0xA9, 0xB1, 0x34, 0xB1, 0xBC, ++0x74, 0x02, 0x80, 0x27, 0xB1, 0xC3, 0xD3, 0x94, ++0x03, 0x40, 0x13, 0x90, 0x8A, 0xB3, 0x12, 0x8C, ++0xE5, 0xAF, 0x0E, 0x12, 0x04, 0x7E, 0xB1, 0x27, ++0xB1, 0xBC, 0x74, 0x03, 0x80, 0x0D, 0xB1, 0x34, ++0x12, 0x8F, 0x75, 0xD1, 0xA9, 0xB1, 0x34, 0xB1, ++0xBC, 0x74, 0x02, 0xF0, 0xAB, 0x0E, 0xE4, 0xFD, ++0xFF, 0x02, 0x6F, 0x75, 0xE0, 0x90, 0x92, 0x5E, ++0xF0, 0xA3, 0x22, 0x74, 0xB6, 0x25, 0x0E, 0xF5, ++0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, 0x22, ++0x8F, 0x73, 0x8D, 0x74, 0xEF, 0xB1, 0x36, 0xE0, ++0xFD, 0x54, 0x7F, 0xF5, 0x75, 0xED, 0x54, 0x80, ++0xF5, 0x76, 0xF1, 0x7C, 0xF5, 0x78, 0x75, 0xF0, ++0x12, 0xEF, 0x71, 0x38, 0xC4, 0x54, 0x03, 0xF5, ++0x79, 0xD1, 0x89, 0x74, 0xFF, 0xF0, 0xF1, 0xBE, ++0xE5, 0x76, 0x4D, 0xFF, 0xD1, 0x9D, 0xEF, 0xF0, ++0xE5, 0x73, 0x12, 0x8F, 0x79, 0xE0, 0x54, 0x03, ++0xF5, 0x77, 0x74, 0x46, 0x25, 0x73, 0xF1, 0x9F, ++0xE5, 0x77, 0xF0, 0xE5, 0x75, 0x65, 0x78, 0x70, ++0x22, 0x75, 0xF0, 0x12, 0xE5, 0x73, 0x91, 0xA6, ++0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0B, 0xE5, ++0x76, 0x70, 0x07, 0xE5, 0x75, 0x44, 0x80, 0xFD, ++0x80, 0x4A, 0xF1, 0xBE, 0x7D, 0x07, 0xAF, 0x73, ++0x02, 0xCA, 0x8B, 0xE5, 0x75, 0xC3, 0x95, 0x78, ++0x50, 0x34, 0xAB, 0x73, 0xAD, 0x78, 0xAF, 0x75, ++0x12, 0x72, 0x7F, 0xAD, 0x07, 0xE5, 0x75, 0xC3, ++0x94, 0x0C, 0x40, 0x28, 0x75, 0xF0, 0x12, 0xE5, ++0x73, 0x91, 0xA6, 0xFE, 0xC4, 0x13, 0x54, 0x07, ++0x30, 0xE0, 0x19, 0xE5, 0x74, 0x60, 0x15, 0xE5, ++0x76, 0x70, 0x11, 0xE5, 0x75, 0x44, 0x80, 0xFD, ++0xD1, 0x89, 0xEF, 0xF0, 0x80, 0x06, 0xD1, 0x9D, ++0xE5, 0x78, 0xF0, 0xFD, 0x90, 0x92, 0x80, 0xE5, ++0x77, 0xF0, 0xAB, 0x74, 0xAF, 0x73, 0x02, 0x75, ++0x80, 0x74, 0x25, 0x25, 0x73, 0xF5, 0x82, 0xE4, ++0x34, 0x96, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, ++0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xC6, 0x25, ++0x73, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, ++0x22, 0xE0, 0x54, 0x03, 0x90, 0x92, 0x80, 0xF0, ++0x7B, 0x01, 0xAF, 0x0E, 0x02, 0x75, 0x80, 0xE0, ++0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, ++0x58, 0x7E, 0x01, 0x02, 0x66, 0x33, 0xAA, 0x07, ++0xA9, 0x05, 0xEA, 0xB1, 0x36, 0xE0, 0xF5, 0x73, ++0x54, 0x7F, 0xF5, 0x75, 0x75, 0xF0, 0x12, 0xEA, ++0xF1, 0xAA, 0xE0, 0x90, 0x95, 0x4F, 0xF0, 0x75, ++0xF0, 0x12, 0xEA, 0xF1, 0x80, 0xFF, 0xEA, 0x12, ++0x8F, 0x79, 0xE0, 0x54, 0x03, 0xF5, 0x74, 0xE5, ++0x75, 0x90, 0x81, 0x9D, 0x93, 0xFD, 0xEA, 0x25, ++0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, ++0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xED, 0xF0, 0x75, ++0xF0, 0x12, 0xEA, 0x71, 0x38, 0xFE, 0xC4, 0x54, ++0x03, 0x90, 0x95, 0x4E, 0xF0, 0x74, 0xC6, 0x2A, ++0xD1, 0xA1, 0xE5, 0x75, 0xF0, 0x74, 0x46, 0x2A, ++0xF1, 0x9F, 0xE5, 0x74, 0xF0, 0xE5, 0x75, 0xD3, ++0x9F, 0x40, 0x04, 0x8F, 0x75, 0x8F, 0x73, 0x89, ++0x76, 0xE4, 0xFF, 0xEF, 0xC3, 0x95, 0x76, 0x50, ++0x34, 0xE5, 0x73, 0x30, 0xE7, 0x09, 0x85, 0x75, ++0x73, 0x19, 0xE9, 0x70, 0x25, 0x80, 0x26, 0x90, ++0x95, 0x4F, 0xE0, 0xFD, 0xE5, 0x75, 0xD3, 0x9D, ++0x40, 0x10, 0xAB, 0x02, 0x90, 0x95, 0x53, 0xE9, ++0xF0, 0xAF, 0x75, 0x12, 0xD2, 0xCB, 0x8F, 0x73, ++0x80, 0x0B, 0x90, 0x95, 0x4F, 0xE0, 0xF5, 0x73, ++0x80, 0x03, 0x0F, 0x80, 0xC6, 0xAF, 0x02, 0x90, ++0x92, 0x80, 0xE5, 0x74, 0xF0, 0xE4, 0xFB, 0xAD, ++0x73, 0x02, 0x75, 0x80, 0x75, 0xF0, 0x12, 0xEF, ++0x90, 0x89, 0x4F, 0x12, 0x04, 0x6E, 0xE0, 0x22, ++0xE4, 0xFD, 0x7F, 0x8D, 0x02, 0x7B, 0x2E, 0xF5, ++0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x22, 0x54, ++0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0x22, 0xF5, ++0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x75, ++0xF0, 0x12, 0x90, 0x89, 0x50, 0x02, 0x04, 0x6E, ++0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, ++0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0xE5, 0x75, ++0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, ++0x81, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, ++0x93, 0xFF, 0xE5, 0x73, 0x25, 0xE0, 0x24, 0x75, ++0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xEE, ++0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x21, 0xE4, 0xFF, ++0xF0, 0x12, 0x02, 0x06, 0xFE, 0x22, 0x25, 0xE0, ++0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0x22, 0x12, 0x02, ++0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x5C, 0xE0, ++0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x02, 0x06, ++0x90, 0x94, 0xE0, 0x12, 0x87, 0xDE, 0x90, 0x94, ++0xE1, 0xF0, 0x60, 0x0D, 0x11, 0x4F, 0x51, 0xF2, ++0x90, 0x94, 0xE1, 0x11, 0x4F, 0x7B, 0x57, 0x11, ++0x5B, 0x90, 0x94, 0xBD, 0x74, 0x20, 0xF0, 0x90, ++0x94, 0xDF, 0x74, 0x03, 0xF0, 0x90, 0x05, 0x22, ++0xE0, 0x90, 0x94, 0xBF, 0xF0, 0x90, 0x93, 0x5D, ++0xE0, 0x90, 0x94, 0xC0, 0xF0, 0x90, 0x93, 0x5E, ++0xE0, 0x90, 0x94, 0xC1, 0x12, 0x9E, 0x3D, 0x12, ++0x8C, 0xD3, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0xE0, ++0xFF, 0x90, 0x94, 0xE0, 0xE0, 0xFD, 0x22, 0x7D, ++0xFF, 0xE4, 0xFF, 0xEB, 0xB4, 0x57, 0x04, 0x11, ++0xF7, 0x80, 0x0E, 0xEF, 0x70, 0x07, 0x90, 0x93, ++0x5D, 0xE0, 0x4D, 0x80, 0x04, 0x71, 0x0A, 0x11, ++0xF7, 0x90, 0x05, 0x22, 0xF0, 0x90, 0x93, 0x01, ++0xEB, 0xF0, 0x22, 0xE4, 0x90, 0x96, 0xB7, 0xF0, ++0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, ++0xB9, 0xF0, 0x7B, 0x47, 0x11, 0x57, 0x90, 0x05, ++0xF8, 0xE0, 0x70, 0x1A, 0xA3, 0xE0, 0x70, 0x16, ++0xA3, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, ++0x90, 0x96, 0xB9, 0xE0, 0xFD, 0x7B, 0x48, 0xE4, ++0xFF, 0x11, 0x5B, 0x7F, 0x01, 0x22, 0x12, 0x9F, ++0x88, 0x54, 0x03, 0x30, 0xE0, 0x19, 0xD3, 0x90, ++0x96, 0xB8, 0xE0, 0x94, 0x03, 0x90, 0x96, 0xB7, ++0xE0, 0x94, 0x00, 0x40, 0x06, 0x31, 0x02, 0x7B, ++0x5A, 0x80, 0x17, 0x7F, 0x01, 0x80, 0x1C, 0xD3, ++0x90, 0x96, 0xB8, 0xE0, 0x94, 0xE8, 0x90, 0x96, ++0xB7, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x31, 0x02, ++0x7B, 0x5B, 0xE4, 0xFF, 0x11, 0x5B, 0x7F, 0x00, ++0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x7C, 0x6A, ++0x90, 0x96, 0xB7, 0x71, 0x1C, 0x80, 0x97, 0x90, ++0x93, 0x5E, 0xE0, 0xFF, 0x90, 0x93, 0x5D, 0xE0, ++0x4F, 0x22, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, ++0xF0, 0x90, 0x96, 0xB9, 0xE0, 0xFD, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, ++0x9E, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, ++0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x9D, 0xE0, ++0x30, 0xE0, 0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, ++0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x34, ++0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0xA2, 0xF0, ++0x7B, 0x26, 0x11, 0x57, 0x90, 0x8A, 0xFD, 0x12, ++0x88, 0xDF, 0xEF, 0x64, 0x01, 0x70, 0x02, 0x80, ++0x08, 0x12, 0x9F, 0x88, 0x54, 0x03, 0x30, 0xE0, ++0x04, 0x31, 0xB3, 0xEE, 0xF0, 0x90, 0x96, 0xA2, ++0xE0, 0xFD, 0x7B, 0x27, 0xE4, 0xFF, 0x11, 0x5B, ++0x31, 0x9F, 0x80, 0x06, 0x31, 0x9F, 0x31, 0xB3, ++0xEE, 0xF0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, ++0x19, 0x12, 0x9F, 0x88, 0x54, 0x03, 0x30, 0xE0, ++0x11, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x6F, 0xFF, ++0x90, 0x8A, 0xF9, 0xB1, 0xAB, 0x7D, 0x28, 0x12, ++0x04, 0x7E, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, ++0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, ++0x96, 0x9E, 0xE0, 0xFF, 0x90, 0x8A, 0xC7, 0xE0, ++0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, ++0x02, 0x04, 0x7E, 0x90, 0x86, 0xB6, 0xE0, 0xFF, ++0x90, 0x96, 0x9F, 0xE0, 0xFB, 0x90, 0x92, 0x13, ++0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x66, 0xDB, ++0x90, 0x96, 0xA0, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, ++0xF0, 0xFD, 0x90, 0x96, 0x9E, 0xE0, 0xFF, 0x90, ++0x8A, 0x95, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xF5, ++0x82, 0x8A, 0x83, 0x12, 0x04, 0x7E, 0x90, 0x96, ++0xA0, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, ++0x9B, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, ++0x8C, 0x83, 0x12, 0x04, 0x7E, 0x90, 0x96, 0xA0, ++0xA3, 0xE0, 0xFF, 0x24, 0x12, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0x01, 0xFE, ++0x90, 0x96, 0x9F, 0xE0, 0x25, 0xE0, 0x25, 0xE0, ++0x44, 0x02, 0x4E, 0xFE, 0x74, 0x12, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, ++0xA8, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x96, ++0xA7, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0xF1, 0x29, ++0xE0, 0x90, 0x96, 0xAA, 0xF0, 0x12, 0x7B, 0x07, ++0x7C, 0x00, 0xAD, 0x07, 0x90, 0x96, 0xA7, 0xE0, ++0x90, 0x04, 0x25, 0xF0, 0x90, 0x96, 0xA8, 0xE0, ++0x60, 0x05, 0x51, 0xE6, 0x44, 0x80, 0xF0, 0xAF, ++0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x51, ++0xE6, 0x54, 0xC0, 0xF0, 0x90, 0x96, 0xAA, 0xE0, ++0xFF, 0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, ++0x00, 0x8B, 0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, ++0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0x74, 0x04, 0xF0, 0xAF, 0x05, 0x51, 0x1C, 0xE0, ++0x54, 0x01, 0xFE, 0x90, 0x96, 0xA9, 0xE0, 0x25, ++0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, ++0x51, 0x1B, 0xEE, 0xF0, 0x74, 0x11, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, ++0xF0, 0x74, 0x29, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0x74, ++0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, 0x04, 0xAF, ++0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x21, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x22, 0xEF, 0xB4, 0xFF, 0x06, 0x90, 0x93, ++0x5D, 0xED, 0xF0, 0x22, 0xEF, 0xF4, 0xFE, 0x90, ++0x93, 0x5D, 0xE0, 0x5E, 0xFE, 0xED, 0x5F, 0x4E, ++0xF0, 0x22, 0xEF, 0xB4, 0xFF, 0x06, 0x90, 0x93, ++0x5E, 0xED, 0xF0, 0x22, 0xEF, 0xF4, 0xFE, 0x90, ++0x93, 0x5E, 0x80, 0xE6, 0xE4, 0x75, 0xF0, 0x01, ++0x02, 0x02, 0xE7, 0xE4, 0x90, 0x96, 0xCA, 0xF0, ++0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, ++0x22, 0xC3, 0x90, 0x96, 0xCB, 0xE0, 0x94, 0xD0, ++0x90, 0x96, 0xCA, 0xE0, 0x94, 0x07, 0x40, 0x0A, ++0x90, 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, ++0x00, 0x22, 0x90, 0x96, 0xCA, 0x71, 0x1C, 0xB1, ++0xA4, 0x80, 0xD7, 0x7F, 0x01, 0x22, 0x90, 0x93, ++0x0E, 0xE0, 0xFD, 0x7C, 0x00, 0xA3, 0xE0, 0xFE, ++0xA3, 0xE0, 0xFF, 0x12, 0x02, 0x92, 0xED, 0x4C, ++0x70, 0x05, 0x90, 0x93, 0x1B, 0x80, 0x2A, 0xED, ++0x64, 0x01, 0x4C, 0x70, 0x05, 0x90, 0x93, 0x1C, ++0x80, 0x1F, 0xED, 0x64, 0x02, 0x4C, 0x70, 0x05, ++0x90, 0x93, 0x1D, 0x80, 0x14, 0xED, 0x64, 0x03, ++0x4C, 0x70, 0x05, 0x90, 0x93, 0x1E, 0x80, 0x09, ++0xED, 0x64, 0x04, 0x4C, 0x70, 0x0C, 0x90, 0x93, ++0x1F, 0xE0, 0xFF, 0xB1, 0xB4, 0x90, 0x93, 0x0F, ++0x71, 0x1C, 0x22, 0x12, 0x9D, 0x2B, 0xE4, 0xFF, ++0x12, 0xDA, 0x26, 0x90, 0x93, 0x03, 0xE0, 0x30, ++0xE0, 0x02, 0x71, 0x56, 0x90, 0x8B, 0x07, 0x12, ++0x88, 0xDF, 0x02, 0x8E, 0xB4, 0x90, 0x96, 0xBD, ++0xEF, 0xB1, 0x9C, 0x90, 0x01, 0x09, 0xE0, 0x7F, ++0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x96, ++0xBD, 0xE0, 0x6F, 0x60, 0x34, 0xC3, 0x90, 0x96, ++0xBF, 0xE0, 0x94, 0x88, 0x90, 0x96, 0xBE, 0xE0, ++0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, ++0x44, 0x10, 0xF0, 0x22, 0x90, 0x96, 0xBE, 0x71, ++0x1C, 0xB1, 0x45, 0xD3, 0x90, 0x96, 0xBF, 0xE0, ++0x94, 0x32, 0x90, 0x96, 0xBE, 0xE0, 0x94, 0x00, ++0x40, 0xC1, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, ++0xBA, 0x22, 0x75, 0x64, 0x14, 0x90, 0x88, 0x32, ++0xE0, 0x44, 0x10, 0xF0, 0xF1, 0xD6, 0xF0, 0x7D, ++0x01, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x41, 0xE0, ++0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, 0x90, 0x88, ++0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, ++0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, ++0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x93, ++0x31, 0xE0, 0x30, 0xE0, 0x6A, 0x90, 0xFD, 0x09, ++0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, 0x90, 0x0E, ++0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, 0x95, ++0x18, 0xF0, 0x90, 0x95, 0x18, 0xE0, 0xFF, 0xC3, ++0x94, 0x05, 0x50, 0x2D, 0xB1, 0xC1, 0x80, 0x05, ++0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, ++0x90, 0x93, 0x33, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, ++0x10, 0x90, 0x95, 0x18, 0x12, 0xDB, 0x0C, 0x90, ++0x95, 0x18, 0x12, 0xDA, 0xEB, 0x44, 0x20, 0xB1, ++0x44, 0x90, 0x95, 0x18, 0xE0, 0x04, 0xF0, 0x80, ++0xC9, 0xB1, 0x3D, 0x54, 0xFE, 0xFD, 0x7F, 0x92, ++0x12, 0x7B, 0x2E, 0xB1, 0x3D, 0x44, 0x08, 0xFD, ++0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x12, 0x97, 0xF5, ++0x54, 0xFD, 0xFD, 0x7F, 0x02, 0x80, 0x07, 0xB1, ++0x3D, 0x44, 0x01, 0xFD, 0x7F, 0x92, 0x12, 0x7B, ++0x2E, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, 0x44, ++0x10, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0x7F, ++0x01, 0x71, 0xBD, 0x90, 0x00, 0x90, 0xE0, 0x44, ++0x01, 0xF0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x14, ++0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x7F, 0x92, 0x12, ++0x7B, 0x41, 0xEF, 0x22, 0xF0, 0x7F, 0x14, 0x7E, ++0x00, 0x02, 0x7C, 0x6A, 0xE4, 0x90, 0x94, 0xBD, ++0xF0, 0xA3, 0xF0, 0xF1, 0x1D, 0xEF, 0x64, 0x01, ++0x60, 0x3B, 0xC3, 0x90, 0x94, 0xBE, 0xE0, 0x94, ++0x88, 0x90, 0x94, 0xBD, 0xE0, 0x94, 0x13, 0x40, ++0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, ++0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1D, ++0x90, 0x94, 0xBD, 0x71, 0x1C, 0xB1, 0x45, 0xD3, ++0x90, 0x94, 0xBE, 0xE0, 0x94, 0x32, 0x90, 0x94, ++0xBD, 0xE0, 0x94, 0x00, 0x40, 0xC5, 0x90, 0x01, ++0xC6, 0xE0, 0x30, 0xE3, 0xBE, 0x90, 0x01, 0xC7, ++0x74, 0xFE, 0xF0, 0x22, 0xF0, 0xE4, 0xA3, 0xF0, ++0xA3, 0xF0, 0x22, 0xF0, 0x7F, 0x0A, 0x7E, 0x00, ++0x02, 0x7C, 0x6A, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, ++0x82, 0x8C, 0x83, 0x22, 0x90, 0x04, 0x24, 0xEF, ++0xF0, 0x90, 0x04, 0x57, 0xF0, 0x22, 0x54, 0x07, ++0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, ++0x22, 0x90, 0x93, 0x31, 0xE0, 0x20, 0xE0, 0x02, ++0xC1, 0x8A, 0xE4, 0x90, 0x94, 0xBD, 0xF0, 0xD1, ++0x8B, 0x40, 0x02, 0xC1, 0x8A, 0xB1, 0xC1, 0x80, ++0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, ++0xFF, 0x90, 0x93, 0x32, 0xE0, 0xFD, 0xEF, 0x5D, ++0x60, 0x02, 0xC1, 0x82, 0x12, 0x02, 0x06, 0xFF, ++0x30, 0xE0, 0x1A, 0x90, 0x93, 0x33, 0xE0, 0xFE, ++0x90, 0x94, 0xBD, 0xE0, 0xFD, 0x74, 0x01, 0xA8, ++0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, ++0x4E, 0x90, 0x93, 0x33, 0xF0, 0xEF, 0xC3, 0x13, ++0x30, 0xE0, 0x16, 0x90, 0x93, 0x34, 0xE0, 0xFF, ++0x90, 0x94, 0xBD, 0x12, 0xA1, 0x13, 0x80, 0x02, ++0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x34, ++0xF0, 0x12, 0x87, 0xDF, 0xFF, 0x90, 0x94, 0xBD, ++0xE0, 0xFE, 0x24, 0x35, 0xF5, 0x82, 0xE4, 0x34, ++0x93, 0xF5, 0x83, 0xEF, 0x12, 0x87, 0xE6, 0xFF, ++0x74, 0x3A, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, ++0x12, 0x87, 0xED, 0xFF, 0x74, 0x3F, 0x2E, 0xF5, ++0x82, 0xE4, 0x34, 0x93, 0x12, 0x87, 0xF7, 0xFF, ++0x74, 0x44, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, ++0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0x32, 0xE0, ++0xFF, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, ++0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x32, ++0xF0, 0x22, 0x90, 0x94, 0xBD, 0xE0, 0x04, 0xF0, ++0xA1, 0xD7, 0x22, 0x90, 0x94, 0xBD, 0xE0, 0xFF, ++0xC3, 0x94, 0x05, 0x22, 0x7B, 0x00, 0x7A, 0x00, ++0x79, 0x00, 0x90, 0x89, 0x2E, 0x12, 0x86, 0x76, ++0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x80, 0x90, 0x89, ++0x31, 0x12, 0x86, 0x76, 0x7A, 0x80, 0x79, 0xBF, ++0x90, 0x89, 0x34, 0x12, 0x86, 0x76, 0x7A, 0x81, ++0x79, 0x61, 0x90, 0x89, 0x3A, 0x12, 0x86, 0x76, ++0x7A, 0x81, 0x79, 0x75, 0x90, 0x89, 0x3D, 0x12, ++0x86, 0x76, 0x7A, 0x81, 0x79, 0x9D, 0x90, 0x89, ++0x40, 0x12, 0x86, 0x76, 0xF1, 0x13, 0x7A, 0x81, ++0x79, 0xD9, 0x90, 0x89, 0x49, 0x12, 0x86, 0x76, ++0x7A, 0x82, 0x79, 0x01, 0x90, 0x89, 0x4C, 0x12, ++0x86, 0x76, 0xE4, 0x90, 0x96, 0x24, 0xF0, 0x90, ++0x96, 0x13, 0xF0, 0x90, 0x94, 0xBD, 0xF0, 0xD1, ++0x8B, 0x50, 0x0F, 0x74, 0x35, 0x2F, 0xF1, 0x0B, ++0xE4, 0xF0, 0x90, 0x94, 0xBD, 0xE0, 0x04, 0xF0, ++0x80, 0xED, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x96, ++0xF5, 0x83, 0x22, 0x7A, 0x81, 0x79, 0xB1, 0x90, ++0x89, 0x46, 0x02, 0x86, 0x76, 0x90, 0x01, 0x95, ++0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, ++0x22, 0x90, 0x86, 0xAD, 0xA3, 0xE0, 0x24, 0x7F, ++0xF5, 0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, 0x22, ++0x90, 0x88, 0x38, 0xE0, 0xFF, 0x90, 0x8A, 0xB9, ++0xB1, 0xAB, 0x7D, 0x01, 0x02, 0x04, 0x7E, 0xE4, ++0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x0E, 0x90, ++0x88, 0x36, 0xE0, 0x60, 0x08, 0xF1, 0x5E, 0x54, ++0x07, 0x70, 0x02, 0xF1, 0x38, 0x22, 0x90, 0x88, ++0x3A, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xE4, 0xF5, ++0x7A, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x7A, 0x54, ++0xC0, 0x70, 0x18, 0xF1, 0x5E, 0x54, 0xFD, 0xF0, ++0xF1, 0x38, 0x90, 0x88, 0x39, 0xE0, 0x60, 0x4D, ++0x12, 0x97, 0xF5, 0x44, 0x01, 0xFD, 0x7F, 0x02, ++0x02, 0x7B, 0x2E, 0xE5, 0x7A, 0x30, 0xE6, 0x21, ++0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x1B, ++0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0xF1, 0xCE, ++0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x12, ++0x88, 0xDF, 0x80, 0x07, 0x12, 0x73, 0x8F, 0x80, ++0x02, 0xF1, 0x5E, 0xE5, 0x7A, 0x90, 0x88, 0x3A, ++0x30, 0xE7, 0x0E, 0xE0, 0x44, 0x02, 0x12, 0x8F, ++0x86, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, ++0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xF0, 0x90, ++0x88, 0x34, 0xE0, 0x54, 0x0F, 0x22, 0x90, 0x88, ++0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, ++0x90, 0x88, 0xE0, 0xE0, 0xFB, 0x90, 0x88, 0xDF, ++0xE0, 0x90, 0x92, 0x90, 0x22, 0x12, 0x02, 0x06, ++0x90, 0x88, 0x9C, 0xF0, 0x60, 0x39, 0xA3, 0xE0, ++0x20, 0xE0, 0x34, 0x90, 0x8A, 0xB9, 0x12, 0x8C, ++0xE5, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, ++0x90, 0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x30, ++0xE0, 0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, ++0x20, 0xE0, 0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, ++0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, ++0x80, 0x02, 0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, ++0x12, 0xC1, 0x9B, 0xFF, 0x54, 0x01, 0xFE, 0x90, ++0x93, 0x29, 0x12, 0xDB, 0x2C, 0x12, 0xA7, 0xE7, ++0x12, 0xDB, 0x8C, 0x90, 0x93, 0x29, 0x12, 0xDB, ++0xB0, 0x4E, 0xF0, 0x90, 0x05, 0x52, 0xE0, 0x54, ++0x07, 0x90, 0x94, 0xBD, 0x60, 0x16, 0x12, 0x86, ++0x6D, 0x12, 0x87, 0xDF, 0xFD, 0x90, 0x05, 0x56, ++0xE0, 0xC3, 0x9D, 0x90, 0x93, 0x2B, 0xF0, 0xA3, ++0xED, 0xF0, 0x80, 0x26, 0x12, 0x86, 0x6D, 0x12, ++0x87, 0xDF, 0xFB, 0xFF, 0x90, 0x05, 0x54, 0xE0, ++0xC3, 0x9F, 0xFF, 0xE4, 0x94, 0x00, 0xFE, 0x7C, ++0x00, 0x7D, 0x05, 0x12, 0x02, 0x92, 0x90, 0x93, ++0x2B, 0xEF, 0xF0, 0xEB, 0x75, 0xF0, 0x05, 0x84, ++0xA3, 0xF0, 0x12, 0x88, 0xD0, 0x12, 0x02, 0x06, ++0x20, 0xE0, 0x13, 0x12, 0x88, 0xDC, 0x90, 0x8A, ++0xF9, 0x12, 0x8C, 0xE5, 0x12, 0x8F, 0xE8, 0x90, ++0x01, 0x57, 0xE4, 0xF0, 0x80, 0x0C, 0x90, 0x8A, ++0x89, 0x12, 0x8C, 0xE5, 0x12, 0x8F, 0x60, 0x12, ++0x8F, 0xF5, 0xB1, 0x97, 0x20, 0xE0, 0x04, 0xEF, ++0x44, 0x20, 0xF0, 0x12, 0x8F, 0xEE, 0x30, 0xE0, ++0x15, 0x90, 0x88, 0x36, 0x74, 0x01, 0xF0, 0xE4, ++0x90, 0x88, 0x38, 0xF0, 0x11, 0xF6, 0xD1, 0x1A, ++0x74, 0x06, 0xF0, 0x02, 0x6E, 0x2F, 0xE4, 0x90, ++0x88, 0x36, 0xF0, 0x90, 0x88, 0x38, 0x74, 0x0C, ++0xF0, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFE, 0xF0, ++0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x88, ++0x32, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x12, 0x9F, ++0xEE, 0x60, 0x02, 0x41, 0x32, 0x90, 0x88, 0x36, ++0xE0, 0x70, 0x02, 0x41, 0x32, 0x90, 0x88, 0x9D, ++0xE0, 0x20, 0xE0, 0x32, 0x90, 0x06, 0xA9, 0xE0, ++0x54, 0xC0, 0x70, 0x2A, 0x90, 0x88, 0x9C, 0xE0, ++0x70, 0x24, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x70, ++0x1D, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x70, 0x16, ++0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, 0x70, 0x0E, ++0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x07, 0x12, ++0x97, 0xF5, 0x54, 0xFE, 0xD1, 0x89, 0x90, 0x05, ++0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, 0x90, 0x05, ++0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, 0x90, 0x05, ++0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, 0x90, 0x05, ++0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, 0x90, 0x07, ++0xF1, 0xE0, 0x90, 0x94, 0x9F, 0xF0, 0x90, 0x07, ++0xF0, 0xE0, 0x90, 0x94, 0xA0, 0xF0, 0x12, 0xC7, ++0x43, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEC, ++0xF0, 0x51, 0x3B, 0x24, 0xFD, 0x50, 0x02, 0x80, ++0x03, 0x12, 0xAF, 0x66, 0x51, 0x3B, 0x64, 0x01, ++0x70, 0x30, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, ++0x3D, 0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x30, 0xE5, ++0x05, 0xA3, 0xE0, 0xFF, 0x80, 0x05, 0x90, 0x88, ++0x3C, 0xE0, 0xFF, 0x90, 0x88, 0x3C, 0xEF, 0xF0, ++0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, ++0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x88, 0x3D, ++0xEF, 0xF0, 0x51, 0x4F, 0xE4, 0x90, 0x88, 0x3F, ++0xF0, 0xA3, 0xF0, 0x90, 0x88, 0x32, 0xB1, 0x9A, ++0x30, 0xE0, 0x5D, 0xEF, 0xC4, 0x13, 0x13, 0x54, ++0x03, 0x20, 0xE0, 0x24, 0x51, 0x33, 0x6F, 0x70, ++0x4F, 0xEF, 0x60, 0x4C, 0x90, 0x88, 0x32, 0xE0, ++0x44, 0x40, 0xF0, 0xF1, 0xDC, 0x51, 0x44, 0x12, ++0x7C, 0x05, 0x12, 0x9F, 0xB1, 0x12, 0x9F, 0xA3, ++0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0x80, 0x30, ++0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x64, ++0x01, 0x70, 0x25, 0x51, 0x33, 0xFE, 0x6F, 0x60, ++0x1F, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, ++0x60, 0x16, 0xB1, 0x8D, 0x30, 0xE0, 0x11, 0xEF, ++0x54, 0xBF, 0x51, 0x44, 0x12, 0x7C, 0x3B, 0x7D, ++0x01, 0x7F, 0x02, 0x12, 0x7C, 0x74, 0xF1, 0x7C, ++0x11, 0xF6, 0x22, 0x90, 0x88, 0x3C, 0xE0, 0xFF, ++0xA3, 0xE0, 0x22, 0x90, 0x88, 0x34, 0xE0, 0xFF, ++0xC4, 0x54, 0x0F, 0x22, 0xF0, 0x90, 0x01, 0x3F, ++0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x90, ++0x88, 0x85, 0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, ++0x07, 0x90, 0x94, 0xA0, 0xE0, 0x24, 0x46, 0xFF, ++0x90, 0x94, 0x9F, 0xE0, 0x34, 0x00, 0xAB, 0x07, ++0xFA, 0xE4, 0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, ++0x12, 0x86, 0x39, 0x90, 0x88, 0x85, 0x91, 0x5D, ++0xEF, 0x24, 0x46, 0xFF, 0xE4, 0x3E, 0xFE, 0xE4, ++0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x90, 0x88, 0x89, ++0x91, 0x5D, 0x90, 0x88, 0x85, 0x91, 0x78, 0x50, ++0x02, 0x61, 0x45, 0x90, 0x88, 0x89, 0x12, 0x86, ++0x61, 0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, ++0x86, 0x39, 0x90, 0x95, 0xCE, 0x12, 0x04, 0x31, ++0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x2C, 0x12, ++0x8E, 0xAD, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, ++0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, ++0x24, 0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, ++0x4E, 0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, ++0x94, 0x00, 0xFA, 0x91, 0x66, 0xEB, 0x2F, 0xFF, ++0xEA, 0x80, 0x1D, 0x90, 0x88, 0x33, 0xB1, 0x90, ++0x30, 0xE0, 0x02, 0x81, 0x42, 0x91, 0x66, 0x90, ++0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, ++0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, 0xED, ++0x3E, 0x90, 0x95, 0xCA, 0xF0, 0xA3, 0xEF, 0xF0, ++0xC3, 0x90, 0x95, 0xCB, 0xE0, 0x94, 0xA0, 0x90, ++0x95, 0xCA, 0xE0, 0x94, 0x00, 0x50, 0x36, 0xA3, ++0xE0, 0xFB, 0x24, 0x5F, 0x91, 0x55, 0xE0, 0x04, ++0xF0, 0x90, 0x95, 0xCE, 0x12, 0x04, 0xB8, 0xEF, ++0x54, 0x7F, 0xFF, 0x74, 0xFF, 0x2B, 0x91, 0x4A, ++0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, ++0x95, 0xCA, 0xA3, 0xE0, 0x91, 0x48, 0xEF, 0xF0, ++0x90, 0x88, 0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, ++0x7F, 0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, ++0xE0, 0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, ++0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, ++0x81, 0x42, 0xE4, 0xFF, 0xFE, 0x91, 0x52, 0xE0, ++0x2F, 0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, ++0xD3, 0x9D, 0x40, 0x07, 0x90, 0x95, 0xCC, 0xEE, ++0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE5, ++0xB1, 0x74, 0x40, 0x02, 0x80, 0x15, 0x90, 0x95, ++0xCC, 0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, ++0x50, 0x13, 0x91, 0x52, 0xE0, 0x2F, 0xFF, 0xB1, ++0x74, 0x40, 0x07, 0x90, 0x95, 0xCD, 0xEE, 0xF0, ++0x80, 0x03, 0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, ++0xE0, 0xFF, 0x91, 0x43, 0xE0, 0xFD, 0xEF, 0xC3, ++0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, ++0xF0, 0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x95, ++0xCD, 0xE0, 0x80, 0x18, 0x91, 0x43, 0xE0, 0xFD, ++0xC3, 0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, ++0xF0, 0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, ++0x95, 0xCD, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, ++0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, ++0x40, 0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, ++0xF0, 0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, ++0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, ++0x50, 0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, ++0x51, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, ++0x88, 0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, ++0x88, 0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, ++0x4F, 0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, ++0xC3, 0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, ++0x90, 0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0xD1, ++0x1A, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, ++0x8A, 0xA3, 0x12, 0x8C, 0xE5, 0xE4, 0xFF, 0x12, ++0x04, 0x7E, 0x22, 0x90, 0x95, 0xCC, 0xE0, 0xFE, ++0x24, 0xFF, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, ++0x83, 0x22, 0x74, 0x5F, 0x2E, 0xF5, 0x82, 0xE4, ++0x34, 0x93, 0xF5, 0x83, 0x22, 0x12, 0x04, 0x31, ++0x90, 0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, 0x95, ++0xCE, 0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, 0x03, ++0xEB, 0x7E, 0x02, 0xFD, 0xFC, 0x90, 0x96, 0x9A, ++0x12, 0x86, 0x61, 0xC3, 0x02, 0x03, 0xDA, 0x90, ++0x96, 0x99, 0xEF, 0xF0, 0x90, 0x88, 0xE0, 0xE0, ++0x70, 0x51, 0x7F, 0x48, 0x7E, 0x09, 0x12, 0x70, ++0x70, 0xEE, 0x54, 0x0F, 0xFE, 0xE4, 0xFD, 0xFC, ++0x90, 0x96, 0x9A, 0x12, 0x04, 0x31, 0xE4, 0x7F, ++0x80, 0x91, 0x71, 0x70, 0x05, 0x90, 0x88, 0xBE, ++0x80, 0x1B, 0xE4, 0xFF, 0xFE, 0x91, 0x73, 0x70, ++0x0A, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xE4, 0xA3, ++0xF0, 0x80, 0x56, 0xE4, 0xFF, 0x91, 0x71, 0x70, ++0x09, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xA3, 0xF0, ++0x80, 0x47, 0xE4, 0x7F, 0x80, 0xFE, 0x91, 0x73, ++0x70, 0x3F, 0x90, 0x88, 0xBE, 0xF0, 0xA3, 0x04, ++0xF0, 0x80, 0x36, 0x7F, 0x2C, 0x7E, 0x09, 0x12, ++0x70, 0x70, 0xEF, 0x54, 0x02, 0xB1, 0x5E, 0x60, ++0x08, 0x90, 0x88, 0xBE, 0x74, 0x01, 0xF0, 0x80, ++0x05, 0xE4, 0x90, 0x88, 0xBE, 0xF0, 0x7F, 0x30, ++0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x01, ++0xB1, 0x5E, 0x60, 0x07, 0xE4, 0x90, 0x88, 0xBF, ++0xF0, 0x80, 0x06, 0x90, 0x88, 0xBF, 0x74, 0x01, ++0xF0, 0x90, 0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, ++0x90, 0x8A, 0xF9, 0x12, 0x8C, 0xE5, 0x7D, 0x11, ++0x12, 0xDB, 0x95, 0x12, 0x88, 0xDF, 0x90, 0x07, ++0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x96, ++0x99, 0xE0, 0xFD, 0x70, 0x02, 0x80, 0x1C, 0xED, ++0xB4, 0x01, 0x06, 0xB1, 0x57, 0x44, 0x20, 0xF0, ++0x22, 0x90, 0x96, 0x99, 0xE0, 0xFD, 0xB4, 0x02, ++0x06, 0xB1, 0x57, 0x44, 0x60, 0xF0, 0x22, 0xED, ++0xB4, 0x03, 0x03, 0xB1, 0x57, 0xF0, 0x22, 0x90, ++0x88, 0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xFF, 0xE4, ++0xFE, 0xFD, 0xFC, 0x90, 0x96, 0x9A, 0x12, 0x04, ++0x31, 0x90, 0x96, 0x9A, 0x12, 0x04, 0xB8, 0xEC, ++0x4D, 0x4E, 0x4F, 0x22, 0x90, 0x88, 0x91, 0xE0, ++0xFD, 0xC3, 0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, ++0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0xFC, 0xEF, ++0xD3, 0x9D, 0xE4, 0x9C, 0x22, 0x90, 0x88, 0x32, ++0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x90, ++0x93, 0x29, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, ++0x1F, 0x22, 0x90, 0x88, 0x32, 0xB1, 0x9A, 0x30, ++0xE0, 0x0C, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, ++0x30, 0xE0, 0x03, 0x12, 0x9F, 0xA3, 0x90, 0x88, ++0x31, 0xB1, 0x90, 0x30, 0xE0, 0x08, 0xEF, 0x12, ++0xC7, 0x6F, 0x70, 0x4D, 0x80, 0x48, 0x90, 0x88, ++0x3F, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, ++0x54, 0xEF, 0xF0, 0x12, 0xD9, 0x33, 0x40, 0x36, ++0x12, 0x9F, 0xEE, 0x70, 0x34, 0x12, 0xAF, 0xCF, ++0x70, 0x08, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xDF, ++0x80, 0x28, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xDF, ++0x90, 0x88, 0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, ++0x94, 0x02, 0x40, 0x09, 0xD1, 0x12, 0xE4, 0x90, ++0x88, 0x40, 0xF0, 0x80, 0x03, 0x12, 0x73, 0x8F, ++0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x22, 0x12, 0xAF, ++0x38, 0x22, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xFB, ++0xF0, 0x22, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, ++0xE0, 0xFD, 0x90, 0x88, 0x4F, 0xE0, 0xFB, 0x90, ++0x92, 0x98, 0x22, 0xE4, 0xFE, 0x91, 0x52, 0xE4, ++0xF0, 0x74, 0xFF, 0x2E, 0x91, 0x4A, 0x74, 0xFF, ++0xF0, 0x0E, 0xEE, 0xB4, 0xA0, 0xEF, 0xE4, 0x90, ++0x88, 0x4D, 0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, ++0x88, 0x50, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, ++0x74, 0xA0, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0x7F, ++0x02, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFE, 0xFD, ++0x7F, 0x02, 0x12, 0x7B, 0x2E, 0x7F, 0x02, 0x12, ++0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, ++0x12, 0x7B, 0x2E, 0x7F, 0x02, 0x12, 0x7B, 0x41, ++0xEF, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x12, 0x7B, ++0x2E, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, ++0x01, 0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0x6F, ++0x90, 0x96, 0xAB, 0x12, 0x04, 0x31, 0x90, 0x96, ++0xAB, 0xF1, 0x66, 0xF1, 0x5F, 0x90, 0x01, 0x01, ++0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, ++0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, ++0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0xD1, 0x81, ++0xD1, 0x57, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, ++0xD4, 0x7C, 0x90, 0x95, 0xEF, 0xEF, 0xF0, 0x90, ++0x8A, 0x89, 0x30, 0xE0, 0x13, 0x12, 0x8C, 0xE5, ++0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, ++0x88, 0x33, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x06, ++0x12, 0x8C, 0xE5, 0x12, 0x8F, 0xE8, 0x90, 0x95, ++0xEF, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, ++0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, ++0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0xD1, 0x1A, ++0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0x6F, 0x90, ++0x96, 0xAF, 0x12, 0x04, 0x31, 0x90, 0x96, 0xAF, ++0xF1, 0x66, 0xF1, 0x5F, 0x90, 0x8A, 0xFD, 0x12, ++0x88, 0xDF, 0x90, 0x06, 0xB7, 0x74, 0x11, 0xF0, ++0x7F, 0x03, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0x90, ++0x06, 0xB4, 0xE0, 0x54, 0x0F, 0x70, 0xF1, 0xD1, ++0x57, 0x12, 0x97, 0xF5, 0x54, 0xFE, 0xD1, 0x89, ++0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, ++0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, ++0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, ++0x30, 0x7E, 0x08, 0x02, 0x70, 0xAD, 0x12, 0x04, ++0xB8, 0x90, 0x92, 0x18, 0x02, 0x04, 0x31, 0x7F, ++0x30, 0x7E, 0x08, 0x12, 0x70, 0x70, 0xED, 0x44, ++0x80, 0xFD, 0xEC, 0x22, 0x7D, 0x02, 0x7F, 0x02, ++0x02, 0x7C, 0x74, 0xF1, 0x94, 0xF1, 0x7C, 0x7F, ++0x01, 0x12, 0xDA, 0x26, 0x90, 0x8B, 0x07, 0xF1, ++0xE4, 0x02, 0x04, 0x7A, 0xE4, 0x90, 0x95, 0xEF, ++0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x3C, 0x12, ++0x9F, 0xEE, 0x70, 0x37, 0xF1, 0xDC, 0xF0, 0x12, ++0xDA, 0xB8, 0xF0, 0x90, 0x95, 0xEF, 0x74, 0x01, ++0xF0, 0xE4, 0x90, 0x88, 0x3D, 0xF0, 0x04, 0x60, ++0x22, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x0D, ++0x90, 0x8A, 0xB9, 0x12, 0x8C, 0xE5, 0x7D, 0x01, ++0x7F, 0x04, 0x12, 0x04, 0x7E, 0x12, 0x9F, 0xE6, ++0xE4, 0x90, 0x92, 0x20, 0xF0, 0x12, 0x9D, 0x21, ++0x12, 0x8F, 0x90, 0x22, 0x90, 0x88, 0x3C, 0xE0, ++0x90, 0x05, 0x73, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, ++0xAA, 0x06, 0xF9, 0x22, 0x90, 0x8A, 0xDF, 0xF1, ++0xE4, 0x02, 0x04, 0x7A, 0x12, 0x02, 0x06, 0x54, ++0x01, 0xFF, 0x90, 0x93, 0x31, 0xE0, 0x54, 0xFE, ++0x4F, 0xF0, 0x30, 0xE0, 0x04, 0xE4, 0x12, 0x97, ++0x3E, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, ++0x4B, 0xF0, 0xBF, 0x01, 0x09, 0x7F, 0x01, 0x11, ++0x1F, 0xE4, 0x90, 0x93, 0x4B, 0xF0, 0x22, 0x90, ++0x94, 0xBD, 0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0x95, ++0x79, 0x04, 0x7F, 0xF4, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x04, 0xE0, ++0x90, 0x95, 0x06, 0xF0, 0x7B, 0x01, 0x7A, 0x95, ++0x79, 0x04, 0x7F, 0xF5, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x04, 0xE0, ++0x90, 0x95, 0x07, 0xF0, 0x7B, 0x01, 0x7A, 0x95, ++0x79, 0x04, 0x7F, 0xF6, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x04, 0xE0, ++0x90, 0x95, 0x08, 0xF0, 0x7B, 0x01, 0x7A, 0x95, ++0x79, 0x04, 0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x04, 0xE0, ++0x90, 0x95, 0x09, 0xF0, 0x7B, 0x01, 0x7A, 0x95, ++0x79, 0x04, 0x7F, 0xF8, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x04, 0xE0, ++0x90, 0x95, 0x0A, 0xF0, 0x7B, 0x01, 0x7A, 0x95, ++0x79, 0x04, 0x12, 0x9F, 0xB8, 0xBF, 0x01, 0x08, ++0x90, 0x95, 0x04, 0xE0, 0x90, 0x95, 0x0B, 0xF0, ++0x7B, 0x01, 0x7A, 0x95, 0x79, 0x04, 0x7F, 0xFB, ++0x51, 0xA4, 0x70, 0x52, 0x90, 0x95, 0x04, 0xE0, ++0x90, 0x95, 0x0C, 0xF0, 0x54, 0x07, 0x60, 0x08, ++0x90, 0x95, 0x04, 0xE0, 0x54, 0xE0, 0x70, 0x3E, ++0x7B, 0x01, 0x7A, 0x95, 0x79, 0x05, 0x7F, 0xFA, ++0x51, 0xA4, 0x70, 0x32, 0x90, 0x95, 0x04, 0xE0, ++0xFC, 0x54, 0x07, 0x70, 0x12, 0x90, 0x95, 0x0C, ++0xE0, 0xFE, 0x90, 0x95, 0x05, 0xE0, 0x54, 0x07, ++0xFD, 0xEE, 0x4D, 0x90, 0x95, 0x0C, 0xF0, 0xEC, ++0x54, 0xE0, 0x70, 0x12, 0x90, 0x95, 0x0C, 0xE0, ++0xFF, 0x90, 0x95, 0x05, 0xE0, 0x54, 0xE0, 0xFE, ++0xEF, 0x4E, 0x90, 0x95, 0x0C, 0xF0, 0x7B, 0x01, ++0x7A, 0x95, 0x79, 0x04, 0x7F, 0xFD, 0x51, 0xA4, ++0x70, 0x47, 0x90, 0x95, 0x04, 0xE0, 0xFE, 0x54, ++0xCC, 0x90, 0x95, 0x0D, 0xF0, 0xEE, 0x54, 0x0C, ++0xFF, 0x60, 0x08, 0x90, 0x95, 0x04, 0xE0, 0x54, ++0xC0, 0x70, 0x2E, 0xEF, 0x70, 0x12, 0x90, 0x95, ++0x0D, 0xE0, 0xFF, 0x90, 0x95, 0x04, 0xE0, 0x54, ++0x03, 0x12, 0xA7, 0xEE, 0x90, 0x95, 0x0D, 0xF0, ++0x90, 0x95, 0x04, 0xE0, 0xFF, 0x54, 0xC0, 0x70, ++0x10, 0x90, 0x95, 0x0D, 0xE0, 0xFE, 0xEF, 0x54, ++0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0xEE, 0x4F, ++0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x04, 0x7F, ++0xF0, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, ++0x08, 0x90, 0x95, 0x04, 0xE0, 0x90, 0x95, 0x0E, ++0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x04, 0x7F, ++0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, ++0x08, 0x90, 0x95, 0x04, 0xE0, 0x90, 0x95, 0x0F, ++0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x04, 0x7F, ++0xF2, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, ++0x08, 0x90, 0x95, 0x04, 0xE0, 0x90, 0x95, 0x10, ++0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x04, 0x7F, ++0xF3, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, ++0x08, 0x90, 0x95, 0x04, 0xE0, 0x90, 0x95, 0x11, ++0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x04, 0x7F, ++0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, ++0x08, 0x90, 0x95, 0x04, 0xE0, 0x90, 0x95, 0x12, ++0xF0, 0x90, 0x94, 0xBE, 0x74, 0x19, 0xF0, 0x90, ++0x94, 0xE0, 0x74, 0x08, 0xF0, 0x90, 0x95, 0x06, ++0xE0, 0x90, 0x94, 0xC0, 0xF0, 0x90, 0x95, 0x07, ++0xE0, 0x90, 0x94, 0xC1, 0xF0, 0x90, 0x95, 0x08, ++0xE0, 0x90, 0x94, 0xC2, 0xF0, 0x90, 0x95, 0x09, ++0xE0, 0x90, 0x94, 0xC3, 0xF0, 0x90, 0x95, 0x0A, ++0xE0, 0x90, 0x94, 0xC4, 0xF0, 0x90, 0x95, 0x0B, ++0xE0, 0x90, 0x94, 0xC5, 0xF0, 0x90, 0x95, 0x0C, ++0xE0, 0x90, 0x94, 0xC6, 0xF0, 0x90, 0x95, 0x0D, ++0xE0, 0x90, 0x94, 0xC7, 0xF0, 0x90, 0x94, 0xE1, ++0x74, 0x1A, 0xF0, 0x90, 0x95, 0x03, 0x74, 0x05, ++0xF0, 0x90, 0x95, 0x0E, 0xE0, 0x90, 0x94, 0xE3, ++0xF0, 0x90, 0x95, 0x0F, 0xE0, 0x90, 0x94, 0xE4, ++0xF0, 0x90, 0x95, 0x10, 0xE0, 0x90, 0x94, 0xE5, ++0xF0, 0x90, 0x95, 0x11, 0xE0, 0x90, 0x94, 0xE6, ++0xF0, 0x90, 0x95, 0x12, 0xE0, 0x90, 0x94, 0xE7, ++0xF0, 0x90, 0x94, 0xBD, 0xE0, 0xB4, 0x01, 0x1A, ++0x7B, 0x01, 0x7A, 0x94, 0x79, 0xBE, 0x12, 0x9F, ++0x7B, 0x12, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x94, ++0x79, 0xE1, 0x12, 0x8C, 0xD3, 0x7F, 0x04, 0x02, ++0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, 0x46, 0x94, ++0x75, 0x47, 0xBE, 0x75, 0x48, 0x0A, 0x7B, 0x01, ++0x7A, 0x01, 0x79, 0xA0, 0x12, 0x69, 0xF5, 0x75, ++0x45, 0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0xE3, ++0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, 0x01, 0x79, ++0xAA, 0x02, 0x69, 0xF5, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xEF, 0x64, 0x01, 0x22, 0x90, 0x00, 0x80, ++0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x7B, ++0x2E, 0xD1, 0xBF, 0x71, 0x76, 0x12, 0x7B, 0x79, ++0x71, 0x95, 0x71, 0x83, 0x7F, 0x01, 0x12, 0x84, ++0x15, 0x90, 0x93, 0x49, 0x74, 0x02, 0xF0, 0xFF, ++0x12, 0x84, 0x15, 0x90, 0x93, 0x49, 0xE0, 0x04, ++0xF0, 0x71, 0x20, 0x12, 0x8E, 0xD6, 0x90, 0x00, ++0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, ++0x7B, 0x2E, 0x75, 0x20, 0xFF, 0x12, 0x7C, 0x97, ++0x90, 0x01, 0xA0, 0xE0, 0xB4, 0xFD, 0x04, 0xE4, ++0xFF, 0x11, 0x1F, 0x12, 0xAD, 0x4C, 0x90, 0x00, ++0x81, 0xE0, 0x44, 0x04, 0xFD, 0x7F, 0x81, 0x12, ++0x7B, 0x2E, 0x71, 0x6B, 0x12, 0x9E, 0xF0, 0x90, ++0x00, 0xAA, 0xE0, 0x44, 0x02, 0xF0, 0xA3, 0xE0, ++0x44, 0x80, 0xF0, 0xE4, 0xFF, 0x02, 0x84, 0x9E, ++0x12, 0x7B, 0x1B, 0x90, 0x86, 0xB3, 0xEF, 0xF0, ++0x71, 0x3A, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, ++0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, ++0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, 0x75, 0xE0, ++0x71, 0xFD, 0x71, 0xD2, 0x75, 0x21, 0x80, 0xE4, ++0xF5, 0x22, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, ++0x21, 0x7F, 0x50, 0x12, 0x7B, 0x2E, 0xAD, 0x22, ++0x7F, 0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, ++0x52, 0x12, 0x7B, 0x2E, 0xAD, 0x24, 0x7F, 0x53, ++0x02, 0x7B, 0x2E, 0x90, 0x01, 0xE4, 0x74, 0x1D, ++0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x01, ++0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, ++0xE4, 0xF0, 0x22, 0xE4, 0x90, 0x86, 0xAF, 0x12, ++0x97, 0x3D, 0x90, 0x93, 0x01, 0xF0, 0x90, 0x93, ++0x5D, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0x8C, ++0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, ++0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, ++0x54, 0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, ++0xE0, 0x44, 0x04, 0xF0, 0x22, 0x80, 0xDE, 0x90, ++0x00, 0xAB, 0xE0, 0xFE, 0x90, 0x00, 0xAA, 0x12, ++0x91, 0xFD, 0x54, 0x7F, 0x90, 0x95, 0xC8, 0xF0, ++0xA3, 0xEF, 0xF0, 0xE0, 0x30, 0xE1, 0x02, 0x71, ++0x95, 0x22, 0x75, 0x39, 0x06, 0x43, 0x39, 0x10, ++0x75, 0x3A, 0x01, 0x43, 0x3A, 0x08, 0x75, 0x3B, ++0x03, 0x75, 0x3C, 0x62, 0x43, 0x3C, 0x80, 0x43, ++0x3B, 0x04, 0x90, 0x01, 0x38, 0xE5, 0x39, 0xF0, ++0xA3, 0xE5, 0x3A, 0xF0, 0xA3, 0xE5, 0x3B, 0xF0, ++0xA3, 0xE5, 0x3C, 0xF0, 0x22, 0x75, 0x29, 0x12, ++0xE4, 0xF5, 0x2A, 0x75, 0x2B, 0x87, 0x75, 0x2C, ++0x33, 0xF5, 0x31, 0xF5, 0x32, 0xF5, 0x33, 0xF5, ++0x34, 0x90, 0x01, 0x30, 0xE5, 0x29, 0xF0, 0xA3, ++0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, 0xF0, 0xA3, ++0xE5, 0x2C, 0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, ++0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, ++0xF0, 0xA3, 0xE5, 0x34, 0xF0, 0x22, 0xC0, 0xE0, ++0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, ++0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, ++0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, ++0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x36, ++0xF0, 0x74, 0xBC, 0xA3, 0xF0, 0x12, 0x6C, 0xD6, ++0xE5, 0x25, 0x30, 0xE7, 0x02, 0x71, 0xB7, 0x74, ++0x36, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBC, ++0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, ++0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, ++0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, ++0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, ++0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, ++0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, ++0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, ++0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x8D, 0xF0, ++0x74, 0xBC, 0xA3, 0xF0, 0x12, 0x75, 0x50, 0xE5, ++0x3D, 0x30, 0xE1, 0x02, 0xD1, 0x51, 0xE5, 0x3D, ++0x30, 0xE2, 0x02, 0xB1, 0x7C, 0xE5, 0x3D, 0x30, ++0xE4, 0x02, 0xB1, 0x3C, 0xE5, 0x3E, 0x30, 0xE0, ++0x03, 0x12, 0xB6, 0xC7, 0xE5, 0x3E, 0x30, 0xE3, ++0x02, 0x71, 0xB5, 0xE5, 0x3F, 0x30, 0xE2, 0x09, ++0xD1, 0x7D, 0x90, 0x07, 0x8F, 0xE0, 0x44, 0x10, ++0xF0, 0xE5, 0x40, 0x30, 0xE1, 0x0B, 0x90, 0x8A, ++0xE5, 0x12, 0x8C, 0xE5, 0x7F, 0x04, 0x12, 0x04, ++0x7E, 0xE5, 0x40, 0x30, 0xE4, 0x03, 0x12, 0xB7, ++0x83, 0xE5, 0x40, 0x30, 0xE5, 0x02, 0xB1, 0x99, ++0xE5, 0x40, 0x30, 0xE6, 0x02, 0xB1, 0xD9, 0xE5, ++0x40, 0x30, 0xE7, 0x02, 0xD1, 0x5D, 0x74, 0x8D, ++0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBC, 0xA3, ++0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, ++0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, ++0xF0, 0xD0, 0xE0, 0x32, 0x12, 0x34, 0x78, 0xD1, ++0x48, 0x90, 0x96, 0xD0, 0xEF, 0xF0, 0x90, 0x86, ++0xB3, 0xE0, 0xB4, 0x02, 0x12, 0x90, 0x96, 0xD0, ++0xE0, 0xFF, 0x64, 0x01, 0x60, 0x25, 0x90, 0x01, ++0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, 0x19, 0x90, ++0x01, 0x00, 0x74, 0xFF, 0xF0, 0x7F, 0x64, 0x7E, ++0x00, 0x12, 0x7C, 0x6A, 0x90, 0x06, 0x90, 0xE0, ++0x44, 0x01, 0xF0, 0x90, 0x96, 0xD0, 0xE0, 0xFF, ++0x12, 0xA1, 0x1B, 0x22, 0x90, 0x88, 0x36, 0xE0, ++0x60, 0x14, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, ++0x08, 0x90, 0x8B, 0x01, 0x12, 0x88, 0xDF, 0x80, ++0x05, 0xD1, 0x40, 0x12, 0xAF, 0x38, 0x02, 0xA4, ++0xAE, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0xC4, 0x13, ++0x13, 0x54, 0x03, 0x30, 0xE0, 0x32, 0xEF, 0x54, ++0xBF, 0xD1, 0x2C, 0x30, 0xE0, 0x06, 0xE0, 0x44, ++0x01, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFE, 0xD1, ++0x35, 0x74, 0x04, 0xF0, 0x90, 0x88, 0xA3, 0xE0, ++0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0D, ++0x90, 0x8A, 0xB9, 0x12, 0x8C, 0xE5, 0x7D, 0x01, ++0x7F, 0x0C, 0x02, 0x04, 0x7E, 0x12, 0xAF, 0x38, ++0x22, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0x12, 0xA1, ++0xDD, 0x30, 0xE0, 0x1E, 0xEF, 0x54, 0x7F, 0xD1, ++0x2C, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, ++0x80, 0x07, 0xE0, 0x54, 0xFD, 0xD1, 0x35, 0x04, ++0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, ++0xAF, 0x38, 0x12, 0x9F, 0x88, 0x54, 0x03, 0x30, ++0xE0, 0x21, 0x90, 0x88, 0xA4, 0xE0, 0xFF, 0xC3, ++0x13, 0x30, 0xE0, 0x17, 0xEF, 0x54, 0xFD, 0xF0, ++0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0xA4, 0x30, ++0xE1, 0x05, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, ++0x54, 0xFB, 0xF0, 0x22, 0xF0, 0x90, 0x04, 0xE0, ++0xE0, 0x90, 0x88, 0x32, 0x22, 0xF0, 0x90, 0x01, ++0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x22, ++0x90, 0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, ++0x90, 0x01, 0xC7, 0x74, 0x66, 0xF0, 0xE4, 0xFF, ++0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, ++0xB5, 0xA2, 0x02, 0x8C, 0xEE, 0x90, 0x88, 0xB8, ++0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0xEB, 0x80, ++0x03, 0x90, 0x8A, 0x99, 0x12, 0x88, 0xDF, 0x90, ++0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x8A, ++0xE7, 0x12, 0x88, 0xDF, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, ++0x30, 0xE0, 0x2F, 0x90, 0x88, 0xF7, 0xE0, 0xB4, ++0x01, 0x18, 0xA3, 0xE0, 0xB4, 0x01, 0x23, 0x74, ++0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, 0xFE, 0xA3, ++0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, 0xA9, 0xA7, ++0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, 0xB4, 0x02, ++0x09, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE7, 0x12, ++0x88, 0xDF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, ++0x8A, 0x79, 0x74, 0x86, 0xF0, 0xA3, 0x74, 0xC2, ++0xF0, 0x90, 0x8A, 0xE5, 0x74, 0xC4, 0xF0, 0xA3, ++0x74, 0xAB, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0x98, ++0xF0, 0xA3, 0x74, 0x20, 0xF0, 0x90, 0x8A, 0xB9, ++0x74, 0x88, 0xF0, 0xA3, 0x74, 0xE9, 0xF0, 0x90, ++0x8A, 0xD5, 0x74, 0xC8, 0xF0, 0xA3, 0x74, 0xFB, ++0xF0, 0x90, 0x8A, 0xFB, 0x74, 0xA5, 0xF0, 0xA3, ++0x74, 0x43, 0xF0, 0x90, 0x8A, 0xA5, 0x74, 0xA3, ++0xF0, 0xA3, 0x74, 0x40, 0xF0, 0x90, 0x8A, 0xB5, ++0x74, 0xCA, 0xF0, 0xA3, 0x74, 0xFC, 0xF0, 0x90, ++0x8A, 0xC3, 0x74, 0xD4, 0xF0, 0xA3, 0x74, 0xE0, ++0xF0, 0x90, 0x8A, 0xF3, 0x74, 0xD5, 0xF0, 0xA3, ++0x74, 0x12, 0xF0, 0x90, 0x8A, 0x85, 0x74, 0xB4, ++0xF0, 0xA3, 0x74, 0x7F, 0xF0, 0x90, 0x86, 0x04, ++0x74, 0xD7, 0xF0, 0xA3, 0x74, 0x06, 0xF0, 0x90, ++0x8A, 0xA9, 0x74, 0xD5, 0xF0, 0xA3, 0x74, 0x1E, ++0xF0, 0x90, 0x8B, 0x07, 0x74, 0xD5, 0xF0, 0xA3, ++0x74, 0x43, 0xF0, 0x90, 0x8A, 0xAD, 0x74, 0xD5, ++0xF0, 0xA3, 0x74, 0xED, 0xF0, 0x90, 0x86, 0x0C, ++0x74, 0xB6, 0xF0, 0xA3, 0x74, 0x8F, 0xF0, 0x90, ++0x8A, 0xEF, 0x74, 0xB7, 0xF0, 0xA3, 0x74, 0x0E, ++0xF0, 0x90, 0x86, 0x00, 0x74, 0xC3, 0xF0, 0xA3, ++0x74, 0x7F, 0xF0, 0x90, 0x86, 0x02, 0x74, 0xC3, ++0xF0, 0xA3, 0x74, 0xEF, 0xF0, 0x90, 0x8A, 0xFD, ++0x74, 0xA8, 0xF0, 0xA3, 0x74, 0x7B, 0xF0, 0x90, ++0x8A, 0xF9, 0x74, 0xC8, 0xF0, 0xA3, 0x74, 0x94, ++0xF0, 0x90, 0x8A, 0xDB, 0x74, 0xD3, 0xF0, 0xA3, ++0x74, 0x3E, 0xF0, 0x90, 0x8A, 0xAF, 0x74, 0xA9, ++0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0x90, 0x8A, 0xD3, ++0x74, 0xD9, 0xF0, 0xA3, 0x74, 0x3F, 0xF0, 0x90, ++0x8A, 0xF5, 0x74, 0xD8, 0xF0, 0xA3, 0x74, 0xED, ++0xF0, 0x90, 0x8A, 0xA3, 0x74, 0xB6, 0xF0, 0xA3, ++0x74, 0x2B, 0xF0, 0x90, 0x86, 0x06, 0x74, 0xAA, ++0xF0, 0xA3, 0x74, 0x27, 0xF0, 0x22, 0x12, 0x02, ++0x06, 0x90, 0x93, 0x25, 0x12, 0x87, 0xDE, 0x90, ++0x93, 0x26, 0x12, 0x87, 0xE6, 0x90, 0x93, 0x27, ++0xF0, 0x22, 0x90, 0x95, 0xCA, 0xEF, 0xF0, 0x90, ++0x04, 0x7E, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x95, ++0xEE, 0xF0, 0xE0, 0xFE, 0x6F, 0x60, 0x72, 0x90, ++0x95, 0xCB, 0x74, 0x03, 0xF0, 0x90, 0x95, 0xED, ++0x74, 0x08, 0xF0, 0xEE, 0x04, 0x54, 0x0F, 0xFF, ++0xE4, 0xFE, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, ++0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, ++0xE5, 0x82, 0x2E, 0x12, 0xA7, 0x8F, 0xE0, 0xFD, ++0x74, 0xCD, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, ++0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x08, ++0xD9, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xCB, 0x12, ++0x9F, 0x7B, 0x12, 0x04, 0x7E, 0x90, 0x95, 0xEE, ++0xE0, 0x04, 0x54, 0x0F, 0xFF, 0xF0, 0xBF, 0x0F, ++0x02, 0xE4, 0xF0, 0x90, 0x95, 0xEE, 0xE0, 0x90, ++0x04, 0x7F, 0xF0, 0x90, 0x95, 0xCA, 0xE0, 0x70, ++0x05, 0x90, 0x8A, 0xE5, 0x80, 0x03, 0x90, 0x8A, ++0x79, 0x12, 0x8C, 0xE5, 0x7F, 0x04, 0x12, 0x04, ++0x7E, 0x22, 0x31, 0x9B, 0x64, 0x01, 0x60, 0x02, ++0x01, 0xF7, 0xEF, 0x24, 0x39, 0x60, 0x12, 0x14, ++0x60, 0x19, 0x24, 0x02, 0x70, 0x1F, 0xE4, 0x90, ++0x94, 0xC3, 0xF0, 0xA3, 0x74, 0x06, 0xF0, 0x80, ++0x14, 0x90, 0x94, 0xC3, 0x74, 0x06, 0xF0, 0xA3, ++0xF0, 0x80, 0x0A, 0x90, 0x94, 0xC3, 0x74, 0x0C, ++0xF0, 0xA3, 0x74, 0x04, 0xF0, 0x31, 0x0B, 0x11, ++0xF8, 0x40, 0x1B, 0x90, 0x94, 0xC1, 0xE0, 0x31, ++0xA4, 0x7A, 0x94, 0x79, 0xC0, 0x12, 0x5F, 0xA6, ++0xBF, 0x01, 0x07, 0x90, 0x94, 0xC0, 0xE0, 0xF4, ++0x70, 0x3D, 0x31, 0x00, 0x80, 0xE1, 0x31, 0x0B, ++0x11, 0xF8, 0x40, 0x33, 0x90, 0x94, 0xC1, 0xE0, ++0xFD, 0x7C, 0x00, 0x24, 0xA8, 0xFF, 0xEC, 0x34, ++0x01, 0xFE, 0xED, 0x24, 0x01, 0xFD, 0xEC, 0x33, ++0xFC, 0x90, 0x94, 0xC3, 0xE0, 0xFB, 0xC3, 0xED, ++0x9B, 0xFD, 0xEC, 0x94, 0x00, 0xFC, 0x12, 0x88, ++0xD0, 0x8D, 0x82, 0x8C, 0x83, 0x12, 0x02, 0x1F, ++0xFD, 0x31, 0x1C, 0x31, 0x00, 0x80, 0xC9, 0x22, ++0x90, 0x94, 0xC2, 0xE0, 0xD3, 0x94, 0x00, 0x22, ++0x90, 0x94, 0xC1, 0xE0, 0x04, 0xF0, 0xA3, 0xE0, ++0x14, 0xF0, 0x22, 0x90, 0x94, 0xC3, 0xE0, 0x90, ++0x94, 0xC1, 0xF0, 0x90, 0x94, 0xC4, 0xE0, 0x90, ++0x94, 0xC2, 0xF0, 0x22, 0x8E, 0x61, 0x8F, 0x62, ++0x8D, 0x63, 0xE4, 0x90, 0x94, 0xC5, 0xF0, 0x90, ++0x00, 0x37, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x37, ++0x12, 0x7B, 0x2E, 0x7D, 0x69, 0x7F, 0xCF, 0x12, ++0x7B, 0x2E, 0xE5, 0x62, 0xFD, 0x7F, 0x31, 0x12, ++0x7B, 0x2E, 0xE5, 0x61, 0x54, 0x03, 0xFF, 0x90, ++0x00, 0x32, 0xE0, 0x54, 0xFC, 0x4F, 0xFD, 0x7F, ++0x32, 0x12, 0x7B, 0x2E, 0xAD, 0x63, 0x7F, 0x30, ++0x12, 0x7B, 0x2E, 0x90, 0x00, 0x33, 0xE0, 0x44, ++0x80, 0xFD, 0x7F, 0x33, 0x12, 0x7B, 0x2E, 0x90, ++0x00, 0x33, 0xE0, 0x30, 0xE7, 0x09, 0x31, 0x93, ++0x50, 0x05, 0xE0, 0x04, 0xF0, 0x80, 0xF0, 0xE4, ++0xFD, 0x7F, 0xCF, 0x12, 0x7B, 0x2E, 0x90, 0x00, ++0x37, 0xE0, 0x54, 0x7F, 0xFD, 0x7F, 0x37, 0x12, ++0x7B, 0x2E, 0x31, 0x93, 0x7F, 0x00, 0x50, 0x02, ++0x7F, 0x01, 0x22, 0x90, 0x94, 0xC5, 0xE0, 0xC3, ++0x94, 0x64, 0x22, 0x90, 0x94, 0xBD, 0x12, 0x86, ++0x76, 0x02, 0x02, 0x06, 0x24, 0xA8, 0xFF, 0xE4, ++0x34, 0x01, 0xFE, 0x7B, 0x01, 0x22, 0x7D, 0x02, ++0x90, 0x01, 0xC4, 0x74, 0xAE, 0xF0, 0x74, 0xC1, ++0xA3, 0xF0, 0x90, 0x93, 0x49, 0xE0, 0xFF, 0xED, ++0xC3, 0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, ++0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, ++0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, ++0x22, 0x0D, 0x80, 0xDE, 0x74, 0xAE, 0x04, 0x90, ++0x01, 0xC4, 0xF0, 0x74, 0xC1, 0xA3, 0xF0, 0x7F, ++0x01, 0x22, 0xE4, 0x90, 0x95, 0x15, 0xF0, 0xA3, ++0xF0, 0xA3, 0xF0, 0x90, 0x95, 0x15, 0xE0, 0x64, ++0x01, 0xF0, 0x90, 0x93, 0x55, 0xE0, 0x70, 0x18, ++0x90, 0x93, 0x52, 0xE0, 0x70, 0x12, 0xA3, 0xE0, ++0x70, 0x0E, 0x90, 0x95, 0x15, 0xE0, 0x24, 0xEA, ++0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC1, 0xA3, 0xF0, ++0x12, 0x7C, 0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, ++0x9F, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x90, ++0x88, 0x39, 0xE0, 0xFF, 0x90, 0x88, 0x38, 0xE0, ++0x6F, 0x60, 0x03, 0x12, 0xAF, 0x38, 0xC2, 0xAF, ++0x31, 0xAE, 0xBF, 0x01, 0x02, 0x51, 0x4B, 0xD2, ++0xAF, 0x51, 0xC0, 0x12, 0xA7, 0xE5, 0x12, 0x83, ++0x4D, 0x80, 0xA8, 0x90, 0x88, 0x31, 0xE0, 0x30, ++0xE0, 0x02, 0x51, 0x55, 0x22, 0x90, 0x88, 0x39, ++0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0E, 0x51, ++0x6E, 0xBF, 0x01, 0x09, 0x12, 0x97, 0xB6, 0x90, ++0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x02, ++0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, ++0x00, 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, 0x64, ++0x01, 0x80, 0x2E, 0x90, 0x02, 0x96, 0xE0, 0x60, ++0x05, 0x75, 0x64, 0x10, 0x80, 0x23, 0x90, 0x02, ++0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, ++0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x64, ++0x04, 0x80, 0x0E, 0x90, 0x88, 0xE6, 0xE0, 0x30, ++0xE0, 0x05, 0x75, 0x64, 0x20, 0x80, 0x02, 0x61, ++0x77, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, ++0x01, 0xB8, 0xE5, 0x64, 0xF0, 0x7F, 0x00, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0x93, 0x52, 0xE0, 0x60, 0x25, 0x7F, 0x54, 0x7E, ++0x09, 0x12, 0x70, 0x70, 0x71, 0x6D, 0x12, 0x04, ++0xB8, 0xEF, 0x44, 0xFE, 0xFF, 0xEE, 0x44, 0x03, ++0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, 0x71, 0x6D, ++0x12, 0xB7, 0x66, 0x7F, 0x54, 0x7E, 0x09, 0x12, ++0x70, 0xAD, 0x90, 0x93, 0x4D, 0xE0, 0x70, 0x29, ++0x90, 0x07, 0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, ++0xF0, 0x90, 0x95, 0x1C, 0x74, 0x22, 0xF0, 0x90, ++0x95, 0x3E, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x1E, ++0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x1C, 0x12, 0x8C, 0xD3, 0x7F, 0x04, 0x12, 0x04, ++0x7E, 0x90, 0x93, 0x55, 0xE0, 0xFF, 0x70, 0x0A, ++0x90, 0x93, 0x52, 0xE0, 0x70, 0x04, 0xA3, 0xE0, ++0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, ++0xF0, 0x90, 0x01, 0xC5, 0x74, 0xEA, 0xF0, 0xA3, ++0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, 0xEF, ++0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, ++0x90, 0x93, 0x52, 0xE0, 0x60, 0x06, 0x90, 0x01, ++0xC4, 0x74, 0x01, 0xF0, 0x90, 0x93, 0x53, 0xE0, ++0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, 0x18, ++0x12, 0x04, 0x31, 0x90, 0x95, 0x18, 0x22, 0x90, ++0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, ++0x9D, 0xE0, 0x30, 0xE0, 0x10, 0x90, 0x88, 0xA3, ++0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x12, ++0x75, 0x10, 0x10, 0x80, 0x3F, 0x12, 0x7A, 0x65, ++0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x10, 0x01, ++0x80, 0x32, 0x90, 0x88, 0x31, 0x12, 0x9D, 0x24, ++0x30, 0xE0, 0x05, 0x75, 0x10, 0x02, 0x80, 0x24, ++0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, 0x04, 0x40, ++0x05, 0x75, 0x10, 0x08, 0x80, 0x16, 0x90, 0x93, ++0x29, 0xE0, 0x30, 0xE0, 0x0B, 0xC4, 0x54, 0x0F, ++0x30, 0xE0, 0x05, 0x75, 0x10, 0x11, 0x80, 0x04, ++0x71, 0x77, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, ++0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x10, 0xF0, ++0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, ++0x9D, 0xE0, 0x30, 0xE0, 0x1E, 0x90, 0x88, 0xAF, ++0xE0, 0x60, 0x05, 0x75, 0x11, 0x40, 0x81, 0x98, ++0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, 0x00, 0x40, ++0x02, 0x80, 0x2D, 0x90, 0x88, 0x9C, 0xE0, 0x60, ++0x7B, 0x80, 0x55, 0x12, 0x7A, 0x65, 0xEF, 0x64, ++0x01, 0x60, 0x05, 0x75, 0x11, 0x01, 0x80, 0x70, ++0x90, 0x88, 0x3A, 0xE0, 0xFF, 0x54, 0x03, 0x60, ++0x05, 0x75, 0x11, 0x02, 0x80, 0x62, 0x90, 0x88, ++0x38, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, ++0x75, 0x11, 0x04, 0x80, 0x53, 0xEF, 0x30, 0xE2, ++0x05, 0x75, 0x11, 0x08, 0x80, 0x4A, 0x90, 0x88, ++0x3A, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x11, 0x10, ++0x80, 0x3E, 0x90, 0x88, 0x32, 0xE0, 0x13, 0x13, ++0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x11, 0x20, ++0x80, 0x2E, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x05, ++0x75, 0x11, 0x80, 0x80, 0x23, 0x90, 0x06, 0x62, ++0xE0, 0x30, 0xE1, 0x05, 0x75, 0x11, 0x11, 0x80, ++0x17, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, ++0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, 0x05, 0x75, ++0x11, 0x12, 0x80, 0x04, 0x71, 0x77, 0x80, 0x0E, ++0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, ++0xB8, 0xE5, 0x11, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x8F, 0x0D, 0x7F, 0x02, 0x12, ++0x85, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0x45, 0x0D, ++0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, ++0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, ++0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, ++0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0x01, 0xC4, 0x74, 0xBA, 0xF0, 0x74, 0xC4, 0xA3, ++0xF0, 0x12, 0x64, 0x7F, 0xE5, 0x30, 0x30, 0xE1, ++0x02, 0xF1, 0x59, 0xE5, 0x2D, 0x30, 0xE1, 0x02, ++0xF1, 0x4E, 0xE5, 0x2D, 0x30, 0xE3, 0x03, 0x12, ++0xD3, 0xC5, 0xE5, 0x2D, 0x30, 0xE4, 0x02, 0xF1, ++0x7C, 0xE5, 0x2D, 0x30, 0xE5, 0x03, 0x12, 0xD3, ++0xD8, 0xE5, 0x2F, 0x30, 0xE0, 0x03, 0x12, 0xAB, ++0xA3, 0xE5, 0x2F, 0x30, 0xE1, 0x03, 0x12, 0x9B, ++0x50, 0xE5, 0x2F, 0x30, 0xE2, 0x02, 0xF1, 0x63, ++0xE5, 0x2F, 0x30, 0xE3, 0x02, 0xF1, 0x0A, 0xE5, ++0x2F, 0x30, 0xE4, 0x02, 0xF1, 0x22, 0xE5, 0x2F, ++0x30, 0xE5, 0x03, 0x12, 0xC8, 0x72, 0xE5, 0x2F, ++0x30, 0xE6, 0x03, 0x12, 0xAF, 0x47, 0xE5, 0x2F, ++0x30, 0xE7, 0x02, 0xD1, 0xF2, 0xE5, 0x30, 0x30, ++0xE0, 0x02, 0xD1, 0xE9, 0xE5, 0x30, 0x30, 0xE4, ++0x02, 0xB1, 0x81, 0xE5, 0x30, 0x30, 0xE5, 0x03, ++0x12, 0xB7, 0xEC, 0x74, 0xBA, 0x04, 0x90, 0x01, ++0xC4, 0xF0, 0x74, 0xC4, 0xA3, 0xF0, 0xD0, 0x07, ++0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, ++0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, ++0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, ++0x32, 0xE4, 0xFF, 0x90, 0x95, 0xCA, 0xEF, 0xF0, ++0x90, 0x88, 0x2B, 0xE0, 0x90, 0x95, 0xDC, 0xF0, ++0xE4, 0x90, 0x95, 0xCB, 0xF0, 0x90, 0x95, 0xDC, ++0xE0, 0xFE, 0x90, 0x95, 0xCB, 0xE0, 0xFF, 0xC3, ++0x9E, 0x50, 0x2B, 0xE0, 0xFE, 0xD1, 0xBA, 0xE4, ++0xF0, 0xEE, 0xF1, 0xDE, 0xE0, 0x30, 0xE7, 0x0A, ++0x75, 0xF0, 0x12, 0xEF, 0xD1, 0xC4, 0xE4, 0xF0, ++0x80, 0x0C, 0x12, 0x7C, 0x8F, 0x90, 0x95, 0xCB, ++0xE0, 0xD1, 0xBA, 0x74, 0x01, 0xF0, 0x90, 0x95, ++0xCB, 0xE0, 0x04, 0xF0, 0x80, 0xC7, 0x7F, 0x0C, ++0x7E, 0x00, 0x12, 0x7C, 0x6A, 0xE4, 0x90, 0x95, ++0xCB, 0xF0, 0x90, 0x95, 0xDC, 0xE0, 0xFF, 0x90, ++0x95, 0xCB, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, ++0xC1, 0xB9, 0x74, 0xCC, 0x2E, 0xD1, 0xBC, 0xE0, ++0x70, 0x02, 0xC1, 0xB1, 0xEE, 0xC4, 0x54, 0xF0, ++0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, ++0x83, 0xE0, 0xFD, 0xEE, 0xC4, 0x54, 0xF0, 0x24, ++0x07, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, ++0xD1, 0xCA, 0xFC, 0x75, 0xF0, 0x12, 0xF1, 0x53, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xEC, 0xC4, 0x54, ++0xF0, 0x24, 0x0A, 0xF5, 0x82, 0xE4, 0x34, 0x81, ++0xF5, 0x83, 0xE0, 0xFD, 0xEC, 0xD1, 0xDC, 0xD1, ++0xCA, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x57, 0x12, ++0x04, 0x6E, 0xEE, 0x8F, 0xF0, 0x12, 0x02, 0xE7, ++0x7F, 0x01, 0x90, 0x95, 0xCB, 0xE0, 0xFE, 0xD1, ++0xDC, 0xE5, 0x82, 0x2F, 0x12, 0xA7, 0x8F, 0xE0, ++0xFD, 0x75, 0xF0, 0x12, 0xEE, 0x90, 0x89, 0x57, ++0x12, 0x04, 0x6E, 0x75, 0xF0, 0x02, 0xEF, 0x12, ++0x04, 0x6E, 0xE4, 0x8D, 0xF0, 0x12, 0x02, 0xE7, ++0x0F, 0xEF, 0xB4, 0x05, 0xD5, 0xD1, 0xD3, 0x24, ++0x09, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, ++0xE0, 0xFE, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, ++0x55, 0x12, 0x04, 0x6E, 0xEE, 0xF0, 0xD1, 0xD3, ++0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, ++0x83, 0xE0, 0xFE, 0xF1, 0x95, 0xF5, 0x83, 0xEE, ++0xF0, 0x90, 0x95, 0xCB, 0xE0, 0xFF, 0x90, 0x95, ++0xCA, 0xE0, 0xFD, 0xF1, 0xA2, 0x90, 0x95, 0xCB, ++0xE0, 0x75, 0xF0, 0x12, 0xD1, 0xC4, 0x74, 0x01, ++0xF0, 0x90, 0x95, 0xCB, 0xE0, 0x04, 0xF0, 0xA1, ++0xDA, 0x22, 0x24, 0xCC, 0xF5, 0x82, 0xE4, 0x34, ++0x95, 0xF5, 0x83, 0x22, 0x90, 0x89, 0x56, 0x02, ++0x04, 0x6E, 0xE0, 0xFE, 0xED, 0xFF, 0x90, 0x95, ++0xCB, 0xE0, 0x22, 0x90, 0x95, 0xCB, 0xE0, 0xFF, ++0xC4, 0x54, 0xF0, 0x22, 0xC4, 0x54, 0xF0, 0x24, ++0x0B, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, ++0x22, 0x12, 0x9F, 0xD6, 0xBF, 0x03, 0x02, 0xF1, ++0x02, 0x22, 0xE4, 0xF5, 0x7A, 0xF5, 0x7B, 0xF5, ++0x7C, 0x12, 0x9F, 0xD6, 0xBF, 0x03, 0x02, 0xF1, ++0x02, 0x22, 0x90, 0x05, 0x21, 0xE0, 0x54, 0x7F, ++0xF0, 0x22, 0x12, 0x9F, 0xEE, 0x70, 0x12, 0x90, ++0x88, 0x36, 0xE0, 0x60, 0x0C, 0x90, 0x88, 0x3A, ++0xE0, 0x20, 0xE4, 0x05, 0xF1, 0x43, 0x12, 0x8F, ++0x86, 0x22, 0x12, 0x9F, 0xEE, 0x70, 0x1B, 0x90, ++0x88, 0x36, 0xE0, 0x60, 0x15, 0x90, 0x88, 0x3A, ++0xE0, 0x20, 0xE4, 0x0E, 0xF1, 0x43, 0xF0, 0x90, ++0x88, 0x31, 0xE0, 0xF1, 0x6F, 0x70, 0x03, 0x12, ++0xAF, 0x38, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, ++0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0xE4, 0xFF, ++0x02, 0xBF, 0xE2, 0x90, 0x89, 0x53, 0x02, 0x04, ++0x6E, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, ++0x8F, 0x9E, 0x22, 0x90, 0x88, 0x39, 0xE0, 0x64, ++0x02, 0x60, 0x03, 0x12, 0xB0, 0xFE, 0x22, 0x54, ++0xFB, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, ++0xF0, 0x54, 0x07, 0x22, 0x90, 0x8A, 0x75, 0x12, ++0x88, 0xDF, 0x90, 0x8A, 0xE5, 0x12, 0x8C, 0xE5, ++0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x89, 0x55, ++0x12, 0x04, 0x6E, 0xE4, 0xF0, 0x74, 0xAD, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x94, 0x22, 0x7D, 0x01, ++0xAF, 0x65, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0xED, 0x60, 0x15, 0x12, 0xCA, 0xBF, 0x90, ++0x89, 0x5F, 0x12, 0xCA, 0xF0, 0x90, 0x89, 0x53, ++0x12, 0xCA, 0xF0, 0xF1, 0x8D, 0xF5, 0x83, 0xE4, ++0xF0, 0xF1, 0xCA, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xEF, 0xC4, 0x54, 0xF0, 0x24, 0x03, ++0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, ++0x54, 0xBF, 0x44, 0x80, 0xFE, 0xEF, 0xC4, 0x54, ++0xF0, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x81, ++0xF5, 0x83, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, ++0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, ++0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, ++0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, ++0x90, 0x01, 0xC4, 0x74, 0xEB, 0xF0, 0x74, 0xC7, ++0xA3, 0xF0, 0x90, 0x8A, 0x9D, 0x12, 0x88, 0xDF, ++0x53, 0x91, 0xBF, 0x74, 0xEB, 0x04, 0x90, 0x01, ++0xC4, 0xF0, 0x74, 0xC7, 0xA3, 0xF0, 0xD0, 0x07, ++0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, ++0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, ++0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, ++0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, ++0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, ++0x7D, 0x41, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, ++0xC8, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, ++0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, ++0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, ++0xE0, 0x32, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, ++0x01, 0x19, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x13, ++0x12, 0xAF, 0xCF, 0x64, 0x02, 0x60, 0x09, 0x90, ++0x8A, 0xE1, 0x12, 0xB7, 0xE4, 0x02, 0x04, 0x7A, ++0x12, 0x73, 0x8F, 0x22, 0x90, 0x96, 0xCD, 0xED, ++0xF0, 0x64, 0x01, 0x60, 0x27, 0xE0, 0xFE, 0x64, ++0x02, 0x60, 0x21, 0xEE, 0x64, 0x29, 0x60, 0x1C, ++0xEE, 0x64, 0x2A, 0x60, 0x17, 0xEE, 0x64, 0x36, ++0x60, 0x12, 0xEE, 0xB4, 0x37, 0x02, 0x80, 0x0C, ++0xAD, 0x07, 0x7F, 0xFF, 0x12, 0xAB, 0x0A, 0x90, ++0x93, 0x5E, 0xE0, 0xFF, 0x90, 0x93, 0x5D, 0xE0, ++0x4F, 0x90, 0x05, 0x22, 0xF0, 0x90, 0x96, 0xCD, ++0xE0, 0x90, 0x93, 0x01, 0xF0, 0x22, 0xE6, 0xFD, ++0xAF, 0x65, 0xEF, 0x11, 0xEE, 0xE0, 0x54, 0xF8, ++0xF5, 0x73, 0xED, 0x42, 0x73, 0xEF, 0x11, 0xEE, ++0xE5, 0x73, 0xF0, 0x22, 0xE5, 0x65, 0xC4, 0x54, ++0xF0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x81, ++0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0x96, 0x6F, 0x51, 0x72, 0x12, ++0xAF, 0x29, 0xE0, 0x90, 0x96, 0x7A, 0xF0, 0xE4, ++0x90, 0x96, 0x77, 0xF0, 0x90, 0x96, 0x6F, 0x12, ++0xB5, 0x9A, 0x90, 0x96, 0x72, 0xF0, 0xEF, 0x54, ++0x07, 0x90, 0x96, 0x74, 0xF0, 0x90, 0x96, 0x6F, ++0xE0, 0x11, 0xEE, 0xE0, 0x90, 0x96, 0x75, 0xF0, ++0x12, 0xA7, 0x7C, 0x54, 0x7F, 0x90, 0x96, 0x78, ++0xF0, 0x90, 0x96, 0x6F, 0xE0, 0x12, 0xA7, 0xA7, ++0xE0, 0x90, 0x96, 0x79, 0xF0, 0xED, 0x54, 0x7F, ++0x90, 0x96, 0x73, 0xF0, 0xEB, 0x70, 0x21, 0x90, ++0x89, 0x3D, 0x51, 0x5F, 0xFF, 0x51, 0x7B, 0xFD, ++0x90, 0x89, 0x40, 0x12, 0x97, 0x6E, 0x2D, 0xFF, ++0xE4, 0x35, 0xF0, 0xC3, 0x13, 0xFE, 0xEF, 0x13, ++0xFF, 0x90, 0x96, 0x6F, 0xE0, 0x12, 0xA7, 0xD4, ++0x90, 0x96, 0x78, 0xE0, 0xFF, 0x90, 0x96, 0x73, ++0xE0, 0xFE, 0xD3, 0x9F, 0x40, 0x0C, 0x90, 0x96, ++0x70, 0xE0, 0x54, 0x80, 0xFD, 0xEF, 0x4D, 0xF0, ++0x80, 0x0F, 0x90, 0x96, 0x79, 0xE0, 0xFF, 0xEE, ++0xC3, 0x9F, 0x50, 0x05, 0x90, 0x96, 0x70, 0xEF, ++0xF0, 0x90, 0x96, 0x70, 0xE0, 0xFE, 0x54, 0x7F, ++0x90, 0x96, 0x73, 0xF0, 0xEE, 0x54, 0x80, 0x90, ++0x96, 0x76, 0xF0, 0x90, 0x96, 0x71, 0xE0, 0x70, ++0x25, 0xA3, 0x51, 0x67, 0xC0, 0x83, 0xC0, 0x82, ++0xE0, 0xFF, 0x90, 0x96, 0x74, 0x12, 0xA1, 0x13, ++0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, ++0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0x96, 0x75, ++0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x42, 0x90, 0x96, ++0x72, 0x51, 0x67, 0xC0, 0x83, 0xC0, 0x82, 0xE0, ++0xFF, 0x90, 0x96, 0x74, 0x12, 0xA1, 0x13, 0x80, ++0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xD0, 0x82, ++0xD0, 0x83, 0xF0, 0x90, 0x96, 0x6F, 0xE0, 0x11, ++0xEE, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x96, 0x75, ++0xF0, 0x90, 0x89, 0x46, 0x51, 0x5F, 0xF5, 0x82, ++0x12, 0x97, 0x73, 0x33, 0x33, 0x33, 0x54, 0xF8, ++0x4F, 0x90, 0x96, 0x75, 0xF0, 0x44, 0x80, 0xF0, ++0x90, 0x96, 0x70, 0x51, 0x57, 0x12, 0xA5, 0x36, ++0xEF, 0xF0, 0xEE, 0x70, 0x05, 0x90, 0x01, 0xC8, ++0xEF, 0xF0, 0x90, 0x96, 0x75, 0x51, 0x57, 0x11, ++0xEE, 0xEF, 0xF0, 0xEE, 0x12, 0x8F, 0x79, 0xE0, ++0x54, 0xFC, 0xFF, 0x90, 0x96, 0x7A, 0xE0, 0x54, ++0x03, 0x4F, 0xFE, 0x90, 0x96, 0x6F, 0xE0, 0xFF, ++0x12, 0x8F, 0x79, 0xEE, 0xF0, 0x7D, 0x01, 0x12, ++0xC7, 0xA2, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, ++0xFF, 0x90, 0x96, 0x6F, 0xE0, 0xFE, 0x22, 0x12, ++0x86, 0x6D, 0x90, 0x96, 0x73, 0xE0, 0x22, 0xE0, ++0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, ++0x83, 0x22, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, ++0xEB, 0xF0, 0x22, 0x75, 0xF0, 0x02, 0xA4, 0xF5, ++0x82, 0x85, 0xF0, 0x83, 0x02, 0x03, 0x3E, 0x7D, ++0x07, 0xAF, 0x65, 0xED, 0x30, 0xE0, 0x0C, 0x51, ++0xBF, 0x90, 0x89, 0x5F, 0x12, 0x04, 0x6E, 0xE4, ++0xF0, 0xA3, 0xF0, 0xED, 0x30, 0xE1, 0x0B, 0x75, ++0xF0, 0x12, 0xEF, 0x12, 0xC7, 0x53, 0xE4, 0xF0, ++0xA3, 0xF0, 0xED, 0x30, 0xE2, 0x0B, 0x75, 0xF0, ++0x12, 0xEF, 0x12, 0xC7, 0x8D, 0xF5, 0x83, 0xE4, ++0xF0, 0x12, 0xC7, 0xCA, 0xEE, 0xF0, 0x22, 0x75, ++0xF0, 0x12, 0xEF, 0x90, 0x89, 0x57, 0x12, 0x04, ++0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, ++0xEF, 0x90, 0x89, 0x59, 0x12, 0x04, 0x6E, 0xE4, ++0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x90, ++0x89, 0x5B, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, ++0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x5D, ++0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, ++0xF0, 0x12, 0xEF, 0x22, 0x12, 0x02, 0x06, 0xFE, ++0x12, 0x87, 0xE7, 0xFF, 0x74, 0xD6, 0x2E, 0xF5, ++0x82, 0xE4, 0x34, 0x8D, 0x12, 0x87, 0xED, 0xFF, ++0x74, 0xC6, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x8D, ++0x12, 0x87, 0xF7, 0xFF, 0x74, 0x14, 0x2E, 0x71, ++0x52, 0xEF, 0xF0, 0x74, 0xC6, 0x2E, 0x12, 0xA6, ++0x95, 0xE0, 0x30, 0xE5, 0x17, 0x75, 0xF0, 0x12, ++0xEE, 0x12, 0xA3, 0x38, 0x13, 0x13, 0x54, 0x03, ++0xFB, 0xAF, 0x06, 0x74, 0xD6, 0x2E, 0x71, 0x49, ++0xFD, 0x12, 0x6B, 0xFD, 0x22, 0x74, 0xD6, 0x25, ++0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, ++0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, ++0x83, 0x22, 0x90, 0x04, 0x85, 0xE0, 0xF5, 0x6E, ++0x90, 0x96, 0x24, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, ++0x65, 0x90, 0x88, 0x2B, 0xE0, 0xFF, 0xE5, 0x65, ++0xC3, 0x9F, 0x40, 0x03, 0x02, 0xD2, 0x22, 0xE5, ++0x65, 0x12, 0xA5, 0x36, 0xE0, 0xF5, 0x70, 0x12, ++0xDB, 0x76, 0xE0, 0x65, 0x70, 0x60, 0x16, 0x90, ++0x92, 0x5E, 0xE5, 0x70, 0xF0, 0xE4, 0xA3, 0xF0, ++0xAB, 0x65, 0xFD, 0xFF, 0x12, 0x6F, 0x75, 0x12, ++0xDB, 0x76, 0xE5, 0x70, 0xF0, 0x90, 0x04, 0xA0, ++0xE0, 0x64, 0x01, 0x70, 0x52, 0xA3, 0xE0, 0x65, ++0x65, 0x70, 0x4C, 0xA3, 0xE0, 0xF5, 0x66, 0xA3, ++0xE0, 0x90, 0x95, 0x4B, 0xF0, 0xE5, 0x65, 0x12, ++0xA5, 0x36, 0xE0, 0x65, 0x66, 0x70, 0x03, 0x02, ++0xD2, 0x1D, 0xE5, 0x65, 0x12, 0xA5, 0x36, 0xE5, ++0x66, 0xF0, 0xE5, 0x65, 0x12, 0x8F, 0x79, 0xE0, ++0x54, 0xFC, 0xFF, 0x90, 0x95, 0x4B, 0xE0, 0x54, ++0x03, 0x4F, 0xFF, 0xE5, 0x65, 0x12, 0x8F, 0x79, ++0xEF, 0xF0, 0x90, 0x92, 0x5E, 0xE5, 0x66, 0xF0, ++0xA3, 0x74, 0xFF, 0xF0, 0xAB, 0x65, 0xE4, 0xFD, ++0xFF, 0x12, 0x6F, 0x75, 0x02, 0xD2, 0x1D, 0x74, ++0xAD, 0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x94, ++0xF5, 0x83, 0xE0, 0xFB, 0x7A, 0x00, 0x75, 0xF0, ++0x12, 0xE5, 0x65, 0x90, 0x89, 0x55, 0x12, 0x04, ++0x6E, 0xE0, 0xC3, 0x9B, 0xFE, 0xE4, 0x9A, 0x90, ++0x95, 0x43, 0xF0, 0xA3, 0xCE, 0xF0, 0x75, 0xF0, ++0x12, 0xE5, 0x65, 0x12, 0xC7, 0x53, 0xE0, 0xFE, ++0xA3, 0xE0, 0xC3, 0x9B, 0xF5, 0x6C, 0xEE, 0x9A, ++0xF5, 0x6B, 0xAF, 0x65, 0x12, 0x78, 0x4A, 0xEF, ++0x70, 0x03, 0x02, 0xD2, 0x1D, 0x75, 0xF0, 0x12, ++0xE5, 0x65, 0x12, 0xA3, 0x38, 0x12, 0xA1, 0xDD, ++0x30, 0xE0, 0x03, 0x02, 0xD2, 0x1D, 0xE5, 0x65, ++0x13, 0x13, 0x13, 0x54, 0x1F, 0x51, 0x68, 0xE0, ++0xFD, 0x7C, 0x00, 0xE5, 0x65, 0x12, 0xAD, 0xBE, ++0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, ++0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, ++0x60, 0x03, 0x02, 0xD2, 0x1D, 0xE5, 0x6C, 0x45, ++0x6B, 0x70, 0x0D, 0x90, 0x95, 0x43, 0xE0, 0x70, ++0x02, 0xA3, 0xE0, 0x70, 0x03, 0x02, 0xD2, 0x1D, ++0xE5, 0x65, 0x75, 0xF0, 0x12, 0xA4, 0x24, 0x57, ++0xF9, 0x74, 0x89, 0x35, 0xF0, 0xFA, 0x7B, 0x01, ++0x90, 0x95, 0x40, 0x12, 0x86, 0x76, 0x12, 0xD2, ++0xB7, 0x12, 0x03, 0x13, 0x2F, 0xFF, 0x12, 0xD2, ++0x4A, 0x2F, 0xFF, 0x90, 0x00, 0x06, 0x12, 0x03, ++0x3E, 0x2F, 0xFF, 0x12, 0xD2, 0xC5, 0x2F, 0xF5, ++0x6F, 0xE5, 0x65, 0x12, 0xA5, 0x36, 0xE0, 0xF5, ++0x66, 0x54, 0x80, 0xF5, 0x68, 0xE5, 0x66, 0x54, ++0x7F, 0xF5, 0x67, 0x90, 0x96, 0x12, 0xE0, 0x60, ++0x16, 0x75, 0x71, 0x0A, 0x12, 0xDB, 0x3B, 0x34, ++0x81, 0xF5, 0x83, 0xE4, 0x93, 0xC3, 0x13, 0x74, ++0x01, 0x93, 0x13, 0xF5, 0x72, 0x80, 0x0A, 0x7B, ++0xFF, 0x12, 0xAF, 0x13, 0xE4, 0xF5, 0x71, 0xF5, ++0x72, 0x75, 0xF0, 0x12, 0xE5, 0x65, 0x12, 0xA7, ++0x80, 0xFF, 0xE5, 0x67, 0xD3, 0x9F, 0x40, 0x08, ++0x8F, 0x67, 0xE5, 0x67, 0x45, 0x68, 0xF5, 0x66, ++0x12, 0xD2, 0x5B, 0xE0, 0xC3, 0x94, 0x05, 0x40, ++0x02, 0xC1, 0xC6, 0xE5, 0x67, 0x90, 0x81, 0x61, ++0x93, 0xF5, 0x6D, 0xFD, 0xAF, 0x67, 0x12, 0x60, ++0x6F, 0x8F, 0x6D, 0xE5, 0x68, 0x60, 0x04, 0x05, ++0x6D, 0x05, 0x6D, 0xE5, 0x67, 0xC3, 0x94, 0x0C, ++0x40, 0x1C, 0x74, 0x14, 0x25, 0x65, 0x71, 0x52, ++0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xEF, 0x30, 0xE7, ++0x06, 0xE5, 0x6D, 0x2E, 0xFF, 0x80, 0x05, 0xC3, ++0xE5, 0x6D, 0x9E, 0xFF, 0x8F, 0x6D, 0xE5, 0x6D, ++0xD3, 0x94, 0x1A, 0xAF, 0x6D, 0x40, 0x02, 0x7F, ++0x1A, 0x8F, 0x6D, 0xE5, 0x66, 0x90, 0x81, 0xD9, ++0x93, 0xFF, 0xD3, 0x90, 0x95, 0x44, 0xE0, 0x9F, ++0x90, 0x95, 0x43, 0xE0, 0x94, 0x00, 0x40, 0x02, ++0xC1, 0x73, 0xC3, 0xE5, 0x6C, 0x94, 0x0A, 0xE5, ++0x6B, 0x94, 0x00, 0x40, 0x02, 0xC1, 0x18, 0x74, ++0x35, 0x25, 0x65, 0x12, 0xAF, 0x0B, 0xE0, 0xC3, ++0x94, 0x01, 0x40, 0x0A, 0x74, 0x35, 0x25, 0x65, ++0x12, 0xAF, 0x0B, 0xE0, 0x14, 0xF0, 0x12, 0xD2, ++0xBF, 0xFF, 0x90, 0x95, 0x44, 0xE0, 0x2F, 0xFF, ++0x90, 0x95, 0x43, 0xE0, 0x12, 0xD2, 0x3A, 0x12, ++0xD2, 0x49, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0xFC, ++0xE5, 0x6B, 0xC3, 0x13, 0xFE, 0xE5, 0x6C, 0x13, ++0xFF, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x12, ++0xE5, 0x65, 0x94, 0x05, 0x50, 0x0A, 0x74, 0x35, ++0x25, 0x65, 0x12, 0xAF, 0x0B, 0x74, 0x03, 0xF0, ++0xC1, 0x73, 0x12, 0xD2, 0x78, 0x12, 0x03, 0x13, ++0x65, 0x6F, 0x70, 0x02, 0xE5, 0xF0, 0x70, 0x32, ++0xE5, 0x65, 0xC3, 0x94, 0x05, 0x50, 0x0F, 0x74, ++0x35, 0x25, 0x65, 0x12, 0xAF, 0x0B, 0xE0, 0xD3, ++0x94, 0x00, 0x40, 0x02, 0x80, 0x07, 0xE5, 0x6F, ++0xC3, 0x94, 0x03, 0x50, 0x09, 0x7D, 0x06, 0xAF, ++0x65, 0x51, 0x8B, 0x02, 0xD2, 0x1D, 0xE4, 0xFD, ++0xAF, 0x65, 0x12, 0xA5, 0xD0, 0x51, 0x87, 0x02, ++0xD0, 0xB6, 0x12, 0xC7, 0x9E, 0x02, 0xD0, 0xB6, ++0x74, 0x35, 0x25, 0x65, 0x12, 0xAF, 0x0B, 0xE4, ++0xF0, 0x90, 0x91, 0x6C, 0x74, 0x02, 0xF0, 0xAB, ++0x6D, 0xAD, 0x65, 0xAF, 0x6C, 0xAE, 0x6B, 0x12, ++0x41, 0x9C, 0x8E, 0x69, 0x8F, 0x6A, 0x12, 0xDB, ++0x3B, 0x34, 0x81, 0xF5, 0x83, 0xC3, 0x74, 0x01, ++0x93, 0x95, 0x72, 0xFF, 0xE4, 0x93, 0x94, 0x00, ++0xFE, 0xD3, 0xE5, 0x6A, 0x9F, 0xE5, 0x69, 0x9E, ++0x40, 0x0F, 0x12, 0xDA, 0xDF, 0xE4, 0xF0, 0x7D, ++0x01, 0xAF, 0x65, 0x12, 0xA5, 0xD0, 0x02, 0xD0, ++0xB6, 0x12, 0xDB, 0xB9, 0xC3, 0xE5, 0x6A, 0x9F, ++0xE5, 0x69, 0x94, 0x00, 0x50, 0x0F, 0x12, 0xDA, ++0xDF, 0xE4, 0xF0, 0x7D, 0x01, 0xAF, 0x65, 0x12, ++0xA6, 0xC6, 0x02, 0xD0, 0xB6, 0x51, 0x87, 0x12, ++0xDA, 0xDF, 0xE0, 0x04, 0xF0, 0xE5, 0x67, 0x90, ++0x81, 0xED, 0x93, 0x25, 0x71, 0xFF, 0xE4, 0x33, ++0xFE, 0x12, 0xDA, 0xDF, 0xE0, 0xC3, 0x9F, 0xEE, ++0x12, 0xDA, 0x1F, 0x50, 0x03, 0x02, 0xD0, 0xB6, ++0x12, 0xDA, 0xDF, 0xE4, 0xF0, 0x12, 0xDB, 0xB9, ++0x12, 0xDB, 0x3B, 0x34, 0x81, 0xF5, 0x83, 0x74, ++0x01, 0x93, 0x2F, 0xFF, 0xE4, 0x93, 0x34, 0x00, ++0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x65, ++0x12, 0xA7, 0xD4, 0x02, 0xD0, 0xB6, 0x12, 0xD2, ++0x5B, 0xE0, 0x64, 0x05, 0x60, 0x02, 0xE1, 0x90, ++0x90, 0x04, 0xA0, 0xE0, 0x64, 0x02, 0x70, 0x11, ++0x12, 0xDA, 0x9F, 0xE4, 0xF0, 0x90, 0x04, 0xA1, ++0xE0, 0x78, 0x88, 0xF6, 0x11, 0xD6, 0x02, 0xD0, ++0xCA, 0xAD, 0x67, 0xAF, 0x65, 0x12, 0x72, 0xEE, ++0x12, 0xDB, 0x6A, 0xEF, 0xF0, 0x11, 0xEC, 0xE0, ++0x54, 0x07, 0x78, 0x88, 0xF6, 0x71, 0x45, 0xFF, ++0xC3, 0x94, 0x30, 0x40, 0x1D, 0x75, 0xF0, 0x12, ++0xE5, 0x65, 0x12, 0xA3, 0x38, 0xFE, 0xC4, 0x13, ++0x13, 0x54, 0x03, 0x20, 0xE0, 0x0C, 0x12, 0xDB, ++0x6A, 0xE0, 0x60, 0x06, 0x90, 0x96, 0x12, 0xE0, ++0x60, 0x0B, 0xE4, 0x78, 0x88, 0xF6, 0x12, 0xDA, ++0x9F, 0xE4, 0xF0, 0x80, 0x5A, 0x12, 0xDB, 0x5E, ++0xE0, 0xFE, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, ++0xEF, 0x12, 0xDA, 0x1C, 0x50, 0x1E, 0x71, 0x45, ++0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEE, 0x12, ++0xDA, 0x1C, 0x50, 0x10, 0x12, 0xDB, 0x52, 0xE0, ++0xB5, 0x67, 0x09, 0x12, 0xDA, 0xAC, 0xE0, 0xC3, ++0x94, 0x0A, 0x40, 0x25, 0x78, 0x88, 0xE6, 0xFF, ++0x70, 0x04, 0x76, 0x01, 0x80, 0x0C, 0xEF, 0x78, ++0x88, 0xB4, 0x01, 0x04, 0x76, 0x03, 0x80, 0x02, ++0x76, 0x05, 0x12, 0xDA, 0xAC, 0xE4, 0xF0, 0x71, ++0x45, 0xFF, 0x12, 0xDB, 0x5E, 0xEF, 0xF0, 0x80, ++0x06, 0x12, 0xDA, 0x9F, 0xE0, 0x04, 0xF0, 0x12, ++0xDB, 0x52, 0xE5, 0x67, 0xF0, 0x02, 0xD0, 0xB1, ++0x12, 0xD2, 0x5B, 0xE0, 0x64, 0x06, 0x60, 0x03, ++0x02, 0xD0, 0xB6, 0xF5, 0x69, 0xF5, 0x6A, 0x11, ++0xEC, 0xE0, 0x54, 0x07, 0x78, 0x88, 0xF6, 0xD3, ++0xE5, 0x6C, 0x94, 0xE8, 0xE5, 0x6B, 0x94, 0x03, ++0x40, 0x06, 0x78, 0x86, 0x76, 0x05, 0x80, 0x15, ++0xD3, 0xE5, 0x6C, 0x94, 0xFA, 0xE5, 0x6B, 0x94, ++0x00, 0x40, 0x06, 0x78, 0x86, 0x76, 0x02, 0x80, ++0x04, 0xE4, 0x78, 0x86, 0xF6, 0xE5, 0x6C, 0xAE, ++0x6B, 0x78, 0x86, 0x86, 0x00, 0x08, 0x80, 0x05, ++0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, ++0x90, 0x82, 0x06, 0xE4, 0x12, 0xD2, 0xB0, 0x90, ++0x95, 0x4C, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, ++0x78, 0x87, 0xF6, 0x12, 0xD2, 0x78, 0x78, 0x87, ++0xE6, 0xFD, 0x51, 0x7B, 0xAE, 0xF0, 0x78, 0x86, ++0x86, 0x00, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, ++0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xED, 0x90, 0x82, ++0x01, 0x51, 0xB0, 0xEF, 0x25, 0x6A, 0xF5, 0x6A, ++0xEE, 0x35, 0x69, 0xF5, 0x69, 0xC3, 0x90, 0x95, ++0x4D, 0xE0, 0x95, 0x6A, 0x90, 0x95, 0x4C, 0xE0, ++0x95, 0x69, 0x40, 0x07, 0x78, 0x87, 0x06, 0xE6, ++0xB4, 0x05, 0xC0, 0x78, 0x87, 0xE6, 0xC3, 0x13, ++0xF6, 0xFD, 0x08, 0xE6, 0x24, 0x01, 0xFF, 0xE4, ++0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x08, 0xF6, ++0xD3, 0x9D, 0x40, 0x07, 0xE6, 0x79, 0x87, 0x97, ++0xF6, 0x80, 0x04, 0xE4, 0x78, 0x89, 0xF6, 0x51, ++0x23, 0xE0, 0xC3, 0x13, 0xFF, 0x78, 0x89, 0xE6, ++0xC4, 0x33, 0x54, 0xE0, 0x2F, 0xFF, 0x51, 0x23, ++0xEF, 0xF0, 0x51, 0x23, 0xE0, 0xC3, 0x94, 0xC0, ++0x40, 0x05, 0x51, 0x23, 0x74, 0xC0, 0xF0, 0x51, ++0x23, 0xE0, 0x24, 0x1F, 0xFF, 0xE4, 0x33, 0xFE, ++0xEF, 0x78, 0x06, 0xCE, 0xA2, 0xE7, 0x13, 0xCE, ++0x13, 0xD8, 0xF8, 0x78, 0x89, 0xF6, 0xE6, 0x25, ++0xE0, 0xF6, 0x70, 0x03, 0xFF, 0x80, 0x05, 0x78, ++0x89, 0xE6, 0x14, 0xFF, 0x78, 0x88, 0xA6, 0x07, ++0xD3, 0x90, 0x95, 0x44, 0xE0, 0x94, 0x03, 0x90, ++0x95, 0x43, 0xE0, 0x94, 0x00, 0x40, 0x02, 0xE4, ++0xF6, 0x78, 0x88, 0x12, 0xC8, 0xD6, 0x51, 0x5B, ++0xE0, 0xFF, 0xD3, 0x94, 0x05, 0x50, 0x05, 0xEF, ++0x04, 0xFF, 0x80, 0x02, 0x7F, 0x00, 0x51, 0x5B, ++0xEF, 0xF0, 0xE4, 0xF5, 0x69, 0xF5, 0x6A, 0x75, ++0xF0, 0x12, 0xE5, 0x65, 0x12, 0xC6, 0xC4, 0xE0, ++0x64, 0x01, 0x60, 0x02, 0x41, 0x1A, 0x51, 0x78, ++0x51, 0xB7, 0xAE, 0xF0, 0x12, 0x03, 0x13, 0x2F, ++0xFF, 0xE5, 0xF0, 0x3E, 0x51, 0x49, 0x2F, 0xFF, ++0xEE, 0x51, 0x3A, 0xFE, 0x90, 0x00, 0x08, 0x51, ++0x40, 0x90, 0x95, 0x45, 0xF0, 0xA3, 0xEF, 0xF0, ++0x12, 0x03, 0x13, 0xFF, 0xC3, 0x90, 0x95, 0x46, ++0xE0, 0x9F, 0xFE, 0x90, 0x95, 0x45, 0xE0, 0x95, ++0xF0, 0x90, 0x95, 0x47, 0xF0, 0xA3, 0xCE, 0xF0, ++0x90, 0x00, 0x06, 0x12, 0x03, 0x3E, 0xFD, 0xAC, ++0xF0, 0x25, 0xE0, 0xFF, 0xEC, 0x33, 0xFE, 0xEF, ++0x2D, 0xFD, 0xEE, 0x3C, 0xFC, 0x51, 0x4A, 0x25, ++0xE0, 0xFF, 0xE5, 0xF0, 0x33, 0xFE, 0x90, 0x00, ++0x02, 0x51, 0x40, 0xCF, 0x2D, 0xFD, 0xEF, 0x3C, ++0xFC, 0x51, 0xBF, 0xAE, 0xF0, 0x78, 0x02, 0xC3, ++0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x2D, 0xFF, ++0xEC, 0x3E, 0x90, 0x95, 0x49, 0xF0, 0xA3, 0xEF, ++0xF0, 0x90, 0x95, 0x43, 0x51, 0x67, 0x51, 0x86, ++0x51, 0x2F, 0x9E, 0x50, 0x08, 0x90, 0x95, 0x43, ++0x51, 0x50, 0xFE, 0x80, 0x04, 0x7E, 0xFF, 0x7F, ++0xFF, 0xE5, 0x65, 0x51, 0x86, 0x12, 0xA7, 0xDD, ++0x90, 0x95, 0x45, 0x51, 0x67, 0x51, 0x90, 0x51, ++0x2F, 0x9E, 0x50, 0x08, 0x90, 0x95, 0x45, 0x51, ++0x50, 0xFE, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, ++0xE5, 0x65, 0x51, 0x90, 0x12, 0xA7, 0xDD, 0x90, ++0x95, 0x49, 0x51, 0x67, 0x51, 0x9A, 0x51, 0x2F, ++0x9E, 0x50, 0x08, 0x90, 0x95, 0x49, 0x51, 0x50, ++0xFE, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xE5, ++0x65, 0x51, 0x9A, 0x12, 0xA7, 0xDD, 0xC3, 0x74, ++0xFF, 0x95, 0x6C, 0xFF, 0x74, 0xFF, 0x95, 0x6B, ++0xFE, 0x51, 0xA4, 0x51, 0x2F, 0x9E, 0x50, 0x0A, ++0xE5, 0x6C, 0x2D, 0xFF, 0xE5, 0x6B, 0x3C, 0xFE, ++0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0x51, 0xA4, ++0x12, 0xA7, 0xDD, 0x51, 0x7E, 0xFB, 0xC3, 0x74, ++0xFF, 0x9B, 0xFF, 0x74, 0xFF, 0x9E, 0xFE, 0x74, ++0xFF, 0x94, 0x00, 0xFD, 0x74, 0xFF, 0x94, 0x00, ++0xFC, 0x90, 0x8D, 0x71, 0x12, 0x86, 0x61, 0xD3, ++0x12, 0x03, 0xDA, 0x50, 0x11, 0x51, 0x7E, 0xFF, ++0xE4, 0xFC, 0xFD, 0x90, 0x8D, 0x71, 0x12, 0x86, ++0x61, 0x12, 0x86, 0x2C, 0x80, 0x06, 0x74, 0xFF, ++0xFF, 0xFE, 0xFD, 0xFC, 0x90, 0x8D, 0x71, 0x12, ++0x04, 0x31, 0x12, 0xC7, 0x9E, 0x05, 0x65, 0x02, ++0xCB, 0x69, 0x22, 0x74, 0x4F, 0x25, 0x65, 0xF5, ++0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0xF5, ++0x83, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x9F, ++0xEC, 0x22, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x06, ++0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, ++0x22, 0xFE, 0x90, 0x00, 0x04, 0x02, 0x03, 0x3E, ++0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xED, 0x2F, 0xFF, ++0xEC, 0x3E, 0x22, 0x74, 0x76, 0x25, 0x65, 0xF5, ++0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, ++0xFF, 0x74, 0xFF, 0x9E, 0xFE, 0xE5, 0x65, 0x22, ++0x90, 0x95, 0x40, 0x02, 0x86, 0x6D, 0x90, 0x95, ++0x47, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x25, 0xE0, ++0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0x22, ++0x25, 0xE0, 0x24, 0x26, 0xF5, 0x82, 0xE4, 0x34, ++0x8E, 0x22, 0x25, 0xE0, 0x24, 0x56, 0xF5, 0x82, ++0xE4, 0x34, 0x8E, 0x22, 0xE5, 0x65, 0x25, 0xE0, ++0x24, 0x86, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0x22, ++0x93, 0xFD, 0x7C, 0x00, 0x02, 0x02, 0x80, 0x90, ++0x00, 0x02, 0x12, 0x03, 0x3E, 0xFF, 0x22, 0x90, ++0x95, 0x40, 0x12, 0x86, 0x6D, 0x90, 0x00, 0x08, ++0x02, 0x03, 0x3E, 0xE4, 0xF5, 0x78, 0xEF, 0x14, ++0xF5, 0x77, 0xED, 0xFF, 0xE5, 0x77, 0xF5, 0x82, ++0x33, 0x95, 0xE0, 0xF5, 0x83, 0xC3, 0xE5, 0x82, ++0x9F, 0x74, 0x80, 0xF8, 0x65, 0x83, 0x98, 0x40, ++0x52, 0xE5, 0x77, 0x78, 0x03, 0xA2, 0xE7, 0x13, ++0xD8, 0xFB, 0xFF, 0x33, 0x95, 0xE0, 0xFE, 0xEB, ++0x12, 0xA7, 0xB0, 0xE5, 0x82, 0x2F, 0xF5, 0x82, ++0xE5, 0x83, 0x3E, 0xF5, 0x83, 0xE0, 0xF5, 0x82, ++0x75, 0x83, 0x00, 0xE5, 0x77, 0x12, 0xAD, 0xBE, ++0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, ++0xF9, 0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, ++0x82, 0x4E, 0x60, 0x13, 0x85, 0x77, 0x79, 0x05, ++0x78, 0x90, 0x95, 0x53, 0xE0, 0x65, 0x78, 0x60, ++0x0A, 0xE5, 0x79, 0xD3, 0x9D, 0x40, 0x04, 0x15, ++0x77, 0x80, 0x97, 0xAF, 0x79, 0x22, 0xEF, 0x64, ++0x13, 0x60, 0x04, 0xEF, 0xB4, 0x0B, 0x05, 0x90, ++0x88, 0xE3, 0x80, 0x1F, 0xEF, 0x64, 0x12, 0x60, ++0x04, 0xEF, 0xB4, 0x0A, 0x05, 0x90, 0x88, 0xE4, ++0x80, 0x11, 0xEF, 0x64, 0x11, 0x60, 0x04, 0xEF, ++0xB4, 0x09, 0x05, 0x90, 0x88, 0xE5, 0x80, 0x03, ++0x90, 0x88, 0xE2, 0xE0, 0xF5, 0x0F, 0xAF, 0x0F, ++0x22, 0x90, 0x93, 0x57, 0xE0, 0x54, 0x7F, 0xF0, ++0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, ++0xF0, 0xE4, 0x90, 0x93, 0x59, 0xF0, 0x90, 0x93, ++0x57, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE4, 0x90, ++0x95, 0xF1, 0xF0, 0x90, 0x95, 0xEF, 0x74, 0x14, ++0xF0, 0x90, 0x96, 0x11, 0x74, 0x01, 0xF0, 0xFB, ++0x7A, 0x95, 0x79, 0xEF, 0x12, 0x8C, 0xD3, 0x7F, ++0x04, 0x02, 0x04, 0x7E, 0x90, 0x01, 0x9A, 0xE0, ++0x54, 0xC0, 0x44, 0x0B, 0x12, 0xAD, 0xA3, 0x90, ++0x01, 0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, ++0x40, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x93, 0x03, ++0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x8A, 0xE5, 0x12, ++0x8C, 0xE5, 0x7F, 0x20, 0x12, 0x04, 0x7E, 0x22, ++0x90, 0x01, 0xCF, 0xE0, 0x90, 0x95, 0xCA, 0xF0, ++0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, ++0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, 0x23, ++0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, ++0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, 0xA8, ++0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, 0x03, ++0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x7B, ++0x2E, 0x80, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x5D, 0xEE, 0xF0, ++0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, 0x90, 0x96, ++0x67, 0x12, 0x04, 0x31, 0x90, 0x96, 0x5F, 0x12, ++0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x96, 0x67, ++0x12, 0x86, 0x61, 0x12, 0x86, 0x47, 0xC0, 0x04, ++0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, ++0x5F, 0x12, 0x04, 0xB8, 0x90, 0x96, 0x63, 0x12, ++0x86, 0x61, 0x12, 0x86, 0x47, 0xD0, 0x03, 0xD0, ++0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x54, ++0x90, 0x96, 0x6B, 0x12, 0x04, 0x31, 0x90, 0x96, ++0x6B, 0x12, 0xB7, 0x66, 0x90, 0x96, 0x5D, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x95, 0xF1, ++0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, ++0x90, 0x95, 0xF0, 0xEF, 0xF0, 0x7F, 0x83, 0x12, ++0x7B, 0x41, 0xAE, 0x07, 0x90, 0x95, 0xF0, 0xE0, ++0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x95, ++0xF2, 0xE0, 0x94, 0x64, 0x90, 0x95, 0xF1, 0xE0, ++0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, ++0x44, 0x40, 0xF0, 0x90, 0x95, 0xF0, 0xE0, 0xFF, ++0x22, 0x90, 0x95, 0xF1, 0x12, 0xAB, 0x1C, 0x80, ++0xC2, 0x90, 0x01, 0xC4, 0x74, 0xC1, 0xF0, 0x74, ++0xD4, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x7B, 0x41, ++0xEF, 0x20, 0xE0, 0xF7, 0x74, 0xC1, 0x04, 0x90, ++0x01, 0xC4, 0xF0, 0x74, 0xD4, 0xA3, 0xF0, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, ++0xAF, 0x29, 0xE0, 0x90, 0x96, 0xCE, 0xF0, 0xED, ++0x90, 0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, ++0xF0, 0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, ++0x80, 0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, ++0x67, 0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, ++0xB8, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, ++0x90, 0x88, 0xBD, 0xE0, 0xFF, 0x12, 0x71, 0x9A, ++0x90, 0x88, 0x36, 0xE0, 0x70, 0x0C, 0x12, 0x88, ++0xDC, 0x90, 0x8A, 0xF9, 0x12, 0x8C, 0xE5, 0x12, ++0x8F, 0xE8, 0x22, 0x90, 0x88, 0x9D, 0xE0, 0x30, ++0xE0, 0x5E, 0x90, 0x94, 0xA1, 0xE0, 0x30, 0xE0, ++0x3D, 0x90, 0x94, 0xAC, 0xE0, 0xFF, 0x90, 0x94, ++0xAB, 0xE0, 0xC3, 0x9F, 0x40, 0x24, 0xB1, 0xAB, ++0x90, 0x06, 0xC4, 0xB1, 0xA9, 0x78, 0x08, 0x12, ++0x03, 0xEB, 0x90, 0x06, 0xC5, 0xB1, 0xA9, 0x78, ++0x10, 0x12, 0x03, 0xEB, 0x90, 0x06, 0xC6, 0xB1, ++0xA9, 0xB1, 0xB1, 0xE4, 0x90, 0x94, 0xAB, 0xF0, ++0x80, 0x1B, 0xB1, 0xBC, 0xB1, 0xB1, 0x90, 0x94, ++0xAB, 0xE0, 0x04, 0xF0, 0x80, 0x0F, 0x90, 0x94, ++0xAA, 0xE0, 0x60, 0x09, 0xB1, 0xBC, 0xB1, 0xB1, ++0xE4, 0x90, 0x94, 0xAA, 0xF0, 0x90, 0x8A, 0xBB, ++0x12, 0x8C, 0xE5, 0xE4, 0xFF, 0x12, 0x04, 0x7E, ++0x22, 0xEF, 0xF0, 0x90, 0x94, 0xA2, 0x02, 0x04, ++0xB8, 0x78, 0x18, 0x12, 0x03, 0xEB, 0x90, 0x06, ++0xC7, 0xEF, 0xF0, 0x22, 0x90, 0x94, 0xA6, 0x12, ++0x04, 0xB8, 0x90, 0x06, 0xC4, 0xEF, 0xF0, 0x90, ++0x94, 0xA6, 0x12, 0x04, 0xB8, 0x78, 0x08, 0x12, ++0x03, 0xEB, 0x90, 0x06, 0xC5, 0xEF, 0xF0, 0x90, ++0x94, 0xA6, 0x12, 0x04, 0xB8, 0x78, 0x10, 0x12, ++0x03, 0xEB, 0x90, 0x06, 0xC6, 0xEF, 0xF0, 0x90, ++0x94, 0xA6, 0x02, 0x04, 0xB8, 0x7E, 0x00, 0x7F, ++0x33, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, ++0x9D, 0x12, 0x04, 0x80, 0x90, 0x88, 0x9E, 0x74, ++0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0x7E, 0x00, ++0x7F, 0x0C, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x94, ++0x79, 0xA1, 0x12, 0x04, 0x80, 0x90, 0x86, 0xB3, ++0xE0, 0xFC, 0x64, 0x02, 0x70, 0x15, 0xD1, 0xFF, ++0x30, 0xE2, 0x02, 0x7E, 0x01, 0xEE, 0x12, 0xA7, ++0x97, 0xFE, 0x90, 0x88, 0xA0, 0xE0, 0x54, 0xBF, ++0x4E, 0xF0, 0x22, 0xEC, 0x64, 0x01, 0x70, 0x09, ++0xD1, 0xF6, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, ++0x0F, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, 0x70, ++0x14, 0xD1, 0x60, 0x30, 0xE2, 0x02, 0x7F, 0x01, ++0xEF, 0x12, 0xA7, 0x97, 0xFF, 0x90, 0x88, 0xA0, ++0xE0, 0x54, 0xBF, 0x4F, 0xF0, 0x22, 0xEF, 0xF0, ++0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, 0x22, 0x90, ++0x93, 0x29, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, ++0xF0, 0x54, 0xEF, 0xF0, 0x44, 0x08, 0xF0, 0x90, ++0x86, 0xB3, 0xE0, 0xFF, 0x64, 0x02, 0x70, 0x29, ++0xD1, 0xFF, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, ++0x93, 0x2F, 0xD1, 0xFD, 0x30, 0xE1, 0x02, 0x7E, ++0x01, 0x90, 0x93, 0x2D, 0xD1, 0xFD, 0x30, 0xE2, ++0x02, 0x7E, 0x01, 0x90, 0x93, 0x2E, 0xEE, 0xF0, ++0x90, 0xFD, 0x80, 0xE0, 0x90, 0x02, 0xFB, 0xF0, ++0x22, 0xEF, 0x64, 0x01, 0x70, 0x1D, 0xD1, 0xF6, ++0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2F, ++0xD1, 0xF4, 0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, ++0x93, 0x2D, 0xD1, 0xF4, 0x30, 0xE2, 0x02, 0x7F, ++0x01, 0x80, 0x23, 0x90, 0x86, 0xB3, 0xE0, 0x64, ++0x03, 0x70, 0x20, 0xD1, 0x60, 0x30, 0xE0, 0x02, ++0x7F, 0x01, 0x90, 0x93, 0x2F, 0xD1, 0x5E, 0x30, ++0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2D, 0xD1, ++0x5E, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x90, 0x93, ++0x2E, 0xEF, 0xF0, 0x22, 0xEF, 0xF0, 0x90, 0xFD, ++0x70, 0xE0, 0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, ++0xFD, 0x80, 0xE0, 0x7E, 0x00, 0x22, 0x90, 0x96, ++0xCF, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, ++0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, 0x7E, ++0xFF, 0x7F, 0xFF, 0x80, 0x23, 0xF1, 0x56, 0x12, ++0x9F, 0xAA, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, ++0xF9, 0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, 0xF1, ++0x4D, 0xFE, 0x74, 0xC8, 0x2D, 0xF5, 0x82, 0xE4, ++0x34, 0x07, 0xF5, 0x83, 0x12, 0x91, 0xFD, 0xFE, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF5, 0x82, 0xE4, ++0x34, 0x07, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x07, ++0xC0, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, ++0xAC, 0x06, 0xEF, 0xF1, 0x89, 0x12, 0x9F, 0xAA, ++0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, ++0x54, 0x03, 0x24, 0xC8, 0xF1, 0x4D, 0xFF, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, ++0xF0, 0x54, 0xFC, 0x90, 0x07, 0xC0, 0xF0, 0xEE, ++0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0x96, 0xC6, 0xF1, 0x84, 0x7A, ++0x00, 0x90, 0x96, 0xC7, 0xE0, 0x54, 0x03, 0xFB, ++0x70, 0x0A, 0x90, 0x07, 0xC4, 0xF1, 0xD4, 0x74, ++0x03, 0xF0, 0x80, 0x0E, 0xEB, 0x64, 0x02, 0x4A, ++0x70, 0x15, 0x90, 0x07, 0xC6, 0xF1, 0xD4, 0x74, ++0x0C, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, ++0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0xED, 0xF0, 0xEC, 0xA3, ++0xF0, 0x90, 0x07, 0xC2, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, 0xFC, 0xFF, ++0xF1, 0x8B, 0xE4, 0xFB, 0x90, 0x96, 0x95, 0x12, ++0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, ++0xF8, 0x12, 0x03, 0xEB, 0x74, 0xC4, 0x2B, 0xF5, ++0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0xEF, 0xF0, ++0x0B, 0xEB, 0xB4, 0x04, 0xDF, 0x90, 0x07, 0xC2, ++0x11, 0x1E, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, ++0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x0F, ++0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xC8, ++0x12, 0xD7, 0x84, 0x11, 0x8D, 0x70, 0x0D, 0x90, ++0x07, 0xC4, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, ++0x01, 0xF0, 0x80, 0x37, 0xEF, 0x64, 0x01, 0x4E, ++0x70, 0x0D, 0x90, 0x07, 0xC5, 0xED, 0xF0, 0x90, ++0x07, 0xC2, 0x74, 0x02, 0xF0, 0x80, 0x24, 0x11, ++0x8D, 0x64, 0x02, 0x70, 0x0D, 0x90, 0x07, 0xC6, ++0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x04, 0xF0, ++0x80, 0x11, 0xEF, 0x64, 0x03, 0x4E, 0x70, 0x0B, ++0x90, 0x07, 0xC7, 0xED, 0xF0, 0x90, 0x07, 0xC2, ++0x74, 0x08, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, ++0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7E, 0x00, 0x90, ++0x96, 0xC9, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0xE4, ++0xFD, 0xFF, 0x02, 0x6E, 0x71, 0x7D, 0x07, 0xEF, ++0x5D, 0xC3, 0x60, 0x0A, 0x11, 0xB2, 0x24, 0x08, ++0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x03, 0x11, 0xB2, ++0xFF, 0x22, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, ++0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, 0x22, 0x90, ++0x93, 0x03, 0xE0, 0x54, 0xFE, 0x12, 0xAD, 0x9C, ++0x90, 0x93, 0x0A, 0x12, 0x97, 0x3D, 0x90, 0x93, ++0x25, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, ++0x88, 0x8D, 0x74, 0x18, 0xF0, 0xA3, 0xF0, 0xA3, ++0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, ++0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x31, 0x33, 0x40, ++0x41, 0x90, 0x88, 0x50, 0xE0, 0x04, 0xF0, 0x90, ++0x88, 0x92, 0xE0, 0xFF, 0x90, 0x88, 0x50, 0xE0, ++0xD3, 0x9F, 0x50, 0x2E, 0x90, 0x88, 0x48, 0xE0, ++0x24, 0x08, 0xF0, 0x90, 0x88, 0x3F, 0x12, 0x9D, ++0x96, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, ++0x88, 0x3E, 0xE0, 0x2F, 0x90, 0x88, 0x4F, 0xF0, ++0xFB, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, ++0xFD, 0x90, 0x92, 0x98, 0x74, 0x03, 0xF0, 0x12, ++0x6E, 0x2F, 0x22, 0x90, 0x88, 0x93, 0xE0, 0xFF, ++0x90, 0x88, 0x3F, 0xE0, 0xD3, 0x9F, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xAF, ++0x29, 0xE0, 0x90, 0x96, 0xD3, 0xF0, 0x90, 0x88, ++0x32, 0xE0, 0x12, 0xA1, 0xDD, 0x30, 0xE0, 0x02, ++0x41, 0x06, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, ++0x1C, 0x12, 0x8E, 0xAD, 0x33, 0x33, 0x33, 0x54, ++0xF8, 0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, 0x53, ++0xE0, 0x04, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, ++0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, 0x88, 0x4B, ++0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, ++0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, 0x88, 0x4A, ++0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, ++0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, 0xF0, 0x90, ++0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, ++0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, 0x3E, 0xF0, ++0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, ++0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, 0x88, 0x4B, ++0x51, 0x12, 0x90, 0x88, 0x4E, 0x51, 0x1B, 0x40, ++0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, ++0x51, 0x12, 0x90, 0x88, 0x3E, 0x51, 0x1B, 0x40, ++0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, ++0x12, 0x9D, 0x24, 0xFF, 0x7E, 0x00, 0x90, 0x88, ++0x42, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, ++0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, ++0xFF, 0x90, 0x05, 0xB1, 0xE0, 0x54, 0xF8, 0x4F, ++0xF0, 0x12, 0x9F, 0xDE, 0x80, 0x07, 0x90, 0x88, ++0x33, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, ++0x33, 0xFC, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, ++0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, ++0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x28, 0x90, 0x96, ++0x3A, 0x74, 0x1E, 0xF0, 0x90, 0x96, 0x5C, 0x74, ++0x01, 0xF0, 0x90, 0x96, 0x3C, 0xEF, 0xF0, 0x7B, ++0x01, 0x7A, 0x96, 0x79, 0x3A, 0x12, 0x9F, 0x7B, ++0x12, 0x04, 0x7E, 0x90, 0x8A, 0xE5, 0x12, 0x8C, ++0xE5, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x90, 0x93, 0x29, 0xE0, 0x30, ++0xE0, 0x34, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, ++0x2D, 0x90, 0x96, 0xD4, 0xE0, 0x04, 0xF0, 0xE0, ++0xD3, 0x94, 0xC8, 0x40, 0x21, 0x90, 0x93, 0x29, ++0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0x96, 0xD4, ++0xF0, 0x90, 0x93, 0x29, 0xE0, 0x13, 0x30, 0xE0, ++0x0D, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x01, 0xF0, ++0x90, 0x88, 0x41, 0x74, 0xD0, 0xF0, 0x22, 0x74, ++0x76, 0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8E, ++0xF5, 0x83, 0xE4, 0xF0, 0x74, 0xF6, 0x25, 0x65, ++0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, ++0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x89, 0xF0, ++0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, ++0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x8B, 0xF0, ++0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, ++0x90, 0x88, 0x32, 0xE0, 0x44, 0x80, 0x22, 0x74, ++0xA6, 0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8D, ++0xF5, 0x83, 0x22, 0xE0, 0xFF, 0x24, 0x35, 0xF5, ++0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, ++0x01, 0xB2, 0xF0, 0x74, 0x3A, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, ++0xB3, 0xF0, 0xE0, 0x22, 0xE0, 0xFF, 0x24, 0x3F, ++0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, ++0x90, 0x01, 0xB0, 0xF0, 0x74, 0x44, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, ++0x01, 0xB1, 0xF0, 0x22, 0xE0, 0x54, 0xFE, 0x4E, ++0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, ++0xFD, 0x4F, 0x22, 0xE5, 0x67, 0x25, 0xE0, 0x24, ++0x75, 0xF5, 0x82, 0xE4, 0x22, 0xE0, 0x90, 0x01, ++0xBA, 0xF0, 0x90, 0x88, 0x38, 0xE0, 0x90, 0x01, ++0xBB, 0x22, 0x74, 0xA6, 0x25, 0x65, 0xF5, 0x82, ++0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x74, 0x5F, ++0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, ++0x83, 0x22, 0x74, 0xE6, 0x25, 0x65, 0xF5, 0x82, ++0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xB6, ++0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, ++0x83, 0x22, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, ++0xEF, 0x4D, 0xFF, 0x22, 0x54, 0x04, 0xFD, 0xEF, ++0x54, 0xFB, 0x4D, 0xFF, 0x22, 0x7F, 0xFF, 0x12, ++0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x22, 0xE4, 0x90, ++0x92, 0x20, 0xF0, 0x90, 0x93, 0x2B, 0x22, 0xF0, ++0xEE, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x22, ++0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, ++0x22, 0xE5, 0x67, 0x90, 0x81, 0x9D, 0x93, 0xFF, ++0x22, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, ++0x22, 0x00, 0x35, 0x55 ++}; ++ ++u4Byte array_length_mp_8723d_fw_ap = 23532; ++ ++#endif /*defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))*/ ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) || (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++ ++u1Byte array_mp_8723d_fw_nic[] = { ++0xD1, 0x23, 0x10, 0x00, 0x1D, 0x00, 0x02, 0x00, ++0x04, 0x14, 0x11, 0x13, 0x62, 0x67, 0x02, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x02, 0x86, 0x71, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xD3, 0x69, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xDB, 0x56, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xDA, 0x8D, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xBC, 0x9A, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xDB, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, ++0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, ++0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, ++0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, ++0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, ++0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, ++0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0A, ++0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, ++0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, ++0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, ++0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, ++0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, ++0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, ++0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, ++0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, ++0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, ++0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, ++0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, ++0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, ++0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, ++0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, ++0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, ++0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, ++0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, ++0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, ++0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, ++0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, ++0x30, 0x02, 0x02, 0x03, 0x04, 0x04, 0x08, 0x09, ++0x09, 0x0C, 0x0E, 0x10, 0x12, 0x02, 0x09, 0x0B, ++0x0E, 0x0D, 0x0F, 0x10, 0x12, 0x00, 0x04, 0x00, ++0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x23, 0x00, ++0x2D, 0x00, 0x50, 0x00, 0x91, 0x00, 0xC3, 0x01, ++0x27, 0x01, 0x31, 0x01, 0x5E, 0x00, 0x8C, 0x00, ++0xC8, 0x00, 0xDC, 0x01, 0x5E, 0x01, 0x68, 0x01, ++0x9A, 0x01, 0xCC, 0x01, 0xEA, 0x02, 0x02, 0x04, ++0x08, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, ++0x6C, 0x14, 0x28, 0x32, 0x50, 0x78, 0xA0, 0xC8, ++0xE6, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x02, ++0x02, 0x03, 0x03, 0x04, 0x04, 0x02, 0x04, 0x06, ++0x07, 0x07, 0x08, 0x08, 0x08, 0x01, 0x01, 0x01, ++0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, ++0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x02, ++0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, ++0x02, 0x03, 0x03, 0x04, 0x05, 0x01, 0x02, 0x03, ++0x04, 0x05, 0x06, 0x07, 0x08, 0x03, 0x03, 0x03, ++0x02, 0x03, 0x03, 0x03, 0x03, 0x03, 0x02, 0x02, ++0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, ++0x02, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x83, 0x04, ++0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, ++0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, ++0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, ++0xEC, 0x24, 0x8B, 0xF8, 0xE6, 0xBC, 0x02, 0x02, ++0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, ++0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, ++0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, ++0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, ++0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, ++0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, ++0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, ++0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, ++0x20, 0x05, 0x0C, 0x74, 0x8A, 0x25, 0x0C, 0xF8, ++0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, ++0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, ++0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, ++0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, ++0x0C, 0x24, 0x8B, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, ++0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, ++0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, ++0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x8A, ++0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, ++0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, ++0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, ++0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, ++0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, ++0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x8A, 0xA6, ++0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, ++0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, ++0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, ++0x76, 0x30, 0x90, 0x86, 0xF4, 0x74, 0x01, 0x93, ++0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, ++0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, ++0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, ++0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, ++0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, ++0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, ++0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, ++0x8A, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, ++0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, ++0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, ++0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, ++0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, ++0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x8A, 0x2E, ++0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, ++0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, ++0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, ++0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, ++0x24, 0x8A, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, ++0x04, 0x90, 0x86, 0xF4, 0x93, 0xF6, 0x08, 0xEF, ++0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, ++0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, ++0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, ++0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, ++0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x8A, 0x2F, ++0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x83, 0x4D, 0x50, ++0x2E, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, ++0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, ++0x8A, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, ++0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, ++0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, ++0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, ++0x8B, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, ++0x0F, 0x74, 0x8A, 0x2F, 0xF8, 0xA6, 0x01, 0x08, ++0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, ++0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, ++0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, ++0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, ++0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, ++0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, ++0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, ++0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, ++0xE2, 0x01, 0x0F, 0x02, 0x83, 0x4C, 0x8F, 0xF0, ++0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, ++0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, ++0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, ++0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, ++0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, ++0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, ++0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, ++0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, ++0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x83, 0x4D, 0x7F, ++0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, ++0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, ++0x22, 0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, ++0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, ++0x9B, 0xFF, 0xEE, 0x9A, 0xFE, 0xED, 0x99, 0xFD, ++0xEC, 0x98, 0xFC, 0x22, 0xE8, 0x8F, 0xF0, 0xA4, ++0xCC, 0x8B, 0xF0, 0xA4, 0x2C, 0xFC, 0xE9, 0x8E, ++0xF0, 0xA4, 0x2C, 0xFC, 0x8A, 0xF0, 0xED, 0xA4, ++0x2C, 0xFC, 0xEA, 0x8E, 0xF0, 0xA4, 0xCD, 0xA8, ++0xF0, 0x8B, 0xF0, 0xA4, 0x2D, 0xCC, 0x38, 0x25, ++0xF0, 0xFD, 0xE9, 0x8F, 0xF0, 0xA4, 0x2C, 0xCD, ++0x35, 0xF0, 0xFC, 0xEB, 0x8E, 0xF0, 0xA4, 0xFE, ++0xA9, 0xF0, 0xEB, 0x8F, 0xF0, 0xA4, 0xCF, 0xC5, ++0xF0, 0x2E, 0xCD, 0x39, 0xFE, 0xE4, 0x3C, 0xFC, ++0xEA, 0xA4, 0x2D, 0xCE, 0x35, 0xF0, 0xFD, 0xE4, ++0x3C, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, ++0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, ++0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, ++0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xF8, 0xA3, ++0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, ++0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, ++0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, ++0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, ++0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, ++0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, ++0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, ++0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, ++0xDF, 0x02, 0x86, 0xAF, 0x02, 0x83, 0xDD, 0xE4, ++0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, ++0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, ++0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, ++0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, ++0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, ++0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, ++0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, ++0x86, 0xFA, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, ++0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, ++0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, ++0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, ++0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, ++0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, ++0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, ++0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, ++0xDE, 0xE7, 0x80, 0xBE, 0xC4, 0x79, 0xD8, 0x56, ++0xD2, 0xFF, 0x41, 0x97, 0x16, 0x00, 0x00, 0x90, ++0x97, 0x12, 0xEF, 0xF0, 0x7F, 0x02, 0xB1, 0x27, ++0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x90, 0x97, 0x12, ++0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, ++0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x02, ++0x06, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x86, ++0xB4, 0xF0, 0xF1, 0xAE, 0xFF, 0xED, 0x2F, 0x90, ++0x86, 0xB5, 0xF0, 0xF1, 0xB9, 0xFF, 0xED, 0x2F, ++0x90, 0x86, 0xB6, 0xF1, 0xA2, 0xFF, 0xED, 0x2F, ++0x90, 0x86, 0xB7, 0xF1, 0x72, 0xFF, 0xED, 0x2F, ++0x90, 0x86, 0xB8, 0xF1, 0x61, 0xFF, 0xED, 0x2F, ++0x90, 0x86, 0xB9, 0xF1, 0x68, 0xFF, 0xAE, 0x05, ++0xED, 0x2F, 0x90, 0x86, 0xBA, 0xF0, 0x22, 0x4E, ++0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, 0x02, 0x1F, ++0xF0, 0x90, 0x00, 0x06, 0x02, 0x02, 0x1F, 0xF5, ++0x83, 0xEF, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x02, ++0x1F, 0x12, 0xB7, 0xDD, 0x12, 0x02, 0x06, 0x90, ++0x93, 0x60, 0xF0, 0xF1, 0xAE, 0x90, 0x93, 0x61, ++0xF0, 0xF1, 0xB9, 0x90, 0x93, 0x7B, 0xF1, 0xA2, ++0x90, 0x93, 0x7C, 0xF1, 0x72, 0x90, 0x93, 0x96, ++0xF1, 0x61, 0x90, 0x93, 0x97, 0xF0, 0x22, 0xF5, ++0x83, 0xEF, 0xF0, 0x90, 0x00, 0x03, 0x02, 0x02, ++0x1F, 0x90, 0x95, 0x53, 0xD1, 0x39, 0x90, 0x00, ++0x01, 0x02, 0x02, 0x1F, 0x90, 0x95, 0x53, 0xD1, ++0x39, 0x90, 0x00, 0x02, 0x02, 0x02, 0x1F, 0x12, ++0xB9, 0x1A, 0x90, 0x93, 0x3B, 0x12, 0xC8, 0xC5, ++0x4F, 0xF0, 0xF1, 0xAE, 0x90, 0x93, 0x3C, 0xF0, ++0xF1, 0xB9, 0x90, 0x93, 0x3D, 0xF0, 0x12, 0xBF, ++0x89, 0x90, 0x93, 0x3B, 0xE0, 0x54, 0x01, 0xFF, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, ++0x64, 0x01, 0x70, 0x1D, 0x12, 0xE7, 0x18, 0x60, ++0x0B, 0x12, 0x88, 0x2A, 0x12, 0x7C, 0x05, 0x12, ++0xBF, 0x77, 0x80, 0x08, 0x12, 0x88, 0x2A, 0x12, ++0x7C, 0x3B, 0xF1, 0xFC, 0x12, 0x79, 0xD4, 0x80, ++0x18, 0x12, 0xE7, 0x18, 0x60, 0x07, 0x11, 0x2A, ++0x12, 0x7C, 0x05, 0x80, 0x05, 0x11, 0x2A, 0x12, ++0x7C, 0x3B, 0xF1, 0xC2, 0xF1, 0xC9, 0x12, 0x7B, ++0xCC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, ++0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, ++0x22, 0x12, 0xB6, 0xC9, 0x60, 0x02, 0x21, 0x74, ++0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0x21, 0x74, ++0x90, 0x88, 0x2C, 0xE0, 0x20, 0xE0, 0x39, 0x90, ++0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x32, 0x90, 0x06, ++0xA9, 0xE0, 0x54, 0xC0, 0x70, 0x2A, 0x90, 0x88, ++0x9C, 0xE0, 0x70, 0x24, 0x90, 0x04, 0x1A, 0xE0, ++0xF4, 0x70, 0x1D, 0xE0, 0x54, 0x07, 0x64, 0x07, ++0x70, 0x16, 0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, ++0x70, 0x0E, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, ++0x07, 0xF1, 0xEE, 0x54, 0xFE, 0x12, 0xCD, 0x98, ++0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, ++0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, ++0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, ++0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, ++0x90, 0x07, 0xF1, 0xE0, 0x90, 0x95, 0x35, 0xF0, ++0x90, 0x07, 0xF0, 0xE0, 0x90, 0x95, 0x36, 0xF0, ++0x12, 0xBF, 0x93, 0xF0, 0x90, 0x88, 0x3A, 0xE0, ++0x54, 0xEC, 0xF0, 0x31, 0x90, 0x24, 0xFD, 0x50, ++0x02, 0x80, 0x0F, 0x90, 0x88, 0x2C, 0xE0, 0x30, ++0xE0, 0x05, 0x12, 0xD5, 0x0A, 0x80, 0x03, 0x12, ++0xD4, 0xAD, 0x31, 0x90, 0x64, 0x01, 0x70, 0x30, ++0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, 0x3D, 0xF0, ++0x90, 0x06, 0xA9, 0xE0, 0x30, 0xE5, 0x05, 0xA3, ++0xE0, 0xFF, 0x80, 0x05, 0x90, 0x88, 0x3C, 0xE0, ++0xFF, 0x90, 0x88, 0x3C, 0xEF, 0xF0, 0xA3, 0xE0, ++0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xFE, ++0xFF, 0x80, 0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, ++0x31, 0x99, 0xE4, 0x90, 0x88, 0x3F, 0xF0, 0xA3, ++0xF0, 0x12, 0xB3, 0xBB, 0x30, 0xE0, 0x5B, 0xEF, ++0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x24, ++0x31, 0x88, 0x6F, 0x70, 0x4D, 0xEF, 0x60, 0x4A, ++0x90, 0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0x12, ++0xE7, 0x20, 0x11, 0x26, 0x12, 0x7C, 0x05, 0x12, ++0x90, 0x03, 0xF1, 0xF5, 0x90, 0x88, 0x3D, 0xE0, ++0x14, 0xF0, 0x80, 0x2E, 0x90, 0x88, 0x34, 0xE0, ++0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x23, 0x31, ++0x88, 0xFE, 0x6F, 0x60, 0x1D, 0x90, 0x05, 0x73, ++0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x14, 0x90, 0x88, ++0x32, 0xF1, 0xDC, 0x30, 0xE0, 0x0C, 0xEF, 0x54, ++0xBF, 0x11, 0x26, 0x12, 0x7C, 0x3B, 0xF1, 0xC9, ++0xF1, 0xC2, 0x31, 0x80, 0x90, 0x88, 0x2C, 0xE0, ++0xC3, 0x13, 0x20, 0xE0, 0x02, 0x31, 0x80, 0x22, ++0x90, 0x88, 0x32, 0xE0, 0x44, 0x04, 0xF0, 0x22, ++0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, ++0x90, 0x88, 0x34, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, ++0x22, 0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0xC0, ++0x06, 0xC0, 0x07, 0x90, 0x95, 0x36, 0xE0, 0x24, ++0x46, 0xFF, 0x90, 0x95, 0x35, 0xE0, 0x34, 0x00, ++0xAB, 0x07, 0xFA, 0xE4, 0xF9, 0xF8, 0xD0, 0x07, ++0xD0, 0x06, 0x12, 0x85, 0xB6, 0x90, 0x88, 0x85, ++0xF1, 0xD0, 0xEF, 0x24, 0x46, 0xF1, 0xE3, 0x90, ++0x88, 0x89, 0xF1, 0xD0, 0x90, 0x88, 0x85, 0x12, ++0xE2, 0x50, 0x50, 0x02, 0x41, 0x89, 0x90, 0x88, ++0x89, 0x12, 0x86, 0x2D, 0x90, 0x88, 0x85, 0x12, ++0x04, 0xB8, 0x12, 0x85, 0xB6, 0xF1, 0x9E, 0x90, ++0x88, 0x31, 0xE0, 0x30, 0xE0, 0x31, 0x12, 0x97, ++0x4A, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x03, ++0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, ++0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, 0x4E, ++0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, ++0x00, 0xFA, 0x71, 0x9D, 0x78, 0x07, 0x12, 0x03, ++0xEB, 0xEB, 0x2F, 0xFF, 0xEA, 0x80, 0x22, 0x90, ++0x88, 0x33, 0xF1, 0xDC, 0x30, 0xE0, 0x02, 0x61, ++0x8B, 0x71, 0x9D, 0x78, 0x07, 0x12, 0x03, 0xEB, ++0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, 0x60, ++0x9D, 0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, ++0xED, 0x3E, 0x90, 0x95, 0xEB, 0xF0, 0xA3, 0xEF, ++0xF0, 0xC3, 0x90, 0x95, 0xEC, 0xE0, 0x94, 0xA0, ++0x90, 0x95, 0xEB, 0xE0, 0x94, 0x00, 0x50, 0x31, ++0xA3, 0xE0, 0xFB, 0x24, 0xF5, 0xF1, 0xB0, 0xE0, ++0x04, 0x71, 0x9C, 0xEF, 0x54, 0x7F, 0xFF, 0x74, ++0x95, 0x2B, 0x71, 0x93, 0xE0, 0xFE, 0xEF, 0xC3, ++0x9E, 0x50, 0x09, 0x90, 0x95, 0xEB, 0xA3, 0xE0, ++0x71, 0x91, 0xEF, 0xF0, 0x90, 0x88, 0x4C, 0xE0, ++0x04, 0xF0, 0xE0, 0xFD, 0x7F, 0xFE, 0x12, 0x7B, ++0x2E, 0x90, 0x88, 0x4C, 0xE0, 0xFF, 0xD3, 0x90, ++0x88, 0x90, 0xE0, 0x9F, 0x90, 0x88, 0x8F, 0xE0, ++0x94, 0x00, 0x40, 0x02, 0x61, 0x8B, 0xE4, 0xFF, ++0xFE, 0xF1, 0xAD, 0xE0, 0x2F, 0xFF, 0x90, 0x88, ++0x91, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, 0x40, 0x07, ++0x90, 0x95, 0xED, 0xEE, 0xF0, 0x80, 0x05, 0x0E, ++0xEE, 0xB4, 0xA0, 0xE5, 0x12, 0xE6, 0x79, 0x9C, ++0x40, 0x02, 0x80, 0x17, 0x90, 0x95, 0xED, 0xE0, ++0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, 0x50, 0x15, ++0xF1, 0xAD, 0xE0, 0x2F, 0xFF, 0x12, 0xE6, 0x79, ++0x9C, 0x40, 0x07, 0x90, 0x95, 0xEE, 0xEE, 0xF0, ++0x80, 0x03, 0x0E, 0x80, 0xE5, 0x90, 0x05, 0x5E, ++0xE0, 0xFF, 0x71, 0x8C, 0xE0, 0xFD, 0xEF, 0xC3, ++0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, ++0xF0, 0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x95, ++0xEE, 0xE0, 0x80, 0x18, 0x71, 0x8C, 0xE0, 0xFD, ++0xC3, 0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, ++0xF0, 0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, ++0x95, 0xEE, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, ++0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, ++0x40, 0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, ++0xF0, 0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, ++0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, ++0x50, 0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, ++0x51, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, ++0x88, 0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, ++0x88, 0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, ++0x4F, 0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, ++0xC3, 0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, ++0x90, 0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0x12, ++0xBC, 0x89, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, ++0x90, 0x8A, 0xA3, 0x12, 0x96, 0x47, 0xE4, 0xFF, ++0x12, 0x04, 0x7E, 0x22, 0x90, 0x95, 0xED, 0xE0, ++0xFE, 0x24, 0x95, 0xF5, 0x82, 0xE4, 0x34, 0x94, ++0xF5, 0x83, 0x22, 0xEF, 0xF0, 0x90, 0x95, 0xEF, ++0x02, 0x04, 0xB8, 0x90, 0x93, 0x58, 0xE0, 0x20, ++0xE0, 0x02, 0xA1, 0xD0, 0xC3, 0x13, 0x54, 0x07, ++0x60, 0x02, 0xA1, 0xD0, 0x90, 0x93, 0xD9, 0xE0, ++0x30, 0xE0, 0x5C, 0x12, 0xDF, 0xB2, 0x40, 0x57, ++0x90, 0x93, 0xE0, 0xE0, 0x30, 0xE0, 0x23, 0x54, ++0xFE, 0xF0, 0x90, 0x93, 0xE2, 0xE0, 0x90, 0x93, ++0xD6, 0xF0, 0x90, 0x93, 0xE5, 0xE0, 0x90, 0x93, ++0xD7, 0xF0, 0x90, 0x93, 0xE3, 0xE0, 0x90, 0x93, ++0x5D, 0xF0, 0x90, 0x93, 0xE4, 0xE0, 0x90, 0x93, ++0x78, 0xF0, 0x90, 0x05, 0x58, 0xE0, 0x90, 0x95, ++0xF7, 0x12, 0xA7, 0xC9, 0x54, 0x07, 0xFF, 0x64, ++0x02, 0x60, 0x03, 0xEF, 0x70, 0x08, 0x12, 0xE6, ++0x9E, 0x24, 0xFD, 0x12, 0xB4, 0xB0, 0x12, 0xE6, ++0x9E, 0x90, 0x92, 0x21, 0x12, 0xDF, 0xA9, 0x12, ++0x66, 0x33, 0xE4, 0x90, 0x93, 0xDA, 0xF0, 0x90, ++0x93, 0xD5, 0xE0, 0x20, 0xE0, 0x02, 0xA1, 0xD0, ++0x90, 0x93, 0xD9, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, ++0x54, 0x1F, 0x70, 0x02, 0xA1, 0xD0, 0xEF, 0x54, ++0xC1, 0xFF, 0xEE, 0x14, 0x54, 0x1F, 0xFE, 0x25, ++0xE0, 0x4F, 0xF0, 0xE0, 0xC3, 0x13, 0x54, 0x1F, ++0x60, 0x02, 0xA1, 0xD0, 0x90, 0x93, 0xE1, 0xE0, ++0x30, 0xE0, 0x17, 0x54, 0xFE, 0xF0, 0x90, 0x93, ++0xE0, 0xE0, 0x44, 0x01, 0xF0, 0xA3, 0xE0, 0x54, ++0xFE, 0xFF, 0x90, 0x93, 0xD5, 0xE0, 0x54, 0x01, ++0x4F, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x44, 0x40, ++0xFD, 0x7B, 0x58, 0x7F, 0x40, 0x12, 0x97, 0x56, ++0x90, 0x05, 0x50, 0xE0, 0x54, 0xF7, 0xF0, 0x90, ++0x05, 0x69, 0xB1, 0xD4, 0x12, 0xC7, 0xA2, 0x90, ++0x05, 0x68, 0xB1, 0xD4, 0x12, 0x86, 0x20, 0xC0, ++0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0x05, 0x6A, 0xB1, 0xD4, 0x78, 0x10, 0x12, 0x03, ++0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, ++0xC0, 0x06, 0xC0, 0x07, 0xA3, 0xB1, 0xD4, 0x78, ++0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, ++0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0x90, ++0x95, 0xEB, 0x12, 0x04, 0x31, 0xF1, 0x92, 0x90, ++0x95, 0xF3, 0x12, 0x04, 0x31, 0x90, 0x05, 0x6D, ++0xB1, 0xD4, 0x12, 0xC7, 0xA2, 0x90, 0x05, 0x6C, ++0xB1, 0xD4, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, ++0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x6E, ++0xB1, 0xD4, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, ++0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, ++0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, ++0xC0, 0x07, 0xA3, 0xB1, 0xD4, 0x78, 0x18, 0x12, ++0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, ++0xD0, 0x00, 0x12, 0x86, 0x20, 0xF1, 0x9E, 0x90, ++0x95, 0xEB, 0x12, 0x86, 0x2D, 0xC0, 0x00, 0xC0, ++0x01, 0xC0, 0x02, 0xC0, 0x03, 0x90, 0x93, 0xD5, ++0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xFF, 0xE4, 0xFC, ++0xFD, 0xFE, 0xFB, 0x7A, 0x04, 0xF9, 0xF8, 0x12, ++0x85, 0xC4, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, ++0xD0, 0x00, 0x12, 0x85, 0xA9, 0x90, 0x95, 0xEB, ++0x12, 0x04, 0x31, 0x90, 0x95, 0xF3, 0x12, 0x04, ++0xB8, 0x90, 0x95, 0xEB, 0x12, 0xE2, 0x50, 0x50, ++0x09, 0x71, 0x9D, 0xEF, 0x24, 0x01, 0xF1, 0xE3, ++0xF1, 0x9E, 0x71, 0x9D, 0x78, 0x18, 0x12, 0x03, ++0xEB, 0x90, 0x05, 0x67, 0x71, 0x9B, 0x78, 0x10, ++0x12, 0x03, 0xEB, 0x90, 0x05, 0x66, 0x71, 0x9B, ++0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, 0x05, 0x65, ++0x71, 0x9B, 0x90, 0x05, 0x64, 0xF1, 0x90, 0x78, ++0x18, 0x12, 0x03, 0xEB, 0x90, 0x05, 0x63, 0xF1, ++0x90, 0x78, 0x10, 0x12, 0x03, 0xEB, 0x90, 0x05, ++0x62, 0xF1, 0x90, 0x78, 0x08, 0x12, 0x03, 0xEB, ++0x90, 0x05, 0x61, 0xF1, 0x90, 0x90, 0x05, 0x60, ++0xEF, 0xF0, 0x90, 0x05, 0x50, 0xE0, 0x44, 0x08, ++0xF0, 0x90, 0x05, 0x22, 0xE0, 0x54, 0xBF, 0xFD, ++0x7B, 0x59, 0x7F, 0x40, 0x12, 0x97, 0x56, 0x7F, ++0x08, 0x12, 0xA7, 0xF3, 0x90, 0x93, 0xD9, 0xE0, ++0x54, 0xC1, 0x44, 0x28, 0xF0, 0x44, 0x01, 0xF0, ++0x22, 0x90, 0x97, 0x0C, 0xE0, 0xFF, 0xE4, 0xFC, ++0xFD, 0xFE, 0x22, 0xFF, 0xEE, 0x13, 0x13, 0x54, ++0x07, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x97, 0x0C, 0xED, 0xF0, 0xE4, 0xA3, ++0xF0, 0xEF, 0x14, 0x60, 0x02, 0xC1, 0xC0, 0x90, ++0x06, 0x03, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x97, ++0x0C, 0xE0, 0xFB, 0xC4, 0x33, 0x54, 0xE0, 0xFE, ++0x90, 0x04, 0x42, 0xE0, 0x54, 0x9F, 0x4E, 0xFE, ++0xF0, 0xE4, 0xFD, 0x12, 0xDF, 0xE8, 0x90, 0x97, ++0x0D, 0xEF, 0xF0, 0x90, 0x04, 0x83, 0xF0, 0x90, ++0x96, 0xA8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, ++0x01, 0x90, 0x96, 0xAC, 0x12, 0x04, 0x3D, 0x00, ++0x00, 0x00, 0x01, 0xF1, 0x86, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xAC, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, ++0x7E, 0x09, 0xF1, 0x8A, 0x12, 0x04, 0x3D, 0x00, ++0x00, 0x00, 0x10, 0xB1, 0xD1, 0xEF, 0x54, 0x03, ++0xFF, 0xE4, 0x78, 0x01, 0x12, 0x03, 0xEB, 0x78, ++0x04, 0xF1, 0xA4, 0x7F, 0x00, 0x7E, 0x0A, 0xF1, ++0x8A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, ++0xB1, 0xD1, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, ++0x0A, 0xF1, 0xA4, 0x7F, 0x00, 0x7E, 0x0D, 0xF1, ++0x8A, 0x12, 0x04, 0x3D, 0x0C, 0x00, 0x00, 0x00, ++0x90, 0x97, 0x0D, 0xB1, 0xD4, 0xEF, 0x54, 0x03, ++0xFF, 0xE4, 0x78, 0x1A, 0xF1, 0xA4, 0x7F, 0x18, ++0xF1, 0x88, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, ++0x00, 0x90, 0x96, 0xAC, 0x12, 0x04, 0x3D, 0x00, ++0x00, 0x00, 0x00, 0xF1, 0xB8, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0x9A, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x04, 0x00, 0x80, 0x58, ++0x90, 0x06, 0x03, 0xE0, 0x44, 0x04, 0xF0, 0x90, ++0x96, 0xA8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, ++0x01, 0x90, 0x96, 0xAC, 0x12, 0x04, 0x3D, 0x00, ++0x00, 0x00, 0x00, 0xF1, 0x86, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xAC, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, ++0x7E, 0x09, 0xF1, 0x8A, 0x12, 0x04, 0x3D, 0x00, ++0x00, 0x0C, 0x00, 0x90, 0x96, 0xAC, 0x12, 0x04, ++0x3D, 0x00, 0x00, 0x0C, 0x00, 0xF1, 0xB8, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, ++0x9A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, ++0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0xB9, ++0xE2, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xA6, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, ++0x90, 0x96, 0xB0, 0x12, 0x04, 0x31, 0x90, 0x96, ++0xA8, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, ++0x96, 0xB0, 0xF1, 0x98, 0xC0, 0x04, 0xC0, 0x05, ++0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0xA8, 0x12, ++0x04, 0xB8, 0x90, 0x96, 0xAC, 0xF1, 0x98, 0xD0, ++0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, ++0x86, 0x20, 0x90, 0x96, 0xB4, 0x12, 0x04, 0x31, ++0x90, 0x96, 0xB4, 0x12, 0xCE, 0x7B, 0x90, 0x96, ++0xA6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, ++0xAD, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x00, ++0x7E, 0x08, 0xF1, 0x26, 0x90, 0x96, 0xA8, 0x22, ++0xEF, 0xF0, 0x90, 0x95, 0xEB, 0x02, 0x04, 0xB8, ++0x12, 0x86, 0x2D, 0x02, 0x86, 0x13, 0x90, 0x95, ++0xEF, 0x02, 0x04, 0x31, 0x12, 0x03, 0xFE, 0x90, ++0x96, 0xAC, 0x02, 0x04, 0x31, 0x74, 0xF5, 0x2E, ++0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, ++0x7F, 0x84, 0x7E, 0x08, 0xF1, 0x26, 0x90, 0x96, ++0x96, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, ++0x74, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x74, ++0x12, 0x04, 0x31, 0x90, 0x88, 0x89, 0x02, 0x04, ++0xB8, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0x13, 0x13, ++0x54, 0x3F, 0x22, 0xFF, 0xE4, 0x3E, 0xFE, 0xE4, ++0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, 0x7F, 0x02, ++0x12, 0x7B, 0x41, 0xEF, 0x22, 0x7D, 0x02, 0x7F, ++0x02, 0x02, 0x7C, 0x7E, 0x7D, 0x02, 0x7F, 0x02, ++0x12, 0x7C, 0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, ++0x7C, 0x7E, 0x12, 0xAF, 0x9A, 0x90, 0x93, 0xE7, ++0xE0, 0x70, 0x0F, 0x71, 0xC7, 0x13, 0x13, 0x54, ++0x3F, 0x30, 0xE0, 0x06, 0x90, 0x93, 0xED, 0x74, ++0x01, 0xF0, 0x90, 0x93, 0xE9, 0xE0, 0x70, 0x0F, ++0x71, 0xC7, 0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x05, ++0x06, 0x90, 0x93, 0xEE, 0x74, 0x01, 0xF0, 0x12, ++0x87, 0xA9, 0xFF, 0x90, 0x95, 0x57, 0xF0, 0x12, ++0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, 0x09, 0x12, ++0x87, 0xB4, 0x90, 0x95, 0x58, 0xF0, 0x80, 0x05, ++0x90, 0x95, 0x58, 0xEF, 0xF0, 0x90, 0x95, 0x57, ++0xE0, 0x90, 0x95, 0x56, 0xF0, 0x90, 0x95, 0x58, ++0xE0, 0xFE, 0x90, 0x95, 0x56, 0xE0, 0xFF, 0xD3, ++0x9E, 0x50, 0x36, 0x71, 0xC7, 0x54, 0x01, 0xFD, ++0x12, 0x6E, 0x71, 0x90, 0x95, 0x56, 0xE0, 0xFF, ++0x12, 0x78, 0x4A, 0xEF, 0x90, 0x95, 0x56, 0x70, ++0x06, 0xE0, 0xFF, 0xF1, 0xF1, 0x80, 0x05, 0xE0, ++0xFF, 0x12, 0xCF, 0xF2, 0x90, 0x93, 0xEE, 0xE0, ++0x60, 0x07, 0x90, 0x95, 0x56, 0xE0, 0xFF, 0xF1, ++0xF1, 0x90, 0x95, 0x56, 0xE0, 0x04, 0xF0, 0x80, ++0xBC, 0x90, 0x05, 0x5E, 0xE4, 0xF0, 0x90, 0x95, ++0x57, 0xE0, 0x70, 0x1A, 0xFF, 0x12, 0x78, 0x4A, ++0xEF, 0x70, 0x13, 0x90, 0x86, 0x0C, 0x51, 0x46, ++0x90, 0x8A, 0xED, 0x51, 0x46, 0x12, 0xBF, 0x6F, ++0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x90, ++0x96, 0xE6, 0x12, 0x86, 0x42, 0x90, 0x96, 0xE5, ++0xEF, 0xF0, 0x12, 0x86, 0x4B, 0x91, 0x57, 0x00, ++0x91, 0x5C, 0x01, 0x91, 0x60, 0x06, 0x91, 0x71, ++0x10, 0x91, 0x76, 0x12, 0x91, 0x7B, 0x14, 0x91, ++0x80, 0x16, 0x91, 0x85, 0x18, 0x91, 0x8A, 0x19, ++0x91, 0x8F, 0x1B, 0x91, 0x94, 0x1C, 0x91, 0x99, ++0x1E, 0x91, 0x9E, 0x20, 0x91, 0xA3, 0x24, 0x91, ++0xA8, 0x25, 0x91, 0xAD, 0x27, 0x91, 0xB2, 0x29, ++0x91, 0xB7, 0x2A, 0x91, 0xBC, 0x40, 0x91, 0xC3, ++0x42, 0x92, 0x36, 0x47, 0x91, 0xCE, 0x49, 0x91, ++0xD3, 0x60, 0x91, 0xD7, 0x61, 0x91, 0xDC, 0x62, ++0x91, 0xE1, 0x63, 0x91, 0xE6, 0x64, 0x91, 0xEB, ++0x65, 0x91, 0xF0, 0x66, 0x91, 0xF5, 0x67, 0x91, ++0xFA, 0x68, 0x91, 0xFF, 0x69, 0x92, 0x04, 0x6B, ++0x92, 0x09, 0x6C, 0x92, 0x0E, 0x6D, 0x92, 0x13, ++0x6E, 0x92, 0x18, 0x6F, 0x92, 0x1D, 0x70, 0x92, ++0x22, 0xC3, 0x91, 0x65, 0xC6, 0x91, 0x65, 0xC7, ++0x91, 0x65, 0xC8, 0x00, 0x00, 0x92, 0x27, 0x51, ++0x37, 0x02, 0x87, 0x19, 0x51, 0x37, 0x01, 0x0A, ++0x51, 0x37, 0x02, 0xC5, 0x99, 0x90, 0x96, 0xE5, ++0xE0, 0xFF, 0xA3, 0x12, 0x86, 0x39, 0x02, 0xD6, ++0x7F, 0x51, 0x37, 0x02, 0xA8, 0x79, 0x51, 0x37, ++0x02, 0xC0, 0x2D, 0x51, 0x37, 0x02, 0xC7, 0xD0, ++0x51, 0x37, 0x02, 0x87, 0x79, 0x51, 0x37, 0x02, ++0xAF, 0xF0, 0x51, 0x37, 0x02, 0xB8, 0x0B, 0x51, ++0x37, 0x02, 0xB8, 0xB1, 0x51, 0x37, 0x02, 0xB9, ++0x22, 0x51, 0x37, 0x02, 0xC4, 0x0D, 0x51, 0x37, ++0x02, 0xC7, 0xDF, 0x51, 0x37, 0x02, 0xB0, 0xF8, ++0x51, 0x37, 0x02, 0xC8, 0xD3, 0x51, 0x37, 0x02, ++0x87, 0xBF, 0x51, 0x37, 0x02, 0xCF, 0xC7, 0x51, ++0x37, 0x02, 0xC9, 0x16, 0x51, 0x37, 0x90, 0x8A, ++0xA5, 0x80, 0x05, 0x51, 0x37, 0x90, 0x8A, 0xB5, ++0x12, 0xBF, 0xC4, 0x02, 0x04, 0x7E, 0x51, 0x37, ++0x02, 0xDE, 0x64, 0x51, 0x37, 0x61, 0xD0, 0x51, ++0x37, 0x02, 0x77, 0x4F, 0x51, 0x37, 0x02, 0x7C, ++0x60, 0x51, 0x37, 0x02, 0x7A, 0xC6, 0x51, 0x37, ++0x02, 0x5D, 0x36, 0x51, 0x37, 0x02, 0x7B, 0xE9, ++0x51, 0x37, 0x02, 0x70, 0x33, 0x51, 0x37, 0x02, ++0x48, 0xC9, 0x51, 0x37, 0x02, 0x79, 0xF3, 0x51, ++0x37, 0x02, 0xC6, 0x32, 0x51, 0x37, 0x02, 0x51, ++0x7B, 0x51, 0x37, 0x02, 0x79, 0x30, 0x51, 0x37, ++0x02, 0x57, 0xF2, 0x51, 0x37, 0x02, 0x74, 0x8D, ++0x51, 0x37, 0x02, 0x78, 0x9A, 0x51, 0x37, 0x02, ++0x5E, 0x0B, 0x51, 0x37, 0x02, 0xCF, 0xDC, 0x90, ++0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x96, ++0xE5, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, ++0x96, 0xE6, 0x02, 0x86, 0x39, 0x7D, 0xFF, 0xE4, ++0xFF, 0xF1, 0x56, 0x90, 0x8A, 0xFD, 0xE0, 0xFE, ++0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0x97, 0x18, 0xED, 0xF0, 0x90, 0x88, 0x31, 0xE0, ++0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, ++0x02, 0x61, 0xC2, 0xEE, 0x12, 0xA3, 0x5C, 0x30, ++0xE0, 0x02, 0x61, 0xC2, 0x90, 0x88, 0x39, 0xE0, ++0xFE, 0x6F, 0x70, 0x02, 0x61, 0xC2, 0xEF, 0x70, ++0x02, 0x61, 0x1E, 0x24, 0xFE, 0x70, 0x02, 0x61, ++0x63, 0x24, 0xFE, 0x60, 0x4F, 0x24, 0xFC, 0x70, ++0x02, 0x61, 0xA8, 0x24, 0xFC, 0x60, 0x02, 0x61, ++0xBB, 0xEE, 0xB4, 0x0E, 0x03, 0x12, 0x71, 0x5F, ++0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, ++0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, ++0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, ++0xE0, 0xB4, 0x04, 0x11, 0x90, 0x97, 0x18, 0xE0, ++0xFF, 0x60, 0x05, 0x12, 0x67, 0x80, 0x80, 0x05, ++0x90, 0x8A, 0xED, 0x51, 0x46, 0x90, 0x88, 0x39, ++0xE0, 0x64, 0x08, 0x60, 0x02, 0x61, 0xBB, 0x12, ++0x7B, 0xCC, 0x61, 0xBB, 0x90, 0x88, 0x39, 0xE0, ++0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, ++0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, ++0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, ++0x90, 0x86, 0x00, 0x51, 0x46, 0xBF, 0x01, 0x03, ++0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, ++0x0C, 0x60, 0x02, 0x61, 0xBB, 0x90, 0x86, 0x00, ++0x51, 0x46, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x61, ++0xBB, 0x12, 0x68, 0xC2, 0x61, 0xBB, 0x90, 0x88, ++0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, ++0x51, 0x46, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, ++0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, ++0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, ++0x0B, 0x90, 0x86, 0x00, 0x51, 0x46, 0xBF, 0x01, ++0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, ++0x64, 0x04, 0x70, 0x67, 0x90, 0x86, 0x02, 0x51, ++0x46, 0xEF, 0x64, 0x01, 0x70, 0x5D, 0x12, 0x73, ++0x5A, 0x80, 0x58, 0x90, 0x88, 0x39, 0xE0, 0xB4, ++0x0E, 0x0B, 0x90, 0x86, 0x00, 0x51, 0x46, 0xBF, ++0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, ++0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, ++0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, ++0x00, 0x51, 0x46, 0xBF, 0x01, 0x03, 0x12, 0x68, ++0xC2, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, ++0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, ++0xB4, 0x04, 0x18, 0x12, 0x7A, 0x49, 0x80, 0x13, ++0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, ++0x88, 0x32, 0x12, 0x8F, 0xDC, 0x30, 0xE0, 0x03, ++0x12, 0x79, 0xD4, 0x90, 0x88, 0x39, 0x12, 0xC8, ++0xB8, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, ++0x95, 0x53, 0x12, 0x86, 0x39, 0x02, 0x02, 0x06, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, ++0xAF, 0x3F, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x88, ++0x9D, 0x12, 0xC8, 0xC5, 0x4F, 0xF0, 0xFC, 0x12, ++0x02, 0x06, 0xFD, 0x54, 0x04, 0x13, 0x13, 0x54, ++0x3F, 0xFF, 0x90, 0x95, 0x37, 0xE0, 0x54, 0xFE, ++0x4F, 0xF0, 0xED, 0x54, 0x08, 0xFF, 0xEC, 0x54, ++0xF7, 0x4F, 0xFF, 0x90, 0x88, 0x9D, 0xF0, 0x12, ++0x02, 0x06, 0x12, 0xC8, 0xAE, 0x90, 0x88, 0x9D, ++0x12, 0xC8, 0xA5, 0x4E, 0xFF, 0xF0, 0x12, 0x02, ++0x06, 0xFE, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, ++0x4D, 0xFF, 0x90, 0x88, 0x9D, 0xF0, 0xEE, 0x54, ++0x80, 0xFE, 0xEF, 0x54, 0x7F, 0x4E, 0xF0, 0x12, ++0xA8, 0x96, 0xE9, 0x24, 0x01, 0xF9, 0xE4, 0x3A, ++0x8B, 0x45, 0x12, 0xE7, 0x57, 0x7B, 0x01, 0x7A, ++0x88, 0x79, 0x9E, 0x12, 0x69, 0xF5, 0x71, 0xC7, ++0x20, 0xE0, 0x02, 0xA1, 0xA9, 0x90, 0x05, 0x54, ++0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, 0x13, ++0x90, 0x88, 0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, ++0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x12, 0x12, 0x87, ++0xAE, 0x90, 0x88, 0x9E, 0x12, 0xE7, 0x4F, 0x12, ++0x87, 0xB9, 0x90, 0x88, 0x9F, 0xF0, 0x80, 0x47, ++0x12, 0x87, 0xAE, 0xFF, 0xC3, 0x94, 0x2A, 0x50, ++0x15, 0xEF, 0xC3, 0x94, 0x03, 0x50, 0x07, 0x90, ++0x88, 0x9E, 0x74, 0x03, 0x80, 0x0D, 0x12, 0x87, ++0xAE, 0x90, 0x88, 0x9E, 0x80, 0x05, 0x90, 0x88, ++0x9E, 0x74, 0x2A, 0x12, 0xE7, 0x4F, 0x12, 0x87, ++0xB9, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, ++0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, ++0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, ++0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, ++0xB4, 0x11, 0x30, 0xE0, 0x3D, 0x90, 0x88, 0x9E, ++0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA6, ++0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0x88, ++0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, ++0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, 0x13, ++0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, 0xE0, ++0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, 0x01, ++0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, 0x12, ++0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0xF0, 0x90, ++0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, ++0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x54, ++0x07, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0xD1, ++0x47, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, 0x7E, ++0x12, 0xE7, 0x47, 0x74, 0x11, 0xF0, 0x90, 0x95, ++0x37, 0xE0, 0x30, 0xE0, 0x33, 0x90, 0x95, 0x40, ++0x74, 0x01, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x06, ++0xC7, 0xE0, 0xFE, 0x90, 0x06, 0xC6, 0x12, 0xAF, ++0xD5, 0xFE, 0xE4, 0xFD, 0x78, 0x10, 0x12, 0xC7, ++0xA4, 0x90, 0x06, 0xC5, 0xE0, 0xFE, 0x90, 0x06, ++0xC4, 0x12, 0xAF, 0xD5, 0xFE, 0xE4, 0xFD, 0x12, ++0x86, 0x20, 0x90, 0x95, 0x3C, 0x12, 0x04, 0x31, ++0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x01, 0x08, 0x90, ++0x88, 0xB0, 0x74, 0x01, 0xF0, 0x80, 0x2B, 0x90, ++0x88, 0xA5, 0xE0, 0xB4, 0x04, 0x08, 0x90, 0x88, ++0xB0, 0x74, 0x04, 0xF0, 0x80, 0x1C, 0x90, 0x88, ++0xA5, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x88, 0xB0, ++0x74, 0x02, 0xF0, 0x80, 0x0D, 0x90, 0x88, 0xA5, ++0xE0, 0xB4, 0x07, 0x06, 0x90, 0x88, 0xB0, 0x74, ++0x05, 0xF0, 0xE4, 0x90, 0x88, 0xA5, 0xF0, 0x80, ++0x40, 0x90, 0x8A, 0xF1, 0x51, 0x46, 0x90, 0x89, ++0x04, 0xE0, 0x90, 0x00, 0x40, 0x30, 0xE0, 0x07, ++0xE0, 0x54, 0x0F, 0x44, 0xA0, 0x80, 0x05, 0xE0, ++0x54, 0x0F, 0x44, 0x20, 0xFD, 0x7F, 0x40, 0x12, ++0x7B, 0x2E, 0x12, 0xA8, 0x96, 0x12, 0x87, 0xA3, ++0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, ++0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, ++0x9A, 0xF1, 0x51, 0x12, 0xE7, 0x47, 0x74, 0x43, ++0xF0, 0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, 0xF0, ++0xE4, 0x90, 0x88, 0xAF, 0xF0, 0x90, 0x88, 0xA0, ++0x12, 0xA3, 0x5B, 0x30, 0xE0, 0x09, 0x90, 0x88, ++0xD0, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x11, 0x90, ++0x8A, 0x97, 0xD1, 0x47, 0x7F, 0x01, 0x12, 0x04, ++0x7E, 0x90, 0x88, 0xD0, 0xE0, 0x54, 0xFD, 0xF0, ++0x90, 0x8A, 0xD9, 0xD1, 0x47, 0x7F, 0x03, 0x12, ++0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, ++0x07, 0x90, 0x88, 0xA1, 0xE0, 0x54, 0xBF, 0xF0, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8A, 0x77, ++0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, ++0x83, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x79, 0xE0, ++0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, ++0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, ++0x7A, 0x88, 0x79, 0x31, 0x12, 0x04, 0x80, 0x12, ++0xE6, 0x3A, 0x12, 0x04, 0x80, 0x90, 0x88, 0x35, ++0x74, 0x02, 0xF0, 0x90, 0x88, 0x3C, 0x14, 0xF0, ++0xA3, 0xF0, 0xA3, 0x74, 0x50, 0xF1, 0x49, 0xFE, ++0xE4, 0x33, 0x90, 0x88, 0x42, 0xF0, 0xA3, 0xCE, ++0xF1, 0x49, 0xFF, 0x12, 0xE6, 0xBC, 0x12, 0xE5, ++0x92, 0x90, 0x8A, 0x89, 0xD1, 0x47, 0xF1, 0xEB, ++0x90, 0x8A, 0x89, 0xD1, 0x47, 0x7D, 0x0C, 0x7F, ++0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0xD1, ++0x47, 0x7D, 0x0C, 0x7F, 0x01, 0x12, 0x04, 0x7E, ++0x90, 0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x01, 0x08, ++0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x80, 0x18, ++0xEF, 0xB4, 0x03, 0x0F, 0x90, 0x88, 0x41, 0x74, ++0xF4, 0xF0, 0x90, 0x00, 0x92, 0xE0, 0x54, 0x7F, ++0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0x41, 0xF0, ++0x7F, 0x79, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0x03, ++0xFF, 0xBF, 0x02, 0x0F, 0x7F, 0x28, 0x12, 0x7B, ++0x41, 0xEF, 0x30, 0xE2, 0x06, 0x90, 0x88, 0x53, ++0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, 0x74, 0x02, ++0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, ++0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0xF1, ++0x49, 0x12, 0xE6, 0xBC, 0x7E, 0x00, 0x7F, 0x18, ++0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x3F, ++0x12, 0x04, 0x80, 0x90, 0x8A, 0xA3, 0xD1, 0x47, ++0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x05, 0x58, ++0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, 0x7D, 0x00, ++0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, 0x12, 0x04, ++0x80, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, ++0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x90, ++0x05, 0x22, 0xE4, 0xF0, 0x90, 0x88, 0x9C, 0xF0, ++0x22, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, ++0x22, 0xE4, 0xFB, 0xFD, 0x7F, 0xFF, 0xEB, 0xB4, ++0x57, 0x04, 0xF1, 0xB1, 0x80, 0x0F, 0xEF, 0x70, ++0x07, 0x90, 0x93, 0xF3, 0xE0, 0x4D, 0x80, 0x05, ++0x12, 0xC7, 0xBE, 0xF1, 0xB1, 0x90, 0x05, 0x22, ++0xF0, 0x90, 0x93, 0x01, 0xEB, 0xF0, 0x22, 0x12, ++0xE4, 0x38, 0x12, 0x7B, 0xDB, 0x90, 0x8A, 0xC5, ++0x51, 0x46, 0x12, 0xC9, 0xE2, 0x12, 0xE4, 0x3E, ++0xD1, 0x50, 0x12, 0xE6, 0x35, 0x12, 0xDE, 0xF1, ++0x90, 0x8A, 0x73, 0x51, 0x46, 0x90, 0x00, 0x6A, ++0xE0, 0x30, 0xE2, 0x14, 0x90, 0x92, 0x20, 0x74, ++0x01, 0xF0, 0xA3, 0x74, 0xF4, 0xF0, 0xE4, 0xFB, ++0xFD, 0x7F, 0x68, 0x7E, 0x01, 0x12, 0x66, 0x33, ++0x22, 0x90, 0x93, 0xF4, 0xE0, 0xFF, 0x90, 0x93, ++0xF3, 0xE0, 0x4F, 0x22, 0x90, 0x8A, 0xF9, 0xD1, ++0x47, 0x7D, 0x20, 0x12, 0xE2, 0x74, 0x51, 0x46, ++0x90, 0x88, 0x2F, 0x74, 0x02, 0xF0, 0x22, 0x90, ++0x86, 0x0C, 0x51, 0x46, 0x90, 0x8A, 0xF9, 0xD1, ++0x47, 0xF1, 0xEB, 0x90, 0x88, 0x2F, 0x74, 0x01, ++0xF0, 0x22, 0x90, 0x8A, 0xF9, 0xD1, 0x47, 0xF1, ++0xEB, 0x80, 0xF0, 0xE4, 0xFD, 0xFF, 0x02, 0x04, ++0x7E, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0x97, 0x06, 0xEF, 0xF0, 0xA3, ++0xED, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x96, 0x47, ++0x7D, 0x44, 0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x12, ++0x92, 0x43, 0x90, 0x97, 0x07, 0xE0, 0x90, 0x97, ++0x06, 0xB4, 0x01, 0x09, 0xE0, 0x11, 0x3C, 0xE0, ++0x44, 0x04, 0xF0, 0x80, 0x07, 0xE0, 0x11, 0x3C, ++0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8A, 0xF9, 0x12, ++0x96, 0x47, 0x12, 0x97, 0xEB, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xE5, 0x0E, 0xC4, 0x54, 0xF0, 0x24, ++0x05, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, ++0x22, 0x8D, 0x0E, 0xEF, 0x30, 0xE6, 0x1C, 0x11, ++0xD6, 0xE0, 0xFD, 0x11, 0x3A, 0xE0, 0x54, 0x03, ++0x90, 0x92, 0x80, 0xF0, 0xE4, 0xFB, 0xAF, 0x0E, ++0x12, 0x75, 0x80, 0x11, 0xC9, 0xD1, 0x4E, 0x74, ++0x01, 0x80, 0x55, 0x12, 0xE6, 0x91, 0x04, 0xF0, ++0x12, 0xE6, 0x91, 0x64, 0x02, 0x70, 0x1F, 0x74, ++0x5B, 0x25, 0x0E, 0x12, 0xA1, 0x86, 0xE0, 0xFD, ++0xF4, 0x60, 0x02, 0x80, 0x04, 0x11, 0xD6, 0xE0, ++0xFD, 0x11, 0x3A, 0x12, 0xE6, 0xAE, 0x11, 0xD6, ++0xD1, 0x4E, 0x74, 0x02, 0x80, 0x2A, 0x12, 0xE6, ++0x91, 0xD3, 0x94, 0x03, 0x40, 0x13, 0x90, 0x8A, ++0xB3, 0x12, 0x96, 0x47, 0xAF, 0x0E, 0x12, 0x04, ++0x7E, 0x11, 0xC9, 0xD1, 0x4E, 0x74, 0x03, 0x80, ++0x0F, 0x11, 0xD6, 0xE0, 0xFD, 0x11, 0x3A, 0x12, ++0xE6, 0xAE, 0x11, 0xD6, 0xD1, 0x4E, 0x74, 0x02, ++0xF0, 0xAB, 0x0E, 0xE4, 0xFD, 0xFF, 0x02, 0x6F, ++0x75, 0x74, 0xB6, 0x25, 0x0E, 0xF5, 0x82, 0xE4, ++0x34, 0x8E, 0xF5, 0x83, 0xE4, 0xF0, 0xE5, 0x0E, ++0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, ++0x34, 0x81, 0xF5, 0x83, 0x22, 0x90, 0x04, 0x85, ++0xE0, 0xF5, 0x70, 0x90, 0x96, 0x5A, 0xE0, 0x04, ++0xF0, 0xE4, 0xF5, 0x67, 0x90, 0x88, 0x2B, 0xE0, ++0xFF, 0xE5, 0x67, 0xC3, 0x9F, 0x40, 0x02, 0xC1, ++0x4D, 0xE5, 0x67, 0x11, 0xD8, 0xE0, 0xF5, 0x72, ++0x12, 0xE6, 0xFA, 0xE0, 0x65, 0x72, 0x60, 0x16, ++0x90, 0x92, 0x5E, 0xE5, 0x72, 0xF0, 0xE4, 0xA3, ++0xF0, 0xAB, 0x67, 0xFD, 0xFF, 0x12, 0x6F, 0x75, ++0x12, 0xE6, 0xFA, 0xE5, 0x72, 0xF0, 0x90, 0x04, ++0xA0, 0xE0, 0x64, 0x01, 0x70, 0x4C, 0xA3, 0xE0, ++0x65, 0x67, 0x70, 0x46, 0xA3, 0xE0, 0xF5, 0x68, ++0xA3, 0xE0, 0x90, 0x95, 0xDB, 0xF0, 0xE5, 0x67, ++0x11, 0xD8, 0xE0, 0x65, 0x68, 0x70, 0x02, 0xC1, ++0x49, 0xE5, 0x67, 0x11, 0xD8, 0xE5, 0x68, 0xF0, ++0xE5, 0x67, 0x11, 0x3C, 0xE0, 0x54, 0xFC, 0xFF, ++0x90, 0x95, 0xDB, 0xE0, 0x54, 0x03, 0x4F, 0xFF, ++0xE5, 0x67, 0x11, 0x3C, 0xEF, 0xF0, 0x90, 0x92, ++0x5E, 0xE5, 0x68, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, ++0xAB, 0x67, 0xE4, 0xFD, 0xFF, 0x12, 0x6F, 0x75, ++0xC1, 0x49, 0x74, 0x43, 0x25, 0x67, 0x12, 0xD2, ++0x59, 0xE0, 0xFB, 0x7A, 0x00, 0x75, 0xF0, 0x12, ++0xE5, 0x67, 0x90, 0x89, 0x55, 0x12, 0x04, 0x6E, ++0xE0, 0xC3, 0x9B, 0xFE, 0xE4, 0x9A, 0x90, 0x95, ++0xD9, 0xF0, 0xA3, 0xCE, 0xF0, 0x75, 0xF0, 0x12, ++0xE5, 0x67, 0x12, 0xD5, 0xB2, 0xE0, 0xFE, 0xA3, ++0xE0, 0xC3, 0x9B, 0xF5, 0x6E, 0xEE, 0x9A, 0xF5, ++0x6D, 0xAF, 0x67, 0x12, 0x78, 0x4A, 0xEF, 0x70, ++0x02, 0xC1, 0x49, 0x75, 0xF0, 0x12, 0xE5, 0x67, ++0xD1, 0xA1, 0x12, 0xA3, 0x5C, 0x30, 0xE0, 0x02, ++0xC1, 0x49, 0xE5, 0x67, 0x13, 0x13, 0x13, 0x54, ++0x1F, 0x12, 0xAF, 0x19, 0xE0, 0xFD, 0x7C, 0x00, ++0xE5, 0x67, 0x12, 0xCA, 0x68, 0x80, 0x05, 0xC3, ++0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, ++0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x60, 0x02, 0xC1, ++0x49, 0xE5, 0x6E, 0x45, 0x6D, 0x70, 0x0C, 0x90, ++0x95, 0xD9, 0xE0, 0x70, 0x02, 0xA3, 0xE0, 0x70, ++0x02, 0xC1, 0x49, 0xE5, 0x67, 0x75, 0xF0, 0x12, ++0xA4, 0x24, 0x57, 0xF9, 0x74, 0x89, 0x35, 0xF0, ++0xFA, 0x7B, 0x01, 0x90, 0x95, 0xD6, 0x12, 0x86, ++0x42, 0x90, 0x00, 0x02, 0x12, 0x03, 0x3E, 0xFF, ++0x12, 0x03, 0x13, 0x2F, 0xFF, 0x12, 0xE7, 0x3F, ++0xFF, 0x12, 0xE7, 0x0F, 0x90, 0x00, 0x08, 0x12, ++0x03, 0x3E, 0x2F, 0xF5, 0x71, 0xE5, 0x67, 0x11, ++0xD8, 0xE0, 0xF5, 0x68, 0x54, 0x80, 0xF5, 0x6A, ++0xE5, 0x68, 0x54, 0x7F, 0xF5, 0x69, 0x90, 0x96, ++0x48, 0xE0, 0x60, 0x15, 0x75, 0x73, 0x0A, 0xF1, ++0xE9, 0x34, 0x81, 0xF5, 0x83, 0xE4, 0x93, 0xC3, ++0x13, 0x74, 0x01, 0x93, 0x13, 0xF5, 0x74, 0x80, ++0x0A, 0x7B, 0xFF, 0x12, 0xCA, 0x5E, 0xE4, 0xF5, ++0x73, 0xF5, 0x74, 0x75, 0xF0, 0x12, 0xE5, 0x67, ++0xF1, 0xF9, 0xFF, 0xE5, 0x69, 0xD3, 0x9F, 0x40, ++0x08, 0x8F, 0x69, 0xE5, 0x69, 0x45, 0x6A, 0xF5, ++0x68, 0xD1, 0x5F, 0xE0, 0xC3, 0x94, 0x05, 0x40, ++0x02, 0x81, 0x32, 0xE5, 0x69, 0x90, 0x81, 0x61, ++0x93, 0xF5, 0x6F, 0xFD, 0xAF, 0x69, 0x12, 0x60, ++0x6F, 0x8F, 0x6F, 0xE5, 0x6A, 0x60, 0x04, 0x05, ++0x6F, 0x05, 0x6F, 0xE5, 0x69, 0xC3, 0x94, 0x0C, ++0x40, 0x1D, 0x74, 0x4A, 0x25, 0x67, 0x12, 0xDE, ++0xB6, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xEF, 0x30, ++0xE7, 0x06, 0xE5, 0x6F, 0x2E, 0xFF, 0x80, 0x05, ++0xC3, 0xE5, 0x6F, 0x9E, 0xFF, 0x8F, 0x6F, 0xE5, ++0x6F, 0xD3, 0x94, 0x1A, 0xAF, 0x6F, 0x40, 0x02, ++0x7F, 0x1A, 0x8F, 0x6F, 0xE5, 0x68, 0x90, 0x81, ++0xD9, 0x93, 0xFF, 0xD3, 0x90, 0x95, 0xDA, 0xE0, ++0x9F, 0x90, 0x95, 0xD9, 0xE0, 0x94, 0x00, 0x40, ++0x02, 0x61, 0xE2, 0xC3, 0xE5, 0x6E, 0x94, 0x0A, ++0xE5, 0x6D, 0x94, 0x00, 0x40, 0x02, 0x61, 0x8E, ++0xD1, 0x55, 0xF5, 0x83, 0xE0, 0xC3, 0x94, 0x01, ++0x40, 0x07, 0xD1, 0x55, 0xF5, 0x83, 0xE0, 0x14, ++0xF0, 0xF1, 0xE3, 0x90, 0x00, 0x08, 0x12, 0x03, ++0x3E, 0xFF, 0x90, 0x95, 0xDA, 0xE0, 0x2F, 0xFF, ++0x90, 0x95, 0xD9, 0xE0, 0x35, 0xF0, 0xFE, 0x12, ++0xE7, 0x0F, 0xEE, 0x35, 0xF0, 0xFE, 0x12, 0xE7, ++0x3F, 0xFD, 0xEE, 0x35, 0xF0, 0xFC, 0xE5, 0x6D, ++0xC3, 0x13, 0xFE, 0xE5, 0x6E, 0x13, 0xFF, 0xD3, ++0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x0F, 0xE5, 0x67, ++0x94, 0x05, 0x50, 0x07, 0xD1, 0x55, 0xF5, 0x83, ++0x74, 0x03, 0xF0, 0x61, 0xE2, 0xF1, 0xE3, 0x12, ++0x03, 0x13, 0x65, 0x71, 0x70, 0x02, 0xE5, 0xF0, ++0x70, 0x2F, 0xE5, 0x67, 0xC3, 0x94, 0x05, 0x50, ++0x0C, 0xD1, 0x55, 0xF5, 0x83, 0xE0, 0xD3, 0x94, ++0x00, 0x40, 0x02, 0x80, 0x07, 0xE5, 0x71, 0xC3, ++0x94, 0x03, 0x50, 0x09, 0x7D, 0x06, 0xAF, 0x67, ++0x12, 0xA1, 0xC6, 0xC1, 0x49, 0xE4, 0xFD, 0xAF, ++0x67, 0x12, 0xA0, 0xC7, 0x12, 0xA1, 0xC2, 0xC1, ++0x2D, 0x12, 0xD1, 0xEA, 0xC1, 0x2D, 0xD1, 0x55, ++0xF5, 0x83, 0xE4, 0xF0, 0x90, 0x91, 0x6C, 0x74, ++0x02, 0xF0, 0xAB, 0x6F, 0xAD, 0x67, 0xAF, 0x6E, ++0xAE, 0x6D, 0x12, 0x41, 0x9C, 0x8E, 0x6B, 0x8F, ++0x6C, 0xF1, 0xE9, 0x34, 0x81, 0xF5, 0x83, 0xC3, ++0x74, 0x01, 0x93, 0x95, 0x74, 0xFF, 0xE4, 0x93, ++0x94, 0x00, 0xFE, 0xD3, 0xE5, 0x6C, 0x9F, 0xE5, ++0x6B, 0x9E, 0x40, 0x0D, 0xD1, 0x77, 0xE4, 0xF0, ++0x7D, 0x01, 0xAF, 0x67, 0x12, 0xA0, 0xC7, 0xC1, ++0x2D, 0x12, 0xE7, 0x37, 0xC3, 0xE5, 0x6C, 0x9F, ++0xE5, 0x6B, 0x94, 0x00, 0x50, 0x0D, 0xD1, 0x77, ++0xE4, 0xF0, 0x7D, 0x01, 0xAF, 0x67, 0x12, 0xA0, ++0x01, 0xC1, 0x2D, 0x12, 0xA1, 0xC2, 0xD1, 0x77, ++0xE0, 0x04, 0xF0, 0xE5, 0x69, 0x90, 0x81, 0xED, ++0x93, 0x25, 0x73, 0xFF, 0xE4, 0x33, 0xFE, 0xD1, ++0x77, 0xE0, 0xC3, 0x9F, 0xEE, 0x64, 0x80, 0xF8, ++0x74, 0x80, 0x98, 0x50, 0x02, 0xC1, 0x2D, 0xD1, ++0x77, 0xE4, 0xF0, 0x12, 0xE7, 0x37, 0xF1, 0xE9, ++0x34, 0x81, 0xF5, 0x83, 0x74, 0x01, 0x93, 0x2F, ++0xFF, 0xE4, 0x93, 0x34, 0x00, 0xC3, 0x13, 0xFE, ++0xEF, 0x13, 0xFF, 0xE5, 0x67, 0x12, 0xA1, 0xB1, ++0xC1, 0x2D, 0xD1, 0x5F, 0xE0, 0x64, 0x05, 0x60, ++0x02, 0xA1, 0x05, 0x90, 0x04, 0xA0, 0xE0, 0x64, ++0x02, 0x70, 0x10, 0xD1, 0x83, 0xE4, 0xF0, 0x90, ++0x04, 0xA1, 0xE0, 0x78, 0x88, 0xF6, 0x12, 0xAF, ++0x48, 0xC1, 0x41, 0xAD, 0x69, 0xAF, 0x67, 0x12, ++0x72, 0xEE, 0x12, 0xE6, 0xEE, 0xEF, 0xF0, 0xE5, ++0x67, 0x12, 0xAE, 0xFB, 0xE0, 0x54, 0x07, 0x78, ++0x88, 0xF6, 0x74, 0xD6, 0x25, 0x67, 0xF1, 0xDA, ++0xFF, 0xC3, 0x94, 0x30, 0x40, 0x1C, 0x75, 0xF0, ++0x12, 0xE5, 0x67, 0xD1, 0xA1, 0xFE, 0xC4, 0x13, ++0x13, 0x54, 0x03, 0x20, 0xE0, 0x0C, 0x12, 0xE6, ++0xEE, 0xE0, 0x60, 0x06, 0x90, 0x96, 0x48, 0xE0, ++0x60, 0x0A, 0xE4, 0x78, 0x88, 0xF6, 0xD1, 0x83, ++0xE4, 0xF0, 0x80, 0x61, 0x12, 0xE6, 0xE2, 0xE0, ++0xFE, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEF, ++0x12, 0xDD, 0xE0, 0x98, 0x50, 0x22, 0x74, 0xD6, ++0x25, 0x67, 0xF1, 0xDA, 0x24, 0x05, 0xFD, 0xE4, ++0x33, 0xFC, 0xEE, 0x12, 0xDD, 0xE0, 0x98, 0x50, ++0x0F, 0x12, 0xE6, 0xD6, 0xE0, 0xB5, 0x69, 0x08, ++0xD1, 0x90, 0xE0, 0xC3, 0x94, 0x0A, 0x40, 0x28, ++0x78, 0x88, 0xE6, 0xFF, 0x70, 0x04, 0x76, 0x01, ++0x80, 0x0C, 0xEF, 0x78, 0x88, 0xB4, 0x01, 0x04, ++0x76, 0x03, 0x80, 0x02, 0x76, 0x05, 0xD1, 0x90, ++0xE4, 0xF0, 0x74, 0xD6, 0x25, 0x67, 0xF1, 0xDA, ++0xFF, 0x12, 0xE6, 0xE2, 0xEF, 0xF0, 0x80, 0x05, ++0xD1, 0x83, 0xE0, 0x04, 0xF0, 0x12, 0xE6, 0xD6, ++0xE5, 0x69, 0xF0, 0xC1, 0x28, 0xD1, 0x5F, 0xE0, ++0x64, 0x06, 0x60, 0x02, 0xC1, 0x2D, 0xF5, 0x6B, ++0xF5, 0x6C, 0xE5, 0x67, 0x12, 0xAE, 0xFB, 0xE0, ++0x54, 0x07, 0x78, 0x88, 0xF6, 0xD3, 0xE5, 0x6E, ++0x94, 0xE8, 0xE5, 0x6D, 0x94, 0x03, 0x40, 0x06, ++0x78, 0x86, 0x76, 0x05, 0x80, 0x15, 0xD3, 0xE5, ++0x6E, 0x94, 0xFA, 0xE5, 0x6D, 0x94, 0x00, 0x40, ++0x06, 0x78, 0x86, 0x76, 0x02, 0x80, 0x04, 0xE4, ++0x78, 0x86, 0xF6, 0xE5, 0x6E, 0xAE, 0x6D, 0x78, ++0x86, 0x86, 0x00, 0x08, 0x80, 0x05, 0xCE, 0xC3, ++0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x82, ++0x06, 0xE4, 0x12, 0xE7, 0x30, 0x90, 0x95, 0xDC, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x78, 0x87, ++0xF6, 0xF1, 0xE3, 0x78, 0x87, 0xE6, 0xFD, 0x12, ++0xE6, 0xCA, 0xAE, 0xF0, 0x78, 0x86, 0x86, 0x00, ++0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, ++0xD8, 0xF9, 0xFF, 0xED, 0x90, 0x82, 0x01, 0x12, ++0xE7, 0x30, 0xEF, 0x25, 0x6C, 0xF5, 0x6C, 0xEE, ++0x35, 0x6B, 0xF5, 0x6B, 0xC3, 0x90, 0x95, 0xDD, ++0xE0, 0x95, 0x6C, 0x90, 0x95, 0xDC, 0xE0, 0x95, ++0x6B, 0x40, 0x07, 0x78, 0x87, 0x06, 0xE6, 0xB4, ++0x05, 0xBF, 0x78, 0x87, 0xE6, 0xC3, 0x13, 0xF6, ++0xFD, 0x08, 0xE6, 0x24, 0x01, 0xFF, 0xE4, 0x33, ++0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x08, 0xF6, 0xD3, ++0x9D, 0x40, 0x07, 0xE6, 0x79, 0x87, 0x97, 0xF6, ++0x80, 0x04, 0xE4, 0x78, 0x89, 0xF6, 0xD1, 0x6B, ++0xE0, 0xC3, 0x13, 0xFF, 0x78, 0x89, 0xE6, 0xC4, ++0x33, 0x54, 0xE0, 0x2F, 0xFF, 0xD1, 0x6B, 0xEF, ++0xF0, 0xD1, 0x6B, 0xE0, 0xC3, 0x94, 0xC0, 0x40, ++0x05, 0xD1, 0x6B, 0x74, 0xC0, 0xF0, 0xD1, 0x6B, ++0xE0, 0x24, 0x1F, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, ++0x78, 0x06, 0xCE, 0xA2, 0xE7, 0x13, 0xCE, 0x13, ++0xD8, 0xF8, 0x78, 0x89, 0xF6, 0xE6, 0x25, 0xE0, ++0xF6, 0x70, 0x03, 0xFF, 0x80, 0x05, 0x78, 0x89, ++0xE6, 0x14, 0xFF, 0x78, 0x88, 0xA6, 0x07, 0xD3, ++0x90, 0x95, 0xDA, 0xE0, 0x94, 0x03, 0x90, 0x95, ++0xD9, 0xE0, 0x94, 0x00, 0x40, 0x02, 0xE4, 0xF6, ++0x78, 0x88, 0x12, 0xAF, 0x48, 0xD1, 0x5F, 0xE0, ++0xFF, 0xD3, 0x94, 0x05, 0x50, 0x05, 0xEF, 0x04, ++0xFF, 0x80, 0x02, 0x7F, 0x00, 0xD1, 0x5F, 0xEF, ++0xF0, 0xE4, 0xF5, 0x6B, 0xF5, 0x6C, 0x12, 0xD1, ++0xEA, 0x05, 0x67, 0x01, 0xF4, 0x22, 0xE0, 0x90, ++0x92, 0x5E, 0xF0, 0xA3, 0x22, 0x74, 0x6B, 0x25, ++0x67, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0x22, 0x74, ++0x76, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8E, ++0xF5, 0x83, 0x22, 0x74, 0x4F, 0x25, 0x67, 0xF5, ++0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, ++0xA6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, ++0xF5, 0x83, 0x22, 0x74, 0x76, 0x25, 0x67, 0xF5, ++0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE4, 0xF0, ++0x74, 0xF6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, ++0x8D, 0xF5, 0x83, 0x22, 0xFF, 0x75, 0xF0, 0x12, ++0xED, 0x90, 0x89, 0x52, 0x12, 0x04, 0x6E, 0xE0, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x12, 0xD2, 0xF8, 0x20, 0xE6, 0x02, 0xE1, 0xC8, ++0x90, 0x00, 0x8C, 0xE0, 0x90, 0x97, 0x00, 0xF0, ++0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, 0x97, 0x01, ++0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0x97, ++0x02, 0xF0, 0x90, 0x97, 0x01, 0xE0, 0x24, 0xFC, ++0x60, 0x10, 0x24, 0x03, 0x60, 0x02, 0xE1, 0xBF, ++0x90, 0x97, 0x00, 0xE0, 0xFF, 0x12, 0xD2, 0x82, ++0xE1, 0xBF, 0x90, 0x97, 0x00, 0xE0, 0x24, 0xD6, ++0xF1, 0xDA, 0xFB, 0xE4, 0xFD, 0xFF, 0xF1, 0xD2, ++0x75, 0xF0, 0x12, 0xD1, 0xA1, 0x13, 0x13, 0x54, ++0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0xF1, 0xD2, 0x75, ++0xF0, 0x12, 0xD1, 0xA1, 0x12, 0xA3, 0x5C, 0xFB, ++0x0D, 0xE4, 0xFF, 0xF1, 0xD2, 0x75, 0xF0, 0x12, ++0xD1, 0xA1, 0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, ++0xFF, 0xF1, 0xD2, 0x75, 0xF0, 0x12, 0xF1, 0xF9, ++0xFB, 0xE4, 0xFD, 0x0F, 0xF1, 0xD2, 0x12, 0xAF, ++0xE7, 0xF1, 0xCF, 0x75, 0xF0, 0x12, 0x12, 0xA1, ++0x93, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, ++0x01, 0xF1, 0xD2, 0x75, 0xF0, 0x12, 0x12, 0xA1, ++0x93, 0x54, 0x1F, 0xF1, 0xD0, 0x12, 0xCF, 0x82, ++0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xF1, 0xD2, 0x75, ++0xF0, 0x08, 0xA4, 0x24, 0x01, 0xF5, 0x82, 0xE4, ++0x34, 0x82, 0xF1, 0xCD, 0x75, 0xF0, 0x08, 0xA4, ++0x24, 0x02, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF1, ++0xCD, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0xF5, ++0x82, 0xE4, 0x34, 0x82, 0xF1, 0xCD, 0x75, 0xF0, ++0x08, 0xA4, 0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, ++0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, ++0xF1, 0xD2, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x05, ++0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF1, 0xCD, 0x75, ++0xF0, 0x08, 0xA4, 0x24, 0x06, 0xF5, 0x82, 0xE4, ++0x34, 0x82, 0xF1, 0xCD, 0x75, 0xF0, 0x08, 0xA4, ++0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, ++0x83, 0xE0, 0xFB, 0x0D, 0x12, 0xD2, 0xD0, 0x12, ++0xD2, 0xF8, 0x30, 0xE0, 0x03, 0x12, 0xD5, 0xB8, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF5, 0x83, 0xE0, ++0xFB, 0x0D, 0x12, 0xD2, 0xD0, 0x90, 0x97, 0x00, ++0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, ++0x83, 0xE0, 0x22, 0x90, 0x95, 0xD6, 0x02, 0x86, ++0x39, 0xE5, 0x69, 0x25, 0xE0, 0x24, 0x75, 0xF5, ++0x82, 0xE4, 0x22, 0xC1, 0xA9, 0x75, 0xF0, 0x12, ++0xEF, 0x90, 0x89, 0x4F, 0x12, 0x04, 0x6E, 0xE0, ++0x22, 0xAA, 0x07, 0xA9, 0x05, 0xEA, 0x12, 0x98, ++0xD8, 0xE0, 0xF5, 0x75, 0x54, 0x7F, 0xF5, 0x77, ++0x75, 0xF0, 0x12, 0xEA, 0x12, 0xAF, 0xEA, 0xE0, ++0x90, 0x95, 0xDF, 0xF0, 0x75, 0xF0, 0x12, 0xEA, ++0x12, 0x9F, 0xF9, 0xFF, 0xEA, 0x12, 0x98, 0x3C, ++0xE0, 0x54, 0x03, 0xF5, 0x76, 0xE5, 0x77, 0x90, ++0x81, 0x9D, 0x93, 0xFD, 0xEA, 0x25, 0xE0, 0x24, ++0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, ++0xE4, 0xF0, 0xA3, 0xED, 0xF0, 0x75, 0xF0, 0x12, ++0xEA, 0x12, 0x9E, 0xA1, 0xFE, 0xC4, 0x54, 0x03, ++0x90, 0x95, 0xDE, 0xF0, 0x74, 0xC6, 0x2A, 0x11, ++0xBF, 0xE5, 0x77, 0xF0, 0x74, 0x46, 0x2A, 0x71, ++0x81, 0xE5, 0x76, 0xF0, 0xE5, 0x77, 0xD3, 0x9F, ++0x40, 0x04, 0x8F, 0x77, 0x8F, 0x75, 0x89, 0x78, ++0xE4, 0xFF, 0xEF, 0xC3, 0x95, 0x78, 0x50, 0x34, ++0xE5, 0x75, 0x30, 0xE7, 0x09, 0x85, 0x77, 0x75, ++0x19, 0xE9, 0x70, 0x25, 0x80, 0x26, 0x90, 0x95, ++0xDF, 0xE0, 0xFD, 0xE5, 0x77, 0xD3, 0x9D, 0x40, ++0x10, 0xAB, 0x02, 0x90, 0x95, 0xE3, 0xE9, 0xF0, ++0xAF, 0x77, 0x12, 0xCE, 0xEC, 0x8F, 0x75, 0x80, ++0x0B, 0x90, 0x95, 0xDF, 0xE0, 0xF5, 0x75, 0x80, ++0x03, 0x0F, 0x80, 0xC6, 0xAF, 0x02, 0x90, 0x92, ++0x80, 0xE5, 0x76, 0xF0, 0xE4, 0xFB, 0xAD, 0x75, ++0x02, 0x75, 0x80, 0x74, 0xC6, 0x25, 0x75, 0xF5, ++0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x8F, ++0x75, 0x8D, 0x76, 0xEF, 0x12, 0x98, 0xD8, 0xE0, ++0xFD, 0x54, 0x7F, 0xF5, 0x77, 0xED, 0x54, 0x80, ++0xF5, 0x78, 0x12, 0x9F, 0xF5, 0xF5, 0x7A, 0x75, ++0xF0, 0x12, 0xEF, 0x12, 0x9E, 0xA1, 0xC4, 0x54, ++0x03, 0xF5, 0x7B, 0x31, 0x82, 0x74, 0xFF, 0xF0, ++0x31, 0x9B, 0xE5, 0x78, 0x4D, 0xFF, 0x11, 0xBB, ++0xEF, 0xF0, 0xE5, 0x75, 0x12, 0x98, 0x3C, 0xE0, ++0x54, 0x03, 0xF5, 0x79, 0x74, 0x46, 0x25, 0x75, ++0x71, 0x81, 0xE5, 0x79, 0xF0, 0xE5, 0x77, 0x65, ++0x7A, 0x70, 0x21, 0x75, 0xF0, 0x12, 0xE5, 0x75, ++0x31, 0x93, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, ++0x0B, 0xE5, 0x78, 0x70, 0x07, 0xE5, 0x77, 0x44, ++0x80, 0xFD, 0x80, 0x49, 0x31, 0x9B, 0x7D, 0x07, ++0xAF, 0x75, 0x21, 0xC6, 0xE5, 0x77, 0xC3, 0x95, ++0x7A, 0x50, 0x34, 0xAB, 0x75, 0xAD, 0x7A, 0xAF, ++0x77, 0x12, 0x72, 0x7F, 0xAD, 0x07, 0xE5, 0x77, ++0xC3, 0x94, 0x0C, 0x40, 0x28, 0x75, 0xF0, 0x12, ++0xE5, 0x75, 0x31, 0x93, 0xFE, 0xC4, 0x13, 0x54, ++0x07, 0x30, 0xE0, 0x19, 0xE5, 0x76, 0x60, 0x15, ++0xE5, 0x78, 0x70, 0x11, 0xE5, 0x77, 0x44, 0x80, ++0xFD, 0x31, 0x82, 0xEF, 0xF0, 0x80, 0x06, 0x11, ++0xBB, 0xE5, 0x7A, 0xF0, 0xFD, 0x90, 0x92, 0x80, ++0xE5, 0x79, 0xF0, 0xAB, 0x76, 0xAF, 0x75, 0x02, ++0x75, 0x80, 0x74, 0x5B, 0x25, 0x75, 0xF5, 0x82, ++0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0xFF, 0x75, ++0xF0, 0x12, 0xED, 0x90, 0x89, 0x51, 0x12, 0x04, ++0x6E, 0xE0, 0x22, 0xE5, 0x77, 0x25, 0xE0, 0x24, ++0x75, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, ++0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE5, ++0x75, 0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, ++0x34, 0x8D, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, ++0xF0, 0x22, 0x7D, 0x07, 0xAF, 0x67, 0xED, 0x30, ++0xE0, 0x0D, 0x12, 0xD2, 0x11, 0x90, 0x89, 0x5F, ++0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, ++0x30, 0xE1, 0x0B, 0x75, 0xF0, 0x12, 0xEF, 0x12, ++0xD5, 0xB2, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, 0x30, ++0xE2, 0x09, 0x75, 0xF0, 0x12, 0xEF, 0x12, 0xD2, ++0x4E, 0xE4, 0xF0, 0x12, 0xD2, 0x61, 0xEE, 0xF0, ++0x22, 0x90, 0x96, 0xC4, 0x12, 0x86, 0x42, 0x90, ++0x96, 0xC4, 0x12, 0x93, 0xCA, 0x54, 0x7F, 0xFD, ++0x12, 0x87, 0xAE, 0xFE, 0x54, 0x1F, 0x90, 0x96, ++0xC8, 0xF0, 0xEE, 0x54, 0x80, 0x71, 0x5C, 0x90, ++0x96, 0xC7, 0xF0, 0x12, 0x87, 0xB9, 0xFE, 0x54, ++0x03, 0xFC, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, ++0x90, 0x96, 0xCA, 0xF0, 0x12, 0x87, 0xB9, 0xFE, ++0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, ++0x96, 0xC9, 0xF0, 0xEE, 0x54, 0x80, 0x71, 0x5C, ++0xFF, 0x12, 0x87, 0xB9, 0xFB, 0x54, 0x08, 0x13, ++0x13, 0x13, 0x54, 0x1F, 0x90, 0x96, 0xCC, 0xF0, ++0xFA, 0xEB, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, ++0xA3, 0xF0, 0xEF, 0x54, 0x01, 0xC4, 0x33, 0x33, ++0x33, 0x54, 0x80, 0x12, 0x9E, 0x9C, 0x54, 0x7F, ++0x4F, 0xF0, 0x90, 0x96, 0xC9, 0xE0, 0x71, 0x79, ++0x12, 0x9E, 0x9C, 0x54, 0xBF, 0x4F, 0xF0, 0xEA, ++0x60, 0x02, 0x61, 0x5A, 0x90, 0x96, 0xC8, 0xE0, ++0x54, 0x1F, 0x31, 0x8E, 0x54, 0xE0, 0x4F, 0xF0, ++0xEC, 0x54, 0x03, 0x12, 0x9E, 0x9C, 0x54, 0xFC, ++0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x25, 0xE0, 0x25, ++0xE0, 0x12, 0x9E, 0x9C, 0x54, 0xF3, 0x4F, 0xF0, ++0x90, 0x96, 0xC7, 0xE0, 0x54, 0x01, 0xC4, 0x33, ++0x54, 0xE0, 0x31, 0x8E, 0x54, 0xDF, 0x4F, 0xF0, ++0x90, 0x96, 0xCA, 0xE0, 0x54, 0x03, 0xC4, 0x54, ++0xF0, 0x12, 0x9E, 0x9C, 0x54, 0xCF, 0x4F, 0x71, ++0x6D, 0xE0, 0x54, 0xFB, 0x71, 0x6D, 0xC0, 0x83, ++0xC0, 0x82, 0xE0, 0xFF, 0x90, 0x96, 0xCD, 0xE0, ++0x12, 0xC7, 0x6C, 0xD0, 0x82, 0xD0, 0x83, 0xF0, ++0x90, 0x93, 0xED, 0xE0, 0x60, 0x3B, 0x90, 0x96, ++0xC4, 0x12, 0x86, 0x39, 0xE9, 0x24, 0x03, 0xF9, ++0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x54, 0x1F, ++0x12, 0x02, 0x4C, 0x90, 0x96, 0xCB, 0x74, 0x01, ++0xF0, 0x90, 0x96, 0xCB, 0xE0, 0xFF, 0xC3, 0x94, ++0x04, 0x50, 0x16, 0xEF, 0x71, 0x63, 0x12, 0x86, ++0x39, 0x8F, 0x82, 0x8E, 0x83, 0xE4, 0x12, 0x02, ++0x5E, 0x90, 0x96, 0xCB, 0xE0, 0x04, 0xF0, 0x80, ++0xE0, 0x90, 0x93, 0xEB, 0xE0, 0x54, 0x07, 0xFF, ++0xBF, 0x05, 0x0A, 0xEC, 0xB4, 0x01, 0x06, 0x90, ++0x93, 0xF0, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x96, ++0xCB, 0xF0, 0x90, 0x96, 0xCB, 0xE0, 0xFC, 0x71, ++0x63, 0x12, 0xAA, 0x3F, 0xFF, 0xED, 0x12, 0xCF, ++0x82, 0xE5, 0x82, 0x2C, 0x12, 0xD0, 0x83, 0xEF, ++0xF0, 0x90, 0x96, 0xCB, 0xE0, 0x04, 0xF0, 0xE0, ++0xB4, 0x04, 0xDF, 0xAF, 0x05, 0x90, 0x8A, 0xFF, ++0x71, 0x91, 0x22, 0xE0, 0xC4, 0x13, 0x13, 0x13, ++0x54, 0x01, 0x22, 0x24, 0x03, 0xFF, 0xE4, 0x33, ++0xFE, 0x90, 0x96, 0xC4, 0x22, 0xF0, 0x74, 0xC6, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, ++0x22, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, ++0x22, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, ++0x22, 0x90, 0x96, 0xE0, 0xE0, 0xFF, 0x90, 0x8A, ++0xC7, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, ++0x8C, 0x83, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xE0, 0xEF, ++0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, ++0x04, 0xF0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, ++0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, ++0x90, 0x04, 0x1D, 0xE0, 0x60, 0x41, 0x90, 0x05, ++0x22, 0xE0, 0x90, 0x96, 0xE4, 0xF0, 0x7B, 0x26, ++0x12, 0x92, 0x3D, 0xEF, 0x64, 0x01, 0x70, 0x0B, ++0x91, 0x3D, 0x90, 0x93, 0x58, 0xE0, 0x20, 0xE0, ++0x16, 0x80, 0x0F, 0x12, 0xB4, 0x11, 0x30, 0xE0, ++0x0E, 0x91, 0x3D, 0x90, 0x93, 0x58, 0xE0, 0x20, ++0xE0, 0x05, 0x12, 0xDC, 0xB4, 0xEE, 0xF0, 0x90, ++0x96, 0xE4, 0xE0, 0xFD, 0x7B, 0x27, 0xE4, 0xFF, ++0x12, 0x97, 0x56, 0x71, 0x89, 0x80, 0x10, 0x71, ++0x89, 0x91, 0x3D, 0x90, 0x93, 0x58, 0xE0, 0x20, ++0xE0, 0x05, 0x12, 0xDC, 0xB4, 0xEE, 0xF0, 0x90, ++0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x18, 0x12, 0xB4, ++0x11, 0x30, 0xE0, 0x12, 0x90, 0x05, 0x22, 0xE0, ++0x54, 0x6F, 0xFF, 0x90, 0x8A, 0xF9, 0x12, 0xB3, ++0xEA, 0x7D, 0x28, 0x12, 0x04, 0x7E, 0xF1, 0xE8, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x86, 0xB6, ++0xE0, 0xFF, 0x90, 0x96, 0xE1, 0xE0, 0xFB, 0x90, ++0x92, 0x13, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, ++0x66, 0xDB, 0x90, 0x96, 0xE2, 0xEE, 0xF0, 0xFC, ++0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x96, 0xE0, 0xE0, ++0xFF, 0x90, 0x8A, 0x95, 0xE0, 0xFA, 0xA3, 0xE0, ++0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0x96, 0xCE, 0xEE, 0xF0, 0xA3, 0x12, 0xAF, 0xDE, ++0x90, 0x04, 0x1D, 0xE0, 0x60, 0x2B, 0x90, 0x05, ++0x22, 0xE0, 0x90, 0x96, 0xD4, 0xF0, 0x7B, 0x14, ++0x12, 0x92, 0x3D, 0xEF, 0x64, 0x01, 0x70, 0x07, ++0x12, 0xE6, 0x47, 0x91, 0x5F, 0x80, 0x04, 0x7F, ++0x00, 0x80, 0x15, 0x90, 0x96, 0xD4, 0xE0, 0xFD, ++0x7B, 0x15, 0xE4, 0xFF, 0x12, 0x97, 0x56, 0x80, ++0x05, 0x12, 0xE6, 0x47, 0x91, 0x5F, 0xF1, 0xE8, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x92, 0x43, ++0xEF, 0x70, 0x02, 0xFF, 0x22, 0xF1, 0x93, 0x90, ++0x93, 0xAC, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFF, ++0xC3, 0x13, 0xFE, 0xEF, 0x54, 0xF1, 0xFF, 0xEE, ++0x04, 0x54, 0x07, 0x25, 0xE0, 0x4F, 0xF0, 0xA3, ++0xE0, 0xFF, 0x90, 0x93, 0x58, 0xE0, 0xFE, 0xC3, ++0x13, 0x54, 0x07, 0xB5, 0x07, 0x04, 0xEE, 0x54, ++0xF1, 0xF0, 0xF1, 0x93, 0xF5, 0x7D, 0xE4, 0x90, ++0x93, 0x5A, 0xF0, 0xE5, 0x7D, 0x75, 0xF0, 0x1B, ++0xA4, 0x24, 0x5F, 0xF5, 0x82, 0xE4, 0x34, 0x93, ++0xF5, 0x83, 0xE0, 0x30, 0xE0, 0x26, 0xB1, 0x8A, ++0xE0, 0x24, 0xAF, 0xF5, 0x82, 0xE4, 0x34, 0x93, ++0xF5, 0x83, 0xE0, 0xFF, 0xF1, 0xB9, 0xEF, 0xB1, ++0x89, 0xE0, 0x04, 0xB1, 0x89, 0xE0, 0xFF, 0x90, ++0x93, 0xAE, 0xE0, 0xFE, 0xEF, 0xB5, 0x06, 0x04, ++0xB1, 0x8A, 0xE4, 0xF0, 0xF1, 0xB9, 0xE0, 0xFC, ++0x90, 0x93, 0xAC, 0xE0, 0xF1, 0xBB, 0xE0, 0x6C, ++0x60, 0x13, 0xE5, 0x7D, 0x12, 0xBA, 0xC8, 0x12, ++0xBB, 0xE9, 0x12, 0xB9, 0x6C, 0xE5, 0x7D, 0x12, ++0xBA, 0xC8, 0x12, 0x8D, 0xDB, 0xE5, 0x7D, 0xF1, ++0xD2, 0x54, 0x07, 0xFF, 0x60, 0x03, 0xBF, 0x02, ++0x0E, 0xE5, 0x7D, 0xF1, 0xA4, 0xE0, 0xFF, 0x7E, ++0x00, 0x7B, 0x04, 0xE4, 0xFD, 0x91, 0x70, 0xAD, ++0x7D, 0x7F, 0x01, 0x12, 0xBB, 0x62, 0x90, 0x93, ++0xAD, 0xE0, 0xC3, 0x13, 0x54, 0x03, 0xFF, 0xBF, ++0x02, 0x04, 0xE4, 0xFF, 0xF1, 0xF3, 0x7F, 0x01, ++0x22, 0xF0, 0x74, 0xD2, 0x25, 0x7D, 0xF5, 0x82, ++0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0xE4, 0x90, ++0x96, 0x21, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFF, ++0x20, 0xE0, 0x02, 0xE1, 0x15, 0xF1, 0xCE, 0x54, ++0x07, 0x90, 0x96, 0x1E, 0xF0, 0x60, 0x07, 0xE0, ++0x64, 0x02, 0x60, 0x02, 0xC1, 0xA5, 0x90, 0x93, ++0x5A, 0xE0, 0x70, 0x30, 0x12, 0xE7, 0x06, 0x7B, ++0x4E, 0xF1, 0xE1, 0xF1, 0x9C, 0xE0, 0xFF, 0x7E, ++0x00, 0x7B, 0x04, 0x7D, 0x01, 0x91, 0x70, 0xBF, ++0x01, 0x11, 0x90, 0x93, 0x58, 0xE0, 0xF1, 0x16, ++0xE0, 0x44, 0x01, 0xF0, 0x90, 0x93, 0x5A, 0x74, ++0x01, 0xF0, 0x22, 0x90, 0x96, 0x1F, 0xE0, 0xFD, ++0x7B, 0x4F, 0xC1, 0x7B, 0x90, 0x93, 0x5A, 0xE0, ++0x64, 0x01, 0x60, 0x02, 0xC1, 0x96, 0x90, 0x01, ++0xA2, 0xE0, 0x04, 0xF1, 0x92, 0xFF, 0xF1, 0xD2, ++0xFE, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x02, 0xC1, ++0x94, 0xEF, 0xF1, 0x1A, 0xE0, 0xFF, 0x30, 0xE0, ++0x08, 0x90, 0x96, 0x21, 0x74, 0x01, 0xF0, 0x80, ++0x13, 0xEF, 0xC3, 0x13, 0x20, 0xE0, 0x0D, 0x90, ++0x96, 0x21, 0x74, 0x01, 0xF0, 0x12, 0xE7, 0x06, ++0x7B, 0x50, 0xF1, 0xE1, 0x90, 0x96, 0x21, 0xE0, ++0x60, 0x64, 0x90, 0x93, 0xDF, 0xE0, 0xFF, 0x90, ++0x93, 0xDE, 0xE0, 0x6F, 0x60, 0x42, 0xE0, 0x04, ++0xF0, 0xE0, 0xD3, 0x94, 0x01, 0x40, 0x08, 0x90, ++0x96, 0x22, 0x74, 0x04, 0xF0, 0x80, 0x05, 0xE4, ++0x90, 0x96, 0x22, 0xF0, 0xF1, 0x9C, 0xE0, 0xFF, ++0x7E, 0x00, 0x90, 0x96, 0x22, 0xE0, 0xFB, 0x7D, ++0x01, 0x91, 0x70, 0xBF, 0x01, 0x0E, 0xE4, 0x90, ++0x92, 0x20, 0xF0, 0xA3, 0x74, 0x03, 0x12, 0xDF, ++0xA9, 0x02, 0x66, 0x33, 0x90, 0x96, 0x1F, 0xE0, ++0xFD, 0x7B, 0x51, 0xE4, 0xFF, 0x02, 0x97, 0x56, ++0xE4, 0x90, 0x93, 0xDE, 0xF0, 0xF1, 0xB2, 0x90, ++0x93, 0x58, 0xE0, 0xFF, 0xF1, 0x16, 0xE0, 0x54, ++0xFB, 0xF0, 0x80, 0x02, 0xF1, 0xB2, 0x90, 0x93, ++0x5A, 0xE0, 0x64, 0x05, 0x70, 0x77, 0x91, 0xBD, ++0xEF, 0x70, 0x72, 0x80, 0x6C, 0x90, 0x96, 0x1E, ++0xE0, 0xFF, 0x64, 0x03, 0x60, 0x05, 0xEF, 0x64, ++0x01, 0x70, 0x62, 0x90, 0x93, 0x5A, 0xE0, 0x64, ++0x05, 0x70, 0x5A, 0x90, 0x96, 0x1E, 0xE0, 0x64, ++0x01, 0x70, 0x41, 0x90, 0x96, 0x20, 0x12, 0xDF, ++0x8F, 0xD3, 0x94, 0x1F, 0x90, 0x93, 0x58, 0xE0, ++0x40, 0x10, 0xF1, 0xA1, 0xE0, 0xFF, 0x90, 0x8A, ++0xBF, 0x12, 0xB3, 0xEA, 0x7D, 0x00, 0x7C, 0x7C, ++0x80, 0x1F, 0xF1, 0xA0, 0xE0, 0xFB, 0x90, 0x96, ++0x20, 0x12, 0xDF, 0x8F, 0x7D, 0x00, 0x25, 0xE0, ++0x25, 0xE0, 0xFC, 0xAF, 0x03, 0x90, 0x8A, 0xBF, ++0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xF5, 0x82, 0x8A, ++0x83, 0x12, 0x04, 0x7E, 0xF1, 0x93, 0xFD, 0x7F, ++0x02, 0x12, 0xBB, 0x62, 0x91, 0xBD, 0xEF, 0x70, ++0x04, 0x7F, 0x06, 0xF1, 0xF3, 0x22, 0xC3, 0x13, ++0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x62, ++0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, ++0xE4, 0x90, 0x96, 0x1D, 0xF0, 0x90, 0x93, 0x58, ++0xE0, 0x30, 0xE0, 0x5D, 0xC3, 0x13, 0x54, 0x07, ++0xFF, 0xF1, 0x1A, 0xE0, 0xFE, 0x30, 0xE0, 0x51, ++0xEF, 0xF1, 0x1A, 0xEE, 0x54, 0xFE, 0xF0, 0xEF, ++0xF1, 0x1A, 0x12, 0x8F, 0xDC, 0x30, 0xE0, 0x0D, ++0x90, 0x93, 0x58, 0xE0, 0xFE, 0xF1, 0x16, 0xEF, ++0x54, 0xFB, 0x12, 0xE7, 0x28, 0x90, 0x04, 0xE0, ++0xE0, 0x30, 0xE1, 0x20, 0xF1, 0xB2, 0x90, 0x93, ++0x58, 0xE0, 0xF1, 0x16, 0xE0, 0x44, 0x02, 0xF0, ++0xE4, 0x90, 0x93, 0xDE, 0xF1, 0x92, 0xFD, 0x7F, ++0x02, 0x12, 0xBB, 0x62, 0x90, 0x96, 0x1D, 0xE0, ++0x60, 0x0F, 0xA1, 0x96, 0x90, 0x93, 0x58, 0xE0, ++0xF1, 0x16, 0xE0, 0x54, 0xFD, 0xF0, 0x12, 0x97, ++0x51, 0x22, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xC3, ++0x13, 0x54, 0x07, 0x22, 0x90, 0x93, 0x58, 0xE0, ++0xC3, 0x13, 0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, ++0x24, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, ++0x83, 0x22, 0x90, 0x93, 0x5A, 0x74, 0x05, 0xF0, ++0x22, 0xE5, 0x7D, 0x75, 0xF0, 0x1B, 0xA4, 0x24, ++0x5B, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, ++0x22, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xC3, 0x13, ++0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5E, ++0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, ++0x22, 0x7D, 0x6F, 0xE4, 0xFF, 0x02, 0x97, 0x56, ++0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, ++0x22, 0x80, 0xBF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0xAD, 0x07, 0x90, 0x05, 0x63, 0xE0, ++0xFE, 0x90, 0x05, 0x62, 0xE0, 0x7A, 0x00, 0x24, ++0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x96, 0x46, 0xF0, ++0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0xFE, ++0x90, 0x05, 0x60, 0xE0, 0x24, 0x00, 0xFF, 0xEA, ++0x3E, 0xFE, 0xED, 0xB4, 0x08, 0x0A, 0x90, 0x05, ++0x58, 0xE0, 0xFC, 0x2F, 0xFF, 0xEA, 0x3E, 0xFE, ++0x90, 0x96, 0x23, 0x74, 0x17, 0xF0, 0x90, 0x96, ++0x45, 0x74, 0x06, 0xF0, 0x90, 0x96, 0x25, 0xED, ++0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFD, 0xC3, 0x13, ++0x54, 0x07, 0x12, 0xA7, 0xBB, 0xE0, 0x90, 0x96, ++0x26, 0xF0, 0xA3, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, ++0x90, 0x96, 0x46, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, ++0x96, 0x29, 0xF0, 0xEE, 0xA3, 0xF0, 0x7B, 0x01, ++0x7A, 0x96, 0x79, 0x23, 0x12, 0x96, 0x35, 0x7F, ++0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xF1, 0x9A, 0x90, 0x04, 0x24, 0xE0, 0xFF, ++0xE4, 0xFE, 0x11, 0x96, 0x8E, 0x82, 0x11, 0xB3, ++0x2F, 0xFD, 0xEE, 0x12, 0xA7, 0xA4, 0xED, 0xF0, ++0x0E, 0xEE, 0xB4, 0x03, 0xED, 0x22, 0x90, 0x95, ++0x53, 0x02, 0x86, 0x39, 0x90, 0x96, 0x14, 0x12, ++0x86, 0x39, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x12, ++0x02, 0x1F, 0xFE, 0x90, 0x96, 0x11, 0x12, 0x86, ++0x39, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x02, 0x02, ++0x1F, 0x71, 0x4F, 0xFF, 0x11, 0x9C, 0x6E, 0x60, ++0x03, 0x7F, 0x00, 0x22, 0x0F, 0xEF, 0xB4, 0x08, ++0xF3, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x96, 0x10, ++0xF0, 0x90, 0x93, 0x03, 0xE0, 0xFF, 0xC3, 0x13, ++0x20, 0xE0, 0x70, 0x31, 0x85, 0x31, 0x96, 0xEF, ++0x60, 0x0D, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x13, ++0x31, 0x8B, 0x11, 0xB9, 0xEF, 0x60, 0x54, 0x31, ++0x85, 0x31, 0x96, 0xEF, 0x60, 0x17, 0x7B, 0x01, ++0x7A, 0x93, 0x79, 0x13, 0x31, 0x8B, 0x11, 0xB9, ++0xEF, 0x60, 0x0A, 0x7B, 0x01, 0x7A, 0x93, 0x79, ++0x1C, 0x71, 0x62, 0x70, 0x36, 0x7B, 0x01, 0x7A, ++0x93, 0x79, 0x20, 0x90, 0x96, 0x14, 0x12, 0x86, ++0x42, 0x7A, 0x93, 0x79, 0x06, 0x31, 0x96, 0xEF, ++0x60, 0x10, 0x31, 0xD0, 0x31, 0x8B, 0x31, 0x96, ++0xEF, 0x60, 0x07, 0x31, 0x85, 0x31, 0xD7, 0xEF, ++0x70, 0x11, 0x31, 0x85, 0x11, 0xB9, 0xEF, 0x60, ++0x29, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x0F, 0x71, ++0x62, 0x60, 0x1F, 0x90, 0x96, 0x10, 0x74, 0x01, ++0xF0, 0x80, 0x17, 0x31, 0xD0, 0x31, 0x8B, 0x31, ++0x96, 0xEF, 0x60, 0x0E, 0x31, 0xD0, 0x31, 0x8B, ++0x31, 0xD7, 0xEF, 0x70, 0x05, 0x90, 0x96, 0x10, ++0x04, 0xF0, 0x90, 0x96, 0x10, 0xE0, 0xFF, 0x90, ++0x05, 0x18, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x90, ++0x05, 0xB3, 0x60, 0x0C, 0xE0, 0x44, 0x80, 0xF0, ++0x90, 0x24, 0xA0, 0xE0, 0x44, 0x01, 0xF0, 0x22, ++0xE0, 0x44, 0x20, 0xF0, 0x22, 0x7B, 0x01, 0x7A, ++0x93, 0x79, 0x06, 0x90, 0x96, 0x14, 0x12, 0x86, ++0x42, 0x7A, 0x93, 0x79, 0x20, 0x22, 0x71, 0x4F, ++0x90, 0x96, 0x17, 0xF0, 0x90, 0x96, 0x17, 0xE0, ++0xFF, 0xC3, 0x94, 0x08, 0x50, 0x27, 0x71, 0x70, ++0x91, 0x3D, 0x51, 0x37, 0xC3, 0x9D, 0x50, 0x03, ++0x7F, 0x00, 0x22, 0x90, 0x96, 0x17, 0xE0, 0xFF, ++0x71, 0x70, 0x91, 0x3D, 0x51, 0x37, 0xD3, 0x9D, ++0x40, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x96, 0x17, ++0xE0, 0x04, 0xF0, 0x80, 0xCF, 0x7F, 0x00, 0x22, ++0x7B, 0x01, 0x7A, 0x93, 0x79, 0x2D, 0x22, 0x71, ++0x4F, 0xFF, 0x11, 0x9C, 0x6E, 0x60, 0x03, 0x7F, ++0x00, 0x22, 0x0F, 0xEF, 0xB4, 0x06, 0xF3, 0x7F, ++0x01, 0x22, 0x71, 0x4F, 0x90, 0x96, 0x17, 0xF0, ++0x90, 0x96, 0x17, 0xE0, 0xFF, 0xC3, 0x94, 0x04, ++0x50, 0x1F, 0x51, 0x1C, 0xC3, 0x9D, 0x50, 0x03, ++0x7F, 0x00, 0x22, 0x90, 0x96, 0x17, 0xE0, 0xFF, ++0x51, 0x1C, 0xD3, 0x9D, 0x40, 0x03, 0x7F, 0x01, ++0x22, 0x90, 0x96, 0x17, 0xE0, 0x04, 0xF0, 0x80, ++0xD7, 0x7F, 0x00, 0x22, 0x7E, 0x00, 0xC3, 0x74, ++0x03, 0x9F, 0xFD, 0xE4, 0x9E, 0xFC, 0x90, 0x96, ++0x14, 0x12, 0x86, 0x39, 0x8D, 0x82, 0x8C, 0x83, ++0x12, 0x02, 0x1F, 0xFD, 0xC3, 0x74, 0x03, 0x9F, ++0xFF, 0xE4, 0x9E, 0xFE, 0x90, 0x96, 0x11, 0x12, ++0x86, 0x39, 0x8F, 0x82, 0x8E, 0x83, 0x02, 0x02, ++0x1F, 0xE4, 0x90, 0x96, 0x14, 0xF0, 0xEF, 0x75, ++0xF0, 0x40, 0xA4, 0x24, 0x80, 0xF9, 0x74, 0x82, ++0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x90, 0x96, 0x10, ++0xF1, 0x42, 0x90, 0x96, 0x13, 0xF0, 0xA3, 0x74, ++0x1C, 0xF0, 0x90, 0x96, 0x13, 0xE0, 0xFF, 0xA3, ++0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0x61, 0x4E, ++0x90, 0x96, 0x10, 0x12, 0x86, 0x39, 0x8E, 0x82, ++0x11, 0xB3, 0x90, 0x96, 0x15, 0xF0, 0xEE, 0xFD, ++0x7C, 0x00, 0xF5, 0x82, 0x8C, 0x83, 0xA3, 0xA3, ++0x12, 0x02, 0x1F, 0xFE, 0x8D, 0x82, 0x8C, 0x83, ++0xA3, 0x12, 0x02, 0x1F, 0xFD, 0xED, 0xFF, 0x90, ++0x96, 0x16, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, ++0x96, 0x15, 0xE0, 0x64, 0x01, 0x60, 0x0E, 0xA3, ++0xA3, 0xE0, 0x24, 0x03, 0xFF, 0x90, 0x96, 0x14, ++0xE0, 0x2F, 0xF0, 0x80, 0xAD, 0xE4, 0x90, 0x96, ++0x18, 0xF0, 0x90, 0x96, 0x18, 0xE0, 0xFF, 0xC3, ++0x94, 0x08, 0x50, 0x1A, 0x90, 0x96, 0x14, 0xE0, ++0x24, 0x03, 0x91, 0x5A, 0x51, 0x3F, 0xFF, 0x90, ++0x96, 0x18, 0xE0, 0x24, 0x20, 0xF5, 0x82, 0xE4, ++0x34, 0x93, 0x71, 0x57, 0x80, 0xDC, 0x90, 0x96, ++0x14, 0xE0, 0x24, 0x0B, 0xFF, 0xE4, 0x33, 0xFE, ++0x90, 0x96, 0x10, 0x51, 0x3F, 0x90, 0x93, 0x28, ++0xF0, 0x70, 0x2A, 0x90, 0x96, 0x18, 0xF0, 0x90, ++0x96, 0x18, 0xE0, 0xFF, 0x24, 0x10, 0xFD, 0xE4, ++0x33, 0xFC, 0x90, 0x96, 0x10, 0x71, 0x7D, 0x12, ++0x02, 0x1F, 0xFE, 0x74, 0x29, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEE, 0x71, 0x5A, ++0xE0, 0xB4, 0x04, 0xDB, 0x22, 0xE4, 0x90, 0x96, ++0x18, 0xF0, 0x90, 0x96, 0x18, 0xE0, 0xFF, 0xC3, ++0x94, 0x04, 0x50, 0x1A, 0x90, 0x96, 0x14, 0xE0, ++0x24, 0x0C, 0x91, 0x5A, 0x51, 0x3F, 0xFF, 0x90, ++0x96, 0x18, 0xE0, 0x24, 0x29, 0xF5, 0x82, 0xE4, ++0x34, 0x93, 0x71, 0x57, 0x80, 0xDC, 0x22, 0x90, ++0x96, 0x11, 0x12, 0x86, 0x42, 0xE4, 0x22, 0xF5, ++0x83, 0xEF, 0xF0, 0x90, 0x96, 0x18, 0xE0, 0x04, ++0xF0, 0x22, 0x90, 0x96, 0x14, 0x12, 0x86, 0x42, ++0x7A, 0x93, 0x79, 0x29, 0x31, 0xEA, 0xEF, 0x22, ++0x7E, 0x00, 0xC3, 0x74, 0x07, 0x9F, 0xFD, 0xE4, ++0x9E, 0xFC, 0x90, 0x96, 0x14, 0x12, 0x86, 0x39, ++0x8D, 0x82, 0x8C, 0x83, 0x22, 0xEF, 0x70, 0x05, ++0x90, 0x93, 0x05, 0x80, 0x03, 0x90, 0x93, 0x04, ++0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, 0x95, 0xEB, ++0xEF, 0xF0, 0x90, 0x95, 0xEB, 0xE0, 0x24, 0x38, ++0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xA3, ++0x12, 0x86, 0x42, 0xE4, 0xFF, 0x74, 0x08, 0x2F, ++0xF1, 0x37, 0xE0, 0xFE, 0x91, 0x30, 0x8F, 0x82, ++0x75, 0x83, 0x00, 0x91, 0x36, 0xB4, 0x06, 0xED, ++0x90, 0x95, 0xEB, 0xE0, 0x24, 0x52, 0xF9, 0xE4, ++0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xA3, 0xF1, 0x42, ++0x70, 0x5D, 0x90, 0x95, 0xEC, 0x12, 0x87, 0xAC, ++0x64, 0x02, 0x70, 0x53, 0x90, 0x24, 0x87, 0xE0, ++0x90, 0x00, 0x03, 0x12, 0x02, 0x5E, 0x90, 0x24, ++0x86, 0xE0, 0x90, 0x00, 0x04, 0x12, 0x02, 0x5E, ++0x91, 0x30, 0x12, 0x87, 0x62, 0x64, 0x01, 0x70, ++0x36, 0x12, 0x87, 0x69, 0x64, 0x0D, 0x70, 0x2F, ++0xFF, 0x74, 0x88, 0x91, 0x4F, 0xEF, 0x24, 0x08, ++0x91, 0x45, 0x71, 0x7D, 0x91, 0x36, 0xB4, 0x08, ++0xF0, 0x90, 0x05, 0xDC, 0xE0, 0xFF, 0x91, 0x30, ++0x90, 0x00, 0x10, 0xEF, 0x12, 0x02, 0x5E, 0xE4, ++0xFF, 0x91, 0x4D, 0xEF, 0x24, 0x11, 0x91, 0x45, ++0x71, 0x7D, 0x91, 0x36, 0xB4, 0x04, 0xF2, 0x22, ++0x90, 0x95, 0xEC, 0x02, 0x86, 0x39, 0xEE, 0x12, ++0x02, 0x5E, 0x0F, 0xEF, 0x22, 0x12, 0x02, 0x1F, ++0xFD, 0xC3, 0x74, 0x07, 0x22, 0xFD, 0xE4, 0x33, ++0xFC, 0x90, 0x95, 0xEC, 0x22, 0x74, 0x90, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x24, 0xF5, 0x83, 0xE0, ++0xFE, 0x22, 0xFD, 0xE4, 0x33, 0xFC, 0x7E, 0x00, ++0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0x90, 0x96, ++0x10, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, ++0x1F, 0xE4, 0xFF, 0x12, 0xD4, 0x6F, 0xE4, 0xFF, ++0x71, 0x85, 0x7F, 0x01, 0x71, 0x85, 0x90, 0x93, ++0x03, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, ++0x07, 0x90, 0x04, 0x1F, 0xE0, 0x44, 0x80, 0xF0, ++0x22, 0xE4, 0xFF, 0x74, 0x94, 0x91, 0x4F, 0x74, ++0x13, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xB1, ++0x97, 0xB4, 0x08, 0xEF, 0xE4, 0xFF, 0x74, 0x9C, ++0x91, 0x4F, 0x74, 0x1C, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0x93, 0xB1, 0x97, 0xB4, 0x04, 0xEF, 0x22, ++0xE4, 0x90, 0x95, 0xEC, 0xF0, 0x12, 0xE4, 0x24, ++0xB1, 0x9E, 0xB1, 0x6A, 0x91, 0x91, 0x90, 0x07, ++0xE3, 0xF1, 0xA0, 0x60, 0x59, 0xE4, 0x90, 0x95, ++0xED, 0xF0, 0x90, 0x96, 0x0F, 0x74, 0x08, 0xF0, ++0x90, 0x05, 0x68, 0xE0, 0x90, 0x95, 0xEF, 0xF0, ++0x90, 0x05, 0x69, 0xE0, 0x90, 0x95, 0xF0, 0xF0, ++0x90, 0x05, 0x6A, 0xE0, 0x90, 0x95, 0xF1, 0xF0, ++0x90, 0x05, 0x6B, 0xE0, 0x90, 0x95, 0xF2, 0xF0, ++0x90, 0x05, 0x78, 0xE0, 0x90, 0x95, 0xF3, 0xF0, ++0x90, 0x05, 0x79, 0xE0, 0x90, 0x95, 0xF4, 0xF0, ++0x90, 0x05, 0x7A, 0xE0, 0x90, 0x95, 0xF5, 0xF0, ++0x90, 0x05, 0x7B, 0xE0, 0x90, 0x95, 0xF6, 0xF0, ++0x7B, 0x01, 0x7A, 0x95, 0x79, 0xED, 0x12, 0x96, ++0x35, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x95, ++0xEB, 0xE0, 0xFD, 0x60, 0x3C, 0xA3, 0xE0, 0x12, ++0xCA, 0x6A, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, ++0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x60, 0xE6, ++0x90, 0x95, 0xEC, 0xE0, 0xFB, 0x74, 0x01, 0xA8, ++0x03, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, ++0xFE, 0xF4, 0xFD, 0x90, 0x95, 0xEB, 0xE0, 0x5D, ++0xF0, 0x90, 0x07, 0xE3, 0xE0, 0x4E, 0xF0, 0xAF, ++0x03, 0x51, 0x49, 0x11, 0xCC, 0xF1, 0x30, 0x80, ++0xBD, 0x22, 0xE4, 0xFF, 0x74, 0x88, 0x91, 0x4F, ++0x74, 0x06, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, ++0xB1, 0x97, 0xB4, 0x08, 0xEF, 0x90, 0x05, 0xDC, ++0xE0, 0x90, 0x93, 0x0E, 0xF0, 0xE4, 0xFF, 0x91, ++0x4D, 0x74, 0x0F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x93, 0xB1, 0x97, 0xB4, 0x04, 0xF1, 0x22, 0xF5, ++0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0x22, 0xE4, 0xFF, ++0x74, 0x80, 0x91, 0x4F, 0x74, 0x2D, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0x93, 0xB1, 0x97, 0xB4, 0x08, ++0xEF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x96, 0xB8, 0xF1, 0xDE, 0x12, 0xDC, ++0xF5, 0xE0, 0x90, 0x96, 0xC3, 0xF0, 0xE4, 0x90, ++0x96, 0xC0, 0xF0, 0x90, 0x96, 0xB8, 0x12, 0xB3, ++0xBE, 0x90, 0x96, 0xBB, 0xF0, 0xEF, 0x54, 0x07, ++0x90, 0x96, 0xBD, 0xD1, 0xF6, 0xE0, 0x90, 0x96, ++0xBE, 0xF0, 0x12, 0x9F, 0xF5, 0x54, 0x7F, 0x90, ++0x96, 0xC1, 0xF0, 0x90, 0x96, 0xB8, 0xE0, 0xF1, ++0xE7, 0xE0, 0x90, 0x96, 0xC2, 0xF0, 0xED, 0x54, ++0x7F, 0x90, 0x96, 0xBC, 0xF0, 0xEB, 0x70, 0x21, ++0x90, 0x89, 0x3D, 0xF1, 0x10, 0xFF, 0x12, 0xE6, ++0xCA, 0xFD, 0x90, 0x89, 0x40, 0x11, 0xAE, 0x2D, ++0xFF, 0xE4, 0x35, 0xF0, 0xC3, 0x13, 0xFE, 0xEF, ++0x13, 0xFF, 0x90, 0x96, 0xB8, 0xE0, 0x12, 0xA1, ++0xB1, 0x90, 0x96, 0xC1, 0xE0, 0xFF, 0x90, 0x96, ++0xBC, 0xE0, 0xFE, 0xD3, 0x9F, 0x40, 0x0C, 0x90, ++0x96, 0xB9, 0xE0, 0x54, 0x80, 0xFD, 0xEF, 0x4D, ++0xF0, 0x80, 0x0F, 0x90, 0x96, 0xC2, 0xE0, 0xFF, ++0xEE, 0xC3, 0x9F, 0x50, 0x05, 0x90, 0x96, 0xB9, ++0xEF, 0xF0, 0x90, 0x96, 0xB9, 0xE0, 0xFE, 0x54, ++0x7F, 0x90, 0x96, 0xBC, 0xF0, 0xEE, 0x54, 0x80, ++0x90, 0x96, 0xBF, 0xF0, 0x90, 0x96, 0xBA, 0xE0, ++0x70, 0x1F, 0xA3, 0xF1, 0x18, 0xC0, 0x83, 0xC0, ++0x82, 0xF1, 0x23, 0x80, 0x02, 0xC3, 0x33, 0xD8, ++0xFC, 0xF4, 0x5F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, ++0x90, 0x96, 0xBE, 0xE0, 0x54, 0x7F, 0xF0, 0x80, ++0x36, 0x90, 0x96, 0xBB, 0xF1, 0x18, 0xC0, 0x83, ++0xC0, 0x82, 0xF1, 0x23, 0x80, 0x02, 0xC3, 0x33, ++0xD8, 0xFC, 0x4F, 0xD0, 0x82, 0xD0, 0x83, 0xD1, ++0xF6, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x96, 0xBE, ++0xF0, 0x90, 0x89, 0x46, 0xF1, 0x10, 0xF5, 0x82, ++0x11, 0xB3, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x4F, ++0x90, 0x96, 0xBE, 0xF0, 0x44, 0x80, 0xF0, 0x90, ++0x96, 0xB9, 0xF1, 0x08, 0x12, 0x98, 0xD8, 0xEF, ++0xF0, 0xEE, 0x70, 0x05, 0x90, 0x01, 0xC8, 0xEF, ++0xF0, 0x90, 0x96, 0xBE, 0xF1, 0x08, 0xD1, 0xFB, ++0xEF, 0xF0, 0xEE, 0x12, 0x98, 0x3C, 0xE0, 0x54, ++0xFC, 0xFF, 0x90, 0x96, 0xC3, 0xE0, 0x54, 0x03, ++0x4F, 0xFE, 0x90, 0x96, 0xB8, 0xE0, 0xFF, 0x12, ++0x98, 0x3C, 0xEE, 0xF0, 0x7D, 0x01, 0x12, 0xD1, ++0xEE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, ++0x96, 0xB8, 0xE0, 0xC4, 0x54, 0xF0, 0x24, 0x01, ++0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, ++0xE0, 0xFF, 0x90, 0x96, 0xB8, 0xE0, 0xFE, 0x22, ++0x12, 0x86, 0x39, 0x90, 0x96, 0xBC, 0xE0, 0x22, ++0xE0, 0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, 0x8D, ++0xF5, 0x83, 0x22, 0xE0, 0xFF, 0x90, 0x96, 0xBD, ++0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, ++0x90, 0x95, 0xEC, 0xE0, 0x04, 0xF0, 0x22, 0xF5, ++0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0x22, 0x90, ++0x95, 0x53, 0x12, 0x86, 0x42, 0x02, 0x02, 0x06, ++0xE6, 0xFD, 0xAF, 0x67, 0xEF, 0xD1, 0xFB, 0xE0, ++0x54, 0xF8, 0xF5, 0x75, 0xED, 0x42, 0x75, 0xEF, ++0xD1, 0xFB, 0xE5, 0x75, 0xF0, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, ++0x06, 0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, ++0x06, 0x7E, 0xFF, 0x7F, 0xFF, 0x80, 0x1E, 0x12, ++0xE3, 0x12, 0xF1, 0xA7, 0x90, 0x07, 0xC3, 0xE0, ++0x30, 0xE5, 0xF9, 0xED, 0x54, 0x03, 0xFD, 0x24, ++0xC9, 0xF1, 0x37, 0xE0, 0xFE, 0x74, 0xC8, 0x2D, ++0xF1, 0x37, 0xF1, 0xD5, 0xFE, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0x95, 0x53, 0x02, 0x86, 0x42, ++0xE0, 0x90, 0x95, 0xEB, 0xF0, 0xE0, 0x22, 0x90, ++0x07, 0xC0, 0x74, 0x80, 0xF0, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, ++0x06, 0xEF, 0x12, 0xE3, 0x5F, 0xF0, 0xF1, 0xA7, ++0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, ++0x54, 0x03, 0x24, 0xC8, 0xF1, 0x37, 0xE0, 0xFF, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0x7C, 0x00, ++0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0xEF, 0xF0, ++0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x22, 0x75, ++0xF0, 0x12, 0x90, 0x89, 0x50, 0x02, 0x04, 0x6E, ++0x12, 0xB7, 0xDD, 0x12, 0x02, 0x06, 0xFF, 0x54, ++0x0F, 0xF5, 0x64, 0xEF, 0xC4, 0x54, 0x0F, 0x64, ++0x0F, 0x70, 0x41, 0x90, 0x93, 0x58, 0xE0, 0x54, ++0xFE, 0xFF, 0xF0, 0xE5, 0x64, 0x54, 0x07, 0x25, ++0xE0, 0xFE, 0xEF, 0x54, 0xF1, 0x4E, 0x12, 0x87, ++0x72, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, 0xDF, ++0x20, 0xE0, 0x05, 0x74, 0x06, 0xF0, 0x80, 0x03, ++0x74, 0x01, 0xF0, 0x7D, 0x20, 0xE4, 0xFF, 0x12, ++0x7C, 0x3B, 0xAF, 0x64, 0x12, 0xBA, 0x6C, 0xBF, ++0x01, 0x06, 0xE4, 0xFD, 0xFF, 0x12, 0xBB, 0x62, ++0x7F, 0x02, 0x01, 0xEA, 0xE5, 0x64, 0x75, 0xF0, ++0x1B, 0xA4, 0x24, 0x5B, 0xF9, 0x74, 0x93, 0x35, ++0xF0, 0xFA, 0x7B, 0x01, 0xC0, 0x02, 0xC0, 0x01, ++0xE5, 0x63, 0x24, 0x01, 0xF9, 0xE4, 0x35, 0x62, ++0x85, 0x61, 0x45, 0x12, 0xE7, 0x57, 0xD0, 0x01, ++0xD0, 0x02, 0x12, 0x69, 0xF5, 0xE5, 0x64, 0x12, ++0xA7, 0xD2, 0x54, 0xF7, 0x11, 0xEE, 0xC4, 0x54, ++0x0F, 0x14, 0x65, 0x64, 0x70, 0x6F, 0x90, 0x88, ++0x36, 0xE0, 0x70, 0x07, 0x90, 0x88, 0x2C, 0xE0, ++0x30, 0xE0, 0x04, 0x7F, 0x05, 0x80, 0x5B, 0x11, ++0xEF, 0xC4, 0x54, 0x0F, 0x90, 0x93, 0x59, 0x12, ++0x87, 0x68, 0xFC, 0x54, 0x0F, 0xC4, 0x54, 0xF0, ++0xFE, 0x90, 0x93, 0x58, 0xE0, 0x54, 0x0F, 0x4E, ++0xF0, 0xEC, 0x54, 0x60, 0xC4, 0x54, 0x0F, 0xFF, ++0x90, 0x93, 0xAD, 0xE0, 0x54, 0xF9, 0x4F, 0xF0, ++0x90, 0x93, 0x58, 0xE0, 0x54, 0xF1, 0xF0, 0x90, ++0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, 0x93, 0xD5, ++0xE0, 0x90, 0x93, 0xD9, 0x30, 0xE0, 0x0B, 0xE0, ++0x54, 0xFE, 0xF0, 0x54, 0xC1, 0x44, 0x02, 0xF0, ++0x80, 0x07, 0xE0, 0x44, 0x01, 0xF0, 0x54, 0xC1, ++0xF0, 0x90, 0x93, 0x58, 0xE0, 0x44, 0x01, 0xF0, ++0x7F, 0x03, 0x12, 0xA7, 0xF3, 0x22, 0xF0, 0xAB, ++0x61, 0xAA, 0x62, 0xA9, 0x63, 0x02, 0x02, 0x06, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, ++0xDD, 0x90, 0x05, 0x27, 0xE0, 0xF5, 0x64, 0x8B, ++0x45, 0x8A, 0x46, 0x89, 0x47, 0x75, 0x48, 0x01, ++0x7B, 0x01, 0x7A, 0x88, 0x79, 0x2C, 0x12, 0x69, ++0xF5, 0x11, 0xEF, 0xFF, 0xC3, 0x13, 0x20, 0xE0, ++0x02, 0x21, 0xAB, 0x90, 0x88, 0x2C, 0xE0, 0x30, ++0xE0, 0x70, 0x71, 0x83, 0x75, 0x64, 0x21, 0x71, ++0xB2, 0x30, 0xE0, 0x04, 0x71, 0xD2, 0x80, 0x0D, ++0xE4, 0x90, 0x88, 0x2D, 0xF0, 0xA3, 0xF0, 0x7D, ++0x40, 0xFF, 0x12, 0x7C, 0x7E, 0x90, 0x88, 0x2C, ++0x71, 0xBE, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x12, ++0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x43, ++0x64, 0x14, 0x90, 0x88, 0x2C, 0xE0, 0xC4, 0x13, ++0x54, 0x07, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x80, ++0x90, 0x88, 0x2C, 0x91, 0x14, 0x20, 0xE0, 0x03, ++0x43, 0x64, 0x40, 0x51, 0x65, 0x90, 0x88, 0x2F, ++0xE0, 0x70, 0x04, 0x7F, 0x01, 0x51, 0x6C, 0x90, ++0x88, 0x2C, 0x71, 0x8A, 0x30, 0xE0, 0x04, 0x7F, ++0x04, 0x80, 0x0B, 0x71, 0xC6, 0xEF, 0x60, 0x04, ++0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x51, 0x6C, ++0x41, 0x20, 0x51, 0x62, 0x90, 0x88, 0x2F, 0xE0, ++0x64, 0x04, 0x60, 0x02, 0x41, 0x5D, 0xFF, 0x51, ++0x6C, 0x41, 0x5D, 0x90, 0x88, 0x2C, 0xE0, 0x30, ++0xE0, 0x76, 0x71, 0x83, 0x43, 0x64, 0x31, 0x71, ++0xB2, 0x30, 0xE0, 0x04, 0x71, 0xD2, 0x80, 0x07, ++0x7D, 0x40, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0x90, ++0x88, 0x2C, 0x71, 0xBE, 0x30, 0xE0, 0x03, 0x43, ++0x64, 0x02, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, ++0x03, 0x43, 0x64, 0x04, 0x51, 0x65, 0x90, 0x88, ++0x2C, 0x71, 0x8A, 0x30, 0xE0, 0x10, 0x71, 0x7C, ++0x60, 0x36, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, ++0xE4, 0xFD, 0x7F, 0x02, 0x80, 0x1D, 0xD1, 0x8D, ++0x71, 0x7C, 0x70, 0x1C, 0x12, 0x7B, 0xAD, 0x71, ++0xC6, 0xBF, 0x01, 0x06, 0x71, 0xE2, 0x7D, 0x01, ++0x80, 0x09, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, ++0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x80, 0x08, ++0x90, 0x88, 0x39, 0xE0, 0x90, 0x88, 0x30, 0xF0, ++0x90, 0x05, 0x40, 0x74, 0x22, 0xF0, 0x80, 0x35, ++0x51, 0x62, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, ++0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, 0x7D, ++0x01, 0x7F, 0x04, 0x80, 0x11, 0x90, 0x88, 0x30, ++0xE0, 0xB4, 0x08, 0x0D, 0x90, 0x8A, 0xB9, 0x12, ++0x96, 0x47, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, ++0x7E, 0xF1, 0xCA, 0x71, 0xE2, 0x7D, 0x01, 0x12, ++0x04, 0x7E, 0x12, 0xE4, 0x3E, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x75, 0x64, 0x01, 0x90, 0x05, 0x27, ++0xE5, 0x64, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x2F, 0xE0, 0x90, ++0x97, 0x17, 0xF0, 0x6F, 0x70, 0x02, 0x61, 0x77, ++0xEF, 0x14, 0x60, 0x42, 0x14, 0x60, 0x6E, 0x14, ++0x70, 0x02, 0x61, 0x22, 0x14, 0x70, 0x02, 0x61, ++0x4D, 0x24, 0x04, 0x60, 0x02, 0x61, 0x77, 0x90, ++0x97, 0x17, 0xE0, 0xB4, 0x04, 0x04, 0xD1, 0x70, ++0x61, 0x77, 0x90, 0x97, 0x17, 0xE0, 0xB4, 0x02, ++0x04, 0xD1, 0xA8, 0x61, 0x77, 0x90, 0x97, 0x17, ++0xE0, 0xB4, 0x03, 0x04, 0xD1, 0xAD, 0x61, 0x77, ++0x90, 0x97, 0x17, 0xE0, 0x64, 0x01, 0x60, 0x02, ++0x61, 0x77, 0xD1, 0x72, 0x61, 0x77, 0x90, 0x97, ++0x17, 0xE0, 0xB4, 0x04, 0x04, 0xD1, 0x7F, 0x61, ++0x77, 0x90, 0x97, 0x17, 0xE0, 0xB4, 0x02, 0x05, ++0x12, 0x97, 0xCF, 0x61, 0x77, 0x90, 0x97, 0x17, ++0xE0, 0xB4, 0x03, 0x05, 0x12, 0x97, 0xE2, 0x61, ++0x77, 0x90, 0x97, 0x17, 0xE0, 0x60, 0x02, 0x61, ++0x77, 0xD1, 0x41, 0x61, 0x77, 0x90, 0x97, 0x17, ++0xE0, 0xB4, 0x04, 0x04, 0xD1, 0x95, 0x80, 0x77, ++0x90, 0x97, 0x17, 0xE0, 0xB4, 0x01, 0x05, 0x12, ++0x97, 0xBC, 0x80, 0x6B, 0x90, 0x97, 0x17, 0xE0, ++0xB4, 0x03, 0x05, 0x12, 0xE4, 0x6D, 0x80, 0x5F, ++0x90, 0x97, 0x17, 0xE0, 0x70, 0x59, 0xD1, 0x6B, ++0x80, 0x55, 0x90, 0x97, 0x17, 0xE0, 0xB4, 0x04, ++0x04, 0xD1, 0x5A, 0x80, 0x4A, 0x90, 0x97, 0x17, ++0xE0, 0xB4, 0x01, 0x04, 0xD1, 0x46, 0x80, 0x3F, ++0x90, 0x97, 0x17, 0xE0, 0xB4, 0x02, 0x04, 0xD1, ++0xC1, 0x80, 0x34, 0x90, 0x97, 0x17, 0xE0, 0x70, ++0x2E, 0xD1, 0x44, 0x80, 0x2A, 0x90, 0x97, 0x17, ++0xE0, 0xB4, 0x03, 0x04, 0xF1, 0xD3, 0x80, 0x1F, ++0x90, 0x97, 0x17, 0xE0, 0xB4, 0x01, 0x04, 0xD1, ++0x26, 0x80, 0x14, 0x90, 0x97, 0x17, 0xE0, 0xB4, ++0x02, 0x05, 0x12, 0xE4, 0x5C, 0x80, 0x08, 0x90, ++0x97, 0x17, 0xE0, 0x70, 0x02, 0xD1, 0x24, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x30, 0xE0, ++0x64, 0x02, 0x22, 0x7D, 0x03, 0x7F, 0x02, 0x02, ++0x7C, 0x05, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, ++0x03, 0x22, 0x90, 0x88, 0x2C, 0x71, 0x8A, 0x30, ++0xE0, 0x11, 0x71, 0x7C, 0x60, 0x0D, 0x90, 0x8A, ++0xB9, 0x12, 0x96, 0x47, 0x7D, 0x01, 0x7F, 0x02, ++0x12, 0x04, 0x7E, 0x71, 0x7C, 0x60, 0x02, 0xF1, ++0x6B, 0x22, 0x90, 0x88, 0x2C, 0xE0, 0x13, 0x13, ++0x54, 0x3F, 0x22, 0x90, 0x88, 0x32, 0xE0, 0xFF, ++0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x05, ++0x43, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, ++0x01, 0x22, 0x90, 0x01, 0x34, 0x74, 0x40, 0xF0, ++0xFD, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x43, 0x64, ++0x08, 0x22, 0x90, 0x88, 0x38, 0xE0, 0xFF, 0x90, ++0x8A, 0xB9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, 0x82, ++0x8C, 0x83, 0x22, 0xAE, 0x07, 0x71, 0xC6, 0xBF, ++0x01, 0x14, 0x90, 0x88, 0x2C, 0x91, 0x14, 0x20, ++0xE0, 0x0C, 0xAF, 0x06, 0x71, 0xE7, 0x7D, 0x01, ++0x12, 0x04, 0x7E, 0x7F, 0x01, 0x22, 0x7F, 0x00, ++0x22, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x13, ++0x54, 0x03, 0x22, 0xE4, 0xF5, 0x7C, 0x90, 0x88, ++0x36, 0xE0, 0x60, 0x65, 0xD1, 0xC9, 0x70, 0x61, ++0xF1, 0xE4, 0xF0, 0x75, 0x7C, 0x01, 0x90, 0x88, ++0x2C, 0xE0, 0x30, 0xE0, 0x11, 0x90, 0x88, 0x30, ++0xE0, 0xB4, 0x02, 0x03, 0xE4, 0xF5, 0x7C, 0x71, ++0xC6, 0xEF, 0x70, 0x02, 0xF5, 0x7C, 0xE5, 0x7C, ++0x60, 0x3F, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, ++0x08, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, 0xD1, ++0xB2, 0xD1, 0xB9, 0x90, 0x88, 0x3F, 0xE0, 0x60, ++0x04, 0x64, 0x01, 0x70, 0x0F, 0x91, 0x8A, 0xFF, ++0xA3, 0xE0, 0x2F, 0x91, 0xB0, 0x91, 0x8F, 0xFF, ++0xA3, 0xE0, 0x80, 0x0B, 0x91, 0x8A, 0x91, 0x99, ++0x2F, 0x91, 0xB0, 0x91, 0x8F, 0x91, 0x99, 0x2F, ++0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4F, ++0xF0, 0x22, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, ++0x88, 0x3E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, ++0x22, 0xFF, 0xA3, 0xE0, 0x75, 0xF0, 0x03, 0xA4, ++0x24, 0xFE, 0x22, 0xE0, 0x44, 0x02, 0xF0, 0xE4, ++0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, ++0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, ++0x54, 0x7E, 0x01, 0x02, 0x66, 0x33, 0xE4, 0x90, ++0x96, 0x1D, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, ++0x49, 0xD1, 0xC9, 0x70, 0x45, 0x12, 0xE7, 0x20, ++0xF0, 0xF1, 0xE4, 0x12, 0xE7, 0x28, 0xE4, 0x90, ++0x88, 0x3D, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0x30, ++0xE0, 0x15, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, ++0x05, 0xE4, 0x90, 0x96, 0x1D, 0xF0, 0x71, 0xC6, ++0xEF, 0x70, 0x04, 0x90, 0x96, 0x1D, 0xF0, 0x90, ++0x96, 0x1D, 0xE0, 0x60, 0x15, 0x90, 0x88, 0x39, ++0xE0, 0x20, 0xE2, 0x08, 0x90, 0x8A, 0xB9, 0x12, ++0x96, 0x47, 0xD1, 0xB2, 0xD1, 0xB9, 0x91, 0x8A, ++0x91, 0xB0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, ++0xE0, 0x05, 0x90, 0x8A, 0x8F, 0x80, 0x03, 0x90, ++0x8A, 0x87, 0x12, 0x92, 0x46, 0x90, 0x88, 0xE6, ++0xE0, 0x30, 0xE0, 0x04, 0xA3, 0xE0, 0x04, 0xF0, ++0x90, 0x88, 0xE7, 0xE0, 0x64, 0x08, 0x70, 0x20, ++0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x14, 0x12, ++0xCC, 0xD8, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, ++0x88, 0xE6, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, ++0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, ++0x91, 0x11, 0x30, 0xE0, 0x13, 0x90, 0x88, 0xE8, ++0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, ++0x04, 0x9C, 0xE4, 0xF0, 0x90, 0x88, 0xE8, 0xF0, ++0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x06, 0x90, ++0x88, 0x2E, 0x74, 0x01, 0xF0, 0x90, 0x88, 0x36, ++0xE0, 0x70, 0x02, 0xC1, 0x07, 0x90, 0x88, 0x4D, ++0xE0, 0x04, 0xF0, 0x90, 0x05, 0x61, 0x12, 0x8D, ++0xD4, 0x12, 0xC7, 0xA2, 0x90, 0x05, 0x60, 0x12, ++0x8D, 0xD4, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, ++0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, ++0x12, 0x8D, 0xD4, 0x78, 0x10, 0x12, 0x03, 0xFE, ++0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, ++0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, ++0x06, 0xC0, 0x07, 0xA3, 0x12, 0x8D, 0xD4, 0x78, ++0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, ++0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0x90, ++0x88, 0x81, 0x12, 0x04, 0x31, 0x90, 0x88, 0x32, ++0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, ++0x0C, 0x12, 0xBC, 0x89, 0x74, 0x05, 0xF0, 0x12, ++0x6E, 0x2F, 0x12, 0xDD, 0xE9, 0x90, 0x88, 0x32, ++0x91, 0x92, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, ++0xE0, 0x30, 0xE4, 0x03, 0x12, 0x8F, 0xFC, 0x90, ++0x8A, 0xE5, 0x12, 0x96, 0x47, 0x7F, 0x01, 0x12, ++0x04, 0x7E, 0x90, 0x93, 0x3B, 0xE0, 0x30, 0xE0, ++0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, ++0x12, 0x8F, 0xFC, 0x22, 0xD1, 0x41, 0x90, 0x8A, ++0xF9, 0x12, 0x96, 0x47, 0x7D, 0x1F, 0x7F, 0x6F, ++0x12, 0x04, 0x7E, 0x90, 0x05, 0x27, 0xE0, 0x54, ++0xBF, 0xF0, 0x90, 0x88, 0x2F, 0x74, 0x04, 0xF0, ++0x22, 0x02, 0x97, 0xDB, 0xD1, 0x41, 0x90, 0x8A, ++0xF9, 0x12, 0x96, 0x47, 0x7D, 0x21, 0x7F, 0xFF, ++0x12, 0x04, 0x7E, 0x90, 0x88, 0x2F, 0x74, 0x03, ++0xF0, 0x22, 0x90, 0x8A, 0xF9, 0x12, 0x96, 0x47, ++0x7D, 0x22, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0xD1, ++0x8D, 0x80, 0xE8, 0xD1, 0x41, 0x02, 0x97, 0xBC, ++0xD1, 0x7F, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, ++0xF0, 0xE4, 0x90, 0x88, 0x2F, 0xF0, 0x22, 0x90, ++0x8A, 0xF9, 0x12, 0x96, 0x47, 0x12, 0x97, 0xEB, ++0xD1, 0x8D, 0x02, 0x97, 0xDB, 0x90, 0x05, 0x27, ++0xE0, 0x44, 0x40, 0xF0, 0x22, 0xD1, 0x8D, 0x90, ++0x8A, 0xF9, 0x12, 0x96, 0x47, 0x7D, 0x23, 0x12, ++0xE2, 0x74, 0x12, 0x92, 0x46, 0x02, 0x97, 0xC8, ++0x12, 0x97, 0xCF, 0x80, 0xC5, 0x12, 0x97, 0xE2, ++0x80, 0xC0, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x04, ++0x7E, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, ++0x22, 0x90, 0x86, 0x0C, 0x12, 0x92, 0x46, 0x80, ++0x8A, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x64, ++0x01, 0x22, 0xD1, 0xC9, 0x70, 0x12, 0x90, 0x88, ++0x36, 0xE0, 0x60, 0x0C, 0x90, 0x88, 0x3A, 0xE0, ++0x20, 0xE4, 0x05, 0x12, 0xBF, 0x93, 0x91, 0xA6, ++0x22, 0x71, 0xBB, 0x30, 0xE0, 0x0C, 0xEF, 0xC4, ++0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x03, 0x12, ++0x8F, 0xF5, 0x12, 0x8F, 0xD9, 0x30, 0xE0, 0x09, ++0x12, 0xBF, 0xB5, 0x54, 0x07, 0x70, 0x3E, 0x80, ++0x3A, 0x12, 0xE5, 0xEF, 0x9F, 0x40, 0x34, 0xD1, ++0xC9, 0x70, 0x32, 0xF1, 0x64, 0x70, 0x08, 0x90, ++0x8A, 0xF5, 0x12, 0x92, 0x46, 0x80, 0x27, 0x90, ++0x8A, 0xF5, 0x12, 0x92, 0x46, 0x90, 0x88, 0x40, ++0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, ++0x09, 0xF1, 0x46, 0xE4, 0x90, 0x88, 0x40, 0xF0, ++0x80, 0x03, 0x12, 0x73, 0x8F, 0xE4, 0x90, 0x88, ++0x3F, 0xF0, 0x22, 0xF1, 0x4E, 0x22, 0x90, 0x88, ++0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x88, ++0x2C, 0xE0, 0x90, 0x88, 0x38, 0x30, 0xE0, 0x04, ++0xE0, 0xFF, 0x61, 0xF3, 0x71, 0xE5, 0x7D, 0x01, ++0x02, 0x04, 0x7E, 0xF0, 0x90, 0x88, 0x34, 0xE0, ++0x54, 0x0F, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x64, ++0x02, 0x60, 0x12, 0xF1, 0x64, 0x60, 0x0E, 0x12, ++0x7A, 0x65, 0xEF, 0x70, 0x08, 0x90, 0x8A, 0xB9, ++0x12, 0x96, 0x47, 0xF1, 0xC3, 0x22, 0x90, 0x88, ++0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xCD, 0x90, ++0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x2B, 0x90, ++0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x23, 0xF1, ++0x64, 0x60, 0x11, 0x90, 0x8A, 0xB9, 0x12, 0x96, ++0x47, 0xF1, 0xC3, 0x90, 0x8B, 0x01, 0x12, 0xD5, ++0xAA, 0x02, 0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, ++0x70, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, ++0xD1, 0xB2, 0x22, 0xE4, 0xFD, 0x7F, 0x0C, 0x02, ++0x04, 0x7E, 0x12, 0x7A, 0x65, 0xEF, 0x70, 0x02, ++0xF1, 0x86, 0x22, 0x90, 0x8A, 0xF9, 0x12, 0x96, ++0x47, 0x7D, 0x25, 0xC1, 0x2E, 0x8B, 0x61, 0x8A, ++0x62, 0x89, 0x63, 0x22, 0x90, 0x05, 0x63, 0xE0, ++0x90, 0x88, 0x89, 0xF0, 0x90, 0x05, 0x62, 0xE0, ++0x90, 0x88, 0x8A, 0xF0, 0x90, 0x05, 0x61, 0xE0, ++0x90, 0x88, 0x8B, 0xF0, 0x90, 0x05, 0x60, 0xE0, ++0x90, 0x88, 0x8C, 0xF0, 0x90, 0x88, 0x32, 0xE0, ++0x44, 0x80, 0x22, 0x12, 0xB7, 0xDD, 0x90, 0x93, ++0xE0, 0xE0, 0x54, 0xFE, 0x12, 0x87, 0x61, 0xFC, ++0x30, 0xE0, 0x45, 0x90, 0x93, 0xE1, 0xE0, 0x44, ++0x01, 0xFE, 0xF0, 0x12, 0x02, 0x06, 0x54, 0xFE, ++0xFD, 0xEE, 0x54, 0x01, 0x4D, 0x90, 0x93, 0xE1, ++0xF0, 0x12, 0x87, 0xAE, 0x90, 0x93, 0xE2, 0xF0, ++0xEC, 0xC3, 0x13, 0x54, 0x7F, 0xFF, 0xA3, 0xF0, ++0x12, 0x87, 0xB9, 0xFE, 0xC3, 0x9F, 0x90, 0x93, ++0xE4, 0xF0, 0xA3, 0xEE, 0xF0, 0xBE, 0x64, 0x04, ++0x74, 0x01, 0xF0, 0x22, 0x90, 0x93, 0xE5, 0xE0, ++0x64, 0x96, 0x70, 0x54, 0x74, 0x03, 0xF0, 0x22, ++0x90, 0x93, 0xE1, 0xE0, 0x54, 0xFE, 0x12, 0xB0, ++0xEE, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0xD5, ++0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, ++0xFE, 0xFF, 0xEE, 0x54, 0x01, 0x4F, 0xF0, 0x12, ++0x87, 0xAE, 0x90, 0x93, 0xD6, 0xF0, 0x12, 0x87, ++0xB9, 0x90, 0x93, 0xD7, 0xF0, 0xE4, 0xA3, 0xF0, ++0x90, 0x93, 0xD7, 0xE0, 0xFF, 0xB4, 0x64, 0x05, ++0x74, 0x01, 0xF0, 0x80, 0x0A, 0xEF, 0xB4, 0x96, ++0x06, 0x90, 0x93, 0xD7, 0x74, 0x03, 0xF0, 0x90, ++0x93, 0xD7, 0xE0, 0x04, 0x90, 0x93, 0xDA, 0xF0, ++0x22, 0x31, 0x1A, 0x90, 0x93, 0x03, 0xE0, 0x54, ++0xFE, 0x4E, 0xF0, 0x30, 0xE0, 0x27, 0xEF, 0x54, ++0x04, 0x25, 0xE0, 0xFE, 0xE0, 0x54, 0xF7, 0x4E, ++0xFE, 0xF0, 0xEF, 0x54, 0x02, 0x25, 0xE0, 0xFF, ++0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x90, 0x04, 0x57, ++0xE0, 0x90, 0x93, 0x05, 0xF0, 0x90, 0x04, 0x55, ++0xE0, 0x90, 0x93, 0x04, 0xF0, 0x90, 0x93, 0x03, ++0xE0, 0x54, 0x01, 0xFF, 0xEF, 0x90, 0x07, 0xDC, ++0x60, 0x25, 0xE4, 0xF0, 0xF0, 0x90, 0x07, 0xDE, ++0xF0, 0xA3, 0x04, 0xF0, 0x90, 0x07, 0xDD, 0x74, ++0x03, 0xF0, 0x90, 0x07, 0xE3, 0xE0, 0xF0, 0xA3, ++0x74, 0x50, 0xF0, 0xA3, 0x74, 0x10, 0xF0, 0x90, ++0x07, 0xDC, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xE4, ++0xF0, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x01, ++0xFE, 0x22, 0x12, 0xAF, 0x3F, 0xFF, 0x12, 0x87, ++0xAE, 0xFE, 0x54, 0x03, 0xFD, 0xEE, 0x13, 0x13, ++0x54, 0x07, 0xFB, 0xC0, 0x03, 0x12, 0x87, 0xB4, ++0x54, 0x0F, 0x90, 0x96, 0xF8, 0xF0, 0xD0, 0x03, ++0x31, 0x6C, 0x12, 0x87, 0xA9, 0xFE, 0x54, 0x03, ++0x12, 0x8D, 0xDB, 0x90, 0x95, 0x56, 0x74, 0x10, ++0xF0, 0x90, 0x95, 0x78, 0x74, 0x07, 0xF0, 0x12, ++0x93, 0xC7, 0x90, 0x95, 0x58, 0xF0, 0x7B, 0x01, ++0x7A, 0x95, 0x79, 0x56, 0x12, 0x96, 0x35, 0x7F, ++0x04, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xF5, 0xEF, 0xF0, ++0xED, 0x64, 0x01, 0x70, 0x30, 0xEB, 0xB4, 0x01, ++0x07, 0xE0, 0x24, 0x02, 0xF5, 0x10, 0x80, 0x08, ++0x90, 0x96, 0xF5, 0xE0, 0x24, 0xFE, 0xF5, 0x10, ++0x90, 0x96, 0x96, 0x12, 0x04, 0x3D, 0x00, 0x00, ++0x00, 0xFF, 0xAF, 0x10, 0xE4, 0xFC, 0xFD, 0xFE, ++0x51, 0x5A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, ++0xFF, 0xAF, 0x10, 0x80, 0x1E, 0x90, 0x96, 0x96, ++0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, ++0x96, 0xF5, 0x12, 0x8D, 0xD4, 0x51, 0x5A, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x96, ++0xF5, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, ++0x96, 0x9A, 0x12, 0x04, 0x31, 0x7D, 0x18, 0x7C, ++0x00, 0x7F, 0x01, 0x31, 0xE2, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x96, 0x94, 0xEC, 0xF0, 0xA3, 0xED, ++0xF0, 0x90, 0x96, 0x93, 0xEF, 0xF0, 0xA3, 0xA3, ++0xE0, 0xFD, 0x12, 0x7B, 0xBD, 0x90, 0x96, 0x9E, ++0x12, 0x04, 0x31, 0x90, 0x96, 0x96, 0x12, 0x04, ++0xB8, 0x12, 0x03, 0xCD, 0x90, 0x96, 0x9E, 0x12, ++0x8F, 0x98, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, ++0xC0, 0x07, 0x90, 0x96, 0x96, 0x12, 0x04, 0xB8, ++0x90, 0x96, 0x9A, 0x12, 0x8F, 0x98, 0xD0, 0x03, ++0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, ++0x20, 0x90, 0x96, 0xA2, 0x12, 0x04, 0x31, 0x90, ++0x96, 0x94, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, ++0x96, 0xA2, 0x12, 0x04, 0xB8, 0x90, 0x8B, 0x9F, ++0x12, 0x04, 0x31, 0x90, 0x96, 0x93, 0xE0, 0xFF, ++0xD0, 0x05, 0x12, 0x79, 0x53, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0x96, 0x9A, 0x12, 0x04, 0x31, ++0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x31, 0xE2, ++0x90, 0x96, 0x96, 0x22, 0x8F, 0x65, 0x90, 0x05, ++0x22, 0xE0, 0x90, 0x95, 0x53, 0xF0, 0x7B, 0x17, ++0x12, 0x92, 0x3D, 0xEF, 0x64, 0x01, 0x70, 0x37, ++0xE5, 0x65, 0x12, 0xA7, 0xBB, 0xE0, 0xFC, 0x51, ++0xC6, 0x71, 0xE9, 0x31, 0x6C, 0x51, 0xC6, 0x12, ++0x8D, 0xDB, 0xE5, 0x65, 0x12, 0xA7, 0xD2, 0x54, ++0x07, 0xFF, 0x60, 0x03, 0xBF, 0x02, 0x0F, 0xE5, ++0x65, 0x12, 0xA7, 0xA4, 0xE0, 0xFF, 0x7E, 0x00, ++0xE4, 0xFB, 0xFD, 0x12, 0xA4, 0x70, 0xAD, 0x65, ++0x7F, 0x01, 0x71, 0x62, 0x7F, 0x01, 0x22, 0x90, ++0x95, 0x53, 0xE0, 0xFD, 0x7B, 0x49, 0xE4, 0xFF, ++0x12, 0x97, 0x56, 0x7F, 0x00, 0x22, 0xE5, 0x65, ++0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5C, 0xF5, 0x82, ++0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFE, 0x54, ++0x03, 0x22, 0xE4, 0x90, 0x96, 0xFD, 0xF0, 0xA3, ++0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0xFF, ++0xF0, 0x7B, 0x47, 0x7D, 0xFF, 0xE4, 0xFF, 0x12, ++0x97, 0x56, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x1B, ++0xA3, 0xE0, 0x70, 0x17, 0xA3, 0xE0, 0x70, 0x13, ++0xA3, 0xE0, 0x70, 0x0F, 0x90, 0x96, 0xFF, 0xE0, ++0xFD, 0x7B, 0x48, 0xE4, 0xFF, 0x12, 0x97, 0x56, ++0x7F, 0x01, 0x22, 0x12, 0xB4, 0x11, 0x30, 0xE0, ++0x19, 0xD3, 0x90, 0x96, 0xFE, 0xE0, 0x94, 0x03, ++0x90, 0x96, 0xFD, 0xE0, 0x94, 0x00, 0x40, 0x06, ++0x71, 0x55, 0x7B, 0x5A, 0x80, 0x17, 0x7F, 0x01, ++0x80, 0x17, 0xD3, 0x90, 0x96, 0xFE, 0xE0, 0x94, ++0xE8, 0x90, 0x96, 0xFD, 0xE0, 0x94, 0x03, 0x40, ++0x06, 0x71, 0x55, 0x7B, 0x5B, 0x41, 0xBE, 0x7F, ++0x32, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0x90, 0x96, ++0xFD, 0x71, 0xE2, 0x80, 0x9D, 0x90, 0x01, 0xC0, ++0xE0, 0x44, 0x20, 0xF0, 0x90, 0x96, 0xFF, 0xE0, ++0xFD, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x96, 0x24, 0xED, 0xF0, 0x90, 0x96, ++0x23, 0xEF, 0xF0, 0x64, 0x02, 0x70, 0x24, 0x90, ++0x05, 0x22, 0xE0, 0x90, 0x96, 0x25, 0xF0, 0x7B, ++0x4A, 0x7D, 0x6F, 0x12, 0x92, 0x3F, 0xBF, 0x01, ++0x07, 0x90, 0x04, 0xD4, 0x74, 0xFF, 0x80, 0x48, ++0x90, 0x96, 0x25, 0xE0, 0xFD, 0x7B, 0x46, 0x51, ++0xBE, 0x80, 0x42, 0x90, 0x96, 0x23, 0xE0, 0x64, ++0x01, 0x70, 0x31, 0x12, 0x97, 0x52, 0x90, 0x96, ++0x24, 0xE0, 0xFF, 0x75, 0xF0, 0x1B, 0xA4, 0x24, ++0x60, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, ++0xE0, 0xF4, 0x90, 0x04, 0xD4, 0xF0, 0xEF, 0x75, ++0xF0, 0x1B, 0xA4, 0x24, 0x61, 0xF5, 0x82, 0xE4, ++0x34, 0x93, 0xF5, 0x83, 0xE0, 0xF4, 0x90, 0x04, ++0xD5, 0xF0, 0x80, 0x07, 0x90, 0x04, 0xD4, 0xE4, ++0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x02, ++0xE7, 0xFD, 0xEE, 0x13, 0x13, 0x54, 0x07, 0xFB, ++0x90, 0x93, 0x58, 0xE0, 0xFE, 0xC4, 0x54, 0x0F, ++0x90, 0x96, 0xF8, 0xF0, 0xAF, 0x04, 0x22, 0xE4, ++0x90, 0x96, 0x1F, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, ++0x12, 0x7B, 0x41, 0x90, 0x96, 0x1E, 0xEF, 0xF0, ++0x7F, 0x83, 0x12, 0x7B, 0x41, 0xAE, 0x07, 0x90, ++0x96, 0x1E, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, ++0xC3, 0x90, 0x96, 0x20, 0xE0, 0x94, 0x64, 0x90, ++0x96, 0x1F, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, ++0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x96, ++0x1E, 0xE0, 0xFF, 0x22, 0x90, 0x96, 0x1F, 0x71, ++0xE2, 0x80, 0xC3, 0x71, 0xFF, 0x90, 0x96, 0x1D, ++0xEF, 0xF0, 0x90, 0x8A, 0x89, 0x30, 0xE0, 0x13, ++0x12, 0x96, 0x47, 0x7D, 0x01, 0xE4, 0xFF, 0x12, ++0x04, 0x7E, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x04, ++0xF0, 0x80, 0x06, 0x12, 0x96, 0x47, 0x12, 0x97, ++0xEB, 0x90, 0x96, 0x1D, 0xE0, 0x30, 0xE6, 0x11, ++0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, ++0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, ++0xF0, 0x91, 0x89, 0x74, 0x02, 0xF0, 0x02, 0x6E, ++0x2F, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, ++0xFD, 0x90, 0x88, 0x4F, 0xE0, 0xFB, 0x90, 0x92, ++0x98, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, ++0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, ++0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, ++0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0x01, 0xC4, 0x74, 0x9A, 0xF0, 0x74, 0xBC, 0xA3, ++0xF0, 0x12, 0x75, 0x50, 0xE5, 0x3D, 0x30, 0xE0, ++0x03, 0x12, 0xDF, 0xBE, 0xE5, 0x3D, 0x30, 0xE1, ++0x02, 0xF1, 0xA9, 0xE5, 0x3D, 0x30, 0xE2, 0x02, ++0xB1, 0xC1, 0xE5, 0x3D, 0x30, 0xE4, 0x02, 0xF1, ++0x6C, 0xE5, 0x3D, 0x30, 0xE5, 0x02, 0xF1, 0x6A, ++0xE5, 0x3E, 0x30, 0xE0, 0x02, 0x91, 0x43, 0xE5, ++0x3E, 0x30, 0xE3, 0x02, 0xB1, 0x75, 0xE5, 0x3E, ++0x30, 0xE4, 0x03, 0x12, 0xDF, 0xD1, 0xE5, 0x3F, ++0x30, 0xE1, 0x02, 0xD1, 0xF4, 0xE5, 0x3F, 0x30, ++0xE0, 0x02, 0xD1, 0x85, 0xE5, 0x3F, 0x30, 0xE4, ++0x02, 0xF1, 0x6B, 0xE5, 0x3F, 0x30, 0xE2, 0x0A, ++0x12, 0xDB, 0x87, 0x90, 0x07, 0x8F, 0xE0, 0x44, ++0x10, 0xF0, 0xE5, 0x40, 0x30, 0xE1, 0x0B, 0x90, ++0x8A, 0xE5, 0x12, 0x96, 0x47, 0x7F, 0x04, 0x12, ++0x04, 0x7E, 0xE5, 0x40, 0x30, 0xE4, 0x02, 0xB1, ++0x95, 0xE5, 0x40, 0x30, 0xE5, 0x02, 0xD1, 0x49, ++0xE5, 0x40, 0x30, 0xE6, 0x02, 0xF1, 0xCE, 0xE5, ++0x40, 0x30, 0xE7, 0x03, 0x12, 0xDB, 0xC9, 0x74, ++0x9A, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBC, ++0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, ++0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, ++0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, ++0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x01, 0x8C, ++0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, ++0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, ++0x54, 0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, ++0xE0, 0x44, 0x04, 0xF0, 0x22, 0x12, 0xB4, 0xBE, ++0x12, 0x8F, 0xC2, 0x7F, 0x01, 0xB1, 0xE6, 0x90, ++0x8B, 0x07, 0x12, 0x92, 0x46, 0x90, 0x93, 0x3B, ++0xE0, 0x30, 0xE0, 0x14, 0xF1, 0x77, 0x90, 0x93, ++0x3E, 0xE0, 0x60, 0x05, 0x14, 0xF0, 0x02, 0x79, ++0xD4, 0xF1, 0x89, 0xE4, 0xFF, 0x12, 0x87, 0xE0, ++0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x14, 0x90, ++0x06, 0x92, 0xE0, 0x30, 0xE1, 0x08, 0x90, 0x8B, ++0x01, 0x12, 0x92, 0x46, 0x80, 0x05, 0xF1, 0x6F, ++0x12, 0xB7, 0x4E, 0x90, 0x93, 0x5A, 0xE0, 0xB4, ++0x01, 0x03, 0x12, 0xA5, 0x96, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, ++0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x27, 0x90, 0x96, ++0x70, 0x74, 0x1E, 0xF0, 0x90, 0x96, 0x92, 0x74, ++0x01, 0xF0, 0x90, 0x96, 0x72, 0xEF, 0xF0, 0x7B, ++0x01, 0x7A, 0x96, 0x79, 0x70, 0xF1, 0xC1, 0x12, ++0x04, 0x7E, 0x90, 0x8A, 0xE5, 0x12, 0x96, 0x47, ++0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, ++0x10, 0xA3, 0x74, 0x01, 0xF0, 0x90, 0x88, 0x2C, ++0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0xD1, ++0xD9, 0x12, 0xB4, 0x1B, 0xE4, 0xFF, 0xB1, 0xE6, ++0x90, 0x8B, 0x07, 0x12, 0x92, 0x46, 0x02, 0x8B, ++0xA3, 0x90, 0x88, 0x31, 0x12, 0xB3, 0x8A, 0x30, ++0xE0, 0x32, 0xEF, 0x54, 0xBF, 0xF1, 0x80, 0x30, ++0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, ++0xE0, 0x54, 0xFE, 0xF1, 0x9E, 0x74, 0x04, 0xF0, ++0x90, 0x88, 0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, ++0x07, 0x30, 0xE0, 0x0D, 0x90, 0x8A, 0xB9, 0x12, ++0x96, 0x47, 0x7D, 0x01, 0x7F, 0x0C, 0x02, 0x04, ++0x7E, 0x12, 0xB7, 0x4E, 0x22, 0x90, 0x88, 0x2C, ++0xE0, 0xFF, 0x30, 0xE0, 0x4B, 0x90, 0x88, 0x30, ++0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, ++0x90, 0x88, 0x2F, 0xE0, 0x7D, 0x00, 0xB4, 0x04, ++0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x31, 0xEF, ++0xC3, 0x13, 0x30, 0xE0, 0x02, 0x80, 0x2A, 0x12, ++0xB3, 0x92, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x08, ++0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, 0xE4, ++0xFD, 0x7F, 0x0C, 0x80, 0x10, 0x90, 0x88, 0x30, ++0xE0, 0x70, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x96, ++0x47, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x12, 0xB3, 0xC6, 0xBF, 0x01, 0x04, 0x7F, 0x01, ++0x80, 0x02, 0x7F, 0x02, 0x12, 0xB2, 0x6C, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x2C, 0xE0, ++0xFF, 0x30, 0xE0, 0x4A, 0x90, 0x88, 0x30, 0xE0, ++0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, ++0x88, 0x2F, 0xE0, 0x7D, 0x00, 0xB4, 0x04, 0x02, ++0x7D, 0x01, 0xED, 0x4E, 0x70, 0x30, 0xEF, 0xC3, ++0x13, 0x30, 0xE0, 0x02, 0x80, 0xBB, 0xF1, 0x47, ++0x90, 0x88, 0x30, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, ++0x8A, 0xB9, 0x12, 0x96, 0x47, 0xE4, 0xFD, 0x7F, ++0x08, 0x80, 0x10, 0x90, 0x88, 0x30, 0xE0, 0xB4, ++0x04, 0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, ++0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x22, 0x90, ++0x01, 0x57, 0xE0, 0x60, 0x1C, 0xF1, 0x96, 0xF0, ++0x12, 0x8F, 0xD9, 0x30, 0xE0, 0x02, 0x80, 0x5D, ++0x12, 0xE5, 0xEF, 0x9F, 0x40, 0x0B, 0xE4, 0xFF, ++0x12, 0x78, 0x4A, 0xBF, 0x01, 0x03, 0x12, 0xB7, ++0x46, 0x22, 0x22, 0x22, 0x02, 0x34, 0x78, 0x90, ++0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x90, ++0x93, 0x3D, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, ++0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0x32, ++0x22, 0x90, 0x93, 0x3C, 0xE0, 0x14, 0x90, 0x93, ++0x3E, 0xF0, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, ++0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0xF0, 0x90, ++0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, ++0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, ++0xB6, 0xE9, 0x02, 0xA5, 0x96, 0xEF, 0x54, 0xFB, ++0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, 0xF0, ++0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, ++0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x90, 0x88, ++0x31, 0xE0, 0xFF, 0x12, 0xA3, 0x5C, 0x30, 0xE0, ++0x1E, 0xEF, 0x54, 0x7F, 0xF1, 0x80, 0x30, 0xE1, ++0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, ++0x54, 0xFD, 0xF1, 0x9E, 0x04, 0xF0, 0x90, 0x88, ++0x36, 0xE0, 0x60, 0x03, 0x12, 0xB7, 0x4E, 0x90, ++0x88, 0xA1, 0x12, 0xB3, 0x8A, 0x30, 0xE0, 0x22, ++0x90, 0x88, 0xA4, 0xE0, 0xFF, 0xC3, 0x13, 0x30, ++0xE0, 0x18, 0xEF, 0x54, 0xFD, 0xF0, 0x90, 0x04, ++0xE0, 0xE0, 0x90, 0x88, 0xA4, 0x30, 0xE1, 0x06, ++0xE0, 0x44, 0x04, 0xF0, 0x80, 0x04, 0xE0, 0x54, ++0xFB, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, ++0x03, 0x12, 0xA7, 0x28, 0x22, 0x12, 0x02, 0x06, ++0xFF, 0x90, 0x93, 0x3A, 0xF0, 0xBF, 0x01, 0x07, ++0x11, 0x40, 0xE4, 0x90, 0x93, 0x3A, 0xF0, 0x22, ++0x11, 0xEB, 0x7F, 0xEF, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xBF, 0x01, 0x06, 0x90, 0x95, 0x53, 0xE0, ++0xA3, 0xF0, 0x11, 0xEB, 0x7F, 0xEE, 0x7E, 0x01, ++0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, ++0x53, 0xE0, 0x90, 0x95, 0x55, 0xF0, 0x11, 0xEB, ++0x7F, 0xED, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, ++0x01, 0x08, 0x90, 0x95, 0x53, 0xE0, 0x90, 0x95, ++0x56, 0xF0, 0x11, 0xEB, 0x7F, 0xEC, 0x7E, 0x01, ++0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, ++0x53, 0xE0, 0x90, 0x95, 0x57, 0xF0, 0x11, 0xEB, ++0x7F, 0xEB, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, ++0x01, 0x08, 0x90, 0x95, 0x53, 0xE0, 0x90, 0x95, ++0x58, 0xF0, 0x90, 0x95, 0x54, 0xE0, 0xFF, 0xA3, ++0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, ++0x95, 0x5C, 0xF0, 0x90, 0x95, 0x58, 0xE0, 0x90, ++0x95, 0x5D, 0xF0, 0x90, 0x95, 0x5E, 0x74, 0x12, ++0xF0, 0x90, 0x95, 0x80, 0x74, 0x05, 0xF0, 0x90, ++0x95, 0x60, 0x12, 0xAF, 0xDE, 0x90, 0x95, 0x5C, ++0xE0, 0x90, 0x95, 0x63, 0xF0, 0x90, 0x95, 0x5D, ++0xE0, 0x90, 0x95, 0x64, 0xF0, 0x7B, 0x01, 0x7A, ++0x95, 0x79, 0x5E, 0x12, 0x96, 0x35, 0x7F, 0x04, ++0x02, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x53, 0x22, 0x7E, 0x00, 0x7F, 0x0B, 0x7D, 0x00, ++0x7B, 0x01, 0x7A, 0x93, 0x79, 0xE7, 0x12, 0x04, ++0x80, 0x11, 0xEB, 0x91, 0x06, 0xBF, 0x01, 0x1C, ++0x90, 0x95, 0x53, 0xE0, 0xFE, 0x54, 0x01, 0x90, ++0x93, 0xE7, 0xF0, 0xEE, 0x54, 0x04, 0x90, 0x93, ++0xE9, 0xF0, 0x90, 0x95, 0x53, 0xE0, 0x54, 0x08, ++0x90, 0x93, 0xE8, 0xF0, 0x11, 0xEB, 0x31, 0x7A, ++0x70, 0x35, 0x90, 0x95, 0x53, 0xE0, 0x54, 0x07, ++0x70, 0x15, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x54, ++0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, ++0x01, 0x0F, 0x90, 0x95, 0x54, 0x80, 0x03, 0x90, ++0x95, 0x53, 0xE0, 0x54, 0x07, 0x90, 0x93, 0xEB, ++0xF0, 0x90, 0x95, 0x53, 0xE0, 0x54, 0xE0, 0xC4, ++0x13, 0x54, 0x07, 0x90, 0x93, 0xEA, 0xF0, 0x11, ++0xEB, 0x7F, 0xFD, 0x7E, 0x01, 0x12, 0x5F, 0xA6, ++0xBF, 0x01, 0x0E, 0x90, 0x95, 0x53, 0xE0, 0x54, ++0x0C, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x93, 0xEC, ++0xF0, 0x22, 0x7F, 0xFB, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xEF, 0x64, 0x01, 0x22, 0x90, 0x95, 0x53, ++0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, ++0x7F, 0xF4, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, ++0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, 0x95, ++0x9C, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, ++0x7F, 0xF5, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, ++0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, 0x95, ++0x9D, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, ++0x7F, 0xF6, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, ++0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, 0x95, ++0x9E, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, ++0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, ++0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, 0x95, ++0x9F, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, ++0x7F, 0xF8, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, ++0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, 0x95, ++0xA0, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, ++0x91, 0x06, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x9A, ++0xE0, 0x90, 0x95, 0xA1, 0xF0, 0x7B, 0x01, 0x7A, ++0x95, 0x79, 0x9A, 0x31, 0x7A, 0x70, 0x52, 0x90, ++0x95, 0x9A, 0xE0, 0x90, 0x95, 0xA2, 0xF0, 0x54, ++0x07, 0x60, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x54, ++0xE0, 0x70, 0x3E, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x9B, 0x7F, 0xFA, 0x31, 0x7C, 0x70, 0x32, 0x90, ++0x95, 0x9A, 0xE0, 0xFC, 0x54, 0x07, 0x70, 0x12, ++0x90, 0x95, 0xA2, 0xE0, 0xFE, 0x90, 0x95, 0x9B, ++0xE0, 0x54, 0x07, 0xFD, 0xEE, 0x4D, 0x90, 0x95, ++0xA2, 0xF0, 0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, ++0x95, 0xA2, 0xE0, 0xFF, 0x90, 0x95, 0x9B, 0xE0, ++0x54, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x95, 0xA2, ++0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, 0x7F, ++0xFD, 0x31, 0x7C, 0x70, 0x46, 0x90, 0x95, 0x9A, ++0xE0, 0xFE, 0x54, 0xCC, 0x90, 0x95, 0xA3, 0xF0, ++0xEE, 0x54, 0x0C, 0xFF, 0x60, 0x08, 0x90, 0x95, ++0x9A, 0xE0, 0x54, 0xC0, 0x70, 0x2D, 0xEF, 0x70, ++0x11, 0x90, 0x95, 0xA3, 0xE0, 0xFF, 0x90, 0x95, ++0x9A, 0xE0, 0x54, 0x03, 0xF1, 0x6C, 0x90, 0x95, ++0xA3, 0xF0, 0x90, 0x95, 0x9A, 0xE0, 0xFF, 0x54, ++0xC0, 0x70, 0x10, 0x90, 0x95, 0xA3, 0xE0, 0xFE, ++0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, ++0xEE, 0x4F, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x9A, 0x7F, 0xF0, 0x7E, 0x01, 0x12, 0x5F, 0xA6, ++0xBF, 0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, ++0x95, 0xA4, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x9A, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, ++0xBF, 0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, ++0x95, 0xA5, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x9A, 0x7F, 0xF2, 0x7E, 0x01, 0x12, 0x5F, 0xA6, ++0xBF, 0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, ++0x95, 0xA6, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x9A, 0x7F, 0xF3, 0x7E, 0x01, 0x12, 0x5F, 0xA6, ++0xBF, 0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, ++0x95, 0xA7, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x9A, 0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, ++0xBF, 0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, ++0x95, 0xA8, 0xF0, 0x90, 0x95, 0x54, 0x74, 0x19, ++0xF0, 0x90, 0x95, 0x76, 0x74, 0x08, 0xF0, 0x90, ++0x95, 0x9C, 0xE0, 0x90, 0x95, 0x56, 0xF0, 0x90, ++0x95, 0x9D, 0xE0, 0x90, 0x95, 0x57, 0xF0, 0x90, ++0x95, 0x9E, 0xE0, 0x90, 0x95, 0x58, 0xF0, 0x90, ++0x95, 0x9F, 0xE0, 0x90, 0x95, 0x59, 0xF0, 0x90, ++0x95, 0xA0, 0xE0, 0x90, 0x95, 0x5A, 0xF0, 0x90, ++0x95, 0xA1, 0xE0, 0x90, 0x95, 0x5B, 0xF0, 0x90, ++0x95, 0xA2, 0xE0, 0x90, 0x95, 0x5C, 0xF0, 0x90, ++0x95, 0xA3, 0xE0, 0x90, 0x95, 0x5D, 0xF0, 0x90, ++0x95, 0x77, 0x74, 0x1A, 0xF0, 0x90, 0x95, 0x99, ++0x74, 0x05, 0xF0, 0x90, 0x95, 0xA4, 0xE0, 0x90, ++0x95, 0x79, 0xF0, 0x90, 0x95, 0xA5, 0xE0, 0x90, ++0x95, 0x7A, 0xF0, 0x90, 0x95, 0xA6, 0xE0, 0x90, ++0x95, 0x7B, 0xF0, 0x90, 0x95, 0xA7, 0xE0, 0x90, ++0x95, 0x7C, 0xF0, 0x90, 0x95, 0xA8, 0xE0, 0x90, ++0x95, 0x7D, 0xF0, 0x90, 0x95, 0x53, 0xE0, 0xB4, ++0x01, 0x1A, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x54, ++0x12, 0xBF, 0xC1, 0x12, 0x04, 0x7E, 0x7B, 0x01, ++0x7A, 0x95, 0x79, 0x77, 0x12, 0x96, 0x35, 0x7F, ++0x04, 0x02, 0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, ++0x46, 0x95, 0x75, 0x47, 0x54, 0x75, 0x48, 0x0A, ++0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x69, ++0xF5, 0x75, 0x45, 0x01, 0x75, 0x46, 0x95, 0x75, ++0x47, 0x79, 0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, ++0x01, 0x79, 0xAA, 0x02, 0x69, 0xF5, 0x7F, 0xF9, ++0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x12, 0x02, 0x06, ++0x90, 0x95, 0x76, 0xF0, 0x12, 0x87, 0xAE, 0x90, ++0x95, 0x77, 0xF0, 0x60, 0x0E, 0x91, 0x59, 0x91, ++0x61, 0x90, 0x95, 0x77, 0x91, 0x59, 0x7B, 0x57, ++0x12, 0x97, 0x56, 0x90, 0x95, 0x53, 0x74, 0x20, ++0xF0, 0x90, 0x95, 0x75, 0x74, 0x03, 0xF0, 0x90, ++0x05, 0x22, 0xE0, 0x90, 0x95, 0x55, 0xF0, 0x90, ++0x93, 0xF3, 0xE0, 0x90, 0x95, 0x56, 0xF0, 0x90, ++0x93, 0xF4, 0xE0, 0x90, 0x95, 0x57, 0xF0, 0x11, ++0xEB, 0x12, 0x96, 0x35, 0x7F, 0x04, 0x02, 0x04, ++0x7E, 0xE0, 0xFF, 0x90, 0x95, 0x76, 0xE0, 0xFD, ++0x22, 0xEF, 0xB4, 0xFF, 0x06, 0x90, 0x93, 0xF3, ++0xED, 0xF0, 0x22, 0xEF, 0xF4, 0xFE, 0x90, 0x93, ++0xF3, 0xE0, 0x5E, 0xFE, 0xED, 0x5F, 0x4E, 0xF0, ++0x22, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, ++0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x12, 0xD9, 0x6F, ++0xF1, 0x95, 0x12, 0x7B, 0x79, 0x12, 0xBD, 0x75, ++0x91, 0xEC, 0x7F, 0x01, 0x12, 0x84, 0x15, 0x90, ++0x93, 0x57, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x84, ++0x15, 0x90, 0x93, 0x57, 0xE0, 0x04, 0xF0, 0x91, ++0xFE, 0x12, 0x97, 0x77, 0x90, 0x00, 0x80, 0xE0, ++0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, ++0x75, 0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, 0x01, ++0xA0, 0xE0, 0xB4, 0xFD, 0x04, 0xE4, 0xFF, 0x31, ++0x85, 0xB1, 0x4B, 0x90, 0x00, 0x81, 0xE0, 0x44, ++0x04, 0xFD, 0x7F, 0x81, 0x12, 0x7B, 0x2E, 0xF1, ++0x7E, 0x11, 0xF2, 0x90, 0x00, 0xAA, 0xE0, 0x44, ++0x02, 0xF0, 0xA3, 0xE0, 0x44, 0x80, 0xF0, 0xE4, ++0xFF, 0x02, 0x84, 0x9E, 0xE4, 0x90, 0x86, 0xAF, ++0xF0, 0xF1, 0x65, 0x90, 0x93, 0x01, 0xF0, 0x90, ++0x93, 0xF3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x7B, ++0x1B, 0x90, 0x86, 0xB3, 0xEF, 0xF0, 0xB1, 0x18, ++0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, ++0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, 0x67, 0xD2, ++0x12, 0x76, 0x6D, 0x12, 0x75, 0xE0, 0x12, 0xD7, ++0xB1, 0x12, 0xD7, 0xEC, 0x75, 0x21, 0x80, 0xE4, ++0xF5, 0x22, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, ++0x21, 0x7F, 0x50, 0x12, 0x7B, 0x2E, 0xAD, 0x22, ++0x7F, 0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, ++0x52, 0x12, 0x7B, 0x2E, 0xAD, 0x24, 0x7F, 0x53, ++0x02, 0x7B, 0x2E, 0xE4, 0x90, 0x95, 0x53, 0xF0, ++0xA3, 0xF0, 0xF1, 0x89, 0xEF, 0x64, 0x01, 0x60, ++0x39, 0xC3, 0x90, 0x95, 0x54, 0xE0, 0x94, 0x88, ++0x90, 0x95, 0x53, 0xE0, 0x94, 0x13, 0x40, 0x0F, ++0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, ++0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1B, 0x90, ++0x95, 0x53, 0xF1, 0xB0, 0xD3, 0x90, 0x95, 0x54, ++0xE0, 0x94, 0x32, 0x90, 0x95, 0x53, 0xE0, 0x94, ++0x00, 0x40, 0xC7, 0x90, 0x01, 0xC6, 0xE0, 0x30, ++0xE3, 0xC0, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, ++0x22, 0x12, 0x02, 0x06, 0x64, 0x01, 0x60, 0x02, ++0xC1, 0x2A, 0x90, 0x95, 0x9A, 0xF0, 0x90, 0x95, ++0x9A, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x50, 0x27, ++0xEF, 0xF1, 0x74, 0x7A, 0x95, 0x79, 0x99, 0x12, ++0x5F, 0xA6, 0xBF, 0x01, 0x12, 0x90, 0x95, 0x99, ++0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0x9B, 0xF5, 0x82, ++0xE4, 0x34, 0x95, 0xF5, 0x83, 0xEF, 0xF0, 0x90, ++0x95, 0x9A, 0xE0, 0x04, 0xF0, 0x80, 0xCF, 0x75, ++0x45, 0x01, 0x75, 0x46, 0x95, 0x75, 0x47, 0x9B, ++0x75, 0x48, 0x08, 0xD1, 0x2B, 0x12, 0x69, 0xF5, ++0x90, 0x95, 0x53, 0x74, 0x24, 0xF0, 0x90, 0x95, ++0x75, 0x74, 0x08, 0xF0, 0x75, 0x45, 0x01, 0x75, ++0x46, 0x95, 0x75, 0x47, 0xA3, 0xF5, 0x48, 0x7B, ++0x01, 0x7A, 0x95, 0x79, 0x78, 0x12, 0x69, 0xF5, ++0x90, 0x95, 0x76, 0x74, 0x25, 0xF0, 0x90, 0x95, ++0x98, 0x74, 0x08, 0xF0, 0x11, 0xEB, 0x12, 0xBF, ++0xC1, 0x12, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x95, ++0x79, 0x76, 0x12, 0x96, 0x35, 0x7F, 0x04, 0x12, ++0x04, 0x7E, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x55, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x12, 0x87, ++0xAE, 0x90, 0x95, 0x55, 0xF0, 0x12, 0x87, 0xB9, ++0x90, 0x95, 0x56, 0x12, 0x87, 0xA2, 0x90, 0x95, ++0x57, 0x12, 0x87, 0x72, 0x90, 0x95, 0x58, 0x12, ++0x87, 0x61, 0x90, 0x95, 0x59, 0x12, 0x87, 0x68, ++0x90, 0x95, 0x5A, 0xF0, 0xEF, 0x12, 0x86, 0x4B, ++0xC6, 0x7C, 0x00, 0xC6, 0x88, 0x01, 0xC6, 0x8F, ++0x02, 0xC6, 0x96, 0x03, 0xC6, 0x9D, 0x04, 0xC6, ++0xA4, 0x05, 0xC6, 0xAE, 0x06, 0xC6, 0xD7, 0x07, ++0x00, 0x00, 0xC7, 0x35, 0x90, 0x95, 0x53, 0x74, ++0x02, 0xF0, 0xA3, 0x74, 0x29, 0xF0, 0xE1, 0x3A, ++0xF1, 0x5C, 0x74, 0x2A, 0xF0, 0xE1, 0x3A, 0xF1, ++0x54, 0x74, 0x31, 0xF0, 0xE1, 0x3A, 0xF1, 0x54, ++0x74, 0x32, 0xF0, 0xE1, 0x3A, 0xF1, 0x5C, 0x74, ++0x33, 0xF0, 0xE1, 0x3A, 0xD1, 0x2B, 0x90, 0x8A, ++0x83, 0x12, 0xBF, 0xC4, 0xE1, 0x51, 0x90, 0x95, ++0x55, 0xE0, 0x90, 0x88, 0xE1, 0xF0, 0x90, 0x95, ++0x56, 0xE0, 0x90, 0x88, 0xE2, 0xF0, 0x90, 0x95, ++0x57, 0xE0, 0x90, 0x88, 0xE3, 0xF0, 0x90, 0x95, ++0x58, 0xE0, 0x90, 0x88, 0xE4, 0xF0, 0x90, 0x95, ++0x59, 0xE0, 0x90, 0x88, 0xE5, 0xF0, 0x22, 0x90, ++0x95, 0x55, 0xE0, 0x90, 0x95, 0x42, 0xF0, 0x90, ++0x95, 0x58, 0x12, 0x8D, 0xD4, 0x78, 0x10, 0x12, ++0x03, 0xFE, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, ++0xC0, 0x07, 0xA3, 0x12, 0x8D, 0xD4, 0x78, 0x18, ++0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, ++0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0xC0, 0x04, ++0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x95, ++0x57, 0x12, 0x8D, 0xD4, 0x78, 0x08, 0x12, 0x03, ++0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0x12, 0x86, 0x20, 0xF1, 0xA7, 0x90, 0x95, ++0x56, 0x12, 0x8D, 0xD4, 0x12, 0x86, 0x20, 0x90, ++0x95, 0x38, 0x02, 0x04, 0x31, 0xF1, 0x54, 0x74, ++0xFF, 0xF0, 0x90, 0x95, 0x54, 0xE0, 0xFF, 0x90, ++0x95, 0x53, 0xE0, 0xFD, 0xD1, 0x2B, 0x90, 0x8A, ++0xCF, 0xE0, 0xF8, 0xA3, 0xE0, 0xF5, 0x82, 0x88, ++0x83, 0x02, 0x04, 0x7E, 0x90, 0x95, 0x53, 0x74, ++0x01, 0xF0, 0xA3, 0x22, 0x90, 0x95, 0x53, 0x74, ++0x06, 0xF0, 0xA3, 0x22, 0xE4, 0xA3, 0xF0, 0xA3, ++0xF0, 0xA3, 0xF0, 0x22, 0x25, 0xE0, 0x25, 0xE0, ++0xFE, 0xEF, 0x4E, 0x22, 0x24, 0xA8, 0xFF, 0xE4, ++0x34, 0x01, 0xFE, 0x7B, 0x01, 0x22, 0x90, 0x01, ++0xE4, 0x74, 0x1D, 0xF0, 0xA3, 0x74, 0x02, 0xF0, ++0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, ++0xE4, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x94, ++0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, ++0xF0, 0x22, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, ++0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, ++0xE4, 0x75, 0xF0, 0x01, 0x12, 0x02, 0xE7, 0x7F, ++0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0xEF, 0xB4, ++0xFF, 0x06, 0x90, 0x93, 0xF4, 0xED, 0xF0, 0x22, ++0xEF, 0xF4, 0xFE, 0x90, 0x93, 0xF4, 0x81, 0x71, ++0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, ++0xF2, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, ++0xAF, 0x9A, 0x12, 0x93, 0xC7, 0xFF, 0x54, 0x7F, ++0x90, 0x88, 0x36, 0xF0, 0xEF, 0x12, 0xA3, 0x5C, ++0xA3, 0xF0, 0x12, 0x87, 0xAE, 0xFD, 0x54, 0xF0, ++0xC4, 0x54, 0x0F, 0xFF, 0x90, 0x88, 0x34, 0xE0, ++0x54, 0xF0, 0x4F, 0x12, 0x87, 0xA2, 0xFC, 0x54, ++0x01, 0x25, 0xE0, 0xFF, 0x90, 0x88, 0x31, 0xE0, ++0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, 0x04, 0xC3, ++0x13, 0xFF, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFD, ++0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, 0x54, 0xF0, ++0xFF, 0xA3, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, 0x12, ++0x87, 0xB9, 0x90, 0x88, 0x35, 0x12, 0x87, 0x72, ++0xFD, 0x90, 0x8A, 0x89, 0x12, 0x96, 0x47, 0x7F, ++0x02, 0x12, 0x04, 0x7E, 0x12, 0xA8, 0x96, 0x12, ++0x87, 0x62, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x88, ++0x9B, 0x11, 0xC5, 0x4F, 0x12, 0x87, 0x60, 0xFE, ++0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, ++0x90, 0x88, 0x9B, 0xF0, 0xEE, 0x54, 0x08, 0xFE, ++0xEF, 0x54, 0xF7, 0x12, 0x87, 0x5F, 0x11, 0xAE, ++0x90, 0x88, 0x9B, 0x11, 0xA5, 0x12, 0x87, 0x5F, ++0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0x90, ++0x88, 0x9B, 0xF0, 0x12, 0x5C, 0x5F, 0x90, 0x88, ++0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, ++0xE0, 0x54, 0xFB, 0xF0, 0x12, 0xBF, 0x9F, 0xF0, ++0x90, 0x88, 0x36, 0x11, 0xB8, 0x12, 0xB7, 0x63, ++0x90, 0x01, 0xBE, 0xF0, 0x22, 0xF0, 0xEE, 0x54, ++0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x22, 0xFE, 0x54, ++0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x22, ++0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x88, 0x38, ++0xE0, 0x90, 0x01, 0xBB, 0x22, 0xE0, 0x54, 0xFE, ++0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, ++0x54, 0xFD, 0x22, 0x12, 0x02, 0x06, 0x90, 0x88, ++0x9C, 0xF0, 0x60, 0x39, 0xA3, 0xE0, 0x20, 0xE0, ++0x34, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, 0xE4, ++0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x88, ++0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x1D, ++0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, ++0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, 0x13, 0x54, ++0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, ++0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, 0x90, 0x93, ++0x3F, 0xE0, 0x20, 0xE0, 0x02, 0x21, 0xD8, 0xE4, ++0x90, 0x95, 0x53, 0xF0, 0x31, 0xD9, 0x40, 0x02, ++0x21, 0xD8, 0x51, 0x6B, 0x80, 0x05, 0xC3, 0x33, ++0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, ++0x40, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x02, 0x21, ++0xD0, 0x12, 0x02, 0x06, 0xFF, 0x30, 0xE0, 0x1A, ++0x90, 0x93, 0x41, 0xE0, 0xFE, 0x90, 0x95, 0x53, ++0xE0, 0xFD, 0x74, 0x01, 0xA8, 0x05, 0x08, 0x80, ++0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, ++0x41, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x16, ++0x90, 0x93, 0x42, 0xE0, 0xFF, 0x90, 0x95, 0x53, ++0x12, 0xAF, 0x28, 0x80, 0x02, 0xC3, 0x33, 0xD8, ++0xFC, 0x4F, 0x90, 0x93, 0x42, 0xF0, 0x12, 0x87, ++0xAE, 0xFF, 0x90, 0x95, 0x53, 0xE0, 0xFE, 0x24, ++0x43, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, ++0xEF, 0xF0, 0x12, 0x87, 0xB9, 0xFF, 0x74, 0x48, ++0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0x12, 0x87, ++0x9F, 0xFF, 0x74, 0x4D, 0x2E, 0xF5, 0x82, 0xE4, ++0x34, 0x93, 0x12, 0x87, 0x6F, 0xFF, 0x74, 0x52, ++0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, ++0xEF, 0xF0, 0x90, 0x93, 0x40, 0xE0, 0xFF, 0x74, ++0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, ++0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x40, 0xF0, 0x22, ++0x90, 0x95, 0x53, 0xE0, 0x04, 0xF0, 0x21, 0x24, ++0x22, 0x90, 0x95, 0x53, 0xE0, 0xFF, 0xC3, 0x94, ++0x05, 0x22, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, ++0x90, 0x89, 0x2E, 0x12, 0x86, 0x42, 0x7B, 0xFF, ++0x7A, 0x80, 0x79, 0x80, 0x90, 0x89, 0x31, 0x12, ++0x86, 0x42, 0x7A, 0x80, 0x79, 0xBF, 0x90, 0x89, ++0x34, 0x12, 0x86, 0x42, 0x7A, 0x81, 0x79, 0x61, ++0x90, 0x89, 0x3A, 0x12, 0x86, 0x42, 0x7A, 0x81, ++0x79, 0x75, 0x90, 0x89, 0x3D, 0x12, 0x86, 0x42, ++0x7A, 0x81, 0x79, 0x9D, 0x90, 0x89, 0x40, 0x12, ++0x86, 0x42, 0x51, 0x5E, 0x7A, 0x81, 0x79, 0xD9, ++0x90, 0x89, 0x49, 0x12, 0x86, 0x42, 0x7A, 0x82, ++0x79, 0x01, 0x90, 0x89, 0x4C, 0x12, 0x86, 0x42, ++0xE4, 0x90, 0x96, 0x5A, 0xF0, 0x90, 0x96, 0x49, ++0xF0, 0x90, 0x95, 0x53, 0xF0, 0x31, 0xD9, 0x50, ++0x14, 0x74, 0x6B, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x96, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0x95, 0x53, ++0xE0, 0x04, 0xF0, 0x80, 0xE8, 0x22, 0x7A, 0x81, ++0x79, 0xB1, 0x90, 0x89, 0x46, 0x02, 0x86, 0x42, ++0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, ++0x07, 0x08, 0x22, 0xE4, 0x90, 0x95, 0xAE, 0xF0, ++0xF1, 0xA8, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, ++0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, ++0xE4, 0xFF, 0xB1, 0xD6, 0x90, 0x93, 0x3F, 0xE0, ++0x20, 0xE0, 0x02, 0x61, 0x74, 0x12, 0x8F, 0xEE, ++0x44, 0x02, 0xB1, 0x98, 0xE4, 0x90, 0x95, 0xAF, ++0xF0, 0x90, 0x95, 0xAF, 0xE0, 0xFF, 0xC3, 0x94, ++0x05, 0x50, 0x30, 0x51, 0x6B, 0x80, 0x05, 0xC3, ++0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, ++0x93, 0x42, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x13, ++0x90, 0x95, 0xAF, 0xB1, 0x27, 0xF0, 0x90, 0x95, ++0xAF, 0xB1, 0x08, 0xF0, 0xE0, 0x44, 0x40, 0xF0, ++0x12, 0xC7, 0xB7, 0x90, 0x95, 0xAF, 0xE0, 0x04, ++0xF0, 0x80, 0xC6, 0x90, 0x07, 0xC7, 0xE4, 0xF0, ++0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, ++0x77, 0xF0, 0x90, 0x07, 0xC4, 0xE4, 0xF0, 0x90, ++0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, ++0xA3, 0xF1, 0x6D, 0x90, 0x02, 0x26, 0xE0, 0x44, ++0x01, 0xF0, 0xE0, 0x90, 0x95, 0xB0, 0xF0, 0x90, ++0x95, 0xB0, 0xE0, 0x30, 0xE0, 0x18, 0x90, 0x95, ++0xAE, 0xE0, 0x04, 0xF1, 0x65, 0x90, 0x02, 0x26, ++0xE0, 0x90, 0x95, 0xB0, 0xF0, 0x90, 0x95, 0xAE, ++0xE0, 0xD3, 0x94, 0xFA, 0x40, 0xE1, 0x90, 0x02, ++0x03, 0x74, 0x80, 0xF0, 0x90, 0x04, 0x24, 0xE0, ++0x90, 0x95, 0xB1, 0xF0, 0x90, 0x04, 0x22, 0xE0, ++0x44, 0x10, 0xF0, 0x90, 0x02, 0x00, 0xE0, 0x90, ++0x95, 0xB0, 0xF0, 0x90, 0x02, 0x01, 0x71, 0x83, ++0x90, 0x02, 0x02, 0x71, 0x83, 0x90, 0x02, 0x14, ++0x71, 0x83, 0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x04, ++0x24, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x54, 0xEF, ++0xF0, 0x90, 0x95, 0xB1, 0xE0, 0x90, 0x04, 0x24, ++0xF0, 0x90, 0xFD, 0x09, 0x74, 0xFF, 0xF0, 0x90, ++0xFD, 0x08, 0xE4, 0xF0, 0x91, 0xD8, 0xE4, 0xFD, ++0x12, 0x76, 0xF7, 0x90, 0x88, 0x32, 0xE0, 0x54, ++0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x95, 0xB0, ++0xE0, 0x2F, 0xF0, 0x22, 0x75, 0x66, 0x14, 0x90, ++0x88, 0x32, 0xE0, 0x44, 0x10, 0xF0, 0x91, 0xD8, ++0x7D, 0x01, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x41, ++0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, 0x90, ++0x88, 0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, ++0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, ++0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, ++0x93, 0x3F, 0xE0, 0x30, 0xE0, 0x6D, 0x90, 0xFD, ++0x09, 0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, 0x90, ++0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, ++0x95, 0xAE, 0xF0, 0x90, 0x95, 0xAE, 0xE0, 0xFF, ++0xC3, 0x94, 0x05, 0x50, 0x30, 0x51, 0x6B, 0x80, ++0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, ++0xFF, 0x90, 0x93, 0x41, 0xE0, 0xFD, 0xEF, 0x5D, ++0x60, 0x13, 0x90, 0x95, 0xAE, 0xB1, 0x27, 0xF0, ++0x90, 0x95, 0xAE, 0xB1, 0x08, 0xF0, 0xE0, 0x44, ++0x20, 0xF0, 0x12, 0xC7, 0xB7, 0x90, 0x95, 0xAE, ++0xE0, 0x04, 0xF0, 0x80, 0xC6, 0x91, 0xC1, 0x54, ++0xFE, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x91, ++0xC1, 0x44, 0x08, 0xFD, 0x7F, 0x92, 0x12, 0x7B, ++0x2E, 0x12, 0x8F, 0xEE, 0x54, 0xFD, 0xFD, 0x7F, ++0x02, 0x80, 0x07, 0x91, 0xC1, 0x44, 0x01, 0xFD, ++0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x7F, 0x08, 0x12, ++0x7B, 0x41, 0xEF, 0x44, 0x10, 0xFD, 0x7F, 0x08, ++0x12, 0x7B, 0x2E, 0x7F, 0x01, 0xB1, 0xD6, 0x90, ++0x00, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, ++0x6A, 0x7F, 0x92, 0x12, 0x7B, 0x41, 0xEF, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x71, ++0x8C, 0x51, 0x73, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, ++0x01, 0xFF, 0x90, 0x88, 0xE0, 0xE0, 0xFB, 0x90, ++0x88, 0xDF, 0xE0, 0x90, 0x92, 0x90, 0xF0, 0x22, ++0x90, 0x88, 0x39, 0xE0, 0xFF, 0x60, 0x03, 0xB4, ++0x08, 0x0D, 0xD1, 0x91, 0xBF, 0x01, 0x08, 0x91, ++0xC8, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, ++0xE0, 0xFF, 0x24, 0x43, 0xF5, 0x82, 0xE4, 0x34, ++0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB2, 0xF0, ++0x74, 0x48, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, ++0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB3, 0x22, 0xE0, ++0xFF, 0x24, 0x4D, 0xF5, 0x82, 0xE4, 0x34, 0x93, ++0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, ++0x52, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, ++0x83, 0xE0, 0x90, 0x01, 0xB1, 0x22, 0x90, 0x88, ++0x31, 0xE0, 0x30, 0xE0, 0x18, 0x90, 0x88, 0x2C, ++0xE0, 0xFF, 0x30, 0xE0, 0x0E, 0xC3, 0x13, 0x30, ++0xE0, 0x07, 0xF1, 0x75, 0xBF, 0x01, 0x06, 0x80, ++0x02, 0x80, 0x00, 0x91, 0xF0, 0x22, 0x7F, 0x02, ++0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, ++0x02, 0x12, 0x7B, 0x2E, 0x7F, 0x02, 0x12, 0x7B, ++0x41, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x12, ++0x7B, 0x2E, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, ++0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x12, 0x7B, 0x2E, ++0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, ++0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD1, 0x84, 0x90, ++0x96, 0xED, 0x12, 0x04, 0x31, 0x90, 0x96, 0xED, ++0xD1, 0x7B, 0xD1, 0x74, 0x90, 0x01, 0x01, 0xE0, ++0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, ++0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, ++0x06, 0xB4, 0x74, 0x86, 0xF0, 0xB1, 0x90, 0xB1, ++0x66, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x97, ++0x03, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, ++0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, ++0x02, 0x7F, 0x01, 0x90, 0x97, 0x03, 0xE0, 0x6F, ++0x60, 0x33, 0xC3, 0x90, 0x97, 0x05, 0xE0, 0x94, ++0x88, 0x90, 0x97, 0x04, 0xE0, 0x94, 0x13, 0x40, ++0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, ++0x22, 0x90, 0x97, 0x04, 0x12, 0xC7, 0xB0, 0xD3, ++0x90, 0x97, 0x05, 0xE0, 0x94, 0x32, 0x90, 0x97, ++0x04, 0xE0, 0x94, 0x00, 0x40, 0xC2, 0x90, 0x01, ++0xC6, 0xE0, 0x30, 0xE0, 0xBB, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD1, 0x84, 0x90, ++0x96, 0xF1, 0x12, 0x04, 0x31, 0x90, 0x96, 0xF1, ++0xD1, 0x7B, 0xD1, 0x74, 0x12, 0x92, 0x43, 0x90, ++0x06, 0xB7, 0x74, 0x11, 0xF0, 0x7F, 0x03, 0x7E, ++0x00, 0x12, 0x7C, 0x6A, 0x90, 0x06, 0xB4, 0xE0, ++0x54, 0x0F, 0x70, 0xF1, 0xB1, 0x66, 0x12, 0x8F, ++0xEE, 0x54, 0xFE, 0xB1, 0x98, 0x90, 0x01, 0x00, ++0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, ++0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x30, 0x7E, 0x08, ++0x02, 0x70, 0xAD, 0x12, 0x04, 0xB8, 0x90, 0x92, ++0x18, 0x02, 0x04, 0x31, 0x7F, 0x30, 0x7E, 0x08, ++0x12, 0x70, 0x70, 0xED, 0x44, 0x80, 0xFD, 0xEC, ++0x22, 0x90, 0x93, 0x3B, 0xE0, 0xC3, 0x13, 0x20, ++0xE0, 0x35, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, ++0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, ++0x60, 0x05, 0x75, 0x66, 0x01, 0x80, 0x2E, 0x90, ++0x02, 0x96, 0xE0, 0x60, 0x05, 0x75, 0x66, 0x10, ++0x80, 0x23, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, ++0x02, 0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, ++0xE3, 0x05, 0x75, 0x66, 0x04, 0x80, 0x0E, 0x90, ++0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x66, ++0x20, 0x80, 0x02, 0xE1, 0x5D, 0x90, 0x01, 0xB9, ++0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x66, ++0xF0, 0x7F, 0x00, 0x22, 0xE4, 0xF5, 0x7A, 0xEF, ++0x14, 0xF5, 0x79, 0xED, 0xFF, 0xE5, 0x79, 0xF5, ++0x82, 0x33, 0x95, 0xE0, 0xF5, 0x83, 0xC3, 0xE5, ++0x82, 0x9F, 0x74, 0x80, 0xF8, 0x65, 0x83, 0x98, ++0x40, 0x50, 0xE5, 0x79, 0x78, 0x03, 0xA2, 0xE7, ++0x13, 0xD8, 0xFB, 0xFF, 0x33, 0x95, 0xE0, 0xFE, ++0xEB, 0xF1, 0x82, 0xE5, 0x82, 0x2F, 0xF5, 0x82, ++0xE5, 0x83, 0x3E, 0xF5, 0x83, 0xE0, 0xF5, 0x82, ++0x75, 0x83, 0x00, 0xE5, 0x79, 0x51, 0x68, 0x80, ++0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, ++0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, ++0x4E, 0x60, 0x13, 0x85, 0x79, 0x7B, 0x05, 0x7A, ++0x90, 0x95, 0xE3, 0xE0, 0x65, 0x7A, 0x60, 0x0A, ++0xE5, 0x7B, 0xD3, 0x9D, 0x40, 0x04, 0x15, 0x79, ++0x80, 0x99, 0xAF, 0x7B, 0x22, 0x90, 0x01, 0xB8, ++0xE4, 0xF0, 0x7F, 0x01, 0x22, 0xF0, 0x7F, 0x0A, ++0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x74, 0x0F, 0xF0, ++0xA3, 0x74, 0xC0, 0xF0, 0x22, 0x90, 0x88, 0x2F, ++0xE0, 0x64, 0x02, 0x7F, 0x01, 0x60, 0x02, 0x7F, ++0x00, 0x22, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, ++0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, ++0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, ++0xF1, 0x65, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xC0, ++0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, ++0x90, 0x01, 0xC4, 0x74, 0xA8, 0xF0, 0x74, 0xCF, ++0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x7B, 0x41, 0xEF, ++0x20, 0xE0, 0xF7, 0x74, 0xA8, 0x04, 0x90, 0x01, ++0xC4, 0xF0, 0x74, 0xCF, 0xA3, 0xF0, 0x22, 0x12, ++0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x3F, ++0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x30, 0xE0, 0x03, ++0x12, 0xC7, 0x64, 0x22, 0x12, 0x02, 0x06, 0xFF, ++0x90, 0x93, 0xE6, 0xF0, 0xBF, 0x01, 0x0A, 0x7F, ++0x01, 0x12, 0xC1, 0x85, 0xE4, 0x90, 0x93, 0xE6, ++0xF0, 0x22, 0xE4, 0xFD, 0x02, 0x97, 0xF3, 0x90, ++0x95, 0xEB, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, ++0xFF, 0xA3, 0xE0, 0x90, 0x96, 0x0F, 0xF0, 0xE0, ++0xFE, 0x6F, 0x60, 0x71, 0x90, 0x95, 0xEC, 0x74, ++0x03, 0xF0, 0x90, 0x96, 0x0E, 0x74, 0x08, 0xF0, ++0xEE, 0x04, 0x54, 0x0F, 0xFF, 0xE4, 0xFE, 0xEF, ++0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, ++0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2E, ++0x11, 0x83, 0xE0, 0xFD, 0x74, 0xEE, 0x2E, 0xF5, ++0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xED, 0xF0, ++0x0E, 0xEE, 0xB4, 0x08, 0xDA, 0x7B, 0x01, 0x7A, ++0x95, 0x79, 0xEC, 0x12, 0xBF, 0xC1, 0x12, 0x04, ++0x7E, 0x90, 0x96, 0x0F, 0xE0, 0x04, 0x54, 0x0F, ++0xFF, 0xF0, 0xBF, 0x0F, 0x02, 0xE4, 0xF0, 0x90, ++0x96, 0x0F, 0xE0, 0x90, 0x04, 0x7F, 0xF0, 0x90, ++0x95, 0xEB, 0xE0, 0x70, 0x05, 0x90, 0x8A, 0xE5, ++0x80, 0x03, 0x90, 0x8A, 0x79, 0x12, 0x96, 0x47, ++0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xE4, 0xFF, ++0x02, 0xCF, 0xF7, 0xF5, 0x82, 0xE4, 0x35, 0x83, ++0xF5, 0x83, 0x22, 0x90, 0x95, 0xEB, 0xEF, 0xF0, ++0x90, 0x88, 0x2B, 0xE0, 0x90, 0x95, 0xFD, 0xF0, ++0xE4, 0x90, 0x95, 0xEC, 0xF0, 0x90, 0x95, 0xFD, ++0xE0, 0xFE, 0x90, 0x95, 0xEC, 0xE0, 0xFF, 0xC3, ++0x9E, 0x50, 0x2C, 0xE0, 0xFE, 0x31, 0xC1, 0xE4, ++0xF0, 0xEE, 0x51, 0x75, 0xE0, 0x30, 0xE7, 0x0E, ++0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x56, 0x12, ++0x04, 0x6E, 0xE4, 0xF0, 0x80, 0x0C, 0x12, 0x7C, ++0x8F, 0x90, 0x95, 0xEC, 0xE0, 0x31, 0xC1, 0x74, ++0x01, 0xF0, 0x12, 0xAF, 0x30, 0x80, 0xC6, 0x7F, ++0x0C, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0xE4, 0x90, ++0x95, 0xEC, 0xF0, 0x90, 0x95, 0xFD, 0xE0, 0xFF, ++0x90, 0x95, 0xEC, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, ++0x02, 0x21, 0xC0, 0x74, 0xED, 0x2E, 0x31, 0xC3, ++0xE0, 0x70, 0x02, 0x21, 0xBB, 0xEE, 0xC4, 0x54, ++0xF0, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x81, ++0xF5, 0x83, 0xE0, 0xFD, 0xEE, 0xC4, 0x54, 0xF0, ++0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, ++0x83, 0x31, 0xCB, 0xFC, 0x75, 0xF0, 0x12, 0xB1, ++0xB2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xEC, 0xC4, ++0x54, 0xF0, 0x24, 0x0A, 0xF5, 0x82, 0xE4, 0x34, ++0x81, 0xF5, 0x83, 0xE0, 0xFD, 0xEC, 0x31, 0xDD, ++0x31, 0xCB, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x57, ++0x12, 0x04, 0x6E, 0xEE, 0x8F, 0xF0, 0x12, 0x02, ++0xE7, 0x7F, 0x01, 0x90, 0x95, 0xEC, 0xE0, 0xFE, ++0x31, 0xDD, 0xE5, 0x82, 0x2F, 0x11, 0x83, 0xE0, ++0xFD, 0x75, 0xF0, 0x12, 0xEE, 0x90, 0x89, 0x57, ++0x12, 0x04, 0x6E, 0x75, 0xF0, 0x02, 0xEF, 0x12, ++0x04, 0x6E, 0xE4, 0x8D, 0xF0, 0x12, 0x02, 0xE7, ++0x0F, 0xEF, 0xB4, 0x05, 0xD6, 0x31, 0xD4, 0x24, ++0x09, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, ++0xE0, 0xFE, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, ++0x55, 0x12, 0x04, 0x6E, 0xEE, 0xF0, 0x31, 0xD4, ++0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, ++0x83, 0xE0, 0xFE, 0x51, 0x56, 0xEE, 0xF0, 0x90, ++0x95, 0xEC, 0xE0, 0xFF, 0x90, 0x95, 0xEB, 0xE0, ++0xFD, 0x31, 0xEE, 0x90, 0x95, 0xEC, 0xE0, 0x75, ++0xF0, 0x12, 0x90, 0x89, 0x56, 0x12, 0x04, 0x6E, ++0x74, 0x01, 0xF0, 0x12, 0xAF, 0x30, 0x01, 0xE3, ++0x22, 0x24, 0xED, 0xF5, 0x82, 0xE4, 0x34, 0x95, ++0xF5, 0x83, 0x22, 0xE0, 0xFE, 0xED, 0xFF, 0x90, ++0x95, 0xEC, 0xE0, 0x22, 0x90, 0x95, 0xEC, 0xE0, ++0xFF, 0xC4, 0x54, 0xF0, 0x22, 0xC4, 0x54, 0xF0, ++0x24, 0x0B, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, ++0x83, 0x22, 0x7D, 0x01, 0xAF, 0x67, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x10, ++0x51, 0x11, 0x90, 0x89, 0x5F, 0x51, 0x42, 0x90, ++0x89, 0x53, 0x51, 0x42, 0x51, 0x4E, 0xE4, 0xF0, ++0x51, 0x61, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x57, ++0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, ++0xF0, 0x12, 0xEF, 0x90, 0x89, 0x59, 0x12, 0x04, ++0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, ++0xEF, 0x90, 0x89, 0x5B, 0x12, 0x04, 0x6E, 0xE4, ++0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x90, ++0x89, 0x5D, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, ++0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x22, 0x90, 0x89, ++0x55, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0x74, 0x43, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, ++0x22, 0xEF, 0xC4, 0x54, 0xF0, 0x24, 0x03, 0xF5, ++0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, 0x54, ++0xBF, 0x44, 0x80, 0xFE, 0xEF, 0xC4, 0x54, 0xF0, ++0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, ++0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x97, 0x08, 0xEF, 0xF0, 0x51, 0xF8, ++0x30, 0xE6, 0x38, 0x7F, 0x8D, 0x12, 0x7B, 0x41, ++0xEF, 0x64, 0x01, 0x70, 0x2E, 0x90, 0x97, 0x09, ++0xF0, 0x90, 0x97, 0x09, 0xE0, 0xFD, 0x90, 0x97, ++0x08, 0xE0, 0x12, 0x98, 0xD8, 0xE5, 0x82, 0x2D, ++0x11, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x51, 0xD0, ++0x90, 0x97, 0x09, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, ++0x94, 0x10, 0x40, 0xDD, 0x51, 0xF8, 0x30, 0xE0, ++0x02, 0xB1, 0xB8, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, ++0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, ++0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, ++0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, ++0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0xE4, ++0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x85, 0x4E, ++0x90, 0x95, 0xD5, 0xEF, 0xF0, 0x60, 0xF0, 0x90, ++0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, ++0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE0, 0x0E, ++0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, ++0xFF, 0x11, 0x8B, 0x12, 0x98, 0xE5, 0x71, 0x5C, ++0x30, 0xE1, 0x09, 0x54, 0xFD, 0xF0, 0x90, 0x86, ++0x08, 0x12, 0x92, 0x46, 0x71, 0x5C, 0x30, 0xE2, ++0x09, 0x54, 0xFB, 0xF0, 0x90, 0x86, 0x0A, 0x12, ++0x92, 0x46, 0x71, 0x5C, 0x30, 0xE6, 0x09, 0x54, ++0xBF, 0xF0, 0x90, 0x8A, 0x7D, 0x12, 0x92, 0x46, ++0xD2, 0xAF, 0x80, 0xB3, 0xD2, 0xAF, 0xC2, 0xAF, ++0x90, 0x86, 0xAF, 0xE0, 0x22, 0xE4, 0xFF, 0x01, ++0x8B, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, ++0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, ++0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, ++0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, ++0xC4, 0x74, 0x69, 0xF0, 0x74, 0xD3, 0xA3, 0xF0, ++0x12, 0x64, 0x7F, 0xE5, 0x30, 0x30, 0xE1, 0x02, ++0xB1, 0xDD, 0xE5, 0x2D, 0x30, 0xE1, 0x02, 0x11, ++0x7E, 0xE5, 0x2D, 0x30, 0xE4, 0x02, 0xB1, 0xCC, ++0xE5, 0x2D, 0x30, 0xE5, 0x02, 0xD1, 0x46, 0xE5, ++0x2D, 0x30, 0xE6, 0x02, 0xB1, 0xBF, 0xE5, 0x2F, ++0x30, 0xE0, 0x03, 0x12, 0xBE, 0x22, 0xE5, 0x2F, ++0x30, 0xE1, 0x03, 0x12, 0xB5, 0x13, 0xE5, 0x2F, ++0x30, 0xE2, 0x02, 0xB1, 0xFE, 0xE5, 0x2F, 0x30, ++0xE3, 0x03, 0x12, 0xB6, 0xD2, 0xE5, 0x2F, 0x30, ++0xE4, 0x02, 0xD1, 0x21, 0xE5, 0x2F, 0x30, 0xE5, ++0x02, 0xB1, 0x89, 0xE5, 0x2F, 0x30, 0xE6, 0x02, ++0x91, 0x8D, 0xE5, 0x30, 0x30, 0xE4, 0x02, 0x71, ++0x65, 0xE5, 0x30, 0x30, 0xE5, 0x02, 0x91, 0x43, ++0xE5, 0x36, 0x30, 0xE0, 0x03, 0x12, 0xAC, 0xB8, ++0xE5, 0x36, 0x30, 0xE6, 0x03, 0x12, 0xAC, 0x6A, ++0xE5, 0x36, 0x30, 0xE7, 0x02, 0x91, 0x4B, 0xE5, ++0x37, 0x30, 0xE2, 0x02, 0x91, 0x57, 0xE5, 0x37, ++0x30, 0xE3, 0x02, 0x91, 0x63, 0x74, 0x69, 0x04, ++0x90, 0x01, 0xC4, 0xF0, 0x74, 0xD3, 0xA3, 0xF0, ++0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, ++0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, ++0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, ++0xD0, 0xE0, 0x32, 0x90, 0x8A, 0xDF, 0xB1, 0xAA, ++0x02, 0x04, 0x7A, 0x90, 0x93, 0x03, 0xE0, 0x30, ++0xE0, 0x04, 0x7F, 0x01, 0x91, 0x6F, 0x22, 0x90, ++0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x02, ++0x91, 0x6F, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, ++0xE0, 0x04, 0x7F, 0x03, 0x91, 0x6F, 0x22, 0x90, ++0x95, 0xED, 0xEF, 0xF0, 0x90, 0x95, 0xEB, 0x74, ++0x18, 0xF0, 0x90, 0x96, 0x0D, 0x74, 0x01, 0xF0, ++0xFB, 0x7A, 0x95, 0x79, 0xEB, 0x12, 0x96, 0x35, ++0x7F, 0x04, 0x02, 0x04, 0x7E, 0xE4, 0xFF, 0x12, ++0x78, 0x4A, 0xBF, 0x01, 0x0F, 0x90, 0x88, 0x36, ++0xE0, 0x60, 0x09, 0x91, 0xA5, 0x54, 0x07, 0x70, ++0x03, 0x12, 0xB7, 0x4E, 0x22, 0x90, 0x88, 0x3A, ++0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xE4, 0xF5, 0x7C, ++0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x7C, 0x54, 0xC0, ++0x70, 0x19, 0x91, 0xA5, 0x54, 0xFD, 0xF0, 0x12, ++0xB7, 0x4E, 0x90, 0x88, 0x39, 0xE0, 0x60, 0x41, ++0x12, 0x8F, 0xEE, 0x44, 0x01, 0xFD, 0x7F, 0x02, ++0x02, 0x7B, 0x2E, 0xE5, 0x7C, 0x30, 0xE6, 0x1E, ++0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x18, ++0xB1, 0x7A, 0x12, 0xB7, 0x63, 0x64, 0x02, 0x60, ++0x08, 0x90, 0x8A, 0xE1, 0x12, 0x92, 0x46, 0x80, ++0x07, 0x12, 0x73, 0x8F, 0x80, 0x02, 0x91, 0xA5, ++0xE5, 0x7C, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x05, ++0x12, 0xB4, 0xA3, 0x80, 0x7C, 0xE0, 0x54, 0xFD, ++0xF0, 0x22, 0x90, 0x06, 0xA9, 0x12, 0xAF, 0xA0, ++0xFD, 0x54, 0xC0, 0x70, 0x04, 0x91, 0xA5, 0x80, ++0x5D, 0xED, 0x30, 0xE6, 0x47, 0x90, 0x88, 0x36, ++0xE0, 0x64, 0x02, 0x70, 0x29, 0x90, 0x88, 0x31, ++0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x05, 0xB1, 0x7A, ++0xF0, 0x80, 0x24, 0x12, 0xB7, 0x64, 0x64, 0x01, ++0x70, 0x2C, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x04, ++0xF0, 0x90, 0x8A, 0x71, 0x12, 0x96, 0x47, 0x7F, ++0x01, 0x12, 0x04, 0x7E, 0x80, 0x18, 0xB1, 0x7A, ++0x12, 0xB7, 0x63, 0x64, 0x02, 0x60, 0x08, 0x90, ++0x8A, 0xE1, 0x12, 0x92, 0x46, 0x80, 0x07, 0x12, ++0x73, 0x8F, 0x80, 0x02, 0x91, 0xA5, 0x90, 0x95, ++0xEB, 0xE0, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x05, ++0x12, 0xB4, 0xA3, 0x80, 0x0C, 0xE0, 0x54, 0xFD, ++0xF0, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, ++0x22, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, ++0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, ++0x18, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x12, 0x12, ++0xB7, 0x64, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, ++0xE1, 0xB1, 0xAA, 0x02, 0x04, 0x7A, 0x12, 0x73, ++0x8F, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, ++0xF9, 0x22, 0x90, 0x89, 0x53, 0x02, 0x04, 0x6E, ++0xE4, 0xFD, 0x7F, 0x8D, 0x02, 0x7B, 0x2E, 0x90, ++0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x05, 0xE4, 0xA3, ++0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x8A, 0x75, 0x12, ++0x92, 0x46, 0x90, 0x8A, 0xE5, 0x12, 0x96, 0x47, ++0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x88, 0x36, ++0xE0, 0x70, 0x07, 0x90, 0x88, 0x2C, 0xE0, 0x30, ++0xE0, 0x13, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, ++0x09, 0x12, 0xB3, 0xC6, 0xBF, 0x01, 0x06, 0x02, ++0xB7, 0x6B, 0x12, 0xB7, 0x86, 0x22, 0x90, 0x88, ++0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x05, 0x12, 0xB3, ++0x7C, 0x60, 0x15, 0x90, 0x88, 0x36, 0xE0, 0x70, ++0x04, 0xEF, 0x30, 0xE0, 0x0B, 0x90, 0x88, 0x39, ++0xE0, 0x64, 0x02, 0x60, 0x03, 0x12, 0x88, 0x31, ++0x22, 0x12, 0xB6, 0xC9, 0x70, 0x1F, 0x90, 0x88, ++0x36, 0xE0, 0x60, 0x19, 0x90, 0x88, 0x3A, 0xE0, ++0x20, 0xE4, 0x12, 0x12, 0xBF, 0x93, 0xF0, 0x90, ++0x88, 0x31, 0xE0, 0x12, 0xBF, 0xB6, 0x54, 0x07, ++0x70, 0x03, 0x12, 0xB7, 0x4E, 0x22, 0x90, 0x01, ++0xCF, 0x12, 0xAF, 0xA0, 0xFF, 0x30, 0xE0, 0x07, ++0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, ++0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, ++0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, ++0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, ++0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, ++0x03, 0x12, 0x7B, 0x2E, 0x80, 0xFE, 0x22, 0x12, ++0xAF, 0x3F, 0x64, 0x01, 0x60, 0x02, 0xE1, 0x0D, ++0xEF, 0x24, 0x39, 0x60, 0x12, 0x14, 0x60, 0x19, ++0x24, 0x02, 0x70, 0x1F, 0xE4, 0x90, 0x95, 0x59, ++0xF0, 0xA3, 0x74, 0x06, 0xF0, 0x80, 0x14, 0x90, ++0x95, 0x59, 0x74, 0x06, 0xF0, 0xA3, 0xF0, 0x80, ++0x0A, 0x90, 0x95, 0x59, 0x74, 0x0C, 0xF0, 0xA3, ++0x74, 0x04, 0xF0, 0xF1, 0x21, 0xF1, 0x0E, 0x40, ++0x1C, 0x90, 0x95, 0x57, 0xE0, 0x12, 0xC7, 0x74, ++0x7A, 0x95, 0x79, 0x56, 0x12, 0x5F, 0xA6, 0xBF, ++0x01, 0x07, 0x90, 0x95, 0x56, 0xE0, 0xF4, 0x70, ++0x3C, 0xF1, 0x16, 0x80, 0xE0, 0xF1, 0x21, 0xF1, ++0x0E, 0x40, 0x32, 0x90, 0x95, 0x57, 0xE0, 0xFD, ++0x7C, 0x00, 0x24, 0xA8, 0xFF, 0xEC, 0x34, 0x01, ++0xFE, 0xED, 0x24, 0x01, 0xFD, 0xEC, 0x33, 0xFC, ++0x90, 0x95, 0x59, 0xE0, 0xFB, 0xC3, 0xED, 0x9B, ++0xFD, 0xEC, 0x94, 0x00, 0xFC, 0x90, 0x95, 0x53, ++0x12, 0xAB, 0x7D, 0x12, 0x02, 0x1F, 0xFD, 0xF1, ++0x32, 0xF1, 0x16, 0x80, 0xCA, 0x22, 0x90, 0x95, ++0x58, 0xE0, 0xD3, 0x94, 0x00, 0x22, 0x90, 0x95, ++0x57, 0xE0, 0x04, 0xF0, 0xA3, 0xE0, 0x14, 0xF0, ++0x22, 0x90, 0x95, 0x59, 0xE0, 0x90, 0x95, 0x57, ++0xF0, 0x90, 0x95, 0x5A, 0xE0, 0x90, 0x95, 0x58, ++0xF0, 0x22, 0x8E, 0x61, 0x8F, 0x62, 0x8D, 0x63, ++0xE4, 0x90, 0x95, 0x5B, 0xF0, 0x90, 0x00, 0x37, ++0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x37, 0x12, 0x7B, ++0x2E, 0x7D, 0x69, 0x7F, 0xCF, 0x12, 0x7B, 0x2E, ++0xE5, 0x62, 0xFD, 0x7F, 0x31, 0x12, 0x7B, 0x2E, ++0xE5, 0x61, 0x54, 0x03, 0xFF, 0x90, 0x00, 0x32, ++0xE0, 0x54, 0xFC, 0x4F, 0xFD, 0x7F, 0x32, 0x12, ++0x7B, 0x2E, 0xAD, 0x63, 0x7F, 0x30, 0x12, 0x7B, ++0x2E, 0x90, 0x00, 0x33, 0xE0, 0x44, 0x80, 0xFD, ++0x7F, 0x33, 0x12, 0x7B, 0x2E, 0x90, 0x00, 0x33, ++0xE0, 0x30, 0xE7, 0x09, 0xF1, 0xA9, 0x50, 0x05, ++0xE0, 0x04, 0xF0, 0x80, 0xF0, 0xE4, 0xFD, 0x7F, ++0xCF, 0x12, 0x7B, 0x2E, 0x90, 0x00, 0x37, 0xE0, ++0x54, 0x7F, 0xFD, 0x7F, 0x37, 0x12, 0x7B, 0x2E, ++0xF1, 0xA9, 0x7F, 0x00, 0x50, 0x02, 0x7F, 0x01, ++0x22, 0x90, 0x95, 0x5B, 0xE0, 0xC3, 0x94, 0x64, ++0x22, 0x75, 0x29, 0x12, 0xE4, 0xF5, 0x2A, 0x75, ++0x2B, 0x07, 0x75, 0x2C, 0x32, 0xF5, 0x31, 0x75, ++0x32, 0xC1, 0x75, 0x33, 0x0C, 0xF5, 0x34, 0x90, ++0x01, 0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, ++0xF0, 0xA3, 0xE5, 0x2B, 0xF0, 0xA3, 0xE5, 0x2C, ++0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, ++0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, 0xF0, 0xA3, ++0xE5, 0x34, 0xF0, 0x22, 0x75, 0x39, 0x06, 0x43, ++0x39, 0x10, 0x75, 0x3A, 0x01, 0x43, 0x3A, 0x08, ++0x43, 0x3A, 0x10, 0x75, 0x3B, 0x03, 0x75, 0x3C, ++0x62, 0x43, 0x3C, 0x80, 0x43, 0x3B, 0x04, 0x90, ++0x01, 0x38, 0xE5, 0x39, 0xF0, 0xA3, 0xE5, 0x3A, ++0xF0, 0xA3, 0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, ++0xF0, 0x22, 0x7D, 0x02, 0x90, 0x01, 0xC4, 0x74, ++0x1A, 0xF0, 0x74, 0xD8, 0xA3, 0xF0, 0x90, 0x93, ++0x57, 0xE0, 0xFF, 0xED, 0xC3, 0x9F, 0x50, 0x18, ++0xED, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, ++0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, ++0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0D, 0x80, 0xDE, ++0x74, 0x1A, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, ++0xD8, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0xE4, 0x90, ++0x95, 0xAB, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, ++0x95, 0xAB, 0xE0, 0x64, 0x01, 0xF0, 0x90, 0x93, ++0xF0, 0xE0, 0x70, 0x18, 0x90, 0x93, 0xED, 0xE0, ++0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0x90, 0x95, ++0xAB, 0xE0, 0x24, 0x56, 0x90, 0x01, 0xC4, 0xF0, ++0x74, 0xD8, 0xA3, 0xF0, 0x12, 0x7C, 0x54, 0xBF, ++0x01, 0x03, 0x12, 0x54, 0x9F, 0x90, 0x88, 0x36, ++0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xFF, ++0x90, 0x88, 0x38, 0xE0, 0x6F, 0x60, 0x03, 0x12, ++0xB7, 0x4E, 0xC2, 0xAF, 0x11, 0x1A, 0xBF, 0x01, ++0x03, 0x12, 0xCD, 0x46, 0xD2, 0xAF, 0x11, 0xB8, ++0x12, 0x9F, 0xF3, 0x12, 0x83, 0x4D, 0x80, 0xA7, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0x93, 0xED, 0xE0, 0x60, 0x25, 0x7F, 0x54, 0x7E, ++0x09, 0x12, 0x70, 0x70, 0x31, 0x65, 0x12, 0x04, ++0xB8, 0xEF, 0x44, 0xFE, 0xFF, 0xEE, 0x44, 0x03, ++0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, 0x31, 0x65, ++0x12, 0xCE, 0x7B, 0x7F, 0x54, 0x7E, 0x09, 0x12, ++0x70, 0xAD, 0x90, 0x93, 0xE8, 0xE0, 0x70, 0x29, ++0x90, 0x07, 0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, ++0xF0, 0x90, 0x95, 0xB2, 0x74, 0x22, 0xF0, 0x90, ++0x95, 0xD4, 0x74, 0x01, 0xF0, 0x90, 0x95, 0xB4, ++0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0xB2, 0x12, 0x96, 0x35, 0x7F, 0x04, 0x12, 0x04, ++0x7E, 0x90, 0x93, 0xF0, 0xE0, 0xFF, 0x70, 0x0A, ++0x90, 0x93, 0xED, 0xE0, 0x70, 0x04, 0xA3, 0xE0, ++0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, ++0xF0, 0x90, 0x01, 0xC5, 0x74, 0xEA, 0xF0, 0xA3, ++0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, 0xEF, ++0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, ++0x90, 0x93, 0xED, 0xE0, 0x60, 0x06, 0x90, 0x01, ++0xC4, 0x74, 0x01, 0xF0, 0x90, 0x93, 0xEE, 0xE0, ++0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, 0xAE, ++0x12, 0x04, 0x31, 0x90, 0x95, 0xAE, 0x22, 0x90, ++0x8A, 0x79, 0x74, 0x86, 0xF0, 0xA3, 0x74, 0xFF, ++0xF0, 0x90, 0x8A, 0xE5, 0x74, 0xDA, 0xF0, 0xA3, ++0x74, 0x7E, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0x90, ++0xF0, 0xA3, 0x74, 0xC7, 0xF0, 0x90, 0x8A, 0xB9, ++0x74, 0x92, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x90, ++0x8A, 0xD5, 0x74, 0xAD, 0xF0, 0xA3, 0x74, 0xB2, ++0xF0, 0x90, 0x8A, 0xFB, 0x74, 0x98, 0xF0, 0xA3, ++0x74, 0x49, 0xF0, 0x90, 0x8A, 0xA5, 0x74, 0xA1, ++0xF0, 0xA3, 0x74, 0xF9, 0xF0, 0x90, 0x8A, 0xB5, ++0x74, 0xDE, 0xF0, 0xA3, 0x74, 0x6C, 0xF0, 0x90, ++0x8A, 0xC3, 0x74, 0xDD, 0xF0, 0xA3, 0x74, 0xF1, ++0xF0, 0x90, 0x8A, 0xF3, 0x74, 0xE0, 0xF0, 0xA3, ++0x74, 0x10, 0xF0, 0x90, 0x8A, 0x85, 0x74, 0xE1, ++0xF0, 0xA3, 0x74, 0x72, 0xF0, 0x90, 0x86, 0x04, ++0x74, 0xE2, 0xF0, 0xA3, 0x74, 0x7D, 0xF0, 0x90, ++0x8A, 0xA9, 0x74, 0xE0, 0xF0, 0xA3, 0x74, 0x1C, ++0xF0, 0x90, 0x8B, 0x07, 0x74, 0xE0, 0xF0, 0xA3, ++0x74, 0x4B, 0xF0, 0x90, 0x8A, 0xAD, 0x74, 0xE0, ++0xF0, 0xA3, 0x74, 0xF5, 0xF0, 0x90, 0x86, 0x0C, ++0x74, 0xCD, 0xF0, 0xA3, 0x74, 0x9E, 0xF0, 0x90, ++0x8A, 0xEF, 0x74, 0xCE, 0xF0, 0xA3, 0x74, 0x26, ++0xF0, 0x90, 0x86, 0x00, 0x74, 0xE4, 0xF0, 0xA3, ++0x74, 0x76, 0xF0, 0x90, 0x86, 0x02, 0x74, 0xE4, ++0xF0, 0xA3, 0x74, 0xD5, 0xF0, 0x90, 0x8A, 0xFD, ++0x74, 0xBA, 0xF0, 0xA3, 0x74, 0xDA, 0xF0, 0x90, ++0x8A, 0xF9, 0x74, 0xDE, 0xF0, 0xA3, 0x74, 0x22, ++0xF0, 0x90, 0x8A, 0xDB, 0x74, 0xDE, 0xF0, 0xA3, ++0x74, 0xBE, 0xF0, 0x90, 0x8A, 0xAF, 0x74, 0xA3, ++0xF0, 0xA3, 0x74, 0x9D, 0xF0, 0x90, 0x8A, 0xD3, ++0x74, 0xDD, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0x90, ++0x8A, 0xF5, 0x74, 0xE5, 0xF0, 0xA3, 0x74, 0xA8, ++0xF0, 0x90, 0x8A, 0xA3, 0x74, 0xE6, 0xF0, 0xA3, ++0x74, 0x07, 0xF0, 0x90, 0x86, 0x06, 0x74, 0xDB, ++0xF0, 0xA3, 0x74, 0xE9, 0xF0, 0x22, 0x8F, 0x0D, ++0x7F, 0x02, 0x12, 0x85, 0x27, 0x90, 0x86, 0xAF, ++0xE0, 0x45, 0x0D, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, ++0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, ++0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, ++0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, ++0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x8D, 0xF0, ++0x74, 0xDA, 0xA3, 0xF0, 0x12, 0x6C, 0xD6, 0xE5, ++0x25, 0x30, 0xE7, 0x02, 0x51, 0xE4, 0x74, 0x8D, ++0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xDA, 0xA3, ++0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, ++0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, ++0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x00, 0xAB, 0xE0, ++0xFE, 0x90, 0x00, 0xAA, 0x12, 0xAF, 0xD5, 0x54, ++0x7F, 0x90, 0x95, 0xE9, 0xF0, 0xA3, 0xEF, 0xF0, ++0xE0, 0x30, 0xE1, 0x03, 0x12, 0xBD, 0x75, 0x22, ++0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, ++0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, ++0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, ++0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, ++0x74, 0x00, 0xF0, 0x74, 0xDB, 0xA3, 0xF0, 0x90, ++0x8A, 0x9D, 0x12, 0x92, 0x46, 0x53, 0x91, 0xBF, ++0x74, 0x00, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, ++0xDB, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, ++0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, ++0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, ++0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, ++0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, ++0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x56, 0x90, ++0x01, 0xC4, 0xED, 0xF0, 0x74, 0xDB, 0xFF, 0xA3, ++0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, ++0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, ++0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, ++0xF0, 0xE0, 0x30, 0xE0, 0x2F, 0x90, 0x88, 0xF7, ++0xE0, 0xB4, 0x01, 0x18, 0xA3, 0xE0, 0xB4, 0x01, ++0x23, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, ++0xA3, 0x91, 0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, ++0xB4, 0x02, 0x09, 0x74, 0x03, 0xF0, 0x90, 0x8A, ++0xE7, 0x12, 0x92, 0x46, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, ++0x90, 0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, ++0x12, 0x92, 0x46, 0x90, 0x88, 0xF0, 0xE0, 0x30, ++0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, 0x92, 0x46, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x90, 0x96, 0xEA, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, ++0x90, 0x96, 0xE9, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, ++0x91, 0xF5, 0xE0, 0x90, 0x96, 0xEC, 0xF0, 0x12, ++0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x96, ++0xE9, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x96, ++0xEA, 0xE0, 0x60, 0x05, 0x91, 0xA8, 0x44, 0x80, ++0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, ++0xF0, 0x91, 0xA8, 0x54, 0xC0, 0xF0, 0x90, 0x96, ++0xEC, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x18, 0x2E, ++0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, ++0xF0, 0x90, 0x00, 0x8B, 0xE0, 0xD3, 0x94, 0x03, ++0x74, 0x10, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0x74, 0x04, 0xF0, 0xAF, 0x05, 0x91, ++0xEA, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x96, 0xEB, ++0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, ++0x02, 0x4B, 0x91, 0xE9, 0xEE, 0xF0, 0x74, 0x11, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0x74, 0xFF, 0xF0, 0x74, 0x29, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, ++0xF0, 0x74, 0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, ++0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, ++0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x22, 0x90, 0x96, 0xE2, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x9B, 0xE0, ++0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, ++0x12, 0x04, 0x7E, 0x90, 0x96, 0xE2, 0xA3, 0xE0, ++0xFF, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x96, ++0xE1, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x44, 0x02, ++0x4E, 0xFE, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x86, 0xAD, ++0xA3, 0xE0, 0x24, 0x7F, 0xF5, 0x82, 0xE4, 0x34, ++0x84, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x91, 0xF5, 0xE0, 0x90, 0x97, ++0x19, 0xF0, 0x90, 0x88, 0x32, 0x12, 0xA3, 0x5B, ++0x30, 0xE0, 0x02, 0xA1, 0xCA, 0x90, 0x88, 0x31, ++0xE0, 0x30, 0xE0, 0x1C, 0x12, 0x97, 0x4A, 0x33, ++0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4B, 0xF0, ++0x90, 0x88, 0x53, 0xE0, 0x04, 0x33, 0x33, 0x33, ++0x54, 0xF8, 0x90, 0x88, 0x4A, 0xF0, 0x80, 0x10, ++0x90, 0x88, 0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, ++0x4A, 0x74, 0x08, 0xF0, 0x74, 0x10, 0x2B, 0xFB, ++0x90, 0x88, 0x4A, 0xE0, 0xFE, 0x90, 0x88, 0x49, ++0xE0, 0xD3, 0x9E, 0x50, 0x0E, 0x90, 0x88, 0x3E, ++0xEB, 0xF0, 0x90, 0x88, 0x4B, 0xE0, 0xC3, 0x9D, ++0x2F, 0x80, 0x11, 0xC3, 0xED, 0x9E, 0x2B, 0x90, ++0x88, 0x3E, 0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, ++0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4E, 0xF0, ++0x90, 0x88, 0x4B, 0xB1, 0xD6, 0x90, 0x88, 0x4E, ++0xB1, 0xDF, 0x98, 0x40, 0x04, 0xEF, 0x24, 0x50, ++0xF0, 0x90, 0x88, 0x4E, 0xB1, 0xD6, 0x90, 0x88, ++0x3E, 0xB1, 0xDF, 0x98, 0x40, 0x04, 0xEF, 0x24, ++0x50, 0xF0, 0x90, 0x88, 0x4E, 0x12, 0xB4, 0x92, ++0xFF, 0x7E, 0x00, 0x90, 0x88, 0x42, 0xEE, 0xF0, ++0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, 0xF0, 0x90, ++0x88, 0x4E, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x05, ++0xB1, 0xE0, 0x54, 0xF8, 0x4F, 0xF0, 0xB1, 0xE9, ++0x80, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x01, ++0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, ++0x24, 0x50, 0xFD, 0xE4, 0x33, 0xFC, 0x22, 0xE0, ++0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, ++0x22, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFE, 0xF0, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x91, 0xF5, 0xE0, 0x90, 0x97, 0x14, 0xF0, 0xED, ++0x90, 0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, ++0xF0, 0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, ++0x80, 0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, ++0x67, 0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0x97, 0x13, 0xED, 0xF0, 0x64, ++0x01, 0x60, 0x27, 0xE0, 0xFE, 0x64, 0x02, 0x60, ++0x21, 0xEE, 0x64, 0x29, 0x60, 0x1C, 0xEE, 0x64, ++0x2A, 0x60, 0x17, 0xEE, 0x64, 0x36, 0x60, 0x12, ++0xEE, 0xB4, 0x37, 0x02, 0x80, 0x0C, 0xAD, 0x07, ++0x7F, 0xFF, 0x12, 0xC7, 0xBE, 0x90, 0x93, 0xF4, ++0xE0, 0xFF, 0x90, 0x93, 0xF3, 0xE0, 0x4F, 0x90, ++0x05, 0x22, 0xF0, 0x90, 0x97, 0x13, 0xE0, 0x90, ++0x93, 0x01, 0xF0, 0x22, 0x12, 0x02, 0x06, 0x90, ++0x96, 0x49, 0xF0, 0x22, 0x12, 0x02, 0x06, 0xFE, ++0x12, 0x87, 0xB9, 0xFF, 0x74, 0xD6, 0x2E, 0xF5, ++0x82, 0xE4, 0x34, 0x8D, 0x12, 0x87, 0x9F, 0xFF, ++0x74, 0xC6, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x8D, ++0x12, 0x87, 0x6F, 0xFF, 0x74, 0x4A, 0x2E, 0xD1, ++0xB6, 0xEF, 0xF0, 0x74, 0xC6, 0x2E, 0x12, 0xA3, ++0x71, 0xE0, 0x30, 0xE5, 0x18, 0x75, 0xF0, 0x12, ++0xEE, 0x12, 0x9E, 0xA1, 0x13, 0x13, 0x54, 0x03, ++0xFB, 0xAF, 0x06, 0x74, 0xD6, 0x2E, 0x12, 0x9F, ++0xDA, 0xFD, 0x12, 0x6B, 0xFD, 0x22, 0xF5, 0x82, ++0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0xEF, 0x64, ++0x13, 0x60, 0x04, 0xEF, 0xB4, 0x0B, 0x05, 0x90, ++0x88, 0xE3, 0x80, 0x1F, 0xEF, 0x64, 0x12, 0x60, ++0x04, 0xEF, 0xB4, 0x0A, 0x05, 0x90, 0x88, 0xE4, ++0x80, 0x11, 0xEF, 0x64, 0x11, 0x60, 0x04, 0xEF, ++0xB4, 0x09, 0x05, 0x90, 0x88, 0xE5, 0x80, 0x03, ++0x90, 0x88, 0xE2, 0xE0, 0xF5, 0x0F, 0xAF, 0x0F, ++0x22, 0x7E, 0x00, 0x7F, 0x8E, 0x7D, 0x00, 0x7B, ++0x01, 0x7A, 0x93, 0x79, 0x58, 0x02, 0x04, 0x80, ++0x90, 0x93, 0x58, 0xE0, 0x20, 0xE0, 0x02, 0xE1, ++0x8B, 0x90, 0x93, 0xDA, 0xE0, 0x04, 0x12, 0xA7, ++0x92, 0x04, 0xFF, 0x90, 0x97, 0x0A, 0xF0, 0x90, ++0x93, 0x59, 0xE0, 0xB5, 0x07, 0x05, 0xE4, 0x90, ++0x97, 0x0A, 0xF0, 0x90, 0x93, 0xD8, 0xE0, 0xFF, ++0x60, 0x0F, 0xF1, 0x8C, 0xC3, 0x9F, 0xF1, 0x9F, ++0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x66, ++0x33, 0x90, 0x97, 0x0A, 0xE0, 0x12, 0xA7, 0xD2, ++0x54, 0x07, 0x90, 0x97, 0x0B, 0x12, 0xA7, 0xC9, ++0x54, 0x07, 0xFF, 0x14, 0x60, 0x0F, 0x14, 0x60, ++0x07, 0x14, 0x60, 0x09, 0x24, 0x03, 0x70, 0x0B, ++0x12, 0xA7, 0xF1, 0x80, 0x03, 0x12, 0xA7, 0xB2, ++0x12, 0xA5, 0x96, 0xF1, 0xB2, 0x50, 0x24, 0x90, ++0x97, 0x0B, 0xE0, 0xFF, 0x64, 0x02, 0x60, 0x03, ++0xEF, 0x70, 0x0F, 0xF1, 0x8C, 0x24, 0xFC, 0xFF, ++0xE4, 0x90, 0x92, 0x20, 0xF0, 0xA3, 0xEF, 0x12, ++0xB4, 0xB3, 0xF1, 0x8C, 0xF1, 0x9F, 0xF1, 0xAB, ++0x12, 0x66, 0x33, 0x22, 0x90, 0x97, 0x0A, 0xE0, ++0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5D, 0xF5, 0x82, ++0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x22, 0x90, ++0x92, 0x21, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, ++0x22, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, ++0x01, 0x22, 0x90, 0x93, 0xD7, 0xE0, 0xFF, 0x90, ++0x93, 0xDA, 0xE0, 0xD3, 0x9F, 0x22, 0x90, 0x93, ++0x58, 0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x93, 0xD8, ++0xE0, 0x60, 0x05, 0x7F, 0x07, 0x12, 0xA7, 0xF3, ++0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x0F, ++0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, ++0x90, 0x04, 0x1F, 0xE0, 0x44, 0x40, 0xF0, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, ++0xFE, 0xFD, 0xEF, 0xB4, 0x01, 0x0D, 0xEB, 0xB4, ++0x02, 0x03, 0x0D, 0x80, 0x06, 0xEB, 0xB4, 0x01, ++0x02, 0x7D, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, ++0xF0, 0x4D, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0xB8, 0xE0, ++0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, 0x90, 0x88, ++0xBD, 0xE0, 0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, ++0x36, 0xE0, 0x70, 0x16, 0x90, 0x93, 0x3B, 0xE0, ++0x20, 0xE0, 0x0F, 0x90, 0x86, 0x0C, 0x12, 0x92, ++0x46, 0x90, 0x8A, 0xF9, 0x12, 0x96, 0x47, 0x12, ++0x97, 0xEB, 0x22, 0x90, 0x88, 0x9D, 0xE0, 0x30, ++0xE0, 0x5E, 0x90, 0x95, 0x37, 0xE0, 0x30, 0xE0, ++0x3D, 0x90, 0x95, 0x42, 0xE0, 0xFF, 0x90, 0x95, ++0x41, 0xE0, 0xC3, 0x9F, 0x40, 0x24, 0x11, 0xB3, ++0x90, 0x06, 0xC4, 0x11, 0xB1, 0x78, 0x08, 0x12, ++0x03, 0xEB, 0x90, 0x06, 0xC5, 0x11, 0xB1, 0x78, ++0x10, 0x12, 0x03, 0xEB, 0x90, 0x06, 0xC6, 0x11, ++0xB1, 0x11, 0xB9, 0xE4, 0x90, 0x95, 0x41, 0xF0, ++0x80, 0x1B, 0x11, 0xC4, 0x11, 0xB9, 0x90, 0x95, ++0x41, 0xE0, 0x04, 0xF0, 0x80, 0x0F, 0x90, 0x95, ++0x40, 0xE0, 0x60, 0x09, 0x11, 0xC4, 0x11, 0xB9, ++0xE4, 0x90, 0x95, 0x40, 0xF0, 0x90, 0x8A, 0xBB, ++0x12, 0x96, 0x47, 0xE4, 0xFF, 0x12, 0x04, 0x7E, ++0x22, 0xEF, 0xF0, 0x90, 0x95, 0x38, 0x02, 0x04, ++0xB8, 0x78, 0x18, 0x12, 0x03, 0xEB, 0x90, 0x06, ++0xC7, 0xEF, 0xF0, 0x22, 0x90, 0x95, 0x3C, 0x12, ++0x04, 0xB8, 0x90, 0x06, 0xC4, 0xEF, 0xF0, 0x90, ++0x95, 0x3C, 0x12, 0x04, 0xB8, 0x78, 0x08, 0x12, ++0x03, 0xEB, 0x90, 0x06, 0xC5, 0xEF, 0xF0, 0x90, ++0x95, 0x3C, 0x12, 0x04, 0xB8, 0x78, 0x10, 0x12, ++0x03, 0xEB, 0x90, 0x06, 0xC6, 0xEF, 0xF0, 0x90, ++0x95, 0x3C, 0x02, 0x04, 0xB8, 0x7E, 0x00, 0x7F, ++0x33, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, ++0x9D, 0x12, 0x04, 0x80, 0x90, 0x88, 0x9E, 0x74, ++0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0x7E, 0x00, ++0x7F, 0x0C, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x95, ++0x79, 0x37, 0x12, 0x04, 0x80, 0x90, 0x86, 0xB3, ++0xE0, 0xFC, 0x64, 0x02, 0x70, 0x19, 0x90, 0xFD, ++0x80, 0xE0, 0x7E, 0x00, 0x30, 0xE2, 0x02, 0x7E, ++0x01, 0xEE, 0x12, 0xA3, 0x79, 0xFE, 0x90, 0x88, ++0xA0, 0xE0, 0x54, 0xBF, 0x4E, 0xF0, 0x22, 0xEC, ++0x64, 0x01, 0x70, 0x0D, 0x90, 0xFD, 0x70, 0xE0, ++0x7F, 0x00, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, ++0x13, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, 0x70, ++0x18, 0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, 0x30, ++0xE2, 0x02, 0x7F, 0x01, 0xEF, 0x12, 0xA3, 0x79, ++0xFF, 0x90, 0x88, 0xA0, 0xE0, 0x54, 0xBF, 0x4F, ++0xF0, 0x22, 0x90, 0x96, 0xDB, 0xEF, 0xF0, 0x90, ++0x88, 0xE0, 0xE0, 0x70, 0x51, 0x7F, 0x48, 0x7E, ++0x09, 0x12, 0x70, 0x70, 0xEE, 0x54, 0x0F, 0xFE, ++0xE4, 0xFD, 0xFC, 0x90, 0x96, 0xDC, 0x12, 0x04, ++0x31, 0xE4, 0x7F, 0x80, 0x51, 0x49, 0x70, 0x05, ++0x90, 0x88, 0xBE, 0x80, 0x1B, 0xE4, 0xFF, 0xFE, ++0x51, 0x4B, 0x70, 0x0A, 0x90, 0x88, 0xBE, 0x04, ++0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x56, 0xE4, 0xFF, ++0x51, 0x49, 0x70, 0x09, 0x90, 0x88, 0xBE, 0x04, ++0xF0, 0xA3, 0xF0, 0x80, 0x47, 0xE4, 0x7F, 0x80, ++0xFE, 0x51, 0x4B, 0x70, 0x3F, 0x90, 0x88, 0xBE, ++0xF0, 0xA3, 0x04, 0xF0, 0x80, 0x36, 0x7F, 0x2C, ++0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x02, ++0x51, 0x5E, 0x60, 0x08, 0x90, 0x88, 0xBE, 0x74, ++0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xBE, ++0xF0, 0x7F, 0x30, 0x7E, 0x09, 0x12, 0x70, 0x70, ++0xEF, 0x54, 0x01, 0x51, 0x5E, 0x60, 0x07, 0xE4, ++0x90, 0x88, 0xBF, 0xF0, 0x80, 0x06, 0x90, 0x88, ++0xBF, 0x74, 0x01, 0xF0, 0x90, 0x88, 0xB8, 0xE0, ++0x44, 0x01, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x96, ++0x47, 0x7D, 0x11, 0x51, 0x74, 0x12, 0x92, 0x46, ++0x90, 0x07, 0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, ++0x90, 0x96, 0xDB, 0xE0, 0xFD, 0x70, 0x02, 0x80, ++0x1C, 0xED, 0xB4, 0x01, 0x06, 0x51, 0x57, 0x44, ++0x20, 0xF0, 0x22, 0x90, 0x96, 0xDB, 0xE0, 0xFD, ++0xB4, 0x02, 0x06, 0x51, 0x57, 0x44, 0x60, 0xF0, ++0x22, 0xED, 0xB4, 0x03, 0x03, 0x51, 0x57, 0xF0, ++0x22, 0x7E, 0x02, 0xFD, 0xFC, 0x90, 0x96, 0xDC, ++0x12, 0x86, 0x2D, 0xC3, 0x02, 0x03, 0xDA, 0x90, ++0x88, 0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xFF, 0xE4, ++0xFE, 0xFD, 0xFC, 0x90, 0x96, 0xDC, 0x12, 0x04, ++0x31, 0x90, 0x96, 0xDC, 0x12, 0x04, 0xB8, 0xEC, ++0x4D, 0x4E, 0x4F, 0x22, 0x7F, 0xFF, 0x12, 0x04, ++0x7E, 0x90, 0x8A, 0xEF, 0x22, 0x90, 0x97, 0x15, ++0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0xAD, 0x07, 0xEF, 0x54, 0xFC, 0xFF, ++0xED, 0x54, 0x03, 0x60, 0x08, 0x74, 0xFF, 0xFF, ++0xFE, 0xFD, 0xFC, 0x80, 0x70, 0x71, 0x12, 0x12, ++0xAF, 0xA7, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, ++0xF9, 0xE4, 0xFF, 0x74, 0xC8, 0x2F, 0x12, 0xAF, ++0x37, 0xE0, 0xFE, 0x74, 0xF9, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0x96, 0x12, 0xAD, 0x97, 0xB4, 0x04, ++0xEA, 0x90, 0x96, 0xFA, 0x12, 0x8D, 0xD4, 0x12, ++0xC7, 0xA2, 0x90, 0x96, 0xF9, 0x12, 0x8D, 0xD4, ++0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, ++0x06, 0xC0, 0x07, 0x90, 0x96, 0xFB, 0x12, 0x8D, ++0xD4, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, ++0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, ++0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, ++0x07, 0xA3, 0x12, 0x8D, 0xD4, 0x78, 0x18, 0x12, ++0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, ++0xD0, 0x00, 0x12, 0x86, 0x20, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0x07, 0xC0, 0xEF, 0xF0, 0xEE, ++0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0xEF, 0x54, 0xFC, 0xFF, 0x71, 0x61, ++0xF0, 0xE4, 0xFB, 0x90, 0x96, 0xD7, 0x12, 0x04, ++0xB8, 0xEB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, 0xF8, ++0x12, 0x03, 0xEB, 0x74, 0xC4, 0x2B, 0x12, 0xAF, ++0x37, 0xEF, 0xF0, 0x0B, 0xEB, 0xB4, 0x04, 0xE3, ++0x90, 0x07, 0xC2, 0x12, 0xCF, 0x6D, 0x90, 0x07, ++0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x54, ++0xFC, 0x90, 0x07, 0xC0, 0xF0, 0xEE, 0xA3, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0x97, 0x0E, 0x71, 0x5A, 0xF0, 0x7A, 0x00, 0x90, ++0x97, 0x0F, 0xE0, 0x54, 0x03, 0xFB, 0x70, 0x0A, ++0x90, 0x07, 0xC4, 0x71, 0xAA, 0x74, 0x03, 0xF0, ++0x80, 0x0E, 0xEB, 0x64, 0x02, 0x4A, 0x70, 0x15, ++0x90, 0x07, 0xC6, 0x71, 0xAA, 0x74, 0x0C, 0xF0, ++0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, ++0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xED, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, ++0x07, 0xC2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0x97, 0x10, 0x71, 0x5A, 0xF0, ++0x91, 0x1A, 0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, ++0xF0, 0x90, 0x07, 0xC2, 0x74, 0x01, 0xF0, 0x80, ++0x37, 0xEF, 0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, ++0x07, 0xC5, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, ++0x02, 0xF0, 0x80, 0x24, 0x91, 0x1A, 0x64, 0x02, ++0x70, 0x0D, 0x90, 0x07, 0xC6, 0xED, 0xF0, 0x90, ++0x07, 0xC2, 0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, ++0x64, 0x03, 0x4E, 0x70, 0x0B, 0x90, 0x07, 0xC7, ++0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, ++0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, ++0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x7E, 0x00, 0x90, 0x97, 0x11, 0xE0, ++0x54, 0x03, 0xFF, 0x22, 0x90, 0x24, 0xA0, 0xE0, ++0x90, 0x93, 0x03, 0x30, 0xE7, 0x05, 0xE0, 0x44, ++0x02, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, ++0xE4, 0xFD, 0xFF, 0x02, 0x6E, 0x71, 0x7E, 0x00, ++0x7F, 0x01, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, ++0x79, 0x2C, 0x12, 0x04, 0x80, 0x90, 0x88, 0x2C, ++0xE0, 0x54, 0xFD, 0xF0, 0x12, 0xC7, 0x64, 0xA3, ++0x74, 0x0C, 0xF0, 0x22, 0x90, 0x86, 0x0C, 0x12, ++0x92, 0x46, 0x90, 0x8A, 0xF9, 0x12, 0x96, 0x47, ++0x7D, 0x24, 0x02, 0xB6, 0x2E, 0x90, 0x8A, 0xEF, ++0x12, 0x92, 0x46, 0x02, 0x97, 0xC8, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, ++0xE0, 0x30, 0xE0, 0x10, 0x90, 0x88, 0xA3, 0xE0, ++0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x12, 0x75, ++0x11, 0x10, 0x80, 0x2E, 0x12, 0x7A, 0x65, 0xEF, ++0x64, 0x01, 0x60, 0x05, 0x75, 0x11, 0x01, 0x80, ++0x21, 0x90, 0x88, 0x31, 0x12, 0xB4, 0x92, 0x30, ++0xE0, 0x05, 0x75, 0x11, 0x02, 0x80, 0x13, 0x90, ++0x88, 0x38, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, ++0x75, 0x11, 0x08, 0x80, 0x05, 0x12, 0xCF, 0x5D, ++0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, ++0x90, 0x01, 0xB8, 0xE5, 0x11, 0xF0, 0x7F, 0x00, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, ++0x30, 0xE0, 0x1E, 0x90, 0x88, 0xAF, 0xE0, 0x60, ++0x05, 0x75, 0x12, 0x40, 0xA1, 0x7F, 0x90, 0x88, ++0x38, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, ++0x2D, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x7B, 0x80, ++0x55, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, ++0x05, 0x75, 0x12, 0x01, 0x80, 0x71, 0x90, 0x88, ++0x3A, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, ++0x12, 0x02, 0x80, 0x63, 0x90, 0x88, 0x38, 0xE0, ++0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, 0x12, ++0x04, 0x80, 0x54, 0xEF, 0x30, 0xE2, 0x05, 0x75, ++0x12, 0x08, 0x80, 0x4B, 0x90, 0x88, 0x3A, 0xE0, ++0x30, 0xE4, 0x05, 0x75, 0x12, 0x10, 0x80, 0x3F, ++0x90, 0x88, 0x32, 0xE0, 0x13, 0x13, 0x54, 0x3F, ++0x20, 0xE0, 0x05, 0x75, 0x12, 0x20, 0x80, 0x2F, ++0x90, 0x88, 0x9C, 0xE0, 0x60, 0x05, 0x75, 0x12, ++0x80, 0x80, 0x24, 0x90, 0x06, 0x62, 0xE0, 0x30, ++0xE1, 0x05, 0x75, 0x12, 0x11, 0x80, 0x18, 0x90, ++0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, ++0xFC, 0xFF, 0xBF, 0x80, 0x05, 0x75, 0x12, 0x12, ++0x80, 0x05, 0x12, 0xCF, 0x5D, 0x80, 0x0E, 0x90, ++0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, ++0xE5, 0x12, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, 0xF0, ++0xA3, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, ++0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, ++0xB1, 0xFC, 0x9F, 0x40, 0x41, 0x90, 0x88, 0x50, ++0xE0, 0x04, 0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, ++0x90, 0x88, 0x50, 0xE0, 0xD3, 0x9F, 0x50, 0x2E, ++0x90, 0x88, 0x48, 0xE0, 0x24, 0x08, 0xF0, 0x90, ++0x88, 0x3F, 0x12, 0xB4, 0x9B, 0x33, 0x33, 0x33, ++0x54, 0xF8, 0xFF, 0x90, 0x88, 0x3E, 0xE0, 0x2F, ++0x90, 0x88, 0x4F, 0xF0, 0xFB, 0x90, 0x88, 0x48, ++0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x92, 0x98, ++0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x22, 0x90, ++0x88, 0x3F, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3A, ++0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x88, 0x93, 0xE0, ++0xFF, 0x90, 0x88, 0x3F, 0xE0, 0xD3, 0x22, 0xE4, ++0xFE, 0x12, 0x8F, 0xAD, 0xE4, 0xF0, 0x74, 0x95, ++0x2E, 0x12, 0x8B, 0x93, 0x74, 0xFF, 0xF0, 0x0E, ++0xEE, 0xB4, 0xA0, 0xED, 0xE4, 0x90, 0x88, 0x4D, ++0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, 0x88, 0x50, ++0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0xA0, ++0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xD1, 0x3A, 0x02, ++0x04, 0x80, 0x7E, 0x00, 0x7F, 0x04, 0x7D, 0x00, ++0x7B, 0x01, 0x7A, 0x93, 0x79, 0x3B, 0x22, 0x90, ++0x96, 0xCE, 0xA3, 0xE0, 0xFF, 0x90, 0x92, 0x13, ++0x74, 0x03, 0xF0, 0x7B, 0x06, 0x7D, 0x01, 0x12, ++0x66, 0xDB, 0x90, 0x96, 0xD2, 0xEE, 0xF0, 0xFC, ++0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x96, 0xD1, 0xE0, ++0xFF, 0x74, 0x10, 0x2D, 0xF5, 0x82, 0xE4, 0x34, ++0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x96, 0xD0, ++0x22, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xC3, 0x90, ++0x88, 0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, ++0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, ++0x22, 0x74, 0xB6, 0x25, 0x0E, 0xF5, 0x82, 0xE4, ++0x34, 0x8E, 0xF5, 0x83, 0xE0, 0x22, 0xE4, 0x90, ++0x92, 0x20, 0xF0, 0x90, 0x95, 0xF7, 0xE0, 0xFF, ++0x90, 0x93, 0xD6, 0xE0, 0x2F, 0x22, 0xE0, 0x54, ++0x03, 0x90, 0x92, 0x80, 0xF0, 0x7B, 0x01, 0xAF, ++0x0E, 0x02, 0x75, 0x80, 0x33, 0x33, 0x33, 0x54, ++0xF8, 0x90, 0x88, 0x4E, 0xF0, 0xA3, 0x74, 0x50, ++0xF0, 0x22, 0x75, 0xF0, 0x02, 0xA4, 0xF5, 0x82, ++0x85, 0xF0, 0x83, 0x02, 0x03, 0x3E, 0x74, 0xA6, ++0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, ++0x83, 0x22, 0x74, 0x5F, 0x25, 0x67, 0xF5, 0x82, ++0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xE6, ++0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, ++0x83, 0x22, 0x74, 0xB6, 0x25, 0x67, 0xF5, 0x82, ++0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x90, 0x05, ++0x22, 0xE0, 0x90, 0x96, 0x1F, 0xF0, 0x22, 0x90, ++0x00, 0x06, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0x22, ++0x90, 0x93, 0x3D, 0xE0, 0x90, 0x01, 0x3F, 0x22, ++0x90, 0x88, 0x3C, 0xE0, 0x90, 0x05, 0x73, 0x22, ++0xF0, 0x90, 0x96, 0x1D, 0x74, 0x01, 0xF0, 0x22, ++0x93, 0xFD, 0x7C, 0x00, 0x02, 0x02, 0x80, 0xE5, ++0x69, 0x90, 0x81, 0x9D, 0x93, 0xFF, 0x22, 0x90, ++0x00, 0x04, 0x12, 0x03, 0x3E, 0x2F, 0x22, 0x90, ++0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0xF0, ++0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0x22, 0xF5, ++0x46, 0x89, 0x47, 0x75, 0x48, 0x04, 0x22, 0x00, ++0xB3, 0xE5 ++}; ++ ++u4Byte array_length_mp_8723d_fw_nic = 26498; ++ ++u1Byte array_mp_8723d_fw_wowlan[] = { ++0xD1, 0x23, 0x30, 0x00, 0x1D, 0x00, 0x02, 0x00, ++0x04, 0x14, 0x11, 0x14, 0x16, 0x7D, 0x02, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x02, 0x88, 0xE9, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xDA, 0x0B, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xE5, 0x4A, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xD9, 0x2A, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xDF, 0xD2, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0xE4, 0xF4, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, ++0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, ++0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, ++0xFF, 0xEE, 0x9A, 0xFE, 0xED, 0x99, 0xFD, 0xEC, ++0x98, 0xFC, 0x22, 0xE8, 0x8F, 0xF0, 0xA4, 0xCC, ++0x8B, 0xF0, 0xA4, 0x2C, 0xFC, 0xE9, 0x8E, 0xF0, ++0xA4, 0x2C, 0xFC, 0x8A, 0xF0, 0xED, 0xA4, 0x2C, ++0xFC, 0xEA, 0x8E, 0xF0, 0xA4, 0xCD, 0xA8, 0xF0, ++0x8B, 0xF0, 0xA4, 0x2D, 0xCC, 0x38, 0x25, 0xF0, ++0xFD, 0xE9, 0x8F, 0xF0, 0xA4, 0x2C, 0xCD, 0x35, ++0xF0, 0xFC, 0xEB, 0x8E, 0xF0, 0xA4, 0xFE, 0xA9, ++0xF0, 0xEB, 0x8F, 0xF0, 0xA4, 0xCF, 0xC5, 0xF0, ++0x2E, 0xCD, 0x39, 0xFE, 0xE4, 0x3C, 0xFC, 0xEA, ++0xA4, 0x2D, 0xCE, 0x35, 0xF0, 0xFD, 0xE4, 0x3C, ++0xFC, 0x22, 0x75, 0xF0, 0x08, 0x75, 0x82, 0x00, ++0xEF, 0x2F, 0xFF, 0xEE, 0x33, 0xFE, 0xCD, 0x33, ++0xCD, 0xCC, 0x33, 0xCC, 0xC5, 0x82, 0x33, 0xC5, ++0x82, 0x9B, 0xED, 0x9A, 0xEC, 0x99, 0xE5, 0x82, ++0x98, 0x40, 0x0C, 0xF5, 0x82, 0xEE, 0x9B, 0xFE, ++0xED, 0x9A, 0xFD, 0xEC, 0x99, 0xFC, 0x0F, 0xD5, ++0xF0, 0xD6, 0xE4, 0xCE, 0xFB, 0xE4, 0xCD, 0xFA, ++0xE4, 0xCC, 0xF9, 0xA8, 0x82, 0x22, 0xB8, 0x00, ++0xC1, 0xB9, 0x00, 0x59, 0xBA, 0x00, 0x2D, 0xEC, ++0x8B, 0xF0, 0x84, 0xCF, 0xCE, 0xCD, 0xFC, 0xE5, ++0xF0, 0xCB, 0xF9, 0x78, 0x18, 0xEF, 0x2F, 0xFF, ++0xEE, 0x33, 0xFE, 0xED, 0x33, 0xFD, 0xEC, 0x33, ++0xFC, 0xEB, 0x33, 0xFB, 0x10, 0xD7, 0x03, 0x99, ++0x40, 0x04, 0xEB, 0x99, 0xFB, 0x0F, 0xD8, 0xE5, ++0xE4, 0xF9, 0xFA, 0x22, 0x78, 0x18, 0xEF, 0x2F, ++0xFF, 0xEE, 0x33, 0xFE, 0xED, 0x33, 0xFD, 0xEC, ++0x33, 0xFC, 0xC9, 0x33, 0xC9, 0x10, 0xD7, 0x05, ++0x9B, 0xE9, 0x9A, 0x40, 0x07, 0xEC, 0x9B, 0xFC, ++0xE9, 0x9A, 0xF9, 0x0F, 0xD8, 0xE0, 0xE4, 0xC9, ++0xFA, 0xE4, 0xCC, 0xFB, 0x22, 0x75, 0xF0, 0x10, ++0xEF, 0x2F, 0xFF, 0xEE, 0x33, 0xFE, 0xED, 0x33, ++0xFD, 0xCC, 0x33, 0xCC, 0xC8, 0x33, 0xC8, 0x10, ++0xD7, 0x07, 0x9B, 0xEC, 0x9A, 0xE8, 0x99, 0x40, ++0x0A, 0xED, 0x9B, 0xFD, 0xEC, 0x9A, 0xFC, 0xE8, ++0x99, 0xF8, 0x0F, 0xD5, 0xF0, 0xDA, 0xE4, 0xCD, ++0xFB, 0xE4, 0xCC, 0xFA, 0xE4, 0xC8, 0xF9, 0x22, ++0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, ++0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, ++0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, ++0xFC, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, ++0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE0, 0xFB, ++0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, ++0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, ++0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, ++0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, ++0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, ++0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, ++0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0xE3, 0xF5, ++0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x6B, 0xDF, ++0xF5, 0x80, 0x67, 0xE3, 0xF5, 0xF0, 0x09, 0xE6, ++0x08, 0xB5, 0xF0, 0x5E, 0xDF, 0xF5, 0x80, 0x5A, ++0x87, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x52, ++0xDF, 0xF6, 0x80, 0x4E, 0x87, 0xF0, 0x09, 0xE2, ++0x08, 0xB5, 0xF0, 0x46, 0xDF, 0xF6, 0x80, 0x42, ++0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE0, ++0xA3, 0xB5, 0xF0, 0x36, 0xDF, 0xF6, 0x80, 0x32, ++0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE4, ++0x93, 0xA3, 0xB5, 0xF0, 0x25, 0xDF, 0xF5, 0x80, ++0x21, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, ++0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x14, 0xDF, 0xF5, ++0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, ++0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x02, ++0xDF, 0xF4, 0x02, 0x85, 0xC5, 0x80, 0x87, 0x80, ++0xE9, 0x80, 0x90, 0x80, 0xD4, 0x80, 0x3E, 0x80, ++0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, 0x80, ++0xB7, 0x80, 0x8D, 0x80, 0xA3, 0x80, 0x51, 0x80, ++0x74, 0x80, 0x3C, 0x02, 0x85, 0xD1, 0x89, 0x82, ++0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, ++0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, ++0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, ++0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x76, 0xDF, ++0xE3, 0xDE, 0xE1, 0x80, 0x70, 0x89, 0x82, 0x8A, ++0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, ++0xB5, 0xF0, 0x62, 0xDF, 0xF4, 0x80, 0x5E, 0x89, ++0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE6, ++0x08, 0xB5, 0xF0, 0x51, 0xDF, 0xF5, 0x80, 0x4D, ++0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, ++0xE2, 0x08, 0xB5, 0xF0, 0x40, 0xDF, 0xF5, 0x80, ++0x3C, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, ++0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, 0x2E, 0xDF, ++0xF4, 0x80, 0x2A, 0x80, 0x02, 0x80, 0x57, 0x89, ++0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, ++0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, ++0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, ++0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x06, 0xDF, ++0xE4, 0xDE, 0xE2, 0x80, 0x00, 0x7F, 0xFF, 0xB5, ++0xF0, 0x02, 0x0F, 0x22, 0x40, 0x02, 0x7F, 0x01, ++0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, ++0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, ++0xC5, 0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, ++0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xD5, ++0xDF, 0xE5, 0xDE, 0xE3, 0x80, 0xCF, 0x89, 0x82, ++0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, ++0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, ++0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, ++0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xAF, 0xDF, 0xE4, ++0xDE, 0xE2, 0x80, 0xA9, 0x88, 0xF0, 0xEF, 0x60, ++0x01, 0x0E, 0x4E, 0x60, 0xAB, 0xED, 0x24, 0x02, ++0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, 0xEB, ++0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x8E, 0x23, ++0x23, 0x45, 0x82, 0x23, 0x90, 0x85, 0x0D, 0x73, ++0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x86, 0x44, ++0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, ++0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, ++0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, ++0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, ++0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, ++0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, ++0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, ++0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, ++0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, ++0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, ++0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, ++0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, ++0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, ++0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, ++0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, ++0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, ++0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, ++0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, ++0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, ++0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, ++0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, ++0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, ++0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, ++0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, ++0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, ++0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, ++0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, ++0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, ++0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, ++0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, ++0x76, 0x30, 0x90, 0x89, 0x80, 0x74, 0x01, 0x93, ++0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, ++0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, ++0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, ++0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, ++0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, ++0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, ++0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, ++0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, ++0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, ++0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, ++0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, ++0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, ++0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, ++0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, ++0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, ++0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, ++0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, ++0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, ++0x04, 0x90, 0x89, 0x80, 0x93, 0xF6, 0x08, 0xEF, ++0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, ++0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, ++0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, ++0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, ++0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, ++0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x86, 0x8D, 0x50, ++0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, ++0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, ++0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, ++0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, ++0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, ++0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, ++0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, ++0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, ++0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, ++0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, ++0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, ++0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, ++0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, ++0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, ++0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, ++0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, ++0xE2, 0x01, 0x0F, 0x02, 0x86, 0x8C, 0x8F, 0xF0, ++0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, ++0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, ++0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, ++0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, ++0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, ++0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, ++0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, ++0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, ++0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x86, 0x8D, 0x7F, ++0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, ++0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, ++0x22, 0x02, 0x89, 0x27, 0x02, 0x87, 0x1D, 0xE4, ++0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, ++0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, ++0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, ++0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, ++0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, ++0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, ++0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, ++0x89, 0x6C, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, ++0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, ++0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, ++0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, ++0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, ++0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, ++0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, ++0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, ++0xDE, 0xE7, 0x80, 0xBE, 0x41, 0x9C, 0xAC, 0x00, ++0x41, 0x9B, 0x63, 0x00, 0x41, 0x9A, 0xE2, 0x00, ++0x44, 0x9C, 0x8C, 0x00, 0x50, 0xF2, 0x01, 0x00, ++0xD4, 0x4D, 0xD1, 0x28, 0x8D, 0x95, 0x90, 0x9C, ++0xA7, 0xEF, 0xF0, 0x7F, 0x02, 0x11, 0x67, 0x90, ++0x86, 0xAF, 0xE0, 0xFF, 0x90, 0x9C, 0xA7, 0xE0, ++0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, 0x22, ++0x12, 0xF7, 0x3E, 0x90, 0x86, 0xB4, 0xD1, 0xFE, ++0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB5, 0xF1, 0xED, ++0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB6, 0xF0, 0xF1, ++0xF4, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB7, 0x12, ++0x97, 0x30, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB8, ++0x12, 0x96, 0x2D, 0xFF, 0xED, 0x2F, 0x90, 0x86, ++0xB9, 0x12, 0xF7, 0x31, 0x90, 0x86, 0xBA, 0xF0, ++0x22, 0x90, 0x9C, 0x71, 0x12, 0x84, 0x67, 0x90, ++0x9C, 0x70, 0xEF, 0xF0, 0x12, 0x84, 0x70, 0x8A, ++0x63, 0x00, 0x8A, 0x67, 0x01, 0x8A, 0x6B, 0x03, ++0x8A, 0x70, 0x04, 0x8A, 0x75, 0x06, 0x8A, 0x86, ++0x12, 0x8A, 0x8B, 0x14, 0x8A, 0x90, 0x1E, 0x8A, ++0x95, 0x20, 0x8A, 0x9A, 0x25, 0x8A, 0x9F, 0x27, ++0x8A, 0xA4, 0x29, 0x8A, 0xA9, 0x2A, 0x8A, 0xAE, ++0x60, 0x8A, 0xB3, 0x61, 0x8A, 0xB8, 0x62, 0x8A, ++0xBD, 0x63, 0x8A, 0xC2, 0x64, 0x8A, 0xC7, 0x65, ++0x8A, 0xCC, 0x66, 0x8A, 0xD1, 0x67, 0x8A, 0xD6, ++0x68, 0x8A, 0xDB, 0x69, 0x8A, 0xE0, 0x6B, 0x8A, ++0xE5, 0x6C, 0x8A, 0xEA, 0x6D, 0x8A, 0xEF, 0x6E, ++0x8A, 0xF4, 0x6F, 0x8A, 0xF9, 0x70, 0x8B, 0x03, ++0x80, 0x8A, 0xFE, 0x81, 0x8B, 0x07, 0x82, 0x8B, ++0x0C, 0x83, 0x8B, 0x11, 0x84, 0x8B, 0x1B, 0x86, ++0x8B, 0x16, 0x88, 0x8B, 0x20, 0xC3, 0x8A, 0x7A, ++0xC6, 0x8A, 0x7A, 0xC7, 0x8A, 0x7A, 0xC8, 0x00, ++0x00, 0x8B, 0x25, 0x71, 0x35, 0x21, 0xA0, 0x71, ++0x35, 0x61, 0x3B, 0x71, 0x35, 0x02, 0xF2, 0x24, ++0x71, 0x35, 0x02, 0xF7, 0x98, 0x71, 0x35, 0x02, ++0xC1, 0x2A, 0x90, 0x9C, 0x70, 0xE0, 0xFF, 0xA3, ++0x12, 0x84, 0x5E, 0x02, 0xC1, 0xD6, 0x71, 0x35, ++0x02, 0x90, 0x00, 0x71, 0x35, 0x02, 0x97, 0xF9, ++0x71, 0x35, 0x02, 0x98, 0x08, 0x71, 0x35, 0x02, ++0x95, 0x5B, 0x71, 0x35, 0x02, 0xA0, 0x03, 0x71, ++0x35, 0x02, 0xA0, 0x46, 0x71, 0x35, 0x02, 0xB0, ++0x16, 0x71, 0x35, 0x02, 0xA8, 0x03, 0x71, 0x35, ++0x02, 0xB7, 0xFD, 0x71, 0x35, 0x02, 0x77, 0x4F, ++0x71, 0x35, 0x02, 0x7C, 0x60, 0x71, 0x35, 0x02, ++0x7A, 0xC6, 0x71, 0x35, 0x02, 0x5D, 0x36, 0x71, ++0x35, 0x02, 0x7B, 0xE9, 0x71, 0x35, 0x02, 0x70, ++0x33, 0x71, 0x35, 0x02, 0x48, 0xC9, 0x71, 0x35, ++0x02, 0x79, 0xF3, 0x71, 0x35, 0x02, 0xBF, 0xF3, ++0x71, 0x35, 0x02, 0x51, 0x7B, 0x71, 0x35, 0x02, ++0x79, 0x30, 0x71, 0x35, 0x02, 0x57, 0xF2, 0x71, ++0x35, 0x02, 0x74, 0x8D, 0x71, 0x35, 0x02, 0x78, ++0x9A, 0x71, 0x35, 0x02, 0x5E, 0x0B, 0x71, 0x35, ++0x02, 0xF4, 0xD1, 0x71, 0x35, 0xC1, 0x09, 0x71, ++0x35, 0x02, 0xF6, 0xE9, 0x71, 0x35, 0x02, 0xF6, ++0xF7, 0x71, 0x35, 0x02, 0xF7, 0x4C, 0x71, 0x35, ++0x02, 0xF7, 0x86, 0x71, 0x35, 0x02, 0xCD, 0x7F, ++0x71, 0x35, 0x02, 0xC8, 0x18, 0x90, 0x01, 0xC0, ++0xE0, 0x44, 0x01, 0xF0, 0x90, 0x9C, 0x70, 0xE0, ++0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, 0x9C, 0x71, ++0x02, 0x84, 0x5E, 0xF1, 0xFA, 0x90, 0x98, 0x25, ++0xE0, 0x70, 0x12, 0x91, 0x04, 0x12, 0x02, 0x06, ++0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x06, 0x90, ++0x98, 0x2B, 0x74, 0x01, 0xF0, 0x90, 0x98, 0x27, ++0xE0, 0x70, 0x12, 0x91, 0x04, 0x12, 0x02, 0x06, ++0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x06, 0x90, ++0x98, 0x2C, 0x74, 0x01, 0xF0, 0x91, 0x04, 0xD1, ++0xFF, 0xFF, 0x90, 0x99, 0x8C, 0xF0, 0x12, 0x02, ++0x06, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x91, 0x04, ++0xF1, 0xEE, 0x90, 0x99, 0x8D, 0xF0, 0x80, 0x05, ++0x90, 0x99, 0x8D, 0xEF, 0xF0, 0x90, 0x99, 0x8C, ++0xE0, 0x90, 0x99, 0x8B, 0xF0, 0x90, 0x99, 0x8D, ++0xE0, 0xFE, 0x90, 0x99, 0x8B, 0xE0, 0xFF, 0xD3, ++0x9E, 0x50, 0x3B, 0x91, 0x04, 0x12, 0x02, 0x06, ++0x54, 0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, 0x99, ++0x8B, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x90, ++0x99, 0x8B, 0x70, 0x07, 0xE0, 0xFF, 0x12, 0xC8, ++0x3B, 0x80, 0x05, 0xE0, 0xFF, 0x12, 0xC8, 0x2E, ++0x90, 0x98, 0x2C, 0xE0, 0x60, 0x08, 0x90, 0x99, ++0x8B, 0xE0, 0xFF, 0x12, 0xC8, 0x3B, 0x90, 0x99, ++0x8B, 0xE0, 0x04, 0xF0, 0x80, 0xB7, 0x90, 0x05, ++0x5E, 0xE4, 0xF0, 0x90, 0x99, 0x8C, 0xE0, 0x70, ++0x1A, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x13, ++0x90, 0x86, 0x0C, 0x91, 0x14, 0x90, 0x8A, 0xED, ++0x91, 0x14, 0x12, 0xDB, 0x46, 0x54, 0xBF, 0xF0, ++0x54, 0x7F, 0xF0, 0x22, 0x90, 0x99, 0x88, 0x02, ++0x84, 0x5E, 0x7D, 0xFF, 0xE4, 0xFF, 0x12, 0x98, ++0x60, 0x90, 0x8A, 0xFD, 0xE0, 0xFE, 0xA3, 0xE0, ++0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0xAD, ++0xED, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, 0xC4, ++0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xA1, ++0x90, 0xEE, 0x12, 0xBF, 0xE4, 0x30, 0xE0, 0x02, ++0xA1, 0x90, 0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, ++0x70, 0x02, 0xA1, 0x90, 0xEF, 0x70, 0x02, 0x81, ++0xEC, 0x24, 0xFE, 0x70, 0x02, 0xA1, 0x31, 0x24, ++0xFE, 0x60, 0x4F, 0x24, 0xFC, 0x70, 0x02, 0xA1, ++0x76, 0x24, 0xFC, 0x60, 0x02, 0xA1, 0x86, 0xEE, ++0xB4, 0x0E, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, ++0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, ++0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, ++0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, ++0x04, 0x11, 0x90, 0x9C, 0xAD, 0xE0, 0xFF, 0x60, ++0x05, 0x12, 0x67, 0x80, 0x80, 0x05, 0x90, 0x8A, ++0xED, 0x91, 0x14, 0x90, 0x88, 0x39, 0xE0, 0x64, ++0x08, 0x60, 0x02, 0xA1, 0x86, 0x12, 0x7B, 0xCC, ++0xA1, 0x86, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, ++0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, ++0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, ++0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, ++0x00, 0x91, 0x14, 0xBF, 0x01, 0x03, 0x12, 0x71, ++0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, ++0x02, 0xA1, 0x86, 0x90, 0x86, 0x00, 0x91, 0x14, ++0xEF, 0x64, 0x01, 0x60, 0x02, 0xA1, 0x86, 0x12, ++0x68, 0xC2, 0xA1, 0x86, 0x90, 0x88, 0x39, 0xE0, ++0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0x91, 0x14, ++0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, ++0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, ++0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, ++0x86, 0x00, 0x91, 0x14, 0xBF, 0x01, 0x03, 0x12, ++0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x04, ++0x70, 0x64, 0x90, 0x86, 0x02, 0x91, 0x14, 0xEF, ++0x64, 0x01, 0x70, 0x5A, 0x12, 0x73, 0x5A, 0x80, ++0x55, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, ++0x90, 0x86, 0x00, 0x91, 0x14, 0xBF, 0x01, 0x03, ++0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, ++0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, ++0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0x91, ++0x14, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, ++0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, ++0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, ++0x15, 0x12, 0x7A, 0x49, 0x80, 0x10, 0x90, 0x88, ++0x39, 0xE0, 0xB4, 0x0C, 0x09, 0x12, 0xCF, 0xBE, ++0x30, 0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, 0x88, ++0x39, 0x12, 0xFC, 0x96, 0x90, 0x01, 0xBB, 0xF0, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFB, 0xFA, ++0xFD, 0x7F, 0x01, 0x11, 0x8E, 0x90, 0x9A, 0x0A, ++0xEF, 0xF0, 0x60, 0xF1, 0x90, 0x86, 0xAF, 0xE0, ++0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE6, 0xC2, ++0xAF, 0xEF, 0x30, 0xE1, 0x0C, 0x90, 0x86, 0xAF, ++0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x86, 0x08, 0x91, ++0x14, 0xD1, 0x01, 0xE0, 0x30, 0xE2, 0x08, 0x54, ++0xFB, 0xF0, 0x90, 0x86, 0x0A, 0x91, 0x14, 0xD1, ++0x01, 0xE0, 0xFF, 0x30, 0xE4, 0x0C, 0x54, 0xEF, ++0xF0, 0x12, 0xD6, 0x92, 0xBF, 0x01, 0x03, 0x12, ++0xC9, 0xA5, 0xD1, 0x01, 0xE0, 0x30, 0xE6, 0x08, ++0x54, 0xBF, 0xF0, 0x90, 0x8A, 0x7D, 0x91, 0x14, ++0xD1, 0x01, 0xE0, 0xFF, 0x30, 0xE7, 0x06, 0x54, ++0x7F, 0xF0, 0x12, 0xB4, 0x20, 0xD2, 0xAF, 0x80, ++0xA3, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x86, 0xAF, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0xF1, 0xFA, 0x12, 0x02, 0x06, 0x20, 0xE0, 0x05, ++0x12, 0xF2, 0x5C, 0xC1, 0xF8, 0x91, 0x04, 0x12, ++0xBF, 0xEB, 0x90, 0x93, 0x27, 0x12, 0xCF, 0xDD, ++0xF1, 0x0E, 0x12, 0xF5, 0xF3, 0x90, 0x93, 0x27, ++0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, ++0xF1, 0x0D, 0x12, 0xF6, 0x07, 0x90, 0x93, 0x27, ++0xF1, 0x05, 0x12, 0xBF, 0xCE, 0x4D, 0xFF, 0x90, ++0x93, 0x27, 0x12, 0xF6, 0x10, 0xD1, 0xFE, 0x54, ++0x80, 0xFF, 0x90, 0x93, 0x28, 0xE0, 0x54, 0x7F, ++0x4F, 0x12, 0x97, 0x30, 0xFF, 0x54, 0x02, 0xFE, ++0x90, 0x93, 0x2B, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, ++0x12, 0x02, 0x06, 0xFE, 0x13, 0x13, 0x54, 0x3F, ++0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, ++0x04, 0xF0, 0xEE, 0x13, 0x13, 0x13, 0x54, 0x1F, ++0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, ++0x08, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x02, ++0x09, 0x90, 0x93, 0x28, 0x12, 0xBF, 0xE3, 0x20, ++0xE0, 0x40, 0x91, 0x04, 0xD1, 0xFF, 0x54, 0x7F, ++0xFE, 0x90, 0x93, 0x28, 0xE0, 0x54, 0x80, 0x4E, ++0xF1, 0xED, 0x90, 0x93, 0x29, 0xF0, 0xF1, 0xF4, ++0xFE, 0x54, 0x01, 0xFD, 0x90, 0x93, 0x2A, 0x12, ++0xF5, 0xEB, 0x54, 0xFE, 0xFE, 0xED, 0x54, 0x01, ++0x4E, 0xF0, 0xEF, 0x54, 0x04, 0xFF, 0xA3, 0xE0, ++0x54, 0xFB, 0x4F, 0xF0, 0xF1, 0x22, 0x54, 0x07, ++0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, ++0xA8, 0xE1, 0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x01, ++0x07, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, ++0x90, 0x95, 0x5F, 0x74, 0x05, 0xF0, 0x12, 0xD7, ++0x6B, 0x7A, 0x94, 0x79, 0x3E, 0x12, 0x04, 0x80, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFE, 0xF0, 0x90, ++0x00, 0x01, 0x02, 0x02, 0x1F, 0xF0, 0xEE, 0x54, ++0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xFF, 0xF0, ++0x12, 0x02, 0x06, 0xFE, 0x22, 0x90, 0x9A, 0xDC, ++0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, ++0xF1, 0xCE, 0x90, 0x93, 0x28, 0xE0, 0x54, 0x7F, ++0xFF, 0x90, 0x93, 0x27, 0xE0, 0xFE, 0xC4, 0x13, ++0x22, 0x90, 0x9A, 0xDC, 0xEE, 0xF0, 0xA3, 0xEF, ++0xF0, 0x90, 0x9A, 0xDF, 0xEB, 0xF0, 0x90, 0x9A, ++0xDE, 0xED, 0xF0, 0x60, 0x14, 0x12, 0xFC, 0xC5, ++0x78, 0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, ++0xF9, 0xF0, 0xEE, 0x90, 0x9A, 0xDC, 0xF0, 0x80, ++0x1A, 0x12, 0xFC, 0xC5, 0x78, 0x06, 0xC3, 0x33, ++0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xF0, 0xEE, 0x90, ++0x9A, 0xDC, 0xF0, 0x74, 0xFF, 0x75, 0xF0, 0xD0, ++0x12, 0x02, 0xE7, 0xF1, 0x22, 0x54, 0x07, 0x7D, ++0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0xA8, ++0xE1, 0xF1, 0x22, 0x54, 0x01, 0xFD, 0x12, 0xA8, ++0xE1, 0x90, 0x9A, 0xE0, 0xE0, 0x60, 0x3E, 0xF1, ++0x15, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, ++0x7D, 0x01, 0x12, 0xA8, 0xE1, 0xE4, 0x90, 0x9A, ++0xE1, 0xF0, 0x90, 0x9A, 0xDF, 0xE0, 0xFF, 0x90, ++0x9A, 0xE1, 0xE0, 0xC3, 0x9F, 0x50, 0x1E, 0xF1, ++0x15, 0x54, 0x01, 0xFD, 0x12, 0xA8, 0xE1, 0xF1, ++0x15, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, ++0x7D, 0x01, 0x12, 0xA8, 0xE1, 0x90, 0x9A, 0xE1, ++0xE0, 0x04, 0xF0, 0x80, 0xD5, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x12, 0x8F, ++0x13, 0xBD, 0x01, 0x05, 0x12, 0x7A, 0xAE, 0x80, ++0x07, 0xAF, 0x13, 0xAE, 0x12, 0x12, 0x7C, 0x6A, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0x00, ++0x02, 0x02, 0x02, 0x1F, 0x90, 0x00, 0x03, 0x02, ++0x02, 0x1F, 0x90, 0x99, 0x88, 0x02, 0x84, 0x67, ++0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0x03, 0xF0, ++0xBF, 0x01, 0x07, 0x11, 0x13, 0xE4, 0x90, 0x93, ++0x03, 0xF0, 0x22, 0x11, 0xBF, 0x7F, 0xEF, 0x7E, ++0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x06, 0x90, ++0x99, 0x88, 0xE0, 0xA3, 0xF0, 0x11, 0xBF, 0x7F, ++0xEE, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, ++0x08, 0x90, 0x99, 0x88, 0xE0, 0x90, 0x99, 0x8A, ++0xF0, 0x11, 0xBF, 0x7F, 0xED, 0x7E, 0x01, 0x12, ++0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0x88, ++0xE0, 0x90, 0x99, 0x8B, 0xF0, 0x11, 0xBF, 0x7F, ++0xEC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, ++0x08, 0x90, 0x99, 0x88, 0xE0, 0x90, 0x99, 0x8C, ++0xF0, 0x11, 0xBF, 0x7F, 0xEB, 0x7E, 0x01, 0x12, ++0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0x88, ++0xE0, 0x90, 0x99, 0x8D, 0xF0, 0x90, 0x99, 0x89, ++0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, ++0xA3, 0xE0, 0x90, 0x99, 0x91, 0xF0, 0x90, 0x99, ++0x8D, 0xE0, 0x90, 0x99, 0x92, 0xF0, 0x90, 0x99, ++0x93, 0x74, 0x12, 0xF0, 0x90, 0x99, 0xB5, 0x74, ++0x05, 0xF0, 0x90, 0x99, 0x95, 0xEF, 0x12, 0xFC, ++0xF4, 0x90, 0x99, 0x91, 0xE0, 0x90, 0x99, 0x98, ++0xF0, 0x90, 0x99, 0x92, 0xE0, 0x90, 0x99, 0x99, ++0xF0, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0x93, 0x31, ++0x50, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0xF0, 0x7B, ++0x01, 0x7A, 0x99, 0x79, 0x88, 0x22, 0x7E, 0x00, ++0x7F, 0x0B, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x98, ++0x79, 0x25, 0x12, 0x04, 0x80, 0x11, 0xBF, 0xF1, ++0xDE, 0xBF, 0x01, 0x1C, 0x90, 0x99, 0x88, 0xE0, ++0xFE, 0x54, 0x01, 0x90, 0x98, 0x25, 0xF0, 0xEE, ++0x54, 0x04, 0x90, 0x98, 0x27, 0xF0, 0x90, 0x99, ++0x88, 0xE0, 0x54, 0x08, 0x90, 0x98, 0x26, 0xF0, ++0x11, 0xBF, 0x91, 0xC3, 0x64, 0x01, 0x70, 0x35, ++0x90, 0x99, 0x88, 0xE0, 0x54, 0x07, 0x70, 0x15, ++0x7B, 0x01, 0x7A, 0x99, 0x79, 0x89, 0x7F, 0xFA, ++0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0F, ++0x90, 0x99, 0x89, 0x80, 0x03, 0x90, 0x99, 0x88, ++0xE0, 0x54, 0x07, 0x90, 0x98, 0x29, 0xF0, 0x90, ++0x99, 0x88, 0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, ++0x07, 0x90, 0x98, 0x28, 0xF0, 0x11, 0xBF, 0x7F, ++0xFD, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, ++0x0E, 0x90, 0x99, 0x88, 0xE0, 0x54, 0x0C, 0x13, ++0x13, 0x54, 0x3F, 0x90, 0x98, 0x2A, 0xF0, 0x22, ++0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0xF5, 0x82, 0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, ++0x8A, 0x79, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, ++0x8E, 0x83, 0x22, 0x90, 0x99, 0x88, 0xEF, 0xF0, ++0x71, 0xBF, 0x7F, 0xF4, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xCF, 0xE0, ++0x90, 0x99, 0xD1, 0xF0, 0x71, 0xBF, 0x7F, 0xF5, ++0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, ++0x90, 0x99, 0xCF, 0xE0, 0x90, 0x99, 0xD2, 0xF0, ++0x71, 0xBF, 0x7F, 0xF6, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xCF, 0xE0, ++0x90, 0x99, 0xD3, 0xF0, 0x71, 0xBF, 0x7F, 0xF7, ++0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, ++0x90, 0x99, 0xCF, 0xE0, 0x90, 0x99, 0xD4, 0xF0, ++0x71, 0xBF, 0x7F, 0xF8, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xCF, 0xE0, ++0x90, 0x99, 0xD5, 0xF0, 0x71, 0xBF, 0xF1, 0xDE, ++0xBF, 0x01, 0x08, 0x90, 0x99, 0xCF, 0xE0, 0x90, ++0x99, 0xD6, 0xF0, 0x71, 0xBF, 0x91, 0xC3, 0x64, ++0x01, 0x70, 0x54, 0x90, 0x99, 0xCF, 0xE0, 0x90, ++0x99, 0xD7, 0xF0, 0x54, 0x07, 0x60, 0x08, 0x90, ++0x99, 0xCF, 0xE0, 0x54, 0xE0, 0x70, 0x40, 0x7B, ++0x01, 0x7A, 0x99, 0x79, 0xD0, 0x7F, 0xFA, 0x91, ++0xC5, 0x64, 0x01, 0x70, 0x32, 0x90, 0x99, 0xCF, ++0xE0, 0xFC, 0x54, 0x07, 0x70, 0x12, 0x90, 0x99, ++0xD7, 0xE0, 0xFE, 0x90, 0x99, 0xD0, 0xE0, 0x54, ++0x07, 0xFD, 0xEE, 0x4D, 0x90, 0x99, 0xD7, 0xF0, ++0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, 0x99, 0xD7, ++0xE0, 0xFF, 0x90, 0x99, 0xD0, 0xE0, 0x54, 0xE0, ++0xFE, 0xEF, 0x4E, 0x90, 0x99, 0xD7, 0xF0, 0x71, ++0xBF, 0x7F, 0xFD, 0x91, 0xC5, 0x64, 0x01, 0x70, ++0x4B, 0x90, 0x99, 0xCF, 0xE0, 0xFE, 0x54, 0xCC, ++0x90, 0x99, 0xD8, 0xF0, 0xEE, 0x54, 0x0C, 0xFF, ++0x60, 0x08, 0x90, 0x99, 0xCF, 0xE0, 0x54, 0xC0, ++0x70, 0x32, 0xEF, 0x70, 0x16, 0x90, 0x99, 0xD8, ++0xE0, 0xFF, 0x90, 0x99, 0xCF, 0xE0, 0x54, 0x03, ++0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, ++0x99, 0xD8, 0xF0, 0x90, 0x99, 0xCF, 0xE0, 0xFF, ++0x54, 0xC0, 0x70, 0x10, 0x90, 0x99, 0xD8, 0xE0, ++0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, ++0xFF, 0xEE, 0x4F, 0xF0, 0x71, 0xBF, 0x7F, 0xF0, ++0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, ++0x90, 0x99, 0xCF, 0xE0, 0x90, 0x99, 0xD9, 0xF0, ++0x71, 0xBF, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xCF, 0xE0, ++0x90, 0x99, 0xDA, 0xF0, 0x71, 0xBF, 0x7F, 0xF2, ++0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, ++0x90, 0x99, 0xCF, 0xE0, 0x90, 0x99, 0xDB, 0xF0, ++0x71, 0xBF, 0x7F, 0xF3, 0x7E, 0x01, 0x12, 0x5F, ++0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xCF, 0xE0, ++0x90, 0x99, 0xDC, 0xF0, 0x71, 0xBF, 0x7F, 0xFC, ++0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, ++0x90, 0x99, 0xCF, 0xE0, 0x90, 0x99, 0xDD, 0xF0, ++0x90, 0x99, 0x89, 0x74, 0x19, 0xF0, 0x90, 0x99, ++0xAB, 0x74, 0x08, 0xF0, 0x90, 0x99, 0xD1, 0xE0, ++0x90, 0x99, 0x8B, 0xF0, 0x90, 0x99, 0xD2, 0xE0, ++0x90, 0x99, 0x8C, 0xF0, 0x90, 0x99, 0xD3, 0xE0, ++0x90, 0x99, 0x8D, 0xF0, 0x90, 0x99, 0xD4, 0xE0, ++0x90, 0x99, 0x8E, 0xF0, 0x90, 0x99, 0xD5, 0xE0, ++0x90, 0x99, 0x8F, 0xF0, 0x90, 0x99, 0xD6, 0xE0, ++0x90, 0x99, 0x90, 0xF0, 0x90, 0x99, 0xD7, 0xE0, ++0x90, 0x99, 0x91, 0xF0, 0x90, 0x99, 0xD8, 0xE0, ++0x90, 0x99, 0x92, 0xF0, 0x90, 0x99, 0xAC, 0x74, ++0x1A, 0xF0, 0x90, 0x99, 0xCE, 0x74, 0x05, 0xF0, ++0x90, 0x99, 0xD9, 0xE0, 0x90, 0x99, 0xAE, 0xF0, ++0x90, 0x99, 0xDA, 0xE0, 0x90, 0x99, 0xAF, 0xF0, ++0x90, 0x99, 0xDB, 0xE0, 0x90, 0x99, 0xB0, 0xF0, ++0x90, 0x99, 0xDC, 0xE0, 0x90, 0x99, 0xB1, 0xF0, ++0x90, 0x99, 0xDD, 0xE0, 0x90, 0x99, 0xB2, 0xF0, ++0x90, 0x99, 0x88, 0xE0, 0xB4, 0x01, 0x19, 0x7B, ++0x01, 0x7A, 0x99, 0x79, 0x89, 0x12, 0xC1, 0xB8, ++0x12, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x99, 0x79, ++0xAC, 0x31, 0x50, 0x7F, 0x04, 0x02, 0x04, 0x7E, ++0x75, 0x45, 0x01, 0x75, 0x46, 0x99, 0x75, 0x47, ++0x89, 0x75, 0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, ++0x79, 0xA0, 0x12, 0xF9, 0x7B, 0x75, 0x46, 0x99, ++0x75, 0x47, 0xAE, 0x75, 0x48, 0x05, 0x7B, 0x01, ++0x7A, 0x01, 0x79, 0xAA, 0x02, 0x69, 0xF5, 0x7B, ++0x01, 0x7A, 0x99, 0x79, 0xCF, 0x22, 0x7E, 0x00, ++0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, ++0x79, 0x31, 0x12, 0x04, 0x80, 0x12, 0xFC, 0x61, ++0x79, 0x08, 0x12, 0x04, 0x80, 0x90, 0x88, 0x35, ++0x74, 0x02, 0xF0, 0x90, 0x88, 0x3C, 0x14, 0xF0, ++0xA3, 0xF0, 0xA3, 0x74, 0x50, 0x91, 0xCC, 0xFE, ++0xE4, 0x33, 0x90, 0x88, 0x42, 0xF0, 0xA3, 0xCE, ++0x91, 0xCC, 0xFF, 0xF1, 0x3F, 0x12, 0xFA, 0xF4, ++0x90, 0x8A, 0x89, 0x31, 0x62, 0xE4, 0xFD, 0xFF, ++0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0x31, 0x62, ++0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, ++0x8A, 0x89, 0x31, 0x62, 0x7D, 0x0C, 0x7F, 0x01, ++0x12, 0x04, 0x7E, 0x90, 0x86, 0xB3, 0xE0, 0xFF, ++0xB4, 0x01, 0x08, 0x90, 0x88, 0x41, 0x74, 0xD4, ++0xF0, 0x80, 0x18, 0xEF, 0xB4, 0x03, 0x0F, 0x90, ++0x88, 0x41, 0x74, 0xF4, 0xF0, 0x90, 0x00, 0x92, ++0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x05, 0xE4, 0x90, ++0x88, 0x41, 0xF0, 0x7F, 0x79, 0x12, 0x7B, 0x41, ++0xEF, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, ++0x28, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE2, 0x06, ++0x90, 0x88, 0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, ++0x93, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, ++0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, ++0x74, 0x07, 0x91, 0xCC, 0xF1, 0x3F, 0x7E, 0x00, ++0x7F, 0x18, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, ++0x79, 0x0C, 0x12, 0x04, 0x80, 0x90, 0x8A, 0xA3, ++0x31, 0x62, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, ++0x05, 0x58, 0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, ++0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, ++0x12, 0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, 0x54, ++0x7F, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, ++0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x88, ++0x9C, 0xF0, 0x22, 0x7F, 0xFB, 0x7E, 0x01, 0x12, ++0x5F, 0xA6, 0xEF, 0x22, 0xF0, 0x90, 0x88, 0x53, ++0xE0, 0x24, 0x04, 0x22, 0xE4, 0x90, 0x9A, 0x0C, ++0xF0, 0x90, 0x9B, 0x63, 0x04, 0xF0, 0x90, 0x06, ++0x32, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x98, 0x01, ++0x12, 0x04, 0xB8, 0xEF, 0x24, 0x01, 0x12, 0xE3, ++0xAD, 0x90, 0x98, 0x01, 0x12, 0x04, 0x31, 0x12, ++0xF9, 0x8A, 0xE4, 0x90, 0x9A, 0xE4, 0xF0, 0xFF, ++0x12, 0xED, 0x15, 0x12, 0xC7, 0x81, 0x70, 0x43, ++0x90, 0x8A, 0xB9, 0x31, 0x62, 0x7D, 0x01, 0x7F, ++0x02, 0x12, 0x04, 0x7E, 0x7F, 0x05, 0x7E, 0x00, ++0x12, 0x7A, 0xAE, 0xF1, 0xED, 0x31, 0x62, 0xF1, ++0xD7, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, ++0x22, 0x90, 0x9A, 0x0C, 0xE0, 0x04, 0xF0, 0x7F, ++0x01, 0x7E, 0x00, 0x12, 0x7A, 0xAE, 0x90, 0x8A, ++0xB9, 0x31, 0x62, 0x7D, 0x01, 0x7F, 0x02, 0x12, ++0x04, 0x7E, 0x90, 0x9A, 0x0C, 0xE0, 0xD3, 0x94, ++0x0A, 0x40, 0xD6, 0x90, 0x9C, 0x55, 0x12, 0x04, ++0x3D, 0x00, 0x00, 0x00, 0x0A, 0x12, 0xEB, 0xC3, ++0x02, 0xB3, 0xAE, 0x12, 0x8F, 0xFA, 0x12, 0x02, ++0x06, 0xFF, 0x54, 0x7F, 0x90, 0x88, 0x36, 0xF0, ++0xEF, 0x12, 0xBF, 0xE4, 0xA3, 0x12, 0x8E, 0xFE, ++0xFD, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFF, 0x90, ++0x88, 0x34, 0xE0, 0x54, 0xF0, 0x4F, 0xF0, 0x12, ++0x8F, 0xF4, 0xFC, 0x54, 0x01, 0x25, 0xE0, 0xFF, ++0x90, 0x88, 0x31, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, ++0xEC, 0x54, 0x04, 0xC3, 0x13, 0xFF, 0x90, 0x88, ++0x33, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xED, 0x54, ++0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xA3, 0xE0, 0x54, ++0x0F, 0x4F, 0x12, 0x8F, 0xED, 0x90, 0x88, 0x35, ++0xF1, 0x30, 0xFD, 0x90, 0x8A, 0x89, 0x31, 0x62, ++0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x9B, 0x63, ++0xE0, 0x60, 0x06, 0xF1, 0xED, 0x31, 0x62, 0xF1, ++0xD7, 0x12, 0x8C, 0x04, 0xD1, 0x2E, 0xFF, 0x54, ++0x01, 0xFE, 0x90, 0x88, 0x9B, 0x12, 0xCF, 0xDD, ++0xD1, 0x2C, 0xFE, 0x12, 0xF5, 0xF3, 0x90, 0x88, ++0x9B, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, ++0xF7, 0xD1, 0x2B, 0x12, 0xF6, 0x06, 0x90, 0x88, ++0x9B, 0xF0, 0xEE, 0x54, 0x20, 0xFE, 0xEF, 0x54, ++0xDF, 0xD1, 0x2B, 0x54, 0x40, 0xFE, 0xEF, 0x54, ++0xBF, 0x4E, 0x90, 0x88, 0x9B, 0xF0, 0x12, 0x5C, ++0x5F, 0x90, 0x88, 0x36, 0xE0, 0xB4, 0x01, 0x07, ++0x90, 0x88, 0x33, 0xE0, 0x54, 0xFB, 0xF0, 0x12, ++0xCF, 0xD3, 0xF0, 0x90, 0x88, 0x36, 0x12, 0xFC, ++0x96, 0x90, 0x01, 0xBB, 0xF1, 0xE5, 0x90, 0x01, ++0xBE, 0xF0, 0x22, 0x4E, 0xFF, 0xF0, 0x90, 0x00, ++0x05, 0x02, 0x02, 0x1F, 0x90, 0x9C, 0x3F, 0x12, ++0x84, 0x67, 0x90, 0x9C, 0x43, 0xE0, 0xFE, 0x64, ++0x04, 0x70, 0x0D, 0xF1, 0x1F, 0x12, 0x02, 0x06, ++0x90, 0x9C, 0x44, 0x12, 0x8E, 0xFE, 0x80, 0x11, ++0xEE, 0x64, 0x02, 0x70, 0x2E, 0xF1, 0x1F, 0x12, ++0x8F, 0xEE, 0x90, 0x9C, 0x44, 0xF0, 0x12, 0x02, ++0x06, 0x90, 0x9C, 0x45, 0xF1, 0x30, 0x90, 0x9C, ++0x46, 0xD1, 0x2D, 0x90, 0x9C, 0x47, 0x12, 0xC1, ++0xC5, 0x90, 0x9C, 0x48, 0xF0, 0x90, 0x00, 0x07, ++0x12, 0x02, 0x1F, 0x90, 0x9C, 0x49, 0xF0, 0x12, ++0x8F, 0xF4, 0xFF, 0xED, 0x70, 0x19, 0xFE, 0xF1, ++0x25, 0xE0, 0xB4, 0xFF, 0x06, 0xF1, 0x25, 0xE4, ++0xF0, 0x80, 0x07, 0xF1, 0x25, 0xE0, 0x04, 0xF0, ++0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x06, 0xE8, 0x90, ++0x9C, 0x43, 0xE0, 0xFE, 0xB4, 0x04, 0x18, 0xA3, ++0xE0, 0xFD, 0xF1, 0x1F, 0xED, 0xF1, 0x37, 0xFD, ++0xF1, 0x1F, 0x90, 0x00, 0x01, 0xED, 0x12, 0x02, ++0x5E, 0x90, 0x00, 0x02, 0xE4, 0x80, 0x20, 0xEE, ++0xB4, 0x02, 0x1F, 0x90, 0x9C, 0x45, 0xF1, 0x1D, ++0xEE, 0xF1, 0x37, 0x44, 0x20, 0x54, 0x7F, 0xF1, ++0x1E, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x02, 0x5E, ++0x90, 0x9C, 0x44, 0xE0, 0x90, 0x00, 0x02, 0x12, ++0x02, 0x5E, 0xF1, 0x1F, 0xE9, 0x24, 0x03, 0xF9, ++0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x44, 0x20, ++0x12, 0x02, 0x4C, 0x90, 0x9C, 0x46, 0xF1, 0x1D, ++0x90, 0x00, 0x04, 0xEE, 0x12, 0x02, 0x5E, 0x90, ++0x9C, 0x47, 0xE0, 0x90, 0x00, 0x05, 0x12, 0x02, ++0x5E, 0x90, 0x9C, 0x48, 0xE0, 0x90, 0x00, 0x06, ++0x12, 0x02, 0x5E, 0x90, 0x9C, 0x49, 0xE0, 0x90, ++0x00, 0x07, 0x02, 0x02, 0x5E, 0xE0, 0xFE, 0x90, ++0x9C, 0x3F, 0x02, 0x84, 0x5E, 0x74, 0x44, 0x2E, ++0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x22, ++0xF0, 0x90, 0x00, 0x04, 0x02, 0x02, 0x1F, 0x12, ++0x02, 0x4C, 0x90, 0x9C, 0x45, 0xE0, 0x22, 0x33, ++0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4E, 0xF0, ++0xA3, 0x74, 0x50, 0xF0, 0x22, 0x90, 0x88, 0x39, ++0xE0, 0xB4, 0x04, 0x08, 0x12, 0xAC, 0x13, 0x44, ++0x01, 0x12, 0xAC, 0xC9, 0x90, 0x88, 0x9D, 0xE0, ++0x20, 0xE0, 0x2D, 0x90, 0x88, 0x36, 0xE0, 0x64, ++0x01, 0x70, 0x25, 0xF1, 0xE6, 0x60, 0x13, 0x90, ++0x8A, 0xB9, 0x31, 0x62, 0xE4, 0xFD, 0x7F, 0x0C, ++0x12, 0x04, 0x7E, 0x12, 0xDA, 0xF5, 0xF9, 0x02, ++0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x08, ++0x90, 0x8A, 0xB9, 0x31, 0x62, 0x12, 0xC7, 0x69, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x90, 0x9C, 0x99, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, ++0x90, 0x8A, 0xF9, 0x31, 0x62, 0x7D, 0x44, 0x7F, ++0x6F, 0x12, 0x04, 0x7E, 0x12, 0x8C, 0x11, 0x90, ++0x9C, 0x9A, 0xE0, 0x90, 0x9C, 0x99, 0xB4, 0x01, ++0x08, 0x12, 0xFC, 0x46, 0x44, 0x04, 0xF0, 0x80, ++0x06, 0x12, 0xFC, 0x46, 0x54, 0xFB, 0xF0, 0x90, ++0x8A, 0xF9, 0x31, 0x62, 0xE4, 0xFD, 0xFF, 0x12, ++0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, ++0x02, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x7F, 0xF9, ++0x7E, 0x01, 0x02, 0x5F, 0xA6, 0xF0, 0x90, 0x88, ++0x34, 0xE0, 0x54, 0x0F, 0x22, 0x90, 0x88, 0x38, ++0xE0, 0x90, 0x9A, 0xFC, 0xF0, 0x90, 0x8A, 0x89, ++0x22, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, ++0x98, 0x35, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, ++0x12, 0x02, 0x06, 0x90, 0x99, 0xAB, 0x12, 0x8E, ++0xFE, 0x90, 0x99, 0xAC, 0xF0, 0x60, 0x0E, 0x11, ++0x53, 0x12, 0xCF, 0xEC, 0x90, 0x99, 0xAC, 0x11, ++0x53, 0x7B, 0x57, 0x11, 0x60, 0x90, 0x99, 0x88, ++0x74, 0x20, 0xF0, 0x90, 0x99, 0xAA, 0x74, 0x03, ++0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x99, 0x8A, ++0xF0, 0x90, 0x98, 0x36, 0xE0, 0x90, 0x99, 0x8B, ++0xF0, 0x90, 0x98, 0x37, 0xE0, 0x90, 0x99, 0x8C, ++0x12, 0x90, 0xBE, 0x12, 0x91, 0x50, 0x7F, 0x04, ++0x02, 0x04, 0x7E, 0xE0, 0xFF, 0x90, 0x99, 0xAB, ++0xE0, 0xFD, 0x22, 0xE4, 0xFB, 0xFD, 0x7F, 0xFF, ++0xEB, 0xB4, 0x57, 0x05, 0x12, 0xFC, 0x81, 0x80, ++0x10, 0xEF, 0x70, 0x07, 0x90, 0x98, 0x36, 0xE0, ++0x4D, 0x80, 0x06, 0x12, 0xD0, 0x04, 0x12, 0xFC, ++0x81, 0x90, 0x05, 0x22, 0xF0, 0x90, 0x93, 0x01, ++0xEB, 0xF0, 0x22, 0x90, 0x9A, 0x38, 0x12, 0x84, ++0x67, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x9A, 0x49, ++0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0C, 0x7B, ++0x39, 0x12, 0x8C, 0x0A, 0xEF, 0x64, 0x01, 0x70, ++0x1C, 0x80, 0x00, 0x90, 0x98, 0x09, 0xE0, 0xFF, ++0x90, 0x92, 0x13, 0x74, 0x11, 0xF0, 0x7B, 0x18, ++0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x9A, 0x46, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x9A, 0x46, ++0x12, 0xCE, 0xC1, 0x90, 0x9A, 0x48, 0xEF, 0xF0, ++0x90, 0x9A, 0x46, 0xF1, 0xF9, 0x7B, 0x01, 0x90, ++0x9A, 0x44, 0xE0, 0xFD, 0x12, 0xF3, 0x9C, 0x90, ++0x9A, 0x45, 0xE0, 0x60, 0x02, 0x21, 0x66, 0xF1, ++0xCC, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, ++0x9A, 0x3B, 0x71, 0x5F, 0x75, 0x48, 0x06, 0xD0, ++0x01, 0xD0, 0x02, 0xD0, 0x03, 0x51, 0x15, 0xF1, ++0xE8, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, ++0x9A, 0x38, 0x71, 0x5F, 0x75, 0x48, 0x10, 0xD0, ++0x01, 0xD0, 0x02, 0xD0, 0x03, 0x51, 0x15, 0xF1, ++0xCF, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, ++0x9A, 0x3E, 0x71, 0x5F, 0x75, 0x48, 0x10, 0xD0, ++0x01, 0xD0, 0x02, 0xD0, 0x03, 0x51, 0x15, 0x24, ++0x60, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, ++0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x9A, ++0x3E, 0x71, 0x5F, 0x75, 0x48, 0x10, 0xD0, 0x01, ++0xD0, 0x02, 0xD0, 0x03, 0x51, 0x15, 0x24, 0x72, ++0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, ++0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x9A, 0x41, ++0x71, 0x5F, 0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, ++0x02, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x9A, ++0x3E, 0x12, 0x84, 0x5E, 0x90, 0x9A, 0x75, 0x12, ++0x84, 0x67, 0x90, 0x9A, 0x78, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x00, 0x20, 0x90, 0x9A, 0x7C, 0x74, ++0x3A, 0xF0, 0x90, 0x9A, 0x38, 0x12, 0x84, 0x5E, ++0x12, 0xF6, 0x68, 0x51, 0x18, 0xF1, 0xD9, 0x12, ++0xB7, 0x68, 0x75, 0x48, 0x28, 0x7B, 0x01, 0x7A, ++0x9A, 0x79, 0x4A, 0x51, 0x15, 0xF1, 0xD9, 0xFA, ++0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, ++0x93, 0x75, 0x47, 0xCD, 0x75, 0x48, 0x28, 0xD0, ++0x03, 0x12, 0x69, 0xF5, 0x90, 0x9A, 0x48, 0xE0, ++0xFF, 0x90, 0x9A, 0x47, 0xE0, 0x2F, 0xFF, 0x90, ++0x9A, 0x46, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x30, ++0xFD, 0xE4, 0x3F, 0xFC, 0x90, 0x98, 0x09, 0xE0, ++0xFB, 0x7F, 0x3A, 0x12, 0xB4, 0xD7, 0x51, 0x18, ++0xF1, 0xD9, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, ++0x45, 0x75, 0x46, 0x9A, 0x75, 0x47, 0x4A, 0x75, ++0x48, 0x28, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, ++0x98, 0x05, 0xE0, 0xB4, 0x02, 0x0C, 0x90, 0x98, ++0x09, 0xE0, 0xFF, 0x90, 0x9A, 0x48, 0xE0, 0xFD, ++0xD1, 0x92, 0x90, 0x06, 0x33, 0xE0, 0x44, 0x02, ++0xF0, 0x90, 0x9A, 0x49, 0xE0, 0xFD, 0x7B, 0x3A, ++0x12, 0xFC, 0x76, 0xF0, 0x22, 0x12, 0x69, 0xF5, ++0x90, 0x9A, 0x46, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, ++0x2F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x9C, 0x11, 0x12, 0x84, 0x67, 0x78, ++0x1D, 0x7C, 0x9C, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, ++0x80, 0x79, 0x8E, 0x12, 0xDF, 0x44, 0x90, 0x05, ++0x22, 0xE0, 0x90, 0x9C, 0x1C, 0xF0, 0x90, 0x04, ++0x1D, 0xE0, 0x60, 0x0C, 0x7B, 0x33, 0x12, 0x8C, ++0x0A, 0xEF, 0x64, 0x01, 0x70, 0x1C, 0x80, 0x00, ++0x90, 0x98, 0x08, 0xE0, 0xFF, 0x90, 0x92, 0x13, ++0x74, 0x10, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0x12, ++0x66, 0xDB, 0x90, 0x9C, 0x19, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0x90, 0x9C, 0x19, 0x12, 0xCE, 0xC1, ++0x90, 0x9C, 0x1B, 0xEF, 0xF0, 0x90, 0x9C, 0x19, ++0xF1, 0xF9, 0x7B, 0x01, 0x90, 0x9C, 0x17, 0xE0, ++0xFD, 0x12, 0xF3, 0x9C, 0x90, 0x9C, 0x18, 0xE0, ++0x70, 0x4F, 0xF1, 0xCC, 0xC0, 0x03, 0xC0, 0x02, ++0xC0, 0x01, 0x71, 0x5C, 0x75, 0x48, 0x06, 0xD0, ++0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x69, 0xF5, ++0x90, 0x9C, 0x19, 0x51, 0x1B, 0xF1, 0xF2, 0xFA, ++0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, ++0x71, 0x5C, 0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, ++0x02, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x9C, ++0x19, 0x51, 0x1B, 0xF1, 0xE8, 0xC0, 0x03, 0xC0, ++0x02, 0xC0, 0x01, 0x90, 0x9C, 0x11, 0x71, 0x5F, ++0x75, 0x48, 0x04, 0xD0, 0x01, 0xD0, 0x02, 0x80, ++0x4C, 0x90, 0x9C, 0x18, 0xE0, 0x64, 0x01, 0x70, ++0x49, 0xF1, 0xCC, 0xC0, 0x03, 0x8B, 0x45, 0x75, ++0x46, 0x93, 0x75, 0x47, 0x49, 0x75, 0x48, 0x06, ++0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x9C, 0x19, ++0x51, 0x1B, 0xF1, 0xF2, 0xFA, 0x7B, 0x01, 0xC0, ++0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, 0x47, ++0x53, 0x75, 0x48, 0x06, 0xD0, 0x03, 0x12, 0x69, ++0xF5, 0x90, 0x9C, 0x19, 0x51, 0x1B, 0xF1, 0xE8, ++0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, ++0x47, 0x59, 0x75, 0x48, 0x04, 0xD0, 0x03, 0x12, ++0x69, 0xF5, 0x90, 0x98, 0x05, 0xE0, 0xB4, 0x02, ++0x0C, 0x90, 0x98, 0x08, 0xE0, 0xFF, 0x90, 0x9C, ++0x1B, 0xE0, 0xFD, 0xD1, 0x92, 0x90, 0x06, 0x30, ++0xE0, 0x44, 0x10, 0xF0, 0x90, 0x9C, 0x1C, 0xE0, ++0xFD, 0x7B, 0x34, 0x12, 0xFC, 0x76, 0xF0, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9C, 0x14, 0x12, ++0x84, 0x5E, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x90, 0x9A, 0x19, 0x12, 0xA7, 0xFA, 0x90, 0x9A, ++0x31, 0x74, 0x18, 0xF0, 0x7E, 0x00, 0x7F, 0x80, ++0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x39, ++0x12, 0x04, 0x80, 0x90, 0x01, 0xC4, 0x74, 0x69, ++0xF0, 0x74, 0x9B, 0xA3, 0xF0, 0x90, 0x98, 0x0A, ++0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, 0x9A, 0x30, ++0xEF, 0xF0, 0xF9, 0xE0, 0xFE, 0x24, 0x29, 0x12, ++0xE6, 0x3E, 0x74, 0x41, 0xF0, 0xEE, 0x24, 0x28, ++0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x9A, 0x31, 0xE0, ++0x7A, 0x00, 0x2D, 0xFE, 0xEA, 0x3C, 0x90, 0x9A, ++0x35, 0xF0, 0xA3, 0xCE, 0xF0, 0x74, 0x28, 0x29, ++0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x90, ++0x9A, 0x1B, 0xE0, 0xFD, 0x12, 0xF3, 0x9C, 0x12, ++0xFB, 0x9E, 0x90, 0x9A, 0x35, 0xE0, 0xFF, 0xA3, ++0xE0, 0x90, 0x9A, 0x33, 0xCF, 0xF0, 0xA3, 0xEF, ++0xF0, 0x90, 0x9A, 0x39, 0x74, 0x01, 0xF0, 0xA3, ++0x74, 0x03, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0x74, ++0x5F, 0xF0, 0x90, 0x9A, 0x35, 0xE4, 0x75, 0xF0, ++0x04, 0x12, 0x02, 0xE7, 0x90, 0x94, 0x39, 0xE0, ++0xFF, 0x7E, 0x02, 0xB4, 0xFE, 0x02, 0x7E, 0xFE, ++0x90, 0x9A, 0x35, 0xA3, 0xE0, 0xFD, 0xD1, 0x88, ++0xEE, 0xF0, 0x74, 0x00, 0x2D, 0xD1, 0x8A, 0xE0, ++0x90, 0x9A, 0x3D, 0xF0, 0x90, 0x9A, 0x35, 0x12, ++0xD5, 0xCD, 0x90, 0x95, 0x2E, 0xE0, 0x90, 0x9A, ++0x19, 0xB4, 0x01, 0x0B, 0xE0, 0x44, 0x03, 0xFC, ++0xA3, 0xE0, 0x44, 0x10, 0xFD, 0x80, 0x09, 0xE0, ++0x44, 0x03, 0xFC, 0xA3, 0xE0, 0x44, 0x20, 0xFD, ++0x90, 0x9A, 0x37, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, ++0x90, 0x9A, 0x19, 0xE0, 0x70, 0x04, 0xA3, 0xE0, ++0x64, 0x01, 0x90, 0x9A, 0x35, 0x70, 0x17, 0xA3, ++0xE0, 0xFE, 0xD1, 0x88, 0x12, 0xB6, 0x96, 0x74, ++0x01, 0xF0, 0x90, 0x9A, 0x3E, 0x74, 0x03, 0xF0, ++0xA3, 0x74, 0x01, 0xF0, 0x80, 0x13, 0xA3, 0xE0, ++0xFE, 0xD1, 0x88, 0x12, 0xB6, 0x96, 0x74, 0x02, ++0xF0, 0x90, 0x9A, 0x3E, 0x04, 0xF0, 0xA3, 0x14, ++0xF0, 0x12, 0xFC, 0x6C, 0xEF, 0x64, 0xFE, 0x90, ++0x9A, 0x35, 0x70, 0x21, 0xA3, 0xE0, 0x24, 0x00, ++0x12, 0xF3, 0x2C, 0xC0, 0x03, 0x8B, 0x45, 0x12, ++0xFC, 0xA0, 0xD0, 0x03, 0x12, 0xF9, 0x7B, 0x12, ++0xFC, 0xA0, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x40, ++0x12, 0x69, 0xF5, 0x80, 0x22, 0xE0, 0xFE, 0xA3, ++0xE0, 0xFF, 0x24, 0x00, 0xF5, 0x82, 0x74, 0xFC, ++0x3E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2F, ++0xF5, 0x82, 0x74, 0xFC, 0x3E, 0xF5, 0x83, 0xE4, ++0xF0, 0x90, 0x9A, 0x40, 0xF0, 0xA3, 0xF0, 0x12, ++0xFC, 0x6C, 0xE4, 0x90, 0x9A, 0x32, 0xF0, 0x12, ++0xFC, 0x1A, 0x90, 0x9A, 0x35, 0xA3, 0xE0, 0xFD, ++0xEF, 0x2D, 0xD1, 0x88, 0xEE, 0xF0, 0x12, 0xFC, ++0x1A, 0x74, 0x42, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x9A, 0xF5, 0x83, 0xEE, 0xF1, 0xE0, 0xE0, 0xB4, ++0x08, 0xDD, 0x12, 0xFB, 0xA8, 0x90, 0x9A, 0x35, ++0x12, 0xBF, 0xDC, 0x90, 0x9A, 0x35, 0x12, 0xBF, ++0xD5, 0x12, 0xFB, 0x9E, 0xE4, 0x90, 0x9A, 0xBC, ++0xF0, 0xE4, 0x90, 0x9A, 0x32, 0xF0, 0x12, 0xFC, ++0xB3, 0x50, 0x11, 0x12, 0xFB, 0xFC, 0xA3, 0x12, ++0xFB, 0xC7, 0x12, 0xFC, 0x8C, 0xD1, 0x87, 0xE4, ++0xF1, 0xE0, 0x80, 0xEA, 0x12, 0xCF, 0x71, 0x90, ++0x06, 0x31, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x98, ++0x0B, 0xE0, 0xFD, 0x12, 0xE6, 0x8D, 0xCE, 0xC3, ++0x13, 0xCE, 0x13, 0xD8, 0xF9, 0x12, 0xFC, 0x3C, ++0xED, 0xFF, 0x90, 0x98, 0x0A, 0x12, 0xFC, 0x0E, ++0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, ++0x90, 0x9A, 0x31, 0xE0, 0x7C, 0x00, 0x2F, 0xFF, ++0xEC, 0x3E, 0xCF, 0x24, 0x38, 0xCF, 0x34, 0x00, ++0xFE, 0x90, 0x92, 0x06, 0x74, 0x10, 0xF0, 0x7B, ++0x63, 0xE4, 0xFD, 0x12, 0x71, 0xD4, 0x90, 0x9A, ++0x19, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, ++0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x39, 0x70, 0x17, ++0x90, 0x91, 0xA0, 0x12, 0xFC, 0xEC, 0x90, 0x91, ++0xA3, 0x12, 0x84, 0x67, 0x90, 0x91, 0xA6, 0x12, ++0xFC, 0xE4, 0x12, 0x6F, 0x34, 0x80, 0x15, 0x90, ++0x91, 0x96, 0x12, 0xFC, 0xEC, 0x90, 0x91, 0x99, ++0x12, 0x84, 0x67, 0x90, 0x91, 0x9C, 0x12, 0xFC, ++0xE4, 0x12, 0x6E, 0xF3, 0x90, 0x9A, 0xBC, 0xE0, ++0x04, 0xF0, 0x90, 0x06, 0x31, 0xE0, 0x30, 0xE2, ++0x07, 0x12, 0xFC, 0xDC, 0x50, 0x02, 0xA1, 0x19, ++0x12, 0xFC, 0xDC, 0x40, 0x0A, 0x90, 0x06, 0x35, ++0xE0, 0x44, 0x20, 0x90, 0x06, 0x34, 0xF0, 0xE4, ++0x90, 0x9A, 0x32, 0xF0, 0x12, 0xFC, 0xB3, 0x50, ++0x23, 0x12, 0xFB, 0xFC, 0xA3, 0x12, 0xFB, 0xC7, ++0x12, 0xFC, 0x8C, 0x90, 0x9A, 0x32, 0xE0, 0x24, ++0x1C, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, ++0xE0, 0xFF, 0x90, 0x9A, 0x30, 0xD1, 0x87, 0xEF, ++0xF1, 0xE0, 0x80, 0xD8, 0x90, 0x9A, 0x19, 0xE0, ++0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x0E, ++0x90, 0x98, 0x0A, 0xE0, 0xFF, 0x90, 0x9A, 0x31, ++0xE0, 0x24, 0x08, 0xFD, 0xD1, 0x92, 0x90, 0x04, ++0x1D, 0xE0, 0x60, 0x24, 0x90, 0x05, 0x22, 0xE0, ++0x90, 0x9A, 0xBB, 0xF0, 0x7B, 0x1D, 0x12, 0x8C, ++0x0A, 0xBF, 0x01, 0x07, 0x12, 0xFB, 0xB2, 0x90, ++0x04, 0x25, 0xF0, 0x90, 0x9A, 0xBB, 0xE0, 0xFD, ++0x7B, 0x1E, 0xE4, 0xFF, 0x11, 0x60, 0x80, 0x07, ++0x12, 0xFB, 0xB2, 0x90, 0x04, 0x25, 0xF0, 0x90, ++0x04, 0x1F, 0x74, 0x20, 0xF0, 0x90, 0x88, 0x39, ++0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, ++0x74, 0x69, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, ++0x9B, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x12, 0x83, 0x00, 0xA8, 0x04, 0xA9, 0x05, 0xAA, ++0x06, 0xAB, 0x07, 0x90, 0x99, 0x88, 0xA3, 0xE0, ++0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0x22, 0x90, 0x9C, 0x24, 0xED, 0xF0, 0x90, ++0x9C, 0x23, 0xEF, 0xF0, 0x12, 0x7B, 0x07, 0x90, ++0x9C, 0x31, 0xEF, 0xF0, 0xE0, 0xFD, 0x24, 0x01, ++0x12, 0xB6, 0x9C, 0xE0, 0xFE, 0x74, 0x00, 0x2D, ++0xD1, 0x8A, 0x12, 0xBA, 0x6E, 0x54, 0x3F, 0x90, ++0x9C, 0x2E, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, ++0x9C, 0x2D, 0xF0, 0x12, 0xFC, 0xBC, 0x50, 0x0B, ++0x12, 0xFB, 0x70, 0xD1, 0x87, 0xE4, 0x12, 0xFC, ++0xFC, 0x80, 0xF0, 0x90, 0x9C, 0x2F, 0xE0, 0x24, ++0xF8, 0xFB, 0x90, 0x9C, 0x2E, 0xE0, 0x34, 0xFF, ++0xFA, 0x90, 0x9C, 0x24, 0xE0, 0xFF, 0x90, 0x91, ++0xDC, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0x74, ++0x01, 0xF0, 0x7D, 0x0A, 0x7C, 0x00, 0x7F, 0x10, ++0x7E, 0x00, 0x12, 0x6D, 0xED, 0x90, 0x98, 0x0B, ++0xE0, 0xFF, 0x90, 0x9C, 0x23, 0xE0, 0xFD, 0xD3, ++0x9F, 0x40, 0x3B, 0x90, 0x98, 0x0B, 0xE0, 0xFC, ++0x12, 0xE6, 0x8D, 0xCE, 0xC3, 0x13, 0xCE, 0x13, ++0xD8, 0xF9, 0x12, 0xFC, 0x3C, 0xEC, 0xFF, 0xC3, ++0xED, 0x12, 0xFC, 0x10, 0xC3, 0x33, 0xCE, 0x33, ++0xCE, 0xD8, 0xF9, 0x24, 0x28, 0xFF, 0xE4, 0x3E, ++0xFE, 0x12, 0xFD, 0x0C, 0xFD, 0x90, 0x9C, 0x24, ++0xE0, 0xFC, 0xC3, 0xED, 0x9C, 0x12, 0xFD, 0x04, ++0x7D, 0x38, 0x7C, 0x00, 0x80, 0x3A, 0x90, 0x9C, ++0x23, 0xE0, 0xFD, 0x12, 0xE6, 0x8D, 0xCE, 0xC3, ++0x13, 0xCE, 0x13, 0xD8, 0xF9, 0x12, 0xFC, 0x3C, ++0xED, 0xFF, 0x90, 0x98, 0x0B, 0x12, 0xFC, 0x0E, ++0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, ++0x38, 0xFD, 0xE4, 0x3E, 0xFC, 0x12, 0xFD, 0x0C, ++0xFF, 0x90, 0x9C, 0x24, 0xE0, 0xFE, 0xC3, 0xEF, ++0x9E, 0x12, 0xFD, 0x04, 0x7F, 0x28, 0x7E, 0x00, ++0x12, 0x71, 0xD4, 0x12, 0xB7, 0xE8, 0x90, 0x91, ++0x45, 0x12, 0x84, 0x67, 0x0B, 0x7A, 0x9C, 0x79, ++0x25, 0x90, 0x91, 0x48, 0x12, 0x84, 0x67, 0x90, ++0x91, 0x4B, 0x74, 0x08, 0xF0, 0x7A, 0x94, 0x79, ++0x2D, 0x12, 0x4E, 0xA5, 0xE4, 0x90, 0x9C, 0x2D, ++0xF0, 0x12, 0xFC, 0xBC, 0x50, 0x1D, 0x12, 0xFB, ++0x70, 0x90, 0x9C, 0x2D, 0xE0, 0x24, 0x25, 0xF5, ++0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFF, ++0x90, 0x9C, 0x30, 0xD1, 0x87, 0xEF, 0x12, 0xFC, ++0xFC, 0x80, 0xDE, 0x22, 0xA3, 0xA3, 0xE0, 0x24, ++0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, ++0x22, 0x24, 0x30, 0xF9, 0xE4, 0x34, 0xFC, 0x22, ++0xF0, 0x90, 0x9A, 0x32, 0xE0, 0x04, 0xF0, 0x22, ++0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, ++0x01, 0x22, 0x24, 0x42, 0xF9, 0xE4, 0x34, 0xFC, ++0x22, 0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, 0x34, ++0xFC, 0xFA, 0x22, 0x12, 0x02, 0x06, 0x90, 0x88, ++0x9C, 0xF0, 0x60, 0x39, 0xA3, 0xE0, 0x20, 0xE0, ++0x34, 0x90, 0x8A, 0xB9, 0x12, 0x91, 0x62, 0xE4, ++0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x88, ++0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x1D, ++0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, ++0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, 0x13, 0x54, ++0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, ++0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, 0x12, 0xBF, ++0xEB, 0x90, 0x93, 0x08, 0x12, 0xCF, 0xDD, 0x12, ++0x8E, 0xFE, 0x90, 0x93, 0x09, 0x12, 0x8F, 0xED, ++0x90, 0x93, 0x0A, 0xF0, 0x12, 0xE1, 0x26, 0x90, ++0x93, 0x08, 0xE0, 0x54, 0x01, 0xFF, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0xDC, ++0xEF, 0xF0, 0x90, 0x93, 0x04, 0x12, 0xDB, 0xDB, ++0x30, 0xE0, 0x3C, 0x90, 0x95, 0xC1, 0x12, 0xDE, ++0x4A, 0x60, 0x10, 0x12, 0xDF, 0x6D, 0x40, 0x0B, ++0xE4, 0x7F, 0x0A, 0xFE, 0xFD, 0xFC, 0x90, 0x95, ++0xC5, 0x80, 0x09, 0xE4, 0x7F, 0x0A, 0xFE, 0xFD, ++0xFC, 0x90, 0x95, 0xBD, 0x12, 0x84, 0x52, 0x12, ++0x83, 0x1B, 0xC0, 0x07, 0x90, 0x93, 0x0A, 0xE0, ++0xFB, 0xE4, 0xFA, 0xF9, 0xF8, 0xD0, 0x07, 0x12, ++0x83, 0xA6, 0x90, 0x93, 0x0B, 0xEF, 0xF0, 0x90, ++0x9A, 0xDC, 0xE0, 0x64, 0x01, 0x70, 0x1B, 0xF1, ++0xC2, 0x60, 0x0A, 0x11, 0xFB, 0x12, 0x7C, 0x05, ++0x12, 0xE1, 0x1D, 0x80, 0x08, 0x11, 0xFB, 0x12, ++0x7C, 0x3B, 0x12, 0xFB, 0x62, 0x12, 0x79, 0xD4, ++0x80, 0x18, 0xF1, 0xC2, 0x60, 0x07, 0x11, 0xFB, ++0x12, 0x7C, 0x05, 0x80, 0x05, 0x11, 0xFB, 0x12, ++0x7C, 0x3B, 0xF1, 0xF0, 0x12, 0xFC, 0xCD, 0x12, ++0x7B, 0xCC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, ++0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, ++0x03, 0x22, 0x90, 0x9A, 0x0F, 0xEC, 0xF0, 0xA3, ++0xED, 0xF0, 0x90, 0x9A, 0x0D, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0xE4, 0x90, 0x9A, 0x33, 0xF0, 0xEF, ++0x24, 0x24, 0xFF, 0xE4, 0x3E, 0xFE, 0xC0, 0x06, ++0xB1, 0xB5, 0xD0, 0x06, 0xE4, 0xFB, 0xFA, 0xB1, ++0x6D, 0x4E, 0x60, 0x39, 0xE0, 0x24, 0x01, 0x91, ++0xD7, 0x71, 0x3F, 0x90, 0x9A, 0x12, 0xB1, 0x8A, ++0x90, 0x9A, 0x12, 0xB1, 0x95, 0xFE, 0xC3, 0x9F, ++0x50, 0x23, 0x90, 0x9A, 0x35, 0xE0, 0x24, 0x02, ++0xFD, 0x91, 0xD8, 0xFC, 0xEE, 0x7E, 0x00, 0x2D, ++0x71, 0x3C, 0x90, 0x9A, 0x11, 0xE0, 0x24, 0x13, ++0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEF, ++0xF0, 0xB1, 0x83, 0x80, 0xD3, 0xB1, 0xA7, 0xFE, ++0xC0, 0x06, 0xB1, 0xB5, 0xD0, 0x06, 0x7B, 0x03, ++0xB1, 0x6A, 0x90, 0x9A, 0x0E, 0xE0, 0x24, 0x22, ++0xB1, 0xAD, 0xFE, 0x90, 0x9A, 0x34, 0xF0, 0xA3, ++0xEF, 0xF0, 0x71, 0x40, 0xEF, 0x20, 0xE4, 0x02, ++0x41, 0x32, 0x90, 0x9A, 0x33, 0xE0, 0x04, 0xF0, ++0xB1, 0xA7, 0xFE, 0xC0, 0x06, 0xB1, 0xB5, 0xD0, ++0x06, 0x7B, 0x30, 0xB1, 0x6A, 0x4E, 0x60, 0x3F, ++0xE0, 0x24, 0x08, 0x91, 0xD7, 0x71, 0x3F, 0x90, ++0x9A, 0x37, 0xB1, 0x8A, 0xB1, 0x92, 0xC3, 0x9F, ++0x50, 0x2D, 0x90, 0x9A, 0x35, 0xE0, 0x24, 0x0D, ++0x91, 0xD7, 0x71, 0x3F, 0x90, 0x9A, 0x36, 0xEF, ++0xF0, 0xBF, 0x02, 0x09, 0x90, 0x9A, 0x33, 0xE0, ++0x24, 0x20, 0xF0, 0x80, 0x0E, 0x90, 0x9A, 0x36, ++0xE0, 0xB4, 0x04, 0x07, 0x90, 0x9A, 0x33, 0xE0, ++0x24, 0x40, 0xF0, 0xB1, 0x79, 0x80, 0xCD, 0xB1, ++0xA7, 0xFE, 0xC0, 0x06, 0xB1, 0xB5, 0xD0, 0x06, ++0x7B, 0xDD, 0x7A, 0x00, 0x7D, 0x01, 0xB1, 0x6E, ++0x4E, 0x60, 0x44, 0xE0, 0x24, 0x0C, 0x91, 0xD7, ++0x71, 0x3F, 0x90, 0x9A, 0x37, 0xB1, 0x8A, 0xB1, ++0x92, 0xC3, 0x9F, 0x50, 0x32, 0x90, 0x9A, 0x35, ++0xE0, 0x24, 0x11, 0x91, 0xD7, 0x71, 0x3F, 0x90, ++0x9A, 0x36, 0xEF, 0xF0, 0xBF, 0x02, 0x09, 0x90, ++0x9A, 0x33, 0xE0, 0x24, 0x02, 0xF0, 0x80, 0x0E, ++0x90, 0x9A, 0x36, 0xE0, 0xB4, 0x04, 0x07, 0x90, ++0x9A, 0x33, 0xE0, 0x24, 0x04, 0xF0, 0xB1, 0x79, ++0x80, 0xCD, 0xE4, 0x90, 0x9A, 0x33, 0xF0, 0x90, ++0x95, 0xB9, 0xE0, 0x90, 0x04, 0xFD, 0xB1, 0x8B, ++0x90, 0x95, 0xB9, 0xB1, 0x95, 0xFE, 0xC3, 0x9F, ++0x50, 0x64, 0x12, 0xFC, 0xAA, 0xF5, 0x83, 0xE0, ++0xFF, 0x90, 0x9A, 0x12, 0xE0, 0xFE, 0x6F, 0x70, ++0x51, 0x90, 0x04, 0xFC, 0xE0, 0x04, 0xF0, 0x90, ++0x9A, 0x11, 0xE0, 0x24, 0xD9, 0xF5, 0x82, 0xE4, ++0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x9A, ++0x33, 0xE0, 0xFD, 0x4F, 0x60, 0x04, 0xED, 0x5F, ++0x60, 0x30, 0xEE, 0xFF, 0x7E, 0x00, 0xC0, 0x06, ++0xC0, 0x07, 0x90, 0x9A, 0x11, 0xE0, 0x75, 0xF0, ++0x20, 0xA4, 0x24, 0x01, 0xF9, 0x74, 0x96, 0x12, ++0xFC, 0x55, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x86, ++0x1C, 0xEF, 0x70, 0x0E, 0x90, 0x01, 0xC7, 0x74, ++0x55, 0xF0, 0x7F, 0x01, 0x12, 0xC9, 0x1D, 0x12, ++0xB2, 0x9E, 0xB1, 0x83, 0x80, 0x92, 0xE4, 0x90, ++0x9A, 0x11, 0xF0, 0x90, 0x9A, 0x11, 0xE0, 0xFF, ++0xC3, 0x94, 0x03, 0x50, 0x62, 0xA3, 0xE0, 0xFE, ++0x60, 0x59, 0xEF, 0x75, 0xF0, 0x21, 0xA4, 0x24, ++0x00, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, ++0xE0, 0xFF, 0xEE, 0x6F, 0x70, 0x45, 0x90, 0x04, ++0xFC, 0xE0, 0x04, 0xF0, 0x90, 0x9A, 0x12, 0xE0, ++0xFF, 0x7E, 0x00, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0x9A, 0x11, 0xE0, 0x75, 0xF0, 0x21, 0xA4, 0x24, ++0x01, 0xF9, 0x74, 0x9B, 0x12, 0xFC, 0x55, 0xD0, ++0x07, 0xD0, 0x06, 0x12, 0x86, 0x1C, 0xEF, 0x70, ++0x1A, 0x90, 0x01, 0xC7, 0x74, 0x24, 0xF0, 0x7F, ++0x01, 0x12, 0xC9, 0x1D, 0x12, 0xCD, 0x07, 0x30, ++0xE0, 0x03, 0x12, 0xB3, 0x96, 0xF1, 0xB2, 0xE4, ++0xFF, 0x11, 0x66, 0xB1, 0x83, 0x80, 0x94, 0x22, ++0x90, 0x9A, 0x0D, 0xE0, 0xFD, 0x90, 0x9A, 0x0C, ++0xE0, 0x2D, 0xFD, 0x90, 0x9A, 0x0B, 0xE0, 0x34, ++0x00, 0xCD, 0x24, 0x10, 0xCD, 0x34, 0x00, 0xFC, ++0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, ++0x90, 0x8A, 0xE9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, ++0x82, 0x8C, 0x83, 0xE4, 0xFD, 0x02, 0x04, 0x7E, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0x06, 0x31, 0xE0, 0x54, 0xEF, 0x44, 0x08, 0xF0, ++0xED, 0x2F, 0xFF, 0xE4, 0x3E, 0xFE, 0x7C, 0x00, ++0xEF, 0x24, 0x08, 0xFF, 0xEC, 0x3E, 0x90, 0x9A, ++0x14, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, 0x00, 0x7F, ++0xE3, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x94, 0x79, ++0x35, 0x12, 0x04, 0x80, 0x90, 0x9A, 0x15, 0xE0, ++0x24, 0x01, 0xFF, 0x91, 0xD0, 0x71, 0x3F, 0x90, ++0x94, 0x36, 0xEF, 0xF0, 0x90, 0x9A, 0x15, 0xE0, ++0x24, 0x04, 0xFF, 0x91, 0xD0, 0x71, 0x3F, 0x90, ++0x94, 0x39, 0xEF, 0xF0, 0x90, 0x9A, 0x15, 0xE0, ++0x24, 0x05, 0xFF, 0x91, 0xD0, 0x71, 0x3F, 0x90, ++0x94, 0x3A, 0xEF, 0xF0, 0x90, 0x9A, 0x15, 0xE0, ++0x24, 0x06, 0xFF, 0x91, 0xD0, 0x71, 0x3F, 0x90, ++0x94, 0x3B, 0xEF, 0xF0, 0x90, 0x9A, 0x15, 0xE0, ++0x24, 0x07, 0xFF, 0x91, 0xD0, 0x71, 0x3F, 0x90, ++0x94, 0x3C, 0xEF, 0xF0, 0x90, 0x9A, 0x15, 0xE0, ++0x24, 0x08, 0xFF, 0x91, 0xD0, 0x71, 0x3F, 0x90, ++0x94, 0x3D, 0xEF, 0xF0, 0xE4, 0x90, 0x9A, 0x13, ++0xF0, 0xF1, 0x1F, 0x94, 0x08, 0x50, 0x1C, 0x90, ++0x9A, 0x15, 0xE0, 0x24, 0x09, 0xFD, 0x90, 0x9A, ++0x14, 0xE0, 0x71, 0x35, 0x90, 0x9A, 0x13, 0xE0, ++0x24, 0x3E, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, ++0x9C, 0x80, 0xDE, 0xE4, 0x90, 0x9A, 0x13, 0xF0, ++0xF1, 0x1F, 0x94, 0x02, 0x50, 0x1C, 0x90, 0x9A, ++0x15, 0xE0, 0x24, 0x61, 0xFD, 0x90, 0x9A, 0x14, ++0xE0, 0x71, 0x35, 0x90, 0x9A, 0x13, 0xE0, 0x24, ++0x96, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x9C, ++0x80, 0xDE, 0xE4, 0x90, 0x9A, 0x13, 0xF0, 0xF1, ++0x1F, 0x94, 0x10, 0x50, 0x1C, 0x90, 0x9A, 0x15, ++0xE0, 0x24, 0x31, 0xFD, 0x90, 0x9A, 0x14, 0xE0, ++0x71, 0x35, 0x90, 0x9A, 0x13, 0xE0, 0x24, 0x66, ++0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x9C, 0x80, ++0xDE, 0xE4, 0x90, 0x9A, 0x13, 0xF0, 0x90, 0x94, ++0x97, 0xE0, 0xFF, 0x90, 0x9A, 0x13, 0xE0, 0xFE, ++0xC3, 0x9F, 0x50, 0x1F, 0x90, 0x9A, 0x15, 0xE0, ++0x24, 0x63, 0xFD, 0x91, 0xD0, 0xFC, 0xEE, 0x7E, ++0x00, 0x2D, 0x71, 0x3C, 0x90, 0x9A, 0x13, 0xE0, ++0x24, 0x98, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, ++0x9C, 0x80, 0xD3, 0x90, 0x94, 0x3A, 0x12, 0xF9, ++0x82, 0x90, 0x9A, 0x11, 0xEE, 0xF0, 0xA3, 0xEF, ++0xF0, 0x30, 0xE3, 0x0D, 0x90, 0x01, 0xC7, 0x74, ++0x03, 0xF0, 0x7F, 0x01, 0x12, 0xC9, 0x1D, 0x80, ++0x20, 0x7E, 0x00, 0x90, 0x9A, 0x12, 0xE0, 0x54, ++0x07, 0xFF, 0x64, 0x01, 0x60, 0x05, 0xEF, 0x64, ++0x02, 0x70, 0x0E, 0xE4, 0xFD, 0x12, 0xE6, 0xBB, ++0x90, 0x06, 0x31, 0xE0, 0x54, 0xF7, 0x44, 0x10, ++0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x90, 0x9A, 0x14, 0xE0, 0x34, 0x00, 0x22, 0xFF, ++0x90, 0x9A, 0x34, 0xE0, 0x34, 0x00, 0x22, 0xF1, ++0xF7, 0xA3, 0xEA, 0xF0, 0xA3, 0xEB, 0xF0, 0xC3, ++0x90, 0x9A, 0x3E, 0xE0, 0x94, 0x01, 0x90, 0x9A, ++0x3D, 0xE0, 0x94, 0x00, 0x50, 0x02, 0x80, 0x6E, ++0xE4, 0x90, 0x9A, 0x41, 0xF0, 0xA3, 0xF0, 0xF1, ++0xCA, 0x71, 0x40, 0x90, 0x9A, 0x3B, 0xE0, 0x70, ++0x03, 0xA3, 0xE0, 0x6F, 0x70, 0x18, 0x90, 0x9A, ++0x39, 0xE0, 0x24, 0x02, 0xF1, 0xBA, 0xFE, 0x90, ++0x9A, 0x3A, 0xE0, 0xFD, 0x12, 0xFA, 0x17, 0xBF, ++0x01, 0x02, 0xE1, 0xCA, 0x80, 0x00, 0x90, 0x9A, ++0x39, 0xE0, 0x24, 0x01, 0xF1, 0xBA, 0x71, 0x3F, ++0x7E, 0x00, 0x90, 0x9A, 0x3F, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0x24, 0x02, 0xFF, 0xEE, 0x33, 0xFE, ++0x90, 0x9A, 0x38, 0x8F, 0xF0, 0x12, 0x02, 0xE7, ++0x90, 0x9A, 0x41, 0xEE, 0x8F, 0xF0, 0x12, 0x02, ++0xE7, 0x90, 0x9A, 0x3D, 0xE0, 0xFE, 0xA3, 0xE0, ++0xFF, 0xC3, 0x90, 0x9A, 0x42, 0xE0, 0x9F, 0x90, ++0x9A, 0x41, 0xE0, 0x9E, 0x40, 0x99, 0xE4, 0xFE, ++0xFF, 0x22, 0x7A, 0x00, 0xE4, 0xFD, 0x91, 0xDF, ++0x90, 0x9A, 0x34, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, ++0x22, 0x90, 0x9A, 0x34, 0xE4, 0x75, 0xF0, 0x04, ++0x12, 0x02, 0xE7, 0x90, 0x9A, 0x11, 0xE0, 0x04, ++0xF0, 0x22, 0xEF, 0xF0, 0xE4, 0x90, 0x9A, 0x11, ++0xF0, 0x22, 0x90, 0x9A, 0x37, 0xE0, 0xFF, 0x90, ++0x9A, 0x11, 0xE0, 0x22, 0xF5, 0x83, 0xEF, 0xF0, ++0x90, 0x9A, 0x13, 0xE0, 0x04, 0xF0, 0x22, 0x90, ++0x9A, 0x0E, 0xE0, 0x24, 0x24, 0xFF, 0x90, 0x9A, ++0x0D, 0xE0, 0x34, 0x00, 0x22, 0x90, 0x9A, 0x10, ++0xE0, 0x24, 0xDC, 0xFE, 0x90, 0x9A, 0x0F, 0xE0, ++0x34, 0xFF, 0x90, 0x9A, 0x3D, 0xF0, 0xA3, 0xCE, ++0xF0, 0x22, 0x12, 0xC7, 0x92, 0xA3, 0xED, 0xF0, ++0x12, 0xDF, 0x5B, 0x7A, 0x80, 0x79, 0x80, 0x12, ++0xDF, 0x44, 0x78, 0x1A, 0x7C, 0x9A, 0x7D, 0x01, ++0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x86, 0xF1, 0x26, ++0x78, 0x1E, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, 0xFF, ++0x7A, 0x80, 0x79, 0x8A, 0xF1, 0x26, 0xE4, 0x90, ++0x9A, 0x23, 0xF0, 0xF1, 0xE5, 0xFF, 0xF1, 0x18, ++0xCF, 0x24, 0x06, 0xCF, 0x34, 0x00, 0x71, 0x3F, ++0xEF, 0x64, 0x08, 0x60, 0x02, 0xC1, 0xFC, 0xF1, ++0xE5, 0xFF, 0xF1, 0x18, 0xCF, 0x24, 0x07, 0xCF, ++0x34, 0x00, 0x71, 0x3F, 0xEF, 0x64, 0x06, 0x60, ++0x02, 0xC1, 0xFC, 0x90, 0x9A, 0x23, 0x04, 0xF0, ++0xE4, 0x90, 0x9A, 0x22, 0xF0, 0xF1, 0xDC, 0x50, ++0x17, 0x90, 0x9A, 0x0C, 0xE0, 0x24, 0x0A, 0xFD, ++0x90, 0x9A, 0x0B, 0xE0, 0x71, 0x35, 0x90, 0x9A, ++0x22, 0x12, 0xDF, 0x52, 0xF1, 0x02, 0x80, 0xE5, ++0x78, 0x0E, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, 0x01, ++0x7A, 0x93, 0x79, 0x34, 0x12, 0xCF, 0xAC, 0x60, ++0x02, 0xC1, 0xFC, 0x90, 0x9A, 0x22, 0xF0, 0xF1, ++0xD3, 0x50, 0x16, 0xF1, 0x0D, 0xCD, 0x24, 0x20, ++0x71, 0x34, 0x90, 0x9A, 0x22, 0xE0, 0x24, 0x1E, ++0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF1, 0x02, 0x80, ++0xE6, 0x78, 0x1E, 0x7C, 0x9A, 0x12, 0xFC, 0x2B, ++0x70, 0x71, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x01, ++0x54, 0xDF, 0xF0, 0x90, 0x93, 0x26, 0xE0, 0x30, ++0xE0, 0x02, 0x80, 0x0D, 0x90, 0x98, 0x05, 0xE0, ++0xB4, 0x02, 0x10, 0x12, 0xC6, 0x11, 0x20, 0xE0, ++0x0A, 0x90, 0x01, 0xC7, 0x74, 0x09, 0x12, 0xC7, ++0x78, 0x80, 0x51, 0xE4, 0x90, 0x9A, 0x22, 0xF0, ++0xF1, 0xDC, 0x50, 0x0C, 0x71, 0x20, 0x90, 0x9A, ++0x22, 0x12, 0xCF, 0x88, 0xF1, 0x02, 0x80, 0xF0, ++0xE4, 0x90, 0x9A, 0x22, 0xF0, 0xF1, 0xD3, 0x50, ++0x16, 0xF1, 0x0D, 0xCD, 0x24, 0x16, 0x71, 0x34, ++0x90, 0x9A, 0x22, 0xE0, 0x24, 0x1A, 0xF5, 0x82, ++0xE4, 0x34, 0x9A, 0xF1, 0x02, 0x80, 0xE6, 0x7B, ++0x01, 0x7A, 0x9A, 0x79, 0x14, 0x12, 0xF1, 0xDC, ++0xA3, 0xF0, 0x7A, 0x9A, 0x79, 0x1A, 0x12, 0x9A, ++0x22, 0x80, 0x09, 0x90, 0x06, 0x30, 0xE0, 0x44, ++0x21, 0x54, 0xEF, 0xF0, 0x90, 0x9A, 0x23, 0xE0, ++0xFF, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x9A, ++0x22, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x9A, 0x0D, ++0xE0, 0xFD, 0x90, 0x9A, 0x0C, 0xE0, 0x2D, 0xFD, ++0x90, 0x9A, 0x0B, 0xE0, 0x34, 0x00, 0x22, 0x90, ++0x9A, 0x13, 0xE0, 0xFF, 0xC3, 0x22, 0x7E, 0x00, ++0x7F, 0x04, 0x02, 0x01, 0xE0, 0x90, 0x9A, 0x12, ++0xF1, 0xFA, 0x78, 0x16, 0x7C, 0x9A, 0x7D, 0x01, ++0x7B, 0xFF, 0x7A, 0x80, 0x79, 0xBA, 0xF1, 0x26, ++0x90, 0x9A, 0x14, 0xE0, 0xFF, 0x90, 0x9A, 0x13, ++0xE0, 0x2F, 0x12, 0xCF, 0xA3, 0x90, 0x9A, 0x1A, ++0xF0, 0xA3, 0xEF, 0xF0, 0x24, 0x06, 0xFF, 0xE4, ++0x3E, 0x71, 0x3F, 0xEF, 0x64, 0x08, 0x70, 0x51, ++0x90, 0x9A, 0x1B, 0xE0, 0x24, 0x07, 0xFF, 0x90, ++0x9A, 0x1A, 0xE0, 0x34, 0x00, 0x71, 0x3F, 0xEF, ++0x70, 0x3F, 0x90, 0x9A, 0x15, 0xF0, 0x90, 0x9A, ++0x15, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x24, ++0x90, 0x9A, 0x1B, 0xE0, 0x24, 0x18, 0xFD, 0x90, ++0x9A, 0x1A, 0xE0, 0x71, 0x35, 0x90, 0x9A, 0x15, ++0xE0, 0x24, 0x16, 0xF5, 0x82, 0xE4, 0x34, 0x9A, ++0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x9A, 0x15, 0xE0, ++0x04, 0xF0, 0x80, 0xD2, 0x78, 0x16, 0x7C, 0x9A, ++0x12, 0xFC, 0x2B, 0x7F, 0x00, 0x70, 0x02, 0x7F, ++0x01, 0x22, 0x12, 0xFC, 0x61, 0x79, 0x08, 0x02, ++0x04, 0x80, 0xFF, 0x90, 0x9A, 0x38, 0xE0, 0x34, ++0x00, 0x22, 0x90, 0x93, 0x0A, 0xE0, 0x90, 0x01, ++0x3F, 0x22, 0x90, 0x9A, 0x38, 0xE0, 0xFE, 0xA3, ++0xE0, 0xFF, 0x22, 0x90, 0x9A, 0x22, 0xE0, 0xFF, ++0xC3, 0x94, 0x04, 0x22, 0x90, 0x9A, 0x22, 0xE0, ++0xFF, 0xC3, 0x94, 0x06, 0x22, 0x90, 0x9A, 0x0D, ++0xE0, 0xFF, 0x90, 0x9A, 0x0C, 0xE0, 0x2F, 0x22, ++0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x74, 0x90, ++0x9A, 0x38, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, ++0xED, 0xF0, 0x22, 0x90, 0x93, 0x0C, 0xE0, 0x20, ++0xE0, 0x02, 0x01, 0xD0, 0xE4, 0x90, 0x99, 0x88, ++0xF0, 0x90, 0x99, 0x88, 0xE0, 0xFF, 0xC3, 0x94, ++0x05, 0x40, 0x02, 0x01, 0xD0, 0x31, 0x8F, 0x80, ++0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, ++0xFF, 0x90, 0x93, 0x0D, 0xE0, 0xFD, 0xEF, 0x5D, ++0x60, 0x02, 0x01, 0xC8, 0x12, 0x02, 0x06, 0xFF, ++0x30, 0xE0, 0x1A, 0x90, 0x93, 0x0E, 0xE0, 0xFE, ++0x90, 0x99, 0x88, 0xE0, 0xFD, 0x74, 0x01, 0xA8, ++0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, ++0x4E, 0x90, 0x93, 0x0E, 0xF0, 0xEF, 0xC3, 0x13, ++0x30, 0xE0, 0x15, 0x90, 0x93, 0x0F, 0xE0, 0xFF, ++0x90, 0x99, 0x88, 0x11, 0xD9, 0x80, 0x02, 0xC3, ++0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x0F, 0xF0, ++0x12, 0x8E, 0xFF, 0xFF, 0x90, 0x99, 0x88, 0xE0, ++0xFE, 0x24, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x93, ++0xF5, 0x83, 0xEF, 0x12, 0x8F, 0xED, 0xFF, 0x74, ++0x15, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, ++0x83, 0xEF, 0xF0, 0x12, 0x8F, 0xF4, 0xFF, 0x74, ++0x1A, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, ++0x83, 0xEF, 0x12, 0x97, 0x30, 0xFF, 0x74, 0x1F, ++0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, ++0xEF, 0xF0, 0x90, 0x93, 0x0D, 0xE0, 0xFF, 0x74, ++0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, ++0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x0D, 0xF0, 0x22, ++0x90, 0x99, 0x88, 0xE0, 0x04, 0xF0, 0x01, 0x11, ++0x22, 0x7F, 0x61, 0x12, 0x7B, 0x41, 0x90, 0x9C, ++0x9D, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x90, 0x9C, 0x9E, 0xED, 0xF0, 0x90, 0x9C, 0x9D, ++0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x42, 0x7F, ++0x47, 0x11, 0xD3, 0x80, 0x02, 0xC3, 0x33, 0xD8, ++0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, 0x12, 0x7B, ++0x2E, 0x7F, 0x46, 0x11, 0xD3, 0x80, 0x02, 0xC3, ++0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x46, 0x31, ++0x87, 0x60, 0x0D, 0x7F, 0x45, 0x11, 0xD3, 0x80, ++0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x80, 0x0C, ++0x7F, 0x45, 0x11, 0xD3, 0x80, 0x02, 0xC3, 0x33, ++0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x45, 0x80, ++0x46, 0x90, 0x9C, 0x9D, 0xE0, 0x24, 0xF8, 0xF0, ++0x7F, 0x63, 0x11, 0xD3, 0x80, 0x02, 0xC3, 0x33, ++0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x12, ++0x7B, 0x2E, 0x7F, 0x62, 0x11, 0xD3, 0x80, 0x02, ++0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, ++0x31, 0x87, 0x60, 0x0E, 0x11, 0xD1, 0x80, 0x02, ++0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, ++0x80, 0x0D, 0x11, 0xD1, 0x80, 0x02, 0xC3, 0x33, ++0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x12, ++0x7B, 0x2E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, ++0x7B, 0x2E, 0x90, 0x9C, 0x9E, 0xE0, 0x22, 0x74, ++0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x22, 0xE4, ++0x90, 0x99, 0xE3, 0xF0, 0x12, 0xED, 0x73, 0x7F, ++0x08, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xEF, 0xFD, ++0x7F, 0x08, 0x12, 0x7B, 0x2E, 0xE4, 0xFF, 0x91, ++0x1A, 0x90, 0x93, 0x0C, 0xE0, 0x20, 0xE0, 0x02, ++0x41, 0x97, 0x91, 0x13, 0x44, 0x02, 0x91, 0xC9, ++0xE4, 0x90, 0x99, 0xE4, 0xF0, 0x90, 0x99, 0xE4, ++0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2C, 0x31, ++0x8F, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, ++0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x0F, 0xE0, 0xFD, ++0xEF, 0x5D, 0x60, 0x0F, 0x90, 0x99, 0xE4, 0xF1, ++0xF6, 0x90, 0x99, 0xE4, 0x12, 0xFB, 0xCE, 0x44, ++0x40, 0x91, 0x69, 0x90, 0x99, 0xE4, 0xE0, 0x04, ++0xF0, 0x80, 0xCA, 0x90, 0x07, 0xC7, 0xE4, 0xF0, ++0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, ++0x77, 0xF0, 0x90, 0x07, 0xC4, 0xE4, 0xF0, 0x90, ++0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, ++0xA3, 0x12, 0xF1, 0xB3, 0x90, 0x02, 0x26, 0xE0, ++0x44, 0x01, 0xF0, 0xE0, 0x90, 0x99, 0xE5, 0xF0, ++0x90, 0x99, 0xE5, 0xE0, 0x30, 0xE0, 0x1A, 0x90, ++0x99, 0xE3, 0xE0, 0x04, 0xF0, 0x12, 0xD7, 0x54, ++0x90, 0x02, 0x26, 0xE0, 0x90, 0x99, 0xE5, 0xF0, ++0x90, 0x99, 0xE3, 0xE0, 0xD3, 0x94, 0xFA, 0x40, ++0xDF, 0x90, 0x02, 0x03, 0x74, 0x80, 0xF0, 0x90, ++0x04, 0x24, 0xE0, 0x90, 0x99, 0xE6, 0xF0, 0x90, ++0x04, 0x22, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x02, ++0x00, 0xE0, 0x90, 0x99, 0xE5, 0xF0, 0x90, 0x02, ++0x01, 0x51, 0xA7, 0x90, 0x02, 0x02, 0x51, 0xA7, ++0x90, 0x02, 0x14, 0x51, 0xA7, 0xE0, 0x04, 0xF0, ++0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0x04, 0x22, ++0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x99, 0xE6, 0xE0, ++0x90, 0x04, 0x24, 0xF0, 0x90, 0xFD, 0x09, 0x74, ++0xFF, 0xF0, 0x90, 0xFD, 0x08, 0xE4, 0xF0, 0xF1, ++0xE3, 0xE0, 0x90, 0x92, 0x90, 0xD1, 0xC9, 0x90, ++0x88, 0x32, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE0, ++0xFF, 0x90, 0x99, 0xE5, 0xE0, 0x2F, 0xF0, 0x22, ++0x75, 0x10, 0x14, 0x90, 0x88, 0x32, 0xE0, 0x44, ++0x10, 0xF0, 0xF1, 0xE3, 0xE0, 0x90, 0x92, 0x90, ++0xF0, 0x7D, 0x01, 0x12, 0x76, 0xF7, 0x90, 0x88, ++0x41, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, ++0x90, 0x88, 0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, ++0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, ++0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, ++0x90, 0x93, 0x0C, 0xE0, 0x30, 0xE0, 0x65, 0x90, ++0xFD, 0x09, 0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, ++0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, ++0x90, 0x99, 0xE3, 0xF0, 0x90, 0x99, 0xE3, 0xE0, ++0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2C, 0x31, 0x8F, ++0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, ++0xF9, 0xFF, 0x90, 0x93, 0x0E, 0xE0, 0xFD, 0xEF, ++0x5D, 0x60, 0x0F, 0x90, 0x99, 0xE3, 0xF1, 0xF6, ++0x90, 0x99, 0xE3, 0x12, 0xFB, 0xCE, 0x44, 0x20, ++0x91, 0x69, 0x90, 0x99, 0xE3, 0xE0, 0x04, 0xF0, ++0x80, 0xCA, 0x71, 0xE2, 0x54, 0xFE, 0xFD, 0x7F, ++0x92, 0x12, 0x7B, 0x2E, 0x71, 0xE2, 0x44, 0x08, ++0xFD, 0x7F, 0x92, 0x91, 0x10, 0x54, 0xFD, 0xFD, ++0x7F, 0x02, 0x80, 0x07, 0x71, 0xE2, 0x44, 0x01, ++0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x7F, 0x08, ++0x12, 0x7B, 0x41, 0xEF, 0x44, 0x10, 0xFD, 0x7F, ++0x08, 0x12, 0x7B, 0x2E, 0x7F, 0x01, 0x91, 0x1A, ++0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x7F, 0x14, 0x7E, 0x00, 0x02, ++0x7C, 0x6A, 0x7F, 0x92, 0x12, 0x7B, 0x41, 0xEF, ++0x22, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, ++0x01, 0xFD, 0x7F, 0x02, 0x12, 0x7B, 0x2E, 0x7F, ++0x02, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFE, 0xFD, ++0x7F, 0x02, 0x12, 0x7B, 0x2E, 0x7F, 0x02, 0x12, ++0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, ++0x12, 0x7B, 0x2E, 0x7F, 0x02, 0x12, 0x7B, 0x41, ++0xEF, 0x22, 0x90, 0x9C, 0x96, 0xEF, 0x12, 0xCF, ++0x6A, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, ++0xE7, 0x02, 0x7F, 0x01, 0x90, 0x9C, 0x96, 0xE0, ++0x6F, 0x60, 0x35, 0xC3, 0x90, 0x9C, 0x98, 0xE0, ++0x94, 0x88, 0x90, 0x9C, 0x97, 0xE0, 0x94, 0x13, ++0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, ++0xF0, 0x22, 0x90, 0x9C, 0x97, 0x12, 0xD5, 0xCD, ++0x91, 0x6A, 0xD3, 0x90, 0x9C, 0x98, 0xE0, 0x94, ++0x32, 0x90, 0x9C, 0x97, 0xE0, 0x94, 0x00, 0x40, ++0xC0, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB9, ++0x22, 0xF0, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, ++0x6A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0xD1, 0xDF, 0xEC, 0x90, 0x9C, 0x7C, 0x12, 0x04, ++0x31, 0x90, 0x9C, 0x7C, 0xD1, 0xD6, 0xD1, 0xCF, ++0xF1, 0xD1, 0xF0, 0x7D, 0x01, 0x12, 0x76, 0xF7, ++0x12, 0x8C, 0x11, 0x90, 0x06, 0xB7, 0x74, 0x11, ++0xF0, 0x7F, 0x03, 0x7E, 0x00, 0x12, 0x7C, 0x6A, ++0x90, 0x06, 0xB4, 0xE0, 0x54, 0x0F, 0x70, 0xF1, ++0x91, 0x13, 0x91, 0xC7, 0x71, 0xE9, 0x91, 0xC7, ++0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, ++0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, ++0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x54, ++0xFE, 0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD1, 0xDF, ++0xEC, 0x90, 0x9C, 0x78, 0x12, 0x04, 0x31, 0x90, ++0x9C, 0x78, 0xD1, 0xD6, 0xD1, 0xCF, 0x90, 0x01, ++0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, ++0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, ++0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0xF1, ++0xD1, 0xD1, 0xC9, 0x71, 0xE9, 0x54, 0xFE, 0x91, ++0x0D, 0x44, 0x01, 0x91, 0xC9, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x12, 0xC7, 0x81, 0x60, 0x02, 0xC1, ++0x47, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0xC1, ++0x47, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x2F, ++0x90, 0x06, 0xA9, 0xE0, 0x54, 0xC0, 0x70, 0x27, ++0x90, 0x88, 0x9C, 0xE0, 0x70, 0x21, 0x90, 0x04, ++0x1A, 0xE0, 0xF4, 0x70, 0x1A, 0xE0, 0x54, 0x07, ++0x64, 0x07, 0x70, 0x13, 0x90, 0x06, 0x62, 0xE0, ++0x54, 0x03, 0x70, 0x0B, 0x90, 0x88, 0x39, 0xE0, ++0xB4, 0x04, 0x04, 0x91, 0x13, 0x91, 0xC7, 0x90, ++0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, 0x90, ++0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, 0x90, ++0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, 0x90, ++0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, 0x90, ++0x07, 0xF1, 0xE0, 0x90, 0x99, 0x79, 0xF0, 0x90, ++0x07, 0xF0, 0xE0, 0x90, 0x99, 0x7A, 0xF0, 0x12, ++0xDB, 0x3B, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, ++0xEC, 0xF0, 0xD1, 0x50, 0x24, 0xFD, 0x50, 0x02, ++0x80, 0x02, 0xD1, 0x59, 0xD1, 0x50, 0x64, 0x01, ++0x70, 0x30, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, ++0x3D, 0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x30, 0xE5, ++0x05, 0xA3, 0xE0, 0xFF, 0x80, 0x05, 0x90, 0x88, ++0x3C, 0xE0, 0xFF, 0x90, 0x88, 0x3C, 0xEF, 0xF0, ++0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, ++0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x88, 0x3D, ++0xEF, 0xF0, 0x12, 0xE1, 0x4C, 0xE4, 0x90, 0x88, ++0x3F, 0xF0, 0xA3, 0xF0, 0x12, 0xDB, 0xD8, 0x30, ++0xE0, 0x5E, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, ++0x20, 0xE0, 0x26, 0xD1, 0x48, 0x6F, 0x70, 0x50, ++0xEF, 0x60, 0x4D, 0x90, 0x88, 0x32, 0xE0, 0x44, ++0x40, 0xF0, 0x12, 0xFC, 0xD4, 0x12, 0xA0, 0xF7, ++0x12, 0x7C, 0x05, 0x12, 0xFB, 0x69, 0x12, 0xDF, ++0x4B, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0x80, ++0x2F, 0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, ++0x64, 0x01, 0x70, 0x24, 0xD1, 0x48, 0xFE, 0x6F, ++0x60, 0x1E, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, ++0x6F, 0x60, 0x15, 0x12, 0xCF, 0xBE, 0x30, 0xE0, ++0x0F, 0xEF, 0x54, 0xBF, 0x12, 0xA0, 0xF7, 0x12, ++0x7C, 0x3B, 0x12, 0xFC, 0xCD, 0x12, 0xA7, 0xF0, ++0x90, 0x88, 0x32, 0xE0, 0x44, 0x04, 0xF0, 0x22, ++0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, ++0x90, 0x88, 0x34, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, ++0x22, 0xE4, 0xF5, 0x11, 0x90, 0x06, 0xA9, 0xE0, ++0xF5, 0x11, 0x54, 0xC0, 0x70, 0x17, 0xD1, 0xC1, ++0x54, 0xFD, 0xF0, 0xD1, 0xEB, 0x90, 0x88, 0x39, ++0xE0, 0x60, 0x4D, 0x91, 0x13, 0x44, 0x01, 0xFD, ++0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE5, 0x11, 0x30, ++0xE6, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, ++0x70, 0x1C, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, ++0x12, 0x97, 0xE5, 0x64, 0x02, 0x60, 0x08, 0x90, ++0x8A, 0xE1, 0x12, 0x8C, 0x14, 0x80, 0x07, 0x12, ++0x73, 0x8F, 0x80, 0x02, 0xD1, 0xC1, 0xE5, 0x11, ++0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0E, 0xE0, 0x44, ++0x02, 0x12, 0xC6, 0xAD, 0x90, 0x88, 0x31, 0xE0, ++0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, ++0x22, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFE, 0xF0, ++0x22, 0xF0, 0xE4, 0xFD, 0x02, 0x76, 0xF7, 0x7F, ++0x30, 0x7E, 0x08, 0x02, 0x70, 0xAD, 0x12, 0x04, ++0xB8, 0x90, 0x92, 0x18, 0x02, 0x04, 0x31, 0x7F, ++0x30, 0x7E, 0x08, 0x12, 0x70, 0x70, 0xED, 0x44, ++0x80, 0xFD, 0x22, 0x90, 0x88, 0x38, 0xE0, 0xFF, ++0x90, 0x8A, 0xB9, 0xF1, 0x05, 0x7D, 0x01, 0x02, ++0x04, 0x7E, 0x90, 0x9A, 0x10, 0xE0, 0xFE, 0xA3, ++0xE0, 0xFF, 0x90, 0x8A, 0xE9, 0xE0, 0xFC, 0xA3, ++0xE0, 0xF5, 0x82, 0x8C, 0x83, 0x22, 0x90, 0x9A, ++0x0D, 0xED, 0x12, 0xC7, 0x91, 0x12, 0xCD, 0x21, ++0xEF, 0x70, 0x02, 0xE1, 0xBE, 0x12, 0xC5, 0x83, ++0x12, 0xCF, 0x80, 0x70, 0x02, 0xE1, 0xBE, 0x12, ++0xA7, 0xE5, 0xFF, 0x12, 0xA7, 0x18, 0xCF, 0x24, ++0x08, 0xCF, 0x34, 0x00, 0x90, 0x9A, 0x10, 0xF0, ++0xA3, 0xEF, 0xF0, 0x90, 0x93, 0x25, 0xE0, 0xC4, ++0x54, 0x0F, 0x30, 0xE0, 0x33, 0xD1, 0xFA, 0x7D, ++0x09, 0x12, 0x04, 0x7E, 0xEF, 0x64, 0x06, 0x70, ++0x27, 0xD1, 0xFA, 0x7D, 0x14, 0x12, 0x04, 0x7E, ++0xEF, 0x70, 0x1D, 0xD1, 0xFA, 0x7D, 0x15, 0x12, ++0x04, 0x7E, 0xEF, 0x64, 0x50, 0x70, 0x11, 0xD1, ++0xFA, 0x7D, 0x21, 0x12, 0x04, 0x7E, 0xEF, 0x20, ++0xE0, 0x03, 0x30, 0xE2, 0x03, 0x7F, 0x01, 0x22, ++0x90, 0x93, 0x25, 0xE0, 0x13, 0x13, 0x54, 0x3F, ++0x30, 0xE0, 0x3B, 0xD1, 0xFA, 0x7D, 0x09, 0x12, ++0x04, 0x7E, 0xEF, 0x64, 0x11, 0x70, 0x2F, 0x90, ++0x9A, 0x11, 0xE0, 0x24, 0x14, 0xFF, 0x90, 0x9A, ++0x10, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x9A, 0x0E, ++0xF0, 0xA3, 0xEF, 0xF0, 0xF1, 0x02, 0x7D, 0x02, ++0x12, 0x04, 0x7E, 0xEF, 0x70, 0x10, 0x90, 0x9A, ++0x0E, 0xD1, 0xFD, 0x7D, 0x03, 0x12, 0x04, 0x7E, ++0xBF, 0x89, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x51, 0xB0, 0x31, 0x97, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x90, 0x93, 0x42, 0xE0, 0xFF, 0x90, 0x93, ++0x41, 0xE0, 0xFB, 0x90, 0x93, 0x43, 0xE0, 0x90, ++0x92, 0x90, 0x22, 0x90, 0x88, 0xA0, 0xE0, 0xC4, ++0x13, 0x13, 0x54, 0x01, 0xFF, 0x90, 0x88, 0xE0, ++0xE0, 0xFB, 0x90, 0x88, 0xDF, 0x22, 0xE0, 0xFF, ++0x24, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, ++0x83, 0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, 0x1F, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, ++0xE0, 0x90, 0x01, 0xB1, 0xF0, 0x22, 0x12, 0x02, ++0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x0C, 0xE0, ++0x54, 0xFE, 0x4F, 0xF0, 0x30, 0xE0, 0x03, 0xE4, ++0x11, 0x2C, 0x22, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, ++0xA3, 0xF0, 0x22, 0x12, 0xC9, 0x9D, 0xE4, 0x90, ++0x98, 0x11, 0x11, 0x2B, 0x90, 0x95, 0x63, 0x11, ++0x2B, 0xA3, 0x11, 0x2B, 0xA3, 0xF0, 0xA3, 0xF0, ++0x90, 0x95, 0x75, 0xF0, 0xA3, 0xF0, 0x90, 0x95, ++0xB7, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x9A, 0xC8, ++0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x84, ++0x67, 0x90, 0x9A, 0xCA, 0x12, 0x84, 0x5E, 0x8B, ++0x45, 0x8A, 0x46, 0x11, 0xD6, 0x24, 0x02, 0x11, ++0xED, 0x31, 0x28, 0x24, 0x04, 0x11, 0xCF, 0x24, ++0x03, 0x11, 0xED, 0x31, 0x28, 0x24, 0x08, 0x11, ++0xCF, 0x24, 0x04, 0x11, 0xED, 0x31, 0x28, 0x24, ++0x0C, 0x11, 0xCF, 0x24, 0x05, 0x11, 0xED, 0x90, ++0x9A, 0xC9, 0xE0, 0xFD, 0xB4, 0x02, 0x08, 0x90, ++0x9A, 0xC8, 0xE0, 0x44, 0x48, 0x80, 0x0A, 0xED, ++0xB4, 0x04, 0x0A, 0x90, 0x9A, 0xC8, 0xE0, 0x44, ++0x50, 0x90, 0x9A, 0xCE, 0xF0, 0x90, 0x9A, 0xCF, ++0x74, 0x80, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0xA3, ++0xF0, 0x11, 0xE4, 0x11, 0xED, 0x90, 0x9A, 0xCE, ++0x74, 0xFF, 0x11, 0x2B, 0x11, 0xE4, 0x04, 0x11, ++0xED, 0x90, 0x06, 0x72, 0xE4, 0xF0, 0x22, 0xF9, ++0xE4, 0x3A, 0x8B, 0x45, 0xF5, 0x46, 0x89, 0x47, ++0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x9A, 0x79, ++0xCE, 0x12, 0x69, 0xF5, 0x90, 0x9A, 0xC8, 0xE0, ++0x75, 0xF0, 0x08, 0xA4, 0x22, 0xFF, 0x90, 0x9A, ++0xCD, 0xF0, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0xCE, ++0x12, 0x02, 0x06, 0x90, 0x06, 0x74, 0x12, 0x8E, ++0xFE, 0x90, 0x06, 0x75, 0x12, 0x8F, 0xED, 0x90, ++0x06, 0x76, 0xF0, 0x12, 0x8F, 0xF4, 0x90, 0x06, ++0x77, 0xF0, 0x90, 0x06, 0x70, 0xEF, 0xF0, 0xA3, ++0xE4, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x74, 0x80, ++0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x02, 0x7C, 0x6A, ++0x90, 0x9A, 0xCA, 0x12, 0x84, 0x5E, 0xE9, 0x22, ++0x7E, 0x00, 0x7F, 0x25, 0x7D, 0x00, 0x7B, 0x01, ++0x7A, 0x93, 0x79, 0x24, 0x12, 0x04, 0x80, 0x90, ++0x06, 0x90, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0xF2, ++0x49, 0x11, 0x33, 0x90, 0x86, 0xB3, 0xE0, 0xFF, ++0x64, 0x02, 0x70, 0x2A, 0x51, 0x0F, 0x30, 0xE0, ++0x02, 0x7E, 0x01, 0x90, 0x93, 0x43, 0x51, 0x0D, ++0x30, 0xE1, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x41, ++0x51, 0x0D, 0x30, 0xE2, 0x02, 0x7E, 0x01, 0x90, ++0x93, 0x42, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, ++0x90, 0x02, 0xFB, 0xF0, 0x80, 0x46, 0xEF, 0x64, ++0x01, 0x70, 0x1D, 0x51, 0x06, 0x30, 0xE0, 0x02, ++0x7F, 0x01, 0x90, 0x93, 0x43, 0x51, 0x04, 0x30, ++0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x41, 0x51, ++0x04, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, 0x1F, ++0x51, 0x89, 0x70, 0x20, 0x31, 0xFD, 0x30, 0xE0, ++0x02, 0x7F, 0x01, 0x90, 0x93, 0x43, 0x31, 0xFB, ++0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x41, ++0x31, 0xFB, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x90, ++0x93, 0x42, 0xEF, 0xF0, 0x90, 0x93, 0x24, 0xE0, ++0x54, 0xEF, 0xF0, 0xE4, 0x90, 0x95, 0xB9, 0xF0, ++0xA3, 0xF0, 0x90, 0x95, 0xC1, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x00, 0x00, 0x90, 0x95, 0xC5, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x90, 0x95, ++0xBD, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, ++0x90, 0x98, 0x01, 0x12, 0x04, 0x3D, 0x00, 0x00, ++0x00, 0x00, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x78, ++0xE0, 0x7F, 0x00, 0x22, 0xEF, 0xF0, 0x90, 0xFD, ++0x70, 0xE0, 0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, ++0xFD, 0x80, 0xE0, 0x7E, 0x00, 0x22, 0x7E, 0x00, ++0x7F, 0x33, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, ++0x79, 0x9D, 0x12, 0x04, 0x80, 0x90, 0x88, 0x9E, ++0x74, 0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0x7E, ++0x00, 0x7F, 0x0C, 0x7D, 0x00, 0x7B, 0x01, 0x7A, ++0x99, 0x79, 0x7C, 0x12, 0x04, 0x80, 0x90, 0x86, ++0xB3, 0xE0, 0xFC, 0x64, 0x02, 0x70, 0x14, 0x51, ++0x0F, 0x30, 0xE2, 0x02, 0x7E, 0x01, 0xEE, 0x51, ++0x81, 0xFE, 0x90, 0x88, 0xA0, 0xE0, 0x54, 0xBF, ++0x4E, 0xF0, 0x22, 0xEC, 0x64, 0x01, 0x70, 0x09, ++0x51, 0x06, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, ++0x0B, 0x51, 0x89, 0x70, 0x13, 0x31, 0xFD, 0x30, ++0xE2, 0x02, 0x7F, 0x01, 0xEF, 0x51, 0x81, 0xFF, ++0x90, 0x88, 0xA0, 0xE0, 0x54, 0xBF, 0x4F, 0xF0, ++0x22, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, ++0x22, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, 0x22, ++0x90, 0x93, 0x24, 0x12, 0xC7, 0xE0, 0x30, 0xE0, ++0x02, 0x11, 0x33, 0x22, 0x51, 0x90, 0x90, 0x93, ++0x24, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, ++0x04, 0x71, 0x96, 0x31, 0xC4, 0x22, 0xEF, 0x70, ++0x02, 0x61, 0x5E, 0x90, 0x06, 0x0F, 0xE0, 0x20, ++0xE6, 0x1D, 0x90, 0x98, 0x38, 0xE0, 0x54, 0xFE, ++0xF0, 0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE5, 0x07, ++0x90, 0x01, 0x0C, 0xE0, 0x30, 0xE1, 0x45, 0x90, ++0x01, 0xC7, 0x74, 0x44, 0xF0, 0x80, 0xFE, 0x90, ++0x98, 0x38, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x06, ++0x0F, 0xE0, 0x30, 0xE5, 0x10, 0x90, 0x01, 0x0C, ++0xE0, 0x20, 0xE1, 0x09, 0x90, 0x98, 0x38, 0xE0, ++0x54, 0xFD, 0xF0, 0x80, 0x1F, 0x90, 0x06, 0x0F, ++0xE0, 0x20, 0xE5, 0x10, 0x90, 0x01, 0x0C, 0xE0, ++0x30, 0xE1, 0x09, 0x90, 0x98, 0x38, 0xE0, 0x44, ++0x02, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xC7, 0x74, ++0x44, 0xF0, 0x80, 0xFE, 0x90, 0x98, 0x07, 0xE0, ++0xFF, 0x60, 0x03, 0x12, 0xF4, 0x9B, 0x90, 0x01, ++0xC7, 0xE4, 0x12, 0xBA, 0x65, 0x12, 0xF5, 0xE3, ++0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF0, 0x7B, ++0x35, 0x7D, 0xFF, 0x7F, 0xFF, 0x12, 0x98, 0x60, ++0x90, 0x8A, 0xEF, 0x12, 0x8C, 0x14, 0x12, 0xCF, ++0x78, 0x12, 0xCF, 0x08, 0x71, 0x76, 0x90, 0x86, ++0x0C, 0x12, 0x8C, 0x14, 0x12, 0x98, 0x5B, 0x12, ++0xF2, 0xF2, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, ++0xFD, 0xE4, 0xFF, 0x02, 0x7C, 0x74, 0x7D, 0x08, ++0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0x90, 0x06, 0x90, ++0xE0, 0x54, 0xF0, 0xF0, 0x12, 0xEB, 0x0F, 0x12, ++0xF2, 0x5C, 0x51, 0x9C, 0x21, 0x30, 0xF1, 0xE7, ++0x12, 0xEB, 0xB3, 0x30, 0xE0, 0x17, 0x90, 0x93, ++0x04, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x20, 0xE0, ++0x0C, 0x90, 0x9C, 0x55, 0x12, 0x04, 0x3D, 0x00, ++0x00, 0x00, 0x14, 0x71, 0xA7, 0x22, 0x90, 0x01, ++0x53, 0xE4, 0xF0, 0xFF, 0xEF, 0x91, 0xBE, 0xE4, ++0xF0, 0x0F, 0xEF, 0xB4, 0x08, 0xF6, 0x22, 0xE4, ++0x90, 0x9C, 0x59, 0xF0, 0x7F, 0x03, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x54, ++0xEF, 0xF0, 0x71, 0x96, 0x90, 0x9C, 0x54, 0xE0, ++0xFF, 0x91, 0xBE, 0x74, 0x01, 0xF0, 0x90, 0x9C, ++0x59, 0xE0, 0xFE, 0xEF, 0xF1, 0xEF, 0xEE, 0xF0, ++0x90, 0x9C, 0x54, 0xE0, 0x91, 0x12, 0x12, 0x04, ++0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x9C, 0x55, ++0x91, 0xCF, 0xAB, 0x07, 0x90, 0x9C, 0x55, 0x12, ++0x04, 0xB8, 0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, ++0x92, 0x20, 0xEF, 0xF0, 0x90, 0x9C, 0x55, 0x12, ++0x04, 0xB8, 0x90, 0x92, 0x21, 0xEF, 0xF0, 0x7D, ++0x01, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x66, 0x33, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9A, 0x0B, ++0xE0, 0xFB, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x64, ++0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x22, ++0xE4, 0x90, 0x9A, 0x0B, 0xF0, 0x90, 0x9A, 0x0B, ++0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x40, 0x02, 0x81, ++0xB6, 0xEF, 0x91, 0xBE, 0xE0, 0x64, 0x01, 0x70, ++0x75, 0x90, 0x9A, 0x0B, 0xE0, 0x91, 0x12, 0x12, ++0x04, 0xB8, 0xE4, 0x7B, 0x01, 0x91, 0xB7, 0x70, ++0x3B, 0x90, 0x9A, 0x0B, 0xE0, 0xFB, 0xF1, 0xEF, ++0xE0, 0x60, 0x21, 0x14, 0x70, 0x58, 0xEB, 0x75, ++0xF0, 0x0A, 0xA4, 0x24, 0x68, 0xF5, 0x82, 0xE4, ++0x34, 0x9B, 0xF5, 0x83, 0x12, 0x04, 0xB8, 0xEB, ++0x91, 0x12, 0x12, 0x04, 0x31, 0x90, 0x9A, 0x0B, ++0xE0, 0xFF, 0x80, 0x0B, 0x91, 0x0D, 0x12, 0x04, ++0x3D, 0x00, 0x00, 0x00, 0x00, 0xAF, 0x03, 0x12, ++0xEB, 0xCB, 0x80, 0x2A, 0x90, 0x9A, 0x0B, 0xE0, ++0x91, 0x12, 0x12, 0x04, 0xB8, 0xE4, 0xFB, 0x91, ++0xB7, 0x50, 0x1B, 0x91, 0x0D, 0x12, 0x04, 0xB8, ++0xEF, 0x24, 0xFF, 0xFF, 0xEE, 0x34, 0xFF, 0xFE, ++0xED, 0x34, 0xFF, 0xFD, 0xEC, 0x34, 0xFF, 0xFC, ++0xEB, 0x91, 0x12, 0x12, 0x04, 0x31, 0x90, 0x9A, ++0x0B, 0xE0, 0x04, 0xF0, 0x81, 0x25, 0x22, 0xFA, ++0xF9, 0xF8, 0xC3, 0x02, 0x03, 0xDA, 0x75, 0xF0, ++0x0A, 0xA4, 0x24, 0x6D, 0xF5, 0x82, 0xE4, 0x34, ++0x9B, 0xF5, 0x83, 0x22, 0x90, 0x9C, 0x39, 0x12, ++0x04, 0xB8, 0x78, 0x10, 0x02, 0x03, 0xEB, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, ++0x32, 0xEC, 0x12, 0xFC, 0xF4, 0xAA, 0x07, 0x90, ++0x9C, 0x39, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, ++0x00, 0xD1, 0xCD, 0xEA, 0x24, 0xEF, 0x60, 0x36, ++0x24, 0xD7, 0x70, 0x02, 0xC1, 0x37, 0x24, 0x3A, ++0x60, 0x02, 0xC1, 0x6E, 0xD1, 0xAA, 0x24, 0x0A, ++0xD1, 0xD8, 0x12, 0x9E, 0x88, 0xE4, 0xD1, 0x98, ++0xE4, 0xF0, 0xFE, 0x74, 0x00, 0x2F, 0xD1, 0xC5, ++0x7D, 0x14, 0xD1, 0x8B, 0xF1, 0xE8, 0xD1, 0xB9, ++0x90, 0x90, 0xBE, 0x12, 0x04, 0x31, 0x7D, 0x14, ++0x7C, 0x00, 0xE4, 0xFF, 0xC1, 0x32, 0x90, 0x9C, ++0x32, 0xE4, 0x75, 0xF0, 0x14, 0x12, 0x02, 0xE7, ++0x90, 0x9C, 0x32, 0xA3, 0xE0, 0xFB, 0xFF, 0x24, ++0x06, 0xFC, 0xE4, 0x33, 0x90, 0x9C, 0x3D, 0xF0, ++0xA3, 0xCC, 0xF0, 0x90, 0x9C, 0x3D, 0xA3, 0xE0, ++0xFE, 0x12, 0x9E, 0x88, 0xE4, 0xD1, 0x98, 0xE4, ++0x12, 0xFB, 0xEF, 0xFE, 0xA9, 0x03, 0x74, 0x05, ++0x29, 0x12, 0xD7, 0x5B, 0x12, 0xBA, 0x6E, 0xFE, ++0x90, 0x9C, 0x37, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, ++0x9C, 0x32, 0xE0, 0xFC, 0xA3, 0xE0, 0x2F, 0xFF, ++0xEC, 0x3E, 0xFE, 0xD3, 0xEF, 0x94, 0x00, 0xEE, ++0x94, 0x01, 0x90, 0x9C, 0x32, 0x40, 0x69, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0xE9, 0x7C, 0x00, 0x24, ++0x00, 0xF9, 0xEC, 0x34, 0xFC, 0xFA, 0x7B, 0x01, ++0xC3, 0xE4, 0x9F, 0xFD, 0x74, 0x01, 0x9E, 0xFC, ++0xD1, 0x8D, 0x90, 0x9C, 0x34, 0xE0, 0x24, 0x01, ++0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, ++0x90, 0xFD, 0x10, 0xF0, 0xD1, 0xA4, 0xC0, 0x00, ++0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0x7B, 0x01, ++0x7A, 0xFC, 0x79, 0x00, 0x90, 0x9C, 0x32, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0xE4, 0x9F, 0xFF, ++0x74, 0x01, 0x9E, 0xFE, 0xD1, 0xB1, 0xC3, 0x9F, ++0xFD, 0xEC, 0x9E, 0xFC, 0x12, 0x45, 0xC2, 0xD0, ++0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, ++0x83, 0x00, 0xD1, 0x90, 0xD1, 0xCD, 0x80, 0x0D, ++0xA3, 0xE0, 0x7E, 0x00, 0x24, 0x00, 0xD1, 0xC5, ++0xD1, 0xB1, 0xFD, 0xD1, 0x8D, 0x90, 0x9C, 0x32, ++0x74, 0xFF, 0x75, 0xF0, 0xEC, 0x12, 0x02, 0xE7, ++0xD1, 0xAA, 0x7E, 0x00, 0x24, 0x0C, 0xF9, 0xEE, ++0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x02, 0xC0, ++0x01, 0x74, 0x10, 0x2F, 0xF9, 0xEE, 0x34, 0xFC, ++0xFA, 0xD1, 0xB9, 0x90, 0x90, 0xBE, 0x12, 0x04, ++0x31, 0xD1, 0xB1, 0xFD, 0xD0, 0x01, 0xD0, 0x02, ++0x7F, 0x11, 0x12, 0x3C, 0xD9, 0x80, 0x2F, 0xD1, ++0xAA, 0x24, 0x2A, 0xD1, 0xD8, 0x12, 0x9E, 0x88, ++0xE4, 0xD1, 0x98, 0xE4, 0xF0, 0x12, 0xF3, 0x29, ++0x7D, 0x48, 0xD1, 0x8B, 0x91, 0xCC, 0xD1, 0xA4, ++0x12, 0x83, 0x00, 0xE4, 0xFD, 0xFC, 0xD1, 0x90, ++0x91, 0xCC, 0xD1, 0xA4, 0x12, 0x83, 0x00, 0xD1, ++0x90, 0xD1, 0xBF, 0x12, 0x03, 0xCD, 0x90, 0x9C, ++0x35, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x9C, ++0x35, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, 0xFF, ++0x90, 0x9C, 0x3D, 0xA3, 0xE0, 0xFE, 0x12, 0x9E, ++0x88, 0xEF, 0xD1, 0x98, 0xED, 0xF0, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x7C, 0x00, 0x12, 0x45, 0xC2, ++0x90, 0x9C, 0x39, 0x02, 0x04, 0x31, 0x74, 0x03, ++0xF0, 0x74, 0x01, 0x2E, 0xF5, 0x82, 0xE4, 0x34, ++0xFC, 0xF5, 0x83, 0x22, 0x90, 0x9C, 0x39, 0x02, ++0x84, 0x52, 0x90, 0x9C, 0x32, 0xA3, 0xE0, 0xFF, ++0x22, 0x90, 0x9C, 0x37, 0xE0, 0xFC, 0xA3, 0xE0, ++0x22, 0x90, 0x90, 0xBB, 0x12, 0x84, 0x67, 0x90, ++0x9C, 0x39, 0x02, 0x04, 0xB8, 0xF9, 0xEE, 0x34, ++0xFC, 0xFA, 0x7B, 0x01, 0x22, 0x90, 0x9C, 0x34, ++0xE0, 0xC3, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0x22, ++0xFD, 0xE4, 0x33, 0x90, 0x9C, 0x3D, 0xF0, 0xA3, ++0xED, 0xF0, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x07, 0x12, 0xE7, ++0xD9, 0x12, 0x9E, 0x8A, 0xE0, 0x90, 0x9B, 0x00, ++0xF0, 0x74, 0x01, 0x2F, 0xD1, 0x9C, 0xE0, 0x90, ++0x9B, 0x21, 0x12, 0xE7, 0xE2, 0x90, 0x9B, 0x42, ++0xF0, 0xEF, 0x24, 0x20, 0x90, 0x99, 0x88, 0xF0, ++0xF1, 0x62, 0x90, 0x9B, 0x00, 0xE0, 0xF5, 0x48, ++0x7B, 0x01, 0x7A, 0x9B, 0x79, 0x01, 0x12, 0x69, ++0xF5, 0x90, 0x9B, 0x00, 0xF1, 0xDE, 0xF1, 0x61, ++0x90, 0x9B, 0x21, 0xE0, 0xF5, 0x48, 0x7B, 0x01, ++0x7A, 0x9B, 0x79, 0x22, 0x12, 0x69, 0xF5, 0x90, ++0x9B, 0x21, 0xF1, 0xDE, 0xF1, 0x61, 0x90, 0x9B, ++0x42, 0xE0, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x9B, ++0x79, 0x43, 0x12, 0x69, 0xF5, 0xE4, 0xFF, 0x90, ++0x9B, 0x00, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, ++0x03, 0x0F, 0x80, 0xF3, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xE0, 0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, ++0x75, 0x45, 0x01, 0xF5, 0x46, 0x89, 0x47, 0x22, ++0x12, 0xBB, 0x33, 0xE4, 0x12, 0xEC, 0x85, 0x12, ++0xCE, 0xC1, 0x90, 0x99, 0x8A, 0xEF, 0xF0, 0x90, ++0x99, 0x88, 0xA3, 0xE0, 0x24, 0x38, 0xF9, 0xE4, ++0x34, 0xFC, 0xF1, 0x68, 0x75, 0x48, 0x06, 0x7B, ++0x01, 0x7A, 0x93, 0x79, 0x49, 0xF1, 0xD7, 0x12, ++0x9A, 0x1B, 0x24, 0x3E, 0xF9, 0xE4, 0x34, 0xFC, ++0xF1, 0x68, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, ++0x93, 0x79, 0x4F, 0xF1, 0xD7, 0x12, 0x9A, 0x1B, ++0x12, 0x9F, 0xF2, 0xF1, 0x68, 0x75, 0x48, 0x06, ++0x7B, 0x01, 0x7A, 0x93, 0x79, 0x53, 0xF1, 0xD7, ++0x12, 0x9A, 0x1B, 0x24, 0x48, 0xF9, 0xE4, 0x34, ++0xFC, 0xF1, 0x68, 0x75, 0x48, 0x04, 0x7B, 0x01, ++0x7A, 0x93, 0x79, 0x59, 0x02, 0x69, 0xF5, 0x12, ++0x69, 0xF5, 0x90, 0x99, 0x88, 0x22, 0xE0, 0xFF, ++0x90, 0x99, 0x88, 0xE0, 0x2F, 0xF0, 0x22, 0x22, ++0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, 0x22, 0x75, ++0xF0, 0x0A, 0xA4, 0x24, 0x6C, 0xF5, 0x82, 0xE4, ++0x34, 0x9B, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x8F, 0xFA, 0xF1, ++0xEB, 0x90, 0x88, 0x9D, 0x12, 0xCF, 0xDD, 0xF0, ++0xFC, 0x12, 0x02, 0x06, 0xFD, 0x54, 0x04, 0x13, ++0x13, 0x54, 0x3F, 0xFF, 0x90, 0x99, 0x7C, 0xE0, ++0x54, 0xFE, 0x4F, 0xF0, 0xED, 0x54, 0x08, 0xFF, ++0xEC, 0x54, 0xF7, 0x4F, 0xFF, 0x90, 0x88, 0x9D, ++0xF0, 0x12, 0x02, 0x06, 0x12, 0xF6, 0x06, 0x90, ++0x88, 0x9D, 0x12, 0x8F, 0x05, 0xF1, 0xCE, 0x4D, ++0xFF, 0x90, 0x88, 0x9D, 0x12, 0xF6, 0x10, 0xF0, ++0x12, 0x8C, 0x04, 0xE9, 0x24, 0x01, 0xF9, 0xE4, ++0x3A, 0x8B, 0x45, 0xF5, 0x46, 0x89, 0x47, 0x75, ++0x48, 0x04, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9E, ++0x12, 0x69, 0xF5, 0x12, 0x8C, 0x04, 0x12, 0x02, ++0x06, 0x20, 0xE0, 0x02, 0x21, 0xCF, 0x90, 0x05, ++0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, ++0x13, 0x90, 0x88, 0xAD, 0xF0, 0x90, 0x88, 0xA0, ++0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x15, 0x12, ++0x8E, 0xFF, 0x90, 0x88, 0x9E, 0xF0, 0x24, 0x0A, ++0x90, 0x88, 0xCF, 0x12, 0x8F, 0xED, 0x90, 0x88, ++0x9F, 0xF0, 0x80, 0x4B, 0x12, 0x8E, 0xFF, 0xFF, ++0xC3, 0x94, 0x2A, 0x50, 0x15, 0xEF, 0xC3, 0x94, ++0x03, 0x50, 0x07, 0x90, 0x88, 0x9E, 0x74, 0x03, ++0x80, 0x0D, 0x12, 0x8E, 0xFF, 0x90, 0x88, 0x9E, ++0x80, 0x05, 0x90, 0x88, 0x9E, 0x74, 0x2A, 0xF0, ++0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0x12, 0x8F, ++0xEE, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, ++0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, ++0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, ++0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, ++0xC4, 0x6A, 0x30, 0xE0, 0x3D, 0x90, 0x88, 0x9E, ++0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA6, ++0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0x88, ++0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, ++0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, 0x13, ++0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, 0xE0, ++0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, 0x01, ++0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, 0x12, ++0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0xF0, 0x90, ++0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, ++0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x54, ++0x07, 0x30, 0xE0, 0x0D, 0x90, 0x8A, 0x89, 0x12, ++0x91, 0x62, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, ++0x7E, 0x51, 0x5D, 0x74, 0x11, 0xF0, 0x90, 0x99, ++0x7C, 0xE0, 0x30, 0xE0, 0x31, 0x90, 0x99, 0x85, ++0x74, 0x01, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x06, ++0xC7, 0xE0, 0xFE, 0x90, 0x06, 0xC6, 0x51, 0x6E, ++0xFE, 0xE4, 0xFD, 0x78, 0x10, 0x12, 0xC3, 0x0D, ++0x90, 0x06, 0xC5, 0xE0, 0xFE, 0x90, 0x06, 0xC4, ++0x51, 0x6E, 0xFE, 0xE4, 0xFD, 0x12, 0x84, 0x45, ++0x90, 0x99, 0x81, 0x12, 0x04, 0x31, 0x90, 0x88, ++0xA5, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0x88, 0xB0, ++0x74, 0x01, 0xF0, 0x80, 0x2B, 0x90, 0x88, 0xA5, ++0xE0, 0xB4, 0x04, 0x08, 0x90, 0x88, 0xB0, 0x74, ++0x04, 0xF0, 0x80, 0x1C, 0x90, 0x88, 0xA5, 0xE0, ++0xB4, 0x06, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x02, ++0xF0, 0x80, 0x0D, 0x90, 0x88, 0xA5, 0xE0, 0xB4, ++0x07, 0x06, 0x90, 0x88, 0xB0, 0x74, 0x05, 0xF0, ++0xE4, 0x90, 0x88, 0xA5, 0xF0, 0x80, 0x41, 0x90, ++0x8A, 0xF1, 0x12, 0x8C, 0x14, 0x90, 0x89, 0x04, ++0xE0, 0x90, 0x00, 0x40, 0x30, 0xE0, 0x07, 0xE0, ++0x54, 0x0F, 0x44, 0xA0, 0x80, 0x05, 0xE0, 0x54, ++0x0F, 0x44, 0x20, 0xFD, 0x7F, 0x40, 0x12, 0x7B, ++0x2E, 0x12, 0x8C, 0x04, 0x12, 0x8F, 0xF4, 0x13, ++0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, ++0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, ++0x12, 0x98, 0x5B, 0x51, 0x5D, 0x74, 0x43, 0xF0, ++0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, ++0x90, 0x88, 0xAF, 0xF0, 0x90, 0x88, 0xA0, 0xF1, ++0xE3, 0x30, 0xE0, 0x09, 0x90, 0x88, 0xD0, 0xE0, ++0x44, 0x02, 0xF0, 0x80, 0x12, 0x90, 0x8A, 0x97, ++0x12, 0x91, 0x62, 0x7F, 0x01, 0x12, 0x04, 0x7E, ++0x90, 0x88, 0xD0, 0xE0, 0x54, 0xFD, 0xF0, 0x90, ++0x8A, 0xD9, 0x12, 0x91, 0x62, 0x7F, 0x03, 0x12, ++0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, ++0x07, 0x90, 0x88, 0xA1, 0xE0, 0x54, 0xBF, 0xF0, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, 0x00, ++0x74, 0x1C, 0xF0, 0xA3, 0x22, 0xF0, 0x90, 0x01, ++0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, ++0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0x90, ++0x98, 0x12, 0x71, 0x31, 0xEF, 0xF0, 0xE0, 0xFE, ++0x24, 0x28, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0xFF, 0x74, 0x29, 0x2E, 0x12, 0xE6, ++0x3E, 0xE0, 0xFD, 0x90, 0x99, 0x88, 0xE0, 0x24, ++0x2C, 0x12, 0xCE, 0xDE, 0x90, 0x99, 0x88, 0xE0, ++0x2F, 0x24, 0x30, 0xA3, 0xF0, 0xE0, 0xFD, 0x24, ++0x04, 0x12, 0xFB, 0xF3, 0xFE, 0x74, 0x05, 0x2D, ++0x12, 0xD7, 0x5B, 0x51, 0x6E, 0x90, 0x95, 0x6D, ++0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0x89, 0xE0, ++0x24, 0x0C, 0xF9, 0xE4, 0x34, 0xFC, 0x12, 0xB7, ++0x68, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x95, ++0x79, 0x6F, 0x12, 0x69, 0xF5, 0x90, 0x99, 0x89, ++0xE0, 0x24, 0x14, 0xF0, 0xE0, 0xFD, 0x24, 0x01, ++0x12, 0xB6, 0x9C, 0xE0, 0xFE, 0x74, 0x00, 0x2D, ++0x12, 0x9E, 0x8A, 0x51, 0x6E, 0x90, 0x95, 0x73, ++0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x98, 0x13, 0x71, ++0x31, 0xEF, 0xF0, 0x90, 0x95, 0x69, 0xE0, 0xFE, ++0xA3, 0xE0, 0xFF, 0x4E, 0x60, 0x11, 0x90, 0x99, ++0x88, 0x12, 0xB7, 0x61, 0x8F, 0x48, 0x7B, 0x01, ++0x7A, 0x95, 0x79, 0x77, 0x12, 0x69, 0xF5, 0x90, ++0x98, 0x14, 0x71, 0x31, 0xEF, 0xF0, 0x12, 0xB7, ++0x62, 0x90, 0x95, 0x6B, 0xA3, 0xE0, 0xF5, 0x48, ++0x7B, 0x01, 0x7A, 0x95, 0x79, 0x97, 0x02, 0x69, ++0xF5, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, 0x99, ++0x88, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x12, 0xD7, 0x63, 0x90, 0x99, 0x8D, 0xF0, ++0x90, 0x02, 0x09, 0xE0, 0x90, 0x99, 0x8E, 0xF0, ++0x90, 0x98, 0x15, 0x12, 0xF3, 0x21, 0x90, 0x99, ++0x88, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x9E, ++0x88, 0xE0, 0x90, 0x95, 0xB9, 0xF0, 0x74, 0x01, ++0x2F, 0x12, 0xB6, 0x9C, 0xE0, 0x90, 0x95, 0xBA, ++0xF0, 0xF1, 0xC6, 0x12, 0x02, 0xE7, 0x90, 0x99, ++0x88, 0xA3, 0xE0, 0x24, 0x02, 0x12, 0xE7, 0xE6, ++0xFF, 0xE4, 0xFC, 0xFD, 0x78, 0x10, 0x12, 0x03, ++0xFE, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, ++0x07, 0xF1, 0xB9, 0xB1, 0xAA, 0x78, 0x18, 0x12, ++0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, ++0xD0, 0x00, 0x12, 0x83, 0x00, 0xC0, 0x04, 0xC0, ++0x05, 0xC0, 0x06, 0xC0, 0x07, 0xF1, 0xAC, 0xB1, ++0xAA, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xD0, 0x03, ++0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x9E, ++0x78, 0xB1, 0xAC, 0x12, 0x83, 0x00, 0x90, 0x95, ++0xBD, 0xB1, 0x91, 0x78, 0x10, 0x12, 0x03, 0xFE, ++0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, ++0xF1, 0xB9, 0xB1, 0xAA, 0x78, 0x18, 0x12, 0x03, ++0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0x12, 0x83, 0x00, 0xC0, 0x04, 0xC0, 0x05, ++0xC0, 0x06, 0xC0, 0x07, 0xF1, 0xAC, 0xB1, 0xAA, ++0x78, 0x08, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, ++0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x9E, 0x78, ++0xB1, 0xAC, 0x12, 0x83, 0x00, 0x90, 0x95, 0xC1, ++0xB1, 0x91, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xC0, ++0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xF1, ++0xB9, 0xB1, 0xAA, 0x78, 0x18, 0x12, 0x03, 0xFE, ++0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, ++0x12, 0x83, 0x00, 0xC0, 0x04, 0xC0, 0x05, 0xC0, ++0x06, 0xC0, 0x07, 0xF1, 0xAC, 0xB1, 0xAA, 0x78, ++0x08, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, ++0xD0, 0x01, 0xD0, 0x00, 0x12, 0x9E, 0x78, 0xB1, ++0xAC, 0x12, 0x83, 0x00, 0x90, 0x95, 0xC5, 0x12, ++0x04, 0x31, 0xF1, 0xC6, 0xF1, 0x85, 0xF1, 0x97, ++0x12, 0x9E, 0x88, 0xE0, 0xFF, 0x12, 0xFC, 0xAA, ++0xB1, 0xB3, 0xE0, 0xB4, 0x10, 0xF0, 0xF1, 0x7E, ++0xF1, 0x97, 0x12, 0x9E, 0x88, 0xE0, 0xFF, 0x74, ++0xD9, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xB1, ++0xB3, 0xE0, 0xB4, 0x10, 0xEB, 0xF1, 0x7E, 0xF1, ++0x97, 0x12, 0x9E, 0x88, 0xE0, 0xFF, 0x74, 0xE9, ++0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xB1, 0xB3, ++0xE0, 0xB4, 0x10, 0xEB, 0x90, 0x99, 0x88, 0xF1, ++0xD5, 0x90, 0x98, 0x15, 0x71, 0x31, 0xE4, 0x12, ++0xEC, 0x85, 0xE4, 0x75, 0xF0, 0x40, 0xF1, 0x85, ++0x90, 0x99, 0x8A, 0xE0, 0xFF, 0xC3, 0x94, 0x08, ++0x50, 0x20, 0x90, 0x99, 0x88, 0xA3, 0xE0, 0xFE, ++0xEF, 0x2E, 0x12, 0x9E, 0x88, 0xE0, 0xFE, 0x90, ++0x99, 0x8E, 0xE0, 0xFD, 0xEE, 0x2D, 0xFE, 0x74, ++0xF9, 0x2F, 0x12, 0xEB, 0xBB, 0xEE, 0xB1, 0xB6, ++0x80, 0xD6, 0x90, 0x98, 0x15, 0xE0, 0x04, 0x90, ++0x99, 0x8C, 0xF0, 0xE4, 0x90, 0x99, 0x8B, 0xF0, ++0x90, 0x95, 0xB9, 0xE0, 0x13, 0x13, 0x54, 0x3F, ++0x24, 0x01, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x99, ++0x8B, 0xE0, 0xC3, 0x9F, 0xEE, 0x12, 0xEE, 0xAF, ++0x50, 0x78, 0xA3, 0x71, 0x31, 0xE4, 0xF0, 0xA3, ++0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x99, 0x8A, ++0xE0, 0xFD, 0xC3, 0x94, 0x04, 0x50, 0x55, 0xA3, ++0xE0, 0x75, 0xF0, 0x04, 0xA4, 0x7C, 0x00, 0x2D, ++0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x90, 0x95, 0xB9, ++0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0x74, 0x80, 0xF8, ++0x6E, 0x98, 0x50, 0x38, 0xEF, 0x78, 0x05, 0xC3, ++0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x01, ++0xF9, 0x74, 0x96, 0x3E, 0xFA, 0x7B, 0x01, 0xC0, ++0x03, 0xC0, 0x01, 0x90, 0x99, 0x88, 0xA3, 0xE0, ++0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, 0x8B, 0x45, ++0xF5, 0x46, 0x89, 0x47, 0x75, 0x48, 0x20, 0xD0, ++0x01, 0xD0, 0x03, 0x12, 0xB7, 0xD7, 0xF1, 0xDC, ++0xB1, 0xB7, 0x80, 0xA1, 0x90, 0x99, 0x8C, 0xE0, ++0x04, 0xF0, 0x90, 0x99, 0x8B, 0xE0, 0x04, 0xF0, ++0x81, 0xE8, 0xE4, 0x90, 0x99, 0x8A, 0xF0, 0xE4, ++0xFF, 0x0F, 0xEF, 0xB4, 0x20, 0xFB, 0xB1, 0xB7, ++0xE0, 0xB4, 0x10, 0xF3, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x12, 0x04, 0x31, 0x90, 0x99, 0x88, 0xE4, ++0x75, 0xF0, 0x04, 0x12, 0x02, 0xE7, 0x90, 0x99, ++0x88, 0xA3, 0xE0, 0x24, 0x02, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0xE4, 0xFC, ++0xFD, 0xFE, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, ++0x99, 0x8A, 0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x9F, ++0xED, 0xF0, 0xE4, 0xA3, 0xF0, 0xEF, 0x14, 0x60, ++0x02, 0xC1, 0xA2, 0x90, 0x06, 0x03, 0xE0, 0x54, ++0xFB, 0xF0, 0x90, 0x9C, 0x9F, 0xE0, 0xFB, 0xC4, ++0x33, 0x54, 0xE0, 0xFE, 0x90, 0x04, 0x42, 0xE0, ++0x54, 0x9F, 0x4E, 0xFE, 0xF0, 0xE4, 0xFD, 0x12, ++0xED, 0x4B, 0x90, 0x9C, 0xA0, 0xEF, 0xF0, 0x90, ++0x04, 0x83, 0xF0, 0x90, 0x9C, 0x01, 0x12, 0x04, ++0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x9C, 0x05, ++0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0xF1, ++0x08, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, ++0x90, 0x9C, 0x05, 0x12, 0x04, 0x3D, 0x00, 0x00, ++0x00, 0x01, 0x7F, 0x00, 0x7E, 0x09, 0xF1, 0x0C, ++0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x10, 0x90, ++0x9C, 0x9F, 0xB1, 0xAC, 0xEF, 0x54, 0x03, 0xFF, ++0xE4, 0x78, 0x01, 0x12, 0x03, 0xEB, 0x78, 0x04, ++0xF1, 0x8E, 0x7F, 0x00, 0x7E, 0x0A, 0xF1, 0x0C, ++0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, ++0x9C, 0x9F, 0xB1, 0xAC, 0xEF, 0x54, 0x03, 0xFF, ++0xE4, 0x78, 0x0A, 0xF1, 0x8E, 0x7F, 0x00, 0x7E, ++0x0D, 0xF1, 0x0C, 0x12, 0x04, 0x3D, 0x0C, 0x00, ++0x00, 0x00, 0x90, 0x9C, 0xA0, 0xB1, 0xAC, 0xEF, ++0x54, 0x03, 0xFF, 0xE4, 0x78, 0x1A, 0xF1, 0x8E, ++0x7F, 0x18, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, ++0x00, 0x0C, 0x00, 0x90, 0x9C, 0x05, 0x12, 0x04, ++0x3D, 0x00, 0x00, 0x00, 0x00, 0xF1, 0xA2, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x9B, ++0xF3, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x04, 0x00, ++0x80, 0x58, 0x90, 0x06, 0x03, 0xE0, 0x44, 0x04, ++0xF0, 0x90, 0x9C, 0x01, 0x12, 0x04, 0x3D, 0x00, ++0x00, 0x00, 0x01, 0x90, 0x9C, 0x05, 0x12, 0x04, ++0x3D, 0x00, 0x00, 0x00, 0x00, 0xF1, 0x08, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x9C, ++0x05, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, ++0x7F, 0x00, 0x7E, 0x09, 0xF1, 0x0C, 0x12, 0x04, ++0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x9C, 0x05, ++0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0xF1, ++0xA2, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, ++0x90, 0x9B, 0xF3, 0x12, 0x04, 0x3D, 0x00, 0x00, ++0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, ++0x12, 0xE8, 0x55, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x7F, 0x00, 0x7E, 0x08, 0xF1, 0x16, 0x90, 0x9C, ++0x01, 0x22, 0x7F, 0x58, 0x7E, 0x0C, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9B, 0xFF, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, ++0x90, 0x9C, 0x09, 0x12, 0x04, 0x31, 0x90, 0x9C, ++0x01, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, ++0x9C, 0x09, 0x12, 0x84, 0x52, 0x12, 0x84, 0x38, ++0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, ++0x90, 0x9C, 0x01, 0x12, 0x04, 0xB8, 0x90, 0x9C, ++0x05, 0x12, 0x84, 0x52, 0x12, 0x84, 0x38, 0xD0, ++0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, ++0x84, 0x45, 0x90, 0x9C, 0x0D, 0x12, 0x04, 0x31, ++0x90, 0x9C, 0x0D, 0x12, 0xAE, 0xD6, 0x90, 0x9B, ++0xFF, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, ++0xAD, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x99, ++0x88, 0xE4, 0x75, 0xF0, 0x10, 0x12, 0x02, 0xE7, ++0xE4, 0x90, 0x99, 0x8A, 0xF0, 0x22, 0x12, 0x03, ++0xFE, 0x90, 0x9C, 0x05, 0x02, 0x04, 0x31, 0x90, ++0x99, 0x88, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFE, ++0x2F, 0x22, 0x7F, 0x84, 0x7E, 0x08, 0xF1, 0x16, ++0x90, 0x9B, 0xEF, 0x22, 0x90, 0x99, 0x88, 0xA3, ++0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0x22, 0x90, 0x99, 0x88, 0xA3, 0xE0, 0x24, 0x03, ++0xF5, 0x82, 0xE4, 0x34, 0xFC, 0x22, 0x90, 0x99, ++0x88, 0xE4, 0x75, 0xF0, 0x04, 0x22, 0x54, 0x40, ++0xFD, 0xEF, 0x54, 0xBF, 0x22, 0xE4, 0x75, 0xF0, ++0x10, 0x02, 0x02, 0xE7, 0xE4, 0x75, 0xF0, 0x20, ++0x02, 0x02, 0xE7, 0xE0, 0xC4, 0x13, 0x13, 0x13, ++0x54, 0x01, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x54, ++0x01, 0xFE, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x12, ++0x8E, 0xFF, 0x90, 0x99, 0x8A, 0x12, 0x8F, 0xED, ++0x90, 0x99, 0x8B, 0xF0, 0x12, 0x8F, 0xF4, 0x90, ++0x99, 0x8C, 0x12, 0x97, 0x30, 0x90, 0x99, 0x8D, ++0x12, 0x96, 0x2D, 0x90, 0x99, 0x8E, 0x31, 0xC5, ++0x90, 0x99, 0x8F, 0xF0, 0xEF, 0x12, 0x84, 0x70, ++0xC0, 0x3C, 0x00, 0xC0, 0x48, 0x01, 0xC0, 0x4F, ++0x02, 0xC0, 0x56, 0x03, 0xC0, 0x5D, 0x04, 0xC0, ++0x64, 0x05, 0xC0, 0x6D, 0x06, 0xC0, 0x96, 0x07, ++0x00, 0x00, 0xC0, 0xF4, 0x90, 0x99, 0x88, 0x74, ++0x02, 0xF0, 0xA3, 0x74, 0x29, 0xF0, 0x01, 0xF9, ++0x31, 0x22, 0x74, 0x2A, 0xF0, 0x01, 0xF9, 0x31, ++0x13, 0x74, 0x31, 0xF0, 0x01, 0xF9, 0x31, 0x13, ++0x74, 0x32, 0xF0, 0x01, 0xF9, 0x31, 0x22, 0x74, ++0x33, 0xF0, 0x01, 0xF9, 0x31, 0x1B, 0x90, 0x8A, ++0x83, 0x31, 0xBB, 0x21, 0x10, 0x90, 0x99, 0x8A, ++0xE0, 0x90, 0x88, 0xE1, 0xF0, 0x90, 0x99, 0x8B, ++0xE0, 0x90, 0x88, 0xE2, 0xF0, 0x90, 0x99, 0x8C, ++0xE0, 0x90, 0x88, 0xE3, 0xF0, 0x90, 0x99, 0x8D, ++0xE0, 0x90, 0x88, 0xE4, 0xF0, 0x90, 0x99, 0x8E, ++0xE0, 0x90, 0x88, 0xE5, 0xF0, 0x22, 0x90, 0x99, ++0x8A, 0xE0, 0x90, 0x99, 0x87, 0xF0, 0x90, 0x99, ++0x8D, 0x12, 0xBD, 0xAC, 0x78, 0x10, 0x12, 0x03, ++0xFE, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, ++0x07, 0xA3, 0x12, 0xBD, 0xAC, 0x78, 0x18, 0x12, ++0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, ++0xD0, 0x00, 0x12, 0x84, 0x45, 0xC0, 0x04, 0xC0, ++0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x99, 0x8C, ++0x12, 0xBD, 0xAC, 0x78, 0x08, 0x12, 0x03, 0xFE, ++0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, ++0x12, 0x84, 0x45, 0x71, 0x10, 0x90, 0x99, 0x8B, ++0x12, 0xBD, 0xAC, 0x12, 0x84, 0x45, 0x90, 0x99, ++0x7D, 0x02, 0x04, 0x31, 0x31, 0x13, 0x74, 0xFF, ++0xF0, 0x90, 0x99, 0x89, 0xE0, 0xFF, 0x90, 0x99, ++0x88, 0xE0, 0xFD, 0x31, 0x1B, 0x90, 0x8A, 0xCF, ++0xE0, 0xF8, 0xA3, 0xE0, 0xF5, 0x82, 0x88, 0x83, ++0x02, 0x04, 0x7E, 0x90, 0x99, 0x88, 0x74, 0x01, ++0xF0, 0xA3, 0x22, 0x7B, 0x01, 0x7A, 0x99, 0x79, ++0x8A, 0x22, 0x90, 0x99, 0x88, 0x74, 0x06, 0xF0, ++0xA3, 0x22, 0x12, 0x02, 0x06, 0x64, 0x01, 0x60, ++0x02, 0x21, 0xB7, 0x90, 0x99, 0xCF, 0xF0, 0x90, ++0x99, 0xCF, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x50, ++0x27, 0xEF, 0x31, 0xCC, 0x7A, 0x99, 0x79, 0xCE, ++0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x12, 0x90, 0x99, ++0xCE, 0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0xD0, 0xF5, ++0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xEF, 0xF0, ++0x90, 0x99, 0xCF, 0xE0, 0x04, 0xF0, 0x80, 0xCF, ++0x75, 0x45, 0x01, 0x75, 0x46, 0x99, 0x75, 0x47, ++0xD0, 0x75, 0x48, 0x08, 0x31, 0x1B, 0x12, 0xB7, ++0xD7, 0x74, 0x24, 0xF0, 0x90, 0x99, 0xAA, 0x74, ++0x08, 0xF0, 0x75, 0x45, 0x01, 0x75, 0x46, 0x99, ++0x75, 0x47, 0xD8, 0xF5, 0x48, 0x7B, 0x01, 0x7A, ++0x99, 0x79, 0xAD, 0x12, 0x69, 0xF5, 0x90, 0x99, ++0xAB, 0x74, 0x25, 0xF0, 0x90, 0x99, 0xCD, 0x74, ++0x08, 0x12, 0x90, 0xBE, 0x31, 0xB8, 0x12, 0x04, ++0x7E, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0xAB, 0x12, ++0x91, 0x50, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, ++0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0xF5, 0x82, 0x8E, 0x83, 0x22, 0xF0, 0x90, 0x00, ++0x06, 0x02, 0x02, 0x1F, 0x24, 0xA8, 0xFF, 0xE4, ++0x34, 0x01, 0xFE, 0x7B, 0x01, 0x22, 0x12, 0x8F, ++0xFA, 0x12, 0x02, 0x06, 0x64, 0x01, 0x60, 0x02, ++0x41, 0x67, 0xEF, 0x24, 0x39, 0x60, 0x12, 0x14, ++0x60, 0x19, 0x24, 0x02, 0x70, 0x1F, 0xE4, 0x90, ++0x99, 0x8E, 0xF0, 0xA3, 0x74, 0x06, 0xF0, 0x80, ++0x14, 0x90, 0x99, 0x8E, 0x74, 0x06, 0xF0, 0xA3, ++0xF0, 0x80, 0x0A, 0x90, 0x99, 0x8E, 0x74, 0x0C, ++0xF0, 0xA3, 0x74, 0x04, 0xF0, 0x51, 0x7B, 0x51, ++0x68, 0x40, 0x1B, 0x90, 0x99, 0x8C, 0xE0, 0x31, ++0xCC, 0x7A, 0x99, 0x79, 0x8B, 0x12, 0x5F, 0xA6, ++0xBF, 0x01, 0x07, 0x90, 0x99, 0x8B, 0xE0, 0xF4, ++0x70, 0x3D, 0x51, 0x70, 0x80, 0xE1, 0x51, 0x7B, ++0x51, 0x68, 0x40, 0x33, 0x90, 0x99, 0x8C, 0xE0, ++0xFD, 0x7C, 0x00, 0x24, 0xA8, 0xFF, 0xEC, 0x34, ++0x01, 0xFE, 0xED, 0x24, 0x01, 0xFD, 0xEC, 0x33, ++0xFC, 0x90, 0x99, 0x8E, 0xE0, 0xFB, 0xC3, 0xED, ++0x9B, 0xFD, 0xEC, 0x94, 0x00, 0xFC, 0x12, 0x8C, ++0x04, 0x8D, 0x82, 0x8C, 0x83, 0x12, 0x02, 0x1F, ++0xFD, 0x51, 0x8C, 0x51, 0x70, 0x80, 0xC9, 0x22, ++0x90, 0x99, 0x8D, 0xE0, 0xD3, 0x94, 0x00, 0x22, ++0x90, 0x99, 0x8C, 0xE0, 0x04, 0xF0, 0xA3, 0xE0, ++0x14, 0xF0, 0x22, 0x90, 0x99, 0x8E, 0xE0, 0x90, ++0x99, 0x8C, 0xF0, 0x90, 0x99, 0x8F, 0xE0, 0x90, ++0x99, 0x8D, 0xF0, 0x22, 0x8E, 0x0D, 0x8F, 0x0E, ++0x8D, 0x0F, 0xE4, 0x90, 0x99, 0x90, 0xF0, 0x90, ++0x00, 0x37, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x37, ++0x12, 0x7B, 0x2E, 0x7D, 0x69, 0x7F, 0xCF, 0x12, ++0x7B, 0x2E, 0xE5, 0x0E, 0xFD, 0x7F, 0x31, 0x12, ++0x7B, 0x2E, 0xE5, 0x0D, 0x54, 0x03, 0xFF, 0x90, ++0x00, 0x32, 0xE0, 0x54, 0xFC, 0x4F, 0xFD, 0x7F, ++0x32, 0x12, 0x7B, 0x2E, 0xAD, 0x0F, 0x7F, 0x30, ++0x12, 0x7B, 0x2E, 0x90, 0x00, 0x33, 0xE0, 0x44, ++0x80, 0xFD, 0x7F, 0x33, 0x12, 0x7B, 0x2E, 0x90, ++0x00, 0x33, 0xE0, 0x30, 0xE7, 0x09, 0x71, 0x03, ++0x50, 0x05, 0xE0, 0x04, 0xF0, 0x80, 0xF0, 0xE4, ++0xFD, 0x7F, 0xCF, 0x12, 0x7B, 0x2E, 0x90, 0x00, ++0x37, 0xE0, 0x54, 0x7F, 0xFD, 0x7F, 0x37, 0x12, ++0x7B, 0x2E, 0x71, 0x03, 0x7F, 0x00, 0x50, 0x02, ++0x7F, 0x01, 0x22, 0x90, 0x99, 0x90, 0xE0, 0xC3, ++0x94, 0x64, 0x22, 0x78, 0x08, 0x12, 0x03, 0xFE, ++0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, ++0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, ++0x90, 0x8A, 0x8F, 0x80, 0x03, 0x90, 0x8A, 0x87, ++0x12, 0x8C, 0x14, 0x90, 0x88, 0xE6, 0xE0, 0x30, ++0xE0, 0x04, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0x88, ++0xE7, 0xE0, 0x64, 0x08, 0x70, 0x22, 0x90, 0x88, ++0xE6, 0xE0, 0x30, 0xE0, 0x16, 0x12, 0xAF, 0xE3, ++0xE0, 0x90, 0x92, 0x90, 0x12, 0xAE, 0xC9, 0x90, ++0x88, 0xE6, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, ++0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, ++0x90, 0x88, 0xA1, 0xF1, 0xE0, 0x30, 0xE0, 0x13, ++0x90, 0x88, 0xE8, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, ++0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, 0xF0, 0x90, ++0x88, 0xE8, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x70, ++0x02, 0x81, 0x01, 0x90, 0x88, 0x4D, 0xE0, 0x04, ++0xF0, 0x90, 0x05, 0x61, 0x12, 0xBD, 0xAC, 0x71, ++0x0B, 0x90, 0x05, 0x60, 0x12, 0xBD, 0xAC, 0x12, ++0x84, 0x45, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, ++0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0xBD, 0xAC, ++0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, ++0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x84, 0x45, ++0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, ++0xA3, 0x12, 0xBD, 0xAC, 0x78, 0x18, 0x12, 0x03, ++0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0x12, 0x84, 0x45, 0x90, 0x88, 0x81, 0x12, ++0x04, 0x31, 0x90, 0x88, 0x32, 0xE0, 0x54, 0x7F, ++0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0B, 0x12, 0xE1, ++0x3B, 0x74, 0x05, 0xF0, 0x12, 0x6E, 0x2F, 0xF1, ++0xE8, 0x12, 0xDB, 0xD8, 0x30, 0xE0, 0x0A, 0x90, ++0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0xFB, ++0x62, 0x12, 0xC8, 0x9D, 0x12, 0xF1, 0xE8, 0xE4, ++0x90, 0x98, 0x1B, 0xF0, 0x12, 0xFB, 0x51, 0x90, ++0x93, 0x24, 0x91, 0x6D, 0x30, 0xE0, 0x52, 0x90, ++0x95, 0x63, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7C, ++0x00, 0x7D, 0x64, 0x12, 0x02, 0x92, 0x90, 0x95, ++0xB7, 0xE0, 0x6E, 0x70, 0x03, 0xA3, 0xE0, 0x6F, ++0x60, 0x0A, 0x90, 0x95, 0xB7, 0xE4, 0x75, 0xF0, ++0x01, 0x02, 0x02, 0xE7, 0x90, 0x95, 0x67, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x75, 0xE0, ++0xB5, 0x06, 0x14, 0xA3, 0xE0, 0xB5, 0x07, 0x0F, ++0xEF, 0x4E, 0x60, 0x0B, 0x90, 0x01, 0xC7, 0x74, ++0x31, 0xF0, 0x7F, 0x01, 0x02, 0xC9, 0x1D, 0x12, ++0xD5, 0xFC, 0xE4, 0x90, 0x95, 0xB7, 0xF0, 0xA3, ++0xF0, 0x22, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, ++0x13, 0x54, 0x03, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x6B, 0xEF, 0xF0, ++0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, 0x04, ++0xF0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x07, ++0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, ++0x04, 0x1D, 0xE0, 0x60, 0x31, 0x90, 0x05, 0x22, ++0xE0, 0x90, 0x9C, 0x6F, 0xF0, 0x7B, 0x26, 0x12, ++0x8C, 0x0A, 0xEF, 0x64, 0x01, 0x70, 0x02, 0x80, ++0x05, 0x91, 0x6A, 0x30, 0xE0, 0x08, 0xF1, 0x00, ++0xB1, 0x1C, 0xF1, 0x28, 0xEE, 0xF0, 0x90, 0x9C, ++0x6F, 0xE0, 0xFD, 0x7B, 0x27, 0xE4, 0xFF, 0x12, ++0x98, 0x60, 0xD1, 0x99, 0x80, 0x0A, 0xD1, 0x99, ++0xF1, 0x00, 0xB1, 0x1C, 0xF1, 0x28, 0xEE, 0xF0, ++0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x17, 0x91, ++0x6A, 0x30, 0xE0, 0x12, 0x90, 0x05, 0x22, 0xE0, ++0x54, 0x6F, 0xFF, 0x90, 0x8A, 0xF9, 0x12, 0xAF, ++0x05, 0x7D, 0x28, 0x12, 0x04, 0x7E, 0x90, 0x04, ++0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x04, 0xF0, 0x90, 0x9A, 0x0B, ++0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x9A, 0x0E, ++0xE0, 0xFD, 0x90, 0x9A, 0x0D, 0xE0, 0x2D, 0x04, ++0xFD, 0x90, 0x8A, 0xE9, 0xE0, 0xFA, 0xA3, 0xE0, ++0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, ++0xF1, 0x8A, 0xE4, 0x90, 0x9A, 0x0F, 0xF0, 0xA3, ++0xF0, 0x12, 0xA3, 0x40, 0xEF, 0x54, 0x0C, 0x64, ++0x08, 0x70, 0x41, 0xB1, 0x83, 0xA3, 0xE0, 0x24, ++0x06, 0xB1, 0x18, 0xEF, 0x64, 0x88, 0x70, 0x34, ++0xB1, 0x83, 0xA3, 0xE0, 0x24, 0x07, 0xB1, 0x18, ++0xEF, 0x64, 0x8E, 0x70, 0x27, 0x90, 0x9A, 0x0F, ++0xB1, 0x03, 0xEF, 0x70, 0x1F, 0xB1, 0x83, 0xD1, ++0x7B, 0x24, 0x04, 0xB1, 0x18, 0xEF, 0x64, 0x01, ++0x70, 0x12, 0xB1, 0x83, 0xD1, 0x7B, 0x24, 0x08, ++0xB1, 0x18, 0xBF, 0x01, 0x07, 0x90, 0x01, 0xC7, ++0x74, 0x0B, 0xF1, 0x78, 0x90, 0x9A, 0x0F, 0xE0, ++0xFF, 0x22, 0xF0, 0x90, 0x9A, 0x0B, 0xE0, 0xFE, ++0xA3, 0xE0, 0xFF, 0x22, 0xF1, 0x8A, 0xE4, 0x90, ++0x9A, 0x10, 0xF0, 0x12, 0xA3, 0x40, 0xEF, 0x54, ++0x0C, 0x64, 0x08, 0x70, 0x6E, 0xB1, 0x83, 0xA3, ++0xE0, 0x24, 0x06, 0xB1, 0x18, 0xEF, 0x64, 0x88, ++0x70, 0x61, 0xB1, 0x83, 0xA3, 0xE0, 0x24, 0x07, ++0xB1, 0x18, 0xEF, 0x64, 0x8E, 0x70, 0x54, 0x90, ++0x9A, 0x10, 0xB1, 0x03, 0xEF, 0x64, 0x03, 0x70, ++0x4A, 0xB1, 0x83, 0xD1, 0x7B, 0x24, 0x06, 0xB1, ++0x18, 0xEF, 0x30, 0xE3, 0x07, 0x90, 0x01, 0xC7, ++0x74, 0x01, 0x80, 0x35, 0x90, 0x93, 0x24, 0xD1, ++0x14, 0x30, 0xE0, 0x20, 0x90, 0x98, 0x05, 0xE0, ++0x64, 0x02, 0x70, 0x0E, 0xD1, 0x11, 0x30, 0xE0, ++0x02, 0x80, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x02, ++0x80, 0x17, 0xB1, 0x83, 0xA3, 0xE0, 0xFD, 0x12, ++0xA3, 0x50, 0x80, 0x0F, 0x90, 0x93, 0x27, 0x91, ++0x6D, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xC7, 0x74, ++0x02, 0xF1, 0x78, 0x90, 0x9A, 0x10, 0xE0, 0xFF, ++0x22, 0x90, 0x93, 0x25, 0xE0, 0x13, 0x13, 0x13, ++0x54, 0x1F, 0x22, 0xE4, 0xF5, 0x11, 0x90, 0x88, ++0x36, 0xE0, 0x60, 0x56, 0xF1, 0x81, 0x70, 0x52, ++0xF1, 0xF0, 0x75, 0x11, 0x01, 0xE5, 0x11, 0x60, ++0x49, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, ++0x90, 0x8A, 0xB9, 0x12, 0x91, 0x62, 0xF1, 0x69, ++0xF1, 0x70, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x04, ++0x64, 0x01, 0x70, 0x14, 0xD1, 0x86, 0xD1, 0x14, ++0xFF, 0xA3, 0xE0, 0x2F, 0xD1, 0xB7, 0x90, 0x88, ++0x3E, 0xD1, 0x14, 0xFF, 0xA3, 0xE0, 0x80, 0x10, ++0xD1, 0x86, 0xD1, 0x14, 0xD1, 0x8F, 0x2F, 0xD1, ++0xB7, 0x90, 0x88, 0x3E, 0xD1, 0x14, 0xD1, 0x8F, ++0x2F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, ++0x4F, 0xF0, 0x22, 0x90, 0x9A, 0x0E, 0xE0, 0xFD, ++0x90, 0x9A, 0x0D, 0xE0, 0x2D, 0x22, 0xE4, 0x90, ++0x92, 0x20, 0xF0, 0x90, 0x88, 0x3E, 0x22, 0xFF, ++0xA3, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, ++0x22, 0x90, 0x9C, 0x6B, 0xE0, 0xFF, 0x90, 0x8A, ++0xC7, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, ++0x8C, 0x83, 0x02, 0x04, 0x7E, 0xF0, 0xE4, 0x90, ++0x92, 0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, 0x90, ++0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, ++0x7E, 0x01, 0x02, 0x66, 0x33, 0xE4, 0x90, 0x9A, ++0xDC, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x2F, ++0xF1, 0x81, 0x70, 0x2B, 0x12, 0xFC, 0xD4, 0xF0, ++0xF1, 0xF0, 0x90, 0x9A, 0xDC, 0x74, 0x01, 0xF0, ++0xE4, 0x90, 0x88, 0x3D, 0xF0, 0x04, 0x60, 0x17, ++0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, 0x90, ++0x8A, 0xB9, 0x12, 0x91, 0x62, 0xF1, 0x69, 0xF1, ++0x70, 0xD1, 0x86, 0xD1, 0x14, 0xD1, 0xB7, 0x22, ++0x90, 0x86, 0xB6, 0xE0, 0xFF, 0x90, 0x9C, 0x6C, ++0xE0, 0xFB, 0x90, 0x92, 0x13, 0x74, 0x0A, 0xF0, ++0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x9C, 0x6D, ++0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, ++0x9C, 0x6B, 0xE0, 0xFF, 0x90, 0x8A, 0x95, 0x22, ++0x90, 0x9C, 0x6D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0x90, 0x8A, 0x9B, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, ++0xF5, 0x82, 0x8C, 0x83, 0x12, 0x04, 0x7E, 0x90, ++0x9C, 0x6D, 0xA3, 0xE0, 0xFF, 0x24, 0x12, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, ++0x01, 0xFE, 0x90, 0x9C, 0x6C, 0xE0, 0x25, 0xE0, ++0x25, 0xE0, 0x44, 0x02, 0x4E, 0xFE, 0x74, 0x12, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0x22, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x04, 0x7E, ++0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, ++0xF0, 0x90, 0x93, 0x2D, 0xE0, 0x44, 0x01, 0xF0, ++0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x64, ++0x01, 0x22, 0x90, 0x9A, 0x0D, 0xED, 0xF0, 0xA3, ++0xEB, 0xF0, 0x90, 0x9A, 0x0B, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0x22, 0xF1, 0x92, 0xA3, 0xED, 0xF0, ++0xE4, 0xA3, 0xF0, 0x12, 0xFA, 0x76, 0x50, 0x20, ++0xB1, 0x83, 0xED, 0x24, 0x1C, 0xB1, 0x18, 0x90, ++0x9A, 0x0E, 0xE0, 0x24, 0x97, 0xF5, 0x82, 0xE4, ++0x34, 0x95, 0xF5, 0x83, 0xE0, 0xB5, 0x07, 0x1D, ++0x90, 0x9A, 0x0E, 0xE0, 0x04, 0xF0, 0x80, 0xDB, ++0x90, 0x06, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x90, ++0x01, 0xC7, 0x74, 0x30, 0xF0, 0x7F, 0x01, 0x12, ++0xC9, 0x1D, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, ++0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, ++0x90, 0x88, 0x33, 0xE0, 0x54, 0xFE, 0xF0, 0x22, ++0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x89, 0xF0, ++0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, ++0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x8B, 0xF0, ++0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, ++0x90, 0x88, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x22, ++0x12, 0x02, 0x06, 0xFF, 0x90, 0x98, 0x24, 0xF0, ++0xBF, 0x01, 0x0A, 0x7F, 0x01, 0x12, 0x91, 0x6B, ++0xE4, 0x90, 0x98, 0x24, 0xF0, 0x22, 0xE4, 0xFD, ++0x02, 0x97, 0x91, 0xE4, 0xFD, 0xFF, 0x12, 0x6E, ++0x71, 0xE4, 0xFF, 0x7D, 0x01, 0x02, 0x97, 0x91, ++0x90, 0x98, 0x1C, 0xE0, 0xFD, 0x30, 0xE0, 0x4D, ++0x90, 0x98, 0x21, 0xE0, 0xFC, 0x60, 0x46, 0x12, ++0xA9, 0x8F, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, ++0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, 0xE0, ++0xFB, 0xEF, 0x5B, 0x60, 0x0B, 0xE4, 0x90, 0x98, ++0x21, 0xF0, 0x90, 0x98, 0x23, 0x04, 0xF0, 0x22, ++0x90, 0x98, 0x1E, 0xE0, 0xD3, 0x9C, 0x50, 0x15, ++0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, ++0x04, 0x11, 0x33, 0x80, 0x04, 0xD1, 0x46, 0x31, ++0x1D, 0x11, 0x96, 0xF0, 0x22, 0x90, 0x8A, 0xAF, ++0x12, 0x91, 0x62, 0xD1, 0x4F, 0x22, 0x90, 0x98, ++0x1C, 0xE0, 0x54, 0xFE, 0x22, 0x90, 0x98, 0x1C, ++0xE0, 0x30, 0xE0, 0x78, 0x90, 0x98, 0x20, 0xE0, ++0x04, 0xF0, 0x90, 0x98, 0x23, 0xE0, 0x64, 0x01, ++0x70, 0x31, 0x90, 0x98, 0x1C, 0xF1, 0xC1, 0x30, ++0xE0, 0x29, 0x90, 0x98, 0x22, 0xE0, 0x70, 0x23, ++0x90, 0x98, 0x1F, 0xE0, 0xFE, 0xA3, 0xE0, 0xC3, ++0x9E, 0x40, 0x18, 0xEF, 0x13, 0x13, 0x13, 0x54, ++0x1F, 0x30, 0xE0, 0x07, 0x11, 0x33, 0x11, 0x96, ++0xF0, 0x80, 0x08, 0xD1, 0x46, 0x31, 0x1D, 0x11, ++0x96, 0xF0, 0x22, 0x90, 0x98, 0x20, 0xE0, 0xFF, ++0x90, 0x98, 0x1D, 0xE0, 0xD3, 0x9F, 0x50, 0x2C, ++0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x16, 0x90, ++0x98, 0x22, 0xE0, 0x70, 0x10, 0x90, 0x8A, 0xAF, ++0x12, 0x91, 0x62, 0xD1, 0x4F, 0x90, 0x98, 0x1B, ++0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, ++0x74, 0x04, 0xF0, 0xE4, 0x90, 0x98, 0x20, 0xF0, ++0x90, 0x98, 0x22, 0xF0, 0x22, 0x90, 0x9C, 0xAB, ++0xEF, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x02, ++0x70, 0x22, 0x90, 0x9C, 0xAB, 0xE0, 0xFD, 0x64, ++0x01, 0x70, 0x67, 0x12, 0xC7, 0x79, 0x90, 0x93, ++0x28, 0x12, 0xBF, 0xE3, 0x30, 0xE0, 0x09, 0x90, ++0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, 0x52, ++0xAF, 0x05, 0x80, 0x4B, 0x12, 0xB2, 0x89, 0x70, ++0x32, 0x90, 0x99, 0x7B, 0xE0, 0xFF, 0x30, 0xE0, ++0x2A, 0x90, 0x00, 0xD4, 0xE0, 0x54, 0xEF, 0xF0, ++0x90, 0x00, 0xC6, 0xE0, 0x54, 0xFD, 0xF0, 0x90, ++0x00, 0x01, 0xE0, 0x44, 0x30, 0xF0, 0x90, 0x00, ++0x23, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x00, 0xCC, ++0xE0, 0x54, 0xFB, 0xF0, 0xEF, 0x54, 0xFE, 0x90, ++0x99, 0x7B, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, ++0xF0, 0xF1, 0x71, 0x90, 0x06, 0x90, 0xE0, 0x44, ++0x01, 0xF0, 0x90, 0x9C, 0xAB, 0xE0, 0xFF, 0x12, ++0xE7, 0xEF, 0x11, 0x96, 0xF0, 0x90, 0x93, 0x24, ++0xE0, 0x54, 0xBF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x9B, 0xE1, ++0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, ++0xF1, 0x6A, 0x90, 0x9B, 0xE9, 0xF0, 0xA3, 0xF0, ++0xA3, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0xA5, 0xF0, ++0x74, 0xC9, 0xA3, 0xF1, 0xC8, 0x12, 0xBA, 0x6E, ++0x90, 0x9B, 0xD7, 0xF1, 0x9A, 0x90, 0x9B, 0xE0, ++0xF0, 0x90, 0x93, 0x24, 0xE0, 0x20, 0xE0, 0x02, ++0x81, 0xD5, 0xE4, 0x90, 0x9B, 0xDF, 0xF0, 0x90, ++0x9B, 0xE0, 0xE0, 0xFF, 0x90, 0x9B, 0xDF, 0xE0, ++0xC3, 0x9F, 0x40, 0x02, 0x81, 0xD5, 0xB1, 0x0F, ++0xEC, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x9B, ++0xE9, 0xEF, 0xF0, 0x12, 0xEB, 0xD9, 0x54, 0x3F, ++0xFE, 0x90, 0x9B, 0xD9, 0xF0, 0xA3, 0xEF, 0xF0, ++0x90, 0x9B, 0xE5, 0xEE, 0x12, 0xEC, 0xCE, 0x30, ++0xE0, 0x0A, 0xC3, 0x13, 0x20, 0xE0, 0x05, 0x12, ++0xEC, 0x9C, 0x80, 0x02, 0x7E, 0x00, 0xEF, 0x24, ++0x18, 0x2E, 0xFF, 0x90, 0x9B, 0xEA, 0xF0, 0x90, ++0x9B, 0xD8, 0xE0, 0x2F, 0xFF, 0x90, 0x9B, 0xD7, ++0xE0, 0x34, 0x00, 0xFE, 0x90, 0x9B, 0xDB, 0xF0, ++0xA3, 0xEF, 0xF0, 0x12, 0xA3, 0x40, 0xC0, 0x07, ++0x90, 0x9B, 0xDB, 0x12, 0xAE, 0xFD, 0x7D, 0x01, ++0x12, 0x04, 0x7E, 0xC0, 0x07, 0x90, 0x9B, 0xDB, ++0x12, 0xAE, 0xFD, 0x7D, 0x04, 0x12, 0x04, 0x7E, ++0xAB, 0x07, 0xD0, 0x05, 0xD0, 0x07, 0xD1, 0xE7, ++0x90, 0x9B, 0xE1, 0xEF, 0x91, 0xF3, 0x12, 0xA3, ++0x40, 0xEF, 0x54, 0xFC, 0x90, 0x9B, 0xDD, 0xF0, ++0x90, 0x9B, 0xEA, 0xE0, 0xFF, 0x90, 0x9B, 0xD9, ++0xE4, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0xB1, 0x18, ++0xD1, 0x5D, 0x90, 0x9B, 0xD9, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0x90, 0x9B, 0xD7, 0x12, 0xAE, 0xFD, ++0x7D, 0x0F, 0x12, 0x04, 0x7E, 0x90, 0x9B, 0xDE, ++0xEF, 0xF0, 0x90, 0x9B, 0x63, 0xE0, 0x60, 0x3F, ++0x90, 0x9B, 0xDD, 0xE0, 0x24, 0xB0, 0x60, 0x18, ++0x24, 0xD0, 0x60, 0x02, 0x81, 0x31, 0xB1, 0x07, ++0x20, 0xE0, 0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, ++0x1F, 0x20, 0xE0, 0x02, 0x81, 0x31, 0x80, 0x10, ++0xB1, 0x07, 0x20, 0xE0, 0x0B, 0xEF, 0x13, 0x13, ++0x13, 0x54, 0x1F, 0x20, 0xE0, 0x02, 0x81, 0x31, ++0x91, 0xF4, 0x90, 0x9B, 0xE5, 0xE0, 0xFC, 0xA3, ++0xE0, 0xFD, 0x12, 0xF9, 0xFD, 0x81, 0x31, 0x90, ++0x9B, 0xDD, 0xE0, 0x24, 0xF8, 0x60, 0x37, 0x24, ++0x80, 0x60, 0x33, 0x24, 0xC8, 0x60, 0x06, 0x24, ++0x20, 0x60, 0x02, 0x81, 0x31, 0x90, 0x93, 0x27, ++0x12, 0xBF, 0xE3, 0x20, 0xE0, 0x02, 0x81, 0x31, ++0x90, 0x93, 0x3A, 0xE0, 0x04, 0x91, 0xF3, 0xB1, ++0x21, 0xEF, 0x70, 0x02, 0x81, 0x31, 0x90, 0x9B, ++0xDD, 0xE0, 0xFF, 0x12, 0xF3, 0x4B, 0x90, 0x93, ++0x3B, 0xE0, 0x04, 0xF0, 0x81, 0x31, 0x90, 0x93, ++0x24, 0x12, 0xC4, 0x6D, 0x30, 0xE0, 0x5F, 0x90, ++0x9B, 0xE1, 0xE0, 0xFF, 0x90, 0x9B, 0xDC, 0xE0, ++0x2F, 0xFF, 0x90, 0x9B, 0xDB, 0xE0, 0x34, 0x00, ++0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, 0xFE, 0x90, ++0x9B, 0xE7, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xA3, ++0x40, 0xEF, 0x64, 0x45, 0x70, 0x38, 0x91, 0xFE, ++0x12, 0xFA, 0x7F, 0xEF, 0x64, 0x01, 0x70, 0x2E, ++0x91, 0xFE, 0x12, 0xFA, 0xBC, 0xEF, 0x64, 0x01, ++0x70, 0x24, 0x90, 0x9B, 0xEB, 0x04, 0x91, 0xFD, ++0xA3, 0xE0, 0xFD, 0x12, 0xFA, 0x24, 0xEF, 0x70, ++0x0D, 0x90, 0x9B, 0xE9, 0xE0, 0xFD, 0x90, 0xFD, ++0x11, 0x91, 0xFD, 0x12, 0xC7, 0x9B, 0x90, 0x9B, ++0xE9, 0xE0, 0x90, 0xFD, 0x11, 0xF0, 0x91, 0xF4, ++0xB1, 0x21, 0xEF, 0x60, 0x39, 0x91, 0xE5, 0x90, ++0x9B, 0xE4, 0xE0, 0xFB, 0x90, 0x9B, 0xE9, 0xE0, ++0x90, 0x9A, 0x0F, 0xF0, 0x12, 0xC5, 0x8C, 0xEF, ++0x60, 0x06, 0x90, 0x9B, 0xEB, 0x74, 0x01, 0xF0, ++0x90, 0x93, 0x25, 0xE0, 0xC4, 0x13, 0x54, 0x07, ++0x30, 0xE0, 0x13, 0x91, 0xE5, 0x90, 0x9B, 0xE4, ++0xE0, 0xFB, 0x12, 0xC5, 0x28, 0xEF, 0x60, 0x06, ++0x90, 0x9B, 0xEB, 0x74, 0x01, 0xF0, 0x90, 0x93, ++0x24, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x0E, 0x91, ++0xE5, 0x12, 0xA5, 0xCA, 0xEF, 0x60, 0x06, 0x90, ++0x9B, 0xEB, 0x74, 0x01, 0xF0, 0x90, 0x93, 0x24, ++0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0E, ++0x91, 0xE5, 0x12, 0xDB, 0xE3, 0xEF, 0x60, 0x06, ++0x90, 0x9B, 0xEB, 0x74, 0x01, 0xF0, 0x90, 0x93, ++0x24, 0x12, 0xBF, 0xE3, 0x30, 0xE0, 0x16, 0x90, ++0x9B, 0xEB, 0xE0, 0x70, 0x10, 0x91, 0xE5, 0xB1, ++0x69, 0xEF, 0x60, 0x09, 0x12, 0xC7, 0x79, 0x90, ++0x01, 0xC7, 0x74, 0x22, 0xF0, 0x91, 0xE5, 0x12, ++0xAF, 0x0E, 0xEF, 0x60, 0x0C, 0x90, 0x93, 0x2D, ++0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0xC7, 0xE4, ++0xF0, 0x90, 0x9B, 0xDE, 0xE0, 0xFF, 0x7D, 0x01, ++0x12, 0xF6, 0xA7, 0xEF, 0x60, 0x13, 0x12, 0xC7, ++0x79, 0x90, 0x9B, 0xD7, 0x12, 0xAE, 0xFD, 0x7D, ++0x10, 0x12, 0x04, 0x7E, 0x90, 0x95, 0x61, 0xEF, ++0xF0, 0xB1, 0x18, 0x90, 0x9B, 0xD7, 0x12, 0xEC, ++0x8D, 0xB1, 0x0F, 0xD3, 0x9F, 0xEC, 0x9E, 0x40, ++0x0F, 0x12, 0xEC, 0xAB, 0xED, 0x9F, 0xFF, 0xEC, ++0x9E, 0x90, 0x9B, 0xD7, 0xF0, 0xA3, 0xEF, 0xF0, ++0x90, 0x93, 0x2D, 0xE0, 0x30, 0xE0, 0x04, 0x7F, ++0x01, 0x31, 0x1D, 0x12, 0xF3, 0x34, 0xEF, 0x64, ++0x01, 0x70, 0x36, 0x90, 0x93, 0x3C, 0xE0, 0x04, ++0xF0, 0xF1, 0x54, 0xAD, 0x07, 0xEF, 0x64, 0x01, ++0x60, 0x1F, 0x12, 0xC7, 0x79, 0xED, 0xB4, 0x02, ++0x08, 0x90, 0x01, 0xC7, 0x74, 0x42, 0xF0, 0x80, ++0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, 0x01, 0xC7, ++0x74, 0x43, 0xF0, 0x7F, 0x01, 0x31, 0x1D, 0x80, ++0x24, 0x90, 0x9B, 0xD7, 0x12, 0xEC, 0xBB, 0x80, ++0x14, 0x90, 0x93, 0x26, 0xE0, 0xC4, 0x13, 0x54, ++0x07, 0x20, 0xE0, 0x11, 0x90, 0x93, 0x24, 0xE0, ++0x54, 0xFE, 0xF0, 0x80, 0x08, 0x90, 0x9B, 0xDF, ++0xE0, 0x04, 0xF0, 0x21, 0xE7, 0x74, 0xA5, 0x04, ++0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC9, 0xA3, 0xF0, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9B, 0xDB, ++0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x9B, 0xE1, ++0xE0, 0xFD, 0x22, 0xF0, 0x90, 0x9B, 0xDB, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xF0, 0x90, 0x9B, ++0xE7, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, ++0x93, 0x04, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0x90, ++0x9B, 0xD7, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x22, ++0x90, 0x9B, 0xD9, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0x22, 0x90, 0x9A, 0x12, 0xEE, 0xF0, 0xA3, 0xEF, ++0xF0, 0xE4, 0x90, 0x9A, 0x1A, 0xF0, 0x90, 0x9A, ++0x1A, 0xE0, 0xFD, 0xC3, 0x94, 0x06, 0x50, 0x1C, ++0x90, 0x9A, 0x13, 0xE0, 0x24, 0x04, 0xF1, 0xA3, ++0x12, 0xC5, 0x19, 0x90, 0x9A, 0x1A, 0xF1, 0x88, ++0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x9A, 0x1A, 0xE0, ++0x04, 0xF0, 0x80, 0xDA, 0x78, 0x2E, 0x7C, 0x93, ++0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x14, ++0xF1, 0xAC, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, ++0x22, 0x90, 0x9A, 0x0D, 0xED, 0x12, 0xC7, 0x91, ++0xB1, 0x21, 0xEF, 0x60, 0x09, 0x12, 0xC5, 0x83, ++0xF1, 0x80, 0x60, 0x02, 0x7F, 0x01, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x02, ++0x09, 0xE0, 0xFD, 0x12, 0xBF, 0xEB, 0x90, 0x93, ++0x04, 0xF1, 0xDD, 0x12, 0x8F, 0x0E, 0x54, 0x04, ++0xFC, 0xEF, 0x54, 0xFB, 0x4C, 0xFF, 0x90, 0x93, ++0x04, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, ++0xF7, 0x4E, 0xFF, 0xF0, 0x12, 0x02, 0x06, 0x54, ++0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0x90, 0x93, ++0x04, 0x12, 0x8E, 0xFE, 0xFF, 0xED, 0x2F, 0x90, ++0x93, 0x05, 0x12, 0x8F, 0xED, 0xFF, 0xED, 0x2F, ++0x90, 0x93, 0x06, 0xF0, 0x12, 0x8F, 0xF4, 0xFF, ++0xAE, 0x05, 0xED, 0x2F, 0x90, 0x93, 0x07, 0xF0, ++0x90, 0x93, 0x04, 0xE0, 0xFF, 0x20, 0xE0, 0x08, ++0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0A, ++0x90, 0x06, 0x31, 0xE0, 0x44, 0x40, 0xF0, 0x12, ++0xE7, 0x73, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x30, ++0xE0, 0x38, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x01, ++0xF0, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF1, ++0x91, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, ++0x08, 0xF1, 0x78, 0x90, 0x9A, 0xFF, 0x74, 0x01, ++0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x74, ++0xB1, 0x07, 0x20, 0xE0, 0x0D, 0x90, 0x9C, 0x55, ++0x12, 0x04, 0x3D, 0x00, 0x00, 0x27, 0x10, 0x12, ++0xB3, 0xA7, 0xB1, 0x07, 0x30, 0xE0, 0x0A, 0x90, ++0x06, 0x32, 0xE0, 0x44, 0x02, 0xF0, 0x12, 0xB6, ++0xE4, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, ++0xC7, 0x74, 0x10, 0xF0, 0x7F, 0x01, 0x22, 0x7D, ++0x08, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x98, ++0x21, 0xE0, 0x04, 0xF0, 0x22, 0x7D, 0x07, 0xEF, ++0x5D, 0xC3, 0x60, 0x0B, 0xD1, 0x74, 0x5F, 0x24, ++0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x04, 0xD1, ++0x74, 0x5F, 0xFF, 0x22, 0x74, 0xFF, 0x9D, 0xFD, ++0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x22, ++0x90, 0x88, 0x31, 0x12, 0xC7, 0xE0, 0x30, 0xE0, ++0x34, 0xEF, 0x54, 0xBF, 0xF1, 0xB5, 0x30, 0xE0, ++0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, 0xE0, ++0x54, 0xFE, 0xF1, 0xD2, 0x74, 0x04, 0xF0, 0x90, ++0x88, 0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, ++0x30, 0xE0, 0x0F, 0x90, 0x8A, 0xB9, 0x12, 0x91, ++0x62, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, 0x7E, ++0x80, 0x03, 0x12, 0xAE, 0xEB, 0xE4, 0xFF, 0x01, ++0x40, 0xA3, 0xE0, 0xFE, 0x24, 0x28, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, ++0x29, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0xFD, 0x74, 0x2C, 0x2E, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, ++0xFE, 0xEF, 0x30, 0xE7, 0x04, 0x7C, 0x02, 0x80, ++0x02, 0xE4, 0xFC, 0xED, 0x30, 0xE6, 0x09, 0xAF, ++0x03, 0x12, 0xF3, 0x5D, 0xAE, 0x07, 0x80, 0x02, ++0xE4, 0xFE, 0xEC, 0x24, 0x18, 0x2E, 0xFF, 0x22, ++0xF1, 0x54, 0xAD, 0x07, 0x90, 0x01, 0xC4, 0x74, ++0x08, 0xF0, 0x74, 0xCF, 0xA3, 0xF0, 0xED, 0x64, ++0x01, 0x60, 0x1D, 0x12, 0xC7, 0x79, 0xED, 0xB4, ++0x02, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x40, 0xF0, ++0x80, 0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, 0x01, ++0xC7, 0x74, 0x41, 0xF0, 0x7F, 0x01, 0x21, 0x1D, ++0x12, 0xEB, 0xF8, 0x90, 0x02, 0x87, 0xE0, 0x70, ++0xF7, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x02, 0xF0, ++0x74, 0x08, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, ++0xCF, 0xA3, 0xF0, 0x22, 0x90, 0x02, 0x86, 0xE0, ++0x20, 0xE2, 0x03, 0x7F, 0x04, 0x22, 0x90, 0x02, ++0x86, 0xE0, 0x7F, 0x01, 0x20, 0xE1, 0x02, 0x7F, ++0x02, 0x22, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, ++0x22, 0x7F, 0x64, 0x7E, 0x00, 0x02, 0x7C, 0x6A, ++0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0x22, ++0xA3, 0xE0, 0xFD, 0x12, 0xA7, 0x2D, 0xEF, 0x22, ++0xE0, 0x24, 0x14, 0xF5, 0x82, 0xE4, 0x34, 0x9A, ++0x22, 0xF0, 0x90, 0x06, 0x08, 0xE0, 0x54, 0x7F, ++0xF0, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, ++0x87, 0xE0, 0x22, 0xFF, 0x90, 0x9A, 0x12, 0xE0, ++0x34, 0x00, 0xFE, 0x22, 0x7E, 0x00, 0x7F, 0x06, ++0x12, 0x86, 0x1C, 0xEF, 0x22, 0xF0, 0x90, 0x04, ++0xE0, 0xE0, 0x90, 0x88, 0x32, 0x22, 0x90, 0x88, ++0x32, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, ++0xF0, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, ++0x1E, 0x22, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, ++0xF0, 0x90, 0x01, 0xB8, 0x22, 0xE0, 0x54, 0xFE, ++0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, ++0x54, 0xFD, 0x4F, 0x22, 0xEF, 0xB4, 0xFF, 0x06, ++0x90, 0x98, 0x36, 0xED, 0xF0, 0x22, 0xEF, 0xF4, ++0xFE, 0x90, 0x98, 0x36, 0xE0, 0x5E, 0xFE, 0xED, ++0x5F, 0x4E, 0xF0, 0x22, 0xEF, 0xB4, 0xFF, 0x06, ++0x90, 0x98, 0x37, 0xED, 0xF0, 0x22, 0xEF, 0xF4, ++0xFE, 0x90, 0x98, 0x37, 0x80, 0xE6, 0x90, 0x9C, ++0xA8, 0xED, 0xF0, 0x64, 0x01, 0x60, 0x26, 0xE0, ++0xFE, 0x64, 0x02, 0x60, 0x20, 0xEE, 0x64, 0x29, ++0x60, 0x1B, 0xEE, 0x64, 0x2A, 0x60, 0x16, 0xEE, ++0x64, 0x36, 0x60, 0x11, 0xEE, 0xB4, 0x37, 0x02, ++0x80, 0x0B, 0xAD, 0x07, 0x7F, 0xFF, 0x11, 0x04, ++0x90, 0x98, 0x37, 0xE0, 0xFF, 0x90, 0x98, 0x36, ++0xE0, 0x4F, 0x90, 0x05, 0x22, 0xF0, 0x90, 0x9C, ++0xA8, 0xE0, 0x90, 0x93, 0x01, 0xF0, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x8F, ++0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, 0x29, 0x90, ++0x00, 0x8C, 0xE0, 0x90, 0x9C, 0x93, 0xF0, 0x7F, ++0x8D, 0x12, 0x7B, 0x41, 0x90, 0x9C, 0x94, 0xEF, ++0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0x9C, 0x95, ++0xF0, 0x90, 0x9C, 0x94, 0xE0, 0x7F, 0x8F, 0x12, ++0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x02, 0x11, 0x95, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFD, 0x7F, ++0x8D, 0x02, 0x7B, 0x2E, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x9B, 0xEF, 0xF0, ++0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, ++0x4A, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0xEF, 0x64, ++0x01, 0x70, 0x40, 0x90, 0x9C, 0x9C, 0xF0, 0x90, ++0x9C, 0x9C, 0xE0, 0xFD, 0x90, 0x9C, 0x9B, 0xE0, ++0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, ++0x34, 0x81, 0xF5, 0x83, 0xE5, 0x82, 0x2D, 0xF5, ++0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, ++0xE4, 0xFF, 0x31, 0x00, 0x90, 0x9C, 0x9C, 0xE0, ++0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCF, ++0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, ++0x02, 0x11, 0x95, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, ++0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, ++0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, ++0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, ++0xE4, 0x90, 0x99, 0xE0, 0xF0, 0xA3, 0xF0, 0xA3, ++0xF0, 0x90, 0x99, 0xE0, 0xE0, 0x64, 0x01, 0xF0, ++0x90, 0x98, 0x2E, 0xE0, 0x70, 0x18, 0x90, 0x98, ++0x2B, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, ++0x90, 0x99, 0xE0, 0xE0, 0x24, 0x28, 0x90, 0x01, ++0xC4, 0xF0, 0x74, 0xD1, 0xA3, 0xF0, 0x12, 0x7C, ++0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, 0x9F, 0x90, ++0x88, 0x36, 0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, ++0xE0, 0xFF, 0x90, 0x88, 0x38, 0xE0, 0x6F, 0x60, ++0x03, 0x12, 0xAE, 0xEB, 0xC2, 0xAF, 0x51, 0xE5, ++0xBF, 0x01, 0x16, 0x90, 0x86, 0xB3, 0xE0, 0xFF, ++0xB4, 0x03, 0x07, 0x90, 0x99, 0x7B, 0xE0, 0x20, ++0xE0, 0x05, 0xEF, 0x64, 0x03, 0x60, 0x02, 0x31, ++0x9C, 0xD2, 0xAF, 0x51, 0x26, 0x11, 0x57, 0x12, ++0x86, 0x8D, 0x80, 0x95, 0x90, 0x88, 0x31, 0xE0, ++0x30, 0xE0, 0x02, 0x31, 0xA6, 0x22, 0x90, 0x88, ++0x39, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0E, ++0x31, 0xBF, 0xBF, 0x01, 0x09, 0x12, 0xAF, 0xC1, ++0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x90, ++0x93, 0x08, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x36, ++0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, ++0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, 0x05, ++0x75, 0x10, 0x01, 0x80, 0x3A, 0x90, 0x93, 0x2D, ++0xE0, 0x30, 0xE0, 0x05, 0x75, 0x10, 0x08, 0x80, ++0x2E, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, ++0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, ++0x05, 0x75, 0x10, 0x04, 0x80, 0x19, 0x90, 0x88, ++0xE6, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x10, 0x20, ++0x80, 0x0D, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x05, ++0x75, 0x10, 0x40, 0x80, 0x02, 0x41, 0xDD, 0x90, ++0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, ++0xE5, 0x10, 0xF0, 0x7F, 0x00, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x98, 0x2B, ++0xE0, 0x60, 0x25, 0x7F, 0x54, 0x7E, 0x09, 0x12, ++0x70, 0x70, 0x51, 0xD3, 0x12, 0x04, 0xB8, 0xEF, ++0x44, 0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, 0xED, ++0x44, 0x04, 0xFD, 0xEC, 0x51, 0xD3, 0x12, 0xAE, ++0xD6, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, ++0x90, 0x98, 0x26, 0xE0, 0x70, 0x29, 0x90, 0x07, ++0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, 0xF0, 0x90, ++0x99, 0xE7, 0x74, 0x22, 0xF0, 0x90, 0x9A, 0x09, ++0x74, 0x01, 0xF0, 0x90, 0x99, 0xE9, 0x74, 0x03, ++0xF0, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0xE7, 0x12, ++0x91, 0x50, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, ++0x98, 0x2E, 0xE0, 0xFF, 0x70, 0x0A, 0x90, 0x98, ++0x2B, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, ++0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, 0xF0, 0x90, ++0x01, 0xC5, 0x74, 0xEA, 0xF0, 0xA3, 0x74, 0xEF, ++0xF0, 0xA3, 0x74, 0xFD, 0xF0, 0xEF, 0x60, 0x06, ++0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, 0x90, 0x98, ++0x2B, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, ++0x01, 0xF0, 0x90, 0x98, 0x2C, 0xE0, 0x60, 0x06, ++0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x90, 0x99, 0xE3, 0x12, 0x04, ++0x31, 0x90, 0x99, 0xE3, 0x22, 0x90, 0x01, 0xB8, ++0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x7D, 0x02, 0x90, ++0x01, 0xC4, 0x74, 0xE5, 0xF0, 0x74, 0xD2, 0xA3, ++0xF0, 0x90, 0x98, 0x17, 0xE0, 0xFF, 0xED, 0xC3, ++0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, 0x81, ++0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, ++0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, ++0x0D, 0x80, 0xDE, 0x74, 0xE5, 0x04, 0x90, 0x01, ++0xC4, 0xF0, 0x74, 0xD2, 0xA3, 0xF0, 0x7F, 0x01, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x10, 0x90, ++0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, ++0xE0, 0x12, 0x75, 0x16, 0x10, 0x80, 0x2D, 0x12, ++0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, ++0x16, 0x01, 0x80, 0x20, 0x90, 0x88, 0x31, 0x12, ++0xC6, 0x14, 0x30, 0xE0, 0x05, 0x75, 0x16, 0x02, ++0x80, 0x12, 0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, ++0x04, 0x40, 0x05, 0x75, 0x16, 0x08, 0x80, 0x04, ++0x51, 0xDD, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, ++0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x16, 0xF0, ++0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, ++0x9D, 0xE0, 0x30, 0xE0, 0x1E, 0x90, 0x88, 0xAF, ++0xE0, 0x60, 0x05, 0x75, 0x17, 0x40, 0x81, 0x28, ++0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, 0x00, 0x40, ++0x02, 0x80, 0x2D, 0x90, 0x88, 0x9C, 0xE0, 0x60, ++0x7B, 0x80, 0x55, 0x12, 0x7A, 0x65, 0xEF, 0x64, ++0x01, 0x60, 0x05, 0x75, 0x17, 0x01, 0x80, 0x70, ++0x90, 0x88, 0x3A, 0xE0, 0xFF, 0x54, 0x03, 0x60, ++0x05, 0x75, 0x17, 0x02, 0x80, 0x62, 0x90, 0x88, ++0x38, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, ++0x75, 0x17, 0x04, 0x80, 0x53, 0xEF, 0x30, 0xE2, ++0x05, 0x75, 0x17, 0x08, 0x80, 0x4A, 0x90, 0x88, ++0x3A, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x17, 0x10, ++0x80, 0x3E, 0x90, 0x88, 0x32, 0xE0, 0x13, 0x13, ++0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x17, 0x20, ++0x80, 0x2E, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x05, ++0x75, 0x17, 0x80, 0x80, 0x23, 0x90, 0x06, 0x62, ++0xE0, 0x30, 0xE1, 0x05, 0x75, 0x17, 0x11, 0x80, ++0x17, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, ++0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, 0x05, 0x75, ++0x17, 0x12, 0x80, 0x04, 0x51, 0xDD, 0x80, 0x0E, ++0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, ++0xB8, 0xE5, 0x17, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0xE4, 0x90, 0x86, 0xAF, 0x12, ++0xB0, 0x2B, 0x90, 0x93, 0x01, 0xF0, 0x90, 0x98, ++0x36, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x00, 0x80, ++0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x7B, ++0x2E, 0x12, 0xD8, 0x3E, 0xF1, 0x8B, 0x12, 0x7B, ++0x79, 0x12, 0xD9, 0xEB, 0x91, 0x3B, 0x7F, 0x01, ++0x12, 0x87, 0x55, 0x90, 0x98, 0x17, 0x74, 0x02, ++0xF0, 0xFF, 0x12, 0x87, 0x55, 0x90, 0x98, 0x17, ++0xE0, 0x04, 0xF0, 0x91, 0xCA, 0xB1, 0x32, 0x90, ++0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, ++0x12, 0x7B, 0x2E, 0x75, 0x20, 0xFF, 0x12, 0x7C, ++0x97, 0x90, 0x01, 0xA0, 0xE0, 0xB4, 0xFD, 0x05, ++0xE4, 0xFF, 0x12, 0x91, 0x6B, 0xB1, 0x7B, 0xF1, ++0xAB, 0x90, 0x00, 0x81, 0xE0, 0x44, 0x04, 0xFD, ++0x7F, 0x81, 0x12, 0x7B, 0x2E, 0xF1, 0x74, 0x12, ++0x90, 0xC6, 0x90, 0x00, 0xAA, 0xE0, 0x44, 0x02, ++0xF0, 0xA3, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x99, ++0x7B, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x02, ++0x87, 0xDE, 0x12, 0x7B, 0x1B, 0x90, 0x86, 0xB3, ++0xEF, 0xF0, 0x91, 0xE4, 0x90, 0x01, 0x64, 0x74, ++0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, ++0xF0, 0x02, 0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, ++0x75, 0xE0, 0xF1, 0xDD, 0x12, 0xD8, 0x16, 0x75, ++0x21, 0x80, 0x90, 0x86, 0xB3, 0xE0, 0xFF, 0xB4, ++0x03, 0x05, 0x75, 0x22, 0x08, 0x80, 0x03, 0xE4, ++0xF5, 0x22, 0xEF, 0xB4, 0x01, 0x0A, 0x90, 0x00, ++0x75, 0xE0, 0x54, 0xFB, 0xF0, 0x75, 0x22, 0x04, ++0xE4, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, 0x21, ++0x7F, 0x50, 0x12, 0x7B, 0x2E, 0xAD, 0x22, 0x7F, ++0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, 0x52, ++0x12, 0x7B, 0x2E, 0xAD, 0x24, 0x7F, 0x53, 0x02, ++0x7B, 0x2E, 0xB1, 0xC7, 0x12, 0x7B, 0xDB, 0x12, ++0x93, 0xC6, 0x12, 0xA7, 0xB2, 0x12, 0xB1, 0x30, ++0xF1, 0x98, 0xB1, 0x67, 0x90, 0x8A, 0x73, 0x12, ++0x8C, 0x14, 0x90, 0x98, 0x30, 0xE0, 0x54, 0x7F, ++0xF0, 0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, ++0xF0, 0xF0, 0xE4, 0x90, 0x98, 0x32, 0xF0, 0x90, ++0x98, 0x30, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xF1, ++0x6B, 0x7A, 0x98, 0x79, 0x1C, 0x12, 0x04, 0x80, ++0x90, 0x98, 0x1D, 0x74, 0x08, 0xF0, 0xA3, 0x74, ++0x03, 0xF0, 0x22, 0xF1, 0x63, 0xF1, 0x7F, 0xEF, ++0x64, 0x01, 0x60, 0x3C, 0xC3, 0x90, 0x99, 0x89, ++0xE0, 0x94, 0x88, 0x90, 0x99, 0x88, 0xE0, 0x94, ++0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, ++0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, ++0x80, 0x1E, 0x90, 0x99, 0x88, 0xB1, 0xCD, 0x12, ++0xAC, 0x6A, 0xD3, 0x90, 0x99, 0x89, 0xE0, 0x94, ++0x32, 0x90, 0x99, 0x88, 0xE0, 0x94, 0x00, 0x40, ++0xC4, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xBD, ++0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0xE4, ++0xFD, 0xFF, 0x02, 0x6E, 0x71, 0xE4, 0x75, 0xF0, ++0x01, 0x02, 0x02, 0xE7, 0xAD, 0x07, 0x90, 0x95, ++0x6D, 0xB1, 0xCD, 0x90, 0x95, 0x6D, 0xE0, 0xFF, ++0xAE, 0x05, 0x74, 0x04, 0x2E, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x95, ++0x6D, 0xA3, 0xE0, 0xFF, 0x74, 0x05, 0x2E, 0xF1, ++0x5B, 0xEF, 0xF0, 0x22, 0xE4, 0x90, 0x9A, 0xD7, ++0xF0, 0xA3, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x44, ++0x20, 0xF0, 0x12, 0x76, 0x9B, 0xEF, 0x64, 0x01, ++0x70, 0x76, 0x90, 0x98, 0x12, 0xE0, 0xFF, 0x90, ++0x92, 0x13, 0x74, 0x0D, 0xF0, 0x7B, 0x08, 0x7D, ++0x01, 0x12, 0x66, 0xDB, 0x90, 0x9A, 0xD4, 0xEE, ++0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x9A, 0xD4, 0x12, ++0xCE, 0xC1, 0x90, 0x9A, 0xD6, 0xEF, 0xF0, 0x90, ++0x9A, 0xD4, 0x12, 0x9F, 0xF9, 0x7B, 0x01, 0xE4, ++0xFD, 0x12, 0xF3, 0x9C, 0x90, 0x9A, 0xD6, 0xE0, ++0xFF, 0x90, 0x9A, 0xD5, 0xE0, 0x2F, 0xFF, 0x90, ++0x9A, 0xD4, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x30, ++0xCF, 0x34, 0x00, 0xFE, 0x90, 0x9A, 0xD7, 0xF0, ++0xA3, 0xEF, 0xF0, 0xB1, 0xD4, 0xD1, 0x89, 0x90, ++0x98, 0x12, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0xB4, ++0xD7, 0xD1, 0x89, 0x90, 0x98, 0x0E, 0xE0, 0xFB, ++0x7F, 0x11, 0x12, 0xB4, 0xD7, 0x90, 0x04, 0x1F, ++0x74, 0x20, 0xF0, 0x90, 0x95, 0x75, 0xB1, 0xCD, ++0x22, 0x90, 0x9A, 0xD7, 0xE0, 0xFC, 0xA3, 0xE0, ++0xFD, 0x22, 0xE4, 0x90, 0x9C, 0xA5, 0xF0, 0xA3, ++0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x22, ++0xC3, 0x90, 0x9C, 0xA6, 0xE0, 0x94, 0xD0, 0x90, ++0x9C, 0xA5, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, ++0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, ++0x22, 0x90, 0x9C, 0xA5, 0xB1, 0xCD, 0xF1, 0x54, ++0x80, 0xD7, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x9C, ++0x90, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, ++0x90, 0x9C, 0x92, 0xF0, 0x7B, 0x47, 0x7D, 0xFF, ++0xE4, 0xFF, 0x12, 0x98, 0x60, 0x90, 0x05, 0xF8, ++0xE0, 0x70, 0x1B, 0xA3, 0xE0, 0x70, 0x17, 0xA3, ++0xE0, 0x70, 0x13, 0xA3, 0xE0, 0x70, 0x0F, 0x90, ++0x9C, 0x92, 0xE0, 0xFD, 0x7B, 0x48, 0xE4, 0xFF, ++0x12, 0x98, 0x60, 0x7F, 0x01, 0x22, 0x12, 0xC4, ++0x6A, 0x30, 0xE0, 0x1A, 0xD3, 0x90, 0x9C, 0x91, ++0xE0, 0x94, 0x03, 0x90, 0x9C, 0x90, 0xE0, 0x94, ++0x00, 0x40, 0x07, 0xF1, 0x48, 0xFD, 0x7B, 0x5A, ++0x80, 0x18, 0x7F, 0x01, 0x80, 0x1E, 0xD3, 0x90, ++0x9C, 0x91, 0xE0, 0x94, 0xE8, 0x90, 0x9C, 0x90, ++0xE0, 0x94, 0x03, 0x40, 0x0D, 0xF1, 0x48, 0xFD, ++0x7B, 0x5B, 0xE4, 0xFF, 0x12, 0x98, 0x60, 0x7F, ++0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x7C, ++0x6A, 0x90, 0x9C, 0x90, 0xB1, 0xCD, 0x80, 0x95, ++0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x90, ++0x9C, 0x92, 0xE0, 0x22, 0x7F, 0x0A, 0x7E, 0x00, ++0x02, 0x7C, 0x6A, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0x22, 0xE4, 0x90, 0x99, 0x88, 0xF0, ++0xA3, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x08, 0x7D, ++0x00, 0x7B, 0x01, 0x22, 0x90, 0x01, 0xE4, 0x74, ++0x1D, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x22, 0x90, ++0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, ++0x7F, 0x01, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, ++0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, ++0x90, 0x98, 0x18, 0xE0, 0x54, 0xFE, 0xF0, 0x54, ++0x7F, 0xF0, 0x54, 0xFB, 0xF0, 0xA3, 0x74, 0x0A, ++0x02, 0xCF, 0x6A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0xE4, 0xFF, 0xEF, 0x12, 0xB4, 0xBE, ++0xE4, 0xF0, 0x0F, 0xEF, 0xB4, 0x08, 0xF5, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0x9A, 0xE0, ++0x54, 0xC0, 0x44, 0x0B, 0xF0, 0xF1, 0x54, 0x90, ++0x01, 0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, ++0x40, 0x02, 0x7F, 0x01, 0x22, 0x75, 0x29, 0x10, ++0xE4, 0xF5, 0x2A, 0x75, 0x2B, 0x07, 0x75, 0x2C, ++0x02, 0xF5, 0x31, 0xF5, 0x32, 0xF5, 0x33, 0xF5, ++0x34, 0x90, 0x01, 0x30, 0xE5, 0x29, 0xF0, 0xA3, ++0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, 0xF0, 0xA3, ++0xE5, 0x2C, 0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, ++0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, ++0xF0, 0xA3, 0xE5, 0x34, 0xF0, 0x22, 0x75, 0x39, ++0x07, 0x43, 0x39, 0x10, 0x75, 0x3A, 0x01, 0x75, ++0x3B, 0x03, 0x75, 0x3C, 0x62, 0x43, 0x3C, 0x80, ++0x43, 0x3B, 0x04, 0x90, 0x01, 0x38, 0xE5, 0x39, ++0xF0, 0xA3, 0xE5, 0x3A, 0xF0, 0xA3, 0xE5, 0x3B, ++0xF0, 0xA3, 0xE5, 0x3C, 0xF0, 0x22, 0x90, 0x8A, ++0x79, 0x74, 0x89, 0xF0, 0xA3, 0x74, 0x86, 0xF0, ++0x90, 0x8A, 0xE5, 0x74, 0xD9, 0xF0, 0xA3, 0x74, ++0x1B, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0x89, 0xF0, ++0xA3, 0x74, 0xD9, 0xF0, 0x90, 0x8A, 0xB9, 0x74, ++0x8C, 0xF0, 0xA3, 0x74, 0x1E, 0xF0, 0x90, 0x8A, ++0xC3, 0x74, 0xED, 0xF0, 0xA3, 0x74, 0x92, 0xF0, ++0x90, 0x8A, 0xF3, 0x74, 0xEE, 0xF0, 0xA3, 0x74, ++0xB6, 0xF0, 0x90, 0x8A, 0x85, 0x74, 0xDE, 0xF0, ++0xA3, 0x74, 0x52, 0xF0, 0x90, 0x86, 0x04, 0x74, ++0xEF, 0xF0, 0xA3, 0x74, 0x9F, 0xF0, 0x90, 0x8A, ++0xA9, 0x74, 0xEE, 0xF0, 0xA3, 0x74, 0xC2, 0xF0, ++0x90, 0x8B, 0x07, 0x74, 0xEE, 0xF0, 0xA3, 0x74, ++0xF4, 0xF0, 0x90, 0x8A, 0xAD, 0x74, 0xB2, 0xF0, ++0xA3, 0x74, 0x16, 0xF0, 0x90, 0x86, 0x0C, 0x74, ++0xAC, 0xF0, 0xA3, 0x74, 0xCF, 0xF0, 0x90, 0x8A, ++0xEF, 0x74, 0xAC, 0xF0, 0xA3, 0x74, 0x71, 0xF0, ++0x90, 0x86, 0x00, 0x74, 0xD3, 0xF0, 0xA3, 0x74, ++0x21, 0xF0, 0x90, 0x86, 0x02, 0x74, 0xD3, 0xF0, ++0xA3, 0x74, 0x7F, 0xF0, 0x90, 0x8A, 0xFD, 0x74, ++0xD6, 0xF0, 0xA3, 0x74, 0xC5, 0xF0, 0x90, 0x8A, ++0xF9, 0x74, 0xD0, 0xF0, 0xA3, 0x74, 0x16, 0xF0, ++0x90, 0x8A, 0xAF, 0x74, 0xC4, 0xF0, 0xA3, 0x74, ++0x74, 0xF0, 0x90, 0x8A, 0xD3, 0x74, 0xED, 0xF0, ++0xA3, 0x74, 0xD2, 0xF0, 0x90, 0x8A, 0xF5, 0x74, ++0xFB, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x90, 0x8A, ++0xA3, 0x74, 0xE3, 0xF0, 0xA3, 0x74, 0x81, 0xF0, ++0x90, 0x86, 0x06, 0x74, 0xE5, 0xF0, 0xA3, 0x74, ++0x7B, 0xF0, 0x22, 0x8F, 0x14, 0x7F, 0x02, 0x12, ++0x88, 0x67, 0x90, 0x86, 0xAF, 0xE0, 0x45, 0x14, ++0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, ++0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, ++0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, ++0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0x01, 0xC4, 0x74, 0x2A, 0xF0, 0x74, 0xD9, 0xA3, ++0xF0, 0x12, 0x6C, 0xD6, 0xE5, 0x25, 0x30, 0xE7, ++0x02, 0x31, 0xD0, 0x90, 0x86, 0xB3, 0xE0, 0xFC, ++0x64, 0x03, 0x70, 0x37, 0x90, 0x99, 0x7B, 0xE0, ++0xFE, 0x20, 0xE0, 0x2F, 0xE5, 0x26, 0x30, 0xE3, ++0x2A, 0x90, 0x00, 0xCC, 0xE0, 0x44, 0x04, 0xF0, ++0x90, 0x00, 0xD4, 0xE0, 0x44, 0x10, 0xF0, 0x90, ++0x00, 0xC6, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x00, ++0x01, 0xE0, 0x54, 0xCF, 0xF0, 0x90, 0x00, 0x23, ++0xE0, 0x54, 0x7F, 0xF0, 0xEE, 0x44, 0x01, 0x90, ++0x99, 0x7B, 0xF0, 0xEC, 0xB4, 0x01, 0x0B, 0xE5, ++0x26, 0x30, 0xE2, 0x06, 0x90, 0x88, 0x41, 0x74, ++0xDD, 0xF0, 0x74, 0x2A, 0x04, 0x90, 0x01, 0xC4, ++0xF0, 0x74, 0xD9, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, ++0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, ++0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, ++0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, ++0x90, 0x00, 0xAB, 0xE0, 0xFE, 0x90, 0x00, 0xAA, ++0x12, 0xBA, 0x6E, 0x54, 0x7F, 0x90, 0x9A, 0xD2, ++0xF0, 0xA3, 0xEF, 0xF0, 0xE0, 0x30, 0xE1, 0x02, ++0x31, 0xEB, 0x22, 0x90, 0x01, 0x8C, 0xE4, 0xF0, ++0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, 0xA3, 0x74, ++0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, 0x54, 0xF0, ++0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, 0xE0, 0x44, ++0x04, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, ++0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, ++0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, ++0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, ++0x90, 0x01, 0xC4, 0x74, 0x0B, 0xF0, 0x74, 0xDA, ++0xA3, 0xF0, 0x12, 0x64, 0x7F, 0xE5, 0x30, 0x30, ++0xE1, 0x02, 0x71, 0x4E, 0xE5, 0x2D, 0x30, 0xE3, ++0x02, 0xF1, 0xA6, 0xE5, 0x2D, 0x30, 0xE4, 0x02, ++0xF1, 0x83, 0xE5, 0x2D, 0x30, 0xE5, 0x03, 0x12, ++0xE8, 0x19, 0xE5, 0x2F, 0x30, 0xE0, 0x02, 0x51, ++0xAA, 0xE5, 0x2F, 0x30, 0xE1, 0x03, 0x12, 0xC3, ++0x19, 0xE5, 0x2F, 0x30, 0xE2, 0x02, 0xF1, 0x94, ++0xE5, 0x2F, 0x30, 0xE3, 0x02, 0x51, 0xBB, 0xE5, ++0x2F, 0x30, 0xE4, 0x02, 0x71, 0x18, 0xE5, 0x2F, ++0x30, 0xE5, 0x02, 0x51, 0xD3, 0xE5, 0x2F, 0x30, ++0xE6, 0x02, 0xF1, 0xB9, 0x74, 0x0B, 0x04, 0x90, ++0x01, 0xC4, 0xF0, 0x74, 0xDA, 0xA3, 0xF0, 0xD0, ++0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, ++0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, ++0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, ++0xE0, 0x32, 0x12, 0xC6, 0x1B, 0xE4, 0xFF, 0x12, ++0xE3, 0xD8, 0x90, 0x8B, 0x07, 0x51, 0xF8, 0xF9, ++0x02, 0x04, 0x7A, 0x12, 0xC7, 0x81, 0x70, 0x12, ++0x90, 0x88, 0x36, 0xE0, 0x60, 0x0C, 0x90, 0x88, ++0x3A, 0xE0, 0x20, 0xE4, 0x05, 0x71, 0x3B, 0x12, ++0xC6, 0xAD, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, ++0xBF, 0x01, 0x19, 0x90, 0x88, 0x36, 0xE0, 0x60, ++0x13, 0x12, 0x97, 0xE6, 0x64, 0x02, 0x60, 0x09, ++0x90, 0x8A, 0xE1, 0x51, 0xF8, 0xF9, 0x02, 0x04, ++0x7A, 0x12, 0x73, 0x8F, 0x22, 0x90, 0x8B, 0x01, ++0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0x22, 0x90, ++0x88, 0x36, 0xE0, 0x60, 0x12, 0x90, 0x06, 0x92, ++0xE0, 0x30, 0xE1, 0x06, 0x51, 0xF5, 0xF9, 0x02, ++0x04, 0x7A, 0x71, 0x46, 0x12, 0xAE, 0xEB, 0x22, ++0x12, 0xC7, 0x81, 0x70, 0x1D, 0x90, 0x88, 0x36, ++0xE0, 0x60, 0x17, 0x90, 0x88, 0x3A, 0xE0, 0x20, ++0xE4, 0x10, 0x71, 0x3B, 0xF0, 0x90, 0x88, 0x31, ++0xE0, 0x71, 0x58, 0x54, 0x07, 0x70, 0x03, 0x12, ++0xAE, 0xEB, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, ++0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0x90, 0x88, ++0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x90, 0x88, ++0x36, 0xE0, 0x60, 0x03, 0x12, 0x97, 0x4D, 0x22, ++0x54, 0xFB, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, ++0xFD, 0xF0, 0x22, 0x71, 0xD8, 0x30, 0xE0, 0x0B, ++0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, ++0x02, 0xF1, 0x4B, 0x90, 0x88, 0x31, 0x12, 0xCF, ++0xC1, 0x30, 0xE0, 0x09, 0xEF, 0x71, 0x58, 0x54, ++0x07, 0x70, 0x4C, 0x80, 0x47, 0x90, 0x88, 0x3F, ++0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, ++0xEF, 0xF0, 0xF1, 0x77, 0x40, 0x36, 0x12, 0xC7, ++0x81, 0x70, 0x34, 0x12, 0x97, 0xE6, 0x70, 0x08, ++0x90, 0x8A, 0xF5, 0x12, 0x8C, 0x14, 0x80, 0x28, ++0x90, 0x8A, 0xF5, 0x12, 0x8C, 0x14, 0x90, 0x88, ++0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, ++0x40, 0x09, 0x71, 0xD0, 0xE4, 0x90, 0x88, 0x40, ++0xF0, 0x80, 0x03, 0x12, 0x73, 0x8F, 0xE4, 0x90, ++0x88, 0x3F, 0xF0, 0x22, 0x12, 0xAE, 0xEB, 0x22, ++0x90, 0x88, 0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x22, ++0x90, 0x88, 0x32, 0xE0, 0xFF, 0x13, 0x13, 0x13, ++0x54, 0x1F, 0x22, 0x12, 0xC7, 0x92, 0xA3, 0xED, ++0xF0, 0x78, 0x0E, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, ++0xFF, 0x7A, 0x80, 0x79, 0x94, 0xF1, 0x44, 0xF1, ++0x5B, 0x7A, 0x80, 0x79, 0x9A, 0xB1, 0xC6, 0x78, ++0x24, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, ++0x80, 0x79, 0xAA, 0xB1, 0xC6, 0xE4, 0x90, 0x9A, ++0x37, 0x12, 0xC5, 0x82, 0xA3, 0xE0, 0xFD, 0x12, ++0xF6, 0x34, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xA1, ++0xAE, 0x12, 0xA7, 0xE5, 0xFF, 0x12, 0xA7, 0x18, ++0xCF, 0x24, 0x0E, 0xCF, 0x34, 0x00, 0x12, 0xA3, ++0x3F, 0xEF, 0x64, 0x3A, 0x60, 0x02, 0xA1, 0xAE, ++0x12, 0xA7, 0xE5, 0xFF, 0x12, 0xA7, 0x18, 0xCF, ++0x24, 0x30, 0xCF, 0x34, 0x00, 0x12, 0xA3, 0x3F, ++0xEF, 0x64, 0x87, 0x60, 0x02, 0xA1, 0xAE, 0x90, ++0x9A, 0x37, 0x04, 0xF0, 0xE4, 0x90, 0x9A, 0x34, ++0xF0, 0xB1, 0xB4, 0x94, 0x10, 0x50, 0x18, 0x12, ++0xA7, 0x0D, 0xCD, 0x24, 0x38, 0x12, 0xA3, 0x34, ++0x90, 0x9A, 0x34, 0xE0, 0x24, 0x24, 0xF5, 0x82, ++0xE4, 0x34, 0x9A, 0xB1, 0xBB, 0x80, 0xE2, 0xE4, ++0x90, 0x9A, 0x35, 0xF0, 0x90, 0x9A, 0x35, 0xE0, ++0xFF, 0xC3, 0x94, 0x02, 0x40, 0x02, 0xA1, 0xAE, ++0x75, 0xF0, 0x38, 0xEF, 0xB1, 0xCD, 0x20, 0xE0, ++0x02, 0xA1, 0xAE, 0xE4, 0x90, 0x9A, 0x36, 0xF0, ++0xB1, 0xD5, 0x90, 0x93, 0x5E, 0x12, 0x04, 0x6E, ++0xE0, 0xFE, 0x90, 0x9A, 0x36, 0xE0, 0xC3, 0x9E, ++0x40, 0x02, 0xA1, 0xA6, 0xEF, 0x75, 0xF0, 0x38, ++0xA4, 0x24, 0x75, 0xF9, 0x74, 0x93, 0x35, 0xF0, ++0xFA, 0x7B, 0x01, 0xE0, 0x75, 0xF0, 0x10, 0xA4, ++0x29, 0xF9, 0xEA, 0x35, 0xF0, 0xFA, 0x78, 0x24, ++0x7C, 0x9A, 0xB1, 0xDE, 0x60, 0x02, 0xA1, 0x97, ++0x90, 0x06, 0x33, 0xE0, 0x44, 0x01, 0x54, 0xFB, ++0xF0, 0xE4, 0x90, 0x9A, 0x34, 0xF0, 0xB1, 0xB4, ++0x94, 0x06, 0x50, 0x12, 0x12, 0xA7, 0x0D, 0xCD, ++0x24, 0x4A, 0x12, 0xA3, 0x34, 0x90, 0x9A, 0x34, ++0xF1, 0x52, 0xB1, 0xBB, 0x80, 0xE8, 0xE4, 0x90, ++0x9A, 0x34, 0xF0, 0xB1, 0xB4, 0x94, 0x10, 0x50, ++0x0D, 0x12, 0xA3, 0x20, 0x90, 0x9A, 0x34, 0x12, ++0xCF, 0x88, 0xB1, 0xBB, 0x80, 0xED, 0xB1, 0xD5, ++0xB1, 0xCD, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x2A, ++0xEF, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x65, 0xF9, ++0x74, 0x93, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x78, ++0x14, 0x7C, 0x9A, 0xB1, 0xDE, 0x70, 0x6F, 0x90, ++0x98, 0x05, 0xE0, 0xB4, 0x02, 0x0A, 0x90, 0x93, ++0x25, 0x71, 0xDB, 0x20, 0xE0, 0x1D, 0x80, 0x11, ++0x80, 0x19, 0x90, 0x98, 0x05, 0xE0, 0xB4, 0x02, ++0x12, 0x90, 0x93, 0x25, 0x71, 0xDB, 0x20, 0xE0, ++0x0A, 0x90, 0x01, 0xC7, 0x74, 0x0A, 0x12, 0xC7, ++0x78, 0x80, 0x53, 0x7B, 0x01, 0x7A, 0x9A, 0x79, ++0x0E, 0x90, 0x9A, 0x3B, 0x12, 0x84, 0x67, 0x7A, ++0x9A, 0x79, 0x24, 0x90, 0x9A, 0x3E, 0x12, 0x84, ++0x67, 0x90, 0x9A, 0x35, 0xE0, 0x75, 0xF0, 0x38, ++0xA4, 0x24, 0x5F, 0xF9, 0x74, 0x93, 0x35, 0xF0, ++0xFA, 0x90, 0x9A, 0x41, 0x12, 0x84, 0x67, 0xE4, ++0x90, 0x9A, 0x44, 0xF0, 0xA3, 0xF0, 0x7A, 0x9A, ++0x79, 0x14, 0x12, 0x98, 0x83, 0x80, 0x07, 0x90, ++0x06, 0x33, 0xE0, 0x44, 0x05, 0xF0, 0x90, 0x9A, ++0x36, 0xE0, 0x04, 0xF0, 0x81, 0x98, 0x90, 0x9A, ++0x35, 0xE0, 0x04, 0xF0, 0x81, 0x7C, 0x90, 0x9A, ++0x37, 0xE0, 0xFF, 0x22, 0x90, 0x9A, 0x34, 0xE0, ++0xFF, 0xC3, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, ++0x9A, 0x34, 0xE0, 0x04, 0xF0, 0x22, 0x7E, 0x00, ++0x7F, 0x10, 0x02, 0x01, 0xE0, 0x90, 0x93, 0x5D, ++0x12, 0x04, 0x6E, 0xE0, 0x22, 0x90, 0x9A, 0x35, ++0xE0, 0xFF, 0x75, 0xF0, 0x38, 0x22, 0x7D, 0x01, ++0x7E, 0x00, 0x7F, 0x10, 0x12, 0x86, 0x1C, 0xEF, ++0x22, 0x90, 0x93, 0x04, 0x71, 0xDB, 0x30, 0xE0, ++0x34, 0xEF, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x28, ++0x90, 0x95, 0xC1, 0xD1, 0x4A, 0x60, 0x0B, 0xF1, ++0x6D, 0x40, 0x07, 0xD1, 0x34, 0x90, 0x95, 0xC5, ++0x80, 0x05, 0xD1, 0x34, 0x90, 0x95, 0xBD, 0x12, ++0x84, 0x52, 0x12, 0x83, 0x1B, 0x90, 0x9C, 0x55, ++0x12, 0x04, 0x31, 0x12, 0xB3, 0xA7, 0x80, 0x05, ++0x7F, 0x01, 0x12, 0xA0, 0x66, 0x90, 0x93, 0x04, ++0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x05, 0x7F, 0x01, ++0x12, 0xA0, 0x66, 0x22, 0xE4, 0x7F, 0xE8, 0x7E, ++0x03, 0xFD, 0xFC, 0x22, 0xFF, 0xE4, 0xFE, 0xFD, ++0xFC, 0x90, 0x9C, 0x67, 0x12, 0x04, 0x31, 0x90, ++0x9C, 0x67, 0x12, 0x04, 0xB8, 0xEC, 0x4D, 0x4E, ++0x4F, 0x22, 0x90, 0x9C, 0x66, 0xEF, 0xF0, 0x90, ++0x88, 0xE0, 0xE0, 0x70, 0x51, 0x7F, 0x48, 0x7E, ++0x09, 0x12, 0x70, 0x70, 0xEE, 0x54, 0x0F, 0xFE, ++0xE4, 0xFD, 0xFC, 0x90, 0x9C, 0x67, 0x12, 0x04, ++0x31, 0xE4, 0x7F, 0x80, 0xF1, 0x2F, 0x70, 0x05, ++0x90, 0x88, 0xBE, 0x80, 0x1B, 0xE4, 0xFF, 0xFE, ++0xF1, 0x31, 0x70, 0x0A, 0x90, 0x88, 0xBE, 0x04, ++0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x56, 0xE4, 0xFF, ++0xF1, 0x2F, 0x70, 0x09, 0x90, 0x88, 0xBE, 0x04, ++0xF0, 0xA3, 0xF0, 0x80, 0x47, 0xE4, 0x7F, 0x80, ++0xFE, 0xF1, 0x31, 0x70, 0x3F, 0x90, 0x88, 0xBE, ++0xF0, 0xA3, 0x04, 0xF0, 0x80, 0x36, 0x7F, 0x2C, ++0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x02, ++0xD1, 0x3C, 0x60, 0x08, 0x90, 0x88, 0xBE, 0x74, ++0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xBE, ++0xF0, 0x7F, 0x30, 0x7E, 0x09, 0x12, 0x70, 0x70, ++0xEF, 0x54, 0x01, 0xD1, 0x3C, 0x60, 0x07, 0xE4, ++0x90, 0x88, 0xBF, 0xF0, 0x80, 0x06, 0x90, 0x88, ++0xBF, 0x74, 0x01, 0xF0, 0x90, 0x88, 0xB8, 0xE0, ++0x44, 0x01, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x91, ++0x62, 0x7D, 0x11, 0x7F, 0xFF, 0x12, 0x04, 0x7E, ++0x90, 0x8A, 0xEF, 0x12, 0x8C, 0x14, 0x90, 0x07, ++0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x9C, ++0x66, 0xE0, 0xFD, 0x70, 0x02, 0x80, 0x1C, 0xED, ++0xB4, 0x01, 0x06, 0xF1, 0x3D, 0x44, 0x20, 0xF0, ++0x22, 0x90, 0x9C, 0x66, 0xE0, 0xFD, 0xB4, 0x02, ++0x06, 0xF1, 0x3D, 0x44, 0x60, 0xF0, 0x22, 0xED, ++0xB4, 0x03, 0x03, 0xF1, 0x3D, 0xF0, 0x22, 0x7E, ++0x02, 0xFD, 0xFC, 0x90, 0x9C, 0x67, 0x12, 0x84, ++0x52, 0xC3, 0x02, 0x03, 0xDA, 0x90, 0x88, 0xB8, ++0xE0, 0x54, 0x1F, 0x22, 0x7E, 0x00, 0x7F, 0x06, ++0x02, 0x01, 0xE0, 0x7D, 0x02, 0x7F, 0x02, 0x02, ++0x7C, 0x7E, 0xE0, 0x24, 0x0E, 0xF5, 0x82, 0xE4, ++0x34, 0x9A, 0x22, 0x78, 0x14, 0x7C, 0x9A, 0x7D, ++0x01, 0x7B, 0xFF, 0x22, 0x90, 0x88, 0x36, 0xE0, ++0x60, 0x02, 0x71, 0x63, 0x22, 0x90, 0x98, 0x01, ++0x12, 0x84, 0x52, 0xD3, 0x02, 0x03, 0xDA, 0x90, ++0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, 0x3F, 0xE0, ++0xD3, 0x9F, 0x22, 0x90, 0x8A, 0x75, 0x12, 0x8C, ++0x14, 0x90, 0x8A, 0xE5, 0x12, 0x91, 0x62, 0x7F, ++0x02, 0x02, 0x04, 0x7E, 0x90, 0x98, 0x22, 0xE0, ++0x04, 0xF0, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, ++0x60, 0x03, 0x12, 0xAD, 0x12, 0x22, 0x90, 0x93, ++0x24, 0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x8A, 0xE5, ++0x12, 0x91, 0x62, 0x7F, 0x10, 0x12, 0x04, 0x7E, ++0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, ++0x10, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0A, 0x12, ++0xAE, 0xC1, 0x54, 0x07, 0x70, 0x03, 0x12, 0xAE, ++0xEB, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, ++0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, ++0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, ++0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0x01, 0xC4, 0x74, 0xD2, 0xF0, 0x74, 0xDF, 0xA3, ++0xF0, 0x12, 0x75, 0x50, 0xE5, 0x3D, 0x30, 0xE0, ++0x02, 0x31, 0x30, 0xE5, 0x3D, 0x30, 0xE1, 0x03, ++0x12, 0xDF, 0x64, 0xE5, 0x3D, 0x30, 0xE2, 0x03, ++0x12, 0xDA, 0xFF, 0xE5, 0x3D, 0x30, 0xE4, 0x02, ++0x31, 0x1A, 0xE5, 0x3E, 0x30, 0xE0, 0x02, 0x11, ++0xD1, 0xE5, 0x3F, 0x30, 0xE2, 0x09, 0x91, 0x15, ++0x90, 0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, ++0x40, 0x30, 0xE1, 0x0B, 0x90, 0x8A, 0xE5, 0x12, ++0x91, 0x62, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, ++0x40, 0x30, 0xE4, 0x02, 0x11, 0x82, 0xE5, 0x40, ++0x30, 0xE5, 0x03, 0x12, 0xCE, 0x80, 0xE5, 0x40, ++0x30, 0xE6, 0x02, 0x91, 0x9C, 0xE5, 0x40, 0x30, ++0xE7, 0x02, 0x71, 0xB8, 0x74, 0xD2, 0x04, 0x90, ++0x01, 0xC4, 0xF0, 0x74, 0xDF, 0xA3, 0xF0, 0xD0, ++0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, ++0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, ++0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, ++0xE0, 0x32, 0x12, 0xC6, 0xC5, 0x12, 0xA7, 0xF0, ++0x7F, 0x01, 0x71, 0xD8, 0x90, 0x8B, 0x07, 0x12, ++0x8C, 0x14, 0x90, 0x93, 0x08, 0xE0, 0x30, 0xE0, ++0x37, 0x31, 0x1D, 0x90, 0x93, 0x0B, 0xE0, 0x60, ++0x0B, 0x14, 0xF0, 0x90, 0x9B, 0x63, 0xE0, 0x70, ++0x27, 0x02, 0x79, 0xD4, 0x31, 0x26, 0xE4, 0xFF, ++0x12, 0xA0, 0x66, 0x90, 0x93, 0x04, 0xE0, 0xFF, ++0x20, 0xE0, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, ++0x30, 0xE0, 0x0D, 0x90, 0x9C, 0x55, 0x12, 0x04, ++0x3D, 0x00, 0x00, 0x00, 0x01, 0x12, 0xB3, 0xA7, ++0x22, 0x91, 0x57, 0x90, 0x9A, 0xDC, 0xEF, 0xF0, ++0x90, 0x8A, 0x89, 0x30, 0xE0, 0x13, 0x12, 0x91, ++0x62, 0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, ++0x90, 0x88, 0x33, 0xE0, 0x44, 0x04, 0xF0, 0x80, ++0x09, 0x12, 0x91, 0x62, 0xE4, 0xFD, 0xFF, 0x12, ++0x04, 0x7E, 0x90, 0x9A, 0xDC, 0xE0, 0x30, 0xE6, ++0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, ++0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, ++0x80, 0xF0, 0x31, 0x3B, 0x74, 0x02, 0xF0, 0x02, ++0x6E, 0x2F, 0x02, 0x34, 0x78, 0x90, 0x93, 0x0A, ++0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x90, 0x93, ++0x09, 0xE0, 0x14, 0x90, 0x93, 0x0B, 0xF0, 0x22, ++0x90, 0x8A, 0xE5, 0x12, 0x91, 0x62, 0x7F, 0x80, ++0x02, 0x04, 0x7E, 0x90, 0x88, 0x48, 0xE0, 0xFF, ++0xA3, 0xE0, 0xFD, 0x90, 0x88, 0x4F, 0xE0, 0xFB, ++0x90, 0x92, 0x98, 0x22, 0x90, 0x88, 0x85, 0x12, ++0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x99, ++0x7A, 0xE0, 0x24, 0x46, 0xFF, 0x90, 0x99, 0x79, ++0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, 0xF9, ++0xF8, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x83, 0x0D, ++0x90, 0x88, 0x85, 0x71, 0x54, 0xEF, 0x24, 0x46, ++0x71, 0xAD, 0x90, 0x88, 0x89, 0x71, 0x54, 0x90, ++0x88, 0x85, 0x12, 0xDF, 0x36, 0x50, 0x02, 0x41, ++0x3C, 0x90, 0x88, 0x89, 0x12, 0x84, 0x52, 0x90, ++0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, 0x83, 0x0D, ++0x90, 0x9A, 0xD8, 0x12, 0x04, 0x31, 0x90, 0x88, ++0x31, 0xE0, 0x30, 0xE0, 0x2C, 0x12, 0x94, 0xCD, ++0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x03, 0xC3, ++0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x50, ++0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, 0x4E, 0xE0, ++0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, 0x00, ++0xFA, 0x71, 0x5D, 0xEB, 0x2F, 0xFF, 0xEA, 0x80, ++0x1E, 0x90, 0x88, 0x33, 0x12, 0xCF, 0xC1, 0x30, ++0xE0, 0x02, 0x61, 0x39, 0x71, 0x5D, 0x90, 0x88, ++0x4E, 0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, 0xCD, ++0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, 0xED, 0x3E, ++0x90, 0x9A, 0xD4, 0xF0, 0xA3, 0xEF, 0xF0, 0xC3, ++0x90, 0x9A, 0xD5, 0xE0, 0x94, 0xA0, 0x90, 0x9A, ++0xD4, 0xE0, 0x94, 0x00, 0x50, 0x36, 0xA3, 0xE0, ++0xFB, 0x24, 0x39, 0x71, 0x4C, 0xE0, 0x04, 0xF0, ++0x90, 0x9A, 0xD8, 0x12, 0x04, 0xB8, 0xEF, 0x54, ++0x7F, 0xFF, 0x74, 0xD9, 0x2B, 0x71, 0x41, 0xE0, ++0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, 0x9A, ++0xD4, 0xA3, 0xE0, 0x71, 0x3F, 0xEF, 0xF0, 0x90, ++0x88, 0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, 0x7F, ++0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, 0xE0, ++0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, ++0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x61, ++0x39, 0xE4, 0xFF, 0xFE, 0x71, 0x49, 0xE0, 0x2F, ++0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, ++0x9D, 0x40, 0x07, 0x90, 0x9A, 0xD6, 0xEE, 0xF0, ++0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE5, 0x71, ++0x68, 0x40, 0x02, 0x80, 0x15, 0x90, 0x9A, 0xD6, ++0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, 0x50, ++0x13, 0x71, 0x49, 0xE0, 0x2F, 0xFF, 0x71, 0x68, ++0x40, 0x07, 0x90, 0x9A, 0xD7, 0xEE, 0xF0, 0x80, ++0x03, 0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, 0xE0, ++0xFF, 0x71, 0x3A, 0xE0, 0xFD, 0xEF, 0xC3, 0x9D, ++0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, 0xF0, ++0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x9A, 0xD7, ++0xE0, 0x80, 0x18, 0x71, 0x3A, 0xE0, 0xFD, 0xC3, ++0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, 0xF0, ++0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, 0x9A, ++0xD7, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, 0x90, ++0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, ++0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, 0xF0, ++0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, 0xF0, ++0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, 0x50, ++0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, 0x51, ++0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, ++0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, 0x88, ++0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, 0x4F, ++0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, ++0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, 0x90, ++0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0x31, 0x3B, ++0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, 0x8A, ++0xA3, 0x12, 0x91, 0x62, 0xE4, 0xFF, 0x12, 0x04, ++0x7E, 0x22, 0x90, 0x9A, 0xD6, 0xE0, 0xFE, 0x24, ++0xD9, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, ++0x22, 0x74, 0x39, 0x2E, 0xF5, 0x82, 0xE4, 0x34, ++0x98, 0xF5, 0x83, 0x22, 0x12, 0x04, 0x31, 0x90, ++0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, 0x9A, 0xD8, ++0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, 0x03, 0xEB, ++0x90, 0x88, 0x91, 0xE0, 0xFD, 0xC3, 0x90, 0x88, ++0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, ++0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, ++0x22, 0xE4, 0xFE, 0x71, 0x49, 0xE4, 0xF0, 0x74, ++0xD9, 0x2E, 0x71, 0x41, 0x74, 0xFF, 0xF0, 0x0E, ++0xEE, 0xB4, 0xA0, 0xEF, 0xE4, 0x90, 0x88, 0x4D, ++0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, 0x88, 0x50, ++0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0xA0, ++0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xFF, 0xE4, 0x3E, ++0xFE, 0xE4, 0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, ++0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, ++0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, 0x12, ++0x8C, 0x14, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, ++0x06, 0x90, 0x8A, 0xE7, 0x12, 0x8C, 0x14, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0x88, 0x33, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x28, ++0x90, 0x9B, 0xB4, 0x74, 0x1E, 0xF0, 0x90, 0x9B, ++0xD6, 0x74, 0x01, 0xF0, 0x90, 0x9B, 0xB6, 0xEF, ++0xF0, 0x7B, 0x01, 0x7A, 0x9B, 0x79, 0xB4, 0x12, ++0xC1, 0xB8, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xE5, ++0x12, 0x91, 0x62, 0x7F, 0x04, 0x12, 0x04, 0x7E, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, ++0x30, 0xE0, 0x2F, 0x90, 0x88, 0xF7, 0xE0, 0xB4, ++0x01, 0x18, 0xA3, 0xE0, 0xB4, 0x01, 0x23, 0x74, ++0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, 0xFE, 0xA3, ++0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, 0xC6, 0xA1, ++0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, 0xB4, 0x02, ++0x09, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE7, 0x12, ++0x8C, 0x14, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, ++0x90, 0x9A, 0xDE, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, ++0x12, 0x7B, 0x41, 0x90, 0x9A, 0xDD, 0xEF, 0xF0, ++0x7F, 0x83, 0x12, 0x7B, 0x41, 0xAE, 0x07, 0x90, ++0x9A, 0xDD, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, ++0xC3, 0x90, 0x9A, 0xDF, 0xE0, 0x94, 0x64, 0x90, ++0x9A, 0xDE, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, ++0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x9A, ++0xDD, 0xE0, 0xFF, 0x22, 0x90, 0x9A, 0xDE, 0x12, ++0xD5, 0xCD, 0x80, 0xC2, 0x90, 0x88, 0x31, 0xE0, ++0xFF, 0x12, 0xBF, 0xE4, 0x30, 0xE0, 0x20, 0xEF, ++0x54, 0x7F, 0x12, 0xCF, 0xB5, 0x30, 0xE1, 0x06, ++0xE0, 0x44, 0x02, 0xF0, 0x80, 0x08, 0xE0, 0x54, ++0xFD, 0x12, 0xCF, 0xD2, 0x04, 0xF0, 0x90, 0x88, ++0x36, 0xE0, 0x60, 0x03, 0x12, 0xAE, 0xEB, 0x12, ++0xC4, 0x6A, 0x30, 0xE0, 0x22, 0x90, 0x88, 0xA4, ++0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x18, 0xEF, ++0x54, 0xFD, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, ++0x88, 0xA4, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x04, ++0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFB, 0xF0, 0x7F, ++0x01, 0x02, 0xC8, 0x40, 0xC0, 0xE0, 0xC0, 0xF0, ++0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, ++0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, ++0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, ++0x07, 0x90, 0x01, 0xC4, 0x74, 0xF4, 0xF0, 0x74, ++0xE4, 0xA3, 0xF0, 0x90, 0x8A, 0x9D, 0x12, 0x8C, ++0x14, 0x53, 0x91, 0xBF, 0x74, 0xF4, 0x04, 0x90, ++0x01, 0xC4, 0xF0, 0x74, 0xE4, 0xA3, 0xF0, 0xD0, ++0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, ++0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, ++0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, ++0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, ++0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, ++0x07, 0x7D, 0x4A, 0x90, 0x01, 0xC4, 0xED, 0xF0, ++0x74, 0xE5, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, ++0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, ++0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, ++0xD0, 0xE0, 0x32, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0x9C, 0x75, 0xED, 0xF0, 0xA3, ++0xEB, 0xF0, 0x90, 0x9C, 0x74, 0xEF, 0xF0, 0xE4, ++0xFD, 0xFC, 0x12, 0xED, 0xC2, 0x90, 0x9C, 0x77, ++0xF0, 0xD1, 0x48, 0x90, 0x9C, 0x74, 0xE0, 0x90, ++0x04, 0x25, 0xF0, 0x90, 0x9C, 0x75, 0xE0, 0x60, ++0x05, 0xD1, 0x32, 0x44, 0x80, 0xF0, 0xAF, 0x05, ++0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0xD1, 0x32, ++0x54, 0xC0, 0xF0, 0x90, 0x9C, 0x77, 0xE0, 0xFF, ++0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, ++0x8B, 0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, 0x2E, ++0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, ++0x04, 0xF0, 0xAF, 0x05, 0x12, 0xC7, 0x5E, 0xE0, ++0x54, 0x01, 0xFE, 0x90, 0x9C, 0x76, 0xE0, 0x25, ++0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, ++0x12, 0xC7, 0x5D, 0xEE, 0xF0, 0x74, 0x11, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, ++0xFF, 0xF0, 0x74, 0x29, 0x2F, 0xD1, 0x3E, 0xE0, ++0x54, 0xF7, 0xF0, 0x74, 0x0D, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, ++0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xE0, 0xFF, ++0x12, 0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, 0x22, ++0xE4, 0xFD, 0xFC, 0xEF, 0x60, 0x2B, 0x90, 0x98, ++0x0B, 0xD1, 0x46, 0x12, 0xF3, 0x29, 0x12, 0x8F, ++0xFA, 0x90, 0x99, 0x88, 0x12, 0x9B, 0x5F, 0x75, ++0x48, 0x40, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xF5, ++0x12, 0x69, 0xF5, 0xD1, 0x82, 0xCE, 0xC3, 0x13, ++0xCE, 0x13, 0xD8, 0xF9, 0xD1, 0xB2, 0x12, 0x54, ++0x1E, 0x22, 0xE4, 0xFD, 0x7F, 0x03, 0x12, 0x54, ++0x1E, 0x90, 0x98, 0x0C, 0xE0, 0x75, 0xF0, 0x80, ++0xA4, 0xAE, 0xF0, 0x78, 0x03, 0x22, 0xE4, 0xFD, ++0x7F, 0x03, 0x12, 0x54, 0x1E, 0x90, 0x01, 0x85, ++0xE0, 0x54, 0xFE, 0xF0, 0xD1, 0x82, 0xCE, 0xC3, ++0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xD1, 0xB2, 0x02, ++0x54, 0x1E, 0xFF, 0x12, 0x77, 0xA4, 0x7D, 0x01, ++0x7F, 0x03, 0x22, 0x90, 0x9A, 0x16, 0x12, 0xA7, ++0xFA, 0xD1, 0x96, 0xD1, 0xD0, 0x12, 0xF7, 0xDF, ++0xD1, 0xD0, 0xA3, 0xE0, 0xFD, 0x02, 0x9B, 0x69, ++0x90, 0x9A, 0x16, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0x22, 0xE4, 0xFD, 0xFC, 0x90, 0x98, 0x11, 0xD1, ++0x46, 0xAB, 0x05, 0x74, 0x01, 0x2B, 0x12, 0xB6, ++0x9C, 0xE0, 0xFE, 0x74, 0x00, 0x2B, 0x12, 0x9E, ++0x8A, 0x12, 0xEB, 0xEF, 0x90, 0x95, 0x63, 0xF0, ++0xA3, 0xEF, 0xF0, 0x74, 0x03, 0x2B, 0xF1, 0x62, ++0xE0, 0xFE, 0x74, 0x02, 0x2B, 0xF1, 0xE6, 0x24, ++0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x65, 0xF0, ++0xA3, 0xEF, 0xF0, 0x74, 0x05, 0x2B, 0x12, 0xD7, ++0x5B, 0xE0, 0xFE, 0x74, 0x04, 0x2B, 0x12, 0xFB, ++0xF3, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, ++0x67, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x07, 0x2B, ++0xF1, 0xD0, 0xFE, 0x74, 0x06, 0x2B, 0xF1, 0xC7, ++0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x69, ++0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x09, 0x2B, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFE, ++0x74, 0x08, 0x2B, 0xF1, 0x6A, 0x24, 0x00, 0xFF, ++0xEC, 0x3E, 0x90, 0x95, 0x6B, 0xF0, 0xA3, 0xEF, ++0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0x22, 0x90, 0x93, 0x06, 0xF1, 0xD9, ++0x12, 0x9E, 0x8A, 0xE0, 0x90, 0x9A, 0xE7, 0xF0, ++0x74, 0x01, 0x2F, 0x12, 0xB6, 0x9C, 0xE0, 0x90, ++0x9A, 0xE8, 0xF1, 0xE2, 0x90, 0x9A, 0xE9, 0xF0, ++0x74, 0x03, 0x2F, 0xF1, 0x62, 0xE0, 0x90, 0x9A, ++0xEA, 0x12, 0xFB, 0xEF, 0x90, 0x9A, 0xEB, 0xF0, ++0x74, 0x05, 0x2F, 0x12, 0xD7, 0x5B, 0xE0, 0x90, ++0x9A, 0xEC, 0xF0, 0x74, 0x06, 0x2F, 0xF1, 0xC7, ++0x90, 0x9A, 0xED, 0xF0, 0x74, 0x07, 0x2F, 0xF1, ++0xD0, 0x90, 0x9A, 0xEE, 0xF0, 0x74, 0x08, 0x2F, ++0xF1, 0x6A, 0x90, 0x9A, 0xEF, 0xF0, 0x22, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, ++0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, ++0x22, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x74, 0x00, ++0x2F, 0x22, 0xF0, 0x74, 0x02, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xEF, ++0x64, 0x01, 0x70, 0x24, 0x90, 0x93, 0x29, 0xE0, ++0xFF, 0x7E, 0x00, 0x90, 0x93, 0x2B, 0xE0, 0x13, ++0x13, 0x54, 0x01, 0xFD, 0x90, 0x93, 0x2A, 0xE0, ++0xFC, 0xC3, 0x13, 0x54, 0x7F, 0xFB, 0xEC, 0x54, ++0x01, 0x90, 0x9A, 0xE0, 0xF0, 0x12, 0x8F, 0x31, ++0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x9A, 0xD4, ++0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, ++0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, ++0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, ++0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, ++0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, ++0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, ++0x7B, 0x2E, 0x80, 0xFE, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9B, 0xED, 0xEC, ++0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x9B, 0xEC, 0xEF, ++0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x7B, 0xBD, ++0x90, 0x9B, 0xF7, 0x12, 0x04, 0x31, 0x90, 0x9B, ++0xEF, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, ++0x9B, 0xF7, 0x12, 0x84, 0x52, 0x12, 0x84, 0x38, ++0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, ++0x90, 0x9B, 0xEF, 0x12, 0x04, 0xB8, 0x90, 0x9B, ++0xF3, 0x12, 0x84, 0x52, 0x12, 0x84, 0x38, 0xD0, ++0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, ++0x84, 0x45, 0x90, 0x9B, 0xFB, 0x12, 0x04, 0x31, ++0x90, 0x9B, 0xED, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, ++0x90, 0x9B, 0xFB, 0x12, 0x04, 0xB8, 0x90, 0x8B, ++0x9F, 0x12, 0x04, 0x31, 0x90, 0x9B, 0xEC, 0xE0, ++0xFF, 0xD0, 0x05, 0x12, 0x79, 0x53, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0x9C, 0x80, 0xEF, 0xF0, 0xED, ++0x64, 0x01, 0x70, 0x2E, 0xEB, 0xB4, 0x01, 0x07, ++0xE0, 0x24, 0x02, 0xF5, 0x15, 0x80, 0x08, 0x90, ++0x9C, 0x80, 0xE0, 0x24, 0xFE, 0xF5, 0x15, 0x90, ++0x9B, 0xEF, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, ++0xFF, 0xAF, 0x15, 0x31, 0x45, 0x31, 0x3D, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x15, ++0x80, 0x20, 0x90, 0x9B, 0xEF, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x00, 0xFF, 0x90, 0x9C, 0x80, 0x12, ++0xBD, 0xAC, 0x31, 0x49, 0x31, 0x3D, 0x12, 0x04, ++0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x9C, 0x80, ++0xE0, 0xFF, 0x31, 0x45, 0x7F, 0x01, 0x11, 0x55, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFF, 0x11, ++0x55, 0x90, 0x9B, 0xEF, 0x22, 0xE4, 0xFC, 0xFD, ++0xFE, 0x90, 0x9B, 0xF3, 0x12, 0x04, 0x31, 0x7D, ++0x18, 0x7C, 0x00, 0x22, 0x90, 0x93, 0x04, 0x12, ++0xCF, 0xC1, 0x30, 0xE0, 0x07, 0x71, 0x0F, 0xE4, ++0x90, 0x9A, 0xFF, 0xF0, 0x90, 0x9C, 0x01, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x9A, ++0xE5, 0x12, 0xBD, 0xAC, 0x12, 0xBF, 0x91, 0x7F, ++0x50, 0x7E, 0x0C, 0x12, 0xBF, 0x0C, 0x12, 0x04, ++0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x9A, 0xE6, ++0x12, 0xBD, 0xAC, 0x12, 0xBF, 0x91, 0x12, 0xBF, ++0x12, 0x90, 0x9A, 0xFB, 0xE0, 0x90, 0x06, 0x08, ++0xF0, 0x90, 0x9A, 0xFD, 0xA3, 0xE0, 0x90, 0x06, ++0xA0, 0xF0, 0xA3, 0xE4, 0xF0, 0x90, 0x9A, 0xE9, ++0xE0, 0xFF, 0x60, 0x06, 0xA3, 0xE0, 0xFD, 0x12, ++0xBD, 0xBE, 0x90, 0x9A, 0xE8, 0xE0, 0xFF, 0x60, ++0x0A, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0x71, ++0x06, 0x11, 0xD3, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0xF7, 0xE0, 0xFF, ++0x91, 0xEA, 0xEF, 0x70, 0x02, 0x41, 0x7B, 0x90, ++0x9A, 0xF8, 0xE0, 0xFB, 0xD3, 0x94, 0x00, 0x40, ++0x1A, 0x90, 0x9C, 0x01, 0x12, 0x04, 0x3D, 0x00, ++0x00, 0x00, 0x0F, 0xAF, 0x03, 0xE4, 0xFC, 0xFD, ++0xFE, 0x12, 0xBF, 0x91, 0x7F, 0x08, 0x7E, 0x0E, ++0x12, 0xBF, 0x16, 0x90, 0x9A, 0xF7, 0xE0, 0xFF, ++0x90, 0x06, 0x33, 0xF0, 0x71, 0x06, 0xE4, 0xFB, ++0xFD, 0x11, 0xD3, 0x90, 0x9A, 0xFA, 0xE0, 0x60, ++0x07, 0x90, 0x93, 0x05, 0xE0, 0xFF, 0x51, 0xC8, ++0x71, 0xB3, 0x30, 0xE0, 0x39, 0x90, 0x95, 0xBA, ++0xE0, 0x60, 0x33, 0xE4, 0x90, 0x9A, 0x0D, 0xF0, ++0x90, 0x95, 0xBA, 0xE0, 0xFF, 0x90, 0x9A, 0x0D, ++0xE0, 0xC3, 0x9F, 0x50, 0x21, 0x7F, 0x03, 0x7E, ++0x00, 0x12, 0x7A, 0xAE, 0x90, 0x9A, 0x0D, 0xE0, ++0x24, 0xF9, 0x71, 0xBB, 0xE0, 0xFF, 0x51, 0xC8, ++0x90, 0x01, 0xA6, 0xE0, 0x04, 0xF0, 0x90, 0x9A, ++0x0D, 0xE0, 0x04, 0xF0, 0x80, 0xD2, 0x90, 0x9A, ++0xF9, 0xE0, 0x90, 0x9A, 0x0C, 0xF0, 0x90, 0x9A, ++0xE4, 0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0xB1, 0x15, ++0x90, 0x9A, 0x0C, 0x12, 0xBD, 0xAC, 0x90, 0x9C, ++0x55, 0x12, 0x04, 0x31, 0x71, 0xC3, 0x12, 0xB3, ++0xAE, 0x80, 0x48, 0xE4, 0x90, 0x9A, 0xE4, 0xF0, ++0x90, 0x9B, 0x63, 0xF0, 0x90, 0x06, 0x32, 0xE0, ++0x54, 0xFB, 0xF0, 0x31, 0x54, 0xE4, 0xFF, 0x12, ++0x78, 0x4A, 0xBF, 0x01, 0x13, 0x90, 0x9A, 0xFC, ++0xE0, 0xFD, 0x90, 0x8A, 0x89, 0x12, 0x91, 0x62, ++0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x7B, 0xAD, ++0x90, 0x9A, 0x0E, 0x74, 0x07, 0xF0, 0x90, 0x9A, ++0x30, 0xF0, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x0E, ++0x12, 0x91, 0x50, 0x7F, 0x04, 0x12, 0x04, 0x7E, ++0x12, 0xDD, 0xE9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0x9A, 0x31, 0xEF, 0xF0, 0x12, 0x76, 0x9B, 0xBF, ++0x01, 0x27, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x08, ++0xF0, 0x90, 0x9A, 0x31, 0xE0, 0xFF, 0x90, 0x92, ++0x13, 0x74, 0x07, 0xF0, 0x7B, 0x18, 0x7D, 0x01, ++0x12, 0x66, 0xDB, 0x90, 0x9A, 0x32, 0xEE, 0xF0, ++0xA3, 0xEF, 0xF0, 0x90, 0x04, 0x1F, 0x74, 0x20, ++0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9A, ++0xEF, 0xE0, 0x90, 0x9C, 0x83, 0xF0, 0x22, 0x90, ++0x02, 0x86, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0xE4, ++0xFD, 0xFC, 0x90, 0x01, 0x1D, 0xE0, 0xFE, 0x90, ++0x01, 0x1C, 0x71, 0xEF, 0x90, 0x9C, 0x88, 0xF0, ++0xA3, 0xEF, 0x12, 0xCF, 0xC8, 0xE0, 0x24, 0x00, ++0xFF, 0xEA, 0x3E, 0x90, 0x9C, 0x8A, 0xF0, 0xA3, ++0xEF, 0xF0, 0x71, 0xAA, 0x90, 0x9C, 0x88, 0xE0, ++0xFA, 0xA3, 0xE0, 0xFB, 0xB5, 0x07, 0x06, 0xEA, ++0xB5, 0x06, 0x02, 0x80, 0x40, 0x71, 0xAA, 0xD3, ++0xEB, 0x9F, 0xEA, 0x9E, 0x40, 0x0E, 0x90, 0x9C, ++0x89, 0xE0, 0x9F, 0xFD, 0x90, 0x9C, 0x88, 0xE0, ++0x9E, 0xFC, 0x80, 0x29, 0x71, 0xAA, 0xC3, 0x90, ++0x9C, 0x89, 0xE0, 0x9F, 0x90, 0x9C, 0x88, 0xE0, ++0x9E, 0x50, 0x1A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0xC3, 0x90, 0x9C, 0x8B, 0xE0, 0x9F, 0xFF, 0x90, ++0x9C, 0x8A, 0xE0, 0x9E, 0xFE, 0xC3, 0xE4, 0x9F, ++0xFD, 0x74, 0x40, 0x9E, 0xFC, 0xD3, 0xED, 0x94, ++0x00, 0xEC, 0x94, 0x38, 0x40, 0x02, 0x61, 0x0F, ++0xC3, 0xEC, 0x94, 0x08, 0x50, 0x0B, 0xED, 0x94, ++0x00, 0xEC, 0x94, 0x00, 0x40, 0x03, 0x12, 0xCF, ++0x78, 0x22, 0x90, 0x9C, 0x8A, 0xE0, 0xFE, 0xA3, ++0xE0, 0xFF, 0x22, 0x90, 0x93, 0x24, 0xE0, 0xC4, ++0x54, 0x0F, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x95, ++0xF5, 0x83, 0x22, 0xE4, 0x90, 0x9C, 0x59, 0xF0, ++0x7F, 0x04, 0x22, 0xEF, 0x24, 0xFC, 0x60, 0x06, ++0x04, 0x70, 0x05, 0x02, 0x94, 0xD4, 0x31, 0xC4, ++0x22, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, ++0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, ++0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, ++0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x22, ++0x12, 0xCF, 0xC9, 0x12, 0xBA, 0x6E, 0x90, 0x99, ++0x88, 0x12, 0xCF, 0x9A, 0xF9, 0x90, 0x93, 0x24, ++0xE0, 0x30, 0xE0, 0x78, 0xEC, 0xC3, 0x99, 0x50, ++0x73, 0x90, 0x99, 0x88, 0xE0, 0xFA, 0xA3, 0xE0, ++0xFB, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, ++0xAD, 0x07, 0x71, 0xD9, 0x54, 0x3F, 0x90, 0x99, ++0x8A, 0x91, 0xCE, 0x30, 0xE0, 0x09, 0xC3, 0x13, ++0x20, 0xE0, 0x04, 0x91, 0x9C, 0x80, 0x02, 0x7E, ++0x00, 0xEE, 0xFB, 0xEF, 0x24, 0x18, 0xFF, 0xE4, ++0x33, 0xCF, 0x2B, 0xCF, 0x34, 0x00, 0x90, 0x99, ++0x8A, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x99, ++0x8A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0xCE, ++0x5D, 0x90, 0x99, 0x8A, 0xEE, 0x91, 0x85, 0x91, ++0x8D, 0xD3, 0x90, 0x99, 0x89, 0xE0, 0x9F, 0x90, ++0x99, 0x88, 0xE0, 0x9E, 0x40, 0x0E, 0x91, 0xAB, ++0x90, 0x99, 0x89, 0xE0, 0x9F, 0xF0, 0x90, 0x99, ++0x88, 0xE0, 0x9E, 0xF0, 0x90, 0x99, 0x88, 0x91, ++0xBB, 0x0C, 0x80, 0x88, 0x22, 0xF0, 0xA3, 0xEF, ++0xF0, 0x90, 0x99, 0x88, 0x22, 0xEE, 0x8F, 0xF0, ++0x12, 0x02, 0xE7, 0x90, 0x88, 0x27, 0xE0, 0xFE, ++0xA3, 0xE0, 0xFF, 0x22, 0x74, 0x03, 0x2D, 0xF5, ++0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, ++0x03, 0xFE, 0x22, 0x90, 0x88, 0x28, 0xE0, 0x24, ++0x01, 0xFF, 0x90, 0x88, 0x27, 0xE0, 0x34, 0x00, ++0xFE, 0xC3, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, ++0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xF0, 0xA3, ++0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, ++0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, ++0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0x98, 0x38, ++0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x9A, 0xE7, 0xE0, 0xFE, 0x90, 0x9A, ++0xE4, 0xE0, 0xC3, 0x9E, 0x40, 0x04, 0x7F, 0x00, ++0x80, 0x0E, 0xEF, 0x60, 0x05, 0xD3, 0x94, 0x0E, ++0x40, 0x04, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x31, 0xEF, ++0xF0, 0x90, 0x93, 0x06, 0xE0, 0xFF, 0x12, 0x7B, ++0x07, 0x74, 0x10, 0x2F, 0xFF, 0x90, 0x9A, 0x31, ++0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x2F, 0xFF, 0x12, ++0xB7, 0x62, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, ++0x9A, 0x79, 0xF7, 0x12, 0x69, 0xF5, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0xE4, 0xFE, 0xFD, 0xEF, 0xB4, 0x01, ++0x0D, 0xEB, 0xB4, 0x02, 0x03, 0x0D, 0x80, 0x06, ++0xEB, 0xB4, 0x01, 0x02, 0x7D, 0x02, 0xAF, 0x06, ++0xEF, 0xC4, 0x54, 0xF0, 0x4D, 0xFF, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x90, 0x01, 0xC4, 0x74, 0x73, ++0xF0, 0x74, 0xED, 0xA3, 0xF0, 0x7F, 0x90, 0x12, ++0x7B, 0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0x73, ++0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xED, 0xA3, ++0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0xB1, 0xC2, 0x90, 0x9C, 0xA9, 0xF0, 0xED, ++0x90, 0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, ++0xF0, 0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, ++0x80, 0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, ++0x67, 0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0x86, 0xAD, 0xA3, 0xE0, 0x24, ++0x7F, 0xF5, 0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, ++0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0xB1, 0xC2, 0x90, 0x9C, 0xAE, 0xF0, 0x90, ++0x88, 0x32, 0x12, 0xBF, 0xE3, 0x30, 0xE0, 0x02, ++0xC1, 0x96, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, ++0x1C, 0x12, 0x94, 0xCD, 0x33, 0x33, 0x33, 0x54, ++0xF8, 0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, 0x53, ++0xE0, 0x04, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, ++0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, 0x88, 0x4B, ++0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, ++0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, 0x88, 0x4A, ++0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, ++0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, 0xF0, 0x90, ++0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, ++0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, 0x3E, 0xF0, ++0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, ++0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, 0x88, 0x4B, ++0xD1, 0xA2, 0x90, 0x88, 0x4E, 0xD1, 0xAB, 0x40, ++0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, ++0xD1, 0xA2, 0x90, 0x88, 0x3E, 0xD1, 0xAB, 0x40, ++0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, ++0x12, 0xC6, 0x14, 0xFF, 0x7E, 0x00, 0x90, 0x88, ++0x42, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, ++0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, ++0xFF, 0x90, 0x05, 0xB1, 0xE0, 0x54, 0xF8, 0x4F, ++0xF0, 0x12, 0xC7, 0xE8, 0x80, 0x07, 0x90, 0x88, ++0x33, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, ++0x33, 0xFC, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, ++0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0xFE, ++0xF0, 0x54, 0xE1, 0xF0, 0x90, 0x88, 0xBD, 0xE0, ++0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, 0x36, 0xE0, ++0x70, 0x19, 0x90, 0x93, 0x08, 0xE0, 0x20, 0xE0, ++0x12, 0x90, 0x86, 0x0C, 0x12, 0x8C, 0x14, 0x90, ++0x8A, 0xF9, 0x12, 0x91, 0x62, 0xE4, 0xFD, 0xFF, ++0x12, 0x04, 0x7E, 0x22, 0x90, 0x88, 0x9D, 0xE0, ++0x30, 0xE0, 0x5F, 0x90, 0x99, 0x7C, 0xE0, 0x30, ++0xE0, 0x3E, 0x90, 0x99, 0x87, 0xE0, 0xFF, 0x90, ++0x99, 0x86, 0xE0, 0xC3, 0x9F, 0x40, 0x25, 0xF1, ++0x5D, 0x90, 0x06, 0xC4, 0xF1, 0x5B, 0x78, 0x08, ++0x12, 0x03, 0xEB, 0x90, 0x06, 0xC5, 0xEF, 0xF0, ++0x90, 0x99, 0x7D, 0x12, 0xB4, 0xCF, 0x90, 0x06, ++0xC6, 0xF1, 0x5B, 0xF1, 0x63, 0xE4, 0x90, 0x99, ++0x86, 0xF0, 0x80, 0x1B, 0xF1, 0x6E, 0xF1, 0x63, ++0x90, 0x99, 0x86, 0xE0, 0x04, 0xF0, 0x80, 0x0F, ++0x90, 0x99, 0x85, 0xE0, 0x60, 0x09, 0xF1, 0x6E, ++0xF1, 0x63, 0xE4, 0x90, 0x99, 0x85, 0xF0, 0x90, ++0x8A, 0xBB, 0x12, 0x91, 0x62, 0xE4, 0xFF, 0x12, ++0x04, 0x7E, 0x22, 0xEF, 0xF0, 0x90, 0x99, 0x7D, ++0x02, 0x04, 0xB8, 0x78, 0x18, 0x12, 0x03, 0xEB, ++0x90, 0x06, 0xC7, 0xEF, 0xF0, 0x22, 0x90, 0x99, ++0x81, 0x12, 0x04, 0xB8, 0x90, 0x06, 0xC4, 0xEF, ++0xF0, 0x90, 0x99, 0x81, 0x12, 0x04, 0xB8, 0x78, ++0x08, 0x12, 0x03, 0xEB, 0x90, 0x06, 0xC5, 0xEF, ++0xF0, 0x90, 0x99, 0x81, 0x12, 0x04, 0xB8, 0x78, ++0x10, 0x12, 0x03, 0xEB, 0x90, 0x06, 0xC6, 0xEF, ++0xF0, 0x90, 0x99, 0x81, 0x02, 0x04, 0xB8, 0x90, ++0x9C, 0xAA, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xEF, 0x54, ++0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, 0x08, 0x74, ++0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, 0x71, 0x12, ++0xF0, 0xA5, 0x12, 0xF0, 0x79, 0x90, 0x07, 0xC3, ++0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, ++0x2F, 0x12, 0xF0, 0x71, 0xE0, 0xFE, 0x74, 0x84, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0x12, 0xF2, ++0xEB, 0xB4, 0x04, 0xEA, 0x90, 0x9C, 0x85, 0x12, ++0xBD, 0xAC, 0x12, 0xC3, 0x0B, 0x90, 0x9C, 0x84, ++0x12, 0xBD, 0xAC, 0x12, 0x84, 0x45, 0xC0, 0x04, ++0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x9C, ++0x86, 0x12, 0xBD, 0xAC, 0x78, 0x10, 0x12, 0x03, ++0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0x12, 0x84, 0x45, 0xC0, 0x04, 0xC0, 0x05, ++0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0xBD, 0xAC, ++0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, ++0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x84, 0x45, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, ++0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, ++0x7E, 0xFF, 0x7F, 0xFF, 0x80, 0x1E, 0x11, 0xA5, ++0x11, 0x79, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, ++0xF9, 0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, 0x11, ++0x71, 0xE0, 0xFE, 0x74, 0xC8, 0x2D, 0x11, 0x71, ++0x12, 0xBA, 0x6E, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xF5, 0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, ++0x22, 0x90, 0x07, 0xC0, 0x74, 0x80, 0xF0, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, ++0x07, 0xAC, 0x06, 0xEF, 0x11, 0xB3, 0x11, 0x79, ++0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, ++0x54, 0x03, 0x24, 0xC8, 0x11, 0x71, 0xE0, 0xFF, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x07, 0xC0, ++0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xEE, 0xF0, ++0xA3, 0xEF, 0xF0, 0x54, 0xFC, 0x90, 0x07, 0xC0, ++0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, 0xFC, 0xFF, ++0x11, 0xB5, 0xE4, 0xFB, 0x90, 0x9C, 0x5C, 0x12, ++0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, ++0xF8, 0x12, 0x03, 0xEB, 0x74, 0xC4, 0x2B, 0x11, ++0x71, 0xEF, 0xF0, 0x0B, 0xEB, 0xB4, 0x04, 0xE4, ++0x90, 0x07, 0xC2, 0x31, 0xB3, 0x90, 0x07, 0xC3, ++0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x90, 0x9C, 0xA1, 0x11, 0xAE, 0x7A, 0x00, 0x90, ++0x9C, 0xA2, 0xE0, 0x54, 0x03, 0xFB, 0x70, 0x0A, ++0x90, 0x07, 0xC4, 0x31, 0x3A, 0x74, 0x03, 0xF0, ++0x80, 0x0E, 0xEB, 0x64, 0x02, 0x4A, 0x70, 0x15, ++0x90, 0x07, 0xC6, 0x31, 0x3A, 0x74, 0x0C, 0xF0, ++0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, ++0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xED, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, ++0x07, 0xC2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0x9C, 0xA3, 0x11, 0xAE, 0x31, ++0xA9, 0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, 0xF0, ++0x90, 0x07, 0xC2, 0x74, 0x01, 0xF0, 0x80, 0x37, ++0xEF, 0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, 0x07, ++0xC5, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x02, ++0xF0, 0x80, 0x24, 0x31, 0xA9, 0x64, 0x02, 0x70, ++0x0D, 0x90, 0x07, 0xC6, 0xED, 0xF0, 0x90, 0x07, ++0xC2, 0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, 0x64, ++0x03, 0x4E, 0x70, 0x0B, 0x90, 0x07, 0xC7, 0xED, ++0xF0, 0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, 0x90, ++0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, 0xC3, ++0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x7E, 0x00, 0x90, 0x9C, 0xA4, 0xE0, 0x54, ++0x03, 0xFF, 0x22, 0x74, 0x0F, 0xF0, 0xA3, 0x74, ++0xC0, 0xF0, 0x22, 0x90, 0x98, 0x18, 0x12, 0xCF, ++0xC1, 0x30, 0xE0, 0x0B, 0x12, 0xB7, 0xE8, 0x31, ++0xDC, 0xA3, 0x04, 0xF0, 0x02, 0x9A, 0x22, 0x90, ++0x8A, 0xAF, 0x12, 0x91, 0x62, 0x7D, 0x08, 0xE4, ++0xFF, 0x02, 0x04, 0x7E, 0x90, 0x9C, 0x14, 0x12, ++0x84, 0x67, 0xE4, 0x90, 0x9C, 0x17, 0xF0, 0x22, ++0x90, 0x98, 0x18, 0xE0, 0x30, 0xE0, 0x34, 0x12, ++0xC7, 0x81, 0x70, 0x2F, 0x90, 0x9C, 0xAC, 0xE0, ++0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0x98, ++0x1A, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x9C, 0xAC, ++0xF0, 0x90, 0x98, 0x1A, 0xE0, 0xFF, 0x90, 0x98, ++0x19, 0xE0, 0xD3, 0x9F, 0x50, 0x0D, 0x90, 0x98, ++0x1B, 0xE0, 0x70, 0x07, 0xE4, 0x90, 0x98, 0x1A, ++0xF0, 0x31, 0xBB, 0x22, 0x12, 0xBF, 0xEB, 0x90, ++0x98, 0x18, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, ++0xEF, 0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, ++0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, ++0x07, 0x12, 0x8E, 0xFF, 0x90, 0x98, 0x19, 0xF0, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0xE4, 0xFD, 0x7F, 0x8F, 0x12, 0x7B, 0x2E, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0x51, 0x49, 0x90, 0x98, ++0x16, 0xE0, 0xFF, 0x51, 0x86, 0x90, 0x01, 0x3F, ++0x74, 0x04, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0xFF, ++0xB4, 0x01, 0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, ++0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0x90, 0xFE, ++0x10, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x99, ++0x8B, 0xEF, 0xF0, 0xE4, 0xFF, 0x74, 0x2F, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, ++0xFE, 0x74, 0x84, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x04, 0x51, 0xEB, 0xB4, 0x08, 0xE7, 0x90, 0x95, ++0x5F, 0xE0, 0x90, 0x04, 0x8C, 0xF0, 0x90, 0x95, ++0x61, 0xE0, 0x90, 0x04, 0x8D, 0xF0, 0x75, 0x45, ++0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0x3E, 0x75, ++0x48, 0x08, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x37, ++0x12, 0x69, 0xF5, 0x90, 0x98, 0x16, 0xE0, 0x60, ++0x19, 0x90, 0x99, 0x8B, 0x71, 0x21, 0x71, 0x29, ++0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x95, 0x75, ++0x47, 0x2F, 0x75, 0x48, 0x34, 0xD0, 0x03, 0x12, ++0x69, 0xF5, 0x22, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, ++0xEF, 0x22, 0xE4, 0xFF, 0x74, 0x18, 0x71, 0x16, ++0x74, 0x34, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, ++0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x10, 0x71, 0x16, ++0x74, 0x2E, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, ++0x51, 0xEB, 0xB4, 0x06, 0xDF, 0x22, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, ++0x22, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x7E, 0x00, ++0x22, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFC, ++0xFA, 0x7B, 0x01, 0x22, 0x90, 0x93, 0x2D, 0xE0, ++0x30, 0xE0, 0x0D, 0x90, 0x93, 0x27, 0xE0, 0xC4, ++0x54, 0x0F, 0x20, 0xE0, 0x03, 0x7F, 0x00, 0x22, ++0x7F, 0x01, 0x22, 0xEF, 0x90, 0x01, 0xC7, 0xB4, ++0xA0, 0x05, 0x74, 0x04, 0xF0, 0x80, 0x03, 0x74, ++0x08, 0xF0, 0x02, 0xC7, 0x79, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x20, 0xE0, 0x05, ++0x90, 0x98, 0x05, 0x80, 0x03, 0x90, 0x98, 0x06, ++0xE0, 0x90, 0x95, 0x60, 0xF0, 0x90, 0x95, 0x60, ++0xE0, 0x14, 0x60, 0x13, 0x14, 0x60, 0x14, 0x24, ++0xFE, 0x60, 0x10, 0x14, 0x60, 0x09, 0x14, 0x60, ++0x06, 0x24, 0x06, 0xE4, 0xFE, 0x80, 0x06, 0x7E, ++0x04, 0x80, 0x02, 0x7E, 0x08, 0xAF, 0x06, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9C, 0x63, 0xED, ++0xF0, 0x90, 0x9C, 0x60, 0x12, 0x84, 0x67, 0xE4, ++0x90, 0x9C, 0x64, 0xF0, 0xA3, 0xF0, 0x12, 0x02, ++0x06, 0xFF, 0x12, 0x8E, 0xFF, 0xFD, 0x12, 0x97, ++0x31, 0xFB, 0x12, 0xCE, 0xE7, 0x90, 0x9C, 0x64, ++0xEF, 0xF0, 0x90, 0x9C, 0x60, 0x12, 0x84, 0x5E, ++0x12, 0x97, 0x31, 0xFF, 0x71, 0x5D, 0x90, 0x9C, ++0x65, 0xEF, 0xF0, 0x90, 0x95, 0x60, 0xE0, 0x24, ++0xFE, 0x60, 0x14, 0x24, 0xFE, 0x60, 0x10, 0x14, ++0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x05, 0x70, ++0x41, 0x91, 0x2B, 0x91, 0x37, 0x80, 0x0D, 0x91, ++0x2B, 0x90, 0x95, 0x60, 0xE0, 0x90, 0x9C, 0x43, ++0xF0, 0x12, 0x96, 0x34, 0x90, 0x9C, 0x65, 0xE0, ++0xFF, 0x90, 0x9C, 0x60, 0x12, 0x84, 0x5E, 0x90, ++0x9C, 0x64, 0xE0, 0x7C, 0x00, 0x29, 0xF9, 0xEC, ++0x3A, 0xFA, 0xC3, 0xE9, 0x9F, 0xF9, 0xEA, 0x94, ++0x00, 0xFA, 0x75, 0x45, 0x01, 0x75, 0x46, 0x95, ++0x75, 0x47, 0x2F, 0xA3, 0xE0, 0xF5, 0x48, 0x12, ++0x69, 0xF5, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x2F, 0x90, 0x9C, 0x63, 0xE0, 0xFD, 0x22, 0x90, ++0x9C, 0x4F, 0xED, 0xF0, 0x90, 0x9C, 0x4C, 0x12, ++0x84, 0x67, 0x12, 0x8F, 0xF4, 0x90, 0x9C, 0x53, ++0xF0, 0x90, 0x9C, 0x4C, 0x12, 0x9B, 0x5F, 0x75, ++0x48, 0x03, 0x7B, 0x01, 0x7A, 0x9C, 0x79, 0x50, ++0x12, 0x69, 0xF5, 0x90, 0x9C, 0x4F, 0xE0, 0x70, ++0x2E, 0xFF, 0x91, 0x90, 0xE0, 0xB4, 0xFF, 0x06, ++0x91, 0x90, 0xE4, 0xF0, 0x80, 0x07, 0x91, 0x90, ++0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, ++0x03, 0xE8, 0x75, 0x45, 0x01, 0x75, 0x46, 0x9C, ++0x75, 0x47, 0x50, 0x75, 0x48, 0x03, 0x90, 0x9C, ++0x4C, 0x12, 0x84, 0x5E, 0x12, 0x69, 0xF5, 0x22, ++0x74, 0x50, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, ++0xF5, 0x83, 0x22, 0x91, 0xAC, 0x12, 0xB7, 0x64, ++0x75, 0x48, 0x08, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x2F, 0x02, 0x69, 0xF5, 0x12, 0x7B, 0x07, 0x7E, ++0x00, 0x74, 0x00, 0x2F, 0x22, 0x91, 0xAC, 0x12, ++0xB7, 0x64, 0x75, 0x48, 0x70, 0x7B, 0x01, 0x7A, ++0x93, 0x79, 0x5D, 0x02, 0x69, 0xF5, 0xEF, 0x60, ++0x07, 0x90, 0x98, 0x0D, 0xE0, 0xFF, 0x91, 0xB5, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x12, 0xBF, 0xEB, 0x90, 0x93, 0x24, 0x12, 0xCF, ++0xDD, 0x12, 0x8F, 0x0E, 0xB1, 0xF3, 0x90, 0x93, ++0x24, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, ++0xF7, 0x12, 0x8F, 0x0D, 0xD1, 0x07, 0x90, 0x93, ++0x24, 0x12, 0x8F, 0x05, 0x12, 0xBF, 0xCE, 0x4D, ++0xFF, 0x90, 0x93, 0x24, 0xD1, 0x10, 0x12, 0x8F, ++0xED, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x26, ++0xE0, 0x54, 0xFE, 0x4E, 0x12, 0x8E, 0xFE, 0xFE, ++0x54, 0x01, 0xFD, 0x90, 0x93, 0x25, 0xB1, 0xEB, ++0x54, 0x04, 0xFE, 0xED, 0x54, 0xFB, 0x4E, 0x12, ++0x8E, 0xFD, 0xFD, 0x54, 0x08, 0xFC, 0xEE, 0x54, ++0xF7, 0x4C, 0xFE, 0x90, 0x93, 0x25, 0xF0, 0xED, ++0x54, 0x10, 0xFD, 0xEE, 0x54, 0xEF, 0x4D, 0x12, ++0x8E, 0xFD, 0xFD, 0x54, 0x20, 0xFC, 0xEE, 0x54, ++0xDF, 0x4C, 0x90, 0x93, 0x25, 0xF0, 0xEF, 0x54, ++0x10, 0xFF, 0xA3, 0xE0, 0x54, 0xEF, 0x4F, 0xFF, ++0x12, 0x8F, 0xED, 0x54, 0x20, 0xFE, 0xEF, 0x54, ++0xDF, 0x4E, 0x90, 0x93, 0x26, 0xF0, 0xED, 0x54, ++0x02, 0xFF, 0x90, 0x93, 0x25, 0xE0, 0x54, 0xFD, ++0x4F, 0x12, 0xBA, 0x65, 0xB1, 0xE3, 0x90, 0x93, ++0x24, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, 0xD1, ++0x1A, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x54, ++0x01, 0xFF, 0x91, 0xC6, 0x12, 0xC6, 0x11, 0x30, ++0xE0, 0x1F, 0x90, 0x93, 0x24, 0x12, 0xDB, 0xDB, ++0x20, 0xE0, 0x0E, 0xEF, 0xC3, 0x13, 0x20, 0xE0, ++0x08, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, ++0x04, 0x7F, 0x01, 0x80, 0x0E, 0x7F, 0x00, 0x80, ++0x0A, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x13, ++0x54, 0x01, 0xFF, 0x12, 0xE6, 0x50, 0x90, 0x93, ++0x24, 0xE0, 0xC4, 0x54, 0x01, 0xFF, 0xD1, 0x26, ++0x90, 0x93, 0x24, 0xE0, 0xC4, 0x13, 0x13, 0x54, ++0x01, 0xFF, 0xB1, 0xFC, 0x90, 0x93, 0x24, 0xE0, ++0x54, 0x01, 0xFF, 0x12, 0xB2, 0xAE, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x90, 0x88, 0x27, 0xF0, 0xA3, ++0xEF, 0xF0, 0x22, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, ++0xF0, 0xEE, 0x22, 0x54, 0x04, 0xFD, 0xEF, 0x54, ++0xFB, 0x4D, 0xFF, 0x22, 0xEF, 0x60, 0x06, 0x12, ++0xE6, 0xD9, 0x12, 0xBA, 0x77, 0x22, 0xFE, 0x54, ++0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x22, ++0xF0, 0xEE, 0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, ++0x4E, 0x22, 0xEF, 0x60, 0x08, 0x90, 0x98, 0x08, ++0xE0, 0xFF, 0x12, 0xB7, 0x70, 0x22, 0xEF, 0x60, ++0x0A, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x80, 0xF0, ++0x12, 0xBB, 0x3A, 0x22, 0x12, 0xA7, 0xF7, 0x2F, ++0xFF, 0xE4, 0x3E, 0xCF, 0x24, 0x06, 0xCF, 0x34, ++0x00, 0x12, 0xA3, 0x3F, 0xEF, 0x64, 0x86, 0x70, ++0x1C, 0x90, 0x9A, 0x3A, 0xE0, 0xFF, 0x90, 0x9A, ++0x39, 0xE0, 0x2F, 0x12, 0xA7, 0xBA, 0xCF, 0x24, ++0x07, 0xCF, 0x34, 0x00, 0x12, 0xA3, 0x3F, 0xBF, ++0xDD, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, ++0x90, 0x9A, 0x72, 0x12, 0x84, 0x67, 0x90, 0x9A, ++0x75, 0x12, 0x9B, 0x5F, 0x75, 0x48, 0x10, 0x7B, ++0x01, 0x7A, 0x93, 0x79, 0xCD, 0x12, 0x69, 0xF5, ++0x90, 0x9A, 0x72, 0x12, 0x9B, 0x5F, 0x75, 0x48, ++0x10, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xDD, 0x12, ++0x69, 0xF5, 0x90, 0x9A, 0x78, 0x12, 0x04, 0xB8, ++0x90, 0x93, 0xED, 0x12, 0x04, 0x31, 0x90, 0x9A, ++0x7C, 0xE0, 0x90, 0x93, 0xF4, 0xF0, 0x22, 0xE4, ++0xFE, 0xED, 0x30, 0xE1, 0x11, 0x90, 0x01, 0x3F, ++0xE0, 0x30, 0xE2, 0x0A, 0x74, 0x04, 0xF0, 0x90, ++0x01, 0xC7, 0x74, 0x23, 0xF0, 0x0E, 0xED, 0x30, ++0xE0, 0x24, 0xEF, 0x30, 0xE6, 0x08, 0x90, 0x01, ++0xC7, 0x74, 0x22, 0xF0, 0x7E, 0x01, 0xEF, 0x30, ++0xE7, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x21, 0xF0, ++0x7E, 0x01, 0xEF, 0x30, 0xE5, 0x08, 0x90, 0x01, ++0xC7, 0x74, 0x23, 0xF0, 0x7E, 0x01, 0xAF, 0x06, ++0x22, 0x12, 0x02, 0x06, 0x90, 0x98, 0x05, 0x12, ++0x8E, 0xFE, 0x90, 0x98, 0x06, 0xF0, 0x22, 0xF1, ++0x3E, 0x90, 0x98, 0x07, 0x12, 0x8E, 0xFE, 0xFF, ++0xED, 0x2F, 0x90, 0x98, 0x08, 0x12, 0x8F, 0xED, ++0xFF, 0xED, 0x2F, 0x90, 0x98, 0x09, 0xF0, 0x12, ++0x8F, 0xF4, 0xFF, 0xED, 0x2F, 0x90, 0x98, 0x0A, ++0x12, 0x97, 0x30, 0xFF, 0xED, 0x2F, 0x90, 0x98, ++0x0B, 0x12, 0x96, 0x2D, 0xFF, 0xED, 0x2F, 0x90, ++0x98, 0x0C, 0xF1, 0x31, 0x90, 0x98, 0x0D, 0xF0, ++0x22, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x02, 0x1F, ++0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x22, 0x90, 0x02, ++0x09, 0xE0, 0xFD, 0x12, 0x02, 0x06, 0xFE, 0xAF, ++0x05, 0xED, 0x2E, 0x22, 0xF1, 0x3E, 0x90, 0x98, ++0x0E, 0x12, 0x8E, 0xFE, 0xFF, 0xED, 0x2F, 0x90, ++0x98, 0x0F, 0x12, 0x8F, 0xED, 0xFF, 0xED, 0x2F, ++0x90, 0x98, 0x10, 0xF0, 0x12, 0x8F, 0xF4, 0xFF, ++0xED, 0x2F, 0x90, 0x98, 0x11, 0x12, 0x97, 0x30, ++0xFF, 0xED, 0x2F, 0x90, 0x98, 0x12, 0x12, 0x96, ++0x2D, 0xFF, 0xED, 0x2F, 0x90, 0x98, 0x13, 0xF1, ++0x31, 0x90, 0x98, 0x14, 0xF0, 0x22, 0xF1, 0x3E, ++0x90, 0x98, 0x15, 0x12, 0x8E, 0xFE, 0xFF, 0xAE, ++0x05, 0xED, 0x2F, 0x90, 0x98, 0x16, 0xF0, 0x22, ++0x12, 0x8F, 0xFA, 0x12, 0xD5, 0x67, 0x12, 0x8C, ++0x04, 0x12, 0xBF, 0xEB, 0x12, 0xC8, 0x96, 0x4E, ++0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x2F, 0x12, ++0x8E, 0xFF, 0x90, 0x98, 0x1D, 0x12, 0x8F, 0xED, ++0x90, 0x98, 0x1E, 0xF0, 0x12, 0x02, 0x06, 0xFF, ++0x54, 0x04, 0xFE, 0x90, 0x98, 0x1C, 0xE0, 0x54, ++0xFB, 0x4E, 0xF0, 0x12, 0x8F, 0xF4, 0x90, 0x98, ++0x1F, 0xF0, 0xEF, 0x54, 0x08, 0xFF, 0x90, 0x98, ++0x1C, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, ++0x19, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x98, ++0x06, 0xE0, 0xFF, 0xB4, 0x02, 0x08, 0x12, 0xF9, ++0x4C, 0x74, 0x08, 0xF0, 0x80, 0x09, 0xEF, 0xB4, ++0x04, 0x05, 0x31, 0x4C, 0x74, 0x10, 0xF0, 0x90, ++0x9A, 0x19, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x64, ++0x02, 0x4E, 0x60, 0x08, 0xEF, 0x64, 0x01, 0x4E, ++0x60, 0x02, 0x21, 0x3F, 0x90, 0x94, 0x36, 0xE0, ++0xFF, 0x64, 0xFE, 0x70, 0x02, 0x21, 0x3F, 0xEF, ++0x64, 0x02, 0x60, 0x07, 0xEF, 0x64, 0x03, 0x60, ++0x02, 0x21, 0x3F, 0x90, 0x94, 0x96, 0x31, 0x82, ++0x90, 0x9A, 0xA6, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, ++0x7E, 0x00, 0x7F, 0x28, 0x7D, 0x00, 0x7B, 0x01, ++0x7A, 0x9A, 0x79, 0x3C, 0x12, 0x04, 0x80, 0x7E, ++0x00, 0x7F, 0x40, 0x7D, 0x00, 0x7B, 0x01, 0x7A, ++0x9A, 0x79, 0x64, 0x12, 0x04, 0x80, 0x90, 0x9A, ++0x19, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, ++0x70, 0x4C, 0x75, 0x45, 0x01, 0x75, 0x46, 0x94, ++0x75, 0x47, 0x66, 0x75, 0x48, 0x10, 0x7B, 0x01, ++0x7A, 0x9A, 0x79, 0xA8, 0x31, 0x7B, 0x75, 0x46, ++0x94, 0x75, 0x47, 0x05, 0x75, 0x48, 0x10, 0x7B, ++0x01, 0x7A, 0x9A, 0x79, 0xB8, 0x12, 0x69, 0xF5, ++0x31, 0x5D, 0x74, 0x20, 0x31, 0x67, 0x90, 0x8F, ++0x3A, 0x31, 0x44, 0x90, 0x8F, 0x3D, 0x31, 0x54, ++0x90, 0x8F, 0x40, 0xF0, 0x7A, 0x9A, 0x79, 0xA8, ++0x12, 0x4C, 0x23, 0x75, 0x45, 0x01, 0x75, 0x46, ++0x9A, 0x75, 0x47, 0x64, 0x80, 0x24, 0x31, 0x5D, ++0x74, 0x10, 0x31, 0x67, 0x90, 0x91, 0x8C, 0x31, ++0x44, 0x90, 0x91, 0x8F, 0x31, 0x54, 0x90, 0x91, ++0x92, 0xF0, 0x7A, 0x94, 0x79, 0x05, 0x12, 0x61, ++0x34, 0x75, 0x45, 0x01, 0x75, 0x46, 0x9A, 0x75, ++0x47, 0x6C, 0x75, 0x48, 0x28, 0x7B, 0x01, 0x7A, ++0x9A, 0x79, 0x3C, 0x12, 0x69, 0xF5, 0x75, 0x45, ++0x01, 0x75, 0x46, 0x9A, 0x75, 0x47, 0x44, 0x75, ++0x48, 0x20, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x1B, ++0x12, 0x69, 0xF5, 0x90, 0x9A, 0x42, 0xE0, 0x54, ++0x03, 0x90, 0x9A, 0x3B, 0xF0, 0xC3, 0x94, 0x04, ++0x50, 0x1C, 0xE0, 0x90, 0x95, 0x5F, 0xF0, 0x75, ++0x45, 0x01, 0x75, 0x46, 0x9A, 0x75, 0x47, 0x1B, ++0x75, 0x48, 0x20, 0x7B, 0x01, 0x7A, 0x95, 0x79, ++0x3F, 0x12, 0x69, 0xF5, 0x80, 0x06, 0x90, 0x95, ++0x5F, 0x74, 0x05, 0xF0, 0x90, 0x9A, 0x3B, 0xE0, ++0xFF, 0x90, 0x98, 0x06, 0xE0, 0xFD, 0x7B, 0x01, ++0x7A, 0x9A, 0x79, 0x1B, 0x12, 0xB0, 0x55, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0x12, 0x84, 0x67, 0x7A, ++0x9A, 0x79, 0x64, 0x22, 0x90, 0x9A, 0xA4, 0x74, ++0x80, 0xF0, 0xA3, 0x22, 0x12, 0x84, 0x67, 0x90, ++0x9A, 0xA6, 0xA3, 0xE0, 0x22, 0x90, 0x9A, 0xA6, ++0xA3, 0xE0, 0xFB, 0x90, 0x92, 0x06, 0x22, 0xF0, ++0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0xFC, 0xFF, ++0xFE, 0x12, 0x71, 0xD4, 0x7B, 0x01, 0x7A, 0x94, ++0x79, 0x98, 0x22, 0x12, 0x69, 0xF5, 0x75, 0x45, ++0x01, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFD, 0xED, ++0xFF, 0x22, 0x7F, 0x50, 0x7E, 0x0C, 0x12, 0x70, ++0x70, 0x90, 0x9A, 0xE5, 0xEF, 0xF0, 0x7F, 0x58, ++0x7E, 0x0C, 0x12, 0x70, 0x70, 0x90, 0x9A, 0xE6, ++0xEF, 0xF0, 0x90, 0x9C, 0x01, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x00, 0x7F, 0x90, 0x9C, 0x05, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x00, 0x17, 0x7F, 0x50, ++0x7E, 0x0C, 0x12, 0xBF, 0x0C, 0x12, 0x04, 0x3D, ++0x00, 0x00, 0x00, 0x7F, 0x90, 0x9C, 0x05, 0x12, ++0x04, 0x3D, 0x00, 0x00, 0x00, 0x17, 0x12, 0xBF, ++0x12, 0x90, 0x06, 0x08, 0xE0, 0x90, 0x9A, 0xFB, ++0xF0, 0x90, 0x06, 0xA1, 0xE0, 0xFE, 0x90, 0x06, ++0xA0, 0x12, 0xBA, 0x6E, 0x90, 0x9A, 0xFD, 0xF0, ++0xA3, 0xEF, 0x12, 0xCF, 0x91, 0x90, 0x06, 0xA0, ++0x74, 0x20, 0xF0, 0xA3, 0x74, 0x01, 0xF0, 0xE4, ++0xFD, 0xFF, 0x02, 0xBD, 0xBE, 0x12, 0xC7, 0x92, ++0x90, 0x9A, 0xE2, 0xE0, 0x64, 0x01, 0xF0, 0xE0, ++0x24, 0xFD, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xF9, ++0xA3, 0x12, 0xC5, 0x82, 0x02, 0xA1, 0x02, 0xED, ++0x14, 0x60, 0x06, 0x04, 0x70, 0x03, 0x7F, 0x01, ++0x22, 0x7F, 0x01, 0x22, 0x12, 0xC7, 0x92, 0xA3, ++0xED, 0xF0, 0x90, 0x95, 0x69, 0xE0, 0x70, 0x02, ++0xA3, 0xE0, 0x60, 0x2E, 0xE4, 0x90, 0x9A, 0x0E, ++0xF0, 0x51, 0x76, 0x50, 0x28, 0x12, 0xC5, 0x83, ++0xED, 0x24, 0x1C, 0x12, 0xC5, 0x18, 0x90, 0x9A, ++0x0E, 0xE0, 0x24, 0x77, 0xF5, 0x82, 0xE4, 0x34, ++0x95, 0xF5, 0x83, 0xE0, 0x6F, 0x60, 0x03, 0x7F, ++0x00, 0x22, 0x90, 0x9A, 0x0E, 0xE0, 0x04, 0xF0, ++0x80, 0xD7, 0x7F, 0x00, 0x22, 0x90, 0x06, 0x32, ++0xE0, 0x44, 0x40, 0xF0, 0xE4, 0x90, 0x95, 0x75, ++0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x9A, ++0x0E, 0xE0, 0xFD, 0xC3, 0x94, 0x02, 0x22, 0x12, ++0xC7, 0x92, 0xE4, 0xA3, 0xF0, 0x90, 0x9A, 0x0D, ++0xE0, 0xFD, 0xC3, 0x94, 0x04, 0x50, 0x2A, 0x90, ++0x9A, 0x0C, 0xE0, 0x24, 0x10, 0xFF, 0x12, 0xA7, ++0x18, 0xFE, 0x12, 0xC5, 0x19, 0x90, 0x9A, 0x0D, ++0xE0, 0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, 0x95, ++0xF5, 0x83, 0xE0, 0x6F, 0x60, 0x03, 0x7F, 0x00, ++0x22, 0x90, 0x9A, 0x0D, 0xE0, 0x04, 0xF0, 0x80, ++0xCC, 0x7F, 0x01, 0x22, 0x12, 0xC7, 0x92, 0x24, ++0x16, 0xFF, 0xE4, 0x3E, 0x12, 0xA3, 0x3F, 0x90, ++0x95, 0x73, 0xA3, 0xE0, 0xB5, 0x07, 0x1F, 0x90, ++0x9A, 0x0C, 0xE0, 0x24, 0x16, 0xFF, 0x12, 0xA7, ++0x18, 0xFE, 0x12, 0xAF, 0x02, 0x7D, 0x01, 0x12, ++0x04, 0x7E, 0xEF, 0xFD, 0x90, 0x95, 0x73, 0xE0, ++0x6D, 0x70, 0x01, 0xE4, 0x60, 0x03, 0x7F, 0x00, ++0x22, 0x7F, 0x01, 0x22, 0x90, 0x88, 0x8D, 0x74, ++0x18, 0xF0, 0xA3, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, ++0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, ++0xF0, 0x22, 0x12, 0xDF, 0x77, 0x40, 0x41, 0x90, ++0x88, 0x50, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x92, ++0xE0, 0xFF, 0x90, 0x88, 0x50, 0xE0, 0xD3, 0x9F, ++0x50, 0x2E, 0x90, 0x88, 0x48, 0xE0, 0x24, 0x08, ++0xF0, 0x90, 0x88, 0x3F, 0x12, 0xC6, 0x91, 0x33, ++0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0x88, 0x3E, ++0xE0, 0x2F, 0x90, 0x88, 0x4F, 0xF0, 0xFB, 0x90, ++0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, ++0x92, 0x98, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, ++0x22, 0x90, 0x93, 0x08, 0xE0, 0x30, 0xE0, 0x09, ++0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x02, 0x71, ++0x62, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x12, 0x7C, ++0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, ++0x90, 0x9C, 0x31, 0xE0, 0xFD, 0x90, 0x9C, 0x2F, ++0xE0, 0x2D, 0xFD, 0x90, 0x9C, 0x2E, 0xE0, 0x34, ++0x00, 0xCD, 0x24, 0x20, 0xCD, 0x34, 0x00, 0xFC, ++0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, ++0x90, 0x9C, 0x23, 0xE0, 0xFD, 0x12, 0x7B, 0x8B, ++0x90, 0x9C, 0x30, 0xEF, 0xF0, 0x22, 0x90, 0x9A, ++0x35, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x02, 0xE7, ++0x90, 0x9A, 0x35, 0xE4, 0x75, 0xF0, 0x08, 0x02, ++0x02, 0xE7, 0x90, 0x98, 0x0A, 0xE0, 0xFF, 0x90, ++0x92, 0x13, 0x74, 0x08, 0xF0, 0x7B, 0x18, 0x7D, ++0x01, 0x12, 0x66, 0xDB, 0x90, 0x9A, 0x30, 0xEF, ++0xF0, 0x90, 0x98, 0x0A, 0xE0, 0x22, 0xE0, 0xFF, ++0x24, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, ++0x83, 0xE0, 0x90, 0x01, 0xB2, 0xF0, 0x74, 0x15, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, ++0xE0, 0x90, 0x01, 0xB3, 0xF0, 0xE0, 0x22, 0xF0, ++0x74, 0x04, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x22, 0x90, 0x9A, 0x36, 0xE0, ++0x2F, 0xFF, 0x90, 0x9A, 0x35, 0xE0, 0x34, 0x00, ++0xFE, 0x90, 0x9A, 0xB9, 0xF0, 0x22, 0xE0, 0xC3, ++0x9F, 0xFF, 0xE4, 0x94, 0x00, 0xFE, 0xEF, 0x78, ++0x07, 0x22, 0x90, 0x9A, 0x32, 0xE0, 0xFF, 0x24, ++0x3E, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, ++0xE0, 0xFE, 0x22, 0x7D, 0x01, 0x7B, 0x01, 0x7A, ++0x93, 0x79, 0x4F, 0x7E, 0x00, 0x7F, 0x04, 0x12, ++0x86, 0x1C, 0xEF, 0x22, 0xFF, 0x90, 0x92, 0x07, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xE0, 0xC4, ++0x54, 0xF0, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, ++0x81, 0xF5, 0x83, 0xE0, 0x22, 0x35, 0xF0, 0xFA, ++0x7B, 0x01, 0x78, 0x13, 0x7C, 0x9A, 0x7D, 0x01, ++0x22, 0x7E, 0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, ++0x01, 0x7A, 0x93, 0x22, 0x90, 0x9A, 0x35, 0xE4, ++0x75, 0xF0, 0x02, 0x02, 0x02, 0xE7, 0xE4, 0xFF, ++0x12, 0x98, 0x60, 0x90, 0x04, 0x1F, 0x74, 0x20, ++0x22, 0x90, 0x98, 0x37, 0xE0, 0xFF, 0x90, 0x98, ++0x36, 0xE0, 0x4F, 0x22, 0xFD, 0x12, 0x7B, 0x8B, ++0x90, 0x9A, 0x30, 0xEF, 0xF0, 0x22, 0xE0, 0x90, ++0x01, 0xBA, 0xF0, 0x90, 0x88, 0x38, 0xE0, 0x22, ++0x75, 0x46, 0x94, 0x75, 0x47, 0x3C, 0x75, 0x48, ++0x02, 0x22, 0x74, 0xC9, 0x2E, 0xF5, 0x82, 0xE4, ++0x34, 0x95, 0x22, 0x90, 0x9A, 0x32, 0xE0, 0xFF, ++0xC3, 0x94, 0x10, 0x22, 0x90, 0x9C, 0x2D, 0xE0, ++0xFF, 0xC3, 0x94, 0x08, 0x22, 0x90, 0x9A, 0xDC, ++0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x7D, 0x01, 0x7F, ++0x02, 0x02, 0x7C, 0x74, 0x90, 0x88, 0x3C, 0xE0, ++0x90, 0x05, 0x73, 0x22, 0x90, 0x9A, 0xBC, 0xE0, ++0xC3, 0x94, 0x0A, 0x22, 0x74, 0x10, 0xF0, 0x7A, ++0x93, 0x79, 0xF5, 0x22, 0x12, 0x84, 0x67, 0x7A, ++0x9A, 0x79, 0x1C, 0x22, 0xF0, 0xA3, 0xED, 0xF0, ++0xA3, 0xEB, 0xF0, 0x22, 0xF0, 0x90, 0x9C, 0x2D, ++0xE0, 0x04, 0xF0, 0x22, 0xFB, 0x90, 0x92, 0x06, ++0x74, 0x08, 0xF0, 0x22, 0x90, 0x9C, 0x2E, 0xA3, ++0xE0, 0x24, 0xF8, 0x22, 0x27, 0xB4 ++}; ++ ++u4Byte array_length_mp_8723d_fw_wowlan = 32054; ++ ++#endif ++ ++#endif /* end of LOAD_FW_HEADER_FROM_DRIVER */ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.h +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.h 2018-02-11 21:44:27.163146330 +0200 +@@ -0,0 +1,43 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2016 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* You should have received a copy of the GNU General Public License along with ++* this program; if not, write to the Free Software Foundation, Inc., ++* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++* ++* ++******************************************************************************/ ++ ++#ifdef CONFIG_RTL8723D ++ ++#ifndef _FW_HEADER_8723D_H ++#define _FW_HEADER_8723D_H ++ ++#ifdef LOAD_FW_HEADER_FROM_DRIVER ++#if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) ++extern u8 array_mp_8723d_fw_ap[23862]; ++extern u32 array_length_mp_8723d_fw_ap; ++#endif ++ ++#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) || (DM_ODM_SUPPORT_TYPE & (ODM_CE)) ++extern u8 array_mp_8723d_fw_nic[27506]; ++extern u32 array_length_mp_8723d_fw_nic; ++extern u8 array_mp_8723d_fw_wowlan[32334]; ++extern u32 array_length_mp_8723d_fw_wowlan; ++#endif ++#endif /* end of LOAD_FW_HEADER_FROM_DRIVER */ ++ ++#endif ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/Hal8723DPwrSeq.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/Hal8723DPwrSeq.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/Hal8723DPwrSeq.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/Hal8723DPwrSeq.c 2018-02-11 21:44:27.162146314 +0200 +@@ -0,0 +1,91 @@ ++ ++/*++ ++Copyright (c) Realtek Semiconductor Corp. All rights reserved. ++ ++Module Name: ++ Hal8821PwrSeq.c ++ ++Abstract: ++ This file includes all kinds of Power Action event for RTL8821A and corresponding hardware configurtions which are released from HW SD. ++ ++Major Change History: ++ When Who What ++ ---------- --------------- ------------------------------- ++ 2011-08-08 Roger Create. ++ ++--*/ ++ ++#include "Mp_Precomp.h" ++ ++#if WPP_SOFTWARE_TRACE ++ #include "Hal8723DPwrSeq.tmh" ++#endif ++ ++#include "Hal8723DPwrSeq.h" ++ ++ ++/* ++ drivers should parse below arrays and do the corresponding actions ++*/ ++/* 3 Power on Array */ ++WLAN_PWR_CFG rtl8723D_power_on_flow[RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS] = { ++ RTL8723D_TRANS_CARDEMU_TO_ACT ++ RTL8723D_TRANS_END ++}; ++ ++/* 3Radio off GPIO Array */ ++WLAN_PWR_CFG rtl8723D_radio_off_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_END_STEPS] = { ++ RTL8723D_TRANS_ACT_TO_CARDEMU ++ RTL8723D_TRANS_END ++}; ++ ++/* 3Card Disable Array */ ++WLAN_PWR_CFG rtl8723D_card_disable_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_CARDDIS_STEPS + RTL8723D_TRANS_END_STEPS] = { ++ RTL8723D_TRANS_ACT_TO_CARDEMU ++ RTL8723D_TRANS_CARDEMU_TO_CARDDIS ++ RTL8723D_TRANS_END ++}; ++ ++/* 3 Card Enable Array */ ++WLAN_PWR_CFG rtl8723D_card_enable_flow[RTL8723D_TRANS_CARDDIS_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS] = { ++ RTL8723D_TRANS_CARDDIS_TO_CARDEMU ++ RTL8723D_TRANS_CARDEMU_TO_ACT ++ RTL8723D_TRANS_END ++}; ++ ++/* 3Suspend Array */ ++WLAN_PWR_CFG rtl8723D_suspend_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_SUS_STEPS + RTL8723D_TRANS_END_STEPS] = { ++ RTL8723D_TRANS_ACT_TO_CARDEMU ++ RTL8723D_TRANS_CARDEMU_TO_SUS ++ RTL8723D_TRANS_END ++}; ++ ++/* 3 Resume Array */ ++WLAN_PWR_CFG rtl8723D_resume_flow[RTL8723D_TRANS_SUS_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS] = { ++ RTL8723D_TRANS_SUS_TO_CARDEMU ++ RTL8723D_TRANS_CARDEMU_TO_ACT ++ RTL8723D_TRANS_END ++}; ++ ++ ++ ++/* 3HWPDN Array */ ++WLAN_PWR_CFG rtl8723D_hwpdn_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723D_TRANS_END_STEPS] = { ++ RTL8723D_TRANS_ACT_TO_CARDEMU ++ RTL8723D_TRANS_CARDEMU_TO_PDN ++ RTL8723D_TRANS_END ++}; ++ ++/* 3 Enter LPS */ ++WLAN_PWR_CFG rtl8723D_enter_lps_flow[RTL8723D_TRANS_ACT_TO_LPS_STEPS + RTL8723D_TRANS_END_STEPS] = { ++ /* FW behavior */ ++ RTL8723D_TRANS_ACT_TO_LPS ++ RTL8723D_TRANS_END ++}; ++ ++/* 3 Leave LPS */ ++WLAN_PWR_CFG rtl8723D_leave_lps_flow[RTL8723D_TRANS_LPS_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS] = { ++ /* FW behavior */ ++ RTL8723D_TRANS_LPS_TO_ACT ++ RTL8723D_TRANS_END ++}; +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_halinit.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_halinit.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_halinit.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_halinit.c 2018-02-11 21:44:27.163146330 +0200 +@@ -0,0 +1,2255 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _HCI_HAL_INIT_C_ ++ ++#include ++ ++ ++/* For Two MAC FPGA verify we must disable all MAC/BB/RF setting */ ++#define FPGA_UNKNOWN 0 ++#define FPGA_2MAC 1 ++#define FPGA_PHY 2 ++#define ASIC 3 ++#define BOARD_TYPE ASIC ++ ++#if BOARD_TYPE == FPGA_2MAC ++#else /* FPGA_PHY and ASIC */ ++ #define FPGA_RF_UNKNOWN 0 ++ #define FPGA_RF_8225 1 ++ #define FPGA_RF_0222D 2 ++ #define FPGA_RF FPGA_RF_0222D ++#endif ++ ++/* ++ * Description: ++ * ePHY Read operation on RTL8723DE ++ * ++ * Created by Roger, 2013.05.08. ++ */ ++static u2Byte hal_MDIORead_8723DE( ++ IN PADAPTER Adapter, ++ IN u1Byte Addr) ++{ ++ u2Byte ret = 0; ++ u1Byte tmpU1b = 0, count = 0; ++ ++ rtw_write8(Adapter, REG_PCIE_MIX_CFG_8723D, Addr | BIT(6)); ++ tmpU1b = rtw_read8(Adapter, REG_PCIE_MIX_CFG_8723D) & BIT(6); ++ count = 0; ++ while (tmpU1b && count < 20) { ++ rtw_udelay_os(10); ++ tmpU1b = rtw_read8(Adapter, REG_PCIE_MIX_CFG_8723D) & BIT(6); ++ count++; ++ } ++ if (0 == tmpU1b) { ++ /* */ ++ ret = rtw_read16(Adapter, REG_MDIO_V1_8723D + 2); ++ } ++ ++ return ret; ++} ++ ++/* ++ * Description: ++ * ePHY Write operation on RTL8723DE ++ * ++ * Created by Roger, 2013.05.08. ++ */ ++static VOID hal_MDIOWrite_8723DE( ++ IN PADAPTER Adapter, ++ IN u1Byte Addr, ++ IN u2Byte Data) ++{ ++ u1Byte tmpU1b = 0, count = 0; ++ ++ rtw_write16(Adapter, REG_MDIO_V1_8723D, Data); ++ rtw_write8(Adapter, REG_PCIE_MIX_CFG_8723D, Addr | BIT(5)); ++ tmpU1b = rtw_read8(Adapter, REG_PCIE_MIX_CFG_8723D) & BIT(5); ++ count = 0; ++ while (tmpU1b && count < 20) { ++ rtw_udelay_os(10); ++ tmpU1b = rtw_read8(Adapter, REG_PCIE_MIX_CFG_8723D) & BIT(5); ++ count++; ++ } ++} ++ ++/* ------------------------------------------------------------------- */ ++/* */ ++/* EEPROM Content Parsing */ ++/* */ ++/* ------------------------------------------------------------------- */ ++ ++static VOID ++Hal_ReadPROMContent_BT_8723DE( ++ IN PADAPTER Adapter ++) ++{ ++ ++#if MP_DRIVER == 1 ++ if (Adapter->registrypriv.mp_mode == 1) ++ EFUSE_ShadowMapUpdate(Adapter, EFUSE_BT, _FALSE); ++#endif ++ ++} ++ ++static VOID ++hal_ReadIDs_8723DE( ++ IN PADAPTER Adapter, ++ IN u8 *PROMContent, ++ IN BOOLEAN AutoloadFail ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ if (!AutoloadFail) { ++ /* VID, DID */ ++ pHalData->EEPROMVID = ReadLE2Byte(&PROMContent[EEPROM_VID_8723DE]); ++ pHalData->EEPROMDID = ReadLE2Byte(&PROMContent[EEPROM_DID_8723DE]); ++ pHalData->EEPROMSVID = ReadLE2Byte(&PROMContent[EEPROM_SVID_8723DE]); ++ pHalData->EEPROMSMID = ReadLE2Byte(&PROMContent[EEPROM_SMID_8723DE]); ++ ++ /* Customer ID, 0x00 and 0xff are reserved for Realtek. */ ++ pHalData->EEPROMCustomerID = *(u8 *)&PROMContent[EEPROM_CustomID_8723D]; ++ if (pHalData->EEPROMCustomerID == 0xFF) ++ pHalData->EEPROMCustomerID = EEPROM_Default_CustomerID_8188E; ++ pHalData->EEPROMSubCustomerID = EEPROM_Default_SubCustomerID; ++ } else { ++ pHalData->EEPROMVID = 0; ++ pHalData->EEPROMDID = 0; ++ pHalData->EEPROMSVID = 0; ++ pHalData->EEPROMSMID = 0; ++ ++ /* Customer ID, 0x00 and 0xff are reserved for Realtek. */ ++ pHalData->EEPROMCustomerID = EEPROM_Default_CustomerID; ++ pHalData->EEPROMSubCustomerID = EEPROM_Default_SubCustomerID; ++ } ++ ++ RTW_INFO("VID = 0x%04X, DID = 0x%04X\n", pHalData->EEPROMVID, pHalData->EEPROMDID); ++ RTW_INFO("SVID = 0x%04X, SMID = 0x%04X\n", pHalData->EEPROMSVID, pHalData->EEPROMSMID); ++} ++ ++static VOID ++Hal_ReadEfusePCIeCap8723DE( ++ IN PADAPTER Adapter, ++ IN u8 *PROMContent, ++ IN BOOLEAN AutoloadFail ++) ++{ ++ u8 AspmOscSupport = RT_PCI_ASPM_OSC_IGNORE; ++ u16 PCIeCap = 0; ++ ++ if (!AutoloadFail) { ++ PCIeCap = PROMContent[EEPROM_PCIE_DEV_CAP_01] | ++ (PROMContent[EEPROM_PCIE_DEV_CAP_02] << 8); ++ ++ RTW_INFO("Hal_ReadEfusePCIeCap8723DE(): PCIeCap = %#x\n", PCIeCap); ++ ++ /* */ ++ /* We shall take L0S/L1 accept latency into consideration for ASPM Configuration policy, 2013.03.27. */ ++ /* L1 accept Latency: 0x8d from PCI CFG space offset 0x75 */ ++ /* L0S accept Latency: 0x80 from PCI CFG space offset 0x74 */ ++ /* */ ++ if (PCIeCap == 0x8d80) ++ AspmOscSupport |= RT_PCI_ASPM_OSC_ENABLE; ++ else ++ AspmOscSupport |= RT_PCI_ASPM_OSC_DISABLE; ++ } ++ ++ rtw_hal_set_def_var(Adapter, HAL_DEF_PCI_ASPM_OSC, (u8 *)&AspmOscSupport); ++ RTW_INFO("Hal_ReadEfusePCIeCap8723DE(): AspmOscSupport = %d\n", AspmOscSupport); ++} ++ ++static VOID ++hal_CustomizedBehavior_8723DE( ++ PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct led_priv *pledpriv = &(Adapter->ledpriv); ++ ++ pledpriv->LedStrategy = SW_LED_MODE7; /* Default LED strategy. */ ++ pHalData->bLedOpenDrain = _TRUE;/* Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. */ ++ ++ switch (pHalData->CustomerID) { ++ case RT_CID_DEFAULT: ++ break; ++ ++ case RT_CID_CCX: ++ /* pMgntInfo->IndicateByDeauth = _TRUE; */ ++ break; ++ ++ case RT_CID_WHQL: ++ /* Adapter->bInHctTest = _TRUE; */ ++ break; ++ ++ default: ++ /* RTW_INFO("Unknown hardware Type\n"); */ ++ break; ++ } ++ RTW_INFO("hal_CustomizedBehavior_8723DE(): RT Customized ID: 0x%02X\n", pHalData->CustomerID); ++ ++#if 0 ++ if (Adapter->bInHctTest) { ++ pMgntInfo->PowerSaveControl.bInactivePs = FALSE; ++ pMgntInfo->PowerSaveControl.bIPSModeBackup = FALSE; ++ pMgntInfo->PowerSaveControl.bLeisurePs = FALSE; ++ pMgntInfo->PowerSaveControl.bLeisurePsModeBackup = FALSE; ++ pMgntInfo->keepAliveLevel = 0; ++ } ++#endif ++} ++ ++static VOID ++hal_CustomizeByCustomerID_8723DE( ++ IN PADAPTER pAdapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ /* If the customer ID had been changed by registry, do not cover up by EEPROM. */ ++ if (pHalData->CustomerID == RT_CID_DEFAULT) { ++ switch (pHalData->EEPROMCustomerID) { ++ default: ++ pHalData->CustomerID = RT_CID_DEFAULT; ++ break; ++ ++ } ++ } ++ RTW_INFO("MGNT Customer ID: 0x%2x\n", pHalData->CustomerID); ++ ++ hal_CustomizedBehavior_8723DE(pAdapter); ++} ++ ++ ++static VOID ++InitAdapterVariablesByPROM_8723DE( ++ IN PADAPTER Adapter ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ /* RTW_INFO("InitAdapterVariablesByPROM_8723DE()!!\n"); */ ++ ++ Hal_InitPGData(Adapter, pHalData->efuse_eeprom_data); ++ Hal_EfuseParseIDCode(Adapter, pHalData->efuse_eeprom_data); ++ ++ Hal_EfuseParseEEPROMVer_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ hal_ReadIDs_8723DE(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ hal_config_macaddr(Adapter, pHalData->bautoload_fail_flag); ++ Hal_EfuseParseTxPowerInfo_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ Hal_ReadEfusePCIeCap8723DE(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ ++ /* */ ++ /* Read Bluetooth co-exist and initialize */ ++ /* */ ++ Hal_EfuseParseBTCoexistInfo_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ ++ Hal_EfuseParseChnlPlan_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ Hal_EfuseParseXtal_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ Hal_EfuseParsePackageType_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ Hal_EfuseParseThermalMeter_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ Hal_EfuseParseAntennaDiversity_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ hal_CustomizeByCustomerID_8723DE(Adapter); ++ ++#ifdef CONFIG_RF_POWER_TRIM ++ Hal_ReadRFGainOffset(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++#endif /* CONFIG_RF_GAIN_OFFSET */ ++ ++#ifdef CONFIG_RTW_MAC_HIDDEN_RPT ++ hal_read_mac_hidden_rpt(Adapter); ++#endif ++} ++ ++static VOID ++Hal_ReadPROMContent_8723DE( ++ IN PADAPTER Adapter ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ u8 eeValue; ++ ++ ++ eeValue = rtw_read8(Adapter, REG_9346CR); ++ /* To check system boot selection. */ ++ pHalData->EepromOrEfuse = (eeValue & BOOT_FROM_EEPROM) ? _TRUE : _FALSE; ++ pHalData->bautoload_fail_flag = (eeValue & EEPROM_EN) ? _FALSE : _TRUE; ++ ++ RTW_INFO("Boot from %s, Autoload %s !\n", (pHalData->EepromOrEfuse ? "EEPROM" : "EFUSE"), ++ (pHalData->bautoload_fail_flag ? "Fail" : "OK")); ++ ++ /* pHalData->EEType = IS_BOOT_FROM_EEPROM(Adapter) ? EEPROM_93C46 : EEPROM_BOOT_EFUSE; */ ++ ++ InitAdapterVariablesByPROM_8723DE(Adapter); ++} ++ ++static void ReadRFType8723DE(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ ++#if DISABLE_BB_RF ++ pHalData->rf_chip = RF_PSEUDO_11N; ++ pHalData->rf_type = RF_1T1R; ++#else ++ pHalData->rf_chip = RF_6052; ++ pHalData->rf_type = RF_1T1R; ++#endif ++} ++ ++static void ReadAdapterInfo8723DE(PADAPTER Adapter) ++{ ++ /* Read EEPROM size before call any EEPROM function */ ++ Adapter->EepromAddressSize = GetEEPROMSize8723D(Adapter); ++ ++ /* For debug test now!!!!! */ ++ PHY_RFShadowRefresh(Adapter); ++ ++ /* Read all content in Efuse/EEPROM. */ ++ Hal_ReadPROMContent_8723DE(Adapter); ++ ++ Hal_ReadPROMContent_BT_8723DE(Adapter); ++ ++ /* We need to define the RF type after all PROM value is recognized. */ ++ ReadRFType8723DE(Adapter); ++} ++ ++ ++void rtl8723de_interface_configure(PADAPTER Adapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); ++ u16 val_16 = 0; ++ u8 ClkDelayCount = 4; /* default: 4, range: 0~15 */ ++ ++ /* /close ASPM for AMD defaultly */ ++ pdvobjpriv->const_amdpci_aspm = 0; ++ ++ /* / ASPM PS mode. */ ++ /* / 0 - Disable ASPM, 1 - Enable ASPM without Clock Req, */ ++ /* / 2 - Enable ASPM with Clock Req, 3- Alwyas Enable ASPM with Clock Req, */ ++ /* / 4- Always Enable ASPM without Clock Req. */ ++ /* / set default to rtl8188ee:3 RTL8192E:2 */ ++ pdvobjpriv->const_pci_aspm = 0; ++ ++ /* / Setting for PCI-E device */ ++ pdvobjpriv->const_devicepci_aspm_setting = 0x03; ++ ++ /* / Setting for PCI-E bridge */ ++ pdvobjpriv->const_hostpci_aspm_setting = 0x03; ++ ++ /* / In Hw/Sw Radio Off situation. */ ++ /* / 0 - Default, 1 - From ASPM setting without low Mac Pwr, */ ++ /* / 2 - From ASPM setting with low Mac Pwr, 3 - Bus D3 */ ++ /* / set default to RTL8192CE:0 RTL8192SE:2 */ ++ pdvobjpriv->const_hwsw_rfoff_d3 = 0; ++ ++ /* / This setting works for those device with backdoor ASPM setting such as EPHY setting. */ ++ /* / 0: Not support ASPM, 1: Support ASPM, 2: According to chipset. */ ++ pdvobjpriv->const_support_pciaspm = 1; ++ ++ pwrpriv->reg_rfoff = 0; ++ pwrpriv->rfoff_reason = 0; ++ ++ pHalData->bL1OffSupport = _FALSE; ++ ++ if(!IS_A_CUT(pHalData->VersionID) && !IS_B_CUT(pHalData->VersionID)) { ++ val_16 = hal_MDIORead_8723DE(Adapter, 0x9); ++ hal_MDIOWrite_8723DE(Adapter, 0x9, val_16 & (~BIT14)); ++ } ++ ++ /*test 0x8[15:12] = 2*/ ++ val_16 = hal_MDIORead_8723DE(Adapter, 0x8); ++ val_16 &= 0x0FFF; ++ val_16 |= (ClkDelayCount << 12); ++ /*val_16 |= 0x2000;*/ ++ /*val_16 &= 0x2fff;*/ ++ hal_MDIOWrite_8723DE(Adapter, 0x8, val_16); ++ ++} ++ ++VOID ++DisableInterrupt8723DE( ++ IN PADAPTER Adapter ++) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); ++ ++ rtw_write32(Adapter, REG_HIMR0_8723D, IMR_DISABLED_8723D); ++ ++ rtw_write32(Adapter, REG_HIMR1_8723D, IMR_DISABLED_8723D); /* by tynli */ ++ ++ pdvobjpriv->irq_enabled = 0; ++} ++ ++VOID ++ClearInterrupt8723DE( ++ IN PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u32 tmp = 0; ++ ++ tmp = rtw_read32(Adapter, REG_HISR0_8723D); ++ rtw_write32(Adapter, REG_HISR0_8723D, tmp); ++ pHalData->IntArray[0] = 0; ++ ++ tmp = rtw_read32(Adapter, REG_HISR1_8723D); ++ rtw_write32(Adapter, REG_HISR1_8723D, tmp); ++ pHalData->IntArray[1] = 0; ++ ++ tmp = rtw_read32(Adapter, REG_HSISR_8723D); ++ rtw_write32(Adapter, REG_HSISR_8723D, tmp); ++ pHalData->SysIntArray[0] = 0; ++} ++ ++ ++VOID ++EnableInterrupt8723DE( ++ IN PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); ++ ++ pdvobjpriv->irq_enabled = 1; ++ ++ rtw_write32(Adapter, REG_HIMR0_8723D, pHalData->IntrMask[0] & 0xFFFFFFFF); ++ ++ rtw_write32(Adapter, REG_HIMR1_8723D, pHalData->IntrMask[1] & 0xFFFFFFFF); ++ ++ rtw_write32(Adapter, REG_HSISR_8723D, pHalData->SysIntrMask[0] & 0xFFFFFFFF); ++} ++ ++BOOLEAN ++InterruptRecognized8723DE( ++ IN PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ BOOLEAN bRecognized = _FALSE; ++ ++ /* 2013.11.18 Glayrainx suggests that turn off IMR and */ ++ /* restore after cleaning ISR. */ ++ rtw_write32(Adapter, REG_HIMR0_8723D, 0); ++ rtw_write32(Adapter, REG_HIMR1_8723D, 0); ++ ++ pHalData->IntArray[0] = rtw_read32(Adapter, REG_HISR0_8723D); ++ pHalData->IntArray[0] &= pHalData->IntrMask[0]; ++ rtw_write32(Adapter, REG_HISR0_8723D, pHalData->IntArray[0]); ++ ++ /* For HISR extension. Added by tynli. 2009.10.07. */ ++ pHalData->IntArray[1] = rtw_read32(Adapter, REG_HISR1_8723D); ++ pHalData->IntArray[1] &= pHalData->IntrMask[1]; ++ rtw_write32(Adapter, REG_HISR1_8723D, pHalData->IntArray[1]); ++ ++ if (((pHalData->IntArray[0]) & pHalData->IntrMask[0]) != 0 || ++ ((pHalData->IntArray[1]) & pHalData->IntrMask[1]) != 0) ++ bRecognized = _TRUE; ++ ++ rtw_write32(Adapter, REG_HIMR0_8723D, pHalData->IntrMask[0] & 0xFFFFFFFF); ++ rtw_write32(Adapter, REG_HIMR1_8723D, pHalData->IntrMask[1] & 0xFFFFFFFF); ++ ++ return bRecognized; ++} ++ ++VOID ++UpdateInterruptMask8723DE( ++ IN PADAPTER Adapter, ++ IN u32 AddMSR, u32 AddMSR1, ++ IN u32 RemoveMSR, u32 RemoveMSR1 ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ DisableInterrupt8723DE(Adapter); ++ ++ if (AddMSR) ++ pHalData->IntrMask[0] |= AddMSR; ++ ++ if (AddMSR1) ++ pHalData->IntrMask[1] |= AddMSR1; ++ ++ if (RemoveMSR) ++ pHalData->IntrMask[0] &= (~RemoveMSR); ++ ++ if (RemoveMSR1) ++ pHalData->IntrMask[1] &= (~RemoveMSR1); ++ ++ EnableInterrupt8723DE(Adapter); ++} ++ ++static VOID ++HwConfigureRTL8723DE( ++ IN PADAPTER Adapter ++) ++{ ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u32 regRRSR = 0; ++ ++ ++ /* 1 This part need to modified according to the rate set we filtered!! */ ++ /* */ ++ /* Set RRSR, RATR, and BW_OPMODE registers */ ++ /* */ ++ switch (pHalData->CurrentWirelessMode) { ++ case WIRELESS_MODE_B: ++ regRRSR = RATE_ALL_CCK; ++ break; ++ case WIRELESS_MODE_G: ++ regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; ++ break; ++ case WIRELESS_MODE_AUTO: ++ case WIRELESS_MODE_N_24G: ++ regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; ++ break; ++ default: ++ break; ++ } ++ ++ /* Init value for RRSR. */ ++ rtw_write32(Adapter, REG_RRSR, regRRSR); ++ ++ /* ARFB table 9 for 11ac 5G 2SS */ ++ rtw_write32(Adapter, REG_ARFR0_8723D, 0x00000010); ++ rtw_write32(Adapter, REG_ARFR0_8723D + 4, 0x3e0ff000); ++ ++ /* ARFB table 10 for 11ac 5G 1SS */ ++ rtw_write32(Adapter, REG_ARFR1_8723D, 0x00000010); ++ rtw_write32(Adapter, REG_ARFR1_8723D + 4, 0x000ff000); ++ ++ /* Set SLOT time Reg518 0x9 */ ++ rtw_write8(Adapter, REG_SLOT_8723D, 0x09); ++ ++ /* CF-End setting. */ ++ rtw_write16(Adapter, REG_FWHW_TXQ_CTRL_8723D, 0x1F00); ++ ++ /* Set retry limit */ ++ /* 3vivi, 20100928, especially for DTM, performance_ext, To avoid asoc too long to another AP more than 4.1 seconds. */ ++ /* 3we find retry 7 times maybe not enough, so we retry more than 7 times to pass DTM. */ ++ /* if(pMgntInfo->bPSPXlinkMode) */ ++ /* { */ ++ /* pHalData->ShortRetryLimit = 3; */ ++ /* pHalData->LongRetryLimit = 3; */ ++ /* Set retry limit */ ++ /* rtw_write16(Adapter, REG_RL, 0x0303); */ ++ /* } */ ++ /* else */ ++ rtw_write16(Adapter, REG_RL, 0x0707); ++ ++ /* BAR settings */ ++ rtw_write32(Adapter, REG_BAR_MODE_CTRL_8723D, 0x0201ffff); ++ ++ /* Set Data / Response auto rate fallack retry count */ ++ rtw_write32(Adapter, REG_DARFRC, 0x01000000); ++ rtw_write32(Adapter, REG_DARFRC + 4, 0x07060504); ++ rtw_write32(Adapter, REG_RARFRC, 0x01000000); ++ rtw_write32(Adapter, REG_RARFRC + 4, 0x07060504); ++ ++ /* Beacon related, for rate adaptive */ ++ rtw_write8(Adapter, REG_ATIMWND_8723D, 0x2); ++ ++ rtw_write8(Adapter, REG_BCN_MAX_ERR_8723D, 0xff); ++ ++ /* 20100211 Joseph: Change original setting of BCN_CTRL(0x550) from */ ++ /* 0x1e(0x2c for test chip) ro 0x1f(0x2d for test chip). Set BIT0 of this register disable ATIM */ ++ /* function. Since we do not use HIGH_QUEUE anymore, ATIM function is no longer used. */ ++ /* Also, enable ATIM function may invoke HW Tx stop operation. This may cause ping failed */ ++ /* sometimes in long run test. So just disable it now. */ ++ /* PlatformAtomicExchange((pu4Byte)(&pHalData->RegBcnCtrlVal), 0x1d); */ ++ pHalData->RegBcnCtrlVal = 0x1d; ++#ifdef CONFIG_CONCURRENT_MODE ++ rtw_write16(Adapter, REG_BCN_CTRL, 0x1818); /* For 2 PORT TSF SYNC */ ++#else ++ rtw_write8(Adapter, REG_BCN_CTRL, (u8)(pHalData->RegBcnCtrlVal)); ++#endif ++ ++ /* BCN_CTRL1 Reg551 0x10 */ ++ ++ /* TBTT prohibit hold time. Suggested by designer TimChen. */ ++ rtw_write8(Adapter, REG_TBTT_PROHIBIT + 1, 0xff); /* 8 ms */ ++ ++ /* 3 Note */ ++ rtw_write8(Adapter, REG_PIFS_8723D, 0); ++ rtw_write8(Adapter, REG_AGGR_BREAK_TIME_8723D, 0x16); ++ ++ rtw_write16(Adapter, REG_NAV_PROT_LEN_8723D, 0x0040); ++ rtw_write16(Adapter, REG_PROT_MODE_CTRL_8723D, 0x08ff); ++ ++ if (!Adapter->registrypriv.wifi_spec) { ++ /* For Rx TP. Suggested by SD1 Richard. Added by tynli. 2010.04.12. */ ++ rtw_write32(Adapter, REG_FAST_EDCA_CTRL, 0x03086666); ++ } else { ++ /* For WiFi WMM. suggested by timchen. Added by tynli. */ ++ rtw_write32(Adapter, REG_FAST_EDCA_CTRL, 0x0); ++ } ++ ++ /* ACKTO for IOT issue. */ ++ rtw_write8(Adapter, REG_ACKTO_8723D, 0x40); ++ ++ ++ /* Set Spec SIFS (used in NAV) */ ++ /* 92d all set these register 0x1010, check it later */ ++ rtw_write16(Adapter, REG_SPEC_SIFS_8723D, 0x100a); ++ rtw_write16(Adapter, REG_MAC_SPEC_SIFS_8723D, 0x100a); ++ ++ /* Set SIFS for CCK */ ++ rtw_write16(Adapter, REG_SIFS_CTX_8723D, 0x100a); ++ ++ /* Set SIFS for OFDM */ ++ rtw_write16(Adapter, REG_SIFS_TRX_8723D, 0x100a); ++ ++ ++ ++ /* 3 Note Data sheet don't define */ ++ rtw_write8(Adapter, 0x4C7, 0x80); ++ ++ rtw_write8(Adapter, REG_RX_PKT_LIMIT_8723D, 0x17); ++ ++ rtw_write8(Adapter, REG_MAX_AGGR_NUM_8723D, 0x0A); ++ rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8723D, 0x1C); ++ ++ /* Set Multicast Address. 2009.01.07. by tynli. */ ++ rtw_write32(Adapter, REG_MAR_8723D, 0xffffffff); ++ rtw_write32(Adapter, REG_MAR_8723D + 4, 0xffffffff); ++ ++ /* end of win drv */ ++ ++#if 1 ++ ++ /* TXOP */ ++ rtw_write32(Adapter, REG_EDCA_BE_PARAM, 0x005EA42B); ++ rtw_write32(Adapter, REG_EDCA_BK_PARAM, 0x0000A44F); ++ rtw_write32(Adapter, REG_EDCA_VI_PARAM, 0x005EA324); ++ rtw_write32(Adapter, REG_EDCA_VO_PARAM, 0x002FA226); ++#endif ++ ++ /*rtw_write8(Adapter, REG_HT_SINGLE_AMPDU_8723D, 0x80);*/ ++ ++ /*#if (OMNIPEEK_SNIFFER_ENABLED == 1)*/ ++ /* For sniffer parsing legacy rate bandwidth information ++ PHY_SetBBReg(Adapter, 0x834, BIT(26), 0x0); */ ++ /*#endif*/ ++ ++#if (HAL_MAC_ENABLE == 0) ++ rtw_write32(Adapter, REG_MAR, 0xffffffff); ++ rtw_write32(Adapter, REG_MAR + 4, 0xffffffff); ++#endif ++} ++ ++static u32 _InitPowerOn_8723DE(PADAPTER Adapter) ++{ ++#ifdef CONFIG_BT_COEXIST ++ u8 value8; ++ u16 value16; ++ u32 value32; ++#endif ++ u32 status = _SUCCESS; ++ u8 tmpU1b; ++ u16 tmpU2b; ++ u8 bMacPwrCtrlOn = _FALSE; ++ u32 tmp4Byte; ++ ++ rtw_hal_get_hwreg(Adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); ++ if (bMacPwrCtrlOn == _TRUE) ++ return _SUCCESS; ++ ++ rtw_write8(Adapter, REG_RSV_CTRL, 0x0); ++ ++ tmp4Byte = rtw_read32(Adapter, REG_SYS_CFG); ++ ++ if (tmp4Byte & BIT(24)) /* LDO */ ++ rtw_write8(Adapter, 0x7C, 0xC3); ++ else /* SPS */ ++ rtw_write8(Adapter, 0x7C, 0x83); ++ ++ /* HW Power on sequence */ ++ if (!HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, rtl8723D_card_enable_flow)) ++ return _FAIL; ++ ++ /* Release MAC IO register reset */ ++ tmpU1b = rtw_read8(Adapter, REG_CR); ++ tmpU1b = 0xff; ++ rtw_write8(Adapter, REG_CR, tmpU1b); ++ rtw_mdelay_os(2); ++ ++ tmpU1b = 0x7f; ++ rtw_write8(Adapter, REG_HWSEQ_CTRL, tmpU1b); ++ rtw_mdelay_os(2); ++ ++ /* Add for wakeup online */ ++ tmpU1b = rtw_read8(Adapter, REG_SYS_CLKR); ++ rtw_write8(Adapter, REG_SYS_CLKR, (tmpU1b | BIT(3))); ++ tmpU1b = rtw_read8(Adapter, REG_GPIO_MUXCFG + 1); ++ rtw_write8(Adapter, REG_GPIO_MUXCFG + 1, (tmpU1b & ~BIT(4))); ++ ++ /* Release MAC IO register reset */ ++ /* 9. CR 0x100[7:0] = 0xFF; */ ++ /* 10. CR 0x101[1] = 0x01; */ /* Enable SEC block */ ++#if 0 ++ rtw_write16(Adapter, REG_CR, 0x00); ++ tmpU2b = rtw_read16(Adapter, REG_CR); ++ tmpU2b |= (HCI_TXDMA_EN | HCI_RXDMA_EN | TXDMA_EN | RXDMA_EN ++ | PROTOCOL_EN | SCHEDULE_EN | ENSEC | CALTMR_EN ++ | MACTXEN | MACRXEN); ++ rtw_write16(Adapter, REG_CR, tmpU2b); ++#else ++ rtw_write16(Adapter, REG_CR, 0x2ff); ++#endif ++ ++ bMacPwrCtrlOn = _TRUE; ++ rtw_hal_set_hwreg(Adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); ++ ++ return status; ++} ++ ++static u8 ++_RQPN_Init_8723DE( ++ IN PADAPTER Adapter, ++ OUT u8 *pNPQRQPNVaule, ++ OUT u32 *pRQPNValue ++) ++{ ++ u8 i, numNQ = 0, numPubQ = 0, numHQ = 0, numLQ = 0; ++ /* u8* numPageArray; */ ++ ++ if (Adapter->registrypriv.wifi_spec) { ++ numHQ = WMM_NORMAL_PAGE_NUM_HPQ_8723D; /* 0x30 */ ++ numLQ = WMM_NORMAL_PAGE_NUM_LPQ_8723D; /* 0x20 */ ++ numNQ = WMM_NORMAL_PAGE_NUM_NPQ_8723D; /* 0x20 */ ++ } else { ++ numHQ = NORMAL_PAGE_NUM_HPQ_8723D; /* 0x0c */ ++ numLQ = NORMAL_PAGE_NUM_LPQ_8723D; /* 0x02 */ ++ numNQ = NORMAL_PAGE_NUM_NPQ_8723D; /* 0x02 */ ++ } ++ ++ numPubQ = TX_TOTAL_PAGE_NUMBER_8723D - numHQ - numLQ - numNQ; ++ ++ *pNPQRQPNVaule = _NPQ(numNQ); ++ *pRQPNValue = _HPQ(numHQ) | _LPQ(numLQ) | _PUBQ(numPubQ) | LD_RQPN; ++ ++ if (Adapter->registrypriv.wifi_spec) ++ return WMM_NORMAL_TX_PAGE_BOUNDARY_8723D; ++ else ++ return TX_PAGE_BOUNDARY_8723D; ++} ++ ++static s32 ++_LLTWrite_8723DE( ++ IN PADAPTER Adapter, ++ IN u32 address, ++ IN u32 data ++) ++{ ++ s32 status = _SUCCESS; ++ s32 count = 0; ++ u32 value = _LLT_INIT_ADDR(address) | _LLT_INIT_DATA(data) | _LLT_OP(_LLT_WRITE_ACCESS); ++ ++ rtw_write32(Adapter, REG_LLT_INIT, value); ++ ++ /* polling */ ++ do { ++ value = rtw_read32(Adapter, REG_LLT_INIT); ++ if (_LLT_NO_ACTIVE == _LLT_OP_VALUE(value)) ++ break; ++ ++ if (count > POLLING_LLT_THRESHOLD) { ++ status = _FAIL; ++ break; ++ } ++ } while (count++); ++ ++ return status; ++} ++ ++static s32 ++LLT_table_init_8723DE( ++ IN PADAPTER Adapter, ++ IN u8 txpktbuf_bndy, ++ IN u32 RQPN, ++ IN u8 RQPN_NPQ ++) ++{ ++ u16 i, maxPage = 255; ++ s32 status = _SUCCESS; ++ ++ /* 12. TXRKTBUG_PG_BNDY 0x114[31:0] = 0x27FF00F6 /TXRKTBUG_PG_BNDY */ ++ rtw_write8(Adapter, REG_TRXFF_BNDY, txpktbuf_bndy); ++ rtw_write16(Adapter, REG_TRXFF_BNDY + 2, RX_DMA_BOUNDARY_8723D); ++ ++ /* 13. 0x208[15:8] 0x209[7:0] = 0xF6 / Beacon Head for TXDMA */ ++ rtw_write8(Adapter, REG_DWBCN0_CTRL_8723D + 1, txpktbuf_bndy); ++ ++ /* 14. BCNQ_PGBNDY 0x424[7:0] = 0xF6 /BCNQ_PGBNDY */ ++ /* 2009/12/03 Why do we set so large boundary. confilct with document V11. */ ++ rtw_write8(Adapter, REG_BCNQ_BDNY, txpktbuf_bndy); ++ rtw_write8(Adapter, REG_MGQ_BDNY, txpktbuf_bndy); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ rtw_write8(Adapter, REG_BCNQ1_BDNY, txpktbuf_bndy + 8); ++ rtw_write8(Adapter, REG_DWBCN1_CTRL_8723D + 1, txpktbuf_bndy + 8); /* BCN1_HEAD */ ++ /* BIT1- BIT_SW_BCN_SEL_EN */ ++ rtw_write8(Adapter, REG_DWBCN1_CTRL_8723D + 2, rtw_read8(Adapter, REG_DWBCN1_CTRL_8723D + 2) | BIT(1)); ++#endif ++ ++ /* 15. WMAC_LBK_BF_HD 0x45D[7:0] = 0xF6 /WMAC_LBK_BF_HD */ ++ rtw_write8(Adapter, REG_WMAC_LBK_BF_HD, txpktbuf_bndy); ++ ++ /* 16. DRV_INFO_SZ = 0x04 */ ++ rtw_write8(Adapter, REG_RX_DRVINFO_SZ, 0x4); ++ ++ /* auto init LLT */ ++ if (rtl8723d_InitLLTTable(Adapter) == _FAIL) { ++ return _FAIL; ++ } ++ ++ /* Set reserved page for each queue */ ++ /* 11. RQPN 0x200[31:0] = 0x80BD1C1C / load RQPN */ ++ rtw_write32(Adapter, REG_RQPN, RQPN);/* 0x80cb1010);/ 0x80711010);/0x80cb1010); */ ++ ++ if (RQPN_NPQ != 0) ++ rtw_write8(Adapter, REG_RQPN_NPQ, RQPN_NPQ); ++ ++ return _SUCCESS; ++} ++ ++static u32 ++InitMAC_8723DE( ++ IN PADAPTER Adapter ++) ++{ ++ u8 tmpU1b; ++ u16 tmpU2b; ++ struct recv_priv *precvpriv = &Adapter->recvpriv; ++ struct xmit_priv *pxmitpriv = &Adapter->xmitpriv; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ RTW_INFO("=======>InitMAC_8723D()\n"); ++ ++ if (rtw_hal_power_on(Adapter) == _FAIL) { ++ RTW_INFO("_InitPowerOn8723DE fail\n"); ++ return _FAIL; ++ } ++ ++ /* if(!pHalData->bMACFuncEnable) */ ++ { ++ /* System init */ ++ /* 18. LLT_table_init(Adapter); */ ++ u32 RQPN = 0x80EB0808; ++ u8 RQPN_NPQ = 0; ++ u8 TX_PAGE_BOUNDARY = ++ _RQPN_Init_8723DE(Adapter, &RQPN_NPQ, &RQPN); ++ ++ if (LLT_table_init_8723DE(Adapter, TX_PAGE_BOUNDARY, RQPN, RQPN_NPQ) == _FAIL) ++ return _FAIL; ++ } ++ ++ /* Enable Host Interrupt */ ++ rtw_write32(Adapter, REG_HISR0_8723D, 0xffffffff); ++ rtw_write32(Adapter, REG_HISR1_8723D, 0xffffffff); ++ ++ ++ tmpU2b = rtw_read16(Adapter, REG_TRXDMA_CTRL); ++ tmpU2b &= 0xf; ++ if (Adapter->registrypriv.wifi_spec) ++ tmpU2b |= 0xF9B1; ++ else ++ tmpU2b |= 0xF5B1; ++ rtw_write16(Adapter, REG_TRXDMA_CTRL, tmpU2b); ++ ++ ++ /* Reported Tx status from HW for rate adaptive. */ ++ /* 2009/12/03 MH This should be realtive to power on step 14. But in document V11 */ ++ /* still not contain the description.!!! */ ++ rtw_write8(Adapter, REG_FWHW_TXQ_CTRL + 1, 0x1F); ++ ++ /* Set RCR register */ ++ rtw_write32(Adapter, REG_RCR, pHalData->ReceiveConfig); ++ rtw_write16(Adapter, REG_RXFLTMAP0, 0xFFFF); ++ rtw_write16(Adapter, REG_RXFLTMAP1, 0x400); ++ rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); ++ /* Set TCR register */ ++ rtw_write32(Adapter, REG_TCR, pHalData->TransmitConfig); ++ ++ /* */ ++ /* Set TX/RX descriptor physical address(from OS API). */ ++ /* */ ++ rtw_write32(Adapter, REG_BCNQ_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[BCN_QUEUE_INX].dma & DMA_BIT_MASK(32)); ++ rtw_write32(Adapter, REG_MGQ_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[MGT_QUEUE_INX].dma & DMA_BIT_MASK(32)); ++ rtw_write32(Adapter, REG_VOQ_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[VO_QUEUE_INX].dma & DMA_BIT_MASK(32)); ++ rtw_write32(Adapter, REG_VIQ_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[VI_QUEUE_INX].dma & DMA_BIT_MASK(32)); ++ rtw_write32(Adapter, REG_BEQ_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[BE_QUEUE_INX].dma & DMA_BIT_MASK(32)); ++ rtw_write32(Adapter, REG_BKQ_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[BK_QUEUE_INX].dma & DMA_BIT_MASK(32)); ++ rtw_write32(Adapter, REG_HI0Q_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[HIGH_QUEUE_INX].dma & DMA_BIT_MASK(32)); ++ rtw_write32(Adapter, REG_RXQ_RXBD_DESA_8723D, (u64)precvpriv->rx_ring[RX_MPDU_QUEUE].dma & DMA_BIT_MASK(32)); ++ ++#ifdef CONFIG_64BIT_DMA ++ /* 2009/10/28 MH For DMA 64 bits. We need to assign the high 32 bit address */ ++ /* for NIC HW to transmit data to correct path. */ ++ rtw_write32(Adapter, REG_BCNQ_TXBD_DESA_8723D + 4, ++ ((u64)pxmitpriv->tx_ring[BCN_QUEUE_INX].dma) >> 32); ++ rtw_write32(Adapter, REG_MGQ_TXBD_DESA_8723D + 4, ++ ((u64)pxmitpriv->tx_ring[MGT_QUEUE_INX].dma) >> 32); ++ rtw_write32(Adapter, REG_VOQ_TXBD_DESA_8723D + 4, ++ ((u64)pxmitpriv->tx_ring[VO_QUEUE_INX].dma) >> 32); ++ rtw_write32(Adapter, REG_VIQ_TXBD_DESA_8723D + 4, ++ ((u64)pxmitpriv->tx_ring[VI_QUEUE_INX].dma) >> 32); ++ rtw_write32(Adapter, REG_BEQ_TXBD_DESA_8723D + 4, ++ ((u64)pxmitpriv->tx_ring[BE_QUEUE_INX].dma) >> 32); ++ rtw_write32(Adapter, REG_BKQ_TXBD_DESA_8723D + 4, ++ ((u64)pxmitpriv->tx_ring[BK_QUEUE_INX].dma) >> 32); ++ rtw_write32(Adapter, REG_HI0Q_TXBD_DESA_8723D + 4, ++ ((u64)pxmitpriv->tx_ring[HIGH_QUEUE_INX].dma) >> 32); ++ rtw_write32(Adapter, REG_RXQ_RXBD_DESA_8723D + 4, ++ ((u64)precvpriv->rx_ring[RX_MPDU_QUEUE].dma) >> 32); ++ ++#if 1 ++ /* Don't check dma addr, just depends on PCI-host setting */ ++ if (Adapter->dvobj->bdma64) { ++ RTW_INFO("Enable DMA64 bit\n"); ++ ++ PlatformEnableDMA64(Adapter); ++ } ++#else ++ /* check dma addr, and it may fallback to 32bit mode */ ++ ++ /* 2009/10/28 MH If RX descriptor address is not equal to zero. We will enable */ ++ /* DMA 64 bit functuion. */ ++ /* Note: We never saw thd consition which the descripto address are divided into */ ++ /* 4G down and 4G upper separate area. */ ++ if (((u64)precvpriv->rx_ring[RX_MPDU_QUEUE].dma) >> 32 != 0) { ++ /* RTW_INFO("RX_DESC_HA=%08lx\n", ((u64)priv->rx_ring_dma[RX_MPDU_QUEUE])>>32); */ ++ RTW_INFO("Enable DMA64 bit\n"); ++ ++ /* Check if other descriptor address is zero and abnormally be in 4G lower area. */ ++ if (((u64)pxmitpriv->tx_ring[MGT_QUEUE_INX].dma) >> 32) { ++ /* */ ++ RTW_INFO("MGNT_QUEUE HA=0\n"); ++ } ++ ++ PlatformEnableDMA64(Adapter); ++ } else { ++ struct pci_dev *pdev = Adapter->dvobj->ppcidev; ++ ++ RTW_INFO("Enable DMA32 bit (fallback)\n"); ++ ++ if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32))) { ++ if (pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)) != 0) ++ RTW_INFO(KERN_ERR "Unable to obtain 32bit DMA for consistent allocations\n"); ++ } ++ } ++#endif ++#endif ++ ++ /* Reset the Read/Write point to 0 */ ++ rtw_write32(Adapter, REG_BD_RW_PTR_CLR_8723D, 0X3FFFFFFF); ++ ++ tmpU1b = rtw_read8(Adapter, REG_PCIE_CTRL_REG_8723D + 3); ++ rtw_write8(Adapter, REG_PCIE_CTRL_REG_8723D + 3, (tmpU1b | 0xF7)); ++ ++ /* 20100318 Joseph: Reset interrupt migration setting when initialization. Suggested by SD1. */ ++ rtw_write32(Adapter, REG_INT_MIG_8723D, 0); ++ pHalData->bInterruptMigration = _FALSE; ++ ++ /* 2009.10.19. Reset H2C protection register. by tynli. */ ++ rtw_write32(Adapter, REG_MCUTST_1_8723D, 0x0); ++ ++#if MP_DRIVER == 1 ++ if (Adapter->registrypriv.mp_mode == 1) { ++ rtw_write32(Adapter, REG_MACID, 0x87654321); ++ rtw_write32(Adapter, 0x0700, 0x87654321); ++ } ++#endif ++ ++ /* pic buffer descriptor mode: */ ++ /* ---- tx */ ++ rtw_write16(Adapter, REG_MGQ_TXBD_NUM_8723D, (pxmitpriv->txringcount[MGT_QUEUE_INX] & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); ++ rtw_write16(Adapter, REG_VOQ_TXBD_NUM_8723D, (pxmitpriv->txringcount[VO_QUEUE_INX] & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); ++ rtw_write16(Adapter, REG_VIQ_TXBD_NUM_8723D, (pxmitpriv->txringcount[VI_QUEUE_INX] & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); ++ rtw_write16(Adapter, REG_BEQ_TXBD_NUM_8723D, (pxmitpriv->txringcount[BE_QUEUE_INX] & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); ++ rtw_write16(Adapter, REG_BKQ_TXBD_NUM_8723D, (pxmitpriv->txringcount[BK_QUEUE_INX] & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); ++ rtw_write16(Adapter, REG_HI0Q_TXBD_NUM_8723D, (pxmitpriv->txringcount[HIGH_QUEUE_INX] & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); ++#if 0 ++ rtw_write16(Adapter, REG_HI1Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); ++ rtw_write16(Adapter, REG_HI2Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); ++ rtw_write16(Adapter, REG_HI3Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); ++ rtw_write16(Adapter, REG_HI4Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); ++ rtw_write16(Adapter, REG_HI5Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); ++ rtw_write16(Adapter, REG_HI6Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); ++ rtw_write16(Adapter, REG_HI7Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); ++#endif ++ /* ---- rx. support 32 bits in linux */ ++#ifdef CONFIG_64BIT_DMA ++ rtw_write16(Adapter, REG_RX_RXBD_NUM_8723D, (precvpriv->rxringcount & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 13) & 0x6000) | 0x8000); /*using 64bit */ ++#else ++ rtw_write16(Adapter, REG_RX_RXBD_NUM_8723D, (precvpriv->rxringcount & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 13) & 0x6000)); /*using 32bit */ ++#endif ++ ++ /* ---- reset read/write point */ ++ rtw_write32(Adapter, REG_BD_RW_PTR_CLR_8723D, 0XFFFFFFFF); /*Reset read/write point*/ ++ ++ pHalData->RxTag = 0; ++ /* Release Pcie Interface Tx DMA. */ ++#if defined(USING_RX_TAG) ++ rtw_write16(Adapter, REG_PCIE_CTRL_REG_8723D, 0x8000); ++#else ++ rtw_write16(Adapter, REG_PCIE_CTRL_REG_8723D, 0x0000); ++#endif ++ ++ RTW_INFO("InitMAC_8723D() <====\n"); ++ ++ return _SUCCESS; ++} ++ ++/* ++ * Description: ++ * PCI configuration space read operation on RTL8723DE ++ * ++ * Created by Roger, 2013.05.08. ++ */ ++u1Byte ++hal_DBIRead_8723DE( ++ IN PADAPTER Adapter, ++ IN u2Byte Addr ++) ++{ ++ u2Byte ReadAddr = Addr & 0xfffc; ++ u1Byte ret = 0, tmpU1b = 0, count = 0; ++ ++ rtw_write16(Adapter, REG_DBI_FLAG_V1_8723D, ReadAddr); ++ rtw_write8(Adapter, REG_DBI_FLAG_V1_8723D + 2, 0x2); ++ tmpU1b = rtw_read8(Adapter, REG_DBI_FLAG_V1_8723D + 2); ++ count = 0; ++ while (tmpU1b && count < 20) { ++ rtw_udelay_os(10); ++ tmpU1b = rtw_read8(Adapter, REG_DBI_FLAG_V1_8723D + 2); ++ count++; ++ } ++ if (0 == tmpU1b) { ++ ReadAddr = REG_DBI_RDATA_V1_8723D + Addr % 4; ++ ret = rtw_read8(Adapter, ReadAddr); ++ } ++ ++ return ret; ++} ++ ++/* ++ * Description: ++ * PCI configuration space write operation on RTL8723DE ++ * ++ * Created by Roger, 2013.05.08. ++ */ ++VOID ++hal_DBIWrite_8723DE( ++ IN PADAPTER Adapter, ++ IN u2Byte Addr, ++ IN u1Byte Data ++) ++{ ++ u1Byte tmpU1b = 0, count = 0; ++ u2Byte WriteAddr = 0, Remainder = Addr % 4; ++ ++ /* Write DBI 1Byte Data */ ++ WriteAddr = REG_DBI_WDATA_V1_8723D + Remainder; ++ rtw_write8(Adapter, WriteAddr, Data); ++ ++ /* Write DBI 2Byte Address & Write Enable */ ++ WriteAddr = (Addr & 0xfffc) | (BIT(0) << (Remainder + 12)); ++ rtw_write16(Adapter, REG_DBI_FLAG_V1_8723D, WriteAddr); ++ ++ /* Write DBI Write Flag */ ++ rtw_write8(Adapter, REG_DBI_FLAG_V1_8723D + 2, 0x1); ++ ++ tmpU1b = rtw_read8(Adapter, REG_DBI_FLAG_V1_8723D + 2); ++ count = 0; ++ while (tmpU1b && count < 20) { ++ rtw_udelay_os(10); ++ tmpU1b = rtw_read8(Adapter, REG_DBI_FLAG_V1_8723D + 2); ++ count++; ++ } ++} ++ ++VOID ++EnableAspmBackDoor_8723DE(IN PADAPTER Adapter) ++{ ++ ++ u1Byte tmp1byte = 0; ++ u2Byte tmp2byte = 0; ++ ++ ++ /* */ ++ /* Overwrite following ePHY parameter for some platform compatibility issue, */ ++ /* especially when CLKReq is enabled, 2012.11.09. */ ++ /* */ ++ tmp2byte = hal_MDIORead_8723DE(Adapter, 0x0b); ++ if (tmp2byte != 0x70) ++ hal_MDIOWrite_8723DE(Adapter, 0x0b, 0x70); ++ ++ /* Configuration Space offset 0x70f BIT7 is used to control L0S */ ++ tmp1byte = hal_DBIRead_8723DE(Adapter, 0x70f); ++ hal_DBIWrite_8723DE(Adapter, 0x70f, tmp1byte | BIT(7)); ++ ++ /* Configuration Space offset 0x719 Bit3 is for L1 BIT4 is for clock request */ ++ tmp1byte = hal_DBIRead_8723DE(Adapter, 0x719); ++ hal_DBIWrite_8723DE(Adapter, 0x719, tmp1byte | BIT(3) | BIT(4)); ++ ++} ++ ++VOID ++EnableL1Off_8723DE(IN PADAPTER Adapter) ++{ ++ u8 tmpU1b = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ if (pHalData->bL1OffSupport == _FALSE) ++ return; ++ ++ hal_MDIOWrite_8723DE(Adapter, 0x1b, (hal_MDIORead_8723DE(Adapter, 0x1b) | BIT(4))); ++ ++ tmpU1b = hal_DBIRead_8723DE(Adapter, 0x718); ++ hal_DBIWrite_8723DE(Adapter, 0x718, tmpU1b | BIT(5)); ++ ++ tmpU1b = hal_DBIRead_8723DE(Adapter, 0x160); ++ hal_DBIWrite_8723DE(Adapter, 0x160, tmpU1b | 0xf); ++} ++ ++VOID ++SetPciLtr_8723DE( ++ IN PADAPTER Adapter ++ ) ++{ ++ u4Byte tmpU4b = 0; ++ ++ /* Add workaround for 11n Wifi spec, set LTR idle latency to 144us for throughput test ++ * by Hana, 2015/04/17 ++ */ ++ if (Adapter->registrypriv.wifi_spec == 1) { ++ PlatformEFIOWrite4Byte(Adapter, REG_LTR_IDLE_LATENCY_V1_8723D, 0x88908890); ++ } else { ++ /* LTR idle latency, 0x90 for 3ms */ ++ PlatformEFIOWrite4Byte(Adapter, REG_LTR_IDLE_LATENCY_V1_8723D, 0x883C883C); ++ } ++ ++ /* LTR active latency, 0x3c for 64us */ ++ PlatformEFIOWrite4Byte(Adapter, REG_LTR_ACTIVE_LATENCY_V1_8723D, 0x880B880B); ++ ++ /* for HP 8723DE device loss, suggest by Tim lin 20170322 */ ++ PlatformEFIOWrite4Byte(Adapter, REG_LTR_CTRL_BASIC_8723D, 0xCB004010); ++ PlatformEFIOWrite4Byte(Adapter, (REG_LTR_CTRL_BASIC_8723D + 4), 0x01233425); ++} ++ ++/* ++ * Description: Check if PCIe DMA Tx/Rx hang. ++ * The flow is provided by SD1 Alan. Added by tynli. 2013.05.03. ++ */ ++BOOLEAN ++CheckPcieDMAHang8723DE( ++ IN PADAPTER Adapter ++) ++{ ++ u1Byte u1bTmp; ++ ++ /* write reg 0x350 Bit[26]=1. Enable debug port. */ ++ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_DBI_FLAG_V1_8723D + 3); ++ if (!(u1bTmp & BIT(2))) { ++ PlatformEFIOWrite1Byte(Adapter, REG_DBI_FLAG_V1_8723D + 3, (u1bTmp | BIT(2))); ++ rtw_mdelay_os(100); /* Suggested by DD Justin_tsai. */ ++ } ++ ++ /* read reg 0x350 Bit[25] if 1 : RX hang */ ++ /* read reg 0x350 Bit[24] if 1 : TX hang */ ++ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_DBI_FLAG_V1_8723D + 3); ++ if ((u1bTmp & BIT(0)) || (u1bTmp & BIT(1))) { ++ return TRUE; ++ } ++ ++ return FALSE; ++} ++ ++/* */ ++/* Description: Reset Pcie interface DMA. */ ++/* */ ++VOID ++ResetPcieInterfaceDMA8723DE( ++ IN PADAPTER Adapter, ++ IN BOOLEAN bInMACPowerOn ++) ++{ ++ u1Byte u1Tmp; ++ BOOLEAN bReleaseMACRxPause; ++ u1Byte BackUpPcieDMAPause; ++ ++ ++ /* Revise Note: Follow the document "PCIe RX DMA Hang Reset Flow_v03" released by SD1 Alan. */ ++ /* 2013.05.07, by tynli. */ ++ ++ /* 1. disable register write lock */ ++ /* write 0x1C bit[1:0] = 2'h0 */ ++ /* write 0xCC bit[2] = 1'b1 */ ++ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_RSV_CTRL_8723D); ++ u1Tmp &= ~(BIT(1) | BIT(0)); ++ PlatformEFIOWrite1Byte(Adapter, REG_RSV_CTRL_8723D, u1Tmp); ++ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_PMC_DBG_CTRL2_8723D); ++ u1Tmp |= BIT(2); ++ PlatformEFIOWrite1Byte(Adapter, REG_PMC_DBG_CTRL2_8723D, u1Tmp); ++ ++ /* 2. Check and pause TRX DMA */ ++ /* write 0x284 bit[18] = 1'b1 */ ++ /* write 0x301 = 0xFF */ ++ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_RXDMA_CONTROL_8723D); ++ if (u1Tmp & BIT(2)) { ++ /* Already pause before the function for another purpose. */ ++ bReleaseMACRxPause = FALSE; ++ } else { ++ PlatformEFIOWrite1Byte(Adapter, REG_RXDMA_CONTROL_8723D, (u1Tmp | BIT(2))); ++ bReleaseMACRxPause = TRUE; ++ } ++ ++ BackUpPcieDMAPause = PlatformEFIORead1Byte(Adapter, REG_PCIE_CTRL_REG_8723D + 1); ++ if (BackUpPcieDMAPause != 0xFF) ++ PlatformEFIOWrite1Byte(Adapter, REG_PCIE_CTRL_REG_8723D + 1, 0xFF); ++ ++ if (bInMACPowerOn) { ++ /* 3. reset TRX function */ ++ /* write 0x100 = 0x00 */ ++ PlatformEFIOWrite1Byte(Adapter, REG_CR, 0); ++ } ++ ++ /* 4. Reset PCIe DMA */ ++ /* write 0x003 bit[0] = 0 */ ++ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_SYS_FUNC_EN + 1); ++ u1Tmp &= ~(BIT(0)); ++ PlatformEFIOWrite1Byte(Adapter, REG_SYS_FUNC_EN + 1, u1Tmp); ++ ++ /* 5. Enable PCIe DMA */ ++ /* write 0x003 bit[0] = 1 */ ++ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_SYS_FUNC_EN + 1); ++ u1Tmp |= BIT(0); ++ PlatformEFIOWrite1Byte(Adapter, REG_SYS_FUNC_EN + 1, u1Tmp); ++ ++ if (bInMACPowerOn) { ++ /* 6. enable TRX function */ ++ /* write 0x100 = 0xFF */ ++ PlatformEFIOWrite1Byte(Adapter, REG_CR, 0xFF); ++ ++ /* We should init LLT & RQPN and prepare Tx/Rx descrptor address later */ ++ /* because MAC function is reset. */ ++ } ++ ++ /* 7. Restore PCIe autoload down bit */ ++ /* write 0xF8 bit[17] = 1'b1 */ ++ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_MAC_PHY_CTRL_NORMAL + 2); ++ u1Tmp |= BIT(1); ++ PlatformEFIOWrite1Byte(Adapter, REG_MAC_PHY_CTRL_NORMAL + 2, u1Tmp); ++ ++ /* In MAC power on state, BB and RF maybe in ON state, if we release TRx DMA here */ ++ /* it will cause packets to be started to Tx/Rx, so we release Tx/Rx DMA later. */ ++ if (!bInMACPowerOn) { ++ /* 8. release TRX DMA */ ++ /* write 0x284 bit[18] = 1'b0 */ ++ /* write 0x301 = 0x00 */ ++ if (bReleaseMACRxPause) { ++ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_RXDMA_CONTROL_8723D); ++ PlatformEFIOWrite1Byte(Adapter, REG_RXDMA_CONTROL_8723D, (u1Tmp & ~BIT(2))); ++ } ++ PlatformEFIOWrite1Byte(Adapter, REG_PCIE_CTRL_REG_8723D + 1, BackUpPcieDMAPause); ++ } ++ ++ /* 9. lock system register */ ++ /* write 0xCC bit[2] = 1'b0 */ ++ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_PMC_DBG_CTRL2_8723D); ++ u1Tmp &= ~(BIT(2)); ++ PlatformEFIOWrite1Byte(Adapter, REG_PMC_DBG_CTRL2_8723D, u1Tmp); ++ ++} ++VOID ++PHY_InitAntennaSelection8723DE( ++ IN PADAPTER Adapter ++) ++{ ++ ++} ++ ++static VOID _InitBBRegBackup_8723DE(PADAPTER Adapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ /* For Channel 1~11 (Default Value)*/ ++ pHalData->RegForRecover[0].offset = rCCK0_TxFilter2; ++ pHalData->RegForRecover[0].value = ++ PHY_QueryBBReg(Adapter, ++ pHalData->RegForRecover[0].offset, bMaskDWord); ++ ++ pHalData->RegForRecover[1].offset = rCCK0_DebugPort; ++ pHalData->RegForRecover[1].value = ++ PHY_QueryBBReg(Adapter, ++ pHalData->RegForRecover[1].offset, bMaskDWord); ++ ++ pHalData->RegForRecover[2].offset = 0xAAC; ++ pHalData->RegForRecover[2].value = ++ PHY_QueryBBReg(Adapter, ++ pHalData->RegForRecover[2].offset, bMaskDWord); ++#if 0 ++ /* For 20 MHz (Default Value)*/ ++ pHalData->RegForRecover[2].offset = rBBrx_DFIR; ++ pHalData->RegForRecover[2].value = PHY_QueryBBReg(Adapter, pHalData->RegForRecover[2].offset, bMaskDWord); ++ ++ pHalData->RegForRecover[3].offset = rOFDM0_XATxAFE; ++ pHalData->RegForRecover[3].value = PHY_QueryBBReg(Adapter, pHalData->RegForRecover[3].offset, bMaskDWord); ++ ++ pHalData->RegForRecover[4].offset = 0x1E; ++ pHalData->RegForRecover[4].value = PHY_QueryRFReg(Adapter, ODM_RF_PATH_A, pHalData->RegForRecover[4].offset, bRFRegOffsetMask); ++#endif ++} ++ ++/* Set CCK and OFDM Block "ON" */ ++static void _BBTurnOnBlock(PADAPTER padapter) ++{ ++#if (DISABLE_BB_RF) ++ return; ++#endif ++ ++ PHY_SetBBReg(padapter, rFPGA0_RFMOD, bCCKEn, 0x1); ++ PHY_SetBBReg(padapter, rFPGA0_RFMOD, bOFDMEn, 0x1); ++} ++ ++static u32 rtl8723de_hal_init(PADAPTER Adapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); ++ u32 rtStatus = _SUCCESS; ++ u8 tmpU1b, u1bRegCR; ++ u32 u4Tmp; ++ u32 i; ++ BOOLEAN bSupportRemoteWakeUp; ++ u32 NavUpper = WiFiNavUpperUs; ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ ++ ++ /* */ ++ /* No I/O if device has been surprise removed */ ++ /* */ ++ if (rtw_is_surprise_removed(Adapter)) { ++ RTW_INFO("rtl8723de_hal_init(): bSurpriseRemoved!\n"); ++ return _SUCCESS; ++ } ++ ++ Adapter->init_adpt_in_progress = _TRUE; ++ RTW_INFO("=======>rtl8723de_hal_init()\n"); ++ ++ u1bRegCR = rtw_read8(Adapter, REG_CR); ++ RTW_INFO(" power-on :REG_CR 0x100=0x%02x.\n", u1bRegCR); ++ if (/*(tmpU1b&BIT3) && */ (u1bRegCR != 0 && u1bRegCR != 0xEA)) { ++ /* pHalData->bMACFuncEnable = TRUE; */ ++ RTW_INFO(" MAC has already power on.\n"); ++ } else { ++ /* pHalData->bMACFuncEnable = FALSE; */ ++ /* Set FwPSState to ALL_ON mode to prevent from the I/O be return because of 32k */ ++ /* state which is set before sleep under wowlan mode. 2012.01.04. by tynli. */ ++ /* pHalData->FwPSState = FW_PS_STATE_ALL_ON_88E; */ ++ } ++ ++ if (CheckPcieDMAHang8723DE(Adapter)) { ++ /* ResetPcieInterfaceDMA8723DE(Adapter, pHalData->bMACFuncEnable); */ ++ ResetPcieInterfaceDMA8723DE(Adapter, (u1bRegCR != 0 && u1bRegCR != 0xEA)); ++ /* Release pHalData->bMACFuncEnable here because it will reset MAC in ResetPcieInterfaceDMA */ ++ /* function such that we need to allow LLT to be initialized in later flow. */ ++ /* pHalData->bMACFuncEnable = FALSE; */ ++ } ++ ++ /*if(pHalData->bMACFuncEnable == FALSE)*/ ++ { ++ u1Byte u1Tmp; ++ ++ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_HCI_OPT_CTRL_8723D+1); ++ PlatformEFIOWrite1Byte(Adapter, REG_HCI_OPT_CTRL_8723D+1, (u1Tmp|BIT0));/*Disable USB Suspend Signal*/ ++ } ++ ++ /* */ ++ /* 1. MAC Initialize */ ++ /* */ ++ rtStatus = InitMAC_8723DE(Adapter); ++ rtw_write8(Adapter, REG_SECONDARY_CCA_CTRL_8723D, 0x03); ++ rtw_write8(Adapter, 0x976, 0); /* hpfan_todo: 2nd CCA related */ ++ if (rtStatus != _SUCCESS) { ++ RTW_INFO("Init MAC failed\n"); ++ return rtStatus; ++ } ++ ++ /* InitHalDm should be put ahead of FirmwareDownload. (HWConfig flow: FW->MAC->-BB->RF) */ ++ /*rtl8723d_InitHalDm(Adapter);*/ ++ ++#if 0 /* This statement is put on ex_halbtc8723d2ant_pre_load_firmware() */ ++ /* ++ To inform FW about: ++ bit0: "0" for no antenna inverse; "1" for antenna inverse ++ bit1: "0" for internal switch; "1" for external switch ++ bit2: "0" for one antenna; "1" for two antenna ++ */ ++ tmpU1b = 0; ++ if (pHalData->EEPROMBluetoothAntNum == Ant_x2) ++ tmpU1b |= BIT(2); /* two antenna case */ ++ ++ rtw_write8(Adapter, 0x3E0, tmpU1b); ++#endif ++ ++#if HAL_FW_ENABLE ++ if (Adapter->registrypriv.mp_mode == 0 ++ #if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTW_CUSTOMER_STR) ++ || Adapter->registrypriv.mp_customer_str ++ #endif ++ ) { ++ tmpU1b = rtw_read8(Adapter, REG_SYS_CFG); ++ rtw_write8(Adapter, REG_SYS_CFG, tmpU1b & 0x7F); ++ ++ rtStatus = rtl8723d_FirmwareDownload(Adapter, _FALSE); ++ ++ if (rtStatus != _SUCCESS) { ++ RTW_INFO("FwLoad failed\n"); ++ rtStatus = _SUCCESS; ++ Adapter->bFWReady = _FALSE; ++ pHalData->fw_ractrl = _FALSE; ++ } else { ++ RTW_INFO("FwLoad SUCCESSFULLY!!!\n"); ++ Adapter->bFWReady = _TRUE; ++ pHalData->fw_ractrl = _TRUE; ++ } ++ } ++#endif ++ ++ if (pHalData->AMPDUBurstMode) ++ rtw_write8(Adapter, REG_AMPDU_BURST_MODE_8723D, 0x7F); ++ ++ pHalData->CurrentChannel = 0;/* set 0 to trigger switch correct channel */ ++ ++ /* We should call the function before MAC/BB configuration. */ ++ PHY_InitAntennaSelection8723DE(Adapter); ++ ++ /* */ ++ /* 2. Initialize MAC/PHY Config by MACPHY_reg.txt */ ++ /* */ ++#if (HAL_MAC_ENABLE == 1) ++ RTW_INFO("8723D MAC Config Start!\n"); ++ rtStatus = PHY_MACConfig8723D(Adapter); ++ if (rtStatus != _SUCCESS) { ++ RTW_INFO("8723D MAC Config failed\n"); ++ return rtStatus; ++ } ++ RTW_INFO("8723D MAC Config Finished!\n"); ++ ++ /* without this statement, RCR doesn't take effect so that it will show 'validate_recv_ctrl_frame fail'. */ ++ /*rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR) & ~(RCR_ADF));*/ ++#endif /* #if (HAL_MAC_ENABLE == 1) */ ++ ++ /* */ ++ /* 3. Initialize BB After MAC Config PHY_reg.txt, AGC_Tab.txt */ ++ /* */ ++#if (HAL_BB_ENABLE == 1) ++ RTW_INFO("BB Config Start!\n"); ++ rtStatus = PHY_BBConfig8723D(Adapter); ++ if (rtStatus != _SUCCESS) { ++ RTW_INFO("BB Config failed\n"); ++ return rtStatus; ++ } ++ ++ if (Adapter->registrypriv.wifi_spec == 1) ++ ODM_SetBBReg(pDM_Odm, 0xc4c, bMaskDWord, 0x00fe0301); ++ ++ RTW_INFO("BB Config Finished!\n"); ++#endif /* #if (HAL_BB_ENABLE == 1) */ ++ ++ /* */ ++ /* 4. Initiailze RF RAIO_A.txt RF RAIO_B.txt */ ++ /* */ ++#if (HAL_RF_ENABLE == 1) ++ RTW_INFO("RF Config started!\n"); ++ rtStatus = PHY_RFConfig8723D(Adapter); ++ if (rtStatus != _SUCCESS) { ++ RTW_INFO("RF Config failed\n"); ++ return rtStatus; ++ } ++ ++ /*---- Set CCK and OFDM Block "ON"----*/ ++ PHY_SetBBReg(Adapter, rFPGA0_RFMOD, bCCKEn, 0x1); ++ PHY_SetBBReg(Adapter, rFPGA0_RFMOD, bOFDMEn, 0x1); ++ ++ RTW_INFO("RF Config Finished!\n"); ++ ++ pHalData->RfRegChnlVal[0] = PHY_QueryRFReg(Adapter, 0, RF_CHNLBW, bRFRegOffsetMask); ++ pHalData->RfRegChnlVal[1] = PHY_QueryRFReg(Adapter, 1, RF_CHNLBW, bRFRegOffsetMask); ++ /* Defalut BW should be 20MH at first for the value. because HAL bandwidh defalut = 20MH. */ ++ /* ++ pHalData->RfRegChnlVal[0] &= 0xFFF03FF; ++ pHalData->RfRegChnlVal[0] |= (BIT(10) | BIT(11)); ++ */ ++ ++#endif /* #if (HAL_RF_ENABLE == 1) */ ++ ++ _InitBBRegBackup_8723DE(Adapter); ++ ++ _InitMacAPLLSetting_8723D(Adapter); ++ ++ /* 3 Set Hardware(MAC default setting.) */ ++ HwConfigureRTL8723DE(Adapter); ++ ++ rtw_hal_set_chnl_bw(Adapter, Adapter->registrypriv.channel, ++ CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE, HAL_PRIME_CHNL_OFFSET_DONT_CARE); ++ ++ /* We should set pHalData->bMACFuncEnable to TRUE after LLT initialize and Fw download */ ++ /* and before GPIO detect. by tynli. 2011.05.27. */ ++ /* pHalData->bMACFuncEnable = _TRUE; */ ++ ++ _BBTurnOnBlock(Adapter); ++ ++ /* 3Security related */ ++ /* ----------------------------------------------------------------------------- */ ++ /* Set up security related. 070106, by rcnjko: */ ++ /* 1. Clear all H/W keys. */ ++ /* ----------------------------------------------------------------------------- */ ++ invalidate_cam_all(Adapter); ++ ++ /* Joseph debug: MAC_SEC_EN need to be set */ ++ rtw_write8(Adapter, REG_CR + 1, (rtw_read8(Adapter, REG_CR + 1) | BIT(1))); ++ ++ /* 2======================================================= */ ++ /* RF Power Save */ ++ /* 2======================================================= */ ++ /* Fix the bug that Hw/Sw radio off before S3/S4, the RF off action will not be executed */ ++ /* in MgntActSet_RF_State() after wake up, because the value of pHalData->eRFPowerState */ ++ /* is the same as eRfOff, we should change it to eRfOn after we config RF parameters. */ ++ /* Added by tynli. 2010.03.30. */ ++ pwrpriv->rf_pwrstate = rf_on; ++ ++ /* if(pPSC->bGpioRfSw) */ ++ if (0) { ++ tmpU1b = rtw_read8(Adapter, 0x60); ++ pwrpriv->rfoff_reason |= (tmpU1b & BIT(1)) ? 0 : RF_CHANGE_BY_HW; ++ } ++ ++ pwrpriv->rfoff_reason |= (pwrpriv->reg_rfoff) ? RF_CHANGE_BY_SW : 0; ++ ++ if (pwrpriv->rfoff_reason & RF_CHANGE_BY_HW) ++ pwrpriv->b_hw_radio_off = _TRUE; ++ ++ if (pwrpriv->rfoff_reason > RF_CHANGE_BY_PS) { ++ /* H/W or S/W RF OFF before sleep. */ ++ RTW_INFO("InitializeAdapter8188EE(): Turn off RF for RfOffReason(%d) ----------\n", pwrpriv->rfoff_reason); ++ /* MgntActSet_RF_State(Adapter, rf_off, pwrpriv->rfoff_reason, _TRUE); */ ++ } else { ++ pwrpriv->rf_pwrstate = rf_on; ++ pwrpriv->rfoff_reason = 0; ++ ++ RTW_INFO("InitializeAdapter8723DE(): Turn on ----------\n"); ++ ++ /* LED control */ ++ rtw_led_control(Adapter, LED_CTL_POWER_ON); ++ ++ } ++ ++ rtl8723d_InitAntenna_Selection(Adapter); ++ ++ /* Fix the bug that when the system enters S3/S4 then tirgger HW radio off, after system */ ++ /* wakes up, the scan OID will be set from upper layer, but we still in RF OFF state and scan */ ++ /* list is empty, such that the system might consider the NIC is in RF off state and will wait */ ++ /* for several seconds (during this time the scan OID will not be set from upper layer anymore) */ ++ /* even though we have already HW RF ON, so we tell the upper layer our RF state here. */ ++ /* Added by tynli. 2010.04.01. */ ++ /* DrvIFIndicateCurrentPhyStatus(Adapter); */ ++ ++ if (Adapter->registrypriv.hw_wps_pbc) { ++ tmpU1b = rtw_read8(Adapter, GPIO_IO_SEL); ++ tmpU1b &= ~(HAL_8192C_HW_GPIO_WPS_BIT); ++ rtw_write8(Adapter, GPIO_IO_SEL, tmpU1b); /* enable GPIO[2] as input mode */ ++ } ++ ++ /* */ ++ /* Execute TX power tracking later */ ++ /* */ ++ ++ EnableAspmBackDoor_8723DE(Adapter); ++ EnableL1Off_8723DE(Adapter); ++ SetPciLtr_8723DE(Adapter); ++ ++ /* Init BT hw config. */ ++ ++ rtl8723d_InitHalDm(Adapter); ++ ++ Adapter->init_adpt_in_progress = _FALSE; ++ ++#if defined(CONFIG_CONCURRENT_MODE) || defined(CONFIG_TX_MCAST2UNI) ++ ++#ifdef CONFIG_CHECK_AC_LIFETIME ++ /* Enable lifetime check for the four ACs */ ++ rtw_write8(Adapter, REG_LIFETIME_CTRL, rtw_read8(Adapter, REG_LIFETIME_CTRL) | 0x0f); ++#endif /* CONFIG_CHECK_AC_LIFETIME */ ++ ++#ifdef CONFIG_TX_MCAST2UNI ++ rtw_write16(Adapter, REG_PKT_VO_VI_LIFE_TIME, 0x0400); /* unit: 256us. 256ms */ ++ rtw_write16(Adapter, REG_PKT_BE_BK_LIFE_TIME, 0x0400); /* unit: 256us. 256ms */ ++#else /* CONFIG_TX_MCAST2UNI */ ++ rtw_write16(Adapter, REG_PKT_VO_VI_LIFE_TIME, 0x3000); /* unit: 256us. 3s */ ++ rtw_write16(Adapter, REG_PKT_BE_BK_LIFE_TIME, 0x3000); /* unit: 256us. 3s */ ++#endif /* CONFIG_TX_MCAST2UNI */ ++#endif /* CONFIG_CONCURRENT_MODE || CONFIG_TX_MCAST2UNI */ ++ ++ ++ /* enable tx DMA to drop the redundate data of packet */ ++ rtw_write16(Adapter, REG_TXDMA_OFFSET_CHK, (rtw_read16(Adapter, REG_TXDMA_OFFSET_CHK) | DROP_DATA_EN)); ++ ++ pHalData->RegBcnCtrlVal = rtw_read8(Adapter, REG_BCN_CTRL); ++ pHalData->RegTxPause = rtw_read8(Adapter, REG_TXPAUSE); ++ pHalData->RegFwHwTxQCtrl = rtw_read8(Adapter, REG_FWHW_TXQ_CTRL + 2); ++ pHalData->RegReg542 = rtw_read8(Adapter, REG_TBTT_PROHIBIT + 2); ++ ++ /* EnableInterrupt8188EE(Adapter); */ ++ ++#if (MP_DRIVER == 1) ++ if (Adapter->registrypriv.mp_mode == 1) { ++ Adapter->mppriv.channel = pHalData->CurrentChannel; ++ MPT_InitializeAdapter(Adapter, Adapter->mppriv.channel); ++ } else ++#endif ++ { ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(Adapter); ++ ++ pwrctrlpriv->rf_pwrstate = rf_on; ++ ++ if (pwrctrlpriv->rf_pwrstate == rf_on) { ++ struct pwrctrl_priv *pwrpriv; ++ u32 start_time; ++ u8 restore_iqk_rst; ++ u8 b2Ant; ++ u8 h2cCmdBuf; ++ ++ pwrpriv = adapter_to_pwrctl(Adapter); ++ ++ PHY_LCCalibrate_8723D(&pHalData->odmpriv); ++ ++ /* Inform WiFi FW that it is the beginning of IQK */ ++ h2cCmdBuf = 1; ++ FillH2CCmd8723D(Adapter, H2C_8723D_BT_WLAN_CALIBRATION, 1, &h2cCmdBuf); ++ ++ start_time = rtw_get_current_time(); ++ do { ++ if (rtw_read8(Adapter, 0x1e7) & 0x01) ++ break; ++ ++ rtw_msleep_os(50); ++ } while (rtw_get_passing_time_ms(start_time) <= 400); ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_IQKNotify(Adapter, _TRUE); ++#endif ++ restore_iqk_rst = (pwrpriv->bips_processing == _TRUE) ? _TRUE : _FALSE; ++ b2Ant = (pHalData->EEPROMBluetoothAntNum == Ant_x2) ? _TRUE : _FALSE; ++ pHalData->odmpriv.nIQK_Cnt = 0; ++ pHalData->odmpriv.nIQK_OK_Cnt = 0; ++ pHalData->odmpriv.nIQK_Fail_Cnt = 0; ++ PHY_IQCalibrate_8723D(Adapter, _FALSE);/*, restore_iqk_rst, b2Ant, pHalData->ant_path);*/ ++ pHalData->bIQKInitialized = _TRUE; ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_IQKNotify(Adapter, _FALSE); ++#endif ++ ++ /* Inform WiFi FW that it is the finish of IQK */ ++ h2cCmdBuf = 0; ++ FillH2CCmd8723D(Adapter, H2C_8723D_BT_WLAN_CALIBRATION, 1, &h2cCmdBuf); ++ ++ ODM_TXPowerTrackingCheck(&pHalData->odmpriv); ++ } ++ } ++ ++#ifdef CONFIG_BT_COEXIST ++ /* Init BT hw config. */ ++ rtw_btcoex_HAL_Initialize(Adapter, _FALSE); ++#else ++ rtw_btcoex_HAL_Initialize(Adapter, _TRUE); ++#endif ++ ++#if (defined(CONFIG_ANT_DETECTION)) ++ ODM_SingleDualAntennaDefaultSetting(pDM_Odm); ++#endif ++ ++ /* ++ tmpU1b = EFUSE_Read1Byte(Adapter, 0x1FA); ++ ++ if(!(tmpU1b & BIT(0))) ++ { ++ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, 0x15, 0x0F, 0x05); ++ RTW_INFO("PA BIAS path A\n"); ++ } ++ ++ if(!(tmpU1b & BIT(1)) && is2T2R) ++ { ++ PHY_SetRFReg(Adapter, ODM_RF_PATH_B, 0x15, 0x0F, 0x05); ++ RTW_INFO("PA BIAS path B\n"); ++ } ++ */ ++ ++ rtw_hal_set_hwreg(Adapter, HW_VAR_NAV_UPPER, ((u8 *)&NavUpper)); ++ ++ ++ PHY_SetBBReg(Adapter, rOFDM0_XAAGCCore1, bMaskByte0, 0x50); ++ PHY_SetBBReg(Adapter, rOFDM0_XAAGCCore1, bMaskByte0, 0x20); ++ ++ ++ /*{ ++ RTW_INFO("===== Start Dump Reg ====="); ++ for(i = 0 ; i <= 0xeff ; i+=4) ++ { ++ #if 1 ++ u32 tmp; ++ ++ if(i%16==0) ++ printk("\n%04x: ",i); ++ ++ tmp = rtw_read32(Adapter, i); ++ ++ printk("%02X %02X %02X %02X ", ++ ( tmp >> 0 ) & 0xFF, ++ ( tmp >> 8 ) & 0xFF, ++ ( tmp >> 16 ) & 0xFF, ++ ( tmp >> 24 ) & 0xFF ++ ); ++ #else ++ if(i%16==0) ++ RTW_INFO("\n%04x: ",i); ++ RTW_INFO("0x%08x ",rtw_read32(Adapter, i)); ++ #endif ++ } ++ RTW_INFO("\n ===== End Dump Reg =====\n"); ++ }*/ ++ ++ ++ return rtStatus; ++} ++ ++/* ++ * 2009/10/13 MH Acoording to documetn form Scott/Alfred.... ++ * This is based on version 8.1. ++ */ ++ ++ ++ ++ ++VOID ++hal_poweroff_8723DE( ++ IN PADAPTER Adapter ++) ++{ ++ u8 u1bTmp; ++ u8 bMacPwrCtrlOn = _FALSE; ++ ++ rtw_hal_get_hwreg(Adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); ++ if (bMacPwrCtrlOn == _FALSE) ++ return; ++ ++ RTW_INFO("=====>%s\n", __func__); ++ ++ /* pHalData->bMACFuncEnable = _FALSE; */ ++ ++ /* Run LPS WL RFOFF flow */ ++ HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, rtl8723D_enter_lps_flow); ++ ++ ++ ++ /* 0x1F[7:0] = 0 / turn off RF */ ++ /* rtw_write8(Adapter, REG_RF_CTRL_8812, 0x00); */ ++ ++ /* ==== Reset digital sequence ====== */ ++ if ((rtw_read8(Adapter, REG_MCUFWDL) & RAM_DL_SEL) && Adapter->bFWReady) /* 8051 RAM code */ ++ rtl8723d_FirmwareSelfReset(Adapter); ++ ++ /* Reset MCU. Suggested by Filen. 2011.01.26. by tynli. */ ++ u1bTmp = rtw_read8(Adapter, REG_SYS_FUNC_EN + 1); ++ rtw_write8(Adapter, REG_SYS_FUNC_EN + 1, (u1bTmp & (~BIT(2)))); ++ ++ /* MCUFWDL 0x80[1:0]=0 / reset MCU ready status */ ++ rtw_write8(Adapter, REG_MCUFWDL, 0x00); ++ ++ /* HW card disable configuration. */ ++ HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, rtl8723D_card_disable_flow); ++ ++ /* Reset MCU IO Wrapper */ ++ u1bTmp = rtw_read8(Adapter, REG_RSV_CTRL + 1); ++ rtw_write8(Adapter, REG_RSV_CTRL + 1, (u1bTmp & (~BIT(0)))); ++ u1bTmp = rtw_read8(Adapter, REG_RSV_CTRL + 1); ++ rtw_write8(Adapter, REG_RSV_CTRL + 1, u1bTmp | BIT(0)); ++ ++ /* RSV_CTRL 0x1C[7:0] = 0x0E / lock ISO/CLK/Power control register */ ++ rtw_write8(Adapter, REG_RSV_CTRL, 0x0e); ++ ++ Adapter->bFWReady = _FALSE; ++ bMacPwrCtrlOn = _FALSE; ++ rtw_hal_set_hwreg(Adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); ++} ++ ++VOID ++PowerOffAdapter8723DE( ++ IN PADAPTER Adapter ++) ++{ ++ rtw_hal_power_off(Adapter); ++} ++ ++static u32 rtl8723de_hal_deinit(PADAPTER Adapter) ++{ ++ u8 u1bTmp = 0; ++ u32 count = 0; ++ u8 bSupportRemoteWakeUp = _FALSE; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); ++ ++ ++ RTW_INFO("====> %s()\n", __func__); ++ ++ if (Adapter->bHaltInProgress == _TRUE) { ++ RTW_INFO("====> Abort rtl8723de_hal_deinit()\n"); ++ return _FAIL; ++ } ++ ++ Adapter->bHaltInProgress = _TRUE; ++ ++ /* */ ++ /* No I/O if device has been surprise removed */ ++ /* */ ++ if (rtw_is_surprise_removed(Adapter)) { ++ Adapter->bHaltInProgress = _FALSE; ++ return _SUCCESS; ++ } ++ ++ RT_SET_PS_LEVEL(pwrpriv, RT_RF_OFF_LEVL_HALT_NIC); ++ ++ /* Without supporting WoWLAN or the driver is in awake (D0) state, we should */ ++ if (!bSupportRemoteWakeUp) {/* ||!pMgntInfo->bPwrSaveState) */ ++ /* 2009/10/13 MH For power off test. */ ++ PowerOffAdapter8723DE(Adapter); ++ } ++#if 0 ++ else { ++ s32 rtStatus = _SUCCESS; ++ ++ /* -------------------------------------------------------- */ ++ /* 3 <1> Prepare for configuring wowlan related infomations */ ++ /* -------------------------------------------------------- */ ++ ++ /* Clear Fw WoWLAN event. */ ++ rtw_write8(Adapter, REG_MCUTST_WOWLAN, 0x0); ++ ++#if (USE_SPECIFIC_FW_TO_SUPPORT_WOWLAN == 1) ++ SetFwRelatedForWoWLAN8812A(Adapter, _TRUE); ++#endif ++ ++ SetWoWLANCAMEntry8812(Adapter); ++ PlatformEFIOWrite1Byte(Adapter, REG_WKFMCAM_NUM_8812, pPSC->WoLPatternNum); ++ ++ /* Dynamically adjust Tx packet boundary for download reserved page packet. */ ++ rtStatus = DynamicRQPN8812AE(Adapter, 0xE0, 0x3, 0x80c20d0d); /* reserve 30 pages for rsvd page */ ++ if (rtStatus == RT_STATUS_SUCCESS) ++ pHalData->bReInitLLTTable = _TRUE; ++ ++ /* -------------------------------------------------------- */ ++ /* 3 <2> Set Fw releted H2C cmd. */ ++ /* -------------------------------------------------------- */ ++ ++ /* Set WoWLAN related security information. */ ++ SetFwGlobalInfoCmd_8812(Adapter); ++ ++ HalDownloadRSVDPage8812E(Adapter, _TRUE); ++ ++ ++ /* Just enable AOAC related functions when we connect to AP. */ ++ if (pMgntInfo->mAssoc && pMgntInfo->OpMode == RT_OP_MODE_INFRASTRUCTURE) { ++ /* Set Join Bss Rpt H2C cmd and download RSVD page. */ ++ /* Fw will check media status to send null packet and perform WoWLAN LPS. */ ++ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_AID, 0); ++ MacIdIndicateSpecificMediaStatus(Adapter, MAC_ID_STATIC_FOR_DEFAULT_PORT, RT_MEDIA_CONNECT); ++ ++ HalSetFWWoWlanMode8812(Adapter, _TRUE); ++ /* Enable Fw Keep alive mechanism. */ ++ HalSetFwKeepAliveCmd8812(Adapter, _TRUE); ++ ++ /* Enable disconnect decision control. */ ++ SetFwDisconnectDecisionCtrlCmd_8812(Adapter, _TRUE); ++ } ++ ++ /* -------------------------------------------------------- */ ++ /* 3 <3> Hw Configutations */ ++ /* -------------------------------------------------------- */ ++ ++ /* Wait until Rx DMA Finished before host sleep. FW Pause Rx DMA may happens when received packet doing dma. /YJ,add,111101 */ ++ rtw_write8(Adapter, REG_RXDMA_CONTROL_8812A, BIT(2)); ++ ++ u1bTmp = rtw_read8(Adapter, REG_RXDMA_CONTROL_8812A); ++ count = 0; ++ while (!(u1bTmp & BIT(1)) && (count++ < 100)) { ++ rtw_udelay_os(10); /* 10 us */ ++ u1bTmp = rtw_read8(Adapter, REG_RXDMA_CONTROL_8812A); ++ } ++ RTW_INFO("HaltAdapter8812E(): 222 Wait until Rx DMA Finished before host sleep. count=%d\n", count); ++ ++ rtw_write8(Adapter, REG_APS_FSMCO + 1, 0x0); ++ ++ PlatformClearPciPMEStatus(Adapter); ++ ++ /* tynli_test for normal chip wowlan. 2010.01.26. Suggested by Sd1 Isaac and designer Alfred. */ ++ rtw_write8(Adapter, REG_SYS_CLKR, (rtw_read8(Adapter, REG_SYS_CLKR) | BIT(3))); ++ ++ /* prevent 8051 to be reset by PERST# */ ++ rtw_write8(Adapter, REG_RSV_CTRL, 0x20); ++ rtw_write8(Adapter, REG_RSV_CTRL, 0x60); ++ } ++ ++ /* For wowlan+LPS+32k. */ ++ if (bSupportRemoteWakeUp && Adapter->bEnterPnpSleep) { ++ BOOLEAN bEnterFwLPS = TRUE; ++ u1Byte QueueID; ++ PRT_TCB pTcb; ++ ++ ++ /* Set the WoWLAN related function control enable. */ ++ /* It should be the last H2C cmd in the WoWLAN flow. 2012.02.10. by tynli. */ ++ SetFwRemoteWakeCtrlCmd_8723D(Adapter, 1); ++ ++ /* Stop Pcie Interface Tx DMA. */ ++ PlatformEFIOWrite1Byte(Adapter, REG_PCIE_CTRL_REG_8723D + 1, 0xff); ++ ++ /* Wait for TxDMA idle. */ ++ count = 0; ++ do { ++ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_PCIE_CTRL_REG_8723D); ++ PlatformSleepUs(10); /* 10 us */ ++ count++; ++ } while ((u1bTmp != 0) && (count < 100)); ++ ++ /* Set Fw to enter LPS mode. */ ++ if (pMgntInfo->mAssoc && ++ pMgntInfo->OpMode == RT_OP_MODE_INFRASTRUCTURE && ++ (pPSC->WoWLANLPSLevel > 0)) { ++ ++ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_FW_LPS_ACTION, (pu1Byte)(&bEnterFwLPS)); ++ pPSC->bEnterLPSDuringSuspend = TRUE; ++ } ++ ++ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); ++ /* guangan, 2009/08/28, return TCB in busy queue to idle queue when resume from S3/S4. */ ++ for (QueueID = 0; QueueID < MAX_TX_QUEUE; QueueID++) { ++ /* 2004.08.11, revised by rcnjko. */ ++ while (!RTIsListEmpty(&Adapter->TcbBusyQueue[QueueID])) { ++ pTcb = (PRT_TCB)RTRemoveHeadList(&Adapter->TcbBusyQueue[QueueID]); ++ ReturnTCB(Adapter, pTcb, RT_STATUS_SUCCESS); ++ } ++ } ++ ++ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); ++ ++ if (pHalData->HwROFEnable) { ++ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_HSISR_8812 + 3); ++ PlatformEFIOWrite1Byte(Adapter, REG_HSISR_8812 + 3, u1bTmp | BIT(1)); ++ } ++ } ++#endif ++ ++ RTW_INFO("%s() <====\n", __func__); ++ ++ Adapter->bHaltInProgress = _FALSE; ++ ++ ++ return _SUCCESS; ++} ++ ++void SetHwReg8723DE(PADAPTER Adapter, u8 variable, u8 *val) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ ++ switch (variable) { ++ case HW_VAR_SET_RPWM: ++#ifdef CONFIG_LPS_LCLK ++ { ++ u8 ps_state = *((u8 *)val); ++ /* rpwm value only use BIT0(clock bit) ,BIT6(Ack bit), and BIT7(Toggle bit) for 88e. */ ++ /* BIT0 value - 1: 32k, 0:40MHz. */ ++ /* BIT6 value - 1: report cpwm value after success set, 0:do not report. */ ++ /* BIT7 value - Toggle bit change. */ ++ /* modify by Thomas. 2012/4/2. */ ++ ps_state = ps_state & 0xC1; ++ /* RTW_INFO("##### Change RPWM value to = %x for switch clk #####\n",ps_state); */ ++ rtw_write8(Adapter, REG_PCIE_HRPWM, ps_state); ++ } ++#endif ++ break; ++ case HW_VAR_AMPDU_MAX_TIME: { ++ u8 maxRate = *(u8 *)val; ++ ++ rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8723D, 0x70); ++ } ++ break; ++ case HW_VAR_PCIE_STOP_TX_DMA: { ++ u16 tmp16; ++ ++ tmp16 = rtw_read16(Adapter, REG_PCIE_CTRL_REG_8723D); ++ tmp16 |= 0x7FFF; ++ rtw_write16(Adapter, REG_PCIE_CTRL_REG_8723D, tmp16); ++ } ++ break; ++ case HW_VAR_DM_IN_LPS: /* [NOTE] copy from 8723ds */ ++ rtl8723d_hal_dm_in_lps(Adapter); ++ break; ++#ifdef CONFIG_GPIO_WAKEUP ++ case HW_SET_GPIO_WL_CTRL: ++ RTW_INFO("%s: check GPIO pin mux first!!\n", __func__); ++ break; ++#endif ++ default: ++ SetHwReg8723D(Adapter, variable, val); ++ break; ++ } ++ ++} ++ ++void GetHwReg8723DE(PADAPTER Adapter, u8 variable, u8 *val) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ /* DM_ODM_T *podmpriv = &pHalData->odmpriv; */ ++ ++ switch (variable) { ++ default: ++ GetHwReg8723D(Adapter, variable, val); ++ break; ++ } ++ ++} ++ ++/* ++ * Description: ++ * Change default setting of specified variable. ++ */ ++u8 ++SetHalDefVar8723DE( ++ IN PADAPTER Adapter, ++ IN HAL_DEF_VARIABLE eVariable, ++ IN PVOID pValue ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 bResult = _SUCCESS; ++ ++ switch (eVariable) { ++ case HAL_DEF_PCI_SUUPORT_L1_BACKDOOR: ++ pHalData->bSupportBackDoor = *((PBOOLEAN)pValue); ++ break; ++ default: ++ SetHalDefVar8723D(Adapter, eVariable, pValue); ++ break; ++ } ++ ++ return bResult; ++} ++ ++/* ++ * Description: ++ * Query setting of specified variable. ++ */ ++u8 ++GetHalDefVar8723DE( ++ IN PADAPTER Adapter, ++ IN HAL_DEF_VARIABLE eVariable, ++ IN PVOID pValue ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 bResult = _SUCCESS; ++ ++ switch (eVariable) { ++ case HAL_DEF_PCI_SUUPORT_L1_BACKDOOR: ++ *((PBOOLEAN)pValue) = pHalData->bSupportBackDoor; ++ break; ++ ++ case HAL_DEF_PCI_AMD_L1_SUPPORT: ++ *((PBOOLEAN)pValue) = _TRUE;/* Support L1 patch on AMD platform in default, added by Roger, 2012.04.30. */ ++ break; ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ case HAL_DEF_IS_SUPPORT_ANT_DIV: ++ *((u8 *)pValue) = (pHalData->AntDivCfg == 0) ? _FALSE : _TRUE; ++ break; ++#endif ++ case HAL_DEF_DRVINFO_SZ: ++ *((u32 *)pValue) = DRVINFO_SZ; ++ break; ++ ++ default: ++ GetHalDefVar8723D(Adapter, eVariable, pValue); ++ break; ++ } ++ ++ return bResult; ++} ++ ++static void rtl8723de_init_default_value(_adapter *padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ rtl8723d_init_default_value(padapter); ++ ++ pHalData->CurrentWirelessMode = WIRELESS_MODE_AUTO; ++ pHalData->bDefaultAntenna = 1; ++ ++ /* */ ++ /* Set TCR-Transmit Control Register. The value is set in InitializeAdapter8190Pci() */ ++ /* */ ++ pHalData->TransmitConfig = CFENDFORM | BIT(12) | BIT(13); ++ ++ /* */ ++ /* Set RCR-Receive Control Register . The value is set in InitializeAdapter8190Pci(). */ ++ /* */ ++ pHalData->ReceiveConfig = ( ++ /*RCR_APPFCS |*/ ++ RCR_APP_MIC | ++ RCR_APP_ICV | ++ RCR_APP_PHYST_RXFF | ++ /*RCR_VHT_DACK |*/ ++ RCR_HTC_LOC_CTRL | ++ RCR_AMF | ++ /*RCR_ACF |*/ ++ RCR_ADF | /* Note: This bit controls the PS-Poll packet filter. */ ++ /*RCR_AICV |*/ ++ /*RCR_ACRC32 |*/ ++ RCR_CBSSID_BCN | ++ RCR_CBSSID_DATA | ++ RCR_AB | ++ RCR_AM | ++ RCR_APM | ++ 0); ++ ++ ++ /* */ ++ /* Set Interrupt Mask Register */ ++ /* */ ++ pHalData->IntrMaskDefault[0] = (u32)( ++ IMR_PSTIMEOUT_8723D | ++ /* IMR_GTINT4_8723D | */ ++ IMR_GTINT3_8723D | ++ IMR_TXBCN0ERR_8723D | ++ IMR_TXBCN0OK_8723D | ++ IMR_BCNDMAINT0_8723D | ++ IMR_HSISR_IND_ON_INT_8723D | ++ IMR_C2HCMD_8723D | ++ /* IMR_CPWM_8723D | */ ++ IMR_HIGHDOK_8723D | ++ IMR_MGNTDOK_8723D | ++ IMR_BKDOK_8723D | ++ IMR_BEDOK_8723D | ++ IMR_VIDOK_8723D | ++ IMR_VODOK_8723D | ++ IMR_RDU_8723D | ++ IMR_ROK_8723D | ++ 0); ++ pHalData->IntrMaskDefault[1] = (u32)( ++ IMR_RXFOVW_8723D | ++ IMR_TXFOVW_8723D | ++ 0); ++ ++ /* 2012/03/27 hpfan Add for win8 DTM DPC ISR test */ ++ pHalData->IntrMaskReg[0] = (u32)( ++ IMR_RDU_8723D | ++ IMR_PSTIMEOUT_8723D | ++ 0); ++ pHalData->IntrMaskReg[1] = (u32)( ++ IMR_C2HCMD_8723D | ++ 0); ++ ++ /* if (padapter->bUseThreadHandleInterrupt) */ ++ /* { */ ++ /* pHalData->IntrMask[0] = pHalData->IntrMaskReg[0]; */ ++ /* pHalData->IntrMask[1] = pHalData->IntrMaskReg[1]; */ ++ /* } */ ++ /* else */ ++ { ++ pHalData->IntrMask[0] = pHalData->IntrMaskDefault[0]; ++ pHalData->IntrMask[1] = pHalData->IntrMaskDefault[1]; ++ } ++ ++ ++ if (1) {/* IS_HARDWARE_TYPE_8723DE(padapter)) */ ++ ++ pHalData->SysIntrMask[0] = (u32)( ++ HSIMR_PDN_INT_EN | ++ HSIMR_RON_INT_EN | ++ 0); ++ } ++} ++ ++void rtl8723de_set_hal_ops(_adapter *padapter) ++{ ++ struct hal_ops *pHalFunc = &padapter->HalFunc; ++ ++ ++ rtl8723d_set_hal_ops(pHalFunc); ++ ++ pHalFunc->hal_power_on = &_InitPowerOn_8723DE; ++ pHalFunc->hal_power_off = &hal_poweroff_8723DE; ++ pHalFunc->hal_init = &rtl8723de_hal_init; ++ pHalFunc->hal_deinit = &rtl8723de_hal_deinit; ++ ++ pHalFunc->inirp_init = &rtl8723de_init_desc_ring; ++ pHalFunc->inirp_deinit = &rtl8723de_free_desc_ring; ++ pHalFunc->irp_reset = &rtl8723de_reset_desc_ring; ++ ++ pHalFunc->init_xmit_priv = &rtl8723de_init_xmit_priv; ++ pHalFunc->free_xmit_priv = &rtl8723de_free_xmit_priv; ++ ++ pHalFunc->init_recv_priv = &rtl8723de_init_recv_priv; ++ pHalFunc->free_recv_priv = &rtl8723de_free_recv_priv; ++#ifdef CONFIG_SW_LED ++ pHalFunc->InitSwLeds = &rtl8723de_InitSwLeds; ++ pHalFunc->DeInitSwLeds = &rtl8723de_DeInitSwLeds; ++#else /* case of hw led or no led */ ++ pHalFunc->InitSwLeds = NULL; ++ pHalFunc->DeInitSwLeds = NULL; ++#endif/* CONFIG_SW_LED */ ++ ++ pHalFunc->init_default_value = &rtl8723de_init_default_value; ++ pHalFunc->intf_chip_configure = &rtl8723de_interface_configure; ++ pHalFunc->read_adapter_info = &ReadAdapterInfo8723DE; ++ ++ pHalFunc->enable_interrupt = &EnableInterrupt8723DE; ++ pHalFunc->disable_interrupt = &DisableInterrupt8723DE; ++ pHalFunc->interrupt_handler = &rtl8723de_interrupt; ++ ++ pHalFunc->SetHwRegHandler = &SetHwReg8723DE; ++ pHalFunc->GetHwRegHandler = &GetHwReg8723DE; ++ pHalFunc->GetHalDefVarHandler = &GetHalDefVar8723DE; ++ pHalFunc->SetHalDefVarHandler = &SetHalDefVar8723DE; ++ ++ pHalFunc->hal_xmit = &rtl8723de_hal_xmit; ++ pHalFunc->mgnt_xmit = &rtl8723de_mgnt_xmit; ++ pHalFunc->hal_xmitframe_enqueue = &rtl8723de_hal_xmitframe_enqueue; ++ ++#ifdef CONFIG_HOSTAPD_MLME ++ pHalFunc->hostap_mgnt_xmit_entry = &rtl8723de_hostap_mgnt_xmit_entry; ++#endif ++ ++#ifdef CONFIG_XMIT_THREAD_MODE ++ pHalFunc->xmit_thread_handler = &rtl8723de_xmit_buf_handler; ++#endif ++ ++ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_ops_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_ops_linux.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_ops_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_ops_linux.c 2018-02-11 21:44:27.163146330 +0200 +@@ -0,0 +1,954 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _HCI_OPS_OS_C_ ++ ++/*#include */ ++#include ++ ++static int rtl8723de_init_rx_ring(_adapter *padapter) ++{ ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct pci_dev *pdev = pdvobjpriv->ppcidev; ++ struct net_device *dev = padapter->pnetdev; ++ dma_addr_t *mapping = NULL; ++ struct sk_buff *skb = NULL; ++ u8 *rx_bufdesc = NULL; ++ int i, rx_queue_idx; ++ ++ ++ /* rx_queue_idx 0:RX_MPDU_QUEUE */ ++ /* rx_queue_idx 1:RX_CMD_QUEUE */ ++ for (rx_queue_idx = 0; rx_queue_idx < 1/*RX_MAX_QUEUE*/; rx_queue_idx++) { ++ precvpriv->rx_ring[rx_queue_idx].buf_desc = ++ pci_alloc_consistent(pdev, ++ sizeof(*precvpriv->rx_ring[rx_queue_idx].buf_desc) * precvpriv->rxringcount, ++ &precvpriv->rx_ring[rx_queue_idx].dma); ++ ++ if (!precvpriv->rx_ring[rx_queue_idx].buf_desc ++ || (unsigned long)precvpriv->rx_ring[rx_queue_idx].buf_desc & 0xFF) { ++ RTW_INFO("Cannot allocate RX ring\n"); ++ return _FAIL; ++ } ++ ++ _rtw_memset(precvpriv->rx_ring[rx_queue_idx].buf_desc, 0, sizeof(*precvpriv->rx_ring[rx_queue_idx].buf_desc) * precvpriv->rxringcount); ++ precvpriv->rx_ring[rx_queue_idx].idx = 0; ++ ++ for (i = 0; i < precvpriv->rxringcount; i++) { ++ skb = rtw_skb_alloc(precvpriv->rxbuffersize); ++ ++ if (!skb) { ++ RTW_INFO("Cannot allocate skb for RX ring\n"); ++ return _FAIL; ++ } ++ ++ rx_bufdesc = (u8 *)(&precvpriv->rx_ring[rx_queue_idx].buf_desc[i]); ++ ++ precvpriv->rx_ring[rx_queue_idx].rx_buf[i] = skb; ++ ++ mapping = (dma_addr_t *)skb->cb; ++ ++ /* just set skb->cb to mapping addr for pci_unmap_single use */ ++ *mapping = pci_map_single(pdev, skb_tail_pointer(skb), ++ precvpriv->rxbuffersize, ++ PCI_DMA_FROMDEVICE); ++ ++ /* Reset FS, LS, Total len */ ++ SET_RX_BUFFER_DESC_LS_8723D(rx_bufdesc, 0); ++ SET_RX_BUFFER_DESC_FS_8723D(rx_bufdesc, 0); ++ SET_RX_BUFFER_DESC_TOTAL_LENGTH_8723D(rx_bufdesc, 0); ++ SET_RX_BUFFER_DESC_DATA_LENGTH_8723D(rx_bufdesc, precvpriv->rxbuffersize); ++ SET_RX_BUFFER_PHYSICAL_LOW_8723D(rx_bufdesc, ((*mapping) & DMA_BIT_MASK(32))); ++ SET_RX_BUFFER_PHYSICAL_HIGH_8723D(rx_bufdesc, ((*mapping) >> 32)); ++ } ++ } ++ ++ ++ return _SUCCESS; ++} ++ ++static void rtl8723de_free_rx_ring(_adapter *padapter) ++{ ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct pci_dev *pdev = pdvobjpriv->ppcidev; ++ int i, rx_queue_idx; ++ ++ ++ /* rx_queue_idx 0:RX_MPDU_QUEUE */ ++ /* rx_queue_idx 1:RX_CMD_QUEUE */ ++ for (rx_queue_idx = 0; rx_queue_idx < 1/*RX_MAX_QUEUE*/; rx_queue_idx++) { ++ for (i = 0; i < precvpriv->rxringcount; i++) { ++ struct sk_buff *skb = precvpriv->rx_ring[rx_queue_idx].rx_buf[i]; ++ ++ if (!skb) ++ continue; ++ ++ pci_unmap_single(pdev, ++ *((dma_addr_t *) skb->cb), ++ precvpriv->rxbuffersize, ++ PCI_DMA_FROMDEVICE); ++ rtw_skb_free(skb); ++ } ++ ++ pci_free_consistent(pdev, ++ sizeof(*precvpriv->rx_ring[rx_queue_idx].buf_desc) * ++ precvpriv->rxringcount, ++ precvpriv->rx_ring[rx_queue_idx].buf_desc, ++ precvpriv->rx_ring[rx_queue_idx].dma); ++ precvpriv->rx_ring[rx_queue_idx].buf_desc = NULL; ++ } ++ ++} ++ ++ ++static int rtl8723de_init_tx_ring(_adapter *padapter, unsigned int prio, unsigned int entries) ++{ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct pci_dev *pdev = pdvobjpriv->ppcidev; ++ struct tx_buf_desc *ring; ++ dma_addr_t dma; ++ int i; ++ ++ ++ /* RTW_INFO("%s entries num:%d\n", __func__, entries); */ ++ ring = pci_alloc_consistent(pdev, sizeof(*ring) * entries, &dma); ++ if (!ring || (unsigned long)ring & 0xFF) { ++ RTW_INFO("Cannot allocate TX ring (prio = %d)\n", prio); ++ return _FAIL; ++ } ++ ++ _rtw_memset(ring, 0, sizeof(*ring) * entries); ++ pxmitpriv->tx_ring[prio].buf_desc = ring; ++ pxmitpriv->tx_ring[prio].dma = dma; ++ pxmitpriv->tx_ring[prio].idx = 0; ++ pxmitpriv->tx_ring[prio].entries = entries; ++ _rtw_init_queue(&pxmitpriv->tx_ring[prio].queue); ++ pxmitpriv->tx_ring[prio].qlen = 0; ++ pxmitpriv->tx_ring[prio].hw_rp_cache = 0; ++ ++ /* RTW_INFO("%s queue:%d, ring_addr:%p\n", __func__, prio, ring); */ ++ ++ ++ return _SUCCESS; ++} ++ ++static void rtl8723de_free_tx_ring(_adapter *padapter, unsigned int prio) ++{ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct pci_dev *pdev = pdvobjpriv->ppcidev; ++ struct rtw_tx_ring *ring = &pxmitpriv->tx_ring[prio]; ++ u8 *tx_bufdesc; ++ struct xmit_buf *pxmitbuf; ++ ++ ++ while (ring->qlen) { ++ tx_bufdesc = (u8 *)(&ring->buf_desc[ring->idx]); ++ ++ SET_TX_BUFF_DESC_OWN_8723D(tx_bufdesc, 0); ++ ++ if (prio != BCN_QUEUE_INX) ++ ring->idx = (ring->idx + 1) % ring->entries; ++ ++ pxmitbuf = rtl8723de_dequeue_xmitbuf(ring); ++ if (pxmitbuf) { ++ dma_addr_t mapping; ++ ++ mapping = GET_TX_BUFF_DESC_ADDR_LOW_0_8723D(tx_bufdesc); ++ mapping |= (dma_addr_t)GET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(tx_bufdesc) << 32; ++ ++ pci_unmap_single(pdev, mapping, pxmitbuf->len, PCI_DMA_TODEVICE); ++ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); ++ } else ++ RTW_INFO("%s(): qlen(%d) is not zero, but have xmitbuf in pending queue\n", __func__, ring->qlen); ++ } ++ ++ pci_free_consistent(pdev, sizeof(*ring->buf_desc) * ring->entries, ring->buf_desc, ring->dma); ++ ring->buf_desc = NULL; ++ ++} ++ ++static void init_desc_ring_var(_adapter *padapter) ++{ ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ u8 i = 0; ++ ++ for (i = 0; i < HW_QUEUE_ENTRY; i++) ++ pxmitpriv->txringcount[i] = TX_BD_NUM; ++ ++ /* we just alloc 2 desc for beacon queue, */ ++ /* because we just need first desc in hw beacon. */ ++ pxmitpriv->txringcount[BCN_QUEUE_INX] = 2; ++ ++ /* BE queue need more descriptor for performance consideration */ ++ /* or, No more tx desc will happen, and may cause mac80211 mem leakage. */ ++ /* if(!padapter->registrypriv.wifi_spec) */ ++ /* pxmitpriv->txringcount[BE_QUEUE_INX] = TXDESC_NUM_BE_QUEUE; */ ++#ifdef CONFIG_CONCURRENT_MODE ++ pxmitpriv->txringcount[BE_QUEUE_INX] *= 2; ++#endif ++ ++ pxmitpriv->txringcount[TXCMD_QUEUE_INX] = 2; ++ ++ precvpriv->rxbuffersize = MAX_RECVBUF_SZ; /* 2048;*/ /*1024; */ ++ precvpriv->rxringcount = PCI_MAX_RX_COUNT; /* 128; */ ++} ++ ++ ++u32 rtl8723de_init_desc_ring(_adapter *padapter) ++{ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ int i, ret = _SUCCESS; ++ ++ ++ init_desc_ring_var(padapter); ++ ++ ret = rtl8723de_init_rx_ring(padapter); ++ if (ret == _FAIL) ++ return ret; ++ ++ /* general process for other queue */ ++ for (i = 0; i < PCI_MAX_TX_QUEUE_COUNT; i++) { ++ ret = rtl8723de_init_tx_ring(padapter, i, pxmitpriv->txringcount[i]); ++ if (ret == _FAIL) ++ goto err_free_rings; ++ } ++ ++ return ret; ++ ++err_free_rings: ++ ++ rtl8723de_free_rx_ring(padapter); ++ ++ for (i = 0; i < PCI_MAX_TX_QUEUE_COUNT; i++) ++ if (pxmitpriv->tx_ring[i].buf_desc) ++ rtl8723de_free_tx_ring(padapter, i); ++ ++ ++ return ret; ++} ++ ++u32 rtl8723de_free_desc_ring(_adapter *padapter) ++{ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ u32 i; ++ ++ ++ /* free rx rings */ ++ rtl8723de_free_rx_ring(padapter); ++ ++ /* free tx rings */ ++ for (i = 0; i < PCI_MAX_TX_QUEUE_COUNT; i++) ++ rtl8723de_free_tx_ring(padapter, i); ++ ++ ++ return _SUCCESS; ++} ++ ++void rtl8723de_reset_desc_ring(_adapter *padapter) ++{ ++ _irqL irqL; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct xmit_buf *pxmitbuf = NULL; ++ u8 *tx_bufdesc/*, *rx_bufdesc*/; ++ int i, rx_queue_idx; ++ ++ for (rx_queue_idx = 0; rx_queue_idx < 1; rx_queue_idx++) { ++ if (precvpriv->rx_ring[rx_queue_idx].buf_desc) { ++#if 0 ++ rx_bufdesc = NULL; ++ for (i = 0; i < precvpriv->rxringcount; i++) { ++ rx_bufdesc = (u8 *)(&precvpriv->rx_ring[rx_queue_idx].buf_desc[i]); ++ /*SET_RX_BUFFER_DESC_OWN_8723D(rx_bufdesc, 1);*/ ++ } ++#endif ++ precvpriv->rx_ring[rx_queue_idx].idx = 0; ++ } ++ } ++ ++ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); ++ for (i = 0; i < PCI_MAX_TX_QUEUE_COUNT; i++) { ++ if (pxmitpriv->tx_ring[i].buf_desc) { ++ struct rtw_tx_ring *ring = &pxmitpriv->tx_ring[i]; ++ ++ while (ring->qlen) { ++ tx_bufdesc = (u8 *)(&ring->buf_desc[ring->idx]); ++ ++ SET_TX_BUFF_DESC_OWN_8723D(tx_bufdesc, 0); ++ ++ if (i != BCN_QUEUE_INX) ++ ring->idx = (ring->idx + 1) % ring->entries; ++ ++ pxmitbuf = rtl8723de_dequeue_xmitbuf(ring); ++ if (pxmitbuf) { ++ dma_addr_t mapping; ++ ++ mapping = GET_TX_BUFF_DESC_ADDR_LOW_0_8723D(tx_bufdesc); ++ mapping |= (dma_addr_t)GET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(tx_bufdesc) << 32; ++ ++ pci_unmap_single(pdvobjpriv->ppcidev, mapping, pxmitbuf->len, PCI_DMA_TODEVICE); ++ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); ++ } else ++ RTW_INFO("%s(): qlen(%d) is not zero, but have xmitbuf in pending queue\n", __func__, ring->qlen); ++ } ++ ring->idx = 0; ++ ring->hw_rp_cache = 0; ++ } ++ } ++ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); ++ ++ /* Reset read/write point */ ++ rtw_write32(padapter, REG_BD_RW_PTR_CLR_8723D, 0XFFFFFFFF); ++} ++ ++static void rtl8723de_xmit_beacon(PADAPTER Adapter) ++{ ++#if defined(CONFIG_AP_MODE) && defined(CONFIG_NATIVEAP_MLME) ++ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ /* send_beacon(Adapter); */ ++ if (pmlmepriv->update_bcn == _TRUE) { ++ WLAN_BSSID_EX *cur_network = &Adapter->mlmeextpriv.mlmext_info.network; ++ ++ /* prevent beacon IE length is 0! */ ++ if (cur_network->IELength < _FIXED_IE_LENGTH_) { ++ /* RTW_INFO( "%s:%d cur_network->IELength=%u\n", __FUNCTION__, __LINE__, cur_network->IELength ); */ ++ return; ++ } ++ ++ tx_beacon_hdl(Adapter, NULL); ++ } ++ } ++#endif ++} ++ ++void rtl8723de_prepare_bcn_tasklet(void *priv) ++{ ++ _adapter *padapter = (_adapter *)priv; ++ ++ rtl8723de_xmit_beacon(padapter); ++} ++ ++u8 check_tx_desc_resource(_adapter *padapter, int prio) ++{ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct rtw_tx_ring *ring; ++ ++ ring = &pxmitpriv->tx_ring[prio]; ++ ++ /* for now we reserve two free descriptor as a safety boundary */ ++ /* between the tail and the head */ ++ if ((ring->entries - ring->qlen) >= 3) ++ return _TRUE; ++ ++ /* RTW_INFO("do not have enough desc for Tx\n"); */ ++ return _FALSE; ++} ++ ++static u32 rtl8723de_check_txdesc_closed(PADAPTER Adapter, u32 queue_idx, ++ struct rtw_tx_ring *ring) ++{ ++ /* ++ * hw_rp_cache is used to reduce REG access. ++ */ ++ u32 tmp32; ++ ++ /* bcn queue should not enter this function */ ++ if (queue_idx == BCN_QUEUE_INX) ++ return _TRUE; ++ ++ /* qlen == 0 --> don't need to process */ ++ if (ring->qlen == 0) ++ return _FALSE; ++ ++ /* sw_rp == hw_rp_cache --> sync hw_rp */ ++ if (ring->idx == ring->hw_rp_cache) { ++ ++ tmp32 = rtw_read32(Adapter, get_txbufdesc_idx_hwaddr(queue_idx)); ++ ++ ring->hw_rp_cache = (tmp32 >> 16) & 0x0FFF; ++ } ++ ++ /* check if need to handle TXOK */ ++ if (ring->idx == ring->hw_rp_cache) ++ return _FALSE; ++ ++ return _TRUE; ++} ++ ++static void rtl8723de_tx_isr(PADAPTER Adapter, int prio) ++{ ++ struct xmit_priv *pxmitpriv = &Adapter->xmitpriv; ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); ++ struct rtw_tx_ring *ring = &pxmitpriv->tx_ring[prio]; ++ struct xmit_buf *pxmitbuf; ++ u8 *tx_bufdesc; ++ ++ while (ring->qlen) { ++ tx_bufdesc = (u8 *)&ring->buf_desc[ring->idx]; ++ ++ /* beacon packet will only use the first descriptor defautly, */ ++ /* and the OWN may not be cleared by the hardware */ ++ if (prio != BCN_QUEUE_INX) { ++ if (!rtl8723de_check_txdesc_closed(Adapter, prio, ring)) ++ break; ++ ++ ring->idx = (ring->idx + 1) % ring->entries; ++ } else if (prio == BCN_QUEUE_INX) ++ SET_TX_BUFF_DESC_OWN_8723D(tx_bufdesc, 0); ++ ++ pxmitbuf = rtl8723de_dequeue_xmitbuf(ring); ++ if (pxmitbuf) { ++ dma_addr_t mapping; ++ ++ mapping = GET_TX_BUFF_DESC_ADDR_LOW_0_8723D(tx_bufdesc); ++ mapping |= (dma_addr_t)GET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(tx_bufdesc) << 32; ++ ++ pci_unmap_single(pdvobjpriv->ppcidev, mapping, pxmitbuf->len, PCI_DMA_TODEVICE); ++ rtw_sctx_done(&pxmitbuf->sctx); ++ rtw_free_xmitbuf(&(pxmitbuf->padapter->xmitpriv), pxmitbuf); ++ } else ++ RTW_INFO("%s(): qlen(%d) is not zero, but have xmitbuf in pending queue\n", __func__, ring->qlen); ++ } ++ ++ if ((prio != BCN_QUEUE_INX) && check_tx_desc_resource(Adapter, prio) ++ && rtw_xmit_ac_blocked(Adapter) != _TRUE ++ ) ++ rtw_mi_xmit_tasklet_schedule(Adapter); ++} ++ ++ ++s32 rtl8723de_interrupt(PADAPTER Adapter) ++{ ++ _irqL irqL; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); ++ struct xmit_priv *pxmitpriv = &Adapter->xmitpriv; ++ int ret = _SUCCESS; ++ ++ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); ++ ++ /* read ISR: 4/8bytes */ ++ if (InterruptRecognized8723DE(Adapter) == _FALSE) { ++ ret = _FAIL; ++ goto done; ++ } ++ ++ /* <1> beacon related */ ++ if (pHalData->IntArray[0] & IMR_TXBCN0OK_8723D) { ++ /*Modify for MI temporary,this processor cannot apply to multi-ap*/ ++ PADAPTER bcn_adapter = rtw_mi_get_ap_adapter(Adapter); ++ if (bcn_adapter->xmitpriv.beaconDMAing) { ++ bcn_adapter->xmitpriv.beaconDMAing = _FAIL; ++ rtl8723de_tx_isr(Adapter, BCN_QUEUE_INX); ++ } ++ } ++ ++ if (pHalData->IntArray[0] & IMR_TXBCN0ERR_8723D) { ++ /*Modify for MI temporary,this processor cannot apply to multi-ap*/ ++ PADAPTER bcn_adapter = rtw_mi_get_ap_adapter(Adapter); ++ if (bcn_adapter->xmitpriv.beaconDMAing) { ++ bcn_adapter->xmitpriv.beaconDMAing = _FAIL; ++ rtl8723de_tx_isr(Adapter, BCN_QUEUE_INX); ++ } ++ } ++ ++ if (pHalData->IntArray[0] & IMR_BCNDERR0_8723D) { ++ /* Release resource and re-transmit beacon to HW */ ++ struct tasklet_struct *bcn_tasklet; ++ /*Modify for MI temporary,this processor cannot apply to multi-ap*/ ++ PADAPTER bcn_adapter = rtw_mi_get_ap_adapter(Adapter); ++ rtl8723de_tx_isr(Adapter, BCN_QUEUE_INX); ++ bcn_adapter->mlmepriv.update_bcn = _TRUE; ++ bcn_tasklet = &bcn_adapter->recvpriv.irq_prepare_beacon_tasklet; ++ tasklet_hi_schedule(bcn_tasklet); ++ } ++ ++ if (pHalData->IntArray[0] & IMR_BCNDMAINT0_8723D) { ++ struct tasklet_struct *bcn_tasklet; ++ /*Modify for MI temporary,this processor cannot apply to multi-ap*/ ++ PADAPTER bcn_adapter = rtw_mi_get_ap_adapter(Adapter); ++ ++ bcn_tasklet = &bcn_adapter->recvpriv.irq_prepare_beacon_tasklet; ++ tasklet_hi_schedule(bcn_tasklet); ++ } ++ ++ /* <2> Rx related */ ++ if ((pHalData->IntArray[0] & (IMR_ROK_8723D | IMR_RDU_8723D)) || (pHalData->IntArray[1] & IMR_RXFOVW_8723D)) { ++ pHalData->IntrMask[0] &= (~(IMR_ROK_8723D | IMR_RDU_8723D)); ++ pHalData->IntrMask[1] &= (~IMR_RXFOVW_8723D); ++ rtw_write32(Adapter, REG_HIMR0_8723D, pHalData->IntrMask[0]); ++ rtw_write32(Adapter, REG_HIMR1_8723D, pHalData->IntrMask[1]); ++ tasklet_hi_schedule(&Adapter->recvpriv.recv_tasklet); ++ } ++ ++ /* <3> Tx related */ ++ if (pHalData->IntArray[1] & IMR_TXFOVW_8723D) { ++ /* */ ++ /* RTW_INFO("IMR_TXFOVW!\n"); */ ++ } ++ ++ /* if (pisr_content->IntArray[0] & IMR_TX_MASK) { */ ++ /* tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); */ ++ /* } */ ++ ++ if (pHalData->IntArray[0] & IMR_MGNTDOK_8723D) { ++ /* RTW_INFO("Manage ok interrupt!\n"); */ ++ rtl8723de_tx_isr(Adapter, MGT_QUEUE_INX); ++ } ++ ++ if (pHalData->IntArray[0] & IMR_HIGHDOK_8723D) { ++ /* RTW_INFO("HIGH_QUEUE ok interrupt!\n"); */ ++ rtl8723de_tx_isr(Adapter, HIGH_QUEUE_INX); ++ } ++ ++ if (pHalData->IntArray[0] & IMR_BKDOK_8723D) { ++ /* RTW_INFO("BK Tx OK interrupt!\n"); */ ++ rtl8723de_tx_isr(Adapter, BK_QUEUE_INX); ++ } ++ ++ if (pHalData->IntArray[0] & IMR_BEDOK_8723D) { ++ /* RTW_INFO("BE TX OK interrupt!\n"); */ ++ rtl8723de_tx_isr(Adapter, BE_QUEUE_INX); ++ } ++ ++ if (pHalData->IntArray[0] & IMR_VIDOK_8723D) { ++ /* RTW_INFO("VI TX OK interrupt!\n"); */ ++ rtl8723de_tx_isr(Adapter, VI_QUEUE_INX); ++ } ++ ++ if (pHalData->IntArray[0] & IMR_VODOK_8723D) { ++ /* RTW_INFO("Vo TX OK interrupt!\n"); */ ++ rtl8723de_tx_isr(Adapter, VO_QUEUE_INX); ++ } ++ ++done: ++ ++ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); ++ ++ return ret; ++} ++ ++/* ++ * Wait until rx data is ready ++ * return value: _SUCCESS if Rx packet is ready, _FAIL if not ready ++ */ ++ ++static u32 ++rtl8723de_wait_rxrdy( ++ _adapter *padapter, ++ u8 *rx_bufdesc, ++ u16 rx_queue_idx ++) ++{ ++ ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ u8 first_seg, last_seg; ++#ifdef USING_RX_TAG ++ u16 rx_tag; ++#else ++ u16 total_len; ++#endif ++ u16 read_cnt = 0; ++ u16 status = _SUCCESS; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ if (rx_bufdesc == NULL) ++ return _FAIL; ++ ++#ifdef USING_RX_TAG ++ rx_tag = (u2Byte)GET_RX_BUFFER_DESC_RX_TAG_8723D(rx_bufdesc); ++#else ++ total_len = (u2Byte)GET_RX_BUFFER_DESC_TOTAL_LENGTH_8723D(rx_bufdesc); ++#endif ++ first_seg = (u1Byte)GET_RX_BUFFER_DESC_FS_8723D(rx_bufdesc); ++ last_seg = (u1Byte)GET_RX_BUFFER_DESC_LS_8723D(rx_bufdesc); ++ ++ /*buf_desc_debug("RX:%s enter: rx_buf_desc addr = %p, total_len=%d, first_seg=%d, last_seg=%d, read_cnt %d, index %d, address %p\n",\ ++ __FUNCTION__, (u8 *)&precvpriv->rx_ring[rx_queue_idx].desc[precvpriv->rx_ring[rx_queue_idx].idx], total_len, first_seg, last_seg, read_cnt, precvpriv->rx_ring[rx_queue_idx].idx, rx_bufdesc);*/ ++ ++#if defined(USING_RX_TAG) ++ while (rx_tag != pHalData->RxTag) { ++ ++ read_cnt++; ++ ++ rx_tag = (u2Byte)GET_RX_BUFFER_DESC_RX_TAG_8723D(rx_bufdesc); ++ ++ first_seg = (u1Byte)GET_RX_BUFFER_DESC_FS_8723D(rx_bufdesc); ++ ++ last_seg = (u1Byte)GET_RX_BUFFER_DESC_LS_8723D(rx_bufdesc); ++ ++ ++ if (read_cnt > 100) { ++ RTW_INFO("RX:%s(%d) Before sync RxTag:sw=%X,hw=%X\n", __func__, __LINE__, pHalData->RxTag, rx_tag); ++ break; ++ } ++ } ++ ++ pHalData->RxTag = (rx_tag + 1) & 0x1FFF; /* rx tag occpies 13 bits [28:16] */ ++#else ++ while (total_len == 0 && first_seg == 0 && last_seg == 0) { ++ ++ read_cnt++; ++ ++ total_len = (u2Byte)GET_RX_BUFFER_DESC_TOTAL_LENGTH_8723D(rx_bufdesc); ++ ++ first_seg = (u1Byte)GET_RX_BUFFER_DESC_FS_8723D(rx_bufdesc); ++ ++ last_seg = (u1Byte)GET_RX_BUFFER_DESC_LS_8723D(rx_bufdesc); ++ ++ if (read_cnt > 20) { ++ status = _FAIL; ++ break; ++ } ++ } ++#endif ++ ++ /* ++ buf_desc_debug("RX:%s exit total_len=%d, rx_tag = %d, first_seg=%d, last_seg=%d, read_cnt %d\n",\ ++ __FUNCTION__, total_len, pHalData->RxTag, first_seg, last_seg, read_cnt); ++ */ ++ ++ return status; ++} ++ ++/* ++ * Check the number of rxdec to be handled between ++ * "index of RX queue descriptor maintained by host (write pointer)" and ++ * "index of RX queue descriptor maintained by hardware (read pointer)" ++ */ ++static u16 rtl8723de_check_rxdesc_remain(_adapter *padapter, struct rtw_rx_ring *prxring) ++{ ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ u16 desc_idx_hw_wp, desc_idx_host_rp; ++ u32 tmp_4bytes; ++ ++ int num_rxdesc_to_handle; ++ ++ tmp_4bytes = rtw_read32(padapter, REG_RXQ_TXBD_IDX_8723D); ++ desc_idx_hw_wp = (u16)((tmp_4bytes >> 16) & 0x7ff); ++ desc_idx_host_rp = (u16)(tmp_4bytes & 0x7ff); ++ ++ /* make sure driver does not handle packet if hardware pointer keeps in zero */ ++ /* in initial state */ ++ /*buf_desc_debug("RX:%s(%d) reg_value %x\n", __FUNCTION__, __LINE__, tmp_4bytes);*/ ++ ++ num_rxdesc_to_handle = desc_idx_hw_wp - desc_idx_host_rp; ++ ++ if (num_rxdesc_to_handle == 0) ++ return 0; /* No RX */ ++ ++ if (num_rxdesc_to_handle < 0) /* wrap-around case */ ++ num_rxdesc_to_handle += RX_BD_NUM; ++ ++ if (prxring->idx != desc_idx_host_rp) { ++ prxring->idx = desc_idx_host_rp; ++ RTW_INFO("RX: %s(%d) host_rp is inconsistent: sw=%X, hw=%X\n", ++ __func__, __LINE__, prxring->idx, desc_idx_host_rp); ++ } ++ ++ /* buf_desc_debug("RX:%s reg_value %x, last_desc_idx_hw = %x, current hw idx %x, current host idx %x, remain desc to handle = %d\n",\ ++ __FUNCTION__, tmp_4bytes, last_idx_hw, desc_idx_hw, desc_idx_host, num_rxdesc_to_handle); */ ++ ++ return (u16)num_rxdesc_to_handle; ++} ++ ++static void rtl8723de_rx_mpdu(_adapter *padapter) ++{ ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ _queue *pfree_recv_queue = &precvpriv->free_recv_queue; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ union recv_frame *precvframe = NULL; ++ u8 *pphy_info = NULL; ++ struct rx_pkt_attrib *pattrib = NULL; ++ int rx_queue_idx = RX_MPDU_QUEUE; ++ u16 remaing_rxdesc = 0; ++ struct rtw_rx_ring *prxring; ++ ++ prxring = &precvpriv->rx_ring[rx_queue_idx]; ++ ++ remaing_rxdesc = rtl8723de_check_rxdesc_remain(padapter, prxring); ++ ++ /* RX NORMAL PKT */ ++ while (remaing_rxdesc) { ++ u8 *rx_bufdesc = (u8 *)&prxring->buf_desc[prxring->idx];/* rx descriptor */ ++ struct sk_buff *skb = prxring->rx_buf[prxring->idx];/* rx pkt */ ++ ++ if (rtl8723de_wait_rxrdy(padapter, rx_bufdesc, rx_queue_idx) != _SUCCESS) ++ RTW_INFO("RX:%s(%d) packet not ready\n", __func__, __LINE__); ++ ++ { ++ precvframe = rtw_alloc_recvframe(pfree_recv_queue); ++ if (precvframe == NULL) { ++ RTW_INFO("%s: precvframe==NULL\n", __func__); ++ goto done; ++ } ++ ++ _rtw_init_listhead(&precvframe->u.hdr.list); ++ precvframe->u.hdr.len = 0; ++ ++ pci_unmap_single(pdvobjpriv->ppcidev, ++ *((dma_addr_t *)skb->cb), ++ precvpriv->rxbuffersize, ++ PCI_DMA_FROMDEVICE); ++ ++ rtl8723d_query_rx_desc_status(precvframe, skb->data); ++ pattrib = &precvframe->u.hdr.attrib; ++ ++#ifdef CONFIG_RX_PACKET_APPEND_FCS ++ if (check_fwstate(&padapter->mlmepriv, WIFI_MONITOR_STATE) == _FALSE) ++ if ((pattrib->pkt_rpt_type == NORMAL_RX) && (pHalData->ReceiveConfig & RCR_APPFCS)) ++ pattrib->pkt_len -= IEEE80211_FCS_LEN; ++#endif ++ ++ if (rtw_os_alloc_recvframe(padapter, precvframe, ++ (skb->data + RXDESC_SIZE + pattrib->drvinfo_sz + pattrib->shift_sz), skb) == _FAIL) { ++ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); ++ RTW_INFO("rtl8723de_rx_mpdu:can not allocate memory for skb copy\n"); ++ *((dma_addr_t *) skb->cb) = pci_map_single(pdvobjpriv->ppcidev, skb_tail_pointer(skb), precvpriv->rxbuffersize, PCI_DMA_FROMDEVICE); ++ goto done; ++ } ++ ++ recvframe_put(precvframe, pattrib->pkt_len); ++ ++ /* Normal rx packet */ ++ if (pattrib->pkt_rpt_type == NORMAL_RX) { ++ if (pattrib->physt) ++ pphy_info = (u8 *)(skb->data) + RXDESC_SIZE; ++#ifdef CONFIG_CONCURRENT_MODE ++ pre_recv_entry(precvframe, pphy_info); ++#endif ++ ++ if (pattrib->physt && pphy_info) ++ rx_query_phy_status(precvframe, pphy_info); ++ ++ rtw_recv_entry(precvframe); ++ } else { ++#ifdef CONFIG_FW_C2H_PKT ++ if (pattrib->pkt_rpt_type == C2H_PACKET) ++ rtw_hal_c2h_pkt_pre_hdl(padapter, precvframe->u.hdr.rx_data, pattrib->pkt_len); ++ else { ++ RTW_INFO("%s: [WARNNING] RX type(%d) not be handled!\n", ++ __func__, pattrib->pkt_rpt_type); ++ } ++#endif ++ rtw_free_recvframe(precvframe, pfree_recv_queue); ++ } ++ ++ *((dma_addr_t *) skb->cb) = pci_map_single(pdvobjpriv->ppcidev, skb_tail_pointer(skb), precvpriv->rxbuffersize, PCI_DMA_FROMDEVICE); ++ } ++done: ++ ++ SET_RX_BUFFER_PHYSICAL_LOW_8723D(rx_bufdesc, (*((dma_addr_t *)skb->cb) & DMA_BIT_MASK(32))); ++ SET_RX_BUFFER_PHYSICAL_HIGH_8723D(rx_bufdesc, (*((dma_addr_t *)skb->cb) >> 32)); ++ SET_RX_BUFFER_DESC_DATA_LENGTH_8723D(rx_bufdesc, precvpriv->rxbuffersize); ++ ++ prxring->idx = (prxring->idx + 1) % precvpriv->rxringcount; ++ rtw_write16(padapter, REG_RXQ_TXBD_IDX_8723D, prxring->idx); ++ ++ remaing_rxdesc--; ++ } ++ ++} ++ ++void rtl8723de_recv_tasklet(void *priv) ++{ ++ _irqL irqL; ++ _adapter *padapter = (_adapter *)priv; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ ++ rtl8723de_rx_mpdu(padapter); ++ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); ++ pHalData->IntrMask[0] |= (IMR_ROK_8723D | IMR_RDU_8723D); ++ pHalData->IntrMask[1] |= IMR_RXFOVW_8723D; ++ rtw_write32(padapter, REG_HIMR0_8723D, pHalData->IntrMask[0]); ++ rtw_write32(padapter, REG_HIMR1_8723D, pHalData->IntrMask[1]); ++ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); ++} ++ ++static u8 pci_read8(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; ++ ++ /* printk("%s, addr=%08x, val=%02x\n", __func__, addr, readb((u8 *)pdvobjpriv->pci_mem_start + addr)); */ ++ return 0xff & readb((u8 *)pdvobjpriv->pci_mem_start + addr); ++} ++ ++static u16 pci_read16(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; ++ /* printk("%s, addr=%08x, val=%04x\n", __func__, addr, readw((u8 *)pdvobjpriv->pci_mem_start + addr)); */ ++ return readw((u8 *)pdvobjpriv->pci_mem_start + addr); ++} ++ ++static u32 pci_read32(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; ++ ++ /* printk("%s, addr=%08x, val=%08x\n", __func__, addr, readl((u8 *)pdvobjpriv->pci_mem_start + addr)); */ ++ return readl((u8 *)pdvobjpriv->pci_mem_start + addr); ++} ++ ++/* 2009.12.23. by tynli. Suggested by SD1 victorh. For ASPM hang on AMD and Nvidia. ++ * 20100212 Tynli: Do read IO operation after write for all PCI bridge suggested by SD1. ++ * Origianally this is only for INTEL. */ ++static int pci_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val) ++{ ++ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; ++ ++ writeb(val, (u8 *)pdvobjpriv->pci_mem_start + addr); ++ /* readb((u8 *)pdvobjpriv->pci_mem_start + addr); */ ++ return 1; ++} ++ ++static int pci_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val) ++{ ++ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; ++ ++ writew(val, (u8 *)pdvobjpriv->pci_mem_start + addr); ++ /* readw((u8 *)pdvobjpriv->pci_mem_start + addr); */ ++ return 2; ++} ++ ++static int pci_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val) ++{ ++ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; ++ ++ writel(val, (u8 *)pdvobjpriv->pci_mem_start + addr); ++ /* readl((u8 *)pdvobjpriv->pci_mem_start + addr); */ ++ return 4; ++} ++ ++ ++static void pci_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) ++{ ++ ++} ++ ++static void pci_write_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem) ++{ ++ ++} ++ ++static u32 pci_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) ++{ ++ return 0; ++} ++ ++void rtl8723de_xmit_tasklet(void *priv) ++{ ++ /* _irqL irqL; */ ++ _adapter *padapter = (_adapter *)priv; ++ /* struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); */ ++ /* PRT_ISR_CONTENT pisr_content = &pdvobjpriv->isr_content; */ ++ ++#if 1 ++ /* try to deal with the pending packets */ ++ rtl8723de_xmitframe_resume(padapter); ++#else ++ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); ++ ++ if (pisr_content->IntArray[0] & IMR_BCNDERR0_88E) { ++ /* RTW_INFO("beacon interrupt!\n"); */ ++ rtl8188ee_tx_isr(padapter, BCN_QUEUE_INX); ++ } ++ ++ if (pisr_content->IntArray[0] & IMR_MGNTDOK) { ++ /* RTW_INFO("Manage ok interrupt!\n"); */ ++ rtl8188ee_tx_isr(padapter, MGT_QUEUE_INX); ++ } ++ ++ if (pisr_content->IntArray[0] & IMR_HIGHDOK) { ++ /* RTW_INFO("HIGH_QUEUE ok interrupt!\n"); */ ++ rtl8188ee_tx_isr(padapter, HIGH_QUEUE_INX); ++ } ++ ++ if (pisr_content->IntArray[0] & IMR_BKDOK) { ++ /* RTW_INFO("BK Tx OK interrupt!\n"); */ ++ rtl8188ee_tx_isr(padapter, BK_QUEUE_INX); ++ } ++ ++ if (pisr_content->IntArray[0] & IMR_BEDOK) { ++ /* RTW_INFO("BE TX OK interrupt!\n"); */ ++ rtl8188ee_tx_isr(padapter, BE_QUEUE_INX); ++ } ++ ++ if (pisr_content->IntArray[0] & IMR_VIDOK) { ++ /* RTW_INFO("VI TX OK interrupt!\n"); */ ++ rtl8188ee_tx_isr(padapter, VI_QUEUE_INX); ++ } ++ ++ if (pisr_content->IntArray[0] & IMR_VODOK) { ++ /* RTW_INFO("Vo TX OK interrupt!\n"); */ ++ rtl8188ee_tx_isr(padapter, VO_QUEUE_INX); ++ } ++ ++ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); ++ ++ if (check_fwstate(&padapter->mlmepriv, _FW_UNDER_SURVEY) != _TRUE) { ++ /* try to deal with the pending packets */ ++ rtl8723de_xmitframe_resume(padapter); ++ } ++#endif ++ ++} ++ ++static u32 pci_write_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem) ++{ ++ _adapter *padapter = (_adapter *)pintfhdl->padapter; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 7, 0)) ++ netif_trans_update(padapter->pnetdev); ++#else ++ padapter->pnetdev->trans_start = jiffies; ++#endif ++ ++ return 0; ++} ++ ++void rtl8723de_set_intf_ops(struct _io_ops *pops) ++{ ++ ++ _rtw_memset((u8 *)pops, 0, sizeof(struct _io_ops)); ++ ++ pops->_read8 = &pci_read8; ++ pops->_read16 = &pci_read16; ++ pops->_read32 = &pci_read32; ++ ++ pops->_read_mem = &pci_read_mem; ++ pops->_read_port = &pci_read_port; ++ ++ pops->_write8 = &pci_write8; ++ pops->_write16 = &pci_write16; ++ pops->_write32 = &pci_write32; ++ ++ pops->_write_mem = &pci_write_mem; ++ pops->_write_port = &pci_write_port; ++ ++ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_led.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_led.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_led.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_led.c 2018-02-11 21:44:27.163146330 +0200 +@@ -0,0 +1,110 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#include "drv_types.h" ++#include ++ ++/* ================================================================================ ++ * Prototype of protected function. ++ * ================================================================================ */ ++ ++/* ================================================================================ ++ * LED_819xUsb routines. ++ * ================================================================================ */ ++ ++/* ++ * Description: ++ * Turn on LED according to LedPin specified. ++ */ ++VOID ++SwLedOn_8723DE( ++ IN PADAPTER Adapter, ++ IN PLED_PCIE pLed ++) ++{ ++ u16 LedReg = REG_LEDCFG0; ++ u8 LedCfg = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ ++ if (RTW_CANNOT_RUN(Adapter)) ++ return; ++ ++ pLed->bLedOn = _TRUE; ++} ++ ++ ++/* ++ * Description: ++ * Turn off LED according to LedPin specified. ++ */ ++VOID ++SwLedOff_8723DE( ++ IN PADAPTER Adapter, ++ IN PLED_PCIE pLed ++) ++{ ++ u16 LedReg = REG_LEDCFG0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ ++ if (RTW_CANNOT_RUN(Adapter)) ++ return; ++ ++ pLed->bLedOn = _FALSE; ++} ++ ++ ++/* ++ * Description: ++ * Initialize all LED_871x objects. ++ */ ++void ++rtl8723de_InitSwLeds( ++ _adapter *padapter ++) ++{ ++ struct led_priv *pledpriv = &(padapter->ledpriv); ++ ++ pledpriv->LedControlHandler = LedControlPCIE; ++ ++ pledpriv->SwLedOn = SwLedOn_8723DE; ++ pledpriv->SwLedOff = SwLedOff_8723DE; ++ ++ InitLed(padapter, &(pledpriv->SwLed0), LED_PIN_LED0); ++ ++ InitLed(padapter, &(pledpriv->SwLed1), LED_PIN_LED1); ++} ++ ++ ++/* ++ * Description: ++ * DeInitialize all LED_819xUsb objects. ++ */ ++void ++rtl8723de_DeInitSwLeds( ++ _adapter *padapter ++) ++{ ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ ++ DeInitLed(&(ledpriv->SwLed0)); ++ DeInitLed(&(ledpriv->SwLed1)); ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_recv.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_recv.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_recv.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_recv.c 2018-02-11 21:44:27.163146330 +0200 +@@ -0,0 +1,51 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTL8723DE_RECV_C_ ++ ++/*#include */ ++#include ++ ++ ++s32 rtl8723de_init_recv_priv(_adapter *padapter) ++{ ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ s32 ret = _SUCCESS; ++ ++ ++#ifdef PLATFORM_LINUX ++ tasklet_init(&precvpriv->recv_tasklet, ++ (void(*)(unsigned long))rtl8723de_recv_tasklet, ++ (unsigned long)padapter); ++ ++ tasklet_init(&precvpriv->irq_prepare_beacon_tasklet, ++ (void(*)(unsigned long))rtl8723de_prepare_bcn_tasklet, ++ (unsigned long)padapter); ++#endif ++ ++ ++ return ret; ++} ++ ++void rtl8723de_free_recv_priv(_adapter *padapter) ++{ ++ /*struct recv_priv *precvpriv = &padapter->recvpriv;*/ ++ ++ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_xmit.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_xmit.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_xmit.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_xmit.c 2018-02-11 21:44:27.163146330 +0200 +@@ -0,0 +1,770 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTL8723DE_XMIT_C_ ++ ++/*#include */ ++#include ++ ++static void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, u8 *ptxdesc) ++{ ++ u8 bDumpTxPkt; ++ u8 bDumpTxDesc = _FALSE; ++ ++ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DUMP_TXPKT, &(bDumpTxPkt)); ++ ++ if (bDumpTxPkt == 1) {/* dump txdesc for data frame */ ++ RTW_INFO("dump tx_desc for data frame\n"); ++ if ((frame_tag & 0x0f) == DATA_FRAMETAG) ++ bDumpTxDesc = _TRUE; ++ } else if (bDumpTxPkt == 2) {/* dump txdesc for mgnt frame */ ++ RTW_INFO("dump tx_desc for mgnt frame\n"); ++ if ((frame_tag & 0x0f) == MGNT_FRAMETAG) ++ bDumpTxDesc = _TRUE; ++ } else if (bDumpTxPkt == 3) {/* dump early info */ ++ } ++ ++ if (bDumpTxDesc) { ++ /* ptxdesc->txdw4 = cpu_to_le32(0x00001006);*/ /*RTS Rate=24M */ ++ /* ptxdesc->txdw6 = 0x6666f800; */ ++ RTW_INFO("=====================================\n"); ++ RTW_INFO("Offset00(0x%08x)\n", *((u32 *)(ptxdesc))); ++ RTW_INFO("Offset04(0x%08x)\n", *((u32 *)(ptxdesc + 4))); ++ RTW_INFO("Offset08(0x%08x)\n", *((u32 *)(ptxdesc + 8))); ++ RTW_INFO("Offset12(0x%08x)\n", *((u32 *)(ptxdesc + 12))); ++ RTW_INFO("Offset16(0x%08x)\n", *((u32 *)(ptxdesc + 16))); ++ RTW_INFO("Offset20(0x%08x)\n", *((u32 *)(ptxdesc + 20))); ++ RTW_INFO("Offset24(0x%08x)\n", *((u32 *)(ptxdesc + 24))); ++ RTW_INFO("Offset28(0x%08x)\n", *((u32 *)(ptxdesc + 28))); ++ RTW_INFO("Offset32(0x%08x)\n", *((u32 *)(ptxdesc + 32))); ++ RTW_INFO("Offset36(0x%08x)\n", *((u32 *)(ptxdesc + 36))); ++ RTW_INFO("=====================================\n"); ++ } ++ ++} ++ ++s32 rtl8723de_init_xmit_priv(_adapter *padapter) ++{ ++ s32 ret = _SUCCESS; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ ++ _rtw_spinlock_init(&pdvobjpriv->irq_th_lock); ++ ++#ifdef PLATFORM_LINUX ++ tasklet_init(&pxmitpriv->xmit_tasklet, ++ (void(*)(unsigned long))rtl8723de_xmit_tasklet, ++ (unsigned long)padapter); ++#endif ++ ++ return ret; ++} ++ ++void rtl8723de_free_xmit_priv(_adapter *padapter) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ ++ _rtw_spinlock_free(&pdvobjpriv->irq_th_lock); ++} ++ ++s32 rtl8723de_enqueue_xmitbuf(struct rtw_tx_ring *ring, struct xmit_buf *pxmitbuf) ++{ ++ _irqL irqL; ++ _queue *ppending_queue = &ring->queue; ++ ++ ++ /* RTW_INFO("+enqueue_xmitbuf\n"); */ ++ ++ if (pxmitbuf == NULL) ++ return _FAIL; ++ ++ /* _enter_critical(&ppending_queue->lock, &irqL); */ ++ ++ rtw_list_delete(&pxmitbuf->list); ++ ++ rtw_list_insert_tail(&(pxmitbuf->list), get_list_head(ppending_queue)); ++ ++ ring->qlen++; ++ ++ /* RTW_INFO("FREE, free_xmitbuf_cnt=%d\n", pxmitpriv->free_xmitbuf_cnt); */ ++ ++ /* _exit_critical(&ppending_queue->lock, &irqL); */ ++ ++ ++ return _SUCCESS; ++} ++ ++struct xmit_buf *rtl8723de_dequeue_xmitbuf(struct rtw_tx_ring *ring) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ struct xmit_buf *pxmitbuf = NULL; ++ _queue *ppending_queue = &ring->queue; ++ ++ ++ /* _enter_critical(&ppending_queue->lock, &irqL); */ ++ ++ if (_rtw_queue_empty(ppending_queue) == _TRUE) ++ pxmitbuf = NULL; ++ else { ++ ++ phead = get_list_head(ppending_queue); ++ ++ plist = get_next(phead); ++ ++ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); ++ ++ rtw_list_delete(&(pxmitbuf->list)); ++ ++ ring->qlen--; ++ } ++ ++ /* _exit_critical(&ppending_queue->lock, &irqL); */ ++ ++ ++ return pxmitbuf; ++} ++ ++static u16 ffaddr2dma(u32 addr) ++{ ++ u16 dma_ctrl; ++ ++ switch (addr) { ++ case VO_QUEUE_INX: ++ dma_ctrl = BIT(3); ++ break; ++ case VI_QUEUE_INX: ++ dma_ctrl = BIT(2); ++ break; ++ case BE_QUEUE_INX: ++ dma_ctrl = BIT(1); ++ break; ++ case BK_QUEUE_INX: ++ dma_ctrl = BIT(0); ++ break; ++ case BCN_QUEUE_INX: ++ dma_ctrl = BIT(4); ++ break; ++ case MGT_QUEUE_INX: ++ dma_ctrl = BIT(6); ++ break; ++ case HIGH_QUEUE_INX: ++ dma_ctrl = BIT(7); ++ break; ++ default: ++ dma_ctrl = 0; ++ break; ++ } ++ ++ return dma_ctrl; ++} ++ ++/* ++ * Fill tx buffer desciptor. Map each buffer address in tx buffer descriptor segment ++ * Designed for tx buffer descriptor architecture ++ * Input *pmem: pointer to the Tx Buffer Descriptor ++ */ ++static void update_txbufdesc(struct xmit_frame *pxmitframe, u8 *pmem, s32 sz) ++{ ++ _adapter *padapter = pxmitframe->padapter; ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ dma_addr_t mapping; ++ u32 i = 0; ++ u16 seg_num = 2 << TX_BUFFER_SEG_NUM; /* 0: 2 seg, 1: 4 seg, 2: 8 seg. */ ++ u16 page_size_length = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ mapping = pci_map_single(pdvobjpriv->ppcidev, pxmitframe->buf_addr , sz + TX_WIFI_INFO_SIZE, PCI_DMA_TODEVICE); ++ ++ /* Calculate page size. Total buffer length including TX_WIFI_INFO and PacketLen */ ++ page_size_length = (sz + TX_WIFI_INFO_SIZE - 1) / PAGE_SIZE_TX_8723D + 1; ++ ++ /* Reset all tx buffer desciprtor content */ ++ /* -- Reset first element */ ++ SET_TX_BUFF_DESC_LEN_0_8723D(pmem, 0); ++ SET_TX_BUFF_DESC_PSB_8723D(pmem, 0); ++ SET_TX_BUFF_DESC_OWN_8723D(pmem, 0); ++ /* -- Reset second and other element */ ++ for (i = 1 ; i < seg_num ; i++) { ++ SET_TXBUFFER_DESC_LEN_WITH_OFFSET(pmem, i, 0); ++ SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(pmem, i, 0); ++ SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(pmem, i, 0); ++ } ++ ++ /* Fill buffer length of the first buffer, */ ++ /* For 8723de, it is required that TX_WIFI_INFO is put in first segment, and the size */ ++ /* of the first segment cannot be larger than TX_WIFI_INFO_SIZE. */ ++ SET_TX_BUFF_DESC_LEN_0_8723D(pmem, TX_WIFI_INFO_SIZE); ++ SET_TX_BUFF_DESC_PSB_8723D(pmem, page_size_length); ++ SET_TX_BUFF_DESC_ADDR_LOW_0_8723D(pmem, (mapping & DMA_BIT_MASK(32))); ++ SET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(pmem, (mapping >> 32)); ++ ++ /* It is assumed that in linux implementation, packet is coalesced in only one buffer */ ++ /* Extension mode is not supported here */ ++ SET_TXBUFFER_DESC_LEN_WITH_OFFSET(pmem, 1, sz); ++ SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(pmem, 1, 0); /* don't using extendsion mode. */ ++ SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(pmem, 1, ((mapping + TX_WIFI_INFO_SIZE) & DMA_BIT_MASK(32))); ++ SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(pmem, 1, ((mapping + TX_WIFI_INFO_SIZE) >> 32)); ++ ++#if 0 ++ buf_desc_debug("TX:%s, tx_buf_desc = 0x%08x\n", __func__, (u32)pmem); ++ buf_desc_debug("TX:%s, Offset00(0x%08x)\n", __func__, *((u32 *)(pmem))); ++ buf_desc_debug("TX:%s, Offset04(0x%08x)\n", __func__, *((u32 *)(pmem + 4))); ++ buf_desc_debug("TX:%s, Offset08(0x%08x)\n", __func__, *((u32 *)(pmem + 8))); ++ buf_desc_debug("TX:%s, Offset12(0x%08x)\n", __func__, *((u32 *)(pmem + 12))); ++#endif ++} ++ ++static s32 update_txdesc(struct xmit_frame *pxmitframe) ++{ ++ _adapter *padapter = pxmitframe->padapter; ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ u8 *ptxdesc = pxmitframe->buf_addr; ++ ++ _rtw_memset(ptxdesc, 0, TXDESC_SIZE); ++ ++ rtl8723d_update_txdesc(pxmitframe, ptxdesc); ++ ++ /* Don't set value before, because rtl8723d_update_txdesc() will clean ptxdesc. */ ++ ++ /* 4 offset 0 */ ++ /* SET_TX_DESC_FIRST_SEG_8723D(ptxdesc, 1); */ ++ /* SET_TX_DESC_LAST_SEG_8723D(ptxdesc, 1); */ ++ /* SET_TX_DESC_OWN_8723D(ptxdesc, 1); */ ++ ++ /* SET_TX_DESC_TX_BUFFER_SIZE_8723D(ptxdesc, sz); */ ++ /* SET_TX_DESC_TX_BUFFER_ADDRESS_8723D(ptxdesc, mapping); */ ++ ++ /* debug */ ++ _dbg_dump_tx_info(padapter, pxmitframe->frame_tag, ptxdesc); ++ ++ return 0; ++} ++ ++static u8 *get_txbufdesc(_adapter *padapter, u8 queue_index) ++{ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct rtw_tx_ring *ring; ++ u8 *pbufdesc; ++ int idx; ++ ++ ring = &pxmitpriv->tx_ring[queue_index]; ++ ++ if (queue_index != BCN_QUEUE_INX) ++ idx = (ring->idx + ring->qlen) % ring->entries; ++ else ++ idx = 0; ++ ++ pbufdesc = (u8 *)&ring->buf_desc[idx]; ++ ++ if ((queue_index != BCN_QUEUE_INX) && (ring->entries - ring->qlen == 1)) { ++ /* ++ * If we fall into this case, we may enlarge checking boundary in ++ * check_nic_enough_desc(). ++ */ ++ RTW_INFO("No more TX desc@%d, ring->idx = %d,idx = %d\n", queue_index, ring->idx, idx); ++ return NULL; ++ } ++ ++ return pbufdesc; ++} ++ ++u16 get_txbufdesc_idx_hwaddr(u16 ff_hwaddr) ++{ ++ u16 txbuf_desc_addr = REG_BEQ_TXBD_IDX_8723D; ++ ++ switch (ff_hwaddr) { ++ case BK_QUEUE_INX: ++ txbuf_desc_addr = REG_BKQ_TXBD_IDX_8723D; ++ break; ++ ++ case BE_QUEUE_INX: ++ txbuf_desc_addr = REG_BEQ_TXBD_IDX_8723D; ++ break; ++ ++ case VI_QUEUE_INX: ++ txbuf_desc_addr = REG_VIQ_TXBD_IDX_8723D; ++ break; ++ ++ case VO_QUEUE_INX: ++ txbuf_desc_addr = REG_VOQ_TXBD_IDX_8723D; ++ break; ++ ++ case BCN_QUEUE_INX: ++ txbuf_desc_addr = REG_BEQ_TXBD_IDX_8723D; /*need check*/ ++ break; ++ ++ case TXCMD_QUEUE_INX: ++ txbuf_desc_addr = REG_BEQ_TXBD_IDX_8723D; /*need check*/ ++ break; ++ ++ case MGT_QUEUE_INX: ++ txbuf_desc_addr = REG_MGQ_TXBD_IDX_8723D; ++ break; ++ ++ case HIGH_QUEUE_INX: ++ txbuf_desc_addr = REG_HI0Q_TXBD_IDX_8723D; ++ break; ++ ++ default: ++ break; ++ } ++ ++ return txbuf_desc_addr; ++} ++ ++/* ++ * Update Read/Write pointer ++ * Read pointer is h/w descriptor index ++ * Write pointer is host desciptor index: For tx side, if own bit is set in packet index n, ++ * host pointer (write pointer) point to index n + 1.) ++ */ ++void fill_txbufdesc_own(_adapter *padapter, u8 *txbufdesc, u16 queue_idx, struct rtw_tx_ring *ptxring) ++{ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ u16 host_wp; ++ ++ if (queue_idx == BCN_QUEUE_INX) { ++ /*Adapter->CurrentTXWritePoint[QueueIndex] = Adapter->CurrentTXReadPoint[QueueIndex] =0;*/ ++ ++ SET_TX_BUFF_DESC_OWN_8723D(txbufdesc, 1); ++ ++ /* kick start */ ++ rtw_write8(padapter, REG_RX_RXBD_NUM_8723D + 1, ++ rtw_read8(padapter, REG_RX_RXBD_NUM_8723D + 1) | BIT(4)); ++ ++ return; ++ } ++ ++ /* update h/w index ++ * for tx side, if own bit is set in packet index n, host pointer (write pointer) point to index n + 1. ++ */ ++ /* for current tx packet, enqueue has been ring->qlen++ before. ++ * so, host_wp = ring->idx + ring->qlen. ++ */ ++ host_wp = (ptxring->idx + ptxring->qlen) % ptxring->entries; ++ rtw_write16(padapter, get_txbufdesc_idx_hwaddr(queue_idx), host_wp); ++} ++ ++s32 rtw_dump_xframe(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ s32 ret = _SUCCESS; ++ s32 inner_ret = _SUCCESS; ++ _irqL irqL; ++ int t, sz, w_sz, pull = 0; ++ u32 ff_hwaddr; ++ struct xmit_buf *pxmitbuf = pxmitframe->pxmitbuf; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ u8 *ptxbufdesc; ++ struct rtw_tx_ring *ptx_ring; ++ ++ _adapter *pri_adapter = GET_PRIMARY_ADAPTER(padapter); ++ struct dvobj_priv *pri_dvobjpriv = adapter_to_dvobj(pri_adapter); ++ ++ ++ if ((pxmitframe->frame_tag == DATA_FRAMETAG) && ++ (pxmitframe->attrib.ether_type != 0x0806) && ++ (pxmitframe->attrib.ether_type != 0x888e) && ++ (pxmitframe->attrib.dhcp_pkt != 1)) ++ ++ rtw_issue_addbareq_cmd(padapter, pxmitframe); ++ ++ /* mem_addr = pxmitframe->buf_addr; */ ++ ++ ++ for (t = 0; t < pattrib->nr_frags; t++) { ++ if (inner_ret != _SUCCESS && ret == _SUCCESS) ++ ret = _FAIL; ++ ++ if (t != (pattrib->nr_frags - 1)) { ++ ++ sz = pxmitpriv->frag_len; ++ sz = sz - 4 - (psecuritypriv->sw_encrypt ? 0 : pattrib->icv_len); ++ } else /* no frag */ ++ sz = pattrib->last_txcmdsz; ++ ++ ff_hwaddr = rtw_get_ff_hwaddr(pxmitframe); ++ ++ _enter_critical(&(pri_dvobjpriv->irq_th_lock), &irqL); ++ ++ ptxbufdesc = get_txbufdesc(pri_adapter, ff_hwaddr); ++ ++ ptx_ring = &(pri_adapter->xmitpriv.tx_ring[ff_hwaddr]); ++ ++ if (BCN_QUEUE_INX == ff_hwaddr) ++ padapter->xmitpriv.beaconDMAing = _TRUE; ++ ++ if (ptxbufdesc == NULL) { ++ _exit_critical(&pri_dvobjpriv->irq_th_lock, &irqL); ++ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_TX_DESC_NA); ++ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); ++ RTW_INFO("##### Tx buffer desc unavailable !#####\n"); ++ break; ++ } ++ update_txdesc(pxmitframe); ++ ++ /* update_txbufdesc() must be called after update_txdesc(). */ ++ /* It rely on update_txbufdesc() to map it into non cache memory */ ++ update_txbufdesc(pxmitframe, ptxbufdesc, sz); ++ ++ if (pxmitbuf->buf_tag != XMITBUF_CMD) ++ rtl8723de_enqueue_xmitbuf(ptx_ring, pxmitbuf); ++ ++ pxmitbuf->len = sz; ++ w_sz = sz; ++ ++ /* Set descriptor fields before! */ ++ wmb(); ++ ++ /*SET_TX_BUFF_DESC_OWN_8723D(ptxbufdesc, 1);*/ ++ fill_txbufdesc_own(pri_adapter, ptxbufdesc, ++ ff_hwaddr, ptx_ring); ++ ++ _exit_critical(&pri_dvobjpriv->irq_th_lock, &irqL); ++ ++ rtw_count_tx_stats(padapter, pxmitframe, sz); ++ /* RTW_INFO("rtw_write_port, w_sz=%d, sz=%d, txdesc_sz=%d, tid=%d\n", w_sz, sz, w_sz-sz, pattrib->priority); */ ++ ++ /* mem_addr += w_sz; */ ++ ++ /* mem_addr = (u8 *)RND4(((SIZE_PTR)(mem_addr))); */ ++ ++ } ++ ++ rtw_free_xmitframe(pxmitpriv, pxmitframe); ++ ++ if (ret != _SUCCESS) ++ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_UNKNOWN); ++ ++ return ret; ++} ++ ++void rtl8723de_xmitframe_resume(_adapter *padapter) ++{ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct xmit_frame *pxmitframe = NULL; ++ struct xmit_buf *pxmitbuf = NULL; ++ int res = _SUCCESS, xcnt = 0; ++ ++ ++ while (1) { ++ if (RTW_CANNOT_RUN(padapter)) { ++ RTW_INFO("rtl8188ee_xmitframe_resume => bDriverStopped or bSurpriseRemoved\n"); ++ break; ++ } ++ ++ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); ++ if (!pxmitbuf) ++ break; ++ ++ pxmitframe = rtw_dequeue_xframe(pxmitpriv, pxmitpriv->hwxmits, pxmitpriv->hwxmit_entry); ++ ++ if (pxmitframe) { ++ pxmitframe->pxmitbuf = pxmitbuf; ++ ++ pxmitframe->buf_addr = pxmitbuf->pbuf; ++ ++ pxmitbuf->priv_data = pxmitframe; ++ ++ if ((pxmitframe->frame_tag & 0x0f) == DATA_FRAMETAG) { ++ if (pxmitframe->attrib.priority <= 15) /* TID0~15 */ ++ res = rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe); ++ ++ rtw_os_xmit_complete(padapter, pxmitframe);/* always return ndis_packet after rtw_xmitframe_coalesce */ ++ } ++ ++ ++ if (res == _SUCCESS) ++ rtw_dump_xframe(padapter, pxmitframe); ++ else { ++ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pxmitframe); ++ } ++ ++ xcnt++; ++ } else { ++ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); ++ break; ++ } ++ } ++} ++ ++static u8 check_nic_enough_desc(_adapter *padapter, struct pkt_attrib *pattrib) ++{ ++ u32 prio; ++ ++ switch (pattrib->qsel) { ++ case 0: ++ case 3: ++ prio = BE_QUEUE_INX; ++ break; ++ case 1: ++ case 2: ++ prio = BK_QUEUE_INX; ++ break; ++ case 4: ++ case 5: ++ prio = VI_QUEUE_INX; ++ break; ++ case 6: ++ case 7: ++ prio = VO_QUEUE_INX; ++ break; ++ default: ++ prio = BE_QUEUE_INX; ++ break; ++ } ++ ++ return check_tx_desc_resource(padapter, prio); ++} ++ ++static s32 xmitframe_direct(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ s32 res = _SUCCESS; ++ ++ res = rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe); ++ if (res == _SUCCESS) ++ rtw_dump_xframe(padapter, pxmitframe); ++ ++ return res; ++} ++ ++/* ++ * Return ++ * _TRUE dump packet directly ++ * _FALSE enqueue packet ++ */ ++static s32 pre_xmitframe(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ _irqL irqL; ++ s32 res; ++ struct xmit_buf *pxmitbuf = NULL; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ _enter_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ if ((rtw_txframes_sta_ac_pending(padapter, pattrib) > 0) || ++ (check_nic_enough_desc(padapter, pattrib) == _FALSE)) ++ goto enqueue; ++ ++ if (rtw_xmit_ac_blocked(padapter) == _TRUE) ++ goto enqueue; ++ ++ if (DEV_STA_LG_NUM(padapter->dvobj)) ++ goto enqueue; ++ ++ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); ++ if (pxmitbuf == NULL) ++ goto enqueue; ++ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ pxmitframe->pxmitbuf = pxmitbuf; ++ pxmitframe->buf_addr = pxmitbuf->pbuf; ++ pxmitbuf->priv_data = pxmitframe; ++ ++ if (xmitframe_direct(padapter, pxmitframe) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pxmitframe); ++ } ++ ++ return _TRUE; ++ ++enqueue: ++ res = rtw_xmitframe_enqueue(padapter, pxmitframe); ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ if (res != _SUCCESS) { ++ rtw_free_xmitframe(pxmitpriv, pxmitframe); ++ ++ /* Trick, make the statistics correct */ ++ pxmitpriv->tx_pkts--; ++ pxmitpriv->tx_drop++; ++ return _TRUE; ++ } ++ ++ return _FALSE; ++} ++ ++s32 rtl8723de_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe) ++{ ++ return rtw_dump_xframe(padapter, pmgntframe); ++} ++ ++/* ++ * Return ++ * _TRUE dump packet directly ok ++ * _FALSE temporary can't transmit packets to hardware ++ */ ++s32 rtl8723de_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ return pre_xmitframe(padapter, pxmitframe); ++} ++ ++s32 rtl8723de_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ s32 err; ++ ++ err = rtw_xmitframe_enqueue(padapter, pxmitframe); ++ ++ if (err != _SUCCESS) { ++ rtw_free_xmitframe(pxmitpriv, pxmitframe); ++ ++ /* Trick, make the statistics correct */ ++ pxmitpriv->tx_pkts--; ++ pxmitpriv->tx_drop++; ++ } else { ++ if (check_nic_enough_desc(padapter, &pxmitframe->attrib) == _TRUE) { ++#ifdef PLATFORM_LINUX ++ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); ++#endif ++ } ++ } ++ ++ return err; ++} ++ ++#ifdef CONFIG_HOSTAPD_MLME ++ ++static void rtl8723de_hostap_mgnt_xmit_cb(struct urb *urb) ++{ ++#ifdef PLATFORM_LINUX ++ struct sk_buff *skb = (struct sk_buff *)urb->context; ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ rtw_skb_free(skb); ++#endif ++} ++ ++s32 rtl8723de_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt) ++{ ++#ifdef PLATFORM_LINUX ++ u16 fc; ++ int rc, len, pipe; ++ unsigned int bmcst, tid, qsel; ++ struct sk_buff *skb, *pxmit_skb; ++ struct urb *urb; ++ unsigned char *pxmitbuf; ++ struct tx_desc *ptxdesc; ++ struct rtw_ieee80211_hdr *tx_hdr; ++ struct hostapd_priv *phostapdpriv = padapter->phostapdpriv; ++ struct net_device *pnetdev = padapter->pnetdev; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); ++ ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ skb = pkt; ++ ++ len = skb->len; ++ tx_hdr = (struct rtw_ieee80211_hdr *)(skb->data); ++ fc = le16_to_cpu(tx_hdr->frame_ctl); ++ bmcst = IS_MCAST(tx_hdr->addr1); ++ ++ if ((fc & RTW_IEEE80211_FCTL_FTYPE) != RTW_IEEE80211_FTYPE_MGMT) ++ goto _exit; ++ ++ pxmit_skb = rtw_skb_alloc(len + TXDESC_SIZE); ++ ++ if (!pxmit_skb) ++ goto _exit; ++ ++ pxmitbuf = pxmit_skb->data; ++ ++ urb = usb_alloc_urb(0, GFP_ATOMIC); ++ if (!urb) ++ goto _exit; ++ ++ /* ----- fill tx desc ----- */ ++ ptxdesc = (struct tx_desc *)pxmitbuf; ++ _rtw_memset(ptxdesc, 0, sizeof(*ptxdesc)); ++ ++ /* offset 0 */ ++ ptxdesc->txdw0 |= cpu_to_le32(len & 0x0000ffff); ++ ptxdesc->txdw0 |= cpu_to_le32(((TXDESC_SIZE + OFFSET_SZ) << OFFSET_SHT) & 0x00ff0000); /* default = 32 bytes for TX Desc */ ++ ptxdesc->txdw0 |= cpu_to_le32(OWN | FSG | LSG); ++ ++ if (bmcst) ++ ptxdesc->txdw0 |= cpu_to_le32(BIT(24)); ++ ++ /* offset 4 */ ++ ptxdesc->txdw1 |= cpu_to_le32(0x00);/* MAC_ID */ ++ ++ ptxdesc->txdw1 |= cpu_to_le32((0x12 << QSEL_SHT) & 0x00001f00); ++ ++ ptxdesc->txdw1 |= cpu_to_le32((0x06 << 16) & 0x000f0000);/* b mode */ ++ ++ /* offset 8 */ ++ ++ /* offset 12 */ ++ ptxdesc->txdw3 |= cpu_to_le32((le16_to_cpu(tx_hdr->seq_ctl) << 16) & 0xffff0000); ++ ++ /* offset 16 */ ++ ptxdesc->txdw4 |= cpu_to_le32(BIT(8));/* driver uses rate */ ++ ++ /* offset 20 */ ++ ++ rtl8188e_cal_txdesc_chksum(ptxdesc); ++ /* ----- end of fill tx desc ----- */ ++ ++ /* */ ++ skb_put(pxmit_skb, len + TXDESC_SIZE); ++ pxmitbuf = pxmitbuf + TXDESC_SIZE; ++ _rtw_memcpy(pxmitbuf, skb->data, len); ++ ++ /* RTW_INFO("mgnt_xmit, len=%x\n", pxmit_skb->len); */ ++ ++ ++ /* ----- prepare urb for submit ----- */ ++ ++ /* translate DMA FIFO addr to pipehandle */ ++ /* pipe = ffaddr2pipehdl(pdvobj, MGT_QUEUE_INX); */ ++ pipe = usb_sndbulkpipe(pdvobj->pusbdev, pHalData->Queue2EPNum[(u8)MGT_QUEUE_INX] & 0x0f); ++ ++ usb_fill_bulk_urb(urb, pdvobj->pusbdev, pipe, ++ pxmit_skb->data, pxmit_skb->len, rtl8723de_hostap_mgnt_xmit_cb, pxmit_skb); ++ ++ urb->transfer_flags |= URB_ZERO_PACKET; ++ usb_anchor_urb(urb, &phostapdpriv->anchored); ++ rc = usb_submit_urb(urb, GFP_ATOMIC); ++ if (rc < 0) { ++ usb_unanchor_urb(urb); ++ kfree_skb(skb); ++ } ++ usb_free_urb(urb); ++ ++ ++_exit: ++ ++ rtw_skb_free(skb); ++ ++#endif ++ ++ return 0; ++ ++} ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_cmd.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_cmd.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_cmd.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_cmd.c 2018-02-11 21:44:27.163146330 +0200 +@@ -0,0 +1,1279 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTL8723D_CMD_C_ ++ ++#include ++#include "hal_com_h2c.h" ++ ++#define MAX_H2C_BOX_NUMS 4 ++#define MESSAGE_BOX_SIZE 4 ++ ++#define RTL8723D_MAX_CMD_LEN 7 ++#define RTL8723D_EX_MESSAGE_BOX_SIZE 4 ++ ++static u8 _is_fw_read_cmd_down(_adapter *padapter, u8 msgbox_num) ++{ ++ u8 read_down = _FALSE; ++ int retry_cnts = 100; ++ ++ u8 valid; ++ ++ /* RTW_INFO(" _is_fw_read_cmd_down ,reg_1cc(%x),msg_box(%d)...\n",rtw_read8(padapter,REG_HMETFR),msgbox_num); */ ++ ++ do { ++ valid = rtw_read8(padapter, REG_HMETFR) & BIT(msgbox_num); ++ if (0 == valid) ++ read_down = _TRUE; ++ else ++ rtw_msleep_os(1); ++ } while ((!read_down) && (retry_cnts--)); ++ ++ return read_down; ++ ++} ++ ++ ++/***************************************** ++* H2C Msg format : ++*| 31 - 8 |7-5 | 4 - 0 | ++*| h2c_msg |Class |CMD_ID | ++*| 31-0 | ++*| Ext msg | ++* ++******************************************/ ++s32 FillH2CCmd8723D(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) ++{ ++ u8 h2c_box_num; ++ u32 msgbox_addr; ++ u32 msgbox_ex_addr = 0; ++ PHAL_DATA_TYPE pHalData; ++ u32 h2c_cmd = 0; ++ u32 h2c_cmd_ex = 0; ++ s32 ret = _FAIL; ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ ++ ++ padapter = GET_PRIMARY_ADAPTER(padapter); ++ pHalData = GET_HAL_DATA(padapter); ++#ifdef DBG_CHECK_FW_PS_STATE ++#ifdef DBG_CHECK_FW_PS_STATE_H2C ++ if (rtw_fw_ps_state(padapter) == _FAIL) { ++ RTW_INFO("%s: h2c doesn't leave 32k ElementID=%02x\n", __FUNCTION__, ElementID); ++ pdbgpriv->dbg_h2c_leave32k_fail_cnt++; ++ } ++ ++ /* RTW_INFO("H2C ElementID=%02x , pHalData->LastHMEBoxNum=%02x\n", ElementID, pHalData->LastHMEBoxNum); */ ++#endif /* DBG_CHECK_FW_PS_STATE_H2C */ ++#endif /* DBG_CHECK_FW_PS_STATE */ ++ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->h2c_fwcmd_mutex), NULL); ++ ++ if (!pCmdBuffer) ++ goto exit; ++ if (CmdLen > RTL8723D_MAX_CMD_LEN) ++ goto exit; ++ if (rtw_is_surprise_removed(padapter)) ++ goto exit; ++ ++ /* pay attention to if race condition happened in H2C cmd setting. */ ++ do { ++ h2c_box_num = pHalData->LastHMEBoxNum; ++ ++ if (!_is_fw_read_cmd_down(padapter, h2c_box_num)) { ++ RTW_INFO(" fw read cmd failed...\n"); ++#ifdef DBG_CHECK_FW_PS_STATE ++ RTW_INFO("MAC_1C0=%08x, MAC_1C4=%08x, MAC_1C8=%08x, MAC_1CC=%08x\n", rtw_read32(padapter, 0x1c0), rtw_read32(padapter, 0x1c4) ++ , rtw_read32(padapter, 0x1c8), rtw_read32(padapter, 0x1cc)); ++#endif /* DBG_CHECK_FW_PS_STATE */ ++ /* RTW_INFO(" 0x1c0: 0x%8x\n", rtw_read32(padapter, 0x1c0)); */ ++ /* RTW_INFO(" 0x1c4: 0x%8x\n", rtw_read32(padapter, 0x1c4)); */ ++ goto exit; ++ } ++ ++ if (CmdLen <= 3) ++ _rtw_memcpy((u8 *)(&h2c_cmd) + 1, pCmdBuffer, CmdLen); ++ else { ++ _rtw_memcpy((u8 *)(&h2c_cmd) + 1, pCmdBuffer, 3); ++ _rtw_memcpy((u8 *)(&h2c_cmd_ex), pCmdBuffer + 3, CmdLen - 3); ++ /* *(u8*)(&h2c_cmd) |= BIT(7); */ ++ } ++ ++ *(u8 *)(&h2c_cmd) |= ElementID; ++ ++ if (CmdLen > 3) { ++ msgbox_ex_addr = REG_HMEBOX_EXT0_8723D + (h2c_box_num * RTL8723D_EX_MESSAGE_BOX_SIZE); ++ h2c_cmd_ex = le32_to_cpu(h2c_cmd_ex); ++ rtw_write32(padapter, msgbox_ex_addr, h2c_cmd_ex); ++ } ++ msgbox_addr = REG_HMEBOX_0 + (h2c_box_num * MESSAGE_BOX_SIZE); ++ h2c_cmd = le32_to_cpu(h2c_cmd); ++ rtw_write32(padapter, msgbox_addr, h2c_cmd); ++ ++ /* RTW_INFO("MSG_BOX:%d, CmdLen(%d), CmdID(0x%x), reg:0x%x =>h2c_cmd:0x%.8x, reg:0x%x =>h2c_cmd_ex:0x%.8x\n" */ ++ /* ,pHalData->LastHMEBoxNum , CmdLen, ElementID, msgbox_addr, h2c_cmd, msgbox_ex_addr, h2c_cmd_ex); */ ++ ++ pHalData->LastHMEBoxNum = (h2c_box_num + 1) % MAX_H2C_BOX_NUMS; ++ ++ } while (0); ++ ++ ret = _SUCCESS; ++ ++exit: ++ ++ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->h2c_fwcmd_mutex), NULL); ++ ++ ++ return ret; ++} ++ ++static void ConstructBeacon(_adapter *padapter, u8 *pframe, u32 *pLength) ++{ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u16 *fctrl; ++ u32 rate_len, pktlen; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); ++ /* pmlmeext->mgnt_seq++; */ ++ SetFrameSubType(pframe, WIFI_BEACON); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ /* timestamp will be inserted by hardware */ ++ pframe += 8; ++ pktlen += 8; ++ ++ /* beacon interval: 2 bytes */ ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); ++ ++ pframe += 2; ++ pktlen += 2; ++ ++ /* capability info: 2 bytes */ ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); ++ ++ pframe += 2; ++ pktlen += 2; ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { ++ /* RTW_INFO("ie len=%d\n", cur_network->IELength); */ ++ pktlen += cur_network->IELength - sizeof(NDIS_802_11_FIXED_IEs); ++ _rtw_memcpy(pframe, cur_network->IEs + sizeof(NDIS_802_11_FIXED_IEs), pktlen); ++ ++ goto _ConstructBeacon; ++ } ++ ++ /* below for ad-hoc mode */ ++ ++ /* SSID */ ++ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pktlen); ++ ++ /* supported rates... */ ++ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pktlen); ++ ++ /* DS parameter set */ ++ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pktlen); ++ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { ++ u32 ATIMWindow; ++ /* IBSS Parameter Set... */ ++ /* ATIMWindow = cur->Configuration.ATIMWindow; */ ++ ATIMWindow = 0; ++ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pktlen); ++ } ++ ++ ++ /* todo: ERP IE */ ++ ++ ++ /* EXTERNDED SUPPORTED RATE */ ++ if (rate_len > 8) ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen); ++ ++ ++ /* todo:HT for adhoc */ ++ ++_ConstructBeacon: ++ ++ if ((pktlen + TXDESC_SIZE) > 512) { ++ RTW_INFO("beacon frame too large\n"); ++ return; ++ } ++ ++ *pLength = pktlen; ++ ++ /* RTW_INFO("%s bcn_sz=%d\n", __FUNCTION__, pktlen); */ ++ ++} ++ ++static void ConstructPSPoll(_adapter *padapter, u8 *pframe, u32 *pLength) ++{ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u16 *fctrl; ++ u32 pktlen; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ /* Frame control. */ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ SetPwrMgt(fctrl); ++ SetFrameSubType(pframe, WIFI_PSPOLL); ++ ++ /* AID. */ ++ SetDuration(pframe, (pmlmeinfo->aid | 0xc000)); ++ ++ /* BSSID. */ ++ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ /* TA. */ ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ ++ *pLength = 16; ++} ++ ++static void ConstructNullFunctionData( ++ PADAPTER padapter, ++ u8 *pframe, ++ u32 *pLength, ++ u8 *StaAddr, ++ u8 bQoS, ++ u8 AC, ++ u8 bEosp, ++ u8 bForcePowerSave) ++{ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u16 *fctrl; ++ u32 pktlen; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wlan_network *cur_network = &pmlmepriv->cur_network; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ ++ /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &pwlanhdr->frame_ctl; ++ *(fctrl) = 0; ++ if (bForcePowerSave) ++ SetPwrMgt(fctrl); ++ ++ switch (cur_network->network.InfrastructureMode) { ++ case Ndis802_11Infrastructure: ++ SetToDs(fctrl); ++ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, StaAddr, ETH_ALEN); ++ break; ++ case Ndis802_11APMode: ++ SetFrDs(fctrl); ++ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ break; ++ case Ndis802_11IBSS: ++ default: ++ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ break; ++ } ++ ++ SetSeqNum(pwlanhdr, 0); ++ ++ if (bQoS == _TRUE) { ++ struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; ++ ++ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); ++ ++ pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos *)pframe; ++ SetPriority(&pwlanqoshdr->qc, AC); ++ SetEOSP(&pwlanqoshdr->qc, bEosp); ++ ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); ++ } else { ++ SetFrameSubType(pframe, WIFI_DATA_NULL); ++ ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ } ++ ++ *pLength = pktlen; ++} ++ ++/* To check if reserved page content is destroyed by beacon because beacon is too large. ++ * 2010.06.23. Added by tynli. */ ++VOID ++CheckFwRsvdPageContent( ++ IN PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u32 MaxBcnPageNum; ++ ++ if (pHalData->FwRsvdPageStartOffset != 0) { ++ /*MaxBcnPageNum = PageNum_128(pMgntInfo->MaxBeaconSize); ++ RT_ASSERT((MaxBcnPageNum <= pHalData->FwRsvdPageStartOffset), ++ ("CheckFwRsvdPageContent(): The reserved page content has been"\ ++ "destroyed by beacon!!! MaxBcnPageNum(%d) FwRsvdPageStartOffset(%d)\n!", ++ MaxBcnPageNum, pHalData->FwRsvdPageStartOffset));*/ ++ } ++} ++ ++/* ++ * Description: Get the reserved page number in Tx packet buffer. ++ * Retrun value: the page number. ++ * 2012.08.09, by tynli. ++ * */ ++u8 GetTxBufferRsvdPageNum8723D(_adapter *padapter, bool wowlan) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 RsvdPageNum = 0; ++ /* default reseved 1 page for the IC type which is undefined. */ ++ u8 TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8723D; ++ ++ rtw_hal_get_def_var(padapter, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&TxPageBndy); ++ ++ RsvdPageNum = LAST_ENTRY_OF_TX_PKT_BUFFER_8723D - TxPageBndy + 1; ++ ++ return RsvdPageNum; ++} ++ ++static void rtl8723d_set_FwRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) ++{ ++ u8 u1H2CRsvdPageParm[H2C_RSVDPAGE_LOC_LEN] = {0}; ++ ++ RTW_INFO("8723DRsvdPageLoc: ProbeRsp=%d PsPoll=%d Null=%d QoSNull=%d BTNull=%d\n", ++ rsvdpageloc->LocProbeRsp, rsvdpageloc->LocPsPoll, ++ rsvdpageloc->LocNullData, rsvdpageloc->LocQosNull, ++ rsvdpageloc->LocBTQosNull); ++ ++ SET_8723D_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(u1H2CRsvdPageParm, rsvdpageloc->LocProbeRsp); ++ SET_8723D_H2CCMD_RSVDPAGE_LOC_PSPOLL(u1H2CRsvdPageParm, rsvdpageloc->LocPsPoll); ++ SET_8723D_H2CCMD_RSVDPAGE_LOC_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocNullData); ++ SET_8723D_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocQosNull); ++ SET_8723D_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocBTQosNull); ++ ++ RTW_DBG_DUMP("u1H2CRsvdPageParm:", ++ u1H2CRsvdPageParm, H2C_RSVDPAGE_LOC_LEN); ++ ++ FillH2CCmd8723D(padapter, H2C_8723D_RSVD_PAGE, H2C_RSVDPAGE_LOC_LEN, u1H2CRsvdPageParm); ++} ++ ++static void rtl8723d_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ u8 res = 0, count = 0; ++#ifdef CONFIG_WOWLAN ++ u8 u1H2CAoacRsvdPageParm[H2C_AOAC_RSVDPAGE_LOC_LEN] = {0}; ++ ++ RTW_INFO("8723DAOACRsvdPageLoc: RWC=%d ArpRsp=%d NbrAdv=%d GtkRsp=%d GtkInfo=%d ProbeReq=%d NetworkList=%d\n", ++ rsvdpageloc->LocRemoteCtrlInfo, rsvdpageloc->LocArpRsp, ++ rsvdpageloc->LocNbrAdv, rsvdpageloc->LocGTKRsp, ++ rsvdpageloc->LocGTKInfo, rsvdpageloc->LocProbeReq, ++ rsvdpageloc->LocNetList); ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED)) { ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocRemoteCtrlInfo); ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocArpRsp); ++ /* SET_H2CCMD_AOAC_RSVDPAGE_LOC_NEIGHBOR_ADV(u1H2CAoacRsvdPageParm, rsvdpageloc->LocNbrAdv); */ ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKRsp); ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKInfo); ++#ifdef CONFIG_GTK_OL ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_EXT_MEM(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKEXTMEM); ++#endif /* CONFIG_GTK_OL */ ++ RTW_DBG_DUMP("u1H2CAoacRsvdPageParm:", ++ u1H2CAoacRsvdPageParm, H2C_AOAC_RSVDPAGE_LOC_LEN); ++ ++ FillH2CCmd8723D(padapter, H2C_8723D_AOAC_RSVD_PAGE, H2C_AOAC_RSVDPAGE_LOC_LEN, u1H2CAoacRsvdPageParm); ++ } else { ++#ifdef CONFIG_PNO_SUPPORT ++ if (!pwrpriv->wowlan_in_resume) { ++ RTW_INFO("NLO_INFO=%d\n", rsvdpageloc->LocPNOInfo); ++ _rtw_memset(&u1H2CAoacRsvdPageParm, 0, sizeof(u1H2CAoacRsvdPageParm)); ++ SET_H2CCMD_AOAC_RSVDPAGE_LOC_NLO_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocPNOInfo); ++ FillH2CCmd8723D(padapter, H2C_AOAC_RSVDPAGE3, H2C_AOAC_RSVDPAGE_LOC_LEN, u1H2CAoacRsvdPageParm); ++ rtw_msleep_os(10); ++ } ++#endif ++ } ++ ++#endif /* CONFIG_WOWLAN */ ++} ++ ++static void rtl8723d_set_FwKeepAlive_cmd(PADAPTER padapter, u8 benable, u8 pkt_type) ++{ ++ u8 u1H2CKeepAliveParm[H2C_KEEP_ALIVE_CTRL_LEN] = {0}; ++ u8 adopt = 1; ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++ u8 check_period = 10; ++#else ++ u8 check_period = 5; ++#endif ++ ++ RTW_INFO("%s(): benable = %d\n", __func__, benable); ++ SET_8723D_H2CCMD_KEEPALIVE_PARM_ENABLE(u1H2CKeepAliveParm, benable); ++ SET_8723D_H2CCMD_KEEPALIVE_PARM_ADOPT(u1H2CKeepAliveParm, adopt); ++ SET_8723D_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(u1H2CKeepAliveParm, pkt_type); ++ SET_8723D_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(u1H2CKeepAliveParm, check_period); ++ ++ RTW_DBG_DUMP("u1H2CKeepAliveParm:", ++ u1H2CKeepAliveParm, H2C_KEEP_ALIVE_CTRL_LEN); ++ ++ FillH2CCmd8723D(padapter, H2C_8723D_KEEP_ALIVE, H2C_KEEP_ALIVE_CTRL_LEN, u1H2CKeepAliveParm); ++} ++ ++static void rtl8723d_set_FwDisconDecision_cmd(PADAPTER padapter, u8 benable) ++{ ++ u8 u1H2CDisconDecisionParm[H2C_DISCON_DECISION_LEN] = {0}; ++ u8 adopt = 1, check_period = 10, trypkt_num = 0; ++ ++ RTW_INFO("%s(): benable = %d\n", __func__, benable); ++ SET_8723D_H2CCMD_DISCONDECISION_PARM_ENABLE(u1H2CDisconDecisionParm, benable); ++ SET_8723D_H2CCMD_DISCONDECISION_PARM_ADOPT(u1H2CDisconDecisionParm, adopt); ++ SET_8723D_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(u1H2CDisconDecisionParm, check_period); ++ SET_8723D_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(u1H2CDisconDecisionParm, trypkt_num); ++ ++ RTW_DBG_DUMP("u1H2CDisconDecisionParm:", ++ u1H2CDisconDecisionParm, H2C_DISCON_DECISION_LEN); ++ ++ FillH2CCmd8723D(padapter, H2C_8723D_DISCON_DECISION, H2C_DISCON_DECISION_LEN, u1H2CDisconDecisionParm); ++} ++ ++void rtl8723d_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 u1H2CMacIdConfigParm[H2C_MACID_CFG_LEN] = {0}; ++ ++ RTW_INFO("%s(): mac_id=%d raid=0x%x bw=%d mask=0x%x\n", __func__, mac_id, raid, bw, mask); ++ ++ ++ SET_8723D_H2CCMD_MACID_CFG_MACID(u1H2CMacIdConfigParm, mac_id); ++ SET_8723D_H2CCMD_MACID_CFG_RAID(u1H2CMacIdConfigParm, raid); ++ SET_8723D_H2CCMD_MACID_CFG_SGI_EN(u1H2CMacIdConfigParm, (sgi) ? 1 : 0); ++ SET_8723D_H2CCMD_MACID_CFG_BW(u1H2CMacIdConfigParm, bw); ++ ++ /* DisableTXPowerTraining */ ++ if (pHalData->bDisableTXPowerTraining) { ++ SET_8723D_H2CCMD_MACID_CFG_DISPT(u1H2CMacIdConfigParm, 1); ++ RTW_INFO("%s,Disable PWT by driver\n", __FUNCTION__); ++ } else { ++ PDM_ODM_T pDM_OutSrc = &pHalData->odmpriv; ++ ++ if (pDM_OutSrc->bDisablePowerTraining) { ++ SET_8723D_H2CCMD_MACID_CFG_DISPT(u1H2CMacIdConfigParm, 1); ++ RTW_INFO("%s,Disable PWT by DM\n", __FUNCTION__); ++ } ++ } ++ ++ SET_8723D_H2CCMD_MACID_CFG_RATE_MASK0(u1H2CMacIdConfigParm, (u8)(mask & 0x000000ff)); ++ SET_8723D_H2CCMD_MACID_CFG_RATE_MASK1(u1H2CMacIdConfigParm, (u8)((mask & 0x0000ff00) >> 8)); ++ SET_8723D_H2CCMD_MACID_CFG_RATE_MASK2(u1H2CMacIdConfigParm, (u8)((mask & 0x00ff0000) >> 16)); ++ SET_8723D_H2CCMD_MACID_CFG_RATE_MASK3(u1H2CMacIdConfigParm, (u8)((mask & 0xff000000) >> 24)); ++ ++ RTW_DBG_DUMP("u1H2CMacIdConfigParm:", ++ u1H2CMacIdConfigParm, H2C_MACID_CFG_LEN); ++ ++ FillH2CCmd8723D(padapter, H2C_8723D_MACID_CFG, H2C_MACID_CFG_LEN, u1H2CMacIdConfigParm); ++ ++} ++ ++void rtl8723d_set_FwRssiSetting_cmd(_adapter *padapter, u8 *param) ++{ ++ u8 u1H2CRssiSettingParm[H2C_RSSI_SETTING_LEN] = {0}; ++ u8 mac_id = *param; ++ u8 rssi = *(param + 2); ++ u8 uldl_state = 0; ++ ++ /* RTW_INFO("%s(): param=%.2x-%.2x-%.2x\n", __func__, *param, *(param+1), *(param+2)); */ ++ /* RTW_INFO("%s(): mac_id=%d rssi=%d\n", __func__, mac_id, rssi); */ ++ ++ SET_8723D_H2CCMD_RSSI_SETTING_MACID(u1H2CRssiSettingParm, mac_id); ++ SET_8723D_H2CCMD_RSSI_SETTING_RSSI(u1H2CRssiSettingParm, rssi); ++ SET_8723D_H2CCMD_RSSI_SETTING_ULDL_STATE(u1H2CRssiSettingParm, uldl_state); ++ ++ RTW_DBG_DUMP("u1H2CRssiSettingParm:", ++ u1H2CRssiSettingParm, H2C_RSSI_SETTING_LEN); ++ FillH2CCmd8723D(padapter, H2C_8723D_RSSI_SETTING, H2C_RSSI_SETTING_LEN, u1H2CRssiSettingParm); ++ ++} ++ ++void rtl8723d_set_FwAPReqRPT_cmd(PADAPTER padapter, u32 need_ack) ++{ ++ u8 u1H2CApReqRptParm[H2C_AP_REQ_TXRPT_LEN] = {0}; ++ u8 macid1 = 1, macid2 = 0; ++ ++ RTW_INFO("%s(): need_ack = %d\n", __func__, need_ack); ++ ++ SET_8723D_H2CCMD_APREQRPT_PARM_MACID1(u1H2CApReqRptParm, macid1); ++ SET_8723D_H2CCMD_APREQRPT_PARM_MACID2(u1H2CApReqRptParm, macid2); ++ ++ RTW_DBG_DUMP("u1H2CApReqRptParm:", ++ u1H2CApReqRptParm, H2C_AP_REQ_TXRPT_LEN); ++ ++ FillH2CCmd8723D(padapter, H2C_8723D_AP_REQ_TXRPT, H2C_AP_REQ_TXRPT_LEN, u1H2CApReqRptParm); ++} ++ ++void rtl8723d_set_FwPwrMode_cmd(PADAPTER padapter, u8 psmode) ++{ ++ int i; ++ u8 smart_ps = 0; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ u8 u1H2CPwrModeParm[H2C_PWRMODE_LEN] = {0}; ++ u8 PowerState = 0, awake_intvl = 1, byte5 = 0, rlbm = 0; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *wdinfo = &(padapter->wdinfo); ++#endif /* CONFIG_P2P */ ++ ++ ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++ if (psmode == PS_MODE_DTIM) ++ psmode = PS_MODE_MAX; ++#endif /* CONFIG_PLATFORM_INTEL_BYT */ ++ ++ ++ if (pwrpriv->dtim > 0) ++ RTW_INFO("%s(): FW LPS mode = %d, SmartPS=%d, dtim=%d\n", __func__, psmode, pwrpriv->smart_ps, pwrpriv->dtim); ++ else ++ RTW_INFO("%s(): FW LPS mode = %d, SmartPS=%d\n", __func__, psmode, pwrpriv->smart_ps); ++ ++ if (psmode == PS_MODE_MIN) { ++ rlbm = 0; ++ awake_intvl = 2; ++ smart_ps = pwrpriv->smart_ps; ++ } else if (psmode == PS_MODE_MAX) { ++ rlbm = 1; ++ awake_intvl = 2; ++ smart_ps = pwrpriv->smart_ps; ++ } else if (psmode == PS_MODE_DTIM) { /* For WOWLAN LPS, DTIM = (awake_intvl - 1) */ ++ if (pwrpriv->dtim > 0 && pwrpriv->dtim < 16) ++ awake_intvl = pwrpriv->dtim + 1; /* DTIM = (awake_intvl - 1) */ ++ else ++ awake_intvl = 4;/* DTIM=3 */ ++ ++ ++ rlbm = 2; ++ smart_ps = pwrpriv->smart_ps; ++ } else { ++ rlbm = 2; ++ awake_intvl = 4; ++ smart_ps = pwrpriv->smart_ps; ++ } ++ ++#ifdef CONFIG_P2P ++ if (!rtw_p2p_chk_state(wdinfo, P2P_STATE_NONE)) { ++ awake_intvl = 2; ++ rlbm = 1; ++ } ++#endif /* CONFIG_P2P */ ++ ++ if (padapter->registrypriv.wifi_spec == 1) { ++ awake_intvl = 2; ++ rlbm = 1; ++ } ++ ++ if (psmode > 0) { ++#ifdef CONFIG_BT_COEXIST ++ if (rtw_btcoex_IsBtControlLps(padapter) == _TRUE) { ++ PowerState = rtw_btcoex_RpwmVal(padapter); ++ byte5 = rtw_btcoex_LpsVal(padapter); ++ ++ if ((rlbm == 2) && (byte5 & BIT(4))) { ++ /* Keep awake interval to 1 to prevent from */ ++ /* decreasing coex performance */ ++ awake_intvl = 2; ++ rlbm = 2; ++ } ++ } else ++#endif /* CONFIG_BT_COEXIST */ ++ { ++ PowerState = 0x00;/* AllON(0x0C), RFON(0x04), RFOFF(0x00) */ ++ byte5 = 0x40; ++ } ++ } else { ++ PowerState = 0x0C;/* AllON(0x0C), RFON(0x04), RFOFF(0x00) */ ++ byte5 = 0x40; ++ } ++ ++ SET_8723D_H2CCMD_PWRMODE_PARM_MODE(u1H2CPwrModeParm, (psmode > 0) ? 1 : 0); ++ SET_8723D_H2CCMD_PWRMODE_PARM_SMART_PS(u1H2CPwrModeParm, smart_ps); ++ SET_8723D_H2CCMD_PWRMODE_PARM_RLBM(u1H2CPwrModeParm, rlbm); ++ SET_8723D_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(u1H2CPwrModeParm, awake_intvl); ++ SET_8723D_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(u1H2CPwrModeParm, padapter->registrypriv.uapsd_enable); ++ SET_8723D_H2CCMD_PWRMODE_PARM_PWR_STATE(u1H2CPwrModeParm, PowerState); ++ SET_8723D_H2CCMD_PWRMODE_PARM_BYTE5(u1H2CPwrModeParm, byte5); ++#ifdef CONFIG_LPS_LCLK ++ if (psmode != PS_MODE_ACTIVE) { ++ if (pmlmeext->adaptive_tsf_done == _FALSE && pmlmeext->bcn_cnt > 0) { ++ u8 ratio_20_delay, ratio_80_delay; ++ ++ /* byte 6 for adaptive_early_32k */ ++ /* [0:3] = DrvBcnEarly (ms) , [4:7] = DrvBcnTimeOut (ms) */ ++ /* 20% for DrvBcnEarly, 80% for DrvBcnTimeOut */ ++ ratio_20_delay = 0; ++ ratio_80_delay = 0; ++ pmlmeext->DrvBcnEarly = 0xff; ++ pmlmeext->DrvBcnTimeOut = 0xff; ++ ++ /* RTW_INFO("%s(): bcn_cnt = %d\n", __func__, pmlmeext->bcn_cnt); */ ++ ++ for (i = 0; i < 9; i++) { ++ pmlmeext->bcn_delay_ratio[i] = (pmlmeext->bcn_delay_cnt[i] * 100) / pmlmeext->bcn_cnt; ++ ++ /* RTW_INFO("%s(): bcn_delay_cnt[%d]=%d, bcn_delay_ratio[%d] = %d\n", __func__, i, pmlmeext->bcn_delay_cnt[i] */ ++ /* ,i ,pmlmeext->bcn_delay_ratio[i]); */ ++ ++ ratio_20_delay += pmlmeext->bcn_delay_ratio[i]; ++ ratio_80_delay += pmlmeext->bcn_delay_ratio[i]; ++ ++ if (ratio_20_delay > 20 && pmlmeext->DrvBcnEarly == 0xff) { ++ pmlmeext->DrvBcnEarly = i; ++ /* RTW_INFO("%s(): DrvBcnEarly = %d\n", __func__, pmlmeext->DrvBcnEarly); */ ++ } ++ ++ if (ratio_80_delay > 80 && pmlmeext->DrvBcnTimeOut == 0xff) { ++ pmlmeext->DrvBcnTimeOut = i; ++ /* RTW_INFO("%s(): DrvBcnTimeOut = %d\n", __func__, pmlmeext->DrvBcnTimeOut); */ ++ } ++ ++ /* reset adaptive_early_32k cnt */ ++ pmlmeext->bcn_delay_cnt[i] = 0; ++ pmlmeext->bcn_delay_ratio[i] = 0; ++ ++ } ++ ++ pmlmeext->bcn_cnt = 0; ++ pmlmeext->adaptive_tsf_done = _TRUE; ++ ++ } else { ++ /* RTW_INFO("%s(): DrvBcnEarly = %d\n", __func__, pmlmeext->DrvBcnEarly); */ ++ /* RTW_INFO("%s(): DrvBcnTimeOut = %d\n", __func__, pmlmeext->DrvBcnTimeOut); */ ++ } ++ ++ /* offload to FW if fw version > v15.10 ++ pmlmeext->DrvBcnEarly=0; ++ pmlmeext->DrvBcnTimeOut=7; ++ ++ if((pmlmeext->DrvBcnEarly!=0Xff) && (pmlmeext->DrvBcnTimeOut!=0xff)) ++ u1H2CPwrModeParm[H2C_PWRMODE_LEN-1] = BIT(0) | ((pmlmeext->DrvBcnEarly<<1)&0x0E) |((pmlmeext->DrvBcnTimeOut<<4)&0xf0) ; ++ */ ++ ++ } ++#endif ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_RecordPwrMode(padapter, u1H2CPwrModeParm, H2C_PWRMODE_LEN); ++#endif /* CONFIG_BT_COEXIST */ ++ ++ RTW_DBG_DUMP("u1H2CPwrModeParm:", ++ u1H2CPwrModeParm, H2C_PWRMODE_LEN); ++ ++ FillH2CCmd8723D(padapter, H2C_8723D_SET_PWR_MODE, H2C_PWRMODE_LEN, u1H2CPwrModeParm); ++} ++ ++void rtl8723d_set_FwPsTuneParam_cmd(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ u8 u1H2CPsTuneParm[H2C_PSTUNEPARAM_LEN] = {0}; ++ u8 bcn_to_limit = 10; /* 10 * 100 * awakeinterval (ms) */ ++ u8 dtim_timeout = 5; /* ms //wait broadcast data timer */ ++ u8 ps_timeout = 20; /* ms //Keep awake when tx */ ++ u8 dtim_period = 3; ++ ++ /* RTW_INFO("%s(): FW LPS mode = %d\n", __func__, psmode); */ ++ ++ SET_8723D_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(u1H2CPsTuneParm, bcn_to_limit); ++ SET_8723D_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(u1H2CPsTuneParm, dtim_timeout); ++ SET_8723D_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(u1H2CPsTuneParm, ps_timeout); ++ SET_8723D_H2CCMD_PSTUNE_PARM_ADOPT(u1H2CPsTuneParm, 1); ++ SET_8723D_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(u1H2CPsTuneParm, dtim_period); ++ ++ RTW_DBG_DUMP("u1H2CPsTuneParm:", ++ u1H2CPsTuneParm, H2C_PSTUNEPARAM_LEN); ++ ++ FillH2CCmd8723D(padapter, H2C_8723D_PS_TUNING_PARA, H2C_PSTUNEPARAM_LEN, u1H2CPsTuneParm); ++} ++ ++void rtl8723d_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param) ++{ ++ u8 u1H2CBtMpOperParm[H2C_BTMP_OPER_LEN] = {0}; ++ ++ ++ RTW_INFO("%s: idx=%d ver=%d reqnum=%d param1=0x%02x param2=0x%02x\n", __FUNCTION__, idx, ver, reqnum, param[0], param[1]); ++ ++ SET_8723D_H2CCMD_BT_MPOPER_VER(u1H2CBtMpOperParm, ver); ++ SET_8723D_H2CCMD_BT_MPOPER_REQNUM(u1H2CBtMpOperParm, reqnum); ++ SET_8723D_H2CCMD_BT_MPOPER_IDX(u1H2CBtMpOperParm, idx); ++ SET_8723D_H2CCMD_BT_MPOPER_PARAM1(u1H2CBtMpOperParm, param[0]); ++ SET_8723D_H2CCMD_BT_MPOPER_PARAM2(u1H2CBtMpOperParm, param[1]); ++ SET_8723D_H2CCMD_BT_MPOPER_PARAM3(u1H2CBtMpOperParm, param[2]); ++ ++ RTW_DBG_DUMP("u1H2CBtMpOperParm:", ++ u1H2CBtMpOperParm, H2C_BTMP_OPER_LEN); ++ ++ FillH2CCmd8723D(padapter, H2C_8723D_BT_MP_OPER, H2C_BTMP_OPER_LEN, u1H2CBtMpOperParm); ++} ++ ++void rtl8723d_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 en) ++{ ++ /* u8 cmd_param; //BIT0:enable, BIT1:Ignore PS Condition.*/ ++ ++ u8 parm[H2C_INACTIVE_PS_LEN] = {0}; ++ ++ SET_H2CCMD_INACTIVE_PS_EN(parm, en); ++ ++ FillH2CCmd8723D(padapter, H2C_INACTIVE_PS_, H2C_INACTIVE_PS_LEN, parm); ++} ++ ++static s32 rtl8723d_set_FwLowPwrLps_cmd(PADAPTER padapter, u8 enable) ++{ ++ /* TODO */ ++ return _FALSE; ++} ++ ++ ++void rtl8723d_download_rsvd_page(PADAPTER padapter, u8 mstatus) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ BOOLEAN bcn_valid = _FALSE; ++ u8 DLBcnCount = 0; ++ u32 poll = 0; ++ u8 val8; ++ ++ ++ RTW_INFO("+" FUNC_ADPT_FMT ": hw_port=%d mstatus(%x)\n", ++ FUNC_ADPT_ARG(padapter), get_hw_port(padapter), mstatus); ++ ++ if (mstatus == RT_MEDIA_CONNECT) { ++ BOOLEAN bRecover = _FALSE; ++ u8 v8; ++ ++ /* We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. */ ++ /* Suggested by filen. Added by tynli. */ ++ rtw_write16(padapter, REG_BCN_PSR_RPT, (0xC000 | pmlmeinfo->aid)); ++ ++ /* set REG_CR bit 8 */ ++ v8 = rtw_read8(padapter, REG_CR + 1); ++ v8 |= BIT(0); /* ENSWBCN */ ++ rtw_write8(padapter, REG_CR + 1, v8); ++ ++ /* Disable Hw protection for a time which revserd for Hw sending beacon. */ ++ /* Fix download reserved page packet fail that access collision with the protection time. */ ++ /* 2010.05.11. Added by tynli. */ ++ val8 = rtw_read8(padapter, REG_BCN_CTRL); ++ val8 &= ~EN_BCN_FUNCTION; ++ val8 |= DIS_TSF_UDT; ++ rtw_write8(padapter, REG_BCN_CTRL, val8); ++ ++ /* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. */ ++ if (pHalData->RegFwHwTxQCtrl & BIT(6)) ++ bRecover = _TRUE; ++ ++ /* To tell Hw the packet is not a real beacon frame. */ ++ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl & ~BIT(6)); ++ pHalData->RegFwHwTxQCtrl &= ~BIT(6); ++ ++ /* Clear beacon valid check bit. */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); ++ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); ++ ++ DLBcnCount = 0; ++ poll = 0; ++ do { ++ /* download rsvd page. */ ++ rtw_hal_set_fw_rsvd_page(padapter, 0); ++ DLBcnCount++; ++ do { ++ rtw_yield_os(); ++ /* rtw_mdelay_os(10); */ ++ /* check rsvd page download OK. */ ++ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8 *)(&bcn_valid)); ++ poll++; ++ } while (!bcn_valid && (poll % 10) != 0 && !RTW_CANNOT_RUN(padapter)); ++ ++ } while (!bcn_valid && DLBcnCount <= 100 && !RTW_CANNOT_RUN(padapter)); ++ ++ if (RTW_CANNOT_RUN(padapter)) ++ ; ++ else if (!bcn_valid) ++ RTW_INFO(ADPT_FMT": 1 DL RSVD page failed! DLBcnCount:%u, poll:%u\n", ++ ADPT_ARG(padapter) , DLBcnCount, poll); ++ else { ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ ++ pwrctl->fw_psmode_iface_id = padapter->iface_id; ++ RTW_INFO(ADPT_FMT": 1 DL RSVD page success! DLBcnCount:%u, poll:%u\n", ++ ADPT_ARG(padapter), DLBcnCount, poll); ++ } ++ ++ /* 2010.05.11. Added by tynli. */ ++ val8 = rtw_read8(padapter, REG_BCN_CTRL); ++ val8 |= EN_BCN_FUNCTION; ++ val8 &= ~DIS_TSF_UDT; ++ rtw_write8(padapter, REG_BCN_CTRL, val8); ++ ++ /* To make sure that if there exists an adapter which would like to send beacon. */ ++ /* If exists, the origianl value of 0x422[6] will be 1, we should check this to */ ++ /* prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ ++ /* the beacon cannot be sent by HW. */ ++ /* 2010.06.23. Added by tynli. */ ++ if (bRecover) { ++ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl | BIT(6)); ++ pHalData->RegFwHwTxQCtrl |= BIT(6); ++ } ++ ++ /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ ++#ifndef CONFIG_PCI_HCI ++ v8 = rtw_read8(padapter, REG_CR + 1); ++ v8 &= ~BIT(0); /* ~ENSWBCN */ ++ rtw_write8(padapter, REG_CR + 1, v8); ++#endif ++ } ++ ++} ++ ++void rtl8723d_set_rssi_cmd(_adapter *padapter, u8 *param) ++{ ++ rtl8723d_set_FwRssiSetting_cmd(padapter, param); ++} ++ ++void rtl8723d_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus) ++{ ++ struct sta_info *psta = NULL; ++ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ if (mstatus == 1) ++ rtl8723d_download_rsvd_page(padapter, RT_MEDIA_CONNECT); ++} ++#if 0 ++void rtl8723d_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack) ++{ ++ rtl8723d_set_FwAPReqRPT_cmd(padapter, need_ack); ++} ++#endif ++ ++#ifdef CONFIG_BT_COEXIST ++static void ConstructBtNullFunctionData( ++ PADAPTER padapter, ++ u8 *pframe, ++ u32 *pLength, ++ u8 *StaAddr, ++ u8 bQoS, ++ u8 AC, ++ u8 bEosp, ++ u8 bForcePowerSave) ++{ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ u16 *fctrl; ++ u32 pktlen; ++ struct mlme_ext_priv *pmlmeext; ++ struct mlme_ext_info *pmlmeinfo; ++ u8 bssid[ETH_ALEN]; ++ ++ ++ RTW_INFO("+" FUNC_ADPT_FMT ": qos=%d eosp=%d ps=%d\n", ++ FUNC_ADPT_ARG(padapter), bQoS, bEosp, bForcePowerSave); ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ pmlmeext = &padapter->mlmeextpriv; ++ pmlmeinfo = &pmlmeext->mlmext_info; ++ ++ if (NULL == StaAddr) { ++ _rtw_memcpy(bssid, adapter_mac_addr(padapter), ETH_ALEN); ++ StaAddr = bssid; ++ } ++ ++ fctrl = &pwlanhdr->frame_ctl; ++ *fctrl = 0; ++ if (bForcePowerSave) ++ SetPwrMgt(fctrl); ++ ++ SetFrDs(fctrl); ++ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ ++ SetDuration(pwlanhdr, 0); ++ SetSeqNum(pwlanhdr, 0); ++ ++ if (bQoS == _TRUE) { ++ struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; ++ ++ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); ++ ++ pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos *)pframe; ++ SetPriority(&pwlanqoshdr->qc, AC); ++ SetEOSP(&pwlanqoshdr->qc, bEosp); ++ ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); ++ } else { ++ SetFrameSubType(pframe, WIFI_DATA_NULL); ++ ++ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ } ++ ++ *pLength = pktlen; ++} ++ ++static void SetFwRsvdPagePkt_BTCoex(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData; ++ struct xmit_frame *pcmdframe; ++ struct pkt_attrib *pattrib; ++ struct xmit_priv *pxmitpriv; ++ struct mlme_ext_priv *pmlmeext; ++ struct mlme_ext_info *pmlmeinfo; ++ u32 BeaconLength = 0; ++ u32 BTQosNullLength = 0; ++ u8 *ReservedPagePacket; ++ u8 TxDescLen, TxDescOffset; ++ u8 TotalPageNum = 0, CurtPktPageNum = 0, RsvdPageNum = 0; ++ u16 BufIndex, PageSize; ++ u32 TotalPacketLen, MaxRsvdPageBufSize = 0; ++ RSVDPAGE_LOC RsvdPageLoc; ++ ++ ++ /* RTW_INFO("+" FUNC_ADPT_FMT "\n", FUNC_ADPT_ARG(padapter)); */ ++ ++ pHalData = GET_HAL_DATA(padapter); ++ pxmitpriv = &padapter->xmitpriv; ++ pmlmeext = &padapter->mlmeextpriv; ++ pmlmeinfo = &pmlmeext->mlmext_info; ++ TxDescLen = TXDESC_SIZE; ++ TxDescOffset = TXDESC_OFFSET; ++ PageSize = PAGE_SIZE_TX_8723D; ++ ++ RsvdPageNum = BCNQ_PAGE_NUM_8723D; ++ MaxRsvdPageBufSize = RsvdPageNum * PageSize; ++ ++ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); ++ if (pcmdframe == NULL) { ++ RTW_INFO("%s: alloc ReservedPagePacket fail!\n", __FUNCTION__); ++ return; ++ } ++ ++ ReservedPagePacket = pcmdframe->buf_addr; ++ _rtw_memset(&RsvdPageLoc, 0, sizeof(RSVDPAGE_LOC)); ++ ++ /* 3 (1) beacon */ ++ BufIndex = TxDescOffset; ++ ConstructBeacon(padapter, &ReservedPagePacket[BufIndex], &BeaconLength); ++ ++ /* When we count the first page size, we need to reserve description size for the RSVD */ ++ /* packet, it will be filled in front of the packet in TXPKTBUF. */ ++ CurtPktPageNum = (u8)PageNum_128(TxDescLen + BeaconLength); ++ /* If we don't add 1 more page, the WOWLAN function has a problem. Baron thinks it's a bug of firmware */ ++ if (CurtPktPageNum == 1) ++ CurtPktPageNum += 1; ++ TotalPageNum += CurtPktPageNum; ++ ++ BufIndex += (CurtPktPageNum * PageSize); ++ ++ /* Jump to lastest page */ ++ if (BufIndex < (MaxRsvdPageBufSize - PageSize)) { ++ BufIndex = TxDescOffset + (MaxRsvdPageBufSize - PageSize); ++ TotalPageNum = BCNQ_PAGE_NUM_8723D - 1; ++ } ++ ++ /* 3 (6) BT Qos null data */ ++ RsvdPageLoc.LocBTQosNull = TotalPageNum; ++ ConstructBtNullFunctionData( ++ padapter, ++ &ReservedPagePacket[BufIndex], ++ &BTQosNullLength, ++ NULL, ++ _TRUE, 0, 0, _FALSE); ++ rtl8723d_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex - TxDescLen], BTQosNullLength, _FALSE, _TRUE, _FALSE); ++ ++ CurtPktPageNum = (u8)PageNum_128(TxDescLen + BTQosNullLength); ++ ++ TotalPageNum += CurtPktPageNum; ++ ++ TotalPacketLen = BufIndex + BTQosNullLength; ++ if (TotalPacketLen > MaxRsvdPageBufSize) { ++ RTW_INFO(FUNC_ADPT_FMT ": ERROR: The rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n", ++ FUNC_ADPT_ARG(padapter), TotalPacketLen, MaxRsvdPageBufSize); ++ goto error; ++ } ++ ++ /* update attribute */ ++ pattrib = &pcmdframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ pattrib->qsel = QSLT_BEACON; ++ pattrib->pktlen = pattrib->last_txcmdsz = TotalPacketLen - TxDescOffset; ++#ifdef CONFIG_PCI_HCI ++ dump_mgntframe(padapter, pcmdframe); ++#else ++ dump_mgntframe_and_wait(padapter, pcmdframe, 100); ++#endif ++ ++ /* RTW_INFO(FUNC_ADPT_FMT ": Set RSVD page location to Fw, TotalPacketLen(%d), TotalPageNum(%d)\n", ++ * FUNC_ADPT_ARG(padapter), TotalPacketLen, TotalPageNum); */ ++ rtl8723d_set_FwRsvdPage_cmd(padapter, &RsvdPageLoc); ++ rtl8723d_set_FwAoacRsvdPage_cmd(padapter, &RsvdPageLoc); ++ ++ return; ++ ++error: ++ rtw_free_xmitframe(pxmitpriv, pcmdframe); ++} ++ ++void rtl8723d_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData; ++ struct mlme_ext_priv *pmlmeext; ++ struct mlme_ext_info *pmlmeinfo; ++ u8 bRecover = _FALSE; ++ u8 bcn_valid = _FALSE; ++ u8 DLBcnCount = 0; ++ u32 poll = 0; ++ u8 val8; ++ ++ ++ RTW_INFO("+" FUNC_ADPT_FMT ": hw_port=%d fw_state=0x%08X\n", ++ FUNC_ADPT_ARG(padapter), get_hw_port(padapter), get_fwstate(&padapter->mlmepriv)); ++ ++#ifdef CONFIG_RTW_DEBUG ++ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _FALSE) { ++ RTW_INFO(FUNC_ADPT_FMT ": [WARNING] not in AP mode!!\n", ++ FUNC_ADPT_ARG(padapter)); ++ } ++#endif /* CONFIG_RTW_DEBUG */ ++ ++ pHalData = GET_HAL_DATA(padapter); ++ pmlmeext = &padapter->mlmeextpriv; ++ pmlmeinfo = &pmlmeext->mlmext_info; ++ ++ /* We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. */ ++ /* Suggested by filen. Added by tynli. */ ++ rtw_write16(padapter, REG_BCN_PSR_RPT, (0xC000 | pmlmeinfo->aid)); ++ ++ /* set REG_CR bit 8 */ ++ val8 = rtw_read8(padapter, REG_CR + 1); ++ val8 |= BIT(0); /* ENSWBCN */ ++ rtw_write8(padapter, REG_CR + 1, val8); ++ ++ /* Disable Hw protection for a time which revserd for Hw sending beacon. */ ++ /* Fix download reserved page packet fail that access collision with the protection time. */ ++ /* 2010.05.11. Added by tynli. */ ++ val8 = rtw_read8(padapter, REG_BCN_CTRL); ++ val8 &= ~EN_BCN_FUNCTION; ++ val8 |= DIS_TSF_UDT; ++ rtw_write8(padapter, REG_BCN_CTRL, val8); ++ ++ /* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. */ ++ if (pHalData->RegFwHwTxQCtrl & BIT(6)) ++ bRecover = _TRUE; ++ ++ /* To tell Hw the packet is not a real beacon frame. */ ++ pHalData->RegFwHwTxQCtrl &= ~BIT(6); ++ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl); ++ ++ /* Clear beacon valid check bit. */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); ++ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); ++ ++ DLBcnCount = 0; ++ poll = 0; ++ do { ++ SetFwRsvdPagePkt_BTCoex(padapter); ++ DLBcnCount++; ++ do { ++ rtw_yield_os(); ++ /* rtw_mdelay_os(10); */ ++ /* check rsvd page download OK. */ ++ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, &bcn_valid); ++ poll++; ++ } while (!bcn_valid && (poll % 10) != 0 && !RTW_CANNOT_RUN(padapter)); ++ } while (!bcn_valid && (DLBcnCount <= 100) && !RTW_CANNOT_RUN(padapter)); ++ ++ if (_TRUE == bcn_valid) { ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ ++ pwrctl->fw_psmode_iface_id = padapter->iface_id; ++ RTW_INFO(ADPT_FMT": DL RSVD page success! DLBcnCount:%d, poll:%d\n", ++ ADPT_ARG(padapter), DLBcnCount, poll); ++ } else { ++ RTW_INFO(ADPT_FMT": DL RSVD page fail! DLBcnCount:%d, poll:%d\n", ++ ADPT_ARG(padapter), DLBcnCount, poll); ++ RTW_INFO(ADPT_FMT": DL RSVD page fail! bSurpriseRemoved=%s\n", ++ ADPT_ARG(padapter), rtw_is_surprise_removed(padapter) ? "True" : "False"); ++ RTW_INFO(ADPT_FMT": DL RSVD page fail! bDriverStopped=%s\n", ++ ADPT_ARG(padapter), rtw_is_drv_stopped(padapter) ? "True" : "False"); ++ } ++ ++ /* 2010.05.11. Added by tynli. */ ++ val8 = rtw_read8(padapter, REG_BCN_CTRL); ++ val8 |= EN_BCN_FUNCTION; ++ val8 &= ~DIS_TSF_UDT; ++ rtw_write8(padapter, REG_BCN_CTRL, val8); ++ ++ /* To make sure that if there exists an adapter which would like to send beacon. */ ++ /* If exists, the origianl value of 0x422[6] will be 1, we should check this to */ ++ /* prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ ++ /* the beacon cannot be sent by HW. */ ++ /* 2010.06.23. Added by tynli. */ ++ if (bRecover) { ++ pHalData->RegFwHwTxQCtrl |= BIT(6); ++ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl); ++ } ++ ++ /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ ++#ifndef CONFIG_PCI_HCI ++ val8 = rtw_read8(padapter, REG_CR + 1); ++ val8 &= ~BIT(0); /* ~ENSWBCN */ ++ rtw_write8(padapter, REG_CR + 1, val8); ++#endif ++} ++#endif /* CONFIG_BT_COEXIST */ ++ ++#ifdef CONFIG_P2P ++void rtl8723d_set_p2p_ps_offload_cmd(_adapter *padapter, u8 p2p_ps_state) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ struct P2P_PS_Offload_t *p2p_ps_offload = (struct P2P_PS_Offload_t *)(&pHalData->p2p_ps_offload); ++ u8 i; ++ ++ ++#if 1 ++ switch (p2p_ps_state) { ++ case P2P_PS_DISABLE: ++ RTW_INFO("P2P_PS_DISABLE\n"); ++ _rtw_memset(p2p_ps_offload, 0 , 1); ++ break; ++ case P2P_PS_ENABLE: ++ RTW_INFO("P2P_PS_ENABLE\n"); ++ /* update CTWindow value. */ ++ if (pwdinfo->ctwindow > 0) { ++ p2p_ps_offload->CTWindow_En = 1; ++ rtw_write8(padapter, REG_P2P_CTWIN, pwdinfo->ctwindow); ++ } ++ ++ /* hw only support 2 set of NoA */ ++ for (i = 0 ; i < pwdinfo->noa_num ; i++) { ++ /* To control the register setting for which NOA */ ++ rtw_write8(padapter, REG_NOA_DESC_SEL, (i << 4)); ++ if (i == 0) ++ p2p_ps_offload->NoA0_En = 1; ++ else ++ p2p_ps_offload->NoA1_En = 1; ++ ++ /* config P2P NoA Descriptor Register */ ++ /* RTW_INFO("%s(): noa_duration = %x\n",__FUNCTION__,pwdinfo->noa_duration[i]); */ ++ rtw_write32(padapter, REG_NOA_DESC_DURATION, pwdinfo->noa_duration[i]); ++ ++ /* RTW_INFO("%s(): noa_interval = %x\n",__FUNCTION__,pwdinfo->noa_interval[i]); */ ++ rtw_write32(padapter, REG_NOA_DESC_INTERVAL, pwdinfo->noa_interval[i]); ++ ++ /* RTW_INFO("%s(): start_time = %x\n",__FUNCTION__,pwdinfo->noa_start_time[i]); */ ++ rtw_write32(padapter, REG_NOA_DESC_START, pwdinfo->noa_start_time[i]); ++ ++ /* RTW_INFO("%s(): noa_count = %x\n",__FUNCTION__,pwdinfo->noa_count[i]); */ ++ rtw_write8(padapter, REG_NOA_DESC_COUNT, pwdinfo->noa_count[i]); ++ } ++ ++ if ((pwdinfo->opp_ps == 1) || (pwdinfo->noa_num > 0)) { ++ /* rst p2p circuit */ ++ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(4)); ++ ++ p2p_ps_offload->Offload_En = 1; ++ ++ if (pwdinfo->role == P2P_ROLE_GO) { ++ p2p_ps_offload->role = 1; ++ p2p_ps_offload->AllStaSleep = 0; ++ } else ++ p2p_ps_offload->role = 0; ++ ++ p2p_ps_offload->discovery = 0; ++ } ++ break; ++ case P2P_PS_SCAN: ++ RTW_INFO("P2P_PS_SCAN\n"); ++ p2p_ps_offload->discovery = 1; ++ break; ++ case P2P_PS_SCAN_DONE: ++ RTW_INFO("P2P_PS_SCAN_DONE\n"); ++ p2p_ps_offload->discovery = 0; ++ pwdinfo->p2p_ps_state = P2P_PS_ENABLE; ++ break; ++ default: ++ break; ++ } ++ ++ FillH2CCmd8723D(padapter, H2C_8723D_P2P_PS_OFFLOAD, 1, (u8 *)p2p_ps_offload); ++#endif ++ ++ ++} ++#endif /* CONFIG_P2P */ ++ ++ ++#ifdef CONFIG_TSF_RESET_OFFLOAD ++/* ++ ask FW to Reset sync register at Beacon early interrupt ++*/ ++u8 rtl8723d_reset_tsf(_adapter *padapter, u8 reset_port) ++{ ++ u8 buf[2]; ++ u8 res = _SUCCESS; ++ ++ if (HW_PORT0 == reset_port) { ++ buf[0] = 0x1; ++ buf[1] = 0; ++ ++ } else { ++ buf[0] = 0x0; ++ buf[1] = 0x1; ++ } ++ FillH2CCmd8723D(padapter, H2C_8723D_RESET_TSF, 2, buf); ++ ++ return res; ++} ++#endif /* CONFIG_TSF_RESET_OFFLOAD */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_dm.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_dm.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_dm.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_dm.c 2018-02-11 21:44:27.163146330 +0200 +@@ -0,0 +1,536 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for 92CE/92CU dynamic mechanism only ++ * ++ * ++ * ************************************************************ */ ++#define _RTL8723D_DM_C_ ++ ++/* ************************************************************ ++ * include files ++ * ************************************************************ */ ++#include ++ ++/* ************************************************************ ++ * Global var ++ * ************************************************************ */ ++ ++ ++static VOID ++dm_CheckProtection( ++ IN PADAPTER Adapter ++) ++{ ++#if 0 ++ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); ++ u1Byte CurRate, RateThreshold; ++ ++ if (pMgntInfo->pHTInfo->bCurBW40MHz) ++ RateThreshold = MGN_MCS1; ++ else ++ RateThreshold = MGN_MCS3; ++ ++ if (Adapter->TxStats.CurrentInitTxRate <= RateThreshold) { ++ pMgntInfo->bDmDisableProtect = TRUE; ++ DbgPrint("Forced disable protect: %x\n", Adapter->TxStats.CurrentInitTxRate); ++ } else { ++ pMgntInfo->bDmDisableProtect = FALSE; ++ DbgPrint("Enable protect: %x\n", Adapter->TxStats.CurrentInitTxRate); ++ } ++#endif ++} ++ ++static VOID ++dm_CheckStatistics( ++ IN PADAPTER Adapter ++) ++{ ++#if 0 ++ if (!Adapter->MgntInfo.bMediaConnect) ++ return; ++ ++ /* 2008.12.10 tynli Add for getting Current_Tx_Rate_Reg flexibly. */ ++ rtw_hal_get_hwreg(Adapter, HW_VAR_INIT_TX_RATE, (pu1Byte)(&Adapter->TxStats.CurrentInitTxRate)); ++ ++ /* Calculate current Tx Rate(Successful transmited!!) */ ++ ++ /* Calculate current Rx Rate(Successful received!!) */ ++ ++ /* for tx tx retry count */ ++ rtw_hal_get_hwreg(Adapter, HW_VAR_RETRY_COUNT, (pu1Byte)(&Adapter->TxStats.NumTxRetryCount)); ++#endif ++} ++#ifdef CONFIG_SUPPORT_HW_WPS_PBC ++static void dm_CheckPbcGPIO(_adapter *padapter) ++{ ++ u8 tmp1byte; ++ u8 bPbcPressed = _FALSE; ++ ++ if (!padapter->registrypriv.hw_wps_pbc) ++ return; ++ ++#ifdef CONFIG_USB_HCI ++ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL); ++ tmp1byte |= (HAL_8192C_HW_GPIO_WPS_BIT); ++ rtw_write8(padapter, GPIO_IO_SEL, tmp1byte); /* enable GPIO[2] as output mode */ ++ ++ tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT); ++ rtw_write8(padapter, GPIO_IN, tmp1byte); /* reset the floating voltage level */ ++ ++ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL); ++ tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT); ++ rtw_write8(padapter, GPIO_IO_SEL, tmp1byte); /* enable GPIO[2] as input mode */ ++ ++ tmp1byte = rtw_read8(padapter, GPIO_IN); ++ ++ if (tmp1byte == 0xff) ++ return; ++ ++ if (tmp1byte & HAL_8192C_HW_GPIO_WPS_BIT) ++ bPbcPressed = _TRUE; ++#else ++ tmp1byte = rtw_read8(padapter, GPIO_IN); ++ ++ if (tmp1byte == 0xff || padapter->init_adpt_in_progress) ++ return; ++ ++ if ((tmp1byte & HAL_8192C_HW_GPIO_WPS_BIT) == 0) ++ bPbcPressed = _TRUE; ++#endif ++ ++ if (_TRUE == bPbcPressed) { ++ /* Here we only set bPbcPressed to true */ ++ /* After trigger PBC, the variable will be set to false */ ++ RTW_INFO("CheckPbcGPIO - PBC is pressed\n"); ++ rtw_request_wps_pbc_event(padapter); ++ } ++} ++#endif /* #ifdef CONFIG_SUPPORT_HW_WPS_PBC */ ++ ++ ++#ifdef CONFIG_PCI_HCI ++/* ++ * Description: ++ * Perform interrupt migration dynamically to reduce CPU utilization. ++ * ++ * Assumption: ++ * 1. Do not enable migration under WIFI test. ++ * ++ * Created by Roger, 2010.03.05. ++ * */ ++VOID ++dm_InterruptMigration( ++ IN PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ BOOLEAN bCurrentIntMt, bCurrentACIntDisable; ++ BOOLEAN IntMtToSet = _FALSE; ++ BOOLEAN ACIntToSet = _FALSE; ++ ++ ++ /* Retrieve current interrupt migration and Tx four ACs IMR settings first. */ ++ bCurrentIntMt = pHalData->bInterruptMigration; ++ bCurrentACIntDisable = pHalData->bDisableTxInt; ++ ++ /* */ ++ /* Currently we use busy traffic for reference instead of RxIntOK counts to prevent non-linear Rx statistics */ ++ /* when interrupt migration is set before. 2010.03.05. */ ++ /* */ ++ if (!Adapter->registrypriv.wifi_spec && ++ (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) && ++ pmlmepriv->LinkDetectInfo.bHigherBusyTraffic) { ++ IntMtToSet = _TRUE; ++ ++ /* To check whether we should disable Tx interrupt or not. */ ++ if (pmlmepriv->LinkDetectInfo.bHigherBusyRxTraffic) ++ ACIntToSet = _TRUE; ++ } ++ ++ /* Update current settings. */ ++ if (bCurrentIntMt != IntMtToSet) { ++ RTW_INFO("%s(): Update interrupt migration(%d)\n", __FUNCTION__, IntMtToSet); ++ if (IntMtToSet) { ++ /* */ ++ /* Set interrupt migration timer and corresponging Tx/Rx counter. */ ++ /* timer 25ns*0xfa0=100us for 0xf packets. */ ++ /* 2010.03.05. */ ++ /* */ ++ rtw_write32(Adapter, REG_INT_MIG_8723D, 0xff000fa0);/* 0x306:Rx, 0x307:Tx */ ++ pHalData->bInterruptMigration = IntMtToSet; ++ } else { ++ /* Reset all interrupt migration settings. */ ++ rtw_write32(Adapter, REG_INT_MIG_8723D, 0); ++ pHalData->bInterruptMigration = IntMtToSet; ++ } ++ } ++ ++ /*if( bCurrentACIntDisable != ACIntToSet ){ ++ RTW_INFO("%s(): Update AC interrupt(%d)\n",__FUNCTION__,ACIntToSet); ++ if(ACIntToSet) ++ { ++ ++ ++ ++ ++ ++ UpdateInterruptMask8192CE( Adapter, 0, RT_AC_INT_MASKS ); ++ pHalData->bDisableTxInt = ACIntToSet; ++ } ++ else ++ { ++ UpdateInterruptMask8192CE( Adapter, RT_AC_INT_MASKS, 0 ); ++ pHalData->bDisableTxInt = ACIntToSet; ++ } ++ }*/ ++ ++} ++ ++#endif ++ ++/* ++ * Initialize GPIO setting registers ++ * */ ++static void ++dm_InitGPIOSetting( ++ IN PADAPTER Adapter ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ ++ u8 tmp1byte; ++ ++ tmp1byte = rtw_read8(Adapter, REG_GPIO_MUXCFG); ++ tmp1byte &= (GPIOSEL_GPIO | ~GPIOSEL_ENBT); ++ ++ rtw_write8(Adapter, REG_GPIO_MUXCFG, tmp1byte); ++} ++/* ************************************************************ ++ * functions ++ * ************************************************************ */ ++static void Init_ODM_ComInfo_8723d(PADAPTER Adapter) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ u32 SupportAbility = 0; ++ u8 cut_ver, fab_ver; ++ ++ Init_ODM_ComInfo(Adapter); ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PACKAGE_TYPE, pHalData->PackageType); ++ ++ fab_ver = ODM_TSMC; ++ cut_ver = GET_CVID_CUT_VERSION(pHalData->VersionID); ++ ++ RTW_INFO("%s(): fab_ver=%d cut_ver=%d\n", __func__, fab_ver, cut_ver); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_FAB_VER, fab_ver); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_CUT_VER, cut_ver); ++ ++#ifdef CONFIG_DISABLE_ODM ++ SupportAbility = 0; ++#else ++ SupportAbility = ++#if 1 ++ ODM_RF_CALIBRATION | ++ ODM_RF_TX_PWR_TRACK ++#else ++ 0 ++#endif ++ ; ++ if (pHalData->AntDivCfg) ++ SupportAbility |= ODM_BB_ANT_DIV; ++#endif ++ ++ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, SupportAbility); ++} ++ ++static void Update_ODM_ComInfo_8723d(PADAPTER Adapter) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ u32 SupportAbility = 0; ++ ++ SupportAbility = 0 ++ | ODM_BB_DIG /* For BB */ ++ | ODM_BB_RA_MASK ++ | ODM_BB_FA_CNT ++ | ODM_BB_RSSI_MONITOR ++ | ODM_BB_CCK_PD ++ | ODM_BB_CFO_TRACKING ++ /* | ODM_BB_PWR_TRAIN */ ++ | ODM_BB_NHM_CNT ++ | ODM_RF_TX_PWR_TRACK /* For RF */ ++ | ODM_RF_CALIBRATION ++ | ODM_MAC_EDCA_TURBO /* For MAC */ ++ ; ++ ++ if (rtw_odm_adaptivity_needed(Adapter) == _TRUE) { ++ rtw_odm_adaptivity_config_msg(RTW_DBGDUMP, Adapter); ++ SupportAbility |= ODM_BB_ADAPTIVITY; ++ } ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ if (pHalData->AntDivCfg) ++ SupportAbility |= ODM_BB_ANT_DIV; ++#endif ++ ++#if (MP_DRIVER == 1) ++ if (Adapter->registrypriv.mp_mode == 1) { ++ SupportAbility = 0 ++ | ODM_RF_CALIBRATION ++ | ODM_RF_TX_PWR_TRACK ++ ; ++ } ++#endif/* (MP_DRIVER==1) */ ++ ++#ifdef CONFIG_DISABLE_ODM ++ SupportAbility = 0; ++#endif/* CONFIG_DISABLE_ODM */ ++ ++ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, SupportAbility); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, ++ pHalData->TRxAntDivType); ++} ++ ++void ++rtl8723d_InitHalDm( ++ IN PADAPTER Adapter ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ ++ u8 i; ++ ++#ifdef CONFIG_USB_HCI ++ dm_InitGPIOSetting(Adapter); ++#endif ++ ++ pHalData->DM_Type = DM_Type_ByDriver; ++ ++ Update_ODM_ComInfo_8723d(Adapter); ++ ++ ODM_DMInit(pDM_Odm); ++ ++} ++ ++VOID ++rtl8723d_HalDmWatchDog( ++ IN PADAPTER Adapter ++) ++{ ++ BOOLEAN bFwCurrentInPSMode = _FALSE; ++ BOOLEAN bFwPSAwake = _TRUE; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ ++#ifdef CONFIG_MP_INCLUDED ++ /* #if MP_DRIVER */ ++ if (Adapter->registrypriv.mp_mode == 1 && Adapter->mppriv.mp_dm == 0) /* for MP power tracking */ ++ return; ++ /* #endif */ ++#endif ++ ++ if (!rtw_is_hw_init_completed(Adapter)) ++ goto skip_dm; ++ ++#ifdef CONFIG_LPS ++ bFwCurrentInPSMode = adapter_to_pwrctl(Adapter)->bFwCurrentInPSMode; ++ rtw_hal_get_hwreg(Adapter, HW_VAR_FWLPS_RF_ON, (u8 *)(&bFwPSAwake)); ++#endif ++ ++#ifdef CONFIG_P2P ++ /* Fw is under p2p powersaving mode, driver should stop dynamic mechanism. */ ++ /* modifed by thomas. 2011.06.11. */ ++ if (Adapter->wdinfo.p2p_ps_mode) ++ bFwPSAwake = _FALSE; ++#endif /* CONFIG_P2P */ ++ ++ ++ if ((rtw_is_hw_init_completed(Adapter)) ++ && ((!bFwCurrentInPSMode) && bFwPSAwake)) { ++ /* */ ++ /* Calculate Tx/Rx statistics. */ ++ /* */ ++ dm_CheckStatistics(Adapter); ++ rtw_hal_check_rxfifo_full(Adapter); ++ /* */ ++ /* Dynamically switch RTS/CTS protection. */ ++ /* */ ++ /* dm_CheckProtection(Adapter); */ ++ ++#ifdef CONFIG_PCI_HCI ++ /* 20100630 Joseph: Disable Interrupt Migration mechanism temporarily because it degrades Rx throughput. */ ++ /* Tx Migration settings. */ ++ /* dm_InterruptMigration(Adapter); */ ++ ++ /* if(Adapter->HalFunc.TxCheckStuckHandler(Adapter)) */ ++ /* PlatformScheduleWorkItem(&(GET_HAL_DATA(Adapter)->HalResetWorkItem)); */ ++#endif ++ } ++ ++ /* ODM */ ++ if (rtw_is_hw_init_completed(Adapter)) { ++ u8 bLinked = _FALSE; ++ u8 bsta_state = _FALSE; ++ u8 bBtDisabled = _TRUE; ++ ++ if (rtw_mi_check_status(Adapter, MI_ASSOC)) { ++ bLinked = _TRUE; ++ if (rtw_mi_check_status(Adapter, MI_STA_LINKED)) ++ bsta_state = _TRUE; ++ } ++ ++ ODM_CmnInfoUpdate(&pHalData->odmpriv , ODM_CMNINFO_LINK, bLinked); ++ ODM_CmnInfoUpdate(&pHalData->odmpriv , ODM_CMNINFO_STATION_STATE, bsta_state); ++ ++ /* ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM); */ ++ ++#ifdef CONFIG_BT_COEXIST ++ bBtDisabled = rtw_btcoex_IsBtDisabled(Adapter); ++#endif /* CONFIG_BT_COEXIST */ ++ ODM_CmnInfoUpdate(&pHalData->odmpriv, ODM_CMNINFO_BT_ENABLED, ((bBtDisabled == _TRUE) ? _FALSE : _TRUE)); ++ ++ ODM_DMWatchdog(&pHalData->odmpriv); ++ } ++ ++skip_dm: ++ ++ /* Check GPIO to determine current RF on/off and Pbc status. */ ++ /* Check Hardware Radio ON/OFF or not */ ++ /* if(Adapter->MgntInfo.PowerSaveControl.bGpioRfSw) */ ++ /* { */ ++ /* RTPRINT(FPWR, PWRHW, ("dm_CheckRfCtrlGPIO\n")); */ ++ /* dm_CheckRfCtrlGPIO(Adapter); */ ++ /* } */ ++#ifdef CONFIG_SUPPORT_HW_WPS_PBC ++ dm_CheckPbcGPIO(Adapter); ++#endif ++ return; ++} ++ ++void rtl8723d_hal_dm_in_lps(PADAPTER padapter) ++{ ++ u32 PWDB_rssi = 0; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta = NULL; ++ ++ RTW_INFO("%s, RSSI_Min=%d\n", __func__, pDM_Odm->RSSI_Min); ++ ++ /* update IGI */ ++ ODM_Write_DIG(pDM_Odm, pDM_Odm->RSSI_Min); ++ ++ ++ /* set rssi to fw */ ++ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); ++ if (psta && (psta->rssi_stat.UndecoratedSmoothedPWDB > 0)) { ++ PWDB_rssi = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB << 16)); ++ ++ rtl8723d_set_rssi_cmd(padapter, (u8 *)&PWDB_rssi); ++ } ++ ++} ++ ++void rtl8723d_HalDmWatchDog_in_LPS(IN PADAPTER Adapter) ++{ ++ u8 bLinked = _FALSE; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ struct sta_priv *pstapriv = &Adapter->stapriv; ++ struct sta_info *psta = NULL; ++ ++ if (!rtw_is_hw_init_completed(Adapter)) ++ goto skip_lps_dm; ++ ++ if (rtw_mi_check_status(Adapter, MI_ASSOC)) ++ bLinked = _TRUE; ++ ++ ODM_CmnInfoUpdate(&pHalData->odmpriv , ODM_CMNINFO_LINK, bLinked); ++ ++ if (bLinked == _FALSE) ++ goto skip_lps_dm; ++ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)) ++ goto skip_lps_dm; ++ ++ ++ /* ODM_DMWatchdog(&pHalData->odmpriv); */ ++ /* Do DIG by RSSI In LPS-32K */ ++ ++ /* .1 Find MIN-RSSI */ ++ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); ++ if (psta == NULL) ++ goto skip_lps_dm; ++ ++ pHalData->EntryMinUndecoratedSmoothedPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB; ++ ++ RTW_INFO("CurIGValue=%d, EntryMinUndecoratedSmoothedPWDB = %d\n", pDM_DigTable->CurIGValue, pHalData->EntryMinUndecoratedSmoothedPWDB); ++ ++ if (pHalData->EntryMinUndecoratedSmoothedPWDB <= 0) ++ goto skip_lps_dm; ++ ++ pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; ++ ++ pDM_Odm->RSSI_Min = pHalData->MinUndecoratedPWDBForDM; ++ ++ /* if(pDM_DigTable->CurIGValue != pDM_Odm->RSSI_Min) */ ++ if ((pDM_DigTable->CurIGValue > pDM_Odm->RSSI_Min + 5) || ++ (pDM_DigTable->CurIGValue < pDM_Odm->RSSI_Min - 5)) ++ ++ { ++#ifdef CONFIG_LPS ++ rtw_dm_in_lps_wk_cmd(Adapter); ++#endif /* CONFIG_LPS */ ++ } ++ ++ ++skip_lps_dm: ++ ++ return; ++ ++} ++ ++void rtl8723d_init_dm_priv(IN PADAPTER Adapter) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T podmpriv = &pHalData->odmpriv; ++ ++ Init_ODM_ComInfo_8723d(Adapter); ++ ODM_InitAllTimers(podmpriv); ++ ++} ++ ++void rtl8723d_deinit_dm_priv(IN PADAPTER Adapter) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T podmpriv = &pHalData->odmpriv; ++ ++ ODM_CancelAllTimers(podmpriv); ++ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_hal_init.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_hal_init.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_hal_init.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_hal_init.c 2018-02-11 21:44:27.164146345 +0200 +@@ -0,0 +1,6195 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _HAL_INIT_C_ ++ ++#include ++#include ++#include "hal_com_h2c.h" ++#include "hal8723d_fw.h" ++ ++#ifndef CONFIG_DLFW_TXPKT ++#define DL_FW_MAX 15 ++#else ++#define FW_DOWNLOAD_SIZE_8723D 8192 ++#endif ++ ++static VOID ++_FWDownloadEnable( ++ IN PADAPTER padapter, ++ IN BOOLEAN enable ++) ++{ ++ u8 tmp, count = 0; ++ ++ if (enable) { ++ /* 8051 enable */ ++ tmp = rtw_read8(padapter, REG_SYS_FUNC_EN + 1); ++ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, tmp | 0x04); ++ ++ tmp = rtw_read8(padapter, REG_MCUFWDL); ++ rtw_write8(padapter, REG_MCUFWDL, tmp | 0x01); ++ ++ do { ++ tmp = rtw_read8(padapter, REG_MCUFWDL); ++ if (tmp & 0x01) ++ break; ++ rtw_write8(padapter, REG_MCUFWDL, tmp | 0x01); ++ rtw_msleep_os(1); ++ } while (count++ < 100); ++ if (count > 0) ++ RTW_INFO("%s: !!!!!!!!Write 0x80 Fail!: count = %d\n", __func__, count); ++ ++ /* 8051 reset */ ++ tmp = rtw_read8(padapter, REG_MCUFWDL + 2); ++ rtw_write8(padapter, REG_MCUFWDL + 2, tmp & 0xf7); ++ } else { ++ /* MCU firmware download disable. */ ++ tmp = rtw_read8(padapter, REG_MCUFWDL); ++ rtw_write8(padapter, REG_MCUFWDL, tmp & 0xfe); ++ } ++} ++ ++static int ++_BlockWrite( ++ IN PADAPTER padapter, ++ IN PVOID buffer, ++ IN u32 buffSize ++) ++{ ++ int ret = _SUCCESS; ++ ++ u32 blockSize_p1 = 4; /* (Default) Phase #1 : PCI muse use 4-byte write to download FW */ ++ u32 blockSize_p2 = 8; /* Phase #2 : Use 8-byte, if Phase#1 use big size to write FW. */ ++ u32 blockSize_p3 = 1; /* Phase #3 : Use 1-byte, the remnant of FW image. */ ++ u32 blockCount_p1 = 0, blockCount_p2 = 0, blockCount_p3 = 0; ++ u32 remainSize_p1 = 0, remainSize_p2 = 0; ++ u8 *bufferPtr = (u8 *)buffer; ++ u32 i = 0, offset = 0; ++#ifdef CONFIG_PCI_HCI ++ u8 remainFW[4] = {0, 0, 0, 0}; ++ u8 *p = NULL; ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ blockSize_p1 = 254; ++#endif ++ ++ /* printk("====>%s %d\n", __func__, __LINE__); */ ++ ++ /* 3 Phase #1 */ ++ blockCount_p1 = buffSize / blockSize_p1; ++ remainSize_p1 = buffSize % blockSize_p1; ++ ++ ++ ++ for (i = 0; i < blockCount_p1; i++) { ++#ifdef CONFIG_USB_HCI ++ ret = rtw_writeN(padapter, (FW_8723D_START_ADDRESS + i * blockSize_p1), blockSize_p1, (bufferPtr + i * blockSize_p1)); ++#else ++ ret = rtw_write32(padapter, (FW_8723D_START_ADDRESS + i * blockSize_p1), le32_to_cpu(*((u32 *)(bufferPtr + i * blockSize_p1)))); ++#endif ++ if (ret == _FAIL) { ++ printk(KERN_ERR "====>%s %d i:%d\n", __func__, __LINE__, i); ++ goto exit; ++ } ++ } ++ ++#ifdef CONFIG_PCI_HCI ++ p = (u8 *)((u32 *)(bufferPtr + blockCount_p1 * blockSize_p1)); ++ if (remainSize_p1) { ++ switch (remainSize_p1) { ++ case 0: ++ break; ++ case 3: ++ remainFW[2] = *(p + 2); ++ case 2: ++ remainFW[1] = *(p + 1); ++ case 1: ++ remainFW[0] = *(p); ++ ret = rtw_write32(padapter, (FW_8723D_START_ADDRESS + blockCount_p1 * blockSize_p1), ++ le32_to_cpu(*(u32 *)remainFW)); ++ } ++ return ret; ++ } ++#endif ++ ++ /* 3 Phase #2 */ ++ if (remainSize_p1) { ++ offset = blockCount_p1 * blockSize_p1; ++ ++ blockCount_p2 = remainSize_p1 / blockSize_p2; ++ remainSize_p2 = remainSize_p1 % blockSize_p2; ++ ++ ++ ++#ifdef CONFIG_USB_HCI ++ for (i = 0; i < blockCount_p2; i++) { ++ ret = rtw_writeN(padapter, (FW_8723D_START_ADDRESS + offset + i * blockSize_p2), blockSize_p2, (bufferPtr + offset + i * blockSize_p2)); ++ ++ if (ret == _FAIL) ++ goto exit; ++ } ++#endif ++ } ++ ++ /* 3 Phase #3 */ ++ if (remainSize_p2) { ++ offset = (blockCount_p1 * blockSize_p1) + (blockCount_p2 * blockSize_p2); ++ ++ blockCount_p3 = remainSize_p2 / blockSize_p3; ++ ++ ++ for (i = 0 ; i < blockCount_p3 ; i++) { ++ ret = rtw_write8(padapter, (FW_8723D_START_ADDRESS + offset + i), *(bufferPtr + offset + i)); ++ ++ if (ret == _FAIL) { ++ printk(KERN_ERR "====>%s %d i:%d\n", __func__, __LINE__, i); ++ goto exit; ++ } ++ } ++ } ++exit: ++ return ret; ++} ++ ++static int ++_PageWrite( ++ IN PADAPTER padapter, ++ IN u32 page, ++ IN PVOID buffer, ++ IN u32 size ++) ++{ ++ u8 value8; ++ u8 u8Page = (u8)(page & 0x07); ++ ++ value8 = (rtw_read8(padapter, REG_MCUFWDL + 2) & 0xF8) | u8Page; ++ rtw_write8(padapter, REG_MCUFWDL + 2, value8); ++ ++ return _BlockWrite(padapter, buffer, size); ++} ++ ++static VOID ++_FillDummy( ++ u8 *pFwBuf, ++ u32 *pFwLen ++) ++{ ++ u32 FwLen = *pFwLen; ++ u8 remain = (u8)(FwLen % 4); ++ ++ remain = (remain == 0) ? 0 : (4 - remain); ++ ++ while (remain > 0) { ++ pFwBuf[FwLen] = 0; ++ FwLen++; ++ remain--; ++ } ++ ++ *pFwLen = FwLen; ++} ++ ++static int ++_WriteFW( ++ IN PADAPTER padapter, ++ IN PVOID buffer, ++ IN u32 size ++) ++{ ++ /* Since we need dynamic decide method of dwonload fw, so we call this function to get chip version. */ ++ int ret = _SUCCESS; ++ u32 pageNums, remainSize; ++ u32 page, offset; ++ u8 *bufferPtr = (u8 *)buffer; ++ ++#ifdef CONFIG_PCI_HCI ++ /* 20100120 Joseph: Add for 88CE normal chip. */ ++ /* Fill in zero to make firmware image to dword alignment. */ ++ _FillDummy(bufferPtr, &size); ++#endif ++ ++ pageNums = size / MAX_DLFW_PAGE_SIZE; ++ /* RT_ASSERT((pageNums <= 4), ("Page numbers should not greater then 4\n")); */ ++ remainSize = size % MAX_DLFW_PAGE_SIZE; ++ ++ for (page = 0; page < pageNums; page++) { ++ offset = page * MAX_DLFW_PAGE_SIZE; ++ ret = _PageWrite(padapter, page, bufferPtr + offset, MAX_DLFW_PAGE_SIZE); ++ ++ if (ret == _FAIL) { ++ printk(KERN_ERR "====>%s %d\n", __func__, __LINE__); ++ goto exit; ++ } ++ } ++ if (remainSize) { ++ offset = pageNums * MAX_DLFW_PAGE_SIZE; ++ page = pageNums; ++ ret = _PageWrite(padapter, page, bufferPtr + offset, remainSize); ++ ++ if (ret == _FAIL) { ++ printk(KERN_ERR "====>%s %d\n", __func__, __LINE__); ++ goto exit; ++ } ++ } ++ ++exit: ++ return ret; ++} ++ ++void _8051Reset8723(PADAPTER padapter) ++{ ++ u8 cpu_rst; ++ u8 io_rst; ++ ++#if 0 ++ io_rst = rtw_read8(padapter, REG_RSV_CTRL); ++ rtw_write8(padapter, REG_RSV_CTRL, io_rst & (~BIT(1))); ++#endif ++ ++ /* Reset 8051(WLMCU) IO wrapper */ ++ /* 0x1c[8] = 0 */ ++ /* Suggested by Isaac@SD1 and Gimmy@SD1, coding by Lucas@20130624 */ ++ io_rst = rtw_read8(padapter, REG_RSV_CTRL + 1); ++ io_rst &= ~BIT(0); ++ rtw_write8(padapter, REG_RSV_CTRL + 1, io_rst); ++ ++ cpu_rst = rtw_read8(padapter, REG_SYS_FUNC_EN + 1); ++ cpu_rst &= ~BIT(2); ++ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, cpu_rst); ++ ++#if 0 ++ io_rst = rtw_read8(padapter, REG_RSV_CTRL); ++ rtw_write8(padapter, REG_RSV_CTRL, io_rst & (~BIT(1))); ++#endif ++ ++ /* Enable 8051 IO wrapper */ ++ /* 0x1c[8] = 1 */ ++ io_rst = rtw_read8(padapter, REG_RSV_CTRL + 1); ++ io_rst |= BIT(0); ++ rtw_write8(padapter, REG_RSV_CTRL + 1, io_rst); ++ ++ cpu_rst = rtw_read8(padapter, REG_SYS_FUNC_EN + 1); ++ cpu_rst |= BIT(2); ++ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, cpu_rst); ++ ++ RTW_INFO("%s: Finish\n", __FUNCTION__); ++} ++ ++static s32 polling_fwdl_chksum(_adapter *adapter, u32 min_cnt, u32 timeout_ms) ++{ ++ s32 ret = _FAIL; ++ u32 value32; ++ u32 start = rtw_get_current_time(); ++ u32 cnt = 0; ++ ++ /* polling CheckSum report */ ++ do { ++ cnt++; ++ value32 = rtw_read32(adapter, REG_MCUFWDL); ++ if (value32 & FWDL_ChkSum_rpt || RTW_CANNOT_IO(adapter)) ++ break; ++ rtw_mdelay_os(5); ++ } while (rtw_get_passing_time_ms(start) < timeout_ms || cnt < min_cnt); ++ ++ if (!(value32 & FWDL_ChkSum_rpt)) ++ goto exit; ++ ++ if (rtw_fwdl_test_trigger_chksum_fail()) ++ goto exit; ++ ++ ret = _SUCCESS; ++ ++exit: ++ RTW_INFO("%s: Checksum report %s! (%u, %dms), REG_MCUFWDL:0x%08x\n", __FUNCTION__ ++ , (ret == _SUCCESS) ? "OK" : "Fail", cnt, rtw_get_passing_time_ms(start), value32); ++ ++ return ret; ++} ++ ++static s32 _FWFreeToGo(_adapter *adapter, u32 min_cnt, u32 timeout_ms) ++{ ++ s32 ret = _FAIL; ++ u32 value32; ++ u32 start = rtw_get_current_time(); ++ u32 cnt = 0; ++ u32 value_to_check = 0; ++ u32 value_expected = (MCUFWDL_RDY | FWDL_ChkSum_rpt | WINTINI_RDY | RAM_DL_SEL); ++ ++ value32 = rtw_read32(adapter, REG_MCUFWDL); ++ value32 |= MCUFWDL_RDY; ++ value32 &= ~WINTINI_RDY; ++ rtw_write32(adapter, REG_MCUFWDL, value32); ++ ++ _8051Reset8723(adapter); ++ ++ /* polling for FW ready */ ++ do { ++ cnt++; ++ value32 = rtw_read32(adapter, REG_MCUFWDL); ++ value_to_check = value32 & value_expected; ++ if ((value_to_check == value_expected) || RTW_CANNOT_IO(adapter)) ++ break; ++ rtw_yield_os(); ++ } while (rtw_get_passing_time_ms(start) < timeout_ms || cnt < min_cnt); ++ ++ if (value_to_check != value_expected) ++ goto exit; ++ ++ if (rtw_fwdl_test_trigger_wintint_rdy_fail()) ++ goto exit; ++ ++ ret = _SUCCESS; ++ ++exit: ++ RTW_INFO("%s: Polling FW ready %s! (%u, %dms), REG_MCUFWDL:0x%08x\n", __FUNCTION__ ++ , (ret == _SUCCESS) ? "OK" : "Fail", cnt, rtw_get_passing_time_ms(start), value32); ++ ++ return ret; ++} ++ ++#define IS_FW_81xxC(padapter) (((GET_HAL_DATA(padapter))->FirmwareSignature & 0xFFF0) == 0x88C0) ++ ++void rtl8723d_FirmwareSelfReset(PADAPTER padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 u1bTmp; ++ u8 Delay = 100; ++ ++ if (!(IS_FW_81xxC(padapter) && ++ ((pHalData->FirmwareVersion < 0x21) || ++ (pHalData->FirmwareVersion == 0x21 && ++ pHalData->FirmwareSubVersion < 0x01)))) { /* after 88C Fw v33.1 */ ++ /* 0x1cf=0x20. Inform 8051 to reset. 2009.12.25. tynli_test */ ++ rtw_write8(padapter, REG_HMETFR + 3, 0x20); ++ ++ u1bTmp = rtw_read8(padapter, REG_SYS_FUNC_EN + 1); ++ while (u1bTmp & BIT(2)) { ++ Delay--; ++ if (Delay == 0) ++ break; ++ rtw_udelay_os(50); ++ u1bTmp = rtw_read8(padapter, REG_SYS_FUNC_EN + 1); ++ } ++ ++ if (Delay == 0) { ++ /* force firmware reset */ ++ u1bTmp = rtw_read8(padapter, REG_SYS_FUNC_EN + 1); ++ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, u1bTmp & (~BIT(2))); ++ } ++ } ++} ++ ++#ifdef CONFIG_FILE_FWIMG ++ u8 FwBuffer[FW_8723D_SIZE]; ++#endif /* CONFIG_FILE_FWIMG */ ++ ++#ifdef CONFIG_MP_INCLUDED ++int _WriteBTFWtoTxPktBuf8723D( ++ IN PADAPTER Adapter, ++ IN PVOID buffer, ++ IN u4Byte FwBufLen, ++ IN u1Byte times ++) ++{ ++ int rtStatus = _SUCCESS; ++ /* u4Byte value32; */ ++ /* u1Byte numHQ, numLQ, numPubQ;//, txpktbuf_bndy; */ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ /* PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); */ ++ u1Byte BcnValidReg; ++ u1Byte count = 0, DLBcnCount = 0; ++ pu1Byte FwbufferPtr = (pu1Byte)buffer; ++ /* PRT_TCB pTcb, ptempTcb; */ ++ /* PRT_TX_LOCAL_BUFFER pBuf; */ ++ BOOLEAN bRecover = _FALSE; ++ pu1Byte ReservedPagePacket = NULL; ++ pu1Byte pGenBufReservedPagePacket = NULL; ++ u4Byte TotalPktLen, txpktbuf_bndy; ++ /* u1Byte tmpReg422; */ ++ /* u1Byte u1bTmp; */ ++ u8 *pframe; ++ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ u8 txdesc_offset = TXDESC_OFFSET; ++ u8 val8; ++#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++ u8 u1bTmp; ++#endif ++ ++#if 1/* (DEV_BUS_TYPE == RT_PCI_INTERFACE) */ ++ TotalPktLen = FwBufLen; ++#else ++ TotalPktLen = FwBufLen + pHalData->HWDescHeadLength; ++#endif ++ ++ if ((TotalPktLen + TXDESC_OFFSET) > MAX_CMDBUF_SZ) { ++ RTW_INFO(" WARNING %s => Total packet len = %d > MAX_CMDBUF_SZ:%d\n" ++ , __FUNCTION__, (TotalPktLen + TXDESC_OFFSET), MAX_CMDBUF_SZ); ++ return _FAIL; ++ } ++ ++ pGenBufReservedPagePacket = rtw_zmalloc(TotalPktLen);/* GetGenTempBuffer (Adapter, TotalPktLen); */ ++ if (!pGenBufReservedPagePacket) ++ return _FAIL; ++ ++ ReservedPagePacket = (u1Byte *)pGenBufReservedPagePacket; ++ ++ _rtw_memset(ReservedPagePacket, 0, TotalPktLen); ++ ++#if 1/* (DEV_BUS_TYPE == RT_PCI_INTERFACE) */ ++ _rtw_memcpy(ReservedPagePacket, FwbufferPtr, FwBufLen); ++ ++#else ++ PlatformMoveMemory(ReservedPagePacket + Adapter->HWDescHeadLength , FwbufferPtr, FwBufLen); ++#endif ++ ++ /* --------------------------------------------------------- */ ++ /* 1. Pause BCN */ ++ /* --------------------------------------------------------- */ ++ /* Set REG_CR bit 8. DMA beacon by SW. */ ++#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR + 1); ++ PlatformEFIOWrite1Byte(Adapter, REG_CR + 1, (u1bTmp | BIT(0))); ++#else ++ /* Remove for temparaily because of the code on v2002 is not sync to MERGE_TMEP for USB/SDIO. */ ++ /* De not remove this part on MERGE_TEMP. by tynli. */ ++ /* pHalData->RegCR_1 |= (BIT0); */ ++ /* PlatformEFIOWrite1Byte(Adapter, REG_CR+1, pHalData->RegCR_1); */ ++#endif ++ ++ /* Disable Hw protection for a time which revserd for Hw sending beacon. */ ++ /* Fix download reserved page packet fail that access collision with the protection time. */ ++ /* 2010.05.11. Added by tynli. */ ++ val8 = rtw_read8(Adapter, REG_BCN_CTRL); ++ val8 &= ~EN_BCN_FUNCTION; ++ val8 |= DIS_TSF_UDT; ++ rtw_write8(Adapter, REG_BCN_CTRL, val8); ++ ++#if 0/* (DEV_BUS_TYPE == RT_PCI_INTERFACE) */ ++ tmpReg422 = PlatformEFIORead1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2); ++ if (tmpReg422 & BIT(6)) ++ bRecover = TRUE; ++ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, tmpReg422 & (~BIT(6))); ++#else ++ /* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. */ ++ if (pHalData->RegFwHwTxQCtrl & BIT(6)) ++ bRecover = _TRUE; ++ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, (pHalData->RegFwHwTxQCtrl & (~BIT(6)))); ++ pHalData->RegFwHwTxQCtrl &= (~BIT(6)); ++#endif ++ ++ /* --------------------------------------------------------- */ ++ /* 2. Adjust LLT table to an even boundary. */ ++ /* --------------------------------------------------------- */ ++#if 0/* (DEV_BUS_TYPE == RT_SDIO_INTERFACE) */ ++ txpktbuf_bndy = 10; /* rsvd page start address should be an even value. */ ++ rtStatus = InitLLTTable8723DS(Adapter, txpktbuf_bndy); ++ if (RT_STATUS_SUCCESS != rtStatus) { ++ RTW_INFO("_CheckWLANFwPatchBTFwReady_8723D(): Failed to init LLT!\n"); ++ return RT_STATUS_FAILURE; ++ } ++ ++ /* Init Tx boundary. */ ++ PlatformEFIOWrite1Byte(Adapter, REG_DWBCN0_CTRL_8723D + 1, (u1Byte)txpktbuf_bndy); ++#endif ++ ++ ++ /* --------------------------------------------------------- */ ++ /* 3. Write Fw to Tx packet buffer by reseverd page. */ ++ /* --------------------------------------------------------- */ ++ do { ++ /* download rsvd page. */ ++ /* Clear beacon valid check bit. */ ++ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_TDECTRL + 2); ++ PlatformEFIOWrite1Byte(Adapter, REG_TDECTRL + 2, BcnValidReg & (~BIT(0))); ++ ++ /* BT patch is big, we should set 0x209 < 0x40 suggested from Gimmy */ ++ ++ PlatformEFIOWrite1Byte(Adapter, REG_TDECTRL + 1, (0x90 - 0x20 * (times - 1))); ++ RTW_INFO("0x209:0x%x\n", PlatformEFIORead1Byte(Adapter, REG_TDECTRL + 1)); ++ ++#if 0 ++ /* Acquice TX spin lock before GetFwBuf and send the packet to prevent system deadlock. */ ++ /* Advertised by Roger. Added by tynli. 2010.02.22. */ ++ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); ++ if (MgntGetFWBuffer(Adapter, &pTcb, &pBuf)) { ++ PlatformMoveMemory(pBuf->Buffer.VirtualAddress, ReservedPagePacket, TotalPktLen); ++ CmdSendPacket(Adapter, pTcb, pBuf, TotalPktLen, DESC_PACKET_TYPE_NORMAL, FALSE); ++ } else ++ dbgdump("SetFwRsvdPagePkt(): MgntGetFWBuffer FAIL!!!!!!!!.\n"); ++ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); ++#else ++ /*--------------------------------------------------------- ++ tx reserved_page_packet ++ ----------------------------------------------------------*/ ++ pmgntframe = rtw_alloc_cmdxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) { ++ rtStatus = _FAIL; ++ goto exit; ++ } ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(Adapter, pattrib); ++ ++ pattrib->qsel = QSLT_BEACON; ++ pattrib->pktlen = pattrib->last_txcmdsz = FwBufLen; ++ ++ /* _rtw_memset(pmgntframe->buf_addr, 0, TotalPktLen+txdesc_size); */ ++ /* pmgntframe->buf_addr = ReservedPagePacket ; */ ++ ++ _rtw_memcpy((u8 *)(pmgntframe->buf_addr + txdesc_offset), ReservedPagePacket, FwBufLen); ++ RTW_INFO("[%d]===>TotalPktLen + TXDESC_OFFSET TotalPacketLen:%d\n", DLBcnCount, (FwBufLen + txdesc_offset)); ++ ++#ifdef CONFIG_PCI_HCI ++ dump_mgntframe(Adapter, pmgntframe); ++#else ++ dump_mgntframe_and_wait(Adapter, pmgntframe, 100); ++#endif ++ ++#endif ++#if 1 ++ /* check rsvd page download OK. */ ++ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_TDECTRL + 2); ++ while (!(BcnValidReg & BIT(0)) && count < 200) { ++ count++; ++ /* PlatformSleepUs(10); */ ++ rtw_msleep_os(1); ++ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_TDECTRL + 2); ++ } ++ DLBcnCount++; ++ /* RTW_INFO("##0x208:%08x,0x210=%08x\n",PlatformEFIORead4Byte(Adapter, REG_TDECTRL),PlatformEFIORead4Byte(Adapter, 0x210)); */ ++ ++ PlatformEFIOWrite1Byte(Adapter, REG_TDECTRL + 2, BcnValidReg); ++ ++ } while ((!(BcnValidReg & BIT(0))) && DLBcnCount < 5); ++ ++ ++#endif ++ if (DLBcnCount >= 5) { ++ RTW_INFO(" check rsvd page download OK DLBcnCount =%d\n", DLBcnCount); ++ rtStatus = _FAIL; ++ goto exit; ++ } ++ ++ if (!(BcnValidReg & BIT(0))) { ++ RTW_INFO("_WriteFWtoTxPktBuf(): 1 Download RSVD page failed!\n"); ++ rtStatus = _FAIL; ++ goto exit; ++ } ++ ++ /* --------------------------------------------------------- */ ++ /* 4. Set Tx boundary to the initial value */ ++ /* --------------------------------------------------------- */ ++ ++ ++ /* --------------------------------------------------------- */ ++ /* 5. Reset beacon setting to the initial value. */ ++ /* After _CheckWLANFwPatchBTFwReady(). */ ++ /* --------------------------------------------------------- */ ++ ++exit: ++ ++ if (pGenBufReservedPagePacket) { ++ RTW_INFO("_WriteBTFWtoTxPktBuf8723D => rtw_mfree pGenBufReservedPagePacket!\n"); ++ rtw_mfree((u8 *)pGenBufReservedPagePacket, TotalPktLen); ++ } ++ return rtStatus; ++} ++ ++ ++ ++/* ++ * Description: Determine the contents of H2C BT_FW_PATCH Command sent to FW. ++ * 2011.10.20 by tynli ++ * */ ++void ++SetFwBTFwPatchCmd( ++ IN PADAPTER Adapter, ++ IN u16 FwSize ++) ++{ ++ u8 u1BTFwPatchParm[H2C_BT_FW_PATCH_LEN] = {0}; ++ u8 addr0 = 0; ++ u8 addr1 = 0xa0; ++ u8 addr2 = 0x10; ++ u8 addr3 = 0x80; ++ ++ ++ SET_8723D_H2CCMD_BT_FW_PATCH_SIZE(u1BTFwPatchParm, FwSize); ++ SET_8723D_H2CCMD_BT_FW_PATCH_ADDR0(u1BTFwPatchParm, addr0); ++ SET_8723D_H2CCMD_BT_FW_PATCH_ADDR1(u1BTFwPatchParm, addr1); ++ SET_8723D_H2CCMD_BT_FW_PATCH_ADDR2(u1BTFwPatchParm, addr2); ++ SET_8723D_H2CCMD_BT_FW_PATCH_ADDR3(u1BTFwPatchParm, addr3); ++ ++ FillH2CCmd8723D(Adapter, H2C_8723D_BT_FW_PATCH, H2C_BT_FW_PATCH_LEN, u1BTFwPatchParm); ++ ++} ++ ++void ++SetFwBTPwrCmd( ++ IN PADAPTER Adapter, ++ IN u1Byte PwrIdx ++) ++{ ++ u1Byte u1BTPwrIdxParm[H2C_FORCE_BT_TXPWR_LEN] = {0}; ++ ++ SET_8723D_H2CCMD_BT_PWR_IDX(u1BTPwrIdxParm, PwrIdx); ++ ++ ++ FillH2CCmd8723D(Adapter, H2C_8723D_FORCE_BT_TXPWR, H2C_FORCE_BT_TXPWR_LEN, u1BTPwrIdxParm); ++} ++ ++/* ++ * Description: WLAN Fw will write BT Fw to BT XRAM and signal driver. ++ * ++ * 2011.10.20. by tynli. ++ * */ ++int ++_CheckWLANFwPatchBTFwReady( ++ IN PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u4Byte count = 0; ++ u1Byte u1bTmp; ++ int ret = _FAIL; ++ ++ /* --------------------------------------------------------- */ ++ /* Check if BT FW patch procedure is ready. */ ++ /* --------------------------------------------------------- */ ++ do { ++ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_HMEBOX_DBG_0_8723D); ++ if ((u1bTmp & BIT(6)) || (u1bTmp & BIT(7))) { ++ ret = _SUCCESS; ++ break; ++ } ++ ++ count++; ++ rtw_msleep_os(50); /* 50ms */ ++ } while (!((u1bTmp & BIT(6)) || (u1bTmp & BIT(7))) && count < 50); ++ ++ ++ ++ ++ /* --------------------------------------------------------- */ ++ /* Reset beacon setting to the initial value. */ ++ /* --------------------------------------------------------- */ ++#if 0/* (DEV_BUS_TYPE == RT_PCI_INTERFACE) */ ++ if (LLT_table_init(Adapter, FALSE, 0) == RT_STATUS_FAILURE) { ++ dbgdump("Init self define for BT Fw patch LLT table fail.\n"); ++ /* return RT_STATUS_FAILURE; */ ++ } ++#endif ++ u1bTmp = rtw_read8(Adapter, REG_BCN_CTRL); ++ u1bTmp |= EN_BCN_FUNCTION; ++ u1bTmp &= ~DIS_TSF_UDT; ++ rtw_write8(Adapter, REG_BCN_CTRL, u1bTmp); ++ ++ /* To make sure that if there exists an adapter which would like to send beacon. */ ++ /* If exists, the origianl value of 0x422[6] will be 1, we should check this to */ ++ /* prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ ++ /* the beacon cannot be sent by HW. */ ++ /* 2010.06.23. Added by tynli. */ ++#if 0/* (DEV_BUS_TYPE == RT_PCI_INTERFACE) */ ++ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2); ++ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, (u1bTmp | BIT(6))); ++#else ++ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, (pHalData->RegFwHwTxQCtrl | BIT(6))); ++ pHalData->RegFwHwTxQCtrl |= BIT(6); ++#endif ++ ++ /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ ++ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR + 1); ++ PlatformEFIOWrite1Byte(Adapter, REG_CR + 1, (u1bTmp & (~BIT(0)))); ++ ++ return ret; ++} ++ ++int ReservedPage_Compare(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware, u32 BTPatchSize) ++{ ++ u8 temp, ret, lastBTsz; ++ u32 u1bTmp = 0, address_start = 0, count = 0, i = 0; ++ u8 *myBTFwBuffer = NULL; ++ ++ myBTFwBuffer = rtw_zmalloc(BTPatchSize); ++ if (myBTFwBuffer == NULL) { ++ RTW_INFO("%s can't be executed due to the failed malloc.\n", __FUNCTION__); ++ Adapter->mppriv.bTxBufCkFail = _TRUE; ++ return _FALSE; ++ } ++ ++ temp = rtw_read8(Adapter, 0x209); ++ ++ address_start = (temp * 128) / 8; ++ ++ rtw_write32(Adapter, 0x140, 0x00000000); ++ rtw_write32(Adapter, 0x144, 0x00000000); ++ rtw_write32(Adapter, 0x148, 0x00000000); ++ ++ rtw_write8(Adapter, 0x106, 0x69); ++ ++ for (i = 0; i < (BTPatchSize / 8); i++) { ++ rtw_write32(Adapter, 0x140, address_start + 5 + i); ++ ++ /* polling until reg 0x140[23]=1; */ ++ do { ++ u1bTmp = rtw_read32(Adapter, 0x140); ++ if (u1bTmp & BIT(23)) { ++ ret = _SUCCESS; ++ break; ++ } ++ count++; ++ RTW_INFO("0x140=%x, wait for 10 ms (%d) times.\n", u1bTmp, count); ++ rtw_msleep_os(10); /* 10ms */ ++ } while (!(u1bTmp & BIT(23)) && count < 50); ++ ++ myBTFwBuffer[i * 8 + 0] = rtw_read8(Adapter, 0x144); ++ myBTFwBuffer[i * 8 + 1] = rtw_read8(Adapter, 0x145); ++ myBTFwBuffer[i * 8 + 2] = rtw_read8(Adapter, 0x146); ++ myBTFwBuffer[i * 8 + 3] = rtw_read8(Adapter, 0x147); ++ myBTFwBuffer[i * 8 + 4] = rtw_read8(Adapter, 0x148); ++ myBTFwBuffer[i * 8 + 5] = rtw_read8(Adapter, 0x149); ++ myBTFwBuffer[i * 8 + 6] = rtw_read8(Adapter, 0x14a); ++ myBTFwBuffer[i * 8 + 7] = rtw_read8(Adapter, 0x14b); ++ } ++ ++ rtw_write32(Adapter, 0x140, address_start + 5 + BTPatchSize / 8); ++ ++ lastBTsz = BTPatchSize % 8; ++ ++ /* polling until reg 0x140[23]=1; */ ++ u1bTmp = 0; ++ count = 0; ++ do { ++ u1bTmp = rtw_read32(Adapter, 0x140); ++ if (u1bTmp & BIT(23)) { ++ ret = _SUCCESS; ++ break; ++ } ++ count++; ++ RTW_INFO("0x140=%x, wait for 10 ms (%d) times.\n", u1bTmp, count); ++ rtw_msleep_os(10); /* 10ms */ ++ } while (!(u1bTmp & BIT(23)) && count < 50); ++ ++ for (i = 0; i < lastBTsz; i++) ++ myBTFwBuffer[(BTPatchSize / 8) * 8 + i] = rtw_read8(Adapter, (0x144 + i)); ++ ++ ++ for (i = 0; i < BTPatchSize; i++) { ++ if (myBTFwBuffer[i] != pFirmware->szFwBuffer[i]) { ++ RTW_INFO(" In direct myBTFwBuffer[%d]=%x , pFirmware->szFwBuffer=%x\n", i, myBTFwBuffer[i], pFirmware->szFwBuffer[i]); ++ Adapter->mppriv.bTxBufCkFail = _TRUE; ++ break; ++ } ++ } ++ ++ if (myBTFwBuffer != NULL) ++ rtw_mfree(myBTFwBuffer, BTPatchSize); ++ ++ return _TRUE; ++} ++ ++/* As the size of bt firmware is more than 16k which is too big for some platforms, we divide it ++ * into four parts to transfer. The last parameter of _WriteBTFWtoTxPktBuf8723D is used to indicate ++ * the location of every part. We call the first 4096 byte of bt firmware as part 1, the second 4096 ++ * part as part 2, the third 4096 part as part 3, the remain as part 4. First we transform the part ++ * 4 and set the register 0x209 to 0x90, then the 32 bytes description are added to the head of part ++ * 4, and those bytes are putted at the location 0x90. Second we transform the part 3 and set the ++ * register 0x209 to 0x70. The 32 bytes description and part 3(4196 bytes) are putted at the location ++ * 0x70. It can contain 4196 bytes between 0x70 and 0x90. So the last 32 bytes os part 3 will cover the ++ * 32 bytes description of part4. Using this method, we can put the whole bt firmware to 0x30 and only ++ * has 32 bytes descrption at the head of part 1. ++*/ ++s32 FirmwareDownloadBT(PADAPTER padapter, PRT_MP_FIRMWARE pFirmware) ++{ ++ s32 rtStatus; ++ u8 *pBTFirmwareBuf; ++ u32 BTFirmwareLen; ++ u8 download_time; ++ s8 i; ++ ++ ++ rtStatus = _SUCCESS; ++ pBTFirmwareBuf = NULL; ++ BTFirmwareLen = 0; ++ ++#if 0 ++ /* */ ++ /* Patch BT Fw. Download BT RAM code to Tx packet buffer. */ ++ /* */ ++ if (padapter->bBTFWReady) { ++ RTW_INFO("%s: BT Firmware is ready!!\n", __FUNCTION__); ++ return _FAIL; ++ } ++ ++#ifdef CONFIG_FILE_FWIMG ++ if (rtw_is_file_readable(rtw_fw_mp_bt_file_path) == _TRUE) { ++ RTW_INFO("%s: acquire MP BT FW from file:%s\n", __FUNCTION__, rtw_fw_mp_bt_file_path); ++ ++ rtStatus = rtw_retrieve_from_file(rtw_fw_mp_bt_file_path, FwBuffer, FW_8723D_SIZE); ++ BTFirmwareLen = rtStatus >= 0 ? rtStatus : 0; ++ pBTFirmwareBuf = FwBuffer; ++ } else ++#endif /* CONFIG_FILE_FWIMG */ ++ { ++#ifdef CONFIG_EMBEDDED_FWIMG ++ RTW_INFO("%s: Download MP BT FW from header\n", __FUNCTION__); ++ ++ pBTFirmwareBuf = (u8 *)Rtl8723DFwBTImgArray; ++ BTFirmwareLen = Rtl8723DFwBTImgArrayLength; ++ pFirmware->szFwBuffer = pBTFirmwareBuf; ++ pFirmware->ulFwLength = BTFirmwareLen; ++#endif /* CONFIG_EMBEDDED_FWIMG */ ++ } ++ ++ RTW_INFO("%s: MP BT Firmware size=%d\n", __FUNCTION__, BTFirmwareLen); ++ ++ /* for h2c cam here should be set to true */ ++ padapter->bFWReady = _TRUE; ++ ++ download_time = (BTFirmwareLen + 4095) / 4096; ++ RTW_INFO("%s: download_time is %d\n", __FUNCTION__, download_time); ++ ++ /* Download BT patch Fw. */ ++ for (i = (download_time - 1); i >= 0; i--) { ++ if (i == (download_time - 1)) { ++ rtStatus = _WriteBTFWtoTxPktBuf8723D(padapter, pBTFirmwareBuf + (4096 * i), (BTFirmwareLen - (4096 * i)), 1); ++ RTW_INFO("%s: start %d, len %d, time 1\n", __FUNCTION__, 4096 * i, BTFirmwareLen - (4096 * i)); ++ } else { ++ rtStatus = _WriteBTFWtoTxPktBuf8723D(padapter, pBTFirmwareBuf + (4096 * i), 4096, (download_time - i)); ++ RTW_INFO("%s: start %d, len 4096, time %d\n", __FUNCTION__, 4096 * i, download_time - i); ++ } ++ ++ if (rtStatus != _SUCCESS) { ++ RTW_INFO("%s: BT Firmware download to Tx packet buffer fail!\n", __FUNCTION__); ++ padapter->bBTFWReady = _FALSE; ++ return rtStatus; ++ } ++ } ++ ++ ReservedPage_Compare(padapter, pFirmware, BTFirmwareLen); ++ ++ padapter->bBTFWReady = _TRUE; ++ SetFwBTFwPatchCmd(padapter, (u16)BTFirmwareLen); ++ rtStatus = _CheckWLANFwPatchBTFwReady(padapter); ++ ++ RTW_INFO("<===%s: return %s!\n", __FUNCTION__, rtStatus == _SUCCESS ? "SUCCESS" : "FAIL"); ++#endif ++ ++ return rtStatus; ++} ++#endif /* CONFIG_MP_INCLUDED */ ++ ++#if defined(CONFIG_SDIO_HCI) && defined (FW_DOWNLOAD_SIZE_8723D) ++u8 send_fw_packet(PADAPTER padapter, u8 *pRam_code, u32 length) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct xmit_buf xmit_buf_tmp; ++ struct submit_ctx sctx_tmp; ++ u8 *pTx_data_buffer = NULL; ++ u8 *pTmp_buffer = NULL; ++ u8 bRet = 0, value8 = 0, res = _FAIL; ++ u32 modify_ram_size = 0; ++ u32 tmp_size = 0, tmp_value = 0; ++ u32 i = 0, counter = 0; ++ u32 dwDataLength = 0, writeLength = 0; ++ ++ /* Due to SDIO can not send 32K packet */ ++ if (FW_DOWNLOAD_SIZE_8723D == length) ++ length--; ++ ++ modify_ram_size = length << 2; ++ ++ pTx_data_buffer = rtw_zmalloc(modify_ram_size); ++ ++ if (NULL == pTx_data_buffer) { ++ RTW_INFO("Allocate buffer fail!!\n"); ++ return _FALSE; ++ } ++ ++ _rtw_memset(pTx_data_buffer, 0, modify_ram_size); ++ ++ /* Transfer to new format */ ++ tmp_size = length >> 1; ++ for (i = 0; i <= tmp_size; i++) { ++ *(pTx_data_buffer + i * 8) = *(pRam_code + i * 2); ++ *(pTx_data_buffer + i * 8 + 1) = *(pRam_code + i * 2 + 1); ++ } ++ ++ /* Gen TX_DESC */ ++ _rtw_memset(pTx_data_buffer, 0, TXDESC_SIZE); ++ pTmp_buffer = pTx_data_buffer; ++ SET_TX_DESC_QUEUE_SEL_8723D(pTmp_buffer, QSLT_BEACON); ++ SET_TX_DESC_PKT_SIZE_8723D(pTmp_buffer, modify_ram_size - TXDESC_SIZE); ++ SET_TX_DESC_OFFSET_8723D(pTmp_buffer, TXDESC_SIZE); ++ ++ /* Send packet */ ++ xmit_buf_tmp.pdata = pTx_data_buffer; ++ xmit_buf_tmp.len = modify_ram_size; ++ rtw_sctx_init(&sctx_tmp, 10); ++ xmit_buf_tmp.sctx = &sctx_tmp; ++ ++ res = rtw_write_port(padapter, ++ pdvobjpriv->Queue2Pipe[BCN_QUEUE_INX], ++ xmit_buf_tmp.len, ++ (u8 *)&xmit_buf_tmp); ++ if (res == _FAIL) { ++ RTW_INFO("rtw_write_port fail\n"); ++ return _FAIL; ++ } ++ ++ /* check if DMA is OK */ ++ counter = 100; ++ do { ++ if (0 == counter) { ++ RTW_INFO("DMA time out!!\n"); ++ return _FALSE; ++ } ++ value8 = rtw_read8(padapter, REG_DWBCN0_CTRL_8723D + 2); ++ counter--; ++ } while (0 == (value8 & BIT(0))); ++ ++ rtw_write8(padapter, REG_DWBCN0_CTRL_8723D + 2, value8); ++ ++ /* Modify ram code by IO method */ ++ tmp_value = rtw_read8(padapter, REG_MCUFWDL + 1); ++ /* Disable DMA */ ++ rtw_write8(padapter, REG_MCUFWDL + 1, (u8)tmp_value & ~(BIT(5))); ++ tmp_value = (tmp_value >> 6) << 1; ++ /* Set page start address */ ++ rtw_write8(padapter, REG_MCUFWDL + 2, ++ (rtw_read8(padapter, REG_MCUFWDL + 2) & 0xF8) | tmp_value); ++ tmp_size = TXDESC_SIZE >> 2; /* 10bytes */ ++ ++ _BlockWrite(padapter, pRam_code, tmp_size); ++ ++ if (pTmp_buffer != NULL) ++ rtw_mfree((u8 *)pTmp_buffer, modify_ram_size); ++ ++ return _TRUE; ++} ++#endif /* CONFIG_SDIO_HCI */ ++ ++/* ++ * Description: ++ * Download 8192C firmware code. ++ * ++ * */ ++s32 rtl8723d_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw) ++{ ++ s32 rtStatus = _SUCCESS; ++ u8 write_fw = 0; ++ u32 fwdl_start_time; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ u8 *FwImage; ++ u32 FwImageLen; ++ u8 *pFwImageFileName; ++#ifdef CONFIG_WOWLAN ++ u8 *FwImageWoWLAN; ++ u32 FwImageWoWLANLen; ++#endif ++ u8 *pucMappedFile = NULL; ++ PRT_FIRMWARE_8723D pFirmware = NULL; ++ PRT_8723D_FIRMWARE_HDR pFwHdr = NULL; ++ u8 *pFirmwareBuf; ++ u32 FirmwareLen; ++#ifdef CONFIG_FILE_FWIMG ++ u8 *fwfilepath; ++#endif /* CONFIG_FILE_FWIMG */ ++ u8 value8; ++ u16 value16; ++ u32 value32; ++ u8 dma_iram_sel; ++ u16 new_chk_sum = 0; ++ u32 send_pkt_size, pkt_size_tmp; ++ u32 mem_offset; ++ u32 counter; ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ ++ ++ pFirmware = (PRT_FIRMWARE_8723D)rtw_zmalloc(sizeof(RT_FIRMWARE_8723D)); ++ ++ if (!pFirmware) { ++ rtStatus = _FAIL; ++ goto exit; ++ } ++ ++ { ++ u8 tmp_ps = 0, tmp_rf = 0; ++ ++ tmp_ps = rtw_read8(padapter, 0xa3); ++ tmp_ps &= 0xf8; ++ tmp_ps |= 0x02; ++ /* 1. write 0xA3[:2:0] = 3b'010 */ ++ rtw_write8(padapter, 0xa3, tmp_ps); ++ /* 2. read power_state = 0xA0[1:0] */ ++ tmp_ps = rtw_read8(padapter, 0xa0); ++ tmp_ps &= 0x03; ++ if (tmp_ps != 0x01) { ++ RTW_INFO(FUNC_ADPT_FMT" tmp_ps=%x\n", ++ FUNC_ADPT_ARG(padapter), tmp_ps); ++ pdbgpriv->dbg_downloadfw_pwr_state_cnt++; ++ } ++ } ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_PreLoadFirmware(padapter); ++#endif /* CONFIG_BT_COEXIST */ ++ ++#ifdef CONFIG_FILE_FWIMG ++#ifdef CONFIG_WOWLAN ++ if (bUsedWoWLANFw) ++ fwfilepath = rtw_fw_wow_file_path; ++ else ++#endif /* CONFIG_WOWLAN */ ++ { ++ fwfilepath = rtw_fw_file_path; ++ } ++#endif /* CONFIG_FILE_FWIMG */ ++ ++#ifdef CONFIG_FILE_FWIMG ++ if (rtw_is_file_readable(fwfilepath) == _TRUE) { ++ RTW_INFO("%s acquire FW from file:%s\n", __FUNCTION__, fwfilepath); ++ pFirmware->eFWSource = FW_SOURCE_IMG_FILE; ++ } else ++#endif /* CONFIG_FILE_FWIMG */ ++ { ++#ifdef CONFIG_EMBEDDED_FWIMG ++ pFirmware->eFWSource = FW_SOURCE_HEADER_FILE; ++#else /* !CONFIG_EMBEDDED_FWIMG */ ++ pFirmware->eFWSource = FW_SOURCE_IMG_FILE; /* We should decided by Reg. */ ++#endif /* !CONFIG_EMBEDDED_FWIMG */ ++ } ++ ++ switch (pFirmware->eFWSource) { ++ case FW_SOURCE_IMG_FILE: ++#ifdef CONFIG_FILE_FWIMG ++ rtStatus = rtw_retrieve_from_file(fwfilepath, FwBuffer, FW_8723D_SIZE); ++ pFirmware->ulFwLength = rtStatus >= 0 ? rtStatus : 0; ++ pFirmware->szFwBuffer = FwBuffer; ++#endif /* CONFIG_FILE_FWIMG */ ++ break; ++ ++ case FW_SOURCE_HEADER_FILE: ++ if (bUsedWoWLANFw) { ++#ifdef CONFIG_WOWLAN ++ if (pwrpriv->wowlan_mode) { ++ pFirmware->szFwBuffer = array_mp_8723d_fw_wowlan; ++ pFirmware->ulFwLength = array_length_mp_8723d_fw_wowlan; ++ RTW_INFO(" ===> %s fw: %s, size: %d\n", ++ __func__, "WoWLAN", pFirmware->ulFwLength); ++ } ++#endif /* CONFIG_WOWLAN */ ++ ++#ifdef CONFIG_AP_WOWLAN ++ if (pwrpriv->wowlan_ap_mode) { ++ pFirmware->szFwBuffer = array_mp_8723d_fw_ap; ++ pFirmware->ulFwLength = array_length_mp_8723d_fw_ap; ++ RTW_INFO(" ===> %s fw: %s, size: %d\n", ++ __func__, "AP_WoWLAN", pFirmware->ulFwLength); ++ } ++#endif /* CONFIG_AP_WOWLAN */ ++ } else { ++ pFirmware->szFwBuffer = array_mp_8723d_fw_nic; ++ pFirmware->ulFwLength = array_length_mp_8723d_fw_nic; ++ RTW_INFO("%s fw: %s, size: %d\n", __func__, "FW_NIC", pFirmware->ulFwLength); ++ } ++ break; ++ } ++ ++ if (pFirmware->ulFwLength > FW_8723D_SIZE) { ++ rtStatus = _FAIL; ++ RTW_ERR("Firmware size:%u exceed %u\n", ++ pFirmware->ulFwLength, FW_8723D_SIZE); ++ goto exit; ++ } ++ ++ pFirmwareBuf = pFirmware->szFwBuffer; ++ FirmwareLen = pFirmware->ulFwLength; ++ ++ /* To Check Fw header. Added by tynli. 2009.12.04. */ ++ pFwHdr = (PRT_8723D_FIRMWARE_HDR)pFirmwareBuf; ++ ++ pHalData->FirmwareVersion = le16_to_cpu(pFwHdr->Version); ++ pHalData->FirmwareSubVersion = le16_to_cpu(pFwHdr->Subversion); ++ pHalData->FirmwareSignature = le16_to_cpu(pFwHdr->Signature); ++ ++ RTW_INFO("%s: fw_ver=%x fw_subver=%04x sig=0x%x, Month=%02x, Date=%02x, Hour=%02x, Minute=%02x\n", ++ __func__, pHalData->FirmwareVersion, ++ pHalData->FirmwareSubVersion, pHalData->FirmwareSignature ++ , pFwHdr->Month, pFwHdr->Date, pFwHdr->Hour, pFwHdr->Minute); ++ ++ if (IS_FW_HEADER_EXIST_8723D(pFwHdr)) { ++ RTW_INFO("%s(): Shift for fw header!\n", __FUNCTION__); ++ /* Shift 32 bytes for FW header */ ++ pFirmwareBuf = pFirmwareBuf + 32; ++ FirmwareLen = FirmwareLen - 32; ++ } ++ ++ fwdl_start_time = rtw_get_current_time(); ++ ++ /* To check if FW already exists before download FW */ ++ if (rtw_read8(padapter, REG_MCUFWDL) & RAM_DL_SEL) { ++ RTW_INFO("%s: FW exists before download FW\n", __func__); ++ rtw_write8(padapter, REG_MCUFWDL, 0x00); ++ _8051Reset8723(padapter); ++ } ++ ++#ifndef CONFIG_DLFW_TXPKT ++ RTW_INFO("%s by IO write!\n", __func__); ++ ++ _FWDownloadEnable(padapter, _TRUE); ++ ++ while (!RTW_CANNOT_IO(padapter) && ++ (write_fw++ < DL_FW_MAX || ++ rtw_get_passing_time_ms(fwdl_start_time) < 500)) { ++ /* reset FWDL chksum */ ++ rtw_write8(padapter, REG_MCUFWDL, ++ rtw_read8(padapter, REG_MCUFWDL) | FWDL_ChkSum_rpt); ++ ++ rtStatus = _WriteFW(padapter, pFirmwareBuf, FirmwareLen); ++ if (rtStatus != _SUCCESS) ++ continue; ++ ++ rtStatus = polling_fwdl_chksum(padapter, 2, 10); ++ if (rtStatus == _SUCCESS) { ++ RTW_INFO("%s: download FW count:%d\n", __func__, ++ write_fw); ++ break; ++ } else { ++ rtw_mdelay_os(10); ++ } ++ } ++#else ++ RTW_INFO("%s by Tx pkt write!\n", __func__); ++ ++ if ((rtw_read8(padapter, REG_MCUFWDL) & MCUFWDL_RDY) == 0) { ++ /* ++ * SDIO DMA condition: ++ * all queue must be 256 (0x100 = 0x20 + 0xE0) ++ */ ++ ++ value32 = 0x802000E0; ++ rtw_write32(padapter, REG_RQPN, value32); ++ ++ /* Set beacon boundary to TXFIFO header */ ++ rtw_write8(padapter, REG_BCNQ_BDNY, 0); ++ rtw_write16(padapter, REG_DWBCN0_CTRL_8723D + 1, BIT(8)); ++ ++ /* SDIO need read this register before send packet */ ++ rtw_read32(padapter, 0x10250020); ++ ++ _FWDownloadEnable(padapter, _TRUE); ++ ++ /* Get original check sum */ ++ new_chk_sum = *(pFirmwareBuf + FirmwareLen - 2) | ++ ((u16)*(pFirmwareBuf + FirmwareLen - 1) << 8); ++ ++ /* Send ram code flow */ ++ dma_iram_sel = 0; ++ mem_offset = 0; ++ pkt_size_tmp = FirmwareLen; ++ while (0 != pkt_size_tmp) { ++ if (pkt_size_tmp >= FW_DOWNLOAD_SIZE_8723D) { ++ send_pkt_size = FW_DOWNLOAD_SIZE_8723D; ++ /* Modify check sum value */ ++ new_chk_sum = (u16)(new_chk_sum ^ (((send_pkt_size - 1) << 2) - TXDESC_SIZE)); ++ } else { ++ send_pkt_size = pkt_size_tmp; ++ new_chk_sum = (u16)(new_chk_sum ^ ((send_pkt_size << 2) - TXDESC_SIZE)); ++ ++ } ++ ++ if (send_pkt_size == pkt_size_tmp) { ++ /* last partition packet, write new check sum to ram code file */ ++ *(pFirmwareBuf + FirmwareLen - 2) = new_chk_sum & 0xFF; ++ *(pFirmwareBuf + FirmwareLen - 1) = (new_chk_sum & 0xFF00) >> 8; ++ } ++ ++ /* IRAM select */ ++ rtw_write8(padapter, REG_MCUFWDL + 1, ++ (rtw_read8(padapter, REG_MCUFWDL + 1) & 0x3F) | (dma_iram_sel << 6)); ++ /* Enable DMA */ ++ rtw_write8(padapter, REG_MCUFWDL + 1, ++ rtw_read8(padapter, REG_MCUFWDL + 1) | BIT(5)); ++ ++ if (_FALSE == send_fw_packet(padapter, pFirmwareBuf + mem_offset, send_pkt_size)) { ++ RTW_INFO("%s: Send FW fail !\n", __FUNCTION__); ++ rtStatus = _FAIL; ++ goto DLFW_FAIL; ++ } ++ ++ dma_iram_sel++; ++ mem_offset += send_pkt_size; ++ pkt_size_tmp -= send_pkt_size; ++ } ++ } else { ++ RTW_INFO("%s: Download FW fail since MCUFWDL_RDY is not set!\n", __FUNCTION__); ++ rtStatus = _FAIL; ++ goto DLFW_FAIL; ++ } ++#endif ++ ++ _FWDownloadEnable(padapter, _FALSE); ++ ++ if (rtStatus == _SUCCESS) ++ rtStatus = _FWFreeToGo(padapter, 10, 200); ++ else ++ goto DLFW_FAIL; ++ ++ if (_SUCCESS != rtStatus) ++ goto DLFW_FAIL; ++ ++DLFW_FAIL: ++ if (rtStatus == _FAIL) { ++ /* Disable FWDL_EN */ ++ value8 = rtw_read8(padapter, REG_MCUFWDL); ++ value8 = (value8 & ~(BIT(0)) & ~(BIT(1))); ++ rtw_write8(padapter, REG_MCUFWDL, value8); ++ } ++ ++ RTW_INFO("%s %s. write_fw:%u, %dms\n" ++ , __FUNCTION__, (rtStatus == _SUCCESS) ? "success" : "fail" ++ , write_fw ++ , rtw_get_passing_time_ms(fwdl_start_time) ++ ); ++ ++exit: ++ if (pFirmware) ++ rtw_mfree((u8 *)pFirmware, sizeof(RT_FIRMWARE_8723D)); ++ ++ rtl8723d_InitializeFirmwareVars(padapter); ++ ++ RTW_INFO(" <=== %s()\n", __FUNCTION__); ++ ++ return rtStatus; ++} ++ ++void rtl8723d_InitializeFirmwareVars(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ ++ /* Init Fw LPS related. */ ++ adapter_to_pwrctl(padapter)->bFwCurrentInPSMode = _FALSE; ++ ++ /* Init H2C cmd. */ ++ rtw_write8(padapter, REG_HMETFR, 0x0f); ++ ++ /* Init H2C counter. by tynli. 2009.12.09. */ ++ pHalData->LastHMEBoxNum = 0; ++ /* pHalData->H2CQueueHead = 0; ++ * pHalData->H2CQueueTail = 0; ++ * pHalData->H2CStopInsertQueue = _FALSE; */ ++} ++ ++/* *********************************************************** ++ * Efuse related code ++ * *********************************************************** */ ++static u8 ++hal_EfuseSwitchToBank( ++ PADAPTER padapter, ++ u8 bank, ++ u8 bPseudoTest) ++{ ++ u8 bRet = _FALSE; ++ u32 value32 = 0; ++#ifdef HAL_EFUSE_MEMORY ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; ++#endif ++ ++ ++ RTW_INFO("%s: Efuse switch bank to %d\n", __FUNCTION__, bank); ++ if (bPseudoTest) { ++#ifdef HAL_EFUSE_MEMORY ++ pEfuseHal->fakeEfuseBank = bank; ++#else ++ fakeEfuseBank = bank; ++#endif ++ bRet = _TRUE; ++ } else { ++ value32 = rtw_read32(padapter, EFUSE_TEST); ++ bRet = _TRUE; ++ switch (bank) { ++ case 0: ++ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_WIFI_SEL_0); ++ break; ++ case 1: ++ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_BT_SEL_0); ++ break; ++ case 2: ++ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_BT_SEL_1); ++ break; ++ case 3: ++ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_BT_SEL_2); ++ break; ++ default: ++ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_WIFI_SEL_0); ++ bRet = _FALSE; ++ break; ++ } ++ rtw_write32(padapter, EFUSE_TEST, value32); ++ } ++ ++ return bRet; ++} ++ ++static void ++Hal_GetEfuseDefinition( ++ PADAPTER padapter, ++ u8 efuseType, ++ u8 type, ++ void *pOut, ++ u8 bPseudoTest) ++{ ++ switch (type) { ++ case TYPE_EFUSE_MAX_SECTION: { ++ u8 *pMax_section; ++ ++ pMax_section = (u8 *)pOut; ++ ++ if (efuseType == EFUSE_WIFI) ++ *pMax_section = EFUSE_MAX_SECTION_8723D; ++ else ++ *pMax_section = EFUSE_BT_MAX_SECTION; ++ } ++ break; ++ ++ case TYPE_EFUSE_REAL_CONTENT_LEN: { ++ u16 *pu2Tmp; ++ ++ pu2Tmp = (u16 *)pOut; ++ ++ if (efuseType == EFUSE_WIFI) ++ *pu2Tmp = EFUSE_REAL_CONTENT_LEN_8723D; ++ else ++ *pu2Tmp = EFUSE_BT_REAL_CONTENT_LEN; ++ } ++ break; ++ ++ case TYPE_AVAILABLE_EFUSE_BYTES_BANK: { ++ u16 *pu2Tmp; ++ ++ pu2Tmp = (u16 *)pOut; ++ ++ if (efuseType == EFUSE_WIFI) ++ *pu2Tmp = (EFUSE_REAL_CONTENT_LEN_8723D - EFUSE_OOB_PROTECT_BYTES); ++ else ++ *pu2Tmp = (EFUSE_BT_REAL_BANK_CONTENT_LEN - EFUSE_PROTECT_BYTES_BANK); ++ } ++ break; ++ ++ case TYPE_AVAILABLE_EFUSE_BYTES_TOTAL: { ++ u16 *pu2Tmp; ++ ++ pu2Tmp = (u16 *)pOut; ++ ++ if (efuseType == EFUSE_WIFI) ++ *pu2Tmp = (EFUSE_REAL_CONTENT_LEN_8723D - EFUSE_OOB_PROTECT_BYTES); ++ else ++ *pu2Tmp = (EFUSE_BT_REAL_CONTENT_LEN - (EFUSE_PROTECT_BYTES_BANK * 3)); ++ } ++ break; ++ ++ case TYPE_EFUSE_MAP_LEN: { ++ u16 *pu2Tmp; ++ ++ pu2Tmp = (u16 *)pOut; ++ ++ if (efuseType == EFUSE_WIFI) ++ *pu2Tmp = EFUSE_MAP_LEN_8723D; ++ else ++ *pu2Tmp = EFUSE_BT_MAP_LEN; ++ } ++ break; ++ ++ case TYPE_EFUSE_PROTECT_BYTES_BANK: { ++ u8 *pu1Tmp; ++ ++ pu1Tmp = (u8 *)pOut; ++ ++ if (efuseType == EFUSE_WIFI) ++ *pu1Tmp = EFUSE_OOB_PROTECT_BYTES; ++ else ++ *pu1Tmp = EFUSE_PROTECT_BYTES_BANK; ++ } ++ break; ++ ++ case TYPE_EFUSE_CONTENT_LEN_BANK: { ++ u16 *pu2Tmp; ++ ++ pu2Tmp = (u16 *)pOut; ++ ++ if (efuseType == EFUSE_WIFI) ++ *pu2Tmp = EFUSE_REAL_CONTENT_LEN_8723D; ++ else ++ *pu2Tmp = EFUSE_BT_REAL_BANK_CONTENT_LEN; ++ } ++ break; ++ ++ default: { ++ u8 *pu1Tmp; ++ ++ pu1Tmp = (u8 *)pOut; ++ *pu1Tmp = 0; ++ } ++ break; ++ } ++} ++ ++#define VOLTAGE_V25 0x03 ++#define LDOE25_SHIFT 28 ++ ++/* ***************************************************************** ++ * The following is for compile ok ++ * That should be merged with the original in the future ++ * ***************************************************************** */ ++#define EFUSE_ACCESS_ON_8723 0x69 /* For RTL8723 only. */ ++#define EFUSE_ACCESS_OFF_8723 0x00 /* For RTL8723 only. */ ++#define REG_EFUSE_ACCESS_8723 0x00CF /* Efuse access protection for RTL8723 */ ++ ++/* ***************************************************************** */ ++static void Hal_BT_EfusePowerSwitch( ++ PADAPTER padapter, ++ u8 bWrite, ++ u8 PwrState) ++{ ++ u8 tempval; ++ ++ if (PwrState == _TRUE) { ++ /* enable BT power cut */ ++ /* 0x6A[14] = 1 */ ++ tempval = rtw_read8(padapter, 0x6B); ++ tempval |= BIT(6); ++ rtw_write8(padapter, 0x6B, tempval); ++ ++ /* Attention!! Between 0x6A[14] and 0x6A[15] setting need 100us delay */ ++ /* So don't write 0x6A[14]=1 and 0x6A[15]=0 together! */ ++ rtw_usleep_os(100); ++ /* disable BT output isolation */ ++ /* 0x6A[15] = 0 */ ++ tempval = rtw_read8(padapter, 0x6B); ++ tempval &= ~BIT(7); ++ rtw_write8(padapter, 0x6B, tempval); ++ } else { ++ /* enable BT output isolation */ ++ /* 0x6A[15] = 1 */ ++ tempval = rtw_read8(padapter, 0x6B); ++ tempval |= BIT(7); ++ rtw_write8(padapter, 0x6B, tempval); ++ ++ /* Attention!! Between 0x6A[14] and 0x6A[15] setting need 100us delay */ ++ /* So don't write 0x6A[14]=1 and 0x6A[15]=0 together! */ ++ ++ /* disable BT power cut */ ++ /* 0x6A[14] = 1 */ ++ tempval = rtw_read8(padapter, 0x6B); ++ tempval &= ~BIT(6); ++ rtw_write8(padapter, 0x6B, tempval); ++ } ++ ++} ++static void ++Hal_EfusePowerSwitch( ++ PADAPTER padapter, ++ u8 bWrite, ++ u8 PwrState) ++{ ++ u8 tempval; ++ u16 tmpV16; ++ ++ ++ if (PwrState == _TRUE) { ++#ifdef CONFIG_SDIO_HCI ++ /* To avoid cannot access efuse regsiters after disable/enable several times during DTM test. */ ++ /* Suggested by SD1 IsaacHsu. 2013.07.08, added by tynli. */ ++ tempval = rtw_read8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HSUS_CTRL); ++ if (tempval & BIT(0)) { /* SDIO local register is suspend */ ++ u8 count = 0; ++ ++ ++ tempval &= ~BIT(0); ++ rtw_write8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HSUS_CTRL, tempval); ++ ++ /* check 0x86[1:0]=10'2h, wait power state to leave suspend */ ++ do { ++ tempval = rtw_read8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HSUS_CTRL); ++ tempval &= 0x3; ++ if (tempval == 0x02) ++ break; ++ ++ count++; ++ if (count >= 100) ++ break; ++ ++ rtw_mdelay_os(10); ++ } while (1); ++ ++ if (count >= 100) { ++ RTW_INFO(FUNC_ADPT_FMT ": Leave SDIO local register suspend fail! Local 0x86=%#X\n", ++ FUNC_ADPT_ARG(padapter), tempval); ++ } else { ++ RTW_INFO(FUNC_ADPT_FMT ": Leave SDIO local register suspend OK! Local 0x86=%#X\n", ++ FUNC_ADPT_ARG(padapter), tempval); ++ } ++ } ++#endif /* CONFIG_SDIO_HCI */ ++ ++ rtw_write8(padapter, REG_EFUSE_ACCESS_8723, EFUSE_ACCESS_ON_8723); ++ ++ /* Reset: 0x0000h[28], default valid */ ++ tmpV16 = rtw_read16(padapter, REG_SYS_FUNC_EN); ++ if (!(tmpV16 & FEN_ELDR)) { ++ tmpV16 |= FEN_ELDR; ++ rtw_write16(padapter, REG_SYS_FUNC_EN, tmpV16); ++ } ++ ++ /* Clock: Gated(0x0008h[5]) 8M(0x0008h[1]) clock from ANA, default valid */ ++ tmpV16 = rtw_read16(padapter, REG_SYS_CLKR); ++ if ((!(tmpV16 & LOADER_CLK_EN)) || (!(tmpV16 & ANA8M))) { ++ tmpV16 |= (LOADER_CLK_EN | ANA8M); ++ rtw_write16(padapter, REG_SYS_CLKR, tmpV16); ++ } ++ ++ if (bWrite == _TRUE) { ++ /* Enable LDO 2.5V before read/write action */ ++ tempval = rtw_read8(padapter, EFUSE_TEST + 3); ++ tempval &= 0x0F; ++ tempval |= (VOLTAGE_V25 << 4); ++ rtw_write8(padapter, EFUSE_TEST + 3, (tempval | 0x80)); ++ ++ /* rtw_write8(padapter, REG_EFUSE_ACCESS, EFUSE_ACCESS_ON); */ ++ } ++ } else { ++ rtw_write8(padapter, REG_EFUSE_ACCESS, EFUSE_ACCESS_OFF); ++ ++ if (bWrite == _TRUE) { ++ /* Disable LDO 2.5V after read/write action */ ++ tempval = rtw_read8(padapter, EFUSE_TEST + 3); ++ rtw_write8(padapter, EFUSE_TEST + 3, (tempval & 0x7F)); ++ } ++ ++ } ++} ++ ++static void ++hal_ReadEFuse_WiFi( ++ PADAPTER padapter, ++ u16 _offset, ++ u16 _size_byte, ++ u8 *pbuf, ++ u8 bPseudoTest) ++{ ++#ifdef HAL_EFUSE_MEMORY ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; ++#endif ++ u8 *efuseTbl = NULL; ++ u16 eFuse_Addr = 0; ++ u8 offset, wden; ++ u8 efuseHeader, efuseExtHdr, efuseData; ++ u16 i, total, used; ++ u8 efuse_usage = 0; ++ ++ /* RTW_INFO("YJ: ====>%s():_offset=%d _size_byte=%d bPseudoTest=%d\n", __func__, _offset, _size_byte, bPseudoTest); */ ++ /* */ ++ /* Do NOT excess total size of EFuse table. Added by Roger, 2008.11.10. */ ++ /* */ ++ if ((_offset + _size_byte) > EFUSE_MAX_MAP_LEN) { ++ RTW_INFO("%s: Invalid offset(%#x) with read bytes(%#x)!!\n", __FUNCTION__, _offset, _size_byte); ++ return; ++ } ++ ++ efuseTbl = (u8 *)rtw_malloc(EFUSE_MAX_MAP_LEN); ++ if (efuseTbl == NULL) { ++ RTW_INFO("%s: alloc efuseTbl fail!\n", __FUNCTION__); ++ return; ++ } ++ /* 0xff will be efuse default value instead of 0x00. */ ++ _rtw_memset(efuseTbl, 0xFF, EFUSE_MAX_MAP_LEN); ++ ++ ++#ifdef CONFIG_DEBUG ++ if (0) { ++ for (i = 0; i < 256; i++) ++ /* ReadEFuseByte(padapter, i, &efuseTbl[i], _FALSE); */ ++ efuse_OneByteRead(padapter, i, &efuseTbl[i], _FALSE); ++ RTW_INFO("Efuse Content:\n"); ++ for (i = 0; i < 256; i++) { ++ if (i % 16 == 0) ++ printk(KERN_ERR"\n"); ++ printk(KERN_ERR"%02X ", efuseTbl[i]); ++ } ++ printk(KERN_ERR"\n"); ++ } ++#endif ++ ++ ++ /* switch bank back to bank 0 for later BT and wifi use. */ ++ hal_EfuseSwitchToBank(padapter, 0, bPseudoTest); ++ ++ while (AVAILABLE_EFUSE_ADDR(eFuse_Addr)) { ++ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); */ ++ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); ++ if (efuseHeader == 0xFF) { ++ RTW_INFO("%s: data end at address=%#x\n", __FUNCTION__, eFuse_Addr - 1); ++ break; ++ } ++ /* RTW_INFO("%s: efuse[0x%X]=0x%02X\n", __FUNCTION__, eFuse_Addr-1, efuseHeader); */ ++ ++ /* Check PG header for section num. */ ++ if (EXT_HEADER(efuseHeader)) { /* extended header */ ++ offset = GET_HDR_OFFSET_2_0(efuseHeader); ++ /* RTW_INFO("%s: extended header offset=0x%X\n", __FUNCTION__, offset); */ ++ ++ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); */ ++ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); ++ /* RTW_INFO("%s: efuse[0x%X]=0x%02X\n", __FUNCTION__, eFuse_Addr-1, efuseExtHdr); */ ++ if (ALL_WORDS_DISABLED(efuseExtHdr)) ++ continue; ++ ++ offset |= ((efuseExtHdr & 0xF0) >> 1); ++ wden = (efuseExtHdr & 0x0F); ++ } else { ++ offset = ((efuseHeader >> 4) & 0x0f); ++ wden = (efuseHeader & 0x0f); ++ } ++ /* RTW_INFO("%s: Offset=%d Worden=0x%X\n", __FUNCTION__, offset, wden); */ ++ ++ if (offset < EFUSE_MAX_SECTION_8723D) { ++ u16 addr; ++ /* Get word enable value from PG header ++ * RTW_INFO("%s: Offset=%d Worden=0x%X\n", __FUNCTION__, offset, wden); */ ++ ++ addr = offset * PGPKT_DATA_SIZE; ++ for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { ++ /* Check word enable condition in the section */ ++ if (!(wden & (0x01 << i))) { ++ efuseData = 0; ++ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseData, bPseudoTest); */ ++ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseData, bPseudoTest); ++ /* RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, eFuse_Addr-1, efuseData); */ ++ efuseTbl[addr] = efuseData; ++ ++ efuseData = 0; ++ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseData, bPseudoTest); */ ++ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseData, bPseudoTest); ++ /* RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, eFuse_Addr-1, efuseData); */ ++ efuseTbl[addr + 1] = efuseData; ++ } ++ addr += 2; ++ } ++ } else { ++ RTW_INFO(KERN_ERR "%s: offset(%d) is illegal!!\n", __FUNCTION__, offset); ++ eFuse_Addr += Efuse_CalculateWordCnts(wden) * 2; ++ } ++ } ++ ++ /* Copy from Efuse map to output pointer memory!!! */ ++ for (i = 0; i < _size_byte; i++) ++ pbuf[i] = efuseTbl[_offset + i]; ++ ++ /* Calculate Efuse utilization */ ++ total = 0; ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &total, bPseudoTest); ++ used = eFuse_Addr - 1; ++ if (total) ++ efuse_usage = (u8)((used * 100) / total); ++ else ++ efuse_usage = 100; ++ if (bPseudoTest) { ++#ifdef HAL_EFUSE_MEMORY ++ pEfuseHal->fakeEfuseUsedBytes = used; ++#else ++ fakeEfuseUsedBytes = used; ++#endif ++ } else { ++ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&used); ++ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_USAGE, (u8 *)&efuse_usage); ++ } ++ ++ if (efuseTbl) ++ rtw_mfree(efuseTbl, EFUSE_MAX_MAP_LEN); ++} ++ ++static VOID ++hal_ReadEFuse_BT( ++ PADAPTER padapter, ++ u16 _offset, ++ u16 _size_byte, ++ u8 *pbuf, ++ u8 bPseudoTest ++) ++{ ++#ifdef HAL_EFUSE_MEMORY ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; ++#endif ++ u8 *efuseTbl; ++ u8 bank; ++ u16 eFuse_Addr; ++ u8 efuseHeader, efuseExtHdr, efuseData; ++ u8 offset, wden; ++ u16 i, total, used; ++ u8 efuse_usage; ++ ++ ++ /* */ ++ /* Do NOT excess total size of EFuse table. Added by Roger, 2008.11.10. */ ++ /* */ ++ if ((_offset + _size_byte) > EFUSE_BT_MAP_LEN) { ++ RTW_INFO("%s: Invalid offset(%#x) with read bytes(%#x)!!\n", __FUNCTION__, _offset, _size_byte); ++ return; ++ } ++ ++ efuseTbl = rtw_malloc(EFUSE_BT_MAP_LEN); ++ if (efuseTbl == NULL) { ++ RTW_INFO("%s: efuseTbl malloc fail!\n", __FUNCTION__); ++ return; ++ } ++ /* 0xff will be efuse default value instead of 0x00. */ ++ _rtw_memset(efuseTbl, 0xFF, EFUSE_BT_MAP_LEN); ++ ++ total = 0; ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_BANK, &total, bPseudoTest); ++ ++ for (bank = 1; bank < 3; bank++) { /* 8723d Max bake 0~2 */ ++ if (hal_EfuseSwitchToBank(padapter, bank, bPseudoTest) == _FALSE) { ++ RTW_INFO("%s: hal_EfuseSwitchToBank Fail!!\n", __FUNCTION__); ++ goto exit; ++ } ++ ++ eFuse_Addr = 0; ++ ++ while (AVAILABLE_EFUSE_ADDR(eFuse_Addr)) { ++ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); */ ++ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); ++ if (efuseHeader == 0xFF) ++ break; ++ RTW_INFO("%s: efuse[%#X]=0x%02x (header)\n", __FUNCTION__, (((bank - 1) * EFUSE_REAL_CONTENT_LEN_8723D) + eFuse_Addr - 1), efuseHeader); ++ ++ /* Check PG header for section num. */ ++ if (EXT_HEADER(efuseHeader)) { /* extended header */ ++ offset = GET_HDR_OFFSET_2_0(efuseHeader); ++ RTW_INFO("%s: extended header offset_2_0=0x%X\n", __FUNCTION__, offset); ++ ++ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); */ ++ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); ++ RTW_INFO("%s: efuse[%#X]=0x%02x (ext header)\n", __FUNCTION__, (((bank - 1) * EFUSE_REAL_CONTENT_LEN_8723D) + eFuse_Addr - 1), efuseExtHdr); ++ if (ALL_WORDS_DISABLED(efuseExtHdr)) ++ continue; ++ ++ offset |= ((efuseExtHdr & 0xF0) >> 1); ++ wden = (efuseExtHdr & 0x0F); ++ } else { ++ offset = ((efuseHeader >> 4) & 0x0f); ++ wden = (efuseHeader & 0x0f); ++ } ++ ++ if (offset < EFUSE_BT_MAX_SECTION) { ++ u16 addr; ++ ++ /* Get word enable value from PG header */ ++ RTW_INFO("%s: Offset=%d Worden=%#X\n", __FUNCTION__, offset, wden); ++ ++ addr = offset * PGPKT_DATA_SIZE; ++ for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { ++ /* Check word enable condition in the section */ ++ if (!(wden & (0x01 << i))) { ++ efuseData = 0; ++ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseData, bPseudoTest); */ ++ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseData, bPseudoTest); ++ RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, eFuse_Addr - 1, efuseData); ++ efuseTbl[addr] = efuseData; ++ ++ efuseData = 0; ++ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseData, bPseudoTest); */ ++ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseData, bPseudoTest); ++ RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, eFuse_Addr - 1, efuseData); ++ efuseTbl[addr + 1] = efuseData; ++ } ++ addr += 2; ++ } ++ } else { ++ RTW_INFO("%s: offset(%d) is illegal!!\n", __FUNCTION__, offset); ++ eFuse_Addr += Efuse_CalculateWordCnts(wden) * 2; ++ } ++ } ++ ++ if ((eFuse_Addr - 1) < total) { ++ RTW_INFO("%s: bank(%d) data end at %#x\n", __FUNCTION__, bank, eFuse_Addr - 1); ++ break; ++ } ++ } ++ ++ /* switch bank back to bank 0 for later BT and wifi use. */ ++ hal_EfuseSwitchToBank(padapter, 0, bPseudoTest); ++ ++ /* Copy from Efuse map to output pointer memory!!! */ ++ for (i = 0; i < _size_byte; i++) ++ pbuf[i] = efuseTbl[_offset + i]; ++ ++ /* */ ++ /* Calculate Efuse utilization. */ ++ /* */ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &total, bPseudoTest); ++ used = (EFUSE_BT_REAL_BANK_CONTENT_LEN * (bank - 1)) + eFuse_Addr - 1; ++ RTW_INFO("%s: bank(%d) data end at %#x ,used =%d\n", __FUNCTION__, bank, eFuse_Addr - 1, used); ++ efuse_usage = (u8)((used * 100) / total); ++ if (bPseudoTest) { ++#ifdef HAL_EFUSE_MEMORY ++ pEfuseHal->fakeBTEfuseUsedBytes = used; ++#else ++ fakeBTEfuseUsedBytes = used; ++#endif ++ } else { ++ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BT_BYTES, (u8 *)&used); ++ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BT_USAGE, (u8 *)&efuse_usage); ++ } ++ ++exit: ++ if (efuseTbl) ++ rtw_mfree(efuseTbl, EFUSE_BT_MAP_LEN); ++} ++ ++static void ++Hal_ReadEFuse( ++ PADAPTER padapter, ++ u8 efuseType, ++ u16 _offset, ++ u16 _size_byte, ++ u8 *pbuf, ++ u8 bPseudoTest) ++{ ++ if (efuseType == EFUSE_WIFI) ++ hal_ReadEFuse_WiFi(padapter, _offset, _size_byte, pbuf, bPseudoTest); ++ else ++ hal_ReadEFuse_BT(padapter, _offset, _size_byte, pbuf, bPseudoTest); ++} ++ ++static u16 ++hal_EfuseGetCurrentSize_WiFi( ++ PADAPTER padapter, ++ u8 bPseudoTest) ++{ ++#ifdef HAL_EFUSE_MEMORY ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; ++#endif ++ u16 efuse_addr = 0; ++ u16 start_addr = 0; /* for debug */ ++ u8 hoffset = 0, hworden = 0; ++ u8 efuse_data, word_cnts = 0; ++ u32 count = 0; /* for debug */ ++ ++ ++ if (bPseudoTest) { ++#ifdef HAL_EFUSE_MEMORY ++ efuse_addr = (u16)pEfuseHal->fakeEfuseUsedBytes; ++#else ++ efuse_addr = (u16)fakeEfuseUsedBytes; ++#endif ++ } else ++ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&efuse_addr); ++ start_addr = efuse_addr; ++ RTW_INFO("%s: start_efuse_addr=0x%X\n", __FUNCTION__, efuse_addr); ++ ++ /* switch bank back to bank 0 for later BT and wifi use. */ ++ hal_EfuseSwitchToBank(padapter, 0, bPseudoTest); ++ ++#if 0 /* for debug test */ ++ efuse_OneByteRead(padapter, 0x1FF, &efuse_data, bPseudoTest); ++ RTW_INFO(FUNC_ADPT_FMT ": efuse raw 0x1FF=0x%02X\n", ++ FUNC_ADPT_ARG(padapter), efuse_data); ++ efuse_data = 0xFF; ++#endif /* for debug test */ ++ ++ count = 0; ++ while (AVAILABLE_EFUSE_ADDR(efuse_addr)) { ++#if 1 ++ if (efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest) == _FALSE) { ++ RTW_INFO(KERN_ERR "%s: efuse_OneByteRead Fail! addr=0x%X !!\n", __FUNCTION__, efuse_addr); ++ goto error; ++ } ++#else ++ ReadEFuseByte(padapter, efuse_addr, &efuse_data, bPseudoTest); ++#endif ++ ++ if (efuse_data == 0xFF) ++ break; ++ ++ if ((start_addr != 0) && (efuse_addr == start_addr)) { ++ count++; ++ RTW_INFO(FUNC_ADPT_FMT ": [WARNING] efuse raw 0x%X=0x%02X not 0xFF!!(%d times)\n", ++ FUNC_ADPT_ARG(padapter), efuse_addr, efuse_data, count); ++ ++ efuse_data = 0xFF; ++ if (count < 4) { ++ /* try again! */ ++ ++ if (count > 2) { ++ /* try again form address 0 */ ++ efuse_addr = 0; ++ start_addr = 0; ++ } ++ ++ continue; ++ } ++ ++ goto error; ++ } ++ ++ if (EXT_HEADER(efuse_data)) { ++ hoffset = GET_HDR_OFFSET_2_0(efuse_data); ++ efuse_addr++; ++ efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest); ++ if (ALL_WORDS_DISABLED(efuse_data)) ++ continue; ++ ++ hoffset |= ((efuse_data & 0xF0) >> 1); ++ hworden = efuse_data & 0x0F; ++ } else { ++ hoffset = (efuse_data >> 4) & 0x0F; ++ hworden = efuse_data & 0x0F; ++ } ++ ++ word_cnts = Efuse_CalculateWordCnts(hworden); ++ efuse_addr += (word_cnts * 2) + 1; ++ } ++ ++ if (bPseudoTest) { ++#ifdef HAL_EFUSE_MEMORY ++ pEfuseHal->fakeEfuseUsedBytes = efuse_addr; ++#else ++ fakeEfuseUsedBytes = efuse_addr; ++#endif ++ } else ++ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&efuse_addr); ++ ++ goto exit; ++ ++error: ++ /* report max size to prevent write efuse */ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &efuse_addr, bPseudoTest); ++ ++exit: ++ RTW_INFO("%s: CurrentSize=%d\n", __FUNCTION__, efuse_addr); ++ ++ return efuse_addr; ++} ++ ++static u16 ++hal_EfuseGetCurrentSize_BT( ++ PADAPTER padapter, ++ u8 bPseudoTest) ++{ ++#ifdef HAL_EFUSE_MEMORY ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; ++#endif ++ u16 btusedbytes; ++ u16 efuse_addr; ++ u8 bank, startBank; ++ u8 hoffset = 0, hworden = 0; ++ u8 efuse_data, word_cnts = 0; ++ u16 retU2 = 0; ++ u8 bContinual = _TRUE; ++ ++ ++ if (bPseudoTest) { ++#ifdef HAL_EFUSE_MEMORY ++ btusedbytes = pEfuseHal->fakeBTEfuseUsedBytes; ++#else ++ btusedbytes = fakeBTEfuseUsedBytes; ++#endif ++ } else { ++ btusedbytes = 0; ++ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BT_BYTES, (u8 *)&btusedbytes); ++ } ++ efuse_addr = (u16)((btusedbytes % EFUSE_BT_REAL_BANK_CONTENT_LEN)); ++ startBank = (u8)(1 + (btusedbytes / EFUSE_BT_REAL_BANK_CONTENT_LEN)); ++ ++ RTW_INFO("%s: start from bank=%d addr=0x%X\n", __FUNCTION__, startBank, efuse_addr); ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_BANK, &retU2, bPseudoTest); ++ ++ for (bank = startBank; bank < 3; bank++) { ++ if (hal_EfuseSwitchToBank(padapter, bank, bPseudoTest) == _FALSE) { ++ RTW_INFO(KERN_ERR "%s: switch bank(%d) Fail!!\n", __FUNCTION__, bank); ++ /* bank = EFUSE_MAX_BANK; */ ++ break; ++ } ++ ++ /* only when bank is switched we have to reset the efuse_addr. */ ++ if (bank != startBank) ++ efuse_addr = 0; ++#if 1 ++ ++ while (AVAILABLE_EFUSE_ADDR(efuse_addr)) { ++ if (efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest) == _FALSE) { ++ RTW_INFO(KERN_ERR "%s: efuse_OneByteRead Fail! addr=0x%X !!\n", __FUNCTION__, efuse_addr); ++ /* bank = EFUSE_MAX_BANK; */ ++ break; ++ } ++ RTW_INFO("%s: efuse_OneByteRead ! addr=0x%X !efuse_data=0x%X! bank =%d\n", __FUNCTION__, efuse_addr, efuse_data, bank); ++ ++ if (efuse_data == 0xFF) ++ break; ++ ++ if (EXT_HEADER(efuse_data)) { ++ hoffset = GET_HDR_OFFSET_2_0(efuse_data); ++ efuse_addr++; ++ efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest); ++ RTW_INFO("%s: efuse_OneByteRead EXT_HEADER ! addr=0x%X !efuse_data=0x%X! bank =%d\n", __FUNCTION__, efuse_addr, efuse_data, bank); ++ ++ if (ALL_WORDS_DISABLED(efuse_data)) { ++ efuse_addr++; ++ continue; ++ } ++ ++ /* hoffset = ((hoffset & 0xE0) >> 5) | ((efuse_data & 0xF0) >> 1); */ ++ hoffset |= ((efuse_data & 0xF0) >> 1); ++ hworden = efuse_data & 0x0F; ++ } else { ++ hoffset = (efuse_data >> 4) & 0x0F; ++ hworden = efuse_data & 0x0F; ++ } ++ ++ RTW_INFO(FUNC_ADPT_FMT": Offset=%d Worden=%#X\n", ++ FUNC_ADPT_ARG(padapter), hoffset, hworden); ++ ++ word_cnts = Efuse_CalculateWordCnts(hworden); ++ /* read next header */ ++ efuse_addr += (word_cnts * 2) + 1; ++ } ++#else ++ while (bContinual && ++ efuse_OneByteRead(padapter, efuse_addr , &efuse_data, bPseudoTest) && ++ AVAILABLE_EFUSE_ADDR(efuse_addr)) { ++ if (efuse_data != 0xFF) { ++ if ((efuse_data & 0x1F) == 0x0F) { /* extended header */ ++ hoffset = efuse_data; ++ efuse_addr++; ++ efuse_OneByteRead(padapter, efuse_addr , &efuse_data, bPseudoTest); ++ if ((efuse_data & 0x0F) == 0x0F) { ++ efuse_addr++; ++ continue; ++ } else { ++ hoffset = ((hoffset & 0xE0) >> 5) | ((efuse_data & 0xF0) >> 1); ++ hworden = efuse_data & 0x0F; ++ } ++ } else { ++ hoffset = (efuse_data >> 4) & 0x0F; ++ hworden = efuse_data & 0x0F; ++ } ++ word_cnts = Efuse_CalculateWordCnts(hworden); ++ /* read next header */ ++ efuse_addr = efuse_addr + (word_cnts * 2) + 1; ++ } else ++ bContinual = _FALSE; ++ } ++#endif ++ ++ ++ /* Check if we need to check next bank efuse */ ++ if (efuse_addr < retU2) ++ break;/* don't need to check next bank. */ ++ } ++#if 0 ++ retU2 = ((bank - 1) * EFUSE_BT_REAL_BANK_CONTENT_LEN) + efuse_addr; ++ if (bPseudoTest) { ++#ifdef HAL_EFUSE_MEMORY ++ pEfuseHal->fakeBTEfuseUsedBytes = retU2; ++#else ++ fakeBTEfuseUsedBytes = retU2; ++#endif ++ } else ++ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BT_BYTES, (u8 *)&retU2); ++#else ++ retU2 = ((bank - 1) * EFUSE_BT_REAL_BANK_CONTENT_LEN) + efuse_addr; ++ if (bPseudoTest) { ++ pEfuseHal->fakeBTEfuseUsedBytes = retU2; ++ /* RT_DISP(FEEPROM, EFUSE_PG, ("Hal_EfuseGetCurrentSize_BT92C(), already use %u bytes\n", pEfuseHal->fakeBTEfuseUsedBytes)); */ ++ } else { ++ pEfuseHal->BTEfuseUsedBytes = retU2; ++ /* RT_DISP(FEEPROM, EFUSE_PG, ("Hal_EfuseGetCurrentSize_BT92C(), already use %u bytes\n", pEfuseHal->BTEfuseUsedBytes)); */ ++ } ++#endif ++ ++ RTW_INFO("%s: CurrentSize=%d\n", __FUNCTION__, retU2); ++ return retU2; ++} ++ ++static u16 ++Hal_EfuseGetCurrentSize( ++ PADAPTER pAdapter, ++ u8 efuseType, ++ u8 bPseudoTest) ++{ ++ u16 ret = 0; ++ ++ if (efuseType == EFUSE_WIFI) ++ ret = hal_EfuseGetCurrentSize_WiFi(pAdapter, bPseudoTest); ++ else ++ ret = hal_EfuseGetCurrentSize_BT(pAdapter, bPseudoTest); ++ ++ return ret; ++} ++ ++static u8 ++Hal_EfuseWordEnableDataWrite( ++ PADAPTER padapter, ++ u16 efuse_addr, ++ u8 word_en, ++ u8 *data, ++ u8 bPseudoTest) ++{ ++ u16 tmpaddr = 0; ++ u16 start_addr = efuse_addr; ++ u8 badworden = 0x0F; ++ u8 tmpdata[PGPKT_DATA_SIZE]; ++ ++ ++ /* RTW_INFO("%s: efuse_addr=%#x word_en=%#x\n", __FUNCTION__, efuse_addr, word_en); */ ++ _rtw_memset(tmpdata, 0xFF, PGPKT_DATA_SIZE); ++ ++ if (!(word_en & BIT(0))) { ++ tmpaddr = start_addr; ++ efuse_OneByteWrite(padapter, start_addr++, data[0], bPseudoTest); ++ efuse_OneByteWrite(padapter, start_addr++, data[1], bPseudoTest); ++ ++ efuse_OneByteRead(padapter, tmpaddr, &tmpdata[0], bPseudoTest); ++ efuse_OneByteRead(padapter, tmpaddr + 1, &tmpdata[1], bPseudoTest); ++ if ((data[0] != tmpdata[0]) || (data[1] != tmpdata[1])) ++ badworden &= (~BIT(0)); ++ } ++ if (!(word_en & BIT(1))) { ++ tmpaddr = start_addr; ++ efuse_OneByteWrite(padapter, start_addr++, data[2], bPseudoTest); ++ efuse_OneByteWrite(padapter, start_addr++, data[3], bPseudoTest); ++ ++ efuse_OneByteRead(padapter, tmpaddr, &tmpdata[2], bPseudoTest); ++ efuse_OneByteRead(padapter, tmpaddr + 1, &tmpdata[3], bPseudoTest); ++ if ((data[2] != tmpdata[2]) || (data[3] != tmpdata[3])) ++ badworden &= (~BIT(1)); ++ } ++ if (!(word_en & BIT(2))) { ++ tmpaddr = start_addr; ++ efuse_OneByteWrite(padapter, start_addr++, data[4], bPseudoTest); ++ efuse_OneByteWrite(padapter, start_addr++, data[5], bPseudoTest); ++ ++ efuse_OneByteRead(padapter, tmpaddr, &tmpdata[4], bPseudoTest); ++ efuse_OneByteRead(padapter, tmpaddr + 1, &tmpdata[5], bPseudoTest); ++ if ((data[4] != tmpdata[4]) || (data[5] != tmpdata[5])) ++ badworden &= (~BIT(2)); ++ } ++ if (!(word_en & BIT(3))) { ++ tmpaddr = start_addr; ++ efuse_OneByteWrite(padapter, start_addr++, data[6], bPseudoTest); ++ efuse_OneByteWrite(padapter, start_addr++, data[7], bPseudoTest); ++ ++ efuse_OneByteRead(padapter, tmpaddr, &tmpdata[6], bPseudoTest); ++ efuse_OneByteRead(padapter, tmpaddr + 1, &tmpdata[7], bPseudoTest); ++ if ((data[6] != tmpdata[6]) || (data[7] != tmpdata[7])) ++ badworden &= (~BIT(3)); ++ } ++ ++ return badworden; ++} ++ ++static s32 ++Hal_EfusePgPacketRead( ++ PADAPTER padapter, ++ u8 offset, ++ u8 *data, ++ u8 bPseudoTest) ++{ ++ u8 bDataEmpty = _TRUE; ++ u8 efuse_data, word_cnts = 0; ++ u16 efuse_addr = 0; ++ u8 hoffset = 0, hworden = 0; ++ u8 i; ++ u8 max_section = 0; ++ s32 ret; ++ ++ ++ if (data == NULL) ++ return _FALSE; ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAX_SECTION, &max_section, bPseudoTest); ++ if (offset > max_section) { ++ RTW_INFO("%s: Packet offset(%d) is illegal(>%d)!\n", __FUNCTION__, offset, max_section); ++ return _FALSE; ++ } ++ ++ _rtw_memset(data, 0xFF, PGPKT_DATA_SIZE); ++ ret = _TRUE; ++ ++ /* */ ++ /* Efuse has been pre-programmed dummy 5Bytes at the end of Efuse by CP. */ ++ /* Skip dummy parts to prevent unexpected data read from Efuse. */ ++ /* By pass right now. 2009.02.19. */ ++ /* */ ++ while (AVAILABLE_EFUSE_ADDR(efuse_addr)) { ++ if (efuse_OneByteRead(padapter, efuse_addr++, &efuse_data, bPseudoTest) == _FALSE) { ++ ret = _FALSE; ++ break; ++ } ++ ++ if (efuse_data == 0xFF) ++ break; ++ ++ if (EXT_HEADER(efuse_data)) { ++ hoffset = GET_HDR_OFFSET_2_0(efuse_data); ++ efuse_OneByteRead(padapter, efuse_addr++, &efuse_data, bPseudoTest); ++ if (ALL_WORDS_DISABLED(efuse_data)) { ++ RTW_INFO("%s: Error!! All words disabled!\n", __FUNCTION__); ++ continue; ++ } ++ ++ hoffset |= ((efuse_data & 0xF0) >> 1); ++ hworden = efuse_data & 0x0F; ++ } else { ++ hoffset = (efuse_data >> 4) & 0x0F; ++ hworden = efuse_data & 0x0F; ++ } ++ ++ if (hoffset == offset) { ++ for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { ++ /* Check word enable condition in the section */ ++ if (!(hworden & (0x01 << i))) { ++ /* ReadEFuseByte(padapter, efuse_addr++, &efuse_data, bPseudoTest); */ ++ efuse_OneByteRead(padapter, efuse_addr++, &efuse_data, bPseudoTest); ++ /* RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, efuse_addr+tmpidx, efuse_data); */ ++ data[i * 2] = efuse_data; ++ ++ /* ReadEFuseByte(padapter, efuse_addr++, &efuse_data, bPseudoTest); */ ++ efuse_OneByteRead(padapter, efuse_addr++, &efuse_data, bPseudoTest); ++ /* RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, efuse_addr+tmpidx, efuse_data); */ ++ data[(i * 2) + 1] = efuse_data; ++ } ++ } ++ } else { ++ word_cnts = Efuse_CalculateWordCnts(hworden); ++ efuse_addr += word_cnts * 2; ++ } ++ } ++ ++ return ret; ++} ++ ++static u8 ++hal_EfusePgCheckAvailableAddr( ++ PADAPTER pAdapter, ++ u8 efuseType, ++ u8 bPseudoTest) ++{ ++ u16 max_available = 0; ++ u16 current_size; ++ ++ ++ EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &max_available, bPseudoTest); ++ /* RTW_INFO("%s: max_available=%d\n", __FUNCTION__, max_available); */ ++ ++ current_size = Efuse_GetCurrentSize(pAdapter, efuseType, bPseudoTest); ++ if (current_size >= max_available) { ++ RTW_INFO("%s: Error!! current_size(%d)>max_available(%d)\n", __FUNCTION__, current_size, max_available); ++ return _FALSE; ++ } ++ return _TRUE; ++} ++ ++static void ++hal_EfuseConstructPGPkt( ++ u8 offset, ++ u8 word_en, ++ u8 *pData, ++ PPGPKT_STRUCT pTargetPkt) ++{ ++ _rtw_memset(pTargetPkt->data, 0xFF, PGPKT_DATA_SIZE); ++ pTargetPkt->offset = offset; ++ pTargetPkt->word_en = word_en; ++ efuse_WordEnableDataRead(word_en, pData, pTargetPkt->data); ++ pTargetPkt->word_cnts = Efuse_CalculateWordCnts(pTargetPkt->word_en); ++} ++ ++#if 0 ++static u8 ++wordEnMatched( ++ PPGPKT_STRUCT pTargetPkt, ++ PPGPKT_STRUCT pCurPkt, ++ u8 *pWden) ++{ ++ u8 match_word_en = 0x0F; /* default all words are disabled */ ++ u8 i; ++ ++ /* check if the same words are enabled both target and current PG packet */ ++ if (((pTargetPkt->word_en & BIT(0)) == 0) && ++ ((pCurPkt->word_en & BIT(0)) == 0)) { ++ match_word_en &= ~BIT(0); /* enable word 0 */ ++ } ++ if (((pTargetPkt->word_en & BIT(1)) == 0) && ++ ((pCurPkt->word_en & BIT(1)) == 0)) { ++ match_word_en &= ~BIT(1); /* enable word 1 */ ++ } ++ if (((pTargetPkt->word_en & BIT(2)) == 0) && ++ ((pCurPkt->word_en & BIT(2)) == 0)) { ++ match_word_en &= ~BIT(2); /* enable word 2 */ ++ } ++ if (((pTargetPkt->word_en & BIT(3)) == 0) && ++ ((pCurPkt->word_en & BIT(3)) == 0)) { ++ match_word_en &= ~BIT(3); /* enable word 3 */ ++ } ++ ++ *pWden = match_word_en; ++ ++ if (match_word_en != 0xf) ++ return _TRUE; ++ else ++ return _FALSE; ++} ++ ++static u8 ++hal_EfuseCheckIfDatafollowed( ++ PADAPTER pAdapter, ++ u8 word_cnts, ++ u16 startAddr, ++ u8 bPseudoTest) ++{ ++ u8 bRet = _FALSE; ++ u8 i, efuse_data; ++ ++ for (i = 0; i < (word_cnts * 2); i++) { ++ if (efuse_OneByteRead(pAdapter, (startAddr + i) , &efuse_data, bPseudoTest) == _FALSE) { ++ RTW_INFO("%s: efuse_OneByteRead FAIL!!\n", __FUNCTION__); ++ bRet = _TRUE; ++ break; ++ } ++ ++ if (efuse_data != 0xFF) { ++ bRet = _TRUE; ++ break; ++ } ++ } ++ ++ return bRet; ++} ++#endif ++ ++static u8 ++hal_EfusePartialWriteCheck( ++ PADAPTER padapter, ++ u8 efuseType, ++ u16 *pAddr, ++ PPGPKT_STRUCT pTargetPkt, ++ u8 bPseudoTest) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; ++ u8 bRet = _FALSE; ++ u16 startAddr = 0, efuse_max_available_len = 0, efuse_max = 0; ++ u8 efuse_data = 0; ++#if 0 ++ u8 i, cur_header = 0; ++ u8 new_wden = 0, matched_wden = 0, badworden = 0; ++ PGPKT_STRUCT curPkt; ++#endif ++ ++ ++ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &efuse_max_available_len, bPseudoTest); ++ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_CONTENT_LEN_BANK, &efuse_max, bPseudoTest); ++ ++ if (efuseType == EFUSE_WIFI) { ++ if (bPseudoTest) { ++#ifdef HAL_EFUSE_MEMORY ++ startAddr = (u16)pEfuseHal->fakeEfuseUsedBytes; ++#else ++ startAddr = (u16)fakeEfuseUsedBytes; ++#endif ++ } else ++ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&startAddr); ++ } else { ++ if (bPseudoTest) { ++#ifdef HAL_EFUSE_MEMORY ++ startAddr = (u16)pEfuseHal->fakeBTEfuseUsedBytes; ++#else ++ startAddr = (u16)fakeBTEfuseUsedBytes; ++#endif ++ } else ++ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BT_BYTES, (u8 *)&startAddr); ++ } ++ startAddr %= efuse_max; ++ RTW_INFO("%s: startAddr=%#X\n", __FUNCTION__, startAddr); ++ ++ while (1) { ++ if (startAddr >= efuse_max_available_len) { ++ bRet = _FALSE; ++ RTW_INFO("%s: startAddr(%d) >= efuse_max_available_len(%d)\n", ++ __FUNCTION__, startAddr, efuse_max_available_len); ++ break; ++ } ++ ++ if (efuse_OneByteRead(padapter, startAddr, &efuse_data, bPseudoTest) && (efuse_data != 0xFF)) { ++#if 1 ++ bRet = _FALSE; ++ RTW_INFO("%s: Something Wrong! last bytes(%#X=0x%02X) is not 0xFF\n", ++ __FUNCTION__, startAddr, efuse_data); ++ break; ++#else ++ if (EXT_HEADER(efuse_data)) { ++ cur_header = efuse_data; ++ startAddr++; ++ efuse_OneByteRead(padapter, startAddr, &efuse_data, bPseudoTest); ++ if (ALL_WORDS_DISABLED(efuse_data)) { ++ RTW_INFO("%s: Error condition, all words disabled!", __FUNCTION__); ++ bRet = _FALSE; ++ break; ++ } /*else*/ ++ { ++ curPkt.offset = ((cur_header & 0xE0) >> 5) | ((efuse_data & 0xF0) >> 1); ++ curPkt.word_en = efuse_data & 0x0F; ++ } ++ } else { ++ cur_header = efuse_data; ++ curPkt.offset = (cur_header >> 4) & 0x0F; ++ curPkt.word_en = cur_header & 0x0F; ++ } ++ ++ curPkt.word_cnts = Efuse_CalculateWordCnts(curPkt.word_en); ++ /* if same header is found but no data followed */ ++ /* write some part of data followed by the header. */ ++ if ((curPkt.offset == pTargetPkt->offset) && ++ (hal_EfuseCheckIfDatafollowed(padapter, curPkt.word_cnts, startAddr + 1, bPseudoTest) == _FALSE) && ++ wordEnMatched(pTargetPkt, &curPkt, &matched_wden) == _TRUE) { ++ RTW_INFO("%s: Need to partial write data by the previous wrote header\n", __FUNCTION__); ++ /* Here to write partial data */ ++ badworden = Efuse_WordEnableDataWrite(padapter, startAddr + 1, matched_wden, pTargetPkt->data, bPseudoTest); ++ if (badworden != 0x0F) { ++ u32 PgWriteSuccess = 0; ++ /* if write fail on some words, write these bad words again */ ++ if (efuseType == EFUSE_WIFI) ++ PgWriteSuccess = Efuse_PgPacketWrite(padapter, pTargetPkt->offset, badworden, pTargetPkt->data, bPseudoTest); ++ else ++ PgWriteSuccess = Efuse_PgPacketWrite_BT(padapter, pTargetPkt->offset, badworden, pTargetPkt->data, bPseudoTest); ++ ++ if (!PgWriteSuccess) { ++ bRet = _FALSE; /* write fail, return */ ++ break; ++ } ++ } ++ /* partial write ok, update the target packet for later use */ ++ for (i = 0; i < 4; i++) { ++ if ((matched_wden & (0x1 << i)) == 0) { /* this word has been written */ ++ pTargetPkt->word_en |= (0x1 << i); /* disable the word */ ++ } ++ } ++ pTargetPkt->word_cnts = Efuse_CalculateWordCnts(pTargetPkt->word_en); ++ } ++ /* read from next header */ ++ startAddr = startAddr + (curPkt.word_cnts * 2) + 1; ++#endif ++ } else { ++ /* not used header, 0xff */ ++ *pAddr = startAddr; ++ /* RTW_INFO("%s: Started from unused header offset=%d\n", __FUNCTION__, startAddr)); */ ++ bRet = _TRUE; ++ break; ++ } ++ } ++ ++ return bRet; ++} ++ ++static u8 ++hal_EfusePgPacketWrite1ByteHeader( ++ PADAPTER pAdapter, ++ u8 efuseType, ++ u16 *pAddr, ++ PPGPKT_STRUCT pTargetPkt, ++ u8 bPseudoTest) ++{ ++ u8 bRet = _FALSE; ++ u8 pg_header = 0, tmp_header = 0; ++ u16 efuse_addr = *pAddr; ++ u8 repeatcnt = 0; ++ ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ pg_header = ((pTargetPkt->offset << 4) & 0xf0) | pTargetPkt->word_en; ++ ++ do { ++ efuse_OneByteWrite(pAdapter, efuse_addr, pg_header, bPseudoTest); ++ efuse_OneByteRead(pAdapter, efuse_addr, &tmp_header, bPseudoTest); ++ if (tmp_header != 0xFF) ++ break; ++ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { ++ RTW_INFO("%s: Repeat over limit for pg_header!!\n", __FUNCTION__); ++ return _FALSE; ++ } ++ } while (1); ++ ++ if (tmp_header != pg_header) { ++ RTW_INFO(KERN_ERR "%s: PG Header Fail!!(pg=0x%02X read=0x%02X)\n", __FUNCTION__, pg_header, tmp_header); ++ return _FALSE; ++ } ++ ++ *pAddr = efuse_addr; ++ ++ return _TRUE; ++} ++ ++static u8 ++hal_EfusePgPacketWrite2ByteHeader( ++ PADAPTER padapter, ++ u8 efuseType, ++ u16 *pAddr, ++ PPGPKT_STRUCT pTargetPkt, ++ u8 bPseudoTest) ++{ ++ u16 efuse_addr, efuse_max_available_len = 0; ++ u8 pg_header = 0, tmp_header = 0; ++ u8 repeatcnt = 0; ++ ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_BANK, &efuse_max_available_len, bPseudoTest); ++ ++ efuse_addr = *pAddr; ++ if (efuse_addr >= efuse_max_available_len) { ++ RTW_INFO("%s: addr(%d) over available(%d)!!\n", __FUNCTION__, efuse_addr, efuse_max_available_len); ++ return _FALSE; ++ } ++ ++ pg_header = ((pTargetPkt->offset & 0x07) << 5) | 0x0F; ++ /* RTW_INFO("%s: pg_header=0x%x\n", __FUNCTION__, pg_header); */ ++ ++ do { ++ efuse_OneByteWrite(padapter, efuse_addr, pg_header, bPseudoTest); ++ efuse_OneByteRead(padapter, efuse_addr, &tmp_header, bPseudoTest); ++ if (tmp_header != 0xFF) ++ break; ++ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { ++ RTW_INFO("%s: Repeat over limit for pg_header!!\n", __FUNCTION__); ++ return _FALSE; ++ } ++ } while (1); ++ ++ if (tmp_header != pg_header) { ++ RTW_INFO(KERN_ERR "%s: PG Header Fail!!(pg=0x%02X read=0x%02X)\n", __FUNCTION__, pg_header, tmp_header); ++ return _FALSE; ++ } ++ ++ /* to write ext_header */ ++ efuse_addr++; ++ pg_header = ((pTargetPkt->offset & 0x78) << 1) | pTargetPkt->word_en; ++ ++ do { ++ efuse_OneByteWrite(padapter, efuse_addr, pg_header, bPseudoTest); ++ efuse_OneByteRead(padapter, efuse_addr, &tmp_header, bPseudoTest); ++ if (tmp_header != 0xFF) ++ break; ++ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { ++ RTW_INFO("%s: Repeat over limit for ext_header!!\n", __FUNCTION__); ++ return _FALSE; ++ } ++ } while (1); ++ ++ if (tmp_header != pg_header) { /* offset PG fail */ ++ RTW_INFO(KERN_ERR "%s: PG EXT Header Fail!!(pg=0x%02X read=0x%02X)\n", __FUNCTION__, pg_header, tmp_header); ++ return _FALSE; ++ } ++ ++ *pAddr = efuse_addr; ++ ++ return _TRUE; ++} ++ ++static u8 ++hal_EfusePgPacketWriteHeader( ++ PADAPTER padapter, ++ u8 efuseType, ++ u16 *pAddr, ++ PPGPKT_STRUCT pTargetPkt, ++ u8 bPseudoTest) ++{ ++ u8 bRet = _FALSE; ++ ++ if (pTargetPkt->offset >= EFUSE_MAX_SECTION_BASE) ++ bRet = hal_EfusePgPacketWrite2ByteHeader(padapter, efuseType, pAddr, pTargetPkt, bPseudoTest); ++ else ++ bRet = hal_EfusePgPacketWrite1ByteHeader(padapter, efuseType, pAddr, pTargetPkt, bPseudoTest); ++ ++ return bRet; ++} ++ ++static u8 ++hal_EfusePgPacketWriteData( ++ PADAPTER pAdapter, ++ u8 efuseType, ++ u16 *pAddr, ++ PPGPKT_STRUCT pTargetPkt, ++ u8 bPseudoTest) ++{ ++ u16 efuse_addr; ++ u8 badworden; ++ ++ ++ efuse_addr = *pAddr; ++ badworden = Efuse_WordEnableDataWrite(pAdapter, efuse_addr + 1, pTargetPkt->word_en, pTargetPkt->data, bPseudoTest); ++ if (badworden != 0x0F) { ++ RTW_INFO("%s: Fail!!\n", __FUNCTION__); ++ return _FALSE; ++ } ++ ++ /* RTW_INFO("%s: ok\n", __FUNCTION__); */ ++ return _TRUE; ++} ++ ++static s32 ++Hal_EfusePgPacketWrite( ++ PADAPTER padapter, ++ u8 offset, ++ u8 word_en, ++ u8 *pData, ++ u8 bPseudoTest) ++{ ++ PGPKT_STRUCT targetPkt; ++ u16 startAddr = 0; ++ u8 efuseType = EFUSE_WIFI; ++ ++ if (!hal_EfusePgCheckAvailableAddr(padapter, efuseType, bPseudoTest)) ++ return _FALSE; ++ ++ hal_EfuseConstructPGPkt(offset, word_en, pData, &targetPkt); ++ ++ if (!hal_EfusePartialWriteCheck(padapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) ++ return _FALSE; ++ ++ if (!hal_EfusePgPacketWriteHeader(padapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) ++ return _FALSE; ++ ++ if (!hal_EfusePgPacketWriteData(padapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) ++ return _FALSE; ++ ++ return _TRUE; ++} ++ ++static u8 ++Hal_EfusePgPacketWrite_BT( ++ PADAPTER pAdapter, ++ u8 offset, ++ u8 word_en, ++ u8 *pData, ++ u8 bPseudoTest) ++{ ++ PGPKT_STRUCT targetPkt; ++ u16 startAddr = 0; ++ u8 efuseType = EFUSE_BT; ++ ++ if (!hal_EfusePgCheckAvailableAddr(pAdapter, efuseType, bPseudoTest)) ++ return _FALSE; ++ ++ hal_EfuseConstructPGPkt(offset, word_en, pData, &targetPkt); ++ ++ if (!hal_EfusePartialWriteCheck(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) ++ return _FALSE; ++ ++ if (!hal_EfusePgPacketWriteHeader(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) ++ return _FALSE; ++ ++ if (!hal_EfusePgPacketWriteData(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) ++ return _FALSE; ++ ++ return _TRUE; ++} ++ ++ ++static void read_chip_version_8723d(PADAPTER padapter) ++{ ++ u32 value32; ++ HAL_DATA_TYPE *pHalData; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ ++ value32 = rtw_read32(padapter, REG_SYS_CFG); ++ pHalData->VersionID.ICType = CHIP_8723D; ++ pHalData->VersionID.ChipType = ((value32 & RTL_ID) ? TEST_CHIP : NORMAL_CHIP); ++ pHalData->VersionID.RFType = RF_TYPE_1T1R; ++ pHalData->VersionID.VendorType = ((value32 & VENDOR_ID) ? CHIP_VENDOR_UMC : CHIP_VENDOR_TSMC); ++ pHalData->VersionID.CUTVersion = (value32 & CHIP_VER_RTL_MASK) >> CHIP_VER_RTL_SHIFT; /* IC version (CUT) */ ++ ++ /* For regulator mode. by tynli. 2011.01.14 */ ++ pHalData->RegulatorMode = ((value32 & SPS_SEL) ? RT_LDO_REGULATOR : RT_SWITCHING_REGULATOR); ++ ++ value32 = rtw_read32(padapter, REG_GPIO_OUTSTS); ++ pHalData->VersionID.ROMVer = ((value32 & RF_RL_ID) >> 20); /* ROM code version. */ ++ ++ /* For multi-function consideration. Added by Roger, 2010.10.06. */ ++ pHalData->MultiFunc = RT_MULTI_FUNC_NONE; ++ value32 = rtw_read32(padapter, REG_MULTI_FUNC_CTRL); ++ pHalData->MultiFunc |= ((value32 & WL_FUNC_EN) ? RT_MULTI_FUNC_WIFI : 0); ++ pHalData->MultiFunc |= ((value32 & BT_FUNC_EN) ? RT_MULTI_FUNC_BT : 0); ++ pHalData->MultiFunc |= ((value32 & GPS_FUNC_EN) ? RT_MULTI_FUNC_GPS : 0); ++ pHalData->PolarityCtl = ((value32 & WL_HWPDN_SL) ? RT_POLARITY_HIGH_ACT : RT_POLARITY_LOW_ACT); ++ ++ rtw_hal_config_rftype(padapter); ++ ++ /* ++ if( IS_B_CUT(pHalData->VersionID) || IS_C_CUT(pHalData->VersionID)) ++ { ++ RTW_INFO(" IS_B/C_CUT SWR up 1 level !!!!!!!!!!!!!!!!!\n"); ++ PHY_SetMacReg(padapter, 0x14, BIT(23)|BIT(22)|BIT(21)|BIT(20), 0x5); ++ }else if ( IS_D_CUT(pHalData->VersionID)) ++ { ++ RTW_INFO(" IS_D_CUT SKIP SWR !!!!!!!!!!!!!!!!!\n"); ++ } ++ */ ++ ++#if 1 ++ dump_chip_info(pHalData->VersionID); ++#endif ++ ++} ++ ++ ++void rtl8723d_InitBeaconParameters(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ u16 val16; ++ u8 val8; ++ ++ ++ val8 = DIS_TSF_UDT; ++ val16 = val8 | (val8 << 8); /* port0 and port1 */ ++#ifdef CONFIG_BT_COEXIST ++ /* Enable prot0 beacon function for PSTDMA */ ++ val16 |= EN_BCN_FUNCTION; ++#endif ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ val16 |= (EN_BCN_FUNCTION << 8); ++#endif ++ rtw_write16(padapter, REG_BCN_CTRL, val16); ++ ++ /* TODO: Remove these magic number */ ++ rtw_write16(padapter, REG_TBTT_PROHIBIT, 0x6404);/* ms */ ++ /* Firmware will control REG_DRVERLYINT when power saving is enable, */ ++ /* so don't set this register on STA mode. */ ++ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) == _FALSE) ++ rtw_write8(padapter, REG_DRVERLYINT, DRIVER_EARLY_INT_TIME_8723D); /* 5ms */ ++ rtw_write8(padapter, REG_BCNDMATIM, BCN_DMA_ATIME_INT_TIME_8723D); /* 2ms */ ++ ++ /* Suggested by designer timchen. Change beacon AIFS to the largest number */ ++ /* beacause test chip does not contension before sending beacon. by tynli. 2009.11.03 */ ++ rtw_write16(padapter, REG_BCNTCFG, 0x660F); ++ ++ pHalData->RegBcnCtrlVal = rtw_read8(padapter, REG_BCN_CTRL); ++ pHalData->RegTxPause = rtw_read8(padapter, REG_TXPAUSE); ++ pHalData->RegFwHwTxQCtrl = rtw_read8(padapter, REG_FWHW_TXQ_CTRL + 2); ++ pHalData->RegReg542 = rtw_read8(padapter, REG_TBTT_PROHIBIT + 2); ++ pHalData->RegCR_1 = rtw_read8(padapter, REG_CR + 1); ++} ++ ++void rtl8723d_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode) ++{ ++#ifdef CONFIG_ADHOC_WORKAROUND_SETTING ++ rtw_write8(padapter, REG_BCN_MAX_ERR, 0xFF); ++#else ++ /* rtw_write8(Adapter, REG_BCN_MAX_ERR, (InfraMode ? 0xFF : 0x10)); */ ++#endif ++} ++ ++void _InitBurstPktLen_8723DS(PADAPTER Adapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ //rtw_write8(Adapter, 0x4c7, rtw_read8(Adapter, 0x4c7) | BIT(7)); /* enable single pkt ampdu */ ++ rtw_write8(Adapter, REG_RX_PKT_LIMIT_8723D, 0x18); /* for VHT packet length 11K */ ++ rtw_write16(Adapter, REG_MAX_AGGR_NUM_8723D, 0x0A0A); ++ rtw_write8(Adapter, REG_PIFS_8723D, 0x00); ++ rtw_write8(Adapter, REG_FWHW_TXQ_CTRL_8723D, rtw_read8(Adapter, REG_FWHW_TXQ_CTRL) & (~BIT(7))); ++ if (pHalData->AMPDUBurstMode) ++ rtw_write8(Adapter, REG_AMPDU_BURST_MODE_8723D, 0x5F); ++ rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8723D, 0x1C); ++ ++ /* ARFB table 9 for 11ac 5G 2SS */ ++ rtw_write32(Adapter, REG_ARFR0_8723D, 0x00000010); ++ if (IS_NORMAL_CHIP(pHalData->VersionID)) ++ rtw_write32(Adapter, REG_ARFR0_8723D + 4, 0xfffff000); ++ else ++ rtw_write32(Adapter, REG_ARFR0_8723D + 4, 0x3e0ff000); ++ ++ /* ARFB table 10 for 11ac 5G 1SS */ ++ rtw_write32(Adapter, REG_ARFR1_8723D, 0x00000010); ++ rtw_write32(Adapter, REG_ARFR1_8723D + 4, 0x003ff000); ++} ++ ++void _InitLTECoex_8723DS(PADAPTER Adapter) ++{ ++ /* LTE COEX setting */ ++ rtw_write16(Adapter, REG_LTECOEX_WRITE_DATA, 0x7700); ++ rtw_write32(Adapter, REG_LTECOEX_CTRL, 0xc0020038); ++ rtw_write8(Adapter, 0x73, 0x04); ++} ++ ++void _InitMacAPLLSetting_8723D(PADAPTER Adapter) ++{ ++ u16 RegValue; ++ ++ RegValue = rtw_read16(Adapter, REG_AFE_CTRL_4_8723D); ++ RegValue |= BIT(4); ++ RegValue |= BIT(15); ++ rtw_write16(Adapter, REG_AFE_CTRL_4_8723D, RegValue); ++} ++ ++static void _BeaconFunctionEnable(PADAPTER padapter, u8 Enable, u8 Linked) ++{ ++ rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); ++ rtw_write8(padapter, REG_RD_CTRL + 1, 0x6F); ++} ++ ++static void rtl8723d_SetBeaconRelatedRegisters(PADAPTER padapter) ++{ ++ u8 val8; ++ u32 value32; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; ++ u32 bcn_ctrl_reg; ++ ++ /* reset TSF, enable update TSF, correcting TSF On Beacon */ ++ ++ /* REG_BCN_INTERVAL */ ++ /* REG_BCNDMATIM */ ++ /* REG_ATIMWND */ ++ /* REG_TBTT_PROHIBIT */ ++ /* REG_DRVERLYINT */ ++ /* REG_BCN_MAX_ERR */ ++ /* REG_BCNTCFG //(0x510) */ ++ /* REG_DUAL_TSF_RST */ ++ /* REG_BCN_CTRL //(0x550) */ ++ ++ ++ bcn_ctrl_reg = REG_BCN_CTRL; ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->hw_port == HW_PORT1) ++ bcn_ctrl_reg = REG_BCN_CTRL_1; ++#endif ++ ++ /* */ ++ /* ATIM window */ ++ /* */ ++ rtw_write16(padapter, REG_ATIMWND, 2); ++ ++ /* */ ++ /* Beacon interval (in unit of TU). */ ++ /* */ ++ rtw_write16(padapter, REG_BCN_INTERVAL, pmlmeinfo->bcn_interval); ++ ++ rtl8723d_InitBeaconParameters(padapter); ++ ++ rtw_write8(padapter, REG_SLOT, 0x09); ++ ++ /* */ ++ /* Reset TSF Timer to zero, added by Roger. 2008.06.24 */ ++ /* */ ++ value32 = rtw_read32(padapter, REG_TCR); ++ value32 &= ~TSFRST; ++ rtw_write32(padapter, REG_TCR, value32); ++ ++ value32 |= TSFRST; ++ rtw_write32(padapter, REG_TCR, value32); ++ ++ /* NOTE: Fix test chip's bug (about contention windows's randomness) */ ++ if (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE | WIFI_AP_STATE) == _TRUE) { ++ rtw_write8(padapter, REG_RXTSF_OFFSET_CCK, 0x50); ++ rtw_write8(padapter, REG_RXTSF_OFFSET_OFDM, 0x50); ++ } ++ ++ _BeaconFunctionEnable(padapter, _TRUE, _TRUE); ++ ++ ResumeTxBeacon(padapter); ++ val8 = rtw_read8(padapter, bcn_ctrl_reg); ++ val8 |= DIS_BCNQ_SUB; ++ rtw_write8(padapter, bcn_ctrl_reg, val8); ++} ++ ++void hal_notch_filter_8723d(_adapter *adapter, bool enable) ++{ ++ if (enable) { ++ RTW_INFO("Enable notch filter\n"); ++ rtw_write8(adapter, rOFDM0_RxDSP + 1, rtw_read8(adapter, rOFDM0_RxDSP + 1) | BIT(1)); ++ } else { ++ RTW_INFO("Disable notch filter\n"); ++ rtw_write8(adapter, rOFDM0_RxDSP + 1, rtw_read8(adapter, rOFDM0_RxDSP + 1) & ~BIT(1)); ++ } ++} ++ ++u8 rtl8723d_MRateIdxToARFRId(PADAPTER padapter, u8 rate_idx) ++{ ++ u8 ret = 0; ++ RT_RF_TYPE_DEF_E rftype = (RT_RF_TYPE_DEF_E)GET_RF_TYPE(padapter); ++ ++ switch (rate_idx) { ++ ++ case RATR_INX_WIRELESS_NGB: ++ if (rftype == RF_1T1R) ++ ret = 1; ++ else ++ ret = 0; ++ break; ++ ++ case RATR_INX_WIRELESS_N: ++ case RATR_INX_WIRELESS_NG: ++ if (rftype == RF_1T1R) ++ ret = 5; ++ else ++ ret = 4; ++ break; ++ ++ case RATR_INX_WIRELESS_NB: ++ if (rftype == RF_1T1R) ++ ret = 3; ++ else ++ ret = 2; ++ break; ++ ++ case RATR_INX_WIRELESS_GB: ++ ret = 6; ++ break; ++ ++ case RATR_INX_WIRELESS_G: ++ ret = 7; ++ break; ++ ++ case RATR_INX_WIRELESS_B: ++ ret = 8; ++ break; ++ ++ case RATR_INX_WIRELESS_MC: ++ if (padapter->mlmeextpriv.cur_wireless_mode & WIRELESS_11BG_24N) ++ ret = 6; ++ else ++ ret = 7; ++ break; ++ case RATR_INX_WIRELESS_AC_N: ++ if (rftype == RF_1T1R) /* || padapter->MgntInfo.VHTHighestOperaRate <= MGN_VHT1SS_MCS9) */ ++ ret = 10; ++ else ++ ret = 9; ++ break; ++ ++ default: ++ ret = 0; ++ break; ++ } ++ ++ return ret; ++} ++ ++void UpdateHalRAMask8723D(PADAPTER padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level) ++{ ++ u32 mask, rate_bitmap = 0, ratr_bitmap_msb = 0; ++ u8 disable_cck_rate = FALSE, MimoPs_enable = FALSE; ++ u8 shortGIrate = _FALSE; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ u8 bw; ++ ++ if (psta == NULL) { ++ RTW_PRINT(FUNC_ADPT_FMT" macid:%u, sta is NULL\n", ++ FUNC_ADPT_ARG(padapter), mac_id); ++ return; ++ } ++ ++ bw = rtw_get_tx_bw_mode(padapter, psta); ++ shortGIrate = query_ra_short_GI(psta, bw); ++ ++ mask = psta->ra_mask; ++ ++#if 1 ++ phydm_UpdateHalRAMask(&pHalData->odmpriv, psta->wireless_mode, pHalData->rf_type, bw, MimoPs_enable, disable_cck_rate, &ratr_bitmap_msb, &mask, rssi_level); ++#else ++ rate_bitmap = 0xffffffff; ++ rate_bitmap = ODM_Get_Rate_Bitmap(&pHalData->odmpriv, mac_id, mask, rssi_level); ++ mask &= rate_bitmap; ++#endif ++ ++#ifdef CONFIG_BT_COEXIST ++ rate_bitmap = rtw_btcoex_GetRaMask(padapter); ++ mask &= ~rate_bitmap; ++#endif /* CONFIG_BT_COEXIST */ ++ ++#ifdef CONFIG_CMCC_TEST ++#ifdef CONFIG_BT_COEXIST ++ if (pmlmeext->cur_wireless_mode & WIRELESS_11G) { ++ if (mac_id == 0) { ++ RTW_INFO("CMCC_BT update raid entry, mask=0x%x\n", mask); ++ /* mask &=0xffffffc0; //disable CCK & <12M OFDM rate for 11G mode for CMCC */ ++ mask &= 0xffffff00; /* disable CCK & <24M OFDM rate for 11G mode for CMCC */ ++ RTW_INFO("CMCC_BT update raid entry, mask=0x%x\n", mask); ++ } ++ } ++#endif ++#endif ++ RTW_INFO("%s => mac_id:%d, networkType:0x%02x, mask:0x%08x\n\t ==> rssi_level:%d, rate_bitmap:0x%08x\n", ++ __FUNCTION__, mac_id, psta->wireless_mode, mask, rssi_level, rate_bitmap); ++ ++ if (pHalData->fw_ractrl == _TRUE) ++ rtl8723d_set_FwMacIdConfig_cmd(padapter, mac_id, psta->raid, bw, shortGIrate, mask); ++ ++ /* set correct initial date rate for each mac_id */ ++ pHalData->INIDATA_RATE[mac_id] = psta->init_rate; ++ RTW_INFO("%s(): mac_id=%d raid=0x%x bw=%d mask=0x%x init_rate=0x%x\n", __func__, mac_id, psta->raid, bw, mask, psta->init_rate); ++ ++ rtw_macid_ctl_set_bw(macid_ctl, mac_id, bw); ++ rtw_macid_ctl_set_rate_bmp0(macid_ctl, mac_id, mask); ++ rtw_update_tx_rate_bmp(adapter_to_dvobj(padapter)); ++} ++/* ++ * Description: In normal chip, we should send some packet to Hw which will be used by Fw ++ * in FW LPS mode. The function is to fill the Tx descriptor of this packets, then ++ * Fw can tell Hw to send these packet derectly. ++ * Added by tynli. 2009.10.15. ++ * ++ * type1:pspoll, type2:null */ ++void rtl8723d_fill_fake_txdesc( ++ PADAPTER padapter, ++ u8 *pDesc, ++ u32 BufferLen, ++ u8 IsPsPoll, ++ u8 IsBTQosNull, ++ u8 bDataFrame) ++{ ++ /* Clear all status */ ++ _rtw_memset(pDesc, 0, TXDESC_SIZE); ++ ++ SET_TX_DESC_OFFSET_8723D(pDesc, 0x28); /* Offset = 32 */ ++ ++ SET_TX_DESC_PKT_SIZE_8723D(pDesc, BufferLen); /* Buffer size + command header */ ++ SET_TX_DESC_QUEUE_SEL_8723D(pDesc, QSLT_MGNT); /* Fixed queue of Mgnt queue */ ++ ++ /* Set NAVUSEHDR to prevent Ps-poll AId filed to be changed to error vlaue by Hw. */ ++ if (_TRUE == IsPsPoll) ++ SET_TX_DESC_NAV_USE_HDR_8723D(pDesc, 1); ++ else { ++ SET_TX_DESC_HWSEQ_EN_8723D(pDesc, 1); /* Hw set sequence number */ ++ SET_TX_DESC_HWSEQ_SEL_8723D(pDesc, 0); ++ } ++ ++ if (_TRUE == IsBTQosNull) ++ SET_TX_DESC_BT_INT_8723D(pDesc, 1); ++ ++ SET_TX_DESC_USE_RATE_8723D(pDesc, 1); /* use data rate which is set by Sw */ ++ ++ SET_TX_DESC_TX_RATE_8723D(pDesc, DESC8723D_RATE1M); ++ ++ /* */ ++ /* Encrypt the data frame if under security mode excepct null data. Suggested by CCW. */ ++ /* */ ++ if (_TRUE == bDataFrame) { ++ u32 EncAlg; ++ ++ EncAlg = padapter->securitypriv.dot11PrivacyAlgrthm; ++ switch (EncAlg) { ++ case _NO_PRIVACY_: ++ SET_TX_DESC_SEC_TYPE_8723D(pDesc, 0x0); ++ break; ++ case _WEP40_: ++ case _WEP104_: ++ case _TKIP_: ++ SET_TX_DESC_SEC_TYPE_8723D(pDesc, 0x1); ++ break; ++ case _SMS4_: ++ SET_TX_DESC_SEC_TYPE_8723D(pDesc, 0x2); ++ break; ++ case _AES_: ++ SET_TX_DESC_SEC_TYPE_8723D(pDesc, 0x3); ++ break; ++ default: ++ SET_TX_DESC_SEC_TYPE_8723D(pDesc, 0x0); ++ break; ++ } ++ } ++ ++#if defined(CONFIG_USB_HCI) ++ /* ++ * USB interface drop packet if the checksum of descriptor isn't correct. ++ * Using this checksum can let hardware recovery from packet bulk out error (e.g. Cancel URC, Bulk out error.). ++ */ ++ rtl8723d_cal_txdesc_chksum((struct tx_desc *)pDesc); ++#endif ++} ++ ++void rtl8723d_InitAntenna_Selection(PADAPTER padapter) ++{ ++ rtw_write8(padapter, REG_LEDCFG2, 0x82); ++} ++ ++void rtl8723d_CheckAntenna_Selection(PADAPTER padapter) ++{ ++#if 0 ++ PHAL_DATA_TYPE pHalData; ++ u8 val; ++ ++ ++ pHalData = GET_HAL_DATA(padapter); ++ ++ val = rtw_read8(padapter, REG_LEDCFG2); ++ /* Let 8051 take control antenna setting */ ++ if (!(val & BIT(7))) { ++ val |= BIT(7); /* DPDT_SEL_EN, 0x4C[23] */ ++ rtw_write8(padapter, REG_LEDCFG2, val); ++ } ++#endif ++} ++void rtl8723d_DeinitAntenna_Selection(PADAPTER padapter) ++{ ++#if 0 ++ PHAL_DATA_TYPE pHalData; ++ u8 val; ++ ++ ++ pHalData = GET_HAL_DATA(padapter); ++ val = rtw_read8(padapter, REG_LEDCFG2); ++ /* Let 8051 take control antenna setting */ ++ val &= ~BIT(7); /* DPDT_SEL_EN, clear 0x4C[23] */ ++ rtw_write8(padapter, REG_LEDCFG2, val); ++#endif ++} ++ ++void init_hal_spec_8723d(_adapter *adapter) ++{ ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ ++ hal_spec->ic_name = "rtl8723d"; ++ hal_spec->macid_num = MACID_NUM_8723D; ++ hal_spec->sec_cam_ent_num = SEC_CAM_ENT_NUM_8723D; ++ hal_spec->sec_cap = SEC_CAP_CHK_BMC; ++ hal_spec->rfpath_num_2g = 2; ++ hal_spec->rfpath_num_5g = 0; ++ hal_spec->max_tx_cnt = 1; ++ hal_spec->nss_num = NSS_NUM_8723D; ++ hal_spec->band_cap = BAND_CAP_8723D; ++ hal_spec->bw_cap = BW_CAP_8723D; ++ hal_spec->port_num = HW_PORT_NUM_8723D; ++ hal_spec->proto_cap = PROTO_CAP_8723D; ++ ++ hal_spec->wl_func = 0 ++ | WL_FUNC_P2P ++ | WL_FUNC_MIRACAST ++ | WL_FUNC_TDLS ++ ; ++} ++ ++void rtl8723d_init_default_value(PADAPTER padapter) ++{ ++ PHAL_DATA_TYPE pHalData; ++ u8 i; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ ++#ifdef CONFIG_80211N_HT ++ padapter->registrypriv.wireless_mode = WIRELESS_11BG_24N; ++#else ++ padapter->registrypriv.wireless_mode = WIRELESS_11BG; ++#endif ++ ++ /* init default value */ ++ pHalData->fw_ractrl = _FALSE; ++ if (!adapter_to_pwrctl(padapter)->bkeepfwalive) ++ pHalData->LastHMEBoxNum = 0; ++ ++ /* init phydm default value */ ++ pHalData->bIQKInitialized = _FALSE; ++ pHalData->odmpriv.RFCalibrateInfo.TM_Trigger = 0;/* for IQK */ ++ pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP_index = 0; ++ for (i = 0; i < HP_THERMAL_NUM; i++) ++ pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP[i] = 0; ++ ++ /* init Efuse variables */ ++ pHalData->EfuseUsedBytes = 0; ++ pHalData->EfuseUsedPercentage = 0; ++#ifdef HAL_EFUSE_MEMORY ++ pHalData->EfuseHal.fakeEfuseBank = 0; ++ pHalData->EfuseHal.fakeEfuseUsedBytes = 0; ++ _rtw_memset(pHalData->EfuseHal.fakeEfuseContent, 0xFF, EFUSE_MAX_HW_SIZE); ++ _rtw_memset(pHalData->EfuseHal.fakeEfuseInitMap, 0xFF, EFUSE_MAX_MAP_LEN); ++ _rtw_memset(pHalData->EfuseHal.fakeEfuseModifiedMap, 0xFF, EFUSE_MAX_MAP_LEN); ++ pHalData->EfuseHal.BTEfuseUsedBytes = 0; ++ pHalData->EfuseHal.BTEfuseUsedPercentage = 0; ++ _rtw_memset(pHalData->EfuseHal.BTEfuseContent, 0xFF, EFUSE_MAX_BT_BANK * EFUSE_MAX_HW_SIZE); ++ _rtw_memset(pHalData->EfuseHal.BTEfuseInitMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); ++ _rtw_memset(pHalData->EfuseHal.BTEfuseModifiedMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); ++ pHalData->EfuseHal.fakeBTEfuseUsedBytes = 0; ++ _rtw_memset(pHalData->EfuseHal.fakeBTEfuseContent, 0xFF, EFUSE_MAX_BT_BANK * EFUSE_MAX_HW_SIZE); ++ _rtw_memset(pHalData->EfuseHal.fakeBTEfuseInitMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); ++ _rtw_memset(pHalData->EfuseHal.fakeBTEfuseModifiedMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); ++#endif ++ pHalData->need_restore = _FALSE; ++} ++ ++u8 GetEEPROMSize8723D(PADAPTER padapter) ++{ ++ u8 size = 0; ++ u32 cr; ++ ++ cr = rtw_read16(padapter, REG_9346CR); ++ /* 6: EEPROM used is 93C46, 4: boot from E-Fuse. */ ++ size = (cr & BOOT_FROM_EEPROM) ? 6 : 4; ++ ++ RTW_INFO("EEPROM type is %s\n", size == 4 ? "E-FUSE" : "93C46"); ++ ++ return size; ++} ++ ++/* ------------------------------------------------------------------------- ++ * ++ * LLT R/W/Init function ++ * ++ * ------------------------------------------------------------------------- */ ++s32 rtl8723d_InitLLTTable(PADAPTER padapter) ++{ ++ u32 start, passing_time; ++ u32 val32; ++ s32 ret; ++ ++ ++ ret = _FAIL; ++ ++ val32 = rtw_read32(padapter, REG_AUTO_LLT); ++ val32 |= BIT_AUTO_INIT_LLT; ++ rtw_write32(padapter, REG_AUTO_LLT, val32); ++ ++ start = rtw_get_current_time(); ++ ++ do { ++ val32 = rtw_read32(padapter, REG_AUTO_LLT); ++ if (!(val32 & BIT_AUTO_INIT_LLT)) { ++ ret = _SUCCESS; ++ break; ++ } ++ ++ passing_time = rtw_get_passing_time_ms(start); ++ if (passing_time > 1000) { ++ RTW_INFO("%s: FAIL!! REG_AUTO_LLT(0x%X)=%08x\n", ++ __FUNCTION__, REG_AUTO_LLT, val32); ++ break; ++ } ++ ++ rtw_usleep_os(2); ++ } while (1); ++ ++ return ret; ++} ++ ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++void _DisableGPIO(PADAPTER padapter) ++{ ++ /*************************************** ++ j. GPIO_PIN_CTRL 0x44[31:0]=0x000 ++ k.Value = GPIO_PIN_CTRL[7:0] ++ l. GPIO_PIN_CTRL 0x44[31:0] = 0x00FF0000 | (value <<8); ++ m. GPIO_MUXCFG 0x42 [15:0] = 0x0780 ++ n. LEDCFG 0x4C[15:0] = 0x8080 ++ ***************************************/ ++ u8 value8; ++ u16 value16; ++ u32 value32; ++ u32 u4bTmp; ++ ++ ++ /* 1. Disable GPIO[7:0] */ ++ rtw_write16(padapter, REG_GPIO_PIN_CTRL + 2, 0x0000); ++ value32 = rtw_read32(padapter, REG_GPIO_PIN_CTRL) & 0xFFFF00FF; ++ u4bTmp = value32 & 0x000000FF; ++ value32 |= ((u4bTmp << 8) | 0x00FF0000); ++ rtw_write32(padapter, REG_GPIO_PIN_CTRL, value32); ++ ++ ++ /* 2. Disable GPIO[10:8] */ ++ rtw_write8(padapter, REG_MAC_PINMUX_CFG, 0x00); ++ value16 = rtw_read16(padapter, REG_GPIO_IO_SEL) & 0xFF0F; ++ value8 = (u8)(value16 & 0x000F); ++ value16 |= ((value8 << 4) | 0x0780); ++ rtw_write16(padapter, REG_GPIO_IO_SEL, value16); ++ ++ ++ /* 3. Disable LED0 & 1 */ ++ rtw_write16(padapter, REG_LEDCFG0, 0x8080); ++ ++} /* end of _DisableGPIO() */ ++ ++void _DisableRFAFEAndResetBB8723D(PADAPTER padapter) ++{ ++ /************************************** ++ a. TXPAUSE 0x522[7:0] = 0xFF ++ b. RF path 0 offset 0x00 = 0x00 ++ c. APSD_CTRL 0x600[7:0] = 0x40 ++ d. SYS_FUNC_EN 0x02[7:0] = 0x16 ++ e. SYS_FUNC_EN 0x02[7:0] = 0x14 ++ ***************************************/ ++ u8 eRFPath = 0, value8 = 0; ++ ++ rtw_write8(padapter, REG_TXPAUSE, 0xFF); ++ ++ PHY_SetRFReg(padapter, (RF_PATH)eRFPath, 0x0, bMaskByte0, 0x0); ++ ++ value8 |= APSDOFF; ++ rtw_write8(padapter, REG_APSD_CTRL, value8);/* 0x40 */ ++ ++ /* Set BB reset at first */ ++ value8 = 0; ++ value8 |= (FEN_USBD | FEN_USBA | FEN_BB_GLB_RSTn); ++ rtw_write8(padapter, REG_SYS_FUNC_EN, value8); /* 0x16 */ ++ ++ /* Set global reset. */ ++ value8 &= ~FEN_BB_GLB_RSTn; ++ rtw_write8(padapter, REG_SYS_FUNC_EN, value8); /* 0x14 */ ++ ++ /* 2010/08/12 MH We need to set BB/GLBAL reset to save power for SS mode. */ ++ ++} ++ ++void _DisableRFAFEAndResetBB(PADAPTER padapter) ++{ ++ _DisableRFAFEAndResetBB8723D(padapter); ++} ++ ++void _ResetDigitalProcedure1_8723D(PADAPTER padapter, BOOLEAN bWithoutHWSM) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ if (IS_FW_81xxC(padapter) && (pHalData->FirmwareVersion <= 0x20)) { ++#if 0 ++ /***************************** ++ f. SYS_FUNC_EN 0x03[7:0]=0x54 ++ g. MCUFWDL 0x80[7:0]=0 ++ ******************************/ ++ u32 value32 = 0; ++ ++ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, 0x54); ++ rtw_write8(padapter, REG_MCUFWDL, 0); ++#else ++ /***************************** ++ f. MCUFWDL 0x80[7:0]=0 ++ g. SYS_FUNC_EN 0x02[10]= 0 ++ h. SYS_FUNC_EN 0x02[15-12]= 5 ++ i. SYS_FUNC_EN 0x02[10]= 1 ++ ******************************/ ++ u16 valu16 = 0; ++ ++ rtw_write8(padapter, REG_MCUFWDL, 0); ++ ++ valu16 = rtw_read16(padapter, REG_SYS_FUNC_EN); ++ rtw_write16(padapter, REG_SYS_FUNC_EN, (valu16 & (~FEN_CPUEN)));/* reset MCU ,8051 */ ++ ++ valu16 = rtw_read16(padapter, REG_SYS_FUNC_EN) & 0x0FFF; ++ rtw_write16(padapter, REG_SYS_FUNC_EN, (valu16 | (FEN_HWPDN | FEN_ELDR))); /* reset MAC */ ++ ++ valu16 = rtw_read16(padapter, REG_SYS_FUNC_EN); ++ rtw_write16(padapter, REG_SYS_FUNC_EN, (valu16 | FEN_CPUEN));/* enable MCU ,8051 */ ++#endif ++ } else { ++ u8 retry_cnts = 0; ++ ++ /* 2010/08/12 MH For USB SS, we can not stop 8051 when we are trying to */ ++ /* enter IPS/HW&SW radio off. For S3/S4/S5/Disable, we can stop 8051 because */ ++ /* we will init FW when power on again. */ ++ /* if(!pDevice->RegUsbSS) */ ++ { /* If we want to SS mode, we can not reset 8051. */ ++ if (rtw_read8(padapter, REG_MCUFWDL) & BIT(1)) { ++ /* IF fw in RAM code, do reset */ ++ ++ ++ if (padapter->bFWReady) { ++ /* 2010/08/25 MH According to RD alfred's suggestion, we need to disable other */ ++ /* HRCV INT to influence 8051 reset. */ ++ rtw_write8(padapter, REG_FWIMR, 0x20); ++ /* 2011/02/15 MH According to Alex's suggestion, close mask to prevent incorrect FW write operation. */ ++ rtw_write8(padapter, REG_FTIMR, 0x00); ++ rtw_write8(padapter, REG_FSIMR, 0x00); ++ ++ rtw_write8(padapter, REG_HMETFR + 3, 0x20); /* 8051 reset by self */ ++ ++ while ((retry_cnts++ < 100) && (FEN_CPUEN & rtw_read16(padapter, REG_SYS_FUNC_EN))) { ++ rtw_udelay_os(50);/* us */ ++ /* 2010/08/25 For test only We keep on reset 5051 to prevent fail. */ ++ /* rtw_write8(padapter, REG_HMETFR+3, 0x20);//8051 reset by self */ ++ } ++ /* RT_ASSERT((retry_cnts < 100), ("8051 reset failed!\n")); */ ++ ++ if (retry_cnts >= 100) { ++ /* if 8051 reset fail we trigger GPIO 0 for LA */ ++ /* rtw_write32( padapter, */ ++ /* REG_GPIO_PIN_CTRL, */ ++ /* 0x00010100); */ ++ /* 2010/08/31 MH According to Filen's info, if 8051 reset fail, reset MAC directly. */ ++ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, 0x50); /* Reset MAC and Enable 8051 */ ++ rtw_mdelay_os(10); ++ } ++ ++ } ++ } ++ ++ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, 0x54); /* Reset MAC and Enable 8051 */ ++ rtw_write8(padapter, REG_MCUFWDL, 0); ++ } ++ } ++ ++ /* if(pDevice->RegUsbSS) */ ++ /* bWithoutHWSM = TRUE; // Sugest by Filen and Issau. */ ++ ++ if (bWithoutHWSM) { ++ /* HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); */ ++ /***************************** ++ Without HW auto state machine ++ g. SYS_CLKR 0x08[15:0] = 0x30A3 ++ h. AFE_PLL_CTRL 0x28[7:0] = 0x80 ++ i. AFE_XTAL_CTRL 0x24[15:0] = 0x880F ++ j. SYS_ISO_CTRL 0x00[7:0] = 0xF9 ++ ******************************/ ++ /* rtw_write16(padapter, REG_SYS_CLKR, 0x30A3); */ ++ /* if(!pDevice->RegUsbSS) */ ++ /* 2011/01/26 MH SD4 Scott suggest to fix UNC-B cut bug. */ ++ rtw_write16(padapter, REG_SYS_CLKR, 0x70A3); /* modify to 0x70A3 by Scott. */ ++ rtw_write8(padapter, REG_AFE_PLL_CTRL, 0x80); ++ rtw_write16(padapter, REG_AFE_XTAL_CTRL, 0x880F); ++ /* if(!pDevice->RegUsbSS) */ ++ rtw_write8(padapter, REG_SYS_ISO_CTRL, 0xF9); ++ } else { ++ /* Disable all RF/BB power */ ++ rtw_write8(padapter, REG_RF_CTRL, 0x00); ++ } ++ ++} ++ ++void _ResetDigitalProcedure1(PADAPTER padapter, BOOLEAN bWithoutHWSM) ++{ ++ _ResetDigitalProcedure1_8723D(padapter, bWithoutHWSM); ++} ++ ++void _ResetDigitalProcedure2(PADAPTER padapter) ++{ ++ /* HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ***************************** ++ k. SYS_FUNC_EN 0x03[7:0] = 0x44 ++ l. SYS_CLKR 0x08[15:0] = 0x3083 ++ m. SYS_ISO_CTRL 0x01[7:0] = 0x83 ++ ******************************/ ++ /* rtw_write8(padapter, REG_SYS_FUNC_EN+1, 0x44); //marked by Scott. */ ++ /* 2011/01/26 MH SD4 Scott suggest to fix UNC-B cut bug. */ ++ rtw_write16(padapter, REG_SYS_CLKR, 0x70a3); /* modify to 0x70a3 by Scott. */ ++ rtw_write8(padapter, REG_SYS_ISO_CTRL + 1, 0x82); /* modify to 0x82 by Scott. */ ++} ++ ++void _DisableAnalog(PADAPTER padapter, BOOLEAN bWithoutHWSM) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u16 value16 = 0; ++ u8 value8 = 0; ++ ++ ++ if (bWithoutHWSM) { ++ /***************************** ++ n. LDOA15_CTRL 0x20[7:0] = 0x04 ++ o. LDOV12D_CTRL 0x21[7:0] = 0x54 ++ r. When driver call disable, the ASIC will turn off remaining clock automatically ++ ******************************/ ++ ++ rtw_write8(padapter, REG_LDOA15_CTRL, 0x04); ++ /* rtw_write8(padapter, REG_LDOV12D_CTRL, 0x54); */ ++ ++ value8 = rtw_read8(padapter, REG_LDOV12D_CTRL); ++ value8 &= (~LDV12_EN); ++ rtw_write8(padapter, REG_LDOV12D_CTRL, value8); ++ } ++ ++ /***************************** ++ h. SPS0_CTRL 0x11[7:0] = 0x23 ++ i. APS_FSMCO 0x04[15:0] = 0x4802 ++ ******************************/ ++ value8 = 0x23; ++ ++ rtw_write8(padapter, REG_SPS0_CTRL, value8); ++ ++ if (bWithoutHWSM) { ++ /* value16 |= (APDM_HOST | AFSM_HSUS |PFM_ALDN); */ ++ /* 2010/08/31 According to Filen description, we need to use HW to shut down 8051 automatically. */ ++ /* Because suspend operation need the asistance of 8051 to wait for 3ms. */ ++ value16 |= (APDM_HOST | AFSM_HSUS | PFM_ALDN); ++ } else ++ value16 |= (APDM_HOST | AFSM_HSUS | PFM_ALDN); ++ ++ rtw_write16(padapter, REG_APS_FSMCO, value16);/* 0x4802 */ ++ ++ rtw_write8(padapter, REG_RSV_CTRL, 0x0e); ++ ++#if 0 ++ /* tynli_test for suspend mode. */ ++ if (!bWithoutHWSM) ++ rtw_write8(padapter, 0xfe10, 0x19); ++#endif ++ ++} ++ ++/* HW Auto state machine */ ++s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU) ++{ ++ int rtStatus = _SUCCESS; ++ ++ ++ if (RTW_CANNOT_RUN(padapter)) ++ return rtStatus; ++ ++ /* ==== RF Off Sequence ==== */ ++ _DisableRFAFEAndResetBB(padapter); ++ ++ /* ==== Reset digital sequence ====== */ ++ _ResetDigitalProcedure1(padapter, _FALSE); ++ ++ /* ==== Pull GPIO PIN to balance level and LED control ====== */ ++ _DisableGPIO(padapter); ++ ++ /* ==== Disable analog sequence === */ ++ _DisableAnalog(padapter, _FALSE); ++ ++ ++ return rtStatus; ++} ++ ++/* without HW Auto state machine */ ++s32 CardDisableWithoutHWSM(PADAPTER padapter) ++{ ++ s32 rtStatus = _SUCCESS; ++ ++ ++ if (RTW_CANNOT_RUN(padapter)) ++ return rtStatus; ++ ++ ++ /* ==== RF Off Sequence ==== */ ++ _DisableRFAFEAndResetBB(padapter); ++ ++ /* ==== Reset digital sequence ====== */ ++ _ResetDigitalProcedure1(padapter, _TRUE); ++ ++ /* ==== Pull GPIO PIN to balance level and LED control ====== */ ++ _DisableGPIO(padapter); ++ ++ /* ==== Reset digital sequence ====== */ ++ _ResetDigitalProcedure2(padapter); ++ ++ /* ==== Disable analog sequence === */ ++ _DisableAnalog(padapter, _TRUE); ++ ++ return rtStatus; ++} ++#endif /* CONFIG_USB_HCI || CONFIG_SDIO_HCI || CONFIG_GSPI_HCI */ ++ ++void ++Hal_InitPGData( ++ PADAPTER padapter, ++ u8 *PROMContent) ++{ ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u32 i; ++ u16 value16; ++ ++ if (_FALSE == pHalData->bautoload_fail_flag) { ++ /* autoload OK. ++ * if (IS_BOOT_FROM_EEPROM(padapter)) */ ++ if (_TRUE == pHalData->EepromOrEfuse) { ++ /* Read all Content from EEPROM or EFUSE. */ ++ for (i = 0; i < HWSET_MAX_SIZE_8723D; i += 2) { ++ /* value16 = EF2Byte(ReadEEprom(pAdapter, (u2Byte) (i>>1))); ++ * *((u16*)(&PROMContent[i])) = value16; */ ++ } ++ } else { ++ /* Read EFUSE real map to shadow. */ ++ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, _FALSE); ++ _rtw_memcpy((void *)PROMContent, (void *)pHalData->efuse_eeprom_data, HWSET_MAX_SIZE_8723D); ++ } ++ } else { ++ /* autoload fail */ ++ /* pHalData->AutoloadFailFlag = _TRUE; */ ++ /* update to default value 0xFF */ ++ if (_FALSE == pHalData->EepromOrEfuse) ++ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, _FALSE); ++ _rtw_memcpy((void *)PROMContent, (void *)pHalData->efuse_eeprom_data, HWSET_MAX_SIZE_8723D); ++ } ++ ++#ifdef CONFIG_EFUSE_CONFIG_FILE ++ if (check_phy_efuse_tx_power_info_valid(padapter) == _FALSE) { ++ if (Hal_readPGDataFromConfigFile(padapter) != _SUCCESS) ++ RTW_ERR("invalid phy efuse and read from file fail, will use driver default!!\n"); ++ } ++#endif ++} ++ ++void ++Hal_EfuseParseIDCode( ++ IN PADAPTER padapter, ++ IN u8 *hwinfo ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u16 EEPROMId; ++ ++ ++ /* Checl 0x8129 again for making sure autoload status!! */ ++ EEPROMId = le16_to_cpu(*((u16 *)hwinfo)); ++ if (EEPROMId != RTL_EEPROM_ID) { ++ RTW_INFO("EEPROM ID(%#x) is invalid!!\n", EEPROMId); ++ pHalData->bautoload_fail_flag = _TRUE; ++ } else ++ pHalData->bautoload_fail_flag = _FALSE; ++ ++} ++ ++static void ++Hal_EEValueCheck( ++ IN u8 EEType, ++ IN PVOID pInValue, ++ OUT PVOID pOutValue ++) ++{ ++ switch (EEType) { ++ case EETYPE_TX_PWR: { ++ u8 *pIn, *pOut; ++ ++ pIn = (u8 *)pInValue; ++ pOut = (u8 *)pOutValue; ++ if (*pIn <= 63) ++ *pOut = *pIn; ++ else { ++ *pOut = EEPROM_Default_TxPowerLevel; ++ } ++ } ++ break; ++ default: ++ break; ++ } ++} ++ ++void ++Hal_EfuseParseTxPowerInfo_8723D( ++ IN PADAPTER padapter, ++ IN u8 *PROMContent, ++ IN BOOLEAN AutoLoadFail ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ TxPowerInfo24G pwrInfo24G; ++ ++ hal_load_txpwr_info(padapter, &pwrInfo24G, NULL, PROMContent); ++ ++ /* 2010/10/19 MH Add Regulator recognize for CU. */ ++ if (!AutoLoadFail) { ++ pHalData->EEPROMRegulatory = (PROMContent[EEPROM_RF_BOARD_OPTION_8723D] & 0x7); /* bit0~2 */ ++ if (PROMContent[EEPROM_RF_BOARD_OPTION_8723D] == 0xFF) ++ pHalData->EEPROMRegulatory = (EEPROM_DEFAULT_BOARD_OPTION & 0x7); /* bit0~2 */ ++ } else ++ pHalData->EEPROMRegulatory = 0; ++} ++ ++VOID ++Hal_EfuseParseBoardType_8723D( ++ IN PADAPTER Adapter, ++ IN u8 *PROMContent, ++ IN BOOLEAN AutoloadFail ++) ++{ ++ ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ if (!AutoloadFail) { ++ pHalData->InterfaceSel = (PROMContent[EEPROM_RF_BOARD_OPTION_8723D] & 0xE0) >> 5; ++ if (PROMContent[EEPROM_RF_BOARD_OPTION_8723D] == 0xFF) ++ pHalData->InterfaceSel = (EEPROM_DEFAULT_BOARD_OPTION & 0xE0) >> 5; ++ } else ++ pHalData->InterfaceSel = 0; ++ ++} ++ ++VOID ++Hal_EfuseParseBTCoexistInfo_8723D( ++ IN PADAPTER padapter, ++ IN u8 *hwinfo, ++ IN BOOLEAN AutoLoadFail ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ u8 tempval; ++ u32 tmpu4; ++ ++ if (!AutoLoadFail) { ++ tmpu4 = rtw_read32(padapter, REG_MULTI_FUNC_CTRL); ++ if (tmpu4 & BT_FUNC_EN) ++ pHalData->EEPROMBluetoothCoexist = _TRUE; ++ else ++ pHalData->EEPROMBluetoothCoexist = _FALSE; ++ ++ pHalData->EEPROMBluetoothType = BT_RTL8723D; ++ ++ tempval = hwinfo[EEPROM_RF_BT_SETTING_8723D]; ++ if (tempval != 0xFF) { ++ /* 0:Ant_x2, 1:Ant_x1 */ ++ pHalData->EEPROMBluetoothAntNum = tempval & BIT(0); ++ /* ++ * EFUSE_0xC3[6] == 0, Wi-Fi at BTGS1(Main, Ant2) - ODM_RF_PATH_A (default) ++ * EFUSE_0xC3[6] == 1, Wi-Fi at BTGS0( Aux, Ant1) - ODM_RF_PATH_B ++ */ ++ pHalData->ant_path = (tempval & BIT(6)) ? ODM_RF_PATH_B : ODM_RF_PATH_A; ++ } else { ++ pHalData->EEPROMBluetoothAntNum = Ant_x1; ++ pHalData->ant_path = ODM_RF_PATH_A; ++ } ++ } else { ++ if (padapter->registrypriv.mp_mode == 1) ++ pHalData->EEPROMBluetoothCoexist = _TRUE; ++ else ++ pHalData->EEPROMBluetoothCoexist = _FALSE; ++ ++ pHalData->EEPROMBluetoothType = BT_RTL8723D; ++ pHalData->EEPROMBluetoothAntNum = Ant_x1; ++ pHalData->ant_path = ODM_RF_PATH_A; ++ } ++ ++#ifdef CONFIG_BT_COEXIST ++ if (padapter->registrypriv.ant_num > 0) { ++ RTW_INFO("%s: Apply driver defined antenna number(%d) to replace origin(%d)\n" ++ , __func__ ++ , padapter->registrypriv.ant_num ++ , pHalData->EEPROMBluetoothAntNum == Ant_x2 ? 2 : 1); ++ ++ switch (padapter->registrypriv.ant_num) { ++ case 1: ++ pHalData->EEPROMBluetoothAntNum = Ant_x1; ++ break; ++ case 2: ++ pHalData->EEPROMBluetoothAntNum = Ant_x2; ++ break; ++ default: ++ RTW_INFO("%s: Discard invalid driver defined antenna number(%d)!\n" ++ , __func__, padapter->registrypriv.ant_num); ++ break; ++ } ++ } ++#endif /* CONFIG_BT_COEXIST */ ++ ++ RTW_INFO("%s: %s BT-coex, ant_num=%d\n" ++ , __func__ ++ , pHalData->EEPROMBluetoothCoexist == _TRUE ? "Enable" : "Disable" ++ , pHalData->EEPROMBluetoothAntNum == Ant_x2 ? 2 : 1); ++} ++ ++VOID ++Hal_EfuseParseEEPROMVer_8723D( ++ IN PADAPTER padapter, ++ IN u8 *hwinfo, ++ IN BOOLEAN AutoLoadFail ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ if (!AutoLoadFail) ++ pHalData->EEPROMVersion = hwinfo[EEPROM_VERSION_8723D]; ++ else ++ pHalData->EEPROMVersion = 1; ++} ++ ++ ++VOID ++Hal_EfuseParsePackageType_8723D( ++ IN PADAPTER pAdapter, ++ IN u8 *hwinfo, ++ IN BOOLEAN AutoLoadFail ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u1Byte package; ++ u8 efuseContent; ++ ++ Efuse_PowerSwitch(pAdapter, _FALSE, _TRUE); ++ efuse_OneByteRead(pAdapter, 0x1FB, &efuseContent, FALSE); ++ RTW_INFO("%s phy efuse read 0x1FB =%x\n", __func__, efuseContent); ++ Efuse_PowerSwitch(pAdapter, _FALSE, _FALSE); ++ ++ package = efuseContent & 0x7; ++ switch (package) { ++ case 0x4: ++ pHalData->PackageType = PACKAGE_TFBGA79; ++ break; ++ case 0x5: ++ pHalData->PackageType = PACKAGE_TFBGA90; ++ break; ++ case 0x6: ++ pHalData->PackageType = PACKAGE_QFN68; ++ break; ++ case 0x7: ++ pHalData->PackageType = PACKAGE_TFBGA80; ++ break; ++ ++ default: ++ pHalData->PackageType = PACKAGE_DEFAULT; ++ break; ++ } ++ ++ RTW_INFO("PackageType = 0x%X\n", pHalData->PackageType); ++ ++#if defined(CONFIG_SDIO_HCI) && defined(CONFIG_80211N_HT) ++ /* RTL8703AS: 0x1FB[5:4] 2b'10 */ ++ /* RTL8723DS: 0x1FB[5:4] 2b'11 */ ++ if ((efuseContent & 0x30) == 0x20) { ++ pAdapter->registrypriv.bw_mode &= 0xF0; ++ RTW_INFO("This is the case of 8703AS\n"); ++ } ++#endif ++} ++ ++VOID ++Hal_EfuseParseVoltage_8723D( ++ IN PADAPTER pAdapter, ++ IN u8 *hwinfo, ++ IN BOOLEAN AutoLoadFail ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ /* _rtw_memcpy(pHalData->adjuseVoltageVal, &hwinfo[EEPROM_Voltage_ADDR_8723D], 1); */ ++ RTW_INFO("%s hwinfo[EEPROM_Voltage_ADDR_8723D] =%02x\n", __func__, hwinfo[EEPROM_Voltage_ADDR_8723D]); ++ pHalData->adjuseVoltageVal = (hwinfo[EEPROM_Voltage_ADDR_8723D] & 0xf0) >> 4; ++ RTW_INFO("%s pHalData->adjuseVoltageVal =%x\n", __func__, pHalData->adjuseVoltageVal); ++} ++ ++VOID ++Hal_EfuseParseChnlPlan_8723D( ++ IN PADAPTER padapter, ++ IN u8 *hwinfo, ++ IN BOOLEAN AutoLoadFail ++) ++{ ++ padapter->mlmepriv.ChannelPlan = hal_com_config_channel_plan( ++ padapter ++ , hwinfo ? &hwinfo[EEPROM_COUNTRY_CODE_8723D] : NULL ++ , hwinfo ? hwinfo[EEPROM_ChannelPlan_8723D] : 0xFF ++ , padapter->registrypriv.alpha2 ++ , padapter->registrypriv.channel_plan ++ , RTW_CHPLAN_WORLD_NULL ++ , AutoLoadFail ++ ); ++} ++ ++VOID ++Hal_EfuseParseCustomerID_8723D( ++ IN PADAPTER padapter, ++ IN u8 *hwinfo, ++ IN BOOLEAN AutoLoadFail ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ if (!AutoLoadFail) ++ pHalData->EEPROMCustomerID = hwinfo[EEPROM_CustomID_8723D]; ++ else ++ pHalData->EEPROMCustomerID = 0; ++} ++ ++VOID ++Hal_EfuseParseAntennaDiversity_8723D( ++ IN PADAPTER pAdapter, ++ IN u8 *hwinfo, ++ IN BOOLEAN AutoLoadFail ++) ++{ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ struct registry_priv *registry_par = &pAdapter->registrypriv; ++ u8 get_efuse_div_type = 0; ++ ++ if (pHalData->EEPROMBluetoothAntNum == Ant_x1) ++ pHalData->AntDivCfg = 0; ++ else { ++ if (registry_par->antdiv_cfg == 2) /* 0:OFF , 1:ON, 2:By EFUSE */ ++ pHalData->AntDivCfg = ++ ((hwinfo[EEPROM_RF_BOARD_OPTION_8723D] & BIT3) >> 3); ++ else ++ pHalData->AntDivCfg = registry_par->antdiv_cfg; ++ } ++ ++ pHalData->TRxAntDivType = S0S1_TRX_HW_ANTDIV; /* it's the only diversity-type for 8723D*/ ++ pHalData->with_extenal_ant_switch = ((hwinfo[EEPROM_RF_BT_SETTING_8723D] & BIT7) >> 7); ++ ++ if (pHalData->AntDivCfg != 0) { ++ get_efuse_div_type = hwinfo[EEPROM_RFE_OPTION_8723D]; ++ if (get_efuse_div_type == 0x11) ++ pHalData->b_fix_tx_ant = NO_FIX_TX_ANT; ++ else if (get_efuse_div_type == 0x13) ++ pHalData->b_fix_tx_ant = FIX_TX_AT_MAIN;/* RX diversity only*/ ++ else ++ pHalData->AntDivCfg = FALSE; ++ } ++ RTW_INFO("%s: AntDivCfg=%d, AntDivType=%d\n", ++ __func__, pHalData->AntDivCfg, pHalData->TRxAntDivType); ++#endif ++} ++ ++VOID ++Hal_EfuseParseXtal_8723D( ++ IN PADAPTER pAdapter, ++ IN u8 *hwinfo, ++ IN BOOLEAN AutoLoadFail ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ if (!AutoLoadFail) { ++ pHalData->CrystalCap = hwinfo[EEPROM_XTAL_8723D]; ++ if (pHalData->CrystalCap == 0xFF) ++ pHalData->CrystalCap = EEPROM_Default_CrystalCap_8723D; /* what value should 8812 set? */ ++ } else ++ pHalData->CrystalCap = EEPROM_Default_CrystalCap_8723D; ++} ++ ++ ++void ++Hal_EfuseParseThermalMeter_8723D( ++ PADAPTER padapter, ++ u8 *PROMContent, ++ u8 AutoLoadFail ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ ++ /* */ ++ /* ThermalMeter from EEPROM */ ++ /* */ ++ if (_FALSE == AutoLoadFail) ++ pHalData->EEPROMThermalMeter = PROMContent[EEPROM_THERMAL_METER_8723D]; ++ else ++ pHalData->EEPROMThermalMeter = EEPROM_Default_ThermalMeter_8723D; ++ ++ if ((pHalData->EEPROMThermalMeter == 0xff) || (_TRUE == AutoLoadFail)) { ++ pHalData->odmpriv.RFCalibrateInfo.bAPKThermalMeterIgnore = _TRUE; ++ pHalData->EEPROMThermalMeter = EEPROM_Default_ThermalMeter_8723D; ++ } ++ ++} ++ ++ ++void Hal_ReadRFGainOffset( ++ IN PADAPTER Adapter, ++ IN u8 *PROMContent, ++ IN BOOLEAN AutoloadFail) ++{ ++#ifdef CONFIG_RF_POWER_TRIM ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct kfree_data_t *kfree_data = &pHalData->kfree_data; ++ u8 pg_pwrtrim = 0xFF, pg_therm = 0xFF; ++ ++ efuse_OneByteRead(Adapter, ++ PPG_BB_GAIN_2G_TX_OFFSET_8723D, &pg_pwrtrim, _FALSE); ++ efuse_OneByteRead(Adapter, ++ PPG_THERMAL_OFFSET_8723D, &pg_therm, _FALSE); ++ ++ if (pg_pwrtrim != 0xFF) { ++ kfree_data->bb_gain[BB_GAIN_2G][PPG_8723D_S1] ++ = KFREE_BB_GAIN_2G_TX_OFFSET(pg_pwrtrim & PPG_BB_GAIN_2G_TX_OFFSET_MASK); ++ kfree_data->bb_gain[BB_GAIN_2G][PPG_8723D_S0] ++ = KFREE_BB_GAIN_2G_TXB_OFFSET(pg_pwrtrim & PPG_BB_GAIN_2G_TXB_OFFSET_MASK); ++ kfree_data->flag |= KFREE_FLAG_ON; ++ } ++ ++ if (pg_therm != 0xFF) { ++ kfree_data->thermal ++ = KFREE_THERMAL_OFFSET(pg_therm & PPG_THERMAL_OFFSET_MASK); ++ /* kfree_data->flag |= KFREE_FLAG_THERMAL_K_ON; */ /* Default disable thermel kfree by realsil Alan 20160428 */ ++ } ++ ++ if (kfree_data->flag & KFREE_FLAG_THERMAL_K_ON) ++ pHalData->EEPROMThermalMeter += kfree_data->thermal; ++ ++ RTW_INFO("kfree Pwr Trim flag:%u\n", kfree_data->flag); ++ if (kfree_data->flag & KFREE_FLAG_ON) { ++ RTW_INFO("bb_gain(S1):%d\n", kfree_data->bb_gain[BB_GAIN_2G][PPG_8723D_S1]); ++ RTW_INFO("bb_gain(S0):%d\n", kfree_data->bb_gain[BB_GAIN_2G][PPG_8723D_S0]); ++ } ++ if (kfree_data->flag & KFREE_FLAG_THERMAL_K_ON) ++ RTW_INFO("thermal:%d\n", kfree_data->thermal); ++#endif /*CONFIG_RF_POWER_TRIM */ ++} ++ ++u8 ++BWMapping_8723D( ++ IN PADAPTER Adapter, ++ IN struct pkt_attrib *pattrib ++) ++{ ++ u8 BWSettingOfDesc = 0; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ ++ /* RTW_INFO("BWMapping pHalData->CurrentChannelBW %d, pattrib->bwmode %d\n",pHalData->CurrentChannelBW,pattrib->bwmode); */ ++ ++ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) { ++ if (pattrib->bwmode == CHANNEL_WIDTH_80) ++ BWSettingOfDesc = 2; ++ else if (pattrib->bwmode == CHANNEL_WIDTH_40) ++ BWSettingOfDesc = 1; ++ else ++ BWSettingOfDesc = 0; ++ } else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) { ++ if ((pattrib->bwmode == CHANNEL_WIDTH_40) || (pattrib->bwmode == CHANNEL_WIDTH_80)) ++ BWSettingOfDesc = 1; ++ else ++ BWSettingOfDesc = 0; ++ } else ++ BWSettingOfDesc = 0; ++ ++ /* if(pTcb->bBTTxPacket) */ ++ /* BWSettingOfDesc = 0; */ ++ ++ return BWSettingOfDesc; ++} ++ ++u8 SCMapping_8723D(PADAPTER Adapter, struct pkt_attrib *pattrib) ++{ ++ u8 SCSettingOfDesc = 0; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ ++ /* RTW_INFO("SCMapping: pHalData->CurrentChannelBW %d, pHalData->nCur80MhzPrimeSC %d, pHalData->nCur40MhzPrimeSC %d\n",pHalData->CurrentChannelBW,pHalData->nCur80MhzPrimeSC,pHalData->nCur40MhzPrimeSC); */ ++ ++ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) { ++ if (pattrib->bwmode == CHANNEL_WIDTH_80) ++ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; ++ else if (pattrib->bwmode == CHANNEL_WIDTH_40) { ++ if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) ++ SCSettingOfDesc = VHT_DATA_SC_40_LOWER_OF_80MHZ; ++ else if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) ++ SCSettingOfDesc = VHT_DATA_SC_40_UPPER_OF_80MHZ; ++ else ++ RTW_INFO("SCMapping: DONOT CARE Mode Setting\n"); ++ } else { ++ if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) ++ SCSettingOfDesc = VHT_DATA_SC_20_LOWEST_OF_80MHZ; ++ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) ++ SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ; ++ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) ++ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; ++ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) ++ SCSettingOfDesc = VHT_DATA_SC_20_UPPERST_OF_80MHZ; ++ else ++ RTW_INFO("SCMapping: DONOT CARE Mode Setting\n"); ++ } ++ } else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) { ++ /* RTW_INFO("SCMapping: HT Case: pHalData->CurrentChannelBW %d, pHalData->nCur40MhzPrimeSC %d\n",pHalData->CurrentChannelBW,pHalData->nCur40MhzPrimeSC); */ ++ ++ if (pattrib->bwmode == CHANNEL_WIDTH_40) ++ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; ++ else if (pattrib->bwmode == CHANNEL_WIDTH_20) { ++ if (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) ++ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; ++ else if (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) ++ SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ; ++ else ++ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; ++ } ++ } else ++ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; ++ ++ return SCSettingOfDesc; ++} ++ ++#if defined(CONFIG_CONCURRENT_MODE) ++void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc) ++{ ++ if ((pattrib->encrypt > 0) && (!pattrib->bswenc) ++ && (pattrib->bmc_camid != INVALID_SEC_MAC_CAM_ID)) { ++ ++ SET_TX_DESC_EN_DESC_ID_8723D(ptxdesc, 1); ++ SET_TX_DESC_MACID_8723D(ptxdesc, pattrib->bmc_camid); ++ } ++} ++#endif ++ ++static u8 fill_txdesc_sectype(struct pkt_attrib *pattrib) ++{ ++ u8 sectype = 0; ++ ++ if ((pattrib->encrypt > 0) && !pattrib->bswenc) { ++ switch (pattrib->encrypt) { ++ /* SEC_TYPE */ ++ case _WEP40_: ++ case _WEP104_: ++ case _TKIP_: ++ case _TKIP_WTMIC_: ++ sectype = 1; ++ break; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ case _SMS4_: ++ sectype = 2; ++ break; ++#endif ++ case _AES_: ++ sectype = 3; ++ break; ++ ++ case _NO_PRIVACY_: ++ default: ++ break; ++ } ++ } ++ return sectype; ++} ++ ++static void fill_txdesc_vcs_8723d(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc) ++{ ++ /* RTW_INFO("cvs_mode=%d\n", pattrib->vcs_mode); */ ++ ++ if (pattrib->vcs_mode) { ++ switch (pattrib->vcs_mode) { ++ case RTS_CTS: ++ SET_TX_DESC_RTS_ENABLE_8723D(ptxdesc, 1); ++ SET_TX_DESC_HW_RTS_ENABLE_8723D(ptxdesc, 1); ++ break; ++ ++ case CTS_TO_SELF: ++ SET_TX_DESC_CTS2SELF_8723D(ptxdesc, 1); ++ break; ++ ++ case NONE_VCS: ++ default: ++ break; ++ } ++ ++ SET_TX_DESC_RTS_RATE_8723D(ptxdesc, 8); /* RTS Rate=24M */ ++ SET_TX_DESC_RTS_RATE_FB_LIMIT_8723D(ptxdesc, 0xF); ++ ++ if (padapter->mlmeextpriv.mlmext_info.preamble_mode == PREAMBLE_SHORT) ++ SET_TX_DESC_RTS_SHORT_8723D(ptxdesc, 1); ++ ++ /* Set RTS BW */ ++ if (pattrib->ht_en) ++ SET_TX_DESC_RTS_SC_8723D(ptxdesc, SCMapping_8723D(padapter, pattrib)); ++ } ++} ++ ++static void fill_txdesc_phy_8723d(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc) ++{ ++ /* RTW_INFO("bwmode=%d, ch_off=%d\n", pattrib->bwmode, pattrib->ch_offset); */ ++ ++ if (pattrib->ht_en) { ++ SET_TX_DESC_DATA_BW_8723D(ptxdesc, BWMapping_8723D(padapter, pattrib)); ++ SET_TX_DESC_DATA_SC_8723D(ptxdesc, SCMapping_8723D(padapter, pattrib)); ++ } ++} ++ ++static void rtl8723d_fill_default_txdesc( ++ struct xmit_frame *pxmitframe, ++ u8 *pbuf) ++{ ++ PADAPTER padapter; ++ HAL_DATA_TYPE *pHalData; ++ struct mlme_ext_priv *pmlmeext; ++ struct mlme_ext_info *pmlmeinfo; ++ struct pkt_attrib *pattrib; ++ s32 bmcst; ++ ++ _rtw_memset(pbuf, 0, TXDESC_SIZE); ++ ++ padapter = pxmitframe->padapter; ++ pHalData = GET_HAL_DATA(padapter); ++ pmlmeext = &padapter->mlmeextpriv; ++ pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ pattrib = &pxmitframe->attrib; ++ bmcst = IS_MCAST(pattrib->ra); ++ ++ if (pHalData->rf_type == RF_1T1R) ++ SET_TX_DESC_PATH_A_EN_8723D(pbuf, 1); ++ ++ if (pxmitframe->frame_tag == DATA_FRAMETAG) { ++ u8 drv_userate = 0; ++ ++ SET_TX_DESC_MACID_8723D(pbuf, pattrib->mac_id); ++ SET_TX_DESC_RATE_ID_8723D(pbuf, pattrib->raid); ++ SET_TX_DESC_QUEUE_SEL_8723D(pbuf, pattrib->qsel); ++ SET_TX_DESC_SEQ_8723D(pbuf, pattrib->seqnum); ++ ++ SET_TX_DESC_SEC_TYPE_8723D(pbuf, fill_txdesc_sectype(pattrib)); ++#if defined(CONFIG_CONCURRENT_MODE) ++ if (bmcst) ++ fill_txdesc_force_bmc_camid(pattrib, pbuf); ++#endif ++ fill_txdesc_vcs_8723d(padapter, pattrib, pbuf); ++ ++ if (pattrib->icmp_pkt == 1 && padapter->registrypriv.wifi_spec == 1) ++ drv_userate = 1; ++ ++ if ((pattrib->ether_type != 0x888e) && ++ (pattrib->ether_type != 0x0806) && ++ (pattrib->ether_type != 0x88B4) && ++ (pattrib->dhcp_pkt != 1) && ++ (drv_userate != 1) ++#ifdef CONFIG_AUTO_AP_MODE ++ && (pattrib->pctrl != _TRUE) ++#endif ++ ) { ++ /* Non EAP & ARP & DHCP type data packet */ ++ ++ if (pattrib->ampdu_en == _TRUE) { ++ SET_TX_DESC_AGG_ENABLE_8723D(pbuf, 1); ++ SET_TX_DESC_MAX_AGG_NUM_8723D(pbuf, 0x1F); ++ SET_TX_DESC_AMPDU_DENSITY_8723D(pbuf, pattrib->ampdu_spacing); ++ } else ++ SET_TX_DESC_BK_8723D(pbuf, 1); ++ ++ fill_txdesc_phy_8723d(padapter, pattrib, pbuf); ++ ++ SET_TX_DESC_DATA_RATE_FB_LIMIT_8723D(pbuf, 0x1F); ++ ++ if (pHalData->fw_ractrl == _FALSE) { ++ SET_TX_DESC_USE_RATE_8723D(pbuf, 1); ++ ++ if (pHalData->INIDATA_RATE[pattrib->mac_id] & BIT(7)) ++ SET_TX_DESC_DATA_SHORT_8723D(pbuf, 1); ++ ++ SET_TX_DESC_TX_RATE_8723D(pbuf, pHalData->INIDATA_RATE[pattrib->mac_id] & 0x7F); ++ } ++ ++ /* modify data rate by iwpriv */ ++ if (padapter->fix_rate != 0xFF) { ++ SET_TX_DESC_USE_RATE_8723D(pbuf, 1); ++ if (padapter->fix_rate & BIT(7)) ++ SET_TX_DESC_DATA_SHORT_8723D(pbuf, 1); ++ SET_TX_DESC_TX_RATE_8723D(pbuf, padapter->fix_rate & 0x7F); ++ if (!padapter->data_fb) ++ SET_TX_DESC_DISABLE_FB_8723D(pbuf, 1); ++ } ++ ++ if (pattrib->stbc) ++ SET_TX_DESC_DATA_STBC_8723D(pbuf, 1); ++ ++#ifdef CONFIG_CMCC_TEST ++ SET_TX_DESC_DATA_SHORT_8723D(pbuf, 1); /* use cck short premble */ ++#endif ++ } else { ++ /* EAP data packet and ARP packet. */ ++ /* Use the 1M data rate to send the EAP/ARP packet. */ ++ /* This will maybe make the handshake smooth. */ ++ ++ SET_TX_DESC_BK_8723D(pbuf, 1); ++ SET_TX_DESC_USE_RATE_8723D(pbuf, 1); ++ if (pmlmeinfo->preamble_mode == PREAMBLE_SHORT) ++ SET_TX_DESC_DATA_SHORT_8723D(pbuf, 1); ++ SET_TX_DESC_TX_RATE_8723D(pbuf, MRateToHwRate(pmlmeext->tx_rate)); ++ ++ RTW_INFO(FUNC_ADPT_FMT ": SP Packet(0x%04X) rate=0x%x\n", ++ FUNC_ADPT_ARG(padapter), pattrib->ether_type, MRateToHwRate(pmlmeext->tx_rate)); ++ } ++ ++#if defined(CONFIG_USB_TX_AGGREGATION) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ SET_TX_DESC_USB_TXAGG_NUM_8723D(pbuf, pxmitframe->agg_num); ++#endif ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_XMIT_ACK ++ /* CCX-TXRPT ack for xmit mgmt frames. */ ++ if (pxmitframe->ack_report) { ++#ifdef DBG_CCX ++ RTW_INFO("%s set spe_rpt\n", __func__); ++#endif ++ SET_TX_DESC_CCX_8723D(pbuf, 1); ++ SET_TX_DESC_SW_DEFINE_8723D(pbuf, (u8)(GET_PRIMARY_ADAPTER(padapter)->xmitpriv.seq_no)); ++ } ++#endif /* CONFIG_XMIT_ACK */ ++#endif ++ } else if (pxmitframe->frame_tag == MGNT_FRAMETAG) { ++ ++ SET_TX_DESC_MACID_8723D(pbuf, pattrib->mac_id); ++ SET_TX_DESC_QUEUE_SEL_8723D(pbuf, pattrib->qsel); ++ SET_TX_DESC_RATE_ID_8723D(pbuf, pattrib->raid); ++ SET_TX_DESC_SEQ_8723D(pbuf, pattrib->seqnum); ++ SET_TX_DESC_USE_RATE_8723D(pbuf, 1); ++ ++ SET_TX_DESC_MBSSID_8723D(pbuf, pattrib->mbssid & 0xF); ++ ++ SET_TX_DESC_RETRY_LIMIT_ENABLE_8723D(pbuf, 1); ++ if (pattrib->retry_ctrl == _TRUE) ++ SET_TX_DESC_DATA_RETRY_LIMIT_8723D(pbuf, 6); ++ else ++ SET_TX_DESC_DATA_RETRY_LIMIT_8723D(pbuf, 12); ++ ++ SET_TX_DESC_TX_RATE_8723D(pbuf, MRateToHwRate(pattrib->rate)); ++ ++#ifdef CONFIG_XMIT_ACK ++ /* CCX-TXRPT ack for xmit mgmt frames. */ ++ if (pxmitframe->ack_report) { ++#ifdef DBG_CCX ++ RTW_INFO("%s set spe_rpt\n", __FUNCTION__); ++#endif ++ SET_TX_DESC_CCX_8723D(pbuf, 1); ++ SET_TX_DESC_SW_DEFINE_8723D(pbuf, (u8)(GET_PRIMARY_ADAPTER(padapter)->xmitpriv.seq_no)); ++ } ++#endif /* CONFIG_XMIT_ACK */ ++ } else if (pxmitframe->frame_tag == TXAGG_FRAMETAG) { ++ } ++#ifdef CONFIG_MP_INCLUDED ++ else if (pxmitframe->frame_tag == MP_FRAMETAG) { ++ fill_txdesc_for_mp(padapter, pbuf); ++ } ++#endif ++ else { ++ ++ SET_TX_DESC_MACID_8723D(pbuf, pattrib->mac_id); ++ SET_TX_DESC_RATE_ID_8723D(pbuf, pattrib->raid); ++ SET_TX_DESC_QUEUE_SEL_8723D(pbuf, pattrib->qsel); ++ SET_TX_DESC_SEQ_8723D(pbuf, pattrib->seqnum); ++ SET_TX_DESC_USE_RATE_8723D(pbuf, 1); ++ SET_TX_DESC_TX_RATE_8723D(pbuf, MRateToHwRate(pmlmeext->tx_rate)); ++ } ++ ++ SET_TX_DESC_PKT_SIZE_8723D(pbuf, pattrib->last_txcmdsz); ++ ++ { ++ u8 pkt_offset, offset; ++ ++ pkt_offset = 0; ++ offset = TXDESC_SIZE; ++#ifdef CONFIG_USB_HCI ++ pkt_offset = pxmitframe->pkt_offset; ++ offset += (pxmitframe->pkt_offset >> 3); ++#endif /* CONFIG_USB_HCI */ ++ ++#ifdef CONFIG_TX_EARLY_MODE ++ if (pxmitframe->frame_tag == DATA_FRAMETAG) { ++ pkt_offset = 1; ++ offset += EARLY_MODE_INFO_SIZE; ++ } ++#endif /* CONFIG_TX_EARLY_MODE */ ++ ++ SET_TX_DESC_PKT_OFFSET_8723D(pbuf, pkt_offset); ++ SET_TX_DESC_OFFSET_8723D(pbuf, offset); ++ } ++ ++ if (bmcst) ++ SET_TX_DESC_BMC_8723D(pbuf, 1); ++ ++ /* 2009.11.05. tynli_test. Suggested by SD4 Filen for FW LPS. */ ++ /* (1) The sequence number of each non-Qos frame / broadcast / multicast / */ ++ /* mgnt frame should be controlled by Hw because Fw will also send null data */ ++ /* which we cannot control when Fw LPS enable. */ ++ /* --> default enable non-Qos data sequense number. 2010.06.23. by tynli. */ ++ /* (2) Enable HW SEQ control for beacon packet, because we use Hw beacon. */ ++ /* (3) Use HW Qos SEQ to control the seq num of Ext port non-Qos packets. */ ++ /* 2010.06.23. Added by tynli. */ ++ if (!pattrib->qos_en) ++ SET_TX_DESC_HWSEQ_EN_8723D(pbuf, 1); ++} ++ ++/* ++ * Description: ++ * ++ * Parameters: ++ * pxmitframe xmitframe ++ * pbuf where to fill tx desc ++ */ ++void rtl8723d_update_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf) ++{ ++ PADAPTER padapter = pxmitframe->padapter; ++ ++ rtl8723d_fill_default_txdesc(pxmitframe, pbuf); ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ ODM_SetTxAntByTxInfo(&GET_HAL_DATA(padapter)->odmpriv, pbuf, pxmitframe->attrib.mac_id); ++#endif /* CONFIG_ANTENNA_DIVERSITY */ ++ ++#if defined(CONFIG_USB_HCI) ++ rtl8723d_cal_txdesc_chksum((struct tx_desc *)pbuf); ++#endif ++} ++ ++#ifdef CONFIG_TSF_RESET_OFFLOAD ++int reset_tsf(PADAPTER Adapter, u8 reset_port) ++{ ++ u8 reset_cnt_before = 0, reset_cnt_after = 0, loop_cnt = 0; ++ u32 reg_reset_tsf_cnt = (HW_PORT0 == reset_port) ? ++ REG_FW_RESET_TSF_CNT_0 : REG_FW_RESET_TSF_CNT_1; ++ ++ rtw_mi_buddy_scan_abort(Adapter, _FALSE); /* site survey will cause reset_tsf fail */ ++ reset_cnt_after = reset_cnt_before = rtw_read8(Adapter, reg_reset_tsf_cnt); ++ rtl8723d_reset_tsf(Adapter, reset_port); ++ ++ while ((reset_cnt_after == reset_cnt_before) && (loop_cnt < 10)) { ++ rtw_msleep_os(100); ++ loop_cnt++; ++ reset_cnt_after = rtw_read8(Adapter, reg_reset_tsf_cnt); ++ } ++ ++ return (loop_cnt >= 10) ? _FAIL : _TRUE; ++} ++#endif /* CONFIG_TSF_RESET_OFFLOAD */ ++ ++static void hw_var_set_monitor(PADAPTER Adapter, u8 variable, u8 *val) ++{ ++ u32 value_rcr, rcr_bits; ++ u16 value_rxfltmap2; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ ++ if (*((u8 *)val) == _HW_STATE_MONITOR_) { ++ ++ /* Leave IPS */ ++ rtw_pm_set_ips(Adapter, IPS_NONE); ++ LeaveAllPowerSaveMode(Adapter); ++ ++ /* Receive all type */ ++ rcr_bits = RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_APWRMGT | RCR_ADF | RCR_ACF | RCR_AMF | RCR_APP_PHYST_RXFF; ++ ++ /* Append FCS */ ++ rcr_bits |= RCR_APPFCS; ++ ++#if 0 ++ /* ++ CRC and ICV packet will drop in recvbuf2recvframe() ++ We no turn on it. ++ */ ++ rcr_bits |= (RCR_ACRC32 | RCR_AICV); ++#endif ++ ++ /* Receive all data frames */ ++ value_rxfltmap2 = 0xFFFF; ++ ++ value_rcr = rcr_bits; ++ rtw_write32(Adapter, REG_RCR, value_rcr); ++ ++ rtw_write16(Adapter, REG_RXFLTMAP2, value_rxfltmap2); ++ ++#if 0 ++ /* tx pause */ ++ rtw_write8(padapter, REG_TXPAUSE, 0xFF); ++#endif ++ } else { ++ /* do nothing */ ++ } ++ ++} ++ ++static void hw_var_set_opmode(PADAPTER padapter, u8 variable, u8 *val) ++{ ++ u8 val8; ++ u8 mode = *((u8 *)val); ++ static u8 isMonitor = _FALSE; ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ if (isMonitor == _TRUE) { ++ /* reset RCR */ ++ rtw_write32(padapter, REG_RCR, pHalData->ReceiveConfig); ++ isMonitor = _FALSE; ++ } ++ ++ if (mode == _HW_STATE_MONITOR_) { ++ isMonitor = _TRUE; ++ /* set net_type */ ++ Set_MSR(padapter, _HW_STATE_NOLINK_); ++ ++ hw_var_set_monitor(padapter, variable, val); ++ return; ++ } ++ /* set mac addr to mac register */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, ++ adapter_mac_addr(padapter)); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->hw_port == HW_PORT1) { ++ /* disable Port1 TSF update */ ++ val8 = rtw_read8(padapter, REG_BCN_CTRL_1); ++ val8 |= DIS_TSF_UDT; ++ rtw_write8(padapter, REG_BCN_CTRL_1, val8); ++ ++ Set_MSR(padapter, mode); ++ ++ RTW_INFO("#### %s()-%d hw_port(%d) mode=%d ####\n", ++ __func__, __LINE__, padapter->hw_port, mode); ++ ++ if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) { ++ if (!rtw_mi_check_status(padapter, MI_AP_MODE)) { ++ StopTxBeacon(padapter); ++#ifdef CONFIG_PCI_HCI ++ UpdateInterruptMask8723DE(padapter, 0, 0, RT_BCN_INT_MASKS, 0); ++#else /* !CONFIG_PCI_HCI */ ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN ++ ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT ++ rtw_write8(padapter, REG_DRVERLYINT, 0x05);/* restore early int time to 5ms */ ++ UpdateInterruptMask8723DU(padapter, _TRUE, 0, IMR_BCNDMAINT0_8723D); ++#endif /* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ ++ ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR ++ UpdateInterruptMask8723DU(padapter, _TRUE , 0, (IMR_TXBCN0ERR_8723D | IMR_TXBCN0OK_8723D)); ++#endif /* CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR */ ++ ++#endif /* CONFIG_INTERRUPT_BASED_TXBCN */ ++#endif /* !CONFIG_PCI_HCI */ ++ } ++ ++ /* disable atim wnd */ ++ rtw_write8(padapter, REG_BCN_CTRL_1, DIS_TSF_UDT | DIS_ATIM | EN_BCN_FUNCTION); ++ } else if ((mode == _HW_STATE_ADHOC_) /*|| (mode == _HW_STATE_AP_)*/) { ++ ResumeTxBeacon(padapter); ++ rtw_write8(padapter, REG_BCN_CTRL_1, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); ++ } else if (mode == _HW_STATE_AP_) { ++#ifdef CONFIG_PCI_HCI ++ UpdateInterruptMask8723DE(padapter, RT_BCN_INT_MASKS, 0, 0, 0); ++#else /* !CONFIG_PCI_HCI */ ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN ++ ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT ++ UpdateInterruptMask8723DU(padapter, _TRUE, IMR_BCNDMAINT0_8723D, 0); ++#endif /* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ ++ ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR ++ UpdateInterruptMask8723DU(padapter, _TRUE, (IMR_TXBCN0ERR_8723D | IMR_TXBCN0OK_8723D), 0); ++#endif /* CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR */ ++ ++#endif /* CONFIG_INTERRUPT_BASED_TXBCN */ ++#endif /* !CONFIG_PCI_HCI */ ++ ++ ResumeTxBeacon(padapter); ++ ++ rtw_write8(padapter, REG_BCN_CTRL_1, DIS_TSF_UDT | DIS_BCNQ_SUB); ++ ++ /* Set RCR */ ++ /* rtw_write32(padapter, REG_RCR, 0x70002a8e);//CBSSID_DATA must set to 0 */ ++ /* rtw_write32(padapter, REG_RCR, 0x7000228e);//CBSSID_DATA must set to 0 */ ++ if (padapter->registrypriv.wifi_spec) ++ /* for 11n Logo 4.2.31/4.2.32, disable BSSID BCN check for AP mode */ ++ rtw_write32(padapter, REG_RCR, (0x7000208e & ~(RCR_CBSSID_BCN))); ++ else ++ rtw_write32(padapter, REG_RCR, 0x7000208e);/* CBSSID_DATA must set to 0,reject ICV_ERR packet */ ++ /* enable to rx data frame*/ ++ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); ++ /* enable to rx ps-poll */ ++ rtw_write16(padapter, REG_RXFLTMAP1, 0x0400); ++ ++ /* Beacon Control related register for first time */ ++ rtw_write8(padapter, REG_BCNDMATIM, 0x02); /* 2ms */ ++ ++ /* rtw_write8(padapter, REG_BCN_MAX_ERR, 0xFF); */ ++ rtw_write8(padapter, REG_ATIMWND_1, 0x0a); /* 10ms for port1 */ ++ rtw_write16(padapter, REG_BCNTCFG, 0x00); ++ rtw_write16(padapter, REG_TBTT_PROHIBIT, 0xff04); ++ rtw_write16(padapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ ++ ++ /* reset TSF2 */ ++ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(1)); ++ ++ /* enable BCN1 Function for if2 */ ++ /* don't enable update TSF1 for if2 (due to TSF update when beacon/probe rsp are received) */ ++ rtw_write8(padapter, REG_BCN_CTRL_1, (DIS_TSF_UDT | EN_BCN_FUNCTION | EN_TXBCN_RPT | DIS_BCNQ_SUB)); ++ ++ /* SW_BCN_SEL - Port1 */ ++ /* rtw_write8(Adapter, REG_DWBCN1_CTRL_8192E+2, rtw_read8(Adapter, REG_DWBCN1_CTRL_8192E+2)|BIT4); */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); ++ ++ /* select BCN on port 1 */ ++ rtw_write8(padapter, REG_CCK_CHECK_8723D, ++ (rtw_read8(padapter, REG_CCK_CHECK_8723D) | BIT_BCN_PORT_SEL)); ++ ++ /* BCN1 TSF will sync to BCN0 TSF with offset(0x518) if if1_sta linked */ ++ /* rtw_write8(padapter, REG_BCN_CTRL_1, rtw_read8(padapter, REG_BCN_CTRL_1)|BIT(5)); */ ++ /* rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(3)); */ ++ ++ /* dis BCN0 ATIM WND if if1 is station */ ++ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) | DIS_ATIM); ++ ++#ifdef CONFIG_TSF_RESET_OFFLOAD ++ /* Reset TSF for STA+AP concurrent mode */ ++ if (rtw_mi_buddy_check_fwstate(padapter, ++ (WIFI_STATION_STATE | WIFI_ASOC_STATE))) { ++ if (reset_tsf(padapter, HW_PORT1) == _FALSE) ++ RTW_INFO("ERROR! %s()-%d: Reset port1 TSF fail\n", ++ __FUNCTION__, __LINE__); ++ } ++#endif /* CONFIG_TSF_RESET_OFFLOAD */ ++ } ++ } else /* else for port0 */ ++#endif /* CONFIG_CONCURRENT_MODE */ ++ { ++#ifdef CONFIG_MI_WITH_MBSSID_CAM /*For Port0 - MBSS CAM*/ ++ hw_var_set_opmode_mbid(padapter, mode); ++#else ++ /* disable Port0 TSF update */ ++ val8 = rtw_read8(padapter, REG_BCN_CTRL); ++ val8 |= DIS_TSF_UDT; ++ rtw_write8(padapter, REG_BCN_CTRL, val8); ++ ++ /* set net_type */ ++ Set_MSR(padapter, mode); ++ RTW_INFO("#### %s() -%d hw_port(0) mode = %d ####\n", ++ __func__, __LINE__, mode); ++ ++ if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) { ++#ifdef CONFIG_CONCURRENT_MODE ++ if (!rtw_mi_check_status(padapter, MI_AP_MODE)) { ++#else ++ { ++#endif /* CONFIG_CONCURRENT_MODE */ ++ StopTxBeacon(padapter); ++#ifdef CONFIG_PCI_HCI ++ UpdateInterruptMask8723DE(padapter, 0, 0, RT_BCN_INT_MASKS, 0); ++#else /* !CONFIG_PCI_HCI */ ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT ++ rtw_write8(padapter, REG_DRVERLYINT, 0x05); /* restore early int time to 5ms */ ++ UpdateInterruptMask8812AU(padapter, _TRUE, 0, IMR_BCNDMAINT0_8723D); ++#endif /* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ ++ ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR ++ UpdateInterruptMask8812AU(padapter, _TRUE , 0, (IMR_TXBCN0ERR_8723D | IMR_TXBCN0OK_8723D)); ++#endif /* CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR */ ++ ++#endif /* CONFIG_INTERRUPT_BASED_TXBCN */ ++#endif /* !CONFIG_PCI_HCI */ ++ } ++ ++ /* disable atim wnd */ ++ rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_ATIM); ++ /* rtw_write8(padapter,REG_BCN_CTRL, 0x18); */ ++ } else if ((mode == _HW_STATE_ADHOC_) /*|| (mode == _HW_STATE_AP_)*/) { ++ ResumeTxBeacon(padapter); ++ rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); ++ } else if (mode == _HW_STATE_AP_) { ++#ifdef CONFIG_PCI_HCI ++ UpdateInterruptMask8723DE(padapter, RT_BCN_INT_MASKS, 0, 0, 0); ++#else /* !CONFIG_PCI_HCI */ ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT ++ UpdateInterruptMask8723DU(padapter, _TRUE , IMR_BCNDMAINT0_8723D, 0); ++#endif /* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ ++ ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR ++ UpdateInterruptMask8723DU(padapter, _TRUE , (IMR_TXBCN0ERR_8723D | IMR_TXBCN0OK_8723D), 0); ++#endif /* CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR */ ++ ++#endif /* CONFIG_INTERRUPT_BASED_TXBCN */ ++#endif ++ ++ ResumeTxBeacon(padapter); ++ ++ rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT | DIS_BCNQ_SUB); ++ ++ /* Set RCR */ ++ /* rtw_write32(padapter, REG_RCR, 0x70002a8e);//CBSSID_DATA must set to 0 */ ++ /* rtw_write32(padapter, REG_RCR, 0x7000228e);//CBSSID_DATA must set to 0 */ ++ if (padapter->registrypriv.wifi_spec) ++ /* for 11n Logo 4.2.31/4.2.32, disable BSSID BCN check for AP mode */ ++ rtw_write32(padapter, REG_RCR, (0x7000208e & ~(RCR_CBSSID_BCN))); ++ else ++ rtw_write32(padapter, REG_RCR, 0x7000208e);/* CBSSID_DATA must set to 0,reject ICV_ERR packet */ ++ /* enable to rx data frame */ ++ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); ++ /* enable to rx ps-poll */ ++ rtw_write16(padapter, REG_RXFLTMAP1, 0x0400); ++ ++ /* Beacon Control related register for first time */ ++ rtw_write8(padapter, REG_BCNDMATIM, 0x02); /* 2ms */ ++ ++ /* rtw_write8(padapter, REG_BCN_MAX_ERR, 0xFF); */ ++ rtw_write8(padapter, REG_ATIMWND, 0x0a); /* 10ms */ ++ rtw_write16(padapter, REG_BCNTCFG, 0x00); ++ rtw_write16(padapter, REG_TBTT_PROHIBIT, 0xff04); ++ rtw_write16(padapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ ++ ++ /* reset TSF */ ++ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(0)); ++ ++ /* enable BCN0 Function for if1 */ ++ /* don't enable update TSF0 for if1 (due to TSF update when beacon/probe rsp are received) */ ++ rtw_write8(padapter, REG_BCN_CTRL, (DIS_TSF_UDT | EN_BCN_FUNCTION | EN_TXBCN_RPT | DIS_BCNQ_SUB)); ++ ++ /* SW_BCN_SEL - Port0 */ ++ /* rtw_write8(Adapter, REG_DWBCN1_CTRL_8192E+2, rtw_read8(Adapter, REG_DWBCN1_CTRL_8192E+2) & ~BIT4); */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); ++ ++ /* select BCN on port 0 */ ++ rtw_write8(padapter, REG_CCK_CHECK_8723D, ++ (rtw_read8(padapter, REG_CCK_CHECK_8723D) & ~BIT_BCN_PORT_SEL)); ++ ++ /* dis BCN1 ATIM WND if if2 is station */ ++ val8 = rtw_read8(padapter, REG_BCN_CTRL_1); ++ val8 |= DIS_ATIM; ++ rtw_write8(padapter, REG_BCN_CTRL_1, val8); ++#ifdef CONFIG_TSF_RESET_OFFLOAD ++ /* Reset TSF for STA+AP concurrent mode */ ++ if (rtw_mi_buddy_check_fwstate(padapter, ++ (WIFI_STATION_STATE | WIFI_ASOC_STATE))) { ++ if (reset_tsf(padapter, HW_PORT0) == _FALSE) ++ RTW_INFO("ERROR! %s()-%d: Reset port0 TSF fail\n", ++ __FUNCTION__, __LINE__); ++ } ++#endif /* CONFIG_TSF_RESET_OFFLOAD */ ++ } ++#endif /* !CONFIG_MI_WITH_MBSSID_CAM */ ++ } ++} ++ ++static void hw_var_set_bcn_func(PADAPTER padapter, u8 variable, u8 *val) ++{ ++ u32 bcn_ctrl_reg; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->hw_port == HW_PORT1) ++ bcn_ctrl_reg = REG_BCN_CTRL_1; ++ else ++#endif ++ { ++ bcn_ctrl_reg = REG_BCN_CTRL; ++ } ++ ++ if (*(u8 *)val) ++ rtw_write8(padapter, bcn_ctrl_reg, (EN_BCN_FUNCTION | EN_TXBCN_RPT)); ++ else { ++ u8 val8; ++ ++ val8 = rtw_read8(padapter, bcn_ctrl_reg); ++ val8 &= ~(EN_BCN_FUNCTION | EN_TXBCN_RPT); ++#ifdef CONFIG_BT_COEXIST ++ /* Always enable port0 beacon function for PSTDMA */ ++ if (REG_BCN_CTRL == bcn_ctrl_reg) ++ val8 |= EN_BCN_FUNCTION; ++#endif ++ rtw_write8(padapter, bcn_ctrl_reg, val8); ++ } ++} ++ ++static void hw_var_set_correct_tsf(PADAPTER padapter, u8 variable, u8 *val) ++{ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ /*do nothing*/ ++#else ++ u8 val8; ++ u64 tsf; ++ struct mlme_ext_priv *pmlmeext; ++ struct mlme_ext_info *pmlmeinfo; ++ ++ ++ pmlmeext = &padapter->mlmeextpriv; ++ pmlmeinfo = &pmlmeext->mlmext_info; ++ ++ tsf = pmlmeext->TSFValue - rtw_modular64(pmlmeext->TSFValue, (pmlmeinfo->bcn_interval * 1024)) - 1024; /* us */ ++ ++ if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || ++ ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) ++ StopTxBeacon(padapter); ++ ++ rtw_hal_correct_tsf(padapter, padapter->hw_port, tsf); ++#ifdef CONFIG_CONCURRENT_MODE ++ /* Update buddy port's TSF if it is SoftAP for beacon TX issue!*/ ++ if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE ++ && rtw_mi_check_status(padapter, MI_AP_MODE)) { ++ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ int i; ++ _adapter *iface; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (!iface) ++ continue; ++ if (iface == padapter) ++ continue; ++ ++ if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE ++ && check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE) { ++ rtw_hal_correct_tsf(iface, iface->hw_port, tsf); ++#ifdef CONFIG_TSF_RESET_OFFLOAD ++ if (reset_tsf(iface, iface->hw_port) == _FALSE) ++ RTW_INFO("%s-[ERROR] "ADPT_FMT" Reset port%d TSF fail\n", __func__, ADPT_ARG(iface), iface->hw_port); ++#endif /* CONFIG_TSF_RESET_OFFLOAD*/ ++ } ++ } ++ } ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) ++ || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) ++ ResumeTxBeacon(padapter); ++#endif /*CONFIG_MI_WITH_MBSSID_CAM*/ ++} ++ ++static void hw_var_set_mlme_disconnect(PADAPTER padapter, u8 variable, u8 *val) ++{ ++ u8 val8; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED) == _FALSE) { ++#else ++ { ++#endif ++ /* Set RCR to not to receive data frame when NO LINK state */ ++ /* rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR) & ~RCR_ADF); */ ++ /* reject all data frames */ ++ rtw_write16(padapter, REG_RXFLTMAP2, 0); ++ } ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->hw_port == HW_PORT1) { ++ /* reset TSF1 */ ++ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(1)); ++ ++ /* disable update TSF1 */ ++ val8 = rtw_read8(padapter, REG_BCN_CTRL_1); ++ val8 |= DIS_TSF_UDT; ++ rtw_write8(padapter, REG_BCN_CTRL_1, val8); ++ } else ++#endif ++ { ++ /* reset TSF */ ++ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(0)); ++ ++ /* disable update TSF */ ++ val8 = rtw_read8(padapter, REG_BCN_CTRL); ++ val8 |= DIS_TSF_UDT; ++ rtw_write8(padapter, REG_BCN_CTRL, val8); ++ } ++} ++ ++static void hw_var_set_mlme_sitesurvey(PADAPTER padapter, u8 variable, u8 *val) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ u32 value_rcr, rcr_clear_bit; ++ u16 value_rxfltmap2; ++ u8 val8; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ int i = 0; ++ _adapter *iface; ++#ifdef DBG_IFACE_STATUS ++ DBG_IFACE_STATUS_DUMP(padapter); ++#endif ++ ++#ifdef CONFIG_FIND_BEST_CHANNEL ++ rcr_clear_bit = (RCR_CBSSID_BCN | RCR_CBSSID_DATA); ++ ++ /* Receive all data frames */ ++ value_rxfltmap2 = 0xFFFF; ++#else /* CONFIG_FIND_BEST_CHANNEL */ ++ ++ rcr_clear_bit = RCR_CBSSID_BCN; ++ ++ /* config RCR to receive different BSSID & not to receive data frame */ ++ value_rxfltmap2 = 0; ++ ++#endif /* CONFIG_FIND_BEST_CHANNEL */ ++ ++ if (rtw_mi_check_fwstate(padapter, WIFI_AP_STATE)) ++ rcr_clear_bit = RCR_CBSSID_BCN; ++ ++#ifdef CONFIG_TDLS ++ /* TDLS will clear RCR_CBSSID_DATA bit for connection. */ ++ else if (padapter->tdlsinfo.link_established == _TRUE) ++ rcr_clear_bit = RCR_CBSSID_BCN; ++#endif /* CONFIG_TDLS */ ++ ++ value_rcr = rtw_read32(padapter, REG_RCR); ++ ++ if (*((u8 *)val)) {/* under sitesurvey */ ++ /* ++ * 1. configure REG_RXFLTMAP2 ++ * 2. disable TSF update & buddy TSF update to avoid updating wrong TSF due to clear RCR_CBSSID_BCN ++ * 3. config RCR to receive different BSSID BCN or probe rsp ++ */ ++ ++ rtw_write16(padapter, REG_RXFLTMAP2, value_rxfltmap2); ++ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ /*do nothing~~*/ ++#else ++ ++ /* disable update TSF */ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (!iface) ++ continue; ++ ++ if (rtw_linked_check(iface) && ++ check_fwstate(&(iface->mlmepriv), WIFI_AP_STATE) != _TRUE) { ++ if (iface->hw_port == HW_PORT1) ++ rtw_write8(iface, REG_BCN_CTRL_1, rtw_read8(iface, REG_BCN_CTRL_1) | DIS_TSF_UDT); ++ else ++ rtw_write8(iface, REG_BCN_CTRL, rtw_read8(iface, REG_BCN_CTRL) | DIS_TSF_UDT); ++ ++ iface->mlmeextpriv.en_hw_update_tsf = _FALSE; ++ } ++ ++ } ++#endif ++ ++ value_rcr &= ~(rcr_clear_bit); ++ rtw_write32(padapter, REG_RCR, value_rcr); ++ ++ /* Save orignal RRSR setting. */ ++ pHalData->RegRRSR = rtw_read16(padapter, REG_RRSR); ++ ++ if (rtw_mi_check_status(padapter, MI_AP_MODE)) ++ StopTxBeacon(padapter); ++ } else {/* sitesurvey done */ ++ /* ++ * 1. enable rx data frame ++ * 2. config RCR not to receive different BSSID BCN or probe rsp ++ * 3. doesn't enable TSF update & buddy TSF right now to avoid HW conflict ++ *so, we enable TSF update when rx first BCN after sitesurvey done ++ */ ++ if (rtw_mi_check_fwstate(padapter, _FW_LINKED | WIFI_AP_STATE)) { ++ /*enable to rx data frame*/ ++ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); ++ } ++ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ value_rcr &= ~(RCR_CBSSID_BCN | RCR_CBSSID_DATA); ++#else ++ value_rcr |= rcr_clear_bit; ++#endif ++ /* for 11n Logo 4.2.31/4.2.32, disable BSSID BCN check for AP mode */ ++ if (padapter->registrypriv.wifi_spec && MLME_IS_AP(padapter)) ++ value_rcr &= ~(RCR_CBSSID_BCN); ++ ++ rtw_write32(padapter, REG_RCR, value_rcr); ++ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ /*if ((rtw_mi_get_assoced_sta_num(Adapter) == 1) && (!rtw_mi_check_status(Adapter, MI_AP_MODE))) ++ rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)&(~DIS_TSF_UDT));*/ ++#else ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (!iface) ++ continue; ++ if (rtw_linked_check(iface) && ++ check_fwstate(&(iface->mlmepriv), WIFI_AP_STATE) != _TRUE) { ++ /* enable HW TSF update when recive beacon*/ ++ /*if (iface->hw_port == HW_PORT1) ++ rtw_write8(iface, REG_BCN_CTRL_1, rtw_read8(iface, REG_BCN_CTRL_1)&(~(DIS_TSF_UDT))); ++ else ++ rtw_write8(iface, REG_BCN_CTRL, rtw_read8(iface, REG_BCN_CTRL)&(~(DIS_TSF_UDT))); ++ */ ++ iface->mlmeextpriv.en_hw_update_tsf = _TRUE; ++ } ++ } ++#endif ++ ++ /*Restore orignal RRSR setting.*/ ++ rtw_write16(padapter, REG_RRSR, pHalData->RegRRSR); ++#ifdef CONFIG_AP_MODE ++ if (rtw_mi_check_status(padapter, MI_AP_MODE)) { ++ ResumeTxBeacon(padapter); ++ rtw_mi_tx_beacon_hdl(padapter); ++ } ++#endif ++ } ++} ++ ++static void hw_var_set_mlme_join(PADAPTER padapter, u8 variable, u8 *val) ++{ ++ u8 val8; ++ u16 val16; ++ u32 val32; ++ u8 RetryLimit; ++ u8 type; ++ PHAL_DATA_TYPE pHalData; ++ struct mlme_priv *pmlmepriv; ++ ++ RetryLimit = 0x30; ++ type = *(u8 *)val; ++ pHalData = GET_HAL_DATA(padapter); ++ pmlmepriv = &padapter->mlmepriv; ++#ifdef CONFIG_CONCURRENT_MODE ++ if (type == 0) { ++ /* prepare to join */ ++ if (rtw_mi_check_status(padapter, MI_AP_MODE)) ++ StopTxBeacon(padapter); ++ ++ /* enable to rx data frame.Accept all data frame */ ++ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ /* ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && (rtw_mi_get_assoced_sta_num(padapter) == 1)) ++ rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_CBSSID_DATA|RCR_CBSSID_BCN); ++ else if ((rtw_mi_get_ap_num(Adapter) == 1) && (rtw_mi_get_assoced_sta_num(Adapter) == 1)) ++ rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_CBSSID_BCN); ++ else*/ ++ rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR) & (~(RCR_CBSSID_DATA | RCR_CBSSID_BCN))); ++#else ++ if (rtw_mi_check_status(padapter, MI_AP_MODE)) { ++ val32 = rtw_read32(padapter, REG_RCR); ++ val32 |= RCR_CBSSID_BCN; ++ rtw_write32(padapter, REG_RCR, val32); ++ } else { ++ val32 = rtw_read32(padapter, REG_RCR); ++ val32 |= RCR_CBSSID_DATA | RCR_CBSSID_BCN; ++ rtw_write32(padapter, REG_RCR, val32); ++ } ++#endif ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) ++ RetryLimit = (pHalData->CustomerID == RT_CID_CCX) ? 7 : 48; ++ else /* Ad-hoc Mode */ ++ RetryLimit = 0x7; ++ } else if (type == 1) { ++ /* joinbss_event call back when join res < 0 */ ++ if (rtw_mi_check_status(padapter, MI_LINKED) == _FALSE) ++ rtw_write16(padapter, REG_RXFLTMAP2, 0x00); ++ ++ if (rtw_mi_check_status(padapter, MI_AP_MODE)) { ++ ResumeTxBeacon(padapter); ++ /* reset TSF 1/2 after ResumeTxBeacon */ ++ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(1) | BIT(0)); ++ } ++ } else if (type == 2) { ++ /* sta add event call back */ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ /*if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && (rtw_mi_get_assoced_sta_num(padapter) == 1)) ++ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)&(~DIS_TSF_UDT));*/ ++#else ++ /* enable update TSF */ ++ if (padapter->hw_port == HW_PORT1) { ++ val8 = rtw_read8(padapter, REG_BCN_CTRL_1); ++ val8 &= ~DIS_TSF_UDT; ++ rtw_write8(padapter, REG_BCN_CTRL_1, val8); ++ } else { ++ val8 = rtw_read8(padapter, REG_BCN_CTRL); ++ val8 &= ~DIS_TSF_UDT; ++ rtw_write8(padapter, REG_BCN_CTRL, val8); ++ } ++#endif ++ if (check_fwstate(pmlmepriv, ++ WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { ++ rtw_write8(padapter, 0x542 , 0x02); ++ RetryLimit = 0x7; ++ } ++ ++ if (rtw_mi_check_status(padapter, MI_AP_MODE)) { ++ ResumeTxBeacon(padapter); ++ ++ /* reset TSF 1/2 after ResumeTxBeacon */ ++ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(1) | BIT(0)); ++ } ++ } ++ ++ val16 = (RetryLimit << RETRY_LIMIT_SHORT_SHIFT) | (RetryLimit << RETRY_LIMIT_LONG_SHIFT); ++ rtw_write16(padapter, REG_RL, val16); ++#else /* !CONFIG_CONCURRENT_MODE */ ++ if (type == 0) { /* prepare to join */ ++ /* enable to rx data frame.Accept all data frame */ ++ /* rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_ADF); */ ++ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); ++ ++ val32 = rtw_read32(padapter, REG_RCR); ++ if (padapter->in_cta_test) ++ val32 &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN);/* | RCR_ADF */ ++ else ++ val32 |= RCR_CBSSID_DATA | RCR_CBSSID_BCN; ++ rtw_write32(padapter, REG_RCR, val32); ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) ++ RetryLimit = (pHalData->CustomerID == RT_CID_CCX) ? 7 : 48; ++ else /* Ad-hoc Mode */ ++ RetryLimit = 0x7; ++ } else if (type == 1) /* joinbss_event call back when join res < 0 */ ++ rtw_write16(padapter, REG_RXFLTMAP2, 0x00); ++ else if (type == 2) { /* sta add event call back */ ++ /* enable update TSF */ ++ val8 = rtw_read8(padapter, REG_BCN_CTRL); ++ val8 &= ~DIS_TSF_UDT; ++ rtw_write8(padapter, REG_BCN_CTRL, val8); ++ ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) ++ RetryLimit = 0x7; ++ } ++ ++ val16 = (RetryLimit << RETRY_LIMIT_SHORT_SHIFT) | (RetryLimit << RETRY_LIMIT_LONG_SHIFT); ++ rtw_write16(padapter, REG_RL, val16); ++#endif /* !CONFIG_CONCURRENT_MODE */ ++} ++ ++void CCX_FwC2HTxRpt_8723d(PADAPTER padapter, u8 *pdata, u8 len) ++{ ++ u8 seq_no; ++ ++#define GET_8723D_C2H_TX_RPT_LIFE_TIME_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 6, 1) ++#define GET_8723D_C2H_TX_RPT_RETRY_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 7, 1) ++ ++ /* RTW_INFO("%s, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n", __func__, */ ++ /**pdata, *(pdata+1), *(pdata+2), *(pdata+3), *(pdata+4), *(pdata+5), *(pdata+6), *(pdata+7)); */ ++ ++ seq_no = *(pdata + 6); ++ ++#ifdef CONFIG_XMIT_ACK ++ if (GET_8723D_C2H_TX_RPT_RETRY_OVER(pdata) | GET_8723D_C2H_TX_RPT_LIFE_TIME_OVER(pdata)) ++ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_CCX_PKT_FAIL); ++ /* ++ else if(seq_no != padapter->xmitpriv.seq_no) { ++ RTW_INFO("tx_seq_no=%d, rpt_seq_no=%d\n", padapter->xmitpriv.seq_no, seq_no); ++ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_CCX_PKT_FAIL); ++ } ++ */ ++ else ++ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_SUCCESS); ++#endif ++} ++ ++s32 c2h_handler_8723d(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) ++{ ++ s32 ret = _SUCCESS; ++ ++ switch (id) { ++ case C2H_CCX_TX_RPT: ++ CCX_FwC2HTxRpt_8723d(adapter, payload, plen); ++ break; ++ default: ++ ret = _FAIL; ++ break; ++ } ++ ++exit: ++ return ret; ++} ++ ++void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ u8 val8; ++ u16 val16; ++ u32 val32; ++ ++ ++ switch (variable) { ++ case HW_VAR_SET_OPMODE: ++ hw_var_set_opmode(padapter, variable, val); ++ break; ++ ++ case HW_VAR_BASIC_RATE: ++ { ++ struct mlme_ext_info *mlmext_info = &padapter->mlmeextpriv.mlmext_info; ++ u16 input_b = 0, masked = 0, ioted = 0, BrateCfg = 0; ++ u16 rrsr_2g_force_mask = RRSR_CCK_RATES; ++ u16 rrsr_2g_allow_mask = (RRSR_24M | RRSR_12M | RRSR_6M | RRSR_CCK_RATES); ++ ++ HalSetBrateCfg(padapter, val, &BrateCfg); ++ input_b = BrateCfg; ++ ++ /* apply force and allow mask */ ++ BrateCfg |= rrsr_2g_force_mask; ++ BrateCfg &= rrsr_2g_allow_mask; ++ masked = BrateCfg; ++ ++#ifdef CONFIG_CMCC_TEST ++ BrateCfg |= (RRSR_11M | RRSR_5_5M | RRSR_1M); /* use 11M to send ACK */ ++ BrateCfg |= (RRSR_24M | RRSR_18M | RRSR_12M); /* CMCC_OFDM_ACK 12/18/24M */ ++#endif ++ ++ /* IOT consideration */ ++ if (mlmext_info->assoc_AP_vendor == HT_IOT_PEER_CISCO) { ++ /* if peer is cisco and didn't use ofdm rate, we enable 6M ack */ ++ if ((BrateCfg & (RRSR_24M | RRSR_12M | RRSR_6M)) == 0) ++ BrateCfg |= RRSR_6M; ++ } ++ ioted = BrateCfg; ++ ++ pHalData->BasicRateSet = BrateCfg; ++ ++ RTW_INFO("HW_VAR_BASIC_RATE: %#x->%#x->%#x\n", input_b, masked, ioted); ++ ++ /* Set RRSR rate table. */ ++ rtw_write16(padapter, REG_RRSR, BrateCfg); ++ rtw_write8(padapter, REG_RRSR + 2, rtw_read8(padapter, REG_RRSR + 2) & 0xf0); ++ } ++ break; ++ ++ case HW_VAR_TXPAUSE: ++ rtw_write8(padapter, REG_TXPAUSE, *val); ++ break; ++ ++ case HW_VAR_BCN_FUNC: ++ hw_var_set_bcn_func(padapter, variable, val); ++ break; ++ ++ case HW_VAR_CORRECT_TSF: ++ hw_var_set_correct_tsf(padapter, variable, val); ++ break; ++ ++ case HW_VAR_CHECK_BSSID: ++ { ++ u32 val32; ++ val32 = rtw_read32(padapter, REG_RCR); ++ if (*val) ++ val32 |= RCR_CBSSID_DATA | RCR_CBSSID_BCN; ++ else ++ val32 &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN); ++ rtw_write32(padapter, REG_RCR, val32); ++ } ++ break; ++ ++ case HW_VAR_MLME_DISCONNECT: ++ hw_var_set_mlme_disconnect(padapter, variable, val); ++ break; ++ ++ case HW_VAR_MLME_SITESURVEY: ++ hw_var_set_mlme_sitesurvey(padapter, variable, val); ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_ScanNotify(padapter, *val ? _TRUE : _FALSE); ++#endif /* CONFIG_BT_COEXIST */ ++ break; ++ ++ case HW_VAR_MLME_JOIN: ++ hw_var_set_mlme_join(padapter, variable, val); ++ ++#ifdef CONFIG_BT_COEXIST ++ switch (*val) { ++ case 0: ++ /* prepare to join */ ++ rtw_btcoex_ConnectNotify(padapter, _TRUE); ++ break; ++ case 1: ++ case 2: ++ rtw_btcoex_ConnectNotify(padapter, _FALSE); ++ break; ++ } ++#endif /* CONFIG_BT_COEXIST */ ++ break; ++ ++ case HW_VAR_ON_RCR_AM: ++ val32 = rtw_read32(padapter, REG_RCR); ++ val32 |= RCR_AM; ++ rtw_write32(padapter, REG_RCR, val32); ++ RTW_INFO("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(padapter, REG_RCR)); ++ break; ++ ++ case HW_VAR_OFF_RCR_AM: ++ val32 = rtw_read32(padapter, REG_RCR); ++ val32 &= ~RCR_AM; ++ rtw_write32(padapter, REG_RCR, val32); ++ RTW_INFO("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(padapter, REG_RCR)); ++ break; ++ ++ case HW_VAR_BEACON_INTERVAL: ++ rtw_write16(padapter, REG_BCN_INTERVAL, *((u16 *)val)); ++ break; ++ ++ case HW_VAR_SLOT_TIME: ++ rtw_write8(padapter, REG_SLOT, *val); ++ break; ++ ++ case HW_VAR_RESP_SIFS: ++#if 0 ++ /* SIFS for OFDM Data ACK */ ++ rtw_write8(padapter, REG_SIFS_CTX + 1, val[0]); ++ /* SIFS for OFDM consecutive tx like CTS data! */ ++ rtw_write8(padapter, REG_SIFS_TRX + 1, val[1]); ++ ++ rtw_write8(padapter, REG_SPEC_SIFS + 1, val[0]); ++ rtw_write8(padapter, REG_MAC_SPEC_SIFS + 1, val[0]); ++ ++ /* 20100719 Joseph: Revise SIFS setting due to Hardware register definition change. */ ++ rtw_write8(padapter, REG_R2T_SIFS + 1, val[0]); ++ rtw_write8(padapter, REG_T2T_SIFS + 1, val[0]); ++ ++#else ++ /* SIFS_Timer = 0x0a0a0808; */ ++ /* RESP_SIFS for CCK */ ++ rtw_write8(padapter, REG_RESP_SIFS_CCK, val[0]); /* SIFS_T2T_CCK (0x08) */ ++ rtw_write8(padapter, REG_RESP_SIFS_CCK + 1, val[1]); /* SIFS_R2T_CCK(0x08) */ ++ /* RESP_SIFS for OFDM */ ++ rtw_write8(padapter, REG_RESP_SIFS_OFDM, val[2]); /* SIFS_T2T_OFDM (0x0a) */ ++ rtw_write8(padapter, REG_RESP_SIFS_OFDM + 1, val[3]); /* SIFS_R2T_OFDM(0x0a) */ ++#endif ++ break; ++ ++ case HW_VAR_ACK_PREAMBLE: { ++ u8 regTmp; ++ u8 bShortPreamble = *val; ++ ++ /* Joseph marked out for Netgear 3500 TKIP channel 7 issue.(Temporarily) */ ++ /* regTmp = (pHalData->nCur40MhzPrimeSC)<<5; */ ++ regTmp = 0; ++ if (bShortPreamble) ++ regTmp |= 0x80; ++ rtw_write8(padapter, REG_RRSR + 2, regTmp); ++ } ++ break; ++ ++ case HW_VAR_CAM_EMPTY_ENTRY: { ++ u8 ucIndex = *val; ++ u8 i; ++ u32 ulCommand = 0; ++ u32 ulContent = 0; ++ u32 ulEncAlgo = CAM_AES; ++ ++ for (i = 0; i < CAM_CONTENT_COUNT; i++) { ++ /* filled id in CAM config 2 byte */ ++ if (i == 0) { ++ ulContent |= (ucIndex & 0x03) | ((u16)(ulEncAlgo) << 2); ++ /* ulContent |= CAM_VALID; */ ++ } else ++ ulContent = 0; ++ /* polling bit, and No Write enable, and address */ ++ ulCommand = CAM_CONTENT_COUNT * ucIndex + i; ++ ulCommand = ulCommand | CAM_POLLINIG | CAM_WRITE; ++ /* write content 0 is equall to mark invalid */ ++ rtw_write32(padapter, WCAMI, ulContent); /* delay_ms(40); */ ++ rtw_write32(padapter, RWCAM, ulCommand); /* delay_ms(40); */ ++ } ++ } ++ break; ++ ++ case HW_VAR_CAM_INVALID_ALL: ++ rtw_write32(padapter, RWCAM, BIT(31) | BIT(30)); ++ break; ++ ++ case HW_VAR_AC_PARAM_VO: ++ rtw_write32(padapter, REG_EDCA_VO_PARAM, *((u32 *)val)); ++ break; ++ ++ case HW_VAR_AC_PARAM_VI: ++ rtw_write32(padapter, REG_EDCA_VI_PARAM, *((u32 *)val)); ++ break; ++ ++ case HW_VAR_AC_PARAM_BE: ++ pHalData->AcParam_BE = ((u32 *)(val))[0]; ++ rtw_write32(padapter, REG_EDCA_BE_PARAM, *((u32 *)val)); ++ break; ++ ++ case HW_VAR_AC_PARAM_BK: ++ rtw_write32(padapter, REG_EDCA_BK_PARAM, *((u32 *)val)); ++ break; ++ ++ case HW_VAR_ACM_CTRL: { ++ u8 ctrl = *((u8 *)val); ++ u8 hwctrl = 0; ++ ++ if (ctrl != 0) { ++ hwctrl |= AcmHw_HwEn; ++ ++ if (ctrl & BIT(1)) /* BE */ ++ hwctrl |= AcmHw_BeqEn; ++ ++ if (ctrl & BIT(2)) /* VI */ ++ hwctrl |= AcmHw_ViqEn; ++ ++ if (ctrl & BIT(3)) /* VO */ ++ hwctrl |= AcmHw_VoqEn; ++ } ++ ++ RTW_INFO("[HW_VAR_ACM_CTRL] Write 0x%02X\n", hwctrl); ++ rtw_write8(padapter, REG_ACMHWCTRL, hwctrl); ++ } ++ break; ++ ++ case HW_VAR_AMPDU_FACTOR: { ++#ifdef CONFIG_80211N_HT ++ u32 AMPDULen = (*((u8 *)val)); ++ ++ if (AMPDULen < HT_AGG_SIZE_32K) ++ AMPDULen = (0x2000 << (*((u8 *)val))) - 1; ++ else ++ AMPDULen = 0x7fff; ++ ++ rtw_write32(padapter, REG_AMPDU_MAX_LENGTH_8723D, AMPDULen); ++#endif /* CONFIG_80211N_HT */ ++ } ++ break; ++ ++#if 0 ++ case HW_VAR_RXDMA_AGG_PG_TH: ++ rtw_write8(padapter, REG_RXDMA_AGG_PG_TH, *val); ++ break; ++#endif ++ ++ case HW_VAR_H2C_FW_PWRMODE: { ++ u8 psmode = *val; ++ ++ /* Forece leave RF low power mode for 1T1R to prevent conficting setting in Fw power */ ++ /* saving sequence. 2010.06.07. Added by tynli. Suggested by SD3 yschang. */ ++ if (psmode != PS_MODE_ACTIVE) ++ ODM_RF_Saving(&pHalData->odmpriv, _TRUE); ++ ++ /* if (psmode != PS_MODE_ACTIVE) { */ ++ /*rtl8723d_set_lowpwr_lps_cmd(padapter, _TRUE); */ ++ /* } else { */ ++ /* rtl8723d_set_lowpwr_lps_cmd(padapter, _FALSE); */ ++ /* } */ ++ rtl8723d_set_FwPwrMode_cmd(padapter, psmode); ++ } ++ break; ++ case HW_VAR_H2C_PS_TUNE_PARAM: ++ rtl8723d_set_FwPsTuneParam_cmd(padapter); ++ break; ++ ++ case HW_VAR_H2C_FW_JOINBSSRPT: ++ rtl8723d_set_FwJoinBssRpt_cmd(padapter, *val); ++#ifdef CONFIG_LPS_POFF ++ rtl8723d_lps_poff_h2c_ctrl(padapter, *val); ++#endif ++ break; ++ ++#ifdef CONFIG_P2P ++ case HW_VAR_H2C_FW_P2P_PS_OFFLOAD: ++ rtl8723d_set_p2p_ps_offload_cmd(padapter, *val); ++ break; ++#endif /* CONFIG_P2P */ ++#ifdef CONFIG_LPS_POFF ++ case HW_VAR_LPS_POFF_INIT: ++ rtl8723d_lps_poff_init(padapter); ++ break; ++ case HW_VAR_LPS_POFF_DEINIT: ++ rtl8723d_lps_poff_deinit(padapter); ++ break; ++ case HW_VAR_LPS_POFF_SET_MODE: ++ rtl8723d_lps_poff_set_ps_mode(padapter, *val); ++ break; ++ case HW_VAR_LPS_POFF_WOW_EN: ++ rtl8723d_lps_poff_h2c_ctrl(padapter, *val); ++ break; ++#endif /*CONFIG_LPS_POFF*/ ++#ifdef CONFIG_TDLS ++ case HW_VAR_TDLS_WRCR: ++ rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR) & (~RCR_CBSSID_DATA)); ++ break; ++ case HW_VAR_TDLS_RS_RCR: ++ rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR) | (RCR_CBSSID_DATA)); ++ break; ++#endif /* CONFIG_TDLS */ ++ ++ case HW_VAR_EFUSE_USAGE: ++ pHalData->EfuseUsedPercentage = *val; ++ break; ++ ++ case HW_VAR_EFUSE_BYTES: ++ pHalData->EfuseUsedBytes = *((u16 *)val); ++ break; ++ ++ case HW_VAR_EFUSE_BT_USAGE: ++#ifdef HAL_EFUSE_MEMORY ++ pHalData->EfuseHal.BTEfuseUsedPercentage = *val; ++#endif ++ break; ++ ++ case HW_VAR_EFUSE_BT_BYTES: ++#ifdef HAL_EFUSE_MEMORY ++ pHalData->EfuseHal.BTEfuseUsedBytes = *((u16 *)val); ++#else ++ BTEfuseUsedBytes = *((u16 *)val); ++#endif ++ break; ++ ++ case HW_VAR_FIFO_CLEARN_UP: { ++#define RW_RELEASE_EN BIT(18) ++#define RXDMA_IDLE BIT(17) ++ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ u8 trycnt = 100; ++ ++ /* pause tx */ ++ rtw_write8(padapter, REG_TXPAUSE, 0xff); ++ ++ /* keep sn */ ++ padapter->xmitpriv.nqos_ssn = rtw_read16(padapter, REG_NQOS_SEQ); ++ ++ if (pwrpriv->bkeepfwalive != _TRUE) { ++ /* RX DMA stop */ ++ val32 = rtw_read32(padapter, REG_RXPKT_NUM); ++ val32 |= RW_RELEASE_EN; ++ rtw_write32(padapter, REG_RXPKT_NUM, val32); ++ do { ++ val32 = rtw_read32(padapter, REG_RXPKT_NUM); ++ val32 &= RXDMA_IDLE; ++ if (val32) ++ break; ++ ++ RTW_INFO("%s: [HW_VAR_FIFO_CLEARN_UP] val=%x times:%d\n", __FUNCTION__, val32, trycnt); ++ } while (--trycnt); ++ if (trycnt == 0) ++ RTW_INFO("[HW_VAR_FIFO_CLEARN_UP] Stop RX DMA failed......\n"); ++ ++ /* RQPN Load 0 */ ++ rtw_write16(padapter, REG_RQPN_NPQ, 0); ++ rtw_write32(padapter, REG_RQPN, 0x80000000); ++ rtw_mdelay_os(2); ++ } ++ } ++ break; ++ ++ case HW_VAR_RESTORE_HW_SEQ: ++ /* restore Sequence No. */ ++ rtw_write8(padapter, 0x4dc, padapter->xmitpriv.nqos_ssn); ++ break; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ case HW_VAR_CHECK_TXBUF: { ++ u32 i; ++ u8 RetryLimit = 0x01; ++ u32 reg_200, reg_204; ++ ++ val16 = RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT; ++ rtw_write16(padapter, REG_RL, val16); ++ ++ for (i = 0; i < 200; i++) { /* polling 200x10=2000 msec */ ++ reg_200 = rtw_read32(padapter, 0x200); ++ reg_204 = rtw_read32(padapter, 0x204); ++ if (reg_200 != reg_204) { ++ /* RTW_INFO("packet in tx packet buffer - 0x204=%x, 0x200=%x (%d)\n", rtw_read32(padapter, 0x204), rtw_read32(padapter, 0x200), i); */ ++ rtw_msleep_os(10); ++ } else { ++ RTW_INFO("[HW_VAR_CHECK_TXBUF] no packet in tx packet buffer (%d)\n", i); ++ break; ++ } ++ } ++ ++ if (reg_200 != reg_204) ++ RTW_INFO("packets in tx buffer - 0x204=%x, 0x200=%x\n", reg_204, reg_200); ++ ++ RetryLimit = 0x30; ++ val16 = RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT; ++ rtw_write16(padapter, REG_RL, val16); ++ } ++ break; ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ case HW_VAR_NAV_UPPER: { ++ u32 usNavUpper = *((u32 *)val); ++ ++ if (usNavUpper > HAL_NAV_UPPER_UNIT_8723D * 0xFF) { ++ break; ++ } ++ ++ /* The value of ((usNavUpper + HAL_NAV_UPPER_UNIT_8723D - 1) / HAL_NAV_UPPER_UNIT_8723D) */ ++ /* is getting the upper integer. */ ++ usNavUpper = (usNavUpper + HAL_NAV_UPPER_UNIT_8723D - 1) / HAL_NAV_UPPER_UNIT_8723D; ++ rtw_write8(padapter, REG_NAV_UPPER, (u8)usNavUpper); ++ } ++ break; ++ ++ case HW_VAR_BCN_VALID: ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->hw_port == HW_PORT1) { ++ val8 = rtw_read8(padapter, REG_DWBCN1_CTRL_8723D + 2); ++ val8 |= BIT(0); ++ rtw_write8(padapter, REG_DWBCN1_CTRL_8723D + 2, val8); ++ } else ++#endif /* CONFIG_CONCURRENT_MODE */ ++ { ++ /* BCN_VALID, BIT16 of REG_TDECTRL = BIT0 of REG_TDECTRL+2, write 1 to clear, Clear by sw */ ++ val8 = rtw_read8(padapter, REG_TDECTRL + 2); ++ val8 |= BIT(0); ++ rtw_write8(padapter, REG_TDECTRL + 2, val8); ++ } ++ break; ++ case HW_VAR_DL_BCN_SEL: ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->hw_port == HW_PORT1) { ++ /* SW_BCN_SEL - Port1 */ ++ val8 = rtw_read8(padapter, REG_DWBCN1_CTRL_8723D + 2); ++ val8 |= BIT(4); ++ rtw_write8(padapter, REG_DWBCN1_CTRL_8723D + 2, val8); ++ } else ++#endif /* CONFIG_CONCURRENT_MODE */ ++ { ++ /* SW_BCN_SEL - Port0 */ ++ val8 = rtw_read8(padapter, REG_DWBCN1_CTRL_8723D + 2); ++ val8 &= ~BIT(4); ++ rtw_write8(padapter, REG_DWBCN1_CTRL_8723D + 2, val8); ++ } ++ break; ++ case HW_VAR_DO_IQK: ++ if (*val) ++ pHalData->bNeedIQK = _TRUE; ++ else ++ pHalData->bNeedIQK = _FALSE; ++ break; ++ ++ case HW_VAR_DL_RSVD_PAGE: ++#ifdef CONFIG_BT_COEXIST ++ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) ++ rtl8723d_download_BTCoex_AP_mode_rsvd_page(padapter); ++ else ++#endif /* CONFIG_BT_COEXIST */ ++ { ++ rtl8723d_download_rsvd_page(padapter, RT_MEDIA_CONNECT); ++ } ++ break; ++ ++ case HW_VAR_MACID_SLEEP: { ++ u32 reg_macid_sleep; ++ u8 bit_shift; ++ u8 id = *(u8 *)val; ++ ++ if (id < 32) { ++ reg_macid_sleep = REG_MACID_SLEEP; ++ bit_shift = id; ++ } else if (id < 64) { ++ reg_macid_sleep = REG_MACID_SLEEP_1; ++ bit_shift = id - 32; ++ } else if (id < 96) { ++ reg_macid_sleep = REG_MACID_SLEEP_2; ++ bit_shift = id - 64; ++ } else if (id < 128) { ++ reg_macid_sleep = REG_MACID_SLEEP_3; ++ bit_shift = id - 96; ++ } else { ++ rtw_warn_on(1); ++ break; ++ } ++ ++ val32 = rtw_read32(padapter, reg_macid_sleep); ++ RTW_INFO(FUNC_ADPT_FMT ": [HW_VAR_MACID_SLEEP] macid=%d, org reg_0x%03x=0x%08X\n", ++ FUNC_ADPT_ARG(padapter), id, reg_macid_sleep, val32); ++ ++ if (val32 & BIT(bit_shift)) ++ break; ++ ++ val32 |= BIT(bit_shift); ++ rtw_write32(padapter, reg_macid_sleep, val32); ++ } ++ break; ++ case HW_VAR_MACID_WAKEUP: { ++ u32 reg_macid_sleep; ++ u8 bit_shift; ++ u8 id = *(u8 *)val; ++ ++ if (id < 32) { ++ reg_macid_sleep = REG_MACID_SLEEP; ++ bit_shift = id; ++ } else if (id < 64) { ++ reg_macid_sleep = REG_MACID_SLEEP_1; ++ bit_shift = id - 32; ++ } else if (id < 96) { ++ reg_macid_sleep = REG_MACID_SLEEP_2; ++ bit_shift = id - 64; ++ } else if (id < 128) { ++ reg_macid_sleep = REG_MACID_SLEEP_3; ++ bit_shift = id - 96; ++ } else { ++ rtw_warn_on(1); ++ break; ++ } ++ ++ val32 = rtw_read32(padapter, reg_macid_sleep); ++ RTW_INFO(FUNC_ADPT_FMT ": [HW_VAR_MACID_WAKEUP] macid=%d, org reg_0x%03x=0x%08X\n", ++ FUNC_ADPT_ARG(padapter), id, reg_macid_sleep, val32); ++ ++ if (!(val32 & BIT(bit_shift))) ++ break; ++ ++ val32 &= ~BIT(bit_shift); ++ rtw_write32(padapter, reg_macid_sleep, val32); ++ } ++ break; ++ default: ++ SetHwReg(padapter, variable, val); ++ break; ++ } ++ ++} ++ ++struct qinfo_8723d { ++ u32 head:8; ++ u32 pkt_num:7; ++ u32 tail:8; ++ u32 ac:2; ++ u32 macid:7; ++}; ++ ++struct bcn_qinfo_8723d { ++ u16 head:8; ++ u16 pkt_num:8; ++}; ++ ++void dump_qinfo_8723d(void *sel, struct qinfo_8723d *info, const char *tag) ++{ ++ /* if (info->pkt_num) */ ++ RTW_PRINT_SEL(sel, "%shead:0x%02x, tail:0x%02x, pkt_num:%u, macid:%u, ac:%u\n" ++ , tag ? tag : "", info->head, info->tail, ++ info->pkt_num, info->macid, info->ac); ++} ++ ++void dump_bcn_qinfo_8723d(void *sel, struct bcn_qinfo_8723d *info, const char *tag) ++{ ++ /* if (info->pkt_num) */ ++ RTW_PRINT_SEL(sel, "%shead:0x%02x, pkt_num:%u\n" ++ , tag ? tag : "", info->head, info->pkt_num); ++} ++ ++void dump_mac_qinfo_8723d(void *sel, _adapter *adapter) ++{ ++ u32 q0_info; ++ u32 q1_info; ++ u32 q2_info; ++ u32 q3_info; ++ u32 q4_info; ++ u32 q5_info; ++ u32 q6_info; ++ u32 q7_info; ++ u32 mg_q_info; ++ u32 hi_q_info; ++ u16 bcn_q_info; ++ ++ q0_info = rtw_read32(adapter, REG_Q0_INFO); ++ q1_info = rtw_read32(adapter, REG_Q1_INFO); ++ q2_info = rtw_read32(adapter, REG_Q2_INFO); ++ q3_info = rtw_read32(adapter, REG_Q3_INFO); ++ q4_info = rtw_read32(adapter, REG_Q4_INFO); ++ q5_info = rtw_read32(adapter, REG_Q5_INFO); ++ q6_info = rtw_read32(adapter, REG_Q6_INFO); ++ q7_info = rtw_read32(adapter, REG_Q7_INFO); ++ mg_q_info = rtw_read32(adapter, REG_MGQ_INFO); ++ hi_q_info = rtw_read32(adapter, REG_HGQ_INFO); ++ bcn_q_info = rtw_read16(adapter, REG_BCNQ_INFO); ++ ++ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q0_info, "Q0 "); ++ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q1_info, "Q1 "); ++ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q2_info, "Q2 "); ++ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q3_info, "Q3 "); ++ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q4_info, "Q4 "); ++ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q5_info, "Q5 "); ++ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q6_info, "Q6 "); ++ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q7_info, "Q7 "); ++ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&mg_q_info, "MG "); ++ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&hi_q_info, "HI "); ++ dump_bcn_qinfo_8723d(sel, (struct bcn_qinfo_8723d *)&bcn_q_info, "BCN "); ++} ++ ++void GetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ u8 val8; ++ u16 val16; ++ u32 val32; ++ ++ switch (variable) { ++ case HW_VAR_TXPAUSE: ++ *val = rtw_read8(padapter, REG_TXPAUSE); ++ break; ++ ++ case HW_VAR_BCN_VALID: ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->hw_port == HW_PORT1) { ++ val8 = rtw_read8(padapter, REG_DWBCN1_CTRL_8723D + 2); ++ *val = (BIT(0) & val8) ? _TRUE : _FALSE; ++ } else ++#endif ++ { ++ /* BCN_VALID, BIT16 of REG_TDECTRL = BIT0 of REG_TDECTRL+2 */ ++ val8 = rtw_read8(padapter, REG_TDECTRL + 2); ++ *val = (BIT(0) & val8) ? _TRUE : _FALSE; ++ } ++ break; ++ ++ case HW_VAR_FWLPS_RF_ON: { ++ /* When we halt NIC, we should check if FW LPS is leave. */ ++ u32 valRCR; ++ ++ if (rtw_is_surprise_removed(padapter) || ++ (adapter_to_pwrctl(padapter)->rf_pwrstate == rf_off)) { ++ /* If it is in HW/SW Radio OFF or IPS state, we do not check Fw LPS Leave, */ ++ /* because Fw is unload. */ ++ *val = _TRUE; ++ } else { ++ valRCR = rtw_read32(padapter, REG_RCR); ++ valRCR &= 0x00070000; ++ if (valRCR) ++ *val = _FALSE; ++ else ++ *val = _TRUE; ++ } ++ } ++ break; ++ ++ case HW_VAR_EFUSE_USAGE: ++ *val = pHalData->EfuseUsedPercentage; ++ break; ++ ++ case HW_VAR_EFUSE_BYTES: ++ *((u16 *)val) = pHalData->EfuseUsedBytes; ++ break; ++ ++ case HW_VAR_EFUSE_BT_USAGE: ++#ifdef HAL_EFUSE_MEMORY ++ *val = pHalData->EfuseHal.BTEfuseUsedPercentage; ++#endif ++ break; ++ ++ case HW_VAR_EFUSE_BT_BYTES: ++#ifdef HAL_EFUSE_MEMORY ++ *((u16 *)val) = pHalData->EfuseHal.BTEfuseUsedBytes; ++#else ++ *((u16 *)val) = BTEfuseUsedBytes; ++#endif ++ break; ++ ++ case HW_VAR_CHK_HI_QUEUE_EMPTY: ++ val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); ++ *val = (val16 & BIT(10)) ? _TRUE : _FALSE; ++ break; ++#ifdef CONFIG_WOWLAN ++ case HW_VAR_RPWM_TOG: ++ *val = rtw_read8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1) & BIT(7); ++ break; ++ case HW_VAR_WAKEUP_REASON: ++ *val = rtw_read8(padapter, REG_WOWLAN_WAKE_REASON); ++ if (*val == 0xEA) ++ *val = 0; ++ break; ++ case HW_VAR_SYS_CLKR: ++ *val = rtw_read8(padapter, REG_SYS_CLKR); ++ break; ++#endif ++ case HW_VAR_DUMP_MAC_QUEUE_INFO: ++ dump_mac_qinfo_8723d(val, padapter); ++ break; ++ default: ++ GetHwReg(padapter, variable, val); ++ break; ++ } ++} ++ ++/* ++ * Description: ++ * Change default setting of specified variable. ++ */ ++u8 SetHalDefVar8723D(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval) ++{ ++ PHAL_DATA_TYPE pHalData; ++ u8 bResult; ++ ++ bResult = _SUCCESS; ++ ++ switch (variable) { ++ default: ++ bResult = SetHalDefVar(padapter, variable, pval); ++ break; ++ } ++ ++ return bResult; ++} ++ ++void hal_ra_info_dump(_adapter *padapter , void *sel) ++{ ++ int i; ++ u8 mac_id; ++ u32 cmd; ++ u32 ra_info1, ra_info2, bw_set; ++ u32 rate_mask1, rate_mask2; ++ u8 curr_tx_rate, curr_tx_sgi, hight_rate, lowest_rate; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ HAL_DATA_TYPE *HalData = GET_HAL_DATA(padapter); ++ ++ for (i = 0; i < macid_ctl->num; i++) { ++ ++ if (rtw_macid_is_used(macid_ctl, i) && !rtw_macid_is_bmc(macid_ctl, i)) { ++ ++ mac_id = (u8) i; ++ _RTW_PRINT_SEL(sel , "============ RA status check Mac_id:%d ===================\n", mac_id); ++ ++ cmd = 0x40000100 | mac_id; ++ rtw_write32(padapter, REG_HMEBOX_DBG_2_8723D, cmd); ++ rtw_msleep_os(10); ++ ra_info1 = rtw_read32(padapter, 0x2F0); ++ curr_tx_rate = ra_info1 & 0x7F; ++ curr_tx_sgi = (ra_info1 >> 7) & 0x01; ++ ++ _RTW_PRINT_SEL(sel , "[ ra_info1:0x%08x ] =>cur_tx_rate= %s,cur_sgi:%d\n", ra_info1, HDATA_RATE(curr_tx_rate), curr_tx_sgi); ++ _RTW_PRINT_SEL(sel , "[ ra_info1:0x%08x ] => PWRSTS = 0x%02x\n", ra_info1, (ra_info1 >> 8) & 0x07); ++ ++ cmd = 0x40000400 | mac_id; ++ rtw_write32(padapter, REG_HMEBOX_DBG_2_8723D, cmd); ++ rtw_msleep_os(10); ++ ra_info1 = rtw_read32(padapter, 0x2F0); ++ ra_info2 = rtw_read32(padapter, 0x2F4); ++ rate_mask1 = rtw_read32(padapter, 0x2F8); ++ rate_mask2 = rtw_read32(padapter, 0x2FC); ++ hight_rate = ra_info2 & 0xFF; ++ lowest_rate = (ra_info2 >> 8) & 0xFF; ++ bw_set = (ra_info1 >> 8) & 0xFF; ++ ++ _RTW_PRINT_SEL(sel , "[ ra_info1:0x%08x ] => VHT_EN=0x%02x, ", ra_info1, (ra_info1 >> 24) & 0xFF); ++ ++ ++ switch (bw_set) { ++ ++ case CHANNEL_WIDTH_20: ++ _RTW_PRINT_SEL(sel , "BW_setting=20M\n"); ++ break; ++ ++ case CHANNEL_WIDTH_40: ++ _RTW_PRINT_SEL(sel , "BW_setting=40M\n"); ++ break; ++ ++ case CHANNEL_WIDTH_80: ++ _RTW_PRINT_SEL(sel , "BW_setting=80M\n"); ++ break; ++ ++ case CHANNEL_WIDTH_160: ++ _RTW_PRINT_SEL(sel , "BW_setting=160M\n"); ++ break; ++ ++ default: ++ _RTW_PRINT_SEL(sel , "BW_setting=0x%02x\n", bw_set); ++ break; ++ ++ } ++ ++ _RTW_PRINT_SEL(sel , "[ ra_info1:0x%08x ] =>RSSI=%d, DISRA=0x%02x\n", ++ ra_info1, ++ ra_info1 & 0xFF, ++ (ra_info1 >> 16) & 0xFF); ++ ++ _RTW_PRINT_SEL(sel , "[ ra_info2:0x%08x ] =>hight_rate=%s, lowest_rate=%s, SGI=0x%02x, RateID=%d\n", ++ ra_info2, ++ HDATA_RATE(hight_rate), ++ HDATA_RATE(lowest_rate), ++ (ra_info2 >> 16) & 0xFF, ++ (ra_info2 >> 24) & 0xFF); ++ ++ _RTW_PRINT_SEL(sel , "rate_mask2=0x%08x, rate_mask1=0x%08x\n", rate_mask2, rate_mask1); ++ ++ } ++ } ++} ++ ++/* ++ * Description: ++ * Query setting of specified variable. ++ */ ++u8 GetHalDefVar8723D(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval) ++{ ++ PHAL_DATA_TYPE pHalData; ++ u8 bResult; ++ ++ pHalData = GET_HAL_DATA(padapter); ++ bResult = _SUCCESS; ++ ++ switch (variable) { ++ case HAL_DEF_MAX_RECVBUF_SZ: ++ *((u32 *)pval) = MAX_RECVBUF_SZ; ++ break; ++ case HAL_DEF_RX_PACKET_OFFSET: ++#ifdef CONFIG_TRX_BD_ARCH ++ *((u32 *)pval) = RX_WIFI_INFO_SIZE + DRVINFO_SZ * 8; ++#else ++ *((u32 *)pval) = RXDESC_SIZE + DRVINFO_SZ * 8; ++#endif ++ break; ++ ++ case HW_VAR_MAX_RX_AMPDU_FACTOR: ++ /* Stanley@BB.SD3 suggests 16K can get stable performance */ ++ /* The experiment was done on SDIO interface */ ++ /* coding by Lucas@20130730 */ ++ *(HT_CAP_AMPDU_FACTOR *)pval = MAX_AMPDU_FACTOR_16K; ++ break; ++ case HW_VAR_BEST_AMPDU_DENSITY: ++ *((u32 *)pval) = AMPDU_DENSITY_VALUE_7; ++ break; ++ case HAL_DEF_TX_LDPC: ++ case HAL_DEF_RX_LDPC: ++ *((u8 *)pval) = _FALSE; ++ break; ++ case HAL_DEF_TX_STBC: ++ *((u8 *)pval) = 0; ++ break; ++ case HAL_DEF_RX_STBC: ++ *((u8 *)pval) = 1; ++ break; ++ case HAL_DEF_EXPLICIT_BEAMFORMER: ++ case HAL_DEF_EXPLICIT_BEAMFORMEE: ++ *((u8 *)pval) = _FALSE; ++ break; ++ ++ case HW_DEF_RA_INFO_DUMP: ++ hal_ra_info_dump(padapter, pval); ++ break; ++ ++ case HAL_DEF_TX_PAGE_BOUNDARY: ++ if (!padapter->registrypriv.wifi_spec) ++ *(u8 *)pval = TX_PAGE_BOUNDARY_8723D; ++ else ++ *(u8 *)pval = WMM_NORMAL_TX_PAGE_BOUNDARY_8723D; ++ break; ++ case HAL_DEF_MACID_SLEEP: ++ *(u8 *)pval = _TRUE; /* support macid sleep */ ++ break; ++ case HAL_DEF_TX_PAGE_SIZE: ++ *((u32 *)pval) = PAGE_SIZE_128; ++ break; ++ case HAL_DEF_RX_DMA_SZ_WOW: ++ *(u32 *)pval = RX_DMA_SIZE_8723D - RESV_FMWF; ++ break; ++ case HAL_DEF_RX_DMA_SZ: ++ *(u32 *)pval = RX_DMA_BOUNDARY_8723D + 1; ++ break; ++ case HAL_DEF_RX_PAGE_SIZE: ++ *((u32 *)pval) = 8; ++ break; ++ default: ++ bResult = GetHalDefVar(padapter, variable, pval); ++ break; ++ } ++ ++ return bResult; ++} ++ ++#ifdef CONFIG_WOWLAN ++void Hal_DetectWoWMode(PADAPTER pAdapter) ++{ ++ adapter_to_pwrctl(pAdapter)->bSupportRemoteWakeup = _TRUE; ++ RTW_INFO("%s\n", __func__); ++} ++#endif /* CONFIG_WOWLAN */ ++ ++void rtl8723d_start_thread(_adapter *padapter) ++{ ++#if (defined CONFIG_SDIO_HCI) || (defined CONFIG_GSPI_HCI) ++#ifndef CONFIG_SDIO_TX_TASKLET ++ struct xmit_priv *xmitpriv = &padapter->xmitpriv; ++ ++ xmitpriv->SdioXmitThread = kthread_run(rtl8723ds_xmit_thread, padapter, "RTWHALXT"); ++ if (IS_ERR(xmitpriv->SdioXmitThread)) ++ RTW_ERR("%s: start rtl8723ds_xmit_thread FAIL!!\n", __func__); ++#endif ++#endif ++} ++ ++void rtl8723d_stop_thread(_adapter *padapter) ++{ ++#if (defined CONFIG_SDIO_HCI) || (defined CONFIG_GSPI_HCI) ++#ifndef CONFIG_SDIO_TX_TASKLET ++ struct xmit_priv *xmitpriv = &padapter->xmitpriv; ++ ++ /* stop xmit_buf_thread */ ++ if (xmitpriv->SdioXmitThread) { ++ _rtw_up_sema(&xmitpriv->SdioXmitSema); ++ /*_rtw_down_sema(&xmitpriv->SdioXmitTerminateSema);*/ ++ rtw_wait_for_thread_stop(&xmitpriv->sdio_xmit_thread_comp); ++ xmitpriv->SdioXmitThread = 0; ++ } ++#endif ++#endif ++} ++ ++#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) ++void rtl8723ds_init_checkbthang_workqueue(_adapter *adapter) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) ++ adapter->priv_checkbt_wq = alloc_workqueue("sdio_wq", 0, 0); ++#else ++ adapter->priv_checkbt_wq = create_workqueue("sdio_wq"); ++#endif ++ INIT_DELAYED_WORK(&adapter->checkbt_work, (void *)check_bt_status_work); ++} ++ ++void rtl8723ds_free_checkbthang_workqueue(_adapter *adapter) ++{ ++ if (adapter->priv_checkbt_wq) { ++ cancel_delayed_work_sync(&adapter->checkbt_work); ++ flush_workqueue(adapter->priv_checkbt_wq); ++ destroy_workqueue(adapter->priv_checkbt_wq); ++ adapter->priv_checkbt_wq = NULL; ++ } ++} ++ ++void rtl8723ds_cancle_checkbthang_workqueue(_adapter *adapter) ++{ ++ if (adapter->priv_checkbt_wq) ++ cancel_delayed_work_sync(&adapter->checkbt_work); ++} ++ ++void rtl8723ds_hal_check_bt_hang(_adapter *adapter) ++{ ++ if (adapter->priv_checkbt_wq) ++ queue_delayed_work(adapter->priv_checkbt_wq, &(adapter->checkbt_work), 0); ++} ++#endif ++ ++void rtl8723d_set_hal_ops(struct hal_ops *pHalFunc) ++{ ++ pHalFunc->dm_init = &rtl8723d_init_dm_priv; ++ pHalFunc->dm_deinit = &rtl8723d_deinit_dm_priv; ++ pHalFunc->read_chip_version = read_chip_version_8723d; ++ pHalFunc->UpdateRAMaskHandler = &UpdateHalRAMask8723D; ++ pHalFunc->set_chnl_bw_handler = &PHY_SetSwChnlBWMode8723D; ++ pHalFunc->set_tx_power_level_handler = &PHY_SetTxPowerLevel8723D; ++ pHalFunc->get_tx_power_level_handler = &PHY_GetTxPowerLevel8723D; ++ pHalFunc->get_tx_power_index_handler = &PHY_GetTxPowerIndex_8723D; ++ pHalFunc->hal_dm_watchdog = &rtl8723d_HalDmWatchDog; ++#ifdef CONFIG_LPS_LCLK_WD_TIMER ++ pHalFunc->hal_dm_watchdog_in_lps = &rtl8723d_HalDmWatchDog_in_LPS; ++#endif ++ ++ pHalFunc->SetBeaconRelatedRegistersHandler = &rtl8723d_SetBeaconRelatedRegisters; ++ pHalFunc->run_thread = &rtl8723d_start_thread; ++ pHalFunc->cancel_thread = &rtl8723d_stop_thread; ++ pHalFunc->read_bbreg = &PHY_QueryBBReg_8723D; ++ pHalFunc->write_bbreg = &PHY_SetBBReg_8723D; ++ pHalFunc->read_rfreg = &PHY_QueryRFReg_8723D; ++ pHalFunc->write_rfreg = &PHY_SetRFReg_8723D; ++ ++ /* Efuse related function */ ++ pHalFunc->BTEfusePowerSwitch = &Hal_BT_EfusePowerSwitch; ++ pHalFunc->EfusePowerSwitch = &Hal_EfusePowerSwitch; ++ pHalFunc->ReadEFuse = &Hal_ReadEFuse; ++ pHalFunc->EFUSEGetEfuseDefinition = &Hal_GetEfuseDefinition; ++ pHalFunc->EfuseGetCurrentSize = &Hal_EfuseGetCurrentSize; ++ pHalFunc->Efuse_PgPacketRead = &Hal_EfusePgPacketRead; ++ pHalFunc->Efuse_PgPacketWrite = &Hal_EfusePgPacketWrite; ++ pHalFunc->Efuse_WordEnableDataWrite = &Hal_EfuseWordEnableDataWrite; ++ pHalFunc->Efuse_PgPacketWrite_BT = &Hal_EfusePgPacketWrite_BT; ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ pHalFunc->sreset_init_value = &sreset_init_value; ++ pHalFunc->sreset_reset_value = &sreset_reset_value; ++ pHalFunc->silentreset = &sreset_reset; ++ pHalFunc->sreset_xmit_status_check = &rtl8723d_sreset_xmit_status_check; ++ pHalFunc->sreset_linked_status_check = &rtl8723d_sreset_linked_status_check; ++ pHalFunc->sreset_get_wifi_status = &sreset_get_wifi_status; ++ pHalFunc->sreset_inprogress = &sreset_inprogress; ++#endif ++ pHalFunc->GetHalODMVarHandler = GetHalODMVar; ++ pHalFunc->SetHalODMVarHandler = SetHalODMVar; ++ ++#ifdef CONFIG_XMIT_THREAD_MODE ++ pHalFunc->xmit_thread_handler = &hal_xmit_handler; ++#endif ++ pHalFunc->hal_notch_filter = &hal_notch_filter_8723d; ++ pHalFunc->c2h_handler = c2h_handler_8723d; ++ pHalFunc->fill_h2c_cmd = &FillH2CCmd8723D; ++ pHalFunc->fill_fake_txdesc = &rtl8723d_fill_fake_txdesc; ++ pHalFunc->fw_dl = &rtl8723d_FirmwareDownload; ++ pHalFunc->hal_get_tx_buff_rsvd_page_num = &GetTxBufferRsvdPageNum8723D; ++} ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_lps_poff.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_lps_poff.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_lps_poff.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_lps_poff.c 2018-02-11 21:44:27.164146345 +0200 +@@ -0,0 +1,877 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#include ++ ++#ifdef CONFIG_LPS_POFF ++/**************************************************************************** ++ * Function: constuct Register Setting for HW to Backup Before LPS ++ * page 2/4/6/7/8~F and page 0x24(for NAN) ++*****************************************************************************/ ++static bool hal_construct_poff_static_file(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ lps_poff_info_t *lps_poff_info = NULL; ++ u8 *staticFile = NULL; ++ u8 *start_at = NULL; ++ u8 page_count = 0, page_offset = 0, round = 0; ++ /*There are 256 bytes in each register bank, and 64 dwords*/ ++ u8 total = 256 / 4; ++ u16 offset = 0, addr_value = 0; ++ ++ if (pwrpriv->plps_poff_info == NULL) { ++ RTW_INFO("%s: please alloc plps_poff_info first!!\n", __func__); ++ return _FALSE; ++ } ++ ++ lps_poff_info = pwrpriv->plps_poff_info; ++ ++ if (lps_poff_info->pStaticFile == NULL) { ++ RTW_INFO("%s: please alloc static configure file first!!\n", ++ __func__); ++ return _FALSE; ++ } ++ staticFile = lps_poff_info->pStaticFile + TXDESC_SIZE; ++ ++ for (page_count = 2 ; page_count < 16 ; page_count++) { ++ page_offset = 0; ++ if (page_count == 3 || page_count == 5) ++ continue; ++ ++ offset = (round << 9); ++ ++ for (page_offset = 0 ; page_offset < total ; page_offset++) { ++ start_at = staticFile + offset + (page_offset << 3); ++ addr_value = ++ ((page_count << 8) + (page_offset << 2)) >> 2; ++ ++ SET_HOIE_ENTRY_LOW_DATA(start_at, 0); ++ SET_HOIE_ENTRY_HIGH_DATA(start_at, 0); ++ SET_HOIE_ENTRY_MODE_SELECT(start_at, 0); ++ SET_HOIE_ENTRY_ADDRESS(start_at, addr_value); ++ SET_HOIE_ENTRY_BYTE_MASK(start_at, 0xF); ++ SET_HOIE_ENTRY_IO_LOCK(start_at, 0); ++ SET_HOIE_ENTRY_WR_EN(start_at, 1); ++ SET_HOIE_ENTRY_RD_EN(start_at, 1); ++ SET_HOIE_ENTRY_RAW_RW(start_at, 0); ++ SET_HOIE_ENTRY_RAW(start_at, 0); ++ SET_HOIE_ENTRY_IO_DELAY(start_at, 0); ++ } ++ ++ round++; ++ } ++ ++ /*construct page 24*/ ++ offset = (round << 9); ++ for (page_offset = 0 ; page_offset < total ; page_offset++) { ++ start_at = staticFile + offset + (page_offset << 3); ++ addr_value = ((0x24 << 8) + (page_offset << 2)) >> 2; ++ ++ SET_HOIE_ENTRY_LOW_DATA(start_at, 0); ++ SET_HOIE_ENTRY_HIGH_DATA(start_at, 0); ++ SET_HOIE_ENTRY_MODE_SELECT(start_at, 0); ++ SET_HOIE_ENTRY_ADDRESS(start_at, addr_value); ++ SET_HOIE_ENTRY_BYTE_MASK(start_at, 0xF); ++ SET_HOIE_ENTRY_IO_LOCK(start_at, 0); ++ SET_HOIE_ENTRY_WR_EN(start_at, 1); ++ SET_HOIE_ENTRY_RD_EN(start_at, 1); ++ SET_HOIE_ENTRY_RAW_RW(start_at, 0); ++ SET_HOIE_ENTRY_RAW(start_at, 0); ++ SET_HOIE_ENTRY_IO_DELAY(start_at, 0); ++ } ++ RTW_INFO("%s: (round << 9) + (PageOffset << 3) = %#08x\n", ++ __func__, offset + (page_offset << 3)); ++ ++ start_at = staticFile + offset + (page_offset << 3); ++ /* add last command: 00 00 00 00 00 40 30 00,suggested by DD */ ++ *(start_at) = 0; ++ *(start_at + 1) = 0; ++ *(start_at + 2) = 0; ++ *(start_at + 3) = 0; ++ *(start_at + 4) = 0; ++ *(start_at + 5) = 0x40; ++ *(start_at + 6) = 0x30; ++ *(start_at + 7) = 0; ++ ++ return _TRUE; ++} ++ ++/**************************************************************************** ++Function: send Location of configuration file and other info for FW ++*****************************************************************************/ ++static void rtl8723d_lps_poff_h2c_param(PADAPTER padapter, u8 tx_bndy, u16 len, ++ bool isDynamic) ++{ ++ u8 lps_poff_param[H2C_LPS_POFF_PARAM_LEN] = {0}; ++ u8 start_addr_l = 0, start_addr_h = 0; ++ u8 end_addr_l = 0, end_addr_h = 0; ++ u16 start_addr = 0, end_addr = 0; ++ ++ if (len < 8) ++ return; ++ /* ++ set start address, The parameter is entrys. every page has 16 entrys ++ The Tx Descriptor is 40Byte which locate 5 entries ++ */ ++ ++ start_addr = (tx_bndy << 4) + 5; ++ end_addr = start_addr + (len >> 3) - 1; ++ ++ RTW_INFO("%s: start_addr = %#02X, end_addr= %#02X\n", ++ __func__, start_addr, end_addr); ++ ++ start_addr_l = (u8)start_addr; ++ start_addr_h = (u8)(start_addr >> 8); ++ ++ end_addr_l = (u8)end_addr; ++ end_addr_h = (u8)(end_addr >> 8); ++ ++ /*construct H2C Cmd*/ ++ if (isDynamic) ++ SET_H2CCMD_LPS_POFF_PARAM_RDVLD(lps_poff_param, 0); ++ else ++ SET_H2CCMD_LPS_POFF_PARAM_RDVLD(lps_poff_param, 1); ++ ++ SET_H2CCMD_LPS_POFF_PARAM_WRVLD(lps_poff_param, 1); ++ SET_H2CCMD_LPS_POFF_PARAM_STARTADDL(lps_poff_param, start_addr_l); ++ SET_H2CCMD_LPS_POFF_PARAM_STARTADDH(lps_poff_param, start_addr_h); ++ SET_H2CCMD_LPS_POFF_PARAM_ENDADDL(lps_poff_param, end_addr_l); ++ SET_H2CCMD_LPS_POFF_PARAM_ENDADDH(lps_poff_param, end_addr_h); ++ ++ rtw_hal_fill_h2c_cmd(padapter, H2C_LPS_POFF_PARAM, ++ H2C_LPS_POFF_PARAM_LEN, lps_poff_param); ++} ++ ++/************************************************************************* ++Function: SET Location of Configuration File to FW ++**************************************************************************/ ++static void rtl8723d_lps_poff_set_param(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; ++ ++ u8 static_tx_bndy = 0; ++ u8 dynamic_tx_bndy = 0; ++ u16 static_len = 0, dynamic_len = 0; ++ ++ static_tx_bndy = plps_poff_info->tx_bndy_static; ++ dynamic_tx_bndy = plps_poff_info->tx_bndy_dynamic; ++ ++ dynamic_len = plps_poff_info->ConfLenForPTK + ++ plps_poff_info->ConfLenForGTK; ++ ++ if (ATOMIC_READ(&plps_poff_info->bSetPOFFParm) == _TRUE) ++ return; ++ ++ /* download static configuration */ ++ static_len = LPS_POFF_STATIC_FILE_LEN - TXDESC_SIZE; ++ rtl8723d_lps_poff_h2c_param(padapter, static_tx_bndy, ++ static_len, _FALSE); ++ ++ /* download dynamic configuration */ ++ /* the length must be add more 8 Byte due to hard bug */ ++ if (dynamic_len != 0) { ++ dynamic_len += 8; ++ rtl8723d_lps_poff_h2c_param(padapter, dynamic_tx_bndy, ++ dynamic_len, _TRUE); ++ } ++ ++ ATOMIC_SET(&plps_poff_info->bSetPOFFParm, _TRUE); ++} ++ ++ ++/**************************************************************************** ++Function: change tx boundary ++*****************************************************************************/ ++static void rtl8723d_lps_poff_set_tx_bndy(PADAPTER padapter, u8 tx_bndy) ++{ ++ u32 numHQ = 0x10; ++ u32 numLQ = 0x10; ++ u32 numPubQ = 0; ++ u8 numNQ = 0; ++ ++ u32 val32 = 0; ++ u8 val8 = 0; ++ ++#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++ numHQ = 0x8; ++ numLQ = 0x8; ++#endif ++ numPubQ = tx_bndy - numHQ - numLQ - numNQ - 1; ++ val8 = _NPQ(numNQ); ++ val32 = _HPQ(numHQ) | _LPQ(numLQ) | _PUBQ(numPubQ) | LD_RQPN; ++ ++ rtw_write8(padapter, REG_RQPN_NPQ, val8); ++ rtw_write32(padapter, REG_RQPN, val32); ++} ++ ++/**************************************************************************** ++Function: change tx boundary flow ++*****************************************************************************/ ++static bool rtl8723d_lps_poff_tx_bndy_flow(PADAPTER padapter, bool enable) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct xmit_priv *pxmitpriv; ++ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; ++ u8 tx_bndy = 0, tx_bndy_new = 0, count = 0, queue_pending = _FALSE; ++ u8 val8 = 0; ++ u16 val16 = 0; ++ u32 val32 = 0; ++ ++ pxmitpriv = &padapter->xmitpriv; ++ rtw_hal_get_def_var(padapter, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&tx_bndy); ++ ++ RTW_INFO("%s: tx_bndy: %#X, tx_bndy_static: %#X\n", ++ __func__, tx_bndy, plps_poff_info->tx_bndy_static); ++ ++ if (enable) ++ tx_bndy_new = plps_poff_info->tx_bndy_static + 1; ++ else ++ tx_bndy_new = tx_bndy; ++ ++ ATOMIC_SET(&plps_poff_info->bTxBoundInProgress, _TRUE); ++ ++ /* stop os layer TX*/ ++ rtw_mi_netif_stop_queue(padapter, _FALSE); ++ ++ val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); ++ ++ /* stop tx process and wait tx empty */ ++ while ((val16 & 0x05FF) != 0x05FF) { ++ rtw_mdelay_os(10); ++ val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); ++ ++ count++; ++ if (count >= 100) { ++ val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); ++ RTW_INFO("%s, txpkt_empty: %#04x\n", __func__, val16); ++ val8 = rtw_read8(padapter, REG_CPU_MGQ_INFORMATION); ++ RTW_INFO("%s, REG_CPU_MGQ_INFORMATION: %#02x\n", ++ __func__, val8); ++ RTW_INFO("%s, wait for tx empty timeout!!\n", __func__); ++ ATOMIC_SET(&plps_poff_info->bTxBoundInProgress, _FALSE); ++ rtw_mi_netif_wake_queue(padapter); ++ return _FALSE; ++ } ++ } ++ ++ /* change tx boundary*/ ++ rtl8723d_lps_poff_set_tx_bndy(padapter, tx_bndy_new); ++ ++ /* set free tail */ ++ val32 = rtw_read32(padapter, REG_FWHW_TXQ_CTRL); ++ val32 |= BIT20; ++ rtw_write32(padapter, REG_FWHW_TXQ_CTRL, val32); ++ rtw_write8(padapter, REG_BCNQ_BDNY, tx_bndy_new); ++ ++ RTW_INFO("%s: free tail = %#x after\n", __func__, ++ rtw_read8(padapter, REG_FW_FREE_TAIL_8723D)); ++ ++ /* set bcn head */ ++ val32 = rtw_read32(padapter, REG_FWHW_TXQ_CTRL); ++ val32 &= ~BIT20; ++ rtw_write32(padapter, REG_FWHW_TXQ_CTRL, val32); ++ rtw_write8(padapter, REG_BCNQ_BDNY, tx_bndy); ++ ++ /* reinit LLT */ ++ rtl8723d_InitLLTTable(padapter); ++ ++ /* clear 0x210 ??*/ ++ val32 = rtw_read32(padapter, REG_TXDMA_STATUS); ++ ++ if (val32 != 0) { ++ RTW_INFO("%s: REG_TXDMA_STATUS: %#08x\n", __func__, val32); ++ rtw_write32(padapter, REG_TXDMA_STATUS, val32); ++ } ++ ++ ATOMIC_SET(&plps_poff_info->bTxBoundInProgress, _FALSE); ++ ++ ++ /* restart tx */ ++ ++ rtw_mi_netif_wake_queue(padapter); ++ ++ return _TRUE; ++} ++ ++/**************************************************************************** ++Function: Append extra bytes for dynamic confiure file ++ Add one entry to fix hw bug, ++ list command: 00 00 00 00 00 40 30 00, suggested by DD ++*****************************************************************************/ ++static u8 rtl8723d_lps_poff_append_extra_info(PADAPTER padapter, u32 len) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; ++ u32 data_offset = len + plps_poff_info->ConfFileOffset; ++ ++ *(plps_poff_info->pDynamicFile + (data_offset)) = 0x00; ++ *(plps_poff_info->pDynamicFile + (data_offset + 1)) = 0x00; ++ *(plps_poff_info->pDynamicFile + (data_offset + 2)) = 0x00; ++ *(plps_poff_info->pDynamicFile + (data_offset + 3)) = 0x00; ++ *(plps_poff_info->pDynamicFile + (data_offset + 4)) = 0x00; ++ *(plps_poff_info->pDynamicFile + (data_offset + 5)) = 0x40; ++ *(plps_poff_info->pDynamicFile + (data_offset + 6)) = 0x30; ++ *(plps_poff_info->pDynamicFile + (data_offset + 7)) = 0x00; ++ return 8; ++} ++ ++/**************************************************************************** ++Function: xmit config file to write port. ++*****************************************************************************/ ++static void rtl8723d_lps_poff_send_config_frame(PADAPTER padapter, ++ u8 *pFile, u32 len) ++{ ++ struct xmit_frame *pcmdframe = NULL; ++ struct pkt_attrib *pattrib; ++ struct xmit_priv *pxmitpriv; ++ int i = 0; ++ ++ pxmitpriv = &padapter->xmitpriv; ++ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); ++ ++ if (pcmdframe == NULL) ++ RTW_INFO("%s: alloc cmdframe fail\n", __func__); ++ ++ _rtw_memcpy(pcmdframe->buf_addr, pFile, len); ++ ++ pattrib = &pcmdframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ pattrib->qsel = QSLT_BEACON; ++ pattrib->pktlen = len - TXDESC_OFFSET; ++ pattrib->last_txcmdsz = len - TXDESC_OFFSET; ++ ++ RTW_INFO("%s, len: %d, MAX_CMDBUF_SZ: %d\n", __func__, len, ++ MAX_CMDBUF_SZ); ++#ifdef CONFIG_PCI_HCI ++ dump_mgntframe(padapter, pcmdframe); ++#else ++ dump_mgntframe_and_wait(padapter, pcmdframe, 100); ++#endif ++ ++} ++ ++/**************************************************************************** ++Function: download config file flow ++*****************************************************************************/ ++static void rtl8723d_lps_poff_send_config_file(PADAPTER padapter, ++ u8 *pFile, u8 loc, u32 len) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ bool bRecover = _FALSE, bcn_valid = _FALSE; ++ u8 DLBcnCount = 0, val8 = 0, tx_bndy = 0; ++ u32 poll = 0; ++ ++ rtw_hal_get_def_var(padapter, ++ HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&tx_bndy); ++ ++ /* set 0x100[8]=1 for SW beacon */ ++ val8 = rtw_read8(padapter, REG_CR + 1); ++ val8 |= BIT(0); ++ rtw_write8(padapter, REG_CR + 1, val8); ++ ++ /*set 0x422[6]=0 to disable beacon DMA pass to MACTx*/ ++ ++ if (pHalData->RegFwHwTxQCtrl & BIT(6)) ++ bRecover = _TRUE; ++ ++ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, ++ pHalData->RegFwHwTxQCtrl & ~BIT(6)); ++ pHalData->RegFwHwTxQCtrl &= ~BIT(6); ++ ++ /* Clear beacon valid check bit. */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); ++ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); ++ ++ /* set 0x209[7:0] beacon queue head page to start download location */ ++ rtw_write8(padapter, REG_TDECTRL_8723D + 1, loc); ++ ++ DLBcnCount = 0; ++ poll = 0; ++ ++ do { ++ rtl8723d_lps_poff_send_config_frame(padapter, pFile, len); ++ DLBcnCount++; ++ do { ++ rtw_mdelay_os(10); ++ /*check rsvd page download OK.*/ ++ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, ++ (u8 *)(&bcn_valid)); ++ poll++; ++ } while (!bcn_valid && (poll % 10) != 0 ++ && !RTW_CANNOT_RUN(padapter)); ++ } while (!bcn_valid && DLBcnCount <= 100 && !RTW_CANNOT_RUN(padapter)); ++ ++ if (!bcn_valid) ++ RTW_INFO(ADPT_FMT": 1 DL RSVD page failed! DLBcnCount:%u, poll:%u\n", ++ ADPT_ARG(padapter), DLBcnCount, poll); ++ else ++ RTW_INFO(ADPT_FMT": 1 DL RSVD page success! DLBcnCount:%u, poll:%u\n", ++ ADPT_ARG(padapter), DLBcnCount, poll); ++ ++ /*restore bcn operation*/ ++ rtw_write8(padapter, REG_TDECTRL_8723D + 1, tx_bndy); ++ ++ /*restore 0x422[6]=1 for normal bcn*/ ++ if (bRecover) { ++ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, ++ pHalData->RegFwHwTxQCtrl | BIT(6)); ++ pHalData->RegFwHwTxQCtrl |= BIT(6); ++ } ++ ++ /*restore 0x100[8]=0 for SW beacon*/ ++ /* Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ ++#ifndef CONFIG_PCI_HCI ++ val8 = rtw_read8(padapter, REG_CR + 1); ++ val8 &= ~BIT(0); ++ rtw_write8(padapter, REG_CR + 1, val8); ++#endif ++} ++ ++/**************************************************************************** ++Function: Prepare Confiure File ++*****************************************************************************/ ++static void rtl8723d_lps_poff_dl_config_file(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; ++ u8 count = 0, append_len = 0; ++ u32 offset = 0, static_file_len = 0, dynamic_file_len = 0; ++ int i = 0, j = 0; ++ ++ offset = plps_poff_info->ConfFileOffset; ++ ++ static_file_len = LPS_POFF_STATIC_FILE_LEN - offset; ++ ++ dynamic_file_len = ++ plps_poff_info->ConfLenForPTK + plps_poff_info->ConfLenForGTK; ++ ++ RTW_INFO("%s: static_file_len: %d dynamic_file_len: %d, offset: %d\n", ++ __func__, static_file_len, dynamic_file_len, offset); ++ ++ /*static file*/ ++ rtl8723d_lps_poff_send_config_file(padapter, ++ plps_poff_info->pStaticFile + offset, ++ plps_poff_info->tx_bndy_static, ++ static_file_len); ++ ++ /*dynamic file*/ ++ if (dynamic_file_len != 0) { ++ dynamic_file_len += TXDESC_SIZE - offset; ++ ++ append_len = ++ rtl8723d_lps_poff_append_extra_info(padapter, ++ dynamic_file_len); ++ dynamic_file_len += append_len; ++ rtl8723d_lps_poff_send_config_file(padapter, ++ plps_poff_info->pDynamicFile + offset, ++ plps_poff_info->tx_bndy_dynamic, ++ dynamic_file_len); ++ } ++} ++ ++static u8 rtl8723d_lps_poff_set_dynamic_file(u8 *pFile, u32 type, u32 wdata) ++{ ++ SET_HOIE_ENTRY_LOW_DATA(pFile, (u16)wdata); ++ SET_HOIE_ENTRY_HIGH_DATA(pFile, (u16)(wdata >> 16)); ++ SET_HOIE_ENTRY_MODE_SELECT(pFile, 0); ++ SET_HOIE_ENTRY_ADDRESS(pFile, (type >> 2)); ++ SET_HOIE_ENTRY_BYTE_MASK(pFile, 0xF); ++ SET_HOIE_ENTRY_IO_LOCK(pFile, 0); ++ SET_HOIE_ENTRY_WR_EN(pFile, 1); ++ SET_HOIE_ENTRY_RD_EN(pFile, 0); ++ SET_HOIE_ENTRY_RAW_RW(pFile, 0); ++ SET_HOIE_ENTRY_RAW(pFile, 0); ++ SET_HOIE_ENTRY_IO_DELAY(pFile, 0); ++ ++ return 8; ++} ++ ++static void rtl8723d_lps_poff_dynamic_file(PADAPTER padapter, u8 index, u8 isGK) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; ++ u8 *ptkfile = NULL; ++ u8 ret = 0; ++ u32 tgt_cmd = 0, tgt_wdata = 0; ++ int i = 0, j = 0; ++ ++ for (i = 0 ; i < CAM_CONTENT_COUNT; i++) { ++ if (!isGK) ++ ptkfile = plps_poff_info->pDynamicFile + ++ plps_poff_info->ConfLenForPTK + TXDESC_SIZE; ++ else ++ ptkfile = plps_poff_info->pDynamicFile + ++ plps_poff_info->ConfLenForPTK + ++ plps_poff_info->ConfLenForGTK + TXDESC_SIZE; ++ ++ tgt_cmd = i + (CAM_CONTENT_COUNT * index); ++ tgt_cmd = tgt_cmd | CAM_POLLINIG | CAM_WRITE; ++ ++ switch (i) { ++ case 0: ++ tgt_wdata = dvobj->cam_cache[index].ctrl | ++ dvobj->cam_cache[index].mac[0] << 16 | ++ dvobj->cam_cache[index].mac[1] << 24; ++ break; ++ case 1: ++ tgt_wdata = dvobj->cam_cache[index].mac[2] | ++ dvobj->cam_cache[index].mac[3] << 8 | ++ dvobj->cam_cache[index].mac[4] << 16 | ++ dvobj->cam_cache[index].mac[5] << 24; ++ break; ++ default: ++ j = (i - 2) << 2; ++ tgt_wdata = ++ dvobj->cam_cache[index].key[j + 3] << 24 | ++ dvobj->cam_cache[index].key[j + 2] << 16 | ++ dvobj->cam_cache[index].key[j + 1] << 8 | ++ dvobj->cam_cache[index].key[j]; ++ break; ++ } ++ ++ ret = rtl8723d_lps_poff_set_dynamic_file(ptkfile, ++ WCAMI, tgt_wdata); ++ ++ if (!isGK) { ++ plps_poff_info->ConfLenForPTK += ret; ++ ++ ptkfile = plps_poff_info->pDynamicFile + ++ plps_poff_info->ConfLenForPTK + TXDESC_SIZE; ++ } else { ++ plps_poff_info->ConfLenForGTK += ret; ++ ptkfile = plps_poff_info->pDynamicFile + ++ plps_poff_info->ConfLenForPTK + ++ plps_poff_info->ConfLenForGTK + TXDESC_SIZE; ++ } ++ ++ ret = rtl8723d_lps_poff_set_dynamic_file(ptkfile, ++ RWCAM, tgt_cmd); ++ ++ if (!isGK) ++ plps_poff_info->ConfLenForPTK += ret; ++ else ++ plps_poff_info->ConfLenForGTK += ret; ++ ++#if 0 ++ RTW_INFO("%s: tgt_wdata: %#08x\n", __func__, tgt_wdata); ++#endif ++ } ++} ++ ++static void rtl8723d_lps_poff_sec_cam_opt(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ int i = 0; ++ u8 isValid = 0, isGK = 0, index = 0, key_id = 0xff, gk_start = 0xff; ++ u16 val16 = 0, len = 0; ++ ++ /*Using cam cache to create config file for FW use.*/ ++ /*1- deail with pairwise key*/ ++ ++ for (i = 0 ; i < cam_ctl->num ; i++) { ++ ++ val16 = dvobj->cam_cache[i].ctrl; ++ isValid = (val16 >> 15) & 0x01; ++ isGK = (val16 >> 6) & 0x01; ++ ++ if (isValid && !isGK) { ++ rtl8723d_lps_poff_dynamic_file(padapter, i, _FALSE); ++ RTW_INFO("%s: id: %2u, kid: %3u, ctrl: %#04x, "MAC_FMT""KEY_FMT"\n", ++ __func__, i, (dvobj->cam_cache[i].ctrl) & 0x03, ++ dvobj->cam_cache[i].ctrl, ++ MAC_ARG(dvobj->cam_cache[i].mac), ++ KEY_ARG(dvobj->cam_cache[i].key)); ++ } else if (isGK) { ++ key_id = dvobj->cam_cache[i].ctrl & 0x03; ++ if (key_id == pmlmeinfo->key_index) ++ gk_start = i; ++ RTW_INFO("%s: GK_start at %d\n", __func__, gk_start); ++ RTW_INFO("%s: id: %2u, kid: %3u, ctrl: %#04x, "MAC_FMT""KEY_FMT"\n", ++ __func__, i, key_id, dvobj->cam_cache[i].ctrl, ++ MAC_ARG(dvobj->cam_cache[i].mac), ++ KEY_ARG(dvobj->cam_cache[i].key)); ++ } ++ } ++ ++ /*2- deail with group key*/ ++ rtl8723d_lps_poff_dynamic_file(padapter, gk_start, _TRUE); ++ ++ RTW_INFO("%s: ConfLenForPTK: %d, ConfLenForGTK: %d\n", __func__, ++ plps_poff_info->ConfLenForPTK, plps_poff_info->ConfLenForGTK); ++} ++ ++/**************************************************************************** ++Function: Prepare enter LPS partial off status. ++change tx boundary, download configuration file if necessary and send info to FW ++*****************************************************************************/ ++static bool rtl8723d_prepare_for_enter_poff(PADAPTER padapter, bool bEnterLPS) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; ++ bool ret = _FALSE; ++ u8 i = 0, cam_cache_num = 0; ++ ++ for (i = 0 ; i < cam_ctl->num; i++) { ++ if (dvobj->cam_cache[i].ctrl != 0) ++ cam_cache_num++; ++ } ++ ++ ret = rtl8723d_lps_poff_tx_bndy_flow(padapter, bEnterLPS); ++ ++ if (ret == _TRUE) { ++ if (cam_cache_num > 0) { ++ rtl8723d_lps_poff_sec_cam_opt(padapter); ++ } else { ++ plps_poff_info->ConfLenForPTK = 0; ++ plps_poff_info->ConfLenForGTK = 0; ++ } ++ rtl8723d_lps_poff_dl_config_file(padapter); ++ rtl8723d_lps_poff_set_param(padapter); ++ } ++ return ret; ++} ++ ++/************************************************************************* ++Function: SET H2C To Enable Partial Off ++**************************************************************************/ ++void rtl8723d_lps_poff_h2c_ctrl(PADAPTER padapter, u8 en) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; ++ u8 param = 0; ++ ++ if (pregistrypriv->wifi_spec == 1) ++ return; ++ ++ if (plps_poff_info->bEn == _FALSE) ++ return; ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { ++ if (en) { ++ RTW_INFO("%s: enable case\n", __func__); ++ SET_H2CCMD_LPS_POFF_CTRL_EN(¶m, 1); ++ } else { ++ RTW_INFO("%s: disable case\n", __func__); ++ ATOMIC_SET(&plps_poff_info->bSetPOFFParm, _FALSE); ++ SET_H2CCMD_LPS_POFF_CTRL_EN(¶m, 0); ++ } ++ rtw_hal_fill_h2c_cmd(padapter, H2C_LPS_POFF_CTRL, ++ H2C_LPS_POFF_CTRL_LEN, ¶m); ++ } ++} ++ ++/************************************************************************* ++Function: The operation to Enter or Leave FWLPS 32K when partial off enable ++**************************************************************************/ ++void rtl8723d_lps_poff_set_ps_mode(PADAPTER padapter, bool bEnterLPS) ++{ ++ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ bool res = _FALSE; ++ ++ if (pregistrypriv->wifi_spec == 1) ++ return; ++ ++ if (plps_poff_info->bEn) { ++ ++ plps_poff_info->ConfLenForPTK = 0; ++ plps_poff_info->ConfLenForGTK = 0; ++ ++ if (bEnterLPS) { ++ res = rtl8723d_prepare_for_enter_poff(padapter, ++ bEnterLPS); ++ ATOMIC_SET(&plps_poff_info->bEnterPOFF, res); ++ } else ++ rtl8723d_lps_poff_tx_bndy_flow(padapter, bEnterLPS); ++ } ++} ++ ++/************************************************************************* ++Function: Get LPS-POFF Enter Status ++**************************************************************************/ ++bool rtl8723d_lps_poff_get_status(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ ++ if (pregistrypriv->wifi_spec == 1) { ++ RTW_INFO("%s: wifi_spec is enable\n", __func__); ++ return _FALSE; ++ } ++ ++ if (plps_poff_info->bEn == _FALSE) { ++ RTW_INFO("%s: POFF is disable\n", __func__); ++ return _FALSE; ++ } ++ ++ return ATOMIC_READ(&plps_poff_info->bEnterPOFF); ++} ++ ++/************************************************************************* ++Function: Get LPS-POFF change tx bndy status ++**************************************************************************/ ++bool rtl8723d_lps_poff_get_txbndy_status(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; ++ ++ return ATOMIC_READ(&plps_poff_info->bTxBoundInProgress); ++} ++ ++/************************************************************************* ++Function: Get LPS-POFF initial ++**************************************************************************/ ++void rtl8723d_lps_poff_init(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ lps_poff_info_t *lps_poff_info; ++ u8 tx_bndy = 0, page_size = 0, total_page = 0, page_num = 0; ++ u8 val = 0; ++ ++ if (pregistrypriv->wifi_spec == 1) ++ return; ++ ++ if (is_primary_adapter(padapter)) { ++ ++ rtw_hal_get_def_var(padapter, ++ HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&val); ++ tx_bndy = val; ++ ++ rtw_hal_get_def_var(padapter, ++ HAL_DEF_TX_PAGE_SIZE, (u8 *)&val); ++ page_size = val; ++ ++ total_page = PageNum(LPS_POFF_STATIC_FILE_LEN, page_size) + ++ PageNum(LPS_POFF_DYNAMIC_FILE_LEN, page_size); ++ ++ lps_poff_info = ++ (lps_poff_info_t *)rtw_zmalloc(sizeof(lps_poff_info_t)); ++ ++ if (lps_poff_info != NULL) { ++ pwrpriv->plps_poff_info = lps_poff_info; ++ ++ lps_poff_info->pStaticFile = ++ (u8 *)rtw_zmalloc(LPS_POFF_STATIC_FILE_LEN); ++ if (lps_poff_info->pStaticFile == NULL) { ++ RTW_INFO("%s: alloc pStaticFile fail\n", ++ __func__); ++ goto alloc_static_conf_file_fail; ++ } else { ++ pwrpriv->plps_poff_info->pStaticFile = ++ lps_poff_info->pStaticFile; ++ } ++ ++ lps_poff_info->pDynamicFile = ++ (u8 *)rtw_zmalloc(LPS_POFF_DYNAMIC_FILE_LEN); ++ if (lps_poff_info->pDynamicFile == NULL) { ++ RTW_INFO("%s: alloc pDynamicFile fail\n", ++ __func__); ++ goto alloc_dynamic_conf_file_fail; ++ } else { ++ pwrpriv->plps_poff_info->pDynamicFile = ++ lps_poff_info->pDynamicFile; ++ } ++ ++ pwrpriv->plps_poff_info->bEn = _TRUE; ++ ATOMIC_SET(&pwrpriv->plps_poff_info->bEnterPOFF, ++ _FALSE); ++ ATOMIC_SET(&pwrpriv->plps_poff_info->bSetPOFFParm, ++ _FALSE); ++ ATOMIC_SET(&pwrpriv->plps_poff_info->bTxBoundInProgress, ++ _FALSE); ++#ifdef CONFIG_PCI_HCI ++ pwrpriv->plps_poff_info->ConfFileOffset = 40; ++#else ++ pwrpriv->plps_poff_info->ConfFileOffset = 0; ++#endif ++ pwrpriv->plps_poff_info->tx_bndy_static = ++ tx_bndy - total_page; ++ page_num = PageNum(LPS_POFF_DYNAMIC_FILE_LEN, ++ page_size); ++ pwrpriv->plps_poff_info->tx_bndy_dynamic = ++ tx_bndy - page_num; ++ /* ++ construct static DLConfiguration File ++ */ ++ hal_construct_poff_static_file(padapter); ++ goto exit; ++ } else { ++ RTW_INFO("%s: alloc lps_poff_info fail\n", __func__); ++ goto exit; ++ } ++ } ++ ++alloc_dynamic_conf_file_fail: ++ rtw_mfree((u8 *)pwrpriv->plps_poff_info->pStaticFile, ++ LPS_POFF_STATIC_FILE_LEN); ++ pwrpriv->plps_poff_info->pStaticFile = NULL; ++alloc_static_conf_file_fail: ++ rtw_mfree((u8 *)pwrpriv->plps_poff_info, sizeof(lps_poff_info_t)); ++ pwrpriv->plps_poff_info = NULL; ++exit: ++ return; ++} ++ ++/************************************************************************* ++Function: Get LPS-POFF de-initial ++**************************************************************************/ ++void rtl8723d_lps_poff_deinit(PADAPTER padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ ++ if (pregistrypriv->wifi_spec == 1) ++ return; ++ ++ if (is_primary_adapter(padapter)) { ++ if (plps_poff_info->pDynamicFile != NULL) { ++ rtw_mfree((u8 *)plps_poff_info->pDynamicFile, ++ LPS_POFF_DYNAMIC_FILE_LEN); ++ plps_poff_info->pDynamicFile = NULL; ++ } ++ if (plps_poff_info->pStaticFile != NULL) { ++ rtw_mfree((u8 *)plps_poff_info->pStaticFile, ++ LPS_POFF_STATIC_FILE_LEN); ++ plps_poff_info->pStaticFile = NULL; ++ } ++ if (plps_poff_info != NULL) { ++ rtw_mfree((u8 *)plps_poff_info, ++ sizeof(lps_poff_info_t)); ++ plps_poff_info = NULL; ++ } ++ } ++ ++} ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_phycfg.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_phycfg.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_phycfg.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_phycfg.c 2018-02-11 21:44:27.164146345 +0200 +@@ -0,0 +1,1317 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTL8723D_PHYCFG_C_ ++ ++#include ++ ++ ++/*---------------------------Define Local Constant---------------------------*/ ++/* Channel switch:The size of command tables for switch channel*/ ++#define MAX_PRECMD_CNT 16 ++#define MAX_RFDEPENDCMD_CNT 16 ++#define MAX_POSTCMD_CNT 16 ++ ++#define MAX_DOZE_WAITING_TIMES_9x 64 ++ ++/*---------------------------Define Local Constant---------------------------*/ ++ ++ ++/*------------------------Define global variable-----------------------------*/ ++ ++/*------------------------Define local variable------------------------------*/ ++ ++ ++/*--------------------Define export function prototype-----------------------*/ ++/* Please refer to header file ++ *--------------------Define export function prototype-----------------------*/ ++ ++/*----------------------------Function Body----------------------------------*/ ++/* ++ * 1. BB register R/W API ++ * */ ++ ++/** ++* Function: phy_CalculateBitShift ++* ++* OverView: Get shifted position of the BitMask ++* ++* Input: ++* u4Byte BitMask, ++* ++* Output: none ++* Return: u4Byte Return the shift bit bit position of the mask ++*/ ++static u32 ++phy_CalculateBitShift( ++ u32 BitMask ++) ++{ ++ u32 i; ++ ++ for (i = 0; i <= 31; i++) { ++ if (((BitMask >> i) & 0x1) == 1) ++ break; ++ } ++ ++ return i; ++} ++ ++ ++/** ++* Function: PHY_QueryBBReg ++* ++* OverView: Read "sepcific bits" from BB register ++* ++* Input: ++* PADAPTER Adapter, ++* u4Byte RegAddr, ++* u4Byte BitMask ++* ++* Output: None ++* Return: u4Byte Data ++* Note: This function is equal to "GetRegSetting" in PHY programming guide ++*/ ++u32 ++PHY_QueryBBReg_8723D( ++ IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask ++) ++{ ++ u32 ReturnValue = 0, OriginalValue, BitShift; ++ u16 BBWaitCounter = 0; ++ ++#if (DISABLE_BB_RF == 1) ++ return 0; ++#endif ++ ++ ++ OriginalValue = rtw_read32(Adapter, RegAddr); ++ BitShift = phy_CalculateBitShift(BitMask); ++ ReturnValue = (OriginalValue & BitMask) >> BitShift; ++ ++ return ReturnValue; ++ ++} ++ ++ ++/** ++* Function: PHY_SetBBReg ++* ++* OverView: Write "Specific bits" to BB register (page 8~) ++* ++* Input: ++* PADAPTER Adapter, ++* u4Byte RegAddr, ++* u4Byte BitMask ++* ++* u4Byte Data ++* ++* ++* Output: None ++* Return: None ++* Note: This function is equal to "PutRegSetting" in PHY programming guide ++*/ ++ ++VOID ++PHY_SetBBReg_8723D( ++ IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ /* u16 BBWaitCounter = 0; */ ++ u32 OriginalValue, BitShift; ++ ++#if (DISABLE_BB_RF == 1) ++ return; ++#endif ++ ++ ++ if (BitMask != bMaskDWord) { /* if not "double word" write */ ++ OriginalValue = rtw_read32(Adapter, RegAddr); ++ BitShift = phy_CalculateBitShift(BitMask); ++ Data = ((OriginalValue & (~BitMask)) | ((Data << BitShift) & BitMask)); ++ } ++ ++ rtw_write32(Adapter, RegAddr, Data); ++ ++} ++ ++ ++/* ++ * 2. RF register R/W API ++ * */ ++ ++/*----------------------------------------------------------------------------- ++ * Function: phy_FwRFSerialRead() ++ * ++ * Overview: We support firmware to execute RF-R/W. ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 01/21/2008 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++static u32 ++phy_FwRFSerialRead( ++ IN PADAPTER Adapter, ++ IN RF_PATH eRFPath, ++ IN u32 Offset) ++{ ++ u32 retValue = 0; ++ /* RT_ASSERT(FALSE,("deprecate!\n")); */ ++ return retValue; ++ ++} /* phy_FwRFSerialRead */ ++ ++ ++/*----------------------------------------------------------------------------- ++ * Function: phy_FwRFSerialWrite() ++ * ++ * Overview: We support firmware to execute RF-R/W. ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 01/21/2008 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++static VOID ++phy_FwRFSerialWrite( ++ IN PADAPTER Adapter, ++ IN RF_PATH eRFPath, ++ IN u32 Offset, ++ IN u32 Data) ++{ ++ /* RT_ASSERT(FALSE,("deprecate!\n")); */ ++} ++ ++static u32 ++phy_RFSerialRead_8723D( ++ IN PADAPTER Adapter, ++ IN RF_PATH eRFPath, ++ IN u32 Offset ++) ++{ ++ u32 retValue = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ BB_REGISTER_DEFINITION_T *pPhyReg = &pHalData->PHYRegDef[eRFPath]; ++ u32 NewOffset; ++ u32 tmplong, tmplong2; ++ u8 RfPiEnable = 0; ++ u4Byte MaskforPhySet = 0; ++ int i = 0; ++ ++ _enter_critical_mutex(&(adapter_to_dvobj(Adapter)->rf_read_reg_mutex) , NULL); ++ /* */ ++ /* Make sure RF register offset is correct */ ++ /* */ ++ Offset &= 0xff; ++ ++ NewOffset = Offset; ++ ++ if (eRFPath == RF_PATH_A) { ++ tmplong2 = PHY_QueryBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord); ++ tmplong2 = (tmplong2 & (~bLSSIReadAddress)) | (NewOffset << 23) | bLSSIReadEdge; /* T65 RF */ ++ PHY_SetBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 & (~bLSSIReadEdge)); ++ } else { ++ tmplong2 = PHY_QueryBBReg(Adapter, rFPGA0_XB_HSSIParameter2 | MaskforPhySet, bMaskDWord); ++ tmplong2 = (tmplong2 & (~bLSSIReadAddress)) | (NewOffset << 23) | bLSSIReadEdge; /* T65 RF */ ++ PHY_SetBBReg(Adapter, rFPGA0_XB_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 & (~bLSSIReadEdge)); ++ } ++ ++ tmplong2 = PHY_QueryBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord); ++ PHY_SetBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 & (~bLSSIReadEdge)); ++ PHY_SetBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 | bLSSIReadEdge); ++ ++ rtw_udelay_os(10); ++ ++ for (i = 0; i < 2; i++) ++ rtw_udelay_os(MAX_STALL_TIME); ++ rtw_udelay_os(10); ++ ++ if (eRFPath == RF_PATH_A) ++ RfPiEnable = (u1Byte)PHY_QueryBBReg(Adapter, rFPGA0_XA_HSSIParameter1 | MaskforPhySet, BIT(8)); ++ else if (eRFPath == RF_PATH_B) ++ RfPiEnable = (u1Byte)PHY_QueryBBReg(Adapter, rFPGA0_XB_HSSIParameter1 | MaskforPhySet, BIT(8)); ++ ++ if (RfPiEnable) { ++ /* Read from BBreg8b8, 12 bits for 8190, 20bits for T65 RF */ ++ retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBackPi | MaskforPhySet, bLSSIReadBackData); ++ ++ /* RT_DISP(FINIT, INIT_RF, ("Readback from RF-PI : 0x%x\n", retValue)); */ ++ } else { ++ /* Read from BBreg8a0, 12 bits for 8190, 20 bits for T65 RF */ ++ retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBack | MaskforPhySet, bLSSIReadBackData); ++ ++ /* RT_DISP(FINIT, INIT_RF,("Readback from RF-SI : 0x%x\n", retValue)); */ ++ } ++ _exit_critical_mutex(&(adapter_to_dvobj(Adapter)->rf_read_reg_mutex) , NULL); ++ return retValue; ++ ++} ++ ++/** ++* Function: phy_RFSerialWrite_8723D ++* ++* OverView: Write data to RF register (page 8~) ++* ++* Input: ++* PADAPTER Adapter, ++* RF_PATH eRFPath, ++* u4Byte Offset, ++* u4Byte Data ++* ++* ++* Output: None ++* Return: None ++* Note: Threre are three types of serial operations: ++* 1. Software serial write ++* 2. Hardware LSSI-Low Speed Serial Interface ++* 3. Hardware HSSI-High speed ++* serial write. Driver need to implement (1) and (2). ++* This function is equal to the combination of RF_ReadReg() and RFLSSIRead() ++ * ++ * Note: For RF8256 only ++ * The total count of RTL8256(Zebra4) register is around 36 bit it only employs ++ * 4-bit RF address. RTL8256 uses "register mode control bit" (Reg00[12], Reg00[10]) ++ * to access register address bigger than 0xf. See "Appendix-4 in PHY Configuration ++ * programming guide" for more details. ++ * Thus, we define a sub-finction for RTL8526 register address conversion ++ * =========================================================== ++ * Register Mode RegCTL[1] RegCTL[0] Note ++ * (Reg00[12]) (Reg00[10]) ++ * =========================================================== ++ * Reg_Mode0 0 x Reg 0 ~15(0x0 ~ 0xf) ++ * ------------------------------------------------------------------ ++ * Reg_Mode1 1 0 Reg 16 ~30(0x1 ~ 0xf) ++ * ------------------------------------------------------------------ ++ * Reg_Mode2 1 1 Reg 31 ~ 45(0x1 ~ 0xf) ++ * ------------------------------------------------------------------ ++ * ++ * 2008/09/02 MH Add 92S RF definition ++ * ++ * ++ * ++*/ ++static VOID ++phy_RFSerialWrite_8723D( ++ IN PADAPTER Adapter, ++ IN RF_PATH eRFPath, ++ IN u32 Offset, ++ IN u32 Data ++) ++{ ++ u32 DataAndAddr = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ BB_REGISTER_DEFINITION_T *pPhyReg = &pHalData->PHYRegDef[eRFPath]; ++ u32 NewOffset; ++ ++ Offset &= 0xff; ++ ++ /* */ ++ /* Shadow Update */ ++ /* */ ++ /* PHY_RFShadowWrite(Adapter, eRFPath, Offset, Data); */ ++ ++ /* */ ++ /* Switch page for 8256 RF IC */ ++ /* */ ++ NewOffset = Offset; ++ ++ /* */ ++ /* Put write addr in [5:0] and write data in [31:16] */ ++ /* */ ++ /* DataAndAddr = (Data<<16) | (NewOffset&0x3f); */ ++ DataAndAddr = ((NewOffset << 20) | (Data & 0x000fffff)) & 0x0fffffff; /* T65 RF */ ++ ++ /* */ ++ /* Write Operation */ ++ /* */ ++ PHY_SetBBReg(Adapter, pPhyReg->rf3wireOffset, bMaskDWord, DataAndAddr); ++ /* RTPRINT(FPHY, PHY_RFW, ("RFW-%d Addr[0x%lx]=0x%lx\n", eRFPath, pPhyReg->rf3wireOffset, DataAndAddr)); */ ++ ++} ++ ++ ++/** ++* Function: PHY_QueryRFReg ++* ++* OverView: Query "Specific bits" to RF register (page 8~) ++* ++* Input: ++* PADAPTER Adapter, ++* RF_PATH eRFPath, ++* u4Byte RegAddr, ++* u4Byte BitMask ++* ++* ++* Output: None ++* Return: u4Byte Readback value ++* Note: This function is equal to "GetRFRegSetting" in PHY programming guide ++*/ ++u32 ++PHY_QueryRFReg_8723D( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask ++) ++{ ++ u32 Original_Value, Readback_Value, BitShift; ++ ++#if (DISABLE_BB_RF == 1) ++ return 0; ++#endif ++ ++ Original_Value = phy_RFSerialRead_8723D(Adapter, eRFPath, RegAddr); ++ ++ BitShift = phy_CalculateBitShift(BitMask); ++ Readback_Value = (Original_Value & BitMask) >> BitShift; ++ ++ return Readback_Value; ++} ++ ++/** ++* Function: PHY_SetRFReg ++* ++* OverView: Write "Specific bits" to RF register (page 8~) ++* ++* Input: ++* PADAPTER Adapter, ++* RF_PATH eRFPath, ++* u4Byte RegAddr, ++* u4Byte BitMask ++* ++* u4Byte Data ++* ++* ++* Output: None ++* Return: None ++* Note: This function is equal to "PutRFRegSetting" in PHY programming guide ++*/ ++VOID ++PHY_SetRFReg_8723D( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data ++) ++{ ++ u32 Original_Value, BitShift; ++ ++#if (DISABLE_BB_RF == 1) ++ return; ++#endif ++ ++ /* RF data is 12 bits only */ ++ if (BitMask != bRFRegOffsetMask) { ++ Original_Value = phy_RFSerialRead_8723D(Adapter, eRFPath, RegAddr); ++ BitShift = phy_CalculateBitShift(BitMask); ++ Data = ((Original_Value & (~BitMask)) | (Data << BitShift)); ++ } ++ ++ phy_RFSerialWrite_8723D(Adapter, eRFPath, RegAddr, Data); ++} ++ ++ ++/* ++ * 3. Initial MAC/BB/RF config by reading MAC/BB/RF txt. ++ * */ ++ ++ ++/*----------------------------------------------------------------------------- ++ * Function: PHY_MACConfig8192C ++ * ++ * Overview: Condig MAC by header file or parameter file. ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 08/12/2008 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++s32 PHY_MACConfig8723D(PADAPTER Adapter) ++{ ++ int rtStatus = _SUCCESS; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ /* */ ++ /* Config MAC */ ++ /* */ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ rtStatus = phy_ConfigMACWithParaFile(Adapter, PHY_FILE_MAC_REG); ++ if (rtStatus == _FAIL) ++#endif ++ { ++#ifdef CONFIG_EMBEDDED_FWIMG ++ ODM_ConfigMACWithHeaderFile(&pHalData->odmpriv); ++ rtStatus = _SUCCESS; ++#endif/* CONFIG_EMBEDDED_FWIMG */ ++ } ++ ++ return rtStatus; ++} ++ ++/** ++* Function: phy_InitBBRFRegisterDefinition ++* ++* OverView: Initialize Register definition offset for Radio Path A/B/C/D ++* ++* Input: ++* PADAPTER Adapter, ++* ++* Output: None ++* Return: None ++* Note: The initialization value is constant and it should never be changes ++*/ ++static VOID ++phy_InitBBRFRegisterDefinition( ++ IN PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ /* RF Interface Sowrtware Control */ ++ pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfs = rFPGA0_XAB_RFInterfaceSW; /* 16 LSBs if read 32-bit from 0x870 */ ++ pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfs = rFPGA0_XAB_RFInterfaceSW; /* 16 MSBs if read 32-bit from 0x870 (16-bit for 0x872) */ ++ ++ /* RF Interface Output (and Enable) */ ++ pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfo = rFPGA0_XA_RFInterfaceOE; /* 16 LSBs if read 32-bit from 0x860 */ ++ pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfo = rFPGA0_XB_RFInterfaceOE; /* 16 LSBs if read 32-bit from 0x864 */ ++ ++ /* RF Interface (Output and) Enable */ ++ pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfe = rFPGA0_XA_RFInterfaceOE; /* 16 MSBs if read 32-bit from 0x860 (16-bit for 0x862) */ ++ pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfe = rFPGA0_XB_RFInterfaceOE; /* 16 MSBs if read 32-bit from 0x864 (16-bit for 0x866) */ ++ ++ pHalData->PHYRegDef[ODM_RF_PATH_A].rf3wireOffset = rFPGA0_XA_LSSIParameter; /* LSSI Parameter */ ++ pHalData->PHYRegDef[ODM_RF_PATH_B].rf3wireOffset = rFPGA0_XB_LSSIParameter; ++ ++ pHalData->PHYRegDef[ODM_RF_PATH_A].rfHSSIPara2 = rFPGA0_XA_HSSIParameter2; /* wire control parameter2 */ ++ pHalData->PHYRegDef[ODM_RF_PATH_B].rfHSSIPara2 = rFPGA0_XB_HSSIParameter2; /* wire control parameter2 */ ++ ++ /* Tranceiver Readback LSSI/HSPI mode */ ++ pHalData->PHYRegDef[ODM_RF_PATH_A].rfLSSIReadBack = rFPGA0_XA_LSSIReadBack; ++ pHalData->PHYRegDef[ODM_RF_PATH_B].rfLSSIReadBack = rFPGA0_XB_LSSIReadBack; ++ pHalData->PHYRegDef[ODM_RF_PATH_A].rfLSSIReadBackPi = TransceiverA_HSPI_Readback; ++ pHalData->PHYRegDef[ODM_RF_PATH_B].rfLSSIReadBackPi = TransceiverB_HSPI_Readback; ++ ++} ++ ++static int ++phy_BB8723d_Config_ParaFile( ++ IN PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ int rtStatus = _SUCCESS; ++ ++ /* */ ++ /* 1. Read PHY_REG.TXT BB INIT!! */ ++ /* */ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ if (phy_ConfigBBWithParaFile(Adapter, PHY_FILE_PHY_REG, CONFIG_BB_PHY_REG) == _FAIL) ++#endif ++ { ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG)) ++ rtStatus = _FAIL; ++#endif ++ } ++ ++ if (rtStatus != _SUCCESS) { ++ RTW_INFO("%s():Write BB Reg Fail!!", __func__); ++ goto phy_BB8190_Config_ParaFile_Fail; ++ } ++ ++#if MP_DRIVER == 1 ++ if (Adapter->registrypriv.mp_mode == 1) { ++ /*20160504, Suggested by jessica_wang. To Fix CCK ACPR issue*/ ++ PHY_SetBBReg(Adapter, 0xCE0, BIT1|BIT0, 0);/*RXHP=low corner*/ ++ PHY_SetBBReg(Adapter, 0xC3C, 0xFF, 0xCC);/*make sure low rate sensitivity*/ ++ } ++#endif /* #if (MP_DRIVER == 1) */ ++ ++ /* */ ++ /* 2. Read BB AGC table Initialization */ ++ /* */ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ if (phy_ConfigBBWithParaFile(Adapter, PHY_FILE_AGC_TAB, CONFIG_BB_AGC_TAB) == _FAIL) ++#endif ++ { ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_AGC_TAB)) ++ rtStatus = _FAIL; ++#endif ++ } ++ ++ if (rtStatus != _SUCCESS) { ++ RTW_INFO("%s():AGC Table Fail\n", __func__); ++ goto phy_BB8190_Config_ParaFile_Fail; ++ } ++ ++phy_BB8190_Config_ParaFile_Fail: ++ ++ return rtStatus; ++} ++ ++ ++int ++PHY_BBConfig8723D( ++ IN PADAPTER Adapter ++) ++{ ++ int rtStatus = _SUCCESS; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u32 RegVal; ++ u8 TmpU1B = 0; ++ u8 value8; ++ ++ phy_InitBBRFRegisterDefinition(Adapter); ++ ++ /* Enable BB and RF */ ++ RegVal = rtw_read16(Adapter, REG_SYS_FUNC_EN); ++ rtw_write16(Adapter, REG_SYS_FUNC_EN, (u16)(RegVal | BIT(13) | BIT(0) | BIT(1))); ++ ++ rtw_write8(Adapter, REG_RF_CTRL, RF_EN | RF_RSTB | RF_SDMRSTB); ++ ++#if (DEV_BUS_TYPE == RT_USB_INTERFACE) ++ rtw_write8(Adapter, REG_SYS_FUNC_EN, FEN_USBA | FEN_USBD | FEN_BB_GLB_RSTn | FEN_BBRSTB); ++#else ++ rtw_write8(Adapter, REG_SYS_FUNC_EN, FEN_PPLL | FEN_PCIEA | FEN_DIO_PCIE | FEN_BB_GLB_RSTn | FEN_BBRSTB); ++#endif ++ ++#if DEV_BUS_TYPE == RT_USB_INTERFACE ++ /* To Fix MAC loopback mode fail. Suggested by SD4 Johnny. 2010.03.23. */ ++ PlatformEFIOWrite1Byte(Adapter, REG_LDOHCI12_CTRL, 0x0f); ++ PlatformEFIOWrite1Byte(Adapter, 0x15, 0xe9); ++#endif ++ ++ rtw_write8(Adapter, REG_AFE_XTAL_CTRL + 1, 0x80); ++ ++ /* ++ * Config BB and AGC ++ */ ++ rtStatus = phy_BB8723d_Config_ParaFile(Adapter); ++ ++ hal_set_crystal_cap(Adapter, pHalData->CrystalCap); ++ ++ return rtStatus; ++} ++#if 0 ++/* Block & Path enable */ ++#define rOFDMCCKEN_Jaguar 0x808 /* OFDM/CCK block enable */ ++#define bOFDMEN_Jaguar 0x20000000 ++#define bCCKEN_Jaguar 0x10000000 ++#define rRxPath_Jaguar 0x808 /* Rx antenna */ ++#define bRxPath_Jaguar 0xff ++#define rTxPath_Jaguar 0x80c /* Tx antenna */ ++#define bTxPath_Jaguar 0x0fffffff ++#define rCCK_RX_Jaguar 0xa04 /* for cck rx path selection */ ++#define bCCK_RX_Jaguar 0x0c000000 ++#define rVhtlen_Use_Lsig_Jaguar 0x8c3 /* Use LSIG for VHT length */ ++VOID ++PHY_BB8723D_Config_1T( ++ IN PADAPTER Adapter ++) ++{ ++ /* BB OFDM RX Path_A */ ++ PHY_SetBBReg(Adapter, rRxPath_Jaguar, bRxPath_Jaguar, 0x11); ++ /* BB OFDM TX Path_A */ ++ PHY_SetBBReg(Adapter, rTxPath_Jaguar, bMaskLWord, 0x1111); ++ /* BB CCK R/Rx Path_A */ ++ PHY_SetBBReg(Adapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); ++ /* MCS support */ ++ PHY_SetBBReg(Adapter, 0x8bc, 0xc0000060, 0x4); ++ /* RF Path_B HSSI OFF */ ++ PHY_SetBBReg(Adapter, 0xe00, 0xf, 0x4); ++ /* RF Path_B Power Down */ ++ PHY_SetBBReg(Adapter, 0xe90, bMaskDWord, 0); ++ /* ADDA Path_B OFF */ ++ PHY_SetBBReg(Adapter, 0xe60, bMaskDWord, 0); ++ PHY_SetBBReg(Adapter, 0xe64, bMaskDWord, 0); ++} ++#endif ++ ++int ++PHY_RFConfig8723D( ++ IN PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ int rtStatus = _SUCCESS; ++ ++ /* */ ++ /* RF config */ ++ /* */ ++ rtStatus = PHY_RF6052_Config8723D(Adapter); ++ /* 20151207 LCK done at RadioA table */ ++ /* PHY_BB8723D_Config_1T(Adapter); */ ++ ++ return rtStatus; ++} ++ ++/*----------------------------------------------------------------------------- ++ * Function: PHY_ConfigRFWithParaFile() ++ * ++ * Overview: This function read RF parameters from general file format, and do RF 3-wire ++ * ++ * Input: PADAPTER Adapter ++ * ps1Byte pFileName ++ * RF_PATH eRFPath ++ * ++ * Output: NONE ++ * ++ * Return: RT_STATUS_SUCCESS: configuration file exist ++ * ++ * Note: Delay may be required for RF configuration ++ *---------------------------------------------------------------------------*/ ++int ++PHY_ConfigRFWithParaFile_8723D( ++ IN PADAPTER Adapter, ++ IN u8 *pFileName, ++ RF_PATH eRFPath ++) ++{ ++ return _SUCCESS; ++} ++ ++/************************************************************************************************************** ++ * Description: ++ * The low-level interface to set TxAGC , called by both MP and Normal Driver. ++ * ++ * <20120830, Kordan> ++ **************************************************************************************************************/ ++ ++VOID ++PHY_SetTxPowerIndex_8723D( ++ IN PADAPTER Adapter, ++ IN u32 PowerIndex, ++ IN u8 RFPath, ++ IN u8 Rate ++) ++{ ++ if (RFPath == ODM_RF_PATH_A || RFPath == ODM_RF_PATH_B) { ++ switch (Rate) { ++ case MGN_1M: ++ PHY_SetBBReg(Adapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, PowerIndex); ++ break; ++ case MGN_2M: ++ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte1, PowerIndex); ++ break; ++ case MGN_5_5M: ++ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte2, PowerIndex); ++ break; ++ case MGN_11M: ++ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte3, PowerIndex); ++ break; ++ ++ case MGN_6M: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte0, PowerIndex); ++ break; ++ case MGN_9M: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte1, PowerIndex); ++ break; ++ case MGN_12M: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte2, PowerIndex); ++ break; ++ case MGN_18M: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte3, PowerIndex); ++ break; ++ ++ case MGN_24M: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte0, PowerIndex); ++ break; ++ case MGN_36M: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte1, PowerIndex); ++ break; ++ case MGN_48M: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte2, PowerIndex); ++ break; ++ case MGN_54M: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte3, PowerIndex); ++ break; ++ ++ case MGN_MCS0: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte0, PowerIndex); ++ break; ++ case MGN_MCS1: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte1, PowerIndex); ++ break; ++ case MGN_MCS2: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte2, PowerIndex); ++ break; ++ case MGN_MCS3: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte3, PowerIndex); ++ break; ++ ++ case MGN_MCS4: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte0, PowerIndex); ++ break; ++ case MGN_MCS5: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte1, PowerIndex); ++ break; ++ case MGN_MCS6: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte2, PowerIndex); ++ break; ++ case MGN_MCS7: ++ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte3, PowerIndex); ++ break; ++ ++ default: ++ RTW_INFO("Invalid Rate!!\n"); ++ break; ++ } ++ } ++} ++ ++u8 ++phy_GetCurrentTxNum_8723D( ++ IN PADAPTER pAdapter ++) ++{ ++ return RF_TX_NUM_NONIMPLEMENT; ++} ++ ++u8 ++PHY_GetTxPowerIndex_8723D( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN u8 BandWidth, ++ IN u8 Channel, ++ struct txpwr_idx_comp *tic ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ u8 base_idx = 0, power_idx = 0; ++ s8 by_rate_diff = 0, limit = 0, tpt_offset = 0, extra_bias = 0; ++ BOOLEAN bIn24G = _FALSE; ++ ++ base_idx = PHY_GetTxPowerIndexBase(pAdapter, RFPath, Rate, BandWidth, Channel, &bIn24G); ++ ++ by_rate_diff = PHY_GetTxPowerByRate(pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, RF_1TX, Rate); ++ limit = PHY_GetTxPowerLimit(pAdapter, pAdapter->registrypriv.RegPwrTblSel, (u8)(!bIn24G), pHalData->CurrentChannelBW, RFPath, Rate, pHalData->CurrentChannel); ++ ++ tpt_offset = PHY_GetTxPowerTrackingOffset(pAdapter, RFPath, Rate); ++ ++ if (tic) { ++ tic->base = base_idx; ++ tic->by_rate = by_rate_diff; ++ tic->limit = limit; ++ tic->tpt = tpt_offset; ++ tic->ebias = extra_bias; ++ } ++ ++ by_rate_diff = by_rate_diff > limit ? limit : by_rate_diff; ++ power_idx = base_idx + by_rate_diff + tpt_offset + extra_bias; ++ ++ if (power_idx > MAX_POWER_INDEX) ++ power_idx = MAX_POWER_INDEX; ++ ++ return power_idx; ++} ++ ++VOID ++PHY_SetTxPowerLevel8723D( ++ IN PADAPTER Adapter, ++ IN u8 Channel ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ u8 cur_antenna; ++ u8 RFPath = ODM_RF_PATH_A; ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ rtw_hal_get_odm_var(Adapter, HAL_ODM_ANTDIV_SELECT, &cur_antenna, NULL); ++ ++ if (pHalData->AntDivCfg) /* antenna diversity Enable */ ++ RFPath = ((cur_antenna == MAIN_ANT) ? ODM_RF_PATH_A : ODM_RF_PATH_B); ++ else /* antenna diversity disable */ ++#endif ++ RFPath = pHalData->ant_path; ++ ++ ++ ++ PHY_SetTxPowerLevelByPath(Adapter, Channel, RFPath); ++ ++} ++ ++VOID ++PHY_GetTxPowerLevel8723D( ++ IN PADAPTER Adapter, ++ OUT s32 *powerlevel ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ s32 TxPwrDbm = 13; ++#if 0 ++ ++ if (pMgntInfo->ClientConfigPwrInDbm != UNSPECIFIED_PWR_DBM) ++ *powerlevel = pMgntInfo->ClientConfigPwrInDbm; ++ else ++ *powerlevel = TxPwrDbm; ++#endif ++} ++ ++ ++/* <20160217, Jessica> A workaround to eliminate the 2472MHz & 2484MHz spur of 8723D. */ ++VOID ++phy_SpurCalibration_8723D( ++ IN PADAPTER pAdapter, ++ IN u1Byte ToChannel, ++ IN u1Byte threshold ++) ++{ ++ u4Byte freq[2] = {0xFCCD, 0xFF9A}; /* {chnl 13, 14} */ ++ u1Byte idx = 0xFF; ++ u1Byte b_doNotch = FALSE; ++ u1Byte initial_gain; ++ ++ /* add for notch */ ++ u4Byte wlan_channel, CurrentChannel; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ ++ /* check threshold */ ++ if (threshold <= 0x0) ++ threshold = 0x16; ++ ++ RTW_INFO("===>phy_SpurCalibration_8723D: Channel = %d\n", ToChannel); ++ ++ if (ToChannel == 13) ++ idx = 0; ++ else if (ToChannel == 14) ++ idx = 1; ++ ++ /* If current channel=13,14 */ ++ if (idx < 0xFF) { ++ initial_gain = (u1Byte)(ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0) & 0x7f); ++ odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, 0x30); ++ PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, bMaskDWord, 0xccf000c0); /* disable 3-wire */ ++ ++ PHY_SetBBReg(pAdapter, rFPGA0_PSDFunction, bMaskDWord, freq[idx]); /* Setup PSD */ ++ PHY_SetBBReg(pAdapter, rFPGA0_PSDFunction, bMaskDWord, 0x400000 | freq[idx]); /* Start PSD */ ++ ++ rtw_msleep_os(30); ++ ++ if (PHY_QueryBBReg(pAdapter, rFPGA0_PSDReport, bMaskDWord) >= threshold) ++ b_doNotch = TRUE; ++ ++ PHY_SetBBReg(pAdapter, rFPGA0_PSDFunction, bMaskDWord, freq[idx]); /* turn off PSD */ ++ PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, bMaskDWord, 0xccc000c0); /* enable 3-wire */ ++ odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, NONE); ++ } ++ ++ /* --- Notch Filter --- Asked by Rock */ ++ if (b_doNotch) { ++ CurrentChannel = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); ++ wlan_channel = CurrentChannel & 0x0f; /* Get center frequency */ ++ ++ switch (wlan_channel) { /* Set notch filter */ ++ case 13: ++ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0xB); ++ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(9), 0x1); /* enable notch filter */ ++ ODM_SetBBReg(pDM_Odm, 0xD40, bMaskDWord, 0x04000000); ++ ODM_SetBBReg(pDM_Odm, 0xD44, bMaskDWord, 0x00000000); ++ ODM_SetBBReg(pDM_Odm, 0xD48, bMaskDWord, 0x00000000); ++ ODM_SetBBReg(pDM_Odm, 0xD4C, bMaskDWord, 0x00000000); ++ ODM_SetBBReg(pDM_Odm, 0xD2C, BIT(28), 0x1); /* enable CSI mask */ ++ break; ++ case 14: ++ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0x5); ++ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(9), 0x1); /* enable notch filter */ ++ ODM_SetBBReg(pDM_Odm, 0xD40, bMaskDWord, 0x00000000); ++ ODM_SetBBReg(pDM_Odm, 0xD44, bMaskDWord, 0x00000000); ++ ODM_SetBBReg(pDM_Odm, 0xD48, bMaskDWord, 0x00000000); ++ ODM_SetBBReg(pDM_Odm, 0xD4C, bMaskDWord, 0x00080000); ++ ODM_SetBBReg(pDM_Odm, 0xD2C, BIT(28), 0x1); /* enable CSI mask */ ++ break; ++ default: ++ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(9), 0x0); /* disable notch filter */ ++ ODM_SetBBReg(pDM_Odm, 0xD2C, BIT(28), 0x0); /* disable CSI mask function */ ++ break; ++ } /* switch(wlan_channel) */ ++ return; ++ } ++ ++ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0x1f); ++ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(9), 0x0); /* disable notch filter */ ++ ODM_SetBBReg(pDM_Odm, 0xD40, bMaskDWord, 0x00000000); ++ ODM_SetBBReg(pDM_Odm, 0xD44, bMaskDWord, 0x00000000); ++ ODM_SetBBReg(pDM_Odm, 0xD48, bMaskDWord, 0x00000000); ++ ODM_SetBBReg(pDM_Odm, 0xD4C, bMaskDWord, 0x00000000); ++ ODM_SetBBReg(pDM_Odm, 0xD2C, BIT(28), 0x0); /* disable CSI mask */ ++} ++ ++VOID ++phy_SetRegBW_8723D( ++ IN PADAPTER Adapter, ++ CHANNEL_WIDTH CurrentBW ++) ++{ ++ u16 RegRfMod_BW, u2tmp = 0; ++ ++ RegRfMod_BW = rtw_read16(Adapter, REG_TRXPTCL_CTL_8723D); ++ ++ switch (CurrentBW) { ++ case CHANNEL_WIDTH_20: ++ rtw_write16(Adapter, REG_TRXPTCL_CTL_8723D, (RegRfMod_BW & 0xFE7F)); /* BIT 7 = 0, BIT 8 = 0 */ ++ break; ++ ++ case CHANNEL_WIDTH_40: ++ u2tmp = RegRfMod_BW | BIT(7); ++ rtw_write16(Adapter, REG_TRXPTCL_CTL_8723D, (u2tmp & 0xFEFF)); /* BIT 7 = 1, BIT 8 = 0 */ ++ break; ++ ++ case CHANNEL_WIDTH_80: ++ u2tmp = RegRfMod_BW | BIT(8); ++ rtw_write16(Adapter, REG_TRXPTCL_CTL_8723D, (u2tmp & 0xFF7F)); /* BIT 7 = 0, BIT 8 = 1 */ ++ break; ++ ++ default: ++ RTW_INFO("phy_PostSetBWMode8723D(): unknown Bandwidth: %#X\n", CurrentBW); ++ break; ++ } ++} ++ ++u8 ++phy_GetSecondaryChnl_8723D( ++ IN PADAPTER Adapter ++) ++{ ++ u8 SCSettingOf40 = 0, SCSettingOf20 = 0; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ ++ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) { ++ if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) ++ SCSettingOf40 = VHT_DATA_SC_40_LOWER_OF_80MHZ; ++ else if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) ++ SCSettingOf40 = VHT_DATA_SC_40_UPPER_OF_80MHZ; ++ ++ ++ if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) ++ SCSettingOf20 = VHT_DATA_SC_20_LOWEST_OF_80MHZ; ++ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) ++ SCSettingOf20 = VHT_DATA_SC_20_LOWER_OF_80MHZ; ++ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) ++ SCSettingOf20 = VHT_DATA_SC_20_UPPER_OF_80MHZ; ++ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) ++ SCSettingOf20 = VHT_DATA_SC_20_UPPERST_OF_80MHZ; ++ ++ } else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) { ++ ++ if (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) ++ SCSettingOf20 = VHT_DATA_SC_20_UPPER_OF_80MHZ; ++ else if (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) ++ SCSettingOf20 = VHT_DATA_SC_20_LOWER_OF_80MHZ; ++ ++ } ++ ++ return (SCSettingOf40 << 4) | SCSettingOf20; ++} ++ ++void ++phy_PostSetBwMode8723D( ++ IN PADAPTER padapter ++) ++{ ++ u1Byte SubChnlNum = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ /* 2 Set Reg668 Reg440 BW */ ++ phy_SetRegBW_8723D(padapter, pHalData->CurrentChannelBW); ++ ++ /* 3 Set Reg483 */ ++ SubChnlNum = phy_GetSecondaryChnl_8723D(padapter); ++ rtw_write8(padapter, REG_DATA_SC_8723D, SubChnlNum); ++ ++ switch (pHalData->CurrentChannelBW) { ++ /* 20 MHz channel*/ ++ case CHANNEL_WIDTH_20: ++ /* ++ 0x800[0]=1'b0 ++ 0x900[0]=1'b0 ++ 0x954[19]=1'b1 ++ 0x954[27:24]= 10 ++ */ ++ PHY_SetBBReg(padapter, rFPGA0_RFMOD, bRFMOD, 0x0); ++ PHY_SetBBReg(padapter, rFPGA1_RFMOD, bRFMOD, 0x0); ++ PHY_SetBBReg(padapter, rBBrx_DFIR, BIT(19), 1); ++ PHY_SetBBReg(padapter, rBBrx_DFIR, ++ (BIT(27) | BIT(26) | BIT(25) | BIT(24)), 0xa); ++ break; ++ /* 40 MHz channel*/ ++ case CHANNEL_WIDTH_40: ++ /* ++ 0x800[0]=1'b1 ++ 0x900[0]=1'b1 ++ 0x954[19]=1'b0 ++ 0x954[23:20]=2'b11(For ACPR) ++ 0xa00[4]=1/0 ++ */ ++ PHY_SetBBReg(padapter, rFPGA0_RFMOD, bRFMOD, 0x1); ++ PHY_SetBBReg(padapter, rFPGA1_RFMOD, bRFMOD, 0x1); ++ PHY_SetBBReg(padapter, rBBrx_DFIR, BIT(19), 0); ++ PHY_SetBBReg(padapter, rCCK0_System, bCCKSideBand, ++ (pHalData->nCur40MhzPrimeSC >> 1)); ++ ++ break; ++ default: ++ break; ++ } ++ ++ /*3<3>Set RF related register */ ++ PHY_RF6052SetBandwidth8723D(padapter, pHalData->CurrentChannelBW); ++} ++ ++VOID ++phy_SwChnl8723D( ++ IN PADAPTER pAdapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u8 channelToSW = pHalData->CurrentChannel; ++ u8 i = 0; ++ ++ if (pHalData->rf_chip == RF_PSEUDO_11N) { ++ RTW_INFO("phy_SwChnl8723D: return for PSEUDO\n"); ++ return; ++ } ++ ++ pHalData->RfRegChnlVal[0] = ++ ((pHalData->RfRegChnlVal[0] & 0xfffff00) | channelToSW); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_CHNLBW, ++ 0x3FF, pHalData->RfRegChnlVal[0]); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_CHNLBW, ++ 0x3FF, pHalData->RfRegChnlVal[0]); ++ ++ phy_SpurCalibration_8723D(pAdapter, channelToSW, 0x16); ++ ++ /* 2.4G CCK TX DFIR */ ++ /* 2016.01.20 Suggest from RS BB mingzhi*/ ++ if (channelToSW >= 1 && channelToSW <= 13) { ++ if (pHalData->need_restore == _TRUE) { ++ for (i = 0 ; i < 3 ; i++) { ++ PHY_SetBBReg(pAdapter, ++ pHalData->RegForRecover[i].offset, ++ bMaskDWord, ++ pHalData->RegForRecover[i].value); ++ } ++ pHalData->need_restore = _FALSE; ++ } ++ } else if (channelToSW == 14) { ++ pHalData->need_restore = _TRUE; ++ PHY_SetBBReg(pAdapter, rCCK0_TxFilter2, bMaskDWord, 0x0000B81C); ++ PHY_SetBBReg(pAdapter, rCCK0_DebugPort, bMaskDWord, 0x00000000); ++ PHY_SetBBReg(pAdapter, 0xAAC, bMaskDWord, 0x00003667); ++ } ++ ++ RTW_INFO("===>phy_SwChnl8723D: Channel = %d\n", channelToSW); ++} ++ ++VOID ++phy_SwChnlAndSetBwMode8723D( ++ IN PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ if (Adapter->bNotifyChannelChange) { ++ RTW_INFO("[%s] bSwChnl=%d, ch=%d, bSetChnlBW=%d, bw=%d\n", ++ __func__, ++ pHalData->bSwChnl, ++ pHalData->CurrentChannel, ++ pHalData->bSetChnlBW, ++ pHalData->CurrentChannelBW); ++ } ++ ++ if (RTW_CANNOT_RUN(Adapter)) ++ return; ++ ++ if (pHalData->bSwChnl) { ++ phy_SwChnl8723D(Adapter); ++ pHalData->bSwChnl = _FALSE; ++ } ++ ++ if (pHalData->bSetChnlBW) { ++ phy_PostSetBwMode8723D(Adapter); ++ pHalData->bSetChnlBW = _FALSE; ++ } ++ ++ PHY_SetTxPowerLevel8723D(Adapter, pHalData->CurrentChannel); ++} ++ ++VOID ++PHY_HandleSwChnlAndSetBW8723D( ++ IN PADAPTER Adapter, ++ IN BOOLEAN bSwitchChannel, ++ IN BOOLEAN bSetBandWidth, ++ IN u8 ChannelNum, ++ IN CHANNEL_WIDTH ChnlWidth, ++ IN EXTCHNL_OFFSET ExtChnlOffsetOf40MHz, ++ IN EXTCHNL_OFFSET ExtChnlOffsetOf80MHz, ++ IN u8 CenterFrequencyIndex1 ++) ++{ ++ /* static BOOLEAN bInitialzed = _FALSE; */ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ u8 tmpChannel = pHalData->CurrentChannel; ++ CHANNEL_WIDTH tmpBW = pHalData->CurrentChannelBW; ++ u8 tmpnCur40MhzPrimeSC = pHalData->nCur40MhzPrimeSC; ++ u8 tmpnCur80MhzPrimeSC = pHalData->nCur80MhzPrimeSC; ++ u8 tmpCenterFrequencyIndex1 = pHalData->CurrentCenterFrequencyIndex1; ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ ++ /* RTW_INFO("=> PHY_HandleSwChnlAndSetBW8812: bSwitchChannel %d, bSetBandWidth %d\n",bSwitchChannel,bSetBandWidth); */ ++ ++ /* check is swchnl or setbw */ ++ if (!bSwitchChannel && !bSetBandWidth) { ++ RTW_INFO("PHY_HandleSwChnlAndSetBW8812: not switch channel and not set bandwidth\n"); ++ return; ++ } ++ ++ /* skip change for channel or bandwidth is the same */ ++ if (bSwitchChannel) { ++ /* if(pHalData->CurrentChannel != ChannelNum) */ ++ { ++ if (HAL_IsLegalChannel(Adapter, ChannelNum)) ++ pHalData->bSwChnl = _TRUE; ++ } ++ } ++ ++ if (bSetBandWidth) { ++#if 0 ++ if (bInitialzed == _FALSE) { ++ bInitialzed = _TRUE; ++ pHalData->bSetChnlBW = _TRUE; ++ } else if ((pHalData->CurrentChannelBW != ChnlWidth) || (pHalData->nCur40MhzPrimeSC != ExtChnlOffsetOf40MHz) || (pHalData->CurrentCenterFrequencyIndex1 != CenterFrequencyIndex1)) ++ pHalData->bSetChnlBW = _TRUE; ++#else ++ pHalData->bSetChnlBW = _TRUE; ++#endif ++ } ++ ++ if (!pHalData->bSetChnlBW && !pHalData->bSwChnl) { ++ /* RTW_INFO("<= PHY_HandleSwChnlAndSetBW8812: bSwChnl %d, bSetChnlBW %d\n",pHalData->bSwChnl,pHalData->bSetChnlBW); */ ++ return; ++ } ++ ++ ++ if (pHalData->bSwChnl) { ++ pHalData->CurrentChannel = ChannelNum; ++ pHalData->CurrentCenterFrequencyIndex1 = ChannelNum; ++ } ++ ++ ++ if (pHalData->bSetChnlBW) { ++ pHalData->CurrentChannelBW = ChnlWidth; ++#if 0 ++ if (ExtChnlOffsetOf40MHz == EXTCHNL_OFFSET_LOWER) ++ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_UPPER; ++ else if (ExtChnlOffsetOf40MHz == EXTCHNL_OFFSET_UPPER) ++ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_LOWER; ++ else ++ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ if (ExtChnlOffsetOf80MHz == EXTCHNL_OFFSET_LOWER) ++ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_UPPER; ++ else if (ExtChnlOffsetOf80MHz == EXTCHNL_OFFSET_UPPER) ++ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_LOWER; ++ else ++ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++#else ++ pHalData->nCur40MhzPrimeSC = ExtChnlOffsetOf40MHz; ++ pHalData->nCur80MhzPrimeSC = ExtChnlOffsetOf80MHz; ++#endif ++ ++ pHalData->CurrentCenterFrequencyIndex1 = CenterFrequencyIndex1; ++ } ++ ++ /* Switch workitem or set timer to do switch channel or setbandwidth operation */ ++ if (!RTW_CANNOT_RUN(Adapter)) ++ phy_SwChnlAndSetBwMode8723D(Adapter); ++ else { ++ if (pHalData->bSwChnl) { ++ pHalData->CurrentChannel = tmpChannel; ++ pHalData->CurrentCenterFrequencyIndex1 = tmpChannel; ++ } ++ if (pHalData->bSetChnlBW) { ++ pHalData->CurrentChannelBW = tmpBW; ++ pHalData->nCur40MhzPrimeSC = tmpnCur40MhzPrimeSC; ++ pHalData->nCur80MhzPrimeSC = tmpnCur80MhzPrimeSC; ++ pHalData->CurrentCenterFrequencyIndex1 = tmpCenterFrequencyIndex1; ++ } ++ } ++ ++ /* RTW_INFO("Channel %d ChannelBW %d ",pHalData->CurrentChannel, pHalData->CurrentChannelBW); */ ++ /* RTW_INFO("40MhzPrimeSC %d 80MhzPrimeSC %d ",pHalData->nCur40MhzPrimeSC, pHalData->nCur80MhzPrimeSC); */ ++ /* RTW_INFO("CenterFrequencyIndex1 %d\n",pHalData->CurrentCenterFrequencyIndex1); */ ++ ++ /* RTW_INFO("<= PHY_HandleSwChnlAndSetBW8812: bSwChnl %d, bSetChnlBW %d\n",pHalData->bSwChnl,pHalData->bSetChnlBW); */ ++ ++} ++ ++VOID ++PHY_SetSwChnlBWMode8723D( ++ IN PADAPTER Adapter, ++ IN u8 channel, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 Offset40, ++ IN u8 Offset80 ++) ++{ ++ /* RTW_INFO("%s()===>\n",__FUNCTION__); */ ++ ++ PHY_HandleSwChnlAndSetBW8723D(Adapter, _TRUE, _TRUE, channel, Bandwidth, Offset40, Offset80, channel); ++ ++ /* RTW_INFO("<==%s()\n",__FUNCTION__); */ ++} ++ ++static VOID ++_PHY_DumpRFReg_8723D(IN PADAPTER pAdapter) ++{ ++ u32 rfRegValue, rfRegOffset; ++ ++ ++ for (rfRegOffset = 0x00; rfRegOffset <= 0x30; rfRegOffset++) { ++ rfRegValue = PHY_QueryRFReg_8723D(pAdapter, RF_PATH_A, rfRegOffset, bMaskDWord); ++ } ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rf6052.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rf6052.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rf6052.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rf6052.c 2018-02-11 21:44:27.164146345 +0200 +@@ -0,0 +1,253 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++/****************************************************************************** ++ * ++ * ++ * Module: rtl8192c_rf6052.c ( Source C File) ++ * ++ * Note: Provide RF 6052 series relative API. ++ * ++ * Function: ++ * ++ * Export: ++ * ++ * Abbrev: ++ * ++ * History: ++ * Data Who Remark ++ * ++ * 09/25/2008 MHC Create initial version. ++ * 11/05/2008 MHC Add API for tw power setting. ++ * ++ * ++******************************************************************************/ ++ ++#include ++ ++/*---------------------------Define Local Constant---------------------------*/ ++/*---------------------------Define Local Constant---------------------------*/ ++ ++ ++/*------------------------Define global variable-----------------------------*/ ++/*------------------------Define global variable-----------------------------*/ ++ ++ ++/*------------------------Define local variable------------------------------*/ ++/* 2008/11/20 MH For Debug only, RF ++ * static RF_SHADOW_T RF_Shadow[RF6052_MAX_PATH][RF6052_MAX_REG] = {0}; */ ++static RF_SHADOW_T RF_Shadow[RF6052_MAX_PATH][RF6052_MAX_REG]; ++/*------------------------Define local variable------------------------------*/ ++ ++/*----------------------------------------------------------------------------- ++ * Function: PHY_RF6052SetBandwidth() ++ * ++ * Overview: This function is called by SetBWModeCallback8190Pci() only ++ * ++ * Input: PADAPTER Adapter ++ * WIRELESS_BANDWIDTH_E Bandwidth ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Note: For RF type 0222D ++ *---------------------------------------------------------------------------*/ ++VOID ++PHY_RF6052SetBandwidth8723D( ++ IN PADAPTER padapter, ++ IN CHANNEL_WIDTH Bandwidth) /* 20M or 40M */ ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ switch (Bandwidth) { ++ case CHANNEL_WIDTH_20: ++ /* ++ RF_A_reg 0x18[11:10]=2'b11 ++ RF_A_reg 0x18[9:0] ++ */ ++ pHalData->RfRegChnlVal[0] = ((pHalData->RfRegChnlVal[0] & 0xfffff3ff) | BIT(10) | BIT(11)); ++ PHY_SetRFReg(padapter, ODM_RF_PATH_A, 0x18, bRFRegOffsetMask, pHalData->RfRegChnlVal[0]); /* RF TRX_BW */ ++ break; ++ case CHANNEL_WIDTH_40: ++ /* ++ RF_A_reg 0x18[11:10]=2'b01 ++ RF_A_reg 0x18[9:0] ++ */ ++ pHalData->RfRegChnlVal[0] = ((pHalData->RfRegChnlVal[0] & 0xfffff3ff) | BIT(10)); ++ PHY_SetRFReg(padapter, ODM_RF_PATH_A, 0x18, bRFRegOffsetMask, pHalData->RfRegChnlVal[0]); /* RF TRX_BW */ ++ break; ++ default: ++ break; ++ } ++} ++ ++static VOID ++phy_RF6052_Config_HardCode( ++ IN PADAPTER Adapter ++) ++{ ++ ++ /* Set Default Bandwidth to 20M */ ++ /* Adapter->HalFunc .SetBWModeHandler(Adapter, CHANNEL_WIDTH_20); */ ++ ++ /* TODO: Set Default Channel to channel one for RTL8225 */ ++ ++} ++ ++static int ++phy_RF6052_Config_ParaFile( ++ IN PADAPTER Adapter ++) ++{ ++ u32 u4RegValue = 0; ++ u8 eRFPath; ++ BB_REGISTER_DEFINITION_T *pPhyReg; ++ ++ int rtStatus = _SUCCESS; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ /* 3//----------------------------------------------------------------- */ ++ /* 3// <2> Initialize RF */ ++ /* 3//----------------------------------------------------------------- */ ++ /* for(eRFPath = RF_PATH_A; eRFPath NumTotalRFPath; eRFPath++) */ ++ for (eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) { ++ ++ pPhyReg = &pHalData->PHYRegDef[eRFPath]; ++ ++ /*----Store original RFENV control type----*/ ++ switch (eRFPath) { ++ case RF_PATH_A: ++ case RF_PATH_C: ++ u4RegValue = PHY_QueryBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV); ++ break; ++ case RF_PATH_B: ++ case RF_PATH_D: ++ u4RegValue = PHY_QueryBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV << 16); ++ break; ++ } ++ ++ /*----Set RF_ENV enable----*/ ++ PHY_SetBBReg(Adapter, pPhyReg->rfintfe, bRFSI_RFENV << 16, 0x1); ++ rtw_udelay_os(1);/* PlatformStallExecution(1); */ ++ ++ /*----Set RF_ENV output high----*/ ++ PHY_SetBBReg(Adapter, pPhyReg->rfintfo, bRFSI_RFENV, 0x1); ++ rtw_udelay_os(1);/* PlatformStallExecution(1); */ ++ ++ /* Set bit number of Address and Data for RF register */ ++ PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, b3WireAddressLength, 0x0); /* Set 1 to 4 bits for 8255 */ ++ rtw_udelay_os(1);/* PlatformStallExecution(1); */ ++ ++ PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, b3WireDataLength, 0x0); /* Set 0 to 12 bits for 8255 */ ++ rtw_udelay_os(1);/* PlatformStallExecution(1); */ ++ ++ /*----Initialize RF fom connfiguration file----*/ ++ switch (eRFPath) { ++ case RF_PATH_A: ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ if (PHY_ConfigRFWithParaFile(Adapter, PHY_FILE_RADIO_A, eRFPath) == _FAIL) ++#endif ++ { ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if (HAL_STATUS_FAILURE == ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv, CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) ++ rtStatus = _FAIL; ++#endif ++ } ++ break; ++ case RF_PATH_B: ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ if (PHY_ConfigRFWithParaFile(Adapter, PHY_FILE_RADIO_B, eRFPath) == _FAIL) ++#endif ++ { ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if (HAL_STATUS_FAILURE == ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv, CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) ++ rtStatus = _FAIL; ++#endif ++ } ++ break; ++ case RF_PATH_C: ++ break; ++ case RF_PATH_D: ++ break; ++ } ++ ++ /*----Restore RFENV control type----*/; ++ switch (eRFPath) { ++ case RF_PATH_A: ++ case RF_PATH_C: ++ PHY_SetBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV, u4RegValue); ++ break; ++ case RF_PATH_B: ++ case RF_PATH_D: ++ PHY_SetBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV << 16, u4RegValue); ++ break; ++ } ++ ++ if (rtStatus != _SUCCESS) { ++ goto phy_RF6052_Config_ParaFile_Fail; ++ } ++ ++ } ++ ++ /* 3 ----------------------------------------------------------------- */ ++ /* 3 Configuration of Tx Power Tracking */ ++ /* 3 ----------------------------------------------------------------- */ ++ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ if (PHY_ConfigRFWithTxPwrTrackParaFile(Adapter, PHY_FILE_TXPWR_TRACK) == _FAIL) ++#endif ++ { ++#ifdef CONFIG_EMBEDDED_FWIMG ++ ODM_ConfigRFWithTxPwrTrackHeaderFile(&pHalData->odmpriv); ++#endif ++ } ++ ++ return rtStatus; ++ ++phy_RF6052_Config_ParaFile_Fail: ++ return rtStatus; ++} ++ ++ ++int ++PHY_RF6052_Config8723D( ++ IN PADAPTER Adapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ int rtStatus = _SUCCESS; ++ ++ /* */ ++ /* Initialize general global value */ ++ /* */ ++ /* TODO: Extend RF_PATH_C and RF_PATH_D in the future */ ++ if (pHalData->rf_type == RF_1T1R) ++ pHalData->NumTotalRFPath = 1; ++ else ++ pHalData->NumTotalRFPath = 2; ++ ++ /* */ ++ /* Config BB and RF */ ++ /* */ ++ rtStatus = phy_RF6052_Config_ParaFile(Adapter); ++ return rtStatus; ++ ++} ++ ++/* End of HalRf6052.c */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rxdesc.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rxdesc.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rxdesc.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rxdesc.c 2018-02-11 21:44:27.164146345 +0200 +@@ -0,0 +1,62 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTL8723D_REDESC_C_ ++ ++#include ++ ++void rtl8723d_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc) ++{ ++ struct rx_pkt_attrib *pattrib; ++ ++ ++ pattrib = &precvframe->u.hdr.attrib; ++ _rtw_memset(pattrib, 0, sizeof(struct rx_pkt_attrib)); ++ ++ pattrib->pkt_len = (u16)GET_RX_STATUS_DESC_PKT_LEN_8723D(pdesc); ++ pattrib->pkt_rpt_type = GET_RX_STATUS_DESC_RPT_SEL_8723D(pdesc) ? C2H_PACKET : NORMAL_RX; ++ ++ if (pattrib->pkt_rpt_type == NORMAL_RX) { ++ /* Offset 0 */ ++ pattrib->crc_err = (u8)GET_RX_STATUS_DESC_CRC32_8723D(pdesc); ++ pattrib->icv_err = (u8)GET_RX_STATUS_DESC_ICV_8723D(pdesc); ++ pattrib->drvinfo_sz = (u8)GET_RX_STATUS_DESC_DRVINFO_SIZE_8723D(pdesc) << 3; ++ pattrib->encrypt = (u8)GET_RX_STATUS_DESC_SECURITY_8723D(pdesc); ++ pattrib->qos = (u8)GET_RX_STATUS_DESC_QOS_8723D(pdesc); ++ pattrib->shift_sz = (u8)GET_RX_STATUS_DESC_SHIFT_8723D(pdesc); ++ pattrib->physt = (u8)GET_RX_STATUS_DESC_PHY_STATUS_8723D(pdesc); ++ pattrib->bdecrypted = (u8)GET_RX_STATUS_DESC_SWDEC_8723D(pdesc) ? 0 : 1; ++ ++ /* Offset 4 */ ++ pattrib->priority = (u8)GET_RX_STATUS_DESC_TID_8723D(pdesc); ++ pattrib->amsdu = (u8)GET_RX_STATUS_DESC_AMSDU_8723D(pdesc); ++ pattrib->mdata = (u8)GET_RX_STATUS_DESC_MORE_DATA_8723D(pdesc); ++ pattrib->mfrag = (u8)GET_RX_STATUS_DESC_MORE_FRAG_8723D(pdesc); ++ ++ /* Offset 8 */ ++ pattrib->seq_num = (u16)GET_RX_STATUS_DESC_SEQ_8723D(pdesc); ++ pattrib->frag_num = (u8)GET_RX_STATUS_DESC_FRAG_8723D(pdesc); ++ ++ /* Offset 12 */ ++ pattrib->data_rate = (u8)GET_RX_STATUS_DESC_RX_RATE_8723D(pdesc); ++ ++ /* Offset 20 */ ++ /* pattrib->tsfl=(u8)GET_RX_STATUS_DESC_TSFL_8723D(pdesc); */ ++ } ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_sreset.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_sreset.c +--- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_sreset.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_sreset.c 2018-02-11 21:44:27.164146345 +0200 +@@ -0,0 +1,109 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RTL8723D_SRESET_C_ ++ ++#include ++ ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++void rtl8723d_sreset_xmit_status_check(_adapter *padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++ ++ unsigned long current_time; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ unsigned int diff_time; ++ u32 txdma_status; ++ ++ txdma_status = rtw_read32(padapter, REG_TXDMA_STATUS); ++ if (txdma_status != 0x00 && txdma_status != 0xeaeaeaea) { ++ RTW_INFO("%s REG_TXDMA_STATUS:0x%08x\n", __FUNCTION__, txdma_status); ++ rtw_hal_sreset_reset(padapter); ++ } ++ ++#ifdef CONFIG_USB_HCI ++ /* total xmit irp = 4 */ ++ /* DBG_8192C("==>%s free_xmitbuf_cnt(%d),txirp_cnt(%d)\n",__FUNCTION__,pxmitpriv->free_xmitbuf_cnt,pxmitpriv->txirp_cnt); */ ++ /* if(pxmitpriv->txirp_cnt == NR_XMITBUFF+1) */ ++ current_time = rtw_get_current_time(); ++ ++ if (0 == pxmitpriv->free_xmitbuf_cnt || 0 == pxmitpriv->free_xmit_extbuf_cnt) { ++ ++ diff_time = rtw_get_passing_time_ms(psrtpriv->last_tx_time); ++ ++ if (diff_time > 2000) { ++ if (psrtpriv->last_tx_complete_time == 0) ++ psrtpriv->last_tx_complete_time = current_time; ++ else { ++ diff_time = rtw_get_passing_time_ms(psrtpriv->last_tx_complete_time); ++ if (diff_time > 4000) { ++ u32 ability = 0; ++ ++ /* padapter->Wifi_Error_Status = WIFI_TX_HANG; */ ++ ability = rtw_phydm_ability_get(padapter); ++ ++ RTW_INFO("%s tx hang %s\n", __FUNCTION__, ++ (ability & ODM_BB_ADAPTIVITY) ? "ODM_BB_ADAPTIVITY" : ""); ++ ++ if (!(ability & ODM_BB_ADAPTIVITY)) ++ rtw_hal_sreset_reset(padapter); ++ } ++ } ++ } ++ } ++#endif /* #ifdef CONFIG_USB_HCI */ ++ ++ if (psrtpriv->dbg_trigger_point == SRESET_TGP_XMIT_STATUS) { ++ psrtpriv->dbg_trigger_point = SRESET_TGP_NULL; ++ rtw_hal_sreset_reset(padapter); ++ return; ++ } ++} ++ ++void rtl8723d_sreset_linked_status_check(_adapter *padapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++#if 0 ++ u32 regc50, regc58, reg824, reg800; ++ ++ regc50 = rtw_read32(padapter, 0xc50); ++ regc58 = rtw_read32(padapter, 0xc58); ++ reg824 = rtw_read32(padapter, 0x824); ++ reg800 = rtw_read32(padapter, 0x800); ++ if (((regc50 & 0xFFFFFF00) != 0x69543400) || ++ ((regc58 & 0xFFFFFF00) != 0x69543400) || ++ (((reg824 & 0xFFFFFF00) != 0x00390000) && (((reg824 & 0xFFFFFF00) != 0x80390000))) || ++ (((reg800 & 0xFFFFFF00) != 0x03040000) && ((reg800 & 0xFFFFFF00) != 0x83040000))) { ++ DBG_8192C("%s regc50:0x%08x, regc58:0x%08x, reg824:0x%08x, reg800:0x%08x,\n", __FUNCTION__, ++ regc50, regc58, reg824, reg800); ++ rtw_hal_sreset_reset(padapter); ++ } ++#endif ++ ++ if (psrtpriv->dbg_trigger_point == SRESET_TGP_LINK_STATUS) { ++ psrtpriv->dbg_trigger_point = SRESET_TGP_NULL; ++ rtw_hal_sreset_reset(padapter); ++ return; ++ } ++} ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/autoconf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/autoconf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/autoconf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/autoconf.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,309 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define CONFIG_ODM_REFRESH_RAMASK ++#define CONFIG_PHY_SETTING_WITH_ODM ++ ++ ++/* ++ * Automatically generated C config: don't edit ++ */ ++ ++#define AUTOCONF_INCLUDED ++ ++#define RTL871X_MODULE_NAME "8723DE" ++#define DRV_NAME "rtl8723de" ++ ++#ifndef CONFIG_RTL8723D ++#define CONFIG_RTL8723D ++#endif ++#define CONFIG_PCI_HCI ++ ++/*#define CONFIG_GSPI_HCI config from Makefile*/ ++/*#define CONFIG_SDIO_HCI config from Makefile*/ ++#define PLATFORM_LINUX ++ ++#define CONFIG_EMBEDDED_FWIMG ++#ifdef CONFIG_EMBEDDED_FWIMG ++ #define LOAD_FW_HEADER_FROM_DRIVER ++#endif ++ ++/* ++ * Functions Config ++ */ ++#define CONFIG_XMIT_ACK ++#ifdef CONFIG_XMIT_ACK ++ #define CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++#endif ++#define CONFIG_80211N_HT ++#define CONFIG_RECV_REORDERING_CTRL ++ ++/*#define CONFIG_IOCTL_CFG80211*/ ++ ++#if defined(CONFIG_PLATFORM_SPRD) && !defined(ANDROID_2X) ++ #ifndef CONFIG_IOCTL_CFG80211 ++ #define CONFIG_IOCTL_CFG80211 1 ++ #endif ++#endif ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ /* ++ * Indecate new sta asoc through cfg80211_new_sta ++ * If kernel version >= 3.2 or ++ * version < 3.2 but already apply cfg80211 patch, ++ * RTW_USE_CFG80211_STA_EVENT must be defiend! ++ */ ++ /*#define RTW_USE_CFG80211_STA_EVENT*/ ++ /*#define CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER*/ ++ /*#define CONFIG_DEBUG_CFG80211*/ ++ #define CONFIG_SET_SCAN_DENY_TIMER ++#endif ++ ++#define CONFIG_AP_MODE ++#ifdef CONFIG_AP_MODE ++ #define CONFIG_NATIVEAP_MLME ++ #ifndef CONFIG_NATIVEAP_MLME ++ #define CONFIG_HOSTAPD_MLME ++ #endif ++ /*#define CONFIG_FIND_BEST_CHANNEL*/ ++#endif ++ ++#define CONFIG_P2P ++#ifdef CONFIG_P2P ++ /* Added by Albert 20110812 */ ++ /* The CONFIG_WFD is for supporting the Wi-Fi display */ ++ #define CONFIG_WFD ++ ++ #define CONFIG_P2P_REMOVE_GROUP_INFO ++ ++ /*#define CONFIG_DBG_P2P*/ ++ #define CONFIG_P2P_PS ++ #define CONFIG_P2P_OP_CHK_SOCIAL_CH ++ #define CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT /* replace CONFIG_P2P_CHK_INVITE_CH_LIST flag */ ++ #define CONFIG_P2P_INVITE_IOT ++#endif ++ ++/* Added by Kurt 20110511 */ ++#ifdef CONFIG_TDLS ++ #define CONFIG_TDLS_DRIVER_SETUP ++/* #ifndef CONFIG_WFD ++ #define CONFIG_WFD ++ #endif ++*/ ++/* #define CONFIG_TDLS_AUTOSETUP */ ++ #define CONFIG_TDLS_AUTOCHECKALIVE ++ #define CONFIG_TDLS_CH_SW /* Enable "CONFIG_TDLS_CH_SW" by default, however limit it to only work in wifi logo test mode but not in normal mode currently */ ++#endif ++ ++#define CONFIG_LAYER2_ROAMING ++#define CONFIG_LAYER2_ROAMING_RESUME ++ ++/*#define CONFIG_80211D*/ ++ ++ ++ ++/* ++ * Hardware Related Config ++ */ ++/*#define CONFIG_BT_COEXIST*/ /* set from Makefile */ ++/*#define CONFIG_ANTENNA_DIVERSITY*/ ++/*#define SUPPORT_HW_RFOFF_DETECTED*/ ++ ++/*#define CONFIG_SW_LED*/ ++ ++ ++/* ++ * Interface Related Config ++ */ ++#ifdef ANDROID_2X ++#if defined(CONFIG_SDIO_HCI) ++#define CONFIG_SDIO_RX_COPY ++#define CONFIG_XMIT_THREAD_MODE ++#endif ++#endif ++ ++#define CONFIG_TRX_BD_ARCH /* PCI only */ ++#define USING_RX_TAG ++/*#define CONFIG_64BIT_DMA*/ /* Enable PCI 64bit DMA */ ++ ++/* ++ * Others ++ */ ++/*#define CONFIG_MAC_LOOPBACK_DRIVER*/ ++#define CONFIG_SKB_COPY /* for amsdu */ ++#define CONFIG_LONG_DELAY_ISSUE ++#define CONFIG_NEW_SIGNAL_STAT_PROCESS ++#define RTW_NOTCH_FILTER 0 /* 0:Disable, 1:Enable, */ ++/*#define CONFIG_PATCH_JOIN_WRONG_CHANNEL*/ ++ ++ ++/* ++ * Auto Config Section ++ */ ++#ifdef CONFIG_MAC_LOOPBACK_DRIVER ++#undef CONFIG_IOCTL_CFG80211 ++#undef CONFIG_AP_MODE ++#undef CONFIG_NATIVEAP_MLME ++#undef CONFIG_POWER_SAVING ++#undef CONFIG_BT_COEXIST ++#undef CONFIG_ANTENNA_DIVERSITY ++#undef SUPPORT_HW_RFOFF_DETECTED ++#endif ++ ++ ++/*#define CONFIG_CONCURRENT_MODE 1*/ ++#ifdef CONFIG_CONCURRENT_MODE ++ #define CONFIG_TSF_RESET_OFFLOAD 1 /* For 2 PORT TSF SYNC. */ ++ #define CONFIG_RUNTIME_PORT_SWITCH ++ /*#define DBG_RUNTIME_PORT_SWITCH*/ ++ #define CONFIG_SCAN_BACKOP ++ #if defined(CONFIG_IPS) ++ #undef CONFIG_IPS ++ #endif ++ #if defined(CONFIG_LPS) ++ #undef CONFIG_LPS ++ #undef CONFIG_LPS_LCLK ++ #endif ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ ++#ifdef CONFIG_MP_INCLUDED ++ #define MP_DRIVER 1 ++ #define CONFIG_MP_IWPRIV_SUPPORT ++ /* disable unnecessary functions for MP */ ++ /* #undef CONFIG_POWER_SAVING */ ++ /* #undef CONFIG_BT_COEXIST */ ++ /* #undef CONFIG_ANTENNA_DIVERSITY */ ++ /* #undef SUPPORT_HW_RFOFF_DETECTED */ ++#else /* !CONFIG_MP_INCLUDED */ ++ #define MP_DRIVER 0 ++ #undef CONFIG_MP_IWPRIV_SUPPORT ++#endif /* !CONFIG_MP_INCLUDED */ ++ ++ ++#ifdef CONFIG_POWER_SAVING ++ #define CONFIG_IPS ++ #define CONFIG_LPS ++ ++ #if defined(CONFIG_LPS) && (defined(CONFIG_GSPI_HCI) || defined(CONFIG_SDIO_HCI)) ++ #define CONFIG_LPS_LCLK ++ #endif ++ ++ #ifdef CONFIG_LPS_LCLK ++ #define CONFIG_LPS_RPWM_TIMER ++ #ifdef CONFIG_LPS_RPWM_TIMER ++ #define LPS_RPWM_WAIT_MS 30 ++ #endif ++ #endif ++#endif /* #ifdef CONFIG_POWER_SAVING */ ++ ++ ++#ifdef CONFIG_BT_COEXIST ++ /* for ODM and outsrc BT-Coex */ ++ #ifndef CONFIG_LPS ++ #define CONFIG_LPS /* download reserved page to FW */ ++ #endif ++#endif /* !CONFIG_BT_COEXIST */ ++ ++ ++ ++#define CONFIG_RF_POWER_TRIM ++ ++ ++#ifndef DISABLE_BB_RF ++#define DISABLE_BB_RF 0 ++#endif ++ ++#if DISABLE_BB_RF ++ #define HAL_MAC_ENABLE 0 ++ #define HAL_BB_ENABLE 0 ++ #define HAL_RF_ENABLE 0 ++#else ++ #define HAL_MAC_ENABLE 1 ++ #define HAL_BB_ENABLE 1 ++ #define HAL_RF_ENABLE 1 ++#endif ++ ++#ifdef CONFIG_GPIO_WAKEUP ++ #ifndef WAKEUP_GPIO_IDX ++ #define WAKEUP_GPIO_IDX 12 /* WIFI Chip Side */ ++ #endif /* !WAKEUP_GPIO_IDX */ ++#endif /* CONFIG_GPIO_WAKEUP */ ++ ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++#define CONFIG_HW_ANTENNA_DIVERSITY ++#endif ++ ++ ++/* ++ * Platform dependent ++ */ ++#ifdef CONFIG_PLATFORM_SPRD ++ ++/*#undef CONFIG_SDIO_RX_COPY*/ ++ ++#ifdef ANDROID_2X ++ ++/*#define CONFIG_SDIO_RX_COPY*/ ++ ++#else /* !ANDROID_2X */ ++ #undef CONFIG_WOWLAN ++ #undef CONFIG_WOWLAN_8723 ++/* #define CONFIG_SDIO_RX_COPY*/ ++/* #define CONFIG_LINKED_LCOK */ ++ #define CONFIG_AUTH_DIRECT_WITHOUT_BCN ++/* #define CONFIG_DISCONNECT_H2CWAY*/ ++/* #define CONFIG_DONT_CARE_TP */ ++ #define CONFIG_LOW_PWR_LPS ++/* #define CONFIG_CMCC_TEST*/ ++ ++ /* 1) LPS unit is only 102 ms, it's not */ ++ /* a good idear to retry it use timer, */ ++ /* 2) we must wait ACK, or lots of IO */ ++ /* is not allowed under 32k, because */ ++ /* this will cause hw hang */ ++ #undef CONFIG_LPS_RPWM_TIMER ++ #define CONFIG_WAIT_PS_ACK ++ #define CONFIG_SOFTAP_11N ++ #define CONFIG_CHECK_BT_HANG ++ ++/* #define CONFIG_8723DE_TEST */ ++#endif /* !ANDROID_2X */ ++ ++#endif /* CONFIG_PLATFORM_SPRD */ ++ ++#define CONFIG_ATTEMPT_TO_FIX_AP_BEACON_ERROR ++ ++/* ++ * Debug Related Config ++ */ ++#define CONFIG_DEBUG ++ ++#ifdef CONFIG_DEBUG ++#define DBG 1 /* for ODM & BTCOEX debug */ ++#else /* !CONFIG_DEBUG */ ++#define DBG 0 /* for ODM & BTCOEX debug */ ++#endif /* !CONFIG_DEBUG */ ++ ++#define CONFIG_PROC_DEBUG ++ ++#define DBG_CONFIG_ERROR_DETECT ++/*#define DBG_XMIT_BUF*/ ++/*#define DBG_XMIT_BUF_EXT*/ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/basic_types.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/basic_types.h +--- linux-4.14.18/3rdparty/rtl8723de/include/basic_types.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/basic_types.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,384 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __BASIC_TYPES_H__ ++#define __BASIC_TYPES_H__ ++ ++ ++#define SUCCESS 0 ++#define FAIL (-1) ++ ++#ifndef TRUE ++ #define _TRUE 1 ++#else ++ #define _TRUE TRUE ++#endif ++ ++#ifndef FALSE ++ #define _FALSE 0 ++#else ++ #define _FALSE FALSE ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ ++ typedef signed char s8; ++ typedef unsigned char u8; ++ ++ typedef signed short s16; ++ typedef unsigned short u16; ++ ++ typedef signed long s32; ++ typedef unsigned long u32; ++ ++ typedef unsigned int uint; ++ typedef signed int sint; ++ ++ ++ typedef signed long long s64; ++ typedef unsigned long long u64; ++ ++ #ifdef NDIS50_MINIPORT ++ ++ #define NDIS_MAJOR_VERSION 5 ++ #define NDIS_MINOR_VERSION 0 ++ ++ #endif ++ ++ #ifdef NDIS51_MINIPORT ++ ++ #define NDIS_MAJOR_VERSION 5 ++ #define NDIS_MINOR_VERSION 1 ++ ++ #endif ++ ++ typedef NDIS_PROC proc_t; ++ ++ typedef LONG atomic_t; ++ ++#endif ++ ++ ++#ifdef PLATFORM_LINUX ++ #include ++ #include ++ #include ++ #include ++ #include ++ #include ++ #define IN ++ #define OUT ++ #define VOID void ++ #define NDIS_OID uint ++ #define NDIS_STATUS uint ++ ++ typedef signed int sint; ++ ++ #ifndef PVOID ++ typedef void *PVOID; ++ /* #define PVOID (void *) */ ++ #endif ++ ++ #define UCHAR u8 ++ #define USHORT u16 ++ #define UINT u32 ++ #define ULONG u32 ++ ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 19)) ++ typedef _Bool bool; ++ #endif ++ ++ typedef void (*proc_t)(void *); ++ ++ typedef __kernel_size_t SIZE_T; ++ typedef __kernel_ssize_t SSIZE_T; ++ #define FIELD_OFFSET(s, field) ((SSIZE_T)&((s *)(0))->field) ++ ++#endif ++ ++ ++#ifdef PLATFORM_FREEBSD ++ ++ typedef signed char s8; ++ typedef unsigned char u8; ++ ++ typedef signed short s16; ++ typedef unsigned short u16; ++ ++ typedef signed int s32; ++ typedef unsigned int u32; ++ ++ typedef unsigned int uint; ++ typedef signed int sint; ++ typedef long atomic_t; ++ ++ typedef signed long long s64; ++ typedef unsigned long long u64; ++ #define IN ++ #define OUT ++ #define VOID void ++ #define NDIS_OID uint ++ #define NDIS_STATUS uint ++ ++ #ifndef PVOID ++ typedef void *PVOID; ++ /* #define PVOID (void *) */ ++ #endif ++ typedef u32 dma_addr_t; ++ #define UCHAR u8 ++ #define USHORT u16 ++ #define UINT u32 ++ #define ULONG u32 ++ ++ typedef void (*proc_t)(void *); ++ ++ typedef unsigned int __kernel_size_t; ++ typedef int __kernel_ssize_t; ++ ++ typedef __kernel_size_t SIZE_T; ++ typedef __kernel_ssize_t SSIZE_T; ++ #define FIELD_OFFSET(s, field) ((SSIZE_T)&((s *)(0))->field) ++ ++#endif ++ ++#define MEM_ALIGNMENT_OFFSET (sizeof (SIZE_T)) ++#define MEM_ALIGNMENT_PADDING (sizeof(SIZE_T) - 1) ++ ++#define SIZE_PTR SIZE_T ++#define SSIZE_PTR SSIZE_T ++ ++/* ++* Continuous bits starting from least significant bit ++* Example: ++* BIT_LEN_MASK_32(0) => 0x00000000 ++* BIT_LEN_MASK_32(1) => 0x00000001 ++* BIT_LEN_MASK_32(2) => 0x00000003 ++* BIT_LEN_MASK_32(32) => 0xFFFFFFFF ++*/ ++#define BIT_LEN_MASK_32(__BitLen) ((u32)(0xFFFFFFFF >> (32 - (__BitLen)))) ++#define BIT_LEN_MASK_16(__BitLen) ((u16)(0xFFFF >> (16 - (__BitLen)))) ++#define BIT_LEN_MASK_8(__BitLen) ((u8)(0xFF >> (8 - (__BitLen)))) ++ ++/* ++* Continuous bits starting from least significant bit ++* Example: ++* BIT_OFFSET_LEN_MASK_32(0, 2) => 0x00000003 ++* BIT_OFFSET_LEN_MASK_32(16, 2) => 0x00030000 ++*/ ++#define BIT_OFFSET_LEN_MASK_32(__BitOffset, __BitLen) ((u32)(BIT_LEN_MASK_32(__BitLen) << (__BitOffset))) ++#define BIT_OFFSET_LEN_MASK_16(__BitOffset, __BitLen) ((u16)(BIT_LEN_MASK_16(__BitLen) << (__BitOffset))) ++#define BIT_OFFSET_LEN_MASK_8(__BitOffset, __BitLen) ((u8)(BIT_LEN_MASK_8(__BitLen) << (__BitOffset))) ++ ++/* ++* Convert LE data to host byte order ++*/ ++#define EF1Byte (u8) ++#define EF2Byte le16_to_cpu ++#define EF4Byte le32_to_cpu ++ ++/* ++* Read LE data from memory to host byte order ++*/ ++#define ReadLE4Byte(_ptr) le32_to_cpu(*((u32 *)(_ptr))) ++#define ReadLE2Byte(_ptr) le16_to_cpu(*((u16 *)(_ptr))) ++#define ReadLE1Byte(_ptr) (*((u8 *)(_ptr))) ++ ++/* ++* Read BE data from memory to host byte order ++*/ ++#define ReadBEE4Byte(_ptr) be32_to_cpu(*((u32 *)(_ptr))) ++#define ReadBE2Byte(_ptr) be16_to_cpu(*((u16 *)(_ptr))) ++#define ReadBE1Byte(_ptr) (*((u8 *)(_ptr))) ++ ++/* ++* Write host byte order data to memory in LE order ++*/ ++#define WriteLE4Byte(_ptr, _val) ((*((u32 *)(_ptr))) = cpu_to_le32(_val)) ++#define WriteLE2Byte(_ptr, _val) ((*((u16 *)(_ptr))) = cpu_to_le16(_val)) ++#define WriteLE1Byte(_ptr, _val) ((*((u8 *)(_ptr))) = ((u8)(_val))) ++ ++/* ++* Write host byte order data to memory in BE order ++*/ ++#define WriteBE4Byte(_ptr, _val) ((*((u32 *)(_ptr))) = cpu_to_be32(_val)) ++#define WriteBE2Byte(_ptr, _val) ((*((u16 *)(_ptr))) = cpu_to_be16(_val)) ++#define WriteBE1Byte(_ptr, _val) ((*((u8 *)(_ptr))) = ((u8)(_val))) ++ ++/* ++* Return 4-byte value in host byte ordering from 4-byte pointer in litten-endian system. ++*/ ++#define LE_P4BYTE_TO_HOST_4BYTE(__pStart) (le32_to_cpu(*((u32 *)(__pStart)))) ++#define LE_P2BYTE_TO_HOST_2BYTE(__pStart) (le16_to_cpu(*((u16 *)(__pStart)))) ++#define LE_P1BYTE_TO_HOST_1BYTE(__pStart) ((*((u8 *)(__pStart)))) ++ ++/* ++* Return 4-byte value in host byte ordering from 4-byte pointer in big-endian system. ++*/ ++#define BE_P4BYTE_TO_HOST_4BYTE(__pStart) (be32_to_cpu(*((u32 *)(__pStart)))) ++#define BE_P2BYTE_TO_HOST_2BYTE(__pStart) (be16_to_cpu(*((u16 *)(__pStart)))) ++#define BE_P1BYTE_TO_HOST_1BYTE(__pStart) ((*((u8 *)(__pStart)))) ++ ++/* ++* Translate subfield (continuous bits in little-endian) of 4-byte value in LE byte to ++* 4-byte value in host byte ordering. ++*/ ++#define LE_BITS_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ ++ ((LE_P4BYTE_TO_HOST_4BYTE(__pStart) >> (__BitOffset)) & BIT_LEN_MASK_32(__BitLen)) ++ ++#define LE_BITS_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ ++ ((LE_P2BYTE_TO_HOST_2BYTE(__pStart) >> (__BitOffset)) & BIT_LEN_MASK_16(__BitLen)) ++ ++#define LE_BITS_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ ++ ((LE_P1BYTE_TO_HOST_1BYTE(__pStart) >> (__BitOffset)) & BIT_LEN_MASK_8(__BitLen)) ++ ++/* ++* Translate subfield (continuous bits in big-endian) of 4-byte value in BE byte to ++* 4-byte value in host byte ordering. ++*/ ++#define BE_BITS_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ ++ ((BE_P4BYTE_TO_HOST_4BYTE(__pStart) >> (__BitOffset)) & BIT_LEN_MASK_32(__BitLen)) ++ ++#define BE_BITS_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ ++ ((BE_P2BYTE_TO_HOST_2BYTE(__pStart) >> (__BitOffset)) & BIT_LEN_MASK_16(__BitLen)) ++ ++#define BE_BITS_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ ++ ((BE_P1BYTE_TO_HOST_1BYTE(__pStart) >> (__BitOffset)) & BIT_LEN_MASK_8(__BitLen)) ++ ++/* ++* Mask subfield (continuous bits in little-endian) of 4-byte value in LE byte oredering ++* and return the result in 4-byte value in host byte ordering. ++*/ ++#define LE_BITS_CLEARED_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ ++ (LE_P4BYTE_TO_HOST_4BYTE(__pStart) & (~BIT_OFFSET_LEN_MASK_32(__BitOffset, __BitLen))) ++ ++#define LE_BITS_CLEARED_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ ++ (LE_P2BYTE_TO_HOST_2BYTE(__pStart) & (~BIT_OFFSET_LEN_MASK_16(__BitOffset, __BitLen))) ++ ++#define LE_BITS_CLEARED_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ ++ (LE_P1BYTE_TO_HOST_1BYTE(__pStart) & ((u8)(~BIT_OFFSET_LEN_MASK_8(__BitOffset, __BitLen)))) ++ ++/* ++* Mask subfield (continuous bits in big-endian) of 4-byte value in BE byte oredering ++* and return the result in 4-byte value in host byte ordering. ++*/ ++#define BE_BITS_CLEARED_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ ++ (BE_P4BYTE_TO_HOST_4BYTE(__pStart) & (~BIT_OFFSET_LEN_MASK_32(__BitOffset, __BitLen))) ++ ++#define BE_BITS_CLEARED_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ ++ (BE_P2BYTE_TO_HOST_2BYTE(__pStart) & (~BIT_OFFSET_LEN_MASK_16(__BitOffset, __BitLen))) ++ ++#define BE_BITS_CLEARED_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ ++ (BE_P1BYTE_TO_HOST_1BYTE(__pStart) & (~BIT_OFFSET_LEN_MASK_8(__BitOffset, __BitLen))) ++ ++/* ++* Set subfield of little-endian 4-byte value to specified value. ++*/ ++#define SET_BITS_TO_LE_4BYTE(__pStart, __BitOffset, __BitLen, __Value) \ ++ do { \ ++ if (__BitOffset == 0 && __BitLen == 32) \ ++ WriteLE4Byte(__pStart, __Value); \ ++ else { \ ++ WriteLE4Byte(__pStart, \ ++ LE_BITS_CLEARED_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ ++ | \ ++ ((((u32)__Value) & BIT_LEN_MASK_32(__BitLen)) << (__BitOffset)) \ ++ ); \ ++ } \ ++ } while (0) ++ ++#define SET_BITS_TO_LE_2BYTE(__pStart, __BitOffset, __BitLen, __Value) \ ++ do { \ ++ if (__BitOffset == 0 && __BitLen == 16) \ ++ WriteLE2Byte(__pStart, __Value); \ ++ else { \ ++ WriteLE2Byte(__pStart, \ ++ LE_BITS_CLEARED_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ ++ | \ ++ ((((u16)__Value) & BIT_LEN_MASK_16(__BitLen)) << (__BitOffset)) \ ++ ); \ ++ } \ ++ } while (0) ++ ++#define SET_BITS_TO_LE_1BYTE(__pStart, __BitOffset, __BitLen, __Value) \ ++ do { \ ++ if (__BitOffset == 0 && __BitLen == 8) \ ++ WriteLE1Byte(__pStart, __Value); \ ++ else { \ ++ WriteLE1Byte(__pStart, \ ++ LE_BITS_CLEARED_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ ++ | \ ++ ((((u8)__Value) & BIT_LEN_MASK_8(__BitLen)) << (__BitOffset)) \ ++ ); \ ++ } \ ++ } while (0) ++ ++/* ++* Set subfield of big-endian 4-byte value to specified value. ++*/ ++#define SET_BITS_TO_BE_4BYTE(__pStart, __BitOffset, __BitLen, __Value) \ ++ do { \ ++ if (__BitOffset == 0 && __BitLen == 32) \ ++ WriteBE4Byte(__pStart, __Value); \ ++ else { \ ++ WriteBE4Byte(__pStart, \ ++ BE_BITS_CLEARED_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ ++ | \ ++ ((((u32)__Value) & BIT_LEN_MASK_32(__BitLen)) << (__BitOffset)) \ ++ ); \ ++ } \ ++ } while (0) ++ ++#define SET_BITS_TO_BE_2BYTE(__pStart, __BitOffset, __BitLen, __Value) \ ++ do { \ ++ if (__BitOffset == 0 && __BitLen == 16) \ ++ WriteBE2Byte(__pStart, __Value); \ ++ else { \ ++ WriteBE2Byte(__pStart, \ ++ BE_BITS_CLEARED_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ ++ | \ ++ ((((u16)__Value) & BIT_LEN_MASK_16(__BitLen)) << (__BitOffset)) \ ++ ); \ ++ } \ ++ } while (0) ++ ++#define SET_BITS_TO_BE_1BYTE(__pStart, __BitOffset, __BitLen, __Value) \ ++ do { \ ++ if (__BitOffset == 0 && __BitLen == 8) \ ++ WriteBE1Byte(__pStart, __Value); \ ++ else { \ ++ WriteBE1Byte(__pStart, \ ++ BE_BITS_CLEARED_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ ++ | \ ++ ((((u8)__Value) & BIT_LEN_MASK_8(__BitLen)) << (__BitOffset)) \ ++ ); \ ++ } \ ++ } while (0) ++ ++/* Get the N-bytes aligment offset from the current length */ ++#define N_BYTE_ALIGMENT(__Value, __Aligment) ((__Aligment == 1) ? (__Value) : (((__Value + __Aligment - 1) / __Aligment) * __Aligment)) ++ ++typedef unsigned char BOOLEAN, *PBOOLEAN, boolean; ++ ++#define TEST_FLAG(__Flag, __testFlag) (((__Flag) & (__testFlag)) != 0) ++#define SET_FLAG(__Flag, __setFlag) ((__Flag) |= __setFlag) ++#define CLEAR_FLAG(__Flag, __clearFlag) ((__Flag) &= ~(__clearFlag)) ++#define CLEAR_FLAGS(__Flag) ((__Flag) = 0) ++#define TEST_FLAGS(__Flag, __testFlags) (((__Flag) & (__testFlags)) == (__testFlags)) ++ ++#endif /* __BASIC_TYPES_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/byteorder/big_endian.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/big_endian.h +--- linux-4.14.18/3rdparty/rtl8723de/include/byteorder/big_endian.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/big_endian.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,87 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _LINUX_BYTEORDER_BIG_ENDIAN_H ++#define _LINUX_BYTEORDER_BIG_ENDIAN_H ++ ++#ifndef __BIG_ENDIAN ++ #define __BIG_ENDIAN 4321 ++#endif ++#ifndef __BIG_ENDIAN_BITFIELD ++ #define __BIG_ENDIAN_BITFIELD ++#endif ++ ++#include ++ ++#define __constant_htonl(x) ((__u32)(x)) ++#define __constant_ntohl(x) ((__u32)(x)) ++#define __constant_htons(x) ((__u16)(x)) ++#define __constant_ntohs(x) ((__u16)(x)) ++#define __constant_cpu_to_le64(x) ___constant_swab64((x)) ++#define __constant_le64_to_cpu(x) ___constant_swab64((x)) ++#define __constant_cpu_to_le32(x) ___constant_swab32((x)) ++#define __constant_le32_to_cpu(x) ___constant_swab32((x)) ++#define __constant_cpu_to_le16(x) ___constant_swab16((x)) ++#define __constant_le16_to_cpu(x) ___constant_swab16((x)) ++#define __constant_cpu_to_be64(x) ((__u64)(x)) ++#define __constant_be64_to_cpu(x) ((__u64)(x)) ++#define __constant_cpu_to_be32(x) ((__u32)(x)) ++#define __constant_be32_to_cpu(x) ((__u32)(x)) ++#define __constant_cpu_to_be16(x) ((__u16)(x)) ++#define __constant_be16_to_cpu(x) ((__u16)(x)) ++#define __cpu_to_le64(x) __swab64((x)) ++#define __le64_to_cpu(x) __swab64((x)) ++#define __cpu_to_le32(x) __swab32((x)) ++#define __le32_to_cpu(x) __swab32((x)) ++#define __cpu_to_le16(x) __swab16((x)) ++#define __le16_to_cpu(x) __swab16((x)) ++#define __cpu_to_be64(x) ((__u64)(x)) ++#define __be64_to_cpu(x) ((__u64)(x)) ++#define __cpu_to_be32(x) ((__u32)(x)) ++#define __be32_to_cpu(x) ((__u32)(x)) ++#define __cpu_to_be16(x) ((__u16)(x)) ++#define __be16_to_cpu(x) ((__u16)(x)) ++#define __cpu_to_le64p(x) __swab64p((x)) ++#define __le64_to_cpup(x) __swab64p((x)) ++#define __cpu_to_le32p(x) __swab32p((x)) ++#define __le32_to_cpup(x) __swab32p((x)) ++#define __cpu_to_le16p(x) __swab16p((x)) ++#define __le16_to_cpup(x) __swab16p((x)) ++#define __cpu_to_be64p(x) (*(__u64 *)(x)) ++#define __be64_to_cpup(x) (*(__u64 *)(x)) ++#define __cpu_to_be32p(x) (*(__u32 *)(x)) ++#define __be32_to_cpup(x) (*(__u32 *)(x)) ++#define __cpu_to_be16p(x) (*(__u16 *)(x)) ++#define __be16_to_cpup(x) (*(__u16 *)(x)) ++#define __cpu_to_le64s(x) __swab64s((x)) ++#define __le64_to_cpus(x) __swab64s((x)) ++#define __cpu_to_le32s(x) __swab32s((x)) ++#define __le32_to_cpus(x) __swab32s((x)) ++#define __cpu_to_le16s(x) __swab16s((x)) ++#define __le16_to_cpus(x) __swab16s((x)) ++#define __cpu_to_be64s(x) do {} while (0) ++#define __be64_to_cpus(x) do {} while (0) ++#define __cpu_to_be32s(x) do {} while (0) ++#define __be32_to_cpus(x) do {} while (0) ++#define __cpu_to_be16s(x) do {} while (0) ++#define __be16_to_cpus(x) do {} while (0) ++ ++#include ++ ++#endif /* _LINUX_BYTEORDER_BIG_ENDIAN_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/byteorder/generic.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/generic.h +--- linux-4.14.18/3rdparty/rtl8723de/include/byteorder/generic.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/generic.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,212 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _LINUX_BYTEORDER_GENERIC_H ++#define _LINUX_BYTEORDER_GENERIC_H ++ ++/* ++ * linux/byteorder_generic.h ++ * Generic Byte-reordering support ++ * ++ * Francois-Rene Rideau 19970707 ++ * gathered all the good ideas from all asm-foo/byteorder.h into one file, ++ * cleaned them up. ++ * I hope it is compliant with non-GCC compilers. ++ * I decided to put __BYTEORDER_HAS_U64__ in byteorder.h, ++ * because I wasn't sure it would be ok to put it in types.h ++ * Upgraded it to 2.1.43 ++ * Francois-Rene Rideau 19971012 ++ * Upgraded it to 2.1.57 ++ * to please Linus T., replaced huge #ifdef's between little/big endian ++ * by nestedly #include'd files. ++ * Francois-Rene Rideau 19971205 ++ * Made it to 2.1.71; now a facelift: ++ * Put files under include/linux/byteorder/ ++ * Split swab from generic support. ++ * ++ * TODO: ++ * = Regular kernel maintainers could also replace all these manual ++ * byteswap macros that remain, disseminated among drivers, ++ * after some grep or the sources... ++ * = Linus might want to rename all these macros and files to fit his taste, ++ * to fit his personal naming scheme. ++ * = it seems that a few drivers would also appreciate ++ * nybble swapping support... ++ * = every architecture could add their byteswap macro in asm/byteorder.h ++ * see how some architectures already do (i386, alpha, ppc, etc) ++ * = cpu_to_beXX and beXX_to_cpu might some day need to be well ++ * distinguished throughout the kernel. This is not the case currently, ++ * since little endian, big endian, and pdp endian machines needn't it. ++ * But this might be the case for, say, a port of Linux to 20/21 bit ++ * architectures (and F21 Linux addict around?). ++ */ ++ ++/* ++ * The following macros are to be defined by : ++ * ++ * Conversion of long and short int between network and host format ++ * ntohl(__u32 x) ++ * ntohs(__u16 x) ++ * htonl(__u32 x) ++ * htons(__u16 x) ++ * It seems that some programs (which? where? or perhaps a standard? POSIX?) ++ * might like the above to be functions, not macros (why?). ++ * if that's true, then detect them, and take measures. ++ * Anyway, the measure is: define only ___ntohl as a macro instead, ++ * and in a separate file, have ++ * unsigned long inline ntohl(x){return ___ntohl(x);} ++ * ++ * The same for constant arguments ++ * __constant_ntohl(__u32 x) ++ * __constant_ntohs(__u16 x) ++ * __constant_htonl(__u32 x) ++ * __constant_htons(__u16 x) ++ * ++ * Conversion of XX-bit integers (16- 32- or 64-) ++ * between native CPU format and little/big endian format ++ * 64-bit stuff only defined for proper architectures ++ * cpu_to_[bl]eXX(__uXX x) ++ * [bl]eXX_to_cpu(__uXX x) ++ * ++ * The same, but takes a pointer to the value to convert ++ * cpu_to_[bl]eXXp(__uXX x) ++ * [bl]eXX_to_cpup(__uXX x) ++ * ++ * The same, but change in situ ++ * cpu_to_[bl]eXXs(__uXX x) ++ * [bl]eXX_to_cpus(__uXX x) ++ * ++ * See asm-foo/byteorder.h for examples of how to provide ++ * architecture-optimized versions ++ * ++ */ ++ ++ ++#if defined(PLATFORM_LINUX) || defined(PLATFORM_WINDOWS) || defined(PLATFORM_MPIXEL) || defined(PLATFORM_FREEBSD) ++ /* ++ * inside the kernel, we can use nicknames; ++ * outside of it, we must avoid POSIX namespace pollution... ++ */ ++ #define cpu_to_le64 __cpu_to_le64 ++ #define le64_to_cpu __le64_to_cpu ++ #define cpu_to_le32 __cpu_to_le32 ++ #define le32_to_cpu __le32_to_cpu ++ #define cpu_to_le16 __cpu_to_le16 ++ #define le16_to_cpu __le16_to_cpu ++ #define cpu_to_be64 __cpu_to_be64 ++ #define be64_to_cpu __be64_to_cpu ++ #define cpu_to_be32 __cpu_to_be32 ++ #define be32_to_cpu __be32_to_cpu ++ #define cpu_to_be16 __cpu_to_be16 ++ #define be16_to_cpu __be16_to_cpu ++ #define cpu_to_le64p __cpu_to_le64p ++ #define le64_to_cpup __le64_to_cpup ++ #define cpu_to_le32p __cpu_to_le32p ++ #define le32_to_cpup __le32_to_cpup ++ #define cpu_to_le16p __cpu_to_le16p ++ #define le16_to_cpup __le16_to_cpup ++ #define cpu_to_be64p __cpu_to_be64p ++ #define be64_to_cpup __be64_to_cpup ++ #define cpu_to_be32p __cpu_to_be32p ++ #define be32_to_cpup __be32_to_cpup ++ #define cpu_to_be16p __cpu_to_be16p ++ #define be16_to_cpup __be16_to_cpup ++ #define cpu_to_le64s __cpu_to_le64s ++ #define le64_to_cpus __le64_to_cpus ++ #define cpu_to_le32s __cpu_to_le32s ++ #define le32_to_cpus __le32_to_cpus ++ #define cpu_to_le16s __cpu_to_le16s ++ #define le16_to_cpus __le16_to_cpus ++ #define cpu_to_be64s __cpu_to_be64s ++ #define be64_to_cpus __be64_to_cpus ++ #define cpu_to_be32s __cpu_to_be32s ++ #define be32_to_cpus __be32_to_cpus ++ #define cpu_to_be16s __cpu_to_be16s ++ #define be16_to_cpus __be16_to_cpus ++#endif ++ ++ ++/* ++ * Handle ntohl and suches. These have various compatibility ++ * issues - like we want to give the prototype even though we ++ * also have a macro for them in case some strange program ++ * wants to take the address of the thing or something.. ++ * ++ * Note that these used to return a "long" in libc5, even though ++ * long is often 64-bit these days.. Thus the casts. ++ * ++ * They have to be macros in order to do the constant folding ++ * correctly - if the argument passed into a inline function ++ * it is no longer constant according to gcc.. ++ */ ++ ++#undef ntohl ++#undef ntohs ++#undef htonl ++#undef htons ++ ++/* ++ * Do the prototypes. Somebody might want to take the ++ * address or some such sick thing.. ++ */ ++#if defined(PLATFORM_LINUX) || (defined(__GLIBC__) && __GLIBC__ >= 2) ++ extern __u32 ntohl(__u32); ++ extern __u32 htonl(__u32); ++#else /* defined(PLATFORM_LINUX) || (defined (__GLIBC__) && __GLIBC__ >= 2) */ ++ #ifndef PLATFORM_FREEBSD ++ extern unsigned long int ntohl(unsigned long int); ++ extern unsigned long int htonl(unsigned long int); ++ #endif ++#endif ++#ifndef PLATFORM_FREEBSD ++ extern unsigned short int ntohs(unsigned short int); ++ extern unsigned short int htons(unsigned short int); ++#endif ++ ++#if defined(__GNUC__) && (__GNUC__ >= 2) && defined(__OPTIMIZE__) || defined(PLATFORM_MPIXEL) ++ ++ #define ___htonl(x) __cpu_to_be32(x) ++ #define ___htons(x) __cpu_to_be16(x) ++ #define ___ntohl(x) __be32_to_cpu(x) ++ #define ___ntohs(x) __be16_to_cpu(x) ++ ++ #if defined(PLATFORM_LINUX) || (defined(__GLIBC__) && __GLIBC__ >= 2) ++ #define htonl(x) ___htonl(x) ++ #define ntohl(x) ___ntohl(x) ++ #else ++ #define htonl(x) ((unsigned long)___htonl(x)) ++ #define ntohl(x) ((unsigned long)___ntohl(x)) ++ #endif ++ #define htons(x) ___htons(x) ++ #define ntohs(x) ___ntohs(x) ++ ++#endif /* OPTIMIZE */ ++ ++ ++#if defined(PLATFORM_WINDOWS) ++ ++ #define htonl(x) __cpu_to_be32(x) ++ #define ntohl(x) __be32_to_cpu(x) ++ #define htons(x) __cpu_to_be16(x) ++ #define ntohs(x) __be16_to_cpu(x) ++ ++ ++#endif ++ ++#endif /* _LINUX_BYTEORDER_GENERIC_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/byteorder/little_endian.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/little_endian.h +--- linux-4.14.18/3rdparty/rtl8723de/include/byteorder/little_endian.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/little_endian.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,89 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _LINUX_BYTEORDER_LITTLE_ENDIAN_H ++#define _LINUX_BYTEORDER_LITTLE_ENDIAN_H ++ ++#ifndef __LITTLE_ENDIAN ++ #define __LITTLE_ENDIAN 1234 ++#endif ++#ifndef __LITTLE_ENDIAN_BITFIELD ++ #define __LITTLE_ENDIAN_BITFIELD ++#endif ++ ++#include ++ ++#ifndef __constant_htonl ++ #define __constant_htonl(x) ___constant_swab32((x)) ++ #define __constant_ntohl(x) ___constant_swab32((x)) ++ #define __constant_htons(x) ___constant_swab16((x)) ++ #define __constant_ntohs(x) ___constant_swab16((x)) ++ #define __constant_cpu_to_le64(x) ((__u64)(x)) ++ #define __constant_le64_to_cpu(x) ((__u64)(x)) ++ #define __constant_cpu_to_le32(x) ((__u32)(x)) ++ #define __constant_le32_to_cpu(x) ((__u32)(x)) ++ #define __constant_cpu_to_le16(x) ((__u16)(x)) ++ #define __constant_le16_to_cpu(x) ((__u16)(x)) ++ #define __constant_cpu_to_be64(x) ___constant_swab64((x)) ++ #define __constant_be64_to_cpu(x) ___constant_swab64((x)) ++ #define __constant_cpu_to_be32(x) ___constant_swab32((x)) ++ #define __constant_be32_to_cpu(x) ___constant_swab32((x)) ++ #define __constant_cpu_to_be16(x) ___constant_swab16((x)) ++ #define __constant_be16_to_cpu(x) ___constant_swab16((x)) ++ #define __cpu_to_le64(x) ((__u64)(x)) ++ #define __le64_to_cpu(x) ((__u64)(x)) ++ #define __cpu_to_le32(x) ((__u32)(x)) ++ #define __le32_to_cpu(x) ((__u32)(x)) ++ #define __cpu_to_le16(x) ((__u16)(x)) ++ #define __le16_to_cpu(x) ((__u16)(x)) ++ #define __cpu_to_be64(x) __swab64((x)) ++ #define __be64_to_cpu(x) __swab64((x)) ++ #define __cpu_to_be32(x) __swab32((x)) ++ #define __be32_to_cpu(x) __swab32((x)) ++ #define __cpu_to_be16(x) __swab16((x)) ++ #define __be16_to_cpu(x) __swab16((x)) ++ #define __cpu_to_le64p(x) (*(__u64 *)(x)) ++ #define __le64_to_cpup(x) (*(__u64 *)(x)) ++ #define __cpu_to_le32p(x) (*(__u32 *)(x)) ++ #define __le32_to_cpup(x) (*(__u32 *)(x)) ++ #define __cpu_to_le16p(x) (*(__u16 *)(x)) ++ #define __le16_to_cpup(x) (*(__u16 *)(x)) ++ #define __cpu_to_be64p(x) __swab64p((x)) ++ #define __be64_to_cpup(x) __swab64p((x)) ++ #define __cpu_to_be32p(x) __swab32p((x)) ++ #define __be32_to_cpup(x) __swab32p((x)) ++ #define __cpu_to_be16p(x) __swab16p((x)) ++ #define __be16_to_cpup(x) __swab16p((x)) ++ #define __cpu_to_le64s(x) do {} while (0) ++ #define __le64_to_cpus(x) do {} while (0) ++ #define __cpu_to_le32s(x) do {} while (0) ++ #define __le32_to_cpus(x) do {} while (0) ++ #define __cpu_to_le16s(x) do {} while (0) ++ #define __le16_to_cpus(x) do {} while (0) ++ #define __cpu_to_be64s(x) __swab64s((x)) ++ #define __be64_to_cpus(x) __swab64s((x)) ++ #define __cpu_to_be32s(x) __swab32s((x)) ++ #define __be32_to_cpus(x) __swab32s((x)) ++ #define __cpu_to_be16s(x) __swab16s((x)) ++ #define __be16_to_cpus(x) __swab16s((x)) ++#endif /* __constant_htonl */ ++ ++#include ++ ++#endif /* _LINUX_BYTEORDER_LITTLE_ENDIAN_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/byteorder/swabb.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/swabb.h +--- linux-4.14.18/3rdparty/rtl8723de/include/byteorder/swabb.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/swabb.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,156 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _LINUX_BYTEORDER_SWABB_H ++#define _LINUX_BYTEORDER_SWABB_H ++ ++/* ++ * linux/byteorder/swabb.h ++ * SWAp Bytes Bizarrely ++ * swaHHXX[ps]?(foo) ++ * ++ * Support for obNUXIous pdp-endian and other bizarre architectures. ++ * Will Linux ever run on such ancient beasts? if not, this file ++ * will be but a programming pearl. Still, it's a reminder that we ++ * shouldn't be making too many assumptions when trying to be portable. ++ * ++ */ ++ ++/* ++ * Meaning of the names I chose (vaxlinux people feel free to correct them): ++ * swahw32 swap 16-bit half-words in a 32-bit word ++ * swahb32 swap 8-bit halves of each 16-bit half-word in a 32-bit word ++ * ++ * No 64-bit support yet. I don't know NUXI conventions for long longs. ++ * I guarantee it will be a mess when it's there, though :-> ++ * It will be even worse if there are conflicting 64-bit conventions. ++ * Hopefully, no one ever used 64-bit objects on NUXI machines. ++ * ++ */ ++ ++#define ___swahw32(x) \ ++ ({ \ ++ __u32 __x = (x); \ ++ ((__u32)(\ ++ (((__u32)(__x) & (__u32)0x0000ffffUL) << 16) | \ ++ (((__u32)(__x) & (__u32)0xffff0000UL) >> 16))); \ ++ }) ++#define ___swahb32(x) \ ++ ({ \ ++ __u32 __x = (x); \ ++ ((__u32)(\ ++ (((__u32)(__x) & (__u32)0x00ff00ffUL) << 8) | \ ++ (((__u32)(__x) & (__u32)0xff00ff00UL) >> 8))); \ ++ }) ++ ++#define ___constant_swahw32(x) \ ++ ((__u32)(\ ++ (((__u32)(x) & (__u32)0x0000ffffUL) << 16) | \ ++ (((__u32)(x) & (__u32)0xffff0000UL) >> 16))) ++#define ___constant_swahb32(x) \ ++ ((__u32)(\ ++ (((__u32)(x) & (__u32)0x00ff00ffUL) << 8) | \ ++ (((__u32)(x) & (__u32)0xff00ff00UL) >> 8))) ++ ++/* ++ * provide defaults when no architecture-specific optimization is detected ++ */ ++#ifndef __arch__swahw32 ++ #define __arch__swahw32(x) ___swahw32(x) ++#endif ++#ifndef __arch__swahb32 ++ #define __arch__swahb32(x) ___swahb32(x) ++#endif ++ ++#ifndef __arch__swahw32p ++ #define __arch__swahw32p(x) __swahw32(*(x)) ++#endif ++#ifndef __arch__swahb32p ++ #define __arch__swahb32p(x) __swahb32(*(x)) ++#endif ++ ++#ifndef __arch__swahw32s ++ #define __arch__swahw32s(x) do { *(x) = __swahw32p((x)); } while (0) ++#endif ++#ifndef __arch__swahb32s ++ #define __arch__swahb32s(x) do { *(x) = __swahb32p((x)); } while (0) ++#endif ++ ++ ++/* ++ * Allow constant folding ++ */ ++#if defined(__GNUC__) && (__GNUC__ >= 2) && defined(__OPTIMIZE__) ++# define __swahw32(x) \ ++ (__builtin_constant_p((__u32)(x)) ? \ ++ ___swahw32((x)) : \ ++ __fswahw32((x))) ++# define __swahb32(x) \ ++ (__builtin_constant_p((__u32)(x)) ? \ ++ ___swahb32((x)) : \ ++ __fswahb32((x))) ++#else ++# define __swahw32(x) __fswahw32(x) ++# define __swahb32(x) __fswahb32(x) ++#endif /* OPTIMIZE */ ++ ++ ++__inline static__ __const__ __u32 __fswahw32(__u32 x) ++{ ++ return __arch__swahw32(x); ++} ++__inline static__ __u32 __swahw32p(__u32 *x) ++{ ++ return __arch__swahw32p(x); ++} ++__inline static__ void __swahw32s(__u32 *addr) ++{ ++ __arch__swahw32s(addr); ++} ++ ++ ++__inline static__ __const__ __u32 __fswahb32(__u32 x) ++{ ++ return __arch__swahb32(x); ++} ++__inline static__ __u32 __swahb32p(__u32 *x) ++{ ++ return __arch__swahb32p(x); ++} ++__inline static__ void __swahb32s(__u32 *addr) ++{ ++ __arch__swahb32s(addr); ++} ++ ++#ifdef __BYTEORDER_HAS_U64__ ++ /* ++ * Not supported yet ++ */ ++#endif /* __BYTEORDER_HAS_U64__ */ ++ ++#if defined(PLATFORM_LINUX) ++ #define swahw32 __swahw32 ++ #define swahb32 __swahb32 ++ #define swahw32p __swahw32p ++ #define swahb32p __swahb32p ++ #define swahw32s __swahw32s ++ #define swahb32s __swahb32s ++#endif ++ ++#endif /* _LINUX_BYTEORDER_SWABB_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/byteorder/swab.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/swab.h +--- linux-4.14.18/3rdparty/rtl8723de/include/byteorder/swab.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/swab.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,141 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _LINUX_BYTEORDER_SWAB_H ++#define _LINUX_BYTEORDER_SWAB_H ++ ++#if !defined(CONFIG_PLATFORM_MSTAR) ++#ifndef __u16 ++ typedef unsigned short __u16; ++#endif ++ ++#ifndef __u32 ++ typedef unsigned int __u32; ++#endif ++ ++#ifndef __u8 ++ typedef unsigned char __u8; ++#endif ++ ++#ifndef __u64 ++ typedef unsigned long long __u64; ++#endif ++ ++ ++__inline static __u16 ___swab16(__u16 x) ++{ ++ __u16 __x = x; ++ return ++ (__u16)( ++ (((__u16)(__x)&(__u16)0x00ffU) << 8) | ++ (((__u16)(__x)&(__u16)0xff00U) >> 8)); ++ ++} ++ ++__inline static __u32 ___swab32(__u32 x) ++{ ++ __u32 __x = (x); ++ return (__u32)( ++ (((__u32)(__x)&(__u32)0x000000ffUL) << 24) | ++ (((__u32)(__x)&(__u32)0x0000ff00UL) << 8) | ++ (((__u32)(__x)&(__u32)0x00ff0000UL) >> 8) | ++ (((__u32)(__x)&(__u32)0xff000000UL) >> 24)); ++} ++ ++__inline static __u64 ___swab64(__u64 x) ++{ ++ __u64 __x = (x); ++ ++ return ++ (__u64)(\ ++ (__u64)(((__u64)(__x)&(__u64)0x00000000000000ffULL) << 56) | \ ++ (__u64)(((__u64)(__x)&(__u64)0x000000000000ff00ULL) << 40) | \ ++ (__u64)(((__u64)(__x)&(__u64)0x0000000000ff0000ULL) << 24) | \ ++ (__u64)(((__u64)(__x)&(__u64)0x00000000ff000000ULL) << 8) | \ ++ (__u64)(((__u64)(__x)&(__u64)0x000000ff00000000ULL) >> 8) | \ ++ (__u64)(((__u64)(__x)&(__u64)0x0000ff0000000000ULL) >> 24) | \ ++ (__u64)(((__u64)(__x)&(__u64)0x00ff000000000000ULL) >> 40) | \ ++ (__u64)(((__u64)(__x)&(__u64)0xff00000000000000ULL) >> 56)); ++ \ ++} ++#endif /* CONFIG_PLATFORM_MSTAR */ ++ ++#ifndef __arch__swab16 ++__inline static __u16 __arch__swab16(__u16 x) ++{ ++ return ___swab16(x); ++} ++ ++#endif ++ ++#ifndef __arch__swab32 ++__inline static __u32 __arch__swab32(__u32 x) ++{ ++ __u32 __tmp = (x) ; ++ return ___swab32(__tmp); ++} ++#endif ++ ++#ifndef __arch__swab64 ++ ++__inline static __u64 __arch__swab64(__u64 x) ++{ ++ __u64 __tmp = (x) ; ++ return ___swab64(__tmp); ++} ++ ++ ++#endif ++ ++#ifndef __swab16 ++ #define __swab16(x) __fswab16(x) ++ #define __swab32(x) __fswab32(x) ++ #define __swab64(x) __fswab64(x) ++#endif /* __swab16 */ ++ ++#ifdef PLATFORM_FREEBSD ++ __inline static __u16 __fswab16(__u16 x) ++#else ++ __inline static const __u16 __fswab16(__u16 x) ++#endif /* PLATFORM_FREEBSD */ ++{ ++ return __arch__swab16(x); ++} ++#ifdef PLATFORM_FREEBSD ++ __inline static __u32 __fswab32(__u32 x) ++#else ++ __inline static const __u32 __fswab32(__u32 x) ++#endif /* PLATFORM_FREEBSD */ ++{ ++ return __arch__swab32(x); ++} ++ ++#if defined(PLATFORM_LINUX) || defined(PLATFORM_WINDOWS) ++ #define swab16 __swab16 ++ #define swab32 __swab32 ++ #define swab64 __swab64 ++ #define swab16p __swab16p ++ #define swab32p __swab32p ++ #define swab64p __swab64p ++ #define swab16s __swab16s ++ #define swab32s __swab32s ++ #define swab64s __swab64s ++#endif ++ ++#endif /* _LINUX_BYTEORDER_SWAB_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/circ_buf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/circ_buf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/circ_buf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/circ_buf.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,28 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __CIRC_BUF_H_ ++#define __CIRC_BUF_H_ 1 ++ ++#define CIRC_CNT(head,tail,size) (((head) - (tail)) & ((size)-1)) ++ ++#define CIRC_SPACE(head,tail,size) CIRC_CNT((tail),((head)+1),(size)) ++ ++#endif //_CIRC_BUF_H_ ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/cmd_osdep.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/cmd_osdep.h +--- linux-4.14.18/3rdparty/rtl8723de/include/cmd_osdep.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/cmd_osdep.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,31 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __CMD_OSDEP_H_ ++#define __CMD_OSDEP_H_ ++ ++ ++extern sint _rtw_init_cmd_priv(struct cmd_priv *pcmdpriv); ++extern sint _rtw_init_evt_priv(struct evt_priv *pevtpriv); ++extern void _rtw_free_evt_priv(struct evt_priv *pevtpriv); ++extern void _rtw_free_cmd_priv(struct cmd_priv *pcmdpriv); ++extern sint _rtw_enqueue_cmd(_queue *queue, struct cmd_obj *obj, bool to_head); ++extern struct cmd_obj *_rtw_dequeue_cmd(_queue *queue); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/custom_gpio.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/custom_gpio.h +--- linux-4.14.18/3rdparty/rtl8723de/include/custom_gpio.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/custom_gpio.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,32 @@ ++#ifndef __CUSTOM_GPIO_H__ ++#define __CUSTOM_GPIO_H___ ++ ++#include ++#include ++ ++#ifdef PLATFORM_OS_XP ++ #include ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ #include ++#endif ++ ++#ifdef PLATFORM_LINUX ++ #include ++#endif ++ ++typedef enum cust_gpio_modes { ++ WLAN_PWDN_ON, ++ WLAN_PWDN_OFF, ++ WLAN_POWER_ON, ++ WLAN_POWER_OFF, ++ WLAN_BT_PWDN_ON, ++ WLAN_BT_PWDN_OFF ++} cust_gpio_modes_t; ++ ++extern int rtw_wifi_gpio_init(void); ++extern int rtw_wifi_gpio_deinit(void); ++extern void rtw_wifi_gpio_wlan_ctrl(int onoff); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_conf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_conf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/drv_conf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_conf.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,322 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __DRV_CONF_H__ ++#define __DRV_CONF_H__ ++#include "autoconf.h" ++#include "hal_ic_cfg.h" ++ ++#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) ++ ++ #error "Shall be Linux or Windows, but not both!\n" ++ ++#endif ++ ++#if defined(CONFIG_MCC_MODE) && (!defined(CONFIG_CONCURRENT_MODE)) ++ ++ #error "Enable CONCURRENT_MODE before enable MCC MODE\n" ++ ++#endif ++ ++#if defined(CONFIG_MCC_MODE) && defined(CONFIG_BT_COEXIST) ++ ++ #error "Disable BT COEXIST before enable MCC MODE\n" ++ ++#endif ++ ++#if defined(CONFIG_MCC_MODE) && defined(CONFIG_TDLS) ++ ++ #error "Disable TDLS before enable MCC MODE\n" ++ ++#endif ++ ++#if defined(CONFIG_RTW_80211R) && !defined(CONFIG_LAYER2_ROAMING) ++ ++ #error "Enable CONFIG_LAYER2_ROAMING before enable CONFIG_RTW_80211R\n" ++ ++#endif ++ ++/* Older Android kernel doesn't has CONFIG_ANDROID defined, ++ * add this to force CONFIG_ANDROID defined */ ++#ifdef CONFIG_PLATFORM_ANDROID ++ #ifndef CONFIG_ANDROID ++ #define CONFIG_ANDROID ++ #endif ++#endif ++ ++#ifdef CONFIG_ANDROID ++ /* Some Android build will restart the UI while non-printable ascii is passed ++ * between java and c/c++ layer (JNI). We force CONFIG_VALIDATE_SSID ++ * for Android here. If you are sure there is no risk on your system about this, ++ * mask this macro define to support non-printable ascii ssid. ++ * #define CONFIG_VALIDATE_SSID */ ++ ++ /* Android expect dbm as the rx signal strength unit */ ++ #define CONFIG_SIGNAL_DISPLAY_DBM ++#endif ++ ++/* ++#if defined(CONFIG_HAS_EARLYSUSPEND) && defined(CONFIG_RESUME_IN_WORKQUEUE) ++ #warning "You have CONFIG_HAS_EARLYSUSPEND enabled in your system, we disable CONFIG_RESUME_IN_WORKQUEUE automatically" ++ #undef CONFIG_RESUME_IN_WORKQUEUE ++#endif ++ ++#if defined(CONFIG_ANDROID_POWER) && defined(CONFIG_RESUME_IN_WORKQUEUE) ++ #warning "You have CONFIG_ANDROID_POWER enabled in your system, we disable CONFIG_RESUME_IN_WORKQUEUE automatically" ++ #undef CONFIG_RESUME_IN_WORKQUEUE ++#endif ++*/ ++ ++#ifdef CONFIG_RESUME_IN_WORKQUEUE /* this can be removed, because there is no case for this... */ ++ #if !defined(CONFIG_WAKELOCK) && !defined(CONFIG_ANDROID_POWER) ++ #error "enable CONFIG_RESUME_IN_WORKQUEUE without CONFIG_WAKELOCK or CONFIG_ANDROID_POWER will suffer from the danger of wifi's unfunctionality..." ++ #error "If you still want to enable CONFIG_RESUME_IN_WORKQUEUE in this case, mask this preprossor checking and GOOD LUCK..." ++ #endif ++#endif ++ ++/* About USB VENDOR REQ */ ++#if defined(CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC) && !defined(CONFIG_USB_VENDOR_REQ_MUTEX) ++ #warning "define CONFIG_USB_VENDOR_REQ_MUTEX for CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC automatically" ++ #define CONFIG_USB_VENDOR_REQ_MUTEX ++#endif ++#if defined(CONFIG_VENDOR_REQ_RETRY) && !defined(CONFIG_USB_VENDOR_REQ_MUTEX) ++ #warning "define CONFIG_USB_VENDOR_REQ_MUTEX for CONFIG_VENDOR_REQ_RETRY automatically" ++ #define CONFIG_USB_VENDOR_REQ_MUTEX ++#endif ++ ++#if !defined(CONFIG_AP_MODE) && defined(CONFIG_DFS_MASTER) ++ #warning "undef CONFIG_DFS_MASTER because CONFIG_AP_MODE is not defined" ++ #undef CONFIG_DFS_MASTER ++#endif ++ ++#define RTW_SCAN_SPARSE_MIRACAST 1 ++#define RTW_SCAN_SPARSE_BG 0 ++#define RTW_SCAN_SPARSE_ROAMING_ACTIVE 1 ++ ++#ifndef CONFIG_RTW_HIQ_FILTER ++ #define CONFIG_RTW_HIQ_FILTER 1 ++#endif ++ ++#ifndef CONFIG_RTW_FORCE_IGI_LB ++ #define CONFIG_RTW_FORCE_IGI_LB 0 ++#endif ++ ++#ifndef CONFIG_RTW_ADAPTIVITY_EN ++ #define CONFIG_RTW_ADAPTIVITY_EN 0 ++#endif ++ ++#ifndef CONFIG_RTW_ADAPTIVITY_MODE ++ #define CONFIG_RTW_ADAPTIVITY_MODE 0 ++#endif ++ ++#ifndef CONFIG_RTW_ADAPTIVITY_DML ++ #define CONFIG_RTW_ADAPTIVITY_DML 0 ++#endif ++ ++#ifndef CONFIG_RTW_ADAPTIVITY_DC_BACKOFF ++ #define CONFIG_RTW_ADAPTIVITY_DC_BACKOFF 2 ++#endif ++ ++#ifndef CONFIG_RTW_ADAPTIVITY_TH_L2H_INI ++ #define CONFIG_RTW_ADAPTIVITY_TH_L2H_INI 0 ++#endif ++ ++#ifndef CONFIG_RTW_ADAPTIVITY_TH_EDCCA_HL_DIFF ++ #define CONFIG_RTW_ADAPTIVITY_TH_EDCCA_HL_DIFF 0 ++#endif ++ ++#ifndef CONFIG_RTW_EXCL_CHS ++ #define CONFIG_RTW_EXCL_CHS {0} ++#endif ++ ++#ifndef CONFIG_RTW_DFS_REGION_DOMAIN ++ #define CONFIG_RTW_DFS_REGION_DOMAIN 0 ++#endif ++ ++#ifndef CONFIG_TXPWR_BY_RATE_EN ++#define CONFIG_TXPWR_BY_RATE_EN 2 /* by efuse */ ++#endif ++#ifndef CONFIG_TXPWR_LIMIT_EN ++#define CONFIG_TXPWR_LIMIT_EN 2 /* by efuse */ ++#endif ++ ++/* compatible with old fashion configuration */ ++#if defined(CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY) ++ #undef CONFIG_TXPWR_BY_RATE_EN ++ #undef CONFIG_TXPWR_LIMIT_EN ++ #define CONFIG_TXPWR_BY_RATE_EN 1 ++ #define CONFIG_TXPWR_LIMIT_EN 1 ++#elif defined(CONFIG_CALIBRATE_TX_POWER_TO_MAX) ++ #undef CONFIG_TXPWR_BY_RATE_EN ++ #undef CONFIG_TXPWR_LIMIT_EN ++ #define CONFIG_TXPWR_BY_RATE_EN 1 ++ #define CONFIG_TXPWR_LIMIT_EN 0 ++#endif ++ ++#ifndef RTW_DEF_MODULE_REGULATORY_CERT ++ #define RTW_DEF_MODULE_REGULATORY_CERT 0 ++#endif ++ ++#if RTW_DEF_MODULE_REGULATORY_CERT ++ /* force enable TX power by rate and TX power limit */ ++ #undef CONFIG_TXPWR_BY_RATE_EN ++ #undef CONFIG_TXPWR_LIMIT_EN ++ #define CONFIG_TXPWR_BY_RATE_EN 1 ++ #define CONFIG_TXPWR_LIMIT_EN 1 ++#endif ++ ++#ifndef CONFIG_RTW_TARGET_TX_PWR_2G_A ++ #define CONFIG_RTW_TARGET_TX_PWR_2G_A {-1, -1, -1, -1, -1, -1, -1, -1, -1, -1} ++#endif ++ ++#ifndef CONFIG_RTW_TARGET_TX_PWR_2G_B ++ #define CONFIG_RTW_TARGET_TX_PWR_2G_B {-1, -1, -1, -1, -1, -1, -1, -1, -1, -1} ++#endif ++ ++#ifndef CONFIG_RTW_TARGET_TX_PWR_2G_C ++ #define CONFIG_RTW_TARGET_TX_PWR_2G_C {-1, -1, -1, -1, -1, -1, -1, -1, -1, -1} ++#endif ++ ++#ifndef CONFIG_RTW_TARGET_TX_PWR_2G_D ++ #define CONFIG_RTW_TARGET_TX_PWR_2G_D {-1, -1, -1, -1, -1, -1, -1, -1, -1, -1} ++#endif ++ ++#ifndef CONFIG_RTW_TARGET_TX_PWR_5G_A ++ #define CONFIG_RTW_TARGET_TX_PWR_5G_A {-1, -1, -1, -1, -1, -1, -1, -1, -1} ++#endif ++ ++#ifndef CONFIG_RTW_TARGET_TX_PWR_5G_B ++ #define CONFIG_RTW_TARGET_TX_PWR_5G_B {-1, -1, -1, -1, -1, -1, -1, -1, -1} ++#endif ++ ++#ifndef CONFIG_RTW_TARGET_TX_PWR_5G_C ++ #define CONFIG_RTW_TARGET_TX_PWR_5G_C {-1, -1, -1, -1, -1, -1, -1, -1, -1} ++#endif ++ ++#ifndef CONFIG_RTW_TARGET_TX_PWR_5G_D ++ #define CONFIG_RTW_TARGET_TX_PWR_5G_D {-1, -1, -1, -1, -1, -1, -1, -1, -1} ++#endif ++ ++#ifndef CONFIG_RTW_AMPLIFIER_TYPE_2G ++ #define CONFIG_RTW_AMPLIFIER_TYPE_2G 0 ++#endif ++ ++#ifndef CONFIG_RTW_AMPLIFIER_TYPE_5G ++ #define CONFIG_RTW_AMPLIFIER_TYPE_5G 0 ++#endif ++ ++#ifndef CONFIG_RTW_RFE_TYPE ++ #define CONFIG_RTW_RFE_TYPE 64 ++#endif ++ ++#ifndef CONFIG_RTW_GLNA_TYPE ++ #define CONFIG_RTW_GLNA_TYPE 0 ++#endif ++ ++#ifndef CONFIG_RTW_PLL_REF_CLK_SEL ++ #define CONFIG_RTW_PLL_REF_CLK_SEL 0x0F ++#endif ++ ++#ifndef CONFIG_IFACE_NUMBER ++ #ifdef CONFIG_CONCURRENT_MODE ++ #define CONFIG_IFACE_NUMBER 2 ++ #else ++ #define CONFIG_IFACE_NUMBER 1 ++ #endif ++#endif ++ ++#ifndef CONFIG_CONCURRENT_MODE ++ #if (CONFIG_IFACE_NUMBER > 1) ++ #error "CONFIG_IFACE_NUMBER over 1,but CONFIG_CONCURRENT_MODE not defined" ++ #endif ++#endif ++ ++#if (CONFIG_IFACE_NUMBER == 0) ++ #error "CONFIG_IFACE_NUMBER cound not equel to 0 !!" ++#endif ++ ++#if (CONFIG_IFACE_NUMBER > 3) ++ #error "Not support over 3 interfaces yet !!" ++#endif ++ ++#if (CONFIG_IFACE_NUMBER > 8) /*IFACE_ID_MAX*/ ++ #error "HW count not support over 8 interfaces !!" ++#endif ++ ++#if (CONFIG_IFACE_NUMBER > 2) ++ #define CONFIG_MI_WITH_MBSSID_CAM ++ ++ #ifdef CONFIG_MI_WITH_MBSSID_CAM ++ #define CONFIG_MBSSID_CAM ++ #if defined(CONFIG_RUNTIME_PORT_SWITCH) ++ #undef CONFIG_RUNTIME_PORT_SWITCH ++ #endif ++ #endif ++ ++ #ifdef CONFIG_AP_MODE ++ #define CONFIG_SWTIMER_BASED_TXBCN ++ /*#define CONFIG_FW_BASED_BCN*/ ++ #endif ++#endif ++ ++#define MACID_NUM_SW_LIMIT 32 ++#define SEC_CAM_ENT_NUM_SW_LIMIT 32 ++ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) ++ #define CONFIG_IEEE80211_BAND_5GHZ ++#endif ++ ++#ifndef RTW_DEF_MODULE_REGULATORY_CERT ++ #define RTW_DEF_MODULE_REGULATORY_CERT 0 ++#endif ++ ++#if RTW_DEF_MODULE_REGULATORY_CERT ++ /* force enable TX power by rate and TX power limit */ ++ #ifndef CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY ++ #define CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY ++ #endif ++#endif ++ ++/* ++ Mark CONFIG_DEAUTH_BEFORE_CONNECT by Arvin 2015/07/20 ++ If the failure of Wi-Fi connection is due to some irregular disconnection behavior (like unplug dongle, ++ power down etc.) in last time, we can unmark this flag to avoid some unpredictable response from AP. ++*/ ++/*#define CONFIG_DEAUTH_BEFORE_CONNECT */ ++ ++/*#define CONFIG_WEXT_DONT_JOIN_BYSSID */ ++/* #include */ ++ ++ ++/*#define CONFIG_DOSCAN_IN_BUSYTRAFFIC */ ++ ++/*Don't release SDIO irq in suspend/resume procedure*/ ++#ifdef CONFIG_SDIO_HCI ++#define CONFIG_RTW_SDIO_KEEP_IRQ ++#endif ++ ++/* ++ * Add by Lucas@2016/02/15 ++ * For RX Aggregation ++ */ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_RX_AGGREGATION) ++ #define RTW_RX_AGGREGATION ++#endif /* CONFIG_SDIO_HCI || CONFIG_USB_RX_AGGREGATION */ ++ ++#endif /* __DRV_CONF_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types_ce.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_ce.h +--- linux-4.14.18/3rdparty/rtl8723de/include/drv_types_ce.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_ce.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,91 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __DRV_TYPES_CE_H__ ++#define __DRV_TYPES_CE_H__ ++ ++#include ++#include ++ ++#include ++ ++#define MAX_ACTIVE_REG_PATH 256 ++ ++#define MAX_MCAST_LIST_NUM 32 ++ ++ ++ ++/* for ioctl */ ++#define MAKE_DRIVER_VERSION(_MainVer, _MinorVer) ((((u32)(_MainVer))<<16)+_MinorVer) ++ ++#define NIC_HEADER_SIZE 14 /* !< can be moved to typedef.h */ ++#define NIC_MAX_PACKET_SIZE 1514 /* !< can be moved to typedef.h */ ++#define NIC_MAX_SEND_PACKETS 10 /* max number of send packets the MiniportSendPackets function can accept, can be moved to typedef.h */ ++#define NIC_VENDOR_DRIVER_VERSION MAKE_DRIVER_VERSION(0, 001) /* !< can be moved to typedef.h */ ++#define NIC_MAX_PACKET_SIZE 1514 /* !< can be moved to typedef.h */ ++ ++typedef struct _MP_REG_ENTRY { ++ ++ NDIS_STRING RegName; /* variable name text */ ++ BOOLEAN bRequired; /* 1->required, 0->optional */ ++ ++ u8 Type; /* NdisParameterInteger/NdisParameterHexInteger/NdisParameterStringle/NdisParameterMultiString */ ++ uint FieldOffset; /* offset to MP_ADAPTER field */ ++ uint FieldSize; /* size (in bytes) of the field */ ++ ++#ifdef UNDER_AMD64 ++ u64 Default; ++#else ++ u32 Default; /* default value to use */ ++#endif ++ ++ u32 Min; /* minimum value allowed */ ++ u32 Max; /* maximum value allowed */ ++} MP_REG_ENTRY, *PMP_REG_ENTRY; ++ ++#ifdef CONFIG_USB_HCI ++typedef struct _USB_EXTENSION { ++ LPCUSB_FUNCS _lpUsbFuncs; ++ USB_HANDLE _hDevice; ++ PVOID pAdapter; ++ ++#if 0 ++ USB_ENDPOINT_DESCRIPTOR _endpACLIn; ++ USB_ENDPOINT_DESCRIPTOR _endpACLOutHigh; ++ USB_ENDPOINT_DESCRIPTOR _endpACLOutNormal; ++ ++ USB_PIPE pPipeIn; ++ USB_PIPE pPipeOutNormal; ++ USB_PIPE pPipeOutHigh; ++#endif ++ ++} USB_EXTENSION, *PUSB_EXTENSION; ++#endif ++ ++ ++typedef struct _OCTET_STRING { ++ u8 *Octet; ++ u16 Length; ++} OCTET_STRING, *POCTET_STRING; ++ ++ ++ ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types_gspi.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_gspi.h +--- linux-4.14.18/3rdparty/rtl8723de/include/drv_types_gspi.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_gspi.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,54 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __DRV_TYPES_GSPI_H__ ++#define __DRV_TYPES_GSPI_H__ ++ ++/* SPI Header Files */ ++#ifdef PLATFORM_LINUX ++ #include ++ #include ++ #include ++ /* #include */ ++ #include ++ #include ++ #include ++ #include ++ #include ++ #include ++ #include ++#endif ++ ++ ++typedef struct gspi_data { ++ u8 func_number; ++ ++ u8 tx_block_mode; ++ u8 rx_block_mode; ++ u32 block_transfer_len; ++ ++#ifdef PLATFORM_LINUX ++ struct spi_device *func; ++ ++ struct workqueue_struct *priv_wq; ++ struct delayed_work irq_work; ++#endif ++} GSPI_DATA, *PGSPI_DATA; ++ ++#endif /* #ifndef __DRV_TYPES_GSPI_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types.h +--- linux-4.14.18/3rdparty/rtl8723de/include/drv_types.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,1584 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++/*------------------------------------------------------------------------------- ++ ++ For type defines and data structure defines ++ ++--------------------------------------------------------------------------------*/ ++ ++ ++#ifndef __DRV_TYPES_H__ ++#define __DRV_TYPES_H__ ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#ifdef CONFIG_ARP_KEEP_ALIVE ++ #include ++ #include ++#endif ++ ++#ifdef PLATFORM_OS_XP ++ #include ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ #include ++#endif ++ ++#ifdef PLATFORM_LINUX ++ #include ++#endif ++ ++enum _NIC_VERSION { ++ ++ RTL8711_NIC, ++ RTL8712_NIC, ++ RTL8713_NIC, ++ RTL8716_NIC ++ ++}; ++ ++typedef struct _ADAPTER _adapter, ADAPTER, *PADAPTER; ++ ++#include ++#include ++ ++#ifdef CONFIG_80211N_HT ++ #include ++#endif ++ ++#ifdef CONFIG_80211AC_VHT ++ #include ++#endif ++ ++#ifdef CONFIG_INTEL_WIDI ++ #include ++#endif ++ ++#include ++#include ++#include ++#include ++#include ++#include ++ ++#ifdef CONFIG_BEAMFORMING ++ #include ++#endif ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include "../hal/hal_dm.h" ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER ++ #include ++#endif ++ ++#include ++ ++#ifdef CONFIG_TDLS ++ #include ++#endif /* CONFIG_TDLS */ ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ #include ++#endif /* CONFIG_WAPI_SUPPORT */ ++ ++#ifdef CONFIG_DRVEXT_MODULE ++ #include ++#endif /* CONFIG_DRVEXT_MODULE */ ++ ++#ifdef CONFIG_MP_INCLUDED ++ #include ++#endif /* CONFIG_MP_INCLUDED */ ++ ++#ifdef CONFIG_BR_EXT ++ #include ++#endif /* CONFIG_BR_EXT */ ++ ++#ifdef CONFIG_IOL ++ #include ++#endif /* CONFIG_IOL */ ++ ++#include ++#include ++#include ++#include ++ ++#include ++ ++#ifdef CONFIG_BT_COEXIST ++ #include ++#endif /* CONFIG_BT_COEXIST */ ++ ++#ifdef CONFIG_MCC_MODE ++ #include ++#endif /*CONFIG_MCC_MODE */ ++ ++#define SPEC_DEV_ID_NONE BIT(0) ++#define SPEC_DEV_ID_DISABLE_HT BIT(1) ++#define SPEC_DEV_ID_ENABLE_PS BIT(2) ++#define SPEC_DEV_ID_RF_CONFIG_1T1R BIT(3) ++#define SPEC_DEV_ID_RF_CONFIG_2T2R BIT(4) ++#define SPEC_DEV_ID_ASSIGN_IFNAME BIT(5) ++ ++struct specific_device_id { ++ ++ u32 flags; ++ ++ u16 idVendor; ++ u16 idProduct; ++ ++}; ++ ++struct registry_priv { ++ u8 chip_version; ++ u8 rfintfs; ++ u8 lbkmode; ++ u8 hci; ++ NDIS_802_11_SSID ssid; ++ u8 network_mode; /* infra, ad-hoc, auto */ ++ u8 channel;/* ad-hoc support requirement */ ++ u8 wireless_mode;/* A, B, G, auto */ ++ u8 scan_mode;/* active, passive */ ++ u8 radio_enable; ++ u8 preamble;/* long, short, auto */ ++ u8 vrtl_carrier_sense;/* Enable, Disable, Auto */ ++ u8 vcs_type;/* RTS/CTS, CTS-to-self */ ++ u16 rts_thresh; ++ u16 frag_thresh; ++ u8 adhoc_tx_pwr; ++ u8 soft_ap; ++ u8 power_mgnt; ++ u8 ips_mode; ++ u8 smart_ps; ++ u8 usb_rxagg_mode; ++ u8 long_retry_lmt; ++ u8 short_retry_lmt; ++ u16 busy_thresh; ++ u8 ack_policy; ++ u8 mp_mode; ++#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTW_CUSTOMER_STR) ++ u8 mp_customer_str; ++#endif ++ u8 mp_dm; ++ u8 software_encrypt; ++ u8 software_decrypt; ++#ifdef CONFIG_TX_EARLY_MODE ++ u8 early_mode; ++#endif ++ u8 acm_method; ++ /* UAPSD */ ++ u8 wmm_enable; ++ u8 uapsd_enable; ++ u8 uapsd_max_sp; ++ u8 uapsd_acbk_en; ++ u8 uapsd_acbe_en; ++ u8 uapsd_acvi_en; ++ u8 uapsd_acvo_en; ++ ++ WLAN_BSSID_EX dev_network; ++ ++ u8 tx_bw_mode; ++ ++#ifdef CONFIG_80211N_HT ++ u8 ht_enable; ++ /* 0: 20 MHz, 1: 40 MHz, 2: 80 MHz, 3: 160MHz */ ++ /* 2.4G use bit 0 ~ 3, 5G use bit 4 ~ 7 */ ++ /* 0x21 means enable 2.4G 40MHz & 5G 80MHz */ ++ u8 bw_mode; ++ u8 ampdu_enable;/* for tx */ ++ u8 rx_stbc; ++ u8 ampdu_amsdu;/* A-MPDU Supports A-MSDU is permitted */ ++ /* Short GI support Bit Map */ ++ /* BIT0 - 20MHz, 1: support, 0: non-support */ ++ /* BIT1 - 40MHz, 1: support, 0: non-support */ ++ /* BIT2 - 80MHz, 1: support, 0: non-support */ ++ /* BIT3 - 160MHz, 1: support, 0: non-support */ ++ u8 short_gi; ++ /* BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx */ ++ u8 ldpc_cap; ++ /* BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx */ ++ u8 stbc_cap; ++ /* ++ * BIT0: Enable VHT SU Beamformer ++ * BIT1: Enable VHT SU Beamformee ++ * BIT2: Enable VHT MU Beamformer, depend on VHT SU Beamformer ++ * BIT3: Enable VHT MU Beamformee, depend on VHT SU Beamformee ++ * BIT4: Enable HT Beamformer ++ * BIT5: Enable HT Beamformee ++ */ ++ u8 beamform_cap; ++ u8 beamformer_rf_num; ++ u8 beamformee_rf_num; ++#endif /* CONFIG_80211N_HT */ ++ ++#ifdef CONFIG_80211AC_VHT ++ u8 vht_enable; /* 0:disable, 1:enable, 2:auto */ ++ u8 ampdu_factor; ++ u8 vht_rate_sel; ++#endif /* CONFIG_80211AC_VHT */ ++ ++ u8 lowrate_two_xmit; ++ ++ u8 rf_config ; ++ u8 low_power ; ++ ++ u8 wifi_spec;/* !turbo_mode */ ++ u8 special_rf_path; /* 0: 2T2R ,1: only turn on path A 1T1R */ ++ char alpha2[2]; ++ u8 channel_plan; ++ u8 excl_chs[MAX_CHANNEL_NUM]; ++ u8 full_ch_in_p2p_handshake; /* 0: reply only softap channel, 1: reply full channel list*/ ++ ++#ifdef CONFIG_BT_COEXIST ++ u8 btcoex; ++ u8 bt_iso; ++ u8 bt_sco; ++ u8 bt_ampdu; ++ u8 ant_num; ++#endif ++ BOOLEAN bAcceptAddbaReq; ++ ++ u8 antdiv_cfg; ++ u8 antdiv_type; ++ u8 drv_ant_band_switch; ++ ++ u8 switch_usb_mode; ++ ++ u8 usbss_enable;/* 0:disable,1:enable */ ++ u8 hwpdn_mode;/* 0:disable,1:enable,2:decide by EFUSE config */ ++ u8 hwpwrp_detect;/* 0:disable,1:enable */ ++ ++ u8 hw_wps_pbc;/* 0:disable,1:enable */ ++ ++#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE ++ char adaptor_info_caching_file_path[PATH_LENGTH_MAX]; ++#endif ++ ++#ifdef CONFIG_LAYER2_ROAMING ++ u8 max_roaming_times; /* the max number driver will try to roaming */ ++#endif ++ ++#ifdef CONFIG_IOL ++ u8 fw_iol; /* enable iol without other concern */ ++#endif ++ ++#ifdef CONFIG_80211D ++ u8 enable80211d; ++#endif ++ ++ u8 ifname[16]; ++ u8 if2name[16]; ++ ++ u8 notch_filter; ++ ++#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV ++ u8 force_ant;/* 0 normal,1 main,2 aux */ ++ u8 force_igi;/* 0 normal */ ++#endif ++ ++ u8 force_igi_lb; ++ ++ /* for pll reference clock selction */ ++ u8 pll_ref_clk_sel; ++ ++ /* define for tx power adjust */ ++ u8 RegEnableTxPowerLimit; ++ u8 RegEnableTxPowerByRate; ++ u8 RegPowerBase; ++ u8 RegPwrTblSel; ++ ++ u8 target_tx_pwr_valid; ++ s8 target_tx_pwr_2g[RF_PATH_MAX][RATE_SECTION_NUM]; ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ s8 target_tx_pwr_5g[RF_PATH_MAX][RATE_SECTION_NUM - 1]; ++#endif ++ ++ s8 TxBBSwing_2G; ++ s8 TxBBSwing_5G; ++ u8 AmplifierType_2G; ++ u8 AmplifierType_5G; ++ u8 bEn_RFE; ++ u8 RFE_Type; ++ u8 PowerTracking_Type; ++ u8 GLNA_Type; ++ u8 check_fw_ps; ++ u8 RegPwrTrimEnable; ++ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ u8 load_phy_file; ++ u8 RegDecryptCustomFile; ++#endif ++#ifdef CONFIG_CONCURRENT_MODE ++ u8 virtual_iface_num; ++#endif ++ u8 qos_opt_enable; ++ ++ u8 hiq_filter; ++ u8 adaptivity_en; ++ u8 adaptivity_mode; ++ u8 adaptivity_dml; ++ u8 adaptivity_dc_backoff; ++ s8 adaptivity_th_l2h_ini; ++ s8 adaptivity_th_edcca_hl_diff; ++ ++ u8 boffefusemask; ++ BOOLEAN bFileMaskEfuse; ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++ u8 acs_mode; ++ u8 acs_auto_scan; ++#endif ++ u32 reg_rxgain_offset_2g; ++ u32 reg_rxgain_offset_5gl; ++ u32 reg_rxgain_offset_5gm; ++ u32 reg_rxgain_offset_5gh; ++ ++#ifdef CONFIG_DFS_MASTER ++ u8 dfs_region_domain; ++#endif ++ ++#ifdef CONFIG_MCC_MODE ++ u8 en_mcc; ++ u32 rtw_mcc_single_tx_cri; ++ u32 rtw_mcc_ap_bw20_target_tx_tp; ++ u32 rtw_mcc_ap_bw40_target_tx_tp; ++ u32 rtw_mcc_ap_bw80_target_tx_tp; ++ u32 rtw_mcc_sta_bw20_target_tx_tp; ++ u32 rtw_mcc_sta_bw40_target_tx_tp; ++ u32 rtw_mcc_sta_bw80_target_tx_tp; ++#endif /* CONFIG_MCC_MODE */ ++ ++#ifdef CONFIG_RTW_NAPI ++ u8 en_napi; ++#ifdef CONFIG_RTW_GRO ++ u8 en_gro; ++#endif /* CONFIG_RTW_GRO */ ++#endif /* CONFIG_RTW_NAPI */ ++ ++ bool default_patterns_en; ++#ifdef CONFIG_SUPPORT_TRX_SHARED ++ u8 trx_share_mode; ++#endif ++ u8 check_hw_status; ++}; ++ ++/* For registry parameters */ ++#define RGTRY_OFT(field) ((ULONG)FIELD_OFFSET(struct registry_priv, field)) ++#define RGTRY_SZ(field) sizeof(((struct registry_priv *) 0)->field) ++ ++#define GetRegAmplifierType2G(_Adapter) (_Adapter->registrypriv.AmplifierType_2G) ++#define GetRegAmplifierType5G(_Adapter) (_Adapter->registrypriv.AmplifierType_5G) ++ ++#define GetRegTxBBSwing_2G(_Adapter) (_Adapter->registrypriv.TxBBSwing_2G) ++#define GetRegTxBBSwing_5G(_Adapter) (_Adapter->registrypriv.TxBBSwing_5G) ++ ++#define GetRegbENRFEType(_Adapter) (_Adapter->registrypriv.bEn_RFE) ++#define GetRegRFEType(_Adapter) (_Adapter->registrypriv.RFE_Type) ++#define GetRegGLNAType(_Adapter) (_Adapter->registrypriv.GLNA_Type) ++#define GetRegPowerTrackingType(_Adapter) (_Adapter->registrypriv.PowerTracking_Type) ++ ++#define BSSID_OFT(field) ((ULONG)FIELD_OFFSET(WLAN_BSSID_EX, field)) ++#define BSSID_SZ(field) sizeof(((PWLAN_BSSID_EX) 0)->field) ++ ++#ifdef CONFIG_80211N_HT ++#define BW_MODE_2G(bw_mode) ((bw_mode) & 0x0F) ++#define BW_MODE_5G(bw_mode) ((bw_mode) >> 4) ++#define REGSTY_BW_2G(regsty) BW_MODE_2G((regsty)->bw_mode) ++#define REGSTY_BW_5G(regsty) BW_MODE_5G((regsty)->bw_mode) ++#define REGSTY_IS_BW_2G_SUPPORT(regsty, bw) (REGSTY_BW_2G((regsty)) >= (bw)) ++#define REGSTY_IS_BW_5G_SUPPORT(regsty, bw) (REGSTY_BW_5G((regsty)) >= (bw)) ++#endif ++ ++#ifdef CONFIG_80211AC_VHT ++#define REGSTY_IS_11AC_ENABLE(regsty) ((regsty)->vht_enable != 0) ++#define REGSTY_IS_11AC_AUTO(regsty) ((regsty)->vht_enable == 2) ++#endif ++ ++typedef struct rtw_if_operations { ++ int __must_check(*read)(struct dvobj_priv *d, int addr, void *buf, ++ size_t len, bool fixed); ++ int __must_check(*write)(struct dvobj_priv *d, int addr, void *buf, ++ size_t len, bool fixed); ++} RTW_IF_OPS, *PRTW_IF_OPS; ++ ++#ifdef CONFIG_SDIO_HCI ++ #include ++ #define INTF_DATA SDIO_DATA ++ #define INTF_OPS PRTW_IF_OPS ++#elif defined(CONFIG_GSPI_HCI) ++ #include ++ #define INTF_DATA GSPI_DATA ++#elif defined(CONFIG_PCI_HCI) ++ #include ++#endif ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ #define is_primary_adapter(adapter) (adapter->adapter_type == PRIMARY_ADAPTER) ++ #define is_vir_adapter(adapter) (adapter->adapter_type == MAX_ADAPTER) ++ #define get_hw_port(adapter) (adapter->hw_port) ++#else ++ #define is_primary_adapter(adapter) (1) ++ #define is_vir_adapter(adapter) (0) ++ #define get_hw_port(adapter) (HW_PORT0) ++#endif ++#define GET_PRIMARY_ADAPTER(padapter) (((_adapter *)padapter)->dvobj->padapters[IFACE_ID0]) ++#define GET_IFACE_NUMS(padapter) (((_adapter *)padapter)->dvobj->iface_nums) ++#define GET_ADAPTER(padapter, iface_id) (((_adapter *)padapter)->dvobj->padapters[iface_id]) ++ ++#define GetDefaultAdapter(padapter) padapter ++ ++enum _IFACE_ID { ++ IFACE_ID0, /*PRIMARY_ADAPTER*/ ++ IFACE_ID1, ++ IFACE_ID2, ++ IFACE_ID3, ++ IFACE_ID4, ++ IFACE_ID5, ++ IFACE_ID6, ++ IFACE_ID7, ++ IFACE_ID_MAX, ++}; ++ ++#define VIF_START_ID 1 ++ ++#ifdef CONFIG_DBG_COUNTER ++ ++struct rx_logs { ++ u32 intf_rx; ++ u32 intf_rx_err_recvframe; ++ u32 intf_rx_err_skb; ++ u32 intf_rx_report; ++ u32 core_rx; ++ u32 core_rx_pre; ++ u32 core_rx_pre_ver_err; ++ u32 core_rx_pre_mgmt; ++ u32 core_rx_pre_mgmt_err_80211w; ++ u32 core_rx_pre_mgmt_err; ++ u32 core_rx_pre_ctrl; ++ u32 core_rx_pre_ctrl_err; ++ u32 core_rx_pre_data; ++ u32 core_rx_pre_data_wapi_seq_err; ++ u32 core_rx_pre_data_wapi_key_err; ++ u32 core_rx_pre_data_handled; ++ u32 core_rx_pre_data_err; ++ u32 core_rx_pre_data_unknown; ++ u32 core_rx_pre_unknown; ++ u32 core_rx_enqueue; ++ u32 core_rx_dequeue; ++ u32 core_rx_post; ++ u32 core_rx_post_decrypt; ++ u32 core_rx_post_decrypt_wep; ++ u32 core_rx_post_decrypt_tkip; ++ u32 core_rx_post_decrypt_aes; ++ u32 core_rx_post_decrypt_wapi; ++ u32 core_rx_post_decrypt_hw; ++ u32 core_rx_post_decrypt_unknown; ++ u32 core_rx_post_decrypt_err; ++ u32 core_rx_post_defrag_err; ++ u32 core_rx_post_portctrl_err; ++ u32 core_rx_post_indicate; ++ u32 core_rx_post_indicate_in_oder; ++ u32 core_rx_post_indicate_reoder; ++ u32 core_rx_post_indicate_err; ++ u32 os_indicate; ++ u32 os_indicate_ap_mcast; ++ u32 os_indicate_ap_forward; ++ u32 os_indicate_ap_self; ++ u32 os_indicate_err; ++ u32 os_netif_ok; ++ u32 os_netif_err; ++}; ++ ++struct tx_logs { ++ u32 os_tx; ++ u32 os_tx_err_up; ++ u32 os_tx_err_xmit; ++ u32 os_tx_m2u; ++ u32 os_tx_m2u_ignore_fw_linked; ++ u32 os_tx_m2u_ignore_self; ++ u32 os_tx_m2u_entry; ++ u32 os_tx_m2u_entry_err_xmit; ++ u32 os_tx_m2u_entry_err_skb; ++ u32 os_tx_m2u_stop; ++ u32 core_tx; ++ u32 core_tx_err_pxmitframe; ++ u32 core_tx_err_brtx; ++ u32 core_tx_upd_attrib; ++ u32 core_tx_upd_attrib_adhoc; ++ u32 core_tx_upd_attrib_sta; ++ u32 core_tx_upd_attrib_ap; ++ u32 core_tx_upd_attrib_unknown; ++ u32 core_tx_upd_attrib_dhcp; ++ u32 core_tx_upd_attrib_icmp; ++ u32 core_tx_upd_attrib_active; ++ u32 core_tx_upd_attrib_err_ucast_sta; ++ u32 core_tx_upd_attrib_err_ucast_ap_link; ++ u32 core_tx_upd_attrib_err_sta; ++ u32 core_tx_upd_attrib_err_link; ++ u32 core_tx_upd_attrib_err_sec; ++ u32 core_tx_ap_enqueue_warn_fwstate; ++ u32 core_tx_ap_enqueue_warn_sta; ++ u32 core_tx_ap_enqueue_warn_nosta; ++ u32 core_tx_ap_enqueue_warn_link; ++ u32 core_tx_ap_enqueue_warn_trigger; ++ u32 core_tx_ap_enqueue_mcast; ++ u32 core_tx_ap_enqueue_ucast; ++ u32 core_tx_ap_enqueue; ++ u32 intf_tx; ++ u32 intf_tx_pending_ac; ++ u32 intf_tx_pending_fw_under_survey; ++ u32 intf_tx_pending_fw_under_linking; ++ u32 intf_tx_pending_xmitbuf; ++ u32 intf_tx_enqueue; ++ u32 core_tx_enqueue; ++ u32 core_tx_enqueue_class; ++ u32 core_tx_enqueue_class_err_sta; ++ u32 core_tx_enqueue_class_err_nosta; ++ u32 core_tx_enqueue_class_err_fwlink; ++ u32 intf_tx_direct; ++ u32 intf_tx_direct_err_coalesce; ++ u32 intf_tx_dequeue; ++ u32 intf_tx_dequeue_err_coalesce; ++ u32 intf_tx_dump_xframe; ++ u32 intf_tx_dump_xframe_err_txdesc; ++ u32 intf_tx_dump_xframe_err_port; ++}; ++ ++struct int_logs { ++ u32 all; ++ u32 err; ++ u32 tbdok; ++ u32 tbder; ++ u32 bcnderr; ++ u32 bcndma; ++ u32 bcndma_e; ++ u32 rx; ++ u32 rx_rdu; ++ u32 rx_fovw; ++ u32 txfovw; ++ u32 mgntok; ++ u32 highdok; ++ u32 bkdok; ++ u32 bedok; ++ u32 vidok; ++ u32 vodok; ++}; ++ ++#endif /* CONFIG_DBG_COUNTER */ ++ ++struct debug_priv { ++ u32 dbg_sdio_free_irq_error_cnt; ++ u32 dbg_sdio_alloc_irq_error_cnt; ++ u32 dbg_sdio_free_irq_cnt; ++ u32 dbg_sdio_alloc_irq_cnt; ++ u32 dbg_sdio_deinit_error_cnt; ++ u32 dbg_sdio_init_error_cnt; ++ u32 dbg_suspend_error_cnt; ++ u32 dbg_suspend_cnt; ++ u32 dbg_resume_cnt; ++ u32 dbg_resume_error_cnt; ++ u32 dbg_deinit_fail_cnt; ++ u32 dbg_carddisable_cnt; ++ u32 dbg_carddisable_error_cnt; ++ u32 dbg_ps_insuspend_cnt; ++ u32 dbg_dev_unload_inIPS_cnt; ++ u32 dbg_wow_leave_ps_fail_cnt; ++ u32 dbg_scan_pwr_state_cnt; ++ u32 dbg_downloadfw_pwr_state_cnt; ++ u32 dbg_fw_read_ps_state_fail_cnt; ++ u32 dbg_leave_ips_fail_cnt; ++ u32 dbg_leave_lps_fail_cnt; ++ u32 dbg_h2c_leave32k_fail_cnt; ++ u32 dbg_diswow_dload_fw_fail_cnt; ++ u32 dbg_enwow_dload_fw_fail_cnt; ++ u32 dbg_ips_drvopen_fail_cnt; ++ u32 dbg_poll_fail_cnt; ++ u32 dbg_rpwm_toogle_cnt; ++ u32 dbg_rpwm_timeout_fail_cnt; ++ u32 dbg_sreset_cnt; ++ u64 dbg_rx_fifo_last_overflow; ++ u64 dbg_rx_fifo_curr_overflow; ++ u64 dbg_rx_fifo_diff_overflow; ++ u64 dbg_rx_ampdu_drop_count; ++ u64 dbg_rx_ampdu_forced_indicate_count; ++ u64 dbg_rx_ampdu_loss_count; ++ u64 dbg_rx_dup_mgt_frame_drop_count; ++ u64 dbg_rx_ampdu_window_shift_cnt; ++ u64 dbg_rx_conflic_mac_addr_cnt; ++}; ++ ++struct rtw_traffic_statistics { ++ /* tx statistics */ ++ u64 tx_bytes; ++ u64 tx_pkts; ++ u64 tx_drop; ++ u64 cur_tx_bytes; ++ u64 last_tx_bytes; ++ u32 cur_tx_tp; /* Tx throughput in MBps. */ ++ ++ /* rx statistics */ ++ u64 rx_bytes; ++ u64 rx_pkts; ++ u64 rx_drop; ++ u64 cur_rx_bytes; ++ u64 last_rx_bytes; ++ u32 cur_rx_tp; /* Rx throughput in MBps. */ ++}; ++ ++#define SEC_CAP_CHK_BMC BIT0 ++ ++#define SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH BIT0 ++ ++struct sec_cam_bmp { ++ u32 m0; ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) ++ u32 m1; ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) ++ u32 m2; ++#endif ++#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) ++ u32 m3; ++#endif ++}; ++ ++struct cam_ctl_t { ++ _lock lock; ++ ++ u8 sec_cap; ++ u32 flags; ++ ++ u8 num; ++ struct sec_cam_bmp used; ++ ++ _mutex sec_cam_access_mutex; ++}; ++ ++struct sec_cam_ent { ++ u16 ctrl; ++ u8 mac[ETH_ALEN]; ++ u8 key[16]; ++}; ++ ++#define KEY_FMT "%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" ++#define KEY_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5], \ ++ ((u8 *)(x))[6], ((u8 *)(x))[7], ((u8 *)(x))[8], ((u8 *)(x))[9], ((u8 *)(x))[10], ((u8 *)(x))[11], \ ++ ((u8 *)(x))[12], ((u8 *)(x))[13], ((u8 *)(x))[14], ((u8 *)(x))[15] ++ ++struct macid_bmp { ++ u32 m0; ++#if (MACID_NUM_SW_LIMIT > 32) ++ u32 m1; ++#endif ++#if (MACID_NUM_SW_LIMIT > 64) ++ u32 m2; ++#endif ++#if (MACID_NUM_SW_LIMIT > 96) ++ u32 m3; ++#endif ++}; ++ ++struct macid_ctl_t { ++ _lock lock; ++ u8 num; ++ struct macid_bmp used; ++ struct macid_bmp bmc; ++ struct macid_bmp if_g[CONFIG_IFACE_NUMBER]; ++ u8 iface_bmc[CONFIG_IFACE_NUMBER];/*for bc-sta of AP or Adhoc mode*/ ++ struct macid_bmp ch_g[2]; /* 2 ch concurrency */ ++ u8 h2c_msr[MACID_NUM_SW_LIMIT]; ++ u8 bw[MACID_NUM_SW_LIMIT]; ++ u8 vht_en[MACID_NUM_SW_LIMIT]; ++ u32 rate_bmp0[MACID_NUM_SW_LIMIT]; ++ u32 rate_bmp1[MACID_NUM_SW_LIMIT]; ++ struct sta_info *sta[MACID_NUM_SW_LIMIT]; ++}; ++ ++/* used for rf_ctl_t.rate_bmp_cck_ofdm */ ++#define RATE_BMP_CCK 0x000F ++#define RATE_BMP_OFDM 0xFFF0 ++#define RATE_BMP_HAS_CCK(_bmp_cck_ofdm) (_bmp_cck_ofdm & RATE_BMP_CCK) ++#define RATE_BMP_HAS_OFDM(_bmp_cck_ofdm) (_bmp_cck_ofdm & RATE_BMP_OFDM) ++#define RATE_BMP_GET_CCK(_bmp_cck_ofdm) (_bmp_cck_ofdm & RATE_BMP_CCK) ++#define RATE_BMP_GET_OFDM(_bmp_cck_ofdm) ((_bmp_cck_ofdm & RATE_BMP_OFDM) >> 4) ++ ++/* used for rf_ctl_t.rate_bmp_ht_by_bw */ ++#define RATE_BMP_HT_1SS 0x000000FF ++#define RATE_BMP_HT_2SS 0x0000FF00 ++#define RATE_BMP_HT_3SS 0x00FF0000 ++#define RATE_BMP_HT_4SS 0xFF000000 ++#define RATE_BMP_HAS_HT_1SS(_bmp_ht) (_bmp_ht & RATE_BMP_HT_1SS) ++#define RATE_BMP_HAS_HT_2SS(_bmp_ht) (_bmp_ht & RATE_BMP_HT_2SS) ++#define RATE_BMP_HAS_HT_3SS(_bmp_ht) (_bmp_ht & RATE_BMP_HT_3SS) ++#define RATE_BMP_HAS_HT_4SS(_bmp_ht) (_bmp_ht & RATE_BMP_HT_4SS) ++#define RATE_BMP_GET_HT_1SS(_bmp_ht) (_bmp_ht & RATE_BMP_HT_1SS) ++#define RATE_BMP_GET_HT_2SS(_bmp_ht) ((_bmp_ht & RATE_BMP_HT_2SS) >> 8) ++#define RATE_BMP_GET_HT_3SS(_bmp_ht) ((_bmp_ht & RATE_BMP_HT_3SS) >> 16) ++#define RATE_BMP_GET_HT_4SS(_bmp_ht) ((_bmp_ht & RATE_BMP_HT_4SS) >> 24) ++ ++/* used for rf_ctl_t.rate_bmp_vht_by_bw */ ++#define RATE_BMP_VHT_1SS 0x000003FF ++#define RATE_BMP_VHT_2SS 0x000FFC00 ++#define RATE_BMP_VHT_3SS 0x3FF00000 ++#define RATE_BMP_HAS_VHT_1SS(_bmp_vht) (_bmp_vht & RATE_BMP_VHT_1SS) ++#define RATE_BMP_HAS_VHT_2SS(_bmp_vht) (_bmp_vht & RATE_BMP_VHT_2SS) ++#define RATE_BMP_HAS_VHT_3SS(_bmp_vht) (_bmp_vht & RATE_BMP_VHT_3SS) ++#define RATE_BMP_GET_VHT_1SS(_bmp_vht) (_bmp_vht & RATE_BMP_VHT_1SS) ++#define RATE_BMP_GET_VHT_2SS(_bmp_vht) ((_bmp_vht & RATE_BMP_VHT_2SS) >> 10) ++#define RATE_BMP_GET_VHT_3SS(_bmp_vht) ((_bmp_vht & RATE_BMP_VHT_3SS) >> 20) ++ ++struct rf_ctl_t { ++ /* used for debug or by tx power limit */ ++ u16 rate_bmp_cck_ofdm; /* 20MHz */ ++ u32 rate_bmp_ht_by_bw[2]; /* 20MHz, 40MHz. 4SS supported */ ++ u32 rate_bmp_vht_by_bw[4]; /* 20MHz, 40MHz, 80MHz, 160MHz. up to 3SS supported */ ++ ++ /* used by tx power limit */ ++ u8 highest_ht_rate_bw_bmp; ++ u8 highest_vht_rate_bw_bmp; ++ ++#ifdef CONFIG_DFS_MASTER ++ bool radar_detect_by_others; ++ u8 dfs_master_enabled; ++ bool radar_detected; ++ ++ u8 radar_detect_ch; ++ u8 radar_detect_bw; ++ u8 radar_detect_offset; ++ ++ u32 cac_start_time; ++ u32 cac_end_time; ++ ++ u8 dfs_ch_sel_d_flags; ++ ++ u8 dbg_dfs_master_fake_radar_detect_cnt; ++ u8 dbg_dfs_master_radar_detect_trigger_non; ++ u8 dbg_dfs_master_choose_dfs_ch_first; ++#endif ++}; ++ ++#define RTW_CAC_STOPPED 0 ++#define IS_CAC_STOPPED(rfctl) ((rfctl)->cac_end_time == RTW_CAC_STOPPED) ++#define IS_CH_WAITING(rfctl) (!IS_CAC_STOPPED(rfctl) && time_after((unsigned long)(rfctl)->cac_end_time, (unsigned long)rtw_get_current_time())) ++#define IS_UNDER_CAC(rfctl) (IS_CH_WAITING(rfctl) && time_after((unsigned long)rtw_get_current_time(), (unsigned long)(rfctl)->cac_start_time)) ++ ++#ifdef CONFIG_MBSSID_CAM ++#define TOTAL_MBID_CAM_NUM 8 ++#define INVALID_CAM_ID 0xFF ++struct mbid_cam_ctl_t { ++ _lock lock; ++ u8 bitmap; ++ ATOMIC_T mbid_entry_num; ++}; ++struct mbid_cam_cache { ++ u8 iface_id; ++ /*u8 role;*/ /*WIFI_STATION_STATE or WIFI_AP_STATE*/ ++ u8 mac_addr[ETH_ALEN]; ++}; ++#endif /*CONFIG_MBSSID_CAM*/ ++ ++#ifdef RTW_HALMAC ++struct halmac_indicator { ++ struct submit_ctx *sctx; ++ u8 *buffer; ++ u32 buf_size; ++ u32 ret_size; ++ u32 status; ++}; ++ ++struct halmacpriv { ++ /* flags */ ++ /* ++ * send_general_info ++ * 0: no need to call halmac_send_general_info() ++ * 1: need to call halmac_send_general_info() ++ */ ++ u8 send_general_info; ++ ++ /* For asynchronous functions */ ++ struct halmac_indicator *indicator; ++ ++#ifdef CONFIG_SDIO_HCI ++ /* Store hardware tx queue page number setting */ ++ u16 txpage[HW_QUEUE_ENTRY]; ++#endif /* CONFIG_SDIO_HCI */ ++}; ++#endif /* RTW_HALMAC */ ++ ++struct dvobj_priv { ++ /*-------- below is common data --------*/ ++ u8 chip_type; ++ u8 HardwareType; ++ u8 interface_type;/*USB,SDIO,SPI,PCI*/ ++ ++ ATOMIC_T bSurpriseRemoved; ++ ATOMIC_T bDriverStopped; ++ ++ s32 processing_dev_remove; ++ ++ struct debug_priv drv_dbg; ++ ++ _mutex hw_init_mutex; ++ _mutex h2c_fwcmd_mutex; ++ ++#ifdef CONFIG_RTW_CUSTOMER_STR ++ _mutex customer_str_mutex; ++ struct submit_ctx *customer_str_sctx; ++ u8 customer_str[RTW_CUSTOMER_STR_LEN]; ++#endif ++ ++ _mutex setch_mutex; ++ _mutex setbw_mutex; ++ _mutex rf_read_reg_mutex; ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++ _mutex sd_indirect_access_mutex; ++#endif ++ ++ unsigned char oper_channel; /* saved channel info when call set_channel_bw */ ++ unsigned char oper_bwmode; ++ unsigned char oper_ch_offset;/* PRIME_CHNL_OFFSET */ ++ u32 on_oper_ch_time; ++ ++ _adapter *padapters[CONFIG_IFACE_NUMBER];/*IFACE_ID_MAX*/ ++ u8 iface_nums; /* total number of ifaces used runtime */ ++ struct mi_state iface_state; ++ ++#ifdef CONFIG_AP_MODE ++ u8 nr_ap_if; /* total interface s number of ap/go mode. */ ++ u32 inter_bcn_space; /* unit:ms */ ++ _queue ap_if_q; ++#endif ++ ++ struct macid_ctl_t macid_ctl; ++ ++ struct cam_ctl_t cam_ctl; ++ struct sec_cam_ent cam_cache[SEC_CAM_ENT_NUM_SW_LIMIT]; ++ ++#ifdef CONFIG_MBSSID_CAM ++ struct mbid_cam_ctl_t mbid_cam_ctl; ++ struct mbid_cam_cache mbid_cam_cache[TOTAL_MBID_CAM_NUM]; ++#endif ++ ++ struct rf_ctl_t rf_ctl; ++ ++ /* For 92D, DMDP have 2 interface. */ ++ u8 InterfaceNumber; ++ u8 NumInterfaces; ++ ++ /* In /Out Pipe information */ ++ int RtInPipe[2]; ++ int RtOutPipe[4]; ++ u8 Queue2Pipe[HW_QUEUE_ENTRY];/* for out pipe mapping */ ++ ++ u8 irq_alloc; ++ ATOMIC_T continual_io_error; ++ ++ ATOMIC_T disable_func; ++ ++ struct pwrctrl_priv pwrctl_priv; ++ ++ struct rtw_traffic_statistics traffic_stat; ++ ++#ifdef PLATFORM_LINUX ++ _thread_hdl_ rtnl_lock_holder; ++ ++ #if defined(CONFIG_IOCTL_CFG80211) && defined(RTW_SINGLE_WIPHY) ++ struct wiphy *wiphy; ++ #endif ++#endif /* PLATFORM_LINUX */ ++ ++#ifdef CONFIG_SWTIMER_BASED_TXBCN ++ _timer txbcn_timer; ++#endif ++ _timer dynamic_chk_timer; /* dynamic/periodic check timer */ ++ ++#ifdef RTW_HALMAC ++ void *halmac; ++ struct halmacpriv hmpriv; ++#endif /* RTW_HALMAC */ ++ ++ /*-------- below is for SDIO INTERFACE --------*/ ++ ++#ifdef INTF_DATA ++ INTF_DATA intf_data; ++#endif ++#ifdef INTF_OPS ++ INTF_OPS intf_ops; ++#endif ++ ++ /*-------- below is for USB INTERFACE --------*/ ++ ++#ifdef CONFIG_USB_HCI ++ ++ u8 usb_speed; /* 1.1, 2.0 or 3.0 */ ++ u8 nr_endpoint; ++ u8 RtNumInPipes; ++ u8 RtNumOutPipes; ++ int ep_num[6]; /* endpoint number */ ++ ++ int RegUsbSS; ++ ++ _sema usb_suspend_sema; ++ ++#ifdef CONFIG_USB_VENDOR_REQ_MUTEX ++ _mutex usb_vendor_req_mutex; ++#endif ++ ++#ifdef CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC ++ u8 *usb_alloc_vendor_req_buf; ++ u8 *usb_vendor_req_buf; ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ /* related device objects */ ++ PDEVICE_OBJECT pphysdevobj;/* pPhysDevObj; */ ++ PDEVICE_OBJECT pfuncdevobj;/* pFuncDevObj; */ ++ PDEVICE_OBJECT pnextdevobj;/* pNextDevObj; */ ++ ++ u8 nextdevstacksz;/* unsigned char NextDeviceStackSize; */ /* = (CHAR)CEdevice->pUsbDevObj->StackSize + 1; */ ++ ++ /* urb for control diescriptor request */ ++ ++#ifdef PLATFORM_OS_XP ++ struct _URB_CONTROL_DESCRIPTOR_REQUEST descriptor_urb; ++ PUSB_CONFIGURATION_DESCRIPTOR pconfig_descriptor;/* UsbConfigurationDescriptor; */ ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ WCHAR active_path[MAX_ACTIVE_REG_PATH]; /* adapter regpath */ ++ USB_EXTENSION usb_extension; ++ ++ _nic_hdl pipehdls_r8192c[0x10]; ++#endif ++ ++ u32 config_descriptor_len;/* ULONG UsbConfigurationDescriptorLength; */ ++#endif/* PLATFORM_WINDOWS */ ++ ++#ifdef PLATFORM_LINUX ++ struct usb_interface *pusbintf; ++ struct usb_device *pusbdev; ++#endif/* PLATFORM_LINUX */ ++ ++#ifdef PLATFORM_FREEBSD ++ struct usb_interface *pusbintf; ++ struct usb_device *pusbdev; ++#endif/* PLATFORM_FREEBSD */ ++ ++#endif/* CONFIG_USB_HCI */ ++ ++ /*-------- below is for PCIE INTERFACE --------*/ ++ ++#ifdef CONFIG_PCI_HCI ++ ++#ifdef PLATFORM_LINUX ++ struct pci_dev *ppcidev; ++ ++ /* PCI MEM map */ ++ unsigned long pci_mem_end; /* shared mem end */ ++ unsigned long pci_mem_start; /* shared mem start */ ++ ++ /* PCI IO map */ ++ unsigned long pci_base_addr; /* device I/O address */ ++ ++#ifdef RTK_129X_PLATFORM ++ /* PCI MASK addr */ ++ unsigned long mask_addr; ++ ++ /* PCI TRANSLATE addr */ ++ unsigned long tran_addr; ++ ++ _lock io_reg_lock; ++#endif ++ ++ /* PciBridge */ ++ struct pci_priv pcipriv; ++ ++ unsigned int irq; /* get from pci_dev.irq, store to net_device.irq */ ++ u16 irqline; ++ u8 irq_enabled; ++ RT_ISR_CONTENT isr_content; ++ _lock irq_th_lock; ++ ++ /* ASPM */ ++ u8 const_pci_aspm; ++ u8 const_amdpci_aspm; ++ u8 const_hwsw_rfoff_d3; ++ u8 const_support_pciaspm; ++ /* pci-e bridge */ ++ u8 const_hostpci_aspm_setting; ++ /* pci-e device */ ++ u8 const_devicepci_aspm_setting; ++ u8 b_support_aspm; /* If it supports ASPM, Offset[560h] = 0x40, otherwise Offset[560h] = 0x00. */ ++ u8 b_support_backdoor; ++ u8 bdma64; ++#endif/* PLATFORM_LINUX */ ++ ++#endif/* CONFIG_PCI_HCI */ ++ ++#ifdef CONFIG_MCC_MODE ++ struct mcc_obj_priv mcc_objpriv; ++#endif /*CONFIG_MCC_MODE */ ++}; ++ ++#define DEV_STA_NUM(_dvobj) MSTATE_STA_NUM(&((_dvobj)->iface_state)) ++#define DEV_STA_LD_NUM(_dvobj) MSTATE_STA_LD_NUM(&((_dvobj)->iface_state)) ++#define DEV_STA_LG_NUM(_dvobj) MSTATE_STA_LG_NUM(&((_dvobj)->iface_state)) ++#define DEV_AP_NUM(_dvobj) MSTATE_AP_NUM(&((_dvobj)->iface_state)) ++#define DEV_AP_LD_NUM(_dvobj) MSTATE_AP_LD_NUM(&((_dvobj)->iface_state)) ++#define DEV_ADHOC_NUM(_dvobj) MSTATE_ADHOC_NUM(&((_dvobj)->iface_state)) ++#define DEV_ADHOC_LD_NUM(_dvobj) MSTATE_ADHOC_LD_NUM(&((_dvobj)->iface_state)) ++#define DEV_WPS_NUM(_dvobj) MSTATE_WPS_NUM(&((_dvobj)->iface_state)) ++#define DEV_ROCH_NUM(_dvobj) MSTATE_ROCH_NUM(&((_dvobj)->iface_state)) ++#define DEV_MGMT_TX_NUM(_dvobj) MSTATE_MGMT_TX_NUM(&((_dvobj)->iface_state)) ++#define DEV_U_CH(_dvobj) MSTATE_U_CH(&((_dvobj)->iface_state)) ++#define DEV_U_BW(_dvobj) MSTATE_U_BW(&((_dvobj)->iface_state)) ++#define DEV_U_OFFSET(_dvobj) MSTATE_U_OFFSET(&((_dvobj)->iface_state)) ++ ++#define dvobj_to_pwrctl(dvobj) (&(dvobj->pwrctl_priv)) ++#define pwrctl_to_dvobj(pwrctl) container_of(pwrctl, struct dvobj_priv, pwrctl_priv) ++#define dvobj_to_macidctl(dvobj) (&(dvobj->macid_ctl)) ++#define dvobj_to_sec_camctl(dvobj) (&(dvobj->cam_ctl)) ++#define dvobj_to_regsty(dvobj) (&(dvobj->padapters[IFACE_ID0]->registrypriv)) ++#if defined(CONFIG_IOCTL_CFG80211) && defined(RTW_SINGLE_WIPHY) ++#define dvobj_to_wiphy(dvobj) ((dvobj)->wiphy) ++#endif ++#define dvobj_to_rfctl(dvobj) (&(dvobj->rf_ctl)) ++#define rfctl_to_dvobj(rfctl) container_of((rfctl), struct dvobj_priv, rf_ctl) ++ ++static inline void dev_set_surprise_removed(struct dvobj_priv *dvobj) ++{ ++ ATOMIC_SET(&dvobj->bSurpriseRemoved, _TRUE); ++} ++static inline void dev_clr_surprise_removed(struct dvobj_priv *dvobj) ++{ ++ ATOMIC_SET(&dvobj->bSurpriseRemoved, _FALSE); ++} ++static inline void dev_set_drv_stopped(struct dvobj_priv *dvobj) ++{ ++ ATOMIC_SET(&dvobj->bDriverStopped, _TRUE); ++} ++static inline void dev_clr_drv_stopped(struct dvobj_priv *dvobj) ++{ ++ ATOMIC_SET(&dvobj->bDriverStopped, _FALSE); ++} ++#define dev_is_surprise_removed(dvobj) (ATOMIC_READ(&dvobj->bSurpriseRemoved) == _TRUE) ++#define dev_is_drv_stopped(dvobj) (ATOMIC_READ(&dvobj->bDriverStopped) == _TRUE) ++ ++#ifdef PLATFORM_LINUX ++static struct device *dvobj_to_dev(struct dvobj_priv *dvobj) ++{ ++ /* todo: get interface type from dvobj and the return the dev accordingly */ ++#ifdef RTW_DVOBJ_CHIP_HW_TYPE ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ return &dvobj->pusbintf->dev; ++#endif ++#ifdef CONFIG_SDIO_HCI ++ return &dvobj->intf_data.func->dev; ++#endif ++#ifdef CONFIG_GSPI_HCI ++ return &dvobj->intf_data.func->dev; ++#endif ++#ifdef CONFIG_PCI_HCI ++ return &dvobj->ppcidev->dev; ++#endif ++} ++#endif ++ ++_adapter *dvobj_get_port0_adapter(struct dvobj_priv *dvobj); ++_adapter *dvobj_get_unregisterd_adapter(struct dvobj_priv *dvobj); ++_adapter *dvobj_get_adapter_by_addr(struct dvobj_priv *dvobj, u8 *addr); ++#define dvobj_get_primary_adapter(dvobj) ((dvobj)->padapters[IFACE_ID0]) ++ ++enum _hw_port { ++ HW_PORT0, ++ HW_PORT1, ++ HW_PORT2, ++ HW_PORT3, ++ HW_PORT4, ++ MAX_HW_PORT, ++}; ++ ++enum _ADAPTER_TYPE { ++ PRIMARY_ADAPTER, ++ VIRTUAL_ADAPTER, ++ MAX_ADAPTER = 0xFF, ++}; ++ ++typedef enum _DRIVER_STATE { ++ DRIVER_NORMAL = 0, ++ DRIVER_DISAPPEAR = 1, ++ DRIVER_REPLACE_DONGLE = 2, ++} DRIVER_STATE; ++ ++#ifdef CONFIG_RTW_NAPI ++enum _NAPI_STATE { ++ NAPI_DISABLE = 0, ++ NAPI_ENABLE = 1, ++}; ++#endif ++ ++#ifdef CONFIG_INTEL_PROXIM ++struct proxim { ++ bool proxim_support; ++ bool proxim_on; ++ ++ void *proximity_priv; ++ int (*proxim_rx)(_adapter *padapter, ++ union recv_frame *precv_frame); ++ u8(*proxim_get_var)(_adapter *padapter, u8 type); ++}; ++#endif /* CONFIG_INTEL_PROXIM */ ++ ++#ifdef CONFIG_MAC_LOOPBACK_DRIVER ++typedef struct loopbackdata { ++ _sema sema; ++ _thread_hdl_ lbkthread; ++ u8 bstop; ++ u32 cnt; ++ u16 size; ++ u16 txsize; ++ u8 txbuf[0x8000]; ++ u16 rxsize; ++ u8 rxbuf[0x8000]; ++ u8 msg[100]; ++ ++} LOOPBACKDATA, *PLOOPBACKDATA; ++#endif ++ ++#ifdef CONFIG_80211N_HT ++#define ADAPTER_TX_BW_2G(adapter) BW_MODE_2G((adapter)->driver_tx_bw_mode) ++#define ADAPTER_TX_BW_5G(adapter) BW_MODE_5G((adapter)->driver_tx_bw_mode) ++#else ++#define ADAPTER_TX_BW_2G(adapter) 0x0 ++#define ADAPTER_TX_BW_5G(adapter) 0x0 ++#endif /* CONFIG_80211N_HT */ ++ ++struct _ADAPTER { ++ int DriverState;/* for disable driver using module, use dongle to replace module. */ ++ int pid[3];/* process id from UI, 0:wps, 1:hostapd, 2:dhcpcd */ ++ int bDongle;/* build-in module or external dongle */ ++ ++ _list list; ++ ++ struct dvobj_priv *dvobj; ++ struct mlme_priv mlmepriv; ++ struct mlme_ext_priv mlmeextpriv; ++ struct cmd_priv cmdpriv; ++ struct evt_priv evtpriv; ++ /* struct io_queue *pio_queue; */ ++ struct io_priv iopriv; ++ struct xmit_priv xmitpriv; ++ struct recv_priv recvpriv; ++ struct sta_priv stapriv; ++ struct security_priv securitypriv; ++ _lock security_key_mutex; /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ struct registry_priv registrypriv; ++ ++ struct led_priv ledpriv; ++ ++#ifdef CONFIG_RTW_NAPI ++ struct napi_struct napi; ++ u8 napi_state; ++#endif ++ ++#ifdef CONFIG_MP_INCLUDED ++ struct mp_priv mppriv; ++#endif ++ ++#ifdef CONFIG_DRVEXT_MODULE ++ struct drvext_priv drvextpriv; ++#endif ++ ++#ifdef CONFIG_AP_MODE ++ struct hostapd_priv *phostapdpriv; ++#endif ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++#ifdef CONFIG_P2P ++ struct cfg80211_wifidirect_info cfg80211_wdinfo; ++#endif /* CONFIG_P2P */ ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ u32 setband; ++ ATOMIC_T bandskip; ++ ++#ifdef CONFIG_P2P ++ struct wifidirect_info wdinfo; ++#endif /* CONFIG_P2P */ ++ ++#ifdef CONFIG_TDLS ++ struct tdls_info tdlsinfo; ++#endif /* CONFIG_TDLS */ ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ u8 WapiSupport; ++ RT_WAPI_T wapiInfo; ++#endif ++ ++ ++#ifdef CONFIG_WFD ++ struct wifi_display_info wfd_info; ++#endif /* CONFIG_WFD */ ++ ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ struct bt_coex_info coex_info; ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++ ++ ERROR_CODE LastError; /* <20130613, Kordan> Only the functions associated with MP records the error code by now. */ ++ ++ PVOID HalData; ++ u32 hal_data_sz; ++ struct hal_ops HalFunc; ++ ++ u32 IsrContent; ++ u32 ImrContent; ++ ++ u8 EepromAddressSize; ++ u8 bDriverIsGoingToUnload; ++ u8 init_adpt_in_progress; ++ u8 bHaltInProgress; ++#ifdef CONFIG_GPIO_API ++ u8 pre_gpio_pin; ++ struct gpio_int_priv { ++ u8 interrupt_mode; ++ u8 interrupt_enable_mask; ++ void (*callback[8])(u8 level); ++ } gpiointpriv; ++#endif ++ _thread_hdl_ cmdThread; ++ _thread_hdl_ evtThread; ++ _thread_hdl_ xmitThread; ++ _thread_hdl_ recvThread; ++ ++ u8 registered; ++#ifndef PLATFORM_LINUX ++ NDIS_STATUS(*dvobj_init)(struct dvobj_priv *dvobj); ++ void (*dvobj_deinit)(struct dvobj_priv *dvobj); ++#endif ++ ++ u32(*intf_init)(struct dvobj_priv *dvobj); ++ void (*intf_deinit)(struct dvobj_priv *dvobj); ++ int (*intf_alloc_irq)(struct dvobj_priv *dvobj); ++ void (*intf_free_irq)(struct dvobj_priv *dvobj); ++ ++ ++ void (*intf_start)(_adapter *adapter); ++ void (*intf_stop)(_adapter *adapter); ++ ++#ifdef PLATFORM_WINDOWS ++ _nic_hdl hndis_adapter;/* hNdisAdapter(NDISMiniportAdapterHandle); */ ++ _nic_hdl hndis_config;/* hNdisConfiguration; */ ++ NDIS_STRING fw_img; ++ ++ u32 NdisPacketFilter; ++ u8 MCList[MAX_MCAST_LIST_NUM][6]; ++ u32 MCAddrCount; ++#endif /* end of PLATFORM_WINDOWS */ ++ ++ ++#ifdef PLATFORM_LINUX ++ _nic_hdl pnetdev; ++ char old_ifname[IFNAMSIZ]; ++ ++ /* used by rtw_rereg_nd_name related function */ ++ struct rereg_nd_name_data { ++ _nic_hdl old_pnetdev; ++ char old_ifname[IFNAMSIZ]; ++ u8 old_ips_mode; ++ u8 old_bRegUseLed; ++ } rereg_nd_name_priv; ++ ++ u8 ndev_unregistering; ++ int bup; ++ struct net_device_stats stats; ++ struct iw_statistics iwstats; ++ struct proc_dir_entry *dir_dev;/* for proc directory */ ++ struct proc_dir_entry *dir_odm; ++ ++#ifdef CONFIG_MCC_MODE ++ struct proc_dir_entry *dir_mcc; ++#endif /* CONFIG_MCC_MODE */ ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ struct wireless_dev *rtw_wdev; ++ struct rtw_wdev_priv wdev_data; ++ ++#if !defined(RTW_SINGLE_WIPHY) ++ struct wiphy *wiphy; ++#endif ++ ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++#endif /* PLATFORM_LINUX */ ++ ++#ifdef PLATFORM_FREEBSD ++ _nic_hdl pifp; ++ int bup; ++ _lock glock; ++#endif /* PLATFORM_FREEBSD */ ++ u8 mac_addr[ETH_ALEN]; ++ int net_closed; ++ ++ u8 netif_up; ++ ++ u8 bFWReady; ++ u8 bBTFWReady; ++ u8 bLinkInfoDump; ++ u8 bRxRSSIDisplay; ++ /* Added by Albert 2012/10/26 */ ++ /* The driver will show up the desired channel number when this flag is 1. */ ++ u8 bNotifyChannelChange; ++#ifdef CONFIG_P2P ++ /* Added by Albert 2012/12/06 */ ++ /* The driver will show the current P2P status when the upper application reads it. */ ++ u8 bShowGetP2PState; ++#endif ++#ifdef CONFIG_AUTOSUSPEND ++ u8 bDisableAutosuspend; ++#endif ++ ++ u8 isprimary; /* is primary adapter or not */ ++ /* notes: ++ ** if isprimary is true, the adapter_type value is 0, iface_id is IFACE_ID0 for PRIMARY_ADAPTER ++ ** if isprimary is false, the adapter_type value is 1, iface_id is IFACE_ID1 for VIRTUAL_ADAPTER ++ ** refer to iface_id if iface_nums>2 and isprimary is false and the adapter_type value is 0xff.*/ ++ u8 adapter_type;/*be used in Multi-interface to recognize whether is PRIMARY_ADAPTER or not(PRIMARY_ADAPTER/VIRTUAL_ADAPTER) .*/ ++ u8 hw_port; /*interface port type, it depends on HW port */ ++ ++ ++ /*extend to support multi interface*/ ++ /*IFACE_ID0 is equals to PRIMARY_ADAPTER ++ IFACE_ID1 is equals to VIRTUAL_ADAPTER*/ ++ u8 iface_id; ++ ++#ifdef CONFIG_BR_EXT ++ _lock br_ext_lock; ++ /* unsigned int macclone_completed; */ ++ struct nat25_network_db_entry *nethash[NAT25_HASH_SIZE]; ++ int pppoe_connection_in_progress; ++ unsigned char pppoe_addr[MACADDRLEN]; ++ unsigned char scdb_mac[MACADDRLEN]; ++ unsigned char scdb_ip[4]; ++ struct nat25_network_db_entry *scdb_entry; ++ unsigned char br_mac[MACADDRLEN]; ++ unsigned char br_ip[4]; ++ ++ struct br_ext_info ethBrExtInfo; ++#endif /* CONFIG_BR_EXT */ ++ ++#ifdef CONFIG_INTEL_PROXIM ++ /* intel Proximity, should be alloc mem ++ * in intel Proximity module and can only ++ * be used in intel Proximity mode */ ++ struct proxim proximity; ++#endif /* CONFIG_INTEL_PROXIM */ ++ ++#ifdef CONFIG_MAC_LOOPBACK_DRIVER ++ PLOOPBACKDATA ploopback; ++#endif ++ ++ /* for debug purpose */ ++ u8 fix_rate; ++ u8 fix_bw; ++ u8 data_fb; /* data rate fallback, valid only when fix_rate is not 0xff */ ++ ++ u8 driver_tx_bw_mode; ++ ++ u8 driver_vcs_en; /* Enable=1, Disable=0 driver control vrtl_carrier_sense for tx */ ++ u8 driver_vcs_type;/* force 0:disable VCS, 1:RTS-CTS, 2:CTS-to-self when vcs_en=1. */ ++ u8 driver_ampdu_spacing;/* driver control AMPDU Density for peer sta's rx */ ++ u8 driver_rx_ampdu_factor;/* 0xff: disable drv ctrl, 0:8k, 1:16k, 2:32k, 3:64k; */ ++ u8 driver_rx_ampdu_spacing; /* driver control Rx AMPDU Density */ ++ u8 fix_rx_ampdu_accept; ++ u8 fix_rx_ampdu_size; /* 0~127, TODO:consider each sta and each TID */ ++ unsigned char in_cta_test; ++#ifdef DBG_RX_COUNTER_DUMP ++ u8 dump_rx_cnt_mode;/*BIT0:drv,BIT1:mac,BIT2:phy*/ ++ u32 drv_rx_cnt_ok; ++ u32 drv_rx_cnt_crcerror; ++ u32 drv_rx_cnt_drop; ++#endif ++ ++#ifdef CONFIG_DBG_COUNTER ++ struct rx_logs rx_logs; ++ struct tx_logs tx_logs; ++ struct int_logs int_logs; ++#endif ++ ++#ifdef CONFIG_MCC_MODE ++ struct mcc_adapter_priv mcc_adapterpriv; ++#endif /* CONFIG_MCC_MODE */ ++}; ++ ++#define adapter_to_dvobj(adapter) ((adapter)->dvobj) ++#define adapter_to_regsty(adapter) dvobj_to_regsty(adapter_to_dvobj((adapter))) ++#define adapter_to_pwrctl(adapter) dvobj_to_pwrctl(adapter_to_dvobj((adapter))) ++#define adapter_wdev_data(adapter) (&((adapter)->wdev_data)) ++#if defined(RTW_SINGLE_WIPHY) ++#define adapter_to_wiphy(adapter) dvobj_to_wiphy(adapter_to_dvobj(adapter)) ++#else ++#define adapter_to_wiphy(adapter) ((adapter)->wiphy) ++#endif ++ ++#define adapter_to_rfctl(adapter) dvobj_to_rfctl(adapter_to_dvobj((adapter))) ++ ++#define adapter_mac_addr(adapter) (adapter->mac_addr) ++ ++#define mlme_to_adapter(mlme) container_of((mlme), struct _ADAPTER, mlmepriv) ++#define tdls_info_to_adapter(tdls) container_of((tdls), struct _ADAPTER, tdlsinfo) ++ ++#define rtw_get_chip_type(adapter) (((PADAPTER)adapter)->dvobj->chip_type) ++#define rtw_get_hw_type(adapter) (((PADAPTER)adapter)->dvobj->HardwareType) ++#define rtw_get_intf_type(adapter) (((PADAPTER)adapter)->dvobj->interface_type) ++ ++#define rtw_get_mi_nums(adapter) (((PADAPTER)adapter)->dvobj->iface_nums) ++ ++static inline void rtw_set_surprise_removed(_adapter *padapter) ++{ ++ dev_set_surprise_removed(adapter_to_dvobj(padapter)); ++} ++static inline void rtw_clr_surprise_removed(_adapter *padapter) ++{ ++ dev_clr_surprise_removed(adapter_to_dvobj(padapter)); ++} ++static inline void rtw_set_drv_stopped(_adapter *padapter) ++{ ++ dev_set_drv_stopped(adapter_to_dvobj(padapter)); ++} ++static inline void rtw_clr_drv_stopped(_adapter *padapter) ++{ ++ dev_clr_drv_stopped(adapter_to_dvobj(padapter)); ++} ++#define rtw_is_surprise_removed(padapter) (dev_is_surprise_removed(adapter_to_dvobj(padapter))) ++#define rtw_is_drv_stopped(padapter) (dev_is_drv_stopped(adapter_to_dvobj(padapter))) ++ ++/* ++ * Function disabled. ++ * */ ++#define DF_TX_BIT BIT0 /*write_port_cancel*/ ++#define DF_RX_BIT BIT1 /*read_port_cancel*/ ++#define DF_IO_BIT BIT2 ++ ++/* #define RTW_DISABLE_FUNC(padapter, func) (ATOMIC_ADD(&adapter_to_dvobj(padapter)->disable_func, (func))) */ ++/* #define RTW_ENABLE_FUNC(padapter, func) (ATOMIC_SUB(&adapter_to_dvobj(padapter)->disable_func, (func))) */ ++__inline static void RTW_DISABLE_FUNC(_adapter *padapter, int func_bit) ++{ ++ int df = ATOMIC_READ(&adapter_to_dvobj(padapter)->disable_func); ++ df |= func_bit; ++ ATOMIC_SET(&adapter_to_dvobj(padapter)->disable_func, df); ++} ++ ++__inline static void RTW_ENABLE_FUNC(_adapter *padapter, int func_bit) ++{ ++ int df = ATOMIC_READ(&adapter_to_dvobj(padapter)->disable_func); ++ df &= ~(func_bit); ++ ATOMIC_SET(&adapter_to_dvobj(padapter)->disable_func, df); ++} ++ ++#define RTW_CANNOT_RUN(padapter) \ ++ (rtw_is_surprise_removed(padapter) || \ ++ rtw_is_drv_stopped(padapter)) ++ ++#define RTW_IS_FUNC_DISABLED(padapter, func_bit) (ATOMIC_READ(&adapter_to_dvobj(padapter)->disable_func) & (func_bit)) ++ ++#define RTW_CANNOT_IO(padapter) \ ++ (rtw_is_surprise_removed(padapter) || \ ++ RTW_IS_FUNC_DISABLED((padapter), DF_IO_BIT)) ++ ++#define RTW_CANNOT_RX(padapter) \ ++ (RTW_CANNOT_RUN(padapter) || \ ++ RTW_IS_FUNC_DISABLED((padapter), DF_RX_BIT)) ++ ++#define RTW_CANNOT_TX(padapter) \ ++ (RTW_CANNOT_RUN(padapter) || \ ++ RTW_IS_FUNC_DISABLED((padapter), DF_TX_BIT)) ++ ++#ifdef CONFIG_PNO_SUPPORT ++int rtw_parse_ssid_list_tlv(char **list_str, pno_ssid_t *ssid, int max, int *bytes_left); ++int rtw_dev_pno_set(struct net_device *net, pno_ssid_t *ssid, int num, ++ int pno_time, int pno_repeat, int pno_freq_expo_max); ++#ifdef CONFIG_PNO_SET_DEBUG ++ void rtw_dev_pno_debug(struct net_device *net); ++#endif /* CONFIG_PNO_SET_DEBUG */ ++#endif /* CONFIG_PNO_SUPPORT */ ++ ++int rtw_suspend_free_assoc_resource(_adapter *padapter); ++#ifdef CONFIG_WOWLAN ++ int rtw_suspend_wow(_adapter *padapter); ++ int rtw_resume_process_wow(_adapter *padapter); ++#endif ++ ++/* HCI Related header file */ ++#ifdef CONFIG_USB_HCI ++ #include ++ #include ++ #include ++#endif ++ ++#ifdef CONFIG_SDIO_HCI ++ #include ++ #include ++ #include ++#endif ++ ++#ifdef CONFIG_GSPI_HCI ++ #include ++ #include ++ #include ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ #include ++ #include ++ #include ++#endif ++ ++#endif /* __DRV_TYPES_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types_linux.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_linux.h +--- linux-4.14.18/3rdparty/rtl8723de/include/drv_types_linux.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_linux.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,24 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __DRV_TYPES_LINUX_H__ ++#define __DRV_TYPES_LINUX_H__ ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types_pci.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_pci.h +--- linux-4.14.18/3rdparty/rtl8723de/include/drv_types_pci.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_pci.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,271 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __DRV_TYPES_PCI_H__ ++#define __DRV_TYPES_PCI_H__ ++ ++ ++#ifdef PLATFORM_LINUX ++ #include ++#endif ++ ++ ++#define INTEL_VENDOR_ID 0x8086 ++#define SIS_VENDOR_ID 0x1039 ++#define ATI_VENDOR_ID 0x1002 ++#define ATI_DEVICE_ID 0x7914 ++#define AMD_VENDOR_ID 0x1022 ++ ++#define PCI_MAX_BRIDGE_NUMBER 255 ++#define PCI_MAX_DEVICES 32 ++#define PCI_MAX_FUNCTION 8 ++ ++#define PCI_CONF_ADDRESS 0x0CF8 /* PCI Configuration Space Address */ ++#define PCI_CONF_DATA 0x0CFC /* PCI Configuration Space Data */ ++ ++#define PCI_CLASS_BRIDGE_DEV 0x06 ++#define PCI_SUBCLASS_BR_PCI_TO_PCI 0x04 ++ ++#define PCI_CAPABILITY_ID_PCI_EXPRESS 0x10 ++ ++#define U1DONTCARE 0xFF ++#define U2DONTCARE 0xFFFF ++#define U4DONTCARE 0xFFFFFFFF ++ ++#define PCI_VENDER_ID_REALTEK 0x10ec ++ ++#define HAL_HW_PCI_8180_DEVICE_ID 0x8180 ++#define HAL_HW_PCI_8185_DEVICE_ID 0x8185 /* 8185 or 8185b */ ++#define HAL_HW_PCI_8188_DEVICE_ID 0x8188 /* 8185b */ ++#define HAL_HW_PCI_8198_DEVICE_ID 0x8198 /* 8185b */ ++#define HAL_HW_PCI_8190_DEVICE_ID 0x8190 /* 8190 */ ++#define HAL_HW_PCI_8723E_DEVICE_ID 0x8723 /* 8723E */ ++#define HAL_HW_PCI_8192_DEVICE_ID 0x8192 /* 8192 PCI-E */ ++#define HAL_HW_PCI_8192SE_DEVICE_ID 0x8192 /* 8192 SE */ ++#define HAL_HW_PCI_8174_DEVICE_ID 0x8174 /* 8192 SE */ ++#define HAL_HW_PCI_8173_DEVICE_ID 0x8173 /* 8191 SE Crab */ ++#define HAL_HW_PCI_8172_DEVICE_ID 0x8172 /* 8191 SE RE */ ++#define HAL_HW_PCI_8171_DEVICE_ID 0x8171 /* 8191 SE Unicron */ ++#define HAL_HW_PCI_0045_DEVICE_ID 0x0045 /* 8190 PCI for Ceraga */ ++#define HAL_HW_PCI_0046_DEVICE_ID 0x0046 /* 8190 Cardbus for Ceraga */ ++#define HAL_HW_PCI_0044_DEVICE_ID 0x0044 /* 8192e PCIE for Ceraga */ ++#define HAL_HW_PCI_0047_DEVICE_ID 0x0047 /* 8192e Express Card for Ceraga */ ++#define HAL_HW_PCI_700F_DEVICE_ID 0x700F ++#define HAL_HW_PCI_701F_DEVICE_ID 0x701F ++#define HAL_HW_PCI_DLINK_DEVICE_ID 0x3304 ++#define HAL_HW_PCI_8188EE_DEVICE_ID 0x8179 ++ ++#define HAL_MEMORY_MAPPED_IO_RANGE_8190PCI 0x1000 /* 8190 support 16 pages of IO registers */ ++#define HAL_HW_PCI_REVISION_ID_8190PCI 0x00 ++#define HAL_MEMORY_MAPPED_IO_RANGE_8192PCIE 0x4000 /* 8192 support 16 pages of IO registers */ ++#define HAL_HW_PCI_REVISION_ID_8192PCIE 0x01 ++#define HAL_MEMORY_MAPPED_IO_RANGE_8192SE 0x4000 /* 8192 support 16 pages of IO registers */ ++#define HAL_HW_PCI_REVISION_ID_8192SE 0x10 ++#define HAL_HW_PCI_REVISION_ID_8192CE 0x1 ++#define HAL_MEMORY_MAPPED_IO_RANGE_8192CE 0x4000 /* 8192 support 16 pages of IO registers */ ++#define HAL_HW_PCI_REVISION_ID_8192DE 0x0 ++#define HAL_MEMORY_MAPPED_IO_RANGE_8192DE 0x4000 /* 8192 support 16 pages of IO registers */ ++ ++enum pci_bridge_vendor { ++ PCI_BRIDGE_VENDOR_INTEL = 0x0,/* 0b'0000,0001 */ ++ PCI_BRIDGE_VENDOR_ATI, /* = 0x02, */ /* 0b'0000,0010 */ ++ PCI_BRIDGE_VENDOR_AMD, /* = 0x04, */ /* 0b'0000,0100 */ ++ PCI_BRIDGE_VENDOR_SIS ,/* = 0x08, */ /* 0b'0000,1000 */ ++ PCI_BRIDGE_VENDOR_UNKNOWN, /* = 0x40, */ /* 0b'0100,0000 */ ++ PCI_BRIDGE_VENDOR_MAX ,/* = 0x80 */ ++} ; ++ ++/* copy this data structor defination from MSDN SDK */ ++typedef struct _PCI_COMMON_CONFIG { ++ u16 VendorID; ++ u16 DeviceID; ++ u16 Command; ++ u16 Status; ++ u8 RevisionID; ++ u8 ProgIf; ++ u8 SubClass; ++ u8 BaseClass; ++ u8 CacheLineSize; ++ u8 LatencyTimer; ++ u8 HeaderType; ++ u8 BIST; ++ ++ union { ++ struct _PCI_HEADER_TYPE_0 { ++ u32 BaseAddresses[6]; ++ u32 CIS; ++ u16 SubVendorID; ++ u16 SubSystemID; ++ u32 ROMBaseAddress; ++ u8 CapabilitiesPtr; ++ u8 Reserved1[3]; ++ u32 Reserved2; ++ ++ u8 InterruptLine; ++ u8 InterruptPin; ++ u8 MinimumGrant; ++ u8 MaximumLatency; ++ } type0; ++#if 0 ++ struct _PCI_HEADER_TYPE_1 { ++ ULONG BaseAddresses[PCI_TYPE1_ADDRESSES]; ++ UCHAR PrimaryBusNumber; ++ UCHAR SecondaryBusNumber; ++ UCHAR SubordinateBusNumber; ++ UCHAR SecondaryLatencyTimer; ++ UCHAR IOBase; ++ UCHAR IOLimit; ++ USHORT SecondaryStatus; ++ USHORT MemoryBase; ++ USHORT MemoryLimit; ++ USHORT PrefetchableMemoryBase; ++ USHORT PrefetchableMemoryLimit; ++ ULONG PrefetchableMemoryBaseUpper32; ++ ULONG PrefetchableMemoryLimitUpper32; ++ USHORT IOBaseUpper; ++ USHORT IOLimitUpper; ++ ULONG Reserved2; ++ ULONG ExpansionROMBase; ++ UCHAR InterruptLine; ++ UCHAR InterruptPin; ++ USHORT BridgeControl; ++ } type1; ++ ++ struct _PCI_HEADER_TYPE_2 { ++ ULONG BaseAddress; ++ UCHAR CapabilitiesPtr; ++ UCHAR Reserved2; ++ USHORT SecondaryStatus; ++ UCHAR PrimaryBusNumber; ++ UCHAR CardbusBusNumber; ++ UCHAR SubordinateBusNumber; ++ UCHAR CardbusLatencyTimer; ++ ULONG MemoryBase0; ++ ULONG MemoryLimit0; ++ ULONG MemoryBase1; ++ ULONG MemoryLimit1; ++ USHORT IOBase0_LO; ++ USHORT IOBase0_HI; ++ USHORT IOLimit0_LO; ++ USHORT IOLimit0_HI; ++ USHORT IOBase1_LO; ++ USHORT IOBase1_HI; ++ USHORT IOLimit1_LO; ++ USHORT IOLimit1_HI; ++ UCHAR InterruptLine; ++ UCHAR InterruptPin; ++ USHORT BridgeControl; ++ USHORT SubVendorID; ++ USHORT SubSystemID; ++ ULONG LegacyBaseAddress; ++ UCHAR Reserved3[56]; ++ ULONG SystemControl; ++ UCHAR MultiMediaControl; ++ UCHAR GeneralStatus; ++ UCHAR Reserved4[2]; ++ UCHAR GPIO0Control; ++ UCHAR GPIO1Control; ++ UCHAR GPIO2Control; ++ UCHAR GPIO3Control; ++ ULONG IRQMuxRouting; ++ UCHAR RetryStatus; ++ UCHAR CardControl; ++ UCHAR DeviceControl; ++ UCHAR Diagnostic; ++ } type2; ++#endif ++ } u; ++ ++ u8 DeviceSpecific[108]; ++} PCI_COMMON_CONFIG , *PPCI_COMMON_CONFIG; ++ ++typedef struct _RT_PCI_CAPABILITIES_HEADER { ++ u8 CapabilityID; ++ u8 Next; ++} RT_PCI_CAPABILITIES_HEADER, *PRT_PCI_CAPABILITIES_HEADER; ++ ++struct pci_priv { ++ BOOLEAN pci_clk_req; ++ ++ u8 pciehdr_offset; ++ /* PCIeCap is only differece between B-cut and C-cut. */ ++ /* Configuration Space offset 72[7:4] */ ++ /* 0: A/B cut */ ++ /* 1: C cut and later. */ ++ u8 pcie_cap; ++ u8 linkctrl_reg; ++ ++ u8 busnumber; ++ u8 devnumber; ++ u8 funcnumber; ++ ++ u8 pcibridge_busnum; ++ u8 pcibridge_devnum; ++ u8 pcibridge_funcnum; ++ u8 pcibridge_vendor; ++ u16 pcibridge_vendorid; ++ u16 pcibridge_deviceid; ++ u8 pcibridge_pciehdr_offset; ++ u8 pcibridge_linkctrlreg; ++ ++ u8 amd_l1_patch; ++}; ++ ++typedef struct _RT_ISR_CONTENT { ++ union { ++ u32 IntArray[2]; ++ u32 IntReg4Byte; ++ u16 IntReg2Byte; ++ }; ++} RT_ISR_CONTENT, *PRT_ISR_CONTENT; ++ ++/* #define RegAddr(addr) (addr + 0xB2000000UL) */ ++/* some platform macros will def here */ ++static inline void NdisRawWritePortUlong(u32 port, u32 val) ++{ ++ outl(val, port); ++ /* writel(val, (u8 *)RegAddr(port)); */ ++} ++ ++static inline void NdisRawWritePortUchar(u32 port, u8 val) ++{ ++ outb(val, port); ++ /* writeb(val, (u8 *)RegAddr(port)); */ ++} ++ ++static inline void NdisRawReadPortUchar(u32 port, u8 *pval) ++{ ++ *pval = inb(port); ++ /* *pval = readb((u8 *)RegAddr(port)); */ ++} ++ ++static inline void NdisRawReadPortUshort(u32 port, u16 *pval) ++{ ++ *pval = inw(port); ++ /* *pval = readw((u8 *)RegAddr(port)); */ ++} ++ ++static inline void NdisRawReadPortUlong(u32 port, u32 *pval) ++{ ++ *pval = inl(port); ++ /* *pval = readl((u8 *)RegAddr(port)); */ ++} ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types_sdio.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_sdio.h +--- linux-4.14.18/3rdparty/rtl8723de/include/drv_types_sdio.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_sdio.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,91 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __DRV_TYPES_SDIO_H__ ++#define __DRV_TYPES_SDIO_H__ ++ ++/* SDIO Header Files */ ++#ifdef PLATFORM_LINUX ++ #include ++ #include ++ #include ++ #include ++ ++ #ifdef CONFIG_PLATFORM_SPRD ++ #include ++ #include ++ #endif /* CONFIG_PLATFORM_SPRD */ ++#endif ++ ++#ifdef PLATFORM_OS_XP ++ #include ++ #include ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ #include ++#endif ++ ++ ++typedef struct sdio_data { ++ u8 func_number; ++ ++ u8 tx_block_mode; ++ u8 rx_block_mode; ++ u32 block_transfer_len; ++ ++#ifdef PLATFORM_LINUX ++ struct sdio_func *func; ++ _thread_hdl_ sys_sdio_irq_thd; ++ unsigned int clock; ++#endif ++ ++#ifdef PLATFORM_OS_XP ++ PDEVICE_OBJECT pphysdevobj; ++ PDEVICE_OBJECT pfuncdevobj; ++ PDEVICE_OBJECT pnextdevobj; ++ SDBUS_INTERFACE_STANDARD sdbusinft; ++ u8 nextdevstacksz; ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ SD_DEVICE_HANDLE hDevice; ++ SD_CARD_RCA sd_rca; ++ SD_CARD_INTERFACE card_intf; ++ BOOLEAN enableIsarWithStatus; ++ WCHAR active_path[MAX_ACTIVE_REG_PATH]; ++ SD_HOST_BLOCK_CAPABILITY sd_host_blk_cap; ++#endif ++} SDIO_DATA, *PSDIO_DATA; ++ ++#define dvobj_to_sdio_func(d) ((d)->intf_data.func) ++ ++#define RTW_SDIO_ADDR_CMD52_BIT (1<<17) ++#define RTW_SDIO_ADDR_CMD52_GEN(a) (a | RTW_SDIO_ADDR_CMD52_BIT) ++#define RTW_SDIO_ADDR_CMD52_CLR(a) (a&~RTW_SDIO_ADDR_CMD52_BIT) ++#define RTW_SDIO_ADDR_CMD52_CHK(a) (a&RTW_SDIO_ADDR_CMD52_BIT ? 1 : 0) ++ ++#define RTW_SDIO_ADDR_F0_BIT (1<<18) ++#define RTW_SDIO_ADDR_F0_GEN(a) (a | RTW_SDIO_ADDR_F0_BIT) ++#define RTW_SDIO_ADDR_F0_CLR(a) (a&~RTW_SDIO_ADDR_F0_BIT) ++#define RTW_SDIO_ADDR_F0_CHK(a) (a&RTW_SDIO_ADDR_F0_BIT ? 1 : 0) ++ ++#define RTW_SDIO_CLK_40M 40000000 ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types_xp.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_xp.h +--- linux-4.14.18/3rdparty/rtl8723de/include/drv_types_xp.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_xp.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,93 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __DRV_TYPES_XP_H__ ++#define __DRV_TYPES_XP_H__ ++ ++#include ++#include ++ ++ ++ ++#define MAX_MCAST_LIST_NUM 32 ++ ++ ++ ++/* for ioctl */ ++#define MAKE_DRIVER_VERSION(_MainVer, _MinorVer) ((((u32)(_MainVer))<<16)+_MinorVer) ++ ++#define NIC_HEADER_SIZE 14 /* !< can be moved to typedef.h */ ++#define NIC_MAX_PACKET_SIZE 1514 /* !< can be moved to typedef.h */ ++#define NIC_MAX_SEND_PACKETS 10 /* max number of send packets the MiniportSendPackets function can accept, can be moved to typedef.h */ ++#define NIC_VENDOR_DRIVER_VERSION MAKE_DRIVER_VERSION(0, 001) /* !< can be moved to typedef.h */ ++#define NIC_MAX_PACKET_SIZE 1514 /* !< can be moved to typedef.h */ ++ ++ ++#undef ON_VISTA ++/* added by Jackson */ ++#ifndef ON_VISTA ++ /* ++ * Bus driver versions ++ * */ ++ ++ #define SDBUS_DRIVER_VERSION_1 0x100 ++ #define SDBUS_DRIVER_VERSION_2 0x200 ++ ++ #define SDP_FUNCTION_TYPE 4 ++ #define SDP_BUS_DRIVER_VERSION 5 ++ #define SDP_BUS_WIDTH 6 ++ #define SDP_BUS_CLOCK 7 ++ #define SDP_BUS_INTERFACE_CONTROL 8 ++ #define SDP_HOST_BLOCK_LENGTH 9 ++ #define SDP_FUNCTION_BLOCK_LENGTH 10 ++ #define SDP_FN0_BLOCK_LENGTH 11 ++ #define SDP_FUNCTION_INT_ENABLE 12 ++#endif ++ ++ ++typedef struct _MP_REG_ENTRY { ++ ++ NDIS_STRING RegName; /* variable name text */ ++ BOOLEAN bRequired; /* 1->required, 0->optional */ ++ ++ u8 Type; /* NdisParameterInteger/NdisParameterHexInteger/NdisParameterStringle/NdisParameterMultiString */ ++ uint FieldOffset; /* offset to MP_ADAPTER field */ ++ uint FieldSize; /* size (in bytes) of the field */ ++ ++#ifdef UNDER_AMD64 ++ u64 Default; ++#else ++ u32 Default; /* default value to use */ ++#endif ++ ++ u32 Min; /* minimum value allowed */ ++ u32 Max; /* maximum value allowed */ ++} MP_REG_ENTRY, *PMP_REG_ENTRY; ++ ++ ++typedef struct _OCTET_STRING { ++ u8 *Octet; ++ u16 Length; ++} OCTET_STRING, *POCTET_STRING; ++ ++ ++ ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/ethernet.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/ethernet.h +--- linux-4.14.18/3rdparty/rtl8723de/include/ethernet.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/ethernet.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,41 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++/*! \file */ ++#ifndef __INC_ETHERNET_H ++#define __INC_ETHERNET_H ++ ++#define ETHERNET_ADDRESS_LENGTH 6 /* !< Ethernet Address Length */ ++#define ETHERNET_HEADER_SIZE 14 /* !< Ethernet Header Length */ ++#define LLC_HEADER_SIZE 6 /* !< LLC Header Length */ ++#define TYPE_LENGTH_FIELD_SIZE 2 /* !< Type/Length Size */ ++#define MINIMUM_ETHERNET_PACKET_SIZE 60 /* !< Minimum Ethernet Packet Size */ ++#define MAXIMUM_ETHERNET_PACKET_SIZE 1514 /* !< Maximum Ethernet Packet Size */ ++ ++#define RT_ETH_IS_MULTICAST(_pAddr) ((((UCHAR *)(_pAddr))[0]&0x01) != 0) /* !< Is Multicast Address? */ ++#define RT_ETH_IS_BROADCAST(_pAddr) (\ ++ ((UCHAR *)(_pAddr))[0] == 0xff && \ ++ ((UCHAR *)(_pAddr))[1] == 0xff && \ ++ ((UCHAR *)(_pAddr))[2] == 0xff && \ ++ ((UCHAR *)(_pAddr))[3] == 0xff && \ ++ ((UCHAR *)(_pAddr))[4] == 0xff && \ ++ ((UCHAR *)(_pAddr))[5] == 0xff) /* !< Is Broadcast Address? */ ++ ++ ++#endif /* #ifndef __INC_ETHERNET_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/gspi_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/gspi_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_hal.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,35 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __GSPI_HAL_H__ ++#define __GSPI_HAL_H__ ++ ++ ++void spi_int_dpc(PADAPTER padapter, u32 sdio_hisr); ++u8 rtw_set_hal_ops(_adapter *padapter); ++ ++#ifdef CONFIG_RTL8188E ++ void rtl8188es_set_hal_ops(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_RTL8723B ++ void rtl8723bs_set_hal_ops(PADAPTER padapter); ++#endif ++ ++#endif /* __GSPI_HAL_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/gspi_ops.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_ops.h +--- linux-4.14.18/3rdparty/rtl8723de/include/gspi_ops.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_ops.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,185 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __GSPI_OPS_H__ ++#define __GSPI_OPS_H__ ++ ++/* follwing defination is based on ++ * GSPI spec of RTL8723, we temp ++ * suppose that it will be the same ++ * for diff chips of GSPI, if not ++ * we should move it to HAL folder */ ++#define SPI_LOCAL_DOMAIN 0x0 ++#define WLAN_IOREG_DOMAIN 0x8 ++#define FW_FIFO_DOMAIN 0x4 ++#define TX_HIQ_DOMAIN 0xc ++#define TX_MIQ_DOMAIN 0xd ++#define TX_LOQ_DOMAIN 0xe ++#define RX_RXFIFO_DOMAIN 0x1f ++ ++/* IO Bus domain address mapping */ ++#define DEFUALT_OFFSET 0x0 ++#define SPI_LOCAL_OFFSET 0x10250000 ++#define WLAN_IOREG_OFFSET 0x10260000 ++#define FW_FIFO_OFFSET 0x10270000 ++#define TX_HIQ_OFFSET 0x10310000 ++#define TX_MIQ_OFFSET 0x1032000 ++#define TX_LOQ_OFFSET 0x10330000 ++#define RX_RXOFF_OFFSET 0x10340000 ++ ++/* SPI Local registers */ ++#define SPI_REG_TX_CTRL 0x0000 /* SPI Tx Control */ ++#define SPI_REG_STATUS_RECOVERY 0x0004 ++#define SPI_REG_INT_TIMEOUT 0x0006 ++#define SPI_REG_HIMR 0x0014 /* SPI Host Interrupt Mask */ ++#define SPI_REG_HISR 0x0018 /* SPI Host Interrupt Service Routine */ ++#define SPI_REG_RX0_REQ_LEN 0x001C /* RXDMA Request Length */ ++#define SPI_REG_FREE_TXPG 0x0020 /* Free Tx Buffer Page */ ++#define SPI_REG_HCPWM1 0x0024 /* HCI Current Power Mode 1 */ ++#define SPI_REG_HCPWM2 0x0026 /* HCI Current Power Mode 2 */ ++#define SPI_REG_HTSFR_INFO 0x0030 /* HTSF Informaion */ ++#define SPI_REG_HRPWM1 0x0080 /* HCI Request Power Mode 1 */ ++#define SPI_REG_HRPWM2 0x0082 /* HCI Request Power Mode 2 */ ++#define SPI_REG_HPS_CLKR 0x0084 /* HCI Power Save Clock */ ++#define SPI_REG_HSUS_CTRL 0x0086 /* SPI HCI Suspend Control */ ++#define SPI_REG_HIMR_ON 0x0090 /* SPI Host Extension Interrupt Mask Always */ ++#define SPI_REG_HISR_ON 0x0091 /* SPI Host Extension Interrupt Status Always */ ++#define SPI_REG_CFG 0x00F0 /* SPI Configuration Register */ ++ ++#define SPI_TX_CTRL (SPI_REG_TX_CTRL | SPI_LOCAL_OFFSET) ++#define SPI_STATUS_RECOVERY (SPI_REG_STATUS_RECOVERY | SPI_LOCAL_OFFSET) ++#define SPI_INT_TIMEOUT (SPI_REG_INT_TIMEOUT | SPI_LOCAL_OFFSET) ++#define SPI_HIMR (SPI_REG_HIMR | SPI_LOCAL_OFFSET) ++#define SPI_HISR (SPI_REG_HISR | SPI_LOCAL_OFFSET) ++#define SPI_RX0_REQ_LEN_1_BYTE (SPI_REG_RX0_REQ_LEN | SPI_LOCAL_OFFSET) ++#define SPI_FREE_TXPG (SPI_REG_FREE_TXPG | SPI_LOCAL_OFFSET) ++ ++#define SPI_HIMR_DISABLED 0 ++ ++/* SPI HIMR MASK diff with SDIO */ ++#define SPI_HISR_RX_REQUEST BIT(0) ++#define SPI_HISR_AVAL BIT(1) ++#define SPI_HISR_TXERR BIT(2) ++#define SPI_HISR_RXERR BIT(3) ++#define SPI_HISR_TXFOVW BIT(4) ++#define SPI_HISR_RXFOVW BIT(5) ++#define SPI_HISR_TXBCNOK BIT(6) ++#define SPI_HISR_TXBCNERR BIT(7) ++#define SPI_HISR_BCNERLY_INT BIT(16) ++#define SPI_HISR_ATIMEND BIT(17) ++#define SPI_HISR_ATIMEND_E BIT(18) ++#define SPI_HISR_CTWEND BIT(19) ++#define SPI_HISR_C2HCMD BIT(20) ++#define SPI_HISR_CPWM1 BIT(21) ++#define SPI_HISR_CPWM2 BIT(22) ++#define SPI_HISR_HSISR_IND BIT(23) ++#define SPI_HISR_GTINT3_IND BIT(24) ++#define SPI_HISR_GTINT4_IND BIT(25) ++#define SPI_HISR_PSTIMEOUT BIT(26) ++#define SPI_HISR_OCPINT BIT(27) ++#define SPI_HISR_TSF_BIT32_TOGGLE BIT(29) ++ ++#define MASK_SPI_HISR_CLEAR (SPI_HISR_TXERR |\ ++ SPI_HISR_RXERR |\ ++ SPI_HISR_TXFOVW |\ ++ SPI_HISR_RXFOVW |\ ++ SPI_HISR_TXBCNOK |\ ++ SPI_HISR_TXBCNERR |\ ++ SPI_HISR_C2HCMD |\ ++ SPI_HISR_CPWM1 |\ ++ SPI_HISR_CPWM2 |\ ++ SPI_HISR_HSISR_IND |\ ++ SPI_HISR_GTINT3_IND |\ ++ SPI_HISR_GTINT4_IND |\ ++ SPI_HISR_PSTIMEOUT |\ ++ SPI_HISR_OCPINT) ++ ++#define REG_LEN_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 0, 8, x)/* (x<<(unsigned int)24) */ ++#define REG_ADDR_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 8, 16, x)/* (x<<(unsigned int)16) */ ++#define REG_DOMAIN_ID_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 24, 5, x)/* (x<<(unsigned int)0) */ ++#define REG_FUN_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 29, 2, x)/* (x<<(unsigned int)5) */ ++#define REG_RW_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 31, 1, x)/* (x<<(unsigned int)7) */ ++ ++#define FIFO_LEN_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 0, 16, x)/* (x<<(unsigned int)24) ++ * #define FIFO_ADDR_FORMAT(pcmd,x) SET_BITS_TO_LE_4BYTE(pcmd, 8, 16, x) */ /* (x<<(unsigned int)16) */ ++#define FIFO_DOMAIN_ID_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 24, 5, x)/* (x<<(unsigned int)0) */ ++#define FIFO_FUN_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 29, 2, x)/* (x<<(unsigned int)5) */ ++#define FIFO_RW_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 31, 1, x)/* (x<<(unsigned int)7) */ ++ ++ ++/* get status dword0 */ ++#define GET_STATUS_PUB_PAGE_NUM(status) LE_BITS_TO_4BYTE(status, 24, 8) ++#define GET_STATUS_HI_PAGE_NUM(status) LE_BITS_TO_4BYTE(status, 18, 6) ++#define GET_STATUS_MID_PAGE_NUM(status) LE_BITS_TO_4BYTE(status, 12, 6) ++#define GET_STATUS_LOW_PAGE_NUM(status) LE_BITS_TO_4BYTE(status, 6, 6) ++#define GET_STATUS_HISR_HI6BIT(status) LE_BITS_TO_4BYTE(status, 0, 6) ++ ++/* get status dword1 */ ++#define GET_STATUS_HISR_MID8BIT(status) LE_BITS_TO_4BYTE(status + 4, 24, 8) ++#define GET_STATUS_HISR_LOW8BIT(status) LE_BITS_TO_4BYTE(status + 4, 16, 8) ++#define GET_STATUS_ERROR(status) LE_BITS_TO_4BYTE(status + 4, 17, 1) ++#define GET_STATUS_INT(status) LE_BITS_TO_4BYTE(status + 4, 16, 1) ++#define GET_STATUS_RX_LENGTH(status) LE_BITS_TO_4BYTE(status + 4, 0, 16) ++ ++ ++#define RXDESC_SIZE 24 ++ ++ ++struct spi_more_data { ++ unsigned long more_data; ++ unsigned long len; ++}; ++ ++#ifdef CONFIG_RTL8188E ++ void rtl8188es_set_hal_ops(PADAPTER padapter); ++ #define set_hal_ops rtl8188es_set_hal_ops ++#endif ++extern void spi_set_chip_endian(PADAPTER padapter); ++extern unsigned int spi_write8_endian(ADAPTER *Adapter, unsigned int addr, unsigned int buf, u32 big); ++extern void spi_set_intf_ops(_adapter *padapter, struct _io_ops *pops); ++extern void spi_set_chip_endian(PADAPTER padapter); ++extern void InitInterrupt8723ASdio(PADAPTER padapter); ++extern void InitSysInterrupt8723ASdio(PADAPTER padapter); ++extern void EnableInterrupt8723ASdio(PADAPTER padapter); ++extern void DisableInterrupt8723ASdio(PADAPTER padapter); ++extern void spi_int_hdl(PADAPTER padapter); ++extern u8 HalQueryTxBufferStatus8723ASdio(PADAPTER padapter); ++#ifdef CONFIG_RTL8723B ++ extern void InitInterrupt8723BSdio(PADAPTER padapter); ++ extern void InitSysInterrupt8723BSdio(PADAPTER padapter); ++ extern void EnableInterrupt8723BSdio(PADAPTER padapter); ++ extern void DisableInterrupt8723BSdio(PADAPTER padapter); ++ extern u8 HalQueryTxBufferStatus8723BSdio(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_RTL8188E ++ extern void InitInterrupt8188EGspi(PADAPTER padapter); ++ extern void EnableInterrupt8188EGspi(PADAPTER padapter); ++ extern void DisableInterrupt8188EGspi(PADAPTER padapter); ++ extern void UpdateInterruptMask8188EGspi(PADAPTER padapter, u32 AddMSR, u32 RemoveMSR); ++ extern u8 HalQueryTxBufferStatus8189EGspi(PADAPTER padapter); ++ extern u8 HalQueryTxOQTBufferStatus8189EGspi(PADAPTER padapter); ++ extern void ClearInterrupt8188EGspi(PADAPTER padapter); ++ extern u8 CheckIPSStatus(PADAPTER padapter); ++#endif /* CONFIG_RTL8188E */ ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++ extern u8 RecvOnePkt(PADAPTER padapter, u32 size); ++#endif /* CONFIG_WOWLAN */ ++ ++#endif /* __GSPI_OPS_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/gspi_ops_linux.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_ops_linux.h +--- linux-4.14.18/3rdparty/rtl8723de/include/gspi_ops_linux.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_ops_linux.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,23 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __SDIO_OPS_LINUX_H__ ++#define __SDIO_OPS_LINUX_H__ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/gspi_osintf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_osintf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/gspi_osintf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_osintf.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,30 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __SDIO_OSINTF_H__ ++#define __SDIO_OSINTF_H__ ++ ++ ++#ifdef PLATFORM_OS_CE ++ extern NDIS_STATUS ce_sd_get_dev_hdl(PADAPTER padapter); ++ SD_API_STATUS ce_sd_int_callback(SD_DEVICE_HANDLE hDevice, PADAPTER padapter); ++ extern void sd_setup_irs(PADAPTER padapter); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/h2clbk.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/h2clbk.h +--- linux-4.14.18/3rdparty/rtl8723de/include/h2clbk.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/h2clbk.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,31 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ ++#define _H2CLBK_H_ ++ ++ ++void _lbk_cmd(PADAPTER Adapter); ++ ++void _lbk_rsp(PADAPTER Adapter); ++ ++void _lbk_evt(IN PADAPTER Adapter); ++ ++void h2c_event_callback(unsigned char *dev, unsigned char *pbuf); +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8188EPhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188EPhyCfg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8188EPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188EPhyCfg.h 2018-02-11 21:44:27.164146345 +0200 +@@ -0,0 +1,265 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8188EPHYCFG_H__ ++#define __INC_HAL8188EPHYCFG_H__ ++ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++#define LOOP_LIMIT 5 ++#define MAX_STALL_TIME 50 /* us */ ++#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ ++#define MAX_TXPWR_IDX_NMODE_92S 63 ++#define Reset_Cnt_Limit 3 ++ ++#ifdef CONFIG_PCI_HCI ++ #define MAX_AGGR_NUM 0x0B ++#else ++ #define MAX_AGGR_NUM 0x07 ++#endif /* CONFIG_PCI_HCI */ ++ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++ ++ ++/*------------------------------Define structure----------------------------*/ ++ ++#define MAX_TX_COUNT_8188E 1 ++ ++/* BB/RF related */ ++ ++ ++/*------------------------------Define structure----------------------------*/ ++ ++ ++/*------------------------Export global variable----------------------------*/ ++/*------------------------Export global variable----------------------------*/ ++ ++ ++/*------------------------Export Marco Definition---------------------------*/ ++/*------------------------Export Marco Definition---------------------------*/ ++ ++ ++/*--------------------------Exported Function prototype---------------------*/ ++/* ++ * BB and RF register read/write ++ * */ ++u32 PHY_QueryBBReg8188E(IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask); ++void PHY_SetBBReg8188E(IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data); ++u32 PHY_QueryRFReg8188E(IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask); ++void PHY_SetRFReg8188E(IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data); ++ ++/* ++ * Initialization related function ++ */ ++/* MAC/BB/RF HAL config */ ++int PHY_MACConfig8188E(IN PADAPTER Adapter); ++int PHY_BBConfig8188E(IN PADAPTER Adapter); ++int PHY_RFConfig8188E(IN PADAPTER Adapter); ++ ++/* RF config */ ++int rtl8188e_PHY_ConfigRFWithParaFile(IN PADAPTER Adapter, IN u8 *pFileName, u8 eRFPath); ++ ++/* ++ * RF Power setting ++ */ ++/* extern BOOLEAN PHY_SetRFPowerState(IN PADAPTER Adapter, ++ * IN RT_RF_POWER_STATE eRFPowerState); */ ++ ++/* ++ * BB TX Power R/W ++ * */ ++void PHY_GetTxPowerLevel8188E(IN PADAPTER Adapter, ++ OUT s32 *powerlevel); ++void PHY_SetTxPowerLevel8188E(IN PADAPTER Adapter, ++ IN u8 channel); ++BOOLEAN PHY_UpdateTxPowerDbm8188E(IN PADAPTER Adapter, ++ IN int powerInDbm); ++ ++VOID ++PHY_SetTxPowerIndex_8188E( ++ IN PADAPTER Adapter, ++ IN u32 PowerIndex, ++ IN u8 RFPath, ++ IN u8 Rate ++); ++ ++u8 ++PHY_GetTxPowerIndex_8188E( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN u8 BandWidth, ++ IN u8 Channel, ++ struct txpwr_idx_comp *tic ++); ++ ++/* ++ * Switch bandwidth for 8192S ++ */ ++/* extern void PHY_SetBWModeCallback8192C( IN PRT_TIMER pTimer ); */ ++void PHY_SetBWMode8188E(IN PADAPTER pAdapter, ++ IN CHANNEL_WIDTH ChnlWidth, ++ IN unsigned char Offset); ++ ++/* ++ * Set FW CMD IO for 8192S. ++ */ ++/* extern BOOLEAN HalSetIO8192C( IN PADAPTER Adapter, ++ * IN IO_TYPE IOType); */ ++ ++/* ++ * Set A2 entry to fw for 8192S ++ * */ ++extern void FillA2Entry8192C(IN PADAPTER Adapter, ++ IN u8 index, ++ IN u8 *val); ++ ++ ++/* ++ * channel switch related funciton ++ */ ++/* extern void PHY_SwChnlCallback8192C( IN PRT_TIMER pTimer ); */ ++void PHY_SwChnl8188E(IN PADAPTER pAdapter, ++ IN u8 channel); ++ ++VOID ++PHY_SetSwChnlBWMode8188E( ++ IN PADAPTER Adapter, ++ IN u8 channel, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 Offset40, ++ IN u8 Offset80 ++); ++ ++VOID ++PHY_SetRFEReg_8188E( ++ IN PADAPTER Adapter ++); ++/* ++ * BB/MAC/RF other monitor API ++ * */ ++VOID PHY_SetRFPathSwitch_8188E(IN PADAPTER pAdapter, IN BOOLEAN bMain); ++ ++extern VOID ++PHY_SwitchEphyParameter( ++ IN PADAPTER Adapter ++); ++ ++extern VOID ++PHY_EnableHostClkReq( ++ IN PADAPTER Adapter ++); ++ ++BOOLEAN ++SetAntennaConfig92C( ++ IN PADAPTER Adapter, ++ IN u8 DefaultAnt ++); ++ ++/*--------------------------Exported Function prototype---------------------*/ ++ ++/* ++ * Initialization related function ++ * ++ * MAC/BB/RF HAL config */ ++/* extern s32 PHY_MACConfig8723(PADAPTER padapter); ++ * s32 PHY_BBConfig8723(PADAPTER padapter); ++ * s32 PHY_RFConfig8723(PADAPTER padapter); */ ++ ++ ++ ++/* ****************************************************************** ++ * Note: If SIC_ENABLE under PCIE, because of the slow operation ++ * you should ++ * 2) "#define RTL8723_FPGA_VERIFICATION 1" in Precomp.h.WlanE.Windows ++ * 3) "#define RTL8190_Download_Firmware_From_Header 0" in Precomp.h.WlanE.Windows if needed. ++ * */ ++#if (RTL8188E_SUPPORT == 1) && (RTL8188E_FPGA_TRUE_PHY_VERIFICATION == 1) ++ #define SIC_ENABLE 1 ++ #define SIC_HW_SUPPORT 1 ++#else ++ #define SIC_ENABLE 0 ++ #define SIC_HW_SUPPORT 0 ++#endif ++/* ****************************************************************** */ ++ ++ ++#define SIC_MAX_POLL_CNT 5 ++ ++#if (SIC_HW_SUPPORT == 1) ++ #define SIC_CMD_READY 0 ++ #define SIC_CMD_PREWRITE 0x1 ++ #if (RTL8188E_SUPPORT == 1) ++ #define SIC_CMD_WRITE 0x40 ++ #define SIC_CMD_PREREAD 0x2 ++ #define SIC_CMD_READ 0x80 ++ #define SIC_CMD_INIT 0xf0 ++ #define SIC_INIT_VAL 0xff ++ ++ #define SIC_INIT_REG 0x1b7 ++ #define SIC_CMD_REG 0x1EB /* 1byte */ ++ #define SIC_ADDR_REG 0x1E8 /* 1b4~1b5, 2 bytes */ ++ #define SIC_DATA_REG 0x1EC /* 1b0~1b3 */ ++ #else ++ #define SIC_CMD_WRITE 0x11 ++ #define SIC_CMD_PREREAD 0x2 ++ #define SIC_CMD_READ 0x12 ++ #define SIC_CMD_INIT 0x1f ++ #define SIC_INIT_VAL 0xff ++ ++ #define SIC_INIT_REG 0x1b7 ++ #define SIC_CMD_REG 0x1b6 /* 1byte */ ++ #define SIC_ADDR_REG 0x1b4 /* 1b4~1b5, 2 bytes */ ++ #define SIC_DATA_REG 0x1b0 /* 1b0~1b3 */ ++ #endif ++#else ++ #define SIC_CMD_READY 0 ++ #define SIC_CMD_WRITE 1 ++ #define SIC_CMD_READ 2 ++ ++ #if (RTL8188E_SUPPORT == 1) ++ #define SIC_CMD_REG 0x1EB /* 1byte */ ++ #define SIC_ADDR_REG 0x1E8 /* 1b9~1ba, 2 bytes */ ++ #define SIC_DATA_REG 0x1EC /* 1bc~1bf */ ++ #else ++ #define SIC_CMD_REG 0x1b8 /* 1byte */ ++ #define SIC_ADDR_REG 0x1b9 /* 1b9~1ba, 2 bytes */ ++ #define SIC_DATA_REG 0x1bc /* 1bc~1bf */ ++ #endif ++#endif ++ ++#if (SIC_ENABLE == 1) ++ VOID SIC_Init(IN PADAPTER Adapter); ++#endif ++ ++ ++#endif /* __INC_HAL8192CPHYCFG_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8188EPhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188EPhyReg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8188EPhyReg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188EPhyReg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,1105 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8188EPHYREG_H__ ++#define __INC_HAL8188EPHYREG_H__ ++/*--------------------------Define Parameters-------------------------------*/ ++/* ++ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 ++ * 3. RF register 0x00-2E ++ * 4. Bit Mask for BB/RF register ++ * 5. Other defintion for BB/RF R/W ++ * */ ++ ++ ++/* ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 1. Page1(0x100) ++ * */ ++#define rPMAC_Reset 0x100 ++#define rPMAC_TxStart 0x104 ++#define rPMAC_TxLegacySIG 0x108 ++#define rPMAC_TxHTSIG1 0x10c ++#define rPMAC_TxHTSIG2 0x110 ++#define rPMAC_PHYDebug 0x114 ++#define rPMAC_TxPacketNum 0x118 ++#define rPMAC_TxIdle 0x11c ++#define rPMAC_TxMACHeader0 0x120 ++#define rPMAC_TxMACHeader1 0x124 ++#define rPMAC_TxMACHeader2 0x128 ++#define rPMAC_TxMACHeader3 0x12c ++#define rPMAC_TxMACHeader4 0x130 ++#define rPMAC_TxMACHeader5 0x134 ++#define rPMAC_TxDataType 0x138 ++#define rPMAC_TxRandomSeed 0x13c ++#define rPMAC_CCKPLCPPreamble 0x140 ++#define rPMAC_CCKPLCPHeader 0x144 ++#define rPMAC_CCKCRC16 0x148 ++#define rPMAC_OFDMRxCRC32OK 0x170 ++#define rPMAC_OFDMRxCRC32Er 0x174 ++#define rPMAC_OFDMRxParityEr 0x178 ++#define rPMAC_OFDMRxCRC8Er 0x17c ++#define rPMAC_CCKCRxRC16Er 0x180 ++#define rPMAC_CCKCRxRC32Er 0x184 ++#define rPMAC_CCKCRxRC32OK 0x188 ++#define rPMAC_TxStatus 0x18c ++ ++/* ++ * 2. Page2(0x200) ++ * ++ * The following two definition are only used for USB interface. */ ++#define RF_BB_CMD_ADDR 0x02c0 /* RF/BB read/write command address. */ ++#define RF_BB_CMD_DATA 0x02c4 /* RF/BB read/write command data. */ ++ ++/* ++ * 3. Page8(0x800) ++ * */ ++#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ ++ ++#define rFPGA0_TxInfo 0x804 /* Status report?? */ ++#define rFPGA0_PSDFunction 0x808 ++ ++#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ ++ ++#define rFPGA0_RFTiming1 0x810 /* Useless now */ ++#define rFPGA0_RFTiming2 0x814 ++ ++#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ ++#define rFPGA0_XA_HSSIParameter2 0x824 ++#define rFPGA0_XB_HSSIParameter1 0x828 ++#define rFPGA0_XB_HSSIParameter2 0x82c ++ ++#define rFPGA0_XA_LSSIParameter 0x840 ++#define rFPGA0_XB_LSSIParameter 0x844 ++ ++#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ ++#define rFPGA0_RFSleepUpParameter 0x854 ++ ++#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ ++#define rFPGA0_XCD_SwitchControl 0x85c ++ ++#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ ++#define rFPGA0_XB_RFInterfaceOE 0x864 ++#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ ++#define rFPGA0_XCD_RFInterfaceSW 0x874 ++ ++#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ ++#define rFPGA0_XCD_RFParameter 0x87c ++ ++#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ ++#define rFPGA0_AnalogParameter2 0x884 ++#define rFPGA0_AnalogParameter3 0x888 ++#define rFPGA0_AdDaClockEn 0x888 /* enable ad/da clock1 for dual-phy */ ++#define rFPGA0_AnalogParameter4 0x88c ++ ++#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ ++#define rFPGA0_XB_LSSIReadBack 0x8a4 ++#define rFPGA0_XC_LSSIReadBack 0x8a8 ++#define rFPGA0_XD_LSSIReadBack 0x8ac ++ ++#define rFPGA0_PSDReport 0x8b4 /* Useless now */ ++#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ ++#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ ++#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ ++#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ ++ ++/* ++ * 4. Page9(0x900) ++ * */ ++#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ ++ ++#define rFPGA1_TxBlock 0x904 /* Useless now */ ++#define rFPGA1_DebugSelect 0x908 /* Useless now */ ++#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ ++ ++/* ++ * 5. PageA(0xA00) ++ * ++ * Set Control channel to upper or lower. These settings are required only for 40MHz */ ++#define rCCK0_System 0xa00 ++ ++#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ ++#define rCCK0_CCA 0xa08 /* Disable init gain now */ /* Init gain */ ++ ++#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level */ /* Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ ++#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ ++ ++#define rCCK0_RxHP 0xa14 ++ ++#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ ++#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ ++ ++#define rCCK0_TxFilter1 0xa20 ++#define rCCK0_TxFilter2 0xa24 ++#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ ++#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ ++#define rCCK0_TRSSIReport 0xa50 ++#define rCCK0_RxReport 0xa54 /* 0xa57 */ ++#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ ++#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ ++ ++/* ++ * PageB(0xB00) ++ * */ ++#define rPdp_AntA 0xb00 ++#define rPdp_AntA_4 0xb04 ++#define rConfig_Pmpd_AntA 0xb28 ++#define rConfig_ram64x16 0xb2c ++#define rConfig_AntA 0xb68 ++#define rConfig_AntB 0xb6c ++#define rPdp_AntB 0xb70 ++#define rPdp_AntB_4 0xb74 ++#define rConfig_Pmpd_AntB 0xb98 ++#define rAPK 0xbd8 ++ ++ ++ ++/* ++ * 6. PageC(0xC00) ++ * */ ++#define rOFDM0_LSTF 0xc00 ++ ++#define rOFDM0_TRxPathEnable 0xc04 ++#define rOFDM0_TRMuxPar 0xc08 ++#define rOFDM0_TRSWIsolation 0xc0c ++ ++#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ ++#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ ++#define rOFDM0_XBRxAFE 0xc18 ++#define rOFDM0_XBRxIQImbalance 0xc1c ++#define rOFDM0_XCRxAFE 0xc20 ++#define rOFDM0_XCRxIQImbalance 0xc24 ++#define rOFDM0_XDRxAFE 0xc28 ++#define rOFDM0_XDRxIQImbalance 0xc2c ++ ++#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ ++#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ ++#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ ++#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ ++ ++#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ ++#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ ++#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ ++#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ ++ ++#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ ++#define rOFDM0_XAAGCCore2 0xc54 ++#define rOFDM0_XBAGCCore1 0xc58 ++#define rOFDM0_XBAGCCore2 0xc5c ++#define rOFDM0_XCAGCCore1 0xc60 ++#define rOFDM0_XCAGCCore2 0xc64 ++#define rOFDM0_XDAGCCore1 0xc68 ++#define rOFDM0_XDAGCCore2 0xc6c ++ ++#define rOFDM0_AGCParameter1 0xc70 ++#define rOFDM0_AGCParameter2 0xc74 ++#define rOFDM0_AGCRSSITable 0xc78 ++#define rOFDM0_HTSTFAGC 0xc7c ++ ++#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ ++#define rOFDM0_XATxAFE 0xc84 ++#define rOFDM0_XBTxIQImbalance 0xc88 ++#define rOFDM0_XBTxAFE 0xc8c ++#define rOFDM0_XCTxIQImbalance 0xc90 ++#define rOFDM0_XCTxAFE 0xc94 ++#define rOFDM0_XDTxIQImbalance 0xc98 ++#define rOFDM0_XDTxAFE 0xc9c ++ ++#define rOFDM0_RxIQExtAnta 0xca0 ++#define rOFDM0_TxCoeff1 0xca4 ++#define rOFDM0_TxCoeff2 0xca8 ++#define rOFDM0_TxCoeff3 0xcac ++#define rOFDM0_TxCoeff4 0xcb0 ++#define rOFDM0_TxCoeff5 0xcb4 ++#define rOFDM0_TxCoeff6 0xcb8 ++#define rOFDM0_RxHPParameter 0xce0 ++#define rOFDM0_TxPseudoNoiseWgt 0xce4 ++#define rOFDM0_FrameSync 0xcf0 ++#define rOFDM0_DFSReport 0xcf4 ++ ++ ++/* ++ * 7. PageD(0xD00) ++ * */ ++#define rOFDM1_LSTF 0xd00 ++#define rOFDM1_TRxPathEnable 0xd04 ++ ++#define rOFDM1_CFO 0xd08 /* No setting now */ ++#define rOFDM1_CSI1 0xd10 ++#define rOFDM1_SBD 0xd14 ++#define rOFDM1_CSI2 0xd18 ++#define rOFDM1_CFOTracking 0xd2c ++#define rOFDM1_TRxMesaure1 0xd34 ++#define rOFDM1_IntfDet 0xd3c ++#define rOFDM1_csi_fix_mask1 0xd40 ++#define rOFDM1_csi_fix_mask2 0xd44 ++#define rOFDM1_PseudoNoiseStateAB 0xd50 ++#define rOFDM1_PseudoNoiseStateCD 0xd54 ++#define rOFDM1_RxPseudoNoiseWgt 0xd58 ++ ++#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ ++#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ ++#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ ++ ++#define rOFDM_ShortCFOAB 0xdac /* No setting now */ ++#define rOFDM_ShortCFOCD 0xdb0 ++#define rOFDM_LongCFOAB 0xdb4 ++#define rOFDM_LongCFOCD 0xdb8 ++#define rOFDM_TailCFOAB 0xdbc ++#define rOFDM_TailCFOCD 0xdc0 ++#define rOFDM_PWMeasure1 0xdc4 ++#define rOFDM_PWMeasure2 0xdc8 ++#define rOFDM_BWReport 0xdcc ++#define rOFDM_AGCReport 0xdd0 ++#define rOFDM_RxSNR 0xdd4 ++#define rOFDM_RxEVMCSI 0xdd8 ++#define rOFDM_SIGReport 0xddc ++ ++ ++/* ++ * 8. PageE(0xE00) ++ * */ ++#define rTxAGC_A_Rate18_06 0xe00 ++#define rTxAGC_A_Rate54_24 0xe04 ++#define rTxAGC_A_CCK1_Mcs32 0xe08 ++#define rTxAGC_A_Mcs03_Mcs00 0xe10 ++#define rTxAGC_A_Mcs07_Mcs04 0xe14 ++#define rTxAGC_A_Mcs11_Mcs08 0xe18 ++#define rTxAGC_A_Mcs15_Mcs12 0xe1c ++ ++#define rTxAGC_B_Rate18_06 0x830 ++#define rTxAGC_B_Rate54_24 0x834 ++#define rTxAGC_B_CCK1_55_Mcs32 0x838 ++#define rTxAGC_B_Mcs03_Mcs00 0x83c ++#define rTxAGC_B_Mcs07_Mcs04 0x848 ++#define rTxAGC_B_Mcs11_Mcs08 0x84c ++#define rTxAGC_B_Mcs15_Mcs12 0x868 ++#define rTxAGC_B_CCK11_A_CCK2_11 0x86c ++ ++#define rFPGA0_IQK 0xe28 ++#define rTx_IQK_Tone_A 0xe30 ++#define rRx_IQK_Tone_A 0xe34 ++#define rTx_IQK_PI_A 0xe38 ++#define rRx_IQK_PI_A 0xe3c ++ ++#define rTx_IQK 0xe40 ++#define rRx_IQK 0xe44 ++#define rIQK_AGC_Pts 0xe48 ++#define rIQK_AGC_Rsp 0xe4c ++#define rTx_IQK_Tone_B 0xe50 ++#define rRx_IQK_Tone_B 0xe54 ++#define rTx_IQK_PI_B 0xe58 ++#define rRx_IQK_PI_B 0xe5c ++#define rIQK_AGC_Cont 0xe60 ++ ++#define rBlue_Tooth 0xe6c ++#define rRx_Wait_CCA 0xe70 ++#define rTx_CCK_RFON 0xe74 ++#define rTx_CCK_BBON 0xe78 ++#define rTx_OFDM_RFON 0xe7c ++#define rTx_OFDM_BBON 0xe80 ++#define rTx_To_Rx 0xe84 ++#define rTx_To_Tx 0xe88 ++#define rRx_CCK 0xe8c ++ ++#define rTx_Power_Before_IQK_A 0xe94 ++#define rTx_Power_After_IQK_A 0xe9c ++ ++#define rRx_Power_Before_IQK_A 0xea0 ++#define rRx_Power_Before_IQK_A_2 0xea4 ++#define rRx_Power_After_IQK_A 0xea8 ++#define rRx_Power_After_IQK_A_2 0xeac ++ ++#define rTx_Power_Before_IQK_B 0xeb4 ++#define rTx_Power_After_IQK_B 0xebc ++ ++#define rRx_Power_Before_IQK_B 0xec0 ++#define rRx_Power_Before_IQK_B_2 0xec4 ++#define rRx_Power_After_IQK_B 0xec8 ++#define rRx_Power_After_IQK_B_2 0xecc ++ ++#define rRx_OFDM 0xed0 ++#define rRx_Wait_RIFS 0xed4 ++#define rRx_TO_Rx 0xed8 ++#define rStandby 0xedc ++#define rSleep 0xee0 ++#define rPMPD_ANAEN 0xeec ++ ++/* ++ * 7. RF Register 0x00-0x2E (RF 8256) ++ * RF-0222D 0x00-3F ++ * ++ * Zebra1 */ ++#define rZebra1_HSSIEnable 0x0 /* Useless now */ ++#define rZebra1_TRxEnable1 0x1 ++#define rZebra1_TRxEnable2 0x2 ++#define rZebra1_AGC 0x4 ++#define rZebra1_ChargePump 0x5 ++#define rZebra1_Channel 0x7 /* RF channel switch */ ++ ++/* #endif */ ++#define rZebra1_TxGain 0x8 /* Useless now */ ++#define rZebra1_TxLPF 0x9 ++#define rZebra1_RxLPF 0xb ++#define rZebra1_RxHPFCorner 0xc ++ ++/* Zebra4 */ ++#define rGlobalCtrl 0 /* Useless now */ ++#define rRTL8256_TxLPF 19 ++#define rRTL8256_RxLPF 11 ++ ++/* RTL8258 */ ++#define rRTL8258_TxLPF 0x11 /* Useless now */ ++#define rRTL8258_RxLPF 0x13 ++#define rRTL8258_RSSILPF 0xa ++ ++/* ++ * RL6052 Register definition ++ * */ ++#define RF_AC 0x00 /* */ ++ ++#define RF_IQADJ_G1 0x01 /* */ ++#define RF_IQADJ_G2 0x02 /* */ ++ ++#define RF_POW_TRSW 0x05 /* */ ++ ++#define RF_GAIN_RX 0x06 /* */ ++#define RF_GAIN_TX 0x07 /* */ ++ ++#define RF_TXM_IDAC 0x08 /* */ ++#define RF_IPA_G 0x09 /* */ ++#define RF_TXBIAS_G 0x0A ++#define RF_TXPA_AG 0x0B ++#define RF_IPA_A 0x0C /* */ ++#define RF_TXBIAS_A 0x0D ++#define RF_BS_PA_APSET_G9_G11 0x0E ++#define RF_BS_IQGEN 0x0F /* */ ++ ++#define RF_MODE1 0x10 /* */ ++#define RF_MODE2 0x11 /* */ ++ ++#define RF_RX_AGC_HP 0x12 /* */ ++#define RF_TX_AGC 0x13 /* */ ++#define RF_BIAS 0x14 /* */ ++#define RF_IPA 0x15 /* */ ++#define RF_TXBIAS 0x16 ++#define RF_POW_ABILITY 0x17 /* */ ++#define RF_CHNLBW 0x18 /* RF channel and BW switch */ ++#define RF_TOP 0x19 /* */ ++ ++#define RF_RX_G1 0x1A /* */ ++#define RF_RX_G2 0x1B /* */ ++ ++#define RF_RX_BB2 0x1C /* */ ++#define RF_RX_BB1 0x1D /* */ ++ ++#define RF_RCK1 0x1E /* */ ++#define RF_RCK2 0x1F /* */ ++ ++#define RF_TX_G1 0x20 /* */ ++#define RF_TX_G2 0x21 /* */ ++#define RF_TX_G3 0x22 /* */ ++ ++#define RF_TX_BB1 0x23 /* */ ++ ++#define RF_T_METER_88E 0x42 /* */ ++#define RF_T_METER 0x24 /* */ ++ ++#define RF_SYN_G1 0x25 /* RF TX Power control */ ++#define RF_SYN_G2 0x26 /* RF TX Power control */ ++#define RF_SYN_G3 0x27 /* RF TX Power control */ ++#define RF_SYN_G4 0x28 /* RF TX Power control */ ++#define RF_SYN_G5 0x29 /* RF TX Power control */ ++#define RF_SYN_G6 0x2A /* RF TX Power control */ ++#define RF_SYN_G7 0x2B /* RF TX Power control */ ++#define RF_SYN_G8 0x2C /* RF TX Power control */ ++ ++#define RF_RCK_OS 0x30 /* RF TX PA control */ ++#define RF_TXPA_G1 0x31 /* RF TX PA control */ ++#define RF_TXPA_G2 0x32 /* RF TX PA control */ ++#define RF_TXPA_G3 0x33 /* RF TX PA control */ ++#define RF_TX_BIAS_A 0x35 ++#define RF_TX_BIAS_D 0x36 ++#define RF_LOBF_9 0x38 ++#define RF_RXRF_A3 0x3C /* */ ++#define RF_TRSW 0x3F ++ ++#define RF_TXRF_A2 0x41 ++#define RF_TXPA_G4 0x46 ++#define RF_TXPA_A4 0x4B ++#define RF_0x52 0x52 ++#define RF_WE_LUT 0xEF ++ ++ ++/* ++ * Bit Mask ++ * ++ * 1. Page1(0x100) */ ++#define bBBResetB 0x100 /* Useless now? */ ++#define bGlobalResetB 0x200 ++#define bOFDMTxStart 0x4 ++#define bCCKTxStart 0x8 ++#define bCRC32Debug 0x100 ++#define bPMACLoopback 0x10 ++#define bTxLSIG 0xffffff ++#define bOFDMTxRate 0xf ++#define bOFDMTxReserved 0x10 ++#define bOFDMTxLength 0x1ffe0 ++#define bOFDMTxParity 0x20000 ++#define bTxHTSIG1 0xffffff ++#define bTxHTMCSRate 0x7f ++#define bTxHTBW 0x80 ++#define bTxHTLength 0xffff00 ++#define bTxHTSIG2 0xffffff ++#define bTxHTSmoothing 0x1 ++#define bTxHTSounding 0x2 ++#define bTxHTReserved 0x4 ++#define bTxHTAggreation 0x8 ++#define bTxHTSTBC 0x30 ++#define bTxHTAdvanceCoding 0x40 ++#define bTxHTShortGI 0x80 ++#define bTxHTNumberHT_LTF 0x300 ++#define bTxHTCRC8 0x3fc00 ++#define bCounterReset 0x10000 ++#define bNumOfOFDMTx 0xffff ++#define bNumOfCCKTx 0xffff0000 ++#define bTxIdleInterval 0xffff ++#define bOFDMService 0xffff0000 ++#define bTxMACHeader 0xffffffff ++#define bTxDataInit 0xff ++#define bTxHTMode 0x100 ++#define bTxDataType 0x30000 ++#define bTxRandomSeed 0xffffffff ++#define bCCKTxPreamble 0x1 ++#define bCCKTxSFD 0xffff0000 ++#define bCCKTxSIG 0xff ++#define bCCKTxService 0xff00 ++#define bCCKLengthExt 0x8000 ++#define bCCKTxLength 0xffff0000 ++#define bCCKTxCRC16 0xffff ++#define bCCKTxStatus 0x1 ++#define bOFDMTxStatus 0x2 ++ ++#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) ++ ++/* 2. Page8(0x800) */ ++#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ ++#define bJapanMode 0x2 ++#define bCCKTxSC 0x30 ++#define bCCKEn 0x1000000 ++#define bOFDMEn 0x2000000 ++ ++#define bOFDMRxADCPhase 0x10000 /* Useless now */ ++#define bOFDMTxDACPhase 0x40000 ++#define bXATxAGC 0x3f ++ ++#define bAntennaSelect 0x0300 ++ ++#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ ++#define bXCTxAGC 0xf000 ++#define bXDTxAGC 0xf0000 ++ ++#define bPAStart 0xf0000000 /* Useless now */ ++#define bTRStart 0x00f00000 ++#define bRFStart 0x0000f000 ++#define bBBStart 0x000000f0 ++#define bBBCCKStart 0x0000000f ++#define bPAEnd 0xf /* Reg0x814 */ ++#define bTREnd 0x0f000000 ++#define bRFEnd 0x000f0000 ++#define bCCAMask 0x000000f0 /* T2R */ ++#define bR2RCCAMask 0x00000f00 ++#define bHSSI_R2TDelay 0xf8000000 ++#define bHSSI_T2RDelay 0xf80000 ++#define bContTxHSSI 0x400 /* chane gain at continue Tx */ ++#define bIGFromCCK 0x200 ++#define bAGCAddress 0x3f ++#define bRxHPTx 0x7000 ++#define bRxHPT2R 0x38000 ++#define bRxHPCCKIni 0xc0000 ++#define bAGCTxCode 0xc00000 ++#define bAGCRxCode 0x300000 ++ ++#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ ++#define b3WireAddressLength 0x400 ++ ++#define b3WireRFPowerDown 0x1 /* Useless now ++ * #define bHWSISelect 0x8 */ ++#define b5GPAPEPolarity 0x40000000 ++#define b2GPAPEPolarity 0x80000000 ++#define bRFSW_TxDefaultAnt 0x3 ++#define bRFSW_TxOptionAnt 0x30 ++#define bRFSW_RxDefaultAnt 0x300 ++#define bRFSW_RxOptionAnt 0x3000 ++#define bRFSI_3WireData 0x1 ++#define bRFSI_3WireClock 0x2 ++#define bRFSI_3WireLoad 0x4 ++#define bRFSI_3WireRW 0x8 ++#define bRFSI_3Wire 0xf ++ ++#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ ++ ++#define bRFSI_TRSW 0x20 /* Useless now */ ++#define bRFSI_TRSWB 0x40 ++#define bRFSI_ANTSW 0x100 ++#define bRFSI_ANTSWB 0x200 ++#define bRFSI_PAPE 0x400 ++#define bRFSI_PAPE5G 0x800 ++#define bBandSelect 0x1 ++#define bHTSIG2_GI 0x80 ++#define bHTSIG2_Smoothing 0x01 ++#define bHTSIG2_Sounding 0x02 ++#define bHTSIG2_Aggreaton 0x08 ++#define bHTSIG2_STBC 0x30 ++#define bHTSIG2_AdvCoding 0x40 ++#define bHTSIG2_NumOfHTLTF 0x300 ++#define bHTSIG2_CRC8 0x3fc ++#define bHTSIG1_MCS 0x7f ++#define bHTSIG1_BandWidth 0x80 ++#define bHTSIG1_HTLength 0xffff ++#define bLSIG_Rate 0xf ++#define bLSIG_Reserved 0x10 ++#define bLSIG_Length 0x1fffe ++#define bLSIG_Parity 0x20 ++#define bCCKRxPhase 0x4 ++ ++#define bLSSIReadAddress 0x7f800000 /* T65 RF */ ++ ++#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ ++ ++#define bLSSIReadBackData 0xfffff /* T65 RF */ ++ ++#define bLSSIReadOKFlag 0x1000 /* Useless now */ ++#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ ++#define bRegulator0Standby 0x1 ++#define bRegulatorPLLStandby 0x2 ++#define bRegulator1Standby 0x4 ++#define bPLLPowerUp 0x8 ++#define bDPLLPowerUp 0x10 ++#define bDA10PowerUp 0x20 ++#define bAD7PowerUp 0x200 ++#define bDA6PowerUp 0x2000 ++#define bXtalPowerUp 0x4000 ++#define b40MDClkPowerUP 0x8000 ++#define bDA6DebugMode 0x20000 ++#define bDA6Swing 0x380000 ++ ++#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ ++ ++#define b80MClkDelay 0x18000000 /* Useless */ ++#define bAFEWatchDogEnable 0x20000000 ++ ++#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ ++#define bXtalCap23 0x3 ++#define bXtalCap92x 0x0f000000 ++#define bXtalCap 0x0f000000 ++ ++#define bIntDifClkEnable 0x400 /* Useless */ ++#define bExtSigClkEnable 0x800 ++#define bBandgapMbiasPowerUp 0x10000 ++#define bAD11SHGain 0xc0000 ++#define bAD11InputRange 0x700000 ++#define bAD11OPCurrent 0x3800000 ++#define bIPathLoopback 0x4000000 ++#define bQPathLoopback 0x8000000 ++#define bAFELoopback 0x10000000 ++#define bDA10Swing 0x7e0 ++#define bDA10Reverse 0x800 ++#define bDAClkSource 0x1000 ++#define bAD7InputRange 0x6000 ++#define bAD7Gain 0x38000 ++#define bAD7OutputCMMode 0x40000 ++#define bAD7InputCMMode 0x380000 ++#define bAD7Current 0xc00000 ++#define bRegulatorAdjust 0x7000000 ++#define bAD11PowerUpAtTx 0x1 ++#define bDA10PSAtTx 0x10 ++#define bAD11PowerUpAtRx 0x100 ++#define bDA10PSAtRx 0x1000 ++#define bCCKRxAGCFormat 0x200 ++#define bPSDFFTSamplepPoint 0xc000 ++#define bPSDAverageNum 0x3000 ++#define bIQPathControl 0xc00 ++#define bPSDFreq 0x3ff ++#define bPSDAntennaPath 0x30 ++#define bPSDIQSwitch 0x40 ++#define bPSDRxTrigger 0x400000 ++#define bPSDTxTrigger 0x80000000 ++#define bPSDSineToneScale 0x7f000000 ++#define bPSDReport 0xffff ++ ++/* 3. Page9(0x900) */ ++#define bOFDMTxSC 0x30000000 /* Useless */ ++#define bCCKTxOn 0x1 ++#define bOFDMTxOn 0x2 ++#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ ++#define bDebugItem 0xff /* reset debug page and LWord */ ++#define bAntL 0x10 ++#define bAntNonHT 0x100 ++#define bAntHT1 0x1000 ++#define bAntHT2 0x10000 ++#define bAntHT1S1 0x100000 ++#define bAntNonHTS1 0x1000000 ++ ++/* 4. PageA(0xA00) */ ++#define bCCKBBMode 0x3 /* Useless */ ++#define bCCKTxPowerSaving 0x80 ++#define bCCKRxPowerSaving 0x40 ++ ++#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ ++ ++#define bCCKScramble 0x8 /* Useless */ ++#define bCCKAntDiversity 0x8000 ++#define bCCKCarrierRecovery 0x4000 ++#define bCCKTxRate 0x3000 ++#define bCCKDCCancel 0x0800 ++#define bCCKISICancel 0x0400 ++#define bCCKMatchFilter 0x0200 ++#define bCCKEqualizer 0x0100 ++#define bCCKPreambleDetect 0x800000 ++#define bCCKFastFalseCCA 0x400000 ++#define bCCKChEstStart 0x300000 ++#define bCCKCCACount 0x080000 ++#define bCCKcs_lim 0x070000 ++#define bCCKBistMode 0x80000000 ++#define bCCKCCAMask 0x40000000 ++#define bCCKTxDACPhase 0x4 ++#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ ++#define bCCKr_cp_mode0 0x0100 ++#define bCCKTxDCOffset 0xf0 ++#define bCCKRxDCOffset 0xf ++#define bCCKCCAMode 0xc000 ++#define bCCKFalseCS_lim 0x3f00 ++#define bCCKCS_ratio 0xc00000 ++#define bCCKCorgBit_sel 0x300000 ++#define bCCKPD_lim 0x0f0000 ++#define bCCKNewCCA 0x80000000 ++#define bCCKRxHPofIG 0x8000 ++#define bCCKRxIG 0x7f00 ++#define bCCKLNAPolarity 0x800000 ++#define bCCKRx1stGain 0x7f0000 ++#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ ++#define bCCKRxAGCSatLevel 0x1f000000 ++#define bCCKRxAGCSatCount 0xe0 ++#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ ++#define bCCKFixedRxAGC 0x8000 ++/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ ++#define bCCKAntennaPolarity 0x2000 ++#define bCCKTxFilterType 0x0c00 ++#define bCCKRxAGCReportType 0x0300 ++#define bCCKRxDAGCEn 0x80000000 ++#define bCCKRxDAGCPeriod 0x20000000 ++#define bCCKRxDAGCSatLevel 0x1f000000 ++#define bCCKTimingRecovery 0x800000 ++#define bCCKTxC0 0x3f0000 ++#define bCCKTxC1 0x3f000000 ++#define bCCKTxC2 0x3f ++#define bCCKTxC3 0x3f00 ++#define bCCKTxC4 0x3f0000 ++#define bCCKTxC5 0x3f000000 ++#define bCCKTxC6 0x3f ++#define bCCKTxC7 0x3f00 ++#define bCCKDebugPort 0xff0000 ++#define bCCKDACDebug 0x0f000000 ++#define bCCKFalseAlarmEnable 0x8000 ++#define bCCKFalseAlarmRead 0x4000 ++#define bCCKTRSSI 0x7f ++#define bCCKRxAGCReport 0xfe ++#define bCCKRxReport_AntSel 0x80000000 ++#define bCCKRxReport_MFOff 0x40000000 ++#define bCCKRxRxReport_SQLoss 0x20000000 ++#define bCCKRxReport_Pktloss 0x10000000 ++#define bCCKRxReport_Lockedbit 0x08000000 ++#define bCCKRxReport_RateError 0x04000000 ++#define bCCKRxReport_RxRate 0x03000000 ++#define bCCKRxFACounterLower 0xff ++#define bCCKRxFACounterUpper 0xff000000 ++#define bCCKRxHPAGCStart 0xe000 ++#define bCCKRxHPAGCFinal 0x1c00 ++#define bCCKRxFalseAlarmEnable 0x8000 ++#define bCCKFACounterFreeze 0x4000 ++#define bCCKTxPathSel 0x10000000 ++#define bCCKDefaultRxPath 0xc000000 ++#define bCCKOptionRxPath 0x3000000 ++ ++/* 5. PageC(0xC00) */ ++#define bNumOfSTF 0x3 /* Useless */ ++#define bShift_L 0xc0 ++#define bGI_TH 0xc ++#define bRxPathA 0x1 ++#define bRxPathB 0x2 ++#define bRxPathC 0x4 ++#define bRxPathD 0x8 ++#define bTxPathA 0x1 ++#define bTxPathB 0x2 ++#define bTxPathC 0x4 ++#define bTxPathD 0x8 ++#define bTRSSIFreq 0x200 ++#define bADCBackoff 0x3000 ++#define bDFIRBackoff 0xc000 ++#define bTRSSILatchPhase 0x10000 ++#define bRxIDCOffset 0xff ++#define bRxQDCOffset 0xff00 ++#define bRxDFIRMode 0x1800000 ++#define bRxDCNFType 0xe000000 ++#define bRXIQImb_A 0x3ff ++#define bRXIQImb_B 0xfc00 ++#define bRXIQImb_C 0x3f0000 ++#define bRXIQImb_D 0xffc00000 ++#define bDC_dc_Notch 0x60000 ++#define bRxNBINotch 0x1f000000 ++#define bPD_TH 0xf ++#define bPD_TH_Opt2 0xc000 ++#define bPWED_TH 0x700 ++#define bIfMF_Win_L 0x800 ++#define bPD_Option 0x1000 ++#define bMF_Win_L 0xe000 ++#define bBW_Search_L 0x30000 ++#define bwin_enh_L 0xc0000 ++#define bBW_TH 0x700000 ++#define bED_TH2 0x3800000 ++#define bBW_option 0x4000000 ++#define bRatio_TH 0x18000000 ++#define bWindow_L 0xe0000000 ++#define bSBD_Option 0x1 ++#define bFrame_TH 0x1c ++#define bFS_Option 0x60 ++#define bDC_Slope_check 0x80 ++#define bFGuard_Counter_DC_L 0xe00 ++#define bFrame_Weight_Short 0x7000 ++#define bSub_Tune 0xe00000 ++#define bFrame_DC_Length 0xe000000 ++#define bSBD_start_offset 0x30000000 ++#define bFrame_TH_2 0x7 ++#define bFrame_GI2_TH 0x38 ++#define bGI2_Sync_en 0x40 ++#define bSarch_Short_Early 0x300 ++#define bSarch_Short_Late 0xc00 ++#define bSarch_GI2_Late 0x70000 ++#define bCFOAntSum 0x1 ++#define bCFOAcc 0x2 ++#define bCFOStartOffset 0xc ++#define bCFOLookBack 0x70 ++#define bCFOSumWeight 0x80 ++#define bDAGCEnable 0x10000 ++#define bTXIQImb_A 0x3ff ++#define bTXIQImb_B 0xfc00 ++#define bTXIQImb_C 0x3f0000 ++#define bTXIQImb_D 0xffc00000 ++#define bTxIDCOffset 0xff ++#define bTxQDCOffset 0xff00 ++#define bTxDFIRMode 0x10000 ++#define bTxPesudoNoiseOn 0x4000000 ++#define bTxPesudoNoise_A 0xff ++#define bTxPesudoNoise_B 0xff00 ++#define bTxPesudoNoise_C 0xff0000 ++#define bTxPesudoNoise_D 0xff000000 ++#define bCCADropOption 0x20000 ++#define bCCADropThres 0xfff00000 ++#define bEDCCA_H 0xf ++#define bEDCCA_L 0xf0 ++#define bLambda_ED 0x300 ++#define bRxInitialGain 0x7f ++#define bRxAntDivEn 0x80 ++#define bRxAGCAddressForLNA 0x7f00 ++#define bRxHighPowerFlow 0x8000 ++#define bRxAGCFreezeThres 0xc0000 ++#define bRxFreezeStep_AGC1 0x300000 ++#define bRxFreezeStep_AGC2 0xc00000 ++#define bRxFreezeStep_AGC3 0x3000000 ++#define bRxFreezeStep_AGC0 0xc000000 ++#define bRxRssi_Cmp_En 0x10000000 ++#define bRxQuickAGCEn 0x20000000 ++#define bRxAGCFreezeThresMode 0x40000000 ++#define bRxOverFlowCheckType 0x80000000 ++#define bRxAGCShift 0x7f ++#define bTRSW_Tri_Only 0x80 ++#define bPowerThres 0x300 ++#define bRxAGCEn 0x1 ++#define bRxAGCTogetherEn 0x2 ++#define bRxAGCMin 0x4 ++#define bRxHP_Ini 0x7 ++#define bRxHP_TRLNA 0x70 ++#define bRxHP_RSSI 0x700 ++#define bRxHP_BBP1 0x7000 ++#define bRxHP_BBP2 0x70000 ++#define bRxHP_BBP3 0x700000 ++#define bRSSI_H 0x7f0000 /* the threshold for high power */ ++#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ ++#define bRxSettle_TRSW 0x7 ++#define bRxSettle_LNA 0x38 ++#define bRxSettle_RSSI 0x1c0 ++#define bRxSettle_BBP 0xe00 ++#define bRxSettle_RxHP 0x7000 ++#define bRxSettle_AntSW_RSSI 0x38000 ++#define bRxSettle_AntSW 0xc0000 ++#define bRxProcessTime_DAGC 0x300000 ++#define bRxSettle_HSSI 0x400000 ++#define bRxProcessTime_BBPPW 0x800000 ++#define bRxAntennaPowerShift 0x3000000 ++#define bRSSITableSelect 0xc000000 ++#define bRxHP_Final 0x7000000 ++#define bRxHTSettle_BBP 0x7 ++#define bRxHTSettle_HSSI 0x8 ++#define bRxHTSettle_RxHP 0x70 ++#define bRxHTSettle_BBPPW 0x80 ++#define bRxHTSettle_Idle 0x300 ++#define bRxHTSettle_Reserved 0x1c00 ++#define bRxHTRxHPEn 0x8000 ++#define bRxHTAGCFreezeThres 0x30000 ++#define bRxHTAGCTogetherEn 0x40000 ++#define bRxHTAGCMin 0x80000 ++#define bRxHTAGCEn 0x100000 ++#define bRxHTDAGCEn 0x200000 ++#define bRxHTRxHP_BBP 0x1c00000 ++#define bRxHTRxHP_Final 0xe0000000 ++#define bRxPWRatioTH 0x3 ++#define bRxPWRatioEn 0x4 ++#define bRxMFHold 0x3800 ++#define bRxPD_Delay_TH1 0x38 ++#define bRxPD_Delay_TH2 0x1c0 ++#define bRxPD_DC_COUNT_MAX 0x600 ++/* #define bRxMF_Hold 0x3800 */ ++#define bRxPD_Delay_TH 0x8000 ++#define bRxProcess_Delay 0xf0000 ++#define bRxSearchrange_GI2_Early 0x700000 ++#define bRxFrame_Guard_Counter_L 0x3800000 ++#define bRxSGI_Guard_L 0xc000000 ++#define bRxSGI_Search_L 0x30000000 ++#define bRxSGI_TH 0xc0000000 ++#define bDFSCnt0 0xff ++#define bDFSCnt1 0xff00 ++#define bDFSFlag 0xf0000 ++#define bMFWeightSum 0x300000 ++#define bMinIdxTH 0x7f000000 ++#define bDAFormat 0x40000 ++#define bTxChEmuEnable 0x01000000 ++#define bTRSWIsolation_A 0x7f ++#define bTRSWIsolation_B 0x7f00 ++#define bTRSWIsolation_C 0x7f0000 ++#define bTRSWIsolation_D 0x7f000000 ++#define bExtLNAGain 0x7c00 ++ ++/* 6. PageE(0xE00) */ ++#define bSTBCEn 0x4 /* Useless */ ++#define bAntennaMapping 0x10 ++#define bNss 0x20 ++#define bCFOAntSumD 0x200 ++#define bPHYCounterReset 0x8000000 ++#define bCFOReportGet 0x4000000 ++#define bOFDMContinueTx 0x10000000 ++#define bOFDMSingleCarrier 0x20000000 ++#define bOFDMSingleTone 0x40000000 ++/* #define bRxPath1 0x01 */ ++/* #define bRxPath2 0x02 */ ++/* #define bRxPath3 0x04 */ ++/* #define bRxPath4 0x08 */ ++/* #define bTxPath1 0x10 */ ++/* #define bTxPath2 0x20 */ ++#define bHTDetect 0x100 ++#define bCFOEn 0x10000 ++#define bCFOValue 0xfff00000 ++#define bSigTone_Re 0x3f ++#define bSigTone_Im 0x7f00 ++#define bCounter_CCA 0xffff ++#define bCounter_ParityFail 0xffff0000 ++#define bCounter_RateIllegal 0xffff ++#define bCounter_CRC8Fail 0xffff0000 ++#define bCounter_MCSNoSupport 0xffff ++#define bCounter_FastSync 0xffff ++#define bShortCFO 0xfff ++#define bShortCFOTLength 12 /* total */ ++#define bShortCFOFLength 11 /* fraction */ ++#define bLongCFO 0x7ff ++#define bLongCFOTLength 11 ++#define bLongCFOFLength 11 ++#define bTailCFO 0x1fff ++#define bTailCFOTLength 13 ++#define bTailCFOFLength 12 ++#define bmax_en_pwdB 0xffff ++#define bCC_power_dB 0xffff0000 ++#define bnoise_pwdB 0xffff ++#define bPowerMeasTLength 10 ++#define bPowerMeasFLength 3 ++#define bRx_HT_BW 0x1 ++#define bRxSC 0x6 ++#define bRx_HT 0x8 ++#define bNB_intf_det_on 0x1 ++#define bIntf_win_len_cfg 0x30 ++#define bNB_Intf_TH_cfg 0x1c0 ++#define bRFGain 0x3f ++#define bTableSel 0x40 ++#define bTRSW 0x80 ++#define bRxSNR_A 0xff ++#define bRxSNR_B 0xff00 ++#define bRxSNR_C 0xff0000 ++#define bRxSNR_D 0xff000000 ++#define bSNREVMTLength 8 ++#define bSNREVMFLength 1 ++#define bCSI1st 0xff ++#define bCSI2nd 0xff00 ++#define bRxEVM1st 0xff0000 ++#define bRxEVM2nd 0xff000000 ++#define bSIGEVM 0xff ++#define bPWDB 0xff00 ++#define bSGIEN 0x10000 ++ ++#define bSFactorQAM1 0xf /* Useless */ ++#define bSFactorQAM2 0xf0 ++#define bSFactorQAM3 0xf00 ++#define bSFactorQAM4 0xf000 ++#define bSFactorQAM5 0xf0000 ++#define bSFactorQAM6 0xf0000 ++#define bSFactorQAM7 0xf00000 ++#define bSFactorQAM8 0xf000000 ++#define bSFactorQAM9 0xf0000000 ++#define bCSIScheme 0x100000 ++ ++#define bNoiseLvlTopSet 0x3 /* Useless */ ++#define bChSmooth 0x4 ++#define bChSmoothCfg1 0x38 ++#define bChSmoothCfg2 0x1c0 ++#define bChSmoothCfg3 0xe00 ++#define bChSmoothCfg4 0x7000 ++#define bMRCMode 0x800000 ++#define bTHEVMCfg 0x7000000 ++ ++#define bLoopFitType 0x1 /* Useless */ ++#define bUpdCFO 0x40 ++#define bUpdCFOOffData 0x80 ++#define bAdvUpdCFO 0x100 ++#define bAdvTimeCtrl 0x800 ++#define bUpdClko 0x1000 ++#define bFC 0x6000 ++#define bTrackingMode 0x8000 ++#define bPhCmpEnable 0x10000 ++#define bUpdClkoLTF 0x20000 ++#define bComChCFO 0x40000 ++#define bCSIEstiMode 0x80000 ++#define bAdvUpdEqz 0x100000 ++#define bUChCfg 0x7000000 ++#define bUpdEqz 0x8000000 ++ ++/* Rx Pseduo noise */ ++#define bRxPesudoNoiseOn 0x20000000 /* Useless */ ++#define bRxPesudoNoise_A 0xff ++#define bRxPesudoNoise_B 0xff00 ++#define bRxPesudoNoise_C 0xff0000 ++#define bRxPesudoNoise_D 0xff000000 ++#define bPesudoNoiseState_A 0xffff ++#define bPesudoNoiseState_B 0xffff0000 ++#define bPesudoNoiseState_C 0xffff ++#define bPesudoNoiseState_D 0xffff0000 ++ ++/* 7. RF Register ++ * Zebra1 */ ++#define bZebra1_HSSIEnable 0x8 /* Useless */ ++#define bZebra1_TRxControl 0xc00 ++#define bZebra1_TRxGainSetting 0x07f ++#define bZebra1_RxCorner 0xc00 ++#define bZebra1_TxChargePump 0x38 ++#define bZebra1_RxChargePump 0x7 ++#define bZebra1_ChannelNum 0xf80 ++#define bZebra1_TxLPFBW 0x400 ++#define bZebra1_RxLPFBW 0x600 ++ ++/* Zebra4 */ ++#define bRTL8256RegModeCtrl1 0x100 /* Useless */ ++#define bRTL8256RegModeCtrl0 0x40 ++#define bRTL8256_TxLPFBW 0x18 ++#define bRTL8256_RxLPFBW 0x600 ++ ++/* RTL8258 */ ++#define bRTL8258_TxLPFBW 0xc /* Useless */ ++#define bRTL8258_RxLPFBW 0xc00 ++#define bRTL8258_RSSILPFBW 0xc0 ++ ++ ++/* ++ * Other Definition ++ * */ ++ ++/* byte endable for sb_write */ ++#define bByte0 0x1 /* Useless */ ++#define bByte1 0x2 ++#define bByte2 0x4 ++#define bByte3 0x8 ++#define bWord0 0x3 ++#define bWord1 0xc ++#define bDWord 0xf ++ ++/* for PutRegsetting & GetRegSetting BitMask */ ++#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ ++#define bMaskByte1 0xff00 ++#define bMaskByte2 0xff0000 ++#define bMaskByte3 0xff000000 ++#define bMaskHWord 0xffff0000 ++#define bMaskLWord 0x0000ffff ++#define bMaskDWord 0xffffffff ++#define bMaskH3Bytes 0xffffff00 ++#define bMask12Bits 0xfff ++#define bMaskH4Bits 0xf0000000 ++#define bMaskOFDM_D 0xffc00000 ++#define bMaskCCK 0x3f3f3f3f ++ ++ ++ ++#define bEnable 0x1 /* Useless */ ++#define bDisable 0x0 ++ ++#define LeftAntenna 0x0 /* Useless */ ++#define RightAntenna 0x1 ++ ++#define tCheckTxStatus 500 /* 500ms */ /* Useless */ ++#define tUpdateRxCounter 100 /* 100ms */ ++ ++#define rateCCK 0 /* Useless */ ++#define rateOFDM 1 ++#define rateHT 2 ++ ++/* define Register-End */ ++#define bPMAC_End 0x1ff /* Useless */ ++#define bFPGAPHY0_End 0x8ff ++#define bFPGAPHY1_End 0x9ff ++#define bCCKPHY0_End 0xaff ++#define bOFDMPHY0_End 0xcff ++#define bOFDMPHY1_End 0xdff ++ ++/* define max debug item in each debug page ++ * #define bMaxItem_FPGA_PHY0 0x9 ++ * #define bMaxItem_FPGA_PHY1 0x3 ++ * #define bMaxItem_PHY_11B 0x16 ++ * #define bMaxItem_OFDM_PHY0 0x29 ++ * #define bMaxItem_OFDM_PHY1 0x0 */ ++ ++#define bPMACControl 0x0 /* Useless */ ++#define bWMACControl 0x1 ++#define bWNICControl 0x2 ++ ++#define PathA 0x0 /* Useless */ ++#define PathB 0x1 ++#define PathC 0x2 ++#define PathD 0x3 ++ ++/*--------------------------Define Parameters-------------------------------*/ ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8188EPwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188EPwrSeq.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8188EPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188EPwrSeq.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,175 @@ ++ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __HAL8188EPWRSEQ_H__ ++#define __HAL8188EPWRSEQ_H__ ++ ++#include "HalPwrSeqCmd.h" ++ ++/* ++ Check document WM-20110607-Paul-RTL8188E_Power_Architecture-R02.vsd ++ There are 6 HW Power States: ++ 0: POFF--Power Off ++ 1: PDN--Power Down ++ 2: CARDEMU--Card Emulation ++ 3: ACT--Active Mode ++ 4: LPS--Low Power State ++ 5: SUS--Suspend ++ ++ The transision from different states are defined below ++ TRANS_CARDEMU_TO_ACT ++ TRANS_ACT_TO_CARDEMU ++ TRANS_CARDEMU_TO_SUS ++ TRANS_SUS_TO_CARDEMU ++ TRANS_CARDEMU_TO_PDN ++ TRANS_ACT_TO_LPS ++ TRANS_LPS_TO_ACT ++ ++ TRANS_END ++ ++ PWR SEQ Version: rtl8188E_PwrSeq_V09.h ++*/ ++#define RTL8188E_TRANS_CARDEMU_TO_ACT_STEPS 10 ++#define RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS 10 ++#define RTL8188E_TRANS_CARDEMU_TO_SUS_STEPS 10 ++#define RTL8188E_TRANS_SUS_TO_CARDEMU_STEPS 10 ++#define RTL8188E_TRANS_CARDEMU_TO_PDN_STEPS 10 ++#define RTL8188E_TRANS_PDN_TO_CARDEMU_STEPS 10 ++#define RTL8188E_TRANS_ACT_TO_LPS_STEPS 15 ++#define RTL8188E_TRANS_LPS_TO_ACT_STEPS 15 ++#define RTL8188E_TRANS_END_STEPS 1 ++ ++ ++#define RTL8188E_TRANS_CARDEMU_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 | BIT1, 0}, /* 0x02[1:0] = 0 reset BB*/ \ ++ {0x0026, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7}, /*0x24[23] = 2b'01 schmit trigger */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0}, /* 0x04[15] = 0 disable HWPDN (control by DRV)*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4 | BIT3, 0}, /*0x04[12:11] = 2b'00 disable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*0x04[8] = 1 polling until return 0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0}, /*wait till 0x04[8] = 0*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*LDO normal mode*/ \ ++ ++#define RTL8188E_TRANS_ACT_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*LDO Sleep mode*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ ++ ++#define RTL8188E_TRANS_CARDEMU_TO_SUS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01enable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3 | BIT4}, /*0x04[12:11] = 2b'11enable WL suspend for PCIe*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, BIT7}, /* 0x04[31:30] = 2b'10 enable enable bandgap mbias in suspend */ \ ++ {0x0041, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*Clear SIC_EN register 0x40[12] = 1'b0 */ \ ++ {0xfe10, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*Set USB suspend enable local register 0xfe10[4]=1 */ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ ++ ++#define RTL8188E_TRANS_SUS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ ++ ++#define RTL8188E_TRANS_CARDEMU_TO_CARDDIS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0026, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7}, /*0x24[23] = 2b'01 schmit trigger */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /* 0x04[31:30] = 2b'10 enable enable bandgap mbias in suspend */ \ ++ {0x0041, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*Clear SIC_EN register 0x40[12] = 1'b0 */ \ ++ {0xfe10, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*Set USB suspend enable local register 0xfe10[4]=1 */ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ ++ ++#define RTL8188E_TRANS_CARDDIS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ ++ ++#define RTL8188E_TRANS_CARDEMU_TO_PDN \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ ++ ++#define RTL8188E_TRANS_PDN_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ ++ ++ /* This is used by driver for LPSRadioOff Procedure, not for FW LPS Step */ ++#define RTL8188E_TRANS_ACT_TO_LPS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x7F},/*Tx Pause*/ \ ++ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x3F},/*Reset MAC TRX*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ ++ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ ++ ++ ++#define RTL8188E_TRANS_LPS_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ ++ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ ++ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ ++ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ ++ ++#define RTL8188E_TRANS_END \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, ++ ++ ++ extern WLAN_PWR_CFG rtl8188E_power_on_flow[RTL8188E_TRANS_CARDEMU_TO_ACT_STEPS + RTL8188E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188E_radio_off_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188E_card_disable_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188E_TRANS_CARDEMU_TO_PDN_STEPS + RTL8188E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188E_card_enable_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188E_TRANS_CARDEMU_TO_PDN_STEPS + RTL8188E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188E_suspend_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188E_TRANS_CARDEMU_TO_SUS_STEPS + RTL8188E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188E_resume_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188E_TRANS_CARDEMU_TO_SUS_STEPS + RTL8188E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188E_hwpdn_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188E_TRANS_CARDEMU_TO_PDN_STEPS + RTL8188E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188E_enter_lps_flow[RTL8188E_TRANS_ACT_TO_LPS_STEPS + RTL8188E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188E_leave_lps_flow[RTL8188E_TRANS_LPS_TO_ACT_STEPS + RTL8188E_TRANS_END_STEPS]; ++ ++#endif /* __HAL8188EPWRSEQ_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8188FPhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188FPhyCfg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8188FPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188FPhyCfg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,136 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8188FPHYCFG_H__ ++#define __INC_HAL8188FPHYCFG_H__ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++#define LOOP_LIMIT 5 ++#define MAX_STALL_TIME 50 /* us */ ++#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ ++#define MAX_TXPWR_IDX_NMODE_92S 63 ++#define Reset_Cnt_Limit 3 ++ ++#ifdef CONFIG_PCI_HCI ++ #define MAX_AGGR_NUM 0x0B ++#else ++ #define MAX_AGGR_NUM 0x07 ++#endif /* CONFIG_PCI_HCI */ ++ ++ ++/*--------------------------Define Parameters End-------------------------------*/ ++ ++ ++/*------------------------------Define structure----------------------------*/ ++ ++/*------------------------------Define structure End----------------------------*/ ++ ++/*--------------------------Exported Function prototype---------------------*/ ++u32 ++PHY_QueryBBReg_8188F( ++ IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask ++); ++ ++VOID ++PHY_SetBBReg_8188F( ++ IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data ++); ++ ++u32 ++PHY_QueryRFReg_8188F( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask ++); ++ ++VOID ++PHY_SetRFReg_8188F( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data ++); ++ ++/* MAC/BB/RF HAL config */ ++int PHY_BBConfig8188F(PADAPTER Adapter); ++ ++int PHY_RFConfig8188F(PADAPTER Adapter); ++ ++s32 PHY_MACConfig8188F(PADAPTER padapter); ++ ++int ++PHY_ConfigRFWithParaFile_8188F( ++ IN PADAPTER Adapter, ++ IN u8 *pFileName, ++ RF_PATH eRFPath ++); ++ ++VOID ++PHY_SetTxPowerIndex_8188F( ++ IN PADAPTER Adapter, ++ IN u32 PowerIndex, ++ IN u8 RFPath, ++ IN u8 Rate ++); ++ ++u8 ++PHY_GetTxPowerIndex_8188F( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN u8 BandWidth, ++ IN u8 Channel, ++ struct txpwr_idx_comp *tic ++); ++ ++VOID ++PHY_GetTxPowerLevel8188F( ++ IN PADAPTER Adapter, ++ OUT s32 *powerlevel ++); ++ ++VOID ++PHY_SetTxPowerLevel8188F( ++ IN PADAPTER Adapter, ++ IN u8 channel ++); ++ ++VOID ++PHY_SetSwChnlBWMode8188F( ++ IN PADAPTER Adapter, ++ IN u8 channel, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 Offset40, ++ IN u8 Offset80 ++); ++ ++VOID PHY_SetRFPathSwitch_8188F( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bMain ++); ++/*--------------------------Exported Function prototype End---------------------*/ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8188FPhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188FPhyReg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8188FPhyReg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188FPhyReg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,1170 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8188FPHYREG_H__ ++#define __INC_HAL8188FPHYREG_H__ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++ ++/* ************************************************************ ++ * Regsiter offset definition ++ * ************************************************************ */ ++ ++/* ++ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 ++ * 3. RF register 0x00-2E ++ * 4. Bit Mask for BB/RF register ++ * 5. Other defintion for BB/RF R/W ++ * */ ++ ++ ++/* ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 1. Page1(0x100) ++ * */ ++#define rPMAC_Reset 0x100 ++#define rPMAC_TxStart 0x104 ++#define rPMAC_TxLegacySIG 0x108 ++#define rPMAC_TxHTSIG1 0x10c ++#define rPMAC_TxHTSIG2 0x110 ++#define rPMAC_PHYDebug 0x114 ++#define rPMAC_TxPacketNum 0x118 ++#define rPMAC_TxIdle 0x11c ++#define rPMAC_TxMACHeader0 0x120 ++#define rPMAC_TxMACHeader1 0x124 ++#define rPMAC_TxMACHeader2 0x128 ++#define rPMAC_TxMACHeader3 0x12c ++#define rPMAC_TxMACHeader4 0x130 ++#define rPMAC_TxMACHeader5 0x134 ++#define rPMAC_TxDataType 0x138 ++#define rPMAC_TxRandomSeed 0x13c ++#define rPMAC_CCKPLCPPreamble 0x140 ++#define rPMAC_CCKPLCPHeader 0x144 ++#define rPMAC_CCKCRC16 0x148 ++#define rPMAC_OFDMRxCRC32OK 0x170 ++#define rPMAC_OFDMRxCRC32Er 0x174 ++#define rPMAC_OFDMRxParityEr 0x178 ++#define rPMAC_OFDMRxCRC8Er 0x17c ++#define rPMAC_CCKCRxRC16Er 0x180 ++#define rPMAC_CCKCRxRC32Er 0x184 ++#define rPMAC_CCKCRxRC32OK 0x188 ++#define rPMAC_TxStatus 0x18c ++ ++/* ++ * 2. Page2(0x200) ++ * ++ * The following two definition are only used for USB interface. */ ++#define RF_BB_CMD_ADDR 0x02c0 /* RF/BB read/write command address. */ ++#define RF_BB_CMD_DATA 0x02c4 /* RF/BB read/write command data. */ ++ ++/* ++ * 3. Page8(0x800) ++ * */ ++#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ ++ ++#define rFPGA0_TxInfo 0x804 /* Status report?? */ ++#define rFPGA0_PSDFunction 0x808 ++ ++#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ ++ ++#define rFPGA0_RFTiming1 0x810 /* Useless now */ ++#define rFPGA0_RFTiming2 0x814 ++ ++#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ ++#define rFPGA0_XA_HSSIParameter2 0x824 ++#define rFPGA0_XB_HSSIParameter1 0x828 ++#define rFPGA0_XB_HSSIParameter2 0x82c ++#define rTxAGC_B_Rate18_06 0x830 ++#define rTxAGC_B_Rate54_24 0x834 ++#define rTxAGC_B_CCK1_55_Mcs32 0x838 ++#define rTxAGC_B_Mcs03_Mcs00 0x83c ++ ++#define rTxAGC_B_Mcs07_Mcs04 0x848 ++#define rTxAGC_B_Mcs11_Mcs08 0x84c ++ ++#define rFPGA0_XA_LSSIParameter 0x840 ++#define rFPGA0_XB_LSSIParameter 0x844 ++ ++#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ ++#define rFPGA0_RFSleepUpParameter 0x854 ++ ++#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ ++#define rFPGA0_XCD_SwitchControl 0x85c ++ ++#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ ++#define rFPGA0_XB_RFInterfaceOE 0x864 ++ ++#define rTxAGC_B_Mcs15_Mcs12 0x868 ++#define rTxAGC_B_CCK11_A_CCK2_11 0x86c ++ ++#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ ++#define rFPGA0_XCD_RFInterfaceSW 0x874 ++ ++#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ ++#define rFPGA0_XCD_RFParameter 0x87c ++ ++#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ ++#define rFPGA0_AnalogParameter2 0x884 ++#define rFPGA0_AnalogParameter3 0x888 /* Useless now */ ++#define rFPGA0_AnalogParameter4 0x88c ++ ++#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ ++#define rFPGA0_XB_LSSIReadBack 0x8a4 ++#define rFPGA0_XC_LSSIReadBack 0x8a8 ++#define rFPGA0_XD_LSSIReadBack 0x8ac ++ ++#define rFPGA0_PSDReport 0x8b4 /* Useless now */ ++#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ ++#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ ++#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ ++#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ ++ ++/* ++ * 4. Page9(0x900) ++ * */ ++#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ ++ ++#define rFPGA1_TxBlock 0x904 /* Useless now */ ++#define rFPGA1_DebugSelect 0x908 /* Useless now */ ++#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ ++#define rS0S1_PathSwitch 0x948 ++ ++/* ++ * 5. PageA(0xA00) ++ * ++ * Set Control channel to upper or lower. These settings are required only for 40MHz */ ++#define rCCK0_System 0xa00 ++ ++#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ ++#define rCCK0_CCA 0xa08 /* Disable init gain now */ /* Init gain */ ++ ++#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level */ /* Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ ++#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ ++ ++#define rCCK0_RxHP 0xa14 ++ ++#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ ++#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ ++ ++#define rCCK0_TxFilter1 0xa20 ++#define rCCK0_TxFilter2 0xa24 ++#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ ++#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ ++#define rCCK0_TRSSIReport 0xa50 ++#define rCCK0_RxReport 0xa54 /* 0xa57 */ ++#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ ++#define rCCK0_FACounterUpper 0xa58 /* 0xa5c ++ * ++ * PageB(0xB00) ++ * */ ++#define rPdp_AntA 0xb00 ++#define rPdp_AntA_4 0xb04 ++#define rConfig_Pmpd_AntA 0xb28 ++#define rConfig_AntA 0xb68 ++#define rConfig_AntB 0xb6c ++#define rPdp_AntB 0xb70 ++#define rPdp_AntB_4 0xb74 ++#define rConfig_Pmpd_AntB 0xb98 ++#define rAPK 0xbd8 ++ ++/* ++ * 6. PageC(0xC00) ++ * */ ++#define rOFDM0_LSTF 0xc00 ++ ++#define rOFDM0_TRxPathEnable 0xc04 ++#define rOFDM0_TRMuxPar 0xc08 ++#define rOFDM0_TRSWIsolation 0xc0c ++ ++#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ ++#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ ++#define rOFDM0_XBRxAFE 0xc18 ++#define rOFDM0_XBRxIQImbalance 0xc1c ++#define rOFDM0_XCRxAFE 0xc20 ++#define rOFDM0_XCRxIQImbalance 0xc24 ++#define rOFDM0_XDRxAFE 0xc28 ++#define rOFDM0_XDRxIQImbalance 0xc2c ++ ++#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ ++#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ ++#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ ++#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ ++ ++#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ ++#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ ++#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ ++#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ ++ ++#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ ++#define rOFDM0_XAAGCCore2 0xc54 ++#define rOFDM0_XBAGCCore1 0xc58 ++#define rOFDM0_XBAGCCore2 0xc5c ++#define rOFDM0_XCAGCCore1 0xc60 ++#define rOFDM0_XCAGCCore2 0xc64 ++#define rOFDM0_XDAGCCore1 0xc68 ++#define rOFDM0_XDAGCCore2 0xc6c ++ ++#define rOFDM0_AGCParameter1 0xc70 ++#define rOFDM0_AGCParameter2 0xc74 ++#define rOFDM0_AGCRSSITable 0xc78 ++#define rOFDM0_HTSTFAGC 0xc7c ++ ++#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ ++#define rOFDM0_XATxAFE 0xc84 ++#define rOFDM0_XBTxIQImbalance 0xc88 ++#define rOFDM0_XBTxAFE 0xc8c ++#define rOFDM0_XCTxIQImbalance 0xc90 ++#define rOFDM0_XCTxAFE 0xc94 ++#define rOFDM0_XDTxIQImbalance 0xc98 ++#define rOFDM0_XDTxAFE 0xc9c ++ ++#define rOFDM0_RxIQExtAnta 0xca0 ++#define rOFDM0_TxCoeff1 0xca4 ++#define rOFDM0_TxCoeff2 0xca8 ++#define rOFDM0_TxCoeff3 0xcac ++#define rOFDM0_TxCoeff4 0xcb0 ++#define rOFDM0_TxCoeff5 0xcb4 ++#define rOFDM0_TxCoeff6 0xcb8 ++#define rOFDM0_RxHPParameter 0xce0 ++#define rOFDM0_TxPseudoNoiseWgt 0xce4 ++#define rOFDM0_FrameSync 0xcf0 ++#define rOFDM0_DFSReport 0xcf4 ++ ++/* ++ * 7. PageD(0xD00) ++ * */ ++#define rOFDM1_LSTF 0xd00 ++#define rOFDM1_TRxPathEnable 0xd04 ++ ++#define rOFDM1_CFO 0xd08 /* No setting now */ ++#define rOFDM1_CSI1 0xd10 ++#define rOFDM1_SBD 0xd14 ++#define rOFDM1_CSI2 0xd18 ++#define rOFDM1_CFOTracking 0xd2c ++#define rOFDM1_TRxMesaure1 0xd34 ++#define rOFDM1_IntfDet 0xd3c ++#define rOFDM1_PseudoNoiseStateAB 0xd50 ++#define rOFDM1_PseudoNoiseStateCD 0xd54 ++#define rOFDM1_RxPseudoNoiseWgt 0xd58 ++ ++#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ ++#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ ++#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ ++ ++#define rOFDM_ShortCFOAB 0xdac /* No setting now */ ++#define rOFDM_ShortCFOCD 0xdb0 ++#define rOFDM_LongCFOAB 0xdb4 ++#define rOFDM_LongCFOCD 0xdb8 ++#define rOFDM_TailCFOAB 0xdbc ++#define rOFDM_TailCFOCD 0xdc0 ++#define rOFDM_PWMeasure1 0xdc4 ++#define rOFDM_PWMeasure2 0xdc8 ++#define rOFDM_BWReport 0xdcc ++#define rOFDM_AGCReport 0xdd0 ++#define rOFDM_RxSNR 0xdd4 ++#define rOFDM_RxEVMCSI 0xdd8 ++#define rOFDM_SIGReport 0xddc ++ ++ ++/* ++ * 8. PageE(0xE00) ++ * */ ++#define rTxAGC_A_Rate18_06 0xe00 ++#define rTxAGC_A_Rate54_24 0xe04 ++#define rTxAGC_A_CCK1_Mcs32 0xe08 ++#define rTxAGC_A_Mcs03_Mcs00 0xe10 ++#define rTxAGC_A_Mcs07_Mcs04 0xe14 ++#define rTxAGC_A_Mcs11_Mcs08 0xe18 ++#define rTxAGC_A_Mcs15_Mcs12 0xe1c ++ ++#define rFPGA0_IQK 0xe28 ++#define rTx_IQK_Tone_A 0xe30 ++#define rRx_IQK_Tone_A 0xe34 ++#define rTx_IQK_PI_A 0xe38 ++#define rRx_IQK_PI_A 0xe3c ++ ++#define rTx_IQK 0xe40 ++#define rRx_IQK 0xe44 ++#define rIQK_AGC_Pts 0xe48 ++#define rIQK_AGC_Rsp 0xe4c ++#define rTx_IQK_Tone_B 0xe50 ++#define rRx_IQK_Tone_B 0xe54 ++#define rTx_IQK_PI_B 0xe58 ++#define rRx_IQK_PI_B 0xe5c ++#define rIQK_AGC_Cont 0xe60 ++ ++#define rBlue_Tooth 0xe6c ++#define rRx_Wait_CCA 0xe70 ++#define rTx_CCK_RFON 0xe74 ++#define rTx_CCK_BBON 0xe78 ++#define rTx_OFDM_RFON 0xe7c ++#define rTx_OFDM_BBON 0xe80 ++#define rTx_To_Rx 0xe84 ++#define rTx_To_Tx 0xe88 ++#define rRx_CCK 0xe8c ++ ++#define rTx_Power_Before_IQK_A 0xe94 ++#define rTx_Power_After_IQK_A 0xe9c ++ ++#define rRx_Power_Before_IQK_A 0xea0 ++#define rRx_Power_Before_IQK_A_2 0xea4 ++#define rRx_Power_After_IQK_A 0xea8 ++#define rRx_Power_After_IQK_A_2 0xeac ++ ++#define rTx_Power_Before_IQK_B 0xeb4 ++#define rTx_Power_After_IQK_B 0xebc ++ ++#define rRx_Power_Before_IQK_B 0xec0 ++#define rRx_Power_Before_IQK_B_2 0xec4 ++#define rRx_Power_After_IQK_B 0xec8 ++#define rRx_Power_After_IQK_B_2 0xecc ++ ++#define rRx_OFDM 0xed0 ++#define rRx_Wait_RIFS 0xed4 ++#define rRx_TO_Rx 0xed8 ++#define rStandby 0xedc ++#define rSleep 0xee0 ++#define rPMPD_ANAEN 0xeec ++ ++/* ++ * 7. RF Register 0x00-0x2E (RF 8256) ++ * RF-0222D 0x00-3F ++ * ++ * Zebra1 */ ++#define rZebra1_HSSIEnable 0x0 /* Useless now */ ++#define rZebra1_TRxEnable1 0x1 ++#define rZebra1_TRxEnable2 0x2 ++#define rZebra1_AGC 0x4 ++#define rZebra1_ChargePump 0x5 ++#define rZebra1_Channel 0x7 /* RF channel switch */ ++ ++/* #endif */ ++#define rZebra1_TxGain 0x8 /* Useless now */ ++#define rZebra1_TxLPF 0x9 ++#define rZebra1_RxLPF 0xb ++#define rZebra1_RxHPFCorner 0xc ++ ++/* Zebra4 */ ++#define rGlobalCtrl 0 /* Useless now */ ++#define rRTL8256_TxLPF 19 ++#define rRTL8256_RxLPF 11 ++ ++/* RTL8258 */ ++#define rRTL8258_TxLPF 0x11 /* Useless now */ ++#define rRTL8258_RxLPF 0x13 ++#define rRTL8258_RSSILPF 0xa ++ ++/* ++ * RL6052 Register definition ++ * */ ++#define RF_AC 0x00 /* */ ++ ++#define RF_IQADJ_G1 0x01 /* */ ++#define RF_IQADJ_G2 0x02 /* */ ++#define RF_BS_PA_APSET_G1_G4 0x03 ++#define RF_BS_PA_APSET_G5_G8 0x04 ++#define RF_POW_TRSW 0x05 /* */ ++ ++#define RF_GAIN_RX 0x06 /* */ ++#define RF_GAIN_TX 0x07 /* */ ++ ++#define RF_TXM_IDAC 0x08 /* */ ++#define RF_IPA_G 0x09 /* */ ++#define RF_TXBIAS_G 0x0A ++#define RF_TXPA_AG 0x0B ++#define RF_IPA_A 0x0C /* */ ++#define RF_TXBIAS_A 0x0D ++#define RF_BS_PA_APSET_G9_G11 0x0E ++#define RF_BS_IQGEN 0x0F /* */ ++ ++#define RF_MODE1 0x10 /* */ ++#define RF_MODE2 0x11 /* */ ++ ++#define RF_RX_AGC_HP 0x12 /* */ ++#define RF_TX_AGC 0x13 /* */ ++#define RF_BIAS 0x14 /* */ ++#define RF_IPA 0x15 /* */ ++#define RF_TXBIAS 0x16 ++#define RF_POW_ABILITY 0x17 /* */ ++#define RF_MODE_AG 0x18 /* */ ++#define rRfChannel 0x18 /* RF channel and BW switch */ ++#define RF_CHNLBW 0x18 /* RF channel and BW switch */ ++#define RF_TOP 0x19 /* */ ++ ++#define RF_RX_G1 0x1A /* */ ++#define RF_RX_G2 0x1B /* */ ++ ++#define RF_RX_BB2 0x1C /* */ ++#define RF_RX_BB1 0x1D /* */ ++ ++#define RF_RCK1 0x1E /* */ ++#define RF_RCK2 0x1F /* */ ++ ++#define RF_TX_G1 0x20 /* */ ++#define RF_TX_G2 0x21 /* */ ++#define RF_TX_G3 0x22 /* */ ++ ++#define RF_TX_BB1 0x23 /* */ ++ ++#define RF_T_METER 0x24 /* */ ++ ++#define RF_SYN_G1 0x25 /* RF TX Power control */ ++#define RF_SYN_G2 0x26 /* RF TX Power control */ ++#define RF_SYN_G3 0x27 /* RF TX Power control */ ++#define RF_SYN_G4 0x28 /* RF TX Power control */ ++#define RF_SYN_G5 0x29 /* RF TX Power control */ ++#define RF_SYN_G6 0x2A /* RF TX Power control */ ++#define RF_SYN_G7 0x2B /* RF TX Power control */ ++#define RF_SYN_G8 0x2C /* RF TX Power control */ ++ ++#define RF_RCK_OS 0x30 /* RF TX PA control */ ++ ++#define RF_TXPA_G1 0x31 /* RF TX PA control */ ++#define RF_TXPA_G2 0x32 /* RF TX PA control */ ++#define RF_TXPA_G3 0x33 /* RF TX PA control */ ++#define RF_TX_BIAS_A 0x35 ++#define RF_TX_BIAS_D 0x36 ++#define RF_LOBF_9 0x38 ++#define RF_RXRF_A3 0x3C /* */ ++#define RF_TRSW 0x3F ++ ++#define RF_TXRF_A2 0x41 ++#define RF_TXPA_G4 0x46 ++#define RF_TXPA_A4 0x4B ++#define RF_0x52 0x52 ++#define RF_RXG_MIX_SWBW 0x87 ++#define RF_DBG_LP_RX2 0xDF ++#define RF_WE_LUT 0xEF ++#define RF_S0S1 0xB0 ++ ++#define RF_TX_GAIN_OFFSET_8188F(_val) (abs((_val)) | (((_val) > 0) ? BIT5 : 0)) ++ ++/* ++ * Bit Mask ++ * ++ * 1. Page1(0x100) */ ++#define bBBResetB 0x100 /* Useless now? */ ++#define bGlobalResetB 0x200 ++#define bOFDMTxStart 0x4 ++#define bCCKTxStart 0x8 ++#define bCRC32Debug 0x100 ++#define bPMACLoopback 0x10 ++#define bTxLSIG 0xffffff ++#define bOFDMTxRate 0xf ++#define bOFDMTxReserved 0x10 ++#define bOFDMTxLength 0x1ffe0 ++#define bOFDMTxParity 0x20000 ++#define bTxHTSIG1 0xffffff ++#define bTxHTMCSRate 0x7f ++#define bTxHTBW 0x80 ++#define bTxHTLength 0xffff00 ++#define bTxHTSIG2 0xffffff ++#define bTxHTSmoothing 0x1 ++#define bTxHTSounding 0x2 ++#define bTxHTReserved 0x4 ++#define bTxHTAggreation 0x8 ++#define bTxHTSTBC 0x30 ++#define bTxHTAdvanceCoding 0x40 ++#define bTxHTShortGI 0x80 ++#define bTxHTNumberHT_LTF 0x300 ++#define bTxHTCRC8 0x3fc00 ++#define bCounterReset 0x10000 ++#define bNumOfOFDMTx 0xffff ++#define bNumOfCCKTx 0xffff0000 ++#define bTxIdleInterval 0xffff ++#define bOFDMService 0xffff0000 ++#define bTxMACHeader 0xffffffff ++#define bTxDataInit 0xff ++#define bTxHTMode 0x100 ++#define bTxDataType 0x30000 ++#define bTxRandomSeed 0xffffffff ++#define bCCKTxPreamble 0x1 ++#define bCCKTxSFD 0xffff0000 ++#define bCCKTxSIG 0xff ++#define bCCKTxService 0xff00 ++#define bCCKLengthExt 0x8000 ++#define bCCKTxLength 0xffff0000 ++#define bCCKTxCRC16 0xffff ++#define bCCKTxStatus 0x1 ++#define bOFDMTxStatus 0x2 ++ ++#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) ++ ++/* 2. Page8(0x800) */ ++#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ ++#define bJapanMode 0x2 ++#define bCCKTxSC 0x30 ++#define bCCKEn 0x1000000 ++#define bOFDMEn 0x2000000 ++ ++#define bOFDMRxADCPhase 0x10000 /* Useless now */ ++#define bOFDMTxDACPhase 0x40000 ++#define bXATxAGC 0x3f ++ ++#define bAntennaSelect 0x0300 ++ ++#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ ++#define bXCTxAGC 0xf000 ++#define bXDTxAGC 0xf0000 ++ ++#define bPAStart 0xf0000000 /* Useless now */ ++#define bTRStart 0x00f00000 ++#define bRFStart 0x0000f000 ++#define bBBStart 0x000000f0 ++#define bBBCCKStart 0x0000000f ++#define bPAEnd 0xf /* Reg0x814 */ ++#define bTREnd 0x0f000000 ++#define bRFEnd 0x000f0000 ++#define bCCAMask 0x000000f0 /* T2R */ ++#define bR2RCCAMask 0x00000f00 ++#define bHSSI_R2TDelay 0xf8000000 ++#define bHSSI_T2RDelay 0xf80000 ++#define bContTxHSSI 0x400 /* chane gain at continue Tx */ ++#define bIGFromCCK 0x200 ++#define bAGCAddress 0x3f ++#define bRxHPTx 0x7000 ++#define bRxHPT2R 0x38000 ++#define bRxHPCCKIni 0xc0000 ++#define bAGCTxCode 0xc00000 ++#define bAGCRxCode 0x300000 ++ ++#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ ++#define b3WireAddressLength 0x400 ++ ++#define b3WireRFPowerDown 0x1 /* Useless now ++ * #define bHWSISelect 0x8 */ ++#define b5GPAPEPolarity 0x40000000 ++#define b2GPAPEPolarity 0x80000000 ++#define bRFSW_TxDefaultAnt 0x3 ++#define bRFSW_TxOptionAnt 0x30 ++#define bRFSW_RxDefaultAnt 0x300 ++#define bRFSW_RxOptionAnt 0x3000 ++#define bRFSI_3WireData 0x1 ++#define bRFSI_3WireClock 0x2 ++#define bRFSI_3WireLoad 0x4 ++#define bRFSI_3WireRW 0x8 ++#define bRFSI_3Wire 0xf ++ ++#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ ++ ++#define bRFSI_TRSW 0x20 /* Useless now */ ++#define bRFSI_TRSWB 0x40 ++#define bRFSI_ANTSW 0x100 ++#define bRFSI_ANTSWB 0x200 ++#define bRFSI_PAPE 0x400 ++#define bRFSI_PAPE5G 0x800 ++#define bBandSelect 0x1 ++#define bHTSIG2_GI 0x80 ++#define bHTSIG2_Smoothing 0x01 ++#define bHTSIG2_Sounding 0x02 ++#define bHTSIG2_Aggreaton 0x08 ++#define bHTSIG2_STBC 0x30 ++#define bHTSIG2_AdvCoding 0x40 ++#define bHTSIG2_NumOfHTLTF 0x300 ++#define bHTSIG2_CRC8 0x3fc ++#define bHTSIG1_MCS 0x7f ++#define bHTSIG1_BandWidth 0x80 ++#define bHTSIG1_HTLength 0xffff ++#define bLSIG_Rate 0xf ++#define bLSIG_Reserved 0x10 ++#define bLSIG_Length 0x1fffe ++#define bLSIG_Parity 0x20 ++#define bCCKRxPhase 0x4 ++ ++#define bLSSIReadAddress 0x7f800000 /* T65 RF */ ++ ++#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ ++ ++#define bLSSIReadBackData 0xfffff /* T65 RF */ ++ ++#define bLSSIReadOKFlag 0x1000 /* Useless now */ ++#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ ++#define bRegulator0Standby 0x1 ++#define bRegulatorPLLStandby 0x2 ++#define bRegulator1Standby 0x4 ++#define bPLLPowerUp 0x8 ++#define bDPLLPowerUp 0x10 ++#define bDA10PowerUp 0x20 ++#define bAD7PowerUp 0x200 ++#define bDA6PowerUp 0x2000 ++#define bXtalPowerUp 0x4000 ++#define b40MDClkPowerUP 0x8000 ++#define bDA6DebugMode 0x20000 ++#define bDA6Swing 0x380000 ++ ++#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ ++ ++#define b80MClkDelay 0x18000000 /* Useless */ ++#define bAFEWatchDogEnable 0x20000000 ++ ++#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ ++#define bXtalCap23 0x3 ++#define bXtalCap92x 0x0f000000 ++#define bXtalCap 0x0f000000 ++ ++#define bIntDifClkEnable 0x400 /* Useless */ ++#define bExtSigClkEnable 0x800 ++#define bBandgapMbiasPowerUp 0x10000 ++#define bAD11SHGain 0xc0000 ++#define bAD11InputRange 0x700000 ++#define bAD11OPCurrent 0x3800000 ++#define bIPathLoopback 0x4000000 ++#define bQPathLoopback 0x8000000 ++#define bAFELoopback 0x10000000 ++#define bDA10Swing 0x7e0 ++#define bDA10Reverse 0x800 ++#define bDAClkSource 0x1000 ++#define bAD7InputRange 0x6000 ++#define bAD7Gain 0x38000 ++#define bAD7OutputCMMode 0x40000 ++#define bAD7InputCMMode 0x380000 ++#define bAD7Current 0xc00000 ++#define bRegulatorAdjust 0x7000000 ++#define bAD11PowerUpAtTx 0x1 ++#define bDA10PSAtTx 0x10 ++#define bAD11PowerUpAtRx 0x100 ++#define bDA10PSAtRx 0x1000 ++#define bCCKRxAGCFormat 0x200 ++#define bPSDFFTSamplepPoint 0xc000 ++#define bPSDAverageNum 0x3000 ++#define bIQPathControl 0xc00 ++#define bPSDFreq 0x3ff ++#define bPSDAntennaPath 0x30 ++#define bPSDIQSwitch 0x40 ++#define bPSDRxTrigger 0x400000 ++#define bPSDTxTrigger 0x80000000 ++#define bPSDSineToneScale 0x7f000000 ++#define bPSDReport 0xffff ++ ++/* 3. Page9(0x900) */ ++#define bOFDMTxSC 0x30000000 /* Useless */ ++#define bCCKTxOn 0x1 ++#define bOFDMTxOn 0x2 ++#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ ++#define bDebugItem 0xff /* reset debug page and LWord */ ++#define bAntL 0x10 ++#define bAntNonHT 0x100 ++#define bAntHT1 0x1000 ++#define bAntHT2 0x10000 ++#define bAntHT1S1 0x100000 ++#define bAntNonHTS1 0x1000000 ++ ++/* 4. PageA(0xA00) */ ++#define bCCKBBMode 0x3 /* Useless */ ++#define bCCKTxPowerSaving 0x80 ++#define bCCKRxPowerSaving 0x40 ++ ++#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ ++ ++#define bCCKScramble 0x8 /* Useless */ ++#define bCCKAntDiversity 0x8000 ++#define bCCKCarrierRecovery 0x4000 ++#define bCCKTxRate 0x3000 ++#define bCCKDCCancel 0x0800 ++#define bCCKISICancel 0x0400 ++#define bCCKMatchFilter 0x0200 ++#define bCCKEqualizer 0x0100 ++#define bCCKPreambleDetect 0x800000 ++#define bCCKFastFalseCCA 0x400000 ++#define bCCKChEstStart 0x300000 ++#define bCCKCCACount 0x080000 ++#define bCCKcs_lim 0x070000 ++#define bCCKBistMode 0x80000000 ++#define bCCKCCAMask 0x40000000 ++#define bCCKTxDACPhase 0x4 ++#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ ++#define bCCKr_cp_mode0 0x0100 ++#define bCCKTxDCOffset 0xf0 ++#define bCCKRxDCOffset 0xf ++#define bCCKCCAMode 0xc000 ++#define bCCKFalseCS_lim 0x3f00 ++#define bCCKCS_ratio 0xc00000 ++#define bCCKCorgBit_sel 0x300000 ++#define bCCKPD_lim 0x0f0000 ++#define bCCKNewCCA 0x80000000 ++#define bCCKRxHPofIG 0x8000 ++#define bCCKRxIG 0x7f00 ++#define bCCKLNAPolarity 0x800000 ++#define bCCKRx1stGain 0x7f0000 ++#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ ++#define bCCKRxAGCSatLevel 0x1f000000 ++#define bCCKRxAGCSatCount 0xe0 ++#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ ++#define bCCKFixedRxAGC 0x8000 ++/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ ++#define bCCKAntennaPolarity 0x2000 ++#define bCCKTxFilterType 0x0c00 ++#define bCCKRxAGCReportType 0x0300 ++#define bCCKRxDAGCEn 0x80000000 ++#define bCCKRxDAGCPeriod 0x20000000 ++#define bCCKRxDAGCSatLevel 0x1f000000 ++#define bCCKTimingRecovery 0x800000 ++#define bCCKTxC0 0x3f0000 ++#define bCCKTxC1 0x3f000000 ++#define bCCKTxC2 0x3f ++#define bCCKTxC3 0x3f00 ++#define bCCKTxC4 0x3f0000 ++#define bCCKTxC5 0x3f000000 ++#define bCCKTxC6 0x3f ++#define bCCKTxC7 0x3f00 ++#define bCCKDebugPort 0xff0000 ++#define bCCKDACDebug 0x0f000000 ++#define bCCKFalseAlarmEnable 0x8000 ++#define bCCKFalseAlarmRead 0x4000 ++#define bCCKTRSSI 0x7f ++#define bCCKRxAGCReport 0xfe ++#define bCCKRxReport_AntSel 0x80000000 ++#define bCCKRxReport_MFOff 0x40000000 ++#define bCCKRxRxReport_SQLoss 0x20000000 ++#define bCCKRxReport_Pktloss 0x10000000 ++#define bCCKRxReport_Lockedbit 0x08000000 ++#define bCCKRxReport_RateError 0x04000000 ++#define bCCKRxReport_RxRate 0x03000000 ++#define bCCKRxFACounterLower 0xff ++#define bCCKRxFACounterUpper 0xff000000 ++#define bCCKRxHPAGCStart 0xe000 ++#define bCCKRxHPAGCFinal 0x1c00 ++#define bCCKRxFalseAlarmEnable 0x8000 ++#define bCCKFACounterFreeze 0x4000 ++#define bCCKTxPathSel 0x10000000 ++#define bCCKDefaultRxPath 0xc000000 ++#define bCCKOptionRxPath 0x3000000 ++ ++/* 5. PageC(0xC00) */ ++#define bNumOfSTF 0x3 /* Useless */ ++#define bShift_L 0xc0 ++#define bGI_TH 0xc ++#define bRxPathA 0x1 ++#define bRxPathB 0x2 ++#define bRxPathC 0x4 ++#define bRxPathD 0x8 ++#define bTxPathA 0x1 ++#define bTxPathB 0x2 ++#define bTxPathC 0x4 ++#define bTxPathD 0x8 ++#define bTRSSIFreq 0x200 ++#define bADCBackoff 0x3000 ++#define bDFIRBackoff 0xc000 ++#define bTRSSILatchPhase 0x10000 ++#define bRxIDCOffset 0xff ++#define bRxQDCOffset 0xff00 ++#define bRxDFIRMode 0x1800000 ++#define bRxDCNFType 0xe000000 ++#define bRXIQImb_A 0x3ff ++#define bRXIQImb_B 0xfc00 ++#define bRXIQImb_C 0x3f0000 ++#define bRXIQImb_D 0xffc00000 ++#define bDC_dc_Notch 0x60000 ++#define bRxNBINotch 0x1f000000 ++#define bPD_TH 0xf ++#define bPD_TH_Opt2 0xc000 ++#define bPWED_TH 0x700 ++#define bIfMF_Win_L 0x800 ++#define bPD_Option 0x1000 ++#define bMF_Win_L 0xe000 ++#define bBW_Search_L 0x30000 ++#define bwin_enh_L 0xc0000 ++#define bBW_TH 0x700000 ++#define bED_TH2 0x3800000 ++#define bBW_option 0x4000000 ++#define bRatio_TH 0x18000000 ++#define bWindow_L 0xe0000000 ++#define bSBD_Option 0x1 ++#define bFrame_TH 0x1c ++#define bFS_Option 0x60 ++#define bDC_Slope_check 0x80 ++#define bFGuard_Counter_DC_L 0xe00 ++#define bFrame_Weight_Short 0x7000 ++#define bSub_Tune 0xe00000 ++#define bFrame_DC_Length 0xe000000 ++#define bSBD_start_offset 0x30000000 ++#define bFrame_TH_2 0x7 ++#define bFrame_GI2_TH 0x38 ++#define bGI2_Sync_en 0x40 ++#define bSarch_Short_Early 0x300 ++#define bSarch_Short_Late 0xc00 ++#define bSarch_GI2_Late 0x70000 ++#define bCFOAntSum 0x1 ++#define bCFOAcc 0x2 ++#define bCFOStartOffset 0xc ++#define bCFOLookBack 0x70 ++#define bCFOSumWeight 0x80 ++#define bDAGCEnable 0x10000 ++#define bTXIQImb_A 0x3ff ++#define bTXIQImb_B 0xfc00 ++#define bTXIQImb_C 0x3f0000 ++#define bTXIQImb_D 0xffc00000 ++#define bTxIDCOffset 0xff ++#define bTxQDCOffset 0xff00 ++#define bTxDFIRMode 0x10000 ++#define bTxPesudoNoiseOn 0x4000000 ++#define bTxPesudoNoise_A 0xff ++#define bTxPesudoNoise_B 0xff00 ++#define bTxPesudoNoise_C 0xff0000 ++#define bTxPesudoNoise_D 0xff000000 ++#define bCCADropOption 0x20000 ++#define bCCADropThres 0xfff00000 ++#define bEDCCA_H 0xf ++#define bEDCCA_L 0xf0 ++#define bLambda_ED 0x300 ++#define bRxInitialGain 0x7f ++#define bRxAntDivEn 0x80 ++#define bRxAGCAddressForLNA 0x7f00 ++#define bRxHighPowerFlow 0x8000 ++#define bRxAGCFreezeThres 0xc0000 ++#define bRxFreezeStep_AGC1 0x300000 ++#define bRxFreezeStep_AGC2 0xc00000 ++#define bRxFreezeStep_AGC3 0x3000000 ++#define bRxFreezeStep_AGC0 0xc000000 ++#define bRxRssi_Cmp_En 0x10000000 ++#define bRxQuickAGCEn 0x20000000 ++#define bRxAGCFreezeThresMode 0x40000000 ++#define bRxOverFlowCheckType 0x80000000 ++#define bRxAGCShift 0x7f ++#define bTRSW_Tri_Only 0x80 ++#define bPowerThres 0x300 ++#define bRxAGCEn 0x1 ++#define bRxAGCTogetherEn 0x2 ++#define bRxAGCMin 0x4 ++#define bRxHP_Ini 0x7 ++#define bRxHP_TRLNA 0x70 ++#define bRxHP_RSSI 0x700 ++#define bRxHP_BBP1 0x7000 ++#define bRxHP_BBP2 0x70000 ++#define bRxHP_BBP3 0x700000 ++#define bRSSI_H 0x7f0000 /* the threshold for high power */ ++#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ ++#define bRxSettle_TRSW 0x7 ++#define bRxSettle_LNA 0x38 ++#define bRxSettle_RSSI 0x1c0 ++#define bRxSettle_BBP 0xe00 ++#define bRxSettle_RxHP 0x7000 ++#define bRxSettle_AntSW_RSSI 0x38000 ++#define bRxSettle_AntSW 0xc0000 ++#define bRxProcessTime_DAGC 0x300000 ++#define bRxSettle_HSSI 0x400000 ++#define bRxProcessTime_BBPPW 0x800000 ++#define bRxAntennaPowerShift 0x3000000 ++#define bRSSITableSelect 0xc000000 ++#define bRxHP_Final 0x7000000 ++#define bRxHTSettle_BBP 0x7 ++#define bRxHTSettle_HSSI 0x8 ++#define bRxHTSettle_RxHP 0x70 ++#define bRxHTSettle_BBPPW 0x80 ++#define bRxHTSettle_Idle 0x300 ++#define bRxHTSettle_Reserved 0x1c00 ++#define bRxHTRxHPEn 0x8000 ++#define bRxHTAGCFreezeThres 0x30000 ++#define bRxHTAGCTogetherEn 0x40000 ++#define bRxHTAGCMin 0x80000 ++#define bRxHTAGCEn 0x100000 ++#define bRxHTDAGCEn 0x200000 ++#define bRxHTRxHP_BBP 0x1c00000 ++#define bRxHTRxHP_Final 0xe0000000 ++#define bRxPWRatioTH 0x3 ++#define bRxPWRatioEn 0x4 ++#define bRxMFHold 0x3800 ++#define bRxPD_Delay_TH1 0x38 ++#define bRxPD_Delay_TH2 0x1c0 ++#define bRxPD_DC_COUNT_MAX 0x600 ++/* #define bRxMF_Hold 0x3800 */ ++#define bRxPD_Delay_TH 0x8000 ++#define bRxProcess_Delay 0xf0000 ++#define bRxSearchrange_GI2_Early 0x700000 ++#define bRxFrame_Guard_Counter_L 0x3800000 ++#define bRxSGI_Guard_L 0xc000000 ++#define bRxSGI_Search_L 0x30000000 ++#define bRxSGI_TH 0xc0000000 ++#define bDFSCnt0 0xff ++#define bDFSCnt1 0xff00 ++#define bDFSFlag 0xf0000 ++#define bMFWeightSum 0x300000 ++#define bMinIdxTH 0x7f000000 ++#define bDAFormat 0x40000 ++#define bTxChEmuEnable 0x01000000 ++#define bTRSWIsolation_A 0x7f ++#define bTRSWIsolation_B 0x7f00 ++#define bTRSWIsolation_C 0x7f0000 ++#define bTRSWIsolation_D 0x7f000000 ++#define bExtLNAGain 0x7c00 ++ ++/* 6. PageE(0xE00) */ ++#define bSTBCEn 0x4 /* Useless */ ++#define bAntennaMapping 0x10 ++#define bNss 0x20 ++#define bCFOAntSumD 0x200 ++#define bPHYCounterReset 0x8000000 ++#define bCFOReportGet 0x4000000 ++#define bOFDMContinueTx 0x10000000 ++#define bOFDMSingleCarrier 0x20000000 ++#define bOFDMSingleTone 0x40000000 ++/* #define bRxPath1 0x01 */ ++/* #define bRxPath2 0x02 */ ++/* #define bRxPath3 0x04 */ ++/* #define bRxPath4 0x08 */ ++/* #define bTxPath1 0x10 */ ++/* #define bTxPath2 0x20 */ ++#define bHTDetect 0x100 ++#define bCFOEn 0x10000 ++#define bCFOValue 0xfff00000 ++#define bSigTone_Re 0x3f ++#define bSigTone_Im 0x7f00 ++#define bCounter_CCA 0xffff ++#define bCounter_ParityFail 0xffff0000 ++#define bCounter_RateIllegal 0xffff ++#define bCounter_CRC8Fail 0xffff0000 ++#define bCounter_MCSNoSupport 0xffff ++#define bCounter_FastSync 0xffff ++#define bShortCFO 0xfff ++#define bShortCFOTLength 12 /* total */ ++#define bShortCFOFLength 11 /* fraction */ ++#define bLongCFO 0x7ff ++#define bLongCFOTLength 11 ++#define bLongCFOFLength 11 ++#define bTailCFO 0x1fff ++#define bTailCFOTLength 13 ++#define bTailCFOFLength 12 ++#define bmax_en_pwdB 0xffff ++#define bCC_power_dB 0xffff0000 ++#define bnoise_pwdB 0xffff ++#define bPowerMeasTLength 10 ++#define bPowerMeasFLength 3 ++#define bRx_HT_BW 0x1 ++#define bRxSC 0x6 ++#define bRx_HT 0x8 ++#define bNB_intf_det_on 0x1 ++#define bIntf_win_len_cfg 0x30 ++#define bNB_Intf_TH_cfg 0x1c0 ++#define bRFGain 0x3f ++#define bTableSel 0x40 ++#define bTRSW 0x80 ++#define bRxSNR_A 0xff ++#define bRxSNR_B 0xff00 ++#define bRxSNR_C 0xff0000 ++#define bRxSNR_D 0xff000000 ++#define bSNREVMTLength 8 ++#define bSNREVMFLength 1 ++#define bCSI1st 0xff ++#define bCSI2nd 0xff00 ++#define bRxEVM1st 0xff0000 ++#define bRxEVM2nd 0xff000000 ++#define bSIGEVM 0xff ++#define bPWDB 0xff00 ++#define bSGIEN 0x10000 ++ ++#define bSFactorQAM1 0xf /* Useless */ ++#define bSFactorQAM2 0xf0 ++#define bSFactorQAM3 0xf00 ++#define bSFactorQAM4 0xf000 ++#define bSFactorQAM5 0xf0000 ++#define bSFactorQAM6 0xf0000 ++#define bSFactorQAM7 0xf00000 ++#define bSFactorQAM8 0xf000000 ++#define bSFactorQAM9 0xf0000000 ++#define bCSIScheme 0x100000 ++ ++#define bNoiseLvlTopSet 0x3 /* Useless */ ++#define bChSmooth 0x4 ++#define bChSmoothCfg1 0x38 ++#define bChSmoothCfg2 0x1c0 ++#define bChSmoothCfg3 0xe00 ++#define bChSmoothCfg4 0x7000 ++#define bMRCMode 0x800000 ++#define bTHEVMCfg 0x7000000 ++ ++#define bLoopFitType 0x1 /* Useless */ ++#define bUpdCFO 0x40 ++#define bUpdCFOOffData 0x80 ++#define bAdvUpdCFO 0x100 ++#define bAdvTimeCtrl 0x800 ++#define bUpdClko 0x1000 ++#define bFC 0x6000 ++#define bTrackingMode 0x8000 ++#define bPhCmpEnable 0x10000 ++#define bUpdClkoLTF 0x20000 ++#define bComChCFO 0x40000 ++#define bCSIEstiMode 0x80000 ++#define bAdvUpdEqz 0x100000 ++#define bUChCfg 0x7000000 ++#define bUpdEqz 0x8000000 ++ ++/* Rx Pseduo noise */ ++#define bRxPesudoNoiseOn 0x20000000 /* Useless */ ++#define bRxPesudoNoise_A 0xff ++#define bRxPesudoNoise_B 0xff00 ++#define bRxPesudoNoise_C 0xff0000 ++#define bRxPesudoNoise_D 0xff000000 ++#define bPesudoNoiseState_A 0xffff ++#define bPesudoNoiseState_B 0xffff0000 ++#define bPesudoNoiseState_C 0xffff ++#define bPesudoNoiseState_D 0xffff0000 ++ ++/* 7. RF Register ++ * Zebra1 */ ++#define bZebra1_HSSIEnable 0x8 /* Useless */ ++#define bZebra1_TRxControl 0xc00 ++#define bZebra1_TRxGainSetting 0x07f ++#define bZebra1_RxCorner 0xc00 ++#define bZebra1_TxChargePump 0x38 ++#define bZebra1_RxChargePump 0x7 ++#define bZebra1_ChannelNum 0xf80 ++#define bZebra1_TxLPFBW 0x400 ++#define bZebra1_RxLPFBW 0x600 ++ ++/* Zebra4 */ ++#define bRTL8256RegModeCtrl1 0x100 /* Useless */ ++#define bRTL8256RegModeCtrl0 0x40 ++#define bRTL8256_TxLPFBW 0x18 ++#define bRTL8256_RxLPFBW 0x600 ++ ++/* RTL8258 */ ++#define bRTL8258_TxLPFBW 0xc /* Useless */ ++#define bRTL8258_RxLPFBW 0xc00 ++#define bRTL8258_RSSILPFBW 0xc0 ++ ++ ++/* ++ * Other Definition ++ * */ ++ ++/* byte endable for sb_write */ ++#define bByte0 0x1 /* Useless */ ++#define bByte1 0x2 ++#define bByte2 0x4 ++#define bByte3 0x8 ++#define bWord0 0x3 ++#define bWord1 0xc ++#define bDWord 0xf ++ ++/* for PutRegsetting & GetRegSetting BitMask */ ++#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ ++#define bMaskByte1 0xff00 ++#define bMaskByte2 0xff0000 ++#define bMaskByte3 0xff000000 ++#define bMaskHWord 0xffff0000 ++#define bMaskLWord 0x0000ffff ++#define bMaskDWord 0xffffffff ++#define bMaskH3Bytes 0xffffff00 ++#define bMask12Bits 0xfff ++#define bMaskH4Bits 0xf0000000 ++#define bMaskOFDM_D 0xffc00000 ++#define bMaskCCK 0x3f3f3f3f ++ ++ ++#define bEnable 0x1 /* Useless */ ++#define bDisable 0x0 ++ ++#define LeftAntenna 0x0 /* Useless */ ++#define RightAntenna 0x1 ++ ++#define tCheckTxStatus 500 /* 500ms */ /* Useless */ ++#define tUpdateRxCounter 100 /* 100ms */ ++ ++#define rateCCK 0 /* Useless */ ++#define rateOFDM 1 ++#define rateHT 2 ++ ++/* define Register-End */ ++#define bPMAC_End 0x1ff /* Useless */ ++#define bFPGAPHY0_End 0x8ff ++#define bFPGAPHY1_End 0x9ff ++#define bCCKPHY0_End 0xaff ++#define bOFDMPHY0_End 0xcff ++#define bOFDMPHY1_End 0xdff ++ ++/* define max debug item in each debug page ++ * #define bMaxItem_FPGA_PHY0 0x9 ++ * #define bMaxItem_FPGA_PHY1 0x3 ++ * #define bMaxItem_PHY_11B 0x16 ++ * #define bMaxItem_OFDM_PHY0 0x29 ++ * #define bMaxItem_OFDM_PHY1 0x0 */ ++ ++#define bPMACControl 0x0 /* Useless */ ++#define bWMACControl 0x1 ++#define bWNICControl 0x2 ++ ++#define PathA 0x0 /* Useless */ ++#define PathB 0x1 ++#define PathC 0x2 ++#define PathD 0x3 ++ ++/*--------------------------Define Parameters-------------------------------*/ ++ ++ ++/* BB Register Definition ++ * ++ * 4. Page9(0x900) ++ * */ ++#define rDPDT_control 0x92c ++#define rfe_ctrl_anta_src 0x930 ++#define rS0S1_PathSwitch 0x948 ++#define BBrx_DFIR 0x954 ++#define AGC_table_select 0xb2c ++ ++/* ++ * PageB(0xB00) ++ * */ ++#define rPdp_AntA 0xb00 ++#define rPdp_AntA_4 0xb04 ++#define rPdp_AntA_8 0xb08 ++#define rPdp_AntA_C 0xb0c ++#define rPdp_AntA_10 0xb10 ++#define rPdp_AntA_14 0xb14 ++#define rPdp_AntA_18 0xb18 ++#define rPdp_AntA_1C 0xb1c ++#define rPdp_AntA_20 0xb20 ++#define rPdp_AntA_24 0xb24 ++ ++#define rConfig_Pmpd_AntA 0xb28 ++#define rConfig_ram64x16 0xb2c ++ ++#define rBndA 0xb30 ++#define rHssiPar 0xb34 ++ ++#define rConfig_AntA 0xb68 ++#define rConfig_AntB 0xb6c ++ ++#define rPdp_AntB 0xb70 ++#define rPdp_AntB_4 0xb74 ++#define rPdp_AntB_8 0xb78 ++#define rPdp_AntB_C 0xb7c ++#define rPdp_AntB_10 0xb80 ++#define rPdp_AntB_14 0xb84 ++#define rPdp_AntB_18 0xb88 ++#define rPdp_AntB_1C 0xb8c ++#define rPdp_AntB_20 0xb90 ++#define rPdp_AntB_24 0xb94 ++ ++#define rConfig_Pmpd_AntB 0xb98 ++ ++#define rBndB 0xba0 ++ ++#define rAPK 0xbd8 ++#define rPm_Rx0_AntA 0xbdc ++#define rPm_Rx1_AntA 0xbe0 ++#define rPm_Rx2_AntA 0xbe4 ++#define rPm_Rx3_AntA 0xbe8 ++#define rPm_Rx0_AntB 0xbec ++#define rPm_Rx1_AntB 0xbf0 ++#define rPm_Rx2_AntB 0xbf4 ++#define rPm_Rx3_AntB 0xbf8 ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8188FPwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188FPwrSeq.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8188FPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188FPwrSeq.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,198 @@ ++#ifndef REALTEK_POWER_SEQUENCE_8188F ++#define REALTEK_POWER_SEQUENCE_8188F ++ ++#include "HalPwrSeqCmd.h" ++ ++/* ++ Check document WM-20130815-JackieLau-RTL8188F_Power_Architecture v08.vsd ++ There are 6 HW Power States: ++ 0: POFF--Power Off ++ 1: PDN--Power Down ++ 2: CARDEMU--Card Emulation ++ 3: ACT--Active Mode ++ 4: LPS--Low Power State ++ 5: SUS--Suspend ++ ++ The transision from different states are defined below ++ TRANS_CARDEMU_TO_ACT ++ TRANS_ACT_TO_CARDEMU ++ TRANS_CARDEMU_TO_SUS ++ TRANS_SUS_TO_CARDEMU ++ TRANS_CARDEMU_TO_PDN ++ TRANS_ACT_TO_LPS ++ TRANS_LPS_TO_ACT ++ ++ TRANS_END ++*/ ++#define RTL8188F_TRANS_CARDEMU_TO_ACT_STEPS 13 ++#define RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS 15 ++#define RTL8188F_TRANS_CARDEMU_TO_SUS_STEPS 14 ++#define RTL8188F_TRANS_SUS_TO_CARDEMU_STEPS 15 ++#define RTL8188F_TRANS_CARDEMU_TO_PDN_STEPS 15 ++#define RTL8188F_TRANS_PDN_TO_CARDEMU_STEPS 15 ++#define RTL8188F_TRANS_ACT_TO_LPS_STEPS 11 ++#define RTL8188F_TRANS_LPS_TO_ACT_STEPS 13 ++#define RTL8188F_TRANS_ACT_TO_SWLPS_STEPS 21 ++#define RTL8188F_TRANS_SWLPS_TO_ACT_STEPS 14 ++#define RTL8188F_TRANS_END_STEPS 1 ++ ++ ++#define RTL8188F_TRANS_CARDEMU_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT3), 0},/* 0x4[11]=1'b0 disable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* 0x4[8]=1 polling until return 0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ ++ {0x0027, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x35}, /*0x27<=35 to reduce RF noise*/ ++ ++#define RTL8188F_TRANS_ACT_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ ++ {0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/*0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ ++ {0x0027, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x34}, /*0x27 <= 34, xtal_qsel = 0 to xtal bring up*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ ++ ++#define RTL8188F_TRANS_CARDEMU_TO_SUS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00}, /*0x07 = 0x00 , SOP option to disable BG/MB*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ \ ++ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4},/* 0xC4[4] <= 1, turn off USB APHY LDO under suspend mode*/ ++ ++#define RTL8188F_TRANS_SUS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ \ ++ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0},/* 0xC4[4] <= 1, turn off USB APHY LDO under suspend mode*/ ++ ++#define RTL8188F_TRANS_CARDEMU_TO_CARDDIS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00}, /*0x07 = 0x00 , SOP option to disable BG/MB*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ \ ++ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4},/* 0xC4[4] <= 1, turn off USB APHY LDO under suspend mode*/ ++ ++#define RTL8188F_TRANS_CARDDIS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ \ ++ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0},/* 0xC4[4] <= 1, turn off USB APHY LDO under suspend mode*/ ++ ++ ++#define RTL8188F_TRANS_CARDEMU_TO_PDN \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ ++ ++#define RTL8188F_TRANS_PDN_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ ++ ++#define RTL8188F_TRANS_ACT_TO_LPS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0139, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*set RPWM IMR*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ ++ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x3F},/*Reset MAC TRX*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ ++ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ ++ ++ ++#define RTL8188F_TRANS_LPS_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ ++ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ ++ {0x0027, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x35},/*xtal_qsel = 1 for low noise*/ \ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ ++ {0x002B, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x1c, 0x1c}, /*. 0x2b[4:2] = 3b'111 to enable BB, AFE clock*/\ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ ++ ++ ++#define RTL8188F_TRANS_ACT_TO_SWLPS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0139, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*set RPWM IMR*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ ++ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x3F},/*Reset MAC TRX*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ ++ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ ++ {0x002b, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x1C, 0x00},/*0x2b[4:2]<=0 to gated BB, AFE clock*/ \ ++ {0x0027, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x34},/*xtal_qsel = 0 for bring up*/ \ ++ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x00},/* sdio LPS option*/ \ ++ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x83},/* usb LPS option, open bandgap, xtal*/ \ ++ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0}, /* 0xC4[5]<=0, digital LDO no standby mode*/ \ ++ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7}, /* 0xC4[7]<=1, on domain voltage adjust*/ \ ++ {0x00a7, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0xe0}, /* low power LPS enable for sdio*/ \ ++ {0x00a7, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0xe4}, /* low power LPS enable for usb*/ \ ++ {0x0090, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /* enable WL_LPS_EN*/ ++ ++ ++#define RTL8188F_TRANS_SWLPS_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/*polling TSF stable*/\ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1, enable security engine*/\ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ ++ {0x06B7, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x09}, /*. reset MAC rx state machine*/\ ++ {0x06B4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x86}, /*. reset MAC rx state machine*/\ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/* set CPU RAM code ready*/ \ ++ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*Reset CPU IO Wrapper*/ \ ++ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* Enable CPU*/ \ ++ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*enable CPU IO Wrapper*/ \ ++ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2},/* Enable CPU*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, BIT7},/*polling FW init ready */ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT6, BIT6},/*polling FW init ready */ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ ++ ++#define RTL8188F_TRANS_END \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, ++ ++ ++ extern WLAN_PWR_CFG rtl8188F_power_on_flow[RTL8188F_TRANS_CARDEMU_TO_ACT_STEPS + RTL8188F_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188F_radio_off_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188F_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188F_card_disable_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188F_TRANS_CARDEMU_TO_PDN_STEPS + RTL8188F_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188F_card_enable_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188F_TRANS_CARDEMU_TO_PDN_STEPS + RTL8188F_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188F_suspend_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188F_TRANS_CARDEMU_TO_SUS_STEPS + RTL8188F_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188F_resume_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188F_TRANS_CARDEMU_TO_SUS_STEPS + RTL8188F_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188F_hwpdn_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188F_TRANS_CARDEMU_TO_PDN_STEPS + RTL8188F_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188F_enter_lps_flow[RTL8188F_TRANS_ACT_TO_LPS_STEPS + RTL8188F_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188F_leave_lps_flow[RTL8188F_TRANS_LPS_TO_ACT_STEPS + RTL8188F_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188F_enter_swlps_flow[RTL8188F_TRANS_ACT_TO_SWLPS_STEPS + RTL8188F_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8188F_leave_swlps_flow[RTL8188F_TRANS_SWLPS_TO_ACT_STEPS + RTL8188F_TRANS_END_STEPS]; ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8192EPhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8192EPhyCfg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8192EPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8192EPhyCfg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,153 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8192EPHYCFG_H__ ++#define __INC_HAL8192EPHYCFG_H__ ++ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++#define LOOP_LIMIT 5 ++#define MAX_STALL_TIME 50 /* us */ ++#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ ++#define MAX_TXPWR_IDX_NMODE_92S 63 ++#define Reset_Cnt_Limit 3 ++ ++#ifdef CONFIG_PCI_HCI ++ #define MAX_AGGR_NUM 0x0B ++#else ++ #define MAX_AGGR_NUM 0x07 ++#endif /* CONFIG_PCI_HCI */ ++ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++ ++/*------------------------------Define structure----------------------------*/ ++ ++/* BB/RF related */ ++ ++/*------------------------------Define structure----------------------------*/ ++ ++ ++/*------------------------Export global variable----------------------------*/ ++/*------------------------Export global variable----------------------------*/ ++ ++ ++/*------------------------Export Marco Definition---------------------------*/ ++/*------------------------Export Marco Definition---------------------------*/ ++ ++ ++/*--------------------------Exported Function prototype---------------------*/ ++/* ++ * BB and RF register read/write ++ * */ ++u32 PHY_QueryBBReg8192E(IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask); ++void PHY_SetBBReg8192E(IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data); ++u32 PHY_QueryRFReg8192E(IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask); ++void PHY_SetRFReg8192E(IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data); ++ ++/* ++ * Initialization related function ++ * ++ * MAC/BB/RF HAL config */ ++int PHY_MACConfig8192E(IN PADAPTER Adapter); ++int PHY_BBConfig8192E(IN PADAPTER Adapter); ++int PHY_RFConfig8192E(IN PADAPTER Adapter); ++ ++/* RF config */ ++ ++ ++/* ++ * BB TX Power R/W ++ * */ ++void PHY_GetTxPowerLevel8192E(IN PADAPTER Adapter, OUT s32 *powerlevel); ++void PHY_SetTxPowerLevel8192E(IN PADAPTER Adapter, IN u8 channel); ++BOOLEAN PHY_UpdateTxPowerDbm8192E(IN PADAPTER Adapter, IN int powerInDbm); ++ ++VOID ++PHY_SetTxPowerIndex_8192E( ++ IN PADAPTER Adapter, ++ IN u32 PowerIndex, ++ IN u8 RFPath, ++ IN u8 Rate ++); ++ ++u8 ++PHY_GetTxPowerIndex_8192E( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN u8 BandWidth, ++ IN u8 Channel, ++ struct txpwr_idx_comp *tic ++); ++ ++/* ++ * channel switch related funciton ++ * */ ++VOID ++PHY_SetSwChnlBWMode8192E( ++ IN PADAPTER Adapter, ++ IN u8 channel, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 Offset40, ++ IN u8 Offset80 ++); ++ ++VOID ++PHY_SetRFEReg_8192E( ++ IN PADAPTER Adapter ++); ++ ++void ++phy_SpurCalibration_8192E( ++ IN PADAPTER Adapter, ++ IN SPUR_CAL_METHOD Method ++); ++void PHY_SpurCalibration_8192E(IN PADAPTER Adapter); ++ ++#ifdef CONFIG_SPUR_CAL_NBI ++void ++phy_SpurCalibration_8192E_NBI( ++ IN PADAPTER Adapter ++); ++#endif ++/* ++ * BB/MAC/RF other monitor API ++ * */ ++ ++VOID ++PHY_SetRFPathSwitch_8192E( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bMain ++); ++ ++/*--------------------------Exported Function prototype---------------------*/ ++#endif /* __INC_HAL8192CPHYCFG_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8192EPhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8192EPhyReg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8192EPhyReg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8192EPhyReg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,1132 @@ ++/***************************************************************************** ++ * Copyright(c) 2008, RealTEK Technology Inc. All Right Reserved. ++ * ++ * Module: __INC_HAL8192SPHYREG_H ++ * ++ * ++ * Note: 1. Define PMAC/BB register map ++ * 2. Define RF register map ++ * 3. PMAC/BB register bit mask. ++ * 4. RF reg bit mask. ++ * 5. Other BB/RF relative definition. ++ * ++ * ++ * Export: Constants, macro, functions(API), global variables(None). ++ * ++ * Abbrev: ++ * ++ * History: ++ * Data Who Remark ++ * 08/07/2007 MHC 1. Porting from 9x series PHYCFG.h. ++ * 2. Reorganize code architecture. ++ * 09/25/2008 MH 1. Add RL6052 register definition ++ * ++ *****************************************************************************/ ++#ifndef __INC_HAL8192EPHYREG_H ++#define __INC_HAL8192EPHYREG_H ++ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++ ++/* ************************************************************ ++ * 8192S Regsiter offset definition ++ * ************************************************************ */ ++ ++/* ++ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 ++ * 3. RF register 0x00-2E ++ * 4. Bit Mask for BB/RF register ++ * 5. Other defintion for BB/RF R/W ++ * */ ++ ++ ++/* ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 1. Page1(0x100) ++ * */ ++#define rPMAC_Reset 0x100 ++#define rPMAC_TxStart 0x104 ++#define rPMAC_TxLegacySIG 0x108 ++#define rPMAC_TxHTSIG1 0x10c ++#define rPMAC_TxHTSIG2 0x110 ++#define rPMAC_PHYDebug 0x114 ++#define rPMAC_TxPacketNum 0x118 ++#define rPMAC_TxIdle 0x11c ++#define rPMAC_TxMACHeader0 0x120 ++#define rPMAC_TxMACHeader1 0x124 ++#define rPMAC_TxMACHeader2 0x128 ++#define rPMAC_TxMACHeader3 0x12c ++#define rPMAC_TxMACHeader4 0x130 ++#define rPMAC_TxMACHeader5 0x134 ++#define rPMAC_TxDataType 0x138 ++#define rPMAC_TxRandomSeed 0x13c ++#define rPMAC_CCKPLCPPreamble 0x140 ++#define rPMAC_CCKPLCPHeader 0x144 ++#define rPMAC_CCKCRC16 0x148 ++#define rPMAC_OFDMRxCRC32OK 0x170 ++#define rPMAC_OFDMRxCRC32Er 0x174 ++#define rPMAC_OFDMRxParityEr 0x178 ++#define rPMAC_OFDMRxCRC8Er 0x17c ++#define rPMAC_CCKCRxRC16Er 0x180 ++#define rPMAC_CCKCRxRC32Er 0x184 ++#define rPMAC_CCKCRxRC32OK 0x188 ++#define rPMAC_TxStatus 0x18c ++ ++ ++/* ++ * 3. Page8(0x800) ++ * */ ++#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ ++ ++#define rFPGA0_TxInfo 0x804 /* Status report?? */ ++#define rFPGA0_PSDFunction 0x808 ++ ++#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ ++ ++#define rFPGA0_RFTiming1 0x810 /* Useless now */ ++#define rFPGA0_RFTiming2 0x814 ++ ++#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ ++#define rFPGA0_XA_HSSIParameter2 0x824 ++#define rFPGA0_XB_HSSIParameter1 0x828 ++#define rFPGA0_XB_HSSIParameter2 0x82c ++ ++#define rFPGA0_XA_LSSIParameter 0x840 ++#define rFPGA0_XB_LSSIParameter 0x844 ++ ++#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ ++#define rFPGA0_RFSleepUpParameter 0x854 ++ ++#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ ++#define rFPGA0_XCD_SwitchControl 0x85c ++ ++#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ ++#define rFPGA0_XB_RFInterfaceOE 0x864 ++ ++#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ ++#define rFPGA0_XCD_RFInterfaceSW 0x874 ++ ++#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ ++#define rFPGA0_XCD_RFParameter 0x87c ++ ++#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ ++#define rFPGA0_AnalogParameter2 0x884 ++#define rFPGA0_AnalogParameter3 0x888 ++#define rFPGA0_AdDaClockEn 0x888 /* enable ad/da clock1 for dual-phy */ ++#define rFPGA0_AnalogParameter4 0x88c ++ ++#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ ++#define rFPGA0_XB_LSSIReadBack 0x8a4 ++#define rFPGA0_XC_LSSIReadBack 0x8a8 ++#define rFPGA0_XD_LSSIReadBack 0x8ac ++ ++#define rFPGA0_PSDReport 0x8b4 /* Useless now */ ++#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ ++#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ ++#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ ++#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ ++ ++/* ++ * 4. Page9(0x900) ++ * */ ++#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ ++ ++#define rFPGA1_TxBlock 0x904 /* Useless now */ ++#define rFPGA1_DebugSelect 0x908 /* Useless now */ ++#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ ++ ++/* ++ * 5. PageA(0xA00) ++ * ++ * Set Control channel to upper or lower. These settings are required only for 40MHz */ ++#define rCCK0_System 0xa00 ++ ++#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ ++#define rCCK0_CCA 0xa08 /* Disable init gain now */ /* Init gain */ ++ ++#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level */ /* Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ ++#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ ++ ++#define rCCK0_RxHP 0xa14 ++ ++#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ ++#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ ++ ++#define rCCK0_TxFilter1 0xa20 ++#define rCCK0_TxFilter2 0xa24 ++#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ ++#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ ++#define rCCK0_TRSSIReport 0xa50 ++#define rCCK0_RxReport 0xa54 /* 0xa57 */ ++#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ ++#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ ++ ++/* ++ * PageB(0xB00) ++ * */ ++#define rPdp_AntA 0xb00 ++#define rPdp_AntA_4 0xb04 ++#define rConfig_Pmpd_AntA 0xb28 ++#define rConfig_ram64x16 0xb2c ++ ++#define rConfig_AntA 0xb68 ++#define rConfig_AntB 0xb6c ++#define rPdp_AntB 0xb70 ++#define rPdp_AntB_4 0xb74 ++#define rConfig_Pmpd_AntB 0xb98 ++#define rAPK 0xbd8 ++ ++ ++ ++/* ++ * 6. PageC(0xC00) ++ * */ ++#define rOFDM0_LSTF 0xc00 ++ ++#define rOFDM0_TRxPathEnable 0xc04 ++#define rOFDM0_TRMuxPar 0xc08 ++#define rOFDM0_TRSWIsolation 0xc0c ++ ++#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ ++#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ ++#define rOFDM0_XBRxAFE 0xc18 ++#define rOFDM0_XBRxIQImbalance 0xc1c ++#define rOFDM0_XCRxAFE 0xc20 ++#define rOFDM0_XCRxIQImbalance 0xc24 ++#define rOFDM0_XDRxAFE 0xc28 ++#define rOFDM0_XDRxIQImbalance 0xc2c ++ ++#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ ++#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ ++#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ ++#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ ++ ++#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ ++#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ ++#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ ++#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ ++ ++#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ ++#define rOFDM0_XAAGCCore2 0xc54 ++#define rOFDM0_XBAGCCore1 0xc58 ++#define rOFDM0_XBAGCCore2 0xc5c ++#define rOFDM0_XCAGCCore1 0xc60 ++#define rOFDM0_XCAGCCore2 0xc64 ++#define rOFDM0_XDAGCCore1 0xc68 ++#define rOFDM0_XDAGCCore2 0xc6c ++ ++#define rOFDM0_AGCParameter1 0xc70 ++#define rOFDM0_AGCParameter2 0xc74 ++#define rOFDM0_AGCRSSITable 0xc78 ++#define rOFDM0_HTSTFAGC 0xc7c ++ ++#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ ++#define rOFDM0_XATxAFE 0xc84 ++#define rOFDM0_XBTxIQImbalance 0xc88 ++#define rOFDM0_XBTxAFE 0xc8c ++#define rOFDM0_XCTxIQImbalance 0xc90 ++#define rOFDM0_XCTxAFE 0xc94 ++#define rOFDM0_XDTxIQImbalance 0xc98 ++#define rOFDM0_XDTxAFE 0xc9c ++ ++#define rOFDM0_RxIQExtAnta 0xca0 ++#define rOFDM0_TxCoeff1 0xca4 ++#define rOFDM0_TxCoeff2 0xca8 ++#define rOFDM0_TxCoeff3 0xcac ++#define rOFDM0_TxCoeff4 0xcb0 ++#define rOFDM0_TxCoeff5 0xcb4 ++#define rOFDM0_RxHPParameter 0xce0 ++#define rOFDM0_TxPseudoNoiseWgt 0xce4 ++#define rOFDM0_FrameSync 0xcf0 ++#define rOFDM0_DFSReport 0xcf4 ++ ++ ++/* ++ * 7. PageD(0xD00) ++ * */ ++#define rOFDM1_LSTF 0xd00 ++#define rOFDM1_TRxPathEnable 0xd04 ++ ++#define rOFDM1_CFO 0xd08 /* No setting now */ ++#define rOFDM1_CSI1 0xd10 ++#define rOFDM1_SBD 0xd14 ++#define rOFDM1_CSI2 0xd18 ++#define rOFDM1_CFOTracking 0xd2c ++#define rOFDM1_TRxMesaure1 0xd34 ++#define rOFDM1_IntfDet 0xd3c ++#define rOFDM1_PseudoNoiseStateAB 0xd50 ++#define rOFDM1_PseudoNoiseStateCD 0xd54 ++#define rOFDM1_RxPseudoNoiseWgt 0xd58 ++ ++#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ ++#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ ++#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ ++ ++#define rOFDM_ShortCFOAB 0xdac /* No setting now */ ++#define rOFDM_ShortCFOCD 0xdb0 ++#define rOFDM_LongCFOAB 0xdb4 ++#define rOFDM_LongCFOCD 0xdb8 ++#define rOFDM_TailCFOAB 0xdbc ++#define rOFDM_TailCFOCD 0xdc0 ++#define rOFDM_PWMeasure1 0xdc4 ++#define rOFDM_PWMeasure2 0xdc8 ++#define rOFDM_BWReport 0xdcc ++#define rOFDM_AGCReport 0xdd0 ++#define rOFDM_RxSNR 0xdd4 ++#define rOFDM_RxEVMCSI 0xdd8 ++#define rOFDM_SIGReport 0xddc ++ ++ ++/* ++ * 8. PageE(0xE00) ++ * */ ++#define rTxAGC_A_Rate18_06 0xe00 ++#define rTxAGC_A_Rate54_24 0xe04 ++#define rTxAGC_A_CCK1_Mcs32 0xe08 ++#define rTxAGC_A_Mcs03_Mcs00 0xe10 ++#define rTxAGC_A_Mcs07_Mcs04 0xe14 ++#define rTxAGC_A_Mcs11_Mcs08 0xe18 ++#define rTxAGC_A_Mcs15_Mcs12 0xe1c ++ ++#define rTxAGC_B_Rate18_06 0x830 ++#define rTxAGC_B_Rate54_24 0x834 ++#define rTxAGC_B_CCK1_55_Mcs32 0x838 ++#define rTxAGC_B_Mcs03_Mcs00 0x83c ++#define rTxAGC_B_Mcs07_Mcs04 0x848 ++#define rTxAGC_B_Mcs11_Mcs08 0x84c ++#define rTxAGC_B_Mcs15_Mcs12 0x868 ++#define rTxAGC_B_CCK11_A_CCK2_11 0x86c ++ ++#define rFPGA0_IQK 0xe28 ++#define rTx_IQK_Tone_A 0xe30 ++#define rRx_IQK_Tone_A 0xe34 ++#define rTx_IQK_PI_A 0xe38 ++#define rRx_IQK_PI_A 0xe3c ++ ++#define rTx_IQK 0xe40 ++#define rRx_IQK 0xe44 ++#define rIQK_AGC_Pts 0xe48 ++#define rIQK_AGC_Rsp 0xe4c ++#define rTx_IQK_Tone_B 0xe50 ++#define rRx_IQK_Tone_B 0xe54 ++#define rTx_IQK_PI_B 0xe58 ++#define rRx_IQK_PI_B 0xe5c ++#define rIQK_AGC_Cont 0xe60 ++ ++#define rBlue_Tooth 0xe6c ++#define rRx_Wait_CCA 0xe70 ++#define rTx_CCK_RFON 0xe74 ++#define rTx_CCK_BBON 0xe78 ++#define rTx_OFDM_RFON 0xe7c ++#define rTx_OFDM_BBON 0xe80 ++#define rTx_To_Rx 0xe84 ++#define rTx_To_Tx 0xe88 ++#define rRx_CCK 0xe8c ++ ++#define rTx_Power_Before_IQK_A 0xe94 ++#define rTx_Power_After_IQK_A 0xe9c ++ ++#define rRx_Power_Before_IQK_A 0xea0 ++#define rRx_Power_Before_IQK_A_2 0xea4 ++#define rRx_Power_After_IQK_A 0xea8 ++#define rRx_Power_After_IQK_A_2 0xeac ++ ++#define rTx_Power_Before_IQK_B 0xeb4 ++#define rTx_Power_After_IQK_B 0xebc ++ ++#define rRx_Power_Before_IQK_B 0xec0 ++#define rRx_Power_Before_IQK_B_2 0xec4 ++#define rRx_Power_After_IQK_B 0xec8 ++#define rRx_Power_After_IQK_B_2 0xecc ++ ++#define rRx_OFDM 0xed0 ++#define rRx_Wait_RIFS 0xed4 ++#define rRx_TO_Rx 0xed8 ++#define rStandby 0xedc ++#define rSleep 0xee0 ++#define rPMPD_ANAEN 0xeec ++ ++/* ++ * 7. RF Register 0x00-0x2E (RF 8256) ++ * RF-0222D 0x00-3F ++ * ++ * Zebra1 */ ++#define rZebra1_HSSIEnable 0x0 /* Useless now */ ++#define rZebra1_TRxEnable1 0x1 ++#define rZebra1_TRxEnable2 0x2 ++#define rZebra1_AGC 0x4 ++#define rZebra1_ChargePump 0x5 ++#define rZebra1_Channel 0x7 /* RF channel switch */ ++ ++/* #endif */ ++#define rZebra1_TxGain 0x8 /* Useless now */ ++#define rZebra1_TxLPF 0x9 ++#define rZebra1_RxLPF 0xb ++#define rZebra1_RxHPFCorner 0xc ++ ++/* Zebra4 */ ++#define rGlobalCtrl 0 /* Useless now */ ++#define rRTL8256_TxLPF 19 ++#define rRTL8256_RxLPF 11 ++ ++/* RTL8258 */ ++#define rRTL8258_TxLPF 0x11 /* Useless now */ ++#define rRTL8258_RxLPF 0x13 ++#define rRTL8258_RSSILPF 0xa ++ ++/* ++ * RL6052 Register definition ++ * */ ++#define RF_AC 0x00 /* */ ++ ++#define RF_IQADJ_G1 0x01 /* */ ++#define RF_IQADJ_G2 0x02 /* */ ++ ++#define RF_POW_TRSW 0x05 /* */ ++ ++#define RF_GAIN_RX 0x06 /* */ ++#define RF_GAIN_TX 0x07 /* */ ++ ++#define RF_TXM_IDAC 0x08 /* */ ++#define RF_IPA_G 0x09 /* */ ++#define RF_TXBIAS_G 0x0A ++#define RF_TXPA_AG 0x0B ++#define RF_IPA_A 0x0C /* */ ++#define RF_TXBIAS_A 0x0D ++#define RF_BS_PA_APSET_G9_G11 0x0E ++#define RF_BS_IQGEN 0x0F /* */ ++ ++#define RF_MODE1 0x10 /* */ ++#define RF_MODE2 0x11 /* */ ++ ++#define RF_RX_AGC_HP 0x12 /* */ ++#define RF_TX_AGC 0x13 /* */ ++#define RF_BIAS 0x14 /* */ ++#define RF_IPA 0x15 /* */ ++#define RF_TXBIAS 0x16 ++#define RF_POW_ABILITY 0x17 /* */ ++#define RF_CHNLBW 0x18 /* RF channel and BW switch */ ++#define RF_TOP 0x19 /* */ ++ ++#define RF_RX_G1 0x1A /* */ ++#define RF_RX_G2 0x1B /* */ ++ ++#define RF_RX_BB2 0x1C /* */ ++#define RF_RX_BB1 0x1D /* */ ++ ++#define RF_RCK1 0x1E /* */ ++#define RF_RCK2 0x1F /* */ ++ ++#define RF_TX_G1 0x20 /* */ ++#define RF_TX_G2 0x21 /* */ ++#define RF_TX_G3 0x22 /* */ ++ ++#define RF_TX_BB1 0x23 /* */ ++ ++#define RF_T_METER_8192E 0x42 /* */ ++#define RF_T_METER_88E 0x42 ++#define RF_T_METER 0x24 /* */ ++ ++/* #endif */ ++ ++#define RF_SYN_G1 0x25 /* RF TX Power control */ ++#define RF_SYN_G2 0x26 /* RF TX Power control */ ++#define RF_SYN_G3 0x27 /* RF TX Power control */ ++#define RF_SYN_G4 0x28 /* RF TX Power control */ ++#define RF_SYN_G5 0x29 /* RF TX Power control */ ++#define RF_SYN_G6 0x2A /* RF TX Power control */ ++#define RF_SYN_G7 0x2B /* RF TX Power control */ ++#define RF_SYN_G8 0x2C /* RF TX Power control */ ++ ++#define RF_RCK_OS 0x30 /* RF TX PA control */ ++#define RF_TXPA_G1 0x31 /* RF TX PA control */ ++#define RF_TXPA_G2 0x32 /* RF TX PA control */ ++#define RF_TXPA_G3 0x33 /* RF TX PA control */ ++#define RF_TX_BIAS_A 0x35 ++#define RF_TX_BIAS_D 0x36 ++#define RF_LOBF_9 0x38 ++#define RF_RXRF_A3 0x3C /* */ ++#define RF_TRSW 0x3F ++ ++#define RF_TXRF_A2 0x41 ++#define RF_TXPA_G4 0x46 ++#define RF_TXPA_A4 0x4B ++#define RF_0x52 0x52 ++#define RF_LDO 0xB1 ++#define RF_WE_LUT 0xEF ++ ++ ++/* ++ * Bit Mask ++ * ++ * 1. Page1(0x100) */ ++#define bBBResetB 0x100 /* Useless now? */ ++#define bGlobalResetB 0x200 ++#define bOFDMTxStart 0x4 ++#define bCCKTxStart 0x8 ++#define bCRC32Debug 0x100 ++#define bPMACLoopback 0x10 ++#define bTxLSIG 0xffffff ++#define bOFDMTxRate 0xf ++#define bOFDMTxReserved 0x10 ++#define bOFDMTxLength 0x1ffe0 ++#define bOFDMTxParity 0x20000 ++#define bTxHTSIG1 0xffffff ++#define bTxHTMCSRate 0x7f ++#define bTxHTBW 0x80 ++#define bTxHTLength 0xffff00 ++#define bTxHTSIG2 0xffffff ++#define bTxHTSmoothing 0x1 ++#define bTxHTSounding 0x2 ++#define bTxHTReserved 0x4 ++#define bTxHTAggreation 0x8 ++#define bTxHTSTBC 0x30 ++#define bTxHTAdvanceCoding 0x40 ++#define bTxHTShortGI 0x80 ++#define bTxHTNumberHT_LTF 0x300 ++#define bTxHTCRC8 0x3fc00 ++#define bCounterReset 0x10000 ++#define bNumOfOFDMTx 0xffff ++#define bNumOfCCKTx 0xffff0000 ++#define bTxIdleInterval 0xffff ++#define bOFDMService 0xffff0000 ++#define bTxMACHeader 0xffffffff ++#define bTxDataInit 0xff ++#define bTxHTMode 0x100 ++#define bTxDataType 0x30000 ++#define bTxRandomSeed 0xffffffff ++#define bCCKTxPreamble 0x1 ++#define bCCKTxSFD 0xffff0000 ++#define bCCKTxSIG 0xff ++#define bCCKTxService 0xff00 ++#define bCCKLengthExt 0x8000 ++#define bCCKTxLength 0xffff0000 ++#define bCCKTxCRC16 0xffff ++#define bCCKTxStatus 0x1 ++#define bOFDMTxStatus 0x2 ++ ++#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) ++#define RF_TX_GAIN_OFFSET_8192E(_val) ((abs((_val)) << 1) | (((_val) > 0) ? BIT0 : 0)) ++ ++ ++/* 2. Page8(0x800) */ ++#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ ++#define bJapanMode 0x2 ++#define bCCKTxSC 0x30 ++#define bCCKEn 0x1000000 ++#define bOFDMEn 0x2000000 ++ ++#define bOFDMRxADCPhase 0x10000 /* Useless now */ ++#define bOFDMTxDACPhase 0x40000 ++#define bXATxAGC 0x3f ++ ++#define bAntennaSelect 0x0300 ++ ++#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ ++#define bXCTxAGC 0xf000 ++#define bXDTxAGC 0xf0000 ++ ++#define bPAStart 0xf0000000 /* Useless now */ ++#define bTRStart 0x00f00000 ++#define bRFStart 0x0000f000 ++#define bBBStart 0x000000f0 ++#define bBBCCKStart 0x0000000f ++#define bPAEnd 0xf /* Reg0x814 */ ++#define bTREnd 0x0f000000 ++#define bRFEnd 0x000f0000 ++#define bCCAMask 0x000000f0 /* T2R */ ++#define bR2RCCAMask 0x00000f00 ++#define bHSSI_R2TDelay 0xf8000000 ++#define bHSSI_T2RDelay 0xf80000 ++#define bContTxHSSI 0x400 /* chane gain at continue Tx */ ++#define bIGFromCCK 0x200 ++#define bAGCAddress 0x3f ++#define bRxHPTx 0x7000 ++#define bRxHPT2R 0x38000 ++#define bRxHPCCKIni 0xc0000 ++#define bAGCTxCode 0xc00000 ++#define bAGCRxCode 0x300000 ++ ++#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ ++#define b3WireAddressLength 0x400 ++ ++#define b3WireRFPowerDown 0x1 /* Useless now ++ * #define bHWSISelect 0x8 */ ++#define b5GPAPEPolarity 0x40000000 ++#define b2GPAPEPolarity 0x80000000 ++#define bRFSW_TxDefaultAnt 0x3 ++#define bRFSW_TxOptionAnt 0x30 ++#define bRFSW_RxDefaultAnt 0x300 ++#define bRFSW_RxOptionAnt 0x3000 ++#define bRFSI_3WireData 0x1 ++#define bRFSI_3WireClock 0x2 ++#define bRFSI_3WireLoad 0x4 ++#define bRFSI_3WireRW 0x8 ++#define bRFSI_3Wire 0xf ++ ++#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ ++ ++#define bRFSI_TRSW 0x20 /* Useless now */ ++#define bRFSI_TRSWB 0x40 ++#define bRFSI_ANTSW 0x100 ++#define bRFSI_ANTSWB 0x200 ++#define bRFSI_PAPE 0x400 ++#define bRFSI_PAPE5G 0x800 ++#define bBandSelect 0x1 ++#define bHTSIG2_GI 0x80 ++#define bHTSIG2_Smoothing 0x01 ++#define bHTSIG2_Sounding 0x02 ++#define bHTSIG2_Aggreaton 0x08 ++#define bHTSIG2_STBC 0x30 ++#define bHTSIG2_AdvCoding 0x40 ++#define bHTSIG2_NumOfHTLTF 0x300 ++#define bHTSIG2_CRC8 0x3fc ++#define bHTSIG1_MCS 0x7f ++#define bHTSIG1_BandWidth 0x80 ++#define bHTSIG1_HTLength 0xffff ++#define bLSIG_Rate 0xf ++#define bLSIG_Reserved 0x10 ++#define bLSIG_Length 0x1fffe ++#define bLSIG_Parity 0x20 ++#define bCCKRxPhase 0x4 ++ ++#define bLSSIReadAddress 0x7f800000 /* T65 RF */ ++ ++#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ ++ ++#define bLSSIReadBackData 0xfffff /* T65 RF */ ++ ++#define bLSSIReadOKFlag 0x1000 /* Useless now */ ++#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ ++#define bRegulator0Standby 0x1 ++#define bRegulatorPLLStandby 0x2 ++#define bRegulator1Standby 0x4 ++#define bPLLPowerUp 0x8 ++#define bDPLLPowerUp 0x10 ++#define bDA10PowerUp 0x20 ++#define bAD7PowerUp 0x200 ++#define bDA6PowerUp 0x2000 ++#define bXtalPowerUp 0x4000 ++#define b40MDClkPowerUP 0x8000 ++#define bDA6DebugMode 0x20000 ++#define bDA6Swing 0x380000 ++ ++#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ ++ ++#define b80MClkDelay 0x18000000 /* Useless */ ++#define bAFEWatchDogEnable 0x20000000 ++ ++#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ ++#define bXtalCap23 0x3 ++#define bXtalCap92x 0x0f000000 ++#define bXtalCap 0x0f000000 ++ ++#define bIntDifClkEnable 0x400 /* Useless */ ++#define bExtSigClkEnable 0x800 ++#define bBandgapMbiasPowerUp 0x10000 ++#define bAD11SHGain 0xc0000 ++#define bAD11InputRange 0x700000 ++#define bAD11OPCurrent 0x3800000 ++#define bIPathLoopback 0x4000000 ++#define bQPathLoopback 0x8000000 ++#define bAFELoopback 0x10000000 ++#define bDA10Swing 0x7e0 ++#define bDA10Reverse 0x800 ++#define bDAClkSource 0x1000 ++#define bAD7InputRange 0x6000 ++#define bAD7Gain 0x38000 ++#define bAD7OutputCMMode 0x40000 ++#define bAD7InputCMMode 0x380000 ++#define bAD7Current 0xc00000 ++#define bRegulatorAdjust 0x7000000 ++#define bAD11PowerUpAtTx 0x1 ++#define bDA10PSAtTx 0x10 ++#define bAD11PowerUpAtRx 0x100 ++#define bDA10PSAtRx 0x1000 ++#define bCCKRxAGCFormat 0x200 ++#define bPSDFFTSamplepPoint 0xc000 ++#define bPSDAverageNum 0x3000 ++#define bIQPathControl 0xc00 ++#define bPSDFreq 0x3ff ++#define bPSDAntennaPath 0x30 ++#define bPSDIQSwitch 0x40 ++#define bPSDRxTrigger 0x400000 ++#define bPSDTxTrigger 0x80000000 ++#define bPSDSineToneScale 0x7f000000 ++#define bPSDReport 0xffff ++ ++/* 3. Page9(0x900) */ ++#define bOFDMTxSC 0x30000000 /* Useless */ ++#define bCCKTxOn 0x1 ++#define bOFDMTxOn 0x2 ++#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ ++#define bDebugItem 0xff /* reset debug page and LWord */ ++#define bAntL 0x10 ++#define bAntNonHT 0x100 ++#define bAntHT1 0x1000 ++#define bAntHT2 0x10000 ++#define bAntHT1S1 0x100000 ++#define bAntNonHTS1 0x1000000 ++ ++/* 4. PageA(0xA00) */ ++#define bCCKBBMode 0x3 /* Useless */ ++#define bCCKTxPowerSaving 0x80 ++#define bCCKRxPowerSaving 0x40 ++ ++#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ ++ ++#define bCCKScramble 0x8 /* Useless */ ++#define bCCKAntDiversity 0x8000 ++#define bCCKCarrierRecovery 0x4000 ++#define bCCKTxRate 0x3000 ++#define bCCKDCCancel 0x0800 ++#define bCCKISICancel 0x0400 ++#define bCCKMatchFilter 0x0200 ++#define bCCKEqualizer 0x0100 ++#define bCCKPreambleDetect 0x800000 ++#define bCCKFastFalseCCA 0x400000 ++#define bCCKChEstStart 0x300000 ++#define bCCKCCACount 0x080000 ++#define bCCKcs_lim 0x070000 ++#define bCCKBistMode 0x80000000 ++#define bCCKCCAMask 0x40000000 ++#define bCCKTxDACPhase 0x4 ++#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ ++#define bCCKr_cp_mode0 0x0100 ++#define bCCKTxDCOffset 0xf0 ++#define bCCKRxDCOffset 0xf ++#define bCCKCCAMode 0xc000 ++#define bCCKFalseCS_lim 0x3f00 ++#define bCCKCS_ratio 0xc00000 ++#define bCCKCorgBit_sel 0x300000 ++#define bCCKPD_lim 0x0f0000 ++#define bCCKNewCCA 0x80000000 ++#define bCCKRxHPofIG 0x8000 ++#define bCCKRxIG 0x7f00 ++#define bCCKLNAPolarity 0x800000 ++#define bCCKRx1stGain 0x7f0000 ++#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ ++#define bCCKRxAGCSatLevel 0x1f000000 ++#define bCCKRxAGCSatCount 0xe0 ++#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ ++#define bCCKFixedRxAGC 0x8000 ++/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ ++#define bCCKAntennaPolarity 0x2000 ++#define bCCKTxFilterType 0x0c00 ++#define bCCKRxAGCReportType 0x0300 ++#define bCCKRxDAGCEn 0x80000000 ++#define bCCKRxDAGCPeriod 0x20000000 ++#define bCCKRxDAGCSatLevel 0x1f000000 ++#define bCCKTimingRecovery 0x800000 ++#define bCCKTxC0 0x3f0000 ++#define bCCKTxC1 0x3f000000 ++#define bCCKTxC2 0x3f ++#define bCCKTxC3 0x3f00 ++#define bCCKTxC4 0x3f0000 ++#define bCCKTxC5 0x3f000000 ++#define bCCKTxC6 0x3f ++#define bCCKTxC7 0x3f00 ++#define bCCKDebugPort 0xff0000 ++#define bCCKDACDebug 0x0f000000 ++#define bCCKFalseAlarmEnable 0x8000 ++#define bCCKFalseAlarmRead 0x4000 ++#define bCCKTRSSI 0x7f ++#define bCCKRxAGCReport 0xfe ++#define bCCKRxReport_AntSel 0x80000000 ++#define bCCKRxReport_MFOff 0x40000000 ++#define bCCKRxRxReport_SQLoss 0x20000000 ++#define bCCKRxReport_Pktloss 0x10000000 ++#define bCCKRxReport_Lockedbit 0x08000000 ++#define bCCKRxReport_RateError 0x04000000 ++#define bCCKRxReport_RxRate 0x03000000 ++#define bCCKRxFACounterLower 0xff ++#define bCCKRxFACounterUpper 0xff000000 ++#define bCCKRxHPAGCStart 0xe000 ++#define bCCKRxHPAGCFinal 0x1c00 ++#define bCCKRxFalseAlarmEnable 0x8000 ++#define bCCKFACounterFreeze 0x4000 ++#define bCCKTxPathSel 0x10000000 ++#define bCCKDefaultRxPath 0xc000000 ++#define bCCKOptionRxPath 0x3000000 ++ ++/* 5. PageC(0xC00) */ ++#define bNumOfSTF 0x3 /* Useless */ ++#define bShift_L 0xc0 ++#define bGI_TH 0xc ++#define bRxPathA 0x1 ++#define bRxPathB 0x2 ++#define bRxPathC 0x4 ++#define bRxPathD 0x8 ++#define bTxPathA 0x1 ++#define bTxPathB 0x2 ++#define bTxPathC 0x4 ++#define bTxPathD 0x8 ++#define bTRSSIFreq 0x200 ++#define bADCBackoff 0x3000 ++#define bDFIRBackoff 0xc000 ++#define bTRSSILatchPhase 0x10000 ++#define bRxIDCOffset 0xff ++#define bRxQDCOffset 0xff00 ++#define bRxDFIRMode 0x1800000 ++#define bRxDCNFType 0xe000000 ++#define bRXIQImb_A 0x3ff ++#define bRXIQImb_B 0xfc00 ++#define bRXIQImb_C 0x3f0000 ++#define bRXIQImb_D 0xffc00000 ++#define bDC_dc_Notch 0x60000 ++#define bRxNBINotch 0x1f000000 ++#define bPD_TH 0xf ++#define bPD_TH_Opt2 0xc000 ++#define bPWED_TH 0x700 ++#define bIfMF_Win_L 0x800 ++#define bPD_Option 0x1000 ++#define bMF_Win_L 0xe000 ++#define bBW_Search_L 0x30000 ++#define bwin_enh_L 0xc0000 ++#define bBW_TH 0x700000 ++#define bED_TH2 0x3800000 ++#define bBW_option 0x4000000 ++#define bRatio_TH 0x18000000 ++#define bWindow_L 0xe0000000 ++#define bSBD_Option 0x1 ++#define bFrame_TH 0x1c ++#define bFS_Option 0x60 ++#define bDC_Slope_check 0x80 ++#define bFGuard_Counter_DC_L 0xe00 ++#define bFrame_Weight_Short 0x7000 ++#define bSub_Tune 0xe00000 ++#define bFrame_DC_Length 0xe000000 ++#define bSBD_start_offset 0x30000000 ++#define bFrame_TH_2 0x7 ++#define bFrame_GI2_TH 0x38 ++#define bGI2_Sync_en 0x40 ++#define bSarch_Short_Early 0x300 ++#define bSarch_Short_Late 0xc00 ++#define bSarch_GI2_Late 0x70000 ++#define bCFOAntSum 0x1 ++#define bCFOAcc 0x2 ++#define bCFOStartOffset 0xc ++#define bCFOLookBack 0x70 ++#define bCFOSumWeight 0x80 ++#define bDAGCEnable 0x10000 ++#define bTXIQImb_A 0x3ff ++#define bTXIQImb_B 0xfc00 ++#define bTXIQImb_C 0x3f0000 ++#define bTXIQImb_D 0xffc00000 ++#define bTxIDCOffset 0xff ++#define bTxQDCOffset 0xff00 ++#define bTxDFIRMode 0x10000 ++#define bTxPesudoNoiseOn 0x4000000 ++#define bTxPesudoNoise_A 0xff ++#define bTxPesudoNoise_B 0xff00 ++#define bTxPesudoNoise_C 0xff0000 ++#define bTxPesudoNoise_D 0xff000000 ++#define bCCADropOption 0x20000 ++#define bCCADropThres 0xfff00000 ++#define bEDCCA_H 0xf ++#define bEDCCA_L 0xf0 ++#define bLambda_ED 0x300 ++#define bRxInitialGain 0x7f ++#define bRxAntDivEn 0x80 ++#define bRxAGCAddressForLNA 0x7f00 ++#define bRxHighPowerFlow 0x8000 ++#define bRxAGCFreezeThres 0xc0000 ++#define bRxFreezeStep_AGC1 0x300000 ++#define bRxFreezeStep_AGC2 0xc00000 ++#define bRxFreezeStep_AGC3 0x3000000 ++#define bRxFreezeStep_AGC0 0xc000000 ++#define bRxRssi_Cmp_En 0x10000000 ++#define bRxQuickAGCEn 0x20000000 ++#define bRxAGCFreezeThresMode 0x40000000 ++#define bRxOverFlowCheckType 0x80000000 ++#define bRxAGCShift 0x7f ++#define bTRSW_Tri_Only 0x80 ++#define bPowerThres 0x300 ++#define bRxAGCEn 0x1 ++#define bRxAGCTogetherEn 0x2 ++#define bRxAGCMin 0x4 ++#define bRxHP_Ini 0x7 ++#define bRxHP_TRLNA 0x70 ++#define bRxHP_RSSI 0x700 ++#define bRxHP_BBP1 0x7000 ++#define bRxHP_BBP2 0x70000 ++#define bRxHP_BBP3 0x700000 ++#define bRSSI_H 0x7f0000 /* the threshold for high power */ ++#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ ++#define bRxSettle_TRSW 0x7 ++#define bRxSettle_LNA 0x38 ++#define bRxSettle_RSSI 0x1c0 ++#define bRxSettle_BBP 0xe00 ++#define bRxSettle_RxHP 0x7000 ++#define bRxSettle_AntSW_RSSI 0x38000 ++#define bRxSettle_AntSW 0xc0000 ++#define bRxProcessTime_DAGC 0x300000 ++#define bRxSettle_HSSI 0x400000 ++#define bRxProcessTime_BBPPW 0x800000 ++#define bRxAntennaPowerShift 0x3000000 ++#define bRSSITableSelect 0xc000000 ++#define bRxHP_Final 0x7000000 ++#define bRxHTSettle_BBP 0x7 ++#define bRxHTSettle_HSSI 0x8 ++#define bRxHTSettle_RxHP 0x70 ++#define bRxHTSettle_BBPPW 0x80 ++#define bRxHTSettle_Idle 0x300 ++#define bRxHTSettle_Reserved 0x1c00 ++#define bRxHTRxHPEn 0x8000 ++#define bRxHTAGCFreezeThres 0x30000 ++#define bRxHTAGCTogetherEn 0x40000 ++#define bRxHTAGCMin 0x80000 ++#define bRxHTAGCEn 0x100000 ++#define bRxHTDAGCEn 0x200000 ++#define bRxHTRxHP_BBP 0x1c00000 ++#define bRxHTRxHP_Final 0xe0000000 ++#define bRxPWRatioTH 0x3 ++#define bRxPWRatioEn 0x4 ++#define bRxMFHold 0x3800 ++#define bRxPD_Delay_TH1 0x38 ++#define bRxPD_Delay_TH2 0x1c0 ++#define bRxPD_DC_COUNT_MAX 0x600 ++/* #define bRxMF_Hold 0x3800 */ ++#define bRxPD_Delay_TH 0x8000 ++#define bRxProcess_Delay 0xf0000 ++#define bRxSearchrange_GI2_Early 0x700000 ++#define bRxFrame_Guard_Counter_L 0x3800000 ++#define bRxSGI_Guard_L 0xc000000 ++#define bRxSGI_Search_L 0x30000000 ++#define bRxSGI_TH 0xc0000000 ++#define bDFSCnt0 0xff ++#define bDFSCnt1 0xff00 ++#define bDFSFlag 0xf0000 ++#define bMFWeightSum 0x300000 ++#define bMinIdxTH 0x7f000000 ++#define bDAFormat 0x40000 ++#define bTxChEmuEnable 0x01000000 ++#define bTRSWIsolation_A 0x7f ++#define bTRSWIsolation_B 0x7f00 ++#define bTRSWIsolation_C 0x7f0000 ++#define bTRSWIsolation_D 0x7f000000 ++#define bExtLNAGain 0x7c00 ++ ++/* 6. PageE(0xE00) */ ++#define bSTBCEn 0x4 /* Useless */ ++#define bAntennaMapping 0x10 ++#define bNss 0x20 ++#define bCFOAntSumD 0x200 ++#define bPHYCounterReset 0x8000000 ++#define bCFOReportGet 0x4000000 ++#define bOFDMContinueTx 0x10000000 ++#define bOFDMSingleCarrier 0x20000000 ++#define bOFDMSingleTone 0x40000000 ++/* #define bRxPath1 0x01 */ ++/* #define bRxPath2 0x02 */ ++/* #define bRxPath3 0x04 */ ++/* #define bRxPath4 0x08 */ ++/* #define bTxPath1 0x10 */ ++/* #define bTxPath2 0x20 */ ++#define bHTDetect 0x100 ++#define bCFOEn 0x10000 ++#define bCFOValue 0xfff00000 ++#define bSigTone_Re 0x3f ++#define bSigTone_Im 0x7f00 ++#define bCounter_CCA 0xffff ++#define bCounter_ParityFail 0xffff0000 ++#define bCounter_RateIllegal 0xffff ++#define bCounter_CRC8Fail 0xffff0000 ++#define bCounter_MCSNoSupport 0xffff ++#define bCounter_FastSync 0xffff ++#define bShortCFO 0xfff ++#define bShortCFOTLength 12 /* total */ ++#define bShortCFOFLength 11 /* fraction */ ++#define bLongCFO 0x7ff ++#define bLongCFOTLength 11 ++#define bLongCFOFLength 11 ++#define bTailCFO 0x1fff ++#define bTailCFOTLength 13 ++#define bTailCFOFLength 12 ++#define bmax_en_pwdB 0xffff ++#define bCC_power_dB 0xffff0000 ++#define bnoise_pwdB 0xffff ++#define bPowerMeasTLength 10 ++#define bPowerMeasFLength 3 ++#define bRx_HT_BW 0x1 ++#define bRxSC 0x6 ++#define bRx_HT 0x8 ++#define bNB_intf_det_on 0x1 ++#define bIntf_win_len_cfg 0x30 ++#define bNB_Intf_TH_cfg 0x1c0 ++#define bRFGain 0x3f ++#define bTableSel 0x40 ++#define bTRSW 0x80 ++#define bRxSNR_A 0xff ++#define bRxSNR_B 0xff00 ++#define bRxSNR_C 0xff0000 ++#define bRxSNR_D 0xff000000 ++#define bSNREVMTLength 8 ++#define bSNREVMFLength 1 ++#define bCSI1st 0xff ++#define bCSI2nd 0xff00 ++#define bRxEVM1st 0xff0000 ++#define bRxEVM2nd 0xff000000 ++#define bSIGEVM 0xff ++#define bPWDB 0xff00 ++#define bSGIEN 0x10000 ++ ++#define bSFactorQAM1 0xf /* Useless */ ++#define bSFactorQAM2 0xf0 ++#define bSFactorQAM3 0xf00 ++#define bSFactorQAM4 0xf000 ++#define bSFactorQAM5 0xf0000 ++#define bSFactorQAM6 0xf0000 ++#define bSFactorQAM7 0xf00000 ++#define bSFactorQAM8 0xf000000 ++#define bSFactorQAM9 0xf0000000 ++#define bCSIScheme 0x100000 ++ ++#define bNoiseLvlTopSet 0x3 /* Useless */ ++#define bChSmooth 0x4 ++#define bChSmoothCfg1 0x38 ++#define bChSmoothCfg2 0x1c0 ++#define bChSmoothCfg3 0xe00 ++#define bChSmoothCfg4 0x7000 ++#define bMRCMode 0x800000 ++#define bTHEVMCfg 0x7000000 ++ ++#define bLoopFitType 0x1 /* Useless */ ++#define bUpdCFO 0x40 ++#define bUpdCFOOffData 0x80 ++#define bAdvUpdCFO 0x100 ++#define bAdvTimeCtrl 0x800 ++#define bUpdClko 0x1000 ++#define bFC 0x6000 ++#define bTrackingMode 0x8000 ++#define bPhCmpEnable 0x10000 ++#define bUpdClkoLTF 0x20000 ++#define bComChCFO 0x40000 ++#define bCSIEstiMode 0x80000 ++#define bAdvUpdEqz 0x100000 ++#define bUChCfg 0x7000000 ++#define bUpdEqz 0x8000000 ++ ++/* Rx Pseduo noise */ ++#define bRxPesudoNoiseOn 0x20000000 /* Useless */ ++#define bRxPesudoNoise_A 0xff ++#define bRxPesudoNoise_B 0xff00 ++#define bRxPesudoNoise_C 0xff0000 ++#define bRxPesudoNoise_D 0xff000000 ++#define bPesudoNoiseState_A 0xffff ++#define bPesudoNoiseState_B 0xffff0000 ++#define bPesudoNoiseState_C 0xffff ++#define bPesudoNoiseState_D 0xffff0000 ++ ++/* 7. RF Register ++ * Zebra1 */ ++#define bZebra1_HSSIEnable 0x8 /* Useless */ ++#define bZebra1_TRxControl 0xc00 ++#define bZebra1_TRxGainSetting 0x07f ++#define bZebra1_RxCorner 0xc00 ++#define bZebra1_TxChargePump 0x38 ++#define bZebra1_RxChargePump 0x7 ++#define bZebra1_ChannelNum 0xf80 ++#define bZebra1_TxLPFBW 0x400 ++#define bZebra1_RxLPFBW 0x600 ++ ++/* Zebra4 */ ++#define bRTL8256RegModeCtrl1 0x100 /* Useless */ ++#define bRTL8256RegModeCtrl0 0x40 ++#define bRTL8256_TxLPFBW 0x18 ++#define bRTL8256_RxLPFBW 0x600 ++ ++/* RTL8258 */ ++#define bRTL8258_TxLPFBW 0xc /* Useless */ ++#define bRTL8258_RxLPFBW 0xc00 ++#define bRTL8258_RSSILPFBW 0xc0 ++ ++ ++/* ++ * Other Definition ++ * */ ++ ++/* byte endable for sb_write */ ++#define bByte0 0x1 /* Useless */ ++#define bByte1 0x2 ++#define bByte2 0x4 ++#define bByte3 0x8 ++#define bWord0 0x3 ++#define bWord1 0xc ++#define bDWord 0xf ++ ++/* for PutRegsetting & GetRegSetting BitMask */ ++#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ ++#define bMaskByte1 0xff00 ++#define bMaskByte2 0xff0000 ++#define bMaskByte3 0xff000000 ++#define bMaskHWord 0xffff0000 ++#define bMaskLWord 0x0000ffff ++#define bMaskDWord 0xffffffff ++#define bMaskH3Bytes 0xffffff00 ++#define bMask12Bits 0xfff ++#define bMaskH4Bits 0xf0000000 ++#define bMaskOFDM_D 0xffc00000 ++#define bMaskCCK 0x3f3f3f3f ++ ++/* for PutRFRegsetting & GetRFRegSetting BitMask ++ * #define bMask12Bits 0xfffff */ /* RF Reg mask bits ++ * #define bMask20Bits 0xfffff */ /* RF Reg mask bits T65 RF */ ++#define bRFRegOffsetMask 0xfffff ++ ++#define bEnable 0x1 /* Useless */ ++#define bDisable 0x0 ++ ++#define LeftAntenna 0x0 /* Useless */ ++#define RightAntenna 0x1 ++ ++#define tCheckTxStatus 500 /* 500ms */ /* Useless */ ++#define tUpdateRxCounter 100 /* 100ms */ ++ ++#define rateCCK 0 /* Useless */ ++#define rateOFDM 1 ++#define rateHT 2 ++ ++/* define Register-End */ ++#define bPMAC_End 0x1ff /* Useless */ ++#define bFPGAPHY0_End 0x8ff ++#define bFPGAPHY1_End 0x9ff ++#define bCCKPHY0_End 0xaff ++#define bOFDMPHY0_End 0xcff ++#define bOFDMPHY1_End 0xdff ++ ++/* define max debug item in each debug page ++ * #define bMaxItem_FPGA_PHY0 0x9 ++ * #define bMaxItem_FPGA_PHY1 0x3 ++ * #define bMaxItem_PHY_11B 0x16 ++ * #define bMaxItem_OFDM_PHY0 0x29 ++ * #define bMaxItem_OFDM_PHY1 0x0 */ ++ ++#define bPMACControl 0x0 /* Useless */ ++#define bWMACControl 0x1 ++#define bWNICControl 0x2 ++ ++#define PathA 0x0 /* Useless */ ++#define PathB 0x1 ++#define PathC 0x2 ++#define PathD 0x3 ++ ++ ++/* RSSI Dump Message */ ++#define rA_RSSIDump_92E 0xcb0 ++#define rB_RSSIDump_92E 0xcb1 ++#define rS1_RXevmDump_92E 0xcb2 ++#define rS2_RXevmDump_92E 0xcb3 ++#define rA_RXsnrDump_92E 0xcb4 ++#define rB_RXsnrDump_92E 0xcb5 ++#define rA_CfoShortDump_92E 0xcb6 ++#define rB_CfoShortDump_92E 0xcb8 ++#define rA_CfoLongDump_92E 0xcba ++#define rB_CfoLongDump_92E 0xcbc ++ ++/*--------------------------Define Parameters-------------------------------*/ ++ ++ ++#endif /* __INC_HAL8188EPHYREG_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8192EPwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8192EPwrSeq.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8192EPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8192EPwrSeq.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,155 @@ ++#ifndef REALTEK_POWER_SEQUENCE_8192E ++#define REALTEK_POWER_SEQUENCE_8192E ++ ++#include "HalPwrSeqCmd.h" ++/* ++ Check document WM-20110607-Paul-RTL8192E_Power_Architecture-R02.vsd ++ There are 6 HW Power States: ++ 0: POFF--Power Off ++ 1: PDN--Power Down ++ 2: CARDEMU--Card Emulation ++ 3: ACT--Active Mode ++ 4: LPS--Low Power State ++ 5: SUS--Suspend ++ ++ The transision from different states are defined below ++ TRANS_CARDEMU_TO_ACT ++ TRANS_ACT_TO_CARDEMU ++ TRANS_CARDEMU_TO_SUS ++ TRANS_SUS_TO_CARDEMU ++ TRANS_CARDEMU_TO_PDN ++ TRANS_ACT_TO_LPS ++ TRANS_LPS_TO_ACT ++ ++ TRANS_END ++*/ ++#define RTL8192E_TRANS_CARDEMU_TO_ACT_STEPS 18 ++#define RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS 18 ++#define RTL8192E_TRANS_CARDEMU_TO_SUS_STEPS 18 ++#define RTL8192E_TRANS_SUS_TO_CARDEMU_STEPS 18 ++#define RTL8192E_TRANS_CARDEMU_TO_PDN_STEPS 18 ++#define RTL8192E_TRANS_PDN_TO_CARDEMU_STEPS 18 ++#define RTL8192E_TRANS_ACT_TO_LPS_STEPS 23 ++#define RTL8192E_TRANS_LPS_TO_ACT_STEPS 23 ++#define RTL8192E_TRANS_END_STEPS 1 ++ ++ ++#define RTL8192E_TRANS_CARDEMU_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3), 0},/* disable WL suspend*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ ++ ++ ++#define RTL8192E_TRANS_ACT_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ ++ {0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/*0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ ++ ++ ++#define RTL8192E_TRANS_CARDEMU_TO_SUS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4 | BIT3, (BIT4 | BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ ++ ++#define RTL8192E_TRANS_SUS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ ++ ++#define RTL8192E_TRANS_CARDEMU_TO_CARDDIS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ ++ {0x00CC, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*Unlock small LDO Register*/ \ ++ {0x0011, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*Disable small LDO*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ ++ ++#define RTL8192E_TRANS_CARDDIS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x0011, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*Enable small LDO*/ \ ++ {0x00CC, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0}, /*Lock small LDO Register*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ ++ ++ ++#define RTL8192E_TRANS_CARDEMU_TO_PDN \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ ++ ++#define RTL8192E_TRANS_PDN_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ ++ ++#define RTL8192E_TRANS_ACT_TO_LPS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ ++ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ ++ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ ++ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ ++ ++ ++#define RTL8192E_TRANS_LPS_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM, For Repeatly In and out, Taggle bit should be changed*/\ ++ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ ++ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/\ ++ {0x013D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*Clear ISR*/ ++ ++#define RTL8192E_TRANS_END \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, ++ ++ ++ extern WLAN_PWR_CFG rtl8192E_power_on_flow[RTL8192E_TRANS_CARDEMU_TO_ACT_STEPS + RTL8192E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8192E_radio_off_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8192E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8192E_card_disable_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8192E_TRANS_CARDEMU_TO_PDN_STEPS + RTL8192E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8192E_card_enable_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8192E_TRANS_CARDEMU_TO_PDN_STEPS + RTL8192E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8192E_suspend_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8192E_TRANS_CARDEMU_TO_SUS_STEPS + RTL8192E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8192E_resume_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8192E_TRANS_CARDEMU_TO_SUS_STEPS + RTL8192E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8192E_hwpdn_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8192E_TRANS_CARDEMU_TO_PDN_STEPS + RTL8192E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8192E_enter_lps_flow[RTL8192E_TRANS_ACT_TO_LPS_STEPS + RTL8192E_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8192E_leave_lps_flow[RTL8192E_TRANS_LPS_TO_ACT_STEPS + RTL8192E_TRANS_END_STEPS]; ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8703BPhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8703BPhyCfg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8703BPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8703BPhyCfg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,137 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8703BPHYCFG_H__ ++#define __INC_HAL8703BPHYCFG_H__ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++#define LOOP_LIMIT 5 ++#define MAX_STALL_TIME 50 /* us */ ++#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ ++#define MAX_TXPWR_IDX_NMODE_92S 63 ++#define Reset_Cnt_Limit 3 ++ ++#ifdef CONFIG_PCI_HCI ++ #define MAX_AGGR_NUM 0x0B ++#else ++ #define MAX_AGGR_NUM 0x07 ++#endif /* CONFIG_PCI_HCI */ ++ ++ ++/*--------------------------Define Parameters End-------------------------------*/ ++ ++ ++/*------------------------------Define structure----------------------------*/ ++ ++/*------------------------------Define structure End----------------------------*/ ++ ++/*--------------------------Exported Function prototype---------------------*/ ++u32 ++PHY_QueryBBReg_8703B( ++ IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask ++); ++ ++VOID ++PHY_SetBBReg_8703B( ++ IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data ++); ++ ++u32 ++PHY_QueryRFReg_8703B( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask ++); ++ ++VOID ++PHY_SetRFReg_8703B( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data ++); ++ ++/* MAC/BB/RF HAL config */ ++int PHY_BBConfig8703B(PADAPTER Adapter); ++ ++int PHY_RFConfig8703B(PADAPTER Adapter); ++ ++s32 PHY_MACConfig8703B(PADAPTER padapter); ++ ++int ++PHY_ConfigRFWithParaFile_8703B( ++ IN PADAPTER Adapter, ++ IN u8 *pFileName, ++ RF_PATH eRFPath ++); ++ ++VOID ++PHY_SetTxPowerIndex_8703B( ++ IN PADAPTER Adapter, ++ IN u32 PowerIndex, ++ IN u8 RFPath, ++ IN u8 Rate ++); ++ ++u8 ++PHY_GetTxPowerIndex_8703B( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN u8 BandWidth, ++ IN u8 Channel, ++ struct txpwr_idx_comp *tic ++); ++ ++VOID ++PHY_GetTxPowerLevel8703B( ++ IN PADAPTER Adapter, ++ OUT s32 *powerlevel ++); ++ ++VOID ++PHY_SetTxPowerLevel8703B( ++ IN PADAPTER Adapter, ++ IN u8 channel ++); ++ ++VOID ++PHY_SetSwChnlBWMode8703B( ++ IN PADAPTER Adapter, ++ IN u8 channel, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 Offset40, ++ IN u8 Offset80 ++); ++ ++VOID PHY_SetRFPathSwitch_8703B( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bMain ++); ++ ++/*--------------------------Exported Function prototype End---------------------*/ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8703BPhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8703BPhyReg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8703BPhyReg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8703BPhyReg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,1138 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8703BPHYREG_H__ ++#define __INC_HAL8703BPHYREG_H__ ++ ++#define rSYM_WLBT_PAPE_SEL 0x64 ++/* ++ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 ++ * 3. RF register 0x00-2E ++ * 4. Bit Mask for BB/RF register ++ * 5. Other defintion for BB/RF R/W ++ * */ ++ ++ ++/* ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 1. Page1(0x100) ++ * */ ++#define rPMAC_Reset 0x100 ++#define rPMAC_TxStart 0x104 ++#define rPMAC_TxLegacySIG 0x108 ++#define rPMAC_TxHTSIG1 0x10c ++#define rPMAC_TxHTSIG2 0x110 ++#define rPMAC_PHYDebug 0x114 ++#define rPMAC_TxPacketNum 0x118 ++#define rPMAC_TxIdle 0x11c ++#define rPMAC_TxMACHeader0 0x120 ++#define rPMAC_TxMACHeader1 0x124 ++#define rPMAC_TxMACHeader2 0x128 ++#define rPMAC_TxMACHeader3 0x12c ++#define rPMAC_TxMACHeader4 0x130 ++#define rPMAC_TxMACHeader5 0x134 ++#define rPMAC_TxDataType 0x138 ++#define rPMAC_TxRandomSeed 0x13c ++#define rPMAC_CCKPLCPPreamble 0x140 ++#define rPMAC_CCKPLCPHeader 0x144 ++#define rPMAC_CCKCRC16 0x148 ++#define rPMAC_OFDMRxCRC32OK 0x170 ++#define rPMAC_OFDMRxCRC32Er 0x174 ++#define rPMAC_OFDMRxParityEr 0x178 ++#define rPMAC_OFDMRxCRC8Er 0x17c ++#define rPMAC_CCKCRxRC16Er 0x180 ++#define rPMAC_CCKCRxRC32Er 0x184 ++#define rPMAC_CCKCRxRC32OK 0x188 ++#define rPMAC_TxStatus 0x18c ++ ++/* ++ * 2. Page2(0x200) ++ * ++ * The following two definition are only used for USB interface. */ ++#define RF_BB_CMD_ADDR 0x02c0 /* RF/BB read/write command address. */ ++#define RF_BB_CMD_DATA 0x02c4 /* RF/BB read/write command data. */ ++ ++/* ++ * 3. Page8(0x800) ++ * */ ++#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ ++ ++#define rFPGA0_TxInfo 0x804 /* Status report?? */ ++#define rFPGA0_PSDFunction 0x808 ++ ++#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ ++ ++#define rFPGA0_RFTiming1 0x810 /* Useless now */ ++#define rFPGA0_RFTiming2 0x814 ++ ++#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ ++#define rFPGA0_XA_HSSIParameter2 0x824 ++#define rFPGA0_XB_HSSIParameter1 0x828 ++#define rFPGA0_XB_HSSIParameter2 0x82c ++#define rTxAGC_B_Rate18_06 0x830 ++#define rTxAGC_B_Rate54_24 0x834 ++#define rTxAGC_B_CCK1_55_Mcs32 0x838 ++#define rTxAGC_B_Mcs03_Mcs00 0x83c ++ ++#define rTxAGC_B_Mcs07_Mcs04 0x848 ++#define rTxAGC_B_Mcs11_Mcs08 0x84c ++ ++#define rFPGA0_XA_LSSIParameter 0x840 ++#define rFPGA0_XB_LSSIParameter 0x844 ++ ++#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ ++#define rFPGA0_RFSleepUpParameter 0x854 ++ ++#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ ++#define rFPGA0_XCD_SwitchControl 0x85c ++ ++#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ ++#define rFPGA0_XB_RFInterfaceOE 0x864 ++ ++#define rTxAGC_B_Mcs15_Mcs12 0x868 ++#define rTxAGC_B_CCK11_A_CCK2_11 0x86c ++ ++#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ ++#define rFPGA0_XCD_RFInterfaceSW 0x874 ++ ++#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ ++#define rFPGA0_XCD_RFParameter 0x87c ++ ++#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ ++#define rFPGA0_AnalogParameter2 0x884 ++#define rFPGA0_AnalogParameter3 0x888 /* Useless now */ ++#define rFPGA0_AnalogParameter4 0x88c ++ ++#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ ++#define rFPGA0_XB_LSSIReadBack 0x8a4 ++#define rFPGA0_XC_LSSIReadBack 0x8a8 ++#define rFPGA0_XD_LSSIReadBack 0x8ac ++ ++#define rFPGA0_PSDReport 0x8b4 /* Useless now */ ++#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ ++#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ ++#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ ++#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ ++ ++/* ++ * 4. Page9(0x900) ++ * */ ++#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ ++#define rFPGA1_TxBlock 0x904 /* Useless now */ ++#define rFPGA1_DebugSelect 0x908 /* Useless now */ ++#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ ++#define rDPDT_control 0x92c ++#define rfe_ctrl_anta_src 0x930 ++#define rS0S1_PathSwitch 0x948 ++#define rBBrx_DFIR 0x954 ++ ++/* ++ * 5. PageA(0xA00) ++ * ++ * Set Control channel to upper or lower. These settings are required only for 40MHz */ ++#define rCCK0_System 0xa00 ++ ++#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ ++#define rCCK0_CCA 0xa08 /* Disable init gain now */ /* Init gain */ ++ ++#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level */ /* Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ ++#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ ++ ++#define rCCK0_RxHP 0xa14 ++ ++#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ ++#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ ++ ++#define rCCK0_TxFilter1 0xa20 ++#define rCCK0_TxFilter2 0xa24 ++#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ ++#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ ++#define rCCK0_TRSSIReport 0xa50 ++#define rCCK0_RxReport 0xa54 /* 0xa57 */ ++#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ ++#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ ++ ++/* ++ * PageB(0xB00) ++ * */ ++#define rPdp_AntA 0xb00 ++#define rPdp_AntA_4 0xb04 ++#define rPdp_AntA_8 0xb08 ++#define rPdp_AntA_C 0xb0c ++#define rPdp_AntA_10 0xb10 ++#define rPdp_AntA_14 0xb14 ++#define rPdp_AntA_18 0xb18 ++#define rPdp_AntA_1C 0xb1c ++#define rPdp_AntA_20 0xb20 ++#define rPdp_AntA_24 0xb24 ++ ++#define rConfig_Pmpd_AntA 0xb28 ++#define rConfig_ram64x16 0xb2c ++ ++#define rBndA 0xb30 ++#define rHssiPar 0xb34 ++ ++#define rConfig_AntA 0xb68 ++#define rConfig_AntB 0xb6c ++ ++#define rPdp_AntB 0xb70 ++#define rPdp_AntB_4 0xb74 ++#define rPdp_AntB_8 0xb78 ++#define rPdp_AntB_C 0xb7c ++#define rPdp_AntB_10 0xb80 ++#define rPdp_AntB_14 0xb84 ++#define rPdp_AntB_18 0xb88 ++#define rPdp_AntB_1C 0xb8c ++#define rPdp_AntB_20 0xb90 ++#define rPdp_AntB_24 0xb94 ++ ++#define rConfig_Pmpd_AntB 0xb98 ++ ++#define rBndB 0xba0 ++ ++#define rAPK 0xbd8 ++#define rPm_Rx0_AntA 0xbdc ++#define rPm_Rx1_AntA 0xbe0 ++#define rPm_Rx2_AntA 0xbe4 ++#define rPm_Rx3_AntA 0xbe8 ++#define rPm_Rx0_AntB 0xbec ++#define rPm_Rx1_AntB 0xbf0 ++#define rPm_Rx2_AntB 0xbf4 ++#define rPm_Rx3_AntB 0xbf8 ++/* ++ * 6. PageC(0xC00) ++ * */ ++#define rOFDM0_LSTF 0xc00 ++ ++#define rOFDM0_TRxPathEnable 0xc04 ++#define rOFDM0_TRMuxPar 0xc08 ++#define rOFDM0_TRSWIsolation 0xc0c ++ ++#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ ++#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ ++#define rOFDM0_XBRxAFE 0xc18 ++#define rOFDM0_XBRxIQImbalance 0xc1c ++#define rOFDM0_XCRxAFE 0xc20 ++#define rOFDM0_XCRxIQImbalance 0xc24 ++#define rOFDM0_XDRxAFE 0xc28 ++#define rOFDM0_XDRxIQImbalance 0xc2c ++ ++#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ ++#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ ++#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ ++#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ ++ ++#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ ++#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ ++#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ ++#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ ++ ++#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ ++#define rOFDM0_XAAGCCore2 0xc54 ++#define rOFDM0_XBAGCCore1 0xc58 ++#define rOFDM0_XBAGCCore2 0xc5c ++#define rOFDM0_XCAGCCore1 0xc60 ++#define rOFDM0_XCAGCCore2 0xc64 ++#define rOFDM0_XDAGCCore1 0xc68 ++#define rOFDM0_XDAGCCore2 0xc6c ++ ++#define rOFDM0_AGCParameter1 0xc70 ++#define rOFDM0_AGCParameter2 0xc74 ++#define rOFDM0_AGCRSSITable 0xc78 ++#define rOFDM0_HTSTFAGC 0xc7c ++ ++#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ ++#define rOFDM0_XATxAFE 0xc84 ++#define rOFDM0_XBTxIQImbalance 0xc88 ++#define rOFDM0_XBTxAFE 0xc8c ++#define rOFDM0_XCTxIQImbalance 0xc90 ++#define rOFDM0_XCTxAFE 0xc94 ++#define rOFDM0_XDTxIQImbalance 0xc98 ++#define rOFDM0_XDTxAFE 0xc9c ++ ++#define rOFDM0_RxIQExtAnta 0xca0 ++#define rOFDM0_TxCoeff1 0xca4 ++#define rOFDM0_TxCoeff2 0xca8 ++#define rOFDM0_TxCoeff3 0xcac ++#define rOFDM0_TxCoeff4 0xcb0 ++#define rOFDM0_TxCoeff5 0xcb4 ++#define rOFDM0_TxCoeff6 0xcb8 ++#define rOFDM0_RxHPParameter 0xce0 ++#define rOFDM0_TxPseudoNoiseWgt 0xce4 ++#define rOFDM0_FrameSync 0xcf0 ++#define rOFDM0_DFSReport 0xcf4 ++ ++/* ++ * 7. PageD(0xD00) ++ * */ ++#define rOFDM1_LSTF 0xd00 ++#define rOFDM1_TRxPathEnable 0xd04 ++ ++#define rOFDM1_CFO 0xd08 /* No setting now */ ++#define rOFDM1_CSI1 0xd10 ++#define rOFDM1_SBD 0xd14 ++#define rOFDM1_CSI2 0xd18 ++#define rOFDM1_CFOTracking 0xd2c ++#define rOFDM1_TRxMesaure1 0xd34 ++#define rOFDM1_IntfDet 0xd3c ++#define rOFDM1_PseudoNoiseStateAB 0xd50 ++#define rOFDM1_PseudoNoiseStateCD 0xd54 ++#define rOFDM1_RxPseudoNoiseWgt 0xd58 ++ ++#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ ++#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ ++#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ ++ ++#define rOFDM_ShortCFOAB 0xdac /* No setting now */ ++#define rOFDM_ShortCFOCD 0xdb0 ++#define rOFDM_LongCFOAB 0xdb4 ++#define rOFDM_LongCFOCD 0xdb8 ++#define rOFDM_TailCFOAB 0xdbc ++#define rOFDM_TailCFOCD 0xdc0 ++#define rOFDM_PWMeasure1 0xdc4 ++#define rOFDM_PWMeasure2 0xdc8 ++#define rOFDM_BWReport 0xdcc ++#define rOFDM_AGCReport 0xdd0 ++#define rOFDM_RxSNR 0xdd4 ++#define rOFDM_RxEVMCSI 0xdd8 ++#define rOFDM_SIGReport 0xddc ++ ++ ++/* ++ * 8. PageE(0xE00) ++ * */ ++#define rTxAGC_A_Rate18_06 0xe00 ++#define rTxAGC_A_Rate54_24 0xe04 ++#define rTxAGC_A_CCK1_Mcs32 0xe08 ++#define rTxAGC_A_Mcs03_Mcs00 0xe10 ++#define rTxAGC_A_Mcs07_Mcs04 0xe14 ++#define rTxAGC_A_Mcs11_Mcs08 0xe18 ++#define rTxAGC_A_Mcs15_Mcs12 0xe1c ++ ++#define rFPGA0_IQK 0xe28 ++#define rTx_IQK_Tone_A 0xe30 ++#define rRx_IQK_Tone_A 0xe34 ++#define rTx_IQK_PI_A 0xe38 ++#define rRx_IQK_PI_A 0xe3c ++ ++#define rTx_IQK 0xe40 ++#define rRx_IQK 0xe44 ++#define rIQK_AGC_Pts 0xe48 ++#define rIQK_AGC_Rsp 0xe4c ++#define rTx_IQK_Tone_B 0xe50 ++#define rRx_IQK_Tone_B 0xe54 ++#define rTx_IQK_PI_B 0xe58 ++#define rRx_IQK_PI_B 0xe5c ++#define rIQK_AGC_Cont 0xe60 ++ ++#define rBlue_Tooth 0xe6c ++#define rRx_Wait_CCA 0xe70 ++#define rTx_CCK_RFON 0xe74 ++#define rTx_CCK_BBON 0xe78 ++#define rTx_OFDM_RFON 0xe7c ++#define rTx_OFDM_BBON 0xe80 ++#define rTx_To_Rx 0xe84 ++#define rTx_To_Tx 0xe88 ++#define rRx_CCK 0xe8c ++ ++#define rTx_Power_Before_IQK_A 0xe94 ++#define rTx_Power_After_IQK_A 0xe9c ++ ++#define rRx_Power_Before_IQK_A 0xea0 ++#define rRx_Power_Before_IQK_A_2 0xea4 ++#define rRx_Power_After_IQK_A 0xea8 ++#define rRx_Power_After_IQK_A_2 0xeac ++ ++#define rTx_Power_Before_IQK_B 0xeb4 ++#define rTx_Power_After_IQK_B 0xebc ++ ++#define rRx_Power_Before_IQK_B 0xec0 ++#define rRx_Power_Before_IQK_B_2 0xec4 ++#define rRx_Power_After_IQK_B 0xec8 ++#define rRx_Power_After_IQK_B_2 0xecc ++ ++#define rRx_OFDM 0xed0 ++#define rRx_Wait_RIFS 0xed4 ++#define rRx_TO_Rx 0xed8 ++#define rStandby 0xedc ++#define rSleep 0xee0 ++#define rPMPD_ANAEN 0xeec ++ ++/* ++ * 7. RF Register 0x00-0x2E (RF 8256) ++ * RF-0222D 0x00-3F ++ * ++ * Zebra1 */ ++#define rZebra1_HSSIEnable 0x0 /* Useless now */ ++#define rZebra1_TRxEnable1 0x1 ++#define rZebra1_TRxEnable2 0x2 ++#define rZebra1_AGC 0x4 ++#define rZebra1_ChargePump 0x5 ++#define rZebra1_Channel 0x7 /* RF channel switch */ ++ ++/* #endif */ ++#define rZebra1_TxGain 0x8 /* Useless now */ ++#define rZebra1_TxLPF 0x9 ++#define rZebra1_RxLPF 0xb ++#define rZebra1_RxHPFCorner 0xc ++ ++/* Zebra4 */ ++#define rGlobalCtrl 0 /* Useless now */ ++#define rRTL8256_TxLPF 19 ++#define rRTL8256_RxLPF 11 ++ ++/* RTL8258 */ ++#define rRTL8258_TxLPF 0x11 /* Useless now */ ++#define rRTL8258_RxLPF 0x13 ++#define rRTL8258_RSSILPF 0xa ++ ++/* ++ * RL6052 Register definition ++ * */ ++#define RF_AC 0x00 /* */ ++ ++#define RF_IQADJ_G1 0x01 /* */ ++#define RF_IQADJ_G2 0x02 /* */ ++#define RF_BS_PA_APSET_G1_G4 0x03 ++#define RF_BS_PA_APSET_G5_G8 0x04 ++#define RF_POW_TRSW 0x05 /* */ ++ ++#define RF_GAIN_RX 0x06 /* */ ++#define RF_GAIN_TX 0x07 /* */ ++ ++#define RF_TXM_IDAC 0x08 /* */ ++#define RF_IPA_G 0x09 /* */ ++#define RF_TXBIAS_G 0x0A ++#define RF_TXPA_AG 0x0B ++#define RF_IPA_A 0x0C /* */ ++#define RF_TXBIAS_A 0x0D ++#define RF_BS_PA_APSET_G9_G11 0x0E ++#define RF_BS_IQGEN 0x0F /* */ ++ ++#define RF_MODE1 0x10 /* */ ++#define RF_MODE2 0x11 /* */ ++ ++#define RF_RX_AGC_HP 0x12 /* */ ++#define RF_TX_AGC 0x13 /* */ ++#define RF_BIAS 0x14 /* */ ++#define RF_IPA 0x15 /* */ ++#define RF_TXBIAS 0x16 ++#define RF_POW_ABILITY 0x17 /* */ ++#define RF_MODE_AG 0x18 /* */ ++#define rRfChannel 0x18 /* RF channel and BW switch */ ++#define RF_CHNLBW 0x18 /* RF channel and BW switch */ ++#define RF_TOP 0x19 /* */ ++ ++#define RF_RX_G1 0x1A /* */ ++#define RF_RX_G2 0x1B /* */ ++ ++#define RF_RX_BB2 0x1C /* */ ++#define RF_RX_BB1 0x1D /* */ ++ ++#define RF_RCK1 0x1E /* */ ++#define RF_RCK2 0x1F /* */ ++ ++#define RF_TX_G1 0x20 /* */ ++#define RF_TX_G2 0x21 /* */ ++#define RF_TX_G3 0x22 /* */ ++ ++#define RF_TX_BB1 0x23 /* */ ++ ++#define RF_T_METER 0x24 /* */ ++ ++#define RF_SYN_G1 0x25 /* RF TX Power control */ ++#define RF_SYN_G2 0x26 /* RF TX Power control */ ++#define RF_SYN_G3 0x27 /* RF TX Power control */ ++#define RF_SYN_G4 0x28 /* RF TX Power control */ ++#define RF_SYN_G5 0x29 /* RF TX Power control */ ++#define RF_SYN_G6 0x2A /* RF TX Power control */ ++#define RF_SYN_G7 0x2B /* RF TX Power control */ ++#define RF_SYN_G8 0x2C /* RF TX Power control */ ++ ++#define RF_RCK_OS 0x30 /* RF TX PA control */ ++ ++#define RF_TXPA_G1 0x31 /* RF TX PA control */ ++#define RF_TXPA_G2 0x32 /* RF TX PA control */ ++#define RF_TXPA_G3 0x33 /* RF TX PA control */ ++#define RF_TX_BIAS_A 0x35 ++#define RF_TX_BIAS_D 0x36 ++#define RF_LOBF_9 0x38 ++#define RF_RXRF_A3 0x3C /* */ ++#define RF_TRSW 0x3F ++ ++#define RF_TXRF_A2 0x41 ++#define RF_TXPA_G4 0x46 ++#define RF_TXPA_A4 0x4B ++#define RF_0x52 0x52 ++#define RF_WE_LUT 0xEF ++#define RF_S0S1 0xB0 ++ ++/* ++ * Bit Mask ++ * ++ * 1. Page1(0x100) */ ++#define bBBResetB 0x100 /* Useless now? */ ++#define bGlobalResetB 0x200 ++#define bOFDMTxStart 0x4 ++#define bCCKTxStart 0x8 ++#define bCRC32Debug 0x100 ++#define bPMACLoopback 0x10 ++#define bTxLSIG 0xffffff ++#define bOFDMTxRate 0xf ++#define bOFDMTxReserved 0x10 ++#define bOFDMTxLength 0x1ffe0 ++#define bOFDMTxParity 0x20000 ++#define bTxHTSIG1 0xffffff ++#define bTxHTMCSRate 0x7f ++#define bTxHTBW 0x80 ++#define bTxHTLength 0xffff00 ++#define bTxHTSIG2 0xffffff ++#define bTxHTSmoothing 0x1 ++#define bTxHTSounding 0x2 ++#define bTxHTReserved 0x4 ++#define bTxHTAggreation 0x8 ++#define bTxHTSTBC 0x30 ++#define bTxHTAdvanceCoding 0x40 ++#define bTxHTShortGI 0x80 ++#define bTxHTNumberHT_LTF 0x300 ++#define bTxHTCRC8 0x3fc00 ++#define bCounterReset 0x10000 ++#define bNumOfOFDMTx 0xffff ++#define bNumOfCCKTx 0xffff0000 ++#define bTxIdleInterval 0xffff ++#define bOFDMService 0xffff0000 ++#define bTxMACHeader 0xffffffff ++#define bTxDataInit 0xff ++#define bTxHTMode 0x100 ++#define bTxDataType 0x30000 ++#define bTxRandomSeed 0xffffffff ++#define bCCKTxPreamble 0x1 ++#define bCCKTxSFD 0xffff0000 ++#define bCCKTxSIG 0xff ++#define bCCKTxService 0xff00 ++#define bCCKLengthExt 0x8000 ++#define bCCKTxLength 0xffff0000 ++#define bCCKTxCRC16 0xffff ++#define bCCKTxStatus 0x1 ++#define bOFDMTxStatus 0x2 ++ ++#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) ++#define RF_TX_GAIN_OFFSET_8703B(_val) (abs((_val)) | (((_val) > 0) ? BIT5 : 0)) ++ ++/* 2. Page8(0x800) */ ++#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ ++#define bJapanMode 0x2 ++#define bCCKTxSC 0x30 ++#define bCCKEn 0x1000000 ++#define bOFDMEn 0x2000000 ++ ++#define bOFDMRxADCPhase 0x10000 /* Useless now */ ++#define bOFDMTxDACPhase 0x40000 ++#define bXATxAGC 0x3f ++ ++#define bAntennaSelect 0x0300 ++ ++#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ ++#define bXCTxAGC 0xf000 ++#define bXDTxAGC 0xf0000 ++ ++#define bPAStart 0xf0000000 /* Useless now */ ++#define bTRStart 0x00f00000 ++#define bRFStart 0x0000f000 ++#define bBBStart 0x000000f0 ++#define bBBCCKStart 0x0000000f ++#define bPAEnd 0xf /* Reg0x814 */ ++#define bTREnd 0x0f000000 ++#define bRFEnd 0x000f0000 ++#define bCCAMask 0x000000f0 /* T2R */ ++#define bR2RCCAMask 0x00000f00 ++#define bHSSI_R2TDelay 0xf8000000 ++#define bHSSI_T2RDelay 0xf80000 ++#define bContTxHSSI 0x400 /* chane gain at continue Tx */ ++#define bIGFromCCK 0x200 ++#define bAGCAddress 0x3f ++#define bRxHPTx 0x7000 ++#define bRxHPT2R 0x38000 ++#define bRxHPCCKIni 0xc0000 ++#define bAGCTxCode 0xc00000 ++#define bAGCRxCode 0x300000 ++ ++#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ ++#define b3WireAddressLength 0x400 ++ ++#define b3WireRFPowerDown 0x1 /* Useless now ++ * #define bHWSISelect 0x8 */ ++#define b5GPAPEPolarity 0x40000000 ++#define b2GPAPEPolarity 0x80000000 ++#define bRFSW_TxDefaultAnt 0x3 ++#define bRFSW_TxOptionAnt 0x30 ++#define bRFSW_RxDefaultAnt 0x300 ++#define bRFSW_RxOptionAnt 0x3000 ++#define bRFSI_3WireData 0x1 ++#define bRFSI_3WireClock 0x2 ++#define bRFSI_3WireLoad 0x4 ++#define bRFSI_3WireRW 0x8 ++#define bRFSI_3Wire 0xf ++ ++#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ ++ ++#define bRFSI_TRSW 0x20 /* Useless now */ ++#define bRFSI_TRSWB 0x40 ++#define bRFSI_ANTSW 0x100 ++#define bRFSI_ANTSWB 0x200 ++#define bRFSI_PAPE 0x400 ++#define bRFSI_PAPE5G 0x800 ++#define bBandSelect 0x1 ++#define bHTSIG2_GI 0x80 ++#define bHTSIG2_Smoothing 0x01 ++#define bHTSIG2_Sounding 0x02 ++#define bHTSIG2_Aggreaton 0x08 ++#define bHTSIG2_STBC 0x30 ++#define bHTSIG2_AdvCoding 0x40 ++#define bHTSIG2_NumOfHTLTF 0x300 ++#define bHTSIG2_CRC8 0x3fc ++#define bHTSIG1_MCS 0x7f ++#define bHTSIG1_BandWidth 0x80 ++#define bHTSIG1_HTLength 0xffff ++#define bLSIG_Rate 0xf ++#define bLSIG_Reserved 0x10 ++#define bLSIG_Length 0x1fffe ++#define bLSIG_Parity 0x20 ++#define bCCKRxPhase 0x4 ++ ++#define bLSSIReadAddress 0x7f800000 /* T65 RF */ ++ ++#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ ++ ++#define bLSSIReadBackData 0xfffff /* T65 RF */ ++ ++#define bLSSIReadOKFlag 0x1000 /* Useless now */ ++#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ ++#define bRegulator0Standby 0x1 ++#define bRegulatorPLLStandby 0x2 ++#define bRegulator1Standby 0x4 ++#define bPLLPowerUp 0x8 ++#define bDPLLPowerUp 0x10 ++#define bDA10PowerUp 0x20 ++#define bAD7PowerUp 0x200 ++#define bDA6PowerUp 0x2000 ++#define bXtalPowerUp 0x4000 ++#define b40MDClkPowerUP 0x8000 ++#define bDA6DebugMode 0x20000 ++#define bDA6Swing 0x380000 ++ ++#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ ++ ++#define b80MClkDelay 0x18000000 /* Useless */ ++#define bAFEWatchDogEnable 0x20000000 ++ ++#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ ++#define bXtalCap23 0x3 ++#define bXtalCap92x 0x0f000000 ++#define bXtalCap 0x0f000000 ++ ++#define bIntDifClkEnable 0x400 /* Useless */ ++#define bExtSigClkEnable 0x800 ++#define bBandgapMbiasPowerUp 0x10000 ++#define bAD11SHGain 0xc0000 ++#define bAD11InputRange 0x700000 ++#define bAD11OPCurrent 0x3800000 ++#define bIPathLoopback 0x4000000 ++#define bQPathLoopback 0x8000000 ++#define bAFELoopback 0x10000000 ++#define bDA10Swing 0x7e0 ++#define bDA10Reverse 0x800 ++#define bDAClkSource 0x1000 ++#define bAD7InputRange 0x6000 ++#define bAD7Gain 0x38000 ++#define bAD7OutputCMMode 0x40000 ++#define bAD7InputCMMode 0x380000 ++#define bAD7Current 0xc00000 ++#define bRegulatorAdjust 0x7000000 ++#define bAD11PowerUpAtTx 0x1 ++#define bDA10PSAtTx 0x10 ++#define bAD11PowerUpAtRx 0x100 ++#define bDA10PSAtRx 0x1000 ++#define bCCKRxAGCFormat 0x200 ++#define bPSDFFTSamplepPoint 0xc000 ++#define bPSDAverageNum 0x3000 ++#define bIQPathControl 0xc00 ++#define bPSDFreq 0x3ff ++#define bPSDAntennaPath 0x30 ++#define bPSDIQSwitch 0x40 ++#define bPSDRxTrigger 0x400000 ++#define bPSDTxTrigger 0x80000000 ++#define bPSDSineToneScale 0x7f000000 ++#define bPSDReport 0xffff ++ ++/* 3. Page9(0x900) */ ++#define bOFDMTxSC 0x30000000 /* Useless */ ++#define bCCKTxOn 0x1 ++#define bOFDMTxOn 0x2 ++#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ ++#define bDebugItem 0xff /* reset debug page and LWord */ ++#define bAntL 0x10 ++#define bAntNonHT 0x100 ++#define bAntHT1 0x1000 ++#define bAntHT2 0x10000 ++#define bAntHT1S1 0x100000 ++#define bAntNonHTS1 0x1000000 ++ ++/* 4. PageA(0xA00) */ ++#define bCCKBBMode 0x3 /* Useless */ ++#define bCCKTxPowerSaving 0x80 ++#define bCCKRxPowerSaving 0x40 ++ ++#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ ++ ++#define bCCKScramble 0x8 /* Useless */ ++#define bCCKAntDiversity 0x8000 ++#define bCCKCarrierRecovery 0x4000 ++#define bCCKTxRate 0x3000 ++#define bCCKDCCancel 0x0800 ++#define bCCKISICancel 0x0400 ++#define bCCKMatchFilter 0x0200 ++#define bCCKEqualizer 0x0100 ++#define bCCKPreambleDetect 0x800000 ++#define bCCKFastFalseCCA 0x400000 ++#define bCCKChEstStart 0x300000 ++#define bCCKCCACount 0x080000 ++#define bCCKcs_lim 0x070000 ++#define bCCKBistMode 0x80000000 ++#define bCCKCCAMask 0x40000000 ++#define bCCKTxDACPhase 0x4 ++#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ ++#define bCCKr_cp_mode0 0x0100 ++#define bCCKTxDCOffset 0xf0 ++#define bCCKRxDCOffset 0xf ++#define bCCKCCAMode 0xc000 ++#define bCCKFalseCS_lim 0x3f00 ++#define bCCKCS_ratio 0xc00000 ++#define bCCKCorgBit_sel 0x300000 ++#define bCCKPD_lim 0x0f0000 ++#define bCCKNewCCA 0x80000000 ++#define bCCKRxHPofIG 0x8000 ++#define bCCKRxIG 0x7f00 ++#define bCCKLNAPolarity 0x800000 ++#define bCCKRx1stGain 0x7f0000 ++#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ ++#define bCCKRxAGCSatLevel 0x1f000000 ++#define bCCKRxAGCSatCount 0xe0 ++#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ ++#define bCCKFixedRxAGC 0x8000 ++/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ ++#define bCCKAntennaPolarity 0x2000 ++#define bCCKTxFilterType 0x0c00 ++#define bCCKRxAGCReportType 0x0300 ++#define bCCKRxDAGCEn 0x80000000 ++#define bCCKRxDAGCPeriod 0x20000000 ++#define bCCKRxDAGCSatLevel 0x1f000000 ++#define bCCKTimingRecovery 0x800000 ++#define bCCKTxC0 0x3f0000 ++#define bCCKTxC1 0x3f000000 ++#define bCCKTxC2 0x3f ++#define bCCKTxC3 0x3f00 ++#define bCCKTxC4 0x3f0000 ++#define bCCKTxC5 0x3f000000 ++#define bCCKTxC6 0x3f ++#define bCCKTxC7 0x3f00 ++#define bCCKDebugPort 0xff0000 ++#define bCCKDACDebug 0x0f000000 ++#define bCCKFalseAlarmEnable 0x8000 ++#define bCCKFalseAlarmRead 0x4000 ++#define bCCKTRSSI 0x7f ++#define bCCKRxAGCReport 0xfe ++#define bCCKRxReport_AntSel 0x80000000 ++#define bCCKRxReport_MFOff 0x40000000 ++#define bCCKRxRxReport_SQLoss 0x20000000 ++#define bCCKRxReport_Pktloss 0x10000000 ++#define bCCKRxReport_Lockedbit 0x08000000 ++#define bCCKRxReport_RateError 0x04000000 ++#define bCCKRxReport_RxRate 0x03000000 ++#define bCCKRxFACounterLower 0xff ++#define bCCKRxFACounterUpper 0xff000000 ++#define bCCKRxHPAGCStart 0xe000 ++#define bCCKRxHPAGCFinal 0x1c00 ++#define bCCKRxFalseAlarmEnable 0x8000 ++#define bCCKFACounterFreeze 0x4000 ++#define bCCKTxPathSel 0x10000000 ++#define bCCKDefaultRxPath 0xc000000 ++#define bCCKOptionRxPath 0x3000000 ++ ++/* 5. PageC(0xC00) */ ++#define bNumOfSTF 0x3 /* Useless */ ++#define bShift_L 0xc0 ++#define bGI_TH 0xc ++#define bRxPathA 0x1 ++#define bRxPathB 0x2 ++#define bRxPathC 0x4 ++#define bRxPathD 0x8 ++#define bTxPathA 0x1 ++#define bTxPathB 0x2 ++#define bTxPathC 0x4 ++#define bTxPathD 0x8 ++#define bTRSSIFreq 0x200 ++#define bADCBackoff 0x3000 ++#define bDFIRBackoff 0xc000 ++#define bTRSSILatchPhase 0x10000 ++#define bRxIDCOffset 0xff ++#define bRxQDCOffset 0xff00 ++#define bRxDFIRMode 0x1800000 ++#define bRxDCNFType 0xe000000 ++#define bRXIQImb_A 0x3ff ++#define bRXIQImb_B 0xfc00 ++#define bRXIQImb_C 0x3f0000 ++#define bRXIQImb_D 0xffc00000 ++#define bDC_dc_Notch 0x60000 ++#define bRxNBINotch 0x1f000000 ++#define bPD_TH 0xf ++#define bPD_TH_Opt2 0xc000 ++#define bPWED_TH 0x700 ++#define bIfMF_Win_L 0x800 ++#define bPD_Option 0x1000 ++#define bMF_Win_L 0xe000 ++#define bBW_Search_L 0x30000 ++#define bwin_enh_L 0xc0000 ++#define bBW_TH 0x700000 ++#define bED_TH2 0x3800000 ++#define bBW_option 0x4000000 ++#define bRatio_TH 0x18000000 ++#define bWindow_L 0xe0000000 ++#define bSBD_Option 0x1 ++#define bFrame_TH 0x1c ++#define bFS_Option 0x60 ++#define bDC_Slope_check 0x80 ++#define bFGuard_Counter_DC_L 0xe00 ++#define bFrame_Weight_Short 0x7000 ++#define bSub_Tune 0xe00000 ++#define bFrame_DC_Length 0xe000000 ++#define bSBD_start_offset 0x30000000 ++#define bFrame_TH_2 0x7 ++#define bFrame_GI2_TH 0x38 ++#define bGI2_Sync_en 0x40 ++#define bSarch_Short_Early 0x300 ++#define bSarch_Short_Late 0xc00 ++#define bSarch_GI2_Late 0x70000 ++#define bCFOAntSum 0x1 ++#define bCFOAcc 0x2 ++#define bCFOStartOffset 0xc ++#define bCFOLookBack 0x70 ++#define bCFOSumWeight 0x80 ++#define bDAGCEnable 0x10000 ++#define bTXIQImb_A 0x3ff ++#define bTXIQImb_B 0xfc00 ++#define bTXIQImb_C 0x3f0000 ++#define bTXIQImb_D 0xffc00000 ++#define bTxIDCOffset 0xff ++#define bTxQDCOffset 0xff00 ++#define bTxDFIRMode 0x10000 ++#define bTxPesudoNoiseOn 0x4000000 ++#define bTxPesudoNoise_A 0xff ++#define bTxPesudoNoise_B 0xff00 ++#define bTxPesudoNoise_C 0xff0000 ++#define bTxPesudoNoise_D 0xff000000 ++#define bCCADropOption 0x20000 ++#define bCCADropThres 0xfff00000 ++#define bEDCCA_H 0xf ++#define bEDCCA_L 0xf0 ++#define bLambda_ED 0x300 ++#define bRxInitialGain 0x7f ++#define bRxAntDivEn 0x80 ++#define bRxAGCAddressForLNA 0x7f00 ++#define bRxHighPowerFlow 0x8000 ++#define bRxAGCFreezeThres 0xc0000 ++#define bRxFreezeStep_AGC1 0x300000 ++#define bRxFreezeStep_AGC2 0xc00000 ++#define bRxFreezeStep_AGC3 0x3000000 ++#define bRxFreezeStep_AGC0 0xc000000 ++#define bRxRssi_Cmp_En 0x10000000 ++#define bRxQuickAGCEn 0x20000000 ++#define bRxAGCFreezeThresMode 0x40000000 ++#define bRxOverFlowCheckType 0x80000000 ++#define bRxAGCShift 0x7f ++#define bTRSW_Tri_Only 0x80 ++#define bPowerThres 0x300 ++#define bRxAGCEn 0x1 ++#define bRxAGCTogetherEn 0x2 ++#define bRxAGCMin 0x4 ++#define bRxHP_Ini 0x7 ++#define bRxHP_TRLNA 0x70 ++#define bRxHP_RSSI 0x700 ++#define bRxHP_BBP1 0x7000 ++#define bRxHP_BBP2 0x70000 ++#define bRxHP_BBP3 0x700000 ++#define bRSSI_H 0x7f0000 /* the threshold for high power */ ++#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ ++#define bRxSettle_TRSW 0x7 ++#define bRxSettle_LNA 0x38 ++#define bRxSettle_RSSI 0x1c0 ++#define bRxSettle_BBP 0xe00 ++#define bRxSettle_RxHP 0x7000 ++#define bRxSettle_AntSW_RSSI 0x38000 ++#define bRxSettle_AntSW 0xc0000 ++#define bRxProcessTime_DAGC 0x300000 ++#define bRxSettle_HSSI 0x400000 ++#define bRxProcessTime_BBPPW 0x800000 ++#define bRxAntennaPowerShift 0x3000000 ++#define bRSSITableSelect 0xc000000 ++#define bRxHP_Final 0x7000000 ++#define bRxHTSettle_BBP 0x7 ++#define bRxHTSettle_HSSI 0x8 ++#define bRxHTSettle_RxHP 0x70 ++#define bRxHTSettle_BBPPW 0x80 ++#define bRxHTSettle_Idle 0x300 ++#define bRxHTSettle_Reserved 0x1c00 ++#define bRxHTRxHPEn 0x8000 ++#define bRxHTAGCFreezeThres 0x30000 ++#define bRxHTAGCTogetherEn 0x40000 ++#define bRxHTAGCMin 0x80000 ++#define bRxHTAGCEn 0x100000 ++#define bRxHTDAGCEn 0x200000 ++#define bRxHTRxHP_BBP 0x1c00000 ++#define bRxHTRxHP_Final 0xe0000000 ++#define bRxPWRatioTH 0x3 ++#define bRxPWRatioEn 0x4 ++#define bRxMFHold 0x3800 ++#define bRxPD_Delay_TH1 0x38 ++#define bRxPD_Delay_TH2 0x1c0 ++#define bRxPD_DC_COUNT_MAX 0x600 ++/* #define bRxMF_Hold 0x3800 */ ++#define bRxPD_Delay_TH 0x8000 ++#define bRxProcess_Delay 0xf0000 ++#define bRxSearchrange_GI2_Early 0x700000 ++#define bRxFrame_Guard_Counter_L 0x3800000 ++#define bRxSGI_Guard_L 0xc000000 ++#define bRxSGI_Search_L 0x30000000 ++#define bRxSGI_TH 0xc0000000 ++#define bDFSCnt0 0xff ++#define bDFSCnt1 0xff00 ++#define bDFSFlag 0xf0000 ++#define bMFWeightSum 0x300000 ++#define bMinIdxTH 0x7f000000 ++#define bDAFormat 0x40000 ++#define bTxChEmuEnable 0x01000000 ++#define bTRSWIsolation_A 0x7f ++#define bTRSWIsolation_B 0x7f00 ++#define bTRSWIsolation_C 0x7f0000 ++#define bTRSWIsolation_D 0x7f000000 ++#define bExtLNAGain 0x7c00 ++ ++/* 6. PageE(0xE00) */ ++#define bSTBCEn 0x4 /* Useless */ ++#define bAntennaMapping 0x10 ++#define bNss 0x20 ++#define bCFOAntSumD 0x200 ++#define bPHYCounterReset 0x8000000 ++#define bCFOReportGet 0x4000000 ++#define bOFDMContinueTx 0x10000000 ++#define bOFDMSingleCarrier 0x20000000 ++#define bOFDMSingleTone 0x40000000 ++/* #define bRxPath1 0x01 */ ++/* #define bRxPath2 0x02 */ ++/* #define bRxPath3 0x04 */ ++/* #define bRxPath4 0x08 */ ++/* #define bTxPath1 0x10 */ ++/* #define bTxPath2 0x20 */ ++#define bHTDetect 0x100 ++#define bCFOEn 0x10000 ++#define bCFOValue 0xfff00000 ++#define bSigTone_Re 0x3f ++#define bSigTone_Im 0x7f00 ++#define bCounter_CCA 0xffff ++#define bCounter_ParityFail 0xffff0000 ++#define bCounter_RateIllegal 0xffff ++#define bCounter_CRC8Fail 0xffff0000 ++#define bCounter_MCSNoSupport 0xffff ++#define bCounter_FastSync 0xffff ++#define bShortCFO 0xfff ++#define bShortCFOTLength 12 /* total */ ++#define bShortCFOFLength 11 /* fraction */ ++#define bLongCFO 0x7ff ++#define bLongCFOTLength 11 ++#define bLongCFOFLength 11 ++#define bTailCFO 0x1fff ++#define bTailCFOTLength 13 ++#define bTailCFOFLength 12 ++#define bmax_en_pwdB 0xffff ++#define bCC_power_dB 0xffff0000 ++#define bnoise_pwdB 0xffff ++#define bPowerMeasTLength 10 ++#define bPowerMeasFLength 3 ++#define bRx_HT_BW 0x1 ++#define bRxSC 0x6 ++#define bRx_HT 0x8 ++#define bNB_intf_det_on 0x1 ++#define bIntf_win_len_cfg 0x30 ++#define bNB_Intf_TH_cfg 0x1c0 ++#define bRFGain 0x3f ++#define bTableSel 0x40 ++#define bTRSW 0x80 ++#define bRxSNR_A 0xff ++#define bRxSNR_B 0xff00 ++#define bRxSNR_C 0xff0000 ++#define bRxSNR_D 0xff000000 ++#define bSNREVMTLength 8 ++#define bSNREVMFLength 1 ++#define bCSI1st 0xff ++#define bCSI2nd 0xff00 ++#define bRxEVM1st 0xff0000 ++#define bRxEVM2nd 0xff000000 ++#define bSIGEVM 0xff ++#define bPWDB 0xff00 ++#define bSGIEN 0x10000 ++ ++#define bSFactorQAM1 0xf /* Useless */ ++#define bSFactorQAM2 0xf0 ++#define bSFactorQAM3 0xf00 ++#define bSFactorQAM4 0xf000 ++#define bSFactorQAM5 0xf0000 ++#define bSFactorQAM6 0xf0000 ++#define bSFactorQAM7 0xf00000 ++#define bSFactorQAM8 0xf000000 ++#define bSFactorQAM9 0xf0000000 ++#define bCSIScheme 0x100000 ++ ++#define bNoiseLvlTopSet 0x3 /* Useless */ ++#define bChSmooth 0x4 ++#define bChSmoothCfg1 0x38 ++#define bChSmoothCfg2 0x1c0 ++#define bChSmoothCfg3 0xe00 ++#define bChSmoothCfg4 0x7000 ++#define bMRCMode 0x800000 ++#define bTHEVMCfg 0x7000000 ++ ++#define bLoopFitType 0x1 /* Useless */ ++#define bUpdCFO 0x40 ++#define bUpdCFOOffData 0x80 ++#define bAdvUpdCFO 0x100 ++#define bAdvTimeCtrl 0x800 ++#define bUpdClko 0x1000 ++#define bFC 0x6000 ++#define bTrackingMode 0x8000 ++#define bPhCmpEnable 0x10000 ++#define bUpdClkoLTF 0x20000 ++#define bComChCFO 0x40000 ++#define bCSIEstiMode 0x80000 ++#define bAdvUpdEqz 0x100000 ++#define bUChCfg 0x7000000 ++#define bUpdEqz 0x8000000 ++ ++/* Rx Pseduo noise */ ++#define bRxPesudoNoiseOn 0x20000000 /* Useless */ ++#define bRxPesudoNoise_A 0xff ++#define bRxPesudoNoise_B 0xff00 ++#define bRxPesudoNoise_C 0xff0000 ++#define bRxPesudoNoise_D 0xff000000 ++#define bPesudoNoiseState_A 0xffff ++#define bPesudoNoiseState_B 0xffff0000 ++#define bPesudoNoiseState_C 0xffff ++#define bPesudoNoiseState_D 0xffff0000 ++ ++/* 7. RF Register ++ * Zebra1 */ ++#define bZebra1_HSSIEnable 0x8 /* Useless */ ++#define bZebra1_TRxControl 0xc00 ++#define bZebra1_TRxGainSetting 0x07f ++#define bZebra1_RxCorner 0xc00 ++#define bZebra1_TxChargePump 0x38 ++#define bZebra1_RxChargePump 0x7 ++#define bZebra1_ChannelNum 0xf80 ++#define bZebra1_TxLPFBW 0x400 ++#define bZebra1_RxLPFBW 0x600 ++ ++/* Zebra4 */ ++#define bRTL8256RegModeCtrl1 0x100 /* Useless */ ++#define bRTL8256RegModeCtrl0 0x40 ++#define bRTL8256_TxLPFBW 0x18 ++#define bRTL8256_RxLPFBW 0x600 ++ ++/* RTL8258 */ ++#define bRTL8258_TxLPFBW 0xc /* Useless */ ++#define bRTL8258_RxLPFBW 0xc00 ++#define bRTL8258_RSSILPFBW 0xc0 ++ ++ ++/* ++ * Other Definition ++ * */ ++ ++/* byte endable for sb_write */ ++#define bByte0 0x1 /* Useless */ ++#define bByte1 0x2 ++#define bByte2 0x4 ++#define bByte3 0x8 ++#define bWord0 0x3 ++#define bWord1 0xc ++#define bDWord 0xf ++ ++/* for PutRegsetting & GetRegSetting BitMask */ ++#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ ++#define bMaskByte1 0xff00 ++#define bMaskByte2 0xff0000 ++#define bMaskByte3 0xff000000 ++#define bMaskHWord 0xffff0000 ++#define bMaskLWord 0x0000ffff ++#define bMaskDWord 0xffffffff ++#define bMaskH3Bytes 0xffffff00 ++#define bMask12Bits 0xfff ++#define bMaskH4Bits 0xf0000000 ++#define bMaskOFDM_D 0xffc00000 ++#define bMaskCCK 0x3f3f3f3f ++ ++ ++#define bEnable 0x1 /* Useless */ ++#define bDisable 0x0 ++ ++#define LeftAntenna 0x0 /* Useless */ ++#define RightAntenna 0x1 ++ ++#define tCheckTxStatus 500 /* 500ms */ /* Useless */ ++#define tUpdateRxCounter 100 /* 100ms */ ++ ++#define rateCCK 0 /* Useless */ ++#define rateOFDM 1 ++#define rateHT 2 ++ ++/* define Register-End */ ++#define bPMAC_End 0x1ff /* Useless */ ++#define bFPGAPHY0_End 0x8ff ++#define bFPGAPHY1_End 0x9ff ++#define bCCKPHY0_End 0xaff ++#define bOFDMPHY0_End 0xcff ++#define bOFDMPHY1_End 0xdff ++ ++/* define max debug item in each debug page ++ * #define bMaxItem_FPGA_PHY0 0x9 ++ * #define bMaxItem_FPGA_PHY1 0x3 ++ * #define bMaxItem_PHY_11B 0x16 ++ * #define bMaxItem_OFDM_PHY0 0x29 ++ * #define bMaxItem_OFDM_PHY1 0x0 */ ++ ++#define bPMACControl 0x0 /* Useless */ ++#define bWMACControl 0x1 ++#define bWNICControl 0x2 ++ ++#define PathA 0x0 /* Useless */ ++#define PathB 0x1 ++#define PathC 0x2 ++#define PathD 0x3 ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8703BPwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8703BPwrSeq.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8703BPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8703BPwrSeq.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,184 @@ ++#ifndef REALTEK_POWER_SEQUENCE_8703B ++#define REALTEK_POWER_SEQUENCE_8703B ++ ++#include "HalPwrSeqCmd.h" ++ ++/* ++ Check document WM-20140402-JackieLau-RTL8703B_Power_Architecture v09.vsd ++ There are 6 HW Power States: ++ 0: POFF--Power Off ++ 1: PDN--Power Down ++ 2: CARDEMU--Card Emulation ++ 3: ACT--Active Mode ++ 4: LPS--Low Power State ++ 5: SUS--Suspend ++ ++ The transision from different states are defined below ++ TRANS_CARDEMU_TO_ACT ++ TRANS_ACT_TO_CARDEMU ++ TRANS_CARDEMU_TO_SUS ++ TRANS_SUS_TO_CARDEMU ++ TRANS_CARDEMU_TO_PDN ++ TRANS_ACT_TO_LPS ++ TRANS_LPS_TO_ACT ++ ++ TRANS_END ++*/ ++#define RTL8703B_TRANS_CARDEMU_TO_ACT_STEPS 23 ++#define RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS 15 ++#define RTL8703B_TRANS_CARDEMU_TO_SUS_STEPS 15 ++#define RTL8703B_TRANS_SUS_TO_CARDEMU_STEPS 15 ++#define RTL8703B_TRANS_CARDEMU_TO_PDN_STEPS 15 ++#define RTL8703B_TRANS_PDN_TO_CARDEMU_STEPS 15 ++#define RTL8703B_TRANS_ACT_TO_LPS_STEPS 15 ++#define RTL8703B_TRANS_LPS_TO_ACT_STEPS 15 ++#define RTL8703B_TRANS_END_STEPS 1 ++ ++ ++#define RTL8703B_TRANS_CARDEMU_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ ++ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ ++ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ ++ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3 | BIT2), 0},/* disable SW LPS 0x04[10]=0 and WLSUS_EN 0x04[11]=0*/ \ ++ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , BIT0},/* Disable USB suspend */ \ ++ {0x0004, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 , BIT3},/* enabled usb resume */ \ ++ {0x0004, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 , 0},/* disable usb resume */ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ ++ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , 0},/* Enable USB suspend */ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3), 0},/* disable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ ++ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/* Enable WL control XTAL setting*/ \ ++ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable falling edge triggering interrupt*/\ ++ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable GPIO9 interrupt mode*/\ ++ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 input mode*/\ ++ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Enable HSISR GPIO[C:0] interrupt*/\ ++ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable HSISR GPIO9 interrupt*/\ ++ {0x0068, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3},/*For GPIO9 internal pull high setting by test chip*/\ ++ {0x0069, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/*For GPIO9 internal pull high setting*/\ ++ ++ ++#define RTL8703B_TRANS_ACT_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ ++ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable rising edge triggering interrupt*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ ++ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, 0},/* Enable BT control XTAL setting*/\ ++ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ ++ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/\ ++ ++ ++#define RTL8703B_TRANS_CARDEMU_TO_SUS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4 | BIT3, (BIT4 | BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ ++ ++#define RTL8703B_TRANS_SUS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ ++ ++#define RTL8703B_TRANS_CARDEMU_TO_CARDDIS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ ++ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ ++ ++#define RTL8703B_TRANS_CARDDIS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ ++ ++ ++#define RTL8703B_TRANS_CARDEMU_TO_PDN \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK | PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ ++ ++#define RTL8703B_TRANS_PDN_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ ++ ++#define RTL8703B_TRANS_ACT_TO_LPS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ ++ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ ++ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ ++ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ ++ ++ ++#define RTL8703B_TRANS_LPS_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ ++ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ ++ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ ++ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ ++ ++#define RTL8703B_TRANS_END \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, ++ ++ ++ extern WLAN_PWR_CFG rtl8703B_power_on_flow[RTL8703B_TRANS_CARDEMU_TO_ACT_STEPS + RTL8703B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8703B_radio_off_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8703B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8703B_card_disable_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8703B_TRANS_CARDEMU_TO_PDN_STEPS + RTL8703B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8703B_card_enable_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8703B_TRANS_CARDEMU_TO_PDN_STEPS + RTL8703B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8703B_suspend_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8703B_TRANS_CARDEMU_TO_SUS_STEPS + RTL8703B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8703B_resume_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8703B_TRANS_CARDEMU_TO_SUS_STEPS + RTL8703B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8703B_hwpdn_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8703B_TRANS_CARDEMU_TO_PDN_STEPS + RTL8703B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8703B_enter_lps_flow[RTL8703B_TRANS_ACT_TO_LPS_STEPS + RTL8703B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8703B_leave_lps_flow[RTL8703B_TRANS_LPS_TO_ACT_STEPS + RTL8703B_TRANS_END_STEPS]; ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723BPhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723BPhyCfg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723BPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723BPhyCfg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,136 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8723BPHYCFG_H__ ++#define __INC_HAL8723BPHYCFG_H__ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++#define LOOP_LIMIT 5 ++#define MAX_STALL_TIME 50 /* us */ ++#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ ++#define MAX_TXPWR_IDX_NMODE_92S 63 ++#define Reset_Cnt_Limit 3 ++ ++#ifdef CONFIG_PCI_HCI ++ #define MAX_AGGR_NUM 0x0B ++#else ++ #define MAX_AGGR_NUM 0x07 ++#endif /* CONFIG_PCI_HCI */ ++ ++ ++/*--------------------------Define Parameters End-------------------------------*/ ++ ++ ++/*------------------------------Define structure----------------------------*/ ++ ++/*------------------------------Define structure End----------------------------*/ ++ ++/*--------------------------Exported Function prototype---------------------*/ ++u32 ++PHY_QueryBBReg_8723B( ++ IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask ++); ++ ++VOID ++PHY_SetBBReg_8723B( ++ IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data ++); ++ ++u32 ++PHY_QueryRFReg_8723B( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask ++); ++ ++VOID ++PHY_SetRFReg_8723B( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data ++); ++ ++/* MAC/BB/RF HAL config */ ++int PHY_BBConfig8723B(PADAPTER Adapter); ++ ++int PHY_RFConfig8723B(PADAPTER Adapter); ++ ++s32 PHY_MACConfig8723B(PADAPTER padapter); ++ ++int ++PHY_ConfigRFWithParaFile_8723B( ++ IN PADAPTER Adapter, ++ IN u8 *pFileName, ++ RF_PATH eRFPath ++); ++ ++VOID ++PHY_SetTxPowerIndex_8723B( ++ IN PADAPTER Adapter, ++ IN u32 PowerIndex, ++ IN u8 RFPath, ++ IN u8 Rate ++); ++ ++u8 ++PHY_GetTxPowerIndex_8723B( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN u8 BandWidth, ++ IN u8 Channel, ++ struct txpwr_idx_comp *tic ++); ++ ++VOID ++PHY_GetTxPowerLevel8723B( ++ IN PADAPTER Adapter, ++ OUT s32 *powerlevel ++); ++ ++VOID ++PHY_SetTxPowerLevel8723B( ++ IN PADAPTER Adapter, ++ IN u8 channel ++); ++ ++VOID ++PHY_SetSwChnlBWMode8723B( ++ IN PADAPTER Adapter, ++ IN u8 channel, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 Offset40, ++ IN u8 Offset80 ++); ++ ++VOID PHY_SetRFPathSwitch_8723B( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bMain ++); ++/*--------------------------Exported Function prototype End---------------------*/ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723BPhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723BPhyReg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723BPhyReg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723BPhyReg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,1136 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8723BPHYREG_H__ ++#define __INC_HAL8723BPHYREG_H__ ++ ++#define rSYM_WLBT_PAPE_SEL 0x64 ++/* ++ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 ++ * 3. RF register 0x00-2E ++ * 4. Bit Mask for BB/RF register ++ * 5. Other defintion for BB/RF R/W ++ * */ ++ ++ ++/* ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 1. Page1(0x100) ++ * */ ++#define rPMAC_Reset 0x100 ++#define rPMAC_TxStart 0x104 ++#define rPMAC_TxLegacySIG 0x108 ++#define rPMAC_TxHTSIG1 0x10c ++#define rPMAC_TxHTSIG2 0x110 ++#define rPMAC_PHYDebug 0x114 ++#define rPMAC_TxPacketNum 0x118 ++#define rPMAC_TxIdle 0x11c ++#define rPMAC_TxMACHeader0 0x120 ++#define rPMAC_TxMACHeader1 0x124 ++#define rPMAC_TxMACHeader2 0x128 ++#define rPMAC_TxMACHeader3 0x12c ++#define rPMAC_TxMACHeader4 0x130 ++#define rPMAC_TxMACHeader5 0x134 ++#define rPMAC_TxDataType 0x138 ++#define rPMAC_TxRandomSeed 0x13c ++#define rPMAC_CCKPLCPPreamble 0x140 ++#define rPMAC_CCKPLCPHeader 0x144 ++#define rPMAC_CCKCRC16 0x148 ++#define rPMAC_OFDMRxCRC32OK 0x170 ++#define rPMAC_OFDMRxCRC32Er 0x174 ++#define rPMAC_OFDMRxParityEr 0x178 ++#define rPMAC_OFDMRxCRC8Er 0x17c ++#define rPMAC_CCKCRxRC16Er 0x180 ++#define rPMAC_CCKCRxRC32Er 0x184 ++#define rPMAC_CCKCRxRC32OK 0x188 ++#define rPMAC_TxStatus 0x18c ++ ++/* ++ * 2. Page2(0x200) ++ * ++ * The following two definition are only used for USB interface. */ ++#define RF_BB_CMD_ADDR 0x02c0 /* RF/BB read/write command address. */ ++#define RF_BB_CMD_DATA 0x02c4 /* RF/BB read/write command data. */ ++ ++/* ++ * 3. Page8(0x800) ++ * */ ++#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ ++ ++#define rFPGA0_TxInfo 0x804 /* Status report?? */ ++#define rFPGA0_PSDFunction 0x808 ++ ++#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ ++ ++#define rFPGA0_RFTiming1 0x810 /* Useless now */ ++#define rFPGA0_RFTiming2 0x814 ++ ++#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ ++#define rFPGA0_XA_HSSIParameter2 0x824 ++#define rFPGA0_XB_HSSIParameter1 0x828 ++#define rFPGA0_XB_HSSIParameter2 0x82c ++#define rTxAGC_B_Rate18_06 0x830 ++#define rTxAGC_B_Rate54_24 0x834 ++#define rTxAGC_B_CCK1_55_Mcs32 0x838 ++#define rTxAGC_B_Mcs03_Mcs00 0x83c ++ ++#define rTxAGC_B_Mcs07_Mcs04 0x848 ++#define rTxAGC_B_Mcs11_Mcs08 0x84c ++ ++#define rFPGA0_XA_LSSIParameter 0x840 ++#define rFPGA0_XB_LSSIParameter 0x844 ++ ++#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ ++#define rFPGA0_RFSleepUpParameter 0x854 ++ ++#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ ++#define rFPGA0_XCD_SwitchControl 0x85c ++ ++#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ ++#define rFPGA0_XB_RFInterfaceOE 0x864 ++ ++#define rTxAGC_B_Mcs15_Mcs12 0x868 ++#define rTxAGC_B_CCK11_A_CCK2_11 0x86c ++ ++#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ ++#define rFPGA0_XCD_RFInterfaceSW 0x874 ++ ++#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ ++#define rFPGA0_XCD_RFParameter 0x87c ++ ++#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ ++#define rFPGA0_AnalogParameter2 0x884 ++#define rFPGA0_AnalogParameter3 0x888 /* Useless now */ ++#define rFPGA0_AnalogParameter4 0x88c ++ ++#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ ++#define rFPGA0_XB_LSSIReadBack 0x8a4 ++#define rFPGA0_XC_LSSIReadBack 0x8a8 ++#define rFPGA0_XD_LSSIReadBack 0x8ac ++ ++#define rFPGA0_PSDReport 0x8b4 /* Useless now */ ++#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ ++#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ ++#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ ++#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ ++ ++/* ++ * 4. Page9(0x900) ++ * */ ++#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ ++#define rFPGA1_TxBlock 0x904 /* Useless now */ ++#define rFPGA1_DebugSelect 0x908 /* Useless now */ ++#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ ++#define rDPDT_control 0x92c ++#define rfe_ctrl_anta_src 0x930 ++#define rS0S1_PathSwitch 0x948 ++ ++/* ++ * 5. PageA(0xA00) ++ * ++ * Set Control channel to upper or lower. These settings are required only for 40MHz */ ++#define rCCK0_System 0xa00 ++ ++#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ ++#define rCCK0_CCA 0xa08 /* Disable init gain now */ /* Init gain */ ++ ++#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level */ /* Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ ++#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ ++ ++#define rCCK0_RxHP 0xa14 ++ ++#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ ++#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ ++ ++#define rCCK0_TxFilter1 0xa20 ++#define rCCK0_TxFilter2 0xa24 ++#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ ++#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ ++#define rCCK0_TRSSIReport 0xa50 ++#define rCCK0_RxReport 0xa54 /* 0xa57 */ ++#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ ++#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ ++ ++/* ++ * PageB(0xB00) ++ * */ ++#define rPdp_AntA 0xb00 ++#define rPdp_AntA_4 0xb04 ++#define rPdp_AntA_8 0xb08 ++#define rPdp_AntA_C 0xb0c ++#define rPdp_AntA_10 0xb10 ++#define rPdp_AntA_14 0xb14 ++#define rPdp_AntA_18 0xb18 ++#define rPdp_AntA_1C 0xb1c ++#define rPdp_AntA_20 0xb20 ++#define rPdp_AntA_24 0xb24 ++ ++#define rConfig_Pmpd_AntA 0xb28 ++#define rConfig_ram64x16 0xb2c ++ ++#define rBndA 0xb30 ++#define rHssiPar 0xb34 ++ ++#define rConfig_AntA 0xb68 ++#define rConfig_AntB 0xb6c ++ ++#define rPdp_AntB 0xb70 ++#define rPdp_AntB_4 0xb74 ++#define rPdp_AntB_8 0xb78 ++#define rPdp_AntB_C 0xb7c ++#define rPdp_AntB_10 0xb80 ++#define rPdp_AntB_14 0xb84 ++#define rPdp_AntB_18 0xb88 ++#define rPdp_AntB_1C 0xb8c ++#define rPdp_AntB_20 0xb90 ++#define rPdp_AntB_24 0xb94 ++ ++#define rConfig_Pmpd_AntB 0xb98 ++ ++#define rBndB 0xba0 ++ ++#define rAPK 0xbd8 ++#define rPm_Rx0_AntA 0xbdc ++#define rPm_Rx1_AntA 0xbe0 ++#define rPm_Rx2_AntA 0xbe4 ++#define rPm_Rx3_AntA 0xbe8 ++#define rPm_Rx0_AntB 0xbec ++#define rPm_Rx1_AntB 0xbf0 ++#define rPm_Rx2_AntB 0xbf4 ++#define rPm_Rx3_AntB 0xbf8 ++/* ++ * 6. PageC(0xC00) ++ * */ ++#define rOFDM0_LSTF 0xc00 ++ ++#define rOFDM0_TRxPathEnable 0xc04 ++#define rOFDM0_TRMuxPar 0xc08 ++#define rOFDM0_TRSWIsolation 0xc0c ++ ++#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ ++#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ ++#define rOFDM0_XBRxAFE 0xc18 ++#define rOFDM0_XBRxIQImbalance 0xc1c ++#define rOFDM0_XCRxAFE 0xc20 ++#define rOFDM0_XCRxIQImbalance 0xc24 ++#define rOFDM0_XDRxAFE 0xc28 ++#define rOFDM0_XDRxIQImbalance 0xc2c ++ ++#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ ++#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ ++#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ ++#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ ++ ++#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ ++#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ ++#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ ++#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ ++ ++#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ ++#define rOFDM0_XAAGCCore2 0xc54 ++#define rOFDM0_XBAGCCore1 0xc58 ++#define rOFDM0_XBAGCCore2 0xc5c ++#define rOFDM0_XCAGCCore1 0xc60 ++#define rOFDM0_XCAGCCore2 0xc64 ++#define rOFDM0_XDAGCCore1 0xc68 ++#define rOFDM0_XDAGCCore2 0xc6c ++ ++#define rOFDM0_AGCParameter1 0xc70 ++#define rOFDM0_AGCParameter2 0xc74 ++#define rOFDM0_AGCRSSITable 0xc78 ++#define rOFDM0_HTSTFAGC 0xc7c ++ ++#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ ++#define rOFDM0_XATxAFE 0xc84 ++#define rOFDM0_XBTxIQImbalance 0xc88 ++#define rOFDM0_XBTxAFE 0xc8c ++#define rOFDM0_XCTxIQImbalance 0xc90 ++#define rOFDM0_XCTxAFE 0xc94 ++#define rOFDM0_XDTxIQImbalance 0xc98 ++#define rOFDM0_XDTxAFE 0xc9c ++ ++#define rOFDM0_RxIQExtAnta 0xca0 ++#define rOFDM0_TxCoeff1 0xca4 ++#define rOFDM0_TxCoeff2 0xca8 ++#define rOFDM0_TxCoeff3 0xcac ++#define rOFDM0_TxCoeff4 0xcb0 ++#define rOFDM0_TxCoeff5 0xcb4 ++#define rOFDM0_TxCoeff6 0xcb8 ++#define rOFDM0_RxHPParameter 0xce0 ++#define rOFDM0_TxPseudoNoiseWgt 0xce4 ++#define rOFDM0_FrameSync 0xcf0 ++#define rOFDM0_DFSReport 0xcf4 ++ ++/* ++ * 7. PageD(0xD00) ++ * */ ++#define rOFDM1_LSTF 0xd00 ++#define rOFDM1_TRxPathEnable 0xd04 ++ ++#define rOFDM1_CFO 0xd08 /* No setting now */ ++#define rOFDM1_CSI1 0xd10 ++#define rOFDM1_SBD 0xd14 ++#define rOFDM1_CSI2 0xd18 ++#define rOFDM1_CFOTracking 0xd2c ++#define rOFDM1_TRxMesaure1 0xd34 ++#define rOFDM1_IntfDet 0xd3c ++#define rOFDM1_PseudoNoiseStateAB 0xd50 ++#define rOFDM1_PseudoNoiseStateCD 0xd54 ++#define rOFDM1_RxPseudoNoiseWgt 0xd58 ++ ++#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ ++#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ ++#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ ++ ++#define rOFDM_ShortCFOAB 0xdac /* No setting now */ ++#define rOFDM_ShortCFOCD 0xdb0 ++#define rOFDM_LongCFOAB 0xdb4 ++#define rOFDM_LongCFOCD 0xdb8 ++#define rOFDM_TailCFOAB 0xdbc ++#define rOFDM_TailCFOCD 0xdc0 ++#define rOFDM_PWMeasure1 0xdc4 ++#define rOFDM_PWMeasure2 0xdc8 ++#define rOFDM_BWReport 0xdcc ++#define rOFDM_AGCReport 0xdd0 ++#define rOFDM_RxSNR 0xdd4 ++#define rOFDM_RxEVMCSI 0xdd8 ++#define rOFDM_SIGReport 0xddc ++ ++ ++/* ++ * 8. PageE(0xE00) ++ * */ ++#define rTxAGC_A_Rate18_06 0xe00 ++#define rTxAGC_A_Rate54_24 0xe04 ++#define rTxAGC_A_CCK1_Mcs32 0xe08 ++#define rTxAGC_A_Mcs03_Mcs00 0xe10 ++#define rTxAGC_A_Mcs07_Mcs04 0xe14 ++#define rTxAGC_A_Mcs11_Mcs08 0xe18 ++#define rTxAGC_A_Mcs15_Mcs12 0xe1c ++ ++#define rFPGA0_IQK 0xe28 ++#define rTx_IQK_Tone_A 0xe30 ++#define rRx_IQK_Tone_A 0xe34 ++#define rTx_IQK_PI_A 0xe38 ++#define rRx_IQK_PI_A 0xe3c ++ ++#define rTx_IQK 0xe40 ++#define rRx_IQK 0xe44 ++#define rIQK_AGC_Pts 0xe48 ++#define rIQK_AGC_Rsp 0xe4c ++#define rTx_IQK_Tone_B 0xe50 ++#define rRx_IQK_Tone_B 0xe54 ++#define rTx_IQK_PI_B 0xe58 ++#define rRx_IQK_PI_B 0xe5c ++#define rIQK_AGC_Cont 0xe60 ++ ++#define rBlue_Tooth 0xe6c ++#define rRx_Wait_CCA 0xe70 ++#define rTx_CCK_RFON 0xe74 ++#define rTx_CCK_BBON 0xe78 ++#define rTx_OFDM_RFON 0xe7c ++#define rTx_OFDM_BBON 0xe80 ++#define rTx_To_Rx 0xe84 ++#define rTx_To_Tx 0xe88 ++#define rRx_CCK 0xe8c ++ ++#define rTx_Power_Before_IQK_A 0xe94 ++#define rTx_Power_After_IQK_A 0xe9c ++ ++#define rRx_Power_Before_IQK_A 0xea0 ++#define rRx_Power_Before_IQK_A_2 0xea4 ++#define rRx_Power_After_IQK_A 0xea8 ++#define rRx_Power_After_IQK_A_2 0xeac ++ ++#define rTx_Power_Before_IQK_B 0xeb4 ++#define rTx_Power_After_IQK_B 0xebc ++ ++#define rRx_Power_Before_IQK_B 0xec0 ++#define rRx_Power_Before_IQK_B_2 0xec4 ++#define rRx_Power_After_IQK_B 0xec8 ++#define rRx_Power_After_IQK_B_2 0xecc ++ ++#define rRx_OFDM 0xed0 ++#define rRx_Wait_RIFS 0xed4 ++#define rRx_TO_Rx 0xed8 ++#define rStandby 0xedc ++#define rSleep 0xee0 ++#define rPMPD_ANAEN 0xeec ++ ++/* ++ * 7. RF Register 0x00-0x2E (RF 8256) ++ * RF-0222D 0x00-3F ++ * ++ * Zebra1 */ ++#define rZebra1_HSSIEnable 0x0 /* Useless now */ ++#define rZebra1_TRxEnable1 0x1 ++#define rZebra1_TRxEnable2 0x2 ++#define rZebra1_AGC 0x4 ++#define rZebra1_ChargePump 0x5 ++#define rZebra1_Channel 0x7 /* RF channel switch */ ++ ++/* #endif */ ++#define rZebra1_TxGain 0x8 /* Useless now */ ++#define rZebra1_TxLPF 0x9 ++#define rZebra1_RxLPF 0xb ++#define rZebra1_RxHPFCorner 0xc ++ ++/* Zebra4 */ ++#define rGlobalCtrl 0 /* Useless now */ ++#define rRTL8256_TxLPF 19 ++#define rRTL8256_RxLPF 11 ++ ++/* RTL8258 */ ++#define rRTL8258_TxLPF 0x11 /* Useless now */ ++#define rRTL8258_RxLPF 0x13 ++#define rRTL8258_RSSILPF 0xa ++ ++/* ++ * RL6052 Register definition ++ * */ ++#define RF_AC 0x00 /* */ ++ ++#define RF_IQADJ_G1 0x01 /* */ ++#define RF_IQADJ_G2 0x02 /* */ ++#define RF_BS_PA_APSET_G1_G4 0x03 ++#define RF_BS_PA_APSET_G5_G8 0x04 ++#define RF_POW_TRSW 0x05 /* */ ++ ++#define RF_GAIN_RX 0x06 /* */ ++#define RF_GAIN_TX 0x07 /* */ ++ ++#define RF_TXM_IDAC 0x08 /* */ ++#define RF_IPA_G 0x09 /* */ ++#define RF_TXBIAS_G 0x0A ++#define RF_TXPA_AG 0x0B ++#define RF_IPA_A 0x0C /* */ ++#define RF_TXBIAS_A 0x0D ++#define RF_BS_PA_APSET_G9_G11 0x0E ++#define RF_BS_IQGEN 0x0F /* */ ++ ++#define RF_MODE1 0x10 /* */ ++#define RF_MODE2 0x11 /* */ ++ ++#define RF_RX_AGC_HP 0x12 /* */ ++#define RF_TX_AGC 0x13 /* */ ++#define RF_BIAS 0x14 /* */ ++#define RF_IPA 0x15 /* */ ++#define RF_TXBIAS 0x16 ++#define RF_POW_ABILITY 0x17 /* */ ++#define RF_MODE_AG 0x18 /* */ ++#define rRfChannel 0x18 /* RF channel and BW switch */ ++#define RF_CHNLBW 0x18 /* RF channel and BW switch */ ++#define RF_TOP 0x19 /* */ ++ ++#define RF_RX_G1 0x1A /* */ ++#define RF_RX_G2 0x1B /* */ ++ ++#define RF_RX_BB2 0x1C /* */ ++#define RF_RX_BB1 0x1D /* */ ++ ++#define RF_RCK1 0x1E /* */ ++#define RF_RCK2 0x1F /* */ ++ ++#define RF_TX_G1 0x20 /* */ ++#define RF_TX_G2 0x21 /* */ ++#define RF_TX_G3 0x22 /* */ ++ ++#define RF_TX_BB1 0x23 /* */ ++ ++#define RF_T_METER 0x24 /* */ ++ ++#define RF_SYN_G1 0x25 /* RF TX Power control */ ++#define RF_SYN_G2 0x26 /* RF TX Power control */ ++#define RF_SYN_G3 0x27 /* RF TX Power control */ ++#define RF_SYN_G4 0x28 /* RF TX Power control */ ++#define RF_SYN_G5 0x29 /* RF TX Power control */ ++#define RF_SYN_G6 0x2A /* RF TX Power control */ ++#define RF_SYN_G7 0x2B /* RF TX Power control */ ++#define RF_SYN_G8 0x2C /* RF TX Power control */ ++ ++#define RF_RCK_OS 0x30 /* RF TX PA control */ ++ ++#define RF_TXPA_G1 0x31 /* RF TX PA control */ ++#define RF_TXPA_G2 0x32 /* RF TX PA control */ ++#define RF_TXPA_G3 0x33 /* RF TX PA control */ ++#define RF_TX_BIAS_A 0x35 ++#define RF_TX_BIAS_D 0x36 ++#define RF_LOBF_9 0x38 ++#define RF_RXRF_A3 0x3C /* */ ++#define RF_TRSW 0x3F ++ ++#define RF_TXRF_A2 0x41 ++#define RF_TXPA_G4 0x46 ++#define RF_TXPA_A4 0x4B ++#define RF_0x52 0x52 ++#define RF_WE_LUT 0xEF ++#define RF_S0S1 0xB0 ++ ++/* ++ * Bit Mask ++ * ++ * 1. Page1(0x100) */ ++#define bBBResetB 0x100 /* Useless now? */ ++#define bGlobalResetB 0x200 ++#define bOFDMTxStart 0x4 ++#define bCCKTxStart 0x8 ++#define bCRC32Debug 0x100 ++#define bPMACLoopback 0x10 ++#define bTxLSIG 0xffffff ++#define bOFDMTxRate 0xf ++#define bOFDMTxReserved 0x10 ++#define bOFDMTxLength 0x1ffe0 ++#define bOFDMTxParity 0x20000 ++#define bTxHTSIG1 0xffffff ++#define bTxHTMCSRate 0x7f ++#define bTxHTBW 0x80 ++#define bTxHTLength 0xffff00 ++#define bTxHTSIG2 0xffffff ++#define bTxHTSmoothing 0x1 ++#define bTxHTSounding 0x2 ++#define bTxHTReserved 0x4 ++#define bTxHTAggreation 0x8 ++#define bTxHTSTBC 0x30 ++#define bTxHTAdvanceCoding 0x40 ++#define bTxHTShortGI 0x80 ++#define bTxHTNumberHT_LTF 0x300 ++#define bTxHTCRC8 0x3fc00 ++#define bCounterReset 0x10000 ++#define bNumOfOFDMTx 0xffff ++#define bNumOfCCKTx 0xffff0000 ++#define bTxIdleInterval 0xffff ++#define bOFDMService 0xffff0000 ++#define bTxMACHeader 0xffffffff ++#define bTxDataInit 0xff ++#define bTxHTMode 0x100 ++#define bTxDataType 0x30000 ++#define bTxRandomSeed 0xffffffff ++#define bCCKTxPreamble 0x1 ++#define bCCKTxSFD 0xffff0000 ++#define bCCKTxSIG 0xff ++#define bCCKTxService 0xff00 ++#define bCCKLengthExt 0x8000 ++#define bCCKTxLength 0xffff0000 ++#define bCCKTxCRC16 0xffff ++#define bCCKTxStatus 0x1 ++#define bOFDMTxStatus 0x2 ++ ++#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) ++ ++/* 2. Page8(0x800) */ ++#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ ++#define bJapanMode 0x2 ++#define bCCKTxSC 0x30 ++#define bCCKEn 0x1000000 ++#define bOFDMEn 0x2000000 ++ ++#define bOFDMRxADCPhase 0x10000 /* Useless now */ ++#define bOFDMTxDACPhase 0x40000 ++#define bXATxAGC 0x3f ++ ++#define bAntennaSelect 0x0300 ++ ++#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ ++#define bXCTxAGC 0xf000 ++#define bXDTxAGC 0xf0000 ++ ++#define bPAStart 0xf0000000 /* Useless now */ ++#define bTRStart 0x00f00000 ++#define bRFStart 0x0000f000 ++#define bBBStart 0x000000f0 ++#define bBBCCKStart 0x0000000f ++#define bPAEnd 0xf /* Reg0x814 */ ++#define bTREnd 0x0f000000 ++#define bRFEnd 0x000f0000 ++#define bCCAMask 0x000000f0 /* T2R */ ++#define bR2RCCAMask 0x00000f00 ++#define bHSSI_R2TDelay 0xf8000000 ++#define bHSSI_T2RDelay 0xf80000 ++#define bContTxHSSI 0x400 /* chane gain at continue Tx */ ++#define bIGFromCCK 0x200 ++#define bAGCAddress 0x3f ++#define bRxHPTx 0x7000 ++#define bRxHPT2R 0x38000 ++#define bRxHPCCKIni 0xc0000 ++#define bAGCTxCode 0xc00000 ++#define bAGCRxCode 0x300000 ++ ++#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ ++#define b3WireAddressLength 0x400 ++ ++#define b3WireRFPowerDown 0x1 /* Useless now ++ * #define bHWSISelect 0x8 */ ++#define b5GPAPEPolarity 0x40000000 ++#define b2GPAPEPolarity 0x80000000 ++#define bRFSW_TxDefaultAnt 0x3 ++#define bRFSW_TxOptionAnt 0x30 ++#define bRFSW_RxDefaultAnt 0x300 ++#define bRFSW_RxOptionAnt 0x3000 ++#define bRFSI_3WireData 0x1 ++#define bRFSI_3WireClock 0x2 ++#define bRFSI_3WireLoad 0x4 ++#define bRFSI_3WireRW 0x8 ++#define bRFSI_3Wire 0xf ++ ++#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ ++ ++#define bRFSI_TRSW 0x20 /* Useless now */ ++#define bRFSI_TRSWB 0x40 ++#define bRFSI_ANTSW 0x100 ++#define bRFSI_ANTSWB 0x200 ++#define bRFSI_PAPE 0x400 ++#define bRFSI_PAPE5G 0x800 ++#define bBandSelect 0x1 ++#define bHTSIG2_GI 0x80 ++#define bHTSIG2_Smoothing 0x01 ++#define bHTSIG2_Sounding 0x02 ++#define bHTSIG2_Aggreaton 0x08 ++#define bHTSIG2_STBC 0x30 ++#define bHTSIG2_AdvCoding 0x40 ++#define bHTSIG2_NumOfHTLTF 0x300 ++#define bHTSIG2_CRC8 0x3fc ++#define bHTSIG1_MCS 0x7f ++#define bHTSIG1_BandWidth 0x80 ++#define bHTSIG1_HTLength 0xffff ++#define bLSIG_Rate 0xf ++#define bLSIG_Reserved 0x10 ++#define bLSIG_Length 0x1fffe ++#define bLSIG_Parity 0x20 ++#define bCCKRxPhase 0x4 ++ ++#define bLSSIReadAddress 0x7f800000 /* T65 RF */ ++ ++#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ ++ ++#define bLSSIReadBackData 0xfffff /* T65 RF */ ++ ++#define bLSSIReadOKFlag 0x1000 /* Useless now */ ++#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ ++#define bRegulator0Standby 0x1 ++#define bRegulatorPLLStandby 0x2 ++#define bRegulator1Standby 0x4 ++#define bPLLPowerUp 0x8 ++#define bDPLLPowerUp 0x10 ++#define bDA10PowerUp 0x20 ++#define bAD7PowerUp 0x200 ++#define bDA6PowerUp 0x2000 ++#define bXtalPowerUp 0x4000 ++#define b40MDClkPowerUP 0x8000 ++#define bDA6DebugMode 0x20000 ++#define bDA6Swing 0x380000 ++ ++#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ ++ ++#define b80MClkDelay 0x18000000 /* Useless */ ++#define bAFEWatchDogEnable 0x20000000 ++ ++#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ ++#define bXtalCap23 0x3 ++#define bXtalCap92x 0x0f000000 ++#define bXtalCap 0x0f000000 ++ ++#define bIntDifClkEnable 0x400 /* Useless */ ++#define bExtSigClkEnable 0x800 ++#define bBandgapMbiasPowerUp 0x10000 ++#define bAD11SHGain 0xc0000 ++#define bAD11InputRange 0x700000 ++#define bAD11OPCurrent 0x3800000 ++#define bIPathLoopback 0x4000000 ++#define bQPathLoopback 0x8000000 ++#define bAFELoopback 0x10000000 ++#define bDA10Swing 0x7e0 ++#define bDA10Reverse 0x800 ++#define bDAClkSource 0x1000 ++#define bAD7InputRange 0x6000 ++#define bAD7Gain 0x38000 ++#define bAD7OutputCMMode 0x40000 ++#define bAD7InputCMMode 0x380000 ++#define bAD7Current 0xc00000 ++#define bRegulatorAdjust 0x7000000 ++#define bAD11PowerUpAtTx 0x1 ++#define bDA10PSAtTx 0x10 ++#define bAD11PowerUpAtRx 0x100 ++#define bDA10PSAtRx 0x1000 ++#define bCCKRxAGCFormat 0x200 ++#define bPSDFFTSamplepPoint 0xc000 ++#define bPSDAverageNum 0x3000 ++#define bIQPathControl 0xc00 ++#define bPSDFreq 0x3ff ++#define bPSDAntennaPath 0x30 ++#define bPSDIQSwitch 0x40 ++#define bPSDRxTrigger 0x400000 ++#define bPSDTxTrigger 0x80000000 ++#define bPSDSineToneScale 0x7f000000 ++#define bPSDReport 0xffff ++ ++/* 3. Page9(0x900) */ ++#define bOFDMTxSC 0x30000000 /* Useless */ ++#define bCCKTxOn 0x1 ++#define bOFDMTxOn 0x2 ++#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ ++#define bDebugItem 0xff /* reset debug page and LWord */ ++#define bAntL 0x10 ++#define bAntNonHT 0x100 ++#define bAntHT1 0x1000 ++#define bAntHT2 0x10000 ++#define bAntHT1S1 0x100000 ++#define bAntNonHTS1 0x1000000 ++ ++/* 4. PageA(0xA00) */ ++#define bCCKBBMode 0x3 /* Useless */ ++#define bCCKTxPowerSaving 0x80 ++#define bCCKRxPowerSaving 0x40 ++ ++#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ ++ ++#define bCCKScramble 0x8 /* Useless */ ++#define bCCKAntDiversity 0x8000 ++#define bCCKCarrierRecovery 0x4000 ++#define bCCKTxRate 0x3000 ++#define bCCKDCCancel 0x0800 ++#define bCCKISICancel 0x0400 ++#define bCCKMatchFilter 0x0200 ++#define bCCKEqualizer 0x0100 ++#define bCCKPreambleDetect 0x800000 ++#define bCCKFastFalseCCA 0x400000 ++#define bCCKChEstStart 0x300000 ++#define bCCKCCACount 0x080000 ++#define bCCKcs_lim 0x070000 ++#define bCCKBistMode 0x80000000 ++#define bCCKCCAMask 0x40000000 ++#define bCCKTxDACPhase 0x4 ++#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ ++#define bCCKr_cp_mode0 0x0100 ++#define bCCKTxDCOffset 0xf0 ++#define bCCKRxDCOffset 0xf ++#define bCCKCCAMode 0xc000 ++#define bCCKFalseCS_lim 0x3f00 ++#define bCCKCS_ratio 0xc00000 ++#define bCCKCorgBit_sel 0x300000 ++#define bCCKPD_lim 0x0f0000 ++#define bCCKNewCCA 0x80000000 ++#define bCCKRxHPofIG 0x8000 ++#define bCCKRxIG 0x7f00 ++#define bCCKLNAPolarity 0x800000 ++#define bCCKRx1stGain 0x7f0000 ++#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ ++#define bCCKRxAGCSatLevel 0x1f000000 ++#define bCCKRxAGCSatCount 0xe0 ++#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ ++#define bCCKFixedRxAGC 0x8000 ++/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ ++#define bCCKAntennaPolarity 0x2000 ++#define bCCKTxFilterType 0x0c00 ++#define bCCKRxAGCReportType 0x0300 ++#define bCCKRxDAGCEn 0x80000000 ++#define bCCKRxDAGCPeriod 0x20000000 ++#define bCCKRxDAGCSatLevel 0x1f000000 ++#define bCCKTimingRecovery 0x800000 ++#define bCCKTxC0 0x3f0000 ++#define bCCKTxC1 0x3f000000 ++#define bCCKTxC2 0x3f ++#define bCCKTxC3 0x3f00 ++#define bCCKTxC4 0x3f0000 ++#define bCCKTxC5 0x3f000000 ++#define bCCKTxC6 0x3f ++#define bCCKTxC7 0x3f00 ++#define bCCKDebugPort 0xff0000 ++#define bCCKDACDebug 0x0f000000 ++#define bCCKFalseAlarmEnable 0x8000 ++#define bCCKFalseAlarmRead 0x4000 ++#define bCCKTRSSI 0x7f ++#define bCCKRxAGCReport 0xfe ++#define bCCKRxReport_AntSel 0x80000000 ++#define bCCKRxReport_MFOff 0x40000000 ++#define bCCKRxRxReport_SQLoss 0x20000000 ++#define bCCKRxReport_Pktloss 0x10000000 ++#define bCCKRxReport_Lockedbit 0x08000000 ++#define bCCKRxReport_RateError 0x04000000 ++#define bCCKRxReport_RxRate 0x03000000 ++#define bCCKRxFACounterLower 0xff ++#define bCCKRxFACounterUpper 0xff000000 ++#define bCCKRxHPAGCStart 0xe000 ++#define bCCKRxHPAGCFinal 0x1c00 ++#define bCCKRxFalseAlarmEnable 0x8000 ++#define bCCKFACounterFreeze 0x4000 ++#define bCCKTxPathSel 0x10000000 ++#define bCCKDefaultRxPath 0xc000000 ++#define bCCKOptionRxPath 0x3000000 ++ ++/* 5. PageC(0xC00) */ ++#define bNumOfSTF 0x3 /* Useless */ ++#define bShift_L 0xc0 ++#define bGI_TH 0xc ++#define bRxPathA 0x1 ++#define bRxPathB 0x2 ++#define bRxPathC 0x4 ++#define bRxPathD 0x8 ++#define bTxPathA 0x1 ++#define bTxPathB 0x2 ++#define bTxPathC 0x4 ++#define bTxPathD 0x8 ++#define bTRSSIFreq 0x200 ++#define bADCBackoff 0x3000 ++#define bDFIRBackoff 0xc000 ++#define bTRSSILatchPhase 0x10000 ++#define bRxIDCOffset 0xff ++#define bRxQDCOffset 0xff00 ++#define bRxDFIRMode 0x1800000 ++#define bRxDCNFType 0xe000000 ++#define bRXIQImb_A 0x3ff ++#define bRXIQImb_B 0xfc00 ++#define bRXIQImb_C 0x3f0000 ++#define bRXIQImb_D 0xffc00000 ++#define bDC_dc_Notch 0x60000 ++#define bRxNBINotch 0x1f000000 ++#define bPD_TH 0xf ++#define bPD_TH_Opt2 0xc000 ++#define bPWED_TH 0x700 ++#define bIfMF_Win_L 0x800 ++#define bPD_Option 0x1000 ++#define bMF_Win_L 0xe000 ++#define bBW_Search_L 0x30000 ++#define bwin_enh_L 0xc0000 ++#define bBW_TH 0x700000 ++#define bED_TH2 0x3800000 ++#define bBW_option 0x4000000 ++#define bRatio_TH 0x18000000 ++#define bWindow_L 0xe0000000 ++#define bSBD_Option 0x1 ++#define bFrame_TH 0x1c ++#define bFS_Option 0x60 ++#define bDC_Slope_check 0x80 ++#define bFGuard_Counter_DC_L 0xe00 ++#define bFrame_Weight_Short 0x7000 ++#define bSub_Tune 0xe00000 ++#define bFrame_DC_Length 0xe000000 ++#define bSBD_start_offset 0x30000000 ++#define bFrame_TH_2 0x7 ++#define bFrame_GI2_TH 0x38 ++#define bGI2_Sync_en 0x40 ++#define bSarch_Short_Early 0x300 ++#define bSarch_Short_Late 0xc00 ++#define bSarch_GI2_Late 0x70000 ++#define bCFOAntSum 0x1 ++#define bCFOAcc 0x2 ++#define bCFOStartOffset 0xc ++#define bCFOLookBack 0x70 ++#define bCFOSumWeight 0x80 ++#define bDAGCEnable 0x10000 ++#define bTXIQImb_A 0x3ff ++#define bTXIQImb_B 0xfc00 ++#define bTXIQImb_C 0x3f0000 ++#define bTXIQImb_D 0xffc00000 ++#define bTxIDCOffset 0xff ++#define bTxQDCOffset 0xff00 ++#define bTxDFIRMode 0x10000 ++#define bTxPesudoNoiseOn 0x4000000 ++#define bTxPesudoNoise_A 0xff ++#define bTxPesudoNoise_B 0xff00 ++#define bTxPesudoNoise_C 0xff0000 ++#define bTxPesudoNoise_D 0xff000000 ++#define bCCADropOption 0x20000 ++#define bCCADropThres 0xfff00000 ++#define bEDCCA_H 0xf ++#define bEDCCA_L 0xf0 ++#define bLambda_ED 0x300 ++#define bRxInitialGain 0x7f ++#define bRxAntDivEn 0x80 ++#define bRxAGCAddressForLNA 0x7f00 ++#define bRxHighPowerFlow 0x8000 ++#define bRxAGCFreezeThres 0xc0000 ++#define bRxFreezeStep_AGC1 0x300000 ++#define bRxFreezeStep_AGC2 0xc00000 ++#define bRxFreezeStep_AGC3 0x3000000 ++#define bRxFreezeStep_AGC0 0xc000000 ++#define bRxRssi_Cmp_En 0x10000000 ++#define bRxQuickAGCEn 0x20000000 ++#define bRxAGCFreezeThresMode 0x40000000 ++#define bRxOverFlowCheckType 0x80000000 ++#define bRxAGCShift 0x7f ++#define bTRSW_Tri_Only 0x80 ++#define bPowerThres 0x300 ++#define bRxAGCEn 0x1 ++#define bRxAGCTogetherEn 0x2 ++#define bRxAGCMin 0x4 ++#define bRxHP_Ini 0x7 ++#define bRxHP_TRLNA 0x70 ++#define bRxHP_RSSI 0x700 ++#define bRxHP_BBP1 0x7000 ++#define bRxHP_BBP2 0x70000 ++#define bRxHP_BBP3 0x700000 ++#define bRSSI_H 0x7f0000 /* the threshold for high power */ ++#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ ++#define bRxSettle_TRSW 0x7 ++#define bRxSettle_LNA 0x38 ++#define bRxSettle_RSSI 0x1c0 ++#define bRxSettle_BBP 0xe00 ++#define bRxSettle_RxHP 0x7000 ++#define bRxSettle_AntSW_RSSI 0x38000 ++#define bRxSettle_AntSW 0xc0000 ++#define bRxProcessTime_DAGC 0x300000 ++#define bRxSettle_HSSI 0x400000 ++#define bRxProcessTime_BBPPW 0x800000 ++#define bRxAntennaPowerShift 0x3000000 ++#define bRSSITableSelect 0xc000000 ++#define bRxHP_Final 0x7000000 ++#define bRxHTSettle_BBP 0x7 ++#define bRxHTSettle_HSSI 0x8 ++#define bRxHTSettle_RxHP 0x70 ++#define bRxHTSettle_BBPPW 0x80 ++#define bRxHTSettle_Idle 0x300 ++#define bRxHTSettle_Reserved 0x1c00 ++#define bRxHTRxHPEn 0x8000 ++#define bRxHTAGCFreezeThres 0x30000 ++#define bRxHTAGCTogetherEn 0x40000 ++#define bRxHTAGCMin 0x80000 ++#define bRxHTAGCEn 0x100000 ++#define bRxHTDAGCEn 0x200000 ++#define bRxHTRxHP_BBP 0x1c00000 ++#define bRxHTRxHP_Final 0xe0000000 ++#define bRxPWRatioTH 0x3 ++#define bRxPWRatioEn 0x4 ++#define bRxMFHold 0x3800 ++#define bRxPD_Delay_TH1 0x38 ++#define bRxPD_Delay_TH2 0x1c0 ++#define bRxPD_DC_COUNT_MAX 0x600 ++/* #define bRxMF_Hold 0x3800 */ ++#define bRxPD_Delay_TH 0x8000 ++#define bRxProcess_Delay 0xf0000 ++#define bRxSearchrange_GI2_Early 0x700000 ++#define bRxFrame_Guard_Counter_L 0x3800000 ++#define bRxSGI_Guard_L 0xc000000 ++#define bRxSGI_Search_L 0x30000000 ++#define bRxSGI_TH 0xc0000000 ++#define bDFSCnt0 0xff ++#define bDFSCnt1 0xff00 ++#define bDFSFlag 0xf0000 ++#define bMFWeightSum 0x300000 ++#define bMinIdxTH 0x7f000000 ++#define bDAFormat 0x40000 ++#define bTxChEmuEnable 0x01000000 ++#define bTRSWIsolation_A 0x7f ++#define bTRSWIsolation_B 0x7f00 ++#define bTRSWIsolation_C 0x7f0000 ++#define bTRSWIsolation_D 0x7f000000 ++#define bExtLNAGain 0x7c00 ++ ++/* 6. PageE(0xE00) */ ++#define bSTBCEn 0x4 /* Useless */ ++#define bAntennaMapping 0x10 ++#define bNss 0x20 ++#define bCFOAntSumD 0x200 ++#define bPHYCounterReset 0x8000000 ++#define bCFOReportGet 0x4000000 ++#define bOFDMContinueTx 0x10000000 ++#define bOFDMSingleCarrier 0x20000000 ++#define bOFDMSingleTone 0x40000000 ++/* #define bRxPath1 0x01 */ ++/* #define bRxPath2 0x02 */ ++/* #define bRxPath3 0x04 */ ++/* #define bRxPath4 0x08 */ ++/* #define bTxPath1 0x10 */ ++/* #define bTxPath2 0x20 */ ++#define bHTDetect 0x100 ++#define bCFOEn 0x10000 ++#define bCFOValue 0xfff00000 ++#define bSigTone_Re 0x3f ++#define bSigTone_Im 0x7f00 ++#define bCounter_CCA 0xffff ++#define bCounter_ParityFail 0xffff0000 ++#define bCounter_RateIllegal 0xffff ++#define bCounter_CRC8Fail 0xffff0000 ++#define bCounter_MCSNoSupport 0xffff ++#define bCounter_FastSync 0xffff ++#define bShortCFO 0xfff ++#define bShortCFOTLength 12 /* total */ ++#define bShortCFOFLength 11 /* fraction */ ++#define bLongCFO 0x7ff ++#define bLongCFOTLength 11 ++#define bLongCFOFLength 11 ++#define bTailCFO 0x1fff ++#define bTailCFOTLength 13 ++#define bTailCFOFLength 12 ++#define bmax_en_pwdB 0xffff ++#define bCC_power_dB 0xffff0000 ++#define bnoise_pwdB 0xffff ++#define bPowerMeasTLength 10 ++#define bPowerMeasFLength 3 ++#define bRx_HT_BW 0x1 ++#define bRxSC 0x6 ++#define bRx_HT 0x8 ++#define bNB_intf_det_on 0x1 ++#define bIntf_win_len_cfg 0x30 ++#define bNB_Intf_TH_cfg 0x1c0 ++#define bRFGain 0x3f ++#define bTableSel 0x40 ++#define bTRSW 0x80 ++#define bRxSNR_A 0xff ++#define bRxSNR_B 0xff00 ++#define bRxSNR_C 0xff0000 ++#define bRxSNR_D 0xff000000 ++#define bSNREVMTLength 8 ++#define bSNREVMFLength 1 ++#define bCSI1st 0xff ++#define bCSI2nd 0xff00 ++#define bRxEVM1st 0xff0000 ++#define bRxEVM2nd 0xff000000 ++#define bSIGEVM 0xff ++#define bPWDB 0xff00 ++#define bSGIEN 0x10000 ++ ++#define bSFactorQAM1 0xf /* Useless */ ++#define bSFactorQAM2 0xf0 ++#define bSFactorQAM3 0xf00 ++#define bSFactorQAM4 0xf000 ++#define bSFactorQAM5 0xf0000 ++#define bSFactorQAM6 0xf0000 ++#define bSFactorQAM7 0xf00000 ++#define bSFactorQAM8 0xf000000 ++#define bSFactorQAM9 0xf0000000 ++#define bCSIScheme 0x100000 ++ ++#define bNoiseLvlTopSet 0x3 /* Useless */ ++#define bChSmooth 0x4 ++#define bChSmoothCfg1 0x38 ++#define bChSmoothCfg2 0x1c0 ++#define bChSmoothCfg3 0xe00 ++#define bChSmoothCfg4 0x7000 ++#define bMRCMode 0x800000 ++#define bTHEVMCfg 0x7000000 ++ ++#define bLoopFitType 0x1 /* Useless */ ++#define bUpdCFO 0x40 ++#define bUpdCFOOffData 0x80 ++#define bAdvUpdCFO 0x100 ++#define bAdvTimeCtrl 0x800 ++#define bUpdClko 0x1000 ++#define bFC 0x6000 ++#define bTrackingMode 0x8000 ++#define bPhCmpEnable 0x10000 ++#define bUpdClkoLTF 0x20000 ++#define bComChCFO 0x40000 ++#define bCSIEstiMode 0x80000 ++#define bAdvUpdEqz 0x100000 ++#define bUChCfg 0x7000000 ++#define bUpdEqz 0x8000000 ++ ++/* Rx Pseduo noise */ ++#define bRxPesudoNoiseOn 0x20000000 /* Useless */ ++#define bRxPesudoNoise_A 0xff ++#define bRxPesudoNoise_B 0xff00 ++#define bRxPesudoNoise_C 0xff0000 ++#define bRxPesudoNoise_D 0xff000000 ++#define bPesudoNoiseState_A 0xffff ++#define bPesudoNoiseState_B 0xffff0000 ++#define bPesudoNoiseState_C 0xffff ++#define bPesudoNoiseState_D 0xffff0000 ++ ++/* 7. RF Register ++ * Zebra1 */ ++#define bZebra1_HSSIEnable 0x8 /* Useless */ ++#define bZebra1_TRxControl 0xc00 ++#define bZebra1_TRxGainSetting 0x07f ++#define bZebra1_RxCorner 0xc00 ++#define bZebra1_TxChargePump 0x38 ++#define bZebra1_RxChargePump 0x7 ++#define bZebra1_ChannelNum 0xf80 ++#define bZebra1_TxLPFBW 0x400 ++#define bZebra1_RxLPFBW 0x600 ++ ++/* Zebra4 */ ++#define bRTL8256RegModeCtrl1 0x100 /* Useless */ ++#define bRTL8256RegModeCtrl0 0x40 ++#define bRTL8256_TxLPFBW 0x18 ++#define bRTL8256_RxLPFBW 0x600 ++ ++/* RTL8258 */ ++#define bRTL8258_TxLPFBW 0xc /* Useless */ ++#define bRTL8258_RxLPFBW 0xc00 ++#define bRTL8258_RSSILPFBW 0xc0 ++ ++ ++/* ++ * Other Definition ++ * */ ++ ++/* byte endable for sb_write */ ++#define bByte0 0x1 /* Useless */ ++#define bByte1 0x2 ++#define bByte2 0x4 ++#define bByte3 0x8 ++#define bWord0 0x3 ++#define bWord1 0xc ++#define bDWord 0xf ++ ++/* for PutRegsetting & GetRegSetting BitMask */ ++#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ ++#define bMaskByte1 0xff00 ++#define bMaskByte2 0xff0000 ++#define bMaskByte3 0xff000000 ++#define bMaskHWord 0xffff0000 ++#define bMaskLWord 0x0000ffff ++#define bMaskDWord 0xffffffff ++#define bMaskH3Bytes 0xffffff00 ++#define bMask12Bits 0xfff ++#define bMaskH4Bits 0xf0000000 ++#define bMaskOFDM_D 0xffc00000 ++#define bMaskCCK 0x3f3f3f3f ++ ++ ++#define bEnable 0x1 /* Useless */ ++#define bDisable 0x0 ++ ++#define LeftAntenna 0x0 /* Useless */ ++#define RightAntenna 0x1 ++ ++#define tCheckTxStatus 500 /* 500ms */ /* Useless */ ++#define tUpdateRxCounter 100 /* 100ms */ ++ ++#define rateCCK 0 /* Useless */ ++#define rateOFDM 1 ++#define rateHT 2 ++ ++/* define Register-End */ ++#define bPMAC_End 0x1ff /* Useless */ ++#define bFPGAPHY0_End 0x8ff ++#define bFPGAPHY1_End 0x9ff ++#define bCCKPHY0_End 0xaff ++#define bOFDMPHY0_End 0xcff ++#define bOFDMPHY1_End 0xdff ++ ++/* define max debug item in each debug page ++ * #define bMaxItem_FPGA_PHY0 0x9 ++ * #define bMaxItem_FPGA_PHY1 0x3 ++ * #define bMaxItem_PHY_11B 0x16 ++ * #define bMaxItem_OFDM_PHY0 0x29 ++ * #define bMaxItem_OFDM_PHY1 0x0 */ ++ ++#define bPMACControl 0x0 /* Useless */ ++#define bWMACControl 0x1 ++#define bWNICControl 0x2 ++ ++#define PathA 0x0 /* Useless */ ++#define PathB 0x1 ++#define PathC 0x2 ++#define PathD 0x3 ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723BPwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723BPwrSeq.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723BPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723BPwrSeq.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,232 @@ ++#ifndef REALTEK_POWER_SEQUENCE_8723B ++#define REALTEK_POWER_SEQUENCE_8723B ++ ++#include "HalPwrSeqCmd.h" ++ ++/* ++ Check document WM-20130815-JackieLau-RTL8723B_Power_Architecture v08.vsd ++ There are 6 HW Power States: ++ 0: POFF--Power Off ++ 1: PDN--Power Down ++ 2: CARDEMU--Card Emulation ++ 3: ACT--Active Mode ++ 4: LPS--Low Power State ++ 5: SUS--Suspend ++ ++ The transision from different states are defined below ++ TRANS_CARDEMU_TO_ACT ++ TRANS_ACT_TO_CARDEMU ++ TRANS_CARDEMU_TO_SUS ++ TRANS_SUS_TO_CARDEMU ++ TRANS_CARDEMU_TO_PDN ++ TRANS_ACT_TO_LPS ++ TRANS_LPS_TO_ACT ++ ++ TRANS_END ++*/ ++#define RTL8723B_TRANS_CARDEMU_TO_ACT_STEPS 26 ++#define RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS 15 ++#define RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS 15 ++#define RTL8723B_TRANS_SUS_TO_CARDEMU_STEPS 15 ++#define RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS 15 ++#define RTL8723B_TRANS_PDN_TO_CARDEMU_STEPS 15 ++#define RTL8723B_TRANS_ACT_TO_LPS_STEPS 15 ++#define RTL8723B_TRANS_LPS_TO_ACT_STEPS 15 ++#define RTL8723B_TRANS_ACT_TO_SWLPS_STEPS 22 ++#define RTL8723B_TRANS_SWLPS_TO_ACT_STEPS 15 ++#define RTL8723B_TRANS_END_STEPS 1 ++ ++ ++#define RTL8723B_TRANS_CARDEMU_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ ++ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ ++ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ ++ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3 | BIT2), 0},/* disable SW LPS 0x04[10]=0 and WLSUS_EN 0x04[11]=0*/ \ ++ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , BIT0},/* Disable USB suspend */ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ ++ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , 0},/* Enable USB suspend */ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3), 0},/* disable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ ++ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/* Enable WL control XTAL setting*/ \ ++ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable falling edge triggering interrupt*/\ ++ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable GPIO9 interrupt mode*/\ ++ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 input mode*/\ ++ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Enable HSISR GPIO[C:0] interrupt*/\ ++ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable HSISR GPIO9 interrupt*/\ ++ {0x0068, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3},/*For GPIO9 internal pull high setting by test chip*/\ ++ {0x0069, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/*For GPIO9 internal pull high setting*/\ ++ ++ ++#define RTL8723B_TRANS_ACT_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ ++ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable rising edge triggering interrupt*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ ++ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, 0},/* Enable BT control XTAL setting*/\ ++ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ ++ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/\ ++ ++ ++#define RTL8723B_TRANS_CARDEMU_TO_SUS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4 | BIT3, (BIT4 | BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ ++ ++#define RTL8723B_TRANS_SUS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ ++ ++#define RTL8723B_TRANS_CARDEMU_TO_CARDDIS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ ++ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ ++ ++#define RTL8723B_TRANS_CARDDIS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ ++ ++ ++#define RTL8723B_TRANS_CARDEMU_TO_PDN \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK | PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ ++ ++#define RTL8723B_TRANS_PDN_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ ++ ++#define RTL8723B_TRANS_ACT_TO_LPS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ ++ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ ++ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ ++ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ ++ ++ ++#define RTL8723B_TRANS_LPS_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ ++ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ ++ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ ++ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ ++ ++ ++#define RTL8723B_TRANS_ACT_TO_SWLPS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0194, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*enable 32 K source*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1},/*CCK and OFDM are enable*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1},/*CCK and OFDM are enable*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x3F},/*Reset MAC TRX*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*disable security engine*/ \ ++ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x40},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ ++ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*reset dual TSF*/ \ ++ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/*Reset CPU*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*Reset MCUFWDL register*/ \ ++ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*Reset CPU IO Wrapper*/ \ ++ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1},/*Reset CPU IO Wrapper*/ \ ++ {0x0287, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*polling RXFF packet number = 0 */ \ ++ {0x0286, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/*polling RXDMA idle */ \ ++ {0x013D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Clear FW RPWM interrupt */\ ++ {0x0139, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Set FW RPWM interrupt source*/\ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4},/*switch TSF to 32K*/\ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/*polling TSF stable*/\ ++ {0x0090, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Set FW LPS*/ \ ++ {0x0090, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/*polling FW LPS ready */ ++ ++ ++#define RTL8723B_TRANS_SWLPS_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0},/*switch TSF to 32K*/\ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/*polling TSF stable*/\ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1, enable security engine*/\ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ ++ {0x06B7, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x09}, /*. reset MAC rx state machine*/\ ++ {0x06B4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x86}, /*. reset MAC rx state machine*/\ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/* set CPU RAM code ready*/ \ ++ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*Reset CPU IO Wrapper*/ \ ++ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* Enable CPU*/ \ ++ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*enable CPU IO Wrapper*/ \ ++ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2},/* Enable CPU*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, BIT7},/*polling FW init ready */ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT6, BIT6},/*polling FW init ready */ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ ++ ++#define RTL8723B_TRANS_END \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, ++ ++ ++ extern WLAN_PWR_CFG rtl8723B_power_on_flow[RTL8723B_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723B_radio_off_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723B_card_disable_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723B_card_enable_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723B_suspend_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS + RTL8723B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723B_resume_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS + RTL8723B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723B_hwpdn_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723B_enter_lps_flow[RTL8723B_TRANS_ACT_TO_LPS_STEPS + RTL8723B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723B_leave_lps_flow[RTL8723B_TRANS_LPS_TO_ACT_STEPS + RTL8723B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723B_enter_swlps_flow[RTL8723B_TRANS_ACT_TO_SWLPS_STEPS + RTL8723B_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723B_leave_swlps_flow[RTL8723B_TRANS_SWLPS_TO_ACT_STEPS + RTL8723B_TRANS_END_STEPS]; ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723DPhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723DPhyCfg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723DPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723DPhyCfg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,136 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8723DPHYCFG_H__ ++#define __INC_HAL8723DPHYCFG_H__ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++#define LOOP_LIMIT 5 ++#define MAX_STALL_TIME 50 /* us */ ++#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ ++#define MAX_TXPWR_IDX_NMODE_92S 63 ++#define Reset_Cnt_Limit 3 ++ ++#ifdef CONFIG_PCI_HCI ++ #define MAX_AGGR_NUM 0x0B ++#else ++ #define MAX_AGGR_NUM 0x07 ++#endif /* CONFIG_PCI_HCI */ ++ ++ ++/*--------------------------Define Parameters End-------------------------------*/ ++ ++ ++/*------------------------------Define structure----------------------------*/ ++ ++/*------------------------------Define structure End----------------------------*/ ++ ++/*--------------------------Exported Function prototype---------------------*/ ++u32 ++PHY_QueryBBReg_8723D( ++ IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask ++); ++ ++VOID ++PHY_SetBBReg_8723D( ++ IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data ++); ++ ++u32 ++PHY_QueryRFReg_8723D( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask ++); ++ ++VOID ++PHY_SetRFReg_8723D( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data ++); ++ ++/* MAC/BB/RF HAL config */ ++int PHY_BBConfig8723D(PADAPTER Adapter); ++ ++int PHY_RFConfig8723D(PADAPTER Adapter); ++ ++s32 PHY_MACConfig8723D(PADAPTER padapter); ++ ++int ++PHY_ConfigRFWithParaFile_8723D( ++ IN PADAPTER Adapter, ++ IN u8 *pFileName, ++ RF_PATH eRFPath ++); ++ ++VOID ++PHY_SetTxPowerIndex_8723D( ++ IN PADAPTER Adapter, ++ IN u32 PowerIndex, ++ IN u8 RFPath, ++ IN u8 Rate ++); ++ ++u8 ++PHY_GetTxPowerIndex_8723D( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN u8 BandWidth, ++ IN u8 Channel, ++ struct txpwr_idx_comp *tic ++); ++ ++VOID ++PHY_GetTxPowerLevel8723D( ++ IN PADAPTER Adapter, ++ OUT s32 *powerlevel ++); ++ ++VOID ++PHY_SetTxPowerLevel8723D( ++ IN PADAPTER Adapter, ++ IN u8 channel ++); ++ ++VOID ++PHY_SetSwChnlBWMode8723D( ++ IN PADAPTER Adapter, ++ IN u8 channel, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 Offset40, ++ IN u8 Offset80 ++); ++ ++VOID PHY_SetRFPathSwitch_8723D( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bMain ++); ++/*--------------------------Exported Function prototype End---------------------*/ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723DPhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723DPhyReg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723DPhyReg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723DPhyReg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,1139 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8723DPHYREG_H__ ++#define __INC_HAL8723DPHYREG_H__ ++ ++#define rSYM_WLBT_PAPE_SEL 0x64 ++/* ++ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 ++ * 3. RF register 0x00-2E ++ * 4. Bit Mask for BB/RF register ++ * 5. Other definition for BB/RF R/W ++ * */ ++ ++ ++/* ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 1. Page1(0x100) ++ * */ ++#define rPMAC_Reset 0x100 ++#define rPMAC_TxStart 0x104 ++#define rPMAC_TxLegacySIG 0x108 ++#define rPMAC_TxHTSIG1 0x10c ++#define rPMAC_TxHTSIG2 0x110 ++#define rPMAC_PHYDebug 0x114 ++#define rPMAC_TxPacketNum 0x118 ++#define rPMAC_TxIdle 0x11c ++#define rPMAC_TxMACHeader0 0x120 ++#define rPMAC_TxMACHeader1 0x124 ++#define rPMAC_TxMACHeader2 0x128 ++#define rPMAC_TxMACHeader3 0x12c ++#define rPMAC_TxMACHeader4 0x130 ++#define rPMAC_TxMACHeader5 0x134 ++#define rPMAC_TxDataType 0x138 ++#define rPMAC_TxRandomSeed 0x13c ++#define rPMAC_CCKPLCPPreamble 0x140 ++#define rPMAC_CCKPLCPHeader 0x144 ++#define rPMAC_CCKCRC16 0x148 ++#define rPMAC_OFDMRxCRC32OK 0x170 ++#define rPMAC_OFDMRxCRC32Er 0x174 ++#define rPMAC_OFDMRxParityEr 0x178 ++#define rPMAC_OFDMRxCRC8Er 0x17c ++#define rPMAC_CCKCRxRC16Er 0x180 ++#define rPMAC_CCKCRxRC32Er 0x184 ++#define rPMAC_CCKCRxRC32OK 0x188 ++#define rPMAC_TxStatus 0x18c ++ ++/* ++ * 2. Page2(0x200) ++ * ++ * The following two definition are only used for USB interface. */ ++#define RF_BB_CMD_ADDR 0x02c0 /* RF/BB read/write command address. */ ++#define RF_BB_CMD_DATA 0x02c4 /* RF/BB read/write command data. */ ++ ++/* ++ * 3. Page8(0x800) ++ * */ ++#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC // RF BW Setting?? */ ++ ++#define rFPGA0_TxInfo 0x804 /* Status report?? */ ++#define rFPGA0_PSDFunction 0x808 ++ ++#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ ++ ++#define rFPGA0_RFTiming1 0x810 /* Useless now */ ++#define rFPGA0_RFTiming2 0x814 ++ ++#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ ++#define rFPGA0_XA_HSSIParameter2 0x824 ++#define rFPGA0_XB_HSSIParameter1 0x828 ++#define rFPGA0_XB_HSSIParameter2 0x82c ++#define rTxAGC_B_Rate18_06 0x830 ++#define rTxAGC_B_Rate54_24 0x834 ++#define rTxAGC_B_CCK1_55_Mcs32 0x838 ++#define rTxAGC_B_Mcs03_Mcs00 0x83c ++ ++#define rTxAGC_B_Mcs07_Mcs04 0x848 ++#define rTxAGC_B_Mcs11_Mcs08 0x84c ++ ++#define rFPGA0_XA_LSSIParameter 0x840 ++#define rFPGA0_XB_LSSIParameter 0x844 ++ ++#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ ++#define rFPGA0_RFSleepUpParameter 0x854 ++ ++#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ ++#define rFPGA0_XCD_SwitchControl 0x85c ++ ++#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ ++#define rFPGA0_XB_RFInterfaceOE 0x864 ++ ++#define rTxAGC_B_Mcs15_Mcs12 0x868 ++#define rTxAGC_B_CCK11_A_CCK2_11 0x86c ++ ++#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ ++#define rFPGA0_XCD_RFInterfaceSW 0x874 ++ ++#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ ++#define rFPGA0_XCD_RFParameter 0x87c ++ ++#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ ++#define rFPGA0_AnalogParameter2 0x884 ++#define rFPGA0_AnalogParameter3 0x888 /* Useless now */ ++#define rFPGA0_AnalogParameter4 0x88c ++ ++#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ ++#define rFPGA0_XB_LSSIReadBack 0x8a4 ++#define rFPGA0_XC_LSSIReadBack 0x8a8 ++#define rFPGA0_XD_LSSIReadBack 0x8ac ++ ++#define rFPGA0_PSDReport 0x8b4 /* Useless now */ ++#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ ++#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ ++#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now // RF Interface Readback Value */ ++#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ ++ ++/* ++ * 4. Page9(0x900) ++ * */ ++#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC // RF BW Setting?? */ ++#define rFPGA1_TxBlock 0x904 /* Useless now */ ++#define rFPGA1_DebugSelect 0x908 /* Useless now */ ++#define rFPGA1_TxInfo 0x90c /* Useless now // Status report?? */ ++#define rDPDT_control 0x92c ++#define rfe_ctrl_anta_src 0x930 ++#define rS0S1_PathSwitch 0x948 ++#define rBBrx_DFIR 0x954 ++ ++/* ++ * 5. PageA(0xA00) ++ * ++ * Set Control channel to upper or lower. These settings are required only for 40MHz */ ++#define rCCK0_System 0xa00 ++ ++#define rCCK0_AFESetting 0xa04 /* Disable init gain now // Select RX path by RSSI */ ++#define rCCK0_CCA 0xa08 /* Disable init gain now // Init gain */ ++ ++#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level // Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ ++#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ ++ ++#define rCCK0_RxHP 0xa14 ++ ++#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ ++#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ ++ ++#define rCCK0_TxFilter1 0xa20 ++#define rCCK0_TxFilter2 0xa24 ++#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ ++#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ ++#define rCCK0_TRSSIReport 0xa50 ++#define rCCK0_RxReport 0xa54 /* 0xa57 */ ++#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ ++#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ ++ ++/* ++ * PageB(0xB00) ++ * */ ++#define rPdp_AntA 0xb00 ++#define rPdp_AntA_4 0xb04 ++#define rPdp_AntA_8 0xb08 ++#define rPdp_AntA_C 0xb0c ++#define rPdp_AntA_10 0xb10 ++#define rPdp_AntA_14 0xb14 ++#define rPdp_AntA_18 0xb18 ++#define rPdp_AntA_1C 0xb1c ++#define rPdp_AntA_20 0xb20 ++#define rPdp_AntA_24 0xb24 ++ ++#define rConfig_Pmpd_AntA 0xb28 ++#define rConfig_ram64x16 0xb2c ++ ++#define rBndA 0xb30 ++#define rHssiPar 0xb34 ++ ++#define rConfig_AntA 0xb68 ++#define rConfig_AntB 0xb6c ++ ++#define rPdp_AntB 0xb70 ++#define rPdp_AntB_4 0xb74 ++#define rPdp_AntB_8 0xb78 ++#define rPdp_AntB_C 0xb7c ++#define rPdp_AntB_10 0xb80 ++#define rPdp_AntB_14 0xb84 ++#define rPdp_AntB_18 0xb88 ++#define rPdp_AntB_1C 0xb8c ++#define rPdp_AntB_20 0xb90 ++#define rPdp_AntB_24 0xb94 ++ ++#define rConfig_Pmpd_AntB 0xb98 ++ ++#define rBndB 0xba0 ++ ++#define rAPK 0xbd8 ++#define rPm_Rx0_AntA 0xbdc ++#define rPm_Rx1_AntA 0xbe0 ++#define rPm_Rx2_AntA 0xbe4 ++#define rPm_Rx3_AntA 0xbe8 ++#define rPm_Rx0_AntB 0xbec ++#define rPm_Rx1_AntB 0xbf0 ++#define rPm_Rx2_AntB 0xbf4 ++#define rPm_Rx3_AntB 0xbf8 ++/* ++ * 6. PageC(0xC00) ++ * */ ++#define rOFDM0_LSTF 0xc00 ++ ++#define rOFDM0_TRxPathEnable 0xc04 ++#define rOFDM0_TRMuxPar 0xc08 ++#define rOFDM0_TRSWIsolation 0xc0c ++ ++#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ ++#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imbalance matrix */ ++#define rOFDM0_XBRxAFE 0xc18 ++#define rOFDM0_XBRxIQImbalance 0xc1c ++#define rOFDM0_XCRxAFE 0xc20 ++#define rOFDM0_XCRxIQImbalance 0xc24 ++#define rOFDM0_XDRxAFE 0xc28 ++#define rOFDM0_XDRxIQImbalance 0xc2c ++ ++#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD // DM tune init gain */ ++#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ ++#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ ++#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ ++ ++#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ ++#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ ++#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ ++#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ ++ ++#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ ++#define rOFDM0_XAAGCCore2 0xc54 ++#define rOFDM0_XBAGCCore1 0xc58 ++#define rOFDM0_XBAGCCore2 0xc5c ++#define rOFDM0_XCAGCCore1 0xc60 ++#define rOFDM0_XCAGCCore2 0xc64 ++#define rOFDM0_XDAGCCore1 0xc68 ++#define rOFDM0_XDAGCCore2 0xc6c ++ ++#define rOFDM0_AGCParameter1 0xc70 ++#define rOFDM0_AGCParameter2 0xc74 ++#define rOFDM0_AGCRSSITable 0xc78 ++#define rOFDM0_HTSTFAGC 0xc7c ++ ++#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ ++#define rOFDM0_XATxAFE 0xc84 ++#define rOFDM0_XBTxIQImbalance 0xc88 ++#define rOFDM0_XBTxAFE 0xc8c ++#define rOFDM0_XCTxIQImbalance 0xc90 ++#define rOFDM0_XCTxAFE 0xc94 ++#define rOFDM0_XDTxIQImbalance 0xc98 ++#define rOFDM0_XDTxAFE 0xc9c ++ ++#define rOFDM0_RxIQExtAnta 0xca0 ++#define rOFDM0_TxCoeff1 0xca4 ++#define rOFDM0_TxCoeff2 0xca8 ++#define rOFDM0_TxCoeff3 0xcac ++#define rOFDM0_TxCoeff4 0xcb0 ++#define rOFDM0_TxCoeff5 0xcb4 ++#define rOFDM0_TxCoeff6 0xcb8 ++#define rOFDM0_RxHPParameter 0xce0 ++#define rOFDM0_TxPseudoNoiseWgt 0xce4 ++#define rOFDM0_FrameSync 0xcf0 ++#define rOFDM0_DFSReport 0xcf4 ++ ++/* ++ * 7. PageD(0xD00) ++ * */ ++#define rOFDM1_LSTF 0xd00 ++#define rOFDM1_TRxPathEnable 0xd04 ++ ++#define rOFDM1_CFO 0xd08 /* No setting now */ ++#define rOFDM1_CSI1 0xd10 ++#define rOFDM1_SBD 0xd14 ++#define rOFDM1_CSI2 0xd18 ++#define rOFDM1_CFOTracking 0xd2c ++#define rOFDM1_TRxMesaure1 0xd34 ++#define rOFDM1_IntfDet 0xd3c ++#define rOFDM1_PseudoNoiseStateAB 0xd50 ++#define rOFDM1_PseudoNoiseStateCD 0xd54 ++#define rOFDM1_RxPseudoNoiseWgt 0xd58 ++ ++#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ ++#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ ++#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ ++ ++#define rOFDM_ShortCFOAB 0xdac /* No setting now */ ++#define rOFDM_ShortCFOCD 0xdb0 ++#define rOFDM_LongCFOAB 0xdb4 ++#define rOFDM_LongCFOCD 0xdb8 ++#define rOFDM_TailCFOAB 0xdbc ++#define rOFDM_TailCFOCD 0xdc0 ++#define rOFDM_PWMeasure1 0xdc4 ++#define rOFDM_PWMeasure2 0xdc8 ++#define rOFDM_BWReport 0xdcc ++#define rOFDM_AGCReport 0xdd0 ++#define rOFDM_RxSNR 0xdd4 ++#define rOFDM_RxEVMCSI 0xdd8 ++#define rOFDM_SIGReport 0xddc ++ ++ ++/* ++ * 8. PageE(0xE00) ++ * */ ++#define rTxAGC_A_Rate18_06 0xe00 ++#define rTxAGC_A_Rate54_24 0xe04 ++#define rTxAGC_A_CCK1_Mcs32 0xe08 ++#define rTxAGC_A_Mcs03_Mcs00 0xe10 ++#define rTxAGC_A_Mcs07_Mcs04 0xe14 ++#define rTxAGC_A_Mcs11_Mcs08 0xe18 ++#define rTxAGC_A_Mcs15_Mcs12 0xe1c ++ ++#define rFPGA0_IQK 0xe28 ++#define rTx_IQK_Tone_A 0xe30 ++#define rRx_IQK_Tone_A 0xe34 ++#define rTx_IQK_PI_A 0xe38 ++#define rRx_IQK_PI_A 0xe3c ++ ++#define rTx_IQK 0xe40 ++#define rRx_IQK 0xe44 ++#define rIQK_AGC_Pts 0xe48 ++#define rIQK_AGC_Rsp 0xe4c ++#define rTx_IQK_Tone_B 0xe50 ++#define rRx_IQK_Tone_B 0xe54 ++#define rTx_IQK_PI_B 0xe58 ++#define rRx_IQK_PI_B 0xe5c ++#define rIQK_AGC_Cont 0xe60 ++ ++#define rBlue_Tooth 0xe6c ++#define rRx_Wait_CCA 0xe70 ++#define rTx_CCK_RFON 0xe74 ++#define rTx_CCK_BBON 0xe78 ++#define rTx_OFDM_RFON 0xe7c ++#define rTx_OFDM_BBON 0xe80 ++#define rTx_To_Rx 0xe84 ++#define rTx_To_Tx 0xe88 ++#define rRx_CCK 0xe8c ++ ++#define rTx_Power_Before_IQK_A 0xe94 ++#define rTx_Power_After_IQK_A 0xe9c ++ ++#define rRx_Power_Before_IQK_A 0xea0 ++#define rRx_Power_Before_IQK_A_2 0xea4 ++#define rRx_Power_After_IQK_A 0xea8 ++#define rRx_Power_After_IQK_A_2 0xeac ++ ++#define rTx_Power_Before_IQK_B 0xeb4 ++#define rTx_Power_After_IQK_B 0xebc ++ ++#define rRx_Power_Before_IQK_B 0xec0 ++#define rRx_Power_Before_IQK_B_2 0xec4 ++#define rRx_Power_After_IQK_B 0xec8 ++#define rRx_Power_After_IQK_B_2 0xecc ++ ++#define rRx_OFDM 0xed0 ++#define rRx_Wait_RIFS 0xed4 ++#define rRx_TO_Rx 0xed8 ++#define rStandby 0xedc ++#define rSleep 0xee0 ++#define rPMPD_ANAEN 0xeec ++ ++/* ++ * 7. RF Register 0x00-0x2E (RF 8256) ++ * RF-0222D 0x00-3F ++ * ++ * Zebra1 */ ++#define rZebra1_HSSIEnable 0x0 /* Useless now */ ++#define rZebra1_TRxEnable1 0x1 ++#define rZebra1_TRxEnable2 0x2 ++#define rZebra1_AGC 0x4 ++#define rZebra1_ChargePump 0x5 ++#define rZebra1_Channel 0x7 /* RF channel switch */ ++ ++/* #endif */ ++#define rZebra1_TxGain 0x8 /* Useless now */ ++#define rZebra1_TxLPF 0x9 ++#define rZebra1_RxLPF 0xb ++#define rZebra1_RxHPFCorner 0xc ++ ++/* Zebra4 */ ++#define rGlobalCtrl 0 /* Useless now */ ++#define rRTL8256_TxLPF 19 ++#define rRTL8256_RxLPF 11 ++ ++/* RTL8258 */ ++#define rRTL8258_TxLPF 0x11 /* Useless now */ ++#define rRTL8258_RxLPF 0x13 ++#define rRTL8258_RSSILPF 0xa ++ ++/* ++ * RL6052 Register definition ++ * */ ++#define RF_AC 0x00 /* */ ++ ++#define RF_IQADJ_G1 0x01 /* */ ++#define RF_IQADJ_G2 0x02 /* */ ++#define RF_BS_PA_APSET_G1_G4 0x03 ++#define RF_BS_PA_APSET_G5_G8 0x04 ++#define RF_POW_TRSW 0x05 /* */ ++ ++#define RF_GAIN_RX 0x06 /* */ ++#define RF_GAIN_TX 0x07 /* */ ++ ++#define RF_TXM_IDAC 0x08 /* */ ++#define RF_IPA_G 0x09 /* */ ++#define RF_TXBIAS_G 0x0A ++#define RF_TXPA_AG 0x0B ++#define RF_IPA_A 0x0C /* */ ++#define RF_TXBIAS_A 0x0D ++#define RF_BS_PA_APSET_G9_G11 0x0E ++#define RF_BS_IQGEN 0x0F /* */ ++ ++#define RF_MODE1 0x10 /* */ ++#define RF_MODE2 0x11 /* */ ++ ++#define RF_RX_AGC_HP 0x12 /* */ ++#define RF_TX_AGC 0x13 /* */ ++#define RF_BIAS 0x14 /* */ ++#define RF_IPA 0x15 /* */ ++#define RF_TXBIAS 0x16 ++#define RF_POW_ABILITY 0x17 /* */ ++#define RF_MODE_AG 0x18 /* */ ++#define rRfChannel 0x18 /* RF channel and BW switch */ ++#define RF_CHNLBW 0x18 /* RF channel and BW switch */ ++#define RF_TOP 0x19 /* */ ++ ++#define RF_RX_G1 0x1A /* */ ++#define RF_RX_G2 0x1B /* */ ++ ++#define RF_RX_BB2 0x1C /* */ ++#define RF_RX_BB1 0x1D /* */ ++ ++#define RF_RCK1 0x1E /* */ ++#define RF_RCK2 0x1F /* */ ++ ++#define RF_TX_G1 0x20 /* */ ++#define RF_TX_G2 0x21 /* */ ++#define RF_TX_G3 0x22 /* */ ++ ++#define RF_TX_BB1 0x23 /* */ ++ ++#define RF_T_METER 0x24 /* */ ++ ++#define RF_SYN_G1 0x25 /* RF TX Power control */ ++#define RF_SYN_G2 0x26 /* RF TX Power control */ ++#define RF_SYN_G3 0x27 /* RF TX Power control */ ++#define RF_SYN_G4 0x28 /* RF TX Power control */ ++#define RF_SYN_G5 0x29 /* RF TX Power control */ ++#define RF_SYN_G6 0x2A /* RF TX Power control */ ++#define RF_SYN_G7 0x2B /* RF TX Power control */ ++#define RF_SYN_G8 0x2C /* RF TX Power control */ ++ ++#define RF_RCK_OS 0x30 /* RF TX PA control */ ++ ++#define RF_TXPA_G1 0x31 /* RF TX PA control */ ++#define RF_TXPA_G2 0x32 /* RF TX PA control */ ++#define RF_TXPA_G3 0x33 /* RF TX PA control */ ++#define RF_TX_BIAS_A 0x35 ++#define RF_TX_BIAS_D 0x36 ++#define RF_LOBF_9 0x38 ++#define RF_RXRF_A3 0x3C /* */ ++#define RF_TRSW 0x3F ++ ++#define RF_TXRF_A2 0x41 ++#define RF_T_METER_88E 0x42 ++#define RF_TXPA_G4 0x46 ++#define RF_TXPA_A4 0x4B ++#define RF_0x52 0x52 ++#define RF_WE_LUT 0xEF ++#define RF_S0S1 0xB0 ++ ++/* ++ * Bit Mask ++ * ++ * 1. Page1(0x100) */ ++#define bBBResetB 0x100 /* Useless now? */ ++#define bGlobalResetB 0x200 ++#define bOFDMTxStart 0x4 ++#define bCCKTxStart 0x8 ++#define bCRC32Debug 0x100 ++#define bPMACLoopback 0x10 ++#define bTxLSIG 0xffffff ++#define bOFDMTxRate 0xf ++#define bOFDMTxReserved 0x10 ++#define bOFDMTxLength 0x1ffe0 ++#define bOFDMTxParity 0x20000 ++#define bTxHTSIG1 0xffffff ++#define bTxHTMCSRate 0x7f ++#define bTxHTBW 0x80 ++#define bTxHTLength 0xffff00 ++#define bTxHTSIG2 0xffffff ++#define bTxHTSmoothing 0x1 ++#define bTxHTSounding 0x2 ++#define bTxHTReserved 0x4 ++#define bTxHTAggreation 0x8 ++#define bTxHTSTBC 0x30 ++#define bTxHTAdvanceCoding 0x40 ++#define bTxHTShortGI 0x80 ++#define bTxHTNumberHT_LTF 0x300 ++#define bTxHTCRC8 0x3fc00 ++#define bCounterReset 0x10000 ++#define bNumOfOFDMTx 0xffff ++#define bNumOfCCKTx 0xffff0000 ++#define bTxIdleInterval 0xffff ++#define bOFDMService 0xffff0000 ++#define bTxMACHeader 0xffffffff ++#define bTxDataInit 0xff ++#define bTxHTMode 0x100 ++#define bTxDataType 0x30000 ++#define bTxRandomSeed 0xffffffff ++#define bCCKTxPreamble 0x1 ++#define bCCKTxSFD 0xffff0000 ++#define bCCKTxSIG 0xff ++#define bCCKTxService 0xff00 ++#define bCCKLengthExt 0x8000 ++#define bCCKTxLength 0xffff0000 ++#define bCCKTxCRC16 0xffff ++#define bCCKTxStatus 0x1 ++#define bOFDMTxStatus 0x2 ++ ++#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) ++#define RF_TX_GAIN_OFFSET_8723D(_val) (abs((_val)) | (((_val) > 0) ? BIT(4) : 0)) ++ ++/* 2. Page8(0x800) */ ++#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ ++#define bJapanMode 0x2 ++#define bCCKTxSC 0x30 ++#define bCCKEn 0x1000000 ++#define bOFDMEn 0x2000000 ++ ++#define bOFDMRxADCPhase 0x10000 /* Useless now */ ++#define bOFDMTxDACPhase 0x40000 ++#define bXATxAGC 0x3f ++ ++#define bAntennaSelect 0x0300 ++ ++#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ ++#define bXCTxAGC 0xf000 ++#define bXDTxAGC 0xf0000 ++ ++#define bPAStart 0xf0000000 /* Useless now */ ++#define bTRStart 0x00f00000 ++#define bRFStart 0x0000f000 ++#define bBBStart 0x000000f0 ++#define bBBCCKStart 0x0000000f ++#define bPAEnd 0xf /* Reg0x814 */ ++#define bTREnd 0x0f000000 ++#define bRFEnd 0x000f0000 ++#define bCCAMask 0x000000f0 /* T2R */ ++#define bR2RCCAMask 0x00000f00 ++#define bHSSI_R2TDelay 0xf8000000 ++#define bHSSI_T2RDelay 0xf80000 ++#define bContTxHSSI 0x400 /* chane gain at continue Tx */ ++#define bIGFromCCK 0x200 ++#define bAGCAddress 0x3f ++#define bRxHPTx 0x7000 ++#define bRxHPT2R 0x38000 ++#define bRxHPCCKIni 0xc0000 ++#define bAGCTxCode 0xc00000 ++#define bAGCRxCode 0x300000 ++ ++#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ ++#define b3WireAddressLength 0x400 ++ ++#define b3WireRFPowerDown 0x1 /* Useless now ++ * #define bHWSISelect 0x8 */ ++#define b5GPAPEPolarity 0x40000000 ++#define b2GPAPEPolarity 0x80000000 ++#define bRFSW_TxDefaultAnt 0x3 ++#define bRFSW_TxOptionAnt 0x30 ++#define bRFSW_RxDefaultAnt 0x300 ++#define bRFSW_RxOptionAnt 0x3000 ++#define bRFSI_3WireData 0x1 ++#define bRFSI_3WireClock 0x2 ++#define bRFSI_3WireLoad 0x4 ++#define bRFSI_3WireRW 0x8 ++#define bRFSI_3Wire 0xf ++ ++#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ ++ ++#define bRFSI_TRSW 0x20 /* Useless now */ ++#define bRFSI_TRSWB 0x40 ++#define bRFSI_ANTSW 0x100 ++#define bRFSI_ANTSWB 0x200 ++#define bRFSI_PAPE 0x400 ++#define bRFSI_PAPE5G 0x800 ++#define bBandSelect 0x1 ++#define bHTSIG2_GI 0x80 ++#define bHTSIG2_Smoothing 0x01 ++#define bHTSIG2_Sounding 0x02 ++#define bHTSIG2_Aggreaton 0x08 ++#define bHTSIG2_STBC 0x30 ++#define bHTSIG2_AdvCoding 0x40 ++#define bHTSIG2_NumOfHTLTF 0x300 ++#define bHTSIG2_CRC8 0x3fc ++#define bHTSIG1_MCS 0x7f ++#define bHTSIG1_BandWidth 0x80 ++#define bHTSIG1_HTLength 0xffff ++#define bLSIG_Rate 0xf ++#define bLSIG_Reserved 0x10 ++#define bLSIG_Length 0x1fffe ++#define bLSIG_Parity 0x20 ++#define bCCKRxPhase 0x4 ++ ++#define bLSSIReadAddress 0x7f800000 /* T65 RF */ ++ ++#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ ++ ++#define bLSSIReadBackData 0xfffff /* T65 RF */ ++ ++#define bLSSIReadOKFlag 0x1000 /* Useless now */ ++#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ ++#define bRegulator0Standby 0x1 ++#define bRegulatorPLLStandby 0x2 ++#define bRegulator1Standby 0x4 ++#define bPLLPowerUp 0x8 ++#define bDPLLPowerUp 0x10 ++#define bDA10PowerUp 0x20 ++#define bAD7PowerUp 0x200 ++#define bDA6PowerUp 0x2000 ++#define bXtalPowerUp 0x4000 ++#define b40MDClkPowerUP 0x8000 ++#define bDA6DebugMode 0x20000 ++#define bDA6Swing 0x380000 ++ ++#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ ++ ++#define b80MClkDelay 0x18000000 /* Useless */ ++#define bAFEWatchDogEnable 0x20000000 ++ ++#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ ++#define bXtalCap23 0x3 ++#define bXtalCap92x 0x0f000000 ++#define bXtalCap 0x0f000000 ++ ++#define bIntDifClkEnable 0x400 /* Useless */ ++#define bExtSigClkEnable 0x800 ++#define bBandgapMbiasPowerUp 0x10000 ++#define bAD11SHGain 0xc0000 ++#define bAD11InputRange 0x700000 ++#define bAD11OPCurrent 0x3800000 ++#define bIPathLoopback 0x4000000 ++#define bQPathLoopback 0x8000000 ++#define bAFELoopback 0x10000000 ++#define bDA10Swing 0x7e0 ++#define bDA10Reverse 0x800 ++#define bDAClkSource 0x1000 ++#define bAD7InputRange 0x6000 ++#define bAD7Gain 0x38000 ++#define bAD7OutputCMMode 0x40000 ++#define bAD7InputCMMode 0x380000 ++#define bAD7Current 0xc00000 ++#define bRegulatorAdjust 0x7000000 ++#define bAD11PowerUpAtTx 0x1 ++#define bDA10PSAtTx 0x10 ++#define bAD11PowerUpAtRx 0x100 ++#define bDA10PSAtRx 0x1000 ++#define bCCKRxAGCFormat 0x200 ++#define bPSDFFTSamplepPoint 0xc000 ++#define bPSDAverageNum 0x3000 ++#define bIQPathControl 0xc00 ++#define bPSDFreq 0x3ff ++#define bPSDAntennaPath 0x30 ++#define bPSDIQSwitch 0x40 ++#define bPSDRxTrigger 0x400000 ++#define bPSDTxTrigger 0x80000000 ++#define bPSDSineToneScale 0x7f000000 ++#define bPSDReport 0xffff ++ ++/* 3. Page9(0x900) */ ++#define bOFDMTxSC 0x30000000 /* Useless */ ++#define bCCKTxOn 0x1 ++#define bOFDMTxOn 0x2 ++#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ ++#define bDebugItem 0xff /* reset debug page and LWord */ ++#define bAntL 0x10 ++#define bAntNonHT 0x100 ++#define bAntHT1 0x1000 ++#define bAntHT2 0x10000 ++#define bAntHT1S1 0x100000 ++#define bAntNonHTS1 0x1000000 ++ ++/* 4. PageA(0xA00) */ ++#define bCCKBBMode 0x3 /* Useless */ ++#define bCCKTxPowerSaving 0x80 ++#define bCCKRxPowerSaving 0x40 ++ ++#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ ++ ++#define bCCKScramble 0x8 /* Useless */ ++#define bCCKAntDiversity 0x8000 ++#define bCCKCarrierRecovery 0x4000 ++#define bCCKTxRate 0x3000 ++#define bCCKDCCancel 0x0800 ++#define bCCKISICancel 0x0400 ++#define bCCKMatchFilter 0x0200 ++#define bCCKEqualizer 0x0100 ++#define bCCKPreambleDetect 0x800000 ++#define bCCKFastFalseCCA 0x400000 ++#define bCCKChEstStart 0x300000 ++#define bCCKCCACount 0x080000 ++#define bCCKcs_lim 0x070000 ++#define bCCKBistMode 0x80000000 ++#define bCCKCCAMask 0x40000000 ++#define bCCKTxDACPhase 0x4 ++#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ ++#define bCCKr_cp_mode0 0x0100 ++#define bCCKTxDCOffset 0xf0 ++#define bCCKRxDCOffset 0xf ++#define bCCKCCAMode 0xc000 ++#define bCCKFalseCS_lim 0x3f00 ++#define bCCKCS_ratio 0xc00000 ++#define bCCKCorgBit_sel 0x300000 ++#define bCCKPD_lim 0x0f0000 ++#define bCCKNewCCA 0x80000000 ++#define bCCKRxHPofIG 0x8000 ++#define bCCKRxIG 0x7f00 ++#define bCCKLNAPolarity 0x800000 ++#define bCCKRx1stGain 0x7f0000 ++#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ ++#define bCCKRxAGCSatLevel 0x1f000000 ++#define bCCKRxAGCSatCount 0xe0 ++#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ ++#define bCCKFixedRxAGC 0x8000 ++/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ ++#define bCCKAntennaPolarity 0x2000 ++#define bCCKTxFilterType 0x0c00 ++#define bCCKRxAGCReportType 0x0300 ++#define bCCKRxDAGCEn 0x80000000 ++#define bCCKRxDAGCPeriod 0x20000000 ++#define bCCKRxDAGCSatLevel 0x1f000000 ++#define bCCKTimingRecovery 0x800000 ++#define bCCKTxC0 0x3f0000 ++#define bCCKTxC1 0x3f000000 ++#define bCCKTxC2 0x3f ++#define bCCKTxC3 0x3f00 ++#define bCCKTxC4 0x3f0000 ++#define bCCKTxC5 0x3f000000 ++#define bCCKTxC6 0x3f ++#define bCCKTxC7 0x3f00 ++#define bCCKDebugPort 0xff0000 ++#define bCCKDACDebug 0x0f000000 ++#define bCCKFalseAlarmEnable 0x8000 ++#define bCCKFalseAlarmRead 0x4000 ++#define bCCKTRSSI 0x7f ++#define bCCKRxAGCReport 0xfe ++#define bCCKRxReport_AntSel 0x80000000 ++#define bCCKRxReport_MFOff 0x40000000 ++#define bCCKRxRxReport_SQLoss 0x20000000 ++#define bCCKRxReport_Pktloss 0x10000000 ++#define bCCKRxReport_Lockedbit 0x08000000 ++#define bCCKRxReport_RateError 0x04000000 ++#define bCCKRxReport_RxRate 0x03000000 ++#define bCCKRxFACounterLower 0xff ++#define bCCKRxFACounterUpper 0xff000000 ++#define bCCKRxHPAGCStart 0xe000 ++#define bCCKRxHPAGCFinal 0x1c00 ++#define bCCKRxFalseAlarmEnable 0x8000 ++#define bCCKFACounterFreeze 0x4000 ++#define bCCKTxPathSel 0x10000000 ++#define bCCKDefaultRxPath 0xc000000 ++#define bCCKOptionRxPath 0x3000000 ++ ++/* 5. PageC(0xC00) */ ++#define bNumOfSTF 0x3 /* Useless */ ++#define bShift_L 0xc0 ++#define bGI_TH 0xc ++#define bRxPathA 0x1 ++#define bRxPathB 0x2 ++#define bRxPathC 0x4 ++#define bRxPathD 0x8 ++#define bTxPathA 0x1 ++#define bTxPathB 0x2 ++#define bTxPathC 0x4 ++#define bTxPathD 0x8 ++#define bTRSSIFreq 0x200 ++#define bADCBackoff 0x3000 ++#define bDFIRBackoff 0xc000 ++#define bTRSSILatchPhase 0x10000 ++#define bRxIDCOffset 0xff ++#define bRxQDCOffset 0xff00 ++#define bRxDFIRMode 0x1800000 ++#define bRxDCNFType 0xe000000 ++#define bRXIQImb_A 0x3ff ++#define bRXIQImb_B 0xfc00 ++#define bRXIQImb_C 0x3f0000 ++#define bRXIQImb_D 0xffc00000 ++#define bDC_dc_Notch 0x60000 ++#define bRxNBINotch 0x1f000000 ++#define bPD_TH 0xf ++#define bPD_TH_Opt2 0xc000 ++#define bPWED_TH 0x700 ++#define bIfMF_Win_L 0x800 ++#define bPD_Option 0x1000 ++#define bMF_Win_L 0xe000 ++#define bBW_Search_L 0x30000 ++#define bwin_enh_L 0xc0000 ++#define bBW_TH 0x700000 ++#define bED_TH2 0x3800000 ++#define bBW_option 0x4000000 ++#define bRatio_TH 0x18000000 ++#define bWindow_L 0xe0000000 ++#define bSBD_Option 0x1 ++#define bFrame_TH 0x1c ++#define bFS_Option 0x60 ++#define bDC_Slope_check 0x80 ++#define bFGuard_Counter_DC_L 0xe00 ++#define bFrame_Weight_Short 0x7000 ++#define bSub_Tune 0xe00000 ++#define bFrame_DC_Length 0xe000000 ++#define bSBD_start_offset 0x30000000 ++#define bFrame_TH_2 0x7 ++#define bFrame_GI2_TH 0x38 ++#define bGI2_Sync_en 0x40 ++#define bSarch_Short_Early 0x300 ++#define bSarch_Short_Late 0xc00 ++#define bSarch_GI2_Late 0x70000 ++#define bCFOAntSum 0x1 ++#define bCFOAcc 0x2 ++#define bCFOStartOffset 0xc ++#define bCFOLookBack 0x70 ++#define bCFOSumWeight 0x80 ++#define bDAGCEnable 0x10000 ++#define bTXIQImb_A 0x3ff ++#define bTXIQImb_B 0xfc00 ++#define bTXIQImb_C 0x3f0000 ++#define bTXIQImb_D 0xffc00000 ++#define bTxIDCOffset 0xff ++#define bTxQDCOffset 0xff00 ++#define bTxDFIRMode 0x10000 ++#define bTxPesudoNoiseOn 0x4000000 ++#define bTxPesudoNoise_A 0xff ++#define bTxPesudoNoise_B 0xff00 ++#define bTxPesudoNoise_C 0xff0000 ++#define bTxPesudoNoise_D 0xff000000 ++#define bCCADropOption 0x20000 ++#define bCCADropThres 0xfff00000 ++#define bEDCCA_H 0xf ++#define bEDCCA_L 0xf0 ++#define bLambda_ED 0x300 ++#define bRxInitialGain 0x7f ++#define bRxAntDivEn 0x80 ++#define bRxAGCAddressForLNA 0x7f00 ++#define bRxHighPowerFlow 0x8000 ++#define bRxAGCFreezeThres 0xc0000 ++#define bRxFreezeStep_AGC1 0x300000 ++#define bRxFreezeStep_AGC2 0xc00000 ++#define bRxFreezeStep_AGC3 0x3000000 ++#define bRxFreezeStep_AGC0 0xc000000 ++#define bRxRssi_Cmp_En 0x10000000 ++#define bRxQuickAGCEn 0x20000000 ++#define bRxAGCFreezeThresMode 0x40000000 ++#define bRxOverFlowCheckType 0x80000000 ++#define bRxAGCShift 0x7f ++#define bTRSW_Tri_Only 0x80 ++#define bPowerThres 0x300 ++#define bRxAGCEn 0x1 ++#define bRxAGCTogetherEn 0x2 ++#define bRxAGCMin 0x4 ++#define bRxHP_Ini 0x7 ++#define bRxHP_TRLNA 0x70 ++#define bRxHP_RSSI 0x700 ++#define bRxHP_BBP1 0x7000 ++#define bRxHP_BBP2 0x70000 ++#define bRxHP_BBP3 0x700000 ++#define bRSSI_H 0x7f0000 /* the threshold for high power */ ++#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ ++#define bRxSettle_TRSW 0x7 ++#define bRxSettle_LNA 0x38 ++#define bRxSettle_RSSI 0x1c0 ++#define bRxSettle_BBP 0xe00 ++#define bRxSettle_RxHP 0x7000 ++#define bRxSettle_AntSW_RSSI 0x38000 ++#define bRxSettle_AntSW 0xc0000 ++#define bRxProcessTime_DAGC 0x300000 ++#define bRxSettle_HSSI 0x400000 ++#define bRxProcessTime_BBPPW 0x800000 ++#define bRxAntennaPowerShift 0x3000000 ++#define bRSSITableSelect 0xc000000 ++#define bRxHP_Final 0x7000000 ++#define bRxHTSettle_BBP 0x7 ++#define bRxHTSettle_HSSI 0x8 ++#define bRxHTSettle_RxHP 0x70 ++#define bRxHTSettle_BBPPW 0x80 ++#define bRxHTSettle_Idle 0x300 ++#define bRxHTSettle_Reserved 0x1c00 ++#define bRxHTRxHPEn 0x8000 ++#define bRxHTAGCFreezeThres 0x30000 ++#define bRxHTAGCTogetherEn 0x40000 ++#define bRxHTAGCMin 0x80000 ++#define bRxHTAGCEn 0x100000 ++#define bRxHTDAGCEn 0x200000 ++#define bRxHTRxHP_BBP 0x1c00000 ++#define bRxHTRxHP_Final 0xe0000000 ++#define bRxPWRatioTH 0x3 ++#define bRxPWRatioEn 0x4 ++#define bRxMFHold 0x3800 ++#define bRxPD_Delay_TH1 0x38 ++#define bRxPD_Delay_TH2 0x1c0 ++#define bRxPD_DC_COUNT_MAX 0x600 ++/* #define bRxMF_Hold 0x3800 */ ++#define bRxPD_Delay_TH 0x8000 ++#define bRxProcess_Delay 0xf0000 ++#define bRxSearchrange_GI2_Early 0x700000 ++#define bRxFrame_Guard_Counter_L 0x3800000 ++#define bRxSGI_Guard_L 0xc000000 ++#define bRxSGI_Search_L 0x30000000 ++#define bRxSGI_TH 0xc0000000 ++#define bDFSCnt0 0xff ++#define bDFSCnt1 0xff00 ++#define bDFSFlag 0xf0000 ++#define bMFWeightSum 0x300000 ++#define bMinIdxTH 0x7f000000 ++#define bDAFormat 0x40000 ++#define bTxChEmuEnable 0x01000000 ++#define bTRSWIsolation_A 0x7f ++#define bTRSWIsolation_B 0x7f00 ++#define bTRSWIsolation_C 0x7f0000 ++#define bTRSWIsolation_D 0x7f000000 ++#define bExtLNAGain 0x7c00 ++ ++/* 6. PageE(0xE00) */ ++#define bSTBCEn 0x4 /* Useless */ ++#define bAntennaMapping 0x10 ++#define bNss 0x20 ++#define bCFOAntSumD 0x200 ++#define bPHYCounterReset 0x8000000 ++#define bCFOReportGet 0x4000000 ++#define bOFDMContinueTx 0x10000000 ++#define bOFDMSingleCarrier 0x20000000 ++#define bOFDMSingleTone 0x40000000 ++/* #define bRxPath1 0x01 */ ++/* #define bRxPath2 0x02 */ ++/* #define bRxPath3 0x04 */ ++/* #define bRxPath4 0x08 */ ++/* #define bTxPath1 0x10 */ ++/* #define bTxPath2 0x20 */ ++#define bHTDetect 0x100 ++#define bCFOEn 0x10000 ++#define bCFOValue 0xfff00000 ++#define bSigTone_Re 0x3f ++#define bSigTone_Im 0x7f00 ++#define bCounter_CCA 0xffff ++#define bCounter_ParityFail 0xffff0000 ++#define bCounter_RateIllegal 0xffff ++#define bCounter_CRC8Fail 0xffff0000 ++#define bCounter_MCSNoSupport 0xffff ++#define bCounter_FastSync 0xffff ++#define bShortCFO 0xfff ++#define bShortCFOTLength 12 /* total */ ++#define bShortCFOFLength 11 /* fraction */ ++#define bLongCFO 0x7ff ++#define bLongCFOTLength 11 ++#define bLongCFOFLength 11 ++#define bTailCFO 0x1fff ++#define bTailCFOTLength 13 ++#define bTailCFOFLength 12 ++#define bmax_en_pwdB 0xffff ++#define bCC_power_dB 0xffff0000 ++#define bnoise_pwdB 0xffff ++#define bPowerMeasTLength 10 ++#define bPowerMeasFLength 3 ++#define bRx_HT_BW 0x1 ++#define bRxSC 0x6 ++#define bRx_HT 0x8 ++#define bNB_intf_det_on 0x1 ++#define bIntf_win_len_cfg 0x30 ++#define bNB_Intf_TH_cfg 0x1c0 ++#define bRFGain 0x3f ++#define bTableSel 0x40 ++#define bTRSW 0x80 ++#define bRxSNR_A 0xff ++#define bRxSNR_B 0xff00 ++#define bRxSNR_C 0xff0000 ++#define bRxSNR_D 0xff000000 ++#define bSNREVMTLength 8 ++#define bSNREVMFLength 1 ++#define bCSI1st 0xff ++#define bCSI2nd 0xff00 ++#define bRxEVM1st 0xff0000 ++#define bRxEVM2nd 0xff000000 ++#define bSIGEVM 0xff ++#define bPWDB 0xff00 ++#define bSGIEN 0x10000 ++ ++#define bSFactorQAM1 0xf /* Useless */ ++#define bSFactorQAM2 0xf0 ++#define bSFactorQAM3 0xf00 ++#define bSFactorQAM4 0xf000 ++#define bSFactorQAM5 0xf0000 ++#define bSFactorQAM6 0xf0000 ++#define bSFactorQAM7 0xf00000 ++#define bSFactorQAM8 0xf000000 ++#define bSFactorQAM9 0xf0000000 ++#define bCSIScheme 0x100000 ++ ++#define bNoiseLvlTopSet 0x3 /* Useless */ ++#define bChSmooth 0x4 ++#define bChSmoothCfg1 0x38 ++#define bChSmoothCfg2 0x1c0 ++#define bChSmoothCfg3 0xe00 ++#define bChSmoothCfg4 0x7000 ++#define bMRCMode 0x800000 ++#define bTHEVMCfg 0x7000000 ++ ++#define bLoopFitType 0x1 /* Useless */ ++#define bUpdCFO 0x40 ++#define bUpdCFOOffData 0x80 ++#define bAdvUpdCFO 0x100 ++#define bAdvTimeCtrl 0x800 ++#define bUpdClko 0x1000 ++#define bFC 0x6000 ++#define bTrackingMode 0x8000 ++#define bPhCmpEnable 0x10000 ++#define bUpdClkoLTF 0x20000 ++#define bComChCFO 0x40000 ++#define bCSIEstiMode 0x80000 ++#define bAdvUpdEqz 0x100000 ++#define bUChCfg 0x7000000 ++#define bUpdEqz 0x8000000 ++ ++/* Rx Pseduo noise */ ++#define bRxPesudoNoiseOn 0x20000000 /* Useless */ ++#define bRxPesudoNoise_A 0xff ++#define bRxPesudoNoise_B 0xff00 ++#define bRxPesudoNoise_C 0xff0000 ++#define bRxPesudoNoise_D 0xff000000 ++#define bPesudoNoiseState_A 0xffff ++#define bPesudoNoiseState_B 0xffff0000 ++#define bPesudoNoiseState_C 0xffff ++#define bPesudoNoiseState_D 0xffff0000 ++ ++/* 7. RF Register ++ * Zebra1 */ ++#define bZebra1_HSSIEnable 0x8 /* Useless */ ++#define bZebra1_TRxControl 0xc00 ++#define bZebra1_TRxGainSetting 0x07f ++#define bZebra1_RxCorner 0xc00 ++#define bZebra1_TxChargePump 0x38 ++#define bZebra1_RxChargePump 0x7 ++#define bZebra1_ChannelNum 0xf80 ++#define bZebra1_TxLPFBW 0x400 ++#define bZebra1_RxLPFBW 0x600 ++ ++/* Zebra4 */ ++#define bRTL8256RegModeCtrl1 0x100 /* Useless */ ++#define bRTL8256RegModeCtrl0 0x40 ++#define bRTL8256_TxLPFBW 0x18 ++#define bRTL8256_RxLPFBW 0x600 ++ ++/* RTL8258 */ ++#define bRTL8258_TxLPFBW 0xc /* Useless */ ++#define bRTL8258_RxLPFBW 0xc00 ++#define bRTL8258_RSSILPFBW 0xc0 ++ ++ ++/* ++ * Other Definition ++ * */ ++ ++/* byte endable for sb_write */ ++#define bByte0 0x1 /* Useless */ ++#define bByte1 0x2 ++#define bByte2 0x4 ++#define bByte3 0x8 ++#define bWord0 0x3 ++#define bWord1 0xc ++#define bDWord 0xf ++ ++/* for PutRegsetting & GetRegSetting BitMask */ ++#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ ++#define bMaskByte1 0xff00 ++#define bMaskByte2 0xff0000 ++#define bMaskByte3 0xff000000 ++#define bMaskHWord 0xffff0000 ++#define bMaskLWord 0x0000ffff ++#define bMaskDWord 0xffffffff ++#define bMaskH3Bytes 0xffffff00 ++#define bMask12Bits 0xfff ++#define bMaskH4Bits 0xf0000000 ++#define bMaskOFDM_D 0xffc00000 ++#define bMaskCCK 0x3f3f3f3f ++ ++ ++#define bEnable 0x1 /* Useless */ ++#define bDisable 0x0 ++ ++#define LeftAntenna 0x0 /* Useless */ ++#define RightAntenna 0x1 ++ ++#define tCheckTxStatus 500 /* 500ms // Useless */ ++#define tUpdateRxCounter 100 /* 100ms */ ++ ++#define rateCCK 0 /* Useless */ ++#define rateOFDM 1 ++#define rateHT 2 ++ ++/* define Register-End */ ++#define bPMAC_End 0x1ff /* Useless */ ++#define bFPGAPHY0_End 0x8ff ++#define bFPGAPHY1_End 0x9ff ++#define bCCKPHY0_End 0xaff ++#define bOFDMPHY0_End 0xcff ++#define bOFDMPHY1_End 0xdff ++ ++/* define max debug item in each debug page ++ * #define bMaxItem_FPGA_PHY0 0x9 ++ * #define bMaxItem_FPGA_PHY1 0x3 ++ * #define bMaxItem_PHY_11B 0x16 ++ * #define bMaxItem_OFDM_PHY0 0x29 ++ * #define bMaxItem_OFDM_PHY1 0x0 */ ++ ++#define bPMACControl 0x0 /* Useless */ ++#define bWMACControl 0x1 ++#define bWNICControl 0x2 ++ ++#define PathA 0x0 /* Useless */ ++#define PathB 0x1 ++#define PathC 0x2 ++#define PathD 0x3 ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723DPwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723DPwrSeq.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723DPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723DPwrSeq.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,193 @@ ++#ifndef REALTEK_POWER_SEQUENCE_8723D ++#define REALTEK_POWER_SEQUENCE_8723D ++ ++/* #include "PwrSeqCmd.h" */ ++#include "HalPwrSeqCmd.h" ++ ++/* ++ Check document WM-20110607-Paul-RTL8192e_Power_Architecture-R02.vsd ++ There are 6 HW Power States: ++ 0: POFF--Power Off ++ 1: PDN--Power Down ++ 2: CARDEMU--Card Emulation ++ 3: ACT--Active Mode ++ 4: LPS--Low Power State ++ 5: SUS--Suspend ++ ++ The transition from different states are defined below ++ TRANS_CARDEMU_TO_ACT ++ TRANS_ACT_TO_CARDEMU ++ TRANS_CARDEMU_TO_SUS ++ TRANS_SUS_TO_CARDEMU ++ TRANS_CARDEMU_TO_PDN ++ TRANS_ACT_TO_LPS ++ TRANS_LPS_TO_ACT ++ ++ TRANS_END ++*/ ++#define RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS 27 ++#define RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS 8 ++#define RTL8723D_TRANS_CARDEMU_TO_SUS_STEPS 7 ++#define RTL8723D_TRANS_SUS_TO_CARDEMU_STEPS 5 ++#define RTL8723D_TRANS_CARDEMU_TO_CARDDIS_STEPS 8 ++#define RTL8723D_TRANS_CARDDIS_TO_CARDEMU_STEPS 7 ++#define RTL8723D_TRANS_CARDEMU_TO_PDN_STEPS 4 ++#define RTL8723D_TRANS_PDN_TO_CARDEMU_STEPS 1 ++#define RTL8723D_TRANS_ACT_TO_LPS_STEPS 13 ++#define RTL8723D_TRANS_LPS_TO_ACT_STEPS 11 ++#define RTL8723D_TRANS_END_STEPS 1 ++ ++ ++#define RTL8723D_TRANS_CARDEMU_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ ++ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), BIT(0)}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ ++ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ ++ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ ++ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(5), 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT(4) | BIT(3) | BIT2), 0},/* disable SW LPS 0x04[10]=0 and WLSUS_EN 0x04[11]=0*/ \ ++ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0) , BIT(0)},/* Disable USB suspend */ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT(1), BIT(1)},/* wait till 0x04[17] = 1 power ready*/ \ ++ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0) , 0},/* Enable USB suspend */ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), BIT(0)},/* release WLON reset 0x04[16]=1*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, (BIT(1) | BIT(0)), 0}, \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(7), 0},/* disable HWPDN 0x04[15]=0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT(4) | BIT(3)), 0},/* disable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), BIT(0)},/* polling until return 0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT(0), 0},/**/ \ ++ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(6), BIT(6)},/* Enable WL control XTAL setting*/ \ ++ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), BIT(1)},/*Enable falling edge triggering interrupt*/\ ++ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), BIT(1)},/*Enable GPIO9 interrupt mode*/\ ++ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), 0},/*Enable GPIO9 input mode*/\ ++ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), BIT(0)},/*Enable HSISR GPIO[C:0] interrupt*/\ ++ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), BIT(1)},/*Enable HSISR GPIO9 interrupt*/\ ++ {0x0068, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3), BIT(3)},/*For GPIO9 internal pull high setting by test chip*/\ ++ {0x0069, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(6), BIT(6)},/*For GPIO9 internal pull high setting*/\ ++ {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*reset RF path S1*/\ ++ {0x0077, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*reset RF path S0*/\ ++ {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x07},/*enable RF path S1*/\ ++ {0x0077, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x07},/*enalbe RF path S0*/\ ++ ++ ++#define RTL8723D_TRANS_ACT_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ ++ /*{0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, */ /*0x1F[7:0] = 0 turn off RF*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), 0}, /*0x2[0]=0 Reset BB, RF enter Power Down mode*/ \ ++ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), 0},/*Enable rising edge triggering interrupt*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), BIT(0)},/* release WLON reset 0x04[16]=1*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), BIT(1)}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT(1), 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ ++ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(6), 0},/* Enable BT control XTAL setting*/\ ++ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(5), BIT(5)}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ ++ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/\ ++ ++ ++#define RTL8723D_TRANS_CARDEMU_TO_SUS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4) | BIT(3), (BIT4 | BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(4), BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), BIT(4)}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(4), BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT(0), BIT(0)}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT(1), 0}, /*wait power state to suspend*/ ++ ++#define RTL8723D_TRANS_SUS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(7), 0}, /*clear suspend enable and power down enable*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT(0), 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT(1), BIT(1)}, /*wait power state to suspend*/\ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(4), 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ ++ ++ ++#define RTL8723D_TRANS_CARDEMU_TO_CARDDIS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(4), BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(2), BIT(2)}, /*0x04[10] = 1, enable SW LPS*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(4), BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend*/ \ ++ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), BIT(4)}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT(0), BIT(0)}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT(1), 0}, /*wait power state to suspend*/ ++ ++#define RTL8723D_TRANS_CARDDIS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(7), 0}, /*clear suspend enable and power down enable*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT(0), 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT(1), BIT(1)}, /*wait power state to suspend*/\ ++ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(4), 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ ++ ++ ++#define RTL8723D_TRANS_CARDEMU_TO_PDN \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), BIT(4)}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK | PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), 0},/* 0x04[16] = 0*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(7), BIT(7)},/* 0x04[15] = 1*/ ++ ++#define RTL8723D_TRANS_PDN_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(7), 0},/* 0x04[15] = 0*/ ++ ++#define RTL8723D_TRANS_ACT_TO_LPS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ ++ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), 0},/*CCK and OFDM are disabled, and clock are gated*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), 0},/*Whole BB is reset*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), 0},/*check if removed later*/ \ ++ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ ++ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(5), BIT(5)},/*Respond TxOK to scheduler*/ \ ++ ++ ++#define RTL8723D_TRANS_LPS_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ ++ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ ++ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT(7), 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ ++ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(6) | BIT(7), 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), BIT(1)}, /*. 0x101[1] = 1*/\ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1) | BIT(0), BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ ++ ++#define RTL8723D_TRANS_END \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ ++ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, ++ ++ ++ extern WLAN_PWR_CFG rtl8723D_power_on_flow[RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723D_radio_off_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723D_card_disable_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_CARDDIS_STEPS + RTL8723D_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723D_card_enable_flow[RTL8723D_TRANS_CARDDIS_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723D_suspend_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_SUS_STEPS + RTL8723D_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723D_resume_flow[RTL8723D_TRANS_SUS_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723D_hwpdn_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723D_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723D_enter_lps_flow[RTL8723D_TRANS_ACT_TO_LPS_STEPS + RTL8723D_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723D_leave_lps_flow[RTL8723D_TRANS_LPS_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS]; ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723PwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723PwrSeq.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723PwrSeq.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723PwrSeq.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,169 @@ ++#ifndef __HAL8723PWRSEQ_H__ ++#define __HAL8723PWRSEQ_H__ ++/* ++ Check document WM-20110607-Paul-RTL8723A_Power_Architecture-R02.vsd ++ There are 6 HW Power States: ++ 0: POFF--Power Off ++ 1: PDN--Power Down ++ 2: CARDEMU--Card Emulation ++ 3: ACT--Active Mode ++ 4: LPS--Low Power State ++ 5: SUS--Suspend ++ ++ The transision from different states are defined below ++ TRANS_CARDEMU_TO_ACT ++ TRANS_ACT_TO_CARDEMU ++ TRANS_CARDEMU_TO_SUS ++ TRANS_SUS_TO_CARDEMU ++ TRANS_CARDEMU_TO_PDN ++ TRANS_ACT_TO_LPS ++ TRANS_LPS_TO_ACT ++ ++ TRANS_END ++*/ ++#include "HalPwrSeqCmd.h" ++ ++#define RTL8723A_TRANS_CARDEMU_TO_ACT_STEPS 15 ++#define RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS 15 ++#define RTL8723A_TRANS_CARDEMU_TO_SUS_STEPS 15 ++#define RTL8723A_TRANS_SUS_TO_CARDEMU_STEPS 15 ++#define RTL8723A_TRANS_CARDEMU_TO_PDN_STEPS 15 ++#define RTL8723A_TRANS_PDN_TO_CARDEMU_STEPS 15 ++#define RTL8723A_TRANS_ACT_TO_LPS_STEPS 15 ++#define RTL8723A_TRANS_LPS_TO_ACT_STEPS 15 ++#define RTL8723A_TRANS_END_STEPS 1 ++ ++ ++#define RTL8723A_TRANS_CARDEMU_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ ++ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ ++ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ ++ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3), 0},/* disable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ ++ {0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 1},/*0x4C[23] = 0x4E[7] = 1, switch DPDT_SEL_P output from WL BB */\ ++ ++#define RTL8723A_TRANS_ACT_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ ++ {0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/*0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ ++ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ ++ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/ \ ++ ++ ++#define RTL8723A_TRANS_CARDEMU_TO_SUS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4 | BIT3, (BIT4 | BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ ++ ++#define RTL8723A_TRANS_SUS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ ++ ++#define RTL8723A_TRANS_CARDEMU_TO_CARDDIS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ ++ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ ++ ++#define RTL8723A_TRANS_CARDDIS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ ++ ++ ++#define RTL8723A_TRANS_CARDEMU_TO_PDN \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK | PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ ++ ++#define RTL8723A_TRANS_PDN_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ ++ ++#define RTL8723A_TRANS_ACT_TO_LPS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ ++ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ ++ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ ++ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ ++ ++ ++#define RTL8723A_TRANS_LPS_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ ++ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ ++ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ ++ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ ++ ++#define RTL8723A_TRANS_END \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, ++ ++ ++ extern WLAN_PWR_CFG rtl8723A_power_on_flow[RTL8723A_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723A_radio_off_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723A_card_disable_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723A_card_enable_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723A_suspend_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723A_TRANS_CARDEMU_TO_SUS_STEPS + RTL8723A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723A_resume_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723A_TRANS_CARDEMU_TO_SUS_STEPS + RTL8723A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723A_hwpdn_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723A_enter_lps_flow[RTL8723A_TRANS_ACT_TO_LPS_STEPS + RTL8723A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8723A_leave_lps_flow[RTL8723A_TRANS_LPS_TO_ACT_STEPS + RTL8723A_TRANS_END_STEPS]; ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8812PhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8812PhyCfg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8812PhyCfg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8812PhyCfg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,148 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8812PHYCFG_H__ ++#define __INC_HAL8812PHYCFG_H__ ++ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++#define LOOP_LIMIT 5 ++#define MAX_STALL_TIME 50 /* us */ ++#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ ++#define MAX_TXPWR_IDX_NMODE_92S 63 ++#define Reset_Cnt_Limit 3 ++ ++ ++#ifdef CONFIG_PCI_HCI ++ #define MAX_AGGR_NUM 0x0B ++#else ++ #define MAX_AGGR_NUM 0x07 ++#endif /* CONFIG_PCI_HCI */ ++ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++ ++/*------------------------------Define structure----------------------------*/ ++ ++ ++/* BB/RF related */ ++ ++/*------------------------------Define structure----------------------------*/ ++ ++ ++/*------------------------Export global variable----------------------------*/ ++/*------------------------Export global variable----------------------------*/ ++ ++ ++/*------------------------Export Marco Definition---------------------------*/ ++/*------------------------Export Marco Definition---------------------------*/ ++ ++ ++/*--------------------------Exported Function prototype---------------------*/ ++/* ++ * BB and RF register read/write ++ * */ ++u32 PHY_QueryBBReg8812(IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask); ++void PHY_SetBBReg8812(IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data); ++u32 PHY_QueryRFReg8812(IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask); ++void PHY_SetRFReg8812(IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data); ++ ++/* ++ * Initialization related function ++ * ++ * MAC/BB/RF HAL config */ ++int PHY_MACConfig8812(IN PADAPTER Adapter); ++int PHY_BBConfig8812(IN PADAPTER Adapter); ++void PHY_BB8812_Config_1T(IN PADAPTER Adapter); ++int PHY_RFConfig8812(IN PADAPTER Adapter); ++ ++/* RF config */ ++ ++s32 ++PHY_SwitchWirelessBand8812( ++ IN PADAPTER Adapter, ++ IN u8 Band ++); ++ ++/* ++ * BB TX Power R/W ++ * */ ++void PHY_GetTxPowerLevel8812(IN PADAPTER Adapter, OUT s32 *powerlevel); ++void PHY_SetTxPowerLevel8812(IN PADAPTER Adapter, IN u8 Channel); ++ ++BOOLEAN PHY_UpdateTxPowerDbm8812(IN PADAPTER Adapter, IN int powerInDbm); ++u8 PHY_GetTxPowerIndex_8812A( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN u8 BandWidth, ++ IN u8 Channel, ++ struct txpwr_idx_comp *tic ++); ++ ++u32 PHY_GetTxBBSwing_8812A( ++ IN PADAPTER Adapter, ++ IN BAND_TYPE Band, ++ IN u8 RFPath ++); ++ ++VOID ++PHY_SetTxPowerIndex_8812A( ++ IN PADAPTER Adapter, ++ IN u4Byte PowerIndex, ++ IN u1Byte RFPath, ++ IN u1Byte Rate ++); ++ ++/* ++ * channel switch related funciton ++ * */ ++VOID ++PHY_SetSwChnlBWMode8812( ++ IN PADAPTER Adapter, ++ IN u8 channel, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 Offset40, ++ IN u8 Offset80 ++); ++ ++/* ++ * BB/MAC/RF other monitor API ++ * */ ++ ++VOID ++PHY_SetRFPathSwitch_8812A( ++ IN PADAPTER pAdapter, ++ IN BOOLEAN bMain ++); ++ ++/*--------------------------Exported Function prototype---------------------*/ ++#endif /* __INC_HAL8192CPHYCFG_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8812PhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8812PhyReg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8812PhyReg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8812PhyReg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,738 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8812PHYREG_H__ ++#define __INC_HAL8812PHYREG_H__ ++/*--------------------------Define Parameters-------------------------------*/ ++/* ++ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 ++ * 3. RF register 0x00-2E ++ * 4. Bit Mask for BB/RF register ++ * 5. Other defintion for BB/RF R/W ++ * */ ++ ++ ++/* BB Register Definition */ ++ ++#define rCCAonSec_Jaguar 0x838 ++#define rPwed_TH_Jaguar 0x830 ++ ++/* BW and sideband setting */ ++#define rBWIndication_Jaguar 0x834 ++#define rL1PeakTH_Jaguar 0x848 ++#define rFPGA0_XA_LSSIReadBack 0x8a0 /*Tranceiver LSSI Readback*/ ++#define rRFMOD_Jaguar 0x8ac /* RF mode */ ++#define rADC_Buf_Clk_Jaguar 0x8c4 ++#define rRFECTRL_Jaguar 0x900 ++#define bRFMOD_Jaguar 0xc3 ++#define rCCK_System_Jaguar 0xa00 /* for cck sideband */ ++#define bCCK_System_Jaguar 0x10 ++ ++/* Block & Path enable */ ++#define rOFDMCCKEN_Jaguar 0x808 /* OFDM/CCK block enable */ ++#define bOFDMEN_Jaguar 0x20000000 ++#define bCCKEN_Jaguar 0x10000000 ++#define rRxPath_Jaguar 0x808 /* Rx antenna */ ++#define bRxPath_Jaguar 0xff ++#define rTxPath_Jaguar 0x80c /* Tx antenna */ ++#define bTxPath_Jaguar 0x0fffffff ++#define rCCK_RX_Jaguar 0xa04 /* for cck rx path selection */ ++#define bCCK_RX_Jaguar 0x0c000000 ++#define rVhtlen_Use_Lsig_Jaguar 0x8c3 /* Use LSIG for VHT length */ ++ ++/* RF read/write-related */ ++#define rHSSIRead_Jaguar 0x8b0 /* RF read addr */ ++#define bHSSIRead_addr_Jaguar 0xff ++#define bHSSIRead_trigger_Jaguar 0x100 ++#define rA_PIRead_Jaguar 0xd04 /* RF readback with PI */ ++#define rB_PIRead_Jaguar 0xd44 /* RF readback with PI */ ++#define rA_SIRead_Jaguar 0xd08 /* RF readback with SI */ ++#define rB_SIRead_Jaguar 0xd48 /* RF readback with SI */ ++#define rRead_data_Jaguar 0xfffff ++#define rA_LSSIWrite_Jaguar 0xc90 /* RF write addr */ ++#define rB_LSSIWrite_Jaguar 0xe90 /* RF write addr */ ++#define bLSSIWrite_data_Jaguar 0x000fffff ++#define bLSSIWrite_addr_Jaguar 0x0ff00000 ++ ++ ++ ++/* YN: mask the following register definition temporarily */ ++#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ ++#define rFPGA0_XB_RFInterfaceOE 0x864 ++ ++#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ ++#define rFPGA0_XCD_RFInterfaceSW 0x874 ++ ++/* #define rFPGA0_XAB_RFParameter 0x878 */ /* RF Parameter ++ * #define rFPGA0_XCD_RFParameter 0x87c */ ++ ++/* #define rFPGA0_AnalogParameter1 0x880 */ /* Crystal cap setting RF-R/W protection for parameter4?? ++ * #define rFPGA0_AnalogParameter2 0x884 ++ * #define rFPGA0_AnalogParameter3 0x888 ++ * #define rFPGA0_AdDaClockEn 0x888 */ /* enable ad/da clock1 for dual-phy ++ * #define rFPGA0_AnalogParameter4 0x88c */ ++ ++ ++/* CCK TX scaling */ ++#define rCCK_TxFilter1_Jaguar 0xa20 ++#define bCCK_TxFilter1_C0_Jaguar 0x00ff0000 ++#define bCCK_TxFilter1_C1_Jaguar 0xff000000 ++#define rCCK_TxFilter2_Jaguar 0xa24 ++#define bCCK_TxFilter2_C2_Jaguar 0x000000ff ++#define bCCK_TxFilter2_C3_Jaguar 0x0000ff00 ++#define bCCK_TxFilter2_C4_Jaguar 0x00ff0000 ++#define bCCK_TxFilter2_C5_Jaguar 0xff000000 ++#define rCCK_TxFilter3_Jaguar 0xa28 ++#define bCCK_TxFilter3_C6_Jaguar 0x000000ff ++#define bCCK_TxFilter3_C7_Jaguar 0x0000ff00 ++ ++ ++/* YN: mask the following register definition temporarily ++ * #define rPdp_AntA 0xb00 ++ * #define rPdp_AntA_4 0xb04 ++ * #define rConfig_Pmpd_AntA 0xb28 ++ * #define rConfig_AntA 0xb68 ++ * #define rConfig_AntB 0xb6c ++ * #define rPdp_AntB 0xb70 ++ * #define rPdp_AntB_4 0xb74 ++ * #define rConfig_Pmpd_AntB 0xb98 ++ * #define rAPK 0xbd8 */ ++ ++/* RXIQC */ ++#define rA_RxIQC_AB_Jaguar 0xc10 /* RxIQ imblance matrix coeff. A & B */ ++#define rA_RxIQC_CD_Jaguar 0xc14 /* RxIQ imblance matrix coeff. C & D */ ++#define rA_TxScale_Jaguar 0xc1c /* Pah_A TX scaling factor */ ++#define rB_TxScale_Jaguar 0xe1c /* Path_B TX scaling factor */ ++#define rB_RxIQC_AB_Jaguar 0xe10 /* RxIQ imblance matrix coeff. A & B */ ++#define rB_RxIQC_CD_Jaguar 0xe14 /* RxIQ imblance matrix coeff. C & D */ ++#define b_RxIQC_AC_Jaguar 0x02ff /* bit mask for IQC matrix element A & C */ ++#define b_RxIQC_BD_Jaguar 0x02ff0000 /* bit mask for IQC matrix element A & C */ ++ ++ ++/* DIG-related */ ++#define rA_IGI_Jaguar 0xc50 /* Initial Gain for path-A */ ++#define rB_IGI_Jaguar 0xe50 /* Initial Gain for path-B */ ++#define rOFDM_FalseAlarm1_Jaguar 0xf48 /* counter for break */ ++#define rOFDM_FalseAlarm2_Jaguar 0xf4c /* counter for spoofing */ ++#define rCCK_FalseAlarm_Jaguar 0xa5c /* counter for cck false alarm */ ++#define b_FalseAlarm_Jaguar 0xffff ++#define rCCK_CCA_Jaguar 0xa08 /* cca threshold */ ++#define bCCK_CCA_Jaguar 0x00ff0000 ++ ++/* Tx Power Ttraining-related */ ++#define rA_TxPwrTraing_Jaguar 0xc54 ++#define rB_TxPwrTraing_Jaguar 0xe54 ++ ++/* Report-related */ ++#define rOFDM_ShortCFOAB_Jaguar 0xf60 ++#define rOFDM_LongCFOAB_Jaguar 0xf64 ++#define rOFDM_EndCFOAB_Jaguar 0xf70 ++#define rOFDM_AGCReport_Jaguar 0xf84 ++#define rOFDM_RxSNR_Jaguar 0xf88 ++#define rOFDM_RxEVMCSI_Jaguar 0xf8c ++#define rOFDM_SIGReport_Jaguar 0xf90 ++ ++/* Misc functions */ ++#define rEDCCA_Jaguar 0x8a4 /* EDCCA */ ++#define bEDCCA_Jaguar 0xffff ++#define rAGC_table_Jaguar 0x82c /* AGC tabel select */ ++#define bAGC_table_Jaguar 0x3 ++#define b_sel5g_Jaguar 0x1000 /* sel5g */ ++#define b_LNA_sw_Jaguar 0x8000 /* HW/WS control for LNA */ ++#define rFc_area_Jaguar 0x860 /* fc_area */ ++#define bFc_area_Jaguar 0x1ffe000 ++#define rSingleTone_ContTx_Jaguar 0x914 ++ ++/* RFE */ ++#define rA_RFE_Pinmux_Jaguar 0xcb0 /* Path_A RFE cotrol pinmux */ ++#define rB_RFE_Pinmux_Jaguar 0xeb0 /* Path_B RFE control pinmux */ ++#define rA_RFE_Inv_Jaguar 0xcb4 /* Path_A RFE cotrol */ ++#define rB_RFE_Inv_Jaguar 0xeb4 /* Path_B RFE control */ ++#define rA_RFE_Jaguar 0xcb8 /* Path_A RFE cotrol */ ++#define rB_RFE_Jaguar 0xeb8 /* Path_B RFE control */ ++#define r_ANTSEL_SW_Jaguar 0x900 /* ANTSEL SW Control */ ++#define bMask_RFEInv_Jaguar 0x3ff00000 ++#define bMask_AntselPathFollow_Jaguar 0x00030000 ++ ++/* TX AGC */ ++#define rTxAGC_A_CCK11_CCK1_JAguar 0xc20 ++#define rTxAGC_A_Ofdm18_Ofdm6_JAguar 0xc24 ++#define rTxAGC_A_Ofdm54_Ofdm24_JAguar 0xc28 ++#define rTxAGC_A_MCS3_MCS0_JAguar 0xc2c ++#define rTxAGC_A_MCS7_MCS4_JAguar 0xc30 ++#define rTxAGC_A_MCS11_MCS8_JAguar 0xc34 ++#define rTxAGC_A_MCS15_MCS12_JAguar 0xc38 ++#define rTxAGC_A_Nss1Index3_Nss1Index0_JAguar 0xc3c ++#define rTxAGC_A_Nss1Index7_Nss1Index4_JAguar 0xc40 ++#define rTxAGC_A_Nss2Index1_Nss1Index8_JAguar 0xc44 ++#define rTxAGC_A_Nss2Index5_Nss2Index2_JAguar 0xc48 ++#define rTxAGC_A_Nss2Index9_Nss2Index6_JAguar 0xc4c ++#define rTxAGC_B_CCK11_CCK1_JAguar 0xe20 ++#define rTxAGC_B_Ofdm18_Ofdm6_JAguar 0xe24 ++#define rTxAGC_B_Ofdm54_Ofdm24_JAguar 0xe28 ++#define rTxAGC_B_MCS3_MCS0_JAguar 0xe2c ++#define rTxAGC_B_MCS7_MCS4_JAguar 0xe30 ++#define rTxAGC_B_MCS11_MCS8_JAguar 0xe34 ++#define rTxAGC_B_MCS15_MCS12_JAguar 0xe38 ++#define rTxAGC_B_Nss1Index3_Nss1Index0_JAguar 0xe3c ++#define rTxAGC_B_Nss1Index7_Nss1Index4_JAguar 0xe40 ++#define rTxAGC_B_Nss2Index1_Nss1Index8_JAguar 0xe44 ++#define rTxAGC_B_Nss2Index5_Nss2Index2_JAguar 0xe48 ++#define rTxAGC_B_Nss2Index9_Nss2Index6_JAguar 0xe4c ++#define bTxAGC_byte0_Jaguar 0xff ++#define bTxAGC_byte1_Jaguar 0xff00 ++#define bTxAGC_byte2_Jaguar 0xff0000 ++#define bTxAGC_byte3_Jaguar 0xff000000 ++ ++/* IQK YN: temporaily mask this part ++ * #define rFPGA0_IQK 0xe28 ++ * #define rTx_IQK_Tone_A 0xe30 ++ * #define rRx_IQK_Tone_A 0xe34 ++ * #define rTx_IQK_PI_A 0xe38 ++ * #define rRx_IQK_PI_A 0xe3c */ ++ ++/* #define rTx_IQK 0xe40 */ ++/* #define rRx_IQK 0xe44 */ ++/* #define rIQK_AGC_Pts 0xe48 */ ++/* #define rIQK_AGC_Rsp 0xe4c */ ++/* #define rTx_IQK_Tone_B 0xe50 */ ++/* #define rRx_IQK_Tone_B 0xe54 */ ++/* #define rTx_IQK_PI_B 0xe58 */ ++/* #define rRx_IQK_PI_B 0xe5c */ ++/* #define rIQK_AGC_Cont 0xe60 */ ++ ++ ++/* AFE-related */ ++#define rA_AFEPwr1_Jaguar 0xc60 /* dynamic AFE power control */ ++#define rA_AFEPwr2_Jaguar 0xc64 /* dynamic AFE power control */ ++#define rA_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xc68 ++#define rA_Tx_CCKBBON_OFDMRFON_Jaguar 0xc6c ++#define rA_Tx_OFDMBBON_Tx2Rx_Jaguar 0xc70 ++#define rA_Tx2Tx_RXCCK_Jaguar 0xc74 ++#define rA_Rx_OFDM_WaitRIFS_Jaguar 0xc78 ++#define rA_Rx2Rx_BT_Jaguar 0xc7c ++#define rA_sleep_nav_Jaguar 0xc80 ++#define rA_pmpd_Jaguar 0xc84 ++#define rB_AFEPwr1_Jaguar 0xe60 /* dynamic AFE power control */ ++#define rB_AFEPwr2_Jaguar 0xe64 /* dynamic AFE power control */ ++#define rB_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xe68 ++#define rB_Tx_CCKBBON_OFDMRFON_Jaguar 0xe6c ++#define rB_Tx_OFDMBBON_Tx2Rx_Jaguar 0xe70 ++#define rB_Tx2Tx_RXCCK_Jaguar 0xe74 ++#define rB_Rx_OFDM_WaitRIFS_Jaguar 0xe78 ++#define rB_Rx2Rx_BT_Jaguar 0xe7c ++#define rB_sleep_nav_Jaguar 0xe80 ++#define rB_pmpd_Jaguar 0xe84 ++ ++ ++/* YN: mask these registers temporaily ++ * #define rTx_Power_Before_IQK_A 0xe94 ++ * #define rTx_Power_After_IQK_A 0xe9c */ ++ ++/* #define rRx_Power_Before_IQK_A 0xea0 */ ++/* #define rRx_Power_Before_IQK_A_2 0xea4 */ ++/* #define rRx_Power_After_IQK_A 0xea8 */ ++/* #define rRx_Power_After_IQK_A_2 0xeac */ ++ ++/* #define rTx_Power_Before_IQK_B 0xeb4 */ ++/* #define rTx_Power_After_IQK_B 0xebc */ ++ ++/* #define rRx_Power_Before_IQK_B 0xec0 */ ++/* #define rRx_Power_Before_IQK_B_2 0xec4 */ ++/* #define rRx_Power_After_IQK_B 0xec8 */ ++/* #define rRx_Power_After_IQK_B_2 0xecc */ ++ ++ ++/* RSSI Dump */ ++#define rA_RSSIDump_Jaguar 0xBF0 ++#define rB_RSSIDump_Jaguar 0xBF1 ++#define rS1_RXevmDump_Jaguar 0xBF4 ++#define rS2_RXevmDump_Jaguar 0xBF5 ++#define rA_RXsnrDump_Jaguar 0xBF6 ++#define rB_RXsnrDump_Jaguar 0xBF7 ++#define rA_CfoShortDump_Jaguar 0xBF8 ++#define rB_CfoShortDump_Jaguar 0xBFA ++#define rA_CfoLongDump_Jaguar 0xBEC ++#define rB_CfoLongDump_Jaguar 0xBEE ++ ++ ++/* RF Register ++ * */ ++#define RF_AC_Jaguar 0x00 /* */ ++#define RF_RF_Top_Jaguar 0x07 /* */ ++#define RF_TXLOK_Jaguar 0x08 /* */ ++#define RF_TXAPK_Jaguar 0x0B ++#define RF_CHNLBW_Jaguar 0x18 /* RF channel and BW switch */ ++#define RF_RCK1_Jaguar 0x1c /* */ ++#define RF_RCK2_Jaguar 0x1d ++#define RF_RCK3_Jaguar 0x1e ++#define RF_ModeTableAddr 0x30 ++#define RF_ModeTableData0 0x31 ++#define RF_ModeTableData1 0x32 ++#define RF_TxLCTank_Jaguar 0x54 ++#define RF_APK_Jaguar 0x63 ++#define RF_LCK 0xB4 ++#define RF_WeLut_Jaguar 0xEF ++ ++#define bRF_CHNLBW_MOD_AG_Jaguar 0x70300 ++#define bRF_CHNLBW_BW 0xc00 ++ ++ ++/* ++ * RL6052 Register definition ++ * */ ++#define RF_AC 0x00 /* */ ++#define RF_IPA_A 0x0C /* */ ++#define RF_TXBIAS_A 0x0D ++#define RF_BS_PA_APSET_G9_G11 0x0E ++#define RF_MODE1 0x10 /* */ ++#define RF_MODE2 0x11 /* */ ++#define RF_CHNLBW 0x18 /* RF channel and BW switch */ ++#define RF_RCK_OS 0x30 /* RF TX PA control */ ++#define RF_TXPA_G1 0x31 /* RF TX PA control */ ++#define RF_TXPA_G2 0x32 /* RF TX PA control */ ++#define RF_TXPA_G3 0x33 /* RF TX PA control */ ++#define RF_0x52 0x52 ++#define RF_WE_LUT 0xEF ++ ++#define RF_TX_GAIN_OFFSET_8812A(_val) ((abs((_val)) << 1) | (((_val) > 0) ? BIT0 : 0)) ++#define RF_TX_GAIN_OFFSET_8821A(_val) ((abs((_val)) << 1) | (((_val) > 0) ? BIT0 : 0)) ++ ++/* ++ * Bit Mask ++ * ++ * 1. Page1(0x100) */ ++#define bBBResetB 0x100 /* Useless now? */ ++#define bGlobalResetB 0x200 ++#define bOFDMTxStart 0x4 ++#define bCCKTxStart 0x8 ++#define bCRC32Debug 0x100 ++#define bPMACLoopback 0x10 ++#define bTxLSIG 0xffffff ++#define bOFDMTxRate 0xf ++#define bOFDMTxReserved 0x10 ++#define bOFDMTxLength 0x1ffe0 ++#define bOFDMTxParity 0x20000 ++#define bTxHTSIG1 0xffffff ++#define bTxHTMCSRate 0x7f ++#define bTxHTBW 0x80 ++#define bTxHTLength 0xffff00 ++#define bTxHTSIG2 0xffffff ++#define bTxHTSmoothing 0x1 ++#define bTxHTSounding 0x2 ++#define bTxHTReserved 0x4 ++#define bTxHTAggreation 0x8 ++#define bTxHTSTBC 0x30 ++#define bTxHTAdvanceCoding 0x40 ++#define bTxHTShortGI 0x80 ++#define bTxHTNumberHT_LTF 0x300 ++#define bTxHTCRC8 0x3fc00 ++#define bCounterReset 0x10000 ++#define bNumOfOFDMTx 0xffff ++#define bNumOfCCKTx 0xffff0000 ++#define bTxIdleInterval 0xffff ++#define bOFDMService 0xffff0000 ++#define bTxMACHeader 0xffffffff ++#define bTxDataInit 0xff ++#define bTxHTMode 0x100 ++#define bTxDataType 0x30000 ++#define bTxRandomSeed 0xffffffff ++#define bCCKTxPreamble 0x1 ++#define bCCKTxSFD 0xffff0000 ++#define bCCKTxSIG 0xff ++#define bCCKTxService 0xff00 ++#define bCCKLengthExt 0x8000 ++#define bCCKTxLength 0xffff0000 ++#define bCCKTxCRC16 0xffff ++#define bCCKTxStatus 0x1 ++#define bOFDMTxStatus 0x2 ++ ++ ++/* ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 1. Page1(0x100) ++ * */ ++#define rPMAC_Reset 0x100 ++#define rPMAC_TxStart 0x104 ++#define rPMAC_TxLegacySIG 0x108 ++#define rPMAC_TxHTSIG1 0x10c ++#define rPMAC_TxHTSIG2 0x110 ++#define rPMAC_PHYDebug 0x114 ++#define rPMAC_TxPacketNum 0x118 ++#define rPMAC_TxIdle 0x11c ++#define rPMAC_TxMACHeader0 0x120 ++#define rPMAC_TxMACHeader1 0x124 ++#define rPMAC_TxMACHeader2 0x128 ++#define rPMAC_TxMACHeader3 0x12c ++#define rPMAC_TxMACHeader4 0x130 ++#define rPMAC_TxMACHeader5 0x134 ++#define rPMAC_TxDataType 0x138 ++#define rPMAC_TxRandomSeed 0x13c ++#define rPMAC_CCKPLCPPreamble 0x140 ++#define rPMAC_CCKPLCPHeader 0x144 ++#define rPMAC_CCKCRC16 0x148 ++#define rPMAC_OFDMRxCRC32OK 0x170 ++#define rPMAC_OFDMRxCRC32Er 0x174 ++#define rPMAC_OFDMRxParityEr 0x178 ++#define rPMAC_OFDMRxCRC8Er 0x17c ++#define rPMAC_CCKCRxRC16Er 0x180 ++#define rPMAC_CCKCRxRC32Er 0x184 ++#define rPMAC_CCKCRxRC32OK 0x188 ++#define rPMAC_TxStatus 0x18c ++ ++/* ++ * 3. Page8(0x800) ++ * */ ++#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ ++ ++#define rFPGA0_TxInfo 0x804 /* Status report?? */ ++#define rFPGA0_PSDFunction 0x808 ++#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ ++ ++#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ ++#define rFPGA0_XA_HSSIParameter2 0x824 ++#define rFPGA0_XB_HSSIParameter1 0x828 ++#define rFPGA0_XB_HSSIParameter2 0x82c ++ ++#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ ++#define rFPGA0_XCD_SwitchControl 0x85c ++ ++#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ ++#define rFPGA0_XCD_RFParameter 0x87c ++ ++#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ ++#define rFPGA0_AnalogParameter2 0x884 ++#define rFPGA0_AnalogParameter3 0x888 ++#define rFPGA0_AdDaClockEn 0x888 /* enable ad/da clock1 for dual-phy */ ++#define rFPGA0_AnalogParameter4 0x88c ++#define rFPGA0_XB_LSSIReadBack 0x8a4 ++#define rFPGA0_XCD_RFPara 0x8b4 ++ ++/* ++ * 4. Page9(0x900) ++ * */ ++#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ ++ ++#define rFPGA1_TxBlock 0x904 /* Useless now */ ++#define rFPGA1_DebugSelect 0x908 /* Useless now */ ++#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ ++ ++/* ++ * PageA(0xA00) ++ * */ ++#define rCCK0_System 0xa00 ++#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ ++#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ ++#define rCCK0_TxFilter1 0xa20 ++#define rCCK0_TxFilter2 0xa24 ++#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ ++#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ ++ ++/* ++ * PageB(0xB00) ++ * */ ++#define rPdp_AntA 0xb00 ++#define rPdp_AntA_4 0xb04 ++#define rConfig_Pmpd_AntA 0xb28 ++#define rConfig_AntA 0xb68 ++#define rConfig_AntB 0xb6c ++#define rPdp_AntB 0xb70 ++#define rPdp_AntB_4 0xb74 ++#define rConfig_Pmpd_AntB 0xb98 ++#define rAPK 0xbd8 ++ ++/* ++ * 6. PageC(0xC00) ++ * */ ++#define rOFDM0_LSTF 0xc00 ++ ++#define rOFDM0_TRxPathEnable 0xc04 ++#define rOFDM0_TRMuxPar 0xc08 ++#define rOFDM0_TRSWIsolation 0xc0c ++ ++#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ ++#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ ++#define rOFDM0_XBRxAFE 0xc18 ++#define rOFDM0_XBRxIQImbalance 0xc1c ++#define rOFDM0_XCRxAFE 0xc20 ++#define rOFDM0_XCRxIQImbalance 0xc24 ++#define rOFDM0_XDRxAFE 0xc28 ++#define rOFDM0_XDRxIQImbalance 0xc2c ++ ++#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ ++#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ ++#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ ++#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ ++ ++#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ ++#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ ++#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ ++#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ ++ ++#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ ++#define rOFDM0_XAAGCCore2 0xc54 ++#define rOFDM0_XBAGCCore1 0xc58 ++#define rOFDM0_XBAGCCore2 0xc5c ++#define rOFDM0_XCAGCCore1 0xc60 ++#define rOFDM0_XCAGCCore2 0xc64 ++#define rOFDM0_XDAGCCore1 0xc68 ++#define rOFDM0_XDAGCCore2 0xc6c ++ ++#define rOFDM0_AGCParameter1 0xc70 ++#define rOFDM0_AGCParameter2 0xc74 ++#define rOFDM0_AGCRSSITable 0xc78 ++#define rOFDM0_HTSTFAGC 0xc7c ++ ++#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ ++#define rOFDM0_XATxAFE 0xc84 ++#define rOFDM0_XBTxIQImbalance 0xc88 ++#define rOFDM0_XBTxAFE 0xc8c ++#define rOFDM0_XCTxIQImbalance 0xc90 ++#define rOFDM0_XCTxAFE 0xc94 ++#define rOFDM0_XDTxIQImbalance 0xc98 ++#define rOFDM0_XDTxAFE 0xc9c ++ ++#define rOFDM0_RxIQExtAnta 0xca0 ++#define rOFDM0_TxCoeff1 0xca4 ++#define rOFDM0_TxCoeff2 0xca8 ++#define rOFDM0_TxCoeff3 0xcac ++#define rOFDM0_TxCoeff4 0xcb0 ++#define rOFDM0_TxCoeff5 0xcb4 ++#define rOFDM0_TxCoeff6 0xcb8 ++#define rOFDM0_RxHPParameter 0xce0 ++#define rOFDM0_TxPseudoNoiseWgt 0xce4 ++#define rOFDM0_FrameSync 0xcf0 ++#define rOFDM0_DFSReport 0xcf4 ++ ++/* ++ * 7. PageD(0xD00) ++ * */ ++#define rOFDM1_LSTF 0xd00 ++#define rOFDM1_TRxPathEnable 0xd04 ++ ++/* ++ * 8. PageE(0xE00) ++ * */ ++#define rTxAGC_A_Rate18_06 0xe00 ++#define rTxAGC_A_Rate54_24 0xe04 ++#define rTxAGC_A_CCK1_Mcs32 0xe08 ++#define rTxAGC_A_Mcs03_Mcs00 0xe10 ++#define rTxAGC_A_Mcs07_Mcs04 0xe14 ++#define rTxAGC_A_Mcs11_Mcs08 0xe18 ++#define rTxAGC_A_Mcs15_Mcs12 0xe1c ++ ++#define rTxAGC_B_Rate18_06 0x830 ++#define rTxAGC_B_Rate54_24 0x834 ++#define rTxAGC_B_CCK1_55_Mcs32 0x838 ++#define rTxAGC_B_Mcs03_Mcs00 0x83c ++#define rTxAGC_B_Mcs07_Mcs04 0x848 ++#define rTxAGC_B_Mcs11_Mcs08 0x84c ++#define rTxAGC_B_Mcs15_Mcs12 0x868 ++#define rTxAGC_B_CCK11_A_CCK2_11 0x86c ++ ++#define rFPGA0_IQK 0xe28 ++#define rTx_IQK_Tone_A 0xe30 ++#define rRx_IQK_Tone_A 0xe34 ++#define rTx_IQK_PI_A 0xe38 ++#define rRx_IQK_PI_A 0xe3c ++ ++#define rTx_IQK 0xe40 ++#define rRx_IQK 0xe44 ++#define rIQK_AGC_Pts 0xe48 ++#define rIQK_AGC_Rsp 0xe4c ++#define rTx_IQK_Tone_B 0xe50 ++#define rRx_IQK_Tone_B 0xe54 ++#define rTx_IQK_PI_B 0xe58 ++#define rRx_IQK_PI_B 0xe5c ++#define rIQK_AGC_Cont 0xe60 ++ ++#define rBlue_Tooth 0xe6c ++#define rRx_Wait_CCA 0xe70 ++#define rTx_CCK_RFON 0xe74 ++#define rTx_CCK_BBON 0xe78 ++#define rTx_OFDM_RFON 0xe7c ++#define rTx_OFDM_BBON 0xe80 ++#define rTx_To_Rx 0xe84 ++#define rTx_To_Tx 0xe88 ++#define rRx_CCK 0xe8c ++ ++#define rTx_Power_Before_IQK_A 0xe94 ++#define rTx_Power_After_IQK_A 0xe9c ++ ++#define rRx_Power_Before_IQK_A 0xea0 ++#define rRx_Power_Before_IQK_A_2 0xea4 ++#define rRx_Power_After_IQK_A 0xea8 ++#define rRx_Power_After_IQK_A_2 0xeac ++ ++#define rTx_Power_Before_IQK_B 0xeb4 ++#define rTx_Power_After_IQK_B 0xebc ++ ++#define rRx_Power_Before_IQK_B 0xec0 ++#define rRx_Power_Before_IQK_B_2 0xec4 ++#define rRx_Power_After_IQK_B 0xec8 ++#define rRx_Power_After_IQK_B_2 0xecc ++ ++#define rRx_OFDM 0xed0 ++#define rRx_Wait_RIFS 0xed4 ++#define rRx_TO_Rx 0xed8 ++#define rStandby 0xedc ++#define rSleep 0xee0 ++#define rPMPD_ANAEN 0xeec ++ ++ ++/* 2. Page8(0x800) */ ++#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ ++#define bJapanMode 0x2 ++#define bCCKTxSC 0x30 ++#define bCCKEn 0x1000000 ++#define bOFDMEn 0x2000000 ++#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ ++#define bXCTxAGC 0xf000 ++#define bXDTxAGC 0xf0000 ++ ++/* 4. PageA(0xA00) */ ++#define bCCKBBMode 0x3 /* Useless */ ++#define bCCKTxPowerSaving 0x80 ++#define bCCKRxPowerSaving 0x40 ++ ++#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ ++ ++#define bCCKScramble 0x8 /* Useless */ ++#define bCCKAntDiversity 0x8000 ++#define bCCKCarrierRecovery 0x4000 ++#define bCCKTxRate 0x3000 ++#define bCCKDCCancel 0x0800 ++#define bCCKISICancel 0x0400 ++#define bCCKMatchFilter 0x0200 ++#define bCCKEqualizer 0x0100 ++#define bCCKPreambleDetect 0x800000 ++#define bCCKFastFalseCCA 0x400000 ++#define bCCKChEstStart 0x300000 ++#define bCCKCCACount 0x080000 ++#define bCCKcs_lim 0x070000 ++#define bCCKBistMode 0x80000000 ++#define bCCKCCAMask 0x40000000 ++#define bCCKTxDACPhase 0x4 ++#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ ++#define bCCKr_cp_mode0 0x0100 ++#define bCCKTxDCOffset 0xf0 ++#define bCCKRxDCOffset 0xf ++#define bCCKCCAMode 0xc000 ++#define bCCKFalseCS_lim 0x3f00 ++#define bCCKCS_ratio 0xc00000 ++#define bCCKCorgBit_sel 0x300000 ++#define bCCKPD_lim 0x0f0000 ++#define bCCKNewCCA 0x80000000 ++#define bCCKRxHPofIG 0x8000 ++#define bCCKRxIG 0x7f00 ++#define bCCKLNAPolarity 0x800000 ++#define bCCKRx1stGain 0x7f0000 ++#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ ++#define bCCKRxAGCSatLevel 0x1f000000 ++#define bCCKRxAGCSatCount 0xe0 ++#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ ++#define bCCKFixedRxAGC 0x8000 ++/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ ++#define bCCKAntennaPolarity 0x2000 ++#define bCCKTxFilterType 0x0c00 ++#define bCCKRxAGCReportType 0x0300 ++#define bCCKRxDAGCEn 0x80000000 ++#define bCCKRxDAGCPeriod 0x20000000 ++#define bCCKRxDAGCSatLevel 0x1f000000 ++#define bCCKTimingRecovery 0x800000 ++#define bCCKTxC0 0x3f0000 ++#define bCCKTxC1 0x3f000000 ++#define bCCKTxC2 0x3f ++#define bCCKTxC3 0x3f00 ++#define bCCKTxC4 0x3f0000 ++#define bCCKTxC5 0x3f000000 ++#define bCCKTxC6 0x3f ++#define bCCKTxC7 0x3f00 ++#define bCCKDebugPort 0xff0000 ++#define bCCKDACDebug 0x0f000000 ++#define bCCKFalseAlarmEnable 0x8000 ++#define bCCKFalseAlarmRead 0x4000 ++#define bCCKTRSSI 0x7f ++#define bCCKRxAGCReport 0xfe ++#define bCCKRxReport_AntSel 0x80000000 ++#define bCCKRxReport_MFOff 0x40000000 ++#define bCCKRxRxReport_SQLoss 0x20000000 ++#define bCCKRxReport_Pktloss 0x10000000 ++#define bCCKRxReport_Lockedbit 0x08000000 ++#define bCCKRxReport_RateError 0x04000000 ++#define bCCKRxReport_RxRate 0x03000000 ++#define bCCKRxFACounterLower 0xff ++#define bCCKRxFACounterUpper 0xff000000 ++#define bCCKRxHPAGCStart 0xe000 ++#define bCCKRxHPAGCFinal 0x1c00 ++#define bCCKRxFalseAlarmEnable 0x8000 ++#define bCCKFACounterFreeze 0x4000 ++#define bCCKTxPathSel 0x10000000 ++#define bCCKDefaultRxPath 0xc000000 ++#define bCCKOptionRxPath 0x3000000 ++ ++/* 6. PageE(0xE00) */ ++#define bSTBCEn 0x4 /* Useless */ ++#define bAntennaMapping 0x10 ++#define bNss 0x20 ++#define bCFOAntSumD 0x200 ++#define bPHYCounterReset 0x8000000 ++#define bCFOReportGet 0x4000000 ++#define bOFDMContinueTx 0x10000000 ++#define bOFDMSingleCarrier 0x20000000 ++#define bOFDMSingleTone 0x40000000 ++ ++ ++/* ++ * Other Definition ++ * */ ++ ++#define bEnable 0x1 /* Useless */ ++#define bDisable 0x0 ++ ++/* byte endable for srwrite */ ++#define bByte0 0x1 /* Useless */ ++#define bByte1 0x2 ++#define bByte2 0x4 ++#define bByte3 0x8 ++#define bWord0 0x3 ++#define bWord1 0xc ++#define bDWord 0xf ++ ++/* for PutRegsetting & GetRegSetting BitMask */ ++#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ ++#define bMaskByte1 0xff00 ++#define bMaskByte2 0xff0000 ++#define bMaskByte3 0xff000000 ++#define bMaskHWord 0xffff0000 ++#define bMaskLWord 0x0000ffff ++#define bMaskDWord 0xffffffff ++#define bMaskH3Bytes 0xffffff00 ++#define bMask12Bits 0xfff ++#define bMaskH4Bits 0xf0000000 ++#define bMaskOFDM_D 0xffc00000 ++#define bMaskCCK 0x3f3f3f3f ++ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8812PwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8812PwrSeq.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8812PwrSeq.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8812PwrSeq.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,209 @@ ++ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __HAL8812PWRSEQ_H__ ++#define __HAL8812PWRSEQ_H__ ++ ++#include "HalPwrSeqCmd.h" ++ ++/* ++ Check document WB-110628-DZ-RTL8195 (Jaguar) Power Architecture-R04.pdf ++ There are 6 HW Power States: ++ 0: POFF--Power Off ++ 1: PDN--Power Down ++ 2: CARDEMU--Card Emulation ++ 3: ACT--Active Mode ++ 4: LPS--Low Power State ++ 5: SUS--Suspend ++ ++ The transision from different states are defined below ++ TRANS_CARDEMU_TO_ACT ++ TRANS_ACT_TO_CARDEMU ++ TRANS_CARDEMU_TO_SUS ++ TRANS_SUS_TO_CARDEMU ++ TRANS_CARDEMU_TO_PDN ++ TRANS_ACT_TO_LPS ++ TRANS_LPS_TO_ACT ++ ++ TRANS_END ++*/ ++#define RTL8812_TRANS_CARDEMU_TO_ACT_STEPS 15 ++#define RTL8812_TRANS_ACT_TO_CARDEMU_STEPS 15 ++#define RTL8812_TRANS_CARDEMU_TO_SUS_STEPS 15 ++#define RTL8812_TRANS_SUS_TO_CARDEMU_STEPS 15 ++#define RTL8812_TRANS_CARDEMU_TO_PDN_STEPS 15 ++#define RTL8812_TRANS_PDN_TO_CARDEMU_STEPS 15 ++#define RTL8812_TRANS_ACT_TO_LPS_STEPS 15 ++#define RTL8812_TRANS_LPS_TO_ACT_STEPS 15 ++#define RTL8812_TRANS_END_STEPS 1 ++ ++ ++#define RTL8812_TRANS_CARDEMU_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ ++ /*{0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0}, disable HWPDN 0x04[15]=0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0},/* disable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ ++ ++#define RTL8812_TRANS_ACT_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ ++ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ ++ /*{0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},//0x1F[7:0] = 0 turn off RF*/ \ ++ /*{0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},//0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x2A}, /* 0x07[7:0] = 0x28 sps pwm mode 0x2a for BT coex*/ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk = 500k */ \ ++ /*{0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 | BIT1, 0}, // 0x02[1:0] = 0 reset BB */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ ++ ++#define RTL8812_TRANS_CARDEMU_TO_SUS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xF0, 0xcc},\ ++ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xF0, 0xEC},\ ++ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x07},/* gpio11 input mode, gpio10~8 output mode */ \ ++ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ ++ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ ++ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/* suspend option all off */ \ ++ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x80, BIT7},/*0x14[7] = 1 turn on ZCD */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x01, BIT0},/* 0x15[0] =1 trun on ZCD */ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x10, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk = 500k */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 2b'11 enable WL suspend for PCIe*/ ++ ++#define RTL8812_TRANS_SUS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 2b'01enable WL suspend*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x10, 0},/*0x23[4] = 0 hpon LDO sleep mode leave */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x01, 0},/* 0x15[0] =0 trun off ZCD */ \ ++ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x80, 0},/*0x14[7] = 0 turn off ZCD */ \ ++ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ ++ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio11 input mode, gpio10~8 input mode */ ++ ++#define RTL8812_TRANS_CARDEMU_TO_CARDDIS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ /**{0x0194, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, //0x194[0]=0 , disable 32K clock*/ \ ++ /**{0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x94}, //0x93 = 0x94 , 90[30] =0 enable 500k ANA clock .switch clock from 12M to 500K , 90 [26] =0 disable EEprom loader clock*/ \ ++ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0}, /*0x03[2] = 0, reset 8051*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x05}, /*0x80 = 05h if reload fw, fill the default value of host_CPU handshake field*/ \ ++ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xF0, 0xcc},\ ++ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xF0, 0xEC},\ ++ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x07},/* gpio11 input mode, gpio10~8 output mode */ \ ++ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ ++ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ ++ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ ++ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x80, BIT7},/*0x14[7] = 1 turn on ZCD */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x01, BIT0},/* 0x15[0] =1 trun on ZCD */ \ ++ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x01, 0},/*0x12[0] = 0 force PFM mode */ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x10, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk = 500k */ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ ++ {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /*0x01f[1]=0 , disable RFC_0 control REG_RF_CTRL_8812 */ \ ++ {0x0076, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /*0x076[1]=0 , disable RFC_1 control REG_OPT_CTRL_8812 +2 */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 2b'01 enable WL suspend*/ ++ ++#define RTL8812_TRANS_CARDDIS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*0x12[0] = 1 force PWM mode */ \ ++ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x80, 0},/*0x14[7] = 0 turn off ZCD */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x01, 0},/* 0x15[0] =0 trun off ZCD */ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x10, 0},/*0x23[4] = 0 hpon LDO leave sleep mode */ \ ++ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ ++ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio11 input mode, gpio10~8 input mode */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0}, /*0x04[10] = 0, enable SW LPS PCIE only*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 2b'01enable WL suspend*/ \ ++ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x03[2] = 1, enable 8051*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ ++ ++ ++#define RTL8812_TRANS_CARDEMU_TO_PDN \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ ++ ++#define RTL8812_TRANS_PDN_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ ++ ++#define RTL8812_TRANS_ACT_TO_LPS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x7F},/*Tx Pause*/ \ ++ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ ++ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated, and RF closed*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ ++ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ ++ ++ ++#define RTL8812_TRANS_LPS_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/ \ ++ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/ \ ++ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/ \ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/ \ ++ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ ++ ++#define RTL8812_TRANS_END \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, ++ ++ ++extern WLAN_PWR_CFG rtl8812_power_on_flow[RTL8812_TRANS_CARDEMU_TO_ACT_STEPS + RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_radio_off_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS + RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_card_disable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS + RTL8812_TRANS_CARDEMU_TO_PDN_STEPS + RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_card_enable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS + RTL8812_TRANS_CARDEMU_TO_PDN_STEPS + RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_suspend_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS + RTL8812_TRANS_CARDEMU_TO_SUS_STEPS + RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_resume_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS + RTL8812_TRANS_CARDEMU_TO_SUS_STEPS + RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_hwpdn_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS + RTL8812_TRANS_CARDEMU_TO_PDN_STEPS + RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_enter_lps_flow[RTL8812_TRANS_ACT_TO_LPS_STEPS + RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_leave_lps_flow[RTL8812_TRANS_LPS_TO_ACT_STEPS + RTL8812_TRANS_END_STEPS]; ++ ++#endif /* __HAL8812PWRSEQ_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8814PhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8814PhyCfg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8814PhyCfg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8814PhyCfg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,269 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8814PHYCFG_H__ ++#define __INC_HAL8814PHYCFG_H__ ++ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++#define LOOP_LIMIT 5 ++#define MAX_STALL_TIME 50 /* us */ ++#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ ++#define MAX_TXPWR_IDX_NMODE_92S 63 ++#define Reset_Cnt_Limit 3 ++ ++ ++#ifdef CONFIG_PCI_HCI ++ #define MAX_AGGR_NUM 0x0B ++#else ++ #define MAX_AGGR_NUM 0x07 ++#endif /* CONFIG_PCI_HCI */ ++ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++ ++/*------------------------------Define structure----------------------------*/ ++ ++ ++/* BB/RF related */ ++ ++#define SIC_ENABLE 0 ++ ++/*------------------------------Define structure----------------------------*/ ++ ++ ++/*------------------------Export global variable----------------------------*/ ++/*------------------------Export global variable----------------------------*/ ++ ++ ++/*------------------------Export Marco Definition---------------------------*/ ++/*------------------------Export Marco Definition---------------------------*/ ++ ++ ++/*--------------------------Exported Function prototype---------------------*/ ++/* 1. BB register R/W API */ ++ ++extern u32 ++PHY_QueryBBReg8814A(IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask); ++ ++ ++VOID ++PHY_SetBBReg8814A(IN PADAPTER Adapter, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data); ++ ++ ++extern u32 ++PHY_QueryRFReg8814A(IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask); ++ ++ ++void ++PHY_SetRFReg8814A(IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data); ++ ++/* 1 3. Initial BB/RF config by reading MAC/BB/RF txt. */ ++s32 ++phy_BB8814A_Config_ParaFile( ++ IN PADAPTER Adapter ++); ++ ++VOID ++PHY_ConfigBB_8814A( ++ IN PADAPTER Adapter ++); ++ ++ ++VOID ++phy_ADC_CLK_8814A( ++ IN PADAPTER Adapter ++); ++ ++s32 ++PHY_RFConfig8814A( ++ IN PADAPTER Adapter ++); ++ ++/* ++ * RF Power setting ++ * ++ * BOOLEAN PHY_SetRFPowerState8814A(PADAPTER Adapter, rt_rf_power_state eRFPowerState); */ ++ ++/* 1 5. Tx Power setting API */ ++ ++VOID ++PHY_GetTxPowerLevel8814( ++ IN PADAPTER Adapter, ++ OUT ps4Byte powerlevel ++); ++ ++VOID ++PHY_SetTxPowerLevel8814( ++ IN PADAPTER Adapter, ++ IN u8 Channel ++); ++ ++u8 ++PHY_GetTxPowerIndex_8814A( ++ IN PADAPTER Adapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN CHANNEL_WIDTH BandWidth, ++ IN u8 Channel ++); ++ ++u8 ++PHY_GetTxPowerIndex8814A( ++ IN PADAPTER Adapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN u8 BandWidth, ++ IN u8 Channel, ++ struct txpwr_idx_comp *tic ++); ++ ++VOID ++PHY_SetTxPowerIndex_8814A( ++ IN PADAPTER Adapter, ++ IN u32 PowerIndex, ++ IN u8 RFPath, ++ IN u8 Rate ++); ++ ++ ++BOOLEAN ++PHY_UpdateTxPowerDbm8814A( ++ IN PADAPTER Adapter, ++ IN s4Byte powerInDbm ++); ++ ++ ++u32 ++PHY_GetTxBBSwing_8814A( ++ IN PADAPTER Adapter, ++ IN BAND_TYPE Band, ++ IN u8 RFPath ++); ++ ++ ++ ++/* 1 6. Channel setting API */ ++ ++VOID ++PHY_SwChnlTimerCallback8814A( ++ IN PRT_TIMER pTimer ++); ++ ++VOID ++PHY_SwChnlWorkItemCallback8814A( ++ IN PVOID pContext ++); ++ ++ ++VOID ++HAL_HandleSwChnl8814A( ++ IN PADAPTER pAdapter, ++ IN u8 channel ++); ++ ++VOID ++PHY_SwChnlSynchronously8814A(IN PADAPTER pAdapter, ++ IN u8 channel); ++ ++VOID ++PHY_SwChnlAndSetBWModeCallback8814A(IN PVOID pContext); ++ ++ ++VOID ++PHY_HandleSwChnlAndSetBW8814A( ++ IN PADAPTER Adapter, ++ IN BOOLEAN bSwitchChannel, ++ IN BOOLEAN bSetBandWidth, ++ IN u8 ChannelNum, ++ IN CHANNEL_WIDTH ChnlWidth, ++ IN u8 ChnlOffsetOf40MHz, ++ IN u8 ChnlOffsetOf80MHz, ++ IN u8 CenterFrequencyIndex1 ++); ++ ++ ++BOOLEAN ++PHY_QueryRFPathSwitch_8814A(IN PADAPTER pAdapter); ++ ++ ++ ++#if (USE_WORKITEM) ++VOID ++RtCheckForHangWorkItemCallback8814A( ++ IN PVOID pContext ++); ++#endif ++ ++BOOLEAN ++SetAntennaConfig8814A( ++ IN PADAPTER Adapter, ++ IN u8 DefaultAnt ++); ++ ++VOID ++PHY_SetRFEReg8814A( ++ IN PADAPTER Adapter, ++ IN BOOLEAN bInit, ++ IN u8 Band ++); ++ ++ ++s32 ++PHY_SwitchWirelessBand8814A( ++ IN PADAPTER Adapter, ++ IN u8 Band ++); ++ ++VOID ++PHY_SetIO_8814A( ++ PADAPTER pAdapter ++); ++ ++VOID ++PHY_SetSwChnlBWMode8814( ++ IN PADAPTER Adapter, ++ IN u8 channel, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 Offset40, ++ IN u8 Offset80 ++); ++ ++s32 PHY_MACConfig8814(PADAPTER Adapter); ++int PHY_BBConfig8814(PADAPTER Adapter); ++VOID PHY_Set_SecCCATH_by_RXANT_8814A(PADAPTER pAdapter, u4Byte ulAntennaRx); ++ ++ ++ ++/*--------------------------Exported Function prototype---------------------*/ ++ ++/*--------------------------Exported Function prototype---------------------*/ ++#endif /* __INC_HAL8192CPHYCFG_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8814PhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8814PhyReg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8814PhyReg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8814PhyReg.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,866 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __INC_HAL8814PHYREG_H__ ++#define __INC_HAL8814PHYREG_H__ ++/*--------------------------Define Parameters-------------------------------*/ ++/* ++ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 ++ * 3. RF register 0x00-2E ++ * 4. Bit Mask for BB/RF register ++ * 5. Other defintion for BB/RF R/W ++ * */ ++ ++ ++/* BB Register Definition */ ++ ++#define rCCAonSec_Jaguar 0x838 ++#define rPwed_TH_Jaguar 0x830 ++#define rL1_Weight_Jaguar 0x840 ++#define r_L1_SBD_start_time 0x844 ++ ++/* BW and sideband setting */ ++#define rBWIndication_Jaguar 0x834 ++#define rL1PeakTH_Jaguar 0x848 ++#define rRFMOD_Jaguar 0x8ac /* RF mode */ ++#define rADC_Buf_Clk_Jaguar 0x8c4 ++#define rADC_Buf_40_Clk_Jaguar2 0x8c8 ++#define rRFECTRL_Jaguar 0x900 ++#define bRFMOD_Jaguar 0xc3 ++#define rCCK_System_Jaguar 0xa00 /* for cck sideband */ ++#define bCCK_System_Jaguar 0x10 ++ ++/* Block & Path enable */ ++#define rOFDMCCKEN_Jaguar 0x808 /* OFDM/CCK block enable */ ++#define bOFDMEN_Jaguar 0x20000000 ++#define bCCKEN_Jaguar 0x10000000 ++#define rRxPath_Jaguar 0x808 /* Rx antenna */ ++#define bRxPath_Jaguar 0xff ++#define rTxPath_Jaguar 0x80c /* Tx antenna */ ++#define bTxPath_Jaguar 0x0fffffff ++#define rCCK_RX_Jaguar 0xa04 /* for cck rx path selection */ ++#define bCCK_RX_Jaguar 0x0c000000 ++#define rVhtlen_Use_Lsig_Jaguar 0x8c3 /* Use LSIG for VHT length */ ++ ++#define rRxPath_Jaguar2 0xa04 /* Rx antenna */ ++#define rTxAnt_1Nsts_Jaguar2 0x93c /* Tx antenna for 1Nsts */ ++#define rTxAnt_23Nsts_Jaguar2 0x940 /* Tx antenna for 2Nsts and 3Nsts */ ++ ++ ++/* RF read/write-related */ ++#define rHSSIRead_Jaguar 0x8b0 /* RF read addr */ ++#define bHSSIRead_addr_Jaguar 0xff ++#define bHSSIRead_trigger_Jaguar 0x100 ++#define rA_PIRead_Jaguar 0xd04 /* RF readback with PI */ ++#define rB_PIRead_Jaguar 0xd44 /* RF readback with PI */ ++#define rA_SIRead_Jaguar 0xd08 /* RF readback with SI */ ++#define rB_SIRead_Jaguar 0xd48 /* RF readback with SI */ ++#define rRead_data_Jaguar 0xfffff ++#define rA_LSSIWrite_Jaguar 0xc90 /* RF write addr */ ++#define rB_LSSIWrite_Jaguar 0xe90 /* RF write addr */ ++#define bLSSIWrite_data_Jaguar 0x000fffff ++#define bLSSIWrite_addr_Jaguar 0x0ff00000 ++ ++#define rC_PIRead_Jaguar2 0xd84 /* RF readback with PI */ ++#define rD_PIRead_Jaguar2 0xdC4 /* RF readback with PI */ ++#define rC_SIRead_Jaguar2 0xd88 /* RF readback with SI */ ++#define rD_SIRead_Jaguar2 0xdC8 /* RF readback with SI */ ++#define rC_LSSIWrite_Jaguar2 0x1890 /* RF write addr */ ++#define rD_LSSIWrite_Jaguar2 0x1A90 /* RF write addr */ ++ ++ ++/* YN: mask the following register definition temporarily */ ++#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ ++#define rFPGA0_XB_RFInterfaceOE 0x864 ++ ++#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ ++#define rFPGA0_XCD_RFInterfaceSW 0x874 ++ ++/* #define rFPGA0_XAB_RFParameter 0x878 */ /* RF Parameter ++ * #define rFPGA0_XCD_RFParameter 0x87c */ ++ ++/* #define rFPGA0_AnalogParameter1 0x880 */ /* Crystal cap setting RF-R/W protection for parameter4?? ++ * #define rFPGA0_AnalogParameter2 0x884 ++ * #define rFPGA0_AnalogParameter3 0x888 ++ * #define rFPGA0_AdDaClockEn 0x888 */ /* enable ad/da clock1 for dual-phy ++ * #define rFPGA0_AnalogParameter4 0x88c */ ++ ++ ++/* CCK TX scaling */ ++#define rCCK_TxFilter1_Jaguar 0xa20 ++#define bCCK_TxFilter1_C0_Jaguar 0x00ff0000 ++#define bCCK_TxFilter1_C1_Jaguar 0xff000000 ++#define rCCK_TxFilter2_Jaguar 0xa24 ++#define bCCK_TxFilter2_C2_Jaguar 0x000000ff ++#define bCCK_TxFilter2_C3_Jaguar 0x0000ff00 ++#define bCCK_TxFilter2_C4_Jaguar 0x00ff0000 ++#define bCCK_TxFilter2_C5_Jaguar 0xff000000 ++#define rCCK_TxFilter3_Jaguar 0xa28 ++#define bCCK_TxFilter3_C6_Jaguar 0x000000ff ++#define bCCK_TxFilter3_C7_Jaguar 0x0000ff00 ++/* NBI & CSI Mask setting */ ++#define rCSI_Mask_Setting1_Jaguar 0x874 ++#define rCSI_Fix_Mask0_Jaguar 0x880 ++#define rCSI_Fix_Mask1_Jaguar 0x884 ++#define rCSI_Fix_Mask2_Jaguar 0x888 ++#define rCSI_Fix_Mask3_Jaguar 0x88c ++#define rCSI_Fix_Mask4_Jaguar 0x890 ++#define rCSI_Fix_Mask5_Jaguar 0x894 ++#define rCSI_Fix_Mask6_Jaguar 0x898 ++#define rCSI_Fix_Mask7_Jaguar 0x89c ++#define rNBI_Setting_Jaguar 0x87c ++ ++ ++/* YN: mask the following register definition temporarily ++ * #define rPdp_AntA 0xb00 ++ * #define rPdp_AntA_4 0xb04 ++ * #define rConfig_Pmpd_AntA 0xb28 ++ * #define rConfig_AntA 0xb68 ++ * #define rConfig_AntB 0xb6c ++ * #define rPdp_AntB 0xb70 ++ * #define rPdp_AntB_4 0xb74 ++ * #define rConfig_Pmpd_AntB 0xb98 ++ * #define rAPK 0xbd8 */ ++ ++/* RXIQC */ ++#define rA_RxIQC_AB_Jaguar 0xc10 /* RxIQ imblance matrix coeff. A & B */ ++#define rA_RxIQC_CD_Jaguar 0xc14 /* RxIQ imblance matrix coeff. C & D */ ++#define rA_TxScale_Jaguar 0xc1c /* Pah_A TX scaling factor */ ++#define rB_TxScale_Jaguar 0xe1c /* Path_B TX scaling factor */ ++#define rB_RxIQC_AB_Jaguar 0xe10 /* RxIQ imblance matrix coeff. A & B */ ++#define rB_RxIQC_CD_Jaguar 0xe14 /* RxIQ imblance matrix coeff. C & D */ ++#define b_RxIQC_AC_Jaguar 0x02ff /* bit mask for IQC matrix element A & C */ ++#define b_RxIQC_BD_Jaguar 0x02ff0000 /* bit mask for IQC matrix element A & C */ ++ ++#define rC_TxScale_Jaguar2 0x181c /* Pah_C TX scaling factor */ ++#define rD_TxScale_Jaguar2 0x1A1c /* Path_D TX scaling factor */ ++#define rRF_TxGainOffset 0x55 ++ ++/* DIG-related */ ++#define rA_IGI_Jaguar 0xc50 /* Initial Gain for path-A */ ++#define rB_IGI_Jaguar 0xe50 /* Initial Gain for path-B */ ++#define rC_IGI_Jaguar2 0x1850 /* Initial Gain for path-C */ ++#define rD_IGI_Jaguar2 0x1A50 /* Initial Gain for path-D */ ++ ++#define rOFDM_FalseAlarm1_Jaguar 0xf48 /* counter for break */ ++#define rOFDM_FalseAlarm2_Jaguar 0xf4c /* counter for spoofing */ ++#define rCCK_FalseAlarm_Jaguar 0xa5c /* counter for cck false alarm */ ++#define b_FalseAlarm_Jaguar 0xffff ++#define rCCK_CCA_Jaguar 0xa08 /* cca threshold */ ++#define bCCK_CCA_Jaguar 0x00ff0000 ++ ++/* Tx Power Ttraining-related */ ++#define rA_TxPwrTraing_Jaguar 0xc54 ++#define rB_TxPwrTraing_Jaguar 0xe54 ++ ++/* Report-related */ ++#define rOFDM_ShortCFOAB_Jaguar 0xf60 ++#define rOFDM_LongCFOAB_Jaguar 0xf64 ++#define rOFDM_EndCFOAB_Jaguar 0xf70 ++#define rOFDM_AGCReport_Jaguar 0xf84 ++#define rOFDM_RxSNR_Jaguar 0xf88 ++#define rOFDM_RxEVMCSI_Jaguar 0xf8c ++#define rOFDM_SIGReport_Jaguar 0xf90 ++ ++/* Misc functions */ ++#define rEDCCA_Jaguar 0x8a4 /* EDCCA */ ++#define bEDCCA_Jaguar 0xffff ++#define rAGC_table_Jaguar 0x82c /* AGC tabel select */ ++#define bAGC_table_Jaguar 0x3 ++#define b_sel5g_Jaguar 0x1000 /* sel5g */ ++#define b_LNA_sw_Jaguar 0x8000 /* HW/WS control for LNA */ ++#define rFc_area_Jaguar 0x860 /* fc_area */ ++#define bFc_area_Jaguar 0x1ffe000 ++#define rSingleTone_ContTx_Jaguar 0x914 ++ ++#define rAGC_table_Jaguar2 0x958 /* AGC tabel select */ ++#define rDMA_trigger_Jaguar2 0x95C /* ADC sample mode */ ++ ++ ++/* RFE */ ++#define rA_RFE_Pinmux_Jaguar 0xcb0 /* Path_A RFE cotrol pinmux */ ++#define rB_RFE_Pinmux_Jaguar 0xeb0 /* Path_B RFE control pinmux */ ++#define rA_RFE_Inv_Jaguar 0xcb4 /* Path_A RFE cotrol */ ++#define rB_RFE_Inv_Jaguar 0xeb4 /* Path_B RFE control */ ++#define rA_RFE_Jaguar 0xcb8 /* Path_A RFE cotrol */ ++#define rB_RFE_Jaguar 0xeb8 /* Path_B RFE control */ ++#define r_ANTSEL_SW_Jaguar 0x900 /* ANTSEL SW Control */ ++#define bMask_RFEInv_Jaguar 0x3ff00000 ++#define bMask_AntselPathFollow_Jaguar 0x00030000 ++ ++#define rC_RFE_Pinmux_Jaguar 0x18B4 /* Path_C RFE cotrol pinmux */ ++#define rD_RFE_Pinmux_Jaguar 0x1AB4 /* Path_D RFE cotrol pinmux */ ++#define rA_RFE_Sel_Jaguar2 0x1990 ++ ++ ++ ++/* TX AGC */ ++#define rTxAGC_A_CCK11_CCK1_JAguar 0xc20 ++#define rTxAGC_A_Ofdm18_Ofdm6_JAguar 0xc24 ++#define rTxAGC_A_Ofdm54_Ofdm24_JAguar 0xc28 ++#define rTxAGC_A_MCS3_MCS0_JAguar 0xc2c ++#define rTxAGC_A_MCS7_MCS4_JAguar 0xc30 ++#define rTxAGC_A_MCS11_MCS8_JAguar 0xc34 ++#define rTxAGC_A_MCS15_MCS12_JAguar 0xc38 ++#define rTxAGC_A_Nss1Index3_Nss1Index0_JAguar 0xc3c ++#define rTxAGC_A_Nss1Index7_Nss1Index4_JAguar 0xc40 ++#define rTxAGC_A_Nss2Index1_Nss1Index8_JAguar 0xc44 ++#define rTxAGC_A_Nss2Index5_Nss2Index2_JAguar 0xc48 ++#define rTxAGC_A_Nss2Index9_Nss2Index6_JAguar 0xc4c ++#define rTxAGC_B_CCK11_CCK1_JAguar 0xe20 ++#define rTxAGC_B_Ofdm18_Ofdm6_JAguar 0xe24 ++#define rTxAGC_B_Ofdm54_Ofdm24_JAguar 0xe28 ++#define rTxAGC_B_MCS3_MCS0_JAguar 0xe2c ++#define rTxAGC_B_MCS7_MCS4_JAguar 0xe30 ++#define rTxAGC_B_MCS11_MCS8_JAguar 0xe34 ++#define rTxAGC_B_MCS15_MCS12_JAguar 0xe38 ++#define rTxAGC_B_Nss1Index3_Nss1Index0_JAguar 0xe3c ++#define rTxAGC_B_Nss1Index7_Nss1Index4_JAguar 0xe40 ++#define rTxAGC_B_Nss2Index1_Nss1Index8_JAguar 0xe44 ++#define rTxAGC_B_Nss2Index5_Nss2Index2_JAguar 0xe48 ++#define rTxAGC_B_Nss2Index9_Nss2Index6_JAguar 0xe4c ++#define bTxAGC_byte0_Jaguar 0xff ++#define bTxAGC_byte1_Jaguar 0xff00 ++#define bTxAGC_byte2_Jaguar 0xff0000 ++#define bTxAGC_byte3_Jaguar 0xff000000 ++ ++ ++/* TX AGC */ ++#define rTxAGC_A_CCK11_CCK1_Jaguar2 0xc20 ++#define rTxAGC_A_Ofdm18_Ofdm6_Jaguar2 0xc24 ++#define rTxAGC_A_Ofdm54_Ofdm24_Jaguar2 0xc28 ++#define rTxAGC_A_MCS3_MCS0_Jaguar2 0xc2c ++#define rTxAGC_A_MCS7_MCS4_Jaguar2 0xc30 ++#define rTxAGC_A_MCS11_MCS8_Jaguar2 0xc34 ++#define rTxAGC_A_MCS15_MCS12_Jaguar2 0xc38 ++#define rTxAGC_A_MCS19_MCS16_Jaguar2 0xcd8 ++#define rTxAGC_A_MCS23_MCS20_Jaguar2 0xcdc ++#define rTxAGC_A_Nss1Index3_Nss1Index0_Jaguar2 0xc3c ++#define rTxAGC_A_Nss1Index7_Nss1Index4_Jaguar2 0xc40 ++#define rTxAGC_A_Nss2Index1_Nss1Index8_Jaguar2 0xc44 ++#define rTxAGC_A_Nss2Index5_Nss2Index2_Jaguar2 0xc48 ++#define rTxAGC_A_Nss2Index9_Nss2Index6_Jaguar2 0xc4c ++#define rTxAGC_A_Nss3Index3_Nss3Index0_Jaguar2 0xce0 ++#define rTxAGC_A_Nss3Index7_Nss3Index4_Jaguar2 0xce4 ++#define rTxAGC_A_Nss3Index9_Nss3Index8_Jaguar2 0xce8 ++#define rTxAGC_B_CCK11_CCK1_Jaguar2 0xe20 ++#define rTxAGC_B_Ofdm18_Ofdm6_Jaguar2 0xe24 ++#define rTxAGC_B_Ofdm54_Ofdm24_Jaguar2 0xe28 ++#define rTxAGC_B_MCS3_MCS0_Jaguar2 0xe2c ++#define rTxAGC_B_MCS7_MCS4_Jaguar2 0xe30 ++#define rTxAGC_B_MCS11_MCS8_Jaguar2 0xe34 ++#define rTxAGC_B_MCS15_MCS12_Jaguar2 0xe38 ++#define rTxAGC_B_MCS19_MCS16_Jaguar2 0xed8 ++#define rTxAGC_B_MCS23_MCS20_Jaguar2 0xedc ++#define rTxAGC_B_Nss1Index3_Nss1Index0_Jaguar2 0xe3c ++#define rTxAGC_B_Nss1Index7_Nss1Index4_Jaguar2 0xe40 ++#define rTxAGC_B_Nss2Index1_Nss1Index8_Jaguar2 0xe44 ++#define rTxAGC_B_Nss2Index5_Nss2Index2_Jaguar2 0xe48 ++#define rTxAGC_B_Nss2Index9_Nss2Index6_Jaguar2 0xe4c ++#define rTxAGC_B_Nss3Index3_Nss3Index0_Jaguar2 0xee0 ++#define rTxAGC_B_Nss3Index7_Nss3Index4_Jaguar2 0xee4 ++#define rTxAGC_B_Nss3Index9_Nss3Index8_Jaguar2 0xee8 ++#define rTxAGC_C_CCK11_CCK1_Jaguar2 0x1820 ++#define rTxAGC_C_Ofdm18_Ofdm6_Jaguar2 0x1824 ++#define rTxAGC_C_Ofdm54_Ofdm24_Jaguar2 0x1828 ++#define rTxAGC_C_MCS3_MCS0_Jaguar2 0x182c ++#define rTxAGC_C_MCS7_MCS4_Jaguar2 0x1830 ++#define rTxAGC_C_MCS11_MCS8_Jaguar2 0x1834 ++#define rTxAGC_C_MCS15_MCS12_Jaguar2 0x1838 ++#define rTxAGC_C_MCS19_MCS16_Jaguar2 0x18d8 ++#define rTxAGC_C_MCS23_MCS20_Jaguar2 0x18dc ++#define rTxAGC_C_Nss1Index3_Nss1Index0_Jaguar2 0x183c ++#define rTxAGC_C_Nss1Index7_Nss1Index4_Jaguar2 0x1840 ++#define rTxAGC_C_Nss2Index1_Nss1Index8_Jaguar2 0x1844 ++#define rTxAGC_C_Nss2Index5_Nss2Index2_Jaguar2 0x1848 ++#define rTxAGC_C_Nss2Index9_Nss2Index6_Jaguar2 0x184c ++#define rTxAGC_C_Nss3Index3_Nss3Index0_Jaguar2 0x18e0 ++#define rTxAGC_C_Nss3Index7_Nss3Index4_Jaguar2 0x18e4 ++#define rTxAGC_C_Nss3Index9_Nss3Index8_Jaguar2 0x18e8 ++#define rTxAGC_D_CCK11_CCK1_Jaguar2 0x1a20 ++#define rTxAGC_D_Ofdm18_Ofdm6_Jaguar2 0x1a24 ++#define rTxAGC_D_Ofdm54_Ofdm24_Jaguar2 0x1a28 ++#define rTxAGC_D_MCS3_MCS0_Jaguar2 0x1a2c ++#define rTxAGC_D_MCS7_MCS4_Jaguar2 0x1a30 ++#define rTxAGC_D_MCS11_MCS8_Jaguar2 0x1a34 ++#define rTxAGC_D_MCS15_MCS12_Jaguar2 0x1a38 ++#define rTxAGC_D_MCS19_MCS16_Jaguar2 0x1ad8 ++#define rTxAGC_D_MCS23_MCS20_Jaguar2 0x1adc ++#define rTxAGC_D_Nss1Index3_Nss1Index0_Jaguar2 0x1a3c ++#define rTxAGC_D_Nss1Index7_Nss1Index4_Jaguar2 0x1a40 ++#define rTxAGC_D_Nss2Index1_Nss1Index8_Jaguar2 0x1a44 ++#define rTxAGC_D_Nss2Index5_Nss2Index2_Jaguar2 0x1a48 ++#define rTxAGC_D_Nss2Index9_Nss2Index6_Jaguar2 0x1a4c ++#define rTxAGC_D_Nss3Index3_Nss3Index0_Jaguar2 0x1ae0 ++#define rTxAGC_D_Nss3Index7_Nss3Index4_Jaguar2 0x1ae4 ++#define rTxAGC_D_Nss3Index9_Nss3Index8_Jaguar2 0x1ae8 ++/* IQK YN: temporaily mask this part ++ * #define rFPGA0_IQK 0xe28 ++ * #define rTx_IQK_Tone_A 0xe30 ++ * #define rRx_IQK_Tone_A 0xe34 ++ * #define rTx_IQK_PI_A 0xe38 ++ * #define rRx_IQK_PI_A 0xe3c */ ++ ++/* #define rTx_IQK 0xe40 */ ++/* #define rRx_IQK 0xe44 */ ++/* #define rIQK_AGC_Pts 0xe48 */ ++/* #define rIQK_AGC_Rsp 0xe4c */ ++/* #define rTx_IQK_Tone_B 0xe50 */ ++/* #define rRx_IQK_Tone_B 0xe54 */ ++/* #define rTx_IQK_PI_B 0xe58 */ ++/* #define rRx_IQK_PI_B 0xe5c */ ++/* #define rIQK_AGC_Cont 0xe60 */ ++ ++ ++/* AFE-related */ ++#define rA_AFEPwr1_Jaguar 0xc60 /* dynamic AFE power control */ ++#define rA_AFEPwr2_Jaguar 0xc64 /* dynamic AFE power control */ ++#define rA_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xc68 ++#define rA_Tx_CCKBBON_OFDMRFON_Jaguar 0xc6c ++#define rA_Tx_OFDMBBON_Tx2Rx_Jaguar 0xc70 ++#define rA_Tx2Tx_RXCCK_Jaguar 0xc74 ++#define rA_Rx_OFDM_WaitRIFS_Jaguar 0xc78 ++#define rA_Rx2Rx_BT_Jaguar 0xc7c ++#define rA_sleep_nav_Jaguar 0xc80 ++#define rA_pmpd_Jaguar 0xc84 ++#define rB_AFEPwr1_Jaguar 0xe60 /* dynamic AFE power control */ ++#define rB_AFEPwr2_Jaguar 0xe64 /* dynamic AFE power control */ ++#define rB_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xe68 ++#define rB_Tx_CCKBBON_OFDMRFON_Jaguar 0xe6c ++#define rB_Tx_OFDMBBON_Tx2Rx_Jaguar 0xe70 ++#define rB_Tx2Tx_RXCCK_Jaguar 0xe74 ++#define rB_Rx_OFDM_WaitRIFS_Jaguar 0xe78 ++#define rB_Rx2Rx_BT_Jaguar 0xe7c ++#define rB_sleep_nav_Jaguar 0xe80 ++#define rB_pmpd_Jaguar 0xe84 ++ ++ ++/* YN: mask these registers temporaily ++ * #define rTx_Power_Before_IQK_A 0xe94 ++ * #define rTx_Power_After_IQK_A 0xe9c */ ++ ++/* #define rRx_Power_Before_IQK_A 0xea0 */ ++/* #define rRx_Power_Before_IQK_A_2 0xea4 */ ++/* #define rRx_Power_After_IQK_A 0xea8 */ ++/* #define rRx_Power_After_IQK_A_2 0xeac */ ++ ++/* #define rTx_Power_Before_IQK_B 0xeb4 */ ++/* #define rTx_Power_After_IQK_B 0xebc */ ++ ++/* #define rRx_Power_Before_IQK_B 0xec0 */ ++/* #define rRx_Power_Before_IQK_B_2 0xec4 */ ++/* #define rRx_Power_After_IQK_B 0xec8 */ ++/* #define rRx_Power_After_IQK_B_2 0xecc */ ++ ++ ++/* RSSI Dump */ ++#define rA_RSSIDump_Jaguar 0xBF0 ++#define rB_RSSIDump_Jaguar 0xBF1 ++#define rS1_RXevmDump_Jaguar 0xBF4 ++#define rS2_RXevmDump_Jaguar 0xBF5 ++#define rA_RXsnrDump_Jaguar 0xBF6 ++#define rB_RXsnrDump_Jaguar 0xBF7 ++#define rA_CfoShortDump_Jaguar 0xBF8 ++#define rB_CfoShortDump_Jaguar 0xBFA ++#define rA_CfoLongDump_Jaguar 0xBEC ++#define rB_CfoLongDump_Jaguar 0xBEE ++ ++ ++/* RF Register ++ * */ ++#define RF_AC_Jaguar 0x00 /* */ ++#define RF_RF_Top_Jaguar 0x07 /* */ ++#define RF_TXLOK_Jaguar 0x08 /* */ ++#define RF_TXAPK_Jaguar 0x0B ++#define RF_CHNLBW_Jaguar 0x18 /* RF channel and BW switch */ ++#define RF_RCK1_Jaguar 0x1c /* */ ++#define RF_RCK2_Jaguar 0x1d ++#define RF_RCK3_Jaguar 0x1e ++#define RF_ModeTableAddr 0x30 ++#define RF_ModeTableData0 0x31 ++#define RF_ModeTableData1 0x32 ++#define RF_TxLCTank_Jaguar 0x54 ++#define RF_APK_Jaguar 0x63 ++#define RF_LCK 0xB4 ++#define RF_WeLut_Jaguar 0xEF ++ ++#define bRF_CHNLBW_MOD_AG_Jaguar 0x70300 ++#define bRF_CHNLBW_BW 0xc00 ++ ++ ++/* ++ * RL6052 Register definition ++ * */ ++#define RF_AC 0x00 /* */ ++#define RF_IPA_A 0x0C /* */ ++#define RF_TXBIAS_A 0x0D ++#define RF_BS_PA_APSET_G9_G11 0x0E ++#define RF_MODE1 0x10 /* */ ++#define RF_MODE2 0x11 /* */ ++#define RF_CHNLBW 0x18 /* RF channel and BW switch */ ++#define RF_RCK_OS 0x30 /* RF TX PA control */ ++#define RF_TXPA_G1 0x31 /* RF TX PA control */ ++#define RF_TXPA_G2 0x32 /* RF TX PA control */ ++#define RF_TXPA_G3 0x33 /* RF TX PA control */ ++#define RF_0x52 0x52 ++#define RF_WE_LUT 0xEF ++ ++/* ++ * Bit Mask ++ * ++ * 1. Page1(0x100) */ ++#define bBBResetB 0x100 /* Useless now? */ ++#define bGlobalResetB 0x200 ++#define bOFDMTxStart 0x4 ++#define bCCKTxStart 0x8 ++#define bCRC32Debug 0x100 ++#define bPMACLoopback 0x10 ++#define bTxLSIG 0xffffff ++#define bOFDMTxRate 0xf ++#define bOFDMTxReserved 0x10 ++#define bOFDMTxLength 0x1ffe0 ++#define bOFDMTxParity 0x20000 ++#define bTxHTSIG1 0xffffff ++#define bTxHTMCSRate 0x7f ++#define bTxHTBW 0x80 ++#define bTxHTLength 0xffff00 ++#define bTxHTSIG2 0xffffff ++#define bTxHTSmoothing 0x1 ++#define bTxHTSounding 0x2 ++#define bTxHTReserved 0x4 ++#define bTxHTAggreation 0x8 ++#define bTxHTSTBC 0x30 ++#define bTxHTAdvanceCoding 0x40 ++#define bTxHTShortGI 0x80 ++#define bTxHTNumberHT_LTF 0x300 ++#define bTxHTCRC8 0x3fc00 ++#define bCounterReset 0x10000 ++#define bNumOfOFDMTx 0xffff ++#define bNumOfCCKTx 0xffff0000 ++#define bTxIdleInterval 0xffff ++#define bOFDMService 0xffff0000 ++#define bTxMACHeader 0xffffffff ++#define bTxDataInit 0xff ++#define bTxHTMode 0x100 ++#define bTxDataType 0x30000 ++#define bTxRandomSeed 0xffffffff ++#define bCCKTxPreamble 0x1 ++#define bCCKTxSFD 0xffff0000 ++#define bCCKTxSIG 0xff ++#define bCCKTxService 0xff00 ++#define bCCKLengthExt 0x8000 ++#define bCCKTxLength 0xffff0000 ++#define bCCKTxCRC16 0xffff ++#define bCCKTxStatus 0x1 ++#define bOFDMTxStatus 0x2 ++ ++ ++/* ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 1. Page1(0x100) ++ * */ ++#define rPMAC_Reset 0x100 ++#define rPMAC_TxStart 0x104 ++#define rPMAC_TxLegacySIG 0x108 ++#define rPMAC_TxHTSIG1 0x10c ++#define rPMAC_TxHTSIG2 0x110 ++#define rPMAC_PHYDebug 0x114 ++#define rPMAC_TxPacketNum 0x118 ++#define rPMAC_TxIdle 0x11c ++#define rPMAC_TxMACHeader0 0x120 ++#define rPMAC_TxMACHeader1 0x124 ++#define rPMAC_TxMACHeader2 0x128 ++#define rPMAC_TxMACHeader3 0x12c ++#define rPMAC_TxMACHeader4 0x130 ++#define rPMAC_TxMACHeader5 0x134 ++#define rPMAC_TxDataType 0x138 ++#define rPMAC_TxRandomSeed 0x13c ++#define rPMAC_CCKPLCPPreamble 0x140 ++#define rPMAC_CCKPLCPHeader 0x144 ++#define rPMAC_CCKCRC16 0x148 ++#define rPMAC_OFDMRxCRC32OK 0x170 ++#define rPMAC_OFDMRxCRC32Er 0x174 ++#define rPMAC_OFDMRxParityEr 0x178 ++#define rPMAC_OFDMRxCRC8Er 0x17c ++#define rPMAC_CCKCRxRC16Er 0x180 ++#define rPMAC_CCKCRxRC32Er 0x184 ++#define rPMAC_CCKCRxRC32OK 0x188 ++#define rPMAC_TxStatus 0x18c ++ ++/* ++ * 3. Page8(0x800) ++ * */ ++#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ ++ ++#define rFPGA0_TxInfo 0x804 /* Status report?? */ ++#define rFPGA0_PSDFunction 0x808 ++#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ ++ ++#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ ++#define rFPGA0_XA_HSSIParameter2 0x824 ++#define rFPGA0_XB_HSSIParameter1 0x828 ++#define rFPGA0_XB_HSSIParameter2 0x82c ++ ++#define rFPGA0_XA_LSSIParameter 0x840 ++#define rFPGA0_XB_LSSIParameter 0x844 ++ ++#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ ++#define rFPGA0_XCD_SwitchControl 0x85c ++ ++#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ ++#define rFPGA0_XCD_RFParameter 0x87c ++ ++#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ ++#define rFPGA0_AnalogParameter2 0x884 ++#define rFPGA0_AnalogParameter3 0x888 ++#define rFPGA0_AdDaClockEn 0x888 /* enable ad/da clock1 for dual-phy */ ++#define rFPGA0_AnalogParameter4 0x88c ++ ++#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ ++#define rFPGA0_XB_LSSIReadBack 0x8a4 ++#define rFPGA0_XC_LSSIReadBack 0x8a8 ++#define rFPGA0_XD_LSSIReadBack 0x8ac ++ ++#define rFPGA0_XCD_RFPara 0x8b4 ++#define rFPGA0_PSDReport 0x8b4 /* Useless now */ ++#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ ++#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ ++#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ ++#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ ++ ++/* ++ * 4. Page9(0x900) ++ * */ ++#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ ++#define REG_BB_TX_PATH_SEL_1_8814A 0x93c ++#define REG_BB_TX_PATH_SEL_2_8814A 0x940 ++#define rFPGA1_TxBlock 0x904 /* Useless now */ ++#define rFPGA1_DebugSelect 0x908 /* Useless now */ ++#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ ++/*Page 19 for TxBF*/ ++#define REG_BB_TXBF_ANT_SET_BF1_8814A 0x19ac ++#define REG_BB_TXBF_ANT_SET_BF0_8814A 0x19b4 ++/* ++ * PageA(0xA00) ++ * */ ++#define rCCK0_System 0xa00 ++#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ ++#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ ++#define rCCK0_TxFilter1 0xa20 ++#define rCCK0_TxFilter2 0xa24 ++#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ ++#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ ++ ++/* ++ * PageB(0xB00) ++ * */ ++#define rPdp_AntA 0xb00 ++#define rPdp_AntA_4 0xb04 ++#define rConfig_Pmpd_AntA 0xb28 ++#define rConfig_AntA 0xb68 ++#define rConfig_AntB 0xb6c ++#define rPdp_AntB 0xb70 ++#define rPdp_AntB_4 0xb74 ++#define rConfig_Pmpd_AntB 0xb98 ++#define rAPK 0xbd8 ++ ++/* ++ * 6. PageC(0xC00) ++ * */ ++#define rOFDM0_LSTF 0xc00 ++ ++#define rOFDM0_TRxPathEnable 0xc04 ++#define rOFDM0_TRMuxPar 0xc08 ++#define rOFDM0_TRSWIsolation 0xc0c ++ ++#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ ++#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ ++#define rOFDM0_XBRxAFE 0xc18 ++#define rOFDM0_XBRxIQImbalance 0xc1c ++#define rOFDM0_XCRxAFE 0xc20 ++#define rOFDM0_XCRxIQImbalance 0xc24 ++#define rOFDM0_XDRxAFE 0xc28 ++#define rOFDM0_XDRxIQImbalance 0xc2c ++ ++#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ ++#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ ++#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ ++#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ ++ ++#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ ++#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ ++#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ ++#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ ++ ++#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ ++#define rOFDM0_XAAGCCore2 0xc54 ++#define rOFDM0_XBAGCCore1 0xc58 ++#define rOFDM0_XBAGCCore2 0xc5c ++#define rOFDM0_XCAGCCore1 0xc60 ++#define rOFDM0_XCAGCCore2 0xc64 ++#define rOFDM0_XDAGCCore1 0xc68 ++#define rOFDM0_XDAGCCore2 0xc6c ++ ++#define rOFDM0_AGCParameter1 0xc70 ++#define rOFDM0_AGCParameter2 0xc74 ++#define rOFDM0_AGCRSSITable 0xc78 ++#define rOFDM0_HTSTFAGC 0xc7c ++ ++#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ ++#define rOFDM0_XATxAFE 0xc84 ++#define rOFDM0_XBTxIQImbalance 0xc88 ++#define rOFDM0_XBTxAFE 0xc8c ++#define rOFDM0_XCTxIQImbalance 0xc90 ++#define rOFDM0_XCTxAFE 0xc94 ++#define rOFDM0_XDTxIQImbalance 0xc98 ++#define rOFDM0_XDTxAFE 0xc9c ++ ++#define rOFDM0_RxIQExtAnta 0xca0 ++#define rOFDM0_TxCoeff1 0xca4 ++#define rOFDM0_TxCoeff2 0xca8 ++#define rOFDM0_TxCoeff3 0xcac ++#define rOFDM0_TxCoeff4 0xcb0 ++#define rOFDM0_TxCoeff5 0xcb4 ++#define rOFDM0_TxCoeff6 0xcb8 ++#define rOFDM0_RxHPParameter 0xce0 ++#define rOFDM0_TxPseudoNoiseWgt 0xce4 ++#define rOFDM0_FrameSync 0xcf0 ++#define rOFDM0_DFSReport 0xcf4 ++ ++/* ++ * 7. PageD(0xD00) ++ * */ ++#define rOFDM1_LSTF 0xd00 ++#define rOFDM1_TRxPathEnable 0xd04 ++ ++/* ++ * 8. PageE(0xE00) ++ * */ ++#define rTxAGC_A_Rate18_06 0xe00 ++#define rTxAGC_A_Rate54_24 0xe04 ++#define rTxAGC_A_CCK1_Mcs32 0xe08 ++#define rTxAGC_A_Mcs03_Mcs00 0xe10 ++#define rTxAGC_A_Mcs07_Mcs04 0xe14 ++#define rTxAGC_A_Mcs11_Mcs08 0xe18 ++#define rTxAGC_A_Mcs15_Mcs12 0xe1c ++ ++#define rTxAGC_B_Rate18_06 0x830 ++#define rTxAGC_B_Rate54_24 0x834 ++#define rTxAGC_B_CCK1_55_Mcs32 0x838 ++#define rTxAGC_B_Mcs03_Mcs00 0x83c ++#define rTxAGC_B_Mcs07_Mcs04 0x848 ++#define rTxAGC_B_Mcs11_Mcs08 0x84c ++#define rTxAGC_B_Mcs15_Mcs12 0x868 ++#define rTxAGC_B_CCK11_A_CCK2_11 0x86c ++ ++#define rFPGA0_IQK 0xe28 ++#define rTx_IQK_Tone_A 0xe30 ++#define rRx_IQK_Tone_A 0xe34 ++#define rTx_IQK_PI_A 0xe38 ++#define rRx_IQK_PI_A 0xe3c ++ ++#define rTx_IQK 0xe40 ++#define rRx_IQK 0xe44 ++#define rIQK_AGC_Pts 0xe48 ++#define rIQK_AGC_Rsp 0xe4c ++#define rTx_IQK_Tone_B 0xe50 ++#define rRx_IQK_Tone_B 0xe54 ++#define rTx_IQK_PI_B 0xe58 ++#define rRx_IQK_PI_B 0xe5c ++#define rIQK_AGC_Cont 0xe60 ++ ++#define rBlue_Tooth 0xe6c ++#define rRx_Wait_CCA 0xe70 ++#define rTx_CCK_RFON 0xe74 ++#define rTx_CCK_BBON 0xe78 ++#define rTx_OFDM_RFON 0xe7c ++#define rTx_OFDM_BBON 0xe80 ++#define rTx_To_Rx 0xe84 ++#define rTx_To_Tx 0xe88 ++#define rRx_CCK 0xe8c ++ ++#define rTx_Power_Before_IQK_A 0xe94 ++#define rTx_Power_After_IQK_A 0xe9c ++ ++#define rRx_Power_Before_IQK_A 0xea0 ++#define rRx_Power_Before_IQK_A_2 0xea4 ++#define rRx_Power_After_IQK_A 0xea8 ++#define rRx_Power_After_IQK_A_2 0xeac ++ ++#define rTx_Power_Before_IQK_B 0xeb4 ++#define rTx_Power_After_IQK_B 0xebc ++ ++#define rRx_Power_Before_IQK_B 0xec0 ++#define rRx_Power_Before_IQK_B_2 0xec4 ++#define rRx_Power_After_IQK_B 0xec8 ++#define rRx_Power_After_IQK_B_2 0xecc ++ ++#define rRx_OFDM 0xed0 ++#define rRx_Wait_RIFS 0xed4 ++#define rRx_TO_Rx 0xed8 ++#define rStandby 0xedc ++#define rSleep 0xee0 ++#define rPMPD_ANAEN 0xeec ++ ++ ++/* 2. Page8(0x800) */ ++#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ ++#define bJapanMode 0x2 ++#define bCCKTxSC 0x30 ++#define bCCKEn 0x1000000 ++#define bOFDMEn 0x2000000 ++#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ ++#define bXCTxAGC 0xf000 ++#define bXDTxAGC 0xf0000 ++ ++/* 4. PageA(0xA00) */ ++#define bCCKBBMode 0x3 /* Useless */ ++#define bCCKTxPowerSaving 0x80 ++#define bCCKRxPowerSaving 0x40 ++ ++#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ ++ ++#define bCCKScramble 0x8 /* Useless */ ++#define bCCKAntDiversity 0x8000 ++#define bCCKCarrierRecovery 0x4000 ++#define bCCKTxRate 0x3000 ++#define bCCKDCCancel 0x0800 ++#define bCCKISICancel 0x0400 ++#define bCCKMatchFilter 0x0200 ++#define bCCKEqualizer 0x0100 ++#define bCCKPreambleDetect 0x800000 ++#define bCCKFastFalseCCA 0x400000 ++#define bCCKChEstStart 0x300000 ++#define bCCKCCACount 0x080000 ++#define bCCKcs_lim 0x070000 ++#define bCCKBistMode 0x80000000 ++#define bCCKCCAMask 0x40000000 ++#define bCCKTxDACPhase 0x4 ++#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ ++#define bCCKr_cp_mode0 0x0100 ++#define bCCKTxDCOffset 0xf0 ++#define bCCKRxDCOffset 0xf ++#define bCCKCCAMode 0xc000 ++#define bCCKFalseCS_lim 0x3f00 ++#define bCCKCS_ratio 0xc00000 ++#define bCCKCorgBit_sel 0x300000 ++#define bCCKPD_lim 0x0f0000 ++#define bCCKNewCCA 0x80000000 ++#define bCCKRxHPofIG 0x8000 ++#define bCCKRxIG 0x7f00 ++#define bCCKLNAPolarity 0x800000 ++#define bCCKRx1stGain 0x7f0000 ++#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ ++#define bCCKRxAGCSatLevel 0x1f000000 ++#define bCCKRxAGCSatCount 0xe0 ++#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ ++#define bCCKFixedRxAGC 0x8000 ++/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ ++#define bCCKAntennaPolarity 0x2000 ++#define bCCKTxFilterType 0x0c00 ++#define bCCKRxAGCReportType 0x0300 ++#define bCCKRxDAGCEn 0x80000000 ++#define bCCKRxDAGCPeriod 0x20000000 ++#define bCCKRxDAGCSatLevel 0x1f000000 ++#define bCCKTimingRecovery 0x800000 ++#define bCCKTxC0 0x3f0000 ++#define bCCKTxC1 0x3f000000 ++#define bCCKTxC2 0x3f ++#define bCCKTxC3 0x3f00 ++#define bCCKTxC4 0x3f0000 ++#define bCCKTxC5 0x3f000000 ++#define bCCKTxC6 0x3f ++#define bCCKTxC7 0x3f00 ++#define bCCKDebugPort 0xff0000 ++#define bCCKDACDebug 0x0f000000 ++#define bCCKFalseAlarmEnable 0x8000 ++#define bCCKFalseAlarmRead 0x4000 ++#define bCCKTRSSI 0x7f ++#define bCCKRxAGCReport 0xfe ++#define bCCKRxReport_AntSel 0x80000000 ++#define bCCKRxReport_MFOff 0x40000000 ++#define bCCKRxRxReport_SQLoss 0x20000000 ++#define bCCKRxReport_Pktloss 0x10000000 ++#define bCCKRxReport_Lockedbit 0x08000000 ++#define bCCKRxReport_RateError 0x04000000 ++#define bCCKRxReport_RxRate 0x03000000 ++#define bCCKRxFACounterLower 0xff ++#define bCCKRxFACounterUpper 0xff000000 ++#define bCCKRxHPAGCStart 0xe000 ++#define bCCKRxHPAGCFinal 0x1c00 ++#define bCCKRxFalseAlarmEnable 0x8000 ++#define bCCKFACounterFreeze 0x4000 ++#define bCCKTxPathSel 0x10000000 ++#define bCCKDefaultRxPath 0xc000000 ++#define bCCKOptionRxPath 0x3000000 ++ ++#define RF_T_METER_88E 0x42 ++ ++/* 6. PageE(0xE00) */ ++#define bSTBCEn 0x4 /* Useless */ ++#define bAntennaMapping 0x10 ++#define bNss 0x20 ++#define bCFOAntSumD 0x200 ++#define bPHYCounterReset 0x8000000 ++#define bCFOReportGet 0x4000000 ++#define bOFDMContinueTx 0x10000000 ++#define bOFDMSingleCarrier 0x20000000 ++#define bOFDMSingleTone 0x40000000 ++ ++ ++/* ++ * Other Definition ++ * */ ++ ++#define bEnable 0x1 /* Useless */ ++#define bDisable 0x0 ++ ++/* byte endable for srwrite */ ++#define bByte0 0x1 /* Useless */ ++#define bByte1 0x2 ++#define bByte2 0x4 ++#define bByte3 0x8 ++#define bWord0 0x3 ++#define bWord1 0xc ++#define bDWord 0xf ++ ++/* for PutRegsetting & GetRegSetting BitMask */ ++#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ ++#define bMaskByte1 0xff00 ++#define bMaskByte2 0xff0000 ++#define bMaskByte3 0xff000000 ++#define bMaskHWord 0xffff0000 ++#define bMaskLWord 0x0000ffff ++#define bMaskDWord 0xffffffff ++#define bMaskH3Bytes 0xffffff00 ++#define bMask12Bits 0xfff ++#define bMaskH4Bits 0xf0000000 ++#define bMaskOFDM_D 0xffc00000 ++#define bMaskCCK 0x3f3f3f3f ++#define bMask7bits 0x7f ++#define bMaskByte2HighNibble 0x00f00000 ++#define bMaskByte3LowNibble 0x0f000000 ++#define bMaskL3Bytes 0x00ffffff ++ ++/*--------------------------Define Parameters-------------------------------*/ ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8814PwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8814PwrSeq.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8814PwrSeq.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8814PwrSeq.h 2018-02-11 21:44:27.165146360 +0200 +@@ -0,0 +1,236 @@ ++ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __HAL8814PWRSEQ_H__ ++#define __HAL8814PWRSEQ_H__ ++ ++#include "HalPwrSeqCmd.h" ++ ++/* ++ Check document WB-110628-DZ-RTL8195 (Jaguar) Power Architecture-R04.pdf ++ There are 6 HW Power States: ++ 0: POFF--Power Off ++ 1: PDN--Power Down ++ 2: CARDEMU--Card Emulation ++ 3: ACT--Active Mode ++ 4: LPS--Low Power State ++ 5: SUS--Suspend ++ ++ The transision from different states are defined below ++ TRANS_CARDEMU_TO_ACT ++ TRANS_ACT_TO_CARDEMU ++ TRANS_CARDEMU_TO_SUS ++ TRANS_SUS_TO_CARDEMU ++ TRANS_CARDEMU_TO_PDN ++ TRANS_ACT_TO_LPS ++ TRANS_LPS_TO_ACT ++ ++ TRANS_END ++*/ ++#define RTL8814A_TRANS_CARDEMU_TO_ACT_STEPS 16 ++#define RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS 20 ++#define RTL8814A_TRANS_CARDEMU_TO_SUS_STEPS 17 ++#define RTL8814A_TRANS_SUS_TO_CARDEMU_STEPS 15 ++#define RTL8814A_TRANS_CARDEMU_TO_PDN_STEPS 17 ++#define RTL8814A_TRANS_PDN_TO_CARDEMU_STEPS 16 ++#define RTL8814A_TRANS_ACT_TO_LPS_STEPS 20 ++#define RTL8814A_TRANS_LPS_TO_ACT_STEPS 15 ++#define RTL8814A_TRANS_END_STEPS 1 ++ ++ ++#define RTL8814A_TRANS_CARDEMU_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ ++ {0x002B, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /* ??0x28[24]=1, enable pll phase select*/ \ ++ {0x0015, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT3 | BIT2 | BIT1), (BIT3 | BIT2 | BIT1)},/* 0x14[11:9]=3'b111, OCP current threshold = 1.5A */ \ ++ {0x002D, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x0E, 0x08},/* 0x2C[11:9]=3'b100, select lpf R3 */ \ ++ {0x002D, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x70, 0x50},/* 0x2C[14:12]=3'b101, select lpf Rs*/ \ ++ {0x007B, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/* 0x78[30]=1'b1, SDM order select*/ \ ++ /*{0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0}, */ /* disable HWPDN 0x04[15]=0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0},/* disable WL suspend*/ \ ++ {0x00F0, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* */ \ ++ {0x0081, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x30, 0x20},/* */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ ++ ++#define RTL8814A_TRANS_ACT_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ ++ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ ++ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ ++ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US}, /*Delay 1us*/ \ ++ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ ++ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ ++ {0x0002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US}, /*Delay 1us*/ \ ++ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ ++ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*0x1F[7:0] = 0 turn off RF*/ \ ++ /*{0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},*/ /*0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x28}, /* 0x07[7:0] = 0x28 sps pwm mode 0x2a for BT coex*/ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x02, 0}, /*0x8[1] = 0 ANA clk = 500k */ \ ++ /*{0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 | BIT1, 0},*/ /* 0x02[1:0] = 0 reset BB */ \ ++ {0x0066, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0}, /*0x66[7]=0, disable ckreq for gpio7 output SUS */ \ ++ {0x0041, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x41[4]=0, disable sic for gpio7 output SUS */ \ ++ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /*0x42[1]=0, disable ckout for gpio7 output SUS */ \ ++ {0x004e, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5}, /*0x4E[5]=1, disable LED2 for gpio7 output SUS */ \ ++ {0x0041, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x41[0]=0, disable uart for gpio7 output SUS */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ ++ ++#define RTL8814A_TRANS_CARDEMU_TO_SUS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0061, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x0F, 0x0c},\ ++ {0x0061, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x0F, 0x0E},\ ++ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x0F, 0x07},/* gpio11 input mode, gpio10~8 output mode */ \ ++ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ ++ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ ++ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/* suspend option all off */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*0x14[13] = 1 turn on ZCD */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/* 0x14[14] =1 trun on ZCD */ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*0x8[1] = 0 ANA clk = 500k */ \ ++ {0x0091, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xA0, 0xA0}, /* 0x91[7]=1 0x91[5]=1 , disable sps, ldo sleep mode */ \ ++ {0x0070, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3}, /* 0x70[3]=1 enable mainbias polling */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 1 enable WL suspend */ ++ ++#define RTL8814A_TRANS_SUS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 0 enable WL suspend*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x10, 0},/*0x23[4] = 0 hpon LDO sleep mode leave */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, 0},/* 0x14[14] =0 trun off ZCD */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0},/*0x14[13] = 0 turn off ZCD */ \ ++ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ ++ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio11 input mode, gpio10~8 input mode */ ++ ++#define RTL8814A_TRANS_CARDEMU_TO_CARDDIS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ /**{0x0194, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, //0x194[0]=0 , disable 32K clock*/ \ ++ /**{0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x94}, //0x93 = 0x94 , 90[30] =0 enable 500k ANA clock .switch clock from 12M to 500K , 90 [26] =0 disable EEprom loader clock*/ \ ++ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0}, /*0x03[2] = 0, reset 3081*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x01}, /*0x80 = 05h if reload fw, fill the default value of host_CPU handshake field*/ \ ++ {0x0081, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x30}, /*0x80 = 05h if reload fw, fill the default value of host_CPU handshake field*/ \ ++ /*{0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xF0, 0xcc},*/ \ ++ /*{0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xF0, 0xEC},*/ \ ++ /*{0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x07},*/ /* gpio11 input mode, gpio10~8 output mode */ \ ++ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ ++ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ ++ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/* 0x15[6] =1 trun on ZCD output */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*0x15[5] = 1 turn on ZCD */ \ ++ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, 0},/*0x12[6] = 0 force PFM mode */ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*0x8[1] = 0 ANA clk = 500k */ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ ++ {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* 0x01f[1]=0 , disable RFC_0 control REG_RF_CTRL_8814A */ \ ++ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* 0x020[1]=0 , disable RFC_1 control REG_RF_CTRL_8814A */ \ ++ {0x0021, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* 0x021[1]=0 , disable RFC_2 control REG_RF_CTRL_8814A */ \ ++ {0x0076, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* 0x076[1]=0 , disable RFC_3 control REG_OPT_CTRL_8814A +2 */ \ ++ {0x0091, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xA0, 0xA0}, /* 0x91[7]=1 0x91[5]=1 , disable sps, ldo sleep mode */ \ ++ {0x0070, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3}, /* 0x70[3]=1 enable mainbias polling */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 1 enable WL suspend*/ ++ ++#define RTL8814A_TRANS_CARDDIS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/*0x12[6] = 1 force PWM mode */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0},/*0x15[5] = 0 turn off ZCD */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, 0},/* 0x15[6] =0 trun off ZCD output */ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0},/*0x23[4] = 0 hpon LDO leave sleep mode */ \ ++ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ ++ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00}, /* gpio11 input mode, gpio10~8 input mode */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0}, /*0x04[10] = 0, enable SW LPS PCIE only*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 0, enable WL suspend*/ \ ++ /*{0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2},*/ /*0x03[2] = 1, enable 3081*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ \ ++ {0x0071, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/*0x70[10] = 0, CPHY_MBIAS_EN disable*/ ++ ++ ++#define RTL8814A_TRANS_CARDEMU_TO_PDN \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ ++ ++#define RTL8814A_TRANS_PDN_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ ++ ++#define RTL8814A_TRANS_ACT_TO_LPS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x7F},/*Tx Pause*/ \ ++ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ ++ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ ++ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated, and RF closed*/ \ ++ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ ++ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated, and RF closed*/ \ ++ {0x0002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ ++ {0x05F1, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Respond TxOK to scheduler*/ ++ ++ ++#define RTL8814A_TRANS_LPS_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/ \ ++ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/ \ ++ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /* Delay*/ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/ \ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /* Polling 0x109[7]=0 TSF in 40M*/ \ ++ /*{0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, */ /*. ??0x29[7:6] = 2b'00 enable BB clock*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/ \ ++ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/ \ ++ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x1002[1:0] = 2b'11 enable BB macro*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ ++ ++#define RTL8814A_TRANS_END \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, ++ ++ ++extern WLAN_PWR_CFG rtl8814A_power_on_flow[RTL8814A_TRANS_CARDEMU_TO_ACT_STEPS + RTL8814A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8814A_radio_off_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8814A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8814A_card_disable_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8814A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8814A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8814A_card_enable_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8814A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8814A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8814A_suspend_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8814A_TRANS_CARDEMU_TO_SUS_STEPS + RTL8814A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8814A_resume_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8814A_TRANS_CARDEMU_TO_SUS_STEPS + RTL8814A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8814A_hwpdn_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8814A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8814A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8814A_enter_lps_flow[RTL8814A_TRANS_ACT_TO_LPS_STEPS + RTL8814A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8814A_leave_lps_flow[RTL8814A_TRANS_LPS_TO_ACT_STEPS + RTL8814A_TRANS_END_STEPS]; ++ ++#endif /* __HAL8814PWRSEQ_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8821APwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8821APwrSeq.h +--- linux-4.14.18/3rdparty/rtl8723de/include/Hal8821APwrSeq.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8821APwrSeq.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,186 @@ ++#ifndef REALTEK_POWER_SEQUENCE_8821 ++#define REALTEK_POWER_SEQUENCE_8821 ++ ++#include "HalPwrSeqCmd.h" ++ ++/* ++ Check document WM-20130516-JackieLau-RTL8821A_Power_Architecture-R10.vsd ++ There are 6 HW Power States: ++ 0: POFF--Power Off ++ 1: PDN--Power Down ++ 2: CARDEMU--Card Emulation ++ 3: ACT--Active Mode ++ 4: LPS--Low Power State ++ 5: SUS--Suspend ++ ++ The transision from different states are defined below ++ TRANS_CARDEMU_TO_ACT ++ TRANS_ACT_TO_CARDEMU ++ TRANS_CARDEMU_TO_SUS ++ TRANS_SUS_TO_CARDEMU ++ TRANS_CARDEMU_TO_PDN ++ TRANS_ACT_TO_LPS ++ TRANS_LPS_TO_ACT ++ ++ TRANS_END ++*/ ++#define RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS 25 ++#define RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS 15 ++#define RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS 15 ++#define RTL8821A_TRANS_SUS_TO_CARDEMU_STEPS 15 ++#define RTL8821A_TRANS_CARDDIS_TO_CARDEMU_STEPS 15 ++#define RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS 15 ++#define RTL8821A_TRANS_PDN_TO_CARDEMU_STEPS 15 ++#define RTL8821A_TRANS_ACT_TO_LPS_STEPS 15 ++#define RTL8821A_TRANS_LPS_TO_ACT_STEPS 15 ++#define RTL8821A_TRANS_END_STEPS 1 ++ ++ ++#define RTL8821A_TRANS_CARDEMU_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ ++ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ ++ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ ++ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3 | BIT2), 0},/* disable SW LPS 0x04[10]=0 and WLSUS_EN 0x04[12:11]=0*/ \ ++ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , BIT0},/* Disable USB suspend */ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ ++ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , 0},/* Enable USB suspend */ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3), 0},/* disable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ ++ {0x004F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*0x4C[24] = 0x4F[0] = 1, switch DPDT_SEL_P output from WL BB */\ ++ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT5 | BIT4), (BIT5 | BIT4)},/*0x66[13] = 0x67[5] = 1, switch for PAPE_G/PAPE_A from WL BB ; 0x66[12] = 0x67[4] = 1, switch LNAON from WL BB */\ ++ {0x0025, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, 0},/*anapar_mac<118> , 0x25[6]=0 by wlan single function*/\ ++ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable falling edge triggering interrupt*/\ ++ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable GPIO9 interrupt mode*/\ ++ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 input mode*/\ ++ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Enable HSISR GPIO[C:0] interrupt*/\ ++ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable HSISR GPIO9 interrupt*/\ ++ {0x007A, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x3A},/*0x7A = 0x3A start BT*/\ ++ {0x002E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF , 0x82 },/* 0x2C[23:12]=0x820 ; XTAL trim */ \ ++ {0x0010, PWR_CUT_A_MSK , PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 , BIT6 },/* 0x10[6]=1 ; MPsW0x2CvA0x10[6]]1~WLAN */ \ ++ ++ ++#define RTL8821A_TRANS_ACT_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ ++ {0x004F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*0x4C[24] = 0x4F[0] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ ++ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable rising edge triggering interrupt*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ ++ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ ++ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/ \ ++ ++ ++#define RTL8821A_TRANS_CARDEMU_TO_SUS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4 | BIT3, (BIT4 | BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ ++ ++#define RTL8821A_TRANS_SUS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ ++ ++#define RTL8821A_TRANS_CARDEMU_TO_CARDDIS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ ++ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ ++ ++#define RTL8821A_TRANS_CARDDIS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ ++ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ ++ ++ ++#define RTL8821A_TRANS_CARDEMU_TO_PDN \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK | PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ ++ ++#define RTL8821A_TRANS_PDN_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ ++ ++#define RTL8821A_TRANS_ACT_TO_LPS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ ++ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ ++ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ ++ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ ++ ++ ++#define RTL8821A_TRANS_LPS_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ ++ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ ++ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ ++ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ ++ ++#define RTL8821A_TRANS_END \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, ++ ++ ++ extern WLAN_PWR_CFG rtl8821A_power_on_flow[RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS + RTL8821A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8821A_radio_off_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8821A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8821A_card_disable_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8821A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8821A_card_enable_flow[RTL8821A_TRANS_CARDDIS_TO_CARDEMU_STEPS + RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS + RTL8821A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8821A_suspend_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS + RTL8821A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8821A_resume_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS + RTL8821A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8821A_hwpdn_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8821A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8821A_enter_lps_flow[RTL8821A_TRANS_ACT_TO_LPS_STEPS + RTL8821A_TRANS_END_STEPS]; ++ extern WLAN_PWR_CFG rtl8821A_leave_lps_flow[RTL8821A_TRANS_LPS_TO_ACT_STEPS + RTL8821A_TRANS_END_STEPS]; ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_btcoex.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_btcoex.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_btcoex.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_btcoex.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,94 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_BTCOEX_H__ ++#define __HAL_BTCOEX_H__ ++ ++#include ++ ++/* Some variables can't get from outsrc BT-Coex, ++ * so we need to save here */ ++typedef struct _BT_COEXIST { ++ u8 bBtExist; ++ u8 btTotalAntNum; ++ u8 btChipType; ++ u8 bInitlized; ++ u8 btAntisolation; ++} BT_COEXIST, *PBT_COEXIST; ++ ++void DBG_BT_INFO(u8 *dbgmsg); ++ ++void hal_btcoex_SetBTCoexist(PADAPTER padapter, u8 bBtExist); ++u8 hal_btcoex_IsBtExist(PADAPTER padapter); ++u8 hal_btcoex_IsBtDisabled(PADAPTER); ++void hal_btcoex_SetChipType(PADAPTER padapter, u8 chipType); ++void hal_btcoex_SetPgAntNum(PADAPTER padapter, u8 antNum); ++ ++u8 hal_btcoex_Initialize(PADAPTER padapter); ++void hal_btcoex_PowerOnSetting(PADAPTER padapter); ++void hal_btcoex_PowerOffSetting(PADAPTER padapter); ++void hal_btcoex_PreLoadFirmware(PADAPTER padapter); ++void hal_btcoex_InitHwConfig(PADAPTER padapter, u8 bWifiOnly); ++ ++void hal_btcoex_IpsNotify(PADAPTER padapter, u8 type); ++void hal_btcoex_LpsNotify(PADAPTER padapter, u8 type); ++void hal_btcoex_ScanNotify(PADAPTER padapter, u8 type); ++void hal_btcoex_ConnectNotify(PADAPTER padapter, u8 action); ++void hal_btcoex_MediaStatusNotify(PADAPTER padapter, u8 mediaStatus); ++void hal_btcoex_SpecialPacketNotify(PADAPTER padapter, u8 pktType); ++void hal_btcoex_IQKNotify(PADAPTER padapter, u8 state); ++void hal_btcoex_BtInfoNotify(PADAPTER padapter, u8 length, u8 *tmpBuf); ++void hal_btcoex_BtMpRptNotify(PADAPTER padapter, u8 length, u8 *tmpBuf); ++void hal_btcoex_SuspendNotify(PADAPTER padapter, u8 state); ++void hal_btcoex_HaltNotify(PADAPTER padapter, u8 do_halt); ++void hal_btcoex_SwitchBtTRxMask(PADAPTER padapter); ++ ++void hal_btcoex_Hanlder(PADAPTER padapter); ++ ++s32 hal_btcoex_IsBTCoexRejectAMPDU(PADAPTER padapter); ++s32 hal_btcoex_IsBTCoexCtrlAMPDUSize(PADAPTER padapter); ++u32 hal_btcoex_GetAMPDUSize(PADAPTER padapter); ++void hal_btcoex_SetManualControl(PADAPTER padapter, u8 bmanual); ++u8 hal_btcoex_1Ant(PADAPTER padapter); ++u8 hal_btcoex_IsBtControlLps(PADAPTER); ++u8 hal_btcoex_IsLpsOn(PADAPTER); ++u8 hal_btcoex_RpwmVal(PADAPTER); ++u8 hal_btcoex_LpsVal(PADAPTER); ++u32 hal_btcoex_GetRaMask(PADAPTER); ++void hal_btcoex_RecordPwrMode(PADAPTER padapter, u8 *pCmdBuf, u8 cmdLen); ++void hal_btcoex_DisplayBtCoexInfo(PADAPTER, u8 *pbuf, u32 bufsize); ++void hal_btcoex_SetDBG(PADAPTER, u32 *pDbgModule); ++u32 hal_btcoex_GetDBG(PADAPTER, u8 *pStrBuf, u32 bufSize); ++u8 hal_btcoex_IncreaseScanDeviceNum(PADAPTER); ++u8 hal_btcoex_IsBtLinkExist(PADAPTER); ++void hal_btcoex_SetBtPatchVersion(PADAPTER, u16 btHciVer, u16 btPatchVer); ++void hal_btcoex_SetHciVersion(PADAPTER, u16 hciVersion); ++void hal_btcoex_SendScanNotify(PADAPTER, u8 type); ++void hal_btcoex_StackUpdateProfileInfo(void); ++void hal_btcoex_BTOffOnNotify(PADAPTER padapter, u8 bBTON); ++void hal_btcoex_SetAntIsolationType(PADAPTER padapter, u8 anttype); ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ int hal_btcoex_AntIsolationConfig_ParaFile(IN PADAPTER Adapter, IN char *pFileName); ++ int hal_btcoex_ParseAntIsolationConfigFile(PADAPTER Adapter, char *buffer); ++#endif /* CONFIG_LOAD_PHY_PARA_FROM_FILE */ ++u16 hal_btcoex_btreg_read(PADAPTER padapter, u8 type, u16 addr, u32 *data); ++u16 hal_btcoex_btreg_write(PADAPTER padapter, u8 type, u16 addr, u16 val); ++void hal_btcoex_set_rfe_type(u8 type); ++void hal_btcoex_switchband_notify(u8 under_scan, u8 band_type); ++#endif /* !__HAL_BTCOEX_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_com.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_com.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,639 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_COMMON_H__ ++#define __HAL_COMMON_H__ ++ ++#include "HalVerDef.h" ++#include "hal_pg.h" ++#include "hal_phy.h" ++#include "hal_phy_reg.h" ++#include "hal_com_reg.h" ++#include "hal_com_phycfg.h" ++#include "../hal/hal_com_c2h.h" ++ ++/*------------------------------ Tx Desc definition Macro ------------------------*/ ++/* #pragma mark -- Tx Desc related definition. -- */ ++/* ---------------------------------------------------------------------------- ++ * ----------------------------------------------------------- ++ * Rate ++ * ----------------------------------------------------------- ++ * CCK Rates, TxHT = 0 */ ++#define DESC_RATE1M 0x00 ++#define DESC_RATE2M 0x01 ++#define DESC_RATE5_5M 0x02 ++#define DESC_RATE11M 0x03 ++ ++/* OFDM Rates, TxHT = 0 */ ++#define DESC_RATE6M 0x04 ++#define DESC_RATE9M 0x05 ++#define DESC_RATE12M 0x06 ++#define DESC_RATE18M 0x07 ++#define DESC_RATE24M 0x08 ++#define DESC_RATE36M 0x09 ++#define DESC_RATE48M 0x0a ++#define DESC_RATE54M 0x0b ++ ++/* MCS Rates, TxHT = 1 */ ++#define DESC_RATEMCS0 0x0c ++#define DESC_RATEMCS1 0x0d ++#define DESC_RATEMCS2 0x0e ++#define DESC_RATEMCS3 0x0f ++#define DESC_RATEMCS4 0x10 ++#define DESC_RATEMCS5 0x11 ++#define DESC_RATEMCS6 0x12 ++#define DESC_RATEMCS7 0x13 ++#define DESC_RATEMCS8 0x14 ++#define DESC_RATEMCS9 0x15 ++#define DESC_RATEMCS10 0x16 ++#define DESC_RATEMCS11 0x17 ++#define DESC_RATEMCS12 0x18 ++#define DESC_RATEMCS13 0x19 ++#define DESC_RATEMCS14 0x1a ++#define DESC_RATEMCS15 0x1b ++#define DESC_RATEMCS16 0x1C ++#define DESC_RATEMCS17 0x1D ++#define DESC_RATEMCS18 0x1E ++#define DESC_RATEMCS19 0x1F ++#define DESC_RATEMCS20 0x20 ++#define DESC_RATEMCS21 0x21 ++#define DESC_RATEMCS22 0x22 ++#define DESC_RATEMCS23 0x23 ++#define DESC_RATEMCS24 0x24 ++#define DESC_RATEMCS25 0x25 ++#define DESC_RATEMCS26 0x26 ++#define DESC_RATEMCS27 0x27 ++#define DESC_RATEMCS28 0x28 ++#define DESC_RATEMCS29 0x29 ++#define DESC_RATEMCS30 0x2A ++#define DESC_RATEMCS31 0x2B ++#define DESC_RATEVHTSS1MCS0 0x2C ++#define DESC_RATEVHTSS1MCS1 0x2D ++#define DESC_RATEVHTSS1MCS2 0x2E ++#define DESC_RATEVHTSS1MCS3 0x2F ++#define DESC_RATEVHTSS1MCS4 0x30 ++#define DESC_RATEVHTSS1MCS5 0x31 ++#define DESC_RATEVHTSS1MCS6 0x32 ++#define DESC_RATEVHTSS1MCS7 0x33 ++#define DESC_RATEVHTSS1MCS8 0x34 ++#define DESC_RATEVHTSS1MCS9 0x35 ++#define DESC_RATEVHTSS2MCS0 0x36 ++#define DESC_RATEVHTSS2MCS1 0x37 ++#define DESC_RATEVHTSS2MCS2 0x38 ++#define DESC_RATEVHTSS2MCS3 0x39 ++#define DESC_RATEVHTSS2MCS4 0x3A ++#define DESC_RATEVHTSS2MCS5 0x3B ++#define DESC_RATEVHTSS2MCS6 0x3C ++#define DESC_RATEVHTSS2MCS7 0x3D ++#define DESC_RATEVHTSS2MCS8 0x3E ++#define DESC_RATEVHTSS2MCS9 0x3F ++#define DESC_RATEVHTSS3MCS0 0x40 ++#define DESC_RATEVHTSS3MCS1 0x41 ++#define DESC_RATEVHTSS3MCS2 0x42 ++#define DESC_RATEVHTSS3MCS3 0x43 ++#define DESC_RATEVHTSS3MCS4 0x44 ++#define DESC_RATEVHTSS3MCS5 0x45 ++#define DESC_RATEVHTSS3MCS6 0x46 ++#define DESC_RATEVHTSS3MCS7 0x47 ++#define DESC_RATEVHTSS3MCS8 0x48 ++#define DESC_RATEVHTSS3MCS9 0x49 ++#define DESC_RATEVHTSS4MCS0 0x4A ++#define DESC_RATEVHTSS4MCS1 0x4B ++#define DESC_RATEVHTSS4MCS2 0x4C ++#define DESC_RATEVHTSS4MCS3 0x4D ++#define DESC_RATEVHTSS4MCS4 0x4E ++#define DESC_RATEVHTSS4MCS5 0x4F ++#define DESC_RATEVHTSS4MCS6 0x50 ++#define DESC_RATEVHTSS4MCS7 0x51 ++#define DESC_RATEVHTSS4MCS8 0x52 ++#define DESC_RATEVHTSS4MCS9 0x53 ++ ++#define HDATA_RATE(rate)\ ++ (rate == DESC_RATE1M) ? "CCK_1M" :\ ++ (rate == DESC_RATE2M) ? "CCK_2M" :\ ++ (rate == DESC_RATE5_5M) ? "CCK5_5M" :\ ++ (rate == DESC_RATE11M) ? "CCK_11M" :\ ++ (rate == DESC_RATE6M) ? "OFDM_6M" :\ ++ (rate == DESC_RATE9M) ? "OFDM_9M" :\ ++ (rate == DESC_RATE12M) ? "OFDM_12M" :\ ++ (rate == DESC_RATE18M) ? "OFDM_18M" :\ ++ (rate == DESC_RATE24M) ? "OFDM_24M" :\ ++ (rate == DESC_RATE36M) ? "OFDM_36M" :\ ++ (rate == DESC_RATE48M) ? "OFDM_48M" :\ ++ (rate == DESC_RATE54M) ? "OFDM_54M" :\ ++ (rate == DESC_RATEMCS0) ? "MCS0" :\ ++ (rate == DESC_RATEMCS1) ? "MCS1" :\ ++ (rate == DESC_RATEMCS2) ? "MCS2" :\ ++ (rate == DESC_RATEMCS3) ? "MCS3" :\ ++ (rate == DESC_RATEMCS4) ? "MCS4" :\ ++ (rate == DESC_RATEMCS5) ? "MCS5" :\ ++ (rate == DESC_RATEMCS6) ? "MCS6" :\ ++ (rate == DESC_RATEMCS7) ? "MCS7" :\ ++ (rate == DESC_RATEMCS8) ? "MCS8" :\ ++ (rate == DESC_RATEMCS9) ? "MCS9" :\ ++ (rate == DESC_RATEMCS10) ? "MCS10" :\ ++ (rate == DESC_RATEMCS11) ? "MCS11" :\ ++ (rate == DESC_RATEMCS12) ? "MCS12" :\ ++ (rate == DESC_RATEMCS13) ? "MCS13" :\ ++ (rate == DESC_RATEMCS14) ? "MCS14" :\ ++ (rate == DESC_RATEMCS15) ? "MCS15" :\ ++ (rate == DESC_RATEMCS16) ? "MCS16" :\ ++ (rate == DESC_RATEMCS17) ? "MCS17" :\ ++ (rate == DESC_RATEMCS18) ? "MCS18" :\ ++ (rate == DESC_RATEMCS19) ? "MCS19" :\ ++ (rate == DESC_RATEMCS20) ? "MCS20" :\ ++ (rate == DESC_RATEMCS21) ? "MCS21" :\ ++ (rate == DESC_RATEMCS22) ? "MCS22" :\ ++ (rate == DESC_RATEMCS23) ? "MCS23" :\ ++ (rate == DESC_RATEVHTSS1MCS0) ? "VHTSS1MCS0" :\ ++ (rate == DESC_RATEVHTSS1MCS1) ? "VHTSS1MCS1" :\ ++ (rate == DESC_RATEVHTSS1MCS2) ? "VHTSS1MCS2" :\ ++ (rate == DESC_RATEVHTSS1MCS3) ? "VHTSS1MCS3" :\ ++ (rate == DESC_RATEVHTSS1MCS4) ? "VHTSS1MCS4" :\ ++ (rate == DESC_RATEVHTSS1MCS5) ? "VHTSS1MCS5" :\ ++ (rate == DESC_RATEVHTSS1MCS6) ? "VHTSS1MCS6" :\ ++ (rate == DESC_RATEVHTSS1MCS7) ? "VHTSS1MCS7" :\ ++ (rate == DESC_RATEVHTSS1MCS8) ? "VHTSS1MCS8" :\ ++ (rate == DESC_RATEVHTSS1MCS9) ? "VHTSS1MCS9" :\ ++ (rate == DESC_RATEVHTSS2MCS0) ? "VHTSS2MCS0" :\ ++ (rate == DESC_RATEVHTSS2MCS1) ? "VHTSS2MCS1" :\ ++ (rate == DESC_RATEVHTSS2MCS2) ? "VHTSS2MCS2" :\ ++ (rate == DESC_RATEVHTSS2MCS3) ? "VHTSS2MCS3" :\ ++ (rate == DESC_RATEVHTSS2MCS4) ? "VHTSS2MCS4" :\ ++ (rate == DESC_RATEVHTSS2MCS5) ? "VHTSS2MCS5" :\ ++ (rate == DESC_RATEVHTSS2MCS6) ? "VHTSS2MCS6" :\ ++ (rate == DESC_RATEVHTSS2MCS7) ? "VHTSS2MCS7" :\ ++ (rate == DESC_RATEVHTSS2MCS8) ? "VHTSS2MCS8" :\ ++ (rate == DESC_RATEVHTSS2MCS9) ? "VHTSS2MCS9" :\ ++ (rate == DESC_RATEVHTSS3MCS0) ? "VHTSS3MCS0" :\ ++ (rate == DESC_RATEVHTSS3MCS1) ? "VHTSS3MCS1" :\ ++ (rate == DESC_RATEVHTSS3MCS2) ? "VHTSS3MCS2" :\ ++ (rate == DESC_RATEVHTSS3MCS3) ? "VHTSS3MCS3" :\ ++ (rate == DESC_RATEVHTSS3MCS4) ? "VHTSS3MCS4" :\ ++ (rate == DESC_RATEVHTSS3MCS5) ? "VHTSS3MCS5" :\ ++ (rate == DESC_RATEVHTSS3MCS6) ? "VHTSS3MCS6" :\ ++ (rate == DESC_RATEVHTSS3MCS7) ? "VHTSS3MCS7" :\ ++ (rate == DESC_RATEVHTSS3MCS8) ? "VHTSS3MCS8" :\ ++ (rate == DESC_RATEVHTSS3MCS9) ? "VHTSS3MCS9" : "UNKNOWN" ++ ++enum { ++ UP_LINK, ++ DOWN_LINK, ++}; ++typedef enum _RT_MEDIA_STATUS { ++ RT_MEDIA_DISCONNECT = 0, ++ RT_MEDIA_CONNECT = 1 ++} RT_MEDIA_STATUS; ++ ++#define MAX_DLFW_PAGE_SIZE 4096 /* @ page : 4k bytes */ ++typedef enum _FIRMWARE_SOURCE { ++ FW_SOURCE_IMG_FILE = 0, ++ FW_SOURCE_HEADER_FILE = 1, /* from header file */ ++} FIRMWARE_SOURCE, *PFIRMWARE_SOURCE; ++ ++typedef enum _CH_SW_USE_CASE { ++ CH_SW_USE_CASE_TDLS = 0, ++ CH_SW_USE_CASE_MCC = 1 ++} CH_SW_USE_CASE; ++ ++typedef enum _WAKEUP_REASON{ ++ RX_PAIRWISEKEY = 0x01, ++ RX_GTK = 0x02, ++ RX_FOURWAY_HANDSHAKE = 0x03, ++ RX_DISASSOC = 0x04, ++ RX_DEAUTH = 0x08, ++ RX_ARP_REQUEST = 0x09, ++ FW_DECISION_DISCONNECT = 0x10, ++ RX_MAGIC_PKT = 0x21, ++ RX_UNICAST_PKT = 0x22, ++ RX_PATTERN_PKT = 0x23, ++ RTD3_SSID_MATCH = 0x24, ++ RX_REALWOW_V2_WAKEUP_PKT = 0x30, ++ RX_REALWOW_V2_ACK_LOST = 0x31, ++ ENABLE_FAIL_DMA_IDLE = 0x40, ++ ENABLE_FAIL_DMA_PAUSE = 0x41, ++ RTIME_FAIL_DMA_IDLE = 0x42, ++ RTIME_FAIL_DMA_PAUSE = 0x43, ++ RX_PNO = 0x55, ++ AP_OFFLOAD_WAKEUP = 0x66, ++ CLK_32K_UNLOCK = 0xFD, ++ CLK_32K_LOCK = 0xFE ++}WAKEUP_REASON; ++ ++/* ++ * Queue Select Value in TxDesc ++ * */ ++#define QSLT_BK 0x2/* 0x01 */ ++#define QSLT_BE 0x0 ++#define QSLT_VI 0x5/* 0x4 */ ++#define QSLT_VO 0x7/* 0x6 */ ++#define QSLT_BEACON 0x10 ++#define QSLT_HIGH 0x11 ++#define QSLT_MGNT 0x12 ++#define QSLT_CMD 0x13 ++ ++/* BK, BE, VI, VO, HCCA, MANAGEMENT, COMMAND, HIGH, BEACON. ++ * #define MAX_TX_QUEUE 9 */ ++ ++#define TX_SELE_HQ BIT(0) /* High Queue */ ++#define TX_SELE_LQ BIT(1) /* Low Queue */ ++#define TX_SELE_NQ BIT(2) /* Normal Queue */ ++#define TX_SELE_EQ BIT(3) /* Extern Queue */ ++ ++#define PageNum_128(_Len) (u32)(((_Len)>>7) + ((_Len) & 0x7F ? 1 : 0)) ++#define PageNum_256(_Len) (u32)(((_Len)>>8) + ((_Len) & 0xFF ? 1 : 0)) ++#define PageNum_512(_Len) (u32)(((_Len)>>9) + ((_Len) & 0x1FF ? 1 : 0)) ++#define PageNum(_Len, _Size) (u32)(((_Len)/(_Size)) + ((_Len)&((_Size) - 1) ? 1 : 0)) ++ ++struct dbg_rx_counter { ++ u32 rx_pkt_ok; ++ u32 rx_pkt_crc_error; ++ u32 rx_pkt_drop; ++ u32 rx_ofdm_fa; ++ u32 rx_cck_fa; ++ u32 rx_ht_fa; ++}; ++ ++#ifdef CONFIG_MBSSID_CAM ++ #define DBG_MBID_CAM_DUMP ++ ++ void rtw_mbid_cam_init(struct dvobj_priv *dvobj); ++ void rtw_mbid_cam_deinit(struct dvobj_priv *dvobj); ++ void rtw_mbid_cam_reset(_adapter *adapter); ++ u8 rtw_get_max_mbid_cam_id(_adapter *adapter); ++ u8 rtw_get_mbid_cam_entry_num(_adapter *adapter); ++ int rtw_mbid_cam_cache_dump(void *sel, const char *fun_name , _adapter *adapter); ++ int rtw_mbid_cam_dump(void *sel, const char *fun_name, _adapter *adapter); ++ void rtw_mbid_cam_restore(_adapter *adapter); ++#endif ++ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ void rtw_hal_set_macaddr_mbid(_adapter *adapter, u8 *mac_addr); ++ void rtw_hal_change_macaddr_mbid(_adapter *adapter, u8 *mac_addr); ++#endif ++ ++void rtw_dump_mac_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_counter); ++void rtw_dump_phy_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_counter); ++void rtw_reset_mac_rx_counters(_adapter *padapter); ++void rtw_reset_phy_rx_counters(_adapter *padapter); ++void rtw_reset_phy_trx_ok_counters(_adapter *padapter); ++ ++#ifdef DBG_RX_COUNTER_DUMP ++ #define DUMP_DRV_RX_COUNTER BIT0 ++ #define DUMP_MAC_RX_COUNTER BIT1 ++ #define DUMP_PHY_RX_COUNTER BIT2 ++ #define DUMP_DRV_TRX_COUNTER_DATA BIT3 ++ ++ void rtw_dump_phy_rxcnts_preprocess(_adapter *padapter, u8 rx_cnt_mode); ++ void rtw_dump_rx_counters(_adapter *padapter); ++#endif ++ ++void dump_chip_info(HAL_VERSION ChipVersion); ++void rtw_hal_config_rftype(PADAPTER padapter); ++ ++#define BAND_CAP_2G BIT0 ++#define BAND_CAP_5G BIT1 ++#define BAND_CAP_BIT_NUM 2 ++ ++#define BW_CAP_5M BIT0 ++#define BW_CAP_10M BIT1 ++#define BW_CAP_20M BIT2 ++#define BW_CAP_40M BIT3 ++#define BW_CAP_80M BIT4 ++#define BW_CAP_160M BIT5 ++#define BW_CAP_80_80M BIT6 ++#define BW_CAP_BIT_NUM 7 ++ ++#define PROTO_CAP_11B BIT0 ++#define PROTO_CAP_11G BIT1 ++#define PROTO_CAP_11N BIT2 ++#define PROTO_CAP_11AC BIT3 ++#define PROTO_CAP_BIT_NUM 4 ++ ++#define WL_FUNC_P2P BIT0 ++#define WL_FUNC_MIRACAST BIT1 ++#define WL_FUNC_TDLS BIT2 ++#define WL_FUNC_FTM BIT3 ++#define WL_FUNC_BIT_NUM 4 ++ ++int hal_spec_init(_adapter *adapter); ++void dump_hal_spec(void *sel, _adapter *adapter); ++ ++bool hal_chk_band_cap(_adapter *adapter, u8 cap); ++bool hal_chk_bw_cap(_adapter *adapter, u8 cap); ++bool hal_chk_proto_cap(_adapter *adapter, u8 cap); ++bool hal_is_band_support(_adapter *adapter, u8 band); ++bool hal_is_bw_support(_adapter *adapter, u8 bw); ++bool hal_is_wireless_mode_support(_adapter *adapter, u8 mode); ++u8 hal_largest_bw(_adapter *adapter, u8 in_bw); ++ ++bool hal_chk_wl_func(_adapter *adapter, u8 func); ++ ++u8 hal_com_config_channel_plan( ++ IN PADAPTER padapter, ++ IN char *hw_alpha2, ++ IN u8 hw_chplan, ++ IN char *sw_alpha2, ++ IN u8 sw_chplan, ++ IN u8 def_chplan, ++ IN BOOLEAN AutoLoadFail ++); ++ ++int hal_config_macaddr(_adapter *adapter, bool autoload_fail); ++ ++BOOLEAN ++HAL_IsLegalChannel( ++ IN PADAPTER Adapter, ++ IN u32 Channel ++); ++ ++u8 MRateToHwRate(u8 rate); ++ ++u8 HwRateToMRate(u8 rate); ++ ++void HalSetBrateCfg( ++ IN PADAPTER Adapter, ++ IN u8 *mBratesOS, ++ OUT u16 *pBrateCfg); ++ ++BOOLEAN ++Hal_MappingOutPipe( ++ IN PADAPTER pAdapter, ++ IN u8 NumOutPipe ++); ++ ++ ++void rtw_restore_mac_addr(_adapter *adapter);/*set mac addr when hal_init for all iface*/ ++void rtw_hal_dump_macaddr(void *sel, _adapter *adapter); ++ ++void rtw_init_hal_com_default_value(PADAPTER Adapter); ++ ++#ifdef CONFIG_FW_C2H_REG ++void c2h_evt_clear(_adapter *adapter); ++s32 c2h_evt_read_88xx(_adapter *adapter, u8 *buf); ++#endif ++ ++#ifdef CONFIG_FW_C2H_PKT ++void rtw_hal_c2h_pkt_pre_hdl(_adapter *adapter, u8 *buf, u16 len); ++void rtw_hal_c2h_pkt_hdl(_adapter *adapter, u8 *buf, u16 len); ++#endif ++ ++u8 rtw_hal_networktype_to_raid(_adapter *adapter, struct sta_info *psta); ++u8 rtw_get_mgntframe_raid(_adapter *adapter, unsigned char network_type); ++void rtw_hal_update_sta_rate_mask(PADAPTER padapter, struct sta_info *psta); ++ ++/* access HW only */ ++u32 rtw_sec_read_cam(_adapter *adapter, u8 addr); ++void rtw_sec_write_cam(_adapter *adapter, u8 addr, u32 wdata); ++void rtw_sec_read_cam_ent(_adapter *adapter, u8 id, u8 *ctrl, u8 *mac, u8 *key); ++void rtw_sec_write_cam_ent(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key); ++void rtw_sec_clr_cam_ent(_adapter *adapter, u8 id); ++bool rtw_sec_read_cam_is_gk(_adapter *adapter, u8 id); ++ ++void rtw_hal_set_msr(_adapter *adapter, u8 net_type); ++void rtw_hal_set_macaddr_port(_adapter *adapter, u8 *val); ++void rtw_hal_get_macaddr_port(_adapter *adapter, u8 *mac_addr); ++ ++void rtw_hal_set_bssid(_adapter *adapter, u8 *val); ++ ++void hw_var_port_switch(_adapter *adapter); ++ ++void SetHwReg(PADAPTER padapter, u8 variable, u8 *val); ++void GetHwReg(PADAPTER padapter, u8 variable, u8 *val); ++void rtw_hal_check_rxfifo_full(_adapter *adapter); ++ ++u8 SetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value); ++u8 GetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value); ++ ++BOOLEAN ++eqNByte( ++ u8 *str1, ++ u8 *str2, ++ u32 num ++); ++ ++u32 ++MapCharToHexDigit( ++ IN char chTmp ++); ++ ++BOOLEAN ++GetHexValueFromString( ++ IN char *szStr, ++ IN OUT u32 *pu4bVal, ++ IN OUT u32 *pu4bMove ++); ++ ++BOOLEAN ++GetFractionValueFromString( ++ IN char *szStr, ++ IN OUT u8 *pInteger, ++ IN OUT u8 *pFraction, ++ IN OUT u32 *pu4bMove ++); ++ ++BOOLEAN ++IsCommentString( ++ IN char *szStr ++); ++ ++BOOLEAN ++ParseQualifiedString( ++ IN char *In, ++ IN OUT u32 *Start, ++ OUT char *Out, ++ IN char LeftQualifier, ++ IN char RightQualifier ++); ++ ++BOOLEAN ++GetU1ByteIntegerFromStringInDecimal( ++ IN char *Str, ++ IN OUT u8 *pInt ++); ++ ++BOOLEAN ++isAllSpaceOrTab( ++ u8 *data, ++ u8 size ++); ++ ++void linked_info_dump(_adapter *padapter, u8 benable); ++#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA ++ void rtw_get_raw_rssi_info(void *sel, _adapter *padapter); ++ void rtw_dump_raw_rssi_info(_adapter *padapter, void *sel); ++#endif ++ ++#ifdef DBG_RX_DFRAME_RAW_DATA ++ void rtw_dump_rx_dframe_info(_adapter *padapter, void *sel); ++#endif ++void rtw_store_phy_info(_adapter *padapter, union recv_frame *prframe); ++#define HWSET_MAX_SIZE 1024 ++#ifdef CONFIG_EFUSE_CONFIG_FILE ++ #define EFUSE_FILE_COLUMN_NUM 16 ++ u32 Hal_readPGDataFromConfigFile(PADAPTER padapter); ++ u32 Hal_ReadMACAddrFromFile(PADAPTER padapter, u8 *mac_addr); ++#endif /* CONFIG_EFUSE_CONFIG_FILE */ ++ ++int check_phy_efuse_tx_power_info_valid(PADAPTER padapter); ++int hal_efuse_macaddr_offset(_adapter *adapter); ++int Hal_GetPhyEfuseMACAddr(PADAPTER padapter, u8 *mac_addr); ++void rtw_dump_cur_efuse(PADAPTER padapter); ++ ++#ifdef CONFIG_RF_POWER_TRIM ++ void rtw_bb_rf_gain_offset(_adapter *padapter); ++#endif /*CONFIG_RF_POWER_TRIM*/ ++ ++void dm_DynamicUsbTxAgg(_adapter *padapter, u8 from_timer); ++u8 rtw_hal_busagg_qsel_check(_adapter *padapter, u8 pre_qsel, u8 next_qsel); ++void GetHalODMVar( ++ PADAPTER Adapter, ++ HAL_ODM_VARIABLE eVariable, ++ PVOID pValue1, ++ PVOID pValue2); ++void SetHalODMVar( ++ PADAPTER Adapter, ++ HAL_ODM_VARIABLE eVariable, ++ PVOID pValue1, ++ BOOLEAN bSet); ++ ++#ifdef CONFIG_BACKGROUND_NOISE_MONITOR ++struct noise_info { ++ u8 bPauseDIG; ++ u8 IGIValue; ++ u32 max_time;/* ms */ ++ u8 chan; ++}; ++#endif ++ ++void rtw_get_noise(_adapter *padapter); ++u8 rtw_get_current_tx_rate(_adapter *padapter, u8 macid); ++u8 rtw_get_current_tx_sgi(_adapter *padapter, u8 macid); ++void rtw_hal_construct_NullFunctionData(PADAPTER, u8 *pframe, u32 *pLength, u8 *StaAddr, u8 bQoS, u8 AC, u8 bEosp, u8 bForcePowerSave); ++ ++void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished); ++ ++#ifdef CONFIG_TDLS ++ #ifdef CONFIG_TDLS_CH_SW ++ s32 rtw_hal_ch_sw_oper_offload(_adapter *padapter, u8 channel, u8 channel_offset, u16 bwmode); ++ #endif ++#endif ++ ++#ifdef CONFIG_GPIO_API ++ u8 rtw_hal_get_gpio(_adapter *adapter, u8 gpio_num); ++ int rtw_hal_set_gpio_output_value(_adapter *adapter, u8 gpio_num, bool isHigh); ++ int rtw_hal_config_gpio(_adapter *adapter, u8 gpio_num, bool isOutput); ++ int rtw_hal_register_gpio_interrupt(_adapter *adapter, int gpio_num, void(*callback)(u8 level)); ++ int rtw_hal_disable_gpio_interrupt(_adapter *adapter, int gpio_num); ++#endif ++ ++s8 rtw_hal_ch_sw_iqk_info_search(_adapter *padapter, u8 central_chnl, u8 bw_mode); ++void rtw_hal_ch_sw_iqk_info_backup(_adapter *adapter); ++void rtw_hal_ch_sw_iqk_info_restore(_adapter *padapter, u8 ch_sw_use_case); ++ ++#ifdef CONFIG_RTW_SDIO_OOB_INT ++void rtw_hal_switch_ood_int_ctrl(_adapter *padapter, u8 enable); ++#endif ++ ++#ifdef CONFIG_GPIO_WAKEUP ++ void rtw_hal_switch_gpio_wl_ctrl(_adapter *padapter, u8 index, u8 enable); ++ void rtw_hal_set_output_gpio(_adapter *padapter, u8 index, u8 outputval); ++#endif ++ ++typedef enum _HAL_PHYDM_OPS { ++ HAL_PHYDM_DIS_ALL_FUNC, ++ HAL_PHYDM_FUNC_SET, ++ HAL_PHYDM_FUNC_CLR, ++ HAL_PHYDM_ABILITY_BK, ++ HAL_PHYDM_ABILITY_RESTORE, ++ HAL_PHYDM_ABILITY_SET, ++ HAL_PHYDM_ABILITY_GET, ++} HAL_PHYDM_OPS; ++ ++ ++#define DYNAMIC_FUNC_DISABLE (0x0) ++u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability); ++ ++#define rtw_phydm_func_disable_all(adapter) \ ++ rtw_phydm_ability_ops(adapter, HAL_PHYDM_DIS_ALL_FUNC, 0) ++ ++#define rtw_phydm_func_for_offchannel(adapter) \ ++ do { \ ++ rtw_phydm_ability_ops(adapter, HAL_PHYDM_DIS_ALL_FUNC, 0); \ ++ if (rtw_odm_adaptivity_needed(adapter)) \ ++ rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_SET, ODM_BB_ADAPTIVITY); \ ++ } while (0) ++ ++#define rtw_phydm_func_set(adapter, ability) \ ++ rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_SET, ability) ++ ++#define rtw_phydm_func_clr(adapter, ability) \ ++ rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_CLR, ability) ++ ++#define rtw_phydm_ability_backup(adapter) \ ++ rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_BK, 0) ++ ++#define rtw_phydm_ability_restore(adapter) \ ++ rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_RESTORE, 0) ++ ++#define rtw_phydm_ability_set(adapter, ability) \ ++ rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_SET, ability) ++ ++static inline u32 rtw_phydm_ability_get(_adapter *adapter) ++{ ++ return rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_GET, 0); ++} ++ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ extern char *rtw_phy_file_path; ++ extern char rtw_phy_para_file_path[PATH_LENGTH_MAX]; ++ #define GetLineFromBuffer(buffer) strsep(&buffer, "\r\n") ++#endif ++ ++void update_IOT_info(_adapter *padapter); ++ ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++ void rtw_acs_start(_adapter *padapter, bool bStart); ++#endif ++ ++void hal_set_crystal_cap(_adapter *adapter, u8 crystal_cap); ++void rtw_hal_correct_tsf(_adapter *padapter, u8 hw_port, u64 tsf); ++ ++void ResumeTxBeacon(_adapter *padapter); ++void StopTxBeacon(_adapter *padapter); ++#ifdef CONFIG_MI_WITH_MBSSID_CAM /*HW port0 - MBSS*/ ++ void hw_var_set_opmode_mbid(_adapter *Adapter, u8 mode); ++ u8 rtw_mbid_camid_alloc(_adapter *adapter, u8 *mac_addr); ++#endif ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ u8 rtw_hal_antdiv_before_linked(_adapter *padapter); ++ void rtw_hal_antdiv_rssi_compared(_adapter *padapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src); ++#endif ++ ++#ifdef DBG_SEC_CAM_MOVE ++ void rtw_hal_move_sta_gk_to_dk(_adapter *adapter); ++ void rtw_hal_read_sta_dk_key(_adapter *adapter, u8 key_id); ++#endif ++ ++#ifdef CONFIG_LPS_PG ++ u8 rtw_hal_set_lps_pg_info(_adapter *adapter); ++#endif ++ ++#endif /* __HAL_COMMON_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_com_h2c.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_h2c.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_com_h2c.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_h2c.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,528 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __COMMON_H2C_H__ ++#define __COMMON_H2C_H__ ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ ++ * --------------------------------------------------------------------------------------------------------- ++ * 88e, 8723b, 8812, 8821, 92e use the same FW code base */ ++enum h2c_cmd { ++ /* Common Class: 000 */ ++ H2C_RSVD_PAGE = 0x00, ++ H2C_MEDIA_STATUS_RPT = 0x01, ++ H2C_SCAN_ENABLE = 0x02, ++ H2C_KEEP_ALIVE = 0x03, ++ H2C_DISCON_DECISION = 0x04, ++ H2C_PSD_OFFLOAD = 0x05, ++ H2C_CUSTOMER_STR_REQ = 0x06, ++ H2C_AP_OFFLOAD = 0x08, ++ H2C_BCN_RSVDPAGE = 0x09, ++ H2C_PROBERSP_RSVDPAGE = 0x0A, ++ H2C_FCS_RSVDPAGE = 0x10, ++ H2C_FCS_INFO = 0x11, ++ H2C_AP_WOW_GPIO_CTRL = 0x13, ++#ifdef CONFIG_MCC_MODE ++ H2C_MCC_UPDATE_PARAM = 0x15, ++ H2C_MCC_MACID_BITMAP = 0x16, ++ H2C_MCC_LOCATION = 0x10, ++ H2C_MCC_INFO = 0x18, ++ H2C_MCC_NOA_PARAM = 0x19, ++ H2C_MCC_IQK_PARAM = 0x1A, ++#endif /* CONFIG_MCC_MODE */ ++ H2C_CHNL_SWITCH_OPER_OFFLOAD = 0x1C, ++ ++ /* PoweSave Class: 001 */ ++ H2C_SET_PWR_MODE = 0x20, ++ H2C_PS_TUNING_PARA = 0x21, ++ H2C_PS_TUNING_PARA2 = 0x22, ++ H2C_P2P_LPS_PARAM = 0x23, ++ H2C_P2P_PS_OFFLOAD = 0x24, ++ H2C_PS_SCAN_ENABLE = 0x25, ++ H2C_SAP_PS_ = 0x26, ++ H2C_INACTIVE_PS_ = 0x27, /* Inactive_PS */ ++ H2C_FWLPS_IN_IPS_ = 0x28, ++#ifdef CONFIG_LPS_POFF ++ H2C_LPS_POFF_CTRL = 0x29, ++ H2C_LPS_POFF_PARAM = 0x2A, ++#endif ++#ifdef CONFIG_LPS_PG ++ H2C_LPS_PG_INFO = 0x2B, ++#endif ++ /* Dynamic Mechanism Class: 010 */ ++ H2C_MACID_CFG = 0x40, ++ H2C_TXBF = 0x41, ++ H2C_RSSI_SETTING = 0x42, ++ H2C_AP_REQ_TXRPT = 0x43, ++ H2C_INIT_RATE_COLLECT = 0x44, ++ H2C_IQ_CALIBRATION = 0x45, ++ ++ H2C_RA_MASK_3SS = 0x46,/* for 8814A */ ++ H2C_RA_PARA_ADJUST = 0x47,/* CONFIG_RA_DBG_CMD */ ++ H2C_DYNAMIC_TX_PATH = 0x48,/* for 8814A */ ++ ++ H2C_FW_TRACE_EN = 0x49, ++ ++ /* BT Class: 011 */ ++ H2C_B_TYPE_TDMA = 0x60, ++ H2C_BT_INFO = 0x61, ++ H2C_FORCE_BT_TXPWR = 0x62, ++ H2C_BT_IGNORE_WLANACT = 0x63, ++ H2C_DAC_SWING_VALUE = 0x64, ++ H2C_ANT_SEL_RSV = 0x65, ++ H2C_WL_OPMODE = 0x66, ++ H2C_BT_MP_OPER = 0x67, ++ H2C_BT_CONTROL = 0x68, ++ H2C_BT_WIFI_CTRL = 0x69, ++ H2C_BT_FW_PATCH = 0x6A, ++ ++ /* WOWLAN Class: 100 */ ++ H2C_WOWLAN = 0x80, ++ H2C_REMOTE_WAKE_CTRL = 0x81, ++ H2C_AOAC_GLOBAL_INFO = 0x82, ++ H2C_AOAC_RSVD_PAGE = 0x83, ++ H2C_AOAC_RSVD_PAGE2 = 0x84, ++ H2C_D0_SCAN_OFFLOAD_CTRL = 0x85, ++ H2C_D0_SCAN_OFFLOAD_INFO = 0x86, ++ H2C_CHNL_SWITCH_OFFLOAD = 0x87, ++ H2C_AOAC_RSVDPAGE3 = 0x88, ++ H2C_P2P_OFFLOAD_RSVD_PAGE = 0x8A, ++ H2C_P2P_OFFLOAD = 0x8B, ++ ++ H2C_RESET_TSF = 0xC0, ++ H2C_BCNHWSEQ = 0xC5, ++ H2C_CUSTOMER_STR_W1 = 0xC6, ++ H2C_CUSTOMER_STR_W2 = 0xC7, ++ H2C_CUSTOMER_STR_W3 = 0xC8, ++ H2C_MAXID, ++}; ++ ++#define H2C_RSVDPAGE_LOC_LEN 5 ++#define H2C_MEDIA_STATUS_RPT_LEN 3 ++#define H2C_KEEP_ALIVE_CTRL_LEN 2 ++#define H2C_DISCON_DECISION_LEN 3 ++#define H2C_AP_OFFLOAD_LEN 3 ++#define H2C_AP_WOW_GPIO_CTRL_LEN 4 ++#define H2C_AP_PS_LEN 2 ++#define H2C_PWRMODE_LEN 7 ++#define H2C_PSTUNEPARAM_LEN 4 ++#define H2C_MACID_CFG_LEN 7 ++#define H2C_BTMP_OPER_LEN 5 ++#define H2C_WOWLAN_LEN 5 ++#define H2C_REMOTE_WAKE_CTRL_LEN 3 ++#define H2C_AOAC_GLOBAL_INFO_LEN 2 ++#define H2C_AOAC_RSVDPAGE_LOC_LEN 7 ++#define H2C_SCAN_OFFLOAD_CTRL_LEN 4 ++#define H2C_BT_FW_PATCH_LEN 6 ++#define H2C_RSSI_SETTING_LEN 4 ++#define H2C_AP_REQ_TXRPT_LEN 2 ++#define H2C_FORCE_BT_TXPWR_LEN 3 ++#define H2C_BCN_RSVDPAGE_LEN 5 ++#define H2C_PROBERSP_RSVDPAGE_LEN 5 ++#define H2C_P2PRSVDPAGE_LOC_LEN 5 ++#define H2C_P2P_OFFLOAD_LEN 3 ++#define H2C_INACTIVE_PS_LEN 4 ++#ifdef CONFIG_MCC_MODE ++ #define H2C_MCC_INFO_LEN 7 ++ #define H2C_MCC_LOCATION_LEN 3 ++ #define H2C_MCC_MACID_BITMAP_LEN 6 ++ #define H2C_MCC_UPDATE_INFO_LEN 4 ++ #define H2C_MCC_NOA_PARAM_LEN 4 ++ #define H2C_MCC_IQK_PARAM_LEN 7 ++#endif /* CONFIG_MCC_MODE */ ++#ifdef CONFIG_LPS_PG ++ #define H2C_LPS_PG_INFO_LEN 2 ++ #define H2C_LPSPG_LEN 16 ++#endif ++#ifdef CONFIG_LPS_POFF ++ #define H2C_LPS_POFF_CTRL_LEN 1 ++ #define H2C_LPS_POFF_PARAM_LEN 5 ++#endif ++#define eqMacAddr(a, b) (((a)[0] == (b)[0] && (a)[1] == (b)[1] && (a)[2] == (b)[2] && (a)[3] == (b)[3] && (a)[4] == (b)[4] && (a)[5] == (b)[5]) ? 1 : 0) ++#define cpMacAddr(des, src) ((des)[0] = (src)[0], (des)[1] = (src)[1], (des)[2] = (src)[2], (des)[3] = (src)[3], (des)[4] = (src)[4], (des)[5] = (src)[5]) ++#define cpIpAddr(des, src) ((des)[0] = (src)[0], (des)[1] = (src)[1], (des)[2] = (src)[2], (des)[3] = (src)[3]) ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++/* ++* ARP packet ++* ++* LLC Header */ ++#define GET_ARP_PKT_LLC_TYPE(__pHeader) ReadLE2Byte(((u8 *)(__pHeader)) + 6) ++ ++/* ARP element */ ++#define GET_ARP_PKT_OPERATION(__pHeader) ReadLE2Byte(((u8 *)(__pHeader)) + 6) ++#define GET_ARP_PKT_SENDER_MAC_ADDR(__pHeader, _val) cpMacAddr((u8 *)(_val), ((u8 *)(__pHeader))+8) ++#define GET_ARP_PKT_SENDER_IP_ADDR(__pHeader, _val) cpIpAddr((u8 *)(_val), ((u8 *)(__pHeader))+14) ++#define GET_ARP_PKT_TARGET_MAC_ADDR(__pHeader, _val) cpMacAddr((u8 *)(_val), ((u8 *)(__pHeader))+18) ++#define GET_ARP_PKT_TARGET_IP_ADDR(__pHeader, _val) cpIpAddr((u8 *)(_val), ((u8 *)(__pHeader))+24) ++ ++#define SET_ARP_PKT_HW(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 0, __Value) ++#define SET_ARP_PKT_PROTOCOL(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 2, __Value) ++#define SET_ARP_PKT_HW_ADDR_LEN(__pHeader, __Value) WriteLE1Byte(((u8 *)(__pHeader)) + 4, __Value) ++#define SET_ARP_PKT_PROTOCOL_ADDR_LEN(__pHeader, __Value) WriteLE1Byte(((u8 *)(__pHeader)) + 5, __Value) ++#define SET_ARP_PKT_OPERATION(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 6, __Value) ++#define SET_ARP_PKT_SENDER_MAC_ADDR(__pHeader, _val) cpMacAddr(((u8 *)(__pHeader))+8, (u8 *)(_val)) ++#define SET_ARP_PKT_SENDER_IP_ADDR(__pHeader, _val) cpIpAddr(((u8 *)(__pHeader))+14, (u8 *)(_val)) ++#define SET_ARP_PKT_TARGET_MAC_ADDR(__pHeader, _val) cpMacAddr(((u8 *)(__pHeader))+18, (u8 *)(_val)) ++#define SET_ARP_PKT_TARGET_IP_ADDR(__pHeader, _val) cpIpAddr(((u8 *)(__pHeader))+24, (u8 *)(_val)) ++ ++#define FW_WOWLAN_FUN_EN BIT(0) ++#define FW_WOWLAN_PATTERN_MATCH BIT(1) ++#define FW_WOWLAN_MAGIC_PKT BIT(2) ++#define FW_WOWLAN_UNICAST BIT(3) ++#define FW_WOWLAN_ALL_PKT_DROP BIT(4) ++#define FW_WOWLAN_GPIO_ACTIVE BIT(5) ++#define FW_WOWLAN_REKEY_WAKEUP BIT(6) ++#define FW_WOWLAN_DEAUTH_WAKEUP BIT(7) ++ ++#define FW_WOWLAN_GPIO_WAKEUP_EN BIT(0) ++#define FW_FW_PARSE_MAGIC_PKT BIT(1) ++ ++#define FW_REMOTE_WAKE_CTRL_EN BIT(0) ++#define FW_REALWOWLAN_EN BIT(5) ++ ++#define FW_WOWLAN_KEEP_ALIVE_EN BIT(0) ++#define FW_ADOPT_USER BIT(1) ++#define FW_WOWLAN_KEEP_ALIVE_PKT_TYPE BIT(2) ++ ++#define FW_REMOTE_WAKE_CTRL_EN BIT(0) ++#define FW_ARP_EN BIT(1) ++#define FW_REALWOWLAN_EN BIT(5) ++#define FW_WOW_FW_UNICAST_EN BIT(7) ++ ++#endif /* CONFIG_WOWLAN */ ++ ++/* _RSVDPAGE_LOC_CMD_0x00 */ ++#define SET_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value)SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++ ++/* _MEDIA_STATUS_RPT_PARM_CMD_0x01 */ ++#define SET_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 0, 1, (__Value)) ++#define SET_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 1, 1, (__Value)) ++#define SET_H2CCMD_MSRRPT_PARM_MIRACAST(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 2, 1, (__Value)) ++#define SET_H2CCMD_MSRRPT_PARM_MIRACAST_SINK(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 3, 1, (__Value)) ++#define SET_H2CCMD_MSRRPT_PARM_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 4, 4, (__Value)) ++#define SET_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)) + 1, 0, 8, (__Value)) ++#define SET_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)) + 2, 0, 8, (__Value)) ++ ++#define GET_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd) LE_BITS_TO_1BYTE(((u8 *)(__pH2CCmd)), 0, 1) ++#define GET_H2CCMD_MSRRPT_PARM_MIRACAST(__pH2CCmd) LE_BITS_TO_1BYTE(((u8 *)(__pH2CCmd)), 2, 1) ++#define GET_H2CCMD_MSRRPT_PARM_MIRACAST_SINK(__pH2CCmd) LE_BITS_TO_1BYTE(((u8 *)(__pH2CCmd)), 3, 1) ++#define GET_H2CCMD_MSRRPT_PARM_ROLE(__pH2CCmd) LE_BITS_TO_1BYTE(((u8 *)(__pH2CCmd)), 4, 4) ++ ++#define H2C_MSR_ROLE_RSVD 0 ++#define H2C_MSR_ROLE_STA 1 ++#define H2C_MSR_ROLE_AP 2 ++#define H2C_MSR_ROLE_GC 3 ++#define H2C_MSR_ROLE_GO 4 ++#define H2C_MSR_ROLE_TDLS 5 ++#define H2C_MSR_ROLE_ADHOC 6 ++#define H2C_MSR_ROLE_MAX 7 ++ ++extern const char *const _h2c_msr_role_str[]; ++#define h2c_msr_role_str(role) (((role) >= H2C_MSR_ROLE_MAX) ? _h2c_msr_role_str[H2C_MSR_ROLE_MAX] : _h2c_msr_role_str[(role)]) ++ ++#define H2C_MSR_FMT "%s %s%s" ++#define H2C_MSR_ARG(h2c_msr) \ ++ GET_H2CCMD_MSRRPT_PARM_OPMODE((h2c_msr)) ? " C" : "", \ ++ h2c_msr_role_str(GET_H2CCMD_MSRRPT_PARM_ROLE((h2c_msr))), \ ++ GET_H2CCMD_MSRRPT_PARM_MIRACAST((h2c_msr)) ? (GET_H2CCMD_MSRRPT_PARM_MIRACAST_SINK((h2c_msr)) ? " MSINK" : " MSRC") : "" ++ ++s32 rtw_hal_set_FwMediaStatusRpt_cmd(_adapter *adapter, bool opmode, bool miracast, bool miracast_sink, u8 role, u8 macid, bool macid_ind, u8 macid_end); ++s32 rtw_hal_set_FwMediaStatusRpt_single_cmd(_adapter *adapter, bool opmode, bool miracast, bool miracast_sink, u8 role, u8 macid); ++s32 rtw_hal_set_FwMediaStatusRpt_range_cmd(_adapter *adapter, bool opmode, bool miracast, bool miracast_sink, u8 role, u8 macid, u8 macid_end); ++ ++/* _KEEP_ALIVE_CMD_0x03 */ ++#define SET_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++ ++/* _DISCONNECT_DECISION_CMD_0x04 */ ++#define SET_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) ++ ++#ifdef CONFIG_RTW_CUSTOMER_STR ++#define RTW_CUSTOMER_STR_LEN 16 ++#define RTW_CUSTOMER_STR_FMT "%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x" ++#define RTW_CUSTOMER_STR_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5], \ ++ ((u8 *)(x))[6], ((u8 *)(x))[7], ((u8 *)(x))[8], ((u8 *)(x))[9], ((u8 *)(x))[10], ((u8 *)(x))[11], \ ++ ((u8 *)(x))[12], ((u8 *)(x))[13], ((u8 *)(x))[14], ((u8 *)(x))[15] ++ ++/* H2C_CUSTOMER_STR_REQ 0x06 */ ++#define H2C_CUSTOMER_STR_REQ_LEN 1 ++#define SET_H2CCMD_CUSTOMER_STR_REQ_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 0, 1, (__Value)) ++s32 rtw_hal_h2c_customer_str_req(_adapter *adapter); ++s32 rtw_hal_customer_str_read(_adapter *adapter, u8 *cs); ++ ++/* H2C_CUSTOMER_STR_W1 0xC6 */ ++#define H2C_CUSTOMER_STR_W1_LEN 7 ++#define SET_H2CCMD_CUSTOMER_STR_W1_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 0, 1, (__Value)) ++#define H2CCMD_CUSTOMER_STR_W1_BYTE0(__pH2CCmd) (((u8 *)(__pH2CCmd)) + 1) ++ ++/* H2C_CUSTOMER_STR_W2 0xC7 */ ++#define H2C_CUSTOMER_STR_W2_LEN 7 ++#define SET_H2CCMD_CUSTOMER_STR_W2_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 0, 1, (__Value)) ++#define H2CCMD_CUSTOMER_STR_W2_BYTE6(__pH2CCmd) (((u8 *)(__pH2CCmd)) + 1) ++ ++/* H2C_CUSTOMER_STR_W3 0xC8 */ ++#define H2C_CUSTOMER_STR_W3_LEN 5 ++#define SET_H2CCMD_CUSTOMER_STR_W3_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 0, 1, (__Value)) ++#define H2CCMD_CUSTOMER_STR_W3_BYTE12(__pH2CCmd) (((u8 *)(__pH2CCmd)) + 1) ++s32 rtw_hal_h2c_customer_str_write(_adapter *adapter, const u8 *cs); ++s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs); ++#endif /* CONFIG_RTW_CUSTOMER_STR */ ++ ++/* _AP_Offload 0x08 */ ++#define SET_H2CCMD_AP_WOWLAN_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++/* _BCN_RsvdPage 0x09 */ ++#define SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_BCN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++/* _Probersp_RsvdPage 0x0a */ ++#define SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_ProbeRsp(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++/* _Probersp_RsvdPage 0x13 */ ++#define SET_H2CCMD_AP_WOW_GPIO_CTRL_INDEX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) ++#define SET_H2CCMD_AP_WOW_GPIO_CTRL_C2H_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) ++#define SET_H2CCMD_AP_WOW_GPIO_CTRL_PLUS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) ++#define SET_H2CCMD_AP_WOW_GPIO_CTRL_HIGH_ACTIVE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) ++#define SET_H2CCMD_AP_WOW_GPIO_CTRL_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) ++#define SET_H2CCMD_AP_WOW_GPIO_CTRL_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_H2CCMD_AP_WOW_GPIO_CTRL_C2H_DURATION(__pH2CCmd, __Value)SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++/* _AP_PS 0x26 */ ++#define SET_H2CCMD_AP_WOW_PS_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_H2CCMD_AP_WOW_PS_32K_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_H2CCMD_AP_WOW_PS_RF(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_H2CCMD_AP_WOW_PS_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++ ++/* INACTIVE_PS 0x27, duration unit is TBTT */ ++#define SET_H2CCMD_INACTIVE_PS_EN(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_H2CCMD_INACTIVE_PS_IGNORE_PS(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_H2CCMD_INACTIVE_PS_PERIOD_SCAN_EN(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_H2CCMD_INACTIVE_PS_FREQ(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE(__pH2CCmd + 1, 0, 8, __Value) ++#define SET_H2CCMD_INACTIVE_PS_DURATION(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE(__pH2CCmd + 2, 0, 8, __Value) ++#define SET_H2CCMD_INACTIVE_PS_PERIOD_SCAN_TIME(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE(__pH2CCmd + 3, 0, 8, __Value) ++ ++#ifdef CONFIG_LPS_POFF ++/*PARTIAL OFF Control 0x29*/ ++#define SET_H2CCMD_LPS_POFF_CTRL_EN(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++/*PARTIAL OFF PARAM 0x2A*/ ++#define SET_H2CCMD_LPS_POFF_PARAM_RDVLD(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_H2CCMD_LPS_POFF_PARAM_WRVLD(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_H2CCMD_LPS_POFF_PARAM_STARTADDL(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_H2CCMD_LPS_POFF_PARAM_STARTADDH(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) ++#define SET_H2CCMD_LPS_POFF_PARAM_ENDADDL(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++#define SET_H2CCMD_LPS_POFF_PARAM_ENDADDH(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) ++#endif ++ ++#ifdef CONFIG_MCC_MODE ++/* MCC LOC CMD 0x10 */ ++#define SET_H2CCMD_MCC_RSVDPAGE_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++ ++/* MCC MAC ID CMD 0x16 */ ++#define SET_H2CCMD_MCC_MACID_BITMAP_L(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_H2CCMD_MCC_MACID_BITMAP_H(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++ ++/* MCC INFO CMD 0x18 */ ++#define SET_H2CCMD_MCC_INFO_ORDER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) ++#define SET_H2CCMD_MCC_INFO_TOTALNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) ++#define SET_H2CCMD_MCC_INFO_CHIDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_H2CCMD_MCC_INFO_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 2, __Value) ++#define SET_H2CCMD_MCC_INFO_BW40SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 2, 3, __Value) ++#define SET_H2CCMD_MCC_INFO_BW80SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 5, 3, __Value) ++#define SET_H2CCMD_MCC_INFO_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_H2CCMD_MCC_INFO_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 3, __Value) ++#define SET_H2CCMD_MCC_INFO_INCURCH(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 3, 1, __Value) ++#define SET_H2CCMD_MCC_INFO_RSVD0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 4, 4, __Value) ++#define SET_H2CCMD_MCC_INFO_RSVD1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++#define SET_H2CCMD_MCC_INFO_RFETYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 0, 4, __Value) ++#define SET_H2CCMD_MCC_INFO_DISTXNULL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 4, 1, __Value) ++#define SET_H2CCMD_MCC_INFO_C2HRPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 5, 2, __Value) ++#define SET_H2CCMD_MCC_INFO_CHSCAN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 7, 1, __Value) ++ ++/* MCC NoA CMD 0x19 */ ++#define SET_H2CCMD_MCC_NOA_FW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_H2CCMD_MCC_NOA_TSF_SYNC_OFFSET(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 7, __Value) ++#define SET_H2CCMD_MCC_NOA_START_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_H2CCMD_MCC_NOA_INTERVAL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_H2CCMD_MCC_EARLY_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++ ++/* MCC IQK CMD 0x1A */ ++#define SET_H2CCMD_MCC_IQK_READY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_H2CCMD_MCC_IQK_ORDER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 2, __Value) ++#define SET_H2CCMD_MCC_IQK_RX_L(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_H2CCMD_MCC_IQK_RX_M1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 2, __Value) ++#define SET_H2CCMD_MCC_IQK_RX_M2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 2, 6, __Value) ++#define SET_H2CCMD_MCC_IQK_RX_H(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 4, __Value) ++#define SET_H2CCMD_MCC_IQK_TX_L(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#define SET_H2CCMD_MCC_IQK_TX_M1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 3, __Value) ++#define SET_H2CCMD_MCC_IQK_TX_M2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 3, 5, __Value) ++#define SET_H2CCMD_MCC_IQK_TX_H(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 0, 6, __Value) ++#endif /* CONFIG_MCC_MODE */ ++ ++/* CHNL SWITCH OPER OFFLOAD 0x1C */ ++#define SET_H2CCMD_CH_SW_OPER_OFFLOAD_CH_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_H2CCMD_CH_SW_OPER_OFFLOAD_BW_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 1, 0, 2, __Value) ++#define SET_H2CCMD_CH_SW_OPER_OFFLOAD_BW_40M_SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 1, 2, 3, __Value) ++#define SET_H2CCMD_CH_SW_OPER_OFFLOAD_BW_80M_SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 1, 5, 3, __Value) ++#define SET_H2CCMD_CH_SW_OPER_OFFLOAD_RFE_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 2, 0, 4, __Value) ++ ++/* _WoWLAN PARAM_CMD_0x80 */ ++#define SET_H2CCMD_WOWLAN_FUNC_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_H2CCMD_WOWLAN_MAGIC_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_H2CCMD_WOWLAN_UNICAST_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) ++#define SET_H2CCMD_WOWLAN_ALL_PKT_DROP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) ++#define SET_H2CCMD_WOWLAN_GPIO_ACTIVE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) ++#define SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) ++#define SET_H2CCMD_WOWLAN_DISCONNECT_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) ++#define SET_H2CCMD_WOWLAN_GPIONUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 7, __Value) ++#define SET_H2CCMD_WOWLAN_DATAPIN_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 7, 1, __Value) ++#define SET_H2CCMD_WOWLAN_GPIO_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_H2CCMD_WOWLAN_GPIO_PULSE_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 1, __Value) ++#define SET_H2CCMD_WOWLAN_GPIO_PULSE_COUNT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 1, 7, __Value) ++#define SET_H2CCMD_WOWLAN_LOWPR_RX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 1, __Value) ++#define SET_H2CCMD_WOWLAN_CHANGE_UNIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 2, 1, __Value) ++/* _REMOTE_WAKEUP_CMD_0x81 */ ++#define SET_H2CCMD_REMOTE_WAKECTRL_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_H2CCMD_REMOTE_WAKE_CTRL_NDP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) ++#define SET_H2CCMD_REMOTE_WAKE_CTRL_NLO_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) ++#define SET_H2CCMD_REMOTE_WAKE_CTRL_FW_UNICAST_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) ++#define SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 1, __Value) ++#define SET_H2CCMD_REMOTE_WAKE_CTRL_NBNS_FILTER_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 2, 1, __Value) ++#define SET_H2CCMD_REMOTE_WAKE_CTRL_TKIP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 3, 1, __Value) ++#define SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 1, __Value) ++#define SET_H2CCMD_REMOTE_WAKE_CTRL_FW_PARSING_UNTIL_WAKEUP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 4, 1, __Value) ++ ++/* AOAC_GLOBAL_INFO_0x82 */ ++#define SET_H2CCMD_AOAC_GLOBAL_INFO_PAIRWISE_ENC_ALG(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_H2CCMD_AOAC_GLOBAL_INFO_GROUP_ENC_ALG(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++ ++/* AOAC_RSVDPAGE_LOC_0x83 */ ++#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 0, 8, __Value) ++#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_NEIGHBOR_ADV(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#ifdef CONFIG_GTK_OL ++#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_EXT_MEM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++#endif /* CONFIG_GTK_OL */ ++#ifdef CONFIG_PNO_SUPPORT ++#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_NLO_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 0, 8, __Value) ++#endif ++#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_AOAC_REPORT(__pH2CCmd, __Value) \ ++ SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 1, 0, 8, __Value) ++ ++#ifdef CONFIG_PNO_SUPPORT ++/* D0_Scan_Offload_Info_0x86 */ ++#define SET_H2CCMD_AOAC_NLO_FUN_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 3, 1, __Value) ++#define SET_H2CCMD_AOAC_NLO_IPS_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 4, 1, __Value) ++#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_PROBE_PACKET(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_SCAN_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_SSID_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#endif /* CONFIG_PNO_SUPPORT */ ++ ++#ifdef CONFIG_P2P_WOWLAN ++/* P2P_RsvdPage_0x8a */ ++#define SET_H2CCMD_RSVDPAGE_LOC_P2P_BCN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_H2CCMD_RSVDPAGE_LOC_P2P_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_H2CCMD_RSVDPAGE_LOC_P2P_NEGO_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_H2CCMD_RSVDPAGE_LOC_P2P_INVITE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_H2CCMD_RSVDPAGE_LOC_P2P_PD_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#endif /* CONFIG_P2P_WOWLAN */ ++ ++#ifdef CONFIG_LPS_PG ++#define SET_H2CCMD_LPSPG_SEC_CAM_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value)/*SecurityCAM_En*/ ++#define SET_H2CCMD_LPSPG_MBID_CAM_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value)/*BSSIDCAM_En*/ ++#define SET_H2CCMD_LPSPG_PMC_CAM_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value)/*PatternMatchCAM_En*/ ++#define SET_H2CCMD_LPSPG_MACID_SEARCH_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value)/*MACIDSearch_En*/ ++#define SET_H2CCMD_LPSPG_TXSC_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value)/*TXSC_En*/ ++#define SET_H2CCMD_LPSPG_MU_RATE_TB_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value)/*MURateTable_En*/ ++#define SET_H2CCMD_LPSPG_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value)/*Loc_LPS_PG*/ ++#endif ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ------------------------------------------- Structure -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- */ ++typedef struct _RSVDPAGE_LOC { ++ u8 LocProbeRsp; ++ u8 LocPsPoll; ++ u8 LocNullData; ++ u8 LocQosNull; ++ u8 LocBTQosNull; ++#ifdef CONFIG_WOWLAN ++ u8 LocRemoteCtrlInfo; ++ u8 LocArpRsp; ++ u8 LocNbrAdv; ++ u8 LocGTKRsp; ++ u8 LocGTKInfo; ++ u8 LocProbeReq; ++ u8 LocNetList; ++#ifdef CONFIG_GTK_OL ++ u8 LocGTKEXTMEM; ++#endif /* CONFIG_GTK_OL */ ++ u8 LocAOACReport; ++#ifdef CONFIG_PNO_SUPPORT ++ u8 LocPNOInfo; ++ u8 LocScanInfo; ++ u8 LocSSIDInfo; ++ u8 LocProbePacket; ++#endif /* CONFIG_PNO_SUPPORT */ ++#endif /* CONFIG_WOWLAN */ ++ u8 LocApOffloadBCN; ++#ifdef CONFIG_P2P_WOWLAN ++ u8 LocP2PBeacon; ++ u8 LocP2PProbeRsp; ++ u8 LocNegoRsp; ++ u8 LocInviteRsp; ++ u8 LocPDRsp; ++#endif /* CONFIG_P2P_WOWLAN */ ++} RSVDPAGE_LOC, *PRSVDPAGE_LOC; ++ ++#endif ++void dump_TX_FIFO(PADAPTER padapter, u8 page_num, u16 page_size); ++u8 rtw_hal_set_fw_media_status_cmd(_adapter *adapter, u8 mstatus, u8 macid); ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++ /* WOW command function */ ++ void rtw_hal_set_fw_wow_related_cmd(_adapter *padapter, u8 enable); ++ #ifdef CONFIG_P2P_WOWLAN ++ /* H2C 0x8A */ ++ u8 rtw_hal_set_FwP2PRsvdPage_cmd(_adapter *adapter, PRSVDPAGE_LOC rsvdpageloc); ++ /* H2C 0x8B */ ++ u8 rtw_hal_set_p2p_wowlan_offload_cmd(_adapter *adapter); ++ #endif /* CONFIG_P2P_WOWLAN */ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_com_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_led.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_com_led.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_led.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,396 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_COMMON_LED_H_ ++#define __HAL_COMMON_LED_H_ ++ ++ ++#define MSECS(t) (HZ * ((t) / 1000) + (HZ * ((t) % 1000)) / 1000) ++ ++/* ******************************************************************************** ++ * LED Behavior Constant. ++ * ******************************************************************************** ++ * Default LED behavior. ++ * */ ++#define LED_BLINK_NORMAL_INTERVAL 100 ++#define LED_BLINK_SLOWLY_INTERVAL 200 ++#define LED_BLINK_LONG_INTERVAL 400 ++#define LED_INITIAL_INTERVAL 1800 ++ ++/* LED Customerization */ ++ ++/* NETTRONIX */ ++#define LED_BLINK_NORMAL_INTERVAL_NETTRONIX 100 ++#define LED_BLINK_SLOWLY_INTERVAL_NETTRONIX 2000 ++ ++/* PORNET */ ++#define LED_BLINK_SLOWLY_INTERVAL_PORNET 1000 ++#define LED_BLINK_NORMAL_INTERVAL_PORNET 100 ++#define LED_BLINK_FAST_INTERVAL_BITLAND 30 ++ ++/* AzWave. */ ++#define LED_CM2_BLINK_ON_INTERVAL 250 ++#define LED_CM2_BLINK_OFF_INTERVAL 4750 ++#define LED_CM8_BLINK_OFF_INTERVAL 3750 /* for QMI */ ++ ++/* RunTop */ ++#define LED_RunTop_BLINK_INTERVAL 300 ++ ++/* ALPHA */ ++#define LED_BLINK_NO_LINK_INTERVAL_ALPHA 1000 ++#define LED_BLINK_NO_LINK_INTERVAL_ALPHA_500MS 500 /* add by ylb 20121012 for customer led for alpha */ ++#define LED_BLINK_LINK_INTERVAL_ALPHA 500 /* 500 */ ++#define LED_BLINK_SCAN_INTERVAL_ALPHA 180 /* 150 */ ++#define LED_BLINK_FASTER_INTERVAL_ALPHA 50 ++#define LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA 5000 ++ ++/* 111122 by hpfan: Customized for Xavi */ ++#define LED_CM11_BLINK_INTERVAL 300 ++#define LED_CM11_LINK_ON_INTERVEL 3000 ++ ++/* Netgear */ ++#define LED_BLINK_LINK_INTERVAL_NETGEAR 500 ++#define LED_BLINK_LINK_SLOWLY_INTERVAL_NETGEAR 1000 ++ ++#define LED_WPS_BLINK_OFF_INTERVAL_NETGEAR 100 ++#define LED_WPS_BLINK_ON_INTERVAL_NETGEAR 500 ++ ++/* Belkin AC950 */ ++#define LED_BLINK_LINK_INTERVAL_ON_BELKIN 200 ++#define LED_BLINK_LINK_INTERVAL_OFF_BELKIN 100 ++#define LED_BLINK_ERROR_INTERVAL_BELKIN 100 ++ ++/* by chiyokolin for Azurewave */ ++#define LED_CM12_BLINK_INTERVAL_5Mbps 160 ++#define LED_CM12_BLINK_INTERVAL_10Mbps 80 ++#define LED_CM12_BLINK_INTERVAL_20Mbps 50 ++#define LED_CM12_BLINK_INTERVAL_40Mbps 40 ++#define LED_CM12_BLINK_INTERVAL_80Mbps 30 ++#define LED_CM12_BLINK_INTERVAL_MAXMbps 25 ++ ++/* Dlink */ ++#define LED_BLINK_NO_LINK_INTERVAL 1000 ++#define LED_BLINK_LINK_IDEL_INTERVAL 100 ++ ++#define LED_BLINK_SCAN_ON_INTERVAL 30 ++#define LED_BLINK_SCAN_OFF_INTERVAL 300 ++ ++#define LED_WPS_BLINK_ON_INTERVAL_DLINK 30 ++#define LED_WPS_BLINK_OFF_INTERVAL_DLINK 300 ++#define LED_WPS_BLINK_LINKED_ON_INTERVAL_DLINK 5000 ++ ++/* ******************************************************************************** ++ * LED object. ++ * ******************************************************************************** */ ++ ++typedef enum _LED_CTL_MODE { ++ LED_CTL_POWER_ON = 1, ++ LED_CTL_LINK = 2, ++ LED_CTL_NO_LINK = 3, ++ LED_CTL_TX = 4, ++ LED_CTL_RX = 5, ++ LED_CTL_SITE_SURVEY = 6, ++ LED_CTL_POWER_OFF = 7, ++ LED_CTL_START_TO_LINK = 8, ++ LED_CTL_START_WPS = 9, ++ LED_CTL_STOP_WPS = 10, ++ LED_CTL_START_WPS_BOTTON = 11, /* added for runtop */ ++ LED_CTL_STOP_WPS_FAIL = 12, /* added for ALPHA */ ++ LED_CTL_STOP_WPS_FAIL_OVERLAP = 13, /* added for BELKIN */ ++ LED_CTL_CONNECTION_NO_TRANSFER = 14, ++} LED_CTL_MODE; ++ ++typedef enum _LED_STATE { ++ LED_UNKNOWN = 0, ++ RTW_LED_ON = 1, ++ RTW_LED_OFF = 2, ++ LED_BLINK_NORMAL = 3, ++ LED_BLINK_SLOWLY = 4, ++ LED_BLINK_POWER_ON = 5, ++ LED_BLINK_SCAN = 6, /* LED is blinking during scanning period, the # of times to blink is depend on time for scanning. */ ++ LED_BLINK_NO_LINK = 7, /* LED is blinking during no link state. */ ++ LED_BLINK_StartToBlink = 8, /* Customzied for Sercomm Printer Server case */ ++ LED_BLINK_TXRX = 9, ++ LED_BLINK_WPS = 10, /* LED is blinkg during WPS communication */ ++ LED_BLINK_WPS_STOP = 11, /* for ALPHA */ ++ LED_BLINK_WPS_STOP_OVERLAP = 12, /* for BELKIN */ ++ LED_BLINK_RUNTOP = 13, /* Customized for RunTop */ ++ LED_BLINK_CAMEO = 14, ++ LED_BLINK_XAVI = 15, ++ LED_BLINK_ALWAYS_ON = 16, ++ LED_BLINK_LINK_IN_PROCESS = 17, /* Customized for Belkin AC950 */ ++ LED_BLINK_AUTH_ERROR = 18, /* Customized for Belkin AC950 */ ++ LED_BLINK_Azurewave_5Mbps = 19, ++ LED_BLINK_Azurewave_10Mbps = 20, ++ LED_BLINK_Azurewave_20Mbps = 21, ++ LED_BLINK_Azurewave_40Mbps = 22, ++ LED_BLINK_Azurewave_80Mbps = 23, ++ LED_BLINK_Azurewave_MAXMbps = 24, ++ LED_BLINK_LINK_IDEL = 25, ++ LED_BLINK_WPS_LINKED = 26, ++} LED_STATE; ++ ++typedef enum _LED_PIN { ++ LED_PIN_GPIO0, ++ LED_PIN_LED0, ++ LED_PIN_LED1, ++ LED_PIN_LED2 ++} LED_PIN; ++ ++ ++/* ******************************************************************************** ++ * PCIE LED Definition. ++ * ******************************************************************************** */ ++#ifdef CONFIG_PCI_HCI ++typedef enum _LED_STRATEGY_PCIE { ++ SW_LED_MODE0, /* SW control 1 LED via GPIO0. It is default option. */ ++ SW_LED_MODE1, /* SW control for PCI Express */ ++ SW_LED_MODE2, /* SW control for Cameo. */ ++ SW_LED_MODE3, /* SW contorl for RunTop. */ ++ SW_LED_MODE4, /* SW control for Netcore */ ++ SW_LED_MODE5, /* added by vivi, for led new mode, DLINK */ ++ SW_LED_MODE6, /* added by vivi, for led new mode, PRONET */ ++ SW_LED_MODE7, /* added by chiyokolin, for Lenovo, PCI Express Minicard Spec Rev.1.2 spec */ ++ SW_LED_MODE8, /* added by chiyokolin, for QMI */ ++ SW_LED_MODE9, /* added by chiyokolin, for BITLAND-LENOVO, PCI Express Minicard Spec Rev.1.1 */ ++ SW_LED_MODE10, /* added by chiyokolin, for Edimax-ASUS */ ++ SW_LED_MODE11, /* added by hpfan, for Xavi */ ++ SW_LED_MODE12, /* added by chiyokolin, for Azurewave */ ++ HW_LED, /* HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes) */ ++} LED_STRATEGY_PCIE, *PLED_STRATEGY_PCIE; ++ ++typedef struct _LED_PCIE { ++ PADAPTER padapter; ++ ++ LED_PIN LedPin; /* Identify how to implement this SW led. */ ++ ++ LED_STATE CurrLedState; /* Current LED state. */ ++ BOOLEAN bLedOn; /* TRUE if LED is ON, FALSE if LED is OFF. */ ++ ++ BOOLEAN bLedBlinkInProgress; /* TRUE if it is blinking, FALSE o.w.. */ ++ BOOLEAN bLedWPSBlinkInProgress; /* TRUE if it is blinking, FALSE o.w.. */ ++ ++ BOOLEAN bLedSlowBlinkInProgress;/* added by vivi, for led new mode */ ++ u32 BlinkTimes; /* Number of times to toggle led state for blinking. */ ++ LED_STATE BlinkingLedState; /* Next state for blinking, either LED_ON or LED_OFF are. */ ++ ++ _timer BlinkTimer; /* Timer object for led blinking. */ ++} LED_PCIE, *PLED_PCIE; ++ ++typedef struct _LED_PCIE LED_DATA, *PLED_DATA; ++typedef enum _LED_STRATEGY_PCIE LED_STRATEGY, *PLED_STRATEGY; ++ ++VOID ++LedControlPCIE( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++); ++ ++VOID ++gen_RefreshLedState( ++ IN PADAPTER Adapter); ++ ++/* ******************************************************************************** ++ * USB LED Definition. ++ * ******************************************************************************** */ ++#elif defined(CONFIG_USB_HCI) ++ ++#define IS_LED_WPS_BLINKING(_LED_USB) (((PLED_USB)_LED_USB)->CurrLedState == LED_BLINK_WPS \ ++ || ((PLED_USB)_LED_USB)->CurrLedState == LED_BLINK_WPS_STOP \ ++ || ((PLED_USB)_LED_USB)->bLedWPSBlinkInProgress) ++ ++#define IS_LED_BLINKING(_LED_USB) (((PLED_USB)_LED_USB)->bLedWPSBlinkInProgress \ ++ || ((PLED_USB)_LED_USB)->bLedScanBlinkInProgress) ++ ++ ++typedef enum _LED_STRATEGY_USB { ++ SW_LED_MODE0, /* SW control 1 LED via GPIO0. It is default option. */ ++ SW_LED_MODE1, /* 2 LEDs, through LED0 and LED1. For ALPHA. */ ++ SW_LED_MODE2, /* SW control 1 LED via GPIO0, customized for AzWave 8187 minicard. */ ++ SW_LED_MODE3, /* SW control 1 LED via GPIO0, customized for Sercomm Printer Server case. */ ++ SW_LED_MODE4, /* for Edimax / Belkin */ ++ SW_LED_MODE5, /* for Sercomm / Belkin */ ++ SW_LED_MODE6, /* for 88CU minicard, porting from ce SW_LED_MODE7 */ ++ SW_LED_MODE7, /* for Netgear special requirement */ ++ SW_LED_MODE8, /* for LC */ ++ SW_LED_MODE9, /* for Belkin AC950 */ ++ SW_LED_MODE10, /* for Netgear A6200V2 */ ++ SW_LED_MODE11, /* for Edimax / ASUS */ ++ SW_LED_MODE12, /* for WNC/NEC */ ++ SW_LED_MODE13, /* for Netgear A6100, 8811Au */ ++ SW_LED_MODE14, /* for Buffalo, DNI, 8811Au */ ++ SW_LED_MODE15, /* for DLINK, 8811Au/8812AU */ ++ HW_LED, /* HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes, see MAC.CONFIG1 for details.) */ ++} LED_STRATEGY_USB, *PLED_STRATEGY_USB; ++ ++ ++typedef struct _LED_USB { ++ PADAPTER padapter; ++ ++ LED_PIN LedPin; /* Identify how to implement this SW led. */ ++ ++ LED_STATE CurrLedState; /* Current LED state. */ ++ BOOLEAN bLedOn; /* TRUE if LED is ON, FALSE if LED is OFF. */ ++ ++ BOOLEAN bSWLedCtrl; ++ ++ BOOLEAN bLedBlinkInProgress; /* TRUE if it is blinking, FALSE o.w.. */ ++ /* ALPHA, added by chiyoko, 20090106 */ ++ BOOLEAN bLedNoLinkBlinkInProgress; ++ BOOLEAN bLedLinkBlinkInProgress; ++ BOOLEAN bLedStartToLinkBlinkInProgress; ++ BOOLEAN bLedScanBlinkInProgress; ++ BOOLEAN bLedWPSBlinkInProgress; ++ ++ u32 BlinkTimes; /* Number of times to toggle led state for blinking. */ ++ u8 BlinkCounter; /* Added for turn off overlap led after blinking a while, by page, 20120821 */ ++ LED_STATE BlinkingLedState; /* Next state for blinking, either LED_ON or LED_OFF are. */ ++ ++ _timer BlinkTimer; /* Timer object for led blinking. */ ++ ++ _workitem BlinkWorkItem; /* Workitem used by BlinkTimer to manipulate H/W to blink LED.' */ ++} LED_USB, *PLED_USB; ++ ++typedef struct _LED_USB LED_DATA, *PLED_DATA; ++typedef enum _LED_STRATEGY_USB LED_STRATEGY, *PLED_STRATEGY; ++ ++VOID ++LedControlUSB( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++); ++ ++ ++/* ******************************************************************************** ++ * SDIO LED Definition. ++ * ******************************************************************************** */ ++#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ ++#define IS_LED_WPS_BLINKING(_LED_SDIO) (((PLED_SDIO)_LED_SDIO)->CurrLedState == LED_BLINK_WPS \ ++ || ((PLED_SDIO)_LED_SDIO)->CurrLedState == LED_BLINK_WPS_STOP \ ++ || ((PLED_SDIO)_LED_SDIO)->bLedWPSBlinkInProgress) ++ ++#define IS_LED_BLINKING(_LED_SDIO) (((PLED_SDIO)_LED_SDIO)->bLedWPSBlinkInProgress \ ++ || ((PLED_SDIO)_LED_SDIO)->bLedScanBlinkInProgress) ++ ++ ++typedef enum _LED_STRATEGY_SDIO { ++ SW_LED_MODE0, /* SW control 1 LED via GPIO0. It is default option. */ ++ SW_LED_MODE1, /* 2 LEDs, through LED0 and LED1. For ALPHA. */ ++ SW_LED_MODE2, /* SW control 1 LED via GPIO0, customized for AzWave 8187 minicard. */ ++ SW_LED_MODE3, /* SW control 1 LED via GPIO0, customized for Sercomm Printer Server case. */ ++ SW_LED_MODE4, /* for Edimax / Belkin */ ++ SW_LED_MODE5, /* for Sercomm / Belkin */ ++ SW_LED_MODE6, /* for 88CU minicard, porting from ce SW_LED_MODE7 */ ++ HW_LED, /* HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes, see MAC.CONFIG1 for details.) */ ++} LED_STRATEGY_SDIO, *PLED_STRATEGY_SDIO; ++ ++typedef struct _LED_SDIO { ++ PADAPTER padapter; ++ ++ LED_PIN LedPin; /* Identify how to implement this SW led. */ ++ ++ LED_STATE CurrLedState; /* Current LED state. */ ++ BOOLEAN bLedOn; /* TRUE if LED is ON, FALSE if LED is OFF. */ ++ ++ BOOLEAN bSWLedCtrl; ++ ++ BOOLEAN bLedBlinkInProgress; /* TRUE if it is blinking, FALSE o.w.. */ ++ /* ALPHA, added by chiyoko, 20090106 */ ++ BOOLEAN bLedNoLinkBlinkInProgress; ++ BOOLEAN bLedLinkBlinkInProgress; ++ BOOLEAN bLedStartToLinkBlinkInProgress; ++ BOOLEAN bLedScanBlinkInProgress; ++ BOOLEAN bLedWPSBlinkInProgress; ++ ++ u32 BlinkTimes; /* Number of times to toggle led state for blinking. */ ++ LED_STATE BlinkingLedState; /* Next state for blinking, either LED_ON or LED_OFF are. */ ++ ++ _timer BlinkTimer; /* Timer object for led blinking. */ ++ ++ _workitem BlinkWorkItem; /* Workitem used by BlinkTimer to manipulate H/W to blink LED. */ ++} LED_SDIO, *PLED_SDIO; ++ ++typedef struct _LED_SDIO LED_DATA, *PLED_DATA; ++typedef enum _LED_STRATEGY_SDIO LED_STRATEGY, *PLED_STRATEGY; ++ ++VOID ++LedControlSDIO( ++ IN PADAPTER Adapter, ++ IN LED_CTL_MODE LedAction ++); ++ ++#endif ++ ++struct led_priv { ++ /* add for led controll */ ++ LED_DATA SwLed0; ++ LED_DATA SwLed1; ++ LED_DATA SwLed2; ++ LED_STRATEGY LedStrategy; ++ u8 bRegUseLed; ++ void (*LedControlHandler)(_adapter *padapter, LED_CTL_MODE LedAction); ++ void (*SwLedOn)(_adapter *padapter, PLED_DATA pLed); ++ void (*SwLedOff)(_adapter *padapter, PLED_DATA pLed); ++ /* add for led controll */ ++}; ++ ++#ifdef CONFIG_SW_LED ++#define rtw_led_control(adapter, LedAction) \ ++ do { \ ++ if ((adapter)->ledpriv.LedControlHandler) \ ++ (adapter)->ledpriv.LedControlHandler((adapter), (LedAction)); \ ++ } while (0) ++#else /* CONFIG_SW_LED */ ++#define rtw_led_control(adapter, LedAction) ++#endif /* CONFIG_SW_LED */ ++ ++#define SwLedOn(adapter, pLed) \ ++ do { \ ++ if ((adapter)->ledpriv.SwLedOn) \ ++ (adapter)->ledpriv.SwLedOn((adapter), (pLed)); \ ++ } while (0) ++ ++#define SwLedOff(adapter, pLed) \ ++ do { \ ++ if ((adapter)->ledpriv.SwLedOff) \ ++ (adapter)->ledpriv.SwLedOff((adapter), (pLed)); \ ++ } while (0) ++ ++void BlinkTimerCallback(void *data); ++void BlinkWorkItemCallback(_workitem *work); ++ ++void ResetLedStatus(PLED_DATA pLed); ++ ++void ++InitLed( ++ _adapter *padapter, ++ PLED_DATA pLed, ++ LED_PIN LedPin ++); ++ ++void ++DeInitLed( ++ PLED_DATA pLed ++); ++ ++/* hal... */ ++extern void BlinkHandler(PLED_DATA pLed); ++ ++#endif /* __RTW_LED_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_com_phycfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_phycfg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_com_phycfg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_phycfg.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,348 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_COM_PHYCFG_H__ ++#define __HAL_COM_PHYCFG_H__ ++ ++#define PathA 0x0 /* Useless */ ++#define PathB 0x1 ++#define PathC 0x2 ++#define PathD 0x3 ++ ++typedef enum _RF_TX_NUM { ++ RF_1TX = 0, ++ RF_2TX, ++ RF_3TX, ++ RF_4TX, ++ RF_MAX_TX_NUM, ++ RF_TX_NUM_NONIMPLEMENT, ++} RF_TX_NUM; ++ ++#define MAX_POWER_INDEX 0x3F ++ ++typedef enum _REGULATION_TXPWR_LMT { ++ TXPWR_LMT_FCC = 0, ++ TXPWR_LMT_MKK = 1, ++ TXPWR_LMT_ETSI = 2, ++ TXPWR_LMT_WW = 3, ++ ++ TXPWR_LMT_MAX_REGULATION_NUM = 4 ++} REGULATION_TXPWR_LMT; ++ ++#define TX_PWR_LMT_REF_VHT_FROM_HT BIT0 ++#define TX_PWR_LMT_REF_HT_FROM_VHT BIT1 ++ ++/*------------------------------Define structure----------------------------*/ ++typedef struct _BB_REGISTER_DEFINITION { ++ u32 rfintfs; /* set software control: */ ++ /* 0x870~0x877[8 bytes] */ ++ ++ u32 rfintfo; /* output data: */ ++ /* 0x860~0x86f [16 bytes] */ ++ ++ u32 rfintfe; /* output enable: */ ++ /* 0x860~0x86f [16 bytes] */ ++ ++ u32 rf3wireOffset; /* LSSI data: */ ++ /* 0x840~0x84f [16 bytes] */ ++ ++ u32 rfHSSIPara2; /* wire parameter control2 : */ ++ /* 0x824~0x827,0x82c~0x82f, 0x834~0x837, 0x83c~0x83f [16 bytes] */ ++ ++ u32 rfLSSIReadBack; /* LSSI RF readback data SI mode */ ++ /* 0x8a0~0x8af [16 bytes] */ ++ ++ u32 rfLSSIReadBackPi; /* LSSI RF readback data PI mode 0x8b8-8bc for Path A and B */ ++ ++} BB_REGISTER_DEFINITION_T, *PBB_REGISTER_DEFINITION_T; ++ ++ ++/* ---------------------------------------------------------------------- */ ++u8 ++PHY_GetTxPowerByRateBase( ++ IN PADAPTER Adapter, ++ IN u8 Band, ++ IN u8 RfPath, ++ IN u8 TxNum, ++ IN RATE_SECTION RateSection ++); ++ ++VOID ++PHY_GetRateValuesOfTxPowerByRate( ++ IN PADAPTER pAdapter, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Value, ++ OUT u8 *Rate, ++ OUT s8 *PwrByRateVal, ++ OUT u8 *RateNum ++); ++ ++u8 ++PHY_GetRateIndexOfTxPowerByRate( ++ IN u8 Rate ++); ++ ++VOID ++PHY_SetTxPowerIndexByRateSection( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Channel, ++ IN u8 RateSection ++); ++ ++s8 ++_PHY_GetTxPowerByRate( ++ IN PADAPTER pAdapter, ++ IN u8 Band, ++ IN u8 RFPath, ++ IN u8 TxNum, ++ IN u8 RateIndex ++); ++ ++s8 ++PHY_GetTxPowerByRate( ++ IN PADAPTER pAdapter, ++ IN u8 Band, ++ IN u8 RFPath, ++ IN u8 TxNum, ++ IN u8 RateIndex ++); ++ ++#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI ++s8 ++PHY_GetTxPowerByRateOriginal( ++ IN PADAPTER pAdapter, ++ IN u8 Band, ++ IN u8 RFPath, ++ IN u8 TxNum, ++ IN u8 Rate ++); ++#endif ++ ++VOID ++PHY_SetTxPowerByRate( ++ IN PADAPTER pAdapter, ++ IN u8 Band, ++ IN u8 RFPath, ++ IN u8 TxNum, ++ IN u8 Rate, ++ IN s8 Value ++); ++ ++VOID ++PHY_SetTxPowerLevelByPath( ++ IN PADAPTER Adapter, ++ IN u8 channel, ++ IN u8 path ++); ++ ++VOID ++PHY_SetTxPowerIndexByRateArray( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN CHANNEL_WIDTH BandWidth, ++ IN u8 Channel, ++ IN u8 *Rates, ++ IN u8 RateArraySize ++); ++ ++VOID ++PHY_InitTxPowerByRate( ++ IN PADAPTER pAdapter ++); ++ ++VOID ++PHY_StoreTxPowerByRate( ++ IN PADAPTER pAdapter, ++ IN u32 Band, ++ IN u32 RfPath, ++ IN u32 TxNum, ++ IN u32 RegAddr, ++ IN u32 BitMask, ++ IN u32 Data ++); ++ ++VOID ++PHY_TxPowerByRateConfiguration( ++ IN PADAPTER pAdapter ++); ++ ++u8 ++PHY_GetTxPowerIndexBase( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN CHANNEL_WIDTH BandWidth, ++ IN u8 Channel, ++ OUT PBOOLEAN bIn24G ++); ++ ++s8 ++PHY_GetTxPowerLimit( ++ IN PADAPTER Adapter, ++ IN u32 RegPwrTblSel, ++ IN BAND_TYPE Band, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 RfPath, ++ IN u8 DataRate, ++ IN u8 Channel ++); ++ ++s8 ++PHY_GetTxPowerLimit_no_sc( ++ IN PADAPTER Adapter, ++ IN u32 RegPwrTblSel, ++ IN BAND_TYPE Band, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 RfPath, ++ IN u8 DataRate, ++ IN u8 Channel ++); ++ ++#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI ++s8 ++PHY_GetTxPowerLimitOriginal( ++ IN PADAPTER Adapter, ++ IN u32 RegPwrTblSel, ++ IN BAND_TYPE Band, ++ IN CHANNEL_WIDTH Bandwidth, ++ IN u8 RfPath, ++ IN u8 DataRate, ++ IN u8 Channel ++); ++#endif ++ ++VOID ++PHY_ConvertTxPowerLimitToPowerIndex( ++ IN PADAPTER Adapter ++); ++ ++VOID ++PHY_InitTxPowerLimit( ++ IN PADAPTER Adapter ++); ++ ++s8 ++PHY_GetTxPowerTrackingOffset( ++ PADAPTER pAdapter, ++ u8 Rate, ++ u8 RFPath ++); ++ ++struct txpwr_idx_comp { ++ u8 base; ++ s8 by_rate; ++ s8 limit; ++ s8 tpt; ++ s8 ebias; ++}; ++ ++u8 ++PHY_GetTxPowerIndex( ++ IN PADAPTER pAdapter, ++ IN u8 RFPath, ++ IN u8 Rate, ++ IN CHANNEL_WIDTH BandWidth, ++ IN u8 Channel ++); ++ ++VOID ++PHY_SetTxPowerIndex( ++ IN PADAPTER pAdapter, ++ IN u32 PowerIndex, ++ IN u8 RFPath, ++ IN u8 Rate ++); ++ ++void dump_tx_power_idx_title(void *sel, _adapter *adapter); ++void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath, u8 rs); ++void dump_tx_power_idx(void *sel, _adapter *adapter); ++ ++bool phy_is_tx_power_limit_needed(_adapter *adapter); ++bool phy_is_tx_power_by_rate_needed(_adapter *adapter); ++int phy_load_tx_power_by_rate(_adapter *adapter, u8 chk_file); ++int phy_load_tx_power_limit(_adapter *adapter, u8 chk_file); ++void phy_load_tx_power_ext_info(_adapter *adapter, u8 chk_file); ++void phy_reload_tx_power_ext_info(_adapter *adapter); ++void phy_reload_default_tx_power_ext_info(_adapter *adapter); ++ ++const struct map_t *hal_pg_txpwr_def_info(_adapter *adapter); ++ ++void dump_pg_txpwr_info_2g(void *sel, TxPowerInfo24G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt); ++void dump_pg_txpwr_info_5g(void *sel, TxPowerInfo5G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt); ++ ++void dump_hal_txpwr_info_2g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt); ++void dump_hal_txpwr_info_5g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt); ++ ++void hal_load_txpwr_info( ++ _adapter *adapter, ++ TxPowerInfo24G *pwr_info_2g, ++ TxPowerInfo5G *pwr_info_5g, ++ u8 *pg_data ++); ++ ++void dump_tx_power_ext_info(void *sel, _adapter *adapter); ++void dump_target_tx_power(void *sel, _adapter *adapter); ++void dump_tx_power_by_rate(void *sel, _adapter *adapter); ++void dump_tx_power_limit(void *sel, _adapter *adapter); ++ ++int rtw_get_phy_file_path(_adapter *adapter, const char *file_name); ++ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++#define MAC_FILE_FW_NIC "FW_NIC.bin" ++#define MAC_FILE_FW_WW_IMG "FW_WoWLAN.bin" ++#define PHY_FILE_MAC_REG "MAC_REG.txt" ++ ++#define PHY_FILE_AGC_TAB "AGC_TAB.txt" ++#define PHY_FILE_PHY_REG "PHY_REG.txt" ++#define PHY_FILE_PHY_REG_MP "PHY_REG_MP.txt" ++#define PHY_FILE_PHY_REG_PG "PHY_REG_PG.txt" ++ ++#define PHY_FILE_RADIO_A "RadioA.txt" ++#define PHY_FILE_RADIO_B "RadioB.txt" ++#define PHY_FILE_RADIO_C "RadioC.txt" ++#define PHY_FILE_RADIO_D "RadioD.txt" ++#define PHY_FILE_TXPWR_TRACK "TxPowerTrack.txt" ++#define PHY_FILE_TXPWR_LMT "TXPWR_LMT.txt" ++ ++#define PHY_FILE_WIFI_ANT_ISOLATION "wifi_ant_isolation.txt" ++ ++#define MAX_PARA_FILE_BUF_LEN 25600 ++ ++#define LOAD_MAC_PARA_FILE BIT0 ++#define LOAD_BB_PARA_FILE BIT1 ++#define LOAD_BB_PG_PARA_FILE BIT2 ++#define LOAD_BB_MP_PARA_FILE BIT3 ++#define LOAD_RF_PARA_FILE BIT4 ++#define LOAD_RF_TXPWR_TRACK_PARA_FILE BIT5 ++#define LOAD_RF_TXPWR_LMT_PARA_FILE BIT6 ++ ++int phy_ConfigMACWithParaFile(IN PADAPTER Adapter, IN char *pFileName); ++int phy_ConfigBBWithParaFile(IN PADAPTER Adapter, IN char *pFileName, IN u32 ConfigType); ++int phy_ConfigBBWithPgParaFile(IN PADAPTER Adapter, IN const char *pFileName); ++int phy_ConfigBBWithMpParaFile(IN PADAPTER Adapter, IN char *pFileName); ++int PHY_ConfigRFWithParaFile(IN PADAPTER Adapter, IN char *pFileName, IN u8 eRFPath); ++int PHY_ConfigRFWithTxPwrTrackParaFile(IN PADAPTER Adapter, IN char *pFileName); ++int PHY_ConfigRFWithPowerLimitTableParaFile(IN PADAPTER Adapter, IN const char *pFileName); ++void phy_free_filebuf_mask(_adapter *padapter, u8 mask); ++void phy_free_filebuf(_adapter *padapter); ++#endif /* CONFIG_LOAD_PHY_PARA_FROM_FILE */ ++ ++#endif /* __HAL_COMMON_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_com_reg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_reg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_com_reg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_reg.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,1819 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_COMMON_REG_H__ ++#define __HAL_COMMON_REG_H__ ++ ++ ++#define MAC_ADDR_LEN 6 ++ ++#define HAL_NAV_UPPER_UNIT 128 /* micro-second */ ++ ++/* 8188E PKT_BUFF_ACCESS_CTRL value */ ++#define TXPKT_BUF_SELECT 0x69 ++#define RXPKT_BUF_SELECT 0xA5 ++#define DISABLE_TRXPKT_BUF_ACCESS 0x0 ++ ++#ifndef RTW_HALMAC ++/* ************************************************************ ++* ++* ************************************************************ */ ++ ++/* ----------------------------------------------------- ++* ++* 0x0000h ~ 0x00FFh System Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_SYS_ISO_CTRL 0x0000 ++#define REG_SYS_FUNC_EN 0x0002 ++#define REG_APS_FSMCO 0x0004 ++#define REG_SYS_CLKR 0x0008 ++#define REG_SYS_CLK_CTRL REG_SYS_CLKR ++#define REG_9346CR 0x000A ++#define REG_SYS_EEPROM_CTRL 0x000A ++#define REG_EE_VPD 0x000C ++#define REG_AFE_MISC 0x0010 ++#define REG_SPS0_CTRL 0x0011 ++#define REG_SPS0_CTRL_6 0x0016 ++#define REG_POWER_OFF_IN_PROCESS 0x0017 ++#define REG_SPS_OCP_CFG 0x0018 ++#define REG_RSV_CTRL 0x001C ++#define REG_RF_CTRL 0x001F ++#define REG_LDOA15_CTRL 0x0020 ++#define REG_LDOV12D_CTRL 0x0021 ++#define REG_LDOHCI12_CTRL 0x0022 ++#define REG_LPLDO_CTRL 0x0023 ++#define REG_AFE_XTAL_CTRL 0x0024 ++#define REG_AFE_LDO_CTRL 0x0027 /* 1.5v for 8188EE test chip, 1.4v for MP chip */ ++#define REG_AFE_PLL_CTRL 0x0028 ++#define REG_MAC_PHY_CTRL 0x002c /* for 92d, DMDP, SMSP, DMSP contrl */ ++#define REG_APE_PLL_CTRL_EXT 0x002c ++#define REG_EFUSE_CTRL 0x0030 ++#define REG_EFUSE_TEST 0x0034 ++#define REG_PWR_DATA 0x0038 ++#define REG_CAL_TIMER 0x003C ++#define REG_ACLK_MON 0x003E ++#define REG_GPIO_MUXCFG 0x0040 ++#define REG_GPIO_IO_SEL 0x0042 ++#define REG_MAC_PINMUX_CFG 0x0043 ++#define REG_GPIO_PIN_CTRL 0x0044 ++#define REG_GPIO_INTM 0x0048 ++#define REG_LEDCFG0 0x004C ++#define REG_LEDCFG1 0x004D ++#define REG_LEDCFG2 0x004E ++#define REG_LEDCFG3 0x004F ++#define REG_FSIMR 0x0050 ++#define REG_FSISR 0x0054 ++#define REG_HSIMR 0x0058 ++#define REG_HSISR 0x005c ++#define REG_GPIO_PIN_CTRL_2 0x0060 /* RTL8723 WIFI/BT/GPS Multi-Function GPIO Pin Control. */ ++#define REG_GPIO_IO_SEL_2 0x0062 /* RTL8723 WIFI/BT/GPS Multi-Function GPIO Select. */ ++#define REG_PAD_CTRL_1 0x0064 ++#define REG_MULTI_FUNC_CTRL 0x0068 /* RTL8723 WIFI/BT/GPS Multi-Function control source. */ ++#define REG_GSSR 0x006c ++#define REG_AFE_XTAL_CTRL_EXT 0x0078 /* RTL8188E */ ++#define REG_XCK_OUT_CTRL 0x007c /* RTL8188E */ ++#define REG_MCUFWDL 0x0080 ++#define REG_WOL_EVENT 0x0081 /* RTL8188E */ ++#define REG_MCUTSTCFG 0x0084 ++#define REG_FDHM0 0x0088 ++#define REG_HOST_SUSP_CNT 0x00BC /* RTL8192C Host suspend counter on FPGA platform */ ++#define REG_SYSTEM_ON_CTRL 0x00CC /* For 8723AE Reset after S3 */ ++#define REG_EFUSE_ACCESS 0x00CF /* Efuse access protection for RTL8723 */ ++#define REG_BIST_SCAN 0x00D0 ++#define REG_BIST_RPT 0x00D4 ++#define REG_BIST_ROM_RPT 0x00D8 ++#define REG_USB_SIE_INTF 0x00E0 ++#define REG_PCIE_MIO_INTF 0x00E4 ++#define REG_PCIE_MIO_INTD 0x00E8 ++#define REG_HPON_FSM 0x00EC ++#define REG_SYS_CFG 0x00F0 ++#define REG_GPIO_OUTSTS 0x00F4 /* For RTL8723 only. */ ++#define REG_TYPE_ID 0x00FC ++ ++/* ++* 2010/12/29 MH Add for 92D ++* */ ++#define REG_MAC_PHY_CTRL_NORMAL 0x00f8 ++ ++ ++/* ----------------------------------------------------- ++* ++* 0x0100h ~ 0x01FFh MACTOP General Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_CR 0x0100 ++#define REG_PBP 0x0104 ++#define REG_PKT_BUFF_ACCESS_CTRL 0x0106 ++#define REG_TRXDMA_CTRL 0x010C ++#define REG_TRXFF_BNDY 0x0114 ++#define REG_TRXFF_STATUS 0x0118 ++#define REG_RXFF_PTR 0x011C ++#define REG_HIMR 0x0120 ++#define REG_HISR 0x0124 ++#define REG_HIMRE 0x0128 ++#define REG_HISRE 0x012C ++#define REG_CPWM 0x012F ++#define REG_FWIMR 0x0130 ++#define REG_FWISR 0x0134 ++#define REG_FTIMR 0x0138 ++#define REG_FTISR 0x013C /* RTL8192C */ ++#define REG_PKTBUF_DBG_CTRL 0x0140 ++#define REG_RXPKTBUF_CTRL (REG_PKTBUF_DBG_CTRL+2) ++#define REG_PKTBUF_DBG_DATA_L 0x0144 ++#define REG_PKTBUF_DBG_DATA_H 0x0148 ++ ++#define REG_TC0_CTRL 0x0150 ++#define REG_TC1_CTRL 0x0154 ++#define REG_TC2_CTRL 0x0158 ++#define REG_TC3_CTRL 0x015C ++#define REG_TC4_CTRL 0x0160 ++#define REG_TCUNIT_BASE 0x0164 ++#define REG_MBIST_START 0x0174 ++#define REG_MBIST_DONE 0x0178 ++#define REG_MBIST_FAIL 0x017C ++#define REG_32K_CTRL 0x0194 /* RTL8188E */ ++#define REG_C2HEVT_MSG_NORMAL 0x01A0 ++#define REG_C2HEVT_CLEAR 0x01AF ++#define REG_MCUTST_1 0x01c0 ++#define REG_MCUTST_WOWLAN 0x01C7 /* Defined after 8188E series. */ ++#define REG_FMETHR 0x01C8 ++#define REG_HMETFR 0x01CC ++#define REG_HMEBOX_0 0x01D0 ++#define REG_HMEBOX_1 0x01D4 ++#define REG_HMEBOX_2 0x01D8 ++#define REG_HMEBOX_3 0x01DC ++#define REG_LLT_INIT 0x01E0 ++#define REG_HMEBOX_EXT_0 0x01F0 ++#define REG_HMEBOX_EXT_1 0x01F4 ++#define REG_HMEBOX_EXT_2 0x01F8 ++#define REG_HMEBOX_EXT_3 0x01FC ++ ++ ++/* ----------------------------------------------------- ++* ++* 0x0200h ~ 0x027Fh TXDMA Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_RQPN 0x0200 ++#define REG_FIFOPAGE 0x0204 ++#define REG_TDECTRL 0x0208 ++#define REG_TXDMA_OFFSET_CHK 0x020C ++#define REG_TXDMA_STATUS 0x0210 ++#define REG_RQPN_NPQ 0x0214 ++#define REG_AUTO_LLT 0x0224 ++ ++ ++/* ----------------------------------------------------- ++* ++* 0x0280h ~ 0x02FFh RXDMA Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_RXDMA_AGG_PG_TH 0x0280 ++#define REG_RXPKT_NUM 0x0284 ++#define REG_RXDMA_STATUS 0x0288 ++ ++/* ----------------------------------------------------- ++* ++* 0x0300h ~ 0x03FFh PCIe ++* ++* ----------------------------------------------------- */ ++#ifndef CONFIG_TRX_BD_ARCH /* prevent CONFIG_TRX_BD_ARCH to use old registers */ ++ ++#define REG_PCIE_CTRL_REG 0x0300 ++#define REG_INT_MIG 0x0304 /* Interrupt Migration */ ++#define REG_BCNQ_DESA 0x0308 /* TX Beacon Descriptor Address */ ++#define REG_HQ_DESA 0x0310 /* TX High Queue Descriptor Address */ ++#define REG_MGQ_DESA 0x0318 /* TX Manage Queue Descriptor Address */ ++#define REG_VOQ_DESA 0x0320 /* TX VO Queue Descriptor Address */ ++#define REG_VIQ_DESA 0x0328 /* TX VI Queue Descriptor Address */ ++#define REG_BEQ_DESA 0x0330 /* TX BE Queue Descriptor Address */ ++#define REG_BKQ_DESA 0x0338 /* TX BK Queue Descriptor Address */ ++#define REG_RX_DESA 0x0340 /* RX Queue Descriptor Address */ ++/* sherry added for DBI Read/Write 20091126 */ ++#define REG_DBI_WDATA 0x0348 /* Backdoor REG for Access Configuration */ ++#define REG_DBI_RDATA 0x034C /* Backdoor REG for Access Configuration */ ++#define REG_DBI_CTRL 0x0350 /* Backdoor REG for Access Configuration */ ++#define REG_DBI_FLAG 0x0352 /* Backdoor REG for Access Configuration */ ++#define REG_MDIO 0x0354 /* MDIO for Access PCIE PHY */ ++#define REG_DBG_SEL 0x0360 /* Debug Selection Register */ ++#define REG_PCIE_HRPWM 0x0361 /* PCIe RPWM */ ++#define REG_PCIE_HCPWM 0x0363 /* PCIe CPWM */ ++#define REG_WATCH_DOG 0x0368 ++#define REG_RX_RXBD_NUM 0x0382 ++ ++/* RTL8723 series ------------------------------- */ ++#define REG_PCIE_HISR_EN 0x0394 /* PCIE Local Interrupt Enable Register */ ++#define REG_PCIE_HISR 0x03A0 ++#define REG_PCIE_HISRE 0x03A4 ++#define REG_PCIE_HIMR 0x03A8 ++#define REG_PCIE_HIMRE 0x03AC ++ ++#endif /* !CONFIG_TRX_BD_ARCH */ ++ ++#define REG_USB_HIMR 0xFE38 ++#define REG_USB_HIMRE 0xFE3C ++#define REG_USB_HISR 0xFE78 ++#define REG_USB_HISRE 0xFE7C ++ ++ ++/* ----------------------------------------------------- ++* ++* 0x0400h ~ 0x047Fh Protocol Configuration ++* ++* ----------------------------------------------------- */ ++ ++/* 92C, 92D */ ++#define REG_VOQ_INFO 0x0400 ++#define REG_VIQ_INFO 0x0404 ++#define REG_BEQ_INFO 0x0408 ++#define REG_BKQ_INFO 0x040C ++ ++/* 88E, 8723A, 8812A, 8821A, 92E, 8723B */ ++#define REG_Q0_INFO 0x400 ++#define REG_Q1_INFO 0x404 ++#define REG_Q2_INFO 0x408 ++#define REG_Q3_INFO 0x40C ++ ++#define REG_MGQ_INFO 0x0410 ++#define REG_HGQ_INFO 0x0414 ++#define REG_BCNQ_INFO 0x0418 ++#define REG_TXPKT_EMPTY 0x041A ++#define REG_CPU_MGQ_INFORMATION 0x041C ++#define REG_FWHW_TXQ_CTRL 0x0420 ++#define REG_HWSEQ_CTRL 0x0423 ++#define REG_BCNQ_BDNY 0x0424 ++#define REG_MGQ_BDNY 0x0425 ++#define REG_LIFETIME_CTRL 0x0426 ++#define REG_MULTI_BCNQ_OFFSET 0x0427 ++#define REG_SPEC_SIFS 0x0428 ++#define REG_RL 0x042A ++#define REG_DARFRC 0x0430 ++#define REG_RARFRC 0x0438 ++#define REG_RRSR 0x0440 ++#define REG_ARFR0 0x0444 ++#define REG_ARFR1 0x0448 ++#define REG_ARFR2 0x044C ++#define REG_ARFR3 0x0450 ++#define REG_CCK_CHECK 0x0454 ++#define REG_BCNQ1_BDNY 0x0457 ++ ++#define REG_AGGLEN_LMT 0x0458 ++#define REG_AMPDU_MIN_SPACE 0x045C ++#define REG_WMAC_LBK_BF_HD 0x045D ++#define REG_FAST_EDCA_CTRL 0x0460 ++#define REG_RD_RESP_PKT_TH 0x0463 ++ ++/* 8723A, 8812A, 8821A, 92E, 8723B */ ++#define REG_Q4_INFO 0x468 ++#define REG_Q5_INFO 0x46C ++#define REG_Q6_INFO 0x470 ++#define REG_Q7_INFO 0x474 ++ ++#define REG_INIRTS_RATE_SEL 0x0480 ++#define REG_INIDATA_RATE_SEL 0x0484 ++ ++/* 8723B, 92E, 8812A, 8821A*/ ++#define REG_MACID_SLEEP_3 0x0484 ++#define REG_MACID_SLEEP_1 0x0488 ++ ++#define REG_POWER_STAGE1 0x04B4 ++#define REG_POWER_STAGE2 0x04B8 ++#define REG_PKT_VO_VI_LIFE_TIME 0x04C0 ++#define REG_PKT_BE_BK_LIFE_TIME 0x04C2 ++#define REG_STBC_SETTING 0x04C4 ++#define REG_QUEUE_CTRL 0x04C6 ++#define REG_SINGLE_AMPDU_CTRL 0x04c7 ++#define REG_PROT_MODE_CTRL 0x04C8 ++#define REG_MAX_AGGR_NUM 0x04CA ++#define REG_RTS_MAX_AGGR_NUM 0x04CB ++#define REG_BAR_MODE_CTRL 0x04CC ++#define REG_RA_TRY_RATE_AGG_LMT 0x04CF ++ ++/* 8723A */ ++#define REG_MACID_DROP 0x04D0 ++ ++/* 88E */ ++#define REG_EARLY_MODE_CONTROL 0x04D0 ++ ++/* 8723B, 92E, 8812A, 8821A */ ++#define REG_MACID_SLEEP_2 0x04D0 ++ ++/* 8723A, 8723B, 92E, 8812A, 8821A */ ++#define REG_MACID_SLEEP 0x04D4 ++ ++#define REG_NQOS_SEQ 0x04DC ++#define REG_QOS_SEQ 0x04DE ++#define REG_NEED_CPU_HANDLE 0x04E0 ++#define REG_PKT_LOSE_RPT 0x04E1 ++#define REG_PTCL_ERR_STATUS 0x04E2 ++#define REG_TX_RPT_CTRL 0x04EC ++#define REG_TX_RPT_TIME 0x04F0 /* 2 byte */ ++#define REG_DUMMY 0x04FC ++ ++/* ----------------------------------------------------- ++* ++* 0x0500h ~ 0x05FFh EDCA Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_EDCA_VO_PARAM 0x0500 ++#define REG_EDCA_VI_PARAM 0x0504 ++#define REG_EDCA_BE_PARAM 0x0508 ++#define REG_EDCA_BK_PARAM 0x050C ++#define REG_BCNTCFG 0x0510 ++#define REG_PIFS 0x0512 ++#define REG_RDG_PIFS 0x0513 ++#define REG_SIFS_CTX 0x0514 ++#define REG_SIFS_TRX 0x0516 ++#define REG_TSFTR_SYN_OFFSET 0x0518 ++#define REG_AGGR_BREAK_TIME 0x051A ++#define REG_SLOT 0x051B ++#define REG_TX_PTCL_CTRL 0x0520 ++#define REG_TXPAUSE 0x0522 ++#define REG_DIS_TXREQ_CLR 0x0523 ++#define REG_RD_CTRL 0x0524 ++/* ++* Format for offset 540h-542h: ++* [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. ++* [7:4]: Reserved. ++* [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. ++* [23:20]: Reserved ++* Description: ++* | ++* |<--Setup--|--Hold------------>| ++* --------------|---------------------- ++* | ++* TBTT ++* Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. ++* Described by Designer Tim and Bruce, 2011-01-14. ++* */ ++#define REG_TBTT_PROHIBIT 0x0540 ++#define REG_RD_NAV_NXT 0x0544 ++#define REG_NAV_PROT_LEN 0x0546 ++#define REG_BCN_CTRL 0x0550 ++#define REG_BCN_CTRL_1 0x0551 ++#define REG_MBID_NUM 0x0552 ++#define REG_DUAL_TSF_RST 0x0553 ++#define REG_BCN_INTERVAL 0x0554 /* The same as REG_MBSSID_BCN_SPACE */ ++#define REG_DRVERLYINT 0x0558 ++#define REG_BCNDMATIM 0x0559 ++#define REG_ATIMWND 0x055A ++#define REG_USTIME_TSF 0x055C ++#define REG_BCN_MAX_ERR 0x055D ++#define REG_RXTSF_OFFSET_CCK 0x055E ++#define REG_RXTSF_OFFSET_OFDM 0x055F ++#define REG_TSFTR 0x0560 ++#define REG_TSFTR1 0x0568 /* HW Port 1 TSF Register */ ++#define REG_ATIMWND_1 0x0570 ++#define REG_P2P_CTWIN 0x0572 /* 1 Byte long (in unit of TU) */ ++#define REG_PSTIMER 0x0580 ++#define REG_TIMER0 0x0584 ++#define REG_TIMER1 0x0588 ++#define REG_ACMHWCTRL 0x05C0 ++#define REG_NOA_DESC_SEL 0x05CF ++#define REG_NOA_DESC_DURATION 0x05E0 ++#define REG_NOA_DESC_INTERVAL 0x05E4 ++#define REG_NOA_DESC_START 0x05E8 ++#define REG_NOA_DESC_COUNT 0x05EC ++ ++#define REG_DMC 0x05F0 /* Dual MAC Co-Existence Register */ ++#define REG_SCH_TX_CMD 0x05F8 ++ ++#define REG_FW_RESET_TSF_CNT_1 0x05FC ++#define REG_FW_RESET_TSF_CNT_0 0x05FD ++#define REG_FW_BCN_DIS_CNT 0x05FE ++ ++/* ----------------------------------------------------- ++* ++* 0x0600h ~ 0x07FFh WMAC Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_APSD_CTRL 0x0600 ++#define REG_BWOPMODE 0x0603 ++#define REG_TCR 0x0604 ++#define REG_RCR 0x0608 ++#define REG_RX_PKT_LIMIT 0x060C ++#define REG_RX_DLK_TIME 0x060D ++#define REG_RX_DRVINFO_SZ 0x060F ++ ++#define REG_MACID 0x0610 ++#define REG_BSSID 0x0618 ++#define REG_MAR 0x0620 ++#define REG_MBIDCAMCFG_1 0x0628 ++#define REG_MBIDCAMCFG_2 0x062C ++ ++#define REG_PNO_STATUS 0x0631 ++#define REG_USTIME_EDCA 0x0638 ++#define REG_MAC_SPEC_SIFS 0x063A ++/* 20100719 Joseph: Hardware register definition change. (HW datasheet v54) */ ++#define REG_RESP_SIFS_CCK 0x063C /* [15:8]SIFS_R2T_OFDM, [7:0]SIFS_R2T_CCK */ ++#define REG_RESP_SIFS_OFDM 0x063E /* [15:8]SIFS_T2T_OFDM, [7:0]SIFS_T2T_CCK */ ++ ++#define REG_ACKTO 0x0640 ++#define REG_CTS2TO 0x0641 ++#define REG_EIFS 0x0642 ++ ++ ++/* RXERR_RPT */ ++#define RXERR_TYPE_OFDM_PPDU 0 ++#define RXERR_TYPE_OFDM_FALSE_ALARM 1 ++#define RXERR_TYPE_OFDM_MPDU_OK 2 ++#define RXERR_TYPE_OFDM_MPDU_FAIL 3 ++#define RXERR_TYPE_CCK_PPDU 4 ++#define RXERR_TYPE_CCK_FALSE_ALARM 5 ++#define RXERR_TYPE_CCK_MPDU_OK 6 ++#define RXERR_TYPE_CCK_MPDU_FAIL 7 ++#define RXERR_TYPE_HT_PPDU 8 ++#define RXERR_TYPE_HT_FALSE_ALARM 9 ++#define RXERR_TYPE_HT_MPDU_TOTAL 10 ++#define RXERR_TYPE_HT_MPDU_OK 11 ++#define RXERR_TYPE_HT_MPDU_FAIL 12 ++#define RXERR_TYPE_RX_FULL_DROP 15 ++ ++#define RXERR_COUNTER_MASK 0xFFFFF ++#define RXERR_RPT_RST BIT(27) ++#define _RXERR_RPT_SEL(type) ((type) << 28) ++ ++/* ++* Note: ++* The NAV upper value is very important to WiFi 11n 5.2.3 NAV test. The default value is ++* always too small, but the WiFi TestPlan test by 25,000 microseconds of NAV through sending ++* CTS in the air. We must update this value greater than 25,000 microseconds to pass the item. ++* The offset of NAV_UPPER in 8192C Spec is incorrect, and the offset should be 0x0652. Commented ++* by SD1 Scott. ++* By Bruce, 2011-07-18. ++* */ ++#define REG_NAV_UPPER 0x0652 /* unit of 128 */ ++ ++/* WMA, BA, CCX */ ++#define REG_NAV_CTRL 0x0650 ++#define REG_BACAMCMD 0x0654 ++#define REG_BACAMCONTENT 0x0658 ++#define REG_LBDLY 0x0660 ++#define REG_FWDLY 0x0661 ++#define REG_RXERR_RPT 0x0664 ++#define REG_WMAC_TRXPTCL_CTL 0x0668 ++ ++/* Security */ ++#define REG_CAMCMD 0x0670 ++#define REG_CAMWRITE 0x0674 ++#define REG_CAMREAD 0x0678 ++#define REG_CAMDBG 0x067C ++#define REG_SECCFG 0x0680 ++ ++/* Power */ ++#define REG_WOW_CTRL 0x0690 ++#define REG_PS_RX_INFO 0x0692 ++#define REG_UAPSD_TID 0x0693 ++#define REG_WKFMCAM_CMD 0x0698 ++#define REG_WKFMCAM_NUM REG_WKFMCAM_CMD ++#define REG_WKFMCAM_RWD 0x069C ++#define REG_RXFLTMAP0 0x06A0 ++#define REG_RXFLTMAP1 0x06A2 ++#define REG_RXFLTMAP2 0x06A4 ++#define REG_BCN_PSR_RPT 0x06A8 ++#define REG_BT_COEX_TABLE 0x06C0 ++ ++/* Hardware Port 1 */ ++#define REG_MACID1 0x0700 ++#define REG_BSSID1 0x0708 ++/* Hardware Port 2 */ ++#define REG_MACID2 0x1620 ++#define REG_BSSID2 0x1628 ++/* Hardware Port 3*/ ++#define REG_MACID3 0x1630 ++#define REG_BSSID3 0x1638 ++/* Hardware Port 4 */ ++#define REG_MACID4 0x1640 ++#define REG_BSSID4 0x1648 ++ ++ ++#define REG_CR_EXT 0x1100 ++ ++/* ----------------------------------------------------- ++* ++* 0xFE00h ~ 0xFE55h USB Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_USB_INFO 0xFE17 ++#define REG_USB_SPECIAL_OPTION 0xFE55 ++#define REG_USB_DMA_AGG_TO 0xFE5B ++#define REG_USB_AGG_TO 0xFE5C ++#define REG_USB_AGG_TH 0xFE5D ++ ++#define REG_USB_HRPWM 0xFE58 ++#define REG_USB_HCPWM 0xFE57 ++ ++/* for 92DU high_Queue low_Queue Normal_Queue select */ ++#define REG_USB_High_NORMAL_Queue_Select_MAC0 0xFE44 ++/* #define REG_USB_LOW_Queue_Select_MAC0 0xFE45 */ ++#define REG_USB_High_NORMAL_Queue_Select_MAC1 0xFE47 ++/* #define REG_USB_LOW_Queue_Select_MAC1 0xFE48 */ ++ ++/* For test chip */ ++#define REG_TEST_USB_TXQS 0xFE48 ++#define REG_TEST_SIE_VID 0xFE60 /* 0xFE60~0xFE61 */ ++#define REG_TEST_SIE_PID 0xFE62 /* 0xFE62~0xFE63 */ ++#define REG_TEST_SIE_OPTIONAL 0xFE64 ++#define REG_TEST_SIE_CHIRP_K 0xFE65 ++#define REG_TEST_SIE_PHY 0xFE66 /* 0xFE66~0xFE6B */ ++#define REG_TEST_SIE_MAC_ADDR 0xFE70 /* 0xFE70~0xFE75 */ ++#define REG_TEST_SIE_STRING 0xFE80 /* 0xFE80~0xFEB9 */ ++ ++ ++/* For normal chip */ ++#define REG_NORMAL_SIE_VID 0xFE60 /* 0xFE60~0xFE61 */ ++#define REG_NORMAL_SIE_PID 0xFE62 /* 0xFE62~0xFE63 */ ++#define REG_NORMAL_SIE_OPTIONAL 0xFE64 ++#define REG_NORMAL_SIE_EP 0xFE65 /* 0xFE65~0xFE67 */ ++#define REG_NORMAL_SIE_PHY 0xFE68 /* 0xFE68~0xFE6B */ ++#define REG_NORMAL_SIE_OPTIONAL2 0xFE6C ++#define REG_NORMAL_SIE_GPS_EP 0xFE6D /* 0xFE6D, for RTL8723 only. */ ++#define REG_NORMAL_SIE_MAC_ADDR 0xFE70 /* 0xFE70~0xFE75 */ ++#define REG_NORMAL_SIE_STRING 0xFE80 /* 0xFE80~0xFEDF */ ++ ++ ++/* ----------------------------------------------------- ++* ++* Redifine 8192C register definition for compatibility ++* ++* ----------------------------------------------------- */ ++ ++/* TODO: use these definition when using REG_xxx naming rule. ++* NOTE: DO NOT Remove these definition. Use later. */ ++ ++#define EFUSE_CTRL REG_EFUSE_CTRL /* E-Fuse Control. */ ++#define EFUSE_TEST REG_EFUSE_TEST /* E-Fuse Test. */ ++#define MSR (REG_CR + 2) /* Media Status register */ ++/* #define ISR REG_HISR */ ++#define MSR1 REG_CR_EXT ++ ++#define TSFR REG_TSFTR /* Timing Sync Function Timer Register. */ ++#define TSFR1 REG_TSFTR1 /* HW Port 1 TSF Register */ ++ ++#define PBP REG_PBP ++ ++/* Redifine MACID register, to compatible prior ICs. */ ++#define IDR0 REG_MACID /* MAC ID Register, Offset 0x0050-0x0053 */ ++#define IDR4 (REG_MACID + 4) /* MAC ID Register, Offset 0x0054-0x0055 */ ++ ++ ++/* ++* 9. Security Control Registers (Offset: ) ++* */ ++#define RWCAM REG_CAMCMD /* IN 8190 Data Sheet is called CAMcmd */ ++#define WCAMI REG_CAMWRITE /* Software write CAM input content */ ++#define RCAMO REG_CAMREAD /* Software read/write CAM config */ ++#define CAMDBG REG_CAMDBG ++#define SECR REG_SECCFG /* Security Configuration Register */ ++ ++/* Unused register */ ++#define UnusedRegister 0x1BF ++#define DCAM UnusedRegister ++#define PSR UnusedRegister ++#define BBAddr UnusedRegister ++#define PhyDataR UnusedRegister ++ ++/* Min Spacing related settings. */ ++#define MAX_MSS_DENSITY_2T 0x13 ++#define MAX_MSS_DENSITY_1T 0x0A ++ ++/* ---------------------------------------------------------------------------- ++* 8192C Cmd9346CR bits (Offset 0xA, 16bit) ++* ---------------------------------------------------------------------------- */ ++#define CmdEEPROM_En BIT5 /* EEPROM enable when set 1 */ ++#define CmdEERPOMSEL BIT4 /* System EEPROM select, 0: boot from E-FUSE, 1: The EEPROM used is 9346 */ ++#define Cmd9346CR_9356SEL BIT4 ++ ++/* ---------------------------------------------------------------------------- ++* 8192C GPIO MUX Configuration Register (offset 0x40, 4 byte) ++* ---------------------------------------------------------------------------- */ ++#define GPIOSEL_GPIO 0 ++#define GPIOSEL_ENBT BIT5 ++ ++/* ---------------------------------------------------------------------------- ++* 8192C GPIO PIN Control Register (offset 0x44, 4 byte) ++* ---------------------------------------------------------------------------- */ ++#define GPIO_IN REG_GPIO_PIN_CTRL /* GPIO pins input value */ ++#define GPIO_OUT (REG_GPIO_PIN_CTRL+1) /* GPIO pins output value */ ++#define GPIO_IO_SEL (REG_GPIO_PIN_CTRL+2) /* GPIO pins output enable when a bit is set to "1"; otherwise, input is configured. */ ++#define GPIO_MOD (REG_GPIO_PIN_CTRL+3) ++ ++/* ---------------------------------------------------------------------------- ++* 8811A GPIO PIN Control Register (offset 0x60, 4 byte) ++* ---------------------------------------------------------------------------- */ ++#define GPIO_IN_8811A REG_GPIO_PIN_CTRL_2 /* GPIO pins input value */ ++#define GPIO_OUT_8811A (REG_GPIO_PIN_CTRL_2+1) /* GPIO pins output value */ ++#define GPIO_IO_SEL_8811A (REG_GPIO_PIN_CTRL_2+2) /* GPIO pins output enable when a bit is set to "1"; otherwise, input is configured. */ ++#define GPIO_MOD_8811A (REG_GPIO_PIN_CTRL_2+3) ++ ++/* ---------------------------------------------------------------------------- ++* 8723/8188E Host System Interrupt Mask Register (offset 0x58, 32 byte) ++* ---------------------------------------------------------------------------- */ ++#define HSIMR_GPIO12_0_INT_EN BIT0 ++#define HSIMR_SPS_OCP_INT_EN BIT5 ++#define HSIMR_RON_INT_EN BIT6 ++#define HSIMR_PDN_INT_EN BIT7 ++#define HSIMR_GPIO9_INT_EN BIT25 ++ ++/* ---------------------------------------------------------------------------- ++* 8723/8188E Host System Interrupt Status Register (offset 0x5C, 32 byte) ++* ---------------------------------------------------------------------------- */ ++#define HSISR_GPIO12_0_INT BIT0 ++#define HSISR_SPS_OCP_INT BIT5 ++#define HSISR_RON_INT BIT6 ++#define HSISR_PDNINT BIT7 ++#define HSISR_GPIO9_INT BIT25 ++ ++/* ---------------------------------------------------------------------------- ++* 8192C (MSR) Media Status Register (Offset 0x4C, 8 bits) ++* ---------------------------------------------------------------------------- */ ++/* ++Network Type ++00: No link ++01: Link in ad hoc network ++10: Link in infrastructure network ++11: AP mode ++Default: 00b. ++*/ ++#define MSR_NOLINK 0x00 ++#define MSR_ADHOC 0x01 ++#define MSR_INFRA 0x02 ++#define MSR_AP 0x03 ++ ++/* ---------------------------------------------------------------------------- ++* USB INTR CONTENT ++* ---------------------------------------------------------------------------- */ ++#define USB_C2H_CMDID_OFFSET 0 ++#define USB_C2H_SEQ_OFFSET 1 ++#define USB_C2H_EVENT_OFFSET 2 ++#define USB_INTR_CPWM_OFFSET 16 ++#define USB_INTR_CONTENT_C2H_OFFSET 0 ++#define USB_INTR_CONTENT_CPWM1_OFFSET 16 ++#define USB_INTR_CONTENT_CPWM2_OFFSET 20 ++#define USB_INTR_CONTENT_HISR_OFFSET 48 ++#define USB_INTR_CONTENT_HISRE_OFFSET 52 ++#define USB_INTR_CONTENT_LENGTH 56 ++ ++/* ---------------------------------------------------------------------------- ++* Response Rate Set Register (offset 0x440, 24bits) ++* ---------------------------------------------------------------------------- */ ++#define RRSR_1M BIT0 ++#define RRSR_2M BIT1 ++#define RRSR_5_5M BIT2 ++#define RRSR_11M BIT3 ++#define RRSR_6M BIT4 ++#define RRSR_9M BIT5 ++#define RRSR_12M BIT6 ++#define RRSR_18M BIT7 ++#define RRSR_24M BIT8 ++#define RRSR_36M BIT9 ++#define RRSR_48M BIT10 ++#define RRSR_54M BIT11 ++#define RRSR_MCS0 BIT12 ++#define RRSR_MCS1 BIT13 ++#define RRSR_MCS2 BIT14 ++#define RRSR_MCS3 BIT15 ++#define RRSR_MCS4 BIT16 ++#define RRSR_MCS5 BIT17 ++#define RRSR_MCS6 BIT18 ++#define RRSR_MCS7 BIT19 ++ ++#define RRSR_CCK_RATES (RRSR_11M | RRSR_5_5M | RRSR_2M | RRSR_1M) ++#define RRSR_OFDM_RATES (RRSR_54M | RRSR_48M | RRSR_36M | RRSR_24M | RRSR_18M | RRSR_12M | RRSR_9M | RRSR_6M) ++ ++/* WOL bit information */ ++#define HAL92C_WOL_PTK_UPDATE_EVENT BIT0 ++#define HAL92C_WOL_GTK_UPDATE_EVENT BIT1 ++#define HAL92C_WOL_DISASSOC_EVENT BIT2 ++#define HAL92C_WOL_DEAUTH_EVENT BIT3 ++#define HAL92C_WOL_FW_DISCONNECT_EVENT BIT4 ++ ++ ++/*---------------------------------------------------------------------------- ++** REG_CCK_CHECK (offset 0x454) ++------------------------------------------------------------------------------*/ ++#define BIT_BCN_PORT_SEL BIT5 ++ ++#endif /* RTW_HALMAC */ ++ ++/* ---------------------------------------------------------------------------- ++ * Rate Definition ++ * ---------------------------------------------------------------------------- */ ++/* CCK */ ++#define RATR_1M 0x00000001 ++#define RATR_2M 0x00000002 ++#define RATR_55M 0x00000004 ++#define RATR_11M 0x00000008 ++/* OFDM */ ++#define RATR_6M 0x00000010 ++#define RATR_9M 0x00000020 ++#define RATR_12M 0x00000040 ++#define RATR_18M 0x00000080 ++#define RATR_24M 0x00000100 ++#define RATR_36M 0x00000200 ++#define RATR_48M 0x00000400 ++#define RATR_54M 0x00000800 ++/* MCS 1 Spatial Stream */ ++#define RATR_MCS0 0x00001000 ++#define RATR_MCS1 0x00002000 ++#define RATR_MCS2 0x00004000 ++#define RATR_MCS3 0x00008000 ++#define RATR_MCS4 0x00010000 ++#define RATR_MCS5 0x00020000 ++#define RATR_MCS6 0x00040000 ++#define RATR_MCS7 0x00080000 ++/* MCS 2 Spatial Stream */ ++#define RATR_MCS8 0x00100000 ++#define RATR_MCS9 0x00200000 ++#define RATR_MCS10 0x00400000 ++#define RATR_MCS11 0x00800000 ++#define RATR_MCS12 0x01000000 ++#define RATR_MCS13 0x02000000 ++#define RATR_MCS14 0x04000000 ++#define RATR_MCS15 0x08000000 ++ ++/* CCK */ ++#define RATE_1M BIT(0) ++#define RATE_2M BIT(1) ++#define RATE_5_5M BIT(2) ++#define RATE_11M BIT(3) ++/* OFDM */ ++#define RATE_6M BIT(4) ++#define RATE_9M BIT(5) ++#define RATE_12M BIT(6) ++#define RATE_18M BIT(7) ++#define RATE_24M BIT(8) ++#define RATE_36M BIT(9) ++#define RATE_48M BIT(10) ++#define RATE_54M BIT(11) ++/* MCS 1 Spatial Stream */ ++#define RATE_MCS0 BIT(12) ++#define RATE_MCS1 BIT(13) ++#define RATE_MCS2 BIT(14) ++#define RATE_MCS3 BIT(15) ++#define RATE_MCS4 BIT(16) ++#define RATE_MCS5 BIT(17) ++#define RATE_MCS6 BIT(18) ++#define RATE_MCS7 BIT(19) ++/* MCS 2 Spatial Stream */ ++#define RATE_MCS8 BIT(20) ++#define RATE_MCS9 BIT(21) ++#define RATE_MCS10 BIT(22) ++#define RATE_MCS11 BIT(23) ++#define RATE_MCS12 BIT(24) ++#define RATE_MCS13 BIT(25) ++#define RATE_MCS14 BIT(26) ++#define RATE_MCS15 BIT(27) ++ ++ ++/* ALL CCK Rate */ ++#define RATE_ALL_CCK (RATR_1M | RATR_2M | RATR_55M | RATR_11M) ++#define RATE_ALL_OFDM_AG (RATR_6M | RATR_9M | RATR_12M | RATR_18M | RATR_24M|\ ++ RATR_36M | RATR_48M | RATR_54M) ++#define RATE_ALL_OFDM_1SS (RATR_MCS0 | RATR_MCS1 | RATR_MCS2 | RATR_MCS3 |\ ++ RATR_MCS4 | RATR_MCS5 | RATR_MCS6 | RATR_MCS7) ++#define RATE_ALL_OFDM_2SS (RATR_MCS8 | RATR_MCS9 | RATR_MCS10 | RATR_MCS11|\ ++ RATR_MCS12 | RATR_MCS13 | RATR_MCS14 | RATR_MCS15) ++ ++#define RATE_BITMAP_ALL 0xFFFFF ++ ++/* Only use CCK 1M rate for ACK */ ++#define RATE_RRSR_CCK_ONLY_1M 0xFFFF1 ++#define RATE_RRSR_WITHOUT_CCK 0xFFFF0 ++ ++/* ---------------------------------------------------------------------------- ++ * BW_OPMODE bits (Offset 0x603, 8bit) ++ * ---------------------------------------------------------------------------- */ ++#define BW_OPMODE_20MHZ BIT2 ++#define BW_OPMODE_5G BIT1 ++ ++/* ---------------------------------------------------------------------------- ++ * CAM Config Setting (offset 0x680, 1 byte) ++ * ---------------------------------------------------------------------------- */ ++#define CAM_VALID BIT15 ++#define CAM_NOTVALID 0x0000 ++#define CAM_USEDK BIT5 ++ ++#define CAM_CONTENT_COUNT 8 ++ ++#define CAM_NONE 0x0 ++#define CAM_WEP40 0x01 ++#define CAM_TKIP 0x02 ++#define CAM_AES 0x04 ++#define CAM_WEP104 0x05 ++#define CAM_SMS4 0x6 ++ ++#define TOTAL_CAM_ENTRY 32 ++#define HALF_CAM_ENTRY 16 ++ ++#define CAM_CONFIG_USEDK _TRUE ++#define CAM_CONFIG_NO_USEDK _FALSE ++ ++#define CAM_WRITE BIT16 ++#define CAM_READ 0x00000000 ++#define CAM_POLLINIG BIT31 ++ ++/* ++ * 10. Power Save Control Registers ++ * */ ++#define WOW_PMEN BIT0 /* Power management Enable. */ ++#define WOW_WOMEN BIT1 /* WoW function on or off. */ ++#define WOW_MAGIC BIT2 /* Magic packet */ ++#define WOW_UWF BIT3 /* Unicast Wakeup frame. */ ++ ++/* ++ * 12. Host Interrupt Status Registers ++ * ++ * ---------------------------------------------------------------------------- ++ * 8190 IMR/ISR bits ++ * ---------------------------------------------------------------------------- */ ++#define IMR8190_DISABLED 0x0 ++#define IMR_DISABLED 0x0 ++/* IMR DW0 Bit 0-31 */ ++#define IMR_BCNDMAINT6 BIT31 /* Beacon DMA Interrupt 6 */ ++#define IMR_BCNDMAINT5 BIT30 /* Beacon DMA Interrupt 5 */ ++#define IMR_BCNDMAINT4 BIT29 /* Beacon DMA Interrupt 4 */ ++#define IMR_BCNDMAINT3 BIT28 /* Beacon DMA Interrupt 3 */ ++#define IMR_BCNDMAINT2 BIT27 /* Beacon DMA Interrupt 2 */ ++#define IMR_BCNDMAINT1 BIT26 /* Beacon DMA Interrupt 1 */ ++#define IMR_BCNDOK8 BIT25 /* Beacon Queue DMA OK Interrup 8 */ ++#define IMR_BCNDOK7 BIT24 /* Beacon Queue DMA OK Interrup 7 */ ++#define IMR_BCNDOK6 BIT23 /* Beacon Queue DMA OK Interrup 6 */ ++#define IMR_BCNDOK5 BIT22 /* Beacon Queue DMA OK Interrup 5 */ ++#define IMR_BCNDOK4 BIT21 /* Beacon Queue DMA OK Interrup 4 */ ++#define IMR_BCNDOK3 BIT20 /* Beacon Queue DMA OK Interrup 3 */ ++#define IMR_BCNDOK2 BIT19 /* Beacon Queue DMA OK Interrup 2 */ ++#define IMR_BCNDOK1 BIT18 /* Beacon Queue DMA OK Interrup 1 */ ++#define IMR_TIMEOUT2 BIT17 /* Timeout interrupt 2 */ ++#define IMR_TIMEOUT1 BIT16 /* Timeout interrupt 1 */ ++#define IMR_TXFOVW BIT15 /* Transmit FIFO Overflow */ ++#define IMR_PSTIMEOUT BIT14 /* Power save time out interrupt */ ++#define IMR_BcnInt BIT13 /* Beacon DMA Interrupt 0 */ ++#define IMR_RXFOVW BIT12 /* Receive FIFO Overflow */ ++#define IMR_RDU BIT11 /* Receive Descriptor Unavailable */ ++#define IMR_ATIMEND BIT10 /* For 92C, ATIM Window End Interrupt. For 8723 and later ICs, it also means P2P CTWin End interrupt. */ ++#define IMR_BDOK BIT9 /* Beacon Queue DMA OK Interrup */ ++#define IMR_HIGHDOK BIT8 /* High Queue DMA OK Interrupt */ ++#define IMR_TBDOK BIT7 /* Transmit Beacon OK interrup */ ++#define IMR_MGNTDOK BIT6 /* Management Queue DMA OK Interrupt */ ++#define IMR_TBDER BIT5 /* For 92C, Transmit Beacon Error Interrupt */ ++#define IMR_BKDOK BIT4 /* AC_BK DMA OK Interrupt */ ++#define IMR_BEDOK BIT3 /* AC_BE DMA OK Interrupt */ ++#define IMR_VIDOK BIT2 /* AC_VI DMA OK Interrupt */ ++#define IMR_VODOK BIT1 /* AC_VO DMA Interrupt */ ++#define IMR_ROK BIT0 /* Receive DMA OK Interrupt */ ++ ++/* 13. Host Interrupt Status Extension Register (Offset: 0x012C-012Eh) */ ++#define IMR_TSF_BIT32_TOGGLE BIT15 ++#define IMR_BcnInt_E BIT12 ++#define IMR_TXERR BIT11 ++#define IMR_RXERR BIT10 ++#define IMR_C2HCMD BIT9 ++#define IMR_CPWM BIT8 ++/* RSVD [2-7] */ ++#define IMR_OCPINT BIT1 ++#define IMR_WLANOFF BIT0 ++ ++/* ---------------------------------------------------------------------------- ++ * 8723E series PCIE Host IMR/ISR bit ++ * ---------------------------------------------------------------------------- */ ++/* IMR DW0 Bit 0-31 */ ++#define PHIMR_TIMEOUT2 BIT31 ++#define PHIMR_TIMEOUT1 BIT30 ++#define PHIMR_PSTIMEOUT BIT29 ++#define PHIMR_GTINT4 BIT28 ++#define PHIMR_GTINT3 BIT27 ++#define PHIMR_TXBCNERR BIT26 ++#define PHIMR_TXBCNOK BIT25 ++#define PHIMR_TSF_BIT32_TOGGLE BIT24 ++#define PHIMR_BCNDMAINT3 BIT23 ++#define PHIMR_BCNDMAINT2 BIT22 ++#define PHIMR_BCNDMAINT1 BIT21 ++#define PHIMR_BCNDMAINT0 BIT20 ++#define PHIMR_BCNDOK3 BIT19 ++#define PHIMR_BCNDOK2 BIT18 ++#define PHIMR_BCNDOK1 BIT17 ++#define PHIMR_BCNDOK0 BIT16 ++#define PHIMR_HSISR_IND_ON BIT15 ++#define PHIMR_BCNDMAINT_E BIT14 ++#define PHIMR_ATIMEND_E BIT13 ++#define PHIMR_ATIM_CTW_END BIT12 ++#define PHIMR_HISRE_IND BIT11 /* RO. HISRE Indicator (HISRE & HIMRE is true, this bit is set to 1) */ ++#define PHIMR_C2HCMD BIT10 ++#define PHIMR_CPWM2 BIT9 ++#define PHIMR_CPWM BIT8 ++#define PHIMR_HIGHDOK BIT7 /* High Queue DMA OK Interrupt */ ++#define PHIMR_MGNTDOK BIT6 /* Management Queue DMA OK Interrupt */ ++#define PHIMR_BKDOK BIT5 /* AC_BK DMA OK Interrupt */ ++#define PHIMR_BEDOK BIT4 /* AC_BE DMA OK Interrupt */ ++#define PHIMR_VIDOK BIT3 /* AC_VI DMA OK Interrupt */ ++#define PHIMR_VODOK BIT2 /* AC_VO DMA Interrupt */ ++#define PHIMR_RDU BIT1 /* Receive Descriptor Unavailable */ ++#define PHIMR_ROK BIT0 /* Receive DMA OK Interrupt */ ++ ++/* PCIE Host Interrupt Status Extension bit */ ++#define PHIMR_BCNDMAINT7 BIT23 ++#define PHIMR_BCNDMAINT6 BIT22 ++#define PHIMR_BCNDMAINT5 BIT21 ++#define PHIMR_BCNDMAINT4 BIT20 ++#define PHIMR_BCNDOK7 BIT19 ++#define PHIMR_BCNDOK6 BIT18 ++#define PHIMR_BCNDOK5 BIT17 ++#define PHIMR_BCNDOK4 BIT16 ++/* bit12 15: RSVD */ ++#define PHIMR_TXERR BIT11 ++#define PHIMR_RXERR BIT10 ++#define PHIMR_TXFOVW BIT9 ++#define PHIMR_RXFOVW BIT8 ++/* bit2-7: RSVD */ ++#define PHIMR_OCPINT BIT1 ++/* bit0: RSVD */ ++ ++#define UHIMR_TIMEOUT2 BIT31 ++#define UHIMR_TIMEOUT1 BIT30 ++#define UHIMR_PSTIMEOUT BIT29 ++#define UHIMR_GTINT4 BIT28 ++#define UHIMR_GTINT3 BIT27 ++#define UHIMR_TXBCNERR BIT26 ++#define UHIMR_TXBCNOK BIT25 ++#define UHIMR_TSF_BIT32_TOGGLE BIT24 ++#define UHIMR_BCNDMAINT3 BIT23 ++#define UHIMR_BCNDMAINT2 BIT22 ++#define UHIMR_BCNDMAINT1 BIT21 ++#define UHIMR_BCNDMAINT0 BIT20 ++#define UHIMR_BCNDOK3 BIT19 ++#define UHIMR_BCNDOK2 BIT18 ++#define UHIMR_BCNDOK1 BIT17 ++#define UHIMR_BCNDOK0 BIT16 ++#define UHIMR_HSISR_IND BIT15 ++#define UHIMR_BCNDMAINT_E BIT14 ++/* RSVD BIT13 */ ++#define UHIMR_CTW_END BIT12 ++/* RSVD BIT11 */ ++#define UHIMR_C2HCMD BIT10 ++#define UHIMR_CPWM2 BIT9 ++#define UHIMR_CPWM BIT8 ++#define UHIMR_HIGHDOK BIT7 /* High Queue DMA OK Interrupt */ ++#define UHIMR_MGNTDOK BIT6 /* Management Queue DMA OK Interrupt */ ++#define UHIMR_BKDOK BIT5 /* AC_BK DMA OK Interrupt */ ++#define UHIMR_BEDOK BIT4 /* AC_BE DMA OK Interrupt */ ++#define UHIMR_VIDOK BIT3 /* AC_VI DMA OK Interrupt */ ++#define UHIMR_VODOK BIT2 /* AC_VO DMA Interrupt */ ++#define UHIMR_RDU BIT1 /* Receive Descriptor Unavailable */ ++#define UHIMR_ROK BIT0 /* Receive DMA OK Interrupt */ ++ ++/* USB Host Interrupt Status Extension bit */ ++#define UHIMR_BCNDMAINT7 BIT23 ++#define UHIMR_BCNDMAINT6 BIT22 ++#define UHIMR_BCNDMAINT5 BIT21 ++#define UHIMR_BCNDMAINT4 BIT20 ++#define UHIMR_BCNDOK7 BIT19 ++#define UHIMR_BCNDOK6 BIT18 ++#define UHIMR_BCNDOK5 BIT17 ++#define UHIMR_BCNDOK4 BIT16 ++/* bit14-15: RSVD */ ++#define UHIMR_ATIMEND_E BIT13 ++#define UHIMR_ATIMEND BIT12 ++#define UHIMR_TXERR BIT11 ++#define UHIMR_RXERR BIT10 ++#define UHIMR_TXFOVW BIT9 ++#define UHIMR_RXFOVW BIT8 ++/* bit2-7: RSVD */ ++#define UHIMR_OCPINT BIT1 ++/* bit0: RSVD */ ++ ++ ++#define HAL_NIC_UNPLUG_ISR 0xFFFFFFFF /* The value when the NIC is unplugged for PCI. */ ++#define HAL_NIC_UNPLUG_PCI_ISR 0xEAEAEAEA /* The value when the NIC is unplugged for PCI in PCI interrupt (page 3). */ ++ ++/* ---------------------------------------------------------------------------- ++ * 8188 IMR/ISR bits ++ * ---------------------------------------------------------------------------- */ ++#define IMR_DISABLED_88E 0x0 ++/* IMR DW0(0x0060-0063) Bit 0-31 */ ++#define IMR_TXCCK_88E BIT30 /* TXRPT interrupt when CCX bit of the packet is set */ ++#define IMR_PSTIMEOUT_88E BIT29 /* Power Save Time Out Interrupt */ ++#define IMR_GTINT4_88E BIT28 /* When GTIMER4 expires, this bit is set to 1 */ ++#define IMR_GTINT3_88E BIT27 /* When GTIMER3 expires, this bit is set to 1 */ ++#define IMR_TBDER_88E BIT26 /* Transmit Beacon0 Error */ ++#define IMR_TBDOK_88E BIT25 /* Transmit Beacon0 OK */ ++#define IMR_TSF_BIT32_TOGGLE_88E BIT24 /* TSF Timer BIT32 toggle indication interrupt */ ++#define IMR_BCNDMAINT0_88E BIT20 /* Beacon DMA Interrupt 0 */ ++#define IMR_BCNDERR0_88E BIT16 /* Beacon Queue DMA Error 0 */ ++#define IMR_HSISR_IND_ON_INT_88E BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ ++#define IMR_BCNDMAINT_E_88E BIT14 /* Beacon DMA Interrupt Extension for Win7 */ ++#define IMR_ATIMEND_88E BIT12 /* CTWidnow End or ATIM Window End */ ++#define IMR_HISR1_IND_INT_88E BIT11 /* HISR1 Indicator (HISR1 & HIMR1 is true, this bit is set to 1) */ ++#define IMR_C2HCMD_88E BIT10 /* CPU to Host Command INT Status, Write 1 clear */ ++#define IMR_CPWM2_88E BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_CPWM_88E BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_HIGHDOK_88E BIT7 /* High Queue DMA OK */ ++#define IMR_MGNTDOK_88E BIT6 /* Management Queue DMA OK */ ++#define IMR_BKDOK_88E BIT5 /* AC_BK DMA OK */ ++#define IMR_BEDOK_88E BIT4 /* AC_BE DMA OK */ ++#define IMR_VIDOK_88E BIT3 /* AC_VI DMA OK */ ++#define IMR_VODOK_88E BIT2 /* AC_VO DMA OK */ ++#define IMR_RDU_88E BIT1 /* Rx Descriptor Unavailable */ ++#define IMR_ROK_88E BIT0 /* Receive DMA OK */ ++ ++/* IMR DW1(0x00B4-00B7) Bit 0-31 */ ++#define IMR_BCNDMAINT7_88E BIT27 /* Beacon DMA Interrupt 7 */ ++#define IMR_BCNDMAINT6_88E BIT26 /* Beacon DMA Interrupt 6 */ ++#define IMR_BCNDMAINT5_88E BIT25 /* Beacon DMA Interrupt 5 */ ++#define IMR_BCNDMAINT4_88E BIT24 /* Beacon DMA Interrupt 4 */ ++#define IMR_BCNDMAINT3_88E BIT23 /* Beacon DMA Interrupt 3 */ ++#define IMR_BCNDMAINT2_88E BIT22 /* Beacon DMA Interrupt 2 */ ++#define IMR_BCNDMAINT1_88E BIT21 /* Beacon DMA Interrupt 1 */ ++#define IMR_BCNDOK7_88E BIT20 /* Beacon Queue DMA OK Interrup 7 */ ++#define IMR_BCNDOK6_88E BIT19 /* Beacon Queue DMA OK Interrup 6 */ ++#define IMR_BCNDOK5_88E BIT18 /* Beacon Queue DMA OK Interrup 5 */ ++#define IMR_BCNDOK4_88E BIT17 /* Beacon Queue DMA OK Interrup 4 */ ++#define IMR_BCNDOK3_88E BIT16 /* Beacon Queue DMA OK Interrup 3 */ ++#define IMR_BCNDOK2_88E BIT15 /* Beacon Queue DMA OK Interrup 2 */ ++#define IMR_BCNDOK1_88E BIT14 /* Beacon Queue DMA OK Interrup 1 */ ++#define IMR_ATIMEND_E_88E BIT13 /* ATIM Window End Extension for Win7 */ ++#define IMR_TXERR_88E BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ ++#define IMR_RXERR_88E BIT10 /* Rx Error Flag INT Status, Write 1 clear */ ++#define IMR_TXFOVW_88E BIT9 /* Transmit FIFO Overflow */ ++#define IMR_RXFOVW_88E BIT8 /* Receive FIFO Overflow */ ++ ++/*=================================================================== ++===================================================================== ++Here the register defines are for 92C. When the define is as same with 92C, ++we will use the 92C's define for the consistency ++So the following defines for 92C is not entire!!!!!! ++===================================================================== ++=====================================================================*/ ++/* ++Based on Datasheet V33---090401 ++Register Summary ++Current IOREG MAP ++0x0000h ~ 0x00FFh System Configuration (256 Bytes) ++0x0100h ~ 0x01FFh MACTOP General Configuration (256 Bytes) ++0x0200h ~ 0x027Fh TXDMA Configuration (128 Bytes) ++0x0280h ~ 0x02FFh RXDMA Configuration (128 Bytes) ++0x0300h ~ 0x03FFh PCIE EMAC Reserved Region (256 Bytes) ++0x0400h ~ 0x04FFh Protocol Configuration (256 Bytes) ++0x0500h ~ 0x05FFh EDCA Configuration (256 Bytes) ++0x0600h ~ 0x07FFh WMAC Configuration (512 Bytes) ++0x2000h ~ 0x3FFFh 8051 FW Download Region (8196 Bytes) ++*/ ++/* ---------------------------------------------------------------------------- */ ++/* 8192C (TXPAUSE) transmission pause (Offset 0x522, 8 bits) */ ++/* ---------------------------------------------------------------------------- */ ++/* Note: ++* The the bits of stoping AC(VO/VI/BE/BK) queue in datasheet RTL8192S/RTL8192C are wrong, ++* the correct arragement is VO - Bit0, VI - Bit1, BE - Bit2, and BK - Bit3. ++* 8723 and 88E may be not correct either in the eralier version. Confirmed with DD Tim. ++* By Bruce, 2011-09-22. */ ++#define StopBecon BIT6 ++#define StopHigh BIT5 ++#define StopMgt BIT4 ++#define StopBK BIT3 ++#define StopBE BIT2 ++#define StopVI BIT1 ++#define StopVO BIT0 ++ ++/* ---------------------------------------------------------------------------- ++ * 8192C (RCR) Receive Configuration Register (Offset 0x608, 32 bits) ++ * ---------------------------------------------------------------------------- */ ++#define RCR_APPFCS BIT31 /* WMAC append FCS after pauload */ ++#define RCR_APP_MIC BIT30 /* MACRX will retain the MIC at the bottom of the packet. */ ++#define RCR_APP_ICV BIT29 /* MACRX will retain the ICV at the bottom of the packet. */ ++#define RCR_APP_PHYST_RXFF BIT28 /* PHY Status is appended before RX packet in RXFF */ ++#define RCR_APP_BA_SSN BIT27 /* SSN of previous TXBA is appended as after original RXDESC as the 4-th DW of RXDESC. */ ++#define RCR_VHT_DACK BIT26 /* This bit to control response type for vht single mpdu data packet. 1. ACK as response 0. BA as response */ ++#define RCR_TCPOFLD_EN BIT25 /* Enable TCP checksum offload */ ++#define RCR_ENMBID BIT24 /* Enable Multiple BssId. Only response ACK to the packets whose DID(A1) matching to the addresses in the MBSSID CAM Entries. */ ++#define RCR_LSIGEN BIT23 /* Enable LSIG TXOP Protection function. Search KEYCAM for each rx packet to check if LSIGEN bit is set. */ ++#define RCR_MFBEN BIT22 /* Enable immediate MCS Feedback function. When Rx packet with MRQ = 1'b1, then search KEYCAM to find sender's MCS Feedback function and send response. */ ++#define RCR_DISCHKPPDLLEN BIT21 /* Do not check PPDU while the PPDU length is smaller than 14 byte. */ ++#define RCR_PKTCTL_DLEN BIT20 /* While rx path dead lock occurs, reset rx path */ ++#define RCR_DISGCLK BIT19 /* Disable macrx clock gating control (no used) */ ++#define RCR_TIM_PARSER_EN BIT18 /* RX Beacon TIM Parser. */ ++#define RCR_BC_MD_EN BIT17 /* Broadcast data packet more data bit check interrupt enable.*/ ++#define RCR_UC_MD_EN BIT16 /* Unicast data packet more data bit check interrupt enable. */ ++#define RCR_RXSK_PERPKT BIT15 /* Executing key search per MPDU */ ++#define RCR_HTC_LOC_CTRL BIT14 /* MFC<--HTC = 1 MFC-->HTC = 0 */ ++#define RCR_AMF BIT13 /* Accept management type frame */ ++#define RCR_ACF BIT12 /* Accept control type frame. Control frames BA, BAR, and PS-Poll (when in AP mode) are not controlled by this bit. They are controlled by ADF. */ ++#define RCR_ADF BIT11 /* Accept data type frame. This bit also regulates BA, BAR, and PS-Poll (AP mode only). */ ++#define RCR_DISDECMYPKT BIT10 /* This bit determines whether hw need to do decryption.1: If A1 match, do decryption.0: Do decryption. */ ++#define RCR_AICV BIT9 /* Accept ICV error packet */ ++#define RCR_ACRC32 BIT8 /* Accept CRC32 error packet */ ++#define RCR_CBSSID_BCN BIT7 /* Accept BSSID match packet (Rx beacon, probe rsp) */ ++#define RCR_CBSSID_DATA BIT6 /* Accept BSSID match packet (Data) */ ++#define RCR_APWRMGT BIT5 /* Accept power management packet */ ++#define RCR_ADD3 BIT4 /* Accept address 3 match packet */ ++#define RCR_AB BIT3 /* Accept broadcast packet */ ++#define RCR_AM BIT2 /* Accept multicast packet */ ++#define RCR_APM BIT1 /* Accept physical match packet */ ++#define RCR_AAP BIT0 /* Accept all unicast packet */ ++ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0000h ~ 0x00FFh System Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* 2 SYS_ISO_CTRL */ ++#define ISO_MD2PP BIT(0) ++#define ISO_UA2USB BIT(1) ++#define ISO_UD2CORE BIT(2) ++#define ISO_PA2PCIE BIT(3) ++#define ISO_PD2CORE BIT(4) ++#define ISO_IP2MAC BIT(5) ++#define ISO_DIOP BIT(6) ++#define ISO_DIOE BIT(7) ++#define ISO_EB2CORE BIT(8) ++#define ISO_DIOR BIT(9) ++#define PWC_EV12V BIT(15) ++ ++ ++/* 2 SYS_FUNC_EN */ ++#define FEN_BBRSTB BIT(0) ++#define FEN_BB_GLB_RSTn BIT(1) ++#define FEN_USBA BIT(2) ++#define FEN_UPLL BIT(3) ++#define FEN_USBD BIT(4) ++#define FEN_DIO_PCIE BIT(5) ++#define FEN_PCIEA BIT(6) ++#define FEN_PPLL BIT(7) ++#define FEN_PCIED BIT(8) ++#define FEN_DIOE BIT(9) ++#define FEN_CPUEN BIT(10) ++#define FEN_DCORE BIT(11) ++#define FEN_ELDR BIT(12) ++#define FEN_EN_25_1 BIT(13) ++#define FEN_HWPDN BIT(14) ++#define FEN_MREGEN BIT(15) ++ ++/* 2 APS_FSMCO */ ++#define PFM_LDALL BIT(0) ++#define PFM_ALDN BIT(1) ++#define PFM_LDKP BIT(2) ++#define PFM_WOWL BIT(3) ++#define EnPDN BIT(4) ++#define PDN_PL BIT(5) ++#define APFM_ONMAC BIT(8) ++#define APFM_OFF BIT(9) ++#define APFM_RSM BIT(10) ++#define AFSM_HSUS BIT(11) ++#define AFSM_PCIE BIT(12) ++#define APDM_MAC BIT(13) ++#define APDM_HOST BIT(14) ++#define APDM_HPDN BIT(15) ++#define RDY_MACON BIT(16) ++#define SUS_HOST BIT(17) ++#define ROP_ALD BIT(20) ++#define ROP_PWR BIT(21) ++#define ROP_SPS BIT(22) ++#define SOP_MRST BIT(25) ++#define SOP_FUSE BIT(26) ++#define SOP_ABG BIT(27) ++#define SOP_AMB BIT(28) ++#define SOP_RCK BIT(29) ++#define SOP_A8M BIT(30) ++#define XOP_BTCK BIT(31) ++ ++/* 2 SYS_CLKR */ ++#define ANAD16V_EN BIT(0) ++#define ANA8M BIT(1) ++#define MACSLP BIT(4) ++#define LOADER_CLK_EN BIT(5) ++ ++ ++/* 2 9346CR /REG_SYS_EEPROM_CTRL */ ++#define BOOT_FROM_EEPROM BIT(4) ++#define EEPROMSEL BIT(4) ++#define EEPROM_EN BIT(5) ++ ++ ++/* 2 RF_CTRL */ ++#define RF_EN BIT(0) ++#define RF_RSTB BIT(1) ++#define RF_SDMRSTB BIT(2) ++ ++ ++/* 2 LDOV12D_CTRL */ ++#define LDV12_EN BIT(0) ++#define LDV12_SDBY BIT(1) ++#define LPLDO_HSM BIT(2) ++#define LPLDO_LSM_DIS BIT(3) ++#define _LDV12_VADJ(x) (((x) & 0xF) << 4) ++ ++ ++ ++/* 2 EFUSE_TEST (For RTL8723 partially) */ ++#define EF_TRPT BIT(7) ++#define EF_CELL_SEL (BIT(8) | BIT(9)) /* 00: Wifi Efuse, 01: BT Efuse0, 10: BT Efuse1, 11: BT Efuse2 */ ++#define LDOE25_EN BIT(31) ++#define EFUSE_SEL(x) (((x) & 0x3) << 8) ++#define EFUSE_SEL_MASK 0x300 ++#define EFUSE_WIFI_SEL_0 0x0 ++#define EFUSE_BT_SEL_0 0x1 ++#define EFUSE_BT_SEL_1 0x2 ++#define EFUSE_BT_SEL_2 0x3 ++ ++ ++/* 2 8051FWDL ++ * 2 MCUFWDL */ ++#define MCUFWDL_EN BIT(0) ++#define MCUFWDL_RDY BIT(1) ++#define FWDL_ChkSum_rpt BIT(2) ++#define MACINI_RDY BIT(3) ++#define BBINI_RDY BIT(4) ++#define RFINI_RDY BIT(5) ++#define WINTINI_RDY BIT(6) ++#define RAM_DL_SEL BIT(7) ++#define CPU_DL_READY BIT(15) /* add flag by gw for fw download ready 20130826 */ ++#define ROM_DLEN BIT(19) ++#define CPRST BIT(23) ++ ++ ++/* 2 REG_SYS_CFG */ ++#define XCLK_VLD BIT(0) ++#define ACLK_VLD BIT(1) ++#define UCLK_VLD BIT(2) ++#define PCLK_VLD BIT(3) ++#define PCIRSTB BIT(4) ++#define V15_VLD BIT(5) ++#define SW_OFFLOAD_EN BIT(7) ++#define SIC_IDLE BIT(8) ++#define BD_MAC2 BIT(9) ++#define BD_MAC1 BIT(10) ++#define IC_MACPHY_MODE BIT(11) ++#define CHIP_VER (BIT(12) | BIT(13) | BIT(14) | BIT(15)) ++#define BT_FUNC BIT(16) ++#define VENDOR_ID BIT(19) ++#define EXT_VENDOR_ID (BIT(18) | BIT(19)) /* Currently only for RTL8723B */ ++#define PAD_HWPD_IDN BIT(22) ++#define TRP_VAUX_EN BIT(23) /* RTL ID */ ++#define TRP_BT_EN BIT(24) ++#define BD_PKG_SEL BIT(25) ++#define BD_HCI_SEL BIT(26) ++#define TYPE_ID BIT(27) ++#define RF_TYPE_ID BIT(27) ++ ++#define RTL_ID BIT(23) /* TestChip ID, 1:Test(RLE); 0:MP(RL) */ ++#define SPS_SEL BIT(24) /* 1:LDO regulator mode; 0:Switching regulator mode */ ++ ++ ++#define CHIP_VER_RTL_MASK 0xF000 /* Bit 12 ~ 15 */ ++#define CHIP_VER_RTL_SHIFT 12 ++#define EXT_VENDOR_ID_SHIFT 18 ++ ++/* 2 REG_GPIO_OUTSTS (For RTL8723 only) */ ++#define EFS_HCI_SEL (BIT(0) | BIT(1)) ++#define PAD_HCI_SEL (BIT(2) | BIT(3)) ++#define HCI_SEL (BIT(4) | BIT(5)) ++#define PKG_SEL_HCI BIT(6) ++#define FEN_GPS BIT(7) ++#define FEN_BT BIT(8) ++#define FEN_WL BIT(9) ++#define FEN_PCI BIT(10) ++#define FEN_USB BIT(11) ++#define BTRF_HWPDN_N BIT(12) ++#define WLRF_HWPDN_N BIT(13) ++#define PDN_BT_N BIT(14) ++#define PDN_GPS_N BIT(15) ++#define BT_CTL_HWPDN BIT(16) ++#define GPS_CTL_HWPDN BIT(17) ++#define PPHY_SUSB BIT(20) ++#define UPHY_SUSB BIT(21) ++#define PCI_SUSEN BIT(22) ++#define USB_SUSEN BIT(23) ++#define RF_RL_ID (BIT(31) | BIT(30) | BIT(29) | BIT(28)) ++ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0100h ~ 0x01FFh MACTOP General Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* 2 Function Enable Registers ++ * 2 CR */ ++#define HCI_TXDMA_EN BIT(0) ++#define HCI_RXDMA_EN BIT(1) ++#define TXDMA_EN BIT(2) ++#define RXDMA_EN BIT(3) ++#define PROTOCOL_EN BIT(4) ++#define SCHEDULE_EN BIT(5) ++#define MACTXEN BIT(6) ++#define MACRXEN BIT(7) ++#define ENSWBCN BIT(8) ++#define ENSEC BIT(9) ++#define CALTMR_EN BIT(10) /* 32k CAL TMR enable */ ++ ++/* Network type */ ++#define _NETTYPE(x) (((x) & 0x3) << 16) ++#define MASK_NETTYPE 0x30000 ++#define NT_NO_LINK 0x0 ++#define NT_LINK_AD_HOC 0x1 ++#define NT_LINK_AP 0x2 ++#define NT_AS_AP 0x3 ++ ++/* 2 PBP - Page Size Register */ ++#define GET_RX_PAGE_SIZE(value) ((value) & 0xF) ++#define GET_TX_PAGE_SIZE(value) (((value) & 0xF0) >> 4) ++#define _PSRX_MASK 0xF ++#define _PSTX_MASK 0xF0 ++#define _PSRX(x) (x) ++#define _PSTX(x) ((x) << 4) ++ ++#define PBP_64 0x0 ++#define PBP_128 0x1 ++#define PBP_256 0x2 ++#define PBP_512 0x3 ++#define PBP_1024 0x4 ++ ++ ++/* 2 TX/RXDMA */ ++#define RXDMA_ARBBW_EN BIT(0) ++#define RXSHFT_EN BIT(1) ++#define RXDMA_AGG_EN BIT(2) ++#define QS_VO_QUEUE BIT(8) ++#define QS_VI_QUEUE BIT(9) ++#define QS_BE_QUEUE BIT(10) ++#define QS_BK_QUEUE BIT(11) ++#define QS_MANAGER_QUEUE BIT(12) ++#define QS_HIGH_QUEUE BIT(13) ++ ++#define HQSEL_VOQ BIT(0) ++#define HQSEL_VIQ BIT(1) ++#define HQSEL_BEQ BIT(2) ++#define HQSEL_BKQ BIT(3) ++#define HQSEL_MGTQ BIT(4) ++#define HQSEL_HIQ BIT(5) ++ ++/* For normal driver, 0x10C */ ++#define _TXDMA_CMQ_MAP(x) (((x) & 0x3) << 16) ++#define _TXDMA_HIQ_MAP(x) (((x) & 0x3) << 14) ++#define _TXDMA_MGQ_MAP(x) (((x) & 0x3) << 12) ++#define _TXDMA_BKQ_MAP(x) (((x) & 0x3) << 10) ++#define _TXDMA_BEQ_MAP(x) (((x) & 0x3) << 8) ++#define _TXDMA_VIQ_MAP(x) (((x) & 0x3) << 6) ++#define _TXDMA_VOQ_MAP(x) (((x) & 0x3) << 4) ++ ++#define QUEUE_EXTRA 0 ++#define QUEUE_LOW 1 ++#define QUEUE_NORMAL 2 ++#define QUEUE_HIGH 3 ++ ++ ++/* 2 TRXFF_BNDY */ ++ ++ ++/* 2 LLT_INIT */ ++#define _LLT_NO_ACTIVE 0x0 ++#define _LLT_WRITE_ACCESS 0x1 ++#define _LLT_READ_ACCESS 0x2 ++ ++#define _LLT_INIT_DATA(x) ((x) & 0xFF) ++#define _LLT_INIT_ADDR(x) (((x) & 0xFF) << 8) ++#define _LLT_OP(x) (((x) & 0x3) << 30) ++#define _LLT_OP_VALUE(x) (((x) >> 30) & 0x3) ++ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0200h ~ 0x027Fh TXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++/* 2 RQPN */ ++#define _HPQ(x) ((x) & 0xFF) ++#define _LPQ(x) (((x) & 0xFF) << 8) ++#define _PUBQ(x) (((x) & 0xFF) << 16) ++#define _NPQ(x) ((x) & 0xFF) /* NOTE: in RQPN_NPQ register */ ++#define _EPQ(x) (((x) & 0xFF) << 16) /* NOTE: in RQPN_EPQ register */ ++ ++ ++#define HPQ_PUBLIC_DIS BIT(24) ++#define LPQ_PUBLIC_DIS BIT(25) ++#define LD_RQPN BIT(31) ++ ++ ++/* 2 TDECTL */ ++#define BLK_DESC_NUM_SHIFT 4 ++#define BLK_DESC_NUM_MASK 0xF ++ ++ ++/* 2 TXDMA_OFFSET_CHK */ ++#define DROP_DATA_EN BIT(9) ++ ++/* 2 AUTO_LLT */ ++#define BIT_SHIFT_TXPKTNUM 24 ++#define BIT_MASK_TXPKTNUM 0xff ++#define BIT_TXPKTNUM(x) (((x) & BIT_MASK_TXPKTNUM) << BIT_SHIFT_TXPKTNUM) ++ ++#define BIT_TDE_DBG_SEL BIT(23) ++#define BIT_AUTO_INIT_LLT BIT(16) ++ ++#define BIT_SHIFT_Tx_OQT_free_space 8 ++#define BIT_MASK_Tx_OQT_free_space 0xff ++#define BIT_Tx_OQT_free_space(x) (((x) & BIT_MASK_Tx_OQT_free_space) << BIT_SHIFT_Tx_OQT_free_space) ++ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0280h ~ 0x028Bh RX DMA Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* 2 REG_RXDMA_CONTROL, 0x0286h ++ * Write only. When this bit is set, RXDMA will decrease RX PKT counter by one. Before ++ * this bit is polled, FW shall update RXFF_RD_PTR first. This register is write pulse and auto clear. ++ * #define RXPKT_RELEASE_POLL BIT(0) ++ * Read only. When RXMA finishes on-going DMA operation, RXMDA will report idle state in ++ * this bit. FW can start releasing packets after RXDMA entering idle mode. ++ * #define RXDMA_IDLE BIT(1) ++ * When this bit is set, RXDMA will enter this mode after on-going RXDMA packet to host ++ * completed, and stop DMA packet to host. RXDMA will then report Default: 0; ++ * #define RW_RELEASE_EN BIT(2) */ ++ ++/* 2 REG_RXPKT_NUM, 0x0284 */ ++#define RXPKT_RELEASE_POLL BIT(16) ++#define RXDMA_IDLE BIT(17) ++#define RW_RELEASE_EN BIT(18) ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0400h ~ 0x047Fh Protocol Configuration ++ * ++ * ----------------------------------------------------- */ ++/* 2 FWHW_TXQ_CTRL */ ++#define EN_AMPDU_RTY_NEW BIT(7) ++ ++ ++/* 2 SPEC SIFS */ ++#define _SPEC_SIFS_CCK(x) ((x) & 0xFF) ++#define _SPEC_SIFS_OFDM(x) (((x) & 0xFF) << 8) ++ ++/* 2 RL */ ++#define RETRY_LIMIT_SHORT_SHIFT 8 ++#define RETRY_LIMIT_LONG_SHIFT 0 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0500h ~ 0x05FFh EDCA Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* 2 EDCA setting */ ++#define AC_PARAM_TXOP_LIMIT_OFFSET 16 ++#define AC_PARAM_ECW_MAX_OFFSET 12 ++#define AC_PARAM_ECW_MIN_OFFSET 8 ++#define AC_PARAM_AIFS_OFFSET 0 ++ ++ ++#define _LRL(x) ((x) & 0x3F) ++#define _SRL(x) (((x) & 0x3F) << 8) ++ ++ ++/* 2 BCN_CTRL */ ++#define EN_TXBCN_RPT BIT(2) ++#define EN_BCN_FUNCTION BIT(3) ++#define STOP_BCNQ BIT(6) ++#define DIS_RX_BSSID_FIT BIT(6) ++ ++#define DIS_ATIM BIT(0) ++#define DIS_BCNQ_SUB BIT(1) ++#define DIS_TSF_UDT BIT(4) ++ ++/* The same function but different bit field. */ ++#define DIS_TSF_UDT0_NORMAL_CHIP BIT(4) ++#define DIS_TSF_UDT0_TEST_CHIP BIT(5) ++ ++ ++/* 2 ACMHWCTRL */ ++#define AcmHw_HwEn BIT(0) ++#define AcmHw_BeqEn BIT(1) ++#define AcmHw_ViqEn BIT(2) ++#define AcmHw_VoqEn BIT(3) ++#define AcmHw_BeqStatus BIT(4) ++#define AcmHw_ViqStatus BIT(5) ++#define AcmHw_VoqStatus BIT(6) ++ ++/* 2 */ /* REG_DUAL_TSF_RST (0x553) */ ++#define DUAL_TSF_RST_P2P BIT(4) ++ ++/* 2 */ /* REG_NOA_DESC_SEL (0x5CF) */ ++#define NOA_DESC_SEL_0 0 ++#define NOA_DESC_SEL_1 BIT(4) ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0600h ~ 0x07FFh WMAC Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* 2 APSD_CTRL */ ++#define APSDOFF BIT(6) ++ ++/* 2 TCR */ ++#define TSFRST BIT(0) ++#define DIS_GCLK BIT(1) ++#define PAD_SEL BIT(2) ++#define PWR_ST BIT(6) ++#define PWRBIT_OW_EN BIT(7) ++#define ACRC BIT(8) ++#define CFENDFORM BIT(9) ++#define ICV BIT(10) ++ ++ ++/* 2 RCR */ ++#define AAP BIT(0) ++#define APM BIT(1) ++#define AM BIT(2) ++#define AB BIT(3) ++#define ADD3 BIT(4) ++#define APWRMGT BIT(5) ++#define CBSSID BIT(6) ++#define CBSSID_DATA BIT(6) ++#define CBSSID_BCN BIT(7) ++#define ACRC32 BIT(8) ++#define AICV BIT(9) ++#define ADF BIT(11) ++#define ACF BIT(12) ++#define AMF BIT(13) ++#define HTC_LOC_CTRL BIT(14) ++#define UC_DATA_EN BIT(16) ++#define BM_DATA_EN BIT(17) ++#define MFBEN BIT(22) ++#define LSIGEN BIT(23) ++#define EnMBID BIT(24) ++#define FORCEACK BIT(26) ++#define APP_BASSN BIT(27) ++#define APP_PHYSTS BIT(28) ++#define APP_ICV BIT(29) ++#define APP_MIC BIT(30) ++#define APP_FCS BIT(31) ++ ++ ++/* 2 SECCFG */ ++#define SCR_TxUseDK BIT(0) /* Force Tx Use Default Key */ ++#define SCR_RxUseDK BIT(1) /* Force Rx Use Default Key */ ++#define SCR_TxEncEnable BIT(2) /* Enable Tx Encryption */ ++#define SCR_RxDecEnable BIT(3) /* Enable Rx Decryption */ ++#define SCR_SKByA2 BIT(4) /* Search kEY BY A2 */ ++#define SCR_NoSKMC BIT(5) /* No Key Search Multicast */ ++#define SCR_TXBCUSEDK BIT(6) /* Force Tx Broadcast packets Use Default Key */ ++#define SCR_RXBCUSEDK BIT(7) /* Force Rx Broadcast packets Use Default Key */ ++#define SCR_CHK_KEYID BIT(8) ++#define SCR_CHK_BMC BIT(9) /* add option to support a2+keyid+bcm */ ++ ++/*REG_MBIDCAMCFG (Offset 0x0628/0x62C)*/ ++#define BIT_MBIDCAM_POLL BIT(31) ++#define BIT_MBIDCAM_WT_EN BIT(30) ++ ++#define MBIDCAM_ADDR_MASK 0x1F ++#define MBIDCAM_ADDR_SHIFT 24 ++ ++#define BIT_MBIDCAM_VALID BIT(23) ++#define BIT_LSIC_TXOP_EN BIT(17) ++#define BIT_CTS_EN BIT(16) ++ ++/* ----------------------------------------------------- ++ * ++ * SDIO Bus Specification ++ * ++ * ----------------------------------------------------- */ ++ ++/* I/O bus domain address mapping */ ++#define SDIO_LOCAL_BASE 0x10250000 ++#define WLAN_IOREG_BASE 0x10260000 ++#define FIRMWARE_FIFO_BASE 0x10270000 ++#define TX_HIQ_BASE 0x10310000 ++#define TX_MIQ_BASE 0x10320000 ++#define TX_LOQ_BASE 0x10330000 ++#define TX_EPQ_BASE 0x10350000 ++#define RX_RX0FF_BASE 0x10340000 ++ ++/* SDIO host local register space mapping. */ ++#define SDIO_LOCAL_MSK 0x0FFF ++#define WLAN_IOREG_MSK 0x7FFF ++#define WLAN_FIFO_MSK 0x1FFF /* Aggregation Length[12:0] */ ++#define WLAN_RX0FF_MSK 0x0003 ++ ++#define SDIO_WITHOUT_REF_DEVICE_ID 0 /* Without reference to the SDIO Device ID */ ++#define SDIO_LOCAL_DEVICE_ID 0 /* 0b[16], 000b[15:13] */ ++#define WLAN_TX_HIQ_DEVICE_ID 4 /* 0b[16], 100b[15:13] */ ++#define WLAN_TX_MIQ_DEVICE_ID 5 /* 0b[16], 101b[15:13] */ ++#define WLAN_TX_LOQ_DEVICE_ID 6 /* 0b[16], 110b[15:13] */ ++#define WLAN_TX_EXQ_DEVICE_ID 3 /* 0b[16], 011b[15:13] */ ++#define WLAN_RX0FF_DEVICE_ID 7 /* 0b[16], 111b[15:13] */ ++#define WLAN_IOREG_DEVICE_ID 8 /* 1b[16] */ ++ ++/* SDIO Tx Free Page Index */ ++#define HI_QUEUE_IDX 0 ++#define MID_QUEUE_IDX 1 ++#define LOW_QUEUE_IDX 2 ++#define PUBLIC_QUEUE_IDX 3 ++ ++#define SDIO_MAX_TX_QUEUE 3 /* HIQ, MIQ and LOQ */ ++#define SDIO_MAX_RX_QUEUE 1 ++ ++#define SDIO_REG_TX_CTRL 0x0000 /* SDIO Tx Control */ ++#define SDIO_REG_HIMR 0x0014 /* SDIO Host Interrupt Mask */ ++#define SDIO_REG_HISR 0x0018 /* SDIO Host Interrupt Service Routine */ ++#define SDIO_REG_HCPWM 0x0019 /* HCI Current Power Mode */ ++#define SDIO_REG_RX0_REQ_LEN 0x001C /* RXDMA Request Length */ ++#define SDIO_REG_OQT_FREE_PG 0x001E /* OQT Free Page */ ++#define SDIO_REG_FREE_TXPG 0x0020 /* Free Tx Buffer Page */ ++#define SDIO_REG_HCPWM1 0x0024 /* HCI Current Power Mode 1 */ ++#define SDIO_REG_HCPWM2 0x0026 /* HCI Current Power Mode 2 */ ++#define SDIO_REG_FREE_TXPG_SEQ 0x0028 /* Free Tx Page Sequence */ ++#define SDIO_REG_HTSFR_INFO 0x0030 /* HTSF Informaion */ ++#define SDIO_REG_HRPWM1 0x0080 /* HCI Request Power Mode 1 */ ++#define SDIO_REG_HRPWM2 0x0082 /* HCI Request Power Mode 2 */ ++#define SDIO_REG_HPS_CLKR 0x0084 /* HCI Power Save Clock */ ++#define SDIO_REG_HSUS_CTRL 0x0086 /* SDIO HCI Suspend Control */ ++#define SDIO_REG_HIMR_ON 0x0090 /* SDIO Host Extension Interrupt Mask Always */ ++#define SDIO_REG_HISR_ON 0x0091 /* SDIO Host Extension Interrupt Status Always */ ++ ++#define SDIO_HIMR_DISABLED 0 ++ ++/* RTL8723/RTL8188E SDIO Host Interrupt Mask Register */ ++#define SDIO_HIMR_RX_REQUEST_MSK BIT0 ++#define SDIO_HIMR_AVAL_MSK BIT1 ++#define SDIO_HIMR_TXERR_MSK BIT2 ++#define SDIO_HIMR_RXERR_MSK BIT3 ++#define SDIO_HIMR_TXFOVW_MSK BIT4 ++#define SDIO_HIMR_RXFOVW_MSK BIT5 ++#define SDIO_HIMR_TXBCNOK_MSK BIT6 ++#define SDIO_HIMR_TXBCNERR_MSK BIT7 ++#define SDIO_HIMR_BCNERLY_INT_MSK BIT16 ++#define SDIO_HIMR_C2HCMD_MSK BIT17 ++#define SDIO_HIMR_CPWM1_MSK BIT18 ++#define SDIO_HIMR_CPWM2_MSK BIT19 ++#define SDIO_HIMR_HSISR_IND_MSK BIT20 ++#define SDIO_HIMR_GTINT3_IND_MSK BIT21 ++#define SDIO_HIMR_GTINT4_IND_MSK BIT22 ++#define SDIO_HIMR_PSTIMEOUT_MSK BIT23 ++#define SDIO_HIMR_OCPINT_MSK BIT24 ++#define SDIO_HIMR_ATIMEND_MSK BIT25 ++#define SDIO_HIMR_ATIMEND_E_MSK BIT26 ++#define SDIO_HIMR_CTWEND_MSK BIT27 ++ ++/* RTL8188E SDIO Specific */ ++#define SDIO_HIMR_MCU_ERR_MSK BIT28 ++#define SDIO_HIMR_TSF_BIT32_TOGGLE_MSK BIT29 ++ ++/* SDIO Host Interrupt Service Routine */ ++#define SDIO_HISR_RX_REQUEST BIT0 ++#define SDIO_HISR_AVAL BIT1 ++#define SDIO_HISR_TXERR BIT2 ++#define SDIO_HISR_RXERR BIT3 ++#define SDIO_HISR_TXFOVW BIT4 ++#define SDIO_HISR_RXFOVW BIT5 ++#define SDIO_HISR_TXBCNOK BIT6 ++#define SDIO_HISR_TXBCNERR BIT7 ++#define SDIO_HISR_BCNERLY_INT BIT16 ++#define SDIO_HISR_C2HCMD BIT17 ++#define SDIO_HISR_CPWM1 BIT18 ++#define SDIO_HISR_CPWM2 BIT19 ++#define SDIO_HISR_HSISR_IND BIT20 ++#define SDIO_HISR_GTINT3_IND BIT21 ++#define SDIO_HISR_GTINT4_IND BIT22 ++#define SDIO_HISR_PSTIMEOUT BIT23 ++#define SDIO_HISR_OCPINT BIT24 ++#define SDIO_HISR_ATIMEND BIT25 ++#define SDIO_HISR_ATIMEND_E BIT26 ++#define SDIO_HISR_CTWEND BIT27 ++ ++/* RTL8188E SDIO Specific */ ++#define SDIO_HISR_MCU_ERR BIT28 ++#define SDIO_HISR_TSF_BIT32_TOGGLE BIT29 ++ ++#define MASK_SDIO_HISR_CLEAR (SDIO_HISR_TXERR |\ ++ SDIO_HISR_RXERR |\ ++ SDIO_HISR_TXFOVW |\ ++ SDIO_HISR_RXFOVW |\ ++ SDIO_HISR_TXBCNOK |\ ++ SDIO_HISR_TXBCNERR |\ ++ SDIO_HISR_C2HCMD |\ ++ SDIO_HISR_CPWM1 |\ ++ SDIO_HISR_CPWM2 |\ ++ SDIO_HISR_HSISR_IND |\ ++ SDIO_HISR_GTINT3_IND |\ ++ SDIO_HISR_GTINT4_IND |\ ++ SDIO_HISR_PSTIMEOUT |\ ++ SDIO_HISR_OCPINT) ++ ++/* SDIO HCI Suspend Control Register */ ++#define HCI_RESUME_PWR_RDY BIT1 ++#define HCI_SUS_CTRL BIT0 ++ ++/* SDIO Tx FIFO related */ ++#define SDIO_TX_FREE_PG_QUEUE 4 /* The number of Tx FIFO free page */ ++#define SDIO_TX_FIFO_PAGE_SZ 128 ++ ++#ifdef CONFIG_SDIO_HCI ++ #define MAX_TX_AGG_PACKET_NUMBER 0x8 ++#else ++ #define MAX_TX_AGG_PACKET_NUMBER 0xFF ++ #define MAX_TX_AGG_PACKET_NUMBER_8812 64 ++#endif ++ ++/* ----------------------------------------------------- ++ * ++ * 0xFE00h ~ 0xFE55h USB Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* 2 USB Information (0xFE17) */ ++#define USB_IS_HIGH_SPEED 0 ++#define USB_IS_FULL_SPEED 1 ++#define USB_SPEED_MASK BIT(5) ++ ++#define USB_NORMAL_SIE_EP_MASK 0xF ++#define USB_NORMAL_SIE_EP_SHIFT 4 ++ ++/* 2 Special Option */ ++#define USB_AGG_EN BIT(3) ++ ++/* 0; Use interrupt endpoint to upload interrupt pkt ++ * 1; Use bulk endpoint to upload interrupt pkt, */ ++#define INT_BULK_SEL BIT(4) ++ ++/* 2REG_C2HEVT_CLEAR */ ++#define C2H_EVT_HOST_CLOSE 0x00 /* Set by driver and notify FW that the driver has read the C2H command message */ ++#define C2H_EVT_FW_CLOSE 0xFF /* Set by FW indicating that FW had set the C2H command message and it's not yet read by driver. */ ++ ++ ++/* 2REG_MULTI_FUNC_CTRL(For RTL8723 Only) */ ++#define WL_HWPDN_EN BIT0 /* Enable GPIO[9] as WiFi HW PDn source */ ++#define WL_HWPDN_SL BIT1 /* WiFi HW PDn polarity control */ ++#define WL_FUNC_EN BIT2 /* WiFi function enable */ ++#define WL_HWROF_EN BIT3 /* Enable GPIO[9] as WiFi RF HW PDn source */ ++#define BT_HWPDN_EN BIT16 /* Enable GPIO[11] as BT HW PDn source */ ++#define BT_HWPDN_SL BIT17 /* BT HW PDn polarity control */ ++#define BT_FUNC_EN BIT18 /* BT function enable */ ++#define BT_HWROF_EN BIT19 /* Enable GPIO[11] as BT/GPS RF HW PDn source */ ++#define GPS_HWPDN_EN BIT20 /* Enable GPIO[10] as GPS HW PDn source */ ++#define GPS_HWPDN_SL BIT21 /* GPS HW PDn polarity control */ ++#define GPS_FUNC_EN BIT22 /* GPS function enable */ ++ ++/* 3 REG_LIFECTRL_CTRL */ ++#define HAL92C_EN_PKT_LIFE_TIME_BK BIT3 ++#define HAL92C_EN_PKT_LIFE_TIME_BE BIT2 ++#define HAL92C_EN_PKT_LIFE_TIME_VI BIT1 ++#define HAL92C_EN_PKT_LIFE_TIME_VO BIT0 ++ ++#define HAL92C_MSDU_LIFE_TIME_UNIT 128 /* in us, said by Tim. */ ++ ++/* 2 8192D PartNo. */ ++#define PARTNO_92D_NIC (BIT7 | BIT6) ++#define PARTNO_92D_NIC_REMARK (BIT5 | BIT4) ++#define PARTNO_SINGLE_BAND_VS BIT3 ++#define PARTNO_SINGLE_BAND_VS_REMARK BIT1 ++#define PARTNO_CONCURRENT_BAND_VC (BIT3 | BIT2) ++#define PARTNO_CONCURRENT_BAND_VC_REMARK (BIT1 | BIT0) ++ ++/* ******************************************************** ++ * General definitions ++ * ******************************************************** */ ++ ++#define LAST_ENTRY_OF_TX_PKT_BUFFER_8188E(__Adapter) (IS_VENDOR_8188E_I_CUT_SERIES(__Adapter) ? 255 : 175) ++#define LAST_ENTRY_OF_TX_PKT_BUFFER_8812 255 ++#define LAST_ENTRY_OF_TX_PKT_BUFFER_8723B 255 ++#define LAST_ENTRY_OF_TX_PKT_BUFFER_8192C 255 ++#define LAST_ENTRY_OF_TX_PKT_BUFFER_8703B 255 ++#define LAST_ENTRY_OF_TX_PKT_BUFFER_DUAL_MAC 127 ++#define LAST_ENTRY_OF_TX_PKT_BUFFER_8188F 255 ++#define LAST_ENTRY_OF_TX_PKT_BUFFER_8723D 255 ++ ++#define POLLING_LLT_THRESHOLD 20 ++#if defined(CONFIG_RTL8723B) && defined(CONFIG_PCI_HCI) ++ #define POLLING_READY_TIMEOUT_COUNT 6000 ++#else ++ #define POLLING_READY_TIMEOUT_COUNT 1000 ++#endif ++ ++ ++/* GPIO BIT */ ++#define HAL_8812A_HW_GPIO_WPS_BIT BIT2 ++#define HAL_8192C_HW_GPIO_WPS_BIT BIT2 ++#define HAL_8192EU_HW_GPIO_WPS_BIT BIT7 ++#define HAL_8188E_HW_GPIO_WPS_BIT BIT7 ++ ++#endif /* __HAL_COMMON_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_data.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_data.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_data.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_data.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,771 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_DATA_H__ ++#define __HAL_DATA_H__ ++ ++#if 1/* def CONFIG_SINGLE_IMG */ ++ ++#include "../hal/phydm/phydm_precomp.h" ++#ifdef CONFIG_BT_COEXIST ++ #include ++#endif ++ ++#ifdef CONFIG_SDIO_HCI ++ #include ++#endif ++#ifdef CONFIG_GSPI_HCI ++ #include ++#endif ++/* ++ * For RTL8723 WiFi/BT/GPS multi-function configuration. 2010.10.06. ++ * */ ++typedef enum _RT_MULTI_FUNC { ++ RT_MULTI_FUNC_NONE = 0x00, ++ RT_MULTI_FUNC_WIFI = 0x01, ++ RT_MULTI_FUNC_BT = 0x02, ++ RT_MULTI_FUNC_GPS = 0x04, ++} RT_MULTI_FUNC, *PRT_MULTI_FUNC; ++/* ++ * For RTL8723 WiFi PDn/GPIO polarity control configuration. 2010.10.08. ++ * */ ++typedef enum _RT_POLARITY_CTL { ++ RT_POLARITY_LOW_ACT = 0, ++ RT_POLARITY_HIGH_ACT = 1, ++} RT_POLARITY_CTL, *PRT_POLARITY_CTL; ++ ++/* For RTL8723 regulator mode. by tynli. 2011.01.14. */ ++typedef enum _RT_REGULATOR_MODE { ++ RT_SWITCHING_REGULATOR = 0, ++ RT_LDO_REGULATOR = 1, ++} RT_REGULATOR_MODE, *PRT_REGULATOR_MODE; ++ ++/* ++ * Interface type. ++ * */ ++typedef enum _INTERFACE_SELECT_PCIE { ++ INTF_SEL0_SOLO_MINICARD = 0, /* WiFi solo-mCard */ ++ INTF_SEL1_BT_COMBO_MINICARD = 1, /* WiFi+BT combo-mCard */ ++ INTF_SEL2_PCIe = 2, /* PCIe Card */ ++} INTERFACE_SELECT_PCIE, *PINTERFACE_SELECT_PCIE; ++ ++ ++typedef enum _INTERFACE_SELECT_USB { ++ INTF_SEL0_USB = 0, /* USB */ ++ INTF_SEL1_USB_High_Power = 1, /* USB with high power PA */ ++ INTF_SEL2_MINICARD = 2, /* Minicard */ ++ INTF_SEL3_USB_Solo = 3, /* USB solo-Slim module */ ++ INTF_SEL4_USB_Combo = 4, /* USB Combo-Slim module */ ++ INTF_SEL5_USB_Combo_MF = 5, /* USB WiFi+BT Multi-Function Combo, i.e., Proprietary layout(AS-VAU) which is the same as SDIO card */ ++} INTERFACE_SELECT_USB, *PINTERFACE_SELECT_USB; ++ ++typedef enum _RT_AMPDU_BRUST_MODE { ++ RT_AMPDU_BRUST_NONE = 0, ++ RT_AMPDU_BRUST_92D = 1, ++ RT_AMPDU_BRUST_88E = 2, ++ RT_AMPDU_BRUST_8812_4 = 3, ++ RT_AMPDU_BRUST_8812_8 = 4, ++ RT_AMPDU_BRUST_8812_12 = 5, ++ RT_AMPDU_BRUST_8812_15 = 6, ++ RT_AMPDU_BRUST_8723B = 7, ++} RT_AMPDU_BRUST, *PRT_AMPDU_BRUST_MODE; ++ ++/* Tx Power Limit Table Size */ ++#define MAX_REGULATION_NUM 4 ++#define MAX_RF_PATH_NUM_IN_POWER_LIMIT_TABLE 4 ++#define MAX_2_4G_BANDWIDTH_NUM 2 ++#define MAX_RATE_SECTION_NUM 10 ++#define MAX_5G_BANDWIDTH_NUM 4 ++ ++#define MAX_BASE_NUM_IN_PHY_REG_PG_2_4G 10 /* CCK:1, OFDM:1, HT:4, VHT:4 */ ++#define MAX_BASE_NUM_IN_PHY_REG_PG_5G 9 /* OFDM:1, HT:4, VHT:4 */ ++ ++ ++/* ###### duplicate code,will move to ODM ######### */ ++/* #define IQK_MAC_REG_NUM 4 */ ++/* #define IQK_ADDA_REG_NUM 16 */ ++ ++/* #define IQK_BB_REG_NUM 10 */ ++#define IQK_BB_REG_NUM_92C 9 ++#define IQK_BB_REG_NUM_92D 10 ++#define IQK_BB_REG_NUM_test 6 ++ ++#define IQK_Matrix_Settings_NUM_92D (1+24+21) ++ ++/* #define HP_THERMAL_NUM 8 */ ++/* ###### duplicate code,will move to ODM ######### */ ++ ++#ifdef RTW_RX_AGGREGATION ++typedef enum _RX_AGG_MODE { ++ RX_AGG_DISABLE, ++ RX_AGG_DMA, ++ RX_AGG_USB, ++ RX_AGG_MIX ++} RX_AGG_MODE; ++ ++/* #define MAX_RX_DMA_BUFFER_SIZE 10240 */ /* 10K for 8192C RX DMA buffer */ ++ ++#endif /* RTW_RX_AGGREGATION */ ++ ++/* E-Fuse */ ++#ifdef CONFIG_RTL8188E ++ #define EFUSE_MAP_SIZE 512 ++#endif ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) ++ #define EFUSE_MAP_SIZE 512 ++#endif ++#ifdef CONFIG_RTL8192E ++ #define EFUSE_MAP_SIZE 512 ++#endif ++#ifdef CONFIG_RTL8723B ++ #define EFUSE_MAP_SIZE 512 ++#endif ++#ifdef CONFIG_RTL8814A ++ #define EFUSE_MAP_SIZE 512 ++#endif ++#ifdef CONFIG_RTL8703B ++ #define EFUSE_MAP_SIZE 512 ++#endif ++#ifdef CONFIG_RTL8723D ++ #define EFUSE_MAP_SIZE 512 ++#endif ++#ifdef CONFIG_RTL8188F ++ #define EFUSE_MAP_SIZE 512 ++#endif ++ ++#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++ #define EFUSE_MAX_SIZE 1024 ++#elif defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8703B) ++ #define EFUSE_MAX_SIZE 256 ++#else ++ #define EFUSE_MAX_SIZE 512 ++#endif ++/* end of E-Fuse */ ++ ++#define Mac_OFDM_OK 0x00000000 ++#define Mac_OFDM_Fail 0x10000000 ++#define Mac_OFDM_FasleAlarm 0x20000000 ++#define Mac_CCK_OK 0x30000000 ++#define Mac_CCK_Fail 0x40000000 ++#define Mac_CCK_FasleAlarm 0x50000000 ++#define Mac_HT_OK 0x60000000 ++#define Mac_HT_Fail 0x70000000 ++#define Mac_HT_FasleAlarm 0x90000000 ++#define Mac_DropPacket 0xA0000000 ++ ++#ifdef CONFIG_RF_POWER_TRIM ++#if defined(CONFIG_RTL8723B) ++ #define REG_RF_BB_GAIN_OFFSET 0x7f ++ #define RF_GAIN_OFFSET_MASK 0xfffff ++#elif defined(CONFIG_RTL8188E) ++ #define REG_RF_BB_GAIN_OFFSET 0x55 ++ #define RF_GAIN_OFFSET_MASK 0xfffff ++#else ++ #define REG_RF_BB_GAIN_OFFSET 0x55 ++ #define RF_GAIN_OFFSET_MASK 0xfffff ++#endif /* CONFIG_RTL8723B */ ++#endif /*CONFIG_RF_POWER_TRIM*/ ++ ++/* For store initial value of BB register */ ++typedef struct _BB_INIT_REGISTER { ++ u16 offset; ++ u32 value; ++ ++} BB_INIT_REGISTER, *PBB_INIT_REGISTER; ++ ++#define PAGE_SIZE_128 128 ++#define PAGE_SIZE_256 256 ++#define PAGE_SIZE_512 512 ++ ++#define HCI_SUS_ENTER 0 ++#define HCI_SUS_LEAVING 1 ++#define HCI_SUS_LEAVE 2 ++#define HCI_SUS_ENTERING 3 ++#define HCI_SUS_ERR 4 ++ ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++typedef enum _ACS_OP { ++ ACS_INIT, /*ACS - Variable init*/ ++ ACS_RESET, /*ACS - NHM Counter reset*/ ++ ACS_SELECT, /*ACS - NHM Counter Statistics */ ++} ACS_OP; ++ ++typedef enum _ACS_STATE { ++ ACS_DISABLE, ++ ACS_ENABLE, ++} ACS_STATE; ++ ++struct auto_chan_sel { ++ ATOMIC_T state; ++ u8 ch; /* previous channel*/ ++}; ++#endif /*CONFIG_AUTO_CHNL_SEL_NHM*/ ++ ++#define EFUSE_FILE_UNUSED 0 ++#define EFUSE_FILE_FAILED 1 ++#define EFUSE_FILE_LOADED 2 ++ ++#define MACADDR_FILE_UNUSED 0 ++#define MACADDR_FILE_FAILED 1 ++#define MACADDR_FILE_LOADED 2 ++ ++#define KFREE_FLAG_ON BIT0 ++#define KFREE_FLAG_THERMAL_K_ON BIT1 ++ ++#define MAX_IQK_INFO_BACKUP_CHNL_NUM 5 ++#define MAX_IQK_INFO_BACKUP_REG_NUM 10 ++ ++struct kfree_data_t { ++ u8 flag; ++ s8 bb_gain[BB_GAIN_NUM][RF_PATH_MAX]; ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ s8 pa_bias_5g[RF_PATH_MAX]; ++ s8 pad_bias_5g[RF_PATH_MAX]; ++#endif ++ s8 thermal; ++}; ++ ++bool kfree_data_is_bb_gain_empty(struct kfree_data_t *data); ++ ++struct hal_spec_t { ++ char *ic_name; ++ u8 macid_num; ++ ++ u8 sec_cam_ent_num; ++ u8 sec_cap; ++ ++ u8 rfpath_num_2g:4; /* used for tx power index path */ ++ u8 rfpath_num_5g:4; /* used for tx power index path */ ++ ++ u8 max_tx_cnt; ++ u8 nss_num; ++ u8 band_cap; /* value of BAND_CAP_XXX */ ++ u8 bw_cap; /* value of BW_CAP_XXX */ ++ u8 port_num; ++ u8 proto_cap; /* value of PROTO_CAP_XXX */ ++ u8 wl_func; /* value of WL_FUNC_XXX */ ++}; ++ ++#define HAL_SPEC_CHK_RF_PATH_2G(_spec, _path) ((_spec)->rfpath_num_2g > (_path)) ++#define HAL_SPEC_CHK_RF_PATH_5G(_spec, _path) ((_spec)->rfpath_num_5g > (_path)) ++#define HAL_SPEC_CHK_RF_PATH(_spec, _band, _path) ( \ ++ _band == BAND_ON_2_4G ? HAL_SPEC_CHK_RF_PATH_2G(_spec, _path) : \ ++ _band == BAND_ON_5G ? HAL_SPEC_CHK_RF_PATH_5G(_spec, _path) : 0) ++ ++#define HAL_SPEC_CHK_TX_CNT(_spec, _cnt_idx) ((_spec)->max_tx_cnt > (_cnt_idx)) ++ ++struct hal_iqk_reg_backup { ++ u8 central_chnl; ++ u8 bw_mode; ++ u32 reg_backup[MAX_RF_PATH][MAX_IQK_INFO_BACKUP_REG_NUM]; ++}; ++ ++typedef struct hal_com_data { ++ HAL_VERSION VersionID; ++ RT_MULTI_FUNC MultiFunc; /* For multi-function consideration. */ ++ RT_POLARITY_CTL PolarityCtl; /* For Wifi PDn Polarity control. */ ++ RT_REGULATOR_MODE RegulatorMode; /* switching regulator or LDO */ ++ u8 hw_init_completed; ++ /****** FW related ******/ ++ u16 FirmwareVersion; ++ u16 FirmwareVersionRev; ++ u16 FirmwareSubVersion; ++ u16 FirmwareSignature; ++ u8 RegFWOffload; ++ u8 fw_ractrl; ++ u8 FwRsvdPageStartOffset; /* 2010.06.23. Added by tynli. Reserve page start offset except beacon in TxQ.*/ ++ u8 LastHMEBoxNum; /* H2C - for host message to fw */ ++ ++ /****** current WIFI_PHY values ******/ ++ WIRELESS_MODE CurrentWirelessMode; ++ CHANNEL_WIDTH CurrentChannelBW; ++ BAND_TYPE CurrentBandType; /* 0:2.4G, 1:5G */ ++ BAND_TYPE BandSet; ++ u8 CurrentChannel; ++ u8 cch_20; ++ u8 cch_40; ++ u8 cch_80; ++ u8 CurrentCenterFrequencyIndex1; ++ u8 nCur40MhzPrimeSC; /* Control channel sub-carrier */ ++ u8 nCur80MhzPrimeSC; /* used for primary 40MHz of 80MHz mode */ ++ BOOLEAN bSwChnlAndSetBWInProgress; ++ u8 bDisableSWChannelPlan; /* flag of disable software change channel plan */ ++ u16 BasicRateSet; ++ u32 ReceiveConfig; ++ u8 rx_tsf_addr_filter_config; /* for 8822B/8821C USE */ ++ BOOLEAN bSwChnl; ++ BOOLEAN bSetChnlBW; ++ BOOLEAN bSWToBW40M; ++ BOOLEAN bSWToBW80M; ++ BOOLEAN bChnlBWInitialized; ++ u32 BackUp_BB_REG_4_2nd_CCA[3]; ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++ struct auto_chan_sel acs; ++#endif ++ /****** rf_ctrl *****/ ++ u8 rf_chip; ++ u8 rf_type; ++ u8 PackageType; ++ u8 NumTotalRFPath; ++ ++ /****** Debug ******/ ++ u16 ForcedDataRate; /* Force Data Rate. 0: Auto, 0x02: 1M ~ 0x6C: 54M. */ ++ u8 u1ForcedIgiLb; /* forced IGI lower bound */ ++ u8 bDumpRxPkt; ++ u8 bDumpTxPkt; ++ u8 bDisableTXPowerTraining; ++ ++ ++ /****** EEPROM setting.******/ ++ u8 bautoload_fail_flag; ++ u8 efuse_file_status; ++ u8 macaddr_file_status; ++ u8 EepromOrEfuse; ++ u8 efuse_eeprom_data[EEPROM_MAX_SIZE]; /*92C:256bytes, 88E:512bytes, we use union set (512bytes)*/ ++ u8 InterfaceSel; /* board type kept in eFuse */ ++ u16 CustomerID; ++ ++ u16 EEPROMVID; ++ u16 EEPROMSVID; ++#ifdef CONFIG_USB_HCI ++ u8 EEPROMUsbSwitch; ++ u16 EEPROMPID; ++ u16 EEPROMSDID; ++#endif ++#ifdef CONFIG_PCI_HCI ++ u16 EEPROMDID; ++ u16 EEPROMSMID; ++#endif ++ ++ u8 EEPROMCustomerID; ++ u8 EEPROMSubCustomerID; ++ u8 EEPROMVersion; ++ u8 EEPROMRegulatory; ++ u8 EEPROMThermalMeter; ++ u8 EEPROMBluetoothCoexist; ++ u8 EEPROMBluetoothType; ++ u8 EEPROMBluetoothAntNum; ++ u8 EEPROMBluetoothAntIsolation; ++ u8 EEPROMBluetoothRadioShared; ++ u8 EEPROMMACAddr[ETH_ALEN]; ++ ++#ifdef CONFIG_RF_POWER_TRIM ++ u8 EEPROMRFGainOffset; ++ u8 EEPROMRFGainVal; ++ struct kfree_data_t kfree_data; ++#endif /*CONFIG_RF_POWER_TRIM*/ ++ ++#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) || \ ++ defined(CONFIG_RTL8723D) ++ u8 adjuseVoltageVal; ++ u8 need_restore; ++#endif ++ u8 EfuseUsedPercentage; ++ u16 EfuseUsedBytes; ++ /*u8 EfuseMap[2][HWSET_MAX_SIZE_JAGUAR];*/ ++ EFUSE_HAL EfuseHal; ++ ++ /*---------------------------------------------------------------------------------*/ ++ /* 2.4G TX power info for target TX power*/ ++ u8 Index24G_CCK_Base[MAX_RF_PATH][CENTER_CH_2G_NUM]; ++ u8 Index24G_BW40_Base[MAX_RF_PATH][CENTER_CH_2G_NUM]; ++ s8 CCK_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 OFDM_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW20_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW40_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ ++ /* 5G TX power info for target TX power*/ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ u8 Index5G_BW40_Base[MAX_RF_PATH][CENTER_CH_5G_ALL_NUM]; ++ u8 Index5G_BW80_Base[MAX_RF_PATH][CENTER_CH_5G_80M_NUM]; ++ s8 OFDM_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW20_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW40_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW80_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++#endif ++ ++ u8 Regulation2_4G; ++ u8 Regulation5G; ++ ++ /******************************** ++ * TX power by rate table at most 4RF path. ++ * The register is ++ * ++ * VHT TX power by rate off setArray = ++ * Band:-2G&5G = 0 / 1 ++ * RF: at most 4*4 = ABCD=0/1/2/3 ++ * CCK=0 OFDM=1/2 HT-MCS 0-15=3/4/56 VHT=7/8/9/10/11 ++ **********************************/ ++ ++ u8 txpwr_by_rate_undefined_band_path[TX_PWR_BY_RATE_NUM_BAND] ++ [TX_PWR_BY_RATE_NUM_RF]; ++ ++ s8 TxPwrByRateOffset[TX_PWR_BY_RATE_NUM_BAND] ++ [TX_PWR_BY_RATE_NUM_RF] ++ [TX_PWR_BY_RATE_NUM_RF] ++ [TX_PWR_BY_RATE_NUM_RATE]; ++ ++#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI ++ s8 TxPwrByRate[TX_PWR_BY_RATE_NUM_BAND] ++ [TX_PWR_BY_RATE_NUM_RF] ++ [TX_PWR_BY_RATE_NUM_RF] ++ [TX_PWR_BY_RATE_NUM_RATE]; ++#endif ++ /* --------------------------------------------------------------------------------- */ ++ ++ u8 tx_pwr_lmt_5g_20_40_ref; ++ ++ /* Power Limit Table for 2.4G */ ++ s8 TxPwrLimit_2_4G[MAX_REGULATION_NUM] ++ [MAX_2_4G_BANDWIDTH_NUM] ++ [MAX_RATE_SECTION_NUM] ++ [CENTER_CH_2G_NUM] ++ [MAX_RF_PATH]; ++ ++ /* Power Limit Table for 5G */ ++ s8 TxPwrLimit_5G[MAX_REGULATION_NUM] ++ [MAX_5G_BANDWIDTH_NUM] ++ [MAX_RATE_SECTION_NUM] ++ [CENTER_CH_5G_ALL_NUM] ++ [MAX_RF_PATH]; ++ ++ ++#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI ++ s8 TxPwrLimit_2_4G_Original[MAX_REGULATION_NUM] ++ [MAX_2_4G_BANDWIDTH_NUM] ++ [MAX_RATE_SECTION_NUM] ++ [CENTER_CH_2G_NUM] ++ [MAX_RF_PATH]; ++ ++ ++ s8 TxPwrLimit_5G_Original[MAX_REGULATION_NUM] ++ [MAX_5G_BANDWIDTH_NUM] ++ [MAX_RATE_SECTION_NUM] ++ [CENTER_CH_5G_ALL_NUM] ++ [MAX_RF_PATH]; ++ ++#endif ++ ++ /* Store the original power by rate value of the base of each rate section of rf path A & B */ ++ u8 TxPwrByRateBase2_4G[TX_PWR_BY_RATE_NUM_RF] ++ [TX_PWR_BY_RATE_NUM_RF] ++ [MAX_BASE_NUM_IN_PHY_REG_PG_2_4G]; ++ u8 TxPwrByRateBase5G[TX_PWR_BY_RATE_NUM_RF] ++ [TX_PWR_BY_RATE_NUM_RF] ++ [MAX_BASE_NUM_IN_PHY_REG_PG_5G]; ++ ++ u8 txpwr_by_rate_loaded:1; ++ u8 txpwr_by_rate_from_file:1; ++ u8 txpwr_limit_loaded:1; ++ u8 txpwr_limit_from_file:1; ++ u8 RfPowerTrackingType; ++ ++ /* Read/write are allow for following hardware information variables */ ++ u8 CrystalCap; ++ ++ u8 PAType_2G; ++ u8 PAType_5G; ++ u8 LNAType_2G; ++ u8 LNAType_5G; ++ u8 ExternalPA_2G; ++ u8 ExternalLNA_2G; ++ u8 ExternalPA_5G; ++ u8 ExternalLNA_5G; ++ u16 TypeGLNA; ++ u16 TypeGPA; ++ u16 TypeALNA; ++ u16 TypeAPA; ++ u16 RFEType; ++ ++ u8 bLedOpenDrain; /* Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. */ ++ u32 AcParam_BE; /* Original parameter for BE, use for EDCA turbo. */ ++ ++ BB_REGISTER_DEFINITION_T PHYRegDef[MAX_RF_PATH]; /* Radio A/B/C/D */ ++ ++ u32 RfRegChnlVal[MAX_RF_PATH]; ++ ++ /* RDG enable */ ++ BOOLEAN bRDGEnable; ++ ++ u8 RegTxPause; ++ /* Beacon function related global variable. */ ++ u8 RegBcnCtrlVal; ++ u8 RegFwHwTxQCtrl; ++ u8 RegReg542; ++ u8 RegCR_1; ++ u8 Reg837; ++ u16 RegRRSR; ++ ++ /****** antenna diversity ******/ ++ u8 AntDivCfg; ++ u8 with_extenal_ant_switch; ++ u8 b_fix_tx_ant; ++ u8 AntDetection; ++ u8 TRxAntDivType; ++ u8 ant_path; /* for 8723B s0/s1 selection */ ++ u32 AntennaTxPath; /* Antenna path Tx */ ++ u32 AntennaRxPath; /* Antenna path Rx */ ++ u8 sw_antdiv_bl_state; ++ ++ /******** PHY DM & DM Section **********/ ++ u8 DM_Type; ++ _lock IQKSpinLock; ++ u8 INIDATA_RATE[MACID_NUM_SW_LIMIT]; ++ /* Upper and Lower Signal threshold for Rate Adaptive*/ ++ int EntryMinUndecoratedSmoothedPWDB; ++ int EntryMaxUndecoratedSmoothedPWDB; ++ int MinUndecoratedPWDBForDM; ++ DM_ODM_T odmpriv; ++ u8 bIQKInitialized; ++ u8 bNeedIQK; ++ u8 IQK_MP_Switch; ++ /******** PHY DM & DM Section **********/ ++ ++ ++ ++ /* 2010/08/09 MH Add CU power down mode. */ ++ BOOLEAN pwrdown; ++ ++ /* Add for dual MAC 0--Mac0 1--Mac1 */ ++ u32 interfaceIndex; ++ ++#ifdef CONFIG_P2P ++ u8 p2p_ps_offload; ++#endif ++ /* Auto FSM to Turn On, include clock, isolation, power control for MAC only */ ++ u8 bMacPwrCtrlOn; ++ u8 hci_sus_state; ++ ++ u8 RegIQKFWOffload; ++ struct submit_ctx iqk_sctx; ++ ++ RT_AMPDU_BRUST AMPDUBurstMode; /* 92C maybe not use, but for compile successfully */ ++ ++ u8 OutEpQueueSel; ++ u8 OutEpNumber; ++ ++#ifdef RTW_RX_AGGREGATION ++ RX_AGG_MODE rxagg_mode; ++ ++ /* For RX Aggregation DMA Mode */ ++ u8 rxagg_dma_size; ++ u8 rxagg_dma_timeout; ++#endif /* RTW_RX_AGGREGATION */ ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ /* */ ++ /* For SDIO Interface HAL related */ ++ /* */ ++ ++ /* */ ++ /* SDIO ISR Related */ ++ /* ++ * u32 IntrMask[1]; ++ * u32 IntrMaskToSet[1]; ++ * LOG_INTERRUPT InterruptLog; */ ++ u32 sdio_himr; ++ u32 sdio_hisr; ++#ifndef RTW_HALMAC ++ /* */ ++ /* SDIO Tx FIFO related. */ ++ /* */ ++ /* HIQ, MID, LOW, PUB free pages; padapter->xmitpriv.free_txpg */ ++ u8 SdioTxFIFOFreePage[SDIO_TX_FREE_PG_QUEUE]; ++ _lock SdioTxFIFOFreePageLock; ++ u8 SdioTxOQTMaxFreeSpace; ++ u8 SdioTxOQTFreeSpace; ++#else /* RTW_HALMAC */ ++ u16 SdioTxOQTFreeSpace; ++#endif /* RTW_HALMAC */ ++ ++ /* */ ++ /* SDIO Rx FIFO related. */ ++ /* */ ++ u8 SdioRxFIFOCnt; ++ u16 SdioRxFIFOSize; ++ ++#ifndef RTW_HALMAC ++ u32 sdio_tx_max_len[SDIO_MAX_TX_QUEUE];/* H, N, L, used for sdio tx aggregation max length per queue */ ++#else ++#ifdef CONFIG_RTL8821C ++ u16 tx_high_page; ++ u16 tx_low_page; ++ u16 tx_normal_page; ++ u16 tx_extra_page; ++ u16 tx_pub_page; ++ u16 max_oqt_page; ++ u32 max_xmit_size_vovi; ++ u32 max_xmit_size_bebk; ++#endif ++#endif /* !RTW_HALMAC */ ++#endif /* CONFIG_SDIO_HCI */ ++ ++#ifdef CONFIG_USB_HCI ++ ++ /* 2010/12/10 MH Add for USB aggreation mode dynamic shceme. */ ++ BOOLEAN UsbRxHighSpeedMode; ++ BOOLEAN UsbTxVeryHighSpeedMode; ++ u32 UsbBulkOutSize; ++ BOOLEAN bSupportUSB3; ++ u8 usb_intf_start; ++ ++ /* Interrupt relatd register information. */ ++ u32 IntArray[3];/* HISR0,HISR1,HSISR */ ++ u32 IntrMask[3]; ++#ifdef CONFIG_USB_TX_AGGREGATION ++ u8 UsbTxAggMode; ++ u8 UsbTxAggDescNum; ++#endif /* CONFIG_USB_TX_AGGREGATION */ ++ ++#ifdef CONFIG_USB_RX_AGGREGATION ++ u16 HwRxPageSize; /* Hardware setting */ ++ ++ /* For RX Aggregation USB Mode */ ++ u8 rxagg_usb_size; ++ u8 rxagg_usb_timeout; ++#endif/* CONFIG_USB_RX_AGGREGATION */ ++#endif /* CONFIG_USB_HCI */ ++ ++ ++#ifdef CONFIG_PCI_HCI ++ /* */ ++ /* EEPROM setting. */ ++ /* */ ++ u32 TransmitConfig; ++ u32 IntrMaskToSet[2]; ++ u32 IntArray[4]; ++ u32 IntrMask[4]; ++ u32 SysIntArray[1]; ++ u32 SysIntrMask[1]; ++ u32 IntrMaskReg[2]; ++ u32 IntrMaskDefault[4]; ++ ++ BOOLEAN bL1OffSupport; ++ BOOLEAN bSupportBackDoor; ++ ++ u8 bDefaultAntenna; ++ ++ u8 bInterruptMigration; ++ u8 bDisableTxInt; ++ ++ u16 RxTag; ++#endif /* CONFIG_PCI_HCI */ ++ ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ struct sreset_priv srestpriv; ++#endif /* #ifdef DBG_CONFIG_ERROR_DETECT */ ++ ++#ifdef CONFIG_BT_COEXIST ++ /* For bluetooth co-existance */ ++ BT_COEXIST bt_coexist; ++#endif /* CONFIG_BT_COEXIST */ ++ ++#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) \ ++ || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8723D) ++#ifndef CONFIG_PCI_HCI /* mutual exclusive with PCI -- so they're SDIO and GSPI */ ++ /* Interrupt relatd register information. */ ++ u32 SysIntrStatus; ++ u32 SysIntrMask; ++#endif ++#endif /*endif CONFIG_RTL8723B */ ++ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ char para_file_buf[MAX_PARA_FILE_BUF_LEN]; ++ char *mac_reg; ++ u32 mac_reg_len; ++ char *bb_phy_reg; ++ u32 bb_phy_reg_len; ++ char *bb_agc_tab; ++ u32 bb_agc_tab_len; ++ char *bb_phy_reg_pg; ++ u32 bb_phy_reg_pg_len; ++ char *bb_phy_reg_mp; ++ u32 bb_phy_reg_mp_len; ++ char *rf_radio_a; ++ u32 rf_radio_a_len; ++ char *rf_radio_b; ++ u32 rf_radio_b_len; ++ char *rf_tx_pwr_track; ++ u32 rf_tx_pwr_track_len; ++ char *rf_tx_pwr_lmt; ++ u32 rf_tx_pwr_lmt_len; ++#endif ++ ++#ifdef CONFIG_BACKGROUND_NOISE_MONITOR ++ s16 noise[ODM_MAX_CHANNEL_NUM]; ++#endif ++ ++ struct hal_spec_t hal_spec; ++ ++ u8 RfKFreeEnable; ++ u8 RfKFree_ch_group; ++ BOOLEAN bCCKinCH14; ++ BB_INIT_REGISTER RegForRecover[5]; ++ ++#if defined(CONFIG_PCI_HCI) && defined(RTL8814AE_SW_BCN) ++ BOOLEAN bCorrectBCN; ++#endif ++ u32 RxGainOffset[4]; /*{2G, 5G_Low, 5G_Middle, G_High}*/ ++ u8 BackUp_IG_REG_4_Chnl_Section[4]; /*{A,B,C,D}*/ ++ ++ struct hal_iqk_reg_backup iqk_reg_backup[MAX_IQK_INFO_BACKUP_CHNL_NUM]; ++ ++#ifdef CONFIG_BEAMFORMING ++#ifdef RTW_BEAMFORMING_VERSION_2 ++ struct beamforming_info beamforming_info; ++#endif /* RTW_BEAMFORMING_VERSION_2 */ ++#endif /* CONFIG_BEAMFORMING */ ++} HAL_DATA_COMMON, *PHAL_DATA_COMMON; ++ ++ ++ ++typedef struct hal_com_data HAL_DATA_TYPE, *PHAL_DATA_TYPE; ++#define GET_HAL_DATA(__pAdapter) ((HAL_DATA_TYPE *)((__pAdapter)->HalData)) ++#define GET_HAL_SPEC(__pAdapter) (&(GET_HAL_DATA((__pAdapter))->hal_spec)) ++#define GET_ODM(__pAdapter) (&(GET_HAL_DATA((__pAdapter))->odmpriv)) ++ ++#define GET_HAL_RFPATH_NUM(__pAdapter) (((HAL_DATA_TYPE *)((__pAdapter)->HalData))->NumTotalRFPath) ++#define RT_GetInterfaceSelection(_Adapter) (GET_HAL_DATA(_Adapter)->InterfaceSel) ++#define GET_RF_TYPE(__pAdapter) (GET_HAL_DATA(__pAdapter)->rf_type) ++#define GET_KFREE_DATA(_adapter) (&(GET_HAL_DATA((_adapter))->kfree_data)) ++ ++#define SUPPORT_HW_RADIO_DETECT(Adapter) (RT_GetInterfaceSelection(Adapter) == INTF_SEL2_MINICARD || \ ++ RT_GetInterfaceSelection(Adapter) == INTF_SEL3_USB_Solo || \ ++ RT_GetInterfaceSelection(Adapter) == INTF_SEL4_USB_Combo) ++ ++#define get_hal_mac_addr(adapter) (GET_HAL_DATA(adapter)->EEPROMMACAddr) ++#define is_boot_from_eeprom(adapter) (GET_HAL_DATA(adapter)->EepromOrEfuse) ++#define rtw_get_hw_init_completed(adapter) (GET_HAL_DATA(adapter)->hw_init_completed) ++#define rtw_is_hw_init_completed(adapter) (GET_HAL_DATA(adapter)->hw_init_completed == _TRUE) ++#endif ++ ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++#define GET_ACS_STATE(padapter) (ATOMIC_READ(&GET_HAL_DATA(padapter)->acs.state)) ++#define SET_ACS_STATE(padapter, set_state) (ATOMIC_SET(&GET_HAL_DATA(padapter)->acs.state, set_state)) ++#define rtw_get_acs_channel(padapter) (GET_HAL_DATA(padapter)->acs.ch) ++#define rtw_set_acs_channel(padapter, survey_ch) (GET_HAL_DATA(padapter)->acs.ch = survey_ch) ++#endif /*CONFIG_AUTO_CHNL_SEL_NHM*/ ++ ++#ifdef RTW_HALMAC ++int rtw_halmac_deinit_adapter(struct dvobj_priv *); ++#endif /* RTW_HALMAC */ ++ ++#endif /* __HAL_DATA_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_gspi.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_gspi.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_gspi.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_gspi.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,31 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_GSPI_H_ ++#define __HAL_GSPI_H_ ++ ++#define ffaddr2deviceId(pdvobj, addr) (pdvobj->Queue2Pipe[addr]) ++ ++u8 rtw_hal_gspi_max_txoqt_free_space(_adapter *padapter); ++u8 rtw_hal_gspi_query_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); ++void rtw_hal_gspi_update_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); ++void rtw_hal_set_gspi_tx_max_length(PADAPTER padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ); ++u32 rtw_hal_get_gspi_tx_max_length(PADAPTER padapter, u8 queue_idx); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_ic_cfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_ic_cfg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_ic_cfg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_ic_cfg.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,156 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_IC_CFG_H__ ++#define __HAL_IC_CFG_H__ ++ ++#define RTL8188E_SUPPORT 0 ++#define RTL8812A_SUPPORT 0 ++#define RTL8821A_SUPPORT 0 ++#define RTL8723B_SUPPORT 0 ++#define RTL8723D_SUPPORT 0 ++#define RTL8192E_SUPPORT 0 ++#define RTL8814A_SUPPORT 0 ++#define RTL8195A_SUPPORT 0 ++#define RTL8197F_SUPPORT 0 ++#define RTL8703B_SUPPORT 0 ++#define RTL8188F_SUPPORT 0 ++#define RTL8822B_SUPPORT 0 ++#define RTL8821B_SUPPORT 0 ++#define RTL8821C_SUPPORT 0 ++ ++/*#if (RTL8188E_SUPPORT==1)*/ ++#define RATE_ADAPTIVE_SUPPORT 0 ++#define POWER_TRAINING_ACTIVE 0 ++ ++#ifdef CONFIG_MULTIDRV ++#endif ++ ++#ifdef CONFIG_RTL8188E ++ #undef RTL8188E_SUPPORT ++ #undef RATE_ADAPTIVE_SUPPORT ++ #undef POWER_TRAINING_ACTIVE ++ ++ #define RTL8188E_SUPPORT 1 ++ #define RATE_ADAPTIVE_SUPPORT 1 ++ #define POWER_TRAINING_ACTIVE 1 ++ #define CONFIG_GET_RAID_BY_DRV ++#endif ++ ++#ifdef CONFIG_RTL8812A ++ #undef RTL8812A_SUPPORT ++ #define RTL8812A_SUPPORT 1 ++ #ifndef CONFIG_FW_C2H_PKT ++ #define CONFIG_FW_C2H_PKT ++ #endif ++#endif ++ ++#ifdef CONFIG_RTL8821A ++ #undef RTL8821A_SUPPORT ++ #define RTL8821A_SUPPORT 1 ++ #ifndef CONFIG_FW_C2H_PKT ++ #define CONFIG_FW_C2H_PKT ++ #endif ++#endif ++ ++#ifdef CONFIG_RTL8192E ++ #undef RTL8192E_SUPPORT ++ #define RTL8192E_SUPPORT 1 ++ #ifndef CONFIG_FW_C2H_PKT ++ #define CONFIG_FW_C2H_PKT ++ #endif ++#endif ++ ++#ifdef CONFIG_RTL8723B ++ #undef RTL8723B_SUPPORT ++ #define RTL8723B_SUPPORT 1 ++ #ifndef CONFIG_FW_C2H_PKT ++ #define CONFIG_FW_C2H_PKT ++ #endif ++#endif ++ ++#ifdef CONFIG_RTL8723D ++ #undef RTL8723D_SUPPORT ++ #define RTL8723D_SUPPORT 1 ++ #ifndef CONFIG_FW_C2H_PKT ++ #define CONFIG_FW_C2H_PKT ++ #endif ++ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT ++ #define CONFIG_RTW_MAC_HIDDEN_RPT ++ #endif ++ #ifndef CONFIG_RTW_CUSTOMER_STR ++ #define CONFIG_RTW_CUSTOMER_STR ++ #endif ++#endif ++ ++#ifdef CONFIG_RTL8814A ++ #undef RTL8814A_SUPPORT ++ #define RTL8814A_SUPPORT 1 ++ #ifndef CONFIG_FW_C2H_PKT ++ #define CONFIG_FW_C2H_PKT ++ #endif ++#endif ++ ++#ifdef CONFIG_RTL8703B ++ #undef RTL8703B_SUPPORT ++ #define RTL8703B_SUPPORT 1 ++ #ifndef CONFIG_FW_C2H_PKT ++ #define CONFIG_FW_C2H_PKT ++ #endif ++ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT ++ #define CONFIG_RTW_MAC_HIDDEN_RPT ++ #endif ++#endif ++ ++#ifdef CONFIG_RTL8188F ++ #undef RTL8188F_SUPPORT ++ #define RTL8188F_SUPPORT 1 ++ #ifndef CONFIG_FW_C2H_PKT ++ #define CONFIG_FW_C2H_PKT ++ #endif ++ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT ++ #define CONFIG_RTW_MAC_HIDDEN_RPT ++ #endif ++#endif ++ ++#ifdef CONFIG_RTL8822B ++ #undef RTL8822B_SUPPORT ++ #define RTL8822B_SUPPORT 1 ++ #ifndef CONFIG_FW_C2H_PKT ++ #define CONFIG_FW_C2H_PKT ++ #endif ++#endif ++ ++#ifdef CONFIG_RTL8821C ++ #undef RTL8821C_SUPPORT ++ #define RTL8821C_SUPPORT 1 ++ #ifndef CONFIG_FW_C2H_PKT ++ #define CONFIG_FW_C2H_PKT ++ #endif ++ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT ++ #define CONFIG_RTW_MAC_HIDDEN_RPT ++ #endif ++ #define LOAD_FW_HEADER_FROM_DRIVER ++ #define CONFIG_PHY_CAPABILITY_QUERY ++ #ifdef CONFIG_CONCURRENT_MODE ++ #define CONFIG_SUPPORT_FW_MULTI_PORT ++ #endif ++#endif ++ ++#endif /*__HAL_IC_CFG_H__*/ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_intf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_intf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_intf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_intf.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,734 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_INTF_H__ ++#define __HAL_INTF_H__ ++ ++ ++enum RTL871X_HCI_TYPE { ++ RTW_PCIE = BIT0, ++ RTW_USB = BIT1, ++ RTW_SDIO = BIT2, ++ RTW_GSPI = BIT3, ++}; ++ ++enum _CHIP_TYPE { ++ ++ NULL_CHIP_TYPE, ++ RTL8188E, ++ RTL8192E, ++ RTL8812, ++ RTL8821, /* RTL8811 */ ++ RTL8723B, ++ RTL8814A, ++ RTL8703B, ++ RTL8188F, ++ RTL8822B, ++ RTL8723D, ++ RTL8821C, ++ MAX_CHIP_TYPE ++}; ++ ++extern const u32 _chip_type_to_odm_ic_type[]; ++#define chip_type_to_odm_ic_type(chip_type) (((chip_type) >= MAX_CHIP_TYPE) ? _chip_type_to_odm_ic_type[MAX_CHIP_TYPE] : _chip_type_to_odm_ic_type[(chip_type)]) ++ ++typedef enum _HAL_HW_TIMER_TYPE { ++ HAL_TIMER_NONE = 0, ++ HAL_TIMER_TXBF = 1, ++ HAL_TIMER_EARLYMODE = 2, ++} HAL_HW_TIMER_TYPE, *PHAL_HW_TIMER_TYPE; ++ ++ ++typedef enum _HW_VARIABLES { ++ HW_VAR_MEDIA_STATUS, ++ HW_VAR_SET_OPMODE, ++ HW_VAR_MAC_ADDR, ++ HW_VAR_BSSID, ++ HW_VAR_INIT_RTS_RATE, ++ HW_VAR_BASIC_RATE, ++ HW_VAR_TXPAUSE, ++ HW_VAR_BCN_FUNC, ++ HW_VAR_CORRECT_TSF, ++ HW_VAR_CHECK_BSSID, ++ HW_VAR_MLME_DISCONNECT, ++ HW_VAR_MLME_SITESURVEY, ++ HW_VAR_MLME_JOIN, ++ HW_VAR_ON_RCR_AM, ++ HW_VAR_OFF_RCR_AM, ++ HW_VAR_BEACON_INTERVAL, ++ HW_VAR_SLOT_TIME, ++ HW_VAR_RESP_SIFS, ++ HW_VAR_ACK_PREAMBLE, ++ HW_VAR_SEC_CFG, ++ HW_VAR_SEC_DK_CFG, ++ HW_VAR_BCN_VALID, ++ HW_VAR_RF_TYPE, ++ /* PHYDM odm->SupportAbility */ ++ HW_VAR_CAM_EMPTY_ENTRY, ++ HW_VAR_CAM_INVALID_ALL, ++ HW_VAR_AC_PARAM_VO, ++ HW_VAR_AC_PARAM_VI, ++ HW_VAR_AC_PARAM_BE, ++ HW_VAR_AC_PARAM_BK, ++ HW_VAR_ACM_CTRL, ++ HW_VAR_AMPDU_MIN_SPACE, ++ HW_VAR_AMPDU_FACTOR, ++ HW_VAR_RXDMA_AGG_PG_TH, ++ HW_VAR_SET_RPWM, ++ HW_VAR_CPWM, ++ HW_VAR_H2C_FW_PWRMODE, ++ HW_VAR_H2C_PS_TUNE_PARAM, ++ HW_VAR_H2C_FW_JOINBSSRPT, ++ HW_VAR_FWLPS_RF_ON, ++ HW_VAR_H2C_FW_P2P_PS_OFFLOAD, ++#ifdef CONFIG_LPS_POFF ++ HW_VAR_LPS_POFF_INIT, ++ HW_VAR_LPS_POFF_DEINIT, ++ HW_VAR_LPS_POFF_SET_MODE, ++ HW_VAR_LPS_POFF_WOW_EN, ++#endif ++ HW_VAR_TRIGGER_GPIO_0, ++ HW_VAR_BT_SET_COEXIST, ++ HW_VAR_BT_ISSUE_DELBA, ++ HW_VAR_SWITCH_EPHY_WoWLAN, ++ HW_VAR_EFUSE_USAGE, ++ HW_VAR_EFUSE_BYTES, ++ HW_VAR_EFUSE_BT_USAGE, ++ HW_VAR_EFUSE_BT_BYTES, ++ HW_VAR_FIFO_CLEARN_UP, ++ HW_VAR_RESTORE_HW_SEQ, ++ HW_VAR_CHECK_TXBUF, ++ HW_VAR_PCIE_STOP_TX_DMA, ++ HW_VAR_APFM_ON_MAC, /* Auto FSM to Turn On, include clock, isolation, power control for MAC only */ ++ HW_VAR_HCI_SUS_STATE, ++ /* The valid upper nav range for the HW updating, if the true value is larger than the upper range, the HW won't update it. */ ++ /* Unit in microsecond. 0 means disable this function. */ ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++ HW_VAR_WOWLAN, ++ HW_VAR_WAKEUP_REASON, ++ HW_VAR_RPWM_TOG, ++#endif ++#ifdef CONFIG_GPIO_WAKEUP ++ HW_SET_GPIO_WL_CTRL, ++#endif ++#ifdef CONFIG_RTW_SDIO_OOB_INT ++ HW_SET_OOB_CTRL, ++#endif ++ HW_VAR_SYS_CLKR, ++ HW_VAR_NAV_UPPER, ++ HW_VAR_RPT_TIMER_SETTING, ++ HW_VAR_TX_RPT_MAX_MACID, ++ HW_VAR_CHK_HI_QUEUE_EMPTY, ++ HW_VAR_DL_BCN_SEL, ++ HW_VAR_AMPDU_MAX_TIME, ++ HW_VAR_WIRELESS_MODE, ++ HW_VAR_USB_MODE, ++ HW_VAR_PORT_SWITCH, ++ HW_VAR_DO_IQK, ++ HW_VAR_DM_IN_LPS, ++ HW_VAR_SET_REQ_FW_PS, ++ HW_VAR_FW_PS_STATE, ++ HW_VAR_SOUNDING_ENTER, ++ HW_VAR_SOUNDING_LEAVE, ++ HW_VAR_SOUNDING_RATE, ++ HW_VAR_SOUNDING_STATUS, ++ HW_VAR_SOUNDING_FW_NDPA, ++ HW_VAR_SOUNDING_CLK, ++ HW_VAR_SOUNDING_SET_GID_TABLE, ++ /*Add by YuChen for TXBF HW timer*/ ++ HW_VAR_HW_REG_TIMER_INIT, ++ HW_VAR_HW_REG_TIMER_RESTART, ++ HW_VAR_HW_REG_TIMER_START, ++ HW_VAR_HW_REG_TIMER_STOP, ++ /*Add by YuChen for TXBF HW timer*/ ++ HW_VAR_DL_RSVD_PAGE, ++ HW_VAR_MACID_LINK, ++ HW_VAR_MACID_NOLINK, ++ HW_VAR_MACID_SLEEP, ++ HW_VAR_MACID_WAKEUP, ++ HW_VAR_DUMP_MAC_QUEUE_INFO, ++ HW_VAR_ASIX_IOT, ++#ifdef CONFIG_MBSSID_CAM ++ HW_VAR_MBSSID_CAM_WRITE, ++ HW_VAR_MBSSID_CAM_CLEAR, ++ HW_VAR_RCR_MBSSID_EN, ++#endif ++ HW_VAR_EN_HW_UPDATE_TSF, ++ HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, ++ HW_VAR_CH_SW_IQK_INFO_BACKUP, ++ HW_VAR_CH_SW_IQK_INFO_RESTORE, ++#ifdef CONFIG_TDLS ++ HW_VAR_TDLS_WRCR, ++ HW_VAR_TDLS_RS_RCR, ++#ifdef CONFIG_TDLS_CH_SW ++ HW_VAR_TDLS_BCN_EARLY_C2H_RPT ++#endif ++#endif ++} HW_VARIABLES; ++ ++typedef enum _HAL_DEF_VARIABLE { ++ HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, ++ HAL_DEF_IS_SUPPORT_ANT_DIV, ++ HAL_DEF_DRVINFO_SZ, ++ HAL_DEF_MAX_RECVBUF_SZ, ++ HAL_DEF_RX_PACKET_OFFSET, ++ HAL_DEF_RX_DMA_SZ_WOW, ++ HAL_DEF_RX_DMA_SZ, ++ HAL_DEF_RX_PAGE_SIZE, ++ HAL_DEF_DBG_DUMP_RXPKT,/* for dbg */ ++ HAL_DEF_RA_DECISION_RATE, ++ HAL_DEF_RA_SGI, ++ HAL_DEF_PT_PWR_STATUS, ++ HAL_DEF_TX_LDPC, /* LDPC support */ ++ HAL_DEF_RX_LDPC, /* LDPC support */ ++ HAL_DEF_TX_STBC, /* TX STBC support */ ++ HAL_DEF_RX_STBC, /* RX STBC support */ ++ HAL_DEF_EXPLICIT_BEAMFORMER,/* Explicit Compressed Steering Capable */ ++ HAL_DEF_EXPLICIT_BEAMFORMEE,/* Explicit Compressed Beamforming Feedback Capable */ ++ HAL_DEF_VHT_MU_BEAMFORMER, /* VHT MU Beamformer support */ ++ HAL_DEF_VHT_MU_BEAMFORMEE, /* VHT MU Beamformee support */ ++ HAL_DEF_BEAMFORMER_CAP, ++ HAL_DEF_BEAMFORMEE_CAP, ++ HW_VAR_MAX_RX_AMPDU_FACTOR, ++ HW_DEF_RA_INFO_DUMP, ++ HAL_DEF_DBG_DUMP_TXPKT, ++ ++ HAL_DEF_TX_PAGE_SIZE, ++ HAL_DEF_TX_PAGE_BOUNDARY, ++ HAL_DEF_TX_PAGE_BOUNDARY_WOWLAN, ++ HAL_DEF_ANT_DETECT,/* to do for 8723a */ ++ HAL_DEF_PCI_SUUPORT_L1_BACKDOOR, /* Determine if the L1 Backdoor setting is turned on. */ ++ HAL_DEF_PCI_AMD_L1_SUPPORT, ++ HAL_DEF_PCI_ASPM_OSC, /* Support for ASPM OSC, added by Roger, 2013.03.27. */ ++ HAL_DEF_MACID_SLEEP, /* Support for MACID sleep */ ++ HAL_DEF_DBG_DIS_PWT, /* disable Tx power training or not. */ ++ HAL_DEF_EFUSE_USAGE, /* Get current EFUSE utilization. 2008.12.19. Added by Roger. */ ++ HAL_DEF_EFUSE_BYTES, ++ HW_VAR_BEST_AMPDU_DENSITY, ++} HAL_DEF_VARIABLE; ++ ++typedef enum _HAL_ODM_VARIABLE { ++ HAL_ODM_STA_INFO, ++ HAL_ODM_P2P_STATE, ++ HAL_ODM_WIFI_DISPLAY_STATE, ++ HAL_ODM_NOISE_MONITOR, ++ HAL_ODM_REGULATION, ++ HAL_ODM_INITIAL_GAIN, ++ HAL_ODM_FA_CNT_DUMP, ++ HAL_ODM_DBG_FLAG, ++ HAL_ODM_DBG_LEVEL, ++ HAL_ODM_RX_INFO_DUMP, ++ HAL_ODM_RX_Dframe_INFO, ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++ HAL_ODM_AUTO_CHNL_SEL, ++#endif ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ HAL_ODM_ANTDIV_SELECT ++#endif ++} HAL_ODM_VARIABLE; ++ ++typedef enum _HAL_INTF_PS_FUNC { ++ HAL_USB_SELECT_SUSPEND, ++ HAL_MAX_ID, ++} HAL_INTF_PS_FUNC; ++ ++typedef s32(*c2h_id_filter)(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); ++ ++struct txpwr_idx_comp; ++ ++struct hal_ops { ++ /*** initialize section ***/ ++ void (*read_chip_version)(_adapter *padapter); ++ void (*init_default_value)(_adapter *padapter); ++ void (*intf_chip_configure)(_adapter *padapter); ++ void (*read_adapter_info)(_adapter *padapter); ++ u32(*hal_power_on)(_adapter *padapter); ++ void (*hal_power_off)(_adapter *padapter); ++ u32(*hal_init)(_adapter *padapter); ++ u32(*hal_deinit)(_adapter *padapter); ++ void (*dm_init)(_adapter *padapter); ++ void (*dm_deinit)(_adapter *padapter); ++ ++ /*** xmit section ***/ ++ s32(*init_xmit_priv)(_adapter *padapter); ++ void (*free_xmit_priv)(_adapter *padapter); ++ s32(*hal_xmit)(_adapter *padapter, struct xmit_frame *pxmitframe); ++ /* ++ * mgnt_xmit should be implemented to run in interrupt context ++ */ ++ s32(*mgnt_xmit)(_adapter *padapter, struct xmit_frame *pmgntframe); ++ s32(*hal_xmitframe_enqueue)(_adapter *padapter, struct xmit_frame *pxmitframe); ++#ifdef CONFIG_XMIT_THREAD_MODE ++ s32(*xmit_thread_handler)(_adapter *padapter); ++#endif ++ void (*run_thread)(_adapter *padapter); ++ void (*cancel_thread)(_adapter *padapter); ++ ++ /*** recv section ***/ ++ s32(*init_recv_priv)(_adapter *padapter); ++ void (*free_recv_priv)(_adapter *padapter); ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) ++ u32(*inirp_init)(_adapter *padapter); ++ u32(*inirp_deinit)(_adapter *padapter); ++#endif ++ /*** interrupt hdl section ***/ ++ void (*enable_interrupt)(_adapter *padapter); ++ void (*disable_interrupt)(_adapter *padapter); ++ u8(*check_ips_status)(_adapter *padapter); ++#if defined(CONFIG_PCI_HCI) ++ s32(*interrupt_handler)(_adapter *padapter); ++#endif ++ ++#if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) ++ void (*interrupt_handler)(_adapter *padapter, u16 pkt_len, u8 *pbuf); ++#endif ++ ++#if defined(CONFIG_PCI_HCI) ++ void (*irp_reset)(_adapter *padapter); ++#endif ++ ++ /*** DM section ***/ ++ ++ void (*InitSwLeds)(_adapter *padapter); ++ void (*DeInitSwLeds)(_adapter *padapter); ++ ++ void (*set_chnl_bw_handler)(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80); ++ ++ void (*set_tx_power_level_handler)(_adapter *padapter, u8 channel); ++ void (*get_tx_power_level_handler)(_adapter *padapter, s32 *powerlevel); ++ ++ void (*set_tx_power_index_handler)(_adapter *padapter, u32 powerindex, u8 rfpath, u8 rate); ++ u8(*get_tx_power_index_handler)(_adapter *padapter, u8 rfpath, u8 rate, u8 bandwidth, u8 channel, struct txpwr_idx_comp *tic); ++ ++ void (*hal_dm_watchdog)(_adapter *padapter); ++#ifdef CONFIG_LPS_LCLK_WD_TIMER ++ void (*hal_dm_watchdog_in_lps)(_adapter *padapter); ++#endif ++ ++ void (*SetHwRegHandler)(_adapter *padapter, u8 variable, u8 *val); ++ void (*GetHwRegHandler)(_adapter *padapter, u8 variable, u8 *val); ++ ++ u8(*GetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); ++ u8(*SetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); ++ ++ void (*GetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, PVOID pValue2); ++ void (*SetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, BOOLEAN bSet); ++ ++ void (*UpdateRAMaskHandler)(_adapter *padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level); ++ void (*SetBeaconRelatedRegistersHandler)(_adapter *padapter); ++ ++ u8(*interface_ps_func)(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val); ++ ++ u32(*read_bbreg)(_adapter *padapter, u32 RegAddr, u32 BitMask); ++ void (*write_bbreg)(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); ++ u32(*read_rfreg)(_adapter *padapter, u8 eRFPath, u32 RegAddr, u32 BitMask); ++ void (*write_rfreg)(_adapter *padapter, u8 eRFPath, u32 RegAddr, u32 BitMask, u32 Data); ++ ++#ifdef CONFIG_HOSTAPD_MLME ++ s32(*hostap_mgnt_xmit_entry)(_adapter *padapter, _pkt *pkt); ++#endif ++ ++ void (*EfusePowerSwitch)(_adapter *padapter, u8 bWrite, u8 PwrState); ++ void (*BTEfusePowerSwitch)(_adapter *padapter, u8 bWrite, u8 PwrState); ++ void (*ReadEFuse)(_adapter *padapter, u8 efuseType, u16 _offset, u16 _size_byte, u8 *pbuf, BOOLEAN bPseudoTest); ++ void (*EFUSEGetEfuseDefinition)(_adapter *padapter, u8 efuseType, u8 type, void *pOut, BOOLEAN bPseudoTest); ++ u16(*EfuseGetCurrentSize)(_adapter *padapter, u8 efuseType, BOOLEAN bPseudoTest); ++ int (*Efuse_PgPacketRead)(_adapter *padapter, u8 offset, u8 *data, BOOLEAN bPseudoTest); ++ int (*Efuse_PgPacketWrite)(_adapter *padapter, u8 offset, u8 word_en, u8 *data, BOOLEAN bPseudoTest); ++ u8(*Efuse_WordEnableDataWrite)(_adapter *padapter, u16 efuse_addr, u8 word_en, u8 *data, BOOLEAN bPseudoTest); ++ BOOLEAN(*Efuse_PgPacketWrite_BT)(_adapter *padapter, u8 offset, u8 word_en, u8 *data, BOOLEAN bPseudoTest); ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ void (*sreset_init_value)(_adapter *padapter); ++ void (*sreset_reset_value)(_adapter *padapter); ++ void (*silentreset)(_adapter *padapter); ++ void (*sreset_xmit_status_check)(_adapter *padapter); ++ void (*sreset_linked_status_check)(_adapter *padapter); ++ u8(*sreset_get_wifi_status)(_adapter *padapter); ++ bool (*sreset_inprogress)(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_IOL ++ int (*IOL_exec_cmds_sync)(_adapter *padapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt); ++#endif ++ ++ void (*hal_notch_filter)(_adapter *adapter, bool enable); ++#ifdef RTW_HALMAC ++ void (*hal_mac_c2h_handler)(_adapter *adapter, u8 *pbuf, u16 length); ++#else ++ s32(*c2h_handler)(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); ++#endif ++ s32(*fill_h2c_cmd)(PADAPTER, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); ++ void (*fill_fake_txdesc)(PADAPTER, u8 *pDesc, u32 BufferLen, ++ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); ++ s32(*fw_dl)(_adapter *adapter, u8 wowlan); ++ ++ void (*clear_interrupt)(_adapter *padapter); ++ ++ u8(*hal_get_tx_buff_rsvd_page_num)(_adapter *adapter, bool wowlan); ++#ifdef CONFIG_GPIO_API ++ void (*update_hisr_hsisr_ind)(PADAPTER padapter, u32 flag); ++ int (*hal_gpio_func_check)(_adapter *padapter, u8 gpio_num); ++ void (*hal_gpio_multi_func_reset)(_adapter *padapter, u8 gpio_num); ++#endif ++ void (*fw_correct_bcn)(PADAPTER padapter); ++ ++#ifdef RTW_HALMAC ++ u8(*init_mac_register)(PADAPTER); ++ u8(*init_phy)(PADAPTER); ++#endif /* RTW_HALMAC */ ++}; ++ ++typedef enum _RT_EEPROM_TYPE { ++ EEPROM_93C46, ++ EEPROM_93C56, ++ EEPROM_BOOT_EFUSE, ++} RT_EEPROM_TYPE, *PRT_EEPROM_TYPE; ++ ++ ++ ++#define RF_CHANGE_BY_INIT 0 ++#define RF_CHANGE_BY_IPS BIT28 ++#define RF_CHANGE_BY_PS BIT29 ++#define RF_CHANGE_BY_HW BIT30 ++#define RF_CHANGE_BY_SW BIT31 ++ ++typedef enum _HARDWARE_TYPE { ++ HARDWARE_TYPE_RTL8188EE, ++ HARDWARE_TYPE_RTL8188EU, ++ HARDWARE_TYPE_RTL8188ES, ++ /* NEW_GENERATION_IC */ ++ HARDWARE_TYPE_RTL8192EE, ++ HARDWARE_TYPE_RTL8192EU, ++ HARDWARE_TYPE_RTL8192ES, ++ HARDWARE_TYPE_RTL8812E, ++ HARDWARE_TYPE_RTL8812AU, ++ HARDWARE_TYPE_RTL8811AU, ++ HARDWARE_TYPE_RTL8821E, ++ HARDWARE_TYPE_RTL8821U, ++ HARDWARE_TYPE_RTL8821S, ++ HARDWARE_TYPE_RTL8723BE, ++ HARDWARE_TYPE_RTL8723BU, ++ HARDWARE_TYPE_RTL8723BS, ++ HARDWARE_TYPE_RTL8814AE, ++ HARDWARE_TYPE_RTL8814AU, ++ HARDWARE_TYPE_RTL8814AS, ++ HARDWARE_TYPE_RTL8821BE, ++ HARDWARE_TYPE_RTL8821BU, ++ HARDWARE_TYPE_RTL8821BS, ++ HARDWARE_TYPE_RTL8822BE, ++ HARDWARE_TYPE_RTL8822BU, ++ HARDWARE_TYPE_RTL8822BS, ++ HARDWARE_TYPE_RTL8703BE, ++ HARDWARE_TYPE_RTL8703BU, ++ HARDWARE_TYPE_RTL8703BS, ++ HARDWARE_TYPE_RTL8188FE, ++ HARDWARE_TYPE_RTL8188FU, ++ HARDWARE_TYPE_RTL8188FS, ++ HARDWARE_TYPE_RTL8723DE, ++ HARDWARE_TYPE_RTL8723DU, ++ HARDWARE_TYPE_RTL8723DS, ++ HARDWARE_TYPE_RTL8821CE, ++ HARDWARE_TYPE_RTL8821CU, ++ HARDWARE_TYPE_RTL8821CS, ++ HARDWARE_TYPE_MAX, ++} HARDWARE_TYPE; ++ ++#define IS_NEW_GENERATION_IC(_Adapter) (rtw_get_hw_type(_Adapter) >= HARDWARE_TYPE_RTL8192EE) ++/* ++ * RTL8188E Series ++ * */ ++#define IS_HARDWARE_TYPE_8188EE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188EE) ++#define IS_HARDWARE_TYPE_8188EU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188EU) ++#define IS_HARDWARE_TYPE_8188ES(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188ES) ++#define IS_HARDWARE_TYPE_8188E(_Adapter) \ ++ (IS_HARDWARE_TYPE_8188EE(_Adapter) || IS_HARDWARE_TYPE_8188EU(_Adapter) || IS_HARDWARE_TYPE_8188ES(_Adapter)) ++ ++/* RTL8812 Series */ ++#define IS_HARDWARE_TYPE_8812E(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8812E) ++#define IS_HARDWARE_TYPE_8812AU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8812AU) ++#define IS_HARDWARE_TYPE_8812(_Adapter) \ ++ (IS_HARDWARE_TYPE_8812E(_Adapter) || IS_HARDWARE_TYPE_8812AU(_Adapter)) ++ ++/* RTL8821 Series */ ++#define IS_HARDWARE_TYPE_8821E(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821E) ++#define IS_HARDWARE_TYPE_8811AU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8811AU) ++#define IS_HARDWARE_TYPE_8821U(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821U || \ ++ rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8811AU) ++#define IS_HARDWARE_TYPE_8821S(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821S) ++#define IS_HARDWARE_TYPE_8821(_Adapter) \ ++ (IS_HARDWARE_TYPE_8821E(_Adapter) || IS_HARDWARE_TYPE_8821U(_Adapter) || IS_HARDWARE_TYPE_8821S(_Adapter)) ++ ++#define IS_HARDWARE_TYPE_JAGUAR(_Adapter) \ ++ (IS_HARDWARE_TYPE_8812(_Adapter) || IS_HARDWARE_TYPE_8821(_Adapter)) ++ ++/* RTL8192E Series */ ++#define IS_HARDWARE_TYPE_8192EE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192EE) ++#define IS_HARDWARE_TYPE_8192EU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192EU) ++#define IS_HARDWARE_TYPE_8192ES(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192ES) ++ ++#define IS_HARDWARE_TYPE_8192E(_Adapter) \ ++ (IS_HARDWARE_TYPE_8192EE(_Adapter) || IS_HARDWARE_TYPE_8192EU(_Adapter) || IS_HARDWARE_TYPE_8192ES(_Adapter)) ++ ++#define IS_HARDWARE_TYPE_8723BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723BE) ++#define IS_HARDWARE_TYPE_8723BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723BU) ++#define IS_HARDWARE_TYPE_8723BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723BS) ++ ++#define IS_HARDWARE_TYPE_8723B(_Adapter) \ ++ (IS_HARDWARE_TYPE_8723BE(_Adapter) || IS_HARDWARE_TYPE_8723BU(_Adapter) || IS_HARDWARE_TYPE_8723BS(_Adapter)) ++ ++/* RTL8814A Series */ ++#define IS_HARDWARE_TYPE_8814AE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814AE) ++#define IS_HARDWARE_TYPE_8814AU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814AU) ++#define IS_HARDWARE_TYPE_8814AS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814AS) ++ ++#define IS_HARDWARE_TYPE_8814A(_Adapter) \ ++ (IS_HARDWARE_TYPE_8814AE(_Adapter) || IS_HARDWARE_TYPE_8814AU(_Adapter) || IS_HARDWARE_TYPE_8814AS(_Adapter)) ++ ++/* RTL8703B Series */ ++#define IS_HARDWARE_TYPE_8703BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8703BE) ++#define IS_HARDWARE_TYPE_8703BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8703BS) ++#define IS_HARDWARE_TYPE_8703BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8703BU) ++#define IS_HARDWARE_TYPE_8703B(_Adapter) \ ++ (IS_HARDWARE_TYPE_8703BE(_Adapter) || IS_HARDWARE_TYPE_8703BU(_Adapter) || IS_HARDWARE_TYPE_8703BS(_Adapter)) ++ ++/* RTL8723D Series */ ++#define IS_HARDWARE_TYPE_8723DE(_Adapter)\ ++ (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723DE) ++#define IS_HARDWARE_TYPE_8723DS(_Adapter)\ ++ (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723DS) ++#define IS_HARDWARE_TYPE_8723DU(_Adapter)\ ++ (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723DU) ++#define IS_HARDWARE_TYPE_8723D(_Adapter)\ ++ (IS_HARDWARE_TYPE_8723DE(_Adapter) || \ ++ IS_HARDWARE_TYPE_8723DU(_Adapter) || \ ++ IS_HARDWARE_TYPE_8723DS(_Adapter)) ++ ++/* RTL8188F Series */ ++#define IS_HARDWARE_TYPE_8188FE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188FE) ++#define IS_HARDWARE_TYPE_8188FS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188FS) ++#define IS_HARDWARE_TYPE_8188FU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188FU) ++#define IS_HARDWARE_TYPE_8188F(_Adapter) \ ++ (IS_HARDWARE_TYPE_8188FE(_Adapter) || IS_HARDWARE_TYPE_8188FU(_Adapter) || IS_HARDWARE_TYPE_8188FS(_Adapter)) ++ ++#define IS_HARDWARE_TYPE_8821BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821BE) ++#define IS_HARDWARE_TYPE_8821BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821BU) ++#define IS_HARDWARE_TYPE_8821BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821BS) ++ ++#define IS_HARDWARE_TYPE_8821B(_Adapter) \ ++ (IS_HARDWARE_TYPE_8821BE(_Adapter) || IS_HARDWARE_TYPE_8821BU(_Adapter) || IS_HARDWARE_TYPE_8821BS(_Adapter)) ++ ++#define IS_HARDWARE_TYPE_8822BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822BE) ++#define IS_HARDWARE_TYPE_8822BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822BU) ++#define IS_HARDWARE_TYPE_8822BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822BS) ++#define IS_HARDWARE_TYPE_8822B(_Adapter) \ ++ (IS_HARDWARE_TYPE_8822BE(_Adapter) || IS_HARDWARE_TYPE_8822BU(_Adapter) || IS_HARDWARE_TYPE_8822BS(_Adapter)) ++ ++#define IS_HARDWARE_TYPE_8821CE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821CE) ++#define IS_HARDWARE_TYPE_8821CU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821CU) ++#define IS_HARDWARE_TYPE_8821CS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821CS) ++#define IS_HARDWARE_TYPE_8821C(_Adapter) \ ++ (IS_HARDWARE_TYPE_8821CE(_Adapter) || IS_HARDWARE_TYPE_8821CU(_Adapter) || IS_HARDWARE_TYPE_8821CS(_Adapter)) ++ ++#define IS_HARDWARE_TYPE_JAGUAR2(_Adapter) \ ++ (IS_HARDWARE_TYPE_8814A(_Adapter) || IS_HARDWARE_TYPE_8821B(_Adapter) || IS_HARDWARE_TYPE_8822B(_Adapter) || IS_HARDWARE_TYPE_8821C(_Adapter)) ++ ++#define IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(_Adapter) \ ++ (IS_HARDWARE_TYPE_JAGUAR(_Adapter) || IS_HARDWARE_TYPE_JAGUAR2(_Adapter)) ++ ++ ++ ++typedef enum _wowlan_subcode { ++ WOWLAN_ENABLE = 0, ++ WOWLAN_DISABLE = 1, ++ WOWLAN_AP_ENABLE = 2, ++ WOWLAN_AP_DISABLE = 3, ++ WOWLAN_PATTERN_CLEAN = 4 ++} wowlan_subcode; ++ ++struct wowlan_ioctl_param { ++ unsigned int subcode; ++ unsigned int subcode_value; ++ unsigned int wakeup_reason; ++}; ++ ++u8 rtw_hal_data_init(_adapter *padapter); ++void rtw_hal_data_deinit(_adapter *padapter); ++ ++void rtw_hal_def_value_init(_adapter *padapter); ++ ++void rtw_hal_free_data(_adapter *padapter); ++ ++void rtw_hal_dm_init(_adapter *padapter); ++void rtw_hal_dm_deinit(_adapter *padapter); ++void rtw_hal_sw_led_init(_adapter *padapter); ++void rtw_hal_sw_led_deinit(_adapter *padapter); ++ ++u32 rtw_hal_power_on(_adapter *padapter); ++void rtw_hal_power_off(_adapter *padapter); ++ ++uint rtw_hal_init(_adapter *padapter); ++uint rtw_hal_deinit(_adapter *padapter); ++void rtw_hal_stop(_adapter *padapter); ++void rtw_hal_set_hwreg(PADAPTER padapter, u8 variable, u8 *val); ++void rtw_hal_get_hwreg(PADAPTER padapter, u8 variable, u8 *val); ++ ++void rtw_hal_chip_configure(_adapter *padapter); ++void rtw_hal_read_chip_info(_adapter *padapter); ++void rtw_hal_read_chip_version(_adapter *padapter); ++ ++u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); ++u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); ++ ++void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, BOOLEAN bSet); ++void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, PVOID pValue2); ++ ++void rtw_hal_enable_interrupt(_adapter *padapter); ++void rtw_hal_disable_interrupt(_adapter *padapter); ++ ++u8 rtw_hal_check_ips_status(_adapter *padapter); ++ ++#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) ++ u32 rtw_hal_inirp_init(_adapter *padapter); ++ u32 rtw_hal_inirp_deinit(_adapter *padapter); ++#endif ++ ++#if defined(CONFIG_PCI_HCI) ++ void rtw_hal_irp_reset(_adapter *padapter); ++#endif ++ ++u8 rtw_hal_intf_ps_func(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val); ++ ++s32 rtw_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++s32 rtw_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe); ++s32 rtw_hal_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe); ++ ++s32 rtw_hal_init_xmit_priv(_adapter *padapter); ++void rtw_hal_free_xmit_priv(_adapter *padapter); ++ ++s32 rtw_hal_init_recv_priv(_adapter *padapter); ++void rtw_hal_free_recv_priv(_adapter *padapter); ++ ++void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level); ++void rtw_update_ramask(_adapter *padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level); ++ ++void rtw_hal_start_thread(_adapter *padapter); ++void rtw_hal_stop_thread(_adapter *padapter); ++ ++void rtw_hal_bcn_related_reg_setting(_adapter *padapter); ++ ++u32 rtw_hal_read_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask); ++void rtw_hal_write_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); ++u32 rtw_hal_read_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask); ++void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask, u32 Data); ++ ++#define PHY_QueryBBReg(Adapter, RegAddr, BitMask) rtw_hal_read_bbreg((Adapter), (RegAddr), (BitMask)) ++#define PHY_SetBBReg(Adapter, RegAddr, BitMask, Data) rtw_hal_write_bbreg((Adapter), (RegAddr), (BitMask), (Data)) ++#define PHY_QueryRFReg(Adapter, eRFPath, RegAddr, BitMask) rtw_hal_read_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask)) ++#define PHY_SetRFReg(Adapter, eRFPath, RegAddr, BitMask, Data) rtw_hal_write_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask), (Data)) ++ ++#define PHY_SetMacReg PHY_SetBBReg ++#define PHY_QueryMacReg PHY_QueryBBReg ++ ++#if defined(CONFIG_PCI_HCI) ++ s32 rtw_hal_interrupt_handler(_adapter *padapter); ++#endif ++#if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) ++ void rtw_hal_interrupt_handler(_adapter *padapter, u16 pkt_len, u8 *pbuf); ++#endif ++ ++void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80); ++void rtw_hal_dm_watchdog(_adapter *padapter); ++void rtw_hal_dm_watchdog_in_lps(_adapter *padapter); ++ ++void rtw_hal_set_tx_power_level(_adapter *padapter, u8 channel); ++void rtw_hal_get_tx_power_level(_adapter *padapter, s32 *powerlevel); ++ ++#ifdef CONFIG_HOSTAPD_MLME ++ s32 rtw_hal_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt); ++#endif ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++void rtw_hal_sreset_init(_adapter *padapter); ++void rtw_hal_sreset_reset(_adapter *padapter); ++void rtw_hal_sreset_reset_value(_adapter *padapter); ++void rtw_hal_sreset_xmit_status_check(_adapter *padapter); ++void rtw_hal_sreset_linked_status_check(_adapter *padapter); ++u8 rtw_hal_sreset_get_wifi_status(_adapter *padapter); ++bool rtw_hal_sreset_inprogress(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_IOL ++int rtw_hal_iol_cmd(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt); ++#endif ++ ++#ifdef CONFIG_XMIT_THREAD_MODE ++s32 rtw_hal_xmit_thread_handler(_adapter *padapter); ++#endif ++ ++void rtw_hal_notch_filter(_adapter *adapter, bool enable); ++ ++#ifdef CONFIG_FW_C2H_REG ++bool rtw_hal_c2h_reg_hdr_parse(_adapter *adapter, u8 *buf, u8 *id, u8 *seq, u8 *plen, u8 **payload); ++bool rtw_hal_c2h_valid(_adapter *adapter, u8 *buf); ++s32 rtw_hal_c2h_evt_read(_adapter *adapter, u8 *buf); ++#endif ++ ++#ifdef CONFIG_FW_C2H_PKT ++bool rtw_hal_c2h_pkt_hdr_parse(_adapter *adapter, u8 *buf, u16 len, u8 *id, u8 *seq, u8 *plen, u8 **payload); ++#endif ++ ++s32 c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); ++#ifndef RTW_HALMAC ++s32 rtw_hal_c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); ++s32 rtw_hal_c2h_id_handle_directly(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); ++#endif ++ ++s32 rtw_hal_is_disable_sw_channel_plan(PADAPTER padapter); ++ ++s32 rtw_hal_macid_sleep(PADAPTER padapter, u8 macid); ++s32 rtw_hal_macid_wakeup(PADAPTER padapter, u8 macid); ++ ++s32 rtw_hal_fill_h2c_cmd(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); ++void rtw_hal_fill_fake_txdesc(_adapter *padapter, u8 *pDesc, u32 BufferLen, ++ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); ++u8 rtw_hal_get_txbuff_rsvd_page_num(_adapter *adapter, bool wowlan); ++ ++#ifdef CONFIG_GPIO_API ++void rtw_hal_update_hisr_hsisr_ind(_adapter *padapter, u32 flag); ++int rtw_hal_gpio_func_check(_adapter *padapter, u8 gpio_num); ++void rtw_hal_gpio_multi_func_reset(_adapter *padapter, u8 gpio_num); ++#endif ++ ++void rtw_hal_fw_correct_bcn(_adapter *padapter); ++s32 rtw_hal_fw_dl(_adapter *padapter, u8 wowlan); ++ ++void rtw_hal_clear_interrupt(_adapter *padapter); ++ ++void rtw_hal_set_tx_power_index(PADAPTER, u32 powerindex, u8 rfpath, u8 rate); ++u8 rtw_hal_get_tx_power_index(PADAPTER, u8 rfpath, u8 rate, u8 bandwidth, u8 channel,struct txpwr_idx_comp *tic); ++ ++u8 rtw_hal_ops_check(_adapter *padapter); ++ ++#ifdef RTW_HALMAC ++ u8 rtw_hal_init_mac_register(PADAPTER); ++ u8 rtw_hal_init_phy(PADAPTER); ++#endif /* RTW_HALMAC */ ++ ++#endif /* __HAL_INTF_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_pg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_pg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_pg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_pg.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,800 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __HAL_PG_H__ ++#define __HAL_PG_H__ ++ ++#define PPG_BB_GAIN_2G_TX_OFFSET_MASK 0x0F ++#define PPG_BB_GAIN_2G_TXB_OFFSET_MASK 0xF0 ++ ++#define PPG_BB_GAIN_5G_TX_OFFSET_MASK 0x1F ++#define PPG_THERMAL_OFFSET_MASK 0x1F ++#define KFREE_BB_GAIN_2G_TX_OFFSET(_ppg_v) (((_ppg_v) == PPG_BB_GAIN_2G_TX_OFFSET_MASK) ? 0 : (((_ppg_v) & 0x01) ? ((_ppg_v) >> 1) : (-((_ppg_v) >> 1)))) ++#define KFREE_BB_GAIN_2G_TXB_OFFSET(_ppg_v) (((_ppg_v) == PPG_BB_GAIN_2G_TXB_OFFSET_MASK) ? 0 : (((_ppg_v) & 0x10) ? ((_ppg_v) >> 5) : (-((_ppg_v) >> 5)))) ++#define KFREE_BB_GAIN_5G_TX_OFFSET(_ppg_v) (((_ppg_v) == PPG_BB_GAIN_5G_TX_OFFSET_MASK) ? 0 : (((_ppg_v) & 0x01) ? ((_ppg_v) >> 1) : (-((_ppg_v) >> 1)))) ++#define KFREE_THERMAL_OFFSET(_ppg_v) (((_ppg_v) == PPG_THERMAL_OFFSET_MASK) ? 0 : (((_ppg_v) & 0x01) ? ((_ppg_v) >> 1) : (-((_ppg_v) >> 1)))) ++ ++/* **************************************************** ++ * EEPROM/Efuse PG Offset for 88EE/88EU/88ES ++ * **************************************************** */ ++#define EEPROM_TX_PWR_INX_88E 0x10 ++ ++#define EEPROM_ChannelPlan_88E 0xB8 ++#define EEPROM_XTAL_88E 0xB9 ++#define EEPROM_THERMAL_METER_88E 0xBA ++#define EEPROM_IQK_LCK_88E 0xBB ++ ++#define EEPROM_RF_BOARD_OPTION_88E 0xC1 ++#define EEPROM_RF_FEATURE_OPTION_88E 0xC2 ++#define EEPROM_RF_BT_SETTING_88E 0xC3 ++#define EEPROM_VERSION_88E 0xC4 ++#define EEPROM_CustomID_88E 0xC5 ++#define EEPROM_RF_ANTENNA_OPT_88E 0xC9 ++#define EEPROM_COUNTRY_CODE_88E 0xCB ++ ++/* RTL88EE */ ++#define EEPROM_MAC_ADDR_88EE 0xD0 ++#define EEPROM_VID_88EE 0xD6 ++#define EEPROM_DID_88EE 0xD8 ++#define EEPROM_SVID_88EE 0xDA ++#define EEPROM_SMID_88EE 0xDC ++ ++/* RTL88EU */ ++#define EEPROM_MAC_ADDR_88EU 0xD7 ++#define EEPROM_VID_88EU 0xD0 ++#define EEPROM_PID_88EU 0xD2 ++#define EEPROM_USB_OPTIONAL_FUNCTION0 0xD4 /* 8188EU, 8192EU, 8812AU is the same */ ++#define EEPROM_USB_OPTIONAL_FUNCTION0_8811AU 0x104 ++ ++/* RTL88ES */ ++#define EEPROM_MAC_ADDR_88ES 0x11A ++/* **************************************************** ++ * EEPROM/Efuse PG Offset for 8192EE/8192EU/8192ES ++ * **************************************************** */ ++#define GET_PG_KFREE_ON_8192E(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) ++#define GET_PG_KFREE_THERMAL_K_ON_8192E(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) ++ ++#define PPG_BB_GAIN_2G_TXA_OFFSET_8192E 0x1F6 ++#define PPG_THERMAL_OFFSET_8192E 0x1F5 ++ ++/* 0x10 ~ 0x63 = TX power area. */ ++#define EEPROM_TX_PWR_INX_8192E 0x10 ++ ++#define EEPROM_ChannelPlan_8192E 0xB8 ++#define EEPROM_XTAL_8192E 0xB9 ++#define EEPROM_THERMAL_METER_8192E 0xBA ++#define EEPROM_IQK_LCK_8192E 0xBB ++#define EEPROM_2G_5G_PA_TYPE_8192E 0xBC ++#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8192E 0xBD ++#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8192E 0xBF ++ ++#define EEPROM_RF_BOARD_OPTION_8192E 0xC1 ++#define EEPROM_RF_FEATURE_OPTION_8192E 0xC2 ++#define EEPROM_RF_BT_SETTING_8192E 0xC3 ++#define EEPROM_VERSION_8192E 0xC4 ++#define EEPROM_CustomID_8192E 0xC5 ++#define EEPROM_TX_BBSWING_2G_8192E 0xC6 ++#define EEPROM_TX_BBSWING_5G_8192E 0xC7 ++#define EEPROM_TX_PWR_CALIBRATE_RATE_8192E 0xC8 ++#define EEPROM_RF_ANTENNA_OPT_8192E 0xC9 ++#define EEPROM_RFE_OPTION_8192E 0xCA ++#define EEPROM_RFE_OPTION_8188E 0xCA ++#define EEPROM_COUNTRY_CODE_8192E 0xCB ++ ++/* RTL8192EE */ ++#define EEPROM_MAC_ADDR_8192EE 0xD0 ++#define EEPROM_VID_8192EE 0xD6 ++#define EEPROM_DID_8192EE 0xD8 ++#define EEPROM_SVID_8192EE 0xDA ++#define EEPROM_SMID_8192EE 0xDC ++ ++/* RTL8192EU */ ++#define EEPROM_MAC_ADDR_8192EU 0xD7 ++#define EEPROM_VID_8192EU 0xD0 ++#define EEPROM_PID_8192EU 0xD2 ++#define EEPROM_PA_TYPE_8192EU 0xBC ++#define EEPROM_LNA_TYPE_2G_8192EU 0xBD ++#define EEPROM_LNA_TYPE_5G_8192EU 0xBF ++ ++/* RTL8192ES */ ++#define EEPROM_MAC_ADDR_8192ES 0x11A ++/* **************************************************** ++ * EEPROM/Efuse PG Offset for 8812AE/8812AU/8812AS ++ * **************************************************** ++ * 0x10 ~ 0x63 = TX power area. */ ++#define EEPROM_USB_MODE_8812 0x08 ++#define EEPROM_TX_PWR_INX_8812 0x10 ++ ++#define EEPROM_ChannelPlan_8812 0xB8 ++#define EEPROM_XTAL_8812 0xB9 ++#define EEPROM_THERMAL_METER_8812 0xBA ++#define EEPROM_IQK_LCK_8812 0xBB ++#define EEPROM_2G_5G_PA_TYPE_8812 0xBC ++#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8812 0xBD ++#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8812 0xBF ++ ++#define EEPROM_RF_BOARD_OPTION_8812 0xC1 ++#define EEPROM_RF_FEATURE_OPTION_8812 0xC2 ++#define EEPROM_RF_BT_SETTING_8812 0xC3 ++#define EEPROM_VERSION_8812 0xC4 ++#define EEPROM_CustomID_8812 0xC5 ++#define EEPROM_TX_BBSWING_2G_8812 0xC6 ++#define EEPROM_TX_BBSWING_5G_8812 0xC7 ++#define EEPROM_TX_PWR_CALIBRATE_RATE_8812 0xC8 ++#define EEPROM_RF_ANTENNA_OPT_8812 0xC9 ++#define EEPROM_RFE_OPTION_8812 0xCA ++#define EEPROM_COUNTRY_CODE_8812 0xCB ++ ++/* RTL8812AE */ ++#define EEPROM_MAC_ADDR_8812AE 0xD0 ++#define EEPROM_VID_8812AE 0xD6 ++#define EEPROM_DID_8812AE 0xD8 ++#define EEPROM_SVID_8812AE 0xDA ++#define EEPROM_SMID_8812AE 0xDC ++ ++/* RTL8812AU */ ++#define EEPROM_MAC_ADDR_8812AU 0xD7 ++#define EEPROM_VID_8812AU 0xD0 ++#define EEPROM_PID_8812AU 0xD2 ++#define EEPROM_PA_TYPE_8812AU 0xBC ++#define EEPROM_LNA_TYPE_2G_8812AU 0xBD ++#define EEPROM_LNA_TYPE_5G_8812AU 0xBF ++ ++/* RTL8814AU */ ++#define EEPROM_MAC_ADDR_8814AU 0xD8 ++#define EEPROM_VID_8814AU 0xD0 ++#define EEPROM_PID_8814AU 0xD2 ++#define EEPROM_PA_TYPE_8814AU 0xBC ++#define EEPROM_LNA_TYPE_2G_8814AU 0xBD ++#define EEPROM_LNA_TYPE_5G_8814AU 0xBF ++ ++/* RTL8814AE */ ++#define EEPROM_MAC_ADDR_8814AE 0xD0 ++#define EEPROM_VID_8814AE 0xD6 ++#define EEPROM_DID_8814AE 0xD8 ++#define EEPROM_SVID_8814AE 0xDA ++#define EEPROM_SMID_8814AE 0xDC ++ ++/* **************************************************** ++ * EEPROM/Efuse PG Offset for 8814AU ++ * **************************************************** */ ++#define GET_PG_KFREE_ON_8814A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 4, 1) ++#define GET_PG_KFREE_THERMAL_K_ON_8814A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) ++#define GET_PG_TX_POWER_TRACKING_MODE_8814A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 6, 2) ++ ++#define KFREE_GAIN_DATA_LENGTH_8814A 22 ++ ++#define PPG_BB_GAIN_2G_TXBA_OFFSET_8814A 0x3EE ++ ++#define PPG_THERMAL_OFFSET_8814A 0x3EF ++ ++#define EEPROM_TX_PWR_INX_8814 0x10 ++#define EEPROM_USB_MODE_8814A 0x0E ++#define EEPROM_ChannelPlan_8814 0xB8 ++#define EEPROM_XTAL_8814 0xB9 ++#define EEPROM_THERMAL_METER_8814 0xBA ++#define EEPROM_IQK_LCK_8814 0xBB ++ ++ ++#define EEPROM_PA_TYPE_8814 0xBC ++#define EEPROM_LNA_TYPE_AB_2G_8814 0xBD ++#define EEPROM_LNA_TYPE_CD_2G_8814 0xBE ++#define EEPROM_LNA_TYPE_AB_5G_8814 0xBF ++#define EEPROM_LNA_TYPE_CD_5G_8814 0xC0 ++#define EEPROM_RF_BOARD_OPTION_8814 0xC1 ++#define EEPROM_RF_BT_SETTING_8814 0xC3 ++#define EEPROM_VERSION_8814 0xC4 ++#define EEPROM_CustomID_8814 0xC5 ++#define EEPROM_TX_BBSWING_2G_8814 0xC6 ++#define EEPROM_TX_BBSWING_5G_8814 0xC7 ++#define EEPROM_TRX_ANTENNA_OPTION_8814 0xC9 ++#define EEPROM_RFE_OPTION_8814 0xCA ++#define EEPROM_COUNTRY_CODE_8814 0xCB ++ ++/*Extra Info for 8814A Initial Gain Fine Tune suggested by Willis, JIRA: MP123*/ ++#define EEPROM_IG_OFFSET_4_AB_2G_8814A 0x120 ++#define EEPROM_IG_OFFSET_4_CD_2G_8814A 0x121 ++#define EEPROM_IG_OFFSET_4_AB_5GL_8814A 0x122 ++#define EEPROM_IG_OFFSET_4_CD_5GL_8814A 0x123 ++#define EEPROM_IG_OFFSET_4_AB_5GM_8814A 0x124 ++#define EEPROM_IG_OFFSET_4_CD_5GM_8814A 0x125 ++#define EEPROM_IG_OFFSET_4_AB_5GH_8814A 0x126 ++#define EEPROM_IG_OFFSET_4_CD_5GH_8814A 0x127 ++ ++/* **************************************************** ++ * EEPROM/Efuse PG Offset for 8821AE/8821AU/8821AS ++ * **************************************************** */ ++ ++#define GET_PG_KFREE_ON_8821A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 4, 1) ++#define GET_PG_KFREE_THERMAL_K_ON_8821A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) ++ ++#define PPG_BB_GAIN_2G_TXA_OFFSET_8821A 0x1F6 ++#define PPG_THERMAL_OFFSET_8821A 0x1F5 ++#define PPG_BB_GAIN_5GLB1_TXA_OFFSET_8821A 0x1F4 ++#define PPG_BB_GAIN_5GLB2_TXA_OFFSET_8821A 0x1F3 ++#define PPG_BB_GAIN_5GMB1_TXA_OFFSET_8821A 0x1F2 ++#define PPG_BB_GAIN_5GMB2_TXA_OFFSET_8821A 0x1F1 ++#define PPG_BB_GAIN_5GHB_TXA_OFFSET_8821A 0x1F0 ++ ++#define EEPROM_TX_PWR_INX_8821 0x10 ++ ++#define EEPROM_ChannelPlan_8821 0xB8 ++#define EEPROM_XTAL_8821 0xB9 ++#define EEPROM_THERMAL_METER_8821 0xBA ++#define EEPROM_IQK_LCK_8821 0xBB ++ ++ ++#define EEPROM_RF_BOARD_OPTION_8821 0xC1 ++#define EEPROM_RF_FEATURE_OPTION_8821 0xC2 ++#define EEPROM_RF_BT_SETTING_8821 0xC3 ++#define EEPROM_VERSION_8821 0xC4 ++#define EEPROM_CustomID_8821 0xC5 ++#define EEPROM_RF_ANTENNA_OPT_8821 0xC9 ++ ++/* RTL8821AE */ ++#define EEPROM_MAC_ADDR_8821AE 0xD0 ++#define EEPROM_VID_8821AE 0xD6 ++#define EEPROM_DID_8821AE 0xD8 ++#define EEPROM_SVID_8821AE 0xDA ++#define EEPROM_SMID_8821AE 0xDC ++ ++/* RTL8821AU */ ++#define EEPROM_PA_TYPE_8821AU 0xBC ++#define EEPROM_LNA_TYPE_8821AU 0xBF ++ ++/* RTL8821AS */ ++#define EEPROM_MAC_ADDR_8821AS 0x11A ++ ++/* RTL8821AU */ ++#define EEPROM_MAC_ADDR_8821AU 0x107 ++#define EEPROM_VID_8821AU 0x100 ++#define EEPROM_PID_8821AU 0x102 ++ ++ ++/* **************************************************** ++ * EEPROM/Efuse PG Offset for 8192 SE/SU ++ * **************************************************** */ ++#define EEPROM_VID_92SE 0x0A ++#define EEPROM_DID_92SE 0x0C ++#define EEPROM_SVID_92SE 0x0E ++#define EEPROM_SMID_92SE 0x10 ++ ++#define EEPROM_MAC_ADDR_92S 0x12 ++ ++#define EEPROM_TSSI_A_92SE 0x74 ++#define EEPROM_TSSI_B_92SE 0x75 ++ ++#define EEPROM_Version_92SE 0x7C ++ ++ ++#define EEPROM_VID_92SU 0x08 ++#define EEPROM_PID_92SU 0x0A ++ ++#define EEPROM_Version_92SU 0x50 ++#define EEPROM_TSSI_A_92SU 0x6b ++#define EEPROM_TSSI_B_92SU 0x6c ++ ++/* ==================================================== ++ EEPROM/Efuse PG Offset for 8188FE/8188FU/8188FS ++ ==================================================== ++ */ ++ ++#define GET_PG_KFREE_ON_8188F(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) ++#define GET_PG_KFREE_THERMAL_K_ON_8188F(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) ++ ++#define PPG_BB_GAIN_2G_TXA_OFFSET_8188F 0xEE ++#define PPG_THERMAL_OFFSET_8188F 0xEF ++ ++/* 0x10 ~ 0x63 = TX power area. */ ++#define EEPROM_TX_PWR_INX_8188F 0x10 ++ ++#define EEPROM_ChannelPlan_8188F 0xB8 ++#define EEPROM_XTAL_8188F 0xB9 ++#define EEPROM_THERMAL_METER_8188F 0xBA ++#define EEPROM_IQK_LCK_8188F 0xBB ++#define EEPROM_2G_5G_PA_TYPE_8188F 0xBC ++#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8188F 0xBD ++#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8188F 0xBF ++ ++#define EEPROM_RF_BOARD_OPTION_8188F 0xC1 ++#define EEPROM_FEATURE_OPTION_8188F 0xC2 ++#define EEPROM_RF_BT_SETTING_8188F 0xC3 ++#define EEPROM_VERSION_8188F 0xC4 ++#define EEPROM_CustomID_8188F 0xC5 ++#define EEPROM_TX_BBSWING_2G_8188F 0xC6 ++#define EEPROM_TX_PWR_CALIBRATE_RATE_8188F 0xC8 ++#define EEPROM_RF_ANTENNA_OPT_8188F 0xC9 ++#define EEPROM_RFE_OPTION_8188F 0xCA ++#define EEPROM_COUNTRY_CODE_8188F 0xCB ++#define EEPROM_CUSTOMER_ID_8188F 0x7F ++#define EEPROM_SUBCUSTOMER_ID_8188F 0x59 ++ ++/* RTL8188FU */ ++#define EEPROM_MAC_ADDR_8188FU 0xD7 ++#define EEPROM_VID_8188FU 0xD0 ++#define EEPROM_PID_8188FU 0xD2 ++#define EEPROM_PA_TYPE_8188FU 0xBC ++#define EEPROM_LNA_TYPE_2G_8188FU 0xBD ++#define EEPROM_USB_OPTIONAL_FUNCTION0_8188FU 0xD4 ++ ++/* RTL8188FS */ ++#define EEPROM_MAC_ADDR_8188FS 0x11A ++#define EEPROM_Voltage_ADDR_8188F 0x8 ++ ++/* **************************************************** ++ * EEPROM/Efuse PG Offset for 8723BE/8723BU/8723BS ++ * **************************************************** ++ * 0x10 ~ 0x63 = TX power area. */ ++#define EEPROM_TX_PWR_INX_8723B 0x10 ++ ++#define EEPROM_ChannelPlan_8723B 0xB8 ++#define EEPROM_XTAL_8723B 0xB9 ++#define EEPROM_THERMAL_METER_8723B 0xBA ++#define EEPROM_IQK_LCK_8723B 0xBB ++#define EEPROM_2G_5G_PA_TYPE_8723B 0xBC ++#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8723B 0xBD ++#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8723B 0xBF ++ ++#define EEPROM_RF_BOARD_OPTION_8723B 0xC1 ++#define EEPROM_FEATURE_OPTION_8723B 0xC2 ++#define EEPROM_RF_BT_SETTING_8723B 0xC3 ++#define EEPROM_VERSION_8723B 0xC4 ++#define EEPROM_CustomID_8723B 0xC5 ++#define EEPROM_TX_BBSWING_2G_8723B 0xC6 ++#define EEPROM_TX_PWR_CALIBRATE_RATE_8723B 0xC8 ++#define EEPROM_RF_ANTENNA_OPT_8723B 0xC9 ++#define EEPROM_RFE_OPTION_8723B 0xCA ++#define EEPROM_COUNTRY_CODE_8723B 0xCB ++ ++/* RTL8723BE */ ++#define EEPROM_MAC_ADDR_8723BE 0xD0 ++#define EEPROM_VID_8723BE 0xD6 ++#define EEPROM_DID_8723BE 0xD8 ++#define EEPROM_SVID_8723BE 0xDA ++#define EEPROM_SMID_8723BE 0xDC ++ ++/* RTL8723BU */ ++#define EEPROM_MAC_ADDR_8723BU 0x107 ++#define EEPROM_VID_8723BU 0x100 ++#define EEPROM_PID_8723BU 0x102 ++#define EEPROM_PA_TYPE_8723BU 0xBC ++#define EEPROM_LNA_TYPE_2G_8723BU 0xBD ++ ++ ++/* RTL8723BS */ ++#define EEPROM_MAC_ADDR_8723BS 0x11A ++#define EEPROM_Voltage_ADDR_8723B 0x8 ++ ++/* **************************************************** ++ * EEPROM/Efuse PG Offset for 8703B ++ * **************************************************** */ ++#define GET_PG_KFREE_ON_8703B(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) ++#define GET_PG_KFREE_THERMAL_K_ON_8703B(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) ++ ++#define PPG_BB_GAIN_2G_TXA_OFFSET_8703B 0xEE ++#define PPG_THERMAL_OFFSET_8703B 0xEF ++ ++#define EEPROM_TX_PWR_INX_8703B 0x10 ++ ++#define EEPROM_ChannelPlan_8703B 0xB8 ++#define EEPROM_XTAL_8703B 0xB9 ++#define EEPROM_THERMAL_METER_8703B 0xBA ++#define EEPROM_IQK_LCK_8703B 0xBB ++#define EEPROM_2G_5G_PA_TYPE_8703B 0xBC ++#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8703B 0xBD ++#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8703B 0xBF ++ ++#define EEPROM_RF_BOARD_OPTION_8703B 0xC1 ++#define EEPROM_FEATURE_OPTION_8703B 0xC2 ++#define EEPROM_RF_BT_SETTING_8703B 0xC3 ++#define EEPROM_VERSION_8703B 0xC4 ++#define EEPROM_CustomID_8703B 0xC5 ++#define EEPROM_TX_BBSWING_2G_8703B 0xC6 ++#define EEPROM_TX_PWR_CALIBRATE_RATE_8703B 0xC8 ++#define EEPROM_RF_ANTENNA_OPT_8703B 0xC9 ++#define EEPROM_RFE_OPTION_8703B 0xCA ++#define EEPROM_COUNTRY_CODE_8703B 0xCB ++ ++/* RTL8703BU */ ++#define EEPROM_MAC_ADDR_8703BU 0x107 ++#define EEPROM_VID_8703BU 0x100 ++#define EEPROM_PID_8703BU 0x102 ++#define EEPROM_USB_OPTIONAL_FUNCTION0_8703BU 0x104 ++#define EEPROM_PA_TYPE_8703BU 0xBC ++#define EEPROM_LNA_TYPE_2G_8703BU 0xBD ++ ++/* RTL8703BS */ ++#define EEPROM_MAC_ADDR_8703BS 0x11A ++#define EEPROM_Voltage_ADDR_8703B 0x8 ++ ++/* ++ * ==================================================== ++ * EEPROM/Efuse PG Offset for 8822B ++ * ==================================================== ++ */ ++#define GET_PG_KFREE_ON_8822B(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) ++#define GET_PG_KFREE_THERMAL_K_ON_8822B(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) ++ ++#define PPG_BB_GAIN_2G_TXA_OFFSET_8822B 0xEE ++#define PPG_THERMAL_OFFSET_8822B 0xEF ++ ++#define EEPROM_TX_PWR_INX_8822B 0x10 ++ ++#define EEPROM_ChannelPlan_8822B 0xB8 ++#define EEPROM_XTAL_8822B 0xB9 ++#define EEPROM_THERMAL_METER_8822B 0xBA ++#define EEPROM_IQK_LCK_8822B 0xBB ++#define EEPROM_2G_5G_PA_TYPE_8822B 0xBC ++/* PATH A & PATH B */ ++#define EEPROM_2G_LNA_TYPE_GAIN_SEL_AB_8822B 0xBD ++/* PATH C & PATH D */ ++#define EEPROM_2G_LNA_TYPE_GAIN_SEL_CD_8822B 0xBE ++/* PATH A & PATH B */ ++#define EEPROM_5G_LNA_TYPE_GAIN_SEL_AB_8822B 0xBF ++/* PATH C & PATH D */ ++#define EEPROM_5G_LNA_TYPE_GAIN_SEL_CD_8822B 0xC0 ++ ++#define EEPROM_RF_BOARD_OPTION_8822B 0xC1 ++#define EEPROM_FEATURE_OPTION_8822B 0xC2 ++#define EEPROM_RF_BT_SETTING_8822B 0xC3 ++#define EEPROM_VERSION_8822B 0xC4 ++#define EEPROM_CustomID_8822B 0xC5 ++#define EEPROM_TX_BBSWING_2G_8822B 0xC6 ++#define EEPROM_TX_PWR_CALIBRATE_RATE_8822B 0xC8 ++#define EEPROM_RF_ANTENNA_OPT_8822B 0xC9 ++#define EEPROM_RFE_OPTION_8822B 0xCA ++#define EEPROM_COUNTRY_CODE_8822B 0xCB ++ ++/* RTL8822BU */ ++#define EEPROM_MAC_ADDR_8822BU 0x107 ++#define EEPROM_VID_8822BU 0x100 ++#define EEPROM_PID_8822BU 0x102 ++#define EEPROM_USB_OPTIONAL_FUNCTION0_8822BU 0x104 ++#define EEPROM_USB_MODE_8822BU 0x06 ++ ++/* RTL8822BS */ ++#define EEPROM_MAC_ADDR_8822BS 0x11A ++ ++/* RTL8822BE */ ++#define EEPROM_MAC_ADDR_8822BE 0xD0 ++/* ++ * ==================================================== ++ * EEPROM/Efuse PG Offset for 8821C ++ * ==================================================== ++ */ ++#define GET_PG_KFREE_ON_8821C(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) ++#define GET_PG_KFREE_THERMAL_K_ON_8821C(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) ++ ++#define PPG_BB_GAIN_2G_TXA_OFFSET_8821C 0xEE ++#define PPG_THERMAL_OFFSET_8821C 0xEF ++ ++#define EEPROM_TX_PWR_INX_8821C 0x10 ++ ++#define EEPROM_ChannelPlan_8821C 0xB8 ++#define EEPROM_XTAL_8821C 0xB9 ++#define EEPROM_THERMAL_METER_8821C 0xBA ++#define EEPROM_IQK_LCK_8821C 0xBB ++#define EEPROM_2G_5G_PA_TYPE_8821C 0xBC ++/* PATH A & PATH B */ ++#define EEPROM_2G_LNA_TYPE_GAIN_SEL_AB_8821C 0xBD ++/* PATH C & PATH D */ ++#define EEPROM_2G_LNA_TYPE_GAIN_SEL_CD_8821C 0xBE ++/* PATH A & PATH B */ ++#define EEPROM_5G_LNA_TYPE_GAIN_SEL_AB_8821C 0xBF ++/* PATH C & PATH D */ ++#define EEPROM_5G_LNA_TYPE_GAIN_SEL_CD_8821C 0xC0 ++ ++#define EEPROM_RF_BOARD_OPTION_8821C 0xC1 ++#define EEPROM_FEATURE_OPTION_8821C 0xC2 ++#define EEPROM_RF_BT_SETTING_8821C 0xC3 ++#define EEPROM_VERSION_8821C 0xC4 ++#define EEPROM_CustomID_8821C 0xC5 ++#define EEPROM_TX_BBSWING_2G_8821C 0xC6 ++#define EEPROM_TX_PWR_CALIBRATE_RATE_8821C 0xC8 ++#define EEPROM_RF_ANTENNA_OPT_8821C 0xC9 ++#define EEPROM_RFE_OPTION_8821C 0xCA ++#define EEPROM_COUNTRY_CODE_8821C 0xCB ++ ++/* RTL8821CU */ ++#define EEPROM_MAC_ADDR_8821CU 0x107 ++#define EEPROM_VID_8821CU 0x100 ++#define EEPROM_PID_8821CU 0x102 ++#define EEPROM_USB_OPTIONAL_FUNCTION0_8821CU 0x104 ++#define EEPROM_USB_MODE_8821CU 0x06 ++ ++/* RTL8821CS */ ++#define EEPROM_MAC_ADDR_8821CS 0x11A ++ ++/* RTL8821CE */ ++#define EEPROM_MAC_ADDR_8821CE 0xD0 ++/* **************************************************** ++ * EEPROM/Efuse PG Offset for 8723D ++ * **************************************************** */ ++#define GET_PG_KFREE_ON_8723D(_pg_m) \ ++ LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) ++#define GET_PG_KFREE_THERMAL_K_ON_8723D(_pg_m) \ ++ LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) ++ ++#define PPG_8723D_S1 0 ++#define PPG_8723D_S0 1 ++ ++#define PPG_BB_GAIN_2G_TXA_OFFSET_8723D 0xEE ++#define PPG_BB_GAIN_2G_TX_OFFSET_8723D 0x1EE ++#define PPG_THERMAL_OFFSET_8723D 0xEF ++ ++#define EEPROM_TX_PWR_INX_8723D 0x10 ++ ++#define EEPROM_ChannelPlan_8723D 0xB8 ++#define EEPROM_XTAL_8723D 0xB9 ++#define EEPROM_THERMAL_METER_8723D 0xBA ++#define EEPROM_IQK_LCK_8723D 0xBB ++#define EEPROM_2G_5G_PA_TYPE_8723D 0xBC ++#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8723D 0xBD ++#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8723D 0xBF ++ ++#define EEPROM_RF_BOARD_OPTION_8723D 0xC1 ++#define EEPROM_FEATURE_OPTION_8723D 0xC2 ++#define EEPROM_RF_BT_SETTING_8723D 0xC3 ++#define EEPROM_VERSION_8723D 0xC4 ++#define EEPROM_CustomID_8723D 0xC5 ++#define EEPROM_TX_BBSWING_2G_8723D 0xC6 ++#define EEPROM_TX_PWR_CALIBRATE_RATE_8723D 0xC8 ++#define EEPROM_RF_ANTENNA_OPT_8723D 0xC9 ++#define EEPROM_RFE_OPTION_8723D 0xCA ++#define EEPROM_COUNTRY_CODE_8723D 0xCB ++ ++/* RTL8723DE */ ++#define EEPROM_MAC_ADDR_8723DE 0xD0 ++#define EEPROM_VID_8723DE 0xD6 ++#define EEPROM_DID_8723DE 0xD8 ++#define EEPROM_SVID_8723DE 0xDA ++#define EEPROM_SMID_8723DE 0xDC ++ ++/* RTL8723DU */ ++#define EEPROM_MAC_ADDR_8723DU 0x107 ++#define EEPROM_VID_8723DU 0x100 ++#define EEPROM_PID_8723DU 0x102 ++#define EEPROM_USB_OPTIONAL_FUNCTION0_8723DU 0x104 ++ ++/* RTL8723BS */ ++#define EEPROM_MAC_ADDR_8723DS 0x11A ++#define EEPROM_Voltage_ADDR_8723D 0x8 ++ ++/* **************************************************** ++ * EEPROM/Efuse Value Type ++ * **************************************************** */ ++#define EETYPE_TX_PWR 0x0 ++/* **************************************************** ++ * EEPROM/Efuse Default Value ++ * **************************************************** */ ++#define EEPROM_CID_DEFAULT 0x0 ++#define EEPROM_CID_DEFAULT_EXT 0xFF /* Reserved for Realtek */ ++#define EEPROM_CID_TOSHIBA 0x4 ++#define EEPROM_CID_CCX 0x10 ++#define EEPROM_CID_QMI 0x0D ++#define EEPROM_CID_WHQL 0xFE ++ ++#define EEPROM_CHANNEL_PLAN_FCC 0x0 ++#define EEPROM_CHANNEL_PLAN_IC 0x1 ++#define EEPROM_CHANNEL_PLAN_ETSI 0x2 ++#define EEPROM_CHANNEL_PLAN_SPAIN 0x3 ++#define EEPROM_CHANNEL_PLAN_FRANCE 0x4 ++#define EEPROM_CHANNEL_PLAN_MKK 0x5 ++#define EEPROM_CHANNEL_PLAN_MKK1 0x6 ++#define EEPROM_CHANNEL_PLAN_ISRAEL 0x7 ++#define EEPROM_CHANNEL_PLAN_TELEC 0x8 ++#define EEPROM_CHANNEL_PLAN_GLOBAL_DOMAIN 0x9 ++#define EEPROM_CHANNEL_PLAN_WORLD_WIDE_13 0xA ++#define EEPROM_CHANNEL_PLAN_NCC_TAIWAN 0xB ++#define EEPROM_CHANNEL_PLAN_CHIAN 0XC ++#define EEPROM_CHANNEL_PLAN_SINGAPORE_INDIA_MEXICO 0XD ++#define EEPROM_CHANNEL_PLAN_KOREA 0xE ++#define EEPROM_CHANNEL_PLAN_TURKEY 0xF ++#define EEPROM_CHANNEL_PLAN_JAPAN 0x10 ++#define EEPROM_CHANNEL_PLAN_FCC_NO_DFS 0x11 ++#define EEPROM_CHANNEL_PLAN_JAPAN_NO_DFS 0x12 ++#define EEPROM_CHANNEL_PLAN_WORLD_WIDE_5G 0x13 ++#define EEPROM_CHANNEL_PLAN_TAIWAN_NO_DFS 0x14 ++ ++#define EEPROM_USB_OPTIONAL1 0xE ++#define EEPROM_CHANNEL_PLAN_BY_HW_MASK 0x80 ++ ++#define RTL_EEPROM_ID 0x8129 ++#define EEPROM_Default_TSSI 0x0 ++#define EEPROM_Default_BoardType 0x02 ++#define EEPROM_Default_ThermalMeter 0x12 ++#define EEPROM_Default_ThermalMeter_92SU 0x7 ++#define EEPROM_Default_ThermalMeter_88E 0x18 ++#define EEPROM_Default_ThermalMeter_8812 0x18 ++#define EEPROM_Default_ThermalMeter_8192E 0x1A ++#define EEPROM_Default_ThermalMeter_8723B 0x18 ++#define EEPROM_Default_ThermalMeter_8703B 0x18 ++#define EEPROM_Default_ThermalMeter_8723D 0x18 ++#define EEPROM_Default_ThermalMeter_8188F 0x18 ++#define EEPROM_Default_ThermalMeter_8814A 0x18 ++ ++ ++#define EEPROM_Default_CrystalCap 0x0 ++#define EEPROM_Default_CrystalCap_8723A 0x20 ++#define EEPROM_Default_CrystalCap_88E 0x20 ++#define EEPROM_Default_CrystalCap_8812 0x20 ++#define EEPROM_Default_CrystalCap_8814 0x20 ++#define EEPROM_Default_CrystalCap_8192E 0x20 ++#define EEPROM_Default_CrystalCap_8723B 0x20 ++#define EEPROM_Default_CrystalCap_8703B 0x20 ++#define EEPROM_Default_CrystalCap_8723D 0x20 ++#define EEPROM_Default_CrystalCap_8188F 0x20 ++#define EEPROM_Default_CrystalFreq 0x0 ++#define EEPROM_Default_TxPowerLevel_92C 0x22 ++#define EEPROM_Default_TxPowerLevel_2G 0x2C ++#define EEPROM_Default_TxPowerLevel_5G 0x22 ++#define EEPROM_Default_TxPowerLevel 0x22 ++#define EEPROM_Default_HT40_2SDiff 0x0 ++#define EEPROM_Default_HT20_Diff 2 ++#define EEPROM_Default_LegacyHTTxPowerDiff 0x3 ++#define EEPROM_Default_LegacyHTTxPowerDiff_92C 0x3 ++#define EEPROM_Default_LegacyHTTxPowerDiff_92D 0x4 ++#define EEPROM_Default_HT40_PwrMaxOffset 0 ++#define EEPROM_Default_HT20_PwrMaxOffset 0 ++ ++#define EEPROM_Default_PID 0x1234 ++#define EEPROM_Default_VID 0x5678 ++#define EEPROM_Default_CustomerID 0xAB ++#define EEPROM_Default_CustomerID_8188E 0x00 ++#define EEPROM_Default_SubCustomerID 0xCD ++#define EEPROM_Default_Version 0 ++ ++#define EEPROM_Default_externalPA_C9 0x00 ++#define EEPROM_Default_externalPA_CC 0xFF ++#define EEPROM_Default_internalPA_SP3T_C9 0xAA ++#define EEPROM_Default_internalPA_SP3T_CC 0xAF ++#define EEPROM_Default_internalPA_SPDT_C9 0xAA ++#ifdef CONFIG_PCI_HCI ++ #define EEPROM_Default_internalPA_SPDT_CC 0xA0 ++#else ++ #define EEPROM_Default_internalPA_SPDT_CC 0xFA ++#endif ++#define EEPROM_Default_PAType 0 ++#define EEPROM_Default_LNAType 0 ++ ++/* New EFUSE default value */ ++#define EEPROM_DEFAULT_CHANNEL_PLAN 0x7F ++#define EEPROM_DEFAULT_BOARD_OPTION 0x00 ++#define EEPROM_DEFAULT_RFE_OPTION_8192E 0xFF ++#define EEPROM_DEFAULT_RFE_OPTION_8188E 0xFF ++#define EEPROM_DEFAULT_RFE_OPTION 0x04 ++#define EEPROM_DEFAULT_FEATURE_OPTION 0x00 ++#define EEPROM_DEFAULT_BT_OPTION 0x10 ++ ++ ++#define EEPROM_DEFAULT_TX_CALIBRATE_RATE 0x00 ++ ++/* PCIe related */ ++#define EEPROM_PCIE_DEV_CAP_01 0xE0 /* Express device capability in PCIe configuration space, i.e., map to offset 0x74 */ ++#define EEPROM_PCIE_DEV_CAP_02 0xE1 /* Express device capability in PCIe configuration space, i.e., map to offset 0x75 */ ++ ++ ++/* ++ * For VHT series TX power by rate table. ++ * VHT TX power by rate off setArray = ++ * Band:-2G&5G = 0 / 1 ++ * RF: at most 4*4 = ABCD=0/1/2/3 ++ * CCK=0 OFDM=1/2 HT-MCS 0-15=3/4/56 VHT=7/8/9/10/11 ++ * */ ++#define TX_PWR_BY_RATE_NUM_BAND 2 ++#define TX_PWR_BY_RATE_NUM_RF 4 ++#define TX_PWR_BY_RATE_NUM_RATE 84 ++ ++#define TXPWR_LMT_MAX_RF 4 ++ ++/* ---------------------------------------------------------------------------- ++ * EEPROM/EFUSE data structure definition. ++ * ---------------------------------------------------------------------------- */ ++ ++/* For 88E new structure */ ++ ++/* ++2.4G: ++{ ++{1,2}, ++{3,4,5}, ++{6,7,8}, ++{9,10,11}, ++{12,13}, ++{14} ++} ++ ++5G: ++{ ++{36,38,40}, ++{44,46,48}, ++{52,54,56}, ++{60,62,64}, ++{100,102,104}, ++{108,110,112}, ++{116,118,120}, ++{124,126,128}, ++{132,134,136}, ++{140,142,144}, ++{149,151,153}, ++{157,159,161}, ++{173,175,177}, ++} ++*/ ++#define MAX_RF_PATH 4 ++#define RF_PATH_MAX MAX_RF_PATH ++#define MAX_CHNL_GROUP_24G 6 ++#define MAX_CHNL_GROUP_5G 14 ++ ++/* It must always set to 4, otherwise read efuse table sequence will be wrong. */ ++#define MAX_TX_COUNT 4 ++ ++typedef struct _TxPowerInfo24G { ++ u8 IndexCCK_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G]; ++ u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G]; ++ /* If only one tx, only BW20 and OFDM are used. */ ++ s8 CCK_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++} TxPowerInfo24G, *PTxPowerInfo24G; ++ ++typedef struct _TxPowerInfo5G { ++ u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_5G]; ++ /* If only one tx, only BW20, OFDM, BW80 and BW160 are used. */ ++ s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW80_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW160_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++} TxPowerInfo5G, *PTxPowerInfo5G; ++ ++ ++typedef enum _BT_Ant_NUM { ++ Ant_x2 = 0, ++ Ant_x1 = 1 ++} BT_Ant_NUM, *PBT_Ant_NUM; ++ ++typedef enum _BT_CoType { ++ BT_2WIRE = 0, ++ BT_ISSC_3WIRE = 1, ++ BT_ACCEL = 2, ++ BT_CSR_BC4 = 3, ++ BT_CSR_BC8 = 4, ++ BT_RTL8756 = 5, ++ BT_RTL8723A = 6, ++ BT_RTL8821 = 7, ++ BT_RTL8723B = 8, ++ BT_RTL8192E = 9, ++ BT_RTL8814A = 10, ++ BT_RTL8812A = 11, ++ BT_RTL8703B = 12, ++ BT_RTL8822B = 13, ++ BT_RTL8723D = 14, ++ BT_RTL8821C = 15 ++} BT_CoType, *PBT_CoType; ++ ++typedef enum _BT_RadioShared { ++ BT_Radio_Shared = 0, ++ BT_Radio_Individual = 1, ++} BT_RadioShared, *PBT_RadioShared; ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_phy.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_phy.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_phy.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_phy.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,243 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_PHY_H__ ++#define __HAL_PHY_H__ ++ ++ ++#if DISABLE_BB_RF ++ #define HAL_FW_ENABLE 0 ++ #define HAL_MAC_ENABLE 0 ++ #define HAL_BB_ENABLE 0 ++ #define HAL_RF_ENABLE 0 ++#else /* FPGA_PHY and ASIC */ ++ #define HAL_FW_ENABLE 1 ++ #define HAL_MAC_ENABLE 1 ++ #define HAL_BB_ENABLE 1 ++ #define HAL_RF_ENABLE 1 ++#endif ++ ++#define RF6052_MAX_TX_PWR 0x3F ++#define RF6052_MAX_REG_88E 0xFF ++#define RF6052_MAX_REG_92C 0x7F ++ ++#define RF6052_MAX_REG \ ++ ((RF6052_MAX_REG_88E > RF6052_MAX_REG_92C) ? RF6052_MAX_REG_88E : RF6052_MAX_REG_92C) ++ ++#define GET_RF6052_REAL_MAX_REG(_Adapter) \ ++ (IS_HARDWARE_TYPE_8188E(_Adapter) ? RF6052_MAX_REG_88E : RF6052_MAX_REG_92C) ++ ++#define RF6052_MAX_PATH 2 ++ ++/* ++ * Antenna detection method, i.e., using single tone detection or RSSI reported from each antenna detected. ++ * Added by Roger, 2013.05.22. ++ * */ ++#define ANT_DETECT_BY_SINGLE_TONE BIT0 ++#define ANT_DETECT_BY_RSSI BIT1 ++#define IS_ANT_DETECT_SUPPORT_SINGLE_TONE(__Adapter) ((GET_HAL_DATA(__Adapter)->AntDetection) & ANT_DETECT_BY_SINGLE_TONE) ++#define IS_ANT_DETECT_SUPPORT_RSSI(__Adapter) ((GET_HAL_DATA(__Adapter)->AntDetection) & ANT_DETECT_BY_RSSI) ++ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++typedef enum _RF_TYPE { ++ RF_TYPE_MIN = 0, /* 0 */ ++ RF_8225 = 1, /* 1 11b/g RF for verification only */ ++ RF_8256 = 2, /* 2 11b/g/n */ ++ RF_8258 = 3, /* 3 11a/b/g/n RF */ ++ RF_6052 = 4, /* 4 11b/g/n RF */ ++ RF_PSEUDO_11N = 5, /* 5, It is a temporality RF. */ ++ RF_TYPE_MAX ++} RF_TYPE_E, *PRF_TYPE_E; ++ ++#define TX_1S 0 ++#define TX_2S 1 ++#define TX_3S 2 ++#define TX_4S 3 ++ ++typedef enum _ANTENNA_PATH { ++ ANTENNA_NONE = 0, ++ ANTENNA_D = 1, ++ ANTENNA_C = 2, ++ ANTENNA_CD = 3, ++ ANTENNA_B = 4, ++ ANTENNA_BD = 5, ++ ANTENNA_BC = 6, ++ ANTENNA_BCD = 7, ++ ANTENNA_A = 8, ++ ANTENNA_AD = 9, ++ ANTENNA_AC = 10, ++ ANTENNA_ACD = 11, ++ ANTENNA_AB = 12, ++ ANTENNA_ABD = 13, ++ ANTENNA_ABC = 14, ++ ANTENNA_ABCD = 15 ++} ANTENNA_PATH; ++ ++typedef enum _RF_CONTENT { ++ radioa_txt = 0x1000, ++ radiob_txt = 0x1001, ++ radioc_txt = 0x1002, ++ radiod_txt = 0x1003 ++} RF_CONTENT; ++ ++typedef enum _BaseBand_Config_Type { ++ BaseBand_Config_PHY_REG = 0, /* Radio Path A */ ++ BaseBand_Config_AGC_TAB = 1, /* Radio Path B */ ++ BaseBand_Config_AGC_TAB_2G = 2, ++ BaseBand_Config_AGC_TAB_5G = 3, ++ BaseBand_Config_PHY_REG_PG ++} BaseBand_Config_Type, *PBaseBand_Config_Type; ++ ++typedef enum _HW_BLOCK { ++ HW_BLOCK_MAC = 0, ++ HW_BLOCK_PHY0 = 1, ++ HW_BLOCK_PHY1 = 2, ++ HW_BLOCK_RF = 3, ++ HW_BLOCK_MAXIMUM = 4, /* Never use this */ ++} HW_BLOCK_E, *PHW_BLOCK_E; ++ ++typedef enum _WIRELESS_MODE { ++ WIRELESS_MODE_UNKNOWN = 0x00, ++ WIRELESS_MODE_A = 0x01, ++ WIRELESS_MODE_B = 0x02, ++ WIRELESS_MODE_G = 0x04, ++ WIRELESS_MODE_AUTO = 0x08, ++ WIRELESS_MODE_N_24G = 0x10, ++ WIRELESS_MODE_N_5G = 0x20, ++ WIRELESS_MODE_AC_5G = 0x40, ++ WIRELESS_MODE_AC_24G = 0x80, ++ WIRELESS_MODE_AC_ONLY = 0x100, ++} WIRELESS_MODE; ++ ++typedef enum _SwChnlCmdID { ++ CmdID_End, ++ CmdID_SetTxPowerLevel, ++ CmdID_BBRegWrite10, ++ CmdID_WritePortUlong, ++ CmdID_WritePortUshort, ++ CmdID_WritePortUchar, ++ CmdID_RF_WriteReg, ++} SwChnlCmdID; ++ ++typedef struct _SwChnlCmd { ++ SwChnlCmdID CmdID; ++ u32 Para1; ++ u32 Para2; ++ u32 msDelay; ++} SwChnlCmd; ++ ++typedef struct _R_ANTENNA_SELECT_OFDM { ++ u32 r_tx_antenna:4; ++ u32 r_ant_l:4; ++ u32 r_ant_non_ht:4; ++ u32 r_ant_ht1:4; ++ u32 r_ant_ht2:4; ++ u32 r_ant_ht_s1:4; ++ u32 r_ant_non_ht_s1:4; ++ u32 OFDM_TXSC:2; ++ u32 Reserved:2; ++} R_ANTENNA_SELECT_OFDM; ++ ++typedef struct _R_ANTENNA_SELECT_CCK { ++ u8 r_cckrx_enable_2:2; ++ u8 r_cckrx_enable:2; ++ u8 r_ccktx_enable:4; ++} R_ANTENNA_SELECT_CCK; ++ ++typedef struct RF_Shadow_Compare_Map { ++ /* Shadow register value */ ++ u32 Value; ++ /* Compare or not flag */ ++ u8 Compare; ++ /* Record If it had ever modified unpredicted */ ++ u8 ErrorOrNot; ++ /* Recorver Flag */ ++ u8 Recorver; ++ /* */ ++ u8 Driver_Write; ++} RF_SHADOW_T; ++ ++/*--------------------------Exported Function prototype---------------------*/ ++ ++u32 ++PHY_CalculateBitShift( ++ u32 BitMask ++); ++ ++u32 ++PHY_RFShadowRead( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 Offset); ++ ++VOID ++PHY_RFShadowWrite( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 Offset, ++ IN u32 Data); ++ ++BOOLEAN ++PHY_RFShadowCompare( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 Offset); ++ ++VOID ++PHY_RFShadowRecorver( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 Offset); ++ ++VOID ++PHY_RFShadowCompareAll( ++ IN PADAPTER Adapter); ++ ++VOID ++PHY_RFShadowRecorverAll( ++ IN PADAPTER Adapter); ++ ++VOID ++PHY_RFShadowCompareFlagSet( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 Offset, ++ IN u8 Type); ++ ++VOID ++PHY_RFShadowRecorverFlagSet( ++ IN PADAPTER Adapter, ++ IN u8 eRFPath, ++ IN u32 Offset, ++ IN u8 Type); ++ ++VOID ++PHY_RFShadowCompareFlagSetAll( ++ IN PADAPTER Adapter); ++ ++VOID ++PHY_RFShadowRecorverFlagSetAll( ++ IN PADAPTER Adapter); ++ ++VOID ++PHY_RFShadowRefresh( ++ IN PADAPTER Adapter); ++ ++#endif /* __HAL_COMMON_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_phy_reg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_phy_reg.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_phy_reg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_phy_reg.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,30 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_PHY_REG_H__ ++#define __HAL_PHY_REG_H__ ++ ++/* for PutRFRegsetting & GetRFRegSetting BitMask ++ * #if (RTL92SE_FPGA_VERIFY == 1) ++ * #define bRFRegOffsetMask 0xfff ++ * #else */ ++#define bRFRegOffsetMask 0xfffff ++/* #endif */ ++ ++#endif /* __HAL_PHY_REG_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/HalPwrSeqCmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/HalPwrSeqCmd.h +--- linux-4.14.18/3rdparty/rtl8723de/include/HalPwrSeqCmd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/HalPwrSeqCmd.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,135 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HALPWRSEQCMD_H__ ++#define __HALPWRSEQCMD_H__ ++ ++#include ++ ++/*---------------------------------------------*/ ++/* 3 The value of cmd: 4 bits ++ *---------------------------------------------*/ ++#define PWR_CMD_READ 0x00 ++/* offset: the read register offset ++ * msk: the mask of the read value ++ * value: N/A, left by 0 ++ * note: dirver shall implement this function by read & msk */ ++ ++#define PWR_CMD_WRITE 0x01 ++/* offset: the read register offset ++ * msk: the mask of the write bits ++ * value: write value ++ * note: driver shall implement this cmd by read & msk after write */ ++ ++#define PWR_CMD_POLLING 0x02 ++/* offset: the read register offset ++ * msk: the mask of the polled value ++ * value: the value to be polled, masked by the msd field. ++ * note: driver shall implement this cmd by ++ * do { ++ * if( (Read(offset) & msk) == (value & msk) ) ++ * break; ++ * } while(not timeout); */ ++ ++#define PWR_CMD_DELAY 0x03 ++/* offset: the value to delay ++ * msk: N/A ++ * value: the unit of delay, 0: us, 1: ms */ ++ ++#define PWR_CMD_END 0x04 ++/* offset: N/A ++ * msk: N/A ++ * value: N/A */ ++ ++/*---------------------------------------------*/ ++/* 3 The value of base: 4 bits ++ *--------------------------------------------- ++ * define the base address of each block */ ++#define PWR_BASEADDR_MAC 0x00 ++#define PWR_BASEADDR_USB 0x01 ++#define PWR_BASEADDR_PCIE 0x02 ++#define PWR_BASEADDR_SDIO 0x03 ++ ++/*---------------------------------------------*/ ++/* 3 The value of interface_msk: 4 bits ++ *---------------------------------------------*/ ++#define PWR_INTF_SDIO_MSK BIT(0) ++#define PWR_INTF_USB_MSK BIT(1) ++#define PWR_INTF_PCI_MSK BIT(2) ++#define PWR_INTF_ALL_MSK (BIT(0) | BIT(1) | BIT(2) | BIT(3)) ++ ++/*---------------------------------------------*/ ++/* 3 The value of fab_msk: 4 bits ++ *---------------------------------------------*/ ++#define PWR_FAB_TSMC_MSK BIT(0) ++#define PWR_FAB_UMC_MSK BIT(1) ++#define PWR_FAB_ALL_MSK (BIT(0) | BIT(1) | BIT(2) | BIT(3)) ++ ++/*---------------------------------------------*/ ++/* 3 The value of cut_msk: 8 bits ++ *---------------------------------------------*/ ++#define PWR_CUT_TESTCHIP_MSK BIT(0) ++#define PWR_CUT_A_MSK BIT(1) ++#define PWR_CUT_B_MSK BIT(2) ++#define PWR_CUT_C_MSK BIT(3) ++#define PWR_CUT_D_MSK BIT(4) ++#define PWR_CUT_E_MSK BIT(5) ++#define PWR_CUT_F_MSK BIT(6) ++#define PWR_CUT_G_MSK BIT(7) ++#define PWR_CUT_ALL_MSK 0xFF ++ ++ ++typedef enum _PWRSEQ_CMD_DELAY_UNIT_ { ++ PWRSEQ_DELAY_US, ++ PWRSEQ_DELAY_MS, ++} PWRSEQ_DELAY_UNIT; ++ ++typedef struct _WL_PWR_CFG_ { ++ u16 offset; ++ u8 cut_msk; ++ u8 fab_msk:4; ++ u8 interface_msk:4; ++ u8 base:4; ++ u8 cmd:4; ++ u8 msk; ++ u8 value; ++} WLAN_PWR_CFG, *PWLAN_PWR_CFG; ++ ++ ++#define GET_PWR_CFG_OFFSET(__PWR_CMD) ((__PWR_CMD).offset) ++#define GET_PWR_CFG_CUT_MASK(__PWR_CMD) ((__PWR_CMD).cut_msk) ++#define GET_PWR_CFG_FAB_MASK(__PWR_CMD) ((__PWR_CMD).fab_msk) ++#define GET_PWR_CFG_INTF_MASK(__PWR_CMD) ((__PWR_CMD).interface_msk) ++#define GET_PWR_CFG_BASE(__PWR_CMD) ((__PWR_CMD).base) ++#define GET_PWR_CFG_CMD(__PWR_CMD) ((__PWR_CMD).cmd) ++#define GET_PWR_CFG_MASK(__PWR_CMD) ((__PWR_CMD).msk) ++#define GET_PWR_CFG_VALUE(__PWR_CMD) ((__PWR_CMD).value) ++ ++ ++/* ******************************************************************************** ++ * Prototype of protected function. ++ * ******************************************************************************** */ ++u8 HalPwrSeqCmdParsing( ++ PADAPTER padapter, ++ u8 CutVersion, ++ u8 FabVersion, ++ u8 InterfaceType, ++ WLAN_PWR_CFG PwrCfgCmd[]); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_sdio.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_sdio.h +--- linux-4.14.18/3rdparty/rtl8723de/include/hal_sdio.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_sdio.h 2018-02-11 21:44:27.167146391 +0200 +@@ -0,0 +1,36 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_SDIO_H_ ++#define __HAL_SDIO_H_ ++ ++#define ffaddr2deviceId(pdvobj, addr) (pdvobj->Queue2Pipe[addr]) ++ ++u8 rtw_hal_sdio_max_txoqt_free_space(_adapter *padapter); ++u8 rtw_hal_sdio_query_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); ++void rtw_hal_sdio_update_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); ++void rtw_hal_set_sdio_tx_max_length(PADAPTER padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ); ++u32 rtw_hal_get_sdio_tx_max_length(PADAPTER padapter, u8 queue_idx); ++bool sdio_power_on_check(PADAPTER padapter); ++ ++#ifdef CONFIG_FW_C2H_REG ++void sd_c2h_hisr_hdl(_adapter *adapter); ++#endif ++ ++#endif /* __HAL_SDIO_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/HalVerDef.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/HalVerDef.h +--- linux-4.14.18/3rdparty/rtl8723de/include/HalVerDef.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/HalVerDef.h 2018-02-11 21:44:27.166146375 +0200 +@@ -0,0 +1,201 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __HAL_VERSION_DEF_H__ ++#define __HAL_VERSION_DEF_H__ ++ ++#define TRUE _TRUE ++#define FALSE _FALSE ++ ++/* HAL_IC_TYPE_E */ ++typedef enum tag_HAL_IC_Type_Definition { ++ CHIP_8192S = 0, ++ CHIP_8188C = 1, ++ CHIP_8192C = 2, ++ CHIP_8192D = 3, ++ CHIP_8723A = 4, ++ CHIP_8188E = 5, ++ CHIP_8812 = 6, ++ CHIP_8821 = 7, ++ CHIP_8723B = 8, ++ CHIP_8192E = 9, ++ CHIP_8814A = 10, ++ CHIP_8703B = 11, ++ CHIP_8188F = 12, ++ CHIP_8822B = 13, ++ CHIP_8723D = 14, ++ CHIP_8821C = 15 ++} HAL_IC_TYPE_E; ++ ++/* HAL_CHIP_TYPE_E */ ++typedef enum tag_HAL_CHIP_Type_Definition { ++ TEST_CHIP = 0, ++ NORMAL_CHIP = 1, ++ FPGA = 2, ++} HAL_CHIP_TYPE_E; ++ ++/* HAL_CUT_VERSION_E */ ++typedef enum tag_HAL_Cut_Version_Definition { ++ A_CUT_VERSION = 0, ++ B_CUT_VERSION = 1, ++ C_CUT_VERSION = 2, ++ D_CUT_VERSION = 3, ++ E_CUT_VERSION = 4, ++ F_CUT_VERSION = 5, ++ G_CUT_VERSION = 6, ++ H_CUT_VERSION = 7, ++ I_CUT_VERSION = 8, ++ J_CUT_VERSION = 9, ++ K_CUT_VERSION = 10, ++} HAL_CUT_VERSION_E; ++ ++/* HAL_Manufacturer */ ++typedef enum tag_HAL_Manufacturer_Version_Definition { ++ CHIP_VENDOR_TSMC = 0, ++ CHIP_VENDOR_UMC = 1, ++ CHIP_VENDOR_SMIC = 2, ++} HAL_VENDOR_E; ++ ++typedef enum tag_HAL_RF_Type_Definition { ++ RF_TYPE_1T1R = 0, ++ RF_TYPE_1T2R = 1, ++ RF_TYPE_2T2R = 2, ++ RF_TYPE_2T3R = 3, ++ RF_TYPE_2T4R = 4, ++ RF_TYPE_3T3R = 5, ++ RF_TYPE_3T4R = 6, ++ RF_TYPE_4T4R = 7, ++} HAL_RF_TYPE_E; ++ ++typedef struct tag_HAL_VERSION { ++ HAL_IC_TYPE_E ICType; ++ HAL_CHIP_TYPE_E ChipType; ++ HAL_CUT_VERSION_E CUTVersion; ++ HAL_VENDOR_E VendorType; ++ HAL_RF_TYPE_E RFType; ++ u8 ROMVer; ++} HAL_VERSION, *PHAL_VERSION; ++ ++/* VERSION_8192C VersionID; ++ * HAL_VERSION VersionID; */ ++ ++/* Get element */ ++#define GET_CVID_IC_TYPE(version) ((HAL_IC_TYPE_E)(((HAL_VERSION)version).ICType)) ++#define GET_CVID_CHIP_TYPE(version) ((HAL_CHIP_TYPE_E)(((HAL_VERSION)version).ChipType)) ++#define GET_CVID_RF_TYPE(version) ((HAL_RF_TYPE_E)(((HAL_VERSION)version).RFType)) ++#define GET_CVID_MANUFACTUER(version) ((HAL_VENDOR_E)(((HAL_VERSION)version).VendorType)) ++#define GET_CVID_CUT_VERSION(version) ((HAL_CUT_VERSION_E)(((HAL_VERSION)version).CUTVersion)) ++#define GET_CVID_ROM_VERSION(version) ((((HAL_VERSION)version).ROMVer) & ROM_VERSION_MASK) ++ ++/* ---------------------------------------------------------------------------- ++ * Common Macro. -- ++ * ---------------------------------------------------------------------------- ++ * HAL_VERSION VersionID */ ++ ++/* HAL_IC_TYPE_E */ ++#if 0 ++ #define IS_81XXC(version) (((GET_CVID_IC_TYPE(version) == CHIP_8192C) || (GET_CVID_IC_TYPE(version) == CHIP_8188C)) ? TRUE : FALSE) ++ #define IS_8723_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8723A) ? TRUE : FALSE) ++ #define IS_92D(version) ((GET_CVID_IC_TYPE(version) == CHIP_8192D) ? TRUE : FALSE) ++#endif ++ ++#define IS_8188E(version) ((GET_CVID_IC_TYPE(version) == CHIP_8188E) ? TRUE : FALSE) ++#define IS_8188F(version) ((GET_CVID_IC_TYPE(version) == CHIP_8188F) ? TRUE : FALSE) ++#define IS_8192E(version) ((GET_CVID_IC_TYPE(version) == CHIP_8192E) ? TRUE : FALSE) ++#define IS_8812_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8812) ? TRUE : FALSE) ++#define IS_8821_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8821) ? TRUE : FALSE) ++#define IS_8814A_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8814A) ? TRUE : FALSE) ++#define IS_8723B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8723B) ? TRUE : FALSE) ++#define IS_8703B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8703B) ? TRUE : FALSE) ++#define IS_8822B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8822B) ? TRUE : FALSE) ++#define IS_8821C_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8821C) ? TRUE : FALSE) ++#define IS_8723D_SERIES(version)\ ++ ((GET_CVID_IC_TYPE(version) == CHIP_8723D) ? TRUE : FALSE) ++/* HAL_CHIP_TYPE_E */ ++#define IS_TEST_CHIP(version) ((GET_CVID_CHIP_TYPE(version) == TEST_CHIP) ? TRUE : FALSE) ++#define IS_NORMAL_CHIP(version) ((GET_CVID_CHIP_TYPE(version) == NORMAL_CHIP) ? TRUE : FALSE) ++ ++/* HAL_CUT_VERSION_E */ ++#define IS_A_CUT(version) ((GET_CVID_CUT_VERSION(version) == A_CUT_VERSION) ? TRUE : FALSE) ++#define IS_B_CUT(version) ((GET_CVID_CUT_VERSION(version) == B_CUT_VERSION) ? TRUE : FALSE) ++#define IS_C_CUT(version) ((GET_CVID_CUT_VERSION(version) == C_CUT_VERSION) ? TRUE : FALSE) ++#define IS_D_CUT(version) ((GET_CVID_CUT_VERSION(version) == D_CUT_VERSION) ? TRUE : FALSE) ++#define IS_E_CUT(version) ((GET_CVID_CUT_VERSION(version) == E_CUT_VERSION) ? TRUE : FALSE) ++#define IS_F_CUT(version) ((GET_CVID_CUT_VERSION(version) == F_CUT_VERSION) ? TRUE : FALSE) ++#define IS_I_CUT(version) ((GET_CVID_CUT_VERSION(version) == I_CUT_VERSION) ? TRUE : FALSE) ++#define IS_J_CUT(version) ((GET_CVID_CUT_VERSION(version) == J_CUT_VERSION) ? TRUE : FALSE) ++#define IS_K_CUT(version) ((GET_CVID_CUT_VERSION(version) == K_CUT_VERSION) ? TRUE : FALSE) ++ ++/* HAL_VENDOR_E */ ++#define IS_CHIP_VENDOR_TSMC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_TSMC) ? TRUE : FALSE) ++#define IS_CHIP_VENDOR_UMC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_UMC) ? TRUE : FALSE) ++#define IS_CHIP_VENDOR_SMIC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_SMIC) ? TRUE : FALSE) ++ ++/* HAL_RF_TYPE_E */ ++#define IS_1T1R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_1T1R) ? TRUE : FALSE) ++#define IS_1T2R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_1T2R) ? TRUE : FALSE) ++#define IS_2T2R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_2T2R) ? TRUE : FALSE) ++#define IS_3T3R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_3T3R) ? TRUE : FALSE) ++#define IS_3T4R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_3T4R) ? TRUE : FALSE) ++#define IS_4T4R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_4T4R) ? TRUE : FALSE) ++ ++ ++ ++/* ---------------------------------------------------------------------------- ++ * Chip version Macro. -- ++ * ---------------------------------------------------------------------------- */ ++#if 0 ++ #define IS_81XXC_TEST_CHIP(version) ((IS_81XXC(version) && (!IS_NORMAL_CHIP(version))) ? TRUE : FALSE) ++ ++ #define IS_92C_SERIAL(version) ((IS_81XXC(version) && IS_2T2R(version)) ? TRUE : FALSE) ++ #define IS_81xxC_VENDOR_UMC_A_CUT(version) (IS_81XXC(version) ? (IS_CHIP_VENDOR_UMC(version) ? (IS_A_CUT(version) ? TRUE : FALSE) : FALSE) : FALSE) ++ #define IS_81xxC_VENDOR_UMC_B_CUT(version) (IS_81XXC(version) ? (IS_CHIP_VENDOR_UMC(version) ? (IS_B_CUT(version) ? TRUE : FALSE) : FALSE) : FALSE) ++ #define IS_81xxC_VENDOR_UMC_C_CUT(version) (IS_81XXC(version) ? (IS_CHIP_VENDOR_UMC(version) ? (IS_C_CUT(version) ? TRUE : FALSE) : FALSE) : FALSE) ++ ++ #define IS_NORMAL_CHIP92D(version) ((IS_92D(version)) ? ((GET_CVID_CHIP_TYPE(version) == NORMAL_CHIP) ? TRUE : FALSE) : FALSE) ++ ++ #define IS_92D_SINGLEPHY(version) ((IS_92D(version)) ? (IS_2T2R(version) ? TRUE : FALSE) : FALSE) ++ #define IS_92D_C_CUT(version) ((IS_92D(version)) ? (IS_C_CUT(version) ? TRUE : FALSE) : FALSE) ++ #define IS_92D_D_CUT(version) ((IS_92D(version)) ? (IS_D_CUT(version) ? TRUE : FALSE) : FALSE) ++ #define IS_92D_E_CUT(version) ((IS_92D(version)) ? (IS_E_CUT(version) ? TRUE : FALSE) : FALSE) ++ ++ #define IS_8723A_A_CUT(version) ((IS_8723_SERIES(version)) ? (IS_A_CUT(version) ? TRUE : FALSE) : FALSE) ++ #define IS_8723A_B_CUT(version) ((IS_8723_SERIES(version)) ? (IS_B_CUT(version) ? TRUE : FALSE) : FALSE) ++#endif ++ ++#define IS_VENDOR_8188E_I_CUT_SERIES(_Adapter) ((IS_8188E(GET_HAL_DATA(_Adapter)->VersionID)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) >= I_CUT_VERSION) ? TRUE : FALSE) : FALSE) ++ ++#define IS_VENDOR_8812A_TEST_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) ++#define IS_VENDOR_8812A_MP_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) ++#define IS_VENDOR_8812A_C_CUT(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) == C_CUT_VERSION) ? TRUE : FALSE) : FALSE) ++ ++#define IS_VENDOR_8821A_TEST_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) ++#define IS_VENDOR_8821A_MP_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) ++ ++#define IS_VENDOR_8192E_B_CUT(_Adapter) ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) == B_CUT_VERSION) ? TRUE : FALSE) ++ ++#define IS_VENDOR_8723B_TEST_CHIP(_Adapter) ((IS_8723B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) ++#define IS_VENDOR_8723B_MP_CHIP(_Adapter) ((IS_8723B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) ++ ++#define IS_VENDOR_8703B_TEST_CHIP(_Adapter) ((IS_8703B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) ++#define IS_VENDOR_8703B_MP_CHIP(_Adapter) ((IS_8703B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) ++#define IS_VENDOR_8814A_TEST_CHIP(_Adapter) ((IS_8814A_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) ++#define IS_VENDOR_8814A_MP_CHIP(_Adapter) ((IS_8814A_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/ieee80211_ext.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/ieee80211_ext.h +--- linux-4.14.18/3rdparty/rtl8723de/include/ieee80211_ext.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/ieee80211_ext.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,476 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __IEEE80211_EXT_H ++#define __IEEE80211_EXT_H ++ ++#include ++#include ++#include ++ ++#define WMM_OUI_TYPE 2 ++#define WMM_OUI_SUBTYPE_INFORMATION_ELEMENT 0 ++#define WMM_OUI_SUBTYPE_PARAMETER_ELEMENT 1 ++#define WMM_OUI_SUBTYPE_TSPEC_ELEMENT 2 ++#define WMM_VERSION 1 ++ ++#define WPA_PROTO_WPA BIT(0) ++#define WPA_PROTO_RSN BIT(1) ++ ++#define WPA_KEY_MGMT_IEEE8021X BIT(0) ++#define WPA_KEY_MGMT_PSK BIT(1) ++#define WPA_KEY_MGMT_NONE BIT(2) ++#define WPA_KEY_MGMT_IEEE8021X_NO_WPA BIT(3) ++#define WPA_KEY_MGMT_WPA_NONE BIT(4) ++ ++ ++#define WPA_CAPABILITY_PREAUTH BIT(0) ++#define WPA_CAPABILITY_MGMT_FRAME_PROTECTION BIT(6) ++#define WPA_CAPABILITY_PEERKEY_ENABLED BIT(9) ++ ++ ++#define PMKID_LEN 16 ++ ++ ++#ifdef PLATFORM_LINUX ++struct wpa_ie_hdr { ++ u8 elem_id; ++ u8 len; ++ u8 oui[4]; /* 24-bit OUI followed by 8-bit OUI type */ ++ u8 version[2]; /* little endian */ ++} __attribute__((packed)); ++ ++struct rsn_ie_hdr { ++ u8 elem_id; /* WLAN_EID_RSN */ ++ u8 len; ++ u8 version[2]; /* little endian */ ++} __attribute__((packed)); ++ ++struct wme_ac_parameter { ++#if defined(CONFIG_LITTLE_ENDIAN) ++ /* byte 1 */ ++ u8 aifsn:4, ++ acm:1, ++ aci:2, ++ reserved:1; ++ ++ /* byte 2 */ ++ u8 eCWmin:4, ++ eCWmax:4; ++#elif defined(CONFIG_BIG_ENDIAN) ++ /* byte 1 */ ++ u8 reserved:1, ++ aci:2, ++ acm:1, ++ aifsn:4; ++ ++ /* byte 2 */ ++ u8 eCWmax:4, ++ eCWmin:4; ++#else ++#error "Please fix " ++#endif ++ ++ /* bytes 3 & 4 */ ++ u16 txopLimit; ++} __attribute__((packed)); ++ ++struct wme_parameter_element { ++ /* required fields for WME version 1 */ ++ u8 oui[3]; ++ u8 oui_type; ++ u8 oui_subtype; ++ u8 version; ++ u8 acInfo; ++ u8 reserved; ++ struct wme_ac_parameter ac[4]; ++ ++} __attribute__((packed)); ++ ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ ++#pragma pack(1) ++ ++struct wpa_ie_hdr { ++ u8 elem_id; ++ u8 len; ++ u8 oui[4]; /* 24-bit OUI followed by 8-bit OUI type */ ++ u8 version[2]; /* little endian */ ++}; ++ ++struct rsn_ie_hdr { ++ u8 elem_id; /* WLAN_EID_RSN */ ++ u8 len; ++ u8 version[2]; /* little endian */ ++}; ++ ++#pragma pack() ++ ++#endif ++ ++#define WPA_PUT_LE16(a, val) \ ++ do { \ ++ (a)[1] = ((u16) (val)) >> 8; \ ++ (a)[0] = ((u16) (val)) & 0xff; \ ++ } while (0) ++ ++#define WPA_PUT_BE32(a, val) \ ++ do { \ ++ (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ ++ (a)[1] = (u8) ((((u32) (val)) >> 16) & 0xff); \ ++ (a)[2] = (u8) ((((u32) (val)) >> 8) & 0xff); \ ++ (a)[3] = (u8) (((u32) (val)) & 0xff); \ ++ } while (0) ++ ++#define WPA_PUT_LE32(a, val) \ ++ do { \ ++ (a)[3] = (u8) ((((u32) (val)) >> 24) & 0xff); \ ++ (a)[2] = (u8) ((((u32) (val)) >> 16) & 0xff); \ ++ (a)[1] = (u8) ((((u32) (val)) >> 8) & 0xff); \ ++ (a)[0] = (u8) (((u32) (val)) & 0xff); \ ++ } while (0) ++ ++#define RSN_SELECTOR_PUT(a, val) WPA_PUT_BE32((u8 *) (a), (val)) ++/* #define RSN_SELECTOR_PUT(a, val) WPA_PUT_LE32((u8 *) (a), (val)) */ ++ ++ ++ ++/* Action category code */ ++enum ieee80211_category { ++ WLAN_CATEGORY_SPECTRUM_MGMT = 0, ++ WLAN_CATEGORY_QOS = 1, ++ WLAN_CATEGORY_DLS = 2, ++ WLAN_CATEGORY_BACK = 3, ++ WLAN_CATEGORY_HT = 7, ++ WLAN_CATEGORY_WMM = 17, ++}; ++ ++/* SPECTRUM_MGMT action code */ ++enum ieee80211_spectrum_mgmt_actioncode { ++ WLAN_ACTION_SPCT_MSR_REQ = 0, ++ WLAN_ACTION_SPCT_MSR_RPRT = 1, ++ WLAN_ACTION_SPCT_TPC_REQ = 2, ++ WLAN_ACTION_SPCT_TPC_RPRT = 3, ++ WLAN_ACTION_SPCT_CHL_SWITCH = 4, ++ WLAN_ACTION_SPCT_EXT_CHL_SWITCH = 5, ++}; ++ ++/* BACK action code */ ++enum ieee80211_back_actioncode { ++ WLAN_ACTION_ADDBA_REQ = 0, ++ WLAN_ACTION_ADDBA_RESP = 1, ++ WLAN_ACTION_DELBA = 2, ++}; ++ ++/* HT features action code */ ++enum ieee80211_ht_actioncode { ++ WLAN_ACTION_NOTIFY_CH_WIDTH = 0, ++ WLAN_ACTION_SM_PS = 1, ++ WLAN_ACTION_PSPM = 2, ++ WLAN_ACTION_PCO_PHASE = 3, ++ WLAN_ACTION_MIMO_CSI_MX = 4, ++ WLAN_ACTION_MIMO_NONCP_BF = 5, ++ WLAN_ACTION_MIMP_CP_BF = 6, ++ WLAN_ACTION_ASEL_INDICATES_FB = 7, ++ WLAN_ACTION_HI_INFO_EXCHG = 8, ++}; ++ ++/* BACK (block-ack) parties */ ++enum ieee80211_back_parties { ++ WLAN_BACK_RECIPIENT = 0, ++ WLAN_BACK_INITIATOR = 1, ++ WLAN_BACK_TIMER = 2, ++}; ++ ++#ifdef PLATFORM_LINUX ++ ++struct ieee80211_mgmt { ++ u16 frame_control; ++ u16 duration; ++ u8 da[6]; ++ u8 sa[6]; ++ u8 bssid[6]; ++ u16 seq_ctrl; ++ union { ++ struct { ++ u16 auth_alg; ++ u16 auth_transaction; ++ u16 status_code; ++ /* possibly followed by Challenge text */ ++ u8 variable[0]; ++ } __attribute__((packed)) auth; ++ struct { ++ u16 reason_code; ++ } __attribute__((packed)) deauth; ++ struct { ++ u16 capab_info; ++ u16 listen_interval; ++ /* followed by SSID and Supported rates */ ++ u8 variable[0]; ++ } __attribute__((packed)) assoc_req; ++ struct { ++ u16 capab_info; ++ u16 status_code; ++ u16 aid; ++ /* followed by Supported rates */ ++ u8 variable[0]; ++ } __attribute__((packed)) assoc_resp, reassoc_resp; ++ struct { ++ u16 capab_info; ++ u16 listen_interval; ++ u8 current_ap[6]; ++ /* followed by SSID and Supported rates */ ++ u8 variable[0]; ++ } __attribute__((packed)) reassoc_req; ++ struct { ++ u16 reason_code; ++ } __attribute__((packed)) disassoc; ++ struct { ++ __le64 timestamp; ++ u16 beacon_int; ++ u16 capab_info; ++ /* followed by some of SSID, Supported rates, ++ * FH Params, DS Params, CF Params, IBSS Params, TIM */ ++ u8 variable[0]; ++ } __attribute__((packed)) beacon; ++ struct { ++ /* only variable items: SSID, Supported rates */ ++ u8 variable[0]; ++ } __attribute__((packed)) probe_req; ++ struct { ++ __le64 timestamp; ++ u16 beacon_int; ++ u16 capab_info; ++ /* followed by some of SSID, Supported rates, ++ * FH Params, DS Params, CF Params, IBSS Params */ ++ u8 variable[0]; ++ } __attribute__((packed)) probe_resp; ++ struct { ++ u8 category; ++ union { ++ struct { ++ u8 action_code; ++ u8 dialog_token; ++ u8 status_code; ++ u8 variable[0]; ++ } __attribute__((packed)) wme_action; ++#if 0 ++ struct { ++ u8 action_code; ++ u8 element_id; ++ u8 length; ++ struct ieee80211_channel_sw_ie sw_elem; ++ } __attribute__((packed)) chan_switch; ++ struct { ++ u8 action_code; ++ u8 dialog_token; ++ u8 element_id; ++ u8 length; ++ struct ieee80211_msrment_ie msr_elem; ++ } __attribute__((packed)) measurement; ++#endif ++ struct { ++ u8 action_code; ++ u8 dialog_token; ++ u16 capab; ++ u16 timeout; ++ u16 start_seq_num; ++ } __attribute__((packed)) addba_req; ++ struct { ++ u8 action_code; ++ u8 dialog_token; ++ u16 status; ++ u16 capab; ++ u16 timeout; ++ } __attribute__((packed)) addba_resp; ++ struct { ++ u8 action_code; ++ u16 params; ++ u16 reason_code; ++ } __attribute__((packed)) delba; ++ struct { ++ u8 action_code; ++ /* capab_info for open and confirm, ++ * reason for close ++ */ ++ u16 aux; ++ /* Followed in plink_confirm by status ++ * code, AID and supported rates, ++ * and directly by supported rates in ++ * plink_open and plink_close ++ */ ++ u8 variable[0]; ++ } __attribute__((packed)) plink_action; ++ struct { ++ u8 action_code; ++ u8 variable[0]; ++ } __attribute__((packed)) mesh_action; ++ } __attribute__((packed)) u; ++ } __attribute__((packed)) action; ++ } __attribute__((packed)) u; ++} __attribute__((packed)); ++ ++#endif ++ ++ ++#ifdef PLATFORM_WINDOWS ++ ++#pragma pack(1) ++ ++struct ieee80211_mgmt { ++ u16 frame_control; ++ u16 duration; ++ u8 da[6]; ++ u8 sa[6]; ++ u8 bssid[6]; ++ u16 seq_ctrl; ++ union { ++ struct { ++ u16 auth_alg; ++ u16 auth_transaction; ++ u16 status_code; ++ /* possibly followed by Challenge text */ ++ u8 variable[0]; ++ } auth; ++ struct { ++ u16 reason_code; ++ } deauth; ++ struct { ++ u16 capab_info; ++ u16 listen_interval; ++ /* followed by SSID and Supported rates */ ++ u8 variable[0]; ++ } assoc_req; ++ struct { ++ u16 capab_info; ++ u16 status_code; ++ u16 aid; ++ /* followed by Supported rates */ ++ u8 variable[0]; ++ } assoc_resp, reassoc_resp; ++ struct { ++ u16 capab_info; ++ u16 listen_interval; ++ u8 current_ap[6]; ++ /* followed by SSID and Supported rates */ ++ u8 variable[0]; ++ } reassoc_req; ++ struct { ++ u16 reason_code; ++ } disassoc; ++#if 0 ++ struct { ++ __le64 timestamp; ++ u16 beacon_int; ++ u16 capab_info; ++ /* followed by some of SSID, Supported rates, ++ * FH Params, DS Params, CF Params, IBSS Params, TIM */ ++ u8 variable[0]; ++ } beacon; ++ struct { ++ /* only variable items: SSID, Supported rates */ ++ u8 variable[0]; ++ } probe_req; ++ ++ struct { ++ __le64 timestamp; ++ u16 beacon_int; ++ u16 capab_info; ++ /* followed by some of SSID, Supported rates, ++ * FH Params, DS Params, CF Params, IBSS Params */ ++ u8 variable[0]; ++ } probe_resp; ++#endif ++ struct { ++ u8 category; ++ union { ++ struct { ++ u8 action_code; ++ u8 dialog_token; ++ u8 status_code; ++ u8 variable[0]; ++ } wme_action; ++ #if 0 ++ struct{ ++ u8 action_code; ++ u8 element_id; ++ u8 length; ++ struct ieee80211_channel_sw_ie sw_elem; ++ } chan_switch; ++ struct{ ++ u8 action_code; ++ u8 dialog_token; ++ u8 element_id; ++ u8 length; ++ struct ieee80211_msrment_ie msr_elem; ++ } measurement; ++ #endif ++ struct { ++ u8 action_code; ++ u8 dialog_token; ++ u16 capab; ++ u16 timeout; ++ u16 start_seq_num; ++ } addba_req; ++ struct { ++ u8 action_code; ++ u8 dialog_token; ++ u16 status; ++ u16 capab; ++ u16 timeout; ++ } addba_resp; ++ struct { ++ u8 action_code; ++ u16 params; ++ u16 reason_code; ++ } delba; ++ struct { ++ u8 action_code; ++ /* capab_info for open and confirm, ++ * reason for close ++ */ ++ u16 aux; ++ /* Followed in plink_confirm by status ++ * code, AID and supported rates, ++ * and directly by supported rates in ++ * plink_open and plink_close ++ */ ++ u8 variable[0]; ++ } plink_action; ++ struct { ++ u8 action_code; ++ u8 variable[0]; ++ } mesh_action; ++ } u; ++ } action; ++ } u; ++} ; ++ ++#pragma pack() ++ ++#endif ++ ++/* mgmt header + 1 byte category code */ ++#define IEEE80211_MIN_ACTION_SIZE FIELD_OFFSET(struct ieee80211_mgmt, u.action.u) ++ ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/ieee80211.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/ieee80211.h +--- linux-4.14.18/3rdparty/rtl8723de/include/ieee80211.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/ieee80211.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,1931 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __IEEE80211_H ++#define __IEEE80211_H ++ ++ ++#ifndef CONFIG_RTL8711FW ++ ++ #if defined PLATFORM_OS_XP ++ #include ++ #endif ++#else ++ ++#endif ++ ++#define MGMT_QUEUE_NUM 5 ++ ++#define ETH_ALEN 6 ++#define ETH_TYPE_LEN 2 ++#define PAYLOAD_TYPE_LEN 1 ++ ++#define NET80211_TU_TO_US 1024 /* unit:us */ ++#define DEFAULT_BCN_INTERVAL 100 /* 100 ms */ ++ ++#ifdef CONFIG_AP_MODE ++ ++#define RTL_IOCTL_HOSTAPD (SIOCIWFIRSTPRIV + 28) ++ ++/* RTL871X_IOCTL_HOSTAPD ioctl() cmd: */ ++enum { ++ RTL871X_HOSTAPD_FLUSH = 1, ++ RTL871X_HOSTAPD_ADD_STA = 2, ++ RTL871X_HOSTAPD_REMOVE_STA = 3, ++ RTL871X_HOSTAPD_GET_INFO_STA = 4, ++ /* REMOVED: PRISM2_HOSTAPD_RESET_TXEXC_STA = 5, */ ++ RTL871X_HOSTAPD_GET_WPAIE_STA = 5, ++ RTL871X_SET_ENCRYPTION = 6, ++ RTL871X_GET_ENCRYPTION = 7, ++ RTL871X_HOSTAPD_SET_FLAGS_STA = 8, ++ RTL871X_HOSTAPD_GET_RID = 9, ++ RTL871X_HOSTAPD_SET_RID = 10, ++ RTL871X_HOSTAPD_SET_ASSOC_AP_ADDR = 11, ++ RTL871X_HOSTAPD_SET_GENERIC_ELEMENT = 12, ++ RTL871X_HOSTAPD_MLME = 13, ++ RTL871X_HOSTAPD_SCAN_REQ = 14, ++ RTL871X_HOSTAPD_STA_CLEAR_STATS = 15, ++ RTL871X_HOSTAPD_SET_BEACON = 16, ++ RTL871X_HOSTAPD_SET_WPS_BEACON = 17, ++ RTL871X_HOSTAPD_SET_WPS_PROBE_RESP = 18, ++ RTL871X_HOSTAPD_SET_WPS_ASSOC_RESP = 19, ++ RTL871X_HOSTAPD_SET_HIDDEN_SSID = 20, ++ RTL871X_HOSTAPD_SET_MACADDR_ACL = 21, ++ RTL871X_HOSTAPD_ACL_ADD_STA = 22, ++ RTL871X_HOSTAPD_ACL_REMOVE_STA = 23, ++}; ++ ++/* STA flags */ ++#define WLAN_STA_AUTH BIT(0) ++#define WLAN_STA_ASSOC BIT(1) ++#define WLAN_STA_PS BIT(2) ++#define WLAN_STA_TIM BIT(3) ++#define WLAN_STA_PERM BIT(4) ++#define WLAN_STA_AUTHORIZED BIT(5) ++#define WLAN_STA_PENDING_POLL BIT(6) /* pending activity poll not ACKed */ ++#define WLAN_STA_SHORT_PREAMBLE BIT(7) ++#define WLAN_STA_PREAUTH BIT(8) ++#define WLAN_STA_WME BIT(9) ++#define WLAN_STA_MFP BIT(10) ++#define WLAN_STA_HT BIT(11) ++#define WLAN_STA_WPS BIT(12) ++#define WLAN_STA_MAYBE_WPS BIT(13) ++#define WLAN_STA_VHT BIT(14) ++#define WLAN_STA_NONERP BIT(31) ++ ++#endif ++ ++#define IEEE_CMD_SET_WPA_PARAM 1 ++#define IEEE_CMD_SET_WPA_IE 2 ++#define IEEE_CMD_SET_ENCRYPTION 3 ++#define IEEE_CMD_MLME 4 ++ ++#define IEEE_PARAM_WPA_ENABLED 1 ++#define IEEE_PARAM_TKIP_COUNTERMEASURES 2 ++#define IEEE_PARAM_DROP_UNENCRYPTED 3 ++#define IEEE_PARAM_PRIVACY_INVOKED 4 ++#define IEEE_PARAM_AUTH_ALGS 5 ++#define IEEE_PARAM_IEEE_802_1X 6 ++#define IEEE_PARAM_WPAX_SELECT 7 ++ ++#define AUTH_ALG_OPEN_SYSTEM 0x1 ++#define AUTH_ALG_SHARED_KEY 0x2 ++#define AUTH_ALG_LEAP 0x00000004 ++ ++#define IEEE_MLME_STA_DEAUTH 1 ++#define IEEE_MLME_STA_DISASSOC 2 ++ ++#define IEEE_CRYPT_ERR_UNKNOWN_ALG 2 ++#define IEEE_CRYPT_ERR_UNKNOWN_ADDR 3 ++#define IEEE_CRYPT_ERR_CRYPT_INIT_FAILED 4 ++#define IEEE_CRYPT_ERR_KEY_SET_FAILED 5 ++#define IEEE_CRYPT_ERR_TX_KEY_SET_FAILED 6 ++#define IEEE_CRYPT_ERR_CARD_CONF_FAILED 7 ++ ++ ++#define IEEE_CRYPT_ALG_NAME_LEN 16 ++ ++#define WPA_CIPHER_NONE BIT(0) ++#define WPA_CIPHER_WEP40 BIT(1) ++#define WPA_CIPHER_WEP104 BIT(2) ++#define WPA_CIPHER_TKIP BIT(3) ++#define WPA_CIPHER_CCMP BIT(4) ++ ++ ++ ++#define WPA_SELECTOR_LEN 4 ++extern u8 RTW_WPA_OUI_TYPE[] ; ++extern u16 RTW_WPA_VERSION ; ++extern u8 WPA_AUTH_KEY_MGMT_NONE[]; ++extern u8 WPA_AUTH_KEY_MGMT_UNSPEC_802_1X[]; ++extern u8 WPA_AUTH_KEY_MGMT_PSK_OVER_802_1X[]; ++extern u8 WPA_CIPHER_SUITE_NONE[]; ++extern u8 WPA_CIPHER_SUITE_WEP40[]; ++extern u8 WPA_CIPHER_SUITE_TKIP[]; ++extern u8 WPA_CIPHER_SUITE_WRAP[]; ++extern u8 WPA_CIPHER_SUITE_CCMP[]; ++extern u8 WPA_CIPHER_SUITE_WEP104[]; ++ ++ ++#define RSN_HEADER_LEN 4 ++#define RSN_SELECTOR_LEN 4 ++ ++extern u16 RSN_VERSION_BSD; ++extern u8 RSN_AUTH_KEY_MGMT_UNSPEC_802_1X[]; ++extern u8 RSN_AUTH_KEY_MGMT_PSK_OVER_802_1X[]; ++extern u8 RSN_CIPHER_SUITE_NONE[]; ++extern u8 RSN_CIPHER_SUITE_WEP40[]; ++extern u8 RSN_CIPHER_SUITE_TKIP[]; ++extern u8 RSN_CIPHER_SUITE_WRAP[]; ++extern u8 RSN_CIPHER_SUITE_CCMP[]; ++extern u8 RSN_CIPHER_SUITE_WEP104[]; ++ ++ ++typedef enum _RATEID_IDX_ { ++ RATEID_IDX_BGN_40M_2SS = 0, ++ RATEID_IDX_BGN_40M_1SS = 1, ++ RATEID_IDX_BGN_20M_2SS_BN = 2, ++ RATEID_IDX_BGN_20M_1SS_BN = 3, ++ RATEID_IDX_GN_N2SS = 4, ++ RATEID_IDX_GN_N1SS = 5, ++ RATEID_IDX_BG = 6, ++ RATEID_IDX_G = 7, ++ RATEID_IDX_B = 8, ++ RATEID_IDX_VHT_2SS = 9, ++ RATEID_IDX_VHT_1SS = 10, ++ RATEID_IDX_MIX1 = 11, ++ RATEID_IDX_MIX2 = 12, ++ RATEID_IDX_VHT_3SS = 13, ++ RATEID_IDX_BGN_3SS = 14, ++} RATEID_IDX, *PRATEID_IDX; ++ ++typedef enum _RATR_TABLE_MODE { ++ RATR_INX_WIRELESS_NGB = 0, /* BGN 40 Mhz 2SS 1SS */ ++ RATR_INX_WIRELESS_NG = 1, /* GN or N */ ++ RATR_INX_WIRELESS_NB = 2, /* BGN 20 Mhz 2SS 1SS or BN */ ++ RATR_INX_WIRELESS_N = 3, ++ RATR_INX_WIRELESS_GB = 4, ++ RATR_INX_WIRELESS_G = 5, ++ RATR_INX_WIRELESS_B = 6, ++ RATR_INX_WIRELESS_MC = 7, ++ RATR_INX_WIRELESS_AC_N = 8, ++} RATR_TABLE_MODE, *PRATR_TABLE_MODE; ++ ++ ++enum NETWORK_TYPE { ++ WIRELESS_INVALID = 0, ++ /* Sub-Element */ ++ WIRELESS_11B = BIT(0), /* tx: cck only , rx: cck only, hw: cck */ ++ WIRELESS_11G = BIT(1), /* tx: ofdm only, rx: ofdm & cck, hw: cck & ofdm */ ++ WIRELESS_11A = BIT(2), /* tx: ofdm only, rx: ofdm only, hw: ofdm only */ ++ WIRELESS_11_24N = BIT(3), /* tx: MCS only, rx: MCS & cck, hw: MCS & cck */ ++ WIRELESS_11_5N = BIT(4), /* tx: MCS only, rx: MCS & ofdm, hw: ofdm only */ ++ WIRELESS_AUTO = BIT(5), ++ WIRELESS_11AC = BIT(6), ++ ++ /* Combination */ ++ /* Type for current wireless mode */ ++ WIRELESS_11BG = (WIRELESS_11B | WIRELESS_11G), /* tx: cck & ofdm, rx: cck & ofdm & MCS, hw: cck & ofdm */ ++ WIRELESS_11G_24N = (WIRELESS_11G | WIRELESS_11_24N), /* tx: ofdm & MCS, rx: ofdm & cck & MCS, hw: cck & ofdm */ ++ WIRELESS_11A_5N = (WIRELESS_11A | WIRELESS_11_5N), /* tx: ofdm & MCS, rx: ofdm & MCS, hw: ofdm only */ ++ WIRELESS_11B_24N = (WIRELESS_11B | WIRELESS_11_24N), /* tx: ofdm & cck & MCS, rx: ofdm & cck & MCS, hw: ofdm & cck */ ++ WIRELESS_11BG_24N = (WIRELESS_11B | WIRELESS_11G | WIRELESS_11_24N), /* tx: ofdm & cck & MCS, rx: ofdm & cck & MCS, hw: ofdm & cck */ ++ WIRELESS_11_24AC = (WIRELESS_11G | WIRELESS_11AC), ++ WIRELESS_11_5AC = (WIRELESS_11A | WIRELESS_11AC), ++ ++ ++ /* Type for registry default wireless mode */ ++ WIRELESS_11AGN = (WIRELESS_11A | WIRELESS_11G | WIRELESS_11_24N | WIRELESS_11_5N), /* tx: ofdm & MCS, rx: ofdm & MCS, hw: ofdm only */ ++ WIRELESS_11ABGN = (WIRELESS_11A | WIRELESS_11B | WIRELESS_11G | WIRELESS_11_24N | WIRELESS_11_5N), ++ WIRELESS_MODE_24G = (WIRELESS_11B | WIRELESS_11G | WIRELESS_11_24N), ++ WIRELESS_MODE_5G = (WIRELESS_11A | WIRELESS_11_5N | WIRELESS_11AC), ++ WIRELESS_MODE_MAX = (WIRELESS_11A | WIRELESS_11B | WIRELESS_11G | WIRELESS_11_24N | WIRELESS_11_5N | WIRELESS_11AC), ++}; ++ ++#define SUPPORTED_24G_NETTYPE_MSK WIRELESS_MODE_24G ++#define SUPPORTED_5G_NETTYPE_MSK WIRELESS_MODE_5G ++ ++#define IsLegacyOnly(NetType) ((NetType) == ((NetType) & (WIRELESS_11BG | WIRELESS_11A))) ++ ++#define IsSupported24G(NetType) ((NetType) & SUPPORTED_24G_NETTYPE_MSK ? _TRUE : _FALSE) ++#define IsSupported5G(NetType) ((NetType) & SUPPORTED_5G_NETTYPE_MSK ? _TRUE : _FALSE) ++ ++#define IsEnableHWCCK(NetType) IsSupported24G(NetType) ++#define IsEnableHWOFDM(NetType) ((NetType) & (WIRELESS_11G | WIRELESS_11_24N | SUPPORTED_5G_NETTYPE_MSK) ? _TRUE : _FALSE) ++ ++#define IsSupportedRxCCK(NetType) IsEnableHWCCK(NetType) ++#define IsSupportedRxOFDM(NetType) IsEnableHWOFDM(NetType) ++#define IsSupportedRxHT(NetType) IsEnableHWOFDM(NetType) ++ ++#define IsSupportedTxCCK(NetType) ((NetType) & (WIRELESS_11B) ? _TRUE : _FALSE) ++#define IsSupportedTxOFDM(NetType) ((NetType) & (WIRELESS_11G | WIRELESS_11A) ? _TRUE : _FALSE) ++#define IsSupportedHT(NetType) ((NetType) & (WIRELESS_11_24N | WIRELESS_11_5N) ? _TRUE : _FALSE) ++ ++#define IsSupportedVHT(NetType) ((NetType) & (WIRELESS_11AC) ? _TRUE : _FALSE) ++ ++ ++typedef struct ieee_param { ++ u32 cmd; ++ u8 sta_addr[ETH_ALEN]; ++ union { ++ struct { ++ u8 name; ++ u32 value; ++ } wpa_param; ++ struct { ++ u32 len; ++ u8 reserved[32]; ++ u8 data[0]; ++ } wpa_ie; ++ struct { ++ int command; ++ int reason_code; ++ } mlme; ++ struct { ++ u8 alg[IEEE_CRYPT_ALG_NAME_LEN]; ++ u8 set_tx; ++ u32 err; ++ u8 idx; ++ u8 seq[8]; /* sequence counter (set: RX, get: TX) */ ++ u16 key_len; ++ u8 key[0]; ++ } crypt; ++#ifdef CONFIG_AP_MODE ++ struct { ++ u16 aid; ++ u16 capability; ++ int flags; ++ u8 tx_supp_rates[16]; ++ struct rtw_ieee80211_ht_cap ht_cap; ++ } add_sta; ++ struct { ++ u8 reserved[2];/* for set max_num_sta */ ++ u8 buf[0]; ++ } bcn_ie; ++#endif ++ ++ } u; ++} ieee_param; ++ ++#ifdef CONFIG_AP_MODE ++typedef struct ieee_param_ex { ++ u32 cmd; ++ u8 sta_addr[ETH_ALEN]; ++ u8 data[0]; ++} ieee_param_ex; ++ ++struct sta_data { ++ u16 aid; ++ u16 capability; ++ int flags; ++ u32 sta_set; ++ u8 tx_supp_rates[16]; ++ u32 tx_supp_rates_len; ++ struct rtw_ieee80211_ht_cap ht_cap; ++ u64 rx_pkts; ++ u64 rx_bytes; ++ u64 rx_drops; ++ u64 tx_pkts; ++ u64 tx_bytes; ++ u64 tx_drops; ++}; ++#endif ++ ++ ++#if WIRELESS_EXT < 17 ++ #define IW_QUAL_QUAL_INVALID 0x10 ++ #define IW_QUAL_LEVEL_INVALID 0x20 ++ #define IW_QUAL_NOISE_INVALID 0x40 ++ #define IW_QUAL_QUAL_UPDATED 0x1 ++ #define IW_QUAL_LEVEL_UPDATED 0x2 ++ #define IW_QUAL_NOISE_UPDATED 0x4 ++#endif ++ ++#define IEEE80211_DATA_LEN 2304 ++/* Maximum size for the MA-UNITDATA primitive, 802.11 standard section ++ 6.2.1.1.2. ++ ++ The figure in section 7.1.2 suggests a body size of up to 2312 ++ bytes is allowed, which is a bit confusing, I suspect this ++ represents the 2304 bytes of real data, plus a possible 8 bytes of ++ WEP IV and ICV. (this interpretation suggested by Ramiro Barreiro) */ ++ ++ ++#define IEEE80211_HLEN 30 ++#define IEEE80211_FRAME_LEN (IEEE80211_DATA_LEN + IEEE80211_HLEN) ++ ++ ++/* this is stolen from ipw2200 driver */ ++#define IEEE_IBSS_MAC_HASH_SIZE 31 ++ ++struct ieee_ibss_seq { ++ u8 mac[ETH_ALEN]; ++ u16 seq_num; ++ u16 frag_num; ++ unsigned long packet_time; ++ _list list; ++}; ++ ++#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) || defined(PLATFORM_FREEBSD) ++ ++struct rtw_ieee80211_hdr { ++ u16 frame_ctl; ++ u16 duration_id; ++ u8 addr1[ETH_ALEN]; ++ u8 addr2[ETH_ALEN]; ++ u8 addr3[ETH_ALEN]; ++ u16 seq_ctl; ++ u8 addr4[ETH_ALEN]; ++} __attribute__((packed)); ++ ++struct rtw_ieee80211_hdr_3addr { ++ u16 frame_ctl; ++ u16 duration_id; ++ u8 addr1[ETH_ALEN]; ++ u8 addr2[ETH_ALEN]; ++ u8 addr3[ETH_ALEN]; ++ u16 seq_ctl; ++} __attribute__((packed)); ++ ++ ++struct rtw_ieee80211_hdr_qos { ++ u16 frame_ctl; ++ u16 duration_id; ++ u8 addr1[ETH_ALEN]; ++ u8 addr2[ETH_ALEN]; ++ u8 addr3[ETH_ALEN]; ++ u16 seq_ctl; ++ u8 addr4[ETH_ALEN]; ++ u16 qc; ++} __attribute__((packed)); ++ ++struct rtw_ieee80211_hdr_3addr_qos { ++ u16 frame_ctl; ++ u16 duration_id; ++ u8 addr1[ETH_ALEN]; ++ u8 addr2[ETH_ALEN]; ++ u8 addr3[ETH_ALEN]; ++ u16 seq_ctl; ++ u16 qc; ++} __attribute__((packed)); ++ ++struct eapol { ++ u8 snap[6]; ++ u16 ethertype; ++ u8 version; ++ u8 type; ++ u16 length; ++} __attribute__((packed)); ++ ++#endif ++ ++ ++ ++#ifdef PLATFORM_WINDOWS ++ ++#pragma pack(1) ++struct rtw_ieee80211_hdr { ++ u16 frame_ctl; ++ u16 duration_id; ++ u8 addr1[ETH_ALEN]; ++ u8 addr2[ETH_ALEN]; ++ u8 addr3[ETH_ALEN]; ++ u16 seq_ctl; ++ u8 addr4[ETH_ALEN]; ++}; ++ ++struct rtw_ieee80211_hdr_3addr { ++ u16 frame_ctl; ++ u16 duration_id; ++ u8 addr1[ETH_ALEN]; ++ u8 addr2[ETH_ALEN]; ++ u8 addr3[ETH_ALEN]; ++ u16 seq_ctl; ++}; ++ ++ ++struct rtw_ieee80211_hdr_qos { ++ struct rtw_ieee80211_hdr wlan_hdr; ++ u16 qc; ++}; ++ ++struct rtw_ieee80211_hdr_3addr_qos { ++ struct rtw_ieee80211_hdr_3addr wlan_hdr; ++ u16 qc; ++}; ++ ++struct eapol { ++ u8 snap[6]; ++ u16 ethertype; ++ u8 version; ++ u8 type; ++ u16 length; ++}; ++#pragma pack() ++ ++#endif ++ ++ ++ ++enum eap_type { ++ EAP_PACKET = 0, ++ EAPOL_START, ++ EAPOL_LOGOFF, ++ EAPOL_KEY, ++ EAPOL_ENCAP_ASF_ALERT ++}; ++ ++#define IEEE80211_3ADDR_LEN 24 ++#define IEEE80211_4ADDR_LEN 30 ++#define IEEE80211_FCS_LEN 4 ++ ++#define MIN_FRAG_THRESHOLD 256U ++#define MAX_FRAG_THRESHOLD 2346U ++ ++/* Frame control field constants */ ++#define RTW_IEEE80211_FCTL_VERS 0x0003 ++#define RTW_IEEE80211_FCTL_FTYPE 0x000c ++#define RTW_IEEE80211_FCTL_STYPE 0x00f0 ++#define RTW_IEEE80211_FCTL_TODS 0x0100 ++#define RTW_IEEE80211_FCTL_FROMDS 0x0200 ++#define RTW_IEEE80211_FCTL_MOREFRAGS 0x0400 ++#define RTW_IEEE80211_FCTL_RETRY 0x0800 ++#define RTW_IEEE80211_FCTL_PM 0x1000 ++#define RTW_IEEE80211_FCTL_MOREDATA 0x2000 ++#define RTW_IEEE80211_FCTL_PROTECTED 0x4000 ++#define RTW_IEEE80211_FCTL_ORDER 0x8000 ++#define RTW_IEEE80211_FCTL_CTL_EXT 0x0f00 ++ ++#define RTW_IEEE80211_FTYPE_MGMT 0x0000 ++#define RTW_IEEE80211_FTYPE_CTL 0x0004 ++#define RTW_IEEE80211_FTYPE_DATA 0x0008 ++#define RTW_IEEE80211_FTYPE_EXT 0x000c ++ ++/* management */ ++#define RTW_IEEE80211_STYPE_ASSOC_REQ 0x0000 ++#define RTW_IEEE80211_STYPE_ASSOC_RESP 0x0010 ++#define RTW_IEEE80211_STYPE_REASSOC_REQ 0x0020 ++#define RTW_IEEE80211_STYPE_REASSOC_RESP 0x0030 ++#define RTW_IEEE80211_STYPE_PROBE_REQ 0x0040 ++#define RTW_IEEE80211_STYPE_PROBE_RESP 0x0050 ++#define RTW_IEEE80211_STYPE_BEACON 0x0080 ++#define RTW_IEEE80211_STYPE_ATIM 0x0090 ++#define RTW_IEEE80211_STYPE_DISASSOC 0x00A0 ++#define RTW_IEEE80211_STYPE_AUTH 0x00B0 ++#define RTW_IEEE80211_STYPE_DEAUTH 0x00C0 ++#define RTW_IEEE80211_STYPE_ACTION 0x00D0 ++ ++/* control */ ++#define RTW_IEEE80211_STYPE_CTL_EXT 0x0060 ++#define RTW_IEEE80211_STYPE_BACK_REQ 0x0080 ++#define RTW_IEEE80211_STYPE_BACK 0x0090 ++#define RTW_IEEE80211_STYPE_PSPOLL 0x00A0 ++#define RTW_IEEE80211_STYPE_RTS 0x00B0 ++#define RTW_IEEE80211_STYPE_CTS 0x00C0 ++#define RTW_IEEE80211_STYPE_ACK 0x00D0 ++#define RTW_IEEE80211_STYPE_CFEND 0x00E0 ++#define RTW_IEEE80211_STYPE_CFENDACK 0x00F0 ++ ++/* data */ ++#define RTW_IEEE80211_STYPE_DATA 0x0000 ++#define RTW_IEEE80211_STYPE_DATA_CFACK 0x0010 ++#define RTW_IEEE80211_STYPE_DATA_CFPOLL 0x0020 ++#define RTW_IEEE80211_STYPE_DATA_CFACKPOLL 0x0030 ++#define RTW_IEEE80211_STYPE_NULLFUNC 0x0040 ++#define RTW_IEEE80211_STYPE_CFACK 0x0050 ++#define RTW_IEEE80211_STYPE_CFPOLL 0x0060 ++#define RTW_IEEE80211_STYPE_CFACKPOLL 0x0070 ++#define RTW_IEEE80211_STYPE_QOS_DATA 0x0080 ++#define RTW_IEEE80211_STYPE_QOS_DATA_CFACK 0x0090 ++#define RTW_IEEE80211_STYPE_QOS_DATA_CFPOLL 0x00A0 ++#define RTW_IEEE80211_STYPE_QOS_DATA_CFACKPOLL 0x00B0 ++#define RTW_IEEE80211_STYPE_QOS_NULLFUNC 0x00C0 ++#define RTW_IEEE80211_STYPE_QOS_CFACK 0x00D0 ++#define RTW_IEEE80211_STYPE_QOS_CFPOLL 0x00E0 ++#define RTW_IEEE80211_STYPE_QOS_CFACKPOLL 0x00F0 ++ ++/* sequence control field */ ++#define RTW_IEEE80211_SCTL_FRAG 0x000F ++#define RTW_IEEE80211_SCTL_SEQ 0xFFF0 ++ ++ ++#define RTW_ERP_INFO_NON_ERP_PRESENT BIT(0) ++#define RTW_ERP_INFO_USE_PROTECTION BIT(1) ++#define RTW_ERP_INFO_BARKER_PREAMBLE_MODE BIT(2) ++ ++/* QoS,QOS */ ++#define NORMAL_ACK 0 ++#define NO_ACK 1 ++#define NON_EXPLICIT_ACK 2 ++#define BLOCK_ACK 3 ++ ++#ifndef ETH_P_PAE ++ #define ETH_P_PAE 0x888E /* Port Access Entity (IEEE 802.1X) */ ++#endif /* ETH_P_PAE */ ++ ++#define ETH_P_PREAUTH 0x88C7 /* IEEE 802.11i pre-authentication */ ++ ++#define ETH_P_ECONET 0x0018 ++ ++#ifndef ETH_P_80211_RAW ++ #define ETH_P_80211_RAW (ETH_P_ECONET + 1) ++#endif ++ ++/* IEEE 802.11 defines */ ++ ++#define P80211_OUI_LEN 3 ++ ++#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) || defined(PLATFORM_FREEBSD) ++ ++struct ieee80211_snap_hdr { ++ ++ u8 dsap; /* always 0xAA */ ++ u8 ssap; /* always 0xAA */ ++ u8 ctrl; /* always 0x03 */ ++ u8 oui[P80211_OUI_LEN]; /* organizational universal id */ ++ ++} __attribute__((packed)); ++ ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ ++#pragma pack(1) ++struct ieee80211_snap_hdr { ++ ++ u8 dsap; /* always 0xAA */ ++ u8 ssap; /* always 0xAA */ ++ u8 ctrl; /* always 0x03 */ ++ u8 oui[P80211_OUI_LEN]; /* organizational universal id */ ++ ++}; ++#pragma pack() ++ ++#endif ++ ++ ++#define SNAP_SIZE sizeof(struct ieee80211_snap_hdr) ++ ++#define WLAN_FC_GET_TYPE(fc) ((fc) & RTW_IEEE80211_FCTL_FTYPE) ++#define WLAN_FC_GET_STYPE(fc) ((fc) & RTW_IEEE80211_FCTL_STYPE) ++ ++#define WLAN_QC_GET_TID(qc) ((qc) & 0x0f) ++ ++#define WLAN_GET_SEQ_FRAG(seq) ((seq) & RTW_IEEE80211_SCTL_FRAG) ++#define WLAN_GET_SEQ_SEQ(seq) ((seq) & RTW_IEEE80211_SCTL_SEQ) ++ ++/* Authentication algorithms */ ++#define WLAN_AUTH_OPEN 0 ++#define WLAN_AUTH_SHARED_KEY 1 ++ ++#define WLAN_AUTH_CHALLENGE_LEN 128 ++ ++#define WLAN_CAPABILITY_BSS (1<<0) ++#define WLAN_CAPABILITY_IBSS (1<<1) ++#define WLAN_CAPABILITY_CF_POLLABLE (1<<2) ++#define WLAN_CAPABILITY_CF_POLL_REQUEST (1<<3) ++#define WLAN_CAPABILITY_PRIVACY (1<<4) ++#define WLAN_CAPABILITY_SHORT_PREAMBLE (1<<5) ++#define WLAN_CAPABILITY_PBCC (1<<6) ++#define WLAN_CAPABILITY_CHANNEL_AGILITY (1<<7) ++#define WLAN_CAPABILITY_SHORT_SLOT (1<<10) ++ ++/* Status codes */ ++#define WLAN_STATUS_SUCCESS 0 ++#define WLAN_STATUS_UNSPECIFIED_FAILURE 1 ++#define WLAN_STATUS_CAPS_UNSUPPORTED 10 ++#define WLAN_STATUS_REASSOC_NO_ASSOC 11 ++#define WLAN_STATUS_ASSOC_DENIED_UNSPEC 12 ++#define WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG 13 ++#define WLAN_STATUS_UNKNOWN_AUTH_TRANSACTION 14 ++#define WLAN_STATUS_CHALLENGE_FAIL 15 ++#define WLAN_STATUS_AUTH_TIMEOUT 16 ++#define WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA 17 ++#define WLAN_STATUS_ASSOC_DENIED_RATES 18 ++/* 802.11b */ ++#define WLAN_STATUS_ASSOC_DENIED_NOSHORT 19 ++#define WLAN_STATUS_ASSOC_DENIED_NOPBCC 20 ++#define WLAN_STATUS_ASSOC_DENIED_NOAGILITY 21 ++ ++/* Reason codes */ ++#define WLAN_REASON_UNSPECIFIED 1 ++#define WLAN_REASON_PREV_AUTH_NOT_VALID 2 ++#define WLAN_REASON_DEAUTH_LEAVING 3 ++#define WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY 4 ++#define WLAN_REASON_DISASSOC_AP_BUSY 5 ++#define WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA 6 ++#define WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA 7 ++#define WLAN_REASON_DISASSOC_STA_HAS_LEFT 8 ++#define WLAN_REASON_STA_REQ_ASSOC_WITHOUT_AUTH 9 ++#define WLAN_REASON_ACTIVE_ROAM 65533 ++#define WLAN_REASON_JOIN_WRONG_CHANNEL 65534 ++#define WLAN_REASON_EXPIRATION_CHK 65535 ++ ++/* Information Element IDs */ ++#define WLAN_EID_SSID 0 ++#define WLAN_EID_SUPP_RATES 1 ++#define WLAN_EID_FH_PARAMS 2 ++#define WLAN_EID_DS_PARAMS 3 ++#define WLAN_EID_CF_PARAMS 4 ++#define WLAN_EID_TIM 5 ++#define WLAN_EID_IBSS_PARAMS 6 ++#define WLAN_EID_CHALLENGE 16 ++/* EIDs defined by IEEE 802.11h - START */ ++#define WLAN_EID_PWR_CONSTRAINT 32 ++#define WLAN_EID_PWR_CAPABILITY 33 ++#define WLAN_EID_TPC_REQUEST 34 ++#define WLAN_EID_TPC_REPORT 35 ++#define WLAN_EID_SUPPORTED_CHANNELS 36 ++#define WLAN_EID_CHANNEL_SWITCH 37 ++#define WLAN_EID_MEASURE_REQUEST 38 ++#define WLAN_EID_MEASURE_REPORT 39 ++#define WLAN_EID_QUITE 40 ++#define WLAN_EID_IBSS_DFS 41 ++/* EIDs defined by IEEE 802.11h - END */ ++#define WLAN_EID_ERP_INFO 42 ++#define WLAN_EID_HT_CAP 45 ++#define WLAN_EID_RSN 48 ++#define WLAN_EID_EXT_SUPP_RATES 50 ++#define WLAN_EID_MOBILITY_DOMAIN 54 ++#define WLAN_EID_FAST_BSS_TRANSITION 55 ++#define WLAN_EID_TIMEOUT_INTERVAL 56 ++#define WLAN_EID_RIC_DATA 57 ++#define WLAN_EID_HT_OPERATION 61 ++#define WLAN_EID_SECONDARY_CHANNEL_OFFSET 62 ++#define WLAN_EID_20_40_BSS_COEXISTENCE 72 ++#define WLAN_EID_20_40_BSS_INTOLERANT 73 ++#define WLAN_EID_OVERLAPPING_BSS_SCAN_PARAMS 74 ++#define WLAN_EID_MMIE 76 ++#define WLAN_EID_VENDOR_SPECIFIC 221 ++#define WLAN_EID_GENERIC (WLAN_EID_VENDOR_SPECIFIC) ++#define WLAN_EID_VHT_CAPABILITY 191 ++#define WLAN_EID_VHT_OPERATION 192 ++#define WLAN_EID_VHT_OP_MODE_NOTIFY 199 ++ ++#define IEEE80211_MGMT_HDR_LEN 24 ++#define IEEE80211_DATA_HDR3_LEN 24 ++#define IEEE80211_DATA_HDR4_LEN 30 ++ ++ ++#define IEEE80211_STATMASK_SIGNAL (1<<0) ++#define IEEE80211_STATMASK_RSSI (1<<1) ++#define IEEE80211_STATMASK_NOISE (1<<2) ++#define IEEE80211_STATMASK_RATE (1<<3) ++#define IEEE80211_STATMASK_WEMASK 0x7 ++ ++ ++#define IEEE80211_CCK_MODULATION (1<<0) ++#define IEEE80211_OFDM_MODULATION (1<<1) ++ ++#define IEEE80211_24GHZ_BAND (1<<0) ++#define IEEE80211_52GHZ_BAND (1<<1) ++ ++#define IEEE80211_CCK_RATE_LEN 4 ++#define IEEE80211_NUM_OFDM_RATESLEN 8 ++ ++ ++#define IEEE80211_CCK_RATE_1MB 0x02 ++#define IEEE80211_CCK_RATE_2MB 0x04 ++#define IEEE80211_CCK_RATE_5MB 0x0B ++#define IEEE80211_CCK_RATE_11MB 0x16 ++#define IEEE80211_OFDM_RATE_LEN 8 ++#define IEEE80211_OFDM_RATE_6MB 0x0C ++#define IEEE80211_OFDM_RATE_9MB 0x12 ++#define IEEE80211_OFDM_RATE_12MB 0x18 ++#define IEEE80211_OFDM_RATE_18MB 0x24 ++#define IEEE80211_OFDM_RATE_24MB 0x30 ++#define IEEE80211_OFDM_RATE_36MB 0x48 ++#define IEEE80211_OFDM_RATE_48MB 0x60 ++#define IEEE80211_OFDM_RATE_54MB 0x6C ++#define IEEE80211_BASIC_RATE_MASK 0x80 ++ ++#define IEEE80211_CCK_RATE_1MB_MASK (1<<0) ++#define IEEE80211_CCK_RATE_2MB_MASK (1<<1) ++#define IEEE80211_CCK_RATE_5MB_MASK (1<<2) ++#define IEEE80211_CCK_RATE_11MB_MASK (1<<3) ++#define IEEE80211_OFDM_RATE_6MB_MASK (1<<4) ++#define IEEE80211_OFDM_RATE_9MB_MASK (1<<5) ++#define IEEE80211_OFDM_RATE_12MB_MASK (1<<6) ++#define IEEE80211_OFDM_RATE_18MB_MASK (1<<7) ++#define IEEE80211_OFDM_RATE_24MB_MASK (1<<8) ++#define IEEE80211_OFDM_RATE_36MB_MASK (1<<9) ++#define IEEE80211_OFDM_RATE_48MB_MASK (1<<10) ++#define IEEE80211_OFDM_RATE_54MB_MASK (1<<11) ++ ++#define IEEE80211_CCK_RATES_MASK 0x0000000F ++#define IEEE80211_CCK_BASIC_RATES_MASK (IEEE80211_CCK_RATE_1MB_MASK | \ ++ IEEE80211_CCK_RATE_2MB_MASK) ++#define IEEE80211_CCK_DEFAULT_RATES_MASK (IEEE80211_CCK_BASIC_RATES_MASK | \ ++ IEEE80211_CCK_RATE_5MB_MASK | \ ++ IEEE80211_CCK_RATE_11MB_MASK) ++ ++#define IEEE80211_OFDM_RATES_MASK 0x00000FF0 ++#define IEEE80211_OFDM_BASIC_RATES_MASK (IEEE80211_OFDM_RATE_6MB_MASK | \ ++ IEEE80211_OFDM_RATE_12MB_MASK | \ ++ IEEE80211_OFDM_RATE_24MB_MASK) ++#define IEEE80211_OFDM_DEFAULT_RATES_MASK (IEEE80211_OFDM_BASIC_RATES_MASK | \ ++ IEEE80211_OFDM_RATE_9MB_MASK | \ ++ IEEE80211_OFDM_RATE_18MB_MASK | \ ++ IEEE80211_OFDM_RATE_36MB_MASK | \ ++ IEEE80211_OFDM_RATE_48MB_MASK | \ ++ IEEE80211_OFDM_RATE_54MB_MASK) ++#define IEEE80211_DEFAULT_RATES_MASK (IEEE80211_OFDM_DEFAULT_RATES_MASK | \ ++ IEEE80211_CCK_DEFAULT_RATES_MASK) ++ ++#define IEEE80211_NUM_OFDM_RATES 8 ++#define IEEE80211_NUM_CCK_RATES 4 ++#define IEEE80211_OFDM_SHIFT_MASK_A 4 ++ ++ ++enum MGN_RATE { ++ MGN_1M = 0x02, ++ MGN_2M = 0x04, ++ MGN_5_5M = 0x0B, ++ MGN_6M = 0x0C, ++ MGN_9M = 0x12, ++ MGN_11M = 0x16, ++ MGN_12M = 0x18, ++ MGN_18M = 0x24, ++ MGN_24M = 0x30, ++ MGN_36M = 0x48, ++ MGN_48M = 0x60, ++ MGN_54M = 0x6C, ++ MGN_MCS32 = 0x7F, ++ MGN_MCS0, ++ MGN_MCS1, ++ MGN_MCS2, ++ MGN_MCS3, ++ MGN_MCS4, ++ MGN_MCS5, ++ MGN_MCS6, ++ MGN_MCS7, ++ MGN_MCS8, ++ MGN_MCS9, ++ MGN_MCS10, ++ MGN_MCS11, ++ MGN_MCS12, ++ MGN_MCS13, ++ MGN_MCS14, ++ MGN_MCS15, ++ MGN_MCS16, ++ MGN_MCS17, ++ MGN_MCS18, ++ MGN_MCS19, ++ MGN_MCS20, ++ MGN_MCS21, ++ MGN_MCS22, ++ MGN_MCS23, ++ MGN_MCS24, ++ MGN_MCS25, ++ MGN_MCS26, ++ MGN_MCS27, ++ MGN_MCS28, ++ MGN_MCS29, ++ MGN_MCS30, ++ MGN_MCS31, ++ MGN_VHT1SS_MCS0, ++ MGN_VHT1SS_MCS1, ++ MGN_VHT1SS_MCS2, ++ MGN_VHT1SS_MCS3, ++ MGN_VHT1SS_MCS4, ++ MGN_VHT1SS_MCS5, ++ MGN_VHT1SS_MCS6, ++ MGN_VHT1SS_MCS7, ++ MGN_VHT1SS_MCS8, ++ MGN_VHT1SS_MCS9, ++ MGN_VHT2SS_MCS0, ++ MGN_VHT2SS_MCS1, ++ MGN_VHT2SS_MCS2, ++ MGN_VHT2SS_MCS3, ++ MGN_VHT2SS_MCS4, ++ MGN_VHT2SS_MCS5, ++ MGN_VHT2SS_MCS6, ++ MGN_VHT2SS_MCS7, ++ MGN_VHT2SS_MCS8, ++ MGN_VHT2SS_MCS9, ++ MGN_VHT3SS_MCS0, ++ MGN_VHT3SS_MCS1, ++ MGN_VHT3SS_MCS2, ++ MGN_VHT3SS_MCS3, ++ MGN_VHT3SS_MCS4, ++ MGN_VHT3SS_MCS5, ++ MGN_VHT3SS_MCS6, ++ MGN_VHT3SS_MCS7, ++ MGN_VHT3SS_MCS8, ++ MGN_VHT3SS_MCS9, ++ MGN_VHT4SS_MCS0, ++ MGN_VHT4SS_MCS1, ++ MGN_VHT4SS_MCS2, ++ MGN_VHT4SS_MCS3, ++ MGN_VHT4SS_MCS4, ++ MGN_VHT4SS_MCS5, ++ MGN_VHT4SS_MCS6, ++ MGN_VHT4SS_MCS7, ++ MGN_VHT4SS_MCS8, ++ MGN_VHT4SS_MCS9, ++ MGN_UNKNOWN ++}; ++ ++#define IS_HT_RATE(_rate) ((_rate) >= MGN_MCS0 && (_rate) <= MGN_MCS31) ++#define IS_VHT_RATE(_rate) ((_rate) >= MGN_VHT1SS_MCS0 && (_rate) <= MGN_VHT4SS_MCS9) ++#define IS_CCK_RATE(_rate) ((_rate) == MGN_1M || (_rate) == MGN_2M || (_rate) == MGN_5_5M || (_rate) == MGN_11M) ++#define IS_OFDM_RATE(_rate) ((_rate) >= MGN_6M && (_rate) <= MGN_54M && (_rate) != MGN_11M) ++ ++#define IS_HT1SS_RATE(_rate) ((_rate) >= MGN_MCS0 && (_rate) <= MGN_MCS7) ++#define IS_HT2SS_RATE(_rate) ((_rate) >= MGN_MCS8 && (_rate) <= MGN_MCS15) ++#define IS_HT3SS_RATE(_rate) ((_rate) >= MGN_MCS16 && (_rate) <= MGN_MCS23) ++#define IS_HT4SS_RATE(_rate) ((_rate) >= MGN_MCS24 && (_rate) <= MGN_MCS31) ++ ++#define IS_VHT1SS_RATE(_rate) ((_rate) >= MGN_VHT1SS_MCS0 && (_rate) <= MGN_VHT1SS_MCS9) ++#define IS_VHT2SS_RATE(_rate) ((_rate) >= MGN_VHT2SS_MCS0 && (_rate) <= MGN_VHT2SS_MCS9) ++#define IS_VHT3SS_RATE(_rate) ((_rate) >= MGN_VHT3SS_MCS0 && (_rate) <= MGN_VHT3SS_MCS9) ++#define IS_VHT4SS_RATE(_rate) ((_rate) >= MGN_VHT4SS_MCS0 && (_rate) <= MGN_VHT4SS_MCS9) ++ ++#define IS_1T_RATE(_rate) (IS_CCK_RATE((_rate)) || IS_OFDM_RATE((_rate)) || IS_HT1SS_RATE((_rate)) || IS_VHT1SS_RATE((_rate))) ++#define IS_2T_RATE(_rate) (IS_HT2SS_RATE((_rate)) || IS_VHT2SS_RATE((_rate))) ++#define IS_3T_RATE(_rate) (IS_HT3SS_RATE((_rate)) || IS_VHT3SS_RATE((_rate))) ++#define IS_4T_RATE(_rate) (IS_HT4SS_RATE((_rate)) || IS_VHT4SS_RATE((_rate))) ++ ++#define MGN_RATE_STR(_rate) \ ++ (_rate == MGN_1M) ? "CCK_1M" : \ ++ (_rate == MGN_2M) ? "CCK_2M" : \ ++ (_rate == MGN_5_5M) ? "CCK_5.5M" : \ ++ (_rate == MGN_11M) ? "CCK_11M" : \ ++ (_rate == MGN_6M) ? "OFDM_6M" : \ ++ (_rate == MGN_9M) ? "OFDM_9M" : \ ++ (_rate == MGN_12M) ? "OFDM_12M" : \ ++ (_rate == MGN_18M) ? "OFDM_18M" : \ ++ (_rate == MGN_24M) ? "OFDM_24M" : \ ++ (_rate == MGN_36M) ? "OFDM_36M" : \ ++ (_rate == MGN_48M) ? "OFDM_48M" : \ ++ (_rate == MGN_54M) ? "OFDM_54M" : \ ++ (_rate == MGN_MCS32) ? "MCS32" : \ ++ (_rate == MGN_MCS0) ? "MCS0" : \ ++ (_rate == MGN_MCS1) ? "MCS1" : \ ++ (_rate == MGN_MCS2) ? "MCS2" : \ ++ (_rate == MGN_MCS3) ? "MCS3" : \ ++ (_rate == MGN_MCS4) ? "MCS4" : \ ++ (_rate == MGN_MCS5) ? "MCS5" : \ ++ (_rate == MGN_MCS6) ? "MCS6" : \ ++ (_rate == MGN_MCS7) ? "MCS7" : \ ++ (_rate == MGN_MCS8) ? "MCS8" : \ ++ (_rate == MGN_MCS9) ? "MCS9" : \ ++ (_rate == MGN_MCS10) ? "MCS10" : \ ++ (_rate == MGN_MCS11) ? "MCS11" : \ ++ (_rate == MGN_MCS12) ? "MCS12" : \ ++ (_rate == MGN_MCS13) ? "MCS13" : \ ++ (_rate == MGN_MCS14) ? "MCS14" : \ ++ (_rate == MGN_MCS15) ? "MCS15" : \ ++ (_rate == MGN_MCS16) ? "MCS16" : \ ++ (_rate == MGN_MCS17) ? "MCS17" : \ ++ (_rate == MGN_MCS18) ? "MCS18" : \ ++ (_rate == MGN_MCS19) ? "MCS19" : \ ++ (_rate == MGN_MCS20) ? "MCS20" : \ ++ (_rate == MGN_MCS21) ? "MCS21" : \ ++ (_rate == MGN_MCS22) ? "MCS22" : \ ++ (_rate == MGN_MCS23) ? "MCS23" : \ ++ (_rate == MGN_MCS24) ? "MCS24" : \ ++ (_rate == MGN_MCS25) ? "MCS25" : \ ++ (_rate == MGN_MCS26) ? "MCS26" : \ ++ (_rate == MGN_MCS27) ? "MCS27" : \ ++ (_rate == MGN_MCS28) ? "MCS28" : \ ++ (_rate == MGN_MCS29) ? "MCS29" : \ ++ (_rate == MGN_MCS30) ? "MCS30" : \ ++ (_rate == MGN_MCS31) ? "MCS31" : \ ++ (_rate == MGN_VHT1SS_MCS0) ? "VHT1SMCS0" : \ ++ (_rate == MGN_VHT1SS_MCS1) ? "VHT1SMCS1" : \ ++ (_rate == MGN_VHT1SS_MCS2) ? "VHT1SMCS2" : \ ++ (_rate == MGN_VHT1SS_MCS3) ? "VHT1SMCS3" : \ ++ (_rate == MGN_VHT1SS_MCS4) ? "VHT1SMCS4" : \ ++ (_rate == MGN_VHT1SS_MCS5) ? "VHT1SMCS5" : \ ++ (_rate == MGN_VHT1SS_MCS6) ? "VHT1SMCS6" : \ ++ (_rate == MGN_VHT1SS_MCS7) ? "VHT1SMCS7" : \ ++ (_rate == MGN_VHT1SS_MCS8) ? "VHT1SMCS8" : \ ++ (_rate == MGN_VHT1SS_MCS9) ? "VHT1SMCS9" : \ ++ (_rate == MGN_VHT2SS_MCS0) ? "VHT2SMCS0" : \ ++ (_rate == MGN_VHT2SS_MCS1) ? "VHT2SMCS1" : \ ++ (_rate == MGN_VHT2SS_MCS2) ? "VHT2SMCS2" : \ ++ (_rate == MGN_VHT2SS_MCS3) ? "VHT2SMCS3" : \ ++ (_rate == MGN_VHT2SS_MCS4) ? "VHT2SMCS4" : \ ++ (_rate == MGN_VHT2SS_MCS5) ? "VHT2SMCS5" : \ ++ (_rate == MGN_VHT2SS_MCS6) ? "VHT2SMCS6" : \ ++ (_rate == MGN_VHT2SS_MCS7) ? "VHT2SMCS7" : \ ++ (_rate == MGN_VHT2SS_MCS8) ? "VHT2SMCS8" : \ ++ (_rate == MGN_VHT2SS_MCS9) ? "VHT2SMCS9" : \ ++ (_rate == MGN_VHT3SS_MCS0) ? "VHT3SMCS0" : \ ++ (_rate == MGN_VHT3SS_MCS1) ? "VHT3SMCS1" : \ ++ (_rate == MGN_VHT3SS_MCS2) ? "VHT3SMCS2" : \ ++ (_rate == MGN_VHT3SS_MCS3) ? "VHT3SMCS3" : \ ++ (_rate == MGN_VHT3SS_MCS4) ? "VHT3SMCS4" : \ ++ (_rate == MGN_VHT3SS_MCS5) ? "VHT3SMCS5" : \ ++ (_rate == MGN_VHT3SS_MCS6) ? "VHT3SMCS6" : \ ++ (_rate == MGN_VHT3SS_MCS7) ? "VHT3SMCS7" : \ ++ (_rate == MGN_VHT3SS_MCS8) ? "VHT3SMCS8" : \ ++ (_rate == MGN_VHT3SS_MCS9) ? "VHT3SMCS9" : \ ++ (_rate == MGN_VHT4SS_MCS0) ? "VHT4SMCS0" : \ ++ (_rate == MGN_VHT4SS_MCS1) ? "VHT4SMCS1" : \ ++ (_rate == MGN_VHT4SS_MCS2) ? "VHT4SMCS2" : \ ++ (_rate == MGN_VHT4SS_MCS3) ? "VHT4SMCS3" : \ ++ (_rate == MGN_VHT4SS_MCS4) ? "VHT4SMCS4" : \ ++ (_rate == MGN_VHT4SS_MCS5) ? "VHT4SMCS5" : \ ++ (_rate == MGN_VHT4SS_MCS6) ? "VHT4SMCS6" : \ ++ (_rate == MGN_VHT4SS_MCS7) ? "VHT4SMCS7" : \ ++ (_rate == MGN_VHT4SS_MCS8) ? "VHT4SMCS8" : \ ++ (_rate == MGN_VHT4SS_MCS9) ? "VHT4SMCS9" : "UNKNOWN" ++ ++typedef enum _RATE_SECTION { ++ CCK = 0, ++ OFDM = 1, ++ HT_MCS0_MCS7 = 2, ++ HT_MCS8_MCS15 = 3, ++ HT_MCS16_MCS23 = 4, ++ HT_MCS24_MCS31 = 5, ++ HT_1SS = HT_MCS0_MCS7, ++ HT_2SS = HT_MCS8_MCS15, ++ HT_3SS = HT_MCS16_MCS23, ++ HT_4SS = HT_MCS24_MCS31, ++ VHT_1SSMCS0_1SSMCS9 = 6, ++ VHT_2SSMCS0_2SSMCS9 = 7, ++ VHT_3SSMCS0_3SSMCS9 = 8, ++ VHT_4SSMCS0_4SSMCS9 = 9, ++ VHT_1SS = VHT_1SSMCS0_1SSMCS9, ++ VHT_2SS = VHT_2SSMCS0_2SSMCS9, ++ VHT_3SS = VHT_3SSMCS0_3SSMCS9, ++ VHT_4SS = VHT_4SSMCS0_4SSMCS9, ++ RATE_SECTION_NUM, ++} RATE_SECTION; ++ ++const char *rate_section_str(u8 section); ++ ++#define IS_CCK_RATE_SECTION(section) ((section) == CCK) ++#define IS_OFDM_RATE_SECTION(section) ((section) == OFDM) ++#define IS_HT_RATE_SECTION(section) ((section) >= HT_1SS && (section) <= HT_4SS) ++#define IS_VHT_RATE_SECTION(section) ((section) >= VHT_1SS && (section) <= VHT_4SS) ++ ++#define IS_1T_RATE_SECTION(section) ((section) == CCK || (section) == OFDM || (section) == HT_1SS || (section) == VHT_1SS) ++#define IS_2T_RATE_SECTION(section) ((section) == HT_2SS || (section) == VHT_2SS) ++#define IS_3T_RATE_SECTION(section) ((section) == HT_3SS || (section) == VHT_3SS) ++#define IS_4T_RATE_SECTION(section) ((section) == HT_4SS || (section) == VHT_4SS) ++ ++extern u8 mgn_rates_cck[]; ++extern u8 mgn_rates_ofdm[]; ++extern u8 mgn_rates_mcs0_7[]; ++extern u8 mgn_rates_mcs8_15[]; ++extern u8 mgn_rates_mcs16_23[]; ++extern u8 mgn_rates_mcs24_31[]; ++extern u8 mgn_rates_vht1ss[]; ++extern u8 mgn_rates_vht2ss[]; ++extern u8 mgn_rates_vht3ss[]; ++extern u8 mgn_rates_vht4ss[]; ++ ++struct rate_section_ent { ++ u8 tx_num; /* value of RF_TX_NUM */ ++ u8 rate_num; ++ u8 *rates; ++}; ++ ++extern struct rate_section_ent rates_by_sections[]; ++ ++#define rate_section_to_tx_num(section) (rates_by_sections[(section)].tx_num) ++#define rate_section_rate_num(section) (rates_by_sections[(section)].rate_num) ++ ++/* NOTE: This data is for statistical purposes; not all hardware provides this ++ * information for frames received. Not setting these will not cause ++ * any adverse affects. */ ++struct ieee80211_rx_stats { ++ /* u32 mac_time[2]; */ ++ s8 rssi; ++ u8 signal; ++ u8 noise; ++ u8 received_channel; ++ u16 rate; /* in 100 kbps */ ++ /* u8 control; */ ++ u8 mask; ++ u8 freq; ++ u16 len; ++}; ++ ++/* IEEE 802.11 requires that STA supports concurrent reception of at least ++ * three fragmented frames. This define can be increased to support more ++ * concurrent frames, but it should be noted that each entry can consume about ++ * 2 kB of RAM and increasing cache size will slow down frame reassembly. */ ++#define IEEE80211_FRAG_CACHE_LEN 4 ++ ++struct ieee80211_frag_entry { ++ u32 first_frag_time; ++ uint seq; ++ uint last_frag; ++ uint qos; /* jackson */ ++ uint tid; /* jackson */ ++ struct sk_buff *skb; ++ u8 src_addr[ETH_ALEN]; ++ u8 dst_addr[ETH_ALEN]; ++}; ++ ++#ifndef PLATFORM_FREEBSD /* Baron BSD has already defined */ ++struct ieee80211_stats { ++ uint tx_unicast_frames; ++ uint tx_multicast_frames; ++ uint tx_fragments; ++ uint tx_unicast_octets; ++ uint tx_multicast_octets; ++ uint tx_deferred_transmissions; ++ uint tx_single_retry_frames; ++ uint tx_multiple_retry_frames; ++ uint tx_retry_limit_exceeded; ++ uint tx_discards; ++ uint rx_unicast_frames; ++ uint rx_multicast_frames; ++ uint rx_fragments; ++ uint rx_unicast_octets; ++ uint rx_multicast_octets; ++ uint rx_fcs_errors; ++ uint rx_discards_no_buffer; ++ uint tx_discards_wrong_sa; ++ uint rx_discards_undecryptable; ++ uint rx_message_in_msg_fragments; ++ uint rx_message_in_bad_msg_fragments; ++}; ++#endif /* PLATFORM_FREEBSD */ ++struct ieee80211_softmac_stats { ++ uint rx_ass_ok; ++ uint rx_ass_err; ++ uint rx_probe_rq; ++ uint tx_probe_rs; ++ uint tx_beacons; ++ uint rx_auth_rq; ++ uint rx_auth_rs_ok; ++ uint rx_auth_rs_err; ++ uint tx_auth_rq; ++ uint no_auth_rs; ++ uint no_ass_rs; ++ uint tx_ass_rq; ++ uint rx_ass_rq; ++ uint tx_probe_rq; ++ uint reassoc; ++ uint swtxstop; ++ uint swtxawake; ++}; ++ ++#define SEC_KEY_1 (1<<0) ++#define SEC_KEY_2 (1<<1) ++#define SEC_KEY_3 (1<<2) ++#define SEC_KEY_4 (1<<3) ++#define SEC_ACTIVE_KEY (1<<4) ++#define SEC_AUTH_MODE (1<<5) ++#define SEC_UNICAST_GROUP (1<<6) ++#define SEC_LEVEL (1<<7) ++#define SEC_ENABLED (1<<8) ++ ++#define SEC_LEVEL_0 0 /* None */ ++#define SEC_LEVEL_1 1 /* WEP 40 and 104 bit */ ++#define SEC_LEVEL_2 2 /* Level 1 + TKIP */ ++#define SEC_LEVEL_2_CKIP 3 /* Level 1 + CKIP */ ++#define SEC_LEVEL_3 4 /* Level 2 + CCMP */ ++ ++#define WEP_KEYS 4 ++#define WEP_KEY_LEN 13 ++ ++#ifdef CONFIG_IEEE80211W ++ #define BIP_MAX_KEYID 5 ++ #define BIP_AAD_SIZE 20 ++#endif /* CONFIG_IEEE80211W */ ++ ++#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) ++ ++struct ieee80211_security { ++ u16 active_key:2, ++ enabled:1, ++ auth_mode:2, ++ auth_algo:4, ++ unicast_uses_group:1; ++ u8 key_sizes[WEP_KEYS]; ++ u8 keys[WEP_KEYS][WEP_KEY_LEN]; ++ u8 level; ++ u16 flags; ++} __attribute__((packed)); ++ ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ ++#pragma pack(1) ++struct ieee80211_security { ++ u16 active_key:2, ++ enabled:1, ++ auth_mode:2, ++ auth_algo:4, ++ unicast_uses_group:1; ++ u8 key_sizes[WEP_KEYS]; ++ u8 keys[WEP_KEYS][WEP_KEY_LEN]; ++ u8 level; ++ u16 flags; ++} ; ++#pragma pack() ++ ++#endif ++ ++/* ++ ++ 802.11 data frame from AP ++ ++ ,-------------------------------------------------------------------. ++Bytes | 2 | 2 | 6 | 6 | 6 | 2 | 0..2312 | 4 | ++ |------|------|---------|---------|---------|------|---------|------| ++Desc. | ctrl | dura | DA/RA | TA | SA | Sequ | frame | fcs | ++ | | tion | (BSSID) | | | ence | data | | ++ `-------------------------------------------------------------------' ++ ++Total: 28-2340 bytes ++ ++*/ ++ ++struct ieee80211_header_data { ++ u16 frame_ctl; ++ u16 duration_id; ++ u8 addr1[6]; ++ u8 addr2[6]; ++ u8 addr3[6]; ++ u16 seq_ctrl; ++}; ++ ++#define BEACON_PROBE_SSID_ID_POSITION 12 ++ ++/* Management Frame Information Element Types */ ++#define MFIE_TYPE_SSID 0 ++#define MFIE_TYPE_RATES 1 ++#define MFIE_TYPE_FH_SET 2 ++#define MFIE_TYPE_DS_SET 3 ++#define MFIE_TYPE_CF_SET 4 ++#define MFIE_TYPE_TIM 5 ++#define MFIE_TYPE_IBSS_SET 6 ++#define MFIE_TYPE_CHALLENGE 16 ++#define MFIE_TYPE_ERP 42 ++#define MFIE_TYPE_RSN 48 ++#define MFIE_TYPE_RATES_EX 50 ++#define MFIE_TYPE_GENERIC 221 ++ ++#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) ++ ++struct ieee80211_info_element_hdr { ++ u8 id; ++ u8 len; ++} __attribute__((packed)); ++ ++struct ieee80211_info_element { ++ u8 id; ++ u8 len; ++ u8 data[0]; ++} __attribute__((packed)); ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ ++#pragma pack(1) ++struct ieee80211_info_element_hdr { ++ u8 id; ++ u8 len; ++} ; ++ ++struct ieee80211_info_element { ++ u8 id; ++ u8 len; ++ u8 data[0]; ++} ; ++#pragma pack() ++ ++#endif ++ ++ ++/* ++ * These are the data types that can make up management packets ++ * ++ u16 auth_algorithm; ++ u16 auth_sequence; ++ u16 beacon_interval; ++ u16 capability; ++ u8 current_ap[ETH_ALEN]; ++ u16 listen_interval; ++ struct { ++ u16 association_id:14, reserved:2; ++ } __attribute__ ((packed)); ++ u32 time_stamp[2]; ++ u16 reason; ++ u16 status; ++*/ ++ ++#define IEEE80211_DEFAULT_TX_ESSID "Penguin" ++#define IEEE80211_DEFAULT_BASIC_RATE 10 ++ ++ ++#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) ++ ++ ++struct ieee80211_authentication { ++ struct ieee80211_header_data header; ++ u16 algorithm; ++ u16 transaction; ++ u16 status; ++ /* struct ieee80211_info_element_hdr info_element; */ ++} __attribute__((packed)); ++ ++ ++struct ieee80211_probe_response { ++ struct ieee80211_header_data header; ++ u32 time_stamp[2]; ++ u16 beacon_interval; ++ u16 capability; ++ struct ieee80211_info_element info_element; ++} __attribute__((packed)); ++ ++struct ieee80211_probe_request { ++ struct ieee80211_header_data header; ++ /*struct ieee80211_info_element info_element;*/ ++} __attribute__((packed)); ++ ++struct ieee80211_assoc_request_frame { ++ struct rtw_ieee80211_hdr_3addr header; ++ u16 capability; ++ u16 listen_interval; ++ /* u8 current_ap[ETH_ALEN]; */ ++ struct ieee80211_info_element_hdr info_element; ++} __attribute__((packed)); ++ ++struct ieee80211_assoc_response_frame { ++ struct rtw_ieee80211_hdr_3addr header; ++ u16 capability; ++ u16 status; ++ u16 aid; ++ /* struct ieee80211_info_element info_element; supported rates */ ++} __attribute__((packed)); ++#endif ++ ++ ++ ++#ifdef PLATFORM_WINDOWS ++ ++#pragma pack(1) ++ ++struct ieee80211_authentication { ++ struct ieee80211_header_data header; ++ u16 algorithm; ++ u16 transaction; ++ u16 status; ++ /* struct ieee80211_info_element_hdr info_element; */ ++} ; ++ ++ ++struct ieee80211_probe_response { ++ struct ieee80211_header_data header; ++ u32 time_stamp[2]; ++ u16 beacon_interval; ++ u16 capability; ++ struct ieee80211_info_element info_element; ++} ; ++ ++struct ieee80211_probe_request { ++ struct ieee80211_header_data header; ++ /*struct ieee80211_info_element info_element;*/ ++} ; ++ ++struct ieee80211_assoc_request_frame { ++ struct rtw_ieee80211_hdr_3addr header; ++ u16 capability; ++ u16 listen_interval; ++ /* u8 current_ap[ETH_ALEN]; */ ++ struct ieee80211_info_element_hdr info_element; ++} ; ++ ++struct ieee80211_assoc_response_frame { ++ struct rtw_ieee80211_hdr_3addr header; ++ u16 capability; ++ u16 status; ++ u16 aid; ++ /* struct ieee80211_info_element info_element; supported rates */ ++}; ++ ++#pragma pack() ++ ++#endif ++ ++ ++ ++ ++struct ieee80211_txb { ++ u8 nr_frags; ++ u8 encrypted; ++ u16 reserved; ++ u16 frag_size; ++ u16 payload_size; ++ struct sk_buff *fragments[0]; ++}; ++ ++ ++/* SWEEP TABLE ENTRIES NUMBER*/ ++#define MAX_SWEEP_TAB_ENTRIES 42 ++#define MAX_SWEEP_TAB_ENTRIES_PER_PACKET 7 ++/* MAX_RATES_LENGTH needs to be 12. The spec says 8, and many APs ++ * only use 8, and then use extended rates for the remaining supported ++ * rates. Other APs, however, stick all of their supported rates on the ++ * main rates information element... */ ++#define MAX_RATES_LENGTH ((u8)12) ++#define MAX_RATES_EX_LENGTH ((u8)16) ++#define MAX_NETWORK_COUNT 128 ++#define MAX_CHANNEL_NUMBER 161 ++#define IEEE80211_SOFTMAC_SCAN_TIME 400 ++/* (HZ / 2) */ ++#define IEEE80211_SOFTMAC_ASSOC_RETRY_TIME (HZ * 2) ++ ++#define CRC_LENGTH 4U ++ ++#define MAX_WPA_IE_LEN (256) ++#define MAX_WPS_IE_LEN (512) ++#define MAX_P2P_IE_LEN (256) ++#define MAX_WFD_IE_LEN (128) ++ ++#define NETWORK_EMPTY_ESSID (1<<0) ++#define NETWORK_HAS_OFDM (1<<1) ++#define NETWORK_HAS_CCK (1<<2) ++ ++#define IEEE80211_DTIM_MBCAST 4 ++#define IEEE80211_DTIM_UCAST 2 ++#define IEEE80211_DTIM_VALID 1 ++#define IEEE80211_DTIM_INVALID 0 ++ ++#define IEEE80211_PS_DISABLED 0 ++#define IEEE80211_PS_UNICAST IEEE80211_DTIM_UCAST ++#define IEEE80211_PS_MBCAST IEEE80211_DTIM_MBCAST ++#define IW_ESSID_MAX_SIZE 32 ++#if 0 ++struct ieee80211_network { ++ /* These entries are used to identify a unique network */ ++ u8 bssid[ETH_ALEN]; ++ u8 channel; ++ /* Ensure null-terminated for any debug msgs */ ++ u8 ssid[IW_ESSID_MAX_SIZE + 1]; ++ u8 ssid_len; ++ u8 rssi; /* relative signal strength */ ++ u8 sq; /* signal quality */ ++ ++ /* These are network statistics */ ++ /* struct ieee80211_rx_stats stats; */ ++ u16 capability; ++ u16 aid; ++ u8 rates[MAX_RATES_LENGTH]; ++ u8 rates_len; ++ u8 rates_ex[MAX_RATES_EX_LENGTH]; ++ u8 rates_ex_len; ++ ++ u8 edca_parmsets[18]; ++ ++ u8 mode; ++ u8 flags; ++ u8 time_stamp[8]; ++ u16 beacon_interval; ++ u16 listen_interval; ++ u16 atim_window; ++ u8 wpa_ie[MAX_WPA_IE_LEN]; ++ size_t wpa_ie_len; ++ u8 rsn_ie[MAX_WPA_IE_LEN]; ++ size_t rsn_ie_len; ++ u8 country[6]; ++ u8 dtim_period; ++ u8 dtim_data; ++ u8 power_constraint; ++ u8 qosinfo; ++ u8 qbssload[5]; ++ u8 network_type; ++ int join_res; ++ unsigned long last_scanned; ++}; ++#endif ++/* ++join_res: ++-1: authentication fail ++-2: association fail ++> 0: TID ++*/ ++ ++#ifndef PLATFORM_FREEBSD /* Baron BSD has already defined */ ++ ++enum ieee80211_state { ++ ++ /* the card is not linked at all */ ++ IEEE80211_NOLINK = 0, ++ ++ /* IEEE80211_ASSOCIATING* are for BSS client mode ++ * the driver shall not perform RX filtering unless ++ * the state is LINKED. ++ * The driver shall just check for the state LINKED and ++ * defaults to NOLINK for ALL the other states (including ++ * LINKED_SCANNING) ++ */ ++ ++ /* the association procedure will start (wq scheduling)*/ ++ IEEE80211_ASSOCIATING, ++ IEEE80211_ASSOCIATING_RETRY, ++ ++ /* the association procedure is sending AUTH request*/ ++ IEEE80211_ASSOCIATING_AUTHENTICATING, ++ ++ /* the association procedure has successfully authentcated ++ * and is sending association request ++ */ ++ IEEE80211_ASSOCIATING_AUTHENTICATED, ++ ++ /* the link is ok. the card associated to a BSS or linked ++ * to a ibss cell or acting as an AP and creating the bss ++ */ ++ IEEE80211_LINKED, ++ ++ /* same as LINKED, but the driver shall apply RX filter ++ * rules as we are in NO_LINK mode. As the card is still ++ * logically linked, but it is doing a syncro site survey ++ * then it will be back to LINKED state. ++ */ ++ IEEE80211_LINKED_SCANNING, ++ ++}; ++#endif /* PLATFORM_FREEBSD */ ++ ++#define DEFAULT_MAX_SCAN_AGE (15 * HZ) ++#define DEFAULT_FTS 2346 ++#define MAC_FMT "%02x:%02x:%02x:%02x:%02x:%02x" ++#define MAC_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5] ++#define MAC_SFMT "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx" ++#define MAC_SARG(x) ((u8*)(x)),((u8*)(x)) + 1,((u8*)(x)) + 2,((u8*)(x)) + 3,((u8*)(x)) + 4,((u8*)(x)) + 5 ++#define IP_FMT "%d.%d.%d.%d" ++#define IP_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3] ++#define PORT_FMT "%u" ++#define PORT_ARG(x) ntohs(*((u16 *)(x))) ++ ++#ifdef PLATFORM_FREEBSD /* Baron change func to macro */ ++#define is_multicast_mac_addr(Addr) ((((Addr[0]) & 0x01) == 0x01) && ((Addr[0]) != 0xff)) ++#define is_broadcast_mac_addr(Addr) ((((Addr[0]) & 0xff) == 0xff) && (((Addr[1]) & 0xff) == 0xff) && \ ++ (((Addr[2]) & 0xff) == 0xff) && (((Addr[3]) & 0xff) == 0xff) && (((Addr[4]) & 0xff) == 0xff) && \ ++ (((Addr[5]) & 0xff) == 0xff)) ++#else ++extern __inline int is_multicast_mac_addr(const u8 *addr) ++{ ++ return (addr[0] != 0xff) && (0x01 & addr[0]); ++} ++ ++extern __inline int is_broadcast_mac_addr(const u8 *addr) ++{ ++ return ((addr[0] == 0xff) && (addr[1] == 0xff) && (addr[2] == 0xff) && \ ++ (addr[3] == 0xff) && (addr[4] == 0xff) && (addr[5] == 0xff)); ++} ++ ++extern __inline int is_zero_mac_addr(const u8 *addr) ++{ ++ return ((addr[0] == 0x00) && (addr[1] == 0x00) && (addr[2] == 0x00) && \ ++ (addr[3] == 0x00) && (addr[4] == 0x00) && (addr[5] == 0x00)); ++} ++#endif /* PLATFORM_FREEBSD */ ++ ++#define CFG_IEEE80211_RESERVE_FCS (1<<0) ++#define CFG_IEEE80211_COMPUTE_FCS (1<<1) ++ ++typedef struct tx_pending_t { ++ int frag; ++ struct ieee80211_txb *txb; ++} tx_pending_t; ++ ++ ++ ++#define TID_NUM 16 ++ ++#define IEEE_A (1<<0) ++#define IEEE_B (1<<1) ++#define IEEE_G (1<<2) ++#define IEEE_MODE_MASK (IEEE_A | IEEE_B | IEEE_G) ++ ++/* Baron move to ieee80211.c */ ++int ieee80211_is_empty_essid(const char *essid, int essid_len); ++int ieee80211_get_hdrlen(u16 fc); ++ ++#if 0 ++ /* Action frame categories (IEEE 802.11-2007, 7.3.1.11, Table 7-24) */ ++ #define WLAN_ACTION_SPECTRUM_MGMT 0 ++ #define WLAN_ACTION_QOS 1 ++ #define WLAN_ACTION_DLS 2 ++ #define WLAN_ACTION_BLOCK_ACK 3 ++ #define WLAN_ACTION_RADIO_MEASUREMENT 5 ++ #define WLAN_ACTION_FT 6 ++ #define WLAN_ACTION_SA_QUERY 8 ++ #define WLAN_ACTION_WMM 17 ++#endif ++ ++ ++/* Action category code */ ++enum rtw_ieee80211_category { ++ RTW_WLAN_CATEGORY_SPECTRUM_MGMT = 0, ++ RTW_WLAN_CATEGORY_QOS = 1, ++ RTW_WLAN_CATEGORY_DLS = 2, ++ RTW_WLAN_CATEGORY_BACK = 3, ++ RTW_WLAN_CATEGORY_PUBLIC = 4, /* IEEE 802.11 public action frames */ ++ RTW_WLAN_CATEGORY_RADIO_MEASUREMENT = 5, ++ RTW_WLAN_CATEGORY_FT = 6, ++ RTW_WLAN_CATEGORY_HT = 7, ++ RTW_WLAN_CATEGORY_SA_QUERY = 8, ++ RTW_WLAN_CATEGORY_WNM = 10, ++ RTW_WLAN_CATEGORY_UNPROTECTED_WNM = 11, /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ RTW_WLAN_CATEGORY_TDLS = 12, ++ RTW_WLAN_CATEGORY_SELF_PROTECTED = 15, /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ RTW_WLAN_CATEGORY_WMM = 17, ++ RTW_WLAN_CATEGORY_VHT = 21, ++ RTW_WLAN_CATEGORY_P2P = 0x7f,/* P2P action frames */ ++}; ++ ++/* SPECTRUM_MGMT action code */ ++enum rtw_ieee80211_spectrum_mgmt_actioncode { ++ RTW_WLAN_ACTION_SPCT_MSR_REQ = 0, ++ RTW_WLAN_ACTION_SPCT_MSR_RPRT = 1, ++ RTW_WLAN_ACTION_SPCT_TPC_REQ = 2, ++ RTW_WLAN_ACTION_SPCT_TPC_RPRT = 3, ++ RTW_WLAN_ACTION_SPCT_CHL_SWITCH = 4, ++ RTW_WLAN_ACTION_SPCT_EXT_CHL_SWITCH = 5, ++}; ++ ++enum _PUBLIC_ACTION { ++ ACT_PUBLIC_BSSCOEXIST = 0, /* 20/40 BSS Coexistence */ ++ ACT_PUBLIC_DSE_ENABLE = 1, ++ ACT_PUBLIC_DSE_DEENABLE = 2, ++ ACT_PUBLIC_DSE_REG_LOCATION = 3, ++ ACT_PUBLIC_EXT_CHL_SWITCH = 4, ++ ACT_PUBLIC_DSE_MSR_REQ = 5, ++ ACT_PUBLIC_DSE_MSR_RPRT = 6, ++ ACT_PUBLIC_MP = 7, /* Measurement Pilot */ ++ ACT_PUBLIC_DSE_PWR_CONSTRAINT = 8, ++ ACT_PUBLIC_VENDOR = 9, /* for WIFI_DIRECT */ ++ ACT_PUBLIC_GAS_INITIAL_REQ = 10, ++ ACT_PUBLIC_GAS_INITIAL_RSP = 11, ++ ACT_PUBLIC_GAS_COMEBACK_REQ = 12, ++ ACT_PUBLIC_GAS_COMEBACK_RSP = 13, ++ ACT_PUBLIC_TDLS_DISCOVERY_RSP = 14, ++ ACT_PUBLIC_LOCATION_TRACK = 15, ++ ACT_PUBLIC_MAX ++}; ++ ++#ifdef CONFIG_TDLS ++enum TDLS_ACTION_FIELD { ++ TDLS_SETUP_REQUEST = 0, ++ TDLS_SETUP_RESPONSE = 1, ++ TDLS_SETUP_CONFIRM = 2, ++ TDLS_TEARDOWN = 3, ++ TDLS_PEER_TRAFFIC_INDICATION = 4, ++ TDLS_CHANNEL_SWITCH_REQUEST = 5, ++ TDLS_CHANNEL_SWITCH_RESPONSE = 6, ++ TDLS_PEER_PSM_REQUEST = 7, ++ TDLS_PEER_PSM_RESPONSE = 8, ++ TDLS_PEER_TRAFFIC_RESPONSE = 9, ++ TDLS_DISCOVERY_REQUEST = 10, ++ TDLS_DISCOVERY_RESPONSE = 14, /* it's used in public action frame */ ++}; ++ ++#define TUNNELED_PROBE_REQ 15 ++#define TUNNELED_PROBE_RSP 16 ++#endif /* CONFIG_TDLS */ ++ ++/* BACK action code */ ++enum rtw_ieee80211_back_actioncode { ++ RTW_WLAN_ACTION_ADDBA_REQ = 0, ++ RTW_WLAN_ACTION_ADDBA_RESP = 1, ++ RTW_WLAN_ACTION_DELBA = 2, ++}; ++ ++/* HT features action code */ ++enum rtw_ieee80211_ht_actioncode { ++ RTW_WLAN_ACTION_HT_NOTI_CHNL_WIDTH = 0, ++ RTW_WLAN_ACTION_HT_SM_PS = 1, ++ RTW_WLAN_ACTION_HT_PSMP = 2, ++ RTW_WLAN_ACTION_HT_SET_PCO_PHASE = 3, ++ RTW_WLAN_ACTION_HT_CSI = 4, ++ RTW_WLAN_ACTION_HT_NON_COMPRESS_BEAMFORMING = 5, ++ RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING = 6, ++ RTW_WLAN_ACTION_HT_ASEL_FEEDBACK = 7, ++}; ++ ++/* BACK (block-ack) parties */ ++enum rtw_ieee80211_back_parties { ++ RTW_WLAN_BACK_RECIPIENT = 0, ++ RTW_WLAN_BACK_INITIATOR = 1, ++ RTW_WLAN_BACK_TIMER = 2, ++}; ++ ++/*20/40 BSS Coexistence element */ ++#define RTW_WLAN_20_40_BSS_COEX_INFO_REQ BIT(0) ++#define RTW_WLAN_20_40_BSS_COEX_40MHZ_INTOL BIT(1) ++#define RTW_WLAN_20_40_BSS_COEX_20MHZ_WIDTH_REQ BIT(2) ++#define RTW_WLAN_20_40_BSS_COEX_OBSS_EXEMPT_REQ BIT(3) ++#define RTW_WLAN_20_40_BSS_COEX_OBSS_EXEMPT_GRNT BIT(4) ++ ++/* VHT features action code */ ++enum rtw_ieee80211_vht_actioncode { ++ RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING = 0, ++ RTW_WLAN_ACTION_VHT_GROUPID_MANAGEMENT = 1, ++ RTW_WLAN_ACTION_VHT_OPMODE_NOTIFICATION = 2, ++}; ++ ++/*IEEE 802.11r action code*/ ++#ifdef CONFIG_RTW_80211R ++enum rtw_ieee80211_ft_actioncode { ++ RTW_WLAN_ACTION_FT_RESV, ++ RTW_WLAN_ACTION_FT_REQUEST, ++ RTW_WLAN_ACTION_FT_RESPONSE, ++ RTW_WLAN_ACTION_FT_CONFIRM, ++ RTW_WLAN_ACTION_FT_ACK, ++ RTW_WLAN_ACTION_FT_MAX, ++}; ++#endif ++ ++#define OUI_MICROSOFT 0x0050f2 /* Microsoft (also used in Wi-Fi specs) ++ * 00:50:F2 */ ++#ifndef PLATFORM_FREEBSD /* Baron BSD has defined */ ++ #define WME_OUI_TYPE 2 ++#endif /* PLATFORM_FREEBSD */ ++#define WME_OUI_SUBTYPE_INFORMATION_ELEMENT 0 ++#define WME_OUI_SUBTYPE_PARAMETER_ELEMENT 1 ++#define WME_OUI_SUBTYPE_TSPEC_ELEMENT 2 ++#define WME_VERSION 1 ++ ++#define WME_ACTION_CODE_SETUP_REQUEST 0 ++#define WME_ACTION_CODE_SETUP_RESPONSE 1 ++#define WME_ACTION_CODE_TEARDOWN 2 ++ ++#define WME_SETUP_RESPONSE_STATUS_ADMISSION_ACCEPTED 0 ++#define WME_SETUP_RESPONSE_STATUS_INVALID_PARAMETERS 1 ++#define WME_SETUP_RESPONSE_STATUS_REFUSED 3 ++ ++#define WME_TSPEC_DIRECTION_UPLINK 0 ++#define WME_TSPEC_DIRECTION_DOWNLINK 1 ++#define WME_TSPEC_DIRECTION_BI_DIRECTIONAL 3 ++ ++ ++#define OUI_BROADCOM 0x00904c /* Broadcom (Epigram) */ ++ ++#define VENDOR_HT_CAPAB_OUI_TYPE 0x33 /* 00-90-4c:0x33 */ ++ ++/** ++ * enum rtw_ieee80211_channel_flags - channel flags ++ * ++ * Channel flags set by the regulatory control code. ++ * ++ * @RTW_IEEE80211_CHAN_DISABLED: This channel is disabled. ++ * @RTW_IEEE80211_CHAN_PASSIVE_SCAN: Only passive scanning is permitted ++ * on this channel. ++ * @RTW_IEEE80211_CHAN_NO_IBSS: IBSS is not allowed on this channel. ++ * @RTW_IEEE80211_CHAN_RADAR: Radar detection is required on this channel. ++ * @RTW_IEEE80211_CHAN_NO_HT40PLUS: extension channel above this channel ++ * is not permitted. ++ * @RTW_IEEE80211_CHAN_NO_HT40MINUS: extension channel below this channel ++ * is not permitted. ++ */ ++enum rtw_ieee80211_channel_flags { ++ RTW_IEEE80211_CHAN_DISABLED = 1 << 0, ++ RTW_IEEE80211_CHAN_PASSIVE_SCAN = 1 << 1, ++ RTW_IEEE80211_CHAN_NO_IBSS = 1 << 2, ++ RTW_IEEE80211_CHAN_RADAR = 1 << 3, ++ RTW_IEEE80211_CHAN_NO_HT40PLUS = 1 << 4, ++ RTW_IEEE80211_CHAN_NO_HT40MINUS = 1 << 5, ++}; ++ ++#define RTW_IEEE80211_CHAN_NO_HT40 \ ++ (RTW_IEEE80211_CHAN_NO_HT40PLUS | RTW_IEEE80211_CHAN_NO_HT40MINUS) ++ ++/* Represent channel details, subset of ieee80211_channel */ ++struct rtw_ieee80211_channel { ++ /* enum ieee80211_band band; */ ++ /* u16 center_freq; */ ++ u16 hw_value; ++ u32 flags; ++ /* int max_antenna_gain; */ ++ /* int max_power; */ ++ /* int max_reg_power; */ ++ /* bool beacon_found; */ ++ /* u32 orig_flags; */ ++ /* int orig_mag; */ ++ /* int orig_mpwr; */ ++}; ++ ++#define CHAN_FMT \ ++ /*"band:%d, "*/ \ ++ /*"center_freq:%u, "*/ \ ++ "hw_value:%u, " \ ++ "flags:0x%08x" \ ++ /*"max_antenna_gain:%d\n"*/ \ ++ /*"max_power:%d\n"*/ \ ++ /*"max_reg_power:%d\n"*/ \ ++ /*"beacon_found:%u\n"*/ \ ++ /*"orig_flags:0x%08x\n"*/ \ ++ /*"orig_mag:%d\n"*/ \ ++ /*"orig_mpwr:%d\n"*/ ++ ++#define CHAN_ARG(channel) \ ++ /*(channel)->band*/ \ ++ /*, (channel)->center_freq*/ \ ++ (channel)->hw_value \ ++ , (channel)->flags \ ++ /*, (channel)->max_antenna_gain*/ \ ++ /*, (channel)->max_power*/ \ ++ /*, (channel)->max_reg_power*/ \ ++ /*, (channel)->beacon_found*/ \ ++ /*, (channel)->orig_flags*/ \ ++ /*, (channel)->orig_mag*/ \ ++ /*, (channel)->orig_mpwr*/ \ ++ ++/* Parsed Information Elements */ ++struct rtw_ieee802_11_elems { ++ u8 *ssid; ++ u8 ssid_len; ++ u8 *supp_rates; ++ u8 supp_rates_len; ++ u8 *fh_params; ++ u8 fh_params_len; ++ u8 *ds_params; ++ u8 ds_params_len; ++ u8 *cf_params; ++ u8 cf_params_len; ++ u8 *tim; ++ u8 tim_len; ++ u8 *ibss_params; ++ u8 ibss_params_len; ++ u8 *challenge; ++ u8 challenge_len; ++ u8 *erp_info; ++ u8 erp_info_len; ++ u8 *ext_supp_rates; ++ u8 ext_supp_rates_len; ++ u8 *wpa_ie; ++ u8 wpa_ie_len; ++ u8 *rsn_ie; ++ u8 rsn_ie_len; ++ u8 *wme; ++ u8 wme_len; ++ u8 *wme_tspec; ++ u8 wme_tspec_len; ++ u8 *wps_ie; ++ u8 wps_ie_len; ++ u8 *power_cap; ++ u8 power_cap_len; ++ u8 *supp_channels; ++ u8 supp_channels_len; ++ u8 *mdie; ++ u8 mdie_len; ++ u8 *ftie; ++ u8 ftie_len; ++ u8 *timeout_int; ++ u8 timeout_int_len; ++ u8 *ht_capabilities; ++ u8 ht_capabilities_len; ++ u8 *ht_operation; ++ u8 ht_operation_len; ++ u8 *vendor_ht_cap; ++ u8 vendor_ht_cap_len; ++ u8 *vht_capabilities; ++ u8 vht_capabilities_len; ++ u8 *vht_operation; ++ u8 vht_operation_len; ++ u8 *vht_op_mode_notify; ++ u8 vht_op_mode_notify_len; ++}; ++ ++typedef enum { ParseOK = 0, ParseUnknown = 1, ParseFailed = -1 } ParseRes; ++ ++ParseRes rtw_ieee802_11_parse_elems(u8 *start, uint len, ++ struct rtw_ieee802_11_elems *elems, ++ int show_errors); ++ ++u8 *rtw_set_fixed_ie(unsigned char *pbuf, unsigned int len, unsigned char *source, unsigned int *frlen); ++u8 *rtw_set_ie(u8 *pbuf, sint index, uint len, u8 *source, uint *frlen); ++ ++enum secondary_ch_offset { ++ SCN = 0, /* no secondary channel */ ++ SCA = 1, /* secondary channel above */ ++ SCB = 3, /* secondary channel below */ ++}; ++u8 secondary_ch_offset_to_hal_ch_offset(u8 ch_offset); ++u8 hal_ch_offset_to_secondary_ch_offset(u8 ch_offset); ++u8 *rtw_set_ie_ch_switch(u8 *buf, u32 *buf_len, u8 ch_switch_mode, u8 new_ch, u8 ch_switch_cnt); ++u8 *rtw_set_ie_secondary_ch_offset(u8 *buf, u32 *buf_len, u8 secondary_ch_offset); ++u8 *rtw_set_ie_mesh_ch_switch_parm(u8 *buf, u32 *buf_len, u8 ttl, u8 flags, u16 reason, u16 precedence); ++ ++u8 *rtw_get_ie(u8 *pbuf, sint index, sint *len, sint limit); ++u8 *rtw_get_ie_ex(u8 *in_ie, uint in_len, u8 eid, u8 *oui, u8 oui_len, u8 *ie, uint *ielen); ++int rtw_ies_remove_ie(u8 *ies, uint *ies_len, uint offset, u8 eid, u8 *oui, u8 oui_len); ++ ++void rtw_set_supported_rate(u8 *SupportedRates, uint mode) ; ++ ++unsigned char *rtw_get_wpa_ie(unsigned char *pie, int *wpa_ie_len, int limit); ++unsigned char *rtw_get_wpa2_ie(unsigned char *pie, int *rsn_ie_len, int limit); ++int rtw_get_wpa_cipher_suite(u8 *s); ++int rtw_get_wpa2_cipher_suite(u8 *s); ++int rtw_get_wapi_ie(u8 *in_ie, uint in_len, u8 *wapi_ie, u16 *wapi_len); ++int rtw_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x); ++int rtw_parse_wpa2_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x); ++ ++int rtw_get_sec_ie(u8 *in_ie, uint in_len, u8 *rsn_ie, u16 *rsn_len, u8 *wpa_ie, u16 *wpa_len); ++ ++u8 rtw_is_wps_ie(u8 *ie_ptr, uint *wps_ielen); ++u8 *rtw_get_wps_ie_from_scan_queue(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen, u8 frame_type); ++u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen); ++u8 *rtw_get_wps_attr(u8 *wps_ie, uint wps_ielen, u16 target_attr_id , u8 *buf_attr, u32 *len_attr); ++u8 *rtw_get_wps_attr_content(u8 *wps_ie, uint wps_ielen, u16 target_attr_id , u8 *buf_content, uint *len_content); ++ ++/** ++ * for_each_ie - iterate over continuous IEs ++ * @ie: ++ * @buf: ++ * @buf_len: ++ */ ++#define for_each_ie(ie, buf, buf_len) \ ++ for (ie = (void *)buf; (((u8 *)ie) - ((u8 *)buf) + 1) < buf_len; ie = (void *)(((u8 *)ie) + *(((u8 *)ie)+1) + 2)) ++ ++void dump_ies(void *sel, u8 *buf, u32 buf_len); ++ ++#ifdef CONFIG_80211N_HT ++void dump_ht_cap_ie_content(void *sel, u8 *buf, u32 buf_len); ++#endif ++ ++void dump_wps_ie(void *sel, u8 *ie, u32 ie_len); ++ ++void rtw_ies_get_chbw(u8 *ies, int ies_len, u8 *ch, u8 *bw, u8 *offset); ++ ++void rtw_bss_get_chbw(WLAN_BSSID_EX *bss, u8 *ch, u8 *bw, u8 *offset); ++ ++bool rtw_is_chbw_grouped(u8 ch_a, u8 bw_a, u8 offset_a ++ , u8 ch_b, u8 bw_b, u8 offset_b); ++void rtw_sync_chbw(u8 *req_ch, u8 *req_bw, u8 *req_offset ++ , u8 *g_ch, u8 *g_bw, u8 *g_offset); ++ ++u32 rtw_get_p2p_merged_ies_len(u8 *in_ie, u32 in_len); ++int rtw_p2p_merge_ies(u8 *in_ie, u32 in_len, u8 *merge_ie); ++void dump_p2p_ie(void *sel, u8 *ie, u32 ie_len); ++u8 *rtw_get_p2p_ie(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen); ++u8 *rtw_get_p2p_attr(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id, u8 *buf_attr, u32 *len_attr); ++u8 *rtw_get_p2p_attr_content(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id, u8 *buf_content, uint *len_content); ++u32 rtw_set_p2p_attr_content(u8 *pbuf, u8 attr_id, u16 attr_len, u8 *pdata_attr); ++uint rtw_del_p2p_ie(u8 *ies, uint ies_len_ori, const char *msg); ++uint rtw_del_p2p_attr(u8 *ie, uint ielen_ori, u8 attr_id); ++u8 *rtw_bss_ex_get_p2p_ie(WLAN_BSSID_EX *bss_ex, u8 *p2p_ie, uint *p2p_ielen); ++void rtw_bss_ex_del_p2p_ie(WLAN_BSSID_EX *bss_ex); ++void rtw_bss_ex_del_p2p_attr(WLAN_BSSID_EX *bss_ex, u8 attr_id); ++ ++void dump_wfd_ie(void *sel, u8 *ie, u32 ie_len); ++u8 *rtw_get_wfd_ie(u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen); ++u8 *rtw_get_wfd_attr(u8 *wfd_ie, uint wfd_ielen, u8 target_attr_id, u8 *buf_attr, u32 *len_attr); ++u8 *rtw_get_wfd_attr_content(u8 *wfd_ie, uint wfd_ielen, u8 target_attr_id, u8 *buf_content, uint *len_content); ++uint rtw_del_wfd_ie(u8 *ies, uint ies_len_ori, const char *msg); ++uint rtw_del_wfd_attr(u8 *ie, uint ielen_ori, u8 attr_id); ++u8 *rtw_bss_ex_get_wfd_ie(WLAN_BSSID_EX *bss_ex, u8 *wfd_ie, uint *wfd_ielen); ++void rtw_bss_ex_del_wfd_ie(WLAN_BSSID_EX *bss_ex); ++void rtw_bss_ex_del_wfd_attr(WLAN_BSSID_EX *bss_ex, u8 attr_id); ++ ++uint rtw_get_rateset_len(u8 *rateset); ++ ++struct registry_priv; ++int rtw_generate_ie(struct registry_priv *pregistrypriv); ++ ++int rtw_get_bit_value_from_ieee_value(u8 val); ++ ++uint rtw_is_cckrates_included(u8 *rate); ++ ++uint rtw_is_cckratesonly_included(u8 *rate); ++ ++int rtw_check_network_type(unsigned char *rate, int ratelen, int channel); ++ ++void rtw_get_bcn_info(struct wlan_network *pnetwork); ++ ++u8 rtw_check_invalid_mac_address(u8 *mac_addr, u8 check_local_bit); ++void rtw_macaddr_cfg(u8 *out, const u8 *hw_mac_addr); ++ ++u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI, unsigned char *MCS_rate); ++u8 rtw_ht_mcsset_to_nss(u8 *supp_mcs_set); ++ ++int rtw_action_frame_parse(const u8 *frame, u32 frame_len, u8 *category, u8 *action); ++const char *action_public_str(u8 action); ++ ++u8 key_2char2num(u8 hch, u8 lch); ++u8 str_2char2num(u8 hch, u8 lch); ++void macstr2num(u8 *dst, u8 *src); ++u8 convert_ip_addr(u8 hch, u8 mch, u8 lch); ++int wifirate2_ratetbl_inx(unsigned char rate); ++ ++ ++#endif /* IEEE80211_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/if_ether.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/if_ether.h +--- linux-4.14.18/3rdparty/rtl8723de/include/if_ether.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/if_ether.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,111 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef _LINUX_IF_ETHER_H ++#define _LINUX_IF_ETHER_H ++ ++/* ++ * IEEE 802.3 Ethernet magic constants. The frame sizes omit the preamble ++ * and FCS/CRC (frame check sequence). ++ */ ++ ++#define ETH_ALEN 6 /* Octets in one ethernet addr */ ++#define ETH_HLEN 14 /* Total octets in header. */ ++#define ETH_ZLEN 60 /* Min. octets in frame sans FCS */ ++#define ETH_DATA_LEN 1500 /* Max. octets in payload */ ++#define ETH_FRAME_LEN 1514 /* Max. octets in frame sans FCS */ ++ ++/* ++ * These are the defined Ethernet Protocol ID's. ++ */ ++ ++#define ETH_P_LOOP 0x0060 /* Ethernet Loopback packet */ ++#define ETH_P_PUP 0x0200 /* Xerox PUP packet */ ++#define ETH_P_PUPAT 0x0201 /* Xerox PUP Addr Trans packet */ ++#define ETH_P_IP 0x0800 /* Internet Protocol packet */ ++#define ETH_P_X25 0x0805 /* CCITT X.25 */ ++#define ETH_P_ARP 0x0806 /* Address Resolution packet */ ++#define ETH_P_BPQ 0x08FF /* G8BPQ AX.25 Ethernet Packet [ NOT AN OFFICIALLY REGISTERED ID ] */ ++#define ETH_P_IEEEPUP 0x0a00 /* Xerox IEEE802.3 PUP packet */ ++#define ETH_P_IEEEPUPAT 0x0a01 /* Xerox IEEE802.3 PUP Addr Trans packet */ ++#define ETH_P_DEC 0x6000 /* DEC Assigned proto */ ++#define ETH_P_DNA_DL 0x6001 /* DEC DNA Dump/Load */ ++#define ETH_P_DNA_RC 0x6002 /* DEC DNA Remote Console */ ++#define ETH_P_DNA_RT 0x6003 /* DEC DNA Routing */ ++#define ETH_P_LAT 0x6004 /* DEC LAT */ ++#define ETH_P_DIAG 0x6005 /* DEC Diagnostics */ ++#define ETH_P_CUST 0x6006 /* DEC Customer use */ ++#define ETH_P_SCA 0x6007 /* DEC Systems Comms Arch */ ++#define ETH_P_RARP 0x8035 /* Reverse Addr Res packet */ ++#define ETH_P_ATALK 0x809B /* Appletalk DDP */ ++#define ETH_P_AARP 0x80F3 /* Appletalk AARP */ ++#define ETH_P_8021Q 0x8100 /* 802.1Q VLAN Extended Header */ ++#define ETH_P_IPX 0x8137 /* IPX over DIX */ ++#define ETH_P_IPV6 0x86DD /* IPv6 over bluebook */ ++#define ETH_P_PPP_DISC 0x8863 /* PPPoE discovery messages */ ++#define ETH_P_PPP_SES 0x8864 /* PPPoE session messages */ ++#define ETH_P_ATMMPOA 0x884c /* MultiProtocol Over ATM */ ++#define ETH_P_ATMFATE 0x8884 /* Frame-based ATM Transport ++ * over Ethernet ++ */ ++ ++/* ++ * Non DIX types. Won't clash for 1500 types. ++ */ ++ ++#define ETH_P_802_3 0x0001 /* Dummy type for 802.3 frames */ ++#define ETH_P_AX25 0x0002 /* Dummy protocol id for AX.25 */ ++#define ETH_P_ALL 0x0003 /* Every packet (be careful!!!) */ ++#define ETH_P_802_2 0x0004 /* 802.2 frames */ ++#define ETH_P_SNAP 0x0005 /* Internal only */ ++#define ETH_P_DDCMP 0x0006 /* DEC DDCMP: Internal only */ ++#define ETH_P_WAN_PPP 0x0007 /* Dummy type for WAN PPP frames*/ ++#define ETH_P_PPP_MP 0x0008 /* Dummy type for PPP MP frames */ ++#define ETH_P_LOCALTALK 0x0009 /* Localtalk pseudo type */ ++#define ETH_P_PPPTALK 0x0010 /* Dummy type for Atalk over PPP*/ ++#define ETH_P_TR_802_2 0x0011 /* 802.2 frames */ ++#define ETH_P_MOBITEX 0x0015 /* Mobitex (kaz@cafe.net) */ ++#define ETH_P_CONTROL 0x0016 /* Card specific control frames */ ++#define ETH_P_IRDA 0x0017 /* Linux-IrDA */ ++#define ETH_P_ECONET 0x0018 /* Acorn Econet */ ++ ++/* ++ * This is an Ethernet frame header. ++ */ ++ ++struct ethhdr { ++ unsigned char h_dest[ETH_ALEN]; /* destination eth addr */ ++ unsigned char h_source[ETH_ALEN]; /* source ether addr */ ++ unsigned short h_proto; /* packet type ID field */ ++}; ++ ++struct _vlan { ++ unsigned short h_vlan_TCI; /* Encapsulates priority and VLAN ID */ ++ unsigned short h_vlan_encapsulated_proto; ++}; ++ ++ ++ ++#define get_vlan_id(pvlan) ((ntohs((unsigned short)pvlan->h_vlan_TCI)) & 0xfff) ++#define get_vlan_priority(pvlan) ((ntohs((unsigned short)pvlan->h_vlan_TCI))>>13) ++#define get_vlan_encap_proto(pvlan) (ntohs((unsigned short)pvlan->h_vlan_encapsulated_proto)) ++ ++ ++#endif /* _LINUX_IF_ETHER_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/ip.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/ip.h +--- linux-4.14.18/3rdparty/rtl8723de/include/ip.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/ip.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,140 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _LINUX_IP_H ++#define _LINUX_IP_H ++ ++/* SOL_IP socket options */ ++ ++#define IPTOS_TOS_MASK 0x1E ++#define IPTOS_TOS(tos) ((tos)&IPTOS_TOS_MASK) ++#define IPTOS_LOWDELAY 0x10 ++#define IPTOS_THROUGHPUT 0x08 ++#define IPTOS_RELIABILITY 0x04 ++#define IPTOS_MINCOST 0x02 ++ ++#define IPTOS_PREC_MASK 0xE0 ++#define IPTOS_PREC(tos) ((tos)&IPTOS_PREC_MASK) ++#define IPTOS_PREC_NETCONTROL 0xe0 ++#define IPTOS_PREC_INTERNETCONTROL 0xc0 ++#define IPTOS_PREC_CRITIC_ECP 0xa0 ++#define IPTOS_PREC_FLASHOVERRIDE 0x80 ++#define IPTOS_PREC_FLASH 0x60 ++#define IPTOS_PREC_IMMEDIATE 0x40 ++#define IPTOS_PREC_PRIORITY 0x20 ++#define IPTOS_PREC_ROUTINE 0x00 ++ ++ ++/* IP options */ ++#define IPOPT_COPY 0x80 ++#define IPOPT_CLASS_MASK 0x60 ++#define IPOPT_NUMBER_MASK 0x1f ++ ++#define IPOPT_COPIED(o) ((o)&IPOPT_COPY) ++#define IPOPT_CLASS(o) ((o)&IPOPT_CLASS_MASK) ++#define IPOPT_NUMBER(o) ((o)&IPOPT_NUMBER_MASK) ++ ++#define IPOPT_CONTROL 0x00 ++#define IPOPT_RESERVED1 0x20 ++#define IPOPT_MEASUREMENT 0x40 ++#define IPOPT_RESERVED2 0x60 ++ ++#define IPOPT_END (0 | IPOPT_CONTROL) ++#define IPOPT_NOOP (1 | IPOPT_CONTROL) ++#define IPOPT_SEC (2 | IPOPT_CONTROL | IPOPT_COPY) ++#define IPOPT_LSRR (3 | IPOPT_CONTROL | IPOPT_COPY) ++#define IPOPT_TIMESTAMP (4 | IPOPT_MEASUREMENT) ++#define IPOPT_RR (7 | IPOPT_CONTROL) ++#define IPOPT_SID (8 | IPOPT_CONTROL | IPOPT_COPY) ++#define IPOPT_SSRR (9 | IPOPT_CONTROL | IPOPT_COPY) ++#define IPOPT_RA (20 | IPOPT_CONTROL | IPOPT_COPY) ++ ++#define IPVERSION 4 ++#define MAXTTL 255 ++#define IPDEFTTL 64 ++ ++/* struct timestamp, struct route and MAX_ROUTES are removed. ++ ++ REASONS: it is clear that nobody used them because: ++ - MAX_ROUTES value was wrong. ++ - "struct route" was wrong. ++ - "struct timestamp" had fatally misaligned bitfields and was completely unusable. ++ */ ++ ++#define IPOPT_OPTVAL 0 ++#define IPOPT_OLEN 1 ++#define IPOPT_OFFSET 2 ++#define IPOPT_MINOFF 4 ++#define MAX_IPOPTLEN 40 ++#define IPOPT_NOP IPOPT_NOOP ++#define IPOPT_EOL IPOPT_END ++#define IPOPT_TS IPOPT_TIMESTAMP ++ ++#define IPOPT_TS_TSONLY 0 /* timestamps only */ ++#define IPOPT_TS_TSANDADDR 1 /* timestamps and addresses */ ++#define IPOPT_TS_PRESPEC 3 /* specified modules only */ ++ ++#ifdef PLATFORM_LINUX ++ ++struct ip_options { ++ __u32 faddr; /* Saved first hop address */ ++ unsigned char optlen; ++ unsigned char srr; ++ unsigned char rr; ++ unsigned char ts; ++ unsigned char is_setbyuser:1, /* Set by setsockopt? */ ++ is_data:1, /* Options in __data, rather than skb */ ++ is_strictroute:1, /* Strict source route */ ++ srr_is_hit:1, /* Packet destination addr was our one */ ++ is_changed:1, /* IP checksum more not valid */ ++ rr_needaddr:1, /* Need to record addr of outgoing dev */ ++ ts_needtime:1, /* Need to record timestamp */ ++ ts_needaddr:1; /* Need to record addr of outgoing dev */ ++ unsigned char router_alert; ++ unsigned char __pad1; ++ unsigned char __pad2; ++ unsigned char __data[0]; ++}; ++ ++#define optlength(opt) (sizeof(struct ip_options) + opt->optlen) ++#endif ++ ++struct iphdr { ++#if defined(__LITTLE_ENDIAN_BITFIELD) ++ __u8 ihl:4, ++ version:4; ++#elif defined (__BIG_ENDIAN_BITFIELD) ++ __u8 version:4, ++ ihl:4; ++#else ++#error "Please fix " ++#endif ++ __u8 tos; ++ __u16 tot_len; ++ __u16 id; ++ __u16 frag_off; ++ __u8 ttl; ++ __u8 protocol; ++ __u16 check; ++ __u32 saddr; ++ __u32 daddr; ++ /*The options start here. */ ++}; ++ ++#endif /* _LINUX_IP_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/linux/wireless.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/linux/wireless.h +--- linux-4.14.18/3rdparty/rtl8723de/include/linux/wireless.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/linux/wireless.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,92 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef _LINUX_WIRELESS_H ++#define _LINUX_WIRELESS_H ++ ++/***************************** INCLUDES *****************************/ ++ ++#if 0 ++ #include /* for __u* and __s* typedefs */ ++ #include /* for "struct sockaddr" et al */ ++ #include /* for IFNAMSIZ and co... */ ++#else ++ #define __user ++ /* typedef uint16_t __u16; */ ++ #include /* for "struct sockaddr" et al */ ++ #include /* for IFNAMSIZ and co... */ ++#endif ++ ++/****************************** TYPES ******************************/ ++#ifdef CONFIG_COMPAT ++struct compat_iw_point { ++ compat_caddr_t pointer; ++ __u16 length; ++ __u16 flags; ++}; ++#endif ++/* --------------------------- SUBTYPES --------------------------- */ ++/* ++ * For all data larger than 16 octets, we need to use a ++ * pointer to memory allocated in user space. ++ */ ++struct iw_point { ++ void __user *pointer; /* Pointer to the data (in user space) */ ++ __u16 length; /* number of fields or size in bytes */ ++ __u16 flags; /* Optional params */ ++}; ++ ++ ++/* ------------------------ IOCTL REQUEST ------------------------ */ ++/* ++ * This structure defines the payload of an ioctl, and is used ++ * below. ++ * ++ * Note that this structure should fit on the memory footprint ++ * of iwreq (which is the same as ifreq), which mean a max size of ++ * 16 octets = 128 bits. Warning, pointers might be 64 bits wide... ++ * You should check this when increasing the structures defined ++ * above in this file... ++ */ ++union iwreq_data { ++ /* Config - generic */ ++ char name[IFNAMSIZ]; ++ /* Name : used to verify the presence of wireless extensions. ++ * Name of the protocol/provider... */ ++ ++ struct iw_point data; /* Other large parameters */ ++}; ++ ++/* ++ * The structure to exchange data for ioctl. ++ * This structure is the same as 'struct ifreq', but (re)defined for ++ * convenience... ++ * Do I need to remind you about structure size (32 octets) ? ++ */ ++struct iwreq { ++ union { ++ char ifrn_name[IFNAMSIZ]; /* if name, e.g. "eth0" */ ++ } ifr_ifrn; ++ ++ /* Data part (defined just above) */ ++ union iwreq_data u; ++}; ++ ++#endif /* _LINUX_WIRELESS_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/mlme_osdep.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/mlme_osdep.h +--- linux-4.14.18/3rdparty/rtl8723de/include/mlme_osdep.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/mlme_osdep.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,36 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __MLME_OSDEP_H_ ++#define __MLME_OSDEP_H_ ++ ++ ++#if defined(PLATFORM_WINDOWS) || defined(PLATFORM_MPIXEL) ++ extern int time_after(u32 now, u32 old); ++#endif ++ ++extern void rtw_init_mlme_timer(_adapter *padapter); ++extern void rtw_os_indicate_disconnect(_adapter *adapter, u16 reason, u8 locally_generated); ++extern void rtw_os_indicate_connect(_adapter *adapter); ++void rtw_os_indicate_scan_done(_adapter *padapter, bool aborted); ++extern void rtw_report_sec_ie(_adapter *adapter, u8 authmode, u8 *sec_ie); ++ ++void rtw_reset_securitypriv(_adapter *adapter); ++ ++#endif /* _MLME_OSDEP_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/mp_custom_oid.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/mp_custom_oid.h +--- linux-4.14.18/3rdparty/rtl8723de/include/mp_custom_oid.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/mp_custom_oid.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,353 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __CUSTOM_OID_H ++#define __CUSTOM_OID_H ++ ++/* by Owen ++ * 0xFF818000 - 0xFF81802F RTL8180 Mass Production Kit ++ * 0xFF818500 - 0xFF81850F RTL8185 Setup Utility ++ * 0xFF818580 - 0xFF81858F RTL8185 Phy Status Utility */ ++ ++/* */ ++ ++/* by Owen for Production Kit ++ * For Production Kit with Agilent Equipments ++ * in order to make our custom oids hopefully somewhat unique ++ * we will use 0xFF (indicating implementation specific OID) ++ * 81(first byte of non zero Realtek unique identifier) ++ * 80 (second byte of non zero Realtek unique identifier) ++ * XX (the custom OID number - providing 255 possible custom oids) */ ++ ++#define OID_RT_PRO_RESET_DUT 0xFF818000 ++#define OID_RT_PRO_SET_DATA_RATE 0xFF818001 ++#define OID_RT_PRO_START_TEST 0xFF818002 ++#define OID_RT_PRO_STOP_TEST 0xFF818003 ++#define OID_RT_PRO_SET_PREAMBLE 0xFF818004 ++#define OID_RT_PRO_SET_SCRAMBLER 0xFF818005 ++#define OID_RT_PRO_SET_FILTER_BB 0xFF818006 ++#define OID_RT_PRO_SET_MANUAL_DIVERSITY_BB 0xFF818007 ++#define OID_RT_PRO_SET_CHANNEL_DIRECT_CALL 0xFF818008 ++#define OID_RT_PRO_SET_SLEEP_MODE_DIRECT_CALL 0xFF818009 ++#define OID_RT_PRO_SET_WAKE_MODE_DIRECT_CALL 0xFF81800A ++ ++#define OID_RT_PRO_SET_TX_ANTENNA_BB 0xFF81800D ++#define OID_RT_PRO_SET_ANTENNA_BB 0xFF81800E ++#define OID_RT_PRO_SET_CR_SCRAMBLER 0xFF81800F ++#define OID_RT_PRO_SET_CR_NEW_FILTER 0xFF818010 ++#define OID_RT_PRO_SET_TX_POWER_CONTROL 0xFF818011 ++#define OID_RT_PRO_SET_CR_TX_CONFIG 0xFF818012 ++#define OID_RT_PRO_GET_TX_POWER_CONTROL 0xFF818013 ++#define OID_RT_PRO_GET_CR_SIGNAL_QUALITY 0xFF818014 ++#define OID_RT_PRO_SET_CR_SETPOINT 0xFF818015 ++#define OID_RT_PRO_SET_INTEGRATOR 0xFF818016 ++#define OID_RT_PRO_SET_SIGNAL_QUALITY 0xFF818017 ++#define OID_RT_PRO_GET_INTEGRATOR 0xFF818018 ++#define OID_RT_PRO_GET_SIGNAL_QUALITY 0xFF818019 ++#define OID_RT_PRO_QUERY_EEPROM_TYPE 0xFF81801A ++#define OID_RT_PRO_WRITE_MAC_ADDRESS 0xFF81801B ++#define OID_RT_PRO_READ_MAC_ADDRESS 0xFF81801C ++#define OID_RT_PRO_WRITE_CIS_DATA 0xFF81801D ++#define OID_RT_PRO_READ_CIS_DATA 0xFF81801E ++#define OID_RT_PRO_WRITE_POWER_CONTROL 0xFF81801F ++#define OID_RT_PRO_READ_POWER_CONTROL 0xFF818020 ++#define OID_RT_PRO_WRITE_EEPROM 0xFF818021 ++#define OID_RT_PRO_READ_EEPROM 0xFF818022 ++#define OID_RT_PRO_RESET_TX_PACKET_SENT 0xFF818023 ++#define OID_RT_PRO_QUERY_TX_PACKET_SENT 0xFF818024 ++#define OID_RT_PRO_RESET_RX_PACKET_RECEIVED 0xFF818025 ++#define OID_RT_PRO_QUERY_RX_PACKET_RECEIVED 0xFF818026 ++#define OID_RT_PRO_QUERY_RX_PACKET_CRC32_ERROR 0xFF818027 ++#define OID_RT_PRO_QUERY_CURRENT_ADDRESS 0xFF818028 ++#define OID_RT_PRO_QUERY_PERMANENT_ADDRESS 0xFF818029 ++#define OID_RT_PRO_SET_PHILIPS_RF_PARAMETERS 0xFF81802A ++#define OID_RT_PRO_RECEIVE_PACKET 0xFF81802C ++/* added by Owen on 04/08/03 for Cameo's request */ ++#define OID_RT_PRO_WRITE_EEPROM_BYTE 0xFF81802D ++#define OID_RT_PRO_READ_EEPROM_BYTE 0xFF81802E ++#define OID_RT_PRO_SET_MODULATION 0xFF81802F ++/* */ ++ ++/* Sean */ ++#define OID_RT_DRIVER_OPTION 0xFF818080 ++#define OID_RT_RF_OFF 0xFF818081 ++#define OID_RT_AUTH_STATUS 0xFF818082 ++ ++/* ************************************************************************ */ ++#define OID_RT_PRO_SET_CONTINUOUS_TX 0xFF81800B ++#define OID_RT_PRO_SET_SINGLE_CARRIER_TX 0xFF81800C ++#define OID_RT_PRO_SET_CARRIER_SUPPRESSION_TX 0xFF81802B ++#define OID_RT_PRO_SET_SINGLE_TONE_TX 0xFF818043 ++/* ************************************************************************ */ ++ ++ ++/* by Owen for RTL8185 Phy Status Report Utility */ ++#define OID_RT_UTILITY_FALSE_ALARM_COUNTERS 0xFF818580 ++#define OID_RT_UTILITY_SELECT_DEBUG_MODE 0xFF818581 ++#define OID_RT_UTILITY_SELECT_SUBCARRIER_NUMBER 0xFF818582 ++#define OID_RT_UTILITY_GET_RSSI_STATUS 0xFF818583 ++#define OID_RT_UTILITY_GET_FRAME_DETECTION_STATUS 0xFF818584 ++#define OID_RT_UTILITY_GET_AGC_AND_FREQUENCY_OFFSET_ESTIMATION_STATUS 0xFF818585 ++#define OID_RT_UTILITY_GET_CHANNEL_ESTIMATION_STATUS 0xFF818586 ++/* */ ++ ++/* by Owen on 03/09/19-03/09/22 for RTL8185 */ ++#define OID_RT_WIRELESS_MODE 0xFF818500 ++#define OID_RT_SUPPORTED_RATES 0xFF818501 ++#define OID_RT_DESIRED_RATES 0xFF818502 ++#define OID_RT_WIRELESS_MODE_STARTING_ADHOC 0xFF818503 ++/* */ ++ ++#define OID_RT_GET_CONNECT_STATE 0xFF030001 ++#define OID_RT_RESCAN 0xFF030002 ++#define OID_RT_SET_KEY_LENGTH 0xFF030003 ++#define OID_RT_SET_DEFAULT_KEY_ID 0xFF030004 ++ ++#define OID_RT_SET_CHANNEL 0xFF010182 ++#define OID_RT_SET_SNIFFER_MODE 0xFF010183 ++#define OID_RT_GET_SIGNAL_QUALITY 0xFF010184 ++#define OID_RT_GET_SMALL_PACKET_CRC 0xFF010185 ++#define OID_RT_GET_MIDDLE_PACKET_CRC 0xFF010186 ++#define OID_RT_GET_LARGE_PACKET_CRC 0xFF010187 ++#define OID_RT_GET_TX_RETRY 0xFF010188 ++#define OID_RT_GET_RX_RETRY 0xFF010189 ++#define OID_RT_PRO_SET_FW_DIG_STATE 0xFF01018A/* S */ ++#define OID_RT_PRO_SET_FW_RA_STATE 0xFF01018B/* S */ ++ ++#define OID_RT_GET_RX_TOTAL_PACKET 0xFF010190 ++#define OID_RT_GET_TX_BEACON_OK 0xFF010191 ++#define OID_RT_GET_TX_BEACON_ERR 0xFF010192 ++#define OID_RT_GET_RX_ICV_ERR 0xFF010193 ++#define OID_RT_SET_ENCRYPTION_ALGORITHM 0xFF010194 ++#define OID_RT_SET_NO_AUTO_RESCAN 0xFF010195 ++#define OID_RT_GET_PREAMBLE_MODE 0xFF010196 ++#define OID_RT_GET_DRIVER_UP_DELTA_TIME 0xFF010197 ++#define OID_RT_GET_AP_IP 0xFF010198 ++#define OID_RT_GET_CHANNELPLAN 0xFF010199 ++#define OID_RT_SET_PREAMBLE_MODE 0xFF01019A ++#define OID_RT_SET_BCN_INTVL 0xFF01019B ++#define OID_RT_GET_RF_VENDER 0xFF01019C ++#define OID_RT_DEDICATE_PROBE 0xFF01019D ++#define OID_RT_PRO_RX_FILTER_PATTERN 0xFF01019E ++ ++#define OID_RT_GET_DCST_CURRENT_THRESHOLD 0xFF01019F ++ ++#define OID_RT_GET_CCA_ERR 0xFF0101A0 ++#define OID_RT_GET_CCA_UPGRADE_THRESHOLD 0xFF0101A1 ++#define OID_RT_GET_CCA_FALLBACK_THRESHOLD 0xFF0101A2 ++ ++#define OID_RT_GET_CCA_UPGRADE_EVALUATE_TIMES 0xFF0101A3 ++#define OID_RT_GET_CCA_FALLBACK_EVALUATE_TIMES 0xFF0101A4 ++ ++/* by Owen on 03/31/03 for Cameo's request */ ++#define OID_RT_SET_RATE_ADAPTIVE 0xFF0101A5 ++/* */ ++#define OID_RT_GET_DCST_EVALUATE_PERIOD 0xFF0101A5 ++#define OID_RT_GET_DCST_TIME_UNIT_INDEX 0xFF0101A6 ++#define OID_RT_GET_TOTAL_TX_BYTES 0xFF0101A7 ++#define OID_RT_GET_TOTAL_RX_BYTES 0xFF0101A8 ++#define OID_RT_CURRENT_TX_POWER_LEVEL 0xFF0101A9 ++#define OID_RT_GET_ENC_KEY_MISMATCH_COUNT 0xFF0101AA ++#define OID_RT_GET_ENC_KEY_MATCH_COUNT 0xFF0101AB ++#define OID_RT_GET_CHANNEL 0xFF0101AC ++ ++#define OID_RT_SET_CHANNELPLAN 0xFF0101AD ++#define OID_RT_GET_HARDWARE_RADIO_OFF 0xFF0101AE ++#define OID_RT_CHANNELPLAN_BY_COUNTRY 0xFF0101AF ++#define OID_RT_SCAN_AVAILABLE_BSSID 0xFF0101B0 ++#define OID_RT_GET_HARDWARE_VERSION 0xFF0101B1 ++#define OID_RT_GET_IS_ROAMING 0xFF0101B2 ++#define OID_RT_GET_IS_PRIVACY 0xFF0101B3 ++#define OID_RT_GET_KEY_MISMATCH 0xFF0101B4 ++#define OID_RT_SET_RSSI_ROAM_TRAFFIC_TH 0xFF0101B5 ++#define OID_RT_SET_RSSI_ROAM_SIGNAL_TH 0xFF0101B6 ++#define OID_RT_RESET_LOG 0xFF0101B7 ++#define OID_RT_GET_LOG 0xFF0101B8 ++#define OID_RT_SET_INDICATE_HIDDEN_AP 0xFF0101B9 ++#define OID_RT_GET_HEADER_FAIL 0xFF0101BA ++#define OID_RT_SUPPORTED_WIRELESS_MODE 0xFF0101BB ++#define OID_RT_GET_CHANNEL_LIST 0xFF0101BC ++#define OID_RT_GET_SCAN_IN_PROGRESS 0xFF0101BD ++#define OID_RT_GET_TX_INFO 0xFF0101BE ++#define OID_RT_RF_READ_WRITE_OFFSET 0xFF0101BF ++#define OID_RT_RF_READ_WRITE 0xFF0101C0 ++ ++/* For Netgear request. 2005.01.13, by rcnjko. */ ++#define OID_RT_FORCED_DATA_RATE 0xFF0101C1 ++#define OID_RT_WIRELESS_MODE_FOR_SCAN_LIST 0xFF0101C2 ++/* For Netgear request. 2005.02.17, by rcnjko. */ ++#define OID_RT_GET_BSS_WIRELESS_MODE 0xFF0101C3 ++/* For AZ project. 2005.06.27, by rcnjko. */ ++#define OID_RT_SCAN_WITH_MAGIC_PACKET 0xFF0101C4 ++ ++/* Vincent 8185MP */ ++#define OID_RT_PRO_RX_FILTER 0xFF0111C0 ++ ++/* Andy TEST ++ * #define OID_RT_PRO_WRITE_REGISTRY 0xFF0111C1 ++ * #define OID_RT_PRO_READ_REGISTRY 0xFF0111C2 */ ++#define OID_CE_USB_WRITE_REGISTRY 0xFF0111C1 ++#define OID_CE_USB_READ_REGISTRY 0xFF0111C2 ++ ++ ++#define OID_RT_PRO_SET_INITIAL_GAIN 0xFF0111C3 ++#define OID_RT_PRO_SET_BB_RF_STANDBY_MODE 0xFF0111C4 ++#define OID_RT_PRO_SET_BB_RF_SHUTDOWN_MODE 0xFF0111C5 ++#define OID_RT_PRO_SET_TX_CHARGE_PUMP 0xFF0111C6 ++#define OID_RT_PRO_SET_RX_CHARGE_PUMP 0xFF0111C7 ++#define OID_RT_PRO_RF_WRITE_REGISTRY 0xFF0111C8 ++#define OID_RT_PRO_RF_READ_REGISTRY 0xFF0111C9 ++#define OID_RT_PRO_QUERY_RF_TYPE 0xFF0111CA ++ ++/* AP OID */ ++#define OID_RT_AP_GET_ASSOCIATED_STATION_LIST 0xFF010300 ++#define OID_RT_AP_GET_CURRENT_TIME_STAMP 0xFF010301 ++#define OID_RT_AP_SWITCH_INTO_AP_MODE 0xFF010302 ++#define OID_RT_AP_SET_DTIM_PERIOD 0xFF010303 ++#define OID_RT_AP_SUPPORTED 0xFF010304 /* Determine if driver supports AP mode. 2004.08.27, by rcnjko. */ ++#define OID_RT_AP_SET_PASSPHRASE 0xFF010305 /* Set WPA-PSK passphrase into authenticator. 2005.07.08, byrcnjko. */ ++ ++/* 8187MP. 2004.09.06, by rcnjko. */ ++#define OID_RT_PRO8187_WI_POLL 0xFF818780 ++#define OID_RT_PRO_WRITE_BB_REG 0xFF818781 ++#define OID_RT_PRO_READ_BB_REG 0xFF818782 ++#define OID_RT_PRO_WRITE_RF_REG 0xFF818783 ++#define OID_RT_PRO_READ_RF_REG 0xFF818784 ++ ++/* Meeting House. added by Annie, 2005-07-20. */ ++#define OID_RT_MH_VENDER_ID 0xFFEDC100 ++ ++/* 8711 MP OID added 20051230. */ ++#define OID_RT_PRO8711_JOIN_BSS 0xFF871100/* S */ ++ ++#define OID_RT_PRO_READ_REGISTER 0xFF871101 /* Q */ ++#define OID_RT_PRO_WRITE_REGISTER 0xFF871102 /* S */ ++ ++#define OID_RT_PRO_BURST_READ_REGISTER 0xFF871103 /* Q */ ++#define OID_RT_PRO_BURST_WRITE_REGISTER 0xFF871104 /* S */ ++ ++#define OID_RT_PRO_WRITE_TXCMD 0xFF871105 /* S */ ++ ++#define OID_RT_PRO_READ16_EEPROM 0xFF871106 /* Q */ ++#define OID_RT_PRO_WRITE16_EEPROM 0xFF871107 /* S */ ++ ++#define OID_RT_PRO_H2C_SET_COMMAND 0xFF871108 /* S */ ++#define OID_RT_PRO_H2C_QUERY_RESULT 0xFF871109 /* Q */ ++ ++#define OID_RT_PRO8711_WI_POLL 0xFF87110A /* Q */ ++#define OID_RT_PRO8711_PKT_LOSS 0xFF87110B /* Q */ ++#define OID_RT_RD_ATTRIB_MEM 0xFF87110C/* Q */ ++#define OID_RT_WR_ATTRIB_MEM 0xFF87110D/* S */ ++ ++ ++/* Method 2 for H2C/C2H */ ++#define OID_RT_PRO_H2C_CMD_MODE 0xFF871110 /* S */ ++#define OID_RT_PRO_H2C_CMD_RSP_MODE 0xFF871111 /* Q */ ++#define OID_RT_PRO_H2C_CMD_EVENT_MODE 0xFF871112 /* S */ ++#define OID_RT_PRO_WAIT_C2H_EVENT 0xFF871113 /* Q */ ++#define OID_RT_PRO_RW_ACCESS_PROTOCOL_TEST 0xFF871114/* Q */ ++ ++#define OID_RT_PRO_SCSI_ACCESS_TEST 0xFF871115 /* Q, S */ ++ ++#define OID_RT_PRO_SCSI_TCPIPOFFLOAD_OUT 0xFF871116 /* S */ ++#define OID_RT_PRO_SCSI_TCPIPOFFLOAD_IN 0xFF871117 /* Q, S */ ++#define OID_RT_RRO_RX_PKT_VIA_IOCTRL 0xFF871118 /* Q */ ++#define OID_RT_RRO_RX_PKTARRAY_VIA_IOCTRL 0xFF871119 /* Q */ ++ ++#define OID_RT_RPO_SET_PWRMGT_TEST 0xFF87111A /* S */ ++#define OID_RT_PRO_QRY_PWRMGT_TEST 0XFF87111B /* Q */ ++#define OID_RT_RPO_ASYNC_RWIO_TEST 0xFF87111C /* S */ ++#define OID_RT_RPO_ASYNC_RWIO_POLL 0xFF87111D /* Q */ ++#define OID_RT_PRO_SET_RF_INTFS 0xFF87111E /* S */ ++#define OID_RT_POLL_RX_STATUS 0xFF87111F /* Q */ ++ ++#define OID_RT_PRO_CFG_DEBUG_MESSAGE 0xFF871120 /* Q, S */ ++#define OID_RT_PRO_SET_DATA_RATE_EX 0xFF871121/* S */ ++#define OID_RT_PRO_SET_BASIC_RATE 0xFF871122/* S */ ++#define OID_RT_PRO_READ_TSSI 0xFF871123/* S */ ++#define OID_RT_PRO_SET_POWER_TRACKING 0xFF871124/* S */ ++ ++ ++#define OID_RT_PRO_QRY_PWRSTATE 0xFF871150 /* Q */ ++#define OID_RT_PRO_SET_PWRSTATE 0xFF871151 /* S */ ++ ++/* Method 2 , using workitem */ ++#define OID_RT_SET_READ_REG 0xFF871181 /* S */ ++#define OID_RT_SET_WRITE_REG 0xFF871182 /* S */ ++#define OID_RT_SET_BURST_READ_REG 0xFF871183 /* S */ ++#define OID_RT_SET_BURST_WRITE_REG 0xFF871184 /* S */ ++#define OID_RT_SET_WRITE_TXCMD 0xFF871185 /* S */ ++#define OID_RT_SET_READ16_EEPROM 0xFF871186 /* S */ ++#define OID_RT_SET_WRITE16_EEPROM 0xFF871187 /* S */ ++#define OID_RT_QRY_POLL_WKITEM 0xFF871188 /* Q */ ++ ++/* For SDIO INTERFACE only */ ++#define OID_RT_PRO_SYNCPAGERW_SRAM 0xFF8711A0 /* Q, S */ ++#define OID_RT_PRO_871X_DRV_EXT 0xFF8711A1 ++ ++/* For USB INTERFACE only */ ++#define OID_RT_PRO_USB_VENDOR_REQ 0xFF8711B0 /* Q, S */ ++#define OID_RT_PRO_SCSI_AUTO_TEST 0xFF8711B1 /* S */ ++#define OID_RT_PRO_USB_MAC_AC_FIFO_WRITE 0xFF8711B2 /* S */ ++#define OID_RT_PRO_USB_MAC_RX_FIFO_READ 0xFF8711B3 /* Q */ ++#define OID_RT_PRO_USB_MAC_RX_FIFO_POLLING 0xFF8711B4 /* Q */ ++ ++#define OID_RT_PRO_H2C_SET_RATE_TABLE 0xFF8711FB /* S */ ++#define OID_RT_PRO_H2C_GET_RATE_TABLE 0xFF8711FC /* S */ ++#define OID_RT_PRO_H2C_C2H_LBK_TEST 0xFF8711FE ++ ++#define OID_RT_PRO_ENCRYPTION_CTRL 0xFF871200 /* Q, S */ ++#define OID_RT_PRO_ADD_STA_INFO 0xFF871201 /* S */ ++#define OID_RT_PRO_DELE_STA_INFO 0xFF871202 /* S */ ++#define OID_RT_PRO_QUERY_DR_VARIABLE 0xFF871203 /* Q */ ++ ++#define OID_RT_PRO_RX_PACKET_TYPE 0xFF871204 /* Q, S */ ++ ++#define OID_RT_PRO_READ_EFUSE 0xFF871205 /* Q */ ++#define OID_RT_PRO_WRITE_EFUSE 0xFF871206 /* S */ ++#define OID_RT_PRO_RW_EFUSE_PGPKT 0xFF871207 /* Q, S */ ++#define OID_RT_GET_EFUSE_CURRENT_SIZE 0xFF871208 /* Q */ ++ ++#define OID_RT_SET_BANDWIDTH 0xFF871209 /* S */ ++#define OID_RT_SET_CRYSTAL_CAP 0xFF87120A /* S */ ++ ++#define OID_RT_SET_RX_PACKET_TYPE 0xFF87120B /* S */ ++ ++#define OID_RT_GET_EFUSE_MAX_SIZE 0xFF87120C /* Q */ ++ ++#define OID_RT_PRO_SET_TX_AGC_OFFSET 0xFF87120D /* S */ ++ ++#define OID_RT_PRO_SET_PKT_TEST_MODE 0xFF87120E /* S */ ++ ++#define OID_RT_PRO_FOR_EVM_TEST_SETTING 0xFF87120F /* S */ ++ ++#define OID_RT_PRO_GET_THERMAL_METER 0xFF871210 /* Q */ ++ ++#define OID_RT_RESET_PHY_RX_PACKET_COUNT 0xFF871211 /* S */ ++#define OID_RT_GET_PHY_RX_PACKET_RECEIVED 0xFF871212 /* Q */ ++#define OID_RT_GET_PHY_RX_PACKET_CRC32_ERROR 0xFF871213 /* Q */ ++ ++#define OID_RT_SET_POWER_DOWN 0xFF871214 /* S */ ++ ++#define OID_RT_GET_POWER_MODE 0xFF871215 /* Q */ ++ ++#define OID_RT_PRO_EFUSE 0xFF871216 /* Q, S */ ++#define OID_RT_PRO_EFUSE_MAP 0xFF871217 /* Q, S */ ++ ++#endif /* #ifndef __CUSTOM_OID_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/nic_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/nic_spec.h +--- linux-4.14.18/3rdparty/rtl8723de/include/nic_spec.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/nic_spec.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,46 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ ++#ifndef __NIC_SPEC_H__ ++#define __NIC_SPEC_H__ ++ ++#include ++ ++#define RTL8711_MCTRL_ (0x20000) ++#define RTL8711_UART_ (0x30000) ++#define RTL8711_TIMER_ (0x40000) ++#define RTL8711_FINT_ (0x50000) ++#define RTL8711_HINT_ (0x50000) ++#define RTL8711_GPIO_ (0x60000) ++#define RTL8711_WLANCTRL_ (0x200000) ++#define RTL8711_WLANFF_ (0xe00000) ++#define RTL8711_HCICTRL_ (0x600000) ++#define RTL8711_SYSCFG_ (0x620000) ++#define RTL8711_SYSCTRL_ (0x620000) ++#define RTL8711_MCCTRL_ (0x020000) ++ ++ ++#include ++ ++#include ++ ++ ++#endif /* __RTL8711_SPEC_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/osdep_intf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_intf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/osdep_intf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_intf.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,171 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __OSDEP_INTF_H_ ++#define __OSDEP_INTF_H_ ++ ++ ++struct intf_priv { ++ ++ u8 *intf_dev; ++ u32 max_iosz; /* USB2.0: 128, USB1.1: 64, SDIO:64 */ ++ u32 max_xmitsz; /* USB2.0: unlimited, SDIO:512 */ ++ u32 max_recvsz; /* USB2.0: unlimited, SDIO:512 */ ++ ++ volatile u8 *io_rwmem; ++ volatile u8 *allocated_io_rwmem; ++ u32 io_wsz; /* unit: 4bytes */ ++ u32 io_rsz;/* unit: 4bytes */ ++ u8 intf_status; ++ ++ void (*_bus_io)(u8 *priv); ++ ++ /* ++ Under Sync. IRP (SDIO/USB) ++ A protection mechanism is necessary for the io_rwmem(read/write protocol) ++ ++ Under Async. IRP (SDIO/USB) ++ The protection mechanism is through the pending queue. ++ */ ++ ++ _mutex ioctl_mutex; ++ ++ ++#ifdef PLATFORM_LINUX ++#ifdef CONFIG_USB_HCI ++ /* when in USB, IO is through interrupt in/out endpoints */ ++ struct usb_device *udev; ++ PURB piorw_urb; ++ u8 io_irp_cnt; ++ u8 bio_irp_pending; ++ _sema io_retevt; ++ _timer io_timer; ++ u8 bio_irp_timeout; ++ u8 bio_timer_cancel; ++#endif ++#endif ++ ++#ifdef PLATFORM_OS_XP ++#ifdef CONFIG_SDIO_HCI ++ /* below is for io_rwmem... */ ++ PMDL pmdl; ++ PSDBUS_REQUEST_PACKET sdrp; ++ PSDBUS_REQUEST_PACKET recv_sdrp; ++ PSDBUS_REQUEST_PACKET xmit_sdrp; ++ ++ PIRP piorw_irp; ++ ++#endif ++#ifdef CONFIG_USB_HCI ++ PURB piorw_urb; ++ PIRP piorw_irp; ++ u8 io_irp_cnt; ++ u8 bio_irp_pending; ++ _sema io_retevt; ++#endif ++#endif ++ ++}; ++ ++ ++#ifdef CONFIG_R871X_TEST ++ int rtw_start_pseudo_adhoc(_adapter *padapter); ++ int rtw_stop_pseudo_adhoc(_adapter *padapter); ++#endif ++ ++struct dvobj_priv *devobj_init(void); ++void devobj_deinit(struct dvobj_priv *pdvobj); ++ ++u8 rtw_init_drv_sw(_adapter *padapter); ++u8 rtw_free_drv_sw(_adapter *padapter); ++u8 rtw_reset_drv_sw(_adapter *padapter); ++void rtw_dev_unload(PADAPTER padapter); ++ ++u32 rtw_start_drv_threads(_adapter *padapter); ++void rtw_stop_drv_threads(_adapter *padapter); ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++void rtw_cancel_dynamic_chk_timer(_adapter *padapter); ++#endif ++void rtw_cancel_all_timer(_adapter *padapter); ++ ++uint loadparam(_adapter *adapter); ++ ++#ifdef PLATFORM_LINUX ++int rtw_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); ++ ++int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname); ++struct net_device *rtw_init_netdev(_adapter *padapter); ++ ++void rtw_os_ndev_free(_adapter *adapter); ++int rtw_os_ndev_init(_adapter *adapter, const char *name); ++void rtw_os_ndev_deinit(_adapter *adapter); ++void rtw_os_ndev_unregister(_adapter *adapter); ++void rtw_os_ndevs_unregister(struct dvobj_priv *dvobj); ++int rtw_os_ndevs_init(struct dvobj_priv *dvobj); ++void rtw_os_ndevs_deinit(struct dvobj_priv *dvobj); ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++u16 rtw_recv_select_queue(struct sk_buff *skb); ++#endif /* LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35) */ ++ ++int rtw_ndev_notifier_register(void); ++void rtw_ndev_notifier_unregister(void); ++ ++#include "../os_dep/linux/rtw_proc.h" ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ #include "../os_dep/linux/ioctl_cfg80211.h" ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++u8 rtw_rtnl_lock_needed(struct dvobj_priv *dvobj); ++void rtw_set_rtnl_lock_holder(struct dvobj_priv *dvobj, _thread_hdl_ thd_hdl); ++ ++#endif /* PLATFORM_LINUX */ ++ ++ ++#ifdef PLATFORM_FREEBSD ++extern int rtw_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data); ++#endif ++ ++void rtw_ips_dev_unload(_adapter *padapter); ++ ++#ifdef CONFIG_IPS ++int rtw_ips_pwr_up(_adapter *padapter); ++void rtw_ips_pwr_down(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_CONCURRENT_MODE ++struct _io_ops; ++struct dvobj_priv; ++_adapter *rtw_drv_add_vir_if(_adapter *primary_padapter, void (*set_intf_ops)(_adapter *primary_padapter, struct _io_ops *pops)); ++void rtw_drv_stop_vir_ifaces(struct dvobj_priv *dvobj); ++void rtw_drv_free_vir_ifaces(struct dvobj_priv *dvobj); ++#endif ++ ++void rtw_ndev_destructor(_nic_hdl ndev); ++ ++#ifdef CONFIG_ARP_KEEP_ALIVE ++int rtw_gw_addr_query(_adapter *padapter); ++#endif ++ ++int rtw_suspend_common(_adapter *padapter); ++int rtw_resume_common(_adapter *padapter); ++ ++#endif /* _OSDEP_INTF_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_bsd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_bsd.h +--- linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_bsd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_bsd.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,745 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __OSDEP_BSD_SERVICE_H_ ++#define __OSDEP_BSD_SERVICE_H_ ++ ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++ ++#include ++#include ++#include ++#include ++#include ++ ++#include ++#include ++#include ++#include ++ ++#include ++#include ++#include "usbdevs.h" ++ ++#define USB_DEBUG_VAR rum_debug ++#include ++ ++#if 1 //Baron porting from linux, it's all temp solution, needs to check again ++#include ++#include /* XXX for PCPU_GET */ ++// typedef struct semaphore _sema; ++ typedef struct sema _sema; ++// typedef spinlock_t _lock; ++ typedef struct mtx _lock; ++ typedef struct mtx _mutex; ++ typedef struct timer_list _timer; ++ struct list_head { ++ struct list_head *next, *prev; ++ }; ++ struct __queue { ++ struct list_head queue; ++ _lock lock; ++ }; ++ ++ //typedef struct sk_buff _pkt; ++ typedef struct mbuf _pkt; ++ typedef struct mbuf _buffer; ++ ++ typedef struct __queue _queue; ++ typedef struct list_head _list; ++ typedef int _OS_STATUS; ++ //typedef u32 _irqL; ++ typedef unsigned long _irqL; ++ typedef struct ifnet * _nic_hdl; ++ ++ typedef pid_t _thread_hdl_; ++// typedef struct thread _thread_hdl_; ++ typedef void thread_return; ++ typedef void* thread_context; ++ ++ typedef void timer_hdl_return; ++ typedef void* timer_hdl_context; ++ typedef struct work_struct _workitem; ++ ++#define KERNEL_VERSION(a,b,c) (((a) << 16) + ((b) << 8) + (c)) ++/* emulate a modern version */ ++#define LINUX_VERSION_CODE KERNEL_VERSION(2, 6, 35) ++ ++#define WIRELESS_EXT -1 ++#define HZ hz ++#define spin_lock_irqsave mtx_lock_irqsave ++#define spin_lock_bh mtx_lock_irqsave ++#define mtx_lock_irqsave(lock, x) mtx_lock(lock)//{local_irq_save((x)); mtx_lock_spin((lock));} ++//#define IFT_RTW 0xf9 //ifnet allocate type for RTW ++#define free_netdev if_free ++#define LIST_CONTAINOR(ptr, type, member) \ ++ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) ++#define container_of(p,t,n) (t*)((p)-&(((t*)0)->n)) ++/* ++ * Linux timers are emulated using FreeBSD callout functions ++ * (and taskqueue functionality). ++ * ++ * Currently no timer stats functionality. ++ * ++ * See (linux_compat) processes.c ++ * ++ */ ++struct timer_list { ++ ++ /* FreeBSD callout related fields */ ++ struct callout callout; ++ ++ //timeout function ++ void (*function)(void*); ++ //argument ++ void *arg; ++ ++}; ++struct workqueue_struct; ++struct work_struct; ++typedef void (*work_func_t)(struct work_struct *work); ++/* Values for the state of an item of work (work_struct) */ ++typedef enum work_state { ++ WORK_STATE_UNSET = 0, ++ WORK_STATE_CALLOUT_PENDING = 1, ++ WORK_STATE_TASK_PENDING = 2, ++ WORK_STATE_WORK_CANCELLED = 3 ++} work_state_t; ++ ++struct work_struct { ++ struct task task; /* FreeBSD task */ ++ work_state_t state; /* the pending or otherwise state of work. */ ++ work_func_t func; ++}; ++#define spin_unlock_irqrestore mtx_unlock_irqrestore ++#define spin_unlock_bh mtx_unlock_irqrestore ++#define mtx_unlock_irqrestore(lock,x) mtx_unlock(lock); ++extern void _rtw_spinlock_init(_lock *plock); ++ ++//modify private structure to match freebsd ++#define BITS_PER_LONG 32 ++union ktime { ++ s64 tv64; ++#if BITS_PER_LONG != 64 && !defined(CONFIG_KTIME_SCALAR) ++ struct { ++#ifdef __BIG_ENDIAN ++ s32 sec, nsec; ++#else ++ s32 nsec, sec; ++#endif ++ } tv; ++#endif ++}; ++#define kmemcheck_bitfield_begin(name) ++#define kmemcheck_bitfield_end(name) ++#define CHECKSUM_NONE 0 ++typedef unsigned char *sk_buff_data_t; ++typedef union ktime ktime_t; /* Kill this */ ++ ++void rtw_mtx_lock(_lock *plock); ++ ++void rtw_mtx_unlock(_lock *plock); ++ ++/** ++ * struct sk_buff - socket buffer ++ * @next: Next buffer in list ++ * @prev: Previous buffer in list ++ * @sk: Socket we are owned by ++ * @tstamp: Time we arrived ++ * @dev: Device we arrived on/are leaving by ++ * @transport_header: Transport layer header ++ * @network_header: Network layer header ++ * @mac_header: Link layer header ++ * @_skb_refdst: destination entry (with norefcount bit) ++ * @sp: the security path, used for xfrm ++ * @cb: Control buffer. Free for use by every layer. Put private vars here ++ * @len: Length of actual data ++ * @data_len: Data length ++ * @mac_len: Length of link layer header ++ * @hdr_len: writable header length of cloned skb ++ * @csum: Checksum (must include start/offset pair) ++ * @csum_start: Offset from skb->head where checksumming should start ++ * @csum_offset: Offset from csum_start where checksum should be stored ++ * @local_df: allow local fragmentation ++ * @cloned: Head may be cloned (check refcnt to be sure) ++ * @nohdr: Payload reference only, must not modify header ++ * @pkt_type: Packet class ++ * @fclone: skbuff clone status ++ * @ip_summed: Driver fed us an IP checksum ++ * @priority: Packet queueing priority ++ * @users: User count - see {datagram,tcp}.c ++ * @protocol: Packet protocol from driver ++ * @truesize: Buffer size ++ * @head: Head of buffer ++ * @data: Data head pointer ++ * @tail: Tail pointer ++ * @end: End pointer ++ * @destructor: Destruct function ++ * @mark: Generic packet mark ++ * @nfct: Associated connection, if any ++ * @ipvs_property: skbuff is owned by ipvs ++ * @peeked: this packet has been seen already, so stats have been ++ * done for it, don't do them again ++ * @nf_trace: netfilter packet trace flag ++ * @nfctinfo: Relationship of this skb to the connection ++ * @nfct_reasm: netfilter conntrack re-assembly pointer ++ * @nf_bridge: Saved data about a bridged frame - see br_netfilter.c ++ * @skb_iif: ifindex of device we arrived on ++ * @rxhash: the packet hash computed on receive ++ * @queue_mapping: Queue mapping for multiqueue devices ++ * @tc_index: Traffic control index ++ * @tc_verd: traffic control verdict ++ * @ndisc_nodetype: router type (from link layer) ++ * @dma_cookie: a cookie to one of several possible DMA operations ++ * done by skb DMA functions ++ * @secmark: security marking ++ * @vlan_tci: vlan tag control information ++ */ ++ ++struct sk_buff { ++ /* These two members must be first. */ ++ struct sk_buff *next; ++ struct sk_buff *prev; ++ ++ ktime_t tstamp; ++ ++ struct sock *sk; ++ //struct net_device *dev; ++ struct ifnet *dev; ++ ++ /* ++ * This is the control buffer. It is free to use for every ++ * layer. Please put your private variables there. If you ++ * want to keep them across layers you have to do a skb_clone() ++ * first. This is owned by whoever has the skb queued ATM. ++ */ ++ char cb[48] __aligned(8); ++ ++ unsigned long _skb_refdst; ++#ifdef CONFIG_XFRM ++ struct sec_path *sp; ++#endif ++ unsigned int len, ++ data_len; ++ u16 mac_len, ++ hdr_len; ++ union { ++ u32 csum; ++ struct { ++ u16 csum_start; ++ u16 csum_offset; ++ }smbol2; ++ }smbol1; ++ u32 priority; ++ kmemcheck_bitfield_begin(flags1); ++ u8 local_df:1, ++ cloned:1, ++ ip_summed:2, ++ nohdr:1, ++ nfctinfo:3; ++ u8 pkt_type:3, ++ fclone:2, ++ ipvs_property:1, ++ peeked:1, ++ nf_trace:1; ++ kmemcheck_bitfield_end(flags1); ++ u16 protocol; ++ ++ void (*destructor)(struct sk_buff *skb); ++#if defined(CONFIG_NF_CONNTRACK) || defined(CONFIG_NF_CONNTRACK_MODULE) ++ struct nf_conntrack *nfct; ++ struct sk_buff *nfct_reasm; ++#endif ++#ifdef CONFIG_BRIDGE_NETFILTER ++ struct nf_bridge_info *nf_bridge; ++#endif ++ ++ int skb_iif; ++#ifdef CONFIG_NET_SCHED ++ u16 tc_index; /* traffic control index */ ++#ifdef CONFIG_NET_CLS_ACT ++ u16 tc_verd; /* traffic control verdict */ ++#endif ++#endif ++ ++ u32 rxhash; ++ ++ kmemcheck_bitfield_begin(flags2); ++ u16 queue_mapping:16; ++#ifdef CONFIG_IPV6_NDISC_NODETYPE ++ u8 ndisc_nodetype:2, ++ deliver_no_wcard:1; ++#else ++ u8 deliver_no_wcard:1; ++#endif ++ kmemcheck_bitfield_end(flags2); ++ ++ /* 0/14 bit hole */ ++ ++#ifdef CONFIG_NET_DMA ++ dma_cookie_t dma_cookie; ++#endif ++#ifdef CONFIG_NETWORK_SECMARK ++ u32 secmark; ++#endif ++ union { ++ u32 mark; ++ u32 dropcount; ++ }symbol3; ++ ++ u16 vlan_tci; ++ ++ sk_buff_data_t transport_header; ++ sk_buff_data_t network_header; ++ sk_buff_data_t mac_header; ++ /* These elements must be at the end, see alloc_skb() for details. */ ++ sk_buff_data_t tail; ++ sk_buff_data_t end; ++ unsigned char *head, ++ *data; ++ unsigned int truesize; ++ atomic_t users; ++}; ++struct sk_buff_head { ++ /* These two members must be first. */ ++ struct sk_buff *next; ++ struct sk_buff *prev; ++ ++ u32 qlen; ++ _lock lock; ++}; ++#define skb_tail_pointer(skb) skb->tail ++static inline unsigned char *skb_put(struct sk_buff *skb, unsigned int len) ++{ ++ unsigned char *tmp = skb_tail_pointer(skb); ++ //SKB_LINEAR_ASSERT(skb); ++ skb->tail += len; ++ skb->len += len; ++ return tmp; ++} ++ ++static inline unsigned char *__skb_pull(struct sk_buff *skb, unsigned int len) ++{ ++ skb->len -= len; ++ if(skb->len < skb->data_len) ++ printf("%s(),%d,error!\n",__FUNCTION__,__LINE__); ++ return skb->data += len; ++} ++static inline unsigned char *skb_pull(struct sk_buff *skb, unsigned int len) ++{ ++ #ifdef PLATFORM_FREEBSD ++ return __skb_pull(skb, len); ++ #else ++ return unlikely(len > skb->len) ? NULL : __skb_pull(skb, len); ++ #endif //PLATFORM_FREEBSD ++} ++static inline u32 skb_queue_len(const struct sk_buff_head *list_) ++{ ++ return list_->qlen; ++} ++static inline void __skb_insert(struct sk_buff *newsk, ++ struct sk_buff *prev, struct sk_buff *next, ++ struct sk_buff_head *list) ++{ ++ newsk->next = next; ++ newsk->prev = prev; ++ next->prev = prev->next = newsk; ++ list->qlen++; ++} ++static inline void __skb_queue_before(struct sk_buff_head *list, ++ struct sk_buff *next, ++ struct sk_buff *newsk) ++{ ++ __skb_insert(newsk, next->prev, next, list); ++} ++static inline void skb_queue_tail(struct sk_buff_head *list, ++ struct sk_buff *newsk) ++{ ++ mtx_lock(&list->lock); ++ __skb_queue_before(list, (struct sk_buff *)list, newsk); ++ mtx_unlock(&list->lock); ++} ++static inline struct sk_buff *skb_peek(struct sk_buff_head *list_) ++{ ++ struct sk_buff *list = ((struct sk_buff *)list_)->next; ++ if (list == (struct sk_buff *)list_) ++ list = NULL; ++ return list; ++} ++static inline void __skb_unlink(struct sk_buff *skb, struct sk_buff_head *list) ++{ ++ struct sk_buff *next, *prev; ++ ++ list->qlen--; ++ next = skb->next; ++ prev = skb->prev; ++ skb->next = skb->prev = NULL; ++ next->prev = prev; ++ prev->next = next; ++} ++ ++static inline struct sk_buff *skb_dequeue(struct sk_buff_head *list) ++{ ++ mtx_lock(&list->lock); ++ ++ struct sk_buff *skb = skb_peek(list); ++ if (skb) ++ __skb_unlink(skb, list); ++ ++ mtx_unlock(&list->lock); ++ ++ return skb; ++} ++static inline void skb_reserve(struct sk_buff *skb, int len) ++{ ++ skb->data += len; ++ skb->tail += len; ++} ++static inline void __skb_queue_head_init(struct sk_buff_head *list) ++{ ++ list->prev = list->next = (struct sk_buff *)list; ++ list->qlen = 0; ++} ++/* ++ * This function creates a split out lock class for each invocation; ++ * this is needed for now since a whole lot of users of the skb-queue ++ * infrastructure in drivers have different locking usage (in hardirq) ++ * than the networking core (in softirq only). In the long run either the ++ * network layer or drivers should need annotation to consolidate the ++ * main types of usage into 3 classes. ++ */ ++static inline void skb_queue_head_init(struct sk_buff_head *list) ++{ ++ _rtw_spinlock_init(&list->lock); ++ __skb_queue_head_init(list); ++} ++unsigned long copy_from_user(void *to, const void *from, unsigned long n); ++unsigned long copy_to_user(void *to, const void *from, unsigned long n); ++struct sk_buff * dev_alloc_skb(unsigned int size); ++struct sk_buff *skb_clone(const struct sk_buff *skb); ++void dev_kfree_skb_any(struct sk_buff *skb); ++#endif //Baron porting from linux, it's all temp solution, needs to check again ++ ++ ++#if 1 // kenny add Linux compatibility code for Linux USB driver ++#include ++ ++#define __init // __attribute ((constructor)) ++#define __exit // __attribute ((destructor)) ++ ++/* ++ * Definitions for module_init and module_exit macros. ++ * ++ * These macros will use the SYSINIT framework to call a specified ++ * function (with no arguments) on module loading or unloading. ++ * ++ */ ++ ++void module_init_exit_wrapper(void *arg); ++ ++#define module_init(initfn) \ ++ SYSINIT(mod_init_ ## initfn, \ ++ SI_SUB_KLD, SI_ORDER_FIRST, \ ++ module_init_exit_wrapper, initfn) ++ ++#define module_exit(exitfn) \ ++ SYSUNINIT(mod_exit_ ## exitfn, \ ++ SI_SUB_KLD, SI_ORDER_ANY, \ ++ module_init_exit_wrapper, exitfn) ++ ++/* ++ * The usb_register and usb_deregister functions are used to register ++ * usb drivers with the usb subsystem. ++ */ ++int usb_register(struct usb_driver *driver); ++int usb_deregister(struct usb_driver *driver); ++ ++/* ++ * usb_get_dev and usb_put_dev - increment/decrement the reference count ++ * of the usb device structure. ++ * ++ * Original body of usb_get_dev: ++ * ++ * if (dev) ++ * get_device(&dev->dev); ++ * return dev; ++ * ++ * Reference counts are not currently used in this compatibility ++ * layer. So these functions will do nothing. ++ */ ++static inline struct usb_device * ++usb_get_dev(struct usb_device *dev) ++{ ++ return dev; ++} ++ ++static inline void ++usb_put_dev(struct usb_device *dev) ++{ ++ return; ++} ++ ++ ++// rtw_usb_compat_linux ++int rtw_usb_submit_urb(struct urb *urb, uint16_t mem_flags); ++int rtw_usb_unlink_urb(struct urb *urb); ++int rtw_usb_clear_halt(struct usb_device *dev, struct usb_host_endpoint *uhe); ++int rtw_usb_control_msg(struct usb_device *dev, struct usb_host_endpoint *uhe, ++ uint8_t request, uint8_t requesttype, ++ uint16_t value, uint16_t index, void *data, ++ uint16_t size, usb_timeout_t timeout); ++int rtw_usb_set_interface(struct usb_device *dev, uint8_t iface_no, uint8_t alt_index); ++int rtw_usb_setup_endpoint(struct usb_device *dev, ++ struct usb_host_endpoint *uhe, usb_size_t bufsize); ++struct urb *rtw_usb_alloc_urb(uint16_t iso_packets, uint16_t mem_flags); ++struct usb_host_endpoint *rtw_usb_find_host_endpoint(struct usb_device *dev, uint8_t type, uint8_t ep); ++struct usb_host_interface *rtw_usb_altnum_to_altsetting(const struct usb_interface *intf, uint8_t alt_index); ++struct usb_interface *rtw_usb_ifnum_to_if(struct usb_device *dev, uint8_t iface_no); ++void *rtw_usbd_get_intfdata(struct usb_interface *intf); ++void rtw_usb_linux_register(void *arg); ++void rtw_usb_linux_deregister(void *arg); ++void rtw_usb_linux_free_device(struct usb_device *dev); ++void rtw_usb_free_urb(struct urb *urb); ++void rtw_usb_init_urb(struct urb *urb); ++void rtw_usb_kill_urb(struct urb *urb); ++void rtw_usb_set_intfdata(struct usb_interface *intf, void *data); ++void rtw_usb_fill_bulk_urb(struct urb *urb, struct usb_device *udev, ++ struct usb_host_endpoint *uhe, void *buf, ++ int length, usb_complete_t callback, void *arg); ++int rtw_usb_bulk_msg(struct usb_device *udev, struct usb_host_endpoint *uhe, ++ void *data, int len, uint16_t *pactlen, usb_timeout_t timeout); ++void *usb_get_intfdata(struct usb_interface *intf); ++int usb_linux_init_endpoints(struct usb_device *udev); ++ ++ ++ ++typedef struct urb * PURB; ++ ++typedef unsigned gfp_t; ++#define __GFP_WAIT ((gfp_t)0x10u) /* Can wait and reschedule? */ ++#define __GFP_HIGH ((gfp_t)0x20u) /* Should access emergency pools? */ ++#define __GFP_IO ((gfp_t)0x40u) /* Can start physical IO? */ ++#define __GFP_FS ((gfp_t)0x80u) /* Can call down to low-level FS? */ ++#define __GFP_COLD ((gfp_t)0x100u) /* Cache-cold page required */ ++#define __GFP_NOWARN ((gfp_t)0x200u) /* Suppress page allocation failure warning */ ++#define __GFP_REPEAT ((gfp_t)0x400u) /* Retry the allocation. Might fail */ ++#define __GFP_NOFAIL ((gfp_t)0x800u) /* Retry for ever. Cannot fail */ ++#define __GFP_NORETRY ((gfp_t)0x1000u)/* Do not retry. Might fail */ ++#define __GFP_NO_GROW ((gfp_t)0x2000u)/* Slab internal usage */ ++#define __GFP_COMP ((gfp_t)0x4000u)/* Add compound page metadata */ ++#define __GFP_ZERO ((gfp_t)0x8000u)/* Return zeroed page on success */ ++#define __GFP_NOMEMALLOC ((gfp_t)0x10000u) /* Don't use emergency reserves */ ++#define __GFP_HARDWALL ((gfp_t)0x20000u) /* Enforce hardwall cpuset memory allocs */ ++ ++/* This equals 0, but use constants in case they ever change */ ++#define GFP_NOWAIT (GFP_ATOMIC & ~__GFP_HIGH) ++/* GFP_ATOMIC means both !wait (__GFP_WAIT not set) and use emergency pool */ ++#define GFP_ATOMIC (__GFP_HIGH) ++#define GFP_NOIO (__GFP_WAIT) ++#define GFP_NOFS (__GFP_WAIT | __GFP_IO) ++#define GFP_KERNEL (__GFP_WAIT | __GFP_IO | __GFP_FS) ++#define GFP_USER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL) ++#define GFP_HIGHUSER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL | \ ++ __GFP_HIGHMEM) ++ ++ ++#endif // kenny add Linux compatibility code for Linux USB ++ ++__inline static _list *get_next(_list *list) ++{ ++ return list->next; ++} ++ ++__inline static _list *get_list_head(_queue *queue) ++{ ++ return (&(queue->queue)); ++} ++ ++ ++#define LIST_CONTAINOR(ptr, type, member) \ ++ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) ++ ++ ++__inline static void _enter_critical(_lock *plock, _irqL *pirqL) ++{ ++ spin_lock_irqsave(plock, *pirqL); ++} ++ ++__inline static void _exit_critical(_lock *plock, _irqL *pirqL) ++{ ++ spin_unlock_irqrestore(plock, *pirqL); ++} ++ ++__inline static void _enter_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ spin_lock_irqsave(plock, *pirqL); ++} ++ ++__inline static void _exit_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ spin_unlock_irqrestore(plock, *pirqL); ++} ++ ++__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) ++{ ++ spin_lock_bh(plock, *pirqL); ++} ++ ++__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) ++{ ++ spin_unlock_bh(plock, *pirqL); ++} ++ ++__inline static void _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) ++{ ++ ++ mtx_lock(pmutex); ++ ++} ++ ++ ++__inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) ++{ ++ ++ mtx_unlock(pmutex); ++ ++} ++static inline void __list_del(struct list_head * prev, struct list_head * next) ++{ ++ next->prev = prev; ++ prev->next = next; ++} ++static inline void INIT_LIST_HEAD(struct list_head *list) ++{ ++ list->next = list; ++ list->prev = list; ++} ++__inline static void rtw_list_delete(_list *plist) ++{ ++ __list_del(plist->prev, plist->next); ++ INIT_LIST_HEAD(plist); ++} ++ ++__inline static void _init_timer(_timer *ptimer,_nic_hdl padapter,void *pfunc,void* cntx) ++{ ++ ptimer->function = pfunc; ++ ptimer->arg = cntx; ++ callout_init(&ptimer->callout, CALLOUT_MPSAFE); ++} ++ ++__inline static void _set_timer(_timer *ptimer,u32 delay_time) ++{ ++ // mod_timer(ptimer , (jiffies+(delay_time*HZ/1000))); ++ if(ptimer->function && ptimer->arg){ ++ rtw_mtx_lock(NULL); ++ callout_reset(&ptimer->callout, delay_time,ptimer->function, ptimer->arg); ++ rtw_mtx_unlock(NULL); ++ } ++} ++ ++__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) ++{ ++ // del_timer_sync(ptimer); ++ // *bcancelled= _TRUE;//TRUE ==1; FALSE==0 ++ rtw_mtx_lock(NULL); ++ callout_drain(&ptimer->callout); ++ rtw_mtx_unlock(NULL); ++} ++ ++__inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) ++{ ++ printf("%s Not implement yet! \n",__FUNCTION__); ++} ++ ++__inline static void _set_workitem(_workitem *pwork) ++{ ++ printf("%s Not implement yet! \n",__FUNCTION__); ++// schedule_work(pwork); ++} ++ ++// ++// Global Mutex: can only be used at PASSIVE level. ++// ++ ++#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ ++{ \ ++} ++ ++#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ ++{ \ ++} ++ ++#define ATOMIC_INIT(i) { (i) } ++ ++static __inline void thread_enter(char *name); ++ ++//Atomic integer operations ++typedef uint32_t ATOMIC_T ; ++ ++#define rtw_netdev_priv(netdev) (((struct ifnet *)netdev)->if_softc) ++ ++#define rtw_free_netdev(netdev) if_free((netdev)) ++ ++#define NDEV_FMT "%s" ++#define NDEV_ARG(ndev) "" ++#define ADPT_FMT "%s" ++#define ADPT_ARG(adapter) "" ++#define FUNC_NDEV_FMT "%s" ++#define FUNC_NDEV_ARG(ndev) __func__ ++#define FUNC_ADPT_FMT "%s" ++#define FUNC_ADPT_ARG(adapter) __func__ ++ ++#define STRUCT_PACKED ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_ce.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_ce.h +--- linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_ce.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_ce.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,191 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __OSDEP_CE_SERVICE_H_ ++#define __OSDEP_CE_SERVICE_H_ ++ ++ ++#include ++#include ++ ++#ifdef CONFIG_SDIO_HCI ++#include "SDCardDDK.h" ++#endif ++ ++#ifdef CONFIG_USB_HCI ++#include ++#endif ++ ++typedef HANDLE _sema; ++typedef LIST_ENTRY _list; ++typedef NDIS_STATUS _OS_STATUS; ++ ++typedef NDIS_SPIN_LOCK _lock; ++ ++typedef HANDLE _rwlock; //Mutex ++ ++typedef u32 _irqL; ++ ++typedef NDIS_HANDLE _nic_hdl; ++ ++ ++typedef NDIS_MINIPORT_TIMER _timer; ++ ++struct __queue { ++ LIST_ENTRY queue; ++ _lock lock; ++}; ++ ++typedef NDIS_PACKET _pkt; ++typedef NDIS_BUFFER _buffer; ++typedef struct __queue _queue; ++ ++typedef HANDLE _thread_hdl_; ++typedef DWORD thread_return; ++typedef void* thread_context; ++typedef NDIS_WORK_ITEM _workitem; ++ ++ ++ ++#define SEMA_UPBND (0x7FFFFFFF) //8192 ++ ++__inline static _list *get_prev(_list *list) ++{ ++ return list->Blink; ++} ++ ++__inline static _list *get_next(_list *list) ++{ ++ return list->Flink; ++} ++ ++__inline static _list *get_list_head(_queue *queue) ++{ ++ return (&(queue->queue)); ++} ++ ++#define LIST_CONTAINOR(ptr, type, member) CONTAINING_RECORD(ptr, type, member) ++ ++__inline static void _enter_critical(_lock *plock, _irqL *pirqL) ++{ ++ NdisAcquireSpinLock(plock); ++} ++ ++__inline static void _exit_critical(_lock *plock, _irqL *pirqL) ++{ ++ NdisReleaseSpinLock(plock); ++} ++ ++__inline static _enter_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ NdisDprAcquireSpinLock(plock); ++} ++ ++__inline static _exit_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ NdisDprReleaseSpinLock(plock); ++} ++ ++ ++__inline static void _enter_hwio_critical(_rwlock *prwlock, _irqL *pirqL) ++{ ++ WaitForSingleObject(*prwlock, INFINITE ); ++ ++} ++ ++__inline static void _exit_hwio_critical(_rwlock *prwlock, _irqL *pirqL) ++{ ++ ReleaseMutex(*prwlock); ++} ++ ++__inline static void rtw_list_delete(_list *plist) ++{ ++ RemoveEntryList(plist); ++ InitializeListHead(plist); ++} ++ ++#define RTW_TIMER_HDL_ARGS IN PVOID SystemSpecific1, IN PVOID FunctionContext, IN PVOID SystemSpecific2, IN PVOID SystemSpecific3 ++ ++__inline static void _init_timer(_timer *ptimer,_nic_hdl nic_hdl,void *pfunc,PVOID cntx) ++{ ++ NdisMInitializeTimer(ptimer, nic_hdl, pfunc, cntx); ++} ++ ++__inline static void _set_timer(_timer *ptimer,u32 delay_time) ++{ ++ NdisMSetTimer(ptimer,delay_time); ++} ++ ++__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) ++{ ++ NdisMCancelTimer(ptimer,bcancelled); ++} ++ ++__inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) ++{ ++ ++ NdisInitializeWorkItem(pwork, pfunc, cntx); ++} ++ ++__inline static void _set_workitem(_workitem *pwork) ++{ ++ NdisScheduleWorkItem(pwork); ++} ++ ++#define ATOMIC_INIT(i) { (i) } ++ ++// ++// Global Mutex: can only be used at PASSIVE level. ++// ++ ++#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ ++{ \ ++ while (NdisInterlockedIncrement((PULONG)&(_MutexCounter)) != 1)\ ++ { \ ++ NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ ++ NdisMSleep(10000); \ ++ } \ ++} ++ ++#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ ++{ \ ++ NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ ++} ++ ++// limitation of path length ++#define PATH_LENGTH_MAX MAX_PATH ++ ++//Atomic integer operations ++#define ATOMIC_T LONG ++ ++#define NDEV_FMT "%s" ++#define NDEV_ARG(ndev) "" ++#define ADPT_FMT "%s" ++#define ADPT_ARG(adapter) "" ++#define FUNC_NDEV_FMT "%s" ++#define FUNC_NDEV_ARG(ndev) __func__ ++#define FUNC_ADPT_FMT "%s" ++#define FUNC_ADPT_ARG(adapter) __func__ ++ ++#define STRUCT_PACKED ++ ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/osdep_service.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service.h +--- linux-4.14.18/3rdparty/rtl8723de/include/osdep_service.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,707 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __OSDEP_SERVICE_H_ ++#define __OSDEP_SERVICE_H_ ++ ++ ++#define _FAIL 0 ++#define _SUCCESS 1 ++#define RTW_RX_HANDLED 2 ++/* #define RTW_STATUS_TIMEDOUT -110 */ ++ ++#undef _TRUE ++#define _TRUE 1 ++ ++#undef _FALSE ++#define _FALSE 0 ++ ++ ++#ifdef PLATFORM_FREEBSD ++ #include ++#endif ++ ++#ifdef PLATFORM_LINUX ++ #include ++ #include ++#endif ++ ++#ifdef PLATFORM_OS_XP ++ #include ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ #include ++#endif ++ ++#define RTW_TIMER_HDL_NAME(name) rtw_##name##_timer_hdl ++#define RTW_DECLARE_TIMER_HDL(name) void RTW_TIMER_HDL_NAME(name)(RTW_TIMER_HDL_ARGS) ++ ++/* #include */ ++ ++#ifndef BIT ++ #define BIT(x) (1 << (x)) ++#endif ++ ++#define BIT0 0x00000001 ++#define BIT1 0x00000002 ++#define BIT2 0x00000004 ++#define BIT3 0x00000008 ++#define BIT4 0x00000010 ++#define BIT5 0x00000020 ++#define BIT6 0x00000040 ++#define BIT7 0x00000080 ++#define BIT8 0x00000100 ++#define BIT9 0x00000200 ++#define BIT10 0x00000400 ++#define BIT11 0x00000800 ++#define BIT12 0x00001000 ++#define BIT13 0x00002000 ++#define BIT14 0x00004000 ++#define BIT15 0x00008000 ++#define BIT16 0x00010000 ++#define BIT17 0x00020000 ++#define BIT18 0x00040000 ++#define BIT19 0x00080000 ++#define BIT20 0x00100000 ++#define BIT21 0x00200000 ++#define BIT22 0x00400000 ++#define BIT23 0x00800000 ++#define BIT24 0x01000000 ++#define BIT25 0x02000000 ++#define BIT26 0x04000000 ++#define BIT27 0x08000000 ++#define BIT28 0x10000000 ++#define BIT29 0x20000000 ++#define BIT30 0x40000000 ++#define BIT31 0x80000000 ++#define BIT32 0x0100000000 ++#define BIT33 0x0200000000 ++#define BIT34 0x0400000000 ++#define BIT35 0x0800000000 ++#define BIT36 0x1000000000 ++ ++extern int RTW_STATUS_CODE(int error_code); ++ ++#ifndef RTK_DMP_PLATFORM ++ #define CONFIG_USE_VMALLOC ++#endif ++ ++/* flags used for rtw_mstat_update() */ ++enum mstat_f { ++ /* type: 0x00ff */ ++ MSTAT_TYPE_VIR = 0x00, ++ MSTAT_TYPE_PHY = 0x01, ++ MSTAT_TYPE_SKB = 0x02, ++ MSTAT_TYPE_USB = 0x03, ++ MSTAT_TYPE_MAX = 0x04, ++ ++ /* func: 0xff00 */ ++ MSTAT_FUNC_UNSPECIFIED = 0x00 << 8, ++ MSTAT_FUNC_IO = 0x01 << 8, ++ MSTAT_FUNC_TX_IO = 0x02 << 8, ++ MSTAT_FUNC_RX_IO = 0x03 << 8, ++ MSTAT_FUNC_TX = 0x04 << 8, ++ MSTAT_FUNC_RX = 0x05 << 8, ++ MSTAT_FUNC_CFG_VENDOR = 0x06 << 8, ++ MSTAT_FUNC_MAX = 0x07 << 8, ++}; ++ ++#define mstat_tf_idx(flags) ((flags) & 0xff) ++#define mstat_ff_idx(flags) (((flags) & 0xff00) >> 8) ++ ++typedef enum mstat_status { ++ MSTAT_ALLOC_SUCCESS = 0, ++ MSTAT_ALLOC_FAIL, ++ MSTAT_FREE ++} MSTAT_STATUS; ++ ++#ifdef DBG_MEM_ALLOC ++void rtw_mstat_update(const enum mstat_f flags, const MSTAT_STATUS status, u32 sz); ++void rtw_mstat_dump(void *sel); ++u8 *dbg_rtw_vmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); ++u8 *dbg_rtw_zvmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); ++void dbg_rtw_vmfree(u8 *pbuf, const enum mstat_f flags, u32 sz, const char *func, const int line); ++u8 *dbg_rtw_malloc(u32 sz, const enum mstat_f flags, const char *func, const int line); ++u8 *dbg_rtw_zmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); ++void dbg_rtw_mfree(u8 *pbuf, const enum mstat_f flags, u32 sz, const char *func, const int line); ++ ++struct sk_buff *dbg_rtw_skb_alloc(unsigned int size, const enum mstat_f flags, const char *func, const int line); ++void dbg_rtw_skb_free(struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line); ++struct sk_buff *dbg_rtw_skb_copy(const struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line); ++struct sk_buff *dbg_rtw_skb_clone(struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line); ++int dbg_rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line); ++#ifdef CONFIG_RTW_NAPI ++int dbg_rtw_netif_receive_skb(_nic_hdl ndev, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line); ++#ifdef CONFIG_RTW_GRO ++gro_result_t dbg_rtw_napi_gro_receive(struct napi_struct *napi, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line); ++#endif ++#endif /* CONFIG_RTW_NAPI */ ++void dbg_rtw_skb_queue_purge(struct sk_buff_head *list, enum mstat_f flags, const char *func, int line); ++#ifdef CONFIG_USB_HCI ++void *dbg_rtw_usb_buffer_alloc(struct usb_device *dev, size_t size, dma_addr_t *dma, const enum mstat_f flags, const char *func, const int line); ++void dbg_rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dma_addr_t dma, const enum mstat_f flags, const char *func, const int line); ++#endif /* CONFIG_USB_HCI */ ++ ++#ifdef CONFIG_USE_VMALLOC ++#define rtw_vmalloc(sz) dbg_rtw_vmalloc((sz), MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) ++#define rtw_zvmalloc(sz) dbg_rtw_zvmalloc((sz), MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) ++#define rtw_vmfree(pbuf, sz) dbg_rtw_vmfree((pbuf), (sz), MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) ++#define rtw_vmalloc_f(sz, mstat_f) dbg_rtw_vmalloc((sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) ++#define rtw_zvmalloc_f(sz, mstat_f) dbg_rtw_zvmalloc((sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) ++#define rtw_vmfree_f(pbuf, sz, mstat_f) dbg_rtw_vmfree((pbuf), (sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) ++#else /* CONFIG_USE_VMALLOC */ ++#define rtw_vmalloc(sz) dbg_rtw_malloc((sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) ++#define rtw_zvmalloc(sz) dbg_rtw_zmalloc((sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) ++#define rtw_vmfree(pbuf, sz) dbg_rtw_mfree((pbuf), (sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) ++#define rtw_vmalloc_f(sz, mstat_f) dbg_rtw_malloc((sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) ++#define rtw_zvmalloc_f(sz, mstat_f) dbg_rtw_zmalloc((sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) ++#define rtw_vmfree_f(pbuf, sz, mstat_f) dbg_rtw_mfree((pbuf), (sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) ++#endif /* CONFIG_USE_VMALLOC */ ++#define rtw_malloc(sz) dbg_rtw_malloc((sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) ++#define rtw_zmalloc(sz) dbg_rtw_zmalloc((sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) ++#define rtw_mfree(pbuf, sz) dbg_rtw_mfree((pbuf), (sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) ++#define rtw_malloc_f(sz, mstat_f) dbg_rtw_malloc((sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) ++#define rtw_zmalloc_f(sz, mstat_f) dbg_rtw_zmalloc((sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) ++#define rtw_mfree_f(pbuf, sz, mstat_f) dbg_rtw_mfree((pbuf), (sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) ++ ++#define rtw_skb_alloc(size) dbg_rtw_skb_alloc((size), MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++#define rtw_skb_free(skb) dbg_rtw_skb_free((skb), MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++#define rtw_skb_alloc_f(size, mstat_f) dbg_rtw_skb_alloc((size), ((mstat_f) & 0xff00) | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++#define rtw_skb_free_f(skb, mstat_f) dbg_rtw_skb_free((skb), ((mstat_f) & 0xff00) | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++#define rtw_skb_copy(skb) dbg_rtw_skb_copy((skb), MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++#define rtw_skb_clone(skb) dbg_rtw_skb_clone((skb), MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++#define rtw_skb_copy_f(skb, mstat_f) dbg_rtw_skb_copy((skb), ((mstat_f) & 0xff00) | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++#define rtw_skb_clone_f(skb, mstat_f) dbg_rtw_skb_clone((skb), ((mstat_f) & 0xff00) | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++#define rtw_netif_rx(ndev, skb) dbg_rtw_netif_rx(ndev, skb, MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++#ifdef CONFIG_RTW_NAPI ++#define rtw_netif_receive_skb(ndev, skb) dbg_rtw_netif_receive_skb(ndev, skb, MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++#ifdef CONFIG_RTW_GRO ++#define rtw_napi_gro_receive(napi, skb) dbg_rtw_napi_gro_receive(napi, skb, MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++#endif ++#endif /* CONFIG_RTW_NAPI */ ++#define rtw_skb_queue_purge(sk_buff_head) dbg_rtw_skb_queue_purge(sk_buff_head, MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++#ifdef CONFIG_USB_HCI ++#define rtw_usb_buffer_alloc(dev, size, dma) dbg_rtw_usb_buffer_alloc((dev), (size), (dma), MSTAT_TYPE_USB, __FUNCTION__, __LINE__) ++#define rtw_usb_buffer_free(dev, size, addr, dma) dbg_rtw_usb_buffer_free((dev), (size), (addr), (dma), MSTAT_TYPE_USB, __FUNCTION__, __LINE__) ++#define rtw_usb_buffer_alloc_f(dev, size, dma, mstat_f) dbg_rtw_usb_buffer_alloc((dev), (size), (dma), ((mstat_f) & 0xff00) | MSTAT_TYPE_USB, __FUNCTION__, __LINE__) ++#define rtw_usb_buffer_free_f(dev, size, addr, dma, mstat_f) dbg_rtw_usb_buffer_free((dev), (size), (addr), (dma), ((mstat_f) & 0xff00) | MSTAT_TYPE_USB, __FUNCTION__, __LINE__) ++#endif /* CONFIG_USB_HCI */ ++ ++#else /* DBG_MEM_ALLOC */ ++#define rtw_mstat_update(flag, status, sz) do {} while (0) ++#define rtw_mstat_dump(sel) do {} while (0) ++u8 *_rtw_vmalloc(u32 sz); ++u8 *_rtw_zvmalloc(u32 sz); ++void _rtw_vmfree(u8 *pbuf, u32 sz); ++u8 *_rtw_zmalloc(u32 sz); ++u8 *_rtw_malloc(u32 sz); ++void _rtw_mfree(u8 *pbuf, u32 sz); ++ ++struct sk_buff *_rtw_skb_alloc(u32 sz); ++void _rtw_skb_free(struct sk_buff *skb); ++struct sk_buff *_rtw_skb_copy(const struct sk_buff *skb); ++struct sk_buff *_rtw_skb_clone(struct sk_buff *skb); ++int _rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb); ++#ifdef CONFIG_RTW_NAPI ++int _rtw_netif_receive_skb(_nic_hdl ndev, struct sk_buff *skb); ++#ifdef CONFIG_RTW_GRO ++gro_result_t _rtw_napi_gro_receive(struct napi_struct *napi, struct sk_buff *skb); ++#endif ++#endif /* CONFIG_RTW_NAPI */ ++void _rtw_skb_queue_purge(struct sk_buff_head *list); ++ ++#ifdef CONFIG_USB_HCI ++void *_rtw_usb_buffer_alloc(struct usb_device *dev, size_t size, dma_addr_t *dma); ++void _rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dma_addr_t dma); ++#endif /* CONFIG_USB_HCI */ ++ ++#ifdef CONFIG_USE_VMALLOC ++#define rtw_vmalloc(sz) _rtw_vmalloc((sz)) ++#define rtw_zvmalloc(sz) _rtw_zvmalloc((sz)) ++#define rtw_vmfree(pbuf, sz) _rtw_vmfree((pbuf), (sz)) ++#define rtw_vmalloc_f(sz, mstat_f) _rtw_vmalloc((sz)) ++#define rtw_zvmalloc_f(sz, mstat_f) _rtw_zvmalloc((sz)) ++#define rtw_vmfree_f(pbuf, sz, mstat_f) _rtw_vmfree((pbuf), (sz)) ++#else /* CONFIG_USE_VMALLOC */ ++#define rtw_vmalloc(sz) _rtw_malloc((sz)) ++#define rtw_zvmalloc(sz) _rtw_zmalloc((sz)) ++#define rtw_vmfree(pbuf, sz) _rtw_mfree((pbuf), (sz)) ++#define rtw_vmalloc_f(sz, mstat_f) _rtw_malloc((sz)) ++#define rtw_zvmalloc_f(sz, mstat_f) _rtw_zmalloc((sz)) ++#define rtw_vmfree_f(pbuf, sz, mstat_f) _rtw_mfree((pbuf), (sz)) ++#endif /* CONFIG_USE_VMALLOC */ ++#define rtw_malloc(sz) _rtw_malloc((sz)) ++#define rtw_zmalloc(sz) _rtw_zmalloc((sz)) ++#define rtw_mfree(pbuf, sz) _rtw_mfree((pbuf), (sz)) ++#define rtw_malloc_f(sz, mstat_f) _rtw_malloc((sz)) ++#define rtw_zmalloc_f(sz, mstat_f) _rtw_zmalloc((sz)) ++#define rtw_mfree_f(pbuf, sz, mstat_f) _rtw_mfree((pbuf), (sz)) ++ ++#define rtw_skb_alloc(size) _rtw_skb_alloc((size)) ++#define rtw_skb_free(skb) _rtw_skb_free((skb)) ++#define rtw_skb_alloc_f(size, mstat_f) _rtw_skb_alloc((size)) ++#define rtw_skb_free_f(skb, mstat_f) _rtw_skb_free((skb)) ++#define rtw_skb_copy(skb) _rtw_skb_copy((skb)) ++#define rtw_skb_clone(skb) _rtw_skb_clone((skb)) ++#define rtw_skb_copy_f(skb, mstat_f) _rtw_skb_copy((skb)) ++#define rtw_skb_clone_f(skb, mstat_f) _rtw_skb_clone((skb)) ++#define rtw_netif_rx(ndev, skb) _rtw_netif_rx(ndev, skb) ++#ifdef CONFIG_RTW_NAPI ++#define rtw_netif_receive_skb(ndev, skb) _rtw_netif_receive_skb(ndev, skb) ++#ifdef CONFIG_RTW_GRO ++#define rtw_napi_gro_receive(napi, skb) _rtw_napi_gro_receive(napi, skb) ++#endif ++#endif /* CONFIG_RTW_NAPI */ ++#define rtw_skb_queue_purge(sk_buff_head) _rtw_skb_queue_purge(sk_buff_head) ++#ifdef CONFIG_USB_HCI ++#define rtw_usb_buffer_alloc(dev, size, dma) _rtw_usb_buffer_alloc((dev), (size), (dma)) ++#define rtw_usb_buffer_free(dev, size, addr, dma) _rtw_usb_buffer_free((dev), (size), (addr), (dma)) ++#define rtw_usb_buffer_alloc_f(dev, size, dma, mstat_f) _rtw_usb_buffer_alloc((dev), (size), (dma)) ++#define rtw_usb_buffer_free_f(dev, size, addr, dma, mstat_f) _rtw_usb_buffer_free((dev), (size), (addr), (dma)) ++#endif /* CONFIG_USB_HCI */ ++#endif /* DBG_MEM_ALLOC */ ++ ++extern void *rtw_malloc2d(int h, int w, size_t size); ++extern void rtw_mfree2d(void *pbuf, int h, int w, int size); ++ ++extern void _rtw_memcpy(void *dec, const void *sour, u32 sz); ++extern void _rtw_memmove(void *dst, const void *src, u32 sz); ++extern int _rtw_memcmp(const void *dst, const void *src, u32 sz); ++extern void _rtw_memset(void *pbuf, int c, u32 sz); ++ ++extern void _rtw_init_listhead(_list *list); ++extern u32 rtw_is_list_empty(_list *phead); ++extern void rtw_list_insert_head(_list *plist, _list *phead); ++extern void rtw_list_insert_tail(_list *plist, _list *phead); ++#ifndef PLATFORM_FREEBSD ++extern void rtw_list_delete(_list *plist); ++#endif /* PLATFORM_FREEBSD */ ++ ++extern void _rtw_init_sema(_sema *sema, int init_val); ++extern void _rtw_free_sema(_sema *sema); ++extern void _rtw_up_sema(_sema *sema); ++extern u32 _rtw_down_sema(_sema *sema); ++extern void _rtw_mutex_init(_mutex *pmutex); ++extern void _rtw_mutex_free(_mutex *pmutex); ++#ifndef PLATFORM_FREEBSD ++extern void _rtw_spinlock_init(_lock *plock); ++#endif /* PLATFORM_FREEBSD */ ++extern void _rtw_spinlock_free(_lock *plock); ++extern void _rtw_spinlock(_lock *plock); ++extern void _rtw_spinunlock(_lock *plock); ++extern void _rtw_spinlock_ex(_lock *plock); ++extern void _rtw_spinunlock_ex(_lock *plock); ++ ++extern void _rtw_init_queue(_queue *pqueue); ++extern void _rtw_deinit_queue(_queue *pqueue); ++extern u32 _rtw_queue_empty(_queue *pqueue); ++extern u32 rtw_end_of_queue_search(_list *queue, _list *pelement); ++ ++extern u32 rtw_get_current_time(void); ++extern u32 rtw_systime_to_ms(u32 systime); ++extern u32 rtw_ms_to_systime(u32 ms); ++extern s32 rtw_get_passing_time_ms(u32 start); ++extern s32 rtw_get_time_interval_ms(u32 start, u32 end); ++ ++extern void rtw_sleep_schedulable(int ms); ++ ++extern void rtw_msleep_os(int ms); ++extern void rtw_usleep_os(int us); ++ ++extern u32 rtw_atoi(u8 *s); ++ ++#ifdef DBG_DELAY_OS ++#define rtw_mdelay_os(ms) _rtw_mdelay_os((ms), __FUNCTION__, __LINE__) ++#define rtw_udelay_os(ms) _rtw_udelay_os((ms), __FUNCTION__, __LINE__) ++extern void _rtw_mdelay_os(int ms, const char *func, const int line); ++extern void _rtw_udelay_os(int us, const char *func, const int line); ++#else ++extern void rtw_mdelay_os(int ms); ++extern void rtw_udelay_os(int us); ++#endif ++ ++extern void rtw_yield_os(void); ++ ++ ++extern void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc); ++ ++ ++__inline static unsigned char _cancel_timer_ex(_timer *ptimer) ++{ ++#ifdef PLATFORM_LINUX ++ return del_timer_sync(ptimer); ++#endif ++#ifdef PLATFORM_FREEBSD ++ _cancel_timer(ptimer, 0); ++ return 0; ++#endif ++#ifdef PLATFORM_WINDOWS ++ u8 bcancelled; ++ ++ _cancel_timer(ptimer, &bcancelled); ++ ++ return bcancelled; ++#endif ++} ++ ++static __inline void thread_enter(char *name) ++{ ++#ifdef PLATFORM_LINUX ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) ++ daemonize("%s", name); ++#endif ++ allow_signal(SIGTERM); ++#endif ++#ifdef PLATFORM_FREEBSD ++ printf("%s", "RTKTHREAD_enter"); ++#endif ++} ++void thread_exit(_completion *comp); ++void _rtw_init_completion(_completion *comp); ++void _rtw_wait_for_comp_timeout(_completion *comp); ++void _rtw_wait_for_comp(_completion *comp); ++#if 1 ++#define rtw_wait_for_thread_stop(_comp) _rtw_wait_for_comp_timeout(_comp) ++#else ++#define rtw_wait_for_thread_stop(_comp) _rtw_wait_for_comp(_comp) ++#endif ++ ++bool rtw_thread_stop(_thread_hdl_ th); ++bool rtw_thread_should_stop(void); ++ ++__inline static void flush_signals_thread(void) ++{ ++#ifdef PLATFORM_LINUX ++ if (signal_pending(current)) ++ flush_signals(current); ++#endif ++} ++ ++__inline static _OS_STATUS res_to_status(sint res) ++{ ++ ++#if defined(PLATFORM_LINUX) || defined (PLATFORM_MPIXEL) || defined (PLATFORM_FREEBSD) ++ return res; ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ ++ if (res == _SUCCESS) ++ return NDIS_STATUS_SUCCESS; ++ else ++ return NDIS_STATUS_FAILURE; ++ ++#endif ++ ++} ++ ++__inline static void rtw_dump_stack(void) ++{ ++#ifdef PLATFORM_LINUX ++ dump_stack(); ++#endif ++} ++ ++#ifdef PLATFORM_LINUX ++#define rtw_warn_on(condition) WARN_ON(condition) ++#else ++#define rtw_warn_on(condition) do {} while (0) ++#endif ++ ++__inline static int rtw_bug_check(void *parg1, void *parg2, void *parg3, void *parg4) ++{ ++ int ret = _TRUE; ++ ++#ifdef PLATFORM_WINDOWS ++ if (((uint)parg1) <= 0x7fffffff || ++ ((uint)parg2) <= 0x7fffffff || ++ ((uint)parg3) <= 0x7fffffff || ++ ((uint)parg4) <= 0x7fffffff) { ++ ret = _FALSE; ++ KeBugCheckEx(0x87110000, (ULONG_PTR)parg1, (ULONG_PTR)parg2, (ULONG_PTR)parg3, (ULONG_PTR)parg4); ++ } ++#endif ++ ++ return ret; ++ ++} ++ ++#define _RND(sz, r) ((((sz)+((r)-1))/(r))*(r)) ++#define RND4(x) (((x >> 2) + (((x & 3) == 0) ? 0 : 1)) << 2) ++ ++__inline static u32 _RND4(u32 sz) ++{ ++ ++ u32 val; ++ ++ val = ((sz >> 2) + ((sz & 3) ? 1 : 0)) << 2; ++ ++ return val; ++ ++} ++ ++__inline static u32 _RND8(u32 sz) ++{ ++ ++ u32 val; ++ ++ val = ((sz >> 3) + ((sz & 7) ? 1 : 0)) << 3; ++ ++ return val; ++ ++} ++ ++__inline static u32 _RND128(u32 sz) ++{ ++ ++ u32 val; ++ ++ val = ((sz >> 7) + ((sz & 127) ? 1 : 0)) << 7; ++ ++ return val; ++ ++} ++ ++__inline static u32 _RND256(u32 sz) ++{ ++ ++ u32 val; ++ ++ val = ((sz >> 8) + ((sz & 255) ? 1 : 0)) << 8; ++ ++ return val; ++ ++} ++ ++__inline static u32 _RND512(u32 sz) ++{ ++ ++ u32 val; ++ ++ val = ((sz >> 9) + ((sz & 511) ? 1 : 0)) << 9; ++ ++ return val; ++ ++} ++ ++__inline static u32 bitshift(u32 bitmask) ++{ ++ u32 i; ++ ++ for (i = 0; i <= 31; i++) ++ if (((bitmask >> i) & 0x1) == 1) ++ break; ++ ++ return i; ++} ++ ++static inline int largest_bit(u32 bitmask) ++{ ++ int i; ++ ++ for (i = 31; i >= 0; i--) ++ if (bitmask & BIT(i)) ++ break; ++ ++ return i; ++} ++ ++#define rtw_min(a, b) ((a > b) ? b : a) ++#define rtw_is_range_a_in_b(hi_a, lo_a, hi_b, lo_b) (((hi_a) <= (hi_b)) && ((lo_a) >= (lo_b))) ++#define rtw_is_range_overlap(hi_a, lo_a, hi_b, lo_b) (((hi_a) > (lo_b)) && ((lo_a) < (hi_b))) ++ ++#ifndef MAC_FMT ++#define MAC_FMT "%02x:%02x:%02x:%02x:%02x:%02x" ++#endif ++#ifndef MAC_ARG ++#define MAC_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5] ++#endif ++ ++ ++extern void rtw_suspend_lock_init(void); ++extern void rtw_suspend_lock_uninit(void); ++extern void rtw_lock_suspend(void); ++extern void rtw_unlock_suspend(void); ++extern void rtw_lock_suspend_timeout(u32 timeout_ms); ++extern void rtw_lock_ext_suspend_timeout(u32 timeout_ms); ++extern void rtw_lock_rx_suspend_timeout(u32 timeout_ms); ++extern void rtw_lock_traffic_suspend_timeout(u32 timeout_ms); ++extern void rtw_lock_resume_scan_timeout(u32 timeout_ms); ++extern void rtw_resume_lock_suspend(void); ++extern void rtw_resume_unlock_suspend(void); ++#ifdef CONFIG_AP_WOWLAN ++extern void rtw_softap_lock_suspend(void); ++extern void rtw_softap_unlock_suspend(void); ++#endif ++ ++extern void ATOMIC_SET(ATOMIC_T *v, int i); ++extern int ATOMIC_READ(ATOMIC_T *v); ++extern void ATOMIC_ADD(ATOMIC_T *v, int i); ++extern void ATOMIC_SUB(ATOMIC_T *v, int i); ++extern void ATOMIC_INC(ATOMIC_T *v); ++extern void ATOMIC_DEC(ATOMIC_T *v); ++extern int ATOMIC_ADD_RETURN(ATOMIC_T *v, int i); ++extern int ATOMIC_SUB_RETURN(ATOMIC_T *v, int i); ++extern int ATOMIC_INC_RETURN(ATOMIC_T *v); ++extern int ATOMIC_DEC_RETURN(ATOMIC_T *v); ++ ++/* File operation APIs, just for linux now */ ++extern int rtw_is_file_readable(const char *path); ++extern int rtw_is_file_readable_with_size(const char *path, u32 *sz); ++extern int rtw_retrieve_from_file(const char *path, u8 *buf, u32 sz); ++extern int rtw_store_to_file(const char *path, u8 *buf, u32 sz); ++ ++ ++#ifndef PLATFORM_FREEBSD ++extern void rtw_free_netdev(struct net_device *netdev); ++#endif /* PLATFORM_FREEBSD */ ++ ++ ++extern u64 rtw_modular64(u64 x, u64 y); ++extern u64 rtw_division64(u64 x, u64 y); ++extern u32 rtw_random32(void); ++ ++/* Macros for handling unaligned memory accesses */ ++ ++#define RTW_GET_BE16(a) ((u16) (((a)[0] << 8) | (a)[1])) ++#define RTW_PUT_BE16(a, val) \ ++ do { \ ++ (a)[0] = ((u16) (val)) >> 8; \ ++ (a)[1] = ((u16) (val)) & 0xff; \ ++ } while (0) ++ ++#define RTW_GET_LE16(a) ((u16) (((a)[1] << 8) | (a)[0])) ++#define RTW_PUT_LE16(a, val) \ ++ do { \ ++ (a)[1] = ((u16) (val)) >> 8; \ ++ (a)[0] = ((u16) (val)) & 0xff; \ ++ } while (0) ++ ++#define RTW_GET_BE24(a) ((((u32) (a)[0]) << 16) | (((u32) (a)[1]) << 8) | \ ++ ((u32) (a)[2])) ++#define RTW_PUT_BE24(a, val) \ ++ do { \ ++ (a)[0] = (u8) ((((u32) (val)) >> 16) & 0xff); \ ++ (a)[1] = (u8) ((((u32) (val)) >> 8) & 0xff); \ ++ (a)[2] = (u8) (((u32) (val)) & 0xff); \ ++ } while (0) ++ ++#define RTW_GET_BE32(a) ((((u32) (a)[0]) << 24) | (((u32) (a)[1]) << 16) | \ ++ (((u32) (a)[2]) << 8) | ((u32) (a)[3])) ++#define RTW_PUT_BE32(a, val) \ ++ do { \ ++ (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ ++ (a)[1] = (u8) ((((u32) (val)) >> 16) & 0xff); \ ++ (a)[2] = (u8) ((((u32) (val)) >> 8) & 0xff); \ ++ (a)[3] = (u8) (((u32) (val)) & 0xff); \ ++ } while (0) ++ ++#define RTW_GET_LE32(a) ((((u32) (a)[3]) << 24) | (((u32) (a)[2]) << 16) | \ ++ (((u32) (a)[1]) << 8) | ((u32) (a)[0])) ++#define RTW_PUT_LE32(a, val) \ ++ do { \ ++ (a)[3] = (u8) ((((u32) (val)) >> 24) & 0xff); \ ++ (a)[2] = (u8) ((((u32) (val)) >> 16) & 0xff); \ ++ (a)[1] = (u8) ((((u32) (val)) >> 8) & 0xff); \ ++ (a)[0] = (u8) (((u32) (val)) & 0xff); \ ++ } while (0) ++ ++#define RTW_GET_BE64(a) ((((u64) (a)[0]) << 56) | (((u64) (a)[1]) << 48) | \ ++ (((u64) (a)[2]) << 40) | (((u64) (a)[3]) << 32) | \ ++ (((u64) (a)[4]) << 24) | (((u64) (a)[5]) << 16) | \ ++ (((u64) (a)[6]) << 8) | ((u64) (a)[7])) ++#define RTW_PUT_BE64(a, val) \ ++ do { \ ++ (a)[0] = (u8) (((u64) (val)) >> 56); \ ++ (a)[1] = (u8) (((u64) (val)) >> 48); \ ++ (a)[2] = (u8) (((u64) (val)) >> 40); \ ++ (a)[3] = (u8) (((u64) (val)) >> 32); \ ++ (a)[4] = (u8) (((u64) (val)) >> 24); \ ++ (a)[5] = (u8) (((u64) (val)) >> 16); \ ++ (a)[6] = (u8) (((u64) (val)) >> 8); \ ++ (a)[7] = (u8) (((u64) (val)) & 0xff); \ ++ } while (0) ++ ++#define RTW_GET_LE64(a) ((((u64) (a)[7]) << 56) | (((u64) (a)[6]) << 48) | \ ++ (((u64) (a)[5]) << 40) | (((u64) (a)[4]) << 32) | \ ++ (((u64) (a)[3]) << 24) | (((u64) (a)[2]) << 16) | \ ++ (((u64) (a)[1]) << 8) | ((u64) (a)[0])) ++ ++void rtw_buf_free(u8 **buf, u32 *buf_len); ++void rtw_buf_update(u8 **buf, u32 *buf_len, u8 *src, u32 src_len); ++ ++struct rtw_cbuf { ++ u32 write; ++ u32 read; ++ u32 size; ++ void *bufs[0]; ++}; ++ ++bool rtw_cbuf_full(struct rtw_cbuf *cbuf); ++bool rtw_cbuf_empty(struct rtw_cbuf *cbuf); ++bool rtw_cbuf_push(struct rtw_cbuf *cbuf, void *buf); ++void *rtw_cbuf_pop(struct rtw_cbuf *cbuf); ++struct rtw_cbuf *rtw_cbuf_alloc(u32 size); ++void rtw_cbuf_free(struct rtw_cbuf *cbuf); ++ ++struct map_seg_t { ++ u16 sa; ++ u16 len; ++ u8 *c; ++}; ++ ++struct map_t { ++ u16 len; ++ u16 seg_num; ++ u8 init_value; ++ struct map_seg_t *segs; ++}; ++ ++#define MAPSEG_ARRAY_ENT(_sa, _len, _c, arg...) \ ++ { .sa = _sa, .len = _len, .c = (u8[_len]){ _c, ##arg}, } ++ ++#define MAPSEG_PTR_ENT(_sa, _len, _p) \ ++ { .sa = _sa, .len = _len, .c = _p, } ++ ++#define MAP_ENT(_len, _seg_num, _init_v, _seg, arg...) \ ++ { .len = _len, .seg_num = _seg_num, .init_value = _init_v, .segs = (struct map_seg_t[_seg_num]){ _seg, ##arg}, } ++ ++int map_readN(const struct map_t *map, u16 offset, u16 len, u8 *buf); ++u8 map_read8(const struct map_t *map, u16 offset); ++ ++/* String handler */ ++ ++BOOLEAN is_null(char c); ++BOOLEAN is_eol(char c); ++BOOLEAN is_space(char c); ++BOOLEAN IsHexDigit(char chTmp); ++BOOLEAN is_alpha(char chTmp); ++char alpha_to_upper(char c); ++ ++/* ++ * Write formatted output to sized buffer ++ */ ++#ifdef PLATFORM_LINUX ++#define rtw_sprintf(buf, size, format, arg...) snprintf(buf, size, format, ##arg) ++#else /* !PLATFORM_LINUX */ ++#error "NOT DEFINE \"rtw_sprintf\"!!" ++#endif /* !PLATFORM_LINUX */ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_linux.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_linux.h +--- linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_linux.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_linux.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,443 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __OSDEP_LINUX_SERVICE_H_ ++#define __OSDEP_LINUX_SERVICE_H_ ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 5)) ++ #include ++#endif ++/* #include */ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) ++ #include ++#else ++ #include ++#endif ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include /* for struct tasklet_struct */ ++#include ++#include ++#include ++#include ++ ++#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 5, 41)) ++ #include ++#endif ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 7, 0)) ++ #include ++#else ++ #include ++#endif ++ ++#ifdef RTK_DMP_PLATFORM ++ #if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 12)) ++ #include ++ #endif ++ #include ++#endif ++ ++#ifdef CONFIG_NET_RADIO ++ #define CONFIG_WIRELESS_EXT ++#endif ++ ++/* Monitor mode */ ++#include ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) ++ #include ++#endif ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ /* #include */ ++ #include ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX ++ #include ++ #include ++#endif ++ ++#ifdef CONFIG_HAS_EARLYSUSPEND ++ #include ++#endif /* CONFIG_HAS_EARLYSUSPEND */ ++ ++#ifdef CONFIG_EFUSE_CONFIG_FILE ++ #include ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ #include ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 21)) ++ #include ++ #else ++ #include ++ #endif ++#endif ++ ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ #include ++ #include ++ #include ++ #include ++ #include ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++ ++#ifdef CONFIG_USB_HCI ++ typedef struct urb *PURB; ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 22)) ++ #ifdef CONFIG_USB_SUSPEND ++ #define CONFIG_AUTOSUSPEND 1 ++ #endif ++ #endif ++#endif ++ ++#if defined(CONFIG_RTW_GRO) && (!defined(CONFIG_RTW_NAPI)) ++ ++ #error "Enable NAPI before enable GRO\n" ++ ++#elif (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,29) && defined(CONFIG_RTW_NAPI)) ++ ++ #error "Linux Kernel version too old (should newer than 2.6.29)\n" ++ ++#endif ++ ++ ++typedef struct semaphore _sema; ++typedef spinlock_t _lock; ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) ++ typedef struct mutex _mutex; ++#else ++ typedef struct semaphore _mutex; ++#endif ++typedef struct timer_list _timer; ++typedef struct completion _completion; ++ ++struct __queue { ++ struct list_head queue; ++ _lock lock; ++}; ++ ++typedef struct sk_buff _pkt; ++typedef unsigned char _buffer; ++ ++typedef struct __queue _queue; ++typedef struct list_head _list; ++typedef int _OS_STATUS; ++/* typedef u32 _irqL; */ ++typedef unsigned long _irqL; ++typedef struct net_device *_nic_hdl; ++ ++typedef void *_thread_hdl_; ++typedef int thread_return; ++typedef void *thread_context; ++ ++typedef void timer_hdl_return; ++typedef void *timer_hdl_context; ++ ++#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 5, 41)) ++ typedef struct work_struct _workitem; ++#else ++ typedef struct tq_struct _workitem; ++#endif ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) ++ #define DMA_BIT_MASK(n) (((n) == 64) ? ~0ULL : ((1ULL<<(n))-1)) ++#endif ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 22)) ++/* Porting from linux kernel, for compatible with old kernel. */ ++static inline unsigned char *skb_tail_pointer(const struct sk_buff *skb) ++{ ++ return skb->tail; ++} ++ ++static inline void skb_reset_tail_pointer(struct sk_buff *skb) ++{ ++ skb->tail = skb->data; ++} ++ ++static inline void skb_set_tail_pointer(struct sk_buff *skb, const int offset) ++{ ++ skb->tail = skb->data + offset; ++} ++ ++static inline unsigned char *skb_end_pointer(const struct sk_buff *skb) ++{ ++ return skb->end; ++} ++#endif ++ ++__inline static _list *get_next(_list *list) ++{ ++ return list->next; ++} ++ ++__inline static _list *get_list_head(_queue *queue) ++{ ++ return &(queue->queue); ++} ++ ++ ++#define LIST_CONTAINOR(ptr, type, member) \ ++ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) ++ ++ ++__inline static void _enter_critical(_lock *plock, _irqL *pirqL) ++{ ++ spin_lock_irqsave(plock, *pirqL); ++} ++ ++__inline static void _exit_critical(_lock *plock, _irqL *pirqL) ++{ ++ spin_unlock_irqrestore(plock, *pirqL); ++} ++ ++__inline static void _enter_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ spin_lock_irqsave(plock, *pirqL); ++} ++ ++__inline static void _exit_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ spin_unlock_irqrestore(plock, *pirqL); ++} ++ ++__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) ++{ ++ spin_lock_bh(plock); ++} ++ ++__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) ++{ ++ spin_unlock_bh(plock); ++} ++ ++__inline static int _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) ++{ ++ int ret = 0; ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) ++ /* mutex_lock(pmutex); */ ++ ret = mutex_lock_interruptible(pmutex); ++#else ++ ret = down_interruptible(pmutex); ++#endif ++ return ret; ++} ++ ++ ++__inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) ++ mutex_unlock(pmutex); ++#else ++ up(pmutex); ++#endif ++} ++ ++__inline static void rtw_list_delete(_list *plist) ++{ ++ list_del_init(plist); ++} ++ ++#define RTW_TIMER_HDL_ARGS void *FunctionContext ++ ++__inline static void _init_timer(_timer *ptimer, _nic_hdl nic_hdl, void *pfunc, void *cntx) ++{ ++ /* setup_timer(ptimer, pfunc,(u32)cntx); */ ++ ptimer->function = pfunc; ++ ptimer->data = (unsigned long)cntx; ++ init_timer(ptimer); ++} ++ ++__inline static void _set_timer(_timer *ptimer, u32 delay_time) ++{ ++ mod_timer(ptimer , (jiffies + (delay_time * HZ / 1000))); ++} ++ ++__inline static void _cancel_timer(_timer *ptimer, u8 *bcancelled) ++{ ++ del_timer_sync(ptimer); ++ *bcancelled = 1; ++} ++ ++ ++static inline void _init_workitem(_workitem *pwork, void *pfunc, void *cntx) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 20)) ++ INIT_WORK(pwork, pfunc); ++#elif (LINUX_VERSION_CODE > KERNEL_VERSION(2, 5, 41)) ++ INIT_WORK(pwork, pfunc, pwork); ++#else ++ INIT_TQUEUE(pwork, pfunc, pwork); ++#endif ++} ++ ++__inline static void _set_workitem(_workitem *pwork) ++{ ++#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 5, 41)) ++ schedule_work(pwork); ++#else ++ schedule_task(pwork); ++#endif ++} ++ ++__inline static void _cancel_workitem_sync(_workitem *pwork) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 22)) ++ cancel_work_sync(pwork); ++#elif (LINUX_VERSION_CODE > KERNEL_VERSION(2, 5, 41)) ++ flush_scheduled_work(); ++#else ++ flush_scheduled_tasks(); ++#endif ++} ++/* ++ * Global Mutex: can only be used at PASSIVE level. ++ * */ ++ ++#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ ++ { \ ++ while (atomic_inc_return((atomic_t *)&(_MutexCounter)) != 1) { \ ++ atomic_dec((atomic_t *)&(_MutexCounter)); \ ++ msleep(10); \ ++ } \ ++ } ++ ++#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ ++ { \ ++ atomic_dec((atomic_t *)&(_MutexCounter)); \ ++ } ++ ++static inline int rtw_netif_queue_stopped(struct net_device *pnetdev) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ return (netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 0)) && ++ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 1)) && ++ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 2)) && ++ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 3))); ++#else ++ return netif_queue_stopped(pnetdev); ++#endif ++} ++ ++static inline void rtw_netif_wake_queue(struct net_device *pnetdev) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ netif_tx_wake_all_queues(pnetdev); ++#else ++ netif_wake_queue(pnetdev); ++#endif ++} ++ ++static inline void rtw_netif_start_queue(struct net_device *pnetdev) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ netif_tx_start_all_queues(pnetdev); ++#else ++ netif_start_queue(pnetdev); ++#endif ++} ++ ++static inline void rtw_netif_stop_queue(struct net_device *pnetdev) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ netif_tx_stop_all_queues(pnetdev); ++#else ++ netif_stop_queue(pnetdev); ++#endif ++} ++static inline void rtw_netif_carrier_on(struct net_device *pnetdev) ++{ ++ netif_device_attach(pnetdev); ++ netif_carrier_on(pnetdev); ++} ++static inline int rtw_merge_string(char *dst, int dst_len, const char *src1, const char *src2) ++{ ++ int len = 0; ++ len += snprintf(dst + len, dst_len - len, "%s", src1); ++ len += snprintf(dst + len, dst_len - len, "%s", src2); ++ ++ return len; ++} ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) ++ #define rtw_signal_process(pid, sig) kill_pid(find_vpid((pid)), (sig), 1) ++#else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) */ ++ #define rtw_signal_process(pid, sig) kill_proc((pid), (sig), 1) ++#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) */ ++ ++ ++/* Suspend lock prevent system from going suspend */ ++#ifdef CONFIG_WAKELOCK ++ #include ++#elif defined(CONFIG_ANDROID_POWER) ++ #include ++#endif ++ ++/* limitation of path length */ ++#define PATH_LENGTH_MAX PATH_MAX ++ ++/* Atomic integer operations */ ++#define ATOMIC_T atomic_t ++ ++#define rtw_netdev_priv(netdev) (((struct rtw_netdev_priv_indicator *)netdev_priv(netdev))->priv) ++ ++#define NDEV_FMT "%s" ++#define NDEV_ARG(ndev) ndev->name ++#define ADPT_FMT "%s" ++#define ADPT_ARG(adapter) (adapter->pnetdev ? adapter->pnetdev->name : NULL) ++#define FUNC_NDEV_FMT "%s(%s)" ++#define FUNC_NDEV_ARG(ndev) __func__, ndev->name ++#define FUNC_ADPT_FMT "%s(%s)" ++#define FUNC_ADPT_ARG(adapter) __func__, (adapter->pnetdev ? adapter->pnetdev->name : NULL) ++ ++struct rtw_netdev_priv_indicator { ++ void *priv; ++ u32 sizeof_priv; ++}; ++struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv); ++extern struct net_device *rtw_alloc_etherdev(int sizeof_priv); ++ ++#define STRUCT_PACKED __attribute__ ((packed)) ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_xp.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_xp.h +--- linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_xp.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_xp.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,201 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __OSDEP_LINUX_SERVICE_H_ ++#define __OSDEP_LINUX_SERVICE_H_ ++ ++ #include ++ #include ++ #include ++ #include ++ ++#ifdef CONFIG_USB_HCI ++ #include ++ #include ++ #include ++#endif ++ ++ typedef KSEMAPHORE _sema; ++ typedef LIST_ENTRY _list; ++ typedef NDIS_STATUS _OS_STATUS; ++ ++ ++ typedef NDIS_SPIN_LOCK _lock; ++ ++ typedef KMUTEX _mutex; ++ ++ typedef KIRQL _irqL; ++ ++ // USB_PIPE for WINCE , but handle can be use just integer under windows ++ typedef NDIS_HANDLE _nic_hdl; ++ ++ ++ typedef NDIS_MINIPORT_TIMER _timer; ++ ++ struct __queue { ++ LIST_ENTRY queue; ++ _lock lock; ++ }; ++ ++ typedef NDIS_PACKET _pkt; ++ typedef NDIS_BUFFER _buffer; ++ typedef struct __queue _queue; ++ ++ typedef PKTHREAD _thread_hdl_; ++ typedef void thread_return; ++ typedef void* thread_context; ++ ++ typedef NDIS_WORK_ITEM _workitem; ++ ++ ++ #define HZ 10000000 ++ #define SEMA_UPBND (0x7FFFFFFF) //8192 ++ ++__inline static _list *get_next(_list *list) ++{ ++ return list->Flink; ++} ++ ++__inline static _list *get_list_head(_queue *queue) ++{ ++ return (&(queue->queue)); ++} ++ ++ ++#define LIST_CONTAINOR(ptr, type, member) CONTAINING_RECORD(ptr, type, member) ++ ++ ++__inline static _enter_critical(_lock *plock, _irqL *pirqL) ++{ ++ NdisAcquireSpinLock(plock); ++} ++ ++__inline static _exit_critical(_lock *plock, _irqL *pirqL) ++{ ++ NdisReleaseSpinLock(plock); ++} ++ ++ ++__inline static _enter_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ NdisDprAcquireSpinLock(plock); ++} ++ ++__inline static _exit_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ NdisDprReleaseSpinLock(plock); ++} ++ ++__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) ++{ ++ NdisDprAcquireSpinLock(plock); ++} ++ ++__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) ++{ ++ NdisDprReleaseSpinLock(plock); ++} ++ ++__inline static _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) ++{ ++ KeWaitForSingleObject(pmutex, Executive, KernelMode, FALSE, NULL); ++} ++ ++ ++__inline static _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) ++{ ++ KeReleaseMutex(pmutex, FALSE); ++} ++ ++ ++__inline static void rtw_list_delete(_list *plist) ++{ ++ RemoveEntryList(plist); ++ InitializeListHead(plist); ++} ++ ++#define RTW_TIMER_HDL_ARGS IN PVOID SystemSpecific1, IN PVOID FunctionContext, IN PVOID SystemSpecific2, IN PVOID SystemSpecific3 ++ ++__inline static void _init_timer(_timer *ptimer,_nic_hdl nic_hdl,void *pfunc,PVOID cntx) ++{ ++ NdisMInitializeTimer(ptimer, nic_hdl, pfunc, cntx); ++} ++ ++__inline static void _set_timer(_timer *ptimer,u32 delay_time) ++{ ++ NdisMSetTimer(ptimer,delay_time); ++} ++ ++__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) ++{ ++ NdisMCancelTimer(ptimer,bcancelled); ++} ++ ++__inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) ++{ ++ ++ NdisInitializeWorkItem(pwork, pfunc, cntx); ++} ++ ++__inline static void _set_workitem(_workitem *pwork) ++{ ++ NdisScheduleWorkItem(pwork); ++} ++ ++ ++#define ATOMIC_INIT(i) { (i) } ++ ++// ++// Global Mutex: can only be used at PASSIVE level. ++// ++ ++#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ ++{ \ ++ while (NdisInterlockedIncrement((PULONG)&(_MutexCounter)) != 1)\ ++ { \ ++ NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ ++ NdisMSleep(10000); \ ++ } \ ++} ++ ++#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ ++{ \ ++ NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ ++} ++ ++// limitation of path length ++#define PATH_LENGTH_MAX MAX_PATH ++ ++//Atomic integer operations ++#define ATOMIC_T LONG ++ ++ ++#define NDEV_FMT "%s" ++#define NDEV_ARG(ndev) "" ++#define ADPT_FMT "%s" ++#define ADPT_ARG(adapter) "" ++#define FUNC_NDEV_FMT "%s" ++#define FUNC_NDEV_ARG(ndev) __func__ ++#define FUNC_ADPT_FMT "%s" ++#define FUNC_ADPT_ARG(adapter) __func__ ++ ++#define STRUCT_PACKED ++ ++#endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/pci_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/pci_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/pci_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/pci_hal.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,53 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __PCI_HAL_H__ ++#define __PCI_HAL_H__ ++ ++#ifdef CONFIG_RTL8188E ++ void rtl8188ee_set_hal_ops(_adapter *padapter); ++#endif ++ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ++ void rtl8812ae_set_hal_ops(_adapter *padapter); ++#endif ++ ++#if defined(CONFIG_RTL8192E) ++ void rtl8192ee_set_hal_ops(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_RTL8723B ++ void rtl8723be_set_hal_ops(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_RTL8723D ++ void rtl8723de_set_hal_ops(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_RTL8814A ++ void rtl8814ae_set_hal_ops(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_RTL8822B ++ void rtl8822be_set_hal_ops(PADAPTER padapter); ++#endif ++ ++u8 rtw_set_hal_ops(_adapter *padapter); ++ ++#endif /* __PCIE_HAL_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/pci_ops.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/pci_ops.h +--- linux-4.14.18/3rdparty/rtl8723de/include/pci_ops.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/pci_ops.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,92 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __PCI_OPS_H_ ++#define __PCI_OPS_H_ ++ ++ ++#ifdef CONFIG_RTL8188E ++ u32 rtl8188ee_init_desc_ring(_adapter *padapter); ++ u32 rtl8188ee_free_desc_ring(_adapter *padapter); ++ void rtl8188ee_reset_desc_ring(_adapter *padapter); ++ int rtl8188ee_interrupt(PADAPTER Adapter); ++ void rtl8188ee_xmit_tasklet(void *priv); ++ void rtl8188ee_recv_tasklet(void *priv); ++ void rtl8188ee_prepare_bcn_tasklet(void *priv); ++ void rtl8188ee_set_intf_ops(struct _io_ops *pops); ++#endif ++ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ++ u32 rtl8812ae_init_desc_ring(_adapter *padapter); ++ u32 rtl8812ae_free_desc_ring(_adapter *padapter); ++ void rtl8812ae_reset_desc_ring(_adapter *padapter); ++ int rtl8812ae_interrupt(PADAPTER Adapter); ++ void rtl8812ae_xmit_tasklet(void *priv); ++ void rtl8812ae_recv_tasklet(void *priv); ++ void rtl8812ae_prepare_bcn_tasklet(void *priv); ++ void rtl8812ae_set_intf_ops(struct _io_ops *pops); ++#endif ++ ++#ifdef CONFIG_RTL8192E ++ u32 rtl8192ee_init_desc_ring(_adapter *padapter); ++ u32 rtl8192ee_free_desc_ring(_adapter *padapter); ++ void rtl8192ee_reset_desc_ring(_adapter *padapter); ++ void rtl8192ee_recv_tasklet(void *priv); ++ void rtl8192ee_prepare_bcn_tasklet(void *priv); ++ int rtl8192ee_interrupt(PADAPTER Adapter); ++ void rtl8192ee_set_intf_ops(struct _io_ops *pops); ++#endif ++ ++#ifdef CONFIG_RTL8723B ++ u32 rtl8723be_init_desc_ring(_adapter *padapter); ++ u32 rtl8723be_free_desc_ring(_adapter *padapter); ++ void rtl8723be_reset_desc_ring(_adapter *padapter); ++ int rtl8723be_interrupt(PADAPTER Adapter); ++ void rtl8723be_recv_tasklet(void *priv); ++ void rtl8723be_prepare_bcn_tasklet(void *priv); ++ void rtl8723be_set_intf_ops(struct _io_ops *pops); ++#endif ++ ++#ifdef CONFIG_RTL8723D ++ u32 rtl8723de_init_desc_ring(_adapter *padapter); ++ u32 rtl8723de_free_desc_ring(_adapter *padapter); ++ void rtl8723de_reset_desc_ring(_adapter *padapter); ++ int rtl8723de_interrupt(PADAPTER Adapter); ++ void rtl8723de_recv_tasklet(void *priv); ++ void rtl8723de_prepare_bcn_tasklet(void *priv); ++ void rtl8723de_set_intf_ops(struct _io_ops *pops); ++ u8 check_tx_desc_resource(_adapter *padapter, int prio); ++#endif ++ ++#ifdef CONFIG_RTL8814A ++ u32 rtl8814ae_init_desc_ring(_adapter *padapter); ++ u32 rtl8814ae_free_desc_ring(_adapter *padapter); ++ void rtl8814ae_reset_desc_ring(_adapter *padapter); ++ int rtl8814ae_interrupt(PADAPTER Adapter); ++ void rtl8814ae_xmit_tasklet(void *priv); ++ void rtl8814ae_recv_tasklet(void *priv); ++ void rtl8814ae_prepare_bcn_tasklet(void *priv); ++ void rtl8814ae_set_intf_ops(struct _io_ops *pops); ++#endif ++ ++#ifdef CONFIG_RTL8822B ++ void rtl8822be_set_intf_ops(struct _io_ops *pops); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/pci_osintf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/pci_osintf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/pci_osintf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/pci_osintf.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,42 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __PCI_OSINTF_H ++#define __PCI_OSINTF_H ++ ++#ifdef RTK_129X_PLATFORM ++#define PCIE_SLOT1_MEM_START 0x9804F000 ++#define PCIE_SLOT1_MEM_LEN 0x1000 ++#define PCIE_SLOT1_MASK 0x9804ED00 ++ ++#define PCIE_SLOT2_MEM_START 0x9803C000 ++#define PCIE_SLOT2_MEM_LEN 0x1000 ++#define PCIE_SLOT2_MASK 0x9803BD00 ++ ++#define PCIE_TRANSLATE_OFFSET 4 /* offset from MASK reg */ ++#endif ++ ++void rtw_pci_disable_aspm(_adapter *padapter); ++void rtw_pci_enable_aspm(_adapter *padapter); ++void PlatformClearPciPMEStatus(PADAPTER Adapter); ++#ifdef CONFIG_64BIT_DMA ++ u8 PlatformEnableDMA64(PADAPTER Adapter); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/recv_osdep.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/recv_osdep.h +--- linux-4.14.18/3rdparty/rtl8723de/include/recv_osdep.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/recv_osdep.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,68 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RECV_OSDEP_H_ ++#define __RECV_OSDEP_H_ ++ ++ ++extern sint _rtw_init_recv_priv(struct recv_priv *precvpriv, _adapter *padapter); ++extern void _rtw_free_recv_priv(struct recv_priv *precvpriv); ++ ++ ++extern s32 rtw_recv_entry(union recv_frame *precv_frame); ++extern int rtw_recv_indicatepkt(_adapter *adapter, union recv_frame *precv_frame); ++extern void rtw_recv_returnpacket(IN _nic_hdl cnxt, IN _pkt *preturnedpkt); ++ ++extern int rtw_recv_monitor(_adapter *padapter, union recv_frame *precv_frame); ++ ++extern void rtw_hostapd_mlme_rx(_adapter *padapter, union recv_frame *precv_frame); ++ ++struct sta_info; ++extern void rtw_handle_tkip_mic_err(_adapter *padapter, struct sta_info *sta, u8 bgroup); ++ ++ ++int rtw_os_recv_resource_init(struct recv_priv *precvpriv, _adapter *padapter); ++int rtw_os_recv_resource_alloc(_adapter *padapter, union recv_frame *precvframe); ++void rtw_os_recv_resource_free(struct recv_priv *precvpriv); ++ ++ ++int rtw_os_alloc_recvframe(_adapter *padapter, union recv_frame *precvframe, u8 *pdata, _pkt *pskb); ++int rtw_os_recvframe_duplicate_skb(_adapter *padapter, union recv_frame *pcloneframe, _pkt *pskb); ++void rtw_os_free_recvframe(union recv_frame *precvframe); ++ ++ ++int rtw_os_recvbuf_resource_alloc(_adapter *padapter, struct recv_buf *precvbuf); ++int rtw_os_recvbuf_resource_free(_adapter *padapter, struct recv_buf *precvbuf); ++ ++_pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, u16 nSubframe_Length, u8 *pdata); ++void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, struct rx_pkt_attrib *pattrib); ++ ++void rtw_os_read_port(_adapter *padapter, struct recv_buf *precvbuf); ++ ++void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl); ++ ++#ifdef PLATFORM_LINUX ++#ifdef CONFIG_RTW_NAPI ++#include /* struct napi_struct */ ++ ++int rtw_recv_napi_poll(struct napi_struct *, int budget); ++#endif /* CONFIG_RTW_NAPI */ ++#endif /* PLATFORM_LINUX */ ++ ++#endif /* */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_cmd.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_cmd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_cmd.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,179 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188E_CMD_H__ ++#define __RTL8188E_CMD_H__ ++ ++#if 0 ++enum cmd_msg_element_id { ++ NONE_CMDMSG_EID, ++ AP_OFFLOAD_EID = 0, ++ SET_PWRMODE_EID = 1, ++ JOINBSS_RPT_EID = 2, ++ RSVD_PAGE_EID = 3, ++ RSSI_4_EID = 4, ++ RSSI_SETTING_EID = 5, ++ MACID_CONFIG_EID = 6, ++ MACID_PS_MODE_EID = 7, ++ P2P_PS_OFFLOAD_EID = 8, ++ SELECTIVE_SUSPEND_ROF_CMD = 9, ++ P2P_PS_CTW_CMD_EID = 32, ++ MAX_CMDMSG_EID ++}; ++#else ++typedef enum _RTL8188E_H2C_CMD_ID { ++ /* Class Common */ ++ H2C_COM_RSVD_PAGE = 0x00, ++ H2C_COM_MEDIA_STATUS_RPT = 0x01, ++ H2C_COM_SCAN = 0x02, ++ H2C_COM_KEEP_ALIVE = 0x03, ++ H2C_COM_DISCNT_DECISION = 0x04, ++#ifndef CONFIG_WOWLAN ++ H2C_COM_WWLAN = 0x05, ++#endif ++ H2C_COM_INIT_OFFLOAD = 0x06, ++ H2C_COM_REMOTE_WAKE_CTL = 0x07, ++ H2C_COM_AP_OFFLOAD = 0x08, ++ H2C_COM_BCN_RSVD_PAGE = 0x09, ++ H2C_COM_PROB_RSP_RSVD_PAGE = 0x0A, ++ ++ /* Class PS */ ++ H2C_PS_PWR_MODE = 0x20, ++ H2C_PS_TUNE_PARA = 0x21, ++ H2C_PS_TUNE_PARA_2 = 0x22, ++ H2C_PS_LPS_PARA = 0x23, ++ H2C_PS_P2P_OFFLOAD = 0x24, ++ ++ /* Class DM */ ++ H2C_DM_MACID_CFG = 0x40, ++ H2C_DM_TXBF = 0x41, ++ H2C_RSSI_REPORT = 0x42, ++ /* Class BT */ ++ H2C_BT_COEX_MASK = 0x60, ++ H2C_BT_COEX_GPIO_MODE = 0x61, ++ H2C_BT_DAC_SWING_VAL = 0x62, ++ H2C_BT_PSD_RST = 0x63, ++ ++ /* Class Remote WakeUp */ ++#ifdef CONFIG_WOWLAN ++ H2C_COM_WWLAN = 0x80, ++ H2C_COM_REMOTE_WAKE_CTRL = 0x81, ++ H2C_COM_AOAC_GLOBAL_INFO = 0x82, ++ H2C_COM_AOAC_RSVD_PAGE = 0x83, ++#endif ++ ++ /* Class */ ++ /* H2C_RESET_TSF =0xc0, */ ++} RTL8188E_H2C_CMD_ID; ++ ++#endif ++ ++ ++struct cmd_msg_parm { ++ u8 eid; /* element id */ ++ u8 sz; /* sz */ ++ u8 buf[6]; ++}; ++ ++enum { ++ PWRS ++}; ++ ++typedef struct _SETPWRMODE_PARM { ++ u8 Mode;/* 0:Active,1:LPS,2:WMMPS */ ++ /* u8 RLBM:4; */ /* 0:Min,1:Max,2: User define */ ++ u8 SmartPS_RLBM;/* LPS=0:PS_Poll,1:PS_Poll,2:NullData,WMM=0:PS_Poll,1:NullData */ ++ u8 AwakeInterval; /* unit: beacon interval */ ++ u8 bAllQueueUAPSD; ++ u8 PwrState;/* AllON(0x0c),RFON(0x04),RFOFF(0x00) */ ++} SETPWRMODE_PARM, *PSETPWRMODE_PARM; ++ ++struct H2C_SS_RFOFF_PARAM { ++ u8 ROFOn; /* 1: on, 0:off */ ++ u16 gpio_period; /* unit: 1024 us */ ++} __attribute__((packed)); ++ ++ ++typedef struct JOINBSSRPT_PARM_88E { ++ u8 OpMode; /* RT_MEDIA_STATUS */ ++#ifdef CONFIG_WOWLAN ++ u8 MacID; /* MACID */ ++#endif /* CONFIG_WOWLAN */ ++} JOINBSSRPT_PARM_88E, *PJOINBSSRPT_PARM_88E; ++ ++#if 0 ++/* move to hal_com_h2c.h */ ++typedef struct _RSVDPAGE_LOC_88E { ++ u8 LocProbeRsp; ++ u8 LocPsPoll; ++ u8 LocNullData; ++ u8 LocQosNull; ++ u8 LocBTQosNull; ++#ifdef CONFIG_WOWLAN ++ u8 LocRemoteCtrlInfo; ++ u8 LocArpRsp; ++ u8 LocNbrAdv; ++ u8 LocGTKRsp; ++ u8 LocGTKInfo; ++ u8 LocProbeReq; ++ u8 LocNetList; ++#endif /* CONFIG_WOWLAN */ ++} RSVDPAGE_LOC_88E, *PRSVDPAGE_LOC_88E; ++#endif ++ ++/* host message to firmware cmd */ ++void rtl8188e_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); ++void rtl8188e_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); ++u8 rtl8188e_set_rssi_cmd(PADAPTER padapter, u8 *param); ++u8 rtl8188e_set_raid_cmd(_adapter *padapter, u32 bitmap, u8 *arg, u8 bw); ++s32 FillH2CCmd_88E(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); ++/* u8 rtl8192c_set_FwSelectSuspend_cmd(PADAPTER padapter, u8 bfwpoll, u16 period); */ ++u8 GetTxBufferRsvdPageNum8188E(_adapter *padapter, bool wowlan); ++ ++ ++#ifdef CONFIG_P2P ++ void rtl8188e_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); ++#endif /* CONFIG_P2P */ ++ ++void CheckFwRsvdPageContent(PADAPTER padapter); ++ ++#ifdef CONFIG_TSF_RESET_OFFLOAD ++ /* u8 rtl8188e_reset_tsf(_adapter *padapter, u8 reset_port); */ ++ int reset_tsf(PADAPTER Adapter, u8 reset_port); ++#endif /* CONFIG_TSF_RESET_OFFLOAD */ ++ ++/* #define H2C_8188E_RSVDPAGE_LOC_LEN 5 */ ++/* #define H2C_8188E_AOAC_RSVDPAGE_LOC_LEN 7 */ ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- ++ * */ ++#if 0 ++ /* move to hal_com_h2c.h ++ * _RSVDPAGE_LOC_CMD_0x00 */ ++ #define SET_8188E_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++ #define SET_8188E_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++ #define SET_8188E_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++ #define SET_8188E_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++ /* AOAC_RSVDPAGE_LOC_0x83 */ ++ #define SET_8188E_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 0, 8, __Value) ++ #define SET_8188E_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#endif ++#endif/* __RTL8188E_CMD_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_dm.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_dm.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_dm.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,32 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188E_DM_H__ ++#define __RTL8188E_DM_H__ ++ ++void rtl8188e_init_dm_priv(IN PADAPTER Adapter); ++void rtl8188e_deinit_dm_priv(IN PADAPTER Adapter); ++void rtl8188e_InitHalDm(IN PADAPTER Adapter); ++void rtl8188e_HalDmWatchDog(IN PADAPTER Adapter); ++ ++/* VOID rtl8192c_dm_CheckTXPowerTracking(IN PADAPTER Adapter); */ ++ ++/* void rtl8192c_dm_RF_Saving(IN PADAPTER pAdapter, IN u8 bForceInNormal); */ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_hal.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,320 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188E_HAL_H__ ++#define __RTL8188E_HAL_H__ ++ ++/* #include "hal_com.h" */ ++#include "hal_data.h" ++ ++/* include HAL Related header after HAL Related compiling flags */ ++#include "rtl8188e_spec.h" ++#include "Hal8188EPhyReg.h" ++#include "Hal8188EPhyCfg.h" ++#include "rtl8188e_rf.h" ++#include "rtl8188e_dm.h" ++#include "rtl8188e_recv.h" ++#include "rtl8188e_xmit.h" ++#include "rtl8188e_cmd.h" ++#include "rtl8188e_led.h" ++#include "Hal8188EPwrSeq.h" ++#ifdef DBG_CONFIG_ERROR_DETECT ++ #include "rtl8188e_sreset.h" ++#endif ++ ++/* --------------------------------------------------------------------- */ ++/* RTL8188E Power Configuration CMDs for USB/SDIO/PCIE interfaces */ ++/* --------------------------------------------------------------------- */ ++#define Rtl8188E_NIC_PWR_ON_FLOW rtl8188E_power_on_flow ++#define Rtl8188E_NIC_RF_OFF_FLOW rtl8188E_radio_off_flow ++#define Rtl8188E_NIC_DISABLE_FLOW rtl8188E_card_disable_flow ++#define Rtl8188E_NIC_ENABLE_FLOW rtl8188E_card_enable_flow ++#define Rtl8188E_NIC_SUSPEND_FLOW rtl8188E_suspend_flow ++#define Rtl8188E_NIC_RESUME_FLOW rtl8188E_resume_flow ++#define Rtl8188E_NIC_PDN_FLOW rtl8188E_hwpdn_flow ++#define Rtl8188E_NIC_LPS_ENTER_FLOW rtl8188E_enter_lps_flow ++#define Rtl8188E_NIC_LPS_LEAVE_FLOW rtl8188E_leave_lps_flow ++ ++ ++#if 1 /* download firmware related data structure */ ++#define MAX_FW_8188E_SIZE 0x8000 /* 32768, 32k / 16384, 16k */ ++ ++#define FW_8188E_SIZE 0x4000 /* 16384, 16k */ ++#define FW_8188E_SIZE_2 0x8000 /* 32768, 32k */ ++ ++#define FW_8188E_START_ADDRESS 0x1000 ++#define FW_8188E_END_ADDRESS 0x1FFF /* 0x5FFF */ ++ ++ ++#define IS_FW_HEADER_EXIST_88E(_pFwHdr) ((le16_to_cpu(_pFwHdr->Signature) & 0xFFF0) == 0x88E0) ++ ++typedef struct _RT_FIRMWARE_8188E { ++ FIRMWARE_SOURCE eFWSource; ++#ifdef CONFIG_EMBEDDED_FWIMG ++ u8 *szFwBuffer; ++#else ++ u8 szFwBuffer[MAX_FW_8188E_SIZE]; ++#endif ++ u32 ulFwLength; ++} RT_FIRMWARE_8188E, *PRT_FIRMWARE_8188E; ++ ++/* ++ * This structure must be cared byte-ordering ++ * */ ++ ++typedef struct _RT_8188E_FIRMWARE_HDR { ++ /* 8-byte alinment required */ ++ ++ /* --- LONG WORD 0 ---- */ ++ u16 Signature; /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ ++ u8 Category; /* AP/NIC and USB/PCI */ ++ u8 Function; /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ ++ u16 Version; /* FW Version */ ++ u8 Subversion; /* FW Subversion, default 0x00 */ ++ u16 Rsvd1; ++ ++ ++ /* --- LONG WORD 1 ---- */ ++ u8 Month; /* Release time Month field */ ++ u8 Date; /* Release time Date field */ ++ u8 Hour; /* Release time Hour field */ ++ u8 Minute; /* Release time Minute field */ ++ u16 RamCodeSize; /* The size of RAM code */ ++ u8 Foundry; ++ u8 Rsvd2; ++ ++ /* --- LONG WORD 2 ---- */ ++ u32 SvnIdx; /* The SVN entry index */ ++ u32 Rsvd3; ++ ++ /* --- LONG WORD 3 ---- */ ++ u32 Rsvd4; ++ u32 Rsvd5; ++} RT_8188E_FIRMWARE_HDR, *PRT_8188E_FIRMWARE_HDR; ++#endif /* download firmware related data structure */ ++ ++ ++#define DRIVER_EARLY_INT_TIME_8188E 0x05 ++#define BCN_DMA_ATIME_INT_TIME_8188E 0x02 ++ ++ ++/* #define MAX_RX_DMA_BUFFER_SIZE_88E 0x2400 */ /* 9k for 88E nornal chip , */ /* MaxRxBuff=10k-max(TxReportSize(64*8), WOLPattern(16*24)) */ ++#ifdef CONFIG_USB_HCI ++ #define RX_DMA_SIZE_88E(__Adapter) 0x2800 /* no cut difference */ ++#else ++ #define RX_DMA_SIZE_88E(__Adapter) ((!IS_VENDOR_8188E_I_CUT_SERIES(__Adapter)) ? 0x2800 : 0x4000) ++#endif ++ ++#ifdef CONFIG_WOWLAN ++ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ ++#else ++ #define RESV_FMWF 0 ++#endif ++ ++#define RX_DMA_RESERVD_FW_FEATURE 0x200 /* for tx report (64*8) */ ++ ++#define MAX_RX_DMA_BUFFER_SIZE_88E(__Adapter) (RX_DMA_SIZE_88E(__Adapter)-RX_DMA_RESERVD_FW_FEATURE) ++ ++#define MAX_TX_REPORT_BUFFER_SIZE 0x0400 /* 1k */ ++ ++/* Note: We will divide number of page equally for each queue other than public queue! ++ * 22k = 22528 bytes = 176 pages (@page = 128 bytes) ++ * must reserved about 7 pages for LPS => 176-7 = 169 (0xA9) ++ * 2*BCN / 1*ps-poll / 1*null-data /1*prob_rsp /1*QOS null-data /1*BT QOS null-data */ ++ ++#define BCNQ_PAGE_NUM_88E 0x08 ++ ++/* For WoWLan , more reserved page */ ++#ifdef CONFIG_WOWLAN ++ #define WOWLAN_PAGE_NUM_88E 0x00 ++#else ++ #define WOWLAN_PAGE_NUM_88E 0x00 ++#endif ++ ++/* Note: ++Tx FIFO Size : previous CUT:22K /I_CUT after:32KB ++Tx page Size : 128B ++Total page numbers : 176(0xB0) / 256(0x100) ++*/ ++#ifdef CONFIG_USB_HCI ++ #define TOTAL_PAGE_NUMBER_88E(_Adapter) (0xB0 - 1) /* no cut difference */ ++#else ++ #define TOTAL_PAGE_NUMBER_88E(_Adapter) ((IS_VENDOR_8188E_I_CUT_SERIES(_Adapter) ? 0x100 : 0xB0) - 1)/* must reserved 1 page for dma issue */ ++#endif ++#define TX_TOTAL_PAGE_NUMBER_88E(_Adapter) (TOTAL_PAGE_NUMBER_88E(_Adapter) - BCNQ_PAGE_NUM_88E - WOWLAN_PAGE_NUM_88E) ++#define TX_PAGE_BOUNDARY_88E(_Adapter) (TX_TOTAL_PAGE_NUMBER_88E(_Adapter) + 1) /* beacon header start address */ ++ ++#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_88E(_Adapter) TX_TOTAL_PAGE_NUMBER_88E(_Adapter) ++#define WMM_NORMAL_TX_PAGE_BOUNDARY_88E(_Adapter) (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_88E(_Adapter) + 1) ++ ++/* For Normal Chip Setting ++ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8723B */ ++#define NORMAL_PAGE_NUM_HPQ_88E 0x0 ++#define NORMAL_PAGE_NUM_LPQ_88E 0x09 ++#define NORMAL_PAGE_NUM_NPQ_88E 0x0 ++ ++/* Note: For Normal Chip Setting, modify later */ ++#define WMM_NORMAL_PAGE_NUM_HPQ_88E 0x29 ++#define WMM_NORMAL_PAGE_NUM_LPQ_88E 0x1C ++#define WMM_NORMAL_PAGE_NUM_NPQ_88E 0x1C ++ ++ ++/* ------------------------------------------------------------------------- ++ * Chip specific ++ * ------------------------------------------------------------------------- */ ++#define CHIP_BONDING_IDENTIFIER(_value) (((_value)>>22) & 0x3) ++#define CHIP_BONDING_92C_1T2R 0x1 ++#define CHIP_BONDING_88C_USB_MCARD 0x2 ++#define CHIP_BONDING_88C_USB_HP 0x1 ++ ++/* ------------------------------------------------------------------------- ++ * Channel Plan ++ * ------------------------------------------------------------------------- */ ++ ++ ++#define EFUSE_REAL_CONTENT_LEN 512 ++#define EFUSE_MAP_LEN 128 ++#define EFUSE_MAX_SECTION 16 ++#define EFUSE_IC_ID_OFFSET 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ ++#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN) ++/* ++ * ++ * To prevent out of boundary programming case, ++ * leave 1byte and program full section ++ * 9bytes + 1byt + 5bytes and pre 1byte. ++ * For worst case: ++ * | 1byte|----8bytes----|1byte|--5bytes--| ++ * | | Reserved(14bytes) | ++ * */ ++#define EFUSE_OOB_PROTECT_BYTES 15 /* PG data exclude header, dummy 6 bytes frome CP test and reserved 1byte. */ ++ ++#define EFUSE_REAL_CONTENT_LEN_88E 256 ++#define EFUSE_MAP_LEN_88E 512 ++#define EFUSE_MAX_SECTION_88E 64 ++#define EFUSE_MAX_WORD_UNIT_88E 4 ++#define EFUSE_IC_ID_OFFSET_88E 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ ++#define AVAILABLE_EFUSE_ADDR_88E(addr) (addr < EFUSE_REAL_CONTENT_LEN_88E) ++/* To prevent out of boundary programming case, leave 1byte and program full section ++ * 9bytes + 1byt + 5bytes and pre 1byte. ++ * For worst case: ++ * | 2byte|----8bytes----|1byte|--7bytes--| */ /* 92D */ ++#define EFUSE_OOB_PROTECT_BYTES_88E 18 /* PG data exclude header, dummy 7 bytes frome CP test and reserved 1byte. */ ++#define EFUSE_PROTECT_BYTES_BANK_88E 16 ++ ++ ++/* ******************************************************** ++ * EFUSE for BT definition ++ * ******************************************************** */ ++#define EFUSE_BT_REAL_CONTENT_LEN 1536 /* 512*3 */ ++#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ ++#define EFUSE_BT_MAX_SECTION 128 /* 1024/8 */ ++ ++#define EFUSE_PROTECT_BYTES_BANK 16 ++ ++#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) ++#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) ++ ++/* #define IS_MULTI_FUNC_CHIP(_Adapter) (((((PHAL_DATA_TYPE)(_Adapter->HalData))->MultiFunc) & (RT_MULTI_FUNC_BT|RT_MULTI_FUNC_GPS)) ? _TRUE : _FALSE) */ ++ ++/* #define RT_IS_FUNC_DISABLED(__pAdapter, __FuncBits) ( (__pAdapter)->DisabledFunctions & (__FuncBits) ) */ ++ ++#ifdef CONFIG_PCI_HCI ++ /* according to the define in the rtw_xmit.h, rtw_recv.h */ ++ #define TX_DESC_NUM_8188EE TXDESC_NUM /* 128 */ ++ #ifdef CONFIG_CONCURRENT_MODE ++ /*#define BE_QUEUE_TX_DESC_NUM_8188EE (TXDESC_NUM<<1)*/ /* 256 */ ++ #define BE_QUEUE_TX_DESC_NUM_8188EE ((TXDESC_NUM<<1)+(TXDESC_NUM>>1)) /* 320 */ ++ /*#define BE_QUEUE_TX_DESC_NUM_8188EE ((TXDESC_NUM<<1)+TXDESC_NUM)*/ /* 384 */ ++ #else ++ #define BE_QUEUE_TX_DESC_NUM_8188EE TXDESC_NUM /* 128 */ ++ /*#define BE_QUEUE_TX_DESC_NUM_8188EE (TXDESC_NUM+(TXDESC_NUM>>1)) */ /* 192 */ ++ #endif ++ ++ void InterruptRecognized8188EE(PADAPTER Adapter, PRT_ISR_CONTENT pIsrContent); ++ void UpdateInterruptMask8188EE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); ++#endif /* CONFIG_PCI_HCI */ ++ ++/* rtl8188e_hal_init.c */ ++ ++s32 rtl8188e_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); ++void _8051Reset88E(PADAPTER padapter); ++void rtl8188e_InitializeFirmwareVars(PADAPTER padapter); ++ ++ ++s32 InitLLTTable(PADAPTER padapter, u8 txpktbuf_bndy); ++ ++/* EFuse */ ++u8 GetEEPROMSize8188E(PADAPTER padapter); ++void Hal_InitPGData88E(PADAPTER padapter); ++void Hal_EfuseParseIDCode88E(PADAPTER padapter, u8 *hwinfo); ++void Hal_ReadTxPowerInfo88E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++ ++void Hal_EfuseParseEEPROMVer88E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void rtl8188e_EfuseParseChnlPlan(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseCustomerID88E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_ReadAntennaDiversity88E(PADAPTER pAdapter, u8 *PROMContent, BOOLEAN AutoLoadFail); ++void Hal_ReadThermalMeter_88E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++void Hal_EfuseParseXtal_8188E(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseBoardType88E(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_ReadPowerSavingMode88E(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_ReadPAType_8188E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++void Hal_ReadAmplifierType_8188E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++void Hal_ReadRFEType_8188E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++ ++BOOLEAN HalDetectPwrDownMode88E(PADAPTER Adapter); ++ ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++ void Hal_DetectWoWMode(PADAPTER pAdapter); ++#endif /* CONFIG_WOWLAN */ ++ ++ ++#ifdef CONFIG_RF_POWER_TRIM ++ void Hal_ReadRFGainOffset(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++#endif /*CONFIG_RF_POWER_TRIM*/ ++ ++void rtl8188e_init_default_value(_adapter *adapter); ++ ++void rtl8188e_set_hal_ops(struct hal_ops *pHalFunc); ++void init_hal_spec_8188e(_adapter *adapter); ++ ++/* register */ ++void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); ++ ++void rtl8188e_start_thread(_adapter *padapter); ++void rtl8188e_stop_thread(_adapter *padapter); ++ ++void rtw_IOL_cmd_tx_pkt_buf_dump(ADAPTER *Adapter, int data_len); ++#ifdef CONFIG_IOL_EFUSE_PATCH ++ s32 rtl8188e_iol_efuse_patch(PADAPTER padapter); ++#endif/* CONFIG_IOL_EFUSE_PATCH */ ++void _InitTransferPageSize(PADAPTER padapter); ++ ++void SetHwReg8188E(PADAPTER padapter, u8 variable, u8 *val); ++void GetHwReg8188E(PADAPTER padapter, u8 variable, u8 *val); ++ ++u8 ++GetHalDefVar8188E( ++ IN PADAPTER Adapter, ++ IN HAL_DEF_VARIABLE eVariable, ++ IN PVOID pValue ++); ++#ifdef CONFIG_GPIO_API ++int rtl8188e_GpioFuncCheck(PADAPTER adapter, u8 gpio_num); ++#endif ++#endif /* __RTL8188E_HAL_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_led.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_led.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_led.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,40 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188E_LED_H__ ++#define __RTL8188E_LED_H__ ++ ++ ++/* ******************************************************************************** ++ * Interface to manipulate LED objects. ++ * ******************************************************************************** */ ++#ifdef CONFIG_USB_HCI ++ void rtl8188eu_InitSwLeds(PADAPTER padapter); ++ void rtl8188eu_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_PCI_HCI ++ void rtl8188ee_InitSwLeds(PADAPTER padapter); ++ void rtl8188ee_DeInitSwLeds(PADAPTER padapter); ++#endif ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ void rtl8188es_InitSwLeds(PADAPTER padapter); ++ void rtl8188es_DeInitSwLeds(PADAPTER padapter); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_recv.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_recv.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_recv.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,170 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188E_RECV_H__ ++#define __RTL8188E_RECV_H__ ++ ++#define RECV_BLK_SZ 512 ++#define RECV_BLK_CNT 16 ++#define RECV_BLK_TH RECV_BLK_CNT ++ ++#if defined(CONFIG_USB_HCI) ++ ++ #ifndef MAX_RECVBUF_SZ ++ #ifdef PLATFORM_OS_CE ++ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ ++ #else ++ #ifndef CONFIG_MINIMAL_MEMORY_USAGE ++ /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ ++ /* #define MAX_RECVBUF_SZ (16384) */ /* 16K */ ++ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ ++ #ifdef CONFIG_PLATFORM_MSTAR ++ #define MAX_RECVBUF_SZ (8192) /* 8K */ ++ #else ++ #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ ++ #endif ++ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ ++ #else ++ #define MAX_RECVBUF_SZ (4000) /* about 4K */ ++ #endif ++ #endif ++ #endif /* !MAX_RECVBUF_SZ */ ++ ++#elif defined(CONFIG_PCI_HCI) ++ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ ++ /* #define MAX_RECVBUF_SZ (9100) */ ++ /* #else */ ++ #define MAX_RECVBUF_SZ (4000) /* about 4K ++ * #endif */ ++ ++ ++#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ ++ #define MAX_RECVBUF_SZ (10240) ++ ++#endif ++ ++/* Rx smooth factor */ ++#define Rx_Smooth_Factor (20) ++ ++#define TX_RPT1_PKT_LEN 8 ++ ++typedef struct rxreport_8188e { ++ /* Offset 0 */ ++ u32 pktlen:14; ++ u32 crc32:1; ++ u32 icverr:1; ++ u32 drvinfosize:4; ++ u32 security:3; ++ u32 qos:1; ++ u32 shift:2; ++ u32 physt:1; ++ u32 swdec:1; ++ u32 ls:1; ++ u32 fs:1; ++ u32 eor:1; ++ u32 own:1; ++ ++ /* Offset 4 */ ++ u32 macid:5; ++ u32 tid:4; ++ u32 hwrsvd:4; ++ u32 amsdu:1; ++ u32 paggr:1; ++ u32 faggr:1; ++ u32 a1fit:4; ++ u32 a2fit:4; ++ u32 pam:1; ++ u32 pwr:1; ++ u32 md:1; ++ u32 mf:1; ++ u32 type:2; ++ u32 mc:1; ++ u32 bc:1; ++ ++ /* Offset 8 */ ++ u32 seq:12; ++ u32 frag:4; ++ u32 nextpktlen:14; ++ u32 nextind:1; ++ u32 rsvd0831:1; ++ ++ /* Offset 12 */ ++ u32 rxmcs:6; ++ u32 rxht:1; ++ u32 gf:1; ++ u32 splcp:1; ++ u32 bw:1; ++ u32 htc:1; ++ u32 eosp:1; ++ u32 bssidfit:2; ++ u32 rpt_sel:2; ++ u32 rsvd1216:13; ++ u32 pattern_match:1; ++ u32 unicastwake:1; ++ u32 magicwake:1; ++ ++ /* Offset 16 */ ++ /* ++ u32 pattern0match:1; ++ u32 pattern1match:1; ++ u32 pattern2match:1; ++ u32 pattern3match:1; ++ u32 pattern4match:1; ++ u32 pattern5match:1; ++ u32 pattern6match:1; ++ u32 pattern7match:1; ++ u32 pattern8match:1; ++ u32 pattern9match:1; ++ u32 patternamatch:1; ++ u32 patternbmatch:1; ++ u32 patterncmatch:1; ++ u32 rsvd1613:19; ++ */ ++ u32 rsvd16; ++ ++ /* Offset 20 */ ++ u32 tsfl; ++ ++ /* Offset 24 */ ++ u32 bassn:12; ++ u32 bavld:1; ++ u32 rsvd2413:19; ++} RXREPORT, *PRXREPORT; ++ ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ s32 rtl8188es_init_recv_priv(PADAPTER padapter); ++ void rtl8188es_free_recv_priv(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ void rtl8188eu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); ++ s32 rtl8188eu_init_recv_priv(PADAPTER padapter); ++ void rtl8188eu_free_recv_priv(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ s32 rtl8188ee_init_recv_priv(PADAPTER padapter); ++ void rtl8188ee_free_recv_priv(PADAPTER padapter); ++#endif ++ ++void rtl8188e_query_rx_desc_status(union recv_frame *precvframe, struct recv_stat *prxstat); ++ ++#endif /* __RTL8188E_RECV_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_rf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_rf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_rf.h 2018-02-11 21:44:27.168146406 +0200 +@@ -0,0 +1,32 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188E_RF_H__ ++#define __RTL8188E_RF_H__ ++ ++ ++ ++int PHY_RF6052_Config8188E(IN PADAPTER Adapter); ++void rtl8188e_RF_ChangeTxPath(IN PADAPTER Adapter, ++ IN u16 DataRate); ++void rtl8188e_PHY_RF6052SetBandwidth( ++ IN PADAPTER Adapter, ++ IN CHANNEL_WIDTH Bandwidth); ++ ++#endif/* __RTL8188E_RF_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_spec.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_spec.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_spec.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,165 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ *******************************************************************************/ ++#ifndef __RTL8188E_SPEC_H__ ++#define __RTL8188E_SPEC_H__ ++ ++ ++/* ************************************************************ ++ * 8188E Regsiter offset definition ++ * ************************************************************ */ ++ ++ ++/* ************************************************************ ++ * ++ * ************************************************************ */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0000h ~ 0x00FFh System Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_BB_PAD_CTRL 0x0064 ++#define REG_HMEBOX_E0 0x0088 ++#define REG_HMEBOX_E1 0x008A ++#define REG_HMEBOX_E2 0x008C ++#define REG_HMEBOX_E3 0x008E ++#define REG_HMEBOX_EXT_0 0x01F0 ++#define REG_HMEBOX_EXT_1 0x01F4 ++#define REG_HMEBOX_EXT_2 0x01F8 ++#define REG_HMEBOX_EXT_3 0x01FC ++#define REG_HIMR_88E 0x00B0 /* RTL8188E */ ++#define REG_HISR_88E 0x00B4 /* RTL8188E */ ++#define REG_HIMRE_88E 0x00B8 /* RTL8188E */ ++#define REG_HISRE_88E 0x00BC /* RTL8188E */ ++#define REG_MACID_NO_LINK_0 0x0484 ++#define REG_MACID_NO_LINK_1 0x0488 ++#define REG_MACID_PAUSE_0 0x048c ++#define REG_MACID_PAUSE_1 0x0490 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0100h ~ 0x01FFh MACTOP General Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_PKTBUF_DBG_ADDR (REG_PKTBUF_DBG_CTRL) ++#define REG_RXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+2) ++#define REG_TXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+3) ++#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0200h ~ 0x027Fh TXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0280h ~ 0x02FFh RXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0300h ~ 0x03FFh PCIe ++ * ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0400h ~ 0x047Fh Protocol Configuration ++ * ++ * ----------------------------------------------------- */ ++#ifdef CONFIG_WOWLAN ++ #define REG_TXPKTBUF_IV_LOW 0x01a4 ++ #define REG_TXPKTBUF_IV_HIGH 0x01a8 ++#endif ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0500h ~ 0x05FFh EDCA Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0600h ~ 0x07FFh WMAC Configuration ++ * ++ * ----------------------------------------------------- */ ++#ifdef CONFIG_RF_POWER_TRIM ++ #define EEPROM_RF_GAIN_OFFSET 0xC1 ++ #define EEPROM_RF_GAIN_VAL 0xF6 ++ #define EEPROM_THERMAL_OFFSET 0xF5 ++#endif /*CONFIG_RF_POWER_TRIM*/ ++/* ---------------------------------------------------------------------------- ++ * 88E Driver Initialization Offload REG_FDHM0(Offset 0x88, 8 bits) ++ * ---------------------------------------------------------------------------- ++ * IOL config for REG_FDHM0(Reg0x88) */ ++#define CMD_INIT_LLT BIT0 ++#define CMD_READ_EFUSE_MAP BIT1 ++#define CMD_EFUSE_PATCH BIT2 ++#define CMD_IOCONFIG BIT3 ++#define CMD_INIT_LLT_ERR BIT4 ++#define CMD_READ_EFUSE_MAP_ERR BIT5 ++#define CMD_EFUSE_PATCH_ERR BIT6 ++#define CMD_IOCONFIG_ERR BIT7 ++ ++/* ----------------------------------------------------- ++ * ++ * Redifine register definition for compatibility ++ * ++ * ----------------------------------------------------- */ ++ ++/* TODO: use these definition when using REG_xxx naming rule. ++ * NOTE: DO NOT Remove these definition. Use later. */ ++#define ISR_88E REG_HISR_88E ++ ++#ifdef CONFIG_PCI_HCI ++ /* #define IMR_RX_MASK (IMR_ROK_88E|IMR_RDU_88E|IMR_RXFOVW_88E) */ ++ #define IMR_TX_MASK (IMR_VODOK_88E | IMR_VIDOK_88E | IMR_BEDOK_88E | IMR_BKDOK_88E | IMR_MGNTDOK_88E | IMR_HIGHDOK_88E | IMR_BCNDERR0_88E) ++ ++ #ifdef CONFIG_CONCURRENT_MODE ++ #define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_88E | IMR_TBDOK_88E | IMR_TBDER_88E | IMR_BCNDMAINT_E_88E) ++ #else ++ #define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_88E | IMR_TBDOK_88E | IMR_TBDER_88E) ++ #endif ++ ++ #define RT_AC_INT_MASKS (IMR_VIDOK_88E | IMR_VODOK_88E | IMR_BEDOK_88E | IMR_BKDOK_88E) ++#endif ++ ++ ++/* ******************************************************** ++ * General definitions ++ * ******************************************************** */ ++ ++#define MACID_NUM_88E 64 ++#define SEC_CAM_ENT_NUM_88E 32 ++#define HW_PORT_NUM_88E 2 ++#define NSS_NUM_88E 1 ++#define BAND_CAP_88E (BAND_CAP_2G) ++#define BW_CAP_88E (BW_CAP_20M | BW_CAP_40M) ++#define PROTO_CAP_88E (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) ++ ++/* ---------------------------------------------------------------------------- ++ * 8192C EEPROM/EFUSE share register definition. ++ * ---------------------------------------------------------------------------- */ ++ ++#define EFUSE_ACCESS_ON 0x69 /* For RTL8723 only. */ ++#define EFUSE_ACCESS_OFF 0x00 /* For RTL8723 only. */ ++ ++#endif /* __RTL8188E_SPEC_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_sreset.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_sreset.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_sreset.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,29 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL8188E_SRESET_H_ ++#define _RTL8188E_SRESET_H_ ++ ++#include ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ extern void rtl8188e_sreset_xmit_status_check(_adapter *padapter); ++ extern void rtl8188e_sreset_linked_status_check(_adapter *padapter); ++#endif ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_xmit.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_xmit.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_xmit.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,300 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188E_XMIT_H__ ++#define __RTL8188E_XMIT_H__ ++ ++ ++ ++ ++/* For 88e early mode */ ++#define SET_EARLYMODE_PKTNUM(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 3, __Value) ++#define SET_EARLYMODE_LEN0(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 12, __Value) ++#define SET_EARLYMODE_LEN1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 16, 12, __Value) ++#define SET_EARLYMODE_LEN2_1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 28, 4, __Value) ++#define SET_EARLYMODE_LEN2_2(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 8, __Value) ++#define SET_EARLYMODE_LEN3(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 8, 12, __Value) ++#define SET_EARLYMODE_LEN4(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 20, 12, __Value) ++ ++/* ++ * defined for TX DESC Operation ++ * */ ++ ++#define MAX_TID (15) ++ ++/* OFFSET 0 */ ++#define OFFSET_SZ 0 ++#define OFFSET_SHT 16 ++#define BMC BIT(24) ++#define LSG BIT(26) ++#define FSG BIT(27) ++#define OWN BIT(31) ++ ++ ++/* OFFSET 4 */ ++#define PKT_OFFSET_SZ 0 ++#define QSEL_SHT 8 ++#define RATE_ID_SHT 16 ++#define NAVUSEHDR BIT(20) ++#define SEC_TYPE_SHT 22 ++#define PKT_OFFSET_SHT 26 ++ ++/* OFFSET 8 */ ++#define AGG_EN BIT(12) ++#define AGG_BK BIT(16) ++#define AMPDU_DENSITY_SHT 20 ++#define ANTSEL_A BIT(24) ++#define ANTSEL_B BIT(25) ++#define TX_ANT_CCK_SHT 26 ++#define TX_ANTL_SHT 28 ++#define TX_ANT_HT_SHT 30 ++ ++/* OFFSET 12 */ ++#define SEQ_SHT 16 ++#define EN_HWSEQ BIT(31) ++ ++/* OFFSET 16 */ ++#define QOS BIT(6) ++#define HW_SSN BIT(7) ++#define USERATE BIT(8) ++#define DISDATAFB BIT(10) ++#define CTS_2_SELF BIT(11) ++#define RTS_EN BIT(12) ++#define HW_RTS_EN BIT(13) ++#define DATA_SHORT BIT(24) ++#define PWR_STATUS_SHT 15 ++#define DATA_SC_SHT 20 ++#define DATA_BW BIT(25) ++ ++/* OFFSET 20 */ ++#define RTY_LMT_EN BIT(17) ++ ++ ++/* OFFSET 20 */ ++#define SGI BIT(6) ++#define USB_TXAGG_NUM_SHT 24 ++ ++typedef struct txdesc_88e { ++ /* Offset 0 */ ++ u32 pktlen:16; ++ u32 offset:8; ++ u32 bmc:1; ++ u32 htc:1; ++ u32 ls:1; ++ u32 fs:1; ++ u32 linip:1; ++ u32 noacm:1; ++ u32 gf:1; ++ u32 own:1; ++ ++ /* Offset 4 */ ++ u32 macid:6; ++ u32 rsvd0406:2; ++ u32 qsel:5; ++ u32 rd_nav_ext:1; ++ u32 lsig_txop_en:1; ++ u32 pifs:1; ++ u32 rate_id:4; ++ u32 navusehdr:1; ++ u32 en_desc_id:1; ++ u32 sectype:2; ++ u32 rsvd0424:2; ++ u32 pkt_offset:5; /* unit: 8 bytes */ ++ u32 rsvd0431:1; ++ ++ /* Offset 8 */ ++ u32 rts_rc:6; ++ u32 data_rc:6; ++ u32 agg_en:1; ++ u32 rd_en:1; ++ u32 bar_rty_th:2; ++ u32 bk:1; ++ u32 morefrag:1; ++ u32 raw:1; ++ u32 ccx:1; ++ u32 ampdu_density:3; ++ u32 bt_null:1; ++ u32 ant_sel_a:1; ++ u32 ant_sel_b:1; ++ u32 tx_ant_cck:2; ++ u32 tx_antl:2; ++ u32 tx_ant_ht:2; ++ ++ /* Offset 12 */ ++ u32 nextheadpage:8; ++ u32 tailpage:8; ++ u32 seq:12; ++ u32 cpu_handle:1; ++ u32 tag1:1; ++ u32 trigger_int:1; ++ u32 hwseq_en:1; ++ ++ /* Offset 16 */ ++ u32 rtsrate:5; ++ u32 ap_dcfe:1; ++ u32 hwseq_sel:2; ++ u32 userate:1; ++ u32 disrtsfb:1; ++ u32 disdatafb:1; ++ u32 cts2self:1; ++ u32 rtsen:1; ++ u32 hw_rts_en:1; ++ u32 port_id:1; ++ u32 pwr_status:3; ++ u32 wait_dcts:1; ++ u32 cts2ap_en:1; ++ u32 data_sc:2; ++ u32 data_stbc:2; ++ u32 data_short:1; ++ u32 data_bw:1; ++ u32 rts_short:1; ++ u32 rts_bw:1; ++ u32 rts_sc:2; ++ u32 vcs_stbc:2; ++ ++ /* Offset 20 */ ++ u32 datarate:6; ++ u32 sgi:1; ++ u32 try_rate:1; ++ u32 data_ratefb_lmt:5; ++ u32 rts_ratefb_lmt:4; ++ u32 rty_lmt_en:1; ++ u32 data_rt_lmt:6; ++ u32 usb_txagg_num:8; ++ ++ /* Offset 24 */ ++ u32 txagg_a:5; ++ u32 txagg_b:5; ++ u32 use_max_len:1; ++ u32 max_agg_num:5; ++ u32 mcsg1_max_len:4; ++ u32 mcsg2_max_len:4; ++ u32 mcsg3_max_len:4; ++ u32 mcs7_sgi_max_len:4; ++ ++ /* Offset 28 */ ++ u32 checksum:16; /* TxBuffSize(PCIe)/CheckSum(USB) */ ++ u32 sw0:8; /* offset 30 */ ++ u32 sw1:4; ++ u32 mcs15_sgi_max_len:4; ++} TXDESC_8188E, *PTXDESC_8188E; ++ ++#define txdesc_set_ccx_sw_88e(txdesc, value) \ ++ do { \ ++ ((struct txdesc_88e *)(txdesc))->sw1 = (((value)>>8) & 0x0f); \ ++ ((struct txdesc_88e *)(txdesc))->sw0 = ((value) & 0xff); \ ++ } while (0) ++ ++struct txrpt_ccx_88e { ++ /* offset 0 */ ++ u8 tag1:1; ++ u8 pkt_num:3; ++ u8 txdma_underflow:1; ++ u8 int_bt:1; ++ u8 int_tri:1; ++ u8 int_ccx:1; ++ ++ /* offset 1 */ ++ u8 mac_id:6; ++ u8 pkt_ok:1; ++ u8 bmc:1; ++ ++ /* offset 2 */ ++ u8 retry_cnt:6; ++ u8 lifetime_over:1; ++ u8 retry_over:1; ++ ++ /* offset 3 */ ++ u8 ccx_qtime0; ++ u8 ccx_qtime1; ++ ++ /* offset 5 */ ++ u8 final_data_rate; ++ ++ /* offset 6 */ ++ u8 sw1:4; ++ u8 qsel:4; ++ ++ /* offset 7 */ ++ u8 sw0; ++}; ++ ++#define txrpt_ccx_sw_88e(txrpt_ccx) ((txrpt_ccx)->sw0 + ((txrpt_ccx)->sw1<<8)) ++#define txrpt_ccx_qtime_88e(txrpt_ccx) ((txrpt_ccx)->ccx_qtime0+((txrpt_ccx)->ccx_qtime1<<8)) ++ ++#define SET_TX_DESC_SEC_TYPE_8188E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) ++ ++void rtl8188e_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, ++ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); ++void rtl8188e_cal_txdesc_chksum(struct tx_desc *ptxdesc); ++#if defined(CONFIG_CONCURRENT_MODE) ++ void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); ++#endif ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ s32 rtl8188es_init_xmit_priv(PADAPTER padapter); ++ void rtl8188es_free_xmit_priv(PADAPTER padapter); ++ s32 rtl8188es_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8188es_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8188es_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ thread_return rtl8188es_xmit_thread(thread_context context); ++ s32 rtl8188es_xmit_buf_handler(PADAPTER padapter); ++ ++ #ifdef CONFIG_SDIO_TX_TASKLET ++ void rtl8188es_xmit_tasklet(void *priv); ++ #endif ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ s32 rtl8188eu_init_xmit_priv(PADAPTER padapter); ++ void rtl8188eu_free_xmit_priv(PADAPTER padapter); ++ s32 rtl8188eu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8188eu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8188eu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8188eu_xmit_buf_handler(PADAPTER padapter); ++ void rtl8188eu_xmit_tasklet(void *priv); ++ s32 rtl8188eu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ s32 rtl8188ee_init_xmit_priv(PADAPTER padapter); ++ void rtl8188ee_free_xmit_priv(PADAPTER padapter); ++ void rtl8188ee_xmitframe_resume(_adapter *padapter); ++ s32 rtl8188ee_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8188ee_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8188ee_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ void rtl8188ee_xmit_tasklet(void *priv); ++#endif ++ ++ ++ ++#ifdef CONFIG_TX_EARLY_MODE ++ void UpdateEarlyModeInfo8188E(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++#endif ++ ++#ifdef CONFIG_XMIT_ACK ++ void dump_txrpt_ccx_88e(void *buf); ++ void handle_txrpt_ccx_88e(_adapter *adapter, u8 *buf); ++#else ++ #define dump_txrpt_ccx_88e(buf) do {} while (0) ++ #define handle_txrpt_ccx_88e(adapter, buf) do {} while (0) ++#endif /* CONFIG_XMIT_ACK */ ++ ++void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, struct tx_desc *ptxdesc); ++#endif /* __RTL8188E_XMIT_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_cmd.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_cmd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_cmd.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,219 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188F_CMD_H__ ++#define __RTL8188F_CMD_H__ ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ ++ * --------------------------------------------------------------------------------------------------------- */ ++ ++enum h2c_cmd_8188F { ++ /* Common Class: 000 */ ++ H2C_8188F_RSVD_PAGE = 0x00, ++ H2C_8188F_MEDIA_STATUS_RPT = 0x01, ++ H2C_8188F_SCAN_ENABLE = 0x02, ++ H2C_8188F_KEEP_ALIVE = 0x03, ++ H2C_8188F_DISCON_DECISION = 0x04, ++ H2C_8188F_PSD_OFFLOAD = 0x05, ++ H2C_8188F_AP_OFFLOAD = 0x08, ++ H2C_8188F_BCN_RSVDPAGE = 0x09, ++ H2C_8188F_PROBERSP_RSVDPAGE = 0x0A, ++ H2C_8188F_FCS_RSVDPAGE = 0x10, ++ H2C_8188F_FCS_INFO = 0x11, ++ H2C_8188F_AP_WOW_GPIO_CTRL = 0x13, ++ ++ /* PoweSave Class: 001 */ ++ H2C_8188F_SET_PWR_MODE = 0x20, ++ H2C_8188F_PS_TUNING_PARA = 0x21, ++ H2C_8188F_PS_TUNING_PARA2 = 0x22, ++ H2C_8188F_P2P_LPS_PARAM = 0x23, ++ H2C_8188F_P2P_PS_OFFLOAD = 0x24, ++ H2C_8188F_PS_SCAN_ENABLE = 0x25, ++ H2C_8188F_SAP_PS_ = 0x26, ++ H2C_8188F_INACTIVE_PS_ = 0x27, /* Inactive_PS */ ++ H2C_8188F_FWLPS_IN_IPS_ = 0x28, ++ ++ /* Dynamic Mechanism Class: 010 */ ++ H2C_8188F_MACID_CFG = 0x40, ++ H2C_8188F_TXBF = 0x41, ++ H2C_8188F_RSSI_SETTING = 0x42, ++ H2C_8188F_AP_REQ_TXRPT = 0x43, ++ H2C_8188F_INIT_RATE_COLLECT = 0x44, ++ H2C_8188F_RA_PARA_ADJUST = 0x46, ++ ++ /* BT Class: 011 */ ++ H2C_8188F_B_TYPE_TDMA = 0x60, ++ H2C_8188F_BT_INFO = 0x61, ++ H2C_8188F_FORCE_BT_TXPWR = 0x62, ++ H2C_8188F_BT_IGNORE_WLANACT = 0x63, ++ H2C_8188F_DAC_SWING_VALUE = 0x64, ++ H2C_8188F_ANT_SEL_RSV = 0x65, ++ H2C_8188F_WL_OPMODE = 0x66, ++ H2C_8188F_BT_MP_OPER = 0x67, ++ H2C_8188F_BT_CONTROL = 0x68, ++ H2C_8188F_BT_WIFI_CTRL = 0x69, ++ H2C_8188F_BT_FW_PATCH = 0x6A, ++ H2C_8188F_BT_WLAN_CALIBRATION = 0x6D, ++ ++ /* WOWLAN Class: 100 */ ++ H2C_8188F_WOWLAN = 0x80, ++ H2C_8188F_REMOTE_WAKE_CTRL = 0x81, ++ H2C_8188F_AOAC_GLOBAL_INFO = 0x82, ++ H2C_8188F_AOAC_RSVD_PAGE = 0x83, ++ H2C_8188F_AOAC_RSVD_PAGE2 = 0x84, ++ H2C_8188F_D0_SCAN_OFFLOAD_CTRL = 0x85, ++ H2C_8188F_D0_SCAN_OFFLOAD_INFO = 0x86, ++ H2C_8188F_CHNL_SWITCH_OFFLOAD = 0x87, ++ H2C_8188F_P2P_OFFLOAD_RSVD_PAGE = 0x8A, ++ H2C_8188F_P2P_OFFLOAD = 0x8B, ++ ++ H2C_8188F_RESET_TSF = 0xC0, ++ H2C_8188F_MAXID, ++}; ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- ++ * _RSVDPAGE_LOC_CMD_0x00 */ ++#define SET_8188F_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8188F_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_8188F_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8188F_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8188F_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++ ++/* _KEEP_ALIVE_CMD_0x03 */ ++#define SET_8188F_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8188F_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8188F_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_8188F_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++ ++/* _DISCONNECT_DECISION_CMD_0x04 */ ++#define SET_8188F_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8188F_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8188F_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_8188F_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) ++ ++/* _PWR_MOD_CMD_0x20 */ ++#define SET_8188F_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8188F_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) ++#define SET_8188F_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) ++#define SET_8188F_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8188F_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8188F_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) ++#define SET_8188F_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#define SET_8188F_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++ ++#define GET_8188F_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) ++ ++/* _PS_TUNE_PARAM_CMD_0x21 */ ++#define SET_8188F_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8188F_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_8188F_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) ++#define SET_8188F_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) ++#define SET_8188F_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++ ++/* _MACID_CFG_CMD_0x40 */ ++#define SET_8188F_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8188F_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) ++#define SET_8188F_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) ++#define SET_8188F_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) ++#define SET_8188F_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) ++#define SET_8188F_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) ++#define SET_8188F_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) ++#define SET_8188F_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) ++#define SET_8188F_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++#define SET_8188F_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) ++#define SET_8188F_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) ++#define SET_8188F_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) ++ ++/* _RSSI_SETTING_CMD_0x42 */ ++#define SET_8188F_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8188F_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) ++#define SET_8188F_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++ ++/* _AP_REQ_TXRPT_CMD_0x43 */ ++#define SET_8188F_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8188F_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++ ++/* _FORCE_BT_TXPWR_CMD_0x62 */ ++#define SET_8188F_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++ ++/* _FORCE_BT_MP_OPER_CMD_0x67 */ ++#define SET_8188F_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) ++#define SET_8188F_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) ++#define SET_8188F_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_8188F_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) ++#define SET_8188F_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++#define SET_8188F_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) ++ ++/* _BT_FW_PATCH_0x6A */ ++#define SET_8188F_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) ++#define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++ ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ------------------------------------------- Structure -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- */ ++ ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- Function Statement -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- */ ++ ++/* host message to firmware cmd */ ++void rtl8188f_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); ++void rtl8188f_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); ++void rtl8188f_set_rssi_cmd(PADAPTER padapter, u8 *param); ++void rtl8188f_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); ++/* s32 rtl8188f_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ ++void rtl8188f_set_FwPsTuneParam_cmd(PADAPTER padapter); ++void rtl8188f_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); ++void rtl8188f_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); ++void rtl8188f_download_rsvd_page(PADAPTER padapter, u8 mstatus); ++#ifdef CONFIG_BT_COEXIST ++ void rtl8188f_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); ++#endif /* CONFIG_BT_COEXIST */ ++#ifdef CONFIG_P2P ++void rtl8188f_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); ++#endif /* CONFIG_P2P */ ++ ++void CheckFwRsvdPageContent(PADAPTER padapter); ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_TDLS_CH_SW ++void rtl8188f_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); ++#endif ++#endif ++ ++#ifdef CONFIG_P2P_WOWLAN ++void rtl8188f_set_p2p_wowlan_offload_cmd(PADAPTER padapter); ++#endif ++ ++void rtl8188f_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); ++ ++#ifdef CONFIG_TSF_RESET_OFFLOAD ++u8 rtl8188f_reset_tsf(_adapter *padapter, u8 reset_port); ++#endif /* CONFIG_TSF_RESET_OFFLOAD */ ++s32 FillH2CCmd8188F(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); ++u8 GetTxBufferRsvdPageNum8188F(_adapter *padapter, bool wowlan); ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_dm.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_dm.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_dm.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,47 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188F_DM_H__ ++#define __RTL8188F_DM_H__ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for 8188F dynamic mechanism only ++ * ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * structure and define ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * function prototype ++ * ************************************************************ */ ++ ++void rtl8188f_init_dm_priv(PADAPTER padapter); ++void rtl8188f_deinit_dm_priv(PADAPTER padapter); ++ ++void rtl8188f_InitHalDm(PADAPTER padapter); ++void rtl8188f_HalDmWatchDog(PADAPTER padapter); ++void rtl8188f_HalDmWatchDog_in_LPS(PADAPTER padapter); ++void rtl8188f_hal_dm_in_lps(PADAPTER padapter); ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_hal.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,271 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188F_HAL_H__ ++#define __RTL8188F_HAL_H__ ++ ++#include "hal_data.h" ++ ++#include "rtl8188f_spec.h" ++#include "rtl8188f_rf.h" ++#include "rtl8188f_dm.h" ++#include "rtl8188f_recv.h" ++#include "rtl8188f_xmit.h" ++#include "rtl8188f_cmd.h" ++#include "rtl8188f_led.h" ++#include "Hal8188FPwrSeq.h" ++#include "Hal8188FPhyReg.h" ++#include "Hal8188FPhyCfg.h" ++#ifdef DBG_CONFIG_ERROR_DETECT ++#include "rtl8188f_sreset.h" ++#endif ++ ++#define FW_8188F_SIZE 0x8000 ++#define FW_8188F_START_ADDRESS 0x1000 ++#define FW_8188F_END_ADDRESS 0x1FFF /* 0x5FFF */ ++ ++#define IS_FW_HEADER_EXIST_8188F(_pFwHdr) ((le16_to_cpu(_pFwHdr->Signature) & 0xFFF0) == 0x88F0) ++ ++typedef struct _RT_FIRMWARE { ++ FIRMWARE_SOURCE eFWSource; ++#ifdef CONFIG_EMBEDDED_FWIMG ++ u8 *szFwBuffer; ++#else ++ u8 szFwBuffer[FW_8188F_SIZE]; ++#endif ++ u32 ulFwLength; ++} RT_FIRMWARE_8188F, *PRT_FIRMWARE_8188F; ++ ++/* ++ * This structure must be cared byte-ordering ++ * ++ * Added by tynli. 2009.12.04. */ ++typedef struct _RT_8188F_FIRMWARE_HDR { ++ /* 8-byte alinment required */ ++ ++ /* --- LONG WORD 0 ---- */ ++ u16 Signature; /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ ++ u8 Category; /* AP/NIC and USB/PCI */ ++ u8 Function; /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ ++ u16 Version; /* FW Version */ ++ u16 Subversion; /* FW Subversion, default 0x00 */ ++ ++ /* --- LONG WORD 1 ---- */ ++ u8 Month; /* Release time Month field */ ++ u8 Date; /* Release time Date field */ ++ u8 Hour; /* Release time Hour field */ ++ u8 Minute; /* Release time Minute field */ ++ u16 RamCodeSize; /* The size of RAM code */ ++ u16 Rsvd2; ++ ++ /* --- LONG WORD 2 ---- */ ++ u32 SvnIdx; /* The SVN entry index */ ++ u32 Rsvd3; ++ ++ /* --- LONG WORD 3 ---- */ ++ u32 Rsvd4; ++ u32 Rsvd5; ++} RT_8188F_FIRMWARE_HDR, *PRT_8188F_FIRMWARE_HDR; ++ ++#define DRIVER_EARLY_INT_TIME_8188F 0x05 ++#define BCN_DMA_ATIME_INT_TIME_8188F 0x02 ++ ++/* for 8188F ++ * TX 32K, RX 16K, Page size 128B for TX, 8B for RX */ ++#define PAGE_SIZE_TX_8188F 128 ++#define PAGE_SIZE_RX_8188F 8 ++ ++#define RX_DMA_SIZE_8188F 0x4000 /* 16K */ ++#ifdef CONFIG_FW_C2H_DEBUG ++ #define RX_DMA_RESERVED_SIZE_8188F 0x100 /* 256B, reserved for c2h debug message */ ++#else ++ #define RX_DMA_RESERVED_SIZE_8188F 0x80 /* 128B, reserved for tx report */ ++#endif ++ ++#ifdef CONFIG_WOWLAN ++ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ ++#else ++ #define RESV_FMWF 0 ++#endif ++ ++#define RX_DMA_BOUNDARY_8188F (RX_DMA_SIZE_8188F - RX_DMA_RESERVED_SIZE_8188F - 1) ++ ++/* Note: We will divide number of page equally for each queue other than public queue! */ ++ ++/* For General Reserved Page Number(Beacon Queue is reserved page) ++ * Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 */ ++#define BCNQ_PAGE_NUM_8188F 0x08 ++#ifdef CONFIG_CONCURRENT_MODE ++ #define BCNQ1_PAGE_NUM_8188F 0x08 /* 0x04 */ ++#else ++ #define BCNQ1_PAGE_NUM_8188F 0x00 ++#endif ++ ++#ifdef CONFIG_PNO_SUPPORT ++#undef BCNQ1_PAGE_NUM_8188F ++#define BCNQ1_PAGE_NUM_8188F 0x00 /* 0x04 */ ++#endif ++ ++/* For WoWLan , more reserved page ++ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ ++#ifdef CONFIG_WOWLAN ++ #define WOWLAN_PAGE_NUM_8188F 0x07 ++#else ++ #define WOWLAN_PAGE_NUM_8188F 0x00 ++#endif ++ ++#ifdef CONFIG_PNO_SUPPORT ++#undef WOWLAN_PAGE_NUM_8188F ++#define WOWLAN_PAGE_NUM_8188F 0x15 ++#endif ++ ++#ifdef CONFIG_AP_WOWLAN ++#define AP_WOWLAN_PAGE_NUM_8188F 0x02 ++#endif ++ ++#define TX_TOTAL_PAGE_NUMBER_8188F (0xFF - BCNQ_PAGE_NUM_8188F - BCNQ1_PAGE_NUM_8188F - WOWLAN_PAGE_NUM_8188F) ++#define TX_PAGE_BOUNDARY_8188F (TX_TOTAL_PAGE_NUMBER_8188F + 1) ++ ++#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8188F TX_TOTAL_PAGE_NUMBER_8188F ++#define WMM_NORMAL_TX_PAGE_BOUNDARY_8188F (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8188F + 1) ++ ++/* For Normal Chip Setting ++ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8188F */ ++#define NORMAL_PAGE_NUM_HPQ_8188F 0x0C ++#define NORMAL_PAGE_NUM_LPQ_8188F 0x02 ++#define NORMAL_PAGE_NUM_NPQ_8188F 0x02 ++ ++/* Note: For Normal Chip Setting, modify later */ ++#define WMM_NORMAL_PAGE_NUM_HPQ_8188F 0x30 ++#define WMM_NORMAL_PAGE_NUM_LPQ_8188F 0x20 ++#define WMM_NORMAL_PAGE_NUM_NPQ_8188F 0x20 ++ ++ ++#include "HalVerDef.h" ++#include "hal_com.h" ++ ++#define EFUSE_OOB_PROTECT_BYTES 15 ++ ++#define HAL_EFUSE_MEMORY ++ ++#define HWSET_MAX_SIZE_8188F 512 ++#define EFUSE_REAL_CONTENT_LEN_8188F 512 ++#define EFUSE_MAP_LEN_8188F 512 ++#define EFUSE_MAX_SECTION_8188F 64 ++ ++#define EFUSE_IC_ID_OFFSET 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ ++#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8188F) ++ ++#define EFUSE_ACCESS_ON 0x69 /* For RTL8188 only. */ ++#define EFUSE_ACCESS_OFF 0x00 /* For RTL8188 only. */ ++ ++/* ******************************************************** ++ * EFUSE for BT definition ++ * ******************************************************** */ ++#define EFUSE_BT_REAL_BANK_CONTENT_LEN 512 ++#define EFUSE_BT_REAL_CONTENT_LEN 1536 /* 512*3 */ ++#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ ++#define EFUSE_BT_MAX_SECTION 128 /* 1024/8 */ ++ ++#define EFUSE_PROTECT_BYTES_BANK 16 ++ ++#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) ++#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) ++ ++/* rtl8188a_hal_init.c */ ++s32 rtl8188f_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); ++void rtl8188f_FirmwareSelfReset(PADAPTER padapter); ++void rtl8188f_InitializeFirmwareVars(PADAPTER padapter); ++ ++void rtl8188f_InitAntenna_Selection(PADAPTER padapter); ++void rtl8188f_DeinitAntenna_Selection(PADAPTER padapter); ++void rtl8188f_CheckAntenna_Selection(PADAPTER padapter); ++void rtl8188f_init_default_value(PADAPTER padapter); ++ ++s32 rtl8188f_InitLLTTable(PADAPTER padapter); ++ ++s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU); ++s32 CardDisableWithoutHWSM(PADAPTER padapter); ++ ++/* EFuse */ ++u8 GetEEPROMSize8188F(PADAPTER padapter); ++void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); ++void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); ++void Hal_EfuseParseTxPowerInfo_8188F(PADAPTER padapter, u8 *PROMContent, BOOLEAN AutoLoadFail); ++/* void Hal_EfuseParseBTCoexistInfo_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); */ ++void Hal_EfuseParseEEPROMVer_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseChnlPlan_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseCustomerID_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParsePowerSavingMode_8188F(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseAntennaDiversity_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseXtal_8188F(PADAPTER pAdapter, u8 *hwinfo, u8 AutoLoadFail); ++void Hal_EfuseParseThermalMeter_8188F(PADAPTER padapter, u8 *hwinfo, u8 AutoLoadFail); ++void Hal_EfuseParseKFreeData_8188F(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++ ++#if 0 /* Do not need for rtl8188f */ ++VOID Hal_EfuseParseVoltage_8188F(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++#endif ++ ++void rtl8188f_set_pll_ref_clk_sel(_adapter *adapter, u8 sel); ++ ++void rtl8188f_set_hal_ops(struct hal_ops *pHalFunc); ++void init_hal_spec_8188f(_adapter *adapter); ++void SetHwReg8188F(PADAPTER padapter, u8 variable, u8 *val); ++void GetHwReg8188F(PADAPTER padapter, u8 variable, u8 *val); ++u8 SetHalDefVar8188F(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++u8 GetHalDefVar8188F(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++ ++/* register */ ++void rtl8188f_InitBeaconParameters(PADAPTER padapter); ++void rtl8188f_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); ++void _InitBurstPktLen_8188FS(PADAPTER Adapter); ++void _8051Reset8188(PADAPTER padapter); ++#ifdef CONFIG_WOWLAN ++void Hal_DetectWoWMode(PADAPTER pAdapter); ++#endif /* CONFIG_WOWLAN */ ++ ++void rtl8188f_start_thread(_adapter *padapter); ++void rtl8188f_stop_thread(_adapter *padapter); ++ ++#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) ++ void rtl8188fs_init_checkbthang_workqueue(_adapter *adapter); ++ void rtl8188fs_free_checkbthang_workqueue(_adapter *adapter); ++ void rtl8188fs_cancle_checkbthang_workqueue(_adapter *adapter); ++ void rtl8188fs_hal_check_bt_hang(_adapter *adapter); ++#endif ++ ++#ifdef CONFIG_GPIO_WAKEUP ++void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); ++#endif ++ ++#ifdef CONFIG_MP_INCLUDED ++int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); ++#endif ++ ++void CCX_FwC2HTxRpt_8188f(PADAPTER padapter, u8 *pdata, u8 len); ++ ++u8 MRateToHwRate8188F(u8 rate); ++u8 HwRateToMRate8188F(u8 rate); ++ ++#ifdef CONFIG_PCI_HCI ++BOOLEAN InterruptRecognized8188FE(PADAPTER Adapter); ++VOID UpdateInterruptMask8188FE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_led.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_led.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_led.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,48 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188F_LED_H__ ++#define __RTL8188F_LED_H__ ++ ++#include ++#include ++#include ++ ++ ++/* ******************************************************************************** ++ * Interface to manipulate LED objects. ++ * ******************************************************************************** */ ++#ifdef CONFIG_USB_HCI ++void rtl8188fu_InitSwLeds(PADAPTER padapter); ++void rtl8188fu_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_SDIO_HCI ++void rtl8188fs_InitSwLeds(PADAPTER padapter); ++void rtl8188fs_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_GSPI_HCI ++void rtl8188fs_InitSwLeds(PADAPTER padapter); ++void rtl8188fs_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_PCI_HCI ++void rtl8188fe_InitSwLeds(PADAPTER padapter); ++void rtl8188fe_DeInitSwLeds(PADAPTER padapter); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_recv.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_recv.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_recv.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,72 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188F_RECV_H__ ++#define __RTL8188F_RECV_H__ ++ ++#if defined(CONFIG_USB_HCI) ++ #ifndef MAX_RECVBUF_SZ ++ #ifdef PLATFORM_OS_CE ++ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ ++ #else ++ #ifdef CONFIG_MINIMAL_MEMORY_USAGE ++ #define MAX_RECVBUF_SZ (4000) /* about 4K */ ++ #else ++ #ifdef CONFIG_PLATFORM_MSTAR ++ #define MAX_RECVBUF_SZ (8192) /* 8K */ ++ #elif defined(CONFIG_PLATFORM_HISILICON) ++ #define MAX_RECVBUF_SZ (16384) /* 16k */ ++ #else ++ #define MAX_RECVBUF_SZ (32768) /* 32k */ ++ #endif ++ /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ ++ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ ++ /* #define MAX_RECVBUF_SZ (16384) */ /* 16k - 92E RX BUF :16K */ ++ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ ++ #endif ++ #endif ++ #endif /* !MAX_RECVBUF_SZ */ ++#elif defined(CONFIG_PCI_HCI) ++ #define MAX_RECVBUF_SZ (4000) /* about 4K */ ++#elif defined(CONFIG_SDIO_HCI) ++ #define MAX_RECVBUF_SZ (RX_DMA_BOUNDARY_8188F + 1) ++#endif /* CONFIG_SDIO_HCI */ ++ ++/* Rx smooth factor */ ++#define Rx_Smooth_Factor (20) ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++s32 rtl8188fs_init_recv_priv(PADAPTER padapter); ++void rtl8188fs_free_recv_priv(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_USB_HCI ++int rtl8188fu_init_recv_priv(_adapter *padapter); ++void rtl8188fu_free_recv_priv(_adapter *padapter); ++void rtl8188fu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++s32 rtl8188fe_init_recv_priv(PADAPTER padapter); ++void rtl8188fe_free_recv_priv(PADAPTER padapter); ++#endif ++ ++void rtl8188f_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); ++ ++#endif /* __RTL8188F_RECV_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_rf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_rf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_rf.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,30 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188F_RF_H__ ++#define __RTL8188F_RF_H__ ++ ++int PHY_RF6052_Config8188F(IN PADAPTER Adapter); ++ ++VOID ++PHY_RF6052SetBandwidth8188F( ++ IN PADAPTER Adapter, ++ IN CHANNEL_WIDTH Bandwidth); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_spec.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_spec.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_spec.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,303 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ *******************************************************************************/ ++#ifndef __RTL8188F_SPEC_H__ ++#define __RTL8188F_SPEC_H__ ++ ++#include ++ ++ ++#define HAL_NAV_UPPER_UNIT_8188F 128 /* micro-second */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0000h ~ 0x00FFh System Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_RSV_CTRL_8188F 0x001C /* 3 Byte */ ++#define REG_BT_WIFI_ANTENNA_SWITCH_8188F 0x0038 ++#define REG_HSISR_8188F 0x005c ++#define REG_PAD_CTRL1_8188F 0x0064 ++#define REG_AFE_CTRL_4_8188F 0x0078 ++#define REG_HMEBOX_DBG_0_8188F 0x0088 ++#define REG_HMEBOX_DBG_1_8188F 0x008A ++#define REG_HMEBOX_DBG_2_8188F 0x008C ++#define REG_HMEBOX_DBG_3_8188F 0x008E ++#define REG_HIMR0_8188F 0x00B0 ++#define REG_HISR0_8188F 0x00B4 ++#define REG_HIMR1_8188F 0x00B8 ++#define REG_HISR1_8188F 0x00BC ++#define REG_PMC_DBG_CTRL2_8188F 0x00CC ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0100h ~ 0x01FFh MACTOP General Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_C2HEVT_CMD_ID_8188F 0x01A0 ++#define REG_C2HEVT_CMD_LEN_8188F 0x01AE ++#define REG_WOWLAN_WAKE_REASON 0x01C7 ++#define REG_WOWLAN_GTK_DBG1 0x630 ++#define REG_WOWLAN_GTK_DBG2 0x634 ++ ++#define REG_HMEBOX_EXT0_8188F 0x01F0 ++#define REG_HMEBOX_EXT1_8188F 0x01F4 ++#define REG_HMEBOX_EXT2_8188F 0x01F8 ++#define REG_HMEBOX_EXT3_8188F 0x01FC ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0200h ~ 0x027Fh TXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0280h ~ 0x02FFh RXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_RXDMA_CONTROL_8188F 0x0286 /* Control the RX DMA. */ ++#define REG_RXDMA_MODE_CTRL_8188F 0x0290 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0300h ~ 0x03FFh PCIe ++ * ++ * ----------------------------------------------------- */ ++#define REG_PCIE_CTRL_REG_8188F 0x0300 ++#define REG_INT_MIG_8188F 0x0304 /* Interrupt Migration */ ++#define REG_BCNQ_DESA_8188F 0x0308 /* TX Beacon Descriptor Address */ ++#define REG_HQ_DESA_8188F 0x0310 /* TX High Queue Descriptor Address */ ++#define REG_MGQ_DESA_8188F 0x0318 /* TX Manage Queue Descriptor Address */ ++#define REG_VOQ_DESA_8188F 0x0320 /* TX VO Queue Descriptor Address */ ++#define REG_VIQ_DESA_8188F 0x0328 /* TX VI Queue Descriptor Address */ ++#define REG_BEQ_DESA_8188F 0x0330 /* TX BE Queue Descriptor Address */ ++#define REG_BKQ_DESA_8188F 0x0338 /* TX BK Queue Descriptor Address */ ++#define REG_RX_DESA_8188F 0x0340 /* RX Queue Descriptor Address */ ++#define REG_DBI_WDATA_8188F 0x0348 /* DBI Write Data */ ++#define REG_DBI_RDATA_8188F 0x034C /* DBI Read Data */ ++#define REG_DBI_ADDR_8188F 0x0350 /* DBI Address */ ++#define REG_DBI_FLAG_8188F 0x0352 /* DBI Read/Write Flag */ ++#define REG_MDIO_WDATA_8188F 0x0354 /* MDIO for Write PCIE PHY */ ++#define REG_MDIO_RDATA_8188F 0x0356 /* MDIO for Reads PCIE PHY */ ++#define REG_MDIO_CTL_8188F 0x0358 /* MDIO for Control */ ++#define REG_DBG_SEL_8188F 0x0360 /* Debug Selection Register */ ++#define REG_PCIE_HRPWM_8188F 0x0361 /* PCIe RPWM */ ++#define REG_PCIE_HCPWM_8188F 0x0363 /* PCIe CPWM */ ++#define REG_PCIE_MULTIFET_CTRL_8188F 0x036A /* PCIE Multi-Fethc Control */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0400h ~ 0x047Fh Protocol Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_TXPKTBUF_BCNQ_BDNY_8188F 0x0424 ++#define REG_TXPKTBUF_MGQ_BDNY_8188F 0x0425 ++#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8188F 0x045D ++#ifdef CONFIG_WOWLAN ++#define REG_TXPKTBUF_IV_LOW 0x0484 ++#define REG_TXPKTBUF_IV_HIGH 0x0488 ++#endif ++#define REG_AMPDU_BURST_MODE_8188F 0x04BC ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0500h ~ 0x05FFh EDCA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_SECONDARY_CCA_CTRL_8188F 0x0577 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0600h ~ 0x07FFh WMAC Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++ ++/* ************************************************************ ++ * SDIO Bus Specification ++ * ************************************************************ */ ++ ++/* ----------------------------------------------------- ++ * SDIO CMD Address Mapping ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * I/O bus domain (Host) ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * SDIO register ++ * ----------------------------------------------------- */ ++#define SDIO_REG_HIQ_FREEPG_8188F 0x0020 ++#define SDIO_REG_MID_FREEPG_8188F 0x0022 ++#define SDIO_REG_LOW_FREEPG_8188F 0x0024 ++#define SDIO_REG_PUB_FREEPG_8188F 0x0026 ++#define SDIO_REG_EXQ_FREEPG_8188F 0x0028 ++#define SDIO_REG_AC_OQT_FREEPG_8188F 0x002A ++#define SDIO_REG_NOAC_OQT_FREEPG_8188F 0x002B ++ ++#define SDIO_REG_HCPWM1_8188F 0x0038 ++ ++/* indirect access */ ++#define SDIO_REG_INDIRECT_REG_CFG_8188F 0x40 ++#define SET_INDIRECT_REG_ADDR(_cmd, _addr) SET_BITS_TO_LE_2BYTE(((u8 *)(_cmd)) + 0, 0, 16, (_addr)) ++#define SET_INDIRECT_REG_SIZE_1BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 0) ++#define SET_INDIRECT_REG_SIZE_2BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 1) ++#define SET_INDIRECT_REG_SIZE_4BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 2) ++#define SET_INDIRECT_REG_WRITE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 2, 1, 1) ++#define SET_INDIRECT_REG_READ(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 3, 1, 1) ++#define GET_INDIRECT_REG_RDY(_cmd) LE_BITS_TO_1BYTE(((u8 *)(_cmd)) + 2, 4, 1) ++ ++#define SDIO_REG_INDIRECT_REG_DATA_8188F 0x44 ++ ++/* **************************************************************************** ++ * 8188 Regsiter Bit and Content definition ++ * **************************************************************************** */ ++ ++/* 2 HSISR ++ * interrupt mask which needs to clear */ ++#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ ++ HSISR_SPS_OCP_INT |\ ++ HSISR_RON_INT |\ ++ HSISR_PDNINT |\ ++ HSISR_GPIO9_INT) ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0100h ~ 0x01FFh MACTOP General Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0200h ~ 0x027Fh TXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0280h ~ 0x02FFh RXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define BIT_USB_RXDMA_AGG_EN BIT(31) ++#define RXDMA_AGG_MODE_EN BIT(1) ++ ++#ifdef CONFIG_WOWLAN ++#define RXPKT_RELEASE_POLL BIT(16) ++#define RXDMA_IDLE BIT(17) ++#define RW_RELEASE_EN BIT(18) ++#endif ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0400h ~ 0x047Fh Protocol Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* ---------------------------------------------------------------------------- ++ * 8188F REG_CCK_CHECK (offset 0x454) ++ * ---------------------------------------------------------------------------- */ ++#define BIT_BCN_PORT_SEL BIT5 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0500h ~ 0x05FFh EDCA Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0600h ~ 0x07FFh WMAC Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* ---------------------------------------------------------------------------- ++ * 8195 IMR/ISR bits (offset 0xB0, 8bits) ++ * ---------------------------------------------------------------------------- */ ++#define IMR_DISABLED_8188F 0 ++/* IMR DW0(0x00B0-00B3) Bit 0-31 */ ++#define IMR_TIMER2_8188F BIT31 /* Timeout interrupt 2 */ ++#define IMR_TIMER1_8188F BIT30 /* Timeout interrupt 1 */ ++#define IMR_PSTIMEOUT_8188F BIT29 /* Power Save Time Out Interrupt */ ++#define IMR_GTINT4_8188F BIT28 /* When GTIMER4 expires, this bit is set to 1 */ ++#define IMR_GTINT3_8188F BIT27 /* When GTIMER3 expires, this bit is set to 1 */ ++#define IMR_TXBCN0ERR_8188F BIT26 /* Transmit Beacon0 Error */ ++#define IMR_TXBCN0OK_8188F BIT25 /* Transmit Beacon0 OK */ ++#define IMR_TSF_BIT32_TOGGLE_8188F BIT24 /* TSF Timer BIT32 toggle indication interrupt */ ++#define IMR_BCNDMAINT0_8188F BIT20 /* Beacon DMA Interrupt 0 */ ++#define IMR_BCNDERR0_8188F BIT16 /* Beacon Queue DMA OK0 */ ++#define IMR_HSISR_IND_ON_INT_8188F BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ ++#define IMR_BCNDMAINT_E_8188F BIT14 /* Beacon DMA Interrupt Extension for Win7 */ ++#define IMR_ATIMEND_8188F BIT12 /* CTWidnow End or ATIM Window End */ ++#define IMR_C2HCMD_8188F BIT10 /* CPU to Host Command INT Status, Write 1 clear */ ++#define IMR_CPWM2_8188F BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_CPWM_8188F BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_HIGHDOK_8188F BIT7 /* High Queue DMA OK */ ++#define IMR_MGNTDOK_8188F BIT6 /* Management Queue DMA OK */ ++#define IMR_BKDOK_8188F BIT5 /* AC_BK DMA OK */ ++#define IMR_BEDOK_8188F BIT4 /* AC_BE DMA OK */ ++#define IMR_VIDOK_8188F BIT3 /* AC_VI DMA OK */ ++#define IMR_VODOK_8188F BIT2 /* AC_VO DMA OK */ ++#define IMR_RDU_8188F BIT1 /* Rx Descriptor Unavailable */ ++#define IMR_ROK_8188F BIT0 /* Receive DMA OK */ ++ ++/* IMR DW1(0x00B4-00B7) Bit 0-31 */ ++#define IMR_BCNDMAINT7_8188F BIT27 /* Beacon DMA Interrupt 7 */ ++#define IMR_BCNDMAINT6_8188F BIT26 /* Beacon DMA Interrupt 6 */ ++#define IMR_BCNDMAINT5_8188F BIT25 /* Beacon DMA Interrupt 5 */ ++#define IMR_BCNDMAINT4_8188F BIT24 /* Beacon DMA Interrupt 4 */ ++#define IMR_BCNDMAINT3_8188F BIT23 /* Beacon DMA Interrupt 3 */ ++#define IMR_BCNDMAINT2_8188F BIT22 /* Beacon DMA Interrupt 2 */ ++#define IMR_BCNDMAINT1_8188F BIT21 /* Beacon DMA Interrupt 1 */ ++#define IMR_BCNDOK7_8188F BIT20 /* Beacon Queue DMA OK Interrup 7 */ ++#define IMR_BCNDOK6_8188F BIT19 /* Beacon Queue DMA OK Interrup 6 */ ++#define IMR_BCNDOK5_8188F BIT18 /* Beacon Queue DMA OK Interrup 5 */ ++#define IMR_BCNDOK4_8188F BIT17 /* Beacon Queue DMA OK Interrup 4 */ ++#define IMR_BCNDOK3_8188F BIT16 /* Beacon Queue DMA OK Interrup 3 */ ++#define IMR_BCNDOK2_8188F BIT15 /* Beacon Queue DMA OK Interrup 2 */ ++#define IMR_BCNDOK1_8188F BIT14 /* Beacon Queue DMA OK Interrup 1 */ ++#define IMR_ATIMEND_E_8188F BIT13 /* ATIM Window End Extension for Win7 */ ++#define IMR_TXERR_8188F BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ ++#define IMR_RXERR_8188F BIT10 /* Rx Error Flag INT Status, Write 1 clear */ ++#define IMR_TXFOVW_8188F BIT9 /* Transmit FIFO Overflow */ ++#define IMR_RXFOVW_8188F BIT8 /* Receive FIFO Overflow */ ++ ++#ifdef CONFIG_PCI_HCI ++/* #define IMR_RX_MASK (IMR_ROK_8188F|IMR_RDU_8188F|IMR_RXFOVW_8188F) */ ++#define IMR_TX_MASK (IMR_VODOK_8188F | IMR_VIDOK_8188F | IMR_BEDOK_8188F | IMR_BKDOK_8188F | IMR_MGNTDOK_8188F | IMR_HIGHDOK_8188F) ++ ++#define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8188F | IMR_TXBCN0OK_8188F | IMR_TXBCN0ERR_8188F | IMR_BCNDERR0_8188F) ++ ++#define RT_AC_INT_MASKS (IMR_VIDOK_8188F | IMR_VODOK_8188F | IMR_BEDOK_8188F | IMR_BKDOK_8188F) ++#endif ++ ++/* ******************************************************** ++ * General definitions ++ * ******************************************************** */ ++ ++#define MACID_NUM_8188F 16 ++#define SEC_CAM_ENT_NUM_8188F 16 ++#define HW_PORT_NUM_8188F 2 ++#define NSS_NUM_8188F 1 ++#define BAND_CAP_8188F (BAND_CAP_2G) ++#define BW_CAP_8188F (BW_CAP_20M | BW_CAP_40M) ++#define PROTO_CAP_8188F (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) ++ ++#endif /* __RTL8188F_SPEC_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_sreset.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_sreset.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_sreset.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,29 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL8188F_SRESET_H_ ++#define _RTL8188F_SRESET_H_ ++ ++#include ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++extern void rtl8188f_sreset_xmit_status_check(_adapter *padapter); ++extern void rtl8188f_sreset_linked_status_check(_adapter *padapter); ++#endif ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_xmit.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_xmit.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_xmit.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,338 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8188F_XMIT_H__ ++#define __RTL8188F_XMIT_H__ ++ ++ ++#define MAX_TID (15) ++ ++ ++#ifndef __INC_HAL8188FDESC_H ++#define __INC_HAL8188FDESC_H ++ ++#define RX_STATUS_DESC_SIZE_8188F 24 ++#define RX_DRV_INFO_SIZE_UNIT_8188F 8 ++ ++ ++/* DWORD 0 */ ++#define SET_RX_STATUS_DESC_PKT_LEN_8188F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) ++#define SET_RX_STATUS_DESC_EOR_8188F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) ++#define SET_RX_STATUS_DESC_OWN_8188F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) ++ ++#define GET_RX_STATUS_DESC_PKT_LEN_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) ++#define GET_RX_STATUS_DESC_CRC32_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) ++#define GET_RX_STATUS_DESC_ICV_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) ++#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) ++#define GET_RX_STATUS_DESC_SECURITY_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) ++#define GET_RX_STATUS_DESC_QOS_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) ++#define GET_RX_STATUS_DESC_SHIFT_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) ++#define GET_RX_STATUS_DESC_PHY_STATUS_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) ++#define GET_RX_STATUS_DESC_SWDEC_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) ++#define GET_RX_STATUS_DESC_LAST_SEG_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 28, 1) ++#define GET_RX_STATUS_DESC_FIRST_SEG_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 29, 1) ++#define GET_RX_STATUS_DESC_EOR_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) ++#define GET_RX_STATUS_DESC_OWN_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) ++ ++/* DWORD 1 */ ++#define GET_RX_STATUS_DESC_MACID_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) ++#define GET_RX_STATUS_DESC_TID_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) ++#define GET_RX_STATUS_DESC_AMSDU_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) ++#define GET_RX_STATUS_DESC_RXID_MATCH_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) ++#define GET_RX_STATUS_DESC_PAGGR_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) ++#define GET_RX_STATUS_DESC_A1_FIT_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) ++#define GET_RX_STATUS_DESC_CHKERR_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) ++#define GET_RX_STATUS_DESC_IPVER_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) ++#define GET_RX_STATUS_DESC_IS_TCPUDP__8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) ++#define GET_RX_STATUS_DESC_CHK_VLD_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) ++#define GET_RX_STATUS_DESC_PAM_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) ++#define GET_RX_STATUS_DESC_PWR_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) ++#define GET_RX_STATUS_DESC_MORE_DATA_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) ++#define GET_RX_STATUS_DESC_MORE_FRAG_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) ++#define GET_RX_STATUS_DESC_TYPE_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) ++#define GET_RX_STATUS_DESC_MC_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) ++#define GET_RX_STATUS_DESC_BC_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) ++ ++/* DWORD 2 */ ++#define GET_RX_STATUS_DESC_SEQ_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) ++#define GET_RX_STATUS_DESC_FRAG_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) ++#define GET_RX_STATUS_DESC_RX_IS_QOS_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) ++#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) ++#define GET_RX_STATUS_DESC_RPT_SEL_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) ++ ++/* DWORD 3 */ ++#define GET_RX_STATUS_DESC_RX_RATE_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) ++#define GET_RX_STATUS_DESC_HTC_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) ++#define GET_RX_STATUS_DESC_EOSP_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) ++#define GET_RX_STATUS_DESC_BSSID_FIT_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) ++#ifdef CONFIG_USB_RX_AGGREGATION ++#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) ++#endif ++#define GET_RX_STATUS_DESC_PATTERN_MATCH_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) ++#define GET_RX_STATUS_DESC_UNICAST_MATCH_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) ++#define GET_RX_STATUS_DESC_MAGIC_MATCH_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) ++ ++/* DWORD 6 */ ++#define GET_RX_STATUS_DESC_SPLCP_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 1) ++#define GET_RX_STATUS_DESC_LDPC_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 1, 1) ++#define GET_RX_STATUS_DESC_STBC_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 2, 1) ++#define GET_RX_STATUS_DESC_BW_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 4, 2) ++ ++/* DWORD 5 */ ++#define GET_RX_STATUS_DESC_TSFL_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) ++ ++#define GET_RX_STATUS_DESC_BUFF_ADDR_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) ++#define GET_RX_STATUS_DESC_BUFF_ADDR64_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) ++ ++#define SET_RX_STATUS_DESC_BUFF_ADDR_8188F(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) ++ ++ ++/* Dword 0 */ ++#define GET_TX_DESC_OWN_8188F(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) ++ ++#define SET_TX_DESC_PKT_SIZE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) ++#define SET_TX_DESC_OFFSET_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) ++#define SET_TX_DESC_BMC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) ++#define SET_TX_DESC_HTC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) ++#define SET_TX_DESC_LAST_SEG_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) ++#define SET_TX_DESC_FIRST_SEG_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) ++#define SET_TX_DESC_LINIP_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) ++#define SET_TX_DESC_NO_ACM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) ++#define SET_TX_DESC_GF_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) ++#define SET_TX_DESC_OWN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) ++ ++/* Dword 1 */ ++#define SET_TX_DESC_MACID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) ++#define SET_TX_DESC_QUEUE_SEL_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) ++#define SET_TX_DESC_RDG_NAV_EXT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) ++#define SET_TX_DESC_LSIG_TXOP_EN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) ++#define SET_TX_DESC_PIFS_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) ++#define SET_TX_DESC_RATE_ID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) ++#define SET_TX_DESC_EN_DESC_ID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) ++#define SET_TX_DESC_SEC_TYPE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) ++#define SET_TX_DESC_PKT_OFFSET_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) ++ ++ ++/* Dword 2 */ ++#define SET_TX_DESC_PAID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) ++#define SET_TX_DESC_CCA_RTS_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) ++#define SET_TX_DESC_AGG_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) ++#define SET_TX_DESC_RDG_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) ++#define SET_TX_DESC_AGG_BREAK_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) ++#define SET_TX_DESC_MORE_FRAG_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) ++#define SET_TX_DESC_RAW_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) ++#define SET_TX_DESC_SPE_RPT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) ++#define SET_TX_DESC_AMPDU_DENSITY_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) ++#define SET_TX_DESC_BT_INT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) ++#define SET_TX_DESC_GID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) ++ ++ ++/* Dword 3 */ ++#define SET_TX_DESC_WHEADER_LEN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) ++#define SET_TX_DESC_CHK_EN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) ++#define SET_TX_DESC_EARLY_MODE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) ++#define SET_TX_DESC_HWSEQ_SEL_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) ++#define SET_TX_DESC_USE_RATE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) ++#define SET_TX_DESC_DISABLE_RTS_FB_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) ++#define SET_TX_DESC_DISABLE_FB_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) ++#define SET_TX_DESC_CTS2SELF_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) ++#define SET_TX_DESC_RTS_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) ++#define SET_TX_DESC_HW_RTS_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) ++#define SET_TX_DESC_NAV_USE_HDR_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) ++#define SET_TX_DESC_USE_MAX_LEN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) ++#define SET_TX_DESC_MAX_AGG_NUM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) ++#define SET_TX_DESC_NDPA_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) ++#define SET_TX_DESC_AMPDU_MAX_TIME_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) ++ ++/* Dword 4 */ ++#define SET_TX_DESC_TX_RATE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) ++#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) ++#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) ++#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) ++#define SET_TX_DESC_DATA_RETRY_LIMIT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) ++#define SET_TX_DESC_RTS_RATE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) ++ ++ ++/* Dword 5 */ ++#define SET_TX_DESC_DATA_SC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) ++#define SET_TX_DESC_DATA_SHORT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) ++#define SET_TX_DESC_DATA_BW_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) ++#define SET_TX_DESC_DATA_LDPC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) ++#define SET_TX_DESC_DATA_STBC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) ++#define SET_TX_DESC_CTROL_STBC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) ++#define SET_TX_DESC_RTS_SHORT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) ++#define SET_TX_DESC_RTS_SC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) ++ ++ ++/* Dword 6 */ ++#define SET_TX_DESC_SW_DEFINE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) ++#define SET_TX_DESC_MBSSID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) ++#define SET_TX_DESC_ANTSEL_A_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) ++#define SET_TX_DESC_ANTSEL_B_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) ++#define SET_TX_DESC_ANTSEL_C_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) ++#define SET_TX_DESC_ANTSEL_D_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) ++ ++/* Dword 7 */ ++#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++#define SET_TX_DESC_TX_BUFFER_SIZE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++#else ++#define SET_TX_DESC_TX_DESC_CHECKSUM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++#endif ++#define SET_TX_DESC_USB_TXAGG_NUM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) ++#if (DEV_BUS_TYPE == RT_SDIO_INTERFACE) ++#define SET_TX_DESC_SDIO_TXSEQ_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) ++#endif ++ ++/* Dword 8 */ ++#define SET_TX_DESC_HWSEQ_EN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) ++ ++/* Dword 9 */ ++#define SET_TX_DESC_SEQ_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) ++ ++/* Dword 10 */ ++#define SET_TX_DESC_TX_BUFFER_ADDRESS_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) ++#define GET_TX_DESC_TX_BUFFER_ADDRESS_8188F(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+40, 0, 32) ++ ++/* Dword 11 */ ++#define SET_TX_DESC_NEXT_DESC_ADDRESS_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) ++ ++ ++#define SET_EARLYMODE_PKTNUM_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) ++#define SET_EARLYMODE_LEN0_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) ++#define SET_EARLYMODE_LEN1_1_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) ++#define SET_EARLYMODE_LEN1_2_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) ++#define SET_EARLYMODE_LEN2_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) ++#define SET_EARLYMODE_LEN3_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) ++ ++#endif ++/* ----------------------------------------------------------- ++ * ++ * Rate ++ * ++ * ----------------------------------------------------------- ++ * CCK Rates, TxHT = 0 */ ++#define DESC8188F_RATE1M 0x00 ++#define DESC8188F_RATE2M 0x01 ++#define DESC8188F_RATE5_5M 0x02 ++#define DESC8188F_RATE11M 0x03 ++ ++/* OFDM Rates, TxHT = 0 */ ++#define DESC8188F_RATE6M 0x04 ++#define DESC8188F_RATE9M 0x05 ++#define DESC8188F_RATE12M 0x06 ++#define DESC8188F_RATE18M 0x07 ++#define DESC8188F_RATE24M 0x08 ++#define DESC8188F_RATE36M 0x09 ++#define DESC8188F_RATE48M 0x0a ++#define DESC8188F_RATE54M 0x0b ++ ++/* MCS Rates, TxHT = 1 */ ++#define DESC8188F_RATEMCS0 0x0c ++#define DESC8188F_RATEMCS1 0x0d ++#define DESC8188F_RATEMCS2 0x0e ++#define DESC8188F_RATEMCS3 0x0f ++#define DESC8188F_RATEMCS4 0x10 ++#define DESC8188F_RATEMCS5 0x11 ++#define DESC8188F_RATEMCS6 0x12 ++#define DESC8188F_RATEMCS7 0x13 ++#define DESC8188F_RATEMCS8 0x14 ++#define DESC8188F_RATEMCS9 0x15 ++#define DESC8188F_RATEMCS10 0x16 ++#define DESC8188F_RATEMCS11 0x17 ++#define DESC8188F_RATEMCS12 0x18 ++#define DESC8188F_RATEMCS13 0x19 ++#define DESC8188F_RATEMCS14 0x1a ++#define DESC8188F_RATEMCS15 0x1b ++#define DESC8188F_RATEVHTSS1MCS0 0x2c ++#define DESC8188F_RATEVHTSS1MCS1 0x2d ++#define DESC8188F_RATEVHTSS1MCS2 0x2e ++#define DESC8188F_RATEVHTSS1MCS3 0x2f ++#define DESC8188F_RATEVHTSS1MCS4 0x30 ++#define DESC8188F_RATEVHTSS1MCS5 0x31 ++#define DESC8188F_RATEVHTSS1MCS6 0x32 ++#define DESC8188F_RATEVHTSS1MCS7 0x33 ++#define DESC8188F_RATEVHTSS1MCS8 0x34 ++#define DESC8188F_RATEVHTSS1MCS9 0x35 ++#define DESC8188F_RATEVHTSS2MCS0 0x36 ++#define DESC8188F_RATEVHTSS2MCS1 0x37 ++#define DESC8188F_RATEVHTSS2MCS2 0x38 ++#define DESC8188F_RATEVHTSS2MCS3 0x39 ++#define DESC8188F_RATEVHTSS2MCS4 0x3a ++#define DESC8188F_RATEVHTSS2MCS5 0x3b ++#define DESC8188F_RATEVHTSS2MCS6 0x3c ++#define DESC8188F_RATEVHTSS2MCS7 0x3d ++#define DESC8188F_RATEVHTSS2MCS8 0x3e ++#define DESC8188F_RATEVHTSS2MCS9 0x3f ++ ++ ++#define RX_HAL_IS_CCK_RATE_8188F(pDesc)\ ++ (GET_RX_STATUS_DESC_RX_RATE_8188F(pDesc) == DESC8188F_RATE1M || \ ++ GET_RX_STATUS_DESC_RX_RATE_8188F(pDesc) == DESC8188F_RATE2M || \ ++ GET_RX_STATUS_DESC_RX_RATE_8188F(pDesc) == DESC8188F_RATE5_5M || \ ++ GET_RX_STATUS_DESC_RX_RATE_8188F(pDesc) == DESC8188F_RATE11M) ++ ++ ++void rtl8188f_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); ++void rtl8188f_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); ++#if defined(CONFIG_CONCURRENT_MODE) ++void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); ++#endif ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++s32 rtl8188fs_init_xmit_priv(PADAPTER padapter); ++void rtl8188fs_free_xmit_priv(PADAPTER padapter); ++s32 rtl8188fs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++s32 rtl8188fs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++s32 rtl8188fs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++s32 rtl8188fs_xmit_buf_handler(PADAPTER padapter); ++thread_return rtl8188fs_xmit_thread(thread_context context); ++#define hal_xmit_handler rtl8188fs_xmit_buf_handler ++#endif ++ ++#ifdef CONFIG_USB_HCI ++s32 rtl8188fu_xmit_buf_handler(PADAPTER padapter); ++#define hal_xmit_handler rtl8188fu_xmit_buf_handler ++ ++ ++s32 rtl8188fu_init_xmit_priv(PADAPTER padapter); ++void rtl8188fu_free_xmit_priv(PADAPTER padapter); ++s32 rtl8188fu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++s32 rtl8188fu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++s32 rtl8188fu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++/* s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); */ ++void rtl8188fu_xmit_tasklet(void *priv); ++s32 rtl8188fu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, struct tx_desc *ptxdesc); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++s32 rtl8188fe_init_xmit_priv(PADAPTER padapter); ++void rtl8188fe_free_xmit_priv(PADAPTER padapter); ++struct xmit_buf *rtl8188fe_dequeue_xmitbuf(struct rtw_tx_ring *ring); ++void rtl8188fe_xmitframe_resume(_adapter *padapter); ++s32 rtl8188fe_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++s32 rtl8188fe_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++s32 rtl8188fe_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++void rtl8188fe_xmit_tasklet(void *priv); ++#endif ++ ++u8 BWMapping_8188F(PADAPTER Adapter, struct pkt_attrib *pattrib); ++u8 SCMapping_8188F(PADAPTER Adapter, struct pkt_attrib *pattrib); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_cmd.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_cmd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_cmd.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,161 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8192E_CMD_H__ ++#define __RTL8192E_CMD_H__ ++ ++typedef enum _RTL8192E_H2C_CMD { ++ H2C_8192E_RSVDPAGE = 0x00, ++ H2C_8192E_MSRRPT = 0x01, ++ H2C_8192E_SCAN = 0x02, ++ H2C_8192E_KEEP_ALIVE_CTRL = 0x03, ++ H2C_8192E_DISCONNECT_DECISION = 0x04, ++ H2C_8192E_INIT_OFFLOAD = 0x06, ++ H2C_8192E_AP_OFFLOAD = 0x08, ++ H2C_8192E_BCN_RSVDPAGE = 0x09, ++ H2C_8192E_PROBERSP_RSVDPAGE = 0x0a, ++ ++ H2C_8192E_AP_WOW_GPIO_CTRL = 0x13, ++ ++ H2C_8192E_SETPWRMODE = 0x20, ++ H2C_8192E_PS_TUNING_PARA = 0x21, ++ H2C_8192E_PS_TUNING_PARA2 = 0x22, ++ H2C_8192E_PS_LPS_PARA = 0x23, ++ H2C_8192E_P2P_PS_OFFLOAD = 0x24, ++ H2C_8192E_SAP_PS = 0x26, ++ H2C_8192E_RA_MASK = 0x40, ++ H2C_8192E_RSSI_REPORT = 0x42, ++ H2C_8192E_RA_PARA_ADJUST = 0x46, ++ ++ H2C_8192E_WO_WLAN = 0x80, ++ H2C_8192E_REMOTE_WAKE_CTRL = 0x81, ++ H2C_8192E_AOAC_GLOBAL_INFO = 0x82, ++ H2C_8192E_AOAC_RSVDPAGE = 0x83, ++ ++ /* Not defined in new 88E H2C CMD Format */ ++ H2C_8192E_SELECTIVE_SUSPEND_ROF_CMD, ++ H2C_8192E_P2P_PS_MODE, ++ H2C_8192E_PSD_RESULT, ++ MAX_8192E_H2CCMD ++} RTL8192E_H2C_CMD; ++ ++struct cmd_msg_parm { ++ u8 eid; /* element id */ ++ u8 sz; /* sz */ ++ u8 buf[6]; ++}; ++ ++enum { ++ PWRS ++}; ++ ++typedef struct _SETPWRMODE_PARM { ++ u8 Mode;/* 0:Active,1:LPS,2:WMMPS */ ++ /* u8 RLBM:4; */ /* 0:Min,1:Max,2: User define */ ++ u8 SmartPS_RLBM;/* LPS=0:PS_Poll,1:PS_Poll,2:NullData,WMM=0:PS_Poll,1:NullData */ ++ u8 AwakeInterval; /* unit: beacon interval */ ++ u8 bAllQueueUAPSD; ++ u8 PwrState;/* AllON(0x0c),RFON(0x04),RFOFF(0x00) */ ++} SETPWRMODE_PARM, *PSETPWRMODE_PARM; ++ ++struct H2C_SS_RFOFF_PARAM { ++ u8 ROFOn; /* 1: on, 0:off */ ++ u16 gpio_period; /* unit: 1024 us */ ++} __attribute__((packed)); ++ ++ ++typedef struct JOINBSSRPT_PARM_92E { ++ u8 OpMode; /* RT_MEDIA_STATUS */ ++#ifdef CONFIG_WOWLAN ++ u8 MacID; /* MACID */ ++#endif /* CONFIG_WOWLAN */ ++} JOINBSSRPT_PARM_92E, *PJOINBSSRPT_PARM_92E; ++ ++/* move to hal_com_h2c.h ++typedef struct _RSVDPAGE_LOC_92E { ++ u8 LocProbeRsp; ++ u8 LocPsPoll; ++ u8 LocNullData; ++ u8 LocQosNull; ++ u8 LocBTQosNull; ++} RSVDPAGE_LOC_92E, *PRSVDPAGE_LOC_92E; ++*/ ++ ++ ++/* _SETPWRMODE_PARM */ ++#define SET_8192E_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8192E_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) ++#define SET_8192E_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) ++#define SET_8192E_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8192E_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8192E_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) ++#define SET_8192E_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#define SET_8192E_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++#define GET_8192E_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) ++ ++/* _P2P_PS_OFFLOAD */ ++#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_CTWINDOW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) ++#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) ++#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) ++ ++ ++/* host message to firmware cmd */ ++void rtl8192e_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); ++void rtl8192e_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); ++u8 rtl8192e_set_rssi_cmd(PADAPTER padapter, u8 *param); ++void rtl8192e_set_raid_cmd(PADAPTER padapter, u32 bitmap, u8 *arg, u8 bw); ++s32 FillH2CCmd_8192E(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); ++u8 GetTxBufferRsvdPageNum8192E(_adapter *padapter, bool wowlan); ++/* u8 rtl8192c_set_FwSelectSuspend_cmd(PADAPTER padapter, u8 bfwpoll, u16 period); */ ++s32 c2h_handler_8192e(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); ++#ifdef CONFIG_BT_COEXIST ++ void rtl8192e_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); ++#endif /* CONFIG_BT_COEXIST */ ++#ifdef CONFIG_P2P_PS ++ void rtl8192e_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); ++#endif /* CONFIG_P2P */ ++ ++void CheckFwRsvdPageContent(PADAPTER padapter); ++ ++#ifdef CONFIG_TDLS ++ #ifdef CONFIG_TDLS_CH_SW ++ void rtl8192e_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); ++ #endif ++#endif ++ ++#ifdef CONFIG_TSF_RESET_OFFLOAD ++ int reset_tsf(PADAPTER Adapter, u8 reset_port); ++#endif /* CONFIG_TSF_RESET_OFFLOAD */ ++ ++/* / TX Feedback Content */ ++#define USEC_UNIT_FOR_8192E_C2H_TX_RPT_QUEUE_TIME 256 ++ ++#define GET_8192E_C2H_TX_RPT_QUEUE_SELECT(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 5) ++#define GET_8192E_C2H_TX_RPT_PKT_BROCAST(_Header) LE_BITS_TO_1BYTE((_Header + 0), 5, 1) ++#define GET_8192E_C2H_TX_RPT_LIFE_TIME_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 6, 1) ++#define GET_8192E_C2H_TX_RPT_RETRY_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 7, 1) ++#define GET_8192E_C2H_TX_RPT_MAC_ID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) ++#define GET_8192E_C2H_TX_RPT_DATA_RETRY_CNT(_Header) LE_BITS_TO_1BYTE((_Header + 2), 0, 6) ++#define GET_8192E_C2H_TX_RPT_QUEUE_TIME(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) /* In unit of 256 microseconds. */ ++#define GET_8192E_C2H_TX_RPT_FINAL_DATA_RATE(_Header) LE_BITS_TO_1BYTE((_Header + 5), 0, 8) ++ ++#endif /* __RTL8192E_CMD_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_dm.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_dm.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_dm.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,33 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8192E_DM_H__ ++#define __RTL8192E_DM_H__ ++ ++ ++void rtl8192e_init_dm_priv(IN PADAPTER Adapter); ++void rtl8192e_deinit_dm_priv(IN PADAPTER Adapter); ++void rtl8192e_InitHalDm(IN PADAPTER Adapter); ++void rtl8192e_HalDmWatchDog(IN PADAPTER Adapter); ++ ++/* VOID rtl8192c_dm_CheckTXPowerTracking(IN PADAPTER Adapter); */ ++ ++/* void rtl8192c_dm_RF_Saving(IN PADAPTER pAdapter, IN u8 bForceInNormal); */ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_hal.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,332 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8192E_HAL_H__ ++#define __RTL8192E_HAL_H__ ++ ++/* #include "hal_com.h" */ ++ ++#include "hal_data.h" ++ ++/* include HAL Related header after HAL Related compiling flags */ ++#include "rtl8192e_spec.h" ++#include "rtl8192e_rf.h" ++#include "rtl8192e_dm.h" ++#include "rtl8192e_recv.h" ++#include "rtl8192e_xmit.h" ++#include "rtl8192e_cmd.h" ++#include "rtl8192e_led.h" ++#include "Hal8192EPwrSeq.h" ++#include "Hal8192EPhyReg.h" ++#include "Hal8192EPhyCfg.h" ++ ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ #include "rtl8192e_sreset.h" ++#endif ++ ++/* --------------------------------------------------------------------- ++ * RTL8192E Power Configuration CMDs for PCIe interface ++ * --------------------------------------------------------------------- */ ++#define Rtl8192E_NIC_PWR_ON_FLOW rtl8192E_power_on_flow ++#define Rtl8192E_NIC_RF_OFF_FLOW rtl8192E_radio_off_flow ++#define Rtl8192E_NIC_DISABLE_FLOW rtl8192E_card_disable_flow ++#define Rtl8192E_NIC_ENABLE_FLOW rtl8192E_card_enable_flow ++#define Rtl8192E_NIC_SUSPEND_FLOW rtl8192E_suspend_flow ++#define Rtl8192E_NIC_RESUME_FLOW rtl8192E_resume_flow ++#define Rtl8192E_NIC_PDN_FLOW rtl8192E_hwpdn_flow ++#define Rtl8192E_NIC_LPS_ENTER_FLOW rtl8192E_enter_lps_flow ++#define Rtl8192E_NIC_LPS_LEAVE_FLOW rtl8192E_leave_lps_flow ++ ++ ++#if 1 /* download firmware related data structure */ ++#define FW_SIZE_8192E 0x8000 /* Compatible with RTL8192e Maximal RAM code size 32k */ ++#define FW_START_ADDRESS 0x1000 ++#define FW_END_ADDRESS 0x5FFF ++ ++ ++#define IS_FW_HEADER_EXIST_8192E(_pFwHdr) ((GET_FIRMWARE_HDR_SIGNATURE_8192E(_pFwHdr) & 0xFFF0) == 0x92E0) ++ ++ ++ ++typedef struct _RT_FIRMWARE_8192E { ++ FIRMWARE_SOURCE eFWSource; ++#ifdef CONFIG_EMBEDDED_FWIMG ++ u8 *szFwBuffer; ++#else ++ u8 szFwBuffer[FW_SIZE_8192E]; ++#endif ++ u32 ulFwLength; ++} RT_FIRMWARE_8192E, *PRT_FIRMWARE_8192E; ++ ++/* ++ * This structure must be cared byte-ordering ++ * ++ * Added by tynli. 2009.12.04. */ ++ ++/* ***************************************************** ++ * Firmware Header(8-byte alinment required) ++ * ***************************************************** ++ * --- LONG WORD 0 ---- */ ++#define GET_FIRMWARE_HDR_SIGNATURE_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 0, 16) /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ ++#define GET_FIRMWARE_HDR_CATEGORY_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 16, 8) /* AP/NIC and USB/PCI */ ++#define GET_FIRMWARE_HDR_FUNCTION_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 24, 8) /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ ++#define GET_FIRMWARE_HDR_VERSION_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 0, 16)/* FW Version */ ++#define GET_FIRMWARE_HDR_SUB_VER_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 16, 8) /* FW Subversion, default 0x00 */ ++#define GET_FIRMWARE_HDR_RSVD1_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 24, 8) ++ ++/* --- LONG WORD 1 ---- */ ++#define GET_FIRMWARE_HDR_MONTH_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 0, 8) /* Release time Month field */ ++#define GET_FIRMWARE_HDR_DATE_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 8, 8) /* Release time Date field */ ++#define GET_FIRMWARE_HDR_HOUR_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 16, 8)/* Release time Hour field */ ++#define GET_FIRMWARE_HDR_MINUTE_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 24, 8)/* Release time Minute field */ ++#define GET_FIRMWARE_HDR_ROMCODE_SIZE_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 0, 16)/* The size of RAM code */ ++#define GET_FIRMWARE_HDR_RSVD2_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 16, 16) ++ ++/* --- LONG WORD 2 ---- */ ++#define GET_FIRMWARE_HDR_SVN_IDX_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 0, 32)/* The SVN entry index */ ++#define GET_FIRMWARE_HDR_RSVD3_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 0, 32) ++ ++/* --- LONG WORD 3 ---- */ ++#define GET_FIRMWARE_HDR_RSVD4_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 0, 32) ++#define GET_FIRMWARE_HDR_RSVD5_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+28, 0, 32) ++ ++#endif /* download firmware related data structure */ ++ ++#define DRIVER_EARLY_INT_TIME_8192E 0x05 ++#define BCN_DMA_ATIME_INT_TIME_8192E 0x02 ++#define RX_DMA_SIZE_8192E 0x4000 /* 16K*/ ++ ++#ifdef CONFIG_WOWLAN ++ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ ++#else ++ #define RESV_FMWF 0 ++#endif ++ ++#ifdef CONFIG_FW_C2H_DEBUG ++ #define RX_DMA_RESERVED_SIZE_8192E 0x100 /* 256B, reserved for c2h debug message*/ ++#else ++ #define RX_DMA_RESERVED_SIZE_8192E 0x40 /* 64B, reserved for c2h event(16bytes) or ccx(8 Bytes)*/ ++#endif ++#define MAX_RX_DMA_BUFFER_SIZE_8192E (RX_DMA_SIZE_8192E-RX_DMA_RESERVED_SIZE_8192E) /*RX 16K*/ ++ ++/* For General Reserved Page Number(Beacon Queue is reserved page) ++ * if (CONFIG_2BCN_EN) Beacon:4, PS-Poll:1, Null Data:1,Prob Rsp:1,Qos Null Data:1 ++ * Beacon:2, PS-Poll:1, Null Data:1,Prob Rsp:1,Qos Null Data:1 */ ++#define RSVD_PAGE_NUM_8192E 0x08 ++/* For WoWLan , more reserved page ++ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ ++#ifdef CONFIG_WOWLAN ++ #define WOWLAN_PAGE_NUM_8192E 0x07 ++#else ++ #define WOWLAN_PAGE_NUM_8192E 0x00 ++#endif ++ ++#ifdef CONFIG_PNO_SUPPORT ++ #undef WOWLAN_PAGE_NUM_8192E ++ #define WOWLAN_PAGE_NUM_8192E 0x0d ++#endif ++ ++/* Note: ++Tx FIFO Size : 64KB ++Tx page Size : 256B ++Total page numbers : 256(0x100) ++*/ ++ ++#define TOTAL_RSVD_PAGE_NUMBER_8192E (RSVD_PAGE_NUM_8192E + WOWLAN_PAGE_NUM_8192E) ++ ++#define TOTAL_PAGE_NUMBER_8192E (0x100) ++#define TX_TOTAL_PAGE_NUMBER_8192E (TOTAL_PAGE_NUMBER_8192E - TOTAL_RSVD_PAGE_NUMBER_8192E) ++ ++#define TX_PAGE_BOUNDARY_8192E (TX_TOTAL_PAGE_NUMBER_8192E) /* beacon header start address */ ++ ++ ++#define PAGE_SIZE_TX_92E PAGE_SIZE_256 ++#define RSVD_PKT_LEN_92E (TOTAL_RSVD_PAGE_NUMBER_8192E * PAGE_SIZE_TX_92E) ++ ++#define TX_PAGE_LOAD_FW_BOUNDARY_8192E 0x47 /* 0xA5 */ ++#define TX_PAGE_BOUNDARY_WOWLAN_8192E 0xE0 ++ ++/* For Normal Chip Setting ++ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_92C */ ++ ++#define NORMAL_PAGE_NUM_HPQ_8192E 0x10 ++#define NORMAL_PAGE_NUM_LPQ_8192E 0x10 ++#define NORMAL_PAGE_NUM_NPQ_8192E 0x10 ++#define NORMAL_PAGE_NUM_EPQ_8192E 0x00 ++ ++ ++/* Note: For WMM Normal Chip Setting ,modify later */ ++#define WMM_NORMAL_PAGE_NUM_HPQ_8192E NORMAL_PAGE_NUM_HPQ_8192E ++#define WMM_NORMAL_PAGE_NUM_LPQ_8192E NORMAL_PAGE_NUM_LPQ_8192E ++#define WMM_NORMAL_PAGE_NUM_NPQ_8192E NORMAL_PAGE_NUM_NPQ_8192E ++ ++ ++/* ------------------------------------------------------------------------- ++ * Chip specific ++ * ------------------------------------------------------------------------- */ ++ ++/* pic buffer descriptor */ ++#define RTL8192EE_SEG_NUM TX_BUFFER_SEG_NUM ++#define TX_DESC_NUM_92E 128 ++#define RX_DESC_NUM_92E 128 ++ ++/* ------------------------------------------------------------------------- ++ * Channel Plan ++ * ------------------------------------------------------------------------- */ ++ ++#define HWSET_MAX_SIZE_8192E 512 ++ ++#define EFUSE_REAL_CONTENT_LEN_8192E 512 ++ ++#define EFUSE_MAP_LEN_8192E 512 ++#define EFUSE_MAX_SECTION_8192E 64 ++#define EFUSE_MAX_WORD_UNIT_8192E 4 ++#define EFUSE_IC_ID_OFFSET_8192E 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ ++#define AVAILABLE_EFUSE_ADDR_8192E(addr) (addr < EFUSE_REAL_CONTENT_LEN_8192E) ++/* ++ * To prevent out of boundary programming case, leave 1byte and program full section ++ * 9bytes + 1byt + 5bytes and pre 1byte. ++ * For worst case: ++ * | 1byte|----8bytes----|1byte|--5bytes--| ++ * | | Reserved(14bytes) | ++ * */ ++#define EFUSE_OOB_PROTECT_BYTES_8192E 15 /* PG data exclude header, dummy 6 bytes frome CP test and reserved 1byte. */ ++ ++ ++ ++/* ******************************************************** ++ * EFUSE for BT definition ++ * ******************************************************** */ ++#define EFUSE_BT_REAL_BANK_CONTENT_LEN_8192E 512 ++#define EFUSE_BT_REAL_CONTENT_LEN_8192E 1024 /* 512*2 */ ++#define EFUSE_BT_MAP_LEN_8192E 1024 /* 1k bytes */ ++#define EFUSE_BT_MAX_SECTION_8192E 128 /* 1024/8 */ ++ ++#define EFUSE_PROTECT_BYTES_BANK_8192E 16 ++#define EFUSE_MAX_BANK_8192E 3 ++/* *********************************************************** */ ++ ++#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) ++#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) ++ ++/* #define IS_MULTI_FUNC_CHIP(_Adapter) (((((PHAL_DATA_TYPE)(_Adapter->HalData))->MultiFunc) & (RT_MULTI_FUNC_BT|RT_MULTI_FUNC_GPS)) ? _TRUE : _FALSE) */ ++ ++/* #define RT_IS_FUNC_DISABLED(__pAdapter, __FuncBits) ( (__pAdapter)->DisabledFunctions & (__FuncBits) ) */ ++ ++/* rtl8812_hal_init.c */ ++void _8051Reset8192E(PADAPTER padapter); ++s32 FirmwareDownload8192E(PADAPTER Adapter, BOOLEAN bUsedWoWLANFw); ++void InitializeFirmwareVars8192E(PADAPTER padapter); ++ ++s32 InitLLTTable8192E(PADAPTER padapter, u8 txpktbuf_bndy); ++ ++/* EFuse */ ++u8 GetEEPROMSize8192E(PADAPTER padapter); ++void hal_InitPGData_8192E(PADAPTER padapter, u8 *PROMContent); ++void Hal_EfuseParseIDCode8192E(PADAPTER padapter, u8 *hwinfo); ++void Hal_ReadPROMVersion8192E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_ReadPowerSavingMode8192E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_ReadTxPowerInfo8192E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_ReadBoardType8192E(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_ReadThermalMeter_8192E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++void Hal_ReadChannelPlan8192E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseXtal_8192E(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_ReadAntennaDiversity8192E(PADAPTER pAdapter, u8 *PROMContent, BOOLEAN AutoLoadFail); ++void Hal_ReadPAType_8192E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++void Hal_ReadAmplifierType_8192E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++void Hal_ReadRFEType_8192E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++void Hal_EfuseParseBTCoexistInfo8192E(PADAPTER Adapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseKFreeData_8192E(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++ ++u8 Hal_CrystalAFEAdjust(_adapter *Adapter); ++ ++BOOLEAN HalDetectPwrDownMode8192E(PADAPTER Adapter); ++ ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++ void Hal_DetectWoWMode(PADAPTER pAdapter); ++#endif /* CONFIG_WOWLAN */ ++ ++/***********************************************************/ ++/* RTL8192E-MAC Setting */ ++VOID _InitQueueReservedPage_8192E(IN PADAPTER Adapter); ++VOID _InitQueuePriority_8192E(IN PADAPTER Adapter); ++VOID _InitTxBufferBoundary_8192E(IN PADAPTER Adapter, IN u8 txpktbuf_bndy); ++VOID _InitPageBoundary_8192E(IN PADAPTER Adapter); ++/* VOID _InitTransferPageSize_8192E(IN PADAPTER Adapter); */ ++VOID _InitDriverInfoSize_8192E(IN PADAPTER Adapter, IN u8 drvInfoSize); ++VOID _InitRDGSetting_8192E(PADAPTER Adapter); ++void _InitID_8192E(IN PADAPTER Adapter); ++VOID _InitNetworkType_8192E(IN PADAPTER Adapter); ++VOID _InitWMACSetting_8192E(IN PADAPTER Adapter); ++VOID _InitAdaptiveCtrl_8192E(IN PADAPTER Adapter); ++VOID _InitRateFallback_8192E(IN PADAPTER Adapter); ++VOID _InitEDCA_8192E(IN PADAPTER Adapter); ++VOID _InitRetryFunction_8192E(IN PADAPTER Adapter); ++VOID _BBTurnOnBlock_8192E(IN PADAPTER Adapter); ++VOID _InitBeaconParameters_8192E(IN PADAPTER Adapter); ++VOID _InitBeaconMaxError_8192E( ++ IN PADAPTER Adapter, ++ IN BOOLEAN InfraMode ++); ++void SetBeaconRelatedRegisters8192E(PADAPTER padapter); ++VOID hal_ReadRFType_8192E(PADAPTER Adapter); ++/* RTL8192E-MAC Setting ++ ***********************************************************/ ++ ++void SetHwReg8192E(PADAPTER Adapter, u8 variable, u8 *val); ++void GetHwReg8192E(PADAPTER Adapter, u8 variable, u8 *val); ++u8 ++SetHalDefVar8192E( ++ IN PADAPTER Adapter, ++ IN HAL_DEF_VARIABLE eVariable, ++ IN PVOID pValue ++); ++u8 ++GetHalDefVar8192E( ++ IN PADAPTER Adapter, ++ IN HAL_DEF_VARIABLE eVariable, ++ IN PVOID pValue ++); ++ ++void rtl8192e_set_hal_ops(struct hal_ops *pHalFunc); ++void init_hal_spec_8192e(_adapter *adapter); ++void rtl8192e_init_default_value(_adapter *padapter); ++/* register */ ++void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); ++ ++void rtl8192e_start_thread(_adapter *padapter); ++void rtl8192e_stop_thread(_adapter *padapter); ++ ++#ifdef CONFIG_PCI_HCI ++ BOOLEAN InterruptRecognized8192EE(PADAPTER Adapter); ++ u16 get_txdesc_buf_addr(u16 ff_hwaddr); ++#endif ++ ++#ifdef CONFIG_SDIO_HCI ++ #ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT ++ void _init_available_page_threshold(PADAPTER padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ); ++ #endif ++#endif ++ ++#ifdef CONFIG_BT_COEXIST ++ void rtl8192e_combo_card_WifiOnlyHwInit(PADAPTER Adapter); ++#endif ++ ++#endif /* __RTL8192E_HAL_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_led.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_led.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_led.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,40 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8192E_LED_H__ ++#define __RTL8192E_LED_H__ ++ ++ ++/* ******************************************************************************** ++ * Interface to manipulate LED objects. ++ * ******************************************************************************** */ ++#ifdef CONFIG_USB_HCI ++ void rtl8192eu_InitSwLeds(PADAPTER padapter); ++ void rtl8192eu_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_PCI_HCI ++ void rtl8192ee_InitSwLeds(PADAPTER padapter); ++ void rtl8192ee_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_SDIO_HCI ++ void rtl8192es_InitSwLeds(PADAPTER padapter); ++ void rtl8192es_DeInitSwLeds(PADAPTER padapter); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_recv.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_recv.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_recv.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,173 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8192E_RECV_H__ ++#define __RTL8192E_RECV_H__ ++ ++#if defined(CONFIG_USB_HCI) ++ ++ #ifndef MAX_RECVBUF_SZ ++ #ifdef PLATFORM_OS_CE ++ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ ++ #else ++ #ifdef CONFIG_MINIMAL_MEMORY_USAGE ++ #define MAX_RECVBUF_SZ (4000) /* about 4K */ ++ #else ++ #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER ++ #define MAX_RECVBUF_SZ (rtw_rtkm_get_buff_size()) /*depend rtkm*/ ++ #elif defined(CONFIG_PLATFORM_HISILICON) ++ #define MAX_RECVBUF_SZ (16384) /* 16k */ ++ #else ++ #define MAX_RECVBUF_SZ (32768) /* 32k */ ++ #endif ++ /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ ++ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ ++ /* #define MAX_RECVBUF_SZ (16384) */ /* 16k - 92E RX BUF :16K */ ++ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ ++ #endif ++ #endif ++ #endif /* !MAX_RECVBUF_SZ */ ++ ++#elif defined(CONFIG_PCI_HCI) ++ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ ++ /* #define MAX_RECVBUF_SZ (9100) */ ++ /* #else */ ++ #define MAX_RECVBUF_SZ (4000) /* about 4K ++ * #endif */ ++ ++ ++#elif defined(CONFIG_SDIO_HCI) ++ ++ #define MAX_RECVBUF_SZ (16384) ++ ++#endif ++ ++ ++/* Rx smooth factor */ ++#define Rx_Smooth_Factor (20) ++ ++/* ************* ++ * [1] Rx Buffer Descriptor (for PCIE) buffer descriptor architecture ++ * DWORD 0 */ ++#define SET_RX_BUFFER_DESC_DATA_LENGTH_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) ++#define SET_RX_BUFFER_DESC_LS_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 15, 1, __Value) ++#define SET_RX_BUFFER_DESC_FS_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 1, __Value) ++#define SET_RX_BUFFER_DESC_TOTAL_LENGTH_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 15, __Value) ++ ++#define GET_RX_BUFFER_DESC_OWN_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) ++#define GET_RX_BUFFER_DESC_LS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) ++#define GET_RX_BUFFER_DESC_FS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 1) ++#define GET_RX_BUFFER_DESC_TOTAL_LENGTH_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 15) ++ ++ ++/* DWORD 1 */ ++#define SET_RX_BUFFER_PHYSICAL_LOW_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+4, 0, 32, __Value) ++#define GET_RX_BUFFER_PHYSICAL_LOW_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 0, 32) ++ ++/* DWORD 2 */ ++#define SET_RX_BUFFER_PHYSICAL_HIGH_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+8, 0, 32, __Value) ++ ++/* ************* ++ * [2] Rx Descriptor ++ * DWORD 0 */ ++#define GET_RX_STATUS_DESC_PKT_LEN_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) ++#define GET_RX_STATUS_DESC_CRC32_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) ++#define GET_RX_STATUS_DESC_ICVERR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) ++#define GET_RX_STATUS_DESC_DRVINFO_SIZE_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) ++#define GET_RX_STATUS_DESC_SECURITY_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) ++#define GET_RX_STATUS_DESC_QOS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) ++#define GET_RX_STATUS_DESC_SHIFT_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) ++#define GET_RX_STATUS_DESC_PHY_STATUS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) ++#define GET_RX_STATUS_DESC_SWDEC_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) ++#define GET_RX_STATUS_DESC_EOR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) ++#define GET_RX_STATUS_DESC_OWN_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) ++ ++ ++#define SET_RX_STATUS_DESC_PKT_LEN_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) ++#define SET_RX_STATUS_DESC_EOR_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) ++#define SET_RX_STATUS_DESC_OWN_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) ++ ++/* DWORD 1 */ ++#define GET_RX_STATUS_DESC_MACID_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) ++#define GET_RX_STATUS_DESC_TID_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) ++#define GET_RX_STATUS_DESC_MACID_VLD_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 12, 1) ++#define GET_RX_STATUS_DESC_AMSDU_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) ++#define GET_RX_STATUS_DESC_RXID_MATCH_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) ++#define GET_RX_STATUS_DESC_PAGGR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 15, 1) ++#define GET_RX_STATUS_DESC_A1_FITS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 16, 4) ++#define GET_RX_STATUS_DESC_TCPOFFLOAD_CHKERR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 20, 1) ++#define GET_RX_STATUS_DESC_TCPOFFLOAD_IPVER_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 21, 1) ++#define GET_RX_STATUS_DESC_TCPOFFLOAD_IS_TCPUDP_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 22, 1) ++#define GET_RX_STATUS_DESC_TCPOFFLOAD_CHK_VLD_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 23, 1) ++#define GET_RX_STATUS_DESC_PAM_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 24, 1) ++#define GET_RX_STATUS_DESC_PWR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 25, 1) ++#define GET_RX_STATUS_DESC_MORE_DATA_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 26, 1) ++#define GET_RX_STATUS_DESC_MORE_FRAG_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 27, 1) ++#define GET_RX_STATUS_DESC_TYPE_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 28, 2) ++#define GET_RX_STATUS_DESC_MC_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 30, 1) ++#define GET_RX_STATUS_DESC_BC_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 31, 1) ++ ++/* DWORD 2 */ ++#define GET_RX_STATUS_DESC_SEQ_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) ++#define GET_RX_STATUS_DESC_FRAG_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) ++#define GET_RX_STATUS_DESC_RX_IS_QOS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) ++ ++#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) ++#define GET_RX_STATUS_DESC_HWRSVD_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 24, 4) ++#define GET_RX_STATUS_DESC_FCS_OK_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 31, 1) ++#define GET_RX_STATUS_DESC_RPT_SEL_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) ++ ++/* DWORD 3 */ ++#define GET_RX_STATUS_DESC_RX_RATE_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) ++#define GET_RX_STATUS_DESC_HTC_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) ++#define GET_RX_STATUS_DESC_EOSP_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) ++#define GET_RX_STATUS_DESC_BSSID_FIT_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) ++#define GET_RX_STATUS_DESC_DMA_AGG_NUM_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) ++ ++#define GET_RX_STATUS_DESC_PATTERN_MATCH_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) ++#define GET_RX_STATUS_DESC_UNICAST_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) ++#define GET_RX_STATUS_DESC_MAGIC_WAKE_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) ++ ++ ++/* DWORD 5 */ ++#define GET_RX_STATUS_DESC_TSFL_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) ++ ++#define GET_RX_STATUS_DESC_BUFF_ADDR_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) ++#define GET_RX_STATUS_DESC_BUFF_ADDR64_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) ++ ++ ++#ifdef CONFIG_SDIO_HCI ++ s32 rtl8192es_init_recv_priv(PADAPTER padapter); ++ void rtl8192es_free_recv_priv(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ void rtl8192eu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); ++ s32 rtl8192eu_init_recv_priv(PADAPTER padapter); ++ void rtl8192eu_free_recv_priv(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ s32 rtl8192ee_init_recv_priv(PADAPTER padapter); ++ void rtl8192ee_free_recv_priv(PADAPTER padapter); ++#endif ++ ++void rtl8192e_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); ++ ++#endif /* __RTL8192E_RECV_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_rf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_rf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_rf.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,33 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8192E_RF_H__ ++#define __RTL8192E_RF_H__ ++ ++VOID ++PHY_RF6052SetBandwidth8192E( ++ IN PADAPTER Adapter, ++ IN CHANNEL_WIDTH Bandwidth); ++ ++ ++int ++PHY_RF6052_Config_8192E( ++ IN PADAPTER Adapter); ++ ++#endif/* __RTL8192E_RF_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_spec.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_spec.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_spec.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,329 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ *******************************************************************************/ ++#ifndef __RTL8192E_SPEC_H__ ++#define __RTL8192E_SPEC_H__ ++ ++#include ++ ++#define HAL_NAV_UPPER_UNIT_8192E 128 /* micro-second */ ++ ++/* ************************************************************ ++ * 8192E Regsiter offset definition ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * ++ * ************************************************************ */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0000h ~ 0x00FFh System Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_SYS_SWR_CTRL1_8192E 0x0010 /* 1 Byte */ ++#define REG_SYS_SWR_CTRL2_8192E 0x0014 /* 1 Byte */ ++#define REG_AFE_CTRL1_8192E 0x0024 ++#define REG_AFE_CTRL2_8192E 0x0028 ++#define REG_AFE_CTRL3_8192E 0x002c ++ ++#define REG_PAD_CTRL1_8192E 0x0064 ++#define REG_SDIO_CTRL_8192E 0x0070 ++#define REG_OPT_CTRL_8192E 0x0074 ++#define REG_RF_B_CTRL_8192E 0x0076 ++#define REG_AFE_CTRL4_8192E 0x0078 ++#define REG_LDO_SWR_CTRL 0x007C ++#define REG_FW_DRV_MSG_8192E 0x0088 ++#define REG_HMEBOX_E2_E3_8192E 0x008C ++#define REG_HIMR0_8192E 0x00B0 ++#define REG_HISR0_8192E 0x00B4 ++#define REG_HIMR1_8192E 0x00B8 ++#define REG_HISR1_8192E 0x00BC ++ ++#define REG_SYS_CFG1_8192E 0x00F0 ++#define REG_SYS_CFG2_8192E 0x00FC ++/* ----------------------------------------------------- ++ * ++ * 0x0100h ~ 0x01FFh MACTOP General Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_PKTBUF_DBG_ADDR (REG_PKTBUF_DBG_CTRL) ++#define REG_RXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+2) ++#define REG_TXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+3) ++#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN ++ ++#define REG_RSVD3_8192E 0x0168 ++#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 ++#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 ++#define REG_C2HEVT_CMD_LEN_88XX 0x01AE ++ ++#define REG_HMEBOX_EXT0_8192E 0x01F0 ++#define REG_HMEBOX_EXT1_8192E 0x01F4 ++#define REG_HMEBOX_EXT2_8192E 0x01F8 ++#define REG_HMEBOX_EXT3_8192E 0x01FC ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0200h ~ 0x027Fh TXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_DWBCN0_CTRL 0x0208 ++#define REG_DWBCN1_CTRL 0x0228 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0280h ~ 0x02FFh RXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_RXDMA_8192E 0x0290 ++#define REG_EARLY_MODE_CONTROL_8192E 0x02BC ++ ++#define REG_RSVD5_8192E 0x02F0 ++#define REG_RSVD6_8192E 0x02F4 ++#define REG_RSVD7_8192E 0x02F8 ++#define REG_RSVD8_8192E 0x02FC ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0300h ~ 0x03FFh PCIe ++ * ++ * ----------------------------------------------------- */ ++#define REG_PCIE_CTRL_REG_8192E 0x0300 ++#define REG_INT_MIG_8192E 0x0304 /* Interrupt Migration */ ++#define REG_BCNQ_TXBD_DESA_8192E 0x0308 /* TX Beacon Descriptor Address */ ++#define REG_MGQ_TXBD_DESA_8192E 0x0310 /* TX Manage Queue Descriptor Address */ ++#define REG_VOQ_TXBD_DESA_8192E 0x0318 /* TX VO Queue Descriptor Address */ ++#define REG_VIQ_TXBD_DESA_8192E 0x0320 /* TX VI Queue Descriptor Address */ ++#define REG_BEQ_TXBD_DESA_8192E 0x0328 /* TX BE Queue Descriptor Address */ ++#define REG_BKQ_TXBD_DESA_8192E 0x0330 /* TX BK Queue Descriptor Address */ ++#define REG_RXQ_RXBD_DESA_8192E 0x0338 /* RX Queue Descriptor Address */ ++#define REG_HI0Q_TXBD_DESA_8192E 0x0340 ++#define REG_HI1Q_TXBD_DESA_8192E 0x0348 ++#define REG_HI2Q_TXBD_DESA_8192E 0x0350 ++#define REG_HI3Q_TXBD_DESA_8192E 0x0358 ++#define REG_HI4Q_TXBD_DESA_8192E 0x0360 ++#define REG_HI5Q_TXBD_DESA_8192E 0x0368 ++#define REG_HI6Q_TXBD_DESA_8192E 0x0370 ++#define REG_HI7Q_TXBD_DESA_8192E 0x0378 ++#define REG_MGQ_TXBD_NUM_8192E 0x0380 ++#define REG_RX_RXBD_NUM_8192E 0x0382 ++#define REG_VOQ_TXBD_NUM_8192E 0x0384 ++#define REG_VIQ_TXBD_NUM_8192E 0x0386 ++#define REG_BEQ_TXBD_NUM_8192E 0x0388 ++#define REG_BKQ_TXBD_NUM_8192E 0x038A ++#define REG_HI0Q_TXBD_NUM_8192E 0x038C ++#define REG_HI1Q_TXBD_NUM_8192E 0x038E ++#define REG_HI2Q_TXBD_NUM_8192E 0x0390 ++#define REG_HI3Q_TXBD_NUM_8192E 0x0392 ++#define REG_HI4Q_TXBD_NUM_8192E 0x0394 ++#define REG_HI5Q_TXBD_NUM_8192E 0x0396 ++#define REG_HI6Q_TXBD_NUM_8192E 0x0398 ++#define REG_HI7Q_TXBD_NUM_8192E 0x039A ++#define REG_TSFTIMER_HCI_8192E 0x039C ++ ++/* Read Write Point */ ++#define REG_VOQ_TXBD_IDX_8192E 0x03A0 ++#define REG_VIQ_TXBD_IDX_8192E 0x03A4 ++#define REG_BEQ_TXBD_IDX_8192E 0x03A8 ++#define REG_BKQ_TXBD_IDX_8192E 0x03AC ++#define REG_MGQ_TXBD_IDX_8192E 0x03B0 ++#define REG_RXQ_TXBD_IDX_8192E 0x03B4 ++#define REG_HI0Q_TXBD_IDX_8192E 0x03B8 ++#define REG_HI1Q_TXBD_IDX_8192E 0x03BC ++#define REG_HI2Q_TXBD_IDX_8192E 0x03C0 ++#define REG_HI3Q_TXBD_IDX_8192E 0x03C4 ++#define REG_HI4Q_TXBD_IDX_8192E 0x03C8 ++#define REG_HI5Q_TXBD_IDX_8192E 0x03CC ++#define REG_HI6Q_TXBD_IDX_8192E 0x03D0 ++#define REG_HI7Q_TXBD_IDX_8192E 0x03D4 ++ ++#define REG_PCIE_HCPWM_8192EE 0x03D8 /* ?????? */ ++#define REG_PCIE_HRPWM_8192EE 0x03DC /* PCIe RPWM */ /* ?????? */ ++#define REG_DBI_WDATA_V1_8192E 0x03E8 ++#define REG_DBI_RDATA_V1_8192E 0x03EC ++#define REG_DBI_FLAG_V1_8192E 0x03F0 ++#define REG_MDIO_V1_8192E 0x3F4 ++#define REG_PCIE_MIX_CFG_8192E 0x3F8 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0400h ~ 0x047Fh Protocol Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_TXBF_CTRL_8192E 0x042C ++#define REG_ARFR0_8192E 0x0444 ++#define REG_ARFR1_8192E 0x044C ++#define REG_CCK_CHECK_8192E 0x0454 ++#define REG_AMPDU_MAX_TIME_8192E 0x0456 ++#define REG_BCNQ1_BDNY_8192E 0x0457 ++ ++#define REG_AMPDU_MAX_LENGTH_8192E 0x0458 ++#define REG_WMAC_LBK_BUF_HD_8192E 0x045D ++#define REG_NDPA_OPT_CTRL_8192E 0x045F ++#define REG_DATA_SC_8192E 0x0483 ++#ifdef CONFIG_WOWLAN ++ #define REG_TXPKTBUF_IV_LOW 0x0484 ++ #define REG_TXPKTBUF_IV_HIGH 0x0488 ++#endif ++#define REG_ARFR2_8192E 0x048C ++#define REG_ARFR3_8192E 0x0494 ++#define REG_TXRPT_START_OFFSET 0x04AC ++#define REG_AMPDU_BURST_MODE_8192E 0x04BC ++#define REG_HT_SINGLE_AMPDU_8192E 0x04C7 ++#define REG_MACID_PKT_DROP0_8192E 0x04D0 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0500h ~ 0x05FFh EDCA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_CTWND_8192E 0x0572 ++#define REG_SECONDARY_CCA_CTRL_8192E 0x0577 ++#define REG_SCH_TXCMD_8192E 0x05F8 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0600h ~ 0x07FFh WMAC Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_MAC_CR_8192E 0x0600 ++ ++#define REG_MAC_TX_SM_STATE_8192E 0x06B4 ++ ++/* Power */ ++#define REG_BFMER0_INFO_8192E 0x06E4 ++#define REG_BFMER1_INFO_8192E 0x06EC ++#define REG_CSI_RPT_PARAM_BW20_8192E 0x06F4 ++#define REG_CSI_RPT_PARAM_BW40_8192E 0x06F8 ++#define REG_CSI_RPT_PARAM_BW80_8192E 0x06FC ++ ++/* Hardware Port 2 */ ++#define REG_BFMEE_SEL_8192E 0x0714 ++#define REG_SND_PTCL_CTRL_8192E 0x0718 ++ ++ ++/* ----------------------------------------------------- ++ * ++ * Redifine register definition for compatibility ++ * ++ * ----------------------------------------------------- */ ++ ++/* TODO: use these definition when using REG_xxx naming rule. ++ * NOTE: DO NOT Remove these definition. Use later. */ ++#define ISR_8192E REG_HISR0_8192E ++ ++/* ---------------------------------------------------------------------------- ++ * 8192E IMR/ISR bits (offset 0xB0, 8bits) ++ * ---------------------------------------------------------------------------- */ ++#define IMR_DISABLED_8192E 0 ++/* IMR DW0(0x00B0-00B3) Bit 0-31 */ ++#define IMR_TIMER2_8192E BIT31 /* Timeout interrupt 2 */ ++#define IMR_TIMER1_8192E BIT30 /* Timeout interrupt 1 */ ++#define IMR_PSTIMEOUT_8192E BIT29 /* Power Save Time Out Interrupt */ ++#define IMR_GTINT4_8192E BIT28 /* When GTIMER4 expires, this bit is set to 1 */ ++#define IMR_GTINT3_8192E BIT27 /* When GTIMER3 expires, this bit is set to 1 */ ++#define IMR_TXBCN0ERR_8192E BIT26 /* Transmit Beacon0 Error */ ++#define IMR_TXBCN0OK_8192E BIT25 /* Transmit Beacon0 OK */ ++#define IMR_TSF_BIT32_TOGGLE_8192E BIT24 /* TSF Timer BIT32 toggle indication interrupt */ ++#define IMR_BCNDMAINT0_8192E BIT20 /* Beacon DMA Interrupt 0 */ ++#define IMR_BCNDERR0_8192E BIT16 /* Beacon Queue DMA OK0 */ ++#define IMR_HSISR_IND_ON_INT_8192E BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ ++#define IMR_BCNDMAINT_E_8192E BIT14 /* Beacon DMA Interrupt Extension for Win7 */ ++#define IMR_ATIMEND_8192E BIT12 /* CTWidnow End or ATIM Window End */ ++#define IMR_C2HCMD_8192E BIT10 /* CPU to Host Command INT Status, Write 1 clear */ ++#define IMR_CPWM2_8192E BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_CPWM_8192E BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_HIGHDOK_8192E BIT7 /* High Queue DMA OK */ ++#define IMR_MGNTDOK_8192E BIT6 /* Management Queue DMA OK */ ++#define IMR_BKDOK_8192E BIT5 /* AC_BK DMA OK */ ++#define IMR_BEDOK_8192E BIT4 /* AC_BE DMA OK */ ++#define IMR_VIDOK_8192E BIT3 /* AC_VI DMA OK */ ++#define IMR_VODOK_8192E BIT2 /* AC_VO DMA OK */ ++#define IMR_RDU_8192E BIT1 /* Rx Descriptor Unavailable */ ++#define IMR_ROK_8192E BIT0 /* Receive DMA OK */ ++ ++/* IMR DW1(0x00B4-00B7) Bit 0-31 */ ++#define IMR_BCNDMAINT7_8192E BIT27 /* Beacon DMA Interrupt 7 */ ++#define IMR_BCNDMAINT6_8192E BIT26 /* Beacon DMA Interrupt 6 */ ++#define IMR_BCNDMAINT5_8192E BIT25 /* Beacon DMA Interrupt 5 */ ++#define IMR_BCNDMAINT4_8192E BIT24 /* Beacon DMA Interrupt 4 */ ++#define IMR_BCNDMAINT3_8192E BIT23 /* Beacon DMA Interrupt 3 */ ++#define IMR_BCNDMAINT2_8192E BIT22 /* Beacon DMA Interrupt 2 */ ++#define IMR_BCNDMAINT1_8192E BIT21 /* Beacon DMA Interrupt 1 */ ++#define IMR_BCNDOK7_8192E BIT20 /* Beacon Queue DMA OK Interrup 7 */ ++#define IMR_BCNDOK6_8192E BIT19 /* Beacon Queue DMA OK Interrup 6 */ ++#define IMR_BCNDOK5_8192E BIT18 /* Beacon Queue DMA OK Interrup 5 */ ++#define IMR_BCNDOK4_8192E BIT17 /* Beacon Queue DMA OK Interrup 4 */ ++#define IMR_BCNDOK3_8192E BIT16 /* Beacon Queue DMA OK Interrup 3 */ ++#define IMR_BCNDOK2_8192E BIT15 /* Beacon Queue DMA OK Interrup 2 */ ++#define IMR_BCNDOK1_8192E BIT14 /* Beacon Queue DMA OK Interrup 1 */ ++#define IMR_ATIMEND_E_8192E BIT13 /* ATIM Window End Extension for Win7 */ ++#define IMR_TXERR_8192E BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ ++#define IMR_RXERR_8192E BIT10 /* Rx Error Flag INT Status, Write 1 clear */ ++#define IMR_TXFOVW_8192E BIT9 /* Transmit FIFO Overflow */ ++#define IMR_RXFOVW_8192E BIT8 /* Receive FIFO Overflow */ ++ ++/* ---------------------------------------------------------------------------- ++ * 8192E Auto LLT bits (offset 0x224, 8bits) ++ * ---------------------------------------------------------------------------- ++ * 224 REG_AUTO_LLT ++ * move to hal_com_reg.h */ ++ ++/* ---------------------------------------------------------------------------- ++ * 8192E Auto LLT bits (offset 0x290, 32bits) ++ * ---------------------------------------------------------------------------- */ ++#define BIT_DMA_MODE BIT1 ++#define BIT_USB_RXDMA_AGG_EN BIT31 ++ ++/* ---------------------------------------------------------------------------- ++ * 8192E REG_SYS_CFG1 (offset 0xF0, 32bits) ++ * ---------------------------------------------------------------------------- */ ++#define BIT_SPSLDO_SEL BIT24 ++ ++ ++/* ---------------------------------------------------------------------------- ++ * 8192E REG_CCK_CHECK (offset 0x454, 8bits) ++ * ---------------------------------------------------------------------------- */ ++#define BIT_BCN_PORT_SEL BIT5 ++ ++/* **************************************************************************** ++ * Regsiter Bit and Content definition ++ * **************************************************************************** */ ++ ++/* 2 ACMHWCTRL 0x05C0 */ ++#define AcmHw_HwEn_8192E BIT(0) ++#define AcmHw_VoqEn_8192E BIT(1) ++#define AcmHw_ViqEn_8192E BIT(2) ++#define AcmHw_BeqEn_8192E BIT(3) ++#define AcmHw_VoqStatus_8192E BIT(5) ++#define AcmHw_ViqStatus_8192E BIT(6) ++#define AcmHw_BeqStatus_8192E BIT(7) ++ ++/* ******************************************************** ++ * General definitions ++ * ******************************************************** */ ++ ++#define MACID_NUM_8192E 128 ++#define SEC_CAM_ENT_NUM_8192E 64 ++#define HW_PORT_NUM_8192E 2 ++#define NSS_NUM_8192E 2 ++#define BAND_CAP_8192E (BAND_CAP_2G) ++#define BW_CAP_8192E (BW_CAP_20M | BW_CAP_40M) ++#define PROTO_CAP_8192E (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) ++ ++#endif /* __RTL8192E_SPEC_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_sreset.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_sreset.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_sreset.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,29 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL88812A_SRESET_H_ ++#define _RTL8812A_SRESET_H_ ++ ++#include ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ extern void rtl8192e_sreset_xmit_status_check(_adapter *padapter); ++ extern void rtl8192e_sreset_linked_status_check(_adapter *padapter); ++#endif ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_xmit.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_xmit.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_xmit.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,451 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8192E_XMIT_H__ ++#define __RTL8192E_XMIT_H__ ++ ++typedef struct txdescriptor_8192e { ++ /* Offset 0 */ ++ u32 pktlen:16; ++ u32 offset:8; ++ u32 bmc:1; ++ u32 htc:1; ++ u32 ls:1; ++ u32 fs:1; ++ u32 linip:1; ++ u32 noacm:1; ++ u32 gf:1; ++ u32 own:1; ++ ++ /* Offset 4 */ ++ u32 macid:6; ++ u32 rsvd0406:2; ++ u32 qsel:5; ++ u32 rd_nav_ext:1; ++ u32 lsig_txop_en:1; ++ u32 pifs:1; ++ u32 rate_id:4; ++ u32 navusehdr:1; ++ u32 en_desc_id:1; ++ u32 sectype:2; ++ u32 rsvd0424:2; ++ u32 pkt_offset:5; /* unit: 8 bytes */ ++ u32 rsvd0431:1; ++ ++ /* Offset 8 */ ++ u32 rts_rc:6; ++ u32 data_rc:6; ++ u32 agg_en:1; ++ u32 rd_en:1; ++ u32 bar_rty_th:2; ++ u32 bk:1; ++ u32 morefrag:1; ++ u32 raw:1; ++ u32 ccx:1; ++ u32 ampdu_density:3; ++ u32 bt_null:1; ++ u32 ant_sel_a:1; ++ u32 ant_sel_b:1; ++ u32 tx_ant_cck:2; ++ u32 tx_antl:2; ++ u32 tx_ant_ht:2; ++ ++ /* Offset 12 */ ++ u32 nextheadpage:8; ++ u32 tailpage:8; ++ u32 seq:12; ++ u32 cpu_handle:1; ++ u32 tag1:1; ++ u32 trigger_int:1; ++ u32 hwseq_en:1; ++ ++ /* Offset 16 */ ++ u32 rtsrate:5; ++ u32 ap_dcfe:1; ++ u32 hwseq_sel:2; ++ u32 userate:1; ++ u32 disrtsfb:1; ++ u32 disdatafb:1; ++ u32 cts2self:1; ++ u32 rtsen:1; ++ u32 hw_rts_en:1; ++ u32 port_id:1; ++ u32 pwr_status:3; ++ u32 wait_dcts:1; ++ u32 cts2ap_en:1; ++ u32 data_sc:2; ++ u32 data_stbc:2; ++ u32 data_short:1; ++ u32 data_bw:1; ++ u32 rts_short:1; ++ u32 rts_bw:1; ++ u32 rts_sc:2; ++ u32 vcs_stbc:2; ++ ++ /* Offset 20 */ ++ u32 datarate:6; ++ u32 sgi:1; ++ u32 try_rate:1; ++ u32 data_ratefb_lmt:5; ++ u32 rts_ratefb_lmt:4; ++ u32 rty_lmt_en:1; ++ u32 data_rt_lmt:6; ++ u32 usb_txagg_num:8; ++ ++ /* Offset 24 */ ++ u32 txagg_a:5; ++ u32 txagg_b:5; ++ u32 use_max_len:1; ++ u32 max_agg_num:5; ++ u32 mcsg1_max_len:4; ++ u32 mcsg2_max_len:4; ++ u32 mcsg3_max_len:4; ++ u32 mcs7_sgi_max_len:4; ++ ++ /* Offset 28 */ ++ u32 checksum:16; /* TxBuffSize(PCIe)/CheckSum(USB) */ ++ u32 mcsg4_max_len:4; ++ u32 mcsg5_max_len:4; ++ u32 mcsg6_max_len:4; ++ u32 mcs15_sgi_max_len:4; ++} TXDESC_8192E, *PTXDESC_8192E; ++ ++ ++ ++/* For 88e early mode */ ++#define SET_EARLYMODE_PKTNUM(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 3, __Value) ++#define SET_EARLYMODE_LEN0(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 12, __Value) ++#define SET_EARLYMODE_LEN1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 16, 12, __Value) ++#define SET_EARLYMODE_LEN2_1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 28, 4, __Value) ++#define SET_EARLYMODE_LEN2_2(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 8, __Value) ++#define SET_EARLYMODE_LEN3(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 8, 12, __Value) ++#define SET_EARLYMODE_LEN4(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 20, 12, __Value) ++ ++/* ++ * defined for TX DESC Operation ++ * */ ++ ++#define MAX_TID (15) ++ ++/* OFFSET 0 */ ++#define OFFSET_SZ 0 ++#define OFFSET_SHT 16 ++#define BMC BIT(24) ++#define LSG BIT(26) ++#define FSG BIT(27) ++#define OWN BIT(31) ++ ++ ++/* OFFSET 4 */ ++#define PKT_OFFSET_SZ 0 ++#define QSEL_SHT 8 ++#define RATE_ID_SHT 16 ++#define NAVUSEHDR BIT(20) ++#define SEC_TYPE_SHT 22 ++#define PKT_OFFSET_SHT 26 ++ ++/* OFFSET 8 */ ++#define AGG_EN BIT(12) ++#define AGG_BK BIT(16) ++#define AMPDU_DENSITY_SHT 20 ++#define ANTSEL_A BIT(24) ++#define ANTSEL_B BIT(25) ++#define TX_ANT_CCK_SHT 26 ++#define TX_ANTL_SHT 28 ++#define TX_ANT_HT_SHT 30 ++ ++/* OFFSET 12 */ ++#define SEQ_SHT 16 ++#define EN_HWSEQ BIT(31) ++ ++/* OFFSET 16 */ ++#define QOS BIT(6) ++#define HW_SSN BIT(7) ++#define USERATE BIT(8) ++#define DISDATAFB BIT(10) ++#define CTS_2_SELF BIT(11) ++#define RTS_EN BIT(12) ++#define HW_RTS_EN BIT(13) ++#define DATA_SHORT BIT(24) ++#define PWR_STATUS_SHT 15 ++#define DATA_SC_SHT 20 ++#define DATA_BW BIT(25) ++ ++/* OFFSET 20 */ ++#define RTY_LMT_EN BIT(17) ++ ++ ++/* OFFSET 20 */ ++#define SGI BIT(6) ++#define USB_TXAGG_NUM_SHT 24 ++ ++ ++/* *****Tx Desc Buffer content */ ++ ++/* config element for each tx buffer ++ * ++#define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16), 0, 16, __Valeu) ++#define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16), 31, 1, __Valeu) ++#define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16)+4, 0, 32, __Valeu) ++#define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16)+8, 0, 32, __Valeu) ++*/ ++#define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 0, 16, __Valeu) ++#define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 31, 1, __Valeu) ++#define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8)+4, 0, 32, __Valeu) ++#define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16)+8, 0, 32, __Valeu) ++ ++ ++/* Dword 0 */ ++#define SET_TX_BUFF_DESC_LEN_0_92E(__pTxDesc, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 14, __Valeu) ++#define SET_TX_BUFF_DESC_PSB_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 15, __Value) ++#define SET_TX_BUFF_DESC_OWN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) ++/* Dword 1 */ ++#define SET_TX_BUFF_DESC_ADDR_LOW_0_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 32, __Value) ++#define GET_TX_DESC_TX_BUFFER_ADDRESS_92E(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+4, 0, 32) ++ ++ ++/* Dword 2 */ ++#define SET_TX_BUFF_DESC_ADDR_HIGH_0_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 32, __Value) ++/* Dword 3, RESERVED */ ++ ++ ++/* *****Tx Desc content ++ * Dword 0 */ ++#define SET_TX_DESC_PKT_SIZE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) ++#define SET_TX_DESC_OFFSET_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) ++#define SET_TX_DESC_BMC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) ++#define SET_TX_DESC_HTC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) ++#define SET_TX_DESC_LAST_SEG_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) ++#define SET_TX_DESC_FIRST_SEG_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) ++#define SET_TX_DESC_LINIP_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) ++#define SET_TX_DESC_NO_ACM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) ++#define SET_TX_DESC_GF_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) ++#define SET_TX_DESC_OWN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) ++#define GET_TX_DESC_OWN_92E(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) ++ ++/* Dword 1 */ ++#define SET_TX_DESC_MACID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) ++#define SET_TX_DESC_QUEUE_SEL_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) ++#define SET_TX_DESC_RDG_NAV_EXT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) ++#define SET_TX_DESC_LSIG_TXOP_EN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) ++#define SET_TX_DESC_PIFS_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) ++#define SET_TX_DESC_RATE_ID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) ++#define SET_TX_DESC_EN_DESC_ID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) ++#define SET_TX_DESC_SEC_TYPE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) ++#define SET_TX_DESC_PKT_OFFSET_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) ++#define SET_TX_DESC_MORE_DATA_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 29, 1, __Value) ++#define SET_TX_DESC_TXOP_PS_CAP_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 30, 1, __Value) ++#define SET_TX_DESC_TXOP_PS_MODE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 31, 1, __Value) ++ ++ ++/* Dword 2 */ ++#define SET_TX_DESC_PAID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) ++#define SET_TX_DESC_CCA_RTS_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) ++#define SET_TX_DESC_AGG_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) ++#define SET_TX_DESC_RDG_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) ++#define SET_TX_DESC_NULL_0_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 14, 1, __Value) ++#define SET_TX_DESC_NULL_1_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 15, 1, __Value) ++#define SET_TX_DESC_BK_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) ++#define SET_TX_DESC_MORE_FRAG_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) ++#define SET_TX_DESC_RAW_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) ++#define GET_TX_DESC_MORE_FRAG_92E(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+8, 17, 1) ++#define SET_TX_DESC_SPE_RPT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) ++#define SET_TX_DESC_AMPDU_DENSITY_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) ++#define SET_TX_DESC_BT_NULL_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) ++#define SET_TX_DESC_GID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) ++ ++ ++/* Dword 3 */ ++#define SET_TX_DESC_WHEADER_LEN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) ++#define SET_TX_DESC_CHK_EN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) ++#define SET_TX_DESC_EARLY_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) ++#define SET_TX_DESC_HWSEQ_SEL_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) ++#define SET_TX_DESC_USE_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) ++#define SET_TX_DESC_DISABLE_RTS_FB_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) ++#define SET_TX_DESC_DISABLE_FB_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) ++#define SET_TX_DESC_CTS2SELF_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) ++#define SET_TX_DESC_RTS_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) ++#define SET_TX_DESC_HW_RTS_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) ++#define SET_TX_DESC_HW_PORT_ID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 14, 1, __Value) ++#define SET_TX_DESC_NAV_USE_HDR_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) ++#define SET_TX_DESC_USE_MAX_LEN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) ++#define SET_TX_DESC_MAX_AGG_NUM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) ++#define SET_TX_DESC_NDPA_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) ++#define SET_TX_DESC_AMPDU_MAX_TIME_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) ++ ++/* Dword 4 */ ++#define SET_TX_DESC_TX_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) ++#define SET_TX_DESC_TRY_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 7, 1, __Value) ++#define SET_TX_DESC_DATA_RATE_FB_LIMIT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) ++#define SET_TX_DESC_RTS_RATE_FB_LIMIT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) ++#define SET_TX_DESC_RETRY_LIMIT_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) ++#define SET_TX_DESC_DATA_RETRY_LIMIT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) ++#define SET_TX_DESC_RTS_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) ++#define SET_TX_DESC_PCTS_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 29, 1, __Value) ++#define SET_TX_DESC_PCTS_MASK_IDX_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 30, 2, __Value) ++ ++ ++/* Dword 5 */ ++#define SET_TX_DESC_DATA_SC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) ++#define SET_TX_DESC_DATA_SHORT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) ++#define SET_TX_DESC_DATA_BW_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) ++#define SET_TX_DESC_DATA_LDPC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) ++#define SET_TX_DESC_DATA_STBC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) ++#define SET_TX_DESC_VCS_STBC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) ++#define SET_TX_DESC_RTS_SHORT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) ++#define SET_TX_DESC_RTS_SC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) ++#define SET_TX_DESC_TX_ANT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 4, __Value) ++#define SET_TX_DESC_TX_POWER_0_PSET_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 28, 3, __Value) ++ ++/* Dword 6 */ ++#define SET_TX_DESC_SW_DEFINE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) ++#define SET_TX_DESC_MBSSID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) ++#define SET_TX_DESC_ANTSEL_A_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) ++#define SET_TX_DESC_ANTSEL_B_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) ++#define SET_TX_DESC_ANTSEL_C_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) ++#define SET_TX_DESC_ANTSEL_D_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) ++ ++/* Dword 7 */ ++#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++ #define SET_TX_DESC_TX_BUFFER_SIZE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++#else ++ #define SET_TX_DESC_TX_DESC_CHECKSUM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++#endif ++#define SET_TX_DESC_USB_TXAGG_NUM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) ++ ++ ++/* #define SET_TX_DESC_HWSEQ_EN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) */ ++/* Dword 8 */ ++ ++#define SET_TX_DESC_RTS_RC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 6, __Value) ++#define SET_TX_DESC_BAR_RTY_TH_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 6, 2, __Value) ++#define SET_TX_DESC_DATA_RC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 8, 6, __Value) ++#define SET_TX_DESC_EN_HWSEQ_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) ++#define SET_TX_DESC_NEXT_HEAD_PAGE_92E(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) ++#define SET_TX_DESC_TAIL_PAGE_92E(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 24, 8, __Value) ++ ++/* Dword 9 */ ++#define SET_TX_DESC_PADDING_LENGTH_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 11, __Value) ++#define SET_TX_DESC_TXBF_PATH_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 11, 1, __Value) ++#define SET_TX_DESC_SEQ_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) ++#define SET_TX_DESC_FINAL_DATA_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 24, 8, __Value) ++ ++ ++#define SET_EARLYMODE_PKTNUM_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) ++#define SET_EARLYMODE_LEN0_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) ++#define SET_EARLYMODE_LEN1_1_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) ++#define SET_EARLYMODE_LEN1_2_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) ++#define SET_EARLYMODE_LEN2_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) ++#define SET_EARLYMODE_LEN3_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) ++ ++void rtl8192e_cal_txdesc_chksum(u8 *ptxdesc); ++ ++#ifdef CONFIG_USB_HCI ++ s32 rtl8192eu_init_xmit_priv(PADAPTER padapter); ++ void rtl8192eu_free_xmit_priv(PADAPTER padapter); ++ s32 rtl8192eu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8192eu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8192eu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8192eu_xmit_buf_handler(PADAPTER padapter); ++ #define hal_xmit_handler rtl8192eu_xmit_buf_handler ++ void rtl8192eu_xmit_tasklet(void *priv); ++ s32 rtl8192eu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ s32 rtl8192ee_init_xmit_priv(PADAPTER padapter); ++ void rtl8192ee_free_xmit_priv(PADAPTER padapter); ++ struct xmit_buf *rtl8192ee_dequeue_xmitbuf(struct rtw_tx_ring *ring); ++ s32 rtl8192ee_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ void rtl8192ee_xmitframe_resume(_adapter *padapter); ++ s32 rtl8192ee_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8192ee_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ void rtl8192ee_xmit_tasklet(void *priv); ++#endif ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ s32 rtl8192es_init_xmit_priv(PADAPTER padapter); ++ void rtl8192es_free_xmit_priv(PADAPTER padapter); ++ ++ s32 rtl8192es_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8192es_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8192es_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ thread_return rtl8192es_xmit_thread(thread_context context); ++ s32 rtl8192es_xmit_buf_handler(PADAPTER padapter); ++ ++ #ifdef CONFIG_SDIO_TX_TASKLET ++ void rtl8192es_xmit_tasklet(void *priv); ++ #endif ++#endif ++ ++struct txrpt_ccx_92e { ++ /* offset 0 */ ++ u8 tag1:1; ++ u8 pkt_num:3; ++ u8 txdma_underflow:1; ++ u8 int_bt:1; ++ u8 int_tri:1; ++ u8 int_ccx:1; ++ ++ /* offset 1 */ ++ u8 mac_id:6; ++ u8 pkt_ok:1; ++ u8 bmc:1; ++ ++ /* offset 2 */ ++ u8 retry_cnt:6; ++ u8 lifetime_over:1; ++ u8 retry_over:1; ++ ++ /* offset 3 */ ++ u8 ccx_qtime0; ++ u8 ccx_qtime1; ++ ++ /* offset 5 */ ++ u8 final_data_rate; ++ ++ /* offset 6 */ ++ u8 sw1:4; ++ u8 qsel:4; ++ ++ /* offset 7 */ ++ u8 sw0; ++}; ++ ++#ifdef CONFIG_TX_EARLY_MODE ++ void UpdateEarlyModeInfo8192E(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++#endif ++s32 rtl8192e_init_xmit_priv(_adapter *padapter); ++void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, u8 *ptxdesc); ++ ++void rtl8192e_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, ++ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); ++void rtl8192e_cal_txdesc_chksum(u8 *ptxdesc); ++ ++u8 BWMapping_92E(PADAPTER Adapter, struct pkt_attrib *pattrib); ++u8 SCMapping_92E(PADAPTER Adapter, struct pkt_attrib *pattrib); ++void fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); ++void fill_txdesc_vcs(struct pkt_attrib *pattrib, u8 *ptxdesc); ++#if defined(CONFIG_CONCURRENT_MODE) ++ void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); ++#endif ++void fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc); ++void rtl8192e_fixed_rate(_adapter *padapter, u8 *ptxdesc); ++ ++#endif /* __RTL8192E_XMIT_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_cmd.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_cmd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_cmd.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,218 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8703B_CMD_H__ ++#define __RTL8703B_CMD_H__ ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ ++ * --------------------------------------------------------------------------------------------------------- */ ++ ++enum h2c_cmd_8703B { ++ /* Common Class: 000 */ ++ H2C_8703B_RSVD_PAGE = 0x00, ++ H2C_8703B_MEDIA_STATUS_RPT = 0x01, ++ H2C_8703B_SCAN_ENABLE = 0x02, ++ H2C_8703B_KEEP_ALIVE = 0x03, ++ H2C_8703B_DISCON_DECISION = 0x04, ++ H2C_8703B_PSD_OFFLOAD = 0x05, ++ H2C_8703B_AP_OFFLOAD = 0x08, ++ H2C_8703B_BCN_RSVDPAGE = 0x09, ++ H2C_8703B_PROBERSP_RSVDPAGE = 0x0A, ++ H2C_8703B_FCS_RSVDPAGE = 0x10, ++ H2C_8703B_FCS_INFO = 0x11, ++ H2C_8703B_AP_WOW_GPIO_CTRL = 0x13, ++ ++ /* PoweSave Class: 001 */ ++ H2C_8703B_SET_PWR_MODE = 0x20, ++ H2C_8703B_PS_TUNING_PARA = 0x21, ++ H2C_8703B_PS_TUNING_PARA2 = 0x22, ++ H2C_8703B_P2P_LPS_PARAM = 0x23, ++ H2C_8703B_P2P_PS_OFFLOAD = 0x24, ++ H2C_8703B_PS_SCAN_ENABLE = 0x25, ++ H2C_8703B_SAP_PS_ = 0x26, ++ H2C_8703B_INACTIVE_PS_ = 0x27, /* Inactive_PS */ ++ H2C_8703B_FWLPS_IN_IPS_ = 0x28, ++ ++ /* Dynamic Mechanism Class: 010 */ ++ H2C_8703B_MACID_CFG = 0x40, ++ H2C_8703B_TXBF = 0x41, ++ H2C_8703B_RSSI_SETTING = 0x42, ++ H2C_8703B_AP_REQ_TXRPT = 0x43, ++ H2C_8703B_INIT_RATE_COLLECT = 0x44, ++ H2C_8703B_RA_PARA_ADJUST = 0x46, ++ ++ /* BT Class: 011 */ ++ H2C_8703B_B_TYPE_TDMA = 0x60, ++ H2C_8703B_BT_INFO = 0x61, ++ H2C_8703B_FORCE_BT_TXPWR = 0x62, ++ H2C_8703B_BT_IGNORE_WLANACT = 0x63, ++ H2C_8703B_DAC_SWING_VALUE = 0x64, ++ H2C_8703B_ANT_SEL_RSV = 0x65, ++ H2C_8703B_WL_OPMODE = 0x66, ++ H2C_8703B_BT_MP_OPER = 0x67, ++ H2C_8703B_BT_CONTROL = 0x68, ++ H2C_8703B_BT_WIFI_CTRL = 0x69, ++ H2C_8703B_BT_FW_PATCH = 0x6A, ++ H2C_8703B_BT_WLAN_CALIBRATION = 0x6D, ++ ++ /* WOWLAN Class: 100 */ ++ H2C_8703B_WOWLAN = 0x80, ++ H2C_8703B_REMOTE_WAKE_CTRL = 0x81, ++ H2C_8703B_AOAC_GLOBAL_INFO = 0x82, ++ H2C_8703B_AOAC_RSVD_PAGE = 0x83, ++ H2C_8703B_AOAC_RSVD_PAGE2 = 0x84, ++ H2C_8703B_D0_SCAN_OFFLOAD_CTRL = 0x85, ++ H2C_8703B_D0_SCAN_OFFLOAD_INFO = 0x86, ++ H2C_8703B_CHNL_SWITCH_OFFLOAD = 0x87, ++ H2C_8703B_P2P_OFFLOAD_RSVD_PAGE = 0x8A, ++ H2C_8703B_P2P_OFFLOAD = 0x8B, ++ ++ H2C_8703B_RESET_TSF = 0xC0, ++ H2C_8703B_MAXID, ++}; ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- ++ * _RSVDPAGE_LOC_CMD_0x00 */ ++#define SET_8703B_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8703B_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_8703B_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8703B_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8703B_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++ ++/* _KEEP_ALIVE_CMD_0x03 */ ++#define SET_8703B_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8703B_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8703B_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_8703B_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++ ++/* _DISCONNECT_DECISION_CMD_0x04 */ ++#define SET_8703B_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8703B_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8703B_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_8703B_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) ++ ++/* _PWR_MOD_CMD_0x20 */ ++#define SET_8703B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8703B_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) ++#define SET_8703B_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) ++#define SET_8703B_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8703B_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8703B_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) ++#define SET_8703B_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#define SET_8703B_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++ ++#define GET_8703B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) ++ ++/* _PS_TUNE_PARAM_CMD_0x21 */ ++#define SET_8703B_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8703B_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_8703B_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) ++#define SET_8703B_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) ++#define SET_8703B_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++ ++/* _MACID_CFG_CMD_0x40 */ ++#define SET_8703B_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8703B_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) ++#define SET_8703B_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) ++#define SET_8703B_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) ++#define SET_8703B_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) ++#define SET_8703B_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) ++#define SET_8703B_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) ++#define SET_8703B_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) ++#define SET_8703B_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++#define SET_8703B_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) ++#define SET_8703B_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) ++#define SET_8703B_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) ++ ++/* _RSSI_SETTING_CMD_0x42 */ ++#define SET_8703B_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8703B_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) ++#define SET_8703B_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++ ++/* _AP_REQ_TXRPT_CMD_0x43 */ ++#define SET_8703B_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8703B_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++ ++/* _FORCE_BT_TXPWR_CMD_0x62 */ ++#define SET_8703B_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++ ++/* _FORCE_BT_MP_OPER_CMD_0x67 */ ++#define SET_8703B_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) ++#define SET_8703B_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) ++#define SET_8703B_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_8703B_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) ++#define SET_8703B_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++#define SET_8703B_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) ++ ++/* _BT_FW_PATCH_0x6A */ ++#define SET_8703B_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) ++#define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ------------------------------------------- Structure -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- */ ++ ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- Function Statement -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- */ ++ ++/* host message to firmware cmd */ ++void rtl8703b_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); ++void rtl8703b_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); ++void rtl8703b_set_rssi_cmd(PADAPTER padapter, u8 *param); ++void rtl8703b_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); ++/* s32 rtl8703b_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ ++void rtl8703b_set_FwPsTuneParam_cmd(PADAPTER padapter); ++void rtl8703b_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); ++void rtl8703b_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); ++void rtl8703b_download_rsvd_page(PADAPTER padapter, u8 mstatus); ++#ifdef CONFIG_BT_COEXIST ++ void rtl8703b_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); ++#endif /* CONFIG_BT_COEXIST */ ++#ifdef CONFIG_P2P ++ void rtl8703b_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); ++#endif /* CONFIG_P2P */ ++ ++void CheckFwRsvdPageContent(PADAPTER padapter); ++ ++#ifdef CONFIG_TDLS ++ #ifdef CONFIG_TDLS_CH_SW ++ void rtl8703b_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); ++ #endif ++#endif ++ ++#ifdef CONFIG_P2P_WOWLAN ++ void rtl8703b_set_p2p_wowlan_offload_cmd(PADAPTER padapter); ++#endif ++ ++void rtl8703b_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); ++ ++#ifdef CONFIG_TSF_RESET_OFFLOAD ++ u8 rtl8703b_reset_tsf(_adapter *padapter, u8 reset_port); ++#endif /* CONFIG_TSF_RESET_OFFLOAD */ ++s32 FillH2CCmd8703B(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); ++u8 GetTxBufferRsvdPageNum8703B(_adapter *padapter, bool wowlan); ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_dm.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_dm.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_dm.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,47 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8703B_DM_H__ ++#define __RTL8703B_DM_H__ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for 8703B dynamic mechanism only ++ * ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * structure and define ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * function prototype ++ * ************************************************************ */ ++ ++void rtl8703b_init_dm_priv(PADAPTER padapter); ++void rtl8703b_deinit_dm_priv(PADAPTER padapter); ++ ++void rtl8703b_InitHalDm(PADAPTER padapter); ++void rtl8703b_HalDmWatchDog(PADAPTER padapter); ++void rtl8703b_HalDmWatchDog_in_LPS(PADAPTER padapter); ++void rtl8703b_hal_dm_in_lps(PADAPTER padapter); ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_hal.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,277 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8703B_HAL_H__ ++#define __RTL8703B_HAL_H__ ++ ++#include "hal_data.h" ++ ++#include "rtl8703b_spec.h" ++#include "rtl8703b_rf.h" ++#include "rtl8703b_dm.h" ++#include "rtl8703b_recv.h" ++#include "rtl8703b_xmit.h" ++#include "rtl8703b_cmd.h" ++#include "rtl8703b_led.h" ++#include "Hal8703BPwrSeq.h" ++#include "Hal8703BPhyReg.h" ++#include "Hal8703BPhyCfg.h" ++#ifdef DBG_CONFIG_ERROR_DETECT ++ #include "rtl8703b_sreset.h" ++#endif ++ ++#define FW_8703B_SIZE 0x8000 ++#define FW_8703B_START_ADDRESS 0x1000 ++#define FW_8703B_END_ADDRESS 0x1FFF /* 0x5FFF */ ++ ++#define IS_FW_HEADER_EXIST_8703B(_pFwHdr) ((le16_to_cpu(_pFwHdr->Signature) & 0xFFF0) == 0x03B0) ++ ++typedef struct _RT_FIRMWARE { ++ FIRMWARE_SOURCE eFWSource; ++#ifdef CONFIG_EMBEDDED_FWIMG ++ u8 *szFwBuffer; ++#else ++ u8 szFwBuffer[FW_8703B_SIZE]; ++#endif ++ u32 ulFwLength; ++} RT_FIRMWARE_8703B, *PRT_FIRMWARE_8703B; ++ ++/* ++ * This structure must be cared byte-ordering ++ * ++ * Added by tynli. 2009.12.04. */ ++typedef struct _RT_8703B_FIRMWARE_HDR { ++ /* 8-byte alinment required */ ++ ++ /* --- LONG WORD 0 ---- */ ++ u16 Signature; /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ ++ u8 Category; /* AP/NIC and USB/PCI */ ++ u8 Function; /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ ++ u16 Version; /* FW Version */ ++ u16 Subversion; /* FW Subversion, default 0x00 */ ++ ++ /* --- LONG WORD 1 ---- */ ++ u8 Month; /* Release time Month field */ ++ u8 Date; /* Release time Date field */ ++ u8 Hour; /* Release time Hour field */ ++ u8 Minute; /* Release time Minute field */ ++ u16 RamCodeSize; /* The size of RAM code */ ++ u16 Rsvd2; ++ ++ /* --- LONG WORD 2 ---- */ ++ u32 SvnIdx; /* The SVN entry index */ ++ u32 Rsvd3; ++ ++ /* --- LONG WORD 3 ---- */ ++ u32 Rsvd4; ++ u32 Rsvd5; ++} RT_8703B_FIRMWARE_HDR, *PRT_8703B_FIRMWARE_HDR; ++ ++#define DRIVER_EARLY_INT_TIME_8703B 0x05 ++#define BCN_DMA_ATIME_INT_TIME_8703B 0x02 ++ ++/* for 8703B ++ * TX 32K, RX 16K, Page size 128B for TX, 8B for RX */ ++#define PAGE_SIZE_TX_8703B 128 ++#define PAGE_SIZE_RX_8703B 8 ++ ++#define TX_DMA_SIZE_8703B 0x8000 /* 32K(TX) */ ++#define RX_DMA_SIZE_8703B 0x4000 /* 16K(RX) */ ++ ++#ifdef CONFIG_WOWLAN ++ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ ++#else ++ #define RESV_FMWF 0 ++#endif ++ ++#ifdef CONFIG_FW_C2H_DEBUG ++ #define RX_DMA_RESERVED_SIZE_8703B 0x100 /* 256B, reserved for c2h debug message */ ++#else ++ #define RX_DMA_RESERVED_SIZE_8703B 0x80 /* 128B, reserved for tx report */ ++#endif ++#define RX_DMA_BOUNDARY_8703B (RX_DMA_SIZE_8703B - RX_DMA_RESERVED_SIZE_8703B - 1) ++ ++ ++/* Note: We will divide number of page equally for each queue other than public queue! */ ++ ++/* For General Reserved Page Number(Beacon Queue is reserved page) ++ * Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 */ ++#define BCNQ_PAGE_NUM_8703B 0x08 ++#ifdef CONFIG_CONCURRENT_MODE ++ #define BCNQ1_PAGE_NUM_8703B 0x08 /* 0x04 */ ++#else ++ #define BCNQ1_PAGE_NUM_8703B 0x00 ++#endif ++ ++#ifdef CONFIG_PNO_SUPPORT ++ #undef BCNQ1_PAGE_NUM_8703B ++ #define BCNQ1_PAGE_NUM_8703B 0x00 /* 0x04 */ ++#endif ++ ++/* For WoWLan , more reserved page ++ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ ++#ifdef CONFIG_WOWLAN ++ #define WOWLAN_PAGE_NUM_8703B 0x07 ++#else ++ #define WOWLAN_PAGE_NUM_8703B 0x00 ++#endif ++ ++#ifdef CONFIG_PNO_SUPPORT ++ #undef WOWLAN_PAGE_NUM_8703B ++ #define WOWLAN_PAGE_NUM_8703B 0x15 ++#endif ++ ++#ifdef CONFIG_AP_WOWLAN ++ #define AP_WOWLAN_PAGE_NUM_8703B 0x02 ++#endif ++ ++#define TX_TOTAL_PAGE_NUMBER_8703B (0xFF - BCNQ_PAGE_NUM_8703B - BCNQ1_PAGE_NUM_8703B - WOWLAN_PAGE_NUM_8703B) ++#define TX_PAGE_BOUNDARY_8703B (TX_TOTAL_PAGE_NUMBER_8703B + 1) ++ ++#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8703B TX_TOTAL_PAGE_NUMBER_8703B ++#define WMM_NORMAL_TX_PAGE_BOUNDARY_8703B (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8703B + 1) ++ ++/* For Normal Chip Setting ++ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8703B */ ++#define NORMAL_PAGE_NUM_HPQ_8703B 0x0C ++#define NORMAL_PAGE_NUM_LPQ_8703B 0x02 ++#define NORMAL_PAGE_NUM_NPQ_8703B 0x02 ++ ++/* Note: For Normal Chip Setting, modify later */ ++#define WMM_NORMAL_PAGE_NUM_HPQ_8703B 0x30 ++#define WMM_NORMAL_PAGE_NUM_LPQ_8703B 0x20 ++#define WMM_NORMAL_PAGE_NUM_NPQ_8703B 0x20 ++ ++ ++#include "HalVerDef.h" ++#include "hal_com.h" ++ ++#define EFUSE_OOB_PROTECT_BYTES 15 ++ ++#define HAL_EFUSE_MEMORY ++ ++#define HWSET_MAX_SIZE_8703B 256 ++#define EFUSE_REAL_CONTENT_LEN_8703B 256 ++#define EFUSE_MAP_LEN_8703B 512 ++#define EFUSE_MAX_SECTION_8703B 64 ++ ++#define EFUSE_IC_ID_OFFSET 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ ++#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8703B) ++ ++#define EFUSE_ACCESS_ON 0x69 ++#define EFUSE_ACCESS_OFF 0x00 ++ ++/* ******************************************************** ++ * EFUSE for BT definition ++ * ******************************************************** */ ++#define BANK_NUM 1 ++#define EFUSE_BT_REAL_BANK_CONTENT_LEN 128 ++#define EFUSE_BT_REAL_CONTENT_LEN (EFUSE_BT_REAL_BANK_CONTENT_LEN * BANK_NUM) ++#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ ++#define EFUSE_BT_MAX_SECTION (EFUSE_BT_MAP_LEN / 8) ++#define EFUSE_PROTECT_BYTES_BANK 16 ++ ++typedef enum tag_Package_Definition { ++ PACKAGE_DEFAULT, ++ PACKAGE_QFN68, ++ PACKAGE_TFBGA90, ++ PACKAGE_TFBGA80, ++ PACKAGE_TFBGA79 ++} PACKAGE_TYPE_E; ++ ++#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) ++#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) ++ ++/* rtl8703b_hal_init.c */ ++s32 rtl8703b_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); ++void rtl8703b_FirmwareSelfReset(PADAPTER padapter); ++void rtl8703b_InitializeFirmwareVars(PADAPTER padapter); ++ ++void rtl8703b_InitAntenna_Selection(PADAPTER padapter); ++void rtl8703b_DeinitAntenna_Selection(PADAPTER padapter); ++void rtl8703b_CheckAntenna_Selection(PADAPTER padapter); ++void rtl8703b_init_default_value(PADAPTER padapter); ++ ++s32 rtl8703b_InitLLTTable(PADAPTER padapter); ++ ++s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU); ++s32 CardDisableWithoutHWSM(PADAPTER padapter); ++ ++/* EFuse */ ++u8 GetEEPROMSize8703B(PADAPTER padapter); ++void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); ++void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); ++void Hal_EfuseParseTxPowerInfo_8703B(PADAPTER padapter, u8 *PROMContent, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseBTCoexistInfo_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseEEPROMVer_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseChnlPlan_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseCustomerID_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseAntennaDiversity_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseXtal_8703B(PADAPTER pAdapter, u8 *hwinfo, u8 AutoLoadFail); ++void Hal_EfuseParseThermalMeter_8703B(PADAPTER padapter, u8 *hwinfo, u8 AutoLoadFail); ++VOID Hal_EfuseParseVoltage_8703B(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++VOID Hal_EfuseParseBoardType_8703B(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++ ++void rtl8703b_set_hal_ops(struct hal_ops *pHalFunc); ++void init_hal_spec_8703b(_adapter *adapter); ++void SetHwReg8703B(PADAPTER padapter, u8 variable, u8 *val); ++void GetHwReg8703B(PADAPTER padapter, u8 variable, u8 *val); ++u8 SetHalDefVar8703B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++u8 GetHalDefVar8703B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++ ++/* register */ ++void rtl8703b_InitBeaconParameters(PADAPTER padapter); ++void rtl8703b_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); ++void _InitBurstPktLen_8703BS(PADAPTER Adapter); ++void _InitLTECoex_8703BS(PADAPTER Adapter); ++void _InitMacAPLLSetting_8703B(PADAPTER Adapter); ++void _8051Reset8703(PADAPTER padapter); ++#ifdef CONFIG_WOWLAN ++ void Hal_DetectWoWMode(PADAPTER pAdapter); ++#endif /* CONFIG_WOWLAN */ ++ ++void rtl8703b_start_thread(_adapter *padapter); ++void rtl8703b_stop_thread(_adapter *padapter); ++ ++#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) ++ void rtl8703bs_init_checkbthang_workqueue(_adapter *adapter); ++ void rtl8703bs_free_checkbthang_workqueue(_adapter *adapter); ++ void rtl8703bs_cancle_checkbthang_workqueue(_adapter *adapter); ++ void rtl8703bs_hal_check_bt_hang(_adapter *adapter); ++#endif ++ ++#ifdef CONFIG_GPIO_WAKEUP ++ void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); ++#endif ++#ifdef CONFIG_MP_INCLUDED ++int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); ++#endif ++void CCX_FwC2HTxRpt_8703b(PADAPTER padapter, u8 *pdata, u8 len); ++ ++u8 MRateToHwRate8703B(u8 rate); ++u8 HwRateToMRate8703B(u8 rate); ++ ++void Hal_ReadRFGainOffset(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++ ++#ifdef CONFIG_PCI_HCI ++ BOOLEAN InterruptRecognized8703BE(PADAPTER Adapter); ++ VOID UpdateInterruptMask8703BE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_led.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_led.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_led.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,48 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8703B_LED_H__ ++#define __RTL8703B_LED_H__ ++ ++#include ++#include ++#include ++ ++ ++/* ******************************************************************************** ++ * Interface to manipulate LED objects. ++ * ******************************************************************************** */ ++#ifdef CONFIG_USB_HCI ++ void rtl8703bu_InitSwLeds(PADAPTER padapter); ++ void rtl8703bu_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_SDIO_HCI ++ void rtl8703bs_InitSwLeds(PADAPTER padapter); ++ void rtl8703bs_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_GSPI_HCI ++ void rtl8703bs_InitSwLeds(PADAPTER padapter); ++ void rtl8703bs_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_PCI_HCI ++ void rtl8703be_InitSwLeds(PADAPTER padapter); ++ void rtl8703be_DeInitSwLeds(PADAPTER padapter); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_recv.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_recv.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_recv.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,91 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8703B_RECV_H__ ++#define __RTL8703B_RECV_H__ ++ ++#define RECV_BLK_SZ 512 ++#define RECV_BLK_CNT 16 ++#define RECV_BLK_TH RECV_BLK_CNT ++ ++#if defined(CONFIG_USB_HCI) ++ ++ #ifndef MAX_RECVBUF_SZ ++ #ifdef PLATFORM_OS_CE ++ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ ++ #else ++ #ifndef CONFIG_MINIMAL_MEMORY_USAGE ++ /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ ++ /* #define MAX_RECVBUF_SZ (16384) */ /* 16K */ ++ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ ++ #ifdef CONFIG_PLATFORM_MSTAR ++ #define MAX_RECVBUF_SZ (8192) /* 8K */ ++ #else ++ #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ ++ #endif ++ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ ++ #else ++ #define MAX_RECVBUF_SZ (4000) /* about 4K */ ++ #endif ++ #endif ++ #endif /* !MAX_RECVBUF_SZ */ ++ ++#elif defined(CONFIG_PCI_HCI) ++ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ ++ /* #define MAX_RECVBUF_SZ (9100) */ ++ /* #else */ ++ #define MAX_RECVBUF_SZ (4000) /* about 4K ++ * #endif */ ++ ++ ++#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ ++ #define MAX_RECVBUF_SZ (RX_DMA_SIZE_8703B - RX_DMA_RESERVED_SIZE_8703B) ++ ++#endif ++ ++/* Rx smooth factor */ ++#define Rx_Smooth_Factor (20) ++ ++#ifdef CONFIG_SDIO_HCI ++ #ifndef CONFIG_SDIO_RX_COPY ++ #undef MAX_RECVBUF_SZ ++ #define MAX_RECVBUF_SZ (RX_DMA_SIZE_8703B - RX_DMA_RESERVED_SIZE_8703B) ++ #endif /* !CONFIG_SDIO_RX_COPY */ ++#endif /* CONFIG_SDIO_HCI */ ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ s32 rtl8703bs_init_recv_priv(PADAPTER padapter); ++ void rtl8703bs_free_recv_priv(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ int rtl8703bu_init_recv_priv(_adapter *padapter); ++ void rtl8703bu_free_recv_priv(_adapter *padapter); ++ void rtl8703bu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ s32 rtl8703be_init_recv_priv(PADAPTER padapter); ++ void rtl8703be_free_recv_priv(PADAPTER padapter); ++#endif ++ ++void rtl8703b_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); ++ ++#endif /* __RTL8703B_RECV_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_rf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_rf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_rf.h 2018-02-11 21:44:27.169146421 +0200 +@@ -0,0 +1,30 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8703B_RF_H__ ++#define __RTL8703B_RF_H__ ++ ++int PHY_RF6052_Config8703B(IN PADAPTER Adapter); ++ ++VOID ++PHY_RF6052SetBandwidth8703B( ++ IN PADAPTER Adapter, ++ IN CHANNEL_WIDTH Bandwidth); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_spec.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_spec.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_spec.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,480 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ *******************************************************************************/ ++#ifndef __RTL8703B_SPEC_H__ ++#define __RTL8703B_SPEC_H__ ++ ++#include ++ ++ ++#define HAL_NAV_UPPER_UNIT_8703B 128 /* micro-second */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0000h ~ 0x00FFh System Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_SYS_ISO_CTRL_8703B 0x0000 /* 2 Byte */ ++#define REG_SYS_FUNC_EN_8703B 0x0002 /* 2 Byte */ ++#define REG_APS_FSMCO_8703B 0x0004 /* 4 Byte */ ++#define REG_SYS_CLKR_8703B 0x0008 /* 2 Byte */ ++#define REG_9346CR_8703B 0x000A /* 2 Byte */ ++#define REG_EE_VPD_8703B 0x000C /* 2 Byte */ ++#define REG_AFE_MISC_8703B 0x0010 /* 1 Byte */ ++#define REG_SPS0_CTRL_8703B 0x0011 /* 7 Byte */ ++#define REG_SPS_OCP_CFG_8703B 0x0018 /* 4 Byte */ ++#define REG_RSV_CTRL_8703B 0x001C /* 3 Byte */ ++#define REG_RF_CTRL_8703B 0x001F /* 1 Byte */ ++#define REG_LPLDO_CTRL_8703B 0x0023 /* 1 Byte */ ++#define REG_AFE_XTAL_CTRL_8703B 0x0024 /* 4 Byte */ ++#define REG_AFE_PLL_CTRL_8703B 0x0028 /* 4 Byte */ ++#define REG_MAC_PLL_CTRL_EXT_8703B 0x002c /* 4 Byte */ ++#define REG_EFUSE_CTRL_8703B 0x0030 ++#define REG_EFUSE_TEST_8703B 0x0034 ++#define REG_PWR_DATA_8703B 0x0038 ++#define REG_CAL_TIMER_8703B 0x003C ++#define REG_ACLK_MON_8703B 0x003E ++#define REG_GPIO_MUXCFG_8703B 0x0040 ++#define REG_GPIO_IO_SEL_8703B 0x0042 ++#define REG_MAC_PINMUX_CFG_8703B 0x0043 ++#define REG_GPIO_PIN_CTRL_8703B 0x0044 ++#define REG_GPIO_INTM_8703B 0x0048 ++#define REG_LEDCFG0_8703B 0x004C ++#define REG_LEDCFG1_8703B 0x004D ++#define REG_LEDCFG2_8703B 0x004E ++#define REG_LEDCFG3_8703B 0x004F ++#define REG_FSIMR_8703B 0x0050 ++#define REG_FSISR_8703B 0x0054 ++#define REG_HSIMR_8703B 0x0058 ++#define REG_HSISR_8703B 0x005c ++#define REG_GPIO_EXT_CTRL 0x0060 ++#define REG_PAD_CTRL1_8703B 0x0064 ++#define REG_MULTI_FUNC_CTRL_8703B 0x0068 ++#define REG_GPIO_STATUS_8703B 0x006C ++#define REG_SDIO_CTRL_8703B 0x0070 ++#define REG_OPT_CTRL_8703B 0x0074 ++#define REG_AFE_CTRL_4_8703B 0x0078 ++#define REG_MCUFWDL_8703B 0x0080 ++#define REG_HMEBOX_DBG_0_8703B 0x0088 ++#define REG_HMEBOX_DBG_1_8703B 0x008A ++#define REG_HMEBOX_DBG_2_8703B 0x008C ++#define REG_HMEBOX_DBG_3_8703B 0x008E ++#define REG_HIMR0_8703B 0x00B0 ++#define REG_HISR0_8703B 0x00B4 ++#define REG_HIMR1_8703B 0x00B8 ++#define REG_HISR1_8703B 0x00BC ++#define REG_PMC_DBG_CTRL2_8703B 0x00CC ++#define REG_EFUSE_BURN_GNT_8703B 0x00CF ++#define REG_HPON_FSM_8703B 0x00EC ++#define REG_SYS_CFG_8703B 0x00F0 ++#define REG_SYS_CFG1_8703B 0x00FC ++#define REG_ROM_VERSION 0x00FD ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0100h ~ 0x01FFh MACTOP General Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_C2HEVT_CMD_ID_8703B 0x01A0 ++#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 ++#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 ++#define REG_C2HEVT_CMD_LEN_8703B 0x01AE ++#define REG_C2HEVT_CMD_LEN_88XX REG_C2HEVT_CMD_LEN_8703B ++#define REG_C2HEVT_CLEAR_8703B 0x01AF ++#define REG_MCUTST_1_8703B 0x01C0 ++#define REG_WOWLAN_WAKE_REASON 0x01C7 ++#define REG_FMETHR_8703B 0x01C8 ++#define REG_HMETFR_8703B 0x01CC ++#define REG_HMEBOX_0_8703B 0x01D0 ++#define REG_HMEBOX_1_8703B 0x01D4 ++#define REG_HMEBOX_2_8703B 0x01D8 ++#define REG_HMEBOX_3_8703B 0x01DC ++#define REG_LLT_INIT_8703B 0x01E0 ++#define REG_HMEBOX_EXT0_8703B 0x01F0 ++#define REG_HMEBOX_EXT1_8703B 0x01F4 ++#define REG_HMEBOX_EXT2_8703B 0x01F8 ++#define REG_HMEBOX_EXT3_8703B 0x01FC ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0200h ~ 0x027Fh TXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_RQPN_8703B 0x0200 ++#define REG_FIFOPAGE_8703B 0x0204 ++#define REG_DWBCN0_CTRL_8703B REG_TDECTRL ++#define REG_TXDMA_OFFSET_CHK_8703B 0x020C ++#define REG_TXDMA_STATUS_8703B 0x0210 ++#define REG_RQPN_NPQ_8703B 0x0214 ++#define REG_DWBCN1_CTRL_8703B 0x0228 ++ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0280h ~ 0x02FFh RXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_RXDMA_AGG_PG_TH_8703B 0x0280 ++#define REG_FW_UPD_RDPTR_8703B 0x0284 /* FW shall update this register before FW write RXPKT_RELEASE_POLL to 1 */ ++#define REG_RXDMA_CONTROL_8703B 0x0286 /* Control the RX DMA. */ ++#define REG_RXPKT_NUM_8703B 0x0287 /* The number of packets in RXPKTBUF. */ ++#define REG_RXDMA_STATUS_8703B 0x0288 ++#define REG_RXDMA_MODE_CTRL_8703B 0x0290 ++#define REG_EARLY_MODE_CONTROL_8703B 0x02BC ++#define REG_RSVD5_8703B 0x02F0 ++#define REG_RSVD6_8703B 0x02F4 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0300h ~ 0x03FFh PCIe ++ * ++ * ----------------------------------------------------- */ ++#define REG_PCIE_CTRL_REG_8703B 0x0300 ++#define REG_INT_MIG_8703B 0x0304 /* Interrupt Migration */ ++#define REG_BCNQ_DESA_8703B 0x0308 /* TX Beacon Descriptor Address */ ++#define REG_HQ_DESA_8703B 0x0310 /* TX High Queue Descriptor Address */ ++#define REG_MGQ_DESA_8703B 0x0318 /* TX Manage Queue Descriptor Address */ ++#define REG_VOQ_DESA_8703B 0x0320 /* TX VO Queue Descriptor Address */ ++#define REG_VIQ_DESA_8703B 0x0328 /* TX VI Queue Descriptor Address */ ++#define REG_BEQ_DESA_8703B 0x0330 /* TX BE Queue Descriptor Address */ ++#define REG_BKQ_DESA_8703B 0x0338 /* TX BK Queue Descriptor Address */ ++#define REG_RX_DESA_8703B 0x0340 /* RX Queue Descriptor Address */ ++#define REG_DBI_WDATA_8703B 0x0348 /* DBI Write Data */ ++#define REG_DBI_RDATA_8703B 0x034C /* DBI Read Data */ ++#define REG_DBI_ADDR_8703B 0x0350 /* DBI Address */ ++#define REG_DBI_FLAG_8703B 0x0352 /* DBI Read/Write Flag */ ++#define REG_MDIO_WDATA_8703B 0x0354 /* MDIO for Write PCIE PHY */ ++#define REG_MDIO_RDATA_8703B 0x0356 /* MDIO for Reads PCIE PHY */ ++#define REG_MDIO_CTL_8703B 0x0358 /* MDIO for Control */ ++#define REG_DBG_SEL_8703B 0x0360 /* Debug Selection Register */ ++#define REG_PCIE_HRPWM_8703B 0x0361 /* PCIe RPWM */ ++#define REG_PCIE_HCPWM_8703B 0x0363 /* PCIe CPWM */ ++#define REG_PCIE_MULTIFET_CTRL_8703B 0x036A /* PCIE Multi-Fethc Control */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0400h ~ 0x047Fh Protocol Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_VOQ_INFORMATION_8703B 0x0400 ++#define REG_VIQ_INFORMATION_8703B 0x0404 ++#define REG_BEQ_INFORMATION_8703B 0x0408 ++#define REG_BKQ_INFORMATION_8703B 0x040C ++#define REG_MGQ_INFORMATION_8703B 0x0410 ++#define REG_HGQ_INFORMATION_8703B 0x0414 ++#define REG_BCNQ_INFORMATION_8703B 0x0418 ++#define REG_TXPKT_EMPTY_8703B 0x041A ++ ++#define REG_FWHW_TXQ_CTRL_8703B 0x0420 ++#define REG_HWSEQ_CTRL_8703B 0x0423 ++#define REG_TXPKTBUF_BCNQ_BDNY_8703B 0x0424 ++#define REG_TXPKTBUF_MGQ_BDNY_8703B 0x0425 ++#define REG_LIFECTRL_CTRL_8703B 0x0426 ++#define REG_MULTI_BCNQ_OFFSET_8703B 0x0427 ++#define REG_SPEC_SIFS_8703B 0x0428 ++#define REG_RL_8703B 0x042A ++#define REG_TXBF_CTRL_8703B 0x042C ++#define REG_DARFRC_8703B 0x0430 ++#define REG_RARFRC_8703B 0x0438 ++#define REG_RRSR_8703B 0x0440 ++#define REG_ARFR0_8703B 0x0444 ++#define REG_ARFR1_8703B 0x044C ++#define REG_CCK_CHECK_8703B 0x0454 ++#define REG_AMPDU_MAX_TIME_8703B 0x0456 ++#define REG_TXPKTBUF_BCNQ_BDNY1_8703B 0x0457 ++ ++#define REG_AMPDU_MAX_LENGTH_8703B 0x0458 ++#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8703B 0x045D ++#define REG_NDPA_OPT_CTRL_8703B 0x045F ++#define REG_FAST_EDCA_CTRL_8703B 0x0460 ++#define REG_RD_RESP_PKT_TH_8703B 0x0463 ++#define REG_DATA_SC_8703B 0x0483 ++#ifdef CONFIG_WOWLAN ++ #define REG_TXPKTBUF_IV_LOW 0x0484 ++ #define REG_TXPKTBUF_IV_HIGH 0x0488 ++#endif ++#define REG_TXRPT_START_OFFSET 0x04AC ++#define REG_POWER_STAGE1_8703B 0x04B4 ++#define REG_POWER_STAGE2_8703B 0x04B8 ++#define REG_AMPDU_BURST_MODE_8703B 0x04BC ++#define REG_PKT_VO_VI_LIFE_TIME_8703B 0x04C0 ++#define REG_PKT_BE_BK_LIFE_TIME_8703B 0x04C2 ++#define REG_STBC_SETTING_8703B 0x04C4 ++#define REG_HT_SINGLE_AMPDU_8703B 0x04C7 ++#define REG_PROT_MODE_CTRL_8703B 0x04C8 ++#define REG_MAX_AGGR_NUM_8703B 0x04CA ++#define REG_RTS_MAX_AGGR_NUM_8703B 0x04CB ++#define REG_BAR_MODE_CTRL_8703B 0x04CC ++#define REG_RA_TRY_RATE_AGG_LMT_8703B 0x04CF ++#define REG_MACID_PKT_DROP0_8703B 0x04D0 ++#define REG_MACID_PKT_SLEEP_8703B 0x04D4 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0500h ~ 0x05FFh EDCA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_EDCA_VO_PARAM_8703B 0x0500 ++#define REG_EDCA_VI_PARAM_8703B 0x0504 ++#define REG_EDCA_BE_PARAM_8703B 0x0508 ++#define REG_EDCA_BK_PARAM_8703B 0x050C ++#define REG_BCNTCFG_8703B 0x0510 ++#define REG_PIFS_8703B 0x0512 ++#define REG_RDG_PIFS_8703B 0x0513 ++#define REG_SIFS_CTX_8703B 0x0514 ++#define REG_SIFS_TRX_8703B 0x0516 ++#define REG_AGGR_BREAK_TIME_8703B 0x051A ++#define REG_SLOT_8703B 0x051B ++#define REG_TX_PTCL_CTRL_8703B 0x0520 ++#define REG_TXPAUSE_8703B 0x0522 ++#define REG_DIS_TXREQ_CLR_8703B 0x0523 ++#define REG_RD_CTRL_8703B 0x0524 ++/* ++ * Format for offset 540h-542h: ++ * [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. ++ * [7:4]: Reserved. ++ * [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. ++ * [23:20]: Reserved ++ * Description: ++ * | ++ * |<--Setup--|--Hold------------>| ++ * --------------|---------------------- ++ * | ++ * TBTT ++ * Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. ++ * Described by Designer Tim and Bruce, 2011-01-14. ++ * */ ++#define REG_TBTT_PROHIBIT_8703B 0x0540 ++#define REG_RD_NAV_NXT_8703B 0x0544 ++#define REG_NAV_PROT_LEN_8703B 0x0546 ++#define REG_BCN_CTRL_8703B 0x0550 ++#define REG_BCN_CTRL_1_8703B 0x0551 ++#define REG_MBID_NUM_8703B 0x0552 ++#define REG_DUAL_TSF_RST_8703B 0x0553 ++#define REG_BCN_INTERVAL_8703B 0x0554 ++#define REG_DRVERLYINT_8703B 0x0558 ++#define REG_BCNDMATIM_8703B 0x0559 ++#define REG_ATIMWND_8703B 0x055A ++#define REG_USTIME_TSF_8703B 0x055C ++#define REG_BCN_MAX_ERR_8703B 0x055D ++#define REG_RXTSF_OFFSET_CCK_8703B 0x055E ++#define REG_RXTSF_OFFSET_OFDM_8703B 0x055F ++#define REG_TSFTR_8703B 0x0560 ++#define REG_CTWND_8703B 0x0572 ++#define REG_SECONDARY_CCA_CTRL_8703B 0x0577 ++#define REG_PSTIMER_8703B 0x0580 ++#define REG_TIMER0_8703B 0x0584 ++#define REG_TIMER1_8703B 0x0588 ++#define REG_ACMHWCTRL_8703B 0x05C0 ++#define REG_SCH_TXCMD_8703B 0x05F8 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0600h ~ 0x07FFh WMAC Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_MAC_CR_8703B 0x0600 ++#define REG_TCR_8703B 0x0604 ++#define REG_RCR_8703B 0x0608 ++#define REG_RX_PKT_LIMIT_8703B 0x060C ++#define REG_RX_DLK_TIME_8703B 0x060D ++#define REG_RX_DRVINFO_SZ_8703B 0x060F ++ ++#define REG_MACID_8703B 0x0610 ++#define REG_BSSID_8703B 0x0618 ++#define REG_MAR_8703B 0x0620 ++#define REG_MBIDCAMCFG_8703B 0x0628 ++#define REG_WOWLAN_GTK_DBG1 0x630 ++#define REG_WOWLAN_GTK_DBG2 0x634 ++ ++#define REG_USTIME_EDCA_8703B 0x0638 ++#define REG_MAC_SPEC_SIFS_8703B 0x063A ++#define REG_RESP_SIFP_CCK_8703B 0x063C ++#define REG_RESP_SIFS_OFDM_8703B 0x063E ++#define REG_ACKTO_8703B 0x0640 ++#define REG_CTS2TO_8703B 0x0641 ++#define REG_EIFS_8703B 0x0642 ++ ++#define REG_NAV_UPPER_8703B 0x0652 /* unit of 128 */ ++#define REG_TRXPTCL_CTL_8703B 0x0668 ++ ++/* Security */ ++#define REG_CAMCMD_8703B 0x0670 ++#define REG_CAMWRITE_8703B 0x0674 ++#define REG_CAMREAD_8703B 0x0678 ++#define REG_CAMDBG_8703B 0x067C ++#define REG_SECCFG_8703B 0x0680 ++ ++/* Power */ ++#define REG_WOW_CTRL_8703B 0x0690 ++#define REG_PS_RX_INFO_8703B 0x0692 ++#define REG_UAPSD_TID_8703B 0x0693 ++#define REG_WKFMCAM_CMD_8703B 0x0698 ++#define REG_WKFMCAM_NUM_8703B 0x0698 ++#define REG_WKFMCAM_RWD_8703B 0x069C ++#define REG_RXFLTMAP0_8703B 0x06A0 ++#define REG_RXFLTMAP1_8703B 0x06A2 ++#define REG_RXFLTMAP2_8703B 0x06A4 ++#define REG_BCN_PSR_RPT_8703B 0x06A8 ++#define REG_BT_COEX_TABLE_8703B 0x06C0 ++#define REG_BFMER0_INFO_8703B 0x06E4 ++#define REG_BFMER1_INFO_8703B 0x06EC ++#define REG_CSI_RPT_PARAM_BW20_8703B 0x06F4 ++#define REG_CSI_RPT_PARAM_BW40_8703B 0x06F8 ++#define REG_CSI_RPT_PARAM_BW80_8703B 0x06FC ++ ++/* Hardware Port 2 */ ++#define REG_MACID1_8703B 0x0700 ++#define REG_BSSID1_8703B 0x0708 ++#define REG_BFMEE_SEL_8703B 0x0714 ++#define REG_SND_PTCL_CTRL_8703B 0x0718 ++ ++/* LTE_COEX */ ++#define REG_LTECOEX_CTRL 0x07C0 ++#define REG_LTECOEX_WRITE_DATA 0x07C4 ++#define REG_LTECOEX_READ_DATA 0x07C8 ++#define REG_LTECOEX_PATH_CONTROL 0x70 ++ ++/* ************************************************************ ++ * SDIO Bus Specification ++ * ************************************************************ */ ++ ++/* ----------------------------------------------------- ++ * SDIO CMD Address Mapping ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * I/O bus domain (Host) ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * SDIO register ++ * ----------------------------------------------------- */ ++#define SDIO_REG_HCPWM1_8703B 0x025 /* HCI Current Power Mode 1 */ ++ ++ ++/* **************************************************************************** ++ * 8703 Regsiter Bit and Content definition ++ * **************************************************************************** */ ++ ++#define BIT_USB_RXDMA_AGG_EN BIT(31) ++#define RXDMA_AGG_MODE_EN BIT(1) ++ ++#ifdef CONFIG_WOWLAN ++ #define RXPKT_RELEASE_POLL BIT(16) ++ #define RXDMA_IDLE BIT(17) ++ #define RW_RELEASE_EN BIT(18) ++#endif ++ ++/* 2 HSISR ++ * interrupt mask which needs to clear */ ++#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ ++ HSISR_SPS_OCP_INT |\ ++ HSISR_RON_INT |\ ++ HSISR_PDNINT |\ ++ HSISR_GPIO9_INT) ++ ++ ++/* ---------------------------------------------------------------------------- ++ * 8703B REG_CCK_CHECK (offset 0x454) ++ * ---------------------------------------------------------------------------- */ ++#define BIT_BCN_PORT_SEL BIT5 ++ ++#ifdef CONFIG_RF_POWER_TRIM ++ ++ #ifdef CONFIG_RTL8703B ++ #define EEPROM_RF_GAIN_OFFSET 0xC1 ++ #endif ++ ++ #define EEPROM_RF_GAIN_VAL 0x1F6 ++#endif /*CONFIG_RF_POWER_TRIM*/ ++ ++ ++/* ---------------------------------------------------------------------------- ++ * 8195 IMR/ISR bits (offset 0xB0, 8bits) ++ * ---------------------------------------------------------------------------- */ ++#define IMR_DISABLED_8703B 0 ++/* IMR DW0(0x00B0-00B3) Bit 0-31 */ ++#define IMR_TIMER2_8703B BIT31 /* Timeout interrupt 2 */ ++#define IMR_TIMER1_8703B BIT30 /* Timeout interrupt 1 */ ++#define IMR_PSTIMEOUT_8703B BIT29 /* Power Save Time Out Interrupt */ ++#define IMR_GTINT4_8703B BIT28 /* When GTIMER4 expires, this bit is set to 1 */ ++#define IMR_GTINT3_8703B BIT27 /* When GTIMER3 expires, this bit is set to 1 */ ++#define IMR_TXBCN0ERR_8703B BIT26 /* Transmit Beacon0 Error */ ++#define IMR_TXBCN0OK_8703B BIT25 /* Transmit Beacon0 OK */ ++#define IMR_TSF_BIT32_TOGGLE_8703B BIT24 /* TSF Timer BIT32 toggle indication interrupt */ ++#define IMR_BCNDMAINT0_8703B BIT20 /* Beacon DMA Interrupt 0 */ ++#define IMR_BCNDERR0_8703B BIT16 /* Beacon Queue DMA OK0 */ ++#define IMR_HSISR_IND_ON_INT_8703B BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ ++#define IMR_BCNDMAINT_E_8703B BIT14 /* Beacon DMA Interrupt Extension for Win7 */ ++#define IMR_ATIMEND_8703B BIT12 /* CTWidnow End or ATIM Window End */ ++#define IMR_C2HCMD_8703B BIT10 /* CPU to Host Command INT Status, Write 1 clear */ ++#define IMR_CPWM2_8703B BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_CPWM_8703B BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_HIGHDOK_8703B BIT7 /* High Queue DMA OK */ ++#define IMR_MGNTDOK_8703B BIT6 /* Management Queue DMA OK */ ++#define IMR_BKDOK_8703B BIT5 /* AC_BK DMA OK */ ++#define IMR_BEDOK_8703B BIT4 /* AC_BE DMA OK */ ++#define IMR_VIDOK_8703B BIT3 /* AC_VI DMA OK */ ++#define IMR_VODOK_8703B BIT2 /* AC_VO DMA OK */ ++#define IMR_RDU_8703B BIT1 /* Rx Descriptor Unavailable */ ++#define IMR_ROK_8703B BIT0 /* Receive DMA OK */ ++ ++/* IMR DW1(0x00B4-00B7) Bit 0-31 */ ++#define IMR_BCNDMAINT7_8703B BIT27 /* Beacon DMA Interrupt 7 */ ++#define IMR_BCNDMAINT6_8703B BIT26 /* Beacon DMA Interrupt 6 */ ++#define IMR_BCNDMAINT5_8703B BIT25 /* Beacon DMA Interrupt 5 */ ++#define IMR_BCNDMAINT4_8703B BIT24 /* Beacon DMA Interrupt 4 */ ++#define IMR_BCNDMAINT3_8703B BIT23 /* Beacon DMA Interrupt 3 */ ++#define IMR_BCNDMAINT2_8703B BIT22 /* Beacon DMA Interrupt 2 */ ++#define IMR_BCNDMAINT1_8703B BIT21 /* Beacon DMA Interrupt 1 */ ++#define IMR_BCNDOK7_8703B BIT20 /* Beacon Queue DMA OK Interrup 7 */ ++#define IMR_BCNDOK6_8703B BIT19 /* Beacon Queue DMA OK Interrup 6 */ ++#define IMR_BCNDOK5_8703B BIT18 /* Beacon Queue DMA OK Interrup 5 */ ++#define IMR_BCNDOK4_8703B BIT17 /* Beacon Queue DMA OK Interrup 4 */ ++#define IMR_BCNDOK3_8703B BIT16 /* Beacon Queue DMA OK Interrup 3 */ ++#define IMR_BCNDOK2_8703B BIT15 /* Beacon Queue DMA OK Interrup 2 */ ++#define IMR_BCNDOK1_8703B BIT14 /* Beacon Queue DMA OK Interrup 1 */ ++#define IMR_ATIMEND_E_8703B BIT13 /* ATIM Window End Extension for Win7 */ ++#define IMR_TXERR_8703B BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ ++#define IMR_RXERR_8703B BIT10 /* Rx Error Flag INT Status, Write 1 clear */ ++#define IMR_TXFOVW_8703B BIT9 /* Transmit FIFO Overflow */ ++#define IMR_RXFOVW_8703B BIT8 /* Receive FIFO Overflow */ ++ ++#ifdef CONFIG_PCI_HCI ++ /* #define IMR_RX_MASK (IMR_ROK_8703B|IMR_RDU_8703B|IMR_RXFOVW_8703B) */ ++ #define IMR_TX_MASK (IMR_VODOK_8703B | IMR_VIDOK_8703B | IMR_BEDOK_8703B | IMR_BKDOK_8703B | IMR_MGNTDOK_8703B | IMR_HIGHDOK_8703B) ++ ++ #define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8703B | IMR_TXBCN0OK_8703B | IMR_TXBCN0ERR_8703B | IMR_BCNDERR0_8703B) ++ ++ #define RT_AC_INT_MASKS (IMR_VIDOK_8703B | IMR_VODOK_8703B | IMR_BEDOK_8703B | IMR_BKDOK_8703B) ++#endif ++ ++/* ******************************************************** ++ * General definitions ++ * ******************************************************** */ ++ ++#define MACID_NUM_8703B 16 ++#define SEC_CAM_ENT_NUM_8703B 16 ++#define HW_PORT_NUM_8703B 2 ++#define NSS_NUM_8703B 1 ++#define BAND_CAP_8703B (BAND_CAP_2G) ++#define BW_CAP_8703B (BW_CAP_20M | BW_CAP_40M) ++#define PROTO_CAP_8703B (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) ++ ++#endif /* __RTL8703B_SPEC_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_sreset.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_sreset.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_sreset.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,29 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL8703B_SRESET_H_ ++#define _RTL8703B_SRESET_H_ ++ ++#include ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ extern void rtl8703b_sreset_xmit_status_check(_adapter *padapter); ++ extern void rtl8703b_sreset_linked_status_check(_adapter *padapter); ++#endif ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_xmit.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_xmit.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_xmit.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,338 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8703B_XMIT_H__ ++#define __RTL8703B_XMIT_H__ ++ ++ ++#define MAX_TID (15) ++ ++ ++#ifndef __INC_HAL8703BDESC_H ++ #define __INC_HAL8703BDESC_H ++ ++ #define RX_STATUS_DESC_SIZE_8703B 24 ++ #define RX_DRV_INFO_SIZE_UNIT_8703B 8 ++ ++ ++ /* DWORD 0 */ ++ #define SET_RX_STATUS_DESC_PKT_LEN_8703B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) ++ #define SET_RX_STATUS_DESC_EOR_8703B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) ++ #define SET_RX_STATUS_DESC_OWN_8703B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) ++ ++ #define GET_RX_STATUS_DESC_PKT_LEN_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) ++ #define GET_RX_STATUS_DESC_CRC32_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) ++ #define GET_RX_STATUS_DESC_ICV_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) ++ #define GET_RX_STATUS_DESC_DRVINFO_SIZE_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) ++ #define GET_RX_STATUS_DESC_SECURITY_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) ++ #define GET_RX_STATUS_DESC_QOS_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) ++ #define GET_RX_STATUS_DESC_SHIFT_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) ++ #define GET_RX_STATUS_DESC_PHY_STATUS_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) ++ #define GET_RX_STATUS_DESC_SWDEC_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) ++ #define GET_RX_STATUS_DESC_LAST_SEG_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 28, 1) ++ #define GET_RX_STATUS_DESC_FIRST_SEG_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 29, 1) ++ #define GET_RX_STATUS_DESC_EOR_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) ++ #define GET_RX_STATUS_DESC_OWN_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) ++ ++ /* DWORD 1 */ ++ #define GET_RX_STATUS_DESC_MACID_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) ++ #define GET_RX_STATUS_DESC_TID_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) ++ #define GET_RX_STATUS_DESC_AMSDU_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) ++ #define GET_RX_STATUS_DESC_RXID_MATCH_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) ++ #define GET_RX_STATUS_DESC_PAGGR_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) ++ #define GET_RX_STATUS_DESC_A1_FIT_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) ++ #define GET_RX_STATUS_DESC_CHKERR_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) ++ #define GET_RX_STATUS_DESC_IPVER_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) ++ #define GET_RX_STATUS_DESC_IS_TCPUDP__8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) ++ #define GET_RX_STATUS_DESC_CHK_VLD_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) ++ #define GET_RX_STATUS_DESC_PAM_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) ++ #define GET_RX_STATUS_DESC_PWR_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) ++ #define GET_RX_STATUS_DESC_MORE_DATA_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) ++ #define GET_RX_STATUS_DESC_MORE_FRAG_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) ++ #define GET_RX_STATUS_DESC_TYPE_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) ++ #define GET_RX_STATUS_DESC_MC_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) ++ #define GET_RX_STATUS_DESC_BC_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) ++ ++ /* DWORD 2 */ ++ #define GET_RX_STATUS_DESC_SEQ_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) ++ #define GET_RX_STATUS_DESC_FRAG_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) ++ #define GET_RX_STATUS_DESC_RX_IS_QOS_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) ++ #define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) ++ #define GET_RX_STATUS_DESC_RPT_SEL_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) ++ ++ /* DWORD 3 */ ++ #define GET_RX_STATUS_DESC_RX_RATE_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) ++ #define GET_RX_STATUS_DESC_HTC_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) ++ #define GET_RX_STATUS_DESC_EOSP_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) ++ #define GET_RX_STATUS_DESC_BSSID_FIT_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) ++ #ifdef CONFIG_USB_RX_AGGREGATION ++ #define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) ++ #endif ++ #define GET_RX_STATUS_DESC_PATTERN_MATCH_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) ++ #define GET_RX_STATUS_DESC_UNICAST_MATCH_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) ++ #define GET_RX_STATUS_DESC_MAGIC_MATCH_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) ++ ++ /* DWORD 6 */ ++ #define GET_RX_STATUS_DESC_SPLCP_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 1) ++ #define GET_RX_STATUS_DESC_LDPC_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 1, 1) ++ #define GET_RX_STATUS_DESC_STBC_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 2, 1) ++ #define GET_RX_STATUS_DESC_BW_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 4, 2) ++ ++ /* DWORD 5 */ ++ #define GET_RX_STATUS_DESC_TSFL_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) ++ ++ #define GET_RX_STATUS_DESC_BUFF_ADDR_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) ++ #define GET_RX_STATUS_DESC_BUFF_ADDR64_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) ++ ++ #define SET_RX_STATUS_DESC_BUFF_ADDR_8703B(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) ++ ++ ++ /* Dword 0 */ ++ #define GET_TX_DESC_OWN_8703B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) ++ ++ #define SET_TX_DESC_PKT_SIZE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) ++ #define SET_TX_DESC_OFFSET_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) ++ #define SET_TX_DESC_BMC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) ++ #define SET_TX_DESC_HTC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) ++ #define SET_TX_DESC_LAST_SEG_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) ++ #define SET_TX_DESC_FIRST_SEG_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) ++ #define SET_TX_DESC_LINIP_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) ++ #define SET_TX_DESC_NO_ACM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) ++ #define SET_TX_DESC_GF_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) ++ #define SET_TX_DESC_OWN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) ++ ++ /* Dword 1 */ ++ #define SET_TX_DESC_MACID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) ++ #define SET_TX_DESC_QUEUE_SEL_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) ++ #define SET_TX_DESC_RDG_NAV_EXT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) ++ #define SET_TX_DESC_LSIG_TXOP_EN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) ++ #define SET_TX_DESC_PIFS_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) ++ #define SET_TX_DESC_RATE_ID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) ++ #define SET_TX_DESC_EN_DESC_ID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) ++ #define SET_TX_DESC_SEC_TYPE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) ++ #define SET_TX_DESC_PKT_OFFSET_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) ++ ++ ++ /* Dword 2 */ ++ #define SET_TX_DESC_PAID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) ++ #define SET_TX_DESC_CCA_RTS_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) ++ #define SET_TX_DESC_AGG_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) ++ #define SET_TX_DESC_RDG_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) ++ #define SET_TX_DESC_AGG_BREAK_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) ++ #define SET_TX_DESC_MORE_FRAG_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) ++ #define SET_TX_DESC_RAW_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) ++ #define SET_TX_DESC_SPE_RPT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) ++ #define SET_TX_DESC_AMPDU_DENSITY_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) ++ #define SET_TX_DESC_BT_INT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) ++ #define SET_TX_DESC_GID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) ++ ++ ++ /* Dword 3 */ ++ #define SET_TX_DESC_WHEADER_LEN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) ++ #define SET_TX_DESC_CHK_EN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) ++ #define SET_TX_DESC_EARLY_MODE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) ++ #define SET_TX_DESC_HWSEQ_SEL_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) ++ #define SET_TX_DESC_USE_RATE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) ++ #define SET_TX_DESC_DISABLE_RTS_FB_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) ++ #define SET_TX_DESC_DISABLE_FB_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) ++ #define SET_TX_DESC_CTS2SELF_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) ++ #define SET_TX_DESC_RTS_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) ++ #define SET_TX_DESC_HW_RTS_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) ++ #define SET_TX_DESC_NAV_USE_HDR_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) ++ #define SET_TX_DESC_USE_MAX_LEN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) ++ #define SET_TX_DESC_MAX_AGG_NUM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) ++ #define SET_TX_DESC_NDPA_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) ++ #define SET_TX_DESC_AMPDU_MAX_TIME_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) ++ ++ /* Dword 4 */ ++ #define SET_TX_DESC_TX_RATE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) ++ #define SET_TX_DESC_DATA_RATE_FB_LIMIT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) ++ #define SET_TX_DESC_RTS_RATE_FB_LIMIT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) ++ #define SET_TX_DESC_RETRY_LIMIT_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) ++ #define SET_TX_DESC_DATA_RETRY_LIMIT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) ++ #define SET_TX_DESC_RTS_RATE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) ++ ++ ++ /* Dword 5 */ ++ #define SET_TX_DESC_DATA_SC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) ++ #define SET_TX_DESC_DATA_SHORT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) ++ #define SET_TX_DESC_DATA_BW_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) ++ #define SET_TX_DESC_DATA_LDPC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) ++ #define SET_TX_DESC_DATA_STBC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) ++ #define SET_TX_DESC_CTROL_STBC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) ++ #define SET_TX_DESC_RTS_SHORT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) ++ #define SET_TX_DESC_RTS_SC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) ++ ++ ++ /* Dword 6 */ ++ #define SET_TX_DESC_SW_DEFINE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) ++ #define SET_TX_DESC_MBSSID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) ++ #define SET_TX_DESC_ANTSEL_A_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) ++ #define SET_TX_DESC_ANTSEL_B_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) ++ #define SET_TX_DESC_ANTSEL_C_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) ++ #define SET_TX_DESC_ANTSEL_D_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) ++ ++ /* Dword 7 */ ++ #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++ #define SET_TX_DESC_TX_BUFFER_SIZE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++ #else ++ #define SET_TX_DESC_TX_DESC_CHECKSUM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++ #endif ++ #define SET_TX_DESC_USB_TXAGG_NUM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) ++ #if (DEV_BUS_TYPE == RT_SDIO_INTERFACE) ++ #define SET_TX_DESC_SDIO_TXSEQ_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) ++ #endif ++ ++ /* Dword 8 */ ++ #define SET_TX_DESC_HWSEQ_EN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) ++ ++ /* Dword 9 */ ++ #define SET_TX_DESC_SEQ_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) ++ ++ /* Dword 10 */ ++ #define SET_TX_DESC_TX_BUFFER_ADDRESS_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) ++ #define GET_TX_DESC_TX_BUFFER_ADDRESS_8703B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+40, 0, 32) ++ ++ /* Dword 11 */ ++ #define SET_TX_DESC_NEXT_DESC_ADDRESS_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) ++ ++ ++ #define SET_EARLYMODE_PKTNUM_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) ++ #define SET_EARLYMODE_LEN0_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) ++ #define SET_EARLYMODE_LEN1_1_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) ++ #define SET_EARLYMODE_LEN1_2_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) ++ #define SET_EARLYMODE_LEN2_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) ++ #define SET_EARLYMODE_LEN3_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) ++ ++#endif ++/* ----------------------------------------------------------- ++ * ++ * Rate ++ * ++ * ----------------------------------------------------------- ++ * CCK Rates, TxHT = 0 */ ++#define DESC8703B_RATE1M 0x00 ++#define DESC8703B_RATE2M 0x01 ++#define DESC8703B_RATE5_5M 0x02 ++#define DESC8703B_RATE11M 0x03 ++ ++/* OFDM Rates, TxHT = 0 */ ++#define DESC8703B_RATE6M 0x04 ++#define DESC8703B_RATE9M 0x05 ++#define DESC8703B_RATE12M 0x06 ++#define DESC8703B_RATE18M 0x07 ++#define DESC8703B_RATE24M 0x08 ++#define DESC8703B_RATE36M 0x09 ++#define DESC8703B_RATE48M 0x0a ++#define DESC8703B_RATE54M 0x0b ++ ++/* MCS Rates, TxHT = 1 */ ++#define DESC8703B_RATEMCS0 0x0c ++#define DESC8703B_RATEMCS1 0x0d ++#define DESC8703B_RATEMCS2 0x0e ++#define DESC8703B_RATEMCS3 0x0f ++#define DESC8703B_RATEMCS4 0x10 ++#define DESC8703B_RATEMCS5 0x11 ++#define DESC8703B_RATEMCS6 0x12 ++#define DESC8703B_RATEMCS7 0x13 ++#define DESC8703B_RATEMCS8 0x14 ++#define DESC8703B_RATEMCS9 0x15 ++#define DESC8703B_RATEMCS10 0x16 ++#define DESC8703B_RATEMCS11 0x17 ++#define DESC8703B_RATEMCS12 0x18 ++#define DESC8703B_RATEMCS13 0x19 ++#define DESC8703B_RATEMCS14 0x1a ++#define DESC8703B_RATEMCS15 0x1b ++#define DESC8703B_RATEVHTSS1MCS0 0x2c ++#define DESC8703B_RATEVHTSS1MCS1 0x2d ++#define DESC8703B_RATEVHTSS1MCS2 0x2e ++#define DESC8703B_RATEVHTSS1MCS3 0x2f ++#define DESC8703B_RATEVHTSS1MCS4 0x30 ++#define DESC8703B_RATEVHTSS1MCS5 0x31 ++#define DESC8703B_RATEVHTSS1MCS6 0x32 ++#define DESC8703B_RATEVHTSS1MCS7 0x33 ++#define DESC8703B_RATEVHTSS1MCS8 0x34 ++#define DESC8703B_RATEVHTSS1MCS9 0x35 ++#define DESC8703B_RATEVHTSS2MCS0 0x36 ++#define DESC8703B_RATEVHTSS2MCS1 0x37 ++#define DESC8703B_RATEVHTSS2MCS2 0x38 ++#define DESC8703B_RATEVHTSS2MCS3 0x39 ++#define DESC8703B_RATEVHTSS2MCS4 0x3a ++#define DESC8703B_RATEVHTSS2MCS5 0x3b ++#define DESC8703B_RATEVHTSS2MCS6 0x3c ++#define DESC8703B_RATEVHTSS2MCS7 0x3d ++#define DESC8703B_RATEVHTSS2MCS8 0x3e ++#define DESC8703B_RATEVHTSS2MCS9 0x3f ++ ++ ++#define RX_HAL_IS_CCK_RATE_8703B(pDesc)\ ++ (GET_RX_STATUS_DESC_RX_RATE_8703B(pDesc) == DESC8703B_RATE1M || \ ++ GET_RX_STATUS_DESC_RX_RATE_8703B(pDesc) == DESC8703B_RATE2M || \ ++ GET_RX_STATUS_DESC_RX_RATE_8703B(pDesc) == DESC8703B_RATE5_5M || \ ++ GET_RX_STATUS_DESC_RX_RATE_8703B(pDesc) == DESC8703B_RATE11M) ++ ++ ++void rtl8703b_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); ++void rtl8703b_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); ++#if defined(CONFIG_CONCURRENT_MODE) ++ void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); ++#endif ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ s32 rtl8703bs_init_xmit_priv(PADAPTER padapter); ++ void rtl8703bs_free_xmit_priv(PADAPTER padapter); ++ s32 rtl8703bs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8703bs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8703bs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8703bs_xmit_buf_handler(PADAPTER padapter); ++ thread_return rtl8703bs_xmit_thread(thread_context context); ++ #define hal_xmit_handler rtl8703bs_xmit_buf_handler ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ s32 rtl8703bu_xmit_buf_handler(PADAPTER padapter); ++ #define hal_xmit_handler rtl8703bu_xmit_buf_handler ++ ++ ++ s32 rtl8703bu_init_xmit_priv(PADAPTER padapter); ++ void rtl8703bu_free_xmit_priv(PADAPTER padapter); ++ s32 rtl8703bu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8703bu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8703bu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ /* s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); */ ++ void rtl8703bu_xmit_tasklet(void *priv); ++ s32 rtl8703bu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++ void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, struct tx_desc *ptxdesc); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ s32 rtl8703be_init_xmit_priv(PADAPTER padapter); ++ void rtl8703be_free_xmit_priv(PADAPTER padapter); ++ struct xmit_buf *rtl8703be_dequeue_xmitbuf(struct rtw_tx_ring *ring); ++ void rtl8703be_xmitframe_resume(_adapter *padapter); ++ s32 rtl8703be_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8703be_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8703be_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ void rtl8703be_xmit_tasklet(void *priv); ++#endif ++ ++u8 BWMapping_8703B(PADAPTER Adapter, struct pkt_attrib *pattrib); ++u8 SCMapping_8703B(PADAPTER Adapter, struct pkt_attrib *pattrib); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_cmd.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_cmd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_cmd.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,218 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723B_CMD_H__ ++#define __RTL8723B_CMD_H__ ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ ++ * --------------------------------------------------------------------------------------------------------- */ ++ ++enum h2c_cmd_8723B { ++ /* Common Class: 000 */ ++ H2C_8723B_RSVD_PAGE = 0x00, ++ H2C_8723B_MEDIA_STATUS_RPT = 0x01, ++ H2C_8723B_SCAN_ENABLE = 0x02, ++ H2C_8723B_KEEP_ALIVE = 0x03, ++ H2C_8723B_DISCON_DECISION = 0x04, ++ H2C_8723B_PSD_OFFLOAD = 0x05, ++ H2C_8723B_AP_OFFLOAD = 0x08, ++ H2C_8723B_BCN_RSVDPAGE = 0x09, ++ H2C_8723B_PROBERSP_RSVDPAGE = 0x0A, ++ H2C_8723B_FCS_RSVDPAGE = 0x10, ++ H2C_8723B_FCS_INFO = 0x11, ++ H2C_8723B_AP_WOW_GPIO_CTRL = 0x13, ++ ++ /* PoweSave Class: 001 */ ++ H2C_8723B_SET_PWR_MODE = 0x20, ++ H2C_8723B_PS_TUNING_PARA = 0x21, ++ H2C_8723B_PS_TUNING_PARA2 = 0x22, ++ H2C_8723B_P2P_LPS_PARAM = 0x23, ++ H2C_8723B_P2P_PS_OFFLOAD = 0x24, ++ H2C_8723B_PS_SCAN_ENABLE = 0x25, ++ H2C_8723B_SAP_PS_ = 0x26, ++ H2C_8723B_INACTIVE_PS_ = 0x27, /* Inactive_PS */ ++ H2C_8723B_FWLPS_IN_IPS_ = 0x28, ++ ++ /* Dynamic Mechanism Class: 010 */ ++ H2C_8723B_MACID_CFG = 0x40, ++ H2C_8723B_TXBF = 0x41, ++ H2C_8723B_RSSI_SETTING = 0x42, ++ H2C_8723B_AP_REQ_TXRPT = 0x43, ++ H2C_8723B_INIT_RATE_COLLECT = 0x44, ++ H2C_8723B_RA_PARA_ADJUST = 0x46, ++ ++ /* BT Class: 011 */ ++ H2C_8723B_B_TYPE_TDMA = 0x60, ++ H2C_8723B_BT_INFO = 0x61, ++ H2C_8723B_FORCE_BT_TXPWR = 0x62, ++ H2C_8723B_BT_IGNORE_WLANACT = 0x63, ++ H2C_8723B_DAC_SWING_VALUE = 0x64, ++ H2C_8723B_ANT_SEL_RSV = 0x65, ++ H2C_8723B_WL_OPMODE = 0x66, ++ H2C_8723B_BT_MP_OPER = 0x67, ++ H2C_8723B_BT_CONTROL = 0x68, ++ H2C_8723B_BT_WIFI_CTRL = 0x69, ++ H2C_8723B_BT_FW_PATCH = 0x6A, ++ H2C_8723B_BT_WLAN_CALIBRATION = 0x6D, ++ ++ /* WOWLAN Class: 100 */ ++ H2C_8723B_WOWLAN = 0x80, ++ H2C_8723B_REMOTE_WAKE_CTRL = 0x81, ++ H2C_8723B_AOAC_GLOBAL_INFO = 0x82, ++ H2C_8723B_AOAC_RSVD_PAGE = 0x83, ++ H2C_8723B_AOAC_RSVD_PAGE2 = 0x84, ++ H2C_8723B_D0_SCAN_OFFLOAD_CTRL = 0x85, ++ H2C_8723B_D0_SCAN_OFFLOAD_INFO = 0x86, ++ H2C_8723B_CHNL_SWITCH_OFFLOAD = 0x87, ++ H2C_8723B_P2P_OFFLOAD_RSVD_PAGE = 0x8A, ++ H2C_8723B_P2P_OFFLOAD = 0x8B, ++ ++ H2C_8723B_RESET_TSF = 0xC0, ++ H2C_8723B_MAXID, ++}; ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- ++ * _RSVDPAGE_LOC_CMD_0x00 */ ++#define SET_8723B_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8723B_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_8723B_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8723B_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8723B_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++ ++/* _KEEP_ALIVE_CMD_0x03 */ ++#define SET_8723B_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8723B_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8723B_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_8723B_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++ ++/* _DISCONNECT_DECISION_CMD_0x04 */ ++#define SET_8723B_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8723B_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8723B_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_8723B_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) ++ ++/* _PWR_MOD_CMD_0x20 */ ++#define SET_8723B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8723B_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) ++#define SET_8723B_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) ++#define SET_8723B_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8723B_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8723B_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) ++#define SET_8723B_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#define SET_8723B_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++ ++#define GET_8723B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) ++ ++/* _PS_TUNE_PARAM_CMD_0x21 */ ++#define SET_8723B_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8723B_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_8723B_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) ++#define SET_8723B_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) ++#define SET_8723B_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++ ++/* _MACID_CFG_CMD_0x40 */ ++#define SET_8723B_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8723B_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) ++#define SET_8723B_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) ++#define SET_8723B_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) ++#define SET_8723B_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) ++#define SET_8723B_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) ++#define SET_8723B_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) ++#define SET_8723B_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) ++#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) ++#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) ++#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) ++ ++/* _RSSI_SETTING_CMD_0x42 */ ++#define SET_8723B_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8723B_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) ++#define SET_8723B_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++ ++/* _AP_REQ_TXRPT_CMD_0x43 */ ++#define SET_8723B_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8723B_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++ ++/* _FORCE_BT_TXPWR_CMD_0x62 */ ++#define SET_8723B_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++ ++/* _FORCE_BT_MP_OPER_CMD_0x67 */ ++#define SET_8723B_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) ++#define SET_8723B_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) ++#define SET_8723B_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_8723B_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) ++#define SET_8723B_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++#define SET_8723B_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) ++ ++/* _BT_FW_PATCH_0x6A */ ++#define SET_8723B_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) ++#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ------------------------------------------- Structure -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- */ ++ ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- Function Statement -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- */ ++ ++/* host message to firmware cmd */ ++void rtl8723b_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); ++void rtl8723b_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); ++void rtl8723b_set_rssi_cmd(PADAPTER padapter, u8 *param); ++void rtl8723b_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); ++/* s32 rtl8723b_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ ++void rtl8723b_set_FwPsTuneParam_cmd(PADAPTER padapter); ++void rtl8723b_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); ++void rtl8723b_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); ++void rtl8723b_download_rsvd_page(PADAPTER padapter, u8 mstatus); ++#ifdef CONFIG_BT_COEXIST ++ void rtl8723b_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); ++#endif /* CONFIG_BT_COEXIST */ ++#ifdef CONFIG_P2P ++ void rtl8723b_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); ++#endif /* CONFIG_P2P */ ++ ++void CheckFwRsvdPageContent(PADAPTER padapter); ++ ++#ifdef CONFIG_TDLS ++ #ifdef CONFIG_TDLS_CH_SW ++ void rtl8723b_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); ++ #endif ++#endif ++ ++#ifdef CONFIG_P2P_WOWLAN ++ void rtl8723b_set_p2p_wowlan_offload_cmd(PADAPTER padapter); ++#endif ++ ++void rtl8723b_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); ++ ++#ifdef CONFIG_TSF_RESET_OFFLOAD ++ u8 rtl8723b_reset_tsf(_adapter *padapter, u8 reset_port); ++#endif /* CONFIG_TSF_RESET_OFFLOAD */ ++s32 FillH2CCmd8723B(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); ++u8 GetTxBufferRsvdPageNum8723B(_adapter *padapter, bool wowlan); ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_dm.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_dm.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_dm.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,47 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723B_DM_H__ ++#define __RTL8723B_DM_H__ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for 8723B dynamic mechanism only ++ * ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * structure and define ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * function prototype ++ * ************************************************************ */ ++ ++void rtl8723b_init_dm_priv(PADAPTER padapter); ++void rtl8723b_deinit_dm_priv(PADAPTER padapter); ++ ++void rtl8723b_InitHalDm(PADAPTER padapter); ++void rtl8723b_HalDmWatchDog(PADAPTER padapter); ++void rtl8723b_HalDmWatchDog_in_LPS(PADAPTER padapter); ++void rtl8723b_hal_dm_in_lps(PADAPTER padapter); ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_hal.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,283 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723B_HAL_H__ ++#define __RTL8723B_HAL_H__ ++ ++#include "hal_data.h" ++ ++#include "rtl8723b_spec.h" ++#include "rtl8723b_rf.h" ++#include "rtl8723b_dm.h" ++#include "rtl8723b_recv.h" ++#include "rtl8723b_xmit.h" ++#include "rtl8723b_cmd.h" ++#include "rtl8723b_led.h" ++#include "Hal8723BPwrSeq.h" ++#include "Hal8723BPhyReg.h" ++#include "Hal8723BPhyCfg.h" ++#ifdef DBG_CONFIG_ERROR_DETECT ++ #include "rtl8723b_sreset.h" ++#endif ++ ++#define FW_8723B_SIZE 0x8000 ++#define FW_8723B_START_ADDRESS 0x1000 ++#define FW_8723B_END_ADDRESS 0x1FFF /* 0x5FFF */ ++ ++#define IS_FW_HEADER_EXIST_8723B(_pFwHdr) ((le16_to_cpu(_pFwHdr->Signature) & 0xFFF0) == 0x5300) ++ ++typedef struct _RT_FIRMWARE { ++ FIRMWARE_SOURCE eFWSource; ++#ifdef CONFIG_EMBEDDED_FWIMG ++ u8 *szFwBuffer; ++#else ++ u8 szFwBuffer[FW_8723B_SIZE]; ++#endif ++ u32 ulFwLength; ++} RT_FIRMWARE_8723B, *PRT_FIRMWARE_8723B; ++ ++/* ++ * This structure must be cared byte-ordering ++ * ++ * Added by tynli. 2009.12.04. */ ++typedef struct _RT_8723B_FIRMWARE_HDR { ++ /* 8-byte alinment required */ ++ ++ /* --- LONG WORD 0 ---- */ ++ u16 Signature; /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ ++ u8 Category; /* AP/NIC and USB/PCI */ ++ u8 Function; /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ ++ u16 Version; /* FW Version */ ++ u16 Subversion; /* FW Subversion, default 0x00 */ ++ ++ /* --- LONG WORD 1 ---- */ ++ u8 Month; /* Release time Month field */ ++ u8 Date; /* Release time Date field */ ++ u8 Hour; /* Release time Hour field */ ++ u8 Minute; /* Release time Minute field */ ++ u16 RamCodeSize; /* The size of RAM code */ ++ u16 Rsvd2; ++ ++ /* --- LONG WORD 2 ---- */ ++ u32 SvnIdx; /* The SVN entry index */ ++ u32 Rsvd3; ++ ++ /* --- LONG WORD 3 ---- */ ++ u32 Rsvd4; ++ u32 Rsvd5; ++} RT_8723B_FIRMWARE_HDR, *PRT_8723B_FIRMWARE_HDR; ++ ++#define DRIVER_EARLY_INT_TIME_8723B 0x05 ++#define BCN_DMA_ATIME_INT_TIME_8723B 0x02 ++ ++/* for 8723B ++ * TX 32K, RX 16K, Page size 128B for TX, 8B for RX */ ++#define PAGE_SIZE_TX_8723B 128 ++#define PAGE_SIZE_RX_8723B 8 ++ ++#define TX_DMA_SIZE_8723B 0x8000 /* 32K(TX) */ ++#define RX_DMA_SIZE_8723B 0x4000 /* 16K(RX) */ ++ ++#ifdef CONFIG_WOWLAN ++ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ ++#else ++ #define RESV_FMWF 0 ++#endif ++ ++#ifdef CONFIG_FW_C2H_DEBUG ++ #define RX_DMA_RESERVED_SIZE_8723B 0x100 /* 256B, reserved for c2h debug message */ ++#else ++ #define RX_DMA_RESERVED_SIZE_8723B 0x80 /* 128B, reserved for tx report */ ++#endif ++#define RX_DMA_BOUNDARY_8723B (RX_DMA_SIZE_8723B - RX_DMA_RESERVED_SIZE_8723B - 1) ++ ++ ++/* Note: We will divide number of page equally for each queue other than public queue! */ ++ ++/* For General Reserved Page Number(Beacon Queue is reserved page) ++ * Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 */ ++#define BCNQ_PAGE_NUM_8723B 0x08 ++#ifdef CONFIG_CONCURRENT_MODE ++ #define BCNQ1_PAGE_NUM_8723B 0x08 /* 0x04 */ ++#else ++ #define BCNQ1_PAGE_NUM_8723B 0x00 ++#endif ++ ++#ifdef CONFIG_PNO_SUPPORT ++ #undef BCNQ1_PAGE_NUM_8723B ++ #define BCNQ1_PAGE_NUM_8723B 0x00 /* 0x04 */ ++#endif ++ ++/* For WoWLan , more reserved page ++ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ ++#ifdef CONFIG_WOWLAN ++ #define WOWLAN_PAGE_NUM_8723B 0x07 ++#else ++ #define WOWLAN_PAGE_NUM_8723B 0x00 ++#endif ++ ++#ifdef CONFIG_PNO_SUPPORT ++ #undef WOWLAN_PAGE_NUM_8723B ++ #define WOWLAN_PAGE_NUM_8723B 0x15 ++#endif ++ ++#ifdef CONFIG_AP_WOWLAN ++ #define AP_WOWLAN_PAGE_NUM_8723B 0x02 ++#endif ++ ++#define TX_TOTAL_PAGE_NUMBER_8723B (0xFF - BCNQ_PAGE_NUM_8723B - BCNQ1_PAGE_NUM_8723B - WOWLAN_PAGE_NUM_8723B) ++#define TX_PAGE_BOUNDARY_8723B (TX_TOTAL_PAGE_NUMBER_8723B + 1) ++ ++#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723B TX_TOTAL_PAGE_NUMBER_8723B ++#define WMM_NORMAL_TX_PAGE_BOUNDARY_8723B (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723B + 1) ++ ++/* For Normal Chip Setting ++ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8723B */ ++#define NORMAL_PAGE_NUM_HPQ_8723B 0x0C ++#define NORMAL_PAGE_NUM_LPQ_8723B 0x02 ++#define NORMAL_PAGE_NUM_NPQ_8723B 0x02 ++ ++/* Note: For Normal Chip Setting, modify later */ ++#define WMM_NORMAL_PAGE_NUM_HPQ_8723B 0x30 ++#define WMM_NORMAL_PAGE_NUM_LPQ_8723B 0x20 ++#define WMM_NORMAL_PAGE_NUM_NPQ_8723B 0x20 ++ ++ ++#include "HalVerDef.h" ++#include "hal_com.h" ++ ++#define EFUSE_OOB_PROTECT_BYTES 15 ++ ++#define HAL_EFUSE_MEMORY ++ ++#define HWSET_MAX_SIZE_8723B 512 ++#define EFUSE_REAL_CONTENT_LEN_8723B 512 ++#define EFUSE_MAP_LEN_8723B 512 ++#define EFUSE_MAX_SECTION_8723B 64 ++ ++#define EFUSE_IC_ID_OFFSET 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ ++#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8723B) ++ ++#define EFUSE_ACCESS_ON 0x69 /* For RTL8723 only. */ ++#define EFUSE_ACCESS_OFF 0x00 /* For RTL8723 only. */ ++ ++/* ******************************************************** ++ * EFUSE for BT definition ++ * ******************************************************** */ ++#define EFUSE_BT_REAL_BANK_CONTENT_LEN 512 ++#define EFUSE_BT_REAL_CONTENT_LEN 1536 /* 512*3 */ ++#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ ++#define EFUSE_BT_MAX_SECTION 128 /* 1024/8 */ ++ ++#define EFUSE_PROTECT_BYTES_BANK 16 ++ ++typedef enum tag_Package_Definition { ++ PACKAGE_DEFAULT, ++ PACKAGE_QFN68, ++ PACKAGE_TFBGA90, ++ PACKAGE_TFBGA80, ++ PACKAGE_TFBGA79 ++} PACKAGE_TYPE_E; ++ ++#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) ++#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) ++ ++/* rtl8723a_hal_init.c */ ++s32 rtl8723b_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); ++void rtl8723b_FirmwareSelfReset(PADAPTER padapter); ++void rtl8723b_InitializeFirmwareVars(PADAPTER padapter); ++ ++void rtl8723b_InitAntenna_Selection(PADAPTER padapter); ++void rtl8723b_DeinitAntenna_Selection(PADAPTER padapter); ++void rtl8723b_CheckAntenna_Selection(PADAPTER padapter); ++void rtl8723b_init_default_value(PADAPTER padapter); ++ ++s32 rtl8723b_InitLLTTable(PADAPTER padapter); ++ ++s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU); ++s32 CardDisableWithoutHWSM(PADAPTER padapter); ++ ++/* EFuse */ ++u8 GetEEPROMSize8723B(PADAPTER padapter); ++void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); ++void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); ++void Hal_EfuseParseTxPowerInfo_8723B(PADAPTER padapter, u8 *PROMContent, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseBTCoexistInfo_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseEEPROMVer_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseChnlPlan_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseCustomerID_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseAntennaDiversity_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseXtal_8723B(PADAPTER pAdapter, u8 *hwinfo, u8 AutoLoadFail); ++void Hal_EfuseParseThermalMeter_8723B(PADAPTER padapter, u8 *hwinfo, u8 AutoLoadFail); ++VOID Hal_EfuseParsePackageType_8723B(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++VOID Hal_EfuseParseVoltage_8723B(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++VOID Hal_EfuseParseBoardType_8723B(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++ ++void rtl8723b_set_hal_ops(struct hal_ops *pHalFunc); ++void init_hal_spec_8723b(_adapter *adapter); ++void SetHwReg8723B(PADAPTER padapter, u8 variable, u8 *val); ++void GetHwReg8723B(PADAPTER padapter, u8 variable, u8 *val); ++u8 SetHalDefVar8723B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++u8 GetHalDefVar8723B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++ ++/* register */ ++void rtl8723b_InitBeaconParameters(PADAPTER padapter); ++void rtl8723b_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); ++void _InitBurstPktLen_8723BS(PADAPTER Adapter); ++void _8051Reset8723(PADAPTER padapter); ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++ void Hal_DetectWoWMode(PADAPTER pAdapter); ++#endif /* CONFIG_WOWLAN */ ++ ++void rtl8723b_start_thread(_adapter *padapter); ++void rtl8723b_stop_thread(_adapter *padapter); ++ ++#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) ++ void rtl8723bs_init_checkbthang_workqueue(_adapter *adapter); ++ void rtl8723bs_free_checkbthang_workqueue(_adapter *adapter); ++ void rtl8723bs_cancle_checkbthang_workqueue(_adapter *adapter); ++ void rtl8723bs_hal_check_bt_hang(_adapter *adapter); ++#endif ++ ++#ifdef CONFIG_GPIO_WAKEUP ++ void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); ++#endif ++#ifdef CONFIG_MP_INCLUDED ++int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); ++#endif ++void CCX_FwC2HTxRpt_8723b(PADAPTER padapter, u8 *pdata, u8 len); ++ ++u8 MRateToHwRate8723B(u8 rate); ++u8 HwRateToMRate8723B(u8 rate); ++ ++#ifdef CONFIG_RF_POWER_TRIM ++ void Hal_ReadRFGainOffset(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++#endif /*CONFIG_RF_POWER_TRIM*/ ++ ++#ifdef CONFIG_PCI_HCI ++ BOOLEAN InterruptRecognized8723BE(PADAPTER Adapter); ++ VOID UpdateInterruptMask8723BE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); ++#endif ++ ++#ifdef CONFIG_GPIO_API ++int rtl8723b_GpioFuncCheck(PADAPTER adapter, u8 gpio_num); ++VOID rtl8723b_GpioMultiFuncReset(PADAPTER adapter, u8 gpio_num); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_led.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_led.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_led.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,48 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723B_LED_H__ ++#define __RTL8723B_LED_H__ ++ ++#include ++#include ++#include ++ ++ ++/* ******************************************************************************** ++ * Interface to manipulate LED objects. ++ * ******************************************************************************** */ ++#ifdef CONFIG_USB_HCI ++ void rtl8723bu_InitSwLeds(PADAPTER padapter); ++ void rtl8723bu_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_SDIO_HCI ++ void rtl8723bs_InitSwLeds(PADAPTER padapter); ++ void rtl8723bs_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_GSPI_HCI ++ void rtl8723bs_InitSwLeds(PADAPTER padapter); ++ void rtl8723bs_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_PCI_HCI ++ void rtl8723be_InitSwLeds(PADAPTER padapter); ++ void rtl8723be_DeInitSwLeds(PADAPTER padapter); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_recv.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_recv.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_recv.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,91 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723B_RECV_H__ ++#define __RTL8723B_RECV_H__ ++ ++#define RECV_BLK_SZ 512 ++#define RECV_BLK_CNT 16 ++#define RECV_BLK_TH RECV_BLK_CNT ++ ++#if defined(CONFIG_USB_HCI) ++ ++ #ifndef MAX_RECVBUF_SZ ++ #ifdef PLATFORM_OS_CE ++ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ ++ #else ++ #ifndef CONFIG_MINIMAL_MEMORY_USAGE ++ /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ ++ /* #define MAX_RECVBUF_SZ (16384) */ /* 16K */ ++ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ ++ #ifdef CONFIG_PLATFORM_MSTAR ++ #define MAX_RECVBUF_SZ (8192) /* 8K */ ++ #else ++ #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ ++ #endif ++ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ ++ #else ++ #define MAX_RECVBUF_SZ (4000) /* about 4K */ ++ #endif ++ #endif ++ #endif /* !MAX_RECVBUF_SZ */ ++ ++#elif defined(CONFIG_PCI_HCI) ++ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ ++ /* #define MAX_RECVBUF_SZ (9100) */ ++ /* #else */ ++ #define MAX_RECVBUF_SZ (4000) /* about 4K ++ * #endif */ ++ ++ ++#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ ++ #define MAX_RECVBUF_SZ (RX_DMA_SIZE_8723B - RX_DMA_RESERVED_SIZE_8723B) ++ ++#endif ++ ++/* Rx smooth factor */ ++#define Rx_Smooth_Factor (20) ++ ++#ifdef CONFIG_SDIO_HCI ++ #ifndef CONFIG_SDIO_RX_COPY ++ #undef MAX_RECVBUF_SZ ++ #define MAX_RECVBUF_SZ (RX_DMA_SIZE_8723B - RX_DMA_RESERVED_SIZE_8723B) ++ #endif /* !CONFIG_SDIO_RX_COPY */ ++#endif /* CONFIG_SDIO_HCI */ ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ s32 rtl8723bs_init_recv_priv(PADAPTER padapter); ++ void rtl8723bs_free_recv_priv(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ int rtl8723bu_init_recv_priv(_adapter *padapter); ++ void rtl8723bu_free_recv_priv(_adapter *padapter); ++ void rtl8723bu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ s32 rtl8723be_init_recv_priv(PADAPTER padapter); ++ void rtl8723be_free_recv_priv(PADAPTER padapter); ++#endif ++ ++void rtl8723b_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); ++ ++#endif /* __RTL8723B_RECV_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_rf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_rf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_rf.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,30 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723B_RF_H__ ++#define __RTL8723B_RF_H__ ++ ++int PHY_RF6052_Config8723B(IN PADAPTER Adapter); ++ ++VOID ++PHY_RF6052SetBandwidth8723B( ++ IN PADAPTER Adapter, ++ IN CHANNEL_WIDTH Bandwidth); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_spec.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_spec.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_spec.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,296 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ *******************************************************************************/ ++#ifndef __RTL8723B_SPEC_H__ ++#define __RTL8723B_SPEC_H__ ++ ++#include ++ ++ ++#define HAL_NAV_UPPER_UNIT_8723B 128 /* micro-second */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0000h ~ 0x00FFh System Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_RSV_CTRL_8723B 0x001C /* 3 Byte */ ++#define REG_BT_WIFI_ANTENNA_SWITCH_8723B 0x0038 ++#define REG_HSISR_8723B 0x005c ++#define REG_PAD_CTRL1_8723B 0x0064 ++#define REG_AFE_CTRL_4_8723B 0x0078 ++#define REG_HMEBOX_DBG_0_8723B 0x0088 ++#define REG_HMEBOX_DBG_1_8723B 0x008A ++#define REG_HMEBOX_DBG_2_8723B 0x008C ++#define REG_HMEBOX_DBG_3_8723B 0x008E ++#define REG_HIMR0_8723B 0x00B0 ++#define REG_HISR0_8723B 0x00B4 ++#define REG_HIMR1_8723B 0x00B8 ++#define REG_HISR1_8723B 0x00BC ++#define REG_PMC_DBG_CTRL2_8723B 0x00CC ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0100h ~ 0x01FFh MACTOP General Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_C2HEVT_CMD_ID_8723B 0x01A0 ++#define REG_C2HEVT_CMD_LEN_8723B 0x01AE ++#define REG_WOWLAN_WAKE_REASON 0x01C7 ++#define REG_WOWLAN_GTK_DBG1 0x630 ++#define REG_WOWLAN_GTK_DBG2 0x634 ++ ++#define REG_HMEBOX_EXT0_8723B 0x01F0 ++#define REG_HMEBOX_EXT1_8723B 0x01F4 ++#define REG_HMEBOX_EXT2_8723B 0x01F8 ++#define REG_HMEBOX_EXT3_8723B 0x01FC ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0200h ~ 0x027Fh TXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0280h ~ 0x02FFh RXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_RXDMA_CONTROL_8723B 0x0286 /* Control the RX DMA. */ ++#define REG_RXDMA_MODE_CTRL_8723B 0x0290 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0300h ~ 0x03FFh PCIe ++ * ++ * ----------------------------------------------------- */ ++#define REG_PCIE_CTRL_REG_8723B 0x0300 ++#define REG_INT_MIG_8723B 0x0304 /* Interrupt Migration */ ++#define REG_BCNQ_DESA_8723B 0x0308 /* TX Beacon Descriptor Address */ ++#define REG_HQ_DESA_8723B 0x0310 /* TX High Queue Descriptor Address */ ++#define REG_MGQ_DESA_8723B 0x0318 /* TX Manage Queue Descriptor Address */ ++#define REG_VOQ_DESA_8723B 0x0320 /* TX VO Queue Descriptor Address */ ++#define REG_VIQ_DESA_8723B 0x0328 /* TX VI Queue Descriptor Address */ ++#define REG_BEQ_DESA_8723B 0x0330 /* TX BE Queue Descriptor Address */ ++#define REG_BKQ_DESA_8723B 0x0338 /* TX BK Queue Descriptor Address */ ++#define REG_RX_DESA_8723B 0x0340 /* RX Queue Descriptor Address */ ++#define REG_DBI_WDATA_8723B 0x0348 /* DBI Write Data */ ++#define REG_DBI_RDATA_8723B 0x034C /* DBI Read Data */ ++#define REG_DBI_ADDR_8723B 0x0350 /* DBI Address */ ++#define REG_DBI_FLAG_8723B 0x0352 /* DBI Read/Write Flag */ ++#define REG_MDIO_WDATA_8723B 0x0354 /* MDIO for Write PCIE PHY */ ++#define REG_MDIO_RDATA_8723B 0x0356 /* MDIO for Reads PCIE PHY */ ++#define REG_MDIO_CTL_8723B 0x0358 /* MDIO for Control */ ++#define REG_DBG_SEL_8723B 0x0360 /* Debug Selection Register */ ++#define REG_PCIE_HRPWM_8723B 0x0361 /* PCIe RPWM */ ++#define REG_PCIE_HCPWM_8723B 0x0363 /* PCIe CPWM */ ++#define REG_PCIE_MULTIFET_CTRL_8723B 0x036A /* PCIE Multi-Fethc Control */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0400h ~ 0x047Fh Protocol Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_TXPKTBUF_BCNQ_BDNY_8723B 0x0424 ++#define REG_TXPKTBUF_MGQ_BDNY_8723B 0x0425 ++#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8723B 0x045D ++#ifdef CONFIG_WOWLAN ++ #define REG_TXPKTBUF_IV_LOW 0x0484 ++ #define REG_TXPKTBUF_IV_HIGH 0x0488 ++#endif ++#define REG_AMPDU_BURST_MODE_8723B 0x04BC ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0500h ~ 0x05FFh EDCA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_SECONDARY_CCA_CTRL_8723B 0x0577 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0600h ~ 0x07FFh WMAC Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++ ++/* ************************************************************ ++ * SDIO Bus Specification ++ * ************************************************************ */ ++ ++/* ----------------------------------------------------- ++ * SDIO CMD Address Mapping ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * I/O bus domain (Host) ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * SDIO register ++ * ----------------------------------------------------- */ ++#define SDIO_REG_HCPWM1_8723B 0x025 /* HCI Current Power Mode 1 */ ++ ++ ++/* **************************************************************************** ++ * 8723 Regsiter Bit and Content definition ++ * **************************************************************************** */ ++ ++/* 2 HSISR ++ * interrupt mask which needs to clear */ ++#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ ++ HSISR_SPS_OCP_INT |\ ++ HSISR_RON_INT |\ ++ HSISR_PDNINT |\ ++ HSISR_GPIO9_INT) ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0100h ~ 0x01FFh MACTOP General Configuration ++ * ++ * ----------------------------------------------------- */ ++#undef IS_E_CUT ++#define IS_E_CUT(version) FALSE ++#undef IS_F_CUT ++#define IS_F_CUT(version) ((GET_CVID_CUT_VERSION(version) == E_CUT_VERSION) ? TRUE : FALSE) ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0200h ~ 0x027Fh TXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0280h ~ 0x02FFh RXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define BIT_USB_RXDMA_AGG_EN BIT(31) ++#define RXDMA_AGG_MODE_EN BIT(1) ++ ++#ifdef CONFIG_WOWLAN ++ #define RXPKT_RELEASE_POLL BIT(16) ++ #define RXDMA_IDLE BIT(17) ++ #define RW_RELEASE_EN BIT(18) ++#endif ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0400h ~ 0x047Fh Protocol Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* ---------------------------------------------------------------------------- ++ * 8723B REG_CCK_CHECK (offset 0x454) ++ * ---------------------------------------------------------------------------- */ ++#define BIT_BCN_PORT_SEL BIT5 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0500h ~ 0x05FFh EDCA Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0600h ~ 0x07FFh WMAC Configuration ++ * ++ * ----------------------------------------------------- */ ++#ifdef CONFIG_RF_POWER_TRIM ++ ++ #ifdef CONFIG_RTL8723B ++ #define EEPROM_RF_GAIN_OFFSET 0xC1 ++ #endif ++ ++ #define EEPROM_RF_GAIN_VAL 0x1F6 ++#endif /*CONFIG_RF_POWER_TRIM*/ ++ ++ ++/* ---------------------------------------------------------------------------- ++ * 8195 IMR/ISR bits (offset 0xB0, 8bits) ++ * ---------------------------------------------------------------------------- */ ++#define IMR_DISABLED_8723B 0 ++/* IMR DW0(0x00B0-00B3) Bit 0-31 */ ++#define IMR_TIMER2_8723B BIT31 /* Timeout interrupt 2 */ ++#define IMR_TIMER1_8723B BIT30 /* Timeout interrupt 1 */ ++#define IMR_PSTIMEOUT_8723B BIT29 /* Power Save Time Out Interrupt */ ++#define IMR_GTINT4_8723B BIT28 /* When GTIMER4 expires, this bit is set to 1 */ ++#define IMR_GTINT3_8723B BIT27 /* When GTIMER3 expires, this bit is set to 1 */ ++#define IMR_TXBCN0ERR_8723B BIT26 /* Transmit Beacon0 Error */ ++#define IMR_TXBCN0OK_8723B BIT25 /* Transmit Beacon0 OK */ ++#define IMR_TSF_BIT32_TOGGLE_8723B BIT24 /* TSF Timer BIT32 toggle indication interrupt */ ++#define IMR_BCNDMAINT0_8723B BIT20 /* Beacon DMA Interrupt 0 */ ++#define IMR_BCNDERR0_8723B BIT16 /* Beacon Queue DMA OK0 */ ++#define IMR_HSISR_IND_ON_INT_8723B BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ ++#define IMR_BCNDMAINT_E_8723B BIT14 /* Beacon DMA Interrupt Extension for Win7 */ ++#define IMR_ATIMEND_8723B BIT12 /* CTWidnow End or ATIM Window End */ ++#define IMR_C2HCMD_8723B BIT10 /* CPU to Host Command INT Status, Write 1 clear */ ++#define IMR_CPWM2_8723B BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_CPWM_8723B BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_HIGHDOK_8723B BIT7 /* High Queue DMA OK */ ++#define IMR_MGNTDOK_8723B BIT6 /* Management Queue DMA OK */ ++#define IMR_BKDOK_8723B BIT5 /* AC_BK DMA OK */ ++#define IMR_BEDOK_8723B BIT4 /* AC_BE DMA OK */ ++#define IMR_VIDOK_8723B BIT3 /* AC_VI DMA OK */ ++#define IMR_VODOK_8723B BIT2 /* AC_VO DMA OK */ ++#define IMR_RDU_8723B BIT1 /* Rx Descriptor Unavailable */ ++#define IMR_ROK_8723B BIT0 /* Receive DMA OK */ ++ ++/* IMR DW1(0x00B4-00B7) Bit 0-31 */ ++#define IMR_BCNDMAINT7_8723B BIT27 /* Beacon DMA Interrupt 7 */ ++#define IMR_BCNDMAINT6_8723B BIT26 /* Beacon DMA Interrupt 6 */ ++#define IMR_BCNDMAINT5_8723B BIT25 /* Beacon DMA Interrupt 5 */ ++#define IMR_BCNDMAINT4_8723B BIT24 /* Beacon DMA Interrupt 4 */ ++#define IMR_BCNDMAINT3_8723B BIT23 /* Beacon DMA Interrupt 3 */ ++#define IMR_BCNDMAINT2_8723B BIT22 /* Beacon DMA Interrupt 2 */ ++#define IMR_BCNDMAINT1_8723B BIT21 /* Beacon DMA Interrupt 1 */ ++#define IMR_BCNDOK7_8723B BIT20 /* Beacon Queue DMA OK Interrup 7 */ ++#define IMR_BCNDOK6_8723B BIT19 /* Beacon Queue DMA OK Interrup 6 */ ++#define IMR_BCNDOK5_8723B BIT18 /* Beacon Queue DMA OK Interrup 5 */ ++#define IMR_BCNDOK4_8723B BIT17 /* Beacon Queue DMA OK Interrup 4 */ ++#define IMR_BCNDOK3_8723B BIT16 /* Beacon Queue DMA OK Interrup 3 */ ++#define IMR_BCNDOK2_8723B BIT15 /* Beacon Queue DMA OK Interrup 2 */ ++#define IMR_BCNDOK1_8723B BIT14 /* Beacon Queue DMA OK Interrup 1 */ ++#define IMR_ATIMEND_E_8723B BIT13 /* ATIM Window End Extension for Win7 */ ++#define IMR_TXERR_8723B BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ ++#define IMR_RXERR_8723B BIT10 /* Rx Error Flag INT Status, Write 1 clear */ ++#define IMR_TXFOVW_8723B BIT9 /* Transmit FIFO Overflow */ ++#define IMR_RXFOVW_8723B BIT8 /* Receive FIFO Overflow */ ++ ++#ifdef CONFIG_PCI_HCI ++ /* #define IMR_RX_MASK (IMR_ROK_8723B|IMR_RDU_8723B|IMR_RXFOVW_8723B) */ ++ #define IMR_TX_MASK (IMR_VODOK_8723B | IMR_VIDOK_8723B | IMR_BEDOK_8723B | IMR_BKDOK_8723B | IMR_MGNTDOK_8723B | IMR_HIGHDOK_8723B) ++ ++ #define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8723B | IMR_TXBCN0OK_8723B | IMR_TXBCN0ERR_8723B | IMR_BCNDERR0_8723B) ++ ++ #define RT_AC_INT_MASKS (IMR_VIDOK_8723B | IMR_VODOK_8723B | IMR_BEDOK_8723B | IMR_BKDOK_8723B) ++#endif ++ ++/* ******************************************************** ++ * General definitions ++ * ******************************************************** */ ++ ++#define MACID_NUM_8723B 128 ++#define SEC_CAM_ENT_NUM_8723B 64 ++#define HW_PORT_NUM_8723B 2 ++#define NSS_NUM_8723B 1 ++#define BAND_CAP_8723B (BAND_CAP_2G) ++#define BW_CAP_8723B (BW_CAP_20M | BW_CAP_40M) ++#define PROTO_CAP_8723B (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) ++ ++#endif /* __RTL8723B_SPEC_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_sreset.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_sreset.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_sreset.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,29 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL8723B_SRESET_H_ ++#define _RTL8723B_SRESET_H_ ++ ++#include ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ extern void rtl8723b_sreset_xmit_status_check(_adapter *padapter); ++ extern void rtl8723b_sreset_linked_status_check(_adapter *padapter); ++#endif ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_xmit.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_xmit.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_xmit.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,338 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723B_XMIT_H__ ++#define __RTL8723B_XMIT_H__ ++ ++ ++#define MAX_TID (15) ++ ++ ++#ifndef __INC_HAL8723BDESC_H ++ #define __INC_HAL8723BDESC_H ++ ++ #define RX_STATUS_DESC_SIZE_8723B 24 ++ #define RX_DRV_INFO_SIZE_UNIT_8723B 8 ++ ++ ++ /* DWORD 0 */ ++ #define SET_RX_STATUS_DESC_PKT_LEN_8723B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) ++ #define SET_RX_STATUS_DESC_EOR_8723B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) ++ #define SET_RX_STATUS_DESC_OWN_8723B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) ++ ++ #define GET_RX_STATUS_DESC_PKT_LEN_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) ++ #define GET_RX_STATUS_DESC_CRC32_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) ++ #define GET_RX_STATUS_DESC_ICV_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) ++ #define GET_RX_STATUS_DESC_DRVINFO_SIZE_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) ++ #define GET_RX_STATUS_DESC_SECURITY_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) ++ #define GET_RX_STATUS_DESC_QOS_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) ++ #define GET_RX_STATUS_DESC_SHIFT_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) ++ #define GET_RX_STATUS_DESC_PHY_STATUS_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) ++ #define GET_RX_STATUS_DESC_SWDEC_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) ++ #define GET_RX_STATUS_DESC_LAST_SEG_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 28, 1) ++ #define GET_RX_STATUS_DESC_FIRST_SEG_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 29, 1) ++ #define GET_RX_STATUS_DESC_EOR_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) ++ #define GET_RX_STATUS_DESC_OWN_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) ++ ++ /* DWORD 1 */ ++ #define GET_RX_STATUS_DESC_MACID_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) ++ #define GET_RX_STATUS_DESC_TID_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) ++ #define GET_RX_STATUS_DESC_AMSDU_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) ++ #define GET_RX_STATUS_DESC_RXID_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) ++ #define GET_RX_STATUS_DESC_PAGGR_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) ++ #define GET_RX_STATUS_DESC_A1_FIT_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) ++ #define GET_RX_STATUS_DESC_CHKERR_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) ++ #define GET_RX_STATUS_DESC_IPVER_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) ++ #define GET_RX_STATUS_DESC_IS_TCPUDP__8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) ++ #define GET_RX_STATUS_DESC_CHK_VLD_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) ++ #define GET_RX_STATUS_DESC_PAM_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) ++ #define GET_RX_STATUS_DESC_PWR_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) ++ #define GET_RX_STATUS_DESC_MORE_DATA_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) ++ #define GET_RX_STATUS_DESC_MORE_FRAG_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) ++ #define GET_RX_STATUS_DESC_TYPE_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) ++ #define GET_RX_STATUS_DESC_MC_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) ++ #define GET_RX_STATUS_DESC_BC_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) ++ ++ /* DWORD 2 */ ++ #define GET_RX_STATUS_DESC_SEQ_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) ++ #define GET_RX_STATUS_DESC_FRAG_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) ++ #define GET_RX_STATUS_DESC_RX_IS_QOS_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) ++ #define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) ++ #define GET_RX_STATUS_DESC_RPT_SEL_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) ++ ++ /* DWORD 3 */ ++ #define GET_RX_STATUS_DESC_RX_RATE_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) ++ #define GET_RX_STATUS_DESC_HTC_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) ++ #define GET_RX_STATUS_DESC_EOSP_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) ++ #define GET_RX_STATUS_DESC_BSSID_FIT_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) ++ #ifdef CONFIG_USB_RX_AGGREGATION ++ #define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) ++ #endif ++ #define GET_RX_STATUS_DESC_PATTERN_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) ++ #define GET_RX_STATUS_DESC_UNICAST_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) ++ #define GET_RX_STATUS_DESC_MAGIC_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) ++ ++ /* DWORD 6 */ ++ #define GET_RX_STATUS_DESC_SPLCP_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 1) ++ #define GET_RX_STATUS_DESC_LDPC_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 1, 1) ++ #define GET_RX_STATUS_DESC_STBC_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 2, 1) ++ #define GET_RX_STATUS_DESC_BW_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 4, 2) ++ ++ /* DWORD 5 */ ++ #define GET_RX_STATUS_DESC_TSFL_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) ++ ++ #define GET_RX_STATUS_DESC_BUFF_ADDR_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) ++ #define GET_RX_STATUS_DESC_BUFF_ADDR64_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) ++ ++ #define SET_RX_STATUS_DESC_BUFF_ADDR_8723B(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) ++ ++ ++ /* Dword 0 */ ++ #define GET_TX_DESC_OWN_8723B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) ++ ++ #define SET_TX_DESC_PKT_SIZE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) ++ #define SET_TX_DESC_OFFSET_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) ++ #define SET_TX_DESC_BMC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) ++ #define SET_TX_DESC_HTC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) ++ #define SET_TX_DESC_LAST_SEG_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) ++ #define SET_TX_DESC_FIRST_SEG_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) ++ #define SET_TX_DESC_LINIP_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) ++ #define SET_TX_DESC_NO_ACM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) ++ #define SET_TX_DESC_GF_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) ++ #define SET_TX_DESC_OWN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) ++ ++ /* Dword 1 */ ++ #define SET_TX_DESC_MACID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) ++ #define SET_TX_DESC_QUEUE_SEL_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) ++ #define SET_TX_DESC_RDG_NAV_EXT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) ++ #define SET_TX_DESC_LSIG_TXOP_EN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) ++ #define SET_TX_DESC_PIFS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) ++ #define SET_TX_DESC_RATE_ID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) ++ #define SET_TX_DESC_EN_DESC_ID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) ++ #define SET_TX_DESC_SEC_TYPE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) ++ #define SET_TX_DESC_PKT_OFFSET_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) ++ ++ ++ /* Dword 2 */ ++ #define SET_TX_DESC_PAID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) ++ #define SET_TX_DESC_CCA_RTS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) ++ #define SET_TX_DESC_AGG_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) ++ #define SET_TX_DESC_RDG_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) ++ #define SET_TX_DESC_AGG_BREAK_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) ++ #define SET_TX_DESC_MORE_FRAG_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) ++ #define SET_TX_DESC_RAW_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) ++ #define SET_TX_DESC_SPE_RPT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) ++ #define SET_TX_DESC_AMPDU_DENSITY_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) ++ #define SET_TX_DESC_BT_INT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) ++ #define SET_TX_DESC_GID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) ++ ++ ++ /* Dword 3 */ ++ #define SET_TX_DESC_WHEADER_LEN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) ++ #define SET_TX_DESC_CHK_EN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) ++ #define SET_TX_DESC_EARLY_MODE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) ++ #define SET_TX_DESC_HWSEQ_SEL_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) ++ #define SET_TX_DESC_USE_RATE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) ++ #define SET_TX_DESC_DISABLE_RTS_FB_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) ++ #define SET_TX_DESC_DISABLE_FB_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) ++ #define SET_TX_DESC_CTS2SELF_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) ++ #define SET_TX_DESC_RTS_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) ++ #define SET_TX_DESC_HW_RTS_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) ++ #define SET_TX_DESC_NAV_USE_HDR_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) ++ #define SET_TX_DESC_USE_MAX_LEN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) ++ #define SET_TX_DESC_MAX_AGG_NUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) ++ #define SET_TX_DESC_NDPA_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) ++ #define SET_TX_DESC_AMPDU_MAX_TIME_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) ++ ++ /* Dword 4 */ ++ #define SET_TX_DESC_TX_RATE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) ++ #define SET_TX_DESC_DATA_RATE_FB_LIMIT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) ++ #define SET_TX_DESC_RTS_RATE_FB_LIMIT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) ++ #define SET_TX_DESC_RETRY_LIMIT_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) ++ #define SET_TX_DESC_DATA_RETRY_LIMIT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) ++ #define SET_TX_DESC_RTS_RATE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) ++ ++ ++ /* Dword 5 */ ++ #define SET_TX_DESC_DATA_SC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) ++ #define SET_TX_DESC_DATA_SHORT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) ++ #define SET_TX_DESC_DATA_BW_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) ++ #define SET_TX_DESC_DATA_LDPC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) ++ #define SET_TX_DESC_DATA_STBC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) ++ #define SET_TX_DESC_CTROL_STBC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) ++ #define SET_TX_DESC_RTS_SHORT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) ++ #define SET_TX_DESC_RTS_SC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) ++ ++ ++ /* Dword 6 */ ++ #define SET_TX_DESC_SW_DEFINE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) ++ #define SET_TX_DESC_MBSSID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) ++ #define SET_TX_DESC_ANTSEL_A_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) ++ #define SET_TX_DESC_ANTSEL_B_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) ++ #define SET_TX_DESC_ANTSEL_C_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) ++ #define SET_TX_DESC_ANTSEL_D_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) ++ ++ /* Dword 7 */ ++ #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++ #define SET_TX_DESC_TX_BUFFER_SIZE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++ #else ++ #define SET_TX_DESC_TX_DESC_CHECKSUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++ #endif ++ #define SET_TX_DESC_USB_TXAGG_NUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) ++ #if (DEV_BUS_TYPE == RT_SDIO_INTERFACE) ++ #define SET_TX_DESC_SDIO_TXSEQ_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) ++ #endif ++ ++ /* Dword 8 */ ++ #define SET_TX_DESC_HWSEQ_EN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) ++ ++ /* Dword 9 */ ++ #define SET_TX_DESC_SEQ_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) ++ ++ /* Dword 10 */ ++ #define SET_TX_DESC_TX_BUFFER_ADDRESS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) ++ #define GET_TX_DESC_TX_BUFFER_ADDRESS_8723B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+40, 0, 32) ++ ++ /* Dword 11 */ ++ #define SET_TX_DESC_NEXT_DESC_ADDRESS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) ++ ++ ++ #define SET_EARLYMODE_PKTNUM_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) ++ #define SET_EARLYMODE_LEN0_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) ++ #define SET_EARLYMODE_LEN1_1_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) ++ #define SET_EARLYMODE_LEN1_2_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) ++ #define SET_EARLYMODE_LEN2_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) ++ #define SET_EARLYMODE_LEN3_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) ++ ++#endif ++/* ----------------------------------------------------------- ++ * ++ * Rate ++ * ++ * ----------------------------------------------------------- ++ * CCK Rates, TxHT = 0 */ ++#define DESC8723B_RATE1M 0x00 ++#define DESC8723B_RATE2M 0x01 ++#define DESC8723B_RATE5_5M 0x02 ++#define DESC8723B_RATE11M 0x03 ++ ++/* OFDM Rates, TxHT = 0 */ ++#define DESC8723B_RATE6M 0x04 ++#define DESC8723B_RATE9M 0x05 ++#define DESC8723B_RATE12M 0x06 ++#define DESC8723B_RATE18M 0x07 ++#define DESC8723B_RATE24M 0x08 ++#define DESC8723B_RATE36M 0x09 ++#define DESC8723B_RATE48M 0x0a ++#define DESC8723B_RATE54M 0x0b ++ ++/* MCS Rates, TxHT = 1 */ ++#define DESC8723B_RATEMCS0 0x0c ++#define DESC8723B_RATEMCS1 0x0d ++#define DESC8723B_RATEMCS2 0x0e ++#define DESC8723B_RATEMCS3 0x0f ++#define DESC8723B_RATEMCS4 0x10 ++#define DESC8723B_RATEMCS5 0x11 ++#define DESC8723B_RATEMCS6 0x12 ++#define DESC8723B_RATEMCS7 0x13 ++#define DESC8723B_RATEMCS8 0x14 ++#define DESC8723B_RATEMCS9 0x15 ++#define DESC8723B_RATEMCS10 0x16 ++#define DESC8723B_RATEMCS11 0x17 ++#define DESC8723B_RATEMCS12 0x18 ++#define DESC8723B_RATEMCS13 0x19 ++#define DESC8723B_RATEMCS14 0x1a ++#define DESC8723B_RATEMCS15 0x1b ++#define DESC8723B_RATEVHTSS1MCS0 0x2c ++#define DESC8723B_RATEVHTSS1MCS1 0x2d ++#define DESC8723B_RATEVHTSS1MCS2 0x2e ++#define DESC8723B_RATEVHTSS1MCS3 0x2f ++#define DESC8723B_RATEVHTSS1MCS4 0x30 ++#define DESC8723B_RATEVHTSS1MCS5 0x31 ++#define DESC8723B_RATEVHTSS1MCS6 0x32 ++#define DESC8723B_RATEVHTSS1MCS7 0x33 ++#define DESC8723B_RATEVHTSS1MCS8 0x34 ++#define DESC8723B_RATEVHTSS1MCS9 0x35 ++#define DESC8723B_RATEVHTSS2MCS0 0x36 ++#define DESC8723B_RATEVHTSS2MCS1 0x37 ++#define DESC8723B_RATEVHTSS2MCS2 0x38 ++#define DESC8723B_RATEVHTSS2MCS3 0x39 ++#define DESC8723B_RATEVHTSS2MCS4 0x3a ++#define DESC8723B_RATEVHTSS2MCS5 0x3b ++#define DESC8723B_RATEVHTSS2MCS6 0x3c ++#define DESC8723B_RATEVHTSS2MCS7 0x3d ++#define DESC8723B_RATEVHTSS2MCS8 0x3e ++#define DESC8723B_RATEVHTSS2MCS9 0x3f ++ ++ ++#define RX_HAL_IS_CCK_RATE_8723B(pDesc)\ ++ (GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE1M || \ ++ GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE2M || \ ++ GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE5_5M || \ ++ GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE11M) ++ ++ ++void rtl8723b_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); ++void rtl8723b_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); ++#if defined(CONFIG_CONCURRENT_MODE) ++ void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); ++#endif ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ s32 rtl8723bs_init_xmit_priv(PADAPTER padapter); ++ void rtl8723bs_free_xmit_priv(PADAPTER padapter); ++ s32 rtl8723bs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8723bs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8723bs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8723bs_xmit_buf_handler(PADAPTER padapter); ++ thread_return rtl8723bs_xmit_thread(thread_context context); ++ #define hal_xmit_handler rtl8723bs_xmit_buf_handler ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ s32 rtl8723bu_xmit_buf_handler(PADAPTER padapter); ++ #define hal_xmit_handler rtl8723bu_xmit_buf_handler ++ ++ ++ s32 rtl8723bu_init_xmit_priv(PADAPTER padapter); ++ void rtl8723bu_free_xmit_priv(PADAPTER padapter); ++ s32 rtl8723bu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8723bu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8723bu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ /* s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); */ ++ void rtl8723bu_xmit_tasklet(void *priv); ++ s32 rtl8723bu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++ void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, struct tx_desc *ptxdesc); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ s32 rtl8723be_init_xmit_priv(PADAPTER padapter); ++ void rtl8723be_free_xmit_priv(PADAPTER padapter); ++ struct xmit_buf *rtl8723be_dequeue_xmitbuf(struct rtw_tx_ring *ring); ++ void rtl8723be_xmitframe_resume(_adapter *padapter); ++ s32 rtl8723be_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8723be_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8723be_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ void rtl8723be_xmit_tasklet(void *priv); ++#endif ++ ++u8 BWMapping_8723B(PADAPTER Adapter, struct pkt_attrib *pattrib); ++u8 SCMapping_8723B(PADAPTER Adapter, struct pkt_attrib *pattrib); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_cmd.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_cmd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_cmd.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,211 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723D_CMD_H__ ++#define __RTL8723D_CMD_H__ ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ ++ * --------------------------------------------------------------------------------------------------------- */ ++ ++enum h2c_cmd_8723D { ++ /* Common Class: 000 */ ++ H2C_8723D_RSVD_PAGE = 0x00, ++ H2C_8723D_MEDIA_STATUS_RPT = 0x01, ++ H2C_8723D_SCAN_ENABLE = 0x02, ++ H2C_8723D_KEEP_ALIVE = 0x03, ++ H2C_8723D_DISCON_DECISION = 0x04, ++ H2C_8723D_PSD_OFFLOAD = 0x05, ++ H2C_8723D_AP_OFFLOAD = 0x08, ++ H2C_8723D_BCN_RSVDPAGE = 0x09, ++ H2C_8723D_PROBERSP_RSVDPAGE = 0x0A, ++ H2C_8723D_FCS_RSVDPAGE = 0x10, ++ H2C_8723D_FCS_INFO = 0x11, ++ H2C_8723D_AP_WOW_GPIO_CTRL = 0x13, ++ ++ /* PoweSave Class: 001 */ ++ H2C_8723D_SET_PWR_MODE = 0x20, ++ H2C_8723D_PS_TUNING_PARA = 0x21, ++ H2C_8723D_PS_TUNING_PARA2 = 0x22, ++ H2C_8723D_P2P_LPS_PARAM = 0x23, ++ H2C_8723D_P2P_PS_OFFLOAD = 0x24, ++ H2C_8723D_PS_SCAN_ENABLE = 0x25, ++ H2C_8723D_SAP_PS_ = 0x26, ++ H2C_8723D_INACTIVE_PS_ = 0x27, /* Inactive_PS */ ++ H2C_8723D_FWLPS_IN_IPS_ = 0x28, ++ ++ /* Dynamic Mechanism Class: 010 */ ++ H2C_8723D_MACID_CFG = 0x40, ++ H2C_8723D_TXBF = 0x41, ++ H2C_8723D_RSSI_SETTING = 0x42, ++ H2C_8723D_AP_REQ_TXRPT = 0x43, ++ H2C_8723D_INIT_RATE_COLLECT = 0x44, ++ H2C_8723D_RA_PARA_ADJUST = 0x46, ++ ++ /* BT Class: 011 */ ++ H2C_8723D_B_TYPE_TDMA = 0x60, ++ H2C_8723D_BT_INFO = 0x61, ++ H2C_8723D_FORCE_BT_TXPWR = 0x62, ++ H2C_8723D_BT_IGNORE_WLANACT = 0x63, ++ H2C_8723D_DAC_SWING_VALUE = 0x64, ++ H2C_8723D_ANT_SEL_RSV = 0x65, ++ H2C_8723D_WL_OPMODE = 0x66, ++ H2C_8723D_BT_MP_OPER = 0x67, ++ H2C_8723D_BT_CONTROL = 0x68, ++ H2C_8723D_BT_WIFI_CTRL = 0x69, ++ H2C_8723D_BT_FW_PATCH = 0x6A, ++ H2C_8723D_BT_WLAN_CALIBRATION = 0x6D, ++ ++ /* WOWLAN Class: 100 */ ++ H2C_8723D_WOWLAN = 0x80, ++ H2C_8723D_REMOTE_WAKE_CTRL = 0x81, ++ H2C_8723D_AOAC_GLOBAL_INFO = 0x82, ++ H2C_8723D_AOAC_RSVD_PAGE = 0x83, ++ H2C_8723D_AOAC_RSVD_PAGE2 = 0x84, ++ H2C_8723D_D0_SCAN_OFFLOAD_CTRL = 0x85, ++ H2C_8723D_D0_SCAN_OFFLOAD_INFO = 0x86, ++ H2C_8723D_CHNL_SWITCH_OFFLOAD = 0x87, ++ H2C_8723D_P2P_OFFLOAD_RSVD_PAGE = 0x8A, ++ H2C_8723D_P2P_OFFLOAD = 0x8B, ++ ++ H2C_8723D_RESET_TSF = 0xC0, ++ H2C_8723D_MAXID, ++}; ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- ++ * _RSVDPAGE_LOC_CMD_0x00 */ ++#define SET_8723D_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8723D_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_8723D_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8723D_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8723D_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++ ++/* _KEEP_ALIVE_CMD_0x03 */ ++#define SET_8723D_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8723D_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8723D_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_8723D_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++ ++/* _DISCONNECT_DECISION_CMD_0x04 */ ++#define SET_8723D_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8723D_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8723D_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_8723D_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) ++ ++/* _PWR_MOD_CMD_0x20 */ ++#define SET_8723D_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8723D_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) ++#define SET_8723D_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) ++#define SET_8723D_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8723D_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8723D_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#define SET_8723D_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++ ++#define GET_8723D_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) ++ ++/* _PS_TUNE_PARAM_CMD_0x21 */ ++#define SET_8723D_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8723D_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_8723D_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) ++#define SET_8723D_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) ++#define SET_8723D_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++ ++/* _MACID_CFG_CMD_0x40 */ ++#define SET_8723D_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8723D_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) ++#define SET_8723D_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) ++#define SET_8723D_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) ++#define SET_8723D_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) ++#define SET_8723D_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) ++#define SET_8723D_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) ++#define SET_8723D_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) ++#define SET_8723D_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++#define SET_8723D_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) ++#define SET_8723D_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) ++#define SET_8723D_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) ++ ++/* _RSSI_SETTING_CMD_0x42 */ ++#define SET_8723D_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8723D_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) ++#define SET_8723D_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++ ++/* _AP_REQ_TXRPT_CMD_0x43 */ ++#define SET_8723D_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8723D_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++ ++/* _FORCE_BT_TXPWR_CMD_0x62 */ ++#define SET_8723D_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++ ++/* _FORCE_BT_MP_OPER_CMD_0x67 */ ++#define SET_8723D_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) ++#define SET_8723D_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) ++#define SET_8723D_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_8723D_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) ++#define SET_8723D_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) ++#define SET_8723D_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) ++ ++/* _BT_FW_PATCH_0x6A */ ++#define SET_8723D_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) ++#define SET_8723D_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8723D_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8723D_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#define SET_8723D_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ------------------------------------------- Structure -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- */ ++ ++ ++/* --------------------------------------------------------------------------------------------------------- ++ * ---------------------------------- Function Statement -------------------------------------------------- ++ * --------------------------------------------------------------------------------------------------------- */ ++ ++/* host message to firmware cmd */ ++void rtl8723d_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); ++void rtl8723d_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); ++void rtl8723d_set_rssi_cmd(PADAPTER padapter, u8 *param); ++void rtl8723d_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); ++/* s32 rtl8723d_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ ++void rtl8723d_set_FwPsTuneParam_cmd(PADAPTER padapter); ++void rtl8723d_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); ++void rtl8723d_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); ++void rtl8723d_download_rsvd_page(PADAPTER padapter, u8 mstatus); ++#ifdef CONFIG_BT_COEXIST ++ void rtl8723d_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); ++#endif /* CONFIG_BT_COEXIST */ ++#ifdef CONFIG_P2P ++ void rtl8723d_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); ++#endif /* CONFIG_P2P */ ++ ++void CheckFwRsvdPageContent(PADAPTER padapter); ++ ++#ifdef CONFIG_P2P_WOWLAN ++ void rtl8723d_set_p2p_wowlan_offload_cmd(PADAPTER padapter); ++#endif ++ ++void rtl8723d_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 en); ++ ++#ifdef CONFIG_TSF_RESET_OFFLOAD ++ u8 rtl8723d_reset_tsf(_adapter *padapter, u8 reset_port); ++#endif /* CONFIG_TSF_RESET_OFFLOAD */ ++s32 FillH2CCmd8723D(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); ++u8 GetTxBufferRsvdPageNum8723D(_adapter *padapter, bool wowlan); ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_dm.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_dm.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_dm.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,47 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723D_DM_H__ ++#define __RTL8723D_DM_H__ ++/* ************************************************************ ++ * Description: ++ * ++ * This file is for 8723D dynamic mechanism only ++ * ++ * ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * structure and define ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * function prototype ++ * ************************************************************ */ ++ ++void rtl8723d_init_dm_priv(PADAPTER padapter); ++void rtl8723d_deinit_dm_priv(PADAPTER padapter); ++ ++void rtl8723d_InitHalDm(PADAPTER padapter); ++void rtl8723d_HalDmWatchDog(PADAPTER padapter); ++void rtl8723d_HalDmWatchDog_in_LPS(PADAPTER padapter); ++void rtl8723d_hal_dm_in_lps(PADAPTER padapter); ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_hal.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,316 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723D_HAL_H__ ++#define __RTL8723D_HAL_H__ ++ ++#include "hal_data.h" ++ ++#include "rtl8723d_spec.h" ++#include "rtl8723d_rf.h" ++#include "rtl8723d_dm.h" ++#include "rtl8723d_recv.h" ++#include "rtl8723d_xmit.h" ++#include "rtl8723d_cmd.h" ++#include "rtl8723d_led.h" ++#include "Hal8723DPwrSeq.h" ++#include "Hal8723DPhyReg.h" ++#include "Hal8723DPhyCfg.h" ++#ifdef DBG_CONFIG_ERROR_DETECT ++ #include "rtl8723d_sreset.h" ++#endif ++#ifdef CONFIG_LPS_POFF ++ #include "rtl8723d_lps_poff.h" ++#endif ++ ++#define FW_8723D_SIZE 0x8000 ++#define FW_8723D_START_ADDRESS 0x1000 ++#define FW_8723D_END_ADDRESS 0x1FFF /* 0x5FFF */ ++ ++#define IS_FW_HEADER_EXIST_8723D(_pFwHdr)\ ++ ((le16_to_cpu(_pFwHdr->Signature) & 0xFFF0) == 0x23D0) ++ ++typedef struct _RT_FIRMWARE { ++ FIRMWARE_SOURCE eFWSource; ++#ifdef CONFIG_EMBEDDED_FWIMG ++ u8 *szFwBuffer; ++#else ++ u8 szFwBuffer[FW_8723D_SIZE]; ++#endif ++ u32 ulFwLength; ++} RT_FIRMWARE_8723D, *PRT_FIRMWARE_8723D; ++ ++/* ++ * This structure must be cared byte-ordering ++ * ++ * Added by tynli. 2009.12.04. */ ++typedef struct _RT_8723D_FIRMWARE_HDR { ++ /* 8-byte alinment required */ ++ ++ /* --- LONG WORD 0 ---- */ ++ u16 Signature; /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ ++ u8 Category; /* AP/NIC and USB/PCI */ ++ u8 Function; /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ ++ u16 Version; /* FW Version */ ++ u16 Subversion; /* FW Subversion, default 0x00 */ ++ ++ /* --- LONG WORD 1 ---- */ ++ u8 Month; /* Release time Month field */ ++ u8 Date; /* Release time Date field */ ++ u8 Hour; /* Release time Hour field */ ++ u8 Minute; /* Release time Minute field */ ++ u16 RamCodeSize; /* The size of RAM code */ ++ u16 Rsvd2; ++ ++ /* --- LONG WORD 2 ---- */ ++ u32 SvnIdx; /* The SVN entry index */ ++ u32 Rsvd3; ++ ++ /* --- LONG WORD 3 ---- */ ++ u32 Rsvd4; ++ u32 Rsvd5; ++} RT_8723D_FIRMWARE_HDR, *PRT_8723D_FIRMWARE_HDR; ++ ++#define DRIVER_EARLY_INT_TIME_8723D 0x05 ++#define BCN_DMA_ATIME_INT_TIME_8723D 0x02 ++ ++/* for 8723D ++ * TX 32K, RX 16K, Page size 128B for TX, 8B for RX */ ++#define PAGE_SIZE_TX_8723D 128 ++#define PAGE_SIZE_RX_8723D 8 ++ ++#define TX_DMA_SIZE_8723D 0x8000 /* 32K(TX) */ ++#define RX_DMA_SIZE_8723D 0x4000 /* 16K(RX) */ ++ ++#ifdef CONFIG_WOWLAN ++ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ ++#else ++ #define RESV_FMWF 0 ++#endif ++ ++#ifdef CONFIG_FW_C2H_DEBUG ++ #define RX_DMA_RESERVED_SIZE_8723D 0x100 /* 256B, reserved for c2h debug message */ ++#else ++ #define RX_DMA_RESERVED_SIZE_8723D 0x80 /* 128B, reserved for tx report */ ++#endif ++#define RX_DMA_BOUNDARY_8723D\ ++ (RX_DMA_SIZE_8723D - RX_DMA_RESERVED_SIZE_8723D - 1) ++ ++ ++/* Note: We will divide number of page equally for each queue other than public queue! */ ++ ++/* For General Reserved Page Number(Beacon Queue is reserved page) ++ * Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 */ ++#define BCNQ_PAGE_NUM_8723D 0x08 ++#ifdef CONFIG_CONCURRENT_MODE ++ #define BCNQ1_PAGE_NUM_8723D 0x08 /* 0x04 */ ++#else ++ #define BCNQ1_PAGE_NUM_8723D 0x00 ++#endif ++ ++#ifdef CONFIG_PNO_SUPPORT ++ #undef BCNQ1_PAGE_NUM_8723D ++ #define BCNQ1_PAGE_NUM_8723D 0x00 /* 0x04 */ ++#endif ++ ++/* For WoWLan , more reserved page ++ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ ++#ifdef CONFIG_WOWLAN ++ #define WOWLAN_PAGE_NUM_8723D 0x07 ++#else ++ #define WOWLAN_PAGE_NUM_8723D 0x00 ++#endif ++ ++#ifdef CONFIG_PNO_SUPPORT ++ #undef WOWLAN_PAGE_NUM_8723D ++ #define WOWLAN_PAGE_NUM_8723D 0x15 ++#endif ++ ++#ifdef CONFIG_AP_WOWLAN ++ #define AP_WOWLAN_PAGE_NUM_8723D 0x02 ++#endif ++ ++#define TX_TOTAL_PAGE_NUMBER_8723D\ ++ (0xFF - BCNQ_PAGE_NUM_8723D - BCNQ1_PAGE_NUM_8723D - WOWLAN_PAGE_NUM_8723D) ++#define TX_PAGE_BOUNDARY_8723D (TX_TOTAL_PAGE_NUMBER_8723D + 1) ++ ++#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723D TX_TOTAL_PAGE_NUMBER_8723D ++#define WMM_NORMAL_TX_PAGE_BOUNDARY_8723D\ ++ (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723D + 1) ++ ++/* For Normal Chip Setting ++ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8723D */ ++#define NORMAL_PAGE_NUM_HPQ_8723D 0x0C ++#define NORMAL_PAGE_NUM_LPQ_8723D 0x02 ++#define NORMAL_PAGE_NUM_NPQ_8723D 0x02 ++ ++/* Note: For Normal Chip Setting, modify later */ ++#define WMM_NORMAL_PAGE_NUM_HPQ_8723D 0x30 ++#define WMM_NORMAL_PAGE_NUM_LPQ_8723D 0x20 ++#define WMM_NORMAL_PAGE_NUM_NPQ_8723D 0x20 ++ ++ ++#include "HalVerDef.h" ++#include "hal_com.h" ++ ++#define EFUSE_OOB_PROTECT_BYTES (96 + 1) ++ ++#define HAL_EFUSE_MEMORY ++#define HWSET_MAX_SIZE_8723D 512 ++#define EFUSE_REAL_CONTENT_LEN_8723D 512 ++#define EFUSE_MAP_LEN_8723D 512 ++#define EFUSE_MAX_SECTION_8723D 64 ++ ++/* For some inferiority IC purpose. added by Roger, 2009.09.02.*/ ++#define EFUSE_IC_ID_OFFSET 506 ++#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8723D) ++ ++#define EFUSE_ACCESS_ON 0x69 ++#define EFUSE_ACCESS_OFF 0x00 ++ ++/* ******************************************************** ++ * EFUSE for BT definition ++ * ******************************************************** */ ++#define BANK_NUM 1 ++#define EFUSE_BT_REAL_BANK_CONTENT_LEN 128 ++#define EFUSE_BT_REAL_CONTENT_LEN \ ++ (EFUSE_BT_REAL_BANK_CONTENT_LEN * BANK_NUM) ++#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ ++#define EFUSE_BT_MAX_SECTION (EFUSE_BT_MAP_LEN / 8) ++#define EFUSE_PROTECT_BYTES_BANK 16 ++ ++typedef enum tag_Package_Definition { ++ PACKAGE_DEFAULT, ++ PACKAGE_QFN68, ++ PACKAGE_TFBGA90, ++ PACKAGE_TFBGA80, ++ PACKAGE_TFBGA79 ++} PACKAGE_TYPE_E; ++ ++#define INCLUDE_MULTI_FUNC_BT(_Adapter) \ ++ (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) ++#define INCLUDE_MULTI_FUNC_GPS(_Adapter) \ ++ (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) ++ ++#ifdef CONFIG_FILE_FWIMG ++ extern char *rtw_fw_file_path; ++ extern char *rtw_fw_wow_file_path; ++ #ifdef CONFIG_MP_INCLUDED ++ extern char *rtw_fw_mp_bt_file_path; ++ #endif /* CONFIG_MP_INCLUDED */ ++#endif /* CONFIG_FILE_FWIMG */ ++ ++/* rtl8723d_hal_init.c */ ++s32 rtl8723d_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); ++void rtl8723d_FirmwareSelfReset(PADAPTER padapter); ++void rtl8723d_InitializeFirmwareVars(PADAPTER padapter); ++ ++void rtl8723d_InitAntenna_Selection(PADAPTER padapter); ++void rtl8723d_DeinitAntenna_Selection(PADAPTER padapter); ++void rtl8723d_CheckAntenna_Selection(PADAPTER padapter); ++void rtl8723d_init_default_value(PADAPTER padapter); ++ ++s32 rtl8723d_InitLLTTable(PADAPTER padapter); ++ ++s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU); ++s32 CardDisableWithoutHWSM(PADAPTER padapter); ++ ++/* EFuse */ ++u8 GetEEPROMSize8723D(PADAPTER padapter); ++void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); ++void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); ++void Hal_EfuseParseTxPowerInfo_8723D(PADAPTER padapter, ++ u8 *PROMContent, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseBTCoexistInfo_8723D(PADAPTER padapter, ++ u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseEEPROMVer_8723D(PADAPTER padapter, ++ u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParsePackageType_8723D(PADAPTER pAdapter, ++ u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseChnlPlan_8723D(PADAPTER padapter, ++ u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseCustomerID_8723D(PADAPTER padapter, ++ u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseAntennaDiversity_8723D(PADAPTER padapter, ++ u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseXtal_8723D(PADAPTER pAdapter, ++ u8 *hwinfo, u8 AutoLoadFail); ++void Hal_EfuseParseThermalMeter_8723D(PADAPTER padapter, ++ u8 *hwinfo, u8 AutoLoadFail); ++VOID Hal_EfuseParseVoltage_8723D(PADAPTER pAdapter, ++ u8 *hwinfo, BOOLEAN AutoLoadFail); ++VOID Hal_EfuseParseBoardType_8723D(PADAPTER Adapter, ++ u8 *PROMContent, BOOLEAN AutoloadFail); ++ ++void rtl8723d_set_hal_ops(struct hal_ops *pHalFunc); ++void init_hal_spec_8723d(_adapter *adapter); ++void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val); ++void GetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val); ++u8 SetHalDefVar8723D(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++u8 GetHalDefVar8723D(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++ ++/* register */ ++void rtl8723d_InitBeaconParameters(PADAPTER padapter); ++void rtl8723d_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); ++void _InitBurstPktLen_8723DS(PADAPTER Adapter); ++void _InitLTECoex_8723DS(PADAPTER Adapter); ++void _InitMacAPLLSetting_8723D(PADAPTER Adapter); ++void _8051Reset8723(PADAPTER padapter); ++#ifdef CONFIG_WOWLAN ++ void Hal_DetectWoWMode(PADAPTER pAdapter); ++#endif /* CONFIG_WOWLAN */ ++ ++void rtl8723d_start_thread(_adapter *padapter); ++void rtl8723d_stop_thread(_adapter *padapter); ++ ++#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) ++ void rtl8723ds_init_checkbthang_workqueue(_adapter *adapter); ++ void rtl8723ds_free_checkbthang_workqueue(_adapter *adapter); ++ void rtl8723ds_cancle_checkbthang_workqueue(_adapter *adapter); ++ void rtl8723ds_hal_check_bt_hang(_adapter *adapter); ++#endif ++ ++#ifdef CONFIG_GPIO_WAKEUP ++ void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); ++#endif ++#ifdef CONFIG_MP_INCLUDED ++int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); ++#endif ++void CCX_FwC2HTxRpt_8723d(PADAPTER padapter, u8 *pdata, u8 len); ++ ++u8 MRateToHwRate8723D(u8 rate); ++u8 HwRateToMRate8723D(u8 rate); ++ ++void Hal_ReadRFGainOffset(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++ ++#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) ++ void check_bt_status_work(void *data); ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ void rtl8723d_cal_txdesc_chksum(struct tx_desc *ptxdesc); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ BOOLEAN InterruptRecognized8723DE(PADAPTER Adapter); ++ VOID UpdateInterruptMask8723DE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); ++ u16 get_txbufdesc_idx_hwaddr(u16 ff_hwaddr); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_led.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_led.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_led.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,48 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723D_LED_H__ ++#define __RTL8723D_LED_H__ ++ ++#include ++#include ++#include ++ ++ ++/* ******************************************************************************** ++ * Interface to manipulate LED objects. ++ * ******************************************************************************** */ ++#ifdef CONFIG_USB_HCI ++ void rtl8723du_InitSwLeds(PADAPTER padapter); ++ void rtl8723du_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_SDIO_HCI ++ void rtl8723ds_InitSwLeds(PADAPTER padapter); ++ void rtl8723ds_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_GSPI_HCI ++ void rtl8723ds_InitSwLeds(PADAPTER padapter); ++ void rtl8723ds_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_PCI_HCI ++ void rtl8723de_InitSwLeds(PADAPTER padapter); ++ void rtl8723de_DeInitSwLeds(PADAPTER padapter); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_lps_poff.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_lps_poff.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_lps_poff.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_lps_poff.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,61 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++/******************************************** CONST ************************/ ++#define NUM_OF_REGISTER_BANK 13 ++#define NUM_OF_TOTAL_DWORD (NUM_OF_REGISTER_BANK * 64) ++#define TOTAL_LEN_FOR_HIOE ((NUM_OF_TOTAL_DWORD + 1) * 8) ++#define LPS_POFF_STATIC_FILE_LEN (TOTAL_LEN_FOR_HIOE + TXDESC_SIZE) ++#define LPS_POFF_DYNAMIC_FILE_LEN (512 + TXDESC_SIZE) ++/******************************************** CONST ************************/ ++ ++/******************************************** MACRO ************************/ ++/* HOIE Entry Definition */ ++#define SET_HOIE_ENTRY_LOW_DATA(__pHOIE, __Value) \ ++ SET_BITS_TO_LE_4BYTE((__pHOIE), 0, 16, __Value) ++#define SET_HOIE_ENTRY_HIGH_DATA(__pHOIE, __Value) \ ++ SET_BITS_TO_LE_4BYTE((__pHOIE), 16, 16, __Value) ++#define SET_HOIE_ENTRY_MODE_SELECT(__pHOIE, __Value) \ ++ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 0, 1, __Value) ++#define SET_HOIE_ENTRY_ADDRESS(__pHOIE, __Value) \ ++ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 1, 14, __Value) ++#define SET_HOIE_ENTRY_BYTE_MASK(__pHOIE, __Value) \ ++ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 15, 4, __Value) ++#define SET_HOIE_ENTRY_IO_LOCK(__pHOIE, __Value) \ ++ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 19, 1, __Value) ++#define SET_HOIE_ENTRY_RD_EN(__pHOIE, __Value) \ ++ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 20, 1, __Value) ++#define SET_HOIE_ENTRY_WR_EN(__pHOIE, __Value) \ ++ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 21, 1, __Value) ++#define SET_HOIE_ENTRY_RAW_RW(__pHOIE, __Value) \ ++ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 22, 1, __Value) ++#define SET_HOIE_ENTRY_RAW(__pHOIE, __Value) \ ++ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 23, 1, __Value) ++#define SET_HOIE_ENTRY_IO_DELAY(__pHOIE, __Value) \ ++ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 24, 8, __Value) ++ ++/*********************Function Definition*******************************************/ ++void rtl8723d_lps_poff_init(PADAPTER padapter); ++void rtl8723d_lps_poff_deinit(PADAPTER padapter); ++bool rtl8723d_lps_poff_get_txbndy_status(PADAPTER padapter); ++void rtl8723d_lps_poff_h2c_ctrl(PADAPTER padapter, u8 enable); ++void rtl8723d_lps_poff_set_ps_mode(PADAPTER padapter, bool bEnterLPS); ++bool rtl8723d_lps_poff_get_status(PADAPTER padapter); ++void rtl8723d_lps_poff_wow(PADAPTER padapter); +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_recv.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_recv.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_recv.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,120 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723D_RECV_H__ ++#define __RTL8723D_RECV_H__ ++ ++#define RECV_BLK_SZ 512 ++#define RECV_BLK_CNT 16 ++#define RECV_BLK_TH RECV_BLK_CNT ++ ++#if defined(CONFIG_USB_HCI) ++ ++ #ifndef MAX_RECVBUF_SZ ++ #ifdef PLATFORM_OS_CE ++ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ ++ #else ++ #ifndef CONFIG_MINIMAL_MEMORY_USAGE ++ /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ ++ /* #define MAX_RECVBUF_SZ (16384) */ /* 16K */ ++ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ ++ #ifdef CONFIG_PLATFORM_MSTAR ++ #define MAX_RECVBUF_SZ (8192) /* 8K */ ++ #else ++ #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ ++ #endif ++ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ ++ #else ++ #define MAX_RECVBUF_SZ (4000) /* about 4K */ ++ #endif ++ #endif ++ #endif /* !MAX_RECVBUF_SZ */ ++ ++#elif defined(CONFIG_PCI_HCI) ++ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ ++ /* #define MAX_RECVBUF_SZ (9100) */ ++ /* #else */ ++ #define MAX_RECVBUF_SZ (4000) /* about 4K ++ * #endif */ ++ ++ ++#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ ++ #define MAX_RECVBUF_SZ (RX_DMA_BOUNDARY_8723D + 1) ++ ++#endif ++ ++/* Rx smooth factor */ ++#define Rx_Smooth_Factor (20) ++ ++#ifdef CONFIG_SDIO_HCI ++ #ifndef CONFIG_SDIO_RX_COPY ++ #undef MAX_RECVBUF_SZ ++ #define MAX_RECVBUF_SZ (RX_DMA_SIZE_8723D - RX_DMA_RESERVED_SIZE_8723D) ++ #endif /* !CONFIG_SDIO_RX_COPY */ ++#endif /* CONFIG_SDIO_HCI */ ++ ++/*-----------------------------------------------------------------*/ ++/* RTL8723D RX BUFFER DESC */ ++/*-----------------------------------------------------------------*/ ++/*DWORD 0*/ ++#define SET_RX_BUFFER_DESC_DATA_LENGTH_8723D(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) ++#define SET_RX_BUFFER_DESC_LS_8723D(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 15, 1, __Value) ++#define SET_RX_BUFFER_DESC_FS_8723D(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 1, __Value) ++#define SET_RX_BUFFER_DESC_TOTAL_LENGTH_8723D(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 15, __Value) ++ ++#define GET_RX_BUFFER_DESC_OWN_8723D(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) ++#define GET_RX_BUFFER_DESC_LS_8723D(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) ++#define GET_RX_BUFFER_DESC_FS_8723D(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 1) ++#ifdef USING_RX_TAG ++ #define GET_RX_BUFFER_DESC_RX_TAG_8723D(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 13) ++#else ++ #define GET_RX_BUFFER_DESC_TOTAL_LENGTH_8723D(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 15) ++#endif ++ ++/*DWORD 1*/ ++#define SET_RX_BUFFER_PHYSICAL_LOW_8723D(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+4, 0, 32, __Value) ++ ++/*DWORD 2*/ ++#ifdef CONFIG_64BIT_DMA ++ #define SET_RX_BUFFER_PHYSICAL_HIGH_8723D(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+8, 0, 32, __Value) ++#else ++ #define SET_RX_BUFFER_PHYSICAL_HIGH_8723D(__pRxStatusDesc, __Value) ++#endif ++ ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ s32 rtl8723ds_init_recv_priv(PADAPTER padapter); ++ void rtl8723ds_free_recv_priv(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ int rtl8723du_init_recv_priv(_adapter *padapter); ++ void rtl8723du_free_recv_priv(_adapter *padapter); ++ void rtl8723du_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ s32 rtl8723de_init_recv_priv(PADAPTER padapter); ++ void rtl8723de_free_recv_priv(PADAPTER padapter); ++#endif ++ ++void rtl8723d_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); ++ ++#endif /* __RTL8723D_RECV_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_rf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_rf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_rf.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,26 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723D_RF_H__ ++#define __RTL8723D_RF_H__ ++ ++int PHY_RF6052_Config8723D(IN PADAPTER pdapter); ++ ++void PHY_RF6052SetBandwidth8723D(IN PADAPTER Adapter, IN CHANNEL_WIDTH Bandwidth); ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_spec.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_spec.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_spec.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,459 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ *******************************************************************************/ ++#ifndef __RTL8723D_SPEC_H__ ++#define __RTL8723D_SPEC_H__ ++ ++#include ++ ++ ++#define HAL_NAV_UPPER_UNIT_8723D 128 /* micro-second */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0000h ~ 0x00FFh System Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_SYS_ISO_CTRL_8723D 0x0000 /* 2 Byte */ ++#define REG_SYS_FUNC_EN_8723D 0x0002 /* 2 Byte */ ++#define REG_APS_FSMCO_8723D 0x0004 /* 4 Byte */ ++#define REG_SYS_CLKR_8723D 0x0008 /* 2 Byte */ ++#define REG_9346CR_8723D 0x000A /* 2 Byte */ ++#define REG_EE_VPD_8723D 0x000C /* 2 Byte */ ++#define REG_AFE_MISC_8723D 0x0010 /* 1 Byte */ ++#define REG_SPS0_CTRL_8723D 0x0011 /* 7 Byte */ ++#define REG_SPS_OCP_CFG_8723D 0x0018 /* 4 Byte */ ++#define REG_RSV_CTRL_8723D 0x001C /* 3 Byte */ ++#define REG_RF_CTRL_8723D 0x001F /* 1 Byte */ ++#define REG_LPLDO_CTRL_8723D 0x0023 /* 1 Byte */ ++#define REG_AFE_XTAL_CTRL_8723D 0x0024 /* 4 Byte */ ++#define REG_AFE_PLL_CTRL_8723D 0x0028 /* 4 Byte */ ++#define REG_MAC_PLL_CTRL_EXT_8723D 0x002c /* 4 Byte */ ++#define REG_EFUSE_CTRL_8723D 0x0030 ++#define REG_EFUSE_TEST_8723D 0x0034 ++#define REG_PWR_DATA_8723D 0x0038 ++#define REG_CAL_TIMER_8723D 0x003C ++#define REG_ACLK_MON_8723D 0x003E ++#define REG_GPIO_MUXCFG_8723D 0x0040 ++#define REG_GPIO_IO_SEL_8723D 0x0042 ++#define REG_MAC_PINMUX_CFG_8723D 0x0043 ++#define REG_GPIO_PIN_CTRL_8723D 0x0044 ++#define REG_GPIO_INTM_8723D 0x0048 ++#define REG_LEDCFG0_8723D 0x004C ++#define REG_LEDCFG1_8723D 0x004D ++#define REG_LEDCFG2_8723D 0x004E ++#define REG_LEDCFG3_8723D 0x004F ++#define REG_FSIMR_8723D 0x0050 ++#define REG_FSISR_8723D 0x0054 ++#define REG_HSIMR_8723D 0x0058 ++#define REG_HSISR_8723D 0x005c ++#define REG_GPIO_EXT_CTRL 0x0060 ++#define REG_PAD_CTRL1_8723D 0x0064 ++#define REG_MULTI_FUNC_CTRL_8723D 0x0068 ++#define REG_GPIO_STATUS_8723D 0x006C ++#define REG_SDIO_CTRL_8723D 0x0070 ++#define REG_OPT_CTRL_8723D 0x0074 ++#define REG_AFE_CTRL_4_8723D 0x0078 ++#define REG_MCUFWDL_8723D 0x0080 ++#define REG_8051FW_CTRL_8723D 0x0080 ++#define REG_HMEBOX_DBG_0_8723D 0x0088 ++#define REG_HMEBOX_DBG_1_8723D 0x008A ++#define REG_HMEBOX_DBG_2_8723D 0x008C ++#define REG_HMEBOX_DBG_3_8723D 0x008E ++#define REG_WLLPS_CTRL 0x0090 ++#define REG_HIMR0_8723D 0x00B0 ++#define REG_HISR0_8723D 0x00B4 ++#define REG_HIMR1_8723D 0x00B8 ++#define REG_HISR1_8723D 0x00BC ++#define REG_PMC_DBG_CTRL2_8723D 0x00CC ++#define REG_EFUSE_BURN_GNT_8723D 0x00CF ++#define REG_HPON_FSM_8723D 0x00EC ++#define REG_SYS_CFG_8723D 0x00FC ++#define REG_ROM_VERSION 0x00FD ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0100h ~ 0x01FFh MACTOP General Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_C2HEVT_CMD_ID_8723D 0x01A0 ++#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 ++#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 ++#define REG_C2HEVT_CMD_LEN_8723D 0x01AE ++#define REG_C2HEVT_CLEAR_8723D 0x01AF ++#define REG_MCUTST_1_8723D 0x01C0 ++#define REG_WOWLAN_WAKE_REASON 0x01C7 ++#define REG_FMETHR_8723D 0x01C8 ++#define REG_HMETFR_8723D 0x01CC ++#define REG_HMEBOX_0_8723D 0x01D0 ++#define REG_HMEBOX_1_8723D 0x01D4 ++#define REG_HMEBOX_2_8723D 0x01D8 ++#define REG_HMEBOX_3_8723D 0x01DC ++#define REG_LLT_INIT_8723D 0x01E0 ++#define REG_HMEBOX_EXT0_8723D 0x01F0 ++#define REG_HMEBOX_EXT1_8723D 0x01F4 ++#define REG_HMEBOX_EXT2_8723D 0x01F8 ++#define REG_HMEBOX_EXT3_8723D 0x01FC ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0200h ~ 0x027Fh TXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_RQPN_8723D 0x0200 ++#define REG_FIFOPAGE_8723D 0x0204 ++#define REG_DWBCN0_CTRL_8723D REG_TDECTRL ++#define REG_TXDMA_OFFSET_CHK_8723D 0x020C ++#define REG_TXDMA_STATUS_8723D 0x0210 ++#define REG_RQPN_NPQ_8723D 0x0214 ++#define REG_DWBCN1_CTRL_8723D 0x0228 ++ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0280h ~ 0x02FFh RXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_RXDMA_AGG_PG_TH_8723D 0x0280 ++#define REG_FW_UPD_RDPTR_8723D 0x0284 /* FW shall update this register before FW write RXPKT_RELEASE_POLL to 1 */ ++#define REG_RXDMA_CONTROL_8723D 0x0286 /* Control the RX DMA. */ ++#define REG_RXDMA_STATUS_8723D 0x0288 ++#define REG_RXDMA_MODE_CTRL_8723D 0x0290 ++#define REG_EARLY_MODE_CONTROL_8723D 0x02BC ++#define REG_RSVD5_8723D 0x02F0 ++#define REG_RSVD6_8723D 0x02F4 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0300h ~ 0x03FFh PCIe ++ * ++ * ----------------------------------------------------- */ ++#define REG_PCIE_CTRL_REG_8723D 0x0300 ++#define REG_INT_MIG_8723D 0x0304 /* Interrupt Migration */ ++#define REG_BCNQ_TXBD_DESA_8723D 0x0308 /* TX Beacon Descriptor Address */ ++#define REG_MGQ_TXBD_DESA_8723D 0x0310 /* TX Manage Queue Descriptor Address */ ++#define REG_VOQ_TXBD_DESA_8723D 0x0318 /* TX VO Queue Descriptor Address */ ++#define REG_VIQ_TXBD_DESA_8723D 0x0320 /* TX VI Queue Descriptor Address */ ++#define REG_BEQ_TXBD_DESA_8723D 0x0328 /* TX BE Queue Descriptor Address */ ++#define REG_BKQ_TXBD_DESA_8723D 0x0330 /* TX BK Queue Descriptor Address */ ++#define REG_RXQ_RXBD_DESA_8723D 0x0338 /* RX Queue Descriptor Address */ ++#define REG_HI0Q_TXBD_DESA_8723D 0x0340 ++#define REG_HI1Q_TXBD_DESA_8723D 0x0348 ++#define REG_HI2Q_TXBD_DESA_8723D 0x0350 ++#define REG_HI3Q_TXBD_DESA_8723D 0x0358 ++#define REG_HI4Q_TXBD_DESA_8723D 0x0360 ++#define REG_HI5Q_TXBD_DESA_8723D 0x0368 ++#define REG_HI6Q_TXBD_DESA_8723D 0x0370 ++#define REG_HI7Q_TXBD_DESA_8723D 0x0378 ++#define REG_MGQ_TXBD_NUM_8723D 0x0380 ++#define REG_RX_RXBD_NUM_8723D 0x0382 ++#define REG_VOQ_TXBD_NUM_8723D 0x0384 ++#define REG_VIQ_TXBD_NUM_8723D 0x0386 ++#define REG_BEQ_TXBD_NUM_8723D 0x0388 ++#define REG_BKQ_TXBD_NUM_8723D 0x038A ++#define REG_HI0Q_TXBD_NUM_8723D 0x038C ++#define REG_HI1Q_TXBD_NUM_8723D 0x038E ++#define REG_HI2Q_TXBD_NUM_8723D 0x0390 ++#define REG_HI3Q_TXBD_NUM_8723D 0x0392 ++#define REG_HI4Q_TXBD_NUM_8723D 0x0394 ++#define REG_HI5Q_TXBD_NUM_8723D 0x0396 ++#define REG_HI6Q_TXBD_NUM_8723D 0x0398 ++#define REG_HI7Q_TXBD_NUM_8723D 0x039A ++#define REG_TSFTIMER_HCI_8723D 0x039C ++#define REG_BD_RW_PTR_CLR_8723D 0x039C ++ ++/* Read Write Point */ ++#define REG_VOQ_TXBD_IDX_8723D 0x03A0 ++#define REG_VIQ_TXBD_IDX_8723D 0x03A4 ++#define REG_BEQ_TXBD_IDX_8723D 0x03A8 ++#define REG_BKQ_TXBD_IDX_8723D 0x03AC ++#define REG_MGQ_TXBD_IDX_8723D 0x03B0 ++#define REG_RXQ_TXBD_IDX_8723D 0x03B4 ++#define REG_HI0Q_TXBD_IDX_8723D 0x03B8 ++#define REG_HI1Q_TXBD_IDX_8723D 0x03BC ++#define REG_HI2Q_TXBD_IDX_8723D 0x03C0 ++#define REG_HI3Q_TXBD_IDX_8723D 0x03C4 ++#define REG_HI4Q_TXBD_IDX_8723D 0x03C8 ++#define REG_HI5Q_TXBD_IDX_8723D 0x03CC ++#define REG_HI6Q_TXBD_IDX_8723D 0x03D0 ++#define REG_HI7Q_TXBD_IDX_8723D 0x03D4 ++ ++#define REG_PCIE_HCPWM_8723DE 0x03D8 /* ?????? */ ++#define REG_PCIE_HRPWM_8723DE 0x03DC /* PCIe RPWM ?????? */ ++#define REG_DBI_WDATA_V1_8723D 0x03E8 ++#define REG_DBI_RDATA_V1_8723D 0x03EC ++#define REG_DBI_FLAG_V1_8723D 0x03F0 ++#define REG_MDIO_V1_8723D 0x03F4 ++#define REG_PCIE_MIX_CFG_8723D 0x03F8 ++#define REG_HCI_MIX_CFG_8723D 0x03FC ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0400h ~ 0x047Fh Protocol Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_VOQ_INFORMATION_8723D 0x0400 ++#define REG_VIQ_INFORMATION_8723D 0x0404 ++#define REG_BEQ_INFORMATION_8723D 0x0408 ++#define REG_BKQ_INFORMATION_8723D 0x040C ++#define REG_MGQ_INFORMATION_8723D 0x0410 ++#define REG_HGQ_INFORMATION_8723D 0x0414 ++#define REG_BCNQ_INFORMATION_8723D 0x0418 ++#define REG_TXPKT_EMPTY_8723D 0x041A ++ ++#define REG_FWHW_TXQ_CTRL_8723D 0x0420 ++#define REG_HWSEQ_CTRL_8723D 0x0423 ++#define REG_TXPKTBUF_BCNQ_BDNY_8723D 0x0424 ++#define REG_TXPKTBUF_MGQ_BDNY_8723D 0x0425 ++#define REG_LIFECTRL_CTRL_8723D 0x0426 ++#define REG_MULTI_BCNQ_OFFSET_8723D 0x0427 ++#define REG_SPEC_SIFS_8723D 0x0428 ++#define REG_RL_8723D 0x042A ++#define REG_TXBF_CTRL_8723D 0x042C ++#define REG_DARFRC_8723D 0x0430 ++#define REG_RARFRC_8723D 0x0438 ++#define REG_RRSR_8723D 0x0440 ++#define REG_ARFR0_8723D 0x0444 ++#define REG_ARFR1_8723D 0x044C ++#define REG_CCK_CHECK_8723D 0x0454 ++#define REG_AMPDU_MAX_TIME_8723D 0x0456 ++#define REG_TXPKTBUF_BCNQ_BDNY1_8723D 0x0457 ++ ++#define REG_AMPDU_MAX_LENGTH_8723D 0x0458 ++#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8723D 0x045D ++#define REG_NDPA_OPT_CTRL_8723D 0x045F ++#define REG_FAST_EDCA_CTRL_8723D 0x0460 ++#define REG_RD_RESP_PKT_TH_8723D 0x0463 ++#define REG_DATA_SC_8723D 0x0483 ++#ifdef CONFIG_WOWLAN ++ #define REG_TXPKTBUF_IV_LOW 0x0484 ++ #define REG_TXPKTBUF_IV_HIGH 0x0488 ++#endif ++#define REG_TXRPT_START_OFFSET 0x04AC ++#define REG_POWER_STAGE1_8723D 0x04B4 ++#define REG_POWER_STAGE2_8723D 0x04B8 ++#define REG_AMPDU_BURST_MODE_8723D 0x04BC ++#define REG_PKT_VO_VI_LIFE_TIME_8723D 0x04C0 ++#define REG_PKT_BE_BK_LIFE_TIME_8723D 0x04C2 ++#define REG_STBC_SETTING_8723D 0x04C4 ++#define REG_HT_SINGLE_AMPDU_8723D 0x04C7 ++#define REG_PROT_MODE_CTRL_8723D 0x04C8 ++#define REG_MAX_AGGR_NUM_8723D 0x04CA ++#define REG_RTS_MAX_AGGR_NUM_8723D 0x04CB ++#define REG_BAR_MODE_CTRL_8723D 0x04CC ++#define REG_RA_TRY_RATE_AGG_LMT_8723D 0x04CF ++#define REG_MACID_PKT_DROP0_8723D 0x04D0 ++#define REG_MACID_PKT_SLEEP_8723D 0x04D4 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0500h ~ 0x05FFh EDCA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_EDCA_VO_PARAM_8723D 0x0500 ++#define REG_EDCA_VI_PARAM_8723D 0x0504 ++#define REG_EDCA_BE_PARAM_8723D 0x0508 ++#define REG_EDCA_BK_PARAM_8723D 0x050C ++#define REG_BCNTCFG_8723D 0x0510 ++#define REG_PIFS_8723D 0x0512 ++#define REG_RDG_PIFS_8723D 0x0513 ++#define REG_SIFS_CTX_8723D 0x0514 ++#define REG_SIFS_TRX_8723D 0x0516 ++#define REG_AGGR_BREAK_TIME_8723D 0x051A ++#define REG_SLOT_8723D 0x051B ++#define REG_TX_PTCL_CTRL_8723D 0x0520 ++#define REG_TXPAUSE_8723D 0x0522 ++#define REG_DIS_TXREQ_CLR_8723D 0x0523 ++#define REG_RD_CTRL_8723D 0x0524 ++/* ++ * Format for offset 540h-542h: ++ * [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. ++ * [7:4]: Reserved. ++ * [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. ++ * [23:20]: Reserved ++ * Description: ++ * | ++ * |<--Setup--|--Hold------------>| ++ * --------------|---------------------- ++ * | ++ * TBTT ++ * Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. ++ * Described by Designer Tim and Bruce, 2011-01-14. ++ * */ ++#define REG_TBTT_PROHIBIT_8723D 0x0540 ++#define REG_RD_NAV_NXT_8723D 0x0544 ++#define REG_NAV_PROT_LEN_8723D 0x0546 ++#define REG_BCN_CTRL_8723D 0x0550 ++#define REG_BCN_CTRL_1_8723D 0x0551 ++#define REG_MBID_NUM_8723D 0x0552 ++#define REG_DUAL_TSF_RST_8723D 0x0553 ++#define REG_BCN_INTERVAL_8723D 0x0554 ++#define REG_DRVERLYINT_8723D 0x0558 ++#define REG_BCNDMATIM_8723D 0x0559 ++#define REG_ATIMWND_8723D 0x055A ++#define REG_USTIME_TSF_8723D 0x055C ++#define REG_BCN_MAX_ERR_8723D 0x055D ++#define REG_RXTSF_OFFSET_CCK_8723D 0x055E ++#define REG_RXTSF_OFFSET_OFDM_8723D 0x055F ++#define REG_TSFTR_8723D 0x0560 ++#define REG_CTWND_8723D 0x0572 ++#define REG_SECONDARY_CCA_CTRL_8723D 0x0577 ++#define REG_PSTIMER_8723D 0x0580 ++#define REG_TIMER0_8723D 0x0584 ++#define REG_TIMER1_8723D 0x0588 ++#define REG_ACMHWCTRL_8723D 0x05C0 ++#define REG_SCH_TXCMD_8723D 0x05F8 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0600h ~ 0x07FFh WMAC Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_MAC_CR_8723D 0x0600 ++#define REG_TCR_8723D 0x0604 ++#define REG_RCR_8723D 0x0608 ++#define REG_RX_PKT_LIMIT_8723D 0x060C ++#define REG_RX_DLK_TIME_8723D 0x060D ++#define REG_RX_DRVINFO_SZ_8723D 0x060F ++ ++#define REG_MACID_8723D 0x0610 ++#define REG_BSSID_8723D 0x0618 ++#define REG_MAR_8723D 0x0620 ++#define REG_MBIDCAMCFG_8723D 0x0628 ++#define REG_WOWLAN_GTK_DBG1 0x630 ++#define REG_WOWLAN_GTK_DBG2 0x634 ++ ++#define REG_USTIME_EDCA_8723D 0x0638 ++#define REG_MAC_SPEC_SIFS_8723D 0x063A ++#define REG_RESP_SIFP_CCK_8723D 0x063C ++#define REG_RESP_SIFS_OFDM_8723D 0x063E ++#define REG_ACKTO_8723D 0x0640 ++#define REG_CTS2TO_8723D 0x0641 ++#define REG_EIFS_8723D 0x0642 ++ ++#define REG_NAV_UPPER_8723D 0x0652 /* unit of 128 */ ++#define REG_TRXPTCL_CTL_8723D 0x0668 ++ ++/* Security */ ++#define REG_CAMCMD_8723D 0x0670 ++#define REG_CAMWRITE_8723D 0x0674 ++#define REG_CAMREAD_8723D 0x0678 ++#define REG_CAMDBG_8723D 0x067C ++#define REG_SECCFG_8723D 0x0680 ++ ++/* Power */ ++#define REG_WOW_CTRL_8723D 0x0690 ++#define REG_PS_RX_INFO_8723D 0x0692 ++#define REG_UAPSD_TID_8723D 0x0693 ++#define REG_WKFMCAM_CMD_8723D 0x0698 ++#define REG_WKFMCAM_NUM_8723D 0x0698 ++#define REG_WKFMCAM_RWD_8723D 0x069C ++#define REG_RXFLTMAP0_8723D 0x06A0 ++#define REG_RXFLTMAP1_8723D 0x06A2 ++#define REG_RXFLTMAP2_8723D 0x06A4 ++#define REG_BCN_PSR_RPT_8723D 0x06A8 ++#define REG_BT_COEX_TABLE_8723D 0x06C0 ++#define REG_BFMER0_INFO_8723D 0x06E4 ++#define REG_BFMER1_INFO_8723D 0x06EC ++#define REG_CSI_RPT_PARAM_BW20_8723D 0x06F4 ++#define REG_CSI_RPT_PARAM_BW40_8723D 0x06F8 ++#define REG_CSI_RPT_PARAM_BW80_8723D 0x06FC ++ ++/* Hardware Port 2 */ ++#define REG_MACID1_8723D 0x0700 ++#define REG_BSSID1_8723D 0x0708 ++#define REG_BFMEE_SEL_8723D 0x0714 ++#define REG_SND_PTCL_CTRL_8723D 0x0718 ++ ++/* LTE_COEX */ ++#define REG_LTECOEX_CTRL 0x07C0 ++#define REG_LTECOEX_WRITE_DATA 0x07C4 ++#define REG_LTECOEX_READ_DATA 0x07C8 ++#define REG_LTECOEX_PATH_CONTROL 0x70 ++ ++/* ************************************************************ ++ * SDIO Bus Specification ++ * ************************************************************ */ ++ ++/* ----------------------------------------------------- ++ * SDIO CMD Address Mapping ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * I/O bus domain (Host) ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * SDIO register ++ * ----------------------------------------------------- */ ++#define SDIO_REG_HCPWM1_8723D 0x025 /* HCI Current Power Mode 1 */ ++#define REG_SDIO_HIMR_8723D 0x10250014 ++#define REG_SDIO_HISR_8723D 0x10250018 ++#define REG_SDIO_RX_REQ_LEN_8723D 0x1025001C ++ ++/* **************************************************************************** ++ * 8723 Regsiter Bit and Content definition ++ * **************************************************************************** */ ++ ++#define BIT_USB_RXDMA_AGG_EN BIT(31) ++#define RXDMA_AGG_MODE_EN BIT(1) ++ ++#ifdef CONFIG_WOWLAN ++ #define RXPKT_RELEASE_POLL BIT(16) ++ #define RXDMA_IDLE BIT(17) ++ #define RW_RELEASE_EN BIT(18) ++#endif ++ ++/* 2 HSISR ++ * interrupt mask which needs to clear */ ++#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ ++ HSISR_SPS_OCP_INT |\ ++ HSISR_RON_INT |\ ++ HSISR_PDNINT |\ ++ HSISR_GPIO9_INT) ++ ++#ifdef CONFIG_RF_POWER_TRIM ++ #ifdef CONFIG_RTL8723D ++ #define EEPROM_RF_GAIN_OFFSET 0xC1 ++ #endif ++ ++ #define EEPROM_RF_GAIN_VAL 0x1F6 ++#endif /*CONFIG_RF_POWER_TRIM*/ ++ ++#ifdef CONFIG_PCI_HCI ++ /* #define IMR_RX_MASK (IMR_ROK_8723D|IMR_RDU_8723D|IMR_RXFOVW_8723D) */ ++ #define IMR_TX_MASK (IMR_VODOK_8723D | IMR_VIDOK_8723D | IMR_BEDOK_8723D | IMR_BKDOK_8723D | IMR_MGNTDOK_8723D | IMR_HIGHDOK_8723D) ++ ++ #define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8723D | IMR_TXBCN0OK_8723D | IMR_TXBCN0ERR_8723D | IMR_BCNDERR0_8723D) ++ ++ #define RT_AC_INT_MASKS (IMR_VIDOK_8723D | IMR_VODOK_8723D | IMR_BEDOK_8723D | IMR_BKDOK_8723D) ++#endif ++ ++/* ******************************************************** ++ * General definitions ++ * ******************************************************** */ ++ ++#define MACID_NUM_8723D 16 ++#define SEC_CAM_ENT_NUM_8723D 32 ++#define HW_PORT_NUM_8723D 3 /*port0, port1, port2*/ ++#define NSS_NUM_8723D 1 ++#define BAND_CAP_8723D (BAND_CAP_2G) ++#define BW_CAP_8723D (BW_CAP_20M | BW_CAP_40M) ++#define PROTO_CAP_8723D (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) ++ ++#endif /* __RTL8723D_SPEC_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_sreset.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_sreset.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_sreset.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,29 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL8723D_SRESET_H_ ++#define _RTL8723D_SRESET_H_ ++ ++#include ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ extern void rtl8723d_sreset_xmit_status_check(_adapter *padapter); ++ extern void rtl8723d_sreset_linked_status_check(_adapter *padapter); ++#endif ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_xmit.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_xmit.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_xmit.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,522 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8723D_XMIT_H__ ++#define __RTL8723D_XMIT_H__ ++ ++ ++#define MAX_TID (15) ++ ++ ++#ifndef __INC_HAL8723DDESC_H ++#define __INC_HAL8723DDESC_H ++ ++#define RX_STATUS_DESC_SIZE_8723D 24 ++#define RX_DRV_INFO_SIZE_UNIT_8723D 8 ++ ++ ++/* DWORD 0 */ ++#define SET_RX_STATUS_DESC_PKT_LEN_8723D(__pRxStatusDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) ++#define SET_RX_STATUS_DESC_EOR_8723D(__pRxStatusDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) ++#define SET_RX_STATUS_DESC_OWN_8723D(__pRxStatusDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) ++ ++#define GET_RX_STATUS_DESC_PKT_LEN_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) ++#define GET_RX_STATUS_DESC_CRC32_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) ++#define GET_RX_STATUS_DESC_ICV_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) ++#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) ++#define GET_RX_STATUS_DESC_SECURITY_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) ++#define GET_RX_STATUS_DESC_QOS_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) ++#define GET_RX_STATUS_DESC_SHIFT_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) ++#define GET_RX_STATUS_DESC_PHY_STATUS_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) ++#define GET_RX_STATUS_DESC_SWDEC_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) ++#define GET_RX_STATUS_DESC_EOR_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) ++#define GET_RX_STATUS_DESC_OWN_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) ++ ++/* DWORD 1 */ ++#define GET_RX_STATUS_DESC_MACID_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) ++#define GET_RX_STATUS_DESC_TID_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) ++#define GET_RX_STATUS_DESC_AMSDU_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) ++#define GET_RX_STATUS_DESC_RXID_MATCH_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) ++#define GET_RX_STATUS_DESC_PAGGR_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) ++#define GET_RX_STATUS_DESC_A1_FIT_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) ++#define GET_RX_STATUS_DESC_CHKERR_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) ++#define GET_RX_STATUS_DESC_IPVER_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) ++#define GET_RX_STATUS_DESC_IS_TCPUDP__8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) ++#define GET_RX_STATUS_DESC_CHK_VLD_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) ++#define GET_RX_STATUS_DESC_PAM_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) ++#define GET_RX_STATUS_DESC_PWR_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) ++#define GET_RX_STATUS_DESC_MORE_DATA_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) ++#define GET_RX_STATUS_DESC_MORE_FRAG_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) ++#define GET_RX_STATUS_DESC_TYPE_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) ++#define GET_RX_STATUS_DESC_MC_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) ++#define GET_RX_STATUS_DESC_BC_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) ++ ++/* DWORD 2 */ ++#define GET_RX_STATUS_DESC_SEQ_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) ++#define GET_RX_STATUS_DESC_FRAG_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) ++#define GET_RX_STATUS_DESC_RX_IS_QOS_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) ++#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) ++#define GET_RX_STATUS_DESC_RPT_SEL_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) ++#define GET_RX_STATUS_DESC_FCS_OK_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 31, 1) ++ ++/* DWORD 3 */ ++#define GET_RX_STATUS_DESC_RX_RATE_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) ++#define GET_RX_STATUS_DESC_HTC_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) ++#define GET_RX_STATUS_DESC_EOSP_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) ++#define GET_RX_STATUS_DESC_BSSID_FIT_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) ++#ifdef CONFIG_USB_RX_AGGREGATION ++#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) ++#endif ++#define GET_RX_STATUS_DESC_PATTERN_MATCH_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) ++#define GET_RX_STATUS_DESC_UNICAST_MATCH_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) ++#define GET_RX_STATUS_DESC_MAGIC_MATCH_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) ++ ++/* DWORD 6 */ ++#define GET_RX_STATUS_DESC_MATCH_ID_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 7) ++ ++/* DWORD 5 */ ++#define GET_RX_STATUS_DESC_TSFL_8723D(__pRxStatusDesc) \ ++ LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) ++ ++#define GET_RX_STATUS_DESC_BUFF_ADDR_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) ++#define GET_RX_STATUS_DESC_BUFF_ADDR64_8723D(__pRxDesc) \ ++ LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) ++ ++#define SET_RX_STATUS_DESC_BUFF_ADDR_8723D(__pRxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) ++ ++ ++/* Dword 0, rsvd: bit26, bit28 */ ++#define GET_TX_DESC_OWN_8723D(__pTxDesc)\ ++ LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) ++ ++#define SET_TX_DESC_PKT_SIZE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) ++#define SET_TX_DESC_OFFSET_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) ++#define SET_TX_DESC_BMC_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) ++#define SET_TX_DESC_HTC_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) ++#define SET_TX_DESC_AMSDU_PAD_EN_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) ++#define SET_TX_DESC_NO_ACM_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) ++#define SET_TX_DESC_GF_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) ++ ++/* Dword 1 */ ++#define SET_TX_DESC_MACID_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) ++#define SET_TX_DESC_QUEUE_SEL_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) ++#define SET_TX_DESC_RDG_NAV_EXT_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) ++#define SET_TX_DESC_LSIG_TXOP_EN_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) ++#define SET_TX_DESC_PIFS_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) ++#define SET_TX_DESC_RATE_ID_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) ++#define SET_TX_DESC_EN_DESC_ID_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) ++#define SET_TX_DESC_SEC_TYPE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) ++#define SET_TX_DESC_PKT_OFFSET_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) ++#define SET_TX_DESC_MORE_DATA_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 29, 1, __Value) ++ ++/* Dword 2 remove P_AID, G_ID field*/ ++#define SET_TX_DESC_CCA_RTS_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) ++#define SET_TX_DESC_AGG_ENABLE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) ++#define SET_TX_DESC_RDG_ENABLE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) ++#define SET_TX_DESC_NULL0_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 14, 1, __Value) ++#define SET_TX_DESC_NULL1_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 15, 1, __Value) ++#define SET_TX_DESC_BK_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) ++#define SET_TX_DESC_MORE_FRAG_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) ++#define SET_TX_DESC_RAW_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) ++#define SET_TX_DESC_CCX_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) ++#define SET_TX_DESC_AMPDU_DENSITY_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) ++#define SET_TX_DESC_BT_INT_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) ++#define SET_TX_DESC_FTM_EN_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 30, 1, __Value) ++ ++/* Dword 3 */ ++#define SET_TX_DESC_NAV_USE_HDR_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) ++#define SET_TX_DESC_HWSEQ_SEL_8723D(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) ++#define SET_TX_DESC_USE_RATE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) ++#define SET_TX_DESC_DISABLE_RTS_FB_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) ++#define SET_TX_DESC_DISABLE_FB_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) ++#define SET_TX_DESC_CTS2SELF_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) ++#define SET_TX_DESC_RTS_ENABLE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) ++#define SET_TX_DESC_HW_RTS_ENABLE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) ++#define SET_TX_DESC_PORT_ID_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 14, 2, __Value) ++#define SET_TX_DESC_USE_MAX_LEN_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) ++#define SET_TX_DESC_MAX_AGG_NUM_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) ++#define SET_TX_DESC_AMPDU_MAX_TIME_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) ++ ++/* Dword 4 */ ++#define SET_TX_DESC_TX_RATE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) ++#define SET_TX_DESC_TX_TRY_RATE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 7, 1, __Value) ++#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) ++#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) ++#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) ++#define SET_TX_DESC_DATA_RETRY_LIMIT_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) ++#define SET_TX_DESC_RTS_RATE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) ++#define SET_TX_DESC_PCTS_EN_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 29, 1, __Value) ++#define SET_TX_DESC_PCTS_MASK_IDX_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 30, 2, __Value) ++ ++/* Dword 5 */ ++#define SET_TX_DESC_DATA_SC_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) ++#define SET_TX_DESC_DATA_SHORT_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) ++#define SET_TX_DESC_DATA_BW_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) ++#define SET_TX_DESC_DATA_STBC_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) ++#define SET_TX_DESC_RTS_STBC_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) ++#define SET_TX_DESC_RTS_SHORT_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) ++#define SET_TX_DESC_RTS_SC_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) ++#define SET_TX_DESC_PATH_A_EN_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 1, __Value) ++#define SET_TX_DESC_TXPWR_OF_SET_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 28, 3, __Value) ++ ++/* Dword 6 */ ++#define SET_TX_DESC_SW_DEFINE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) ++#define SET_TX_DESC_MBSSID_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) ++#define SET_TX_DESC_RF_SEL_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) ++ ++/* Dword 7 */ ++#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++#define SET_TX_DESC_TX_BUFFER_SIZE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++#elif(DEV_BUS_TYPE == RT_USB_INTERFACE) ++#define SET_TX_DESC_TX_DESC_CHECKSUM_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++#else ++#define SET_TX_DESC_TX_TIMESTAMP_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 6, 18, __Value) ++#endif ++ ++#define SET_TX_DESC_USB_TXAGG_NUM_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) ++ ++/* Dword 8 */ ++#define SET_TX_DESC_RTS_RC_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 6, __Value) ++#define SET_TX_DESC_BAR_RC_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 6, 2, __Value) ++#define SET_TX_DESC_DATA_RC_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 8, 6, __Value) ++#define SET_TX_DESC_HWSEQ_EN_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) ++#define SET_TX_DESC_NEXTHEADPAGE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) ++#define SET_TX_DESC_TAILPAGE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 24, 8, __Value) ++ ++/* Dword 9 */ ++#define SET_TX_DESC_PADDING_LEN_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 11, __Value) ++#define SET_TX_DESC_SEQ_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) ++#define SET_TX_DESC_FINAL_DATA_RATE_8723D(__pTxDesc, __Value) \ ++ SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 24, 8, __Value) ++ ++ ++#define SET_EARLYMODE_PKTNUM_8723D(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) ++#define SET_EARLYMODE_LEN0_8723D(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) ++#define SET_EARLYMODE_LEN1_1_8723D(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) ++#define SET_EARLYMODE_LEN1_2_8723D(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) ++#define SET_EARLYMODE_LEN2_8723D(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) ++#define SET_EARLYMODE_LEN3_8723D(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) ++ ++ ++/*-----------------------------------------------------------------*/ ++/* RTL8723D TX BUFFER DESC */ ++/*-----------------------------------------------------------------*/ ++#ifdef CONFIG_64BIT_DMA ++ #define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 0, 16, __Valeu) ++ #define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 31, 1, __Valeu) ++ #define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+4, 0, 32, __Valeu) ++ #define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+8, 0, 32, __Valeu) ++#else ++ #define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 0, 16, __Valeu) ++ #define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 31, 1, __Valeu) ++ #define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8)+4, 0, 32, __Valeu) ++ #define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) /* 64 BIT mode only */ ++#endif ++/* ********************************************************* */ ++ ++/* 64 bits -- 32 bits */ ++/* ======= ======= */ ++/* Dword 0 0 */ ++#define SET_TX_BUFF_DESC_LEN_0_8723D(__pTxDesc, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 14, __Valeu) ++#define SET_TX_BUFF_DESC_PSB_8723D(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 15, __Value) ++#define SET_TX_BUFF_DESC_OWN_8723D(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) ++ ++/* Dword 1 1 */ ++#define SET_TX_BUFF_DESC_ADDR_LOW_0_8723D(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 32, __Value) ++#define GET_TX_BUFF_DESC_ADDR_LOW_0_8723D(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+4, 0, 32) ++/* Dword 2 NA */ ++#define SET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 0, __Value) ++#ifdef CONFIG_64BIT_DMA ++ #define GET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+8, 0, 32) ++#else ++ #define GET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(__pTxDesc) 0 ++#endif ++/* Dword 3 NA */ ++/* RESERVED 0 */ ++/* Dword 4 2 */ ++#define SET_TX_BUFF_DESC_LEN_1_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 1, __Value) ++#define SET_TX_BUFF_DESC_AMSDU_1_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 1, __Value) ++/* Dword 5 3 */ ++#define SET_TX_BUFF_DESC_ADDR_LOW_1_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 1, __Value) ++/* Dword 6 NA */ ++#define SET_TX_BUFF_DESC_ADDR_HIGH_1_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 1, __Value) ++/* Dword 7 NA */ ++/*RESERVED 0 */ ++/* Dword 8 4 */ ++#define SET_TX_BUFF_DESC_LEN_2_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 2, __Value) ++#define SET_TX_BUFF_DESC_AMSDU_2_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 2, __Value) ++/* Dword 9 5 */ ++#define SET_TX_BUFF_DESC_ADDR_LOW_2_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 2, __Value) ++/* Dword 10 NA */ ++#define SET_TX_BUFF_DESC_ADDR_HIGH_2_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 2, __Value) ++/* Dword 11 NA */ ++/*RESERVED 0 */ ++/* Dword 12 6 */ ++#define SET_TX_BUFF_DESC_LEN_3_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 3, __Value) ++#define SET_TX_BUFF_DESC_AMSDU_3_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 3, __Value) ++/* Dword 13 7 */ ++#define SET_TX_BUFF_DESC_ADDR_LOW_3_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 3, __Value) ++/* Dword 14 NA */ ++#define SET_TX_BUFF_DESC_ADDR_HIGH_3_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 3, __Value) ++/* Dword 15 NA */ ++/*RESERVED 0 */ ++ ++ ++#endif ++/* ----------------------------------------------------------- ++ * ++ * Rate ++ * ++ * ----------------------------------------------------------- ++ * CCK Rates, TxHT = 0 */ ++#define DESC8723D_RATE1M 0x00 ++#define DESC8723D_RATE2M 0x01 ++#define DESC8723D_RATE5_5M 0x02 ++#define DESC8723D_RATE11M 0x03 ++ ++/* OFDM Rates, TxHT = 0 */ ++#define DESC8723D_RATE6M 0x04 ++#define DESC8723D_RATE9M 0x05 ++#define DESC8723D_RATE12M 0x06 ++#define DESC8723D_RATE18M 0x07 ++#define DESC8723D_RATE24M 0x08 ++#define DESC8723D_RATE36M 0x09 ++#define DESC8723D_RATE48M 0x0a ++#define DESC8723D_RATE54M 0x0b ++ ++/* MCS Rates, TxHT = 1 */ ++#define DESC8723D_RATEMCS0 0x0c ++#define DESC8723D_RATEMCS1 0x0d ++#define DESC8723D_RATEMCS2 0x0e ++#define DESC8723D_RATEMCS3 0x0f ++#define DESC8723D_RATEMCS4 0x10 ++#define DESC8723D_RATEMCS5 0x11 ++#define DESC8723D_RATEMCS6 0x12 ++#define DESC8723D_RATEMCS7 0x13 ++#define DESC8723D_RATEMCS8 0x14 ++#define DESC8723D_RATEMCS9 0x15 ++#define DESC8723D_RATEMCS10 0x16 ++#define DESC8723D_RATEMCS11 0x17 ++#define DESC8723D_RATEMCS12 0x18 ++#define DESC8723D_RATEMCS13 0x19 ++#define DESC8723D_RATEMCS14 0x1a ++#define DESC8723D_RATEMCS15 0x1b ++#define DESC8723D_RATEVHTSS1MCS0 0x2c ++#define DESC8723D_RATEVHTSS1MCS1 0x2d ++#define DESC8723D_RATEVHTSS1MCS2 0x2e ++#define DESC8723D_RATEVHTSS1MCS3 0x2f ++#define DESC8723D_RATEVHTSS1MCS4 0x30 ++#define DESC8723D_RATEVHTSS1MCS5 0x31 ++#define DESC8723D_RATEVHTSS1MCS6 0x32 ++#define DESC8723D_RATEVHTSS1MCS7 0x33 ++#define DESC8723D_RATEVHTSS1MCS8 0x34 ++#define DESC8723D_RATEVHTSS1MCS9 0x35 ++#define DESC8723D_RATEVHTSS2MCS0 0x36 ++#define DESC8723D_RATEVHTSS2MCS1 0x37 ++#define DESC8723D_RATEVHTSS2MCS2 0x38 ++#define DESC8723D_RATEVHTSS2MCS3 0x39 ++#define DESC8723D_RATEVHTSS2MCS4 0x3a ++#define DESC8723D_RATEVHTSS2MCS5 0x3b ++#define DESC8723D_RATEVHTSS2MCS6 0x3c ++#define DESC8723D_RATEVHTSS2MCS7 0x3d ++#define DESC8723D_RATEVHTSS2MCS8 0x3e ++#define DESC8723D_RATEVHTSS2MCS9 0x3f ++ ++ ++#define RX_HAL_IS_CCK_RATE_8723D(pDesc)\ ++ (GET_RX_STATUS_DESC_RX_RATE_8723D(pDesc) == DESC8723D_RATE1M || \ ++ GET_RX_STATUS_DESC_RX_RATE_8723D(pDesc) == DESC8723D_RATE2M || \ ++ GET_RX_STATUS_DESC_RX_RATE_8723D(pDesc) == DESC8723D_RATE5_5M || \ ++ GET_RX_STATUS_DESC_RX_RATE_8723D(pDesc) == DESC8723D_RATE11M) ++ ++#ifdef CONFIG_TRX_BD_ARCH ++ struct tx_desc; ++#endif ++ ++void rtl8723d_cal_txdesc_chksum(struct tx_desc *ptxdesc); ++void rtl8723d_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); ++void rtl8723d_fill_txdesc_sectype(struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); ++void rtl8723d_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); ++void rtl8723d_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); ++void rtl8723d_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); ++ ++#if defined(CONFIG_CONCURRENT_MODE) ++ void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); ++#endif ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ s32 rtl8723ds_init_xmit_priv(PADAPTER padapter); ++ void rtl8723ds_free_xmit_priv(PADAPTER padapter); ++ s32 rtl8723ds_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8723ds_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8723ds_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8723ds_xmit_buf_handler(PADAPTER padapter); ++ thread_return rtl8723ds_xmit_thread(thread_context context); ++ #define hal_xmit_handler rtl8723ds_xmit_buf_handler ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ s32 rtl8723du_xmit_buf_handler(PADAPTER padapter); ++ #define hal_xmit_handler rtl8723du_xmit_buf_handler ++ s32 rtl8723du_init_xmit_priv(PADAPTER padapter); ++ void rtl8723du_free_xmit_priv(PADAPTER padapter); ++ s32 rtl8723du_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8723du_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8723du_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ void rtl8723du_xmit_tasklet(void *priv); ++ s32 rtl8723du_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++ void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, struct tx_desc *ptxdesc); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ s32 rtl8723de_init_xmit_priv(PADAPTER padapter); ++ void rtl8723de_free_xmit_priv(PADAPTER padapter); ++ struct xmit_buf *rtl8723de_dequeue_xmitbuf(struct rtw_tx_ring *ring); ++ void rtl8723de_xmitframe_resume(_adapter *padapter); ++ s32 rtl8723de_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8723de_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8723de_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ void rtl8723de_xmit_tasklet(void *priv); ++#endif ++ ++u8 BWMapping_8723D(PADAPTER Adapter, struct pkt_attrib *pattrib); ++u8 SCMapping_8723D(PADAPTER Adapter, struct pkt_attrib *pattrib); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_cmd.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_cmd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_cmd.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,172 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8812A_CMD_H__ ++#define __RTL8812A_CMD_H__ ++ ++typedef enum _RTL8812_H2C_CMD { ++ H2C_8812_RSVDPAGE = 0, ++ H2C_8812_MSRRPT = 1, ++ H2C_8812_SCAN = 2, ++ H2C_8812_KEEP_ALIVE_CTRL = 3, ++ H2C_8812_DISCONNECT_DECISION = 4, ++ ++ H2C_8812_INIT_OFFLOAD = 6, ++ H2C_8812_AP_OFFLOAD = 8, ++ H2C_8812_BCN_RSVDPAGE = 9, ++ H2C_8812_PROBERSP_RSVDPAGE = 10, ++ ++ H2C_8812_SETPWRMODE = 0x20, ++ H2C_8812_PS_TUNING_PARA = 0x21, ++ H2C_8812_PS_TUNING_PARA2 = 0x22, ++ H2C_8812_PS_LPS_PARA = 0x23, ++ H2C_8812_P2P_PS_OFFLOAD = 0x24, ++ H2C_8812_INACTIVE_PS = 0x27, ++ H2C_8812_RA_MASK = 0x40, ++ H2C_8812_TxBF = 0x41, ++ H2C_8812_RSSI_REPORT = 0x42, ++ H2C_8812_IQ_CALIBRATION = 0x45, ++ H2C_8812_RA_PARA_ADJUST = 0x46, ++ ++ H2C_8812_BT_FW_PATCH = 0x6a, ++ ++ H2C_8812_WO_WLAN = 0x80, ++ H2C_8812_REMOTE_WAKE_CTRL = 0x81, ++ H2C_8812_AOAC_GLOBAL_INFO = 0x82, ++ H2C_8812_AOAC_RSVDPAGE = 0x83, ++ H2C_8812_FW_SWCHANNL = 0x87, ++ ++ H2C_8812_TSF_RESET = 0xC0, ++ ++ MAX_8812_H2CCMD ++} RTL8812_H2C_CMD; ++ ++struct cmd_msg_parm { ++ u8 eid; /* element id */ ++ u8 sz; /* sz */ ++ u8 buf[6]; ++}; ++ ++enum { ++ PWRS ++}; ++ ++struct H2C_SS_RFOFF_PARAM { ++ u8 ROFOn; /* 1: on, 0:off */ ++ u16 gpio_period; /* unit: 1024 us */ ++} __attribute__((packed)); ++ ++ ++ ++/* _RSVDPAGE_LOC_CMD0 */ ++#define SET_8812_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8812_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_8812_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8812_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8812_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++ ++/* _SETPWRMODE_PARM */ ++#define SET_8812_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8812_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) ++#define SET_8812_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) ++#define SET_8812_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8812_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8812_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) ++#define SET_8812_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#define SET_8812_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++ ++#define GET_8812_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) ++ ++/* _P2P_PS_OFFLOAD */ ++#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_CTWINDOW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) ++#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) ++#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) ++#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) ++ ++ ++void Set_RA_LDPC_8812(struct sta_info *psta, BOOLEAN bLDPC); ++ ++/* host message to firmware cmd */ ++s32 FillH2CCmd_8812(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); ++void rtl8812_set_FwPwrMode_cmd(PADAPTER padapter, u8 PSMode); ++void rtl8812_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); ++u8 rtl8812_set_rssi_cmd(PADAPTER padapter, u8 *param); ++void rtl8812_set_raid_cmd(PADAPTER padapter, u32 bitmap, u8 *arg, u8 bw); ++void rtl8812_set_wowlan_cmd(_adapter *padapter, u8 enable); ++s32 FillH2CCmd_8812(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); ++u8 GetTxBufferRsvdPageNum8812(_adapter *padapter, bool wowlan); ++ ++#ifdef CONFIG_BT_COEXIST ++void rtl8812a_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); ++#endif /* CONFIG_BT_COEXIST */ ++#ifdef CONFIG_P2P_PS ++void rtl8812_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); ++#endif /* CONFIG_P2P */ ++ ++#ifdef CONFIG_FWLPS_IN_IPS ++void rtl8812_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); ++#endif ++ ++void CheckFwRsvdPageContent(PADAPTER padapter); ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_TDLS_CH_SW ++void rtl8812_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); ++#endif ++#endif ++ ++#ifdef CONFIG_TSF_RESET_OFFLOAD ++int reset_tsf(PADAPTER Adapter, u8 reset_port); ++#endif /* CONFIG_TSF_RESET_OFFLOAD */ ++ ++/* ------------------------------------ ++ * C2H format ++ * ------------------------------------ */ ++ ++/* TX Beamforming */ ++#define GET_8812_C2H_TXBF_ORIGINATE(_Header) LE_BITS_TO_1BYTE(_Header, 0, 8) ++#define GET_8812_C2H_TXBF_MACID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) ++ ++ ++ ++/* / TX Feedback Content */ ++#define USEC_UNIT_FOR_8812_C2H_TX_RPT_QUEUE_TIME 256 ++ ++#define GET_8812_C2H_TX_RPT_QUEUE_SELECT(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 5) ++#define GET_8812_C2H_TX_RPT_PKT_BROCAST(_Header) LE_BITS_TO_1BYTE((_Header + 0), 5, 1) ++#define GET_8812_C2H_TX_RPT_LIFE_TIME_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 6, 1) ++#define GET_8812_C2H_TX_RPT_RETRY_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 7, 1) ++#define GET_8812_C2H_TX_RPT_MAC_ID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) ++#define GET_8812_C2H_TX_RPT_DATA_RETRY_CNT(_Header) LE_BITS_TO_1BYTE((_Header + 2), 0, 6) ++#define GET_8812_C2H_TX_RPT_QUEUE_TIME(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) /* In unit of 256 microseconds. */ ++#define GET_8812_C2H_TX_RPT_FINAL_DATA_RATE(_Header) LE_BITS_TO_1BYTE((_Header + 5), 0, 8) ++ ++/* BT_FW_PATCH */ ++#define SET_8812_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) ++#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+4, 0, 8, __Value) ++#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+5, 0, 8, __Value) ++ ++s32 c2h_handler_8812a(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); ++ ++#endif/* __RTL8812A_CMD_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_dm.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_dm.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_dm.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,32 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8812A_DM_H__ ++#define __RTL8812A_DM_H__ ++ ++void rtl8812_init_dm_priv(IN PADAPTER Adapter); ++void rtl8812_deinit_dm_priv(IN PADAPTER Adapter); ++void rtl8812_InitHalDm(IN PADAPTER Adapter); ++void rtl8812_HalDmWatchDog(IN PADAPTER Adapter); ++ ++/* VOID rtl8192c_dm_CheckTXPowerTracking(IN PADAPTER Adapter); */ ++ ++/* void rtl8192c_dm_RF_Saving(IN PADAPTER pAdapter, IN u8 bForceInNormal); */ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_hal.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,348 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8812A_HAL_H__ ++#define __RTL8812A_HAL_H__ ++ ++/* #include "hal_com.h" */ ++#include "hal_data.h" ++ ++/* include HAL Related header after HAL Related compiling flags */ ++#include "rtl8812a_spec.h" ++#include "rtl8812a_rf.h" ++#include "rtl8812a_dm.h" ++#include "rtl8812a_recv.h" ++#include "rtl8812a_xmit.h" ++#include "rtl8812a_cmd.h" ++#include "rtl8812a_led.h" ++#include "Hal8812PwrSeq.h" ++#include "Hal8821APwrSeq.h" /* for 8821A/8811A */ ++#include "Hal8812PhyReg.h" ++#include "Hal8812PhyCfg.h" ++#ifdef DBG_CONFIG_ERROR_DETECT ++#include "rtl8812a_sreset.h" ++#endif ++ ++/* --------------------------------------------------------------------- ++ * RTL8812 Power Configuration CMDs for PCIe interface ++ * --------------------------------------------------------------------- */ ++#define Rtl8812_NIC_PWR_ON_FLOW rtl8812_power_on_flow ++#define Rtl8812_NIC_RF_OFF_FLOW rtl8812_radio_off_flow ++#define Rtl8812_NIC_DISABLE_FLOW rtl8812_card_disable_flow ++#define Rtl8812_NIC_ENABLE_FLOW rtl8812_card_enable_flow ++#define Rtl8812_NIC_SUSPEND_FLOW rtl8812_suspend_flow ++#define Rtl8812_NIC_RESUME_FLOW rtl8812_resume_flow ++#define Rtl8812_NIC_PDN_FLOW rtl8812_hwpdn_flow ++#define Rtl8812_NIC_LPS_ENTER_FLOW rtl8812_enter_lps_flow ++#define Rtl8812_NIC_LPS_LEAVE_FLOW rtl8812_leave_lps_flow ++ ++/* --------------------------------------------------------------------- ++ * RTL8821 Power Configuration CMDs for PCIe interface ++ * --------------------------------------------------------------------- */ ++#define Rtl8821A_NIC_PWR_ON_FLOW rtl8821A_power_on_flow ++#define Rtl8821A_NIC_RF_OFF_FLOW rtl8821A_radio_off_flow ++#define Rtl8821A_NIC_DISABLE_FLOW rtl8821A_card_disable_flow ++#define Rtl8821A_NIC_ENABLE_FLOW rtl8821A_card_enable_flow ++#define Rtl8821A_NIC_SUSPEND_FLOW rtl8821A_suspend_flow ++#define Rtl8821A_NIC_RESUME_FLOW rtl8821A_resume_flow ++#define Rtl8821A_NIC_PDN_FLOW rtl8821A_hwpdn_flow ++#define Rtl8821A_NIC_LPS_ENTER_FLOW rtl8821A_enter_lps_flow ++#define Rtl8821A_NIC_LPS_LEAVE_FLOW rtl8821A_leave_lps_flow ++ ++ ++#if 1 /* download firmware related data structure */ ++#define FW_SIZE_8812 0x8000 /* Compatible with RTL8723 Maximal RAM code size 24K. modified to 32k, TO compatible with 92d maximal fw size 32k */ ++#define FW_START_ADDRESS 0x1000 ++#define FW_END_ADDRESS 0x5FFF ++ ++ ++ ++typedef struct _RT_FIRMWARE_8812 { ++ FIRMWARE_SOURCE eFWSource; ++#ifdef CONFIG_EMBEDDED_FWIMG ++ u8 *szFwBuffer; ++#else ++ u8 szFwBuffer[FW_SIZE_8812]; ++#endif ++ u32 ulFwLength; ++} RT_FIRMWARE_8812, *PRT_FIRMWARE_8812; ++ ++/* ++ * This structure must be cared byte-ordering ++ * ++ * Added by tynli. 2009.12.04. */ ++#define IS_FW_HEADER_EXIST_8812(_pFwHdr) ((GET_FIRMWARE_HDR_SIGNATURE_8812(_pFwHdr) & 0xFFF0) == 0x9500) ++ ++#define IS_FW_HEADER_EXIST_8821(_pFwHdr) ((GET_FIRMWARE_HDR_SIGNATURE_8812(_pFwHdr) & 0xFFF0) == 0x2100) ++/* ***************************************************** ++ * Firmware Header(8-byte alinment required) ++ * ***************************************************** ++ * --- LONG WORD 0 ---- */ ++#define GET_FIRMWARE_HDR_SIGNATURE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 0, 16) /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ ++#define GET_FIRMWARE_HDR_CATEGORY_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 16, 8) /* AP/NIC and USB/PCI */ ++#define GET_FIRMWARE_HDR_FUNCTION_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 24, 8) /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ ++#define GET_FIRMWARE_HDR_VERSION_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 0, 16)/* FW Version */ ++#define GET_FIRMWARE_HDR_SUB_VER_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 16, 8) /* FW Subversion, default 0x00 */ ++#define GET_FIRMWARE_HDR_RSVD1_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 24, 8) ++ ++/* --- LONG WORD 1 ---- */ ++#define GET_FIRMWARE_HDR_MONTH_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 0, 8) /* Release time Month field */ ++#define GET_FIRMWARE_HDR_DATE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 8, 8) /* Release time Date field */ ++#define GET_FIRMWARE_HDR_HOUR_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 16, 8)/* Release time Hour field */ ++#define GET_FIRMWARE_HDR_MINUTE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 24, 8)/* Release time Minute field */ ++#define GET_FIRMWARE_HDR_ROMCODE_SIZE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 0, 16)/* The size of RAM code */ ++#define GET_FIRMWARE_HDR_RSVD2_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 16, 16) ++ ++/* --- LONG WORD 2 ---- */ ++#define GET_FIRMWARE_HDR_SVN_IDX_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 0, 32)/* The SVN entry index */ ++#define GET_FIRMWARE_HDR_RSVD3_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 0, 32) ++ ++/* --- LONG WORD 3 ---- */ ++#define GET_FIRMWARE_HDR_RSVD4_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 0, 32) ++#define GET_FIRMWARE_HDR_RSVD5_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+28, 0, 32) ++ ++#endif /* download firmware related data structure */ ++ ++ ++#define DRIVER_EARLY_INT_TIME_8812 0x05 ++#define BCN_DMA_ATIME_INT_TIME_8812 0x02 ++ ++/* for 8812 ++ * TX 128K, RX 16K, Page size 512B for TX, 128B for RX */ ++#define MAX_RX_DMA_BUFFER_SIZE_8812 0x3E80 /* RX 16K */ ++ ++#ifdef CONFIG_WOWLAN ++ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ ++#else ++ #define RESV_FMWF 0 ++#endif ++ ++#ifdef CONFIG_FW_C2H_DEBUG ++ #define RX_DMA_RESERVED_SIZE_8812 0x100 /* 256B, reserved for c2h debug message */ ++#else ++ #define RX_DMA_RESERVED_SIZE_8812 0x0 /* 0B */ ++#endif ++#define RX_DMA_BOUNDARY_8812 (MAX_RX_DMA_BUFFER_SIZE_8812 - RX_DMA_RESERVED_SIZE_8812 - 1) ++ ++#define BCNQ_PAGE_NUM_8812 0x07 ++ ++/* For WoWLan , more reserved page ++ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:1,GTK EXT MEM:1, PNO: 6 */ ++#ifdef CONFIG_WOWLAN ++ #define WOWLAN_PAGE_NUM_8812 0x05 ++#else ++ #define WOWLAN_PAGE_NUM_8812 0x00 ++#endif ++ ++ ++#ifdef CONFIG_BEAMFORMER_FW_NDPA ++ #define FW_NDPA_PAGE_NUM 0x02 ++#else ++ #define FW_NDPA_PAGE_NUM 0x00 ++#endif ++ ++#define TX_TOTAL_PAGE_NUMBER_8812 (0xFF - BCNQ_PAGE_NUM_8812 - WOWLAN_PAGE_NUM_8812-FW_NDPA_PAGE_NUM) ++#define TX_PAGE_BOUNDARY_8812 (TX_TOTAL_PAGE_NUMBER_8812 + 1) ++ ++#define TX_PAGE_BOUNDARY_WOWLAN_8812 (0xFF - BCNQ_PAGE_NUM_8812 - WOWLAN_PAGE_NUM_8812 + 1) ++ ++#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8812 TX_TOTAL_PAGE_NUMBER_8812 ++#define WMM_NORMAL_TX_PAGE_BOUNDARY_8812 (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8812 + 1) ++ ++/* For Normal Chip Setting ++ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8812 */ ++#define NORMAL_PAGE_NUM_LPQ_8812 0x10 ++#define NORMAL_PAGE_NUM_HPQ_8812 0x10 ++#define NORMAL_PAGE_NUM_NPQ_8812 0x00 ++ ++#define WMM_NORMAL_PAGE_NUM_HPQ_8812 0x30 ++#define WMM_NORMAL_PAGE_NUM_LPQ_8812 0x20 ++#define WMM_NORMAL_PAGE_NUM_NPQ_8812 0x20 ++ ++ ++/* for 8821A ++ * TX 64K, RX 16K, Page size 256B for TX, 128B for RX */ ++#define PAGE_SIZE_TX_8821A 256 ++#define PAGE_SIZE_RX_8821A 128 ++ ++#define MAX_RX_DMA_BUFFER_SIZE_8821 0x3E80 /* RX 16K */ ++ ++#ifdef CONFIG_FW_C2H_DEBUG ++ #define RX_DMA_RESERVED_SIZE_8821 0x100 /* 256B, reserved for c2h debug message */ ++#else ++ #define RX_DMA_RESERVED_SIZE_8821 0x0 /* 0B */ ++#endif ++#define RX_DMA_BOUNDARY_8821 (MAX_RX_DMA_BUFFER_SIZE_8821 - RX_DMA_RESERVED_SIZE_8821 - 1) ++ ++#define BCNQ_PAGE_NUM_8821 0x08 ++#ifdef CONFIG_CONCURRENT_MODE ++ #define BCNQ1_PAGE_NUM_8821 0x04 ++#else ++ #define BCNQ1_PAGE_NUM_8821 0x00 ++#endif ++ ++/* For WoWLan , more reserved page ++ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:1,GTK EXT MEM:1, PNO: 6 */ ++#ifdef CONFIG_WOWLAN ++ #define WOWLAN_PAGE_NUM_8821 0x06 ++#else ++ #define WOWLAN_PAGE_NUM_8821 0x00 ++#endif ++ ++#define TX_TOTAL_PAGE_NUMBER_8821 (0xFF - BCNQ_PAGE_NUM_8821 - BCNQ1_PAGE_NUM_8821 - WOWLAN_PAGE_NUM_8821) ++#define TX_PAGE_BOUNDARY_8821 (TX_TOTAL_PAGE_NUMBER_8821 + 1) ++/* #define TX_PAGE_BOUNDARY_WOWLAN_8821 0xE0 */ ++ ++#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8821 TX_TOTAL_PAGE_NUMBER_8821 ++#define WMM_NORMAL_TX_PAGE_BOUNDARY_8821 (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8821 + 1) ++ ++ ++/* (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER */ ++#define NORMAL_PAGE_NUM_LPQ_8821 0x08/* 0x10 */ ++#define NORMAL_PAGE_NUM_HPQ_8821 0x08/* 0x10 */ ++#define NORMAL_PAGE_NUM_NPQ_8821 0x00 ++ ++#define WMM_NORMAL_PAGE_NUM_HPQ_8821 0x30 ++#define WMM_NORMAL_PAGE_NUM_LPQ_8821 0x20 ++#define WMM_NORMAL_PAGE_NUM_NPQ_8821 0x20 ++ ++#define MCC_NORMAL_PAGE_NUM_HPQ_8821 0x10 ++#define MCC_NORMAL_PAGE_NUM_LPQ_8821 0x10 ++#define MCC_NORMAL_PAGE_NUM_NPQ_8821 0x10 ++ ++#define EFUSE_HIDDEN_812AU 0 ++#define EFUSE_HIDDEN_812AU_VS 1 ++#define EFUSE_HIDDEN_812AU_VL 2 ++#define EFUSE_HIDDEN_812AU_VN 3 ++ ++#if 0 ++#define EFUSE_REAL_CONTENT_LEN_JAGUAR 1024 ++#define HWSET_MAX_SIZE_JAGUAR 1024 ++#else ++#define EFUSE_REAL_CONTENT_LEN_JAGUAR 512 ++#define HWSET_MAX_SIZE_JAGUAR 512 ++#endif ++ ++#define EFUSE_MAX_BANK_8812A 2 ++#define EFUSE_MAP_LEN_JAGUAR 512 ++#define EFUSE_MAX_SECTION_JAGUAR 64 ++#define EFUSE_MAX_WORD_UNIT_JAGUAR 4 ++#define EFUSE_IC_ID_OFFSET_JAGUAR 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ ++#define AVAILABLE_EFUSE_ADDR_8812(addr) (addr < EFUSE_REAL_CONTENT_LEN_JAGUAR) ++/* To prevent out of boundary programming case, leave 1byte and program full section ++ * 9bytes + 1byt + 5bytes and pre 1byte. ++ * For worst case: ++ * | 2byte|----8bytes----|1byte|--7bytes--| */ /* 92D */ ++#define EFUSE_OOB_PROTECT_BYTES_JAGUAR 18 /* PG data exclude header, dummy 7 bytes frome CP test and reserved 1byte. */ ++#define EFUSE_PROTECT_BYTES_BANK_JAGUAR 16 ++ ++#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) ++#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) ++ ++/* #define IS_MULTI_FUNC_CHIP(_Adapter) (((((PHAL_DATA_TYPE)(_Adapter->HalData))->MultiFunc) & (RT_MULTI_FUNC_BT|RT_MULTI_FUNC_GPS)) ? _TRUE : _FALSE) */ ++ ++/* #define RT_IS_FUNC_DISABLED(__pAdapter, __FuncBits) ( (__pAdapter)->DisabledFunctions & (__FuncBits) ) */ ++ ++ ++#ifdef CONFIG_FILE_FWIMG ++extern char *rtw_fw_file_path; ++#ifdef CONFIG_WOWLAN ++extern char *rtw_fw_wow_file_path; ++#endif ++#ifdef CONFIG_MP_INCLUDED ++extern char *rtw_fw_mp_bt_file_path; ++#endif ++#endif ++ ++ ++/* rtl8812_hal_init.c */ ++void _8051Reset8812(PADAPTER padapter); ++s32 FirmwareDownload8812(PADAPTER Adapter, BOOLEAN bUsedWoWLANFw); ++void InitializeFirmwareVars8812(PADAPTER padapter); ++ ++s32 _LLTWrite_8812A(PADAPTER Adapter, u32 address, u32 data); ++s32 InitLLTTable8812A(PADAPTER padapter, u8 txpktbuf_bndy); ++void InitRDGSetting8812A(PADAPTER padapter); ++ ++void CheckAutoloadState8812A(PADAPTER padapter); ++ ++/* EFuse */ ++u8 GetEEPROMSize8812A(PADAPTER padapter); ++void InitPGData8812A(PADAPTER padapter); ++void Hal_EfuseParseIDCode8812A(PADAPTER padapter, u8 *hwinfo); ++void Hal_ReadPROMVersion8812A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_ReadTxPowerInfo8812A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_ReadBoardType8812A(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_ReadThermalMeter_8812A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++void Hal_ReadChannelPlan8812A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_EfuseParseXtal_8812A(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void Hal_ReadAntennaDiversity8812A(PADAPTER pAdapter, u8 *PROMContent, BOOLEAN AutoLoadFail); ++void Hal_ReadAmplifierType_8812A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++void Hal_ReadPAType_8821A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++void Hal_ReadRFEType_8812A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++void Hal_EfuseParseBTCoexistInfo8812A(PADAPTER Adapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void hal_ReadUsbType_8812AU(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++#ifdef CONFIG_MP_INCLUDED ++int FirmwareDownloadBT(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); ++#endif ++void Hal_ReadRemoteWakeup_8812A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++ ++BOOLEAN HalDetectPwrDownMode8812(PADAPTER Adapter); ++void Hal_EfuseParseKFreeData_8821A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++ ++#ifdef CONFIG_WOWLAN ++void Hal_DetectWoWMode(PADAPTER pAdapter); ++#endif /* CONFIG_WOWLAN */ ++ ++void _InitBeaconParameters_8812A(PADAPTER padapter); ++void SetBeaconRelatedRegisters8812A(PADAPTER padapter); ++ ++void ReadRFType8812A(PADAPTER padapter); ++void InitDefaultValue8821A(PADAPTER padapter); ++ ++void SetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval); ++void GetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval); ++u8 SetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++u8 GetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++void rtl8812_set_hal_ops(struct hal_ops *pHalFunc); ++void init_hal_spec_8812a(_adapter *adapter); ++void init_hal_spec_8821a(_adapter *adapter); ++ ++/* register */ ++void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); ++ ++void rtl8812_start_thread(PADAPTER padapter); ++void rtl8812_stop_thread(PADAPTER padapter); ++ ++#ifdef CONFIG_PCI_HCI ++BOOLEAN InterruptRecognized8812AE(PADAPTER Adapter); ++VOID UpdateInterruptMask8812AE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); ++#endif ++ ++#ifdef CONFIG_BT_COEXIST ++void rtl8812a_combo_card_WifiOnlyHwInit(PADAPTER Adapter); ++#endif ++ ++VOID ++Hal_PatchwithJaguar_8812( ++ IN PADAPTER Adapter, ++ IN RT_MEDIA_STATUS MediaStatus ++); ++ ++#endif /* __RTL8188E_HAL_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_led.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_led.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_led.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,41 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8812A_LED_H__ ++#define __RTL8812A_LED_H__ ++ ++ ++/* ******************************************************************************** ++ * Interface to manipulate LED objects. ++ * ******************************************************************************** */ ++#ifdef CONFIG_USB_HCI ++void rtl8812au_InitSwLeds(PADAPTER padapter); ++void rtl8812au_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_PCI_HCI ++void rtl8812ae_InitSwLeds(PADAPTER padapter); ++void rtl8812ae_DeInitSwLeds(PADAPTER padapter); ++#endif ++#ifdef CONFIG_SDIO_HCI ++void rtl8821as_hw_led_config(PADAPTER adapter); ++void rtl8821as_InitSwLeds(PADAPTER padapter); ++void rtl8821as_DeInitSwLeds(PADAPTER padapter); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_recv.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_recv.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_recv.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,158 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8812A_RECV_H__ ++#define __RTL8812A_RECV_H__ ++ ++#if defined(CONFIG_USB_HCI) ++ ++ #ifndef MAX_RECVBUF_SZ ++ #ifdef PLATFORM_OS_CE ++ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ ++ #else ++ #ifndef CONFIG_MINIMAL_MEMORY_USAGE ++ #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER ++ #define MAX_RECVBUF_SZ (rtw_rtkm_get_buff_size()) /*depend rtkm*/ ++ #else ++ #define MAX_RECVBUF_SZ (32768) /*32k*/ ++ #endif ++ /* #define MAX_RECVBUF_SZ (24576) */ /* 24k */ ++ /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ ++ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ ++ /* #define MAX_RECVBUF_SZ (15360) */ /* 15k < 16k */ ++ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ ++ #ifdef CONFIG_PLATFORM_NOVATEK_NT72668 ++ #undef MAX_RECVBUF_SZ ++ #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ ++ #endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */ ++ #else ++ #define MAX_RECVBUF_SZ (4000) /* about 4K */ ++ #endif ++ #endif ++ #endif /* !MAX_RECVBUF_SZ */ ++ ++#elif defined(CONFIG_PCI_HCI) ++ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ ++ /* #define MAX_RECVBUF_SZ (9100) */ ++ /* #else */ ++ #define MAX_RECVBUF_SZ (4000) /* about 4K ++ * #endif */ ++ ++ ++#elif defined(CONFIG_SDIO_HCI) ++ ++ #define MAX_RECVBUF_SZ (RX_DMA_BOUNDARY_8821 + 1) ++ ++#endif ++ ++ ++/* Rx smooth factor */ ++#define Rx_Smooth_Factor (20) ++ ++/* DWORD 0 */ ++#define SET_RX_STATUS_DESC_PKT_LEN_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) ++#define SET_RX_STATUS_DESC_EOR_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) ++#define SET_RX_STATUS_DESC_OWN_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) ++ ++#define GET_RX_STATUS_DESC_PKT_LEN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) ++#define GET_RX_STATUS_DESC_CRC32_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) ++#define GET_RX_STATUS_DESC_ICV_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) ++#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) ++#define GET_RX_STATUS_DESC_SECURITY_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) ++#define GET_RX_STATUS_DESC_QOS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) ++#define GET_RX_STATUS_DESC_SHIFT_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) ++#define GET_RX_STATUS_DESC_PHY_STATUS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) ++#define GET_RX_STATUS_DESC_SWDEC_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) ++#define GET_RX_STATUS_DESC_LAST_SEG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 28, 1) ++#define GET_RX_STATUS_DESC_FIRST_SEG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 29, 1) ++#define GET_RX_STATUS_DESC_EOR_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) ++#define GET_RX_STATUS_DESC_OWN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) ++ ++/* DWORD 1 */ ++#define GET_RX_STATUS_DESC_MACID_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) ++#define GET_RX_STATUS_DESC_TID_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) ++#define GET_RX_STATUS_DESC_AMSDU_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) ++#define GET_RX_STATUS_DESC_RXID_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) ++#define GET_RX_STATUS_DESC_PAGGR_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) ++#define GET_RX_STATUS_DESC_A1_FIT_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) ++#define GET_RX_STATUS_DESC_CHKERR_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) ++#define GET_RX_STATUS_DESC_IPVER_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) ++#define GET_RX_STATUS_DESC_IS_TCPUDP__8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) ++#define GET_RX_STATUS_DESC_CHK_VLD_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) ++#define GET_RX_STATUS_DESC_PAM_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) ++#define GET_RX_STATUS_DESC_PWR_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) ++#define GET_RX_STATUS_DESC_MORE_DATA_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) ++#define GET_RX_STATUS_DESC_MORE_FRAG_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) ++#define GET_RX_STATUS_DESC_TYPE_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) ++#define GET_RX_STATUS_DESC_MC_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) ++#define GET_RX_STATUS_DESC_BC_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) ++ ++/* DWORD 2 */ ++#define GET_RX_STATUS_DESC_SEQ_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) ++#define GET_RX_STATUS_DESC_FRAG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) ++#define GET_RX_STATUS_DESC_RX_IS_QOS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) ++#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) ++#define GET_RX_STATUS_DESC_RPT_SEL_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) ++ ++/* DWORD 3 */ ++#define GET_RX_STATUS_DESC_RX_RATE_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) ++#define GET_RX_STATUS_DESC_HTC_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) ++#define GET_RX_STATUS_DESC_EOSP_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) ++#define GET_RX_STATUS_DESC_BSSID_FIT_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) ++#ifdef CONFIG_USB_RX_AGGREGATION ++#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) ++#endif ++#define GET_RX_STATUS_DESC_PATTERN_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) ++#define GET_RX_STATUS_DESC_UNICAST_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) ++#define GET_RX_STATUS_DESC_MAGIC_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) ++ ++/* DWORD 6 */ ++#define GET_RX_STATUS_DESC_SPLCP_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 1) ++#define GET_RX_STATUS_DESC_LDPC_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 1, 1) ++#define GET_RX_STATUS_DESC_STBC_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 2, 1) ++#define GET_RX_STATUS_DESC_BW_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 4, 2) ++ ++/* DWORD 5 */ ++#define GET_RX_STATUS_DESC_TSFL_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) ++ ++#define GET_RX_STATUS_DESC_BUFF_ADDR_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) ++#define GET_RX_STATUS_DESC_BUFF_ADDR64_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) ++ ++#define SET_RX_STATUS_DESC_BUFF_ADDR_8812(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) ++ ++ ++#ifdef CONFIG_SDIO_HCI ++s32 InitRecvPriv8821AS(PADAPTER padapter); ++void FreeRecvPriv8821AS(PADAPTER padapter); ++#endif /* CONFIG_SDIO_HCI */ ++ ++#ifdef CONFIG_USB_HCI ++void rtl8812au_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); ++s32 rtl8812au_init_recv_priv(PADAPTER padapter); ++void rtl8812au_free_recv_priv(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++s32 rtl8812ae_init_recv_priv(PADAPTER padapter); ++void rtl8812ae_free_recv_priv(PADAPTER padapter); ++#endif ++ ++void rtl8812_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); ++ ++#endif /* __RTL8812A_RECV_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_rf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_rf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_rf.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,33 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8812A_RF_H__ ++#define __RTL8812A_RF_H__ ++ ++VOID ++PHY_RF6052SetBandwidth8812( ++ IN PADAPTER Adapter, ++ IN CHANNEL_WIDTH Bandwidth); ++ ++ ++int ++PHY_RF6052_Config_8812( ++ IN PADAPTER Adapter); ++ ++#endif/* __RTL8188E_RF_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_spec.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_spec.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_spec.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,276 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ *******************************************************************************/ ++#ifndef __RTL8812A_SPEC_H__ ++#define __RTL8812A_SPEC_H__ ++ ++#include ++ ++ ++/* ************************************************************ ++* 8812 Regsiter offset definition ++* ************************************************************ */ ++ ++/* ************************************************************ ++* ++* ************************************************************ */ ++ ++/* ----------------------------------------------------- ++* ++* 0x0000h ~ 0x00FFh System Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_SYS_CLKR_8812A 0x0008 ++#define REG_AFE_PLL_CTRL_8812A 0x0028 ++#define REG_HSIMR_8812 0x0058 ++#define REG_HSISR_8812 0x005c ++#define REG_GPIO_EXT_CTRL 0x0060 ++#define REG_GPIO_STATUS_8812 0x006C ++#define REG_SDIO_CTRL_8812 0x0070 ++#define REG_OPT_CTRL_8812 0x0074 ++#define REG_RF_B_CTRL_8812 0x0076 ++#define REG_FW_DRV_MSG_8812 0x0088 ++#define REG_HMEBOX_E2_E3_8812 0x008C ++#define REG_HIMR0_8812 0x00B0 ++#define REG_HISR0_8812 0x00B4 ++#define REG_HIMR1_8812 0x00B8 ++#define REG_HISR1_8812 0x00BC ++#define REG_EFUSE_BURN_GNT_8812 0x00CF ++#define REG_SYS_CFG1_8812 0x00FC ++ ++/* ----------------------------------------------------- ++* ++* 0x0100h ~ 0x01FFh MACTOP General Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_CR_8812A 0x100 ++#define REG_PKTBUF_DBG_ADDR (REG_PKTBUF_DBG_CTRL) ++#define REG_RXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+2) ++#define REG_TXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+3) ++#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN ++ ++#define REG_RSVD3_8812 0x0168 ++#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 ++#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 ++#define REG_C2HEVT_CMD_LEN_88XX 0x01AE ++ ++#define REG_HMEBOX_EXT0_8812 0x01F0 ++#define REG_HMEBOX_EXT1_8812 0x01F4 ++#define REG_HMEBOX_EXT2_8812 0x01F8 ++#define REG_HMEBOX_EXT3_8812 0x01FC ++ ++/* ----------------------------------------------------- ++* ++* 0x0200h ~ 0x027Fh TXDMA Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_DWBCN0_CTRL_8812 REG_TDECTRL ++#define REG_DWBCN1_CTRL_8812 0x0228 ++ ++/* ----------------------------------------------------- ++* ++* 0x0280h ~ 0x02FFh RXDMA Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_TDECTRL_8812A 0x0208 ++#define REG_RXDMA_CONTROL_8812A 0x0286 /*Control the RX DMA.*/ ++#define REG_RXDMA_PRO_8812 0x0290 ++#define REG_EARLY_MODE_CONTROL_8812 0x02BC ++#define REG_RSVD5_8812 0x02F0 ++#define REG_RSVD6_8812 0x02F4 ++#define REG_RSVD7_8812 0x02F8 ++#define REG_RSVD8_8812 0x02FC ++ ++ ++/* ----------------------------------------------------- ++* ++* 0x0300h ~ 0x03FFh PCIe ++* ++* ----------------------------------------------------- */ ++#define REG_PCIE_CTRL_REG_8812A 0x0300 ++#define REG_DBI_WDATA_8812 0x0348 /* DBI Write Data */ ++#define REG_DBI_RDATA_8812 0x034C /* DBI Read Data */ ++#define REG_DBI_ADDR_8812 0x0350 /* DBI Address */ ++#define REG_DBI_FLAG_8812 0x0352 /* DBI Read/Write Flag */ ++#define REG_MDIO_WDATA_8812 0x0354 /* MDIO for Write PCIE PHY */ ++#define REG_MDIO_RDATA_8812 0x0356 /* MDIO for Reads PCIE PHY */ ++#define REG_MDIO_CTL_8812 0x0358 /* MDIO for Control */ ++#define REG_PCIE_MULTIFET_CTRL_8812 0x036A /* PCIE Multi-Fethc Control */ ++ ++/* ----------------------------------------------------- ++* ++* 0x0400h ~ 0x047Fh Protocol Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_TXPKT_EMPTY_8812A 0x041A ++#define REG_FWHW_TXQ_CTRL_8812A 0x0420 ++#define REG_TXBF_CTRL_8812A 0x042C ++#define REG_ARFR0_8812 0x0444 ++#define REG_ARFR1_8812 0x044C ++#define REG_CCK_CHECK_8812 0x0454 ++#define REG_AMPDU_MAX_TIME_8812 0x0456 ++#define REG_TXPKTBUF_BCNQ_BDNY1_8812 0x0457 ++ ++#define REG_AMPDU_MAX_LENGTH_8812 0x0458 ++#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8812 0x045D ++#define REG_NDPA_OPT_CTRL_8812A 0x045F ++#define REG_DATA_SC_8812 0x0483 ++#ifdef CONFIG_WOWLAN ++#define REG_TXPKTBUF_IV_LOW 0x0484 ++#define REG_TXPKTBUF_IV_HIGH 0x0488 ++#endif ++#define REG_ARFR2_8812 0x048C ++#define REG_ARFR3_8812 0x0494 ++#define REG_TXRPT_START_OFFSET 0x04AC ++#define REG_AMPDU_BURST_MODE_8812 0x04BC ++#define REG_HT_SINGLE_AMPDU_8812 0x04C7 ++#define REG_MACID_PKT_DROP0_8812 0x04D0 ++ ++/* ----------------------------------------------------- ++* ++* 0x0500h ~ 0x05FFh EDCA Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_TXPAUSE_8812A 0x0522 ++#define REG_CTWND_8812 0x0572 ++#define REG_SECONDARY_CCA_CTRL_8812 0x0577 ++#define REG_SCH_TXCMD_8812A 0x05F8 ++ ++/* ----------------------------------------------------- ++* ++* 0x0600h ~ 0x07FFh WMAC Configuration ++* ++* ----------------------------------------------------- */ ++#define REG_MAC_CR_8812 0x0600 ++ ++#define REG_MAC_TX_SM_STATE_8812 0x06B4 ++ ++/* Power */ ++#define REG_BFMER0_INFO_8812A 0x06E4 ++#define REG_BFMER1_INFO_8812A 0x06EC ++#define REG_CSI_RPT_PARAM_BW20_8812A 0x06F4 ++#define REG_CSI_RPT_PARAM_BW40_8812A 0x06F8 ++#define REG_CSI_RPT_PARAM_BW80_8812A 0x06FC ++ ++/* Hardware Port 2 */ ++#define REG_BFMEE_SEL_8812A 0x0714 ++#define REG_SND_PTCL_CTRL_8812A 0x0718 ++ ++ ++/* ----------------------------------------------------- ++* ++* Redifine register definition for compatibility ++* ++* ----------------------------------------------------- */ ++ ++/* TODO: use these definition when using REG_xxx naming rule. ++* NOTE: DO NOT Remove these definition. Use later. */ ++#define ISR_8812 REG_HISR0_8812 ++ ++/* ---------------------------------------------------------------------------- ++* 8195 IMR/ISR bits (offset 0xB0, 8bits) ++* ---------------------------------------------------------------------------- */ ++#define IMR_DISABLED_8812 0 ++/* IMR DW0(0x00B0-00B3) Bit 0-31 */ ++#define IMR_TIMER2_8812 BIT31 /* Timeout interrupt 2 */ ++#define IMR_TIMER1_8812 BIT30 /* Timeout interrupt 1 */ ++#define IMR_PSTIMEOUT_8812 BIT29 /* Power Save Time Out Interrupt */ ++#define IMR_GTINT4_8812 BIT28 /* When GTIMER4 expires, this bit is set to 1 */ ++#define IMR_GTINT3_8812 BIT27 /* When GTIMER3 expires, this bit is set to 1 */ ++#define IMR_TXBCN0ERR_8812 BIT26 /* Transmit Beacon0 Error */ ++#define IMR_TXBCN0OK_8812 BIT25 /* Transmit Beacon0 OK */ ++#define IMR_TSF_BIT32_TOGGLE_8812 BIT24 /* TSF Timer BIT32 toggle indication interrupt */ ++#define IMR_BCNDMAINT0_8812 BIT20 /* Beacon DMA Interrupt 0 */ ++#define IMR_BCNDERR0_8812 BIT16 /* Beacon Queue DMA OK0 */ ++#define IMR_HSISR_IND_ON_INT_8812 BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ ++#define IMR_BCNDMAINT_E_8812 BIT14 /* Beacon DMA Interrupt Extension for Win7 */ ++#define IMR_ATIMEND_8812 BIT12 /* CTWidnow End or ATIM Window End */ ++#define IMR_C2HCMD_8812 BIT10 /* CPU to Host Command INT Status, Write 1 clear */ ++#define IMR_CPWM2_8812 BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_CPWM_8812 BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_HIGHDOK_8812 BIT7 /* High Queue DMA OK */ ++#define IMR_MGNTDOK_8812 BIT6 /* Management Queue DMA OK */ ++#define IMR_BKDOK_8812 BIT5 /* AC_BK DMA OK */ ++#define IMR_BEDOK_8812 BIT4 /* AC_BE DMA OK */ ++#define IMR_VIDOK_8812 BIT3 /* AC_VI DMA OK */ ++#define IMR_VODOK_8812 BIT2 /* AC_VO DMA OK */ ++#define IMR_RDU_8812 BIT1 /* Rx Descriptor Unavailable */ ++#define IMR_ROK_8812 BIT0 /* Receive DMA OK */ ++ ++/* IMR DW1(0x00B4-00B7) Bit 0-31 */ ++#define IMR_BCNDMAINT7_8812 BIT27 /* Beacon DMA Interrupt 7 */ ++#define IMR_BCNDMAINT6_8812 BIT26 /* Beacon DMA Interrupt 6 */ ++#define IMR_BCNDMAINT5_8812 BIT25 /* Beacon DMA Interrupt 5 */ ++#define IMR_BCNDMAINT4_8812 BIT24 /* Beacon DMA Interrupt 4 */ ++#define IMR_BCNDMAINT3_8812 BIT23 /* Beacon DMA Interrupt 3 */ ++#define IMR_BCNDMAINT2_8812 BIT22 /* Beacon DMA Interrupt 2 */ ++#define IMR_BCNDMAINT1_8812 BIT21 /* Beacon DMA Interrupt 1 */ ++#define IMR_BCNDOK7_8812 BIT20 /* Beacon Queue DMA OK Interrup 7 */ ++#define IMR_BCNDOK6_8812 BIT19 /* Beacon Queue DMA OK Interrup 6 */ ++#define IMR_BCNDOK5_8812 BIT18 /* Beacon Queue DMA OK Interrup 5 */ ++#define IMR_BCNDOK4_8812 BIT17 /* Beacon Queue DMA OK Interrup 4 */ ++#define IMR_BCNDOK3_8812 BIT16 /* Beacon Queue DMA OK Interrup 3 */ ++#define IMR_BCNDOK2_8812 BIT15 /* Beacon Queue DMA OK Interrup 2 */ ++#define IMR_BCNDOK1_8812 BIT14 /* Beacon Queue DMA OK Interrup 1 */ ++#define IMR_ATIMEND_E_8812 BIT13 /* ATIM Window End Extension for Win7 */ ++#define IMR_TXERR_8812 BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ ++#define IMR_RXERR_8812 BIT10 /* Rx Error Flag INT Status, Write 1 clear */ ++#define IMR_TXFOVW_8812 BIT9 /* Transmit FIFO Overflow */ ++#define IMR_RXFOVW_8812 BIT8 /* Receive FIFO Overflow */ ++ ++ ++#ifdef CONFIG_PCI_HCI ++/* #define IMR_RX_MASK (IMR_ROK_8812|IMR_RDU_8812|IMR_RXFOVW_8812) */ ++#define IMR_TX_MASK (IMR_VODOK_8812 | IMR_VIDOK_8812 | IMR_BEDOK_8812 | IMR_BKDOK_8812 | IMR_MGNTDOK_8812 | IMR_HIGHDOK_8812) ++ ++#define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8812 | IMR_TXBCN0OK_8812 | IMR_TXBCN0ERR_8812 | IMR_BCNDERR0_8812) ++ ++#define RT_AC_INT_MASKS (IMR_VIDOK_8812 | IMR_VODOK_8812 | IMR_BEDOK_8812 | IMR_BKDOK_8812) ++#endif ++ ++ ++/* **************************************************************************** ++* Regsiter Bit and Content definition ++* **************************************************************************** */ ++ ++/* 2 ACMHWCTRL 0x05C0 */ ++#define AcmHw_HwEn_8812 BIT(0) ++#define AcmHw_VoqEn_8812 BIT(1) ++#define AcmHw_ViqEn_8812 BIT(2) ++#define AcmHw_BeqEn_8812 BIT(3) ++#define AcmHw_VoqStatus_8812 BIT(5) ++#define AcmHw_ViqStatus_8812 BIT(6) ++#define AcmHw_BeqStatus_8812 BIT(7) ++ ++/* ******************************************************** ++* General definitions ++* ******************************************************** */ ++ ++#define MACID_NUM_8812A 128 ++#define SEC_CAM_ENT_NUM_8812A 64 ++#define HW_PORT_NUM_8812A 2 ++#define NSS_NUM_8812A 2 ++#define BAND_CAP_8812A (BAND_CAP_2G | BAND_CAP_5G) ++#define BW_CAP_8812A (BW_CAP_20M | BW_CAP_40M | BW_CAP_80M) ++#define PROTO_CAP_8812A (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N | PROTO_CAP_11AC) ++ ++#endif /* __RTL8812A_SPEC_H__ */ ++ ++#ifdef CONFIG_RTL8821A ++#include "rtl8821a_spec.h" ++#endif /* CONFIG_RTL8821A */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_sreset.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_sreset.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_sreset.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,29 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL88812A_SRESET_H_ ++#define _RTL8812A_SRESET_H_ ++ ++#include ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++extern void rtl8812_sreset_xmit_status_check(_adapter *padapter); ++extern void rtl8812_sreset_linked_status_check(_adapter *padapter); ++#endif ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_xmit.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_xmit.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_xmit.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,366 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8812A_XMIT_H__ ++#define __RTL8812A_XMIT_H__ ++ ++ ++/* For 88e early mode */ ++#define SET_EARLYMODE_PKTNUM(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 3, __Value) ++#define SET_EARLYMODE_LEN0(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 12, __Value) ++#define SET_EARLYMODE_LEN1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 16, 12, __Value) ++#define SET_EARLYMODE_LEN2_1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 28, 4, __Value) ++#define SET_EARLYMODE_LEN2_2(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 8, __Value) ++#define SET_EARLYMODE_LEN3(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 8, 12, __Value) ++#define SET_EARLYMODE_LEN4(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 20, 12, __Value) ++ ++/* ++ * defined for TX DESC Operation ++ * */ ++ ++#define MAX_TID (15) ++ ++/* OFFSET 0 */ ++#define OFFSET_SZ 0 ++#define OFFSET_SHT 16 ++#define BMC BIT(24) ++#define LSG BIT(26) ++#define FSG BIT(27) ++#define OWN BIT(31) ++ ++ ++/* OFFSET 4 */ ++#define PKT_OFFSET_SZ 0 ++#define QSEL_SHT 8 ++#define RATE_ID_SHT 16 ++#define NAVUSEHDR BIT(20) ++#define SEC_TYPE_SHT 22 ++#define PKT_OFFSET_SHT 26 ++ ++/* OFFSET 8 */ ++#define AGG_EN BIT(12) ++#define AGG_BK BIT(16) ++#define AMPDU_DENSITY_SHT 20 ++#define ANTSEL_A BIT(24) ++#define ANTSEL_B BIT(25) ++#define TX_ANT_CCK_SHT 26 ++#define TX_ANTL_SHT 28 ++#define TX_ANT_HT_SHT 30 ++ ++/* OFFSET 12 */ ++#define SEQ_SHT 16 ++#define EN_HWSEQ BIT(31) ++ ++/* OFFSET 16 */ ++#define QOS BIT(6) ++#define HW_SSN BIT(7) ++#define USERATE BIT(8) ++#define DISDATAFB BIT(10) ++#define CTS_2_SELF BIT(11) ++#define RTS_EN BIT(12) ++#define HW_RTS_EN BIT(13) ++#define DATA_SHORT BIT(24) ++#define PWR_STATUS_SHT 15 ++#define DATA_SC_SHT 20 ++#define DATA_BW BIT(25) ++ ++/* OFFSET 20 */ ++#define RTY_LMT_EN BIT(17) ++ ++/* OFFSET 20 */ ++#define SGI BIT(6) ++#define USB_TXAGG_NUM_SHT 24 ++ ++typedef struct txdescriptor_8812 { ++ /* Offset 0 */ ++ u32 pktlen:16; ++ u32 offset:8; ++ u32 bmc:1; ++ u32 htc:1; ++ u32 ls:1; ++ u32 fs:1; ++ u32 linip:1; ++ u32 noacm:1; ++ u32 gf:1; ++ u32 own:1; ++ ++ /* Offset 4 */ ++ u32 macid:6; ++ u32 rsvd0406:2; ++ u32 qsel:5; ++ u32 rd_nav_ext:1; ++ u32 lsig_txop_en:1; ++ u32 pifs:1; ++ u32 rate_id:4; ++ u32 navusehdr:1; ++ u32 en_desc_id:1; ++ u32 sectype:2; ++ u32 rsvd0424:2; ++ u32 pkt_offset:5; /* unit: 8 bytes */ ++ u32 rsvd0431:1; ++ ++ /* Offset 8 */ ++ u32 rts_rc:6; ++ u32 data_rc:6; ++ u32 agg_en:1; ++ u32 rd_en:1; ++ u32 bar_rty_th:2; ++ u32 bk:1; ++ u32 morefrag:1; ++ u32 raw:1; ++ u32 ccx:1; ++ u32 ampdu_density:3; ++ u32 bt_null:1; ++ u32 ant_sel_a:1; ++ u32 ant_sel_b:1; ++ u32 tx_ant_cck:2; ++ u32 tx_antl:2; ++ u32 tx_ant_ht:2; ++ ++ /* Offset 12 */ ++ u32 nextheadpage:8; ++ u32 tailpage:8; ++ u32 seq:12; ++ u32 cpu_handle:1; ++ u32 tag1:1; ++ u32 trigger_int:1; ++ u32 hwseq_en:1; ++ ++ /* Offset 16 */ ++ u32 rtsrate:5; ++ u32 ap_dcfe:1; ++ u32 hwseq_sel:2; ++ u32 userate:1; ++ u32 disrtsfb:1; ++ u32 disdatafb:1; ++ u32 cts2self:1; ++ u32 rtsen:1; ++ u32 hw_rts_en:1; ++ u32 port_id:1; ++ u32 pwr_status:3; ++ u32 wait_dcts:1; ++ u32 cts2ap_en:1; ++ u32 data_sc:2; ++ u32 data_stbc:2; ++ u32 data_short:1; ++ u32 data_bw:1; ++ u32 rts_short:1; ++ u32 rts_bw:1; ++ u32 rts_sc:2; ++ u32 vcs_stbc:2; ++ ++ /* Offset 20 */ ++ u32 datarate:6; ++ u32 sgi:1; ++ u32 try_rate:1; ++ u32 data_ratefb_lmt:5; ++ u32 rts_ratefb_lmt:4; ++ u32 rty_lmt_en:1; ++ u32 data_rt_lmt:6; ++ u32 usb_txagg_num:8; ++ ++ /* Offset 24 */ ++ u32 txagg_a:5; ++ u32 txagg_b:5; ++ u32 use_max_len:1; ++ u32 max_agg_num:5; ++ u32 mcsg1_max_len:4; ++ u32 mcsg2_max_len:4; ++ u32 mcsg3_max_len:4; ++ u32 mcs7_sgi_max_len:4; ++ ++ /* Offset 28 */ ++ u32 checksum:16; /* TxBuffSize(PCIe)/CheckSum(USB) */ ++ u32 mcsg4_max_len:4; ++ u32 mcsg5_max_len:4; ++ u32 mcsg6_max_len:4; ++ u32 mcs15_sgi_max_len:4; ++ ++ /* Offset 32 */ ++ u32 rsvd32; ++ ++ /* Offset 36 */ ++ u32 rsvd36; ++} TXDESC_8812, *PTXDESC_8812; ++ ++ ++/* Dword 0 */ ++#define GET_TX_DESC_OWN_8812(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) ++#define SET_TX_DESC_PKT_SIZE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) ++#define SET_TX_DESC_OFFSET_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) ++#define SET_TX_DESC_BMC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) ++#define SET_TX_DESC_HTC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) ++#define SET_TX_DESC_LAST_SEG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) ++#define SET_TX_DESC_FIRST_SEG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) ++#define SET_TX_DESC_LINIP_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) ++#define SET_TX_DESC_NO_ACM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) ++#define SET_TX_DESC_GF_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) ++#define SET_TX_DESC_OWN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) ++ ++/* Dword 1 */ ++#define SET_TX_DESC_MACID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) ++#define SET_TX_DESC_QUEUE_SEL_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) ++#define SET_TX_DESC_RDG_NAV_EXT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) ++#define SET_TX_DESC_LSIG_TXOP_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) ++#define SET_TX_DESC_PIFS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) ++#define SET_TX_DESC_RATE_ID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) ++#define SET_TX_DESC_EN_DESC_ID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) ++#define SET_TX_DESC_SEC_TYPE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) ++#define SET_TX_DESC_PKT_OFFSET_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) ++ ++/* Dword 2 */ ++#define SET_TX_DESC_PAID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) ++#define SET_TX_DESC_CCA_RTS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) ++#define SET_TX_DESC_AGG_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) ++#define SET_TX_DESC_RDG_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) ++#define SET_TX_DESC_AGG_BREAK_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) ++#define SET_TX_DESC_MORE_FRAG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) ++#define SET_TX_DESC_RAW_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) ++#define SET_TX_DESC_SPE_RPT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) ++#define SET_TX_DESC_AMPDU_DENSITY_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) ++#define SET_TX_DESC_BT_INT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) ++#define SET_TX_DESC_GID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) ++ ++/* Dword 3 */ ++#define SET_TX_DESC_WHEADER_LEN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) ++#define SET_TX_DESC_CHK_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) ++#define SET_TX_DESC_EARLY_MODE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) ++#define SET_TX_DESC_HWSEQ_SEL_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) ++#define SET_TX_DESC_USE_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) ++#define SET_TX_DESC_DISABLE_RTS_FB_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) ++#define SET_TX_DESC_DISABLE_FB_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) ++#define SET_TX_DESC_CTS2SELF_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) ++#define SET_TX_DESC_RTS_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) ++#define SET_TX_DESC_HW_RTS_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) ++#define SET_TX_DESC_NAV_USE_HDR_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) ++#define SET_TX_DESC_USE_MAX_LEN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) ++#define SET_TX_DESC_MAX_AGG_NUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) ++#define SET_TX_DESC_NDPA_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) ++#define SET_TX_DESC_AMPDU_MAX_TIME_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) ++ ++/* Dword 4 */ ++#define SET_TX_DESC_TX_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) ++#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) ++#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) ++#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) ++#define SET_TX_DESC_DATA_RETRY_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) ++#define SET_TX_DESC_RTS_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) ++ ++/* Dword 5 */ ++#define SET_TX_DESC_DATA_SC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) ++#define SET_TX_DESC_DATA_SHORT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) ++#define SET_TX_DESC_DATA_BW_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) ++#define SET_TX_DESC_DATA_LDPC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) ++#define SET_TX_DESC_DATA_STBC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) ++#define SET_TX_DESC_CTROL_STBC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) ++#define SET_TX_DESC_RTS_SHORT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) ++#define SET_TX_DESC_RTS_SC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) ++#define SET_TX_DESC_TX_ANT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 4, __Value) ++ ++/* Dword 6 */ ++#define SET_TX_DESC_SW_DEFINE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) ++#define SET_TX_DESC_ANTSEL_A_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) ++#define SET_TX_DESC_ANTSEL_B_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) ++#define SET_TX_DESC_ANTSEL_C_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) ++#define SET_TX_DESC_ANTSEL_D_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) ++#define SET_TX_DESC_MBSSID_8821(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) ++ ++/* Dword 7 */ ++#define SET_TX_DESC_TX_BUFFER_SIZE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++#define SET_TX_DESC_TX_DESC_CHECKSUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++#define SET_TX_DESC_USB_TXAGG_NUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) ++#ifdef CONFIG_SDIO_HCI ++#define SET_TX_DESC_SDIO_TXSEQ_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) ++#endif ++ ++/* Dword 8 */ ++#define SET_TX_DESC_HWSEQ_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) ++ ++/* Dword 9 */ ++#define SET_TX_DESC_SEQ_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) ++ ++/* Dword 10 */ ++#define SET_TX_DESC_TX_BUFFER_ADDRESS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) ++#define GET_TX_DESC_TX_BUFFER_ADDRESS_8812(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+40, 0, 32) ++ ++/* Dword 11 */ ++#define SET_TX_DESC_NEXT_DESC_ADDRESS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) ++ ++ ++#define SET_EARLYMODE_PKTNUM_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) ++#define SET_EARLYMODE_LEN0_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) ++#define SET_EARLYMODE_LEN1_1_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) ++#define SET_EARLYMODE_LEN1_2_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) ++#define SET_EARLYMODE_LEN2_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) ++#define SET_EARLYMODE_LEN3_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) ++ ++#ifdef CONFIG_TX_EARLY_MODE ++ #define USB_DUMMY_OFFSET 2 ++#else ++ #define USB_DUMMY_OFFSET 1 ++#endif ++#define USB_DUMMY_LENGTH (USB_DUMMY_OFFSET * PACKET_OFFSET_SZ) ++ ++ ++void rtl8812a_cal_txdesc_chksum(u8 *ptxdesc); ++void rtl8812a_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); ++void rtl8812a_fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc); ++void rtl8812a_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); ++void rtl8812a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); ++#if defined(CONFIG_CONCURRENT_MODE) ++void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); ++#endif ++ ++#ifdef CONFIG_USB_HCI ++s32 rtl8812au_init_xmit_priv(PADAPTER padapter); ++void rtl8812au_free_xmit_priv(PADAPTER padapter); ++s32 rtl8812au_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++s32 rtl8812au_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++s32 rtl8812au_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); ++void rtl8812au_xmit_tasklet(void *priv); ++s32 rtl8812au_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++s32 rtl8812ae_init_xmit_priv(PADAPTER padapter); ++void rtl8812ae_free_xmit_priv(PADAPTER padapter); ++struct xmit_buf *rtl8812ae_dequeue_xmitbuf(struct rtw_tx_ring *ring); ++void rtl8812ae_xmitframe_resume(_adapter *padapter); ++s32 rtl8812ae_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++s32 rtl8812ae_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++s32 rtl8812ae_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++void rtl8812ae_xmit_tasklet(void *priv); ++#endif ++ ++#ifdef CONFIG_TX_EARLY_MODE ++void UpdateEarlyModeInfo8812(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++#endif ++ ++void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, u8 *ptxdesc); ++ ++u8 BWMapping_8812(PADAPTER Adapter, struct pkt_attrib *pattrib); ++ ++u8 SCMapping_8812(PADAPTER Adapter, struct pkt_attrib *pattrib); ++ ++#endif /* __RTL8812_XMIT_H__ */ ++ ++#ifdef CONFIG_RTL8821A ++#include "rtl8821a_xmit.h" ++#endif /* CONFIG_RTL8821A */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_cmd.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_cmd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_cmd.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,145 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8814A_CMD_H__ ++#define __RTL8814A_CMD_H__ ++#include "hal_com_h2c.h" ++ ++/* _RSVDPAGE_LOC_CMD0 */ ++#define SET_8814A_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8814A_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_8814A_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8814A_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8814A_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++ ++/* _SETPWRMODE_PARM */ ++#define SET_8814A_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8814A_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) ++#define SET_8814A_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) ++#define SET_8814A_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8814A_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8814A_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) ++#define SET_8814A_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#define SET_8814A_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++ ++#define GET_8814A_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) ++ ++ ++/* _WoWLAN PARAM_CMD5 */ ++#define SET_8814A_H2CCMD_WOWLAN_FUNC_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8814A_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8814A_H2CCMD_WOWLAN_MAGIC_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_8814A_H2CCMD_WOWLAN_UNICAST_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) ++#define SET_8814A_H2CCMD_WOWLAN_ALL_PKT_DROP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) ++#define SET_8814A_H2CCMD_WOWLAN_GPIO_ACTIVE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) ++#define SET_8814A_H2CCMD_WOWLAN_REKEY_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) ++#define SET_8814A_H2CCMD_WOWLAN_DISCONNECT_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) ++#define SET_8814A_H2CCMD_WOWLAN_GPIONUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_8814A_H2CCMD_WOWLAN_GPIO_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++ ++ ++/* WLANINFO_PARM */ ++#define SET_8814A_H2CCMD_WLANINFO_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8814A_H2CCMD_WLANINFO_PARM_CHANNEL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_8814A_H2CCMD_WLANINFO_PARM_BW40MHZ(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++ ++/* _REMOTE_WAKEUP_CMD7 */ ++#define SET_8814A_H2CCMD_REMOTE_WAKECTRL_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8814A_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8814A_H2CCMD_REMOTE_WAKE_CTRL_NDP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_8814A_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) ++ ++ ++/* _AP_OFFLOAD_CMD8 */ ++#define SET_8814A_H2CCMD_AP_OFFLOAD_ON(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8814A_H2CCMD_AP_OFFLOAD_HIDDEN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_8814A_H2CCMD_AP_OFFLOAD_DENYANY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8814A_H2CCMD_AP_OFFLOAD_WAKEUP_EVT_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++ ++/* _PWR_MOD_CMD20 */ ++#define SET_88E_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_88E_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) ++#define SET_88E_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) ++#define SET_88E_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_88E_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_88E_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++ ++/*BCNHWSEQ*/ ++#define SET_8814A_H2CCMD_BCNHWSEQ_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 0, 1, __Value) ++#define SET_8814A_H2CCMD_BCNHWSEQ_BCN_NUMBER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 1, 3, __Value) ++#define SET_8814A_H2CCMD_BCNHWSEQ_HWSEQ(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 6, 1, __Value) ++#define SET_8814A_H2CCMD_BCNHWSEQ_EXHWSEQ(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 7, 1, __Value) ++#define SET_8814A_H2CCMD_BCNHWSEQ_PAGE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++void rtl8814_fw_update_beacon_cmd(_adapter *padapter); ++ ++/* TX Beamforming */ ++#define GET_8814A_C2H_TXBF_ORIGINATE(_Header) LE_BITS_TO_1BYTE(_Header, 0, 8) ++#define GET_8814A_C2H_TXBF_MACID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) ++ ++ ++ ++/* / TX Feedback Content */ ++#define USEC_UNIT_FOR_8814A_C2H_TX_RPT_QUEUE_TIME 256 ++ ++#define GET_8814A_C2H_TX_RPT_QUEUE_SELECT(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 5) ++#define GET_8814A_C2H_TX_RPT_PKT_BROCAST(_Header) LE_BITS_TO_1BYTE((_Header + 0), 5, 1) ++#define GET_8814A_C2H_TX_RPT_LIFE_TIME_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 6, 1) ++#define GET_8814A_C2H_TX_RPT_RETRY_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 7, 1) ++#define GET_8814A_C2H_TX_RPT_MAC_ID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) ++#define GET_8814A_C2H_TX_RPT_DATA_RETRY_CNT(_Header) LE_BITS_TO_1BYTE((_Header + 2), 0, 6) ++#define GET_8814A_C2H_TX_RPT_QUEUE_TIME(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) /* In unit of 256 microseconds. */ ++#define GET_8814A_C2H_TX_RPT_FINAL_DATA_RATE(_Header) LE_BITS_TO_1BYTE((_Header + 5), 0, 8) ++ ++ ++/* _P2P_PS_OFFLOAD */ ++#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_CTWINDOW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) ++#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) ++#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) ++#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) ++#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) ++ ++s32 FillH2CCmd_8814(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); ++void rtl8814_set_raid_cmd(PADAPTER padapter, u64 bitmap, u8 *arg, u8 bw); ++void rtl8814_set_wowlan_cmd(_adapter *padapter, u8 enable); ++void rtl8814_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); ++void rtl8814_set_FwPwrMode_cmd(PADAPTER padapter, u8 PSMode); ++u8 GetTxBufferRsvdPageNum8814(_adapter *padapter, bool wowlan); ++u8 rtl8814_set_rssi_cmd(_adapter *padapter, u8 *param); ++ ++#ifdef CONFIG_TDLS ++ #ifdef CONFIG_TDLS_CH_SW ++ void rtl8814_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); ++ #endif ++#endif ++ ++void ++Set_RA_LDPC_8814( ++ struct sta_info *psta, ++ BOOLEAN bLDPC ++); ++ ++s32 c2h_handler_8814a(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); ++ ++#ifdef CONFIG_P2P_PS ++ void rtl8814_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); ++#endif /* CONFIG_P2P */ ++ ++#endif/* __RTL8814A_CMD_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_dm.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_dm.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_dm.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,28 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8814A_DM_H__ ++#define __RTL8814A_DM_H__ ++ ++void rtl8814_init_dm_priv(IN PADAPTER Adapter); ++void rtl8814_deinit_dm_priv(IN PADAPTER Adapter); ++void rtl8814_InitHalDm(IN PADAPTER Adapter); ++void rtl8814_HalDmWatchDog(IN PADAPTER Adapter); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_hal.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,324 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8814A_HAL_H__ ++#define __RTL8814A_HAL_H__ ++ ++/* #include "hal_com.h" */ ++#include "hal_data.h" ++ ++/* include HAL Related header after HAL Related compiling flags */ ++#include "rtl8814a_spec.h" ++#include "rtl8814a_rf.h" ++#include "rtl8814a_dm.h" ++#include "rtl8814a_recv.h" ++#include "rtl8814a_xmit.h" ++#include "rtl8814a_cmd.h" ++#include "rtl8814a_led.h" ++#include "Hal8814PwrSeq.h" ++#include "Hal8814PhyReg.h" ++#include "Hal8814PhyCfg.h" ++#ifdef DBG_CONFIG_ERROR_DETECT ++ #include "rtl8814a_sreset.h" ++#endif /* DBG_CONFIG_ERROR_DETECT */ ++ ++enum { ++ VOLTAGE_V25 = 0x03, ++ LDOE25_SHIFT = 28 , ++}; ++/* max. iram is 64k , max dmen is 32k. Total = 96k = 0x18000*/ ++#define FW_SIZE 0x18000 ++#define FW_START_ADDRESS 0x1000 ++typedef struct _RT_FIRMWARE_8814 { ++ FIRMWARE_SOURCE eFWSource; ++#ifdef CONFIG_EMBEDDED_FWIMG ++ u8 *szFwBuffer; ++#else ++ u8 szFwBuffer[FW_SIZE]; ++#endif ++ u32 ulFwLength; ++} RT_FIRMWARE_8814, *PRT_FIRMWARE_8814; ++ ++#define PAGE_SIZE_TX_8814 PAGE_SIZE_128 ++#define BCNQ_PAGE_NUM_8814 0x08 ++ ++#define Rtl8814A_NIC_PWR_ON_FLOW rtl8814A_power_on_flow ++#define Rtl8814A_NIC_RF_OFF_FLOW rtl8814A_radio_off_flow ++#define Rtl8814A_NIC_DISABLE_FLOW rtl8814A_card_disable_flow ++#define Rtl8814A_NIC_ENABLE_FLOW rtl8814A_card_enable_flow ++#define Rtl8814A_NIC_SUSPEND_FLOW rtl8814A_suspend_flow ++#define Rtl8814A_NIC_RESUME_FLOW rtl8814A_resume_flow ++#define Rtl8814A_NIC_PDN_FLOW rtl8814A_hwpdn_flow ++#define Rtl8814A_NIC_LPS_ENTER_FLOW rtl8814A_enter_lps_flow ++#define Rtl8814A_NIC_LPS_LEAVE_FLOW rtl8814A_leave_lps_flow ++ ++/* ***************************************************** ++ * New Firmware Header(8-byte alinment required) ++ * ***************************************************** ++ * --- LONG WORD 0 ---- */ ++#define GET_FIRMWARE_HDR_SIGNATURE_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 0, 16) ++#define GET_FIRMWARE_HDR_CATEGORY_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 16, 8) /* AP/NIC and USB/PCI */ ++#define GET_FIRMWARE_HDR_FUNCTION_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 24, 8) /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ ++#define GET_FIRMWARE_HDR_VERSION_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 0, 16)/* FW Version */ ++#define GET_FIRMWARE_HDR_SUB_VER_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 16, 8) /* FW Subversion, default 0x00 */ ++#define GET_FIRMWARE_HDR_SUB_IDX_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 24, 8) /* FW Subversion Index */ ++ ++/* --- LONG WORD 1 ---- */ ++#define GET_FIRMWARE_HDR_SVN_IDX_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 0, 32)/* The SVN entry index */ ++#define GET_FIRMWARE_HDR_RSVD1_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 0, 32) ++ ++/* --- LONG WORD 2 ---- */ ++#define GET_FIRMWARE_HDR_MONTH_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 0, 8) /* Release time Month field */ ++#define GET_FIRMWARE_HDR_DATE_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 8, 8) /* Release time Date field */ ++#define GET_FIRMWARE_HDR_HOUR_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 16, 8)/* Release time Hour field */ ++#define GET_FIRMWARE_HDR_MINUTE_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 24, 8)/* Release time Minute field */ ++#define GET_FIRMWARE_HDR_YEAR_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 0, 16)/* Release time Year field */ ++#define GET_FIRMWARE_HDR_FOUNDRY_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 16, 8)/* Release time Foundry field */ ++#define GET_FIRMWARE_HDR_RSVD2_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 24, 8) ++ ++/* --- LONG WORD 3 ---- */ ++#define GET_FIRMWARE_HDR_MEM_UASGE_DL_FROM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 0, 1) ++#define GET_FIRMWARE_HDR_MEM_UASGE_BOOT_FROM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 1, 1) ++#define GET_FIRMWARE_HDR_MEM_UASGE_BOOT_LOADER_3081(__FwHdr)LE_BITS_TO_4BYTE(__FwHdr+24, 2, 1) ++#define GET_FIRMWARE_HDR_MEM_UASGE_IRAM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 3, 1) ++#define GET_FIRMWARE_HDR_MEM_UASGE_ERAM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 4, 1) ++#define GET_FIRMWARE_HDR_MEM_UASGE_RSVD4_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 5, 3) ++#define GET_FIRMWARE_HDR_RSVD3_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 8, 8) ++#define GET_FIRMWARE_HDR_BOOT_LOADER_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 16, 16) ++#define GET_FIRMWARE_HDR_RSVD5_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+28, 0, 32) ++ ++/* --- LONG WORD 4 ---- */ ++#define GET_FIRMWARE_HDR_TOTAL_DMEM_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+36, 0, 32) ++#define GET_FIRMWARE_HDR_FW_CFG_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+36, 0, 16) ++#define GET_FIRMWARE_HDR_FW_ATTR_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+36, 16, 16) ++ ++/* --- LONG WORD 5 ---- */ ++#define GET_FIRMWARE_HDR_IROM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+40, 0, 32) ++#define GET_FIRMWARE_HDR_EROM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+44, 0, 32) ++ ++/* --- LONG WORD 6 ---- */ ++#define GET_FIRMWARE_HDR_IRAM_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+48, 0, 32) ++#define GET_FIRMWARE_HDR_ERAM_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+52, 0, 32) ++ ++/* --- LONG WORD 7 ---- */ ++#define GET_FIRMWARE_HDR_RSVD6_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+56, 0, 32) ++#define GET_FIRMWARE_HDR_RSVD7_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+60, 0, 32) ++ ++ ++ ++/* ++ * 2013/08/16 MH MOve from SDIO.h for common use. ++ * */ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) ++ #define TRX_SHARE_MODE_8814A 0 /* TRX Buffer Share Index */ ++ #define BASIC_RXFF_SIZE_8814A 24576/* Basic RXFF Size is 24K = 24*1024 Unit: Byte */ ++ #define TRX_SHARE_BUFF_UNIT_8814A 65536/* TRX Share Buffer unit Size 64K = 64*1024 Unit: Byte */ ++ #define TRX_SHARE_BUFF_UNIT_PAGE_8814A (TRX_SHARE_BUFF_UNIT_8814A/PAGE_SIZE_8814A)/* 512 Pages */ ++ ++ /* Origin: */ ++ #define HPQ_PGNUM_8814A 0x20 /* High Queue */ ++ #define LPQ_PGNUM_8814A 0x20 /* Low Queue */ ++ #define NPQ_PGNUM_8814A 0x20 /* Normal Queue */ ++ #define EPQ_PGNUM_8814A 0x20 /* Extra Queue */ ++ ++#else /* #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) */ ++ ++ #define HPQ_PGNUM_8814A 20 ++ #define NPQ_PGNUM_8814A 20 ++ #define LPQ_PGNUM_8814A 20 /* 1972 */ ++ #define EPQ_PGNUM_8814A 20 ++ #define BCQ_PGNUM_8814A 32 ++ ++#endif /* #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) */ ++ ++#ifdef CONFIG_WOWLAN ++ #define WOWLAN_PAGE_NUM_8814 0x00 ++#else ++ #define WOWLAN_PAGE_NUM_8814 0x00 ++#endif ++ ++#define PAGE_SIZE_8814A 128/* TXFF Page Size, Unit: Byte */ ++#define MAX_RX_DMA_BUFFER_SIZE_8814A 0x5C00 /* BASIC_RXFF_SIZE_8814A + TRX_SHARE_MODE_8814A * TRX_SHARE_BUFF_UNIT_8814A */ /* Basic RXFF Size + ShareBuffer Size */ ++#define TX_PAGE_BOUNDARY_8814A TXPKT_PGNUM_8814A /* Need to enlarge boundary, by KaiYuan */ ++#define TX_PAGE_BOUNDARY_WOWLAN_8814A TXPKT_PGNUM_8814A /* TODO: 20130415 KaiYuan Check this value later */ ++ ++#ifdef CONFIG_FW_C2H_DEBUG ++ #define RX_DMA_RESERVED_SIZE_8814A 0x100 /* 256B, reserved for c2h debug message */ ++#else ++ #define RX_DMA_RESERVED_SIZE_8814A 0x0 /* 0B */ ++#endif ++#define RX_DMA_BOUNDARY_8814A (MAX_RX_DMA_BUFFER_SIZE_8814A - RX_DMA_RESERVED_SIZE_8814A - 1) ++ ++#define TOTAL_PGNUM_8814A 2048 ++#define TXPKT_PGNUM_8814A (2048 - BCNQ_PAGE_NUM_8814-WOWLAN_PAGE_NUM_8814) ++#define PUB_PGNUM_8814A (TXPKT_PGNUM_8814A-HPQ_PGNUM_8814A-NPQ_PGNUM_8814A-LPQ_PGNUM_8814A-EPQ_PGNUM_8814A) ++ ++/* Note: For WMM Normal Chip Setting ,modify later */ ++#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8814A TX_PAGE_BOUNDARY_8814A ++#define WMM_NORMAL_TX_PAGE_BOUNDARY_8814A (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8814A + 1) ++ ++#define DRIVER_EARLY_INT_TIME_8814 0x05 ++#define BCN_DMA_ATIME_INT_TIME_8814 0x02 ++ ++ ++#define MAX_PAGE_SIZE 4096 /* @ page : 4k bytes */ ++ ++#define EFUSE_MAX_SECTION_JAGUAR 64 ++ ++#define HWSET_MAX_SIZE_8814A 512 ++ ++#define EFUSE_REAL_CONTENT_LEN_8814A 1024 ++#define EFUSE_MAX_BANK_8814A 2 ++ ++#define EFUSE_MAP_LEN_8814A 512 ++#define EFUSE_MAX_SECTION_8814A 64 ++#define EFUSE_MAX_WORD_UNIT_8814A 4 ++#define EFUSE_PROTECT_BYTES_BANK_8814A 16 ++ ++#define EFUSE_IC_ID_OFFSET_8814A 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ ++#define AVAILABLE_EFUSE_ADDR_8814A(addr) (addr < EFUSE_REAL_CONTENT_LEN_8814A) ++ ++/*------------------------------------------------------------------------- ++Chip specific ++-------------------------------------------------------------------------*/ ++ ++/* pic buffer descriptor */ ++#if 1 /* according to the define in the rtw_xmit.h, rtw_recv.h */ ++ #define RTL8814AE_SEG_NUM TX_BUFFER_SEG_NUM /* 0:2 seg, 1: 4 seg, 2: 8 seg */ ++ #define TX_DESC_NUM_8814A TXDESC_NUM /* 128 */ ++ #define RX_DESC_NUM_8814A PCI_MAX_RX_COUNT /* 128 */ ++ #ifdef CONFIG_CONCURRENT_MODE ++ #define BE_QUEUE_TX_DESC_NUM_8814A (TXDESC_NUM<<1) /* 256 */ ++ #else ++ #define BE_QUEUE_TX_DESC_NUM_8814A (TXDESC_NUM+(TXDESC_NUM>>1)) /* 192 */ ++ #endif ++#else ++ #define RTL8814AE_SEG_NUM TX_BUFFER_SEG_NUM /* 0:2 seg, 1: 4 seg, 2: 8 seg */ ++ #define TX_DESC_NUM_8814A 128 /* 1024//2048 change by ylb 20130624 */ ++ #define RX_DESC_NUM_8814A 128 /* 1024 //512 change by ylb 20130624 */ ++#endif ++ ++/* To prevent out of boundary programming case, leave 1byte and program full section ++ * 9bytes + 1byt + 5bytes and pre 1byte. ++ * For worst case: ++ * | 1byte|----8bytes----|1byte|--5bytes--| ++ * | | Reserved(14bytes) | ++ * */ ++#define EFUSE_OOB_PROTECT_BYTES 15 /* PG data exclude header, dummy 6 bytes frome CP test and reserved 1byte. */ ++ ++/* rtl8814_hal_init.c */ ++s32 FirmwareDownload8814A(PADAPTER Adapter, BOOLEAN bUsedWoWLANFw); ++void InitializeFirmwareVars8814(PADAPTER padapter); ++ ++VOID ++Hal_InitEfuseVars_8814A( ++ IN PADAPTER Adapter ++); ++ ++s32 InitLLTTable8814A( ++ IN PADAPTER Adapter ++); ++ ++ ++void InitRDGSetting8814A(PADAPTER padapter); ++ ++/* void CheckAutoloadState8812A(PADAPTER padapter); */ ++ ++/* EFuse */ ++u8 GetEEPROMSize8814A(PADAPTER padapter); ++VOID hal_InitPGData_8814A( ++ IN PADAPTER padapter, ++ IN OUT u8 *PROMContent ++); ++ ++void hal_ReadPROMVersion8814A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void hal_ReadTxPowerInfo8814A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void hal_ReadBoardType8814A(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void hal_ReadThermalMeter_8814A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++void hal_ReadChannelPlan8814A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void hal_EfuseParseXtal_8814A(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++void hal_ReadAntennaDiversity8814A(PADAPTER pAdapter, u8 *PROMContent, BOOLEAN AutoLoadFail); ++void hal_Read_TRX_antenna_8814A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++VOID hal_ReadAmplifierType_8814A( ++ IN PADAPTER Adapter ++); ++VOID hal_ReadPAType_8814A( ++ IN PADAPTER Adapter, ++ IN u8 *PROMContent, ++ IN BOOLEAN AutoloadFail, ++ OUT u8 *pPAType, ++ OUT u8 *pLNAType ++); ++ ++void hal_ReadPowerTrackingType_8814A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++ ++void hal_GetRxGainOffset_8814A( ++ PADAPTER Adapter, ++ pu1Byte PROMContent, ++ BOOLEAN AutoloadFail ++); ++void Hal_EfuseParseKFreeData_8814A( ++ IN PADAPTER Adapter, ++ IN u8 *PROMContent, ++ IN BOOLEAN AutoloadFail); ++void hal_ReadRFEType_8814A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++void hal_EfuseParseBTCoexistInfo8814A(PADAPTER Adapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++ ++/* void hal_ReadUsbType_8812AU(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); ++ * int FirmwareDownloadBT(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); */ ++void hal_ReadRemoteWakeup_8814A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); ++u8 MgntQuery_NssTxRate(u16 Rate); ++ ++/* BOOLEAN HalDetectPwrDownMode8812(PADAPTER Adapter); */ ++ ++#ifdef CONFIG_WOWLAN ++ void Hal_DetectWoWMode(PADAPTER pAdapter); ++#endif /* CONFIG_WOWLAN */ ++ ++void _InitBeaconParameters_8814A(PADAPTER padapter); ++void SetBeaconRelatedRegisters8814A(PADAPTER padapter); ++ ++void ReadRFType8814A(PADAPTER padapter); ++void InitDefaultValue8814A(PADAPTER padapter); ++ ++void SetHwReg8814A(PADAPTER padapter, u8 variable, u8 *pval); ++void GetHwReg8814A(PADAPTER padapter, u8 variable, u8 *pval); ++u8 SetHalDefVar8814A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++u8 GetHalDefVar8814A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++void rtl8814_set_hal_ops(struct hal_ops *pHalFunc); ++void init_hal_spec_8814a(_adapter *adapter); ++ ++/* register */ ++void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); ++void SetBcnCtrlReg(PADAPTER Adapter, u8 SetBits, u8 ClearBits); ++void rtl8814_start_thread(PADAPTER padapter); ++void rtl8814_stop_thread(PADAPTER padapter); ++ ++ ++#ifdef CONFIG_PCI_HCI ++ BOOLEAN InterruptRecognized8814AE(PADAPTER Adapter); ++ VOID UpdateInterruptMask8814AE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); ++ u16 get_txbd_idx_addr(u16 ff_hwaddr); ++#endif ++ ++#ifdef CONFIG_BT_COEXIST ++ void rtl8812a_combo_card_WifiOnlyHwInit(PADAPTER Adapter); ++#endif ++ ++#endif /* __RTL8188E_HAL_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_led.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_led.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_led.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,40 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8814A_LED_H__ ++#define __RTL8814A_LED_H__ ++ ++ ++/* ******************************************************************************** ++ * Interface to manipulate LED objects. ++ * ******************************************************************************** */ ++#ifdef CONFIG_USB_HCI ++ void rtl8814au_InitSwLeds(PADAPTER padapter); ++ void rtl8814au_DeInitSwLeds(PADAPTER padapter); ++#endif /* CONFIG_USB_HCI */ ++#ifdef CONFIG_PCI_HCI ++ void rtl8814ae_InitSwLeds(PADAPTER padapter); ++ void rtl8814ae_DeInitSwLeds(PADAPTER padapter); ++#endif /* CONFIG_PCI_HCI */ ++#ifdef CONFIG_SDIO_HCI ++ void rtl8814s_InitSwLeds(PADAPTER padapter); ++ void rtl8814s_DeInitSwLeds(PADAPTER padapter); ++#endif /* CONFIG_SDIO_HCI */ ++ ++#endif /* __RTL8814A_LED_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_recv.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_recv.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_recv.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,191 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8814A_RECV_H__ ++#define __RTL8814A_RECV_H__ ++ ++#if defined(CONFIG_USB_HCI) ++ ++ #ifndef MAX_RECVBUF_SZ ++ #ifdef PLATFORM_OS_CE ++ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ ++ #else ++ #ifndef CONFIG_MINIMAL_MEMORY_USAGE ++ #ifdef CONFIG_PLATFORM_MSTAR ++ #define MAX_RECVBUF_SZ (8192) /* 8K */ ++ #else ++ #define MAX_RECVBUF_SZ (32768) /* 32k */ ++ #endif ++ /* #define MAX_RECVBUF_SZ (24576) */ /* 24k */ ++ /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ ++ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ ++ /* #define MAX_RECVBUF_SZ (15360) */ /* 15k < 16k */ ++ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ ++ #else ++ #define MAX_RECVBUF_SZ (4000) /* about 4K */ ++ #endif ++ #endif ++ #endif /* !MAX_RECVBUF_SZ */ ++ ++#elif defined(CONFIG_PCI_HCI) ++ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ ++ /* #define MAX_RECVBUF_SZ (9100) */ ++ /* #else */ ++ #define MAX_RECVBUF_SZ (4000) /* about 4K ++ * #endif */ ++ ++ ++#elif defined(CONFIG_SDIO_HCI) ++ #if 0 ++ /* temp solution */ ++ #ifdef CONFIG_SDIO_RX_COPY ++ #define MAX_RECVBUF_SZ (10240) ++ #else /* !CONFIG_SDIO_RX_COPY */ ++ #define MAX_RECVBUF_SZ MAX_RX_DMA_BUFFER_SIZE_8821 ++ #endif /* !CONFIG_SDIO_RX_COPY */ ++ #endif ++#endif ++ ++ ++/* RX buffer descriptor */ ++/* DWORD 0 */ ++#define SET_RX_BUFFER_DESC_DATA_LENGTH_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) ++#define SET_RX_BUFFER_DESC_LS_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 14, 1, __Value) ++#define SET_RX_BUFFER_DESC_FS_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 15, 1, __Value) ++#define SET_RX_BUFFER_DESC_TOTAL_LENGTH_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 16, __Value) ++ ++#define GET_RX_BUFFER_DESC_OWN_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) ++#define GET_RX_BUFFER_DESC_LS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) ++#define GET_RX_BUFFER_DESC_FS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) ++#define GET_RX_BUFFER_DESC_TOTAL_LENGTH_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 15) ++ ++/* DWORD 1 */ ++#define SET_RX_BUFFER_PHYSICAL_LOW_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+4, 0, 32, __Value) ++#define GET_RX_BUFFER_PHYSICAL_LOW_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 0, 32) ++ ++/* DWORD 2 */ ++#define SET_RX_BUFFER_PHYSICAL_HIGH_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+8, 0, 32, __Value) ++ ++/* DWORD 3*/ /* RESERVED */ ++ ++ ++#if 0 ++ /* ============= ++ * RX Info ++ * ============== */ ++#endif ++/* DWORD 0 */ ++#define SET_RX_STATUS_DESC_PKT_LEN_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) ++#define SET_RX_STATUS_DESC_EOR_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) ++#define SET_RX_STATUS_DESC_OWN_8814AE(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) ++ ++#define GET_RX_STATUS_DESC_PKT_LEN_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) ++#define GET_RX_STATUS_DESC_CRC32_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) ++#define GET_RX_STATUS_DESC_ICV_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) ++#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) ++#define GET_RX_STATUS_DESC_SECURITY_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) ++#define GET_RX_STATUS_DESC_QOS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) ++#define GET_RX_STATUS_DESC_SHIFT_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) ++#define GET_RX_STATUS_DESC_PHY_STATUS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) ++#define GET_RX_STATUS_DESC_SWDEC_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) ++#define GET_RX_STATUS_DESC_LAST_SEG_8814AE(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 28, 1) ++#define GET_RX_STATUS_DESC_EOR_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) ++ ++/* DWORD 1 */ ++#define GET_RX_STATUS_DESC_MACID_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 0, 7) ++#define GET_RX_STATUS_DESC_EXT_SECTYPE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 7, 1)/* 20130415 KaiYuan add for 8814 */ ++#define GET_RX_STATUS_DESC_TID_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 8, 4) ++#define GET_RX_STATUS_DESC_MACID_VLD_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 12, 1) ++#define GET_RX_STATUS_DESC_AMSDU_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 13, 1) ++#define GET_RX_STATUS_DESC_RXID_MATCH_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 14, 1) ++#define GET_RX_STATUS_DESC_PAGGR_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 15, 1) ++#define GET_RX_STATUS_DESC_TCPOFFLOAD_CHKERR_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 20, 1) ++#define GET_RX_STATUS_DESC_TCPOFFLOAD_IPVER_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 21, 1) ++#define GET_RX_STATUS_DESC_TCPOFFLOAD_IS_TCPUDP_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 22, 1) ++#define GET_RX_STATUS_DESC_TCPOFFLOAD_CHK_VLD_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 23, 1) ++#define GET_RX_STATUS_DESC_PAM_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 24, 1) ++#define GET_RX_STATUS_DESC_PWR_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 25, 1) ++#define GET_RX_STATUS_DESC_MORE_DATA_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 26, 1) ++#define GET_RX_STATUS_DESC_MORE_FRAG_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 27, 1) ++#define GET_RX_STATUS_DESC_TYPE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 28, 2) ++#define GET_RX_STATUS_DESC_FIRST_SEG_8814AE(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 29, 1) ++#define GET_RX_STATUS_DESC_EOR_8814AE(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) ++#define GET_RX_STATUS_DESC_MC_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 30, 1) ++#define GET_RX_STATUS_DESC_BC_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 31, 1) ++ ++/* DWORD 2 */ ++#define GET_RX_STATUS_DESC_SEQ_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) ++#define GET_RX_STATUS_DESC_FRAG_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) ++#ifdef CONFIG_USB_RX_AGGREGATION ++ #define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 8) ++#else ++ #define GET_RX_STATUS_DESC_RX_IS_QOS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) ++#endif ++#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) ++#define GET_RX_STATUS_DESC_HWRSVD_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 24, 4) ++#define GET_RX_STATUS_C2H_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) ++#define GET_RX_STATUS_DESC_FCS_OK_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 31, 1) ++ ++/* DWORD 3 */ ++#define GET_RX_STATUS_DESC_RX_RATE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) ++#define GET_RX_STATUS_DESC_BSSID_FIT_H_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 7, 3)/* 20130415 KaiYuan add for 8814 */ ++#define GET_RX_STATUS_DESC_HTC_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) ++#define GET_RX_STATUS_DESC_EOSP_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) ++#define GET_RX_STATUS_DESC_BSSID_FIT_L_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) ++#define GET_RX_STATUS_DESC_DMA_AGG_NUM_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8)/* 20130415 KaiYuan Check if it exist anymore */ ++#define GET_RX_STATUS_DESC_PATTERN_MATCH_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 29, 1) ++#define GET_RX_STATUS_DESC_UNICAST_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 30, 1) ++#define GET_RX_STATUS_DESC_MAGIC_WAKE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 31, 1) ++ ++/* DWORD 4 */ ++#define GET_RX_STATUS_DESC_PATTERN_IDX_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+16, 0, 8) ++#define GET_RX_STATUS_DESC_RX_EOF_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+16, 8, 1) ++#define GET_RX_STATUS_DESC_RX_SCRAMBLER_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+16, 9, 7) ++#define GET_RX_STATUS_DESC_RX_PRE_NDP_VLD_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+16, 16, 1) ++#define GET_RX_STATUS_DESC_A1_FIT_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+16, 24, 5) ++ ++ ++/* DWORD 5 */ ++#define GET_RX_STATUS_DESC_TSFL_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) ++ ++ ++/* Rx smooth factor */ ++#define Rx_Smooth_Factor (20) ++ ++#ifdef CONFIG_USB_HCI ++ s32 rtl8814au_init_recv_priv(PADAPTER padapter); ++ void rtl8814au_free_recv_priv(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ s32 rtl8814ae_init_recv_priv(PADAPTER padapter); ++ void rtl8814ae_free_recv_priv(PADAPTER padapter); ++#endif ++ ++#if 0 ++ /* temp solution */ ++ #ifdef CONFIG_SDIO_HCI ++ s32 InitRecvPriv8821AS(PADAPTER padapter); ++ void FreeRecvPriv8821AS(PADAPTER padapter); ++ #endif /* CONFIG_SDIO_HCI */ ++#endif ++ ++void rtl8814_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); ++ ++#endif /* __RTL8814A_RECV_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_rf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_rf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_rf.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,33 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8814A_RF_H__ ++#define __RTL8814A_RF_H__ ++ ++VOID ++PHY_RF6052SetBandwidth8814A( ++ IN PADAPTER Adapter, ++ IN CHANNEL_WIDTH Bandwidth); ++ ++ ++int ++PHY_RF6052_Config_8814A( ++ IN PADAPTER Adapter); ++ ++#endif/* __RTL8188E_RF_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_spec.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_spec.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_spec.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,651 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ *******************************************************************************/ ++#ifndef __RTL8814A_SPEC_H__ ++#define __RTL8814A_SPEC_H__ ++ ++#include ++ ++ ++/* ************************************************************ ++ * ++ * ************************************************************ */ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0000h ~ 0x00FFh System Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_SYS_ISO_CTRL_8814A 0x0000 /* 2 Byte */ ++#define REG_SYS_FUNC_EN_8814A 0x0002 /* 2 Byte */ ++#define REG_SYS_PW_CTRL_8814A 0x0004 /* 4 Byte */ ++#define REG_SYS_CLKR_8814A 0x0008 /* 2 Byte */ ++#define REG_SYS_EEPROM_CTRL_8814A 0x000A /* 2 Byte */ ++#define REG_EE_VPD_8814A 0x000C /* 2 Byte */ ++#define REG_SYS_SWR_CTRL1_8814A 0x0010 /* 1 Byte */ ++#define REG_SPS0_CTRL_8814A 0x0011 /* 7 Byte */ ++#define REG_SYS_SWR_CTRL3_8814A 0x0018 /* 4 Byte */ ++#define REG_RSV_CTRL_8814A 0x001C /* 3 Byte */ ++#define REG_RF_CTRL0_8814A 0x001F /* 1 Byte */ ++#define REG_RF_CTRL1_8814A 0x0020 /* 1 Byte */ ++#define REG_RF_CTRL2_8814A 0x0021 /* 1 Byte */ ++#define REG_LPLDO_CTRL_8814A 0x0023 /* 1 Byte */ ++#define REG_AFE_CTRL1_8814A 0x0024 /* 4 Byte */ ++#define REG_AFE_CTRL2_8814A 0x0028 /* 4 Byte */ ++#define REG_AFE_CTRL3_8814A 0x002c /* 4 Byte */ ++#define REG_EFUSE_CTRL_8814A 0x0030 ++#define REG_LDO_EFUSE_CTRL_8814A 0x0034 ++#define REG_PWR_DATA_8814A 0x0038 ++#define REG_CAL_TIMER_8814A 0x003C ++#define REG_ACLK_MON_8814A 0x003E ++#define REG_GPIO_MUXCFG_8814A 0x0040 ++#define REG_GPIO_IO_SEL_8814A 0x0042 ++#define REG_MAC_PINMUX_CFG_8814A 0x0043 ++#define REG_GPIO_PIN_CTRL_8814A 0x0044 ++#define REG_GPIO_INTM_8814A 0x0048 ++#define REG_LEDCFG0_8814A 0x004C ++#define REG_LEDCFG1_8814A 0x004D ++#define REG_LEDCFG2_8814A 0x004E ++#define REG_LEDCFG3_8814A 0x004F ++#define REG_FSIMR_8814A 0x0050 ++#define REG_FSISR_8814A 0x0054 ++#define REG_HSIMR_8814A 0x0058 ++#define REG_HSISR_8814A 0x005c ++#define REG_GPIO_EXT_CTRL_8814A 0x0060 ++#define REG_GPIO_STATUS_8814A 0x006C ++#define REG_SDIO_CTRL_8814A 0x0070 ++#define REG_HCI_OPT_CTRL_8814A 0x0074 ++#define REG_RF_CTRL3_8814A 0x0076 /* 1 Byte */ ++#define REG_AFE_CTRL4_8814A 0x0078 ++#define REG_8051FW_CTRL_8814A 0x0080 ++#define REG_HIMR0_8814A 0x00B0 ++#define REG_HISR0_8814A 0x00B4 ++#define REG_HIMR1_8814A 0x00B8 ++#define REG_HISR1_8814A 0x00BC ++#define REG_SYS_CFG1_8814A 0x00F0 ++#define REG_SYS_CFG2_8814A 0x00FC ++#define REG_SYS_CFG3_8814A 0x1000 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0100h ~ 0x01FFh MACTOP General Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_CR_8814A 0x0100 ++#define REG_PBP_8814A 0x0104 ++#define REG_PKT_BUFF_ACCESS_CTRL_8814A 0x0106 ++#define REG_TRXDMA_CTRL_8814A 0x010C ++#define REG_TRXFF_BNDY_8814A 0x0114 ++#define REG_TRXFF_STATUS_8814A 0x0118 ++#define REG_RXFF_PTR_8814A 0x011C ++#define REG_CPWM_8814A 0x012F ++#define REG_FWIMR_8814A 0x0130 ++#define REG_FWISR_8814A 0x0134 ++#define REG_FTIMR_8814A 0x0138 ++#define REG_PKTBUF_DBG_CTRL_8814A 0x0140 ++#define REG_RXPKTBUF_CTRL_8814A 0x0142 ++#define REG_PKTBUF_DBG_DATA_L_8814A 0x0144 ++#define REG_PKTBUF_DBG_DATA_H_8814A 0x0148 ++ ++#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN ++ ++#define REG_TC0_CTRL_8814A 0x0150 ++#define REG_TC1_CTRL_8814A 0x0154 ++#define REG_TC2_CTRL_8814A 0x0158 ++#define REG_TC3_CTRL_8814A 0x015C ++#define REG_TC4_CTRL_8814A 0x0160 ++#define REG_TCUNIT_BASE_8814A 0x0164 ++#define REG_RSVD3_8814A 0x0168 ++#define REG_C2HEVT_MSG_NORMAL_8814A 0x01A0 ++#define REG_C2HEVT_CLEAR_8814A 0x01AF ++#define REG_MCUTST_1_8814A 0x01C0 ++#define REG_MCUTST_WOWLAN_8814A 0x01C7 ++#define REG_FMETHR_8814A 0x01C8 ++#define REG_HMETFR_8814A 0x01CC ++#define REG_HMEBOX_0_8814A 0x01D0 ++#define REG_HMEBOX_1_8814A 0x01D4 ++#define REG_HMEBOX_2_8814A 0x01D8 ++#define REG_HMEBOX_3_8814A 0x01DC ++#define REG_LLT_INIT_8814A 0x01E0 ++#define REG_LLT_ADDR_8814A 0x01E4 /* 20130415 KaiYuan add for 8814 */ ++#define REG_HMEBOX_EXT0_8814A 0x01F0 ++#define REG_HMEBOX_EXT1_8814A 0x01F4 ++#define REG_HMEBOX_EXT2_8814A 0x01F8 ++#define REG_HMEBOX_EXT3_8814A 0x01FC ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0200h ~ 0x027Fh TXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_FIFOPAGE_CTRL_1_8814A 0x0200 ++#define REG_FIFOPAGE_CTRL_2_8814A 0x0204 ++#define REG_AUTO_LLT_8814A 0x0208 ++#define REG_TXDMA_OFFSET_CHK_8814A 0x020C ++#define REG_TXDMA_STATUS_8814A 0x0210 ++#define REG_RQPN_NPQ_8814A 0x0214 ++#define REG_TQPNT1_8814A 0x0218 ++#define REG_TQPNT2_8814A 0x021C ++#define REG_TQPNT3_8814A 0x0220 ++#define REG_TQPNT4_8814A 0x0224 ++#define REG_RQPN_CTRL_1_8814A 0x0228 ++#define REG_RQPN_CTRL_2_8814A 0x022C ++#define REG_FIFOPAGE_INFO_1_8814A 0x0230 ++#define REG_FIFOPAGE_INFO_2_8814A 0x0234 ++#define REG_FIFOPAGE_INFO_3_8814A 0x0238 ++#define REG_FIFOPAGE_INFO_4_8814A 0x023C ++#define REG_FIFOPAGE_INFO_5_8814A 0x0240 ++ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0280h ~ 0x02FFh RXDMA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_RXDMA_AGG_PG_TH_8814A 0x0280 ++#define REG_RXPKT_NUM_8814A 0x0284 /* The number of packets in RXPKTBUF. */ ++#define REG_RXDMA_CONTROL_8814A 0x0286 /* ?????? Control the RX DMA. */ ++#define REG_RXDMA_STATUS_8814A 0x0288 ++#define REG_RXDMA_MODE_8814A 0x0290 /* ?????? */ ++#define REG_EARLY_MODE_CONTROL_8814A 0x02BC /* ?????? */ ++#define REG_RSVD5_8814A 0x02F0 /* ?????? */ ++ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0300h ~ 0x03FFh PCIe ++ * ++ * ----------------------------------------------------- */ ++#define REG_PCIE_CTRL_REG_8814A 0x0300 ++#define REG_INT_MIG_8814A 0x0304 /* Interrupt Migration */ ++#define REG_BCNQ_TXBD_DESA_8814A 0x0308 /* TX Beacon Descriptor Address */ ++#define REG_MGQ_TXBD_DESA_8814A 0x0310 /* TX Manage Queue Descriptor Address */ ++#define REG_VOQ_TXBD_DESA_8814A 0x0318 /* TX VO Queue Descriptor Address */ ++#define REG_VIQ_TXBD_DESA_8814A 0x0320 /* TX VI Queue Descriptor Address */ ++#define REG_BEQ_TXBD_DESA_8814A 0x0328 /* TX BE Queue Descriptor Address */ ++#define REG_BKQ_TXBD_DESA_8814A 0x0330 /* TX BK Queue Descriptor Address */ ++#define REG_RXQ_RXBD_DESA_8814A 0x0338 /* RX Queue Descriptor Address */ ++#define REG_HI0Q_TXBD_DESA_8814A 0x0340 ++#define REG_HI1Q_TXBD_DESA_8814A 0x0348 ++#define REG_HI2Q_TXBD_DESA_8814A 0x0350 ++#define REG_HI3Q_TXBD_DESA_8814A 0x0358 ++#define REG_HI4Q_TXBD_DESA_8814A 0x0360 ++#define REG_HI5Q_TXBD_DESA_8814A 0x0368 ++#define REG_HI6Q_TXBD_DESA_8814A 0x0370 ++#define REG_HI7Q_TXBD_DESA_8814A 0x0378 ++#define REG_MGQ_TXBD_NUM_8814A 0x0380 ++#define REG_RX_RXBD_NUM_8814A 0x0382 ++#define REG_VOQ_TXBD_NUM_8814A 0x0384 ++#define REG_VIQ_TXBD_NUM_8814A 0x0386 ++#define REG_BEQ_TXBD_NUM_8814A 0x0388 ++#define REG_BKQ_TXBD_NUM_8814A 0x038A ++#define REG_HI0Q_TXBD_NUM_8814A 0x038C ++#define REG_HI1Q_TXBD_NUM_8814A 0x038E ++#define REG_HI2Q_TXBD_NUM_8814A 0x0390 ++#define REG_HI3Q_TXBD_NUM_8814A 0x0392 ++#define REG_HI4Q_TXBD_NUM_8814A 0x0394 ++#define REG_HI5Q_TXBD_NUM_8814A 0x0396 ++#define REG_HI6Q_TXBD_NUM_8814A 0x0398 ++#define REG_HI7Q_TXBD_NUM_8814A 0x039A ++#define REG_TSFTIMER_HCI_8814A 0x039C ++ ++/* Read Write Point */ ++#define REG_VOQ_TXBD_IDX_8814A 0x03A0 ++#define REG_VIQ_TXBD_IDX_8814A 0x03A4 ++#define REG_BEQ_TXBD_IDX_8814A 0x03A8 ++#define REG_BKQ_TXBD_IDX_8814A 0x03AC ++#define REG_MGQ_TXBD_IDX_8814A 0x03B0 ++#define REG_RXQ_TXBD_IDX_8814A 0x03B4 ++#define REG_HI0Q_TXBD_IDX_8814A 0x03B8 ++#define REG_HI1Q_TXBD_IDX_8814A 0x03BC ++#define REG_HI2Q_TXBD_IDX_8814A 0x03C0 ++#define REG_HI3Q_TXBD_IDX_8814A 0x03C4 ++#define REG_HI4Q_TXBD_IDX_8814A 0x03C8 ++#define REG_HI5Q_TXBD_IDX_8814A 0x03CC ++#define REG_HI6Q_TXBD_IDX_8814A 0x03D0 ++#define REG_HI7Q_TXBD_IDX_8814A 0x03D4 ++#define REG_DBG_SEL_V1_8814A 0x03D8 ++#define REG_PCIE_HRPWM1_V1_8814A 0x03D9 ++#define REG_PCIE_HCPWM1_V1_8814A 0x03DA ++#define REG_PCIE_CTRL2_8814A 0x03DB ++#define REG_PCIE_HRPWM2_V1_8814A 0x03DC ++#define REG_PCIE_HCPWM2_V1_8814A 0x03DE ++#define REG_PCIE_H2C_MSG_V1_8814A 0x03E0 ++#define REG_PCIE_C2H_MSG_V1_8814A 0x03E4 ++#define REG_DBI_WDATA_V1_8814A 0x03E8 ++#define REG_DBI_RDATA_V1_8814A 0x03EC ++#define REG_DBI_FLAG_V1_8814A 0x03F0 ++#define REG_MDIO_V1_8814A 0x03F4 ++#define REG_PCIE_MIX_CFG_8814A 0x03F8 ++#define REG_DBG_8814A 0x03FC ++/* ----------------------------------------------------- ++ * ++ * 0x0400h ~ 0x047Fh Protocol Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_VOQ_INFORMATION_8814A 0x0400 ++#define REG_VIQ_INFORMATION_8814A 0x0404 ++#define REG_BEQ_INFORMATION_8814A 0x0408 ++#define REG_BKQ_INFORMATION_8814A 0x040C ++#define REG_MGQ_INFORMATION_8814A 0x0410 ++#define REG_HGQ_INFORMATION_8814A 0x0414 ++#define REG_BCNQ_INFORMATION_8814A 0x0418 ++#define REG_TXPKT_EMPTY_8814A 0x041A ++#define REG_CPU_MGQ_INFORMATION_8814A 0x041C ++#define REG_FWHW_TXQ_CTRL_8814A 0x0420 ++#define REG_HWSEQ_CTRL_8814A 0x0423 ++#define REG_TXPKTBUF_BCNQ_BDNY_8814A 0x0424 ++/* #define REG_MGQ_BDNY_8814A 0x0425 */ ++#define REG_LIFETIME_EN_8814A 0x0426 ++/* #define REG_FW_FREE_TAIL_8814A 0x0427 */ ++#define REG_SPEC_SIFS_8814A 0x0428 ++#define REG_RETRY_LIMIT_8814A 0x042A ++#define REG_TXBF_CTRL_8814A 0x042C ++#define REG_DARFRC_8814A 0x0430 ++#define REG_RARFRC_8814A 0x0438 ++#define REG_RRSR_8814A 0x0440 ++#define REG_ARFR0_8814A 0x0444 ++#define REG_ARFR1_8814A 0x044C ++#define REG_CCK_CHECK_8814A 0x0454 ++#define REG_AMPDU_MAX_TIME_8814A 0x0455 ++#define REG_TXPKTBUF_BCNQ1_BDNY_8814A 0x0456 ++#define REG_AMPDU_MAX_LENGTH_8814A 0x0458 ++#define REG_ACQ_STOP_8814A 0x045C ++#define REG_NDPA_RATE_8814A 0x045D ++#define REG_TX_HANG_CTRL_8814A 0x045E ++#define REG_NDPA_OPT_CTRL_8814A 0x045F ++#define REG_FAST_EDCA_CTRL_8814A 0x0460 ++#define REG_RD_RESP_PKT_TH_8814A 0x0463 ++#define REG_CMDQ_INFO_8814A 0x0464 ++#define REG_Q4_INFO_8814A 0x0468 ++#define REG_Q5_INFO_8814A 0x046C ++#define REG_Q6_INFO_8814A 0x0470 ++#define REG_Q7_INFO_8814A 0x0474 ++#define REG_WMAC_LBK_BUF_HD_8814A 0x0478 ++#define REG_MGQ_PGBNDY_8814A 0x047A ++#define REG_INIRTS_RATE_SEL_8814A 0x0480 ++#define REG_BASIC_CFEND_RATE_8814A 0x0481 ++#define REG_STBC_CFEND_RATE_8814A 0x0482 ++#define REG_DATA_SC_8814A 0x0483 ++#define REG_MACID_SLEEP3_8814A 0x0484 ++#define REG_MACID_SLEEP1_8814A 0x0488 ++#ifdef CONFIG_WOWLAN ++ #define REG_TXPKTBUF_IV_LOW 0x0484 ++ #define REG_TXPKTBUF_IV_HIGH 0x0488 ++#endif /* CONFIG_WOWLAN */ ++#define REG_ARFR2_8814A 0x048C ++#define REG_ARFR3_8814A 0x0494 ++#define REG_ARFR4_8814A 0x049C ++#define REG_ARFR5_8814A 0x04A4 ++#define REG_TXRPT_START_OFFSET_8814A 0x04AC ++#define REG_TRYING_CNT_TH_8814A 0x04B0 ++#define REG_POWER_STAGE1_8814A 0x04B4 ++#define REG_POWER_STAGE2_8814A 0x04B8 ++#define REG_SW_AMPDU_BURST_MODE_CTRL_8814A 0x04BC ++#define REG_PKT_LIFE_TIME_8814A 0x04C0 ++#define REG_PKT_BE_BK_LIFE_TIME_8814A 0x04C2 /* ?????? */ ++#define REG_STBC_SETTING_8814A 0x04C4 ++#define REG_STBC_8814A 0x04C5 ++#define REG_QUEUE_CTRL_8814A 0x04C6 ++#define REG_SINGLE_AMPDU_CTRL_8814A 0x04C7 ++#define REG_PROT_MODE_CTRL_8814A 0x04C8 ++#define REG_MAX_AGGR_NUM_8814A 0x04CA ++#define REG_RTS_MAX_AGGR_NUM_8814A 0x04CB ++#define REG_BAR_MODE_CTRL_8814A 0x04CC ++#define REG_RA_TRY_RATE_AGG_LMT_8814A 0x04CF ++#define REG_MACID_SLEEP2_8814A 0x04D0 ++#define REG_MACID_SLEEP0_8814A 0x04D4 ++#define REG_HW_SEQ0_8814A 0x04D8 ++#define REG_HW_SEQ1_8814A 0x04DA ++#define REG_HW_SEQ2_8814A 0x04DC ++#define REG_HW_SEQ3_8814A 0x04DE ++#define REG_NULL_PKT_STATUS_8814A 0x04E0 ++#define REG_PTCL_ERR_STATUS_8814A 0x04E2 ++#define REG_DROP_PKT_NUM_8814A 0x04EC ++#define REG_PTCL_TX_RPT_8814A 0x04F0 ++#define REG_Dummy_8814A 0x04FC ++ ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0500h ~ 0x05FFh EDCA Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_EDCA_VO_PARAM_8814A 0x0500 ++#define REG_EDCA_VI_PARAM_8814A 0x0504 ++#define REG_EDCA_BE_PARAM_8814A 0x0508 ++#define REG_EDCA_BK_PARAM_8814A 0x050C ++#define REG_BCNTCFG_8814A 0x0510 ++#define REG_PIFS_8814A 0x0512 ++#define REG_RDG_PIFS_8814A 0x0513 ++#define REG_SIFS_CTX_8814A 0x0514 ++#define REG_SIFS_TRX_8814A 0x0516 ++#define REG_AGGR_BREAK_TIME_8814A 0x051A ++#define REG_SLOT_8814A 0x051B ++#define REG_TX_PTCL_CTRL_8814A 0x0520 ++#define REG_TXPAUSE_8814A 0x0522 ++#define REG_DIS_TXREQ_CLR_8814A 0x0523 ++#define REG_RD_CTRL_8814A 0x0524 ++/* ++ * Format for offset 540h-542h: ++ * [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. ++ * [7:4]: Reserved. ++ * [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. ++ * [23:20]: Reserved ++ * Description: ++ * | ++ * |<--Setup--|--Hold------------>| ++ * --------------|---------------------- ++ * | ++ * TBTT ++ * Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. ++ * Described by Designer Tim and Bruce, 2011-01-14. ++ * */ ++#define REG_TBTT_PROHIBIT_8814A 0x0540 ++#define REG_RD_NAV_NXT_8814A 0x0544 ++#define REG_NAV_PROT_LEN_8814A 0x0546 ++#define REG_BCN_CTRL_8814A 0x0550 ++#define REG_BCN_CTRL_1_8814A 0x0551 ++#define REG_MBID_NUM_8814A 0x0552 ++#define REG_DUAL_TSF_RST_8814A 0x0553 ++#define REG_MBSSID_BCN_SPACE_8814A 0x0554 ++#define REG_DRVERLYINT_8814A 0x0558 ++#define REG_BCNDMATIM_8814A 0x0559 ++#define REG_ATIMWND_8814A 0x055A ++#define REG_USTIME_TSF_8814A 0x055C ++#define REG_BCN_MAX_ERR_8814A 0x055D ++#define REG_RXTSF_OFFSET_CCK_8814A 0x055E ++#define REG_RXTSF_OFFSET_OFDM_8814A 0x055F ++#define REG_TSFTR_8814A 0x0560 ++#define REG_CTWND_8814A 0x0572 ++#define REG_SECONDARY_CCA_CTRL_8814A 0x0577 /* ?????? */ ++#define REG_PSTIMER_8814A 0x0580 ++#define REG_TIMER0_8814A 0x0584 ++#define REG_TIMER1_8814A 0x0588 ++#define REG_BCN_PREDL_ITV_8814A 0x058F /* Pre download beacon interval */ ++#define REG_ACMHWCTRL_8814A 0x05C0 ++#define REG_P2P_RST_8814A 0x05F0 ++ ++/* ----------------------------------------------------- ++ * ++ * 0x0600h ~ 0x07FFh WMAC Configuration ++ * ++ * ----------------------------------------------------- */ ++#define REG_MAC_CR_8814A 0x0600 ++#define REG_TCR_8814A 0x0604 ++#define REG_RCR_8814A 0x0608 ++#define REG_RX_PKT_LIMIT_8814A 0x060C ++#define REG_RX_DLK_TIME_8814A 0x060D ++#define REG_RX_DRVINFO_SZ_8814A 0x060F ++ ++#define REG_MACID_8814A 0x0610 ++#define REG_BSSID_8814A 0x0618 ++#define REG_MAR_8814A 0x0620 ++#define REG_MBIDCAMCFG_8814A 0x0628 ++ ++#define REG_USTIME_EDCA_8814A 0x0638 ++#define REG_MAC_SPEC_SIFS_8814A 0x063A ++#define REG_RESP_SIFP_CCK_8814A 0x063C ++#define REG_RESP_SIFS_OFDM_8814A 0x063E ++#define REG_ACKTO_8814A 0x0640 ++#define REG_CTS2TO_8814A 0x0641 ++#define REG_EIFS_8814A 0x0642 ++ ++#define REG_NAV_UPPER_8814A 0x0652 /* unit of 128 */ ++#define REG_TRXPTCL_CTL_8814A 0x0668 ++ ++/* Security */ ++#define REG_CAMCMD_8814A 0x0670 ++#define REG_CAMWRITE_8814A 0x0674 ++#define REG_CAMREAD_8814A 0x0678 ++#define REG_CAMDBG_8814A 0x067C ++#define REG_SECCFG_8814A 0x0680 ++ ++/* Power */ ++#define REG_WOW_CTRL_8814A 0x0690 ++#define REG_PS_RX_INFO_8814A 0x0692 ++#define REG_UAPSD_TID_8814A 0x0693 ++#define REG_WKFMCAM_NUM_8814A 0x0698 ++#define REG_RXFLTMAP0_8814A 0x06A0 ++#define REG_RXFLTMAP1_8814A 0x06A2 ++#define REG_RXFLTMAP2_8814A 0x06A4 ++#define REG_BCN_PSR_RPT_8814A 0x06A8 ++#define REG_BT_COEX_TABLE_8814A 0x06C0 ++#define REG_TX_DATA_RSP_RATE_8814A 0x06DE ++#define REG_ASSOCIATED_BFMER0_INFO_8814A 0x06E4 ++#define REG_ASSOCIATED_BFMER1_INFO_8814A 0x06EC ++#define REG_CSI_RPT_PARAM_BW20_8814A 0x06F4 ++#define REG_CSI_RPT_PARAM_BW40_8814A 0x06F8 ++#define REG_CSI_RPT_PARAM_BW80_8814A 0x06FC ++ ++/* Hardware Port 2 */ ++#define REG_MACID1_8814A 0x0700 ++#define REG_BSSID1_8814A 0x0708 ++/* Hardware Port 3 */ ++#define REG_MACID2_8814A 0x1620 ++#define REG_BSSID2_8814A 0x1628 ++/* Hardware Port 4 */ ++#define REG_MACID3_8814A 0x1630 ++#define REG_BSSID3_8814A 0x1638 ++/* Hardware Port 5 */ ++#define REG_MACID4_8814A 0x1640 ++#define REG_BSSID4_8814A 0x1648 ++ ++#define REG_ASSOCIATED_BFMEE_SEL_8814A 0x0714 ++#define REG_SND_PTCL_CTRL_8814A 0x0718 ++#define REG_IQ_DUMP_8814A 0x07C0 ++ ++/**** page 19 ****/ ++/* TX BeamForming */ ++#define REG_BB_TXBF_ANT_SET_BF1 0x19ac ++#define REG_BB_TXBF_ANT_SET_BF0 0x19b4 ++ ++/* 0x1200h ~ 0x12FFh DDMA CTRL ++ * ++ * ----------------------------------------------------- */ ++#define REG_DDMA_CH0SA 0x1200 ++#define REG_DDMA_CH0DA 0x1204 ++#define REG_DDMA_CH0CTRL 0x1208 ++#define REG_DDMA_CH1SA 0x1210 ++#define REG_DDMA_CH1DA 0x1214 ++#define REG_DDMA_CH1CTRL 0x1218 ++#define REG_DDMA_CH2SA 0x1220 ++#define REG_DDMA_CH2DA 0x1224 ++#define REG_DDMA_CH2CTRL 0x1228 ++#define REG_DDMA_CH3SA 0x1230 ++#define REG_DDMA_CH3DA 0x1234 ++#define REG_DDMA_CH3CTRL 0x1238 ++#define REG_DDMA_CH4SA 0x1240 ++#define REG_DDMA_CH4DA 0x1244 ++#define REG_DDMA_CH4CTRL 0x1248 ++#define REG_DDMA_CH5SA 0x1250 ++#define REG_DDMA_CH5DA 0x1254 ++#define REG_DDMA_CH5CTRL 0x1258 ++#define REG_DDMA_INT_MSK 0x12E0 ++#define REG_DDMA_CHSTATUS 0x12E8 ++#define REG_DDMA_CHKSUM 0x12F0 ++#define REG_DDMA_MONITER 0x12FC ++ ++#define DDMA_LEN_MASK 0x0001FFFF ++#define FW_CHKSUM_DUMMY_SZ 8 ++#define DDMA_CH_CHKSUM_CNT BIT(24) ++#define DDMA_RST_CHKSUM_STS BIT(25) ++#define DDMA_MODE_BLOCK_CPU BIT(26) ++#define DDMA_CHKSUM_FAIL BIT(27) ++#define DDMA_DA_W_DISABLE BIT(28) ++#define DDMA_CHKSUM_EN BIT(29) ++#define DDMA_CH_OWN BIT(31) ++ ++ ++/* 3081 FWDL */ ++#define FWDL_EN BIT0 ++#define IMEM_BOOT_DL_RDY BIT1 ++#define IMEM_BOOT_CHKSUM_FAIL BIT2 ++#define IMEM_DL_RDY BIT3 ++#define IMEM_CHKSUM_OK BIT4 ++#define DMEM_DL_RDY BIT5 ++#define DMEM_CHKSUM_OK BIT6 ++#define EMEM_DL_RDY BIT7 ++#define EMEM_CHKSUM_FAIL BIT8 ++#define EMEM_TXBUF_DL_RDY BIT9 ++#define EMEM_TXBUF_CHKSUM_FAIL BIT10 ++#define CPU_CLK_SWITCH_BUSY BIT11 ++#define CPU_CLK_SEL (BIT12 | BIT13) ++#define FWDL_OK BIT14 ++#define FW_INIT_RDY BIT15 ++#define R_EN_BOOT_FLASH BIT20 ++ ++#define OCPBASE_IMEM_3081 0x00000000 ++#define OCPBASE_DMEM_3081 0x00200000 ++#define OCPBASE_RPTBUF_3081 0x18660000 ++#define OCPBASE_RXBUF2_3081 0x18680000 ++#define OCPBASE_RXBUF_3081 0x18700000 ++#define OCPBASE_TXBUF_3081 0x18780000 ++ ++ ++#define REG_FAST_EDCA_VOVI_SETTING_8814A 0x1448 ++#define REG_FAST_EDCA_BEBK_SETTING_8814A 0x144C ++ ++ ++/* ----------------------------------------------------- ++ * */ ++ ++ ++/* ----------------------------------------------------- ++ * ++ * Redifine 8192C register definition for compatibility ++ * ++ * ----------------------------------------------------- */ ++ ++/* TODO: use these definition when using REG_xxx naming rule. ++ * NOTE: DO NOT Remove these definition. Use later. */ ++#define EFUSE_CTRL_8814A REG_EFUSE_CTRL_8814A /* E-Fuse Control. */ ++#define EFUSE_TEST_8814A REG_LDO_EFUSE_CTRL_8814A /* E-Fuse Test. */ ++#define MSR_8814A (REG_CR_8814A + 2) /* Media Status register */ ++#define ISR_8814A REG_HISR0_8814A ++#define TSFR_8814A REG_TSFTR_8814A /* Timing Sync Function Timer Register. */ ++ ++#define PBP_8814A REG_PBP_8814A ++ ++/* Redifine MACID register, to compatible prior ICs. */ ++#define IDR0_8814A REG_MACID_8814A /* MAC ID Register, Offset 0x0050-0x0053 */ ++#define IDR4_8814A (REG_MACID_8814A + 4) /* MAC ID Register, Offset 0x0054-0x0055 */ ++ ++ ++/* ++ * 9. Security Control Registers (Offset: ) ++ * */ ++#define RWCAM_8814A REG_CAMCMD_8814A /* IN 8190 Data Sheet is called CAMcmd */ ++#define WCAMI_8814A REG_CAMWRITE_8814A /* Software write CAM input content */ ++#define RCAMO_8814A REG_CAMREAD_8814A /* Software read/write CAM config */ ++#define CAMDBG_8814A REG_CAMDBG_8814A ++#define SECR_8814A REG_SECCFG_8814A /* Security Configuration Register */ ++ ++ ++/* ---------------------------------------------------------------------------- ++ * 8195 IMR/ISR bits (offset 0xB0, 8bits) ++ * ---------------------------------------------------------------------------- */ ++#define IMR_DISABLED_8814A 0 ++/* IMR DW0(0x00B0-00B3) Bit 0-31 */ ++#define IMR_TIMER2_8814A BIT31 /* Timeout interrupt 2 */ ++#define IMR_TIMER1_8814A BIT30 /* Timeout interrupt 1 */ ++#define IMR_PSTIMEOUT_8814A BIT29 /* Power Save Time Out Interrupt */ ++#define IMR_GTINT4_8814A BIT28 /* When GTIMER4 expires, this bit is set to 1 */ ++#define IMR_GTINT3_8814A BIT27 /* When GTIMER3 expires, this bit is set to 1 */ ++#define IMR_TXBCN0ERR_8814A BIT26 /* Transmit Beacon0 Error */ ++#define IMR_TXBCN0OK_8814A BIT25 /* Transmit Beacon0 OK */ ++#define IMR_TSF_BIT32_TOGGLE_8814A BIT24 /* TSF Timer BIT32 toggle indication interrupt */ ++#define IMR_BCNDMAINT0_8814A BIT20 /* Beacon DMA Interrupt 0 */ ++#define IMR_BCNDERR0_8814A BIT16 /* Beacon Queue DMA OK0 */ ++#define IMR_HSISR_IND_ON_INT_8814A BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ ++#define IMR_BCNDMAINT_E_8814A BIT14 /* Beacon DMA Interrupt Extension for Win7 */ ++#define IMR_ATIMEND_8814A BIT12 /* CTWidnow End or ATIM Window End */ ++#define IMR_C2HCMD_8814A BIT10 /* CPU to Host Command INT Status, Write 1 clear */ ++#define IMR_CPWM2_8814A BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_CPWM_8814A BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ ++#define IMR_HIGHDOK_8814A BIT7 /* High Queue DMA OK */ ++#define IMR_MGNTDOK_8814A BIT6 /* Management Queue DMA OK */ ++#define IMR_BKDOK_8814A BIT5 /* AC_BK DMA OK */ ++#define IMR_BEDOK_8814A BIT4 /* AC_BE DMA OK */ ++#define IMR_VIDOK_8814A BIT3 /* AC_VI DMA OK */ ++#define IMR_VODOK_8814A BIT2 /* AC_VO DMA OK */ ++#define IMR_RDU_8814A BIT1 /* Rx Descriptor Unavailable */ ++#define IMR_ROK_8814A BIT0 /* Receive DMA OK */ ++ ++/* IMR DW1(0x00B4-00B7) Bit 0-31 */ ++#define IMR_MCUERR_8814A BIT28 /* Beacon DMA Interrupt 7 */ ++#define IMR_BCNDMAINT7_8814A BIT27 /* Beacon DMA Interrupt 7 */ ++#define IMR_BCNDMAINT6_8814A BIT26 /* Beacon DMA Interrupt 6 */ ++#define IMR_BCNDMAINT5_8814A BIT25 /* Beacon DMA Interrupt 5 */ ++#define IMR_BCNDMAINT4_8814A BIT24 /* Beacon DMA Interrupt 4 */ ++#define IMR_BCNDMAINT3_8814A BIT23 /* Beacon DMA Interrupt 3 */ ++#define IMR_BCNDMAINT2_8814A BIT22 /* Beacon DMA Interrupt 2 */ ++#define IMR_BCNDMAINT1_8814A BIT21 /* Beacon DMA Interrupt 1 */ ++#define IMR_BCNDOK7_8814A BIT20 /* Beacon Queue DMA OK Interrup 7 */ ++#define IMR_BCNDOK6_8814A BIT19 /* Beacon Queue DMA OK Interrup 6 */ ++#define IMR_BCNDOK5_8814A BIT18 /* Beacon Queue DMA OK Interrup 5 */ ++#define IMR_BCNDOK4_8814A BIT17 /* Beacon Queue DMA OK Interrup 4 */ ++#define IMR_BCNDOK3_8814A BIT16 /* Beacon Queue DMA OK Interrup 3 */ ++#define IMR_BCNDOK2_8814A BIT15 /* Beacon Queue DMA OK Interrup 2 */ ++#define IMR_BCNDOK1_8814A BIT14 /* Beacon Queue DMA OK Interrup 1 */ ++#define IMR_ATIMEND_E_8814A BIT13 /* ATIM Window End Extension for Win7 */ ++#define IMR_TXERR_8814A BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ ++#define IMR_RXERR_8814A BIT10 /* Rx Error Flag INT Status, Write 1 clear */ ++#define IMR_TXFOVW_8814A BIT9 /* Transmit FIFO Overflow */ ++#define IMR_RXFOVW_8814A BIT8 /* Receive FIFO Overflow */ ++ ++ ++#ifdef CONFIG_PCI_HCI ++ #define IMR_TX_MASK (IMR_VODOK_8814A | IMR_VIDOK_8814A | IMR_BEDOK_8814A | IMR_BKDOK_8814A | IMR_MGNTDOK_8814A | IMR_HIGHDOK_8814A) ++ ++ #define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8814A | IMR_TXBCN0OK_8814A | IMR_TXBCN0ERR_8814A | IMR_BCNDERR0_8814A) ++ ++ #define RT_AC_INT_MASKS (IMR_VIDOK_8814A | IMR_VODOK_8814A | IMR_BEDOK_8814A | IMR_BKDOK_8814A) ++#endif ++ ++ ++/*=================================================================== ++===================================================================== ++Here the register defines are for 92C. When the define is as same with 92C, ++we will use the 92C's define for the consistency ++So the following defines for 92C is not entire!!!!!! ++===================================================================== ++=====================================================================*/ ++ ++ ++/* ----------------------------------------------------- ++ * ++ * 0xFE00h ~ 0xFE55h USB Configuration ++ * ++ * ----------------------------------------------------- */ ++ ++/* 2 Special Option */ ++#define USB_AGG_EN_8814A BIT(7) ++#define REG_USB_HRPWM_U3 0xF052 ++ ++#define LAST_ENTRY_OF_TX_PKT_BUFFER_8814A (2048-1) /* 20130415 KaiYuan add for 8814 */ ++ ++#define MACID_NUM_8814A 128 ++#define SEC_CAM_ENT_NUM_8814A 64 ++#define HW_PORT_NUM_8814A 5 ++#define NSS_NUM_8814A 3 ++#define BAND_CAP_8814A (BAND_CAP_2G | BAND_CAP_5G) ++#define BW_CAP_8814A (BW_CAP_20M | BW_CAP_40M | BW_CAP_80M) ++#define PROTO_CAP_8814A (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N | PROTO_CAP_11AC) ++ ++#endif /* __RTL8814A_SPEC_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_sreset.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_sreset.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_sreset.h 2018-02-11 21:44:27.170146436 +0200 +@@ -0,0 +1,29 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL88814A_SRESET_H_ ++#define _RTL8814A_SRESET_H_ ++ ++#include ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ extern void rtl8814_sreset_xmit_status_check(_adapter *padapter); ++ extern void rtl8814_sreset_linked_status_check(_adapter *padapter); ++#endif ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_xmit.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_xmit.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_xmit.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,310 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8814A_XMIT_H__ ++#define __RTL8814A_XMIT_H__ ++ ++typedef struct txdescriptor_8814 { ++ /* Offset 0 */ ++ u32 pktlen:16; ++ u32 offset:8; ++ u32 bmc:1; ++ u32 htc:1; ++ u32 ls:1; ++} TXDESC_8814, *PTXDESC_8814; ++ ++ ++#define OFFSET_SZ 0 ++#define OFFSET_SHT 16 ++ ++ ++ ++#ifdef CONFIG_SDIO_HCI ++ #define SET_TX_DESC_SDIO_TXSEQ_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) ++#endif /* CONFIG_SDIO_HCI */ ++ ++/* ----------------------------------------------------------------- ++ * RTL8814A TX BUFFER DESC ++ * ----------------------------------------------------------------- ++ * ++- Each TXBD has 4 segment. ++ -- For 32 bit, each segment is 8 bytes. ++ -- For 64 bit, each segment is 16 bytes. ++*/ ++#if 0 ++ #if 1 /* 32 bit */ ++ #define SET_TX_EXTBUFF_DESC_LEN_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*8), 0, 16, __Value) ++ #define SET_TX_EXTBUFF_DESC_ADDR_LOW_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*8)+4, 0, 32, __Value) ++ #else /* 64 bit */ ++ #define SET_TX_EXTBUFF_DESC_LEN_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*16), 0, 16, __Value) ++ #define SET_TX_EXTBUFF_DESC_ADDR_LOW_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*16)+4, 0, 32, __Value) ++ #endif ++ #define SET_TX_EXTBUFF_DESC_ADDR_HIGH_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*16)+8, 0, 32, __Value) ++#endif ++/*c2h-DWORD 2*/ ++#define GET_RX_STATUS_DESC_RPT_SEL_8814A(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+8, 28, 1) ++ ++/* ********************************************************* ++ * for Txfilldescroptor8814Ae, fill the desc content. */ ++#if 1 /* 32 bit */ ++ #define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*8), 0, 16, __Valeu) ++ #define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*8), 31, 1, __Valeu) ++ #define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*8)+4, 0, 32, __Valeu) ++#else /* 64 bit */ ++ #define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 0, 16, __Valeu) ++ #define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 31, 1, __Valeu) ++ #define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+4, 0, 32, __Valeu) ++#endif ++#define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+8, 0, 32, __Valeu) ++ ++/* ********************************************************* */ ++ ++/* TX buffer ++ * ************* ++ * Dword 0 */ ++#define SET_TX_BUFF_DESC_LEN_0_8814A(__pTxDesc, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Valeu) ++#define SET_TX_BUFF_DESC_PSB_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 15, __Value) ++#define SET_TX_BUFF_DESC_OWN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) ++#define GET_TX_BUFF_DESC_OWN_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) ++ ++/* Dword 1 */ ++#define SET_TX_BUFF_DESC_ADDR_LOW_0_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 32, __Value) ++#define GET_TX_BUFF_DESC_ADDR_LOW_0_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+4, 0, 32) ++/* Dword 2 */ ++#define SET_TX_BUFF_DESC_ADDR_HIGH_0_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 32, __Value) ++#define GET_TX_BUFF_DESC_ADDR_HIGH_0_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+8, 0, 32) ++/* Dword 3 */ /* RESERVED 0 */ ++ ++#if 0 /* 64 bit */ ++ /* Dword 4 */ ++ #define SET_TX_BUFF_DESC_LEN_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 16, __Value) ++ #define SET_TX_BUFF_DESC_AMSDU_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 31, 1, __Value) ++ /* Dword 5 */ ++ #define SET_TX_BUFF_DESC_ADDR_LOW_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 32, __Value) ++ /* Dword 6 */ ++ #define SET_TX_BUFF_DESC_ADDR_HIGH_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 32, __Value) ++ /* Dword 7 */ /* RESERVED 0 */ ++ /* Dword 8 */ ++ #define SET_TX_BUFF_DESC_LEN_2_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 16, __Value) ++ #define SET_TX_BUFF_DESC_AMSDU_2_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 31, 1, __Value) ++ /* Dword 9 */ ++ #define SET_TX_BUFF_DESC_ADDR_LOW_2_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 32, __Value) ++ /* Dword 10 */ ++ #define SET_TX_BUFF_DESC_ADDR_HIGH_2_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) ++ /* Dword 11 */ /* RESERVED 0 */ ++ /* Dword 12 */ ++ #define SET_TX_BUFF_DESC_LEN_3_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 16, __Value) ++ #define SET_TX_BUFF_DESC_AMSDU_3_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 31, 1, __Value) ++ /* Dword 13 */ ++ #define SET_TX_BUFF_DESC_ADDR_LOW_3_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+52, 0, 32, __Value) ++ /* Dword 14 */ ++ #define SET_TX_BUFF_DESC_ADDR_HIGH_3_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+56, 0, 32, __Value) ++ /* Dword 15 */ /* RESERVED 0 */ ++#endif ++ ++/* *****Desc content ++ * TX Info ++ * ************* ++ * Dword 0 */ ++#define SET_TX_DESC_PKT_SIZE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) ++#define GET_TX_DESC_PKT_SIZE_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 0, 16) ++#define SET_TX_DESC_OFFSET_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) ++#define GET_TX_DESC_OFFSET_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 16, 8) ++#define SET_TX_DESC_BMC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) ++#define SET_TX_DESC_HTC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) ++#define SET_TX_DESC_LAST_SEG_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) ++#define SET_TX_DESC_LINIP_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) ++#define SET_TX_DESC_AMSDU_PAD_EN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) ++#define SET_TX_DESC_NO_ACM_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) ++#define SET_TX_DESC_GF_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) ++#define SET_TX_DESC_DISQSELSEQ_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) ++ ++/* Dword 1 */ ++#define SET_TX_DESC_MACID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) ++#define SET_TX_DESC_QUEUE_SEL_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) ++#define SET_TX_DESC_RDG_NAV_EXT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) ++#define SET_TX_DESC_LSIG_TXOP_EN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) ++#define SET_TX_DESC_PIFS_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) ++#define SET_TX_DESC_RATE_ID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) ++#define SET_TX_DESC_EN_DESC_ID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) ++#define SET_TX_DESC_SEC_TYPE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) ++#define SET_TX_DESC_PKT_OFFSET_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) ++#define SET_TX_DESC_MORE_DATA_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 29, 1, __Value) ++#define SET_TX_DESC_TXOP_PS_CAP_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 30, 1, __Value) ++#define SET_TX_DESC_TXOP_PS_MODE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 31, 1, __Value) ++ ++ ++/* Dword 2 */ ++#define SET_TX_DESC_PAID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) ++#define SET_TX_DESC_CCA_RTS_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) ++#define SET_TX_DESC_AGG_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) ++#define SET_TX_DESC_RDG_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) ++#define SET_TX_DESC_NULL_0_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 14, 1, __Value) ++#define SET_TX_DESC_NULL_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 15, 1, __Value) ++#define SET_TX_DESC_BK_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) ++#define SET_TX_DESC_MORE_FRAG_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) ++#define GET_TX_DESC_MORE_FRAG_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+8, 17, 1) ++#define SET_TX_DESC_RAW_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) ++#define SET_TX_DESC_SPE_RPT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) ++#define SET_TX_DESC_AMPDU_DENSITY_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) ++#define SET_TX_DESC_BT_NULL_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) ++#define SET_TX_DESC_GID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) ++#define SET_TX_DESC_HW_AES_IV_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 31, 1, __Value) ++ ++ ++/* Dword 3 */ ++#define SET_TX_DESC_WHEADER_LEN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 5, __Value) ++#define SET_TX_DESC_EARLY_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) ++#define SET_TX_DESC_HW_SSN_SEL_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) ++#define SET_TX_DESC_USE_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) ++#define SET_TX_DESC_DISABLE_RTS_FB_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) ++#define SET_TX_DESC_DISABLE_FB_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) ++#define SET_TX_DESC_CTS2SELF_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) ++#define SET_TX_DESC_RTS_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) ++#define SET_TX_DESC_HW_RTS_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) ++#define SET_TX_DESC_CHECK_EN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 14, 1, __Value) ++#define SET_TX_DESC_NAV_USE_HDR_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) ++#define SET_TX_DESC_USE_MAX_LEN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) ++#define SET_TX_DESC_MAX_AGG_NUM_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) ++#define SET_TX_DESC_NDPA_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) ++#define SET_TX_DESC_AMPDU_MAX_TIME_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) ++ ++/* Dword 4 */ ++#define SET_TX_DESC_TX_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) ++#define SET_TX_DESC_TRY_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 7, 1, __Value) ++#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) ++#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) ++#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) ++#define SET_TX_DESC_DATA_RETRY_LIMIT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) ++#define SET_TX_DESC_RTS_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) ++#define SET_TX_DESC_PCTS_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 29, 1, __Value) ++#define SET_TX_DESC_PCTS_MASK_IDX_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 30, 2, __Value) ++ ++ ++/* Dword 5 */ ++#define SET_TX_DESC_DATA_SC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) ++#define SET_TX_DESC_DATA_SHORT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) ++#define SET_TX_DESC_DATA_BW_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) ++#define SET_TX_DESC_DATA_LDPC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) ++#define SET_TX_DESC_DATA_STBC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) ++#define SET_TX_DESC_CTROL_STBC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) ++#define SET_TX_DESC_RTS_SHORT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) ++#define SET_TX_DESC_RTS_SC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) ++#define SET_TX_DESC_SIGNALING_TA_PKT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 17, 1, __Value) ++#define SET_TX_DESC_PORT_ID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 21, 3, __Value)/* 20130415 KaiYuan add for 8814 */ ++#define SET_TX_DESC_TX_ANT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 4, __Value) ++#define SET_TX_DESC_TX_POWER_OFFSET_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 28, 3, __Value) ++ ++/* Dword 6 */ ++#define SET_TX_DESC_SW_DEFINE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) ++#define SET_TX_DESC_MBSSID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) ++#define SET_TX_DESC_ANTSEL_A_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) ++#define SET_TX_DESC_ANTSEL_B_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) ++#define SET_TX_DESC_ANT_MAPA_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 2, __Value) ++#define SET_TX_DESC_ANT_MAPB_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 24, 2, __Value) ++#define SET_TX_DESC_ANT_MAPC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 26, 2, __Value) ++#define SET_TX_DESC_ANT_MAPD_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 28, 2, __Value) ++ ++ ++/* Dword 7 */ ++#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++ #define SET_TX_DESC_TX_BUFFER_SIZE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++#else ++ #define SET_TX_DESC_TX_DESC_CHECKSUM_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++#endif ++#define SET_TX_DESC_NTX_MAP_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 20, 4, __Value) ++#define SET_TX_DESC_USB_TXAGG_NUM_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) ++ ++ ++/* Dword 8 */ ++#define SET_TX_DESC_RTS_RC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 6, __Value) ++#define SET_TX_DESC_BAR_RTY_TH_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 6, 2, __Value) ++#define SET_TX_DESC_DATA_RC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 8, 6, __Value) ++#define SET_TX_DESC_EN_HWEXSEQ_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 14, 1, __Value) ++#define SET_TX_DESC_HWSEQ_EN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) ++#if (DEV_BUS_TYPE != RT_SDIO_INTERFACE) ++ #define SET_TX_DESC_NEXT_HEAD_PAGE_L_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) ++#else ++ #define SET_TX_DESC_SDIO_SEQ_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) /* 20130415 KaiYuan add for 8814AS */ ++#endif ++#define SET_TX_DESC_TAIL_PAGE_L_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 24, 8, __Value) ++ ++/* Dword 9 */ ++#define SET_TX_DESC_PADDING_LENGTH_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 11, __Value) ++#define SET_TX_DESC_TXBF_PATH_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 11, 1, __Value) ++#define SET_TX_DESC_SEQ_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) ++#define SET_TX_DESC_NEXT_HEAD_PAGE_H_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 24, 4, __Value) ++#define SET_TX_DESC_TAIL_PAGE_H_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 28, 4, __Value) ++ ++ ++ ++#define SET_EARLYMODE_PKTNUM_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) ++#define SET_EARLYMODE_LEN0_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) ++#define SET_EARLYMODE_LEN1_1_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) ++#define SET_EARLYMODE_LEN1_2_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) ++#define SET_EARLYMODE_LEN2_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) ++#define SET_EARLYMODE_LEN3_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) ++ ++ ++void rtl8814a_cal_txdesc_chksum(u8 *ptxdesc); ++void rtl8814a_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); ++void rtl8814a_fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc); ++void rtl8814a_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); ++void rtl8814a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); ++#if defined(CONFIG_CONCURRENT_MODE) ++ void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ s32 rtl8814au_init_xmit_priv(PADAPTER padapter); ++ void rtl8814au_free_xmit_priv(PADAPTER padapter); ++ s32 rtl8814au_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8814au_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8814au_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8814au_xmit_buf_handler(PADAPTER padapter); ++ void rtl8814au_xmit_tasklet(void *priv); ++ s32 rtl8814au_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++#endif /* CONFIG_USB_HCI */ ++ ++#ifdef CONFIG_PCI_HCI ++ s32 rtl8814ae_init_xmit_priv(PADAPTER padapter); ++ void rtl8814ae_free_xmit_priv(PADAPTER padapter); ++ struct xmit_buf *rtl8814ae_dequeue_xmitbuf(struct rtw_tx_ring *ring); ++ void rtl8814ae_xmitframe_resume(_adapter *padapter); ++ s32 rtl8814ae_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++ s32 rtl8814ae_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++ s32 rtl8814ae_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++ void rtl8814ae_xmit_tasklet(void *priv); ++#endif ++ ++void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, u8 *ptxdesc); ++u8 ++SCMapping_8814( ++ IN PADAPTER Adapter, ++ IN struct pkt_attrib *pattrib ++); ++ ++u8 ++BWMapping_8814( ++ IN PADAPTER Adapter, ++ IN struct pkt_attrib *pattrib ++); ++ ++ ++#endif /* __RTL8814_XMIT_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8821a_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821a_spec.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8821a_spec.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821a_spec.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,108 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ *******************************************************************************/ ++#ifndef __RTL8821A_SPEC_H__ ++#define __RTL8821A_SPEC_H__ ++ ++#include ++/* This file should based on "hal_com_reg.h" */ ++#include ++/* Because 8812a and 8821a is the same serial, ++ * most of 8821a register definitions are the same as 8812a. */ ++#include ++ ++ ++/* ************************************************************ ++ * 8821A Regsiter offset definition ++ * ************************************************************ */ ++ ++/* ************************************************************ ++ * MAC register ++ * ************************************************************ */ ++ ++/* ----------------------------------------------------- ++ * 0x0000h ~ 0x00FFh System Configuration ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * 0x0100h ~ 0x01FFh MACTOP General Configuration ++ * ----------------------------------------------------- */ ++#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN ++ ++/* ----------------------------------------------------- ++ * 0x0200h ~ 0x027Fh TXDMA Configuration ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * 0x0280h ~ 0x02FFh RXDMA Configuration ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * 0x0300h ~ 0x03FFh PCIe ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * 0x0400h ~ 0x047Fh Protocol Configuration ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * 0x0500h ~ 0x05FFh EDCA Configuration ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * 0x0600h ~ 0x07FFh WMAC Configuration ++ * ----------------------------------------------------- */ ++ ++ ++/* ************************************************************ ++ * SDIO Bus Specification ++ * ************************************************************ */ ++ ++/* ----------------------------------------------------- ++ * SDIO CMD Address Mapping ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * I/O bus domain (Host) ++ * ----------------------------------------------------- */ ++ ++/* ----------------------------------------------------- ++ * SDIO register ++ * ----------------------------------------------------- */ ++#undef SDIO_REG_HCPWM1 ++#define SDIO_REG_FREE_TXPG2 0x024 ++#define SDIO_REG_HCPWM1 0x025 ++ ++ ++/* ************************************************************ ++ * Regsiter Bit and Content definition ++ * ************************************************************ */ ++ ++/* ******************************************************** ++ * General definitions ++ * ******************************************************** */ ++ ++#define MACID_NUM_8821A 128 ++#define SEC_CAM_ENT_NUM_8821A 64 ++#define HW_PORT_NUM_8821A 2 ++#define NSS_NUM_8821A 1 ++#define BAND_CAP_8821A (BAND_CAP_2G | BAND_CAP_5G) ++#define BW_CAP_8821A (BW_CAP_20M | BW_CAP_40M | BW_CAP_80M) ++#define PROTO_CAP_8821A (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N | PROTO_CAP_11AC) ++ ++#endif /* __RTL8821A_SPEC_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8821a_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821a_xmit.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8821a_xmit.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821a_xmit.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,178 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTL8821A_XMIT_H__ ++#define __RTL8821A_XMIT_H__ ++ ++#include ++ ++typedef struct txdescriptor_8821a { ++ /* Offset 0 */ ++ u32 pktlen:16; ++ u32 offset:8; ++ u32 bmc:1; ++ u32 htc:1; ++ u32 rsvd0026:1; ++ u32 rsvd0027:1; ++ u32 linip:1; ++ u32 noacm:1; ++ u32 gf:1; ++ u32 rsvd0031:1; ++ ++ /* Offset 4 */ ++ u32 macid:7; ++ u32 rsvd0407:1; ++ u32 qsel:5; ++ u32 rdg_nav_ext:1; ++ u32 lsig_txop_en:1; ++ u32 pifs:1; ++ u32 rate_id:5; ++ u32 en_desc_id:1; ++ u32 sectype:2; ++ u32 pkt_offset:5; /* unit: 8 bytes */ ++ u32 moredata:1; ++ u32 txop_ps_cap:1; ++ u32 txop_ps_mode:1; ++ ++ /* Offset 8 */ ++ u32 p_aid:9; ++ u32 rsvd0809:1; ++ u32 cca_rts:2; ++ u32 agg_en:1; ++ u32 rdg_en:1; ++ u32 null_0:1; ++ u32 null_1:1; ++ u32 bk:1; ++ u32 morefrag:1; ++ u32 raw:1; ++ u32 spe_rpt:1; ++ u32 ampdu_density:3; ++ u32 bt_null:1; ++ u32 g_id:6; ++ u32 rsvd0830:2; ++ ++ /* Offset 12 */ ++ u32 wheader_len:4; ++ u32 chk_en:1; ++ u32 early_rate:1; ++ u32 hw_ssn_sel:2; ++ u32 userate:1; ++ u32 disrtsfb:1; ++ u32 disdatafb:1; ++ u32 cts2self:1; ++ u32 rtsen:1; ++ u32 hw_rts_en:1; ++ u32 port_id:1; ++ u32 navusehdr:1; ++ u32 use_max_len:1; ++ u32 max_agg_num:5; ++ u32 ndpa:2; ++ u32 ampdu_max_time:8; ++ ++ /* Offset 16 */ ++ u32 datarate:7; ++ u32 try_rate:1; ++ u32 data_ratefb_lmt:5; ++ u32 rts_ratefb_lmt:4; ++ u32 rty_lmt_en:1; ++ u32 data_rt_lmt:6; ++ u32 rtsrate:5; ++ u32 pcts_en:1; ++ u32 pcts_mask_idx:2; ++ ++ /* Offset 20 */ ++ u32 data_sc:4; ++ u32 data_short:1; ++ u32 data_bw:2; ++ u32 data_ldpc:1; ++ u32 data_stbc:2; ++ u32 vcs_stbc:2; ++ u32 rts_short:1; ++ u32 rts_sc:4; ++ u32 rsvd2016:7; ++ u32 tx_ant:4; ++ u32 txpwr_offset:3; ++ u32 rsvd2031:1; ++ ++ /* Offset 24 */ ++ u32 sw_define:12; ++ u32 mbssid:4; ++ u32 antsel_A:3; ++ u32 antsel_B:3; ++ u32 antsel_C:3; ++ u32 antsel_D:3; ++ u32 rsvd2428:4; ++ ++ /* Offset 28 */ ++ u32 checksum:16; ++ u32 rsvd2816:8; ++ u32 usb_txagg_num:8; ++ ++ /* Offset 32 */ ++ u32 rts_rc:6; ++ u32 bar_rty_th:2; ++ u32 data_rc:6; ++ u32 rsvd3214:1; ++ u32 en_hwseq:1; ++ u32 nextneadpage:8; ++ u32 tailpage:8; ++ ++ /* Offset 36 */ ++ u32 padding_len:11; ++ u32 txbf_path:1; ++ u32 seq:12; ++ u32 final_data_rate:8; ++} TXDESC_8821A, *PTXDESC_8821A; ++ ++#ifdef CONFIG_SDIO_HCI ++s32 InitXmitPriv8821AS(PADAPTER padapter); ++void FreeXmitPriv8821AS(PADAPTER padapter); ++s32 XmitBufHandler8821AS(PADAPTER padapter); ++s32 MgntXmit8821AS(PADAPTER padapter, struct xmit_frame *pmgntframe); ++s32 HalXmitNoLock8821AS(PADAPTER padapter, struct xmit_frame *pxmitframe); ++s32 HalXmit8821AS(PADAPTER padapter, struct xmit_frame *pxmitframe); ++#ifndef CONFIG_SDIO_TX_TASKLET ++thread_return XmitThread8821AS(thread_context context); ++#endif /* !CONFIG_SDIO_TX_TASKLET */ ++#endif /* CONFIG_SDIO_HCI */ ++ ++#if 0 ++#ifdef CONFIG_USB_HCI ++s32 rtl8821au_init_xmit_priv(PADAPTER padapter); ++void rtl8821au_free_xmit_priv(PADAPTER padapter); ++s32 rtl8821au_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++s32 rtl8821au_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++s32 rtl8821au_hal_xmitframe_enqueue(PADAPTER padapter, struct xmit_frame *pxmitframe); ++s32 rtl8821au_xmit_buf_handler(PADAPTER padapter); ++void rtl8821au_xmit_tasklet(void *priv); ++s32 rtl8821au_xmitframe_complete(PADAPTER padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++#endif /* CONFIG_USB_HCI */ ++ ++#ifdef CONFIG_PCI_HCI ++s32 rtl8821e_init_xmit_priv(PADAPTER padapter); ++void rtl8821e_free_xmit_priv(PADAPTER padapter); ++struct xmit_buf *rtl8821e_dequeue_xmitbuf(struct rtw_tx_ring *ring); ++void rtl8821e_xmitframe_resume(PADAPTER padapter); ++s32 rtl8821e_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++s32 rtl8821e_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++void rtl8821e_xmit_tasklet(void *priv); ++#endif /* CONFIG_PCI_HCI */ ++#endif ++ ++#endif /* __RTL8821_XMIT_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8821c_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821c_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8821c_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821c_hal.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,68 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2016 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL8821C_HAL_H_ ++#define _RTL8821C_HAL_H_ ++ ++#include /* BIT(x) */ ++#include "../hal/halmac/halmac_api.h" /* MAC REG definition */ ++#include "hal_data.h" ++ ++#if defined(CONFIG_USB_HCI) ++ ++ #ifndef MAX_RECVBUF_SZ ++ #ifndef CONFIG_MINIMAL_MEMORY_USAGE ++ #ifdef CONFIG_PLATFORM_MSTAR ++ #define MAX_RECVBUF_SZ (8192) /* 8K */ ++ #else ++ /* 8821C - RX FIFO :16K ,for RX agg DMA mode = 16K, Rx agg USB mode could large than 16k*/ ++ #define MAX_RECVBUF_SZ HALMAC_RX_FIFO_SIZE_8821C ++ #endif ++ /*#define MAX_RECVBUF_SZ_8821C (24576)*/ /* 24k*/ ++ /*#define MAX_RECVBUF_SZ_8821C (20480)*/ /*20K*/ ++ /*#define MAX_RECVBUF_SZ_8821C (10240) */ /*10K*/ ++ /*#define MAX_RECVBUF_SZ_8821C (15360)*/ /*15k < 16k*/ ++ /*#define MAX_RECVBUF_SZ_8821C (8192+1024)*/ /* 8K+1k*/ ++ #else ++ #define MAX_RECVBUF_SZ (4096) /* about 4K */ ++ #endif ++ #endif/* !MAX_RECVBUF_SZ*/ ++ ++#elif defined(CONFIG_PCI_HCI) ++ /*#ifndef CONFIG_MINIMAL_MEMORY_USAGE ++ #define MAX_RECVBUF_SZ (9100) ++ #else*/ ++ #define MAX_RECVBUF_SZ (4096) /* about 4K */ ++ /*#endif*/ ++ ++#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ ++ #define MAX_RECVBUF_SZ HALMAC_RX_FIFO_SIZE_8821C ++ ++#endif ++ ++void init_hal_spec_rtl8821c(PADAPTER); ++/* MP Functions */ ++#ifdef CONFIG_MP_INCLUDED ++void rtl8821c_phy_init_haldm(PADAPTER); /* rtw_mp.c */ ++void rtl8821c_prepare_mp_txdesc(PADAPTER, struct mp_priv *); /* rtw_mp.c */ ++void rtl8821c_mp_config_rfpath(PADAPTER); /* hal_mp.c */ ++#endif ++ ++#endif /* _RTL8821C_HAL_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8821cs_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821cs_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8821cs_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821cs_hal.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,28 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2016 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL8821CS_HAL_H_ ++#define _RTL8821CS_HAL_H_ ++ ++#include /* PADAPTER */ ++ ++/* rtl8821cs_ops.c */ ++u8 rtl8821cs_set_hal_ops(PADAPTER); ++ ++#endif /* _RTL8821CS_HAL_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8821cu_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821cu_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8821cu_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821cu_hal.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,29 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2016 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL8821CU_HAL_H_ ++#define _RTL8821CU_HAL_H_ ++ ++#include /* PADAPTER */ ++ ++/* rtl8821cu_ops.c */ ++u8 rtl8821cu_set_hal_ops(PADAPTER); ++void rtl8821cu_set_hw_type(struct dvobj_priv *pdvobj); ++ ++#endif /* _RTL8821CU_HAL_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8822be_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822be_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8822be_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822be_hal.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,30 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL8822BE_HAL_H_ ++#define _RTL8822BE_HAL_H_ ++ ++#include /* PADAPTER */ ++ ++#define RT_BCN_INT_MASKS (BIT20 | BIT25 | BIT26 | BIT16) ++ ++/* rtl8822be_ops.c */ ++void UpdateInterruptMask8822BE(PADAPTER, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); ++ ++#endif /* _RTL8822BE_HAL_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8822b_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822b_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8822b_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822b_hal.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,216 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL8822B_HAL_H_ ++#define _RTL8822B_HAL_H_ ++ ++#include /* BIT(x) */ ++#include /* PADAPTER */ ++#include "../hal/halmac/halmac_api.h" /* MAC REG definition */ ++ ++ ++#define MAX_RECVBUF_SZ HALMAC_RX_FIFO_SIZE_8822B ++ ++/* ++ * MAC Register definition ++ */ ++#define REG_AFE_XTAL_CTRL REG_AFE_CTRL1_8822B /* hal_com.c & phydm */ ++#define REG_AFE_PLL_CTRL REG_AFE_CTRL2_8822B /* hal_com.c & phydm */ ++#define REG_MAC_PHY_CTRL REG_AFE_CTRL3_8822B /* phydm only */ ++#define REG_LEDCFG0 REG_LED_CFG_8822B /* rtw_mp.c */ ++#define MSR (REG_CR_8822B + 2) /* rtw_mp.c & hal_com.c */ ++#define MSR1 REG_CR_EXT_8822B /* rtw_mp.c & hal_com.c */ ++#define REG_C2HEVT_MSG_NORMAL 0x1A0 /* hal_com.c */ ++#define REG_C2HEVT_CLEAR 0x1AF /* hal_com.c */ ++#define REG_BCN_CTRL_1 REG_BCN_CTRL_CLINT0_8822B /* hal_com.c */ ++#define REG_TSFTR1 REG_FREERUN_CNT_8822B /* hal_com.c */ ++#define REG_RXFLTMAP2 REG_RXFLTMAP_8822B /* rtw_mp.c */ ++ ++/* RXERR_RPT, for rtw_mp.c */ ++#define RXERR_TYPE_OFDM_PPDU 0 ++#define RXERR_TYPE_OFDM_FALSE_ALARM 2 ++#define RXERR_TYPE_OFDM_MPDU_OK 0 ++#define RXERR_TYPE_OFDM_MPDU_FAIL 1 ++#define RXERR_TYPE_CCK_PPDU 3 ++#define RXERR_TYPE_CCK_FALSE_ALARM 5 ++#define RXERR_TYPE_CCK_MPDU_OK 3 ++#define RXERR_TYPE_CCK_MPDU_FAIL 4 ++#define RXERR_TYPE_HT_PPDU 8 ++#define RXERR_TYPE_HT_FALSE_ALARM 9 ++#define RXERR_TYPE_HT_MPDU_TOTAL 6 ++#define RXERR_TYPE_HT_MPDU_OK 6 ++#define RXERR_TYPE_HT_MPDU_FAIL 7 ++#define RXERR_TYPE_RX_FULL_DROP 10 ++ ++#define RXERR_COUNTER_MASK BIT_MASK_RPT_COUNTER_8822B ++#define RXERR_RPT_RST BIT_RXERR_RPT_RST_8822B ++#define _RXERR_RPT_SEL(type) (BIT_RXERR_RPT_SEL_V1_3_0_8822B(type) \ ++ | ((type & 0x10) ? BIT_RXERR_RPT_SEL_V1_4_8822B : 0)) ++ ++/* ++ * BB Register definition ++ */ ++#define rPMAC_Reset 0x100 /* hal_mp.c */ ++ ++#define rFPGA0_RFMOD 0x800 ++#define rFPGA0_TxInfo 0x804 ++#define rOFDMCCKEN_Jaguar 0x808 /* hal_mp.c */ ++#define rFPGA0_TxGainStage 0x80C /* phydm only */ ++#define rFPGA0_XA_HSSIParameter1 0x820 /* hal_mp.c */ ++#define rFPGA0_XA_HSSIParameter2 0x824 /* hal_mp.c */ ++#define rFPGA0_XB_HSSIParameter1 0x828 /* hal_mp.c */ ++#define rFPGA0_XB_HSSIParameter2 0x82C /* hal_mp.c */ ++#define rTxAGC_B_Rate18_06 0x830 ++#define rTxAGC_B_Rate54_24 0x834 ++#define rTxAGC_B_CCK1_55_Mcs32 0x838 ++#define rCCAonSec_Jaguar 0x838 /* hal_mp.c */ ++#define rTxAGC_B_Mcs03_Mcs00 0x83C ++#define rTxAGC_B_Mcs07_Mcs04 0x848 ++#define rTxAGC_B_Mcs11_Mcs08 0x84C ++#define rFPGA0_XA_RFInterfaceOE 0x860 ++#define rFPGA0_XB_RFInterfaceOE 0x864 ++#define rTxAGC_B_Mcs15_Mcs12 0x868 ++#define rTxAGC_B_CCK11_A_CCK2_11 0x86C ++#define rFPGA0_XAB_RFInterfaceSW 0x870 ++#define rFPGA0_XAB_RFParameter 0x878 ++#define rFPGA0_AnalogParameter4 0x88C /* hal_mp.c & phydm */ ++#define rFPGA0_XB_LSSIReadBack 0x8A4 /* phydm */ ++#define rHSSIRead_Jaguar 0x8B0 /* RF read addr (rtl8822b_phy.c) */ ++ ++#define rC_TxScale_Jaguar2 0x181C /* Pah_C TX scaling factor (hal_mp.c) */ ++#define rC_IGI_Jaguar2 0x1850 /* Initial Gain for path-C (hal_mp.c) */ ++ ++#define rFPGA1_TxInfo 0x90C /* hal_mp.c */ ++#define rSingleTone_ContTx_Jaguar 0x914 /* hal_mp.c */ ++/* TX BeamForming */ ++#define REG_BB_TX_PATH_SEL_1_8822B 0x93C /* rtl8822b_phy.c */ ++#define REG_BB_TX_PATH_SEL_2_8822B 0x940 /* rtl8822b_phy.c */ ++ ++/* TX BeamForming */ ++#define REG_BB_TXBF_ANT_SET_BF1_8822B 0x19AC /* rtl8822b_phy.c */ ++#define REG_BB_TXBF_ANT_SET_BF0_8822B 0x19B4 /* rtl8822b_phy.c */ ++ ++#define rCCK0_System 0xA00 ++#define rCCK0_AFESetting 0xA04 ++ ++#define rCCK0_DSPParameter2 0xA1C ++#define rCCK0_TxFilter1 0xA20 ++#define rCCK0_TxFilter2 0xA24 ++#define rCCK0_DebugPort 0xA28 ++#define rCCK0_FalseAlarmReport 0xA2C ++ ++#define rD_TxScale_Jaguar2 0x1A1C /* Path_D TX scaling factor (hal_mp.c) */ ++#define rD_IGI_Jaguar2 0x1A50 /* Initial Gain for path-D (hal_mp.c) */ ++ ++#define rOFDM0_TRxPathEnable 0xC04 ++#define rOFDM0_TRMuxPar 0xC08 ++#define rA_TxScale_Jaguar 0xC1C /* Pah_A TX scaling factor (hal_mp.c) */ ++#define rOFDM0_RxDetector1 0xC30 /* rtw_mp.c */ ++#define rOFDM0_ECCAThreshold 0xC4C /* phydm only */ ++#define rOFDM0_XAAGCCore1 0xC50 /* phydm only */ ++#define rA_IGI_Jaguar 0xC50 /* Initial Gain for path-A (hal_mp.c) */ ++#define rOFDM0_XBAGCCore1 0xC58 /* phydm only */ ++#define rOFDM0_XATxIQImbalance 0xC80 /* phydm only */ ++#define rA_LSSIWrite_Jaguar 0xC90 /* RF write addr, LSSI Parameter (rtl8822b_phy.c) */ ++#define rA_RFE_Pinmux_Jaguar 0xCB0 /* hal_mp.c */ ++ ++#define rOFDM1_LSTF 0xD00 ++#define rOFDM1_TRxPathEnable 0xD04 /* hal_mp.c */ ++#define rA_PIRead_Jaguar 0xD04 /* RF readback with PI (rtl8822b_phy.c) */ ++#define rA_SIRead_Jaguar 0xD08 /* RF readback with SI (rtl8822b_phy.c) */ ++#define rB_PIRead_Jaguar 0xD44 /* RF readback with PI (rtl8822b_phy.c) */ ++#define rB_SIRead_Jaguar 0xD48 /* RF readback with SI (rtl8822b_phy.c) */ ++ ++#define rTxAGC_A_Rate18_06 0xE00 ++#define rTxAGC_A_Rate54_24 0xE04 ++#define rTxAGC_A_CCK1_Mcs32 0xE08 ++#define rTxAGC_A_Mcs03_Mcs00 0xE10 ++#define rTxAGC_A_Mcs07_Mcs04 0xE14 ++#define rTxAGC_A_Mcs11_Mcs08 0xE18 ++#define rTxAGC_A_Mcs15_Mcs12 0xE1C ++#define rB_TxScale_Jaguar 0xE1C /* Path_B TX scaling factor (hal_mp.c) */ ++#define rB_IGI_Jaguar 0xE50 /* Initial Gain for path-B (hal_mp.c) */ ++#define rB_LSSIWrite_Jaguar 0xE90 /* RF write addr, LSSI Parameter (rtl8822b_phy.c) */ ++#define rB_RFE_Pinmux_Jaguar 0xEB0 /* hal_mp.c */ ++ ++/* Page1(0x100) */ ++#define bBBResetB 0x100 ++ ++/* Page8(0x800) */ ++#define bCCKEn 0x1000000 ++#define bOFDMEn 0x2000000 ++/* Reg 0x80C rFPGA0_TxGainStage */ ++#define bXBTxAGC 0xF00 ++#define bXCTxAGC 0xF000 ++#define bXDTxAGC 0xF0000 ++ ++/* PageA(0xA00) */ ++#define bCCKBBMode 0x3 ++ ++#define bCCKScramble 0x8 ++#define bCCKTxRate 0x3000 ++ ++/* General */ ++#define bMaskByte0 0xFF /* mp, rtw_odm.c & phydm */ ++#define bMaskByte1 0xFF00 /* hal_mp.c & phydm */ ++#define bMaskByte2 0xFF0000 /* hal_mp.c & phydm */ ++#define bMaskByte3 0xFF000000 /* hal_mp.c & phydm */ ++#define bMaskHWord 0xFFFF0000 /* hal_com.c, rtw_mp.c */ ++#define bMaskLWord 0x0000FFFF /* mp, hal_com.c & phydm */ ++#define bMaskDWord 0xFFFFFFFF /* mp, hal, rtw_odm.c & phydm */ ++ ++#define bEnable 0x1 /* hal_mp.c, rtw_mp.c */ ++#define bDisable 0x0 /* rtw_mp.c */ ++ ++#define MAX_STALL_TIME 50 /* unit: us, hal_com_phycfg.c */ ++ ++#define Rx_Smooth_Factor 20 /* phydm only */ ++ ++/* ++ * RF Register definition ++ */ ++#define RF_AC 0x00 ++#define RF_AC_Jaguar 0x00 /* hal_mp.c */ ++#define RF_CHNLBW 0x18 /* rtl8822b_phy.c */ ++#define RF_ModeTableAddr 0x30 /* rtl8822b_phy.c */ ++#define RF_ModeTableData0 0x31 /* rtl8822b_phy.c */ ++#define RF_ModeTableData1 0x32 /* rtl8822b_phy.c */ ++#define RF_0x52 0x52 ++#define RF_WeLut_Jaguar 0xEF /* rtl8822b_phy.c */ ++ ++/* General Functions */ ++void rtl8822b_init_hal_spec(PADAPTER); /* hal/hal_com.c */ ++ ++#ifdef CONFIG_MP_INCLUDED ++/* MP Functions */ ++#include /* struct mp_priv */ ++void rtl8822b_phy_init_haldm(PADAPTER); /* rtw_mp.c */ ++void rtl8822b_prepare_mp_txdesc(PADAPTER, struct mp_priv *); /* rtw_mp.c */ ++void rtl8822b_mp_config_rfpath(PADAPTER); /* hal_mp.c */ ++#endif ++ ++#ifdef CONFIG_USB_HCI ++#include ++#elif defined(CONFIG_SDIO_HCI) ++#include ++#elif defined(CONFIG_PCI_HCI) ++#include ++#endif ++ ++#endif /* _RTL8822B_HAL_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8822bs_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822bs_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8822bs_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822bs_hal.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,32 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL8822BS_HAL_H_ ++#define _RTL8822BS_HAL_H_ ++ ++#include /* PADAPTER */ ++ ++/* rtl8822bs_ops.c */ ++void rtl8822bs_set_hal_ops(PADAPTER); ++ ++/* rtl8822bs_xmit.c */ ++s32 rtl8822bs_dequeue_writeport(PADAPTER); ++#define _dequeue_writeport(a) rtl8822bs_dequeue_writeport(a) ++ ++#endif /* _RTL8822BS_HAL_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8822bu_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822bu_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtl8822bu_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822bu_hal.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,58 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL8822BU_HAL_H_ ++#define _RTL8822BU_HAL_H_ ++ ++#ifdef CONFIG_USB_HCI ++ #include /* PADAPTER */ ++ ++ #ifdef CONFIG_USB_HCI ++ #ifdef USB_PACKET_OFFSET_SZ ++ #define PACKET_OFFSET_SZ (USB_PACKET_OFFSET_SZ) ++ #else ++ #define PACKET_OFFSET_SZ (8) ++ #endif ++ #define TXDESC_OFFSET (TXDESC_SIZE + PACKET_OFFSET_SZ) ++ #endif ++ ++ /* recv_buffer must be large than usb agg size */ ++ #ifndef MAX_RECVBUF_SZ ++ #ifdef PLATFORM_OS_CE ++ #define MAX_RECVBUF_SZ (8192+1024) ++ #else /* !PLATFORM_OS_CE */ ++ #ifndef CONFIG_MINIMAL_MEMORY_USAGE ++ #define MAX_RECVBUF_SZ (32768) ++ #else ++ #define MAX_RECVBUF_SZ (4000) ++ #endif ++ #endif /* PLATFORM_OS_CE */ ++ #endif /* !MAX_RECVBUF_SZ */ ++ ++ /* rtl8822bu_ops.c */ ++ void rtl8822bu_set_hal_ops(PADAPTER padapter); ++ void rtl8822bu_set_hw_type(struct dvobj_priv *pdvobj); ++ ++ /* rtl8822bu_io.c */ ++ void rtl8822bu_set_intf_ops(struct _io_ops *pops); ++ ++#endif /* CONFIG_USB_HCI */ ++ ++ ++#endif /* _RTL8822BU_HAL_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_android.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_android.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_android.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_android.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,115 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __RTW_ANDROID_H__ ++#define __RTW_ANDROID_H__ ++ ++enum ANDROID_WIFI_CMD { ++ ANDROID_WIFI_CMD_START, ++ ANDROID_WIFI_CMD_STOP, ++ ANDROID_WIFI_CMD_SCAN_ACTIVE, ++ ANDROID_WIFI_CMD_SCAN_PASSIVE, ++ ANDROID_WIFI_CMD_RSSI, ++ ANDROID_WIFI_CMD_LINKSPEED, ++ ANDROID_WIFI_CMD_RXFILTER_START, ++ ANDROID_WIFI_CMD_RXFILTER_STOP, ++ ANDROID_WIFI_CMD_RXFILTER_ADD, ++ ANDROID_WIFI_CMD_RXFILTER_REMOVE, ++ ANDROID_WIFI_CMD_BTCOEXSCAN_START, ++ ANDROID_WIFI_CMD_BTCOEXSCAN_STOP, ++ ANDROID_WIFI_CMD_BTCOEXMODE, ++ ANDROID_WIFI_CMD_SETSUSPENDOPT, ++ ANDROID_WIFI_CMD_P2P_DEV_ADDR, ++ ANDROID_WIFI_CMD_SETFWPATH, ++ ANDROID_WIFI_CMD_SETBAND, ++ ANDROID_WIFI_CMD_GETBAND, ++ ANDROID_WIFI_CMD_COUNTRY, ++ ANDROID_WIFI_CMD_P2P_SET_NOA, ++ ANDROID_WIFI_CMD_P2P_GET_NOA, ++ ANDROID_WIFI_CMD_P2P_SET_PS, ++ ANDROID_WIFI_CMD_SET_AP_WPS_P2P_IE, ++ ++ ANDROID_WIFI_CMD_MIRACAST, ++ ++#ifdef CONFIG_PNO_SUPPORT ++ ANDROID_WIFI_CMD_PNOSSIDCLR_SET, ++ ANDROID_WIFI_CMD_PNOSETUP_SET, ++ ANDROID_WIFI_CMD_PNOENABLE_SET, ++ ANDROID_WIFI_CMD_PNODEBUG_SET, ++#endif ++ ++ ANDROID_WIFI_CMD_MACADDR, ++ ++ ANDROID_WIFI_CMD_BLOCK_SCAN, ++ ANDROID_WIFI_CMD_BLOCK, ++ ++ ANDROID_WIFI_CMD_WFD_ENABLE, ++ ANDROID_WIFI_CMD_WFD_DISABLE, ++ ++ ANDROID_WIFI_CMD_WFD_SET_TCPPORT, ++ ANDROID_WIFI_CMD_WFD_SET_MAX_TPUT, ++ ANDROID_WIFI_CMD_WFD_SET_DEVTYPE, ++ ANDROID_WIFI_CMD_CHANGE_DTIM, ++ ANDROID_WIFI_CMD_HOSTAPD_SET_MACADDR_ACL, ++ ANDROID_WIFI_CMD_HOSTAPD_ACL_ADD_STA, ++ ANDROID_WIFI_CMD_HOSTAPD_ACL_REMOVE_STA, ++#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 1, 0)) ++ ANDROID_WIFI_CMD_GTK_REKEY_OFFLOAD, ++#endif /* CONFIG_GTK_OL */ ++ ANDROID_WIFI_CMD_P2P_DISABLE, ++ ANDROID_WIFI_CMD_DRIVERVERSION, ++ ANDROID_WIFI_CMD_MAX ++}; ++ ++int rtw_android_cmdstr_to_num(char *cmdstr); ++int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd); ++ ++#if defined(CONFIG_PNO_SUPPORT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) ++int rtw_android_pno_enable(struct net_device *net, int pno_enable); ++int rtw_android_cfg80211_pno_setup(struct net_device *net, ++ struct cfg80211_ssid *ssid, int n_ssids, int interval); ++#endif ++ ++#if defined(RTW_ENABLE_WIFI_CONTROL_FUNC) ++int rtw_android_wifictrl_func_add(void); ++void rtw_android_wifictrl_func_del(void); ++void *wl_android_prealloc(int section, unsigned long size); ++ ++int wifi_get_irq_number(unsigned long *irq_flags_ptr); ++int wifi_set_power(int on, unsigned long msec); ++int wifi_get_mac_addr(unsigned char *buf); ++void *wifi_get_country_code(char *ccode); ++#else ++static int rtw_android_wifictrl_func_add(void) ++{ ++ return 0; ++} ++static void rtw_android_wifictrl_func_del(void) {} ++#endif /* defined(RTW_ENABLE_WIFI_CONTROL_FUNC) */ ++ ++#if defined (CONFIG_GPIO_WAKEUP) || defined (CONFIG_RTW_SDIO_OOB_INT) ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++int wifi_configure_gpio(void); ++#endif /* CONFIG_PLATFORM_INTEL_BYT */ ++void wifi_free_gpio(unsigned int gpio); ++#endif /* CONFIG_GPIO_WAKEUP */ ++ ++ ++#endif /* __RTW_ANDROID_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_ap.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ap.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_ap.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ap.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,90 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_AP_H_ ++#define __RTW_AP_H_ ++ ++ ++#ifdef CONFIG_AP_MODE ++ ++/* external function */ ++extern void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta); ++extern void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta); ++ ++ ++void init_mlme_ap_info(_adapter *padapter); ++void free_mlme_ap_info(_adapter *padapter); ++/* void update_BCNTIM(_adapter *padapter); */ ++void rtw_add_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index, u8 *data, u8 len); ++void rtw_remove_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index); ++void _update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx, const char *tag); ++#define update_beacon(adapter, ie_id, oui, tx) _update_beacon((adapter), (ie_id), (oui), (tx), __func__) ++void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level); ++void expire_timeout_chk(_adapter *padapter); ++void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta); ++void rtw_start_bss_hdl_after_chbw_decided(_adapter *adapter); ++void start_bss_network(_adapter *padapter, struct createbss_parm *parm); ++int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len); ++void rtw_ap_restore_network(_adapter *padapter); ++ ++#if CONFIG_RTW_MACADDR_ACL ++void rtw_set_macaddr_acl(_adapter *adapter, int mode); ++int rtw_acl_add_sta(_adapter *adapter, const u8 *addr); ++int rtw_acl_remove_sta(_adapter *adapter, const u8 *addr); ++#endif /* CONFIG_RTW_MACADDR_ACL */ ++ ++u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta); ++int rtw_ap_set_group_key(_adapter *padapter, u8 *key, u8 alg, int keyid); ++int rtw_ap_set_wep_key(_adapter *padapter, u8 *key, u8 keylen, int keyid, u8 set_tx); ++ ++#ifdef CONFIG_NATIVEAP_MLME ++void associated_clients_update(_adapter *padapter, u8 updated, u32 sta_info_type); ++void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta); ++u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta); ++void sta_info_update(_adapter *padapter, struct sta_info *psta); ++void ap_sta_info_defer_update(_adapter *padapter, struct sta_info *psta); ++u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reason, bool enqueue); ++int rtw_sta_flush(_adapter *padapter, bool enqueue); ++int rtw_ap_inform_ch_switch(_adapter *padapter, u8 new_ch, u8 ch_offset); ++void start_ap_mode(_adapter *padapter); ++void stop_ap_mode(_adapter *padapter); ++#endif ++ ++void rtw_ap_update_bss_chbw(_adapter *adapter, WLAN_BSSID_EX *bss, u8 ch, u8 bw, u8 offset); ++bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offset, u8 *ch, u8 *bw, u8 *offset, u8 *chbw_allow); ++ ++#ifdef CONFIG_AUTO_AP_MODE ++extern void rtw_start_auto_ap(_adapter *adapter); ++#endif /* CONFIG_AUTO_AP_MODE */ ++ ++#endif /* end of CONFIG_AP_MODE */ ++ ++#endif ++void update_bmc_sta(_adapter *padapter); ++void rtw_process_public_act_bsscoex(_adapter *padapter, u8 *pframe, uint frame_len); ++ ++#ifdef CONFIG_80211N_HT ++void rtw_process_ht_action_smps(_adapter *padapter, u8 *ta, u8 ctrl_field); ++int rtw_ht_operation_update(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_SWTIMER_BASED_TXBCN ++void tx_beacon_handlder(struct dvobj_priv *pdvobj); ++void tx_beacon_timer_handlder(struct dvobj_priv *pdvobj); ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_beamforming.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_beamforming.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_beamforming.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_beamforming.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,299 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2016 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_BEAMFORMING_H_ ++#define __RTW_BEAMFORMING_H_ ++ ++#ifdef CONFIG_BEAMFORMING ++ ++#if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ ++#ifdef RTW_BEAMFORMING_VERSION_2 ++#define MAX_NUM_BEAMFORMEE_SU 2 ++#define MAX_NUM_BEAMFORMER_SU 2 ++#define MAX_NUM_BEAMFORMEE_MU 6 ++#define MAX_NUM_BEAMFORMER_MU 1 ++ ++#define MAX_BEAMFORMEE_ENTRY_NUM (MAX_NUM_BEAMFORMEE_SU + MAX_NUM_BEAMFORMEE_MU) ++#define MAX_BEAMFORMER_ENTRY_NUM (MAX_NUM_BEAMFORMER_SU + MAX_NUM_BEAMFORMER_MU) ++ ++#define GetInitSoundCnt(_SoundPeriod, _MinSoundPeriod) ((_SoundPeriod)/(_MinSoundPeriod)) ++ ++#define GET_BEAMFORM_INFO(adapter) (&GET_HAL_DATA(adapter)->beamforming_info) ++#else /* !RTW_BEAMFORMING_VERSION_2 */ ++#define BEAMFORMING_ENTRY_NUM 2 ++#define GET_BEAMFORM_INFO(_pmlmepriv) ((struct beamforming_info *)(&(_pmlmepriv)->beamforming_info)) ++#endif /* !RTW_BEAMFORMING_VERSION_2 */ ++ ++typedef enum _BEAMFORMING_ENTRY_STATE { ++ BEAMFORMING_ENTRY_STATE_UNINITIALIZE, ++ BEAMFORMING_ENTRY_STATE_INITIALIZEING, ++ BEAMFORMING_ENTRY_STATE_INITIALIZED, ++ BEAMFORMING_ENTRY_STATE_PROGRESSING, ++ BEAMFORMING_ENTRY_STATE_PROGRESSED, ++} BEAMFORMING_ENTRY_STATE, *PBEAMFORMING_ENTRY_STATE; ++ ++ ++typedef enum _BEAMFORMING_STATE { ++ BEAMFORMING_STATE_IDLE, ++ BEAMFORMING_STATE_START, ++ BEAMFORMING_STATE_END, ++} BEAMFORMING_STATE, *PBEAMFORMING_STATE; ++ ++ ++typedef enum _BEAMFORMING_CAP { ++ BEAMFORMING_CAP_NONE = 0x0, ++ BEAMFORMER_CAP_HT_EXPLICIT = 0x1, ++ BEAMFORMEE_CAP_HT_EXPLICIT = 0x2, ++ BEAMFORMER_CAP_VHT_SU = 0x4, /* Self has er Cap, because Reg er & peer ee */ ++ BEAMFORMEE_CAP_VHT_SU = 0x8, /* Self has ee Cap, because Reg ee & peer er */ ++ BEAMFORMER_CAP_VHT_MU = 0x10, /* Self has er Cap, because Reg er & peer ee */ ++ BEAMFORMEE_CAP_VHT_MU = 0x20, /* Self has ee Cap, because Reg ee & peer er */ ++ BEAMFORMER_CAP = 0x40, ++ BEAMFORMEE_CAP = 0x80, ++} BEAMFORMING_CAP, *PBEAMFORMING_CAP; ++ ++ ++typedef enum _SOUNDING_MODE { ++ SOUNDING_SW_VHT_TIMER = 0x0, ++ SOUNDING_SW_HT_TIMER = 0x1, ++ SOUNDING_STOP_All_TIMER = 0x2, ++ SOUNDING_HW_VHT_TIMER = 0x3, ++ SOUNDING_HW_HT_TIMER = 0x4, ++ SOUNDING_STOP_OID_TIMER = 0x5, ++ SOUNDING_AUTO_VHT_TIMER = 0x6, ++ SOUNDING_AUTO_HT_TIMER = 0x7, ++ SOUNDING_FW_VHT_TIMER = 0x8, ++ SOUNDING_FW_HT_TIMER = 0x9, ++} SOUNDING_MODE, *PSOUNDING_MODE; ++ ++#ifdef RTW_BEAMFORMING_VERSION_2 ++enum _BEAMFORM_ENTRY_HW_STATE { ++ BEAMFORM_ENTRY_HW_STATE_NONE, ++ BEAMFORM_ENTRY_HW_STATE_ADD_INIT, ++ BEAMFORM_ENTRY_HW_STATE_ADDING, ++ BEAMFORM_ENTRY_HW_STATE_ADDED, ++ BEAMFORM_ENTRY_HW_STATE_DELETE_INIT, ++ BEAMFORM_ENTRY_HW_STATE_DELETING, ++ BEAMFORM_ENTRY_HW_STATE_MAX ++}; ++ ++struct beamformee_entry { ++ u8 used; /* _TRUE/_FALSE */ ++ u8 txbf; ++ u8 sounding; ++ /* Used to construct AID field of NDPA packet */ ++ u16 aid; ++ /* Used to Set Reg42C in IBSS mode */ ++ u16 mac_id; ++ /* Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC */ ++ u16 p_aid; ++ u16 g_id; ++ /* Used to fill Reg6E4 to fill Mac address of CSI report frame */ ++ u8 mac_addr[ETH_ALEN]; ++ /* Sounding BandWidth */ ++ CHANNEL_WIDTH sound_bw; ++ u16 sound_period; ++ ++ BEAMFORMING_CAP cap; ++ enum _BEAMFORM_ENTRY_HW_STATE state; ++ ++ /* The BFee need to be sounded when count to zero */ ++ u8 SoundCnt; ++ u8 bCandidateSoundingPeer; ++ u8 bSoundingTimeout; ++ u8 bDeleteSounding; ++ ++ u16 LogStatusFailCnt:5; /* 0~21 */ ++ u16 DefaultCSICnt:5; /* 0~21 */ ++ u8 CSIMatrix[327]; ++ u16 CSIMatrixLen; ++ ++ u8 NumofSoundingDim; ++ u8 CompSteeringNumofBFer; ++ ++ u8 su_reg_index; ++ ++ /* MU-MIMO */ ++ u8 mu_reg_index; ++ u8 gid_valid[8]; ++ u8 user_position[16]; ++}; ++ ++struct beamformer_entry { ++ u8 used; ++ /* p_aid of BFer entry is probably not used */ ++ /* Used to fill Reg42C & Reg714 to compare with p_aid of Tx DESC */ ++ u16 p_aid; ++ u16 g_id; ++ u8 mac_addr[ETH_ALEN]; ++ ++ BEAMFORMING_CAP cap; ++ enum _BEAMFORM_ENTRY_HW_STATE state; ++ ++ u8 NumofSoundingDim; ++ u8 su_reg_index; ++ ++ /* MU-MIMO */ ++ u8 gid_valid[8]; ++ u8 user_position[16]; ++ u16 aid; ++}; ++ ++/* The sounding state is recorded by BFer. */ ++enum _SOUNDING_STATE { ++ SOUNDING_STATE_NONE = 0, ++ SOUNDING_STATE_INIT = 1, ++ SOUNDING_STATE_SU_START = 2, ++ SOUNDING_STATE_SU_SOUNDDOWN = 3, ++ SOUNDING_STATE_MU_START = 4, ++ SOUNDING_STATE_MU_SOUNDDOWN = 5, ++ SOUNDING_STATE_SOUNDING_TIMEOUT = 6, ++ SOUNDING_STATE_MAX ++}; ++ ++struct sounding_info { ++ u8 su_sounding_list[MAX_NUM_BEAMFORMEE_SU]; ++ u8 mu_sounding_list[MAX_NUM_BEAMFORMEE_MU]; ++ ++ enum _SOUNDING_STATE state; ++ u8 su_bfee_curidx; ++ u8 candidate_mu_bfee_cnt; ++ ++ /* For sounding schedule maintenance */ ++ u16 min_sounding_period; ++ /* Get from sounding list */ ++ /* Ex: SU STA1, SU STA2, MU STA(1~n) => the value will be 2+1=3 */ ++ u8 sound_remain_cnt_per_period; ++ /* Real number of SU sound per period */ ++ u8 su_sound_num_per_period; ++ /* Real number of MU sound per period */ ++ u8 mu_sound_num_per_period; ++}; ++ ++struct beamforming_info { ++ BEAMFORMING_CAP beamforming_cap; ++ BEAMFORMING_STATE beamforming_state; ++ struct beamformee_entry bfee_entry[MAX_BEAMFORMEE_ENTRY_NUM]; ++ struct beamformer_entry bfer_entry[MAX_BEAMFORMER_ENTRY_NUM]; ++ u8 sounding_sequence; ++ u8 beamformee_su_cnt; ++ u8 beamformer_su_cnt; ++ u32 beamformee_su_reg_maping; ++ u32 beamformer_su_reg_maping; ++ /* For MU-MINO */ ++ u8 beamformee_mu_cnt; ++ u8 beamformer_mu_cnt; ++ u32 beamformee_mu_reg_maping; ++ u8 first_mu_bfee_index; ++ u8 mu_bfer_curidx; ++ ++ struct sounding_info sounding_info; ++ ++ /* For HW configuration */ ++ u8 SetHalBFEnterOnDemandCnt; ++ u8 SetHalBFLeaveOnDemandCnt; ++ u8 SetHalSoundownOnDemandCnt; ++}; ++ ++struct beamformee_entry *beamforming_get_bfee_entry_by_addr(PADAPTER, u8 *ra); ++struct beamformer_entry *beamforming_get_bfer_entry_by_addr(PADAPTER, u8 *ra); ++u8 beamforming_send_vht_gid_mgnt_packet(PADAPTER, struct beamformee_entry*); ++ ++#else /* !RTW_BEAMFORMING_VERSION_2 */ ++struct beamforming_entry { ++ BOOLEAN bUsed; ++ BOOLEAN bSound; ++ u16 aid; /* Used to construct AID field of NDPA packet. */ ++ u16 mac_id; /* Used to Set Reg42C in IBSS mode. */ ++ u16 p_aid; /* Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ ++ u16 g_id; ++ u8 mac_addr[6];/* Used to fill Reg6E4 to fill Mac address of CSI report frame. */ ++ CHANNEL_WIDTH sound_bw; /* Sounding BandWidth */ ++ u16 sound_period; ++ BEAMFORMING_CAP beamforming_entry_cap; ++ BEAMFORMING_ENTRY_STATE beamforming_entry_state; ++ u8 ClockResetTimes; /*Modified by Jeffery @2015-04-10*/ ++ u8 PreLogSeq; /*Modified by Jeffery @2015-03-30*/ ++ u8 LogSeq; /*Modified by Jeffery @2014-10-29*/ ++ u16 LogRetryCnt:3; /*Modified by Jeffery @2014-10-29*/ ++ u16 LogSuccess:2; /*Modified by Jeffery @2014-10-29*/ ++ ++ u8 LogStatusFailCnt; ++ u8 PreCsiReport[327]; ++ u8 DefaultCsiCnt; ++ BOOLEAN bDefaultCSI; ++}; ++ ++struct sounding_info { ++ u8 sound_idx; ++ CHANNEL_WIDTH sound_bw; ++ SOUNDING_MODE sound_mode; ++ u16 sound_period; ++}; ++ ++struct beamforming_info { ++ BEAMFORMING_CAP beamforming_cap; ++ BEAMFORMING_STATE beamforming_state; ++ struct beamforming_entry beamforming_entry[BEAMFORMING_ENTRY_NUM]; ++ u8 beamforming_cur_idx; ++ u8 beamforming_in_progress; ++ u8 sounding_sequence; ++ struct sounding_info sounding_info; ++}; ++ ++struct rtw_ndpa_sta_info { ++ u16 aid:12; ++ u16 feedback_type:1; ++ u16 nc_index:3; ++}; ++ ++void beamforming_notify(PADAPTER adapter); ++BEAMFORMING_CAP beamforming_get_beamform_cap(struct beamforming_info *pBeamInfo); ++#endif /* !RTW_BEAMFORMING_VERSION_2 */ ++ ++BEAMFORMING_CAP beamforming_get_entry_beam_cap_by_mac_id(void *mlmepriv, u8 mac_id); ++ ++BOOLEAN beamforming_send_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx); ++BOOLEAN beamforming_send_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx); ++ ++void beamforming_check_sounding_success(PADAPTER Adapter, BOOLEAN status); ++ ++void beamforming_watchdog(PADAPTER Adapter); ++#endif /*#if (BEAMFORMING_SUPPORT ==0)- for diver defined beamforming*/ ++ ++enum BEAMFORMING_CTRL_TYPE { ++ BEAMFORMING_CTRL_ENTER = 0, ++ BEAMFORMING_CTRL_LEAVE = 1, ++ BEAMFORMING_CTRL_START_PERIOD = 2, ++ BEAMFORMING_CTRL_END_PERIOD = 3, ++ BEAMFORMING_CTRL_SOUNDING_FAIL = 4, ++ BEAMFORMING_CTRL_SOUNDING_CLK = 5, ++ BEAMFORMING_CTRL_SET_GID_TABLE = 6, ++}; ++u32 beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_frame); ++void beamforming_get_ndpa_frame(PADAPTER Adapter, union recv_frame *precv_frame); ++u32 beamforming_get_vht_gid_mgnt_frame(PADAPTER, union recv_frame *); ++ ++void beamforming_wk_hdl(_adapter *padapter, u8 type, u8 *pbuf); ++u8 beamforming_wk_cmd(_adapter *padapter, s32 type, u8 *pbuf, s32 size, u8 enqueue); ++void update_attrib_txbf_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta); ++ ++#endif /*#ifdef CONFIG_BEAMFORMING */ ++ ++#endif /*__RTW_BEAMFORMING_H_*/ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_br_ext.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_br_ext.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_br_ext.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_br_ext.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,74 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTW_BR_EXT_H_ ++#define _RTW_BR_EXT_H_ ++ ++#if 1 /* rtw_wifi_driver */ ++#define CL_IPV6_PASS 1 ++#define MACADDRLEN 6 ++#define _DEBUG_ERR RTW_INFO ++#define _DEBUG_INFO /* RTW_INFO */ ++#define DEBUG_WARN RTW_INFO ++#define DEBUG_INFO /* RTW_INFO */ ++#define DEBUG_ERR RTW_INFO ++/* #define GET_MY_HWADDR ((GET_MIB(priv))->dot11OperationEntry.hwaddr) */ ++#define GET_MY_HWADDR(padapter) (adapter_mac_addr(padapter)) ++#endif /* rtw_wifi_driver */ ++ ++#define NAT25_HASH_BITS 4 ++#define NAT25_HASH_SIZE (1 << NAT25_HASH_BITS) ++#define NAT25_AGEING_TIME 300 ++ ++#ifdef CL_IPV6_PASS ++ #define MAX_NETWORK_ADDR_LEN 17 ++#else ++ #define MAX_NETWORK_ADDR_LEN 11 ++#endif ++ ++struct nat25_network_db_entry { ++ struct nat25_network_db_entry *next_hash; ++ struct nat25_network_db_entry **pprev_hash; ++ atomic_t use_count; ++ unsigned char macAddr[6]; ++ unsigned long ageing_timer; ++ unsigned char networkAddr[MAX_NETWORK_ADDR_LEN]; ++}; ++ ++enum NAT25_METHOD { ++ NAT25_MIN, ++ NAT25_CHECK, ++ NAT25_INSERT, ++ NAT25_LOOKUP, ++ NAT25_PARSE, ++ NAT25_MAX ++}; ++ ++struct br_ext_info { ++ unsigned int nat25_disable; ++ unsigned int macclone_enable; ++ unsigned int dhcp_bcst_disable; ++ int addPPPoETag; /* 1: Add PPPoE relay-SID, 0: disable */ ++ unsigned char nat25_dmzMac[MACADDRLEN]; ++ unsigned int nat25sc_disable; ++}; ++ ++void nat25_db_cleanup(_adapter *priv); ++ ++#endif /* _RTW_BR_EXT_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_btcoex.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_btcoex.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_btcoex.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_btcoex.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,446 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_BTCOEX_H__ ++#define __RTW_BTCOEX_H__ ++ ++#include ++ ++/* For H2C: H2C_BT_MP_OPER. Return status definition to the user layer */ ++typedef enum _BT_CTRL_STATUS { ++ BT_STATUS_SUCCESS = 0x00, /* Success */ ++ BT_STATUS_BT_OP_SUCCESS = 0x01, /* bt fw op execution success */ ++ BT_STATUS_H2C_SUCCESS = 0x02, /* H2c success */ ++ BT_STATUS_H2C_FAIL = 0x03, /* H2c fail */ ++ BT_STATUS_H2C_LENGTH_EXCEEDED = 0x04, /* H2c command length exceeded */ ++ BT_STATUS_H2C_TIMTOUT = 0x05, /* H2c timeout */ ++ BT_STATUS_H2C_BT_NO_RSP = 0x06, /* H2c sent, bt no rsp */ ++ BT_STATUS_C2H_SUCCESS = 0x07, /* C2h success */ ++ BT_STATUS_C2H_REQNUM_MISMATCH = 0x08, /* bt fw wrong rsp */ ++ BT_STATUS_OPCODE_U_VERSION_MISMATCH = 0x08, /* Upper layer OP code version mismatch. */ ++ BT_STATUS_OPCODE_L_VERSION_MISMATCH = 0x0a, /* Lower layer OP code version mismatch. */ ++ BT_STATUS_UNKNOWN_OPCODE_U = 0x0b, /* Unknown Upper layer OP code */ ++ BT_STATUS_UNKNOWN_OPCODE_L = 0x0c, /* Unknown Lower layer OP code */ ++ BT_STATUS_PARAMETER_FORMAT_ERROR_U = 0x0d, /* Wrong parameters sent by upper layer. */ ++ BT_STATUS_PARAMETER_FORMAT_ERROR_L = 0x0e, /* bt fw parameter format is not consistency */ ++ BT_STATUS_PARAMETER_OUT_OF_RANGE_U = 0x0f, /* uppery layer parameter value is out of range */ ++ BT_STATUS_PARAMETER_OUT_OF_RANGE_L = 0x10, /* bt fw parameter value is out of range */ ++ BT_STATUS_UNKNOWN_STATUS_L = 0x11, /* bt returned an defined status code */ ++ BT_STATUS_UNKNOWN_STATUS_H = 0x12, /* driver need to do error handle or not handle-well. */ ++ BT_STATUS_WRONG_LEVEL = 0x13, /* should be under passive level */ ++ BT_STATUS_NOT_IMPLEMENT = 0x14, /* op code not implemented yet */ ++ BT_STATUS_BT_STACK_OP_SUCCESS = 0x15, /* bt stack op execution success */ ++ BT_STATUS_BT_STACK_NOT_SUPPORT = 0x16, /* stack version not support this. */ ++ BT_STATUS_BT_STACK_SEND_HCI_EVENT_FAIL = 0x17, /* send hci event fail */ ++ BT_STATUS_BT_STACK_NOT_BIND = 0x18, /* stack not bind wifi driver */ ++ BT_STATUS_BT_STACK_NO_RSP = 0x19, /* stack doesn't have any rsp. */ ++ BT_STATUS_MAX ++} BT_CTRL_STATUS, *PBT_CTRL_STATUS; ++ ++typedef enum _BTCOEX_SUSPEND_STATE { ++ BTCOEX_SUSPEND_STATE_RESUME = 0x0, ++ BTCOEX_SUSPEND_STATE_SUSPEND = 0x1, ++ BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT = 0x2, ++ BTCOEX_SUSPEND_STATE_MAX ++} BTCOEX_SUSPEND_STATE, *PBTCOEX_SUSPEND_STATE; ++ ++#define SET_BT_MP_OPER_RET(OpCode, StatusCode) ((OpCode << 8) | StatusCode) ++#define GET_OP_CODE_FROM_BT_MP_OPER_RET(RetCode) ((RetCode & 0xF0) >> 8) ++#define GET_STATUS_CODE_FROM_BT_MP_OPER_RET(RetCode) (RetCode & 0x0F) ++#define CHECK_STATUS_CODE_FROM_BT_MP_OPER_RET(RetCode, StatusCode) (GET_STATUS_CODE_FROM_BT_MP_OPER_RET(RetCode) == StatusCode) ++ ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ ++#define NETLINK_USER 31 ++#define CONNECT_PORT 30000 ++#define CONNECT_PORT_BT 30001 ++#define KERNEL_SOCKET_OK 0x01 ++#define NETLINK_SOCKET_OK 0x02 ++ ++#define OTHER 0 ++#define RX_ATTEND_ACK 1 ++#define RX_LEAVE_ACK 2 ++#define RX_BT_LEAVE 3 ++#define RX_INVITE_REQ 4 ++#define RX_ATTEND_REQ 5 ++#define RX_INVITE_RSP 6 ++ ++#define invite_req "INVITE_REQ" ++#define invite_rsp "INVITE_RSP" ++#define attend_req "ATTEND_REQ" ++#define attend_ack "ATTEND_ACK" ++#define wifi_leave "WIFI_LEAVE" ++#define leave_ack "LEAVE_ACK" ++#define bt_leave "BT_LEAVE" ++ ++#define BT_INFO_NOTIFY_CMD 0x0106 ++#define BT_INFO_LEN 8 ++ ++typedef struct _HCI_LINK_INFO { ++ u2Byte ConnectHandle; ++ u1Byte IncomingTrafficMode; ++ u1Byte OutgoingTrafficMode; ++ u1Byte BTProfile; ++ u1Byte BTCoreSpec; ++ s1Byte BT_RSSI; ++ u1Byte TrafficProfile; ++ u1Byte linkRole; ++} HCI_LINK_INFO, *PHCI_LINK_INFO; ++ ++#define MAX_BT_ACL_LINK_NUM 8 ++ ++typedef struct _HCI_EXT_CONFIG { ++ HCI_LINK_INFO aclLink[MAX_BT_ACL_LINK_NUM]; ++ u1Byte btOperationCode; ++ u2Byte CurrentConnectHandle; ++ u1Byte CurrentIncomingTrafficMode; ++ u1Byte CurrentOutgoingTrafficMode; ++ ++ u1Byte NumberOfACL; ++ u1Byte NumberOfSCO; ++ u1Byte CurrentBTStatus; ++ u2Byte HCIExtensionVer; ++ ++ BOOLEAN bEnableWifiScanNotify; ++} HCI_EXT_CONFIG, *PHCI_EXT_CONFIG; ++ ++typedef struct _HCI_PHY_LINK_BSS_INFO { ++ u2Byte bdCap; /* capability information */ ++ ++ /* Qos related. Added by Annie, 2005-11-01. */ ++ /* BSS_QOS BssQos; */ ++ ++} HCI_PHY_LINK_BSS_INFO, *PHCI_PHY_LINK_BSS_INFO; ++ ++typedef enum _BT_CONNECT_TYPE { ++ BT_CONNECT_AUTH_REQ = 0x00, ++ BT_CONNECT_AUTH_RSP = 0x01, ++ BT_CONNECT_ASOC_REQ = 0x02, ++ BT_CONNECT_ASOC_RSP = 0x03, ++ BT_DISCONNECT = 0x04 ++} BT_CONNECT_TYPE, *PBT_CONNECT_TYPE; ++ ++ ++typedef struct _PACKET_IRP_HCIEVENT_DATA { ++ u8 EventCode; ++ u8 Length; /* total cmd length = extension event length+1(extension event code length) */ ++ u8 Data[1]; /* byte1 is extension event code */ ++} rtw_HCI_event; ++ ++ ++struct btinfo_8761ATV { ++ u8 cid; ++ u8 len; ++ ++ u8 bConnection:1; ++ u8 bSCOeSCO:1; ++ u8 bInQPage:1; ++ u8 bACLBusy:1; ++ u8 bSCOBusy:1; ++ u8 bHID:1; ++ u8 bA2DP:1; ++ u8 bFTP:1; ++ ++ u8 retry_cnt:4; ++ u8 rsvd_34:1; ++ u8 bPage:1; ++ u8 TRxMask:1; ++ u8 Sniff_attempt:1; ++ ++ u8 rssi; ++ ++ u8 A2dp_rate:1; ++ u8 ReInit:1; ++ u8 MaxPower:1; ++ u8 bEnIgnoreWlanAct:1; ++ u8 TxPowerLow:1; ++ u8 TxPowerHigh:1; ++ u8 eSCO_SCO:1; ++ u8 Master_Slave:1; ++ ++ u8 ACL_TRx_TP_low; ++ u8 ACL_TRx_TP_high; ++}; ++ ++#define HCIOPCODE(_OCF, _OGF) ((_OGF)<<10|(_OCF)) ++#define HCIOPCODELOW(_OCF, _OGF) (u8)(HCIOPCODE(_OCF, _OGF) & 0x00ff) ++#define HCIOPCODEHIGHT(_OCF, _OGF) (u8)(HCIOPCODE(_OCF, _OGF)>>8) ++#define HCI_OGF(opCode) (unsigned char)((0xFC00 & (opCode)) >> 10) ++#define HCI_OCF(opCode) (0x3FF & (opCode)) ++ ++ ++typedef enum _HCI_STATUS { ++ HCI_STATUS_SUCCESS = 0x00, /* Success */ ++ HCI_STATUS_UNKNOW_HCI_CMD = 0x01, /* Unknown HCI Command */ ++ HCI_STATUS_UNKNOW_CONNECT_ID = 0X02, /* Unknown Connection Identifier */ ++ HCI_STATUS_HW_FAIL = 0X03, /* Hardware Failure */ ++ HCI_STATUS_PAGE_TIMEOUT = 0X04, /* Page Timeout */ ++ HCI_STATUS_AUTH_FAIL = 0X05, /* Authentication Failure */ ++ HCI_STATUS_PIN_OR_KEY_MISSING = 0X06, /* PIN or Key Missing */ ++ HCI_STATUS_MEM_CAP_EXCEED = 0X07, /* Memory Capacity Exceeded */ ++ HCI_STATUS_CONNECT_TIMEOUT = 0X08, /* Connection Timeout */ ++ HCI_STATUS_CONNECT_LIMIT = 0X09, /* Connection Limit Exceeded */ ++ HCI_STATUS_SYN_CONNECT_LIMIT = 0X0a, /* Synchronous Connection Limit To A Device Exceeded */ ++ HCI_STATUS_ACL_CONNECT_EXISTS = 0X0b, /* ACL Connection Already Exists */ ++ HCI_STATUS_CMD_DISALLOW = 0X0c, /* Command Disallowed */ ++ HCI_STATUS_CONNECT_RJT_LIMIT_RESOURCE = 0X0d, /* Connection Rejected due to Limited Resources */ ++ HCI_STATUS_CONNECT_RJT_SEC_REASON = 0X0e, /* Connection Rejected Due To Security Reasons */ ++ HCI_STATUS_CONNECT_RJT_UNACCEPT_BD_ADDR = 0X0f, /* Connection Rejected due to Unacceptable BD_ADDR */ ++ HCI_STATUS_CONNECT_ACCEPT_TIMEOUT = 0X10, /* Connection Accept Timeout Exceeded */ ++ HCI_STATUS_UNSUPPORT_FEATURE_PARA_VALUE = 0X11, /* Unsupported Feature or Parameter Value */ ++ HCI_STATUS_INVALID_HCI_CMD_PARA_VALUE = 0X12, /* Invalid HCI Command Parameters */ ++ HCI_STATUS_REMOTE_USER_TERMINATE_CONNECT = 0X13, /* Remote User Terminated Connection */ ++ HCI_STATUS_REMOTE_DEV_TERMINATE_LOW_RESOURCE = 0X14, /* Remote Device Terminated Connection due to Low Resources */ ++ HCI_STATUS_REMOTE_DEV_TERMINATE_CONNECT_POWER_OFF = 0X15, /* Remote Device Terminated Connection due to Power Off */ ++ HCI_STATUS_CONNECT_TERMINATE_LOCAL_HOST = 0X16, /* Connection Terminated By Local Host */ ++ HCI_STATUS_REPEATE_ATTEMPT = 0X17, /* Repeated Attempts */ ++ HCI_STATUS_PAIR_NOT_ALLOW = 0X18, /* Pairing Not Allowed */ ++ HCI_STATUS_UNKNOW_LMP_PDU = 0X19, /* Unknown LMP PDU */ ++ HCI_STATUS_UNSUPPORT_REMOTE_LMP_FEATURE = 0X1a, /* Unsupported Remote Feature / Unsupported LMP Feature */ ++ HCI_STATUS_SOC_OFFSET_REJECT = 0X1b, /* SCO Offset Rejected */ ++ HCI_STATUS_SOC_INTERVAL_REJECT = 0X1c, /* SCO Interval Rejected */ ++ HCI_STATUS_SOC_AIR_MODE_REJECT = 0X1d, /* SCO Air Mode Rejected */ ++ HCI_STATUS_INVALID_LMP_PARA = 0X1e, /* Invalid LMP Parameters */ ++ HCI_STATUS_UNSPECIFIC_ERROR = 0X1f, /* Unspecified Error */ ++ HCI_STATUS_UNSUPPORT_LMP_PARA_VALUE = 0X20, /* Unsupported LMP Parameter Value */ ++ HCI_STATUS_ROLE_CHANGE_NOT_ALLOW = 0X21, /* Role Change Not Allowed */ ++ HCI_STATUS_LMP_RESPONSE_TIMEOUT = 0X22, /* LMP Response Timeout */ ++ HCI_STATUS_LMP_ERROR_TRANSACTION_COLLISION = 0X23, /* LMP Error Transaction Collision */ ++ HCI_STATUS_LMP_PDU_NOT_ALLOW = 0X24, /* LMP PDU Not Allowed */ ++ HCI_STATUS_ENCRYPTION_MODE_NOT_ALLOW = 0X25, /* Encryption Mode Not Acceptable */ ++ HCI_STATUS_LINK_KEY_CAN_NOT_CHANGE = 0X26, /* Link Key Can Not be Changed */ ++ HCI_STATUS_REQUEST_QOS_NOT_SUPPORT = 0X27, /* Requested QoS Not Supported */ ++ HCI_STATUS_INSTANT_PASSED = 0X28, /* Instant Passed */ ++ HCI_STATUS_PAIRING_UNIT_KEY_NOT_SUPPORT = 0X29, /* Pairing With Unit Key Not Supported */ ++ HCI_STATUS_DIFFERENT_TRANSACTION_COLLISION = 0X2a, /* Different Transaction Collision */ ++ HCI_STATUS_RESERVE_1 = 0X2b, /* Reserved */ ++ HCI_STATUS_QOS_UNACCEPT_PARA = 0X2c, /* QoS Unacceptable Parameter */ ++ HCI_STATUS_QOS_REJECT = 0X2d, /* QoS Rejected */ ++ HCI_STATUS_CHNL_CLASSIFICATION_NOT_SUPPORT = 0X2e, /* Channel Classification Not Supported */ ++ HCI_STATUS_INSUFFICIENT_SECURITY = 0X2f, /* Insufficient Security */ ++ HCI_STATUS_PARA_OUT_OF_RANGE = 0x30, /* Parameter Out Of Mandatory Range */ ++ HCI_STATUS_RESERVE_2 = 0X31, /* Reserved */ ++ HCI_STATUS_ROLE_SWITCH_PENDING = 0X32, /* Role Switch Pending */ ++ HCI_STATUS_RESERVE_3 = 0X33, /* Reserved */ ++ HCI_STATUS_RESERVE_SOLT_VIOLATION = 0X34, /* Reserved Slot Violation */ ++ HCI_STATUS_ROLE_SWITCH_FAIL = 0X35, /* Role Switch Failed */ ++ HCI_STATUS_EXTEND_INQUIRY_RSP_TOO_LARGE = 0X36, /* Extended Inquiry Response Too Large */ ++ HCI_STATUS_SEC_SIMPLE_PAIRING_NOT_SUPPORT = 0X37, /* Secure Simple Pairing Not Supported By Host. */ ++ HCI_STATUS_HOST_BUSY_PAIRING = 0X38, /* Host Busy - Pairing */ ++ HCI_STATUS_CONNECT_REJ_NOT_SUIT_CHNL_FOUND = 0X39, /* Connection Rejected due to No Suitable Channel Found */ ++ HCI_STATUS_CONTROLLER_BUSY = 0X3a /* CONTROLLER BUSY */ ++} RTW_HCI_STATUS; ++ ++#define HCI_EVENT_COMMAND_COMPLETE 0x0e ++ ++#define OGF_EXTENSION 0X3f ++typedef enum HCI_EXTENSION_COMMANDS { ++ HCI_SET_ACL_LINK_DATA_FLOW_MODE = 0x0010, ++ HCI_SET_ACL_LINK_STATUS = 0x0020, ++ HCI_SET_SCO_LINK_STATUS = 0x0030, ++ HCI_SET_RSSI_VALUE = 0x0040, ++ HCI_SET_CURRENT_BLUETOOTH_STATUS = 0x0041, ++ ++ /* The following is for RTK8723 */ ++ HCI_EXTENSION_VERSION_NOTIFY = 0x0100, ++ HCI_LINK_STATUS_NOTIFY = 0x0101, ++ HCI_BT_OPERATION_NOTIFY = 0x0102, ++ HCI_ENABLE_WIFI_SCAN_NOTIFY = 0x0103, ++ HCI_QUERY_RF_STATUS = 0x0104, ++ HCI_BT_ABNORMAL_NOTIFY = 0x0105, ++ HCI_BT_INFO_NOTIFY = 0x0106, ++ HCI_BT_COEX_NOTIFY = 0x0107, ++ HCI_BT_PATCH_VERSION_NOTIFY = 0x0108, ++ HCI_BT_AFH_MAP_NOTIFY = 0x0109, ++ HCI_BT_REGISTER_VALUE_NOTIFY = 0x010a, ++ ++ /* The following is for IVT */ ++ HCI_WIFI_CURRENT_CHANNEL = 0x0300, ++ HCI_WIFI_CURRENT_BANDWIDTH = 0x0301, ++ HCI_WIFI_CONNECTION_STATUS = 0x0302 ++} RTW_HCI_EXT_CMD; ++ ++#define HCI_EVENT_EXTENSION_RTK 0xfe ++typedef enum HCI_EXTENSION_EVENT_RTK { ++ HCI_EVENT_EXT_WIFI_SCAN_NOTIFY = 0x01, ++ HCI_EVENT_EXT_WIFI_RF_STATUS_NOTIFY = 0x02, ++ HCI_EVENT_EXT_BT_INFO_CONTROL = 0x03, ++ HCI_EVENT_EXT_BT_COEX_CONTROL = 0x04 ++} RTW_HCI_EXT_EVENT; ++ ++typedef enum _BT_TRAFFIC_MODE { ++ BT_MOTOR_EXT_BE = 0x00, /* Best Effort. Default. for HCRP, PAN, SDP, RFCOMM-based profiles like FTP,OPP, SPP, DUN, etc. */ ++ BT_MOTOR_EXT_GUL = 0x01, /* Guaranteed Latency. This type of traffic is used e.g. for HID and AVRCP. */ ++ BT_MOTOR_EXT_GUB = 0X02, /* Guaranteed Bandwidth. */ ++ BT_MOTOR_EXT_GULB = 0X03 /* Guaranteed Latency and Bandwidth. for A2DP and VDP. */ ++} BT_TRAFFIC_MODE; ++ ++typedef enum _BT_TRAFFIC_MODE_PROFILE { ++ BT_PROFILE_NONE, ++ BT_PROFILE_A2DP, ++ BT_PROFILE_PAN , ++ BT_PROFILE_HID, ++ BT_PROFILE_SCO ++} BT_TRAFFIC_MODE_PROFILE; ++ ++typedef enum _HCI_EXT_BT_OPERATION { ++ HCI_BT_OP_NONE = 0x0, ++ HCI_BT_OP_INQUIRY_START = 0x1, ++ HCI_BT_OP_INQUIRY_FINISH = 0x2, ++ HCI_BT_OP_PAGING_START = 0x3, ++ HCI_BT_OP_PAGING_SUCCESS = 0x4, ++ HCI_BT_OP_PAGING_UNSUCCESS = 0x5, ++ HCI_BT_OP_PAIRING_START = 0x6, ++ HCI_BT_OP_PAIRING_FINISH = 0x7, ++ HCI_BT_OP_BT_DEV_ENABLE = 0x8, ++ HCI_BT_OP_BT_DEV_DISABLE = 0x9, ++ HCI_BT_OP_MAX ++} HCI_EXT_BT_OPERATION, *PHCI_EXT_BT_OPERATION; ++ ++typedef struct _BT_MGNT { ++ BOOLEAN bBTConnectInProgress; ++ BOOLEAN bLogLinkInProgress; ++ BOOLEAN bPhyLinkInProgress; ++ BOOLEAN bPhyLinkInProgressStartLL; ++ u1Byte BtCurrentPhyLinkhandle; ++ u2Byte BtCurrentLogLinkhandle; ++ u1Byte CurrentConnectEntryNum; ++ u1Byte DisconnectEntryNum; ++ u1Byte CurrentBTConnectionCnt; ++ BT_CONNECT_TYPE BTCurrentConnectType; ++ BT_CONNECT_TYPE BTReceiveConnectPkt; ++ u1Byte BTAuthCount; ++ u1Byte BTAsocCount; ++ BOOLEAN bStartSendSupervisionPkt; ++ BOOLEAN BtOperationOn; ++ BOOLEAN BTNeedAMPStatusChg; ++ BOOLEAN JoinerNeedSendAuth; ++ HCI_PHY_LINK_BSS_INFO bssDesc; ++ HCI_EXT_CONFIG ExtConfig; ++ BOOLEAN bNeedNotifyAMPNoCap; ++ BOOLEAN bCreateSpportQos; ++ BOOLEAN bSupportProfile; ++ u1Byte BTChannel; ++ BOOLEAN CheckChnlIsSuit; ++ BOOLEAN bBtScan; ++ BOOLEAN btLogoTest; ++ BOOLEAN bRfStatusNotified; ++ BOOLEAN bBtRsvedPageDownload; ++} BT_MGNT, *PBT_MGNT; ++ ++struct bt_coex_info { ++ /* For Kernel Socket */ ++ struct socket *udpsock; ++ struct sockaddr_in wifi_sockaddr; /*wifi socket*/ ++ struct sockaddr_in bt_sockaddr;/* BT socket */ ++ struct sock *sk_store;/*back up socket for UDP RX int*/ ++ ++ /* store which socket is OK */ ++ u8 sock_open; ++ ++ u8 BT_attend; ++ u8 is_exist; /* socket exist */ ++ BT_MGNT BtMgnt; ++ struct workqueue_struct *btcoex_wq; ++ struct delayed_work recvmsg_work; ++}; ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++ ++#define PACKET_NORMAL 0 ++#define PACKET_DHCP 1 ++#define PACKET_ARP 2 ++#define PACKET_EAPOL 3 ++ ++void rtw_btcoex_Initialize(PADAPTER); ++void rtw_btcoex_PowerOnSetting(PADAPTER padapter); ++void rtw_btcoex_PowerOffSetting(PADAPTER padapter); ++void rtw_btcoex_PreLoadFirmware(PADAPTER padapter); ++void rtw_btcoex_HAL_Initialize(PADAPTER padapter, u8 bWifiOnly); ++void rtw_btcoex_IpsNotify(PADAPTER, u8 type); ++void rtw_btcoex_LpsNotify(PADAPTER, u8 type); ++void rtw_btcoex_ScanNotify(PADAPTER, u8 type); ++void rtw_btcoex_ConnectNotify(PADAPTER, u8 action); ++void rtw_btcoex_MediaStatusNotify(PADAPTER, u8 mediaStatus); ++void rtw_btcoex_SpecialPacketNotify(PADAPTER, u8 pktType); ++void rtw_btcoex_IQKNotify(PADAPTER padapter, u8 state); ++void rtw_btcoex_BtInfoNotify(PADAPTER, u8 length, u8 *tmpBuf); ++void rtw_btcoex_BtMpRptNotify(PADAPTER, u8 length, u8 *tmpBuf); ++void rtw_btcoex_SuspendNotify(PADAPTER, u8 state); ++void rtw_btcoex_HaltNotify(PADAPTER); ++void rtw_btcoex_switchband_notify(u8 under_scan, u8 band_type); ++void rtw_btcoex_SwitchBtTRxMask(PADAPTER); ++void rtw_btcoex_Switch(PADAPTER, u8 enable); ++u8 rtw_btcoex_IsBtDisabled(PADAPTER); ++void rtw_btcoex_Handler(PADAPTER); ++s32 rtw_btcoex_IsBTCoexRejectAMPDU(PADAPTER padapter); ++s32 rtw_btcoex_IsBTCoexCtrlAMPDUSize(PADAPTER); ++u32 rtw_btcoex_GetAMPDUSize(PADAPTER); ++void rtw_btcoex_SetManualControl(PADAPTER, u8 bmanual); ++u8 rtw_btcoex_1Ant(PADAPTER); ++u8 rtw_btcoex_IsBtControlLps(PADAPTER); ++u8 rtw_btcoex_IsLpsOn(PADAPTER); ++u8 rtw_btcoex_RpwmVal(PADAPTER); ++u8 rtw_btcoex_LpsVal(PADAPTER); ++u32 rtw_btcoex_GetRaMask(PADAPTER); ++void rtw_btcoex_RecordPwrMode(PADAPTER, u8 *pCmdBuf, u8 cmdLen); ++void rtw_btcoex_DisplayBtCoexInfo(PADAPTER, u8 *pbuf, u32 bufsize); ++void rtw_btcoex_SetDBG(PADAPTER, u32 *pDbgModule); ++u32 rtw_btcoex_GetDBG(PADAPTER, u8 *pStrBuf, u32 bufSize); ++u8 rtw_btcoex_IncreaseScanDeviceNum(PADAPTER); ++u8 rtw_btcoex_IsBtLinkExist(PADAPTER); ++void rtw_btcoex_BTOffOnNotify(PADAPTER padapter, u8 bBTON); ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++void rtw_btcoex_SetBtPatchVersion(PADAPTER padapter, u16 btHciVer, u16 btPatchVer); ++void rtw_btcoex_SetHciVersion(PADAPTER padapter, u16 hciVersion); ++void rtw_btcoex_StackUpdateProfileInfo(void); ++void rtw_btcoex_init_socket(_adapter *padapter); ++void rtw_btcoex_close_socket(_adapter *padapter); ++void rtw_btcoex_dump_tx_msg(u8 *tx_msg, u8 len, u8 *msg_name); ++u8 rtw_btcoex_sendmsgbysocket(_adapter *padapter, u8 *msg, u8 msg_size, bool force); ++u8 rtw_btcoex_create_kernel_socket(_adapter *padapter); ++void rtw_btcoex_close_kernel_socket(_adapter *padapter); ++void rtw_btcoex_recvmsgbysocket(void *data); ++u16 rtw_btcoex_parse_recv_data(u8 *msg, u8 msg_size); ++u8 rtw_btcoex_btinfo_cmd(PADAPTER padapter, u8 *pbuf, u16 length); ++void rtw_btcoex_parse_hci_cmd(_adapter *padapter, u8 *cmd, u16 len); ++void rtw_btcoex_SendEventExtBtCoexControl(PADAPTER Adapter, u8 bNeedDbgRsp, u8 dataLen, void *pData); ++void rtw_btcoex_SendEventExtBtInfoControl(PADAPTER Adapter, u8 dataLen, void *pData); ++void rtw_btcoex_SendScanNotify(PADAPTER padapter, u8 scanType); ++#define BT_SendEventExtBtCoexControl(Adapter, bNeedDbgRsp, dataLen, pData) rtw_btcoex_SendEventExtBtCoexControl(Adapter, bNeedDbgRsp, dataLen, pData) ++#define BT_SendEventExtBtInfoControl(Adapter, dataLen, pData) rtw_btcoex_SendEventExtBtInfoControl(Adapter, dataLen, pData) ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++u16 rtw_btcoex_btreg_read(PADAPTER padapter, u8 type, u16 addr, u32 *data); ++u16 rtw_btcoex_btreg_write(PADAPTER padapter, u8 type, u16 addr, u16 val); ++u8 rtw_btcoex_get_ant_div_cfg(PADAPTER padapter); ++u8 rtw_btcoex_get_bt_coexist(PADAPTER padapter); ++u8 rtw_btcoex_get_chip_type(PADAPTER padapter); ++u8 rtw_btcoex_get_pg_ant_num(PADAPTER padapter); ++u8 rtw_btcoex_get_pg_single_ant_path(PADAPTER padapter); ++u8 rtw_btcoex_get_pg_rfe_type(PADAPTER padapter); ++u8 rtw_btcoex_is_tfbga_package_type(PADAPTER padapter); ++u8 rtw_btcoex_get_ant_div_cfg(PADAPTER padapter); ++ ++/* ================================================== ++ * Below Functions are called by BT-Coex ++ * ================================================== */ ++void rtw_btcoex_rx_ampdu_apply(PADAPTER); ++void rtw_btcoex_LPS_Enter(PADAPTER); ++void rtw_btcoex_LPS_Leave(PADAPTER); ++ ++#endif /* __RTW_BTCOEX_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_bt_mp.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_bt_mp.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_bt_mp.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_bt_mp.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,293 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef __RTW_BT_MP_H ++#define __RTW_BT_MP_H ++ ++ ++#if (MP_DRIVER == 1) ++ ++#pragma pack(1) ++ ++/* definition for BT_UP_OP_BT_READY */ ++#define MP_BT_NOT_READY 0 ++#define MP_BT_READY 1 ++ ++/* definition for BT_UP_OP_BT_SET_MODE */ ++typedef enum _MP_BT_MODE { ++ MP_BT_MODE_RF_TXRX_TEST_MODE = 0, ++ MP_BT_MODE_BT20_DUT_TEST_MODE = 1, ++ MP_BT_MODE_BT40_DIRECT_TEST_MODE = 2, ++ MP_BT_MODE_CONNECT_TEST_MODE = 3, ++ MP_BT_MODE_MAX ++} MP_BT_MODE, *PMP_BT_MODE; ++ ++ ++/* definition for BT_UP_OP_BT_SET_TX_RX_PARAMETER */ ++typedef struct _BT_TXRX_PARAMETERS { ++ u1Byte txrxChannel; ++ u4Byte txrxTxPktCnt; ++ u1Byte txrxTxPktInterval; ++ u1Byte txrxPayloadType; ++ u1Byte txrxPktType; ++ u2Byte txrxPayloadLen; ++ u4Byte txrxPktHeader; ++ u1Byte txrxWhitenCoeff; ++ u1Byte txrxBdaddr[6]; ++ u1Byte txrxTxGainIndex; ++} BT_TXRX_PARAMETERS, *PBT_TXRX_PARAMETERS; ++ ++/* txrxPktType */ ++typedef enum _MP_BT_PKT_TYPE { ++ MP_BT_PKT_DH1 = 0, ++ MP_BT_PKT_DH3 = 1, ++ MP_BT_PKT_DH5 = 2, ++ MP_BT_PKT_2DH1 = 3, ++ MP_BT_PKT_2DH3 = 4, ++ MP_BT_PKT_2DH5 = 5, ++ MP_BT_PKT_3DH1 = 6, ++ MP_BT_PKT_3DH3 = 7, ++ MP_BT_PKT_3DH5 = 8, ++ MP_BT_PKT_LE = 9, ++ MP_BT_PKT_MAX ++} MP_BT_PKT_TYPE, *PMP_BT_PKT_TYPE; ++/* txrxPayloadType */ ++typedef enum _MP_BT_PAYLOAD_TYPE { ++ MP_BT_PAYLOAD_01010101 = 0, ++ MP_BT_PAYLOAD_ALL_1 = 1, ++ MP_BT_PAYLOAD_ALL_0 = 2, ++ MP_BT_PAYLOAD_11110000 = 3, ++ MP_BT_PAYLOAD_PRBS9 = 4, ++ MP_BT_PAYLOAD_MAX = 8, ++} MP_BT_PAYLOAD_TYPE, *PMP_BT_PAYLOAD_TYPE; ++ ++ ++/* definition for BT_UP_OP_BT_TEST_CTRL */ ++typedef enum _MP_BT_TEST_CTRL { ++ MP_BT_TEST_STOP_ALL_TESTS = 0, ++ MP_BT_TEST_START_RX_TEST = 1, ++ MP_BT_TEST_START_PACKET_TX_TEST = 2, ++ MP_BT_TEST_START_CONTINUOUS_TX_TEST = 3, ++ MP_BT_TEST_START_INQUIRY_SCAN_TEST = 4, ++ MP_BT_TEST_START_PAGE_SCAN_TEST = 5, ++ MP_BT_TEST_START_INQUIRY_PAGE_SCAN_TEST = 6, ++ MP_BT_TEST_START_LEGACY_CONNECT_TEST = 7, ++ MP_BT_TEST_START_LE_CONNECT_TEST_INITIATOR = 8, ++ MP_BT_TEST_START_LE_CONNECT_TEST_ADVERTISER = 9, ++ MP_BT_TEST_MAX ++} MP_BT_TEST_CTRL, *PMP_BT_TEST_CTRL; ++ ++ ++typedef enum _RTL_EXT_C2H_EVT { ++ EXT_C2H_WIFI_FW_ACTIVE_RSP = 0, ++ EXT_C2H_TRIG_BY_BT_FW = 1, ++ MAX_EXT_C2HEVENT ++} RTL_EXT_C2H_EVT; ++ ++/* OP codes definition between the user layer and driver */ ++typedef enum _BT_CTRL_OPCODE_UPPER { ++ BT_UP_OP_BT_READY = 0x00, ++ BT_UP_OP_BT_SET_MODE = 0x01, ++ BT_UP_OP_BT_SET_TX_RX_PARAMETER = 0x02, ++ BT_UP_OP_BT_SET_GENERAL = 0x03, ++ BT_UP_OP_BT_GET_GENERAL = 0x04, ++ BT_UP_OP_BT_TEST_CTRL = 0x05, ++ BT_UP_OP_TEST_BT = 0x06, ++ BT_UP_OP_MAX ++} BT_CTRL_OPCODE_UPPER, *PBT_CTRL_OPCODE_UPPER; ++ ++ ++typedef enum _BT_SET_GENERAL { ++ BT_GSET_REG = 0x00, ++ BT_GSET_RESET = 0x01, ++ BT_GSET_TARGET_BD_ADDR = 0x02, ++ BT_GSET_TX_PWR_FINETUNE = 0x03, ++ BT_SET_TRACKING_INTERVAL = 0x04, ++ BT_SET_THERMAL_METER = 0x05, ++ BT_ENABLE_CFO_TRACKING = 0x06, ++ BT_GSET_UPDATE_BT_PATCH = 0x07, ++ BT_GSET_MAX ++} BT_SET_GENERAL, *PBT_SET_GENERAL; ++ ++typedef enum _BT_GET_GENERAL { ++ BT_GGET_REG = 0x00, ++ BT_GGET_STATUS = 0x01, ++ BT_GGET_REPORT = 0x02, ++ BT_GGET_AFH_MAP = 0x03, ++ BT_GGET_AFH_STATUS = 0x04, ++ BT_GGET_MAX ++} BT_GET_GENERAL, *PBT_GET_GENERAL; ++ ++/* definition for BT_UP_OP_BT_SET_GENERAL */ ++typedef enum _BT_REG_TYPE { ++ BT_REG_RF = 0, ++ BT_REG_MODEM = 1, ++ BT_REG_BLUEWIZE = 2, ++ BT_REG_VENDOR = 3, ++ BT_REG_LE = 4, ++ BT_REG_MAX ++} BT_REG_TYPE, *PBT_REG_TYPE; ++ ++/* definition for BT_LO_OP_GET_AFH_MAP */ ++typedef enum _BT_AFH_MAP_TYPE { ++ BT_AFH_MAP_RESULT = 0, ++ BT_AFH_MAP_WIFI_PSD_ONLY = 1, ++ BT_AFH_MAP_WIFI_CH_BW_ONLY = 2, ++ BT_AFH_MAP_BT_PSD_ONLY = 3, ++ BT_AFH_MAP_HOST_CLASSIFICATION_ONLY = 4, ++ BT_AFH_MAP_MAX ++} BT_AFH_MAP_TYPE, *PBT_AFH_MAP_TYPE; ++ ++/* definition for BT_UP_OP_BT_GET_GENERAL */ ++typedef enum _BT_REPORT_TYPE { ++ BT_REPORT_RX_PACKET_CNT = 0, ++ BT_REPORT_RX_ERROR_BITS = 1, ++ BT_REPORT_RSSI = 2, ++ BT_REPORT_CFO_HDR_QUALITY = 3, ++ BT_REPORT_CONNECT_TARGET_BD_ADDR = 4, ++ BT_REPORT_MAX ++} BT_REPORT_TYPE, *PBT_REPORT_TYPE; ++ ++VOID ++MPTBT_Test( ++ IN PADAPTER Adapter, ++ IN u1Byte opCode, ++ IN u1Byte byte1, ++ IN u1Byte byte2, ++ IN u1Byte byte3 ++); ++ ++NDIS_STATUS ++MPTBT_SendOidBT( ++ IN PADAPTER pAdapter, ++ IN PVOID InformationBuffer, ++ IN ULONG InformationBufferLength, ++ OUT PULONG BytesRead, ++ OUT PULONG BytesNeeded ++); ++ ++VOID ++MPTBT_FwC2hBtMpCtrl( ++ PADAPTER Adapter, ++ pu1Byte tmpBuf, ++ u1Byte length ++); ++ ++void MPh2c_timeout_handle(void *FunctionContext); ++ ++VOID mptbt_BtControlProcess( ++ PADAPTER Adapter, ++ PVOID pInBuf ++); ++ ++#define BT_H2C_MAX_RETRY 1 ++#define BT_MAX_C2H_LEN 20 ++ ++typedef struct _BT_REQ_CMD { ++ UCHAR opCodeVer; ++ UCHAR OpCode; ++ USHORT paraLength; ++ UCHAR pParamStart[100]; ++} BT_REQ_CMD, *PBT_REQ_CMD; ++ ++typedef struct _BT_RSP_CMD { ++ USHORT status; ++ USHORT paraLength; ++ UCHAR pParamStart[100]; ++} BT_RSP_CMD, *PBT_RSP_CMD; ++ ++ ++typedef struct _BT_H2C { ++ u1Byte opCodeVer:4; ++ u1Byte reqNum:4; ++ u1Byte opCode; ++ u1Byte buf[100]; ++} BT_H2C, *PBT_H2C; ++ ++ ++ ++typedef struct _BT_EXT_C2H { ++ u1Byte extendId; ++ u1Byte statusCode:4; ++ u1Byte retLen:4; ++ u1Byte opCodeVer:4; ++ u1Byte reqNum:4; ++ u1Byte buf[100]; ++} BT_EXT_C2H, *PBT_EXT_C2H; ++ ++ ++typedef enum _BT_OPCODE_STATUS { ++ BT_OP_STATUS_SUCCESS = 0x00, /* Success */ ++ BT_OP_STATUS_VERSION_MISMATCH = 0x01, ++ BT_OP_STATUS_UNKNOWN_OPCODE = 0x02, ++ BT_OP_STATUS_ERROR_PARAMETER = 0x03, ++ BT_OP_STATUS_MAX ++} BT_OPCODE_STATUS, *PBT_OPCODE_STATUS; ++ ++ ++ ++/* OP codes definition between driver and bt fw */ ++typedef enum _BT_CTRL_OPCODE_LOWER { ++ BT_LO_OP_GET_BT_VERSION = 0x00, ++ BT_LO_OP_RESET = 0x01, ++ BT_LO_OP_TEST_CTRL = 0x02, ++ BT_LO_OP_SET_BT_MODE = 0x03, ++ BT_LO_OP_SET_CHNL_TX_GAIN = 0x04, ++ BT_LO_OP_SET_PKT_TYPE_LEN = 0x05, ++ BT_LO_OP_SET_PKT_CNT_L_PL_TYPE = 0x06, ++ BT_LO_OP_SET_PKT_CNT_H_PKT_INTV = 0x07, ++ BT_LO_OP_SET_PKT_HEADER = 0x08, ++ BT_LO_OP_SET_WHITENCOEFF = 0x09, ++ BT_LO_OP_SET_BD_ADDR_L = 0x0a, ++ BT_LO_OP_SET_BD_ADDR_H = 0x0b, ++ BT_LO_OP_WRITE_REG_ADDR = 0x0c, ++ BT_LO_OP_WRITE_REG_VALUE = 0x0d, ++ BT_LO_OP_GET_BT_STATUS = 0x0e, ++ BT_LO_OP_GET_BD_ADDR_L = 0x0f, ++ BT_LO_OP_GET_BD_ADDR_H = 0x10, ++ BT_LO_OP_READ_REG = 0x11, ++ BT_LO_OP_SET_TARGET_BD_ADDR_L = 0x12, ++ BT_LO_OP_SET_TARGET_BD_ADDR_H = 0x13, ++ BT_LO_OP_SET_TX_POWER_CALIBRATION = 0x14, ++ BT_LO_OP_GET_RX_PKT_CNT_L = 0x15, ++ BT_LO_OP_GET_RX_PKT_CNT_H = 0x16, ++ BT_LO_OP_GET_RX_ERROR_BITS_L = 0x17, ++ BT_LO_OP_GET_RX_ERROR_BITS_H = 0x18, ++ BT_LO_OP_GET_RSSI = 0x19, ++ BT_LO_OP_GET_CFO_HDR_QUALITY_L = 0x1a, ++ BT_LO_OP_GET_CFO_HDR_QUALITY_H = 0x1b, ++ BT_LO_OP_GET_TARGET_BD_ADDR_L = 0x1c, ++ BT_LO_OP_GET_TARGET_BD_ADDR_H = 0x1d, ++ BT_LO_OP_GET_AFH_MAP_L = 0x1e, ++ BT_LO_OP_GET_AFH_MAP_M = 0x1f, ++ BT_LO_OP_GET_AFH_MAP_H = 0x20, ++ BT_LO_OP_GET_AFH_STATUS = 0x21, ++ BT_LO_OP_SET_TRACKING_INTERVAL = 0x22, ++ BT_LO_OP_SET_THERMAL_METER = 0x23, ++ BT_LO_OP_ENABLE_CFO_TRACKING = 0x24, ++ BT_LO_OP_MAX ++} BT_CTRL_OPCODE_LOWER, *PBT_CTRL_OPCODE_LOWER; ++ ++ ++ ++ ++#endif /* #if(MP_DRIVER == 1) */ ++ ++#endif /* #ifndef __INC_MPT_BT_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_byteorder.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_byteorder.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_byteorder.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_byteorder.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,38 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTL871X_BYTEORDER_H_ ++#define _RTL871X_BYTEORDER_H_ ++ ++ ++#if defined(CONFIG_LITTLE_ENDIAN) && defined (CONFIG_BIG_ENDIAN) ++ #error "Shall be CONFIG_LITTLE_ENDIAN or CONFIG_BIG_ENDIAN, but not both!\n" ++#endif ++ ++#if defined(CONFIG_LITTLE_ENDIAN) ++ #ifndef CONFIG_PLATFORM_MSTAR389 ++ #include ++ #endif ++#elif defined (CONFIG_BIG_ENDIAN) ++ #include ++#else ++ # error "Must be LITTLE/BIG Endian Host" ++#endif ++ ++#endif /* _RTL871X_BYTEORDER_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_cmd.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_cmd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_cmd.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,1319 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_CMD_H_ ++#define __RTW_CMD_H_ ++ ++ ++#define C2H_MEM_SZ (16*1024) ++ ++#ifndef CONFIG_RTL8711FW ++ ++#define FREE_CMDOBJ_SZ 128 ++ ++#define MAX_CMDSZ 1024 ++#define MAX_RSPSZ 512 ++#define MAX_EVTSZ 1024 ++ ++#ifdef PLATFORM_OS_CE ++ #define CMDBUFF_ALIGN_SZ 4 ++#else ++ #define CMDBUFF_ALIGN_SZ 512 ++#endif ++ ++struct cmd_obj { ++ _adapter *padapter; ++ u16 cmdcode; ++ u8 res; ++ u8 *parmbuf; ++ u32 cmdsz; ++ u8 *rsp; ++ u32 rspsz; ++ struct submit_ctx *sctx; ++ u8 no_io; ++ /* _sema cmd_sem; */ ++ _list list; ++}; ++ ++/* cmd flags */ ++enum { ++ RTW_CMDF_DIRECTLY = BIT0, ++ RTW_CMDF_WAIT_ACK = BIT1, ++}; ++ ++struct cmd_priv { ++ _sema cmd_queue_sema; ++ /* _sema cmd_done_sema; */ ++ /*_sema terminate_cmdthread_sema;*/ ++ _sema start_cmdthread_sema; ++ _completion cmdthread_comp; ++ _queue cmd_queue; ++ u8 cmd_seq; ++ u8 *cmd_buf; /* shall be non-paged, and 4 bytes aligned */ ++ u8 *cmd_allocated_buf; ++ u8 *rsp_buf; /* shall be non-paged, and 4 bytes aligned */ ++ u8 *rsp_allocated_buf; ++ u32 cmd_issued_cnt; ++ u32 cmd_done_cnt; ++ u32 rsp_cnt; ++ ATOMIC_T cmdthd_running; ++ /* u8 cmdthd_running; */ ++ u8 stop_req; ++ _adapter *padapter; ++ _mutex sctx_mutex; ++}; ++ ++#ifdef CONFIG_EVENT_THREAD_MODE ++struct evt_obj { ++ u16 evtcode; ++ u8 res; ++ u8 *parmbuf; ++ u32 evtsz; ++ _list list; ++}; ++#endif ++ ++struct evt_priv { ++#ifdef CONFIG_EVENT_THREAD_MODE ++ _sema evt_notify; ++ _sema terminate_evtthread_sema; ++ _queue evt_queue; ++#endif ++ ++#ifdef CONFIG_FW_C2H_REG ++ #define CONFIG_C2H_WK ++#endif ++ ++#ifdef CONFIG_C2H_WK ++ _workitem c2h_wk; ++ bool c2h_wk_alive; ++ struct rtw_cbuf *c2h_queue; ++ #define C2H_QUEUE_MAX_LEN 10 ++#endif ++ ++#ifdef CONFIG_H2CLBK ++ _sema lbkevt_done; ++ u8 lbkevt_limit; ++ u8 lbkevt_num; ++ u8 *cmdevt_parm; ++#endif ++ ATOMIC_T event_seq; ++ u8 *evt_buf; /* shall be non-paged, and 4 bytes aligned */ ++ u8 *evt_allocated_buf; ++ u32 evt_done_cnt; ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ u8 *c2h_mem; ++ u8 *allocated_c2h_mem; ++#ifdef PLATFORM_OS_XP ++ PMDL pc2h_mdl; ++#endif ++#endif ++ ++}; ++ ++#define init_h2fwcmd_w_parm_no_rsp(pcmd, pparm, code) \ ++ do {\ ++ _rtw_init_listhead(&pcmd->list);\ ++ pcmd->cmdcode = code;\ ++ pcmd->parmbuf = (u8 *)(pparm);\ ++ pcmd->cmdsz = sizeof (*pparm);\ ++ pcmd->rsp = NULL;\ ++ pcmd->rspsz = 0;\ ++ } while (0) ++ ++#define init_h2fwcmd_w_parm_no_parm_rsp(pcmd, code) \ ++ do {\ ++ _rtw_init_listhead(&pcmd->list);\ ++ pcmd->cmdcode = code;\ ++ pcmd->parmbuf = NULL;\ ++ pcmd->cmdsz = 0;\ ++ pcmd->rsp = NULL;\ ++ pcmd->rspsz = 0;\ ++ } while (0) ++ ++struct P2P_PS_Offload_t { ++ u8 Offload_En:1; ++ u8 role:1; /* 1: Owner, 0: Client */ ++ u8 CTWindow_En:1; ++ u8 NoA0_En:1; ++ u8 NoA1_En:1; ++ u8 AllStaSleep:1; /* Only valid in Owner */ ++ u8 discovery:1; ++ u8 rsvd:1; ++}; ++ ++struct P2P_PS_CTWPeriod_t { ++ u8 CTWPeriod; /* TU */ ++}; ++ ++#ifdef CONFIG_P2P_WOWLAN ++ ++struct P2P_WoWlan_Offload_t { ++ u8 Disconnect_Wkup_Drv:1; ++ u8 role:2; ++ u8 Wps_Config[2]; ++}; ++ ++#endif /* CONFIG_P2P_WOWLAN */ ++ ++extern u32 rtw_enqueue_cmd(struct cmd_priv *pcmdpriv, struct cmd_obj *obj); ++extern struct cmd_obj *rtw_dequeue_cmd(struct cmd_priv *pcmdpriv); ++extern void rtw_free_cmd_obj(struct cmd_obj *pcmd); ++ ++#ifdef CONFIG_EVENT_THREAD_MODE ++extern u32 rtw_enqueue_evt(struct evt_priv *pevtpriv, struct evt_obj *obj); ++extern struct evt_obj *rtw_dequeue_evt(_queue *queue); ++extern void rtw_free_evt_obj(struct evt_obj *pcmd); ++#endif ++ ++void rtw_stop_cmd_thread(_adapter *adapter); ++thread_return rtw_cmd_thread(thread_context context); ++ ++extern u32 rtw_init_cmd_priv(struct cmd_priv *pcmdpriv); ++extern void rtw_free_cmd_priv(struct cmd_priv *pcmdpriv); ++ ++extern u32 rtw_init_evt_priv(struct evt_priv *pevtpriv); ++extern void rtw_free_evt_priv(struct evt_priv *pevtpriv); ++extern void rtw_cmd_clr_isr(struct cmd_priv *pcmdpriv); ++extern void rtw_evt_notify_isr(struct evt_priv *pevtpriv); ++#ifdef CONFIG_P2P ++u8 p2p_protocol_wk_cmd(_adapter *padapter, int intCmdType); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++struct p2p_roch_parm { ++ u64 cookie; ++ struct wireless_dev *wdev; ++ struct ieee80211_channel ch; ++ enum nl80211_channel_type ch_type; ++ unsigned int duration; ++}; ++ ++u8 p2p_roch_cmd(_adapter *adapter ++ , u64 cookie, struct wireless_dev *wdev ++ , struct ieee80211_channel *ch, enum nl80211_channel_type ch_type ++ , unsigned int duration ++ , u8 flags ++); ++u8 p2p_cancel_roch_cmd(_adapter *adapter, u64 cookie, struct wireless_dev *wdev, u8 flags); ++#endif /* CONFIG_IOCTL_CFG80211 */ ++#endif /* CONFIG_P2P */ ++ ++#else ++/* #include */ ++#endif /* CONFIG_RTL8711FW */ ++ ++enum rtw_drvextra_cmd_id { ++ NONE_WK_CID, ++ STA_MSTATUS_RPT_WK_CID, ++ DYNAMIC_CHK_WK_CID, ++ DM_CTRL_WK_CID, ++ PBC_POLLING_WK_CID, ++ POWER_SAVING_CTRL_WK_CID,/* IPS,AUTOSuspend */ ++ LPS_CTRL_WK_CID, ++ ANT_SELECT_WK_CID, ++ P2P_PS_WK_CID, ++ P2P_PROTO_WK_CID, ++ CHECK_HIQ_WK_CID,/* for softap mode, check hi queue if empty */ ++ INTEl_WIDI_WK_CID, ++ C2H_WK_CID, ++ RTP_TIMER_CFG_WK_CID, ++ RESET_SECURITYPRIV, /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ FREE_ASSOC_RESOURCES, /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ DM_IN_LPS_WK_CID, ++ DM_RA_MSK_WK_CID, /* add for STA update RAMask when bandwith change. */ ++ BEAMFORMING_WK_CID, ++ LPS_CHANGE_DTIM_CID, ++ BTINFO_WK_CID, ++ DFS_MASTER_WK_CID, ++ SESSION_TRACKER_WK_CID, ++ EN_HW_UPDATE_TSF_WK_CID, ++ TEST_H2C_CID, ++ CUSTOMER_STR_WK_CID, ++ MAX_WK_CID ++}; ++ ++enum LPS_CTRL_TYPE { ++ LPS_CTRL_SCAN = 0, ++ LPS_CTRL_JOINBSS = 1, ++ LPS_CTRL_CONNECT = 2, ++ LPS_CTRL_DISCONNECT = 3, ++ LPS_CTRL_SPECIAL_PACKET = 4, ++ LPS_CTRL_LEAVE = 5, ++ LPS_CTRL_TRAFFIC_BUSY = 6, ++ LPS_CTRL_TX_TRAFFIC_LEAVE = 7, ++ LPS_CTRL_RX_TRAFFIC_LEAVE = 8, ++ LPS_CTRL_ENTER = 9, ++ LPS_CTRL_LEAVE_CFG80211_PWRMGMT = 10, ++}; ++ ++enum STAKEY_TYPE { ++ GROUP_KEY = 0, ++ UNICAST_KEY = 1, ++ TDLS_KEY = 2, ++}; ++ ++enum RFINTFS { ++ SWSI, ++ HWSI, ++ HWPI, ++}; ++ ++/* ++Caller Mode: Infra, Ad-HoC(C) ++ ++Notes: To enter USB suspend mode ++ ++Command Mode ++ ++*/ ++struct usb_suspend_parm { ++ u32 action;/* 1: sleep, 0:resume */ ++}; ++ ++/* ++Caller Mode: Infra, Ad-HoC ++ ++Notes: To join a known BSS. ++ ++Command-Event Mode ++ ++*/ ++ ++/* ++Caller Mode: Infra, Ad-Hoc ++ ++Notes: To join the specified bss ++ ++Command Event Mode ++ ++*/ ++struct joinbss_parm { ++ WLAN_BSSID_EX network; ++}; ++ ++/* ++Caller Mode: Infra, Ad-HoC(C) ++ ++Notes: To disconnect the current associated BSS ++ ++Command Mode ++ ++*/ ++struct disconnect_parm { ++ u32 deauth_timeout_ms; ++}; ++ ++/* ++Caller Mode: AP, Ad-HoC(M) ++ ++Notes: To create a BSS ++ ++Command Mode ++*/ ++struct createbss_parm { ++ bool adhoc; ++ ++ /* used by AP mode now */ ++ s16 req_ch; ++ s8 req_bw; ++ s8 req_offset; ++}; ++ ++#if 0 ++/* Caller Mode: AP, Ad-HoC, Infra */ ++/* Notes: To set the NIC mode of RTL8711 */ ++/* Command Mode */ ++/* The definition of mode: */ ++ ++#define IW_MODE_AUTO 0 /* Let the driver decides which AP to join */ ++#define IW_MODE_ADHOC 1 /* Single cell network (Ad-Hoc Clients) */ ++#define IW_MODE_INFRA 2 /* Multi cell network, roaming, .. */ ++#define IW_MODE_MASTER 3 /* Synchronisation master or Access Point */ ++#define IW_MODE_REPEAT 4 /* Wireless Repeater (forwarder) */ ++#define IW_MODE_SECOND 5 /* Secondary master/repeater (backup) */ ++#define IW_MODE_MONITOR 6 /* Passive monitor (listen only) */ ++#endif ++ ++struct setopmode_parm { ++ u8 mode; ++ u8 rsvd[3]; ++}; ++ ++/* ++Caller Mode: AP, Ad-HoC, Infra ++ ++Notes: To ask RTL8711 performing site-survey ++ ++Command-Event Mode ++ ++*/ ++ ++#define RTW_SSID_SCAN_AMOUNT 9 /* for WEXT_CSCAN_AMOUNT 9 */ ++#define RTW_CHANNEL_SCAN_AMOUNT (14+37) ++struct sitesurvey_parm { ++ sint scan_mode; /* active: 1, passive: 0 */ ++ /* sint bsslimit; // 1 ~ 48 */ ++ u8 ssid_num; ++ u8 ch_num; ++ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; ++ struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; ++}; ++ ++/* ++Caller Mode: Any ++ ++Notes: To set the auth type of RTL8711. open/shared/802.1x ++ ++Command Mode ++ ++*/ ++struct setauth_parm { ++ u8 mode; /* 0: legacy open, 1: legacy shared 2: 802.1x */ ++ u8 _1x; /* 0: PSK, 1: TLS */ ++ u8 rsvd[2]; ++}; ++ ++/* ++Caller Mode: Infra ++ ++a. algorithm: wep40, wep104, tkip & aes ++b. keytype: grp key/unicast key ++c. key contents ++ ++when shared key ==> keyid is the camid ++when 802.1x ==> keyid [0:1] ==> grp key ++when 802.1x ==> keyid > 2 ==> unicast key ++ ++*/ ++struct setkey_parm { ++ u8 algorithm; /* encryption algorithm, could be none, wep40, TKIP, CCMP, wep104 */ ++ u8 keyid; ++ u8 grpkey; /* 1: this is the grpkey for 802.1x. 0: this is the unicast key for 802.1x */ ++ u8 set_tx; /* 1: main tx key for wep. 0: other key. */ ++ u8 key[16]; /* this could be 40 or 104 */ ++}; ++ ++/* ++When in AP or Ad-Hoc mode, this is used to ++allocate an sw/hw entry for a newly associated sta. ++ ++Command ++ ++when shared key ==> algorithm/keyid ++ ++*/ ++struct set_stakey_parm { ++ u8 addr[ETH_ALEN]; ++ u8 algorithm; ++ u8 keyid; ++ u8 key[16]; ++}; ++ ++struct set_stakey_rsp { ++ u8 addr[ETH_ALEN]; ++ u8 keyid; ++ u8 rsvd; ++}; ++ ++/* ++Caller Ad-Hoc/AP ++ ++Command -Rsp(AID == CAMID) mode ++ ++This is to force fw to add an sta_data entry per driver's request. ++ ++FW will write an cam entry associated with it. ++ ++*/ ++struct set_assocsta_parm { ++ u8 addr[ETH_ALEN]; ++}; ++ ++struct set_assocsta_rsp { ++ u8 cam_id; ++ u8 rsvd[3]; ++}; ++ ++/* ++ Caller Ad-Hoc/AP ++ Command mode ++ This is to force fw to del an sta_data entry per driver's request ++ FW will invalidate the cam entry associated with it. ++*/ ++struct del_assocsta_parm { ++ u8 addr[ETH_ALEN]; ++}; ++ ++/* ++Caller Mode: AP/Ad-HoC(M) ++ ++Notes: To notify fw that given staid has changed its power state ++ ++Command Mode ++ ++*/ ++struct setstapwrstate_parm { ++ u8 staid; ++ u8 status; ++ u8 hwaddr[6]; ++}; ++ ++/* ++Caller Mode: Any ++ ++Notes: To setup the basic rate of RTL8711 ++ ++Command Mode ++ ++*/ ++struct setbasicrate_parm { ++ u8 basicrates[NumRates]; ++}; ++ ++/* ++Caller Mode: Any ++ ++Notes: To read the current basic rate ++ ++Command-Rsp Mode ++ ++*/ ++struct getbasicrate_parm { ++ u32 rsvd; ++}; ++ ++struct getbasicrate_rsp { ++ u8 basicrates[NumRates]; ++}; ++ ++/* ++Caller Mode: Any ++ ++Notes: To setup the data rate of RTL8711 ++ ++Command Mode ++ ++*/ ++struct setdatarate_parm { ++#ifdef MP_FIRMWARE_OFFLOAD ++ u32 curr_rateidx; ++#else ++ u8 mac_id; ++ u8 datarates[NumRates]; ++#endif ++}; ++ ++/* ++Caller Mode: Any ++ ++Notes: To read the current data rate ++ ++Command-Rsp Mode ++ ++*/ ++struct getdatarate_parm { ++ u32 rsvd; ++ ++}; ++struct getdatarate_rsp { ++ u8 datarates[NumRates]; ++}; ++ ++ ++/* ++Caller Mode: Any ++AP: AP can use the info for the contents of beacon frame ++Infra: STA can use the info when sitesurveying ++Ad-HoC(M): Like AP ++Ad-HoC(C): Like STA ++ ++ ++Notes: To set the phy capability of the NIC ++ ++Command Mode ++ ++*/ ++ ++struct setphyinfo_parm { ++ struct regulatory_class class_sets[NUM_REGULATORYS]; ++ u8 status; ++}; ++ ++struct getphyinfo_parm { ++ u32 rsvd; ++}; ++ ++struct getphyinfo_rsp { ++ struct regulatory_class class_sets[NUM_REGULATORYS]; ++ u8 status; ++}; ++ ++/* ++Caller Mode: Any ++ ++Notes: To set the channel/modem/band ++This command will be used when channel/modem/band is changed. ++ ++Command Mode ++ ++*/ ++struct setphy_parm { ++ u8 rfchannel; ++ u8 modem; ++}; ++ ++/* ++Caller Mode: Any ++ ++Notes: To get the current setting of channel/modem/band ++ ++Command-Rsp Mode ++ ++*/ ++struct getphy_parm { ++ u32 rsvd; ++ ++}; ++struct getphy_rsp { ++ u8 rfchannel; ++ u8 modem; ++}; ++ ++struct readBB_parm { ++ u8 offset; ++}; ++struct readBB_rsp { ++ u8 value; ++}; ++ ++struct readTSSI_parm { ++ u8 offset; ++}; ++struct readTSSI_rsp { ++ u8 value; ++}; ++ ++struct readMAC_parm { ++ u8 len; ++ u32 addr; ++}; ++ ++struct writeBB_parm { ++ u8 offset; ++ u8 value; ++}; ++ ++struct readRF_parm { ++ u8 offset; ++}; ++struct readRF_rsp { ++ u32 value; ++}; ++ ++struct writeRF_parm { ++ u32 offset; ++ u32 value; ++}; ++ ++struct getrfintfs_parm { ++ u8 rfintfs; ++}; ++ ++ ++struct Tx_Beacon_param { ++ WLAN_BSSID_EX network; ++}; ++ ++/* ++ Notes: This command is used for H2C/C2H loopback testing ++ ++ mac[0] == 0 ++ ==> CMD mode, return H2C_SUCCESS. ++ The following condition must be ture under CMD mode ++ mac[1] == mac[4], mac[2] == mac[3], mac[0]=mac[5]= 0; ++ s0 == 0x1234, s1 == 0xabcd, w0 == 0x78563412, w1 == 0x5aa5def7; ++ s2 == (b1 << 8 | b0); ++ ++ mac[0] == 1 ++ ==> CMD_RSP mode, return H2C_SUCCESS_RSP ++ ++ The rsp layout shall be: ++ rsp: parm: ++ mac[0] = mac[5]; ++ mac[1] = mac[4]; ++ mac[2] = mac[3]; ++ mac[3] = mac[2]; ++ mac[4] = mac[1]; ++ mac[5] = mac[0]; ++ s0 = s1; ++ s1 = swap16(s0); ++ w0 = swap32(w1); ++ b0 = b1 ++ s2 = s0 + s1 ++ b1 = b0 ++ w1 = w0 ++ ++ mac[0] == 2 ++ ==> CMD_EVENT mode, return H2C_SUCCESS ++ The event layout shall be: ++ event: parm: ++ mac[0] = mac[5]; ++ mac[1] = mac[4]; ++ mac[2] = event's sequence number, starting from 1 to parm's marc[3] ++ mac[3] = mac[2]; ++ mac[4] = mac[1]; ++ mac[5] = mac[0]; ++ s0 = swap16(s0) - event.mac[2]; ++ s1 = s1 + event.mac[2]; ++ w0 = swap32(w0); ++ b0 = b1 ++ s2 = s0 + event.mac[2] ++ b1 = b0 ++ w1 = swap32(w1) - event.mac[2]; ++ ++ parm->mac[3] is the total event counts that host requested. ++ ++ ++ event will be the same with the cmd's param. ++ ++*/ ++ ++#ifdef CONFIG_H2CLBK ++ ++struct seth2clbk_parm { ++ u8 mac[6]; ++ u16 s0; ++ u16 s1; ++ u32 w0; ++ u8 b0; ++ u16 s2; ++ u8 b1; ++ u32 w1; ++}; ++ ++struct geth2clbk_parm { ++ u32 rsv; ++}; ++ ++struct geth2clbk_rsp { ++ u8 mac[6]; ++ u16 s0; ++ u16 s1; ++ u32 w0; ++ u8 b0; ++ u16 s2; ++ u8 b1; ++ u32 w1; ++}; ++ ++#endif /* CONFIG_H2CLBK */ ++ ++/* CMD param Formart for driver extra cmd handler */ ++struct drvextra_cmd_parm { ++ int ec_id; /* extra cmd id */ ++ int type; /* Can use this field as the type id or command size */ ++ int size; /* buffer size */ ++ unsigned char *pbuf; ++}; ++ ++/*------------------- Below are used for RF/BB tunning ---------------------*/ ++ ++struct setantenna_parm { ++ u8 tx_antset; ++ u8 rx_antset; ++ u8 tx_antenna; ++ u8 rx_antenna; ++}; ++ ++struct enrateadaptive_parm { ++ u32 en; ++}; ++ ++struct settxagctbl_parm { ++ u32 txagc[MAX_RATES_LENGTH]; ++}; ++ ++struct gettxagctbl_parm { ++ u32 rsvd; ++}; ++struct gettxagctbl_rsp { ++ u32 txagc[MAX_RATES_LENGTH]; ++}; ++ ++struct setagcctrl_parm { ++ u32 agcctrl; /* 0: pure hw, 1: fw */ ++}; ++ ++ ++struct setssup_parm { ++ u32 ss_ForceUp[MAX_RATES_LENGTH]; ++}; ++ ++struct getssup_parm { ++ u32 rsvd; ++}; ++struct getssup_rsp { ++ u8 ss_ForceUp[MAX_RATES_LENGTH]; ++}; ++ ++ ++struct setssdlevel_parm { ++ u8 ss_DLevel[MAX_RATES_LENGTH]; ++}; ++ ++struct getssdlevel_parm { ++ u32 rsvd; ++}; ++struct getssdlevel_rsp { ++ u8 ss_DLevel[MAX_RATES_LENGTH]; ++}; ++ ++struct setssulevel_parm { ++ u8 ss_ULevel[MAX_RATES_LENGTH]; ++}; ++ ++struct getssulevel_parm { ++ u32 rsvd; ++}; ++struct getssulevel_rsp { ++ u8 ss_ULevel[MAX_RATES_LENGTH]; ++}; ++ ++ ++struct setcountjudge_parm { ++ u8 count_judge[MAX_RATES_LENGTH]; ++}; ++ ++struct getcountjudge_parm { ++ u32 rsvd; ++}; ++struct getcountjudge_rsp { ++ u8 count_judge[MAX_RATES_LENGTH]; ++}; ++ ++ ++struct setratable_parm { ++ u8 ss_ForceUp[NumRates]; ++ u8 ss_ULevel[NumRates]; ++ u8 ss_DLevel[NumRates]; ++ u8 count_judge[NumRates]; ++}; ++ ++struct getratable_parm { ++ uint rsvd; ++}; ++struct getratable_rsp { ++ u8 ss_ForceUp[NumRates]; ++ u8 ss_ULevel[NumRates]; ++ u8 ss_DLevel[NumRates]; ++ u8 count_judge[NumRates]; ++}; ++ ++ ++/* to get TX,RX retry count */ ++struct gettxretrycnt_parm { ++ unsigned int rsvd; ++}; ++struct gettxretrycnt_rsp { ++ unsigned long tx_retrycnt; ++}; ++ ++struct getrxretrycnt_parm { ++ unsigned int rsvd; ++}; ++struct getrxretrycnt_rsp { ++ unsigned long rx_retrycnt; ++}; ++ ++/* to get BCNOK,BCNERR count */ ++struct getbcnokcnt_parm { ++ unsigned int rsvd; ++}; ++struct getbcnokcnt_rsp { ++ unsigned long bcnokcnt; ++}; ++ ++struct getbcnerrcnt_parm { ++ unsigned int rsvd; ++}; ++struct getbcnerrcnt_rsp { ++ unsigned long bcnerrcnt; ++}; ++ ++/* to get current TX power level */ ++struct getcurtxpwrlevel_parm { ++ unsigned int rsvd; ++}; ++struct getcurtxpwrlevel_rsp { ++ unsigned short tx_power; ++}; ++ ++struct setprobereqextraie_parm { ++ unsigned char e_id; ++ unsigned char ie_len; ++ unsigned char ie[0]; ++}; ++ ++struct setassocreqextraie_parm { ++ unsigned char e_id; ++ unsigned char ie_len; ++ unsigned char ie[0]; ++}; ++ ++struct setproberspextraie_parm { ++ unsigned char e_id; ++ unsigned char ie_len; ++ unsigned char ie[0]; ++}; ++ ++struct setassocrspextraie_parm { ++ unsigned char e_id; ++ unsigned char ie_len; ++ unsigned char ie[0]; ++}; ++ ++ ++struct addBaReq_parm { ++ unsigned int tid; ++ u8 addr[ETH_ALEN]; ++}; ++ ++struct addBaRsp_parm { ++ unsigned int tid; ++ unsigned int start_seq; ++ u8 addr[ETH_ALEN]; ++ u8 status; ++ u8 size; ++}; ++ ++/*H2C Handler index: 46 */ ++struct set_ch_parm { ++ u8 ch; ++ u8 bw; ++ u8 ch_offset; ++}; ++ ++#ifdef MP_FIRMWARE_OFFLOAD ++/*H2C Handler index: 47 */ ++struct SetTxPower_parm { ++ u8 TxPower; ++}; ++ ++/*H2C Handler index: 48 */ ++struct SwitchAntenna_parm { ++ u16 antenna_tx; ++ u16 antenna_rx; ++ /* R_ANTENNA_SELECT_CCK cck_txrx; */ ++ u8 cck_txrx; ++}; ++ ++/*H2C Handler index: 49 */ ++struct SetCrystalCap_parm { ++ u32 curr_crystalcap; ++}; ++ ++/*H2C Handler index: 50 */ ++struct SetSingleCarrierTx_parm { ++ u8 bStart; ++}; ++ ++/*H2C Handler index: 51 */ ++struct SetSingleToneTx_parm { ++ u8 bStart; ++ u8 curr_rfpath; ++}; ++ ++/*H2C Handler index: 52 */ ++struct SetCarrierSuppressionTx_parm { ++ u8 bStart; ++ u32 curr_rateidx; ++}; ++ ++/*H2C Handler index: 53 */ ++struct SetContinuousTx_parm { ++ u8 bStart; ++ u8 CCK_flag; /*1:CCK 2:OFDM*/ ++ u32 curr_rateidx; ++}; ++ ++/*H2C Handler index: 54 */ ++struct SwitchBandwidth_parm { ++ u8 curr_bandwidth; ++}; ++ ++#endif /* MP_FIRMWARE_OFFLOAD */ ++ ++/*H2C Handler index: 59 */ ++struct SetChannelPlan_param { ++ const struct country_chplan *country_ent; ++ u8 channel_plan; ++}; ++ ++/*H2C Handler index: 60 */ ++struct LedBlink_param { ++ PVOID pLed; ++}; ++ ++/*H2C Handler index: 61 */ ++struct SetChannelSwitch_param { ++ u8 new_ch_no; ++}; ++ ++/*H2C Handler index: 62 */ ++struct TDLSoption_param { ++ u8 addr[ETH_ALEN]; ++ u8 option; ++}; ++ ++/*H2C Handler index: 64 */ ++struct RunInThread_param { ++ void (*func)(void *); ++ void *context; ++}; ++ ++ ++#define GEN_CMD_CODE(cmd) cmd ## _CMD_ ++ ++ ++/* ++ ++Result: ++0x00: success ++0x01: sucess, and check Response. ++0x02: cmd ignored due to duplicated sequcne number ++0x03: cmd dropped due to invalid cmd code ++0x04: reserved. ++ ++*/ ++ ++#define H2C_RSP_OFFSET 512 ++ ++#define H2C_SUCCESS 0x00 ++#define H2C_SUCCESS_RSP 0x01 ++#define H2C_DUPLICATED 0x02 ++#define H2C_DROPPED 0x03 ++#define H2C_PARAMETERS_ERROR 0x04 ++#define H2C_REJECTED 0x05 ++#define H2C_CMD_OVERFLOW 0x06 ++#define H2C_RESERVED 0x07 ++#define H2C_ENQ_HEAD 0x08 ++#define H2C_ENQ_HEAD_FAIL 0x09 ++ ++extern u8 rtw_setassocsta_cmd(_adapter *padapter, u8 *mac_addr); ++extern u8 rtw_setstandby_cmd(_adapter *padapter, uint action); ++u8 rtw_sitesurvey_cmd(_adapter *padapter, NDIS_802_11_SSID *ssid, int ssid_num, struct rtw_ieee80211_channel *ch, int ch_num); ++ ++u8 rtw_create_ibss_cmd(_adapter *adapter, int flags); ++u8 rtw_startbss_cmd(_adapter *adapter, int flags); ++u8 rtw_change_bss_chbw_cmd(_adapter *adapter, int flags, s16 req_ch, s8 req_bw, s8 req_offset); ++ ++extern u8 rtw_setphy_cmd(_adapter *padapter, u8 modem, u8 ch); ++ ++struct sta_info; ++extern u8 rtw_setstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 key_type, bool enqueue); ++extern u8 rtw_clearstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 enqueue); ++ ++extern u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork); ++u8 rtw_disassoc_cmd(_adapter *padapter, u32 deauth_timeout_ms, bool enqueue); ++extern u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, bool enqueue); ++extern u8 rtw_setdatarate_cmd(_adapter *padapter, u8 *rateset); ++extern u8 rtw_setbasicrate_cmd(_adapter *padapter, u8 *rateset); ++extern u8 rtw_getmacreg_cmd(_adapter *padapter, u8 len, u32 addr); ++extern void rtw_usb_catc_trigger_cmd(_adapter *padapter, const char *caller); ++extern u8 rtw_setbbreg_cmd(_adapter *padapter, u8 offset, u8 val); ++extern u8 rtw_setrfreg_cmd(_adapter *padapter, u8 offset, u32 val); ++extern u8 rtw_getbbreg_cmd(_adapter *padapter, u8 offset, u8 *pval); ++extern u8 rtw_getrfreg_cmd(_adapter *padapter, u8 offset, u8 *pval); ++extern u8 rtw_setrfintfs_cmd(_adapter *padapter, u8 mode); ++extern u8 rtw_setrttbl_cmd(_adapter *padapter, struct setratable_parm *prate_table); ++extern u8 rtw_getrttbl_cmd(_adapter *padapter, struct getratable_rsp *pval); ++ ++extern u8 rtw_gettssi_cmd(_adapter *padapter, u8 offset, u8 *pval); ++extern u8 rtw_setfwdig_cmd(_adapter *padapter, u8 type); ++extern u8 rtw_setfwra_cmd(_adapter *padapter, u8 type); ++ ++extern u8 rtw_addbareq_cmd(_adapter *padapter, u8 tid, u8 *addr); ++extern u8 rtw_addbarsp_cmd(_adapter *padapter, u8 *addr, u16 tid, u8 status, u8 size, u16 start_seq); ++/* add for CONFIG_IEEE80211W, none 11w also can use */ ++extern u8 rtw_reset_securitypriv_cmd(_adapter *padapter); ++extern u8 rtw_free_assoc_resources_cmd(_adapter *padapter); ++extern u8 rtw_dynamic_chk_wk_cmd(_adapter *adapter); ++ ++u8 rtw_lps_ctrl_wk_cmd(_adapter *padapter, u8 lps_ctrl_type, u8 enqueue); ++u8 rtw_dm_in_lps_wk_cmd(_adapter *padapter); ++u8 rtw_lps_change_dtim_cmd(_adapter *padapter, u8 dtim); ++ ++#if (RATE_ADAPTIVE_SUPPORT == 1) ++u8 rtw_rpt_timer_cfg_cmd(_adapter *padapter, u16 minRptTime); ++#endif ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++extern u8 rtw_antenna_select_cmd(_adapter *padapter, u8 antenna, u8 enqueue); ++#endif ++ ++u8 rtw_dm_ra_mask_wk_cmd(_adapter *padapter, u8 *psta); ++ ++extern u8 rtw_ps_cmd(_adapter *padapter); ++ ++#ifdef CONFIG_AP_MODE ++u8 rtw_chk_hi_queue_cmd(_adapter *padapter); ++#ifdef CONFIG_DFS_MASTER ++u8 rtw_dfs_master_cmd(_adapter *adapter, bool enqueue); ++void rtw_dfs_master_timer_hdl(RTW_TIMER_HDL_ARGS); ++void rtw_dfs_master_enable(_adapter *adapter, u8 ch, u8 bw, u8 offset); ++void rtw_dfs_master_disable(_adapter *adapter, u8 ch, u8 bw, u8 offset, bool by_others); ++enum { ++ MLME_STA_CONNECTING, ++ MLME_STA_CONNECTED, ++ MLME_STA_DISCONNECTED, ++ MLME_AP_STARTED, ++ MLME_AP_STOPPED, ++}; ++void rtw_dfs_master_status_apply(_adapter *adapter, u8 self_action); ++#endif /* CONFIG_DFS_MASTER */ ++#endif /* CONFIG_AP_MODE */ ++ ++#ifdef CONFIG_BT_COEXIST ++u8 rtw_btinfo_cmd(PADAPTER padapter, u8 *pbuf, u16 length); ++#endif ++ ++u8 rtw_test_h2c_cmd(_adapter *adapter, u8 *buf, u8 len); ++ ++u8 rtw_enable_hw_update_tsf_cmd(_adapter *padapter); ++ ++u8 rtw_set_ch_cmd(_adapter *padapter, u8 ch, u8 bw, u8 ch_offset, u8 enqueue); ++ ++u8 rtw_set_chplan_cmd(_adapter *adapter, int flags, u8 chplan, u8 swconfig); ++u8 rtw_set_country_cmd(_adapter *adapter, int flags, const char *country_code, u8 swconfig); ++ ++extern u8 rtw_led_blink_cmd(_adapter *padapter, PVOID pLed); ++extern u8 rtw_set_csa_cmd(_adapter *padapter, u8 new_ch_no); ++extern u8 rtw_tdls_cmd(_adapter *padapter, u8 *addr, u8 option); ++ ++#ifdef CONFIG_RTW_CUSTOMER_STR ++u8 rtw_customer_str_req_cmd(_adapter *adapter); ++u8 rtw_customer_str_write_cmd(_adapter *adapter, const u8 *cstr); ++#endif ++ ++#ifdef CONFIG_FW_C2H_REG ++u8 rtw_c2h_reg_wk_cmd(_adapter *adapter, u8 *c2h_evt); ++#endif ++#ifdef CONFIG_FW_C2H_PKT ++u8 rtw_c2h_packet_wk_cmd(_adapter *adapter, u8 *c2h_evt, u16 length); ++#endif ++ ++u8 rtw_run_in_thread_cmd(PADAPTER padapter, void (*func)(void *), void *context); ++ ++u8 session_tracker_chk_cmd(_adapter *adapter, struct sta_info *sta); ++u8 session_tracker_add_cmd(_adapter *adapter, struct sta_info *sta, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port); ++u8 session_tracker_del_cmd(_adapter *adapter, struct sta_info *sta, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port); ++ ++u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf); ++ ++extern void rtw_survey_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); ++extern void rtw_disassoc_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); ++extern void rtw_joinbss_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); ++void rtw_create_ibss_post_hdl(_adapter *padapter, int status); ++extern void rtw_getbbrfreg_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); ++extern void rtw_readtssi_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); ++ ++extern void rtw_setstaKey_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); ++extern void rtw_setassocsta_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); ++extern void rtw_getrttbl_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); ++extern void rtw_getmacreg_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); ++ ++ ++struct _cmd_callback { ++ u32 cmd_code; ++ void (*callback)(_adapter *padapter, struct cmd_obj *cmd); ++}; ++ ++enum rtw_h2c_cmd { ++ GEN_CMD_CODE(_Read_MACREG) , /*0*/ ++ GEN_CMD_CODE(_Write_MACREG) , ++ GEN_CMD_CODE(_Read_BBREG) , ++ GEN_CMD_CODE(_Write_BBREG) , ++ GEN_CMD_CODE(_Read_RFREG) , ++ GEN_CMD_CODE(_Write_RFREG) , /*5*/ ++ GEN_CMD_CODE(_Read_EEPROM) , ++ GEN_CMD_CODE(_Write_EEPROM) , ++ GEN_CMD_CODE(_Read_EFUSE) , ++ GEN_CMD_CODE(_Write_EFUSE) , ++ ++ GEN_CMD_CODE(_Read_CAM) , /*10*/ ++ GEN_CMD_CODE(_Write_CAM) , ++ GEN_CMD_CODE(_setBCNITV), ++ GEN_CMD_CODE(_setMBIDCFG), ++ GEN_CMD_CODE(_JoinBss), /*14*/ ++ GEN_CMD_CODE(_DisConnect) , /*15*/ ++ GEN_CMD_CODE(_CreateBss) , ++ GEN_CMD_CODE(_SetOpMode) , ++ GEN_CMD_CODE(_SiteSurvey), /*18*/ ++ GEN_CMD_CODE(_SetAuth) , ++ ++ GEN_CMD_CODE(_SetKey) , /*20*/ ++ GEN_CMD_CODE(_SetStaKey) , ++ GEN_CMD_CODE(_SetAssocSta) , ++ GEN_CMD_CODE(_DelAssocSta) , ++ GEN_CMD_CODE(_SetStaPwrState) , ++ GEN_CMD_CODE(_SetBasicRate) , /*25*/ ++ GEN_CMD_CODE(_GetBasicRate) , ++ GEN_CMD_CODE(_SetDataRate) , ++ GEN_CMD_CODE(_GetDataRate) , ++ GEN_CMD_CODE(_SetPhyInfo) , ++ ++ GEN_CMD_CODE(_GetPhyInfo) , /*30*/ ++ GEN_CMD_CODE(_SetPhy) , ++ GEN_CMD_CODE(_GetPhy) , ++ GEN_CMD_CODE(_readRssi) , ++ GEN_CMD_CODE(_readGain) , ++ GEN_CMD_CODE(_SetAtim) , /*35*/ ++ GEN_CMD_CODE(_SetPwrMode) , ++ GEN_CMD_CODE(_JoinbssRpt), ++ GEN_CMD_CODE(_SetRaTable) , ++ GEN_CMD_CODE(_GetRaTable) , ++ ++ GEN_CMD_CODE(_GetCCXReport), /*40*/ ++ GEN_CMD_CODE(_GetDTMReport), ++ GEN_CMD_CODE(_GetTXRateStatistics), ++ GEN_CMD_CODE(_SetUsbSuspend), ++ GEN_CMD_CODE(_SetH2cLbk), ++ GEN_CMD_CODE(_AddBAReq) , /*45*/ ++ GEN_CMD_CODE(_SetChannel), /*46*/ ++ GEN_CMD_CODE(_SetTxPower), ++ GEN_CMD_CODE(_SwitchAntenna), ++ GEN_CMD_CODE(_SetCrystalCap), ++ GEN_CMD_CODE(_SetSingleCarrierTx), /*50*/ ++ ++ GEN_CMD_CODE(_SetSingleToneTx),/*51*/ ++ GEN_CMD_CODE(_SetCarrierSuppressionTx), ++ GEN_CMD_CODE(_SetContinuousTx), ++ GEN_CMD_CODE(_SwitchBandwidth), /*54*/ ++ GEN_CMD_CODE(_TX_Beacon), /*55*/ ++ ++ GEN_CMD_CODE(_Set_MLME_EVT), /*56*/ ++ GEN_CMD_CODE(_Set_Drv_Extra), /*57*/ ++ GEN_CMD_CODE(_Set_H2C_MSG), /*58*/ ++ ++ GEN_CMD_CODE(_SetChannelPlan), /*59*/ ++ GEN_CMD_CODE(_LedBlink), /*60*/ ++ ++ GEN_CMD_CODE(_SetChannelSwitch), /*61*/ ++ GEN_CMD_CODE(_TDLS), /*62*/ ++ GEN_CMD_CODE(_ChkBMCSleepq), /*63*/ ++ ++ GEN_CMD_CODE(_RunInThreadCMD), /*64*/ ++ GEN_CMD_CODE(_AddBARsp) , /*65*/ ++ ++ MAX_H2CCMD ++}; ++ ++#define _GetMACReg_CMD_ _Read_MACREG_CMD_ ++#define _SetMACReg_CMD_ _Write_MACREG_CMD_ ++#define _GetBBReg_CMD_ _Read_BBREG_CMD_ ++#define _SetBBReg_CMD_ _Write_BBREG_CMD_ ++#define _GetRFReg_CMD_ _Read_RFREG_CMD_ ++#define _SetRFReg_CMD_ _Write_RFREG_CMD_ ++ ++#ifdef _RTW_CMD_C_ ++struct _cmd_callback rtw_cmd_callback[] = { ++ {GEN_CMD_CODE(_Read_MACREG), &rtw_getmacreg_cmdrsp_callback}, /*0*/ ++ {GEN_CMD_CODE(_Write_MACREG), NULL}, ++ {GEN_CMD_CODE(_Read_BBREG), &rtw_getbbrfreg_cmdrsp_callback}, ++ {GEN_CMD_CODE(_Write_BBREG), NULL}, ++ {GEN_CMD_CODE(_Read_RFREG), &rtw_getbbrfreg_cmdrsp_callback}, ++ {GEN_CMD_CODE(_Write_RFREG), NULL}, /*5*/ ++ {GEN_CMD_CODE(_Read_EEPROM), NULL}, ++ {GEN_CMD_CODE(_Write_EEPROM), NULL}, ++ {GEN_CMD_CODE(_Read_EFUSE), NULL}, ++ {GEN_CMD_CODE(_Write_EFUSE), NULL}, ++ ++ {GEN_CMD_CODE(_Read_CAM), NULL}, /*10*/ ++ {GEN_CMD_CODE(_Write_CAM), NULL}, ++ {GEN_CMD_CODE(_setBCNITV), NULL}, ++ {GEN_CMD_CODE(_setMBIDCFG), NULL}, ++ {GEN_CMD_CODE(_JoinBss), &rtw_joinbss_cmd_callback}, /*14*/ ++ {GEN_CMD_CODE(_DisConnect), &rtw_disassoc_cmd_callback}, /*15*/ ++ {GEN_CMD_CODE(_CreateBss), NULL}, ++ {GEN_CMD_CODE(_SetOpMode), NULL}, ++ {GEN_CMD_CODE(_SiteSurvey), &rtw_survey_cmd_callback}, /*18*/ ++ {GEN_CMD_CODE(_SetAuth), NULL}, ++ ++ {GEN_CMD_CODE(_SetKey), NULL}, /*20*/ ++ {GEN_CMD_CODE(_SetStaKey), &rtw_setstaKey_cmdrsp_callback}, ++ {GEN_CMD_CODE(_SetAssocSta), &rtw_setassocsta_cmdrsp_callback}, ++ {GEN_CMD_CODE(_DelAssocSta), NULL}, ++ {GEN_CMD_CODE(_SetStaPwrState), NULL}, ++ {GEN_CMD_CODE(_SetBasicRate), NULL}, /*25*/ ++ {GEN_CMD_CODE(_GetBasicRate), NULL}, ++ {GEN_CMD_CODE(_SetDataRate), NULL}, ++ {GEN_CMD_CODE(_GetDataRate), NULL}, ++ {GEN_CMD_CODE(_SetPhyInfo), NULL}, ++ ++ {GEN_CMD_CODE(_GetPhyInfo), NULL}, /*30*/ ++ {GEN_CMD_CODE(_SetPhy), NULL}, ++ {GEN_CMD_CODE(_GetPhy), NULL}, ++ {GEN_CMD_CODE(_readRssi), NULL}, ++ {GEN_CMD_CODE(_readGain), NULL}, ++ {GEN_CMD_CODE(_SetAtim), NULL}, /*35*/ ++ {GEN_CMD_CODE(_SetPwrMode), NULL}, ++ {GEN_CMD_CODE(_JoinbssRpt), NULL}, ++ {GEN_CMD_CODE(_SetRaTable), NULL}, ++ {GEN_CMD_CODE(_GetRaTable) , NULL}, ++ ++ {GEN_CMD_CODE(_GetCCXReport), NULL}, /*40*/ ++ {GEN_CMD_CODE(_GetDTMReport), NULL}, ++ {GEN_CMD_CODE(_GetTXRateStatistics), NULL}, ++ {GEN_CMD_CODE(_SetUsbSuspend), NULL}, ++ {GEN_CMD_CODE(_SetH2cLbk), NULL}, ++ {GEN_CMD_CODE(_AddBAReq), NULL}, /*45*/ ++ {GEN_CMD_CODE(_SetChannel), NULL}, /*46*/ ++ {GEN_CMD_CODE(_SetTxPower), NULL}, ++ {GEN_CMD_CODE(_SwitchAntenna), NULL}, ++ {GEN_CMD_CODE(_SetCrystalCap), NULL}, ++ {GEN_CMD_CODE(_SetSingleCarrierTx), NULL}, /*50*/ ++ ++ {GEN_CMD_CODE(_SetSingleToneTx), NULL}, /*51*/ ++ {GEN_CMD_CODE(_SetCarrierSuppressionTx), NULL}, ++ {GEN_CMD_CODE(_SetContinuousTx), NULL}, ++ {GEN_CMD_CODE(_SwitchBandwidth), NULL}, /*54*/ ++ {GEN_CMD_CODE(_TX_Beacon), NULL},/*55*/ ++ ++ {GEN_CMD_CODE(_Set_MLME_EVT), NULL},/*56*/ ++ {GEN_CMD_CODE(_Set_Drv_Extra), NULL},/*57*/ ++ {GEN_CMD_CODE(_Set_H2C_MSG), NULL},/*58*/ ++ {GEN_CMD_CODE(_SetChannelPlan), NULL},/*59*/ ++ {GEN_CMD_CODE(_LedBlink), NULL},/*60*/ ++ ++ {GEN_CMD_CODE(_SetChannelSwitch), NULL},/*61*/ ++ {GEN_CMD_CODE(_TDLS), NULL},/*62*/ ++ {GEN_CMD_CODE(_ChkBMCSleepq), NULL}, /*63*/ ++ ++ {GEN_CMD_CODE(_RunInThreadCMD), NULL},/*64*/ ++ {GEN_CMD_CODE(_AddBARsp), NULL}, /*65*/ ++}; ++#endif ++ ++#define CMD_FMT "cmd=%d,%d,%d" ++#define CMD_ARG(cmd) \ ++ (cmd)->cmdcode, \ ++ (cmd)->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra) ? ((struct drvextra_cmd_parm *)(cmd)->parmbuf)->ec_id : ((cmd)->cmdcode == GEN_CMD_CODE(_Set_MLME_EVT) ? ((struct C2HEvent_Header *)(cmd)->parmbuf)->ID : 0), \ ++ (cmd)->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra) ? ((struct drvextra_cmd_parm *)(cmd)->parmbuf)->type : 0 ++ ++#endif /* _CMD_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_debug.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_debug.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_debug.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_debug.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,599 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_DEBUG_H__ ++#define __RTW_DEBUG_H__ ++ ++/* driver log level*/ ++enum { ++ _DRV_NONE_ = 0, ++ _DRV_ALWAYS_ = 1, ++ _DRV_ERR_ = 2, ++ _DRV_WARNING_ = 3, ++ _DRV_INFO_ = 4, ++ _DRV_DEBUG_ = 5, ++ _DRV_MAX_ = 6 ++}; ++ ++#define DRIVER_PREFIX "RTW: " ++ ++#ifdef PLATFORM_OS_CE ++extern void rtl871x_cedbg(const char *fmt, ...); ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ #define RTW_PRINT do {} while (0) ++ #define RTW_ERR do {} while (0) ++ #define RTW_WARN do {} while (0) ++ #define RTW_INFO do {} while (0) ++ #define RTW_DBG do {} while (0) ++ #define RTW_PRINT_SEL do {} while (0) ++ #define _RTW_PRINT do {} while (0) ++ #define _RTW_ERR do {} while (0) ++ #define _RTW_WARN do {} while (0) ++ #define _RTW_INFO do {} while (0) ++ #define _RTW_DBG do {} while (0) ++ #define _RTW_PRINT_SEL do {} while (0) ++#else ++ #define RTW_PRINT(x, ...) do {} while (0) ++ #define RTW_ERR(x, ...) do {} while (0) ++ #define RTW_WARN(x,...) do {} while (0) ++ #define RTW_INFO(x,...) do {} while (0) ++ #define RTW_DBG(x,...) do {} while (0) ++ #define RTW_PRINT_SEL(x,...) do {} while (0) ++ #define _RTW_PRINT(x, ...) do {} while (0) ++ #define _RTW_ERR(x, ...) do {} while (0) ++ #define _RTW_WARN(x,...) do {} while (0) ++ #define _RTW_INFO(x,...) do {} while (0) ++ #define _RTW_DBG(x,...) do {} while (0) ++ #define _RTW_PRINT_SEL(x,...) do {} while (0) ++#endif ++ ++#define RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) ++#define RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) ++#define RTW_PRINT_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) ++#define _RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) ++#define _RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) ++ ++#define RTW_DBG_EXPR(EXPR) do {} while (0) ++ ++#define RTW_DBGDUMP 0 /* 'stream' for _dbgdump */ ++ ++/* don't use these 3 APIs anymore, will be removed later */ ++#define RT_TRACE(_Comp, _Level, Fmt) do {} while (0) ++ ++ ++#undef _dbgdump ++#undef _seqdump ++ ++#if defined(PLATFORM_WINDOWS) && defined(PLATFORM_OS_XP) ++ #define _dbgdump DbgPrint ++ #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) ++#elif defined(PLATFORM_WINDOWS) && defined(PLATFORM_OS_CE) ++ #define _dbgdump rtl871x_cedbg ++ #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) ++#elif defined PLATFORM_LINUX ++ #define _dbgdump printk ++ #define _seqdump seq_printf ++#elif defined PLATFORM_FREEBSD ++ #define _dbgdump printf ++ #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) ++#endif ++ ++#ifdef CONFIG_RTW_DEBUG ++ ++#ifndef _OS_INTFS_C_ ++extern uint rtw_drv_log_level; ++#endif ++ ++#if defined(_dbgdump) ++ ++/* with driver-defined prefix */ ++#undef RTW_PRINT ++#define RTW_PRINT(fmt, arg...) \ ++ do {\ ++ if (_DRV_ALWAYS_ <= rtw_drv_log_level) {\ ++ _dbgdump(DRIVER_PREFIX fmt, ##arg);\ ++ } \ ++ } while (0) ++ ++#undef RTW_ERR ++#define RTW_ERR(fmt, arg...) \ ++ do {\ ++ if (_DRV_ERR_ <= rtw_drv_log_level) {\ ++ _dbgdump(DRIVER_PREFIX"ERROR " fmt, ##arg);\ ++ } \ ++ } while (0) ++ ++ ++#undef RTW_WARN ++#define RTW_WARN(fmt, arg...) \ ++ do {\ ++ if (_DRV_WARNING_ <= rtw_drv_log_level) {\ ++ _dbgdump(DRIVER_PREFIX"WARN " fmt, ##arg);\ ++ } \ ++ } while (0) ++ ++#undef RTW_INFO ++#define RTW_INFO(fmt, arg...) \ ++ do {\ ++ if (_DRV_INFO_ <= rtw_drv_log_level) {\ ++ _dbgdump(DRIVER_PREFIX fmt, ##arg);\ ++ } \ ++ } while (0) ++ ++ ++#undef RTW_DBG ++#define RTW_DBG(fmt, arg...) \ ++ do {\ ++ if (_DRV_DEBUG_ <= rtw_drv_log_level) {\ ++ _dbgdump(DRIVER_PREFIX fmt, ##arg);\ ++ } \ ++ } while (0) ++ ++ ++#undef RTW_INFO_DUMP ++#define RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) \ ++ do {\ ++ if (_DRV_INFO_ <= rtw_drv_log_level) { \ ++ int __i; \ ++ u8 *ptr = (u8 *)_HexData; \ ++ _dbgdump("%s", DRIVER_PREFIX); \ ++ _dbgdump(_TitleString); \ ++ for (__i = 0; __i < (int)_HexDataLen; __i++) { \ ++ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ ++ if (((__i + 1) % 16) == 0) \ ++ _dbgdump("\n"); \ ++ } \ ++ _dbgdump("\n"); \ ++ } \ ++ } while (0) ++ ++#undef RTW_DBG_DUMP ++#define RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) \ ++ do {\ ++ if (_DRV_DEBUG_ <= rtw_drv_log_level) { \ ++ int __i; \ ++ u8 *ptr = (u8 *)_HexData; \ ++ _dbgdump("%s", DRIVER_PREFIX); \ ++ _dbgdump(_TitleString); \ ++ for (__i = 0; __i < (int)_HexDataLen; __i++) { \ ++ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ ++ if (((__i + 1) % 16) == 0) \ ++ _dbgdump("\n"); \ ++ } \ ++ _dbgdump("\n"); \ ++ } \ ++ } while (0) ++ ++ ++#undef RTW_PRINT_DUMP ++#define RTW_PRINT_DUMP(_TitleString, _HexData, _HexDataLen) \ ++ do {\ ++ if (_DRV_ALWAYS_ <= rtw_drv_log_level) { \ ++ int __i; \ ++ u8 *ptr = (u8 *)_HexData; \ ++ _dbgdump("%s", DRIVER_PREFIX); \ ++ _dbgdump(_TitleString); \ ++ for (__i = 0; __i < (int)_HexDataLen; __i++) { \ ++ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ ++ if (((__i + 1) % 16) == 0) \ ++ _dbgdump("\n"); \ ++ } \ ++ _dbgdump("\n"); \ ++ } \ ++ } while (0) ++ ++/* without driver-defined prefix */ ++#undef _RTW_PRINT ++#define _RTW_PRINT(fmt, arg...) \ ++ do {\ ++ if (_DRV_ALWAYS_ <= rtw_drv_log_level) {\ ++ _dbgdump(fmt, ##arg);\ ++ } \ ++ } while (0) ++ ++#undef _RTW_ERR ++#define _RTW_ERR(fmt, arg...) \ ++ do {\ ++ if (_DRV_ERR_ <= rtw_drv_log_level) {\ ++ _dbgdump(fmt, ##arg);\ ++ } \ ++ } while (0) ++ ++ ++#undef _RTW_WARN ++#define _RTW_WARN(fmt, arg...) \ ++ do {\ ++ if (_DRV_WARNING_ <= rtw_drv_log_level) {\ ++ _dbgdump(fmt, ##arg);\ ++ } \ ++ } while (0) ++ ++#undef _RTW_INFO ++#define _RTW_INFO(fmt, arg...) \ ++ do {\ ++ if (_DRV_INFO_ <= rtw_drv_log_level) {\ ++ _dbgdump(fmt, ##arg);\ ++ } \ ++ } while (0) ++ ++#undef _RTW_DBG ++#define _RTW_DBG(fmt, arg...) \ ++ do {\ ++ if (_DRV_DEBUG_ <= rtw_drv_log_level) {\ ++ _dbgdump(fmt, ##arg);\ ++ } \ ++ } while (0) ++ ++ ++#undef _RTW_INFO_DUMP ++#define _RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) \ ++ if (_DRV_INFO_ <= rtw_drv_log_level) { \ ++ int __i; \ ++ u8 *ptr = (u8 *)_HexData; \ ++ _dbgdump(_TitleString); \ ++ for (__i = 0; __i<(int)_HexDataLen; __i++) \ ++ { \ ++ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ ++ if (((__i + 1) % 16) == 0) _dbgdump("\n"); \ ++ } \ ++ _dbgdump("\n"); \ ++ } ++ ++#undef _RTW_DBG_DUMP ++#define _RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) \ ++ if (_DRV_DEBUG_ <= rtw_drv_log_level) { \ ++ int __i; \ ++ u8 *ptr = (u8 *)_HexData; \ ++ _dbgdump(_TitleString); \ ++ for (__i = 0; __i<(int)_HexDataLen; __i++) \ ++ { \ ++ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ ++ if (((__i + 1) % 16) == 0) _dbgdump("\n"); \ ++ } \ ++ _dbgdump("\n"); \ ++ } ++ ++/* other debug APIs */ ++#undef RTW_DBG_EXPR ++#define RTW_DBG_EXPR(EXPR) do { if (_DRV_DEBUG_ <= rtw_drv_log_level) EXPR; } while (0) ++ ++#endif /* defined(_dbgdump) */ ++#endif /* CONFIG_RTW_DEBUG */ ++ ++ ++#if defined(_seqdump) ++/* dump message to selected 'stream' with driver-defined prefix */ ++#undef RTW_PRINT_SEL ++#define RTW_PRINT_SEL(sel, fmt, arg...) \ ++ do {\ ++ if (sel == RTW_DBGDUMP)\ ++ RTW_PRINT(fmt, ##arg); \ ++ else {\ ++ _seqdump(sel, fmt, ##arg) /*rtw_warn_on(1)*/; \ ++ } \ ++ } while (0) ++ ++/* dump message to selected 'stream' */ ++#undef _RTW_PRINT_SEL ++#define _RTW_PRINT_SEL(sel, fmt, arg...) \ ++ do {\ ++ if (sel == RTW_DBGDUMP)\ ++ _RTW_PRINT(fmt, ##arg); \ ++ else {\ ++ _seqdump(sel, fmt, ##arg) /*rtw_warn_on(1)*/; \ ++ } \ ++ } while (0) ++ ++#endif /* defined(_seqdump) */ ++ ++ ++#ifdef CONFIG_DBG_COUNTER ++ #define DBG_COUNTER(counter) counter++ ++#else ++ #define DBG_COUNTER(counter) ++#endif ++ ++void dump_drv_version(void *sel); ++void dump_log_level(void *sel); ++void dump_drv_cfg(void *sel); ++ ++#ifdef CONFIG_SDIO_HCI ++void sd_f0_reg_dump(void *sel, _adapter *adapter); ++void sdio_local_reg_dump(void *sel, _adapter *adapter); ++#endif /* CONFIG_SDIO_HCI */ ++ ++void mac_reg_dump(void *sel, _adapter *adapter); ++void bb_reg_dump(void *sel, _adapter *adapter); ++void rf_reg_dump(void *sel, _adapter *adapter); ++ ++bool rtw_fwdl_test_trigger_chksum_fail(void); ++bool rtw_fwdl_test_trigger_wintint_rdy_fail(void); ++bool rtw_del_rx_ampdu_test_trigger_no_tx_fail(void); ++ ++u32 rtw_get_wait_hiq_empty_ms(void); ++void rtw_sink_rtp_seq_dbg(_adapter *adapter, _pkt *pkt); ++ ++struct sta_info; ++void sta_rx_reorder_ctl_dump(void *sel, struct sta_info *sta); ++ ++struct dvobj_priv; ++void dump_tx_rate_bmp(void *sel, struct dvobj_priv *dvobj); ++void dump_adapters_status(void *sel, struct dvobj_priv *dvobj); ++ ++struct sec_cam_ent; ++void dump_sec_cam_ent(void *sel, struct sec_cam_ent *ent, int id); ++void dump_sec_cam_ent_title(void *sel, u8 has_id); ++void dump_sec_cam(void *sel, _adapter *adapter); ++void dump_sec_cam_cache(void *sel, _adapter *adapter); ++ ++#ifdef CONFIG_PROC_DEBUG ++ssize_t proc_set_write_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_read_reg(struct seq_file *m, void *v); ++ssize_t proc_set_read_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++int proc_get_fwstate(struct seq_file *m, void *v); ++int proc_get_sec_info(struct seq_file *m, void *v); ++int proc_get_mlmext_state(struct seq_file *m, void *v); ++#ifdef CONFIG_LAYER2_ROAMING ++int proc_get_roam_flags(struct seq_file *m, void *v); ++ssize_t proc_set_roam_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_roam_param(struct seq_file *m, void *v); ++ssize_t proc_set_roam_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ssize_t proc_set_roam_tgt_addr(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++#endif /* CONFIG_LAYER2_ROAMING */ ++#ifdef CONFIG_RTW_80211R ++int proc_get_ft_flags(struct seq_file *m, void *v); ++ssize_t proc_set_ft_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++#endif ++int proc_get_qos_option(struct seq_file *m, void *v); ++int proc_get_ht_option(struct seq_file *m, void *v); ++int proc_get_rf_info(struct seq_file *m, void *v); ++int proc_get_scan_param(struct seq_file *m, void *v); ++ssize_t proc_set_scan_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_scan_abort(struct seq_file *m, void *v); ++#ifdef CONFIG_SCAN_BACKOP ++int proc_get_backop_flags_sta(struct seq_file *m, void *v); ++ssize_t proc_set_backop_flags_sta(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_backop_flags_ap(struct seq_file *m, void *v); ++ssize_t proc_set_backop_flags_ap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++#endif /* CONFIG_SCAN_BACKOP */ ++int proc_get_survey_info(struct seq_file *m, void *v); ++ssize_t proc_set_survey_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_ap_info(struct seq_file *m, void *v); ++ssize_t proc_reset_trx_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_trx_info(struct seq_file *m, void *v); ++int proc_get_rate_ctl(struct seq_file *m, void *v); ++int proc_get_wifi_spec(struct seq_file *m, void *v); ++ssize_t proc_set_rate_ctl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_bw_ctl(struct seq_file *m, void *v); ++ssize_t proc_set_bw_ctl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++#ifdef DBG_RX_COUNTER_DUMP ++int proc_get_rx_cnt_dump(struct seq_file *m, void *v); ++ssize_t proc_set_rx_cnt_dump(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++#endif ++int proc_get_dis_pwt(struct seq_file *m, void *v); ++ssize_t proc_set_dis_pwt(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++int proc_get_suspend_resume_info(struct seq_file *m, void *v); ++ ++ssize_t proc_set_fwdl_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ssize_t proc_set_del_rx_ampdu_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++#ifdef CONFIG_DFS_MASTER ++int proc_get_dfs_master_test_case(struct seq_file *m, void *v); ++ssize_t proc_set_dfs_master_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++#endif /* CONFIG_DFS_MASTER */ ++ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++#ifdef CONFIG_AP_MODE ++int proc_get_all_sta_info(struct seq_file *m, void *v); ++#endif /* CONFIG_AP_MODE */ ++ ++#ifdef DBG_MEMORY_LEAK ++int proc_get_malloc_cnt(struct seq_file *m, void *v); ++#endif /* DBG_MEMORY_LEAK */ ++ ++#ifdef CONFIG_FIND_BEST_CHANNEL ++int proc_get_best_channel(struct seq_file *m, void *v); ++ssize_t proc_set_best_channel(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++#endif /* CONFIG_FIND_BEST_CHANNEL */ ++ ++int proc_get_trx_info_debug(struct seq_file *m, void *v); ++ ++int proc_get_rx_signal(struct seq_file *m, void *v); ++ssize_t proc_set_rx_signal(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_hw_status(struct seq_file *m, void *v); ++ssize_t proc_set_hw_status(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++#ifdef CONFIG_80211N_HT ++int proc_get_ht_enable(struct seq_file *m, void *v); ++ssize_t proc_set_ht_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++int proc_get_bw_mode(struct seq_file *m, void *v); ++ssize_t proc_set_bw_mode(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++int proc_get_ampdu_enable(struct seq_file *m, void *v); ++ssize_t proc_set_ampdu_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++int proc_get_rx_ampdu(struct seq_file *m, void *v); ++ssize_t proc_set_rx_ampdu(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++int proc_get_rx_stbc(struct seq_file *m, void *v); ++ssize_t proc_set_rx_stbc(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++int proc_get_rx_ampdu_factor(struct seq_file *m, void *v); ++ssize_t proc_set_rx_ampdu_factor(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++int proc_get_rx_ampdu_density(struct seq_file *m, void *v); ++ssize_t proc_set_rx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++int proc_get_tx_ampdu_density(struct seq_file *m, void *v); ++ssize_t proc_set_tx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++#endif /* CONFIG_80211N_HT */ ++ ++int proc_get_mac_rptbuf(struct seq_file *m, void *v); ++int proc_get_en_fwps(struct seq_file *m, void *v); ++ssize_t proc_set_en_fwps(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++#if 0 ++int proc_get_two_path_rssi(struct seq_file *m, void *v); ++int proc_get_rssi_disp(struct seq_file *m, void *v); ++ssize_t proc_set_rssi_disp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++#endif ++ ++#ifdef CONFIG_BT_COEXIST ++int proc_get_btcoex_dbg(struct seq_file *m, void *v); ++ssize_t proc_set_btcoex_dbg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_btcoex_info(struct seq_file *m, void *v); ++#endif /* CONFIG_BT_COEXIST */ ++ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++int proc_get_sreset(struct seq_file *m, void *v); ++ssize_t proc_set_sreset(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++#endif /* DBG_CONFIG_ERROR_DETECT */ ++ ++int proc_get_odm_dbg_comp(struct seq_file *m, void *v); ++ssize_t proc_set_odm_dbg_comp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_odm_dbg_level(struct seq_file *m, void *v); ++ssize_t proc_set_odm_dbg_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++int proc_get_odm_adaptivity(struct seq_file *m, void *v); ++ssize_t proc_set_odm_adaptivity(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++#ifdef CONFIG_DBG_COUNTER ++int proc_get_rx_logs(struct seq_file *m, void *v); ++int proc_get_tx_logs(struct seq_file *m, void *v); ++int proc_get_int_logs(struct seq_file *m, void *v); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++int proc_get_rx_ring(struct seq_file *m, void *v); ++int proc_get_tx_ring(struct seq_file *m, void *v); ++#endif ++ ++#ifdef CONFIG_WOWLAN ++int proc_get_pattern_info(struct seq_file *m, void *v); ++ssize_t proc_set_pattern_info(struct file *file, const char __user *buffer, ++ size_t count, loff_t *pos, void *data); ++int proc_get_wakeup_reason(struct seq_file *m, void *v); ++#endif ++ ++#ifdef CONFIG_GPIO_WAKEUP ++int proc_get_wowlan_gpio_info(struct seq_file *m, void *v); ++ssize_t proc_set_wowlan_gpio_info(struct file *file, const char __user *buffer, ++ size_t count, loff_t *pos, void *data); ++#endif /*CONFIG_GPIO_WAKEUP*/ ++ ++#ifdef CONFIG_P2P_WOWLAN ++int proc_get_p2p_wowlan_info(struct seq_file *m, void *v); ++#endif /* CONFIG_P2P_WOWLAN */ ++ ++int proc_get_new_bcn_max(struct seq_file *m, void *v); ++ssize_t proc_set_new_bcn_max(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++#ifdef CONFIG_POWER_SAVING ++int proc_get_ps_info(struct seq_file *m, void *v); ++#endif /* CONFIG_POWER_SAVING */ ++ ++#ifdef CONFIG_TDLS ++int proc_get_tdls_info(struct seq_file *m, void *v); ++#endif ++ ++int proc_get_monitor(struct seq_file *m, void *v); ++ssize_t proc_set_monitor(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++ ++#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER ++int proc_get_rtkm_info(struct seq_file *m, void *v); ++#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ ++ ++#ifdef CONFIG_IEEE80211W ++ssize_t proc_set_tx_sa_query(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_tx_sa_query(struct seq_file *m, void *v); ++ssize_t proc_set_tx_deauth(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_tx_deauth(struct seq_file *m, void *v); ++ssize_t proc_set_tx_auth(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_tx_auth(struct seq_file *m, void *v); ++#endif /* CONFIG_IEEE80211W */ ++ ++#endif /* CONFIG_PROC_DEBUG */ ++ ++int proc_get_efuse_map(struct seq_file *m, void *v); ++ssize_t proc_set_efuse_map(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ ++#ifdef CONFIG_MCC_MODE ++int proc_get_mcc_info(struct seq_file *m, void *v); ++ssize_t proc_set_mcc_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ssize_t proc_set_mcc_single_tx_criteria(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ssize_t proc_set_mcc_ap_bw20_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ssize_t proc_set_mcc_ap_bw40_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ssize_t proc_set_mcc_ap_bw80_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ssize_t proc_set_mcc_sta_bw20_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ssize_t proc_set_mcc_sta_bw40_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ssize_t proc_set_mcc_sta_bw80_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++#endif /* CONFIG_MCC_MODE */ ++ ++ ++#define _drv_always_ 1 ++#define _drv_emerg_ 2 ++#define _drv_alert_ 3 ++#define _drv_crit_ 4 ++#define _drv_err_ 5 ++#define _drv_warning_ 6 ++#define _drv_notice_ 7 ++#define _drv_info_ 8 ++#define _drv_dump_ 9 ++#define _drv_debug_ 10 ++ ++#define _module_rtl871x_xmit_c_ BIT(0) ++#define _module_xmit_osdep_c_ BIT(1) ++#define _module_rtl871x_recv_c_ BIT(2) ++#define _module_recv_osdep_c_ BIT(3) ++#define _module_rtl871x_mlme_c_ BIT(4) ++#define _module_mlme_osdep_c_ BIT(5) ++#define _module_rtl871x_sta_mgt_c_ BIT(6) ++#define _module_rtl871x_cmd_c_ BIT(7) ++#define _module_cmd_osdep_c_ BIT(8) ++#define _module_rtl871x_io_c_ BIT(9) ++#define _module_io_osdep_c_ BIT(10) ++#define _module_os_intfs_c_ BIT(11) ++#define _module_rtl871x_security_c_ BIT(12) ++#define _module_rtl871x_eeprom_c_ BIT(13) ++#define _module_hal_init_c_ BIT(14) ++#define _module_hci_hal_init_c_ BIT(15) ++#define _module_rtl871x_ioctl_c_ BIT(16) ++#define _module_rtl871x_ioctl_set_c_ BIT(17) ++#define _module_rtl871x_ioctl_query_c_ BIT(18) ++#define _module_rtl871x_pwrctrl_c_ BIT(19) ++#define _module_hci_intfs_c_ BIT(20) ++#define _module_hci_ops_c_ BIT(21) ++#define _module_osdep_service_c_ BIT(22) ++#define _module_mp_ BIT(23) ++#define _module_hci_ops_os_c_ BIT(24) ++#define _module_rtl871x_ioctl_os_c BIT(25) ++#define _module_rtl8712_cmd_c_ BIT(26) ++/* #define _module_efuse_ BIT(27) */ ++#define _module_rtl8192c_xmit_c_ BIT(28) ++#define _module_hal_xmit_c_ BIT(28) ++#define _module_efuse_ BIT(29) ++#define _module_rtl8712_recv_c_ BIT(30) ++#define _module_rtl8712_led_c_ BIT(31) ++ ++#endif /* __RTW_DEBUG_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_eeprom.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_eeprom.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_eeprom.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_eeprom.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,121 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_EEPROM_H__ ++#define __RTW_EEPROM_H__ ++ ++ ++#define RTL8712_EEPROM_ID 0x8712 ++/* #define EEPROM_MAX_SIZE 256 */ ++ ++#define HWSET_MAX_SIZE_128 128 ++#define HWSET_MAX_SIZE_256 256 ++#define HWSET_MAX_SIZE_512 512 ++#define HWSET_MAX_SIZE_1024 1024 ++ ++#define EEPROM_MAX_SIZE HWSET_MAX_SIZE_1024 ++ ++#define CLOCK_RATE 50 /* 100us */ ++ ++/* - EEPROM opcodes */ ++#define EEPROM_READ_OPCODE 06 ++#define EEPROM_WRITE_OPCODE 05 ++#define EEPROM_ERASE_OPCODE 07 ++#define EEPROM_EWEN_OPCODE 19 /* Erase/write enable */ ++#define EEPROM_EWDS_OPCODE 16 /* Erase/write disable */ ++ ++/* Country codes */ ++#define USA 0x555320 ++#define EUROPE 0x1 /* temp, should be provided later */ ++#define JAPAN 0x2 /* temp, should be provided later */ ++ ++/* ++ * Customer ID, note that: ++ * This variable is initiailzed through EEPROM or registry, ++ * however, its definition may be different with that in EEPROM for ++ * EEPROM size consideration. So, we have to perform proper translation between them. ++ * Besides, CustomerID of registry has precedence of that of EEPROM. ++ * defined below. 060703, by rcnjko. ++ * */ ++typedef enum _RT_CUSTOMER_ID { ++ RT_CID_DEFAULT = 0, ++ RT_CID_8187_ALPHA0 = 1, ++ RT_CID_8187_SERCOMM_PS = 2, ++ RT_CID_8187_HW_LED = 3, ++ RT_CID_8187_NETGEAR = 4, ++ RT_CID_WHQL = 5, ++ RT_CID_819x_CAMEO = 6, ++ RT_CID_819x_RUNTOP = 7, ++ RT_CID_819x_Senao = 8, ++ RT_CID_TOSHIBA = 9, /* Merge by Jacken, 2008/01/31. */ ++ RT_CID_819x_Netcore = 10, ++ RT_CID_Nettronix = 11, ++ RT_CID_DLINK = 12, ++ RT_CID_PRONET = 13, ++ RT_CID_COREGA = 14, ++ RT_CID_CHINA_MOBILE = 15, ++ RT_CID_819x_ALPHA = 16, ++ RT_CID_819x_Sitecom = 17, ++ RT_CID_CCX = 18, /* It's set under CCX logo test and isn't demanded for CCX functions, but for test behavior like retry limit and tx report. By Bruce, 2009-02-17. */ ++ RT_CID_819x_Lenovo = 19, ++ RT_CID_819x_QMI = 20, ++ RT_CID_819x_Edimax_Belkin = 21, ++ RT_CID_819x_Sercomm_Belkin = 22, ++ RT_CID_819x_CAMEO1 = 23, ++ RT_CID_819x_MSI = 24, ++ RT_CID_819x_Acer = 25, ++ RT_CID_819x_AzWave_ASUS = 26, ++ RT_CID_819x_AzWave = 27, /* For AzWave in PCIe, The ID is AzWave use and not only Asus */ ++ RT_CID_819x_HP = 28, ++ RT_CID_819x_WNC_COREGA = 29, ++ RT_CID_819x_Arcadyan_Belkin = 30, ++ RT_CID_819x_SAMSUNG = 31, ++ RT_CID_819x_CLEVO = 32, ++ RT_CID_819x_DELL = 33, ++ RT_CID_819x_PRONETS = 34, ++ RT_CID_819x_Edimax_ASUS = 35, ++ RT_CID_NETGEAR = 36, ++ RT_CID_PLANEX = 37, ++ RT_CID_CC_C = 38, ++ RT_CID_819x_Xavi = 39, ++ RT_CID_LENOVO_CHINA = 40, ++ RT_CID_INTEL_CHINA = 41, ++ RT_CID_TPLINK_HPWR = 42, ++ RT_CID_819x_Sercomm_Netgear = 43, ++ RT_CID_819x_ALPHA_Dlink = 44,/* add by ylb 20121012 for customer led for alpha */ ++ RT_CID_WNC_NEC = 45,/* add by page for NEC */ ++ RT_CID_DNI_BUFFALO = 46,/* add by page for NEC */ ++} RT_CUSTOMER_ID, *PRT_CUSTOMER_ID; ++ ++extern void eeprom_write16(_adapter *padapter, u16 reg, u16 data); ++extern u16 eeprom_read16(_adapter *padapter, u16 reg); ++extern void read_eeprom_content(_adapter *padapter); ++extern void eeprom_read_sz(_adapter *padapter, u16 reg, u8 *data, u32 sz); ++ ++extern void read_eeprom_content_by_attrib(_adapter *padapter); ++ ++#ifdef PLATFORM_LINUX ++#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE ++extern int isAdaptorInfoFileValid(void); ++extern int storeAdaptorInfoFile(char *path, u8 *efuse_data); ++extern int retriveAdaptorInfoFile(char *path, u8 *efuse_data); ++#endif /* CONFIG_ADAPTOR_INFO_CACHING_FILE */ ++#endif /* PLATFORM_LINUX */ ++ ++#endif /* __RTL871X_EEPROM_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_efuse.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_efuse.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_efuse.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_efuse.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,244 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_EFUSE_H__ ++#define __RTW_EFUSE_H__ ++ ++ ++#define EFUSE_ERROE_HANDLE 1 ++ ++#define PG_STATE_HEADER 0x01 ++#define PG_STATE_WORD_0 0x02 ++#define PG_STATE_WORD_1 0x04 ++#define PG_STATE_WORD_2 0x08 ++#define PG_STATE_WORD_3 0x10 ++#define PG_STATE_DATA 0x20 ++ ++#define PG_SWBYTE_H 0x01 ++#define PG_SWBYTE_L 0x02 ++ ++#define PGPKT_DATA_SIZE 8 ++ ++#define EFUSE_WIFI 0 ++#define EFUSE_BT 1 ++ ++enum _EFUSE_DEF_TYPE { ++ TYPE_EFUSE_MAX_SECTION = 0, ++ TYPE_EFUSE_REAL_CONTENT_LEN = 1, ++ TYPE_AVAILABLE_EFUSE_BYTES_BANK = 2, ++ TYPE_AVAILABLE_EFUSE_BYTES_TOTAL = 3, ++ TYPE_EFUSE_MAP_LEN = 4, ++ TYPE_EFUSE_PROTECT_BYTES_BANK = 5, ++ TYPE_EFUSE_CONTENT_LEN_BANK = 6, ++}; ++ ++#define EFUSE_MAX_MAP_LEN 1024 ++ ++#define EFUSE_MAX_HW_SIZE 1024 ++#define EFUSE_MAX_SECTION_BASE 16 ++ ++/*RTL8822B 8821C BT EFUSE Define 1 BANK 128 size logical map 1024*/ ++#ifdef RTW_HALMAC ++#define BANK_NUM 1 ++#define EFUSE_BT_REAL_BANK_CONTENT_LEN 128 ++#define EFUSE_BT_REAL_CONTENT_LEN (EFUSE_BT_REAL_BANK_CONTENT_LEN * BANK_NUM) ++#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ ++#define EFUSE_BT_MAX_SECTION (EFUSE_BT_MAP_LEN / 8) ++#define EFUSE_PROTECT_BYTES_BANK 16 ++#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_BT_REAL_CONTENT_LEN) ++#endif ++ ++#define EXT_HEADER(header) ((header & 0x1F) == 0x0F) ++#define ALL_WORDS_DISABLED(wde) ((wde & 0x0F) == 0x0F) ++#define GET_HDR_OFFSET_2_0(header) ((header & 0xE0) >> 5) ++ ++#define EFUSE_REPEAT_THRESHOLD_ 3 ++ ++#define IS_MASKED_MP(ic, txt, offset) (EFUSE_IsAddressMasked_MP_##ic##txt(offset)) ++#define IS_MASKED_TC(ic, txt, offset) (EFUSE_IsAddressMasked_TC_##ic##txt(offset)) ++#define GET_MASK_ARRAY_LEN_MP(ic, txt) (EFUSE_GetArrayLen_MP_##ic##txt()) ++#define GET_MASK_ARRAY_LEN_TC(ic, txt) (EFUSE_GetArrayLen_TC_##ic##txt()) ++#define GET_MASK_ARRAY_MP(ic, txt, offset) (EFUSE_GetMaskArray_MP_##ic##txt(offset)) ++#define GET_MASK_ARRAY_TC(ic, txt, offset) (EFUSE_GetMaskArray_TC_##ic##txt(offset)) ++ ++ ++#define IS_MASKED(ic, txt, offset) (IS_MASKED_MP(ic, txt, offset)) ++#define GET_MASK_ARRAY_LEN(ic, txt) (GET_MASK_ARRAY_LEN_MP(ic, txt)) ++#define GET_MASK_ARRAY(ic, txt, out) do { GET_MASK_ARRAY_MP(ic, txt, out); } while (0) ++ ++/* ********************************************* ++ * The following is for BT Efuse definition ++ * ********************************************* */ ++#define EFUSE_BT_MAX_MAP_LEN 1024 ++#define EFUSE_MAX_BANK 4 ++#define EFUSE_MAX_BT_BANK (EFUSE_MAX_BANK-1) ++/* ********************************************* ++ *--------------------------Define Parameters-------------------------------*/ ++#define EFUSE_MAX_WORD_UNIT 4 ++ ++/*------------------------------Define structure----------------------------*/ ++typedef struct PG_PKT_STRUCT_A { ++ u8 offset; ++ u8 word_en; ++ u8 data[8]; ++ u8 word_cnts; ++} PGPKT_STRUCT, *PPGPKT_STRUCT; ++ ++typedef enum { ++ ERR_SUCCESS = 0, ++ ERR_DRIVER_FAILURE, ++ ERR_IO_FAILURE, ++ ERR_WI_TIMEOUT, ++ ERR_WI_BUSY, ++ ERR_BAD_FORMAT, ++ ERR_INVALID_DATA, ++ ERR_NOT_ENOUGH_SPACE, ++ ERR_WRITE_PROTECT, ++ ERR_READ_BACK_FAIL, ++ ERR_OUT_OF_RANGE ++} ERROR_CODE; ++ ++/*------------------------------Define structure----------------------------*/ ++typedef struct _EFUSE_HAL { ++ u8 fakeEfuseBank; ++ u32 fakeEfuseUsedBytes; ++ u8 fakeEfuseContent[EFUSE_MAX_HW_SIZE]; ++ u8 fakeEfuseInitMap[EFUSE_MAX_MAP_LEN]; ++ u8 fakeEfuseModifiedMap[EFUSE_MAX_MAP_LEN]; ++ u32 EfuseUsedBytes; ++ u8 EfuseUsedPercentage; ++ ++ u16 BTEfuseUsedBytes; ++ u8 BTEfuseUsedPercentage; ++ u8 BTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; ++ u8 BTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN]; ++ u8 BTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN]; ++ ++ u16 fakeBTEfuseUsedBytes; ++ u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; ++ u8 fakeBTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN]; ++ u8 fakeBTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN]; ++ ++ /* EFUSE Configuration, initialized in HAL_CmnInitPGData(). */ ++ const u16 MaxSecNum_WiFi; ++ const u16 MaxSecNum_BT; ++ const u16 WordUnit; ++ const u16 PhysicalLen_WiFi; ++ const u16 PhysicalLen_BT; ++ const u16 LogicalLen_WiFi; ++ const u16 LogicalLen_BT; ++ const u16 BankSize; ++ const u16 TotalBankNum; ++ const u16 BankNum_WiFi; ++ const u16 BankNum_BT; ++ const u16 OOBProtectBytes; ++ const u16 ProtectBytes; ++ const u16 BankAvailBytes; ++ const u16 TotalAvailBytes_WiFi; ++ const u16 TotalAvailBytes_BT; ++ const u16 HeaderRetry; ++ const u16 DataRetry; ++ ++ ERROR_CODE Status; ++ ++} EFUSE_HAL, *PEFUSE_HAL; ++ ++extern u8 maskfileBuffer[64]; ++ ++/*------------------------Export global variable----------------------------*/ ++extern u8 fakeEfuseBank; ++extern u32 fakeEfuseUsedBytes; ++extern u8 fakeEfuseContent[]; ++extern u8 fakeEfuseInitMap[]; ++extern u8 fakeEfuseModifiedMap[]; ++ ++extern u32 BTEfuseUsedBytes; ++extern u8 BTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; ++extern u8 BTEfuseInitMap[]; ++extern u8 BTEfuseModifiedMap[]; ++ ++extern u32 fakeBTEfuseUsedBytes; ++extern u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; ++extern u8 fakeBTEfuseInitMap[]; ++extern u8 fakeBTEfuseModifiedMap[]; ++/*------------------------Export global variable----------------------------*/ ++u8 efuse_bt_GetCurrentSize(PADAPTER padapter, u16 *size); ++u16 efuse_bt_GetMaxSize(PADAPTER padapter); ++ ++u8 efuse_GetCurrentSize(PADAPTER padapter, u16 *size); ++u16 efuse_GetMaxSize(PADAPTER padapter); ++u8 rtw_efuse_access(PADAPTER padapter, u8 bRead, u16 start_addr, u16 cnts, u8 *data); ++u8 rtw_efuse_bt_access(PADAPTER adapter, u8 write, u16 addr, u16 cnts, u8 *data); ++ ++u8 rtw_efuse_mask_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); ++u8 rtw_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); ++u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); ++u8 rtw_BT_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); ++u8 rtw_BT_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); ++ ++u16 Efuse_GetCurrentSize(PADAPTER pAdapter, u8 efuseType, BOOLEAN bPseudoTest); ++u8 Efuse_CalculateWordCnts(u8 word_en); ++void ReadEFuseByte(PADAPTER Adapter, u16 _offset, u8 *pbuf, BOOLEAN bPseudoTest) ; ++void EFUSE_GetEfuseDefinition(PADAPTER pAdapter, u8 efuseType, u8 type, void *pOut, BOOLEAN bPseudoTest); ++u8 efuse_OneByteRead(PADAPTER pAdapter, u16 addr, u8 *data, BOOLEAN bPseudoTest); ++u8 efuse_OneByteWrite(PADAPTER pAdapter, u16 addr, u8 data, BOOLEAN bPseudoTest); ++ ++void BTEfuse_PowerSwitch(PADAPTER pAdapter, u8 bWrite, u8 PwrState); ++void Efuse_PowerSwitch(PADAPTER pAdapter, u8 bWrite, u8 PwrState); ++int Efuse_PgPacketRead(PADAPTER pAdapter, u8 offset, u8 *data, BOOLEAN bPseudoTest); ++int Efuse_PgPacketWrite(PADAPTER pAdapter, u8 offset, u8 word_en, u8 *data, BOOLEAN bPseudoTest); ++void efuse_WordEnableDataRead(u8 word_en, u8 *sourdata, u8 *targetdata); ++u8 Efuse_WordEnableDataWrite(PADAPTER pAdapter, u16 efuse_addr, u8 word_en, u8 *data, BOOLEAN bPseudoTest); ++void EFUSE_ShadowMapUpdate(PADAPTER pAdapter, u8 efuseType, BOOLEAN bPseudoTest); ++void EFUSE_ShadowRead(PADAPTER pAdapter, u8 Type, u16 Offset, u32 *Value); ++ ++VOID hal_ReadEFuse_BT_logic_map( ++ PADAPTER padapter, ++ u16 _offset, ++ u16 _size_byte, ++ u8 *pbuf ++); ++u8 EfusePgPacketWrite_BT( ++ PADAPTER pAdapter, ++ u8 offset, ++ u8 word_en, ++ u8 *pData, ++ u8 bPseudoTest); ++u16 rtw_get_efuse_mask_arraylen(PADAPTER pAdapter); ++void rtw_efuse_mask_array(PADAPTER pAdapter, u8 *pArray); ++ ++#define MAC_HIDDEN_MAX_BW_NUM 8 ++extern const u8 _mac_hidden_max_bw_to_hal_bw_cap[]; ++#define mac_hidden_max_bw_to_hal_bw_cap(max_bw) (((max_bw) >= MAC_HIDDEN_MAX_BW_NUM) ? 0 : _mac_hidden_max_bw_to_hal_bw_cap[(max_bw)]) ++ ++#define MAC_HIDDEN_PROTOCOL_NUM 4 ++extern const u8 _mac_hidden_proto_to_hal_proto_cap[]; ++#define mac_hidden_proto_to_hal_proto_cap(proto) (((proto) >= MAC_HIDDEN_PROTOCOL_NUM) ? 0 : _mac_hidden_proto_to_hal_proto_cap[(proto)]) ++ ++u8 mac_hidden_wl_func_to_hal_wl_func(u8 func); ++ ++#ifdef PLATFORM_LINUX ++u8 rtw_efuse_file_read(PADAPTER padapter, u8 *filepatch, u8 *buf, u32 len); ++#ifdef CONFIG_EFUSE_CONFIG_FILE ++u32 rtw_read_efuse_from_file(const char *path, u8 *buf, int map_size); ++u32 rtw_read_macaddr_from_file(const char *path, u8 *buf); ++#endif /* CONFIG_EFUSE_CONFIG_FILE */ ++#endif /* PLATFORM_LINUX */ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_event.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_event.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_event.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_event.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,135 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTW_EVENT_H_ ++#define _RTW_EVENT_H_ ++ ++#ifdef CONFIG_H2CLBK ++ #include ++#endif ++ ++/* ++Used to report a bss has been scanned ++ ++*/ ++struct survey_event { ++ WLAN_BSSID_EX bss; ++}; ++ ++/* ++Used to report that the requested site survey has been done. ++ ++bss_cnt indicates the number of bss that has been reported. ++ ++ ++*/ ++struct surveydone_event { ++ unsigned int bss_cnt; ++ ++}; ++ ++/* ++Used to report the link result of joinning the given bss ++ ++ ++join_res: ++-1: authentication fail ++-2: association fail ++> 0: TID ++ ++*/ ++struct joinbss_event { ++ struct wlan_network network; ++}; ++ ++/* ++Used to report a given STA has joinned the created BSS. ++It is used in AP/Ad-HoC(M) mode. ++ ++ ++*/ ++struct stassoc_event { ++ unsigned char macaddr[6]; ++}; ++ ++struct stadel_event { ++ unsigned char macaddr[6]; ++ unsigned char rsvd[2]; /* for reason */ ++ unsigned char locally_generated; ++ int mac_id; ++}; ++ ++struct addba_event { ++ unsigned int tid; ++}; ++ ++struct wmm_event { ++ unsigned char wmm; ++}; ++ ++#ifdef CONFIG_H2CLBK ++struct c2hlbk_event { ++ unsigned char mac[6]; ++ unsigned short s0; ++ unsigned short s1; ++ unsigned int w0; ++ unsigned char b0; ++ unsigned short s2; ++ unsigned char b1; ++ unsigned int w1; ++}; ++#endif/* CONFIG_H2CLBK */ ++ ++#define GEN_EVT_CODE(event) event ## _EVT_ ++ ++ ++ ++struct fwevent { ++ u32 parmsize; ++ void (*event_callback)(_adapter *dev, u8 *pbuf); ++}; ++ ++ ++#define C2HEVENT_SZ 32 ++ ++struct event_node { ++ unsigned char *node; ++ unsigned char evt_code; ++ unsigned short evt_sz; ++ volatile int *caller_ff_tail; ++ int caller_ff_sz; ++}; ++ ++struct c2hevent_queue { ++ volatile int head; ++ volatile int tail; ++ struct event_node nodes[C2HEVENT_SZ]; ++ unsigned char seq; ++}; ++ ++#define NETWORK_QUEUE_SZ 4 ++ ++struct network_queue { ++ volatile int head; ++ volatile int tail; ++ WLAN_BSSID_EX networks[NETWORK_QUEUE_SZ]; ++}; ++ ++ ++#endif /* _WLANEVENT_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_ht.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ht.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_ht.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ht.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,219 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTW_HT_H_ ++#define _RTW_HT_H_ ++ ++ ++struct ht_priv { ++ u8 ht_option; ++ u8 ampdu_enable;/* for enable Tx A-MPDU */ ++ u8 tx_amsdu_enable;/* for enable Tx A-MSDU */ ++ u8 bss_coexist;/* for 20/40 Bss coexist */ ++ ++ /* u8 baddbareq_issued[16]; */ ++ u32 tx_amsdu_maxlen; /* 1: 8k, 0:4k ; default:8k, for tx */ ++ u32 rx_ampdu_maxlen; /* for rx reordering ctrl win_sz, updated when join_callback. */ ++ ++ u8 rx_ampdu_min_spacing; ++ ++ u8 ch_offset;/* PRIME_CHNL_OFFSET */ ++ u8 sgi_20m; ++ u8 sgi_40m; ++ ++ /* for processing Tx A-MPDU */ ++ u8 agg_enable_bitmap; ++ /* u8 ADDBA_retry_count; */ ++ u8 candidate_tid_bitmap; ++ ++ u8 ldpc_cap; ++ u8 stbc_cap; ++ u8 beamform_cap; ++ u8 smps_cap; /*spatial multiplexing power save mode. 0:static SMPS, 1:dynamic SMPS, 3:SMPS disabled, 2:reserved*/ ++ ++ struct rtw_ieee80211_ht_cap ht_cap; ++ ++}; ++ ++typedef enum AGGRE_SIZE { ++ HT_AGG_SIZE_8K = 0, ++ HT_AGG_SIZE_16K = 1, ++ HT_AGG_SIZE_32K = 2, ++ HT_AGG_SIZE_64K = 3, ++ VHT_AGG_SIZE_128K = 4, ++ VHT_AGG_SIZE_256K = 5, ++ VHT_AGG_SIZE_512K = 6, ++ VHT_AGG_SIZE_1024K = 7, ++} AGGRE_SIZE_E, *PAGGRE_SIZE_E; ++ ++typedef enum _RT_HT_INF0_CAP { ++ RT_HT_CAP_USE_TURBO_AGGR = 0x01, ++ RT_HT_CAP_USE_LONG_PREAMBLE = 0x02, ++ RT_HT_CAP_USE_AMPDU = 0x04, ++ RT_HT_CAP_USE_WOW = 0x8, ++ RT_HT_CAP_USE_SOFTAP = 0x10, ++ RT_HT_CAP_USE_92SE = 0x20, ++ RT_HT_CAP_USE_88C_92C = 0x40, ++ RT_HT_CAP_USE_AP_CLIENT_MODE = 0x80, /* AP team request to reserve this bit, by Emily */ ++} RT_HT_INF0_CAPBILITY, *PRT_HT_INF0_CAPBILITY; ++ ++typedef enum _RT_HT_INF1_CAP { ++ RT_HT_CAP_USE_VIDEO_CLIENT = 0x01, ++ RT_HT_CAP_USE_JAGUAR_BCUT = 0x02, ++ RT_HT_CAP_USE_JAGUAR_CCUT = 0x04, ++} RT_HT_INF1_CAPBILITY, *PRT_HT_INF1_CAPBILITY; ++ ++#define LDPC_HT_ENABLE_RX BIT0 ++#define LDPC_HT_ENABLE_TX BIT1 ++#define LDPC_HT_TEST_TX_ENABLE BIT2 ++#define LDPC_HT_CAP_TX BIT3 ++ ++#define STBC_HT_ENABLE_RX BIT0 ++#define STBC_HT_ENABLE_TX BIT1 ++#define STBC_HT_TEST_TX_ENABLE BIT2 ++#define STBC_HT_CAP_TX BIT3 ++ ++#define BEAMFORMING_HT_BEAMFORMER_ENABLE BIT0 /* Declare our NIC supports beamformer */ ++#define BEAMFORMING_HT_BEAMFORMEE_ENABLE BIT1 /* Declare our NIC supports beamformee */ ++#define BEAMFORMING_HT_BEAMFORMER_TEST BIT2 /* Transmiting Beamforming no matter the target supports it or not */ ++#define BEAMFORMING_HT_BEAMFORMER_STEER_NUM (BIT4 | BIT5) ++#define BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP (BIT6 | BIT7) ++ ++/* ------------------------------------------------------------ ++ * The HT Control field ++ * ------------------------------------------------------------ */ ++#define SET_HT_CTRL_CSI_STEERING(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart))+2, 6, 2, _val) ++#define SET_HT_CTRL_NDP_ANNOUNCEMENT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart))+3, 0, 1, _val) ++#define GET_HT_CTRL_NDP_ANNOUNCEMENT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+3, 0, 1) ++ ++/* 20/40 BSS Coexist */ ++#define SET_EXT_CAPABILITY_ELE_BSS_COEXIST(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 0, 1, _val) ++#define GET_EXT_CAPABILITY_ELE_BSS_COEXIST(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 0, 1) ++ ++/* HT Capabilities Info field */ ++#define HT_CAP_ELE_CAP_INFO(_pEleStart) ((u8 *)(_pEleStart)) ++#define GET_HT_CAP_ELE_LDPC_CAP(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 0, 1) ++#define GET_HT_CAP_ELE_CHL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 1, 1) ++#define GET_HT_CAP_ELE_SM_PS(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 2, 2) ++#define GET_HT_CAP_ELE_GREENFIELD(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 4, 1) ++#define GET_HT_CAP_ELE_SHORT_GI20M(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 5, 1) ++#define GET_HT_CAP_ELE_SHORT_GI40M(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 6, 1) ++#define GET_HT_CAP_ELE_TX_STBC(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 7, 1) ++#define GET_HT_CAP_ELE_RX_STBC(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 0, 2) ++#define GET_HT_CAP_ELE_DELAYED_BA(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 2, 1) ++#define GET_HT_CAP_ELE_MAX_AMSDU_LENGTH(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 3, 1) ++#define GET_HT_CAP_ELE_DSSS_CCK_40M(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 4, 1) ++#define GET_HT_CAP_ELE_FORTY_INTOLERANT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 6, 1) ++#define GET_HT_CAP_ELE_LSIG_TXOP_PROTECT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 7, 1) ++ ++#define SET_HT_CAP_ELE_LDPC_CAP(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 0, 1, _val) ++#define SET_HT_CAP_ELE_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 1, 1, _val) ++#define SET_HT_CAP_ELE_SM_PS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 2, 2, _val) ++#define SET_HT_CAP_ELE_GREENFIELD(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 4, 1, _val) ++#define SET_HT_CAP_ELE_SHORT_GI20M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 5, 1, _val) ++#define SET_HT_CAP_ELE_SHORT_GI40M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 6, 1, _val) ++#define SET_HT_CAP_ELE_TX_STBC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 7, 1, _val) ++#define SET_HT_CAP_ELE_RX_STBC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 0, 2, _val) ++#define SET_HT_CAP_ELE_DELAYED_BA(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 2, 1, _val) ++#define SET_HT_CAP_ELE_MAX_AMSDU_LENGTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 3, 1, _val) ++#define SET_HT_CAP_ELE_DSSS_CCK_40M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 4, 1, _val) ++#define SET_HT_CAP_ELE_FORTY_INTOLERANT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 6, 1, _val) ++#define SET_HT_CAP_ELE_LSIG_TXOP_PROTECT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 7, 1, _val) ++ ++/* A-MPDU Parameters field */ ++#define HT_CAP_ELE_AMPDU_PARA(_pEleStart) (((u8 *)(_pEleStart))+2) ++#define GET_HT_CAP_ELE_MAX_AMPDU_LEN_EXP(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+2, 0, 2) ++#define GET_HT_CAP_ELE_MIN_MPDU_S_SPACE(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+2, 2, 3) ++ ++#define HT_AMPDU_PARA_FMT "%02x " \ ++ "MAX AMPDU len:%u bytes, MIN MPDU Start Spacing:%u" ++ ++#define HT_AMPDU_PARA_ARG(x) \ ++ *((u8 *)(x)) \ ++ , (1 << (13+GET_HT_CAP_ELE_MAX_AMPDU_LEN_EXP(((u8 *)x)-2)))-1 \ ++ , GET_HT_CAP_ELE_MIN_MPDU_S_SPACE(((u8 *)x)-2) ++ ++/* Supported MCS Set field */ ++#define HT_CAP_ELE_SUP_MCS_SET(_pEleStart) (((u8 *)(_pEleStart))+3) ++#define HT_CAP_ELE_RX_MCS_MAP(_pEleStart) HT_CAP_ELE_SUP_MCS_SET(_pEleStart) ++#define GET_HT_CAP_ELE_RX_HIGHEST_DATA_RATE(_pEleStart) LE_BITS_TO_2BYTE(((u8 *)(_pEleStart))+13, 0, 10) ++#define GET_HT_CAP_ELE_TX_MCS_DEF(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 0, 1) ++#define GET_HT_CAP_ELE_TRX_MCS_NEQ(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 1, 1) ++#define GET_HT_CAP_ELE_TX_MAX_SS(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 2, 2) ++#define GET_HT_CAP_ELE_TX_UEQM(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 4, 1) ++ ++#define HT_SUP_MCS_SET_FMT "%02x %02x %02x %02x %02x%02x%02x%02x%02x%02x" \ ++ /* "\n%02x%02x%02x%02x%02x%02x" */\ ++ " %uMbps %s%s%s" ++#define HT_SUP_MCS_SET_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5], \ ++ ((u8 *)(x))[6], ((u8 *)(x))[7], ((u8 *)(x))[8], ((u8 *)(x))[9] \ ++ /*,((u8 *)(x))[10], ((u8 *)(x))[11], ((u8 *)(x))[12], ((u8 *)(x))[13], ((u8 *)(x))[14], ((u8 *)(x))[15] */\ ++ , GET_HT_CAP_ELE_RX_HIGHEST_DATA_RATE(((u8 *)x)-3) \ ++ , GET_HT_CAP_ELE_TX_MCS_DEF(((u8 *)x)-3) ? "TX_MCS_DEF " : "" \ ++ , GET_HT_CAP_ELE_TRX_MCS_NEQ(((u8 *)x)-3) ? "TRX_MCS_NEQ " : "" \ ++ , GET_HT_CAP_ELE_TX_UEQM(((u8 *)x)-3) ? "TX_UEQM " : "" ++ ++/* TXBF Capabilities */ ++#define SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 3, 1, ((u8)_val)) ++#define SET_HT_CAP_TXBF_TRANSMIT_NDP_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 4, 1, ((u8)_val)) ++#define SET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 10, 1, ((u8)_val)) ++#define SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 15, 2, ((u8)_val)) ++#define SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 23, 2, ((u8)_val)) ++#define SET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 27, 2, ((u8)_val)) ++ ++ ++#define GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(_pEleStart) LE_BITS_TO_4BYTE(((u8 *)(_pEleStart))+21, 10, 1) ++#define GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(_pEleStart) LE_BITS_TO_4BYTE(((u8 *)(_pEleStart))+21, 15, 2) ++#define GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(_pEleStart) LE_BITS_TO_4BYTE(((u8 *)(_pEleStart))+21, 23, 2) ++#define GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(_pEleStart) LE_BITS_TO_4BYTE(((u8 *)(_pEleStart))+21, 27, 2) ++ ++/* HT Operation element */ ++ ++#define GET_HT_OP_ELE_PRI_CHL(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 0, 8) ++#define SET_HT_OP_ELE_PRI_CHL(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 0, 8, _val) ++ ++/* HT Operation Info field */ ++#define HT_OP_ELE_OP_INFO(_pEleStart) (((u8 *)(_pEleStart)) + 1) ++#define GET_HT_OP_ELE_2ND_CHL_OFFSET(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 1, 0, 2) ++#define GET_HT_OP_ELE_STA_CHL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 1, 2, 1) ++#define GET_HT_OP_ELE_RIFS_MODE(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 1, 3, 1) ++#define GET_HT_OP_ELE_HT_PROTECT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 2, 0, 2) ++#define GET_HT_OP_ELE_NON_GREEN_PRESENT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 2, 2, 1) ++#define GET_HT_OP_ELE_OBSS_NON_HT_PRESENT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 2, 4, 1) ++#define GET_HT_OP_ELE_DUAL_BEACON(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 4, 6, 1) ++#define GET_HT_OP_ELE_DUAL_CTS(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 4, 7, 1) ++#define GET_HT_OP_ELE_STBC_BEACON(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 5, 0, 1) ++#define GET_HT_OP_ELE_LSIG_TXOP_PROTECT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 5, 1, 1) ++#define GET_HT_OP_ELE_PCO_ACTIVE(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 5, 2, 1) ++#define GET_HT_OP_ELE_PCO_PHASE(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 5, 3, 1) ++ ++#define SET_HT_OP_ELE_2ND_CHL_OFFSET(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 0, 2, _val) ++#define SET_HT_OP_ELE_STA_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 2, 1, _val) ++#define SET_HT_OP_ELE_RIFS_MODE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 3, 1, _val) ++#define SET_HT_OP_ELE_HT_PROTECT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 2, 0, 2, _val) ++#define SET_HT_OP_ELE_NON_GREEN_PRESENT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 2, 2, 1, _val) ++#define SET_HT_OP_ELE_OBSS_NON_HT_PRESENT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 2, 4, 1, _val) ++#define SET_HT_OP_ELE_DUAL_BEACON(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 4, 6, 1, _val) ++#define SET_HT_OP_ELE_DUAL_CTS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 4, 7, 1, _val) ++#define SET_HT_OP_ELE_STBC_BEACON(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 5, 0, 1, _val) ++#define SET_HT_OP_ELE_LSIG_TXOP_PROTECT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 5, 1, 1, _val) ++#define SET_HT_OP_ELE_PCO_ACTIVE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 5, 2, 1, _val) ++#define SET_HT_OP_ELE_PCO_PHASE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 5, 3, 1, _val) ++ ++#endif /* _RTL871X_HT_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,317 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTW_IOCTL_H_ ++#define _RTW_IOCTL_H_ ++ ++#ifndef PLATFORM_WINDOWS ++/* 00 - Success ++* 11 - Error */ ++#define STATUS_SUCCESS (0x00000000L) ++#define STATUS_PENDING (0x00000103L) ++ ++#define STATUS_UNSUCCESSFUL (0xC0000001L) ++#define STATUS_INSUFFICIENT_RESOURCES (0xC000009AL) ++#define STATUS_NOT_SUPPORTED (0xC00000BBL) ++ ++#define NDIS_STATUS_SUCCESS ((NDIS_STATUS)STATUS_SUCCESS) ++#define NDIS_STATUS_PENDING ((NDIS_STATUS)STATUS_PENDING) ++#define NDIS_STATUS_NOT_RECOGNIZED ((NDIS_STATUS)0x00010001L) ++#define NDIS_STATUS_NOT_COPIED ((NDIS_STATUS)0x00010002L) ++#define NDIS_STATUS_NOT_ACCEPTED ((NDIS_STATUS)0x00010003L) ++#define NDIS_STATUS_CALL_ACTIVE ((NDIS_STATUS)0x00010007L) ++ ++#define NDIS_STATUS_FAILURE ((NDIS_STATUS)STATUS_UNSUCCESSFUL) ++#define NDIS_STATUS_RESOURCES ((NDIS_STATUS)STATUS_INSUFFICIENT_RESOURCES) ++#define NDIS_STATUS_CLOSING ((NDIS_STATUS)0xC0010002L) ++#define NDIS_STATUS_BAD_VERSION ((NDIS_STATUS)0xC0010004L) ++#define NDIS_STATUS_BAD_CHARACTERISTICS ((NDIS_STATUS)0xC0010005L) ++#define NDIS_STATUS_ADAPTER_NOT_FOUND ((NDIS_STATUS)0xC0010006L) ++#define NDIS_STATUS_OPEN_FAILED ((NDIS_STATUS)0xC0010007L) ++#define NDIS_STATUS_DEVICE_FAILED ((NDIS_STATUS)0xC0010008L) ++#define NDIS_STATUS_MULTICAST_FULL ((NDIS_STATUS)0xC0010009L) ++#define NDIS_STATUS_MULTICAST_EXISTS ((NDIS_STATUS)0xC001000AL) ++#define NDIS_STATUS_MULTICAST_NOT_FOUND ((NDIS_STATUS)0xC001000BL) ++#define NDIS_STATUS_REQUEST_ABORTED ((NDIS_STATUS)0xC001000CL) ++#define NDIS_STATUS_RESET_IN_PROGRESS ((NDIS_STATUS)0xC001000DL) ++#define NDIS_STATUS_CLOSING_INDICATING ((NDIS_STATUS)0xC001000EL) ++#define NDIS_STATUS_NOT_SUPPORTED ((NDIS_STATUS)STATUS_NOT_SUPPORTED) ++#define NDIS_STATUS_INVALID_PACKET ((NDIS_STATUS)0xC001000FL) ++#define NDIS_STATUS_OPEN_LIST_FULL ((NDIS_STATUS)0xC0010010L) ++#define NDIS_STATUS_ADAPTER_NOT_READY ((NDIS_STATUS)0xC0010011L) ++#define NDIS_STATUS_ADAPTER_NOT_OPEN ((NDIS_STATUS)0xC0010012L) ++#define NDIS_STATUS_NOT_INDICATING ((NDIS_STATUS)0xC0010013L) ++#define NDIS_STATUS_INVALID_LENGTH ((NDIS_STATUS)0xC0010014L) ++#define NDIS_STATUS_INVALID_DATA ((NDIS_STATUS)0xC0010015L) ++#define NDIS_STATUS_BUFFER_TOO_SHORT ((NDIS_STATUS)0xC0010016L) ++#define NDIS_STATUS_INVALID_OID ((NDIS_STATUS)0xC0010017L) ++#define NDIS_STATUS_ADAPTER_REMOVED ((NDIS_STATUS)0xC0010018L) ++#define NDIS_STATUS_UNSUPPORTED_MEDIA ((NDIS_STATUS)0xC0010019L) ++#define NDIS_STATUS_GROUP_ADDRESS_IN_USE ((NDIS_STATUS)0xC001001AL) ++#define NDIS_STATUS_FILE_NOT_FOUND ((NDIS_STATUS)0xC001001BL) ++#define NDIS_STATUS_ERROR_READING_FILE ((NDIS_STATUS)0xC001001CL) ++#define NDIS_STATUS_ALREADY_MAPPED ((NDIS_STATUS)0xC001001DL) ++#define NDIS_STATUS_RESOURCE_CONFLICT ((NDIS_STATUS)0xC001001EL) ++#define NDIS_STATUS_NO_CABLE ((NDIS_STATUS)0xC001001FL) ++ ++#define NDIS_STATUS_INVALID_SAP ((NDIS_STATUS)0xC0010020L) ++#define NDIS_STATUS_SAP_IN_USE ((NDIS_STATUS)0xC0010021L) ++#define NDIS_STATUS_INVALID_ADDRESS ((NDIS_STATUS)0xC0010022L) ++#define NDIS_STATUS_VC_NOT_ACTIVATED ((NDIS_STATUS)0xC0010023L) ++#define NDIS_STATUS_DEST_OUT_OF_ORDER ((NDIS_STATUS)0xC0010024L) /* cause 27 */ ++#define NDIS_STATUS_VC_NOT_AVAILABLE ((NDIS_STATUS)0xC0010025L) /* cause 35, 45 */ ++#define NDIS_STATUS_CELLRATE_NOT_AVAILABLE ((NDIS_STATUS)0xC0010026L) /* cause 37 */ ++#define NDIS_STATUS_INCOMPATABLE_QOS ((NDIS_STATUS)0xC0010027L) /* cause 49 */ ++#define NDIS_STATUS_AAL_PARAMS_UNSUPPORTED ((NDIS_STATUS)0xC0010028L) /* cause 93 */ ++#define NDIS_STATUS_NO_ROUTE_TO_DESTINATION ((NDIS_STATUS)0xC0010029L) /* cause 3 */ ++#endif /* #ifndef PLATFORM_WINDOWS */ ++ ++ ++#ifndef OID_802_11_CAPABILITY ++ #define OID_802_11_CAPABILITY 0x0d010122 ++#endif ++ ++#ifndef OID_802_11_PMKID ++ #define OID_802_11_PMKID 0x0d010123 ++#endif ++ ++ ++/* For DDK-defined OIDs */ ++#define OID_NDIS_SEG1 0x00010100 ++#define OID_NDIS_SEG2 0x00010200 ++#define OID_NDIS_SEG3 0x00020100 ++#define OID_NDIS_SEG4 0x01010100 ++#define OID_NDIS_SEG5 0x01020100 ++#define OID_NDIS_SEG6 0x01020200 ++#define OID_NDIS_SEG7 0xFD010100 ++#define OID_NDIS_SEG8 0x0D010100 ++#define OID_NDIS_SEG9 0x0D010200 ++#define OID_NDIS_SEG10 0x0D020200 ++ ++#define SZ_OID_NDIS_SEG1 23 ++#define SZ_OID_NDIS_SEG2 3 ++#define SZ_OID_NDIS_SEG3 6 ++#define SZ_OID_NDIS_SEG4 6 ++#define SZ_OID_NDIS_SEG5 4 ++#define SZ_OID_NDIS_SEG6 8 ++#define SZ_OID_NDIS_SEG7 7 ++#define SZ_OID_NDIS_SEG8 36 ++#define SZ_OID_NDIS_SEG9 24 ++#define SZ_OID_NDIS_SEG10 19 ++ ++/* For Realtek-defined OIDs */ ++#define OID_MP_SEG1 0xFF871100 ++#define OID_MP_SEG2 0xFF818000 ++ ++#define OID_MP_SEG3 0xFF818700 ++#define OID_MP_SEG4 0xFF011100 ++ ++enum oid_type { ++ QUERY_OID, ++ SET_OID ++}; ++ ++struct oid_funs_node { ++ unsigned int oid_start; /* the starting number for OID */ ++ unsigned int oid_end; /* the ending number for OID */ ++ struct oid_obj_priv *node_array; ++ unsigned int array_sz; /* the size of node_array */ ++ int query_counter; /* count the number of query hits for this segment */ ++ int set_counter; /* count the number of set hits for this segment */ ++}; ++ ++struct oid_par_priv { ++ void *adapter_context; ++ NDIS_OID oid; ++ void *information_buf; ++ u32 information_buf_len; ++ u32 *bytes_rw; ++ u32 *bytes_needed; ++ enum oid_type type_of_oid; ++ u32 dbg; ++}; ++ ++struct oid_obj_priv { ++ unsigned char dbg; /* 0: without OID debug message 1: with OID debug message */ ++ NDIS_STATUS(*oidfuns)(struct oid_par_priv *poid_par_priv); ++}; ++ ++#if (defined(CONFIG_MP_INCLUDED) && defined(_RTW_MP_IOCTL_C_)) || \ ++ (defined(PLATFORM_WINDOWS) && defined(_RTW_IOCTL_RTL_C_)) ++static NDIS_STATUS oid_null_function(struct oid_par_priv *poid_par_priv) ++{ ++ return NDIS_STATUS_SUCCESS; ++} ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ ++int TranslateNdisPsToRtPs(IN NDIS_802_11_POWER_MODE ndisPsMode); ++ ++/* OID Handler for Segment 1 */ ++NDIS_STATUS oid_gen_supported_list_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_hardware_status_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_media_supported_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_media_in_use_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_maximum_lookahead_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_maximum_frame_size_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_link_speed_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_transmit_buffer_space_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_receive_buffer_space_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_transmit_block_size_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_receive_block_size_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_vendor_id_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_vendor_description_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_current_packet_filter_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_current_lookahead_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_driver_version_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_maximum_total_size_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_protocol_options_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_mac_options_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_media_connect_status_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_maximum_send_packets_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_vendor_driver_version_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++/* OID Handler for Segment 2 */ ++NDIS_STATUS oid_gen_physical_medium_hdl(struct oid_par_priv *poid_par_priv); ++ ++/* OID Handler for Segment 3 */ ++NDIS_STATUS oid_gen_xmit_ok_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_rcv_ok_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_xmit_error_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_rcv_error_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_gen_rcv_no_buffer_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++/* OID Handler for Segment 4 */ ++NDIS_STATUS oid_802_3_permanent_address_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_3_current_address_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_3_multicast_list_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_3_maximum_list_size_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_3_mac_options_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++ ++/* OID Handler for Segment 5 */ ++NDIS_STATUS oid_802_3_rcv_error_alignment_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_3_xmit_one_collision_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_3_xmit_more_collisions_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++/* OID Handler for Segment 6 */ ++NDIS_STATUS oid_802_3_xmit_deferred_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_3_xmit_max_collisions_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_3_rcv_overrun_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_3_xmit_underrun_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_3_xmit_heartbeat_failure_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_3_xmit_times_crs_lost_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_3_xmit_late_collisions_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++ ++/* OID Handler for Segment 7 */ ++NDIS_STATUS oid_pnp_capabilities_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_pnp_set_power_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_pnp_query_power_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_pnp_add_wake_up_pattern_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_pnp_remove_wake_up_pattern_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_pnp_wake_up_pattern_list_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_pnp_enable_wake_up_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++ ++/* OID Handler for Segment 8 */ ++NDIS_STATUS oid_802_11_bssid_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_ssid_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_infrastructure_mode_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_add_wep_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_remove_wep_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_disassociate_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_authentication_mode_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_privacy_filter_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_bssid_list_scan_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_encryption_status_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_reload_defaults_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_add_key_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_remove_key_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_association_information_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_test_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_media_stream_mode_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_capability_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_pmkid_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++ ++ ++ ++/* OID Handler for Segment 9 */ ++NDIS_STATUS oid_802_11_network_types_supported_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_network_type_in_use_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_tx_power_level_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_rssi_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_rssi_trigger_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_fragmentation_threshold_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_rts_threshold_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_number_of_antennas_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_rx_antenna_selected_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_tx_antenna_selected_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_supported_rates_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_desired_rates_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_configuration_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_power_mode_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_802_11_bssid_list_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++/* OID Handler for Segment 10 */ ++NDIS_STATUS oid_802_11_statistics_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++/* OID Handler for Segment ED */ ++NDIS_STATUS oid_rt_mh_vender_id_hdl(struct oid_par_priv *poid_par_priv); ++ ++void Set_802_3_MULTICAST_LIST(ADAPTER *pAdapter, UCHAR *MCListbuf, ULONG MCListlen, BOOLEAN bAcceptAllMulticast); ++ ++#endif/* end of PLATFORM_WINDOWS */ ++ ++#if defined(PLATFORM_LINUX) && defined(CONFIG_WIRELESS_EXT) ++extern struct iw_handler_def rtw_handlers_def; ++#endif ++ ++extern void rtw_request_wps_pbc_event(_adapter *padapter); ++ ++extern NDIS_STATUS drv_query_info( ++ IN _nic_hdl MiniportAdapterContext, ++ IN NDIS_OID Oid, ++ IN void *InformationBuffer, ++ IN u32 InformationBufferLength, ++ OUT u32 *BytesWritten, ++ OUT u32 *BytesNeeded ++); ++ ++extern NDIS_STATUS drv_set_info( ++ IN _nic_hdl MiniportAdapterContext, ++ IN NDIS_OID Oid, ++ IN void *InformationBuffer, ++ IN u32 InformationBufferLength, ++ OUT u32 *BytesRead, ++ OUT u32 *BytesNeeded ++); ++ ++#endif /* #ifndef __INC_CEINFO_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl_query.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl_query.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl_query.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl_query.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,30 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTW_IOCTL_QUERY_H_ ++#define _RTW_IOCTL_QUERY_H_ ++ ++ ++#ifdef PLATFORM_WINDOWS ++u8 query_802_11_capability(_adapter *padapter, u8 *pucBuf, u32 *pulOutLen); ++u8 query_802_11_association_information(_adapter *padapter, PNDIS_802_11_ASSOCIATION_INFORMATION pAssocInfo); ++#endif ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl_rtl.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl_rtl.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl_rtl.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl_rtl.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,80 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTW_IOCTL_RTL_H_ ++#define _RTW_IOCTL_RTL_H_ ++ ++ ++/* ************** oid_rtl_seg_01_01 ************** */ ++NDIS_STATUS oid_rt_get_signal_quality_hdl(struct oid_par_priv *poid_par_priv);/* 84 */ ++NDIS_STATUS oid_rt_get_small_packet_crc_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_middle_packet_crc_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_large_packet_crc_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_tx_retry_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_rx_retry_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_rx_total_packet_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_tx_beacon_ok_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_tx_beacon_err_hdl(struct oid_par_priv *poid_par_priv); ++ ++NDIS_STATUS oid_rt_pro_set_fw_dig_state_hdl(struct oid_par_priv *poid_par_priv); /* 8a */ ++NDIS_STATUS oid_rt_pro_set_fw_ra_state_hdl(struct oid_par_priv *poid_par_priv); /* 8b */ ++ ++NDIS_STATUS oid_rt_get_rx_icv_err_hdl(struct oid_par_priv *poid_par_priv);/* 93 */ ++NDIS_STATUS oid_rt_set_encryption_algorithm_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_preamble_mode_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_ap_ip_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_channelplan_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_set_channelplan_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_set_preamble_mode_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_set_bcn_intvl_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_dedicate_probe_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_total_tx_bytes_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_total_rx_bytes_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_current_tx_power_level_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_enc_key_mismatch_count_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_enc_key_match_count_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_channel_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_hardware_radio_off_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_key_mismatch_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_supported_wireless_mode_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_channel_list_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_scan_in_progress_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_forced_data_rate_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_wireless_mode_for_scan_list_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_bss_wireless_mode_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_scan_with_magic_packet_hdl(struct oid_par_priv *poid_par_priv); ++ ++/* ************** oid_rtl_seg_01_03 section start ************** */ ++NDIS_STATUS oid_rt_ap_get_associated_station_list_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_ap_switch_into_ap_mode_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_ap_supported_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_ap_set_passphrase_hdl(struct oid_par_priv *poid_par_priv); ++ ++/* oid_rtl_seg_01_11 */ ++NDIS_STATUS oid_rt_pro_rf_write_registry_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_rf_read_registry_hdl(struct oid_par_priv *poid_par_priv); ++ ++/* ************** oid_rtl_seg_03_00 section start ************** */ ++NDIS_STATUS oid_rt_get_connect_state_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_set_default_key_id_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl_set.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl_set.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl_set.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl_set.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,75 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_IOCTL_SET_H_ ++#define __RTW_IOCTL_SET_H_ ++ ++ ++typedef u8 NDIS_802_11_PMKID_VALUE[16]; ++ ++typedef struct _BSSIDInfo { ++ NDIS_802_11_MAC_ADDRESS BSSID; ++ NDIS_802_11_PMKID_VALUE PMKID; ++} BSSIDInfo, *PBSSIDInfo; ++ ++ ++#ifdef PLATFORM_OS_XP ++typedef struct _NDIS_802_11_PMKID { ++ u32 Length; ++ u32 BSSIDInfoCount; ++ BSSIDInfo BSSIDInfo[1]; ++} NDIS_802_11_PMKID, *PNDIS_802_11_PMKID; ++#endif ++ ++ ++#ifdef PLATFORM_WINDOWS ++u8 rtw_set_802_11_reload_defaults(_adapter *padapter, NDIS_802_11_RELOAD_DEFAULTS reloadDefaults); ++u8 rtw_set_802_11_test(_adapter *padapter, NDIS_802_11_TEST *test); ++u8 rtw_set_802_11_pmkid(_adapter *pdapter, NDIS_802_11_PMKID *pmkid); ++ ++u8 rtw_pnp_set_power_sleep(_adapter *padapter); ++u8 rtw_pnp_set_power_wakeup(_adapter *padapter); ++ ++void rtw_pnp_resume_wk(void *context); ++void rtw_pnp_sleep_wk(void *context); ++ ++#endif ++ ++u8 rtw_set_802_11_add_key(_adapter *padapter, NDIS_802_11_KEY *key); ++u8 rtw_set_802_11_authentication_mode(_adapter *pdapter, NDIS_802_11_AUTHENTICATION_MODE authmode); ++u8 rtw_set_802_11_bssid(_adapter *padapter, u8 *bssid); ++u8 rtw_set_802_11_add_wep(_adapter *padapter, NDIS_802_11_WEP *wep); ++u8 rtw_set_802_11_disassociate(_adapter *padapter); ++u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, NDIS_802_11_SSID *pssid, int ssid_max_num, struct rtw_ieee80211_channel *ch, int ch_num); ++u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype); ++u8 rtw_set_802_11_remove_wep(_adapter *padapter, u32 keyindex); ++u8 rtw_set_802_11_ssid(_adapter *padapter, NDIS_802_11_SSID *ssid); ++u8 rtw_set_802_11_connect(_adapter *padapter, u8 *bssid, NDIS_802_11_SSID *ssid); ++u8 rtw_set_802_11_remove_key(_adapter *padapter, NDIS_802_11_REMOVE_KEY *key); ++ ++u8 rtw_validate_bssid(u8 *bssid); ++u8 rtw_validate_ssid(NDIS_802_11_SSID *ssid); ++ ++u16 rtw_get_cur_max_rate(_adapter *adapter); ++int rtw_set_scan_mode(_adapter *adapter, RT_SCAN_TYPE scan_mode); ++int rtw_set_channel_plan(_adapter *adapter, u8 channel_plan); ++int rtw_set_country(_adapter *adapter, const char *country_code); ++int rtw_set_band(_adapter *adapter, u8 band); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_io.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_io.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_io.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_io.h 2018-02-11 21:44:27.171146452 +0200 +@@ -0,0 +1,576 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef _RTW_IO_H_ ++#define _RTW_IO_H_ ++ ++#define NUM_IOREQ 8 ++ ++#ifdef PLATFORM_WINDOWS ++ #define MAX_PROT_SZ 64 ++#endif ++#ifdef PLATFORM_LINUX ++ #define MAX_PROT_SZ (64-16) ++#endif ++ ++#define _IOREADY 0 ++#define _IO_WAIT_COMPLETE 1 ++#define _IO_WAIT_RSP 2 ++ ++/* IO COMMAND TYPE */ ++#define _IOSZ_MASK_ (0x7F) ++#define _IO_WRITE_ BIT(7) ++#define _IO_FIXED_ BIT(8) ++#define _IO_BURST_ BIT(9) ++#define _IO_BYTE_ BIT(10) ++#define _IO_HW_ BIT(11) ++#define _IO_WORD_ BIT(12) ++#define _IO_SYNC_ BIT(13) ++#define _IO_CMDMASK_ (0x1F80) ++ ++ ++/* ++ For prompt mode accessing, caller shall free io_req ++ Otherwise, io_handler will free io_req ++*/ ++ ++ ++ ++/* IO STATUS TYPE */ ++#define _IO_ERR_ BIT(2) ++#define _IO_SUCCESS_ BIT(1) ++#define _IO_DONE_ BIT(0) ++ ++ ++#define IO_RD32 (_IO_SYNC_ | _IO_WORD_) ++#define IO_RD16 (_IO_SYNC_ | _IO_HW_) ++#define IO_RD8 (_IO_SYNC_ | _IO_BYTE_) ++ ++#define IO_RD32_ASYNC (_IO_WORD_) ++#define IO_RD16_ASYNC (_IO_HW_) ++#define IO_RD8_ASYNC (_IO_BYTE_) ++ ++#define IO_WR32 (_IO_WRITE_ | _IO_SYNC_ | _IO_WORD_) ++#define IO_WR16 (_IO_WRITE_ | _IO_SYNC_ | _IO_HW_) ++#define IO_WR8 (_IO_WRITE_ | _IO_SYNC_ | _IO_BYTE_) ++ ++#define IO_WR32_ASYNC (_IO_WRITE_ | _IO_WORD_) ++#define IO_WR16_ASYNC (_IO_WRITE_ | _IO_HW_) ++#define IO_WR8_ASYNC (_IO_WRITE_ | _IO_BYTE_) ++ ++/* ++ ++ Only Sync. burst accessing is provided. ++ ++*/ ++ ++#define IO_WR_BURST(x) (_IO_WRITE_ | _IO_SYNC_ | _IO_BURST_ | ((x) & _IOSZ_MASK_)) ++#define IO_RD_BURST(x) (_IO_SYNC_ | _IO_BURST_ | ((x) & _IOSZ_MASK_)) ++ ++ ++ ++/* below is for the intf_option bit defition... */ ++ ++#define _INTF_ASYNC_ BIT(0) /* support async io */ ++ ++struct intf_priv; ++struct intf_hdl; ++struct io_queue; ++ ++struct _io_ops { ++ u8(*_read8)(struct intf_hdl *pintfhdl, u32 addr); ++ u16(*_read16)(struct intf_hdl *pintfhdl, u32 addr); ++ u32(*_read32)(struct intf_hdl *pintfhdl, u32 addr); ++ ++ int (*_write8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); ++ int (*_write16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); ++ int (*_write32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); ++ int (*_writeN)(struct intf_hdl *pintfhdl, u32 addr, u32 length, u8 *pdata); ++ ++ int (*_write8_async)(struct intf_hdl *pintfhdl, u32 addr, u8 val); ++ int (*_write16_async)(struct intf_hdl *pintfhdl, u32 addr, u16 val); ++ int (*_write32_async)(struct intf_hdl *pintfhdl, u32 addr, u32 val); ++ ++ void (*_read_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); ++ void (*_write_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); ++ ++ void (*_sync_irp_protocol_rw)(struct io_queue *pio_q); ++ ++ u32(*_read_interrupt)(struct intf_hdl *pintfhdl, u32 addr); ++ ++ u32(*_read_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); ++ u32(*_write_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); ++ ++ u32(*_write_scsi)(struct intf_hdl *pintfhdl, u32 cnt, u8 *pmem); ++ ++ void (*_read_port_cancel)(struct intf_hdl *pintfhdl); ++ void (*_write_port_cancel)(struct intf_hdl *pintfhdl); ++ ++#ifdef CONFIG_SDIO_HCI ++ u8(*_sd_f0_read8)(struct intf_hdl *pintfhdl, u32 addr); ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++ u8(*_sd_iread8)(struct intf_hdl *pintfhdl, u32 addr); ++ u16(*_sd_iread16)(struct intf_hdl *pintfhdl, u32 addr); ++ u32(*_sd_iread32)(struct intf_hdl *pintfhdl, u32 addr); ++ int (*_sd_iwrite8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); ++ int (*_sd_iwrite16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); ++ int (*_sd_iwrite32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); ++#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ ++#endif ++ ++}; ++ ++struct io_req { ++ _list list; ++ u32 addr; ++ volatile u32 val; ++ u32 command; ++ u32 status; ++ u8 *pbuf; ++ _sema sema; ++ ++#ifdef PLATFORM_OS_CE ++#ifdef CONFIG_USB_HCI ++ /* URB handler for rtw_write_mem */ ++ USB_TRANSFER usb_transfer_write_mem; ++#endif ++#endif ++ ++ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt); ++ u8 *cnxt; ++ ++#ifdef PLATFORM_OS_XP ++ PMDL pmdl; ++ PIRP pirp; ++ ++#ifdef CONFIG_SDIO_HCI ++ PSDBUS_REQUEST_PACKET sdrp; ++#endif ++ ++#endif ++ ++ ++}; ++ ++struct intf_hdl { ++ ++#if 0 ++ u32 intf_option; ++ u32 bus_status; ++ u32 do_flush; ++ u8 *adapter; ++ u8 *intf_dev; ++ struct intf_priv *pintfpriv; ++ u8 cnt; ++ void (*intf_hdl_init)(u8 *priv); ++ void (*intf_hdl_unload)(u8 *priv); ++ void (*intf_hdl_open)(u8 *priv); ++ void (*intf_hdl_close)(u8 *priv); ++ struct _io_ops io_ops; ++ /* u8 intf_status;//moved to struct intf_priv */ ++ u16 len; ++ u16 done_len; ++#endif ++ _adapter *padapter; ++ struct dvobj_priv *pintf_dev;/* pointer to &(padapter->dvobjpriv); */ ++ ++ struct _io_ops io_ops; ++ ++}; ++ ++struct reg_protocol_rd { ++ ++#ifdef CONFIG_LITTLE_ENDIAN ++ ++ /* DW1 */ ++ u32 NumOfTrans:4; ++ u32 Reserved1:4; ++ u32 Reserved2:24; ++ /* DW2 */ ++ u32 ByteCount:7; ++ u32 WriteEnable:1; /* 0:read, 1:write */ ++ u32 FixOrContinuous:1; /* 0:continuous, 1: Fix */ ++ u32 BurstMode:1; ++ u32 Byte1Access:1; ++ u32 Byte2Access:1; ++ u32 Byte4Access:1; ++ u32 Reserved3:3; ++ u32 Reserved4:16; ++ /* DW3 */ ++ u32 BusAddress; ++ /* DW4 */ ++ /* u32 Value; */ ++#else ++ ++ ++ /* DW1 */ ++ u32 Reserved1:4; ++ u32 NumOfTrans:4; ++ ++ u32 Reserved2:24; ++ ++ /* DW2 */ ++ u32 WriteEnable:1; ++ u32 ByteCount:7; ++ ++ ++ u32 Reserved3:3; ++ u32 Byte4Access:1; ++ ++ u32 Byte2Access:1; ++ u32 Byte1Access:1; ++ u32 BurstMode:1; ++ u32 FixOrContinuous:1; ++ ++ u32 Reserved4:16; ++ ++ /* DW3 */ ++ u32 BusAddress; ++ ++ /* DW4 */ ++ /* u32 Value; */ ++ ++#endif ++ ++}; ++ ++ ++struct reg_protocol_wt { ++ ++ ++#ifdef CONFIG_LITTLE_ENDIAN ++ ++ /* DW1 */ ++ u32 NumOfTrans:4; ++ u32 Reserved1:4; ++ u32 Reserved2:24; ++ /* DW2 */ ++ u32 ByteCount:7; ++ u32 WriteEnable:1; /* 0:read, 1:write */ ++ u32 FixOrContinuous:1; /* 0:continuous, 1: Fix */ ++ u32 BurstMode:1; ++ u32 Byte1Access:1; ++ u32 Byte2Access:1; ++ u32 Byte4Access:1; ++ u32 Reserved3:3; ++ u32 Reserved4:16; ++ /* DW3 */ ++ u32 BusAddress; ++ /* DW4 */ ++ u32 Value; ++ ++#else ++ /* DW1 */ ++ u32 Reserved1:4; ++ u32 NumOfTrans:4; ++ ++ u32 Reserved2:24; ++ ++ /* DW2 */ ++ u32 WriteEnable:1; ++ u32 ByteCount:7; ++ ++ u32 Reserved3:3; ++ u32 Byte4Access:1; ++ ++ u32 Byte2Access:1; ++ u32 Byte1Access:1; ++ u32 BurstMode:1; ++ u32 FixOrContinuous:1; ++ ++ u32 Reserved4:16; ++ ++ /* DW3 */ ++ u32 BusAddress; ++ ++ /* DW4 */ ++ u32 Value; ++ ++#endif ++ ++}; ++#ifdef CONFIG_PCI_HCI ++#define MAX_CONTINUAL_IO_ERR 4 ++#endif ++ ++#ifdef CONFIG_USB_HCI ++#define MAX_CONTINUAL_IO_ERR 4 ++#endif ++ ++#ifdef CONFIG_SDIO_HCI ++#define SD_IO_TRY_CNT (8) ++#define MAX_CONTINUAL_IO_ERR SD_IO_TRY_CNT ++#endif ++ ++#ifdef CONFIG_GSPI_HCI ++#define SD_IO_TRY_CNT (8) ++#define MAX_CONTINUAL_IO_ERR SD_IO_TRY_CNT ++#endif ++ ++ ++int rtw_inc_and_chk_continual_io_error(struct dvobj_priv *dvobj); ++void rtw_reset_continual_io_error(struct dvobj_priv *dvobj); ++ ++/* ++Below is the data structure used by _io_handler ++ ++*/ ++ ++struct io_queue { ++ _lock lock; ++ _list free_ioreqs; ++ _list pending; /* The io_req list that will be served in the single protocol read/write. */ ++ _list processing; ++ u8 *free_ioreqs_buf; /* 4-byte aligned */ ++ u8 *pallocated_free_ioreqs_buf; ++ struct intf_hdl intf; ++}; ++ ++struct io_priv { ++ ++ _adapter *padapter; ++ ++ struct intf_hdl intf; ++ ++}; ++ ++extern uint ioreq_flush(_adapter *adapter, struct io_queue *ioqueue); ++extern void sync_ioreq_enqueue(struct io_req *preq, struct io_queue *ioqueue); ++extern uint sync_ioreq_flush(_adapter *adapter, struct io_queue *ioqueue); ++ ++ ++extern uint free_ioreq(struct io_req *preq, struct io_queue *pio_queue); ++extern struct io_req *alloc_ioreq(struct io_queue *pio_q); ++ ++extern uint register_intf_hdl(u8 *dev, struct intf_hdl *pintfhdl); ++extern void unregister_intf_hdl(struct intf_hdl *pintfhdl); ++ ++extern void _rtw_attrib_read(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); ++extern void _rtw_attrib_write(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); ++ ++extern u8 _rtw_read8(_adapter *adapter, u32 addr); ++extern u16 _rtw_read16(_adapter *adapter, u32 addr); ++extern u32 _rtw_read32(_adapter *adapter, u32 addr); ++extern void _rtw_read_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); ++extern void _rtw_read_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); ++extern void _rtw_read_port_cancel(_adapter *adapter); ++ ++ ++extern int _rtw_write8(_adapter *adapter, u32 addr, u8 val); ++extern int _rtw_write16(_adapter *adapter, u32 addr, u16 val); ++extern int _rtw_write32(_adapter *adapter, u32 addr, u32 val); ++extern int _rtw_writeN(_adapter *adapter, u32 addr, u32 length, u8 *pdata); ++ ++#ifdef CONFIG_SDIO_HCI ++u8 _rtw_sd_f0_read8(_adapter *adapter, u32 addr); ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++u8 _rtw_sd_iread8(_adapter *adapter, u32 addr); ++u16 _rtw_sd_iread16(_adapter *adapter, u32 addr); ++u32 _rtw_sd_iread32(_adapter *adapter, u32 addr); ++int _rtw_sd_iwrite8(_adapter *adapter, u32 addr, u8 val); ++int _rtw_sd_iwrite16(_adapter *adapter, u32 addr, u16 val); ++int _rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val); ++#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ ++#endif /* CONFIG_SDIO_HCI */ ++ ++extern int _rtw_write8_async(_adapter *adapter, u32 addr, u8 val); ++extern int _rtw_write16_async(_adapter *adapter, u32 addr, u16 val); ++extern int _rtw_write32_async(_adapter *adapter, u32 addr, u32 val); ++ ++extern void _rtw_write_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); ++extern u32 _rtw_write_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); ++u32 _rtw_write_port_and_wait(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem, int timeout_ms); ++extern void _rtw_write_port_cancel(_adapter *adapter); ++ ++#ifdef DBG_IO ++bool match_read_sniff_ranges(u32 addr, u16 len); ++bool match_write_sniff_ranges(u32 addr, u16 len); ++bool match_rf_read_sniff_ranges(u8 path, u32 addr, u32 mask); ++bool match_rf_write_sniff_ranges(u8 path, u32 addr, u32 mask); ++ ++extern u8 dbg_rtw_read8(_adapter *adapter, u32 addr, const char *caller, const int line); ++extern u16 dbg_rtw_read16(_adapter *adapter, u32 addr, const char *caller, const int line); ++extern u32 dbg_rtw_read32(_adapter *adapter, u32 addr, const char *caller, const int line); ++ ++extern int dbg_rtw_write8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line); ++extern int dbg_rtw_write16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line); ++extern int dbg_rtw_write32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line); ++extern int dbg_rtw_writeN(_adapter *adapter, u32 addr , u32 length , u8 *data, const char *caller, const int line); ++ ++#ifdef CONFIG_SDIO_HCI ++u8 dbg_rtw_sd_f0_read8(_adapter *adapter, u32 addr, const char *caller, const int line); ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++u8 dbg_rtw_sd_iread8(_adapter *adapter, u32 addr, const char *caller, const int line); ++u16 dbg_rtw_sd_iread16(_adapter *adapter, u32 addr, const char *caller, const int line); ++u32 dbg_rtw_sd_iread32(_adapter *adapter, u32 addr, const char *caller, const int line); ++int dbg_rtw_sd_iwrite8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line); ++int dbg_rtw_sd_iwrite16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line); ++int dbg_rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line); ++#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ ++#endif /* CONFIG_SDIO_HCI */ ++ ++#define rtw_read8(adapter, addr) dbg_rtw_read8((adapter), (addr), __FUNCTION__, __LINE__) ++#define rtw_read16(adapter, addr) dbg_rtw_read16((adapter), (addr), __FUNCTION__, __LINE__) ++#define rtw_read32(adapter, addr) dbg_rtw_read32((adapter), (addr), __FUNCTION__, __LINE__) ++#define rtw_read_mem(adapter, addr, cnt, mem) _rtw_read_mem((adapter), (addr), (cnt), (mem)) ++#define rtw_read_port(adapter, addr, cnt, mem) _rtw_read_port((adapter), (addr), (cnt), (mem)) ++#define rtw_read_port_cancel(adapter) _rtw_read_port_cancel((adapter)) ++ ++#define rtw_write8(adapter, addr, val) dbg_rtw_write8((adapter), (addr), (val), __FUNCTION__, __LINE__) ++#define rtw_write16(adapter, addr, val) dbg_rtw_write16((adapter), (addr), (val), __FUNCTION__, __LINE__) ++#define rtw_write32(adapter, addr, val) dbg_rtw_write32((adapter), (addr), (val), __FUNCTION__, __LINE__) ++#define rtw_writeN(adapter, addr, length, data) dbg_rtw_writeN((adapter), (addr), (length), (data), __FUNCTION__, __LINE__) ++ ++#define rtw_write8_async(adapter, addr, val) _rtw_write8_async((adapter), (addr), (val)) ++#define rtw_write16_async(adapter, addr, val) _rtw_write16_async((adapter), (addr), (val)) ++#define rtw_write32_async(adapter, addr, val) _rtw_write32_async((adapter), (addr), (val)) ++ ++#define rtw_write_mem(adapter, addr, cnt, mem) _rtw_write_mem((adapter), addr, cnt, mem) ++#define rtw_write_port(adapter, addr, cnt, mem) _rtw_write_port(adapter, addr, cnt, mem) ++#define rtw_write_port_and_wait(adapter, addr, cnt, mem, timeout_ms) _rtw_write_port_and_wait((adapter), (addr), (cnt), (mem), (timeout_ms)) ++#define rtw_write_port_cancel(adapter) _rtw_write_port_cancel(adapter) ++ ++#ifdef CONFIG_SDIO_HCI ++#define rtw_sd_f0_read8(adapter, addr) dbg_rtw_sd_f0_read8((adapter), (addr), __func__, __LINE__) ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++#define rtw_sd_iread8(adapter, addr) dbg_rtw_sd_iread8((adapter), (addr), __func__, __LINE__) ++#define rtw_sd_iread16(adapter, addr) dbg_rtw_sd_iread16((adapter), (addr), __func__, __LINE__) ++#define rtw_sd_iread32(adapter, addr) dbg_rtw_sd_iread32((adapter), (addr), __func__, __LINE__) ++#define rtw_sd_iwrite8(adapter, addr, val) dbg_rtw_sd_iwrite8((adapter), (addr), (val), __func__, __LINE__) ++#define rtw_sd_iwrite16(adapter, addr, val) dbg_rtw_sd_iwrite16((adapter), (addr), (val), __func__, __LINE__) ++#define rtw_sd_iwrite32(adapter, addr, val) dbg_rtw_sd_iwrite32((adapter), (addr), (val), __func__, __LINE__) ++#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ ++#endif /* CONFIG_SDIO_HCI */ ++ ++#else /* DBG_IO */ ++#define match_read_sniff_ranges(addr, len) _FALSE ++#define match_write_sniff_ranges(addr, len) _FALSE ++#define match_rf_read_sniff_ranges(path, addr, mask) _FALSE ++#define match_rf_write_sniff_ranges(path, addr, mask) _FALSE ++#define rtw_read8(adapter, addr) _rtw_read8((adapter), (addr)) ++#define rtw_read16(adapter, addr) _rtw_read16((adapter), (addr)) ++#define rtw_read32(adapter, addr) _rtw_read32((adapter), (addr)) ++#define rtw_read_mem(adapter, addr, cnt, mem) _rtw_read_mem((adapter), (addr), (cnt), (mem)) ++#define rtw_read_port(adapter, addr, cnt, mem) _rtw_read_port((adapter), (addr), (cnt), (mem)) ++#define rtw_read_port_cancel(adapter) _rtw_read_port_cancel((adapter)) ++ ++#define rtw_write8(adapter, addr, val) _rtw_write8((adapter), (addr), (val)) ++#define rtw_write16(adapter, addr, val) _rtw_write16((adapter), (addr), (val)) ++#define rtw_write32(adapter, addr, val) _rtw_write32((adapter), (addr), (val)) ++#define rtw_writeN(adapter, addr, length, data) _rtw_writeN((adapter), (addr), (length), (data)) ++ ++#define rtw_write8_async(adapter, addr, val) _rtw_write8_async((adapter), (addr), (val)) ++#define rtw_write16_async(adapter, addr, val) _rtw_write16_async((adapter), (addr), (val)) ++#define rtw_write32_async(adapter, addr, val) _rtw_write32_async((adapter), (addr), (val)) ++ ++#define rtw_write_mem(adapter, addr, cnt, mem) _rtw_write_mem((adapter), (addr), (cnt), (mem)) ++#define rtw_write_port(adapter, addr, cnt, mem) _rtw_write_port((adapter), (addr), (cnt), (mem)) ++#define rtw_write_port_and_wait(adapter, addr, cnt, mem, timeout_ms) _rtw_write_port_and_wait((adapter), (addr), (cnt), (mem), (timeout_ms)) ++#define rtw_write_port_cancel(adapter) _rtw_write_port_cancel((adapter)) ++ ++#ifdef CONFIG_SDIO_HCI ++#define rtw_sd_f0_read8(adapter, addr) _rtw_sd_f0_read8((adapter), (addr)) ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++#define rtw_sd_iread8(adapter, addr) _rtw_sd_iread8((adapter), (addr)) ++#define rtw_sd_iread16(adapter, addr) _rtw_sd_iread16((adapter), (addr)) ++#define rtw_sd_iread32(adapter, addr) _rtw_sd_iread32((adapter), (addr)) ++#define rtw_sd_iwrite8(adapter, addr, val) _rtw_sd_iwrite8((adapter), (addr), (val)) ++#define rtw_sd_iwrite16(adapter, addr, val) _rtw_sd_iwrite16((adapter), (addr), (val)) ++#define rtw_sd_iwrite32(adapter, addr, val) _rtw_sd_iwrite32((adapter), (addr), (val)) ++#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ ++#endif /* CONFIG_SDIO_HCI */ ++ ++#endif /* DBG_IO */ ++ ++extern void rtw_write_scsi(_adapter *adapter, u32 cnt, u8 *pmem); ++ ++/* ioreq */ ++extern void ioreq_read8(_adapter *adapter, u32 addr, u8 *pval); ++extern void ioreq_read16(_adapter *adapter, u32 addr, u16 *pval); ++extern void ioreq_read32(_adapter *adapter, u32 addr, u32 *pval); ++extern void ioreq_write8(_adapter *adapter, u32 addr, u8 val); ++extern void ioreq_write16(_adapter *adapter, u32 addr, u16 val); ++extern void ioreq_write32(_adapter *adapter, u32 addr, u32 val); ++ ++ ++extern uint async_read8(_adapter *adapter, u32 addr, u8 *pbuff, ++ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); ++extern uint async_read16(_adapter *adapter, u32 addr, u8 *pbuff, ++ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); ++extern uint async_read32(_adapter *adapter, u32 addr, u8 *pbuff, ++ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); ++ ++extern void async_read_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); ++extern void async_read_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); ++ ++extern void async_write8(_adapter *adapter, u32 addr, u8 val, ++ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); ++extern void async_write16(_adapter *adapter, u32 addr, u16 val, ++ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); ++extern void async_write32(_adapter *adapter, u32 addr, u32 val, ++ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); ++ ++extern void async_write_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); ++extern void async_write_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); ++ ++ ++int rtw_init_io_priv(_adapter *padapter, void (*set_intf_ops)(_adapter *padapter, struct _io_ops *pops)); ++ ++ ++extern uint alloc_io_queue(_adapter *adapter); ++extern void free_io_queue(_adapter *adapter); ++extern void async_bus_io(struct io_queue *pio_q); ++extern void bus_sync_io(struct io_queue *pio_q); ++extern u32 _ioreq2rwmem(struct io_queue *pio_q); ++extern void dev_power_down(_adapter *Adapter, u8 bpwrup); ++ ++/* ++#define RTL_R8(reg) rtw_read8(padapter, reg) ++#define RTL_R16(reg) rtw_read16(padapter, reg) ++#define RTL_R32(reg) rtw_read32(padapter, reg) ++#define RTL_W8(reg, val8) rtw_write8(padapter, reg, val8) ++#define RTL_W16(reg, val16) rtw_write16(padapter, reg, val16) ++#define RTL_W32(reg, val32) rtw_write32(padapter, reg, val32) ++*/ ++ ++/* ++#define RTL_W8_ASYNC(reg, val8) rtw_write32_async(padapter, reg, val8) ++#define RTL_W16_ASYNC(reg, val16) rtw_write32_async(padapter, reg, val16) ++#define RTL_W32_ASYNC(reg, val32) rtw_write32_async(padapter, reg, val32) ++ ++#define RTL_WRITE_BB(reg, val32) phy_SetUsbBBReg(padapter, reg, val32) ++#define RTL_READ_BB(reg) phy_QueryUsbBBReg(padapter, reg) ++*/ ++ ++#define PlatformEFIOWrite1Byte(_a, _b, _c) \ ++ rtw_write8(_a, _b, _c) ++#define PlatformEFIOWrite2Byte(_a, _b, _c) \ ++ rtw_write16(_a, _b, _c) ++#define PlatformEFIOWrite4Byte(_a, _b, _c) \ ++ rtw_write32(_a, _b, _c) ++ ++#define PlatformEFIORead1Byte(_a, _b) \ ++ rtw_read8(_a, _b) ++#define PlatformEFIORead2Byte(_a, _b) \ ++ rtw_read16(_a, _b) ++#define PlatformEFIORead4Byte(_a, _b) \ ++ rtw_read32(_a, _b) ++ ++#endif /* _RTL8711_IO_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_iol.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_iol.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_iol.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_iol.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,136 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_IOL_H_ ++#define __RTW_IOL_H_ ++ ++ ++struct xmit_frame *rtw_IOL_accquire_xmit_frame(ADAPTER *adapter); ++int rtw_IOL_append_cmds(struct xmit_frame *xmit_frame, u8 *IOL_cmds, u32 cmd_len); ++int rtw_IOL_append_LLT_cmd(struct xmit_frame *xmit_frame, u8 page_boundary); ++int rtw_IOL_exec_cmds_sync(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt); ++bool rtw_IOL_applied(ADAPTER *adapter); ++int rtw_IOL_append_DELAY_US_cmd(struct xmit_frame *xmit_frame, u16 us); ++int rtw_IOL_append_DELAY_MS_cmd(struct xmit_frame *xmit_frame, u16 ms); ++int rtw_IOL_append_END_cmd(struct xmit_frame *xmit_frame); ++ ++ ++#ifdef CONFIG_IOL_NEW_GENERATION ++#define IOREG_CMD_END_LEN 4 ++ ++struct ioreg_cfg { ++ u8 length; ++ u8 cmd_id; ++ u16 address; ++ u32 data; ++ u32 mask; ++}; ++enum ioreg_cmd { ++ IOREG_CMD_LLT = 0x01, ++ IOREG_CMD_REFUSE = 0x02, ++ IOREG_CMD_EFUSE_PATH = 0x03, ++ IOREG_CMD_WB_REG = 0x04, ++ IOREG_CMD_WW_REG = 0x05, ++ IOREG_CMD_WD_REG = 0x06, ++ IOREG_CMD_W_RF = 0x07, ++ IOREG_CMD_DELAY_US = 0x10, ++ IOREG_CMD_DELAY_MS = 0x11, ++ IOREG_CMD_END = 0xFF, ++}; ++void read_efuse_from_txpktbuf(ADAPTER *adapter, int bcnhead, u8 *content, u16 *size); ++ ++int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, u8 mask); ++int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, u16 mask); ++int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, u32 mask); ++int _rtw_IOL_append_WRF_cmd(struct xmit_frame *xmit_frame, u8 rf_path, u16 addr, u32 value, u32 mask); ++#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value, mask) _rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value), (mask)) ++#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value, mask) _rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value), (mask)) ++#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value, mask) _rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value), (mask)) ++#define rtw_IOL_append_WRF_cmd(xmit_frame, rf_path, addr, value, mask) _rtw_IOL_append_WRF_cmd((xmit_frame), (rf_path), (addr), (value), (mask)) ++ ++u8 rtw_IOL_cmd_boundary_handle(struct xmit_frame *pxmit_frame); ++void rtw_IOL_cmd_buf_dump(ADAPTER *Adapter, int buf_len, u8 *pbuf); ++ ++#ifdef CONFIG_IOL_IOREG_CFG_DBG ++struct cmd_cmp { ++ u16 addr; ++ u32 value; ++}; ++#endif ++ ++#else /* CONFIG_IOL_NEW_GENERATION */ ++ ++typedef struct _io_offload_cmd { ++ u8 rsvd0; ++ u8 cmd; ++ u16 address; ++ u32 value; ++} IO_OFFLOAD_CMD, IOL_CMD; ++ ++#define IOL_CMD_LLT 0x00 ++/* #define IOL_CMD_R_EFUSE 0x01 */ ++#define IOL_CMD_WB_REG 0x02 ++#define IOL_CMD_WW_REG 0x03 ++#define IOL_CMD_WD_REG 0x04 ++/* #define IOL_CMD_W_RF 0x05 */ ++#define IOL_CMD_DELAY_US 0x80 ++#define IOL_CMD_DELAY_MS 0x81 ++/* #define IOL_CMD_DELAY_S 0x82 */ ++#define IOL_CMD_END 0x83 ++ ++/***************************************************** ++CMD Address Value ++(B1) (B2/B3:H/L addr) (B4:B7 : MSB:LSB) ++****************************************************** ++IOL_CMD_LLT - B7: PGBNDY ++IOL_CMD_R_EFUSE - - ++IOL_CMD_WB_REG 0x0~0xFFFF B7 ++IOL_CMD_WW_REG 0x0~0xFFFF B6~B7 ++IOL_CMD_WD_REG 0x0~0xFFFF B4~B7 ++IOL_CMD_W_RF RF Reg B5~B7 ++IOL_CMD_DELAY_US - B6~B7 ++IOL_CMD_DELAY_MS - B6~B7 ++IOL_CMD_DELAY_S - B6~B7 ++IOL_CMD_END - - ++******************************************************/ ++int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value); ++int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value); ++int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value); ++ ++ ++int rtw_IOL_exec_cmd_array_sync(PADAPTER adapter, u8 *IOL_cmds, u32 cmd_num, u32 max_wating_ms); ++int rtw_IOL_exec_empty_cmds_sync(ADAPTER *adapter, u32 max_wating_ms); ++ ++#ifdef DBG_IO ++int dbg_rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, const char *caller, const int line); ++int dbg_rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, const char *caller, const int line); ++int dbg_rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, const char *caller, const int line); ++#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) ++#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) ++#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) ++#else ++#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value) _rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value)) ++#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value) _rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value)) ++#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value) _rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value)) ++#endif /* DBG_IO */ ++#endif /* CONFIG_IOL_NEW_GENERATION */ ++ ++ ++ ++#endif /* __RTW_IOL_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mcc.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mcc.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mcc.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mcc.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,207 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2015 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ ******************************************************************************/ ++#ifdef CONFIG_MCC_MODE ++ ++#ifndef _RTW_MCC_H_ ++#define _RTW_MCC_H_ ++ ++#include /* PADAPTER */ ++ ++#define MCC_STATUS_PROCESS_MCC_START_SETTING BIT0 ++#define MCC_STATUS_PROCESS_MCC_STOP_SETTING BIT1 ++#define MCC_STATUS_NEED_MCC BIT2 ++#define MCC_STATUS_DOING_MCC BIT3 ++ ++ ++#define MCC_DURATION 35 /* ms */ ++#define MCC_SWCH_FW_EARLY_TIME 10 /* ms */ ++#define MCC_EXPIRE_TIME 50 /* ms */ ++#define MCC_TOLERANCE_TIME 2 /* 2*2 = 4s */ ++ ++#define MCC_ROLE_STA_GC_MGMT_QUEUE_MACID 0 ++#define MCC_ROLE_SOFTAP_GO_MGMT_QUEUE_MACID 1 ++ ++/* Lower for stop, Higher for start */ ++#define MCC_SETCMD_STATUS_STOP_DISCONNECT 0x0 ++#define MCC_SETCMD_STATUS_STOP_SCAN_START 0x1 ++#define MCC_SETCMD_STATUS_START_CONNECT 0x80 ++#define MCC_SETCMD_STATUS_START_SCAN_DONE 0x81 ++ ++/* ++* depenad platform or customer requirement(TP unit:Mbps), ++* must be provided by PM or sales or product document ++* too large value means not to limit tx bytes (current for ap mode) ++* NOTE: following values ref from test results ++*/ ++#define MCC_AP_BW20_TARGET_TX_TP (300) ++#define MCC_AP_BW40_TARGET_TX_TP (300) ++#define MCC_AP_BW80_TARGET_TX_TP (300) ++#define MCC_STA_BW20_TARGET_TX_TP (35) ++#define MCC_STA_BW40_TARGET_TX_TP (70) ++#define MCC_STA_BW80_TARGET_TX_TP (140) ++#define MCC_SINGLE_TX_CRITERIA 5 /* Mbps */ ++ ++#define MAX_MCC_NUM 2 ++ ++#define MCC_STOP(adapter) (adapter->mcc_adapterpriv.mcc_tx_stop) ++#define MCC_EN(adapter) (adapter->registrypriv.en_mcc) ++ ++/* Represent Channel Tx Null setting */ ++enum mcc_channel_tx_null { ++ MCC_ENABLE_TX_NULL = 0, ++ MCC_DISABLE_TX_NULL = 1, ++}; ++ ++/* Represent C2H Report setting */ ++enum mcc_c2h_report { ++ MCC_C2H_REPORT_DISABLE = 0, ++ MCC_C2H_REPORT_FAIL_STATUS = 1, ++ MCC_C2H_REPORT_ALL_STATUS = 2, ++}; ++ ++/* Represent Channel Scan */ ++enum mcc_channel_scan { ++ MCC_CHIDX = 0, ++ MCC_SCANCH_RSVD_LOC = 1, ++}; ++ ++/* Represent FW status report of channel switch */ ++enum mcc_status_rpt { ++ MCC_RPT_SUCCESS = 0, ++ MCC_RPT_TXNULL_FAIL = 1, ++ MCC_RPT_STOPMCC = 2, ++ MCC_RPT_READY = 3, ++ MCC_RPT_SWICH_CHANNEL_NOTIFY = 7, ++ MCC_RPT_MAX, ++}; ++ ++enum MCC_ROLE { ++ MCC_ROLE_STA = 0, ++ MCC_ROLE_AP = 1, ++ MCC_ROLE_GC = 2, ++ MCC_ROLE_GO = 3, ++ MCC_ROLE_MAX, ++}; ++ ++struct mcc_iqk_backup { ++ u16 TX_X; ++ u16 TX_Y; ++ u16 RX_X; ++ u16 RX_Y; ++}; ++ ++/* mcc data for adapter */ ++struct mcc_adapter_priv { ++ u8 order; /* FW document, softap/AP must be 0 */ ++ u8 role; /* MCC role(AP,STA,GO,GC) */ ++ u8 mcc_duration; /* channel stay period, UNIT:1TU */ ++ ++ /* flow control */ ++ u8 mcc_tx_stop; /* check if tp stop or not */ ++ u8 mcc_tp_limit; /* check if tp limit or not */ ++ u32 mcc_target_tx_bytes_to_port; /* customer require */ ++ u32 mcc_tx_bytes_to_port; /* already tx to tx fifo (write port) */ ++ ++ /* data from kernel to check if enqueue data or netif stop queue */ ++ u32 mcc_tp; ++ u64 mcc_tx_bytes_from_kernel; ++ u64 mcc_last_tx_bytes_from_kernel; ++ ++ /* Backup IQK value for MCC */ ++ struct mcc_iqk_backup mcc_iqk_arr[MAX_RF_PATH]; ++ ++ /* mgmt queue macid to avoid RA issue */ ++ u8 mgmt_queue_macid; ++ ++ /* set macid bitmap to let fw know which macid should be tx pause */ ++ /* all interface share total 16 macid */ ++ u16 mcc_macid_bitmap; ++}; ++ ++struct mcc_obj_priv { ++ u8 duration; /* channel stay period, UNIT:1TU */ ++ u8 mcc_c2h_status; ++ u8 cur_mcc_success_cnt; /* used for check mcc switch channel success */ ++ u8 prev_mcc_success_cnt; /* used for check mcc switch channel success */ ++ u8 mcc_tolerance_time; /* used for detect mcc switch channel success */ ++ u8 mcc_loc_rsvd_paga[MAX_MCC_NUM]; /* mcc rsvd page */ ++ u8 mcc_status; /* mcc status stop or start .... */ ++ u32 mcc_launch_time; /* mcc launch time, used for starting detect mcc switch channel success */ ++ _mutex mcc_mutex; ++ _lock mcc_lock; ++ PADAPTER iface[MAX_MCC_NUM]; /* by order, use for mcc parameter cmd */ ++ struct submit_ctx mcc_sctx; ++}; ++ ++/* backup IQK val */ ++void rtw_hal_mcc_backup_IQK_val(PADAPTER padapter); ++ ++/* check mcc status */ ++u8 rtw_hal_check_mcc_status(PADAPTER padapter, u8 mcc_status); ++ ++/* set mcc status */ ++void rtw_hal_set_mcc_status(PADAPTER padapter, u8 mcc_status); ++ ++/* clear mcc status */ ++void rtw_hal_clear_mcc_status(PADAPTER padapter, u8 mcc_status); ++ ++/* dl mcc rsvd page */ ++u8 rtw_hal_dl_mcc_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 *index ++ , u8 tx_desc, u32 page_size, u8 *page_num, u32 *total_pkt_len, RSVDPAGE_LOC *rsvd_page_loc); ++ ++/* handle C2H */ ++void rtw_hal_mcc_c2h_handler(PADAPTER padapter, u8 buflen, u8 *tmpBuf); ++ ++/* switch channel successfully or not */ ++void rtw_hal_mcc_sw_status_check(PADAPTER padapter); ++ ++/* change some scan flags under site survey */ ++u8 rtw_hal_mcc_change_scan_flag(PADAPTER padapter, u8 *ch, u8 *bw, u8 *offset); ++ ++/* record data kernel TX to driver to check MCC concurrent TX */ ++void rtw_hal_mcc_calc_tx_bytes_from_kernel(PADAPTER padapter, u32 len); ++ ++/* record data to port to let driver do flow ctrl */ ++void rtw_hal_mcc_calc_tx_bytes_to_port(PADAPTER padapter, u32 len); ++ ++/* check stop write port or not */ ++u8 rtw_hal_mcc_stop_tx_bytes_to_port(PADAPTER padapter); ++ ++u8 rtw_hal_set_mcc_setting_scan_start(PADAPTER padapter); ++ ++u8 rtw_hal_set_mcc_setting_scan_complete(PADAPTER padapter); ++ ++u8 rtw_hal_set_mcc_setting_start_bss_network(PADAPTER padapter, u8 chbw_grouped); ++ ++u8 rtw_hal_set_mcc_setting_disconnect(PADAPTER padapter); ++ ++u8 rtw_hal_set_mcc_setting_join_done_chk_ch(PADAPTER padapter); ++ ++u8 rtw_hal_set_mcc_setting_chk_start_clnt_join(PADAPTER padapter, u8 *ch, u8 *bw, u8 *offset, u8 chbw_allow); ++ ++void rtw_hal_dump_mcc_info(void *sel, struct dvobj_priv *dvobj); ++ ++void update_mcc_mgntframe_attrib(_adapter *padapter, struct pkt_attrib *pattrib); ++ ++u8 rtw_hal_mcc_link_status_chk(_adapter *padapter, const char *msg); ++ ++void rtw_hal_mcc_issue_null_data(_adapter *padapter, u8 chbw_allow, u8 ps_mode); ++ ++#endif /* _RTW_MCC_H_ */ ++#endif /* CONFIG_MCC_MODE */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mem.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mem.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mem.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mem.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,41 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_MEM_H__ ++#define __RTW_MEM_H__ ++ ++#include ++#include ++#include ++ ++#ifdef CONFIG_PLATFORM_MSTAR_HIGH ++ #define MAX_RTKM_RECVBUF_SZ (31744) /* 31k */ ++#else ++ #define MAX_RTKM_RECVBUF_SZ (15360) /* 15k */ ++#endif /* CONFIG_PLATFORM_MSTAR_HIGH */ ++#define MAX_RTKM_NR_PREALLOC_RECV_SKB 16 ++ ++u16 rtw_rtkm_get_buff_size(void); ++u8 rtw_rtkm_get_nr_recv_skb(void); ++struct u8 *rtw_alloc_revcbuf_premem(void); ++struct sk_buff *rtw_alloc_skb_premem(u16 in_size); ++int rtw_free_skb_premem(struct sk_buff *pskb); ++ ++ ++#endif /* __RTW_MEM_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mi.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mi.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mi.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mi.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,240 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_MI_H_ ++#define __RTW_MI_H_ ++ ++void rtw_mi_update_union_chan_inf(_adapter *adapter, u8 ch, u8 offset , u8 bw); ++int rtw_mi_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset); ++int rtw_mi_get_ch_setting_union_no_self(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset); ++ ++struct mi_state { ++ u8 sta_num; /*WIFI_FW_STATION_STATE*/ ++ u8 ld_sta_num; /*WIFI_FW_STATION_STATE |_FW_LINKED*/ ++ u8 lg_sta_num; /*WIFI_FW_STATION_STATE |_FW_UNDER_LINKING*/ ++ u8 ap_num; /*WIFI_FW_AP_STATE|_FW_LINKED*/ ++ u8 ld_ap_num; /*WIFI_FW_AP_STATE|_FW_LINKED && asoc_sta_count > 2*/ ++ u8 adhoc_num; /* WIFI_FW_ADHOC_STATE */ ++ u8 ld_adhoc_num; /* WIFI_FW_ADHOC_STATE && asoc_sta_count > 2 */ ++ u8 uwps_num; /*WIFI_UNDER_WPS*/ ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ #ifdef CONFIG_P2P ++ u8 roch_num; ++ #endif ++ u8 mgmt_tx_num; ++#endif ++ ++ u8 union_ch; ++ u8 union_bw; ++ u8 union_offset; ++}; ++ ++#define MSTATE_STA_NUM(_mstate) ((_mstate)->sta_num) ++#define MSTATE_STA_LD_NUM(_mstate) ((_mstate)->ld_sta_num) ++#define MSTATE_STA_LG_NUM(_mstate) ((_mstate)->lg_sta_num) ++#define MSTATE_AP_NUM(_mstate) ((_mstate)->ap_num) ++#define MSTATE_AP_LD_NUM(_mstate) ((_mstate)->ld_ap_num) ++#define MSTATE_ADHOC_NUM(_mstate) ((_mstate)->adhoc_num) ++#define MSTATE_ADHOC_LD_NUM(_mstate) ((_mstate)->ld_adhoc_num) ++#define MSTATE_WPS_NUM(_mstate) ((_mstate)->uwps_num) ++ ++#if defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_P2P) ++#define MSTATE_ROCH_NUM(_mstate) ((_mstate)->roch_num) ++#else ++#define MSTATE_ROCH_NUM(_mstate) 0 ++#endif ++ ++#if defined(CONFIG_IOCTL_CFG80211) ++#define MSTATE_MGMT_TX_NUM(_mstate) ((_mstate)->mgmt_tx_num) ++#else ++#define MSTATE_MGMT_TX_NUM(_mstate) 0 ++#endif ++ ++#define MSTATE_U_CH(_mstate) ((_mstate)->union_ch) ++#define MSTATE_U_BW(_mstate) ((_mstate)->union_bw) ++#define MSTATE_U_OFFSET(_mstate) ((_mstate)->union_offset) ++ ++#define rtw_mi_get_union_chan(adapter) adapter_to_dvobj(adapter)->iface_state.union_ch ++#define rtw_mi_get_union_bw(adapter) adapter_to_dvobj(adapter)->iface_state.union_bw ++#define rtw_mi_get_union_offset(adapter) adapter_to_dvobj(adapter)->iface_state.union_offset ++ ++#define rtw_mi_get_assoced_sta_num(adapter) DEV_STA_LD_NUM(adapter_to_dvobj(adapter)) ++#define rtw_mi_get_ap_num(adapter) DEV_AP_NUM(adapter_to_dvobj(adapter)) ++ ++/* For now, not return union_ch/bw/offset */ ++void rtw_mi_status(_adapter *adapter, struct mi_state *mstate); ++void rtw_mi_status_no_self(_adapter *adapter, struct mi_state *mstate); ++ ++void rtw_mi_update_iface_status(struct mlme_priv *pmlmepriv, sint state); ++ ++u8 rtw_mi_mp_mode_check(_adapter *padapter); ++ ++u8 rtw_mi_netif_stop_queue(_adapter *padapter, bool carrier_off); ++u8 rtw_mi_buddy_netif_stop_queue(_adapter *padapter, bool carrier_off); ++ ++u8 rtw_mi_netif_wake_queue(_adapter *padapter); ++u8 rtw_mi_buddy_netif_wake_queue(_adapter *padapter); ++ ++u8 rtw_mi_netif_carrier_on(_adapter *padapter); ++u8 rtw_mi_buddy_netif_carrier_on(_adapter *padapter); ++ ++void rtw_mi_scan_abort(_adapter *adapter, bool bwait); ++void rtw_mi_buddy_scan_abort(_adapter *adapter, bool bwait); ++void rtw_mi_start_drv_threads(_adapter *adapter); ++void rtw_mi_buddy_start_drv_threads(_adapter *adapter); ++void rtw_mi_stop_drv_threads(_adapter *adapter); ++void rtw_mi_buddy_stop_drv_threads(_adapter *adapter); ++void rtw_mi_cancel_all_timer(_adapter *adapter); ++void rtw_mi_buddy_cancel_all_timer(_adapter *adapter); ++void rtw_mi_reset_drv_sw(_adapter *adapter); ++void rtw_mi_buddy_reset_drv_sw(_adapter *adapter); ++ ++extern void rtw_intf_start(_adapter *adapter); ++extern void rtw_intf_stop(_adapter *adapter); ++void rtw_mi_intf_start(_adapter *adapter); ++void rtw_mi_buddy_intf_start(_adapter *adapter); ++void rtw_mi_intf_stop(_adapter *adapter); ++void rtw_mi_buddy_intf_stop(_adapter *adapter); ++ ++void rtw_mi_suspend_free_assoc_resource(_adapter *adapter); ++void rtw_mi_buddy_suspend_free_assoc_resource(_adapter *adapter); ++ ++#ifdef CONFIG_SET_SCAN_DENY_TIMER ++void rtw_mi_set_scan_deny(_adapter *adapter, u32 ms); ++void rtw_mi_buddy_set_scan_deny(_adapter *adapter, u32 ms); ++#else ++#define rtw_mi_set_scan_deny(adapter, ms) do {} while (0) ++#define rtw_mi_buddy_set_scan_deny(adapter, ms) do {} while (0) ++#endif ++ ++u8 rtw_mi_is_scan_deny(_adapter *adapter); ++u8 rtw_mi_buddy_is_scan_deny(_adapter *adapter); ++ ++u8 rtw_mi_issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); ++u8 rtw_mi_buddy_issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); ++ ++void rtw_mi_beacon_update(_adapter *padapter); ++void rtw_mi_buddy_beacon_update(_adapter *padapter); ++ ++void rtw_mi_hal_dump_macaddr(_adapter *padapter); ++void rtw_mi_buddy_hal_dump_macaddr(_adapter *padapter); ++ ++#ifdef CONFIG_PCI_HCI ++void rtw_mi_xmit_tasklet_schedule(_adapter *padapter); ++void rtw_mi_buddy_xmit_tasklet_schedule(_adapter *padapter); ++#endif ++ ++u8 rtw_mi_busy_traffic_check(_adapter *padapter, bool check_sc_interval); ++u8 rtw_mi_buddy_busy_traffic_check(_adapter *padapter, bool check_sc_interval); ++ ++u8 rtw_mi_check_mlmeinfo_state(_adapter *padapter, u32 state); ++u8 rtw_mi_buddy_check_mlmeinfo_state(_adapter *padapter, u32 state); ++ ++u8 rtw_mi_check_fwstate(_adapter *padapter, sint state); ++u8 rtw_mi_buddy_check_fwstate(_adapter *padapter, sint state); ++enum { ++ MI_LINKED, ++ MI_ASSOC, ++ MI_UNDER_WPS, ++ MI_AP_MODE, ++ MI_AP_ASSOC, ++ MI_ADHOC, ++ MI_ADHOC_ASSOC, ++ MI_STA_NOLINK, /* this is misleading, but not used now */ ++ MI_STA_LINKED, ++ MI_STA_LINKING, ++}; ++u8 rtw_mi_check_status(_adapter *adapter, u8 type); ++ ++void dump_dvobj_mi_status(void *sel, const char *fun_name, _adapter *adapter); ++#ifdef DBG_IFACE_STATUS ++#define DBG_IFACE_STATUS_DUMP(adapter) dump_dvobj_mi_status(RTW_DBGDUMP, __func__, adapter) ++#endif ++void dump_mi_status(void *sel, struct dvobj_priv *dvobj); ++ ++u8 rtw_mi_traffic_statistics(_adapter *padapter); ++u8 rtw_mi_check_miracast_enabled(_adapter *padapter); ++ ++#ifdef CONFIG_XMIT_THREAD_MODE ++u8 rtw_mi_check_pending_xmitbuf(_adapter *padapter); ++u8 rtw_mi_buddy_check_pending_xmitbuf(_adapter *padapter); ++#endif ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++#ifdef CONFIG_RTL8822B ++ #include ++#else ++ extern s32 _dequeue_writeport(PADAPTER padapter); ++#endif ++u8 rtw_mi_dequeue_writeport(_adapter *padapter); ++u8 rtw_mi_buddy_dequeue_writeport(_adapter *padapter); ++#endif ++ ++void rtw_mi_adapter_reset(_adapter *padapter); ++void rtw_mi_buddy_adapter_reset(_adapter *padapter); ++ ++u8 rtw_mi_dynamic_check_timer_handlder(_adapter *padapter); ++u8 rtw_mi_buddy_dynamic_check_timer_handlder(_adapter *padapter); ++ ++u8 rtw_mi_dev_unload(_adapter *padapter); ++u8 rtw_mi_buddy_dev_unload(_adapter *padapter); ++ ++extern void rtw_iface_dynamic_chk_wk_hdl(_adapter *padapter); ++u8 rtw_mi_dynamic_chk_wk_hdl(_adapter *padapter); ++u8 rtw_mi_buddy_dynamic_chk_wk_hdl(_adapter *padapter); ++ ++u8 rtw_mi_os_xmit_schedule(_adapter *padapter); ++u8 rtw_mi_buddy_os_xmit_schedule(_adapter *padapter); ++ ++u8 rtw_mi_report_survey_event(_adapter *padapter, union recv_frame *precv_frame); ++u8 rtw_mi_buddy_report_survey_event(_adapter *padapter, union recv_frame *precv_frame); ++ ++extern void sreset_start_adapter(_adapter *padapter); ++extern void sreset_stop_adapter(_adapter *padapter); ++u8 rtw_mi_sreset_adapter_hdl(_adapter *padapter, u8 bstart); ++u8 rtw_mi_buddy_sreset_adapter_hdl(_adapter *padapter, u8 bstart); ++ ++u8 rtw_mi_tx_beacon_hdl(_adapter *padapter); ++u8 rtw_mi_buddy_tx_beacon_hdl(_adapter *padapter); ++ ++u8 rtw_mi_set_tx_beacon_cmd(_adapter *padapter); ++u8 rtw_mi_buddy_set_tx_beacon_cmd(_adapter *padapter); ++ ++#ifdef CONFIG_P2P ++u8 rtw_mi_p2p_chk_state(_adapter *padapter, enum P2P_STATE p2p_state); ++u8 rtw_mi_buddy_p2p_chk_state(_adapter *padapter, enum P2P_STATE p2p_state); ++u8 rtw_mi_stay_in_p2p_mode(_adapter *padapter); ++u8 rtw_mi_buddy_stay_in_p2p_mode(_adapter *padapter); ++#endif ++ ++_adapter *rtw_get_iface_by_id(_adapter *padapter, u8 iface_id); ++_adapter *rtw_get_iface_by_macddr(_adapter *padapter, u8 *mac_addr); ++_adapter *rtw_get_iface_by_hwport(_adapter *padapter, u8 hw_port); ++ ++void rtw_mi_buddy_clone_bcmc_packet(_adapter *padapter, union recv_frame *precvframe, u8 *pphy_status); ++ ++#ifdef CONFIG_PCI_HCI ++/*API be create temporary for MI, caller is interrupt-handler, PCIE's interrupt handler cannot apply to multi-AP*/ ++_adapter *rtw_mi_get_ap_adapter(_adapter *padapter); ++#endif ++ ++void rtw_mi_update_ap_bmc_camid(_adapter *padapter, u8 camid_a, u8 camid_b); ++ ++#endif /*__RTW_MI_H_*/ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mlme_ext.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mlme_ext.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mlme_ext.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mlme_ext.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,1287 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_MLME_EXT_H_ ++#define __RTW_MLME_EXT_H_ ++ ++ ++/* Commented by Albert 20101105 ++ * Increase the SURVEY_TO value from 100 to 150 ( 100ms to 150ms ) ++ * The Realtek 8188CE SoftAP will spend around 100ms to send the probe response after receiving the probe request. ++ * So, this driver tried to extend the dwell time for each scanning channel. ++ * This will increase the chance to receive the probe response from SoftAP. */ ++ ++#define SURVEY_TO (100) ++#define REAUTH_TO (300) /* (50) */ ++#define REASSOC_TO (300) /* (50) */ ++/* #define DISCONNECT_TO (3000) */ ++#define ADDBA_TO (2000) ++ ++#define LINKED_TO (1) /* unit:2 sec, 1x2 = 2 sec */ ++ ++#define REAUTH_LIMIT (4) ++#define REASSOC_LIMIT (4) ++#define READDBA_LIMIT (2) ++ ++#ifdef CONFIG_GSPI_HCI ++ #define ROAMING_LIMIT 5 ++#else ++ #define ROAMING_LIMIT 8 ++#endif ++/* #define IOCMD_REG0 0x10250370 */ ++/* #define IOCMD_REG1 0x10250374 */ ++/* #define IOCMD_REG2 0x10250378 */ ++ ++/* #define FW_DYNAMIC_FUN_SWITCH 0x10250364 */ ++ ++/* #define WRITE_BB_CMD 0xF0000001 */ ++/* #define SET_CHANNEL_CMD 0xF3000000 */ ++/* #define UPDATE_RA_CMD 0xFD0000A2 */ ++ ++#define _HW_STATE_NOLINK_ 0x00 ++#define _HW_STATE_ADHOC_ 0x01 ++#define _HW_STATE_STATION_ 0x02 ++#define _HW_STATE_AP_ 0x03 ++#define _HW_STATE_MONITOR_ 0x04 ++ ++ ++#define _1M_RATE_ 0 ++#define _2M_RATE_ 1 ++#define _5M_RATE_ 2 ++#define _11M_RATE_ 3 ++#define _6M_RATE_ 4 ++#define _9M_RATE_ 5 ++#define _12M_RATE_ 6 ++#define _18M_RATE_ 7 ++#define _24M_RATE_ 8 ++#define _36M_RATE_ 9 ++#define _48M_RATE_ 10 ++#define _54M_RATE_ 11 ++ ++/******************************************************** ++MCS rate definitions ++*********************************************************/ ++#define MCS_RATE_1R (0x000000ff) ++#define MCS_RATE_2R (0x0000ffff) ++#define MCS_RATE_3R (0x00ffffff) ++#define MCS_RATE_4R (0xffffffff) ++#define MCS_RATE_2R_13TO15_OFF (0x00001fff) ++ ++ ++extern unsigned char RTW_WPA_OUI[]; ++extern unsigned char WMM_OUI[]; ++extern unsigned char WPS_OUI[]; ++extern unsigned char WFD_OUI[]; ++extern unsigned char P2P_OUI[]; ++ ++extern unsigned char WMM_INFO_OUI[]; ++extern unsigned char WMM_PARA_OUI[]; ++ ++typedef enum _RT_CHANNEL_DOMAIN { ++ /* ===== 0x00 ~ 0x1F, legacy channel plan ===== */ ++ RTW_CHPLAN_FCC = 0x00, ++ RTW_CHPLAN_IC = 0x01, ++ RTW_CHPLAN_ETSI = 0x02, ++ RTW_CHPLAN_SPAIN = 0x03, ++ RTW_CHPLAN_FRANCE = 0x04, ++ RTW_CHPLAN_MKK = 0x05, ++ RTW_CHPLAN_MKK1 = 0x06, ++ RTW_CHPLAN_ISRAEL = 0x07, ++ RTW_CHPLAN_TELEC = 0x08, ++ RTW_CHPLAN_GLOBAL_DOAMIN = 0x09, ++ RTW_CHPLAN_WORLD_WIDE_13 = 0x0A, ++ RTW_CHPLAN_TAIWAN = 0x0B, ++ RTW_CHPLAN_CHINA = 0x0C, ++ RTW_CHPLAN_SINGAPORE_INDIA_MEXICO = 0x0D, ++ RTW_CHPLAN_KOREA = 0x0E, ++ RTW_CHPLAN_TURKEY = 0x0F, ++ RTW_CHPLAN_JAPAN = 0x10, ++ RTW_CHPLAN_FCC_NO_DFS = 0x11, ++ RTW_CHPLAN_JAPAN_NO_DFS = 0x12, ++ RTW_CHPLAN_WORLD_WIDE_5G = 0x13, ++ RTW_CHPLAN_TAIWAN_NO_DFS = 0x14, ++ ++ /* ===== 0x20 ~ 0x7F, new channel plan ===== */ ++ RTW_CHPLAN_WORLD_NULL = 0x20, ++ RTW_CHPLAN_ETSI1_NULL = 0x21, ++ RTW_CHPLAN_FCC1_NULL = 0x22, ++ RTW_CHPLAN_MKK1_NULL = 0x23, ++ RTW_CHPLAN_ETSI2_NULL = 0x24, ++ RTW_CHPLAN_FCC1_FCC1 = 0x25, ++ RTW_CHPLAN_WORLD_ETSI1 = 0x26, ++ RTW_CHPLAN_MKK1_MKK1 = 0x27, ++ RTW_CHPLAN_WORLD_KCC1 = 0x28, ++ RTW_CHPLAN_WORLD_FCC2 = 0x29, ++ RTW_CHPLAN_FCC2_NULL = 0x2A, ++ RTW_CHPLAN_WORLD_FCC3 = 0x30, ++ RTW_CHPLAN_WORLD_FCC4 = 0x31, ++ RTW_CHPLAN_WORLD_FCC5 = 0x32, ++ RTW_CHPLAN_WORLD_FCC6 = 0x33, ++ RTW_CHPLAN_FCC1_FCC7 = 0x34, ++ RTW_CHPLAN_WORLD_ETSI2 = 0x35, ++ RTW_CHPLAN_WORLD_ETSI3 = 0x36, ++ RTW_CHPLAN_MKK1_MKK2 = 0x37, ++ RTW_CHPLAN_MKK1_MKK3 = 0x38, ++ RTW_CHPLAN_FCC1_NCC1 = 0x39, ++ RTW_CHPLAN_FCC1_NCC2 = 0x40, ++ RTW_CHPLAN_GLOBAL_NULL = 0x41, ++ RTW_CHPLAN_ETSI1_ETSI4 = 0x42, ++ RTW_CHPLAN_FCC1_FCC2 = 0x43, ++ RTW_CHPLAN_FCC1_NCC3 = 0x44, ++ RTW_CHPLAN_WORLD_ETSI5 = 0x45, ++ RTW_CHPLAN_FCC1_FCC8 = 0x46, ++ RTW_CHPLAN_WORLD_ETSI6 = 0x47, ++ RTW_CHPLAN_WORLD_ETSI7 = 0x48, ++ RTW_CHPLAN_WORLD_ETSI8 = 0x49, ++ RTW_CHPLAN_WORLD_ETSI9 = 0x50, ++ RTW_CHPLAN_WORLD_ETSI10 = 0x51, ++ RTW_CHPLAN_WORLD_ETSI11 = 0x52, ++ RTW_CHPLAN_FCC1_NCC4 = 0x53, ++ RTW_CHPLAN_WORLD_ETSI12 = 0x54, ++ RTW_CHPLAN_FCC1_FCC9 = 0x55, ++ RTW_CHPLAN_WORLD_ETSI13 = 0x56, ++ RTW_CHPLAN_FCC1_FCC10 = 0x57, ++ RTW_CHPLAN_MKK2_MKK4 = 0x58, ++ RTW_CHPLAN_WORLD_ETSI14 = 0x59, ++ RTW_CHPLAN_FCC1_FCC5 = 0x60, ++ RTW_CHPLAN_FCC2_FCC7 = 0x61, ++ RTW_CHPLAN_FCC2_FCC1 = 0x62, ++ ++ RTW_CHPLAN_MAX, ++ RTW_CHPLAN_REALTEK_DEFINE = 0x7F, ++} RT_CHANNEL_DOMAIN, *PRT_CHANNEL_DOMAIN; ++ ++typedef enum _RT_CHANNEL_DOMAIN_2G { ++ RTW_RD_2G_NULL = 0, ++ RTW_RD_2G_WORLD = 1, /* Worldwird 13 */ ++ RTW_RD_2G_ETSI1 = 2, /* Europe */ ++ RTW_RD_2G_FCC1 = 3, /* US */ ++ RTW_RD_2G_MKK1 = 4, /* Japan */ ++ RTW_RD_2G_ETSI2 = 5, /* France */ ++ RTW_RD_2G_GLOBAL = 6, /* Global domain */ ++ RTW_RD_2G_MKK2 = 7, /* Japan */ ++ RTW_RD_2G_FCC2 = 8, /* US */ ++ ++ RTW_RD_2G_MAX, ++} RT_CHANNEL_DOMAIN_2G, *PRT_CHANNEL_DOMAIN_2G; ++ ++typedef enum _RT_CHANNEL_DOMAIN_5G { ++ RTW_RD_5G_NULL = 0, /* */ ++ RTW_RD_5G_ETSI1 = 1, /* Europe */ ++ RTW_RD_5G_ETSI2 = 2, /* Australia, New Zealand */ ++ RTW_RD_5G_ETSI3 = 3, /* Russia */ ++ RTW_RD_5G_FCC1 = 4, /* US */ ++ RTW_RD_5G_FCC2 = 5, /* FCC w/o DFS Channels */ ++ RTW_RD_5G_FCC3 = 6, /* Bolivia, Chile, El Salvador, Venezuela */ ++ RTW_RD_5G_FCC4 = 7, /* Venezuela */ ++ RTW_RD_5G_FCC5 = 8, /* China */ ++ RTW_RD_5G_FCC6 = 9, /* */ ++ RTW_RD_5G_FCC7 = 10, /* US Canada(w/o Weather radar) */ ++ RTW_RD_5G_KCC1 = 11, /* Korea */ ++ RTW_RD_5G_MKK1 = 12, /* Japan */ ++ RTW_RD_5G_MKK2 = 13, /* Japan (W52, W53) */ ++ RTW_RD_5G_MKK3 = 14, /* Japan (W56) */ ++ RTW_RD_5G_NCC1 = 15, /* Taiwan, (w/o Weather radar) */ ++ RTW_RD_5G_NCC2 = 16, /* Taiwan, Band2, Band4 */ ++ RTW_RD_5G_NCC3 = 17, /* Taiwan w/o DFS, Band4 only */ ++ RTW_RD_5G_ETSI4 = 18, /* Europe w/o DFS, Band1 only */ ++ RTW_RD_5G_ETSI5 = 19, /* Australia, New Zealand(w/o Weather radar) */ ++ RTW_RD_5G_FCC8 = 20, /* Latin America */ ++ RTW_RD_5G_ETSI6 = 21, /* Israel, Bahrain, Egypt, India, China, Malaysia */ ++ RTW_RD_5G_ETSI7 = 22, /* China */ ++ RTW_RD_5G_ETSI8 = 23, /* Jordan */ ++ RTW_RD_5G_ETSI9 = 24, /* Lebanon */ ++ RTW_RD_5G_ETSI10 = 25, /* Qatar */ ++ RTW_RD_5G_ETSI11 = 26, /* Russia */ ++ RTW_RD_5G_NCC4 = 27, /* Taiwan, (w/o Weather radar) */ ++ RTW_RD_5G_ETSI12 = 28, /* Indonesia */ ++ RTW_RD_5G_FCC9 = 29, /* (w/o Weather radar) */ ++ RTW_RD_5G_ETSI13 = 30, /* (w/o Weather radar) */ ++ RTW_RD_5G_FCC10 = 31, /* Argentina(w/o Weather radar) */ ++ RTW_RD_5G_MKK4 = 32, /* Japan (W52) */ ++ RTW_RD_5G_ETSI14 = 33, /* Russia */ ++ RTW_RD_5G_FCC11 = 34, /* US(include CH144) */ ++ ++ /* === Below are driver defined for legacy channel plan compatible, DON'T assign index ==== */ ++ RTW_RD_5G_OLD_FCC1, ++ RTW_RD_5G_OLD_NCC1, ++ RTW_RD_5G_OLD_KCC1, ++ ++ RTW_RD_5G_MAX, ++} RT_CHANNEL_DOMAIN_5G, *PRT_CHANNEL_DOMAIN_5G; ++ ++bool rtw_chplan_is_empty(u8 id); ++#define rtw_is_channel_plan_valid(chplan) (((chplan) < RTW_CHPLAN_MAX || (chplan) == RTW_CHPLAN_REALTEK_DEFINE) && !rtw_chplan_is_empty(chplan)) ++#define rtw_is_legacy_channel_plan(chplan) ((chplan) < 0x20) ++ ++typedef struct _RT_CHANNEL_PLAN { ++ unsigned char Channel[MAX_CHANNEL_NUM]; ++ unsigned char Len; ++} RT_CHANNEL_PLAN, *PRT_CHANNEL_PLAN; ++ ++struct ch_list_t { ++ u8 *len_ch; ++}; ++ ++#define CH_LIST_ENT(_len, arg...) \ ++ {.len_ch = (u8[_len + 1]) {_len, ##arg}, } ++ ++#define CH_LIST_LEN(_ch_list) (_ch_list.len_ch[0]) ++#define CH_LIST_CH(_ch_list, _i) (_ch_list.len_ch[_i + 1]) ++ ++typedef struct _RT_CHANNEL_PLAN_MAP { ++ u8 Index2G; ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ u8 Index5G; ++#endif ++ u8 regd; /* value of REGULATION_TXPWR_LMT */ ++} RT_CHANNEL_PLAN_MAP, *PRT_CHANNEL_PLAN_MAP; ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++#define CHPLAN_ENT(i2g, i5g, regd) {i2g, i5g, regd} ++#else ++#define CHPLAN_ENT(i2g, i5g, regd) {i2g, regd} ++#endif ++ ++enum Associated_AP { ++ atherosAP = 0, ++ broadcomAP = 1, ++ ciscoAP = 2, ++ marvellAP = 3, ++ ralinkAP = 4, ++ realtekAP = 5, ++ airgocapAP = 6, ++ unknownAP = 7, ++ maxAP, ++}; ++ ++typedef enum _HT_IOT_PEER { ++ HT_IOT_PEER_UNKNOWN = 0, ++ HT_IOT_PEER_REALTEK = 1, ++ HT_IOT_PEER_REALTEK_92SE = 2, ++ HT_IOT_PEER_BROADCOM = 3, ++ HT_IOT_PEER_RALINK = 4, ++ HT_IOT_PEER_ATHEROS = 5, ++ HT_IOT_PEER_CISCO = 6, ++ HT_IOT_PEER_MERU = 7, ++ HT_IOT_PEER_MARVELL = 8, ++ HT_IOT_PEER_REALTEK_SOFTAP = 9,/* peer is RealTek SOFT_AP, by Bohn, 2009.12.17 */ ++ HT_IOT_PEER_SELF_SOFTAP = 10, /* Self is SoftAP */ ++ HT_IOT_PEER_AIRGO = 11, ++ HT_IOT_PEER_INTEL = 12, ++ HT_IOT_PEER_RTK_APCLIENT = 13, ++ HT_IOT_PEER_REALTEK_81XX = 14, ++ HT_IOT_PEER_REALTEK_WOW = 15, ++ HT_IOT_PEER_REALTEK_JAGUAR_BCUTAP = 16, ++ HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP = 17, ++ HT_IOT_PEER_MAX = 18 ++} HT_IOT_PEER_E, *PHTIOT_PEER_E; ++ ++struct mlme_handler { ++ unsigned int num; ++ char *str; ++ unsigned int (*func)(_adapter *padapter, union recv_frame *precv_frame); ++}; ++ ++struct action_handler { ++ unsigned int num; ++ char *str; ++ unsigned int (*func)(_adapter *padapter, union recv_frame *precv_frame); ++}; ++ ++enum SCAN_STATE { ++ SCAN_DISABLE = 0, ++ SCAN_START = 1, ++ SCAN_PS_ANNC_WAIT = 2, ++ SCAN_ENTER = 3, ++ SCAN_PROCESS = 4, ++ ++ /* backop */ ++ SCAN_BACKING_OP = 5, ++ SCAN_BACK_OP = 6, ++ SCAN_LEAVING_OP = 7, ++ SCAN_LEAVE_OP = 8, ++ ++ /* SW antenna diversity (before linked) */ ++ SCAN_SW_ANTDIV_BL = 9, ++ ++ /* legacy p2p */ ++ SCAN_TO_P2P_LISTEN = 10, ++ SCAN_P2P_LISTEN = 11, ++ ++ SCAN_COMPLETE = 12, ++ SCAN_STATE_MAX, ++}; ++ ++const char *scan_state_str(u8 state); ++ ++enum ss_backop_flag { ++ SS_BACKOP_EN = BIT0, /* backop when linked */ ++ SS_BACKOP_EN_NL = BIT1, /* backop even when no linked */ ++ ++ SS_BACKOP_PS_ANNC = BIT4, ++ SS_BACKOP_TX_RESUME = BIT5, ++}; ++ ++struct ss_res { ++ u8 state; ++ u8 next_state; /* will set to state on next cmd hdl */ ++ int bss_cnt; ++ int channel_idx; ++ int scan_mode; ++ u16 scan_ch_ms; ++ u8 rx_ampdu_accept; ++ u8 rx_ampdu_size; ++ u8 igi_scan; ++ u8 igi_before_scan; /* used for restoring IGI value without enable DIG & FA_CNT */ ++#ifdef CONFIG_SCAN_BACKOP ++ u8 backop_flags_sta; /* policy for station mode*/ ++ u8 backop_flags_ap; /* policy for ap mode */ ++ u8 backop_flags; /* per backop runtime decision */ ++ u8 scan_cnt; ++ u8 scan_cnt_max; ++ u32 backop_time; /* the start time of backop */ ++ u16 backop_ms; ++#endif ++#if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) ++ u8 is_sw_antdiv_bl_scan; ++#endif ++ u8 ssid_num; ++ u8 ch_num; ++ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; ++ struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; ++}; ++ ++/* #define AP_MODE 0x0C */ ++/* #define STATION_MODE 0x08 */ ++/* #define AD_HOC_MODE 0x04 */ ++/* #define NO_LINK_MODE 0x00 */ ++ ++#define WIFI_FW_NULL_STATE _HW_STATE_NOLINK_ ++#define WIFI_FW_STATION_STATE _HW_STATE_STATION_ ++#define WIFI_FW_AP_STATE _HW_STATE_AP_ ++#define WIFI_FW_ADHOC_STATE _HW_STATE_ADHOC_ ++ ++#define WIFI_FW_AUTH_NULL 0x00000100 ++#define WIFI_FW_AUTH_STATE 0x00000200 ++#define WIFI_FW_AUTH_SUCCESS 0x00000400 ++ ++#define WIFI_FW_ASSOC_STATE 0x00002000 ++#define WIFI_FW_ASSOC_SUCCESS 0x00004000 ++ ++#define WIFI_FW_LINKING_STATE (WIFI_FW_AUTH_NULL | WIFI_FW_AUTH_STATE | WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE) ++ ++#ifdef CONFIG_TDLS ++enum TDLS_option { ++ TDLS_ESTABLISHED = 1, ++ TDLS_ISSUE_PTI, ++ TDLS_CH_SW_RESP, ++ TDLS_CH_SW_PREPARE, ++ TDLS_CH_SW_START, ++ TDLS_CH_SW_TO_OFF_CHNL, ++ TDLS_CH_SW_TO_BASE_CHNL_UNSOLICITED, ++ TDLS_CH_SW_TO_BASE_CHNL, ++ TDLS_CH_SW_END_TO_BASE_CHNL, ++ TDLS_CH_SW_END, ++ TDLS_RS_RCR, ++ TDLS_TEARDOWN_STA, ++ TDLS_TEARDOWN_STA_LOCALLY, ++ maxTDLS, ++}; ++ ++#endif /* CONFIG_TDLS */ ++ ++/* ++ * Usage: ++ * When one iface acted as AP mode and the other iface is STA mode and scanning, ++ * it should switch back to AP's operating channel periodically. ++ * Parameters info: ++ * When the driver scanned RTW_SCAN_NUM_OF_CH channels, it would switch back to AP's operating channel for ++ * RTW_BACK_OP_CH_MS milliseconds. ++ * Example: ++ * For chip supports 2.4G + 5GHz and AP mode is operating in channel 1, ++ * RTW_SCAN_NUM_OF_CH is 8, RTW_BACK_OP_CH_MS is 300 ++ * When it's STA mode gets set_scan command, ++ * it would ++ * 1. Doing the scan on channel 1.2.3.4.5.6.7.8 ++ * 2. Back to channel 1 for 300 milliseconds ++ * 3. Go through doing site survey on channel 9.10.11.36.40.44.48.52 ++ * 4. Back to channel 1 for 300 milliseconds ++ * 5. ... and so on, till survey done. ++ */ ++#if defined(CONFIG_ATMEL_RC_PATCH) ++ #define RTW_SCAN_NUM_OF_CH 2 ++ #define RTW_BACK_OP_CH_MS 200 ++#else ++ #define RTW_SCAN_NUM_OF_CH 3 ++ #define RTW_BACK_OP_CH_MS 400 ++#endif ++ ++struct mlme_ext_info { ++ u32 state; ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ u8 hw_media_state; ++#endif ++ u32 reauth_count; ++ u32 reassoc_count; ++ u32 link_count; ++ u32 auth_seq; ++ u32 auth_algo; /* 802.11 auth, could be open, shared, auto */ ++ u32 authModeToggle; ++ u32 enc_algo;/* encrypt algorithm; */ ++ u32 key_index; /* this is only valid for legendary wep, 0~3 for key id. */ ++ u32 iv; ++ u8 chg_txt[128]; ++ u16 aid; ++ u16 bcn_interval; ++ u16 capability; ++ u8 assoc_AP_vendor; ++ u8 slotTime; ++ u8 preamble_mode; ++ u8 WMM_enable; ++ u8 ERP_enable; ++ u8 ERP_IE; ++ u8 HT_enable; ++ u8 HT_caps_enable; ++ u8 HT_info_enable; ++ u8 HT_protection; ++ u8 turboMode_cts2self; ++ u8 turboMode_rtsen; ++ u8 SM_PS; ++ u8 agg_enable_bitmap; ++ u8 ADDBA_retry_count; ++ u8 candidate_tid_bitmap; ++ u8 dialogToken; ++ /* Accept ADDBA Request */ ++ BOOLEAN bAcceptAddbaReq; ++ u8 bwmode_updated; ++ u8 hidden_ssid_mode; ++ u8 VHT_enable; ++ ++ struct ADDBA_request ADDBA_req; ++ struct WMM_para_element WMM_param; ++ struct HT_caps_element HT_caps; ++ struct HT_info_element HT_info; ++ WLAN_BSSID_EX network;/* join network or bss_network, if in ap mode, it is the same to cur_network.network */ ++}; ++ ++/* The channel information about this channel including joining, scanning, and power constraints. */ ++typedef struct _RT_CHANNEL_INFO { ++ u8 ChannelNum; /* The channel number. */ ++ RT_SCAN_TYPE ScanType; /* Scan type such as passive or active scan. */ ++ /* u16 ScanPeriod; */ /* Listen time in millisecond in this channel. */ ++ /* s32 MaxTxPwrDbm; */ /* Max allowed tx power. */ ++ /* u32 ExInfo; */ /* Extended Information for this channel. */ ++#ifdef CONFIG_FIND_BEST_CHANNEL ++ u32 rx_count; ++#endif ++#ifdef CONFIG_DFS_MASTER ++ u32 non_ocp_end_time; ++#endif ++} RT_CHANNEL_INFO, *PRT_CHANNEL_INFO; ++ ++#define DFS_MASTER_TIMER_MS 100 ++#define CAC_TIME_MS (60*1000) ++#define CAC_TIME_CE_MS (10*60*1000) ++#define NON_OCP_TIME_MS (30*60*1000) ++ ++void rtw_rfctl_init(_adapter *adapter); ++ ++#ifdef CONFIG_DFS_MASTER ++struct rf_ctl_t; ++#define CH_IS_NON_OCP(rt_ch_info) (time_after((unsigned long)(rt_ch_info)->non_ocp_end_time, (unsigned long)rtw_get_current_time())) ++bool rtw_is_cac_reset_needed(_adapter *adapter, u8 ch, u8 bw, u8 offset); ++bool _rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset); ++bool rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl); ++bool rtw_rfctl_is_tx_blocked_by_ch_waiting(struct rf_ctl_t *rfctl); ++bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); ++void rtw_chset_update_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); ++void rtw_chset_update_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset, int ms); ++u32 rtw_get_ch_waiting_ms(_adapter *adapter, u8 ch, u8 bw, u8 offset, u32 *r_non_ocp_ms, u32 *r_cac_ms); ++void rtw_reset_cac(_adapter *adapter, u8 ch, u8 bw, u8 offset); ++bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 *dec_bw, u8 *dec_offset, u8 d_flags); ++#else ++#define CH_IS_NON_OCP(rt_ch_info) 0 ++#define rtw_chset_is_ch_non_ocp(ch_set, ch, bw, offset) _FALSE ++#define rtw_rfctl_is_tx_blocked_by_ch_waiting(rfctl) _FALSE ++#endif ++ ++enum { ++ RTW_CHF_2G = BIT0, ++ RTW_CHF_5G = BIT1, ++ RTW_CHF_DFS = BIT2, ++ RTW_CHF_LONG_CAC = BIT3, ++ RTW_CHF_NON_DFS = BIT4, ++ RTW_CHF_NON_LONG_CAC = BIT5, ++ RTW_CHF_NON_OCP = BIT6, ++}; ++void dump_country_chplan(void *sel, const struct country_chplan *ent); ++void dump_country_chplan_map(void *sel); ++void dump_chplan_id_list(void *sel); ++void dump_chplan_test(void *sel); ++void dump_chset(void *sel, RT_CHANNEL_INFO *ch_set); ++void dump_cur_chset(void *sel, _adapter *adapter); ++ ++int rtw_ch_set_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch); ++u8 rtw_chset_is_chbw_valid(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); ++ ++bool rtw_mlme_band_check(_adapter *adapter, const u32 ch); ++ ++ ++enum { ++ BAND_24G = BIT0, ++ BAND_5G = BIT1, ++}; ++void RTW_SET_SCAN_BAND_SKIP(_adapter *padapter, int skip_band); ++void RTW_CLR_SCAN_BAND_SKIP(_adapter *padapter, int skip_band); ++int RTW_GET_SCAN_BAND_SKIP(_adapter *padapter); ++ ++bool rtw_mlme_ignore_chan(_adapter *adapter, const u32 ch); ++ ++/* P2P_MAX_REG_CLASSES - Maximum number of regulatory classes */ ++#define P2P_MAX_REG_CLASSES 10 ++ ++/* P2P_MAX_REG_CLASS_CHANNELS - Maximum number of channels per regulatory class */ ++#define P2P_MAX_REG_CLASS_CHANNELS 20 ++ ++/* struct p2p_channels - List of supported channels */ ++struct p2p_channels { ++ /* struct p2p_reg_class - Supported regulatory class */ ++ struct p2p_reg_class { ++ /* reg_class - Regulatory class (IEEE 802.11-2007, Annex J) */ ++ u8 reg_class; ++ ++ /* channel - Supported channels */ ++ u8 channel[P2P_MAX_REG_CLASS_CHANNELS]; ++ ++ /* channels - Number of channel entries in use */ ++ size_t channels; ++ } reg_class[P2P_MAX_REG_CLASSES]; ++ ++ /* reg_classes - Number of reg_class entries in use */ ++ size_t reg_classes; ++}; ++ ++struct p2p_oper_class_map { ++ enum hw_mode {IEEE80211G, IEEE80211A} mode; ++ u8 op_class; ++ u8 min_chan; ++ u8 max_chan; ++ u8 inc; ++ enum { BW20, BW40PLUS, BW40MINUS } bw; ++}; ++ ++struct mlme_ext_priv { ++ _adapter *padapter; ++ u8 mlmeext_init; ++ ATOMIC_T event_seq; ++ u16 mgnt_seq; ++#ifdef CONFIG_IEEE80211W ++ u16 sa_query_seq; ++ u64 mgnt_80211w_IPN; ++ u64 mgnt_80211w_IPN_rx; ++#endif /* CONFIG_IEEE80211W */ ++ /* struct fw_priv fwpriv; */ ++ ++ unsigned char cur_channel; ++ unsigned char cur_bwmode; ++ unsigned char cur_ch_offset;/* PRIME_CHNL_OFFSET */ ++ unsigned char cur_wireless_mode; /* NETWORK_TYPE */ ++ ++ unsigned char max_chan_nums; ++ RT_CHANNEL_INFO channel_set[MAX_CHANNEL_NUM]; ++ struct p2p_channels channel_list; ++ unsigned char basicrate[NumRates]; ++ unsigned char datarate[NumRates]; ++#ifdef CONFIG_80211N_HT ++ unsigned char default_supported_mcs_set[16]; ++#endif ++ ++ struct ss_res sitesurvey_res; ++ struct mlme_ext_info mlmext_info;/* for sta/adhoc mode, including current scanning/connecting/connected related info. ++ * for ap mode, network includes ap's cap_info */ ++ _timer survey_timer; ++ _timer link_timer; ++#ifdef CONFIG_RTW_80211R ++ _timer ft_link_timer; ++ _timer ft_roam_timer; ++#endif ++ ++ /* _timer ADDBA_timer; */ ++ u32 last_scan_time; ++ u8 scan_abort; ++ u8 tx_rate; /* TXRATE when USERATE is set. */ ++ ++ u32 retry; /* retry for issue probereq */ ++ ++ u64 TSFValue; ++ ++ /* for LPS-32K to adaptive bcn early and timeout */ ++ u8 adaptive_tsf_done; ++ u32 bcn_delay_cnt[9]; ++ u32 bcn_delay_ratio[9]; ++ u32 bcn_cnt; ++ u8 DrvBcnEarly; ++ u8 DrvBcnTimeOut; ++ ++#ifdef CONFIG_AP_MODE ++ unsigned char bstart_bss; ++#endif ++ ++#ifdef CONFIG_80211D ++ u8 update_channel_plan_by_ap_done; ++#endif ++ /* recv_decache check for Action_public frame */ ++ u8 action_public_dialog_token; ++ u16 action_public_rxseq; ++ ++ /* #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ ++ u8 active_keep_alive_check; ++ /* #endif */ ++#ifdef DBG_FIXED_CHAN ++ u8 fixed_chan; ++#endif ++ /* set hw sync bcn tsf register or not */ ++ u8 en_hw_update_tsf; ++}; ++ ++static inline u8 check_mlmeinfo_state(struct mlme_ext_priv *plmeext, sint state) ++{ ++ if ((plmeext->mlmext_info.state & 0x03) == state) ++ return _TRUE; ++ ++ return _FALSE; ++} ++ ++#define mlmeext_msr(mlmeext) ((mlmeext)->mlmext_info.state & 0x03) ++#define mlmeext_scan_state(mlmeext) ((mlmeext)->sitesurvey_res.state) ++#define mlmeext_scan_state_str(mlmeext) scan_state_str((mlmeext)->sitesurvey_res.state) ++#define mlmeext_chk_scan_state(mlmeext, _state) ((mlmeext)->sitesurvey_res.state == (_state)) ++#define mlmeext_set_scan_state(mlmeext, _state) \ ++ do { \ ++ ((mlmeext)->sitesurvey_res.state = (_state)); \ ++ ((mlmeext)->sitesurvey_res.next_state = (_state)); \ ++ /* RTW_INFO("set_scan_state:%s\n", scan_state_str(_state)); */ \ ++ } while (0) ++ ++#define mlmeext_scan_next_state(mlmeext) ((mlmeext)->sitesurvey_res.next_state) ++#define mlmeext_set_scan_next_state(mlmeext, _state) \ ++ do { \ ++ ((mlmeext)->sitesurvey_res.next_state = (_state)); \ ++ /* RTW_INFO("set_scan_next_state:%s\n", scan_state_str(_state)); */ \ ++ } while (0) ++ ++#ifdef CONFIG_SCAN_BACKOP ++#define mlmeext_scan_backop_flags(mlmeext) ((mlmeext)->sitesurvey_res.backop_flags) ++#define mlmeext_chk_scan_backop_flags(mlmeext, flags) ((mlmeext)->sitesurvey_res.backop_flags & (flags)) ++#define mlmeext_assign_scan_backop_flags(mlmeext, flags) \ ++ do { \ ++ ((mlmeext)->sitesurvey_res.backop_flags = (flags)); \ ++ RTW_INFO("assign_scan_backop_flags:0x%02x\n", (mlmeext)->sitesurvey_res.backop_flags); \ ++ } while (0) ++ ++#define mlmeext_scan_backop_flags_sta(mlmeext) ((mlmeext)->sitesurvey_res.backop_flags_sta) ++#define mlmeext_chk_scan_backop_flags_sta(mlmeext, flags) ((mlmeext)->sitesurvey_res.backop_flags_sta & (flags)) ++#define mlmeext_assign_scan_backop_flags_sta(mlmeext, flags) \ ++ do { \ ++ ((mlmeext)->sitesurvey_res.backop_flags_sta = (flags)); \ ++ } while (0) ++ ++#define mlmeext_scan_backop_flags_ap(mlmeext) ((mlmeext)->sitesurvey_res.backop_flags_ap) ++#define mlmeext_chk_scan_backop_flags_ap(mlmeext, flags) ((mlmeext)->sitesurvey_res.backop_flags_ap & (flags)) ++#define mlmeext_assign_scan_backop_flags_ap(mlmeext, flags) \ ++ do { \ ++ ((mlmeext)->sitesurvey_res.backop_flags_ap = (flags)); \ ++ } while (0) ++#else ++#define mlmeext_scan_backop_flags(mlmeext) (0) ++#define mlmeext_chk_scan_backop_flags(mlmeext, flags) (0) ++#define mlmeext_assign_scan_backop_flags(mlmeext, flags) do {} while (0) ++ ++#define mlmeext_scan_backop_flags_sta(mlmeext) (0) ++#define mlmeext_chk_scan_backop_flags_sta(mlmeext, flags) (0) ++#define mlmeext_assign_scan_backop_flags_sta(mlmeext, flags) do {} while (0) ++ ++#define mlmeext_scan_backop_flags_ap(mlmeext) (0) ++#define mlmeext_chk_scan_backop_flags_ap(mlmeext, flags) (0) ++#define mlmeext_assign_scan_backop_flags_ap(mlmeext, flags) do {} while (0) ++#endif ++ ++void init_mlme_default_rate_set(_adapter *padapter); ++int init_mlme_ext_priv(_adapter *padapter); ++int init_hw_mlme_ext(_adapter *padapter); ++void free_mlme_ext_priv(struct mlme_ext_priv *pmlmeext); ++extern void init_mlme_ext_timer(_adapter *padapter); ++extern void init_addba_retry_timer(_adapter *padapter, struct sta_info *psta); ++extern struct xmit_frame *alloc_mgtxmitframe(struct xmit_priv *pxmitpriv); ++struct xmit_frame *alloc_mgtxmitframe_once(struct xmit_priv *pxmitpriv); ++ ++/* void fill_fwpriv(_adapter * padapter, struct fw_priv *pfwpriv); */ ++#ifdef CONFIG_GET_RAID_BY_DRV ++unsigned char networktype_to_raid(_adapter *adapter, struct sta_info *psta); ++unsigned char networktype_to_raid_ex(_adapter *adapter, struct sta_info *psta); ++#endif ++u8 judge_network_type(_adapter *padapter, unsigned char *rate, int ratelen); ++void get_rate_set(_adapter *padapter, unsigned char *pbssrate, int *bssrate_len); ++void set_mcs_rate_by_mask(u8 *mcs_set, u32 mask); ++void UpdateBrateTbl(_adapter *padapter, u8 *mBratesOS); ++void UpdateBrateTblForSoftAP(u8 *bssrateset, u32 bssratelen); ++void change_band_update_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 ch); ++ ++void Set_MSR(_adapter *padapter, u8 type); ++ ++u8 rtw_get_oper_ch(_adapter *adapter); ++void rtw_set_oper_ch(_adapter *adapter, u8 ch); ++u8 rtw_get_oper_bw(_adapter *adapter); ++void rtw_set_oper_bw(_adapter *adapter, u8 bw); ++u8 rtw_get_oper_choffset(_adapter *adapter); ++void rtw_set_oper_choffset(_adapter *adapter, u8 offset); ++u8 rtw_get_center_ch(u8 channel, u8 chnl_bw, u8 chnl_offset); ++u32 rtw_get_on_oper_ch_time(_adapter *adapter); ++u32 rtw_get_on_cur_ch_time(_adapter *adapter); ++ ++u8 rtw_get_offset_by_chbw(u8 ch, u8 bw, u8 *r_offset); ++u8 rtw_get_offset_by_ch(u8 channel); ++ ++void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char channel_offset, unsigned short bwmode); ++ ++unsigned int decide_wait_for_beacon_timeout(unsigned int bcn_interval); ++ ++void _clear_cam_entry(_adapter *padapter, u8 entry); ++void write_cam_from_cache(_adapter *adapter, u8 id); ++void rtw_sec_cam_swap(_adapter *adapter, u8 cam_id_a, u8 cam_id_b); ++void rtw_clean_dk_section(_adapter *adapter); ++void rtw_clean_hw_dk_cam(_adapter *adapter); ++ ++/* modify both HW and cache */ ++void write_cam(_adapter *padapter, u8 id, u16 ctrl, u8 *mac, u8 *key); ++void clear_cam_entry(_adapter *padapter, u8 id); ++ ++/* modify cache only */ ++void write_cam_cache(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key); ++void clear_cam_cache(_adapter *adapter, u8 id); ++ ++void invalidate_cam_all(_adapter *padapter); ++void CAM_empty_entry(PADAPTER Adapter, u8 ucIndex); ++ ++void flush_all_cam_entry(_adapter *padapter); ++ ++BOOLEAN IsLegal5GChannel(PADAPTER Adapter, u8 channel); ++ ++void site_survey(_adapter *padapter, u8 survey_channel, RT_SCAN_TYPE ScanType); ++u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSID_EX *bssid); ++void update_network(WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src, _adapter *padapter, bool update_ie); ++ ++int get_bsstype(unsigned short capability); ++u8 *get_my_bssid(WLAN_BSSID_EX *pnetwork); ++u16 get_beacon_interval(WLAN_BSSID_EX *bss); ++ ++int is_client_associated_to_ap(_adapter *padapter); ++int is_client_associated_to_ibss(_adapter *padapter); ++int is_IBSS_empty(_adapter *padapter); ++ ++unsigned char check_assoc_AP(u8 *pframe, uint len); ++ ++int WMM_param_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); ++#ifdef CONFIG_WFD ++void rtw_process_wfd_ie(_adapter *adapter, u8 *ie, u8 ie_len, const char *tag); ++void rtw_process_wfd_ies(_adapter *adapter, u8 *ies, u8 ies_len, const char *tag); ++#endif ++void WMMOnAssocRsp(_adapter *padapter); ++ ++void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); ++void HT_info_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); ++void HTOnAssocRsp(_adapter *padapter); ++ ++void ERP_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); ++void VCS_update(_adapter *padapter, struct sta_info *psta); ++void update_ldpc_stbc_cap(struct sta_info *psta); ++ ++int rtw_get_bcn_keys(ADAPTER *Adapter, u8 *pframe, u32 packet_len, ++ struct beacon_keys *recv_beacon); ++void rtw_dump_bcn_keys(struct beacon_keys *recv_beacon); ++int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len); ++void update_beacon_info(_adapter *padapter, u8 *pframe, uint len, struct sta_info *psta); ++#ifdef CONFIG_DFS ++void process_csa_ie(_adapter *padapter, u8 *pframe, uint len); ++#endif /* CONFIG_DFS */ ++void update_capinfo(PADAPTER Adapter, u16 updateCap); ++void update_wireless_mode(_adapter *padapter); ++void update_tx_basic_rate(_adapter *padapter, u8 modulation); ++void update_sta_basic_rate(struct sta_info *psta, u8 wireless_mode); ++int rtw_ies_get_supported_rate(u8 *ies, uint ies_len, u8 *rate_set, u8 *rate_num); ++ ++/* for sta/adhoc mode */ ++void update_sta_info(_adapter *padapter, struct sta_info *psta); ++unsigned int update_basic_rate(unsigned char *ptn, unsigned int ptn_sz); ++unsigned int update_supported_rate(unsigned char *ptn, unsigned int ptn_sz); ++unsigned int update_MCS_rate(struct HT_caps_element *pHT_caps); ++void Update_RA_Entry(_adapter *padapter, struct sta_info *psta); ++void set_sta_rate(_adapter *padapter, struct sta_info *psta); ++ ++unsigned int receive_disconnect(_adapter *padapter, unsigned char *MacAddr, unsigned short reason, u8 locally_generated); ++ ++unsigned char get_highest_rate_idx(u32 mask); ++int support_short_GI(_adapter *padapter, struct HT_caps_element *pHT_caps, u8 bwmode); ++unsigned int is_ap_in_tkip(_adapter *padapter); ++unsigned int is_ap_in_wep(_adapter *padapter); ++unsigned int should_forbid_n_rate(_adapter *padapter); ++ ++bool _rtw_camctl_chk_cap(_adapter *adapter, u8 cap); ++void _rtw_camctl_set_flags(_adapter *adapter, u32 flags); ++void rtw_camctl_set_flags(_adapter *adapter, u32 flags); ++void _rtw_camctl_clr_flags(_adapter *adapter, u32 flags); ++void rtw_camctl_clr_flags(_adapter *adapter, u32 flags); ++bool _rtw_camctl_chk_flags(_adapter *adapter, u32 flags); ++ ++struct sec_cam_bmp; ++void dump_sec_cam_map(void *sel, struct sec_cam_bmp *map, u8 max_num); ++void rtw_sec_cam_map_clr_all(struct sec_cam_bmp *map); ++ ++bool _rtw_camid_is_gk(_adapter *adapter, u8 cam_id); ++bool rtw_camid_is_gk(_adapter *adapter, u8 cam_id); ++s16 rtw_camid_search(_adapter *adapter, u8 *addr, s16 kid, s8 gk); ++s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, bool *used); ++void rtw_camid_free(_adapter *adapter, u8 cam_id); ++u8 rtw_get_sec_camid(_adapter *adapter, u8 max_bk_key_num, u8 *sec_key_id); ++ ++struct macid_bmp; ++struct macid_ctl_t; ++void dump_macid_map(void *sel, struct macid_bmp *map, u8 max_num); ++bool rtw_macid_is_set(struct macid_bmp *map, u8 id); ++bool rtw_macid_is_used(struct macid_ctl_t *macid_ctl, u8 id); ++bool rtw_macid_is_bmc(struct macid_ctl_t *macid_ctl, u8 id); ++s8 rtw_macid_get_if_g(struct macid_ctl_t *macid_ctl, u8 id); ++s8 rtw_macid_get_ch_g(struct macid_ctl_t *macid_ctl, u8 id); ++void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta); ++void rtw_release_macid(_adapter *padapter, struct sta_info *psta); ++u8 rtw_search_max_mac_id(_adapter *padapter); ++void rtw_macid_ctl_set_h2c_msr(struct macid_ctl_t *macid_ctl, u8 id, u8 h2c_msr); ++void rtw_macid_ctl_set_bw(struct macid_ctl_t *macid_ctl, u8 id, u8 bw); ++void rtw_macid_ctl_set_vht_en(struct macid_ctl_t *macid_ctl, u8 id, u8 en); ++void rtw_macid_ctl_set_rate_bmp0(struct macid_ctl_t *macid_ctl, u8 id, u32 bmp); ++void rtw_macid_ctl_set_rate_bmp1(struct macid_ctl_t *macid_ctl, u8 id, u32 bmp); ++void rtw_macid_ctl_init(struct macid_ctl_t *macid_ctl); ++void rtw_macid_ctl_deinit(struct macid_ctl_t *macid_ctl); ++u8 rtw_iface_bcmc_id_get(_adapter *padapter); ++ ++u32 report_join_res(_adapter *padapter, int res); ++void report_survey_event(_adapter *padapter, union recv_frame *precv_frame); ++void report_surveydone_event(_adapter *padapter); ++u32 report_del_sta_event(_adapter *padapter, unsigned char *MacAddr, unsigned short reason, bool enqueue, u8 locally_generated); ++void report_add_sta_event(_adapter *padapter, unsigned char *MacAddr); ++bool rtw_port_switch_chk(_adapter *adapter); ++void report_wmm_edca_update(_adapter *padapter); ++ ++void beacon_timing_control(_adapter *padapter); ++u8 chk_bmc_sleepq_cmd(_adapter *padapter); ++extern u8 set_tx_beacon_cmd(_adapter *padapter); ++unsigned int setup_beacon_frame(_adapter *padapter, unsigned char *beacon_frame); ++void update_mgnt_tx_rate(_adapter *padapter, u8 rate); ++void update_monitor_frame_attrib(_adapter *padapter, struct pkt_attrib *pattrib); ++void update_mgntframe_attrib(_adapter *padapter, struct pkt_attrib *pattrib); ++void update_mgntframe_attrib_addr(_adapter *padapter, struct xmit_frame *pmgntframe); ++void dump_mgntframe(_adapter *padapter, struct xmit_frame *pmgntframe); ++s32 dump_mgntframe_and_wait(_adapter *padapter, struct xmit_frame *pmgntframe, int timeout_ms); ++s32 dump_mgntframe_and_wait_ack(_adapter *padapter, struct xmit_frame *pmgntframe); ++s32 dump_mgntframe_and_wait_ack_timeout(_adapter *padapter, struct xmit_frame *pmgntframe, int timeout_ms); ++ ++#ifdef CONFIG_P2P ++void issue_probersp_p2p(_adapter *padapter, unsigned char *da); ++void issue_p2p_provision_request(_adapter *padapter, u8 *pssid, u8 ussidlen, u8 *pdev_raddr); ++void issue_p2p_GO_request(_adapter *padapter, u8 *raddr); ++void issue_probereq_p2p(_adapter *padapter, u8 *da); ++int issue_probereq_p2p_ex(_adapter *adapter, u8 *da, int try_cnt, int wait_ms); ++void issue_p2p_invitation_response(_adapter *padapter, u8 *raddr, u8 dialogToken, u8 success); ++void issue_p2p_invitation_request(_adapter *padapter, u8 *raddr); ++#endif /* CONFIG_P2P */ ++void issue_beacon(_adapter *padapter, int timeout_ms); ++void issue_probersp(_adapter *padapter, unsigned char *da, u8 is_valid_p2p_probereq); ++void _issue_assocreq(_adapter *padapter, u8 is_assoc); ++void issue_assocreq(_adapter *padapter); ++void issue_reassocreq(_adapter *padapter); ++void issue_asocrsp(_adapter *padapter, unsigned short status, struct sta_info *pstat, int pkt_type); ++void issue_auth(_adapter *padapter, struct sta_info *psta, unsigned short status); ++void issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da); ++s32 issue_probereq_ex(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, bool append_wps, int try_cnt, int wait_ms); ++int issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); ++s32 issue_nulldata_in_interrupt(PADAPTER padapter, u8 *da, unsigned int power_mode); ++int issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int try_cnt, int wait_ms); ++int issue_deauth(_adapter *padapter, unsigned char *da, unsigned short reason); ++int issue_deauth_ex(_adapter *padapter, u8 *da, unsigned short reason, int try_cnt, int wait_ms); ++void issue_action_spct_ch_switch(_adapter *padapter, u8 *ra, u8 new_ch, u8 ch_offset); ++void issue_addba_req(_adapter *adapter, unsigned char *ra, u8 tid); ++void issue_addba_rsp(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u8 size); ++u8 issue_addba_rsp_wait_ack(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u8 size, int try_cnt, int wait_ms); ++void issue_del_ba(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator); ++int issue_del_ba_ex(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator, int try_cnt, int wait_ms); ++ ++#ifdef CONFIG_IEEE80211W ++void issue_action_SA_Query(_adapter *padapter, unsigned char *raddr, unsigned char action, unsigned short tid, u8 key_type); ++int issue_deauth_11w(_adapter *padapter, unsigned char *da, unsigned short reason, u8 key_type); ++extern void init_dot11w_expire_timer(_adapter *padapter, struct sta_info *psta); ++#endif /* CONFIG_IEEE80211W */ ++int issue_action_SM_PS(_adapter *padapter , unsigned char *raddr , u8 NewMimoPsMode); ++int issue_action_SM_PS_wait_ack(_adapter *padapter, unsigned char *raddr, u8 NewMimoPsMode, int try_cnt, int wait_ms); ++ ++unsigned int send_delba_sta_tid(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid, u8 force); ++unsigned int send_delba_sta_tid_wait_ack(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid, u8 force); ++ ++unsigned int send_delba(_adapter *padapter, u8 initiator, u8 *addr); ++unsigned int send_beacon(_adapter *padapter); ++ ++void start_clnt_assoc(_adapter *padapter); ++void start_clnt_auth(_adapter *padapter); ++void start_clnt_join(_adapter *padapter); ++void start_create_ibss(_adapter *padapter); ++ ++unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnAssocRsp(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnProbeReq(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnProbeRsp(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int DoReserved(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnAtim(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnDisassoc(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnAuth(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnAuthClient(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnDeAuth(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnAction(_adapter *padapter, union recv_frame *precv_frame); ++ ++unsigned int on_action_spct(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnAction_qos(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnAction_dls(_adapter *padapter, union recv_frame *precv_frame); ++#ifdef CONFIG_RTW_WNM ++unsigned int on_action_wnm(_adapter *adapter, union recv_frame *rframe); ++#endif ++ ++#define RX_AMPDU_ACCEPT_INVALID 0xFF ++#define RX_AMPDU_SIZE_INVALID 0xFF ++ ++enum rx_ampdu_reason { ++ RX_AMPDU_DRV_FIXED = 1, ++ RX_AMPDU_BTCOEX = 2, /* not used, because BTCOEX has its own variable management */ ++ RX_AMPDU_DRV_SCAN = 3, ++}; ++u8 rtw_rx_ampdu_size(_adapter *adapter); ++bool rtw_rx_ampdu_is_accept(_adapter *adapter); ++bool rtw_rx_ampdu_set_size(_adapter *adapter, u8 size, u8 reason); ++bool rtw_rx_ampdu_set_accept(_adapter *adapter, u8 accept, u8 reason); ++u8 rx_ampdu_apply_sta_tid(_adapter *adapter, struct sta_info *sta, u8 tid, u8 accept, u8 size); ++u8 rx_ampdu_apply_sta(_adapter *adapter, struct sta_info *sta, u8 accept, u8 size); ++u16 rtw_rx_ampdu_apply(_adapter *adapter); ++ ++unsigned int OnAction_back(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int on_action_public(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnAction_ft(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnAction_ht(_adapter *padapter, union recv_frame *precv_frame); ++#ifdef CONFIG_IEEE80211W ++unsigned int OnAction_sa_query(_adapter *padapter, union recv_frame *precv_frame); ++#endif /* CONFIG_IEEE80211W */ ++unsigned int OnAction_wmm(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnAction_vht(_adapter *padapter, union recv_frame *precv_frame); ++unsigned int OnAction_p2p(_adapter *padapter, union recv_frame *precv_frame); ++ ++#ifdef CONFIG_RTW_80211R ++void start_clnt_ft_action(_adapter *padapter, u8 *pTargetAddr); ++void issue_action_ft_request(_adapter *padapter, u8 *pTargetAddr); ++void report_ft_event(_adapter *padapter); ++void report_ft_reassoc_event(_adapter *padapter, u8 *pMacAddr); ++void ft_link_timer_hdl(_adapter *padapter); ++void ft_roam_timer_hdl(_adapter *padapter); ++#endif ++void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res); ++void mlmeext_sta_del_event_callback(_adapter *padapter); ++void mlmeext_sta_add_event_callback(_adapter *padapter, struct sta_info *psta); ++ ++void linked_status_chk(_adapter *padapter, u8 from_timer); ++ ++void _linked_info_dump(_adapter *padapter); ++ ++void survey_timer_hdl(_adapter *padapter); ++void link_timer_hdl(_adapter *padapter); ++void addba_timer_hdl(struct sta_info *psta); ++#ifdef CONFIG_IEEE80211W ++void sa_query_timer_hdl(struct sta_info *psta); ++#endif /* CONFIG_IEEE80211W */ ++#if 0 ++void reauth_timer_hdl(_adapter *padapter); ++void reassoc_timer_hdl(_adapter *padapter); ++#endif ++ ++#define set_survey_timer(mlmeext, ms) \ ++ do { \ ++ /*RTW_INFO("%s set_survey_timer(%p, %d)\n", __FUNCTION__, (mlmeext), (ms));*/ \ ++ _set_timer(&(mlmeext)->survey_timer, (ms)); \ ++ } while (0) ++ ++#define set_link_timer(mlmeext, ms) \ ++ do { \ ++ /*RTW_INFO("%s set_link_timer(%p, %d)\n", __FUNCTION__, (mlmeext), (ms));*/ \ ++ _set_timer(&(mlmeext)->link_timer, (ms)); \ ++ } while (0) ++ ++extern int cckrates_included(unsigned char *rate, int ratelen); ++extern int cckratesonly_included(unsigned char *rate, int ratelen); ++ ++extern void process_addba_req(_adapter *padapter, u8 *paddba_req, u8 *addr); ++ ++extern void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len); ++extern void correct_TSF(_adapter *padapter, struct mlme_ext_priv *pmlmeext); ++extern void adaptive_early_32k(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len); ++extern u8 traffic_status_watchdog(_adapter *padapter, u8 from_timer); ++ ++ ++void rtw_join_done_chk_ch(_adapter *padapter, int join_res); ++ ++int rtw_chk_start_clnt_join(_adapter *padapter, u8 *ch, u8 *bw, u8 *offset); ++ ++#ifdef CONFIG_PLATFORM_ARM_SUN8I ++ #define BUSY_TRAFFIC_SCAN_DENY_PERIOD 8000 ++#else ++ #define BUSY_TRAFFIC_SCAN_DENY_PERIOD 12000 ++#endif ++ ++struct cmd_hdl { ++ uint parmsize; ++ u8(*h2cfuns)(struct _ADAPTER *padapter, u8 *pbuf); ++}; ++ ++ ++u8 read_macreg_hdl(_adapter *padapter, u8 *pbuf); ++u8 write_macreg_hdl(_adapter *padapter, u8 *pbuf); ++u8 read_bbreg_hdl(_adapter *padapter, u8 *pbuf); ++u8 write_bbreg_hdl(_adapter *padapter, u8 *pbuf); ++u8 read_rfreg_hdl(_adapter *padapter, u8 *pbuf); ++u8 write_rfreg_hdl(_adapter *padapter, u8 *pbuf); ++ ++ ++u8 NULL_hdl(_adapter *padapter, u8 *pbuf); ++u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf); ++u8 disconnect_hdl(_adapter *padapter, u8 *pbuf); ++u8 createbss_hdl(_adapter *padapter, u8 *pbuf); ++u8 setopmode_hdl(_adapter *padapter, u8 *pbuf); ++u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf); ++u8 setauth_hdl(_adapter *padapter, u8 *pbuf); ++u8 setkey_hdl(_adapter *padapter, u8 *pbuf); ++u8 set_stakey_hdl(_adapter *padapter, u8 *pbuf); ++u8 set_assocsta_hdl(_adapter *padapter, u8 *pbuf); ++u8 del_assocsta_hdl(_adapter *padapter, u8 *pbuf); ++u8 add_ba_hdl(_adapter *padapter, unsigned char *pbuf); ++u8 add_ba_rsp_hdl(_adapter *padapter, unsigned char *pbuf); ++ ++void rtw_ap_wep_pk_setting(_adapter *adapter, struct sta_info *psta); ++ ++u8 mlme_evt_hdl(_adapter *padapter, unsigned char *pbuf); ++u8 h2c_msg_hdl(_adapter *padapter, unsigned char *pbuf); ++u8 chk_bmc_sleepq_hdl(_adapter *padapter, unsigned char *pbuf); ++u8 tx_beacon_hdl(_adapter *padapter, unsigned char *pbuf); ++u8 set_ch_hdl(_adapter *padapter, u8 *pbuf); ++u8 set_chplan_hdl(_adapter *padapter, unsigned char *pbuf); ++u8 led_blink_hdl(_adapter *padapter, unsigned char *pbuf); ++u8 set_csa_hdl(_adapter *padapter, unsigned char *pbuf); /* Kurt: Handling DFS channel switch announcement ie. */ ++u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf); ++u8 run_in_thread_hdl(_adapter *padapter, u8 *pbuf); ++u8 rtw_getmacreg_hdl(_adapter *padapter, u8 *pbuf); ++ ++#define GEN_DRV_CMD_HANDLER(size, cmd) {size, &cmd ## _hdl}, ++#define GEN_MLME_EXT_HANDLER(size, cmd) {size, cmd}, ++ ++#ifdef _RTW_CMD_C_ ++ ++struct cmd_hdl wlancmds[] = { ++ GEN_DRV_CMD_HANDLER(sizeof(struct readMAC_parm), rtw_getmacreg) /*0*/ ++ GEN_DRV_CMD_HANDLER(0, NULL) ++ GEN_DRV_CMD_HANDLER(0, NULL) ++ GEN_DRV_CMD_HANDLER(0, NULL) ++ GEN_DRV_CMD_HANDLER(0, NULL) ++ GEN_DRV_CMD_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) /*10*/ ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(sizeof(struct joinbss_parm), join_cmd_hdl) /*14*/ ++ GEN_MLME_EXT_HANDLER(sizeof(struct disconnect_parm), disconnect_hdl) ++ GEN_MLME_EXT_HANDLER(sizeof(struct createbss_parm), createbss_hdl) ++ GEN_MLME_EXT_HANDLER(sizeof(struct setopmode_parm), setopmode_hdl) ++ GEN_MLME_EXT_HANDLER(sizeof(struct sitesurvey_parm), sitesurvey_cmd_hdl) /*18*/ ++ GEN_MLME_EXT_HANDLER(sizeof(struct setauth_parm), setauth_hdl) ++ GEN_MLME_EXT_HANDLER(sizeof(struct setkey_parm), setkey_hdl) /*20*/ ++ GEN_MLME_EXT_HANDLER(sizeof(struct set_stakey_parm), set_stakey_hdl) ++ GEN_MLME_EXT_HANDLER(sizeof(struct set_assocsta_parm), NULL) ++ GEN_MLME_EXT_HANDLER(sizeof(struct del_assocsta_parm), NULL) ++ GEN_MLME_EXT_HANDLER(sizeof(struct setstapwrstate_parm), NULL) ++ GEN_MLME_EXT_HANDLER(sizeof(struct setbasicrate_parm), NULL) ++ GEN_MLME_EXT_HANDLER(sizeof(struct getbasicrate_parm), NULL) ++ GEN_MLME_EXT_HANDLER(sizeof(struct setdatarate_parm), NULL) ++ GEN_MLME_EXT_HANDLER(sizeof(struct getdatarate_parm), NULL) ++ GEN_MLME_EXT_HANDLER(sizeof(struct setphyinfo_parm), NULL) ++ GEN_MLME_EXT_HANDLER(sizeof(struct getphyinfo_parm), NULL) /*30*/ ++ GEN_MLME_EXT_HANDLER(sizeof(struct setphy_parm), NULL) ++ GEN_MLME_EXT_HANDLER(sizeof(struct getphy_parm), NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) /*40*/ ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(sizeof(struct addBaReq_parm), add_ba_hdl) ++ GEN_MLME_EXT_HANDLER(sizeof(struct set_ch_parm), set_ch_hdl) /* 46 */ ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) /*50*/ ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(sizeof(struct Tx_Beacon_param), tx_beacon_hdl) /*55*/ ++ ++ GEN_MLME_EXT_HANDLER(0, mlme_evt_hdl) /*56*/ ++ GEN_MLME_EXT_HANDLER(0, rtw_drvextra_cmd_hdl) /*57*/ ++ ++ GEN_MLME_EXT_HANDLER(0, h2c_msg_hdl) /*58*/ ++ GEN_MLME_EXT_HANDLER(sizeof(struct SetChannelPlan_param), set_chplan_hdl) /*59*/ ++ GEN_MLME_EXT_HANDLER(sizeof(struct LedBlink_param), led_blink_hdl) /*60*/ ++ ++ GEN_MLME_EXT_HANDLER(sizeof(struct SetChannelSwitch_param), set_csa_hdl) /*61*/ ++ GEN_MLME_EXT_HANDLER(sizeof(struct TDLSoption_param), tdls_hdl) /*62*/ ++ GEN_MLME_EXT_HANDLER(0, chk_bmc_sleepq_hdl) /*63*/ ++ GEN_MLME_EXT_HANDLER(sizeof(struct RunInThread_param), run_in_thread_hdl) /*64*/ ++ GEN_MLME_EXT_HANDLER(sizeof(struct addBaRsp_parm), add_ba_rsp_hdl) /* 65 */ ++}; ++ ++#endif ++ ++struct C2HEvent_Header { ++ ++#ifdef CONFIG_LITTLE_ENDIAN ++ ++ unsigned int len:16; ++ unsigned int ID:8; ++ unsigned int seq:8; ++ ++#elif defined(CONFIG_BIG_ENDIAN) ++ ++ unsigned int seq:8; ++ unsigned int ID:8; ++ unsigned int len:16; ++ ++#else ++ ++# error "Must be LITTLE or BIG Endian" ++ ++#endif ++ ++ unsigned int rsvd; ++ ++}; ++ ++void rtw_dummy_event_callback(_adapter *adapter , u8 *pbuf); ++void rtw_fwdbg_event_callback(_adapter *adapter , u8 *pbuf); ++ ++enum rtw_c2h_event { ++ GEN_EVT_CODE(_Read_MACREG) = 0, /*0*/ ++ GEN_EVT_CODE(_Read_BBREG), ++ GEN_EVT_CODE(_Read_RFREG), ++ GEN_EVT_CODE(_Read_EEPROM), ++ GEN_EVT_CODE(_Read_EFUSE), ++ GEN_EVT_CODE(_Read_CAM), /*5*/ ++ GEN_EVT_CODE(_Get_BasicRate), ++ GEN_EVT_CODE(_Get_DataRate), ++ GEN_EVT_CODE(_Survey), /*8*/ ++ GEN_EVT_CODE(_SurveyDone), /*9*/ ++ ++ GEN_EVT_CODE(_JoinBss) , /*10*/ ++ GEN_EVT_CODE(_AddSTA), ++ GEN_EVT_CODE(_DelSTA), ++ GEN_EVT_CODE(_AtimDone) , ++ GEN_EVT_CODE(_TX_Report), ++ GEN_EVT_CODE(_CCX_Report), /*15*/ ++ GEN_EVT_CODE(_DTM_Report), ++ GEN_EVT_CODE(_TX_Rate_Statistics), ++ GEN_EVT_CODE(_C2HLBK), ++ GEN_EVT_CODE(_FWDBG), ++ GEN_EVT_CODE(_C2HFEEDBACK), /*20*/ ++ GEN_EVT_CODE(_ADDBA), ++ GEN_EVT_CODE(_C2HBCN), ++ GEN_EVT_CODE(_ReportPwrState), /* filen: only for PCIE, USB */ ++ GEN_EVT_CODE(_CloseRF), /* filen: only for PCIE, work around ASPM */ ++ GEN_EVT_CODE(_WMM), /*25*/ ++#ifdef CONFIG_IEEE80211W ++ GEN_EVT_CODE(_TimeoutSTA), ++#endif /* CONFIG_IEEE80211W */ ++#ifdef CONFIG_RTW_80211R ++ GEN_EVT_CODE(_FT_REASSOC), ++#endif ++ MAX_C2HEVT ++}; ++ ++ ++#ifdef _RTW_MLME_EXT_C_ ++ ++static struct fwevent wlanevents[] = { ++ {0, rtw_dummy_event_callback}, /*0*/ ++ {0, NULL}, ++ {0, NULL}, ++ {0, NULL}, ++ {0, NULL}, ++ {0, NULL}, ++ {0, NULL}, ++ {0, NULL}, ++ {0, &rtw_survey_event_callback}, /*8*/ ++ {sizeof(struct surveydone_event), &rtw_surveydone_event_callback}, /*9*/ ++ ++ {0, &rtw_joinbss_event_callback}, /*10*/ ++ {sizeof(struct stassoc_event), &rtw_stassoc_event_callback}, ++ {sizeof(struct stadel_event), &rtw_stadel_event_callback}, ++ {0, &rtw_atimdone_event_callback}, ++ {0, rtw_dummy_event_callback}, ++ {0, NULL}, /*15*/ ++ {0, NULL}, ++ {0, NULL}, ++ {0, NULL}, ++ {0, rtw_fwdbg_event_callback}, ++ {0, NULL}, /*20*/ ++ {0, NULL}, ++ {0, NULL}, ++ {0, &rtw_cpwm_event_callback}, ++ {0, NULL}, ++ {0, &rtw_wmm_event_callback}, /*25*/ ++#ifdef CONFIG_IEEE80211W ++ {sizeof(struct stadel_event), &rtw_sta_timeout_event_callback}, ++#endif /* CONFIG_IEEE80211W */ ++#ifdef CONFIG_RTW_80211R ++ {sizeof(struct stassoc_event), &rtw_ft_reassoc_event_callback}, ++#endif ++}; ++ ++#endif/* _RTW_MLME_EXT_C_ */ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mlme.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mlme.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mlme.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mlme.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,1205 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_MLME_H_ ++#define __RTW_MLME_H_ ++ ++ ++#define MAX_BSS_CNT 128 ++/* #define MAX_JOIN_TIMEOUT 2000 */ ++/* #define MAX_JOIN_TIMEOUT 2500 */ ++#define MAX_JOIN_TIMEOUT 6500 ++ ++/* Commented by Albert 20101105 ++ * Increase the scanning timeout because of increasing the SURVEY_TO value. */ ++ ++#define SCANNING_TIMEOUT 8000 ++#ifdef CONFIG_SCAN_BACKOP ++#define CONC_SCANNING_TIMEOUT_SINGLE_BAND 10000 ++#define CONC_SCANNING_TIMEOUT_DUAL_BAND 15000 ++#endif ++ ++#ifdef PALTFORM_OS_WINCE ++#define SCANQUEUE_LIFETIME 12000000 /* unit:us */ ++#else ++#define SCANQUEUE_LIFETIME 20000 /* 20sec, unit:msec */ ++#endif ++ ++#define WIFI_NULL_STATE 0x00000000 ++#define WIFI_ASOC_STATE 0x00000001 /* Linked */ ++#define WIFI_REASOC_STATE 0x00000002 ++#define WIFI_SLEEP_STATE 0x00000004 ++#define WIFI_STATION_STATE 0x00000008 ++#define WIFI_AP_STATE 0x00000010 ++#define WIFI_ADHOC_STATE 0x00000020 ++#define WIFI_ADHOC_MASTER_STATE 0x00000040 ++#define WIFI_UNDER_LINKING 0x00000080 ++#define WIFI_UNDER_WPS 0x00000100 ++/*#define WIFI_UNDEFINED_STATE 0x00000200*/ ++#define WIFI_STA_ALIVE_CHK_STATE 0x00000400 ++#define WIFI_SITE_MONITOR 0x00000800 /* under site surveying */ ++#define WIFI_WDS 0x00001000 ++#define WIFI_WDS_RX_BEACON 0x00002000 /* already rx WDS AP beacon */ ++#define WIFI_AUTOCONF 0x00004000 ++#define WIFI_AUTOCONF_IND 0x00008000 ++#define WIFI_MP_STATE 0x00010000 ++#define WIFI_MP_CTX_BACKGROUND 0x00020000 /* in continuous tx background */ ++#define WIFI_MP_CTX_ST 0x00040000 /* in continuous tx with single-tone */ ++#define WIFI_MP_CTX_BACKGROUND_PENDING 0x00080000 /* pending in continuous tx background due to out of skb */ ++#define WIFI_MP_CTX_CCK_HW 0x00100000 /* in continuous tx */ ++#define WIFI_MP_CTX_CCK_CS 0x00200000 /* in continuous tx with carrier suppression */ ++#define WIFI_MP_LPBK_STATE 0x00400000 ++#define WIFI_OP_CH_SWITCHING 0x00800000 ++/*#define WIFI_UNDEFINED_STATE 0x01000000*/ ++/*#define WIFI_UNDEFINED_STATE 0x02000000*/ ++/*#define WIFI_UNDEFINED_STATE 0x04000000*/ ++/*#define WIFI_UNDEFINED_STATE 0x08000000*/ ++/*#define WIFI_UNDEFINED_STATE 0x10000000*/ ++/*#define WIFI_UNDEFINED_STATE 0x20000000*/ ++/*#define WIFI_UNDEFINED_STATE 0x40000000*/ ++#define WIFI_MONITOR_STATE 0x80000000 ++ ++#define MIRACAST_DISABLED 0 ++#define MIRACAST_SOURCE BIT0 ++#define MIRACAST_SINK BIT1 ++ ++#define MIRACAST_MODE_REVERSE(mode) \ ++ ((((mode) & MIRACAST_SOURCE) ? MIRACAST_SINK : 0) | (((mode) & MIRACAST_SINK) ? MIRACAST_SOURCE : 0)) ++ ++bool is_miracast_enabled(_adapter *adapter); ++bool rtw_chk_miracast_mode(_adapter *adapter, u8 mode); ++const char *get_miracast_mode_str(int mode); ++void rtw_wfd_st_switch(struct sta_info *sta, bool on); ++ ++#define MLME_STATE(adapter) get_fwstate(&((adapter)->mlmepriv)) ++ ++#define MLME_IS_STA(adapter) (MLME_STATE((adapter)) & WIFI_STATION_STATE) ++#define MLME_IS_AP(adapter) (MLME_STATE((adapter)) & WIFI_AP_STATE) ++#define MLME_IS_ADHOC(adapter) (MLME_STATE((adapter)) & WIFI_ADHOC_STATE) ++#define MLME_IS_ADHOC_MASTER(adapter) (MLME_STATE((adapter)) & WIFI_ADHOC_MASTER_STATE) ++#define MLME_IS_MONITOR(adapter) (MLME_STATE((adapter)) & WIFI_MONITOR_STATE) ++#define MLME_IS_MP(adapter) (MLME_STATE((adapter)) & WIFI_MP_STATE) ++#ifdef CONFIG_P2P ++ #define MLME_IS_PD(adapter) rtw_p2p_chk_role(&(adapter)->wdinfo, P2P_ROLE_DEVICE) ++ #define MLME_IS_GC(adapter) rtw_p2p_chk_role(&(adapter)->wdinfo, P2P_ROLE_CLIENT) ++ #define MLME_IS_GO(adapter) rtw_p2p_chk_role(&(adapter)->wdinfo, P2P_ROLE_GO) ++#else /* !CONFIG_P2P */ ++ #define MLME_IS_PD(adapter) 0 ++ #define MLME_IS_GC(adapter) 0 ++ #define MLME_IS_GO(adapter) 0 ++#endif /* !CONFIG_P2P */ ++ ++#if defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_P2P) ++#define MLME_IS_ROCH(adapter) (rtw_cfg80211_get_is_roch(adapter) == _TRUE) ++#else ++#define MLME_IS_ROCH(adapter) 0 ++#endif ++ ++#define MLME_IS_MSRC(adapter) rtw_chk_miracast_mode((adapter), MIRACAST_SOURCE) ++#define MLME_IS_MSINK(adapter) rtw_chk_miracast_mode((adapter), MIRACAST_SINK) ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++#define MLME_IS_MGMT_TX(adapter) rtw_cfg80211_get_is_mgmt_tx(adapter) ++#else ++#define MLME_IS_MGMT_TX(adapter) 0 ++#endif ++ ++#define MLME_STATE_FMT "%s%s%s%s%s%s%s%s%s%s%s%s" ++#define MLME_STATE_ARG(adapter) \ ++ MLME_IS_STA((adapter)) ? (MLME_IS_GC((adapter)) ? " GC" : " STA") : \ ++ MLME_IS_AP((adapter)) ? (MLME_IS_GO((adapter)) ? " GO" : " AP") : \ ++ MLME_IS_ADHOC((adapter)) ? " ADHOC" : \ ++ MLME_IS_ADHOC_MASTER((adapter)) ? " ADHOC_M" : \ ++ MLME_IS_MONITOR((adapter)) ? " MONITOR" : \ ++ MLME_IS_MP((adapter)) ? " MP" : "", \ ++ MLME_IS_PD((adapter)) ? " PD" : "", \ ++ MLME_IS_MSRC((adapter)) ? " MSRC" : "", \ ++ MLME_IS_MSINK((adapter)) ? " MSINK" : "", \ ++ (MLME_STATE((adapter)) & WIFI_SITE_MONITOR) ? " SCAN" : "", \ ++ (MLME_STATE((adapter)) & WIFI_UNDER_LINKING) ? " LINKING" : "", \ ++ (MLME_STATE((adapter)) & WIFI_ASOC_STATE) ? " ASOC" : "", \ ++ (MLME_STATE((adapter)) & WIFI_OP_CH_SWITCHING) ? " OP_CH_SW" : "", \ ++ (MLME_STATE((adapter)) & WIFI_UNDER_WPS) ? " WPS" : "", \ ++ MLME_IS_ROCH((adapter)) ? " ROCH" : "", \ ++ MLME_IS_MGMT_TX((adapter)) ? " MGMT_TX" : "", \ ++ (MLME_STATE((adapter)) & WIFI_SLEEP_STATE) ? " SLEEP" : "" ++ ++#define _FW_UNDER_LINKING WIFI_UNDER_LINKING ++#define _FW_LINKED WIFI_ASOC_STATE ++#define _FW_UNDER_SURVEY WIFI_SITE_MONITOR ++ ++ ++enum dot11AuthAlgrthmNum { ++ dot11AuthAlgrthm_Open = 0, ++ dot11AuthAlgrthm_Shared, ++ dot11AuthAlgrthm_8021X, ++ dot11AuthAlgrthm_Auto, ++ dot11AuthAlgrthm_WAPI, ++ dot11AuthAlgrthm_MaxNum ++}; ++ ++/* Scan type including active and passive scan. */ ++typedef enum _RT_SCAN_TYPE { ++ SCAN_PASSIVE, ++ SCAN_ACTIVE, ++ SCAN_MIX, ++} RT_SCAN_TYPE, *PRT_SCAN_TYPE; ++ ++#define WIFI_FREQUENCY_BAND_AUTO 0 ++#define WIFI_FREQUENCY_BAND_5GHZ 1 ++#define WIFI_FREQUENCY_BAND_2GHZ 2 ++ ++#define rtw_band_valid(band) ((band) <= WIFI_FREQUENCY_BAND_2GHZ) ++ ++enum DriverInterface { ++ DRIVER_WEXT = 1, ++ DRIVER_CFG80211 = 2 ++}; ++ ++enum SCAN_RESULT_TYPE { ++ SCAN_RESULT_P2P_ONLY = 0, /* Will return all the P2P devices. */ ++ SCAN_RESULT_ALL = 1, /* Will return all the scanned device, include AP. */ ++ SCAN_RESULT_WFD_TYPE = 2 /* Will just return the correct WFD device. */ ++ /* If this device is Miracast sink device, it will just return all the Miracast source devices. */ ++}; ++ ++/* ++ ++there are several "locks" in mlme_priv, ++since mlme_priv is a shared resource between many threads, ++like ISR/Call-Back functions, the OID handlers, and even timer functions. ++ ++ ++Each _queue has its own locks, already. ++Other items are protected by mlme_priv.lock. ++ ++To avoid possible dead lock, any thread trying to modifiying mlme_priv ++SHALL not lock up more than one locks at a time! ++ ++*/ ++ ++ ++#define traffic_threshold 10 ++#define traffic_scan_period 500 ++ ++struct sitesurvey_ctrl { ++ u64 last_tx_pkts; ++ uint last_rx_pkts; ++ sint traffic_busy; ++ _timer sitesurvey_ctrl_timer; ++}; ++ ++typedef struct _RT_LINK_DETECT_T { ++ u32 NumTxOkInPeriod; ++ u32 NumRxOkInPeriod; ++ u32 NumRxUnicastOkInPeriod; ++ BOOLEAN bBusyTraffic; ++ BOOLEAN bTxBusyTraffic; ++ BOOLEAN bRxBusyTraffic; ++ BOOLEAN bHigherBusyTraffic; /* For interrupt migration purpose. */ ++ BOOLEAN bHigherBusyRxTraffic; /* We may disable Tx interrupt according as Rx traffic. */ ++ BOOLEAN bHigherBusyTxTraffic; /* We may disable Tx interrupt according as Tx traffic. */ ++ /* u8 TrafficBusyState; */ ++ u8 TrafficTransitionCount; ++ u32 LowPowerTransitionCount; ++} RT_LINK_DETECT_T, *PRT_LINK_DETECT_T; ++ ++struct profile_info { ++ u8 ssidlen; ++ u8 ssid[WLAN_SSID_MAXLEN]; ++ u8 peermac[ETH_ALEN]; ++}; ++ ++struct tx_invite_req_info { ++ u8 token; ++ u8 benable; ++ u8 go_ssid[WLAN_SSID_MAXLEN]; ++ u8 ssidlen; ++ u8 go_bssid[ETH_ALEN]; ++ u8 peer_macaddr[ETH_ALEN]; ++ u8 operating_ch; /* This information will be set by using the p2p_set op_ch=x */ ++ u8 peer_ch; /* The listen channel for peer P2P device */ ++ ++}; ++ ++struct tx_invite_resp_info { ++ u8 token; /* Used to record the dialog token of p2p invitation request frame. */ ++}; ++ ++#ifdef CONFIG_WFD ++ ++struct wifi_display_info { ++ u16 wfd_enable; /* Eanble/Disable the WFD function. */ ++ u16 init_rtsp_ctrlport; /* init value of rtsp_ctrlport when WFD enable */ ++ u16 rtsp_ctrlport; /* TCP port number at which the this WFD device listens for RTSP messages, 0 when WFD disable */ ++ u16 tdls_rtsp_ctrlport; /* rtsp_ctrlport used by tdls, will sync when rtsp_ctrlport is changed by user */ ++ u16 peer_rtsp_ctrlport; /* TCP port number at which the peer WFD device listens for RTSP messages */ ++ /* This filed should be filled when receiving the gropu negotiation request */ ++ ++ u8 peer_session_avail; /* WFD session is available or not for the peer wfd device. */ ++ /* This variable will be set when sending the provisioning discovery request to peer WFD device. */ ++ /* And this variable will be reset when it is read by using the iwpriv p2p_get wfd_sa command. */ ++ u8 ip_address[4]; ++ u8 peer_ip_address[4]; ++ u8 wfd_pc; /* WFD preferred connection */ ++ /* 0 -> Prefer to use the P2P for WFD connection on peer side. */ ++ /* 1 -> Prefer to use the TDLS for WFD connection on peer side. */ ++ ++ u8 wfd_device_type; /* WFD Device Type */ ++ /* 0 -> WFD Source Device */ ++ /* 1 -> WFD Primary Sink Device */ ++ enum SCAN_RESULT_TYPE scan_result_type; /* Used when P2P is enable. This parameter will impact the scan result. */ ++ u8 op_wfd_mode; ++ u8 stack_wfd_mode; ++}; ++#endif /* CONFIG_WFD */ ++ ++struct tx_provdisc_req_info { ++ u16 wps_config_method_request; /* Used when sending the provisioning request frame */ ++ u16 peer_channel_num[2]; /* The channel number which the receiver stands. */ ++ NDIS_802_11_SSID ssid; ++ u8 peerDevAddr[ETH_ALEN]; /* Peer device address */ ++ u8 peerIFAddr[ETH_ALEN]; /* Peer interface address */ ++ u8 benable; /* This provision discovery request frame is trigger to send or not */ ++}; ++ ++struct rx_provdisc_req_info { /* When peer device issue prov_disc_req first, we should store the following informations */ ++ u8 peerDevAddr[ETH_ALEN]; /* Peer device address */ ++ u8 strconfig_method_desc_of_prov_disc_req[4]; /* description for the config method located in the provisioning discovery request frame. */ ++ /* The UI must know this information to know which config method the remote p2p device is requiring. */ ++}; ++ ++struct tx_nego_req_info { ++ u16 peer_channel_num[2]; /* The channel number which the receiver stands. */ ++ u8 peerDevAddr[ETH_ALEN]; /* Peer device address */ ++ u8 benable; /* This negoitation request frame is trigger to send or not */ ++ u8 peer_ch; /* The listen channel for peer P2P device */ ++}; ++ ++struct group_id_info { ++ u8 go_device_addr[ETH_ALEN]; /* The GO's device address of this P2P group */ ++ u8 ssid[WLAN_SSID_MAXLEN]; /* The SSID of this P2P group */ ++}; ++ ++struct scan_limit_info { ++ u8 scan_op_ch_only; /* When this flag is set, the driver should just scan the operation channel */ ++#ifndef CONFIG_P2P_OP_CHK_SOCIAL_CH ++ u8 operation_ch[2]; /* Store the operation channel of invitation request frame */ ++#else ++ u8 operation_ch[5]; /* Store additional channel 1,6,11 for Android 4.2 IOT & Nexus 4 */ ++#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ ++}; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++struct cfg80211_wifidirect_info { ++ _timer remain_on_ch_timer; ++ u8 restore_channel; ++ struct ieee80211_channel remain_on_ch_channel; ++ enum nl80211_channel_type remain_on_ch_type; ++ ATOMIC_T ro_ch_cookie_gen; ++ u64 remain_on_ch_cookie; ++ bool is_ro_ch; ++ struct wireless_dev *ro_ch_wdev; ++ u32 last_ro_ch_time; /* this will be updated at the beginning and end of ro_ch */ ++}; ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++#ifdef CONFIG_P2P_WOWLAN ++ ++enum P2P_WOWLAN_RECV_FRAME_TYPE { ++ P2P_WOWLAN_RECV_NEGO_REQ = 0, ++ P2P_WOWLAN_RECV_INVITE_REQ = 1, ++ P2P_WOWLAN_RECV_PROVISION_REQ = 2, ++}; ++ ++struct p2p_wowlan_info { ++ ++ u8 is_trigger; ++ enum P2P_WOWLAN_RECV_FRAME_TYPE wowlan_recv_frame_type; ++ u8 wowlan_peer_addr[ETH_ALEN]; ++ u16 wowlan_peer_wpsconfig; ++ u8 wowlan_peer_is_persistent; ++ u8 wowlan_peer_invitation_type; ++}; ++ ++#endif /* CONFIG_P2P_WOWLAN */ ++ ++struct wifidirect_info { ++ _adapter *padapter; ++ _timer find_phase_timer; ++ _timer restore_p2p_state_timer; ++ ++ /* Used to do the scanning. After confirming the peer is availalble, the driver transmits the P2P frame to peer. */ ++ _timer pre_tx_scan_timer; ++ _timer reset_ch_sitesurvey; ++ _timer reset_ch_sitesurvey2; /* Just for resetting the scan limit function by using p2p nego */ ++#ifdef CONFIG_CONCURRENT_MODE ++ /* Used to switch the channel between legacy AP and listen state. */ ++ _timer ap_p2p_switch_timer; ++#endif ++ struct tx_provdisc_req_info tx_prov_disc_info; ++ struct rx_provdisc_req_info rx_prov_disc_info; ++ struct tx_invite_req_info invitereq_info; ++ struct profile_info profileinfo[P2P_MAX_PERSISTENT_GROUP_NUM]; /* Store the profile information of persistent group */ ++ struct tx_invite_resp_info inviteresp_info; ++ struct tx_nego_req_info nego_req_info; ++ struct group_id_info groupid_info; /* Store the group id information when doing the group negotiation handshake. */ ++ struct scan_limit_info rx_invitereq_info; /* Used for get the limit scan channel from the Invitation procedure */ ++ struct scan_limit_info p2p_info; /* Used for get the limit scan channel from the P2P negotiation handshake */ ++#ifdef CONFIG_WFD ++ struct wifi_display_info *wfd_info; ++#endif ++ ++#ifdef CONFIG_P2P_WOWLAN ++ struct p2p_wowlan_info p2p_wow_info; ++#endif /* CONFIG_P2P_WOWLAN */ ++ ++ enum P2P_ROLE role; ++ enum P2P_STATE pre_p2p_state; ++ enum P2P_STATE p2p_state; ++ u8 device_addr[ETH_ALEN]; /* The device address should be the mac address of this device. */ ++ u8 interface_addr[ETH_ALEN]; ++ u8 social_chan[4]; ++ u8 listen_channel; ++ u8 operating_channel; ++ u8 listen_dwell; /* This value should be between 1 and 3 */ ++ u8 support_rate[8]; ++ u8 p2p_wildcard_ssid[P2P_WILDCARD_SSID_LEN]; ++ u8 intent; /* should only include the intent value. */ ++ u8 p2p_peer_interface_addr[ETH_ALEN]; ++ u8 p2p_peer_device_addr[ETH_ALEN]; ++ u8 peer_intent; /* Included the intent value and tie breaker value. */ ++ u8 device_name[WPS_MAX_DEVICE_NAME_LEN]; /* Device name for displaying on searching device screen */ ++ u8 device_name_len; ++ u8 profileindex; /* Used to point to the index of profileinfo array */ ++ u8 peer_operating_ch; ++ u8 find_phase_state_exchange_cnt; ++ u16 device_password_id_for_nego; /* The device password ID for group negotation */ ++ u8 negotiation_dialog_token; ++ u8 nego_ssid[WLAN_SSID_MAXLEN]; /* SSID information for group negotitation */ ++ u8 nego_ssidlen; ++ u8 p2p_group_ssid[WLAN_SSID_MAXLEN]; ++ u8 p2p_group_ssid_len; ++ u8 persistent_supported; /* Flag to know the persistent function should be supported or not. */ ++ /* In the Sigma test, the Sigma will provide this enable from the sta_set_p2p CAPI. */ ++ /* 0: disable */ ++ /* 1: enable */ ++ u8 session_available; /* Flag to set the WFD session available to enable or disable "by Sigma" */ ++ /* In the Sigma test, the Sigma will disable the session available by using the sta_preset CAPI. */ ++ /* 0: disable */ ++ /* 1: enable */ ++ ++ u8 wfd_tdls_enable; /* Flag to enable or disable the TDLS by WFD Sigma */ ++ /* 0: disable */ ++ /* 1: enable */ ++ u8 wfd_tdls_weaksec; /* Flag to enable or disable the weak security function for TDLS by WFD Sigma */ ++ /* 0: disable */ ++ /* In this case, the driver can't issue the tdsl setup request frame. */ ++ /* 1: enable */ ++ /* In this case, the driver can issue the tdls setup request frame */ ++ /* even the current security is weak security. */ ++ ++ enum P2P_WPSINFO ui_got_wps_info; /* This field will store the WPS value (PIN value or PBC) that UI had got from the user. */ ++ u16 supported_wps_cm; /* This field describes the WPS config method which this driver supported. */ ++ /* The value should be the combination of config method defined in page104 of WPS v2.0 spec. */ ++ u8 external_uuid; /* UUID flag */ ++ u8 uuid[16]; /* UUID */ ++ uint channel_list_attr_len; /* This field will contain the length of body of P2P Channel List attribute of group negotitation response frame. */ ++ u8 channel_list_attr[100]; /* This field will contain the body of P2P Channel List attribute of group negotitation response frame. */ ++ /* We will use the channel_cnt and channel_list fields when constructing the group negotitation confirm frame. */ ++ u8 driver_interface; /* Indicate DRIVER_WEXT or DRIVER_CFG80211 */ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ u16 ext_listen_interval; /* The interval to be available with legacy AP (ms) */ ++ u16 ext_listen_period; /* The time period to be available for P2P listen state (ms) */ ++#endif ++#ifdef CONFIG_P2P_PS ++ enum P2P_PS_MODE p2p_ps_mode; /* indicate p2p ps mode */ ++ enum P2P_PS_STATE p2p_ps_state; /* indicate p2p ps state */ ++ u8 noa_index; /* Identifies and instance of Notice of Absence timing. */ ++ u8 ctwindow; /* Client traffic window. A period of time in TU after TBTT. */ ++ u8 opp_ps; /* opportunistic power save. */ ++ u8 noa_num; /* number of NoA descriptor in P2P IE. */ ++ u8 noa_count[P2P_MAX_NOA_NUM]; /* Count for owner, Type of client. */ ++ u32 noa_duration[P2P_MAX_NOA_NUM]; /* Max duration for owner, preferred or min acceptable duration for client. */ ++ u32 noa_interval[P2P_MAX_NOA_NUM]; /* Length of interval for owner, preferred or max acceptable interval of client. */ ++ u32 noa_start_time[P2P_MAX_NOA_NUM]; /* schedule expressed in terms of the lower 4 bytes of the TSF timer. */ ++#endif /* CONFIG_P2P_PS */ ++}; ++ ++struct tdls_ss_record { /* signal strength record */ ++ u8 macaddr[ETH_ALEN]; ++ u8 RxPWDBAll; ++ u8 is_tdls_sta; /* _TRUE: direct link sta, _FALSE: else */ ++}; ++ ++struct tdls_temp_mgmt { ++ u8 initiator; /* 0: None, 1: we initiate, 2: peer initiate */ ++ u8 peer_addr[ETH_ALEN]; ++}; ++ ++#ifdef CONFIG_TDLS_CH_SW ++struct tdls_ch_switch { ++ u32 ch_sw_state; ++ ATOMIC_T chsw_on; ++ u8 addr[ETH_ALEN]; ++ u8 off_ch_num; ++ u8 ch_offset; ++ u32 cur_time; ++ u8 delay_switch_back; ++ u8 dump_stack; ++ struct submit_ctx chsw_sctx; ++}; ++#endif ++ ++struct tdls_info { ++ u8 ap_prohibited; ++ u8 ch_switch_prohibited; ++ u8 link_established; ++ u8 sta_cnt; ++ u8 sta_maximum; /* 1:tdls sta is equal (NUM_STA-1), reach max direct link number; 0: else; */ ++ struct tdls_ss_record ss_record; ++#ifdef CONFIG_TDLS_CH_SW ++ struct tdls_ch_switch chsw_info; ++#endif ++ ++ u8 ch_sensing; ++ u8 cur_channel; ++ u8 collect_pkt_num[MAX_CHANNEL_NUM]; ++ _lock cmd_lock; ++ _lock hdl_lock; ++ u8 watchdog_count; ++ u8 dev_discovered; /* WFD_TDLS: for sigma test */ ++ u8 tdls_enable; ++ ++ /* Let wpa_supplicant to setup*/ ++ u8 driver_setup; ++#ifdef CONFIG_WFD ++ struct wifi_display_info *wfd_info; ++#endif ++}; ++ ++struct tdls_txmgmt { ++ u8 peer[ETH_ALEN]; ++ u8 action_code; ++ u8 dialog_token; ++ u16 status_code; ++ u8 *buf; ++ size_t len; ++}; ++ ++/* used for mlme_priv.roam_flags */ ++enum { ++ RTW_ROAM_ON_EXPIRED = BIT0, ++ RTW_ROAM_ON_RESUME = BIT1, ++ RTW_ROAM_ACTIVE = BIT2, ++}; ++ ++struct beacon_keys { ++ u8 ssid[IW_ESSID_MAX_SIZE]; ++ u32 ssid_len; ++ u8 bcn_channel; ++ u16 ht_cap_info; ++ u8 ht_info_infos_0_sco; /* bit0 & bit1 in infos[0] is second channel offset */ ++ int encryp_protocol; ++ int pairwise_cipher; ++ int group_cipher; ++ int is_8021x; ++}; ++#ifdef CONFIG_RTW_80211R ++#define FT_ACTION_REQ_LIMIT 4 ++ ++typedef enum _RTW_WIFI_FT_STA_STATUS { ++ RTW_FT_UNASSOCIATED_STA = 0, ++ RTW_FT_AUTHENTICATING_STA, ++ RTW_FT_AUTHENTICATED_STA, ++ RTW_FT_ASSOCIATING_STA, ++ RTW_FT_ASSOCIATED_STA, ++ RTW_FT_REQUESTING_STA, ++ RTW_FT_REQUESTED_STA, ++ RTW_FT_CONFIRMED_STA, ++ RTW_FT_UNSPECIFIED_STA ++} RTW_WIFI_FT_STA_STATUS; ++ ++#define rtw_chk_ft_status(adapter, status) ((adapter)->mlmepriv.ftpriv.ft_status == status) ++#define rtw_set_ft_status(adapter, status) \ ++ do { \ ++ ((adapter)->mlmepriv.ftpriv.ft_status = status); \ ++ } while (0) ++ ++#define rtw_reset_ft_status(adapter) \ ++ do { \ ++ ((adapter)->mlmepriv.ftpriv.ft_status = RTW_FT_UNASSOCIATED_STA); \ ++ } while (0) ++ ++typedef enum _RTW_WIFI_FT_CAPABILITY { ++ RTW_FT_STA_SUPPORTED = BIT0, ++ RTW_FT_STA_OVER_DS_SUPPORTED = BIT1, ++ RTW_FT_SUPPORTED = BIT2, ++ RTW_FT_OVER_DS_SUPPORTED = BIT3, ++} RTW_WIFI_FT_CAPABILITY; ++ ++#define rtw_chk_ft_flags(adapter, flags) ((adapter)->mlmepriv.ftpriv.ft_flags & (flags)) ++#define rtw_set_ft_flags(adapter, flags) \ ++ do { \ ++ ((adapter)->mlmepriv.ftpriv.ft_flags |= (flags)); \ ++ } while (0) ++ ++#define rtw_clr_ft_flags(adapter, flags) \ ++ do { \ ++ ((adapter)->mlmepriv.ftpriv.ft_flags &= ~(flags)); \ ++ } while (0) ++ ++#define RTW_MAX_FTIE_SZ 256 ++typedef struct _ft_priv { ++ u16 mdid; ++ u8 ft_cap; /*b0: FT over DS, b1: Resource Req Protocol Cap, b2~b7: Reserved*/ ++ u8 updated_ft_ies[RTW_MAX_FTIE_SZ]; ++ u16 updated_ft_ies_len; ++ u8 ft_action[RTW_MAX_FTIE_SZ]; ++ u16 ft_action_len; ++ struct cfg80211_ft_event_params ft_event; ++ u8 ft_roam_on_expired; ++ u8 ft_flags; ++ u32 ft_status; ++ u32 ft_req_retry_cnt; ++} ft_priv; ++#endif ++ ++struct mlme_priv { ++ ++ _lock lock; ++ sint fw_state; /* shall we protect this variable? maybe not necessarily... */ ++ u8 bScanInProcess; ++ u8 to_join; /* flag */ ++#ifdef CONFIG_LAYER2_ROAMING ++ u8 to_roam; /* roaming trying times */ ++ struct wlan_network *roam_network; /* the target of active roam */ ++ u8 roam_flags; ++ u8 roam_rssi_diff_th; /* rssi difference threshold for active scan candidate selection */ ++ u32 roam_scan_int_ms; /* scan interval for active roam */ ++ u32 roam_scanr_exp_ms; /* scan result expire time in ms for roam */ ++ u8 roam_tgt_addr[ETH_ALEN]; /* request to roam to speicific target without other consideration */ ++ u8 roam_rssi_threshold; ++ bool need_to_roam; ++#endif ++ ++ u8 *nic_hdl; ++ ++ _list *pscanned; ++ _queue free_bss_pool; ++ _queue scanned_queue; ++ u8 *free_bss_buf; ++ u32 num_of_scanned; ++ ++ NDIS_802_11_SSID assoc_ssid; ++ u8 assoc_bssid[6]; ++ ++ struct wlan_network cur_network; ++ struct wlan_network *cur_network_scanned; ++ ++ /* bcn check info */ ++ struct beacon_keys cur_beacon_keys; /* save current beacon keys */ ++ struct beacon_keys new_beacon_keys; /* save new beacon keys */ ++ u8 new_beacon_cnts; /* if new_beacon_cnts >= threshold, ap beacon is changed */ ++ ++#ifdef CONFIG_ARP_KEEP_ALIVE ++ /* for arp offload keep alive */ ++ u8 bGetGateway; ++ u8 GetGatewayTryCnt; ++ u8 gw_mac_addr[6]; ++ u8 gw_ip[4]; ++#endif ++ ++ /* uint wireless_mode; no used, remove it */ ++ ++ u32 auto_scan_int_ms; ++ ++ _timer assoc_timer; ++ ++ uint assoc_by_bssid; ++ uint assoc_by_rssi; ++ ++ _timer scan_to_timer; /* driver itself handles scan_timeout status. */ ++ u32 scan_start_time; /* used to evaluate the time spent in scanning */ ++ ++#ifdef CONFIG_SET_SCAN_DENY_TIMER ++ _timer set_scan_deny_timer; ++ ATOMIC_T set_scan_deny; /* 0: allowed, 1: deny */ ++#endif ++ ++ struct qos_priv qospriv; ++ ++#ifdef CONFIG_80211N_HT ++ ++ /* Number of non-HT AP/stations */ ++ int num_sta_no_ht; ++ ++ /* Number of HT AP/stations 20 MHz */ ++ /* int num_sta_ht_20mhz; */ ++ ++ ++ int num_FortyMHzIntolerant; ++ ++ struct ht_priv htpriv; ++ ++#endif ++ ++#ifdef CONFIG_80211AC_VHT ++ struct vht_priv vhtpriv; ++#endif ++#ifdef CONFIG_BEAMFORMING ++#if (BEAMFORMING_SUPPORT == 0)/*for driver beamforming*/ ++#ifndef RTW_BEAMFORMING_VERSION_2 ++ struct beamforming_info beamforming_info; ++#endif /* !RTW_BEAMFORMING_VERSION_2 */ ++#endif ++#endif ++ ++#ifdef CONFIG_DFS ++ u8 handle_dfs; ++#endif ++#ifdef CONFIG_DFS_MASTER ++ /* TODO: move to rfctl */ ++ _timer dfs_master_timer; ++#endif ++#ifdef CONFIG_RTW_80211R ++ ft_priv ftpriv; ++#endif ++ ++ RT_LINK_DETECT_T LinkDetectInfo; ++ ++ u8 acm_mask; /* for wmm acm mask */ ++ const struct country_chplan *country_ent; ++ u8 ChannelPlan; ++ RT_SCAN_TYPE scan_mode; /* active: 1, passive: 0 */ ++ ++ u8 *wps_probe_req_ie; ++ u32 wps_probe_req_ie_len; ++ ++ u8 ext_capab_ie_data[8];/*currently for ap mode only*/ ++ u8 ext_capab_ie_len; ++ ++ u8 *assoc_req; ++ u32 assoc_req_len; ++ ++ u8 *assoc_rsp; ++ u32 assoc_rsp_len; ++ ++#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) ++ /* Number of associated Non-ERP stations (i.e., stations using 802.11b ++ * in 802.11g BSS) */ ++ int num_sta_non_erp; ++ ++ /* Number of associated stations that do not support Short Slot Time */ ++ int num_sta_no_short_slot_time; ++ ++ /* Number of associated stations that do not support Short Preamble */ ++ int num_sta_no_short_preamble; ++ ++ ATOMIC_T olbc; /* Overlapping Legacy BSS Condition (Legacy b/g)*/ ++ ++ /* Number of HT associated stations that do not support greenfield */ ++ int num_sta_ht_no_gf; ++ ++ /* Number of associated non-HT stations */ ++ /* int num_sta_no_ht; */ ++ ++ /* Number of HT associated stations 20 MHz */ ++ int num_sta_ht_20mhz; ++ ++ /* number of associated stations 40MHz intolerant */ ++ int num_sta_40mhz_intolerant; ++ ++ /* Overlapping BSS information */ ++ ATOMIC_T olbc_ht; ++ ++#ifdef CONFIG_80211N_HT ++ int ht_20mhz_width_req; ++ int ht_intolerant_ch_reported; ++ u16 ht_op_mode; ++ u8 sw_to_20mhz; /*switch to 20Mhz BW*/ ++#endif /* CONFIG_80211N_HT */ ++ ++#ifdef CONFIG_RTW_80211R ++ u8 *auth_rsp; ++ u32 auth_rsp_len; ++#endif ++ ++ /* u8 *wps_probe_req_ie; */ ++ /* u32 wps_probe_req_ie_len; */ ++ ++ u8 *wps_beacon_ie; ++ u32 wps_beacon_ie_len; ++ ++ u8 *wps_probe_resp_ie; ++ u32 wps_probe_resp_ie_len; ++ ++ u8 *wps_assoc_resp_ie; ++ u32 wps_assoc_resp_ie_len; ++ ++ u8 *p2p_beacon_ie; ++ u32 p2p_beacon_ie_len; ++ ++ u8 *p2p_probe_req_ie; ++ u32 p2p_probe_req_ie_len; ++ ++ u8 *p2p_probe_resp_ie; ++ u32 p2p_probe_resp_ie_len; ++ ++ u8 *p2p_go_probe_resp_ie; /* for GO */ ++ u32 p2p_go_probe_resp_ie_len; /* for GO */ ++ ++ u8 *p2p_assoc_req_ie; ++ u32 p2p_assoc_req_ie_len; ++ ++ u8 *p2p_assoc_resp_ie; ++ u32 p2p_assoc_resp_ie_len; ++ ++ _lock bcn_update_lock; ++ u8 update_bcn; ++ ++ u8 ori_ch; ++ u8 ori_bw; ++ u8 ori_offset; ++#endif /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ ++ ++#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) ++ u8 *wfd_beacon_ie; ++ u32 wfd_beacon_ie_len; ++ ++ u8 *wfd_probe_req_ie; ++ u32 wfd_probe_req_ie_len; ++ ++ u8 *wfd_probe_resp_ie; ++ u32 wfd_probe_resp_ie_len; ++ ++ u8 *wfd_go_probe_resp_ie; /* for GO */ ++ u32 wfd_go_probe_resp_ie_len; /* for GO */ ++ ++ u8 *wfd_assoc_req_ie; ++ u32 wfd_assoc_req_ie_len; ++ ++ u8 *wfd_assoc_resp_ie; ++ u32 wfd_assoc_resp_ie_len; ++#endif ++ ++#ifdef RTK_DMP_PLATFORM ++ /* DMP kobject_hotplug function signal need in passive level */ ++ _workitem Linkup_workitem; ++ _workitem Linkdown_workitem; ++#endif ++ ++#ifdef CONFIG_INTEL_WIDI ++ int widi_state; ++ int listen_state; ++ _timer listen_timer; ++ ATOMIC_T rx_probe_rsp; /* 1:receive probe respone from RDS source. */ ++ u8 *l2sdTaBuffer; ++ u8 channel_idx; ++ u8 group_cnt; /* In WiDi 3.5, they specified another scan algo. for WFD/RDS co-existed */ ++ u8 sa_ext[L2SDTA_SERVICE_VE_LEN]; ++ ++ u8 widi_enable; ++ /** ++ * For WiDi 4; upper layer would set ++ * p2p_primary_device_type_category_id ++ * p2p_primary_device_type_sub_category_id ++ * p2p_secondary_device_type_category_id ++ * p2p_secondary_device_type_sub_category_id ++ */ ++ u16 p2p_pdt_cid; ++ u16 p2p_pdt_scid; ++ u8 num_p2p_sdt; ++ u16 p2p_sdt_cid[MAX_NUM_P2P_SDT]; ++ u16 p2p_sdt_scid[MAX_NUM_P2P_SDT]; ++ u8 p2p_reject_disable; /* When starting NL80211 wpa_supplicant/hostapd, it will call netdev_close */ ++ /* such that it will cause p2p disabled. Use this flag to reject. */ ++#endif /* CONFIG_INTEL_WIDI */ ++ u32 lastscantime; ++#ifdef CONFIG_CONCURRENT_MODE ++ u8 scanning_via_buddy_intf; ++#endif ++ ++#if 0 ++ u8 NumOfBcnInfoChkFail; ++ u32 timeBcnInfoChkStart; ++#endif ++ ++#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE ++ u32 vendor_ie_mask[WLAN_MAX_VENDOR_IE_NUM]; ++ u8 vendor_ie[WLAN_MAX_VENDOR_IE_NUM][WLAN_MAX_VENDOR_IE_LEN]; ++ u32 vendor_ielen[WLAN_MAX_VENDOR_IE_NUM]; ++#endif ++}; ++ ++#define mlme_set_scan_to_timer(mlme, ms) \ ++ do { \ ++ /* RTW_INFO("%s set_scan_to_timer(%p, %d)\n", __FUNCTION__, (mlme), (ms)); */ \ ++ _set_timer(&(mlme)->scan_to_timer, (ms)); \ ++ } while (0) ++ ++#define rtw_mlme_set_auto_scan_int(adapter, ms) \ ++ do { \ ++ adapter->mlmepriv.auto_scan_int_ms = ms; \ ++ } while (0) ++ ++#define RTW_AUTO_SCAN_REASON_UNSPECIFIED 0 ++#define RTW_AUTO_SCAN_REASON_2040_BSS BIT0 ++#define RTW_AUTO_SCAN_REASON_ACS BIT1 ++#define RTW_AUTO_SCAN_REASON_ROAM BIT2 ++ ++void rtw_mlme_reset_auto_scan_int(_adapter *adapter, u8 *reason); ++ ++#ifdef CONFIG_AP_MODE ++ ++struct hostapd_priv { ++ _adapter *padapter; ++ ++#ifdef CONFIG_HOSTAPD_MLME ++ struct net_device *pmgnt_netdev; ++ struct usb_anchor anchored; ++#endif ++ ++}; ++ ++extern int hostapd_mode_init(_adapter *padapter); ++extern void hostapd_mode_unload(_adapter *padapter); ++#endif ++ ++ ++extern void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf); ++extern void rtw_survey_event_callback(_adapter *adapter, u8 *pbuf); ++extern void rtw_surveydone_event_callback(_adapter *adapter, u8 *pbuf); ++extern void rtw_joinbss_event_callback(_adapter *adapter, u8 *pbuf); ++extern void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf); ++extern void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf); ++void rtw_sta_mstatus_report(_adapter *adapter); ++extern void rtw_atimdone_event_callback(_adapter *adapter, u8 *pbuf); ++extern void rtw_cpwm_event_callback(_adapter *adapter, u8 *pbuf); ++extern void rtw_wmm_event_callback(PADAPTER padapter, u8 *pbuf); ++#ifdef CONFIG_IEEE80211W ++void rtw_sta_timeout_event_callback(_adapter *adapter, u8 *pbuf); ++#endif /* CONFIG_IEEE80211W */ ++#ifdef CONFIG_RTW_80211R ++void rtw_update_ft_stainfo(_adapter *padapter, WLAN_BSSID_EX *pnetwork); ++void rtw_ft_reassoc_event_callback(_adapter *padapter, u8 *pbuf); ++#endif ++extern void rtw_join_timeout_handler(RTW_TIMER_HDL_ARGS); ++extern void _rtw_scan_timeout_handler(RTW_TIMER_HDL_ARGS); ++ ++thread_return event_thread(thread_context context); ++ ++extern void rtw_free_network_queue(_adapter *adapter, u8 isfreeall); ++extern int rtw_init_mlme_priv(_adapter *adapter);/* (struct mlme_priv *pmlmepriv); */ ++ ++extern void rtw_free_mlme_priv(struct mlme_priv *pmlmepriv); ++ ++ ++extern sint rtw_select_and_join_from_scanned_queue(struct mlme_priv *pmlmepriv); ++extern sint rtw_set_key(_adapter *adapter, struct security_priv *psecuritypriv, sint keyid, u8 set_tx, bool enqueue); ++extern sint rtw_set_auth(_adapter *adapter, struct security_priv *psecuritypriv); ++ ++__inline static u8 *get_bssid(struct mlme_priv *pmlmepriv) ++{ ++ /* if sta_mode:pmlmepriv->cur_network.network.MacAddress=> bssid */ ++ /* if adhoc_mode:pmlmepriv->cur_network.network.MacAddress=> ibss mac address */ ++ return pmlmepriv->cur_network.network.MacAddress; ++} ++ ++__inline static sint check_fwstate(struct mlme_priv *pmlmepriv, sint state) ++{ ++ if ((state == WIFI_NULL_STATE) && ++ (pmlmepriv->fw_state == WIFI_NULL_STATE)) ++ return _TRUE; ++ ++ if (pmlmepriv->fw_state & state) ++ return _TRUE; ++ ++ return _FALSE; ++} ++ ++__inline static sint get_fwstate(struct mlme_priv *pmlmepriv) ++{ ++ return pmlmepriv->fw_state; ++} ++ ++/* ++ * No Limit on the calling context, ++ * therefore set it to be the critical section... ++ * ++ * ### NOTE:#### (!!!!) ++ * MUST TAKE CARE THAT BEFORE CALLING THIS FUNC, YOU SHOULD HAVE LOCKED pmlmepriv->lock ++ */ ++extern void rtw_mi_update_iface_status(struct mlme_priv *pmlmepriv, sint state); ++ ++static inline void set_fwstate(struct mlme_priv *pmlmepriv, sint state) ++{ ++ pmlmepriv->fw_state |= state; ++ ++ /*bScanInProcess hook in phydm*/ ++ if (_FW_UNDER_SURVEY == state) ++ pmlmepriv->bScanInProcess = _TRUE; ++ ++ rtw_mi_update_iface_status(pmlmepriv, state); ++} ++static inline void init_fwstate(struct mlme_priv *pmlmepriv, sint state) ++{ ++ pmlmepriv->fw_state = state; ++ ++ /*bScanInProcess hook in phydm*/ ++ if (_FW_UNDER_SURVEY == state) ++ pmlmepriv->bScanInProcess = _TRUE; ++ ++ rtw_mi_update_iface_status(pmlmepriv, state); ++} ++ ++static inline void _clr_fwstate_(struct mlme_priv *pmlmepriv, sint state) ++{ ++ pmlmepriv->fw_state &= ~state; ++ ++ /*bScanInProcess hook in phydm*/ ++ if (_FW_UNDER_SURVEY == state) ++ pmlmepriv->bScanInProcess = _FALSE; ++ ++ rtw_mi_update_iface_status(pmlmepriv, state); ++} ++ ++/* ++ * No Limit on the calling context, ++ * therefore set it to be the critical section... ++ */ ++static inline void clr_fwstate(struct mlme_priv *pmlmepriv, sint state) ++{ ++ _irqL irqL; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ _clr_fwstate_(pmlmepriv, state); ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++} ++ ++static inline void up_scanned_network(struct mlme_priv *pmlmepriv) ++{ ++ _irqL irqL; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ pmlmepriv->num_of_scanned++; ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++} ++u8 rtw_is_adapter_up(_adapter *padapter); ++ ++__inline static void down_scanned_network(struct mlme_priv *pmlmepriv) ++{ ++ _irqL irqL; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ pmlmepriv->num_of_scanned--; ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++} ++ ++__inline static void set_scanned_network_val(struct mlme_priv *pmlmepriv, sint val) ++{ ++ _irqL irqL; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ pmlmepriv->num_of_scanned = val; ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++} ++ ++extern u16 rtw_get_capability(WLAN_BSSID_EX *bss); ++extern void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target); ++extern void rtw_disconnect_hdl_under_linked(_adapter *adapter, struct sta_info *psta, u8 free_assoc); ++extern void rtw_generate_random_ibss(u8 *pibss); ++extern struct wlan_network *rtw_find_network(_queue *scanned_queue, u8 *addr); ++extern struct wlan_network *rtw_get_oldest_wlan_network(_queue *scanned_queue); ++struct wlan_network *_rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network); ++struct wlan_network *rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network); ++ ++extern void rtw_free_assoc_resources(_adapter *adapter, int lock_scanned_queue); ++extern void rtw_indicate_disconnect(_adapter *adapter, u16 reason, u8 locally_generated); ++extern void rtw_indicate_connect(_adapter *adapter); ++void rtw_indicate_scan_done(_adapter *padapter, bool aborted); ++ ++void rtw_drv_scan_by_self(_adapter *padapter, u8 reason); ++void rtw_scan_wait_completed(_adapter *adapter); ++u32 rtw_scan_abort_timeout(_adapter *adapter, u32 timeout_ms); ++void rtw_scan_abort_no_wait(_adapter *adapter); ++void rtw_scan_abort(_adapter *adapter); ++ ++extern int rtw_restruct_sec_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len); ++extern int rtw_restruct_wmm_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len, uint initial_out_len); ++extern void rtw_init_registrypriv_dev_network(_adapter *adapter); ++ ++extern void rtw_update_registrypriv_dev_network(_adapter *adapter); ++ ++extern void rtw_get_encrypt_decrypt_from_registrypriv(_adapter *adapter); ++ ++extern void _rtw_join_timeout_handler(_adapter *adapter); ++extern void rtw_scan_timeout_handler(_adapter *adapter); ++ ++extern void _dynamic_check_timer_handlder(void *FunctionContext); ++extern void rtw_dynamic_check_timer_handlder(_adapter *adapter); ++extern void rtw_iface_dynamic_check_timer_handlder(_adapter *adapter); ++ ++#ifdef CONFIG_SET_SCAN_DENY_TIMER ++bool rtw_is_scan_deny(_adapter *adapter); ++void rtw_clear_scan_deny(_adapter *adapter); ++void rtw_set_scan_deny_timer_hdl(_adapter *adapter); ++void rtw_set_scan_deny(_adapter *adapter, u32 ms); ++#else ++#define rtw_is_scan_deny(adapter) _FALSE ++#define rtw_clear_scan_deny(adapter) do {} while (0) ++#define rtw_set_scan_deny_timer_hdl(adapter) do {} while (0) ++#define rtw_set_scan_deny(adapter, ms) do {} while (0) ++#endif ++ ++void rtw_free_mlme_priv_ie_data(struct mlme_priv *pmlmepriv); ++ ++#define MLME_BEACON_IE 0 ++#define MLME_PROBE_REQ_IE 1 ++#define MLME_PROBE_RESP_IE 2 ++#define MLME_GO_PROBE_RESP_IE 3 ++#define MLME_ASSOC_REQ_IE 4 ++#define MLME_ASSOC_RESP_IE 5 ++ ++#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) ++int rtw_mlme_update_wfd_ie_data(struct mlme_priv *mlme, u8 type, u8 *ie, u32 ie_len); ++#endif ++ ++ ++/* extern struct wlan_network* _rtw_dequeue_network(_queue *queue); */ ++ ++extern struct wlan_network *_rtw_alloc_network(struct mlme_priv *pmlmepriv); ++ ++ ++extern void _rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 isfreeall); ++extern void _rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork); ++ ++ ++extern struct wlan_network *_rtw_find_network(_queue *scanned_queue, u8 *addr); ++ ++extern void _rtw_free_network_queue(_adapter *padapter, u8 isfreeall); ++ ++extern sint rtw_if_up(_adapter *padapter); ++ ++sint rtw_linked_check(_adapter *padapter); ++ ++u8 *rtw_get_capability_from_ie(u8 *ie); ++u8 *rtw_get_timestampe_from_ie(u8 *ie); ++u8 *rtw_get_beacon_interval_from_ie(u8 *ie); ++ ++ ++void rtw_joinbss_reset(_adapter *padapter); ++ ++#ifdef CONFIG_80211N_HT ++void rtw_ht_use_default_setting(_adapter *padapter); ++void rtw_build_wmm_ie_ht(_adapter *padapter, u8 *out_ie, uint *pout_len); ++unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len, u8 channel); ++void rtw_update_ht_cap(_adapter *padapter, u8 *pie, uint ie_len, u8 channel); ++void rtw_issue_addbareq_cmd(_adapter *padapter, struct xmit_frame *pxmitframe); ++void rtw_append_exented_cap(_adapter *padapter, u8 *out_ie, uint *pout_len); ++#endif ++ ++int rtw_is_same_ibss(_adapter *adapter, struct wlan_network *pnetwork); ++int is_same_network(WLAN_BSSID_EX *src, WLAN_BSSID_EX *dst, u8 feature); ++ ++#ifdef CONFIG_LAYER2_ROAMING ++#define rtw_roam_flags(adapter) ((adapter)->mlmepriv.roam_flags) ++#define rtw_chk_roam_flags(adapter, flags) ((adapter)->mlmepriv.roam_flags & flags) ++#define rtw_clr_roam_flags(adapter, flags) \ ++ do { \ ++ ((adapter)->mlmepriv.roam_flags &= ~flags); \ ++ } while (0) ++ ++#define rtw_set_roam_flags(adapter, flags) \ ++ do { \ ++ ((adapter)->mlmepriv.roam_flags |= flags); \ ++ } while (0) ++ ++#define rtw_assign_roam_flags(adapter, flags) \ ++ do { \ ++ ((adapter)->mlmepriv.roam_flags = flags); \ ++ } while (0) ++ ++void _rtw_roaming(_adapter *adapter, struct wlan_network *tgt_network); ++void rtw_roaming(_adapter *adapter, struct wlan_network *tgt_network); ++void rtw_set_to_roam(_adapter *adapter, u8 to_roam); ++u8 rtw_dec_to_roam(_adapter *adapter); ++u8 rtw_to_roam(_adapter *adapter); ++int rtw_select_roaming_candidate(struct mlme_priv *pmlmepriv); ++#else ++#define rtw_roam_flags(adapter) 0 ++#define rtw_chk_roam_flags(adapter, flags) 0 ++#define rtw_clr_roam_flags(adapter, flags) do {} while (0) ++#define rtw_set_roam_flags(adapter, flags) do {} while (0) ++#define rtw_assign_roam_flags(adapter, flags) do {} while (0) ++#define _rtw_roaming(adapter, tgt_network) do {} while (0) ++#define rtw_roaming(adapter, tgt_network) do {} while (0) ++#define rtw_set_to_roam(adapter, to_roam) do {} while (0) ++#define rtw_dec_to_roam(adapter) 0 ++#define rtw_to_roam(adapter) 0 ++#define rtw_select_roaming_candidate(mlme) _FAIL ++#endif /* CONFIG_LAYER2_ROAMING */ ++ ++#ifdef CONFIG_80211N_HT ++bool rtw_adjust_chbw(_adapter *adapter, u8 req_ch, u8 *req_bw, u8 *req_offset); ++#endif ++ ++struct sta_media_status_rpt_cmd_parm { ++ struct sta_info *sta; ++ bool connected; ++}; ++ ++void rtw_sta_media_status_rpt(_adapter *adapter, struct sta_info *sta, bool connected); ++u8 rtw_sta_media_status_rpt_cmd(_adapter *adapter, struct sta_info *sta, bool connected); ++void rtw_sta_media_status_rpt_cmd_hdl(_adapter *adapter, struct sta_media_status_rpt_cmd_parm *parm); ++ ++#ifdef CONFIG_INTEL_PROXIM ++void rtw_proxim_enable(_adapter *padapter); ++void rtw_proxim_disable(_adapter *padapter); ++void rtw_proxim_send_packet(_adapter *padapter, u8 *pbuf, u16 len, u8 m_rate); ++#endif /* CONFIG_INTEL_PROXIM */ ++ ++#define IPV4_SRC(_iphdr) (((u8 *)(_iphdr)) + 12) ++#define IPV4_DST(_iphdr) (((u8 *)(_iphdr)) + 16) ++#define GET_IPV4_IHL(_iphdr) BE_BITS_TO_1BYTE(((u8 *)(_iphdr)) + 0, 0, 4) ++#define GET_IPV4_PROTOCOL(_iphdr) BE_BITS_TO_1BYTE(((u8 *)(_iphdr)) + 9, 0, 8) ++#define GET_IPV4_SRC(_iphdr) BE_BITS_TO_4BYTE(((u8 *)(_iphdr)) + 12, 0, 32) ++#define GET_IPV4_DST(_iphdr) BE_BITS_TO_4BYTE(((u8 *)(_iphdr)) + 16, 0, 32) ++ ++#define GET_UDP_SRC(_udphdr) BE_BITS_TO_2BYTE(((u8 *)(_udphdr)) + 0, 0, 16) ++#define GET_UDP_DST(_udphdr) BE_BITS_TO_2BYTE(((u8 *)(_udphdr)) + 2, 0, 16) ++ ++#define TCP_SRC(_tcphdr) (((u8 *)(_tcphdr)) + 0) ++#define TCP_DST(_tcphdr) (((u8 *)(_tcphdr)) + 2) ++#define GET_TCP_SRC(_tcphdr) BE_BITS_TO_2BYTE(((u8 *)(_tcphdr)) + 0, 0, 16) ++#define GET_TCP_DST(_tcphdr) BE_BITS_TO_2BYTE(((u8 *)(_tcphdr)) + 2, 0, 16) ++#define GET_TCP_SEQ(_tcphdr) BE_BITS_TO_4BYTE(((u8 *)(_tcphdr)) + 4, 0, 32) ++#define GET_TCP_ACK_SEQ(_tcphdr) BE_BITS_TO_4BYTE(((u8 *)(_tcphdr)) + 8, 0, 32) ++#define GET_TCP_DOFF(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 12, 4, 4) ++#define GET_TCP_FIN(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 0, 1) ++#define GET_TCP_SYN(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 1, 1) ++#define GET_TCP_RST(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 2, 1) ++#define GET_TCP_PSH(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 3, 1) ++#define GET_TCP_ACK(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 4, 1) ++#define GET_TCP_URG(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 5, 1) ++#define GET_TCP_ECE(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 6, 1) ++#define GET_TCP_CWR(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 7, 1) ++ ++#endif /* __RTL871X_MLME_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mp.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mp.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mp.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mp.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,936 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTW_MP_H_ ++#define _RTW_MP_H_ ++ ++#define RTWPRIV_VER_INFO 1 ++ ++#define MAX_MP_XMITBUF_SZ 2048 ++#define NR_MP_XMITFRAME 8 ++ ++struct mp_xmit_frame { ++ _list list; ++ ++ struct pkt_attrib attrib; ++ ++ _pkt *pkt; ++ ++ int frame_tag; ++ ++ _adapter *padapter; ++ ++#ifdef CONFIG_USB_HCI ++ ++ /* insert urb, irp, and irpcnt info below... */ ++ /* max frag_cnt = 8 */ ++ ++ u8 *mem_addr; ++ u32 sz[8]; ++ ++#if defined(PLATFORM_OS_XP) || defined(PLATFORM_LINUX) ++ PURB pxmit_urb[8]; ++#endif ++ ++#ifdef PLATFORM_OS_XP ++ PIRP pxmit_irp[8]; ++#endif ++ ++ u8 bpending[8]; ++ sint ac_tag[8]; ++ sint last[8]; ++ uint irpcnt; ++ uint fragcnt; ++#endif /* CONFIG_USB_HCI */ ++ ++ uint mem[(MAX_MP_XMITBUF_SZ >> 2)]; ++}; ++ ++struct mp_wiparam { ++ u32 bcompleted; ++ u32 act_type; ++ u32 io_offset; ++ u32 io_value; ++}; ++ ++typedef void(*wi_act_func)(void *padapter); ++ ++#ifdef PLATFORM_WINDOWS ++struct mp_wi_cntx { ++ u8 bmpdrv_unload; ++ ++ /* Work Item */ ++ NDIS_WORK_ITEM mp_wi; ++ NDIS_EVENT mp_wi_evt; ++ _lock mp_wi_lock; ++ u8 bmp_wi_progress; ++ wi_act_func curractfunc; ++ /* Variable needed in each implementation of CurrActFunc. */ ++ struct mp_wiparam param; ++}; ++#endif ++ ++struct mp_tx { ++ u8 stop; ++ u32 count, sended; ++ u8 payload; ++ struct pkt_attrib attrib; ++ /* struct tx_desc desc; */ ++ /* u8 resvdtx[7]; */ ++ u8 desc[TXDESC_SIZE]; ++ u8 *pallocated_buf; ++ u8 *buf; ++ u32 buf_size, write_size; ++ _thread_hdl_ PktTxThread; ++}; ++ ++#define MP_MAX_LINES 1000 ++#define MP_MAX_LINES_BYTES 256 ++#define u1Byte u8 ++#define s1Byte s8 ++#define u4Byte u32 ++#define s4Byte s32 ++#define u1Byte u8 ++#define pu1Byte u8* ++ ++#define u2Byte u16 ++#define pu2Byte u16* ++ ++#define u4Byte u32 ++#define pu4Byte u32* ++ ++#define u8Byte u64 ++#define pu8Byte u64* ++ ++#define s1Byte s8 ++#define ps1Byte s8* ++ ++#define s2Byte s16 ++#define ps2Byte s16* ++ ++#define s4Byte s32 ++#define ps4Byte s32* ++ ++#define s8Byte s64 ++#define ps8Byte s64* ++ ++#define UCHAR u8 ++#define USHORT u16 ++#define UINT u32 ++#define ULONG u32 ++#define PULONG u32* ++ ++typedef struct _RT_PMAC_PKT_INFO { ++ UCHAR MCS; ++ UCHAR Nss; ++ UCHAR Nsts; ++ UINT N_sym; ++ UCHAR SIGA2B3; ++} RT_PMAC_PKT_INFO, *PRT_PMAC_PKT_INFO; ++ ++typedef struct _RT_PMAC_TX_INFO { ++ u8 bEnPMacTx:1; /* 0: Disable PMac 1: Enable PMac */ ++ u8 Mode:3; /* 0: Packet TX 3:Continuous TX */ ++ u8 Ntx:4; /* 0-7 */ ++ u8 TX_RATE; /* MPT_RATE_E */ ++ u8 TX_RATE_HEX; ++ u8 TX_SC; ++ u8 bSGI:1; ++ u8 bSPreamble:1; ++ u8 bSTBC:1; ++ u8 bLDPC:1; ++ u8 NDP_sound:1; ++ u8 BandWidth:3; /* 0: 20 1:40 2:80Mhz */ ++ u8 m_STBC; /* bSTBC + 1 */ ++ USHORT PacketPeriod; ++ UINT PacketCount; ++ UINT PacketLength; ++ u8 PacketPattern; ++ USHORT SFD; ++ u8 SignalField; ++ u8 ServiceField; ++ USHORT LENGTH; ++ u8 CRC16[2]; ++ u8 LSIG[3]; ++ u8 HT_SIG[6]; ++ u8 VHT_SIG_A[6]; ++ u8 VHT_SIG_B[4]; ++ u8 VHT_SIG_B_CRC; ++ u8 VHT_Delimiter[4]; ++ u8 MacAddress[6]; ++} RT_PMAC_TX_INFO, *PRT_PMAC_TX_INFO; ++ ++ ++typedef VOID (*MPT_WORK_ITEM_HANDLER)(IN PVOID Adapter); ++typedef struct _MPT_CONTEXT { ++ /* Indicate if we have started Mass Production Test. */ ++ BOOLEAN bMassProdTest; ++ ++ /* Indicate if the driver is unloading or unloaded. */ ++ BOOLEAN bMptDrvUnload; ++ ++ _sema MPh2c_Sema; ++ _timer MPh2c_timeout_timer; ++ /* Event used to sync H2c for BT control */ ++ ++ BOOLEAN MptH2cRspEvent; ++ BOOLEAN MptBtC2hEvent; ++ BOOLEAN bMPh2c_timeout; ++ ++ /* 8190 PCI does not support NDIS_WORK_ITEM. */ ++ /* Work Item for Mass Production Test. */ ++ /* NDIS_WORK_ITEM MptWorkItem; ++ * RT_WORK_ITEM MptWorkItem; */ ++ /* Event used to sync the case unloading driver and MptWorkItem is still in progress. ++ * NDIS_EVENT MptWorkItemEvent; */ ++ /* To protect the following variables. ++ * NDIS_SPIN_LOCK MptWorkItemSpinLock; */ ++ /* Indicate a MptWorkItem is scheduled and not yet finished. */ ++ BOOLEAN bMptWorkItemInProgress; ++ /* An instance which implements function and context of MptWorkItem. */ ++ MPT_WORK_ITEM_HANDLER CurrMptAct; ++ ++ /* 1=Start, 0=Stop from UI. */ ++ ULONG MptTestStart; ++ /* _TEST_MODE, defined in MPT_Req2.h */ ++ ULONG MptTestItem; ++ /* Variable needed in each implementation of CurrMptAct. */ ++ ULONG MptActType; /* Type of action performed in CurrMptAct. */ ++ /* The Offset of IO operation is depend of MptActType. */ ++ ULONG MptIoOffset; ++ /* The Value of IO operation is depend of MptActType. */ ++ ULONG MptIoValue; ++ /* The RfPath of IO operation is depend of MptActType. */ ++ ULONG MptRfPath; ++ ++ WIRELESS_MODE MptWirelessModeToSw; /* Wireless mode to switch. */ ++ u8 MptChannelToSw; /* Channel to switch. */ ++ u8 MptInitGainToSet; /* Initial gain to set. */ ++ /* ULONG bMptAntennaA; */ /* TRUE if we want to use antenna A. */ ++ ULONG MptBandWidth; /* bandwidth to switch. */ ++ ULONG MptRateIndex; /* rate index. */ ++ /* Register value kept for Single Carrier Tx test. */ ++ u8 btMpCckTxPower; ++ /* Register value kept for Single Carrier Tx test. */ ++ u8 btMpOfdmTxPower; ++ /* For MP Tx Power index */ ++ u8 TxPwrLevel[4]; /* rf-A, rf-B*/ ++ u32 RegTxPwrLimit; ++ /* Content of RCR Regsiter for Mass Production Test. */ ++ ULONG MptRCR; ++ /* TRUE if we only receive packets with specific pattern. */ ++ BOOLEAN bMptFilterPattern; ++ /* Rx OK count, statistics used in Mass Production Test. */ ++ ULONG MptRxOkCnt; ++ /* Rx CRC32 error count, statistics used in Mass Production Test. */ ++ ULONG MptRxCrcErrCnt; ++ ++ BOOLEAN bCckContTx; /* TRUE if we are in CCK Continuous Tx test. */ ++ BOOLEAN bOfdmContTx; /* TRUE if we are in OFDM Continuous Tx test. */ ++ BOOLEAN bStartContTx; /* TRUE if we have start Continuous Tx test. */ ++ /* TRUE if we are in Single Carrier Tx test. */ ++ BOOLEAN bSingleCarrier; ++ /* TRUE if we are in Carrier Suppression Tx Test. */ ++ BOOLEAN bCarrierSuppression; ++ /* TRUE if we are in Single Tone Tx test. */ ++ BOOLEAN bSingleTone; ++ ++ /* ACK counter asked by K.Y.. */ ++ BOOLEAN bMptEnableAckCounter; ++ ULONG MptAckCounter; ++ ++ /* SD3 Willis For 8192S to save 1T/2T RF table for ACUT Only fro ACUT delete later ~~~! */ ++ /* s1Byte BufOfLines[2][MAX_LINES_HWCONFIG_TXT][MAX_BYTES_LINE_HWCONFIG_TXT]; */ ++ /* s1Byte BufOfLines[2][MP_MAX_LINES][MP_MAX_LINES_BYTES]; */ ++ /* s4Byte RfReadLine[2]; */ ++ ++ u8 APK_bound[2]; /* for APK path A/path B */ ++ BOOLEAN bMptIndexEven; ++ ++ u8 backup0xc50; ++ u8 backup0xc58; ++ u8 backup0xc30; ++ u8 backup0x52_RF_A; ++ u8 backup0x52_RF_B; ++ ++ u4Byte backup0x58_RF_A; ++ u4Byte backup0x58_RF_B; ++ ++ u1Byte h2cReqNum; ++ u1Byte c2hBuf[32]; ++ ++ u1Byte btInBuf[100]; ++ ULONG mptOutLen; ++ u1Byte mptOutBuf[100]; ++ RT_PMAC_TX_INFO PMacTxInfo; ++ RT_PMAC_PKT_INFO PMacPktInfo; ++ u8 HWTxmode; ++ ++ BOOLEAN bldpc; ++ BOOLEAN bstbc; ++} MPT_CONTEXT, *PMPT_CONTEXT; ++/* #endif */ ++ ++ ++/* #define RTPRIV_IOCTL_MP ( SIOCIWFIRSTPRIV + 0x17) */ ++enum { ++ WRITE_REG = 1, ++ READ_REG, ++ WRITE_RF, ++ READ_RF, ++ MP_START, ++ MP_STOP, ++ MP_RATE, ++ MP_CHANNEL, ++ MP_BANDWIDTH, ++ MP_TXPOWER, ++ MP_ANT_TX, ++ MP_ANT_RX, ++ MP_CTX, ++ MP_QUERY, ++ MP_ARX, ++ MP_PSD, ++ MP_PWRTRK, ++ MP_THER, ++ MP_IOCTL, ++ EFUSE_GET, ++ EFUSE_SET, ++ MP_RESET_STATS, ++ MP_DUMP, ++ MP_PHYPARA, ++ MP_SetRFPathSwh, ++ MP_QueryDrvStats, ++ CTA_TEST, ++ MP_DISABLE_BT_COEXIST, ++ MP_PwrCtlDM, ++ MP_GETVER, ++ MP_MON, ++ EFUSE_MASK, ++ EFUSE_FILE, ++ MP_TX, ++ MP_RX, ++ MP_IQK, ++ MP_LCK, ++ MP_HW_TX_MODE, ++ MP_GET_TXPOWER_INX, ++ MP_CUSTOMER_STR, ++ MP_NULL, ++ MP_SetBT, ++#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE ++ VENDOR_IE_SET , ++ VENDOR_IE_GET , ++#endif ++#ifdef CONFIG_WOWLAN ++ MP_WOW_ENABLE, ++ MP_WOW_SET_PATTERN, ++#endif ++#ifdef CONFIG_AP_WOWLAN ++ MP_AP_WOW_ENABLE, ++#endif ++ MP_SD_IREAD, ++ MP_SD_IWRITE, ++}; ++ ++struct mp_priv { ++ _adapter *papdater; ++ ++ /* Testing Flag */ ++ u32 mode;/* 0 for normal type packet, 1 for loopback packet (16bytes TXCMD) */ ++ ++ u32 prev_fw_state; ++ ++ /* OID cmd handler */ ++ struct mp_wiparam workparam; ++ /* u8 act_in_progress; */ ++ ++ /* Tx Section */ ++ u8 TID; ++ u32 tx_pktcount; ++ u32 pktInterval; ++ u32 pktLength; ++ struct mp_tx tx; ++ ++ /* Rx Section */ ++ u32 rx_bssidpktcount; ++ u32 rx_pktcount; ++ u32 rx_pktcount_filter_out; ++ u32 rx_crcerrpktcount; ++ u32 rx_pktloss; ++ BOOLEAN rx_bindicatePkt; ++ struct recv_stat rxstat; ++ ++ /* RF/BB relative */ ++ u8 channel; ++ u8 bandwidth; ++ u8 prime_channel_offset; ++ u8 txpoweridx; ++ u8 rateidx; ++ u32 preamble; ++ /* u8 modem; */ ++ u32 CrystalCap; ++ /* u32 curr_crystalcap; */ ++ ++ u16 antenna_tx; ++ u16 antenna_rx; ++ /* u8 curr_rfpath; */ ++ ++ u8 check_mp_pkt; ++ ++ u8 bSetTxPower; ++ /* uint ForcedDataRate; */ ++ u8 mp_dm; ++ u8 mac_filter[ETH_ALEN]; ++ u8 bmac_filter; ++ ++ struct wlan_network mp_network; ++ NDIS_802_11_MAC_ADDRESS network_macaddr; ++ ++#ifdef PLATFORM_WINDOWS ++ u32 rx_testcnt; ++ u32 rx_testcnt1; ++ u32 rx_testcnt2; ++ u32 tx_testcnt; ++ u32 tx_testcnt1; ++ ++ struct mp_wi_cntx wi_cntx; ++ ++ u8 h2c_result; ++ u8 h2c_seqnum; ++ u16 h2c_cmdcode; ++ u8 h2c_resp_parambuf[512]; ++ _lock h2c_lock; ++ _lock wkitm_lock; ++ u32 h2c_cmdcnt; ++ NDIS_EVENT h2c_cmd_evt; ++ NDIS_EVENT c2h_set; ++ NDIS_EVENT h2c_clr; ++ NDIS_EVENT cpwm_int; ++ ++ NDIS_EVENT scsir_full_evt; ++ NDIS_EVENT scsiw_empty_evt; ++#endif ++ ++ u8 *pallocated_mp_xmitframe_buf; ++ u8 *pmp_xmtframe_buf; ++ _queue free_mp_xmitqueue; ++ u32 free_mp_xmitframe_cnt; ++ BOOLEAN bSetRxBssid; ++ BOOLEAN bTxBufCkFail; ++ BOOLEAN bRTWSmbCfg; ++ BOOLEAN bloopback; ++ MPT_CONTEXT MptCtx; ++ BOOLEAN bloadefusemap; ++ ++ u8 *TXradomBuffer; ++}; ++ ++typedef struct _IOCMD_STRUCT_ { ++ u8 cmdclass; ++ u16 value; ++ u8 index; ++} IOCMD_STRUCT; ++ ++struct rf_reg_param { ++ u32 path; ++ u32 offset; ++ u32 value; ++}; ++ ++struct bb_reg_param { ++ u32 offset; ++ u32 value; ++}; ++ ++typedef struct _MP_FIRMWARE { ++ FIRMWARE_SOURCE eFWSource; ++#ifdef CONFIG_EMBEDDED_FWIMG ++ u8 *szFwBuffer; ++#else ++ u8 szFwBuffer[0x8000]; ++#endif ++ u32 ulFwLength; ++} RT_MP_FIRMWARE, *PRT_MP_FIRMWARE; ++ ++ ++ ++ ++/* *********************************************************************** */ ++ ++#define LOWER _TRUE ++#define RAISE _FALSE ++ ++/* Hardware Registers */ ++#if 0 ++#if 0 ++#define IOCMD_CTRL_REG 0x102502C0 ++#define IOCMD_DATA_REG 0x102502C4 ++#else ++#define IOCMD_CTRL_REG 0x10250370 ++#define IOCMD_DATA_REG 0x10250374 ++#endif ++ ++#define IOCMD_GET_THERMAL_METER 0xFD000028 ++ ++#define IOCMD_CLASS_BB_RF 0xF0 ++#define IOCMD_BB_READ_IDX 0x00 ++#define IOCMD_BB_WRITE_IDX 0x01 ++#define IOCMD_RF_READ_IDX 0x02 ++#define IOCMD_RF_WRIT_IDX 0x03 ++#endif ++#define BB_REG_BASE_ADDR 0x800 ++ ++/* MP variables */ ++#if 0 ++#define _2MAC_MODE_ 0 ++#define _LOOPBOOK_MODE_ 1 ++#endif ++typedef enum _MP_MODE_ { ++ MP_OFF, ++ MP_ON, ++ MP_ERR, ++ MP_CONTINUOUS_TX, ++ MP_SINGLE_CARRIER_TX, ++ MP_CARRIER_SUPPRISSION_TX, ++ MP_SINGLE_TONE_TX, ++ MP_PACKET_TX, ++ MP_PACKET_RX ++} MP_MODE; ++ ++typedef enum _TEST_MODE { ++ TEST_NONE , ++ PACKETS_TX , ++ PACKETS_RX , ++ CONTINUOUS_TX , ++ OFDM_Single_Tone_TX , ++ CCK_Carrier_Suppression_TX ++} TEST_MODE; ++ ++ ++typedef enum _MPT_BANDWIDTH { ++ MPT_BW_20MHZ = 0, ++ MPT_BW_40MHZ_DUPLICATE = 1, ++ MPT_BW_40MHZ_ABOVE = 2, ++ MPT_BW_40MHZ_BELOW = 3, ++ MPT_BW_40MHZ = 4, ++ MPT_BW_80MHZ = 5, ++ MPT_BW_80MHZ_20_ABOVE = 6, ++ MPT_BW_80MHZ_20_BELOW = 7, ++ MPT_BW_80MHZ_20_BOTTOM = 8, ++ MPT_BW_80MHZ_20_TOP = 9, ++ MPT_BW_80MHZ_40_ABOVE = 10, ++ MPT_BW_80MHZ_40_BELOW = 11, ++} MPT_BANDWIDTHE, *PMPT_BANDWIDTH; ++ ++#define MAX_RF_PATH_NUMS RF_PATH_MAX ++ ++ ++extern u8 mpdatarate[NumRates]; ++ ++/* MP set force data rate base on the definition. */ ++typedef enum _MPT_RATE_INDEX { ++ /* CCK rate. */ ++ MPT_RATE_1M = 1 , /* 0 */ ++ MPT_RATE_2M, ++ MPT_RATE_55M, ++ MPT_RATE_11M, /* 3 */ ++ ++ /* OFDM rate. */ ++ MPT_RATE_6M, /* 4 */ ++ MPT_RATE_9M, ++ MPT_RATE_12M, ++ MPT_RATE_18M, ++ MPT_RATE_24M, ++ MPT_RATE_36M, ++ MPT_RATE_48M, ++ MPT_RATE_54M, /* 11 */ ++ ++ /* HT rate. */ ++ MPT_RATE_MCS0, /* 12 */ ++ MPT_RATE_MCS1, ++ MPT_RATE_MCS2, ++ MPT_RATE_MCS3, ++ MPT_RATE_MCS4, ++ MPT_RATE_MCS5, ++ MPT_RATE_MCS6, ++ MPT_RATE_MCS7, /* 19 */ ++ MPT_RATE_MCS8, ++ MPT_RATE_MCS9, ++ MPT_RATE_MCS10, ++ MPT_RATE_MCS11, ++ MPT_RATE_MCS12, ++ MPT_RATE_MCS13, ++ MPT_RATE_MCS14, ++ MPT_RATE_MCS15, /* 27 */ ++ MPT_RATE_MCS16, ++ MPT_RATE_MCS17, /* #29 */ ++ MPT_RATE_MCS18, ++ MPT_RATE_MCS19, ++ MPT_RATE_MCS20, ++ MPT_RATE_MCS21, ++ MPT_RATE_MCS22, /* #34 */ ++ MPT_RATE_MCS23, ++ MPT_RATE_MCS24, ++ MPT_RATE_MCS25, ++ MPT_RATE_MCS26, ++ MPT_RATE_MCS27, /* #39 */ ++ MPT_RATE_MCS28, /* #40 */ ++ MPT_RATE_MCS29, /* #41 */ ++ MPT_RATE_MCS30, /* #42 */ ++ MPT_RATE_MCS31, /* #43 */ ++ /* VHT rate. Total: 20*/ ++ MPT_RATE_VHT1SS_MCS0 = 100,/* #44*/ ++ MPT_RATE_VHT1SS_MCS1, /* # */ ++ MPT_RATE_VHT1SS_MCS2, ++ MPT_RATE_VHT1SS_MCS3, ++ MPT_RATE_VHT1SS_MCS4, ++ MPT_RATE_VHT1SS_MCS5, ++ MPT_RATE_VHT1SS_MCS6, /* # */ ++ MPT_RATE_VHT1SS_MCS7, ++ MPT_RATE_VHT1SS_MCS8, ++ MPT_RATE_VHT1SS_MCS9, /* #53 */ ++ MPT_RATE_VHT2SS_MCS0, /* #54 */ ++ MPT_RATE_VHT2SS_MCS1, ++ MPT_RATE_VHT2SS_MCS2, ++ MPT_RATE_VHT2SS_MCS3, ++ MPT_RATE_VHT2SS_MCS4, ++ MPT_RATE_VHT2SS_MCS5, ++ MPT_RATE_VHT2SS_MCS6, ++ MPT_RATE_VHT2SS_MCS7, ++ MPT_RATE_VHT2SS_MCS8, ++ MPT_RATE_VHT2SS_MCS9, /* #63 */ ++ MPT_RATE_VHT3SS_MCS0, ++ MPT_RATE_VHT3SS_MCS1, ++ MPT_RATE_VHT3SS_MCS2, ++ MPT_RATE_VHT3SS_MCS3, ++ MPT_RATE_VHT3SS_MCS4, ++ MPT_RATE_VHT3SS_MCS5, ++ MPT_RATE_VHT3SS_MCS6, /* #126 */ ++ MPT_RATE_VHT3SS_MCS7, ++ MPT_RATE_VHT3SS_MCS8, ++ MPT_RATE_VHT3SS_MCS9, ++ MPT_RATE_VHT4SS_MCS0, ++ MPT_RATE_VHT4SS_MCS1, /* #131 */ ++ MPT_RATE_VHT4SS_MCS2, ++ MPT_RATE_VHT4SS_MCS3, ++ MPT_RATE_VHT4SS_MCS4, ++ MPT_RATE_VHT4SS_MCS5, ++ MPT_RATE_VHT4SS_MCS6, /* #136 */ ++ MPT_RATE_VHT4SS_MCS7, ++ MPT_RATE_VHT4SS_MCS8, ++ MPT_RATE_VHT4SS_MCS9, ++ MPT_RATE_LAST ++} MPT_RATE_E, *PMPT_RATE_E; ++ ++#define MAX_TX_PWR_INDEX_N_MODE 64 /* 0x3F */ ++ ++#define MPT_IS_CCK_RATE(_value) (MPT_RATE_1M <= _value && _value <= MPT_RATE_11M) ++#define MPT_IS_OFDM_RATE(_value) (MPT_RATE_6M <= _value && _value <= MPT_RATE_54M) ++#define MPT_IS_HT_RATE(_value) (MPT_RATE_MCS0 <= _value && _value <= MPT_RATE_MCS31) ++#define MPT_IS_HT_1S_RATE(_value) (MPT_RATE_MCS0 <= _value && _value <= MPT_RATE_MCS7) ++#define MPT_IS_HT_2S_RATE(_value) (MPT_RATE_MCS8 <= _value && _value <= MPT_RATE_MCS15) ++#define MPT_IS_HT_3S_RATE(_value) (MPT_RATE_MCS16 <= _value && _value <= MPT_RATE_MCS23) ++#define MPT_IS_HT_4S_RATE(_value) (MPT_RATE_MCS24 <= _value && _value <= MPT_RATE_MCS31) ++ ++#define MPT_IS_VHT_RATE(_value) (MPT_RATE_VHT1SS_MCS0 <= _value && _value <= MPT_RATE_VHT4SS_MCS9) ++#define MPT_IS_VHT_1S_RATE(_value) (MPT_RATE_VHT1SS_MCS0 <= _value && _value <= MPT_RATE_VHT1SS_MCS9) ++#define MPT_IS_VHT_2S_RATE(_value) (MPT_RATE_VHT2SS_MCS0 <= _value && _value <= MPT_RATE_VHT2SS_MCS9) ++#define MPT_IS_VHT_3S_RATE(_value) (MPT_RATE_VHT3SS_MCS0 <= _value && _value <= MPT_RATE_VHT3SS_MCS9) ++#define MPT_IS_VHT_4S_RATE(_value) (MPT_RATE_VHT4SS_MCS0 <= _value && _value <= MPT_RATE_VHT4SS_MCS9) ++ ++#define MPT_IS_2SS_RATE(_rate) ((MPT_RATE_MCS8 <= _rate && _rate <= MPT_RATE_MCS15) || \ ++ (MPT_RATE_VHT2SS_MCS0 <= _rate && _rate <= MPT_RATE_VHT2SS_MCS9)) ++#define MPT_IS_3SS_RATE(_rate) ((MPT_RATE_MCS16 <= _rate && _rate <= MPT_RATE_MCS23) || \ ++ (MPT_RATE_VHT3SS_MCS0 <= _rate && _rate <= MPT_RATE_VHT3SS_MCS9)) ++#define MPT_IS_4SS_RATE(_rate) ((MPT_RATE_MCS24 <= _rate && _rate <= MPT_RATE_MCS31) || \ ++ (MPT_RATE_VHT4SS_MCS0 <= _rate && _rate <= MPT_RATE_VHT4SS_MCS9)) ++ ++typedef enum _POWER_MODE_ { ++ POWER_LOW = 0, ++ POWER_NORMAL ++} POWER_MODE; ++ ++/* The following enumeration is used to define the value of Reg0xD00[30:28] or JaguarReg0x914[18:16]. */ ++typedef enum _OFDM_TX_MODE { ++ OFDM_ALL_OFF = 0, ++ OFDM_ContinuousTx = 1, ++ OFDM_SingleCarrier = 2, ++ OFDM_SingleTone = 4, ++} OFDM_TX_MODE; ++ ++ ++#define RX_PKT_BROADCAST 1 ++#define RX_PKT_DEST_ADDR 2 ++#define RX_PKT_PHY_MATCH 3 ++ ++typedef enum _ENCRY_CTRL_STATE_ { ++ HW_CONTROL, /* hw encryption& decryption */ ++ SW_CONTROL, /* sw encryption& decryption */ ++ HW_ENCRY_SW_DECRY, /* hw encryption & sw decryption */ ++ SW_ENCRY_HW_DECRY /* sw encryption & hw decryption */ ++} ENCRY_CTRL_STATE; ++ ++typedef enum _MPT_TXPWR_DEF { ++ MPT_CCK, ++ MPT_OFDM, /* L and HT OFDM */ ++ MPT_OFDM_AND_HT, ++ MPT_HT, ++ MPT_VHT ++} MPT_TXPWR_DEF; ++ ++ ++#define IS_MPT_HT_RATE(_rate) (_rate >= MPT_RATE_MCS0 && _rate <= MPT_RATE_MCS31) ++#define IS_MPT_VHT_RATE(_rate) (_rate >= MPT_RATE_VHT1SS_MCS0 && _rate <= MPT_RATE_VHT4SS_MCS9) ++#define IS_MPT_CCK_RATE(_rate) (_rate >= MPT_RATE_1M && _rate <= MPT_RATE_11M) ++#define IS_MPT_OFDM_RATE(_rate) (_rate >= MPT_RATE_6M && _rate <= MPT_RATE_54M) ++/*************************************************************************/ ++#if 0 ++extern struct mp_xmit_frame *alloc_mp_xmitframe(struct mp_priv *pmp_priv); ++extern int free_mp_xmitframe(struct xmit_priv *pxmitpriv, struct mp_xmit_frame *pmp_xmitframe); ++#endif ++ ++extern s32 init_mp_priv(PADAPTER padapter); ++extern void free_mp_priv(struct mp_priv *pmp_priv); ++extern s32 MPT_InitializeAdapter(PADAPTER padapter, u8 Channel); ++extern void MPT_DeInitAdapter(PADAPTER padapter); ++extern s32 mp_start_test(PADAPTER padapter); ++extern void mp_stop_test(PADAPTER padapter); ++ ++extern u32 _read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask); ++extern void _write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask, u32 val); ++ ++extern u32 read_macreg(_adapter *padapter, u32 addr, u32 sz); ++extern void write_macreg(_adapter *padapter, u32 addr, u32 val, u32 sz); ++extern u32 read_bbreg(_adapter *padapter, u32 addr, u32 bitmask); ++extern void write_bbreg(_adapter *padapter, u32 addr, u32 bitmask, u32 val); ++extern u32 read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr); ++extern void write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 val); ++ ++void SetChannel(PADAPTER pAdapter); ++void SetBandwidth(PADAPTER pAdapter); ++int SetTxPower(PADAPTER pAdapter); ++void SetAntenna(PADAPTER pAdapter); ++void SetDataRate(PADAPTER pAdapter); ++void SetAntenna(PADAPTER pAdapter); ++s32 SetThermalMeter(PADAPTER pAdapter, u8 target_ther); ++void GetThermalMeter(PADAPTER pAdapter, u8 *value); ++void SetContinuousTx(PADAPTER pAdapter, u8 bStart); ++void SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart); ++void SetSingleToneTx(PADAPTER pAdapter, u8 bStart); ++void SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart); ++void PhySetTxPowerLevel(PADAPTER pAdapter); ++void fill_txdesc_for_mp(PADAPTER padapter, u8 *ptxdesc); ++void SetPacketTx(PADAPTER padapter); ++void SetPacketRx(PADAPTER pAdapter, u8 bStartRx, u8 bAB); ++void ResetPhyRxPktCount(PADAPTER pAdapter); ++u32 GetPhyRxPktReceived(PADAPTER pAdapter); ++u32 GetPhyRxPktCRC32Error(PADAPTER pAdapter); ++s32 SetPowerTracking(PADAPTER padapter, u8 enable); ++void GetPowerTracking(PADAPTER padapter, u8 *enable); ++u32 mp_query_psd(PADAPTER pAdapter, u8 *data); ++void rtw_mp_trigger_iqk(PADAPTER padapter); ++void rtw_mp_trigger_lck(PADAPTER padapter); ++ ++ ++ ++void hal_mpt_SwitchRfSetting(PADAPTER pAdapter); ++s32 hal_mpt_SetPowerTracking(PADAPTER padapter, u8 enable); ++void hal_mpt_GetPowerTracking(PADAPTER padapter, u8 *enable); ++void hal_mpt_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14); ++void hal_mpt_SetChannel(PADAPTER pAdapter); ++void hal_mpt_SetBandwidth(PADAPTER pAdapter); ++void hal_mpt_SetTxPower(PADAPTER pAdapter); ++void hal_mpt_SetDataRate(PADAPTER pAdapter); ++void hal_mpt_SetAntenna(PADAPTER pAdapter); ++s32 hal_mpt_SetThermalMeter(PADAPTER pAdapter, u8 target_ther); ++void hal_mpt_TriggerRFThermalMeter(PADAPTER pAdapter); ++u8 hal_mpt_ReadRFThermalMeter(PADAPTER pAdapter); ++void hal_mpt_GetThermalMeter(PADAPTER pAdapter, u8 *value); ++void hal_mpt_SetContinuousTx(PADAPTER pAdapter, u8 bStart); ++void hal_mpt_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart); ++void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart); ++void hal_mpt_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart); ++void hal_mpt_SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart); ++void hal_mpt_SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart); ++void mpt_ProSetPMacTx(PADAPTER Adapter); ++ ++void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter , BOOLEAN bMain); ++ULONG mpt_ProQueryCalTxPower(PADAPTER pAdapter, u8 RfPath); ++void MPT_PwrCtlDM(PADAPTER padapter, u32 bstart); ++u8 MptToMgntRate(u32 MptRateIdx); ++u8 rtw_mpRateParseFunc(PADAPTER pAdapter, u8 *targetStr); ++u32 mp_join(PADAPTER padapter, u8 mode); ++u32 hal_mpt_query_phytxok(PADAPTER pAdapter); ++ ++void ++PMAC_Get_Pkt_Param( ++ PRT_PMAC_TX_INFO pPMacTxInfo, ++ PRT_PMAC_PKT_INFO pPMacPktInfo ++); ++void ++CCK_generator( ++ PRT_PMAC_TX_INFO pPMacTxInfo, ++ PRT_PMAC_PKT_INFO pPMacPktInfo ++); ++void ++PMAC_Nsym_generator( ++ PRT_PMAC_TX_INFO pPMacTxInfo, ++ PRT_PMAC_PKT_INFO pPMacPktInfo ++); ++void ++L_SIG_generator( ++ UINT N_SYM, /* Max: 750*/ ++ PRT_PMAC_TX_INFO pPMacTxInfo, ++ PRT_PMAC_PKT_INFO pPMacPktInfo ++); ++ ++void HT_SIG_generator( ++ PRT_PMAC_TX_INFO pPMacTxInfo, ++ PRT_PMAC_PKT_INFO pPMacPktInfo); ++ ++void VHT_SIG_A_generator( ++ PRT_PMAC_TX_INFO pPMacTxInfo, ++ PRT_PMAC_PKT_INFO pPMacPktInfo); ++ ++void VHT_SIG_B_generator( ++ PRT_PMAC_TX_INFO pPMacTxInfo); ++ ++void VHT_Delimiter_generator( ++ PRT_PMAC_TX_INFO pPMacTxInfo); ++ ++ ++int rtw_mp_write_reg(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_read_reg(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_write_rf(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_read_rf(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_start(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_stop(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_rate(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_channel(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_bandwidth(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_txpower_index(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_txpower(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_txpower(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_ant_tx(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_ant_rx(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_set_ctx_destAddr(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_ctx(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_disable_bt_coexist(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra); ++int rtw_mp_disable_bt_coexist(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra); ++int rtw_mp_arx(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_trx_query(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_pwrtrk(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_psd(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_thermal(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_reset_stats(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_dump(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_phypara(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_SetRFPath(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_QueryDrv(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra); ++int rtw_mp_PwrCtlDM(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_getver(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra); ++int rtw_mp_mon(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra); ++int rtw_efuse_mask_file(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra); ++int rtw_efuse_file_map(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra); ++int rtw_mp_SetBT(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra); ++int rtw_mp_pretx_proc(PADAPTER padapter, u8 bStartTest, char *extra); ++int rtw_mp_tx(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra); ++int rtw_mp_rx(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra); ++int rtw_mp_hwtx(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra); ++u8 HwRateToMPTRate(u8 rate); ++int rtw_mp_iqk(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++int rtw_mp_lck(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra); ++#endif /* _RTW_MP_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mp_ioctl.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mp_ioctl.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mp_ioctl.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mp_ioctl.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,575 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTW_MP_IOCTL_H_ ++#define _RTW_MP_IOCTL_H_ ++ ++#include ++#include ++ ++#if 0 ++#define TESTFWCMDNUMBER 1000000 ++#define TEST_H2CINT_WAIT_TIME 500 ++#define TEST_C2HINT_WAIT_TIME 500 ++#define HCI_TEST_SYSCFG_HWMASK 1 ++#define _BUSCLK_40M (4 << 2) ++#endif ++/* ------------------------------------------------------------------------------ */ ++typedef struct CFG_DBG_MSG_STRUCT { ++ u32 DebugLevel; ++ u32 DebugComponent_H32; ++ u32 DebugComponent_L32; ++} CFG_DBG_MSG_STRUCT, *PCFG_DBG_MSG_STRUCT; ++ ++typedef struct _RW_REG { ++ u32 offset; ++ u32 width; ++ u32 value; ++} mp_rw_reg, RW_Reg, *pRW_Reg; ++ ++/* for OID_RT_PRO_READ16_EEPROM & OID_RT_PRO_WRITE16_EEPROM */ ++typedef struct _EEPROM_RW_PARAM { ++ u32 offset; ++ u16 value; ++} eeprom_rw_param, EEPROM_RWParam, *pEEPROM_RWParam; ++ ++typedef struct _EFUSE_ACCESS_STRUCT_ { ++ u16 start_addr; ++ u16 cnts; ++ u8 data[0]; ++} EFUSE_ACCESS_STRUCT, *PEFUSE_ACCESS_STRUCT; ++ ++typedef struct _BURST_RW_REG { ++ u32 offset; ++ u32 len; ++ u8 Data[256]; ++} burst_rw_reg, Burst_RW_Reg, *pBurst_RW_Reg; ++ ++typedef struct _USB_VendorReq { ++ u8 bRequest; ++ u16 wValue; ++ u16 wIndex; ++ u16 wLength; ++ u8 u8Dir;/* 0:OUT, 1:IN */ ++ u8 u8InData; ++} usb_vendor_req, USB_VendorReq, *pUSB_VendorReq; ++ ++typedef struct _DR_VARIABLE_STRUCT_ { ++ u8 offset; ++ u32 variable; ++} DR_VARIABLE_STRUCT; ++ ++/* int mp_start_joinbss(_adapter *padapter, NDIS_802_11_SSID *pssid); */ ++ ++/* void _irqlevel_changed_(_irqL *irqlevel, BOOLEANunsigned char bLower); */ ++#ifdef PLATFORM_OS_XP ++static void _irqlevel_changed_(_irqL *irqlevel, u8 bLower) ++{ ++ ++ if (bLower == LOWER) { ++ *irqlevel = KeGetCurrentIrql(); ++ ++ if (*irqlevel > PASSIVE_LEVEL) ++ KeLowerIrql(PASSIVE_LEVEL); ++ } else { ++ if (KeGetCurrentIrql() == PASSIVE_LEVEL) ++ KeRaiseIrql(DISPATCH_LEVEL, irqlevel); ++ } ++ ++} ++#else ++#define _irqlevel_changed_(a, b) ++#endif ++ ++/* oid_rtl_seg_81_80_00 */ ++NDIS_STATUS oid_rt_pro_set_data_rate_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_start_test_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_stop_test_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv *poid_par_priv); ++/* oid_rtl_seg_81_80_20 */ ++NDIS_STATUS oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv); ++ ++NDIS_STATUS oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_set_modulation_hdl(struct oid_par_priv *poid_par_priv); ++ ++NDIS_STATUS oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++/* oid_rtl_seg_81_87 */ ++NDIS_STATUS oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv *poid_par_priv); ++ ++NDIS_STATUS oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++/* oid_rtl_seg_81_85 */ ++NDIS_STATUS oid_rt_wireless_mode_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++/* oid_rtl_seg_87_11_00 */ ++NDIS_STATUS oid_rt_pro8711_join_bss_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_read_register_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_write_register_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_burst_read_register_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_burst_write_register_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_write_txcmd_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_write16_eeprom_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_rd_attrib_mem_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_wr_attrib_mem_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_poll_rx_status_hdl(struct oid_par_priv *poid_par_priv); ++/* oid_rtl_seg_87_11_20 */ ++NDIS_STATUS oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_read_tssi_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv *poid_par_priv); ++/* oid_rtl_seg_87_11_50 */ ++NDIS_STATUS oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv *poid_par_priv); ++/* oid_rtl_seg_87_11_F0 */ ++NDIS_STATUS oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv *poid_par_priv); ++ ++ ++/* oid_rtl_seg_87_12_00 */ ++NDIS_STATUS oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_add_sta_info_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv); ++ ++NDIS_STATUS oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv); ++ ++NDIS_STATUS oid_rt_set_bandwidth_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_set_crystal_cap_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_set_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_efuse_max_size_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv *poid_par_priv); ++ ++NDIS_STATUS oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv *poid_par_priv); ++ ++NDIS_STATUS oid_rt_get_thermal_meter_hdl(struct oid_par_priv *poid_par_priv); ++ ++NDIS_STATUS oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv); ++NDIS_STATUS oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv); ++ ++NDIS_STATUS oid_rt_set_power_down_hdl(struct oid_par_priv *poid_par_priv); ++ ++NDIS_STATUS oid_rt_get_power_mode_hdl(struct oid_par_priv *poid_par_priv); ++ ++NDIS_STATUS oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv); ++ ++#ifdef _RTW_MP_IOCTL_C_ ++ ++const struct oid_obj_priv oid_rtl_seg_81_80_00[] = { ++ {1, &oid_null_function}, /* 0x00 OID_RT_PRO_RESET_DUT */ ++ {1, &oid_rt_pro_set_data_rate_hdl}, /* 0x01 */ ++ {1, &oid_rt_pro_start_test_hdl}, /* 0x02 */ ++ {1, &oid_rt_pro_stop_test_hdl}, /* 0x03 */ ++ {1, &oid_null_function}, /* 0x04 OID_RT_PRO_SET_PREAMBLE */ ++ {1, &oid_null_function}, /* 0x05 OID_RT_PRO_SET_SCRAMBLER */ ++ {1, &oid_null_function}, /* 0x06 OID_RT_PRO_SET_FILTER_BB */ ++ {1, &oid_null_function}, /* 0x07 OID_RT_PRO_SET_MANUAL_DIVERSITY_BB */ ++ {1, &oid_rt_pro_set_channel_direct_call_hdl}, /* 0x08 */ ++ {1, &oid_null_function}, /* 0x09 OID_RT_PRO_SET_SLEEP_MODE_DIRECT_CALL */ ++ {1, &oid_null_function}, /* 0x0A OID_RT_PRO_SET_WAKE_MODE_DIRECT_CALL */ ++ {1, &oid_rt_pro_set_continuous_tx_hdl}, /* 0x0B OID_RT_PRO_SET_TX_CONTINUOUS_DIRECT_CALL */ ++ {1, &oid_rt_pro_set_single_carrier_tx_hdl}, /* 0x0C OID_RT_PRO_SET_SINGLE_CARRIER_TX_CONTINUOUS */ ++ {1, &oid_null_function}, /* 0x0D OID_RT_PRO_SET_TX_ANTENNA_BB */ ++ {1, &oid_rt_pro_set_antenna_bb_hdl}, /* 0x0E */ ++ {1, &oid_null_function}, /* 0x0F OID_RT_PRO_SET_CR_SCRAMBLER */ ++ {1, &oid_null_function}, /* 0x10 OID_RT_PRO_SET_CR_NEW_FILTER */ ++ {1, &oid_rt_pro_set_tx_power_control_hdl}, /* 0x11 OID_RT_PRO_SET_TX_POWER_CONTROL */ ++ {1, &oid_null_function}, /* 0x12 OID_RT_PRO_SET_CR_TX_CONFIG */ ++ {1, &oid_null_function}, /* 0x13 OID_RT_PRO_GET_TX_POWER_CONTROL */ ++ {1, &oid_null_function}, /* 0x14 OID_RT_PRO_GET_CR_SIGNAL_QUALITY */ ++ {1, &oid_null_function}, /* 0x15 OID_RT_PRO_SET_CR_SETPOINT */ ++ {1, &oid_null_function}, /* 0x16 OID_RT_PRO_SET_INTEGRATOR */ ++ {1, &oid_null_function}, /* 0x17 OID_RT_PRO_SET_SIGNAL_QUALITY */ ++ {1, &oid_null_function}, /* 0x18 OID_RT_PRO_GET_INTEGRATOR */ ++ {1, &oid_null_function}, /* 0x19 OID_RT_PRO_GET_SIGNAL_QUALITY */ ++ {1, &oid_null_function}, /* 0x1A OID_RT_PRO_QUERY_EEPROM_TYPE */ ++ {1, &oid_null_function}, /* 0x1B OID_RT_PRO_WRITE_MAC_ADDRESS */ ++ {1, &oid_null_function}, /* 0x1C OID_RT_PRO_READ_MAC_ADDRESS */ ++ {1, &oid_null_function}, /* 0x1D OID_RT_PRO_WRITE_CIS_DATA */ ++ {1, &oid_null_function}, /* 0x1E OID_RT_PRO_READ_CIS_DATA */ ++ {1, &oid_null_function} /* 0x1F OID_RT_PRO_WRITE_POWER_CONTROL */ ++ ++}; ++ ++const struct oid_obj_priv oid_rtl_seg_81_80_20[] = { ++ {1, &oid_null_function}, /* 0x20 OID_RT_PRO_READ_POWER_CONTROL */ ++ {1, &oid_null_function}, /* 0x21 OID_RT_PRO_WRITE_EEPROM */ ++ {1, &oid_null_function}, /* 0x22 OID_RT_PRO_READ_EEPROM */ ++ {1, &oid_rt_pro_reset_tx_packet_sent_hdl}, /* 0x23 */ ++ {1, &oid_rt_pro_query_tx_packet_sent_hdl}, /* 0x24 */ ++ {1, &oid_rt_pro_reset_rx_packet_received_hdl}, /* 0x25 */ ++ {1, &oid_rt_pro_query_rx_packet_received_hdl}, /* 0x26 */ ++ {1, &oid_rt_pro_query_rx_packet_crc32_error_hdl}, /* 0x27 */ ++ {1, &oid_null_function}, /* 0x28 OID_RT_PRO_QUERY_CURRENT_ADDRESS */ ++ {1, &oid_null_function}, /* 0x29 OID_RT_PRO_QUERY_PERMANENT_ADDRESS */ ++ {1, &oid_null_function}, /* 0x2A OID_RT_PRO_SET_PHILIPS_RF_PARAMETERS */ ++ {1, &oid_rt_pro_set_carrier_suppression_tx_hdl},/* 0x2B OID_RT_PRO_SET_CARRIER_SUPPRESSION_TX */ ++ {1, &oid_null_function}, /* 0x2C OID_RT_PRO_RECEIVE_PACKET */ ++ {1, &oid_null_function}, /* 0x2D OID_RT_PRO_WRITE_EEPROM_BYTE */ ++ {1, &oid_null_function}, /* 0x2E OID_RT_PRO_READ_EEPROM_BYTE */ ++ {1, &oid_rt_pro_set_modulation_hdl} /* 0x2F */ ++ ++}; ++ ++const struct oid_obj_priv oid_rtl_seg_81_80_40[] = { ++ {1, &oid_null_function}, /* 0x40 */ ++ {1, &oid_null_function}, /* 0x41 */ ++ {1, &oid_null_function}, /* 0x42 */ ++ {1, &oid_rt_pro_set_single_tone_tx_hdl}, /* 0x43 */ ++ {1, &oid_null_function}, /* 0x44 */ ++ {1, &oid_null_function} /* 0x45 */ ++}; ++ ++const struct oid_obj_priv oid_rtl_seg_81_80_80[] = { ++ {1, &oid_null_function}, /* 0x80 OID_RT_DRIVER_OPTION */ ++ {1, &oid_null_function}, /* 0x81 OID_RT_RF_OFF */ ++ {1, &oid_null_function} /* 0x82 OID_RT_AUTH_STATUS */ ++ ++}; ++ ++const struct oid_obj_priv oid_rtl_seg_81_85[] = { ++ {1, &oid_rt_wireless_mode_hdl} /* 0x00 OID_RT_WIRELESS_MODE */ ++}; ++ ++struct oid_obj_priv oid_rtl_seg_81_87[] = { ++ {1, &oid_null_function}, /* 0x80 OID_RT_PRO8187_WI_POLL */ ++ {1, &oid_rt_pro_write_bb_reg_hdl}, /* 0x81 */ ++ {1, &oid_rt_pro_read_bb_reg_hdl}, /* 0x82 */ ++ {1, &oid_rt_pro_write_rf_reg_hdl}, /* 0x82 */ ++ {1, &oid_rt_pro_read_rf_reg_hdl} /* 0x83 */ ++}; ++ ++struct oid_obj_priv oid_rtl_seg_87_11_00[] = { ++ {1, &oid_rt_pro8711_join_bss_hdl}, /* 0x00 */ /* S */ ++ {1, &oid_rt_pro_read_register_hdl}, /* 0x01 */ ++ {1, &oid_rt_pro_write_register_hdl}, /* 0x02 */ ++ {1, &oid_rt_pro_burst_read_register_hdl}, /* 0x03 */ ++ {1, &oid_rt_pro_burst_write_register_hdl}, /* 0x04 */ ++ {1, &oid_rt_pro_write_txcmd_hdl}, /* 0x05 */ ++ {1, &oid_rt_pro_read16_eeprom_hdl}, /* 0x06 */ ++ {1, &oid_rt_pro_write16_eeprom_hdl}, /* 0x07 */ ++ {1, &oid_null_function}, /* 0x08 OID_RT_PRO_H2C_SET_COMMAND */ ++ {1, &oid_null_function}, /* 0x09 OID_RT_PRO_H2C_QUERY_RESULT */ ++ {1, &oid_rt_pro8711_wi_poll_hdl}, /* 0x0A */ ++ {1, &oid_rt_pro8711_pkt_loss_hdl}, /* 0x0B */ ++ {1, &oid_rt_rd_attrib_mem_hdl}, /* 0x0C */ ++ {1, &oid_rt_wr_attrib_mem_hdl}, /* 0x0D */ ++ {1, &oid_null_function}, /* 0x0E */ ++ {1, &oid_null_function}, /* 0x0F */ ++ {1, &oid_null_function}, /* 0x10 OID_RT_PRO_H2C_CMD_MODE */ ++ {1, &oid_null_function}, /* 0x11 OID_RT_PRO_H2C_CMD_RSP_MODE */ ++ {1, &oid_null_function}, /* 0X12 OID_RT_PRO_WAIT_C2H_EVENT */ ++ {1, &oid_null_function}, /* 0X13 OID_RT_PRO_RW_ACCESS_PROTOCOL_TEST */ ++ {1, &oid_null_function}, /* 0X14 OID_RT_PRO_SCSI_ACCESS_TEST */ ++ {1, &oid_null_function}, /* 0X15 OID_RT_PRO_SCSI_TCPIPOFFLOAD_OUT */ ++ {1, &oid_null_function}, /* 0X16 OID_RT_PRO_SCSI_TCPIPOFFLOAD_IN */ ++ {1, &oid_null_function}, /* 0X17 OID_RT_RRO_RX_PKT_VIA_IOCTRL */ ++ {1, &oid_null_function}, /* 0X18 OID_RT_RRO_RX_PKTARRAY_VIA_IOCTRL */ ++ {1, &oid_null_function}, /* 0X19 OID_RT_RPO_SET_PWRMGT_TEST */ ++ {1, &oid_null_function}, /* 0X1A */ ++ {1, &oid_null_function}, /* 0X1B OID_RT_PRO_QRY_PWRMGT_TEST */ ++ {1, &oid_null_function}, /* 0X1C OID_RT_RPO_ASYNC_RWIO_TEST */ ++ {1, &oid_null_function}, /* 0X1D OID_RT_RPO_ASYNC_RWIO_POLL */ ++ {1, &oid_rt_pro_set_rf_intfs_hdl}, /* 0X1E */ ++ {1, &oid_rt_poll_rx_status_hdl} /* 0X1F */ ++}; ++ ++struct oid_obj_priv oid_rtl_seg_87_11_20[] = { ++ {1, &oid_rt_pro_cfg_debug_message_hdl}, /* 0x20 */ ++ {1, &oid_rt_pro_set_data_rate_ex_hdl}, /* 0x21 */ ++ {1, &oid_rt_pro_set_basic_rate_hdl}, /* 0x22 */ ++ {1, &oid_rt_pro_read_tssi_hdl}, /* 0x23 */ ++ {1, &oid_rt_pro_set_power_tracking_hdl} /* 0x24 */ ++}; ++ ++ ++struct oid_obj_priv oid_rtl_seg_87_11_50[] = { ++ {1, &oid_rt_pro_qry_pwrstate_hdl}, /* 0x50 */ ++ {1, &oid_rt_pro_set_pwrstate_hdl} /* 0x51 */ ++}; ++ ++struct oid_obj_priv oid_rtl_seg_87_11_80[] = { ++ {1, &oid_null_function} /* 0x80 */ ++}; ++ ++struct oid_obj_priv oid_rtl_seg_87_11_B0[] = { ++ {1, &oid_null_function} /* 0xB0 */ ++}; ++ ++struct oid_obj_priv oid_rtl_seg_87_11_F0[] = { ++ {1, &oid_null_function}, /* 0xF0 */ ++ {1, &oid_null_function}, /* 0xF1 */ ++ {1, &oid_null_function}, /* 0xF2 */ ++ {1, &oid_null_function}, /* 0xF3 */ ++ {1, &oid_null_function}, /* 0xF4 */ ++ {1, &oid_null_function}, /* 0xF5 */ ++ {1, &oid_null_function}, /* 0xF6 */ ++ {1, &oid_null_function}, /* 0xF7 */ ++ {1, &oid_null_function}, /* 0xF8 */ ++ {1, &oid_null_function}, /* 0xF9 */ ++ {1, &oid_null_function}, /* 0xFA */ ++ {1, &oid_rt_pro_h2c_set_rate_table_hdl}, /* 0xFB */ ++ {1, &oid_rt_pro_h2c_get_rate_table_hdl}, /* 0xFC */ ++ {1, &oid_null_function}, /* 0xFD */ ++ {1, &oid_null_function}, /* 0xFE OID_RT_PRO_H2C_C2H_LBK_TEST */ ++ {1, &oid_null_function} /* 0xFF */ ++ ++}; ++ ++struct oid_obj_priv oid_rtl_seg_87_12_00[] = { ++ {1, &oid_rt_pro_encryption_ctrl_hdl}, /* 0x00 Q&S */ ++ {1, &oid_rt_pro_add_sta_info_hdl}, /* 0x01 S */ ++ {1, &oid_rt_pro_dele_sta_info_hdl}, /* 0x02 S */ ++ {1, &oid_rt_pro_query_dr_variable_hdl}, /* 0x03 Q */ ++ {1, &oid_rt_pro_rx_packet_type_hdl}, /* 0x04 Q,S */ ++ {1, &oid_rt_pro_read_efuse_hdl}, /* 0x05 Q OID_RT_PRO_READ_EFUSE */ ++ {1, &oid_rt_pro_write_efuse_hdl}, /* 0x06 S OID_RT_PRO_WRITE_EFUSE */ ++ {1, &oid_rt_pro_rw_efuse_pgpkt_hdl}, /* 0x07 Q,S */ ++ {1, &oid_rt_get_efuse_current_size_hdl}, /* 0x08 Q */ ++ {1, &oid_rt_set_bandwidth_hdl}, /* 0x09 */ ++ {1, &oid_rt_set_crystal_cap_hdl}, /* 0x0a */ ++ {1, &oid_rt_set_rx_packet_type_hdl}, /* 0x0b S */ ++ {1, &oid_rt_get_efuse_max_size_hdl}, /* 0x0c */ ++ {1, &oid_rt_pro_set_tx_agc_offset_hdl}, /* 0x0d */ ++ {1, &oid_rt_pro_set_pkt_test_mode_hdl}, /* 0x0e */ ++ {1, &oid_null_function}, /* 0x0f OID_RT_PRO_FOR_EVM_TEST_SETTING */ ++ {1, &oid_rt_get_thermal_meter_hdl}, /* 0x10 Q OID_RT_PRO_GET_THERMAL_METER */ ++ {1, &oid_rt_reset_phy_rx_packet_count_hdl}, /* 0x11 S OID_RT_RESET_PHY_RX_PACKET_COUNT */ ++ {1, &oid_rt_get_phy_rx_packet_received_hdl}, /* 0x12 Q OID_RT_GET_PHY_RX_PACKET_RECEIVED */ ++ {1, &oid_rt_get_phy_rx_packet_crc32_error_hdl}, /* 0x13 Q OID_RT_GET_PHY_RX_PACKET_CRC32_ERROR */ ++ {1, &oid_rt_set_power_down_hdl}, /* 0x14 Q OID_RT_SET_POWER_DOWN */ ++ {1, &oid_rt_get_power_mode_hdl} /* 0x15 Q OID_RT_GET_POWER_MODE */ ++}; ++ ++#else /* _RTL871X_MP_IOCTL_C_ */ ++ ++extern struct oid_obj_priv oid_rtl_seg_81_80_00[32]; ++extern struct oid_obj_priv oid_rtl_seg_81_80_20[16]; ++extern struct oid_obj_priv oid_rtl_seg_81_80_40[6]; ++extern struct oid_obj_priv oid_rtl_seg_81_80_80[3]; ++ ++extern struct oid_obj_priv oid_rtl_seg_81_85[1]; ++extern struct oid_obj_priv oid_rtl_seg_81_87[5]; ++ ++extern struct oid_obj_priv oid_rtl_seg_87_11_00[32]; ++extern struct oid_obj_priv oid_rtl_seg_87_11_20[5]; ++extern struct oid_obj_priv oid_rtl_seg_87_11_50[2]; ++extern struct oid_obj_priv oid_rtl_seg_87_11_80[1]; ++extern struct oid_obj_priv oid_rtl_seg_87_11_B0[1]; ++extern struct oid_obj_priv oid_rtl_seg_87_11_F0[16]; ++ ++extern struct oid_obj_priv oid_rtl_seg_87_12_00[32]; ++ ++#endif /* _RTL871X_MP_IOCTL_C_ */ ++ ++struct rwreg_param { ++ u32 offset; ++ u32 width; ++ u32 value; ++}; ++ ++struct bbreg_param { ++ u32 offset; ++ u32 phymask; ++ u32 value; ++}; ++/* ++struct rfchannel_param{ ++ u32 ch; ++ u32 modem; ++}; ++*/ ++struct txpower_param { ++ u32 pwr_index; ++}; ++ ++ ++struct datarate_param { ++ u32 rate_index; ++}; ++ ++ ++struct rfintfs_parm { ++ u32 rfintfs; ++}; ++ ++typedef struct _mp_xmit_parm_ { ++ u8 enable; ++ u32 count; ++ u16 length; ++ u8 payload_type; ++ u8 da[ETH_ALEN]; ++} MP_XMIT_PARM, *PMP_XMIT_PARM; ++ ++struct mp_xmit_packet { ++ u32 len; ++ u32 mem[MAX_MP_XMITBUF_SZ >> 2]; ++}; ++ ++struct psmode_param { ++ u32 ps_mode; ++ u32 smart_ps; ++}; ++ ++/* for OID_RT_PRO_READ16_EEPROM & OID_RT_PRO_WRITE16_EEPROM */ ++struct eeprom_rw_param { ++ u32 offset; ++ u16 value; ++}; ++ ++struct mp_ioctl_handler { ++ u32 paramsize; ++ u32(*handler)(struct oid_par_priv *poid_par_priv); ++ u32 oid; ++}; ++ ++struct mp_ioctl_param { ++ u32 subcode; ++ u32 len; ++ u8 data[0]; ++}; ++ ++#define GEN_MP_IOCTL_SUBCODE(code) _MP_IOCTL_ ## code ## _CMD_ ++ ++enum RTL871X_MP_IOCTL_SUBCODE { ++ GEN_MP_IOCTL_SUBCODE(MP_START), /*0*/ ++ GEN_MP_IOCTL_SUBCODE(MP_STOP), ++ GEN_MP_IOCTL_SUBCODE(READ_REG), ++ GEN_MP_IOCTL_SUBCODE(WRITE_REG), ++ GEN_MP_IOCTL_SUBCODE(READ_BB_REG), ++ GEN_MP_IOCTL_SUBCODE(WRITE_BB_REG), /*5*/ ++ GEN_MP_IOCTL_SUBCODE(READ_RF_REG), ++ GEN_MP_IOCTL_SUBCODE(WRITE_RF_REG), ++ GEN_MP_IOCTL_SUBCODE(SET_CHANNEL), ++ GEN_MP_IOCTL_SUBCODE(SET_TXPOWER), ++ GEN_MP_IOCTL_SUBCODE(SET_DATARATE), /*10*/ ++ GEN_MP_IOCTL_SUBCODE(SET_BANDWIDTH), ++ GEN_MP_IOCTL_SUBCODE(SET_ANTENNA), ++ GEN_MP_IOCTL_SUBCODE(CNTU_TX), ++ GEN_MP_IOCTL_SUBCODE(SC_TX), ++ GEN_MP_IOCTL_SUBCODE(CS_TX), /*15*/ ++ GEN_MP_IOCTL_SUBCODE(ST_TX), ++ GEN_MP_IOCTL_SUBCODE(IOCTL_XMIT_PACKET), ++ GEN_MP_IOCTL_SUBCODE(SET_RX_PKT_TYPE), ++ GEN_MP_IOCTL_SUBCODE(RESET_PHY_RX_PKT_CNT), ++ GEN_MP_IOCTL_SUBCODE(GET_PHY_RX_PKT_RECV), /*20*/ ++ GEN_MP_IOCTL_SUBCODE(GET_PHY_RX_PKT_ERROR), ++ GEN_MP_IOCTL_SUBCODE(READ16_EEPROM), ++ GEN_MP_IOCTL_SUBCODE(WRITE16_EEPROM), ++ GEN_MP_IOCTL_SUBCODE(EFUSE), ++ GEN_MP_IOCTL_SUBCODE(EFUSE_MAP), /*25*/ ++ GEN_MP_IOCTL_SUBCODE(GET_EFUSE_MAX_SIZE), ++ GEN_MP_IOCTL_SUBCODE(GET_EFUSE_CURRENT_SIZE), ++ GEN_MP_IOCTL_SUBCODE(GET_THERMAL_METER), ++ GEN_MP_IOCTL_SUBCODE(SET_PTM), ++ GEN_MP_IOCTL_SUBCODE(SET_POWER_DOWN), /*30*/ ++ GEN_MP_IOCTL_SUBCODE(TRIGGER_GPIO), ++ GEN_MP_IOCTL_SUBCODE(SET_DM_BT), /*32*/ ++ GEN_MP_IOCTL_SUBCODE(DEL_BA), /*33*/ ++ GEN_MP_IOCTL_SUBCODE(GET_WIFI_STATUS), /*34*/ ++ MAX_MP_IOCTL_SUBCODE, ++}; ++ ++u32 mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv); ++ ++#ifdef _RTW_MP_IOCTL_C_ ++ ++#define GEN_MP_IOCTL_HANDLER(sz, hdl, oid) {sz, hdl, oid}, ++ ++#define EXT_MP_IOCTL_HANDLER(sz, subcode, oid) {sz, mp_ioctl_ ## subcode ## _hdl, oid}, ++ ++ ++struct mp_ioctl_handler mp_ioctl_hdl[] = { ++ ++ /*0*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_start_test_hdl, OID_RT_PRO_START_TEST) ++ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_stop_test_hdl, OID_RT_PRO_STOP_TEST) ++ ++ GEN_MP_IOCTL_HANDLER(sizeof(struct rwreg_param), oid_rt_pro_read_register_hdl, OID_RT_PRO_READ_REGISTER) ++ GEN_MP_IOCTL_HANDLER(sizeof(struct rwreg_param), oid_rt_pro_write_register_hdl, OID_RT_PRO_WRITE_REGISTER) ++ GEN_MP_IOCTL_HANDLER(sizeof(struct bb_reg_param), oid_rt_pro_read_bb_reg_hdl, OID_RT_PRO_READ_BB_REG) ++ /*5*/ GEN_MP_IOCTL_HANDLER(sizeof(struct bb_reg_param), oid_rt_pro_write_bb_reg_hdl, OID_RT_PRO_WRITE_BB_REG) ++ GEN_MP_IOCTL_HANDLER(sizeof(struct rf_reg_param), oid_rt_pro_read_rf_reg_hdl, OID_RT_PRO_RF_READ_REGISTRY) ++ GEN_MP_IOCTL_HANDLER(sizeof(struct rf_reg_param), oid_rt_pro_write_rf_reg_hdl, OID_RT_PRO_RF_WRITE_REGISTRY) ++ ++ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_channel_direct_call_hdl, OID_RT_PRO_SET_CHANNEL_DIRECT_CALL) ++ GEN_MP_IOCTL_HANDLER(sizeof(struct txpower_param), oid_rt_pro_set_tx_power_control_hdl, OID_RT_PRO_SET_TX_POWER_CONTROL) ++ /*10*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_data_rate_hdl, OID_RT_PRO_SET_DATA_RATE) ++ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_set_bandwidth_hdl, OID_RT_SET_BANDWIDTH) ++ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_antenna_bb_hdl, OID_RT_PRO_SET_ANTENNA_BB) ++ ++ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_continuous_tx_hdl, OID_RT_PRO_SET_CONTINUOUS_TX) ++ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_single_carrier_tx_hdl, OID_RT_PRO_SET_SINGLE_CARRIER_TX) ++ /*15*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_carrier_suppression_tx_hdl, OID_RT_PRO_SET_CARRIER_SUPPRESSION_TX) ++ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_single_tone_tx_hdl, OID_RT_PRO_SET_SINGLE_TONE_TX) ++ ++ EXT_MP_IOCTL_HANDLER(0, xmit_packet, 0) ++ ++ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_set_rx_packet_type_hdl, OID_RT_SET_RX_PACKET_TYPE) ++ GEN_MP_IOCTL_HANDLER(0, oid_rt_reset_phy_rx_packet_count_hdl, OID_RT_RESET_PHY_RX_PACKET_COUNT) ++ /*20*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_phy_rx_packet_received_hdl, OID_RT_GET_PHY_RX_PACKET_RECEIVED) ++ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_phy_rx_packet_crc32_error_hdl, OID_RT_GET_PHY_RX_PACKET_CRC32_ERROR) ++ ++ GEN_MP_IOCTL_HANDLER(sizeof(struct eeprom_rw_param), NULL, 0) ++ GEN_MP_IOCTL_HANDLER(sizeof(struct eeprom_rw_param), NULL, 0) ++ GEN_MP_IOCTL_HANDLER(sizeof(EFUSE_ACCESS_STRUCT), oid_rt_pro_efuse_hdl, OID_RT_PRO_EFUSE) ++ /*25*/ GEN_MP_IOCTL_HANDLER(0, oid_rt_pro_efuse_map_hdl, OID_RT_PRO_EFUSE_MAP) ++ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_efuse_max_size_hdl, OID_RT_GET_EFUSE_MAX_SIZE) ++ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_efuse_current_size_hdl, OID_RT_GET_EFUSE_CURRENT_SIZE) ++ ++ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_thermal_meter_hdl, OID_RT_PRO_GET_THERMAL_METER) ++ GEN_MP_IOCTL_HANDLER(sizeof(u8), oid_rt_pro_set_power_tracking_hdl, OID_RT_PRO_SET_POWER_TRACKING) ++ /*30*/ GEN_MP_IOCTL_HANDLER(sizeof(u8), oid_rt_set_power_down_hdl, OID_RT_SET_POWER_DOWN) ++ /*31*/ GEN_MP_IOCTL_HANDLER(0, oid_rt_pro_trigger_gpio_hdl, 0) ++ GEN_MP_IOCTL_HANDLER(0, NULL, 0) ++ GEN_MP_IOCTL_HANDLER(0, NULL, 0) ++ GEN_MP_IOCTL_HANDLER(0, NULL, 0) ++}; ++ ++#else /* _RTW_MP_IOCTL_C_ */ ++ ++extern struct mp_ioctl_handler mp_ioctl_hdl[]; ++ ++#endif /* _RTW_MP_IOCTL_C_ */ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mp_phy_regdef.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mp_phy_regdef.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mp_phy_regdef.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mp_phy_regdef.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,1099 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++/***************************************************************************** ++ * ++ * Module: __RTW_MP_PHY_REGDEF_H_ ++ * ++ * ++ * Note: 1. Define PMAC/BB register map ++ * 2. Define RF register map ++ * 3. PMAC/BB register bit mask. ++ * 4. RF reg bit mask. ++ * 5. Other BB/RF relative definition. ++ * ++ * ++ * Export: Constants, macro, functions(API), global variables(None). ++ * ++ * Abbrev: ++ * ++ * History: ++ * Data Who Remark ++ * 08/07/2007 MHC 1. Porting from 9x series PHYCFG.h. ++ * 2. Reorganize code architecture. ++ * 09/25/2008 MH 1. Add RL6052 register definition ++ * ++ *****************************************************************************/ ++#ifndef __RTW_MP_PHY_REGDEF_H_ ++#define __RTW_MP_PHY_REGDEF_H_ ++ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++ ++/* ************************************************************ ++ * 8192S Regsiter offset definition ++ * ************************************************************ */ ++ ++/* ++ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 ++ * 3. RF register 0x00-2E ++ * 4. Bit Mask for BB/RF register ++ * 5. Other defintion for BB/RF R/W ++ * */ ++ ++ ++/* ++ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++ * 1. Page1(0x100) ++ * */ ++#define rPMAC_Reset 0x100 ++#define rPMAC_TxStart 0x104 ++#define rPMAC_TxLegacySIG 0x108 ++#define rPMAC_TxHTSIG1 0x10c ++#define rPMAC_TxHTSIG2 0x110 ++#define rPMAC_PHYDebug 0x114 ++#define rPMAC_TxPacketNum 0x118 ++#define rPMAC_TxIdle 0x11c ++#define rPMAC_TxMACHeader0 0x120 ++#define rPMAC_TxMACHeader1 0x124 ++#define rPMAC_TxMACHeader2 0x128 ++#define rPMAC_TxMACHeader3 0x12c ++#define rPMAC_TxMACHeader4 0x130 ++#define rPMAC_TxMACHeader5 0x134 ++#define rPMAC_TxDataType 0x138 ++#define rPMAC_TxRandomSeed 0x13c ++#define rPMAC_CCKPLCPPreamble 0x140 ++#define rPMAC_CCKPLCPHeader 0x144 ++#define rPMAC_CCKCRC16 0x148 ++#define rPMAC_OFDMRxCRC32OK 0x170 ++#define rPMAC_OFDMRxCRC32Er 0x174 ++#define rPMAC_OFDMRxParityEr 0x178 ++#define rPMAC_OFDMRxCRC8Er 0x17c ++#define rPMAC_CCKCRxRC16Er 0x180 ++#define rPMAC_CCKCRxRC32Er 0x184 ++#define rPMAC_CCKCRxRC32OK 0x188 ++#define rPMAC_TxStatus 0x18c ++ ++/* ++ * 2. Page2(0x200) ++ * ++ * The following two definition are only used for USB interface. ++ * #define RF_BB_CMD_ADDR 0x02c0 */ /* RF/BB read/write command address. ++ * #define RF_BB_CMD_DATA 0x02c4 */ /* RF/BB read/write command data. */ ++ ++/* ++ * 3. Page8(0x800) ++ * */ ++#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ ++ ++#define rFPGA0_TxInfo 0x804 /* Status report?? */ ++#define rFPGA0_PSDFunction 0x808 ++ ++#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ ++ ++#define rFPGA0_RFTiming1 0x810 /* Useless now */ ++#define rFPGA0_RFTiming2 0x814 ++/* #define rFPGA0_XC_RFTiming 0x818 */ ++/* #define rFPGA0_XD_RFTiming 0x81c */ ++ ++#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ ++#define rFPGA0_XA_HSSIParameter2 0x824 ++#define rFPGA0_XB_HSSIParameter1 0x828 ++#define rFPGA0_XB_HSSIParameter2 0x82c ++#define rFPGA0_XC_HSSIParameter1 0x830 ++#define rFPGA0_XC_HSSIParameter2 0x834 ++#define rFPGA0_XD_HSSIParameter1 0x838 ++#define rFPGA0_XD_HSSIParameter2 0x83c ++#define rFPGA0_XA_LSSIParameter 0x840 ++#define rFPGA0_XB_LSSIParameter 0x844 ++#define rFPGA0_XC_LSSIParameter 0x848 ++#define rFPGA0_XD_LSSIParameter 0x84c ++ ++#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ ++#define rFPGA0_RFSleepUpParameter 0x854 ++ ++#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ ++#define rFPGA0_XCD_SwitchControl 0x85c ++ ++#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ ++#define rFPGA0_XB_RFInterfaceOE 0x864 ++#define rFPGA0_XC_RFInterfaceOE 0x868 ++#define rFPGA0_XD_RFInterfaceOE 0x86c ++ ++#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ ++#define rFPGA0_XCD_RFInterfaceSW 0x874 ++ ++#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ ++#define rFPGA0_XCD_RFParameter 0x87c ++ ++#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ ++#define rFPGA0_AnalogParameter2 0x884 ++#define rFPGA0_AnalogParameter3 0x888 /* Useless now */ ++#define rFPGA0_AnalogParameter4 0x88c ++ ++#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ ++#define rFPGA0_XB_LSSIReadBack 0x8a4 ++#define rFPGA0_XC_LSSIReadBack 0x8a8 ++#define rFPGA0_XD_LSSIReadBack 0x8ac ++ ++#define rFPGA0_PSDReport 0x8b4 /* Useless now */ ++#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ ++#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ ++ ++/* ++ * 4. Page9(0x900) ++ * */ ++#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ ++ ++#define rFPGA1_TxBlock 0x904 /* Useless now */ ++#define rFPGA1_DebugSelect 0x908 /* Useless now */ ++#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ ++#define rS0S1_PathSwitch 0x948 ++ ++/* ++ * 5. PageA(0xA00) ++ * ++ * Set Control channel to upper or lower. These settings are required only for 40MHz */ ++#define rCCK0_System 0xa00 ++ ++#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ ++#define rCCK0_CCA 0xa08 /* Disable init gain now */ /* Init gain */ ++ ++#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level */ /* Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ ++#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ ++ ++#define rCCK0_RxHP 0xa14 ++ ++#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ ++#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ ++ ++#define rCCK0_TxFilter1 0xa20 ++#define rCCK0_TxFilter2 0xa24 ++#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ ++#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ ++#define rCCK0_TRSSIReport 0xa50 ++#define rCCK0_RxReport 0xa54 /* 0xa57 */ ++#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ ++#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ ++ ++/* ++ * 6. PageC(0xC00) ++ * */ ++#define rOFDM0_LSTF 0xc00 ++ ++#define rOFDM0_TRxPathEnable 0xc04 ++#define rOFDM0_TRMuxPar 0xc08 ++#define rOFDM0_TRSWIsolation 0xc0c ++ ++#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ ++#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ ++#define rOFDM0_XBRxAFE 0xc18 ++#define rOFDM0_XBRxIQImbalance 0xc1c ++#define rOFDM0_XCRxAFE 0xc20 ++#define rOFDM0_XCRxIQImbalance 0xc24 ++#define rOFDM0_XDRxAFE 0xc28 ++#define rOFDM0_XDRxIQImbalance 0xc2c ++ ++#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ ++#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ ++#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ ++#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ ++ ++#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ ++#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ ++#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ ++#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ ++ ++#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ ++#define rOFDM0_XAAGCCore2 0xc54 ++#define rOFDM0_XBAGCCore1 0xc58 ++#define rOFDM0_XBAGCCore2 0xc5c ++#define rOFDM0_XCAGCCore1 0xc60 ++#define rOFDM0_XCAGCCore2 0xc64 ++#define rOFDM0_XDAGCCore1 0xc68 ++#define rOFDM0_XDAGCCore2 0xc6c ++ ++#define rOFDM0_AGCParameter1 0xc70 ++#define rOFDM0_AGCParameter2 0xc74 ++#define rOFDM0_AGCRSSITable 0xc78 ++#define rOFDM0_HTSTFAGC 0xc7c ++ ++#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ ++#define rOFDM0_XATxAFE 0xc84 ++#define rOFDM0_XBTxIQImbalance 0xc88 ++#define rOFDM0_XBTxAFE 0xc8c ++#define rOFDM0_XCTxIQImbalance 0xc90 ++#define rOFDM0_XCTxAFE 0xc94 ++#define rOFDM0_XDTxIQImbalance 0xc98 ++#define rOFDM0_XDTxAFE 0xc9c ++#define rOFDM0_RxIQExtAnta 0xca0 ++ ++#define rOFDM0_RxHPParameter 0xce0 ++#define rOFDM0_TxPseudoNoiseWgt 0xce4 ++#define rOFDM0_FrameSync 0xcf0 ++#define rOFDM0_DFSReport 0xcf4 ++#define rOFDM0_TxCoeff1 0xca4 ++#define rOFDM0_TxCoeff2 0xca8 ++#define rOFDM0_TxCoeff3 0xcac ++#define rOFDM0_TxCoeff4 0xcb0 ++#define rOFDM0_TxCoeff5 0xcb4 ++#define rOFDM0_TxCoeff6 0xcb8 ++ ++ ++/* ++ * 7. PageD(0xD00) ++ * */ ++#define rOFDM1_LSTF 0xd00 ++#define rOFDM1_TRxPathEnable 0xd04 ++ ++#define rOFDM1_CFO 0xd08 /* No setting now */ ++#define rOFDM1_CSI1 0xd10 ++#define rOFDM1_SBD 0xd14 ++#define rOFDM1_CSI2 0xd18 ++#define rOFDM1_CFOTracking 0xd2c ++#define rOFDM1_TRxMesaure1 0xd34 ++#define rOFDM1_IntfDet 0xd3c ++#define rOFDM1_PseudoNoiseStateAB 0xd50 ++#define rOFDM1_PseudoNoiseStateCD 0xd54 ++#define rOFDM1_RxPseudoNoiseWgt 0xd58 ++ ++#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ ++#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ ++#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ ++ ++#define rOFDM_ShortCFOAB 0xdac /* No setting now */ ++#define rOFDM_ShortCFOCD 0xdb0 ++#define rOFDM_LongCFOAB 0xdb4 ++#define rOFDM_LongCFOCD 0xdb8 ++#define rOFDM_TailCFOAB 0xdbc ++#define rOFDM_TailCFOCD 0xdc0 ++#define rOFDM_PWMeasure1 0xdc4 ++#define rOFDM_PWMeasure2 0xdc8 ++#define rOFDM_BWReport 0xdcc ++#define rOFDM_AGCReport 0xdd0 ++#define rOFDM_RxSNR 0xdd4 ++#define rOFDM_RxEVMCSI 0xdd8 ++#define rOFDM_SIGReport 0xddc ++ ++ ++/* ++ * 8. PageE(0xE00) ++ * */ ++#define rTxAGC_Rate18_06 0xe00 ++#define rTxAGC_Rate54_24 0xe04 ++#define rTxAGC_CCK_Mcs32 0xe08 ++#define rTxAGC_Mcs03_Mcs00 0xe10 ++#define rTxAGC_Mcs07_Mcs04 0xe14 ++#define rTxAGC_Mcs11_Mcs08 0xe18 ++#define rTxAGC_Mcs15_Mcs12 0xe1c ++ ++/* Analog- control in RX_WAIT_CCA : REG: EE0 [Analog- Power & Control Register] */ ++#define rRx_Wait_CCCA 0xe70 ++#define rAnapar_Ctrl_BB 0xee0 ++ ++/* ++ * 7. RF Register 0x00-0x2E (RF 8256) ++ * RF-0222D 0x00-3F ++ * ++ * Zebra1 */ ++#define RTL92SE_FPGA_VERIFY 0 ++#define rZebra1_HSSIEnable 0x0 /* Useless now */ ++#define rZebra1_TRxEnable1 0x1 ++#define rZebra1_TRxEnable2 0x2 ++#define rZebra1_AGC 0x4 ++#define rZebra1_ChargePump 0x5 ++/* #if (RTL92SE_FPGA_VERIFY == 1) */ ++#define rZebra1_Channel 0x7 /* RF channel switch ++ * #else */ ++ ++/* #endif */ ++#define rZebra1_TxGain 0x8 /* Useless now */ ++#define rZebra1_TxLPF 0x9 ++#define rZebra1_RxLPF 0xb ++#define rZebra1_RxHPFCorner 0xc ++ ++/* Zebra4 */ ++#define rGlobalCtrl 0 /* Useless now */ ++#define rRTL8256_TxLPF 19 ++#define rRTL8256_RxLPF 11 ++ ++/* RTL8258 */ ++#define rRTL8258_TxLPF 0x11 /* Useless now */ ++#define rRTL8258_RxLPF 0x13 ++#define rRTL8258_RSSILPF 0xa ++ ++/* ++ * RL6052 Register definition ++ * */ ++#define RF_AC 0x00 /* */ ++ ++#define RF_IQADJ_G1 0x01 /* */ ++#define RF_IQADJ_G2 0x02 /* */ ++#define RF_POW_TRSW 0x05 /* */ ++ ++#define RF_GAIN_RX 0x06 /* */ ++#define RF_GAIN_TX 0x07 /* */ ++ ++#define RF_TXM_IDAC 0x08 /* */ ++#define RF_BS_IQGEN 0x0F /* */ ++ ++#define RF_MODE1 0x10 /* */ ++#define RF_MODE2 0x11 /* */ ++ ++#define RF_RX_AGC_HP 0x12 /* */ ++#define RF_TX_AGC 0x13 /* */ ++#define RF_BIAS 0x14 /* */ ++#define RF_IPA 0x15 /* */ ++#define RF_TXBIAS 0x16 ++#define RF_POW_ABILITY 0x17 /* */ ++#define RF_MODE_AG 0x18 /* */ ++#define rRfChannel 0x18 /* RF channel and BW switch */ ++#define RF_CHNLBW 0x18 /* RF channel and BW switch */ ++#define RF_TOP 0x19 /* */ ++ ++#define RF_RX_G1 0x1A /* */ ++#define RF_RX_G2 0x1B /* */ ++ ++#define RF_RX_BB2 0x1C /* */ ++#define RF_RX_BB1 0x1D /* */ ++ ++#define RF_RCK1 0x1E /* */ ++#define RF_RCK2 0x1F /* */ ++ ++#define RF_TX_G1 0x20 /* */ ++#define RF_TX_G2 0x21 /* */ ++#define RF_TX_G3 0x22 /* */ ++ ++#define RF_TX_BB1 0x23 /* */ ++ ++#define RF_T_METER 0x24 /* */ ++ ++#define RF_SYN_G1 0x25 /* RF TX Power control */ ++#define RF_SYN_G2 0x26 /* RF TX Power control */ ++#define RF_SYN_G3 0x27 /* RF TX Power control */ ++#define RF_SYN_G4 0x28 /* RF TX Power control */ ++#define RF_SYN_G5 0x29 /* RF TX Power control */ ++#define RF_SYN_G6 0x2A /* RF TX Power control */ ++#define RF_SYN_G7 0x2B /* RF TX Power control */ ++#define RF_SYN_G8 0x2C /* RF TX Power control */ ++ ++#define RF_RCK_OS 0x30 /* RF TX PA control */ ++ ++#define RF_TXPA_G1 0x31 /* RF TX PA control */ ++#define RF_TXPA_G2 0x32 /* RF TX PA control */ ++#define RF_TXPA_G3 0x33 /* RF TX PA control */ ++ ++/* ++ * Bit Mask ++ * ++ * 1. Page1(0x100) */ ++#define bBBResetB 0x100 /* Useless now? */ ++#define bGlobalResetB 0x200 ++#define bOFDMTxStart 0x4 ++#define bCCKTxStart 0x8 ++#define bCRC32Debug 0x100 ++#define bPMACLoopback 0x10 ++#define bTxLSIG 0xffffff ++#define bOFDMTxRate 0xf ++#define bOFDMTxReserved 0x10 ++#define bOFDMTxLength 0x1ffe0 ++#define bOFDMTxParity 0x20000 ++#define bTxHTSIG1 0xffffff ++#define bTxHTMCSRate 0x7f ++#define bTxHTBW 0x80 ++#define bTxHTLength 0xffff00 ++#define bTxHTSIG2 0xffffff ++#define bTxHTSmoothing 0x1 ++#define bTxHTSounding 0x2 ++#define bTxHTReserved 0x4 ++#define bTxHTAggreation 0x8 ++#define bTxHTSTBC 0x30 ++#define bTxHTAdvanceCoding 0x40 ++#define bTxHTShortGI 0x80 ++#define bTxHTNumberHT_LTF 0x300 ++#define bTxHTCRC8 0x3fc00 ++#define bCounterReset 0x10000 ++#define bNumOfOFDMTx 0xffff ++#define bNumOfCCKTx 0xffff0000 ++#define bTxIdleInterval 0xffff ++#define bOFDMService 0xffff0000 ++#define bTxMACHeader 0xffffffff ++#define bTxDataInit 0xff ++#define bTxHTMode 0x100 ++#define bTxDataType 0x30000 ++#define bTxRandomSeed 0xffffffff ++#define bCCKTxPreamble 0x1 ++#define bCCKTxSFD 0xffff0000 ++#define bCCKTxSIG 0xff ++#define bCCKTxService 0xff00 ++#define bCCKLengthExt 0x8000 ++#define bCCKTxLength 0xffff0000 ++#define bCCKTxCRC16 0xffff ++#define bCCKTxStatus 0x1 ++#define bOFDMTxStatus 0x2 ++ ++#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) ++ ++/* 2. Page8(0x800) */ ++#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ ++#define bJapanMode 0x2 ++#define bCCKTxSC 0x30 ++#define bCCKEn 0x1000000 ++#define bOFDMEn 0x2000000 ++ ++#define bOFDMRxADCPhase 0x10000 /* Useless now */ ++#define bOFDMTxDACPhase 0x40000 ++#define bXATxAGC 0x3f ++ ++#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ ++#define bXCTxAGC 0xf000 ++#define bXDTxAGC 0xf0000 ++ ++#define bPAStart 0xf0000000 /* Useless now */ ++#define bTRStart 0x00f00000 ++#define bRFStart 0x0000f000 ++#define bBBStart 0x000000f0 ++#define bBBCCKStart 0x0000000f ++#define bPAEnd 0xf /* Reg0x814 */ ++#define bTREnd 0x0f000000 ++#define bRFEnd 0x000f0000 ++#define bCCAMask 0x000000f0 /* T2R */ ++#define bR2RCCAMask 0x00000f00 ++#define bHSSI_R2TDelay 0xf8000000 ++#define bHSSI_T2RDelay 0xf80000 ++#define bContTxHSSI 0x400 /* chane gain at continue Tx */ ++#define bIGFromCCK 0x200 ++#define bAGCAddress 0x3f ++#define bRxHPTx 0x7000 ++#define bRxHPT2R 0x38000 ++#define bRxHPCCKIni 0xc0000 ++#define bAGCTxCode 0xc00000 ++#define bAGCRxCode 0x300000 ++ ++#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ ++#define b3WireAddressLength 0x400 ++ ++#define b3WireRFPowerDown 0x1 /* Useless now ++ * #define bHWSISelect 0x8 */ ++#define b5GPAPEPolarity 0x40000000 ++#define b2GPAPEPolarity 0x80000000 ++#define bRFSW_TxDefaultAnt 0x3 ++#define bRFSW_TxOptionAnt 0x30 ++#define bRFSW_RxDefaultAnt 0x300 ++#define bRFSW_RxOptionAnt 0x3000 ++#define bRFSI_3WireData 0x1 ++#define bRFSI_3WireClock 0x2 ++#define bRFSI_3WireLoad 0x4 ++#define bRFSI_3WireRW 0x8 ++#define bRFSI_3Wire 0xf ++ ++#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ ++ ++#define bRFSI_TRSW 0x20 /* Useless now */ ++#define bRFSI_TRSWB 0x40 ++#define bRFSI_ANTSW 0x100 ++#define bRFSI_ANTSWB 0x200 ++#define bRFSI_PAPE 0x400 ++#define bRFSI_PAPE5G 0x800 ++#define bBandSelect 0x1 ++#define bHTSIG2_GI 0x80 ++#define bHTSIG2_Smoothing 0x01 ++#define bHTSIG2_Sounding 0x02 ++#define bHTSIG2_Aggreaton 0x08 ++#define bHTSIG2_STBC 0x30 ++#define bHTSIG2_AdvCoding 0x40 ++#define bHTSIG2_NumOfHTLTF 0x300 ++#define bHTSIG2_CRC8 0x3fc ++#define bHTSIG1_MCS 0x7f ++#define bHTSIG1_BandWidth 0x80 ++#define bHTSIG1_HTLength 0xffff ++#define bLSIG_Rate 0xf ++#define bLSIG_Reserved 0x10 ++#define bLSIG_Length 0x1fffe ++#define bLSIG_Parity 0x20 ++#define bCCKRxPhase 0x4 ++#if (RTL92SE_FPGA_VERIFY == 1) ++ #define bLSSIReadAddress 0x3f000000 /* LSSI "Read" Address */ /* Reg 0x824 rFPGA0_XA_HSSIParameter2 */ ++#else ++ #define bLSSIReadAddress 0x7f800000 /* T65 RF */ ++#endif ++#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ ++#if (RTL92SE_FPGA_VERIFY == 1) ++ #define bLSSIReadBackData 0xfff /* Reg 0x8a0 rFPGA0_XA_LSSIReadBack */ ++#else ++ #define bLSSIReadBackData 0xfffff /* T65 RF */ ++#endif ++#define bLSSIReadOKFlag 0x1000 /* Useless now */ ++#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ ++#define bRegulator0Standby 0x1 ++#define bRegulatorPLLStandby 0x2 ++#define bRegulator1Standby 0x4 ++#define bPLLPowerUp 0x8 ++#define bDPLLPowerUp 0x10 ++#define bDA10PowerUp 0x20 ++#define bAD7PowerUp 0x200 ++#define bDA6PowerUp 0x2000 ++#define bXtalPowerUp 0x4000 ++#define b40MDClkPowerUP 0x8000 ++#define bDA6DebugMode 0x20000 ++#define bDA6Swing 0x380000 ++ ++#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ ++ ++#define b80MClkDelay 0x18000000 /* Useless */ ++#define bAFEWatchDogEnable 0x20000000 ++ ++#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ ++#define bXtalCap23 0x3 ++#define bXtalCap92x 0x0f000000 ++#define bXtalCap 0x0f000000 ++ ++#define bIntDifClkEnable 0x400 /* Useless */ ++#define bExtSigClkEnable 0x800 ++#define bBandgapMbiasPowerUp 0x10000 ++#define bAD11SHGain 0xc0000 ++#define bAD11InputRange 0x700000 ++#define bAD11OPCurrent 0x3800000 ++#define bIPathLoopback 0x4000000 ++#define bQPathLoopback 0x8000000 ++#define bAFELoopback 0x10000000 ++#define bDA10Swing 0x7e0 ++#define bDA10Reverse 0x800 ++#define bDAClkSource 0x1000 ++#define bAD7InputRange 0x6000 ++#define bAD7Gain 0x38000 ++#define bAD7OutputCMMode 0x40000 ++#define bAD7InputCMMode 0x380000 ++#define bAD7Current 0xc00000 ++#define bRegulatorAdjust 0x7000000 ++#define bAD11PowerUpAtTx 0x1 ++#define bDA10PSAtTx 0x10 ++#define bAD11PowerUpAtRx 0x100 ++#define bDA10PSAtRx 0x1000 ++#define bCCKRxAGCFormat 0x200 ++#define bPSDFFTSamplepPoint 0xc000 ++#define bPSDAverageNum 0x3000 ++#define bIQPathControl 0xc00 ++#define bPSDFreq 0x3ff ++#define bPSDAntennaPath 0x30 ++#define bPSDIQSwitch 0x40 ++#define bPSDRxTrigger 0x400000 ++#define bPSDTxTrigger 0x80000000 ++#define bPSDSineToneScale 0x7f000000 ++#define bPSDReport 0xffff ++ ++/* 3. Page9(0x900) */ ++#define bOFDMTxSC 0x30000000 /* Useless */ ++#define bCCKTxOn 0x1 ++#define bOFDMTxOn 0x2 ++#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ ++#define bDebugItem 0xff /* reset debug page and LWord */ ++#define bAntL 0x10 ++#define bAntNonHT 0x100 ++#define bAntHT1 0x1000 ++#define bAntHT2 0x10000 ++#define bAntHT1S1 0x100000 ++#define bAntNonHTS1 0x1000000 ++ ++/* 4. PageA(0xA00) */ ++#define bCCKBBMode 0x3 /* Useless */ ++#define bCCKTxPowerSaving 0x80 ++#define bCCKRxPowerSaving 0x40 ++ ++#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ ++ ++#define bCCKScramble 0x8 /* Useless */ ++#define bCCKAntDiversity 0x8000 ++#define bCCKCarrierRecovery 0x4000 ++#define bCCKTxRate 0x3000 ++#define bCCKDCCancel 0x0800 ++#define bCCKISICancel 0x0400 ++#define bCCKMatchFilter 0x0200 ++#define bCCKEqualizer 0x0100 ++#define bCCKPreambleDetect 0x800000 ++#define bCCKFastFalseCCA 0x400000 ++#define bCCKChEstStart 0x300000 ++#define bCCKCCACount 0x080000 ++#define bCCKcs_lim 0x070000 ++#define bCCKBistMode 0x80000000 ++#define bCCKCCAMask 0x40000000 ++#define bCCKTxDACPhase 0x4 ++#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ ++#define bCCKr_cp_mode0 0x0100 ++#define bCCKTxDCOffset 0xf0 ++#define bCCKRxDCOffset 0xf ++#define bCCKCCAMode 0xc000 ++#define bCCKFalseCS_lim 0x3f00 ++#define bCCKCS_ratio 0xc00000 ++#define bCCKCorgBit_sel 0x300000 ++#define bCCKPD_lim 0x0f0000 ++#define bCCKNewCCA 0x80000000 ++#define bCCKRxHPofIG 0x8000 ++#define bCCKRxIG 0x7f00 ++#define bCCKLNAPolarity 0x800000 ++#define bCCKRx1stGain 0x7f0000 ++#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ ++#define bCCKRxAGCSatLevel 0x1f000000 ++#define bCCKRxAGCSatCount 0xe0 ++#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ ++#define bCCKFixedRxAGC 0x8000 ++/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ ++#define bCCKAntennaPolarity 0x2000 ++#define bCCKTxFilterType 0x0c00 ++#define bCCKRxAGCReportType 0x0300 ++#define bCCKRxDAGCEn 0x80000000 ++#define bCCKRxDAGCPeriod 0x20000000 ++#define bCCKRxDAGCSatLevel 0x1f000000 ++#define bCCKTimingRecovery 0x800000 ++#define bCCKTxC0 0x3f0000 ++#define bCCKTxC1 0x3f000000 ++#define bCCKTxC2 0x3f ++#define bCCKTxC3 0x3f00 ++#define bCCKTxC4 0x3f0000 ++#define bCCKTxC5 0x3f000000 ++#define bCCKTxC6 0x3f ++#define bCCKTxC7 0x3f00 ++#define bCCKDebugPort 0xff0000 ++#define bCCKDACDebug 0x0f000000 ++#define bCCKFalseAlarmEnable 0x8000 ++#define bCCKFalseAlarmRead 0x4000 ++#define bCCKTRSSI 0x7f ++#define bCCKRxAGCReport 0xfe ++#define bCCKRxReport_AntSel 0x80000000 ++#define bCCKRxReport_MFOff 0x40000000 ++#define bCCKRxRxReport_SQLoss 0x20000000 ++#define bCCKRxReport_Pktloss 0x10000000 ++#define bCCKRxReport_Lockedbit 0x08000000 ++#define bCCKRxReport_RateError 0x04000000 ++#define bCCKRxReport_RxRate 0x03000000 ++#define bCCKRxFACounterLower 0xff ++#define bCCKRxFACounterUpper 0xff000000 ++#define bCCKRxHPAGCStart 0xe000 ++#define bCCKRxHPAGCFinal 0x1c00 ++#define bCCKRxFalseAlarmEnable 0x8000 ++#define bCCKFACounterFreeze 0x4000 ++#define bCCKTxPathSel 0x10000000 ++#define bCCKDefaultRxPath 0xc000000 ++#define bCCKOptionRxPath 0x3000000 ++ ++/* 5. PageC(0xC00) */ ++#define bNumOfSTF 0x3 /* Useless */ ++#define bShift_L 0xc0 ++#define bGI_TH 0xc ++#define bRxPathA 0x1 ++#define bRxPathB 0x2 ++#define bRxPathC 0x4 ++#define bRxPathD 0x8 ++#define bTxPathA 0x1 ++#define bTxPathB 0x2 ++#define bTxPathC 0x4 ++#define bTxPathD 0x8 ++#define bTRSSIFreq 0x200 ++#define bADCBackoff 0x3000 ++#define bDFIRBackoff 0xc000 ++#define bTRSSILatchPhase 0x10000 ++#define bRxIDCOffset 0xff ++#define bRxQDCOffset 0xff00 ++#define bRxDFIRMode 0x1800000 ++#define bRxDCNFType 0xe000000 ++#define bRXIQImb_A 0x3ff ++#define bRXIQImb_B 0xfc00 ++#define bRXIQImb_C 0x3f0000 ++#define bRXIQImb_D 0xffc00000 ++#define bDC_dc_Notch 0x60000 ++#define bRxNBINotch 0x1f000000 ++#define bPD_TH 0xf ++#define bPD_TH_Opt2 0xc000 ++#define bPWED_TH 0x700 ++#define bIfMF_Win_L 0x800 ++#define bPD_Option 0x1000 ++#define bMF_Win_L 0xe000 ++#define bBW_Search_L 0x30000 ++#define bwin_enh_L 0xc0000 ++#define bBW_TH 0x700000 ++#define bED_TH2 0x3800000 ++#define bBW_option 0x4000000 ++#define bRatio_TH 0x18000000 ++#define bWindow_L 0xe0000000 ++#define bSBD_Option 0x1 ++#define bFrame_TH 0x1c ++#define bFS_Option 0x60 ++#define bDC_Slope_check 0x80 ++#define bFGuard_Counter_DC_L 0xe00 ++#define bFrame_Weight_Short 0x7000 ++#define bSub_Tune 0xe00000 ++#define bFrame_DC_Length 0xe000000 ++#define bSBD_start_offset 0x30000000 ++#define bFrame_TH_2 0x7 ++#define bFrame_GI2_TH 0x38 ++#define bGI2_Sync_en 0x40 ++#define bSarch_Short_Early 0x300 ++#define bSarch_Short_Late 0xc00 ++#define bSarch_GI2_Late 0x70000 ++#define bCFOAntSum 0x1 ++#define bCFOAcc 0x2 ++#define bCFOStartOffset 0xc ++#define bCFOLookBack 0x70 ++#define bCFOSumWeight 0x80 ++#define bDAGCEnable 0x10000 ++#define bTXIQImb_A 0x3ff ++#define bTXIQImb_B 0xfc00 ++#define bTXIQImb_C 0x3f0000 ++#define bTXIQImb_D 0xffc00000 ++#define bTxIDCOffset 0xff ++#define bTxQDCOffset 0xff00 ++#define bTxDFIRMode 0x10000 ++#define bTxPesudoNoiseOn 0x4000000 ++#define bTxPesudoNoise_A 0xff ++#define bTxPesudoNoise_B 0xff00 ++#define bTxPesudoNoise_C 0xff0000 ++#define bTxPesudoNoise_D 0xff000000 ++#define bCCADropOption 0x20000 ++#define bCCADropThres 0xfff00000 ++#define bEDCCA_H 0xf ++#define bEDCCA_L 0xf0 ++#define bLambda_ED 0x300 ++#define bRxInitialGain 0x7f ++#define bRxAntDivEn 0x80 ++#define bRxAGCAddressForLNA 0x7f00 ++#define bRxHighPowerFlow 0x8000 ++#define bRxAGCFreezeThres 0xc0000 ++#define bRxFreezeStep_AGC1 0x300000 ++#define bRxFreezeStep_AGC2 0xc00000 ++#define bRxFreezeStep_AGC3 0x3000000 ++#define bRxFreezeStep_AGC0 0xc000000 ++#define bRxRssi_Cmp_En 0x10000000 ++#define bRxQuickAGCEn 0x20000000 ++#define bRxAGCFreezeThresMode 0x40000000 ++#define bRxOverFlowCheckType 0x80000000 ++#define bRxAGCShift 0x7f ++#define bTRSW_Tri_Only 0x80 ++#define bPowerThres 0x300 ++#define bRxAGCEn 0x1 ++#define bRxAGCTogetherEn 0x2 ++#define bRxAGCMin 0x4 ++#define bRxHP_Ini 0x7 ++#define bRxHP_TRLNA 0x70 ++#define bRxHP_RSSI 0x700 ++#define bRxHP_BBP1 0x7000 ++#define bRxHP_BBP2 0x70000 ++#define bRxHP_BBP3 0x700000 ++#define bRSSI_H 0x7f0000 /* the threshold for high power */ ++#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ ++#define bRxSettle_TRSW 0x7 ++#define bRxSettle_LNA 0x38 ++#define bRxSettle_RSSI 0x1c0 ++#define bRxSettle_BBP 0xe00 ++#define bRxSettle_RxHP 0x7000 ++#define bRxSettle_AntSW_RSSI 0x38000 ++#define bRxSettle_AntSW 0xc0000 ++#define bRxProcessTime_DAGC 0x300000 ++#define bRxSettle_HSSI 0x400000 ++#define bRxProcessTime_BBPPW 0x800000 ++#define bRxAntennaPowerShift 0x3000000 ++#define bRSSITableSelect 0xc000000 ++#define bRxHP_Final 0x7000000 ++#define bRxHTSettle_BBP 0x7 ++#define bRxHTSettle_HSSI 0x8 ++#define bRxHTSettle_RxHP 0x70 ++#define bRxHTSettle_BBPPW 0x80 ++#define bRxHTSettle_Idle 0x300 ++#define bRxHTSettle_Reserved 0x1c00 ++#define bRxHTRxHPEn 0x8000 ++#define bRxHTAGCFreezeThres 0x30000 ++#define bRxHTAGCTogetherEn 0x40000 ++#define bRxHTAGCMin 0x80000 ++#define bRxHTAGCEn 0x100000 ++#define bRxHTDAGCEn 0x200000 ++#define bRxHTRxHP_BBP 0x1c00000 ++#define bRxHTRxHP_Final 0xe0000000 ++#define bRxPWRatioTH 0x3 ++#define bRxPWRatioEn 0x4 ++#define bRxMFHold 0x3800 ++#define bRxPD_Delay_TH1 0x38 ++#define bRxPD_Delay_TH2 0x1c0 ++#define bRxPD_DC_COUNT_MAX 0x600 ++/* #define bRxMF_Hold 0x3800 */ ++#define bRxPD_Delay_TH 0x8000 ++#define bRxProcess_Delay 0xf0000 ++#define bRxSearchrange_GI2_Early 0x700000 ++#define bRxFrame_Guard_Counter_L 0x3800000 ++#define bRxSGI_Guard_L 0xc000000 ++#define bRxSGI_Search_L 0x30000000 ++#define bRxSGI_TH 0xc0000000 ++#define bDFSCnt0 0xff ++#define bDFSCnt1 0xff00 ++#define bDFSFlag 0xf0000 ++#define bMFWeightSum 0x300000 ++#define bMinIdxTH 0x7f000000 ++#define bDAFormat 0x40000 ++#define bTxChEmuEnable 0x01000000 ++#define bTRSWIsolation_A 0x7f ++#define bTRSWIsolation_B 0x7f00 ++#define bTRSWIsolation_C 0x7f0000 ++#define bTRSWIsolation_D 0x7f000000 ++#define bExtLNAGain 0x7c00 ++ ++/* 6. PageE(0xE00) */ ++#define bSTBCEn 0x4 /* Useless */ ++#define bAntennaMapping 0x10 ++#define bNss 0x20 ++#define bCFOAntSumD 0x200 ++#define bPHYCounterReset 0x8000000 ++#define bCFOReportGet 0x4000000 ++#define bOFDMContinueTx 0x10000000 ++#define bOFDMSingleCarrier 0x20000000 ++#define bOFDMSingleTone 0x40000000 ++/* #define bRxPath1 0x01 */ ++/* #define bRxPath2 0x02 */ ++/* #define bRxPath3 0x04 */ ++/* #define bRxPath4 0x08 */ ++/* #define bTxPath1 0x10 */ ++/* #define bTxPath2 0x20 */ ++#define bHTDetect 0x100 ++#define bCFOEn 0x10000 ++#define bCFOValue 0xfff00000 ++#define bSigTone_Re 0x3f ++#define bSigTone_Im 0x7f00 ++#define bCounter_CCA 0xffff ++#define bCounter_ParityFail 0xffff0000 ++#define bCounter_RateIllegal 0xffff ++#define bCounter_CRC8Fail 0xffff0000 ++#define bCounter_MCSNoSupport 0xffff ++#define bCounter_FastSync 0xffff ++#define bShortCFO 0xfff ++#define bShortCFOTLength 12 /* total */ ++#define bShortCFOFLength 11 /* fraction */ ++#define bLongCFO 0x7ff ++#define bLongCFOTLength 11 ++#define bLongCFOFLength 11 ++#define bTailCFO 0x1fff ++#define bTailCFOTLength 13 ++#define bTailCFOFLength 12 ++#define bmax_en_pwdB 0xffff ++#define bCC_power_dB 0xffff0000 ++#define bnoise_pwdB 0xffff ++#define bPowerMeasTLength 10 ++#define bPowerMeasFLength 3 ++#define bRx_HT_BW 0x1 ++#define bRxSC 0x6 ++#define bRx_HT 0x8 ++#define bNB_intf_det_on 0x1 ++#define bIntf_win_len_cfg 0x30 ++#define bNB_Intf_TH_cfg 0x1c0 ++#define bRFGain 0x3f ++#define bTableSel 0x40 ++#define bTRSW 0x80 ++#define bRxSNR_A 0xff ++#define bRxSNR_B 0xff00 ++#define bRxSNR_C 0xff0000 ++#define bRxSNR_D 0xff000000 ++#define bSNREVMTLength 8 ++#define bSNREVMFLength 1 ++#define bCSI1st 0xff ++#define bCSI2nd 0xff00 ++#define bRxEVM1st 0xff0000 ++#define bRxEVM2nd 0xff000000 ++#define bSIGEVM 0xff ++#define bPWDB 0xff00 ++#define bSGIEN 0x10000 ++ ++#define bSFactorQAM1 0xf /* Useless */ ++#define bSFactorQAM2 0xf0 ++#define bSFactorQAM3 0xf00 ++#define bSFactorQAM4 0xf000 ++#define bSFactorQAM5 0xf0000 ++#define bSFactorQAM6 0xf0000 ++#define bSFactorQAM7 0xf00000 ++#define bSFactorQAM8 0xf000000 ++#define bSFactorQAM9 0xf0000000 ++#define bCSIScheme 0x100000 ++ ++#define bNoiseLvlTopSet 0x3 /* Useless */ ++#define bChSmooth 0x4 ++#define bChSmoothCfg1 0x38 ++#define bChSmoothCfg2 0x1c0 ++#define bChSmoothCfg3 0xe00 ++#define bChSmoothCfg4 0x7000 ++#define bMRCMode 0x800000 ++#define bTHEVMCfg 0x7000000 ++ ++#define bLoopFitType 0x1 /* Useless */ ++#define bUpdCFO 0x40 ++#define bUpdCFOOffData 0x80 ++#define bAdvUpdCFO 0x100 ++#define bAdvTimeCtrl 0x800 ++#define bUpdClko 0x1000 ++#define bFC 0x6000 ++#define bTrackingMode 0x8000 ++#define bPhCmpEnable 0x10000 ++#define bUpdClkoLTF 0x20000 ++#define bComChCFO 0x40000 ++#define bCSIEstiMode 0x80000 ++#define bAdvUpdEqz 0x100000 ++#define bUChCfg 0x7000000 ++#define bUpdEqz 0x8000000 ++ ++#define bTxAGCRate18_06 0x7f7f7f7f /* Useless */ ++#define bTxAGCRate54_24 0x7f7f7f7f ++#define bTxAGCRateMCS32 0x7f ++#define bTxAGCRateCCK 0x7f00 ++#define bTxAGCRateMCS3_MCS0 0x7f7f7f7f ++#define bTxAGCRateMCS7_MCS4 0x7f7f7f7f ++#define bTxAGCRateMCS11_MCS8 0x7f7f7f7f ++#define bTxAGCRateMCS15_MCS12 0x7f7f7f7f ++ ++/* Rx Pseduo noise */ ++#define bRxPesudoNoiseOn 0x20000000 /* Useless */ ++#define bRxPesudoNoise_A 0xff ++#define bRxPesudoNoise_B 0xff00 ++#define bRxPesudoNoise_C 0xff0000 ++#define bRxPesudoNoise_D 0xff000000 ++#define bPesudoNoiseState_A 0xffff ++#define bPesudoNoiseState_B 0xffff0000 ++#define bPesudoNoiseState_C 0xffff ++#define bPesudoNoiseState_D 0xffff0000 ++ ++/* 7. RF Register ++ * Zebra1 */ ++#define bZebra1_HSSIEnable 0x8 /* Useless */ ++#define bZebra1_TRxControl 0xc00 ++#define bZebra1_TRxGainSetting 0x07f ++#define bZebra1_RxCorner 0xc00 ++#define bZebra1_TxChargePump 0x38 ++#define bZebra1_RxChargePump 0x7 ++#define bZebra1_ChannelNum 0xf80 ++#define bZebra1_TxLPFBW 0x400 ++#define bZebra1_RxLPFBW 0x600 ++ ++/* Zebra4 */ ++#define bRTL8256RegModeCtrl1 0x100 /* Useless */ ++#define bRTL8256RegModeCtrl0 0x40 ++#define bRTL8256_TxLPFBW 0x18 ++#define bRTL8256_RxLPFBW 0x600 ++ ++/* RTL8258 */ ++#define bRTL8258_TxLPFBW 0xc /* Useless */ ++#define bRTL8258_RxLPFBW 0xc00 ++#define bRTL8258_RSSILPFBW 0xc0 ++ ++ ++/* ++ * Other Definition ++ * */ ++ ++/* byte endable for sb_write */ ++#define bByte0 0x1 /* Useless */ ++#define bByte1 0x2 ++#define bByte2 0x4 ++#define bByte3 0x8 ++#define bWord0 0x3 ++#define bWord1 0xc ++#define bDWord 0xf ++ ++/* for PutRegsetting & GetRegSetting BitMask */ ++#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ ++#define bMaskByte1 0xff00 ++#define bMaskByte2 0xff0000 ++#define bMaskByte3 0xff000000 ++#define bMaskHWord 0xffff0000 ++#define bMaskLWord 0x0000ffff ++#define bMaskDWord 0xffffffff ++#define bMaskH4Bits 0xf0000000 ++#define bMaskH3Bytes 0xffffff00 ++#define bMaskOFDM_D 0xffc00000 ++#define bMaskCCK 0x3f3f3f3f ++#define bMask12Bits 0xfff ++ ++/* for PutRFRegsetting & GetRFRegSetting BitMask */ ++#if (RTL92SE_FPGA_VERIFY == 1) ++/* #define bMask12Bits 0xfff */ /* RF Reg mask bits */ ++/* #define bMask20Bits 0xfff */ /* RF Reg mask bits T65 RF */ ++#define bRFRegOffsetMask 0xfff ++#else ++/* #define bMask12Bits 0xfffff */ /* RF Reg mask bits */ ++/* #define bMask20Bits 0xfffff */ /* RF Reg mask bits T65 RF */ ++#define bRFRegOffsetMask 0xfffff ++#endif ++#define bEnable 0x1 /* Useless */ ++#define bDisable 0x0 ++ ++#define LeftAntenna 0x0 /* Useless */ ++#define RightAntenna 0x1 ++ ++#define tCheckTxStatus 500 /* 500ms */ /* Useless */ ++#define tUpdateRxCounter 100 /* 100ms */ ++ ++#define rateCCK 0 /* Useless */ ++#define rateOFDM 1 ++#define rateHT 2 ++ ++/* define Register-End */ ++#define bPMAC_End 0x1ff /* Useless */ ++#define bFPGAPHY0_End 0x8ff ++#define bFPGAPHY1_End 0x9ff ++#define bCCKPHY0_End 0xaff ++#define bOFDMPHY0_End 0xcff ++#define bOFDMPHY1_End 0xdff ++ ++/* define max debug item in each debug page ++ * #define bMaxItem_FPGA_PHY0 0x9 ++ * #define bMaxItem_FPGA_PHY1 0x3 ++ * #define bMaxItem_PHY_11B 0x16 ++ * #define bMaxItem_OFDM_PHY0 0x29 ++ * #define bMaxItem_OFDM_PHY1 0x0 */ ++ ++#define bPMACControl 0x0 /* Useless */ ++#define bWMACControl 0x1 ++#define bWNICControl 0x2 ++ ++#if 0 ++#define ANTENNA_A 0x1 /* Useless */ ++#define ANTENNA_B 0x2 ++#define ANTENNA_AB 0x3 /* ANTENNA_A | ANTENNA_B */ ++ ++#define ANTENNA_C 0x4 ++#define ANTENNA_D 0x8 ++#endif ++ ++#define RCR_AAP BIT(0) /* accept all physical address */ ++#define RCR_APM BIT(1) /* accept physical match */ ++#define RCR_AM BIT(2) /* accept multicast */ ++#define RCR_AB BIT(3) /* accept broadcast */ ++#define RCR_ACRC32 BIT(5) /* accept error packet */ ++#define RCR_9356SEL BIT(6) ++#define RCR_AICV BIT(9) /* Accept ICV error packet */ ++#define RCR_RXFTH0 (BIT(13) | BIT(14) | BIT(15)) /* Rx FIFO threshold */ ++#define RCR_ADF BIT(18) /* Accept Data(frame type) frame */ ++#define RCR_ACF BIT(19) /* Accept control frame */ ++#define RCR_AMF BIT(20) /* Accept management frame */ ++#define RCR_ADD3 BIT(21) ++#define RCR_APWRMGT BIT(22) /* Accept power management packet */ ++#define RCR_CBSSID BIT(23) /* Accept BSSID match packet */ ++#define RCR_ENMARP BIT(28) /* enable mac auto reset phy */ ++#define RCR_EnCS1 BIT(29) /* enable carrier sense method 1 */ ++#define RCR_EnCS2 BIT(30) /* enable carrier sense method 2 */ ++#define RCR_OnlyErlPkt BIT(31) /* Rx Early mode is performed for packet size greater than 1536 */ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++ ++ ++#endif /* __INC_HAL8192SPHYREG_H */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_odm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_odm.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_odm.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_odm.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,61 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_ODM_H__ ++#define __RTW_ODM_H__ ++ ++#include ++#include "../hal/phydm/phydm_types.h" ++/* ++* This file provides utilities/wrappers for rtw driver to use ODM ++*/ ++ ++void rtw_odm_dbg_comp_msg(void *sel, _adapter *adapter); ++void rtw_odm_dbg_comp_set(_adapter *adapter, u64 comps); ++void rtw_odm_dbg_level_msg(void *sel, _adapter *adapter); ++void rtw_odm_dbg_level_set(_adapter *adapter, u32 level); ++ ++void rtw_odm_ability_msg(void *sel, _adapter *adapter); ++void rtw_odm_ability_set(_adapter *adapter, u32 ability); ++ ++void rtw_odm_init_ic_type(_adapter *adapter); ++ ++void rtw_odm_set_force_igi_lb(_adapter *adapter, u8 lb); ++u8 rtw_odm_get_force_igi_lb(_adapter *adapter); ++ ++void rtw_odm_adaptivity_config_msg(void *sel, _adapter *adapter); ++ ++bool rtw_odm_adaptivity_needed(_adapter *adapter); ++void rtw_odm_adaptivity_parm_msg(void *sel, _adapter *adapter); ++void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 TH_L2H_ini, s8 TH_EDCCA_HL_diff, s8 TH_L2H_ini_mode2, s8 TH_EDCCA_HL_diff_mode2, u8 EDCCA_enable); ++void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter); ++void rtw_odm_acquirespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type); ++void rtw_odm_releasespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type); ++ ++#ifdef CONFIG_DFS_MASTER ++u8 rtw_odm_get_dfs_domain(_adapter *adapter); ++VOID rtw_odm_radar_detect_reset(_adapter *adapter); ++VOID rtw_odm_radar_detect_disable(_adapter *adapter); ++VOID rtw_odm_radar_detect_enable(_adapter *adapter); ++BOOLEAN rtw_odm_radar_detect(_adapter *adapter); ++#endif /* CONFIG_DFS_MASTER */ ++ ++void rtw_odm_parse_rx_phy_status_chinfo(union recv_frame *rframe, u8 *phys); ++ ++#endif /* __RTW_ODM_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_p2p.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_p2p.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_p2p.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_p2p.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,176 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_P2P_H_ ++#define __RTW_P2P_H_ ++ ++ ++u32 build_beacon_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++u32 build_probe_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++u32 build_prov_disc_request_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 *pssid, u8 ussidlen, u8 *pdev_raddr); ++u32 build_assoc_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 status_code); ++u32 build_deauth_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++#ifdef CONFIG_WFD ++int rtw_init_wifi_display_info(_adapter *padapter); ++void rtw_wfd_enable(_adapter *adapter, bool on); ++void rtw_wfd_set_ctrl_port(_adapter *adapter, u16 port); ++void rtw_tdls_wfd_enable(_adapter *adapter, bool on); ++ ++u32 build_probe_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++u32 build_probe_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 tunneled); ++u32 build_beacon_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++u32 build_nego_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++u32 build_nego_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++u32 build_nego_confirm_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++u32 build_invitation_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++u32 build_invitation_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++u32 build_assoc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++u32 build_assoc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++u32 build_provdisc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++u32 build_provdisc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); ++ ++u32 rtw_append_beacon_wfd_ie(_adapter *adapter, u8 *pbuf); ++u32 rtw_append_probe_req_wfd_ie(_adapter *adapter, u8 *pbuf); ++u32 rtw_append_probe_resp_wfd_ie(_adapter *adapter, u8 *pbuf); ++u32 rtw_append_assoc_req_wfd_ie(_adapter *adapter, u8 *pbuf); ++u32 rtw_append_assoc_resp_wfd_ie(_adapter *adapter, u8 *pbuf); ++#endif /*CONFIG_WFD */ ++ ++void rtw_xframe_chk_wfd_ie(struct xmit_frame *xframe); ++ ++u32 process_probe_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); ++u32 process_assoc_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len, struct sta_info *psta); ++u32 process_p2p_devdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); ++u32 process_p2p_devdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); ++u8 process_p2p_provdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); ++u8 process_p2p_provdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe); ++u8 process_p2p_group_negotation_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); ++u8 process_p2p_group_negotation_resp(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); ++u8 process_p2p_group_negotation_confirm(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); ++u8 process_p2p_presence_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); ++int process_p2p_cross_connect_ie(PADAPTER padapter, u8 *IEs, u32 IELength); ++ ++s32 p2p_protocol_wk_hdl(_adapter *padapter, int intCmdType, u8 *buf); ++ ++#ifdef CONFIG_P2P_PS ++void process_p2p_ps_ie(PADAPTER padapter, u8 *IEs, u32 IELength); ++void p2p_ps_wk_hdl(_adapter *padapter, u8 p2p_ps_state); ++u8 p2p_ps_wk_cmd(_adapter *padapter, u8 p2p_ps_state, u8 enqueue); ++#endif /* CONFIG_P2P_PS */ ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++void rtw_init_cfg80211_wifidirect_info(_adapter *padapter); ++int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx); ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++void reset_global_wifidirect_info(_adapter *padapter); ++void rtw_init_wifidirect_timers(_adapter *padapter); ++void rtw_init_wifidirect_addrs(_adapter *padapter, u8 *dev_addr, u8 *iface_addr); ++void init_wifidirect_info(_adapter *padapter, enum P2P_ROLE role); ++int rtw_p2p_enable(_adapter *padapter, enum P2P_ROLE role); ++ ++static inline void _rtw_p2p_set_state(struct wifidirect_info *wdinfo, enum P2P_STATE state) ++{ ++ if (wdinfo->p2p_state != state) { ++ /* wdinfo->pre_p2p_state = wdinfo->p2p_state; */ ++ wdinfo->p2p_state = state; ++ } ++} ++static inline void _rtw_p2p_set_pre_state(struct wifidirect_info *wdinfo, enum P2P_STATE state) ++{ ++ if (wdinfo->pre_p2p_state != state) ++ wdinfo->pre_p2p_state = state; ++} ++#if 0 ++static inline void _rtw_p2p_restore_state(struct wifidirect_info *wdinfo) ++{ ++ if (wdinfo->pre_p2p_state != -1) { ++ wdinfo->p2p_state = wdinfo->pre_p2p_state; ++ wdinfo->pre_p2p_state = -1; ++ } ++} ++#endif ++static inline void _rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role) ++{ ++ if (wdinfo->role != role) ++ wdinfo->role = role; ++} ++static inline int _rtw_p2p_state(struct wifidirect_info *wdinfo) ++{ ++ return wdinfo->p2p_state; ++} ++static inline int _rtw_p2p_pre_state(struct wifidirect_info *wdinfo) ++{ ++ return wdinfo->pre_p2p_state; ++} ++static inline int _rtw_p2p_role(struct wifidirect_info *wdinfo) ++{ ++ return wdinfo->role; ++} ++static inline bool _rtw_p2p_chk_state(struct wifidirect_info *wdinfo, enum P2P_STATE state) ++{ ++ return wdinfo->p2p_state == state; ++} ++static inline bool _rtw_p2p_chk_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role) ++{ ++ return wdinfo->role == role; ++} ++ ++#ifdef CONFIG_DBG_P2P ++void dbg_rtw_p2p_set_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line); ++void dbg_rtw_p2p_set_pre_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line); ++/* void dbg_rtw_p2p_restore_state(struct wifidirect_info *wdinfo, const char *caller, int line); */ ++void dbg_rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role, const char *caller, int line); ++#define rtw_p2p_set_state(wdinfo, state) dbg_rtw_p2p_set_state(wdinfo, state, __FUNCTION__, __LINE__) ++#define rtw_p2p_set_pre_state(wdinfo, state) dbg_rtw_p2p_set_pre_state(wdinfo, state, __FUNCTION__, __LINE__) ++#define rtw_p2p_set_role(wdinfo, role) dbg_rtw_p2p_set_role(wdinfo, role, __FUNCTION__, __LINE__) ++/* #define rtw_p2p_restore_state(wdinfo) dbg_rtw_p2p_restore_state(wdinfo, __FUNCTION__, __LINE__) */ ++#else /* CONFIG_DBG_P2P */ ++#define rtw_p2p_set_state(wdinfo, state) _rtw_p2p_set_state(wdinfo, state) ++#define rtw_p2p_set_pre_state(wdinfo, state) _rtw_p2p_set_pre_state(wdinfo, state) ++#define rtw_p2p_set_role(wdinfo, role) _rtw_p2p_set_role(wdinfo, role) ++/* #define rtw_p2p_restore_state(wdinfo) _rtw_p2p_restore_state(wdinfo) */ ++#endif /* CONFIG_DBG_P2P */ ++ ++#define rtw_p2p_state(wdinfo) _rtw_p2p_state(wdinfo) ++#define rtw_p2p_pre_state(wdinfo) _rtw_p2p_pre_state(wdinfo) ++#define rtw_p2p_role(wdinfo) _rtw_p2p_role(wdinfo) ++#define rtw_p2p_chk_state(wdinfo, state) _rtw_p2p_chk_state(wdinfo, state) ++#define rtw_p2p_chk_role(wdinfo, role) _rtw_p2p_chk_role(wdinfo, role) ++ ++#define rtw_p2p_findphase_ex_set(wdinfo, value) \ ++ (wdinfo)->find_phase_state_exchange_cnt = (value) ++ ++#ifdef CONFIG_P2P ++/* is this find phase exchange for social channel scan? */ ++#define rtw_p2p_findphase_ex_is_social(wdinfo) \ ++ (wdinfo)->find_phase_state_exchange_cnt >= P2P_FINDPHASE_EX_SOCIAL_FIRST ++ ++/* should we need find phase exchange anymore? */ ++#define rtw_p2p_findphase_ex_is_needed(wdinfo) \ ++ ((wdinfo)->find_phase_state_exchange_cnt < P2P_FINDPHASE_EX_MAX && \ ++ (wdinfo)->find_phase_state_exchange_cnt != P2P_FINDPHASE_EX_NONE && \ ++ !(wdinfo)->rx_invitereq_info.scan_op_ch_only && \ ++ !(wdinfo)->p2p_info.scan_op_ch_only) ++#else ++#define rtw_p2p_findphase_ex_is_social(wdinfo) 0 ++#define rtw_p2p_findphase_ex_is_needed(wdinfo) 0 ++#endif /* CONFIG_P2P */ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_pwrctrl.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_pwrctrl.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_pwrctrl.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_pwrctrl.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,556 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_PWRCTRL_H_ ++#define __RTW_PWRCTRL_H_ ++ ++ ++#define FW_PWR0 0 ++#define FW_PWR1 1 ++#define FW_PWR2 2 ++#define FW_PWR3 3 ++ ++ ++#define HW_PWR0 7 ++#define HW_PWR1 6 ++#define HW_PWR2 2 ++#define HW_PWR3 0 ++#define HW_PWR4 8 ++ ++#define FW_PWRMSK 0x7 ++ ++ ++#define XMIT_ALIVE BIT(0) ++#define RECV_ALIVE BIT(1) ++#define CMD_ALIVE BIT(2) ++#define EVT_ALIVE BIT(3) ++#ifdef CONFIG_BT_COEXIST ++#define BTCOEX_ALIVE BIT(4) ++#endif /* CONFIG_BT_COEXIST */ ++ ++#ifdef CONFIG_WOWLAN ++#ifdef CONFIG_DEFAULT_PATTERNS_EN ++ #ifdef CONFIG_PLATFORM_ANDROID_INTEL_X86 ++ /* TCP/ICMP/UDP multicast with specific IP addr */ ++ #define DEFAULT_PATTERN_NUM 3 ++ #else ++ /* TCP/ICMP */ ++ #define DEFAULT_PATTERN_NUM 2 ++ #endif ++#else ++ #define DEFAULT_PATTERN_NUM 0 ++#endif /*CONFIG_DEFAULT_PATTERNS_EN*/ ++ ++#define MAX_WKFM_NUM 16 /* Frame Mask Cam number for pattern match */ ++#define MAX_WKFM_SIZE 16 /* (16 bytes for WKFM bit mask, 16*8 = 128 bits) */ ++#define MAX_WKFM_PATTERN_SIZE 128 ++#define WKFMCAM_ADDR_NUM 6 ++#define WKFMCAM_SIZE 24 /* each entry need 6*4 bytes */ ++enum pattern_type { ++ PATTERN_BROADCAST = 0, ++ PATTERN_MULTICAST, ++ PATTERN_UNICAST, ++ PATTERN_VALID, ++ PATTERN_INVALID, ++}; ++ ++typedef struct rtl_priv_pattern { ++ int len; ++ char content[MAX_WKFM_PATTERN_SIZE]; ++ char mask[MAX_WKFM_SIZE]; ++} rtl_priv_pattern_t; ++ ++struct rtl_wow_pattern { ++ u16 crc; ++ u8 type; ++ u32 mask[4]; ++}; ++ ++struct aoac_report { ++ u8 iv[8]; ++ u8 replay_counter_eapol_key[8]; ++ u8 group_key[32]; ++ u8 key_index; ++ u8 scurity_type; ++}; ++#endif /* CONFIG_WOWLAN */ ++ ++enum Power_Mgnt { ++ PS_MODE_ACTIVE = 0 , ++ PS_MODE_MIN , ++ PS_MODE_MAX , ++ PS_MODE_DTIM , /* PS_MODE_SELF_DEFINED */ ++ PS_MODE_VOIP , ++ PS_MODE_UAPSD_WMM , ++ PS_MODE_UAPSD , ++ PS_MODE_IBSS , ++ PS_MODE_WWLAN , ++ PM_Radio_Off , ++ PM_Card_Disable , ++ PS_MODE_NUM, ++}; ++ ++#ifdef CONFIG_PNO_SUPPORT ++#define MAX_PNO_LIST_COUNT 16 ++#define MAX_SCAN_LIST_COUNT 14 /* 2.4G only */ ++#define MAX_HIDDEN_AP 8 /* 8 hidden AP */ ++#endif ++ ++/* ++ BIT[2:0] = HW state ++ BIT[3] = Protocol PS state, 0: register active state , 1: register sleep state ++ BIT[4] = sub-state ++*/ ++ ++#define PS_DPS BIT(0) ++#define PS_LCLK (PS_DPS) ++#define PS_RF_OFF BIT(1) ++#define PS_ALL_ON BIT(2) ++#define PS_ST_ACTIVE BIT(3) ++ ++#define PS_ISR_ENABLE BIT(4) ++#define PS_IMR_ENABLE BIT(5) ++#define PS_ACK BIT(6) ++#define PS_TOGGLE BIT(7) ++ ++#define PS_STATE_MASK (0x0F) ++#define PS_STATE_HW_MASK (0x07) ++#define PS_SEQ_MASK (0xc0) ++ ++#define PS_STATE(x) (PS_STATE_MASK & (x)) ++#define PS_STATE_HW(x) (PS_STATE_HW_MASK & (x)) ++#define PS_SEQ(x) (PS_SEQ_MASK & (x)) ++ ++#define PS_STATE_S0 (PS_DPS) ++#define PS_STATE_S1 (PS_LCLK) ++#define PS_STATE_S2 (PS_RF_OFF) ++#define PS_STATE_S3 (PS_ALL_ON) ++#define PS_STATE_S4 ((PS_ST_ACTIVE) | (PS_ALL_ON)) ++ ++ ++#define PS_IS_RF_ON(x) ((x) & (PS_ALL_ON)) ++#define PS_IS_ACTIVE(x) ((x) & (PS_ST_ACTIVE)) ++#define CLR_PS_STATE(x) ((x) = ((x) & (0xF0))) ++ ++ ++struct reportpwrstate_parm { ++ unsigned char mode; ++ unsigned char state; /* the CPWM value */ ++ unsigned short rsvd; ++}; ++ ++ ++typedef _sema _pwrlock; ++ ++ ++__inline static void _init_pwrlock(_pwrlock *plock) ++{ ++ _rtw_init_sema(plock, 1); ++} ++ ++__inline static void _free_pwrlock(_pwrlock *plock) ++{ ++ _rtw_free_sema(plock); ++} ++ ++ ++__inline static void _enter_pwrlock(_pwrlock *plock) ++{ ++ _rtw_down_sema(plock); ++} ++ ++ ++__inline static void _exit_pwrlock(_pwrlock *plock) ++{ ++ _rtw_up_sema(plock); ++} ++ ++#define LPS_DELAY_TIME 1*HZ /* 1 sec */ ++ ++#define EXE_PWR_NONE 0x01 ++#define EXE_PWR_IPS 0x02 ++#define EXE_PWR_LPS 0x04 ++ ++/* RF state. */ ++typedef enum _rt_rf_power_state { ++ rf_on, /* RF is on after RFSleep or RFOff */ ++ rf_sleep, /* 802.11 Power Save mode */ ++ rf_off, /* HW/SW Radio OFF or Inactive Power Save */ ++ /* =====Add the new RF state above this line===== */ ++ rf_max ++} rt_rf_power_state; ++ ++/* RF Off Level for IPS or HW/SW radio off */ ++#define RT_RF_OFF_LEVL_ASPM BIT(0) /* PCI ASPM */ ++#define RT_RF_OFF_LEVL_CLK_REQ BIT(1) /* PCI clock request */ ++#define RT_RF_OFF_LEVL_PCI_D3 BIT(2) /* PCI D3 mode */ ++#define RT_RF_OFF_LEVL_HALT_NIC BIT(3) /* NIC halt, re-initialize hw parameters */ ++#define RT_RF_OFF_LEVL_FREE_FW BIT(4) /* FW free, re-download the FW */ ++#define RT_RF_OFF_LEVL_FW_32K BIT(5) /* FW in 32k */ ++#define RT_RF_PS_LEVEL_ALWAYS_ASPM BIT(6) /* Always enable ASPM and Clock Req in initialization. */ ++#define RT_RF_LPS_DISALBE_2R BIT(30) /* When LPS is on, disable 2R if no packet is received or transmittd. */ ++#define RT_RF_LPS_LEVEL_ASPM BIT(31) /* LPS with ASPM */ ++ ++#define RT_IN_PS_LEVEL(ppsc, _PS_FLAG) ((ppsc->cur_ps_level & _PS_FLAG) ? _TRUE : _FALSE) ++#define RT_CLEAR_PS_LEVEL(ppsc, _PS_FLAG) (ppsc->cur_ps_level &= (~(_PS_FLAG))) ++#define RT_SET_PS_LEVEL(ppsc, _PS_FLAG) (ppsc->cur_ps_level |= _PS_FLAG) ++ ++/* ASPM OSC Control bit, added by Roger, 2013.03.29. */ ++#define RT_PCI_ASPM_OSC_IGNORE 0 /* PCI ASPM ignore OSC control in default */ ++#define RT_PCI_ASPM_OSC_ENABLE BIT0 /* PCI ASPM controlled by OS according to ACPI Spec 5.0 */ ++#define RT_PCI_ASPM_OSC_DISABLE BIT1 /* PCI ASPM controlled by driver or BIOS, i.e., force enable ASPM */ ++ ++ ++enum _PS_BBRegBackup_ { ++ PSBBREG_RF0 = 0, ++ PSBBREG_RF1, ++ PSBBREG_RF2, ++ PSBBREG_AFE0, ++ PSBBREG_TOTALCNT ++}; ++ ++enum { /* for ips_mode */ ++ IPS_NONE = 0, ++ IPS_NORMAL, ++ IPS_LEVEL_2, ++ IPS_NUM ++}; ++ ++/* Design for pwrctrl_priv.ips_deny, 32 bits for 32 reasons at most */ ++typedef enum _PS_DENY_REASON { ++ PS_DENY_DRV_INITIAL = 0, ++ PS_DENY_SCAN, ++ PS_DENY_JOIN, ++ PS_DENY_DISCONNECT, ++ PS_DENY_SUSPEND, ++ PS_DENY_IOCTL, ++ PS_DENY_MGNT_TX, ++ PS_DENY_DRV_REMOVE = 30, ++ PS_DENY_OTHERS = 31 ++} PS_DENY_REASON; ++ ++#ifdef CONFIG_PNO_SUPPORT ++typedef struct pno_nlo_info { ++ u32 fast_scan_period; /* Fast scan period */ ++ u8 ssid_num; /* number of entry */ ++ u8 hidden_ssid_num; ++ u32 slow_scan_period; /* slow scan period */ ++ u32 fast_scan_iterations; /* Fast scan iterations */ ++ u8 ssid_length[MAX_PNO_LIST_COUNT]; /* SSID Length Array */ ++ u8 ssid_cipher_info[MAX_PNO_LIST_COUNT]; /* Cipher information for security */ ++ u8 ssid_channel_info[MAX_PNO_LIST_COUNT]; /* channel information */ ++ u8 loc_probe_req[MAX_HIDDEN_AP]; /* loc_probeReq */ ++} pno_nlo_info_t; ++ ++typedef struct pno_ssid { ++ u32 SSID_len; ++ u8 SSID[32]; ++} pno_ssid_t; ++ ++typedef struct pno_ssid_list { ++ pno_ssid_t node[MAX_PNO_LIST_COUNT]; ++} pno_ssid_list_t; ++ ++typedef struct pno_scan_channel_info { ++ u8 channel; ++ u8 tx_power; ++ u8 timeout; ++ u8 active; /* set 1 means active scan, or pasivite scan. */ ++} pno_scan_channel_info_t; ++ ++typedef struct pno_scan_info { ++ u8 enableRFE; /* Enable RFE */ ++ u8 period_scan_time; /* exclusive with fast_scan_period and slow_scan_period */ ++ u8 periodScan; /* exclusive with fast_scan_period and slow_scan_period */ ++ u8 orig_80_offset; /* original channel 80 offset */ ++ u8 orig_40_offset; /* original channel 40 offset */ ++ u8 orig_bw; /* original bandwidth */ ++ u8 orig_ch; /* original channel */ ++ u8 channel_num; /* number of channel */ ++ u64 rfe_type; /* rfe_type && 0x00000000000000ff */ ++ pno_scan_channel_info_t ssid_channel_info[MAX_SCAN_LIST_COUNT]; ++} pno_scan_info_t; ++#endif /* CONFIG_PNO_SUPPORT */ ++ ++#ifdef CONFIG_LPS_POFF ++/* Driver context for LPS 32K Close IO Power */ ++typedef struct lps_poff_info { ++ bool bEn; ++ u8 *pStaticFile; ++ u8 *pDynamicFile; ++ u32 ConfFileOffset; ++ u32 tx_bndy_static; ++ u32 tx_bndy_dynamic; ++ u16 ConfLenForPTK; ++ u16 ConfLenForGTK; ++ ATOMIC_T bEnterPOFF; ++ ATOMIC_T bTxBoundInProgress; ++ ATOMIC_T bSetPOFFParm; ++} lps_poff_info_t; ++#endif /*CONFIG_LPS_POFF*/ ++ ++struct pwrctrl_priv { ++ _pwrlock lock; ++ _pwrlock check_32k_lock; ++ volatile u8 rpwm; /* requested power state for fw */ ++ volatile u8 cpwm; /* fw current power state. updated when 1. read from HCPWM 2. driver lowers power level */ ++ volatile u8 tog; /* toggling */ ++ volatile u8 cpwm_tog; /* toggling */ ++ ++ u8 pwr_mode; ++ u8 smart_ps; ++ u8 bcn_ant_mode; ++ u8 dtim; ++ ++ u32 alives; ++ _workitem cpwm_event; ++#ifdef CONFIG_LPS_RPWM_TIMER ++ u8 brpwmtimeout; ++ _workitem rpwmtimeoutwi; ++ _timer pwr_rpwm_timer; ++#endif /* CONFIG_LPS_RPWM_TIMER */ ++ u8 bpower_saving; /* for LPS/IPS */ ++ ++ u8 b_hw_radio_off; ++ u8 reg_rfoff; ++ u8 reg_pdnmode; /* powerdown mode */ ++ u32 rfoff_reason; ++ ++ /* RF OFF Level */ ++ u32 cur_ps_level; ++ u32 reg_rfps_level; ++ ++ uint ips_enter_cnts; ++ uint ips_leave_cnts; ++ uint lps_enter_cnts; ++ uint lps_leave_cnts; ++ ++ u8 ips_mode; ++ u8 ips_org_mode; ++ u8 ips_mode_req; /* used to accept the mode setting request, will update to ipsmode later */ ++ uint bips_processing; ++ u32 ips_deny_time; /* will deny IPS when system time is smaller than this */ ++ u8 pre_ips_type;/* 0: default flow, 1: carddisbale flow */ ++ ++ /* ps_deny: if 0, power save is free to go; otherwise deny all kinds of power save. */ ++ /* Use PS_DENY_REASON to decide reason. */ ++ /* Don't access this variable directly without control function, */ ++ /* and this variable should be protected by lock. */ ++ u32 ps_deny; ++ ++ u8 ps_processing; /* temporarily used to mark whether in rtw_ps_processor */ ++ ++ u8 fw_psmode_iface_id; ++ u8 bLeisurePs; ++ u8 LpsIdleCount; ++ u8 power_mgnt; ++ u8 org_power_mgnt; ++ u8 bFwCurrentInPSMode; ++ u32 DelayLPSLastTimeStamp; ++ s32 pnp_current_pwr_state; ++ u8 pnp_bstop_trx; ++ ++ ++ u8 bInternalAutoSuspend; ++ u8 bInSuspend; ++#ifdef CONFIG_BT_COEXIST ++ u8 bAutoResume; ++ u8 autopm_cnt; ++#endif ++ u8 bSupportRemoteWakeup; ++ u8 wowlan_wake_reason; ++ u8 wowlan_last_wake_reason; ++ u8 wowlan_ap_mode; ++ u8 wowlan_mode; ++ u8 wowlan_p2p_mode; ++ u8 wowlan_pno_enable; ++#ifdef CONFIG_GPIO_WAKEUP ++ u8 is_high_active; ++#endif /* CONFIG_GPIO_WAKEUP */ ++#ifdef CONFIG_WOWLAN ++ u8 wowlan_txpause_status; ++ u8 wowlan_pattern_idx; ++ u8 wowlan_in_resume; ++ u64 wowlan_fw_iv; ++ struct rtl_priv_pattern patterns[MAX_WKFM_NUM]; ++ struct aoac_report wowlan_aoac_rpt; ++ u8 wowlan_aoac_rpt_loc; ++#ifdef CONFIG_PNO_SUPPORT ++ u8 pno_inited; ++ pno_nlo_info_t *pnlo_info; ++ pno_scan_info_t *pscan_info; ++ pno_ssid_list_t *pno_ssid_list; ++#endif /* CONFIG_PNO_SUPPORT */ ++#endif /* CONFIG_WOWLAN */ ++ _timer pwr_state_check_timer; ++ int pwr_state_check_interval; ++ u8 pwr_state_check_cnts; ++ ++ int ps_flag; /* used by autosuspend */ ++ ++ rt_rf_power_state rf_pwrstate;/* cur power state, only for IPS */ ++ /* rt_rf_power_state current_rfpwrstate; */ ++ rt_rf_power_state change_rfpwrstate; ++ ++ u8 bHWPowerdown; /* power down mode selection. 0:radio off, 1:power down */ ++ u8 bHWPwrPindetect; /* come from registrypriv.hwpwrp_detect. enable power down function. 0:disable, 1:enable */ ++ u8 bkeepfwalive; ++ u8 brfoffbyhw; ++ unsigned long PS_BBRegBackup[PSBBREG_TOTALCNT]; ++ ++#ifdef CONFIG_RESUME_IN_WORKQUEUE ++ struct workqueue_struct *rtw_workqueue; ++ _workitem resume_work; ++#endif ++ ++#ifdef CONFIG_HAS_EARLYSUSPEND ++ struct early_suspend early_suspend; ++ u8 do_late_resume; ++#endif /* CONFIG_HAS_EARLYSUSPEND */ ++ ++#ifdef CONFIG_ANDROID_POWER ++ android_early_suspend_t early_suspend; ++ u8 do_late_resume; ++#endif ++ ++#ifdef CONFIG_INTEL_PROXIM ++ u8 stored_power_mgnt; ++#endif ++ ++#ifdef CONFIG_LPS_POFF ++ lps_poff_info_t *plps_poff_info; ++#endif ++ ++#ifdef CONFIG_LPS_PG ++ u8 lpspg_rsvd_page_locate; ++ u8 blpspg_info_up; ++#endif ++}; ++ ++#define rtw_get_ips_mode_req(pwrctl) \ ++ (pwrctl)->ips_mode_req ++ ++#define rtw_ips_mode_req(pwrctl, ips_mode) \ ++ (pwrctl)->ips_mode_req = (ips_mode) ++ ++#define RTW_PWR_STATE_CHK_INTERVAL 2000 ++ ++#define _rtw_set_pwr_state_check_timer(pwrctl, ms) \ ++ do { \ ++ /*RTW_INFO("%s _rtw_set_pwr_state_check_timer(%p, %d)\n", __FUNCTION__, (pwrctl), (ms));*/ \ ++ _set_timer(&(pwrctl)->pwr_state_check_timer, (ms)); \ ++ } while (0) ++ ++#define rtw_set_pwr_state_check_timer(pwrctl) \ ++ _rtw_set_pwr_state_check_timer((pwrctl), (pwrctl)->pwr_state_check_interval) ++ ++extern void rtw_init_pwrctrl_priv(_adapter *adapter); ++extern void rtw_free_pwrctrl_priv(_adapter *adapter); ++ ++#ifdef CONFIG_LPS_LCLK ++s32 rtw_register_task_alive(PADAPTER, u32 task); ++void rtw_unregister_task_alive(PADAPTER, u32 task); ++extern s32 rtw_register_tx_alive(PADAPTER padapter); ++extern void rtw_unregister_tx_alive(PADAPTER padapter); ++extern s32 rtw_register_rx_alive(PADAPTER padapter); ++extern void rtw_unregister_rx_alive(PADAPTER padapter); ++extern s32 rtw_register_cmd_alive(PADAPTER padapter); ++extern void rtw_unregister_cmd_alive(PADAPTER padapter); ++extern s32 rtw_register_evt_alive(PADAPTER padapter); ++extern void rtw_unregister_evt_alive(PADAPTER padapter); ++extern void cpwm_int_hdl(PADAPTER padapter, struct reportpwrstate_parm *preportpwrstate); ++extern void LPS_Leave_check(PADAPTER padapter); ++#endif ++ ++extern void LeaveAllPowerSaveMode(PADAPTER Adapter); ++extern void LeaveAllPowerSaveModeDirect(PADAPTER Adapter); ++#ifdef CONFIG_IPS ++void _ips_enter(_adapter *padapter); ++void ips_enter(_adapter *padapter); ++int _ips_leave(_adapter *padapter); ++int ips_leave(_adapter *padapter); ++#endif ++ ++void rtw_ps_processor(_adapter *padapter); ++ ++#ifdef CONFIG_AUTOSUSPEND ++int autoresume_enter(_adapter *padapter); ++#endif ++#ifdef SUPPORT_HW_RFOFF_DETECTED ++rt_rf_power_state RfOnOffDetect(IN PADAPTER pAdapter); ++#endif ++ ++ ++int rtw_fw_ps_state(PADAPTER padapter); ++ ++#ifdef CONFIG_LPS ++s32 LPS_RF_ON_check(PADAPTER padapter, u32 delay_ms); ++void LPS_Enter(PADAPTER padapter, const char *msg); ++void LPS_Leave(PADAPTER padapter, const char *msg); ++void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets); ++void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode, const char *msg); ++void rtw_set_fw_in_ips_mode(PADAPTER padapter, u8 enable); ++void rtw_set_rpwm(_adapter *padapter, u8 val8); ++#endif ++ ++#ifdef CONFIG_RESUME_IN_WORKQUEUE ++void rtw_resume_in_workqueue(struct pwrctrl_priv *pwrpriv); ++#endif /* CONFIG_RESUME_IN_WORKQUEUE */ ++ ++#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) ++bool rtw_is_earlysuspend_registered(struct pwrctrl_priv *pwrpriv); ++bool rtw_is_do_late_resume(struct pwrctrl_priv *pwrpriv); ++void rtw_set_do_late_resume(struct pwrctrl_priv *pwrpriv, bool enable); ++void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv); ++void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv); ++#else ++#define rtw_is_earlysuspend_registered(pwrpriv) _FALSE ++#define rtw_is_do_late_resume(pwrpriv) _FALSE ++#define rtw_set_do_late_resume(pwrpriv, enable) do {} while (0) ++#define rtw_register_early_suspend(pwrpriv) do {} while (0) ++#define rtw_unregister_early_suspend(pwrpriv) do {} while (0) ++#endif /* CONFIG_HAS_EARLYSUSPEND || CONFIG_ANDROID_POWER */ ++ ++u8 rtw_interface_ps_func(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val); ++void rtw_set_ips_deny(_adapter *padapter, u32 ms); ++int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller); ++#define rtw_pwr_wakeup(adapter) _rtw_pwr_wakeup(adapter, RTW_PWR_STATE_CHK_INTERVAL, __FUNCTION__) ++#define rtw_pwr_wakeup_ex(adapter, ips_deffer_ms) _rtw_pwr_wakeup(adapter, ips_deffer_ms, __FUNCTION__) ++int rtw_pm_set_ips(_adapter *padapter, u8 mode); ++int rtw_pm_set_lps(_adapter *padapter, u8 mode); ++ ++void rtw_ps_deny(PADAPTER padapter, PS_DENY_REASON reason); ++void rtw_ps_deny_cancel(PADAPTER padapter, PS_DENY_REASON reason); ++u32 rtw_ps_deny_get(PADAPTER padapter); ++ ++#if defined(CONFIG_WOWLAN) ++void rtw_get_current_ip_address(PADAPTER padapter, u8 *pcurrentip); ++void rtw_get_sec_iv(PADAPTER padapter, u8 *pcur_dot11txpn, u8 *StaAddr); ++bool rtw_check_pattern_valid(u8 *input, u8 len); ++bool rtw_write_to_frame_mask(_adapter *adapter, u8 idx, ++ struct rtl_wow_pattern *content); ++ ++bool rtw_read_from_frame_mask(_adapter *adapter, u8 idx); ++bool rtw_wowlan_parser_pattern_cmd(u8 *input, char *pattern, ++ int *pattern_len, char *bit_mask); ++u8 rtw_set_default_pattern(_adapter *adapter); ++void rtw_dump_priv_pattern(_adapter *adapter, u8 idx); ++void rtw_clean_pattern(_adapter *adapter); ++#endif /* CONFIG_WOWLAN */ ++#endif /* __RTL871X_PWRCTRL_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_qos.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_qos.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_qos.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_qos.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,34 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ ++#ifndef _RTW_QOS_H_ ++#define _RTW_QOS_H_ ++ ++ ++ ++struct qos_priv { ++ ++ unsigned int qos_option; /* bit mask option: u-apsd, s-apsd, ts, block ack... */ ++ ++}; ++ ++ ++#endif /* _RTL871X_QOS_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_recv.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_recv.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_recv.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,893 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTW_RECV_H_ ++#define _RTW_RECV_H_ ++ ++#ifdef PLATFORM_OS_XP ++ #ifdef CONFIG_SDIO_HCI ++ #define NR_RECVBUFF 1024/* 512 */ /* 128 */ ++ #else ++ #define NR_RECVBUFF (16) ++ #endif ++#elif defined(PLATFORM_OS_CE) ++ #ifdef CONFIG_SDIO_HCI ++ #define NR_RECVBUFF (128) ++ #else ++ #define NR_RECVBUFF (4) ++ #endif ++#else /* PLATFORM_LINUX /PLATFORM_BSD */ ++ ++ #ifdef CONFIG_SINGLE_RECV_BUF ++ #define NR_RECVBUFF (1) ++ #else ++ #if defined(CONFIG_GSPI_HCI) ++ #define NR_RECVBUFF (32) ++ #elif defined(CONFIG_SDIO_HCI) ++ #define NR_RECVBUFF (8) ++ #else ++ #define NR_RECVBUFF (8) ++ #endif ++ #endif /* CONFIG_SINGLE_RECV_BUF */ ++ #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER ++ #define NR_PREALLOC_RECV_SKB (rtw_rtkm_get_nr_recv_skb()>>1) ++ #else /*!CONFIG_PREALLOC_RX_SKB_BUFFER */ ++ #define NR_PREALLOC_RECV_SKB 8 ++ #endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ ++ ++ #ifdef CONFIG_RTW_NAPI ++ #define RTL_NAPI_WEIGHT (32) ++ #endif ++#endif ++ ++#define NR_RECVFRAME 256 ++ ++#define RXFRAME_ALIGN 8 ++#define RXFRAME_ALIGN_SZ (1<network.PhyInfo.SignalStrength); */ ++ struct rx_raw_rssi raw_rssi_info; ++ /* s8 rxpwdb; */ ++ s16 noise; ++ /* int RxSNRdB[2]; */ ++ /* s8 RxRssi[2]; */ ++ /* int FalseAlmCnt_all; */ ++ ++ ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ _timer signal_stat_timer; ++ u32 signal_stat_sampling_interval; ++ /* u32 signal_stat_converging_constant; */ ++ struct signal_stat signal_qual_data; ++ struct signal_stat signal_strength_data; ++#else /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ ++ struct smooth_rssi_data signal_qual_data; ++ struct smooth_rssi_data signal_strength_data; ++#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ ++ u16 sink_udpport, pre_rtp_rxseq, cur_rtp_rxseq; ++ ++ BOOLEAN store_law_data_flag; ++}; ++ ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++#define rtw_set_signal_stat_timer(recvpriv) _set_timer(&(recvpriv)->signal_stat_timer, (recvpriv)->signal_stat_sampling_interval) ++#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ ++ ++struct sta_recv_priv { ++ ++ _lock lock; ++ sint option; ++ ++ /* _queue blk_strms[MAX_RX_NUMBLKS]; */ ++ _queue defrag_q; /* keeping the fragment frame until defrag */ ++ ++ struct stainfo_rxcache rxcache; ++ ++ /* uint sta_rx_bytes; */ ++ /* uint sta_rx_pkts; */ ++ /* uint sta_rx_fail; */ ++ ++}; ++ ++ ++struct recv_buf { ++ _list list; ++ ++ _lock recvbuf_lock; ++ ++ u32 ref_cnt; ++ ++ PADAPTER adapter; ++ ++ u8 *pbuf; ++ u8 *pallocated_buf; ++ ++ u32 len; ++ u8 *phead; ++ u8 *pdata; ++ u8 *ptail; ++ u8 *pend; ++ ++#ifdef CONFIG_USB_HCI ++ ++#if defined(PLATFORM_OS_XP) || defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) ++ PURB purb; ++ dma_addr_t dma_transfer_addr; /* (in) dma addr for transfer_buffer */ ++ u32 alloc_sz; ++#endif ++ ++#ifdef PLATFORM_OS_XP ++ PIRP pirp; ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ USB_TRANSFER usb_transfer_read_port; ++#endif ++ ++ u8 irp_pending; ++ int transfer_len; ++ ++#endif ++ ++#ifdef PLATFORM_LINUX ++ _pkt *pskb; ++#endif ++#ifdef PLATFORM_FREEBSD /* skb solution */ ++ struct sk_buff *pskb; ++#endif /* PLATFORM_FREEBSD */ /* skb solution */ ++}; ++ ++ ++/* ++ head -----> ++ ++ data -----> ++ ++ payload ++ ++ tail -----> ++ ++ ++ end -----> ++ ++ len = (unsigned int )(tail - data); ++ ++*/ ++struct recv_frame_hdr { ++ _list list; ++#ifndef CONFIG_BSD_RX_USE_MBUF ++ struct sk_buff *pkt; ++ struct sk_buff *pkt_newalloc; ++#else /* CONFIG_BSD_RX_USE_MBUF */ ++ _pkt *pkt; ++ _pkt *pkt_newalloc; ++#endif /* CONFIG_BSD_RX_USE_MBUF */ ++ ++ _adapter *adapter; ++ ++ u8 fragcnt; ++ ++ int frame_tag; ++ ++ struct rx_pkt_attrib attrib; ++ ++ uint len; ++ u8 *rx_head; ++ u8 *rx_data; ++ u8 *rx_tail; ++ u8 *rx_end; ++ ++ void *precvbuf; ++ ++ ++ /* */ ++ struct sta_info *psta; ++ ++ /* for A-MPDU Rx reordering buffer control */ ++ struct recv_reorder_ctrl *preorder_ctrl; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ u8 UserPriority; ++ u8 WapiTempPN[16]; ++ u8 WapiSrcAddr[6]; ++ u8 bWapiCheckPNInDecrypt; ++ u8 bIsWaiPacket; ++#endif ++ ++}; ++ ++ ++union recv_frame { ++ ++ union { ++ _list list; ++ struct recv_frame_hdr hdr; ++ uint mem[RECVFRAME_HDR_ALIGN >> 2]; ++ } u; ++ ++ /* uint mem[MAX_RXSZ>>2]; */ ++ ++}; ++ ++bool rtw_rframe_del_wfd_ie(union recv_frame *rframe, u8 ies_offset); ++ ++typedef enum _RX_PACKET_TYPE { ++ NORMAL_RX,/* Normal rx packet */ ++ TX_REPORT1,/* CCX */ ++ TX_REPORT2,/* TX RPT */ ++ HIS_REPORT,/* USB HISR RPT */ ++ C2H_PACKET ++} RX_PACKET_TYPE, *PRX_PACKET_TYPE; ++ ++extern union recv_frame *_rtw_alloc_recvframe(_queue *pfree_recv_queue); /* get a free recv_frame from pfree_recv_queue */ ++extern union recv_frame *rtw_alloc_recvframe(_queue *pfree_recv_queue); /* get a free recv_frame from pfree_recv_queue */ ++extern void rtw_init_recvframe(union recv_frame *precvframe , struct recv_priv *precvpriv); ++extern int rtw_free_recvframe(union recv_frame *precvframe, _queue *pfree_recv_queue); ++ ++#define rtw_dequeue_recvframe(queue) rtw_alloc_recvframe(queue) ++extern int _rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue); ++extern int rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue); ++ ++extern void rtw_free_recvframe_queue(_queue *pframequeue, _queue *pfree_recv_queue); ++u32 rtw_free_uc_swdec_pending_queue(_adapter *adapter); ++ ++sint rtw_enqueue_recvbuf_to_head(struct recv_buf *precvbuf, _queue *queue); ++sint rtw_enqueue_recvbuf(struct recv_buf *precvbuf, _queue *queue); ++struct recv_buf *rtw_dequeue_recvbuf(_queue *queue); ++ ++void rtw_reordering_ctrl_timeout_handler(void *pcontext); ++ ++void rx_query_phy_status(union recv_frame *rframe, u8 *phy_stat); ++int rtw_inc_and_chk_continual_no_rx_packet(struct sta_info *sta, int tid_index); ++void rtw_reset_continual_no_rx_packet(struct sta_info *sta, int tid_index); ++ ++__inline static u8 *get_rxmem(union recv_frame *precvframe) ++{ ++ /* always return rx_head... */ ++ if (precvframe == NULL) ++ return NULL; ++ ++ return precvframe->u.hdr.rx_head; ++} ++ ++__inline static u8 *get_rx_status(union recv_frame *precvframe) ++{ ++ ++ return get_rxmem(precvframe); ++ ++} ++ ++__inline static u8 *get_recvframe_data(union recv_frame *precvframe) ++{ ++ ++ /* alwasy return rx_data */ ++ if (precvframe == NULL) ++ return NULL; ++ ++ return precvframe->u.hdr.rx_data; ++ ++} ++ ++__inline static u8 *recvframe_push(union recv_frame *precvframe, sint sz) ++{ ++ /* append data before rx_data */ ++ ++ /* add data to the start of recv_frame ++ * ++ * This function extends the used data area of the recv_frame at the buffer ++ * start. rx_data must be still larger than rx_head, after pushing. ++ */ ++ ++ if (precvframe == NULL) ++ return NULL; ++ ++ ++ precvframe->u.hdr.rx_data -= sz ; ++ if (precvframe->u.hdr.rx_data < precvframe->u.hdr.rx_head) { ++ precvframe->u.hdr.rx_data += sz ; ++ return NULL; ++ } ++ ++ precvframe->u.hdr.len += sz; ++ ++ return precvframe->u.hdr.rx_data; ++ ++} ++ ++ ++__inline static u8 *recvframe_pull(union recv_frame *precvframe, sint sz) ++{ ++ /* rx_data += sz; move rx_data sz bytes hereafter */ ++ ++ /* used for extract sz bytes from rx_data, update rx_data and return the updated rx_data to the caller */ ++ ++ ++ if (precvframe == NULL) ++ return NULL; ++ ++ ++ precvframe->u.hdr.rx_data += sz; ++ ++ if (precvframe->u.hdr.rx_data > precvframe->u.hdr.rx_tail) { ++ precvframe->u.hdr.rx_data -= sz; ++ return NULL; ++ } ++ ++ precvframe->u.hdr.len -= sz; ++ ++ return precvframe->u.hdr.rx_data; ++ ++} ++ ++__inline static u8 *recvframe_put(union recv_frame *precvframe, sint sz) ++{ ++ /* rx_tai += sz; move rx_tail sz bytes hereafter */ ++ ++ /* used for append sz bytes from ptr to rx_tail, update rx_tail and return the updated rx_tail to the caller */ ++ /* after putting, rx_tail must be still larger than rx_end. */ ++ unsigned char *prev_rx_tail; ++ ++ /* RTW_INFO("recvframe_put: len=%d\n", sz); */ ++ ++ if (precvframe == NULL) ++ return NULL; ++ ++ prev_rx_tail = precvframe->u.hdr.rx_tail; ++ ++ precvframe->u.hdr.rx_tail += sz; ++ ++ if (precvframe->u.hdr.rx_tail > precvframe->u.hdr.rx_end) { ++ precvframe->u.hdr.rx_tail -= sz; ++ return NULL; ++ } ++ ++ precvframe->u.hdr.len += sz; ++ ++ return precvframe->u.hdr.rx_tail; ++ ++} ++ ++ ++ ++__inline static u8 *recvframe_pull_tail(union recv_frame *precvframe, sint sz) ++{ ++ /* rmv data from rx_tail (by yitsen) */ ++ ++ /* used for extract sz bytes from rx_end, update rx_end and return the updated rx_end to the caller */ ++ /* after pulling, rx_end must be still larger than rx_data. */ ++ ++ if (precvframe == NULL) ++ return NULL; ++ ++ precvframe->u.hdr.rx_tail -= sz; ++ ++ if (precvframe->u.hdr.rx_tail < precvframe->u.hdr.rx_data) { ++ precvframe->u.hdr.rx_tail += sz; ++ return NULL; ++ } ++ ++ precvframe->u.hdr.len -= sz; ++ ++ return precvframe->u.hdr.rx_tail; ++ ++} ++ ++ ++ ++__inline static _buffer *get_rxbuf_desc(union recv_frame *precvframe) ++{ ++ _buffer *buf_desc; ++ ++ if (precvframe == NULL) ++ return NULL; ++#ifdef PLATFORM_WINDOWS ++ NdisQueryPacket(precvframe->u.hdr.pkt, NULL, NULL, &buf_desc, NULL); ++#endif ++ ++ return buf_desc; ++} ++ ++ ++__inline static union recv_frame *rxmem_to_recvframe(u8 *rxmem) ++{ ++ /* due to the design of 2048 bytes alignment of recv_frame, we can reference the union recv_frame */ ++ /* from any given member of recv_frame. */ ++ /* rxmem indicates the any member/address in recv_frame */ ++ ++ return (union recv_frame *)(((SIZE_PTR)rxmem >> RXFRAME_ALIGN) << RXFRAME_ALIGN); ++ ++} ++ ++__inline static union recv_frame *pkt_to_recvframe(_pkt *pkt) ++{ ++ ++ u8 *buf_star; ++ union recv_frame *precv_frame; ++#ifdef PLATFORM_WINDOWS ++ _buffer *buf_desc; ++ uint len; ++ ++ NdisQueryPacket(pkt, NULL, NULL, &buf_desc, &len); ++ NdisQueryBufferSafe(buf_desc, &buf_star, &len, HighPagePriority); ++#endif ++ precv_frame = rxmem_to_recvframe((unsigned char *)buf_star); ++ ++ return precv_frame; ++} ++ ++__inline static u8 *pkt_to_recvmem(_pkt *pkt) ++{ ++ /* return the rx_head */ ++ ++ union recv_frame *precv_frame = pkt_to_recvframe(pkt); ++ ++ return precv_frame->u.hdr.rx_head; ++ ++} ++ ++__inline static u8 *pkt_to_recvdata(_pkt *pkt) ++{ ++ /* return the rx_data */ ++ ++ union recv_frame *precv_frame = pkt_to_recvframe(pkt); ++ ++ return precv_frame->u.hdr.rx_data; ++ ++} ++ ++ ++__inline static sint get_recvframe_len(union recv_frame *precvframe) ++{ ++ return precvframe->u.hdr.len; ++} ++ ++ ++__inline static s32 translate_percentage_to_dbm(u32 SignalStrengthIndex) ++{ ++ s32 SignalPower; /* in dBm. */ ++ ++#ifdef CONFIG_SIGNAL_SCALE_MAPPING ++ /* Translate to dBm (x=0.5y-95). */ ++ SignalPower = (s32)((SignalStrengthIndex + 1) >> 1); ++ SignalPower -= 95; ++#else ++ /* Translate to dBm (x=y-100) */ ++ SignalPower = SignalStrengthIndex - 100; ++#endif ++ ++ return SignalPower; ++} ++ ++ ++struct sta_info; ++ ++extern void _rtw_init_sta_recv_priv(struct sta_recv_priv *psta_recvpriv); ++ ++extern void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame); ++ ++s32 pre_recv_entry(union recv_frame *precvframe, u8 *pphy_status); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_rf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_rf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_rf.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,287 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_RF_H_ ++#define __RTW_RF_H_ ++ ++ ++#define OFDM_PHY 1 ++#define MIXED_PHY 2 ++#define CCK_PHY 3 ++ ++#define b_mode_rate_num 4 ++#define g_mode_rate_num 8 ++#define NumRates (13) ++ ++/* slot time for 11g */ ++#define SHORT_SLOT_TIME 9 ++#define NON_SHORT_SLOT_TIME 20 ++ ++#define RTL8711_RF_MAX_SENS 6 ++#define RTL8711_RF_DEF_SENS 4 ++ ++/* ++ * We now define the following channels as the max channels in each channel plan. ++ * 2G, total 14 chnls ++ * {1,2,3,4,5,6,7,8,9,10,11,12,13,14} ++ * 5G, total 25 chnls ++ * {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,144,149,153,157,161,165} ++ */ ++#define MAX_CHANNEL_NUM_2G 14 ++#define MAX_CHANNEL_NUM_5G 25 ++#define MAX_CHANNEL_NUM (MAX_CHANNEL_NUM_2G + MAX_CHANNEL_NUM_5G) ++ ++#define CENTER_CH_2G_40M_NUM 9 ++#define CENTER_CH_2G_NUM 14 ++#define CENTER_CH_5G_20M_NUM 28 /* 20M center channels */ ++#define CENTER_CH_5G_40M_NUM 14 /* 40M center channels */ ++#define CENTER_CH_5G_80M_NUM 7 /* 80M center channels */ ++#define CENTER_CH_5G_160M_NUM 3 /* 160M center channels */ ++#define CENTER_CH_5G_ALL_NUM (CENTER_CH_5G_20M_NUM + CENTER_CH_5G_40M_NUM + CENTER_CH_5G_80M_NUM) ++ ++extern u8 center_ch_2g[CENTER_CH_2G_NUM]; ++extern u8 center_ch_2g_40m[CENTER_CH_2G_40M_NUM]; ++ ++u8 center_chs_2g_num(u8 bw); ++u8 center_chs_2g(u8 bw, u8 id); ++ ++extern u8 center_ch_5g_20m[CENTER_CH_5G_20M_NUM]; ++extern u8 center_ch_5g_40m[CENTER_CH_5G_40M_NUM]; ++extern u8 center_ch_5g_20m_40m[CENTER_CH_5G_20M_NUM + CENTER_CH_5G_40M_NUM]; ++extern u8 center_ch_5g_80m[CENTER_CH_5G_80M_NUM]; ++extern u8 center_ch_5g_all[CENTER_CH_5G_ALL_NUM]; ++ ++u8 center_chs_5g_num(u8 bw); ++u8 center_chs_5g(u8 bw, u8 id); ++ ++u8 rtw_get_scch_by_cch_offset(u8 cch, u8 bw, u8 offset); ++ ++u8 rtw_get_op_chs_by_cch_bw(u8 cch, u8 bw, u8 **op_chs, u8 *op_ch_num); ++ ++u8 rtw_get_ch_group(u8 ch, u8 *group, u8 *cck_group); ++ ++/* #define NUM_REGULATORYS 21 */ ++#define NUM_REGULATORYS 1 ++ ++/* Country codes */ ++#define USA 0x555320 ++#define EUROPE 0x1 /* temp, should be provided later */ ++#define JAPAN 0x2 /* temp, should be provided later */ ++ ++struct regulatory_class { ++ u32 starting_freq; /* MHz, */ ++ u8 channel_set[MAX_CHANNEL_NUM]; ++ u8 channel_cck_power[MAX_CHANNEL_NUM];/* dbm */ ++ u8 channel_ofdm_power[MAX_CHANNEL_NUM];/* dbm */ ++ u8 txpower_limit; /* dbm */ ++ u8 channel_spacing; /* MHz */ ++ u8 modem; ++}; ++ ++typedef enum _CAPABILITY { ++ cESS = 0x0001, ++ cIBSS = 0x0002, ++ cPollable = 0x0004, ++ cPollReq = 0x0008, ++ cPrivacy = 0x0010, ++ cShortPreamble = 0x0020, ++ cPBCC = 0x0040, ++ cChannelAgility = 0x0080, ++ cSpectrumMgnt = 0x0100, ++ cQos = 0x0200, /* For HCCA, use with CF-Pollable and CF-PollReq */ ++ cShortSlotTime = 0x0400, ++ cAPSD = 0x0800, ++ cRM = 0x1000, /* RRM (Radio Request Measurement) */ ++ cDSSS_OFDM = 0x2000, ++ cDelayedBA = 0x4000, ++ cImmediateBA = 0x8000, ++} CAPABILITY, *PCAPABILITY; ++ ++enum _REG_PREAMBLE_MODE { ++ PREAMBLE_LONG = 1, ++ PREAMBLE_AUTO = 2, ++ PREAMBLE_SHORT = 3, ++}; ++ ++ ++enum _RTL8712_RF_MIMO_CONFIG_ { ++ RTL8712_RFCONFIG_1T = 0x10, ++ RTL8712_RFCONFIG_2T = 0x20, ++ RTL8712_RFCONFIG_1R = 0x01, ++ RTL8712_RFCONFIG_2R = 0x02, ++ RTL8712_RFCONFIG_1T1R = 0x11, ++ RTL8712_RFCONFIG_1T2R = 0x12, ++ RTL8712_RFCONFIG_TURBO = 0x92, ++ RTL8712_RFCONFIG_2T2R = 0x22 ++}; ++ ++typedef enum _RF_PATH { ++ RF_PATH_A = 0, ++ RF_PATH_B = 1, ++ RF_PATH_C = 2, ++ RF_PATH_D = 3, ++} RF_PATH, *PRF_PATH; ++ ++#define rf_path_char(path) (((path) >= RF_PATH_MAX) ? 'X' : 'A' + (path)) ++ ++/* Bandwidth Offset */ ++#define HAL_PRIME_CHNL_OFFSET_DONT_CARE 0 ++#define HAL_PRIME_CHNL_OFFSET_LOWER 1 ++#define HAL_PRIME_CHNL_OFFSET_UPPER 2 ++ ++typedef enum _BAND_TYPE { ++ BAND_ON_2_4G = 0, ++ BAND_ON_5G = 1, ++ BAND_ON_BOTH = 2, ++ BAND_MAX = 3, ++} BAND_TYPE, *PBAND_TYPE; ++ ++extern const char *const _band_str[]; ++#define band_str(band) (((band) >= BAND_MAX) ? _band_str[BAND_MAX] : _band_str[(band)]) ++ ++extern const u8 _band_to_band_cap[]; ++#define band_to_band_cap(band) (((band) >= BAND_MAX) ? _band_to_band_cap[BAND_MAX] : _band_to_band_cap[(band)]) ++ ++/* Represent Channel Width in HT Capabilities ++ * */ ++typedef enum _CHANNEL_WIDTH { ++ CHANNEL_WIDTH_20 = 0, ++ CHANNEL_WIDTH_40 = 1, ++ CHANNEL_WIDTH_80 = 2, ++ CHANNEL_WIDTH_160 = 3, ++ CHANNEL_WIDTH_80_80 = 4, ++ CHANNEL_WIDTH_MAX = 5, ++} CHANNEL_WIDTH, *PCHANNEL_WIDTH; ++ ++extern const char *const _ch_width_str[]; ++#define ch_width_str(bw) (((bw) >= CHANNEL_WIDTH_MAX) ? _ch_width_str[CHANNEL_WIDTH_MAX] : _ch_width_str[(bw)]) ++ ++extern const u8 _ch_width_to_bw_cap[]; ++#define ch_width_to_bw_cap(bw) (((bw) >= CHANNEL_WIDTH_MAX) ? _ch_width_to_bw_cap[CHANNEL_WIDTH_MAX] : _ch_width_to_bw_cap[(bw)]) ++ ++/* ++ * Represent Extention Channel Offset in HT Capabilities ++ * This is available only in 40Mhz mode. ++ * */ ++typedef enum _EXTCHNL_OFFSET { ++ EXTCHNL_OFFSET_NO_EXT = 0, ++ EXTCHNL_OFFSET_UPPER = 1, ++ EXTCHNL_OFFSET_NO_DEF = 2, ++ EXTCHNL_OFFSET_LOWER = 3, ++} EXTCHNL_OFFSET, *PEXTCHNL_OFFSET; ++ ++typedef enum _VHT_DATA_SC { ++ VHT_DATA_SC_DONOT_CARE = 0, ++ VHT_DATA_SC_20_UPPER_OF_80MHZ = 1, ++ VHT_DATA_SC_20_LOWER_OF_80MHZ = 2, ++ VHT_DATA_SC_20_UPPERST_OF_80MHZ = 3, ++ VHT_DATA_SC_20_LOWEST_OF_80MHZ = 4, ++ VHT_DATA_SC_20_RECV1 = 5, ++ VHT_DATA_SC_20_RECV2 = 6, ++ VHT_DATA_SC_20_RECV3 = 7, ++ VHT_DATA_SC_20_RECV4 = 8, ++ VHT_DATA_SC_40_UPPER_OF_80MHZ = 9, ++ VHT_DATA_SC_40_LOWER_OF_80MHZ = 10, ++} VHT_DATA_SC, *PVHT_DATA_SC_E; ++ ++typedef enum _PROTECTION_MODE { ++ PROTECTION_MODE_AUTO = 0, ++ PROTECTION_MODE_FORCE_ENABLE = 1, ++ PROTECTION_MODE_FORCE_DISABLE = 2, ++} PROTECTION_MODE, *PPROTECTION_MODE; ++ ++typedef enum _RT_RF_TYPE_DEFINITION { ++ RF_1T2R = 0, ++ RF_2T4R = 1, ++ RF_2T2R = 2, ++ RF_1T1R = 3, ++ RF_2T2R_GREEN = 4, ++ RF_2T3R = 5, ++ RF_3T3R = 6, ++ RF_3T4R = 7, ++ RF_4T4R = 8, ++ ++ RF_MAX_TYPE = 0xF, /* u1Byte */ ++} RT_RF_TYPE_DEF_E; ++ ++int rtw_ch2freq(int chan); ++int rtw_freq2ch(int freq); ++bool rtw_chbw_to_freq_range(u8 ch, u8 bw, u8 offset, u32 *hi, u32 *lo); ++ ++#define RTW_MODULE_RTL8821AE_HMC_M2 BIT0 /* RTL8821AE(HMC + M.2) */ ++#define RTW_MODULE_RTL8821AU BIT1 /* RTL8821AU */ ++#define RTW_MODULE_RTL8812AENF_NGFF BIT2 /* RTL8812AENF(8812AE+8761)_NGFF */ ++#define RTW_MODULE_RTL8812AEBT_HMC BIT3 /* RTL8812AEBT(8812AE+8761)_HMC */ ++#define RTW_MODULE_RTL8188EE_HMC_M2 BIT4 /* RTL8188EE(HMC + M.2) */ ++#define RTW_MODULE_RTL8723BE_HMC_M2 BIT5 /* RTL8723BE(HMC + M.2) */ ++#define RTW_MODULE_RTL8723BS_NGFF1216 BIT6 /* RTL8723BS(NGFF1216) */ ++#define RTW_MODULE_RTL8192EEBT_HMC_M2 BIT7 /* RTL8192EEBT(8192EE+8761AU)_(HMC + M.2) */ ++ ++#define IS_ALPHA2_NO_SPECIFIED(_alpha2) ((*((u16 *)(_alpha2))) == 0xFFFF) ++ ++struct country_chplan { ++ char alpha2[2]; ++ u8 chplan; ++#ifdef CONFIG_80211AC_VHT ++ u8 en_11ac; ++#endif ++#if RTW_DEF_MODULE_REGULATORY_CERT ++ u8 def_module_flags; /* RTW_MODULE_RTLXXX */ ++#endif ++}; ++ ++#ifdef CONFIG_80211AC_VHT ++#define COUNTRY_CHPLAN_EN_11AC(_ent) ((_ent)->en_11ac) ++#else ++#define COUNTRY_CHPLAN_EN_11AC(_ent) 0 ++#endif ++ ++#if RTW_DEF_MODULE_REGULATORY_CERT ++#define COUNTRY_CHPLAN_DEF_MODULE_FALGS(_ent) ((_ent)->def_module_flags) ++#else ++#define COUNTRY_CHPLAN_DEF_MODULE_FALGS(_ent) 0 ++#endif ++ ++const struct country_chplan *rtw_get_chplan_from_country(const char *country_code); ++ ++#define BB_GAIN_2G 0 ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++#define BB_GAIN_5GLB1 1 ++#define BB_GAIN_5GLB2 2 ++#define BB_GAIN_5GMB1 3 ++#define BB_GAIN_5GMB2 4 ++#define BB_GAIN_5GHB 5 ++#endif ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++#define BB_GAIN_NUM 6 ++#else ++#define BB_GAIN_NUM 1 ++#endif ++ ++int rtw_ch_to_bb_gain_sel(int ch); ++void rtw_rf_set_tx_gain_offset(_adapter *adapter, u8 path, s8 offset); ++void rtw_rf_apply_tx_gain_offset(_adapter *adapter, u8 ch); ++ ++bool rtw_is_dfs_range(u32 hi, u32 lo); ++bool rtw_is_dfs_ch(u8 ch, u8 bw, u8 offset); ++bool rtw_is_long_cac_range(u32 hi, u32 lo, u8 dfs_region); ++bool rtw_is_long_cac_ch(u8 ch, u8 bw, u8 offset, u8 dfs_region); ++ ++#endif /* _RTL8711_RF_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_sdio.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_sdio.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_sdio.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_sdio.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,30 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ ******************************************************************************/ ++#ifndef _RTW_SDIO_H_ ++#define _RTW_SDIO_H_ ++ ++#include /* struct dvobj_priv and etc. */ ++ ++u8 rtw_sdio_read_cmd52(struct dvobj_priv *, u32 addr, void *buf, size_t len); ++u8 rtw_sdio_read_cmd53(struct dvobj_priv *, u32 addr, void *buf, size_t len); ++u8 rtw_sdio_write_cmd52(struct dvobj_priv *, u32 addr, void *buf, size_t len); ++u8 rtw_sdio_write_cmd53(struct dvobj_priv *, u32 addr, void *buf, size_t len); ++u8 rtw_sdio_f0_read(struct dvobj_priv *, u32 addr, void *buf, size_t len); ++ ++#endif /* _RTW_SDIO_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_security.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_security.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_security.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_security.h 2018-02-11 21:44:27.172146467 +0200 +@@ -0,0 +1,494 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_SECURITY_H_ ++#define __RTW_SECURITY_H_ ++ ++ ++#define _NO_PRIVACY_ 0x0 ++#define _WEP40_ 0x1 ++#define _TKIP_ 0x2 ++#define _TKIP_WTMIC_ 0x3 ++#define _AES_ 0x4 ++#define _WEP104_ 0x5 ++#define _WEP_WPA_MIXED_ 0x07 /* WEP + WPA */ ++#define _SMS4_ 0x06 ++#ifdef CONFIG_IEEE80211W ++#define _BIP_ 0x8 ++#endif /* CONFIG_IEEE80211W */ ++/* 802.11W use wrong key */ ++#define IEEE80211W_RIGHT_KEY 0x0 ++#define IEEE80211W_WRONG_KEY 0x1 ++#define IEEE80211W_NO_KEY 0x2 ++ ++#define is_wep_enc(alg) (((alg) == _WEP40_) || ((alg) == _WEP104_)) ++ ++const char *security_type_str(u8 value); ++ ++#define _WPA_IE_ID_ 0xdd ++#define _WPA2_IE_ID_ 0x30 ++ ++#define SHA256_MAC_LEN 32 ++#define AES_BLOCK_SIZE 16 ++#define AES_PRIV_SIZE (4 * 44) ++ ++#define RTW_KEK_LEN 16 ++#define RTW_KCK_LEN 16 ++#define RTW_TKIP_MIC_LEN 8 ++#define RTW_REPLAY_CTR_LEN 8 ++ ++#define INVALID_SEC_MAC_CAM_ID 0xFF ++ ++typedef enum { ++ ENCRYP_PROTOCOL_OPENSYS, /* open system */ ++ ENCRYP_PROTOCOL_WEP, /* WEP */ ++ ENCRYP_PROTOCOL_WPA, /* WPA */ ++ ENCRYP_PROTOCOL_WPA2, /* WPA2 */ ++ ENCRYP_PROTOCOL_WAPI, /* WAPI: Not support in this version */ ++ ENCRYP_PROTOCOL_MAX ++} ENCRYP_PROTOCOL_E; ++ ++ ++#ifndef Ndis802_11AuthModeWPA2 ++#define Ndis802_11AuthModeWPA2 (Ndis802_11AuthModeWPANone + 1) ++#endif ++ ++#ifndef Ndis802_11AuthModeWPA2PSK ++#define Ndis802_11AuthModeWPA2PSK (Ndis802_11AuthModeWPANone + 2) ++#endif ++ ++union pn48 { ++ ++ u64 val; ++ ++#ifdef CONFIG_LITTLE_ENDIAN ++ ++struct { ++ u8 TSC0; ++ u8 TSC1; ++ u8 TSC2; ++ u8 TSC3; ++ u8 TSC4; ++ u8 TSC5; ++ u8 TSC6; ++ u8 TSC7; ++} _byte_; ++ ++#elif defined(CONFIG_BIG_ENDIAN) ++ ++struct { ++ u8 TSC7; ++ u8 TSC6; ++ u8 TSC5; ++ u8 TSC4; ++ u8 TSC3; ++ u8 TSC2; ++ u8 TSC1; ++ u8 TSC0; ++} _byte_; ++ ++#endif ++ ++}; ++ ++union Keytype { ++ u8 skey[16]; ++ u32 lkey[4]; ++}; ++ ++ ++typedef struct _RT_PMKID_LIST { ++ u8 bUsed; ++ u8 Bssid[6]; ++ u8 PMKID[16]; ++ u8 SsidBuf[33]; ++ u8 *ssid_octet; ++ u16 ssid_length; ++} RT_PMKID_LIST, *PRT_PMKID_LIST; ++ ++ ++struct security_priv { ++ u32 dot11AuthAlgrthm; /* 802.11 auth, could be open, shared, 8021x and authswitch */ ++ u32 dot11PrivacyAlgrthm; /* This specify the privacy for shared auth. algorithm. */ ++ ++ /* WEP */ ++ u32 dot11PrivacyKeyIndex; /* this is only valid for legendary wep, 0~3 for key id. (tx key index) */ ++ union Keytype dot11DefKey[4]; /* this is only valid for def. key */ ++ u32 dot11DefKeylen[4]; ++ u8 dot11Def_camid[4]; ++ u8 key_mask; /* use to restore wep key after hal_init */ ++ ++ u32 dot118021XGrpPrivacy; /* This specify the privacy algthm. used for Grp key */ ++ u32 dot118021XGrpKeyid; /* key id used for Grp Key ( tx key index) */ ++ union Keytype dot118021XGrpKey[4]; /* 802.1x Group Key, for inx0 and inx1 */ ++ union Keytype dot118021XGrptxmickey[4]; ++ union Keytype dot118021XGrprxmickey[4]; ++ union pn48 dot11Grptxpn; /* PN48 used for Grp Key xmit. */ ++ union pn48 dot11Grprxpn; /* PN48 used for Grp Key recv. */ ++ u8 iv_seq[4][8]; ++#ifdef CONFIG_IEEE80211W ++ u32 dot11wBIPKeyid; /* key id used for BIP Key ( tx key index) */ ++ union Keytype dot11wBIPKey[6]; /* BIP Key, for index4 and index5 */ ++ union pn48 dot11wBIPtxpn; /* PN48 used for Grp Key xmit. */ ++ union pn48 dot11wBIPrxpn; /* PN48 used for Grp Key recv. */ ++#endif /* CONFIG_IEEE80211W */ ++#ifdef CONFIG_AP_MODE ++ /* extend security capabilities for AP_MODE */ ++ unsigned int dot8021xalg;/* 0:disable, 1:psk, 2:802.1x */ ++ unsigned int wpa_psk;/* 0:disable, bit(0): WPA, bit(1):WPA2 */ ++ unsigned int wpa_group_cipher; ++ unsigned int wpa2_group_cipher; ++ unsigned int wpa_pairwise_cipher; ++ unsigned int wpa2_pairwise_cipher; ++#endif ++#ifdef CONFIG_CONCURRENT_MODE ++ u8 dot118021x_bmc_cam_id; ++#endif ++ /*IEEE802.11-2012 Std. Table 8-101 AKM Suite Selectors*/ ++ u32 rsn_akm_suite_type; ++ ++ u8 wps_ie[MAX_WPS_IE_LEN];/* added in assoc req */ ++ int wps_ie_len; ++ ++ ++ u8 binstallGrpkey; ++#ifdef CONFIG_GTK_OL ++ u8 binstallKCK_KEK; ++#endif /* CONFIG_GTK_OL */ ++#ifdef CONFIG_IEEE80211W ++ u8 binstallBIPkey; ++#endif /* CONFIG_IEEE80211W */ ++ u8 busetkipkey; ++ /* _timer tkip_timer; */ ++ u8 bcheck_grpkey; ++ u8 bgrpkey_handshake; ++ ++ /* u8 packet_cnt; */ /* unused, removed */ ++ ++ s32 sw_encrypt;/* from registry_priv */ ++ s32 sw_decrypt;/* from registry_priv */ ++ ++ s32 hw_decrypted;/* if the rx packets is hw_decrypted==_FALSE, it means the hw has not been ready. */ ++ ++ ++ /* keeps the auth_type & enc_status from upper layer ioctl(wpa_supplicant or wzc) */ ++ u32 ndisauthtype; /* NDIS_802_11_AUTHENTICATION_MODE */ ++ u32 ndisencryptstatus; /* NDIS_802_11_ENCRYPTION_STATUS */ ++ ++ NDIS_802_11_WEP ndiswep; ++#ifdef PLATFORM_WINDOWS ++ u8 KeyMaterial[16];/* variable length depending on above field. */ ++#endif ++ ++ u8 assoc_info[600]; ++ u8 szofcapability[256]; /* for wpa2 usage */ ++ u8 oidassociation[512]; /* for wpa/wpa2 usage */ ++ u8 authenticator_ie[256]; /* store ap security information element */ ++ u8 supplicant_ie[256]; /* store sta security information element */ ++ ++ ++ /* for tkip countermeasure */ ++ u32 last_mic_err_time; ++ u8 btkip_countermeasure; ++ u8 btkip_wait_report; ++ u32 btkip_countermeasure_time; ++ ++ /* --------------------------------------------------------------------------- */ ++ /* For WPA2 Pre-Authentication. */ ++ /* --------------------------------------------------------------------------- */ ++ /* u8 RegEnablePreAuth; */ /* Default value: Pre-Authentication enabled or not, from registry "EnablePreAuth". Added by Annie, 2005-11-01. */ ++ /* u8 EnablePreAuthentication; */ /* Current Value: Pre-Authentication enabled or not. */ ++ RT_PMKID_LIST PMKIDList[NUM_PMKID_CACHE]; /* Renamed from PreAuthKey[NUM_PRE_AUTH_KEY]. Annie, 2006-10-13. */ ++ u8 PMKIDIndex; ++ /* u32 PMKIDCount; */ /* Added by Annie, 2006-10-13. */ ++ /* u8 szCapability[256]; */ /* For WPA2-PSK using zero-config, by Annie, 2005-09-20. */ ++ ++ u8 bWepDefaultKeyIdxSet; ++ ++#define DBG_SW_SEC_CNT ++#ifdef DBG_SW_SEC_CNT ++ u64 wep_sw_enc_cnt_bc; ++ u64 wep_sw_enc_cnt_mc; ++ u64 wep_sw_enc_cnt_uc; ++ u64 wep_sw_dec_cnt_bc; ++ u64 wep_sw_dec_cnt_mc; ++ u64 wep_sw_dec_cnt_uc; ++ ++ u64 tkip_sw_enc_cnt_bc; ++ u64 tkip_sw_enc_cnt_mc; ++ u64 tkip_sw_enc_cnt_uc; ++ u64 tkip_sw_dec_cnt_bc; ++ u64 tkip_sw_dec_cnt_mc; ++ u64 tkip_sw_dec_cnt_uc; ++ ++ u64 aes_sw_enc_cnt_bc; ++ u64 aes_sw_enc_cnt_mc; ++ u64 aes_sw_enc_cnt_uc; ++ u64 aes_sw_dec_cnt_bc; ++ u64 aes_sw_dec_cnt_mc; ++ u64 aes_sw_dec_cnt_uc; ++#endif /* DBG_SW_SEC_CNT */ ++}; ++ ++struct sha256_state { ++ u64 length; ++ u32 state[8], curlen; ++ u8 buf[64]; ++}; ++ ++#define GET_ENCRY_ALGO(psecuritypriv, psta, encry_algo, bmcst)\ ++ do {\ ++ switch (psecuritypriv->dot11AuthAlgrthm) {\ ++ case dot11AuthAlgrthm_Open:\ ++ case dot11AuthAlgrthm_Shared:\ ++ case dot11AuthAlgrthm_Auto:\ ++ encry_algo = (u8)psecuritypriv->dot11PrivacyAlgrthm;\ ++ break;\ ++ case dot11AuthAlgrthm_8021X:\ ++ if (bmcst)\ ++ encry_algo = (u8)psecuritypriv->dot118021XGrpPrivacy;\ ++ else\ ++ encry_algo = (u8) psta->dot118021XPrivacy;\ ++ break;\ ++ case dot11AuthAlgrthm_WAPI:\ ++ encry_algo = (u8)psecuritypriv->dot11PrivacyAlgrthm;\ ++ break;\ ++ } \ ++ } while (0) ++ ++#define _AES_IV_LEN_ 8 ++ ++#define SET_ICE_IV_LEN(iv_len, icv_len, encrypt)\ ++ do {\ ++ switch (encrypt) {\ ++ case _WEP40_:\ ++ case _WEP104_:\ ++ iv_len = 4;\ ++ icv_len = 4;\ ++ break;\ ++ case _TKIP_:\ ++ iv_len = 8;\ ++ icv_len = 4;\ ++ break;\ ++ case _AES_:\ ++ iv_len = 8;\ ++ icv_len = 8;\ ++ break;\ ++ case _SMS4_:\ ++ iv_len = 18;\ ++ icv_len = 16;\ ++ break;\ ++ default:\ ++ iv_len = 0;\ ++ icv_len = 0;\ ++ break;\ ++ } \ ++ } while (0) ++ ++ ++#define GET_TKIP_PN(iv, dot11txpn)\ ++ do {\ ++ dot11txpn._byte_.TSC0 = iv[2];\ ++ dot11txpn._byte_.TSC1 = iv[0];\ ++ dot11txpn._byte_.TSC2 = iv[4];\ ++ dot11txpn._byte_.TSC3 = iv[5];\ ++ dot11txpn._byte_.TSC4 = iv[6];\ ++ dot11txpn._byte_.TSC5 = iv[7];\ ++ } while (0) ++ ++ ++#define ROL32(A, n) (((A) << (n)) | (((A)>>(32-(n))) & ((1UL << (n)) - 1))) ++#define ROR32(A, n) ROL32((A), 32-(n)) ++ ++struct mic_data { ++ u32 K0, K1; /* Key */ ++ u32 L, R; /* Current state */ ++ u32 M; /* Message accumulator (single word) */ ++ u32 nBytesInM; /* # bytes in M */ ++}; ++ ++extern const u32 Te0[256]; ++extern const u32 Te1[256]; ++extern const u32 Te2[256]; ++extern const u32 Te3[256]; ++extern const u32 Te4[256]; ++extern const u32 Td0[256]; ++extern const u32 Td1[256]; ++extern const u32 Td2[256]; ++extern const u32 Td3[256]; ++extern const u32 Td4[256]; ++extern const u32 rcon[10]; ++extern const u8 Td4s[256]; ++extern const u8 rcons[10]; ++ ++#define RCON(i) (rcons[(i)] << 24) ++ ++static inline u32 rotr(u32 val, int bits) ++{ ++ return (val >> bits) | (val << (32 - bits)); ++} ++ ++#define TE0(i) Te0[((i) >> 24) & 0xff] ++#define TE1(i) rotr(Te0[((i) >> 16) & 0xff], 8) ++#define TE2(i) rotr(Te0[((i) >> 8) & 0xff], 16) ++#define TE3(i) rotr(Te0[(i) & 0xff], 24) ++#define TE41(i) ((Te0[((i) >> 24) & 0xff] << 8) & 0xff000000) ++#define TE42(i) (Te0[((i) >> 16) & 0xff] & 0x00ff0000) ++#define TE43(i) (Te0[((i) >> 8) & 0xff] & 0x0000ff00) ++#define TE44(i) ((Te0[(i) & 0xff] >> 8) & 0x000000ff) ++#define TE421(i) ((Te0[((i) >> 16) & 0xff] << 8) & 0xff000000) ++#define TE432(i) (Te0[((i) >> 8) & 0xff] & 0x00ff0000) ++#define TE443(i) (Te0[(i) & 0xff] & 0x0000ff00) ++#define TE414(i) ((Te0[((i) >> 24) & 0xff] >> 8) & 0x000000ff) ++#define TE4(i) ((Te0[(i)] >> 8) & 0x000000ff) ++ ++#define TD0(i) Td0[((i) >> 24) & 0xff] ++#define TD1(i) rotr(Td0[((i) >> 16) & 0xff], 8) ++#define TD2(i) rotr(Td0[((i) >> 8) & 0xff], 16) ++#define TD3(i) rotr(Td0[(i) & 0xff], 24) ++#define TD41(i) (Td4s[((i) >> 24) & 0xff] << 24) ++#define TD42(i) (Td4s[((i) >> 16) & 0xff] << 16) ++#define TD43(i) (Td4s[((i) >> 8) & 0xff] << 8) ++#define TD44(i) (Td4s[(i) & 0xff]) ++#define TD0_(i) Td0[(i) & 0xff] ++#define TD1_(i) rotr(Td0[(i) & 0xff], 8) ++#define TD2_(i) rotr(Td0[(i) & 0xff], 16) ++#define TD3_(i) rotr(Td0[(i) & 0xff], 24) ++ ++#define GETU32(pt) (((u32)(pt)[0] << 24) ^ ((u32)(pt)[1] << 16) ^ \ ++ ((u32)(pt)[2] << 8) ^ ((u32)(pt)[3])) ++ ++#define PUTU32(ct, st) { \ ++ (ct)[0] = (u8)((st) >> 24); (ct)[1] = (u8)((st) >> 16); \ ++ (ct)[2] = (u8)((st) >> 8); (ct)[3] = (u8)(st); } ++ ++#define WPA_GET_BE32(a) ((((u32) (a)[0]) << 24) | (((u32) (a)[1]) << 16) | \ ++ (((u32) (a)[2]) << 8) | ((u32) (a)[3])) ++ ++#define WPA_PUT_LE16(a, val) \ ++ do { \ ++ (a)[1] = ((u16) (val)) >> 8; \ ++ (a)[0] = ((u16) (val)) & 0xff; \ ++ } while (0) ++ ++#define WPA_PUT_BE32(a, val) \ ++ do { \ ++ (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ ++ (a)[1] = (u8) ((((u32) (val)) >> 16) & 0xff); \ ++ (a)[2] = (u8) ((((u32) (val)) >> 8) & 0xff); \ ++ (a)[3] = (u8) (((u32) (val)) & 0xff); \ ++ } while (0) ++ ++#define WPA_PUT_BE64(a, val) \ ++ do { \ ++ (a)[0] = (u8) (((u64) (val)) >> 56); \ ++ (a)[1] = (u8) (((u64) (val)) >> 48); \ ++ (a)[2] = (u8) (((u64) (val)) >> 40); \ ++ (a)[3] = (u8) (((u64) (val)) >> 32); \ ++ (a)[4] = (u8) (((u64) (val)) >> 24); \ ++ (a)[5] = (u8) (((u64) (val)) >> 16); \ ++ (a)[6] = (u8) (((u64) (val)) >> 8); \ ++ (a)[7] = (u8) (((u64) (val)) & 0xff); \ ++ } while (0) ++ ++/* ===== start - public domain SHA256 implementation ===== */ ++ ++/* This is based on SHA256 implementation in LibTomCrypt that was released into ++ * public domain by Tom St Denis. */ ++ ++/* the K array */ ++static const unsigned long K[64] = { ++ 0x428a2f98UL, 0x71374491UL, 0xb5c0fbcfUL, 0xe9b5dba5UL, 0x3956c25bUL, ++ 0x59f111f1UL, 0x923f82a4UL, 0xab1c5ed5UL, 0xd807aa98UL, 0x12835b01UL, ++ 0x243185beUL, 0x550c7dc3UL, 0x72be5d74UL, 0x80deb1feUL, 0x9bdc06a7UL, ++ 0xc19bf174UL, 0xe49b69c1UL, 0xefbe4786UL, 0x0fc19dc6UL, 0x240ca1ccUL, ++ 0x2de92c6fUL, 0x4a7484aaUL, 0x5cb0a9dcUL, 0x76f988daUL, 0x983e5152UL, ++ 0xa831c66dUL, 0xb00327c8UL, 0xbf597fc7UL, 0xc6e00bf3UL, 0xd5a79147UL, ++ 0x06ca6351UL, 0x14292967UL, 0x27b70a85UL, 0x2e1b2138UL, 0x4d2c6dfcUL, ++ 0x53380d13UL, 0x650a7354UL, 0x766a0abbUL, 0x81c2c92eUL, 0x92722c85UL, ++ 0xa2bfe8a1UL, 0xa81a664bUL, 0xc24b8b70UL, 0xc76c51a3UL, 0xd192e819UL, ++ 0xd6990624UL, 0xf40e3585UL, 0x106aa070UL, 0x19a4c116UL, 0x1e376c08UL, ++ 0x2748774cUL, 0x34b0bcb5UL, 0x391c0cb3UL, 0x4ed8aa4aUL, 0x5b9cca4fUL, ++ 0x682e6ff3UL, 0x748f82eeUL, 0x78a5636fUL, 0x84c87814UL, 0x8cc70208UL, ++ 0x90befffaUL, 0xa4506cebUL, 0xbef9a3f7UL, 0xc67178f2UL ++}; ++ ++ ++/* Various logical functions */ ++#define RORc(x, y) \ ++ (((((unsigned long) (x) & 0xFFFFFFFFUL) >> (unsigned long) ((y) & 31)) | \ ++ ((unsigned long) (x) << (unsigned long) (32 - ((y) & 31)))) & 0xFFFFFFFFUL) ++#define Ch(x, y, z) (z ^ (x & (y ^ z))) ++#define Maj(x, y, z) (((x | y) & z) | (x & y)) ++#define S(x, n) RORc((x), (n)) ++#define R(x, n) (((x) & 0xFFFFFFFFUL)>>(n)) ++#define Sigma0(x) (S(x, 2) ^ S(x, 13) ^ S(x, 22)) ++#define Sigma1(x) (S(x, 6) ^ S(x, 11) ^ S(x, 25)) ++#define Gamma0(x) (S(x, 7) ^ S(x, 18) ^ R(x, 3)) ++#define Gamma1(x) (S(x, 17) ^ S(x, 19) ^ R(x, 10)) ++#ifndef MIN ++#define MIN(x, y) (((x) < (y)) ? (x) : (y)) ++#endif ++#ifdef CONFIG_IEEE80211W ++int omac1_aes_128(u8 *key, u8 *data, size_t data_len, u8 *mac); ++#endif /* CONFIG_IEEE80211W */ ++void rtw_secmicsetkey(struct mic_data *pmicdata, u8 *key); ++void rtw_secmicappendbyte(struct mic_data *pmicdata, u8 b); ++void rtw_secmicappend(struct mic_data *pmicdata, u8 *src, u32 nBytes); ++void rtw_secgetmic(struct mic_data *pmicdata, u8 *dst); ++ ++void rtw_seccalctkipmic( ++ u8 *key, ++ u8 *header, ++ u8 *data, ++ u32 data_len, ++ u8 *Miccode, ++ u8 priority); ++ ++u32 rtw_aes_encrypt(_adapter *padapter, u8 *pxmitframe); ++u32 rtw_tkip_encrypt(_adapter *padapter, u8 *pxmitframe); ++void rtw_wep_encrypt(_adapter *padapter, u8 *pxmitframe); ++ ++u32 rtw_aes_decrypt(_adapter *padapter, u8 *precvframe); ++u32 rtw_tkip_decrypt(_adapter *padapter, u8 *precvframe); ++void rtw_wep_decrypt(_adapter *padapter, u8 *precvframe); ++#ifdef CONFIG_IEEE80211W ++u32 rtw_BIP_verify(_adapter *padapter, u8 *precvframe); ++#endif /* CONFIG_IEEE80211W */ ++#ifdef CONFIG_TDLS ++void wpa_tdls_generate_tpk(_adapter *padapter, PVOID sta); ++int wpa_tdls_ftie_mic(u8 *kck, u8 trans_seq, ++ u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie, ++ u8 *mic); ++int wpa_tdls_teardown_ftie_mic(u8 *kck, u8 *lnkid, u16 reason, ++ u8 dialog_token, u8 trans_seq, u8 *ftie, u8 *mic); ++int tdls_verify_mic(u8 *kck, u8 trans_seq, ++ u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie); ++#endif /* CONFIG_TDLS */ ++ ++void rtw_use_tkipkey_handler(RTW_TIMER_HDL_ARGS); ++ ++void rtw_sec_restore_wep_key(_adapter *adapter); ++u8 rtw_handle_tkip_countermeasure(_adapter *adapter, const char *caller); ++ ++#ifdef CONFIG_WOWLAN ++u16 rtw_calc_crc(u8 *pdata, int length); ++#endif /*CONFIG_WOWLAN*/ ++ ++#endif /* __RTL871X_SECURITY_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_sreset.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_sreset.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_sreset.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,60 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTW_SRESET_H_ ++#define _RTW_SRESET_H_ ++ ++/* #include */ ++ ++enum { ++ SRESET_TGP_NULL = 0, ++ SRESET_TGP_XMIT_STATUS = 1, ++ SRESET_TGP_LINK_STATUS = 2, ++}; ++ ++struct sreset_priv { ++ _mutex silentreset_mutex; ++ u8 silent_reset_inprogress; ++ u8 Wifi_Error_Status; ++ unsigned long last_tx_time; ++ unsigned long last_tx_complete_time; ++ ++ s32 dbg_trigger_point; ++}; ++ ++ ++ ++#define WIFI_STATUS_SUCCESS 0 ++#define USB_VEN_REQ_CMD_FAIL BIT0 ++#define USB_READ_PORT_FAIL BIT1 ++#define USB_WRITE_PORT_FAIL BIT2 ++#define WIFI_MAC_TXDMA_ERROR BIT3 ++#define WIFI_TX_HANG BIT4 ++#define WIFI_RX_HANG BIT5 ++#define WIFI_IF_NOT_EXIST BIT6 ++ ++void sreset_init_value(_adapter *padapter); ++void sreset_reset_value(_adapter *padapter); ++u8 sreset_get_wifi_status(_adapter *padapter); ++void sreset_set_wifi_error_status(_adapter *padapter, u32 status); ++void sreset_set_trigger_point(_adapter *padapter, s32 tgp); ++bool sreset_inprogress(_adapter *padapter); ++void sreset_reset(_adapter *padapter); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_tdls.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_tdls.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_tdls.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_tdls.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,173 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_TDLS_H_ ++#define __RTW_TDLS_H_ ++ ++ ++#ifdef CONFIG_TDLS ++/* TDLS STA state */ ++ ++ ++/* TDLS Diect Link Establishment */ ++#define TDLS_STATE_NONE 0x00000000 /* Default state */ ++#define TDLS_INITIATOR_STATE BIT(28) /* 0x10000000 */ ++#define TDLS_RESPONDER_STATE BIT(29) /* 0x20000000 */ ++#define TDLS_LINKED_STATE BIT(30) /* 0x40000000 */ ++/* TDLS PU Buffer STA */ ++#define TDLS_WAIT_PTR_STATE BIT(24) /* 0x01000000 */ /* Waiting peer's TDLS_PEER_TRAFFIC_RESPONSE frame */ ++/* TDLS Check ALive */ ++#define TDLS_ALIVE_STATE BIT(20) /* 0x00100000 */ /* Check if peer sta is alived. */ ++/* TDLS Channel Switch */ ++#define TDLS_CH_SWITCH_PREPARE_STATE BIT(15) /* 0x00008000 */ ++#define TDLS_CH_SWITCH_ON_STATE BIT(16) /* 0x00010000 */ ++#define TDLS_PEER_AT_OFF_STATE BIT(17) /* 0x00020000 */ /* Could send pkt on target ch */ ++#define TDLS_CH_SW_INITIATOR_STATE BIT(18) /* 0x00040000 */ /* Avoid duplicated or unconditional ch. switch rsp. */ ++#define TDLS_WAIT_CH_RSP_STATE BIT(19) /* 0x00080000 */ /* Wait Ch. response as we are TDLS channel switch initiator */ ++ ++ ++#define TDLS_TPK_RESEND_COUNT 86400 /*Unit: seconds */ ++#define TDLS_CH_SWITCH_TIME 15 ++#define TDLS_CH_SWITCH_TIMEOUT 30 ++#define TDLS_CH_SWITCH_OPER_OFFLOAD_TIMEOUT 10 ++#define TDLS_SIGNAL_THRESH 0x20 ++#define TDLS_WATCHDOG_PERIOD 10 /* Periodically sending tdls discovery request in TDLS_WATCHDOG_PERIOD * 2 sec */ ++#define TDLS_HANDSHAKE_TIME 3000 ++#define TDLS_PTI_TIME 7000 ++ ++#define TDLS_CH_SW_STAY_ON_BASE_CHNL_TIMEOUT 20 /* ms */ ++#define TDLS_CH_SW_MONITOR_TIMEOUT 2000 /*ms */ ++ ++#define TDLS_MIC_LEN 16 ++#define WPA_NONCE_LEN 32 ++#define TDLS_TIMEOUT_LEN 4 ++ ++enum TDLS_CH_SW_CHNL { ++ TDLS_CH_SW_BASE_CHNL = 0, ++ TDLS_CH_SW_OFF_CHNL ++}; ++ ++struct wpa_tdls_ftie { ++ u8 ie_type; /* FTIE */ ++ u8 ie_len; ++ u8 mic_ctrl[2]; ++ u8 mic[TDLS_MIC_LEN]; ++ u8 Anonce[WPA_NONCE_LEN]; /* Responder Nonce in TDLS */ ++ u8 Snonce[WPA_NONCE_LEN]; /* Initiator Nonce in TDLS */ ++ /* followed by optional elements */ ++} ; ++ ++struct wpa_tdls_lnkid { ++ u8 ie_type; /* Link Identifier IE */ ++ u8 ie_len; ++ u8 bssid[ETH_ALEN]; ++ u8 init_sta[ETH_ALEN]; ++ u8 resp_sta[ETH_ALEN]; ++} ; ++ ++static u8 TDLS_RSNIE[20] = { 0x01, 0x00, /* Version shall be set to 1 */ ++ 0x00, 0x0f, 0xac, 0x07, /* Group sipher suite */ ++ 0x01, 0x00, /* Pairwise cipher suite count */ ++ 0x00, 0x0f, 0xac, 0x04, /* Pairwise cipher suite list; CCMP only */ ++ 0x01, 0x00, /* AKM suite count */ ++ 0x00, 0x0f, 0xac, 0x07, /* TPK Handshake */ ++ 0x0c, 0x02, ++ /* PMKID shall not be present */ ++ }; ++ ++static u8 TDLS_WMMIE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01, 0x00}; /* Qos info all set zero */ ++ ++static u8 TDLS_WMM_PARAM_IE[] = {0x00, 0x00, 0x03, 0xa4, 0x00, 0x00, 0x27, 0xa4, 0x00, 0x00, 0x42, 0x43, 0x5e, 0x00, 0x62, 0x32, 0x2f, 0x00}; ++ ++static u8 TDLS_EXT_CAPIE[] = {0x00, 0x00, 0x00, 0x50, 0x20, 0x00, 0x00, 0x00}; /* bit(28), bit(30), bit(37) */ ++ ++/* SRC: Supported Regulatory Classes */ ++static u8 TDLS_SRC[] = { 0x01, 0x01, 0x02, 0x03, 0x04, 0x0c, 0x16, 0x17, 0x18, 0x19, 0x1b, 0x1c, 0x1d, 0x1e, 0x20, 0x21 }; ++ ++int check_ap_tdls_prohibited(u8 *pframe, u8 pkt_len); ++int check_ap_tdls_ch_switching_prohibited(u8 *pframe, u8 pkt_len); ++ ++u8 rtw_tdls_is_setup_allowed(_adapter *padapter); ++#ifdef CONFIG_TDLS_CH_SW ++u8 rtw_tdls_is_chsw_allowed(_adapter *padapter); ++#endif ++ ++void rtw_reset_tdls_info(_adapter *padapter); ++int rtw_init_tdls_info(_adapter *padapter); ++void rtw_free_tdls_info(struct tdls_info *ptdlsinfo); ++int issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); ++void rtw_init_tdls_timer(_adapter *padapter, struct sta_info *psta); ++void rtw_free_tdls_timer(struct sta_info *psta); ++void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta); ++ ++#ifdef CONFIG_TDLS_CH_SW ++void rtw_tdls_set_ch_sw_oper_control(_adapter *padapter, u8 enable); ++void rtw_tdls_ch_sw_back_to_base_chnl(_adapter *padapter); ++s32 rtw_tdls_do_ch_sw(_adapter *padapter, struct sta_info *ptdls_sta, u8 chnl_type, u8 channel, u8 channel_offset, u16 bwmode, u16 ch_switch_time); ++void rtw_tdls_chsw_oper_done(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_WFD ++int issue_tunneled_probe_req(_adapter *padapter); ++int issue_tunneled_probe_rsp(_adapter *padapter, union recv_frame *precv_frame); ++#endif /* CONFIG_WFD */ ++int issue_tdls_dis_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt); ++int issue_tdls_setup_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack); ++int issue_tdls_setup_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt); ++int issue_tdls_setup_cfm(_adapter *padapter, struct tdls_txmgmt *ptxmgmt); ++int issue_tdls_dis_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 privacy); ++int issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack); ++int issue_tdls_peer_traffic_rsp(_adapter *padapter, struct sta_info *psta, struct tdls_txmgmt *ptxmgmt); ++int issue_tdls_peer_traffic_indication(_adapter *padapter, struct sta_info *psta); ++#ifdef CONFIG_TDLS_CH_SW ++int issue_tdls_ch_switch_req(_adapter *padapter, struct sta_info *ptdls_sta); ++int issue_tdls_ch_switch_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack); ++#endif ++sint On_TDLS_Dis_Rsp(_adapter *adapter, union recv_frame *precv_frame); ++sint On_TDLS_Setup_Req(_adapter *adapter, union recv_frame *precv_frame); ++int On_TDLS_Setup_Rsp(_adapter *adapter, union recv_frame *precv_frame); ++int On_TDLS_Setup_Cfm(_adapter *adapter, union recv_frame *precv_frame); ++int On_TDLS_Dis_Req(_adapter *adapter, union recv_frame *precv_frame); ++int On_TDLS_Teardown(_adapter *adapter, union recv_frame *precv_frame); ++int On_TDLS_Peer_Traffic_Indication(_adapter *adapter, union recv_frame *precv_frame); ++int On_TDLS_Peer_Traffic_Rsp(_adapter *adapter, union recv_frame *precv_frame); ++#ifdef CONFIG_TDLS_CH_SW ++sint On_TDLS_Ch_Switch_Req(_adapter *adapter, union recv_frame *precv_frame); ++sint On_TDLS_Ch_Switch_Rsp(_adapter *adapter, union recv_frame *precv_frame); ++void rtw_build_tdls_ch_switch_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); ++void rtw_build_tdls_ch_switch_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); ++#endif ++void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); ++void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); ++void rtw_build_tdls_setup_cfm_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); ++void rtw_build_tdls_teardown_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); ++void rtw_build_tdls_dis_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); ++void rtw_build_tdls_dis_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, u8 privacy); ++void rtw_build_tdls_peer_traffic_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); ++void rtw_build_tdls_peer_traffic_indication_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); ++void rtw_build_tunneled_probe_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe); ++void rtw_build_tunneled_probe_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe); ++ ++u32 update_mask_tdls(_adapter *padapter, struct sta_info *psta); ++int rtw_tdls_is_driver_setup(_adapter *padapter); ++void rtw_tdls_set_key(_adapter *padapter, struct sta_info *ptdls_sta); ++const char *rtw_tdls_action_txt(enum TDLS_ACTION_FIELD action); ++#endif /* CONFIG_TDLS */ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_version.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_version.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_version.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_version.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,2 @@ ++#define DRIVERVERSION "v5.1.1.8_21285.20171026" ++#define BTCOEXVERSION "BTCOEX20170111-1414" +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_vht.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_vht.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_vht.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_vht.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,143 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTW_VHT_H_ ++#define _RTW_VHT_H_ ++ ++#define LDPC_VHT_ENABLE_RX BIT0 ++#define LDPC_VHT_ENABLE_TX BIT1 ++#define LDPC_VHT_TEST_TX_ENABLE BIT2 ++#define LDPC_VHT_CAP_TX BIT3 ++ ++#define STBC_VHT_ENABLE_RX BIT0 ++#define STBC_VHT_ENABLE_TX BIT1 ++#define STBC_VHT_TEST_TX_ENABLE BIT2 ++#define STBC_VHT_CAP_TX BIT3 ++ ++#define BEAMFORMING_VHT_BEAMFORMER_ENABLE BIT0 /* Declare our NIC supports beamformer */ ++#define BEAMFORMING_VHT_BEAMFORMEE_ENABLE BIT1 /* Declare our NIC supports beamformee */ ++#define BEAMFORMING_VHT_MU_MIMO_AP_ENABLE BIT2 /*Declare our NIC support MU-MIMO AP mode*/ ++#define BEAMFORMING_VHT_MU_MIMO_STA_ENABLE BIT3 /*Declare our NIC support MU-MIMO STA mode*/ ++#define BEAMFORMING_VHT_BEAMFORMER_TEST BIT4 /*Transmiting Beamforming no matter the target supports it or not*/ ++#define BEAMFORMING_VHT_BEAMFORMER_STS_CAP (BIT8 | BIT9 | BIT10) /*Asoc rsp cap*/ ++#define BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM (BIT12 | BIT13 | BIT14) /*Asoc rsp cap*/ ++ ++ ++/* VHT capability info */ ++#define SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 0, 2, _val) ++#define SET_VHT_CAPABILITY_ELE_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 2, 2, _val) ++#define SET_VHT_CAPABILITY_ELE_RX_LDPC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 4, 1, _val) ++#define SET_VHT_CAPABILITY_ELE_SHORT_GI80M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 5, 1, _val) ++#define SET_VHT_CAPABILITY_ELE_SHORT_GI160M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 6, 1, _val) ++#define SET_VHT_CAPABILITY_ELE_TX_STBC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 7, 1, _val) ++#define SET_VHT_CAPABILITY_ELE_RX_STBC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 0, 3, _val) ++#define SET_VHT_CAPABILITY_ELE_SU_BFER(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 3, 1, _val) ++#define SET_VHT_CAPABILITY_ELE_SU_BFEE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 4, 1, _val) ++#define SET_VHT_CAPABILITY_ELE_BFER_ANT_SUPP(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 5, 3, _val) ++#define SET_VHT_CAPABILITY_ELE_SOUNDING_DIMENSIONS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 0, 3, _val) ++ ++#define SET_VHT_CAPABILITY_ELE_MU_BFER(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 3, 1, _val) ++#define SET_VHT_CAPABILITY_ELE_MU_BFEE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 4, 1, _val) ++#define SET_VHT_CAPABILITY_ELE_TXOP_PS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 5, 1, _val) ++#define SET_VHT_CAPABILITY_ELE_HTC_VHT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 6, 1, _val) ++#define SET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+2, 7, 3, _val) /* B23~B25 */ ++#define SET_VHT_CAPABILITY_ELE_LINK_ADAPTION(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 2, 2, _val) ++#define SET_VHT_CAPABILITY_ELE_MCS_RX_MAP(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+4, 0, 16, _val) /* B0~B15 indicate Rx MCS MAP, we write 0 to indicate MCS0~7. by page */ ++#define SET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+6, 0, 13, _val) ++#define SET_VHT_CAPABILITY_ELE_MCS_TX_MAP(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+8, 0, 16, _val) /* B0~B15 indicate Tx MCS MAP, we write 0 to indicate MCS0~7. by page */ ++#define SET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+10, 0, 13, _val) ++ ++ ++#define GET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 0, 2) ++#define GET_VHT_CAPABILITY_ELE_CHL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 2, 2) ++#define GET_VHT_CAPABILITY_ELE_RX_LDPC(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 4, 1) ++#define GET_VHT_CAPABILITY_ELE_SHORT_GI80M(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 5, 1) ++#define GET_VHT_CAPABILITY_ELE_SHORT_GI160M(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 6, 1) ++#define GET_VHT_CAPABILITY_ELE_TX_STBC(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 7, 1) ++#define GET_VHT_CAPABILITY_ELE_RX_STBC(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 0, 3) ++#define GET_VHT_CAPABILITY_ELE_SU_BFER(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 3, 1) ++#define GET_VHT_CAPABILITY_ELE_SU_BFEE(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 4, 1) ++/*phydm-beamforming*/ ++#define GET_VHT_CAPABILITY_ELE_SU_BFEE_STS_CAP(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+1, 5, 3) ++#define GET_VHT_CAPABILITY_ELE_SU_BFER_SOUND_DIM_NUM(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+2, 0, 3) ++#define GET_VHT_CAPABILITY_ELE_MU_BFER(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+2, 3, 1) ++#define GET_VHT_CAPABILITY_ELE_MU_BFEE(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+2, 4, 1) ++#define GET_VHT_CAPABILITY_ELE_TXOP_PS(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+2, 5, 1) ++#define GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+2, 7, 3) ++#define GET_VHT_CAPABILITY_ELE_RX_MCS(_pEleStart) ((_pEleStart)+4) ++#define GET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+6, 0, 13) ++#define GET_VHT_CAPABILITY_ELE_TX_MCS(_pEleStart) ((_pEleStart)+8) ++#define GET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+10, 0, 13) ++ ++ ++/* VHT Operation Information Element */ ++#define SET_VHT_OPERATION_ELE_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 0, 8, _val) ++#define SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart+1, 0, 8, _val) ++#define SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart+2, 0, 8, _val) ++#define SET_VHT_OPERATION_ELE_BASIC_MCS_SET(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+3, 0, 16, _val) ++ ++#define GET_VHT_OPERATION_ELE_CHL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 0, 8) ++#define GET_VHT_OPERATION_ELE_CENTER_FREQ1(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 0, 8) ++#define GET_VHT_OPERATION_ELE_CENTER_FREQ2(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+2, 0, 8) ++ ++/* VHT Operating Mode */ ++#define SET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 0, 2, _val) ++#define SET_VHT_OPERATING_MODE_FIELD_RX_NSS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 4, 3, _val) ++#define SET_VHT_OPERATING_MODE_FIELD_RX_NSS_TYPE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 7, 1, _val) ++#define GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 0, 2) ++#define GET_VHT_OPERATING_MODE_FIELD_RX_NSS(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 4, 3) ++#define GET_VHT_OPERATING_MODE_FIELD_RX_NSS_TYPE(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 7, 1) ++ ++#define SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+7, 6, 1, _val) ++#define GET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+7, 6, 1) ++ ++struct vht_priv { ++ u8 vht_option; ++ ++ u8 ldpc_cap; ++ u8 stbc_cap; ++ u16 beamform_cap; ++ ++ u8 sgi_80m;/* short GI */ ++ u8 ampdu_len; ++ ++ u8 vht_op_mode_notify; ++ u8 vht_highest_rate; ++ u8 vht_mcs_map[2]; ++ ++ u8 vht_cap[32]; ++}; ++ ++u8 rtw_get_vht_highest_rate(u8 *pvht_mcs_map); ++u16 rtw_vht_mcs_to_data_rate(u8 bw, u8 short_GI, u8 vht_mcs_rate); ++u64 rtw_vht_rate_to_bitmap(u8 *pVHTRate); ++void rtw_vht_use_default_setting(_adapter *padapter); ++u32 rtw_build_vht_operation_ie(_adapter *padapter, u8 *pbuf, u8 channel); ++u32 rtw_build_vht_op_mode_notify_ie(_adapter *padapter, u8 *pbuf, u8 bw); ++u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf); ++void update_sta_vht_info_apmode(_adapter *padapter, PVOID psta); ++void update_hw_vht_param(_adapter *padapter); ++void VHT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); ++void VHT_operation_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); ++void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, PVOID sta); ++u32 rtw_restructure_vht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len); ++void VHTOnAssocRsp(_adapter *padapter); ++u8 rtw_vht_mcsmap_to_nss(u8 *pvht_mcs_map); ++ ++#endif /* _RTW_VHT_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_wapi.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_wapi.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_wapi.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_wapi.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,214 @@ ++#ifndef __INC_WAPI_H ++#define __INC_WAPI_H ++ ++ ++#define CONFIG_WAPI_SW_SMS4 ++#define WAPI_DEBUG ++ ++#define SMS4_MIC_LEN 16 ++#define WAPI_EXT_LEN 18 ++#define MAX_WAPI_IE_LEN 256 ++#define sMacHdrLng 24 /* octets in data header, no WEP */ ++ ++#ifdef WAPI_DEBUG ++ ++/* WAPI trace debug */ ++extern u32 wapi_debug_component; ++ ++static inline void dump_buf(u8 *buf, u32 len) ++{ ++ u32 i; ++ printk("-----------------Len %d----------------\n", len); ++ for (i = 0; i < len; i++) ++ printk("%2.2x-", *(buf + i)); ++ printk("\n"); ++} ++ ++#define WAPI_TRACE(component, x, args...) \ ++ do { if (wapi_debug_component & (component)) \ ++ printk(KERN_DEBUG "WAPI" ":" x "" , \ ++ ##args);\ ++ } while (0); ++ ++#define WAPI_DATA(component, x, buf, len) \ ++ do { if (wapi_debug_component & (component)) { \ ++ printk("%s:\n", x);\ ++ dump_buf((buf), (len)); } \ ++ } while (0); ++ ++#define RT_ASSERT_RET(_Exp) \ ++ if (!(_Exp)) { \ ++ printk("RTWLAN: "); \ ++ printk("Assertion failed! %s,%s, line=%d\n", \ ++ #_Exp, __FUNCTION__, __LINE__); \ ++ return; \ ++ } ++#define RT_ASSERT_RET_VALUE(_Exp, Ret) \ ++ if (!(_Exp)) { \ ++ printk("RTWLAN: "); \ ++ printk("Assertion failed! %s,%s, line=%d\n", \ ++ #_Exp, __FUNCTION__, __LINE__); \ ++ return Ret; \ ++ } ++ ++#else ++#define RT_ASSERT_RET(_Exp) do {} while (0) ++#define RT_ASSERT_RET_VALUE(_Exp, Ret) do {} while (0) ++#define WAPI_TRACE(component, x, args...) do {} while (0) ++#define WAPI_DATA(component, x, buf, len) do {} while (0) ++#endif ++ ++ ++enum WAPI_DEBUG { ++ WAPI_INIT = 1, ++ WAPI_API = 1 << 1, ++ WAPI_TX = 1 << 2, ++ WAPI_RX = 1 << 3, ++ WAPI_MLME = 1 << 4, ++ WAPI_IOCTL = 1 << 5, ++ WAPI_ERR = 1 << 31 ++}; ++ ++#define WAPI_MAX_BKID_NUM 4 ++#define WAPI_MAX_STAINFO_NUM 4 ++#define WAPI_CAM_ENTRY_NUM 14 /* 28/2 = 14 */ ++ ++typedef struct _RT_WAPI_BKID { ++ struct list_head list; ++ u8 bkid[16]; ++} RT_WAPI_BKID, *PRT_WAPI_BKID; ++ ++typedef struct _RT_WAPI_KEY { ++ u8 dataKey[16]; ++ u8 micKey[16]; ++ u8 keyId; ++ bool bSet; ++ bool bTxEnable; ++} RT_WAPI_KEY, *PRT_WAPI_KEY; ++ ++typedef enum _RT_WAPI_PACKET_TYPE { ++ WAPI_NONE = 0, ++ WAPI_PREAUTHENTICATE = 1, ++ WAPI_STAKEY_REQUEST = 2, ++ WAPI_AUTHENTICATE_ACTIVE = 3, ++ WAPI_ACCESS_AUTHENTICATE_REQUEST = 4, ++ WAPI_ACCESS_AUTHENTICATE_RESPONSE = 5, ++ WAPI_CERTIFICATE_AUTHENTICATE_REQUEST = 6, ++ WAPI_CERTIFICATE_AUTHENTICATE_RESPONSE = 7, ++ WAPI_USK_REQUEST = 8, ++ WAPI_USK_RESPONSE = 9, ++ WAPI_USK_CONFIRM = 10, ++ WAPI_MSK_NOTIFICATION = 11, ++ WAPI_MSK_RESPONSE = 12 ++} RT_WAPI_PACKET_TYPE; ++ ++typedef struct _RT_WAPI_STA_INFO { ++ struct list_head list; ++ u8 PeerMacAddr[6]; ++ RT_WAPI_KEY wapiUsk; ++ RT_WAPI_KEY wapiUskUpdate; ++ RT_WAPI_KEY wapiMsk; ++ RT_WAPI_KEY wapiMskUpdate; ++ u8 lastRxUnicastPN[16]; ++ u8 lastTxUnicastPN[16]; ++ u8 lastRxMulticastPN[16]; ++ u8 lastRxUnicastPNBEQueue[16]; ++ u8 lastRxUnicastPNBKQueue[16]; ++ u8 lastRxUnicastPNVIQueue[16]; ++ u8 lastRxUnicastPNVOQueue[16]; ++ bool bSetkeyOk; ++ bool bAuthenticateInProgress; ++ bool bAuthenticatorInUpdata; ++} RT_WAPI_STA_INFO, *PRT_WAPI_STA_INFO; ++ ++/* Added for HW wapi en/decryption */ ++typedef struct _RT_WAPI_CAM_ENTRY { ++ /* RT_LIST_ENTRY list; */ ++ u8 IsUsed; ++ u8 entry_idx;/* for cam entry */ ++ u8 keyidx; /* 0 or 1,new or old key */ ++ u8 PeerMacAddr[6]; ++ u8 type; /* should be 110,wapi */ ++} RT_WAPI_CAM_ENTRY, *PRT_WAPI_CAM_ENTRY; ++ ++typedef struct _RT_WAPI_T { ++ /* BKID */ ++ RT_WAPI_BKID wapiBKID[WAPI_MAX_BKID_NUM]; ++ struct list_head wapiBKIDIdleList; ++ struct list_head wapiBKIDStoreList; ++ /* Key for Tx Multicast/Broadcast */ ++ RT_WAPI_KEY wapiTxMsk; ++ ++ /* sec related */ ++ u8 lastTxMulticastPN[16]; ++ /* STA list */ ++ RT_WAPI_STA_INFO wapiSta[WAPI_MAX_STAINFO_NUM]; ++ struct list_head wapiSTAIdleList; ++ struct list_head wapiSTAUsedList; ++ /* */ ++ bool bWapiEnable; ++ ++ /* store WAPI IE */ ++ u8 wapiIE[256]; ++ u8 wapiIELength; ++ bool bWapiPSK; ++ /* last sequece number for wai packet */ ++ u16 wapiSeqnumAndFragNum; ++ int extra_prefix_len; ++ int extra_postfix_len; ++ ++ RT_WAPI_CAM_ENTRY wapiCamEntry[WAPI_CAM_ENTRY_NUM]; ++} RT_WAPI_T, *PRT_WAPI_T; ++ ++typedef struct _WLAN_HEADER_WAPI_EXTENSION { ++ u8 KeyIdx; ++ u8 Reserved; ++ u8 PN[16]; ++} WLAN_HEADER_WAPI_EXTENSION, *PWLAN_HEADER_WAPI_EXTENSION; ++ ++u32 WapiComparePN(u8 *PN1, u8 *PN2); ++ ++ ++void rtw_wapi_init(_adapter *padapter); ++ ++void rtw_wapi_free(_adapter *padapter); ++ ++void rtw_wapi_disable_tx(_adapter *padapter); ++ ++u8 rtw_wapi_is_wai_packet(_adapter *padapter, u8 *pkt_data); ++ ++void rtw_wapi_update_info(_adapter *padapter, union recv_frame *precv_frame); ++ ++u8 rtw_wapi_check_for_drop(_adapter *padapter, union recv_frame *precv_frame); ++ ++void rtw_build_probe_resp_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib); ++ ++void rtw_build_beacon_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib); ++ ++void rtw_build_assoc_req_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib); ++ ++void rtw_wapi_on_assoc_ok(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); ++ ++void rtw_wapi_return_one_sta_info(_adapter *padapter, u8 *MacAddr); ++ ++void rtw_wapi_return_all_sta_info(_adapter *padapter); ++ ++void rtw_wapi_clear_cam_entry(_adapter *padapter, u8 *pMacAddr); ++ ++void rtw_wapi_clear_all_cam_entry(_adapter *padapter); ++ ++void rtw_wapi_set_key(_adapter *padapter, RT_WAPI_KEY *pWapiKey, RT_WAPI_STA_INFO *pWapiSta, u8 bGroupKey, u8 bUseDefaultKey); ++ ++int rtw_wapi_create_event_send(_adapter *padapter, u8 EventId, u8 *MacAddr, u8 *Buff, u16 BufLen); ++ ++u32 rtw_sms4_encrypt(_adapter *padapter, u8 *pxmitframe); ++ ++u32 rtw_sms4_decrypt(_adapter *padapter, u8 *precvframe); ++ ++void rtw_wapi_get_iv(_adapter *padapter, u8 *pRA, u8 *IV); ++ ++u8 WapiIncreasePN(u8 *PN, u8 AddCount); ++ ++bool rtw_wapi_drop_for_key_absent(_adapter *padapter, u8 *pRA); ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_wifi_regd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_wifi_regd.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_wifi_regd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_wifi_regd.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,25 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2009-2010 Realtek Corporation. ++ * ++ *****************************************************************************/ ++ ++#ifndef __RTW_WIFI_REGD_H__ ++#define __RTW_WIFI_REGD_H__ ++ ++struct country_code_to_enum_rd { ++ u16 countrycode; ++ const char *iso_name; ++}; ++ ++enum country_code_type_t { ++ COUNTRY_CODE_USER = 0, ++ ++ /*add new channel plan above this line */ ++ COUNTRY_CODE_MAX ++}; ++ ++int rtw_regd_init(_adapter *padapter); ++void rtw_reg_notify_by_driver(_adapter *adapter); ++ ++#endif /* __RTW_WIFI_REGD_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_xmit.h +--- linux-4.14.18/3rdparty/rtl8723de/include/rtw_xmit.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_xmit.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,936 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _RTW_XMIT_H_ ++#define _RTW_XMIT_H_ ++ ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ #ifdef CONFIG_TX_AGGREGATION ++ #define MAX_XMITBUF_SZ (20480) /* 20k */ ++ /* #define SDIO_TX_AGG_MAX 5 */ ++ #else ++ #define MAX_XMITBUF_SZ (1664) ++ #define SDIO_TX_AGG_MAX 1 ++ #endif ++ ++ #if defined CONFIG_SDIO_HCI ++ #define NR_XMITBUFF (16) ++ #endif ++ #if defined(CONFIG_GSPI_HCI) ++ #define NR_XMITBUFF (128) ++ #endif ++ ++#elif defined (CONFIG_USB_HCI) ++ ++ #ifdef CONFIG_USB_TX_AGGREGATION ++ #if defined(CONFIG_PLATFORM_ARM_SUNxI) || defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) || defined(CONFIG_PLATFORM_ARM_SUN8I) || defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) ++ #define MAX_XMITBUF_SZ (12288) /* 12k 1536*8 */ ++ #elif defined (CONFIG_PLATFORM_MSTAR) ++ #define MAX_XMITBUF_SZ 7680 /* 7.5k */ ++ #else ++ #define MAX_XMITBUF_SZ (20480) /* 20k */ ++ #endif ++ #else ++ #define MAX_XMITBUF_SZ (2048) ++ #endif ++ ++ #ifdef CONFIG_SINGLE_XMIT_BUF ++ #define NR_XMITBUFF (1) ++ #else ++ #define NR_XMITBUFF (4) ++ #endif /* CONFIG_SINGLE_XMIT_BUF */ ++#elif defined (CONFIG_PCI_HCI) ++ #define MAX_XMITBUF_SZ (1664) ++ #define NR_XMITBUFF (128) ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ #define XMITBUF_ALIGN_SZ 4 ++#else ++ #ifdef CONFIG_PCI_HCI ++ #define XMITBUF_ALIGN_SZ 4 ++ #else ++ #ifdef USB_XMITBUF_ALIGN_SZ ++ #define XMITBUF_ALIGN_SZ (USB_XMITBUF_ALIGN_SZ) ++ #else ++ #define XMITBUF_ALIGN_SZ 512 ++ #endif ++ #endif ++#endif ++ ++/* xmit extension buff defination */ ++#define MAX_XMIT_EXTBUF_SZ (1536) ++ ++#ifdef CONFIG_SINGLE_XMIT_BUF ++ #define NR_XMIT_EXTBUFF (1) ++#else ++ #define NR_XMIT_EXTBUFF (32) ++#endif ++ ++#ifdef CONFIG_RTL8812A ++ #define MAX_CMDBUF_SZ (512*14) ++#elif defined(CONFIG_RTL8723D) && defined(CONFIG_LPS_POFF) ++ #define MAX_CMDBUF_SZ (128*70) /*(8960)*/ ++#else ++ #define MAX_CMDBUF_SZ (5120) /* (4096) */ ++#endif ++ ++#define MAX_NUMBLKS (1) ++ ++#define XMIT_VO_QUEUE (0) ++#define XMIT_VI_QUEUE (1) ++#define XMIT_BE_QUEUE (2) ++#define XMIT_BK_QUEUE (3) ++ ++#define VO_QUEUE_INX 0 ++#define VI_QUEUE_INX 1 ++#define BE_QUEUE_INX 2 ++#define BK_QUEUE_INX 3 ++#define BCN_QUEUE_INX 4 ++#define MGT_QUEUE_INX 5 ++#define HIGH_QUEUE_INX 6 ++#define TXCMD_QUEUE_INX 7 ++ ++#define HW_QUEUE_ENTRY 8 ++ ++#ifdef CONFIG_PCI_HCI ++ #ifdef CONFIG_TRX_BD_ARCH ++ #define TX_BD_NUM (128+1) /* +1 result from ring buffer */ ++ #else ++ /* #define TXDESC_NUM 64 */ ++ #define TXDESC_NUM 128 ++ #define TXBD_NUM TXDESC_NUM ++ #define TXDESC_NUM_BE_QUEUE 128 ++ #define TXBD_NUM_RSVD 2 ++ #endif ++#endif ++ ++#define WEP_IV(pattrib_iv, dot11txpn, keyidx)\ ++ do {\ ++ pattrib_iv[0] = dot11txpn._byte_.TSC0;\ ++ pattrib_iv[1] = dot11txpn._byte_.TSC1;\ ++ pattrib_iv[2] = dot11txpn._byte_.TSC2;\ ++ pattrib_iv[3] = ((keyidx & 0x3)<<6);\ ++ dot11txpn.val = (dot11txpn.val == 0xffffff) ? 0 : (dot11txpn.val+1);\ ++ } while (0) ++ ++ ++#define TKIP_IV(pattrib_iv, dot11txpn, keyidx)\ ++ do {\ ++ pattrib_iv[0] = dot11txpn._byte_.TSC1;\ ++ pattrib_iv[1] = (dot11txpn._byte_.TSC1 | 0x20) & 0x7f;\ ++ pattrib_iv[2] = dot11txpn._byte_.TSC0;\ ++ pattrib_iv[3] = BIT(5) | ((keyidx & 0x3)<<6);\ ++ pattrib_iv[4] = dot11txpn._byte_.TSC2;\ ++ pattrib_iv[5] = dot11txpn._byte_.TSC3;\ ++ pattrib_iv[6] = dot11txpn._byte_.TSC4;\ ++ pattrib_iv[7] = dot11txpn._byte_.TSC5;\ ++ dot11txpn.val = dot11txpn.val == 0xffffffffffffULL ? 0 : (dot11txpn.val+1);\ ++ } while (0) ++ ++#define AES_IV(pattrib_iv, dot11txpn, keyidx)\ ++ do {\ ++ pattrib_iv[0] = dot11txpn._byte_.TSC0;\ ++ pattrib_iv[1] = dot11txpn._byte_.TSC1;\ ++ pattrib_iv[2] = 0;\ ++ pattrib_iv[3] = BIT(5) | ((keyidx & 0x3)<<6);\ ++ pattrib_iv[4] = dot11txpn._byte_.TSC2;\ ++ pattrib_iv[5] = dot11txpn._byte_.TSC3;\ ++ pattrib_iv[6] = dot11txpn._byte_.TSC4;\ ++ pattrib_iv[7] = dot11txpn._byte_.TSC5;\ ++ dot11txpn.val = dot11txpn.val == 0xffffffffffffULL ? 0 : (dot11txpn.val+1);\ ++ } while (0) ++ ++ ++#define HWXMIT_ENTRY 4 ++ ++/* For Buffer Descriptor ring architecture */ ++#if defined(BUF_DESC_ARCH) || defined(CONFIG_TRX_BD_ARCH) ++ #if defined(CONFIG_RTL8192E) ++ #define TX_BUFFER_SEG_NUM 1 /* 0:2 seg, 1: 4 seg, 2: 8 seg. */ ++ #elif defined(CONFIG_RTL8814A) ++ #define TX_BUFFER_SEG_NUM 1 /* 0:2 seg, 1: 4 seg, 2: 8 seg. */ ++ #else ++ #define TX_BUFFER_SEG_NUM 1 /* 0:2 seg, 1: 4 seg, 2: 8 seg. */ ++ #endif ++#endif ++ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ||\ ++ defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8192E) ||\ ++ defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8703B) ||\ ++ defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8723D) ++ #define TXDESC_SIZE 40 ++#elif defined(CONFIG_RTL8822B) ++ #define TXDESC_SIZE 48 /* HALMAC_TX_DESC_SIZE_8822B */ ++#elif defined(CONFIG_RTL8821C) ++ #define TXDESC_SIZE 48 /* HALMAC_TX_DESC_SIZE_8821C */ ++#else ++ #define TXDESC_SIZE 32 /* old IC (ex: 8188E) */ ++#endif ++ ++#ifdef CONFIG_TX_EARLY_MODE ++ #define EARLY_MODE_INFO_SIZE 8 ++#endif ++ ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ #define TXDESC_OFFSET TXDESC_SIZE ++#endif ++ ++#ifdef CONFIG_USB_HCI ++ #ifdef USB_PACKET_OFFSET_SZ ++ #define PACKET_OFFSET_SZ (USB_PACKET_OFFSET_SZ) ++ #else ++ #define PACKET_OFFSET_SZ (8) ++ #endif ++ #define TXDESC_OFFSET (TXDESC_SIZE + PACKET_OFFSET_SZ) ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ #if defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_TRX_BD_ARCH) ++ /* this section is defined for buffer descriptor ring architecture */ ++ #define TX_WIFI_INFO_SIZE (TXDESC_SIZE) /* it may add 802.11 hdr or others... */ ++ /* tx desc and payload are in the same buf */ ++ #define TXDESC_OFFSET (TX_WIFI_INFO_SIZE) ++ #else ++ /* tx desc and payload are NOT in the same buf */ ++ #define TXDESC_OFFSET (0) ++ /* 8188ee/8723be/8812ae/8821ae has extra PCI DMA info in tx desc */ ++ #define TX_DESC_NEXT_DESC_OFFSET (TXDESC_SIZE + 8) ++ #endif ++#endif /* CONFIG_PCI_HCI */ ++ ++enum TXDESC_SC { ++ SC_DONT_CARE = 0x00, ++ SC_UPPER = 0x01, ++ SC_LOWER = 0x02, ++ SC_DUPLICATE = 0x03 ++}; ++ ++#ifdef CONFIG_PCI_HCI ++ #ifndef CONFIG_TRX_BD_ARCH /* CONFIG_TRX_BD_ARCH doesn't need this */ ++ #define TXDESC_64_BYTES ++ #endif ++#elif defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8723B) \ ++ || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8723D) ++ #define TXDESC_40_BYTES ++#endif ++ ++#ifdef CONFIG_TRX_BD_ARCH ++struct tx_buf_desc { ++#ifdef CONFIG_64BIT_DMA ++#define TX_BUFFER_SEG_SIZE 4 /* in unit of DWORD */ ++#else ++#define TX_BUFFER_SEG_SIZE 2 /* in unit of DWORD */ ++#endif ++ unsigned int dword[TX_BUFFER_SEG_SIZE * (2 << TX_BUFFER_SEG_NUM)]; ++} __packed; ++#elif (defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B)) && defined(CONFIG_PCI_HCI) /* 8192ee or 8814ae */ ++/* 8192EE_TODO */ ++struct tx_desc { ++ unsigned int txdw0; ++ unsigned int txdw1; ++ unsigned int txdw2; ++ unsigned int txdw3; ++ unsigned int txdw4; ++ unsigned int txdw5; ++ unsigned int txdw6; ++ unsigned int txdw7; ++}; ++#else ++struct tx_desc { ++ unsigned int txdw0; ++ unsigned int txdw1; ++ unsigned int txdw2; ++ unsigned int txdw3; ++ unsigned int txdw4; ++ unsigned int txdw5; ++ unsigned int txdw6; ++ unsigned int txdw7; ++ ++#if defined(TXDESC_40_BYTES) || defined(TXDESC_64_BYTES) ++ unsigned int txdw8; ++ unsigned int txdw9; ++#endif /* TXDESC_40_BYTES */ ++ ++#ifdef TXDESC_64_BYTES ++ unsigned int txdw10; ++ unsigned int txdw11; ++ ++ /* 2008/05/15 MH Because PCIE HW memory R/W 4K limit. And now, our descriptor */ ++ /* size is 40 bytes. If you use more than 102 descriptor( 103*40>4096), HW will execute */ ++ /* memoryR/W CRC error. And then all DMA fetch will fail. We must decrease descriptor */ ++ /* number or enlarge descriptor size as 64 bytes. */ ++ unsigned int txdw12; ++ unsigned int txdw13; ++ unsigned int txdw14; ++ unsigned int txdw15; ++#endif ++}; ++#endif ++ ++#ifndef CONFIG_TRX_BD_ARCH ++union txdesc { ++ struct tx_desc txdesc; ++ unsigned int value[TXDESC_SIZE >> 2]; ++}; ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++#define PCI_MAX_TX_QUEUE_COUNT 8 /* == HW_QUEUE_ENTRY */ ++ ++struct rtw_tx_ring { ++ unsigned char qid; ++#ifdef CONFIG_TRX_BD_ARCH ++ struct tx_buf_desc *buf_desc; ++#else ++ struct tx_desc *desc; ++#endif ++ dma_addr_t dma; ++ unsigned int idx; ++ unsigned int entries; ++ _queue queue; ++ u32 qlen; ++#ifdef CONFIG_TRX_BD_ARCH ++ u16 hw_rp_cache; ++#endif ++}; ++#endif ++ ++struct hw_xmit { ++ /* _lock xmit_lock; */ ++ /* _list pending; */ ++ _queue *sta_queue; ++ /* struct hw_txqueue *phwtxqueue; */ ++ /* sint txcmdcnt; */ ++ int accnt; ++}; ++ ++#if 0 ++struct pkt_attrib { ++ u8 type; ++ u8 subtype; ++ u8 bswenc; ++ u8 dhcp_pkt; ++ u16 ether_type; ++ int pktlen; /* the original 802.3 pkt raw_data len (not include ether_hdr data) */ ++ int pkt_hdrlen; /* the original 802.3 pkt header len */ ++ int hdrlen; /* the WLAN Header Len */ ++ int nr_frags; ++ int last_txcmdsz; ++ int encrypt; /* when 0 indicate no encrypt. when non-zero, indicate the encrypt algorith */ ++ u8 iv[8]; ++ int iv_len; ++ u8 icv[8]; ++ int icv_len; ++ int priority; ++ int ack_policy; ++ int mac_id; ++ int vcs_mode; /* virtual carrier sense method */ ++ ++ u8 dst[ETH_ALEN]; ++ u8 src[ETH_ALEN]; ++ u8 ta[ETH_ALEN]; ++ u8 ra[ETH_ALEN]; ++ ++ u8 key_idx; ++ ++ u8 qos_en; ++ u8 ht_en; ++ u8 raid;/* rate adpative id */ ++ u8 bwmode; ++ u8 ch_offset;/* PRIME_CHNL_OFFSET */ ++ u8 sgi;/* short GI */ ++ u8 ampdu_en;/* tx ampdu enable */ ++ u8 mdata;/* more data bit */ ++ u8 eosp; ++ ++ u8 triggered;/* for ap mode handling Power Saving sta */ ++ ++ u32 qsel; ++ u16 seqnum; ++ ++ struct sta_info *psta; ++#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX ++ u8 hw_tcp_csum; ++#endif ++}; ++#else ++/* reduce size */ ++struct pkt_attrib { ++ u8 type; ++ u8 subtype; ++ u8 bswenc; ++ u8 dhcp_pkt; ++ u16 ether_type; ++ u16 seqnum; ++ u8 hw_ssn_sel; /* for HW_SEQ0,1,2,3 */ ++ u16 pkt_hdrlen; /* the original 802.3 pkt header len */ ++ u16 hdrlen; /* the WLAN Header Len */ ++ u32 pktlen; /* the original 802.3 pkt raw_data len (not include ether_hdr data) */ ++ u32 last_txcmdsz; ++ u8 nr_frags; ++ u8 encrypt; /* when 0 indicate no encrypt. when non-zero, indicate the encrypt algorith */ ++#if defined(CONFIG_CONCURRENT_MODE) ++ u8 bmc_camid; ++#endif ++ u8 iv_len; ++ u8 icv_len; ++ u8 iv[18]; ++ u8 icv[16]; ++ u8 priority; ++ u8 ack_policy; ++ u8 mac_id; ++ u8 vcs_mode; /* virtual carrier sense method */ ++ u8 dst[ETH_ALEN]; ++ u8 src[ETH_ALEN]; ++ u8 ta[ETH_ALEN]; ++ u8 ra[ETH_ALEN]; ++ u8 key_idx; ++ u8 qos_en; ++ u8 ht_en; ++ u8 raid;/* rate adpative id */ ++ u8 bwmode; ++ u8 ch_offset;/* PRIME_CHNL_OFFSET */ ++ u8 sgi;/* short GI */ ++ u8 ampdu_en;/* tx ampdu enable */ ++ u8 ampdu_spacing; /* ampdu_min_spacing for peer sta's rx */ ++ u8 mdata;/* more data bit */ ++ u8 pctrl;/* per packet txdesc control enable */ ++ u8 triggered;/* for ap mode handling Power Saving sta */ ++ u8 qsel; ++ u8 order;/* order bit */ ++ u8 eosp; ++ u8 rate; ++ u8 intel_proxim; ++ u8 retry_ctrl; ++ u8 mbssid; ++ u8 ldpc; ++ u8 stbc; ++ struct sta_info *psta; ++#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX ++ u8 hw_tcp_csum; ++#endif ++ ++ u8 rtsen; ++ u8 cts2self; ++ union Keytype dot11tkiptxmickey; ++ /* union Keytype dot11tkiprxmickey; */ ++ union Keytype dot118021x_UncstKey; ++ ++#ifdef CONFIG_TDLS ++ u8 direct_link; ++ struct sta_info *ptdls_sta; ++#endif /* CONFIG_TDLS */ ++ u8 key_type; ++ ++ u8 icmp_pkt; ++ ++#ifdef CONFIG_BEAMFORMING ++ u16 txbf_p_aid;/*beamforming Partial_AID*/ ++ u16 txbf_g_id;/*beamforming Group ID*/ ++#endif ++ ++}; ++#endif ++ ++#define WLANHDR_OFFSET 64 ++ ++#define NULL_FRAMETAG (0x0) ++#define DATA_FRAMETAG 0x01 ++#define L2_FRAMETAG 0x02 ++#define MGNT_FRAMETAG 0x03 ++#define AMSDU_FRAMETAG 0x04 ++ ++#define EII_FRAMETAG 0x05 ++#define IEEE8023_FRAMETAG 0x06 ++ ++#define MP_FRAMETAG 0x07 ++ ++#define TXAGG_FRAMETAG 0x08 ++ ++enum { ++ XMITBUF_DATA = 0, ++ XMITBUF_MGNT = 1, ++ XMITBUF_CMD = 2, ++}; ++ ++bool rtw_xmit_ac_blocked(_adapter *adapter); ++ ++struct submit_ctx { ++ u32 submit_time; /* */ ++ u32 timeout_ms; /* <0: not synchronous, 0: wait forever, >0: up to ms waiting */ ++ int status; /* status for operation */ ++#ifdef PLATFORM_LINUX ++ struct completion done; ++#endif ++}; ++ ++enum { ++ RTW_SCTX_SUBMITTED = -1, ++ RTW_SCTX_DONE_SUCCESS = 0, ++ RTW_SCTX_DONE_UNKNOWN, ++ RTW_SCTX_DONE_TIMEOUT, ++ RTW_SCTX_DONE_BUF_ALLOC, ++ RTW_SCTX_DONE_BUF_FREE, ++ RTW_SCTX_DONE_WRITE_PORT_ERR, ++ RTW_SCTX_DONE_TX_DESC_NA, ++ RTW_SCTX_DONE_TX_DENY, ++ RTW_SCTX_DONE_CCX_PKT_FAIL, ++ RTW_SCTX_DONE_DRV_STOP, ++ RTW_SCTX_DONE_DEV_REMOVE, ++ RTW_SCTX_DONE_CMD_ERROR, ++ RTW_SCTX_DONE_CMD_DROP, ++ RTX_SCTX_CSTR_WAIT_RPT2, ++}; ++ ++ ++void rtw_sctx_init(struct submit_ctx *sctx, int timeout_ms); ++int rtw_sctx_wait(struct submit_ctx *sctx, const char *msg); ++void rtw_sctx_done_err(struct submit_ctx **sctx, int status); ++void rtw_sctx_done(struct submit_ctx **sctx); ++ ++struct xmit_buf { ++ _list list; ++ ++ _adapter *padapter; ++ ++ u8 *pallocated_buf; ++ ++ u8 *pbuf; ++ ++ void *priv_data; ++ ++ u16 buf_tag; /* 0: Normal xmitbuf, 1: extension xmitbuf, 2:cmd xmitbuf */ ++ u16 flags; ++ u32 alloc_sz; ++ ++ u32 len; ++ ++ struct submit_ctx *sctx; ++ ++#ifdef CONFIG_USB_HCI ++ ++ /* u32 sz[8]; */ ++ u32 ff_hwaddr; ++#ifdef RTW_HALMAC ++ u8 bulkout_id; /* for halmac */ ++#endif /* RTW_HALMAC */ ++ ++#if defined(PLATFORM_OS_XP) || defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) ++ PURB pxmit_urb[8]; ++ dma_addr_t dma_transfer_addr; /* (in) dma addr for transfer_buffer */ ++#endif ++ ++#ifdef PLATFORM_OS_XP ++ PIRP pxmit_irp[8]; ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ USB_TRANSFER usb_transfer_write_port; ++#endif ++ ++ u8 bpending[8]; ++ ++ sint last[8]; ++ ++#endif ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ u8 *phead; ++ u8 *pdata; ++ u8 *ptail; ++ u8 *pend; ++ u32 ff_hwaddr; ++ u8 pg_num; ++ u8 agg_num; ++#ifdef PLATFORM_OS_XP ++ PMDL pxmitbuf_mdl; ++ PIRP pxmitbuf_irp; ++ PSDBUS_REQUEST_PACKET pxmitbuf_sdrp; ++#endif ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++#ifdef CONFIG_TRX_BD_ARCH ++ /*struct tx_buf_desc *buf_desc;*/ ++#else ++ struct tx_desc *desc; ++#endif ++#endif ++ ++#if defined(DBG_XMIT_BUF) || defined(DBG_XMIT_BUF_EXT) ++ u8 no; ++#endif ++ ++}; ++ ++ ++struct xmit_frame { ++ _list list; ++ ++ struct pkt_attrib attrib; ++ ++ _pkt *pkt; ++ ++ int frame_tag; ++ ++ _adapter *padapter; ++ ++ u8 *buf_addr; ++ ++ struct xmit_buf *pxmitbuf; ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ u8 pg_num; ++ u8 agg_num; ++#endif ++ ++#ifdef CONFIG_USB_HCI ++#ifdef CONFIG_USB_TX_AGGREGATION ++ u8 agg_num; ++#endif ++ s8 pkt_offset; ++#endif ++ ++#ifdef CONFIG_XMIT_ACK ++ u8 ack_report; ++#endif ++ ++ u8 *alloc_addr; /* the actual address this xmitframe allocated */ ++ u8 ext_tag; /* 0:data, 1:mgmt */ ++ ++}; ++ ++struct tx_servq { ++ _list tx_pending; ++ _queue sta_pending; ++ int qcnt; ++}; ++ ++ ++struct sta_xmit_priv { ++ _lock lock; ++ sint option; ++ sint apsd_setting; /* When bit mask is on, the associated edca queue supports APSD. */ ++ ++ ++ /* struct tx_servq blk_q[MAX_NUMBLKS]; */ ++ struct tx_servq be_q; /* priority == 0,3 */ ++ struct tx_servq bk_q; /* priority == 1,2 */ ++ struct tx_servq vi_q; /* priority == 4,5 */ ++ struct tx_servq vo_q; /* priority == 6,7 */ ++ _list legacy_dz; ++ _list apsd; ++ ++ u16 txseq_tid[16]; ++ ++ /* uint sta_tx_bytes; */ ++ /* u64 sta_tx_pkts; */ ++ /* uint sta_tx_fail; */ ++ ++ ++}; ++ ++ ++struct hw_txqueue { ++ volatile sint head; ++ volatile sint tail; ++ volatile sint free_sz; /* in units of 64 bytes */ ++ volatile sint free_cmdsz; ++ volatile sint txsz[8]; ++ uint ff_hwaddr; ++ uint cmd_hwaddr; ++ sint ac_tag; ++}; ++ ++struct agg_pkt_info { ++ u16 offset; ++ u16 pkt_len; ++}; ++ ++enum cmdbuf_type { ++ CMDBUF_BEACON = 0x00, ++ CMDBUF_RSVD, ++ CMDBUF_MAX ++}; ++ ++u8 rtw_get_hwseq_no(_adapter *padapter); ++ ++struct xmit_priv { ++ ++ _lock lock; ++ ++ _sema xmit_sema; ++ /*_sema terminate_xmitthread_sema;*/ ++ _completion xmitthread_comp; ++ ++ /* _queue blk_strms[MAX_NUMBLKS]; */ ++ _queue be_pending; ++ _queue bk_pending; ++ _queue vi_pending; ++ _queue vo_pending; ++ _queue bm_pending; ++ ++ /* _queue legacy_dz_queue; */ ++ /* _queue apsd_queue; */ ++ ++ u8 *pallocated_frame_buf; ++ u8 *pxmit_frame_buf; ++ uint free_xmitframe_cnt; ++ _queue free_xmit_queue; ++ ++ /* uint mapping_addr; */ ++ /* uint pkt_sz; */ ++ ++ u8 *xframe_ext_alloc_addr; ++ u8 *xframe_ext; ++ uint free_xframe_ext_cnt; ++ _queue free_xframe_ext_queue; ++ ++ /* struct hw_txqueue be_txqueue; */ ++ /* struct hw_txqueue bk_txqueue; */ ++ /* struct hw_txqueue vi_txqueue; */ ++ /* struct hw_txqueue vo_txqueue; */ ++ /* struct hw_txqueue bmc_txqueue; */ ++ ++ uint frag_len; ++ ++ _adapter *adapter; ++ ++ u8 vcs_setting; ++ u8 vcs; ++ u8 vcs_type; ++ /* u16 rts_thresh; */ ++ ++ u64 tx_bytes; ++ u64 tx_pkts; ++ u64 tx_drop; ++ u64 last_tx_pkts; ++ ++ struct hw_xmit *hwxmits; ++ u8 hwxmit_entry; ++ ++ u8 wmm_para_seq[4];/* sequence for wmm ac parameter strength from large to small. it's value is 0->vo, 1->vi, 2->be, 3->bk. */ ++ ++#ifdef CONFIG_USB_HCI ++ _sema tx_retevt;/* all tx return event; */ ++ u8 txirp_cnt; ++ ++#ifdef PLATFORM_OS_CE ++ USB_TRANSFER usb_transfer_write_port; ++ /* USB_TRANSFER usb_transfer_write_mem; */ ++#endif ++#ifdef PLATFORM_LINUX ++ struct tasklet_struct xmit_tasklet; ++#endif ++#ifdef PLATFORM_FREEBSD ++ struct task xmit_tasklet; ++#endif ++ /* per AC pending irp */ ++ int beq_cnt; ++ int bkq_cnt; ++ int viq_cnt; ++ int voq_cnt; ++ ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ /* Tx */ ++ struct rtw_tx_ring tx_ring[PCI_MAX_TX_QUEUE_COUNT]; ++ int txringcount[PCI_MAX_TX_QUEUE_COUNT]; ++ u8 beaconDMAing; /* flag of indicating beacon is transmiting to HW by DMA */ ++#ifdef PLATFORM_LINUX ++ struct tasklet_struct xmit_tasklet; ++#endif ++#endif ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++#ifdef CONFIG_SDIO_TX_TASKLET ++#ifdef PLATFORM_LINUX ++ struct tasklet_struct xmit_tasklet; ++#endif /* PLATFORM_LINUX */ ++#else ++ _thread_hdl_ SdioXmitThread; ++ _sema SdioXmitSema; ++ /*_sema SdioXmitTerminateSema;*/ ++ _completion sdio_xmit_thread_comp; ++#endif /* CONFIG_SDIO_TX_TASKLET */ ++#endif /* CONFIG_SDIO_HCI */ ++ ++ _queue free_xmitbuf_queue; ++ _queue pending_xmitbuf_queue; ++ u8 *pallocated_xmitbuf; ++ u8 *pxmitbuf; ++ uint free_xmitbuf_cnt; ++ ++ _queue free_xmit_extbuf_queue; ++ u8 *pallocated_xmit_extbuf; ++ u8 *pxmit_extbuf; ++ uint free_xmit_extbuf_cnt; ++ ++ struct xmit_buf pcmd_xmitbuf[CMDBUF_MAX]; ++ u8 hw_ssn_seq_no;/* mapping to REG_HW_SEQ 0,1,2,3 */ ++ u16 nqos_ssn; ++#ifdef CONFIG_TX_EARLY_MODE ++ ++#ifdef CONFIG_SDIO_HCI ++#define MAX_AGG_PKT_NUM 20 ++#else ++#define MAX_AGG_PKT_NUM 256 /* Max tx ampdu coounts */ ++#endif ++ ++ struct agg_pkt_info agg_pkt[MAX_AGG_PKT_NUM]; ++#endif ++ ++#ifdef CONFIG_XMIT_ACK ++ int ack_tx; ++ _mutex ack_tx_mutex; ++ struct submit_ctx ack_tx_ops; ++ u8 seq_no; ++#endif ++ _lock lock_sctx; ++ ++ u8 stop_req; ++}; ++ ++extern struct xmit_frame *__rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, ++ enum cmdbuf_type buf_type); ++#define rtw_alloc_cmdxmitframe(p) __rtw_alloc_cmdxmitframe(p, CMDBUF_RSVD) ++#if defined(CONFIG_RTL8192E) && defined(CONFIG_PCI_HCI) ++extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8192ee(struct xmit_priv *pxmitpriv, ++ enum cmdbuf_type buf_type); ++#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8192ee(p, CMDBUF_BEACON) ++#elif defined(CONFIG_RTL8822B) && defined(CONFIG_PCI_HCI) ++extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8822be(struct xmit_priv *pxmitpriv, ++ enum cmdbuf_type buf_type); ++#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8822be(p, CMDBUF_BEACON) ++#elif defined(CONFIG_RTL8821C) && defined(CONFIG_PCI_HCI) ++extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8821ce(struct xmit_priv *pxmitpriv, ++ enum cmdbuf_type buf_type); ++#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8821ce(p, CMDBUF_BEACON) ++#else ++#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe(p, CMDBUF_BEACON) ++#endif ++ ++extern struct xmit_buf *rtw_alloc_xmitbuf_ext(struct xmit_priv *pxmitpriv); ++extern s32 rtw_free_xmitbuf_ext(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++ ++extern struct xmit_buf *rtw_alloc_xmitbuf(struct xmit_priv *pxmitpriv); ++extern s32 rtw_free_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++ ++void rtw_count_tx_stats(_adapter *padapter, struct xmit_frame *pxmitframe, int sz); ++extern void rtw_update_protection(_adapter *padapter, u8 *ie, uint ie_len); ++static s32 update_attrib_sec_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta); ++static void update_attrib_phy_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta); ++extern s32 rtw_make_wlanhdr(_adapter *padapter, u8 *hdr, struct pkt_attrib *pattrib); ++extern s32 rtw_put_snap(u8 *data, u16 h_proto); ++ ++extern struct xmit_frame *rtw_alloc_xmitframe(struct xmit_priv *pxmitpriv); ++struct xmit_frame *rtw_alloc_xmitframe_ext(struct xmit_priv *pxmitpriv); ++struct xmit_frame *rtw_alloc_xmitframe_once(struct xmit_priv *pxmitpriv); ++extern s32 rtw_free_xmitframe(struct xmit_priv *pxmitpriv, struct xmit_frame *pxmitframe); ++extern void rtw_free_xmitframe_queue(struct xmit_priv *pxmitpriv, _queue *pframequeue); ++struct tx_servq *rtw_get_sta_pending(_adapter *padapter, struct sta_info *psta, sint up, u8 *ac); ++extern s32 rtw_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++extern struct xmit_frame *rtw_dequeue_xframe(struct xmit_priv *pxmitpriv, struct hw_xmit *phwxmit_i, sint entry); ++ ++extern s32 rtw_xmit_classifier(_adapter *padapter, struct xmit_frame *pxmitframe); ++extern u32 rtw_calculate_wlan_pkt_size_by_attribue(struct pkt_attrib *pattrib); ++#define rtw_wlan_pkt_size(f) rtw_calculate_wlan_pkt_size_by_attribue(&f->attrib) ++extern s32 rtw_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe); ++#ifdef CONFIG_IEEE80211W ++extern s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe); ++#endif /* CONFIG_IEEE80211W */ ++#ifdef CONFIG_TDLS ++extern struct tdls_txmgmt *ptxmgmt; ++s32 rtw_xmit_tdls_coalesce(_adapter *padapter, struct xmit_frame *pxmitframe, struct tdls_txmgmt *ptxmgmt); ++s32 update_tdls_attrib(_adapter *padapter, struct pkt_attrib *pattrib); ++#endif ++s32 _rtw_init_hw_txqueue(struct hw_txqueue *phw_txqueue, u8 ac_tag); ++void _rtw_init_sta_xmit_priv(struct sta_xmit_priv *psta_xmitpriv); ++ ++ ++s32 rtw_txframes_pending(_adapter *padapter); ++s32 rtw_txframes_sta_ac_pending(_adapter *padapter, struct pkt_attrib *pattrib); ++void rtw_init_hwxmits(struct hw_xmit *phwxmit, sint entry); ++ ++ ++s32 _rtw_init_xmit_priv(struct xmit_priv *pxmitpriv, _adapter *padapter); ++void _rtw_free_xmit_priv(struct xmit_priv *pxmitpriv); ++ ++ ++void rtw_alloc_hwxmits(_adapter *padapter); ++void rtw_free_hwxmits(_adapter *padapter); ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) ++s32 rtw_monitor_xmit_entry(struct sk_buff *skb, struct net_device *ndev); ++#endif ++s32 rtw_xmit(_adapter *padapter, _pkt **pkt); ++bool xmitframe_hiq_filter(struct xmit_frame *xmitframe); ++#if defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) ++sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe); ++void stop_sta_xmit(_adapter *padapter, struct sta_info *psta); ++void wakeup_sta_to_xmit(_adapter *padapter, struct sta_info *psta); ++void xmit_delivery_enabled_frames(_adapter *padapter, struct sta_info *psta); ++#endif ++ ++u8 rtw_get_tx_bw_mode(_adapter *adapter, struct sta_info *sta); ++ ++void rtw_get_adapter_tx_rate_bmp_by_bw(_adapter *adapter, u8 bw, u16 *r_bmp_cck_ofdm, u32 *r_bmp_ht, u32 *r_bmp_vht); ++void rtw_update_tx_rate_bmp(struct dvobj_priv *dvobj); ++u16 rtw_get_tx_rate_bmp_cck_ofdm(struct dvobj_priv *dvobj); ++u32 rtw_get_tx_rate_bmp_ht_by_bw(struct dvobj_priv *dvobj, u8 bw); ++u32 rtw_get_tx_rate_bmp_vht_by_bw(struct dvobj_priv *dvobj, u8 bw); ++u8 rtw_get_tx_bw_bmp_of_ht_rate(struct dvobj_priv *dvobj, u8 rate, u8 max_bw); ++u8 rtw_get_tx_bw_bmp_of_vht_rate(struct dvobj_priv *dvobj, u8 rate, u8 max_bw); ++ ++ ++void rtw_get_adapter_tx_rate_bmp_by_bw(_adapter *adapter, u8 bw, u16 *r_bmp_cck_ofdm, u32 *r_bmp_ht, u32 *r_bmp_vht); ++void rtw_update_tx_rate_bmp(struct dvobj_priv *dvobj); ++u16 rtw_get_tx_rate_bmp_cck_ofdm(struct dvobj_priv *dvobj); ++u32 rtw_get_tx_rate_bmp_ht_by_bw(struct dvobj_priv *dvobj, u8 bw); ++u32 rtw_get_tx_rate_bmp_vht_by_bw(struct dvobj_priv *dvobj, u8 bw); ++ ++u8 query_ra_short_GI(struct sta_info *psta, u8 bw); ++ ++u8 qos_acm(u8 acm_mask, u8 priority); ++ ++#ifdef CONFIG_XMIT_THREAD_MODE ++void enqueue_pending_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++void enqueue_pending_xmitbuf_to_head(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++struct xmit_buf *dequeue_pending_xmitbuf(struct xmit_priv *pxmitpriv); ++struct xmit_buf *select_and_dequeue_pending_xmitbuf(_adapter *padapter); ++sint check_pending_xmitbuf(struct xmit_priv *pxmitpriv); ++thread_return rtw_xmit_thread(thread_context context); ++#endif ++ ++static void do_queue_select(_adapter *padapter, struct pkt_attrib *pattrib); ++u32 rtw_get_ff_hwaddr(struct xmit_frame *pxmitframe); ++ ++#ifdef CONFIG_XMIT_ACK ++int rtw_ack_tx_wait(struct xmit_priv *pxmitpriv, u32 timeout_ms); ++void rtw_ack_tx_done(struct xmit_priv *pxmitpriv, int status); ++#endif /* CONFIG_XMIT_ACK */ ++ ++ ++/* include after declaring struct xmit_buf, in order to avoid warning */ ++#include ++ ++#endif /* _RTL871X_XMIT_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sdio_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/sdio_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_hal.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,54 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __SDIO_HAL_H__ ++#define __SDIO_HAL_H__ ++ ++void sd_int_dpc(PADAPTER padapter); ++u8 rtw_set_hal_ops(_adapter *padapter); ++ ++#ifdef CONFIG_RTL8188E ++void rtl8188es_set_hal_ops(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_RTL8723B ++void rtl8723bs_set_hal_ops(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_RTL8821A ++void rtl8821as_set_hal_ops(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_RTL8192E ++void rtl8192es_set_hal_ops(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_RTL8703B ++void rtl8703bs_set_hal_ops(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_RTL8723D ++void rtl8723ds_set_hal_ops(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_RTL8188F ++void rtl8188fs_set_hal_ops(PADAPTER padapter); ++#endif ++ ++#endif /* __SDIO_HAL_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops_ce.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops_ce.h +--- linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops_ce.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops_ce.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,54 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _SDIO_OPS_WINCE_H_ ++#define _SDIO_OPS_WINCE_H_ ++ ++#include ++#include ++#include ++#include ++ ++ ++#ifdef PLATFORM_OS_CE ++ ++ ++extern u8 sdbus_cmd52r_ce(struct intf_priv *pintfpriv, u32 addr); ++ ++ ++extern void sdbus_cmd52w_ce(struct intf_priv *pintfpriv, u32 addr, u8 val8); ++ ++ ++uint sdbus_read_blocks_to_membuf_ce(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); ++ ++extern uint sdbus_read_bytes_to_membuf_ce(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); ++ ++ ++extern uint sdbus_write_blocks_from_membuf_ce(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf, u8 async); ++ ++extern uint sdbus_write_bytes_from_membuf_ce(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); ++extern u8 sdbus_func1cmd52r_ce(struct intf_priv *pintfpriv, u32 addr); ++extern void sdbus_func1cmd52w_ce(struct intf_priv *pintfpriv, u32 addr, u8 val8); ++extern uint sdbus_read_reg(struct intf_priv *pintfpriv, u32 addr, u32 cnt, void *pdata); ++extern uint sdbus_write_reg(struct intf_priv *pintfpriv, u32 addr, u32 cnt, void *pdata); ++extern void sdio_read_int(_adapter *padapter, u32 addr, u8 sz, void *pdata); ++ ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops.h +--- linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,161 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __SDIO_OPS_H__ ++#define __SDIO_OPS_H__ ++ ++ ++/* Follow mac team suggestion, default I/O fail return value is 0xFF */ ++#define SDIO_ERR_VAL8 0xFF ++#define SDIO_ERR_VAL16 0xFFFF ++#define SDIO_ERR_VAL32 0xFFFFFFFF ++ ++#ifdef PLATFORM_LINUX ++#include ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ ++#ifdef PLATFORM_OS_XP ++#include ++struct async_context { ++ PMDL pmdl; ++ PSDBUS_REQUEST_PACKET sdrp; ++ unsigned char *r_buf; ++ unsigned char *padapter; ++}; ++#endif ++ ++#ifdef PLATFORM_OS_CE ++#include ++#endif ++ ++#endif /* PLATFORM_WINDOWS */ ++ ++ ++extern void sdio_set_intf_ops(_adapter *padapter, struct _io_ops *pops); ++ ++#if 0 ++extern void sdio_func1cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem); ++extern void sdio_func1cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem); ++#endif ++extern u8 SdioLocalCmd52Read1Byte(PADAPTER padapter, u32 addr); ++extern void SdioLocalCmd52Write1Byte(PADAPTER padapter, u32 addr, u8 v); ++extern s32 _sdio_local_read(PADAPTER padapter, u32 addr, u32 cnt, u8 *pbuf); ++extern s32 sdio_local_read(PADAPTER padapter, u32 addr, u32 cnt, u8 *pbuf); ++extern s32 _sdio_local_write(PADAPTER padapter, u32 addr, u32 cnt, u8 *pbuf); ++extern s32 sdio_local_write(PADAPTER padapter, u32 addr, u32 cnt, u8 *pbuf); ++ ++u32 _sdio_read32(PADAPTER padapter, u32 addr); ++s32 _sdio_write32(PADAPTER padapter, u32 addr, u32 val); ++ ++extern void sd_int_hdl(PADAPTER padapter); ++extern u8 CheckIPSStatus(PADAPTER padapter); ++ ++#ifdef CONFIG_RTL8188E ++extern void InitInterrupt8188ESdio(PADAPTER padapter); ++extern void EnableInterrupt8188ESdio(PADAPTER padapter); ++extern void DisableInterrupt8188ESdio(PADAPTER padapter); ++extern void UpdateInterruptMask8188ESdio(PADAPTER padapter, u32 AddMSR, u32 RemoveMSR); ++extern u8 HalQueryTxBufferStatus8189ESdio(PADAPTER padapter); ++extern u8 HalQueryTxOQTBufferStatus8189ESdio(PADAPTER padapter); ++extern void ClearInterrupt8188ESdio(PADAPTER padapter); ++#endif /* CONFIG_RTL8188E */ ++ ++#ifdef CONFIG_RTL8821A ++extern void InitInterrupt8821AS(PADAPTER padapter); ++extern void EnableInterrupt8821AS(PADAPTER padapter); ++extern void DisableInterrupt8821AS(PADAPTER padapter); ++extern u8 HalQueryTxBufferStatus8821AS(PADAPTER padapter); ++extern u8 HalQueryTxOQTBufferStatus8821ASdio(PADAPTER padapter); ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++void ClearInterrupt8821AS(PADAPTER padapter); ++#endif /* defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) */ ++#endif /* CONFIG_RTL8821A */ ++ ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++#ifdef CONFIG_RTL8821C ++u8 rtw_hal_enable_cpwm2(_adapter *adapter); ++#endif ++extern u8 RecvOnePkt(PADAPTER padapter, u32 size); ++#endif /* CONFIG_WOWLAN */ ++#ifdef CONFIG_RTL8723B ++extern void InitInterrupt8723BSdio(PADAPTER padapter); ++extern void InitSysInterrupt8723BSdio(PADAPTER padapter); ++extern void EnableInterrupt8723BSdio(PADAPTER padapter); ++extern void DisableInterrupt8723BSdio(PADAPTER padapter); ++extern u8 HalQueryTxBufferStatus8723BSdio(PADAPTER padapter); ++extern u8 HalQueryTxOQTBufferStatus8723BSdio(PADAPTER padapter); ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++extern void DisableInterruptButCpwm28723BSdio(PADAPTER padapter); ++extern void ClearInterrupt8723BSdio(PADAPTER padapter); ++#endif /* CONFIG_WOWLAN */ ++#endif ++ ++ ++#ifdef CONFIG_RTL8192E ++extern void InitInterrupt8192ESdio(PADAPTER padapter); ++extern void EnableInterrupt8192ESdio(PADAPTER padapter); ++extern void DisableInterrupt8192ESdio(PADAPTER padapter); ++extern void UpdateInterruptMask8192ESdio(PADAPTER padapter, u32 AddMSR, u32 RemoveMSR); ++extern u8 HalQueryTxBufferStatus8192ESdio(PADAPTER padapter); ++extern u8 HalQueryTxOQTBufferStatus8192ESdio(PADAPTER padapter); ++extern void ClearInterrupt8192ESdio(PADAPTER padapter); ++#endif /* CONFIG_RTL8192E */ ++ ++#ifdef CONFIG_RTL8703B ++extern void InitInterrupt8703BSdio(PADAPTER padapter); ++extern void InitSysInterrupt8703BSdio(PADAPTER padapter); ++extern void EnableInterrupt8703BSdio(PADAPTER padapter); ++extern void DisableInterrupt8703BSdio(PADAPTER padapter); ++extern u8 HalQueryTxBufferStatus8703BSdio(PADAPTER padapter); ++extern u8 HalQueryTxOQTBufferStatus8703BSdio(PADAPTER padapter); ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++extern void DisableInterruptButCpwm28703BSdio(PADAPTER padapter); ++extern void ClearInterrupt8703BSdio(PADAPTER padapter); ++#endif /* CONFIG_WOWLAN */ ++#endif ++ ++#ifdef CONFIG_RTL8723D ++extern void InitInterrupt8723DSdio(PADAPTER padapter); ++extern void InitSysInterrupt8723DSdio(PADAPTER padapter); ++extern void EnableInterrupt8723DSdio(PADAPTER padapter); ++extern void DisableInterrupt8723DSdio(PADAPTER padapter); ++extern u8 HalQueryTxBufferStatus8723DSdio(PADAPTER padapter); ++extern u8 HalQueryTxOQTBufferStatus8723DSdio(PADAPTER padapter); ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++extern void DisableInterruptButCpwm28723dSdio(PADAPTER padapter); ++#endif /* CONFIG_WOWLAN */ ++extern void ClearInterrupt8723DSdio(PADAPTER padapter); ++#endif ++ ++#ifdef CONFIG_RTL8188F ++extern void InitInterrupt8188FSdio(PADAPTER padapter); ++extern void InitSysInterrupt8188FSdio(PADAPTER padapter); ++extern void EnableInterrupt8188FSdio(PADAPTER padapter); ++extern void DisableInterrupt8188FSdio(PADAPTER padapter); ++extern u8 HalQueryTxBufferStatus8188FSdio(PADAPTER padapter); ++extern u8 HalQueryTxOQTBufferStatus8188FSdio(PADAPTER padapter); ++#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++extern void DisableInterruptButCpwm28188FSdio(PADAPTER padapter); ++extern void ClearInterrupt8188FSdio(PADAPTER padapter); ++#endif /* defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) */ ++#endif ++ ++#endif /* !__SDIO_OPS_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops_linux.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops_linux.h +--- linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops_linux.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops_linux.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,53 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __SDIO_OPS_LINUX_H__ ++#define __SDIO_OPS_LINUX_H__ ++ ++#ifndef RTW_HALMAC ++u8 sd_f0_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err); ++void sd_f0_write8(struct intf_hdl *pintfhdl, u32 addr, u8 v, s32 *err); ++ ++s32 _sd_cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); ++s32 _sd_cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); ++s32 sd_cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); ++s32 sd_cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); ++ ++u8 _sd_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err); ++u8 sd_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err); ++u16 sd_read16(struct intf_hdl *pintfhdl, u32 addr, s32 *err); ++u32 _sd_read32(struct intf_hdl *pintfhdl, u32 addr, s32 *err); ++u32 sd_read32(struct intf_hdl *pintfhdl, u32 addr, s32 *err); ++void sd_write8(struct intf_hdl *pintfhdl, u32 addr, u8 v, s32 *err); ++void sd_write16(struct intf_hdl *pintfhdl, u32 addr, u16 v, s32 *err); ++void _sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err); ++void sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err); ++#endif /* RTW_HALMAC */ ++ ++s32 _sd_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); ++s32 sd_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); ++s32 _sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); ++s32 sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); ++ ++void rtw_sdio_set_irq_thd(struct dvobj_priv *dvobj, _thread_hdl_ thd_hdl); ++int __must_check rtw_sdio_raw_read(struct dvobj_priv *d, int addr, ++ void *buf, size_t len, bool fixed); ++int __must_check rtw_sdio_raw_write(struct dvobj_priv *d, int addr, ++ void *buf, size_t len, bool fixed); ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops_xp.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops_xp.h +--- linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops_xp.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops_xp.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,54 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _SDIO_OPS_XP_H_ ++#define _SDIO_OPS_XP_H_ ++ ++#include ++#include ++#include ++#include ++ ++ ++#ifdef PLATFORM_OS_XP ++ ++ ++extern u8 sdbus_cmd52r_xp(struct intf_priv *pintfpriv, u32 addr); ++ ++ ++extern void sdbus_cmd52w_xp(struct intf_priv *pintfpriv, u32 addr, u8 val8); ++ ++ ++uint sdbus_read_blocks_to_membuf_xp(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); ++ ++extern uint sdbus_read_bytes_to_membuf_xp(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); ++ ++ ++extern uint sdbus_write_blocks_from_membuf_xp(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf, u8 async); ++ ++extern uint sdbus_write_bytes_from_membuf_xp(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); ++extern u8 sdbus_func1cmd52r_xp(struct intf_priv *pintfpriv, u32 addr); ++extern void sdbus_func1cmd52w_xp(struct intf_priv *pintfpriv, u32 addr, u8 val8); ++extern uint sdbus_read_reg(struct intf_priv *pintfpriv, u32 addr, u32 cnt, void *pdata); ++extern uint sdbus_write_reg(struct intf_priv *pintfpriv, u32 addr, u32 cnt, void *pdata); ++extern void sdio_read_int(_adapter *padapter, u32 addr, u8 sz, void *pdata); ++ ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sdio_osintf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_osintf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/sdio_osintf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_osintf.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,30 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __SDIO_OSINTF_H__ ++#define __SDIO_OSINTF_H__ ++ ++ ++#ifdef PLATFORM_OS_CE ++extern NDIS_STATUS ce_sd_get_dev_hdl(PADAPTER padapter); ++SD_API_STATUS ce_sd_int_callback(SD_DEVICE_HANDLE hDevice, PADAPTER padapter); ++extern void sd_setup_irs(PADAPTER padapter); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sta_info.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sta_info.h +--- linux-4.14.18/3rdparty/rtl8723de/include/sta_info.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sta_info.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,628 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __STA_INFO_H_ ++#define __STA_INFO_H_ ++ ++ ++#define IBSS_START_MAC_ID 2 ++#define NUM_STA MACID_NUM_SW_LIMIT ++ ++#ifndef CONFIG_RTW_MACADDR_ACL ++ #define CONFIG_RTW_MACADDR_ACL 1 ++#endif ++#define NUM_ACL 16 ++#define RTW_ACL_MODE_DISABLED 0 ++#define RTW_ACL_MODE_ACCEPT_UNLESS_LISTED 1 ++#define RTW_ACL_MODE_DENY_UNLESS_LISTED 2 ++#define RTW_ACL_MODE_MAX 3 ++ ++#if CONFIG_RTW_MACADDR_ACL ++extern const char *const _acl_mode_str[]; ++#define acl_mode_str(mode) (((mode) >= RTW_ACL_MODE_MAX) ? _acl_mode_str[RTW_ACL_MODE_DISABLED] : _acl_mode_str[(mode)]) ++#endif ++ ++#ifdef CONFIG_TDLS ++#define MAX_ALLOWED_TDLS_STA_NUM 4 ++#endif ++ ++enum sta_info_update_type { ++ STA_INFO_UPDATE_NONE = 0, ++ STA_INFO_UPDATE_BW = BIT(0), ++ STA_INFO_UPDATE_RATE = BIT(1), ++ STA_INFO_UPDATE_PROTECTION_MODE = BIT(2), ++ STA_INFO_UPDATE_CAP = BIT(3), ++ STA_INFO_UPDATE_HT_CAP = BIT(4), ++ STA_INFO_UPDATE_VHT_CAP = BIT(5), ++ STA_INFO_UPDATE_ALL = STA_INFO_UPDATE_BW ++ | STA_INFO_UPDATE_RATE ++ | STA_INFO_UPDATE_PROTECTION_MODE ++ | STA_INFO_UPDATE_CAP ++ | STA_INFO_UPDATE_HT_CAP ++ | STA_INFO_UPDATE_VHT_CAP, ++ STA_INFO_UPDATE_MAX ++}; ++ ++struct rtw_wlan_acl_node { ++ _list list; ++ u8 addr[ETH_ALEN]; ++ u8 valid; ++}; ++ ++struct wlan_acl_pool { ++ int mode; ++ int num; ++ struct rtw_wlan_acl_node aclnode[NUM_ACL]; ++ _queue acl_node_q; ++}; ++ ++typedef struct _RSSI_STA { ++ s32 UndecoratedSmoothedPWDB; ++ s32 UndecoratedSmoothedCCK; ++ s32 UndecoratedSmoothedOFDM; ++ u8 OFDM_pkt; ++ u8 CCK_pkt; ++ u16 CCK_sum_power; ++ u8 bsend_rssi; ++ u64 PacketMap; ++ u8 ValidBit; ++} RSSI_STA, *PRSSI_STA; ++ ++struct stainfo_stats { ++ ++ u64 rx_mgnt_pkts; ++ u64 rx_beacon_pkts; ++ u64 rx_probereq_pkts; ++ u64 rx_probersp_pkts; ++ u64 rx_probersp_bm_pkts; ++ u64 rx_probersp_uo_pkts; ++ u64 rx_ctrl_pkts; ++ u64 rx_data_pkts; ++ u64 rx_data_qos_pkts[TID_NUM]; ++ u64 last_rx_mgnt_pkts; ++ u64 last_rx_beacon_pkts; ++ u64 last_rx_probereq_pkts; ++ u64 last_rx_probersp_pkts; ++ u64 last_rx_probersp_bm_pkts; ++ u64 last_rx_probersp_uo_pkts; ++ u64 last_rx_ctrl_pkts; ++ u64 last_rx_data_pkts; ++ u64 last_rx_data_qos_pkts[TID_NUM]; ++#ifdef CONFIG_TDLS ++ u64 rx_tdls_disc_rsp_pkts; ++ u64 last_rx_tdls_disc_rsp_pkts; ++#endif ++ u64 rx_bytes; ++ u64 rx_drops; ++ ++ u64 tx_pkts; ++ u64 tx_bytes; ++ u64 tx_drops; ++}; ++ ++#ifndef DBG_SESSION_TRACKER ++#define DBG_SESSION_TRACKER 0 ++#endif ++ ++/* session tracker status */ ++#define ST_STATUS_NONE 0 ++#define ST_STATUS_CHECK BIT0 ++#define ST_STATUS_ESTABLISH BIT1 ++#define ST_STATUS_EXPIRE BIT2 ++ ++#define ST_EXPIRE_MS (10 * 1000) ++ ++struct session_tracker { ++ _list list; /* session_tracker_queue */ ++ u32 local_naddr; ++ u16 local_port; ++ u32 remote_naddr; ++ u16 remote_port; ++ u32 set_time; ++ u8 status; ++}; ++ ++/* session tracker cmd */ ++#define ST_CMD_ADD 0 ++#define ST_CMD_DEL 1 ++#define ST_CMD_CHK 2 ++ ++struct st_cmd_parm { ++ u8 cmd; ++ struct sta_info *sta; ++ u32 local_naddr; /* TODO: IPV6 */ ++ u16 local_port; ++ u32 remote_naddr; /* TODO: IPV6 */ ++ u16 remote_port; ++}; ++ ++typedef bool (*st_match_rule)(_adapter *adapter, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port); ++ ++struct st_register { ++ u8 s_proto; ++ st_match_rule rule; ++}; ++ ++#define SESSION_TRACKER_REG_ID_WFD 0 ++#define SESSION_TRACKER_REG_ID_NUM 1 ++ ++struct st_ctl_t { ++ struct st_register reg[SESSION_TRACKER_REG_ID_NUM]; ++ _queue tracker_q; ++}; ++ ++void rtw_st_ctl_init(struct st_ctl_t *st_ctl); ++void rtw_st_ctl_deinit(struct st_ctl_t *st_ctl); ++void rtw_st_ctl_register(struct st_ctl_t *st_ctl, u8 st_reg_id, struct st_register *reg); ++void rtw_st_ctl_unregister(struct st_ctl_t *st_ctl, u8 st_reg_id); ++bool rtw_st_ctl_chk_reg_s_proto(struct st_ctl_t *st_ctl, u8 s_proto); ++bool rtw_st_ctl_chk_reg_rule(struct st_ctl_t *st_ctl, _adapter *adapter, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port); ++void dump_st_ctl(void *sel, struct st_ctl_t *st_ctl); ++ ++#ifdef CONFIG_TDLS ++struct TDLS_PeerKey { ++ u8 kck[16]; /* TPK-KCK */ ++ u8 tk[16]; /* TPK-TK; only CCMP will be used */ ++} ; ++#endif /* CONFIG_TDLS */ ++ ++#ifdef DBG_RX_DFRAME_RAW_DATA ++struct sta_recv_dframe_info { ++ ++ u8 sta_data_rate; ++ u8 sta_sgi; ++ u8 sta_bw_mode; ++ s8 sta_mimo_signal_strength[4]; ++ s8 sta_RxPwr[4]; ++ u8 sta_ofdm_snr[4]; ++}; ++#endif ++ ++struct sta_info { ++ ++ _lock lock; ++ _list list; /* free_sta_queue */ ++ _list hash_list; /* sta_hash */ ++ /* _list asoc_list; */ /* 20061114 */ ++ /* _list sleep_list; */ /* sleep_q */ ++ /* _list wakeup_list; */ /* wakeup_q */ ++ _adapter *padapter; ++ ++ struct sta_xmit_priv sta_xmitpriv; ++ struct sta_recv_priv sta_recvpriv; ++ ++#ifdef DBG_RX_DFRAME_RAW_DATA ++ struct sta_recv_dframe_info sta_dframe_info; ++#endif ++ _queue sleep_q; ++ unsigned int sleepq_len; ++ ++ uint state; ++ uint aid; ++ uint mac_id; ++ uint qos_option; ++ u8 hwaddr[ETH_ALEN]; ++ u16 hwseq; ++ u8 ra_rpt_linked; ++ ++ uint ieee8021x_blocked; /* 0: allowed, 1:blocked */ ++ uint dot118021XPrivacy; /* aes, tkip... */ ++ union Keytype dot11tkiptxmickey; ++ union Keytype dot11tkiprxmickey; ++ union Keytype dot118021x_UncstKey; ++ union pn48 dot11txpn; /* PN48 used for Unicast xmit */ ++#ifdef CONFIG_GTK_OL ++ u8 kek[RTW_KEK_LEN]; ++ u8 kck[RTW_KCK_LEN]; ++ u8 replay_ctr[RTW_REPLAY_CTR_LEN]; ++#endif /* CONFIG_GTK_OL */ ++#ifdef CONFIG_IEEE80211W ++ union pn48 dot11wtxpn; /* PN48 used for Unicast mgmt xmit. */ ++ _timer dot11w_expire_timer; ++#endif /* CONFIG_IEEE80211W */ ++ union pn48 dot11rxpn; /* PN48 used for Unicast recv. */ ++ ++ ++ u8 bssrateset[16]; ++ u32 bssratelen; ++ s32 rssi; ++ s32 signal_quality; ++ ++ u8 cts2self; ++ u8 rtsen; ++ ++ u8 raid; ++ u8 init_rate; ++ u64 ra_mask; ++ u8 wireless_mode; /* NETWORK_TYPE */ ++ u8 bw_mode; ++ ++ u8 ldpc; ++ u8 stbc; ++ ++#ifdef CONFIG_BEAMFORMING ++ u16 txbf_paid; ++ u16 txbf_gid; ++#endif ++ ++ struct stainfo_stats sta_stats; ++ ++#ifdef CONFIG_TDLS ++ u32 tdls_sta_state; ++ u8 SNonce[32]; ++ u8 ANonce[32]; ++ u32 TDLS_PeerKey_Lifetime; ++ u32 TPK_count; ++ _timer TPK_timer; ++ struct TDLS_PeerKey tpk; ++#ifdef CONFIG_TDLS_CH_SW ++ u16 ch_switch_time; ++ u16 ch_switch_timeout; ++ /* u8 option; */ ++ _timer ch_sw_timer; ++ _timer delay_timer; ++ _timer stay_on_base_chnl_timer; ++ _timer ch_sw_monitor_timer; ++#endif ++ _timer handshake_timer; ++ u8 alive_count; ++ _timer pti_timer; ++ u8 TDLS_RSNIE[20]; /* Save peer's RSNIE, used for sending TDLS_SETUP_RSP */ ++#endif /* CONFIG_TDLS */ ++ ++ /* for A-MPDU TX, ADDBA timeout check */ ++ _timer addba_retry_timer; ++ ++ /* for A-MPDU Rx reordering buffer control */ ++ struct recv_reorder_ctrl recvreorder_ctrl[TID_NUM]; ++ ATOMIC_T continual_no_rx_packet[TID_NUM]; ++ /* for A-MPDU Tx */ ++ /* unsigned char ampdu_txen_bitmap; */ ++ u16 BA_starting_seqctrl[16]; ++ ++ ++#ifdef CONFIG_80211N_HT ++ struct ht_priv htpriv; ++#endif ++ ++#ifdef CONFIG_80211AC_VHT ++ struct vht_priv vhtpriv; ++#endif ++ ++ /* Notes: */ ++ /* STA_Mode: */ ++ /* curr_network(mlme_priv/security_priv/qos/ht) + sta_info: (STA & AP) CAP/INFO */ ++ /* scan_q: AP CAP/INFO */ ++ ++ /* AP_Mode: */ ++ /* curr_network(mlme_priv/security_priv/qos/ht) : AP CAP/INFO */ ++ /* sta_info: (AP & STA) CAP/INFO */ ++ ++ unsigned int expire_to; ++ u8 bpairwise_key_installed; ++ ++#ifdef CONFIG_AP_MODE ++ ++ _list asoc_list; ++ _list auth_list; ++ ++ unsigned int auth_seq; ++ unsigned int authalg; ++ unsigned char chg_txt[128]; ++ ++ u16 capability; ++ int flags; ++ ++ int dot8021xalg;/* 0:disable, 1:psk, 2:802.1x */ ++ int wpa_psk;/* 0:disable, bit(0): WPA, bit(1):WPA2 */ ++ int wpa_group_cipher; ++ int wpa2_group_cipher; ++ int wpa_pairwise_cipher; ++ int wpa2_pairwise_cipher; ++ ++#ifdef CONFIG_RTW_80211R ++ u8 ft_pairwise_key_installed; ++#endif ++ ++#ifdef CONFIG_NATIVEAP_MLME ++ u8 wpa_ie[32]; ++ ++ u8 nonerp_set; ++ u8 no_short_slot_time_set; ++ u8 no_short_preamble_set; ++ u8 no_ht_gf_set; ++ u8 no_ht_set; ++ u8 ht_20mhz_set; ++ u8 ht_40mhz_intolerant; ++#endif /* CONFIG_NATIVEAP_MLME */ ++ ++#ifdef CONFIG_ATMEL_RC_PATCH ++ u8 flag_atmel_rc; ++#endif ++ ++ u8 qos_info; ++ ++ u8 max_sp_len; ++ u8 uapsd_bk;/* BIT(0): Delivery enabled, BIT(1): Trigger enabled */ ++ u8 uapsd_be; ++ u8 uapsd_vi; ++ u8 uapsd_vo; ++ ++ u8 has_legacy_ac; ++ unsigned int sleepq_ac_len; ++ ++#ifdef CONFIG_P2P ++ /* p2p priv data */ ++ u8 is_p2p_device; ++ u8 p2p_status_code; ++ ++ /* p2p client info */ ++ u8 dev_addr[ETH_ALEN]; ++ /* u8 iface_addr[ETH_ALEN]; */ /* = hwaddr[ETH_ALEN] */ ++ u8 dev_cap; ++ u16 config_methods; ++ u8 primary_dev_type[8]; ++ u8 num_of_secdev_type; ++ u8 secdev_types_list[32];/* 32/8 == 4; */ ++ u16 dev_name_len; ++ u8 dev_name[32]; ++#endif /* CONFIG_P2P */ ++ ++#ifdef CONFIG_WFD ++ u8 op_wfd_mode; ++#endif ++ ++#ifdef CONFIG_TX_MCAST2UNI ++ u8 under_exist_checking; ++#endif /* CONFIG_TX_MCAST2UNI */ ++ ++ u8 keep_alive_trycnt; ++ ++#ifdef CONFIG_AUTO_AP_MODE ++ u8 isrc; /* this device is rc */ ++ u16 pid; /* pairing id */ ++#endif ++ ++#endif /* CONFIG_AP_MODE */ ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ u8 *passoc_req; ++ u32 assoc_req_len; ++#endif ++ ++ /* for DM */ ++ RSSI_STA rssi_stat; ++ ++ /* ODM_STA_INFO_T */ ++ /* ================ODM Relative Info======================= */ ++ /* Please be care, dont declare too much structure here. It will cost memory * STA support num. */ ++ /* */ ++ /* */ ++ /* 2011/10/20 MH Add for ODM STA info. */ ++ /* */ ++ /* Driver Write */ ++ u8 bValid; /* record the sta status link or not? */ ++ /* u8 WirelessMode; */ /* */ ++ u8 IOTPeer; /* Enum value. HT_IOT_PEER_E */ ++ /* ODM Write */ ++ /* 1 PHY_STATUS_INFO */ ++ u8 RSSI_Path[4]; /* */ ++ u8 RSSI_Ave; ++ u8 RXEVM[4]; ++ u8 RXSNR[4]; ++ ++ u8 rssi_level; /* for Refresh RA mask */ ++ /* ODM Write */ ++ /* 1 TX_INFO (may changed by IC) */ ++ /* TX_INFO_T pTxInfo; */ /* Define in IC folder. Move lower layer. */ ++ /* */ ++ /* ================ODM Relative Info======================= */ ++ /* */ ++ ++ /* To store the sequence number of received management frame */ ++ u16 RxMgmtFrameSeqNum; ++ ++ struct st_ctl_t st_ctl; ++}; ++ ++#define sta_rx_pkts(sta) \ ++ (sta->sta_stats.rx_mgnt_pkts \ ++ + sta->sta_stats.rx_ctrl_pkts \ ++ + sta->sta_stats.rx_data_pkts) ++ ++#define sta_last_rx_pkts(sta) \ ++ (sta->sta_stats.last_rx_mgnt_pkts \ ++ + sta->sta_stats.last_rx_ctrl_pkts \ ++ + sta->sta_stats.last_rx_data_pkts) ++ ++#define sta_rx_data_pkts(sta) \ ++ (sta->sta_stats.rx_data_pkts) ++ ++#define sta_rx_data_qos_pkts(sta, i) \ ++ (sta->sta_stats.rx_data_qos_pkts[i]) ++ ++#define sta_last_rx_data_pkts(sta) \ ++ (sta->sta_stats.last_rx_data_pkts) ++ ++#define sta_last_rx_data_qos_pkts(sta, i) \ ++ (sta->sta_stats.last_rx_data_qos_pkts[i]) ++ ++#define sta_rx_mgnt_pkts(sta) \ ++ (sta->sta_stats.rx_mgnt_pkts) ++ ++#define sta_last_rx_mgnt_pkts(sta) \ ++ (sta->sta_stats.last_rx_mgnt_pkts) ++ ++#define sta_rx_beacon_pkts(sta) \ ++ (sta->sta_stats.rx_beacon_pkts) ++ ++#define sta_last_rx_beacon_pkts(sta) \ ++ (sta->sta_stats.last_rx_beacon_pkts) ++ ++#define sta_rx_probereq_pkts(sta) \ ++ (sta->sta_stats.rx_probereq_pkts) ++ ++#define sta_last_rx_probereq_pkts(sta) \ ++ (sta->sta_stats.last_rx_probereq_pkts) ++ ++#define sta_rx_probersp_pkts(sta) \ ++ (sta->sta_stats.rx_probersp_pkts) ++ ++#define sta_last_rx_probersp_pkts(sta) \ ++ (sta->sta_stats.last_rx_probersp_pkts) ++ ++#define sta_rx_probersp_bm_pkts(sta) \ ++ (sta->sta_stats.rx_probersp_bm_pkts) ++ ++#define sta_last_rx_probersp_bm_pkts(sta) \ ++ (sta->sta_stats.last_rx_probersp_bm_pkts) ++ ++#define sta_rx_probersp_uo_pkts(sta) \ ++ (sta->sta_stats.rx_probersp_uo_pkts) ++ ++#define sta_last_rx_probersp_uo_pkts(sta) \ ++ (sta->sta_stats.last_rx_probersp_uo_pkts) ++ ++#define sta_update_last_rx_pkts(sta) \ ++ do { \ ++ sta->sta_stats.last_rx_mgnt_pkts = sta->sta_stats.rx_mgnt_pkts; \ ++ sta->sta_stats.last_rx_beacon_pkts = sta->sta_stats.rx_beacon_pkts; \ ++ sta->sta_stats.last_rx_probereq_pkts = sta->sta_stats.rx_probereq_pkts; \ ++ sta->sta_stats.last_rx_probersp_pkts = sta->sta_stats.rx_probersp_pkts; \ ++ sta->sta_stats.last_rx_probersp_bm_pkts = sta->sta_stats.rx_probersp_bm_pkts; \ ++ sta->sta_stats.last_rx_probersp_uo_pkts = sta->sta_stats.rx_probersp_uo_pkts; \ ++ sta->sta_stats.last_rx_ctrl_pkts = sta->sta_stats.rx_ctrl_pkts; \ ++ sta->sta_stats.last_rx_data_pkts = sta->sta_stats.rx_data_pkts; \ ++ } while (0) ++ ++#define STA_RX_PKTS_ARG(sta) \ ++ sta->sta_stats.rx_mgnt_pkts \ ++ , sta->sta_stats.rx_ctrl_pkts \ ++ , sta->sta_stats.rx_data_pkts ++ ++#define STA_LAST_RX_PKTS_ARG(sta) \ ++ sta->sta_stats.last_rx_mgnt_pkts \ ++ , sta->sta_stats.last_rx_ctrl_pkts \ ++ , sta->sta_stats.last_rx_data_pkts ++ ++#define STA_RX_PKTS_DIFF_ARG(sta) \ ++ sta->sta_stats.rx_mgnt_pkts - sta->sta_stats.last_rx_mgnt_pkts \ ++ , sta->sta_stats.rx_ctrl_pkts - sta->sta_stats.last_rx_ctrl_pkts \ ++ , sta->sta_stats.rx_data_pkts - sta->sta_stats.last_rx_data_pkts ++ ++#define STA_PKTS_FMT "(m:%llu, c:%llu, d:%llu)" ++ ++#ifdef CONFIG_WFD ++#define STA_OP_WFD_MODE(sta) (sta)->op_wfd_mode ++#define STA_SET_OP_WFD_MODE(sta, mode) (sta)->op_wfd_mode = (mode) ++#else ++#define STA_OP_WFD_MODE(sta) 0 ++#define STA_SET_OP_WFD_MODE(sta, mode) do {} while (0) ++#endif ++ ++struct sta_priv { ++ ++ u8 *pallocated_stainfo_buf; ++ u8 *pstainfo_buf; ++ _queue free_sta_queue; ++ ++ _lock sta_hash_lock; ++ _list sta_hash[NUM_STA]; ++ int asoc_sta_count; ++ _queue sleep_q; ++ _queue wakeup_q; ++ ++ _adapter *padapter; ++ ++ u32 adhoc_expire_to; ++ ++#ifdef CONFIG_AP_MODE ++ _list asoc_list; ++ _list auth_list; ++ _lock asoc_list_lock; ++ _lock auth_list_lock; ++ u8 asoc_list_cnt; ++ u8 auth_list_cnt; ++ ++ unsigned int auth_to; /* sec, time to expire in authenticating. */ ++ unsigned int assoc_to; /* sec, time to expire before associating. */ ++ unsigned int expire_to; /* sec , time to expire after associated. */ ++ ++ /* pointers to STA info; based on allocated AID or NULL if AID free ++ * AID is in the range 1-2007, so sta_aid[0] corresponders to AID 1 ++ * and so on ++ */ ++ struct sta_info *sta_aid[NUM_STA]; ++ ++ u16 sta_dz_bitmap;/* only support 15 stations, staion aid bitmap for sleeping sta. */ ++ u16 tim_bitmap;/* only support 15 stations, aid=0~15 mapping bit0~bit15 */ ++ ++ u16 max_num_sta; ++ ++#ifdef CONFIG_RTW_MACADDR_ACL ++ struct wlan_acl_pool acl_list; ++#endif ++ ++#endif ++ ++#ifdef CONFIG_ATMEL_RC_PATCH ++ u8 atmel_rc_pattern[6]; ++#endif ++ ++}; ++ ++ ++__inline static u32 wifi_mac_hash(u8 *mac) ++{ ++ u32 x; ++ ++ x = mac[0]; ++ x = (x << 2) ^ mac[1]; ++ x = (x << 2) ^ mac[2]; ++ x = (x << 2) ^ mac[3]; ++ x = (x << 2) ^ mac[4]; ++ x = (x << 2) ^ mac[5]; ++ ++ x ^= x >> 8; ++ x = x & (NUM_STA - 1); ++ ++ return x; ++} ++ ++ ++extern u32 _rtw_init_sta_priv(struct sta_priv *pstapriv); ++extern u32 _rtw_free_sta_priv(struct sta_priv *pstapriv); ++ ++#define stainfo_offset_valid(offset) (offset < NUM_STA && offset >= 0) ++int rtw_stainfo_offset(struct sta_priv *stapriv, struct sta_info *sta); ++struct sta_info *rtw_get_stainfo_by_offset(struct sta_priv *stapriv, int offset); ++ ++extern struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr); ++extern u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta); ++extern void rtw_free_all_stainfo(_adapter *padapter); ++extern struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr); ++extern u32 rtw_init_bcmc_stainfo(_adapter *padapter); ++extern struct sta_info *rtw_get_bcmc_stainfo(_adapter *padapter); ++ ++#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) ++extern u8 rtw_access_ctrl(_adapter *adapter, u8 *mac_addr); ++void dump_macaddr_acl(void *sel, _adapter *adapter); ++#endif ++ ++#endif /* _STA_INFO_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/usb_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_hal.h +--- linux-4.14.18/3rdparty/rtl8723de/include/usb_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_hal.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,67 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __USB_HAL_H__ ++#define __USB_HAL_H__ ++ ++int usb_init_recv_priv(_adapter *padapter, u16 ini_in_buf_sz); ++void usb_free_recv_priv(_adapter *padapter, u16 ini_in_buf_sz); ++#ifdef CONFIG_FW_C2H_REG ++void usb_c2h_hisr_hdl(_adapter *adapter, u8 *buf); ++#endif ++ ++u8 rtw_set_hal_ops(_adapter *padapter); ++ ++#ifdef CONFIG_RTL8188E ++void rtl8188eu_set_hal_ops(_adapter *padapter); ++#endif ++ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ++void rtl8812au_set_hal_ops(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_RTL8192E ++void rtl8192eu_set_hal_ops(_adapter *padapter); ++#endif ++ ++ ++#ifdef CONFIG_RTL8723B ++void rtl8723bu_set_hal_ops(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_RTL8814A ++void rtl8814au_set_hal_ops(_adapter *padapter); ++#endif /* CONFIG_RTL8814A */ ++ ++#ifdef CONFIG_RTL8188F ++void rtl8188fu_set_hal_ops(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_RTL8703B ++void rtl8703bu_set_hal_ops(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_RTL8723D ++void rtl8723du_set_hal_ops(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_INTEL_PROXIM ++extern _adapter *rtw_usb_get_sw_pointer(void); ++#endif /* CONFIG_INTEL_PROXIM */ ++#endif /* __USB_HAL_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/usb_ops.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_ops.h +--- linux-4.14.18/3rdparty/rtl8723de/include/usb_ops.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_ops.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,133 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __USB_OPS_H_ ++#define __USB_OPS_H_ ++ ++ ++#define REALTEK_USB_VENQT_READ 0xC0 ++#define REALTEK_USB_VENQT_WRITE 0x40 ++#define REALTEK_USB_VENQT_CMD_REQ 0x05 ++#define REALTEK_USB_VENQT_CMD_IDX 0x00 ++#define REALTEK_USB_IN_INT_EP_IDX 1 ++ ++enum { ++ VENDOR_WRITE = 0x00, ++ VENDOR_READ = 0x01, ++}; ++#define ALIGNMENT_UNIT 16 ++#define MAX_VENDOR_REQ_CMD_SIZE 254 /* 8188cu SIE Support */ ++#define MAX_USB_IO_CTL_SIZE (MAX_VENDOR_REQ_CMD_SIZE + ALIGNMENT_UNIT) ++ ++#ifdef PLATFORM_LINUX ++#include ++#endif /* PLATFORM_LINUX */ ++ ++#ifdef CONFIG_RTL8188E ++void rtl8188eu_set_hw_type(struct dvobj_priv *pdvobj); ++#ifdef CONFIG_SUPPORT_USB_INT ++void interrupt_handler_8188eu(_adapter *padapter, u16 pkt_len, u8 *pbuf); ++#endif ++#endif ++ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ++void rtl8812au_set_hw_type(struct dvobj_priv *pdvobj); ++#ifdef CONFIG_SUPPORT_USB_INT ++void interrupt_handler_8812au(_adapter *padapter, u16 pkt_len, u8 *pbuf); ++#endif ++#endif ++ ++#ifdef CONFIG_RTL8814A ++void rtl8814au_set_hw_type(struct dvobj_priv *pdvobj); ++#ifdef CONFIG_SUPPORT_USB_INT ++void interrupt_handler_8814au(_adapter *padapter, u16 pkt_len, u8 *pbuf); ++#endif ++#endif /* CONFIG_RTL8814 */ ++ ++#ifdef CONFIG_RTL8192E ++void rtl8192eu_set_hw_type(struct dvobj_priv *pdvobj); ++#ifdef CONFIG_SUPPORT_USB_INT ++void interrupt_handler_8192eu(_adapter *padapter, u16 pkt_len, u8 *pbuf); ++#endif ++ ++#endif ++ ++#ifdef CONFIG_RTL8188F ++void rtl8188fu_set_hw_type(struct dvobj_priv *pdvobj); ++#ifdef CONFIG_SUPPORT_USB_INT ++void interrupt_handler_8188fu(_adapter *padapter, u16 pkt_len, u8 *pbuf); ++#endif ++#endif ++ ++#ifdef CONFIG_RTL8723B ++void rtl8723bu_set_hw_type(struct dvobj_priv *pdvobj); ++#ifdef CONFIG_SUPPORT_USB_INT ++void interrupt_handler_8723bu(_adapter *padapter, u16 pkt_len, u8 *pbuf); ++#endif ++#endif ++ ++#ifdef CONFIG_RTL8703B ++void rtl8703bu_set_hw_type(struct dvobj_priv *pdvobj); ++#ifdef CONFIG_SUPPORT_USB_INT ++void interrupt_handler_8703bu(_adapter *padapter, u16 pkt_len, u8 *pbuf); ++#endif /* CONFIG_SUPPORT_USB_INT */ ++#endif /* CONFIG_RTL8703B */ ++ ++void usb_set_intf_ops(_adapter *padapter, struct _io_ops *pops); ++ ++#ifdef CONFIG_RTL8723D ++void rtl8723du_set_hw_type(struct dvobj_priv *pdvobj); ++void rtl8723du_set_intf_ops(struct _io_ops *pops); ++void rtl8723du_recv_tasklet(void *priv); ++void rtl8723du_xmit_tasklet(void *priv); ++#ifdef CONFIG_SUPPORT_USB_INT ++void interrupt_handler_8723du(_adapter *padapter, u16 pkt_len, u8 *pbuf); ++#endif /* CONFIG_SUPPORT_USB_INT */ ++#endif /* CONFIG_RTL8723D */ ++ ++enum RTW_USB_SPEED { ++ RTW_USB_SPEED_UNKNOWN = 0, ++ RTW_USB_SPEED_1_1 = 1, ++ RTW_USB_SPEED_2 = 2, ++ RTW_USB_SPEED_3 = 3, ++}; ++ ++#define IS_FULL_SPEED_USB(Adapter) (adapter_to_dvobj(Adapter)->usb_speed == RTW_USB_SPEED_1_1) ++#define IS_HIGH_SPEED_USB(Adapter) (adapter_to_dvobj(Adapter)->usb_speed == RTW_USB_SPEED_2) ++#define IS_SUPER_SPEED_USB(Adapter) (adapter_to_dvobj(Adapter)->usb_speed == RTW_USB_SPEED_3) ++ ++#define USB_SUPER_SPEED_BULK_SIZE 1024 /* usb 3.0 */ ++#define USB_HIGH_SPEED_BULK_SIZE 512 /* usb 2.0 */ ++#define USB_FULL_SPEED_BULK_SIZE 64 /* usb 1.1 */ ++ ++static inline u8 rtw_usb_bulk_size_boundary(_adapter *padapter, int buf_len) ++{ ++ u8 rst = _TRUE; ++ ++ if (IS_SUPER_SPEED_USB(padapter)) ++ rst = (0 == (buf_len) % USB_SUPER_SPEED_BULK_SIZE) ? _TRUE : _FALSE; ++ if (IS_HIGH_SPEED_USB(padapter)) ++ rst = (0 == (buf_len) % USB_HIGH_SPEED_BULK_SIZE) ? _TRUE : _FALSE; ++ else ++ rst = (0 == (buf_len) % USB_FULL_SPEED_BULK_SIZE) ? _TRUE : _FALSE; ++ return rst; ++} ++ ++ ++#endif /* __USB_OPS_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/usb_ops_linux.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_ops_linux.h +--- linux-4.14.18/3rdparty/rtl8723de/include/usb_ops_linux.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_ops_linux.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,103 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __USB_OPS_LINUX_H__ ++#define __USB_OPS_LINUX_H__ ++ ++#define VENDOR_CMD_MAX_DATA_LEN 254 ++#define FW_START_ADDRESS 0x1000 ++ ++#define RTW_USB_CONTROL_MSG_TIMEOUT_TEST 10/* ms */ ++#define RTW_USB_CONTROL_MSG_TIMEOUT 500/* ms */ ++ ++#define RECV_BULK_IN_ADDR 0x80/* assign by drv, not real address */ ++#define RECV_INT_IN_ADDR 0x81/* assign by drv, not real address */ ++ ++#define INTERRUPT_MSG_FORMAT_LEN 60 ++ ++#if defined(CONFIG_VENDOR_REQ_RETRY) && defined(CONFIG_USB_VENDOR_REQ_MUTEX) ++ /* vendor req retry should be in the situation when each vendor req is atomically submitted from others */ ++ #define MAX_USBCTRL_VENDORREQ_TIMES 10 ++#else ++ #define MAX_USBCTRL_VENDORREQ_TIMES 1 ++#endif ++ ++#define RTW_USB_BULKOUT_TIMEOUT 5000/* ms */ ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 5, 0)) || (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 18)) ++#define _usbctrl_vendorreq_async_callback(urb, regs) _usbctrl_vendorreq_async_callback(urb) ++#define usb_bulkout_zero_complete(purb, regs) usb_bulkout_zero_complete(purb) ++#define usb_write_mem_complete(purb, regs) usb_write_mem_complete(purb) ++#define usb_write_port_complete(purb, regs) usb_write_port_complete(purb) ++#define usb_read_port_complete(purb, regs) usb_read_port_complete(purb) ++#define usb_read_interrupt_complete(purb, regs) usb_read_interrupt_complete(purb) ++#endif ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 12)) ++#define rtw_usb_control_msg(dev, pipe, request, requesttype, value, index, data, size, timeout_ms) \ ++ usb_control_msg((dev), (pipe), (request), (requesttype), (value), (index), (data), (size), (timeout_ms)) ++#define rtw_usb_bulk_msg(usb_dev, pipe, data, len, actual_length, timeout_ms) \ ++ usb_bulk_msg((usb_dev), (pipe), (data), (len), (actual_length), (timeout_ms)) ++#else ++#define rtw_usb_control_msg(dev, pipe, request, requesttype, value, index, data, size, timeout_ms) \ ++ usb_control_msg((dev), (pipe), (request), (requesttype), (value), (index), (data), (size), \ ++ ((timeout_ms) == 0) || ((timeout_ms) * HZ / 1000 > 0) ? ((timeout_ms) * HZ / 1000) : 1) ++#define rtw_usb_bulk_msg(usb_dev, pipe, data, len, actual_length, timeout_ms) \ ++ usb_bulk_msg((usb_dev), (pipe), (data), (len), (actual_length), \ ++ ((timeout_ms) == 0) || ((timeout_ms) * HZ / 1000 > 0) ? ((timeout_ms) * HZ / 1000) : 1) ++#endif ++ ++ ++#ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ ++int usb_async_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val); ++int usb_async_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val); ++int usb_async_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val); ++#endif /* CONFIG_USB_SUPPORT_ASYNC_VDN_REQ */ ++ ++unsigned int ffaddr2pipehdl(struct dvobj_priv *pdvobj, u32 addr); ++ ++void usb_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem); ++void usb_write_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem); ++ ++void usb_read_port_cancel(struct intf_hdl *pintfhdl); ++ ++u32 usb_write_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem); ++void usb_write_port_cancel(struct intf_hdl *pintfhdl); ++ ++int usbctrl_vendorreq(struct intf_hdl *pintfhdl, u8 request, u16 value, u16 index, void *pdata, u16 len, u8 requesttype); ++#ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ ++int _usbctrl_vendorreq_async_write(struct usb_device *udev, u8 request, ++ u16 value, u16 index, void *pdata, u16 len, u8 requesttype); ++#endif /* CONFIG_USB_SUPPORT_ASYNC_VDN_REQ */ ++ ++u8 usb_read8(struct intf_hdl *pintfhdl, u32 addr); ++u16 usb_read16(struct intf_hdl *pintfhdl, u32 addr); ++u32 usb_read32(struct intf_hdl *pintfhdl, u32 addr); ++int usb_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val); ++int usb_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val); ++int usb_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val); ++int usb_writeN(struct intf_hdl *pintfhdl, u32 addr, u32 length, u8 *pdata); ++u32 usb_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem); ++void usb_recv_tasklet(void *priv); ++ ++#ifdef CONFIG_USB_INTERRUPT_IN_PIPE ++void usb_read_interrupt_complete(struct urb *purb, struct pt_regs *regs); ++u32 usb_read_interrupt(struct intf_hdl *pintfhdl, u32 addr); ++#endif ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/usb_osintf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_osintf.h +--- linux-4.14.18/3rdparty/rtl8723de/include/usb_osintf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_osintf.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,31 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __USB_OSINTF_H ++#define __USB_OSINTF_H ++ ++#include ++ ++#define USBD_HALTED(Status) ((ULONG)(Status) >> 30 == 3) ++ ++ ++u8 usbvendorrequest(struct dvobj_priv *pdvobjpriv, RT_USB_BREQUEST brequest, RT_USB_WVALUE wvalue, u8 windex, void *data, u8 datalen, u8 isdirectionin); ++ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/usb_vendor_req.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_vendor_req.h +--- linux-4.14.18/3rdparty/rtl8723de/include/usb_vendor_req.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_vendor_req.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,61 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _USB_VENDOR_REQUEST_H_ ++#define _USB_VENDOR_REQUEST_H_ ++ ++/* 4 Set/Get Register related wIndex/Data */ ++#define RT_USB_RESET_MASK_OFF 0 ++#define RT_USB_RESET_MASK_ON 1 ++#define RT_USB_SLEEP_MASK_OFF 0 ++#define RT_USB_SLEEP_MASK_ON 1 ++#define RT_USB_LDO_ON 1 ++#define RT_USB_LDO_OFF 0 ++ ++/* 4 Set/Get SYSCLK related wValue or Data */ ++#define RT_USB_SYSCLK_32KHZ 0 ++#define RT_USB_SYSCLK_40MHZ 1 ++#define RT_USB_SYSCLK_60MHZ 2 ++ ++ ++typedef enum _RT_USB_BREQUEST { ++ RT_USB_SET_REGISTER = 1, ++ RT_USB_SET_SYSCLK = 2, ++ RT_USB_GET_SYSCLK = 3, ++ RT_USB_GET_REGISTER = 4 ++} RT_USB_BREQUEST; ++ ++ ++typedef enum _RT_USB_WVALUE { ++ RT_USB_RESET_MASK = 1, ++ RT_USB_SLEEP_MASK = 2, ++ RT_USB_USB_HRCPWM = 3, ++ RT_USB_LDO = 4, ++ RT_USB_BOOT_TYPE = 5 ++} RT_USB_WVALUE; ++ ++ ++#if 0 ++BOOLEAN usbvendorrequest(PCE_USB_DEVICE CEdevice, RT_USB_BREQUEST bRequest, RT_USB_WVALUE wValue, UCHAR wIndex, PVOID Data, UCHAR DataLength, BOOLEAN isDirectionIn); ++BOOLEAN CEusbGetStatusRequest(PCE_USB_DEVICE CEdevice, IN USHORT Op, IN USHORT Index, PVOID Data); ++BOOLEAN CEusbFeatureRequest(PCE_USB_DEVICE CEdevice, IN USHORT Op, IN USHORT FeatureSelector, IN USHORT Index); ++BOOLEAN CEusbGetDescriptorRequest(PCE_USB_DEVICE CEdevice, IN short urbLength, IN UCHAR DescriptorType, IN UCHAR Index, IN USHORT LanguageId, IN PVOID TransferBuffer, IN ULONG TransferBufferLength); ++#endif ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/wifi.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/wifi.h +--- linux-4.14.18/3rdparty/rtl8723de/include/wifi.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/wifi.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,1391 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef _WIFI_H_ ++#define _WIFI_H_ ++ ++ ++#ifdef BIT ++/* #error "BIT define occurred earlier elsewhere!\n" */ ++#undef BIT ++#endif ++#define BIT(x) (1 << (x)) ++ ++ ++#define WLAN_ETHHDR_LEN 14 ++#define WLAN_ETHADDR_LEN 6 ++#define WLAN_IEEE_OUI_LEN 3 ++#define WLAN_ADDR_LEN 6 ++#define WLAN_CRC_LEN 4 ++#define WLAN_BSSID_LEN 6 ++#define WLAN_BSS_TS_LEN 8 ++#define WLAN_HDR_A3_LEN 24 ++#define WLAN_HDR_A4_LEN 30 ++#define WLAN_HDR_A3_QOS_LEN 26 ++#define WLAN_HDR_A4_QOS_LEN 32 ++#define WLAN_SSID_MAXLEN 32 ++#define WLAN_DATA_MAXLEN 2312 ++ ++#define WLAN_A3_PN_OFFSET 24 ++#define WLAN_A4_PN_OFFSET 30 ++ ++#define WLAN_MIN_ETHFRM_LEN 60 ++#define WLAN_MAX_ETHFRM_LEN 1514 ++#define WLAN_ETHHDR_LEN 14 ++#define WLAN_WMM_LEN 24 ++ ++#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE ++#define WLAN_MAX_VENDOR_IE_LEN 255 ++#define WLAN_MAX_VENDOR_IE_NUM 5 ++#define WIFI_BEACON_VENDOR_IE_BIT BIT(0) ++#define WIFI_PROBEREQ_VENDOR_IE_BIT BIT(1) ++#define WIFI_PROBERESP_VENDOR_IE_BIT BIT(2) ++#define WIFI_ASSOCREQ_VENDOR_IE_BIT BIT(3) ++#define WIFI_ASSOCRESP_VENDOR_IE_BIT BIT(4) ++#endif ++ ++#define P80211CAPTURE_VERSION 0x80211001 ++ ++/* This value is tested by WiFi 11n Test Plan 5.2.3. ++ * This test verifies the WLAN NIC can update the NAV through sending the CTS with large duration. */ ++#define WiFiNavUpperUs 30000 /* 30 ms */ ++ ++#ifdef GREEN_HILL ++#pragma pack(1) ++#endif ++ ++enum WIFI_FRAME_TYPE { ++ WIFI_MGT_TYPE = (0), ++ WIFI_CTRL_TYPE = (BIT(2)), ++ WIFI_DATA_TYPE = (BIT(3)), ++ WIFI_QOS_DATA_TYPE = (BIT(7) | BIT(3)), /* !< QoS Data */ ++}; ++ ++enum WIFI_FRAME_SUBTYPE { ++ ++ /* below is for mgt frame */ ++ WIFI_ASSOCREQ = (0 | WIFI_MGT_TYPE), ++ WIFI_ASSOCRSP = (BIT(4) | WIFI_MGT_TYPE), ++ WIFI_REASSOCREQ = (BIT(5) | WIFI_MGT_TYPE), ++ WIFI_REASSOCRSP = (BIT(5) | BIT(4) | WIFI_MGT_TYPE), ++ WIFI_PROBEREQ = (BIT(6) | WIFI_MGT_TYPE), ++ WIFI_PROBERSP = (BIT(6) | BIT(4) | WIFI_MGT_TYPE), ++ WIFI_BEACON = (BIT(7) | WIFI_MGT_TYPE), ++ WIFI_ATIM = (BIT(7) | BIT(4) | WIFI_MGT_TYPE), ++ WIFI_DISASSOC = (BIT(7) | BIT(5) | WIFI_MGT_TYPE), ++ WIFI_AUTH = (BIT(7) | BIT(5) | BIT(4) | WIFI_MGT_TYPE), ++ WIFI_DEAUTH = (BIT(7) | BIT(6) | WIFI_MGT_TYPE), ++ WIFI_ACTION = (BIT(7) | BIT(6) | BIT(4) | WIFI_MGT_TYPE), ++ WIFI_ACTION_NOACK = (BIT(7) | BIT(6) | BIT(5) | WIFI_MGT_TYPE), ++ ++ /* below is for control frame */ ++ WIFI_NDPA = (BIT(6) | BIT(4) | WIFI_CTRL_TYPE), ++ WIFI_PSPOLL = (BIT(7) | BIT(5) | WIFI_CTRL_TYPE), ++ WIFI_RTS = (BIT(7) | BIT(5) | BIT(4) | WIFI_CTRL_TYPE), ++ WIFI_CTS = (BIT(7) | BIT(6) | WIFI_CTRL_TYPE), ++ WIFI_ACK = (BIT(7) | BIT(6) | BIT(4) | WIFI_CTRL_TYPE), ++ WIFI_CFEND = (BIT(7) | BIT(6) | BIT(5) | WIFI_CTRL_TYPE), ++ WIFI_CFEND_CFACK = (BIT(7) | BIT(6) | BIT(5) | BIT(4) | WIFI_CTRL_TYPE), ++ ++ /* below is for data frame */ ++ WIFI_DATA = (0 | WIFI_DATA_TYPE), ++ WIFI_DATA_CFACK = (BIT(4) | WIFI_DATA_TYPE), ++ WIFI_DATA_CFPOLL = (BIT(5) | WIFI_DATA_TYPE), ++ WIFI_DATA_CFACKPOLL = (BIT(5) | BIT(4) | WIFI_DATA_TYPE), ++ WIFI_DATA_NULL = (BIT(6) | WIFI_DATA_TYPE), ++ WIFI_CF_ACK = (BIT(6) | BIT(4) | WIFI_DATA_TYPE), ++ WIFI_CF_POLL = (BIT(6) | BIT(5) | WIFI_DATA_TYPE), ++ WIFI_CF_ACKPOLL = (BIT(6) | BIT(5) | BIT(4) | WIFI_DATA_TYPE), ++ WIFI_QOS_DATA_NULL = (BIT(6) | WIFI_QOS_DATA_TYPE), ++}; ++ ++enum WIFI_REASON_CODE { ++ _RSON_RESERVED_ = 0, ++ _RSON_UNSPECIFIED_ = 1, ++ _RSON_AUTH_NO_LONGER_VALID_ = 2, ++ _RSON_DEAUTH_STA_LEAVING_ = 3, ++ _RSON_INACTIVITY_ = 4, ++ _RSON_UNABLE_HANDLE_ = 5, ++ _RSON_CLS2_ = 6, ++ _RSON_CLS3_ = 7, ++ _RSON_DISAOC_STA_LEAVING_ = 8, ++ _RSON_ASOC_NOT_AUTH_ = 9, ++ ++ /* WPA reason */ ++ _RSON_INVALID_IE_ = 13, ++ _RSON_MIC_FAILURE_ = 14, ++ _RSON_4WAY_HNDSHK_TIMEOUT_ = 15, ++ _RSON_GROUP_KEY_UPDATE_TIMEOUT_ = 16, ++ _RSON_DIFF_IE_ = 17, ++ _RSON_MLTCST_CIPHER_NOT_VALID_ = 18, ++ _RSON_UNICST_CIPHER_NOT_VALID_ = 19, ++ _RSON_AKMP_NOT_VALID_ = 20, ++ _RSON_UNSUPPORT_RSNE_VER_ = 21, ++ _RSON_INVALID_RSNE_CAP_ = 22, ++ _RSON_IEEE_802DOT1X_AUTH_FAIL_ = 23, ++ ++ /* belowing are Realtek definition */ ++ _RSON_PMK_NOT_AVAILABLE_ = 24, ++ _RSON_TDLS_TEAR_TOOFAR_ = 25, ++ _RSON_TDLS_TEAR_UN_RSN_ = 26, ++}; ++ ++/* Reason codes (IEEE 802.11-2007, 7.3.1.7, Table 7-22) */ ++#if 0 ++#define WLAN_REASON_UNSPECIFIED 1 ++#define WLAN_REASON_PREV_AUTH_NOT_VALID 2 ++#define WLAN_REASON_DEAUTH_LEAVING 3 ++#define WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY 4 ++#define WLAN_REASON_DISASSOC_AP_BUSY 5 ++#define WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA 6 ++#define WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA 7 ++#define WLAN_REASON_DISASSOC_STA_HAS_LEFT 8 ++#define WLAN_REASON_STA_REQ_ASSOC_WITHOUT_AUTH 9 ++#endif ++/* IEEE 802.11h */ ++#define WLAN_REASON_PWR_CAPABILITY_NOT_VALID 10 ++#define WLAN_REASON_SUPPORTED_CHANNEL_NOT_VALID 11 ++#if 0 ++/* IEEE 802.11i */ ++#define WLAN_REASON_INVALID_IE 13 ++#define WLAN_REASON_MICHAEL_MIC_FAILURE 14 ++#define WLAN_REASON_4WAY_HANDSHAKE_TIMEOUT 15 ++#define WLAN_REASON_GROUP_KEY_UPDATE_TIMEOUT 16 ++#define WLAN_REASON_IE_IN_4WAY_DIFFERS 17 ++#define WLAN_REASON_GROUP_CIPHER_NOT_VALID 18 ++#define WLAN_REASON_PAIRWISE_CIPHER_NOT_VALID 19 ++#define WLAN_REASON_AKMP_NOT_VALID 20 ++#define WLAN_REASON_UNSUPPORTED_RSN_IE_VERSION 21 ++#define WLAN_REASON_INVALID_RSN_IE_CAPAB 22 ++#define WLAN_REASON_IEEE_802_1X_AUTH_FAILED 23 ++#define WLAN_REASON_CIPHER_SUITE_REJECTED 24 ++#endif ++ ++enum WIFI_STATUS_CODE { ++ _STATS_SUCCESSFUL_ = 0, ++ _STATS_FAILURE_ = 1, ++ _STATS_SEC_DISABLED_ = 5, ++ _STATS_NOT_IN_SAME_BSS_ = 7, ++ _STATS_CAP_FAIL_ = 10, ++ _STATS_NO_ASOC_ = 11, ++ _STATS_OTHER_ = 12, ++ _STATS_NO_SUPP_ALG_ = 13, ++ _STATS_OUT_OF_AUTH_SEQ_ = 14, ++ _STATS_CHALLENGE_FAIL_ = 15, ++ _STATS_AUTH_TIMEOUT_ = 16, ++ _STATS_UNABLE_HANDLE_STA_ = 17, ++ _STATS_RATE_FAIL_ = 18, ++ _STATS_REFUSED_TEMPORARILY_ = 30, ++ _STATS_DECLINE_REQ_ = 37, ++ _STATS_INVALID_PARAMETERS_ = 38, ++ _STATS_INVALID_RSNIE_ = 72, ++}; ++ ++/* Status codes (IEEE 802.11-2007, 7.3.1.9, Table 7-23) */ ++#if 0 ++#define WLAN_STATUS_SUCCESS 0 ++#define WLAN_STATUS_UNSPECIFIED_FAILURE 1 ++#define WLAN_STATUS_CAPS_UNSUPPORTED 10 ++#define WLAN_STATUS_REASSOC_NO_ASSOC 11 ++#define WLAN_STATUS_ASSOC_DENIED_UNSPEC 12 ++#define WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG 13 ++#define WLAN_STATUS_UNKNOWN_AUTH_TRANSACTION 14 ++#define WLAN_STATUS_CHALLENGE_FAIL 15 ++#define WLAN_STATUS_AUTH_TIMEOUT 16 ++#define WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA 17 ++#define WLAN_STATUS_ASSOC_DENIED_RATES 18 ++#endif ++/* entended */ ++/* IEEE 802.11b */ ++#define WLAN_STATUS_ASSOC_DENIED_NOSHORT 19 ++#define WLAN_STATUS_ASSOC_DENIED_NOPBCC 20 ++#define WLAN_STATUS_ASSOC_DENIED_NOAGILITY 21 ++/* IEEE 802.11h */ ++#define WLAN_STATUS_SPEC_MGMT_REQUIRED 22 ++#define WLAN_STATUS_PWR_CAPABILITY_NOT_VALID 23 ++#define WLAN_STATUS_SUPPORTED_CHANNEL_NOT_VALID 24 ++/* IEEE 802.11g */ ++#define WLAN_STATUS_ASSOC_DENIED_NO_SHORT_SLOT_TIME 25 ++#define WLAN_STATUS_ASSOC_DENIED_NO_ER_PBCC 26 ++#define WLAN_STATUS_ASSOC_DENIED_NO_DSSS_OFDM 27 ++/* IEEE 802.11w */ ++#define WLAN_STATUS_ASSOC_REJECTED_TEMPORARILY 30 ++#define WLAN_STATUS_ROBUST_MGMT_FRAME_POLICY_VIOLATION 31 ++/* IEEE 802.11i */ ++#define WLAN_STATUS_INVALID_IE 40 ++#define WLAN_STATUS_GROUP_CIPHER_NOT_VALID 41 ++#define WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID 42 ++#define WLAN_STATUS_AKMP_NOT_VALID 43 ++#define WLAN_STATUS_UNSUPPORTED_RSN_IE_VERSION 44 ++#define WLAN_STATUS_INVALID_RSN_IE_CAPAB 45 ++#define WLAN_STATUS_CIPHER_REJECTED_PER_POLICY 46 ++#define WLAN_STATUS_TS_NOT_CREATED 47 ++#define WLAN_STATUS_DIRECT_LINK_NOT_ALLOWED 48 ++#define WLAN_STATUS_DEST_STA_NOT_PRESENT 49 ++#define WLAN_STATUS_DEST_STA_NOT_QOS_STA 50 ++#define WLAN_STATUS_ASSOC_DENIED_LISTEN_INT_TOO_LARGE 51 ++/* IEEE 802.11r */ ++#define WLAN_STATUS_INVALID_FT_ACTION_FRAME_COUNT 52 ++#define WLAN_STATUS_INVALID_PMKID 53 ++#define WLAN_STATUS_INVALID_MDIE 54 ++#define WLAN_STATUS_INVALID_FTIE 55 ++ ++ ++enum WIFI_REG_DOMAIN { ++ DOMAIN_FCC = 1, ++ DOMAIN_IC = 2, ++ DOMAIN_ETSI = 3, ++ DOMAIN_SPAIN = 4, ++ DOMAIN_FRANCE = 5, ++ DOMAIN_MKK = 6, ++ DOMAIN_ISRAEL = 7, ++ DOMAIN_MKK1 = 8, ++ DOMAIN_MKK2 = 9, ++ DOMAIN_MKK3 = 10, ++ DOMAIN_MAX ++}; ++ ++#define _TO_DS_ BIT(8) ++#define _FROM_DS_ BIT(9) ++#define _MORE_FRAG_ BIT(10) ++#define _RETRY_ BIT(11) ++#define _PWRMGT_ BIT(12) ++#define _MORE_DATA_ BIT(13) ++#define _PRIVACY_ BIT(14) ++#define _ORDER_ BIT(15) ++ ++#define SetToDs(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) |= cpu_to_le16(_TO_DS_); \ ++ } while (0) ++ ++#define GetToDs(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_TO_DS_)) != 0) ++ ++#define ClearToDs(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_TO_DS_)); \ ++ } while (0) ++ ++#define SetFrDs(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) |= cpu_to_le16(_FROM_DS_); \ ++ } while (0) ++ ++#define GetFrDs(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_FROM_DS_)) != 0) ++ ++#define ClearFrDs(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_FROM_DS_)); \ ++ } while (0) ++ ++#define get_tofr_ds(pframe) ((GetToDs(pframe) << 1) | GetFrDs(pframe)) ++ ++ ++#define SetMFrag(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) |= cpu_to_le16(_MORE_FRAG_); \ ++ } while (0) ++ ++#define GetMFrag(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_MORE_FRAG_)) != 0) ++ ++#define ClearMFrag(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_MORE_FRAG_)); \ ++ } while (0) ++ ++#define SetRetry(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) |= cpu_to_le16(_RETRY_); \ ++ } while (0) ++ ++#define GetRetry(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_RETRY_)) != 0) ++ ++#define ClearRetry(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_RETRY_)); \ ++ } while (0) ++ ++#define SetPwrMgt(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) |= cpu_to_le16(_PWRMGT_); \ ++ } while (0) ++ ++#define GetPwrMgt(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_PWRMGT_)) != 0) ++ ++#define ClearPwrMgt(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_PWRMGT_)); \ ++ } while (0) ++ ++#define SetMData(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) |= cpu_to_le16(_MORE_DATA_); \ ++ } while (0) ++ ++#define GetMData(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_MORE_DATA_)) != 0) ++ ++#define ClearMData(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_MORE_DATA_)); \ ++ } while (0) ++ ++#define SetPrivacy(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) |= cpu_to_le16(_PRIVACY_); \ ++ } while (0) ++ ++#define GetPrivacy(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_PRIVACY_)) != 0) ++ ++#define ClearPrivacy(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_PRIVACY_)); \ ++ } while (0) ++ ++ ++#define GetOrder(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_ORDER_)) != 0) ++ ++#define GetFrameType(pbuf) (le16_to_cpu(*(unsigned short *)(pbuf)) & (BIT(3) | BIT(2))) ++ ++#define SetFrameType(pbuf, type) \ ++ do { \ ++ *(unsigned short *)(pbuf) &= __constant_cpu_to_le16(~(BIT(3) | BIT(2))); \ ++ *(unsigned short *)(pbuf) |= __constant_cpu_to_le16(type); \ ++ } while (0) ++ ++#define GetFrameSubType(pbuf) (cpu_to_le16(*(unsigned short *)(pbuf)) & (BIT(7) | BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2))) ++ ++#define SetFrameSubType(pbuf, type) \ ++ do { \ ++ *(unsigned short *)(pbuf) &= cpu_to_le16(~(BIT(7) | BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2))); \ ++ *(unsigned short *)(pbuf) |= cpu_to_le16(type); \ ++ } while (0) ++ ++#define GetSequence(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) >> 4) ++ ++#define GetFragNum(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) & 0x0f) ++ ++#define GetTupleCache(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 22))) ++ ++#define SetFragNum(pbuf, num) \ ++ do { \ ++ *(unsigned short *)((SIZE_PTR)(pbuf) + 22) = \ ++ ((*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) & le16_to_cpu(~(0x000f))) | \ ++ cpu_to_le16(0x0f & (num)); \ ++ } while (0) ++ ++#define SetSeqNum(pbuf, num) \ ++ do { \ ++ *(unsigned short *)((SIZE_PTR)(pbuf) + 22) = \ ++ ((*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) & le16_to_cpu((unsigned short)~0xfff0)) | \ ++ le16_to_cpu((unsigned short)(0xfff0 & (num << 4))); \ ++ } while (0) ++ ++#define SetDuration(pbuf, dur) \ ++ do { \ ++ *(unsigned short *)((SIZE_PTR)(pbuf) + 2) = cpu_to_le16(0xffff & (dur)); \ ++ } while (0) ++ ++ ++#define SetPriority(pbuf, tid) \ ++ do { \ ++ *(unsigned short *)(pbuf) |= cpu_to_le16(tid & 0xf); \ ++ } while (0) ++ ++#define GetPriority(pbuf) ((le16_to_cpu(*(unsigned short *)(pbuf))) & 0xf) ++ ++#define SetEOSP(pbuf, eosp) \ ++ do { \ ++ *(unsigned short *)(pbuf) |= cpu_to_le16((eosp & 1) << 4); \ ++ } while (0) ++ ++#define SetAckpolicy(pbuf, ack) \ ++ do { \ ++ *(unsigned short *)(pbuf) |= cpu_to_le16((ack & 3) << 5); \ ++ } while (0) ++ ++#define GetAckpolicy(pbuf) (((le16_to_cpu(*(unsigned short *)pbuf)) >> 5) & 0x3) ++ ++#define GetAMsdu(pbuf) (((le16_to_cpu(*(unsigned short *)pbuf)) >> 7) & 0x1) ++ ++#define SetAMsdu(pbuf, amsdu) \ ++ do { \ ++ *(unsigned short *)(pbuf) |= cpu_to_le16((amsdu & 1) << 7); \ ++ } while (0) ++ ++#define GetAid(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 2)) & 0x3fff) ++ ++#define GetTid(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + (((GetToDs(pbuf)<<1) | GetFrDs(pbuf)) == 3 ? 30 : 24))) & 0x000f) ++ ++#define GetAddr1Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 4)) ++ ++#define GetAddr2Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 10)) ++ ++#define GetAddr3Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 16)) ++ ++#define GetAddr4Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 24)) ++ ++#define MacAddr_isBcst(addr) \ ++ (\ ++ ((addr[0] == 0xff) && (addr[1] == 0xff) && \ ++ (addr[2] == 0xff) && (addr[3] == 0xff) && \ ++ (addr[4] == 0xff) && (addr[5] == 0xff)) ? _TRUE : _FALSE \ ++ ) ++ ++__inline static int IS_MCAST(unsigned char *da) ++{ ++ if ((*da) & 0x01) ++ return _TRUE; ++ else ++ return _FALSE; ++} ++ ++__inline static unsigned char *get_ra(unsigned char *pframe) ++{ ++ unsigned char *ra; ++ ra = GetAddr1Ptr(pframe); ++ return ra; ++} ++__inline static unsigned char *get_ta(unsigned char *pframe) ++{ ++ unsigned char *ta; ++ ta = GetAddr2Ptr(pframe); ++ return ta; ++} ++ ++__inline static unsigned char *get_da(unsigned char *pframe) ++{ ++ unsigned char *da; ++ unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); ++ ++ switch (to_fr_ds) { ++ case 0x00: /* ToDs=0, FromDs=0 */ ++ da = GetAddr1Ptr(pframe); ++ break; ++ case 0x01: /* ToDs=0, FromDs=1 */ ++ da = GetAddr1Ptr(pframe); ++ break; ++ case 0x02: /* ToDs=1, FromDs=0 */ ++ da = GetAddr3Ptr(pframe); ++ break; ++ default: /* ToDs=1, FromDs=1 */ ++ da = GetAddr3Ptr(pframe); ++ break; ++ } ++ ++ return da; ++} ++ ++ ++__inline static unsigned char *get_sa(unsigned char *pframe) ++{ ++ unsigned char *sa; ++ unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); ++ ++ switch (to_fr_ds) { ++ case 0x00: /* ToDs=0, FromDs=0 */ ++ sa = GetAddr2Ptr(pframe); ++ break; ++ case 0x01: /* ToDs=0, FromDs=1 */ ++ sa = GetAddr3Ptr(pframe); ++ break; ++ case 0x02: /* ToDs=1, FromDs=0 */ ++ sa = GetAddr2Ptr(pframe); ++ break; ++ default: /* ToDs=1, FromDs=1 */ ++ sa = GetAddr4Ptr(pframe); ++ break; ++ } ++ ++ return sa; ++} ++ ++__inline static unsigned char *get_hdr_bssid(unsigned char *pframe) ++{ ++ unsigned char *sa = NULL; ++ unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); ++ ++ switch (to_fr_ds) { ++ case 0x00: /* ToDs=0, FromDs=0 */ ++ sa = GetAddr3Ptr(pframe); ++ break; ++ case 0x01: /* ToDs=0, FromDs=1 */ ++ sa = GetAddr2Ptr(pframe); ++ break; ++ case 0x02: /* ToDs=1, FromDs=0 */ ++ sa = GetAddr1Ptr(pframe); ++ break; ++ case 0x03: /* ToDs=1, FromDs=1 */ ++ sa = GetAddr1Ptr(pframe); ++ break; ++ } ++ ++ return sa; ++} ++ ++ ++__inline static int IsFrameTypeCtrl(unsigned char *pframe) ++{ ++ if (WIFI_CTRL_TYPE == GetFrameType(pframe)) ++ return _TRUE; ++ else ++ return _FALSE; ++} ++/*----------------------------------------------------------------------------- ++ Below is for the security related definition ++------------------------------------------------------------------------------*/ ++#define _RESERVED_FRAME_TYPE_ 0 ++#define _SKB_FRAME_TYPE_ 2 ++#define _PRE_ALLOCMEM_ 1 ++#define _PRE_ALLOCHDR_ 3 ++#define _PRE_ALLOCLLCHDR_ 4 ++#define _PRE_ALLOCICVHDR_ 5 ++#define _PRE_ALLOCMICHDR_ 6 ++ ++#define _SIFSTIME_ ((priv->pmib->dot11BssType.net_work_type&WIRELESS_11A) ? 16 : 10) ++#define _ACKCTSLNG_ 14 /* 14 bytes long, including crclng */ ++#define _CRCLNG_ 4 ++ ++#define _ASOCREQ_IE_OFFSET_ 4 /* excluding wlan_hdr */ ++#define _ASOCRSP_IE_OFFSET_ 6 ++#define _REASOCREQ_IE_OFFSET_ 10 ++#define _REASOCRSP_IE_OFFSET_ 6 ++#define _PROBEREQ_IE_OFFSET_ 0 ++#define _PROBERSP_IE_OFFSET_ 12 ++#define _AUTH_IE_OFFSET_ 6 ++#define _DEAUTH_IE_OFFSET_ 0 ++#define _BEACON_IE_OFFSET_ 12 ++#define _PUBLIC_ACTION_IE_OFFSET_ 8 ++ ++#define _FIXED_IE_LENGTH_ _BEACON_IE_OFFSET_ ++ ++#define _SSID_IE_ 0 ++#define _SUPPORTEDRATES_IE_ 1 ++#define _DSSET_IE_ 3 ++#define _TIM_IE_ 5 ++#define _IBSS_PARA_IE_ 6 ++#define _COUNTRY_IE_ 7 ++#define _CHLGETXT_IE_ 16 ++#define _SUPPORTED_CH_IE_ 36 ++#define _CH_SWTICH_ANNOUNCE_ 37 /* Secondary Channel Offset */ ++#define _RSN_IE_2_ 48 ++#define _SSN_IE_1_ 221 ++#define _ERPINFO_IE_ 42 ++#define _EXT_SUPPORTEDRATES_IE_ 50 ++ ++#define _HT_CAPABILITY_IE_ 45 ++#define _MDIE_ 54 ++#define _FTIE_ 55 ++#define _TIMEOUT_ITVL_IE_ 56 ++#define _SRC_IE_ 59 ++#define _HT_EXTRA_INFO_IE_ 61 ++#define _HT_ADD_INFO_IE_ 61 /* _HT_EXTRA_INFO_IE_ */ ++#define _WAPI_IE_ 68 ++ ++ ++/* #define EID_BSSCoexistence 72 */ /* 20/40 BSS Coexistence ++ * #define EID_BSSIntolerantChlReport 73 */ ++#define _RIC_Descriptor_IE_ 75 ++#ifdef CONFIG_IEEE80211W ++#define _MME_IE_ 76 /* 802.11w Management MIC element */ ++#endif /* CONFIG_IEEE80211W */ ++#define _LINK_ID_IE_ 101 ++#define _CH_SWITCH_TIMING_ 104 ++#define _PTI_BUFFER_STATUS_ 106 ++#define _EXT_CAP_IE_ 127 ++#define _VENDOR_SPECIFIC_IE_ 221 ++ ++#define _RESERVED47_ 47 ++ ++typedef enum _ELEMENT_ID { ++ EID_SsId = 0, /* service set identifier (0:32) */ ++ EID_SupRates = 1, /* supported rates (1:8) */ ++ EID_FHParms = 2, /* FH parameter set (5) */ ++ EID_DSParms = 3, /* DS parameter set (1) */ ++ EID_CFParms = 4, /* CF parameter set (6) */ ++ EID_Tim = 5, /* Traffic Information Map (4:254) */ ++ EID_IbssParms = 6, /* IBSS parameter set (2) */ ++ EID_Country = 7, /* */ ++ ++ /* Form 7.3.2: Information elements in 802.11E/D13.0, page 46. */ ++ EID_QBSSLoad = 11, ++ EID_EDCAParms = 12, ++ EID_TSpec = 13, ++ EID_TClass = 14, ++ EID_Schedule = 15, ++ /* */ ++ ++ EID_Ctext = 16, /* challenge text*/ ++ EID_POWER_CONSTRAINT = 32, /* Power Constraint*/ ++ ++ /* vivi for WIFITest, 802.11h AP, 20100427 */ ++ /* 2010/12/26 MH The definition we can declare always!! */ ++ EID_PowerCap = 33, ++ EID_SupportedChannels = 36, ++ EID_ChlSwitchAnnounce = 37, ++ ++ EID_MeasureRequest = 38, /* Measurement Request */ ++ EID_MeasureReport = 39, /* Measurement Report */ ++ ++ EID_ERPInfo = 42, ++ ++ /* Form 7.3.2: Information elements in 802.11E/D13.0, page 46. */ ++ EID_TSDelay = 43, ++ EID_TCLASProc = 44, ++ EID_HTCapability = 45, ++ EID_QoSCap = 46, ++ /* */ ++ ++ EID_WPA2 = 48, ++ EID_ExtSupRates = 50, ++ ++ EID_FTIE = 55, /* Defined in 802.11r */ ++ EID_Timeout = 56, /* Defined in 802.11r */ ++ ++ EID_SupRegulatory = 59, /* Supported Requlatory Classes 802.11y */ ++ EID_HTInfo = 61, ++ EID_SecondaryChnlOffset = 62, ++ ++ EID_BSSCoexistence = 72, /* 20/40 BSS Coexistence */ ++ EID_BSSIntolerantChlReport = 73, ++ EID_OBSS = 74, /* Overlapping BSS Scan Parameters */ ++ ++ EID_LinkIdentifier = 101, /* Defined in 802.11z */ ++ EID_WakeupSchedule = 102, /* Defined in 802.11z */ ++ EID_ChnlSwitchTimeing = 104, /* Defined in 802.11z */ ++ EID_PTIControl = 105, /* Defined in 802.11z */ ++ EID_PUBufferStatus = 106, /* Defined in 802.11z */ ++ ++ EID_EXTCapability = 127, /* Extended Capabilities */ ++ /* From S19:Aironet IE and S21:AP IP address IE in CCX v1.13, p16 and p18. */ ++ EID_Aironet = 133, /* 0x85: Aironet Element for Cisco CCX */ ++ EID_CiscoIP = 149, /* 0x95: IP Address IE for Cisco CCX */ ++ ++ EID_CellPwr = 150, /* 0x96: Cell Power Limit IE. Ref. 0x96. */ ++ ++ EID_CCKM = 156, ++ ++ EID_Vendor = 221, /* 0xDD: Vendor Specific */ ++ ++ EID_WAPI = 68, ++ EID_VHTCapability = 191, /* Based on 802.11ac D2.0 */ ++ EID_VHTOperation = 192, /* Based on 802.11ac D2.0 */ ++ EID_AID = 197, /* Based on 802.11ac D4.0 */ ++ EID_OpModeNotification = 199, /* Based on 802.11ac D3.0 */ ++} ELEMENT_ID, *PELEMENT_ID; ++ ++/* --------------------------------------------------------------------------- ++ Below is the fixed elements... ++-----------------------------------------------------------------------------*/ ++#define _AUTH_ALGM_NUM_ 2 ++#define _AUTH_SEQ_NUM_ 2 ++#define _BEACON_ITERVAL_ 2 ++#define _CAPABILITY_ 2 ++#define _CURRENT_APADDR_ 6 ++#define _LISTEN_INTERVAL_ 2 ++#define _RSON_CODE_ 2 ++#define _ASOC_ID_ 2 ++#define _STATUS_CODE_ 2 ++#define _TIMESTAMP_ 8 ++ ++#define AUTH_ODD_TO 0 ++#define AUTH_EVEN_TO 1 ++ ++#define WLAN_ETHCONV_ENCAP 1 ++#define WLAN_ETHCONV_RFC1042 2 ++#define WLAN_ETHCONV_8021h 3 ++ ++#define cap_ESS BIT(0) ++#define cap_IBSS BIT(1) ++#define cap_CFPollable BIT(2) ++#define cap_CFRequest BIT(3) ++#define cap_Privacy BIT(4) ++#define cap_ShortPremble BIT(5) ++#define cap_PBCC BIT(6) ++#define cap_ChAgility BIT(7) ++#define cap_SpecMgmt BIT(8) ++#define cap_QoS BIT(9) ++#define cap_ShortSlot BIT(10) ++ ++/*----------------------------------------------------------------------------- ++ Below is the definition for 802.11i / 802.1x ++------------------------------------------------------------------------------*/ ++#define _IEEE8021X_MGT_ 1 /* WPA */ ++#define _IEEE8021X_PSK_ 2 /* WPA with pre-shared key */ ++ ++#if 0 ++#define _NO_PRIVACY_ 0 ++#define _WEP_40_PRIVACY_ 1 ++#define _TKIP_PRIVACY_ 2 ++#define _WRAP_PRIVACY_ 3 ++#define _CCMP_PRIVACY_ 4 ++#define _WEP_104_PRIVACY_ 5 ++#define _WEP_WPA_MIXED_PRIVACY_ 6 /* WEP + WPA */ ++#endif ++ ++#ifdef CONFIG_IEEE80211W ++#define _MME_IE_LENGTH_ 18 ++#endif /* CONFIG_IEEE80211W */ ++/*----------------------------------------------------------------------------- ++ Below is the definition for WMM ++------------------------------------------------------------------------------*/ ++#define _WMM_IE_Length_ 7 /* for WMM STA */ ++#define _WMM_Para_Element_Length_ 24 ++ ++ ++/*----------------------------------------------------------------------------- ++ Below is the definition for 802.11n ++------------------------------------------------------------------------------*/ ++ ++/* #ifdef CONFIG_80211N_HT */ ++ ++#define SetOrderBit(pbuf) \ ++ do { \ ++ *(unsigned short *)(pbuf) |= cpu_to_le16(_ORDER_); \ ++ } while (0) ++ ++#define GetOrderBit(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_ORDER_)) != 0) ++ ++#define ACT_CAT_VENDOR 0x7F/* 127 */ ++ ++/** ++ * struct rtw_ieee80211_bar - HT Block Ack Request ++ * ++ * This structure refers to "HT BlockAckReq" as ++ * described in 802.11n draft section 7.2.1.7.1 ++ */ ++#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8712FW) ++struct rtw_ieee80211_bar { ++ unsigned short frame_control; ++ unsigned short duration; ++ unsigned char ra[6]; ++ unsigned char ta[6]; ++ unsigned short control; ++ unsigned short start_seq_num; ++} __attribute__((packed)); ++#endif ++ ++/* 802.11 BAR control masks */ ++#define IEEE80211_BAR_CTRL_ACK_POLICY_NORMAL 0x0000 ++#define IEEE80211_BAR_CTRL_CBMTID_COMPRESSED_BA 0x0004 ++ ++ ++#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8712FW) || defined(PLATFORM_FREEBSD) ++ ++ ++ ++/** ++* struct rtw_ieee80211_ht_cap - HT capabilities ++* ++* This structure refers to "HT capabilities element" as ++* described in 802.11n draft section 7.3.2.52 ++*/ ++ ++struct rtw_ieee80211_ht_cap { ++ unsigned short cap_info; ++ unsigned char ampdu_params_info; ++ unsigned char supp_mcs_set[16]; ++ unsigned short extended_ht_cap_info; ++ unsigned int tx_BF_cap_info; ++ unsigned char antenna_selection_info; ++} __attribute__((packed)); ++ ++/** ++ * struct rtw_ieee80211_ht_cap - HT additional information ++ * ++ * This structure refers to "HT information element" as ++ * described in 802.11n draft section 7.3.2.53 ++ */ ++struct ieee80211_ht_addt_info { ++ unsigned char control_chan; ++ unsigned char ht_param; ++ unsigned short operation_mode; ++ unsigned short stbc_param; ++ unsigned char basic_set[16]; ++} __attribute__((packed)); ++ ++ ++struct HT_caps_element { ++ union { ++ struct { ++ unsigned short HT_caps_info; ++ unsigned char AMPDU_para; ++ unsigned char MCS_rate[16]; ++ unsigned short HT_ext_caps; ++ unsigned int Beamforming_caps; ++ unsigned char ASEL_caps; ++ } HT_cap_element; ++ unsigned char HT_cap[26]; ++ } u; ++} __attribute__((packed)); ++ ++struct HT_info_element { ++ unsigned char primary_channel; ++ unsigned char infos[5]; ++ unsigned char MCS_rate[16]; ++} __attribute__((packed)); ++ ++struct AC_param { ++ unsigned char ACI_AIFSN; ++ unsigned char CW; ++ unsigned short TXOP_limit; ++} __attribute__((packed)); ++ ++struct WMM_para_element { ++ unsigned char QoS_info; ++ unsigned char reserved; ++ struct AC_param ac_param[4]; ++} __attribute__((packed)); ++ ++struct ADDBA_request { ++ unsigned char dialog_token; ++ unsigned short BA_para_set; ++ unsigned short BA_timeout_value; ++ unsigned short BA_starting_seqctrl; ++} __attribute__((packed)); ++ ++ ++ ++#endif ++ ++ ++#ifdef PLATFORM_WINDOWS ++ ++#pragma pack(1) ++ ++struct rtw_ieee80211_ht_cap { ++ unsigned short cap_info; ++ unsigned char ampdu_params_info; ++ unsigned char supp_mcs_set[16]; ++ unsigned short extended_ht_cap_info; ++ unsigned int tx_BF_cap_info; ++ unsigned char antenna_selection_info; ++}; ++ ++ ++struct ieee80211_ht_addt_info { ++ unsigned char control_chan; ++ unsigned char ht_param; ++ unsigned short operation_mode; ++ unsigned short stbc_param; ++ unsigned char basic_set[16]; ++}; ++ ++struct HT_caps_element { ++ union { ++ struct { ++ unsigned short HT_caps_info; ++ unsigned char AMPDU_para; ++ unsigned char MCS_rate[16]; ++ unsigned short HT_ext_caps; ++ unsigned int Beamforming_caps; ++ unsigned char ASEL_caps; ++ } HT_cap_element; ++ unsigned char HT_cap[26]; ++ }; ++}; ++ ++struct HT_info_element { ++ unsigned char primary_channel; ++ unsigned char infos[5]; ++ unsigned char MCS_rate[16]; ++}; ++ ++struct AC_param { ++ unsigned char ACI_AIFSN; ++ unsigned char CW; ++ unsigned short TXOP_limit; ++}; ++ ++struct WMM_para_element { ++ unsigned char QoS_info; ++ unsigned char reserved; ++ struct AC_param ac_param[4]; ++}; ++ ++struct ADDBA_request { ++ unsigned char dialog_token; ++ unsigned short BA_para_set; ++ unsigned short BA_timeout_value; ++ unsigned short BA_starting_seqctrl; ++}; ++ ++ ++#pragma pack() ++ ++#endif ++ ++typedef enum _HT_CAP_AMPDU_FACTOR { ++ MAX_AMPDU_FACTOR_8K = 0, ++ MAX_AMPDU_FACTOR_16K = 1, ++ MAX_AMPDU_FACTOR_32K = 2, ++ MAX_AMPDU_FACTOR_64K = 3, ++} HT_CAP_AMPDU_FACTOR; ++ ++ ++typedef enum _HT_CAP_AMPDU_DENSITY { ++ AMPDU_DENSITY_VALUE_0 = 0 , /* For no restriction */ ++ AMPDU_DENSITY_VALUE_1 = 1 , /* For 1/4 us */ ++ AMPDU_DENSITY_VALUE_2 = 2 , /* For 1/2 us */ ++ AMPDU_DENSITY_VALUE_3 = 3 , /* For 1 us */ ++ AMPDU_DENSITY_VALUE_4 = 4 , /* For 2 us */ ++ AMPDU_DENSITY_VALUE_5 = 5 , /* For 4 us */ ++ AMPDU_DENSITY_VALUE_6 = 6 , /* For 8 us */ ++ AMPDU_DENSITY_VALUE_7 = 7 , /* For 16 us */ ++} HT_CAP_AMPDU_DENSITY; ++ ++/* 802.11n HT capabilities masks */ ++#define IEEE80211_HT_CAP_LDPC_CODING 0x0001 ++#define IEEE80211_HT_CAP_SUP_WIDTH 0x0002 ++#define IEEE80211_HT_CAP_SM_PS 0x000C ++#define IEEE80211_HT_CAP_GRN_FLD 0x0010 ++#define IEEE80211_HT_CAP_SGI_20 0x0020 ++#define IEEE80211_HT_CAP_SGI_40 0x0040 ++#define IEEE80211_HT_CAP_TX_STBC 0x0080 ++#define IEEE80211_HT_CAP_RX_STBC_1R 0x0100 ++#define IEEE80211_HT_CAP_RX_STBC_2R 0x0200 ++#define IEEE80211_HT_CAP_RX_STBC_3R 0x0300 ++#define IEEE80211_HT_CAP_DELAY_BA 0x0400 ++#define IEEE80211_HT_CAP_MAX_AMSDU 0x0800 ++#define IEEE80211_HT_CAP_DSSSCCK40 0x1000 ++#define RTW_IEEE80211_HT_CAP_40MHZ_INTOLERANT ((u16) BIT(14)) ++/* 802.11n HT capability AMPDU settings */ ++#define IEEE80211_HT_CAP_AMPDU_FACTOR 0x03 ++#define IEEE80211_HT_CAP_AMPDU_DENSITY 0x1C ++/* 802.11n HT capability MSC set */ ++#define IEEE80211_SUPP_MCS_SET_UEQM 4 ++#define IEEE80211_HT_CAP_MAX_STREAMS 4 ++#define IEEE80211_SUPP_MCS_SET_LEN 10 ++/* maximum streams the spec allows */ ++#define IEEE80211_HT_CAP_MCS_TX_DEFINED 0x01 ++#define IEEE80211_HT_CAP_MCS_TX_RX_DIFF 0x02 ++#define IEEE80211_HT_CAP_MCS_TX_STREAMS 0x0C ++#define IEEE80211_HT_CAP_MCS_TX_UEQM 0x10 ++/* 802.11n HT capability TXBF capability */ ++#define IEEE80211_HT_CAP_TXBF_RX_NDP 0x00000008 ++#define IEEE80211_HT_CAP_TXBF_TX_NDP 0x00000010 ++#define IEEE80211_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP 0x00000400 ++ ++/* 802.11n HT IE masks */ ++#define IEEE80211_HT_IE_CHA_SEC_OFFSET 0x03 ++#define IEEE80211_HT_IE_CHA_SEC_NONE 0x00 ++#define IEEE80211_HT_IE_CHA_SEC_ABOVE 0x01 ++#define IEEE80211_HT_IE_CHA_SEC_BELOW 0x03 ++#define IEEE80211_HT_IE_CHA_WIDTH 0x04 ++#define IEEE80211_HT_IE_HT_PROTECTION 0x0003 ++#define IEEE80211_HT_IE_NON_GF_STA_PRSNT 0x0004 ++#define IEEE80211_HT_IE_NON_HT_STA_PRSNT 0x0010 ++ ++/* block-ack parameters */ ++#define IEEE80211_ADDBA_PARAM_POLICY_MASK 0x0002 ++#define IEEE80211_ADDBA_PARAM_TID_MASK 0x003C ++#define RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK 0xFFC0 ++#define IEEE80211_DELBA_PARAM_TID_MASK 0xF000 ++#define IEEE80211_DELBA_PARAM_INITIATOR_MASK 0x0800 ++ ++/* ++ * A-PMDU buffer sizes ++ * According to IEEE802.11n spec size varies from 8K to 64K (in powers of 2) ++ */ ++#define IEEE80211_MIN_AMPDU_BUF 0x8 ++#define IEEE80211_MAX_AMPDU_BUF 0x40 ++ ++ ++/* Spatial Multiplexing Power Save Modes */ ++#define WLAN_HT_CAP_SM_PS_STATIC 0 ++#define WLAN_HT_CAP_SM_PS_DYNAMIC 1 ++#define WLAN_HT_CAP_SM_PS_INVALID 2 ++#define WLAN_HT_CAP_SM_PS_DISABLED 3 ++ ++ ++#define OP_MODE_PURE 0 ++#define OP_MODE_MAY_BE_LEGACY_STAS 1 ++#define OP_MODE_20MHZ_HT_STA_ASSOCED 2 ++#define OP_MODE_MIXED 3 ++ ++#define HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK ((u8) BIT(0) | BIT(1)) ++#define HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE ((u8) BIT(0)) ++#define HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW ((u8) BIT(0) | BIT(1)) ++#define HT_INFO_HT_PARAM_REC_TRANS_CHNL_WIDTH ((u8) BIT(2)) ++#define HT_INFO_HT_PARAM_RIFS_MODE ((u8) BIT(3)) ++#define HT_INFO_HT_PARAM_CTRL_ACCESS_ONLY ((u8) BIT(4)) ++#define HT_INFO_HT_PARAM_SRV_INTERVAL_GRANULARITY ((u8) BIT(5)) ++ ++#define HT_INFO_OPERATION_MODE_OP_MODE_MASK \ ++ ((u16) (0x0001 | 0x0002)) ++#define HT_INFO_OPERATION_MODE_OP_MODE_OFFSET 0 ++#define HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT ((u8) BIT(2)) ++#define HT_INFO_OPERATION_MODE_TRANSMIT_BURST_LIMIT ((u8) BIT(3)) ++#define HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT ((u8) BIT(4)) ++ ++#define HT_INFO_STBC_PARAM_DUAL_BEACON ((u16) BIT(6)) ++#define HT_INFO_STBC_PARAM_DUAL_STBC_PROTECT ((u16) BIT(7)) ++#define HT_INFO_STBC_PARAM_SECONDARY_BCN ((u16) BIT(8)) ++#define HT_INFO_STBC_PARAM_LSIG_TXOP_PROTECT_ALLOWED ((u16) BIT(9)) ++#define HT_INFO_STBC_PARAM_PCO_ACTIVE ((u16) BIT(10)) ++#define HT_INFO_STBC_PARAM_PCO_PHASE ((u16) BIT(11)) ++ ++ ++ ++/* #endif */ ++ ++/* ===============WPS Section=============== */ ++/* For WPSv1.0 */ ++#define WPSOUI 0x0050f204 ++/* WPS attribute ID */ ++#define WPS_ATTR_VER1 0x104A ++#define WPS_ATTR_SIMPLE_CONF_STATE 0x1044 ++#define WPS_ATTR_RESP_TYPE 0x103B ++#define WPS_ATTR_UUID_E 0x1047 ++#define WPS_ATTR_MANUFACTURER 0x1021 ++#define WPS_ATTR_MODEL_NAME 0x1023 ++#define WPS_ATTR_MODEL_NUMBER 0x1024 ++#define WPS_ATTR_SERIAL_NUMBER 0x1042 ++#define WPS_ATTR_PRIMARY_DEV_TYPE 0x1054 ++#define WPS_ATTR_SEC_DEV_TYPE_LIST 0x1055 ++#define WPS_ATTR_DEVICE_NAME 0x1011 ++#define WPS_ATTR_CONF_METHOD 0x1008 ++#define WPS_ATTR_RF_BANDS 0x103C ++#define WPS_ATTR_DEVICE_PWID 0x1012 ++#define WPS_ATTR_REQUEST_TYPE 0x103A ++#define WPS_ATTR_ASSOCIATION_STATE 0x1002 ++#define WPS_ATTR_CONFIG_ERROR 0x1009 ++#define WPS_ATTR_VENDOR_EXT 0x1049 ++#define WPS_ATTR_SELECTED_REGISTRAR 0x1041 ++ ++/* Value of WPS attribute "WPS_ATTR_DEVICE_NAME */ ++#define WPS_MAX_DEVICE_NAME_LEN 32 ++ ++/* Value of WPS Request Type Attribute */ ++#define WPS_REQ_TYPE_ENROLLEE_INFO_ONLY 0x00 ++#define WPS_REQ_TYPE_ENROLLEE_OPEN_8021X 0x01 ++#define WPS_REQ_TYPE_REGISTRAR 0x02 ++#define WPS_REQ_TYPE_WLAN_MANAGER_REGISTRAR 0x03 ++ ++/* Value of WPS Response Type Attribute */ ++#define WPS_RESPONSE_TYPE_INFO_ONLY 0x00 ++#define WPS_RESPONSE_TYPE_8021X 0x01 ++#define WPS_RESPONSE_TYPE_REGISTRAR 0x02 ++#define WPS_RESPONSE_TYPE_AP 0x03 ++ ++/* Value of WPS WiFi Simple Configuration State Attribute */ ++#define WPS_WSC_STATE_NOT_CONFIG 0x01 ++#define WPS_WSC_STATE_CONFIG 0x02 ++ ++/* Value of WPS Version Attribute */ ++#define WPS_VERSION_1 0x10 ++ ++/* Value of WPS Configuration Method Attribute */ ++#define WPS_CONFIG_METHOD_FLASH 0x0001 ++#define WPS_CONFIG_METHOD_ETHERNET 0x0002 ++#define WPS_CONFIG_METHOD_LABEL 0x0004 ++#define WPS_CONFIG_METHOD_DISPLAY 0x0008 ++#define WPS_CONFIG_METHOD_E_NFC 0x0010 ++#define WPS_CONFIG_METHOD_I_NFC 0x0020 ++#define WPS_CONFIG_METHOD_NFC 0x0040 ++#define WPS_CONFIG_METHOD_PBC 0x0080 ++#define WPS_CONFIG_METHOD_KEYPAD 0x0100 ++#define WPS_CONFIG_METHOD_VPBC 0x0280 ++#define WPS_CONFIG_METHOD_PPBC 0x0480 ++#define WPS_CONFIG_METHOD_VDISPLAY 0x2008 ++#define WPS_CONFIG_METHOD_PDISPLAY 0x4008 ++ ++/* Value of Category ID of WPS Primary Device Type Attribute */ ++#define WPS_PDT_CID_DISPLAYS 0x0007 ++#define WPS_PDT_CID_MULIT_MEDIA 0x0008 ++#define WPS_PDT_CID_RTK_WIDI WPS_PDT_CID_MULIT_MEDIA ++ ++/* Value of Sub Category ID of WPS Primary Device Type Attribute */ ++#define WPS_PDT_SCID_MEDIA_SERVER 0x0005 ++#define WPS_PDT_SCID_RTK_DMP WPS_PDT_SCID_MEDIA_SERVER ++ ++/* Value of Device Password ID */ ++#define WPS_DPID_PIN 0x0000 ++#define WPS_DPID_USER_SPEC 0x0001 ++#define WPS_DPID_MACHINE_SPEC 0x0002 ++#define WPS_DPID_REKEY 0x0003 ++#define WPS_DPID_PBC 0x0004 ++#define WPS_DPID_REGISTRAR_SPEC 0x0005 ++ ++/* Value of WPS RF Bands Attribute */ ++#define WPS_RF_BANDS_2_4_GHZ 0x01 ++#define WPS_RF_BANDS_5_GHZ 0x02 ++ ++/* Value of WPS Association State Attribute */ ++#define WPS_ASSOC_STATE_NOT_ASSOCIATED 0x00 ++#define WPS_ASSOC_STATE_CONNECTION_SUCCESS 0x01 ++#define WPS_ASSOC_STATE_CONFIGURATION_FAILURE 0x02 ++#define WPS_ASSOC_STATE_ASSOCIATION_FAILURE 0x03 ++#define WPS_ASSOC_STATE_IP_FAILURE 0x04 ++ ++/* =====================P2P Section===================== */ ++/* For P2P */ ++#define P2POUI 0x506F9A09 ++ ++/* P2P Attribute ID */ ++#define P2P_ATTR_STATUS 0x00 ++#define P2P_ATTR_MINOR_REASON_CODE 0x01 ++#define P2P_ATTR_CAPABILITY 0x02 ++#define P2P_ATTR_DEVICE_ID 0x03 ++#define P2P_ATTR_GO_INTENT 0x04 ++#define P2P_ATTR_CONF_TIMEOUT 0x05 ++#define P2P_ATTR_LISTEN_CH 0x06 ++#define P2P_ATTR_GROUP_BSSID 0x07 ++#define P2P_ATTR_EX_LISTEN_TIMING 0x08 ++#define P2P_ATTR_INTENDED_IF_ADDR 0x09 ++#define P2P_ATTR_MANAGEABILITY 0x0A ++#define P2P_ATTR_CH_LIST 0x0B ++#define P2P_ATTR_NOA 0x0C ++#define P2P_ATTR_DEVICE_INFO 0x0D ++#define P2P_ATTR_GROUP_INFO 0x0E ++#define P2P_ATTR_GROUP_ID 0x0F ++#define P2P_ATTR_INTERFACE 0x10 ++#define P2P_ATTR_OPERATING_CH 0x11 ++#define P2P_ATTR_INVITATION_FLAGS 0x12 ++ ++/* Value of Status Attribute */ ++#define P2P_STATUS_SUCCESS 0x00 ++#define P2P_STATUS_FAIL_INFO_UNAVAILABLE 0x01 ++#define P2P_STATUS_FAIL_INCOMPATIBLE_PARAM 0x02 ++#define P2P_STATUS_FAIL_LIMIT_REACHED 0x03 ++#define P2P_STATUS_FAIL_INVALID_PARAM 0x04 ++#define P2P_STATUS_FAIL_REQUEST_UNABLE 0x05 ++#define P2P_STATUS_FAIL_PREVOUS_PROTO_ERR 0x06 ++#define P2P_STATUS_FAIL_NO_COMMON_CH 0x07 ++#define P2P_STATUS_FAIL_UNKNOWN_P2PGROUP 0x08 ++#define P2P_STATUS_FAIL_BOTH_GOINTENT_15 0x09 ++#define P2P_STATUS_FAIL_INCOMPATIBLE_PROVSION 0x0A ++#define P2P_STATUS_FAIL_USER_REJECT 0x0B ++ ++/* Value of Inviation Flags Attribute */ ++#define P2P_INVITATION_FLAGS_PERSISTENT BIT(0) ++ ++#define DMP_P2P_DEVCAP_SUPPORT (P2P_DEVCAP_SERVICE_DISCOVERY | \ ++ P2P_DEVCAP_CLIENT_DISCOVERABILITY | \ ++ P2P_DEVCAP_CONCURRENT_OPERATION | \ ++ P2P_DEVCAP_INVITATION_PROC) ++ ++#define DMP_P2P_GRPCAP_SUPPORT (P2P_GRPCAP_INTRABSS) ++ ++/* Value of Device Capability Bitmap */ ++#define P2P_DEVCAP_SERVICE_DISCOVERY BIT(0) ++#define P2P_DEVCAP_CLIENT_DISCOVERABILITY BIT(1) ++#define P2P_DEVCAP_CONCURRENT_OPERATION BIT(2) ++#define P2P_DEVCAP_INFRA_MANAGED BIT(3) ++#define P2P_DEVCAP_DEVICE_LIMIT BIT(4) ++#define P2P_DEVCAP_INVITATION_PROC BIT(5) ++ ++/* Value of Group Capability Bitmap */ ++#define P2P_GRPCAP_GO BIT(0) ++#define P2P_GRPCAP_PERSISTENT_GROUP BIT(1) ++#define P2P_GRPCAP_GROUP_LIMIT BIT(2) ++#define P2P_GRPCAP_INTRABSS BIT(3) ++#define P2P_GRPCAP_CROSS_CONN BIT(4) ++#define P2P_GRPCAP_PERSISTENT_RECONN BIT(5) ++#define P2P_GRPCAP_GROUP_FORMATION BIT(6) ++ ++/* P2P Public Action Frame ( Management Frame ) */ ++#define P2P_PUB_ACTION_ACTION 0x09 ++ ++/* P2P Public Action Frame Type */ ++#define P2P_GO_NEGO_REQ 0 ++#define P2P_GO_NEGO_RESP 1 ++#define P2P_GO_NEGO_CONF 2 ++#define P2P_INVIT_REQ 3 ++#define P2P_INVIT_RESP 4 ++#define P2P_DEVDISC_REQ 5 ++#define P2P_DEVDISC_RESP 6 ++#define P2P_PROVISION_DISC_REQ 7 ++#define P2P_PROVISION_DISC_RESP 8 ++ ++/* P2P Action Frame Type */ ++#define P2P_NOTICE_OF_ABSENCE 0 ++#define P2P_PRESENCE_REQUEST 1 ++#define P2P_PRESENCE_RESPONSE 2 ++#define P2P_GO_DISC_REQUEST 3 ++ ++ ++#define P2P_MAX_PERSISTENT_GROUP_NUM 10 ++ ++#define P2P_PROVISIONING_SCAN_CNT 3 ++ ++#define P2P_WILDCARD_SSID_LEN 7 ++ ++#define P2P_FINDPHASE_EX_NONE 0 /* default value, used when: (1)p2p disabed or (2)p2p enabled but only do 1 scan phase */ ++#define P2P_FINDPHASE_EX_FULL 1 /* used when p2p enabled and want to do 1 scan phase and P2P_FINDPHASE_EX_MAX-1 find phase */ ++#define P2P_FINDPHASE_EX_SOCIAL_FIRST (P2P_FINDPHASE_EX_FULL+1) ++#define P2P_FINDPHASE_EX_MAX 4 ++#define P2P_FINDPHASE_EX_SOCIAL_LAST P2P_FINDPHASE_EX_MAX ++ ++#define P2P_PROVISION_TIMEOUT 5000 /* 5 seconds timeout for sending the provision discovery request */ ++#define P2P_CONCURRENT_PROVISION_TIMEOUT 3000 /* 3 seconds timeout for sending the provision discovery request under concurrent mode */ ++#define P2P_GO_NEGO_TIMEOUT 5000 /* 5 seconds timeout for receiving the group negotation response */ ++#define P2P_CONCURRENT_GO_NEGO_TIMEOUT 3000 /* 3 seconds timeout for sending the negotiation request under concurrent mode */ ++#define P2P_TX_PRESCAN_TIMEOUT 100 /* 100ms */ ++#define P2P_INVITE_TIMEOUT 5000 /* 5 seconds timeout for sending the invitation request */ ++#define P2P_CONCURRENT_INVITE_TIMEOUT 3000 /* 3 seconds timeout for sending the invitation request under concurrent mode */ ++#define P2P_RESET_SCAN_CH 25000 /* 25 seconds timeout to reset the scan channel (based on channel plan) */ ++#define P2P_MAX_INTENT 15 ++ ++#define P2P_MAX_NOA_NUM 2 ++ ++/* WPS Configuration Method */ ++#define WPS_CM_NONE 0x0000 ++#define WPS_CM_LABEL 0x0004 ++#define WPS_CM_DISPLYA 0x0008 ++#define WPS_CM_EXTERNAL_NFC_TOKEN 0x0010 ++#define WPS_CM_INTEGRATED_NFC_TOKEN 0x0020 ++#define WPS_CM_NFC_INTERFACE 0x0040 ++#define WPS_CM_PUSH_BUTTON 0x0080 ++#define WPS_CM_KEYPAD 0x0100 ++#define WPS_CM_SW_PUHS_BUTTON 0x0280 ++#define WPS_CM_HW_PUHS_BUTTON 0x0480 ++#define WPS_CM_SW_DISPLAY_PIN 0x2008 ++#define WPS_CM_LCD_DISPLAY_PIN 0x4008 ++ ++enum P2P_ROLE { ++ P2P_ROLE_DISABLE = 0, ++ P2P_ROLE_DEVICE = 1, ++ P2P_ROLE_CLIENT = 2, ++ P2P_ROLE_GO = 3 ++}; ++ ++enum P2P_STATE { ++ P2P_STATE_NONE = 0, /* P2P disable */ ++ P2P_STATE_IDLE = 1, /* P2P had enabled and do nothing , buddy adapters is linked */ ++ P2P_STATE_LISTEN = 2, /* In pure listen state */ ++ P2P_STATE_SCAN = 3, /* In scan phase */ ++ P2P_STATE_FIND_PHASE_LISTEN = 4, /* In the listen state of find phase */ ++ P2P_STATE_FIND_PHASE_SEARCH = 5, /* In the search state of find phase */ ++ P2P_STATE_TX_PROVISION_DIS_REQ = 6, /* In P2P provisioning discovery */ ++ P2P_STATE_RX_PROVISION_DIS_RSP = 7, ++ P2P_STATE_RX_PROVISION_DIS_REQ = 8, ++ P2P_STATE_GONEGO_ING = 9, /* Doing the group owner negoitation handshake */ ++ P2P_STATE_GONEGO_OK = 10, /* finish the group negoitation handshake with success */ ++ P2P_STATE_GONEGO_FAIL = 11, /* finish the group negoitation handshake with failure */ ++ P2P_STATE_RECV_INVITE_REQ_MATCH = 12, /* receiving the P2P Inviation request and match with the profile. */ ++ P2P_STATE_PROVISIONING_ING = 13, /* Doing the P2P WPS */ ++ P2P_STATE_PROVISIONING_DONE = 14, /* Finish the P2P WPS */ ++ P2P_STATE_TX_INVITE_REQ = 15, /* Transmit the P2P Invitation request */ ++ P2P_STATE_RX_INVITE_RESP_OK = 16, /* Receiving the P2P Invitation response */ ++ P2P_STATE_RECV_INVITE_REQ_DISMATCH = 17, /* receiving the P2P Inviation request and dismatch with the profile. */ ++ P2P_STATE_RECV_INVITE_REQ_GO = 18, /* receiving the P2P Inviation request and this wifi is GO. */ ++ P2P_STATE_RECV_INVITE_REQ_JOIN = 19, /* receiving the P2P Inviation request to join an existing P2P Group. */ ++ P2P_STATE_RX_INVITE_RESP_FAIL = 20, /* recveing the P2P Inviation response with failure */ ++ P2P_STATE_RX_INFOR_NOREADY = 21, /* receiving p2p negoitation response with information is not available */ ++ P2P_STATE_TX_INFOR_NOREADY = 22, /* sending p2p negoitation response with information is not available */ ++}; ++ ++enum P2P_WPSINFO { ++ P2P_NO_WPSINFO = 0, ++ P2P_GOT_WPSINFO_PEER_DISPLAY_PIN = 1, ++ P2P_GOT_WPSINFO_SELF_DISPLAY_PIN = 2, ++ P2P_GOT_WPSINFO_PBC = 3, ++}; ++ ++#define P2P_PRIVATE_IOCTL_SET_LEN 64 ++ ++enum P2P_PROTO_WK_ID { ++ P2P_FIND_PHASE_WK = 0, ++ P2P_RESTORE_STATE_WK = 1, ++ P2P_PRE_TX_PROVDISC_PROCESS_WK = 2, ++ P2P_PRE_TX_NEGOREQ_PROCESS_WK = 3, ++ P2P_PRE_TX_INVITEREQ_PROCESS_WK = 4, ++ P2P_AP_P2P_CH_SWITCH_PROCESS_WK = 5, ++ P2P_RO_CH_WK = 6, ++ P2P_CANCEL_RO_CH_WK = 7, ++}; ++ ++#ifdef CONFIG_P2P_PS ++enum P2P_PS_STATE { ++ P2P_PS_DISABLE = 0, ++ P2P_PS_ENABLE = 1, ++ P2P_PS_SCAN = 2, ++ P2P_PS_SCAN_DONE = 3, ++ P2P_PS_ALLSTASLEEP = 4, /* for P2P GO */ ++}; ++ ++enum P2P_PS_MODE { ++ P2P_PS_NONE = 0, ++ P2P_PS_CTWINDOW = 1, ++ P2P_PS_NOA = 2, ++ P2P_PS_MIX = 3, /* CTWindow and NoA */ ++}; ++#endif /* CONFIG_P2P_PS */ ++ ++/* =====================WFD Section===================== ++ * For Wi-Fi Display */ ++#define WFD_ATTR_DEVICE_INFO 0x00 ++#define WFD_ATTR_ASSOC_BSSID 0x01 ++#define WFD_ATTR_COUPLED_SINK_INFO 0x06 ++#define WFD_ATTR_LOCAL_IP_ADDR 0x08 ++#define WFD_ATTR_SESSION_INFO 0x09 ++#define WFD_ATTR_ALTER_MAC 0x0a ++ ++/* For WFD Device Information Attribute */ ++#define WFD_DEVINFO_SOURCE 0x0000 ++#define WFD_DEVINFO_PSINK 0x0001 ++#define WFD_DEVINFO_SSINK 0x0002 ++#define WFD_DEVINFO_DUAL 0x0003 ++ ++#define WFD_DEVINFO_SESSION_AVAIL 0x0010 ++#define WFD_DEVINFO_WSD 0x0040 ++#define WFD_DEVINFO_PC_TDLS 0x0080 ++#define WFD_DEVINFO_HDCP_SUPPORT 0x0100 ++ ++#ifdef CONFIG_TX_MCAST2UNI ++#define IP_MCAST_MAC(mac) ((mac[0] == 0x01) && (mac[1] == 0x00) && (mac[2] == 0x5e)) ++#define ICMPV6_MCAST_MAC(mac) ((mac[0] == 0x33) && (mac[1] == 0x33) && (mac[2] != 0xff)) ++#endif /* CONFIG_TX_MCAST2UNI */ ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++/* Regulatroy Domain */ ++struct regd_pair_mapping { ++ u16 reg_dmnenum; ++ u16 reg_5ghz_ctl; ++ u16 reg_2ghz_ctl; ++}; ++ ++struct rtw_regulatory { ++ char alpha2[2]; ++ u16 country_code; ++ u16 max_power_level; ++ u32 tp_scale; ++ u16 current_rd; ++ u16 current_rd_ext; ++ int16_t power_limit; ++ struct regd_pair_mapping *regpair; ++}; ++#endif ++ ++#ifdef CONFIG_WAPI_SUPPORT ++#ifndef IW_AUTH_WAPI_VERSION_1 ++#define IW_AUTH_WAPI_VERSION_1 0x00000008 ++#endif ++#ifndef IW_AUTH_KEY_MGMT_WAPI_PSK ++#define IW_AUTH_KEY_MGMT_WAPI_PSK 0x04 ++#endif ++#ifndef IW_AUTH_WAPI_ENABLED ++#define IW_AUTH_WAPI_ENABLED 0x20 ++#endif ++#ifndef IW_ENCODE_ALG_SM4 ++#define IW_ENCODE_ALG_SM4 0x20 ++#endif ++#endif ++ ++#endif /* _WIFI_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/wlan_bssdef.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/wlan_bssdef.h +--- linux-4.14.18/3rdparty/rtl8723de/include/wlan_bssdef.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/wlan_bssdef.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,690 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __WLAN_BSSDEF_H__ ++#define __WLAN_BSSDEF_H__ ++ ++ ++#define MAX_IE_SZ 768 ++ ++ ++#ifdef PLATFORM_LINUX ++ ++#define NDIS_802_11_LENGTH_SSID 32 ++#define NDIS_802_11_LENGTH_RATES 8 ++#define NDIS_802_11_LENGTH_RATES_EX 16 ++ ++typedef unsigned char NDIS_802_11_MAC_ADDRESS[6]; ++typedef long NDIS_802_11_RSSI; /* in dBm */ ++typedef unsigned char NDIS_802_11_RATES[NDIS_802_11_LENGTH_RATES]; /* Set of 8 data rates */ ++typedef unsigned char NDIS_802_11_RATES_EX[NDIS_802_11_LENGTH_RATES_EX]; /* Set of 16 data rates */ ++ ++ ++typedef ULONG NDIS_802_11_KEY_INDEX; ++typedef unsigned long long NDIS_802_11_KEY_RSC; ++ ++ ++typedef struct _NDIS_802_11_SSID { ++ ULONG SsidLength; ++ UCHAR Ssid[32]; ++} NDIS_802_11_SSID, *PNDIS_802_11_SSID; ++ ++typedef enum _NDIS_802_11_NETWORK_TYPE { ++ Ndis802_11FH, ++ Ndis802_11DS, ++ Ndis802_11OFDM5, ++ Ndis802_11OFDM24, ++ Ndis802_11NetworkTypeMax /* not a real type, defined as an upper bound */ ++} NDIS_802_11_NETWORK_TYPE, *PNDIS_802_11_NETWORK_TYPE; ++ ++typedef struct _NDIS_802_11_CONFIGURATION_FH { ++ ULONG Length; /* Length of structure */ ++ ULONG HopPattern; /* As defined by 802.11, MSB set */ ++ ULONG HopSet; /* to one if non-802.11 */ ++ ULONG DwellTime; /* units are Kusec */ ++} NDIS_802_11_CONFIGURATION_FH, *PNDIS_802_11_CONFIGURATION_FH; ++ ++ ++/* ++ FW will only save the channel number in DSConfig. ++ ODI Handler will convert the channel number to freq. number. ++*/ ++typedef struct _NDIS_802_11_CONFIGURATION { ++ ULONG Length; /* Length of structure */ ++ ULONG BeaconPeriod; /* units are Kusec */ ++ ULONG ATIMWindow; /* units are Kusec */ ++ ULONG DSConfig; /* channel number */ ++ NDIS_802_11_CONFIGURATION_FH FHConfig; ++} NDIS_802_11_CONFIGURATION, *PNDIS_802_11_CONFIGURATION; ++ ++ ++ ++typedef enum _NDIS_802_11_NETWORK_INFRASTRUCTURE { ++ Ndis802_11IBSS, ++ Ndis802_11Infrastructure, ++ Ndis802_11AutoUnknown, ++ Ndis802_11InfrastructureMax, /* Not a real value, defined as upper bound */ ++ Ndis802_11APMode, ++ Ndis802_11Monitor, ++} NDIS_802_11_NETWORK_INFRASTRUCTURE, *PNDIS_802_11_NETWORK_INFRASTRUCTURE; ++ ++ ++ ++ ++ ++typedef struct _NDIS_802_11_FIXED_IEs { ++ UCHAR Timestamp[8]; ++ USHORT BeaconInterval; ++ USHORT Capabilities; ++} NDIS_802_11_FIXED_IEs, *PNDIS_802_11_FIXED_IEs; ++ ++ ++ ++typedef struct _NDIS_802_11_VARIABLE_IEs { ++ UCHAR ElementID; ++ UCHAR Length; ++ UCHAR data[1]; ++} NDIS_802_11_VARIABLE_IEs, *PNDIS_802_11_VARIABLE_IEs; ++ ++ ++ ++/* ++ ++ ++ ++Length is the 4 bytes multiples of the sume of ++ sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + sizeof (NDIS_802_11_SSID) + sizeof (ULONG) +++ sizeof (NDIS_802_11_RSSI) + sizeof (NDIS_802_11_NETWORK_TYPE) + sizeof (NDIS_802_11_CONFIGURATION) +++ sizeof (NDIS_802_11_RATES_EX) + IELength ++ ++Except the IELength, all other fields are fixed length. Therefore, we can define a marco to present the ++partial sum. ++ ++*/ ++#if 0 ++typedef struct _NDIS_WLAN_BSSID_EX { ++ ULONG Length; ++ NDIS_802_11_MAC_ADDRESS MacAddress; ++ UCHAR Reserved[2];/* [0]: IS beacon frame, [1]:optimum_antenna=>For antenna diversity; */ ++ NDIS_802_11_SSID Ssid; ++ ULONG Privacy; ++ NDIS_802_11_RSSI Rssi; ++ NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; ++ NDIS_802_11_CONFIGURATION Configuration; ++ NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; ++ NDIS_802_11_RATES_EX SupportedRates; ++ ULONG IELength; ++ UCHAR IEs[MAX_IE_SZ]; /* (timestamp, beacon interval, and capability information) */ ++} NDIS_WLAN_BSSID_EX, *PNDIS_WLAN_BSSID_EX; ++ ++ ++typedef struct _NDIS_802_11_BSSID_LIST_EX { ++ ULONG NumberOfItems; ++ NDIS_WLAN_BSSID_EX Bssid[1]; ++} NDIS_802_11_BSSID_LIST_EX, *PNDIS_802_11_BSSID_LIST_EX; ++#endif ++ ++typedef enum _NDIS_802_11_AUTHENTICATION_MODE { ++ Ndis802_11AuthModeOpen, ++ Ndis802_11AuthModeShared, ++ Ndis802_11AuthModeAutoSwitch, ++ Ndis802_11AuthModeWPA, ++ Ndis802_11AuthModeWPAPSK, ++ Ndis802_11AuthModeWPANone, ++ Ndis802_11AuthModeWAPI, ++ Ndis802_11AuthModeMax /* Not a real mode, defined as upper bound */ ++} NDIS_802_11_AUTHENTICATION_MODE, *PNDIS_802_11_AUTHENTICATION_MODE; ++ ++typedef enum _NDIS_802_11_WEP_STATUS { ++ Ndis802_11WEPEnabled, ++ Ndis802_11Encryption1Enabled = Ndis802_11WEPEnabled, ++ Ndis802_11WEPDisabled, ++ Ndis802_11EncryptionDisabled = Ndis802_11WEPDisabled, ++ Ndis802_11WEPKeyAbsent, ++ Ndis802_11Encryption1KeyAbsent = Ndis802_11WEPKeyAbsent, ++ Ndis802_11WEPNotSupported, ++ Ndis802_11EncryptionNotSupported = Ndis802_11WEPNotSupported, ++ Ndis802_11Encryption2Enabled, ++ Ndis802_11Encryption2KeyAbsent, ++ Ndis802_11Encryption3Enabled, ++ Ndis802_11Encryption3KeyAbsent, ++ Ndis802_11_EncrypteionWAPI ++} NDIS_802_11_WEP_STATUS, *PNDIS_802_11_WEP_STATUS, ++NDIS_802_11_ENCRYPTION_STATUS, *PNDIS_802_11_ENCRYPTION_STATUS; ++ ++ ++#define NDIS_802_11_AI_REQFI_CAPABILITIES 1 ++#define NDIS_802_11_AI_REQFI_LISTENINTERVAL 2 ++#define NDIS_802_11_AI_REQFI_CURRENTAPADDRESS 4 ++ ++#define NDIS_802_11_AI_RESFI_CAPABILITIES 1 ++#define NDIS_802_11_AI_RESFI_STATUSCODE 2 ++#define NDIS_802_11_AI_RESFI_ASSOCIATIONID 4 ++ ++typedef struct _NDIS_802_11_AI_REQFI { ++ USHORT Capabilities; ++ USHORT ListenInterval; ++ NDIS_802_11_MAC_ADDRESS CurrentAPAddress; ++} NDIS_802_11_AI_REQFI, *PNDIS_802_11_AI_REQFI; ++ ++typedef struct _NDIS_802_11_AI_RESFI { ++ USHORT Capabilities; ++ USHORT StatusCode; ++ USHORT AssociationId; ++} NDIS_802_11_AI_RESFI, *PNDIS_802_11_AI_RESFI; ++ ++typedef struct _NDIS_802_11_ASSOCIATION_INFORMATION { ++ ULONG Length; ++ USHORT AvailableRequestFixedIEs; ++ NDIS_802_11_AI_REQFI RequestFixedIEs; ++ ULONG RequestIELength; ++ ULONG OffsetRequestIEs; ++ USHORT AvailableResponseFixedIEs; ++ NDIS_802_11_AI_RESFI ResponseFixedIEs; ++ ULONG ResponseIELength; ++ ULONG OffsetResponseIEs; ++} NDIS_802_11_ASSOCIATION_INFORMATION, *PNDIS_802_11_ASSOCIATION_INFORMATION; ++ ++typedef enum _NDIS_802_11_RELOAD_DEFAULTS { ++ Ndis802_11ReloadWEPKeys ++} NDIS_802_11_RELOAD_DEFAULTS, *PNDIS_802_11_RELOAD_DEFAULTS; ++ ++ ++/* Key mapping keys require a BSSID */ ++typedef struct _NDIS_802_11_KEY { ++ ULONG Length; /* Length of this structure */ ++ ULONG KeyIndex; ++ ULONG KeyLength; /* length of key in bytes */ ++ NDIS_802_11_MAC_ADDRESS BSSID; ++ NDIS_802_11_KEY_RSC KeyRSC; ++ UCHAR KeyMaterial[32]; /* variable length depending on above field */ ++} NDIS_802_11_KEY, *PNDIS_802_11_KEY; ++ ++typedef struct _NDIS_802_11_REMOVE_KEY { ++ ULONG Length; /* Length of this structure */ ++ ULONG KeyIndex; ++ NDIS_802_11_MAC_ADDRESS BSSID; ++} NDIS_802_11_REMOVE_KEY, *PNDIS_802_11_REMOVE_KEY; ++ ++typedef struct _NDIS_802_11_WEP { ++ ULONG Length; /* Length of this structure */ ++ ULONG KeyIndex; /* 0 is the per-client key, 1-N are the global keys */ ++ ULONG KeyLength; /* length of key in bytes */ ++ UCHAR KeyMaterial[16];/* variable length depending on above field */ ++} NDIS_802_11_WEP, *PNDIS_802_11_WEP; ++ ++typedef struct _NDIS_802_11_AUTHENTICATION_REQUEST { ++ ULONG Length; /* Length of structure */ ++ NDIS_802_11_MAC_ADDRESS Bssid; ++ ULONG Flags; ++} NDIS_802_11_AUTHENTICATION_REQUEST, *PNDIS_802_11_AUTHENTICATION_REQUEST; ++ ++typedef enum _NDIS_802_11_STATUS_TYPE { ++ Ndis802_11StatusType_Authentication, ++ Ndis802_11StatusType_MediaStreamMode, ++ Ndis802_11StatusType_PMKID_CandidateList, ++ Ndis802_11StatusTypeMax /* not a real type, defined as an upper bound */ ++} NDIS_802_11_STATUS_TYPE, *PNDIS_802_11_STATUS_TYPE; ++ ++typedef struct _NDIS_802_11_STATUS_INDICATION { ++ NDIS_802_11_STATUS_TYPE StatusType; ++} NDIS_802_11_STATUS_INDICATION, *PNDIS_802_11_STATUS_INDICATION; ++ ++/* mask for authentication/integrity fields */ ++#define NDIS_802_11_AUTH_REQUEST_AUTH_FIELDS 0x0f ++#define NDIS_802_11_AUTH_REQUEST_REAUTH 0x01 ++#define NDIS_802_11_AUTH_REQUEST_KEYUPDATE 0x02 ++#define NDIS_802_11_AUTH_REQUEST_PAIRWISE_ERROR 0x06 ++#define NDIS_802_11_AUTH_REQUEST_GROUP_ERROR 0x0E ++ ++/* MIC check time, 60 seconds. */ ++#define MIC_CHECK_TIME 60000000 ++ ++typedef struct _NDIS_802_11_AUTHENTICATION_EVENT { ++ NDIS_802_11_STATUS_INDICATION Status; ++ NDIS_802_11_AUTHENTICATION_REQUEST Request[1]; ++} NDIS_802_11_AUTHENTICATION_EVENT, *PNDIS_802_11_AUTHENTICATION_EVENT; ++ ++typedef struct _NDIS_802_11_TEST { ++ ULONG Length; ++ ULONG Type; ++ union { ++ NDIS_802_11_AUTHENTICATION_EVENT AuthenticationEvent; ++ NDIS_802_11_RSSI RssiTrigger; ++ } tt; ++} NDIS_802_11_TEST, *PNDIS_802_11_TEST; ++ ++ ++#endif /* end of #ifdef PLATFORM_LINUX */ ++ ++#ifdef PLATFORM_FREEBSD ++ ++#define NDIS_802_11_LENGTH_SSID 32 ++#define NDIS_802_11_LENGTH_RATES 8 ++#define NDIS_802_11_LENGTH_RATES_EX 16 ++ ++typedef unsigned char NDIS_802_11_MAC_ADDRESS[6]; ++typedef long NDIS_802_11_RSSI; /* in dBm */ ++typedef unsigned char NDIS_802_11_RATES[NDIS_802_11_LENGTH_RATES]; /* Set of 8 data rates */ ++typedef unsigned char NDIS_802_11_RATES_EX[NDIS_802_11_LENGTH_RATES_EX]; /* Set of 16 data rates */ ++ ++ ++typedef ULONG NDIS_802_11_KEY_INDEX; ++typedef unsigned long long NDIS_802_11_KEY_RSC; ++ ++ ++typedef struct _NDIS_802_11_SSID { ++ ULONG SsidLength; ++ UCHAR Ssid[32]; ++} NDIS_802_11_SSID, *PNDIS_802_11_SSID; ++ ++typedef enum _NDIS_802_11_NETWORK_TYPE { ++ Ndis802_11FH, ++ Ndis802_11DS, ++ Ndis802_11OFDM5, ++ Ndis802_11OFDM24, ++ Ndis802_11NetworkTypeMax /* not a real type, defined as an upper bound */ ++} NDIS_802_11_NETWORK_TYPE, *PNDIS_802_11_NETWORK_TYPE; ++ ++typedef struct _NDIS_802_11_CONFIGURATION_FH { ++ ULONG Length; /* Length of structure */ ++ ULONG HopPattern; /* As defined by 802.11, MSB set */ ++ ULONG HopSet; /* to one if non-802.11 */ ++ ULONG DwellTime; /* units are Kusec */ ++} NDIS_802_11_CONFIGURATION_FH, *PNDIS_802_11_CONFIGURATION_FH; ++ ++ ++/* ++ FW will only save the channel number in DSConfig. ++ ODI Handler will convert the channel number to freq. number. ++*/ ++typedef struct _NDIS_802_11_CONFIGURATION { ++ ULONG Length; /* Length of structure */ ++ ULONG BeaconPeriod; /* units are Kusec */ ++ ULONG ATIMWindow; /* units are Kusec */ ++ ULONG DSConfig; /* channel number */ ++ NDIS_802_11_CONFIGURATION_FH FHConfig; ++} NDIS_802_11_CONFIGURATION, *PNDIS_802_11_CONFIGURATION; ++ ++ ++ ++typedef enum _NDIS_802_11_NETWORK_INFRASTRUCTURE { ++ Ndis802_11IBSS, ++ Ndis802_11Infrastructure, ++ Ndis802_11AutoUnknown, ++ Ndis802_11InfrastructureMax, /* Not a real value, defined as upper bound */ ++ Ndis802_11APMode ++} NDIS_802_11_NETWORK_INFRASTRUCTURE, *PNDIS_802_11_NETWORK_INFRASTRUCTURE; ++ ++ ++ ++ ++ ++typedef struct _NDIS_802_11_FIXED_IEs { ++ UCHAR Timestamp[8]; ++ USHORT BeaconInterval; ++ USHORT Capabilities; ++} NDIS_802_11_FIXED_IEs, *PNDIS_802_11_FIXED_IEs; ++ ++ ++ ++typedef struct _NDIS_802_11_VARIABLE_IEs { ++ UCHAR ElementID; ++ UCHAR Length; ++ UCHAR data[1]; ++} NDIS_802_11_VARIABLE_IEs, *PNDIS_802_11_VARIABLE_IEs; ++ ++ ++ ++/* ++ ++ ++ ++Length is the 4 bytes multiples of the sume of ++ sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + sizeof (NDIS_802_11_SSID) + sizeof (ULONG) +++ sizeof (NDIS_802_11_RSSI) + sizeof (NDIS_802_11_NETWORK_TYPE) + sizeof (NDIS_802_11_CONFIGURATION) +++ sizeof (NDIS_802_11_RATES_EX) + IELength ++ ++Except the IELength, all other fields are fixed length. Therefore, we can define a marco to present the ++partial sum. ++ ++*/ ++#if 0 ++typedef struct _NDIS_WLAN_BSSID_EX { ++ ULONG Length; ++ NDIS_802_11_MAC_ADDRESS MacAddress; ++ UCHAR Reserved[2];/* [0]: IS beacon frame, [1]:optimum_antenna=>For antenna diversity; */ ++ NDIS_802_11_SSID Ssid; ++ ULONG Privacy; ++ NDIS_802_11_RSSI Rssi; ++ NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; ++ NDIS_802_11_CONFIGURATION Configuration; ++ NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; ++ NDIS_802_11_RATES_EX SupportedRates; ++ ULONG IELength; ++ UCHAR IEs[MAX_IE_SZ]; /* (timestamp, beacon interval, and capability information) */ ++} NDIS_WLAN_BSSID_EX, *PNDIS_WLAN_BSSID_EX; ++ ++ ++typedef struct _NDIS_802_11_BSSID_LIST_EX { ++ ULONG NumberOfItems; ++ NDIS_WLAN_BSSID_EX Bssid[1]; ++} NDIS_802_11_BSSID_LIST_EX, *PNDIS_802_11_BSSID_LIST_EX; ++#endif ++ ++typedef enum _NDIS_802_11_AUTHENTICATION_MODE { ++ Ndis802_11AuthModeOpen, ++ Ndis802_11AuthModeShared, ++ Ndis802_11AuthModeAutoSwitch, ++ Ndis802_11AuthModeWPA, ++ Ndis802_11AuthModeWPAPSK, ++ Ndis802_11AuthModeWPANone, ++ Ndis802_11AuthModeMax /* Not a real mode, defined as upper bound */ ++} NDIS_802_11_AUTHENTICATION_MODE, *PNDIS_802_11_AUTHENTICATION_MODE; ++ ++typedef enum _NDIS_802_11_WEP_STATUS { ++ Ndis802_11WEPEnabled, ++ Ndis802_11Encryption1Enabled = Ndis802_11WEPEnabled, ++ Ndis802_11WEPDisabled, ++ Ndis802_11EncryptionDisabled = Ndis802_11WEPDisabled, ++ Ndis802_11WEPKeyAbsent, ++ Ndis802_11Encryption1KeyAbsent = Ndis802_11WEPKeyAbsent, ++ Ndis802_11WEPNotSupported, ++ Ndis802_11EncryptionNotSupported = Ndis802_11WEPNotSupported, ++ Ndis802_11Encryption2Enabled, ++ Ndis802_11Encryption2KeyAbsent, ++ Ndis802_11Encryption3Enabled, ++ Ndis802_11Encryption3KeyAbsent ++} NDIS_802_11_WEP_STATUS, *PNDIS_802_11_WEP_STATUS, ++NDIS_802_11_ENCRYPTION_STATUS, *PNDIS_802_11_ENCRYPTION_STATUS; ++ ++ ++#define NDIS_802_11_AI_REQFI_CAPABILITIES 1 ++#define NDIS_802_11_AI_REQFI_LISTENINTERVAL 2 ++#define NDIS_802_11_AI_REQFI_CURRENTAPADDRESS 4 ++ ++#define NDIS_802_11_AI_RESFI_CAPABILITIES 1 ++#define NDIS_802_11_AI_RESFI_STATUSCODE 2 ++#define NDIS_802_11_AI_RESFI_ASSOCIATIONID 4 ++ ++typedef struct _NDIS_802_11_AI_REQFI { ++ USHORT Capabilities; ++ USHORT ListenInterval; ++ NDIS_802_11_MAC_ADDRESS CurrentAPAddress; ++} NDIS_802_11_AI_REQFI, *PNDIS_802_11_AI_REQFI; ++ ++typedef struct _NDIS_802_11_AI_RESFI { ++ USHORT Capabilities; ++ USHORT StatusCode; ++ USHORT AssociationId; ++} NDIS_802_11_AI_RESFI, *PNDIS_802_11_AI_RESFI; ++ ++typedef struct _NDIS_802_11_ASSOCIATION_INFORMATION { ++ ULONG Length; ++ USHORT AvailableRequestFixedIEs; ++ NDIS_802_11_AI_REQFI RequestFixedIEs; ++ ULONG RequestIELength; ++ ULONG OffsetRequestIEs; ++ USHORT AvailableResponseFixedIEs; ++ NDIS_802_11_AI_RESFI ResponseFixedIEs; ++ ULONG ResponseIELength; ++ ULONG OffsetResponseIEs; ++} NDIS_802_11_ASSOCIATION_INFORMATION, *PNDIS_802_11_ASSOCIATION_INFORMATION; ++ ++typedef enum _NDIS_802_11_RELOAD_DEFAULTS { ++ Ndis802_11ReloadWEPKeys ++} NDIS_802_11_RELOAD_DEFAULTS, *PNDIS_802_11_RELOAD_DEFAULTS; ++ ++ ++/* Key mapping keys require a BSSID */ ++typedef struct _NDIS_802_11_KEY { ++ ULONG Length; /* Length of this structure */ ++ ULONG KeyIndex; ++ ULONG KeyLength; /* length of key in bytes */ ++ NDIS_802_11_MAC_ADDRESS BSSID; ++ NDIS_802_11_KEY_RSC KeyRSC; ++ UCHAR KeyMaterial[32]; /* variable length depending on above field */ ++} NDIS_802_11_KEY, *PNDIS_802_11_KEY; ++ ++typedef struct _NDIS_802_11_REMOVE_KEY { ++ ULONG Length; /* Length of this structure */ ++ ULONG KeyIndex; ++ NDIS_802_11_MAC_ADDRESS BSSID; ++} NDIS_802_11_REMOVE_KEY, *PNDIS_802_11_REMOVE_KEY; ++ ++typedef struct _NDIS_802_11_WEP { ++ ULONG Length; /* Length of this structure */ ++ ULONG KeyIndex; /* 0 is the per-client key, 1-N are the global keys */ ++ ULONG KeyLength; /* length of key in bytes */ ++ UCHAR KeyMaterial[16];/* variable length depending on above field */ ++} NDIS_802_11_WEP, *PNDIS_802_11_WEP; ++ ++typedef struct _NDIS_802_11_AUTHENTICATION_REQUEST { ++ ULONG Length; /* Length of structure */ ++ NDIS_802_11_MAC_ADDRESS Bssid; ++ ULONG Flags; ++} NDIS_802_11_AUTHENTICATION_REQUEST, *PNDIS_802_11_AUTHENTICATION_REQUEST; ++ ++typedef enum _NDIS_802_11_STATUS_TYPE { ++ Ndis802_11StatusType_Authentication, ++ Ndis802_11StatusType_MediaStreamMode, ++ Ndis802_11StatusType_PMKID_CandidateList, ++ Ndis802_11StatusTypeMax /* not a real type, defined as an upper bound */ ++} NDIS_802_11_STATUS_TYPE, *PNDIS_802_11_STATUS_TYPE; ++ ++typedef struct _NDIS_802_11_STATUS_INDICATION { ++ NDIS_802_11_STATUS_TYPE StatusType; ++} NDIS_802_11_STATUS_INDICATION, *PNDIS_802_11_STATUS_INDICATION; ++ ++/* mask for authentication/integrity fields */ ++#define NDIS_802_11_AUTH_REQUEST_AUTH_FIELDS 0x0f ++#define NDIS_802_11_AUTH_REQUEST_REAUTH 0x01 ++#define NDIS_802_11_AUTH_REQUEST_KEYUPDATE 0x02 ++#define NDIS_802_11_AUTH_REQUEST_PAIRWISE_ERROR 0x06 ++#define NDIS_802_11_AUTH_REQUEST_GROUP_ERROR 0x0E ++ ++/* MIC check time, 60 seconds. */ ++#define MIC_CHECK_TIME 60000000 ++ ++typedef struct _NDIS_802_11_AUTHENTICATION_EVENT { ++ NDIS_802_11_STATUS_INDICATION Status; ++ NDIS_802_11_AUTHENTICATION_REQUEST Request[1]; ++} NDIS_802_11_AUTHENTICATION_EVENT, *PNDIS_802_11_AUTHENTICATION_EVENT; ++ ++typedef struct _NDIS_802_11_TEST { ++ ULONG Length; ++ ULONG Type; ++ union { ++ NDIS_802_11_AUTHENTICATION_EVENT AuthenticationEvent; ++ NDIS_802_11_RSSI RssiTrigger; ++ } tt; ++} NDIS_802_11_TEST, *PNDIS_802_11_TEST; ++ ++ ++#endif /* PLATFORM_FREEBSD */ ++#ifndef Ndis802_11APMode ++#define Ndis802_11APMode (Ndis802_11InfrastructureMax+1) ++#endif ++ ++typedef struct _WLAN_PHY_INFO { ++ u8 SignalStrength;/* (in percentage) */ ++ u8 SignalQuality;/* (in percentage) */ ++ u8 Optimum_antenna; /* for Antenna diversity */ ++ u8 Reserved_0; ++} WLAN_PHY_INFO, *PWLAN_PHY_INFO; ++ ++typedef struct _WLAN_BCN_INFO { ++ /* these infor get from rtw_get_encrypt_info when ++ * * translate scan to UI */ ++ u8 encryp_protocol;/* ENCRYP_PROTOCOL_E: OPEN/WEP/WPA/WPA2/WAPI */ ++ int group_cipher; /* WPA/WPA2 group cipher */ ++ int pairwise_cipher;/* //WPA/WPA2/WEP pairwise cipher */ ++ int is_8021x; ++ ++ /* bwmode 20/40 and ch_offset UP/LOW */ ++ unsigned short ht_cap_info; ++ unsigned char ht_info_infos_0; ++} WLAN_BCN_INFO, *PWLAN_BCN_INFO; ++ ++/* temporally add #pragma pack for structure alignment issue of ++* WLAN_BSSID_EX and get_WLAN_BSSID_EX_sz() ++*/ ++#ifdef PLATFORM_WINDOWS ++#pragma pack(push) ++#pragma pack(1) ++#endif ++typedef struct _WLAN_BSSID_EX { ++ ULONG Length; ++ NDIS_802_11_MAC_ADDRESS MacAddress; ++ UCHAR Reserved[2];/* [0]: IS beacon frame */ ++ NDIS_802_11_SSID Ssid; ++ ULONG Privacy; ++ NDIS_802_11_RSSI Rssi;/* (in dBM,raw data ,get from PHY) */ ++ NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; ++ NDIS_802_11_CONFIGURATION Configuration; ++ NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; ++ NDIS_802_11_RATES_EX SupportedRates; ++ WLAN_PHY_INFO PhyInfo; ++ ULONG IELength; ++ UCHAR IEs[MAX_IE_SZ]; /* (timestamp, beacon interval, and capability information) */ ++} ++#ifndef PLATFORM_WINDOWS ++__attribute__((packed)) ++#endif ++WLAN_BSSID_EX, *PWLAN_BSSID_EX; ++#ifdef PLATFORM_WINDOWS ++#pragma pack(pop) ++#endif ++ ++#define BSS_EX_IES(bss_ex) ((bss_ex)->IEs) ++#define BSS_EX_IES_LEN(bss_ex) ((bss_ex)->IELength) ++#define BSS_EX_FIXED_IE_OFFSET(bss_ex) ((bss_ex)->Reserved[0] == 2 ? 0 : 12) ++#define BSS_EX_TLV_IES(bss_ex) (BSS_EX_IES((bss_ex)) + BSS_EX_FIXED_IE_OFFSET((bss_ex))) ++#define BSS_EX_TLV_IES_LEN(bss_ex) (BSS_EX_IES_LEN((bss_ex)) - BSS_EX_FIXED_IE_OFFSET((bss_ex))) ++ ++__inline static uint get_WLAN_BSSID_EX_sz(WLAN_BSSID_EX *bss) ++{ ++#if 0 ++ uint t_len; ++ ++ t_len = sizeof(ULONG) ++ + sizeof(NDIS_802_11_MAC_ADDRESS) ++ + 2 ++ + sizeof(NDIS_802_11_SSID) ++ + sizeof(ULONG) ++ + sizeof(NDIS_802_11_RSSI) ++ + sizeof(NDIS_802_11_NETWORK_TYPE) ++ + sizeof(NDIS_802_11_CONFIGURATION) ++ + sizeof(NDIS_802_11_NETWORK_INFRASTRUCTURE) ++ + sizeof(NDIS_802_11_RATES_EX) ++ /* all new member add here */ ++ + sizeof(WLAN_PHY_INFO) ++ /* all new member add here */ ++ + sizeof(ULONG) ++ + bss->IELength; ++ return t_len; ++#else ++ return sizeof(WLAN_BSSID_EX) - MAX_IE_SZ + bss->IELength; ++#endif ++} ++ ++struct wlan_network { ++ _list list; ++ int network_type; /* refer to ieee80211.h for WIRELESS_11A/B/G */ ++ int fixed; /* set to fixed when not to be removed as site-surveying */ ++ unsigned long last_scanned; /* timestamp for the network */ ++ int aid; /* will only be valid when a BSS is joinned. */ ++ int join_res; ++ WLAN_BSSID_EX network; /* must be the last item */ ++ WLAN_BCN_INFO BcnInfo; ++#ifdef PLATFORM_WINDOWS ++ unsigned char iebuf[MAX_IE_SZ]; ++#endif ++ ++}; ++ ++enum VRTL_CARRIER_SENSE { ++ DISABLE_VCS, ++ ENABLE_VCS, ++ AUTO_VCS ++}; ++ ++enum VCS_TYPE { ++ NONE_VCS, ++ RTS_CTS, ++ CTS_TO_SELF ++}; ++ ++ ++ ++ ++#define PWR_CAM 0 ++#define PWR_MINPS 1 ++#define PWR_MAXPS 2 ++#define PWR_UAPSD 3 ++#define PWR_VOIP 4 ++ ++ ++enum UAPSD_MAX_SP { ++ NO_LIMIT, ++ TWO_MSDU, ++ FOUR_MSDU, ++ SIX_MSDU ++}; ++ ++ ++/* john */ ++#define NUM_PRE_AUTH_KEY 16 ++#define NUM_PMKID_CACHE NUM_PRE_AUTH_KEY ++ ++/* ++* WPA2 ++*/ ++ ++#ifndef PLATFORM_OS_CE ++typedef struct _PMKID_CANDIDATE { ++ NDIS_802_11_MAC_ADDRESS BSSID; ++ ULONG Flags; ++} PMKID_CANDIDATE, *PPMKID_CANDIDATE; ++ ++typedef struct _NDIS_802_11_PMKID_CANDIDATE_LIST { ++ ULONG Version; /* Version of the structure */ ++ ULONG NumCandidates; /* No. of pmkid candidates */ ++ PMKID_CANDIDATE CandidateList[1]; ++} NDIS_802_11_PMKID_CANDIDATE_LIST, *PNDIS_802_11_PMKID_CANDIDATE_LIST; ++ ++ ++typedef struct _NDIS_802_11_AUTHENTICATION_ENCRYPTION { ++ NDIS_802_11_AUTHENTICATION_MODE AuthModeSupported; ++ NDIS_802_11_ENCRYPTION_STATUS EncryptStatusSupported; ++ ++} NDIS_802_11_AUTHENTICATION_ENCRYPTION, *PNDIS_802_11_AUTHENTICATION_ENCRYPTION; ++ ++typedef struct _NDIS_802_11_CAPABILITY { ++ ULONG Length; ++ ULONG Version; ++ ULONG NoOfPMKIDs; ++ ULONG NoOfAuthEncryptPairsSupported; ++ NDIS_802_11_AUTHENTICATION_ENCRYPTION AuthenticationEncryptionSupported[1]; ++ ++} NDIS_802_11_CAPABILITY, *PNDIS_802_11_CAPABILITY; ++#endif ++ ++ ++#endif /* #ifndef WLAN_BSSDEF_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/xmit_osdep.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/xmit_osdep.h +--- linux-4.14.18/3rdparty/rtl8723de/include/xmit_osdep.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/xmit_osdep.h 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,99 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __XMIT_OSDEP_H_ ++#define __XMIT_OSDEP_H_ ++ ++ ++struct pkt_file { ++ _pkt *pkt; ++ SIZE_T pkt_len; /* the remainder length of the open_file */ ++ _buffer *cur_buffer; ++ u8 *buf_start; ++ u8 *cur_addr; ++ SIZE_T buf_len; ++}; ++ ++#ifdef PLATFORM_WINDOWS ++ ++#ifdef PLATFORM_OS_XP ++#ifdef CONFIG_USB_HCI ++#include ++#include ++#include ++#endif ++#endif ++ ++#ifdef CONFIG_GSPI_HCI ++ #define NR_XMITFRAME 64 ++#else ++ #define NR_XMITFRAME 128 ++#endif ++ ++#define ETH_ALEN 6 ++ ++extern NDIS_STATUS rtw_xmit_entry( ++ IN _nic_hdl cnxt, ++ IN NDIS_PACKET *pkt, ++ IN UINT flags ++); ++ ++#endif /* PLATFORM_WINDOWS */ ++ ++#ifdef PLATFORM_FREEBSD ++#define NR_XMITFRAME 256 ++extern int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); ++extern void rtw_xmit_entry_wrap(struct ifnet *pifp); ++#endif /* PLATFORM_FREEBSD */ ++ ++#ifdef PLATFORM_LINUX ++ ++#define NR_XMITFRAME 256 ++ ++struct xmit_priv; ++struct pkt_attrib; ++struct sta_xmit_priv; ++struct xmit_frame; ++struct xmit_buf; ++ ++extern int _rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); ++extern int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); ++ ++#endif /* PLATFORM_LINUX */ ++ ++void rtw_os_xmit_schedule(_adapter *padapter); ++ ++int rtw_os_xmit_resource_alloc(_adapter *padapter, struct xmit_buf *pxmitbuf, u32 alloc_sz, u8 flag); ++void rtw_os_xmit_resource_free(_adapter *padapter, struct xmit_buf *pxmitbuf, u32 free_sz, u8 flag); ++ ++extern void rtw_set_tx_chksum_offload(_pkt *pkt, struct pkt_attrib *pattrib); ++ ++extern uint rtw_remainder_len(struct pkt_file *pfile); ++extern void _rtw_open_pktfile(_pkt *pkt, struct pkt_file *pfile); ++extern uint _rtw_pktfile_read(struct pkt_file *pfile, u8 *rmem, uint rlen); ++extern sint rtw_endofpktfile(struct pkt_file *pfile); ++ ++extern void rtw_os_pkt_complete(_adapter *padapter, _pkt *pkt); ++extern void rtw_os_xmit_complete(_adapter *padapter, struct xmit_frame *pxframe); ++ ++void rtw_os_wake_queue_at_free_stainfo(_adapter *padapter, int *qcnt_freed); ++ ++void dump_os_queue(void *sel, _adapter *padapter); ++ ++#endif /* __XMIT_OSDEP_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/Kconfig linux-4.14.18-rtl/3rdparty/rtl8723de/Kconfig +--- linux-4.14.18/3rdparty/rtl8723de/Kconfig 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/Kconfig 2018-02-11 21:44:27.134145888 +0200 +@@ -0,0 +1,6 @@ ++config RTL8723DE ++ tristate "Realtek 8723DE PCI WiFi" ++ depends on PCI ++ ---help--- ++ Help message of RTL8723DE ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/Makefile linux-4.14.18-rtl/3rdparty/rtl8723de/Makefile +--- linux-4.14.18/3rdparty/rtl8723de/Makefile 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/Makefile 2018-02-11 21:44:27.134145888 +0200 +@@ -0,0 +1,1919 @@ ++EXTRA_CFLAGS += $(USER_EXTRA_CFLAGS) ++EXTRA_CFLAGS += -O1 ++#EXTRA_CFLAGS += -O3 ++#EXTRA_CFLAGS += -Wall ++#EXTRA_CFLAGS += -Wextra ++#EXTRA_CFLAGS += -Werror ++#EXTRA_CFLAGS += -pedantic ++#EXTRA_CFLAGS += -Wshadow -Wpointer-arith -Wcast-qual -Wstrict-prototypes -Wmissing-prototypes ++ ++EXTRA_CFLAGS += -Wno-unused-variable ++EXTRA_CFLAGS += -Wno-unused-value ++EXTRA_CFLAGS += -Wno-unused-label ++EXTRA_CFLAGS += -Wno-unused-parameter ++EXTRA_CFLAGS += -Wno-unused-function ++EXTRA_CFLAGS += -Wno-unused ++#EXTRA_CFLAGS += -Wno-uninitialized ++ ++GCC_VER_49 := $(shell echo `$(CC) -dumpversion | cut -f1-2 -d.` \>= 4.9 | bc ) ++ifeq ($(GCC_VER_49),1) ++EXTRA_CFLAGS += -Wno-date-time # Fix compile error && warning on gcc 4.9 and later ++endif ++ ++EXTRA_CFLAGS += -I$(src)/include ++EXTRA_CFLAGS += -I$(src)/hal/phydm ++ ++EXTRA_LDFLAGS += --strip-debug ++ ++CONFIG_AUTOCFG_CP = n ++ ++########################## WIFI IC ############################ ++CONFIG_MULTIDRV = n ++CONFIG_RTL8188E = n ++CONFIG_RTL8812A = n ++CONFIG_RTL8821A = n ++CONFIG_RTL8192E = n ++CONFIG_RTL8723B = n ++CONFIG_RTL8814A = n ++CONFIG_RTL8723C = n ++CONFIG_RTL8188F = n ++CONFIG_RTL8822B = n ++CONFIG_RTL8723D = y ++CONFIG_RTL8821C = n ++######################### Interface ########################### ++CONFIG_USB_HCI = n ++CONFIG_PCI_HCI = y ++CONFIG_SDIO_HCI = n ++CONFIG_GSPI_HCI = n ++########################## Features ########################### ++CONFIG_MP_INCLUDED = y ++CONFIG_POWER_SAVING = y ++CONFIG_USB_AUTOSUSPEND = n ++CONFIG_HW_PWRP_DETECTION = n ++CONFIG_WIFI_TEST = n ++CONFIG_BT_COEXIST = y ++CONFIG_INTEL_WIDI = n ++CONFIG_WAPI_SUPPORT = n ++CONFIG_EFUSE_CONFIG_FILE = y ++CONFIG_EXT_CLK = n ++CONFIG_TRAFFIC_PROTECT = y ++CONFIG_LOAD_PHY_PARA_FROM_FILE = y ++CONFIG_TXPWR_BY_RATE_EN = auto ++CONFIG_TXPWR_LIMIT_EN = auto ++CONFIG_RTW_ADAPTIVITY_EN = disable ++CONFIG_RTW_ADAPTIVITY_MODE = normal ++CONFIG_SIGNAL_SCALE_MAPPING = n ++CONFIG_80211W = n ++CONFIG_REDUCE_TX_CPU_LOADING = n ++CONFIG_BR_EXT = y ++CONFIG_TDLS = n ++CONFIG_WIFI_MONITOR = n ++CONFIG_MCC_MODE = n ++CONFIG_APPEND_VENDOR_IE_ENABLE = n ++CONFIG_RTW_NAPI = y ++CONFIG_RTW_GRO = y ++########################## Debug ########################### ++CONFIG_RTW_DEBUG = y ++# default log level is _DRV_INFO_ = 4, ++# please refer to "How_to_set_driver_debug_log_level.doc" to set the available level. ++CONFIG_RTW_LOG_LEVEL = 4 ++######################## Wake On Lan ########################## ++CONFIG_WOWLAN = n ++CONFIG_GPIO_WAKEUP = n ++CONFIG_DEFAULT_PATTERNS_EN = n ++CONFIG_WAKEUP_GPIO_IDX = default ++CONFIG_HIGH_ACTIVE = n ++CONFIG_PNO_SUPPORT = n ++CONFIG_PNO_SET_DEBUG = n ++CONFIG_AP_WOWLAN = n ++######### Notify SDIO Host Keep Power During Syspend ########## ++CONFIG_RTW_SDIO_PM_KEEP_POWER = y ++###################### MP HW TX MODE FOR VHT ####################### ++CONFIG_MP_VHT_HW_TX_MODE = n ++###################### Platform Related ####################### ++CONFIG_PLATFORM_I386_PC = y ++CONFIG_PLATFORM_ARM_NV_TK1 = n ++CONFIG_PLATFORM_ANDROID_X86 = n ++CONFIG_PLATFORM_ANDROID_INTEL_X86 = n ++CONFIG_PLATFORM_JB_X86 = n ++CONFIG_PLATFORM_ARM_S3C2K4 = n ++CONFIG_PLATFORM_ARM_PXA2XX = n ++CONFIG_PLATFORM_ARM_S3C6K4 = n ++CONFIG_PLATFORM_MIPS_RMI = n ++CONFIG_PLATFORM_RTD2880B = n ++CONFIG_PLATFORM_MIPS_AR9132 = n ++CONFIG_PLATFORM_RTK_DMP = n ++CONFIG_PLATFORM_MIPS_PLM = n ++CONFIG_PLATFORM_MSTAR389 = n ++CONFIG_PLATFORM_MT53XX = n ++CONFIG_PLATFORM_ARM_MX51_241H = n ++CONFIG_PLATFORM_FS_MX61 = n ++CONFIG_PLATFORM_ACTIONS_ATJ227X = n ++CONFIG_PLATFORM_TEGRA3_CARDHU = n ++CONFIG_PLATFORM_TEGRA4_DALMORE = n ++CONFIG_PLATFORM_ARM_TCC8900 = n ++CONFIG_PLATFORM_ARM_TCC8920 = n ++CONFIG_PLATFORM_ARM_TCC8920_JB42 = n ++CONFIG_PLATFORM_ARM_TCC8930_JB42 = n ++CONFIG_PLATFORM_ARM_RK2818 = n ++CONFIG_PLATFORM_ARM_RK3066 = n ++CONFIG_PLATFORM_ARM_RK3188 = n ++CONFIG_PLATFORM_ARM_URBETTER = n ++CONFIG_PLATFORM_ARM_TI_PANDA = n ++CONFIG_PLATFORM_MIPS_JZ4760 = n ++CONFIG_PLATFORM_DMP_PHILIPS = n ++CONFIG_PLATFORM_MSTAR_TITANIA12 = n ++CONFIG_PLATFORM_MSTAR = n ++CONFIG_PLATFORM_SZEBOOK = n ++CONFIG_PLATFORM_ARM_SUNxI = n ++CONFIG_PLATFORM_ARM_SUN6I = n ++CONFIG_PLATFORM_ARM_SUN7I = n ++CONFIG_PLATFORM_ARM_SUN8I_W3P1 = n ++CONFIG_PLATFORM_ARM_SUN8I_W5P1 = n ++CONFIG_PLATFORM_ACTIONS_ATM702X = n ++CONFIG_PLATFORM_ACTIONS_ATV5201 = n ++CONFIG_PLATFORM_ACTIONS_ATM705X = n ++CONFIG_PLATFORM_ARM_SUN50IW1P1 = n ++CONFIG_PLATFORM_ARM_RTD299X = n ++CONFIG_PLATFORM_ARM_SPREADTRUM_6820 = n ++CONFIG_PLATFORM_ARM_SPREADTRUM_8810 = n ++CONFIG_PLATFORM_ARM_WMT = n ++CONFIG_PLATFORM_TI_DM365 = n ++CONFIG_PLATFORM_MOZART = n ++CONFIG_PLATFORM_RTK119X = n ++CONFIG_PLATFORM_RTK129X = n ++CONFIG_PLATFORM_NOVATEK_NT72668 = n ++CONFIG_PLATFORM_HISILICON = n ++############################################################### ++ ++CONFIG_DRVEXT_MODULE = n ++ ++export TopDIR ?= $(shell pwd) ++ ++########### COMMON ################################# ++ifeq ($(CONFIG_GSPI_HCI), y) ++HCI_NAME = gspi ++endif ++ ++ifeq ($(CONFIG_SDIO_HCI), y) ++HCI_NAME = sdio ++endif ++ ++ifeq ($(CONFIG_USB_HCI), y) ++HCI_NAME = usb ++endif ++ ++ifeq ($(CONFIG_PCI_HCI), y) ++HCI_NAME = pci ++endif ++ ++ ++_OS_INTFS_FILES := os_dep/osdep_service.o \ ++ os_dep/linux/os_intfs.o \ ++ os_dep/linux/$(HCI_NAME)_intf.o \ ++ os_dep/linux/$(HCI_NAME)_ops_linux.o \ ++ os_dep/linux/ioctl_linux.o \ ++ os_dep/linux/xmit_linux.o \ ++ os_dep/linux/mlme_linux.o \ ++ os_dep/linux/recv_linux.o \ ++ os_dep/linux/ioctl_cfg80211.o \ ++ os_dep/linux/rtw_cfgvendor.o \ ++ os_dep/linux/wifi_regd.o \ ++ os_dep/linux/rtw_android.o \ ++ os_dep/linux/rtw_proc.o ++ ++ifeq ($(CONFIG_MP_INCLUDED), y) ++_OS_INTFS_FILES += os_dep/linux/ioctl_mp.o ++endif ++ ++ifeq ($(CONFIG_SDIO_HCI), y) ++_OS_INTFS_FILES += os_dep/linux/custom_gpio_linux.o ++_OS_INTFS_FILES += os_dep/linux/$(HCI_NAME)_ops_linux.o ++endif ++ ++ifeq ($(CONFIG_GSPI_HCI), y) ++_OS_INTFS_FILES += os_dep/linux/custom_gpio_linux.o ++_OS_INTFS_FILES += os_dep/linux/$(HCI_NAME)_ops_linux.o ++endif ++ ++ ++_HAL_INTFS_FILES := hal/hal_intf.o \ ++ hal/hal_com.o \ ++ hal/hal_com_phycfg.o \ ++ hal/hal_phy.o \ ++ hal/hal_dm.o \ ++ hal/hal_btcoex.o \ ++ hal/hal_mp.o \ ++ hal/hal_mcc.o \ ++ hal/hal_hci/hal_$(HCI_NAME).o \ ++ hal/led/hal_$(HCI_NAME)_led.o ++ ++ ++_OUTSRC_FILES := hal/phydm/phydm_debug.o \ ++ hal/phydm/phydm_antdiv.o\ ++ hal/phydm/phydm_antdect.o\ ++ hal/phydm/phydm_interface.o\ ++ hal/phydm/phydm_hwconfig.o\ ++ hal/phydm/phydm.o\ ++ hal/phydm/halphyrf_ce.o\ ++ hal/phydm/phydm_edcaturbocheck.o\ ++ hal/phydm/phydm_dig.o\ ++ hal/phydm/phydm_pathdiv.o\ ++ hal/phydm/phydm_rainfo.o\ ++ hal/phydm/phydm_dynamicbbpowersaving.o\ ++ hal/phydm/phydm_powertracking_ce.o\ ++ hal/phydm/phydm_dynamictxpower.o\ ++ hal/phydm/phydm_adaptivity.o\ ++ hal/phydm/phydm_cfotracking.o\ ++ hal/phydm/phydm_noisemonitor.o\ ++ hal/phydm/phydm_acs.o\ ++ hal/phydm/phydm_beamforming.o\ ++ hal/phydm/phydm_dfs.o\ ++ hal/phydm/txbf/halcomtxbf.o\ ++ hal/phydm/txbf/haltxbfinterface.o\ ++ hal/phydm/txbf/phydm_hal_txbf_api.o\ ++ hal/phydm/phydm_kfree.o\ ++ hal/phydm/phydm_ccx.o ++ ++ ++EXTRA_CFLAGS += -I$(src)/platform ++_PLATFORM_FILES := platform/platform_ops.o ++ ++ifeq ($(CONFIG_BT_COEXIST), y) ++EXTRA_CFLAGS += -I$(src)/hal/btc ++_OUTSRC_FILES += hal/btc/HalBtc8192e1Ant.o \ ++ hal/btc/HalBtc8192e2Ant.o \ ++ hal/btc/HalBtc8723b1Ant.o \ ++ hal/btc/HalBtc8723b2Ant.o \ ++ hal/btc/HalBtc8812a1Ant.o \ ++ hal/btc/HalBtc8812a2Ant.o \ ++ hal/btc/HalBtc8821a1Ant.o \ ++ hal/btc/HalBtc8821a2Ant.o \ ++ hal/btc/HalBtc8821aCsr2Ant.o \ ++ hal/btc/HalBtc8703b1Ant.o \ ++ hal/btc/halbtc8723d1ant.o \ ++ hal/btc/halbtc8723d2ant.o \ ++ hal/btc/HalBtc8822b1Ant.o \ ++ hal/btc/halbtc8821c1ant.o \ ++ hal/btc/halbtc8821c2ant.o ++endif ++ ++ ++########### HAL_RTL8188E ################################# ++ifeq ($(CONFIG_RTL8188E), y) ++ ++RTL871X = rtl8188e ++ifeq ($(CONFIG_SDIO_HCI), y) ++MODULE_NAME = 8189es ++endif ++ ++ifeq ($(CONFIG_GSPI_HCI), y) ++MODULE_NAME = 8189es ++endif ++ ++ifeq ($(CONFIG_USB_HCI), y) ++MODULE_NAME = 8188eu ++endif ++ ++ifeq ($(CONFIG_PCI_HCI), y) ++MODULE_NAME = 8188ee ++endif ++EXTRA_CFLAGS += -DCONFIG_RTL8188E ++ ++_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ ++ hal/$(RTL871X)/Hal8188EPwrSeq.o\ ++ hal/$(RTL871X)/$(RTL871X)_xmit.o\ ++ hal/$(RTL871X)/$(RTL871X)_sreset.o ++ ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ ++ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ ++ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ ++ hal/$(RTL871X)/$(RTL871X)_dm.o \ ++ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ ++ hal/$(RTL871X)/$(RTL871X)_cmd.o \ ++ hal/$(RTL871X)/hal8188e_s_fw.o \ ++ hal/$(RTL871X)/hal8188e_t_fw.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o ++ ++ifeq ($(CONFIG_SDIO_HCI), y) ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o ++else ++ifeq ($(CONFIG_GSPI_HCI), y) ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o ++else ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o ++endif ++endif ++ ++ifeq ($(CONFIG_USB_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188E_USB.o ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188E_PCIE.o ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188E_SDIO.o ++endif ++ ++#hal/OUTSRC/$(RTL871X)/Hal8188EFWImg_CE.o ++_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8188e_mac.o\ ++ hal/phydm/$(RTL871X)/halhwimg8188e_bb.o\ ++ hal/phydm/$(RTL871X)/halhwimg8188e_rf.o\ ++ hal/phydm/$(RTL871X)/halhwimg8188e_t_fw.o\ ++ hal/phydm/$(RTL871X)/halhwimg8188e_s_fw.o\ ++ hal/phydm/$(RTL871X)/halphyrf_8188e_ce.o\ ++ hal/phydm/$(RTL871X)/phydm_regconfig8188e.o\ ++ hal/phydm/$(RTL871X)/hal8188erateadaptive.o\ ++ hal/phydm/$(RTL871X)/phydm_rtl8188e.o ++ ++endif ++ ++########### HAL_RTL8192E ################################# ++ifeq ($(CONFIG_RTL8192E), y) ++ ++RTL871X = rtl8192e ++ifeq ($(CONFIG_SDIO_HCI), y) ++MODULE_NAME = 8192es ++endif ++ ++ifeq ($(CONFIG_USB_HCI), y) ++MODULE_NAME = 8192eu ++endif ++ ++ifeq ($(CONFIG_PCI_HCI), y) ++MODULE_NAME = 8192ee ++endif ++EXTRA_CFLAGS += -DCONFIG_RTL8192E ++_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ ++ hal/$(RTL871X)/Hal8192EPwrSeq.o\ ++ hal/$(RTL871X)/$(RTL871X)_xmit.o\ ++ hal/$(RTL871X)/$(RTL871X)_sreset.o ++ ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ ++ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ ++ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ ++ hal/$(RTL871X)/$(RTL871X)_dm.o \ ++ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ ++ hal/$(RTL871X)/$(RTL871X)_cmd.o \ ++ hal/$(RTL871X)/hal8192e_fw.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o ++ ++ifeq ($(CONFIG_SDIO_HCI), y) ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o ++else ++ifeq ($(CONFIG_GSPI_HCI), y) ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o ++else ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o ++endif ++endif ++ ++ifeq ($(CONFIG_USB_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8192E_USB.o ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8192E_PCIE.o ++endif ++ ++#hal/OUTSRC/$(RTL871X)/HalHWImg8188E_FW.o ++_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8192e_mac.o\ ++ hal/phydm/$(RTL871X)/halhwimg8192e_bb.o\ ++ hal/phydm/$(RTL871X)/halhwimg8192e_rf.o\ ++ hal/phydm/$(RTL871X)/halhwimg8192e_fw.o\ ++ hal/phydm/$(RTL871X)/halphyrf_8192e_ce.o\ ++ hal/phydm/$(RTL871X)/phydm_regconfig8192e.o\ ++ hal/phydm/$(RTL871X)/phydm_rtl8192e.o ++ ++endif ++ ++########### HAL_RTL8812A_RTL8821A ################################# ++ ++ifneq ($(CONFIG_RTL8812A)_$(CONFIG_RTL8821A), n_n) ++ ++RTL871X = rtl8812a ++ifeq ($(CONFIG_USB_HCI), y) ++MODULE_NAME = 8812au ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++MODULE_NAME = 8812ae ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++MODULE_NAME = 8812as ++endif ++ ++_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ ++ hal/$(RTL871X)/Hal8812PwrSeq.o \ ++ hal/$(RTL871X)/Hal8821APwrSeq.o\ ++ hal/$(RTL871X)/$(RTL871X)_xmit.o\ ++ hal/$(RTL871X)/$(RTL871X)_sreset.o ++ ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ ++ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ ++ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ ++ hal/$(RTL871X)/$(RTL871X)_dm.o \ ++ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ ++ hal/$(RTL871X)/$(RTL871X)_cmd.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o ++ ++ifeq ($(CONFIG_SDIO_HCI), y) ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o ++else ++ifeq ($(CONFIG_GSPI_HCI), y) ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o ++else ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o ++endif ++endif ++ ++ifeq ($(CONFIG_RTL8812A), y) ++ifeq ($(CONFIG_USB_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8812A_USB.o ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8812A_PCIE.o ++endif ++endif ++ifeq ($(CONFIG_RTL8821A), y) ++ifeq ($(CONFIG_USB_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8821A_USB.o ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8821A_PCIE.o ++endif ++endif ++ ++ifeq ($(CONFIG_RTL8812A), y) ++EXTRA_CFLAGS += -DCONFIG_RTL8812A ++_HAL_INTFS_FILES += hal/rtl8812a/hal8812a_fw.o ++ ++_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8812a_fw.o\ ++ hal/phydm/$(RTL871X)/halhwimg8812a_mac.o\ ++ hal/phydm/$(RTL871X)/halhwimg8812a_bb.o\ ++ hal/phydm/$(RTL871X)/halhwimg8812a_rf.o\ ++ hal/phydm/$(RTL871X)/halphyrf_8812a_ce.o\ ++ hal/phydm/$(RTL871X)/phydm_regconfig8812a.o\ ++ hal/phydm/$(RTL871X)/phydm_rtl8812a.o\ ++ hal/phydm/txbf/haltxbfjaguar.o ++endif ++ ++ifeq ($(CONFIG_RTL8821A), y) ++ ++ifeq ($(CONFIG_RTL8812A), n) ++ ++RTL871X = rtl8821a ++ifeq ($(CONFIG_USB_HCI), y) ++ifeq ($(CONFIG_BT_COEXIST), y) ++MODULE_NAME := 8821au ++else ++MODULE_NAME := 8811au ++endif ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++MODULE_NAME := 8821ae ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++MODULE_NAME := 8821as ++endif ++ ++endif ++ ++EXTRA_CFLAGS += -DCONFIG_RTL8821A ++ ++_HAL_INTFS_FILES += hal/rtl8812a/hal8821a_fw.o ++_OUTSRC_FILES += hal/phydm/rtl8821a/halhwimg8821a_fw.o\ ++ hal/phydm/rtl8821a/halhwimg8821a_mac.o\ ++ hal/phydm/rtl8821a/halhwimg8821a_bb.o\ ++ hal/phydm/rtl8821a/halhwimg8821a_rf.o\ ++ hal/phydm/rtl8812a/halphyrf_8812a_ce.o\ ++ hal/phydm/rtl8821a/halphyrf_8821a_ce.o\ ++ hal/phydm/rtl8821a/phydm_regconfig8821a.o\ ++ hal/phydm/rtl8821a/phydm_rtl8821a.o\ ++ hal/phydm/rtl8821a/phydm_iqk_8821a_ce.o\ ++ hal/phydm/txbf/haltxbfjaguar.o ++ ++endif ++ ++endif ++ ++########### HAL_RTL8723B ################################# ++ifeq ($(CONFIG_RTL8723B), y) ++ ++RTL871X = rtl8723b ++ifeq ($(CONFIG_USB_HCI), y) ++MODULE_NAME = 8723bu ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++MODULE_NAME = 8723be ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++MODULE_NAME = 8723bs ++endif ++ ++EXTRA_CFLAGS += -DCONFIG_RTL8723B ++ ++_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ ++ hal/$(RTL871X)/Hal8723BPwrSeq.o\ ++ hal/$(RTL871X)/$(RTL871X)_sreset.o ++ ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ ++ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ ++ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ ++ hal/$(RTL871X)/$(RTL871X)_dm.o \ ++ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ ++ hal/$(RTL871X)/$(RTL871X)_cmd.o \ ++ hal/$(RTL871X)/hal8723b_fw.o \ ++ ++_HAL_INTFS_FILES += \ ++ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o ++ ++ifeq ($(CONFIG_PCI_HCI), y) ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o ++else ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o ++endif ++ ++ifeq ($(CONFIG_USB_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723B_USB.o ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723B_PCIE.o ++endif ++ ++_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8723b_bb.o\ ++ hal/phydm/$(RTL871X)/halhwimg8723b_mac.o\ ++ hal/phydm/$(RTL871X)/halhwimg8723b_rf.o\ ++ hal/phydm/$(RTL871X)/halhwimg8723b_fw.o\ ++ hal/phydm/$(RTL871X)/halhwimg8723b_mp.o\ ++ hal/phydm/$(RTL871X)/phydm_regconfig8723b.o\ ++ hal/phydm/$(RTL871X)/halphyrf_8723b_ce.o\ ++ hal/phydm/$(RTL871X)/phydm_rtl8723b.o ++ ++endif ++ ++########### HAL_RTL8814A ################################# ++ifeq ($(CONFIG_RTL8814A), y) ++## ADD NEW VHT MP HW TX MODE ## ++EXTRA_CFLAGS += -DCONFIG_MP_VHT_HW_TX_MODE ++CONFIG_MP_VHT_HW_TX_MODE = y ++########################################## ++RTL871X = rtl8814a ++ifeq ($(CONFIG_USB_HCI), y) ++MODULE_NAME = 8814au ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++MODULE_NAME = 8814ae ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++MODULE_NAME = 8814as ++endif ++ ++EXTRA_CFLAGS += -DCONFIG_RTL8814A ++ ++_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ ++ hal/$(RTL871X)/Hal8814PwrSeq.o \ ++ hal/$(RTL871X)/$(RTL871X)_xmit.o\ ++ hal/$(RTL871X)/$(RTL871X)_sreset.o ++ ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ ++ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ ++ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ ++ hal/$(RTL871X)/$(RTL871X)_dm.o \ ++ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ ++ hal/$(RTL871X)/$(RTL871X)_cmd.o \ ++ hal/$(RTL871X)/hal8814a_fw.o \ ++ ++ ++_HAL_INTFS_FILES += \ ++ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o ++ ++ifeq ($(CONFIG_SDIO_HCI), y) ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o ++else ++ifeq ($(CONFIG_GSPI_HCI), y) ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o ++else ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o ++endif ++endif ++ ++ifeq ($(CONFIG_USB_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8814A_USB.o ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8814A_PCIE.o ++endif ++ ++_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8814a_bb.o\ ++ hal/phydm/$(RTL871X)/halhwimg8814a_mac.o\ ++ hal/phydm/$(RTL871X)/halhwimg8814a_rf.o\ ++ hal/phydm/$(RTL871X)/halhwimg8814a_fw.o\ ++ hal/phydm/$(RTL871X)/phydm_iqk_8814a.o\ ++ hal/phydm/$(RTL871X)/phydm_regconfig8814a.o\ ++ hal/phydm/$(RTL871X)/halphyrf_8814a_ce.o\ ++ hal/phydm/$(RTL871X)/phydm_rtl8814a.o\ ++ hal/phydm/txbf/haltxbf8814a.o ++ ++endif ++ ++########### HAL_RTL8723C ################################# ++ifeq ($(CONFIG_RTL8723C), y) ++ ++RTL871X = rtl8703b ++ifeq ($(CONFIG_USB_HCI), y) ++MODULE_NAME = 8723cu ++MODULE_SUB_NAME = 8703bu ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++MODULE_NAME = 8723ce ++MODULE_SUB_NAME = 8703be ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++MODULE_NAME = 8723cs ++MODULE_SUB_NAME = 8703bs ++endif ++ ++EXTRA_CFLAGS += -DCONFIG_RTL8703B ++ ++_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ ++ hal/$(RTL871X)/Hal8703BPwrSeq.o\ ++ hal/$(RTL871X)/$(RTL871X)_sreset.o ++ ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ ++ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ ++ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ ++ hal/$(RTL871X)/$(RTL871X)_dm.o \ ++ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ ++ hal/$(RTL871X)/$(RTL871X)_cmd.o \ ++ hal/$(RTL871X)/hal8703b_fw.o \ ++ ++_HAL_INTFS_FILES += \ ++ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_led.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_xmit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_recv.o ++ ++ifeq ($(CONFIG_PCI_HCI), y) ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o ++else ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o ++endif ++ ++ifeq ($(CONFIG_USB_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8703B_USB.o ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8703B_PCIE.o ++endif ++ ++_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8703b_bb.o\ ++ hal/phydm/$(RTL871X)/halhwimg8703b_mac.o\ ++ hal/phydm/$(RTL871X)/halhwimg8703b_rf.o\ ++ hal/phydm/$(RTL871X)/halhwimg8703b_fw.o\ ++ hal/phydm/$(RTL871X)/phydm_regconfig8703b.o\ ++ hal/phydm/$(RTL871X)/halphyrf_8703b.o ++endif ++ ++########### HAL_RTL8723D ################################# ++ifeq ($(CONFIG_RTL8723D), y) ++ ++RTL871X = rtl8723d ++ifeq ($(CONFIG_USB_HCI), y) ++MODULE_NAME = 8723du ++MODULE_SUB_NAME = 8723du ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++MODULE_NAME = 8723de ++MODULE_SUB_NAME = 8723de ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++MODULE_NAME = 8723ds ++MODULE_SUB_NAME = 8723ds ++endif ++ ++EXTRA_CFLAGS += -DCONFIG_RTL8723D ++ ++_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ ++ hal/$(RTL871X)/Hal8723DPwrSeq.o\ ++ hal/$(RTL871X)/$(RTL871X)_sreset.o ++ ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ ++ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ ++ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ ++ hal/$(RTL871X)/$(RTL871X)_dm.o \ ++ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ ++ hal/$(RTL871X)/$(RTL871X)_cmd.o \ ++ hal/$(RTL871X)/hal8723d_fw.o \ ++ hal/$(RTL871X)/$(RTL871X)_lps_poff.o ++ ++ ++_HAL_INTFS_FILES += \ ++ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_led.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_xmit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_recv.o ++ ++ifeq ($(CONFIG_PCI_HCI), y) ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o ++else ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o ++endif ++ ++ifeq ($(CONFIG_USB_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723D_USB.o ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723D_PCIE.o ++endif ++ ++_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8723d_bb.o\ ++ hal/phydm/$(RTL871X)/halhwimg8723d_mac.o\ ++ hal/phydm/$(RTL871X)/halhwimg8723d_rf.o\ ++ hal/phydm/$(RTL871X)/halhwimg8723d_fw.o\ ++ hal/phydm/$(RTL871X)/phydm_regconfig8723d.o\ ++ hal/phydm/$(RTL871X)/phydm_rtl8723d.o\ ++ hal/phydm/$(RTL871X)/halphyrf_8723d.o ++endif ++ ++########### HAL_RTL8188F ################################# ++ifeq ($(CONFIG_RTL8188F), y) ++ ++RTL871X = rtl8188f ++ifeq ($(CONFIG_USB_HCI), y) ++MODULE_NAME = 8188fu ++endif ++ifeq ($(CONFIG_PCI_HCI), y) ++MODULE_NAME = 8188fe ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++MODULE_NAME = 8189fs ++endif ++ ++EXTRA_CFLAGS += -DCONFIG_RTL8188F ++ ++_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ ++ hal/$(RTL871X)/Hal8188FPwrSeq.o\ ++ hal/$(RTL871X)/$(RTL871X)_sreset.o ++ ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ ++ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ ++ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ ++ hal/$(RTL871X)/$(RTL871X)_dm.o \ ++ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ ++ hal/$(RTL871X)/$(RTL871X)_cmd.o \ ++ hal/$(RTL871X)/hal8188f_fw.o \ ++ ++_HAL_INTFS_FILES += \ ++ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ ++ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o ++ ++ifeq ($(CONFIG_PCI_HCI), y) ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o ++else ++_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o ++endif ++ ++ifeq ($(CONFIG_USB_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188F_USB.o ++endif ++ ++ifeq ($(CONFIG_SDIO_HCI), y) ++_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188F_SDIO.o ++endif ++ ++_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8188f_bb.o\ ++ hal/phydm/$(RTL871X)/halhwimg8188f_mac.o\ ++ hal/phydm/$(RTL871X)/halhwimg8188f_rf.o\ ++ hal/phydm/$(RTL871X)/halhwimg8188f_fw.o\ ++ hal/phydm/$(RTL871X)/phydm_regconfig8188f.o\ ++ hal/phydm/$(RTL871X)/halphyrf_8188f.o \ ++ hal/phydm/$(RTL871X)/phydm_rtl8188f.o ++ ++endif ++ ++########### HAL_RTL8822B ################################# ++ifeq ($(CONFIG_RTL8822B), y) ++include $(TopDIR)/rtl8822b.mk ++endif ++ ++########### HAL_RTL8821C ################################# ++ifeq ($(CONFIG_RTL8821C), y) ++include $(TopDIR)/rtl8821c.mk ++ ++_OUTSRC_FILES += hal/phydm/rtl8821c/halhwimg8821c_testchip_bb.o \ ++ hal/phydm/rtl8821c/halhwimg8821c_testchip_mac.o \ ++ hal/phydm/rtl8821c/halhwimg8821c_testchip_rf.o \ ++ hal/phydm/rtl8821c/phydm_hal_api8821c.o \ ++ hal/phydm/rtl8821c/phydm_regconfig8821c.o ++endif ++ ++########### AUTO_CFG ################################# ++ ++ifeq ($(CONFIG_AUTOCFG_CP), y) ++ ++ifeq ($(CONFIG_MULTIDRV), y) ++$(shell cp $(TopDIR)/autoconf_multidrv_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) ++else ++ifeq ($(CONFIG_RTL8188E)$(CONFIG_SDIO_HCI),yy) ++$(shell cp $(TopDIR)/autoconf_rtl8189e_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) ++else ifeq ($(CONFIG_RTL8188F)$(CONFIG_SDIO_HCI),yy) ++$(shell cp $(TopDIR)/autoconf_rtl8189f_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) ++else ifeq ($(CONFIG_RTL8723C),y) ++$(shell cp $(TopDIR)/autoconf_rtl8723c_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) ++else ++$(shell cp $(TopDIR)/autoconf_$(RTL871X)_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) ++endif ++endif ++ ++endif ++ ++########### END OF PATH ################################# ++ ++ifeq ($(CONFIG_USB_HCI), y) ++ifeq ($(CONFIG_USB_AUTOSUSPEND), y) ++EXTRA_CFLAGS += -DCONFIG_USB_AUTOSUSPEND ++endif ++endif ++ ++ifeq ($(CONFIG_MP_INCLUDED), y) ++#MODULE_NAME := $(MODULE_NAME)_mp ++EXTRA_CFLAGS += -DCONFIG_MP_INCLUDED ++endif ++ ++ifeq ($(CONFIG_POWER_SAVING), y) ++EXTRA_CFLAGS += -DCONFIG_POWER_SAVING ++endif ++ ++ifeq ($(CONFIG_HW_PWRP_DETECTION), y) ++EXTRA_CFLAGS += -DCONFIG_HW_PWRP_DETECTION ++endif ++ ++ifeq ($(CONFIG_WIFI_TEST), y) ++EXTRA_CFLAGS += -DCONFIG_WIFI_TEST ++endif ++ ++ifeq ($(CONFIG_BT_COEXIST), y) ++EXTRA_CFLAGS += -DCONFIG_BT_COEXIST ++endif ++ ++ifeq ($(CONFIG_INTEL_WIDI), y) ++EXTRA_CFLAGS += -DCONFIG_INTEL_WIDI ++endif ++ ++ifeq ($(CONFIG_WAPI_SUPPORT), y) ++EXTRA_CFLAGS += -DCONFIG_WAPI_SUPPORT ++endif ++ ++ ++ifeq ($(CONFIG_EFUSE_CONFIG_FILE), y) ++EXTRA_CFLAGS += -DCONFIG_EFUSE_CONFIG_FILE ++ ++#EFUSE_MAP_PATH ++USER_EFUSE_MAP_PATH ?= ++ifneq ($(USER_EFUSE_MAP_PATH),) ++EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"$(USER_EFUSE_MAP_PATH)\" ++else ifeq ($(MODULE_NAME), 8189es) ++EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"/system/etc/wifi/wifi_efuse_8189e.map\" ++else ifeq ($(MODULE_NAME), 8723bs) ++EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"/system/etc/wifi/wifi_efuse_8723bs.map\" ++else ++EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"/system/etc/wifi/wifi_efuse_$(MODULE_NAME).map\" ++endif ++ ++#WIFIMAC_PATH ++USER_WIFIMAC_PATH ?= ++ifneq ($(USER_WIFIMAC_PATH),) ++EXTRA_CFLAGS += -DWIFIMAC_PATH=\"$(USER_WIFIMAC_PATH)\" ++else ++EXTRA_CFLAGS += -DWIFIMAC_PATH=\"/data/wifimac.txt\" ++endif ++ ++endif ++ ++ifeq ($(CONFIG_EXT_CLK), y) ++EXTRA_CFLAGS += -DCONFIG_EXT_CLK ++endif ++ ++ifeq ($(CONFIG_TRAFFIC_PROTECT), y) ++EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT ++endif ++ ++ifeq ($(CONFIG_LOAD_PHY_PARA_FROM_FILE), y) ++EXTRA_CFLAGS += -DCONFIG_LOAD_PHY_PARA_FROM_FILE ++#EXTRA_CFLAGS += -DREALTEK_CONFIG_PATH_WITH_IC_NAME_FOLDER ++#EXTRA_CFLAGS += -DREALTEK_CONFIG_PATH=\"/lib/firmware/\" ++EXTRA_CFLAGS += -DREALTEK_CONFIG_PATH=\"\" ++endif ++ ++ifeq ($(CONFIG_TXPWR_BY_RATE_EN), n) ++EXTRA_CFLAGS += -DCONFIG_TXPWR_BY_RATE_EN=0 ++else ifeq ($(CONFIG_TXPWR_BY_RATE_EN), y) ++EXTRA_CFLAGS += -DCONFIG_TXPWR_BY_RATE_EN=1 ++else ifeq ($(CONFIG_TXPWR_BY_RATE_EN), auto) ++EXTRA_CFLAGS += -DCONFIG_TXPWR_BY_RATE_EN=2 ++endif ++ ++ifeq ($(CONFIG_TXPWR_LIMIT_EN), n) ++EXTRA_CFLAGS += -DCONFIG_TXPWR_LIMIT_EN=0 ++else ifeq ($(CONFIG_TXPWR_LIMIT_EN), y) ++EXTRA_CFLAGS += -DCONFIG_TXPWR_LIMIT_EN=1 ++else ifeq ($(CONFIG_TXPWR_LIMIT_EN), auto) ++EXTRA_CFLAGS += -DCONFIG_TXPWR_LIMIT_EN=2 ++endif ++ ++ifeq ($(CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY), y) ++EXTRA_CFLAGS += -DCONFIG_CALIBRATE_TX_POWER_BY_REGULATORY ++endif ++ ++ifeq ($(CONFIG_CALIBRATE_TX_POWER_TO_MAX), y) ++EXTRA_CFLAGS += -DCONFIG_CALIBRATE_TX_POWER_TO_MAX ++endif ++ ++ifeq ($(CONFIG_RTW_ADAPTIVITY_EN), disable) ++EXTRA_CFLAGS += -DCONFIG_RTW_ADAPTIVITY_EN=0 ++else ifeq ($(CONFIG_RTW_ADAPTIVITY_EN), enable) ++EXTRA_CFLAGS += -DCONFIG_RTW_ADAPTIVITY_EN=1 ++endif ++ ++ifeq ($(CONFIG_RTW_ADAPTIVITY_MODE), normal) ++EXTRA_CFLAGS += -DCONFIG_RTW_ADAPTIVITY_MODE=0 ++else ifeq ($(CONFIG_RTW_ADAPTIVITY_MODE), carrier_sense) ++EXTRA_CFLAGS += -DCONFIG_RTW_ADAPTIVITY_MODE=1 ++endif ++ ++ifeq ($(CONFIG_SIGNAL_SCALE_MAPPING), y) ++EXTRA_CFLAGS += -DCONFIG_SIGNAL_SCALE_MAPPING ++endif ++ ++ifeq ($(CONFIG_80211W), y) ++EXTRA_CFLAGS += -DCONFIG_IEEE80211W ++endif ++ ++ifeq ($(CONFIG_WOWLAN), y) ++EXTRA_CFLAGS += -DCONFIG_WOWLAN ++ifeq ($(CONFIG_SDIO_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER ++endif ++ifeq ($(CONFIG_DEFAULT_PATTERNS_EN), y) ++EXTRA_CFLAGS += -DCONFIG_DEFAULT_PATTERNS_EN ++endif ++endif ++ ++ifeq ($(CONFIG_AP_WOWLAN), y) ++EXTRA_CFLAGS += -DCONFIG_AP_WOWLAN ++ifeq ($(CONFIG_SDIO_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER ++endif ++endif ++ ++ifeq ($(CONFIG_PNO_SUPPORT), y) ++EXTRA_CFLAGS += -DCONFIG_PNO_SUPPORT ++ifeq ($(CONFIG_PNO_SET_DEBUG), y) ++EXTRA_CFLAGS += -DCONFIG_PNO_SET_DEBUG ++endif ++endif ++ ++ifeq ($(CONFIG_GPIO_WAKEUP), y) ++EXTRA_CFLAGS += -DCONFIG_GPIO_WAKEUP ++ifeq ($(CONFIG_HIGH_ACTIVE), y) ++EXTRA_CFLAGS += -DHIGH_ACTIVE=1 ++else ++EXTRA_CFLAGS += -DHIGH_ACTIVE=0 ++endif ++endif ++ ++ifneq ($(CONFIG_WAKEUP_GPIO_IDX), default) ++EXTRA_CFLAGS += -DWAKEUP_GPIO_IDX=$(CONFIG_WAKEUP_GPIO_IDX) ++endif ++ ++ifeq ($(CONFIG_RTW_SDIO_PM_KEEP_POWER), y) ++ifeq ($(CONFIG_SDIO_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER ++endif ++endif ++ ++ifeq ($(CONFIG_REDUCE_TX_CPU_LOADING), y) ++EXTRA_CFLAGS += -DCONFIG_REDUCE_TX_CPU_LOADING ++endif ++ ++ifeq ($(CONFIG_BR_EXT), y) ++BR_NAME = br0 ++EXTRA_CFLAGS += -DCONFIG_BR_EXT ++EXTRA_CFLAGS += '-DCONFIG_BR_EXT_BRNAME="'$(BR_NAME)'"' ++endif ++ ++ifeq ($(CONFIG_ANTENNA_DIVERSITY), y) ++EXTRA_CFLAGS += -DCONFIG_ANTENNA_DIVERSITY ++endif ++ ++ifeq ($(CONFIG_TDLS), y) ++EXTRA_CFLAGS += -DCONFIG_TDLS ++endif ++ ++ifeq ($(CONFIG_WIFI_MONITOR), y) ++EXTRA_CFLAGS += -DCONFIG_WIFI_MONITOR ++endif ++ ++ifeq ($(CONFIG_MCC_MODE), y) ++EXTRA_CFLAGS += -DCONFIG_MCC_MODE ++endif ++ ++ifeq ($(CONFIG_RTW_NAPI), y) ++EXTRA_CFLAGS += -DCONFIG_RTW_NAPI ++endif ++ ++ifeq ($(CONFIG_RTW_GRO), y) ++EXTRA_CFLAGS += -DCONFIG_RTW_GRO ++endif ++ ++ifeq ($(CONFIG_MP_VHT_HW_TX_MODE), y) ++EXTRA_CFLAGS += -DCONFIG_MP_VHT_HW_TX_MODE ++ifeq ($(CONFIG_PLATFORM_I386_PC), y) ++## For I386 X86 ToolChain use Hardware FLOATING ++EXTRA_CFLAGS += -mhard-float ++else ++## For ARM ToolChain use Hardware FLOATING ++EXTRA_CFLAGS += -mfloat-abi=hard ++endif ++endif ++ ++ifeq ($(CONFIG_APPEND_VENDOR_IE_ENABLE), y) ++EXTRA_CFLAGS += -DCONFIG_APPEND_VENDOR_IE_ENABLE ++endif ++ ++ifeq ($(CONFIG_RTW_DEBUG), y) ++EXTRA_CFLAGS += -DCONFIG_RTW_DEBUG ++EXTRA_CFLAGS += -DRTW_LOG_LEVEL=$(CONFIG_RTW_LOG_LEVEL) ++endif ++ ++EXTRA_CFLAGS += -DDM_ODM_SUPPORT_TYPE=0x04 ++ ++ifeq ($(CONFIG_PLATFORM_I386_PC), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++SUBARCH := $(shell uname -m | sed -e s/i.86/i386/) ++ARCH ?= $(SUBARCH) ++CROSS_COMPILE ?= ++KVER := $(shell uname -r) ++KSRC := /lib/modules/$(KVER)/build ++MODDESTDIR := /lib/modules/$(KVER)/kernel/drivers/net/wireless/ ++INSTALL_PREFIX := ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ACTIONS_ATM702X), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -DCONFIG_PLATFORM_ACTIONS_ATM702X ++#ARCH := arm ++ARCH := $(R_ARCH) ++#CROSS_COMPILE := arm-none-linux-gnueabi- ++CROSS_COMPILE := $(R_CROSS_COMPILE) ++KVER:= 3.4.0 ++#KSRC := ../../../../build/out/kernel ++KSRC := $(KERNEL_BUILD_PATH) ++MODULE_NAME :=wlan ++endif ++ ++ ++ifeq ($(CONFIG_PLATFORM_ACTIONS_ATM705X), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++#EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC ++# default setting for Android 4.1, 4.2, 4.3, 4.4 ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_ACTIONS_ATM705X ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++ ++# Enable this for Android 5.0 ++EXTRA_CFLAGS += -DCONFIG_RADIO_WORK ++ ++ifeq ($(CONFIG_SDIO_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS ++_PLATFORM_FILES += platform/platform_arm_act_sdio.o ++endif ++ ++ARCH := arm ++CROSS_COMPILE := /opt/arm-2011.09/bin/arm-none-linux-gnueabi- ++KSRC := /home/android_sdk/Action-semi/705a_android_L/android/kernel ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_SUN50IW1P1), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN50IW1P1 ++EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT ++# default setting for Android 4.1, 4.2 ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++EXTRA_CFLAGS += -DCONFIG_RESUME_IN_WORKQUEUE ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS ++ ++# Enable this for Android 5.0 ++EXTRA_CFLAGS += -DCONFIG_RADIO_WORK ++ ++ifeq ($(CONFIG_USB_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX ++_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++_PLATFORM_FILES += platform/platform_ARM_SUN50IW1P1_sdio.o ++endif ++ ++ARCH := arm64 ++# ===Cross compile setting for Android 5.1(64) SDK === ++CROSS_COMPILE := /home/android_sdk/Allwinner/a64/android-51/lichee/out/sun50iw1p1/android/common/buildroot/external-toolchain/bin/aarch64-linux-gnu- ++KSRC :=/home/android_sdk/Allwinner/a64/android-51/lichee/linux-3.10/ ++endif ++ ++ifeq ($(CONFIG_PLATFORM_TI_AM3517), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -DCONFIG_PLATFORM_SHUTTLE ++CROSS_COMPILE := arm-eabi- ++KSRC := $(shell pwd)/../../../Android/kernel ++ARCH := arm ++endif ++ ++ifeq ($(CONFIG_PLATFORM_MSTAR_TITANIA12), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MSTAR -DCONFIG_PLATFORM_MSTAR_TITANIA12 ++ARCH:=mips ++CROSS_COMPILE:= /usr/src/Mstar_kernel/mips-4.3/bin/mips-linux-gnu- ++KVER:= 2.6.28.9 ++KSRC:= /usr/src/Mstar_kernel/2.6.28.9/ ++endif ++ ++ifeq ($(CONFIG_PLATFORM_MSTAR), y) ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MSTAR -DCONFIG_USE_USB_BUFFER_ALLOC_TX -DCONFIG_FIX_NR_BULKIN_BUFFER -DCONFIG_PREALLOC_RX_SKB_BUFFER ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_MSTAR_HIGH ++ARCH:=arm ++CROSS_COMPILE:= /usr/src/bin/arm-none-linux-gnueabi- ++KVER:= 3.1.10 ++KSRC:= /usr/src/Mstar_kernel/3.1.10/ ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ANDROID_X86), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++SUBARCH := $(shell uname -m | sed -e s/i.86/i386/) ++ARCH := $(SUBARCH) ++CROSS_COMPILE := /media/DATA-2/android-x86/ics-x86_20120130/prebuilt/linux-x86/toolchain/i686-unknown-linux-gnu-4.2.1/bin/i686-unknown-linux-gnu- ++KSRC := /media/DATA-2/android-x86/ics-x86_20120130/out/target/product/generic_x86/obj/kernel ++MODULE_NAME :=wlan ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ANDROID_INTEL_X86), y) ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_ANDROID_INTEL_X86 ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_INTEL_BYT ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++EXTRA_CFLAGS += -DCONFIG_SKIP_SIGNAL_SCALE_MAPPING ++ifeq ($(CONFIG_SDIO_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_RESUME_IN_WORKQUEUE ++endif ++endif ++ ++ifeq ($(CONFIG_PLATFORM_JB_X86), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++SUBARCH := $(shell uname -m | sed -e s/i.86/i386/) ++ARCH := $(SUBARCH) ++CROSS_COMPILE := /home/android_sdk/android-x86_JB/prebuilts/gcc/linux-x86/x86/i686-linux-android-4.7/bin/i686-linux-android- ++KSRC := /home/android_sdk/android-x86_JB/out/target/product/x86/obj/kernel/ ++MODULE_NAME :=wlan ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_NV_TK1), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT ++# default setting for Android 4.1, 4.2 ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++EXTRA_CFLAGS += -DCONFIG_P2P_IPS -DCONFIG_PLATFORM_ANDROID ++EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC ++#EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_OOB_INT ++# Enable this for Android 5.0 ++EXTRA_CFLAGS += -DCONFIG_RADIO_WORK ++EXTRA_CFLAGS += -DRTW_VENDOR_EXT_SUPPORT ++EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC ++ARCH := arm ++CROSS_COMPILE := /mnt/newdisk/android_sdk/nvidia_tk1/android_L/prebuilts/gcc/linux-x86/arm/arm-eabi-4.8/bin/arm-eabi- ++KSRC :=/mnt/newdisk/android_sdk/nvidia_tk1/android_L/out/target/product/shieldtablet/obj/KERNEL/ ++MODULE_NAME = wlan ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_PXA2XX), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++ARCH := arm ++CROSS_COMPILE := arm-none-linux-gnueabi- ++KVER := 2.6.34.1 ++KSRC ?= /usr/src/linux-2.6.34.1 ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_S3C2K4), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++ARCH := arm ++CROSS_COMPILE := arm-linux- ++KVER := 2.6.24.7_$(ARCH) ++KSRC := /usr/src/kernels/linux-$(KVER) ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_S3C6K4), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++ARCH := arm ++CROSS_COMPILE := arm-none-linux-gnueabi- ++KVER := 2.6.34.1 ++KSRC ?= /usr/src/linux-2.6.34.1 ++endif ++ ++ifeq ($(CONFIG_PLATFORM_RTD2880B), y) ++EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN -DCONFIG_PLATFORM_RTD2880B ++ARCH:= ++CROSS_COMPILE:= ++KVER:= ++KSRC:= ++endif ++ ++ifeq ($(CONFIG_PLATFORM_MIPS_RMI), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++ARCH:=mips ++CROSS_COMPILE:=mipsisa32r2-uclibc- ++KVER:= ++KSRC:= /root/work/kernel_realtek ++endif ++ ++ifeq ($(CONFIG_PLATFORM_MIPS_PLM), y) ++EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN ++ARCH:=mips ++CROSS_COMPILE:=mipsisa32r2-uclibc- ++KVER:= ++KSRC:= /root/work/kernel_realtek ++endif ++ ++ifeq ($(CONFIG_PLATFORM_MSTAR389), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MSTAR389 ++ARCH:=mips ++CROSS_COMPILE:= mips-linux-gnu- ++KVER:= 2.6.28.10 ++KSRC:= /home/mstar/mstar_linux/2.6.28.9/ ++endif ++ ++ifeq ($(CONFIG_PLATFORM_MIPS_AR9132), y) ++EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN ++ARCH := mips ++CROSS_COMPILE := mips-openwrt-linux- ++KSRC := /home/alex/test_openwrt/tmp/linux-2.6.30.9 ++endif ++ ++ifeq ($(CONFIG_PLATFORM_DMP_PHILIPS), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DRTK_DMP_PLATFORM ++ARCH := mips ++#CROSS_COMPILE:=/usr/local/msdk-4.3.6-mips-EL-2.6.12.6-0.9.30.3/bin/mipsel-linux- ++CROSS_COMPILE:=/usr/local/toolchain_mipsel/bin/mipsel-linux- ++KSRC ?=/usr/local/Jupiter/linux-2.6.12 ++endif ++ ++ifeq ($(CONFIG_PLATFORM_RTK_DMP), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DRTK_DMP_PLATFORM -DCONFIG_WIRELESS_EXT ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS ++ifeq ($(CONFIG_USB_HCI), y) ++_PLATFORM_FILES += platform/platform_RTK_DMP_usb.o ++endif ++ARCH:=mips ++CROSS_COMPILE:=mipsel-linux- ++KVER:= ++KSRC ?= /usr/src/DMP_Kernel/jupiter/linux-2.6.12 ++endif ++ ++ifeq ($(CONFIG_PLATFORM_MT53XX), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MT53XX ++ARCH:= arm ++CROSS_COMPILE:= arm11_mtk_le- ++KVER:= 2.6.27 ++KSRC?= /proj/mtk00802/BD_Compare/BDP/Dev/BDP_V301/BDP_Linux/linux-2.6.27 ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_MX51_241H), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_WISTRON_PLATFORM ++ARCH := arm ++CROSS_COMPILE := /opt/freescale/usr/local/gcc-4.1.2-glibc-2.5-nptl-3/arm-none-linux-gnueabi/bin/arm-none-linux-gnueabi- ++KVER := 2.6.31 ++KSRC ?= /lib/modules/2.6.31-770-g0e46b52/source ++endif ++ ++ifeq ($(CONFIG_PLATFORM_FS_MX61), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++ARCH := arm ++CROSS_COMPILE := /home/share/CusEnv/FreeScale/arm-eabi-4.4.3/bin/arm-eabi- ++KSRC ?= /home/share/CusEnv/FreeScale/FS_kernel_env ++endif ++ ++ ++ ++ifeq ($(CONFIG_PLATFORM_ACTIONS_ATJ227X), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ACTIONS_ATJ227X ++ARCH := mips ++CROSS_COMPILE := /home/cnsd4/project/actions/tools-2.6.27/bin/mipsel-linux-gnu- ++KVER := 2.6.27 ++KSRC := /home/cnsd4/project/actions/linux-2.6.27.28 ++endif ++ ++ifeq ($(CONFIG_PLATFORM_TI_DM365), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_TI_DM365 ++EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_RX ++EXTRA_CFLAGS += -DCONFIG_SINGLE_XMIT_BUF -DCONFIG_SINGLE_RECV_BUF ++ARCH := arm ++#CROSS_COMPILE := /home/cnsd4/Appro/mv_pro_5.0/montavista/pro/devkit/arm/v5t_le/bin/arm_v5t_le- ++#KSRC := /home/cnsd4/Appro/mv_pro_5.0/montavista/pro/devkit/lsp/ti-davinci/linux-dm365 ++CROSS_COMPILE := /opt/montavista/pro5.0/devkit/arm/v5t_le/bin/arm-linux- ++KSRC:= /home/vivotek/lsp/DM365/kernel_platform/kernel/linux-2.6.18 ++KERNELOUTPUT := ${PRODUCTDIR}/tmp ++KVER := 2.6.18 ++endif ++ ++ifeq ($(CONFIG_PLATFORM_MOZART), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MOZART ++ARCH := arm ++CROSS_COMPILE := /home/vivotek/lsp/mozart3v2/Mozart3e_Toolchain/build_arm_nofpu/usr/bin/arm-linux- ++KVER := $(shell uname -r) ++KSRC:= /opt/Vivotek/lsp/mozart3v2/kernel_platform/kernel/mozart_kernel-1.17 ++KERNELOUTPUT := /home/pink/sample/ODM/IP8136W-VINT/tmp/kernel ++endif ++ ++ifeq ($(CONFIG_PLATFORM_TEGRA3_CARDHU), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++# default setting for Android 4.1, 4.2 ++EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++ARCH := arm ++CROSS_COMPILE := /home/android_sdk/nvidia/tegra-16r3-partner-android-4.1_20120723/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- ++KSRC := /home/android_sdk/nvidia/tegra-16r3-partner-android-4.1_20120723/out/target/product/cardhu/obj/KERNEL ++MODULE_NAME := wlan ++endif ++ ++ifeq ($(CONFIG_PLATFORM_TEGRA4_DALMORE), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++# default setting for Android 4.1, 4.2 ++EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++ARCH := arm ++CROSS_COMPILE := /home/android_sdk/nvidia/tegra-17r9-partner-android-4.2-dalmore_20130131/prebuilts/gcc/linux-x86/arm/arm-eabi-4.6/bin/arm-eabi- ++KSRC := /home/android_sdk/nvidia/tegra-17r9-partner-android-4.2-dalmore_20130131/out/target/product/dalmore/obj/KERNEL ++MODULE_NAME := wlan ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_TCC8900), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++ARCH := arm ++CROSS_COMPILE := /home/android_sdk/Telechips/SDK_2304_20110613/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- ++KSRC := /home/android_sdk/Telechips/SDK_2304_20110613/kernel ++MODULE_NAME := wlan ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_TCC8920), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++ARCH := arm ++CROSS_COMPILE := /home/android_sdk/Telechips/v12.06_r1-tcc-android-4.0.4/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- ++KSRC := /home/android_sdk/Telechips/v12.06_r1-tcc-android-4.0.4/kernel ++MODULE_NAME := wlan ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_TCC8920_JB42), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++# default setting for Android 4.1, 4.2 ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++ARCH := arm ++CROSS_COMPILE := /home/android_sdk/Telechips/v13.03_r1-tcc-android-4.2.2_ds_patched/prebuilts/gcc/linux-x86/arm/arm-eabi-4.6/bin/arm-eabi- ++KSRC := /home/android_sdk/Telechips/v13.03_r1-tcc-android-4.2.2_ds_patched/kernel ++MODULE_NAME := wlan ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_RK2818), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -DCONFIG_PLATFORM_ROCKCHIPS ++ARCH := arm ++CROSS_COMPILE := /usr/src/release_fae_version/toolchain/arm-eabi-4.4.0/bin/arm-eabi- ++KSRC := /usr/src/release_fae_version/kernel25_A7_281x ++MODULE_NAME := wlan ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_RK3188), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -DCONFIG_PLATFORM_ROCKCHIPS ++# default setting for Android 4.1, 4.2, 4.3, 4.4 ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++# default setting for Power control ++EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC ++EXTRA_CFLAGS += -DRTW_SUPPORT_PLATFORM_SHUTDOWN ++# default setting for Special function ++ARCH := arm ++CROSS_COMPILE := /home/android_sdk/Rockchip/Rk3188/prebuilts/gcc/linux-x86/arm/arm-eabi-4.6/bin/arm-eabi- ++KSRC := /home/android_sdk/Rockchip/Rk3188/kernel ++MODULE_NAME := wlan ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_RK3066), y) ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_RK3066 ++EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 ++ifeq ($(CONFIG_SDIO_HCI), y) ++EXTRA_CFLAGS += -DRTW_SUPPORT_PLATFORM_SHUTDOWN ++endif ++EXTRA_CFLAGS += -fno-pic ++ARCH := arm ++CROSS_COMPILE := /home/android_sdk/Rockchip/rk3066_20130607/prebuilts/gcc/linux-x86/arm/arm-linux-androideabi-4.6/bin/arm-linux-androideabi- ++#CROSS_COMPILE := /home/android_sdk/Rockchip/Rk3066sdk/prebuilts/gcc/linux-x86/arm/arm-linux-androideabi-4.6/bin/arm-linux-androideabi- ++KSRC := /home/android_sdk/Rockchip/Rk3066sdk/kernel ++MODULE_NAME :=wlan ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_URBETTER), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN #-DCONFIG_MINIMAL_MEMORY_USAGE ++ARCH := arm ++CROSS_COMPILE := /media/DATA-1/urbetter/arm-2009q3/bin/arm-none-linux-gnueabi- ++KSRC := /media/DATA-1/urbetter/ics-urbetter/kernel ++MODULE_NAME := wlan ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_TI_PANDA), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN #-DCONFIG_MINIMAL_MEMORY_USAGE ++ARCH := arm ++#CROSS_COMPILE := /media/DATA-1/aosp/ics-aosp_20111227/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- ++#KSRC := /media/DATA-1/aosp/android-omap-panda-3.0_20120104 ++CROSS_COMPILE := /media/DATA-1/android-4.0/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- ++KSRC := /media/DATA-1/android-4.0/panda_kernel/omap ++MODULE_NAME := wlan ++endif ++ ++ifeq ($(CONFIG_PLATFORM_MIPS_JZ4760), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_MINIMAL_MEMORY_USAGE ++ARCH ?= mips ++CROSS_COMPILE ?= /mnt/sdb5/Ingenic/Umido/mips-4.3/bin/mips-linux-gnu- ++KSRC ?= /mnt/sdb5/Ingenic/Umido/kernel ++endif ++ ++ifeq ($(CONFIG_PLATFORM_SZEBOOK), y) ++EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN ++ARCH:=arm ++CROSS_COMPILE:=/opt/crosstool2/bin/armeb-unknown-linux-gnueabi- ++KVER:= 2.6.31.6 ++KSRC:= ../code/linux-2.6.31.6-2020/ ++endif ++ ++#Add setting for MN10300 ++ifeq ($(CONFIG_PLATFORM_MN10300), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MN10300 ++ARCH := mn10300 ++CROSS_COMPILE := mn10300-linux- ++KVER := 2.6.32.2 ++KSRC := /home/winuser/work/Plat_sLD2T_V3010/usr/src/linux-2.6.32.2 ++INSTALL_PREFIX := ++endif ++ ++ ++ifeq ($(CONFIG_PLATFORM_ARM_SUNxI), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUNxI ++# default setting for Android 4.1, 4.2 ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++ ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS ++ifeq ($(CONFIG_USB_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX ++_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++# default setting for A10-EVB mmc0 ++#EXTRA_CFLAGS += -DCONFIG_WITS_EVB_V13 ++_PLATFORM_FILES += platform/platform_ARM_SUNxI_sdio.o ++endif ++ ++ARCH := arm ++#CROSS_COMPILE := arm-none-linux-gnueabi- ++CROSS_COMPILE=/home/android_sdk/Allwinner/a10/android-jb42/lichee-jb42/buildroot/output/external-toolchain/bin/arm-none-linux-gnueabi- ++KVER := 3.0.8 ++#KSRC:= ../lichee/linux-3.0/ ++KSRC=/home/android_sdk/Allwinner/a10/android-jb42/lichee-jb42/linux-3.0 ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_SUN6I), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN6I ++EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT ++# default setting for Android 4.1, 4.2, 4.3, 4.4 ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION ++ ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS ++ifeq ($(CONFIG_USB_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX ++_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++# default setting for A31-EVB mmc0 ++EXTRA_CFLAGS += -DCONFIG_A31_EVB ++_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o ++endif ++ ++ARCH := arm ++#Android-JB42 ++#CROSS_COMPILE := /home/android_sdk/Allwinner/a31/android-jb42/lichee/buildroot/output/external-toolchain/bin/arm-linux-gnueabi- ++#KSRC :=/home/android_sdk/Allwinner/a31/android-jb42/lichee/linux-3.3 ++#ifeq ($(CONFIG_USB_HCI), y) ++#MODULE_NAME := 8188eu_sw ++#endif ++# ==== Cross compile setting for kitkat-a3x_v4.5 ===== ++CROSS_COMPILE := /home/android_sdk/Allwinner/a31/kitkat-a3x_v4.5/lichee/buildroot/output/external-toolchain/bin/arm-linux-gnueabi- ++KSRC :=/home/android_sdk/Allwinner/a31/kitkat-a3x_v4.5/lichee/linux-3.3 ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_SUN7I), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN7I ++EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT ++# default setting for Android 4.1, 4.2, 4.3, 4.4 ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION ++ ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS ++ifeq ($(CONFIG_USB_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX ++_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o ++endif ++ ++ARCH := arm ++# ===Cross compile setting for Android 4.2 SDK === ++#CROSS_COMPILE := /home/android_sdk/Allwinner/a20_evb/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- ++#KSRC := /home/android_sdk/Allwinner/a20_evb/lichee/linux-3.3 ++# ==== Cross compile setting for Android 4.3 SDK ===== ++#CROSS_COMPILE := /home/android_sdk/Allwinner/a20/android-jb43/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- ++#KSRC := /home/android_sdk/Allwinner/a20/android-jb43/lichee/linux-3.4 ++# ==== Cross compile setting for kitkat-a20_v4.4 ===== ++CROSS_COMPILE := /home/android_sdk/Allwinner/a20/kitkat-a20_v4.4/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- ++KSRC := /home/android_sdk/Allwinner/a20/kitkat-a20_v4.4/lichee/linux-3.4 ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_SUN8I_W3P1), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN8I ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN8I_W3P1 ++EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT ++# default setting for Android 4.1, 4.2 ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++ ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS ++ifeq ($(CONFIG_USB_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX ++_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o ++endif ++ ++ARCH := arm ++# ===Cross compile setting for Android 4.2 SDK === ++#CROSS_COMPILE := /home/android_sdk/Allwinner/a23/android-jb42/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- ++#KSRC :=/home/android_sdk/Allwinner/a23/android-jb42/lichee/linux-3.4 ++# ===Cross compile setting for Android 4.4 SDK === ++CROSS_COMPILE := /home/android_sdk/Allwinner/a23/android-kk44/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- ++KSRC :=/home/android_sdk/Allwinner/a23/android-kk44/lichee/linux-3.4 ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_SUN8I_W5P1), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN8I ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN8I_W5P1 ++EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT ++# default setting for Android 4.1, 4.2 ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++ ++# Enable this for Android 5.0 ++EXTRA_CFLAGS += -DCONFIG_RADIO_WORK ++ ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS ++ifeq ($(CONFIG_USB_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX ++_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o ++endif ++ ++ARCH := arm ++# ===Cross compile setting for Android L SDK === ++CROSS_COMPILE := /home/android_sdk/Allwinner/a33/android-L/lichee/out/sun8iw5p1/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- ++KSRC :=/home/android_sdk/Allwinner/a33/android-L/lichee/linux-3.4 ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ACTIONS_ATV5201), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ACTIONS_ATV5201 ++EXTRA_CFLAGS += -DCONFIG_SDIO_DISABLE_RXFIFO_POLLING_LOOP ++ARCH := mips ++CROSS_COMPILE := mipsel-linux-gnu- ++KVER := $(KERNEL_VER) ++KSRC:= $(CFGDIR)/../../kernel/linux-$(KERNEL_VER) ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_RTD299X), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DUSB_XMITBUF_ALIGN_SZ=1024 -DUSB_PACKET_OFFSET_SZ=0 ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++ifeq ($(CONFIG_ANDROID), y) ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++# Enable this for Android 5.0 ++EXTRA_CFLAGS += -DCONFIG_RADIO_WORK ++endif ++#ARCH, CROSS_COMPILE, KSRC,and MODDESTDIR are provided by external makefile ++INSTALL_PREFIX := ++endif ++ ++ifeq ($(CONFIG_PLATFORM_HISILICON), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_HISILICON ++ifeq ($(SUPPORT_CONCURRENT),y) ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++endif ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++ARCH := arm ++ifeq ($(CROSS_COMPILE),) ++ CROSS_COMPILE = arm-hisiv200-linux- ++endif ++MODULE_NAME := rtl8192eu ++ifeq ($(KSRC),) ++ KSRC := ../../../../../../kernel/linux-3.4.y ++endif ++endif ++ ++# Platform setting ++ifeq ($(CONFIG_PLATFORM_ARM_SPREADTRUM_6820), y) ++ifeq ($(CONFIG_ANDROID_2X), y) ++EXTRA_CFLAGS += -DANDROID_2X ++endif ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_SPRD ++EXTRA_CFLAGS += -DPLATFORM_SPREADTRUM_6820 ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++ifeq ($(RTL871X), rtl8188e) ++EXTRA_CFLAGS += -DSOFTAP_PS_DURATION=50 ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS ++_PLATFORM_FILES += platform/platform_sprd_sdio.o ++endif ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_SPREADTRUM_8810), y) ++ifeq ($(CONFIG_ANDROID_2X), y) ++EXTRA_CFLAGS += -DANDROID_2X ++endif ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_SPRD ++EXTRA_CFLAGS += -DPLATFORM_SPREADTRUM_8810 ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++ifeq ($(RTL871X), rtl8188e) ++EXTRA_CFLAGS += -DSOFTAP_PS_DURATION=50 ++endif ++ifeq ($(CONFIG_SDIO_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS ++_PLATFORM_FILES += platform/platform_sprd_sdio.o ++endif ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_WMT), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS ++ifeq ($(CONFIG_SDIO_HCI), y) ++_PLATFORM_FILES += platform/platform_ARM_WMT_sdio.o ++endif ++ARCH := arm ++CROSS_COMPILE := /home/android_sdk/WonderMedia/wm8880-android4.4/toolchain/arm_201103_gcc4.5.2/mybin/arm_1103_le- ++KSRC := /home/android_sdk/WonderMedia/wm8880-android4.4/kernel4.4/ ++MODULE_NAME :=8189es_kk ++endif ++ ++ifeq ($(CONFIG_PLATFORM_RTK119X), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++#EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN7I ++EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT ++# default setting for Android 4.1, 4.2 ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++#EXTRA_CFLAGS += -DCONFIG_IFACE_NUMBER=3 ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++#EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION ++EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION ++ ++#EXTRA_CFLAGS += -DCONFIG_#PLATFORM_OPS ++ifeq ($(CONFIG_USB_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX ++#_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o ++endif ++#ifeq ($(CONFIG_SDIO_HCI), y) ++#_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o ++#endif ++ ++ARCH := arm ++ ++# ==== Cross compile setting for Android 4.4 SDK ===== ++#CROSS_COMPILE := arm-linux-gnueabihf- ++KVER := 3.10.24 ++#KSRC :=/home/android_sdk/Allwinner/a20/android-kitkat44/lichee/linux-3.4 ++CROSS_COMPILE := $(CROSS) ++KSRC := $(LINUX_KERNEL_PATH) ++MODULE_NAME := 8192eu ++ ++endif ++ ++ifeq ($(CONFIG_PLATFORM_RTK129X), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DRTK_129X_PLATFORM ++EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT ++# default setting for Android 4.1, 4.2 ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++#EXTRA_CFLAGS += -DCONFIG_P2P_IPS -DCONFIG_QOS_OPTIMIZATION ++EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION ++EXTRA_CFLAGS += -Wno-error=date-time ++ ++#EXTRA_CFLAGS += -DCONFIG_#PLATFORM_OPS ++ifeq ($(CONFIG_USB_HCI), y) ++EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX ++#_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o ++endif ++ ++ARCH := arm64 ++ ++# ==== Cross compile setting for Android 4.4 SDK ===== ++#CROSS_COMPILE := arm-linux-gnueabihf- ++KVER := 4.1.10 ++CROSS_COMPILE := $(CROSS) ++KSRC := $(LINUX_KERNEL_PATH) ++MODULE_NAME := 8822be ++endif ++ ++ifeq ($(CONFIG_PLATFORM_NOVATEK_NT72668), y) ++EXTRA_CFLAGS += -DCONFIG_PLATFORM_NOVATEK_NT72668 ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_RX ++EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX ++ARCH ?= arm ++CROSS_COMPILE := arm-linux-gnueabihf- ++KVER := 3.8.0 ++KSRC := /Custom/Novatek/TCL/linux-3.8_header ++#KSRC := $(KERNELDIR) ++endif ++ ++ifeq ($(CONFIG_PLATFORM_ARM_TCC8930_JB42), y) ++EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ++# default setting for Android 4.1, 4.2 ++EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE ++EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT ++ARCH := arm ++CROSS_COMPILE := /home/android_sdk/Telechips/v13.05_r1-tcc-android-4.2.2_tcc893x-evm_build/prebuilts/gcc/linux-x86/arm/arm-eabi-4.6/bin/arm-eabi- ++KSRC := /home/android_sdk/Telechips/v13.05_r1-tcc-android-4.2.2_tcc893x-evm_build/kernel ++MODULE_NAME := wlan ++endif ++ ++ifeq ($(CONFIG_MULTIDRV), y) ++ ++ifeq ($(CONFIG_SDIO_HCI), y) ++MODULE_NAME := rtw_sdio ++endif ++ ++ifeq ($(CONFIG_USB_HCI), y) ++MODULE_NAME := rtw_usb ++endif ++ ++ifeq ($(CONFIG_PCI_HCI), y) ++MODULE_NAME := rtw_pci ++endif ++ ++ ++endif ++ ++USER_MODULE_NAME ?= ++ifneq ($(USER_MODULE_NAME),) ++MODULE_NAME := $(USER_MODULE_NAME) ++endif ++ ++ifneq ($(KERNELRELEASE),) ++ ++rtk_core := core/rtw_cmd.o \ ++ core/rtw_security.o \ ++ core/rtw_debug.o \ ++ core/rtw_io.o \ ++ core/rtw_ioctl_query.o \ ++ core/rtw_ioctl_set.o \ ++ core/rtw_ieee80211.o \ ++ core/rtw_mlme.o \ ++ core/rtw_mlme_ext.o \ ++ core/rtw_mi.o \ ++ core/rtw_wlan_util.o \ ++ core/rtw_vht.o \ ++ core/rtw_pwrctrl.o \ ++ core/rtw_rf.o \ ++ core/rtw_recv.o \ ++ core/rtw_sta_mgt.o \ ++ core/rtw_ap.o \ ++ core/rtw_xmit.o \ ++ core/rtw_p2p.o \ ++ core/rtw_tdls.o \ ++ core/rtw_br_ext.o \ ++ core/rtw_iol.o \ ++ core/rtw_sreset.o \ ++ core/rtw_btcoex.o \ ++ core/rtw_beamforming.o \ ++ core/rtw_odm.o \ ++ core/efuse/rtw_efuse.o ++ ++ifeq ($(CONFIG_SDIO_HCI), y) ++rtk_core += core/rtw_sdio.o ++endif ++ ++$(MODULE_NAME)-y += $(rtk_core) ++ ++$(MODULE_NAME)-$(CONFIG_INTEL_WIDI) += core/rtw_intel_widi.o ++ ++$(MODULE_NAME)-$(CONFIG_WAPI_SUPPORT) += core/rtw_wapi.o \ ++ core/rtw_wapi_sms4.o ++ ++$(MODULE_NAME)-y += $(_OS_INTFS_FILES) ++$(MODULE_NAME)-y += $(_HAL_INTFS_FILES) ++$(MODULE_NAME)-y += $(_OUTSRC_FILES) ++$(MODULE_NAME)-y += $(_PLATFORM_FILES) ++ ++$(MODULE_NAME)-$(CONFIG_MP_INCLUDED) += core/rtw_mp.o ++ ++ifeq ($(CONFIG_RTL8723B), y) ++$(MODULE_NAME)-$(CONFIG_MP_INCLUDED)+= core/rtw_bt_mp.o ++endif ++ ++obj-$(CONFIG_RTL8723DE) := $(MODULE_NAME).o ++ ++else ++ ++export CONFIG_RTL8723DE = m ++ ++all: modules ++ ++modules: ++ $(MAKE) ARCH=$(ARCH) CROSS_COMPILE=$(CROSS_COMPILE) -C $(KSRC) M=$(shell pwd) modules ++ ++strip: ++ $(CROSS_COMPILE)strip $(MODULE_NAME).ko --strip-unneeded ++ ++install: ++ install -p -m 644 $(MODULE_NAME).ko $(MODDESTDIR) ++ /sbin/depmod -a ${KVER} ++ ++uninstall: ++ rm -f $(MODDESTDIR)/$(MODULE_NAME).ko ++ /sbin/depmod -a ${KVER} ++ ++config_r: ++ @echo "make config" ++ /bin/bash script/Configure script/config.in ++ ++ ++.PHONY: modules clean ++ ++clean: ++ #$(MAKE) -C $(KSRC) M=$(shell pwd) clean ++ cd hal ; rm -fr */*/*/*.mod.c */*/*/*.mod */*/*/*.o */*/*/.*.cmd */*/*/*.ko ++ cd hal ; rm -fr */*/*.mod.c */*/*.mod */*/*.o */*/.*.cmd */*/*.ko ++ cd hal ; rm -fr */*.mod.c */*.mod */*.o */.*.cmd */*.ko ++ cd hal ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko ++ cd core/efuse ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko ++ cd core ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko ++ cd os_dep/linux ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko ++ cd os_dep ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko ++ cd platform ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko ++ rm -fr Module.symvers ; rm -fr Module.markers ; rm -fr modules.order ++ rm -fr *.mod.c *.mod *.o .*.cmd *.ko *~ ++ rm -fr .tmp_versions ++endif ++ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/custom_gpio_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/custom_gpio_linux.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/custom_gpio_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/custom_gpio_linux.c 2018-02-11 21:44:27.173146482 +0200 +@@ -0,0 +1,346 @@ ++/****************************************************************************** ++ * Customer code to add GPIO control during WLAN start/stop ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#include "drv_types.h" ++ ++#ifdef CONFIG_PLATFORM_SPRD ++ ++/* gspi func & GPIO define */ ++#include /* 0915 */ ++#include ++ ++#if !(defined ANDROID_2X) ++ ++#ifdef CONFIG_RTL8188E ++#include ++#include ++#endif /* CONFIG_RTL8188E */ ++ ++#ifndef GPIO_WIFI_POWER ++#define GPIO_WIFI_POWER -1 ++#endif /* !GPIO_WIFI_POWER */ ++ ++#ifndef GPIO_WIFI_RESET ++#define GPIO_WIFI_RESET -1 ++#endif /* !GPIO_WIFI_RESET */ ++ ++#ifndef GPIO_WIFI_PWDN ++#define GPIO_WIFI_PWDN -1 ++#endif /* !GPIO_WIFI_RESET */ ++#ifdef CONFIG_GSPI_HCI ++extern unsigned int oob_irq; ++#endif /* CONFIG_GSPI_HCI */ ++ ++#ifdef CONFIG_SDIO_HCI ++extern int rtw_mp_mode; ++#else /* !CONFIG_SDIO_HCI */ ++#endif /* !CONFIG_SDIO_HCI */ ++ ++int rtw_wifi_gpio_init(void) ++{ ++#ifdef CONFIG_GSPI_HCI ++ if (GPIO_WIFI_IRQ > 0) { ++ gpio_request(GPIO_WIFI_IRQ, "oob_irq"); ++ gpio_direction_input(GPIO_WIFI_IRQ); ++ ++ oob_irq = gpio_to_irq(GPIO_WIFI_IRQ); ++ ++ RTW_INFO("%s oob_irq:%d\n", __func__, oob_irq); ++ } ++#endif ++ if (GPIO_WIFI_RESET > 0) ++ gpio_request(GPIO_WIFI_RESET , "wifi_rst"); ++ if (GPIO_WIFI_POWER > 0) ++ gpio_request(GPIO_WIFI_POWER, "wifi_power"); ++ ++#ifdef CONFIG_SDIO_HCI ++#if (defined(CONFIG_RTL8723B)) && (MP_DRIVER == 1) ++ if (rtw_mp_mode == 1) { ++ RTW_INFO("%s GPIO_BT_RESET pin special for mp_test\n", __func__); ++ if (GPIO_BT_RESET > 0) ++ gpio_request(GPIO_BT_RESET , "bt_rst"); ++ } ++#endif ++#endif ++ return 0; ++} ++ ++int rtw_wifi_gpio_deinit(void) ++{ ++#ifdef CONFIG_GSPI_HCI ++ if (GPIO_WIFI_IRQ > 0) ++ gpio_free(GPIO_WIFI_IRQ); ++#endif ++ if (GPIO_WIFI_RESET > 0) ++ gpio_free(GPIO_WIFI_RESET); ++ if (GPIO_WIFI_POWER > 0) ++ gpio_free(GPIO_WIFI_POWER); ++ ++#ifdef CONFIG_SDIO_HCI ++#if (defined(CONFIG_RTL8723B)) && (MP_DRIVER == 1) ++ if (rtw_mp_mode == 1) { ++ RTW_INFO("%s GPIO_BT_RESET pin special for mp_test\n", __func__); ++ if (GPIO_BT_RESET > 0) ++ gpio_free(GPIO_BT_RESET); ++ } ++#endif ++#endif ++ return 0; ++} ++ ++/* Customer function to control hw specific wlan gpios */ ++void rtw_wifi_gpio_wlan_ctrl(int onoff) ++{ ++ switch (onoff) { ++ case WLAN_PWDN_OFF: ++ RTW_INFO("%s: call customer specific GPIO(%d) to set wifi power down pin to 0\n", ++ __FUNCTION__, GPIO_WIFI_RESET); ++ ++#ifndef CONFIG_DONT_BUS_SCAN ++ if (GPIO_WIFI_RESET > 0) ++ gpio_direction_output(GPIO_WIFI_RESET , 0); ++#endif ++ break; ++ ++ case WLAN_PWDN_ON: ++ RTW_INFO("%s: callc customer specific GPIO(%d) to set wifi power down pin to 1\n", ++ __FUNCTION__, GPIO_WIFI_RESET); ++ ++ if (GPIO_WIFI_RESET > 0) ++ gpio_direction_output(GPIO_WIFI_RESET , 1); ++ break; ++ ++ case WLAN_POWER_OFF: ++ break; ++ ++ case WLAN_POWER_ON: ++ break; ++#ifdef CONFIG_SDIO_HCI ++#if (defined(CONFIG_RTL8723B)) && (MP_DRIVER == 1) ++ case WLAN_BT_PWDN_OFF: ++ if (rtw_mp_mode == 1) { ++ RTW_INFO("%s: call customer specific GPIO to set wifi power down pin to 0\n", ++ __FUNCTION__); ++ if (GPIO_BT_RESET > 0) ++ gpio_direction_output(GPIO_BT_RESET , 0); ++ } ++ break; ++ ++ case WLAN_BT_PWDN_ON: ++ if (rtw_mp_mode == 1) { ++ RTW_INFO("%s: callc customer specific GPIO to set wifi power down pin to 1 %x\n", ++ __FUNCTION__, GPIO_BT_RESET); ++ ++ if (GPIO_BT_RESET > 0) ++ gpio_direction_output(GPIO_BT_RESET , 1); ++ } ++ break; ++#endif ++#endif ++ } ++} ++ ++#else /* ANDROID_2X */ ++ ++#include ++ ++#ifdef CONFIG_RTL8188E ++extern int sprd_3rdparty_gpio_wifi_power; ++#endif ++extern int sprd_3rdparty_gpio_wifi_pwd; ++#if defined(CONFIG_RTL8723B) ++extern int sprd_3rdparty_gpio_bt_reset; ++#endif ++ ++int rtw_wifi_gpio_init(void) ++{ ++#if defined(CONFIG_RTL8723B) ++ if (sprd_3rdparty_gpio_bt_reset > 0) ++ gpio_direction_output(sprd_3rdparty_gpio_bt_reset, 1); ++#endif ++ ++ return 0; ++} ++ ++int rtw_wifi_gpio_deinit(void) ++{ ++ return 0; ++} ++ ++/* Customer function to control hw specific wlan gpios */ ++void rtw_wifi_gpio_wlan_ctrl(int onoff) ++{ ++ switch (onoff) { ++ case WLAN_PWDN_OFF: ++ RTW_INFO("%s: call customer specific GPIO to set wifi power down pin to 0\n", ++ __FUNCTION__); ++ if (sprd_3rdparty_gpio_wifi_pwd > 0) ++ gpio_set_value(sprd_3rdparty_gpio_wifi_pwd, 0); ++ ++ if (sprd_3rdparty_gpio_wifi_pwd == 60) { ++ RTW_INFO("%s: turn off VSIM2 2.8V\n", __func__); ++ LDO_TurnOffLDO(LDO_LDO_SIM2); ++ } ++ break; ++ ++ case WLAN_PWDN_ON: ++ RTW_INFO("%s: callc customer specific GPIO to set wifi power down pin to 1\n", ++ __FUNCTION__); ++ if (sprd_3rdparty_gpio_wifi_pwd == 60) { ++ RTW_INFO("%s: turn on VSIM2 2.8V\n", __func__); ++ LDO_SetVoltLevel(LDO_LDO_SIM2, LDO_VOLT_LEVEL0); ++ LDO_TurnOnLDO(LDO_LDO_SIM2); ++ } ++ if (sprd_3rdparty_gpio_wifi_pwd > 0) ++ gpio_set_value(sprd_3rdparty_gpio_wifi_pwd, 1); ++ break; ++ ++ case WLAN_POWER_OFF: ++#ifdef CONFIG_RTL8188E ++#ifdef CONFIG_WIF1_LDO ++ RTW_INFO("%s: turn off VDD-WIFI0 1.2V\n", __FUNCTION__); ++ LDO_TurnOffLDO(LDO_LDO_WIF1); ++#endif /* CONFIG_WIF1_LDO */ ++ ++ RTW_INFO("%s: turn off VDD-WIFI0 3.3V\n", __FUNCTION__); ++ LDO_TurnOffLDO(LDO_LDO_WIF0); ++ ++ RTW_INFO("%s: call customer specific GPIO(%d) to turn off wifi power\n", ++ __FUNCTION__, sprd_3rdparty_gpio_wifi_power); ++ if (sprd_3rdparty_gpio_wifi_power != 65535) ++ gpio_set_value(sprd_3rdparty_gpio_wifi_power, 0); ++#endif ++ break; ++ ++ case WLAN_POWER_ON: ++#ifdef CONFIG_RTL8188E ++ RTW_INFO("%s: call customer specific GPIO(%d) to turn on wifi power\n", ++ __FUNCTION__, sprd_3rdparty_gpio_wifi_power); ++ if (sprd_3rdparty_gpio_wifi_power != 65535) ++ gpio_set_value(sprd_3rdparty_gpio_wifi_power, 1); ++ ++ RTW_INFO("%s: turn on VDD-WIFI0 3.3V\n", __FUNCTION__); ++ LDO_TurnOnLDO(LDO_LDO_WIF0); ++ LDO_SetVoltLevel(LDO_LDO_WIF0, LDO_VOLT_LEVEL1); ++ ++#ifdef CONFIG_WIF1_LDO ++ RTW_INFO("%s: turn on VDD-WIFI1 1.2V\n", __func__); ++ LDO_TurnOnLDO(LDO_LDO_WIF1); ++ LDO_SetVoltLevel(LDO_LDO_WIF1, LDO_VOLT_LEVEL3); ++#endif /* CONFIG_WIF1_LDO */ ++#endif ++ break; ++ ++ case WLAN_BT_PWDN_OFF: ++ RTW_INFO("%s: call customer specific GPIO to set bt power down pin to 0\n", ++ __FUNCTION__); ++#if defined(CONFIG_RTL8723B) ++ if (sprd_3rdparty_gpio_bt_reset > 0) ++ gpio_set_value(sprd_3rdparty_gpio_bt_reset, 0); ++#endif ++ break; ++ ++ case WLAN_BT_PWDN_ON: ++ RTW_INFO("%s: callc customer specific GPIO to set bt power down pin to 1\n", ++ __FUNCTION__); ++#if defined(CONFIG_RTL8723B) ++ if (sprd_3rdparty_gpio_bt_reset > 0) ++ gpio_set_value(sprd_3rdparty_gpio_bt_reset, 1); ++#endif ++ break; ++ } ++} ++#endif /* ANDROID_2X */ ++ ++#elif defined(CONFIG_PLATFORM_ARM_RK3066) ++#include ++ ++#define GPIO_WIFI_IRQ RK30_PIN2_PC2 ++extern unsigned int oob_irq; ++int rtw_wifi_gpio_init(void) ++{ ++#ifdef CONFIG_GSPI_HCI ++ if (GPIO_WIFI_IRQ > 0) { ++ rk30_mux_api_set(GPIO2C2_LCDC1DATA18_SMCBLSN1_HSADCDATA5_NAME, GPIO2C_GPIO2C2);/* jacky_test */ ++ gpio_request(GPIO_WIFI_IRQ, "oob_irq"); ++ gpio_direction_input(GPIO_WIFI_IRQ); ++ ++ oob_irq = gpio_to_irq(GPIO_WIFI_IRQ); ++ ++ RTW_INFO("%s oob_irq:%d\n", __func__, oob_irq); ++ } ++#endif ++ return 0; ++} ++ ++ ++int rtw_wifi_gpio_deinit(void) ++{ ++#ifdef CONFIG_GSPI_HCI ++ if (GPIO_WIFI_IRQ > 0) ++ gpio_free(GPIO_WIFI_IRQ); ++#endif ++ return 0; ++} ++ ++void rtw_wifi_gpio_wlan_ctrl(int onoff) ++{ ++} ++ ++#ifdef CONFIG_GPIO_API ++/* this is a demo for extending GPIO pin[7] as interrupt mode */ ++struct net_device *rtl_net; ++extern int rtw_register_gpio_interrupt(struct net_device *netdev, int gpio_num, void(*callback)(u8 level)); ++extern int rtw_disable_gpio_interrupt(struct net_device *netdev, int gpio_num); ++void gpio_int(u8 is_high) ++{ ++ RTW_INFO("%s level=%d\n", __func__, is_high); ++} ++int register_net_gpio_init(void) ++{ ++ rtl_net = dev_get_by_name(&init_net, "wlan0"); ++ if (!rtl_net) { ++ RTW_PRINT("rtl_net init fail!\n"); ++ return -1; ++ } ++ return rtw_register_gpio_interrupt(rtl_net, 7, gpio_int); ++} ++int unregister_net_gpio_init(void) ++{ ++ rtl_net = dev_get_by_name(&init_net, "wlan0"); ++ if (!rtl_net) { ++ RTW_PRINT("rtl_net init fail!\n"); ++ return -1; ++ } ++ return rtw_disable_gpio_interrupt(rtl_net, 7); ++} ++#endif ++ ++#else ++ ++int rtw_wifi_gpio_init(void) ++{ ++ return 0; ++} ++ ++void rtw_wifi_gpio_wlan_ctrl(int onoff) ++{ ++} ++#endif /* CONFIG_PLATFORM_SPRD */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.c 2018-02-11 21:44:27.174146497 +0200 +@@ -0,0 +1,7183 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _IOCTL_CFG80211_C_ ++ ++#include ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) ++#define STATION_INFO_SIGNAL BIT(NL80211_STA_INFO_SIGNAL) ++#define STATION_INFO_TX_BITRATE BIT(NL80211_STA_INFO_TX_BITRATE) ++#define STATION_INFO_RX_PACKETS BIT(NL80211_STA_INFO_RX_PACKETS) ++#define STATION_INFO_TX_PACKETS BIT(NL80211_STA_INFO_TX_PACKETS) ++#define STATION_INFO_ASSOC_REQ_IES 0 ++#endif /* Linux kernel >= 4.0.0 */ ++ ++#include ++ ++#define RTW_MAX_MGMT_TX_CNT (8) ++#define RTW_MAX_MGMT_TX_MS_GAS (500) ++ ++#define RTW_SCAN_IE_LEN_MAX 2304 ++#define RTW_MAX_REMAIN_ON_CHANNEL_DURATION 5000 /* ms */ ++#define RTW_MAX_NUM_PMKIDS 4 ++ ++#define RTW_CH_MAX_2G_CHANNEL 14 /* Max channel in 2G band */ ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ ++#ifndef WLAN_CIPHER_SUITE_SMS4 ++#define WLAN_CIPHER_SUITE_SMS4 0x00147201 ++#endif ++ ++#ifndef WLAN_AKM_SUITE_WAPI_PSK ++#define WLAN_AKM_SUITE_WAPI_PSK 0x000FAC04 ++#endif ++ ++#ifndef WLAN_AKM_SUITE_WAPI_CERT ++#define WLAN_AKM_SUITE_WAPI_CERT 0x000FAC12 ++#endif ++ ++#ifndef NL80211_WAPI_VERSION_1 ++#define NL80211_WAPI_VERSION_1 (1 << 2) ++#endif ++ ++#endif /* CONFIG_WAPI_SUPPORT */ ++ ++#ifdef CONFIG_RTW_80211R ++#define WLAN_AKM_SUITE_FT_8021X 0x000FAC03 ++#define WLAN_AKM_SUITE_FT_PSK 0x000FAC04 ++#endif ++ ++static const u32 rtw_cipher_suites[] = { ++ WLAN_CIPHER_SUITE_WEP40, ++ WLAN_CIPHER_SUITE_WEP104, ++ WLAN_CIPHER_SUITE_TKIP, ++ WLAN_CIPHER_SUITE_CCMP, ++#ifdef CONFIG_WAPI_SUPPORT ++ WLAN_CIPHER_SUITE_SMS4, ++#endif /* CONFIG_WAPI_SUPPORT */ ++#ifdef CONFIG_IEEE80211W ++ WLAN_CIPHER_SUITE_AES_CMAC, ++#endif /* CONFIG_IEEE80211W */ ++}; ++ ++#define RATETAB_ENT(_rate, _rateid, _flags) \ ++ { \ ++ .bitrate = (_rate), \ ++ .hw_value = (_rateid), \ ++ .flags = (_flags), \ ++ } ++ ++#define CHAN2G(_channel, _freq, _flags) { \ ++ .band = NL80211_BAND_2GHZ, \ ++ .center_freq = (_freq), \ ++ .hw_value = (_channel), \ ++ .flags = (_flags), \ ++ .max_antenna_gain = 0, \ ++ .max_power = 30, \ ++ } ++ ++#define CHAN5G(_channel, _flags) { \ ++ .band = NL80211_BAND_5GHZ, \ ++ .center_freq = 5000 + (5 * (_channel)), \ ++ .hw_value = (_channel), \ ++ .flags = (_flags), \ ++ .max_antenna_gain = 0, \ ++ .max_power = 30, \ ++ } ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) ++/* if wowlan is not supported, kernel generate a disconnect at each suspend ++ * cf: /net/wireless/sysfs.c, so register a stub wowlan. ++ * Moreover wowlan has to be enabled via a the nl80211_set_wowlan callback. ++ * (from user space, e.g. iw phy0 wowlan enable) ++ */ ++static const struct wiphy_wowlan_support wowlan_stub = { ++ .flags = WIPHY_WOWLAN_ANY, ++ .n_patterns = 0, ++ .pattern_max_len = 0, ++ .pattern_min_len = 0, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) ++ .max_pkt_offset = 0, ++#endif ++}; ++#endif ++ ++static struct ieee80211_rate rtw_rates[] = { ++ RATETAB_ENT(10, 0x1, 0), ++ RATETAB_ENT(20, 0x2, 0), ++ RATETAB_ENT(55, 0x4, 0), ++ RATETAB_ENT(110, 0x8, 0), ++ RATETAB_ENT(60, 0x10, 0), ++ RATETAB_ENT(90, 0x20, 0), ++ RATETAB_ENT(120, 0x40, 0), ++ RATETAB_ENT(180, 0x80, 0), ++ RATETAB_ENT(240, 0x100, 0), ++ RATETAB_ENT(360, 0x200, 0), ++ RATETAB_ENT(480, 0x400, 0), ++ RATETAB_ENT(540, 0x800, 0), ++}; ++ ++#define rtw_a_rates (rtw_rates + 4) ++#define RTW_A_RATES_NUM 8 ++#define rtw_g_rates (rtw_rates + 0) ++#define RTW_G_RATES_NUM 12 ++ ++#define RTW_2G_CHANNELS_NUM 14 ++#define RTW_5G_CHANNELS_NUM 37 ++ ++static struct ieee80211_channel rtw_2ghz_channels[] = { ++ CHAN2G(1, 2412, 0), ++ CHAN2G(2, 2417, 0), ++ CHAN2G(3, 2422, 0), ++ CHAN2G(4, 2427, 0), ++ CHAN2G(5, 2432, 0), ++ CHAN2G(6, 2437, 0), ++ CHAN2G(7, 2442, 0), ++ CHAN2G(8, 2447, 0), ++ CHAN2G(9, 2452, 0), ++ CHAN2G(10, 2457, 0), ++ CHAN2G(11, 2462, 0), ++ CHAN2G(12, 2467, 0), ++ CHAN2G(13, 2472, 0), ++ CHAN2G(14, 2484, 0), ++}; ++ ++static struct ieee80211_channel rtw_5ghz_a_channels[] = { ++ CHAN5G(34, 0), CHAN5G(36, 0), ++ CHAN5G(38, 0), CHAN5G(40, 0), ++ CHAN5G(42, 0), CHAN5G(44, 0), ++ CHAN5G(46, 0), CHAN5G(48, 0), ++ CHAN5G(52, 0), CHAN5G(56, 0), ++ CHAN5G(60, 0), CHAN5G(64, 0), ++ CHAN5G(100, 0), CHAN5G(104, 0), ++ CHAN5G(108, 0), CHAN5G(112, 0), ++ CHAN5G(116, 0), CHAN5G(120, 0), ++ CHAN5G(124, 0), CHAN5G(128, 0), ++ CHAN5G(132, 0), CHAN5G(136, 0), ++ CHAN5G(140, 0), CHAN5G(149, 0), ++ CHAN5G(153, 0), CHAN5G(157, 0), ++ CHAN5G(161, 0), CHAN5G(165, 0), ++ CHAN5G(184, 0), CHAN5G(188, 0), ++ CHAN5G(192, 0), CHAN5G(196, 0), ++ CHAN5G(200, 0), CHAN5G(204, 0), ++ CHAN5G(208, 0), CHAN5G(212, 0), ++ CHAN5G(216, 0), ++}; ++ ++ ++void rtw_2g_channels_init(struct ieee80211_channel *channels) ++{ ++ _rtw_memcpy((void *)channels, (void *)rtw_2ghz_channels, ++ sizeof(struct ieee80211_channel) * RTW_2G_CHANNELS_NUM ++ ); ++} ++ ++void rtw_5g_channels_init(struct ieee80211_channel *channels) ++{ ++ _rtw_memcpy((void *)channels, (void *)rtw_5ghz_a_channels, ++ sizeof(struct ieee80211_channel) * RTW_5G_CHANNELS_NUM ++ ); ++} ++ ++void rtw_2g_rates_init(struct ieee80211_rate *rates) ++{ ++ _rtw_memcpy(rates, rtw_g_rates, ++ sizeof(struct ieee80211_rate) * RTW_G_RATES_NUM ++ ); ++} ++ ++void rtw_5g_rates_init(struct ieee80211_rate *rates) ++{ ++ _rtw_memcpy(rates, rtw_a_rates, ++ sizeof(struct ieee80211_rate) * RTW_A_RATES_NUM ++ ); ++} ++ ++struct ieee80211_supported_band *rtw_spt_band_alloc( ++ enum nl80211_band band ++) ++{ ++ struct ieee80211_supported_band *spt_band = NULL; ++ int n_channels, n_bitrates; ++ ++ if (band == NL80211_BAND_2GHZ) { ++ n_channels = RTW_2G_CHANNELS_NUM; ++ n_bitrates = RTW_G_RATES_NUM; ++ } else if (band == NL80211_BAND_5GHZ) { ++ n_channels = RTW_5G_CHANNELS_NUM; ++ n_bitrates = RTW_A_RATES_NUM; ++ } else ++ goto exit; ++ ++ spt_band = (struct ieee80211_supported_band *)rtw_zmalloc( ++ sizeof(struct ieee80211_supported_band) ++ + sizeof(struct ieee80211_channel) * n_channels ++ + sizeof(struct ieee80211_rate) * n_bitrates ++ ); ++ if (!spt_band) ++ goto exit; ++ ++ spt_band->channels = (struct ieee80211_channel *)(((u8 *)spt_band) + sizeof(struct ieee80211_supported_band)); ++ spt_band->bitrates = (struct ieee80211_rate *)(((u8 *)spt_band->channels) + sizeof(struct ieee80211_channel) * n_channels); ++ spt_band->band = band; ++ spt_band->n_channels = n_channels; ++ spt_band->n_bitrates = n_bitrates; ++ ++ if (band == NL80211_BAND_2GHZ) { ++ rtw_2g_channels_init(spt_band->channels); ++ rtw_2g_rates_init(spt_band->bitrates); ++ } else if (band == NL80211_BAND_5GHZ) { ++ rtw_5g_channels_init(spt_band->channels); ++ rtw_5g_rates_init(spt_band->bitrates); ++ } ++ ++ /* spt_band.ht_cap */ ++ ++exit: ++ ++ return spt_band; ++} ++ ++void rtw_spt_band_free(struct ieee80211_supported_band *spt_band) ++{ ++ u32 size = 0; ++ ++ if (!spt_band) ++ return; ++ ++#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) ++ if (spt_band->band == NL80211_BAND_2GHZ) { ++#else ++ if (spt_band->band == IEEE80211_BAND_2GHZ) { ++#endif ++ size = sizeof(struct ieee80211_supported_band) ++ + sizeof(struct ieee80211_channel) * RTW_2G_CHANNELS_NUM ++ + sizeof(struct ieee80211_rate) * RTW_G_RATES_NUM; ++#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) ++ } else if (spt_band->band == NL80211_BAND_5GHZ) { ++#else ++ } else if (spt_band->band == IEEE80211_BAND_5GHZ) { ++#endif ++ size = sizeof(struct ieee80211_supported_band) ++ + sizeof(struct ieee80211_channel) * RTW_5G_CHANNELS_NUM ++ + sizeof(struct ieee80211_rate) * RTW_A_RATES_NUM; ++ } else { ++ ++ } ++ rtw_mfree((u8 *)spt_band, size); ++} ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++static const struct ieee80211_txrx_stypes ++ rtw_cfg80211_default_mgmt_stypes[NUM_NL80211_IFTYPES] = { ++ [NL80211_IFTYPE_ADHOC] = { ++ .tx = 0xffff, ++ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) ++ }, ++ [NL80211_IFTYPE_STATION] = { ++ .tx = 0xffff, ++ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | ++ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) ++ }, ++ [NL80211_IFTYPE_AP] = { ++ .tx = 0xffff, ++ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | ++ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | ++ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | ++ BIT(IEEE80211_STYPE_DISASSOC >> 4) | ++ BIT(IEEE80211_STYPE_AUTH >> 4) | ++ BIT(IEEE80211_STYPE_DEAUTH >> 4) | ++ BIT(IEEE80211_STYPE_ACTION >> 4) ++ }, ++ [NL80211_IFTYPE_AP_VLAN] = { ++ /* copy AP */ ++ .tx = 0xffff, ++ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | ++ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | ++ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | ++ BIT(IEEE80211_STYPE_DISASSOC >> 4) | ++ BIT(IEEE80211_STYPE_AUTH >> 4) | ++ BIT(IEEE80211_STYPE_DEAUTH >> 4) | ++ BIT(IEEE80211_STYPE_ACTION >> 4) ++ }, ++ [NL80211_IFTYPE_P2P_CLIENT] = { ++ .tx = 0xffff, ++ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | ++ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) ++ }, ++ [NL80211_IFTYPE_P2P_GO] = { ++ .tx = 0xffff, ++ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | ++ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | ++ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | ++ BIT(IEEE80211_STYPE_DISASSOC >> 4) | ++ BIT(IEEE80211_STYPE_AUTH >> 4) | ++ BIT(IEEE80211_STYPE_DEAUTH >> 4) | ++ BIT(IEEE80211_STYPE_ACTION >> 4) ++ }, ++#if defined(RTW_DEDICATED_P2P_DEVICE) ++ [NL80211_IFTYPE_P2P_DEVICE] = { ++ .tx = 0xffff, ++ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | ++ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) ++ }, ++#endif ++}; ++#endif ++ ++static u64 rtw_get_systime_us(void) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39)) ++ struct timespec ts; ++ get_monotonic_boottime(&ts); ++ return ((u64)ts.tv_sec * 1000000) + ts.tv_nsec / 1000; ++#else ++ struct timeval tv; ++ do_gettimeofday(&tv); ++ return ((u64)tv.tv_sec * 1000000) + tv.tv_usec; ++#endif ++} ++ ++/* Try to remove non target BSS's SR to reduce PBC overlap rate */ ++static int rtw_cfg80211_clear_wps_sr_of_non_target_bss(_adapter *padapter, struct wlan_network *pnetwork, struct cfg80211_ssid *req_ssid) ++{ ++ struct rtw_wdev_priv *wdev_data = adapter_wdev_data(padapter); ++ int ret = 0; ++ u8 *psr = NULL, sr = 0; ++ NDIS_802_11_SSID *pssid = &pnetwork->network.Ssid; ++ u32 wpsielen = 0; ++ u8 *wpsie = NULL; ++ ++ if (pssid->SsidLength == req_ssid->ssid_len ++ && _rtw_memcmp(pssid->Ssid, req_ssid->ssid, req_ssid->ssid_len) == _TRUE) ++ goto exit; ++ ++ wpsie = rtw_get_wps_ie(pnetwork->network.IEs + _FIXED_IE_LENGTH_ ++ , pnetwork->network.IELength - _FIXED_IE_LENGTH_, NULL, &wpsielen); ++ if (wpsie && wpsielen > 0) ++ psr = rtw_get_wps_attr_content(wpsie, wpsielen, WPS_ATTR_SELECTED_REGISTRAR, &sr, NULL); ++ ++ if (psr && sr) { ++ if (0) ++ RTW_INFO("clear sr of non target bss:%s("MAC_FMT")\n" ++ , pssid->Ssid, MAC_ARG(pnetwork->network.MacAddress)); ++ *psr = 0; /* clear sr */ ++ ret = 1; ++ } ++ ++exit: ++ return ret; ++} ++ ++#define MAX_BSSINFO_LEN 1000 ++struct cfg80211_bss *rtw_cfg80211_inform_bss(_adapter *padapter, struct wlan_network *pnetwork) ++{ ++ struct ieee80211_channel *notify_channel; ++ struct cfg80211_bss *bss = NULL; ++ /* struct ieee80211_supported_band *band; */ ++ u16 channel; ++ u32 freq; ++ u64 notify_timestamp; ++ u16 notify_capability; ++ u16 notify_interval; ++ u8 *notify_ie; ++ size_t notify_ielen; ++ s32 notify_signal; ++ /* u8 buf[MAX_BSSINFO_LEN]; */ ++ ++ u8 *pbuf; ++ size_t buf_size = MAX_BSSINFO_LEN; ++ size_t len, bssinf_len = 0; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ struct wireless_dev *wdev = padapter->rtw_wdev; ++ struct wiphy *wiphy = wdev->wiphy; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ pbuf = rtw_zmalloc(buf_size); ++ if (pbuf == NULL) { ++ RTW_INFO("%s pbuf allocate failed !!\n", __FUNCTION__); ++ return bss; ++ } ++ ++ /* RTW_INFO("%s\n", __func__); */ ++ ++ bssinf_len = pnetwork->network.IELength + sizeof(struct rtw_ieee80211_hdr_3addr); ++ if (bssinf_len > buf_size) { ++ RTW_INFO("%s IE Length too long > %zu byte\n", __FUNCTION__, buf_size); ++ goto exit; ++ } ++ ++#ifndef CONFIG_WAPI_SUPPORT ++ { ++ u16 wapi_len = 0; ++ ++ if (rtw_get_wapi_ie(pnetwork->network.IEs, pnetwork->network.IELength, NULL, &wapi_len) > 0) { ++ if (wapi_len > 0) { ++ RTW_INFO("%s, no support wapi!\n", __FUNCTION__); ++ goto exit; ++ } ++ } ++ } ++#endif /* !CONFIG_WAPI_SUPPORT */ ++ ++ channel = pnetwork->network.Configuration.DSConfig; ++ freq = rtw_ch2freq(channel); ++ notify_channel = ieee80211_get_channel(wiphy, freq); ++ ++ if (0) ++ notify_timestamp = le64_to_cpu(*(u64 *)rtw_get_timestampe_from_ie(pnetwork->network.IEs)); ++ else ++ notify_timestamp = rtw_get_systime_us(); ++ ++ notify_interval = le16_to_cpu(*(u16 *)rtw_get_beacon_interval_from_ie(pnetwork->network.IEs)); ++ notify_capability = le16_to_cpu(*(u16 *)rtw_get_capability_from_ie(pnetwork->network.IEs)); ++ ++ notify_ie = pnetwork->network.IEs + _FIXED_IE_LENGTH_; ++ notify_ielen = pnetwork->network.IELength - _FIXED_IE_LENGTH_; ++ ++ /* We've set wiphy's signal_type as CFG80211_SIGNAL_TYPE_MBM: signal strength in mBm (100*dBm) */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && ++ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { ++ notify_signal = 100 * translate_percentage_to_dbm(padapter->recvpriv.signal_strength); /* dbm */ ++ } else { ++ notify_signal = 100 * translate_percentage_to_dbm(pnetwork->network.PhyInfo.SignalStrength); /* dbm */ ++ } ++ ++#if 0 ++ RTW_INFO("bssid: "MAC_FMT"\n", MAC_ARG(pnetwork->network.MacAddress)); ++ RTW_INFO("Channel: %d(%d)\n", channel, freq); ++ RTW_INFO("Capability: %X\n", notify_capability); ++ RTW_INFO("Beacon interval: %d\n", notify_interval); ++ RTW_INFO("Signal: %d\n", notify_signal); ++ RTW_INFO("notify_timestamp: %llu\n", notify_timestamp); ++#endif ++ ++ /* pbuf = buf; */ ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pbuf; ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); ++ /* pmlmeext->mgnt_seq++; */ ++ ++ if (pnetwork->network.Reserved[0] == 1) { /* WIFI_BEACON */ ++ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); ++ SetFrameSubType(pbuf, WIFI_BEACON); ++ } else { ++ _rtw_memcpy(pwlanhdr->addr1, adapter_mac_addr(padapter), ETH_ALEN); ++ SetFrameSubType(pbuf, WIFI_PROBERSP); ++ } ++ ++ _rtw_memcpy(pwlanhdr->addr2, pnetwork->network.MacAddress, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pnetwork->network.MacAddress, ETH_ALEN); ++ ++ ++ /* pbuf += sizeof(struct rtw_ieee80211_hdr_3addr); */ ++ len = sizeof(struct rtw_ieee80211_hdr_3addr); ++ _rtw_memcpy((pbuf + len), pnetwork->network.IEs, pnetwork->network.IELength); ++ *((u64 *)(pbuf + len)) = cpu_to_le64(notify_timestamp); ++ ++ len += pnetwork->network.IELength; ++ ++ #if defined(CONFIG_P2P) && 0 ++ if(rtw_get_p2p_ie(pnetwork->network.IEs+12, pnetwork->network.IELength-12, NULL, NULL)) ++ RTW_INFO("%s, got p2p_ie\n", __func__); ++ #endif ++ ++#if 1 ++ bss = cfg80211_inform_bss_frame(wiphy, notify_channel, (struct ieee80211_mgmt *)pbuf, ++ len, notify_signal, GFP_ATOMIC); ++#else ++ ++ bss = cfg80211_inform_bss(wiphy, notify_channel, (const u8 *)pnetwork->network.MacAddress, ++ notify_timestamp, notify_capability, notify_interval, notify_ie, ++ notify_ielen, notify_signal, GFP_ATOMIC/*GFP_KERNEL*/); ++#endif ++ ++ if (unlikely(!bss)) { ++ RTW_INFO(FUNC_ADPT_FMT" bss NULL\n", FUNC_ADPT_ARG(padapter)); ++ goto exit; ++ } ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 38)) ++#ifndef COMPAT_KERNEL_RELEASE ++ /* patch for cfg80211, update beacon ies to information_elements */ ++ if (pnetwork->network.Reserved[0] == 1) { /* WIFI_BEACON */ ++ ++ if (bss->len_information_elements != bss->len_beacon_ies) { ++ bss->information_elements = bss->beacon_ies; ++ bss->len_information_elements = bss->len_beacon_ies; ++ } ++ } ++#endif /* COMPAT_KERNEL_RELEASE */ ++#endif /* LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 38) */ ++ ++#if 0 ++ { ++ if (bss->information_elements == bss->proberesp_ies) { ++ if (bss->len_information_elements != bss->len_proberesp_ies) ++ RTW_INFO("error!, len_information_elements != bss->len_proberesp_ies\n"); ++ } else if (bss->len_information_elements < bss->len_beacon_ies) { ++ bss->information_elements = bss->beacon_ies; ++ bss->len_information_elements = bss->len_beacon_ies; ++ } ++ } ++#endif ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0) ++ cfg80211_put_bss(wiphy, bss); ++#else ++ cfg80211_put_bss(bss); ++#endif ++ ++exit: ++ if (pbuf) ++ rtw_mfree(pbuf, buf_size); ++ return bss; ++ ++} ++ ++/* ++ Check the given bss is valid by kernel API cfg80211_get_bss() ++ @padapter : the given adapter ++ ++ return _TRUE if bss is valid, _FALSE for not found. ++*/ ++int rtw_cfg80211_check_bss(_adapter *padapter) ++{ ++ WLAN_BSSID_EX *pnetwork = &(padapter->mlmeextpriv.mlmext_info.network); ++ struct cfg80211_bss *bss = NULL; ++ struct ieee80211_channel *notify_channel = NULL; ++ u32 freq; ++ ++ if (!(pnetwork) || !(padapter->rtw_wdev)) ++ return _FALSE; ++ ++ freq = rtw_ch2freq(pnetwork->Configuration.DSConfig); ++ notify_channel = ieee80211_get_channel(padapter->rtw_wdev->wiphy, freq); ++ bss = cfg80211_get_bss(padapter->rtw_wdev->wiphy, notify_channel, ++ pnetwork->MacAddress, pnetwork->Ssid.Ssid, ++ pnetwork->Ssid.SsidLength, ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0) ++ pnetwork->InfrastructureMode == Ndis802_11Infrastructure?IEEE80211_BSS_TYPE_ESS:IEEE80211_BSS_TYPE_IBSS, ++ IEEE80211_PRIVACY(pnetwork->Privacy)); ++#else ++ pnetwork->InfrastructureMode == Ndis802_11Infrastructure?WLAN_CAPABILITY_ESS:WLAN_CAPABILITY_IBSS, pnetwork->InfrastructureMode == Ndis802_11Infrastructure?WLAN_CAPABILITY_ESS:WLAN_CAPABILITY_IBSS); ++#endif ++ ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0) ++ cfg80211_put_bss(padapter->rtw_wdev->wiphy, bss); ++#else ++ cfg80211_put_bss(bss); ++#endif ++ ++ return bss != NULL; ++} ++ ++void rtw_cfg80211_ibss_indicate_connect(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ struct wireless_dev *pwdev = padapter->rtw_wdev; ++ struct cfg80211_bss *bss = NULL; ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) ++ struct wiphy *wiphy = pwdev->wiphy; ++ int freq = 2412; ++ struct ieee80211_channel *notify_channel; ++#endif ++ ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) ++ freq = rtw_ch2freq(cur_network->network.Configuration.DSConfig); ++ ++ if (0) ++ RTW_INFO("chan: %d, freq: %d\n", cur_network->network.Configuration.DSConfig, freq); ++#endif ++ ++ if (pwdev->iftype != NL80211_IFTYPE_ADHOC) ++ return; ++ ++ if (!rtw_cfg80211_check_bss(padapter)) { ++ WLAN_BSSID_EX *pnetwork = &(padapter->mlmeextpriv.mlmext_info.network); ++ struct wlan_network *scanned = pmlmepriv->cur_network_scanned; ++ ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) { ++ ++ _rtw_memcpy(&cur_network->network, pnetwork, sizeof(WLAN_BSSID_EX)); ++ if (cur_network) { ++ if (!rtw_cfg80211_inform_bss(padapter, cur_network)) ++ RTW_INFO(FUNC_ADPT_FMT" inform fail !!\n", FUNC_ADPT_ARG(padapter)); ++ else ++ RTW_INFO(FUNC_ADPT_FMT" inform success !!\n", FUNC_ADPT_ARG(padapter)); ++ } else { ++ RTW_INFO("cur_network is not exist!!!\n"); ++ return ; ++ } ++ } else { ++ if (scanned == NULL) ++ rtw_warn_on(1); ++ ++ if (_rtw_memcmp(&(scanned->network.Ssid), &(pnetwork->Ssid), sizeof(NDIS_802_11_SSID)) == _TRUE ++ && _rtw_memcmp(scanned->network.MacAddress, pnetwork->MacAddress, sizeof(NDIS_802_11_MAC_ADDRESS)) == _TRUE ++ ) { ++ if (!rtw_cfg80211_inform_bss(padapter, scanned)) ++ RTW_INFO(FUNC_ADPT_FMT" inform fail !!\n", FUNC_ADPT_ARG(padapter)); ++ else { ++ /* RTW_INFO(FUNC_ADPT_FMT" inform success !!\n", FUNC_ADPT_ARG(padapter)); */ ++ } ++ } else { ++ RTW_INFO("scanned & pnetwork compare fail\n"); ++ rtw_warn_on(1); ++ } ++ } ++ ++ if (!rtw_cfg80211_check_bss(padapter)) ++ RTW_PRINT(FUNC_ADPT_FMT" BSS not found !!\n", FUNC_ADPT_ARG(padapter)); ++ } ++ /* notify cfg80211 that device joined an IBSS */ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) ++ notify_channel = ieee80211_get_channel(wiphy, freq); ++ cfg80211_ibss_joined(padapter->pnetdev, cur_network->network.MacAddress, notify_channel, GFP_ATOMIC); ++#else ++ cfg80211_ibss_joined(padapter->pnetdev, cur_network->network.MacAddress, GFP_ATOMIC); ++#endif ++} ++ ++void rtw_cfg80211_indicate_connect(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ struct wireless_dev *pwdev = padapter->rtw_wdev; ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); ++ _irqL irqL; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif ++ struct cfg80211_bss *bss = NULL; ++ ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ if (pwdev->iftype != NL80211_IFTYPE_STATION ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++ && pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT ++ #endif ++ ) ++ return; ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ return; ++ ++#ifdef CONFIG_P2P ++ if (pwdinfo->driver_interface == DRIVER_CFG80211) { ++ #if !RTW_P2P_GROUP_INTERFACE ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ RTW_INFO("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), rtw_p2p_pre_state(pwdinfo)); ++ } ++ #endif ++ } ++#endif /* CONFIG_P2P */ ++ ++ if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) != _TRUE) { ++ WLAN_BSSID_EX *pnetwork = &(padapter->mlmeextpriv.mlmext_info.network); ++ struct wlan_network *scanned = pmlmepriv->cur_network_scanned; ++ ++ /* RTW_INFO(FUNC_ADPT_FMT" BSS not found\n", FUNC_ADPT_ARG(padapter)); */ ++ ++ if (scanned == NULL) { ++ rtw_warn_on(1); ++ goto check_bss; ++ } ++ ++ if (_rtw_memcmp(scanned->network.MacAddress, pnetwork->MacAddress, sizeof(NDIS_802_11_MAC_ADDRESS)) == _TRUE ++ && _rtw_memcmp(&(scanned->network.Ssid), &(pnetwork->Ssid), sizeof(NDIS_802_11_SSID)) == _TRUE ++ ) { ++ if (!rtw_cfg80211_inform_bss(padapter, scanned)) ++ RTW_INFO(FUNC_ADPT_FMT" inform fail !!\n", FUNC_ADPT_ARG(padapter)); ++ else { ++ /* RTW_INFO(FUNC_ADPT_FMT" inform success !!\n", FUNC_ADPT_ARG(padapter)); */ ++ } ++ } else { ++ RTW_INFO("scanned: %s("MAC_FMT"), cur: %s("MAC_FMT")\n", ++ scanned->network.Ssid.Ssid, MAC_ARG(scanned->network.MacAddress), ++ pnetwork->Ssid.Ssid, MAC_ARG(pnetwork->MacAddress) ++ ); ++ rtw_warn_on(1); ++ } ++ } ++ ++check_bss: ++ if (!rtw_cfg80211_check_bss(padapter)) ++ RTW_PRINT(FUNC_ADPT_FMT" BSS not found !!\n", FUNC_ADPT_ARG(padapter)); ++ ++ _enter_critical_bh(&pwdev_priv->connect_req_lock, &irqL); ++ ++ if (rtw_to_roam(padapter) > 0) { ++ #if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 39) || defined(COMPAT_KERNEL_RELEASE) ++ struct wiphy *wiphy = pwdev->wiphy; ++ struct ieee80211_channel *notify_channel; ++ struct cfg80211_roam_info roam_info = {}; ++ u32 freq; ++ u16 channel = cur_network->network.Configuration.DSConfig; ++ ++ freq = rtw_ch2freq(channel); ++ notify_channel = ieee80211_get_channel(wiphy, freq); ++ #endif ++ ++ RTW_INFO(FUNC_ADPT_FMT" call cfg80211_roamed\n", FUNC_ADPT_ARG(padapter)); ++ roam_info.channel = notify_channel; ++ roam_info.bssid = cur_network->network.MacAddress; ++ roam_info.req_ie = pmlmepriv->assoc_req + sizeof(struct rtw_ieee80211_hdr_3addr) + 2; ++ roam_info.req_ie_len = pmlmepriv->assoc_req_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 2; ++ roam_info.resp_ie = pmlmepriv->assoc_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6; ++ roam_info.resp_ie_len = pmlmepriv->assoc_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6; ++ ++ cfg80211_roamed(padapter->pnetdev, &roam_info, GFP_ATOMIC); ++#ifdef CONFIG_RTW_80211R ++ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) ++ rtw_set_ft_status(padapter, RTW_FT_ASSOCIATED_STA); ++#endif ++ } else { ++ #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) || defined(COMPAT_KERNEL_RELEASE) ++ RTW_INFO("pwdev->sme_state(b)=%d\n", pwdev->sme_state); ++ #endif ++ rtw_cfg80211_connect_result(pwdev, cur_network->network.MacAddress ++ , pmlmepriv->assoc_req + sizeof(struct rtw_ieee80211_hdr_3addr) + 2 ++ , pmlmepriv->assoc_req_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 2 ++ , pmlmepriv->assoc_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6 ++ , pmlmepriv->assoc_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6 ++ , WLAN_STATUS_SUCCESS, GFP_ATOMIC); ++ #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) || defined(COMPAT_KERNEL_RELEASE) ++ RTW_INFO("pwdev->sme_state(a)=%d\n", pwdev->sme_state); ++ #endif ++ } ++ ++ rtw_wdev_free_connect_req(pwdev_priv); ++ ++ _exit_critical_bh(&pwdev_priv->connect_req_lock, &irqL); ++} ++ ++void rtw_cfg80211_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally_generated) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wireless_dev *pwdev = padapter->rtw_wdev; ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); ++ _irqL irqL; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif ++ ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ ++ /*always replace privated definitions with wifi reserved value 0*/ ++ if ((reason == WLAN_REASON_ACTIVE_ROAM) || (reason == WLAN_REASON_JOIN_WRONG_CHANNEL) || (reason == WLAN_REASON_EXPIRATION_CHK)) ++ reason = 0; ++ ++ if (pwdev->iftype != NL80211_IFTYPE_STATION ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++ && pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT ++ #endif ++ ) ++ return; ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ return; ++ ++#ifdef CONFIG_P2P ++ if (pwdinfo->driver_interface == DRIVER_CFG80211) { ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); ++ ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++ if (pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT) ++ #endif ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ ++ RTW_INFO("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), rtw_p2p_pre_state(pwdinfo)); ++ } ++ } ++#endif /* CONFIG_P2P */ ++ ++ _enter_critical_bh(&pwdev_priv->connect_req_lock, &irqL); ++ ++ if (padapter->ndev_unregistering || !rtw_wdev_not_indic_disco(pwdev_priv)) { ++ #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) || defined(COMPAT_KERNEL_RELEASE) ++ RTW_INFO("pwdev->sme_state(b)=%d\n", pwdev->sme_state); ++ ++ if (pwdev->sme_state == CFG80211_SME_CONNECTING) ++ rtw_cfg80211_connect_result(pwdev, NULL, NULL, 0, NULL, 0, ++ WLAN_STATUS_UNSPECIFIED_FAILURE, GFP_ATOMIC); ++ else if (pwdev->sme_state == CFG80211_SME_CONNECTED) ++ rtw_cfg80211_disconnected(pwdev, reason, NULL, 0, locally_generated, GFP_ATOMIC); ++ ++ RTW_INFO("pwdev->sme_state(a)=%d\n", pwdev->sme_state); ++ #else ++ if (pwdev_priv->connect_req) { ++ RTW_INFO(FUNC_ADPT_FMT" call cfg80211_connect_result\n", FUNC_ADPT_ARG(padapter)); ++ rtw_cfg80211_connect_result(pwdev, NULL, NULL, 0, NULL, 0, ++ WLAN_STATUS_UNSPECIFIED_FAILURE, GFP_ATOMIC); ++ } else { ++ RTW_INFO(FUNC_ADPT_FMT" call cfg80211_disconnected\n", FUNC_ADPT_ARG(padapter)); ++ rtw_cfg80211_disconnected(pwdev, reason, NULL, 0, locally_generated, GFP_ATOMIC); ++ } ++ #endif ++ } ++ ++ rtw_wdev_free_connect_req(pwdev_priv); ++ ++ _exit_critical_bh(&pwdev_priv->connect_req_lock, &irqL); ++} ++ ++ ++#ifdef CONFIG_AP_MODE ++static int rtw_cfg80211_ap_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) ++{ ++ int ret = 0; ++ u32 wep_key_idx, wep_key_len, wep_total_len; ++ struct sta_info *psta = NULL, *pbcmc_sta = NULL; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &(padapter->securitypriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ param->u.crypt.err = 0; ++ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; ++ ++ /* sizeof(struct ieee_param) = 64 bytes; */ ++ /* if (param_len != (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) */ ++ if (param_len != sizeof(struct ieee_param) + param->u.crypt.key_len) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && ++ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) { ++ if (param->u.crypt.idx >= WEP_KEYS ++#ifdef CONFIG_IEEE80211W ++ && param->u.crypt.idx > BIP_MAX_KEYID ++#endif /* CONFIG_IEEE80211W */ ++ ) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ } else { ++ psta = rtw_get_stainfo(pstapriv, param->sta_addr); ++ if (!psta) { ++ /* ret = -EINVAL; */ ++ RTW_INFO("rtw_set_encryption(), sta has already been removed or never been added\n"); ++ goto exit; ++ } ++ } ++ ++ if (strcmp(param->u.crypt.alg, "none") == 0 && (psta == NULL)) { ++ /* todo:clear default encryption keys */ ++ ++ RTW_INFO("clear default encryption keys, keyid=%d\n", param->u.crypt.idx); ++ ++ goto exit; ++ } ++ ++ ++ if (strcmp(param->u.crypt.alg, "WEP") == 0 && (psta == NULL)) { ++ RTW_INFO("r871x_set_encryption, crypt.alg = WEP\n"); ++ ++ wep_key_idx = param->u.crypt.idx; ++ wep_key_len = param->u.crypt.key_len; ++ ++ RTW_INFO("r871x_set_encryption, wep_key_idx=%d, len=%d\n", wep_key_idx, wep_key_len); ++ ++ if ((wep_key_idx >= WEP_KEYS) || (wep_key_len <= 0)) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (wep_key_len > 0) ++ wep_key_len = wep_key_len <= 5 ? 5 : 13; ++ ++ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) { ++ /* wep default key has not been set, so use this key index as default key. */ ++ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; ++ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; ++ ++ if (wep_key_len == 13) { ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; ++ } ++ ++ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; ++ } ++ ++ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); ++ ++ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; ++ ++ rtw_ap_set_wep_key(padapter, param->u.crypt.key, wep_key_len, wep_key_idx, 1); ++ ++ goto exit; ++ ++ } ++ ++ ++ if (!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) { /* group key */ ++ if (param->u.crypt.set_tx == 0) { /* group key */ ++ if (strcmp(param->u.crypt.alg, "WEP") == 0) { ++ RTW_INFO("%s, set group_key, WEP\n", __FUNCTION__); ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; ++ if (param->u.crypt.key_len == 13) ++ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; ++ ++ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { ++ RTW_INFO("%s, set group_key, TKIP\n", __FUNCTION__); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ ++ /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ ++ /* set mic key */ ++ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); ++ ++ psecuritypriv->busetkipkey = _TRUE; ++ ++ } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { ++ RTW_INFO("%s, set group_key, CCMP\n", __FUNCTION__); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _AES_; ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ } ++#ifdef CONFIG_IEEE80211W ++ else if (strcmp(param->u.crypt.alg, "BIP") == 0) { ++ int no; ++ ++ RTW_INFO("BIP key_len=%d , index=%d\n", param->u.crypt.key_len, param->u.crypt.idx); ++ /* save the IGTK key, length 16 bytes */ ++ _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ /* RTW_INFO("IGTK key below:\n"); ++ for(no=0;no<16;no++) ++ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); ++ RTW_INFO("\n"); */ ++ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; ++ padapter->securitypriv.binstallBIPkey = _TRUE; ++ RTW_INFO(" ~~~~set sta key:IGKT\n"); ++ goto exit; ++ } ++#endif /* CONFIG_IEEE80211W */ ++ else { ++ RTW_INFO("%s, set group_key, none\n", __FUNCTION__); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; ++ } ++ ++ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; ++ ++ psecuritypriv->binstallGrpkey = _TRUE; ++ ++ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ ++ ++ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); ++ ++ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); ++ if (pbcmc_sta) { ++ pbcmc_sta->ieee8021x_blocked = _FALSE; ++ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ ++ } ++ ++ } ++ ++ goto exit; ++ ++ } ++ ++ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) { /* psk/802_1x */ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ if (param->u.crypt.set_tx == 1) { /* pairwise key */ ++ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ ++ if (strcmp(param->u.crypt.alg, "WEP") == 0) { ++ RTW_INFO("%s, set pairwise key, WEP\n", __FUNCTION__); ++ ++ psta->dot118021XPrivacy = _WEP40_; ++ if (param->u.crypt.key_len == 13) ++ psta->dot118021XPrivacy = _WEP104_; ++ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { ++ RTW_INFO("%s, set pairwise key, TKIP\n", __FUNCTION__); ++ ++ psta->dot118021XPrivacy = _TKIP_; ++ ++ /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ ++ /* set mic key */ ++ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); ++ ++ psecuritypriv->busetkipkey = _TRUE; ++ ++ } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { ++ ++ RTW_INFO("%s, set pairwise key, CCMP\n", __FUNCTION__); ++ ++ psta->dot118021XPrivacy = _AES_; ++ } else { ++ RTW_INFO("%s, set pairwise key, none\n", __FUNCTION__); ++ ++ psta->dot118021XPrivacy = _NO_PRIVACY_; ++ } ++ ++ rtw_ap_set_pairwise_key(padapter, psta); ++ ++ psta->ieee8021x_blocked = _FALSE; ++ ++ psta->bpairwise_key_installed = _TRUE; ++ ++ } else { /* group key??? */ ++ if (strcmp(param->u.crypt.alg, "WEP") == 0) { ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; ++ if (param->u.crypt.key_len == 13) ++ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; ++ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { ++ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ ++ /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ ++ /* set mic key */ ++ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); ++ ++ psecuritypriv->busetkipkey = _TRUE; ++ ++ } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { ++ psecuritypriv->dot118021XGrpPrivacy = _AES_; ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ } else ++ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; ++ ++ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; ++ ++ psecuritypriv->binstallGrpkey = _TRUE; ++ ++ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ ++ ++ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); ++ ++ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); ++ if (pbcmc_sta) { ++ pbcmc_sta->ieee8021x_blocked = _FALSE; ++ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ ++ } ++ ++ } ++ ++ } ++ ++ } ++ ++exit: ++ ++ return ret; ++ ++} ++#endif ++ ++static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) ++{ ++ int ret = 0; ++ u32 wep_key_idx, wep_key_len, wep_total_len; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++#endif /* CONFIG_P2P */ ++ ++ ++ RTW_INFO("%s\n", __func__); ++ ++ param->u.crypt.err = 0; ++ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; ++ ++ if (param_len < (u32)((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && ++ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) { ++ if (param->u.crypt.idx >= WEP_KEYS ++#ifdef CONFIG_IEEE80211W ++ && param->u.crypt.idx > BIP_MAX_KEYID ++#endif /* CONFIG_IEEE80211W */ ++ ) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ } else { ++#ifdef CONFIG_WAPI_SUPPORT ++ if (strcmp(param->u.crypt.alg, "SMS4")) ++#endif ++ { ++ ret = -EINVAL; ++ goto exit; ++ } ++ } ++ ++ if (strcmp(param->u.crypt.alg, "WEP") == 0) { ++ RTW_INFO("wpa_set_encryption, crypt.alg = WEP\n"); ++ ++ wep_key_idx = param->u.crypt.idx; ++ wep_key_len = param->u.crypt.key_len; ++ ++ if ((wep_key_idx > WEP_KEYS) || (wep_key_len <= 0)) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) { ++ /* wep default key has not been set, so use this key index as default key. */ ++ ++ wep_key_len = wep_key_len <= 5 ? 5 : 13; ++ ++ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; ++ ++ if (wep_key_len == 13) { ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; ++ } ++ ++ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; ++ } ++ ++ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); ++ ++ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; ++ ++ rtw_set_key(padapter, psecuritypriv, wep_key_idx, 0, _TRUE); ++ ++ goto exit; ++ } ++ ++ if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { /* 802_1x */ ++ struct sta_info *psta, *pbcmc_sta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ /* RTW_INFO("%s, : dot11AuthAlgrthm == dot11AuthAlgrthm_8021X\n", __func__); */ ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == _TRUE) { /* sta mode */ ++#ifdef CONFIG_RTW_80211R ++ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) ++ psta = rtw_get_stainfo(pstapriv, pmlmepriv->assoc_bssid); ++ else ++#endif ++ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); ++ if (psta == NULL) { ++ /* DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail\n")); */ ++ RTW_INFO("%s, : Obtain Sta_info fail\n", __func__); ++ } else { ++ /* Jeff: don't disable ieee8021x_blocked while clearing key */ ++ if (strcmp(param->u.crypt.alg, "none") != 0) ++ psta->ieee8021x_blocked = _FALSE; ++ ++ ++ if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled) || ++ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) ++ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; ++ ++ if (param->u.crypt.set_tx == 1) { /* pairwise key */ ++ ++ RTW_INFO("%s, : param->u.crypt.set_tx ==1\n", __func__); ++ ++ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ ++ if (strcmp(param->u.crypt.alg, "TKIP") == 0) { /* set mic key */ ++ /* DEBUG_ERR(("\nset key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); */ ++ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); ++ ++ padapter->securitypriv.busetkipkey = _FALSE; ++ /* _set_timer(&padapter->securitypriv.tkip_timer, 50); */ ++ } ++ psta->bpairwise_key_installed = _TRUE; ++#ifdef CONFIG_RTW_80211R ++ psta->ft_pairwise_key_installed = _TRUE; ++#endif ++ /* DEBUG_ERR((" param->u.crypt.key_len=%d\n",param->u.crypt.key_len)); */ ++ RTW_INFO(" ~~~~set sta key:unicastkey\n"); ++ ++ rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _TRUE); ++ } else { /* group key */ ++ if (strcmp(param->u.crypt.alg, "TKIP") == 0 || strcmp(param->u.crypt.alg, "CCMP") == 0) { ++ _rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, ++ (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ _rtw_memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); ++ padapter->securitypriv.binstallGrpkey = _TRUE; ++ if (param->u.crypt.idx < 4) ++ _rtw_memcpy(padapter->securitypriv.iv_seq[param->u.crypt.idx], param->u.crypt.seq, 8); ++ ++ /* DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); */ ++ RTW_INFO(" ~~~~set sta key:groupkey\n"); ++ ++ padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; ++ rtw_set_key(padapter, &padapter->securitypriv, param->u.crypt.idx, 1, _TRUE); ++ } ++#ifdef CONFIG_IEEE80211W ++ else if (strcmp(param->u.crypt.alg, "BIP") == 0) { ++ int no; ++ /* RTW_INFO("BIP key_len=%d , index=%d @@@@@@@@@@@@@@@@@@\n", param->u.crypt.key_len, param->u.crypt.idx); */ ++ /* save the IGTK key, length 16 bytes */ ++ _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, ++ (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ /*RTW_INFO("IGTK key below:\n"); ++ for(no=0;no<16;no++) ++ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); ++ RTW_INFO("\n");*/ ++ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; ++ padapter->securitypriv.binstallBIPkey = _TRUE; ++ RTW_INFO(" ~~~~set sta key:IGKT\n"); ++ } ++#endif /* CONFIG_IEEE80211W */ ++ ++#ifdef CONFIG_P2P ++ if (pwdinfo->driver_interface == DRIVER_CFG80211) { ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_DONE); ++ } ++#endif /* CONFIG_P2P */ ++ ++ } ++ } ++ ++ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); ++ if (pbcmc_sta == NULL) { ++ /* DEBUG_ERR( ("Set OID_802_11_ADD_KEY: bcmc stainfo is null\n")); */ ++ } else { ++ /* Jeff: don't disable ieee8021x_blocked while clearing key */ ++ if (strcmp(param->u.crypt.alg, "none") != 0) ++ pbcmc_sta->ieee8021x_blocked = _FALSE; ++ ++ if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled) || ++ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) ++ pbcmc_sta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; ++ } ++ } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { /* adhoc mode */ ++ } ++ } ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (strcmp(param->u.crypt.alg, "SMS4") == 0) { ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ PRT_WAPI_STA_INFO pWapiSta; ++ u8 WapiASUEPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; ++ u8 WapiAEPNInitialValueSrc[16] = {0x37, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; ++ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; ++ ++ if (param->u.crypt.set_tx == 1) { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if (_rtw_memcmp(pWapiSta->PeerMacAddr, param->sta_addr, 6)) { ++ _rtw_memcpy(pWapiSta->lastTxUnicastPN, WapiASUEPNInitialValueSrc, 16); ++ ++ pWapiSta->wapiUsk.bSet = true; ++ _rtw_memcpy(pWapiSta->wapiUsk.dataKey, param->u.crypt.key, 16); ++ _rtw_memcpy(pWapiSta->wapiUsk.micKey, param->u.crypt.key + 16, 16); ++ pWapiSta->wapiUsk.keyId = param->u.crypt.idx ; ++ pWapiSta->wapiUsk.bTxEnable = true; ++ ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue, WapiAEPNInitialValueSrc, 16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue, WapiAEPNInitialValueSrc, 16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue, WapiAEPNInitialValueSrc, 16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue, WapiAEPNInitialValueSrc, 16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPN, WapiAEPNInitialValueSrc, 16); ++ pWapiSta->wapiUskUpdate.bTxEnable = false; ++ pWapiSta->wapiUskUpdate.bSet = false; ++ ++ if (psecuritypriv->sw_encrypt == false || psecuritypriv->sw_decrypt == false) { ++ /* set unicast key for ASUE */ ++ rtw_wapi_set_key(padapter, &pWapiSta->wapiUsk, pWapiSta, false, false); ++ } ++ } ++ } ++ } else { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if (_rtw_memcmp(pWapiSta->PeerMacAddr, get_bssid(pmlmepriv), 6)) { ++ pWapiSta->wapiMsk.bSet = true; ++ _rtw_memcpy(pWapiSta->wapiMsk.dataKey, param->u.crypt.key, 16); ++ _rtw_memcpy(pWapiSta->wapiMsk.micKey, param->u.crypt.key + 16, 16); ++ pWapiSta->wapiMsk.keyId = param->u.crypt.idx ; ++ pWapiSta->wapiMsk.bTxEnable = false; ++ if (!pWapiSta->bSetkeyOk) ++ pWapiSta->bSetkeyOk = true; ++ pWapiSta->bAuthenticateInProgress = false; ++ ++ _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); ++ ++ if (psecuritypriv->sw_decrypt == false) { ++ /* set rx broadcast key for ASUE */ ++ rtw_wapi_set_key(padapter, &pWapiSta->wapiMsk, pWapiSta, true, false); ++ } ++ } ++ ++ } ++ } ++ } ++#endif ++ ++ ++exit: ++ ++ RTW_INFO("%s, ret=%d\n", __func__, ret); ++ ++ ++ return ret; ++} ++ ++static int cfg80211_rtw_add_key(struct wiphy *wiphy, struct net_device *ndev, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++ u8 key_index, bool pairwise, const u8 *mac_addr, ++#else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ ++ u8 key_index, const u8 *mac_addr, ++#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ ++ struct key_params *params) ++{ ++ char *alg_name; ++ u32 param_len; ++ struct ieee_param *param = NULL; ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct wireless_dev *rtw_wdev = padapter->rtw_wdev; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++#ifdef CONFIG_TDLS ++ struct sta_info *ptdls_sta; ++#endif /* CONFIG_TDLS */ ++ ++ RTW_INFO(FUNC_NDEV_FMT" adding key for %pM\n", FUNC_NDEV_ARG(ndev), mac_addr); ++ RTW_INFO("cipher=0x%x\n", params->cipher); ++ RTW_INFO("key_len=0x%x\n", params->key_len); ++ RTW_INFO("seq_len=0x%x\n", params->seq_len); ++ RTW_INFO("key_index=%d\n", key_index); ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++ RTW_INFO("pairwise=%d\n", pairwise); ++#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ ++ ++ param_len = sizeof(struct ieee_param) + params->key_len; ++ param = (struct ieee_param *)rtw_malloc(param_len); ++ if (param == NULL) ++ return -1; ++ ++ _rtw_memset(param, 0, param_len); ++ ++ param->cmd = IEEE_CMD_SET_ENCRYPTION; ++ _rtw_memset(param->sta_addr, 0xff, ETH_ALEN); ++ ++ switch (params->cipher) { ++ case IW_AUTH_CIPHER_NONE: ++ /* todo: remove key */ ++ /* remove = 1; */ ++ alg_name = "none"; ++ break; ++ case WLAN_CIPHER_SUITE_WEP40: ++ case WLAN_CIPHER_SUITE_WEP104: ++ alg_name = "WEP"; ++ break; ++ case WLAN_CIPHER_SUITE_TKIP: ++ alg_name = "TKIP"; ++ break; ++ case WLAN_CIPHER_SUITE_CCMP: ++ alg_name = "CCMP"; ++ break; ++#ifdef CONFIG_IEEE80211W ++ case WLAN_CIPHER_SUITE_AES_CMAC: ++ alg_name = "BIP"; ++ break; ++#endif /* CONFIG_IEEE80211W */ ++#ifdef CONFIG_WAPI_SUPPORT ++ case WLAN_CIPHER_SUITE_SMS4: ++ alg_name = "SMS4"; ++ if (pairwise == NL80211_KEYTYPE_PAIRWISE) { ++ if (key_index != 0 && key_index != 1) { ++ ret = -ENOTSUPP; ++ goto addkey_end; ++ } ++ _rtw_memcpy((void *)param->sta_addr, (void *)mac_addr, ETH_ALEN); ++ } else ++ RTW_INFO("mac_addr is null\n"); ++ RTW_INFO("rtw_wx_set_enc_ext: SMS4 case\n"); ++ break; ++#endif ++ ++ default: ++ ret = -ENOTSUPP; ++ goto addkey_end; ++ } ++ ++ strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN); ++ ++ ++ if (!mac_addr || is_broadcast_ether_addr(mac_addr)) { ++ param->u.crypt.set_tx = 0; /* for wpa/wpa2 group key */ ++ } else { ++ param->u.crypt.set_tx = 1; /* for wpa/wpa2 pairwise key */ ++ } ++ ++ ++ /* param->u.crypt.idx = key_index - 1; */ ++ param->u.crypt.idx = key_index; ++ ++ if (params->seq_len && params->seq) ++ _rtw_memcpy(param->u.crypt.seq, (u8 *)params->seq, params->seq_len); ++ ++ if (params->key_len && params->key) { ++ param->u.crypt.key_len = params->key_len; ++ _rtw_memcpy(param->u.crypt.key, (u8 *)params->key, params->key_len); ++ } ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { ++#ifdef CONFIG_TDLS ++ if (rtw_tdls_is_driver_setup(padapter) == _FALSE && mac_addr) { ++ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, (void *)mac_addr); ++ if (ptdls_sta != NULL && ptdls_sta->tdls_sta_state) { ++ _rtw_memcpy(ptdls_sta->tpk.tk, params->key, params->key_len); ++ rtw_tdls_set_key(padapter, ptdls_sta); ++ goto addkey_end; ++ } ++ } ++#endif /* CONFIG_TDLS */ ++ ++ ret = rtw_cfg80211_set_encryption(ndev, param, param_len); ++ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { ++#ifdef CONFIG_AP_MODE ++ if (mac_addr) ++ _rtw_memcpy(param->sta_addr, (void *)mac_addr, ETH_ALEN); ++ ++ ret = rtw_cfg80211_ap_set_encryption(ndev, param, param_len); ++#endif ++ } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE ++ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE ++ ) { ++ /* RTW_INFO("@@@@@@@@@@ fw_state=0x%x, iftype=%d\n", pmlmepriv->fw_state, rtw_wdev->iftype); */ ++ ret = rtw_cfg80211_set_encryption(ndev, param, param_len); ++ } else ++ RTW_INFO("error! fw_state=0x%x, iftype=%d\n", pmlmepriv->fw_state, rtw_wdev->iftype); ++ ++ ++addkey_end: ++ if (param) ++ rtw_mfree((u8 *)param, param_len); ++ ++ return ret; ++ ++} ++ ++static int cfg80211_rtw_get_key(struct wiphy *wiphy, struct net_device *ndev, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++ u8 key_index, bool pairwise, const u8 *mac_addr, ++#else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ ++ u8 key_index, const u8 *mac_addr, ++#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ ++ void *cookie, ++ void (*callback)(void *cookie, struct key_params *)) ++{ ++#if 0 ++ struct iwm_priv *iwm = ndev_to_iwm(ndev); ++ struct iwm_key *key = &iwm->keys[key_index]; ++ struct key_params params; ++ ++ IWM_DBG_WEXT(iwm, DBG, "Getting key %d\n", key_index); ++ ++ memset(¶ms, 0, sizeof(params)); ++ ++ params.cipher = key->cipher; ++ params.key_len = key->key_len; ++ params.seq_len = key->seq_len; ++ params.seq = key->seq; ++ params.key = key->key; ++ ++ callback(cookie, ¶ms); ++ ++ return key->key_len ? 0 : -ENOENT; ++#endif ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ return 0; ++} ++ ++static int cfg80211_rtw_del_key(struct wiphy *wiphy, struct net_device *ndev, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++ u8 key_index, bool pairwise, const u8 *mac_addr) ++#else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ ++ u8 key_index, const u8 *mac_addr) ++#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++ RTW_INFO(FUNC_NDEV_FMT" key_index=%d\n", FUNC_NDEV_ARG(ndev), key_index); ++ ++ if (key_index == psecuritypriv->dot11PrivacyKeyIndex) { ++ /* clear the flag of wep default key set. */ ++ psecuritypriv->bWepDefaultKeyIdxSet = 0; ++ } ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_set_default_key(struct wiphy *wiphy, ++ struct net_device *ndev, u8 key_index ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) ++ , bool unicast, bool multicast ++ #endif ++) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++#define SET_DEF_KEY_PARAM_FMT " key_index=%d" ++#define SET_DEF_KEY_PARAM_ARG , key_index ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) ++ #define SET_DEF_KEY_PARAM_FMT_2_6_38 ", unicast=%d, multicast=%d" ++ #define SET_DEF_KEY_PARAM_ARG_2_6_38 , unicast, multicast ++#else ++ #define SET_DEF_KEY_PARAM_FMT_2_6_38 "" ++ #define SET_DEF_KEY_PARAM_ARG_2_6_38 ++#endif ++ ++ RTW_INFO(FUNC_NDEV_FMT ++ SET_DEF_KEY_PARAM_FMT ++ SET_DEF_KEY_PARAM_FMT_2_6_38 ++ "\n", FUNC_NDEV_ARG(ndev) ++ SET_DEF_KEY_PARAM_ARG ++ SET_DEF_KEY_PARAM_ARG_2_6_38 ++ ); ++ ++ if ((key_index < WEP_KEYS) && ((psecuritypriv->dot11PrivacyAlgrthm == _WEP40_) || (psecuritypriv->dot11PrivacyAlgrthm == _WEP104_))) { /* set wep default key */ ++ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ ++ psecuritypriv->dot11PrivacyKeyIndex = key_index; ++ ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; ++ if (psecuritypriv->dot11DefKeylen[key_index] == 13) { ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; ++ } ++ ++ psecuritypriv->bWepDefaultKeyIdxSet = 1; /* set the flag to represent that wep default key has been set */ ++ } ++ ++ return 0; ++ ++} ++#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 1, 0)) ++static int cfg80211_rtw_set_rekey_data(struct wiphy *wiphy, ++ struct net_device *ndev, ++ struct cfg80211_gtk_rekey_data *data) ++{ ++ /*int i;*/ ++ struct sta_info *psta; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct security_priv *psecuritypriv = &(padapter->securitypriv); ++ ++ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); ++ if (psta == NULL) { ++ RTW_INFO("%s, : Obtain Sta_info fail\n", __func__); ++ return -1; ++ } ++ ++ _rtw_memcpy(psta->kek, data->kek, NL80211_KEK_LEN); ++ /*printk("\ncfg80211_rtw_set_rekey_data KEK:"); ++ for(i=0;ikek[i]);*/ ++ _rtw_memcpy(psta->kck, data->kck, NL80211_KCK_LEN); ++ /*printk("\ncfg80211_rtw_set_rekey_data KCK:"); ++ for(i=0;ikck[i]);*/ ++ _rtw_memcpy(psta->replay_ctr, data->replay_ctr, NL80211_REPLAY_CTR_LEN); ++ psecuritypriv->binstallKCK_KEK = _TRUE; ++ /*printk("\nREPLAY_CTR: "); ++ for(i=0;ireplay_ctr[i]);*/ ++ ++ return 0; ++} ++#endif /*CONFIG_GTK_OL*/ ++static int cfg80211_rtw_get_station(struct wiphy *wiphy, ++ struct net_device *ndev, ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0)) ++ u8 *mac, ++#else ++ const u8 *mac, ++#endif ++ struct station_info *sinfo) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ sinfo->filled = 0; ++ ++ if (!mac) { ++ RTW_INFO(FUNC_NDEV_FMT" mac==%p\n", FUNC_NDEV_ARG(ndev), mac); ++ ret = -ENOENT; ++ goto exit; ++ } ++ ++ psta = rtw_get_stainfo(pstapriv, (u8 *)mac); ++ if (psta == NULL) { ++ RTW_INFO("%s, sta_info is null\n", __func__); ++ ret = -ENOENT; ++ goto exit; ++ } ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO(FUNC_NDEV_FMT" mac="MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(mac)); ++#endif ++ ++ /* for infra./P2PClient mode */ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) ++ && check_fwstate(pmlmepriv, _FW_LINKED) ++ ) { ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ ++ if (_rtw_memcmp((u8 *)mac, cur_network->network.MacAddress, ETH_ALEN) == _FALSE) { ++ RTW_INFO("%s, mismatch bssid="MAC_FMT"\n", __func__, MAC_ARG(cur_network->network.MacAddress)); ++ ret = -ENOENT; ++ goto exit; ++ } ++ ++ sinfo->filled |= STATION_INFO_SIGNAL; ++ sinfo->signal = translate_percentage_to_dbm(padapter->recvpriv.signal_strength); ++ ++ sinfo->filled |= STATION_INFO_TX_BITRATE; ++ sinfo->txrate.legacy = rtw_get_cur_max_rate(padapter); ++ ++ sinfo->filled |= STATION_INFO_RX_PACKETS; ++ sinfo->rx_packets = sta_rx_data_pkts(psta); ++ ++ sinfo->filled |= STATION_INFO_TX_PACKETS; ++ sinfo->tx_packets = psta->sta_stats.tx_pkts; ++ ++ } ++ ++ /* for Ad-Hoc/AP mode */ ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) ++ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) ++ || check_fwstate(pmlmepriv, WIFI_AP_STATE)) ++ && check_fwstate(pmlmepriv, _FW_LINKED) ++ ) { ++ /* TODO: should acquire station info... */ ++ } ++ ++exit: ++ return ret; ++} ++ ++extern int netdev_open(struct net_device *pnetdev); ++ ++#if 0 ++enum nl80211_iftype { ++ NL80211_IFTYPE_UNSPECIFIED, ++ NL80211_IFTYPE_ADHOC, /* 1 */ ++ NL80211_IFTYPE_STATION, /* 2 */ ++ NL80211_IFTYPE_AP, /* 3 */ ++ NL80211_IFTYPE_AP_VLAN, ++ NL80211_IFTYPE_WDS, ++ NL80211_IFTYPE_MONITOR, /* 6 */ ++ NL80211_IFTYPE_MESH_POINT, ++ NL80211_IFTYPE_P2P_CLIENT, /* 8 */ ++ NL80211_IFTYPE_P2P_GO, /* 9 */ ++ /* keep last */ ++ NUM_NL80211_IFTYPES, ++ NL80211_IFTYPE_MAX = NUM_NL80211_IFTYPES - 1 ++}; ++#endif ++static int cfg80211_rtw_change_iface(struct wiphy *wiphy, ++ struct net_device *ndev, ++ enum nl80211_iftype type, ++ struct vif_params *params) ++{ ++ enum nl80211_iftype old_type; ++ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct wireless_dev *rtw_wdev = padapter->rtw_wdev; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 is_p2p = _FALSE; ++#endif ++ int ret = 0; ++ u8 change = _FALSE; ++ ++ RTW_INFO(FUNC_NDEV_FMT" type=%d\n", FUNC_NDEV_ARG(ndev), type); ++ ++ if (adapter_to_dvobj(padapter)->processing_dev_remove == _TRUE) { ++ ret = -EPERM; ++ goto exit; ++ } ++ ++ ++ RTW_INFO(FUNC_NDEV_FMT" call netdev_open\n", FUNC_NDEV_ARG(ndev)); ++ if (netdev_open(ndev) != 0) { ++ RTW_INFO(FUNC_NDEV_FMT" call netdev_open fail\n", FUNC_NDEV_ARG(ndev)); ++ ret = -EPERM; ++ goto exit; ++ } ++ ++ ++ if (_FAIL == rtw_pwr_wakeup(padapter)) { ++ RTW_INFO(FUNC_NDEV_FMT" call rtw_pwr_wakeup fail\n", FUNC_NDEV_ARG(ndev)); ++ ret = -EPERM; ++ goto exit; ++ } ++ ++ old_type = rtw_wdev->iftype; ++ RTW_INFO(FUNC_NDEV_FMT" old_iftype=%d, new_iftype=%d\n", ++ FUNC_NDEV_ARG(ndev), old_type, type); ++ ++ if (old_type != type) { ++ change = _TRUE; ++ pmlmeext->action_public_rxseq = 0xffff; ++ pmlmeext->action_public_dialog_token = 0xff; ++ } ++ ++ /* initial default type */ ++ ndev->type = ARPHRD_ETHER; ++ ++ switch (type) { ++ case NL80211_IFTYPE_ADHOC: ++ networkType = Ndis802_11IBSS; ++ break; ++ ++ #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) ++ case NL80211_IFTYPE_P2P_CLIENT: ++ is_p2p = _TRUE; ++ #endif ++ case NL80211_IFTYPE_STATION: ++ networkType = Ndis802_11Infrastructure; ++ ++ #ifdef CONFIG_P2P ++ if (change && pwdinfo->driver_interface == DRIVER_CFG80211) { ++ if (is_p2p == _TRUE) ++ rtw_p2p_enable(padapter, P2P_ROLE_CLIENT); ++ #if !RTW_P2P_GROUP_INTERFACE ++ else if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) ++ || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) ++ ) { ++ /* it means remove GC/GO and change mode from GC/GO to station(P2P DEVICE) */ ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ } ++ #endif ++ } ++ #endif /* CONFIG_P2P */ ++ ++ break; ++ ++ #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) ++ case NL80211_IFTYPE_P2P_GO: ++ is_p2p = _TRUE; ++ #endif ++ case NL80211_IFTYPE_AP: ++ networkType = Ndis802_11APMode; ++ ++ #ifdef CONFIG_P2P ++ if (change && pwdinfo->driver_interface == DRIVER_CFG80211) { ++ if (is_p2p == _TRUE) ++ rtw_p2p_enable(padapter, P2P_ROLE_GO); ++ #if !RTW_P2P_GROUP_INTERFACE ++ else if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ /* it means P2P Group created, we will be GO and change mode from P2P DEVICE to AP(GO) */ ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); ++ } ++ #endif ++ } ++ #endif /* CONFIG_P2P */ ++ ++ break; ++ ++ case NL80211_IFTYPE_MONITOR: ++ networkType = Ndis802_11Monitor; ++#if 0 ++ ndev->type = ARPHRD_IEEE80211; /* IEEE 802.11 : 801 */ ++#endif ++ ndev->type = ARPHRD_IEEE80211_RADIOTAP; /* IEEE 802.11 + radiotap header : 803 */ ++ break; ++ default: ++ ret = -EOPNOTSUPP; ++ goto exit; ++ } ++ ++ rtw_wdev->iftype = type; ++ ++ if (rtw_set_802_11_infrastructure_mode(padapter, networkType) == _FALSE) { ++ rtw_wdev->iftype = old_type; ++ ret = -EPERM; ++ goto exit; ++ } ++ ++ rtw_setopmode_cmd(padapter, networkType, _TRUE); ++ ++exit: ++ ++ RTW_INFO(FUNC_NDEV_FMT" ret:%d\n", FUNC_NDEV_ARG(ndev), ret); ++ return ret; ++} ++ ++void rtw_cfg80211_indicate_scan_done(_adapter *adapter, bool aborted) ++{ ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); ++ _irqL irqL; ++ ++#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) ++ struct cfg80211_scan_info info; ++ ++ memset(&info, 0, sizeof(info)); ++ info.aborted = aborted; ++#endif ++ ++ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); ++ if (pwdev_priv->scan_request != NULL) { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s with scan req\n", __FUNCTION__); ++ #endif ++ ++ /* avoid WARN_ON(request != wiphy_to_dev(request->wiphy)->scan_req); */ ++ if (pwdev_priv->scan_request->wiphy != pwdev_priv->rtw_wdev->wiphy) ++ RTW_INFO("error wiphy compare\n"); ++ else ++#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) ++ cfg80211_scan_done(pwdev_priv->scan_request, &info); ++#else ++ cfg80211_scan_done(pwdev_priv->scan_request, aborted); ++#endif ++ ++ pwdev_priv->scan_request = NULL; ++ } else { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s without scan req\n", __FUNCTION__); ++ #endif ++ } ++ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); ++} ++ ++u32 rtw_cfg80211_wait_scan_req_empty(_adapter *adapter, u32 timeout_ms) ++{ ++ struct rtw_wdev_priv *wdev_priv = adapter_wdev_data(adapter); ++ u8 empty = _FALSE; ++ u32 start; ++ u32 pass_ms; ++ ++ start = rtw_get_current_time(); ++ ++ while (rtw_get_passing_time_ms(start) <= timeout_ms) { ++ ++ if (RTW_CANNOT_RUN(adapter)) ++ break; ++ ++ if (!wdev_priv->scan_request) { ++ empty = _TRUE; ++ break; ++ } ++ ++ rtw_msleep_os(10); ++ } ++ ++ pass_ms = rtw_get_passing_time_ms(start); ++ ++ if (empty == _FALSE && pass_ms > timeout_ms) ++ RTW_PRINT(FUNC_ADPT_FMT" pass_ms:%u, timeout\n" ++ , FUNC_ADPT_ARG(adapter), pass_ms); ++ ++ return pass_ms; ++} ++ ++void rtw_cfg80211_unlink_bss(_adapter *padapter, struct wlan_network *pnetwork) ++{ ++ struct wireless_dev *pwdev = padapter->rtw_wdev; ++ struct wiphy *wiphy = pwdev->wiphy; ++ struct cfg80211_bss *bss = NULL; ++ WLAN_BSSID_EX select_network = pnetwork->network; ++ ++ bss = cfg80211_get_bss(wiphy, NULL/*notify_channel*/, ++ select_network.MacAddress, select_network.Ssid.Ssid, ++ select_network.Ssid.SsidLength, ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0) ++ select_network.InfrastructureMode == Ndis802_11Infrastructure?IEEE80211_BSS_TYPE_ESS:IEEE80211_BSS_TYPE_IBSS, ++ IEEE80211_PRIVACY(select_network.Privacy)); ++#else ++ select_network.InfrastructureMode == Ndis802_11Infrastructure?WLAN_CAPABILITY_ESS:WLAN_CAPABILITY_IBSS, ++ select_network.InfrastructureMode == Ndis802_11Infrastructure?WLAN_CAPABILITY_ESS:WLAN_CAPABILITY_IBSS); ++#endif ++ ++ if (bss) { ++ cfg80211_unlink_bss(wiphy, bss); ++ RTW_INFO("%s(): cfg80211_unlink %s!!\n", __func__, select_network.Ssid.Ssid); ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0) ++ cfg80211_put_bss(padapter->rtw_wdev->wiphy, bss); ++#else ++ cfg80211_put_bss(bss); ++#endif ++ } ++ return; ++} ++ ++/* if target wps scan ongoing, target_ssid is filled */ ++int rtw_cfg80211_is_target_wps_scan(struct cfg80211_scan_request *scan_req, struct cfg80211_ssid *target_ssid) ++{ ++ int ret = 0; ++ ++ if (scan_req->n_ssids != 1 ++ || scan_req->ssids[0].ssid_len == 0 ++ || scan_req->n_channels != 1 ++ ) ++ goto exit; ++ ++ /* under target WPS scan */ ++ _rtw_memcpy(target_ssid, scan_req->ssids, sizeof(struct cfg80211_ssid)); ++ ret = 1; ++ ++exit: ++ return ret; ++} ++ ++static void _rtw_cfg80211_surveydone_event_callback(_adapter *padapter, struct cfg80211_scan_request *scan_req) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ u32 cnt = 0; ++ u32 wait_for_surveydone; ++ sint wait_status; ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); ++ struct cfg80211_ssid target_ssid; ++ u8 target_wps_scan = 0; ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s\n", __func__); ++#endif ++ ++ if (scan_req) ++ target_wps_scan = rtw_cfg80211_is_target_wps_scan(scan_req, &target_ssid); ++ else { ++ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); ++ if (pwdev_priv->scan_request != NULL) ++ target_wps_scan = rtw_cfg80211_is_target_wps_scan(pwdev_priv->scan_request, &target_ssid); ++ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); ++ } ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ ++ /* report network only if the current channel set contains the channel to which this network belongs */ ++ if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 ++ && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE ++ && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid)) ++ ) { ++ if (target_wps_scan) ++ rtw_cfg80211_clear_wps_sr_of_non_target_bss(padapter, pnetwork, &target_ssid); ++ rtw_cfg80211_inform_bss(padapter, pnetwork); ++ } ++#if 0 ++ /* check ralink testbed RSN IE length */ ++ { ++ if (_rtw_memcmp(pnetwork->network.Ssid.Ssid, "Ralink_11n_AP", 13)) { ++ uint ie_len = 0; ++ u8 *p = NULL; ++ p = rtw_get_ie(pnetwork->network.IEs + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pnetwork->network.IELength - _BEACON_IE_OFFSET_)); ++ RTW_INFO("ie_len=%d\n", ie_len); ++ } ++ } ++#endif ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++} ++ ++inline void rtw_cfg80211_surveydone_event_callback(_adapter *padapter) ++{ ++ _rtw_cfg80211_surveydone_event_callback(padapter, NULL); ++} ++ ++static int rtw_cfg80211_set_probe_req_wpsp2pie(_adapter *padapter, char *buf, int len) ++{ ++ int ret = 0; ++ uint wps_ielen = 0; ++ u8 *wps_ie; ++ u32 p2p_ielen = 0; ++ u8 *p2p_ie; ++ u32 wfd_ielen = 0; ++ u8 *wfd_ie; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s, ielen=%d\n", __func__, len); ++#endif ++ ++ if (len > 0) { ++ wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen); ++ if (wps_ie) { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("probe_req_wps_ielen=%d\n", wps_ielen); ++ #endif ++ ++ if (pmlmepriv->wps_probe_req_ie) { ++ u32 free_len = pmlmepriv->wps_probe_req_ie_len; ++ pmlmepriv->wps_probe_req_ie_len = 0; ++ rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len); ++ pmlmepriv->wps_probe_req_ie = NULL; ++ } ++ ++ pmlmepriv->wps_probe_req_ie = rtw_malloc(wps_ielen); ++ if (pmlmepriv->wps_probe_req_ie == NULL) { ++ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ _rtw_memcpy(pmlmepriv->wps_probe_req_ie, wps_ie, wps_ielen); ++ pmlmepriv->wps_probe_req_ie_len = wps_ielen; ++ } ++ ++ /* buf += wps_ielen; */ ++ /* len -= wps_ielen; */ ++ ++ #ifdef CONFIG_P2P ++ p2p_ie = rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen); ++ if (p2p_ie) { ++ struct wifidirect_info *wdinfo = &padapter->wdinfo; ++ u32 attr_contentlen = 0; ++ u8 listen_ch_attr[5]; ++ ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("probe_req_p2p_ielen=%d\n", p2p_ielen); ++ #endif ++ ++ if (pmlmepriv->p2p_probe_req_ie) { ++ u32 free_len = pmlmepriv->p2p_probe_req_ie_len; ++ pmlmepriv->p2p_probe_req_ie_len = 0; ++ rtw_mfree(pmlmepriv->p2p_probe_req_ie, free_len); ++ pmlmepriv->p2p_probe_req_ie = NULL; ++ } ++ ++ pmlmepriv->p2p_probe_req_ie = rtw_malloc(p2p_ielen); ++ if (pmlmepriv->p2p_probe_req_ie == NULL) { ++ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ _rtw_memcpy(pmlmepriv->p2p_probe_req_ie, p2p_ie, p2p_ielen); ++ pmlmepriv->p2p_probe_req_ie_len = p2p_ielen; ++ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_LISTEN_CH, (u8 *)listen_ch_attr, (uint *) &attr_contentlen) ++ && attr_contentlen == 5) { ++ if (wdinfo->listen_channel != listen_ch_attr[4]) { ++ RTW_INFO(FUNC_ADPT_FMT" listen channel - country:%c%c%c, class:%u, ch:%u\n", ++ FUNC_ADPT_ARG(padapter), listen_ch_attr[0], listen_ch_attr[1], listen_ch_attr[2], ++ listen_ch_attr[3], listen_ch_attr[4]); ++ wdinfo->listen_channel = listen_ch_attr[4]; ++ } ++ } ++ } ++ #endif /* CONFIG_P2P */ ++ ++ #ifdef CONFIG_WFD ++ wfd_ie = rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen); ++ if (wfd_ie) { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("probe_req_wfd_ielen=%d\n", wfd_ielen); ++ #endif ++ ++ if (rtw_mlme_update_wfd_ie_data(pmlmepriv, MLME_PROBE_REQ_IE, wfd_ie, wfd_ielen) != _SUCCESS) ++ return -EINVAL; ++ } ++ #endif /* CONFIG_WFD */ ++ } ++ ++ return ret; ++ ++} ++ ++#ifdef CONFIG_CONCURRENT_MODE ++u8 rtw_cfg80211_scan_via_buddy(_adapter *padapter, struct cfg80211_scan_request *request) ++{ ++ int i; ++ u8 ret = _FALSE; ++ _adapter *iface = NULL; ++ _irqL irqL; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ struct mlme_priv *buddy_mlmepriv; ++ struct rtw_wdev_priv *buddy_wdev_priv; ++ ++ iface = dvobj->padapters[i]; ++ if (iface == NULL) ++ continue; ++ ++ if (iface == padapter) ++ continue; ++ ++ if (rtw_is_adapter_up(iface) == _FALSE) ++ continue; ++ ++ buddy_mlmepriv = &iface->mlmepriv; ++ if (!check_fwstate(buddy_mlmepriv, _FW_UNDER_SURVEY)) ++ continue; ++ ++ buddy_wdev_priv = adapter_wdev_data(iface); ++ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); ++ _enter_critical_bh(&buddy_wdev_priv->scan_req_lock, &irqL); ++ if (buddy_wdev_priv->scan_request) { ++ pmlmepriv->scanning_via_buddy_intf = _TRUE; ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ set_fwstate(pmlmepriv, _FW_UNDER_SURVEY); ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ pwdev_priv->scan_request = request; ++ ret = _TRUE; ++ } ++ _exit_critical_bh(&buddy_wdev_priv->scan_req_lock, &irqL); ++ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); ++ ++ if (ret == _TRUE) ++ goto exit; ++ } ++ ++exit: ++ return ret; ++} ++ ++void rtw_cfg80211_indicate_scan_done_for_buddy(_adapter *padapter, bool bscan_aborted) ++{ ++ int i; ++ u8 ret = 0; ++ _adapter *iface = NULL; ++ _irqL irqL; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct mlme_priv *mlmepriv; ++ struct rtw_wdev_priv *wdev_priv; ++ bool indicate_buddy_scan; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ ++ if (iface == padapter) ++ continue; ++ ++ mlmepriv = &(iface->mlmepriv); ++ wdev_priv = adapter_wdev_data(iface); ++ ++ indicate_buddy_scan = _FALSE; ++ _enter_critical_bh(&wdev_priv->scan_req_lock, &irqL); ++ if (wdev_priv->scan_request && mlmepriv->scanning_via_buddy_intf == _TRUE) { ++ mlmepriv->scanning_via_buddy_intf = _FALSE; ++ clr_fwstate(mlmepriv, _FW_UNDER_SURVEY); ++ indicate_buddy_scan = _TRUE; ++ } ++ _exit_critical_bh(&wdev_priv->scan_req_lock, &irqL); ++ ++ if (indicate_buddy_scan == _TRUE) { ++ rtw_cfg80211_surveydone_event_callback(iface); ++ rtw_indicate_scan_done(iface, bscan_aborted); ++ } ++ ++ } ++ } ++} ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++static int cfg80211_rtw_scan(struct wiphy *wiphy ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) ++ , struct net_device *ndev ++ #endif ++ , struct cfg80211_scan_request *request) ++{ ++ int i, chan_num = 0; ++ u8 _status = _FALSE; ++ int ret = 0; ++ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; ++ struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; ++ struct rtw_ieee80211_channel *pch; ++ _irqL irqL; ++ u8 *wps_ie = NULL; ++ uint wps_ielen = 0; ++ u8 *p2p_ie = NULL; ++ uint p2p_ielen = 0; ++ u8 survey_times = 3; ++ u8 survey_times_for_one_ch = 6; ++ struct cfg80211_ssid *ssids = request->ssids; ++ int social_channel = 0, j = 0; ++ bool need_indicate_scan_done = _FALSE; ++ bool ps_denied = _FALSE; ++ ++ _adapter *padapter; ++ struct wireless_dev *wdev; ++ struct rtw_wdev_priv *pwdev_priv; ++ struct mlme_priv *pmlmepriv; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo; ++#endif /* CONFIG_P2P */ ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ wdev = request->wdev; ++ #if defined(RTW_DEDICATED_P2P_DEVICE) ++ if (wdev == wiphy_to_pd_wdev(wiphy)) ++ padapter = wiphy_to_adapter(wiphy); ++ else ++ #endif ++ if (wdev_to_ndev(wdev)) ++ padapter = (_adapter *)rtw_netdev_priv(wdev_to_ndev(wdev)); ++ else { ++ ret = -EINVAL; ++ goto exit; ++ } ++#else ++ if (ndev == NULL) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ padapter = (_adapter *)rtw_netdev_priv(ndev); ++ wdev = ndev_to_wdev(ndev); ++#endif ++ ++ pwdev_priv = adapter_wdev_data(padapter); ++ pmlmepriv = &padapter->mlmepriv; ++#ifdef CONFIG_P2P ++ pwdinfo = &(padapter->wdinfo); ++#endif /* CONFIG_P2P */ ++ ++ RTW_INFO(FUNC_ADPT_FMT"%s\n", FUNC_ADPT_ARG(padapter) ++ , wdev == wiphy_to_pd_wdev(wiphy) ? " PD" : ""); ++ ++#ifdef CONFIG_MP_INCLUDED ++ if (rtw_mi_mp_mode_check(padapter)) { ++ RTW_INFO("MP mode block Scan request\n"); ++ ret = -EPERM; ++ goto exit; ++ } ++#endif ++ ++ if (adapter_wdev_data(padapter)->block_scan == _TRUE) { ++ RTW_INFO(FUNC_ADPT_FMT" wdev_priv.block_scan is set\n", FUNC_ADPT_ARG(padapter)); ++ need_indicate_scan_done = _TRUE; ++ goto check_need_indicate_scan_done; ++ } ++ ++ rtw_ps_deny(padapter, PS_DENY_SCAN); ++ ps_denied = _TRUE; ++ if (_FAIL == rtw_pwr_wakeup(padapter)) { ++ need_indicate_scan_done = _TRUE; ++ goto check_need_indicate_scan_done; ++ } ++ ++#ifdef CONFIG_P2P ++ if (pwdinfo->driver_interface == DRIVER_CFG80211) { ++ if (ssids->ssid != NULL ++ && _rtw_memcmp(ssids->ssid, "DIRECT-", 7) ++ && rtw_get_p2p_ie((u8 *)request->ie, request->ie_len, NULL, NULL) ++ ) { ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); ++ else { ++ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); ++ #endif ++ } ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); ++ ++ if (request->n_channels == 3 && ++ request->channels[0]->hw_value == 1 && ++ request->channels[1]->hw_value == 6 && ++ request->channels[2]->hw_value == 11 ++ ) ++ social_channel = 1; ++ } ++ } ++#endif /*CONFIG_P2P*/ ++ ++ if (request->ie && request->ie_len > 0) ++ rtw_cfg80211_set_probe_req_wpsp2pie(padapter, (u8 *)request->ie, request->ie_len); ++ ++ if (rtw_is_scan_deny(padapter)) { ++ RTW_INFO(FUNC_ADPT_FMT ": scan deny\n", FUNC_ADPT_ARG(padapter)); ++ need_indicate_scan_done = _TRUE; ++ goto check_need_indicate_scan_done; ++ } ++ ++ /* check fw state*/ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO(FUNC_ADPT_FMT" under WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter)); ++#endif ++ ++ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS | _FW_UNDER_SURVEY | _FW_UNDER_LINKING) == _TRUE) { ++ RTW_INFO("%s, fwstate=0x%x\n", __func__, pmlmepriv->fw_state); ++ ++ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) ++ RTW_INFO("AP mode process WPS\n"); ++ ++ need_indicate_scan_done = _TRUE; ++ goto check_need_indicate_scan_done; ++ } ++ } ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { ++ RTW_INFO("%s, fwstate=0x%x\n", __func__, pmlmepriv->fw_state); ++ need_indicate_scan_done = _TRUE; ++ goto check_need_indicate_scan_done; ++ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { ++ RTW_INFO("%s, fwstate=0x%x\n", __func__, pmlmepriv->fw_state); ++ ret = -EBUSY; ++ goto check_need_indicate_scan_done; ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_LINKING | WIFI_UNDER_WPS)) { ++ RTW_INFO("%s exit due to buddy_intf's mlme state under linking or wps\n", __func__); ++ need_indicate_scan_done = _TRUE; ++ goto check_need_indicate_scan_done; ++ ++ } else if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_SURVEY)) { ++ bool scan_via_buddy = rtw_cfg80211_scan_via_buddy(padapter, request); ++ ++ if (scan_via_buddy == _FALSE) ++ need_indicate_scan_done = _TRUE; ++ ++ goto check_need_indicate_scan_done; ++ } ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ /* busy traffic check*/ ++ if (rtw_mi_busy_traffic_check(padapter, _TRUE)) { ++ need_indicate_scan_done = _TRUE; ++ goto check_need_indicate_scan_done; ++ } ++ ++#ifdef CONFIG_P2P ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) { ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); ++ rtw_free_network_queue(padapter, _TRUE); ++ ++ if (social_channel == 0) ++ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); ++ else ++ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_SOCIAL_LAST); ++ } ++#endif /* CONFIG_P2P */ ++ ++ ++ _rtw_memset(ssid, 0, sizeof(NDIS_802_11_SSID) * RTW_SSID_SCAN_AMOUNT); ++ /* parsing request ssids, n_ssids */ ++ for (i = 0; i < request->n_ssids && i < RTW_SSID_SCAN_AMOUNT; i++) { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("ssid=%s, len=%d\n", ssids[i].ssid, ssids[i].ssid_len); ++ #endif ++ _rtw_memcpy(ssid[i].Ssid, ssids[i].ssid, ssids[i].ssid_len); ++ ssid[i].SsidLength = ssids[i].ssid_len; ++ } ++ ++ /* parsing channels, n_channels */ ++ _rtw_memset(ch, 0, sizeof(struct rtw_ieee80211_channel) * RTW_CHANNEL_SCAN_AMOUNT); ++ for (i = 0; i < request->n_channels && i < RTW_CHANNEL_SCAN_AMOUNT; i++) { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO(FUNC_ADPT_FMT CHAN_FMT"\n", FUNC_ADPT_ARG(padapter), CHAN_ARG(request->channels[i])); ++ #endif ++ ch[i].hw_value = request->channels[i]->hw_value; ++ ch[i].flags = request->channels[i]->flags; ++ } ++ ++ if (request->n_channels == 1) { ++ for (i = 1; i < survey_times_for_one_ch; i++) ++ _rtw_memcpy(&ch[i], &ch[0], sizeof(struct rtw_ieee80211_channel)); ++ pch = ch; ++ chan_num = survey_times_for_one_ch; ++ } else if (request->n_channels <= 4) { ++ for (j = request->n_channels - 1; j >= 0; j--) ++ for (i = 0; i < survey_times; i++) ++ _rtw_memcpy(&ch[j * survey_times + i], &ch[j], sizeof(struct rtw_ieee80211_channel)); ++ pch = ch; ++ chan_num = survey_times * request->n_channels; ++ } else { ++ pch = ch; ++ chan_num = request->n_channels; ++ } ++ ++ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ _status = rtw_sitesurvey_cmd(padapter, ssid, RTW_SSID_SCAN_AMOUNT, pch, chan_num); ++ if (_status == _SUCCESS) ++ pwdev_priv->scan_request = request; ++ else ++ ret = -1; ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); ++ ++check_need_indicate_scan_done: ++ if (_TRUE == need_indicate_scan_done) { ++#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) ++ struct cfg80211_scan_info info; ++ ++ memset(&info, 0, sizeof(info)); ++ info.aborted = 0; ++#endif ++ ++ _rtw_cfg80211_surveydone_event_callback(padapter, request); ++#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) ++ cfg80211_scan_done(request, &info); ++#else ++ cfg80211_scan_done(request, 0); ++#endif ++ } ++ ++cancel_ps_deny: ++ if (ps_denied == _TRUE) ++ rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); ++ ++exit: ++ return ret; ++ ++} ++ ++static int cfg80211_rtw_set_wiphy_params(struct wiphy *wiphy, u32 changed) ++{ ++#if 0 ++ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); ++ ++ if (changed & WIPHY_PARAM_RTS_THRESHOLD && ++ (iwm->conf.rts_threshold != wiphy->rts_threshold)) { ++ int ret; ++ ++ iwm->conf.rts_threshold = wiphy->rts_threshold; ++ ++ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_CFG_FIX, ++ CFG_RTS_THRESHOLD, ++ iwm->conf.rts_threshold); ++ if (ret < 0) ++ return ret; ++ } ++ ++ if (changed & WIPHY_PARAM_FRAG_THRESHOLD && ++ (iwm->conf.frag_threshold != wiphy->frag_threshold)) { ++ int ret; ++ ++ iwm->conf.frag_threshold = wiphy->frag_threshold; ++ ++ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_FA_CFG_FIX, ++ CFG_FRAG_THRESHOLD, ++ iwm->conf.frag_threshold); ++ if (ret < 0) ++ return ret; ++ } ++#endif ++ RTW_INFO("%s\n", __func__); ++ return 0; ++} ++ ++ ++ ++static int rtw_cfg80211_set_wpa_version(struct security_priv *psecuritypriv, u32 wpa_version) ++{ ++ RTW_INFO("%s, wpa_version=%d\n", __func__, wpa_version); ++ ++ if (!wpa_version) { ++ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; ++ return 0; ++ } ++ ++ ++ if (wpa_version & (NL80211_WPA_VERSION_1 | NL80211_WPA_VERSION_2)) ++ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPAPSK; ++ ++#if 0 ++ if (wpa_version & NL80211_WPA_VERSION_2) ++ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPA2PSK; ++#endif ++ ++ #ifdef CONFIG_WAPI_SUPPORT ++ if (wpa_version & NL80211_WAPI_VERSION_1) ++ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWAPI; ++ #endif ++ ++ return 0; ++ ++} ++ ++static int rtw_cfg80211_set_auth_type(struct security_priv *psecuritypriv, ++ enum nl80211_auth_type sme_auth_type) ++{ ++ RTW_INFO("%s, nl80211_auth_type=%d\n", __func__, sme_auth_type); ++ ++ ++ switch (sme_auth_type) { ++ case NL80211_AUTHTYPE_AUTOMATIC: ++ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; ++ ++ break; ++ case NL80211_AUTHTYPE_OPEN_SYSTEM: ++ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; ++ ++ if (psecuritypriv->ndisauthtype > Ndis802_11AuthModeWPA) ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWAPI) ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; ++#endif ++ ++ break; ++ case NL80211_AUTHTYPE_SHARED_KEY: ++ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; ++ ++ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ ++ ++ break; ++ default: ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; ++ /* return -ENOTSUPP; */ ++ } ++ ++ return 0; ++ ++} ++ ++static int rtw_cfg80211_set_cipher(struct security_priv *psecuritypriv, u32 cipher, bool ucast) ++{ ++ u32 ndisencryptstatus = Ndis802_11EncryptionDisabled; ++ ++ u32 *profile_cipher = ucast ? &psecuritypriv->dot11PrivacyAlgrthm : ++ &psecuritypriv->dot118021XGrpPrivacy; ++ ++ RTW_INFO("%s, ucast=%d, cipher=0x%x\n", __func__, ucast, cipher); ++ ++ ++ if (!cipher) { ++ *profile_cipher = _NO_PRIVACY_; ++ psecuritypriv->ndisencryptstatus = ndisencryptstatus; ++ return 0; ++ } ++ ++ switch (cipher) { ++ case IW_AUTH_CIPHER_NONE: ++ *profile_cipher = _NO_PRIVACY_; ++ ndisencryptstatus = Ndis802_11EncryptionDisabled; ++#ifdef CONFIG_WAPI_SUPPORT ++ if (psecuritypriv->dot11PrivacyAlgrthm == _SMS4_) ++ *profile_cipher = _SMS4_; ++#endif ++ break; ++ case WLAN_CIPHER_SUITE_WEP40: ++ *profile_cipher = _WEP40_; ++ ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ case WLAN_CIPHER_SUITE_WEP104: ++ *profile_cipher = _WEP104_; ++ ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ case WLAN_CIPHER_SUITE_TKIP: ++ *profile_cipher = _TKIP_; ++ ndisencryptstatus = Ndis802_11Encryption2Enabled; ++ break; ++ case WLAN_CIPHER_SUITE_CCMP: ++ *profile_cipher = _AES_; ++ ndisencryptstatus = Ndis802_11Encryption3Enabled; ++ break; ++#ifdef CONFIG_WAPI_SUPPORT ++ case WLAN_CIPHER_SUITE_SMS4: ++ *profile_cipher = _SMS4_; ++ ndisencryptstatus = Ndis802_11_EncrypteionWAPI; ++ break; ++#endif ++ default: ++ RTW_INFO("Unsupported cipher: 0x%x\n", cipher); ++ return -ENOTSUPP; ++ } ++ ++ if (ucast) { ++ psecuritypriv->ndisencryptstatus = ndisencryptstatus; ++ ++ /* if(psecuritypriv->dot11PrivacyAlgrthm >= _AES_) */ ++ /* psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPA2PSK; */ ++ } ++ ++ return 0; ++} ++ ++static int rtw_cfg80211_set_key_mgt(struct security_priv *psecuritypriv, u32 key_mgt) ++{ ++ RTW_INFO("%s, key_mgt=0x%x\n", __func__, key_mgt); ++ ++ if (key_mgt == WLAN_AKM_SUITE_8021X) { ++ /* *auth_type = UMAC_AUTH_TYPE_8021X; */ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ psecuritypriv->rsn_akm_suite_type = 1; ++ } else if (key_mgt == WLAN_AKM_SUITE_PSK) { ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ psecuritypriv->rsn_akm_suite_type = 2; ++ } ++#ifdef CONFIG_WAPI_SUPPORT ++ else if (key_mgt == WLAN_AKM_SUITE_WAPI_PSK) ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; ++ else if (key_mgt == WLAN_AKM_SUITE_WAPI_CERT) ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; ++#endif ++#ifdef CONFIG_RTW_80211R ++ else if (key_mgt == WLAN_AKM_SUITE_FT_8021X) { ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ psecuritypriv->rsn_akm_suite_type = 3; ++ } else if (key_mgt == WLAN_AKM_SUITE_FT_PSK) { ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ psecuritypriv->rsn_akm_suite_type = 4; ++ } ++#endif ++ else { ++ RTW_INFO("Invalid key mgt: 0x%x\n", key_mgt); ++ /* return -EINVAL; */ ++ } ++ ++ return 0; ++} ++ ++static int rtw_cfg80211_set_wpa_ie(_adapter *padapter, u8 *pie, size_t ielen) ++{ ++ u8 *buf = NULL, *pos = NULL; ++ u32 left; ++ int group_cipher = 0, pairwise_cipher = 0; ++ int ret = 0; ++ int wpa_ielen = 0; ++ int wpa2_ielen = 0; ++ u8 *pwpa, *pwpa2; ++ u8 null_addr[] = {0, 0, 0, 0, 0, 0}; ++ ++ if (pie == NULL || !ielen) { ++ /* Treat this as normal case, but need to clear WIFI_UNDER_WPS */ ++ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); ++ goto exit; ++ } ++ ++ if (ielen > MAX_WPA_IE_LEN + MAX_WPS_IE_LEN + MAX_P2P_IE_LEN) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ buf = rtw_zmalloc(ielen); ++ if (buf == NULL) { ++ ret = -ENOMEM; ++ goto exit; ++ } ++ ++ _rtw_memcpy(buf, pie , ielen); ++ ++ /* dump */ ++ { ++ int i; ++ RTW_INFO("set wpa_ie(length:%zu):\n", ielen); ++ for (i = 0; i < ielen; i = i + 8) ++ RTW_INFO("0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x\n", buf[i], buf[i + 1], buf[i + 2], buf[i + 3], buf[i + 4], buf[i + 5], buf[i + 6], buf[i + 7]); ++ } ++ ++ pos = buf; ++ if (ielen < RSN_HEADER_LEN) { ++ ret = -1; ++ goto exit; ++ } ++ ++ pwpa = rtw_get_wpa_ie(buf, &wpa_ielen, ielen); ++ if (pwpa && wpa_ielen > 0) { ++ if (rtw_parse_wpa_ie(pwpa, wpa_ielen + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPAPSK; ++ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &pwpa[0], wpa_ielen + 2); ++ ++ RTW_INFO("got wpa_ie, wpa_ielen:%u\n", wpa_ielen); ++ } ++ } ++ ++ pwpa2 = rtw_get_wpa2_ie(buf, &wpa2_ielen, ielen); ++ if (pwpa2 && wpa2_ielen > 0) { ++ if (rtw_parse_wpa2_ie(pwpa2, wpa2_ielen + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPA2PSK; ++ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &pwpa2[0], wpa2_ielen + 2); ++ ++ RTW_INFO("got wpa2_ie, wpa2_ielen:%u\n", wpa2_ielen); ++ } ++ } ++ ++ if (group_cipher == 0) ++ group_cipher = WPA_CIPHER_NONE; ++ if (pairwise_cipher == 0) ++ pairwise_cipher = WPA_CIPHER_NONE; ++ ++ switch (group_cipher) { ++ case WPA_CIPHER_NONE: ++ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; ++ break; ++ case WPA_CIPHER_WEP40: ++ padapter->securitypriv.dot118021XGrpPrivacy = _WEP40_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ case WPA_CIPHER_TKIP: ++ padapter->securitypriv.dot118021XGrpPrivacy = _TKIP_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; ++ break; ++ case WPA_CIPHER_CCMP: ++ padapter->securitypriv.dot118021XGrpPrivacy = _AES_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; ++ break; ++ case WPA_CIPHER_WEP104: ++ padapter->securitypriv.dot118021XGrpPrivacy = _WEP104_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ } ++ ++ switch (pairwise_cipher) { ++ case WPA_CIPHER_NONE: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; ++ break; ++ case WPA_CIPHER_WEP40: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ case WPA_CIPHER_TKIP: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _TKIP_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; ++ break; ++ case WPA_CIPHER_CCMP: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _AES_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; ++ break; ++ case WPA_CIPHER_WEP104: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ } ++ ++ {/* handle wps_ie */ ++ uint wps_ielen; ++ u8 *wps_ie; ++ ++ wps_ie = rtw_get_wps_ie(buf, ielen, NULL, &wps_ielen); ++ if (wps_ie && wps_ielen > 0) { ++ RTW_INFO("got wps_ie, wps_ielen:%u\n", wps_ielen); ++ padapter->securitypriv.wps_ie_len = wps_ielen < MAX_WPS_IE_LEN ? wps_ielen : MAX_WPS_IE_LEN; ++ _rtw_memcpy(padapter->securitypriv.wps_ie, wps_ie, padapter->securitypriv.wps_ie_len); ++ set_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS); ++ } else ++ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); ++ } ++ ++ #ifdef CONFIG_P2P ++ {/* check p2p_ie for assoc req; */ ++ uint p2p_ielen = 0; ++ u8 *p2p_ie; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ p2p_ie = rtw_get_p2p_ie(buf, ielen, NULL, &p2p_ielen); ++ if (p2p_ie) { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s p2p_assoc_req_ielen=%d\n", __FUNCTION__, p2p_ielen); ++ #endif ++ ++ if (pmlmepriv->p2p_assoc_req_ie) { ++ u32 free_len = pmlmepriv->p2p_assoc_req_ie_len; ++ pmlmepriv->p2p_assoc_req_ie_len = 0; ++ rtw_mfree(pmlmepriv->p2p_assoc_req_ie, free_len); ++ pmlmepriv->p2p_assoc_req_ie = NULL; ++ } ++ ++ pmlmepriv->p2p_assoc_req_ie = rtw_malloc(p2p_ielen); ++ if (pmlmepriv->p2p_assoc_req_ie == NULL) { ++ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ goto exit; ++ } ++ _rtw_memcpy(pmlmepriv->p2p_assoc_req_ie, p2p_ie, p2p_ielen); ++ pmlmepriv->p2p_assoc_req_ie_len = p2p_ielen; ++ } ++ } ++ #endif /* CONFIG_P2P */ ++ ++ #ifdef CONFIG_WFD ++ { ++ uint wfd_ielen = 0; ++ u8 *wfd_ie; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ wfd_ie = rtw_get_wfd_ie(buf, ielen, NULL, &wfd_ielen); ++ if (wfd_ie) { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s wfd_assoc_req_ielen=%d\n", __FUNCTION__, wfd_ielen); ++ #endif ++ ++ if (rtw_mlme_update_wfd_ie_data(pmlmepriv, MLME_ASSOC_REQ_IE, wfd_ie, wfd_ielen) != _SUCCESS) ++ goto exit; ++ } ++ } ++ #endif /* CONFIG_WFD */ ++ ++ /* TKIP and AES disallow multicast packets until installing group key */ ++ if (padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_ ++ || padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_ ++ || padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) ++ /* WPS open need to enable multicast */ ++ /* || check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == _TRUE) */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_OFF_RCR_AM, null_addr); ++ ++ ++exit: ++ if (buf) ++ rtw_mfree(buf, ielen); ++ if (ret) ++ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); ++ ++ return ret; ++} ++ ++static int cfg80211_rtw_join_ibss(struct wiphy *wiphy, struct net_device *ndev, ++ struct cfg80211_ibss_params *params) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ NDIS_802_11_SSID ndis_ssid; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) ++ struct cfg80211_chan_def *pch_def; ++#endif ++ struct ieee80211_channel *pch; ++ int ret = 0; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) ++ pch_def = (struct cfg80211_chan_def *)(¶ms->chandef); ++ pch = (struct ieee80211_channel *) pch_def->chan; ++#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 31)) ++ pch = (struct ieee80211_channel *)(params->channel); ++#endif ++ ++ if (!params->ssid || !params->ssid_len) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (params->ssid_len > IW_ESSID_MAX_SIZE) { ++ ret = -E2BIG; ++ goto exit; ++ } ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ ret = -EPERM; ++ goto exit; ++ } ++ ++ rtw_ps_deny(padapter, PS_DENY_JOIN); ++ if (_FAIL == rtw_pwr_wakeup(padapter)) { ++ ret = -EPERM; ++ goto cancel_ps_deny; ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_LINKING)) { ++ RTW_INFO("%s, but buddy_intf is under linking\n", __FUNCTION__); ++ ret = -EINVAL; ++ goto cancel_ps_deny; ++ } ++ rtw_mi_buddy_scan_abort(padapter, _TRUE); /* OR rtw_mi_scan_abort(padapter, _TRUE);*/ ++#endif /*CONFIG_CONCURRENT_MODE*/ ++ ++ ++ _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID)); ++ ndis_ssid.SsidLength = params->ssid_len; ++ _rtw_memcpy(ndis_ssid.Ssid, (u8 *)params->ssid, params->ssid_len); ++ ++ /* RTW_INFO("ssid=%s, len=%zu\n", ndis_ssid.Ssid, params->ssid_len); */ ++ ++ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; ++ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ ++ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; ++ ++ ret = rtw_cfg80211_set_auth_type(psecuritypriv, NL80211_AUTHTYPE_OPEN_SYSTEM); ++ rtw_set_802_11_authentication_mode(padapter, psecuritypriv->ndisauthtype); ++ ++ RTW_INFO("%s: center_freq = %d\n", __func__, pch->center_freq); ++ pmlmeext->cur_channel = rtw_freq2ch(pch->center_freq); ++ ++ if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == _FALSE) { ++ ret = -1; ++ goto cancel_ps_deny; ++ } ++ ++cancel_ps_deny: ++ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); ++exit: ++ return ret; ++} ++ ++static int cfg80211_rtw_leave_ibss(struct wiphy *wiphy, struct net_device *ndev) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct wireless_dev *rtw_wdev = padapter->rtw_wdev; ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); ++ enum nl80211_iftype old_type; ++ int ret = 0; ++ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ rtw_wdev_set_not_indic_disco(pwdev_priv, 1); ++ ++ old_type = rtw_wdev->iftype; ++ ++ rtw_set_to_roam(padapter, 0); ++ ++ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { ++ rtw_scan_abort(padapter); ++ LeaveAllPowerSaveMode(padapter); ++ ++ rtw_wdev->iftype = NL80211_IFTYPE_STATION; ++ ++ if (rtw_set_802_11_infrastructure_mode(padapter, Ndis802_11Infrastructure) == _FALSE) { ++ rtw_wdev->iftype = old_type; ++ ret = -EPERM; ++ goto leave_ibss; ++ } ++ rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure, _TRUE); ++ } ++ ++leave_ibss: ++ rtw_wdev_set_not_indic_disco(pwdev_priv, 0); ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, ++ struct cfg80211_connect_params *sme) ++{ ++ int ret = 0; ++ struct wlan_network *pnetwork = NULL; ++ NDIS_802_11_AUTHENTICATION_MODE authmode; ++ NDIS_802_11_SSID ndis_ssid; ++ u8 *dst_ssid, *src_ssid; ++ u8 *dst_bssid, *src_bssid; ++ /* u8 matched_by_bssid=_FALSE; */ ++ /* u8 matched_by_ssid=_FALSE; */ ++ u8 matched = _FALSE; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ _queue *queue = &pmlmepriv->scanned_queue; ++ struct wireless_dev *pwdev = padapter->rtw_wdev; ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); ++ _irqL irqL; ++ ++ rtw_wdev_set_not_indic_disco(pwdev_priv, 1); ++ ++ RTW_INFO("=>"FUNC_NDEV_FMT" - Start to Connection\n", FUNC_NDEV_ARG(ndev)); ++ RTW_INFO("privacy=%d, key=%p, key_len=%d, key_idx=%d, auth_type=%d\n", ++ sme->privacy, sme->key, sme->key_len, sme->key_idx, sme->auth_type); ++ ++ ++ if (pwdev_priv->block == _TRUE) { ++ ret = -EBUSY; ++ RTW_INFO("%s wdev_priv.block is set\n", __FUNCTION__); ++ goto exit; ++ } ++ ++#ifdef CONFIG_PLATFORM_MSTAR_SCAN_BEFORE_CONNECT ++ printk("MStar Android!\n"); ++ if (pwdev_priv->bandroid_scan == _FALSE) { ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++#endif /* CONFIG_P2P */ ++ { ++ ret = -EBUSY; ++ printk("Android hasn't attached yet!\n"); ++ goto exit; ++ } ++ } ++#endif ++ ++ if (!sme->ssid || !sme->ssid_len) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (sme->ssid_len > IW_ESSID_MAX_SIZE) { ++ ret = -E2BIG; ++ goto exit; ++ } ++ ++ rtw_ps_deny(padapter, PS_DENY_JOIN); ++ if (_FAIL == rtw_pwr_wakeup(padapter)) { ++ ret = -EPERM; ++ goto cancel_ps_deny; ++ } ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ ret = -EPERM; ++ goto cancel_ps_deny; ++ } ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { ++ ret = -EBUSY; ++ RTW_INFO("%s, fw_state=0x%x, goto exit\n", __func__, pmlmepriv->fw_state); ++ goto cancel_ps_deny; ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_LINKING)) { ++ ret = -EINVAL; ++ goto cancel_ps_deny; ++ } ++#endif ++ ++ rtw_mi_scan_abort(padapter, _TRUE); ++ ++ _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID)); ++ ndis_ssid.SsidLength = sme->ssid_len; ++ _rtw_memcpy(ndis_ssid.Ssid, (u8 *)sme->ssid, sme->ssid_len); ++ ++ RTW_INFO("ssid=%s, len=%zu\n", ndis_ssid.Ssid, sme->ssid_len); ++ ++ ++ if (sme->bssid) ++ RTW_INFO("bssid="MAC_FMT"\n", MAC_ARG(sme->bssid)); ++ ++ ++ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; ++ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ ++ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ padapter->wapiInfo.bWapiEnable = false; ++#endif ++ ++ ret = rtw_cfg80211_set_wpa_version(psecuritypriv, sme->crypto.wpa_versions); ++ if (ret < 0) ++ goto cancel_ps_deny; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (sme->crypto.wpa_versions & NL80211_WAPI_VERSION_1) { ++ padapter->wapiInfo.bWapiEnable = true; ++ padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN; ++ padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN; ++ } ++#endif ++ ++ ret = rtw_cfg80211_set_auth_type(psecuritypriv, sme->auth_type); ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_WAPI) ++ padapter->mlmeextpriv.mlmext_info.auth_algo = psecuritypriv->dot11AuthAlgrthm; ++#endif ++ ++ ++ if (ret < 0) ++ goto cancel_ps_deny; ++ ++ RTW_INFO("%s, ie_len=%zu\n", __func__, sme->ie_len); ++ ++ ret = rtw_cfg80211_set_wpa_ie(padapter, (u8 *)sme->ie, sme->ie_len); ++ if (ret < 0) ++ goto cancel_ps_deny; ++ ++ if (sme->crypto.n_ciphers_pairwise) { ++ ret = rtw_cfg80211_set_cipher(psecuritypriv, sme->crypto.ciphers_pairwise[0], _TRUE); ++ if (ret < 0) ++ goto cancel_ps_deny; ++ } ++ ++ /* For WEP Shared auth */ ++ if (sme->key_len > 0 && sme->key) { ++ u32 wep_key_idx, wep_key_len, wep_total_len; ++ NDIS_802_11_WEP *pwep = NULL; ++ RTW_INFO("%s(): Shared/Auto WEP\n", __FUNCTION__); ++ ++ wep_key_idx = sme->key_idx; ++ wep_key_len = sme->key_len; ++ ++ if (sme->key_idx > WEP_KEYS) { ++ ret = -EINVAL; ++ goto cancel_ps_deny; ++ } ++ ++ if (wep_key_len > 0) { ++ wep_key_len = wep_key_len <= 5 ? 5 : 13; ++ wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); ++ pwep = (NDIS_802_11_WEP *) rtw_malloc(wep_total_len); ++ if (pwep == NULL) { ++ RTW_INFO(" wpa_set_encryption: pwep allocate fail !!!\n"); ++ ret = -ENOMEM; ++ goto cancel_ps_deny; ++ } ++ ++ _rtw_memset(pwep, 0, wep_total_len); ++ ++ pwep->KeyLength = wep_key_len; ++ pwep->Length = wep_total_len; ++ ++ if (wep_key_len == 13) { ++ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; ++ padapter->securitypriv.dot118021XGrpPrivacy = _WEP104_; ++ } ++ } else { ++ ret = -EINVAL; ++ goto cancel_ps_deny; ++ } ++ ++ pwep->KeyIndex = wep_key_idx; ++ pwep->KeyIndex |= 0x80000000; ++ ++ _rtw_memcpy(pwep->KeyMaterial, (void *)sme->key, pwep->KeyLength); ++ ++ if (rtw_set_802_11_add_wep(padapter, pwep) == (u8)_FAIL) ++ ret = -EOPNOTSUPP ; ++ ++ if (pwep) ++ rtw_mfree((u8 *)pwep, wep_total_len); ++ ++ if (ret < 0) ++ goto cancel_ps_deny; ++ } ++ ++ ret = rtw_cfg80211_set_cipher(psecuritypriv, sme->crypto.cipher_group, _FALSE); ++ if (ret < 0) ++ return ret; ++ ++ if (sme->crypto.n_akm_suites) { ++ ret = rtw_cfg80211_set_key_mgt(psecuritypriv, sme->crypto.akm_suites[0]); ++ if (ret < 0) ++ goto cancel_ps_deny; ++ } ++#ifdef CONFIG_8011R ++ else { ++ /*It could be a connection without RSN IEs*/ ++ psecuritypriv->rsn_akm_suite_type = 0; ++ } ++#endif ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (sme->crypto.akm_suites[0] == WLAN_AKM_SUITE_WAPI_PSK) ++ padapter->wapiInfo.bWapiPSK = true; ++ else if (sme->crypto.akm_suites[0] == WLAN_AKM_SUITE_WAPI_CERT) ++ padapter->wapiInfo.bWapiPSK = false; ++#endif ++ ++ authmode = psecuritypriv->ndisauthtype; ++ rtw_set_802_11_authentication_mode(padapter, authmode); ++ ++ /* rtw_set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); */ ++ ++ if (rtw_set_802_11_connect(padapter, (u8 *)sme->bssid, &ndis_ssid) == _FALSE) { ++ ret = -1; ++ goto cancel_ps_deny; ++ } ++ ++ ++ _enter_critical_bh(&pwdev_priv->connect_req_lock, &irqL); ++ ++ if (pwdev_priv->connect_req) { ++ rtw_wdev_free_connect_req(pwdev_priv); ++ RTW_INFO(FUNC_NDEV_FMT" free existing connect_req\n", FUNC_NDEV_ARG(ndev)); ++ } ++ ++ pwdev_priv->connect_req = (struct cfg80211_connect_params *)rtw_malloc(sizeof(*pwdev_priv->connect_req)); ++ if (pwdev_priv->connect_req) ++ _rtw_memcpy(pwdev_priv->connect_req, sme, sizeof(*pwdev_priv->connect_req)); ++ else ++ RTW_WARN(FUNC_NDEV_FMT" alloc connect_req fail\n", FUNC_NDEV_ARG(ndev)); ++ ++ _exit_critical_bh(&pwdev_priv->connect_req_lock, &irqL); ++ ++ RTW_INFO("set ssid:dot11AuthAlgrthm=%d, dot11PrivacyAlgrthm=%d, dot118021XGrpPrivacy=%d\n", psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, ++ psecuritypriv->dot118021XGrpPrivacy); ++ ++cancel_ps_deny: ++ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); ++ ++exit: ++ RTW_INFO("<=%s, ret %d\n", __FUNCTION__, ret); ++ ++ rtw_wdev_set_not_indic_disco(pwdev_priv, 0); ++ ++ return ret; ++} ++ ++static int cfg80211_rtw_disconnect(struct wiphy *wiphy, struct net_device *ndev, ++ u16 reason_code) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); ++ ++ RTW_INFO(FUNC_NDEV_FMT" - Start to Disconnect\n", FUNC_NDEV_ARG(ndev)); ++ ++ rtw_wdev_set_not_indic_disco(pwdev_priv, 1); ++ ++ rtw_set_to_roam(padapter, 0); ++ ++ /* if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)) */ ++ { ++ rtw_scan_abort(padapter); ++ LeaveAllPowerSaveMode(padapter); ++ rtw_disassoc_cmd(padapter, 500, _FALSE); ++ rtw_sta_mstatus_report(padapter); ++ ++ RTW_INFO("%s...call rtw_indicate_disconnect\n", __func__); ++ ++ rtw_free_assoc_resources(padapter, 1); ++ rtw_indicate_disconnect(padapter, 0, _TRUE); ++ ++ rtw_pwr_wakeup(padapter); ++ } ++ ++ rtw_wdev_set_not_indic_disco(pwdev_priv, 0); ++ ++ RTW_INFO(FUNC_NDEV_FMT" return 0\n", FUNC_NDEV_ARG(ndev)); ++ return 0; ++} ++ ++static int cfg80211_rtw_set_txpower(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) ++ struct wireless_dev *wdev, ++#endif ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) || defined(COMPAT_KERNEL_RELEASE) ++ enum nl80211_tx_power_setting type, int mbm) ++#else ++ enum tx_power_setting type, int dbm) ++#endif ++{ ++#if 0 ++ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); ++ int ret; ++ ++ switch (type) { ++ case NL80211_TX_POWER_AUTOMATIC: ++ return 0; ++ case NL80211_TX_POWER_FIXED: ++ if (mbm < 0 || (mbm % 100)) ++ return -EOPNOTSUPP; ++ ++ if (!test_bit(IWM_STATUS_READY, &iwm->status)) ++ return 0; ++ ++ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_CFG_FIX, ++ CFG_TX_PWR_LIMIT_USR, ++ MBM_TO_DBM(mbm) * 2); ++ if (ret < 0) ++ return ret; ++ ++ return iwm_tx_power_trigger(iwm); ++ default: ++ IWM_ERR(iwm, "Unsupported power type: %d\n", type); ++ return -EOPNOTSUPP; ++ } ++#endif ++ RTW_INFO("%s\n", __func__); ++ return 0; ++} ++ ++static int cfg80211_rtw_get_txpower(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) ++ struct wireless_dev *wdev, ++#endif ++ int *dbm) ++{ ++ RTW_INFO("%s\n", __func__); ++ ++ *dbm = (12); ++ ++ return 0; ++} ++ ++inline bool rtw_cfg80211_pwr_mgmt(_adapter *adapter) ++{ ++ struct rtw_wdev_priv *rtw_wdev_priv = adapter_wdev_data(adapter); ++ return rtw_wdev_priv->power_mgmt; ++} ++ ++static int cfg80211_rtw_set_power_mgmt(struct wiphy *wiphy, ++ struct net_device *ndev, ++ bool enabled, int timeout) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct rtw_wdev_priv *rtw_wdev_priv = adapter_wdev_data(padapter); ++ ++ RTW_INFO(FUNC_NDEV_FMT" enabled:%u, timeout:%d\n", FUNC_NDEV_ARG(ndev), ++ enabled, timeout); ++ ++ rtw_wdev_priv->power_mgmt = enabled; ++ ++#ifdef CONFIG_LPS ++ if (!enabled) ++ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE_CFG80211_PWRMGMT, 1); ++#endif ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_set_pmksa(struct wiphy *wiphy, ++ struct net_device *ndev, ++ struct cfg80211_pmksa *pmksa) ++{ ++ u8 index, blInserted = _FALSE; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct mlme_priv *mlme = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ u8 strZeroMacAddress[ETH_ALEN] = { 0x00 }; ++ ++ RTW_INFO(FUNC_NDEV_FMT" "MAC_FMT" "KEY_FMT"\n", FUNC_NDEV_ARG(ndev) ++ , MAC_ARG(pmksa->bssid), KEY_ARG(pmksa->pmkid)); ++ ++ if (_rtw_memcmp((u8 *)pmksa->bssid, strZeroMacAddress, ETH_ALEN) == _TRUE) ++ return -EINVAL; ++ ++ if (check_fwstate(mlme, _FW_LINKED) == _FALSE) { ++ RTW_INFO(FUNC_NDEV_FMT" not set pmksa cause not in linked state\n", FUNC_NDEV_ARG(ndev)); ++ return -EINVAL; ++ } ++ ++ blInserted = _FALSE; ++ ++ /* overwrite PMKID */ ++ for (index = 0 ; index < NUM_PMKID_CACHE; index++) { ++ if (_rtw_memcmp(psecuritypriv->PMKIDList[index].Bssid, (u8 *)pmksa->bssid, ETH_ALEN) == _TRUE) { ++ /* BSSID is matched, the same AP => rewrite with new PMKID. */ ++ RTW_INFO(FUNC_NDEV_FMT" BSSID exists in the PMKList.\n", FUNC_NDEV_ARG(ndev)); ++ ++ _rtw_memcpy(psecuritypriv->PMKIDList[index].PMKID, (u8 *)pmksa->pmkid, WLAN_PMKID_LEN); ++ psecuritypriv->PMKIDList[index].bUsed = _TRUE; ++ psecuritypriv->PMKIDIndex = index + 1; ++ blInserted = _TRUE; ++ break; ++ } ++ } ++ ++ if (!blInserted) { ++ /* Find a new entry */ ++ RTW_INFO(FUNC_NDEV_FMT" Use the new entry index = %d for this PMKID.\n", ++ FUNC_NDEV_ARG(ndev), psecuritypriv->PMKIDIndex); ++ ++ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, (u8 *)pmksa->bssid, ETH_ALEN); ++ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, (u8 *)pmksa->pmkid, WLAN_PMKID_LEN); ++ ++ psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].bUsed = _TRUE; ++ psecuritypriv->PMKIDIndex++ ; ++ if (psecuritypriv->PMKIDIndex == 16) ++ psecuritypriv->PMKIDIndex = 0; ++ } ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_del_pmksa(struct wiphy *wiphy, ++ struct net_device *ndev, ++ struct cfg80211_pmksa *pmksa) ++{ ++ u8 index, bMatched = _FALSE; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++ RTW_INFO(FUNC_NDEV_FMT" "MAC_FMT" "KEY_FMT"\n", FUNC_NDEV_ARG(ndev) ++ , MAC_ARG(pmksa->bssid), KEY_ARG(pmksa->pmkid)); ++ ++ for (index = 0 ; index < NUM_PMKID_CACHE; index++) { ++ if (_rtw_memcmp(psecuritypriv->PMKIDList[index].Bssid, (u8 *)pmksa->bssid, ETH_ALEN) == _TRUE) { ++ /* BSSID is matched, the same AP => Remove this PMKID information and reset it. */ ++ _rtw_memset(psecuritypriv->PMKIDList[index].Bssid, 0x00, ETH_ALEN); ++ _rtw_memset(psecuritypriv->PMKIDList[index].PMKID, 0x00, WLAN_PMKID_LEN); ++ psecuritypriv->PMKIDList[index].bUsed = _FALSE; ++ bMatched = _TRUE; ++ RTW_INFO(FUNC_NDEV_FMT" clear id:%hhu\n", FUNC_NDEV_ARG(ndev), index); ++ break; ++ } ++ } ++ ++ if (_FALSE == bMatched) { ++ RTW_INFO(FUNC_NDEV_FMT" do not have matched BSSID\n" ++ , FUNC_NDEV_ARG(ndev)); ++ return -EINVAL; ++ } ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_flush_pmksa(struct wiphy *wiphy, ++ struct net_device *ndev) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ _rtw_memset(&psecuritypriv->PMKIDList[0], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); ++ psecuritypriv->PMKIDIndex = 0; ++ ++ return 0; ++} ++ ++#ifdef CONFIG_AP_MODE ++void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint frame_len) ++{ ++ s32 freq; ++ int channel; ++ struct wireless_dev *pwdev = padapter->rtw_wdev; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct net_device *ndev = padapter->pnetdev; ++ ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ ++#if defined(RTW_USE_CFG80211_STA_EVENT) || defined(COMPAT_KERNEL_RELEASE) ++ { ++ struct station_info sinfo; ++ u8 ie_offset; ++ if (GetFrameSubType(pmgmt_frame) == WIFI_ASSOCREQ) ++ ie_offset = _ASOCREQ_IE_OFFSET_; ++ else /* WIFI_REASSOCREQ */ ++ ie_offset = _REASOCREQ_IE_OFFSET_; ++ ++ memset(&sinfo, 0, sizeof(sinfo)); ++ sinfo.filled = STATION_INFO_ASSOC_REQ_IES; ++ sinfo.assoc_req_ies = pmgmt_frame + WLAN_HDR_A3_LEN + ie_offset; ++ sinfo.assoc_req_ies_len = frame_len - WLAN_HDR_A3_LEN - ie_offset; ++ cfg80211_new_sta(ndev, GetAddr2Ptr(pmgmt_frame), &sinfo, GFP_ATOMIC); ++ } ++#else /* defined(RTW_USE_CFG80211_STA_EVENT) */ ++ channel = pmlmeext->cur_channel; ++ freq = rtw_ch2freq(channel); ++ ++ #ifdef COMPAT_KERNEL_RELEASE ++ rtw_cfg80211_rx_mgmt(pwdev, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); ++ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) ++ rtw_cfg80211_rx_mgmt(pwdev, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); ++ #else /* COMPAT_KERNEL_RELEASE */ ++ { ++ /* to avoid WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION) when calling cfg80211_send_rx_assoc() */ ++ #ifndef CONFIG_PLATFORM_MSTAR ++ pwdev->iftype = NL80211_IFTYPE_STATION; ++ #endif /* CONFIG_PLATFORM_MSTAR */ ++ RTW_INFO("iftype=%d before call cfg80211_send_rx_assoc()\n", pwdev->iftype); ++ rtw_cfg80211_send_rx_assoc(padapter, NULL, pmgmt_frame, frame_len); ++ RTW_INFO("iftype=%d after call cfg80211_send_rx_assoc()\n", pwdev->iftype); ++ pwdev->iftype = NL80211_IFTYPE_AP; ++ /* cfg80211_rx_action(padapter->pnetdev, freq, pmgmt_frame, frame_len, GFP_ATOMIC); */ ++ } ++ #endif /* COMPAT_KERNEL_RELEASE */ ++#endif /* defined(RTW_USE_CFG80211_STA_EVENT) */ ++ ++} ++ ++void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, unsigned short reason) ++{ ++ s32 freq; ++ int channel; ++ u8 *pmgmt_frame; ++ uint frame_len; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ u8 mgmt_buf[128] = {0}; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct wireless_dev *wdev = padapter->rtw_wdev; ++ struct net_device *ndev = padapter->pnetdev; ++ ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ ++#if defined(RTW_USE_CFG80211_STA_EVENT) || defined(COMPAT_KERNEL_RELEASE) ++ cfg80211_del_sta(ndev, da, GFP_ATOMIC); ++#else /* defined(RTW_USE_CFG80211_STA_EVENT) */ ++ channel = pmlmeext->cur_channel; ++ freq = rtw_ch2freq(channel); ++ ++ pmgmt_frame = mgmt_buf; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pmgmt_frame; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, da, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pmgmt_frame, WIFI_DEAUTH); ++ ++ pmgmt_frame += sizeof(struct rtw_ieee80211_hdr_3addr); ++ frame_len = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ reason = cpu_to_le16(reason); ++ pmgmt_frame = rtw_set_fixed_ie(pmgmt_frame, _RSON_CODE_ , (unsigned char *)&reason, &frame_len); ++ ++ #ifdef COMPAT_KERNEL_RELEASE ++ rtw_cfg80211_rx_mgmt(wdev, freq, 0, mgmt_buf, frame_len, GFP_ATOMIC); ++ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) ++ rtw_cfg80211_rx_mgmt(wdev, freq, 0, mgmt_buf, frame_len, GFP_ATOMIC); ++ #else /* COMPAT_KERNEL_RELEASE */ ++ cfg80211_send_disassoc(padapter->pnetdev, mgmt_buf, frame_len); ++ /* cfg80211_rx_action(padapter->pnetdev, freq, mgmt_buf, frame_len, GFP_ATOMIC); */ ++ #endif /* COMPAT_KERNEL_RELEASE */ ++#endif /* defined(RTW_USE_CFG80211_STA_EVENT) */ ++} ++ ++static int rtw_cfg80211_monitor_if_open(struct net_device *ndev) ++{ ++ int ret = 0; ++ ++ RTW_INFO("%s\n", __func__); ++ ++ return ret; ++} ++ ++static int rtw_cfg80211_monitor_if_close(struct net_device *ndev) ++{ ++ int ret = 0; ++ ++ RTW_INFO("%s\n", __func__); ++ ++ return ret; ++} ++ ++static int rtw_cfg80211_monitor_if_xmit_entry(struct sk_buff *skb, struct net_device *ndev) ++{ ++ int ret = 0; ++ int rtap_len; ++ int qos_len = 0; ++ int dot11_hdr_len = 24; ++ int snap_len = 6; ++ unsigned char *pdata; ++ u16 frame_ctl; ++ unsigned char src_mac_addr[6]; ++ unsigned char dst_mac_addr[6]; ++ struct rtw_ieee80211_hdr *dot11_hdr; ++ struct ieee80211_radiotap_header *rtap_hdr; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ if (skb) ++ rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, skb->truesize); ++ ++ if (unlikely(skb->len < sizeof(struct ieee80211_radiotap_header))) ++ goto fail; ++ ++ rtap_hdr = (struct ieee80211_radiotap_header *)skb->data; ++ if (unlikely(rtap_hdr->it_version)) ++ goto fail; ++ ++ rtap_len = ieee80211_get_radiotap_len(skb->data); ++ if (unlikely(skb->len < rtap_len)) ++ goto fail; ++ ++ if (rtap_len != 14) { ++ RTW_INFO("radiotap len (should be 14): %d\n", rtap_len); ++ goto fail; ++ } ++ ++ /* Skip the ratio tap header */ ++ skb_pull(skb, rtap_len); ++ ++ dot11_hdr = (struct rtw_ieee80211_hdr *)skb->data; ++ frame_ctl = le16_to_cpu(dot11_hdr->frame_ctl); ++ /* Check if the QoS bit is set */ ++ if ((frame_ctl & RTW_IEEE80211_FCTL_FTYPE) == RTW_IEEE80211_FTYPE_DATA) { ++ /* Check if this ia a Wireless Distribution System (WDS) frame ++ * which has 4 MAC addresses ++ */ ++ if (dot11_hdr->frame_ctl & 0x0080) ++ qos_len = 2; ++ if ((dot11_hdr->frame_ctl & 0x0300) == 0x0300) ++ dot11_hdr_len += 6; ++ ++ memcpy(dst_mac_addr, dot11_hdr->addr1, sizeof(dst_mac_addr)); ++ memcpy(src_mac_addr, dot11_hdr->addr2, sizeof(src_mac_addr)); ++ ++ /* Skip the 802.11 header, QoS (if any) and SNAP, but leave spaces for ++ * for two MAC addresses ++ */ ++ skb_pull(skb, dot11_hdr_len + qos_len + snap_len - sizeof(src_mac_addr) * 2); ++ pdata = (unsigned char *)skb->data; ++ memcpy(pdata, dst_mac_addr, sizeof(dst_mac_addr)); ++ memcpy(pdata + sizeof(dst_mac_addr), src_mac_addr, sizeof(src_mac_addr)); ++ ++ RTW_INFO("should be eapol packet\n"); ++ ++ /* Use the real net device to transmit the packet */ ++ ret = _rtw_xmit_entry(skb, padapter->pnetdev); ++ ++ return ret; ++ ++ } else if ((frame_ctl & (RTW_IEEE80211_FCTL_FTYPE | RTW_IEEE80211_FCTL_STYPE)) ++ == (RTW_IEEE80211_FTYPE_MGMT | RTW_IEEE80211_STYPE_ACTION) ++ ) { ++ /* only for action frames */ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ /* u8 category, action, OUI_Subtype, dialogToken=0; */ ++ /* unsigned char *frame_body; */ ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ u8 *buf = skb->data; ++ u32 len = skb->len; ++ u8 category, action; ++ int type = -1; ++ ++ if (rtw_action_frame_parse(buf, len, &category, &action) == _FALSE) { ++ RTW_INFO(FUNC_NDEV_FMT" frame_control:0x%x\n", FUNC_NDEV_ARG(ndev), ++ le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl)); ++ goto fail; ++ } ++ ++ RTW_INFO("RTW_Tx:da="MAC_FMT" via "FUNC_NDEV_FMT"\n", ++ MAC_ARG(GetAddr1Ptr(buf)), FUNC_NDEV_ARG(ndev)); ++ #ifdef CONFIG_P2P ++ type = rtw_p2p_check_frames(padapter, buf, len, _TRUE); ++ if (type >= 0) ++ goto dump; ++ #endif ++ if (category == RTW_WLAN_CATEGORY_PUBLIC) ++ RTW_INFO("RTW_Tx:%s\n", action_public_str(action)); ++ else ++ RTW_INFO("RTW_Tx:category(%u), action(%u)\n", category, action); ++ ++dump: ++ /* starting alloc mgmt frame to dump it */ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ goto fail; ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ pattrib->retry_ctrl = _FALSE; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ _rtw_memcpy(pframe, (void *)buf, len); ++ pattrib->pktlen = len; ++ ++#ifdef CONFIG_P2P ++ if (type >= 0) ++ rtw_xframe_chk_wfd_ie(pmgntframe); ++#endif /* CONFIG_P2P */ ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ /* update seq number */ ++ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); ++ pattrib->seqnum = pmlmeext->mgnt_seq; ++ pmlmeext->mgnt_seq++; ++ ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ } else ++ RTW_INFO("frame_ctl=0x%x\n", frame_ctl & (RTW_IEEE80211_FCTL_FTYPE | RTW_IEEE80211_FCTL_STYPE)); ++ ++ ++fail: ++ ++ rtw_skb_free(skb); ++ ++ return 0; ++ ++} ++ ++static void rtw_cfg80211_monitor_if_set_multicast_list(struct net_device *ndev) ++{ ++ RTW_INFO("%s\n", __func__); ++} ++ ++static int rtw_cfg80211_monitor_if_set_mac_address(struct net_device *ndev, void *addr) ++{ ++ int ret = 0; ++ ++ RTW_INFO("%s\n", __func__); ++ ++ return ret; ++} ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) ++static const struct net_device_ops rtw_cfg80211_monitor_if_ops = { ++ .ndo_open = rtw_cfg80211_monitor_if_open, ++ .ndo_stop = rtw_cfg80211_monitor_if_close, ++ .ndo_start_xmit = rtw_cfg80211_monitor_if_xmit_entry, ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 2, 0)) ++ .ndo_set_multicast_list = rtw_cfg80211_monitor_if_set_multicast_list, ++ #endif ++ .ndo_set_mac_address = rtw_cfg80211_monitor_if_set_mac_address, ++}; ++#endif ++ ++static int rtw_cfg80211_add_monitor_if(_adapter *padapter, char *name, struct net_device **ndev) ++{ ++ int ret = 0; ++ struct net_device *mon_ndev = NULL; ++ struct wireless_dev *mon_wdev = NULL; ++ struct rtw_netdev_priv_indicator *pnpi; ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); ++ ++ if (!name) { ++ RTW_INFO(FUNC_ADPT_FMT" without specific name\n", FUNC_ADPT_ARG(padapter)); ++ ret = -EINVAL; ++ goto out; ++ } ++ ++ if (pwdev_priv->pmon_ndev) { ++ RTW_INFO(FUNC_ADPT_FMT" monitor interface exist: "NDEV_FMT"\n", ++ FUNC_ADPT_ARG(padapter), NDEV_ARG(pwdev_priv->pmon_ndev)); ++ ret = -EBUSY; ++ goto out; ++ } ++ ++ mon_ndev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); ++ if (!mon_ndev) { ++ RTW_INFO(FUNC_ADPT_FMT" allocate ndev fail\n", FUNC_ADPT_ARG(padapter)); ++ ret = -ENOMEM; ++ goto out; ++ } ++ ++ mon_ndev->type = ARPHRD_IEEE80211_RADIOTAP; ++ strncpy(mon_ndev->name, name, IFNAMSIZ); ++ mon_ndev->name[IFNAMSIZ - 1] = 0; ++ mon_ndev->priv_destructor = rtw_ndev_destructor; ++ mon_ndev->needs_free_netdev = true; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) ++ mon_ndev->netdev_ops = &rtw_cfg80211_monitor_if_ops; ++#else ++ mon_ndev->open = rtw_cfg80211_monitor_if_open; ++ mon_ndev->stop = rtw_cfg80211_monitor_if_close; ++ mon_ndev->hard_start_xmit = rtw_cfg80211_monitor_if_xmit_entry; ++ mon_ndev->set_mac_address = rtw_cfg80211_monitor_if_set_mac_address; ++#endif ++ ++ pnpi = netdev_priv(mon_ndev); ++ pnpi->priv = padapter; ++ pnpi->sizeof_priv = sizeof(_adapter); ++ ++ /* wdev */ ++ mon_wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); ++ if (!mon_wdev) { ++ RTW_INFO(FUNC_ADPT_FMT" allocate mon_wdev fail\n", FUNC_ADPT_ARG(padapter)); ++ ret = -ENOMEM; ++ goto out; ++ } ++ ++ mon_wdev->wiphy = padapter->rtw_wdev->wiphy; ++ mon_wdev->netdev = mon_ndev; ++ mon_wdev->iftype = NL80211_IFTYPE_MONITOR; ++ mon_ndev->ieee80211_ptr = mon_wdev; ++ ++ ret = register_netdevice(mon_ndev); ++ if (ret) ++ goto out; ++ ++ *ndev = pwdev_priv->pmon_ndev = mon_ndev; ++ _rtw_memcpy(pwdev_priv->ifname_mon, name, IFNAMSIZ + 1); ++ ++out: ++ if (ret && mon_wdev) { ++ rtw_mfree((u8 *)mon_wdev, sizeof(struct wireless_dev)); ++ mon_wdev = NULL; ++ } ++ ++ if (ret && mon_ndev) { ++ free_netdev(mon_ndev); ++ *ndev = mon_ndev = NULL; ++ } ++ ++ return ret; ++} ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++static struct wireless_dev * ++#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) ++static struct net_device * ++#else ++static int ++#endif ++ cfg80211_rtw_add_virtual_intf( ++ struct wiphy *wiphy, ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 7, 0)) ++ const char *name, ++ #else ++ char *name, ++ #endif ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) ++ unsigned char name_assign_type, ++ #endif ++ enum nl80211_iftype type, struct vif_params *params) ++{ ++ int ret = 0; ++ struct wireless_dev *wdev = NULL; ++ struct net_device *ndev = NULL; ++ _adapter *padapter; ++ struct dvobj_priv *dvobj = wiphy_to_dvobj(wiphy); ++ ++ rtw_set_rtnl_lock_holder(dvobj, current); ++ ++ RTW_INFO(FUNC_WIPHY_FMT" name:%s, type:%d\n", FUNC_WIPHY_ARG(wiphy), name, type); ++ ++ switch (type) { ++ case NL80211_IFTYPE_MONITOR: ++ padapter = wiphy_to_adapter(wiphy); /* TODO: get ap iface ? */ ++ ret = rtw_cfg80211_add_monitor_if(padapter, (char *)name, &ndev); ++ if (ret == 0) ++ wdev = ndev->ieee80211_ptr; ++ break; ++ ++#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) ++ case NL80211_IFTYPE_P2P_CLIENT: ++ case NL80211_IFTYPE_P2P_GO: ++#endif ++ case NL80211_IFTYPE_STATION: ++ case NL80211_IFTYPE_AP: ++ padapter = dvobj_get_unregisterd_adapter(dvobj); ++ if (!padapter) { ++ RTW_WARN("adapter pool empty!\n"); ++ ret = -ENODEV; ++ break; ++ } ++ if (rtw_os_ndev_init(padapter, name) != _SUCCESS) { ++ RTW_WARN("ndev init fail!\n"); ++ ret = -ENODEV; ++ break; ++ } ++ #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) ++ if (type == NL80211_IFTYPE_P2P_CLIENT || type == NL80211_IFTYPE_P2P_GO) ++ rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); ++ #endif ++ ndev = padapter->pnetdev; ++ wdev = ndev->ieee80211_ptr; ++ break; ++ ++#if defined(CONFIG_P2P) && defined(RTW_DEDICATED_P2P_DEVICE) ++ case NL80211_IFTYPE_P2P_DEVICE: ++ ret = rtw_pd_iface_alloc(wiphy, name, &wdev); ++ break; ++#endif ++ ++ case NL80211_IFTYPE_ADHOC: ++ case NL80211_IFTYPE_AP_VLAN: ++ case NL80211_IFTYPE_WDS: ++ case NL80211_IFTYPE_MESH_POINT: ++ default: ++ ret = -ENODEV; ++ RTW_INFO("Unsupported interface type\n"); ++ break; ++ } ++ ++ if (ndev) ++ RTW_INFO(FUNC_WIPHY_FMT" ndev:%p, ret:%d\n", FUNC_WIPHY_ARG(wiphy), ndev, ret); ++ else ++ RTW_INFO(FUNC_WIPHY_FMT" wdev:%p, ret:%d\n", FUNC_WIPHY_ARG(wiphy), wdev, ret); ++ ++ rtw_set_rtnl_lock_holder(dvobj, NULL); ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ return wdev ? wdev : ERR_PTR(ret); ++#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) ++ return ndev ? ndev : ERR_PTR(ret); ++#else ++ return ret; ++#endif ++} ++ ++static int cfg80211_rtw_del_virtual_intf(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ struct wireless_dev *wdev ++#else ++ struct net_device *ndev ++#endif ++) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ struct net_device *ndev = wdev_to_ndev(wdev); ++#endif ++ int ret = 0; ++ struct dvobj_priv *dvobj = wiphy_to_dvobj(wiphy); ++ _adapter *adapter; ++ struct rtw_wdev_priv *pwdev_priv; ++ ++ rtw_set_rtnl_lock_holder(dvobj, current); ++ ++ if (ndev) { ++ adapter = (_adapter *)rtw_netdev_priv(ndev); ++ pwdev_priv = adapter_wdev_data(adapter); ++ ++ if (ndev == pwdev_priv->pmon_ndev) { ++ unregister_netdevice(ndev); ++ pwdev_priv->pmon_ndev = NULL; ++ pwdev_priv->ifname_mon[0] = '\0'; ++ RTW_INFO(FUNC_NDEV_FMT" remove monitor ndev\n", FUNC_NDEV_ARG(ndev)); ++ } else { ++ RTW_INFO(FUNC_NDEV_FMT" unregister ndev\n", FUNC_NDEV_ARG(ndev)); ++ rtw_os_ndev_unregister(adapter); ++ } ++ } else ++#if defined(CONFIG_P2P) && defined(RTW_DEDICATED_P2P_DEVICE) ++ if (wdev->iftype == NL80211_IFTYPE_P2P_DEVICE) { ++ if (wdev == wiphy_to_pd_wdev(wiphy)) ++ rtw_pd_iface_free(wiphy); ++ else { ++ RTW_ERR(FUNC_WIPHY_FMT" unknown P2P Device wdev:%p\n", FUNC_WIPHY_ARG(wiphy), wdev); ++ rtw_warn_on(1); ++ } ++ } else ++#endif ++ { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++exit: ++ rtw_set_rtnl_lock_holder(dvobj, NULL); ++ return ret; ++} ++ ++static int rtw_add_beacon(_adapter *adapter, const u8 *head, size_t head_len, const u8 *tail, size_t tail_len) ++{ ++ int ret = 0; ++ u8 *pbuf = NULL; ++ uint len, wps_ielen = 0; ++ uint p2p_ielen = 0; ++ u8 *p2p_ie; ++ u8 got_p2p_ie = _FALSE; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ /* struct sta_priv *pstapriv = &padapter->stapriv; */ ++ ++ ++ RTW_INFO("%s beacon_head_len=%zu, beacon_tail_len=%zu\n", __FUNCTION__, head_len, tail_len); ++ ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ return -EINVAL; ++ ++ if (head_len < 24) ++ return -EINVAL; ++ ++ ++ pbuf = rtw_zmalloc(head_len + tail_len); ++ if (!pbuf) ++ return -ENOMEM; ++ ++ ++ /* _rtw_memcpy(&pstapriv->max_num_sta, param->u.bcn_ie.reserved, 2); */ ++ ++ /* if((pstapriv->max_num_sta>NUM_STA) || (pstapriv->max_num_sta<=0)) */ ++ /* pstapriv->max_num_sta = NUM_STA; */ ++ ++ ++ _rtw_memcpy(pbuf, (void *)head + 24, head_len - 24); /* 24=beacon header len. */ ++ _rtw_memcpy(pbuf + head_len - 24, (void *)tail, tail_len); ++ ++ len = head_len + tail_len - 24; ++ ++ /* check wps ie if inclued */ ++ if (rtw_get_wps_ie(pbuf + _FIXED_IE_LENGTH_, len - _FIXED_IE_LENGTH_, NULL, &wps_ielen)) ++ RTW_INFO("add bcn, wps_ielen=%d\n", wps_ielen); ++ ++#ifdef CONFIG_P2P ++ if (adapter->wdinfo.driver_interface == DRIVER_CFG80211) { ++ /* check p2p if enable */ ++ if (rtw_get_p2p_ie(pbuf + _FIXED_IE_LENGTH_, len - _FIXED_IE_LENGTH_, NULL, &p2p_ielen)) { ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); ++ ++ RTW_INFO("got p2p_ie, len=%d\n", p2p_ielen); ++ ++ got_p2p_ie = _TRUE; ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ RTW_INFO("Enable P2P function for the first time\n"); ++ rtw_p2p_enable(adapter, P2P_ROLE_GO); ++ ++ adapter->stapriv.expire_to = 3; /* 3x2 = 6 sec in p2p mode */ ++ } else { ++ RTW_INFO("enter GO Mode, p2p_ielen=%d\n", p2p_ielen); ++ ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ pwdinfo->intent = 15; ++ } ++ } ++ } ++#endif /* CONFIG_P2P */ ++ ++ /* pbss_network->IEs will not include p2p_ie, wfd ie */ ++ rtw_ies_remove_ie(pbuf, &len, _BEACON_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, P2P_OUI, 4); ++ rtw_ies_remove_ie(pbuf, &len, _BEACON_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, WFD_OUI, 4); ++ ++ if (rtw_check_beacon_data(adapter, pbuf, len) == _SUCCESS) { ++#ifdef CONFIG_P2P ++ /* check p2p if enable */ ++ if (got_p2p_ie == _TRUE) { ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); ++ pwdinfo->operating_channel = pmlmeext->cur_channel; ++ } ++#endif /* CONFIG_P2P */ ++ ret = 0; ++ } else ++ ret = -EINVAL; ++ ++ ++ rtw_mfree(pbuf, head_len + tail_len); ++ ++ return ret; ++} ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) && !defined(COMPAT_KERNEL_RELEASE) ++static int cfg80211_rtw_add_beacon(struct wiphy *wiphy, struct net_device *ndev, ++ struct beacon_parameters *info) ++{ ++ int ret = 0; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); ++ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ret = rtw_add_beacon(adapter, info->head, info->head_len, info->tail, info->tail_len); ++ ++ return ret; ++} ++ ++static int cfg80211_rtw_set_beacon(struct wiphy *wiphy, struct net_device *ndev, ++ struct beacon_parameters *info) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); ++ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ pmlmeext->bstart_bss = _TRUE; ++ ++ cfg80211_rtw_add_beacon(wiphy, ndev, info); ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_del_beacon(struct wiphy *wiphy, struct net_device *ndev) ++{ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ return 0; ++} ++#else ++static int cfg80211_rtw_start_ap(struct wiphy *wiphy, struct net_device *ndev, ++ struct cfg80211_ap_settings *settings) ++{ ++ int ret = 0; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); ++ ++ RTW_INFO(FUNC_NDEV_FMT" hidden_ssid:%d, auth_type:%d\n", FUNC_NDEV_ARG(ndev), ++ settings->hidden_ssid, settings->auth_type); ++ ++ ret = rtw_add_beacon(adapter, settings->beacon.head, settings->beacon.head_len, ++ settings->beacon.tail, settings->beacon.tail_len); ++ ++ adapter->mlmeextpriv.mlmext_info.hidden_ssid_mode = settings->hidden_ssid; ++ ++ if (settings->ssid && settings->ssid_len) { ++ WLAN_BSSID_EX *pbss_network = &adapter->mlmepriv.cur_network.network; ++ WLAN_BSSID_EX *pbss_network_ext = &adapter->mlmeextpriv.mlmext_info.network; ++ ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" ssid:(%s,%zu), from ie:(%s,%d)\n", FUNC_ADPT_ARG(adapter), ++ settings->ssid, settings->ssid_len, ++ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength); ++ ++ _rtw_memcpy(pbss_network->Ssid.Ssid, (void *)settings->ssid, settings->ssid_len); ++ pbss_network->Ssid.SsidLength = settings->ssid_len; ++ _rtw_memcpy(pbss_network_ext->Ssid.Ssid, (void *)settings->ssid, settings->ssid_len); ++ pbss_network_ext->Ssid.SsidLength = settings->ssid_len; ++ ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), ++ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, ++ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); ++ } ++ ++ return ret; ++} ++ ++static int cfg80211_rtw_change_beacon(struct wiphy *wiphy, struct net_device *ndev, ++ struct cfg80211_beacon_data *info) ++{ ++ int ret = 0; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); ++ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ ret = rtw_add_beacon(adapter, info->head, info->head_len, info->tail, info->tail_len); ++ ++ return ret; ++} ++ ++static int cfg80211_rtw_stop_ap(struct wiphy *wiphy, struct net_device *ndev) ++{ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ return 0; ++} ++ ++#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) */ ++ ++#if CONFIG_RTW_MACADDR_ACL && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) ++static int cfg80211_rtw_set_mac_acl(struct wiphy *wiphy, struct net_device *ndev, ++ const struct cfg80211_acl_data *params) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); ++ u8 acl_mode = RTW_ACL_MODE_DISABLED; ++ int ret = -1; ++ int i; ++ ++ if (!params) { ++ RTW_WARN(FUNC_ADPT_FMT" params NULL\n", FUNC_ADPT_ARG(adapter)); ++ goto exit; ++ } ++ ++ RTW_INFO(FUNC_ADPT_FMT" acl_policy:%d, entry_num:%d\n" ++ , FUNC_ADPT_ARG(adapter), params->acl_policy, params->n_acl_entries); ++ ++ if (params->acl_policy == NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED) ++ acl_mode = RTW_ACL_MODE_ACCEPT_UNLESS_LISTED; ++ else if (params->acl_policy == NL80211_ACL_POLICY_DENY_UNLESS_LISTED) ++ acl_mode = RTW_ACL_MODE_DENY_UNLESS_LISTED; ++ ++ if (!params->n_acl_entries) { ++ if (acl_mode != RTW_ACL_MODE_DISABLED) ++ RTW_WARN(FUNC_ADPT_FMT" acl_policy:%d with no entry\n" ++ , FUNC_ADPT_ARG(adapter), params->acl_policy); ++ acl_mode = RTW_ACL_MODE_DISABLED; ++ goto exit; ++ } ++ ++ for (i = 0; i < params->n_acl_entries; i++) ++ rtw_acl_add_sta(adapter, params->mac_addrs[i].addr); ++ ++ ret = 0; ++ ++exit: ++ rtw_set_macaddr_acl(adapter, acl_mode); ++ return ret; ++} ++#endif /* CONFIG_RTW_MACADDR_ACL && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) */ ++ ++static int cfg80211_rtw_add_station(struct wiphy *wiphy, struct net_device *ndev, ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0)) ++ u8 *mac, ++#else ++ const u8 *mac, ++#endif ++ struct station_parameters *params) ++{ ++ int ret = 0; ++#ifdef CONFIG_TDLS ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta; ++#endif /* CONFIG_TDLS */ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++#ifdef CONFIG_TDLS ++ psta = rtw_get_stainfo(pstapriv, (u8 *)mac); ++ if (psta == NULL) { ++ psta = rtw_alloc_stainfo(pstapriv, (u8 *)mac); ++ if (psta == NULL) { ++ RTW_INFO("[%s] Alloc station for "MAC_FMT" fail\n", __FUNCTION__, MAC_ARG(mac)); ++ ret = -EOPNOTSUPP; ++ goto exit; ++ } ++ } ++#endif /* CONFIG_TDLS */ ++ ++exit: ++ return ret; ++} ++ ++static int cfg80211_rtw_del_station(struct wiphy *wiphy, struct net_device *ndev, ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0)) ++ u8 *mac ++#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 0)) ++ const u8 *mac ++#else ++ struct station_del_parameters *params ++#endif ++) ++{ ++ int ret = 0; ++ _irqL irqL; ++ _list *phead, *plist; ++ u8 updated = _FALSE; ++ const u8 *target_mac; ++ struct sta_info *psta = NULL; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ RTW_INFO("+"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 0)) ++ target_mac = mac; ++#else ++ target_mac = params->mac; ++#endif ++ ++ if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE) { ++ RTW_INFO("%s, fw_state != FW_LINKED|WIFI_AP_STATE\n", __func__); ++ return -EINVAL; ++ } ++ ++ ++ if (!target_mac) { ++ RTW_INFO("flush all sta, and cam_entry\n"); ++ ++ flush_all_cam_entry(padapter); /* clear CAM */ ++ ++ ret = rtw_sta_flush(padapter, _TRUE); ++ ++ return ret; ++ } ++ ++ ++ RTW_INFO("free sta macaddr =" MAC_FMT "\n", MAC_ARG(target_mac)); ++ ++ if (target_mac[0] == 0xff && target_mac[1] == 0xff && ++ target_mac[2] == 0xff && target_mac[3] == 0xff && ++ target_mac[4] == 0xff && target_mac[5] == 0xff) ++ return -EINVAL; ++ ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ /* check asoc_queue */ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ ++ plist = get_next(plist); ++ ++ if (_rtw_memcmp((u8 *)target_mac, psta->hwaddr, ETH_ALEN)) { ++ if (psta->dot8021xalg == 1 && psta->bpairwise_key_installed == _FALSE) ++ RTW_INFO("%s, sta's dot8021xalg = 1 and key_installed = _FALSE\n", __func__); ++ else { ++ RTW_INFO("free psta=%p, aid=%d\n", psta, psta->aid); ++ ++ rtw_list_delete(&psta->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ ++ /* _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); */ ++ if (check_fwstate(pmlmepriv, (WIFI_AP_STATE)) == _TRUE) ++ updated = ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_PREV_AUTH_NOT_VALID, _TRUE); ++ else ++ updated = ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); ++ /* _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); */ ++ ++ psta = NULL; ++ ++ break; ++ } ++ ++ } ++ ++ } ++ ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); ++ ++ RTW_INFO("-"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ return ret; ++ ++} ++ ++static int cfg80211_rtw_change_station(struct wiphy *wiphy, struct net_device *ndev, ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0)) ++ u8 *mac, ++#else ++ const u8 *mac, ++#endif ++ struct station_parameters *params) ++{ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ return 0; ++} ++ ++struct sta_info *rtw_sta_info_get_by_idx(const int idx, struct sta_priv *pstapriv) ++ ++{ ++ ++ _list *phead, *plist; ++ struct sta_info *psta = NULL; ++ int i = 0; ++ ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ /* check asoc_queue */ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ if (idx == i) ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ plist = get_next(plist); ++ i++; ++ } ++ return psta; ++} ++ ++static int cfg80211_rtw_dump_station(struct wiphy *wiphy, struct net_device *ndev, ++ int idx, u8 *mac, struct station_info *sinfo) ++{ ++ ++ int ret = 0; ++ _irqL irqL; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ psta = rtw_sta_info_get_by_idx(idx, pstapriv); ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ if (NULL == psta) { ++ RTW_INFO("Station is not found\n"); ++ ret = -ENOENT; ++ goto exit; ++ } ++ _rtw_memcpy(mac, psta->hwaddr, ETH_ALEN); ++ sinfo->filled = 0; ++ sinfo->filled |= STATION_INFO_SIGNAL; ++ sinfo->signal = psta->rssi; ++ ++exit: ++ return ret; ++} ++ ++static int cfg80211_rtw_change_bss(struct wiphy *wiphy, struct net_device *ndev, ++ struct bss_parameters *params) ++{ ++ u8 i; ++ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++/* ++ RTW_INFO("use_cts_prot=%d\n", params->use_cts_prot); ++ RTW_INFO("use_short_preamble=%d\n", params->use_short_preamble); ++ RTW_INFO("use_short_slot_time=%d\n", params->use_short_slot_time); ++ RTW_INFO("ap_isolate=%d\n", params->ap_isolate); ++ ++ RTW_INFO("basic_rates_len=%d\n", params->basic_rates_len); ++ for(i = 0; i < params->basic_rates_len; i++) ++ RTW_INFO("basic_rates=%d\n", params->basic_rates[i]); ++*/ ++ return 0; ++ ++} ++ ++static int cfg80211_rtw_set_channel(struct wiphy *wiphy ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ , struct net_device *ndev ++ #endif ++ , struct ieee80211_channel *chan, enum nl80211_channel_type channel_type) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++#else ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++#endif ++ int chan_target = (u8) ieee80211_frequency_to_channel(chan->center_freq); ++ int chan_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ int chan_width = CHANNEL_WIDTH_20; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++#endif ++ ++ switch (channel_type) { ++ case NL80211_CHAN_NO_HT: ++ case NL80211_CHAN_HT20: ++ chan_width = CHANNEL_WIDTH_20; ++ chan_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ case NL80211_CHAN_HT40MINUS: ++ chan_width = CHANNEL_WIDTH_40; ++ chan_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ case NL80211_CHAN_HT40PLUS: ++ chan_width = CHANNEL_WIDTH_40; ++ chan_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ break; ++ default: ++ chan_width = CHANNEL_WIDTH_20; ++ chan_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ } ++ ++ set_channel_bwmode(padapter, chan_target, chan_offset, chan_width); ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_set_monitor_channel(struct wiphy *wiphy ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) ++ , struct cfg80211_chan_def *chandef ++#else ++ , struct ieee80211_channel *chan ++ , enum nl80211_channel_type channel_type ++#endif ++) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) ++ struct ieee80211_channel *chan = chandef->chan; ++#endif ++ ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ int target_channal = chan->hw_value; ++ int target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ int target_width = CHANNEL_WIDTH_20; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("center_freq %u Mhz ch %u width %u freq1 %u freq2 %u\n" ++ , chan->center_freq ++ , chan->hw_value ++ , chandef->width ++ , chandef->center_freq1 ++ , chandef->center_freq2); ++#endif /* CONFIG_DEBUG_CFG80211 */ ++ ++ switch (chandef->width) { ++ case NL80211_CHAN_WIDTH_20_NOHT: ++ case NL80211_CHAN_WIDTH_20: ++ target_width = CHANNEL_WIDTH_20; ++ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ case NL80211_CHAN_WIDTH_40: ++ target_width = CHANNEL_WIDTH_40; ++ if (chandef->center_freq1 > chan->center_freq) ++ target_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ else ++ target_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ case NL80211_CHAN_WIDTH_80: ++ target_width = CHANNEL_WIDTH_80; ++ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ case NL80211_CHAN_WIDTH_80P80: ++ target_width = CHANNEL_WIDTH_80_80; ++ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ case NL80211_CHAN_WIDTH_160: ++ target_width = CHANNEL_WIDTH_160; ++ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) ++ case NL80211_CHAN_WIDTH_5: ++ case NL80211_CHAN_WIDTH_10: ++#endif ++ default: ++ target_width = CHANNEL_WIDTH_20; ++ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ } ++#else ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("center_freq %u Mhz ch %u channel_type %u\n" ++ , chan->center_freq ++ , chan->hw_value ++ , channel_type); ++#endif /* CONFIG_DEBUG_CFG80211 */ ++ ++ switch (channel_type) { ++ case NL80211_CHAN_NO_HT: ++ case NL80211_CHAN_HT20: ++ target_width = CHANNEL_WIDTH_20; ++ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ case NL80211_CHAN_HT40MINUS: ++ target_width = CHANNEL_WIDTH_40; ++ target_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ case NL80211_CHAN_HT40PLUS: ++ target_width = CHANNEL_WIDTH_40; ++ target_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ break; ++ default: ++ target_width = CHANNEL_WIDTH_20; ++ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ } ++#endif ++ ++ set_channel_bwmode(padapter, target_channal, target_offset, target_width); ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_auth(struct wiphy *wiphy, struct net_device *ndev, ++ struct cfg80211_auth_request *req) ++{ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_assoc(struct wiphy *wiphy, struct net_device *ndev, ++ struct cfg80211_assoc_request *req) ++{ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ return 0; ++} ++#endif /* CONFIG_AP_MODE */ ++ ++void rtw_cfg80211_rx_probe_request(_adapter *adapter, union recv_frame *rframe) ++{ ++ struct wireless_dev *wdev = adapter->rtw_wdev; ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); ++ u8 *frame = get_recvframe_data(rframe); ++ uint frame_len = rframe->u.hdr.len; ++ s32 freq; ++ u8 ch, sch = rtw_get_oper_ch(adapter); ++ ++ ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; ++ freq = rtw_ch2freq(ch); ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("RTW_Rx: probe request, ch=%d(%d)\n", ch, sch); ++#endif ++ ++ rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, frame_len, GFP_ATOMIC); ++} ++ ++void rtw_cfg80211_rx_action_p2p(_adapter *adapter, union recv_frame *rframe) ++{ ++ struct wireless_dev *wdev = adapter->rtw_wdev; ++ u8 *frame = get_recvframe_data(rframe); ++ uint frame_len = rframe->u.hdr.len; ++ s32 freq; ++ u8 ch, sch = rtw_get_oper_ch(adapter); ++ u8 category, action; ++ int type; ++ ++ ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; ++ freq = rtw_ch2freq(ch); ++ ++ RTW_INFO("RTW_Rx:ch=%d(%d)\n", ch, sch); ++#ifdef CONFIG_P2P ++ type = rtw_p2p_check_frames(adapter, frame, frame_len, _FALSE); ++ if (type >= 0) ++ goto indicate; ++#endif ++ rtw_action_frame_parse(frame, frame_len, &category, &action); ++ RTW_INFO("RTW_Rx:category(%u), action(%u)\n", category, action); ++ ++indicate: ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++ rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, frame_len, GFP_ATOMIC); ++#else ++ cfg80211_rx_action(adapter->pnetdev, freq, frame, frame_len, GFP_ATOMIC); ++#endif ++} ++ ++void rtw_cfg80211_rx_p2p_action_public(_adapter *adapter, union recv_frame *rframe) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct wireless_dev *wdev = adapter->rtw_wdev; ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); ++ u8 *frame = get_recvframe_data(rframe); ++ uint frame_len = rframe->u.hdr.len; ++ s32 freq; ++ u8 ch, sch = rtw_get_oper_ch(adapter); ++ u8 category, action; ++ int type; ++ ++ ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; ++ freq = rtw_ch2freq(ch); ++ ++ RTW_INFO("RTW_Rx:ch=%d(%d)\n", ch, sch); ++ #ifdef CONFIG_P2P ++ type = rtw_p2p_check_frames(adapter, frame, frame_len, _FALSE); ++ if (type >= 0) { ++ switch (type) { ++ case P2P_GO_NEGO_CONF: ++ if (0) { ++ RTW_INFO(FUNC_ADPT_FMT" Nego confirm. state=%u, status=%u, iaddr="MAC_FMT"\n" ++ , FUNC_ADPT_ARG(adapter), pwdev_priv->nego_info.state, pwdev_priv->nego_info.status ++ , MAC_ARG(pwdev_priv->nego_info.iface_addr)); ++ } ++ if (pwdev_priv->nego_info.state == 2 ++ && pwdev_priv->nego_info.status == 0 ++ && rtw_check_invalid_mac_address(pwdev_priv->nego_info.iface_addr, _FALSE) == _FALSE ++ ) { ++ _adapter *intended_iface = dvobj_get_adapter_by_addr(dvobj, pwdev_priv->nego_info.iface_addr); ++ ++ if (intended_iface) { ++ RTW_INFO(FUNC_ADPT_FMT" Nego confirm. Allow only "ADPT_FMT" to scan for 2000 ms\n" ++ , FUNC_ADPT_ARG(adapter), ADPT_ARG(intended_iface)); ++ /* allow only intended_iface to do scan for 2000 ms */ ++ rtw_mi_set_scan_deny(adapter, 2000); ++ rtw_clear_scan_deny(intended_iface); ++ } ++ } ++ break; ++ case P2P_PROVISION_DISC_RESP: ++ case P2P_INVIT_RESP: ++ #if !RTW_P2P_GROUP_INTERFACE ++ rtw_mi_buddy_set_scan_deny(adapter, 2000); ++ #endif ++ break; ++ } ++ goto indicate; ++ } ++ #endif ++ rtw_action_frame_parse(frame, frame_len, &category, &action); ++ RTW_INFO("RTW_Rx:category(%u), action(%u)\n", category, action); ++ ++indicate: ++ #if defined(RTW_DEDICATED_P2P_DEVICE) ++ if (rtw_cfg80211_redirect_pd_wdev(dvobj_to_wiphy(dvobj), get_ra(frame), &wdev)) ++ if (0) ++ RTW_INFO("redirect to pd_wdev:%p\n", wdev); ++ #endif ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++ rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, frame_len, GFP_ATOMIC); ++#else ++ cfg80211_rx_action(adapter->pnetdev, freq, frame, frame_len, GFP_ATOMIC); ++#endif ++} ++ ++void rtw_cfg80211_rx_action(_adapter *adapter, union recv_frame *rframe, const char *msg) ++{ ++ struct wireless_dev *wdev = adapter->rtw_wdev; ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); ++ u8 *frame = get_recvframe_data(rframe); ++ uint frame_len = rframe->u.hdr.len; ++ s32 freq; ++ u8 ch, sch = rtw_get_oper_ch(adapter); ++ u8 category, action; ++ ++ ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; ++ freq = rtw_ch2freq(ch); ++ ++ rtw_action_frame_parse(frame, frame_len, &category, &action); ++ ++ if (action == ACT_PUBLIC_GAS_INITIAL_REQ) { ++ rtw_mi_set_scan_deny(adapter, 200); ++ rtw_mi_scan_abort(adapter, _FALSE); /*rtw_scan_abort_no_wait*/ ++ } ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++ rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, frame_len, GFP_ATOMIC); ++#else ++ cfg80211_rx_action(adapter->pnetdev, freq, frame, frame_len, GFP_ATOMIC); ++#endif ++ ++ RTW_INFO("RTW_Rx:ch=%d(%d)\n", ch, sch); ++ if (msg) ++ RTW_INFO("RTW_Rx:%s\n", msg); ++ else ++ RTW_INFO("RTW_Rx:category(%u), action(%u)\n", category, action); ++} ++ ++#ifdef CONFIG_P2P ++void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, size_t len) ++{ ++ u16 wps_devicepassword_id = 0x0000; ++ uint wps_devicepassword_id_len = 0; ++ u8 wpsie[255] = { 0x00 }, p2p_ie[255] = { 0x00 }; ++ uint p2p_ielen = 0; ++ uint wpsielen = 0; ++ u32 devinfo_contentlen = 0; ++ u8 devinfo_content[64] = { 0x00 }; ++ u16 capability = 0; ++ uint capability_len = 0; ++ ++ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = P2P_PUB_ACTION_ACTION; ++ u8 dialogToken = 1; ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_PROVISION_DISC_REQ; ++ u32 p2pielen = 0; ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif ++ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 *frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ size_t frame_body_len = len - sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ ++ RTW_INFO("[%s] In\n", __FUNCTION__); ++ ++ /* prepare for building provision_request frame */ ++ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerIFAddr, GetAddr1Ptr(buf), ETH_ALEN); ++ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerDevAddr, GetAddr1Ptr(buf), ETH_ALEN); ++ ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON; ++ ++ rtw_get_wps_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, wpsie, &wpsielen); ++ rtw_get_wps_attr_content(wpsie, wpsielen, WPS_ATTR_DEVICE_PWID, (u8 *) &wps_devicepassword_id, &wps_devicepassword_id_len); ++ wps_devicepassword_id = be16_to_cpu(wps_devicepassword_id); ++ ++ switch (wps_devicepassword_id) { ++ case WPS_DPID_PIN: ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_LABEL; ++ break; ++ case WPS_DPID_USER_SPEC: ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_DISPLYA; ++ break; ++ case WPS_DPID_MACHINE_SPEC: ++ break; ++ case WPS_DPID_REKEY: ++ break; ++ case WPS_DPID_PBC: ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON; ++ break; ++ case WPS_DPID_REGISTRAR_SPEC: ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_KEYPAD; ++ break; ++ default: ++ break; ++ } ++ ++ ++ if (rtw_get_p2p_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, p2p_ie, &p2p_ielen)) { ++ ++ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO, devinfo_content, &devinfo_contentlen); ++ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8 *)&capability, &capability_len); ++ ++ } ++ ++ ++ /* start to build provision_request frame */ ++ _rtw_memset(wpsie, 0, sizeof(wpsie)); ++ _rtw_memset(p2p_ie, 0, sizeof(p2p_ie)); ++ p2p_ielen = 0; ++ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) ++ return; ++ ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, pwdinfo->tx_prov_disc_info.peerDevAddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->tx_prov_disc_info.peerDevAddr, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ ++ ++ /* build_prov_disc_request_p2p_ie */ ++ /* P2P OUI */ ++ p2pielen = 0; ++ p2p_ie[p2pielen++] = 0x50; ++ p2p_ie[p2pielen++] = 0x6F; ++ p2p_ie[p2pielen++] = 0x9A; ++ p2p_ie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ ++ ++ /* Commented by Albert 20110301 */ ++ /* According to the P2P Specification, the provision discovery request frame should contain 3 P2P attributes */ ++ /* 1. P2P Capability */ ++ /* 2. Device Info */ ++ /* 3. Group ID ( When joining an operating P2P Group ) */ ++ ++ /* P2P Capability ATTR */ ++ /* Type: */ ++ p2p_ie[p2pielen++] = P2P_ATTR_CAPABILITY; ++ ++ /* Length: */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); */ ++ RTW_PUT_LE16(p2p_ie + p2pielen, 0x0002); ++ p2pielen += 2; ++ ++ /* Value: */ ++ /* Device Capability Bitmap, 1 byte */ ++ /* Group Capability Bitmap, 1 byte */ ++ _rtw_memcpy(p2p_ie + p2pielen, &capability, 2); ++ p2pielen += 2; ++ ++ ++ /* Device Info ATTR */ ++ /* Type: */ ++ p2p_ie[p2pielen++] = P2P_ATTR_DEVICE_INFO; ++ ++ /* Length: */ ++ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ ++ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ ++ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); */ ++ RTW_PUT_LE16(p2p_ie + p2pielen, devinfo_contentlen); ++ p2pielen += 2; ++ ++ /* Value: */ ++ _rtw_memcpy(p2p_ie + p2pielen, devinfo_content, devinfo_contentlen); ++ p2pielen += devinfo_contentlen; ++ ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2p_ie, &p2p_ielen); ++ /* p2pielen = build_prov_disc_request_p2p_ie( pwdinfo, pframe, NULL, 0, pwdinfo->tx_prov_disc_info.peerDevAddr); */ ++ /* pframe += p2pielen; */ ++ pattrib->pktlen += p2p_ielen; ++ ++ wpsielen = 0; ++ /* WPS OUI */ ++ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); ++ wpsielen += 4; ++ ++ /* WPS version */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); ++ wpsielen += 2; ++ ++ /* Value: */ ++ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ ++ ++ /* Config Method */ ++ /* Type: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_CONF_METHOD); ++ wpsielen += 2; ++ ++ /* Length: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); ++ wpsielen += 2; ++ ++ /* Value: */ ++ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->tx_prov_disc_info.wps_config_method_request); ++ wpsielen += 2; ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); ++ ++ ++#ifdef CONFIG_WFD ++ wfdielen = build_provdisc_req_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++#endif ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ /* dump_mgntframe(padapter, pmgntframe); */ ++ if (dump_mgntframe_and_wait_ack(padapter, pmgntframe) != _SUCCESS) ++ RTW_INFO("%s, ack to\n", __func__); ++ ++ #if 0 ++ if(wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC) { ++ RTW_INFO("waiting for p2p peer key-in PIN CODE\n"); ++ rtw_msleep_os(15000); /* 15 sec for key in PIN CODE, workaround for GS2 before issuing Nego Req. */ ++ } ++ #endif ++ ++} ++ ++#ifdef CONFIG_RTW_80211R ++static s32 cfg80211_rtw_update_ft_ies(struct wiphy *wiphy, ++ struct net_device *ndev, ++ struct cfg80211_update_ft_ies_params *ftie) ++{ ++ _adapter *padapter = NULL; ++ struct mlme_priv *pmlmepriv = NULL; ++ ft_priv *pftpriv = NULL; ++ _irqL irqL; ++ u8 *p; ++ u8 *pie = NULL; ++ u32 ie_len = 0; ++ ++ if (ndev == NULL) ++ return -EINVAL; ++ ++ padapter = (_adapter *)rtw_netdev_priv(ndev); ++ pmlmepriv = &(padapter->mlmepriv); ++ pftpriv = &pmlmepriv->ftpriv; ++ ++ p = (u8 *)ftie->ie; ++ if (ftie->ie_len <= sizeof(pftpriv->updated_ft_ies)) { ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ _rtw_memcpy(pftpriv->updated_ft_ies, ftie->ie, ftie->ie_len); ++ pftpriv->updated_ft_ies_len = ftie->ie_len; ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ } else { ++ RTW_ERR("FTIEs parsing fail!\n"); ++ return -EINVAL; ++ } ++ ++ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_status(padapter, RTW_FT_AUTHENTICATED_STA)) { ++ RTW_PRINT("auth success, start reassoc\n"); ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ rtw_set_ft_status(padapter, RTW_FT_ASSOCIATING_STA); ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ start_clnt_assoc(padapter); ++ } ++ ++ return 0; ++} ++#endif ++ ++inline void rtw_cfg80211_set_is_roch(_adapter *adapter, bool val) ++{ ++ adapter->cfg80211_wdinfo.is_ro_ch = val; ++ rtw_mi_update_iface_status(&(adapter->mlmepriv), 0); ++} ++ ++inline bool rtw_cfg80211_get_is_roch(_adapter *adapter) ++{ ++ return adapter->cfg80211_wdinfo.is_ro_ch; ++} ++ ++static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ struct wireless_dev *wdev, ++#else ++ struct net_device *ndev, ++#endif ++ struct ieee80211_channel *channel, ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) ++ enum nl80211_channel_type channel_type, ++#endif ++ unsigned int duration, u64 *cookie) ++{ ++ s32 err = 0; ++ u8 remain_ch = (u8) ieee80211_frequency_to_channel(channel->center_freq); ++ u8 union_ch = 0, union_bw = 0, union_offset = 0; ++ u8 i; ++ u8 ready_on_channel = _FALSE; ++ _adapter *padapter = NULL; ++ _adapter *iface; ++ struct dvobj_priv *dvobj; ++ struct rtw_wdev_priv *pwdev_priv; ++ struct mlme_ext_priv *pmlmeext; ++ struct wifidirect_info *pwdinfo; ++ struct cfg80211_wifidirect_info *pcfg80211_wdinfo; ++ u8 is_p2p_find = _FALSE; ++ ++#ifndef CONFIG_RADIO_WORK ++#define RTW_ROCH_DURATION_ENLARGE ++#define RTW_ROCH_BACK_OP ++#endif ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ #if defined(RTW_DEDICATED_P2P_DEVICE) ++ if (wdev == wiphy_to_pd_wdev(wiphy)) ++ padapter = wiphy_to_adapter(wiphy); ++ else ++ #endif ++ if (wdev_to_ndev(wdev)) ++ padapter = (_adapter *)rtw_netdev_priv(wdev_to_ndev(wdev)); ++ else { ++ err = -EINVAL; ++ goto exit; ++ } ++#else ++ struct wireless_dev *wdev; ++ ++ if (ndev == NULL) { ++ err = -EINVAL; ++ goto exit; ++ } ++ padapter = (_adapter *)rtw_netdev_priv(ndev); ++ wdev = ndev_to_wdev(ndev); ++#endif ++ ++ dvobj = adapter_to_dvobj(padapter); ++ pwdev_priv = adapter_wdev_data(padapter); ++ pmlmeext = &padapter->mlmeextpriv; ++ pwdinfo = &padapter->wdinfo; ++ pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; ++#ifdef CONFIG_CONCURRENT_MODE ++ is_p2p_find = (duration < (pwdinfo->ext_listen_interval)) ? _TRUE : _FALSE; ++#endif ++ ++ *cookie = ATOMIC_INC_RETURN(&pcfg80211_wdinfo->ro_ch_cookie_gen); ++ ++ RTW_INFO(FUNC_ADPT_FMT"%s ch:%u duration:%d, cookie:0x%llx\n" ++ , FUNC_ADPT_ARG(padapter), wdev == wiphy_to_pd_wdev(wiphy) ? " PD" : "" ++ , remain_ch, duration, *cookie); ++ ++ if (rtw_ch_set_search_ch(pmlmeext->channel_set, remain_ch) < 0) { ++ RTW_WARN(FUNC_ADPT_FMT" invalid ch:%u\n", FUNC_ADPT_ARG(padapter), remain_ch); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++#ifdef CONFIG_MP_INCLUDED ++ if (rtw_mi_mp_mode_check(padapter)) { ++ RTW_INFO("MP mode block remain_on_channel request\n"); ++ err = -EFAULT; ++ goto exit; ++ } ++#endif ++ ++ if (_FAIL == rtw_pwr_wakeup(padapter)) { ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ rtw_scan_abort(padapter); ++#ifdef CONFIG_CONCURRENT_MODE ++ /*don't scan_abort during p2p_listen.*/ ++ if (is_p2p_find) ++ rtw_mi_buddy_scan_abort(padapter, _TRUE); ++#endif /*CONFIG_CONCURRENT_MODE*/ ++ ++ if (rtw_cfg80211_get_is_roch(padapter) == _TRUE) { ++ _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); ++ p2p_cancel_roch_cmd(padapter, 0, NULL, RTW_CMDF_WAIT_ACK); ++ } ++ ++ /* if(!rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) && !rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) */ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); ++ padapter->wdinfo.listen_channel = remain_ch; ++ RTW_INFO(FUNC_ADPT_FMT" init listen_channel %u\n" ++ , FUNC_ADPT_ARG(padapter), padapter->wdinfo.listen_channel); ++ } else if (rtw_p2p_chk_state(pwdinfo , P2P_STATE_LISTEN) ++ && (time_after_eq((unsigned long)rtw_get_current_time(), (unsigned long)pwdev_priv->probe_resp_ie_update_time) ++ && rtw_get_passing_time_ms(pwdev_priv->probe_resp_ie_update_time) < 50) ++ ) { ++ if (padapter->wdinfo.listen_channel != remain_ch) { ++ padapter->wdinfo.listen_channel = remain_ch; ++ RTW_INFO(FUNC_ADPT_FMT" update listen_channel %u\n" ++ , FUNC_ADPT_ARG(padapter), padapter->wdinfo.listen_channel); ++ } ++ } else { ++ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); ++ #endif ++ } ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if (check_fwstate(&iface->mlmepriv, _FW_UNDER_LINKING | WIFI_UNDER_WPS) == _TRUE) { ++ RTW_INFO(ADPT_FMT"- _FW_UNDER_LINKING |WIFI_UNDER_WPS (mlme state:0x%x)\n", ADPT_ARG(iface), get_fwstate(&iface->mlmepriv)); ++ remain_ch = iface->mlmeextpriv.cur_channel; ++ } ++ } ++ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); ++ ++ #ifdef RTW_ROCH_DURATION_ENLARGE ++ if (duration < 400) ++ duration = duration * 3; /* extend from exper */ ++ #endif ++ ++#if defined(RTW_ROCH_BACK_OP) && defined(CONFIG_CONCURRENT_MODE) ++ if (rtw_mi_check_status(padapter, MI_LINKED)) { ++ if (is_p2p_find) /* p2p_find , duration<1000 */ ++ duration = duration + pwdinfo->ext_listen_interval; ++ else /* p2p_listen, duration=5000 */ ++ duration = pwdinfo->ext_listen_interval + (pwdinfo->ext_listen_interval / 4); ++ } ++#endif /*defined (RTW_ROCH_BACK_OP) && defined(CONFIG_CONCURRENT_MODE) */ ++ ++ rtw_cfg80211_set_is_roch(padapter, _TRUE); ++ pcfg80211_wdinfo->ro_ch_wdev = wdev; ++ pcfg80211_wdinfo->remain_on_ch_cookie = *cookie; ++ pcfg80211_wdinfo->last_ro_ch_time = rtw_get_current_time(); ++ _rtw_memcpy(&pcfg80211_wdinfo->remain_on_ch_channel, channel, sizeof(struct ieee80211_channel)); ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) ++ pcfg80211_wdinfo->remain_on_ch_type = channel_type; ++ #endif ++ pcfg80211_wdinfo->restore_channel = rtw_get_oper_ch(padapter); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED) && (0 != rtw_mi_get_union_chan(padapter))) { ++ if ((remain_ch != rtw_mi_get_union_chan(padapter)) && !check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { ++ if (ATOMIC_READ(&pwdev_priv->switch_ch_to) == 1 || ++ (remain_ch != pmlmeext->cur_channel)) { ++ ++ rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); ++ ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); ++ ++ #ifdef RTW_ROCH_BACK_OP ++ RTW_INFO("%s, set switch ch timer, duration=%d\n", __func__, duration - pwdinfo->ext_listen_interval); ++ _set_timer(&pwdinfo->ap_p2p_switch_timer, duration - pwdinfo->ext_listen_interval); ++ #endif ++ } ++ } ++ ready_on_channel = _TRUE; ++ } else ++#endif /* CONFIG_CONCURRENT_MODE */ ++ { ++ if (remain_ch != rtw_get_oper_ch(padapter)) ++ ready_on_channel = _TRUE; ++ } ++ ++ if (ready_on_channel == _TRUE) { ++ #ifndef RTW_SINGLE_WIPHY ++ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) ++ #endif ++ { ++ #ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_get_oper_ch(padapter) != remain_ch) ++ #endif ++ { ++ /* if (!padapter->mlmepriv.LinkDetectInfo.bBusyTraffic) */ ++ set_channel_bwmode(padapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ } ++ } ++ } ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_ScanNotify(padapter, _TRUE); ++#endif ++ ++ RTW_INFO("%s, set ro ch timer, duration=%d\n", __func__, duration); ++ _set_timer(&pcfg80211_wdinfo->remain_on_ch_timer, duration); ++ ++ rtw_cfg80211_ready_on_channel(wdev, *cookie, channel, channel_type, duration, GFP_KERNEL); ++ ++exit: ++ return err; ++} ++ ++static s32 cfg80211_rtw_cancel_remain_on_channel(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ struct wireless_dev *wdev, ++#else ++ struct net_device *ndev, ++#endif ++ u64 cookie) ++{ ++ s32 err = 0; ++ _adapter *padapter; ++ struct rtw_wdev_priv *pwdev_priv; ++ struct wifidirect_info *pwdinfo; ++ struct cfg80211_wifidirect_info *pcfg80211_wdinfo; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ #if defined(RTW_DEDICATED_P2P_DEVICE) ++ if (wdev == wiphy_to_pd_wdev(wiphy)) ++ padapter = wiphy_to_adapter(wiphy); ++ else ++ #endif ++ if (wdev_to_ndev(wdev)) ++ padapter = (_adapter *)rtw_netdev_priv(wdev_to_ndev(wdev)); ++ else { ++ err = -EINVAL; ++ goto exit; ++ } ++#else ++ struct wireless_dev *wdev; ++ ++ if (ndev == NULL) { ++ err = -EINVAL; ++ goto exit; ++ } ++ padapter = (_adapter *)rtw_netdev_priv(ndev); ++ wdev = ndev_to_wdev(ndev); ++#endif ++ ++ pwdev_priv = adapter_wdev_data(padapter); ++ pwdinfo = &padapter->wdinfo; ++ pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; ++ ++ RTW_INFO(FUNC_ADPT_FMT"%s cookie:0x%llx\n" ++ , FUNC_ADPT_ARG(padapter), wdev == wiphy_to_pd_wdev(wiphy) ? " PD" : "" ++ , cookie); ++ ++ if (rtw_cfg80211_get_is_roch(padapter) == _TRUE) { ++ _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); ++ p2p_cancel_roch_cmd(padapter, cookie, wdev, RTW_CMDF_WAIT_ACK); ++ } ++ ++exit: ++ return err; ++} ++ ++inline int rtw_cfg80211_iface_has_p2p_group_cap(_adapter *adapter) ++{ ++ struct wiphy *wiphy = adapter_to_wiphy(adapter); ++ struct rtw_wdev_priv *wdev_data = adapter_wdev_data(adapter); ++ ++#if RTW_P2P_GROUP_INTERFACE ++ if (is_primary_adapter(adapter)) ++ return 0; ++#endif ++ return 1; ++} ++ ++inline int rtw_cfg80211_is_p2p_scan(_adapter *adapter) ++{ ++#if RTW_P2P_GROUP_INTERFACE ++ if (rtw_cfg80211_iface_has_p2p_group_cap(adapter)) ++#endif ++ { ++ struct wifidirect_info *wdinfo = &adapter->wdinfo; ++ ++ return rtw_p2p_chk_state(wdinfo, P2P_STATE_SCAN) ++ || rtw_p2p_chk_state(wdinfo, P2P_STATE_FIND_PHASE_SEARCH); ++ } ++ ++#if RTW_P2P_GROUP_INTERFACE ++ #if defined(RTW_DEDICATED_P2P_DEVICE) ++ if (wiphy_to_pd_wdev(adapter_to_wiphy(adapter))) /* pd_wdev exist */ ++ return rtw_cfg80211_is_scan_by_pd_wdev(adapter); ++ #endif ++ { ++ /* ++ * For 2 RTW_P2P_GROUP_INTERFACE cases: ++ * 1. RTW_DEDICATED_P2P_DEVICE defined but upper layer don't use pd_wdev or ++ * 2. RTW_DEDICATED_P2P_DEVICE not defined ++ */ ++ struct rtw_wdev_priv *wdev_data = adapter_wdev_data(adapter); ++ _irqL irqL; ++ int is_p2p_scan = 0; ++ ++ _enter_critical_bh(&wdev_data->scan_req_lock, &irqL); ++ if (wdev_data->scan_request ++ && wdev_data->scan_request->ssids ++ && wdev_data->scan_request->ie ++ ) { ++ if (_rtw_memcmp(wdev_data->scan_request->ssids->ssid, "DIRECT-", 7) ++ && rtw_get_p2p_ie((u8 *)wdev_data->scan_request->ie, wdev_data->scan_request->ie_len, NULL, NULL)) ++ is_p2p_scan = 1; ++ } ++ _exit_critical_bh(&wdev_data->scan_req_lock, &irqL); ++ ++ return is_p2p_scan; ++ } ++#endif ++} ++ ++#if defined(RTW_DEDICATED_P2P_DEVICE) ++int rtw_pd_iface_alloc(struct wiphy *wiphy, const char *name, struct wireless_dev **pd_wdev) ++{ ++ struct rtw_wiphy_data *wiphy_data = rtw_wiphy_priv(wiphy); ++ struct wireless_dev *wdev = NULL; ++ struct rtw_netdev_priv_indicator *npi; ++ _adapter *primary_adpt = wiphy_to_adapter(wiphy); ++ int ret = 0; ++ ++ if (wiphy_data->pd_wdev) { ++ RTW_WARN(FUNC_WIPHY_FMT" pd_wdev already exists\n", FUNC_WIPHY_ARG(wiphy)); ++ ret = -EBUSY; ++ goto exit; ++ } ++ ++ wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); ++ if (!wdev) { ++ RTW_WARN(FUNC_WIPHY_FMT" allocate wdev fail\n", FUNC_WIPHY_ARG(wiphy)); ++ ret = -ENOMEM; ++ goto exit; ++ } ++ ++ wdev->wiphy = wiphy; ++ wdev->iftype = NL80211_IFTYPE_P2P_DEVICE; ++ _rtw_memcpy(wdev->address, adapter_mac_addr(primary_adpt), ETH_ALEN); ++ ++ wiphy_data->pd_wdev = wdev; ++ *pd_wdev = wdev; ++ ++ RTW_INFO(FUNC_WIPHY_FMT" pd_wdev:%p, addr="MAC_FMT" added\n" ++ , FUNC_WIPHY_ARG(wiphy), wdev, MAC_ARG(wdev_address(wdev))); ++ ++exit: ++ if (ret && wdev) { ++ rtw_mfree((u8 *)wdev, sizeof(struct wireless_dev)); ++ wdev = NULL; ++ } ++ ++ return ret; ++} ++ ++void rtw_pd_iface_free(struct wiphy *wiphy) ++{ ++ struct dvobj_priv *dvobj = wiphy_to_dvobj(wiphy); ++ struct rtw_wiphy_data *wiphy_data = rtw_wiphy_priv(wiphy); ++ u8 rtnl_lock_needed; ++ ++ if (!wiphy_data->pd_wdev) ++ goto exit; ++ ++ RTW_INFO(FUNC_WIPHY_FMT" pd_wdev:%p, addr="MAC_FMT"\n" ++ , FUNC_WIPHY_ARG(wiphy), wiphy_data->pd_wdev ++ , MAC_ARG(wdev_address(wiphy_data->pd_wdev))); ++ ++ rtnl_lock_needed = rtw_rtnl_lock_needed(dvobj); ++ if (rtnl_lock_needed) ++ rtnl_lock(); ++ cfg80211_unregister_wdev(wiphy_data->pd_wdev); ++ if (rtnl_lock_needed) ++ rtnl_unlock(); ++ ++ rtw_mfree((u8 *)wiphy_data->pd_wdev, sizeof(struct wireless_dev)); ++ wiphy_data->pd_wdev = NULL; ++ ++exit: ++ return; ++} ++ ++static int cfg80211_rtw_start_p2p_device(struct wiphy *wiphy, struct wireless_dev *wdev) ++{ ++ _adapter *adapter = wiphy_to_adapter(wiphy); ++ ++ RTW_INFO(FUNC_WIPHY_FMT" wdev=%p\n", FUNC_WIPHY_ARG(wiphy), wdev); ++ ++ rtw_p2p_enable(adapter, P2P_ROLE_DEVICE); ++ return 0; ++} ++ ++static void cfg80211_rtw_stop_p2p_device(struct wiphy *wiphy, struct wireless_dev *wdev) ++{ ++ _adapter *adapter = wiphy_to_adapter(wiphy); ++ ++ RTW_INFO(FUNC_WIPHY_FMT" wdev=%p\n", FUNC_WIPHY_ARG(wiphy), wdev); ++ ++ if (rtw_cfg80211_is_p2p_scan(adapter)) ++ rtw_scan_abort(adapter); ++ ++ rtw_p2p_enable(adapter, P2P_ROLE_DISABLE); ++} ++ ++inline int rtw_cfg80211_redirect_pd_wdev(struct wiphy *wiphy, u8 *ra, struct wireless_dev **wdev) ++{ ++ struct wireless_dev *pd_wdev = wiphy_to_pd_wdev(wiphy); ++ ++ if (pd_wdev && pd_wdev != *wdev ++ && _rtw_memcmp(wdev_address(pd_wdev), ra, ETH_ALEN) == _TRUE ++ ) { ++ *wdev = pd_wdev; ++ return 1; ++ } ++ return 0; ++} ++ ++inline int rtw_cfg80211_is_scan_by_pd_wdev(_adapter *adapter) ++{ ++ struct wiphy *wiphy = adapter_to_wiphy(adapter); ++ struct rtw_wdev_priv *wdev_data = adapter_wdev_data(adapter); ++ struct wireless_dev *wdev = NULL; ++ _irqL irqL; ++ ++ _enter_critical_bh(&wdev_data->scan_req_lock, &irqL); ++ if (wdev_data->scan_request) ++ wdev = wdev_data->scan_request->wdev; ++ _exit_critical_bh(&wdev_data->scan_req_lock, &irqL); ++ ++ if (wdev && wdev == wiphy_to_pd_wdev(wiphy)) ++ return 1; ++ ++ return 0; ++} ++#endif /* RTW_DEDICATED_P2P_DEVICE */ ++#endif /* CONFIG_P2P */ ++ ++inline void rtw_cfg80211_set_is_mgmt_tx(_adapter *adapter, u8 val) ++{ ++ struct rtw_wdev_priv *wdev_priv = adapter_wdev_data(adapter); ++ ++ wdev_priv->is_mgmt_tx = val; ++ rtw_mi_update_iface_status(&(adapter->mlmepriv), 0); ++} ++ ++inline u8 rtw_cfg80211_get_is_mgmt_tx(_adapter *adapter) ++{ ++ struct rtw_wdev_priv *wdev_priv = adapter_wdev_data(adapter); ++ ++ return wdev_priv->is_mgmt_tx; ++} ++ ++static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, u8 no_cck, const u8 *buf, size_t len, int wait_ack) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ int ret = _FAIL; ++ bool ack = _TRUE; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++#endif /* CONFIG_P2P */ ++ /* struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; */ ++ ++ rtw_mi_set_scan_deny(padapter, 1000); ++ rtw_mi_scan_abort(padapter, _TRUE); ++ ++ rtw_cfg80211_set_is_mgmt_tx(padapter, 1); ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_ScanNotify(padapter, _TRUE); ++#endif ++ ++#ifdef CONFIG_P2P ++ if (rtw_cfg80211_get_is_roch(padapter) == _TRUE) { ++ #ifdef CONFIG_CONCURRENT_MODE ++ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { ++ RTW_INFO("%s, extend ro ch time\n", __func__); ++ _set_timer(&padapter->cfg80211_wdinfo.remain_on_ch_timer, pwdinfo->ext_listen_period); ++ } ++ #endif /* CONFIG_CONCURRENT_MODE */ ++ } ++#endif /* CONFIG_P2P */ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) { ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ u8 co_channel = 0xff; ++ co_channel = rtw_get_oper_ch(padapter); ++ ++ if (tx_ch != union_ch) { ++ u16 ext_listen_period; ++ ++ if (ATOMIC_READ(&pwdev_priv->switch_ch_to) == 1) { ++ rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); ++ ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); ++ /* RTW_INFO("%s, set switch ch timer, period=%d\n", __func__, pwdinfo->ext_listen_period); */ ++ /* _set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_period); */ ++ } ++ ++ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) ++ ext_listen_period = 500;/*500ms*/ ++#ifdef CONFIG_P2P ++ else ++ ext_listen_period = pwdinfo->ext_listen_period; ++ ++ _set_timer(&pwdinfo->ap_p2p_switch_timer, ext_listen_period); ++#endif ++ RTW_INFO("%s, set switch ch timer, period=%d\n", __func__, ext_listen_period); ++ } ++ ++ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) ++ pmlmeext->cur_channel = tx_ch; ++ ++ if (tx_ch != co_channel) ++ set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ } else ++#endif /* CONFIG_CONCURRENT_MODE */ ++ /* if (tx_ch != pmlmeext->cur_channel) { */ ++ if (tx_ch != rtw_get_oper_ch(padapter)) { ++ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) ++ pmlmeext->cur_channel = tx_ch; ++ set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ } ++ ++ /* starting alloc mgmt frame to dump it */ ++ pmgntframe = alloc_mgtxmitframe(pxmitpriv); ++ if (pmgntframe == NULL) { ++ /* ret = -ENOMEM; */ ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ /* update attribute */ ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ if (no_cck && IS_CCK_RATE(pattrib->rate)) { ++ /* force OFDM 6M rate*/ ++ pattrib->rate = MGN_6M; ++ pattrib->raid = rtw_get_mgntframe_raid(padapter, WIRELESS_11G); ++ } ++ ++ pattrib->retry_ctrl = _FALSE; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ _rtw_memcpy(pframe, (void *)buf, len); ++ pattrib->pktlen = len; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ /* update seq number */ ++ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); ++ pattrib->seqnum = pmlmeext->mgnt_seq; ++ pmlmeext->mgnt_seq++; ++ ++#ifdef CONFIG_P2P ++ rtw_xframe_chk_wfd_ie(pmgntframe); ++#endif /* CONFIG_P2P */ ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ if (wait_ack) { ++ if (dump_mgntframe_and_wait_ack(padapter, pmgntframe) != _SUCCESS) { ++ ack = _FALSE; ++ ret = _FAIL; ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s, ack == _FAIL\n", __func__); ++#endif ++ } else { ++ ++#ifdef CONFIG_XMIT_ACK ++ rtw_msleep_os(50); ++#endif ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s, ack=%d, ok!\n", __func__, ack); ++#endif ++ ret = _SUCCESS; ++ } ++ } else { ++ dump_mgntframe(padapter, pmgntframe); ++ ret = _SUCCESS; ++ } ++exit: ++ rtw_cfg80211_set_is_mgmt_tx(padapter, 0); ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_ScanNotify(padapter, _FALSE); ++#endif ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s, ret=%d\n", __func__, ret); ++#endif ++ ++ return ret; ++ ++} ++ ++static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ struct wireless_dev *wdev, ++#else ++ struct net_device *ndev, ++#endif ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) || defined(COMPAT_KERNEL_RELEASE) ++ struct ieee80211_channel *chan, ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) ++ bool offchan, ++ #endif ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34)) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) ++ enum nl80211_channel_type channel_type, ++ #endif ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) ++ bool channel_type_valid, ++ #endif ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) ++ unsigned int wait, ++ #endif ++ const u8 *buf, size_t len, ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) ++ bool no_cck, ++ #endif ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) ++ bool dont_wait_for_ack, ++ #endif ++#else ++ struct cfg80211_mgmt_tx_params *params, ++#endif ++ u64 *cookie) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(COMPAT_KERNEL_RELEASE) ++ struct ieee80211_channel *chan = params->chan; ++ bool offchan = params->offchan; ++ unsigned int wait = params->wait; ++ const u8 *buf = params->buf; ++ size_t len = params->len; ++ bool no_cck = params->no_cck; ++ bool dont_wait_for_ack = params->dont_wait_for_ack; ++#endif ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 2, 0)) ++ bool no_cck = 0; ++#endif ++ int ret = 0; ++ int tx_ret; ++ int wait_ack = 1; ++ u32 dump_limit = RTW_MAX_MGMT_TX_CNT; ++ u32 dump_cnt = 0; ++ bool ack = _TRUE; ++ u8 tx_ch; ++ u8 category, action; ++ u8 frame_styp; ++ int type = (-1); ++ u32 start = rtw_get_current_time(); ++ _adapter *padapter; ++ struct dvobj_priv *dvobj; ++ struct rtw_wdev_priv *pwdev_priv; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ #if defined(RTW_DEDICATED_P2P_DEVICE) ++ if (wdev == wiphy_to_pd_wdev(wiphy)) ++ padapter = wiphy_to_adapter(wiphy); ++ else ++ #endif ++ if (wdev_to_ndev(wdev)) ++ padapter = (_adapter *)rtw_netdev_priv(wdev_to_ndev(wdev)); ++ else { ++ ret = -EINVAL; ++ goto exit; ++ } ++#else ++ struct wireless_dev *wdev; ++ ++ if (ndev == NULL) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ padapter = (_adapter *)rtw_netdev_priv(ndev); ++ wdev = ndev_to_wdev(ndev); ++#endif ++ ++ if (chan == NULL) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ tx_ch = (u8)ieee80211_frequency_to_channel(chan->center_freq); ++ ++ dvobj = adapter_to_dvobj(padapter); ++ pwdev_priv = adapter_wdev_data(padapter); ++ ++ /* cookie generation */ ++ *cookie = (unsigned long) buf; ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO(FUNC_ADPT_FMT"%s len=%zu, ch=%d" ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34)) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) ++ ", ch_type=%d" ++ #endif ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) ++ ", channel_type_valid=%d" ++ #endif ++ "\n", FUNC_ADPT_ARG(padapter), wdev == wiphy_to_pd_wdev(wiphy) ? " PD" : "" ++ , len, tx_ch ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34)) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) ++ , channel_type ++ #endif ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34)) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) ++ , channel_type_valid ++ #endif ++ ); ++#endif /* CONFIG_DEBUG_CFG80211 */ ++ ++ /* indicate ack before issue frame to avoid racing with rsp frame */ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++ rtw_cfg80211_mgmt_tx_status(wdev, *cookie, buf, len, ack, GFP_KERNEL); ++#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34) && LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 36)) ++ cfg80211_action_tx_status(ndev, *cookie, buf, len, ack, GFP_KERNEL); ++#endif ++ ++ frame_styp = le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl) & IEEE80211_FCTL_STYPE; ++ if (IEEE80211_STYPE_PROBE_RESP == frame_styp) { ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("RTW_Tx: probe_resp tx_ch=%d, no_cck=%u, da="MAC_FMT"\n", tx_ch, no_cck, MAC_ARG(GetAddr1Ptr(buf))); ++#endif /* CONFIG_DEBUG_CFG80211 */ ++ wait_ack = 0; ++ goto dump; ++ } ++ ++ if (rtw_action_frame_parse(buf, len, &category, &action) == _FALSE) { ++ RTW_INFO(FUNC_ADPT_FMT" frame_control:0x%x\n", FUNC_ADPT_ARG(padapter), ++ le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl)); ++ goto exit; ++ } ++ ++ RTW_INFO("RTW_Tx:tx_ch=%d, no_cck=%u, da="MAC_FMT"\n", tx_ch, no_cck, MAC_ARG(GetAddr1Ptr(buf))); ++#ifdef CONFIG_P2P ++ type = rtw_p2p_check_frames(padapter, buf, len, _TRUE); ++ if (type >= 0) { ++ no_cck = 1; /* force no CCK for P2P frames */ ++ goto dump; ++ } ++#endif ++ if (category == RTW_WLAN_CATEGORY_PUBLIC) ++ RTW_INFO("RTW_Tx:%s\n", action_public_str(action)); ++ else ++ RTW_INFO("RTW_Tx:category(%u), action(%u)\n", category, action); ++ ++dump: ++ ++ rtw_ps_deny(padapter, PS_DENY_MGNT_TX); ++ if (_FAIL == rtw_pwr_wakeup(padapter)) { ++ ret = -EFAULT; ++ goto cancel_ps_deny; ++ } ++ ++ while (1) { ++ u32 sleep_ms = 0; ++ u32 retry_guarantee_ms = 0; ++ ++ dump_cnt++; ++ tx_ret = _cfg80211_rtw_mgmt_tx(padapter, tx_ch, no_cck, buf, len, wait_ack); ++ ++ switch (action) { ++ case ACT_PUBLIC_GAS_INITIAL_REQ: ++ case ACT_PUBLIC_GAS_INITIAL_RSP: ++ sleep_ms = 50; ++ retry_guarantee_ms = RTW_MAX_MGMT_TX_MS_GAS; ++ } ++ ++ if (tx_ret == _SUCCESS ++ || (dump_cnt >= dump_limit && rtw_get_passing_time_ms(start) >= retry_guarantee_ms)) ++ break; ++ ++ if (sleep_ms > 0) ++ rtw_msleep_os(sleep_ms); ++ } ++ ++ if (tx_ret != _SUCCESS || dump_cnt > 1) { ++ RTW_INFO(FUNC_ADPT_FMT" %s (%d/%d) in %d ms\n", FUNC_ADPT_ARG(padapter), ++ tx_ret == _SUCCESS ? "OK" : "FAIL", dump_cnt, dump_limit, rtw_get_passing_time_ms(start)); ++ } ++ ++ switch (type) { ++ case P2P_GO_NEGO_CONF: ++ if (0) { ++ RTW_INFO(FUNC_ADPT_FMT" Nego confirm. state=%u, status=%u, iaddr="MAC_FMT"\n" ++ , FUNC_ADPT_ARG(padapter), pwdev_priv->nego_info.state, pwdev_priv->nego_info.status ++ , MAC_ARG(pwdev_priv->nego_info.iface_addr)); ++ } ++ if (pwdev_priv->nego_info.state == 2 ++ && pwdev_priv->nego_info.status == 0 ++ && rtw_check_invalid_mac_address(pwdev_priv->nego_info.iface_addr, _FALSE) == _FALSE ++ ) { ++ _adapter *intended_iface = dvobj_get_adapter_by_addr(dvobj, pwdev_priv->nego_info.iface_addr); ++ ++ if (intended_iface) { ++ RTW_INFO(FUNC_ADPT_FMT" Nego confirm. Allow only "ADPT_FMT" to scan for 2000 ms\n" ++ , FUNC_ADPT_ARG(padapter), ADPT_ARG(intended_iface)); ++ /* allow only intended_iface to do scan for 2000 ms */ ++ rtw_mi_set_scan_deny(padapter, 2000); ++ rtw_clear_scan_deny(intended_iface); ++ } ++ } ++ break; ++ case P2P_INVIT_RESP: ++ if (pwdev_priv->invit_info.flags & BIT(0) ++ && pwdev_priv->invit_info.status == 0 ++ ) { ++ RTW_INFO(FUNC_ADPT_FMT" agree with invitation of persistent group\n", ++ FUNC_ADPT_ARG(padapter)); ++ #if !RTW_P2P_GROUP_INTERFACE ++ rtw_mi_buddy_set_scan_deny(padapter, 5000); ++ #endif ++ rtw_pwr_wakeup_ex(padapter, 5000); ++ } ++ break; ++ } ++ ++cancel_ps_deny: ++ rtw_ps_deny_cancel(padapter, PS_DENY_MGNT_TX); ++exit: ++ return ret; ++} ++ ++static void cfg80211_rtw_mgmt_frame_register(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ struct wireless_dev *wdev, ++#else ++ struct net_device *ndev, ++#endif ++ u16 frame_type, bool reg) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ struct net_device *ndev = wdev_to_ndev(wdev); ++#endif ++ _adapter *adapter; ++ ++ struct rtw_wdev_priv *pwdev_priv; ++ ++ if (ndev == NULL) ++ goto exit; ++ ++ adapter = (_adapter *)rtw_netdev_priv(ndev); ++ pwdev_priv = adapter_wdev_data(adapter); ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO(FUNC_ADPT_FMT" frame_type:%x, reg:%d\n", FUNC_ADPT_ARG(adapter), ++ frame_type, reg); ++#endif ++ ++ /* Wait QC Verify */ ++ return; ++ ++ switch (frame_type) { ++ case IEEE80211_STYPE_PROBE_REQ: /* 0x0040 */ ++ SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_PROBE_REQ, reg); ++ break; ++ case IEEE80211_STYPE_ACTION: /* 0x00D0 */ ++ SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_ACTION, reg); ++ break; ++ default: ++ break; ++ } ++ ++exit: ++ return; ++} ++ ++#if defined(CONFIG_TDLS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) ++static int cfg80211_rtw_tdls_mgmt(struct wiphy *wiphy, ++ struct net_device *ndev, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0)) ++ const u8 *peer, ++#else ++ u8 *peer, ++#endif ++ u8 action_code, ++ u8 dialog_token, ++ u16 status_code, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) ++ u32 peer_capability, ++#endif ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0)) ++ bool initiator, ++#endif ++ const u8 *buf, ++ size_t len) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; ++ int ret = 0; ++ struct tdls_txmgmt txmgmt; ++ ++ if (hal_chk_wl_func(padapter, WL_FUNC_TDLS) == _FALSE) { ++ RTW_INFO("Discard tdls action:%d, since hal doesn't support tdls\n", action_code); ++ goto discard; ++ } ++ ++ if (rtw_tdls_is_driver_setup(padapter)) { ++ RTW_INFO("Discard tdls action:%d, let driver to set up direct link\n", action_code); ++ goto discard; ++ } ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ _rtw_memcpy(txmgmt.peer, peer, ETH_ALEN); ++ txmgmt.action_code = action_code; ++ txmgmt.dialog_token = dialog_token; ++ txmgmt.status_code = status_code; ++ txmgmt.len = len; ++ txmgmt.buf = (u8 *)rtw_malloc(txmgmt.len); ++ if (txmgmt.buf == NULL) { ++ ret = -ENOMEM; ++ goto bad; ++ } ++ _rtw_memcpy(txmgmt.buf, (void *)buf, txmgmt.len); ++ ++ /* Debug purpose */ ++#if 1 ++ RTW_INFO("%s %d\n", __FUNCTION__, __LINE__); ++ RTW_INFO("peer:"MAC_FMT", action code:%d, dialog:%d, status code:%d\n", ++ MAC_ARG(txmgmt.peer), txmgmt.action_code, ++ txmgmt.dialog_token, txmgmt.status_code); ++ if (txmgmt.len > 0) { ++ int i = 0; ++ for (; i < len; i++) ++ printk("%02x ", *(txmgmt.buf + i)); ++ RTW_INFO("len:%d\n", (u32)txmgmt.len); ++ } ++#endif ++ ++ switch (txmgmt.action_code) { ++ case TDLS_SETUP_REQUEST: ++ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); ++ break; ++ case TDLS_SETUP_RESPONSE: ++ issue_tdls_setup_rsp(padapter, &txmgmt); ++ break; ++ case TDLS_SETUP_CONFIRM: ++ issue_tdls_setup_cfm(padapter, &txmgmt); ++ break; ++ case TDLS_TEARDOWN: ++ issue_tdls_teardown(padapter, &txmgmt, _TRUE); ++ break; ++ case TDLS_DISCOVERY_REQUEST: ++ issue_tdls_dis_req(padapter, &txmgmt); ++ break; ++ case TDLS_DISCOVERY_RESPONSE: ++ issue_tdls_dis_rsp(padapter, &txmgmt, pmlmeinfo->enc_algo ? _TRUE : _FALSE); ++ break; ++ } ++ ++bad: ++ if (txmgmt.buf) ++ rtw_mfree(txmgmt.buf, txmgmt.len); ++ ++discard: ++ return ret; ++} ++ ++static int cfg80211_rtw_tdls_oper(struct wiphy *wiphy, ++ struct net_device *ndev, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0)) ++ const u8 *peer, ++#else ++ u8 *peer, ++#endif ++ enum nl80211_tdls_operation oper) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct tdls_txmgmt txmgmt; ++ struct sta_info *ptdls_sta = NULL; ++ ++ RTW_INFO(FUNC_NDEV_FMT", nl80211_tdls_operation:%d\n", FUNC_NDEV_ARG(ndev), oper); ++ ++ if (hal_chk_wl_func(padapter, WL_FUNC_TDLS) == _FALSE) { ++ RTW_INFO("Discard tdls oper:%d, since hal doesn't support tdls\n", oper); ++ return 0; ++ } ++ ++#ifdef CONFIG_LPS ++ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); ++#endif /* CONFIG_LPS */ ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ if (peer) ++ _rtw_memcpy(txmgmt.peer, peer, ETH_ALEN); ++ ++ if (rtw_tdls_is_driver_setup(padapter)) { ++ /* these two cases are done by driver itself */ ++ if (oper == NL80211_TDLS_ENABLE_LINK || oper == NL80211_TDLS_DISABLE_LINK) ++ return 0; ++ } ++ ++ switch (oper) { ++ case NL80211_TDLS_DISCOVERY_REQ: ++ issue_tdls_dis_req(padapter, &txmgmt); ++ break; ++ case NL80211_TDLS_SETUP: ++#ifdef CONFIG_WFD ++ if (_AES_ != padapter->securitypriv.dot11PrivacyAlgrthm) { ++ if (padapter->wdinfo.wfd_tdls_weaksec == _TRUE) ++ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); ++ else ++ RTW_INFO("[%s] Current link is not AES, SKIP sending the tdls setup request!!\n", __FUNCTION__); ++ } else ++#endif /* CONFIG_WFD */ ++ { ++ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); ++ } ++ break; ++ case NL80211_TDLS_TEARDOWN: ++ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), txmgmt.peer); ++ if (ptdls_sta != NULL) { ++ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; ++ issue_tdls_teardown(padapter, &txmgmt, _TRUE); ++ } else ++ RTW_INFO("TDLS peer not found\n"); ++ break; ++ case NL80211_TDLS_ENABLE_LINK: ++ RTW_INFO(FUNC_NDEV_FMT", NL80211_TDLS_ENABLE_LINK;mac:"MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(peer)); ++ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), (u8 *)peer); ++ if (ptdls_sta != NULL) { ++ ptdlsinfo->link_established = _TRUE; ++ ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; ++ ptdls_sta->state |= _FW_LINKED; ++ rtw_tdls_cmd(padapter, txmgmt.peer, TDLS_ESTABLISHED); ++ } ++ break; ++ case NL80211_TDLS_DISABLE_LINK: ++ RTW_INFO(FUNC_NDEV_FMT", NL80211_TDLS_DISABLE_LINK;mac:"MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(peer)); ++ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), (u8 *)peer); ++ if (ptdls_sta != NULL) ++ rtw_tdls_cmd(padapter, (u8 *)peer, TDLS_TEARDOWN_STA_LOCALLY); ++ break; ++ } ++ return 0; ++} ++#endif /* CONFIG_TDLS */ ++ ++#if defined(CONFIG_PNO_SUPPORT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) ++static int cfg80211_rtw_sched_scan_start(struct wiphy *wiphy, ++ struct net_device *dev, ++ struct cfg80211_sched_scan_request *request) ++{ ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u8 ret; ++ ++ if (padapter->bup == _FALSE) { ++ RTW_INFO("%s: net device is down.\n", __func__); ++ return -EIO; ++ } ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE || ++ check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE || ++ check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { ++ RTW_INFO("%s: device is busy.\n", __func__); ++ rtw_scan_abort(padapter); ++ } ++ ++ if (request == NULL) { ++ RTW_INFO("%s: invalid cfg80211_requests parameters.\n", __func__); ++ return -EINVAL; ++ } ++ ++ ret = rtw_android_cfg80211_pno_setup(dev, request->ssids, ++ request->n_ssids, request->interval); ++ ++ if (ret < 0) { ++ RTW_INFO("%s ret: %d\n", __func__, ret); ++ goto exit; ++ } ++ ++ ret = rtw_android_pno_enable(dev, _TRUE); ++ if (ret < 0) { ++ RTW_INFO("%s ret: %d\n", __func__, ret); ++ goto exit; ++ } ++exit: ++ return ret; ++} ++ ++static int cfg80211_rtw_sched_scan_stop(struct wiphy *wiphy, ++ struct net_device *dev) ++{ ++ return rtw_android_pno_enable(dev, _FALSE); ++} ++#endif /* CONFIG_PNO_SUPPORT */ ++ ++#ifdef CONFIG_AP_MODE ++static int rtw_cfg80211_set_beacon_wpsp2pie(struct net_device *ndev, char *buf, int len) ++{ ++ int ret = 0; ++ uint wps_ielen = 0; ++ u8 *wps_ie; ++ u32 p2p_ielen = 0; ++ u8 wps_oui[8] = {0x0, 0x50, 0xf2, 0x04}; ++ u8 *p2p_ie; ++ u32 wfd_ielen = 0; ++ u8 *wfd_ie; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ ++ RTW_INFO(FUNC_NDEV_FMT" ielen=%d\n", FUNC_NDEV_ARG(ndev), len); ++ ++ if (len > 0) { ++ wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen); ++ if (wps_ie) { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("bcn_wps_ielen=%d\n", wps_ielen); ++ #endif ++ ++ if (pmlmepriv->wps_beacon_ie) { ++ u32 free_len = pmlmepriv->wps_beacon_ie_len; ++ pmlmepriv->wps_beacon_ie_len = 0; ++ rtw_mfree(pmlmepriv->wps_beacon_ie, free_len); ++ pmlmepriv->wps_beacon_ie = NULL; ++ } ++ ++ pmlmepriv->wps_beacon_ie = rtw_malloc(wps_ielen); ++ if (pmlmepriv->wps_beacon_ie == NULL) { ++ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ ++ _rtw_memcpy(pmlmepriv->wps_beacon_ie, wps_ie, wps_ielen); ++ pmlmepriv->wps_beacon_ie_len = wps_ielen; ++ ++ update_beacon(padapter, _VENDOR_SPECIFIC_IE_, wps_oui, _TRUE); ++ ++ } ++ ++ /* buf += wps_ielen; */ ++ /* len -= wps_ielen; */ ++ ++ #ifdef CONFIG_P2P ++ p2p_ie = rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen); ++ if (p2p_ie) { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("bcn_p2p_ielen=%d\n", p2p_ielen); ++ #endif ++ ++ if (pmlmepriv->p2p_beacon_ie) { ++ u32 free_len = pmlmepriv->p2p_beacon_ie_len; ++ pmlmepriv->p2p_beacon_ie_len = 0; ++ rtw_mfree(pmlmepriv->p2p_beacon_ie, free_len); ++ pmlmepriv->p2p_beacon_ie = NULL; ++ } ++ ++ pmlmepriv->p2p_beacon_ie = rtw_malloc(p2p_ielen); ++ if (pmlmepriv->p2p_beacon_ie == NULL) { ++ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ ++ _rtw_memcpy(pmlmepriv->p2p_beacon_ie, p2p_ie, p2p_ielen); ++ pmlmepriv->p2p_beacon_ie_len = p2p_ielen; ++ ++ } ++ #endif /* CONFIG_P2P */ ++ ++ ++ #ifdef CONFIG_WFD ++ wfd_ie = rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen); ++ if (wfd_ie) { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("bcn_wfd_ielen=%d\n", wfd_ielen); ++ #endif ++ ++ if (rtw_mlme_update_wfd_ie_data(pmlmepriv, MLME_BEACON_IE, wfd_ie, wfd_ielen) != _SUCCESS) ++ return -EINVAL; ++ } ++ #endif /* CONFIG_WFD */ ++ ++ pmlmeext->bstart_bss = _TRUE; ++ ++ } ++ ++ return ret; ++ ++} ++ ++static int rtw_cfg80211_set_probe_resp_wpsp2pie(struct net_device *net, char *buf, int len) ++{ ++ int ret = 0; ++ uint wps_ielen = 0; ++ u8 *wps_ie; ++ u32 p2p_ielen = 0; ++ u8 *p2p_ie; ++ u32 wfd_ielen = 0; ++ u8 *wfd_ie; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s, ielen=%d\n", __func__, len); ++#endif ++ ++ if (len > 0) { ++ wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen); ++ if (wps_ie) { ++ uint attr_contentlen = 0; ++ u16 uconfig_method, *puconfig_method = NULL; ++ ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("probe_resp_wps_ielen=%d\n", wps_ielen); ++ #endif ++ ++ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { ++ u8 sr = 0; ++ rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8 *)(&sr), NULL); ++ ++ if (sr != 0) ++ RTW_INFO("%s, got sr\n", __func__); ++ else { ++ RTW_INFO("GO mode process WPS under site-survey, sr no set\n"); ++ return ret; ++ } ++ } ++ ++ if (pmlmepriv->wps_probe_resp_ie) { ++ u32 free_len = pmlmepriv->wps_probe_resp_ie_len; ++ pmlmepriv->wps_probe_resp_ie_len = 0; ++ rtw_mfree(pmlmepriv->wps_probe_resp_ie, free_len); ++ pmlmepriv->wps_probe_resp_ie = NULL; ++ } ++ ++ pmlmepriv->wps_probe_resp_ie = rtw_malloc(wps_ielen); ++ if (pmlmepriv->wps_probe_resp_ie == NULL) { ++ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ ++ /* add PUSH_BUTTON config_method by driver self in wpsie of probe_resp at GO Mode */ ++ puconfig_method = (u16 *)rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_CONF_METHOD , NULL, &attr_contentlen); ++ if (puconfig_method != NULL) { ++ /* struct registry_priv *pregistrypriv = &padapter->registrypriv; */ ++ struct wireless_dev *wdev = padapter->rtw_wdev; ++ ++ #ifdef CONFIG_DEBUG_CFG80211 ++ /* printk("config_method in wpsie of probe_resp = 0x%x\n", be16_to_cpu(*puconfig_method)); */ ++ #endif ++ ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++ /* for WIFI-DIRECT LOGO 4.2.2, AUTO GO can't set PUSH_BUTTON flags */ ++ if (wdev->iftype == NL80211_IFTYPE_P2P_GO) { ++ uconfig_method = WPS_CM_PUSH_BUTTON; ++ uconfig_method = cpu_to_be16(uconfig_method); ++ ++ *puconfig_method &= ~uconfig_method; ++ } ++ #endif ++ } ++ ++ _rtw_memcpy(pmlmepriv->wps_probe_resp_ie, wps_ie, wps_ielen); ++ pmlmepriv->wps_probe_resp_ie_len = wps_ielen; ++ ++ } ++ ++ /* buf += wps_ielen; */ ++ /* len -= wps_ielen; */ ++ ++ #ifdef CONFIG_P2P ++ p2p_ie = rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen); ++ if (p2p_ie) { ++ u8 is_GO = _FALSE; ++ u32 attr_contentlen = 0; ++ u16 cap_attr = 0; ++ ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("probe_resp_p2p_ielen=%d\n", p2p_ielen); ++ #endif ++ ++ /* Check P2P Capability ATTR */ ++ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8 *)&cap_attr, (uint *) &attr_contentlen)) { ++ u8 grp_cap = 0; ++ /* RTW_INFO( "[%s] Got P2P Capability Attr!!\n", __FUNCTION__ ); */ ++ cap_attr = le16_to_cpu(cap_attr); ++ grp_cap = (u8)((cap_attr >> 8) & 0xff); ++ ++ is_GO = (grp_cap & BIT(0)) ? _TRUE : _FALSE; ++ ++ if (is_GO) ++ RTW_INFO("Got P2P Capability Attr, grp_cap=0x%x, is_GO\n", grp_cap); ++ } ++ ++ ++ if (is_GO == _FALSE) { ++ if (pmlmepriv->p2p_probe_resp_ie) { ++ u32 free_len = pmlmepriv->p2p_probe_resp_ie_len; ++ pmlmepriv->p2p_probe_resp_ie_len = 0; ++ rtw_mfree(pmlmepriv->p2p_probe_resp_ie, free_len); ++ pmlmepriv->p2p_probe_resp_ie = NULL; ++ } ++ ++ pmlmepriv->p2p_probe_resp_ie = rtw_malloc(p2p_ielen); ++ if (pmlmepriv->p2p_probe_resp_ie == NULL) { ++ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ _rtw_memcpy(pmlmepriv->p2p_probe_resp_ie, p2p_ie, p2p_ielen); ++ pmlmepriv->p2p_probe_resp_ie_len = p2p_ielen; ++ } else { ++ if (pmlmepriv->p2p_go_probe_resp_ie) { ++ u32 free_len = pmlmepriv->p2p_go_probe_resp_ie_len; ++ pmlmepriv->p2p_go_probe_resp_ie_len = 0; ++ rtw_mfree(pmlmepriv->p2p_go_probe_resp_ie, free_len); ++ pmlmepriv->p2p_go_probe_resp_ie = NULL; ++ } ++ ++ pmlmepriv->p2p_go_probe_resp_ie = rtw_malloc(p2p_ielen); ++ if (pmlmepriv->p2p_go_probe_resp_ie == NULL) { ++ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ _rtw_memcpy(pmlmepriv->p2p_go_probe_resp_ie, p2p_ie, p2p_ielen); ++ pmlmepriv->p2p_go_probe_resp_ie_len = p2p_ielen; ++ } ++ ++ } ++ #endif /* CONFIG_P2P */ ++ ++ ++ #ifdef CONFIG_WFD ++ wfd_ie = rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen); ++ if (wfd_ie) { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("probe_resp_wfd_ielen=%d\n", wfd_ielen); ++ #endif ++ ++ if (rtw_mlme_update_wfd_ie_data(pmlmepriv, MLME_PROBE_RESP_IE, wfd_ie, wfd_ielen) != _SUCCESS) ++ return -EINVAL; ++ } ++ #endif /* CONFIG_WFD */ ++ ++ } ++ ++ return ret; ++ ++} ++ ++static int rtw_cfg80211_set_assoc_resp_wpsp2pie(struct net_device *net, char *buf, int len) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u8 *ie; ++ u32 ie_len; ++ ++ RTW_INFO("%s, ielen=%d\n", __func__, len); ++ ++ if (len <= 0) ++ goto exit; ++ ++ ie = rtw_get_wps_ie(buf, len, NULL, &ie_len); ++ if (ie && ie_len) { ++ if (pmlmepriv->wps_assoc_resp_ie) { ++ u32 free_len = pmlmepriv->wps_assoc_resp_ie_len; ++ ++ pmlmepriv->wps_assoc_resp_ie_len = 0; ++ rtw_mfree(pmlmepriv->wps_assoc_resp_ie, free_len); ++ pmlmepriv->wps_assoc_resp_ie = NULL; ++ } ++ ++ pmlmepriv->wps_assoc_resp_ie = rtw_malloc(ie_len); ++ if (pmlmepriv->wps_assoc_resp_ie == NULL) { ++ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ } ++ _rtw_memcpy(pmlmepriv->wps_assoc_resp_ie, ie, ie_len); ++ pmlmepriv->wps_assoc_resp_ie_len = ie_len; ++ } ++ ++ ie = rtw_get_p2p_ie(buf, len, NULL, &ie_len); ++ if (ie && ie_len) { ++ if (pmlmepriv->p2p_assoc_resp_ie) { ++ u32 free_len = pmlmepriv->p2p_assoc_resp_ie_len; ++ ++ pmlmepriv->p2p_assoc_resp_ie_len = 0; ++ rtw_mfree(pmlmepriv->p2p_assoc_resp_ie, free_len); ++ pmlmepriv->p2p_assoc_resp_ie = NULL; ++ } ++ ++ pmlmepriv->p2p_assoc_resp_ie = rtw_malloc(ie_len); ++ if (pmlmepriv->p2p_assoc_resp_ie == NULL) { ++ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ } ++ _rtw_memcpy(pmlmepriv->p2p_assoc_resp_ie, ie, ie_len); ++ pmlmepriv->p2p_assoc_resp_ie_len = ie_len; ++ } ++ ++#ifdef CONFIG_WFD ++ ie = rtw_get_wfd_ie(buf, len, NULL, &ie_len); ++ if (rtw_mlme_update_wfd_ie_data(pmlmepriv, MLME_ASSOC_RESP_IE, ie, ie_len) != _SUCCESS) ++ return -EINVAL; ++#endif ++ ++exit: ++ return ret; ++} ++ ++int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, ++ int type) ++{ ++ int ret = 0; ++ uint wps_ielen = 0; ++ u32 p2p_ielen = 0; ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ RTW_INFO("%s, ielen=%d\n", __func__, len); ++#endif ++ ++ if ((rtw_get_wps_ie(buf, len, NULL, &wps_ielen) && (wps_ielen > 0)) ++ #ifdef CONFIG_P2P ++ || (rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen) && (p2p_ielen > 0)) ++ #endif ++ ) { ++ if (net != NULL) { ++ switch (type) { ++ case 0x1: /* BEACON */ ++ ret = rtw_cfg80211_set_beacon_wpsp2pie(net, buf, len); ++ break; ++ case 0x2: /* PROBE_RESP */ ++ ret = rtw_cfg80211_set_probe_resp_wpsp2pie(net, buf, len); ++ #ifdef CONFIG_P2P ++ if (ret == 0) ++ adapter_wdev_data((_adapter *)rtw_netdev_priv(net))->probe_resp_ie_update_time = rtw_get_current_time(); ++ #endif ++ break; ++ case 0x4: /* ASSOC_RESP */ ++ ret = rtw_cfg80211_set_assoc_resp_wpsp2pie(net, buf, len); ++ break; ++ } ++ } ++ } ++ ++ return ret; ++ ++} ++#endif /* CONFIG_AP_MODE */ ++ ++#ifdef CONFIG_80211N_HT ++static void rtw_cfg80211_init_ht_capab_ex(_adapter *padapter, struct ieee80211_sta_ht_cap *ht_cap, enum nl80211_band band, u8 rf_type) ++{ ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++ u8 stbc_rx_enable = _FALSE; ++ ++ rtw_ht_use_default_setting(padapter); ++ ++ /* RX LDPC */ ++ if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_RX)) ++ ht_cap->cap |= IEEE80211_HT_CAP_LDPC_CODING; ++ ++ /* TX STBC */ ++ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX)) ++ ht_cap->cap |= IEEE80211_HT_CAP_TX_STBC; ++ ++ /* RX STBC */ ++ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX)) { ++ /*rtw_rx_stbc 0: disable, bit(0):enable 2.4g, bit(1):enable 5g*/ ++ if (band == NL80211_BAND_2GHZ) ++ stbc_rx_enable = (pregistrypriv->rx_stbc & BIT(0)) ? _TRUE : _FALSE; ++ if (band == NL80211_BAND_5GHZ) ++ stbc_rx_enable = (pregistrypriv->rx_stbc & BIT(1)) ? _TRUE : _FALSE; ++ ++ if (stbc_rx_enable) { ++ switch (rf_type) { ++ case RF_1T1R: ++ ht_cap->cap |= IEEE80211_HT_CAP_RX_STBC_1R;/*RX STBC One spatial stream*/ ++ break; ++ ++ case RF_2T2R: ++ case RF_1T2R: ++ ht_cap->cap |= IEEE80211_HT_CAP_RX_STBC_1R;/* Only one spatial-stream STBC RX is supported */ ++ break; ++ case RF_3T3R: ++ case RF_3T4R: ++ case RF_4T4R: ++ ht_cap->cap |= IEEE80211_HT_CAP_RX_STBC_1R;/* Only one spatial-stream STBC RX is supported */ ++ break; ++ default: ++ RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); ++ break; ++ } ++ } ++ } ++} ++ ++static void rtw_cfg80211_init_ht_capab(_adapter *padapter, struct ieee80211_sta_ht_cap *ht_cap, enum nl80211_band band, u8 rf_type) ++{ ++#define MAX_BIT_RATE_40MHZ_MCS23 450 /* Mbps */ ++#define MAX_BIT_RATE_40MHZ_MCS15 300 /* Mbps */ ++#define MAX_BIT_RATE_40MHZ_MCS7 150 /* Mbps */ ++ ++ ht_cap->ht_supported = _TRUE; ++ ++ ht_cap->cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 | ++ IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_SGI_20 | ++ IEEE80211_HT_CAP_DSSSCCK40 | IEEE80211_HT_CAP_MAX_AMSDU; ++ rtw_cfg80211_init_ht_capab_ex(padapter, ht_cap, band, rf_type); ++ ++ /* ++ *Maximum length of AMPDU that the STA can receive. ++ *Length = 2 ^ (13 + max_ampdu_length_exp) - 1 (octets) ++ */ ++ ht_cap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K; ++ ++ /*Minimum MPDU start spacing , */ ++ ht_cap->ampdu_density = IEEE80211_HT_MPDU_DENSITY_16; ++ ++ ht_cap->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED; ++ ++ /* ++ *hw->wiphy->bands[IEEE80211_BAND_2GHZ] ++ *base on ant_num ++ *rx_mask: RX mask ++ *if rx_ant =1 rx_mask[0]=0xff;==>MCS0-MCS7 ++ *if rx_ant =2 rx_mask[1]=0xff;==>MCS8-MCS15 ++ *if rx_ant >=3 rx_mask[2]=0xff; ++ *if BW_40 rx_mask[4]=0x01; ++ *highest supported RX rate ++ */ ++ if (rf_type == RF_1T1R) { ++ ht_cap->mcs.rx_mask[0] = 0xFF; ++ ++ ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS7; ++ } else if ((rf_type == RF_1T2R) || (rf_type == RF_2T2R) || (rf_type == RF_2T2R_GREEN)) { ++ ht_cap->mcs.rx_mask[0] = 0xFF; ++ ht_cap->mcs.rx_mask[1] = 0xFF; ++ ++ ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS15; ++ } else if ((rf_type == RF_2T3R) || (rf_type == RF_3T3R)) { ++ ht_cap->mcs.rx_mask[0] = 0xFF; ++ ht_cap->mcs.rx_mask[1] = 0xFF; ++ ht_cap->mcs.rx_mask[2] = 0xFF; ++ ++ ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS23; ++ } else { ++ rtw_warn_on(1); ++ RTW_INFO("%s, error rf_type=%d\n", __func__, rf_type); ++ } ++ ++} ++#endif /* CONFIG_80211N_HT */ ++ ++void rtw_cfg80211_init_wdev_data(_adapter *padapter) ++{ ++#ifdef CONFIG_CONCURRENT_MODE ++ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); ++ ++ ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); ++#endif ++} ++ ++void rtw_cfg80211_init_wiphy(_adapter *padapter) ++{ ++ u8 rf_type; ++ struct ieee80211_supported_band *bands; ++ struct wireless_dev *pwdev = padapter->rtw_wdev; ++ struct wiphy *wiphy = pwdev->wiphy; ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ RTW_INFO("%s:rf_type=%d\n", __func__, rf_type); ++ ++#ifdef CONFIG_80211N_HT ++ if (IsSupported24G(padapter->registrypriv.wireless_mode)) { ++ bands = wiphy->bands[NL80211_BAND_2GHZ]; ++ if (bands) ++ rtw_cfg80211_init_ht_capab(padapter, &bands->ht_cap, NL80211_BAND_2GHZ, rf_type); ++ } ++#endif /* CONFIG_80211N_HT */ ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ if (IsSupported5G(padapter->registrypriv.wireless_mode)) { ++ bands = wiphy->bands[NL80211_BAND_5GHZ]; ++ if (bands) ++ rtw_cfg80211_init_ht_capab(padapter, &bands->ht_cap, NL80211_BAND_5GHZ, rf_type); ++ } ++#endif ++ /* init regulary domain */ ++ rtw_regd_init(padapter); ++ ++ /* copy mac_addr to wiphy */ ++ _rtw_memcpy(wiphy->perm_addr, adapter_mac_addr(padapter), ETH_ALEN); ++ ++} ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) ++struct ieee80211_iface_limit rtw_limits[] = { ++ { ++ .max = 2, ++ .types = BIT(NL80211_IFTYPE_STATION) ++ #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) ++ | BIT(NL80211_IFTYPE_P2P_CLIENT) ++ #endif ++ }, ++ #ifdef CONFIG_AP_MODE ++ { ++ .max = 1, ++ .types = BIT(NL80211_IFTYPE_AP) ++ #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) ++ | BIT(NL80211_IFTYPE_P2P_GO) ++ #endif ++ }, ++ #endif ++ #if defined(RTW_DEDICATED_P2P_DEVICE) ++ { ++ .max = 1, ++ .types = BIT(NL80211_IFTYPE_P2P_DEVICE) ++ } ++ #endif ++}; ++ ++struct ieee80211_iface_combination rtw_combinations[] = { ++ { ++ .limits = rtw_limits, ++ .n_limits = ARRAY_SIZE(rtw_limits), ++ #if defined(RTW_DEDICATED_P2P_DEVICE) ++ .max_interfaces = 3, ++ #else ++ .max_interfaces = 2, ++ #endif ++ .num_different_channels = 1, ++ }, ++}; ++#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) */ ++ ++static void rtw_cfg80211_preinit_wiphy(_adapter *adapter, struct wiphy *wiphy) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct registry_priv *regsty = dvobj_to_regsty(dvobj); ++ ++ wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; ++ ++ wiphy->max_scan_ssids = RTW_SSID_SCAN_AMOUNT; ++ wiphy->max_scan_ie_len = RTW_SCAN_IE_LEN_MAX; ++ wiphy->max_num_pmkids = RTW_MAX_NUM_PMKIDS; ++ ++#if CONFIG_RTW_MACADDR_ACL && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) ++ wiphy->max_acl_mac_addrs = NUM_ACL; ++#endif ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) ++ wiphy->max_remain_on_channel_duration = RTW_MAX_REMAIN_ON_CHANNEL_DURATION; ++#endif ++ ++ wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) ++ | BIT(NL80211_IFTYPE_ADHOC) ++#ifdef CONFIG_AP_MODE ++ | BIT(NL80211_IFTYPE_AP) ++ #ifdef CONFIG_WIFI_MONITOR ++ | BIT(NL80211_IFTYPE_MONITOR) ++ #endif ++#endif ++#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) ++ | BIT(NL80211_IFTYPE_P2P_CLIENT) ++ | BIT(NL80211_IFTYPE_P2P_GO) ++ #if defined(RTW_DEDICATED_P2P_DEVICE) ++ | BIT(NL80211_IFTYPE_P2P_DEVICE) ++ #endif ++#endif ++ ; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++#ifdef CONFIG_AP_MODE ++ wiphy->mgmt_stypes = rtw_cfg80211_default_mgmt_stypes; ++#endif /* CONFIG_AP_MODE */ ++#endif ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) ++ #ifdef CONFIG_WIFI_MONITOR ++ wiphy->software_iftypes |= BIT(NL80211_IFTYPE_MONITOR); ++ #endif ++#endif ++ ++#if defined(RTW_SINGLE_WIPHY) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) ++ wiphy->iface_combinations = rtw_combinations; ++ wiphy->n_iface_combinations = ARRAY_SIZE(rtw_combinations); ++#endif ++ ++ wiphy->cipher_suites = rtw_cipher_suites; ++ wiphy->n_cipher_suites = ARRAY_SIZE(rtw_cipher_suites); ++ ++ if (IsSupported24G(adapter->registrypriv.wireless_mode)) ++ wiphy->bands[NL80211_BAND_2GHZ] = rtw_spt_band_alloc(NL80211_BAND_2GHZ); ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ if (IsSupported5G(adapter->registrypriv.wireless_mode)) ++ wiphy->bands[NL80211_BAND_5GHZ] = rtw_spt_band_alloc(NL80211_BAND_5GHZ); ++#endif ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38) && LINUX_VERSION_CODE < KERNEL_VERSION(3, 0, 0)) ++ wiphy->flags |= WIPHY_FLAG_SUPPORTS_SEPARATE_DEFAULT_KEYS; ++#endif ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) ++ wiphy->flags |= WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL; ++ wiphy->flags |= WIPHY_FLAG_HAVE_AP_SME; ++ /* remove WIPHY_FLAG_OFFCHAN_TX, because we not support this feature */ ++ /* wiphy->flags |= WIPHY_FLAG_OFFCHAN_TX | WIPHY_FLAG_HAVE_AP_SME; */ ++#endif ++ ++#if defined(CONFIG_PM) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) ++ wiphy->max_sched_scan_reqs = 1; ++#ifdef CONFIG_PNO_SUPPORT ++ wiphy->max_sched_scan_ssids = MAX_PNO_LIST_COUNT; ++#endif ++#endif ++ ++#if defined(CONFIG_PM) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0)) ++ wiphy->wowlan = wowlan_stub; ++#else ++ wiphy->wowlan = &wowlan_stub; ++#endif ++#endif ++ ++#if defined(CONFIG_TDLS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) ++ wiphy->flags |= WIPHY_FLAG_SUPPORTS_TDLS; ++#ifndef CONFIG_TDLS_DRIVER_SETUP ++ wiphy->flags |= WIPHY_FLAG_TDLS_EXTERNAL_SETUP; /* Driver handles key exchange */ ++ wiphy->flags |= NL80211_ATTR_HT_CAPABILITY; ++#endif /* CONFIG_TDLS_DRIVER_SETUP */ ++#endif /* CONFIG_TDLS */ ++ ++ if (regsty->power_mgnt != PS_MODE_ACTIVE) ++ wiphy->flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT; ++ else ++ wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) ++ /* wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM; */ ++#endif ++} ++ ++static struct cfg80211_ops rtw_cfg80211_ops = { ++ .change_virtual_intf = cfg80211_rtw_change_iface, ++ .add_key = cfg80211_rtw_add_key, ++ .get_key = cfg80211_rtw_get_key, ++ .del_key = cfg80211_rtw_del_key, ++ .set_default_key = cfg80211_rtw_set_default_key, ++#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 1, 0)) ++ .set_rekey_data = cfg80211_rtw_set_rekey_data, ++#endif /*CONFIG_GTK_OL*/ ++ .get_station = cfg80211_rtw_get_station, ++ .scan = cfg80211_rtw_scan, ++ .set_wiphy_params = cfg80211_rtw_set_wiphy_params, ++ .connect = cfg80211_rtw_connect, ++ .disconnect = cfg80211_rtw_disconnect, ++ .join_ibss = cfg80211_rtw_join_ibss, ++ .leave_ibss = cfg80211_rtw_leave_ibss, ++ .set_tx_power = cfg80211_rtw_set_txpower, ++ .get_tx_power = cfg80211_rtw_get_txpower, ++ .set_power_mgmt = cfg80211_rtw_set_power_mgmt, ++ .set_pmksa = cfg80211_rtw_set_pmksa, ++ .del_pmksa = cfg80211_rtw_del_pmksa, ++ .flush_pmksa = cfg80211_rtw_flush_pmksa, ++ ++#ifdef CONFIG_AP_MODE ++ .add_virtual_intf = cfg80211_rtw_add_virtual_intf, ++ .del_virtual_intf = cfg80211_rtw_del_virtual_intf, ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) && !defined(COMPAT_KERNEL_RELEASE) ++ .add_beacon = cfg80211_rtw_add_beacon, ++ .set_beacon = cfg80211_rtw_set_beacon, ++ .del_beacon = cfg80211_rtw_del_beacon, ++#else ++ .start_ap = cfg80211_rtw_start_ap, ++ .change_beacon = cfg80211_rtw_change_beacon, ++ .stop_ap = cfg80211_rtw_stop_ap, ++#endif ++ ++#if CONFIG_RTW_MACADDR_ACL && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) ++ .set_mac_acl = cfg80211_rtw_set_mac_acl, ++#endif ++ ++ .add_station = cfg80211_rtw_add_station, ++ .del_station = cfg80211_rtw_del_station, ++ .change_station = cfg80211_rtw_change_station, ++ .dump_station = cfg80211_rtw_dump_station, ++ .change_bss = cfg80211_rtw_change_bss, ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) ++ .set_channel = cfg80211_rtw_set_channel, ++#endif ++ /* .auth = cfg80211_rtw_auth, */ ++ /* .assoc = cfg80211_rtw_assoc, */ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ .set_monitor_channel = cfg80211_rtw_set_monitor_channel, ++#endif ++#endif /* CONFIG_AP_MODE */ ++ ++#ifdef CONFIG_P2P ++ .remain_on_channel = cfg80211_rtw_remain_on_channel, ++ .cancel_remain_on_channel = cfg80211_rtw_cancel_remain_on_channel, ++ #if defined(RTW_DEDICATED_P2P_DEVICE) ++ .start_p2p_device = cfg80211_rtw_start_p2p_device, ++ .stop_p2p_device = cfg80211_rtw_stop_p2p_device, ++ #endif ++#endif /* CONFIG_P2P */ ++ ++#ifdef CONFIG_RTW_80211R ++ .update_ft_ies = cfg80211_rtw_update_ft_ies, ++#endif ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) ++ .mgmt_tx = cfg80211_rtw_mgmt_tx, ++ .mgmt_frame_register = cfg80211_rtw_mgmt_frame_register, ++#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34) && LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) ++ .action = cfg80211_rtw_mgmt_tx, ++#endif ++ ++#if defined(CONFIG_TDLS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) ++ .tdls_mgmt = cfg80211_rtw_tdls_mgmt, ++ .tdls_oper = cfg80211_rtw_tdls_oper, ++#endif /* CONFIG_TDLS */ ++ ++#if defined(CONFIG_PNO_SUPPORT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) ++ .sched_scan_start = cfg80211_rtw_sched_scan_start, ++ .sched_scan_stop = cfg80211_rtw_sched_scan_stop, ++#endif /* CONFIG_PNO_SUPPORT */ ++}; ++ ++struct wiphy *rtw_wiphy_alloc(_adapter *padapter, struct device *dev) ++{ ++ struct wiphy *wiphy; ++ struct rtw_wiphy_data *wiphy_data; ++ ++ /* wiphy */ ++ wiphy = wiphy_new(&rtw_cfg80211_ops, sizeof(struct rtw_wiphy_data)); ++ if (!wiphy) { ++ RTW_INFO("Couldn't allocate wiphy device\n"); ++ goto exit; ++ } ++ set_wiphy_dev(wiphy, dev); ++ ++ /* wiphy_data */ ++ wiphy_data = rtw_wiphy_priv(wiphy); ++ wiphy_data->dvobj = adapter_to_dvobj(padapter); ++#ifndef RTW_SINGLE_WIPHY ++ wiphy_data->adapter = padapter; ++#endif ++ ++ rtw_cfg80211_preinit_wiphy(padapter, wiphy); ++ ++ RTW_INFO(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); ++ ++exit: ++ return wiphy; ++} ++ ++void rtw_wiphy_free(struct wiphy *wiphy) ++{ ++ if (!wiphy) ++ return; ++ ++ RTW_INFO(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); ++ ++ if (wiphy->bands[NL80211_BAND_2GHZ]) { ++ rtw_spt_band_free(wiphy->bands[NL80211_BAND_2GHZ]); ++ wiphy->bands[NL80211_BAND_2GHZ] = NULL; ++ } ++ if (wiphy->bands[NL80211_BAND_5GHZ]) { ++ rtw_spt_band_free(wiphy->bands[NL80211_BAND_5GHZ]); ++ wiphy->bands[NL80211_BAND_5GHZ] = NULL; ++ } ++ ++ wiphy_free(wiphy); ++} ++ ++int rtw_wiphy_register(struct wiphy *wiphy) ++{ ++ RTW_INFO(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) ++ rtw_cfgvendor_attach(wiphy); ++#endif ++ ++ return wiphy_register(wiphy); ++} ++ ++void rtw_wiphy_unregister(struct wiphy *wiphy) ++{ ++ RTW_INFO(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) ++ rtw_cfgvendor_detach(wiphy); ++#endif ++ ++ #if defined(RTW_DEDICATED_P2P_DEVICE) ++ rtw_pd_iface_free(wiphy); ++ #endif ++ ++ return wiphy_unregister(wiphy); ++} ++ ++int rtw_wdev_alloc(_adapter *padapter, struct wiphy *wiphy) ++{ ++ int ret = 0; ++ struct net_device *pnetdev = padapter->pnetdev; ++ struct wireless_dev *wdev; ++ struct rtw_wdev_priv *pwdev_priv; ++ ++ RTW_INFO("%s(padapter=%p)\n", __func__, padapter); ++ ++ /* wdev */ ++ wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); ++ if (!wdev) { ++ RTW_INFO("Couldn't allocate wireless device\n"); ++ ret = -ENOMEM; ++ goto exit; ++ } ++ wdev->wiphy = wiphy; ++ wdev->netdev = pnetdev; ++ ++ wdev->iftype = NL80211_IFTYPE_STATION; /* will be init in rtw_hal_init() */ ++ /* Must sync with _rtw_init_mlme_priv() */ ++ /* pmlmepriv->fw_state = WIFI_STATION_STATE */ ++ /* wdev->iftype = NL80211_IFTYPE_MONITOR; */ /* for rtw_setopmode_cmd() in cfg80211_rtw_change_iface() */ ++ padapter->rtw_wdev = wdev; ++ pnetdev->ieee80211_ptr = wdev; ++ ++ /* init pwdev_priv */ ++ pwdev_priv = adapter_wdev_data(padapter); ++ pwdev_priv->rtw_wdev = wdev; ++ pwdev_priv->pmon_ndev = NULL; ++ pwdev_priv->ifname_mon[0] = '\0'; ++ pwdev_priv->padapter = padapter; ++ pwdev_priv->scan_request = NULL; ++ _rtw_spinlock_init(&pwdev_priv->scan_req_lock); ++ pwdev_priv->connect_req = NULL; ++ _rtw_spinlock_init(&pwdev_priv->connect_req_lock); ++ ++ pwdev_priv->p2p_enabled = _FALSE; ++ pwdev_priv->probe_resp_ie_update_time = rtw_get_current_time(); ++ pwdev_priv->provdisc_req_issued = _FALSE; ++ rtw_wdev_invit_info_init(&pwdev_priv->invit_info); ++ rtw_wdev_nego_info_init(&pwdev_priv->nego_info); ++ ++ pwdev_priv->bandroid_scan = _FALSE; ++ ++ if (padapter->registrypriv.power_mgnt != PS_MODE_ACTIVE) ++ pwdev_priv->power_mgmt = _TRUE; ++ else ++ pwdev_priv->power_mgmt = _FALSE; ++ ++ _rtw_mutex_init(&pwdev_priv->roch_mutex); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); ++#endif ++ ++exit: ++ return ret; ++} ++ ++void rtw_wdev_free(struct wireless_dev *wdev) ++{ ++ if (!wdev) ++ return; ++ ++ RTW_INFO("%s(wdev=%p)\n", __func__, wdev); ++ ++ if (wdev_to_ndev(wdev)) { ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(wdev_to_ndev(wdev)); ++ struct rtw_wdev_priv *wdev_priv = adapter_wdev_data(adapter); ++ _irqL irqL; ++ ++ _rtw_spinlock_free(&wdev_priv->scan_req_lock); ++ ++ _enter_critical_bh(&wdev_priv->connect_req_lock, &irqL); ++ rtw_wdev_free_connect_req(wdev_priv); ++ _exit_critical_bh(&wdev_priv->connect_req_lock, &irqL); ++ _rtw_spinlock_free(&wdev_priv->connect_req_lock); ++ ++ _rtw_mutex_free(&wdev_priv->roch_mutex); ++ } ++ ++ rtw_mfree((u8 *)wdev, sizeof(struct wireless_dev)); ++} ++ ++void rtw_wdev_unregister(struct wireless_dev *wdev) ++{ ++ struct net_device *ndev; ++ _adapter *adapter; ++ struct rtw_wdev_priv *pwdev_priv; ++ ++ if (!wdev) ++ return; ++ ++ RTW_INFO("%s(wdev=%p)\n", __func__, wdev); ++ ++ ndev = wdev_to_ndev(wdev); ++ if (!ndev) ++ return; ++ ++ adapter = (_adapter *)rtw_netdev_priv(ndev); ++ pwdev_priv = adapter_wdev_data(adapter); ++ ++ rtw_cfg80211_indicate_scan_done(adapter, _TRUE); ++ ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) || defined(COMPAT_KERNEL_RELEASE) ++ if (wdev->current_bss) { ++ RTW_INFO(FUNC_ADPT_FMT" clear current_bss by cfg80211_disconnected\n", FUNC_ADPT_ARG(adapter)); ++ rtw_cfg80211_indicate_disconnect(adapter, 0, 1); ++ } ++ #endif ++ ++ if (pwdev_priv->pmon_ndev) { ++ RTW_INFO("%s, unregister monitor interface\n", __func__); ++ unregister_netdev(pwdev_priv->pmon_ndev); ++ } ++} ++ ++int rtw_cfg80211_ndev_res_alloc(_adapter *adapter) ++{ ++ int ret = _FAIL; ++ ++#if !defined(RTW_SINGLE_WIPHY) ++ struct wiphy *wiphy; ++ struct device *dev = dvobj_to_dev(adapter_to_dvobj(adapter)); ++ ++ wiphy = rtw_wiphy_alloc(adapter, dev); ++ if (wiphy == NULL) ++ goto exit; ++ ++ adapter->wiphy = wiphy; ++#endif ++ ++ if (rtw_wdev_alloc(adapter, adapter_to_wiphy(adapter)) == 0) ++ ret = _SUCCESS; ++ ++#if !defined(RTW_SINGLE_WIPHY) ++ if (ret != _SUCCESS) { ++ rtw_wiphy_free(wiphy); ++ adapter->wiphy = NULL; ++ } ++#endif ++ ++exit: ++ return ret; ++} ++ ++void rtw_cfg80211_ndev_res_free(_adapter *adapter) ++{ ++ rtw_wdev_free(adapter->rtw_wdev); ++#if !defined(RTW_SINGLE_WIPHY) ++ rtw_wiphy_free(adapter_to_wiphy(adapter)); ++ adapter->wiphy = NULL; ++#endif ++} ++ ++int rtw_cfg80211_ndev_res_register(_adapter *adapter) ++{ ++ int ret = _FAIL; ++ ++#if !defined(RTW_SINGLE_WIPHY) ++ if (rtw_wiphy_register(adapter_to_wiphy(adapter)) < 0) { ++ RTW_INFO("%s rtw_wiphy_register fail for if%d\n", __func__, (adapter->iface_id + 1)); ++ goto exit; ++ } ++#endif ++ ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++ ++void rtw_cfg80211_ndev_res_unregister(_adapter *adapter) ++{ ++ rtw_wdev_unregister(adapter->rtw_wdev); ++} ++ ++int rtw_cfg80211_dev_res_alloc(struct dvobj_priv *dvobj) ++{ ++ int ret = _FAIL; ++ ++#if defined(RTW_SINGLE_WIPHY) ++ struct wiphy *wiphy; ++ struct device *dev = dvobj_to_dev(dvobj); ++ ++ wiphy = rtw_wiphy_alloc(dvobj->padapters[IFACE_ID0], dev); ++ if (wiphy == NULL) ++ goto exit; ++ ++ dvobj->wiphy = wiphy; ++#endif ++ ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++ ++void rtw_cfg80211_dev_res_free(struct dvobj_priv *dvobj) ++{ ++#if defined(RTW_SINGLE_WIPHY) ++ rtw_wiphy_free(dvobj_to_wiphy(dvobj)); ++ dvobj->wiphy = NULL; ++#endif ++} ++ ++int rtw_cfg80211_dev_res_register(struct dvobj_priv *dvobj) ++{ ++ int ret = _FAIL; ++ ++#if defined(RTW_SINGLE_WIPHY) ++ if (rtw_wiphy_register(dvobj_to_wiphy(dvobj)) != 0) ++ goto exit; ++#endif ++ ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++ ++void rtw_cfg80211_dev_res_unregister(struct dvobj_priv *dvobj) ++{ ++#if defined(RTW_SINGLE_WIPHY) ++ rtw_wiphy_unregister(dvobj_to_wiphy(dvobj)); ++#endif ++} ++ ++#endif /* CONFIG_IOCTL_CFG80211 */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.h linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.h +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.h 2018-02-11 21:44:27.174146497 +0200 +@@ -0,0 +1,353 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __IOCTL_CFG80211_H__ ++#define __IOCTL_CFG80211_H__ ++ ++ ++#ifndef RTW_CFG80211_ALWAYS_INFORM_STA_DISCONNECT_EVENT ++ #define RTW_CFG80211_ALWAYS_INFORM_STA_DISCONNECT_EVENT 0 ++#endif ++ ++#if defined(RTW_USE_CFG80211_STA_EVENT) ++ #undef CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER ++#endif ++ ++#ifndef RTW_P2P_GROUP_INTERFACE ++ #define RTW_P2P_GROUP_INTERFACE 0 ++#endif ++ ++/* ++* (RTW_P2P_GROUP_INTERFACE, RTW_DEDICATED_P2P_DEVICE) ++* (0, 0): wlan0 + p2p0(PD+PG) ++* (1, 0): wlan0(with PD) + dynamic PGs ++* (1, 1): wlan0 (with dynamic PD wdev) + dynamic PGs ++*/ ++ ++#if RTW_P2P_GROUP_INTERFACE ++ #ifndef CONFIG_RTW_DYNAMIC_NDEV ++ #define CONFIG_RTW_DYNAMIC_NDEV ++ #endif ++ #ifndef RTW_SINGLE_WIPHY ++ #define RTW_SINGLE_WIPHY ++ #endif ++ #ifndef CONFIG_RADIO_WORK ++ #define CONFIG_RADIO_WORK ++ #endif ++ #ifndef RTW_DEDICATED_P2P_DEVICE ++ #define RTW_DEDICATED_P2P_DEVICE ++ #endif ++#endif ++ ++#if !defined(CONFIG_P2P) && RTW_P2P_GROUP_INTERFACE ++ #error "RTW_P2P_GROUP_INTERFACE can't be enabled when CONFIG_P2P is disabled\n" ++#endif ++ ++#if !RTW_P2P_GROUP_INTERFACE && defined(RTW_DEDICATED_P2P_DEVICE) ++ #error "RTW_DEDICATED_P2P_DEVICE can't be enabled when RTW_P2P_GROUP_INTERFACE is disabled\n" ++#endif ++ ++#if defined(RTW_DEDICATED_P2P_DEVICE) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 7, 0)) ++ #error "RTW_DEDICATED_P2P_DEVICE can't be enabled when kernel < 3.7.0\n" ++#endif ++ ++struct rtw_wdev_invit_info { ++ u8 state; /* 0: req, 1:rep */ ++ u8 peer_mac[ETH_ALEN]; ++ u8 group_bssid[ETH_ALEN]; ++ u8 active; ++ u8 token; ++ u8 flags; ++ u8 status; ++ u8 req_op_ch; ++ u8 rsp_op_ch; ++}; ++ ++#define rtw_wdev_invit_info_init(invit_info) \ ++ do { \ ++ (invit_info)->state = 0xff; \ ++ _rtw_memset((invit_info)->peer_mac, 0, ETH_ALEN); \ ++ _rtw_memset((invit_info)->group_bssid, 0, ETH_ALEN); \ ++ (invit_info)->active = 0xff; \ ++ (invit_info)->token = 0; \ ++ (invit_info)->flags = 0x00; \ ++ (invit_info)->status = 0xff; \ ++ (invit_info)->req_op_ch = 0; \ ++ (invit_info)->rsp_op_ch = 0; \ ++ } while (0) ++ ++struct rtw_wdev_nego_info { ++ u8 state; /* 0: req, 1:rep, 2:conf */ ++ u8 iface_addr[ETH_ALEN]; ++ u8 peer_mac[ETH_ALEN]; ++ u8 peer_iface_addr[ETH_ALEN]; ++ u8 active; ++ u8 token; ++ u8 status; ++ u8 req_intent; ++ u8 req_op_ch; ++ u8 req_listen_ch; ++ u8 rsp_intent; ++ u8 rsp_op_ch; ++ u8 conf_op_ch; ++}; ++ ++#define rtw_wdev_nego_info_init(nego_info) \ ++ do { \ ++ (nego_info)->state = 0xff; \ ++ _rtw_memset((nego_info)->iface_addr, 0, ETH_ALEN); \ ++ _rtw_memset((nego_info)->peer_mac, 0, ETH_ALEN); \ ++ _rtw_memset((nego_info)->peer_iface_addr, 0, ETH_ALEN); \ ++ (nego_info)->active = 0xff; \ ++ (nego_info)->token = 0; \ ++ (nego_info)->status = 0xff; \ ++ (nego_info)->req_intent = 0xff; \ ++ (nego_info)->req_op_ch = 0; \ ++ (nego_info)->req_listen_ch = 0; \ ++ (nego_info)->rsp_intent = 0xff; \ ++ (nego_info)->rsp_op_ch = 0; \ ++ (nego_info)->conf_op_ch = 0; \ ++ } while (0) ++ ++struct rtw_wdev_priv { ++ struct wireless_dev *rtw_wdev; ++ ++ _adapter *padapter; ++ ++ #if !RTW_CFG80211_ALWAYS_INFORM_STA_DISCONNECT_EVENT ++ u8 not_indic_disco; ++ #endif ++ ++ struct cfg80211_scan_request *scan_request; ++ _lock scan_req_lock; ++ ++ struct cfg80211_connect_params *connect_req; ++ _lock connect_req_lock; ++ ++ struct net_device *pmon_ndev;/* for monitor interface */ ++ char ifname_mon[IFNAMSIZ + 1]; /* interface name for monitor interface */ ++ ++ u8 p2p_enabled; ++ u32 probe_resp_ie_update_time; ++ ++ u8 provdisc_req_issued; ++ ++ struct rtw_wdev_invit_info invit_info; ++ struct rtw_wdev_nego_info nego_info; ++ ++ u8 bandroid_scan; ++ bool block; ++ bool block_scan; ++ bool power_mgmt; ++ ++ /* report mgmt_frame registered */ ++ u16 report_mgmt; ++ ++ u8 is_mgmt_tx; ++ ++ _mutex roch_mutex; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ ATOMIC_T switch_ch_to; ++#endif ++ ++}; ++ ++#if RTW_CFG80211_ALWAYS_INFORM_STA_DISCONNECT_EVENT ++#define rtw_wdev_not_indic_disco(rtw_wdev_data) 0 ++#define rtw_wdev_set_not_indic_disco(rtw_wdev_data, val) do {} while (0) ++#else ++#define rtw_wdev_not_indic_disco(rtw_wdev_data) ((rtw_wdev_data)->not_indic_disco) ++#define rtw_wdev_set_not_indic_disco(rtw_wdev_data, val) do { (rtw_wdev_data)->not_indic_disco = (val); } while (0) ++#endif ++ ++#define rtw_wdev_free_connect_req(rtw_wdev_data) \ ++ do { \ ++ if ((rtw_wdev_data)->connect_req) { \ ++ rtw_mfree((u8 *)(rtw_wdev_data)->connect_req, sizeof(*(rtw_wdev_data)->connect_req)); \ ++ (rtw_wdev_data)->connect_req = NULL; \ ++ } \ ++ } while (0) ++ ++#define wdev_to_ndev(w) ((w)->netdev) ++#define wdev_to_wiphy(w) ((w)->wiphy) ++#define ndev_to_wdev(n) ((n)->ieee80211_ptr) ++ ++struct rtw_wiphy_data { ++ struct dvobj_priv *dvobj; ++ ++#ifndef RTW_SINGLE_WIPHY ++ _adapter *adapter; ++#endif ++ ++#if defined(RTW_DEDICATED_P2P_DEVICE) ++ struct wireless_dev *pd_wdev; /* P2P device wdev */ ++#endif ++}; ++ ++#define rtw_wiphy_priv(wiphy) ((struct rtw_wiphy_data *)wiphy_priv(wiphy)) ++#define wiphy_to_dvobj(wiphy) (((struct rtw_wiphy_data *)wiphy_priv(wiphy))->dvobj) ++#ifdef RTW_SINGLE_WIPHY ++#define wiphy_to_adapter(wiphy) (dvobj_get_primary_adapter(wiphy_to_dvobj(wiphy))) ++#else ++#define wiphy_to_adapter(wiphy) (((struct rtw_wiphy_data *)wiphy_priv(wiphy))->adapter) ++#endif ++ ++#if defined(RTW_DEDICATED_P2P_DEVICE) ++#define wiphy_to_pd_wdev(wiphy) (rtw_wiphy_priv(wiphy)->pd_wdev) ++#else ++#define wiphy_to_pd_wdev(wiphy) NULL ++#endif ++ ++#define WIPHY_FMT "%s" ++#define WIPHY_ARG(wiphy) wiphy_name(wiphy) ++#define FUNC_WIPHY_FMT "%s("WIPHY_FMT")" ++#define FUNC_WIPHY_ARG(wiphy) __func__, WIPHY_ARG(wiphy) ++ ++#define SET_CFG80211_REPORT_MGMT(w, t, v) (w->report_mgmt |= (v ? BIT(t >> 4) : 0)) ++#define GET_CFG80211_REPORT_MGMT(w, t) ((w->report_mgmt & BIT(t >> 4)) > 0) ++ ++struct wiphy *rtw_wiphy_alloc(_adapter *padapter, struct device *dev); ++void rtw_wiphy_free(struct wiphy *wiphy); ++int rtw_wiphy_register(struct wiphy *wiphy); ++void rtw_wiphy_unregister(struct wiphy *wiphy); ++ ++int rtw_wdev_alloc(_adapter *padapter, struct wiphy *wiphy); ++void rtw_wdev_free(struct wireless_dev *wdev); ++void rtw_wdev_unregister(struct wireless_dev *wdev); ++ ++int rtw_cfg80211_ndev_res_alloc(_adapter *adapter); ++void rtw_cfg80211_ndev_res_free(_adapter *adapter); ++int rtw_cfg80211_ndev_res_register(_adapter *adapter); ++void rtw_cfg80211_ndev_res_unregister(_adapter *adapter); ++ ++int rtw_cfg80211_dev_res_alloc(struct dvobj_priv *dvobj); ++void rtw_cfg80211_dev_res_free(struct dvobj_priv *dvobj); ++int rtw_cfg80211_dev_res_register(struct dvobj_priv *dvobj); ++void rtw_cfg80211_dev_res_unregister(struct dvobj_priv *dvobj); ++ ++void rtw_cfg80211_init_wdev_data(_adapter *padapter); ++void rtw_cfg80211_init_wiphy(_adapter *padapter); ++ ++void rtw_cfg80211_unlink_bss(_adapter *padapter, struct wlan_network *pnetwork); ++void rtw_cfg80211_surveydone_event_callback(_adapter *padapter); ++struct cfg80211_bss *rtw_cfg80211_inform_bss(_adapter *padapter, struct wlan_network *pnetwork); ++int rtw_cfg80211_check_bss(_adapter *padapter); ++void rtw_cfg80211_ibss_indicate_connect(_adapter *padapter); ++void rtw_cfg80211_indicate_connect(_adapter *padapter); ++void rtw_cfg80211_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally_generated); ++void rtw_cfg80211_indicate_scan_done(_adapter *adapter, bool aborted); ++u32 rtw_cfg80211_wait_scan_req_empty(_adapter *adapter, u32 timeout_ms); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++u8 rtw_cfg80211_scan_via_buddy(_adapter *padapter, struct cfg80211_scan_request *request); ++void rtw_cfg80211_indicate_scan_done_for_buddy(_adapter *padapter, bool bscan_aborted); ++#endif ++ ++#ifdef CONFIG_AP_MODE ++void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint frame_len); ++void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, unsigned short reason); ++#endif /* CONFIG_AP_MODE */ ++ ++#ifdef CONFIG_P2P ++void rtw_cfg80211_set_is_roch(_adapter *adapter, bool val); ++bool rtw_cfg80211_get_is_roch(_adapter *adapter); ++ ++int rtw_cfg80211_iface_has_p2p_group_cap(_adapter *adapter); ++int rtw_cfg80211_is_p2p_scan(_adapter *adapter); ++#if defined(RTW_DEDICATED_P2P_DEVICE) ++int rtw_cfg80211_redirect_pd_wdev(struct wiphy *wiphy, u8 *ra, struct wireless_dev **wdev); ++int rtw_cfg80211_is_scan_by_pd_wdev(_adapter *adapter); ++int rtw_pd_iface_alloc(struct wiphy *wiphy, const char *name, struct wireless_dev **pd_wdev); ++void rtw_pd_iface_free(struct wiphy *wiphy); ++#endif ++#endif /* CONFIG_P2P */ ++ ++void rtw_cfg80211_set_is_mgmt_tx(_adapter *adapter, u8 val); ++u8 rtw_cfg80211_get_is_mgmt_tx(_adapter *adapter); ++ ++void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, size_t len); ++ ++void rtw_cfg80211_rx_p2p_action_public(_adapter *padapter, union recv_frame *rframe); ++void rtw_cfg80211_rx_action_p2p(_adapter *padapter, union recv_frame *rframe); ++void rtw_cfg80211_rx_action(_adapter *adapter, union recv_frame *rframe, const char *msg); ++void rtw_cfg80211_rx_probe_request(_adapter *padapter, union recv_frame *rframe); ++ ++int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, int type); ++ ++bool rtw_cfg80211_pwr_mgmt(_adapter *adapter); ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) && !defined(COMPAT_KERNEL_RELEASE) ++#define rtw_cfg80211_rx_mgmt(wdev, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt(wdev_to_ndev(wdev), freq, buf, len, gfp) ++#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) ++#define rtw_cfg80211_rx_mgmt(wdev, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt(wdev_to_ndev(wdev), freq, sig_dbm, buf, len, gfp) ++#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0)) ++#define rtw_cfg80211_rx_mgmt(wdev, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt(wdev, freq, sig_dbm, buf, len, gfp) ++#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3 , 18 , 0)) ++#define rtw_cfg80211_rx_mgmt(wdev , freq , sig_dbm , buf , len , gfp) cfg80211_rx_mgmt(wdev , freq , sig_dbm , buf , len , 0 , gfp) ++#else ++#define rtw_cfg80211_rx_mgmt(wdev , freq , sig_dbm , buf , len , gfp) cfg80211_rx_mgmt(wdev , freq , sig_dbm , buf , len , 0) ++#endif ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) && !defined(COMPAT_KERNEL_RELEASE) ++#define rtw_cfg80211_send_rx_assoc(adapter, bss, buf, len) cfg80211_send_rx_assoc((adapter)->pnetdev, buf, len) ++#else ++#define rtw_cfg80211_send_rx_assoc(adapter, bss, buf, len) cfg80211_send_rx_assoc((adapter)->pnetdev, bss, buf, len) ++#endif ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) ++#define rtw_cfg80211_mgmt_tx_status(wdev, cookie, buf, len, ack, gfp) cfg80211_mgmt_tx_status(wdev_to_ndev(wdev), cookie, buf, len, ack, gfp) ++#else ++#define rtw_cfg80211_mgmt_tx_status(wdev, cookie, buf, len, ack, gfp) cfg80211_mgmt_tx_status(wdev, cookie, buf, len, ack, gfp) ++#endif ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) ++#define rtw_cfg80211_ready_on_channel(wdev, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel(wdev_to_ndev(wdev), cookie, chan, channel_type, duration, gfp) ++#define rtw_cfg80211_remain_on_channel_expired(wdev, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired(wdev_to_ndev(wdev), cookie, chan, chan_type, gfp) ++#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) ++#define rtw_cfg80211_ready_on_channel(wdev, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel(wdev, cookie, chan, channel_type, duration, gfp) ++#define rtw_cfg80211_remain_on_channel_expired(wdev, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired(wdev, cookie, chan, chan_type, gfp) ++#else ++#define rtw_cfg80211_ready_on_channel(wdev, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel(wdev, cookie, chan, duration, gfp) ++#define rtw_cfg80211_remain_on_channel_expired(wdev, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired(wdev, cookie, chan, gfp) ++#endif ++ ++#define rtw_cfg80211_connect_result(wdev, bssid, req_ie, req_ie_len, resp_ie, resp_ie_len, status, gfp) cfg80211_connect_result(wdev_to_ndev(wdev), bssid, req_ie, req_ie_len, resp_ie, resp_ie_len, status, gfp) ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 2, 0)) ++#define rtw_cfg80211_disconnected(wdev, reason, ie, ie_len, locally_generated, gfp) cfg80211_disconnected(wdev_to_ndev(wdev), reason, ie, ie_len, gfp) ++#else ++#define rtw_cfg80211_disconnected(wdev, reason, ie, ie_len, locally_generated, gfp) cfg80211_disconnected(wdev_to_ndev(wdev), reason, ie, ie_len, locally_generated, gfp) ++#endif ++ ++#ifdef CONFIG_RTW_80211R ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) ++#define rtw_cfg80211_ft_event(adapter, parm) cfg80211_ft_event((adapter)->pnetdev, parm) ++#else ++ #error "Cannot support FT for KERNEL_VERSION < 3.10\n" ++#endif ++#endif ++ ++#if (KERNEL_VERSION(4, 7, 0) >= LINUX_VERSION_CODE) ++#define NUM_NL80211_BANDS IEEE80211_NUM_BANDS ++#endif ++ ++#include "rtw_cfgvendor.h" ++ ++#endif /* __IOCTL_CFG80211_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_linux.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_linux.c 2018-02-11 21:44:27.175146513 +0200 +@@ -0,0 +1,13299 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _IOCTL_LINUX_C_ ++ ++#include ++#include ++#include ++#include "../../hal/phydm/phydm_precomp.h" ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 27)) ++#define iwe_stream_add_event(a, b, c, d, e) iwe_stream_add_event(b, c, d, e) ++#define iwe_stream_add_point(a, b, c, d, e) iwe_stream_add_point(b, c, d, e) ++#endif ++ ++#ifdef CONFIG_80211N_HT ++extern int rtw_ht_enable; ++#endif ++ ++ ++#define RTL_IOCTL_WPA_SUPPLICANT (SIOCIWFIRSTPRIV+30) ++ ++#define SCAN_ITEM_SIZE 768 ++#define MAX_CUSTOM_LEN 64 ++#define RATE_COUNT 4 ++ ++#ifdef CONFIG_GLOBAL_UI_PID ++extern int ui_pid[3]; ++#endif ++ ++/* combo scan */ ++#define WEXT_CSCAN_AMOUNT 9 ++#define WEXT_CSCAN_BUF_LEN 360 ++#define WEXT_CSCAN_HEADER "CSCAN S\x01\x00\x00S\x00" ++#define WEXT_CSCAN_HEADER_SIZE 12 ++#define WEXT_CSCAN_SSID_SECTION 'S' ++#define WEXT_CSCAN_CHANNEL_SECTION 'C' ++#define WEXT_CSCAN_NPROBE_SECTION 'N' ++#define WEXT_CSCAN_ACTV_DWELL_SECTION 'A' ++#define WEXT_CSCAN_PASV_DWELL_SECTION 'P' ++#define WEXT_CSCAN_HOME_DWELL_SECTION 'H' ++#define WEXT_CSCAN_TYPE_SECTION 'T' ++ ++ ++extern u8 key_2char2num(u8 hch, u8 lch); ++extern u8 str_2char2num(u8 hch, u8 lch); ++extern void macstr2num(u8 *dst, u8 *src); ++extern u8 convert_ip_addr(u8 hch, u8 mch, u8 lch); ++ ++u32 rtw_rates[] = {1000000, 2000000, 5500000, 11000000, ++ 6000000, 9000000, 12000000, 18000000, 24000000, 36000000, 48000000, 54000000}; ++ ++static const char *const iw_operation_mode[] = { ++ "Auto", "Ad-Hoc", "Managed", "Master", "Repeater", "Secondary", "Monitor" ++}; ++ ++static int hex2num_i(char c) ++{ ++ if (c >= '0' && c <= '9') ++ return c - '0'; ++ if (c >= 'a' && c <= 'f') ++ return c - 'a' + 10; ++ if (c >= 'A' && c <= 'F') ++ return c - 'A' + 10; ++ return -1; ++} ++ ++static int hex2byte_i(const char *hex) ++{ ++ int a, b; ++ a = hex2num_i(*hex++); ++ if (a < 0) ++ return -1; ++ b = hex2num_i(*hex++); ++ if (b < 0) ++ return -1; ++ return (a << 4) | b; ++} ++ ++/** ++ * hwaddr_aton - Convert ASCII string to MAC address ++ * @txt: MAC address as a string (e.g., "00:11:22:33:44:55") ++ * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes) ++ * Returns: 0 on success, -1 on failure (e.g., string not a MAC address) ++ */ ++static int hwaddr_aton_i(const char *txt, u8 *addr) ++{ ++ int i; ++ ++ for (i = 0; i < 6; i++) { ++ int a, b; ++ ++ a = hex2num_i(*txt++); ++ if (a < 0) ++ return -1; ++ b = hex2num_i(*txt++); ++ if (b < 0) ++ return -1; ++ *addr++ = (a << 4) | b; ++ if (i < 5 && *txt++ != ':') ++ return -1; ++ } ++ ++ return 0; ++} ++ ++static void indicate_wx_custom_event(_adapter *padapter, char *msg) ++{ ++ u8 *buff, *p; ++ union iwreq_data wrqu; ++ ++ if (strlen(msg) > IW_CUSTOM_MAX) { ++ RTW_INFO("%s strlen(msg):%zu > IW_CUSTOM_MAX:%u\n", __FUNCTION__ , strlen(msg), IW_CUSTOM_MAX); ++ return; ++ } ++ ++ buff = rtw_zmalloc(IW_CUSTOM_MAX + 1); ++ if (!buff) ++ return; ++ ++ _rtw_memcpy(buff, msg, strlen(msg)); ++ ++ _rtw_memset(&wrqu, 0, sizeof(wrqu)); ++ wrqu.data.length = strlen(msg); ++ ++ RTW_INFO("%s %s\n", __FUNCTION__, buff); ++#ifndef CONFIG_IOCTL_CFG80211 ++ wireless_send_event(padapter->pnetdev, IWEVCUSTOM, &wrqu, buff); ++#endif ++ ++ rtw_mfree(buff, IW_CUSTOM_MAX + 1); ++ ++} ++ ++ ++static void request_wps_pbc_event(_adapter *padapter) ++{ ++ u8 *buff, *p; ++ union iwreq_data wrqu; ++ ++ ++ buff = rtw_malloc(IW_CUSTOM_MAX); ++ if (!buff) ++ return; ++ ++ _rtw_memset(buff, 0, IW_CUSTOM_MAX); ++ ++ p = buff; ++ ++ p += sprintf(p, "WPS_PBC_START.request=TRUE"); ++ ++ _rtw_memset(&wrqu, 0, sizeof(wrqu)); ++ ++ wrqu.data.length = p - buff; ++ ++ wrqu.data.length = (wrqu.data.length < IW_CUSTOM_MAX) ? wrqu.data.length : IW_CUSTOM_MAX; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++#ifndef CONFIG_IOCTL_CFG80211 ++ wireless_send_event(padapter->pnetdev, IWEVCUSTOM, &wrqu, buff); ++#endif ++ ++ if (buff) ++ rtw_mfree(buff, IW_CUSTOM_MAX); ++ ++} ++ ++#ifdef CONFIG_SUPPORT_HW_WPS_PBC ++void rtw_request_wps_pbc_event(_adapter *padapter) ++{ ++#ifdef RTK_DMP_PLATFORM ++#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 12)) ++ kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_NET_PBC); ++#else ++ kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_NET_PBC); ++#endif ++#else ++ ++ if (padapter->pid[0] == 0) { ++ /* 0 is the default value and it means the application monitors the HW PBC doesn't privde its pid to driver. */ ++ return; ++ } ++ ++ rtw_signal_process(padapter->pid[0], SIGUSR1); ++ ++#endif ++ ++ rtw_led_control(padapter, LED_CTL_START_WPS_BOTTON); ++} ++#endif/* #ifdef CONFIG_SUPPORT_HW_WPS_PBC */ ++ ++void indicate_wx_scan_complete_event(_adapter *padapter) ++{ ++ union iwreq_data wrqu; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ _rtw_memset(&wrqu, 0, sizeof(union iwreq_data)); ++ ++ /* RTW_INFO("+rtw_indicate_wx_scan_complete_event\n"); */ ++#ifndef CONFIG_IOCTL_CFG80211 ++ wireless_send_event(padapter->pnetdev, SIOCGIWSCAN, &wrqu, NULL); ++#endif ++} ++ ++ ++void rtw_indicate_wx_assoc_event(_adapter *padapter) ++{ ++ union iwreq_data wrqu; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); ++ ++ _rtw_memset(&wrqu, 0, sizeof(union iwreq_data)); ++ ++ wrqu.ap_addr.sa_family = ARPHRD_ETHER; ++ ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) ++ _rtw_memcpy(wrqu.ap_addr.sa_data, pnetwork->MacAddress, ETH_ALEN); ++ else ++ _rtw_memcpy(wrqu.ap_addr.sa_data, pmlmepriv->cur_network.network.MacAddress, ETH_ALEN); ++ ++ RTW_PRINT("assoc success\n"); ++#ifndef CONFIG_IOCTL_CFG80211 ++ wireless_send_event(padapter->pnetdev, SIOCGIWAP, &wrqu, NULL); ++#endif ++} ++ ++void rtw_indicate_wx_disassoc_event(_adapter *padapter) ++{ ++ union iwreq_data wrqu; ++ ++ _rtw_memset(&wrqu, 0, sizeof(union iwreq_data)); ++ ++ wrqu.ap_addr.sa_family = ARPHRD_ETHER; ++ _rtw_memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN); ++ ++#ifndef CONFIG_IOCTL_CFG80211 ++ RTW_PRINT("indicate disassoc\n"); ++ wireless_send_event(padapter->pnetdev, SIOCGIWAP, &wrqu, NULL); ++#endif ++} ++ ++/* ++uint rtw_is_cckrates_included(u8 *rate) ++{ ++ u32 i = 0; ++ ++ while(rate[i]!=0) ++ { ++ if ( (((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || ++ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22) ) ++ return _TRUE; ++ i++; ++ } ++ ++ return _FALSE; ++} ++ ++uint rtw_is_cckratesonly_included(u8 *rate) ++{ ++ u32 i = 0; ++ ++ while(rate[i]!=0) ++ { ++ if ( (((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && ++ (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22) ) ++ return _FALSE; ++ i++; ++ } ++ ++ return _TRUE; ++} ++*/ ++ ++static int search_p2p_wfd_ie(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop) ++{ ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++#ifdef CONFIG_WFD ++ if (SCAN_RESULT_ALL == pwdinfo->wfd_info->scan_result_type) { ++ ++ } else if ((SCAN_RESULT_P2P_ONLY == pwdinfo->wfd_info->scan_result_type) || ++ (SCAN_RESULT_WFD_TYPE == pwdinfo->wfd_info->scan_result_type)) ++#endif /* CONFIG_WFD */ ++ { ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ u32 blnGotP2PIE = _FALSE; ++ ++ /* User is doing the P2P device discovery */ ++ /* The prefix of SSID should be "DIRECT-" and the IE should contains the P2P IE. */ ++ /* If not, the driver should ignore this AP and go to the next AP. */ ++ ++ /* Verifying the SSID */ ++ if (_rtw_memcmp(pnetwork->network.Ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN)) { ++ u32 p2pielen = 0; ++ ++ /* Verifying the P2P IE */ ++ if (rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen)) ++ blnGotP2PIE = _TRUE; ++ } ++ ++ if (blnGotP2PIE == _FALSE) ++ return _FALSE; ++ ++ } ++ } ++ ++#ifdef CONFIG_WFD ++ if (SCAN_RESULT_WFD_TYPE == pwdinfo->wfd_info->scan_result_type) { ++ u32 blnGotWFD = _FALSE; ++ u8 *wfd_ie; ++ uint wfd_ielen = 0; ++ ++ wfd_ie = rtw_bss_ex_get_wfd_ie(&pnetwork->network, NULL, &wfd_ielen); ++ if (wfd_ie) { ++ u8 *wfd_devinfo; ++ uint wfd_devlen; ++ ++ wfd_devinfo = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &wfd_devlen); ++ if (wfd_devinfo) { ++ if (pwdinfo->wfd_info->wfd_device_type == WFD_DEVINFO_PSINK) { ++ /* the first two bits will indicate the WFD device type */ ++ if ((wfd_devinfo[1] & 0x03) == WFD_DEVINFO_SOURCE) { ++ /* If this device is Miracast PSink device, the scan reuslt should just provide the Miracast source. */ ++ blnGotWFD = _TRUE; ++ } ++ } else if (pwdinfo->wfd_info->wfd_device_type == WFD_DEVINFO_SOURCE) { ++ /* the first two bits will indicate the WFD device type */ ++ if ((wfd_devinfo[1] & 0x03) == WFD_DEVINFO_PSINK) { ++ /* If this device is Miracast source device, the scan reuslt should just provide the Miracast PSink. */ ++ /* Todo: How about the SSink?! */ ++ blnGotWFD = _TRUE; ++ } ++ } ++ } ++ } ++ ++ if (blnGotWFD == _FALSE) ++ return _FALSE; ++ } ++#endif /* CONFIG_WFD */ ++ ++#endif /* CONFIG_P2P */ ++ return _TRUE; ++} ++static inline char *iwe_stream_mac_addr_proess(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop, struct iw_event *iwe) ++{ ++ /* AP MAC address */ ++ iwe->cmd = SIOCGIWAP; ++ iwe->u.ap_addr.sa_family = ARPHRD_ETHER; ++ ++ _rtw_memcpy(iwe->u.ap_addr.sa_data, pnetwork->network.MacAddress, ETH_ALEN); ++ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_ADDR_LEN); ++ return start; ++} ++static inline char *iwe_stream_essid_proess(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop, struct iw_event *iwe) ++{ ++ ++ /* Add the ESSID */ ++ iwe->cmd = SIOCGIWESSID; ++ iwe->u.data.flags = 1; ++ iwe->u.data.length = min((u16)pnetwork->network.Ssid.SsidLength, (u16)32); ++ start = iwe_stream_add_point(info, start, stop, iwe, pnetwork->network.Ssid.Ssid); ++ return start; ++} ++ ++static inline char *iwe_stream_chan_process(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop, struct iw_event *iwe) ++{ ++ if (pnetwork->network.Configuration.DSConfig < 1 /*|| pnetwork->network.Configuration.DSConfig>14*/) ++ pnetwork->network.Configuration.DSConfig = 1; ++ ++ /* Add frequency/channel */ ++ iwe->cmd = SIOCGIWFREQ; ++ iwe->u.freq.m = rtw_ch2freq(pnetwork->network.Configuration.DSConfig) * 100000; ++ iwe->u.freq.e = 1; ++ iwe->u.freq.i = pnetwork->network.Configuration.DSConfig; ++ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_FREQ_LEN); ++ return start; ++} ++static inline char *iwe_stream_mode_process(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop, struct iw_event *iwe, u16 cap) ++{ ++ /* Add mode */ ++ if (cap & (WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_BSS)) { ++ iwe->cmd = SIOCGIWMODE; ++ if (cap & WLAN_CAPABILITY_BSS) ++ iwe->u.mode = IW_MODE_MASTER; ++ else ++ iwe->u.mode = IW_MODE_ADHOC; ++ ++ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_UINT_LEN); ++ } ++ return start; ++} ++static inline char *iwe_stream_encryption_process(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop, struct iw_event *iwe, u16 cap) ++{ ++ ++ /* Add encryption capability */ ++ iwe->cmd = SIOCGIWENCODE; ++ if (cap & WLAN_CAPABILITY_PRIVACY) ++ iwe->u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; ++ else ++ iwe->u.data.flags = IW_ENCODE_DISABLED; ++ iwe->u.data.length = 0; ++ start = iwe_stream_add_point(info, start, stop, iwe, pnetwork->network.Ssid.Ssid); ++ return start; ++ ++} ++ ++static inline char *iwe_stream_protocol_process(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop, struct iw_event *iwe) ++{ ++ u16 ht_cap = _FALSE, vht_cap = _FALSE; ++ u32 ht_ielen = 0, vht_ielen = 0; ++ char *p; ++ u8 ie_offset = (pnetwork->network.Reserved[0] == 2 ? 0 : 12); /* Probe Request */ ++ ++ /* parsing HT_CAP_IE */ ++ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - ie_offset); ++ if (p && ht_ielen > 0) ++ ht_cap = _TRUE; ++ ++#ifdef CONFIG_80211AC_VHT ++ /* parsing VHT_CAP_IE */ ++ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength - ie_offset); ++ if (p && vht_ielen > 0) ++ vht_cap = _TRUE; ++#endif ++ /* Add the protocol name */ ++ iwe->cmd = SIOCGIWNAME; ++ if ((rtw_is_cckratesonly_included((u8 *)&pnetwork->network.SupportedRates)) == _TRUE) { ++ if (ht_cap == _TRUE) ++ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11bn"); ++ else ++ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11b"); ++ } else if ((rtw_is_cckrates_included((u8 *)&pnetwork->network.SupportedRates)) == _TRUE) { ++ if (ht_cap == _TRUE) ++ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11bgn"); ++ else ++ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11bg"); ++ } else { ++ if (pnetwork->network.Configuration.DSConfig > 14) { ++ #ifdef CONFIG_80211AC_VHT ++ if (vht_cap == _TRUE) ++ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11AC"); ++ else ++ #endif ++ { ++ if (ht_cap == _TRUE) ++ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11an"); ++ else ++ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11a"); ++ } ++ } else { ++ if (ht_cap == _TRUE) ++ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11gn"); ++ else ++ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11g"); ++ } ++ } ++ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_CHAR_LEN); ++ return start; ++} ++ ++static inline char *iwe_stream_rate_process(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop, struct iw_event *iwe) ++{ ++ u32 ht_ielen = 0, vht_ielen = 0; ++ char *p; ++ u16 max_rate = 0, rate, ht_cap = _FALSE, vht_cap = _FALSE; ++ u32 i = 0; ++ u8 bw_40MHz = 0, short_GI = 0, bw_160MHz = 0, vht_highest_rate = 0; ++ u16 mcs_rate = 0, vht_data_rate = 0; ++ char custom[MAX_CUSTOM_LEN] = {0}; ++ u8 ie_offset = (pnetwork->network.Reserved[0] == 2 ? 0 : 12); /* Probe Request */ ++ ++ /* parsing HT_CAP_IE */ ++ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - ie_offset); ++ if (p && ht_ielen > 0) { ++ struct rtw_ieee80211_ht_cap *pht_capie; ++ ht_cap = _TRUE; ++ pht_capie = (struct rtw_ieee80211_ht_cap *)(p + 2); ++ _rtw_memcpy(&mcs_rate , pht_capie->supp_mcs_set, 2); ++ bw_40MHz = (pht_capie->cap_info & IEEE80211_HT_CAP_SUP_WIDTH) ? 1 : 0; ++ short_GI = (pht_capie->cap_info & (IEEE80211_HT_CAP_SGI_20 | IEEE80211_HT_CAP_SGI_40)) ? 1 : 0; ++ } ++ ++#ifdef CONFIG_80211AC_VHT ++ /* parsing VHT_CAP_IE */ ++ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength - ie_offset); ++ if (p && vht_ielen > 0) { ++ u8 mcs_map[2]; ++ ++ vht_cap = _TRUE; ++ bw_160MHz = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p + 2); ++ if (bw_160MHz) ++ short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI160M(p + 2); ++ else ++ short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI80M(p + 2); ++ ++ _rtw_memcpy(mcs_map, GET_VHT_CAPABILITY_ELE_TX_MCS(p + 2), 2); ++ ++ vht_highest_rate = rtw_get_vht_highest_rate(mcs_map); ++ vht_data_rate = rtw_vht_mcs_to_data_rate(CHANNEL_WIDTH_80, short_GI, vht_highest_rate); ++ } ++#endif ++ ++ /*Add basic and extended rates */ ++ p = custom; ++ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): "); ++ while (pnetwork->network.SupportedRates[i] != 0) { ++ rate = pnetwork->network.SupportedRates[i] & 0x7F; ++ if (rate > max_rate) ++ max_rate = rate; ++ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), ++ "%d%s ", rate >> 1, (rate & 1) ? ".5" : ""); ++ i++; ++ } ++#ifdef CONFIG_80211AC_VHT ++ if (vht_cap == _TRUE) ++ max_rate = vht_data_rate; ++ else ++#endif ++ if (ht_cap == _TRUE) { ++ if (mcs_rate & 0x8000) /* MCS15 */ ++ max_rate = (bw_40MHz) ? ((short_GI) ? 300 : 270) : ((short_GI) ? 144 : 130); ++ ++ else if (mcs_rate & 0x0080) /* MCS7 */ ++ max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65); ++ else { /* default MCS7 */ ++ /* RTW_INFO("wx_get_scan, mcs_rate_bitmap=0x%x\n", mcs_rate); */ ++ max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65); ++ } ++ ++ max_rate = max_rate * 2; /* Mbps/2; */ ++ } ++ ++ iwe->cmd = SIOCGIWRATE; ++ iwe->u.bitrate.fixed = iwe->u.bitrate.disabled = 0; ++ iwe->u.bitrate.value = max_rate * 500000; ++ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_PARAM_LEN); ++ return start ; ++} ++ ++static inline char *iwe_stream_wpa_wpa2_process(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop, struct iw_event *iwe) ++{ ++ int buf_size = MAX_WPA_IE_LEN * 2; ++ /* u8 pbuf[buf_size]={0}; */ ++ u8 *pbuf = rtw_zmalloc(buf_size); ++ ++ u8 wpa_ie[255] = {0}, rsn_ie[255] = {0}; ++ u16 i, wpa_len = 0, rsn_len = 0; ++ u8 *p; ++ sint out_len = 0; ++ ++ ++ if (pbuf) { ++ p = pbuf; ++ ++ /* parsing WPA/WPA2 IE */ ++ if (pnetwork->network.Reserved[0] != 2) { /* Probe Request */ ++ out_len = rtw_get_sec_ie(pnetwork->network.IEs , pnetwork->network.IELength, rsn_ie, &rsn_len, wpa_ie, &wpa_len); ++ ++ if (wpa_len > 0) { ++ ++ _rtw_memset(pbuf, 0, buf_size); ++ p += sprintf(p, "wpa_ie="); ++ for (i = 0; i < wpa_len; i++) ++ p += sprintf(p, "%02x", wpa_ie[i]); ++ ++ if (wpa_len > 100) { ++ printk("-----------------Len %d----------------\n", wpa_len); ++ for (i = 0; i < wpa_len; i++) ++ printk("%02x ", wpa_ie[i]); ++ printk("\n"); ++ printk("-----------------Len %d----------------\n", wpa_len); ++ } ++ ++ _rtw_memset(iwe, 0, sizeof(*iwe)); ++ iwe->cmd = IWEVCUSTOM; ++ iwe->u.data.length = strlen(pbuf); ++ start = iwe_stream_add_point(info, start, stop, iwe, pbuf); ++ ++ _rtw_memset(iwe, 0, sizeof(*iwe)); ++ iwe->cmd = IWEVGENIE; ++ iwe->u.data.length = wpa_len; ++ start = iwe_stream_add_point(info, start, stop, iwe, wpa_ie); ++ } ++ if (rsn_len > 0) { ++ ++ _rtw_memset(pbuf, 0, buf_size); ++ p += sprintf(p, "rsn_ie="); ++ for (i = 0; i < rsn_len; i++) ++ p += sprintf(p, "%02x", rsn_ie[i]); ++ _rtw_memset(iwe, 0, sizeof(*iwe)); ++ iwe->cmd = IWEVCUSTOM; ++ iwe->u.data.length = strlen(pbuf); ++ start = iwe_stream_add_point(info, start, stop, iwe, pbuf); ++ ++ _rtw_memset(iwe, 0, sizeof(*iwe)); ++ iwe->cmd = IWEVGENIE; ++ iwe->u.data.length = rsn_len; ++ start = iwe_stream_add_point(info, start, stop, iwe, rsn_ie); ++ } ++ } ++ ++ rtw_mfree(pbuf, buf_size); ++ } ++ return start; ++} ++ ++static inline char *iwe_stream_wps_process(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop, struct iw_event *iwe) ++{ ++ /* parsing WPS IE */ ++ uint cnt = 0, total_ielen; ++ u8 *wpsie_ptr = NULL; ++ uint wps_ielen = 0; ++ u8 ie_offset = (pnetwork->network.Reserved[0] == 2 ? 0 : 12); ++ ++ u8 *ie_ptr = pnetwork->network.IEs + ie_offset; ++ total_ielen = pnetwork->network.IELength - ie_offset; ++ ++ if (pnetwork->network.Reserved[0] == 2) { /* Probe Request */ ++ ie_ptr = pnetwork->network.IEs; ++ total_ielen = pnetwork->network.IELength; ++ } else { /* Beacon or Probe Respones */ ++ ie_ptr = pnetwork->network.IEs + _FIXED_IE_LENGTH_; ++ total_ielen = pnetwork->network.IELength - _FIXED_IE_LENGTH_; ++ } ++ while (cnt < total_ielen) { ++ if (rtw_is_wps_ie(&ie_ptr[cnt], &wps_ielen) && (wps_ielen > 2)) { ++ wpsie_ptr = &ie_ptr[cnt]; ++ iwe->cmd = IWEVGENIE; ++ iwe->u.data.length = (u16)wps_ielen; ++ start = iwe_stream_add_point(info, start, stop, iwe, wpsie_ptr); ++ } ++ cnt += ie_ptr[cnt + 1] + 2; /* goto next */ ++ } ++ return start; ++} ++ ++static inline char *iwe_stream_wapi_process(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop, struct iw_event *iwe) ++{ ++#ifdef CONFIG_WAPI_SUPPORT ++ char *p; ++ ++ if (pnetwork->network.Reserved[0] != 2) { /* Probe Request */ ++ sint out_len_wapi = 0; ++ /* here use static for stack size */ ++ static u8 buf_wapi[MAX_WAPI_IE_LEN * 2] = {0}; ++ static u8 wapi_ie[MAX_WAPI_IE_LEN] = {0}; ++ u16 wapi_len = 0; ++ u16 i; ++ ++ out_len_wapi = rtw_get_wapi_ie(pnetwork->network.IEs , pnetwork->network.IELength, wapi_ie, &wapi_len); ++ ++ RTW_INFO("rtw_wx_get_scan: %s ", pnetwork->network.Ssid.Ssid); ++ RTW_INFO("rtw_wx_get_scan: ssid = %d ", wapi_len); ++ ++ ++ if (wapi_len > 0) { ++ p = buf_wapi; ++ /* _rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN*2); */ ++ p += sprintf(p, "wapi_ie="); ++ for (i = 0; i < wapi_len; i++) ++ p += sprintf(p, "%02x", wapi_ie[i]); ++ ++ _rtw_memset(iwe, 0, sizeof(*iwe)); ++ iwe->cmd = IWEVCUSTOM; ++ iwe->u.data.length = strlen(buf_wapi); ++ start = iwe_stream_add_point(info, start, stop, iwe, buf_wapi); ++ ++ _rtw_memset(iwe, 0, sizeof(*iwe)); ++ iwe->cmd = IWEVGENIE; ++ iwe->u.data.length = wapi_len; ++ start = iwe_stream_add_point(info, start, stop, iwe, wapi_ie); ++ } ++ } ++#endif/* #ifdef CONFIG_WAPI_SUPPORT */ ++ return start; ++} ++ ++static inline char *iwe_stream_rssi_process(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop, struct iw_event *iwe) ++{ ++ u8 ss, sq; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ /* Add quality statistics */ ++ iwe->cmd = IWEVQUAL; ++ iwe->u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED ++#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) ++ | IW_QUAL_NOISE_UPDATED ++#else ++ | IW_QUAL_NOISE_INVALID ++#endif ++#ifdef CONFIG_SIGNAL_DISPLAY_DBM ++ | IW_QUAL_DBM ++#endif ++ ; ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && ++ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { ++ ss = padapter->recvpriv.signal_strength; ++ sq = padapter->recvpriv.signal_qual; ++ } else { ++ ss = pnetwork->network.PhyInfo.SignalStrength; ++ sq = pnetwork->network.PhyInfo.SignalQuality; ++ } ++ ++ ++#ifdef CONFIG_SIGNAL_DISPLAY_DBM ++ iwe->u.qual.level = (u8) translate_percentage_to_dbm(ss); /* dbm */ ++#else ++#ifdef CONFIG_SIGNAL_SCALE_MAPPING ++ iwe->u.qual.level = (u8)ss; /* % */ ++#else ++ { ++ /* Do signal scale mapping when using percentage as the unit of signal strength, since the scale mapping is skipped in odm */ ++ ++ HAL_DATA_TYPE *pHal = GET_HAL_DATA(padapter); ++ ++ iwe->u.qual.level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, ss); ++ } ++#endif ++#endif ++ ++ iwe->u.qual.qual = (u8)sq; /* signal quality */ ++ ++#ifdef CONFIG_PLATFORM_ROCKCHIPS ++ iwe->u.qual.noise = -100; /* noise level suggest by zhf@rockchips */ ++#else ++#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) ++ { ++ s16 tmp_noise = 0; ++ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &(pnetwork->network.Configuration.DSConfig), &(tmp_noise)); ++ iwe->u.qual.noise = tmp_noise ; ++ } ++#else ++ iwe->u.qual.noise = 0; /* noise level */ ++#endif ++#endif /* CONFIG_PLATFORM_ROCKCHIPS */ ++ ++ /* RTW_INFO("iqual=%d, ilevel=%d, inoise=%d, iupdated=%d\n", iwe.u.qual.qual, iwe.u.qual.level , iwe.u.qual.noise, iwe.u.qual.updated); */ ++ ++ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_QUAL_LEN); ++ return start; ++} ++ ++static inline char *iwe_stream_net_rsv_process(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop, struct iw_event *iwe) ++{ ++ u8 buf[32] = {0}; ++ u8 *p, *pos; ++ int len; ++ p = buf; ++ pos = pnetwork->network.Reserved; ++ ++ p += sprintf(p, "fm=%02X%02X", pos[1], pos[0]); ++ _rtw_memset(iwe, 0, sizeof(*iwe)); ++ iwe->cmd = IWEVCUSTOM; ++ iwe->u.data.length = strlen(buf); ++ start = iwe_stream_add_point(info, start, stop, iwe, buf); ++ return start; ++} ++ ++#if 1 ++static char *translate_scan(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop) ++{ ++ struct iw_event iwe; ++ u16 cap = 0; ++ _rtw_memset(&iwe, 0, sizeof(iwe)); ++ ++ if (_FALSE == search_p2p_wfd_ie(padapter, info, pnetwork, start, stop)) ++ return start; ++ ++ start = iwe_stream_mac_addr_proess(padapter, info, pnetwork, start, stop, &iwe); ++ start = iwe_stream_essid_proess(padapter, info, pnetwork, start, stop, &iwe); ++ start = iwe_stream_protocol_process(padapter, info, pnetwork, start, stop, &iwe); ++ if (pnetwork->network.Reserved[0] == 2) /* Probe Request */ ++ cap = 0; ++ else { ++ _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); ++ cap = le16_to_cpu(cap); ++ } ++ ++ start = iwe_stream_mode_process(padapter, info, pnetwork, start, stop, &iwe, cap); ++ start = iwe_stream_chan_process(padapter, info, pnetwork, start, stop, &iwe); ++ start = iwe_stream_encryption_process(padapter, info, pnetwork, start, stop, &iwe, cap); ++ start = iwe_stream_rate_process(padapter, info, pnetwork, start, stop, &iwe); ++ start = iwe_stream_wpa_wpa2_process(padapter, info, pnetwork, start, stop, &iwe); ++ start = iwe_stream_wps_process(padapter, info, pnetwork, start, stop, &iwe); ++ start = iwe_stream_wapi_process(padapter, info, pnetwork, start, stop, &iwe); ++ start = iwe_stream_rssi_process(padapter, info, pnetwork, start, stop, &iwe); ++ start = iwe_stream_net_rsv_process(padapter, info, pnetwork, start, stop, &iwe); ++ ++ return start; ++} ++#else ++static char *translate_scan(_adapter *padapter, ++ struct iw_request_info *info, struct wlan_network *pnetwork, ++ char *start, char *stop) ++{ ++ struct iw_event iwe; ++ u16 cap; ++ u32 ht_ielen = 0, vht_ielen = 0; ++ char custom[MAX_CUSTOM_LEN]; ++ char *p; ++ u16 max_rate = 0, rate, ht_cap = _FALSE, vht_cap = _FALSE; ++ u32 i = 0; ++ char *current_val; ++ long rssi; ++ u8 bw_40MHz = 0, short_GI = 0, bw_160MHz = 0, vht_highest_rate = 0; ++ u16 mcs_rate = 0, vht_data_rate = 0; ++ u8 ie_offset = (pnetwork->network.Reserved[0] == 2 ? 0 : 12); ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ ++ if (_FALSE == search_p2p_wfd_ie(padapter, info, pnetwork, start, stop)) ++ return start; ++ ++ /* AP MAC address */ ++ iwe.cmd = SIOCGIWAP; ++ iwe.u.ap_addr.sa_family = ARPHRD_ETHER; ++ ++ _rtw_memcpy(iwe.u.ap_addr.sa_data, pnetwork->network.MacAddress, ETH_ALEN); ++ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_ADDR_LEN); ++ ++ /* Add the ESSID */ ++ iwe.cmd = SIOCGIWESSID; ++ iwe.u.data.flags = 1; ++ iwe.u.data.length = min((u16)pnetwork->network.Ssid.SsidLength, (u16)32); ++ start = iwe_stream_add_point(info, start, stop, &iwe, pnetwork->network.Ssid.Ssid); ++ ++ /* parsing HT_CAP_IE */ ++ if (pnetwork->network.Reserved[0] == 2) /* Probe Request */ ++ p = rtw_get_ie(&pnetwork->network.IEs[0], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength); ++ else ++ p = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - 12); ++ if (p && ht_ielen > 0) { ++ struct rtw_ieee80211_ht_cap *pht_capie; ++ ht_cap = _TRUE; ++ pht_capie = (struct rtw_ieee80211_ht_cap *)(p + 2); ++ _rtw_memcpy(&mcs_rate , pht_capie->supp_mcs_set, 2); ++ bw_40MHz = (pht_capie->cap_info & IEEE80211_HT_CAP_SUP_WIDTH) ? 1 : 0; ++ short_GI = (pht_capie->cap_info & (IEEE80211_HT_CAP_SGI_20 | IEEE80211_HT_CAP_SGI_40)) ? 1 : 0; ++ } ++ ++#ifdef CONFIG_80211AC_VHT ++ /* parsing VHT_CAP_IE */ ++ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength - ie_offset); ++ if (p && vht_ielen > 0) { ++ u8 mcs_map[2]; ++ ++ vht_cap = _TRUE; ++ bw_160MHz = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p + 2); ++ if (bw_160MHz) ++ short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI160M(p + 2); ++ else ++ short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI80M(p + 2); ++ ++ _rtw_memcpy(mcs_map, GET_VHT_CAPABILITY_ELE_TX_MCS(p + 2), 2); ++ ++ vht_highest_rate = rtw_get_vht_highest_rate(mcs_map); ++ vht_data_rate = rtw_vht_mcs_to_data_rate(CHANNEL_WIDTH_80, short_GI, vht_highest_rate); ++ } ++#endif ++ ++ /* Add the protocol name */ ++ iwe.cmd = SIOCGIWNAME; ++ if ((rtw_is_cckratesonly_included((u8 *)&pnetwork->network.SupportedRates)) == _TRUE) { ++ if (ht_cap == _TRUE) ++ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bn"); ++ else ++ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11b"); ++ } else if ((rtw_is_cckrates_included((u8 *)&pnetwork->network.SupportedRates)) == _TRUE) { ++ if (ht_cap == _TRUE) ++ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bgn"); ++ else ++ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bg"); ++ } else { ++ if (pnetwork->network.Configuration.DSConfig > 14) { ++ if (vht_cap == _TRUE) ++ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11AC"); ++ else if (ht_cap == _TRUE) ++ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11an"); ++ else ++ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11a"); ++ } else { ++ if (ht_cap == _TRUE) ++ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11gn"); ++ else ++ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11g"); ++ } ++ } ++ ++ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_CHAR_LEN); ++ ++ /* Add mode */ ++ if (pnetwork->network.Reserved[0] == 2) /* Probe Request */ ++ cap = 0; ++ else { ++ iwe.cmd = SIOCGIWMODE; ++ _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); ++ cap = le16_to_cpu(cap); ++ } ++ ++ if (cap & (WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_BSS)) { ++ if (cap & WLAN_CAPABILITY_BSS) ++ iwe.u.mode = IW_MODE_MASTER; ++ else ++ iwe.u.mode = IW_MODE_ADHOC; ++ ++ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_UINT_LEN); ++ } ++ ++ if (pnetwork->network.Configuration.DSConfig < 1 /*|| pnetwork->network.Configuration.DSConfig>14*/) ++ pnetwork->network.Configuration.DSConfig = 1; ++ ++ /* Add frequency/channel */ ++ iwe.cmd = SIOCGIWFREQ; ++ iwe.u.freq.m = rtw_ch2freq(pnetwork->network.Configuration.DSConfig) * 100000; ++ iwe.u.freq.e = 1; ++ iwe.u.freq.i = pnetwork->network.Configuration.DSConfig; ++ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_FREQ_LEN); ++ ++ /* Add encryption capability */ ++ iwe.cmd = SIOCGIWENCODE; ++ if (cap & WLAN_CAPABILITY_PRIVACY) ++ iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; ++ else ++ iwe.u.data.flags = IW_ENCODE_DISABLED; ++ iwe.u.data.length = 0; ++ start = iwe_stream_add_point(info, start, stop, &iwe, pnetwork->network.Ssid.Ssid); ++ ++ /*Add basic and extended rates */ ++ max_rate = 0; ++ p = custom; ++ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): "); ++ while (pnetwork->network.SupportedRates[i] != 0) { ++ rate = pnetwork->network.SupportedRates[i] & 0x7F; ++ if (rate > max_rate) ++ max_rate = rate; ++ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), ++ "%d%s ", rate >> 1, (rate & 1) ? ".5" : ""); ++ i++; ++ } ++ ++ if (vht_cap == _TRUE) ++ max_rate = vht_data_rate; ++ else if (ht_cap == _TRUE) { ++ if (mcs_rate & 0x8000) /* MCS15 */ ++ max_rate = (bw_40MHz) ? ((short_GI) ? 300 : 270) : ((short_GI) ? 144 : 130); ++ ++ else if (mcs_rate & 0x0080) /* MCS7 */ ++ max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65); ++ else { /* default MCS7 */ ++ /* RTW_INFO("wx_get_scan, mcs_rate_bitmap=0x%x\n", mcs_rate); */ ++ max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65); ++ } ++ ++ max_rate = max_rate * 2; /* Mbps/2; */ ++ } ++ ++ iwe.cmd = SIOCGIWRATE; ++ iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0; ++ iwe.u.bitrate.value = max_rate * 500000; ++ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_PARAM_LEN); ++ ++ /* parsing WPA/WPA2 IE */ ++ if (pnetwork->network.Reserved[0] != 2) { /* Probe Request */ ++ u8 buf[MAX_WPA_IE_LEN * 2]; ++ u8 wpa_ie[255], rsn_ie[255]; ++ u16 wpa_len = 0, rsn_len = 0; ++ u8 *p; ++ sint out_len = 0; ++ out_len = rtw_get_sec_ie(pnetwork->network.IEs , pnetwork->network.IELength, rsn_ie, &rsn_len, wpa_ie, &wpa_len); ++ ++ if (wpa_len > 0) { ++ p = buf; ++ _rtw_memset(buf, 0, MAX_WPA_IE_LEN * 2); ++ p += sprintf(p, "wpa_ie="); ++ for (i = 0; i < wpa_len; i++) ++ p += sprintf(p, "%02x", wpa_ie[i]); ++ ++ if (wpa_len > 100) { ++ printk("-----------------Len %d----------------\n", wpa_len); ++ for (i = 0; i < wpa_len; i++) ++ printk("%02x ", wpa_ie[i]); ++ printk("\n"); ++ printk("-----------------Len %d----------------\n", wpa_len); ++ } ++ ++ _rtw_memset(&iwe, 0, sizeof(iwe)); ++ iwe.cmd = IWEVCUSTOM; ++ iwe.u.data.length = strlen(buf); ++ start = iwe_stream_add_point(info, start, stop, &iwe, buf); ++ ++ _rtw_memset(&iwe, 0, sizeof(iwe)); ++ iwe.cmd = IWEVGENIE; ++ iwe.u.data.length = wpa_len; ++ start = iwe_stream_add_point(info, start, stop, &iwe, wpa_ie); ++ } ++ if (rsn_len > 0) { ++ p = buf; ++ _rtw_memset(buf, 0, MAX_WPA_IE_LEN * 2); ++ p += sprintf(p, "rsn_ie="); ++ for (i = 0; i < rsn_len; i++) ++ p += sprintf(p, "%02x", rsn_ie[i]); ++ _rtw_memset(&iwe, 0, sizeof(iwe)); ++ iwe.cmd = IWEVCUSTOM; ++ iwe.u.data.length = strlen(buf); ++ start = iwe_stream_add_point(info, start, stop, &iwe, buf); ++ ++ _rtw_memset(&iwe, 0, sizeof(iwe)); ++ iwe.cmd = IWEVGENIE; ++ iwe.u.data.length = rsn_len; ++ start = iwe_stream_add_point(info, start, stop, &iwe, rsn_ie); ++ } ++ } ++ ++ { /* parsing WPS IE */ ++ uint cnt = 0, total_ielen; ++ u8 *wpsie_ptr = NULL; ++ uint wps_ielen = 0; ++ ++ u8 *ie_ptr = pnetwork->network.IEs + ie_offset; ++ total_ielen = pnetwork->network.IELength - ie_offset; ++ ++ if (pnetwork->network.Reserved[0] == 2) { /* Probe Request */ ++ ie_ptr = pnetwork->network.IEs; ++ total_ielen = pnetwork->network.IELength; ++ } else { /* Beacon or Probe Respones */ ++ ie_ptr = pnetwork->network.IEs + _FIXED_IE_LENGTH_; ++ total_ielen = pnetwork->network.IELength - _FIXED_IE_LENGTH_; ++ } ++ ++ while (cnt < total_ielen) { ++ if (rtw_is_wps_ie(&ie_ptr[cnt], &wps_ielen) && (wps_ielen > 2)) { ++ wpsie_ptr = &ie_ptr[cnt]; ++ iwe.cmd = IWEVGENIE; ++ iwe.u.data.length = (u16)wps_ielen; ++ start = iwe_stream_add_point(info, start, stop, &iwe, wpsie_ptr); ++ } ++ cnt += ie_ptr[cnt + 1] + 2; /* goto next */ ++ } ++ } ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (pnetwork->network.Reserved[0] != 2) { /* Probe Request */ ++ sint out_len_wapi = 0; ++ /* here use static for stack size */ ++ static u8 buf_wapi[MAX_WAPI_IE_LEN * 2]; ++ static u8 wapi_ie[MAX_WAPI_IE_LEN]; ++ u16 wapi_len = 0; ++ u16 i; ++ ++ _rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN); ++ _rtw_memset(wapi_ie, 0, MAX_WAPI_IE_LEN); ++ ++ out_len_wapi = rtw_get_wapi_ie(pnetwork->network.IEs , pnetwork->network.IELength, wapi_ie, &wapi_len); ++ ++ RTW_INFO("rtw_wx_get_scan: %s ", pnetwork->network.Ssid.Ssid); ++ RTW_INFO("rtw_wx_get_scan: ssid = %d ", wapi_len); ++ ++ ++ if (wapi_len > 0) { ++ p = buf_wapi; ++ _rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN * 2); ++ p += sprintf(p, "wapi_ie="); ++ for (i = 0; i < wapi_len; i++) ++ p += sprintf(p, "%02x", wapi_ie[i]); ++ ++ _rtw_memset(&iwe, 0, sizeof(iwe)); ++ iwe.cmd = IWEVCUSTOM; ++ iwe.u.data.length = strlen(buf_wapi); ++ start = iwe_stream_add_point(info, start, stop, &iwe, buf_wapi); ++ ++ _rtw_memset(&iwe, 0, sizeof(iwe)); ++ iwe.cmd = IWEVGENIE; ++ iwe.u.data.length = wapi_len; ++ start = iwe_stream_add_point(info, start, stop, &iwe, wapi_ie); ++ } ++ } ++#endif ++ ++ { ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u8 ss, sq; ++ ++ /* Add quality statistics */ ++ iwe.cmd = IWEVQUAL; ++ iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED ++#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) ++ | IW_QUAL_NOISE_UPDATED ++#else ++ | IW_QUAL_NOISE_INVALID ++#endif ++#ifdef CONFIG_SIGNAL_DISPLAY_DBM ++ | IW_QUAL_DBM ++#endif ++ ; ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && ++ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { ++ ss = padapter->recvpriv.signal_strength; ++ sq = padapter->recvpriv.signal_qual; ++ } else { ++ ss = pnetwork->network.PhyInfo.SignalStrength; ++ sq = pnetwork->network.PhyInfo.SignalQuality; ++ } ++ ++ ++#ifdef CONFIG_SIGNAL_DISPLAY_DBM ++ iwe.u.qual.level = (u8) translate_percentage_to_dbm(ss); /* dbm */ ++#else ++#ifdef CONFIG_SIGNAL_SCALE_MAPPING ++ iwe.u.qual.level = (u8)ss; /* % */ ++#else ++ { ++ /* Do signal scale mapping when using percentage as the unit of signal strength, since the scale mapping is skipped in odm */ ++ ++ HAL_DATA_TYPE *pHal = GET_HAL_DATA(padapter); ++ ++ iwe.u.qual.level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, ss); ++ } ++#endif ++#endif ++ ++ iwe.u.qual.qual = (u8)sq; /* signal quality */ ++ ++#ifdef CONFIG_PLATFORM_ROCKCHIPS ++ iwe.u.qual.noise = -100; /* noise level suggest by zhf@rockchips */ ++#else ++#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) ++ { ++ s16 tmp_noise = 0; ++ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &(pnetwork->network.Configuration.DSConfig), &(tmp_noise)); ++ iwe.u.qual.noise = tmp_noise ; ++ } ++#else ++ iwe.u.qual.noise = 0; /* noise level */ ++#endif ++#endif /* CONFIG_PLATFORM_ROCKCHIPS */ ++ ++ /* RTW_INFO("iqual=%d, ilevel=%d, inoise=%d, iupdated=%d\n", iwe.u.qual.qual, iwe.u.qual.level , iwe.u.qual.noise, iwe.u.qual.updated); */ ++ ++ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_QUAL_LEN); ++ } ++ ++ { ++ u8 buf[MAX_WPA_IE_LEN]; ++ u8 *p, *pos; ++ int len; ++ p = buf; ++ pos = pnetwork->network.Reserved; ++ _rtw_memset(buf, 0, MAX_WPA_IE_LEN); ++ p += sprintf(p, "fm=%02X%02X", pos[1], pos[0]); ++ _rtw_memset(&iwe, 0, sizeof(iwe)); ++ iwe.cmd = IWEVCUSTOM; ++ iwe.u.data.length = strlen(buf); ++ start = iwe_stream_add_point(info, start, stop, &iwe, buf); ++ } ++ ++ return start; ++} ++#endif ++ ++static int wpa_set_auth_algs(struct net_device *dev, u32 value) ++{ ++ _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); ++ int ret = 0; ++ ++ if ((value & AUTH_ALG_SHARED_KEY) && (value & AUTH_ALG_OPEN_SYSTEM)) { ++ RTW_INFO("wpa_set_auth_algs, AUTH_ALG_SHARED_KEY and AUTH_ALG_OPEN_SYSTEM [value:0x%x]\n", value); ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch; ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; ++ } else if (value & AUTH_ALG_SHARED_KEY) { ++ RTW_INFO("wpa_set_auth_algs, AUTH_ALG_SHARED_KEY [value:0x%x]\n", value); ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ ++#ifdef CONFIG_PLATFORM_MT53XX ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch; ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; ++#else ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeShared; ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; ++#endif ++ } else if (value & AUTH_ALG_OPEN_SYSTEM) { ++ RTW_INFO("wpa_set_auth_algs, AUTH_ALG_OPEN_SYSTEM\n"); ++ /* padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; */ ++ if (padapter->securitypriv.ndisauthtype < Ndis802_11AuthModeWPAPSK) { ++#ifdef CONFIG_PLATFORM_MT53XX ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch; ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; ++#else ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; ++#endif ++ } ++ ++ } else if (value & AUTH_ALG_LEAP) ++ RTW_INFO("wpa_set_auth_algs, AUTH_ALG_LEAP\n"); ++ else { ++ RTW_INFO("wpa_set_auth_algs, error!\n"); ++ ret = -EINVAL; ++ } ++ ++ return ret; ++ ++} ++ ++static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) ++{ ++ int ret = 0; ++ u32 wep_key_idx, wep_key_len, wep_total_len; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++#endif /* CONFIG_P2P */ ++ ++ ++ param->u.crypt.err = 0; ++ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; ++ ++ if (param_len < (u32)((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && ++ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) { ++ ++ if (param->u.crypt.idx >= WEP_KEYS ++#ifdef CONFIG_IEEE80211W ++ && param->u.crypt.idx > BIP_MAX_KEYID ++#endif /* CONFIG_IEEE80211W */ ++ ) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ } else { ++#ifdef CONFIG_WAPI_SUPPORT ++ if (strcmp(param->u.crypt.alg, "SMS4")) ++#endif ++ { ++ ret = -EINVAL; ++ goto exit; ++ } ++ } ++ ++ if (strcmp(param->u.crypt.alg, "WEP") == 0) { ++ RTW_INFO("wpa_set_encryption, crypt.alg = WEP\n"); ++ ++ wep_key_idx = param->u.crypt.idx; ++ wep_key_len = param->u.crypt.key_len; ++ ++ if ((wep_key_idx > WEP_KEYS) || (wep_key_len <= 0)) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) { ++ /* wep default key has not been set, so use this key index as default key.*/ ++ ++ wep_key_len = wep_key_len <= 5 ? 5 : 13; ++ ++ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; ++ ++ if (wep_key_len == 13) { ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; ++ } ++ ++ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; ++ } ++ ++ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); ++ ++ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; ++ ++ psecuritypriv->key_mask |= BIT(wep_key_idx); ++ ++ goto exit; ++ } ++ ++ if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { /* 802_1x */ ++ struct sta_info *psta, *pbcmc_sta; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == _TRUE) { /* sta mode */ ++ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); ++ if (psta == NULL) { ++ /* DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail\n")); */ ++ } else { ++ /* Jeff: don't disable ieee8021x_blocked while clearing key */ ++ if (strcmp(param->u.crypt.alg, "none") != 0) ++ psta->ieee8021x_blocked = _FALSE; ++ ++ if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled) || ++ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) ++ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; ++ ++ if (param->u.crypt.set_tx == 1) { /* pairwise key */ ++ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ ++ if (strcmp(param->u.crypt.alg, "TKIP") == 0) { /* set mic key */ ++ /* DEBUG_ERR(("\nset key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); */ ++ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); ++ ++ padapter->securitypriv.busetkipkey = _FALSE; ++ /* _set_timer(&padapter->securitypriv.tkip_timer, 50); */ ++ } ++ ++ /* DEBUG_ERR((" param->u.crypt.key_len=%d\n",param->u.crypt.key_len)); */ ++ RTW_INFO(" ~~~~set sta key:unicastkey\n"); ++ ++ rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _TRUE); ++ ++ psta->bpairwise_key_installed = _TRUE; ++ ++ } else { /* group key */ ++ if (strcmp(param->u.crypt.alg, "TKIP") == 0 || strcmp(param->u.crypt.alg, "CCMP") == 0) { ++ _rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, ++ (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ /* only TKIP group key need to install this */ ++ if (param->u.crypt.key_len > 16) { ++ _rtw_memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); ++ } ++ padapter->securitypriv.binstallGrpkey = _TRUE; ++ /* DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); */ ++ RTW_INFO(" ~~~~set sta key:groupkey\n"); ++ ++ padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; ++ ++ rtw_set_key(padapter, &padapter->securitypriv, param->u.crypt.idx, 1, _TRUE); ++ } ++#ifdef CONFIG_IEEE80211W ++ else if (strcmp(param->u.crypt.alg, "BIP") == 0) { ++ int no; ++ /* printk("BIP key_len=%d , index=%d @@@@@@@@@@@@@@@@@@\n", param->u.crypt.key_len, param->u.crypt.idx); */ ++ /* save the IGTK key, length 16 bytes */ ++ _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, ++ (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ /*printk("IGTK key below:\n"); ++ for(no=0;no<16;no++) ++ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); ++ printk("\n");*/ ++ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; ++ padapter->securitypriv.binstallBIPkey = _TRUE; ++ RTW_INFO(" ~~~~set sta key:IGKT\n"); ++ } ++#endif /* CONFIG_IEEE80211W */ ++ ++#ifdef CONFIG_P2P ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_DONE); ++#endif /* CONFIG_P2P */ ++ ++ } ++ } ++ ++ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); ++ if (pbcmc_sta == NULL) { ++ /* DEBUG_ERR( ("Set OID_802_11_ADD_KEY: bcmc stainfo is null\n")); */ ++ } else { ++ /* Jeff: don't disable ieee8021x_blocked while clearing key */ ++ if (strcmp(param->u.crypt.alg, "none") != 0) ++ pbcmc_sta->ieee8021x_blocked = _FALSE; ++ ++ if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled) || ++ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) ++ pbcmc_sta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; ++ } ++ } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { /* adhoc mode */ ++ } ++ } ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (strcmp(param->u.crypt.alg, "SMS4") == 0) { ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ PRT_WAPI_STA_INFO pWapiSta; ++ u8 WapiASUEPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; ++ u8 WapiAEPNInitialValueSrc[16] = {0x37, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; ++ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; ++ ++ if (param->u.crypt.set_tx == 1) { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if (_rtw_memcmp(pWapiSta->PeerMacAddr, param->sta_addr, 6)) { ++ _rtw_memcpy(pWapiSta->lastTxUnicastPN, WapiASUEPNInitialValueSrc, 16); ++ ++ pWapiSta->wapiUsk.bSet = true; ++ _rtw_memcpy(pWapiSta->wapiUsk.dataKey, param->u.crypt.key, 16); ++ _rtw_memcpy(pWapiSta->wapiUsk.micKey, param->u.crypt.key + 16, 16); ++ pWapiSta->wapiUsk.keyId = param->u.crypt.idx ; ++ pWapiSta->wapiUsk.bTxEnable = true; ++ ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue, WapiAEPNInitialValueSrc, 16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue, WapiAEPNInitialValueSrc, 16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue, WapiAEPNInitialValueSrc, 16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue, WapiAEPNInitialValueSrc, 16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPN, WapiAEPNInitialValueSrc, 16); ++ pWapiSta->wapiUskUpdate.bTxEnable = false; ++ pWapiSta->wapiUskUpdate.bSet = false; ++ ++ if (psecuritypriv->sw_encrypt == false || psecuritypriv->sw_decrypt == false) { ++ /* set unicast key for ASUE */ ++ rtw_wapi_set_key(padapter, &pWapiSta->wapiUsk, pWapiSta, false, false); ++ } ++ } ++ } ++ } else { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if (_rtw_memcmp(pWapiSta->PeerMacAddr, get_bssid(pmlmepriv), 6)) { ++ pWapiSta->wapiMsk.bSet = true; ++ _rtw_memcpy(pWapiSta->wapiMsk.dataKey, param->u.crypt.key, 16); ++ _rtw_memcpy(pWapiSta->wapiMsk.micKey, param->u.crypt.key + 16, 16); ++ pWapiSta->wapiMsk.keyId = param->u.crypt.idx ; ++ pWapiSta->wapiMsk.bTxEnable = false; ++ if (!pWapiSta->bSetkeyOk) ++ pWapiSta->bSetkeyOk = true; ++ pWapiSta->bAuthenticateInProgress = false; ++ ++ _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); ++ ++ if (psecuritypriv->sw_decrypt == false) { ++ /* set rx broadcast key for ASUE */ ++ rtw_wapi_set_key(padapter, &pWapiSta->wapiMsk, pWapiSta, true, false); ++ } ++ } ++ ++ } ++ } ++ } ++#endif ++ ++exit: ++ ++ ++ return ret; ++} ++ ++static int rtw_set_wpa_ie(_adapter *padapter, char *pie, unsigned short ielen) ++{ ++ u8 *buf = NULL, *pos = NULL; ++ u32 left; ++ int group_cipher = 0, pairwise_cipher = 0; ++ int ret = 0; ++ u8 null_addr[] = {0, 0, 0, 0, 0, 0}; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++#endif /* CONFIG_P2P */ ++ ++ if ((ielen > MAX_WPA_IE_LEN) || (pie == NULL)) { ++ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); ++ if (pie == NULL) ++ return ret; ++ else ++ return -EINVAL; ++ } ++ ++ if (ielen) { ++ buf = rtw_zmalloc(ielen); ++ if (buf == NULL) { ++ ret = -ENOMEM; ++ goto exit; ++ } ++ ++ _rtw_memcpy(buf, pie , ielen); ++ ++ /* dump */ ++ { ++ int i; ++ RTW_INFO("\n wpa_ie(length:%d):\n", ielen); ++ for (i = 0; i < ielen; i = i + 8) ++ RTW_INFO("0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x\n", buf[i], buf[i + 1], buf[i + 2], buf[i + 3], buf[i + 4], buf[i + 5], buf[i + 6], buf[i + 7]); ++ } ++ ++ pos = buf; ++ if (ielen < RSN_HEADER_LEN) { ++ ret = -1; ++ goto exit; ++ } ++ ++#if 0 ++ pos += RSN_HEADER_LEN; ++ left = ielen - RSN_HEADER_LEN; ++ ++ if (left >= RSN_SELECTOR_LEN) { ++ pos += RSN_SELECTOR_LEN; ++ left -= RSN_SELECTOR_LEN; ++ } else if (left > 0) { ++ ret = -1; ++ goto exit; ++ } ++#endif ++ ++ if (rtw_parse_wpa_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPAPSK; ++ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); ++ } ++ ++ if (rtw_parse_wpa2_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPA2PSK; ++ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); ++ } ++ ++ if (group_cipher == 0) ++ group_cipher = WPA_CIPHER_NONE; ++ if (pairwise_cipher == 0) ++ pairwise_cipher = WPA_CIPHER_NONE; ++ ++ switch (group_cipher) { ++ case WPA_CIPHER_NONE: ++ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; ++ break; ++ case WPA_CIPHER_WEP40: ++ padapter->securitypriv.dot118021XGrpPrivacy = _WEP40_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ case WPA_CIPHER_TKIP: ++ padapter->securitypriv.dot118021XGrpPrivacy = _TKIP_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; ++ break; ++ case WPA_CIPHER_CCMP: ++ padapter->securitypriv.dot118021XGrpPrivacy = _AES_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; ++ break; ++ case WPA_CIPHER_WEP104: ++ padapter->securitypriv.dot118021XGrpPrivacy = _WEP104_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ } ++ ++ switch (pairwise_cipher) { ++ case WPA_CIPHER_NONE: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; ++ break; ++ case WPA_CIPHER_WEP40: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ case WPA_CIPHER_TKIP: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _TKIP_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; ++ break; ++ case WPA_CIPHER_CCMP: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _AES_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; ++ break; ++ case WPA_CIPHER_WEP104: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ } ++ ++ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); ++ {/* set wps_ie */ ++ u16 cnt = 0; ++ u8 eid, wps_oui[4] = {0x0, 0x50, 0xf2, 0x04}; ++ ++ while (cnt < ielen) { ++ eid = buf[cnt]; ++ ++ if ((eid == _VENDOR_SPECIFIC_IE_) && (_rtw_memcmp(&buf[cnt + 2], wps_oui, 4) == _TRUE)) { ++ RTW_INFO("SET WPS_IE\n"); ++ ++ padapter->securitypriv.wps_ie_len = ((buf[cnt + 1] + 2) < MAX_WPS_IE_LEN) ? (buf[cnt + 1] + 2) : MAX_WPS_IE_LEN; ++ ++ _rtw_memcpy(padapter->securitypriv.wps_ie, &buf[cnt], padapter->securitypriv.wps_ie_len); ++ ++ set_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS); ++ ++#ifdef CONFIG_P2P ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_OK)) ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_ING); ++#endif /* CONFIG_P2P */ ++ cnt += buf[cnt + 1] + 2; ++ ++ break; ++ } else { ++ cnt += buf[cnt + 1] + 2; /* goto next */ ++ } ++ } ++ } ++ } ++ ++ /* TKIP and AES disallow multicast packets until installing group key */ ++ if (padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_ ++ || padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_ ++ || padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) ++ /* WPS open need to enable multicast ++ * || check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == _TRUE) */ ++ rtw_hal_set_hwreg(padapter, HW_VAR_OFF_RCR_AM, null_addr); ++ ++ ++exit: ++ ++ if (buf) ++ rtw_mfree(buf, ielen); ++ ++ return ret; ++} ++ ++static int rtw_wx_get_name(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u16 cap; ++ u32 ht_ielen = 0; ++ char *p; ++ u8 ht_cap = _FALSE, vht_cap = _FALSE; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; ++ NDIS_802_11_RATES_EX *prates = NULL; ++ ++ ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED | WIFI_ADHOC_MASTER_STATE) == _TRUE) { ++ /* parsing HT_CAP_IE */ ++ p = rtw_get_ie(&pcur_bss->IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pcur_bss->IELength - 12); ++ if (p && ht_ielen > 0) ++ ht_cap = _TRUE; ++ ++#ifdef CONFIG_80211AC_VHT ++ if (pmlmepriv->vhtpriv.vht_option == _TRUE) ++ vht_cap = _TRUE; ++#endif ++ ++ prates = &pcur_bss->SupportedRates; ++ ++ if (rtw_is_cckratesonly_included((u8 *)prates) == _TRUE) { ++ if (ht_cap == _TRUE) ++ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bn"); ++ else ++ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11b"); ++ } else if ((rtw_is_cckrates_included((u8 *)prates)) == _TRUE) { ++ if (ht_cap == _TRUE) ++ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bgn"); ++ else ++ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bg"); ++ } else { ++ if (pcur_bss->Configuration.DSConfig > 14) { ++#ifdef CONFIG_80211AC_VHT ++ if (vht_cap == _TRUE) ++ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11AC"); ++ else ++#endif ++ { ++ if (ht_cap == _TRUE) ++ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11an"); ++ else ++ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11a"); ++ } ++ } else { ++ if (ht_cap == _TRUE) ++ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11gn"); ++ else ++ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11g"); ++ } ++ } ++ } else { ++ /* prates = &padapter->registrypriv.dev_network.SupportedRates; */ ++ /* snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11g"); */ ++ snprintf(wrqu->name, IFNAMSIZ, "unassociated"); ++ } ++ ++ ++ return 0; ++} ++ ++static int rtw_wx_set_freq(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ int exp = 1, freq = 0, div = 0; ++ ++ ++ ++ if (wrqu->freq.m <= 1000) { ++ if (wrqu->freq.flags == IW_FREQ_AUTO) { ++ if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, wrqu->freq.m) > 0) { ++ padapter->mlmeextpriv.cur_channel = wrqu->freq.m; ++ RTW_INFO("%s: channel is auto, set to channel %d\n", __func__, wrqu->freq.m); ++ } else { ++ padapter->mlmeextpriv.cur_channel = 1; ++ RTW_INFO("%s: channel is auto, Channel Plan don't match just set to channel 1\n", __func__); ++ } ++ } else { ++ padapter->mlmeextpriv.cur_channel = wrqu->freq.m; ++ RTW_INFO("%s: set to channel %d\n", __func__, padapter->mlmeextpriv.cur_channel); ++ } ++ } else { ++ while (wrqu->freq.e) { ++ exp *= 10; ++ wrqu->freq.e--; ++ } ++ ++ freq = wrqu->freq.m; ++ ++ while (!(freq % 10)) { ++ freq /= 10; ++ exp *= 10; ++ } ++ ++ /* freq unit is MHz here */ ++ div = 1000000 / exp; ++ ++ if (div) ++ freq /= div; ++ else { ++ div = exp / 1000000; ++ freq *= div; ++ } ++ ++ /* If freq is invalid, rtw_freq2ch() will return channel 1 */ ++ padapter->mlmeextpriv.cur_channel = rtw_freq2ch(freq); ++ RTW_INFO("%s: set to channel %d\n", __func__, padapter->mlmeextpriv.cur_channel); ++ } ++ ++ set_channel_bwmode(padapter, padapter->mlmeextpriv.cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ ++ ++ return 0; ++} ++ ++static int rtw_wx_get_freq(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) != _TRUE) { ++ ++ wrqu->freq.m = rtw_ch2freq(pcur_bss->Configuration.DSConfig) * 100000; ++ wrqu->freq.e = 1; ++ wrqu->freq.i = pcur_bss->Configuration.DSConfig; ++ ++ } else { ++ wrqu->freq.m = rtw_ch2freq(padapter->mlmeextpriv.cur_channel) * 100000; ++ wrqu->freq.e = 1; ++ wrqu->freq.i = padapter->mlmeextpriv.cur_channel; ++ } ++ ++ return 0; ++} ++ ++static int rtw_wx_set_mode(struct net_device *dev, struct iw_request_info *a, ++ union iwreq_data *wrqu, char *b) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType ; ++ int ret = 0; ++ ++ ++ if (_FAIL == rtw_pwr_wakeup(padapter)) { ++ ret = -EPERM; ++ goto exit; ++ } ++ ++ if (!rtw_is_hw_init_completed(padapter)) { ++ ret = -EPERM; ++ goto exit; ++ } ++ ++ /* initial default type */ ++ dev->type = ARPHRD_ETHER; ++ ++ switch (wrqu->mode) { ++ case IW_MODE_MONITOR: ++ networkType = Ndis802_11Monitor; ++#if 0 ++ dev->type = ARPHRD_IEEE80211; /* IEEE 802.11 : 801 */ ++#endif ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) ++ dev->type = ARPHRD_IEEE80211_RADIOTAP; /* IEEE 802.11 + radiotap header : 803 */ ++ RTW_INFO("set_mode = IW_MODE_MONITOR\n"); ++#else ++ RTW_INFO("kernel version < 2.6.24 not support IW_MODE_MONITOR\n"); ++#endif ++ break; ++ ++ case IW_MODE_AUTO: ++ networkType = Ndis802_11AutoUnknown; ++ RTW_INFO("set_mode = IW_MODE_AUTO\n"); ++ break; ++ case IW_MODE_ADHOC: ++ networkType = Ndis802_11IBSS; ++ RTW_INFO("set_mode = IW_MODE_ADHOC\n"); ++ break; ++ case IW_MODE_MASTER: ++ networkType = Ndis802_11APMode; ++ RTW_INFO("set_mode = IW_MODE_MASTER\n"); ++ /* rtw_setopmode_cmd(padapter, networkType,_TRUE); */ ++ break; ++ case IW_MODE_INFRA: ++ networkType = Ndis802_11Infrastructure; ++ RTW_INFO("set_mode = IW_MODE_INFRA\n"); ++ break; ++ ++ default: ++ ret = -EINVAL;; ++ goto exit; ++ } ++ ++ /* ++ if(Ndis802_11APMode == networkType) ++ { ++ rtw_setopmode_cmd(padapter, networkType,_TRUE); ++ } ++ else ++ { ++ rtw_setopmode_cmd(padapter, Ndis802_11AutoUnknown,_TRUE); ++ } ++ */ ++ ++ if (rtw_set_802_11_infrastructure_mode(padapter, networkType) == _FALSE) { ++ ++ ret = -EPERM; ++ goto exit; ++ ++ } ++ ++ rtw_setopmode_cmd(padapter, networkType, _TRUE); ++ ++ if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) == _TRUE) ++ rtw_indicate_connect(padapter); ++ ++exit: ++ ++ ++ return ret; ++ ++} ++ ++static int rtw_wx_get_mode(struct net_device *dev, struct iw_request_info *a, ++ union iwreq_data *wrqu, char *b) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) ++ wrqu->mode = IW_MODE_INFRA; ++ else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) ++ ++ wrqu->mode = IW_MODE_ADHOC; ++ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ wrqu->mode = IW_MODE_MASTER; ++ else if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) == _TRUE) ++ wrqu->mode = IW_MODE_MONITOR; ++ else ++ wrqu->mode = IW_MODE_AUTO; ++ ++ ++ return 0; ++ ++} ++ ++ ++static int rtw_wx_set_pmkid(struct net_device *dev, ++ struct iw_request_info *a, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 j, blInserted = _FALSE; ++ int intReturn = _FALSE; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct iw_pmksa *pPMK = (struct iw_pmksa *) extra; ++ u8 strZeroMacAddress[ETH_ALEN] = { 0x00 }; ++ u8 strIssueBssid[ETH_ALEN] = { 0x00 }; ++ ++#if 0 ++ struct iw_pmksa { ++ __u32 cmd; ++ struct sockaddr bssid; ++ __u8 pmkid[IW_PMKID_LEN]; /* IW_PMKID_LEN=16 */ ++ } ++ There are the BSSID information in the bssid.sa_data array. ++ If cmd is IW_PMKSA_FLUSH, it means the wpa_suppplicant wants to clear all the PMKID information. ++ If cmd is IW_PMKSA_ADD, it means the wpa_supplicant wants to add a PMKID / BSSID to driver. ++ If cmd is IW_PMKSA_REMOVE, it means the wpa_supplicant wants to remove a PMKID / BSSID from driver. ++#endif ++ ++ _rtw_memcpy(strIssueBssid, pPMK->bssid.sa_data, ETH_ALEN); ++ if (pPMK->cmd == IW_PMKSA_ADD) { ++ RTW_INFO("[rtw_wx_set_pmkid] IW_PMKSA_ADD!\n"); ++ if (_rtw_memcmp(strIssueBssid, strZeroMacAddress, ETH_ALEN) == _TRUE) ++ return intReturn ; ++ else ++ intReturn = _TRUE; ++ blInserted = _FALSE; ++ ++ /* overwrite PMKID */ ++ for (j = 0 ; j < NUM_PMKID_CACHE; j++) { ++ if (_rtw_memcmp(psecuritypriv->PMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) == _TRUE) { ++ /* BSSID is matched, the same AP => rewrite with new PMKID. */ ++ ++ RTW_INFO("[rtw_wx_set_pmkid] BSSID exists in the PMKList.\n"); ++ ++ _rtw_memcpy(psecuritypriv->PMKIDList[j].PMKID, pPMK->pmkid, IW_PMKID_LEN); ++ psecuritypriv->PMKIDList[j].bUsed = _TRUE; ++ psecuritypriv->PMKIDIndex = j + 1; ++ blInserted = _TRUE; ++ break; ++ } ++ } ++ ++ if (!blInserted) { ++ /* Find a new entry */ ++ RTW_INFO("[rtw_wx_set_pmkid] Use the new entry index = %d for this PMKID.\n", ++ psecuritypriv->PMKIDIndex); ++ ++ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, strIssueBssid, ETH_ALEN); ++ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, pPMK->pmkid, IW_PMKID_LEN); ++ ++ psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].bUsed = _TRUE; ++ psecuritypriv->PMKIDIndex++ ; ++ if (psecuritypriv->PMKIDIndex == 16) ++ psecuritypriv->PMKIDIndex = 0; ++ } ++ } else if (pPMK->cmd == IW_PMKSA_REMOVE) { ++ RTW_INFO("[rtw_wx_set_pmkid] IW_PMKSA_REMOVE!\n"); ++ intReturn = _TRUE; ++ for (j = 0 ; j < NUM_PMKID_CACHE; j++) { ++ if (_rtw_memcmp(psecuritypriv->PMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) == _TRUE) { ++ /* BSSID is matched, the same AP => Remove this PMKID information and reset it. */ ++ _rtw_memset(psecuritypriv->PMKIDList[j].Bssid, 0x00, ETH_ALEN); ++ psecuritypriv->PMKIDList[j].bUsed = _FALSE; ++ break; ++ } ++ } ++ } else if (pPMK->cmd == IW_PMKSA_FLUSH) { ++ RTW_INFO("[rtw_wx_set_pmkid] IW_PMKSA_FLUSH!\n"); ++ _rtw_memset(&psecuritypriv->PMKIDList[0], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); ++ psecuritypriv->PMKIDIndex = 0; ++ intReturn = _TRUE; ++ } ++ return intReturn ; ++} ++ ++static int rtw_wx_get_sens(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++#ifdef CONFIG_PLATFORM_ROCKCHIPS ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ /* ++ * 20110311 Commented by Jeff ++ * For rockchip platform's wpa_driver_wext_get_rssi ++ */ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ /* wrqu->sens.value=-padapter->recvpriv.signal_strength; */ ++ wrqu->sens.value = -padapter->recvpriv.rssi; ++ /* RTW_INFO("%s: %d\n", __FUNCTION__, wrqu->sens.value); */ ++ wrqu->sens.fixed = 0; /* no auto select */ ++ } else ++#endif ++ { ++ wrqu->sens.value = 0; ++ wrqu->sens.fixed = 0; /* no auto select */ ++ wrqu->sens.disabled = 1; ++ } ++ return 0; ++} ++ ++static int rtw_wx_get_range(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ struct iw_range *range = (struct iw_range *)extra; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ u16 val; ++ int i; ++ ++ ++ ++ wrqu->data.length = sizeof(*range); ++ _rtw_memset(range, 0, sizeof(*range)); ++ ++ /* Let's try to keep this struct in the same order as in ++ * linux/include/wireless.h ++ */ ++ ++ /* TODO: See what values we can set, and remove the ones we can't ++ * set, or fill them with some default data. ++ */ ++ ++ /* ~5 Mb/s real (802.11b) */ ++ range->throughput = 5 * 1000 * 1000; ++ ++ /* TODO: Not used in 802.11b? ++ * range->min_nwid; Minimal NWID we are able to set */ ++ /* TODO: Not used in 802.11b? ++ * range->max_nwid; Maximal NWID we are able to set */ ++ ++ /* Old Frequency (backward compat - moved lower ) */ ++ /* range->old_num_channels; ++ * range->old_num_frequency; ++ * range->old_freq[6]; Filler to keep "version" at the same offset */ ++ ++ /* signal level threshold range */ ++ ++ /* Quality of link & SNR stuff */ ++ /* Quality range (link, level, noise) ++ * If the quality is absolute, it will be in the range [0 ; max_qual], ++ * if the quality is dBm, it will be in the range [max_qual ; 0]. ++ * Don't forget that we use 8 bit arithmetics... ++ * ++ * If percentage range is 0~100 ++ * Signal strength dbm range logical is -100 ~ 0 ++ * but usually value is -90 ~ -20 ++ * When CONFIG_SIGNAL_SCALE_MAPPING is defined, dbm range is -95 ~ -45 ++ */ ++ range->max_qual.qual = 100; ++#ifdef CONFIG_SIGNAL_DISPLAY_DBM ++ range->max_qual.level = (u8)-100; ++ range->max_qual.noise = (u8)-100; ++ range->max_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */ ++ range->max_qual.updated |= IW_QUAL_DBM; ++#else /* !CONFIG_SIGNAL_DISPLAY_DBM */ ++ /* percent values between 0 and 100. */ ++ range->max_qual.level = 100; ++ range->max_qual.noise = 100; ++ range->max_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */ ++#endif /* !CONFIG_SIGNAL_DISPLAY_DBM */ ++ ++ /* This should contain the average/typical values of the quality ++ * indicator. This should be the threshold between a "good" and ++ * a "bad" link (example : monitor going from green to orange). ++ * Currently, user space apps like quality monitors don't have any ++ * way to calibrate the measurement. With this, they can split ++ * the range between 0 and max_qual in different quality level ++ * (using a geometric subdivision centered on the average). ++ * I expect that people doing the user space apps will feedback ++ * us on which value we need to put in each driver... */ ++ range->avg_qual.qual = 92; /* > 8% missed beacons is 'bad' */ ++#ifdef CONFIG_SIGNAL_DISPLAY_DBM ++ /* TODO: Find real 'good' to 'bad' threshold value for RSSI */ ++ range->avg_qual.level = (u8)-70; ++ range->avg_qual.noise = 0; ++ range->avg_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */ ++ range->avg_qual.updated |= IW_QUAL_DBM; ++#else /* !CONFIG_SIGNAL_DISPLAY_DBM */ ++ /* TODO: Find real 'good' to 'bad' threshol value for RSSI */ ++ range->avg_qual.level = 30; ++ range->avg_qual.noise = 100; ++ range->avg_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */ ++#endif /* !CONFIG_SIGNAL_DISPLAY_DBM */ ++ ++ range->num_bitrates = RATE_COUNT; ++ ++ for (i = 0; i < RATE_COUNT && i < IW_MAX_BITRATES; i++) ++ range->bitrate[i] = rtw_rates[i]; ++ ++ range->min_frag = MIN_FRAG_THRESHOLD; ++ range->max_frag = MAX_FRAG_THRESHOLD; ++ ++ range->pm_capa = 0; ++ ++ range->we_version_compiled = WIRELESS_EXT; ++ range->we_version_source = 16; ++ ++ /* range->retry_capa; What retry options are supported ++ * range->retry_flags; How to decode max/min retry limit ++ * range->r_time_flags; How to decode max/min retry life ++ * range->min_retry; Minimal number of retries ++ * range->max_retry; Maximal number of retries ++ * range->min_r_time; Minimal retry lifetime ++ * range->max_r_time; Maximal retry lifetime */ ++ ++ for (i = 0, val = 0; i < MAX_CHANNEL_NUM; i++) { ++ ++ /* Include only legal frequencies for some countries */ ++ if (pmlmeext->channel_set[i].ChannelNum != 0) { ++ range->freq[val].i = pmlmeext->channel_set[i].ChannelNum; ++ range->freq[val].m = rtw_ch2freq(pmlmeext->channel_set[i].ChannelNum) * 100000; ++ range->freq[val].e = 1; ++ val++; ++ } ++ ++ if (val == IW_MAX_FREQUENCIES) ++ break; ++ } ++ ++ range->num_channels = val; ++ range->num_frequency = val; ++ ++ /* Commented by Albert 2009/10/13 ++ * The following code will proivde the security capability to network manager. ++ * If the driver doesn't provide this capability to network manager, ++ * the WPA/WPA2 routers can't be choosen in the network manager. */ ++ ++ /* ++ #define IW_SCAN_CAPA_NONE 0x00 ++ #define IW_SCAN_CAPA_ESSID 0x01 ++ #define IW_SCAN_CAPA_BSSID 0x02 ++ #define IW_SCAN_CAPA_CHANNEL 0x04 ++ #define IW_SCAN_CAPA_MODE 0x08 ++ #define IW_SCAN_CAPA_RATE 0x10 ++ #define IW_SCAN_CAPA_TYPE 0x20 ++ #define IW_SCAN_CAPA_TIME 0x40 ++ */ ++ ++#if WIRELESS_EXT > 17 ++ range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 | ++ IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP; ++#endif ++ ++#ifdef IW_SCAN_CAPA_ESSID /* WIRELESS_EXT > 21 */ ++ range->scan_capa = IW_SCAN_CAPA_ESSID | IW_SCAN_CAPA_TYPE | IW_SCAN_CAPA_BSSID | ++ IW_SCAN_CAPA_CHANNEL | IW_SCAN_CAPA_MODE | IW_SCAN_CAPA_RATE; ++#endif ++ ++ ++ ++ return 0; ++ ++} ++ ++/* set bssid flow ++ * s1. rtw_set_802_11_infrastructure_mode() ++ * s2. rtw_set_802_11_authentication_mode() ++ * s3. set_802_11_encryption_mode() ++ * s4. rtw_set_802_11_bssid() */ ++static int rtw_wx_set_wap(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *awrq, ++ char *extra) ++{ ++ _irqL irqL; ++ uint ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct sockaddr *temp = (struct sockaddr *)awrq; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ _list *phead; ++ u8 *dst_bssid, *src_bssid; ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ NDIS_802_11_AUTHENTICATION_MODE authmode; ++ ++ /* ++ #ifdef CONFIG_CONCURRENT_MODE ++ if(padapter->adapter_type > PRIMARY_IFACE) ++ { ++ ret = -EINVAL; ++ goto exit; ++ } ++ #endif ++ */ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) == _TRUE) { ++ RTW_INFO("set bssid, but buddy_intf is under scanning or linking\n"); ++ ++ ret = -EINVAL; ++ ++ goto exit; ++ } ++#endif ++ ++ rtw_ps_deny(padapter, PS_DENY_JOIN); ++ if (_FAIL == rtw_pwr_wakeup(padapter)) { ++ ret = -1; ++ goto cancel_ps_deny; ++ } ++ ++ if (!padapter->bup) { ++ ret = -1; ++ goto cancel_ps_deny; ++ } ++ ++ ++ if (temp->sa_family != ARPHRD_ETHER) { ++ ret = -EINVAL; ++ goto cancel_ps_deny; ++ } ++ ++ authmode = padapter->securitypriv.ndisauthtype; ++ _enter_critical_bh(&queue->lock, &irqL); ++ phead = get_list_head(queue); ++ pmlmepriv->pscanned = get_next(phead); ++ ++ while (1) { ++ ++ if ((rtw_end_of_queue_search(phead, pmlmepriv->pscanned)) == _TRUE) { ++#if 0 ++ ret = -EINVAL; ++ goto cancel_ps_deny; ++ ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) { ++ rtw_set_802_11_bssid(padapter, temp->sa_data); ++ goto cancel_ps_deny; ++ } else { ++ ret = -EINVAL; ++ goto cancel_ps_deny; ++ } ++#endif ++ ++ break; ++ } ++ ++ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); ++ ++ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); ++ ++ dst_bssid = pnetwork->network.MacAddress; ++ ++ src_bssid = temp->sa_data; ++ ++ if ((_rtw_memcmp(dst_bssid, src_bssid, ETH_ALEN)) == _TRUE) { ++ if (!rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode)) { ++ ret = -1; ++ _exit_critical_bh(&queue->lock, &irqL); ++ goto cancel_ps_deny; ++ } ++ ++ break; ++ } ++ ++ } ++ _exit_critical_bh(&queue->lock, &irqL); ++ ++ rtw_set_802_11_authentication_mode(padapter, authmode); ++ /* set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); */ ++ if (rtw_set_802_11_bssid(padapter, temp->sa_data) == _FALSE) { ++ ret = -1; ++ goto cancel_ps_deny; ++ } ++ ++cancel_ps_deny: ++ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); ++ ++exit: ++ return ret; ++} ++ ++static int rtw_wx_get_wap(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; ++ ++ wrqu->ap_addr.sa_family = ARPHRD_ETHER; ++ ++ _rtw_memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN); ++ ++ ++ ++ if (((check_fwstate(pmlmepriv, _FW_LINKED)) == _TRUE) || ++ ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == _TRUE) || ++ ((check_fwstate(pmlmepriv, WIFI_AP_STATE)) == _TRUE)) ++ ++ _rtw_memcpy(wrqu->ap_addr.sa_data, pcur_bss->MacAddress, ETH_ALEN); ++ else ++ _rtw_memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN); ++ ++ ++ return 0; ++ ++} ++ ++static int rtw_wx_set_mlme(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++#if 0 ++ /* SIOCSIWMLME data */ ++ struct iw_mlme { ++ __u16 cmd; /* IW_MLME_* */ ++ __u16 reason_code; ++ struct sockaddr addr; ++ }; ++#endif ++ ++ int ret = 0; ++ u16 reason; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_mlme *mlme = (struct iw_mlme *) extra; ++ ++ ++ if (mlme == NULL) ++ return -1; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ reason = cpu_to_le16(mlme->reason_code); ++ ++ ++ RTW_INFO("%s, cmd=%d, reason=%d\n", __FUNCTION__, mlme->cmd, reason); ++ ++ ++ switch (mlme->cmd) { ++ case IW_MLME_DEAUTH: ++ if (!rtw_set_802_11_disassociate(padapter)) ++ ret = -1; ++ break; ++ ++ case IW_MLME_DISASSOC: ++ if (!rtw_set_802_11_disassociate(padapter)) ++ ret = -1; ++ ++ break; ++ ++ default: ++ return -EOPNOTSUPP; ++ } ++ ++ return ret; ++} ++ ++static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, ++ union iwreq_data *wrqu, char *extra) ++{ ++ u8 _status = _FALSE; ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; ++ ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif /* CONFIG_P2P */ ++ ++ ++#ifdef DBG_IOCTL ++ RTW_INFO("DBG_IOCTL %s:%d\n", __FUNCTION__, __LINE__); ++#endif ++ ++#ifdef CONFIG_MP_INCLUDED ++ if (rtw_mi_mp_mode_check(padapter)) { ++ RTW_INFO("MP mode block Scan request\n"); ++ ret = -EPERM; ++ goto exit; ++ } ++#endif ++ if (rtw_is_scan_deny(padapter)) { ++ indicate_wx_scan_complete_event(padapter); ++ goto exit; ++ } ++ ++ rtw_ps_deny(padapter, PS_DENY_SCAN); ++ if (_FAIL == rtw_pwr_wakeup(padapter)) { ++ ret = -1; ++ goto cancel_ps_deny; ++ } ++ ++ if (!rtw_is_adapter_up(padapter)) { ++ ret = -1; ++ goto cancel_ps_deny; ++ } ++ ++#ifndef CONFIG_DOSCAN_IN_BUSYTRAFFIC ++ /* When Busy Traffic, driver do not site survey. So driver return success. */ ++ /* wpa_supplicant will not issue SIOCSIWSCAN cmd again after scan timeout. */ ++ /* modify by thomas 2011-02-22. */ ++ if (rtw_mi_busy_traffic_check(padapter, _FALSE)) { ++ indicate_wx_scan_complete_event(padapter); ++ goto cancel_ps_deny; ++ } ++#endif ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) && check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { ++ RTW_INFO("AP mode process WPS\n"); ++ indicate_wx_scan_complete_event(padapter); ++ goto cancel_ps_deny; ++ } ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) == _TRUE) { ++ indicate_wx_scan_complete_event(padapter); ++ goto cancel_ps_deny; ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_buddy_check_fwstate(padapter, ++ _FW_UNDER_SURVEY | _FW_UNDER_LINKING | WIFI_UNDER_WPS)) { ++ ++ indicate_wx_scan_complete_event(padapter); ++ goto cancel_ps_deny; ++ } ++#endif ++ ++#ifdef CONFIG_P2P ++ if (pwdinfo->p2p_state != P2P_STATE_NONE) { ++ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); ++ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_FULL); ++ rtw_free_network_queue(padapter, _TRUE); ++ } ++#endif /* CONFIG_P2P */ ++ ++ _rtw_memset(ssid, 0, sizeof(NDIS_802_11_SSID) * RTW_SSID_SCAN_AMOUNT); ++ ++#if WIRELESS_EXT >= 17 ++ if (wrqu->data.length == sizeof(struct iw_scan_req)) { ++ struct iw_scan_req *req = (struct iw_scan_req *)extra; ++ ++ if (wrqu->data.flags & IW_SCAN_THIS_ESSID) { ++ int len = min((int)req->essid_len, IW_ESSID_MAX_SIZE); ++ ++ _rtw_memcpy(ssid[0].Ssid, req->essid, len); ++ ssid[0].SsidLength = len; ++ ++ RTW_INFO("IW_SCAN_THIS_ESSID, ssid=%s, len=%d\n", req->essid, req->essid_len); ++ ++ _status = rtw_set_802_11_bssid_list_scan(padapter, ssid, 1, NULL, 0); ++ ++ } else if (req->scan_type == IW_SCAN_TYPE_PASSIVE) ++ RTW_INFO("rtw_wx_set_scan, req->scan_type == IW_SCAN_TYPE_PASSIVE\n"); ++ ++ } else ++#endif ++ ++ if (wrqu->data.length >= WEXT_CSCAN_HEADER_SIZE ++ && _rtw_memcmp(extra, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == _TRUE ++ ) { ++ int len = wrqu->data.length - WEXT_CSCAN_HEADER_SIZE; ++ char *pos = extra + WEXT_CSCAN_HEADER_SIZE; ++ char section; ++ char sec_len; ++ int ssid_index = 0; ++ ++ /* RTW_INFO("%s COMBO_SCAN header is recognized\n", __FUNCTION__); */ ++ ++ while (len >= 1) { ++ section = *(pos++); ++ len -= 1; ++ ++ switch (section) { ++ case WEXT_CSCAN_SSID_SECTION: ++ /* RTW_INFO("WEXT_CSCAN_SSID_SECTION\n"); */ ++ if (len < 1) { ++ len = 0; ++ break; ++ } ++ ++ sec_len = *(pos++); ++ len -= 1; ++ ++ if (sec_len > 0 && sec_len <= len) { ++ ssid[ssid_index].SsidLength = sec_len; ++ _rtw_memcpy(ssid[ssid_index].Ssid, pos, ssid[ssid_index].SsidLength); ++ /* RTW_INFO("%s COMBO_SCAN with specific ssid:%s, %d\n", __FUNCTION__ */ ++ /* , ssid[ssid_index].Ssid, ssid[ssid_index].SsidLength); */ ++ ssid_index++; ++ } ++ ++ pos += sec_len; ++ len -= sec_len; ++ break; ++ ++ ++ case WEXT_CSCAN_CHANNEL_SECTION: ++ /* RTW_INFO("WEXT_CSCAN_CHANNEL_SECTION\n"); */ ++ pos += 1; ++ len -= 1; ++ break; ++ case WEXT_CSCAN_ACTV_DWELL_SECTION: ++ /* RTW_INFO("WEXT_CSCAN_ACTV_DWELL_SECTION\n"); */ ++ pos += 2; ++ len -= 2; ++ break; ++ case WEXT_CSCAN_PASV_DWELL_SECTION: ++ /* RTW_INFO("WEXT_CSCAN_PASV_DWELL_SECTION\n"); */ ++ pos += 2; ++ len -= 2; ++ break; ++ case WEXT_CSCAN_HOME_DWELL_SECTION: ++ /* RTW_INFO("WEXT_CSCAN_HOME_DWELL_SECTION\n"); */ ++ pos += 2; ++ len -= 2; ++ break; ++ case WEXT_CSCAN_TYPE_SECTION: ++ /* RTW_INFO("WEXT_CSCAN_TYPE_SECTION\n"); */ ++ pos += 1; ++ len -= 1; ++ break; ++#if 0 ++ case WEXT_CSCAN_NPROBE_SECTION: ++ RTW_INFO("WEXT_CSCAN_NPROBE_SECTION\n"); ++ break; ++#endif ++ ++ default: ++ /* RTW_INFO("Unknown CSCAN section %c\n", section); */ ++ len = 0; /* stop parsing */ ++ } ++ /* RTW_INFO("len:%d\n", len); */ ++ ++ } ++ ++ /* jeff: it has still some scan paramater to parse, we only do this now... */ ++ _status = rtw_set_802_11_bssid_list_scan(padapter, ssid, RTW_SSID_SCAN_AMOUNT, NULL, 0); ++ ++ } else ++ ++ _status = rtw_set_802_11_bssid_list_scan(padapter, NULL, 0, NULL, 0); ++ ++ if (_status == _FALSE) ++ ret = -1; ++ ++cancel_ps_deny: ++ rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); ++ ++exit: ++#ifdef DBG_IOCTL ++ RTW_INFO("DBG_IOCTL %s:%d return %d\n", __FUNCTION__, __LINE__, ret); ++#endif ++ ++ return ret; ++} ++ ++static int rtw_wx_get_scan(struct net_device *dev, struct iw_request_info *a, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ char *ev = extra; ++ char *stop = ev + wrqu->data.length; ++ u32 ret = 0; ++ u32 cnt = 0; ++ u32 wait_for_surveydone; ++ sint wait_status; ++ ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++#endif /* CONFIG_P2P */ ++ ++ ++#ifdef DBG_IOCTL ++ RTW_INFO("DBG_IOCTL %s:%d\n", __FUNCTION__, __LINE__); ++#endif ++ ++ if (adapter_to_pwrctl(padapter)->brfoffbyhw && rtw_is_drv_stopped(padapter)) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++#ifdef CONFIG_P2P ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ wait_for_surveydone = 200; ++ else { ++ /* P2P is disabled */ ++ wait_for_surveydone = 100; ++ } ++#else ++ { ++ wait_for_surveydone = 100; ++ } ++#endif /* CONFIG_P2P */ ++ ++#if 1 /* Wireless Extension use EAGAIN to try */ ++ wait_status = _FW_UNDER_SURVEY ++#ifndef CONFIG_ANDROID ++ | _FW_UNDER_LINKING ++#endif ++ ; ++ ++ while (check_fwstate(pmlmepriv, wait_status) == _TRUE) ++ return -EAGAIN; ++#else ++ wait_status = _FW_UNDER_SURVEY ++#ifndef CONFIG_ANDROID ++ | _FW_UNDER_LINKING ++#endif ++ ; ++ ++ while (check_fwstate(pmlmepriv, wait_status) == _TRUE) { ++ rtw_msleep_os(30); ++ cnt++; ++ if (cnt > wait_for_surveydone) ++ break; ++ } ++#endif ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ if ((stop - ev) < SCAN_ITEM_SIZE) { ++ ret = -E2BIG; ++ break; ++ } ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ ++ /* report network only if the current channel set contains the channel to which this network belongs */ ++ if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 ++ && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE ++ && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid)) ++ ) ++ ev = translate_scan(padapter, a, pnetwork, ev, stop); ++ ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ wrqu->data.length = ev - extra; ++ wrqu->data.flags = 0; ++ ++exit: ++ ++ ++#ifdef DBG_IOCTL ++ RTW_INFO("DBG_IOCTL %s:%d return %d\n", __FUNCTION__, __LINE__, ret); ++#endif ++ ++ return ret ; ++ ++} ++ ++/* set ssid flow ++ * s1. rtw_set_802_11_infrastructure_mode() ++ * s2. set_802_11_authenticaion_mode() ++ * s3. set_802_11_encryption_mode() ++ * s4. rtw_set_802_11_ssid() */ ++static int rtw_wx_set_essid(struct net_device *dev, ++ struct iw_request_info *a, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _irqL irqL; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ _queue *queue = &pmlmepriv->scanned_queue; ++ _list *phead; ++ s8 status = _TRUE; ++ struct wlan_network *pnetwork = NULL; ++ NDIS_802_11_AUTHENTICATION_MODE authmode; ++ NDIS_802_11_SSID ndis_ssid; ++ u8 *dst_ssid, *src_ssid; ++ ++ uint ret = 0, len; ++ ++ ++#ifdef DBG_IOCTL ++ RTW_INFO("DBG_IOCTL %s:%d\n", __FUNCTION__, __LINE__); ++#endif ++#ifdef CONFIG_WEXT_DONT_JOIN_BYSSID ++ RTW_INFO("%s: CONFIG_WEXT_DONT_JOIN_BYSSID be defined!! only allow bssid joining\n", __func__); ++ return -EPERM; ++#endif ++ ++#if WIRELESS_EXT <= 20 ++ if ((wrqu->essid.length - 1) > IW_ESSID_MAX_SIZE) { ++#else ++ if (wrqu->essid.length > IW_ESSID_MAX_SIZE) { ++#endif ++ ret = -E2BIG; ++ goto exit; ++ } ++ ++ ++ ++ rtw_ps_deny(padapter, PS_DENY_JOIN); ++ if (_FAIL == rtw_pwr_wakeup(padapter)) { ++ ret = -1; ++ goto cancel_ps_deny; ++ } ++ ++ if (!padapter->bup) { ++ ret = -1; ++ goto cancel_ps_deny; ++ } ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ ret = -1; ++ goto cancel_ps_deny; ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_SURVEY | _FW_UNDER_LINKING)) { ++ RTW_INFO("set ssid, but buddy_intf is under scanning or linking\n"); ++ ret = -EINVAL; ++ goto cancel_ps_deny; ++ } ++#endif ++ authmode = padapter->securitypriv.ndisauthtype; ++ RTW_INFO("=>%s\n", __FUNCTION__); ++ if (wrqu->essid.flags && wrqu->essid.length) { ++ /* Commented by Albert 20100519 */ ++ /* We got the codes in "set_info" function of iwconfig source code. */ ++ /* ========================================= */ ++ /* wrq.u.essid.length = strlen(essid) + 1; */ ++ /* if(we_kernel_version > 20) */ ++ /* wrq.u.essid.length--; */ ++ /* ========================================= */ ++ /* That means, if the WIRELESS_EXT less than or equal to 20, the correct ssid len should subtract 1. */ ++#if WIRELESS_EXT <= 20 ++ len = ((wrqu->essid.length - 1) < IW_ESSID_MAX_SIZE) ? (wrqu->essid.length - 1) : IW_ESSID_MAX_SIZE; ++#else ++ len = (wrqu->essid.length < IW_ESSID_MAX_SIZE) ? wrqu->essid.length : IW_ESSID_MAX_SIZE; ++#endif ++ ++ if (wrqu->essid.length != 33) ++ RTW_INFO("ssid=%s, len=%d\n", extra, wrqu->essid.length); ++ ++ _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID)); ++ ndis_ssid.SsidLength = len; ++ _rtw_memcpy(ndis_ssid.Ssid, extra, len); ++ src_ssid = ndis_ssid.Ssid; ++ ++ _enter_critical_bh(&queue->lock, &irqL); ++ phead = get_list_head(queue); ++ pmlmepriv->pscanned = get_next(phead); ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, pmlmepriv->pscanned) == _TRUE) { ++#if 0 ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) { ++ rtw_set_802_11_ssid(padapter, &ndis_ssid); ++ ++ goto cancel_ps_deny; ++ } else { ++ ret = -EINVAL; ++ goto cancel_ps_deny; ++ } ++#endif ++ ++ break; ++ } ++ ++ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); ++ ++ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); ++ ++ dst_ssid = pnetwork->network.Ssid.Ssid; ++ ++ ++ if ((_rtw_memcmp(dst_ssid, src_ssid, ndis_ssid.SsidLength) == _TRUE) && ++ (pnetwork->network.Ssid.SsidLength == ndis_ssid.SsidLength)) { ++ ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) { ++ if (pnetwork->network.InfrastructureMode != pmlmepriv->cur_network.network.InfrastructureMode) ++ continue; ++ } ++ ++ if (rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode) == _FALSE) { ++ ret = -1; ++ _exit_critical_bh(&queue->lock, &irqL); ++ goto cancel_ps_deny; ++ } ++ ++ break; ++ } ++ } ++ _exit_critical_bh(&queue->lock, &irqL); ++ rtw_set_802_11_authentication_mode(padapter, authmode); ++ /* set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); */ ++ if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == _FALSE) { ++ ret = -1; ++ goto cancel_ps_deny; ++ } ++ } ++ ++cancel_ps_deny: ++ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); ++ ++exit: ++ RTW_INFO("<=%s, ret %d\n", __FUNCTION__, ret); ++ ++#ifdef DBG_IOCTL ++ RTW_INFO("DBG_IOCTL %s:%d return %d\n", __FUNCTION__, __LINE__, ret); ++#endif ++ ++ ++ return ret; ++} ++ ++static int rtw_wx_get_essid(struct net_device *dev, ++ struct iw_request_info *a, ++ union iwreq_data *wrqu, char *extra) ++{ ++ u32 len, ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; ++ ++ ++ ++ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { ++ len = pcur_bss->Ssid.SsidLength; ++ ++ wrqu->essid.length = len; ++ ++ _rtw_memcpy(extra, pcur_bss->Ssid.Ssid, len); ++ ++ wrqu->essid.flags = 1; ++ } else { ++ ret = -1; ++ goto exit; ++ } ++ ++exit: ++ ++ ++ return ret; ++ ++} ++ ++static int rtw_wx_set_rate(struct net_device *dev, ++ struct iw_request_info *a, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int i, ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 datarates[NumRates]; ++ u32 target_rate = wrqu->bitrate.value; ++ u32 fixed = wrqu->bitrate.fixed; ++ u32 ratevalue = 0; ++ u8 mpdatarate[NumRates] = {11, 10, 9, 8, 7, 6, 5, 4, 3, 2, 1, 0, 0xff}; ++ ++ ++ ++ if (target_rate == -1) { ++ ratevalue = 11; ++ goto set_rate; ++ } ++ target_rate = target_rate / 100000; ++ ++ switch (target_rate) { ++ case 10: ++ ratevalue = 0; ++ break; ++ case 20: ++ ratevalue = 1; ++ break; ++ case 55: ++ ratevalue = 2; ++ break; ++ case 60: ++ ratevalue = 3; ++ break; ++ case 90: ++ ratevalue = 4; ++ break; ++ case 110: ++ ratevalue = 5; ++ break; ++ case 120: ++ ratevalue = 6; ++ break; ++ case 180: ++ ratevalue = 7; ++ break; ++ case 240: ++ ratevalue = 8; ++ break; ++ case 360: ++ ratevalue = 9; ++ break; ++ case 480: ++ ratevalue = 10; ++ break; ++ case 540: ++ ratevalue = 11; ++ break; ++ default: ++ ratevalue = 11; ++ break; ++ } ++ ++set_rate: ++ ++ for (i = 0; i < NumRates; i++) { ++ if (ratevalue == mpdatarate[i]) { ++ datarates[i] = mpdatarate[i]; ++ if (fixed == 0) ++ break; ++ } else ++ datarates[i] = 0xff; ++ ++ } ++ ++ if (rtw_setdatarate_cmd(padapter, datarates) != _SUCCESS) { ++ ret = -1; ++ } ++ ++ ++ return ret; ++} ++ ++static int rtw_wx_get_rate(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ u16 max_rate = 0; ++ ++ max_rate = rtw_get_cur_max_rate((_adapter *)rtw_netdev_priv(dev)); ++ ++ if (max_rate == 0) ++ return -EPERM; ++ ++ wrqu->bitrate.fixed = 0; /* no auto select */ ++ wrqu->bitrate.value = max_rate * 100000; ++ ++ return 0; ++} ++ ++static int rtw_wx_set_rts(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ ++ if (wrqu->rts.disabled) ++ padapter->registrypriv.rts_thresh = 2347; ++ else { ++ if (wrqu->rts.value < 0 || ++ wrqu->rts.value > 2347) ++ return -EINVAL; ++ ++ padapter->registrypriv.rts_thresh = wrqu->rts.value; ++ } ++ ++ RTW_INFO("%s, rts_thresh=%d\n", __func__, padapter->registrypriv.rts_thresh); ++ ++ ++ return 0; ++ ++} ++ ++static int rtw_wx_get_rts(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ ++ RTW_INFO("%s, rts_thresh=%d\n", __func__, padapter->registrypriv.rts_thresh); ++ ++ wrqu->rts.value = padapter->registrypriv.rts_thresh; ++ wrqu->rts.fixed = 0; /* no auto select */ ++ /* wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD); */ ++ ++ ++ return 0; ++} ++ ++static int rtw_wx_set_frag(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ ++ if (wrqu->frag.disabled) ++ padapter->xmitpriv.frag_len = MAX_FRAG_THRESHOLD; ++ else { ++ if (wrqu->frag.value < MIN_FRAG_THRESHOLD || ++ wrqu->frag.value > MAX_FRAG_THRESHOLD) ++ return -EINVAL; ++ ++ padapter->xmitpriv.frag_len = wrqu->frag.value & ~0x1; ++ } ++ ++ RTW_INFO("%s, frag_len=%d\n", __func__, padapter->xmitpriv.frag_len); ++ ++ ++ return 0; ++ ++} ++ ++static int rtw_wx_get_frag(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ ++ RTW_INFO("%s, frag_len=%d\n", __func__, padapter->xmitpriv.frag_len); ++ ++ wrqu->frag.value = padapter->xmitpriv.frag_len; ++ wrqu->frag.fixed = 0; /* no auto select */ ++ /* wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FRAG_THRESHOLD); */ ++ ++ ++ return 0; ++} ++ ++static int rtw_wx_get_retry(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ /* _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); */ ++ ++ ++ wrqu->retry.value = 7; ++ wrqu->retry.fixed = 0; /* no auto select */ ++ wrqu->retry.disabled = 1; ++ ++ return 0; ++ ++} ++ ++#if 0 ++ #define IW_ENCODE_INDEX 0x00FF /* Token index (if needed) */ ++ #define IW_ENCODE_FLAGS 0xFF00 /* Flags defined below */ ++ #define IW_ENCODE_MODE 0xF000 /* Modes defined below */ ++ #define IW_ENCODE_DISABLED 0x8000 /* Encoding disabled */ ++ #define IW_ENCODE_ENABLED 0x0000 /* Encoding enabled */ ++ #define IW_ENCODE_RESTRICTED 0x4000 /* Refuse non-encoded packets */ ++ #define IW_ENCODE_OPEN 0x2000 /* Accept non-encoded packets */ ++ #define IW_ENCODE_NOKEY 0x0800 /* Key is write only, so not present */ ++ #define IW_ENCODE_TEMP 0x0400 /* Temporary key */ ++ /* ++ iwconfig wlan0 key on->flags = 0x6001->maybe it means auto ++ iwconfig wlan0 key off->flags = 0x8800 ++ iwconfig wlan0 key open->flags = 0x2800 ++ iwconfig wlan0 key open 1234567890->flags = 0x2000 ++ iwconfig wlan0 key restricted->flags = 0x4800 ++ iwconfig wlan0 key open [3] 1234567890->flags = 0x2003 ++ iwconfig wlan0 key restricted [2] 1234567890->flags = 0x4002 ++ iwconfig wlan0 key open [3] -> flags = 0x2803 ++ iwconfig wlan0 key restricted [2] -> flags = 0x4802 ++ */ ++#endif ++ ++static int rtw_wx_set_enc(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *keybuf) ++{ ++ u32 key, ret = 0; ++ u32 keyindex_provided; ++ NDIS_802_11_WEP wep; ++ NDIS_802_11_AUTHENTICATION_MODE authmode; ++ ++ struct iw_point *erq = &(wrqu->encoding); ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ RTW_INFO("+rtw_wx_set_enc, flags=0x%x\n", erq->flags); ++ ++ _rtw_memset(&wep, 0, sizeof(NDIS_802_11_WEP)); ++ ++ key = erq->flags & IW_ENCODE_INDEX; ++ ++ ++ if (erq->flags & IW_ENCODE_DISABLED) { ++ RTW_INFO("EncryptionDisabled\n"); ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; ++ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ ++ authmode = Ndis802_11AuthModeOpen; ++ padapter->securitypriv.ndisauthtype = authmode; ++ ++ goto exit; ++ } ++ ++ if (key) { ++ if (key > WEP_KEYS) ++ return -EINVAL; ++ key--; ++ keyindex_provided = 1; ++ } else { ++ keyindex_provided = 0; ++ key = padapter->securitypriv.dot11PrivacyKeyIndex; ++ RTW_INFO("rtw_wx_set_enc, key=%d\n", key); ++ } ++ ++ /* set authentication mode */ ++ if (erq->flags & IW_ENCODE_OPEN) { ++ RTW_INFO("rtw_wx_set_enc():IW_ENCODE_OPEN\n"); ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;/* Ndis802_11EncryptionDisabled; */ ++ ++#ifdef CONFIG_PLATFORM_MT53XX ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; ++#else ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; ++#endif ++ ++ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; ++ authmode = Ndis802_11AuthModeOpen; ++ padapter->securitypriv.ndisauthtype = authmode; ++ } else if (erq->flags & IW_ENCODE_RESTRICTED) { ++ RTW_INFO("rtw_wx_set_enc():IW_ENCODE_RESTRICTED\n"); ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ ++#ifdef CONFIG_PLATFORM_MT53XX ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; ++#else ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; ++#endif ++ ++ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; ++ padapter->securitypriv.dot118021XGrpPrivacy = _WEP40_; ++ authmode = Ndis802_11AuthModeShared; ++ padapter->securitypriv.ndisauthtype = authmode; ++ } else { ++ RTW_INFO("rtw_wx_set_enc():erq->flags=0x%x\n", erq->flags); ++ ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;/* Ndis802_11EncryptionDisabled; */ ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ ++ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; ++ authmode = Ndis802_11AuthModeOpen; ++ padapter->securitypriv.ndisauthtype = authmode; ++ } ++ ++ wep.KeyIndex = key; ++ if (erq->length > 0) { ++ wep.KeyLength = erq->length <= 5 ? 5 : 13; ++ ++ wep.Length = wep.KeyLength + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); ++ } else { ++ wep.KeyLength = 0 ; ++ ++ if (keyindex_provided == 1) { /* set key_id only, no given KeyMaterial(erq->length==0). */ ++ padapter->securitypriv.dot11PrivacyKeyIndex = key; ++ ++ RTW_INFO("(keyindex_provided == 1), keyid=%d, key_len=%d\n", key, padapter->securitypriv.dot11DefKeylen[key]); ++ ++ switch (padapter->securitypriv.dot11DefKeylen[key]) { ++ case 5: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; ++ break; ++ case 13: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; ++ break; ++ default: ++ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ break; ++ } ++ ++ goto exit; ++ ++ } ++ ++ } ++ ++ wep.KeyIndex |= 0x80000000; ++ ++ _rtw_memcpy(wep.KeyMaterial, keybuf, wep.KeyLength); ++ ++ if (rtw_set_802_11_add_wep(padapter, &wep) == _FALSE) { ++ if (rf_on == pwrpriv->rf_pwrstate) ++ ret = -EOPNOTSUPP; ++ goto exit; ++ } ++ ++exit: ++ ++ ++ return ret; ++ ++} ++ ++static int rtw_wx_get_enc(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *keybuf) ++{ ++ uint key, ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *erq = &(wrqu->encoding); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) != _TRUE) { ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != _TRUE) { ++ erq->length = 0; ++ erq->flags |= IW_ENCODE_DISABLED; ++ return 0; ++ } ++ } ++ ++ ++ key = erq->flags & IW_ENCODE_INDEX; ++ ++ if (key) { ++ if (key > WEP_KEYS) ++ return -EINVAL; ++ key--; ++ } else ++ key = padapter->securitypriv.dot11PrivacyKeyIndex; ++ ++ erq->flags = key + 1; ++ ++ /* if(padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen) */ ++ /* { */ ++ /* erq->flags |= IW_ENCODE_OPEN; */ ++ /* } */ ++ ++ switch (padapter->securitypriv.ndisencryptstatus) { ++ case Ndis802_11EncryptionNotSupported: ++ case Ndis802_11EncryptionDisabled: ++ ++ erq->length = 0; ++ erq->flags |= IW_ENCODE_DISABLED; ++ ++ break; ++ ++ case Ndis802_11Encryption1Enabled: ++ ++ erq->length = padapter->securitypriv.dot11DefKeylen[key]; ++ ++ if (erq->length) { ++ _rtw_memcpy(keybuf, padapter->securitypriv.dot11DefKey[key].skey, padapter->securitypriv.dot11DefKeylen[key]); ++ ++ erq->flags |= IW_ENCODE_ENABLED; ++ ++ if (padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen) ++ erq->flags |= IW_ENCODE_OPEN; ++ else if (padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeShared) ++ erq->flags |= IW_ENCODE_RESTRICTED; ++ } else { ++ erq->length = 0; ++ erq->flags |= IW_ENCODE_DISABLED; ++ } ++ ++ break; ++ ++ case Ndis802_11Encryption2Enabled: ++ case Ndis802_11Encryption3Enabled: ++ ++ erq->length = 16; ++ erq->flags |= (IW_ENCODE_ENABLED | IW_ENCODE_OPEN | IW_ENCODE_NOKEY); ++ ++ break; ++ ++ default: ++ erq->length = 0; ++ erq->flags |= IW_ENCODE_DISABLED; ++ ++ break; ++ ++ } ++ ++ ++ return ret; ++ ++} ++ ++static int rtw_wx_get_power(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ /* _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); */ ++ ++ wrqu->power.value = 0; ++ wrqu->power.fixed = 0; /* no auto select */ ++ wrqu->power.disabled = 1; ++ ++ return 0; ++ ++} ++ ++static int rtw_wx_set_gen_ie(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ ret = rtw_set_wpa_ie(padapter, extra, wrqu->data.length); ++ ++ return ret; ++} ++ ++static int rtw_wx_set_auth(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_param *param = (struct iw_param *)&(wrqu->param); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u32 value = param->value; ++ int ret = 0; ++ ++ switch (param->flags & IW_AUTH_INDEX) { ++ ++ case IW_AUTH_WPA_VERSION: ++#ifdef CONFIG_WAPI_SUPPORT ++#ifndef CONFIG_IOCTL_CFG80211 ++ padapter->wapiInfo.bWapiEnable = false; ++ if (value == IW_AUTH_WAPI_VERSION_1) { ++ padapter->wapiInfo.bWapiEnable = true; ++ psecuritypriv->dot11PrivacyAlgrthm = _SMS4_; ++ psecuritypriv->dot118021XGrpPrivacy = _SMS4_; ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; ++ pmlmeinfo->auth_algo = psecuritypriv->dot11AuthAlgrthm; ++ padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN; ++ padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN; ++ } ++#endif ++#endif ++ break; ++ case IW_AUTH_CIPHER_PAIRWISE: ++ ++ break; ++ case IW_AUTH_CIPHER_GROUP: ++ ++ break; ++ case IW_AUTH_KEY_MGMT: ++#ifdef CONFIG_WAPI_SUPPORT ++#ifndef CONFIG_IOCTL_CFG80211 ++ RTW_INFO("rtw_wx_set_auth: IW_AUTH_KEY_MGMT case\n"); ++ if (value == IW_AUTH_KEY_MGMT_WAPI_PSK) ++ padapter->wapiInfo.bWapiPSK = true; ++ else ++ padapter->wapiInfo.bWapiPSK = false; ++ RTW_INFO("rtw_wx_set_auth: IW_AUTH_KEY_MGMT bwapipsk %d\n", padapter->wapiInfo.bWapiPSK); ++#endif ++#endif ++ /* ++ * ??? does not use these parameters ++ */ ++ break; ++ ++ case IW_AUTH_TKIP_COUNTERMEASURES: { ++ if (param->value) { ++ /* wpa_supplicant is enabling the tkip countermeasure. */ ++ padapter->securitypriv.btkip_countermeasure = _TRUE; ++ } else { ++ /* wpa_supplicant is disabling the tkip countermeasure. */ ++ padapter->securitypriv.btkip_countermeasure = _FALSE; ++ } ++ break; ++ } ++ case IW_AUTH_DROP_UNENCRYPTED: { ++ /* HACK: ++ * ++ * wpa_supplicant calls set_wpa_enabled when the driver ++ * is loaded and unloaded, regardless of if WPA is being ++ * used. No other calls are made which can be used to ++ * determine if encryption will be used or not prior to ++ * association being expected. If encryption is not being ++ * used, drop_unencrypted is set to false, else true -- we ++ * can use this to determine if the CAP_PRIVACY_ON bit should ++ * be set. ++ */ ++ ++ if (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption1Enabled) { ++ break;/* it means init value, or using wep, ndisencryptstatus = Ndis802_11Encryption1Enabled, */ ++ /* then it needn't reset it; */ ++ } ++ ++ if (param->value) { ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; ++ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; ++ } ++ ++ break; ++ } ++ ++ case IW_AUTH_80211_AUTH_ALG: ++ ++#if defined(CONFIG_ANDROID) || 1 ++ /* ++ * It's the starting point of a link layer connection using wpa_supplicant ++ */ ++ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { ++ LeaveAllPowerSaveMode(padapter); ++ rtw_disassoc_cmd(padapter, 500, _FALSE); ++ RTW_INFO("%s...call rtw_indicate_disconnect\n ", __FUNCTION__); ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ rtw_free_assoc_resources(padapter, 1); ++ } ++#endif ++ ++ ++ ret = wpa_set_auth_algs(dev, (u32)param->value); ++ ++ break; ++ ++ case IW_AUTH_WPA_ENABLED: ++ ++ /* if(param->value) */ ++ /* padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; */ /* 802.1x */ ++ /* else */ ++ /* padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; */ /* open system */ ++ ++ /* _disassociate(priv); */ ++ ++ break; ++ ++ case IW_AUTH_RX_UNENCRYPTED_EAPOL: ++ /* ieee->ieee802_1x = param->value; */ ++ break; ++ ++ case IW_AUTH_PRIVACY_INVOKED: ++ /* ieee->privacy_invoked = param->value; */ ++ break; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++#ifndef CONFIG_IOCTL_CFG80211 ++ case IW_AUTH_WAPI_ENABLED: ++ break; ++#endif ++#endif ++ ++ default: ++ return -EOPNOTSUPP; ++ ++ } ++ ++ return ret; ++ ++} ++ ++static int rtw_wx_set_enc_ext(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ char *alg_name; ++ u32 param_len; ++ struct ieee_param *param = NULL; ++ struct iw_point *pencoding = &wrqu->encoding; ++ struct iw_encode_ext *pext = (struct iw_encode_ext *)extra; ++ int ret = 0; ++ ++ param_len = sizeof(struct ieee_param) + pext->key_len; ++ param = (struct ieee_param *)rtw_malloc(param_len); ++ if (param == NULL) ++ return -1; ++ ++ _rtw_memset(param, 0, param_len); ++ ++ param->cmd = IEEE_CMD_SET_ENCRYPTION; ++ _rtw_memset(param->sta_addr, 0xff, ETH_ALEN); ++ ++ ++ switch (pext->alg) { ++ case IW_ENCODE_ALG_NONE: ++ /* todo: remove key */ ++ /* remove = 1; */ ++ alg_name = "none"; ++ break; ++ case IW_ENCODE_ALG_WEP: ++ alg_name = "WEP"; ++ break; ++ case IW_ENCODE_ALG_TKIP: ++ alg_name = "TKIP"; ++ break; ++ case IW_ENCODE_ALG_CCMP: ++ alg_name = "CCMP"; ++ break; ++#ifdef CONFIG_IEEE80211W ++ case IW_ENCODE_ALG_AES_CMAC: ++ alg_name = "BIP"; ++ break; ++#endif /* CONFIG_IEEE80211W */ ++#ifdef CONFIG_WAPI_SUPPORT ++#ifndef CONFIG_IOCTL_CFG80211 ++ case IW_ENCODE_ALG_SM4: ++ alg_name = "SMS4"; ++ _rtw_memcpy(param->sta_addr, pext->addr.sa_data, ETH_ALEN); ++ RTW_INFO("rtw_wx_set_enc_ext: SMS4 case\n"); ++ break; ++#endif ++#endif ++ default: ++ ret = -1; ++ goto exit; ++ } ++ ++ strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN); ++ ++ if (pext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) ++ param->u.crypt.set_tx = 1; ++ ++ /* cliW: WEP does not have group key ++ * just not checking GROUP key setting ++ */ ++ if ((pext->alg != IW_ENCODE_ALG_WEP) && ++ ((pext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) ++#ifdef CONFIG_IEEE80211W ++ || (pext->ext_flags & IW_ENCODE_ALG_AES_CMAC) ++#endif /* CONFIG_IEEE80211W */ ++ )) ++ param->u.crypt.set_tx = 0; ++ ++ param->u.crypt.idx = (pencoding->flags & 0x00FF) - 1 ; ++ ++ if (pext->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) { ++#ifdef CONFIG_WAPI_SUPPORT ++#ifndef CONFIG_IOCTL_CFG80211 ++ if (pext->alg == IW_ENCODE_ALG_SM4) ++ _rtw_memcpy(param->u.crypt.seq, pext->rx_seq, 16); ++ else ++#endif /* CONFIG_IOCTL_CFG80211 */ ++#endif /* CONFIG_WAPI_SUPPORT */ ++ _rtw_memcpy(param->u.crypt.seq, pext->rx_seq, 8); ++ } ++ ++ if (pext->key_len) { ++ param->u.crypt.key_len = pext->key_len; ++ /* _rtw_memcpy(param + 1, pext + 1, pext->key_len); */ ++ _rtw_memcpy(param->u.crypt.key, pext + 1, pext->key_len); ++ } ++ ++ if (pencoding->flags & IW_ENCODE_DISABLED) { ++ /* todo: remove key */ ++ /* remove = 1; */ ++ } ++ ++ ret = wpa_set_encryption(dev, param, param_len); ++ ++exit: ++ if (param) ++ rtw_mfree((u8 *)param, param_len); ++ ++ return ret; ++} ++ ++ ++static int rtw_wx_get_nick(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ /* _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); */ ++ /* struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); */ ++ /* struct security_priv *psecuritypriv = &padapter->securitypriv; */ ++ ++ if (extra) { ++ wrqu->data.length = 14; ++ wrqu->data.flags = 1; ++ _rtw_memcpy(extra, "", 14); ++ } ++ ++ /* rtw_signal_process(pid, SIGUSR1); */ /* for test */ ++ ++ /* dump debug info here */ ++#if 0 ++ u32 dot11AuthAlgrthm; /* 802.11 auth, could be open, shared, and 8021x */ ++ u32 dot11PrivacyAlgrthm; /* This specify the privacy for shared auth. algorithm. */ ++ u32 dot118021XGrpPrivacy; /* This specify the privacy algthm. used for Grp key */ ++ u32 ndisauthtype; ++ u32 ndisencryptstatus; ++#endif ++ ++ /* RTW_INFO("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", */ ++ /* psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, */ ++ /* psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus); */ ++ ++ /* RTW_INFO("enc_alg=0x%x\n", psecuritypriv->dot11PrivacyAlgrthm); */ ++ /* RTW_INFO("auth_type=0x%x\n", psecuritypriv->ndisauthtype); */ ++ /* RTW_INFO("enc_type=0x%x\n", psecuritypriv->ndisencryptstatus); */ ++ ++#if 0 ++ RTW_INFO("dbg(0x210)=0x%x\n", rtw_read32(padapter, 0x210)); ++ RTW_INFO("dbg(0x608)=0x%x\n", rtw_read32(padapter, 0x608)); ++ RTW_INFO("dbg(0x280)=0x%x\n", rtw_read32(padapter, 0x280)); ++ RTW_INFO("dbg(0x284)=0x%x\n", rtw_read32(padapter, 0x284)); ++ RTW_INFO("dbg(0x288)=0x%x\n", rtw_read32(padapter, 0x288)); ++ ++ RTW_INFO("dbg(0x664)=0x%x\n", rtw_read32(padapter, 0x664)); ++ ++ ++ RTW_INFO("\n"); ++ ++ RTW_INFO("dbg(0x430)=0x%x\n", rtw_read32(padapter, 0x430)); ++ RTW_INFO("dbg(0x438)=0x%x\n", rtw_read32(padapter, 0x438)); ++ ++ RTW_INFO("dbg(0x440)=0x%x\n", rtw_read32(padapter, 0x440)); ++ ++ RTW_INFO("dbg(0x458)=0x%x\n", rtw_read32(padapter, 0x458)); ++ ++ RTW_INFO("dbg(0x484)=0x%x\n", rtw_read32(padapter, 0x484)); ++ RTW_INFO("dbg(0x488)=0x%x\n", rtw_read32(padapter, 0x488)); ++ ++ RTW_INFO("dbg(0x444)=0x%x\n", rtw_read32(padapter, 0x444)); ++ RTW_INFO("dbg(0x448)=0x%x\n", rtw_read32(padapter, 0x448)); ++ RTW_INFO("dbg(0x44c)=0x%x\n", rtw_read32(padapter, 0x44c)); ++ RTW_INFO("dbg(0x450)=0x%x\n", rtw_read32(padapter, 0x450)); ++#endif ++ ++ return 0; ++ ++} ++ ++static int rtw_wx_read32(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ PADAPTER padapter; ++ struct iw_point *p; ++ u16 len; ++ u32 addr; ++ u32 data32; ++ u32 bytes; ++ u8 *ptmp; ++ int ret; ++ ++ ++ ret = 0; ++ padapter = (PADAPTER)rtw_netdev_priv(dev); ++ p = &wrqu->data; ++ len = p->length; ++ if (0 == len) ++ return -EINVAL; ++ ++ ptmp = (u8 *)rtw_malloc(len); ++ if (NULL == ptmp) ++ return -ENOMEM; ++ ++ if (copy_from_user(ptmp, p->pointer, len)) { ++ ret = -EFAULT; ++ goto exit; ++ } ++ ++ bytes = 0; ++ addr = 0; ++ sscanf(ptmp, "%d,%x", &bytes, &addr); ++ ++ switch (bytes) { ++ case 1: ++ data32 = rtw_read8(padapter, addr); ++ sprintf(extra, "0x%02X", data32); ++ break; ++ case 2: ++ data32 = rtw_read16(padapter, addr); ++ sprintf(extra, "0x%04X", data32); ++ break; ++ case 4: ++ data32 = rtw_read32(padapter, addr); ++ sprintf(extra, "0x%08X", data32); ++ break; ++ ++ #if defined(CONFIG_SDIO_HCI) && defined(CONFIG_SDIO_INDIRECT_ACCESS) && defined(DBG_SDIO_INDIRECT_ACCESS) ++ case 11: ++ data32 = rtw_sd_iread8(padapter, addr); ++ sprintf(extra, "0x%02X", data32); ++ break; ++ case 12: ++ data32 = rtw_sd_iread16(padapter, addr); ++ sprintf(extra, "0x%04X", data32); ++ break; ++ case 14: ++ data32 = rtw_sd_iread32(padapter, addr); ++ sprintf(extra, "0x%08X", data32); ++ break; ++ #endif ++ default: ++ RTW_INFO("%s: usage> read [bytes],[address(hex)]\n", __func__); ++ ret = -EINVAL; ++ goto exit; ++ } ++ RTW_INFO("%s: addr=0x%08X data=%s\n", __func__, addr, extra); ++ ++exit: ++ rtw_mfree(ptmp, len); ++ ++ return 0; ++} ++ ++static int rtw_wx_write32(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev); ++ ++ u32 addr; ++ u32 data32; ++ u32 bytes; ++ ++ ++ bytes = 0; ++ addr = 0; ++ data32 = 0; ++ sscanf(extra, "%d,%x,%x", &bytes, &addr, &data32); ++ ++ switch (bytes) { ++ case 1: ++ rtw_write8(padapter, addr, (u8)data32); ++ RTW_INFO("%s: addr=0x%08X data=0x%02X\n", __func__, addr, (u8)data32); ++ break; ++ case 2: ++ rtw_write16(padapter, addr, (u16)data32); ++ RTW_INFO("%s: addr=0x%08X data=0x%04X\n", __func__, addr, (u16)data32); ++ break; ++ case 4: ++ rtw_write32(padapter, addr, data32); ++ RTW_INFO("%s: addr=0x%08X data=0x%08X\n", __func__, addr, data32); ++ break; ++ default: ++ RTW_INFO("%s: usage> write [bytes],[address(hex)],[data(hex)]\n", __func__); ++ return -EINVAL; ++ } ++ ++ return 0; ++} ++ ++static int rtw_wx_read_rf(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u32 path, addr, data32; ++ ++ ++ path = *(u32 *)extra; ++ addr = *((u32 *)extra + 1); ++ data32 = rtw_hal_read_rfreg(padapter, path, addr, 0xFFFFF); ++ /* RTW_INFO("%s: path=%d addr=0x%02x data=0x%05x\n", __func__, path, addr, data32); */ ++ /* ++ * IMPORTANT!! ++ * Only when wireless private ioctl is at odd order, ++ * "extra" would be copied to user space. ++ */ ++ sprintf(extra, "0x%05x", data32); ++ ++ return 0; ++} ++ ++static int rtw_wx_write_rf(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u32 path, addr, data32; ++ ++ ++ path = *(u32 *)extra; ++ addr = *((u32 *)extra + 1); ++ data32 = *((u32 *)extra + 2); ++ /* RTW_INFO("%s: path=%d addr=0x%02x data=0x%05x\n", __func__, path, addr, data32); */ ++ rtw_hal_write_rfreg(padapter, path, addr, 0xFFFFF, data32); ++ ++ return 0; ++} ++ ++static int rtw_wx_priv_null(struct net_device *dev, struct iw_request_info *a, ++ union iwreq_data *wrqu, char *b) ++{ ++ return -1; ++} ++ ++static int dummy(struct net_device *dev, struct iw_request_info *a, ++ union iwreq_data *wrqu, char *b) ++{ ++ /* _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); */ ++ /* struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); */ ++ ++ /* RTW_INFO("cmd_code=%x, fwstate=0x%x\n", a->cmd, get_fwstate(pmlmepriv)); */ ++ ++ return -1; ++ ++} ++ ++static int rtw_wx_set_channel_plan(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ u8 channel_plan_req = (u8)(*((int *)wrqu)); ++ ++ if (_SUCCESS != rtw_set_channel_plan(padapter, channel_plan_req)) ++ return -EPERM; ++ ++ return 0; ++} ++ ++static int rtw_wx_set_mtk_wps_probe_ie(struct net_device *dev, ++ struct iw_request_info *a, ++ union iwreq_data *wrqu, char *b) ++{ ++#ifdef CONFIG_PLATFORM_MT53XX ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++#endif ++ return 0; ++} ++ ++static int rtw_wx_get_sensitivity(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *buf) ++{ ++#ifdef CONFIG_PLATFORM_MT53XX ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ /* Modified by Albert 20110914 */ ++ /* This is in dbm format for MTK platform. */ ++ wrqu->qual.level = padapter->recvpriv.rssi; ++ RTW_INFO(" level = %u\n", wrqu->qual.level); ++#endif ++ return 0; ++} ++ ++static int rtw_wx_set_mtk_wps_ie(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++#ifdef CONFIG_PLATFORM_MT53XX ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ return rtw_set_wpa_ie(padapter, wrqu->data.pointer, wrqu->data.length); ++#else ++ return 0; ++#endif ++} ++ ++/* ++typedef int (*iw_handler)(struct net_device *dev, struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra); ++*/ ++/* ++ * For all data larger than 16 octets, we need to use a ++ * pointer to memory allocated in user space. ++ */ ++static int rtw_drvext_hdl(struct net_device *dev, struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++#if 0 ++ struct iw_point { ++ void __user *pointer; /* Pointer to the data (in user space) */ ++ __u16 length; /* number of fields or size in bytes */ ++ __u16 flags; /* Optional params */ ++ }; ++#endif ++ ++#ifdef CONFIG_DRVEXT_MODULE ++ u8 res; ++ struct drvext_handler *phandler; ++ struct drvext_oidparam *poidparam; ++ int ret; ++ u16 len; ++ u8 *pparmbuf, bset; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *p = &wrqu->data; ++ ++ if ((!p->length) || (!p->pointer)) { ++ ret = -EINVAL; ++ goto _rtw_drvext_hdl_exit; ++ } ++ ++ ++ bset = (u8)(p->flags & 0xFFFF); ++ len = p->length; ++ pparmbuf = (u8 *)rtw_malloc(len); ++ if (pparmbuf == NULL) { ++ ret = -ENOMEM; ++ goto _rtw_drvext_hdl_exit; ++ } ++ ++ if (bset) { /* set info */ ++ if (copy_from_user(pparmbuf, p->pointer, len)) { ++ rtw_mfree(pparmbuf, len); ++ ret = -EFAULT; ++ goto _rtw_drvext_hdl_exit; ++ } ++ } else { /* query info */ ++ ++ } ++ ++ ++ /* */ ++ poidparam = (struct drvext_oidparam *)pparmbuf; ++ ++ ++ ++ /* check subcode */ ++ if (poidparam->subcode >= MAX_DRVEXT_HANDLERS) { ++ ret = -EINVAL; ++ goto _rtw_drvext_hdl_exit; ++ } ++ ++ ++ if (poidparam->subcode >= MAX_DRVEXT_OID_SUBCODES) { ++ ret = -EINVAL; ++ goto _rtw_drvext_hdl_exit; ++ } ++ ++ ++ phandler = drvextoidhandlers + poidparam->subcode; ++ ++ if (poidparam->len != phandler->parmsize) { ++ ret = -EINVAL; ++ goto _rtw_drvext_hdl_exit; ++ } ++ ++ ++ res = phandler->handler(&padapter->drvextpriv, bset, poidparam->data); ++ ++ if (res == 0) { ++ ret = 0; ++ ++ if (bset == 0x00) {/* query info */ ++ /* _rtw_memcpy(p->pointer, pparmbuf, len); */ ++ if (copy_to_user(p->pointer, pparmbuf, len)) ++ ret = -EFAULT; ++ } ++ } else ++ ret = -EFAULT; ++ ++ ++_rtw_drvext_hdl_exit: ++ ++ return ret; ++ ++#endif ++ ++ return 0; ++ ++} ++ ++static void rtw_dbg_mode_hdl(_adapter *padapter, u32 id, u8 *pdata, u32 len) ++{ ++ pRW_Reg RegRWStruct; ++ struct rf_reg_param *prfreg; ++ u8 path; ++ u8 offset; ++ u32 value; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ switch (id) { ++ case GEN_MP_IOCTL_SUBCODE(MP_START): ++ RTW_INFO("871x_driver is only for normal mode, can't enter mp mode\n"); ++ break; ++ case GEN_MP_IOCTL_SUBCODE(READ_REG): ++ RegRWStruct = (pRW_Reg)pdata; ++ switch (RegRWStruct->width) { ++ case 1: ++ RegRWStruct->value = rtw_read8(padapter, RegRWStruct->offset); ++ break; ++ case 2: ++ RegRWStruct->value = rtw_read16(padapter, RegRWStruct->offset); ++ break; ++ case 4: ++ RegRWStruct->value = rtw_read32(padapter, RegRWStruct->offset); ++ break; ++ default: ++ break; ++ } ++ ++ break; ++ case GEN_MP_IOCTL_SUBCODE(WRITE_REG): ++ RegRWStruct = (pRW_Reg)pdata; ++ switch (RegRWStruct->width) { ++ case 1: ++ rtw_write8(padapter, RegRWStruct->offset, (u8)RegRWStruct->value); ++ break; ++ case 2: ++ rtw_write16(padapter, RegRWStruct->offset, (u16)RegRWStruct->value); ++ break; ++ case 4: ++ rtw_write32(padapter, RegRWStruct->offset, (u32)RegRWStruct->value); ++ break; ++ default: ++ break; ++ } ++ ++ break; ++ case GEN_MP_IOCTL_SUBCODE(READ_RF_REG): ++ ++ prfreg = (struct rf_reg_param *)pdata; ++ ++ path = (u8)prfreg->path; ++ offset = (u8)prfreg->offset; ++ ++ value = rtw_hal_read_rfreg(padapter, path, offset, 0xffffffff); ++ ++ prfreg->value = value; ++ ++ break; ++ case GEN_MP_IOCTL_SUBCODE(WRITE_RF_REG): ++ ++ prfreg = (struct rf_reg_param *)pdata; ++ ++ path = (u8)prfreg->path; ++ offset = (u8)prfreg->offset; ++ value = prfreg->value; ++ ++ rtw_hal_write_rfreg(padapter, path, offset, 0xffffffff, value); ++ ++ break; ++ case GEN_MP_IOCTL_SUBCODE(TRIGGER_GPIO): ++ RTW_INFO("==> trigger gpio 0\n"); ++ rtw_hal_set_hwreg(padapter, HW_VAR_TRIGGER_GPIO_0, 0); ++ break; ++#ifdef CONFIG_BT_COEXIST ++ case GEN_MP_IOCTL_SUBCODE(SET_DM_BT): ++ RTW_INFO("==> set dm_bt_coexist:%x\n", *(u8 *)pdata); ++ rtw_hal_set_hwreg(padapter, HW_VAR_BT_SET_COEXIST, pdata); ++ break; ++ case GEN_MP_IOCTL_SUBCODE(DEL_BA): ++ RTW_INFO("==> delete ba:%x\n", *(u8 *)pdata); ++ rtw_hal_set_hwreg(padapter, HW_VAR_BT_ISSUE_DELBA, pdata); ++ break; ++#endif ++#ifdef DBG_CONFIG_ERROR_DETECT ++ case GEN_MP_IOCTL_SUBCODE(GET_WIFI_STATUS): ++ *pdata = rtw_hal_sreset_get_wifi_status(padapter); ++ break; ++#endif ++ ++ default: ++ break; ++ } ++ ++} ++#ifdef MP_IOCTL_HDL ++static int rtw_mp_ioctl_hdl(struct net_device *dev, struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ u32 BytesRead, BytesWritten, BytesNeeded; ++ struct oid_par_priv oid_par; ++ struct mp_ioctl_handler *phandler; ++ struct mp_ioctl_param *poidparam; ++ uint status = 0; ++ u16 len; ++ u8 *pparmbuf = NULL, bset; ++ PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev); ++ struct iw_point *p = &wrqu->data; ++ ++ /* RTW_INFO("+rtw_mp_ioctl_hdl\n"); */ ++ ++ /* mutex_lock(&ioctl_mutex); */ ++ ++ if ((!p->length) || (!p->pointer)) { ++ ret = -EINVAL; ++ goto _rtw_mp_ioctl_hdl_exit; ++ } ++ ++ pparmbuf = NULL; ++ bset = (u8)(p->flags & 0xFFFF); ++ len = p->length; ++ pparmbuf = (u8 *)rtw_malloc(len); ++ if (pparmbuf == NULL) { ++ ret = -ENOMEM; ++ goto _rtw_mp_ioctl_hdl_exit; ++ } ++ ++ if (copy_from_user(pparmbuf, p->pointer, len)) { ++ ret = -EFAULT; ++ goto _rtw_mp_ioctl_hdl_exit; ++ } ++ ++ poidparam = (struct mp_ioctl_param *)pparmbuf; ++ ++ if (poidparam->subcode >= MAX_MP_IOCTL_SUBCODE) { ++ ret = -EINVAL; ++ goto _rtw_mp_ioctl_hdl_exit; ++ } ++ ++ /* RTW_INFO("%s: %d\n", __func__, poidparam->subcode); */ ++#ifdef CONFIG_MP_INCLUDED ++ if (padapter->registrypriv.mp_mode == 1) { ++ phandler = mp_ioctl_hdl + poidparam->subcode; ++ ++ if ((phandler->paramsize != 0) && (poidparam->len < phandler->paramsize)) { ++ ret = -EINVAL; ++ goto _rtw_mp_ioctl_hdl_exit; ++ } ++ ++ if (phandler->handler) { ++ oid_par.adapter_context = padapter; ++ oid_par.oid = phandler->oid; ++ oid_par.information_buf = poidparam->data; ++ oid_par.information_buf_len = poidparam->len; ++ oid_par.dbg = 0; ++ ++ BytesWritten = 0; ++ BytesNeeded = 0; ++ ++ if (bset) { ++ oid_par.bytes_rw = &BytesRead; ++ oid_par.bytes_needed = &BytesNeeded; ++ oid_par.type_of_oid = SET_OID; ++ } else { ++ oid_par.bytes_rw = &BytesWritten; ++ oid_par.bytes_needed = &BytesNeeded; ++ oid_par.type_of_oid = QUERY_OID; ++ } ++ ++ status = phandler->handler(&oid_par); ++ ++ /* todo:check status, BytesNeeded, etc. */ ++ } else { ++ RTW_INFO("rtw_mp_ioctl_hdl(): err!, subcode=%d, oid=%d, handler=%p\n", ++ poidparam->subcode, phandler->oid, phandler->handler); ++ ret = -EFAULT; ++ goto _rtw_mp_ioctl_hdl_exit; ++ } ++ } else ++#endif ++ { ++ rtw_dbg_mode_hdl(padapter, poidparam->subcode, poidparam->data, poidparam->len); ++ } ++ ++ if (bset == 0x00) {/* query info */ ++ if (copy_to_user(p->pointer, pparmbuf, len)) ++ ret = -EFAULT; ++ } ++ ++ if (status) { ++ ret = -EFAULT; ++ goto _rtw_mp_ioctl_hdl_exit; ++ } ++ ++_rtw_mp_ioctl_hdl_exit: ++ ++ if (pparmbuf) ++ rtw_mfree(pparmbuf, len); ++ ++ /* mutex_unlock(&ioctl_mutex); */ ++ ++ return ret; ++} ++#endif ++static int rtw_get_ap_info(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int bssid_match, ret = 0; ++ u32 cnt = 0, wpa_ielen; ++ _irqL irqL; ++ _list *plist, *phead; ++ unsigned char *pbuf; ++ u8 bssid[ETH_ALEN]; ++ char data[32]; ++ struct wlan_network *pnetwork = NULL; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct iw_point *pdata = &wrqu->data; ++ ++ RTW_INFO("+rtw_get_aplist_info\n"); ++ ++ if (rtw_is_drv_stopped(padapter) || (pdata == NULL)) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ while ((check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY | _FW_UNDER_LINKING))) == _TRUE) { ++ rtw_msleep_os(30); ++ cnt++; ++ if (cnt > 100) ++ break; ++ } ++ ++ ++ /* pdata->length = 0; */ /* ? */ ++ pdata->flags = 0; ++ if (pdata->length >= 32) { ++ if (copy_from_user(data, pdata->pointer, 32)) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ } else { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ ++ /* if(hwaddr_aton_i(pdata->pointer, bssid)) */ ++ if (hwaddr_aton_i(data, bssid)) { ++ RTW_INFO("Invalid BSSID '%s'.\n", (u8 *)data); ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ return -EINVAL; ++ } ++ ++ ++ if (_rtw_memcmp(bssid, pnetwork->network.MacAddress, ETH_ALEN) == _TRUE) { /* BSSID match, then check if supporting wpa/wpa2 */ ++ RTW_INFO("BSSID:" MAC_FMT "\n", MAC_ARG(bssid)); ++ ++ pbuf = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength - 12); ++ if (pbuf && (wpa_ielen > 0)) { ++ pdata->flags = 1; ++ break; ++ } ++ ++ pbuf = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength - 12); ++ if (pbuf && (wpa_ielen > 0)) { ++ pdata->flags = 2; ++ break; ++ } ++ ++ } ++ ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ if (pdata->length >= 34) { ++ if (copy_to_user((u8 *)pdata->pointer + 32, (u8 *)&pdata->flags, 1)) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ } ++ ++exit: ++ ++ return ret; ++ ++} ++ ++static int rtw_set_pid(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = rtw_netdev_priv(dev); ++ int *pdata = (int *)wrqu; ++ int selector; ++ ++ if (rtw_is_drv_stopped(padapter) || (pdata == NULL)) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ selector = *pdata; ++ if (selector < 3 && selector >= 0) { ++ padapter->pid[selector] = *(pdata + 1); ++#ifdef CONFIG_GLOBAL_UI_PID ++ ui_pid[selector] = *(pdata + 1); ++#endif ++ RTW_INFO("%s set pid[%d]=%d\n", __FUNCTION__, selector , padapter->pid[selector]); ++ } else ++ RTW_INFO("%s selector %d error\n", __FUNCTION__, selector); ++ ++exit: ++ ++ return ret; ++ ++} ++ ++static int rtw_wps_start(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ u32 u32wps_start = 0; ++ unsigned int uintRet = 0; ++ ++ if (RTW_CANNOT_RUN(padapter) || (NULL == pdata)) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ uintRet = copy_from_user((void *) &u32wps_start, pdata->pointer, 4); ++ if (u32wps_start == 0) ++ u32wps_start = *extra; ++ ++ RTW_INFO("[%s] wps_start = %d\n", __FUNCTION__, u32wps_start); ++ ++ if (u32wps_start == 1) /* WPS Start */ ++ rtw_led_control(padapter, LED_CTL_START_WPS); ++ else if (u32wps_start == 2) /* WPS Stop because of wps success */ ++ rtw_led_control(padapter, LED_CTL_STOP_WPS); ++ else if (u32wps_start == 3) /* WPS Stop because of wps fail */ ++ rtw_led_control(padapter, LED_CTL_STOP_WPS_FAIL); ++ ++#ifdef CONFIG_INTEL_WIDI ++ process_intel_widi_wps_status(padapter, u32wps_start); ++#endif /* CONFIG_INTEL_WIDI */ ++ ++exit: ++ ++ return ret; ++ ++} ++ ++#ifdef CONFIG_P2P ++static int rtw_wext_p2p_enable(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ enum P2P_ROLE init_role = P2P_ROLE_DISABLE; ++ ++ if (*extra == '0') ++ init_role = P2P_ROLE_DISABLE; ++ else if (*extra == '1') ++ init_role = P2P_ROLE_DEVICE; ++ else if (*extra == '2') ++ init_role = P2P_ROLE_CLIENT; ++ else if (*extra == '3') ++ init_role = P2P_ROLE_GO; ++ ++ if (_FAIL == rtw_p2p_enable(padapter, init_role)) { ++ ret = -EFAULT; ++ goto exit; ++ } ++ ++ /* set channel/bandwidth */ ++ if (init_role != P2P_ROLE_DISABLE) { ++ u8 channel, ch_offset; ++ u16 bwmode; ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN)) { ++ /* Stay at the listen state and wait for discovery. */ ++ channel = pwdinfo->listen_channel; ++ pwdinfo->operating_channel = pwdinfo->listen_channel; ++ ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ bwmode = CHANNEL_WIDTH_20; ++ } ++#ifdef CONFIG_CONCURRENT_MODE ++ else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) { ++ ++ _set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_interval); ++ ++ channel = rtw_mi_get_union_chan(padapter); ++ ch_offset = rtw_mi_get_union_offset(padapter); ++ bwmode = rtw_mi_get_union_bw(padapter); ++ ++ pwdinfo->operating_channel = channel; ++ } ++#endif ++ else { ++ pwdinfo->operating_channel = pmlmeext->cur_channel; ++ ++ channel = pwdinfo->operating_channel; ++ ch_offset = pmlmeext->cur_ch_offset; ++ bwmode = pmlmeext->cur_bwmode; ++ } ++ ++ set_channel_bwmode(padapter, channel, ch_offset, bwmode); ++ } ++ ++exit: ++ return ret; ++ ++} ++ ++static int rtw_p2p_set_go_nego_ssid(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ RTW_INFO("[%s] ssid = %s, len = %zu\n", __FUNCTION__, extra, strlen(extra)); ++ _rtw_memcpy(pwdinfo->nego_ssid, extra, strlen(extra)); ++ pwdinfo->nego_ssidlen = strlen(extra); ++ ++ return ret; ++ ++} ++ ++ ++static int rtw_p2p_set_intent(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 intent = pwdinfo->intent; ++ ++ extra[wrqu->data.length] = 0x00; ++ ++ intent = rtw_atoi(extra); ++ ++ if (intent <= 15) ++ pwdinfo->intent = intent; ++ else ++ ret = -1; ++ ++ RTW_INFO("[%s] intent = %d\n", __FUNCTION__, intent); ++ ++ return ret; ++ ++} ++ ++static int rtw_p2p_set_listen_ch(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 listen_ch = pwdinfo->listen_channel; /* Listen channel number */ ++ ++ extra[wrqu->data.length] = 0x00; ++ listen_ch = rtw_atoi(extra); ++ ++ if ((listen_ch == 1) || (listen_ch == 6) || (listen_ch == 11)) { ++ pwdinfo->listen_channel = listen_ch; ++ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ } else ++ ret = -1; ++ ++ RTW_INFO("[%s] listen_ch = %d\n", __FUNCTION__, pwdinfo->listen_channel); ++ ++ return ret; ++ ++} ++ ++static int rtw_p2p_set_op_ch(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ /* Commented by Albert 20110524 ++ * This function is used to set the operating channel if the driver will become the group owner */ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 op_ch = pwdinfo->operating_channel; /* Operating channel number */ ++ ++ extra[wrqu->data.length] = 0x00; ++ ++ op_ch = (u8) rtw_atoi(extra); ++ if (op_ch > 0) ++ pwdinfo->operating_channel = op_ch; ++ else ++ ret = -1; ++ ++ RTW_INFO("[%s] op_ch = %d\n", __FUNCTION__, pwdinfo->operating_channel); ++ ++ return ret; ++ ++} ++ ++ ++static int rtw_p2p_profilefound(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ /* Comment by Albert 2010/10/13 */ ++ /* Input data format: */ ++ /* Ex: 0 */ ++ /* Ex: 1XX:XX:XX:XX:XX:XXYYSSID */ ++ /* 0 => Reflush the profile record list. */ ++ /* 1 => Add the profile list */ ++ /* XX:XX:XX:XX:XX:XX => peer's MAC Address ( ex: 00:E0:4C:00:00:01 ) */ ++ /* YY => SSID Length */ ++ /* SSID => SSID for persistence group */ ++ ++ RTW_INFO("[%s] In value = %s, len = %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ ++ ++ /* The upper application should pass the SSID to driver by using this rtw_p2p_profilefound function. */ ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ if (extra[0] == '0') { ++ /* Remove all the profile information of wifidirect_info structure. */ ++ _rtw_memset(&pwdinfo->profileinfo[0], 0x00, sizeof(struct profile_info) * P2P_MAX_PERSISTENT_GROUP_NUM); ++ pwdinfo->profileindex = 0; ++ } else { ++ if (pwdinfo->profileindex >= P2P_MAX_PERSISTENT_GROUP_NUM) ++ ret = -1; ++ else { ++ int jj, kk; ++ ++ /* Add this profile information into pwdinfo->profileinfo */ ++ /* Ex: 1XX:XX:XX:XX:XX:XXYYSSID */ ++ for (jj = 0, kk = 1; jj < ETH_ALEN; jj++, kk += 3) ++ pwdinfo->profileinfo[pwdinfo->profileindex].peermac[jj] = key_2char2num(extra[kk], extra[kk + 1]); ++ ++ /* pwdinfo->profileinfo[pwdinfo->profileindex].ssidlen = ( extra[18] - '0' ) * 10 + ( extra[19] - '0' ); */ ++ /* _rtw_memcpy( pwdinfo->profileinfo[pwdinfo->profileindex].ssid, &extra[20], pwdinfo->profileinfo[pwdinfo->profileindex].ssidlen ); */ ++ pwdinfo->profileindex++; ++ } ++ } ++ } ++ ++ return ret; ++ ++} ++ ++static int rtw_p2p_setDN(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ ++ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ _rtw_memset(pwdinfo->device_name, 0x00, WPS_MAX_DEVICE_NAME_LEN); ++ _rtw_memcpy(pwdinfo->device_name, extra, wrqu->data.length - 1); ++ pwdinfo->device_name_len = wrqu->data.length - 1; ++ ++ return ret; ++ ++} ++ ++ ++static int rtw_p2p_get_status(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ if (padapter->bShowGetP2PState) { ++ RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), ++ pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], pwdinfo->p2p_peer_interface_addr[2], ++ pwdinfo->p2p_peer_interface_addr[3], pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]); ++ } ++ ++ /* Commented by Albert 2010/10/12 */ ++ /* Because of the output size limitation, I had removed the "Role" information. */ ++ /* About the "Role" information, we will use the new private IOCTL to get the "Role" information. */ ++ sprintf(extra, "\n\nStatus=%.2d\n", rtw_p2p_state(pwdinfo)); ++ wrqu->data.length = strlen(extra); ++ ++ return ret; ++ ++} ++ ++/* Commented by Albert 20110520 ++ * This function will return the config method description ++ * This config method description will show us which config method the remote P2P device is intented to use ++ * by sending the provisioning discovery request frame. */ ++ ++static int rtw_p2p_get_req_cm(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ sprintf(extra, "\n\nCM=%s\n", pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req); ++ wrqu->data.length = strlen(extra); ++ return ret; ++ ++} ++ ++ ++static int rtw_p2p_get_role(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ ++ RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), ++ pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], pwdinfo->p2p_peer_interface_addr[2], ++ pwdinfo->p2p_peer_interface_addr[3], pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]); ++ ++ sprintf(extra, "\n\nRole=%.2d\n", rtw_p2p_role(pwdinfo)); ++ wrqu->data.length = strlen(extra); ++ return ret; ++ ++} ++ ++ ++static int rtw_p2p_get_peer_ifaddr(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ ++ RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), ++ pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], pwdinfo->p2p_peer_interface_addr[2], ++ pwdinfo->p2p_peer_interface_addr[3], pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]); ++ ++ sprintf(extra, "\nMAC %.2X:%.2X:%.2X:%.2X:%.2X:%.2X", ++ pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], pwdinfo->p2p_peer_interface_addr[2], ++ pwdinfo->p2p_peer_interface_addr[3], pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]); ++ wrqu->data.length = strlen(extra); ++ return ret; ++ ++} ++ ++static int rtw_p2p_get_peer_devaddr(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++ ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), ++ pwdinfo->rx_prov_disc_info.peerDevAddr[0], pwdinfo->rx_prov_disc_info.peerDevAddr[1], ++ pwdinfo->rx_prov_disc_info.peerDevAddr[2], pwdinfo->rx_prov_disc_info.peerDevAddr[3], ++ pwdinfo->rx_prov_disc_info.peerDevAddr[4], pwdinfo->rx_prov_disc_info.peerDevAddr[5]); ++ sprintf(extra, "\n%.2X%.2X%.2X%.2X%.2X%.2X", ++ pwdinfo->rx_prov_disc_info.peerDevAddr[0], pwdinfo->rx_prov_disc_info.peerDevAddr[1], ++ pwdinfo->rx_prov_disc_info.peerDevAddr[2], pwdinfo->rx_prov_disc_info.peerDevAddr[3], ++ pwdinfo->rx_prov_disc_info.peerDevAddr[4], pwdinfo->rx_prov_disc_info.peerDevAddr[5]); ++ wrqu->data.length = strlen(extra); ++ return ret; ++ ++} ++ ++static int rtw_p2p_get_peer_devaddr_by_invitation(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++ ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), ++ pwdinfo->p2p_peer_device_addr[0], pwdinfo->p2p_peer_device_addr[1], ++ pwdinfo->p2p_peer_device_addr[2], pwdinfo->p2p_peer_device_addr[3], ++ pwdinfo->p2p_peer_device_addr[4], pwdinfo->p2p_peer_device_addr[5]); ++ sprintf(extra, "\nMAC %.2X:%.2X:%.2X:%.2X:%.2X:%.2X", ++ pwdinfo->p2p_peer_device_addr[0], pwdinfo->p2p_peer_device_addr[1], ++ pwdinfo->p2p_peer_device_addr[2], pwdinfo->p2p_peer_device_addr[3], ++ pwdinfo->p2p_peer_device_addr[4], pwdinfo->p2p_peer_device_addr[5]); ++ wrqu->data.length = strlen(extra); ++ return ret; ++ ++} ++ ++static int rtw_p2p_get_groupid(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++ ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ sprintf(extra, "\n%.2X:%.2X:%.2X:%.2X:%.2X:%.2X %s", ++ pwdinfo->groupid_info.go_device_addr[0], pwdinfo->groupid_info.go_device_addr[1], ++ pwdinfo->groupid_info.go_device_addr[2], pwdinfo->groupid_info.go_device_addr[3], ++ pwdinfo->groupid_info.go_device_addr[4], pwdinfo->groupid_info.go_device_addr[5], ++ pwdinfo->groupid_info.ssid); ++ wrqu->data.length = strlen(extra); ++ return ret; ++ ++} ++ ++static int rtw_p2p_get_op_ch(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++ ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ ++ RTW_INFO("[%s] Op_ch = %02x\n", __FUNCTION__, pwdinfo->operating_channel); ++ ++ sprintf(extra, "\n\nOp_ch=%.2d\n", pwdinfo->operating_channel); ++ wrqu->data.length = strlen(extra); ++ return ret; ++ ++} ++ ++static int rtw_p2p_get_wps_configmethod(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra, char *subcmd) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 peerMAC[ETH_ALEN] = { 0x00 }; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ _irqL irqL; ++ _list *plist, *phead; ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ u8 blnMatch = 0; ++ u16 attr_content = 0; ++ uint attr_contentlen = 0; ++ u8 attr_content_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; ++ ++ /* Commented by Albert 20110727 */ ++ /* The input data is the MAC address which the application wants to know its WPS config method. */ ++ /* After knowing its WPS config method, the application can decide the config method for provisioning discovery. */ ++ /* Format: iwpriv wlanx p2p_get_wpsCM 00:E0:4C:00:00:05 */ ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd); ++ ++ macstr2num(peerMAC, subcmd); ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { ++ u8 *wpsie; ++ uint wpsie_len = 0; ++ ++ /* The mac address is matched. */ ++ ++ wpsie = rtw_get_wps_ie_from_scan_queue(&pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &wpsie_len, pnetwork->network.Reserved[0]); ++ if (wpsie) { ++ rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_CONF_METHOD, (u8 *)&attr_content, &attr_contentlen); ++ if (attr_contentlen) { ++ attr_content = be16_to_cpu(attr_content); ++ sprintf(attr_content_str, "\n\nM=%.4d", attr_content); ++ blnMatch = 1; ++ } ++ } ++ ++ break; ++ } ++ ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ if (!blnMatch) ++ sprintf(attr_content_str, "\n\nM=0000"); ++ ++ wrqu->data.length = strlen(attr_content_str); ++ _rtw_memcpy(extra, attr_content_str, wrqu->data.length); ++ ++ return ret; ++ ++} ++ ++#ifdef CONFIG_WFD ++static int rtw_p2p_get_peer_wfd_port(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ RTW_INFO("[%s] p2p_state = %d\n", __FUNCTION__, rtw_p2p_state(pwdinfo)); ++ ++ sprintf(extra, "\n\nPort=%d\n", pwdinfo->wfd_info->peer_rtsp_ctrlport); ++ RTW_INFO("[%s] remote port = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_rtsp_ctrlport); ++ ++ wrqu->data.length = strlen(extra); ++ return ret; ++ ++} ++ ++static int rtw_p2p_get_peer_wfd_preferred_connection(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ sprintf(extra, "\n\nwfd_pc=%d\n", pwdinfo->wfd_info->wfd_pc); ++ RTW_INFO("[%s] wfd_pc = %d\n", __FUNCTION__, pwdinfo->wfd_info->wfd_pc); ++ ++ wrqu->data.length = strlen(extra); ++ pwdinfo->wfd_info->wfd_pc = _FALSE; /* Reset the WFD preferred connection to P2P */ ++ return ret; ++ ++} ++ ++static int rtw_p2p_get_peer_wfd_session_available(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ sprintf(extra, "\n\nwfd_sa=%d\n", pwdinfo->wfd_info->peer_session_avail); ++ RTW_INFO("[%s] wfd_sa = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_session_avail); ++ ++ wrqu->data.length = strlen(extra); ++ pwdinfo->wfd_info->peer_session_avail = _TRUE; /* Reset the WFD session available */ ++ return ret; ++ ++} ++#endif /* CONFIG_WFD */ ++ ++static int rtw_p2p_get_go_device_address(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra, char *subcmd) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 peerMAC[ETH_ALEN] = { 0x00 }; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ _irqL irqL; ++ _list *plist, *phead; ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ u8 blnMatch = 0; ++ u8 *p2pie; ++ uint p2pielen = 0, attr_contentlen = 0; ++ u8 attr_content[100] = { 0x00 }; ++ u8 go_devadd_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; ++ ++ /* Commented by Albert 20121209 */ ++ /* The input data is the GO's interface address which the application wants to know its device address. */ ++ /* Format: iwpriv wlanx p2p_get2 go_devadd=00:E0:4C:00:00:05 */ ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd); ++ ++ macstr2num(peerMAC, subcmd); ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { ++ /* Commented by Albert 2011/05/18 */ ++ /* Match the device address located in the P2P IE */ ++ /* This is for the case that the P2P device address is not the same as the P2P interface address. */ ++ ++ p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen); ++ if (p2pie) { ++ while (p2pie) { ++ /* The P2P Device ID attribute is included in the Beacon frame. */ ++ /* The P2P Device Info attribute is included in the probe response frame. */ ++ ++ _rtw_memset(attr_content, 0x00, 100); ++ if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen)) { ++ /* Handle the P2P Device ID attribute of Beacon first */ ++ blnMatch = 1; ++ break; ++ ++ } else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen)) { ++ /* Handle the P2P Device Info attribute of probe response */ ++ blnMatch = 1; ++ break; ++ } ++ ++ /* Get the next P2P IE */ ++ p2pie = rtw_get_p2p_ie(p2pie + p2pielen, BSS_EX_TLV_IES_LEN(&pnetwork->network) - (p2pie + p2pielen - BSS_EX_TLV_IES(&pnetwork->network)), NULL, &p2pielen); ++ } ++ } ++ } ++ ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ if (!blnMatch) ++ sprintf(go_devadd_str, "\n\ndev_add=NULL"); ++ else { ++ sprintf(go_devadd_str, "\n\ndev_add=%.2X:%.2X:%.2X:%.2X:%.2X:%.2X", ++ attr_content[0], attr_content[1], attr_content[2], attr_content[3], attr_content[4], attr_content[5]); ++ } ++ ++ wrqu->data.length = strlen(go_devadd_str); ++ _rtw_memcpy(extra, go_devadd_str, wrqu->data.length); ++ ++ return ret; ++ ++} ++ ++static int rtw_p2p_get_device_type(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra, char *subcmd) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 peerMAC[ETH_ALEN] = { 0x00 }; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ _irqL irqL; ++ _list *plist, *phead; ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ u8 blnMatch = 0; ++ u8 dev_type[8] = { 0x00 }; ++ uint dev_type_len = 0; ++ u8 dev_type_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; /* +9 is for the str "dev_type=", we have to clear it at wrqu->data.pointer */ ++ ++ /* Commented by Albert 20121209 */ ++ /* The input data is the MAC address which the application wants to know its device type. */ ++ /* Such user interface could know the device type. */ ++ /* Format: iwpriv wlanx p2p_get2 dev_type=00:E0:4C:00:00:05 */ ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd); ++ ++ macstr2num(peerMAC, subcmd); ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { ++ u8 *wpsie; ++ uint wpsie_len = 0; ++ ++ /* The mac address is matched. */ ++ ++ wpsie = rtw_get_wps_ie_from_scan_queue(&pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &wpsie_len, pnetwork->network.Reserved[0]); ++ if (wpsie) { ++ rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_PRIMARY_DEV_TYPE, dev_type, &dev_type_len); ++ if (dev_type_len) { ++ u16 type = 0; ++ ++ _rtw_memcpy(&type, dev_type, 2); ++ type = be16_to_cpu(type); ++ sprintf(dev_type_str, "\n\nN=%.2d", type); ++ blnMatch = 1; ++ } ++ } ++ break; ++ } ++ ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ if (!blnMatch) ++ sprintf(dev_type_str, "\n\nN=00"); ++ ++ wrqu->data.length = strlen(dev_type_str); ++ _rtw_memcpy(extra, dev_type_str, wrqu->data.length); ++ ++ return ret; ++ ++} ++ ++static int rtw_p2p_get_device_name(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra, char *subcmd) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 peerMAC[ETH_ALEN] = { 0x00 }; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ _irqL irqL; ++ _list *plist, *phead; ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ u8 blnMatch = 0; ++ u8 dev_name[WPS_MAX_DEVICE_NAME_LEN] = { 0x00 }; ++ uint dev_len = 0; ++ u8 dev_name_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; ++ ++ /* Commented by Albert 20121225 */ ++ /* The input data is the MAC address which the application wants to know its device name. */ ++ /* Such user interface could show peer device's device name instead of ssid. */ ++ /* Format: iwpriv wlanx p2p_get2 devN=00:E0:4C:00:00:05 */ ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd); ++ ++ macstr2num(peerMAC, subcmd); ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { ++ u8 *wpsie; ++ uint wpsie_len = 0; ++ ++ /* The mac address is matched. */ ++ ++ wpsie = rtw_get_wps_ie_from_scan_queue(&pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &wpsie_len, pnetwork->network.Reserved[0]); ++ if (wpsie) { ++ rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_DEVICE_NAME, dev_name, &dev_len); ++ if (dev_len) { ++ sprintf(dev_name_str, "\n\nN=%s", dev_name); ++ blnMatch = 1; ++ } ++ } ++ break; ++ } ++ ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ if (!blnMatch) ++ sprintf(dev_name_str, "\n\nN=0000"); ++ ++ wrqu->data.length = strlen(dev_name_str); ++ _rtw_memcpy(extra, dev_name_str, wrqu->data.length); ++ ++ return ret; ++ ++} ++ ++static int rtw_p2p_get_invitation_procedure(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra, char *subcmd) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 peerMAC[ETH_ALEN] = { 0x00 }; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ _irqL irqL; ++ _list *plist, *phead; ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ u8 blnMatch = 0; ++ u8 *p2pie; ++ uint p2pielen = 0, attr_contentlen = 0; ++ u8 attr_content[2] = { 0x00 }; ++ u8 inv_proc_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; ++ ++ /* Commented by Ouden 20121226 */ ++ /* The application wants to know P2P initation procedure is support or not. */ ++ /* Format: iwpriv wlanx p2p_get2 InvProc=00:E0:4C:00:00:05 */ ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd); ++ ++ macstr2num(peerMAC, subcmd); ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { ++ /* Commented by Albert 20121226 */ ++ /* Match the device address located in the P2P IE */ ++ /* This is for the case that the P2P device address is not the same as the P2P interface address. */ ++ ++ p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen); ++ if (p2pie) { ++ while (p2pie) { ++ /* _rtw_memset( attr_content, 0x00, 2); */ ++ if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_CAPABILITY, attr_content, &attr_contentlen)) { ++ /* Handle the P2P capability attribute */ ++ blnMatch = 1; ++ break; ++ ++ } ++ ++ /* Get the next P2P IE */ ++ p2pie = rtw_get_p2p_ie(p2pie + p2pielen, BSS_EX_TLV_IES_LEN(&pnetwork->network) - (p2pie + p2pielen - BSS_EX_TLV_IES(&pnetwork->network)), NULL, &p2pielen); ++ } ++ } ++ } ++ ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ if (!blnMatch) ++ sprintf(inv_proc_str, "\nIP=-1"); ++ else { ++ if ((attr_content[0] & 0x20) == 0x20) ++ sprintf(inv_proc_str, "\nIP=1"); ++ else ++ sprintf(inv_proc_str, "\nIP=0"); ++ } ++ ++ wrqu->data.length = strlen(inv_proc_str); ++ _rtw_memcpy(extra, inv_proc_str, wrqu->data.length); ++ ++ return ret; ++ ++} ++ ++static int rtw_p2p_connect(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 peerMAC[ETH_ALEN] = { 0x00 }; ++ int jj, kk; ++ u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ _irqL irqL; ++ _list *plist, *phead; ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ uint uintPeerChannel = 0; ++ ++ /* Commented by Albert 20110304 */ ++ /* The input data contains two informations. */ ++ /* 1. First information is the MAC address which wants to formate with */ ++ /* 2. Second information is the WPS PINCode or "pbc" string for push button method */ ++ /* Format: 00:E0:4C:00:00:05 */ ++ /* Format: 00:E0:4C:00:00:05 */ ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); ++ ++ if (pwdinfo->p2p_state == P2P_STATE_NONE) { ++ RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__); ++ return ret; ++ } ++ ++#ifdef CONFIG_INTEL_WIDI ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { ++ RTW_INFO("[%s] WiFi is under survey!\n", __FUNCTION__); ++ return ret; ++ } ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ if (pwdinfo->ui_got_wps_info == P2P_NO_WPSINFO) ++ return -1; ++ ++ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) ++ peerMAC[jj] = key_2char2num(extra[kk], extra[kk + 1]); ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { ++ if (pnetwork->network.Configuration.DSConfig != 0) ++ uintPeerChannel = pnetwork->network.Configuration.DSConfig; ++ else if (pwdinfo->nego_req_info.peer_ch != 0) ++ uintPeerChannel = pnetwork->network.Configuration.DSConfig = pwdinfo->nego_req_info.peer_ch; ++ else { ++ /* Unexpected case */ ++ uintPeerChannel = 0; ++ RTW_INFO("%s uintPeerChannel = 0\n", __func__); ++ } ++ break; ++ } ++ ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ if (uintPeerChannel) { ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) ++ _cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer); ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ _rtw_memset(&pwdinfo->nego_req_info, 0x00, sizeof(struct tx_nego_req_info)); ++ _rtw_memset(&pwdinfo->groupid_info, 0x00, sizeof(struct group_id_info)); ++ ++ pwdinfo->nego_req_info.peer_channel_num[0] = uintPeerChannel; ++ _rtw_memcpy(pwdinfo->nego_req_info.peerDevAddr, pnetwork->network.MacAddress, ETH_ALEN); ++ pwdinfo->nego_req_info.benable = _TRUE; ++ ++ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); ++ if (rtw_p2p_state(pwdinfo) != P2P_STATE_GONEGO_OK) { ++ /* Restore to the listen state if the current p2p state is not nego OK */ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); ++ } ++ ++ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_ING); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) { ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ u8 union_bw = rtw_mi_get_union_bw(padapter); ++ u8 union_offset = rtw_mi_get_union_offset(padapter); ++ /* Have to enter the power saving with the AP */ ++ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); ++ ++ rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); ++ } ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ RTW_INFO("[%s] Start PreTx Procedure!\n", __FUNCTION__); ++ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) ++ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_GO_NEGO_TIMEOUT); ++ else ++ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_GO_NEGO_TIMEOUT); ++#else ++ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_GO_NEGO_TIMEOUT); ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ } else { ++ RTW_INFO("[%s] Not Found in Scanning Queue~\n", __FUNCTION__); ++#ifdef CONFIG_INTEL_WIDI ++ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); ++ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); ++ rtw_free_network_queue(padapter, _TRUE); ++ /** ++ * For WiDi, if we can't find candidate device in scanning queue, ++ * driver will do scanning itself ++ */ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ rtw_sitesurvey_cmd(padapter, NULL, 0, NULL, 0); ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++#endif /* CONFIG_INTEL_WIDI */ ++ ret = -1; ++ } ++exit: ++ return ret; ++} ++ ++static int rtw_p2p_invite_req(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ int jj, kk; ++ u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ _list *plist, *phead; ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ uint uintPeerChannel = 0; ++ u8 attr_content[50] = { 0x00 }, _status = 0; ++ u8 *p2pie; ++ uint p2pielen = 0, attr_contentlen = 0; ++ _irqL irqL; ++ struct tx_invite_req_info *pinvite_req_info = &pwdinfo->invitereq_info; ++ ++ /* Commented by Albert 20120321 */ ++ /* The input data contains two informations. */ ++ /* 1. First information is the P2P device address which you want to send to. */ ++ /* 2. Second information is the group id which combines with GO's mac address, space and GO's ssid. */ ++ /* Command line sample: iwpriv wlan0 p2p_set invite="00:11:22:33:44:55 00:E0:4C:00:00:05 DIRECT-xy" */ ++ /* Format: 00:11:22:33:44:55 00:E0:4C:00:00:05 DIRECT-xy */ ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); ++ ++ if (wrqu->data.length <= 37) { ++ RTW_INFO("[%s] Wrong format!\n", __FUNCTION__); ++ return ret; ++ } ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__); ++ return ret; ++ } else { ++ /* Reset the content of struct tx_invite_req_info */ ++ pinvite_req_info->benable = _FALSE; ++ _rtw_memset(pinvite_req_info->go_bssid, 0x00, ETH_ALEN); ++ _rtw_memset(pinvite_req_info->go_ssid, 0x00, WLAN_SSID_MAXLEN); ++ pinvite_req_info->ssidlen = 0x00; ++ pinvite_req_info->operating_ch = pwdinfo->operating_channel; ++ _rtw_memset(pinvite_req_info->peer_macaddr, 0x00, ETH_ALEN); ++ pinvite_req_info->token = 3; ++ } ++ ++ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) ++ pinvite_req_info->peer_macaddr[jj] = key_2char2num(extra[kk], extra[kk + 1]); ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ ++ /* Commented by Albert 2011/05/18 */ ++ /* Match the device address located in the P2P IE */ ++ /* This is for the case that the P2P device address is not the same as the P2P interface address. */ ++ ++ p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen); ++ if (p2pie) { ++ /* The P2P Device ID attribute is included in the Beacon frame. */ ++ /* The P2P Device Info attribute is included in the probe response frame. */ ++ ++ if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen)) { ++ /* Handle the P2P Device ID attribute of Beacon first */ ++ if (_rtw_memcmp(attr_content, pinvite_req_info->peer_macaddr, ETH_ALEN)) { ++ uintPeerChannel = pnetwork->network.Configuration.DSConfig; ++ break; ++ } ++ } else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen)) { ++ /* Handle the P2P Device Info attribute of probe response */ ++ if (_rtw_memcmp(attr_content, pinvite_req_info->peer_macaddr, ETH_ALEN)) { ++ uintPeerChannel = pnetwork->network.Configuration.DSConfig; ++ break; ++ } ++ } ++ ++ } ++ ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++#ifdef CONFIG_WFD ++ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST) && uintPeerChannel) { ++ struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; ++ u8 *wfd_ie; ++ uint wfd_ielen = 0; ++ ++ wfd_ie = rtw_bss_ex_get_wfd_ie(&pnetwork->network, NULL, &wfd_ielen); ++ if (wfd_ie) { ++ u8 *wfd_devinfo; ++ uint wfd_devlen; ++ ++ RTW_INFO("[%s] Found WFD IE!\n", __FUNCTION__); ++ wfd_devinfo = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &wfd_devlen); ++ if (wfd_devinfo) { ++ u16 wfd_devinfo_field = 0; ++ ++ /* Commented by Albert 20120319 */ ++ /* The first two bytes are the WFD device information field of WFD device information subelement. */ ++ /* In big endian format. */ ++ wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo); ++ if (wfd_devinfo_field & WFD_DEVINFO_SESSION_AVAIL) ++ pwfd_info->peer_session_avail = _TRUE; ++ else ++ pwfd_info->peer_session_avail = _FALSE; ++ } ++ } ++ ++ if (_FALSE == pwfd_info->peer_session_avail) { ++ RTW_INFO("[%s] WFD Session not avaiable!\n", __FUNCTION__); ++ goto exit; ++ } ++ } ++#endif /* CONFIG_WFD */ ++ ++ if (uintPeerChannel) { ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) ++ _cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer); ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ /* Store the GO's bssid */ ++ for (jj = 0, kk = 18; jj < ETH_ALEN; jj++, kk += 3) ++ pinvite_req_info->go_bssid[jj] = key_2char2num(extra[kk], extra[kk + 1]); ++ ++ /* Store the GO's ssid */ ++ pinvite_req_info->ssidlen = wrqu->data.length - 36; ++ _rtw_memcpy(pinvite_req_info->go_ssid, &extra[36], (u32) pinvite_req_info->ssidlen); ++ pinvite_req_info->benable = _TRUE; ++ pinvite_req_info->peer_ch = uintPeerChannel; ++ ++ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_INVITE_REQ); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) { ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ u8 union_bw = rtw_mi_get_union_bw(padapter); ++ u8 union_offset = rtw_mi_get_union_offset(padapter); ++ /* Have to enter the power saving with the AP */ ++ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); ++ ++ rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); ++ } else ++ set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++#else ++ set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++#endif ++ ++ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) ++ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_INVITE_TIMEOUT); ++ else ++ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_INVITE_TIMEOUT); ++#else ++ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_INVITE_TIMEOUT); ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ ++ } else ++ RTW_INFO("[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__); ++exit: ++ ++ return ret; ++ ++} ++ ++static int rtw_p2p_set_persistent(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ int jj, kk; ++ u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ _list *plist, *phead; ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ uint uintPeerChannel = 0; ++ u8 attr_content[50] = { 0x00 }, _status = 0; ++ u8 *p2pie; ++ uint p2pielen = 0, attr_contentlen = 0; ++ _irqL irqL; ++ struct tx_invite_req_info *pinvite_req_info = &pwdinfo->invitereq_info; ++ ++ /* Commented by Albert 20120328 */ ++ /* The input data is 0 or 1 */ ++ /* 0: disable persistent group functionality */ ++ /* 1: enable persistent group founctionality */ ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__); ++ return ret; ++ } else { ++ if (extra[0] == '0') /* Disable the persistent group function. */ ++ pwdinfo->persistent_supported = _FALSE; ++ else if (extra[0] == '1') /* Enable the persistent group function. */ ++ pwdinfo->persistent_supported = _TRUE; ++ else ++ pwdinfo->persistent_supported = _FALSE; ++ } ++ printk("[%s] persistent_supported = %d\n", __FUNCTION__, pwdinfo->persistent_supported); ++ ++exit: ++ ++ return ret; ++ ++} ++ ++static int hexstr2bin(const char *hex, u8 *buf, size_t len) ++{ ++ size_t i; ++ int a; ++ const char *ipos = hex; ++ u8 *opos = buf; ++ ++ for (i = 0; i < len; i++) { ++ a = hex2byte_i(ipos); ++ if (a < 0) ++ return -1; ++ *opos++ = a; ++ ipos += 2; ++ } ++ return 0; ++} ++ ++static int uuid_str2bin(const char *str, u8 *bin) ++{ ++ const char *pos; ++ u8 *opos; ++ ++ pos = str; ++ opos = bin; ++ ++ if (hexstr2bin(pos, opos, 4)) ++ return -1; ++ pos += 8; ++ opos += 4; ++ ++ if (*pos++ != '-' || hexstr2bin(pos, opos, 2)) ++ return -1; ++ pos += 4; ++ opos += 2; ++ ++ if (*pos++ != '-' || hexstr2bin(pos, opos, 2)) ++ return -1; ++ pos += 4; ++ opos += 2; ++ ++ if (*pos++ != '-' || hexstr2bin(pos, opos, 2)) ++ return -1; ++ pos += 4; ++ opos += 2; ++ ++ if (*pos++ != '-' || hexstr2bin(pos, opos, 6)) ++ return -1; ++ ++ return 0; ++} ++ ++static int rtw_p2p_set_wps_uuid(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); ++ ++ if ((36 == strlen(extra)) && (uuid_str2bin(extra, pwdinfo->uuid) == 0)) ++ pwdinfo->external_uuid = 1; ++ else { ++ pwdinfo->external_uuid = 0; ++ ret = -EINVAL; ++ } ++ ++ return ret; ++ ++} ++#ifdef CONFIG_WFD ++static int rtw_p2p_set_pc(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 peerMAC[ETH_ALEN] = { 0x00 }; ++ int jj, kk; ++ u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ _list *plist, *phead; ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ u8 attr_content[50] = { 0x00 }, _status = 0; ++ u8 *p2pie; ++ uint p2pielen = 0, attr_contentlen = 0; ++ _irqL irqL; ++ uint uintPeerChannel = 0; ++ ++ struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; ++ ++ /* Commented by Albert 20120512 */ ++ /* 1. Input information is the MAC address which wants to know the Preferred Connection bit (PC bit) */ ++ /* Format: 00:E0:4C:00:00:05 */ ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); ++ ++ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__); ++ return ret; ++ } ++ ++ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) ++ peerMAC[jj] = key_2char2num(extra[kk], extra[kk + 1]); ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ ++ /* Commented by Albert 2011/05/18 */ ++ /* Match the device address located in the P2P IE */ ++ /* This is for the case that the P2P device address is not the same as the P2P interface address. */ ++ ++ p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen); ++ if (p2pie) { ++ /* The P2P Device ID attribute is included in the Beacon frame. */ ++ /* The P2P Device Info attribute is included in the probe response frame. */ ++ printk("[%s] Got P2P IE\n", __FUNCTION__); ++ if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen)) { ++ /* Handle the P2P Device ID attribute of Beacon first */ ++ printk("[%s] P2P_ATTR_DEVICE_ID\n", __FUNCTION__); ++ if (_rtw_memcmp(attr_content, peerMAC, ETH_ALEN)) { ++ uintPeerChannel = pnetwork->network.Configuration.DSConfig; ++ break; ++ } ++ } else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen)) { ++ /* Handle the P2P Device Info attribute of probe response */ ++ printk("[%s] P2P_ATTR_DEVICE_INFO\n", __FUNCTION__); ++ if (_rtw_memcmp(attr_content, peerMAC, ETH_ALEN)) { ++ uintPeerChannel = pnetwork->network.Configuration.DSConfig; ++ break; ++ } ++ } ++ ++ } ++ ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ printk("[%s] channel = %d\n", __FUNCTION__, uintPeerChannel); ++ ++ if (uintPeerChannel) { ++ u8 *wfd_ie; ++ uint wfd_ielen = 0; ++ ++ wfd_ie = rtw_bss_ex_get_wfd_ie(&pnetwork->network, NULL, &wfd_ielen); ++ if (wfd_ie) { ++ u8 *wfd_devinfo; ++ uint wfd_devlen; ++ ++ RTW_INFO("[%s] Found WFD IE!\n", __FUNCTION__); ++ wfd_devinfo = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &wfd_devlen); ++ if (wfd_devinfo) { ++ u16 wfd_devinfo_field = 0; ++ ++ /* Commented by Albert 20120319 */ ++ /* The first two bytes are the WFD device information field of WFD device information subelement. */ ++ /* In big endian format. */ ++ wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo); ++ if (wfd_devinfo_field & WFD_DEVINFO_PC_TDLS) ++ pwfd_info->wfd_pc = _TRUE; ++ else ++ pwfd_info->wfd_pc = _FALSE; ++ } ++ } ++ } else ++ RTW_INFO("[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__); ++ ++exit: ++ ++ return ret; ++ ++} ++ ++static int rtw_p2p_set_wfd_device_type(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; ++ ++ /* Commented by Albert 20120328 */ ++ /* The input data is 0 or 1 */ ++ /* 0: specify to Miracast source device */ ++ /* 1 or others: specify to Miracast sink device (display device) */ ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); ++ ++ if (extra[0] == '0') /* Set to Miracast source device. */ ++ pwfd_info->wfd_device_type = WFD_DEVINFO_SOURCE; ++ else /* Set to Miracast sink device. */ ++ pwfd_info->wfd_device_type = WFD_DEVINFO_PSINK; ++ ++exit: ++ ++ return ret; ++ ++} ++ ++static int rtw_p2p_set_wfd_enable(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ /* Commented by Kurt 20121206 ++ * This function is used to set wfd enabled */ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ if (*extra == '0') ++ rtw_wfd_enable(padapter, 0); ++ else if (*extra == '1') ++ rtw_wfd_enable(padapter, 1); ++ ++ RTW_INFO("[%s] wfd_enable = %d\n", __FUNCTION__, pwdinfo->wfd_info->wfd_enable); ++ ++ return ret; ++ ++} ++ ++static int rtw_p2p_set_driver_iface(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ /* Commented by Kurt 20121206 ++ * This function is used to set driver iface is WEXT or CFG80211 */ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ if (*extra == '1') { ++ pwdinfo->driver_interface = DRIVER_WEXT; ++ RTW_INFO("[%s] driver_interface = WEXT\n", __FUNCTION__); ++ } else if (*extra == '2') { ++ pwdinfo->driver_interface = DRIVER_CFG80211; ++ RTW_INFO("[%s] driver_interface = CFG80211\n", __FUNCTION__); ++ } ++ ++ return ret; ++ ++} ++ ++/* To set the WFD session available to enable or disable */ ++static int rtw_p2p_set_sa(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); ++ ++ if (0) { ++ RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__); ++ return ret; ++ } else { ++ if (extra[0] == '0') /* Disable the session available. */ ++ pwdinfo->session_available = _FALSE; ++ else if (extra[0] == '1') /* Enable the session available. */ ++ pwdinfo->session_available = _TRUE; ++ else ++ pwdinfo->session_available = _FALSE; ++ } ++ printk("[%s] session available = %d\n", __FUNCTION__, pwdinfo->session_available); ++ ++exit: ++ ++ return ret; ++ ++} ++#endif /* CONFIG_WFD */ ++ ++static int rtw_p2p_prov_disc(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 peerMAC[ETH_ALEN] = { 0x00 }; ++ int jj, kk; ++ u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ _list *plist, *phead; ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ uint uintPeerChannel = 0; ++ u8 attr_content[100] = { 0x00 }, _status = 0; ++ u8 *p2pie; ++ uint p2pielen = 0, attr_contentlen = 0; ++ _irqL irqL; ++ ++ /* Commented by Albert 20110301 */ ++ /* The input data contains two informations. */ ++ /* 1. First information is the MAC address which wants to issue the provisioning discovery request frame. */ ++ /* 2. Second information is the WPS configuration method which wants to discovery */ ++ /* Format: 00:E0:4C:00:00:05_display */ ++ /* Format: 00:E0:4C:00:00:05_keypad */ ++ /* Format: 00:E0:4C:00:00:05_pbc */ ++ /* Format: 00:E0:4C:00:00:05_label */ ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); ++ ++ if (pwdinfo->p2p_state == P2P_STATE_NONE) { ++ RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__); ++ return ret; ++ } else { ++#ifdef CONFIG_INTEL_WIDI ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { ++ RTW_INFO("[%s] WiFi is under survey!\n", __FUNCTION__); ++ return ret; ++ } ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ /* Reset the content of struct tx_provdisc_req_info excluded the wps_config_method_request. */ ++ _rtw_memset(pwdinfo->tx_prov_disc_info.peerDevAddr, 0x00, ETH_ALEN); ++ _rtw_memset(pwdinfo->tx_prov_disc_info.peerIFAddr, 0x00, ETH_ALEN); ++ _rtw_memset(&pwdinfo->tx_prov_disc_info.ssid, 0x00, sizeof(NDIS_802_11_SSID)); ++ pwdinfo->tx_prov_disc_info.peer_channel_num[0] = 0; ++ pwdinfo->tx_prov_disc_info.peer_channel_num[1] = 0; ++ pwdinfo->tx_prov_disc_info.benable = _FALSE; ++ } ++ ++ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) ++ peerMAC[jj] = key_2char2num(extra[kk], extra[kk + 1]); ++ ++ if (_rtw_memcmp(&extra[18], "display", 7)) ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_DISPLYA; ++ else if (_rtw_memcmp(&extra[18], "keypad", 7)) ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_KEYPAD; ++ else if (_rtw_memcmp(&extra[18], "pbc", 3)) ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON; ++ else if (_rtw_memcmp(&extra[18], "label", 5)) ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_LABEL; ++ else { ++ RTW_INFO("[%s] Unknown WPS config methodn", __FUNCTION__); ++ return ret ; ++ } ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while (1) { ++ if (rtw_end_of_queue_search(phead, plist) == _TRUE) ++ break; ++ ++ if (uintPeerChannel != 0) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ ++ /* Commented by Albert 2011/05/18 */ ++ /* Match the device address located in the P2P IE */ ++ /* This is for the case that the P2P device address is not the same as the P2P interface address. */ ++ ++ p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen); ++ if (p2pie) { ++ while (p2pie) { ++ /* The P2P Device ID attribute is included in the Beacon frame. */ ++ /* The P2P Device Info attribute is included in the probe response frame. */ ++ ++ if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen)) { ++ /* Handle the P2P Device ID attribute of Beacon first */ ++ if (_rtw_memcmp(attr_content, peerMAC, ETH_ALEN)) { ++ uintPeerChannel = pnetwork->network.Configuration.DSConfig; ++ break; ++ } ++ } else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen)) { ++ /* Handle the P2P Device Info attribute of probe response */ ++ if (_rtw_memcmp(attr_content, peerMAC, ETH_ALEN)) { ++ uintPeerChannel = pnetwork->network.Configuration.DSConfig; ++ break; ++ } ++ } ++ ++ /* Get the next P2P IE */ ++ p2pie = rtw_get_p2p_ie(p2pie + p2pielen, BSS_EX_TLV_IES_LEN(&pnetwork->network) - (p2pie + p2pielen - BSS_EX_TLV_IES(&pnetwork->network)), NULL, &p2pielen); ++ } ++ ++ } ++ ++#ifdef CONFIG_INTEL_WIDI ++ /* Some Intel WiDi source may not provide P2P IE, */ ++ /* so we could only compare mac addr by 802.11 Source Address */ ++ if (pmlmepriv->widi_state == INTEL_WIDI_STATE_WFD_CONNECTION ++ && uintPeerChannel == 0) { ++ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { ++ uintPeerChannel = pnetwork->network.Configuration.DSConfig; ++ break; ++ } ++ } ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ if (uintPeerChannel) { ++#ifdef CONFIG_WFD ++ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) { ++ struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; ++ u8 *wfd_ie; ++ uint wfd_ielen = 0; ++ ++ wfd_ie = rtw_bss_ex_get_wfd_ie(&pnetwork->network, NULL, &wfd_ielen); ++ if (wfd_ie) { ++ u8 *wfd_devinfo; ++ uint wfd_devlen; ++ ++ RTW_INFO("[%s] Found WFD IE!\n", __FUNCTION__); ++ wfd_devinfo = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &wfd_devlen); ++ if (wfd_devinfo) { ++ u16 wfd_devinfo_field = 0; ++ ++ /* Commented by Albert 20120319 */ ++ /* The first two bytes are the WFD device information field of WFD device information subelement. */ ++ /* In big endian format. */ ++ wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo); ++ if (wfd_devinfo_field & WFD_DEVINFO_SESSION_AVAIL) ++ pwfd_info->peer_session_avail = _TRUE; ++ else ++ pwfd_info->peer_session_avail = _FALSE; ++ } ++ } ++ ++ if (_FALSE == pwfd_info->peer_session_avail) { ++ RTW_INFO("[%s] WFD Session not avaiable!\n", __FUNCTION__); ++ goto exit; ++ } ++ } ++#endif /* CONFIG_WFD */ ++ ++ RTW_INFO("[%s] peer channel: %d!\n", __FUNCTION__, uintPeerChannel); ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) ++ _cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer); ++#endif /* CONFIG_CONCURRENT_MODE */ ++ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerIFAddr, pnetwork->network.MacAddress, ETH_ALEN); ++ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerDevAddr, peerMAC, ETH_ALEN); ++ pwdinfo->tx_prov_disc_info.peer_channel_num[0] = (u16) uintPeerChannel; ++ pwdinfo->tx_prov_disc_info.benable = _TRUE; ++ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ); ++ ++ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) ++ _rtw_memcpy(&pwdinfo->tx_prov_disc_info.ssid, &pnetwork->network.Ssid, sizeof(NDIS_802_11_SSID)); ++ else if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { ++ _rtw_memcpy(pwdinfo->tx_prov_disc_info.ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN); ++ pwdinfo->tx_prov_disc_info.ssid.SsidLength = P2P_WILDCARD_SSID_LEN; ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) { ++ u8 union_ch = rtw_mi_get_union_chan(padapter); ++ u8 union_bw = rtw_mi_get_union_bw(padapter); ++ u8 union_offset = rtw_mi_get_union_offset(padapter); ++ ++ /* Have to enter the power saving with the AP */ ++ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); ++ ++ rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); ++ } else ++ set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++#else ++ set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++#endif ++ ++ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_mi_check_status(padapter, MI_LINKED)) ++ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_PROVISION_TIMEOUT); ++ else ++ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT); ++#else ++ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT); ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++ } else { ++ RTW_INFO("[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__); ++#ifdef CONFIG_INTEL_WIDI ++ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); ++ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); ++ rtw_free_network_queue(padapter, _TRUE); ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ rtw_sitesurvey_cmd(padapter, NULL, 0, NULL, 0); ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++#endif /* CONFIG_INTEL_WIDI */ ++ } ++exit: ++ ++ return ret; ++ ++} ++ ++/* Added by Albert 20110328 ++ * This function is used to inform the driver the user had specified the pin code value or pbc ++ * to application. */ ++ ++static int rtw_p2p_got_wpsinfo(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ ++ ++ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); ++ /* Added by Albert 20110328 */ ++ /* if the input data is P2P_NO_WPSINFO -> reset the wpsinfo */ ++ /* if the input data is P2P_GOT_WPSINFO_PEER_DISPLAY_PIN -> the utility just input the PIN code got from the peer P2P device. */ ++ /* if the input data is P2P_GOT_WPSINFO_SELF_DISPLAY_PIN -> the utility just got the PIN code from itself. */ ++ /* if the input data is P2P_GOT_WPSINFO_PBC -> the utility just determine to use the PBC */ ++ ++ if (*extra == '0') ++ pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO; ++ else if (*extra == '1') ++ pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_PEER_DISPLAY_PIN; ++ else if (*extra == '2') ++ pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_SELF_DISPLAY_PIN; ++ else if (*extra == '3') ++ pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_PBC; ++ else ++ pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO; ++ ++ return ret; ++ ++} ++ ++#endif /* CONFIG_P2P */ ++ ++static int rtw_p2p_set(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++#ifdef CONFIG_P2P ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ RTW_INFO("[%s] extra = %s\n", __FUNCTION__, extra); ++ ++ if (_rtw_memcmp(extra, "enable=", 7)) ++ rtw_wext_p2p_enable(dev, info, wrqu, &extra[7]); ++ else if (_rtw_memcmp(extra, "setDN=", 6)) { ++ wrqu->data.length -= 6; ++ rtw_p2p_setDN(dev, info, wrqu, &extra[6]); ++ } else if (_rtw_memcmp(extra, "profilefound=", 13)) { ++ wrqu->data.length -= 13; ++ rtw_p2p_profilefound(dev, info, wrqu, &extra[13]); ++ } else if (_rtw_memcmp(extra, "prov_disc=", 10)) { ++ wrqu->data.length -= 10; ++ rtw_p2p_prov_disc(dev, info, wrqu, &extra[10]); ++ } else if (_rtw_memcmp(extra, "nego=", 5)) { ++ wrqu->data.length -= 5; ++ rtw_p2p_connect(dev, info, wrqu, &extra[5]); ++ } else if (_rtw_memcmp(extra, "intent=", 7)) { ++ /* Commented by Albert 2011/03/23 */ ++ /* The wrqu->data.length will include the null character */ ++ /* So, we will decrease 7 + 1 */ ++ wrqu->data.length -= 8; ++ rtw_p2p_set_intent(dev, info, wrqu, &extra[7]); ++ } else if (_rtw_memcmp(extra, "ssid=", 5)) { ++ wrqu->data.length -= 5; ++ rtw_p2p_set_go_nego_ssid(dev, info, wrqu, &extra[5]); ++ } else if (_rtw_memcmp(extra, "got_wpsinfo=", 12)) { ++ wrqu->data.length -= 12; ++ rtw_p2p_got_wpsinfo(dev, info, wrqu, &extra[12]); ++ } else if (_rtw_memcmp(extra, "listen_ch=", 10)) { ++ /* Commented by Albert 2011/05/24 */ ++ /* The wrqu->data.length will include the null character */ ++ /* So, we will decrease (10 + 1) */ ++ wrqu->data.length -= 11; ++ rtw_p2p_set_listen_ch(dev, info, wrqu, &extra[10]); ++ } else if (_rtw_memcmp(extra, "op_ch=", 6)) { ++ /* Commented by Albert 2011/05/24 */ ++ /* The wrqu->data.length will include the null character */ ++ /* So, we will decrease (6 + 1) */ ++ wrqu->data.length -= 7; ++ rtw_p2p_set_op_ch(dev, info, wrqu, &extra[6]); ++ } else if (_rtw_memcmp(extra, "invite=", 7)) { ++ wrqu->data.length -= 8; ++ rtw_p2p_invite_req(dev, info, wrqu, &extra[7]); ++ } else if (_rtw_memcmp(extra, "persistent=", 11)) { ++ wrqu->data.length -= 11; ++ rtw_p2p_set_persistent(dev, info, wrqu, &extra[11]); ++ } else if (_rtw_memcmp(extra, "uuid=", 5)) { ++ wrqu->data.length -= 5; ++ ret = rtw_p2p_set_wps_uuid(dev, info, wrqu, &extra[5]); ++ } ++ ++#ifdef CONFIG_WFD ++ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) { ++ if (_rtw_memcmp(extra, "sa=", 3)) { ++ /* sa: WFD Session Available information */ ++ wrqu->data.length -= 3; ++ rtw_p2p_set_sa(dev, info, wrqu, &extra[3]); ++ } else if (_rtw_memcmp(extra, "pc=", 3)) { ++ /* pc: WFD Preferred Connection */ ++ wrqu->data.length -= 3; ++ rtw_p2p_set_pc(dev, info, wrqu, &extra[3]); ++ } else if (_rtw_memcmp(extra, "wfd_type=", 9)) { ++ wrqu->data.length -= 9; ++ rtw_p2p_set_wfd_device_type(dev, info, wrqu, &extra[9]); ++ } else if (_rtw_memcmp(extra, "wfd_enable=", 11)) { ++ wrqu->data.length -= 11; ++ rtw_p2p_set_wfd_enable(dev, info, wrqu, &extra[11]); ++ } else if (_rtw_memcmp(extra, "driver_iface=", 13)) { ++ wrqu->data.length -= 13; ++ rtw_p2p_set_driver_iface(dev, info, wrqu, &extra[13]); ++ } ++ } ++#endif /* CONFIG_WFD */ ++ ++#endif /* CONFIG_P2P */ ++ ++ return ret; ++ ++} ++ ++static int rtw_p2p_get(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ ++#ifdef CONFIG_P2P ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct iw_point *pdata = &wrqu->data; ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ if (padapter->bShowGetP2PState) ++ RTW_INFO("[%s] extra = %s\n", __FUNCTION__, (char *) wrqu->data.pointer); ++ ++ if (_rtw_memcmp(wrqu->data.pointer, "status", 6)) ++ rtw_p2p_get_status(dev, info, wrqu, extra); ++ else if (_rtw_memcmp(wrqu->data.pointer, "role", 4)) ++ rtw_p2p_get_role(dev, info, wrqu, extra); ++ else if (_rtw_memcmp(wrqu->data.pointer, "peer_ifa", 8)) ++ rtw_p2p_get_peer_ifaddr(dev, info, wrqu, extra); ++ else if (_rtw_memcmp(wrqu->data.pointer, "req_cm", 6)) ++ rtw_p2p_get_req_cm(dev, info, wrqu, extra); ++ else if (_rtw_memcmp(wrqu->data.pointer, "peer_deva", 9)) { ++ /* Get the P2P device address when receiving the provision discovery request frame. */ ++ rtw_p2p_get_peer_devaddr(dev, info, wrqu, extra); ++ } else if (_rtw_memcmp(wrqu->data.pointer, "group_id", 8)) ++ rtw_p2p_get_groupid(dev, info, wrqu, extra); ++ else if (_rtw_memcmp(wrqu->data.pointer, "inv_peer_deva", 13)) { ++ /* Get the P2P device address when receiving the P2P Invitation request frame. */ ++ rtw_p2p_get_peer_devaddr_by_invitation(dev, info, wrqu, extra); ++ } else if (_rtw_memcmp(wrqu->data.pointer, "op_ch", 5)) ++ rtw_p2p_get_op_ch(dev, info, wrqu, extra); ++ ++#ifdef CONFIG_WFD ++ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) { ++ if (_rtw_memcmp(wrqu->data.pointer, "peer_port", 9)) ++ rtw_p2p_get_peer_wfd_port(dev, info, wrqu, extra); ++ else if (_rtw_memcmp(wrqu->data.pointer, "wfd_sa", 6)) ++ rtw_p2p_get_peer_wfd_session_available(dev, info, wrqu, extra); ++ else if (_rtw_memcmp(wrqu->data.pointer, "wfd_pc", 6)) ++ rtw_p2p_get_peer_wfd_preferred_connection(dev, info, wrqu, extra); ++ } ++#endif /* CONFIG_WFD */ ++ ++#endif /* CONFIG_P2P */ ++ ++ return ret; ++ ++} ++ ++static int rtw_p2p_get2(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ ++#ifdef CONFIG_P2P ++ ++ int length = wrqu->data.length; ++ char *buffer = (u8 *)rtw_malloc(length); ++ ++ if (buffer == NULL) { ++ ret = -ENOMEM; ++ goto bad; ++ } ++ ++ if (copy_from_user(buffer, wrqu->data.pointer, wrqu->data.length)) { ++ ret = -EFAULT; ++ goto bad; ++ } ++ ++ RTW_INFO("[%s] buffer = %s\n", __FUNCTION__, buffer); ++ ++ if (_rtw_memcmp(buffer, "wpsCM=", 6)) ++ ret = rtw_p2p_get_wps_configmethod(dev, info, wrqu, extra, &buffer[6]); ++ else if (_rtw_memcmp(buffer, "devN=", 5)) ++ ret = rtw_p2p_get_device_name(dev, info, wrqu, extra, &buffer[5]); ++ else if (_rtw_memcmp(buffer, "dev_type=", 9)) ++ ret = rtw_p2p_get_device_type(dev, info, wrqu, extra, &buffer[9]); ++ else if (_rtw_memcmp(buffer, "go_devadd=", 10)) ++ ret = rtw_p2p_get_go_device_address(dev, info, wrqu, extra, &buffer[10]); ++ else if (_rtw_memcmp(buffer, "InvProc=", 8)) ++ ret = rtw_p2p_get_invitation_procedure(dev, info, wrqu, extra, &buffer[8]); ++ else { ++ snprintf(extra, sizeof("Command not found."), "Command not found."); ++ wrqu->data.length = strlen(extra); ++ } ++ ++bad: ++ if (buffer) ++ rtw_mfree(buffer, length); ++ ++#endif /* CONFIG_P2P */ ++ ++ return ret; ++ ++} ++ ++static int rtw_cta_test_start(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ RTW_INFO("%s %s\n", __func__, extra); ++ if (!strcmp(extra, "1")) ++ padapter->in_cta_test = 1; ++ else ++ padapter->in_cta_test = 0; ++ ++ if (padapter->in_cta_test) { ++ u32 v = rtw_read32(padapter, REG_RCR); ++ v &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN); /* | RCR_ADF */ ++ rtw_write32(padapter, REG_RCR, v); ++ RTW_INFO("enable RCR_ADF\n"); ++ } else { ++ u32 v = rtw_read32(padapter, REG_RCR); ++ v |= RCR_CBSSID_DATA | RCR_CBSSID_BCN ;/* | RCR_ADF */ ++ rtw_write32(padapter, REG_RCR, v); ++ RTW_INFO("disable RCR_ADF\n"); ++ } ++ return ret; ++} ++ ++ ++extern int rtw_change_ifname(_adapter *padapter, const char *ifname); ++static int rtw_rereg_nd_name(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ _adapter *padapter = rtw_netdev_priv(dev); ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct rereg_nd_name_data *rereg_priv = &padapter->rereg_nd_name_priv; ++ char new_ifname[IFNAMSIZ]; ++ ++ if (rereg_priv->old_ifname[0] == 0) { ++ char *reg_ifname; ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->isprimary) ++ reg_ifname = padapter->registrypriv.ifname; ++ else ++#endif ++ reg_ifname = padapter->registrypriv.if2name; ++ ++ strncpy(rereg_priv->old_ifname, reg_ifname, IFNAMSIZ); ++ rereg_priv->old_ifname[IFNAMSIZ - 1] = 0; ++ } ++ ++ /* RTW_INFO("%s wrqu->data.length:%d\n", __FUNCTION__, wrqu->data.length); */ ++ if (wrqu->data.length > IFNAMSIZ) ++ return -EFAULT; ++ ++ if (copy_from_user(new_ifname, wrqu->data.pointer, IFNAMSIZ)) ++ return -EFAULT; ++ ++ if (0 == strcmp(rereg_priv->old_ifname, new_ifname)) ++ return ret; ++ ++ RTW_INFO("%s new_ifname:%s\n", __FUNCTION__, new_ifname); ++ rtw_set_rtnl_lock_holder(dvobj, current); ++ ret = rtw_change_ifname(padapter, new_ifname); ++ rtw_set_rtnl_lock_holder(dvobj, NULL); ++ if (0 != ret) ++ goto exit; ++ ++ if (_rtw_memcmp(rereg_priv->old_ifname, "disable%d", 9) == _TRUE) { ++ padapter->ledpriv.bRegUseLed = rereg_priv->old_bRegUseLed; ++ rtw_hal_sw_led_init(padapter); ++ /* rtw_ips_mode_req(&padapter->pwrctrlpriv, rereg_priv->old_ips_mode); */ ++ } ++ ++ strncpy(rereg_priv->old_ifname, new_ifname, IFNAMSIZ); ++ rereg_priv->old_ifname[IFNAMSIZ - 1] = 0; ++ ++ if (_rtw_memcmp(new_ifname, "disable%d", 9) == _TRUE) { ++ ++ RTW_INFO("%s disable\n", __FUNCTION__); ++ /* free network queue for Android's timming issue */ ++ rtw_free_network_queue(padapter, _TRUE); ++ ++ /* close led */ ++ rtw_led_control(padapter, LED_CTL_POWER_OFF); ++ rereg_priv->old_bRegUseLed = padapter->ledpriv.bRegUseLed; ++ padapter->ledpriv.bRegUseLed = _FALSE; ++ rtw_hal_sw_led_deinit(padapter); ++ ++ /* the interface is being "disabled", we can do deeper IPS */ ++ /* rereg_priv->old_ips_mode = rtw_get_ips_mode_req(&padapter->pwrctrlpriv); */ ++ /* rtw_ips_mode_req(&padapter->pwrctrlpriv, IPS_NORMAL); */ ++ } ++exit: ++ return ret; ++ ++} ++ ++#ifdef CONFIG_IOL ++#include ++#endif ++ ++#ifdef DBG_CMD_QUEUE ++u8 dump_cmd_id = 0; ++#endif ++static int rtw_dbg_port(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _irqL irqL; ++ int ret = 0; ++ u8 major_cmd, minor_cmd; ++ u16 arg; ++ u32 extra_arg, *pdata, val32; ++ struct sta_info *psta; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ ++ pdata = (u32 *)&wrqu->data; ++ ++ val32 = *pdata; ++ arg = (u16)(val32 & 0x0000ffff); ++ major_cmd = (u8)(val32 >> 24); ++ minor_cmd = (u8)((val32 >> 16) & 0x00ff); ++ ++ extra_arg = *(pdata + 1); ++ ++ switch (major_cmd) { ++ case 0x70: /* read_reg */ ++ switch (minor_cmd) { ++ case 1: ++ RTW_INFO("rtw_read8(0x%x)=0x%02x\n", arg, rtw_read8(padapter, arg)); ++ break; ++ case 2: ++ RTW_INFO("rtw_read16(0x%x)=0x%04x\n", arg, rtw_read16(padapter, arg)); ++ break; ++ case 4: ++ RTW_INFO("rtw_read32(0x%x)=0x%08x\n", arg, rtw_read32(padapter, arg)); ++ break; ++ } ++ break; ++ case 0x71: /* write_reg */ ++ switch (minor_cmd) { ++ case 1: ++ rtw_write8(padapter, arg, extra_arg); ++ RTW_INFO("rtw_write8(0x%x)=0x%02x\n", arg, rtw_read8(padapter, arg)); ++ break; ++ case 2: ++ rtw_write16(padapter, arg, extra_arg); ++ RTW_INFO("rtw_write16(0x%x)=0x%04x\n", arg, rtw_read16(padapter, arg)); ++ break; ++ case 4: ++ rtw_write32(padapter, arg, extra_arg); ++ RTW_INFO("rtw_write32(0x%x)=0x%08x\n", arg, rtw_read32(padapter, arg)); ++ break; ++ } ++ break; ++ case 0x72: /* read_bb */ ++ RTW_INFO("read_bbreg(0x%x)=0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff)); ++ break; ++ case 0x73: /* write_bb */ ++ rtw_hal_write_bbreg(padapter, arg, 0xffffffff, extra_arg); ++ RTW_INFO("write_bbreg(0x%x)=0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff)); ++ break; ++ case 0x74: /* read_rf */ ++ RTW_INFO("read RF_reg path(0x%02x),offset(0x%x),value(0x%08x)\n", minor_cmd, arg, rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff)); ++ break; ++ case 0x75: /* write_rf */ ++ rtw_hal_write_rfreg(padapter, minor_cmd, arg, 0xffffffff, extra_arg); ++ RTW_INFO("write RF_reg path(0x%02x),offset(0x%x),value(0x%08x)\n", minor_cmd, arg, rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff)); ++ break; ++ ++ case 0x76: ++ switch (minor_cmd) { ++ case 0x00: /* normal mode, */ ++ padapter->recvpriv.is_signal_dbg = 0; ++ break; ++ case 0x01: /* dbg mode */ ++ padapter->recvpriv.is_signal_dbg = 1; ++ extra_arg = extra_arg > 100 ? 100 : extra_arg; ++ padapter->recvpriv.signal_strength_dbg = extra_arg; ++ break; ++ } ++ break; ++ case 0x78: /* IOL test */ ++ switch (minor_cmd) { ++ #ifdef CONFIG_IOL ++ case 0x04: { /* LLT table initialization test */ ++ u8 page_boundary = 0xf9; ++ { ++ struct xmit_frame *xmit_frame; ++ ++ xmit_frame = rtw_IOL_accquire_xmit_frame(padapter); ++ if (xmit_frame == NULL) { ++ ret = -ENOMEM; ++ break; ++ } ++ ++ rtw_IOL_append_LLT_cmd(xmit_frame, page_boundary); ++ ++ ++ if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 500, 0)) ++ ret = -EPERM; ++ } ++ } ++ break; ++ case 0x05: { /* blink LED test */ ++ u16 reg = 0x4c; ++ u32 blink_num = 50; ++ u32 blink_delay_ms = 200; ++ int i; ++ ++ { ++ struct xmit_frame *xmit_frame; ++ ++ xmit_frame = rtw_IOL_accquire_xmit_frame(padapter); ++ if (xmit_frame == NULL) { ++ ret = -ENOMEM; ++ break; ++ } ++ ++ for (i = 0; i < blink_num; i++) { ++ #ifdef CONFIG_IOL_NEW_GENERATION ++ rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x00, 0xff); ++ rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms); ++ rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x08, 0xff); ++ rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms); ++ #else ++ rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x00); ++ rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms); ++ rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x08); ++ rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms); ++ #endif ++ } ++ if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, (blink_delay_ms * blink_num * 2) + 200, 0)) ++ ret = -EPERM; ++ } ++ } ++ break; ++ ++ case 0x06: { /* continuous wirte byte test */ ++ u16 reg = arg; ++ u16 start_value = 0; ++ u32 write_num = extra_arg; ++ int i; ++ u8 final; ++ ++ { ++ struct xmit_frame *xmit_frame; ++ ++ xmit_frame = rtw_IOL_accquire_xmit_frame(padapter); ++ if (xmit_frame == NULL) { ++ ret = -ENOMEM; ++ break; ++ } ++ ++ for (i = 0; i < write_num; i++) { ++ #ifdef CONFIG_IOL_NEW_GENERATION ++ rtw_IOL_append_WB_cmd(xmit_frame, reg, i + start_value, 0xFF); ++ #else ++ rtw_IOL_append_WB_cmd(xmit_frame, reg, i + start_value); ++ #endif ++ } ++ if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 5000, 0)) ++ ret = -EPERM; ++ } ++ ++ final = rtw_read8(padapter, reg); ++ if (start_value + write_num - 1 == final) ++ RTW_INFO("continuous IOL_CMD_WB_REG to 0x%x %u times Success, start:%u, final:%u\n", reg, write_num, start_value, final); ++ else ++ RTW_INFO("continuous IOL_CMD_WB_REG to 0x%x %u times Fail, start:%u, final:%u\n", reg, write_num, start_value, final); ++ } ++ break; ++ ++ case 0x07: { /* continuous wirte word test */ ++ u16 reg = arg; ++ u16 start_value = 200; ++ u32 write_num = extra_arg; ++ ++ int i; ++ u16 final; ++ ++ { ++ struct xmit_frame *xmit_frame; ++ ++ xmit_frame = rtw_IOL_accquire_xmit_frame(padapter); ++ if (xmit_frame == NULL) { ++ ret = -ENOMEM; ++ break; ++ } ++ ++ for (i = 0; i < write_num; i++) { ++ #ifdef CONFIG_IOL_NEW_GENERATION ++ rtw_IOL_append_WW_cmd(xmit_frame, reg, i + start_value, 0xFFFF); ++ #else ++ rtw_IOL_append_WW_cmd(xmit_frame, reg, i + start_value); ++ #endif ++ } ++ if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 5000, 0)) ++ ret = -EPERM; ++ } ++ ++ final = rtw_read16(padapter, reg); ++ if (start_value + write_num - 1 == final) ++ RTW_INFO("continuous IOL_CMD_WW_REG to 0x%x %u times Success, start:%u, final:%u\n", reg, write_num, start_value, final); ++ else ++ RTW_INFO("continuous IOL_CMD_WW_REG to 0x%x %u times Fail, start:%u, final:%u\n", reg, write_num, start_value, final); ++ } ++ break; ++ ++ case 0x08: { /* continuous wirte dword test */ ++ u16 reg = arg; ++ u32 start_value = 0x110000c7; ++ u32 write_num = extra_arg; ++ ++ int i; ++ u32 final; ++ ++ { ++ struct xmit_frame *xmit_frame; ++ ++ xmit_frame = rtw_IOL_accquire_xmit_frame(padapter); ++ if (xmit_frame == NULL) { ++ ret = -ENOMEM; ++ break; ++ } ++ ++ for (i = 0; i < write_num; i++) { ++ #ifdef CONFIG_IOL_NEW_GENERATION ++ rtw_IOL_append_WD_cmd(xmit_frame, reg, i + start_value, 0xFFFFFFFF); ++ #else ++ rtw_IOL_append_WD_cmd(xmit_frame, reg, i + start_value); ++ #endif ++ } ++ if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 5000, 0)) ++ ret = -EPERM; ++ ++ } ++ ++ final = rtw_read32(padapter, reg); ++ if (start_value + write_num - 1 == final) ++ RTW_INFO("continuous IOL_CMD_WD_REG to 0x%x %u times Success, start:%u, final:%u\n", reg, write_num, start_value, final); ++ else ++ RTW_INFO("continuous IOL_CMD_WD_REG to 0x%x %u times Fail, start:%u, final:%u\n", reg, write_num, start_value, final); ++ } ++ break; ++ #endif /* CONFIG_IOL */ ++ } ++ break; ++ case 0x79: { ++ /* ++ * dbg 0x79000000 [value], set RESP_TXAGC to + value, value:0~15 ++ * dbg 0x79010000 [value], set RESP_TXAGC to - value, value:0~15 ++ */ ++ u8 value = extra_arg & 0x0f; ++ u8 sign = minor_cmd; ++ u16 write_value = 0; ++ ++ RTW_INFO("%s set RESP_TXAGC to %s %u\n", __func__, sign ? "minus" : "plus", value); ++ ++ if (sign) ++ value = value | 0x10; ++ ++ write_value = value | (value << 5); ++ rtw_write16(padapter, 0x6d9, write_value); ++ } ++ break; ++ case 0x7a: ++ receive_disconnect(padapter, pmlmeinfo->network.MacAddress ++ , WLAN_REASON_EXPIRATION_CHK, _FALSE); ++ break; ++ case 0x7F: ++ switch (minor_cmd) { ++ case 0x0: ++ RTW_INFO("fwstate=0x%x\n", get_fwstate(pmlmepriv)); ++ break; ++ case 0x01: ++ RTW_INFO("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", ++ psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, ++ psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus); ++ break; ++ case 0x02: ++ RTW_INFO("pmlmeinfo->state=0x%x\n", pmlmeinfo->state); ++ RTW_INFO("DrvBcnEarly=%d\n", pmlmeext->DrvBcnEarly); ++ RTW_INFO("DrvBcnTimeOut=%d\n", pmlmeext->DrvBcnTimeOut); ++ break; ++ case 0x03: ++ RTW_INFO("qos_option=%d\n", pmlmepriv->qospriv.qos_option); ++#ifdef CONFIG_80211N_HT ++ RTW_INFO("ht_option=%d\n", pmlmepriv->htpriv.ht_option); ++#endif /* CONFIG_80211N_HT */ ++ break; ++ case 0x04: ++ RTW_INFO("cur_ch=%d\n", pmlmeext->cur_channel); ++ RTW_INFO("cur_bw=%d\n", pmlmeext->cur_bwmode); ++ RTW_INFO("cur_ch_off=%d\n", pmlmeext->cur_ch_offset); ++ ++ RTW_INFO("oper_ch=%d\n", rtw_get_oper_ch(padapter)); ++ RTW_INFO("oper_bw=%d\n", rtw_get_oper_bw(padapter)); ++ RTW_INFO("oper_ch_offet=%d\n", rtw_get_oper_choffset(padapter)); ++ ++ break; ++ case 0x05: ++ psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); ++ if (psta) { ++ RTW_INFO("SSID=%s\n", cur_network->network.Ssid.Ssid); ++ RTW_INFO("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); ++ RTW_INFO("cur_channel=%d, cur_bwmode=%d, cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); ++ RTW_INFO("rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); ++ RTW_INFO("state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); ++#ifdef CONFIG_80211N_HT ++ RTW_INFO("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); ++ RTW_INFO("bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); ++ RTW_INFO("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); ++ RTW_INFO("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); ++#endif /* CONFIG_80211N_HT */ ++ ++ sta_rx_reorder_ctl_dump(RTW_DBGDUMP, psta); ++ } else ++ RTW_INFO("can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); ++ break; ++ case 0x06: { ++ } ++ break; ++ case 0x07: ++ RTW_INFO("bSurpriseRemoved=%s, bDriverStopped=%s\n" ++ , rtw_is_surprise_removed(padapter) ? "True" : "False" ++ , rtw_is_drv_stopped(padapter) ? "True" : "False"); ++ break; ++ case 0x08: { ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ ++ RTW_INFO("free_xmitbuf_cnt=%d, free_xmitframe_cnt=%d" ++ ", free_xmit_extbuf_cnt=%d, free_xframe_ext_cnt=%d" ++ ", free_recvframe_cnt=%d\n", ++ pxmitpriv->free_xmitbuf_cnt, pxmitpriv->free_xmitframe_cnt, ++ pxmitpriv->free_xmit_extbuf_cnt, pxmitpriv->free_xframe_ext_cnt, ++ precvpriv->free_recvframe_cnt); ++#ifdef CONFIG_USB_HCI ++ RTW_INFO("rx_urb_pending_cn=%d\n", ATOMIC_READ(&(precvpriv->rx_pending_cnt))); ++#endif ++ } ++ break; ++ case 0x09: { ++ int i; ++ _list *plist, *phead; ++ ++#ifdef CONFIG_AP_MODE ++ RTW_INFO("sta_dz_bitmap=0x%x, tim_bitmap=0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap); ++#endif ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ for (i = 0; i < NUM_STA; i++) { ++ phead = &(pstapriv->sta_hash[i]); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); ++ ++ plist = get_next(plist); ++ ++ if (extra_arg == psta->aid) { ++ RTW_INFO("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); ++ RTW_INFO("rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); ++ RTW_INFO("state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); ++#ifdef CONFIG_80211N_HT ++ RTW_INFO("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); ++ RTW_INFO("bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, ++ psta->htpriv.sgi_40m); ++ RTW_INFO("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); ++ RTW_INFO("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); ++#endif /* CONFIG_80211N_HT */ ++ ++#ifdef CONFIG_AP_MODE ++ RTW_INFO("capability=0x%x\n", psta->capability); ++ RTW_INFO("flags=0x%x\n", psta->flags); ++ RTW_INFO("wpa_psk=0x%x\n", psta->wpa_psk); ++ RTW_INFO("wpa2_group_cipher=0x%x\n", psta->wpa2_group_cipher); ++ RTW_INFO("wpa2_pairwise_cipher=0x%x\n", psta->wpa2_pairwise_cipher); ++ RTW_INFO("qos_info=0x%x\n", psta->qos_info); ++#endif ++ RTW_INFO("dot118021XPrivacy=0x%x\n", psta->dot118021XPrivacy); ++ ++ sta_rx_reorder_ctl_dump(RTW_DBGDUMP, psta); ++ } ++ ++ } ++ } ++ ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ } ++ break; ++ ++ case 0x0b: { /* Enable=1, Disable=0 driver control vrtl_carrier_sense. */ ++ /* u8 driver_vcs_en; */ /* Enable=1, Disable=0 driver control vrtl_carrier_sense. */ ++ /* u8 driver_vcs_type; */ /* force 0:disable VCS, 1:RTS-CTS, 2:CTS-to-self when vcs_en=1. */ ++ ++ if (arg == 0) { ++ RTW_INFO("disable driver ctrl vcs\n"); ++ padapter->driver_vcs_en = 0; ++ } else if (arg == 1) { ++ RTW_INFO("enable driver ctrl vcs = %d\n", extra_arg); ++ padapter->driver_vcs_en = 1; ++ ++ if (extra_arg > 2) ++ padapter->driver_vcs_type = 1; ++ else ++ padapter->driver_vcs_type = extra_arg; ++ } ++ } ++ break; ++ case 0x0c: { /* dump rx/tx packet */ ++ if (arg == 0) { ++ RTW_INFO("dump rx packet (%d)\n", extra_arg); ++ /* pHalData->bDumpRxPkt =extra_arg; */ ++ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DUMP_RXPKT, &(extra_arg)); ++ } else if (arg == 1) { ++ RTW_INFO("dump tx packet (%d)\n", extra_arg); ++ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DUMP_TXPKT, &(extra_arg)); ++ } ++ } ++ break; ++ case 0x0e: { ++ if (arg == 0) { ++ RTW_INFO("disable driver ctrl rx_ampdu_factor\n"); ++ padapter->driver_rx_ampdu_factor = 0xFF; ++ } else if (arg == 1) { ++ ++ RTW_INFO("enable driver ctrl rx_ampdu_factor = %d\n", extra_arg); ++ ++ if (extra_arg > 0x03) ++ padapter->driver_rx_ampdu_factor = 0xFF; ++ else ++ padapter->driver_rx_ampdu_factor = extra_arg; ++ } ++ } ++ break; ++ #ifdef DBG_CONFIG_ERROR_DETECT ++ case 0x0f: { ++ if (extra_arg == 0) { ++ RTW_INFO("###### silent reset test.......#####\n"); ++ rtw_hal_sreset_reset(padapter); ++ } else { ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++ psrtpriv->dbg_trigger_point = extra_arg; ++ } ++ ++ } ++ break; ++ case 0x15: { ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ RTW_INFO("==>silent resete cnts:%d\n", pwrpriv->ips_enter_cnts); ++ } ++ break; ++ ++ #endif ++ ++ case 0x10: /* driver version display */ ++ dump_drv_version(RTW_DBGDUMP); ++ break; ++ case 0x11: { /* dump linked status */ ++ int pre_mode; ++ pre_mode = padapter->bLinkInfoDump; ++ /* linked_info_dump(padapter,extra_arg); */ ++ if (extra_arg == 1 || (extra_arg == 0 && pre_mode == 1)) /* not consider pwr_saving 0: */ ++ padapter->bLinkInfoDump = extra_arg; ++ ++ else if ((extra_arg == 2) || (extra_arg == 0 && pre_mode == 2)) { /* consider power_saving */ ++ /* RTW_INFO("linked_info_dump =%s\n", (padapter->bLinkInfoDump)?"enable":"disable") */ ++ linked_info_dump(padapter, extra_arg); ++ } ++ ++ ++ ++ } ++ break; ++#ifdef CONFIG_80211N_HT ++ case 0x12: { /* set rx_stbc */ ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ /* 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, 0x3: enable both 2.4g and 5g */ ++ /* default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ */ ++ if (pregpriv && (extra_arg == 0 || extra_arg == 1 || extra_arg == 2 || extra_arg == 3)) { ++ pregpriv->rx_stbc = extra_arg; ++ RTW_INFO("set rx_stbc=%d\n", pregpriv->rx_stbc); ++ } else ++ RTW_INFO("get rx_stbc=%d\n", pregpriv->rx_stbc); ++ ++ } ++ break; ++ case 0x13: { /* set ampdu_enable */ ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ /* 0: disable, 0x1:enable */ ++ if (pregpriv && extra_arg < 2) { ++ pregpriv->ampdu_enable = extra_arg; ++ RTW_INFO("set ampdu_enable=%d\n", pregpriv->ampdu_enable); ++ } else ++ RTW_INFO("get ampdu_enable=%d\n", pregpriv->ampdu_enable); ++ ++ } ++ break; ++#endif ++ case 0x14: { /* get wifi_spec */ ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ RTW_INFO("get wifi_spec=%d\n", pregpriv->wifi_spec); ++ ++ } ++ break; ++ case 0x16: { ++ if (arg == 0xff) ++ rtw_odm_dbg_comp_msg(RTW_DBGDUMP, padapter); ++ else { ++ u64 dbg_comp = (u64)extra_arg; ++ rtw_odm_dbg_comp_set(padapter, dbg_comp); ++ } ++ } ++ break; ++#ifdef DBG_FIXED_CHAN ++ case 0x17: { ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ printk("===> Fixed channel to %d\n", extra_arg); ++ pmlmeext->fixed_chan = extra_arg; ++ ++ } ++ break; ++#endif ++#ifdef CONFIG_80211N_HT ++ case 0x19: { ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ /* extra_arg : */ ++ /* BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, */ ++ /* BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx */ ++ if (arg == 0) { ++ RTW_INFO("driver disable LDPC\n"); ++ pregistrypriv->ldpc_cap = 0x00; ++ } else if (arg == 1) { ++ RTW_INFO("driver set LDPC cap = 0x%x\n", extra_arg); ++ pregistrypriv->ldpc_cap = (u8)(extra_arg & 0x33); ++ } ++ } ++ break; ++ case 0x1a: { ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ /* extra_arg : */ ++ /* BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, */ ++ /* BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx */ ++ if (arg == 0) { ++ RTW_INFO("driver disable STBC\n"); ++ pregistrypriv->stbc_cap = 0x00; ++ } else if (arg == 1) { ++ RTW_INFO("driver set STBC cap = 0x%x\n", extra_arg); ++ pregistrypriv->stbc_cap = (u8)(extra_arg & 0x33); ++ } ++ } ++ break; ++#endif /* CONFIG_80211N_HT */ ++ case 0x1b: { ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ ++ if (arg == 0) { ++ RTW_INFO("disable driver ctrl max_rx_rate, reset to default_rate_set\n"); ++ init_mlme_default_rate_set(padapter); ++#ifdef CONFIG_80211N_HT ++ pregistrypriv->ht_enable = (u8)rtw_ht_enable; ++#endif /* CONFIG_80211N_HT */ ++ } else if (arg == 1) { ++ ++ int i; ++ u8 max_rx_rate; ++ ++ RTW_INFO("enable driver ctrl max_rx_rate = 0x%x\n", extra_arg); ++ ++ max_rx_rate = (u8)extra_arg; ++ ++ if (max_rx_rate < 0xc) { /* max_rx_rate < MSC0->B or G -> disable HT */ ++#ifdef CONFIG_80211N_HT ++ pregistrypriv->ht_enable = 0; ++#endif /* CONFIG_80211N_HT */ ++ for (i = 0; i < NumRates; i++) { ++ if (pmlmeext->datarate[i] > max_rx_rate) ++ pmlmeext->datarate[i] = 0xff; ++ } ++ ++ } ++#ifdef CONFIG_80211N_HT ++ else if (max_rx_rate < 0x1c) { /* mcs0~mcs15 */ ++ u32 mcs_bitmap = 0x0; ++ ++ for (i = 0; i < ((max_rx_rate + 1) - 0xc); i++) ++ mcs_bitmap |= BIT(i); ++ ++ set_mcs_rate_by_mask(pmlmeext->default_supported_mcs_set, mcs_bitmap); ++ } ++#endif /* CONFIG_80211N_HT */ ++ } ++ } ++ break; ++ case 0x1c: { /* enable/disable driver control AMPDU Density for peer sta's rx */ ++ if (arg == 0) { ++ RTW_INFO("disable driver ctrl ampdu density\n"); ++ padapter->driver_ampdu_spacing = 0xFF; ++ } else if (arg == 1) { ++ ++ RTW_INFO("enable driver ctrl ampdu density = %d\n", extra_arg); ++ ++ if (extra_arg > 0x07) ++ padapter->driver_ampdu_spacing = 0xFF; ++ else ++ padapter->driver_ampdu_spacing = extra_arg; ++ } ++ } ++ break; ++#ifdef CONFIG_BACKGROUND_NOISE_MONITOR ++ case 0x1e: { ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ u8 chan = rtw_get_oper_ch(padapter); ++ RTW_INFO("===========================================\n"); ++ ODM_InbandNoise_Monitor(pDM_Odm, _TRUE, 0x1e, 100); ++ RTW_INFO("channel(%d),noise_a = %d, noise_b = %d , noise_all:%d\n", ++ chan, pDM_Odm->noise_level.noise[ODM_RF_PATH_A], ++ pDM_Odm->noise_level.noise[ODM_RF_PATH_B], ++ pDM_Odm->noise_level.noise_all); ++ RTW_INFO("===========================================\n"); ++ ++ } ++ break; ++#endif ++ ++ ++#if defined(CONFIG_SDIO_HCI) && defined(CONFIG_SDIO_INDIRECT_ACCESS) && defined(DBG_SDIO_INDIRECT_ACCESS) ++ case 0x1f: ++ { ++ int i, j = 0, test_cnts = 0; ++ static u8 test_code = 0x5A; ++ static u32 data_misatch_cnt = 0, d_acc_err_cnt = 0; ++ ++ u32 d_data, i_data; ++ u32 imr; ++ ++ test_cnts = extra_arg; ++ for (i = 0; i < test_cnts; i++) { ++ if (RTW_CANNOT_IO(padapter)) ++ break; ++ ++ rtw_write8(padapter, 0x07, test_code); ++ ++ d_data = rtw_read32(padapter, 0x04); ++ imr = rtw_read32(padapter, 0x10250014); ++ rtw_write32(padapter, 0x10250014, 0); ++ rtw_msleep_os(50); ++ ++ i_data = rtw_sd_iread32(padapter, 0x04); ++ ++ rtw_write32(padapter, 0x10250014, imr); ++ ++ if (d_data != i_data) { ++ data_misatch_cnt++; ++ RTW_ERR("d_data :0x%08x, i_data : 0x%08x\n", d_data, i_data); ++ } ++ ++ if (test_code != (i_data >> 24)) { ++ d_acc_err_cnt++; ++ rtw_write8(padapter, 0x07, 0xAA); ++ RTW_ERR("test_code :0x%02x, i_data : 0x%08x\n", test_code, i_data); ++ } ++ if ((j++) == 100) { ++ rtw_msleep_os(2000); ++ RTW_INFO(" Indirect access testing..........%d/%d\n", i, test_cnts); ++ j = 0; ++ } ++ ++ test_code = ~test_code; ++ rtw_msleep_os(50); ++ } ++ RTW_INFO("========Indirect access test=========\n"); ++ RTW_INFO(" test_cnts = %d\n", test_cnts); ++ RTW_INFO(" direct & indirect read32 data missatch cnts = %d\n", data_misatch_cnt); ++ RTW_INFO(" indirect rdata is not equal to wdata cnts = %d\n", d_acc_err_cnt); ++ RTW_INFO("========Indirect access test=========\n\n"); ++ data_misatch_cnt = d_acc_err_cnt = 0; ++ ++ } ++ break; ++#endif ++ ++ case 0x23: { ++ RTW_INFO("turn %s the bNotifyChannelChange Variable\n", (extra_arg == 1) ? "on" : "off"); ++ padapter->bNotifyChannelChange = extra_arg; ++ break; ++ } ++ case 0x24: { ++#ifdef CONFIG_P2P ++ RTW_INFO("turn %s the bShowGetP2PState Variable\n", (extra_arg == 1) ? "on" : "off"); ++ padapter->bShowGetP2PState = extra_arg; ++#endif /* CONFIG_P2P */ ++ break; ++ } ++#ifdef CONFIG_GPIO_API ++ case 0x25: { /* Get GPIO register */ ++ /* ++ * dbg 0x7f250000 [gpio_num], Get gpio value, gpio_num:0~7 ++ */ ++ ++ u8 value; ++ RTW_INFO("Read GPIO Value extra_arg = %d\n", extra_arg); ++ value = rtw_hal_get_gpio(padapter, extra_arg); ++ RTW_INFO("Read GPIO Value = %d\n", value); ++ break; ++ } ++ case 0x26: { /* Set GPIO direction */ ++ ++ /* dbg 0x7f26000x [y], Set gpio direction, ++ * x: gpio_num,4~7 y: indicate direction, 0~1 ++ */ ++ ++ int value; ++ RTW_INFO("Set GPIO Direction! arg = %d ,extra_arg=%d\n", arg , extra_arg); ++ value = rtw_hal_config_gpio(padapter, arg, extra_arg); ++ RTW_INFO("Set GPIO Direction %s\n", (value == -1) ? "Fail!!!" : "Success"); ++ break; ++ } ++ case 0x27: { /* Set GPIO output direction value */ ++ /* ++ * dbg 0x7f27000x [y], Set gpio output direction value, ++ * x: gpio_num,4~7 y: indicate direction, 0~1 ++ */ ++ ++ int value; ++ RTW_INFO("Set GPIO Value! arg = %d ,extra_arg=%d\n", arg , extra_arg); ++ value = rtw_hal_set_gpio_output_value(padapter, arg, extra_arg); ++ RTW_INFO("Set GPIO Value %s\n", (value == -1) ? "Fail!!!" : "Success"); ++ break; ++ } ++#endif ++#ifdef DBG_CMD_QUEUE ++ case 0x28: { ++ dump_cmd_id = extra_arg; ++ RTW_INFO("dump_cmd_id:%d\n", dump_cmd_id); ++ } ++ break; ++#endif /* DBG_CMD_QUEUE */ ++ case 0xaa: { ++ if ((extra_arg & 0x7F) > 0x3F) ++ extra_arg = 0xFF; ++ RTW_INFO("chang data rate to :0x%02x\n", extra_arg); ++ padapter->fix_rate = extra_arg; ++ } ++ break; ++ case 0xdd: { /* registers dump , 0 for mac reg,1 for bb reg, 2 for rf reg */ ++ if (extra_arg == 0) ++ mac_reg_dump(RTW_DBGDUMP, padapter); ++ else if (extra_arg == 1) ++ bb_reg_dump(RTW_DBGDUMP, padapter); ++ else if (extra_arg == 2) ++ rf_reg_dump(RTW_DBGDUMP, padapter); ++ } ++ break; ++ ++ case 0xee: { ++ RTW_INFO(" === please control /proc to trun on/off PHYDM func ===\n"); ++ } ++ break; ++ ++ case 0xfd: ++ rtw_write8(padapter, 0xc50, arg); ++ RTW_INFO("wr(0xc50)=0x%x\n", rtw_read8(padapter, 0xc50)); ++ rtw_write8(padapter, 0xc58, arg); ++ RTW_INFO("wr(0xc58)=0x%x\n", rtw_read8(padapter, 0xc58)); ++ break; ++ case 0xfe: ++ RTW_INFO("rd(0xc50)=0x%x\n", rtw_read8(padapter, 0xc50)); ++ RTW_INFO("rd(0xc58)=0x%x\n", rtw_read8(padapter, 0xc58)); ++ break; ++ case 0xff: { ++ RTW_INFO("dbg(0x210)=0x%x\n", rtw_read32(padapter, 0x210)); ++ RTW_INFO("dbg(0x608)=0x%x\n", rtw_read32(padapter, 0x608)); ++ RTW_INFO("dbg(0x280)=0x%x\n", rtw_read32(padapter, 0x280)); ++ RTW_INFO("dbg(0x284)=0x%x\n", rtw_read32(padapter, 0x284)); ++ RTW_INFO("dbg(0x288)=0x%x\n", rtw_read32(padapter, 0x288)); ++ ++ RTW_INFO("dbg(0x664)=0x%x\n", rtw_read32(padapter, 0x664)); ++ ++ ++ RTW_INFO("\n"); ++ ++ RTW_INFO("dbg(0x430)=0x%x\n", rtw_read32(padapter, 0x430)); ++ RTW_INFO("dbg(0x438)=0x%x\n", rtw_read32(padapter, 0x438)); ++ ++ RTW_INFO("dbg(0x440)=0x%x\n", rtw_read32(padapter, 0x440)); ++ ++ RTW_INFO("dbg(0x458)=0x%x\n", rtw_read32(padapter, 0x458)); ++ ++ RTW_INFO("dbg(0x484)=0x%x\n", rtw_read32(padapter, 0x484)); ++ RTW_INFO("dbg(0x488)=0x%x\n", rtw_read32(padapter, 0x488)); ++ ++ RTW_INFO("dbg(0x444)=0x%x\n", rtw_read32(padapter, 0x444)); ++ RTW_INFO("dbg(0x448)=0x%x\n", rtw_read32(padapter, 0x448)); ++ RTW_INFO("dbg(0x44c)=0x%x\n", rtw_read32(padapter, 0x44c)); ++ RTW_INFO("dbg(0x450)=0x%x\n", rtw_read32(padapter, 0x450)); ++ } ++ break; ++ } ++ break; ++ default: ++ RTW_INFO("error dbg cmd!\n"); ++ break; ++ } ++ ++ ++ return ret; ++ ++} ++ ++static int wpa_set_param(struct net_device *dev, u8 name, u32 value) ++{ ++ uint ret = 0; ++ u32 flags; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ switch (name) { ++ case IEEE_PARAM_WPA_ENABLED: ++ ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; /* 802.1x */ ++ ++ /* ret = ieee80211_wpa_enable(ieee, value); */ ++ ++ switch ((value) & 0xff) { ++ case 1: /* WPA */ ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPAPSK; /* WPA_PSK */ ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; ++ break; ++ case 2: /* WPA2 */ ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPA2PSK; /* WPA2_PSK */ ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; ++ break; ++ } ++ ++ ++ break; ++ ++ case IEEE_PARAM_TKIP_COUNTERMEASURES: ++ /* ieee->tkip_countermeasures=value; */ ++ break; ++ ++ case IEEE_PARAM_DROP_UNENCRYPTED: { ++ /* HACK: ++ * ++ * wpa_supplicant calls set_wpa_enabled when the driver ++ * is loaded and unloaded, regardless of if WPA is being ++ * used. No other calls are made which can be used to ++ * determine if encryption will be used or not prior to ++ * association being expected. If encryption is not being ++ * used, drop_unencrypted is set to false, else true -- we ++ * can use this to determine if the CAP_PRIVACY_ON bit should ++ * be set. ++ */ ++ ++#if 0 ++ struct ieee80211_security sec = { ++ .flags = SEC_ENABLED, ++ .enabled = value, ++ }; ++ ieee->drop_unencrypted = value; ++ /* We only change SEC_LEVEL for open mode. Others ++ * are set by ipw_wpa_set_encryption. ++ */ ++ if (!value) { ++ sec.flags |= SEC_LEVEL; ++ sec.level = SEC_LEVEL_0; ++ } else { ++ sec.flags |= SEC_LEVEL; ++ sec.level = SEC_LEVEL_1; ++ } ++ if (ieee->set_security) ++ ieee->set_security(ieee->dev, &sec); ++#endif ++ break; ++ ++ } ++ case IEEE_PARAM_PRIVACY_INVOKED: ++ ++ /* ieee->privacy_invoked=value; */ ++ ++ break; ++ ++ case IEEE_PARAM_AUTH_ALGS: ++ ++ ret = wpa_set_auth_algs(dev, value); ++ ++ break; ++ ++ case IEEE_PARAM_IEEE_802_1X: ++ ++ /* ieee->ieee802_1x=value; */ ++ ++ break; ++ ++ case IEEE_PARAM_WPAX_SELECT: ++ ++ /* added for WPA2 mixed mode */ ++ /*RTW_WARN("------------------------>wpax value = %x\n", value);*/ ++ /* ++ spin_lock_irqsave(&ieee->wpax_suitlist_lock,flags); ++ ieee->wpax_type_set = 1; ++ ieee->wpax_type_notify = value; ++ spin_unlock_irqrestore(&ieee->wpax_suitlist_lock,flags); ++ */ ++ ++ break; ++ ++ default: ++ ++ ++ ++ ret = -EOPNOTSUPP; ++ ++ ++ break; ++ ++ } ++ ++ return ret; ++ ++} ++ ++static int wpa_mlme(struct net_device *dev, u32 command, u32 reason) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ switch (command) { ++ case IEEE_MLME_STA_DEAUTH: ++ ++ if (!rtw_set_802_11_disassociate(padapter)) ++ ret = -1; ++ ++ break; ++ ++ case IEEE_MLME_STA_DISASSOC: ++ ++ if (!rtw_set_802_11_disassociate(padapter)) ++ ret = -1; ++ ++ break; ++ ++ default: ++ ret = -EOPNOTSUPP; ++ break; ++ } ++ ++ return ret; ++ ++} ++ ++static int wpa_supplicant_ioctl(struct net_device *dev, struct iw_point *p) ++{ ++ struct ieee_param *param; ++ uint ret = 0; ++ ++ /* down(&ieee->wx_sem); */ ++ ++ if (p->length < sizeof(struct ieee_param) || !p->pointer) { ++ ret = -EINVAL; ++ goto out; ++ } ++ ++ param = (struct ieee_param *)rtw_malloc(p->length); ++ if (param == NULL) { ++ ret = -ENOMEM; ++ goto out; ++ } ++ ++ if (copy_from_user(param, p->pointer, p->length)) { ++ rtw_mfree((u8 *)param, p->length); ++ ret = -EFAULT; ++ goto out; ++ } ++ ++ switch (param->cmd) { ++ ++ case IEEE_CMD_SET_WPA_PARAM: ++ ret = wpa_set_param(dev, param->u.wpa_param.name, param->u.wpa_param.value); ++ break; ++ ++ case IEEE_CMD_SET_WPA_IE: ++ /* ret = wpa_set_wpa_ie(dev, param, p->length); */ ++ ret = rtw_set_wpa_ie((_adapter *)rtw_netdev_priv(dev), (char *)param->u.wpa_ie.data, (u16)param->u.wpa_ie.len); ++ break; ++ ++ case IEEE_CMD_SET_ENCRYPTION: ++ ret = wpa_set_encryption(dev, param, p->length); ++ break; ++ ++ case IEEE_CMD_MLME: ++ ret = wpa_mlme(dev, param->u.mlme.command, param->u.mlme.reason_code); ++ break; ++ ++ default: ++ RTW_INFO("Unknown WPA supplicant request: %d\n", param->cmd); ++ ret = -EOPNOTSUPP; ++ break; ++ ++ } ++ ++ if (ret == 0 && copy_to_user(p->pointer, param, p->length)) ++ ret = -EFAULT; ++ ++ rtw_mfree((u8 *)param, p->length); ++ ++out: ++ ++ /* up(&ieee->wx_sem); */ ++ ++ return ret; ++ ++} ++ ++#ifdef CONFIG_AP_MODE ++static int rtw_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) ++{ ++ int ret = 0; ++ u32 wep_key_idx, wep_key_len, wep_total_len; ++ NDIS_802_11_WEP *pwep = NULL; ++ struct sta_info *psta = NULL, *pbcmc_sta = NULL; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &(padapter->securitypriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ param->u.crypt.err = 0; ++ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; ++ ++ /* sizeof(struct ieee_param) = 64 bytes; */ ++ /* if (param_len != (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) */ ++ if (param_len != sizeof(struct ieee_param) + param->u.crypt.key_len) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && ++ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) { ++ if (param->u.crypt.idx >= WEP_KEYS ++#ifdef CONFIG_IEEE80211W ++ && param->u.crypt.idx > BIP_MAX_KEYID ++#endif /* CONFIG_IEEE80211W */ ++ ) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ } else { ++ psta = rtw_get_stainfo(pstapriv, param->sta_addr); ++ if (!psta) { ++ /* ret = -EINVAL; */ ++ RTW_INFO("rtw_set_encryption(), sta has already been removed or never been added\n"); ++ goto exit; ++ } ++ } ++ ++ if (strcmp(param->u.crypt.alg, "none") == 0 && (psta == NULL)) { ++ /* todo:clear default encryption keys */ ++ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; ++ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; ++ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; ++ ++ RTW_INFO("clear default encryption keys, keyid=%d\n", param->u.crypt.idx); ++ ++ goto exit; ++ } ++ ++ ++ if (strcmp(param->u.crypt.alg, "WEP") == 0 && (psta == NULL)) { ++ RTW_INFO("r871x_set_encryption, crypt.alg = WEP\n"); ++ ++ wep_key_idx = param->u.crypt.idx; ++ wep_key_len = param->u.crypt.key_len; ++ ++ RTW_INFO("r871x_set_encryption, wep_key_idx=%d, len=%d\n", wep_key_idx, wep_key_len); ++ ++ if ((wep_key_idx >= WEP_KEYS) || (wep_key_len <= 0)) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ ++ if (wep_key_len > 0) { ++ wep_key_len = wep_key_len <= 5 ? 5 : 13; ++ wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); ++ pwep = (NDIS_802_11_WEP *)rtw_malloc(wep_total_len); ++ if (pwep == NULL) { ++ RTW_INFO(" r871x_set_encryption: pwep allocate fail !!!\n"); ++ goto exit; ++ } ++ ++ _rtw_memset(pwep, 0, wep_total_len); ++ ++ pwep->KeyLength = wep_key_len; ++ pwep->Length = wep_total_len; ++ ++ } ++ ++ pwep->KeyIndex = wep_key_idx; ++ ++ _rtw_memcpy(pwep->KeyMaterial, param->u.crypt.key, pwep->KeyLength); ++ ++ if (param->u.crypt.set_tx) { ++ RTW_INFO("wep, set_tx=1\n"); ++ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; ++ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; ++ ++ if (pwep->KeyLength == 13) { ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; ++ } ++ ++ ++ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; ++ ++ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength); ++ ++ psecuritypriv->dot11DefKeylen[wep_key_idx] = pwep->KeyLength; ++ ++ rtw_ap_set_wep_key(padapter, pwep->KeyMaterial, pwep->KeyLength, wep_key_idx, 1); ++ } else { ++ RTW_INFO("wep, set_tx=0\n"); ++ ++ /* don't update "psecuritypriv->dot11PrivacyAlgrthm" and */ ++ /* "psecuritypriv->dot11PrivacyKeyIndex=keyid", but can rtw_set_key to cam */ ++ ++ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength); ++ ++ psecuritypriv->dot11DefKeylen[wep_key_idx] = pwep->KeyLength; ++ ++ rtw_ap_set_wep_key(padapter, pwep->KeyMaterial, pwep->KeyLength, wep_key_idx, 0); ++ } ++ ++ goto exit; ++ ++ } ++ ++ ++ if (!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) /* */ { /* group key */ ++ if (param->u.crypt.set_tx == 1) { ++ if (strcmp(param->u.crypt.alg, "WEP") == 0) { ++ RTW_INFO("%s, set group_key, WEP\n", __FUNCTION__); ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; ++ if (param->u.crypt.key_len == 13) ++ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; ++ ++ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { ++ RTW_INFO("%s, set group_key, TKIP\n", __FUNCTION__); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ ++ /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ ++ /* set mic key */ ++ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); ++ ++ psecuritypriv->busetkipkey = _TRUE; ++ ++ } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { ++ RTW_INFO("%s, set group_key, CCMP\n", __FUNCTION__); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _AES_; ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ } ++#ifdef CONFIG_IEEE80211W ++ else if (strcmp(param->u.crypt.alg, "BIP") == 0) { ++ int no; ++ ++ RTW_INFO("BIP key_len=%d , index=%d\n", param->u.crypt.key_len, param->u.crypt.idx); ++ /* save the IGTK key, length 16 bytes */ ++ _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ /* RTW_INFO("IGTK key below:\n"); ++ for(no=0;no<16;no++) ++ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); ++ RTW_INFO("\n"); */ ++ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; ++ padapter->securitypriv.binstallBIPkey = _TRUE; ++ RTW_INFO(" ~~~~set sta key:IGKT\n"); ++ goto exit; ++ } ++#endif /* CONFIG_IEEE80211W */ ++ else { ++ RTW_INFO("%s, set group_key, none\n", __FUNCTION__); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; ++ } ++ ++ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; ++ ++ psecuritypriv->binstallGrpkey = _TRUE; ++ ++ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ ++ ++ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); ++ ++ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); ++ if (pbcmc_sta) { ++ pbcmc_sta->ieee8021x_blocked = _FALSE; ++ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ ++ } ++ ++ } ++ ++ goto exit; ++ ++ } ++ ++ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) { /* psk/802_1x */ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ if (param->u.crypt.set_tx == 1) { ++ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ ++ if (strcmp(param->u.crypt.alg, "WEP") == 0) { ++ RTW_INFO("%s, set pairwise key, WEP\n", __FUNCTION__); ++ ++ psta->dot118021XPrivacy = _WEP40_; ++ if (param->u.crypt.key_len == 13) ++ psta->dot118021XPrivacy = _WEP104_; ++ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { ++ RTW_INFO("%s, set pairwise key, TKIP\n", __FUNCTION__); ++ ++ psta->dot118021XPrivacy = _TKIP_; ++ ++ /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ ++ /* set mic key */ ++ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); ++ ++ psecuritypriv->busetkipkey = _TRUE; ++ ++ } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { ++ ++ RTW_INFO("%s, set pairwise key, CCMP\n", __FUNCTION__); ++ ++ psta->dot118021XPrivacy = _AES_; ++ } else { ++ RTW_INFO("%s, set pairwise key, none\n", __FUNCTION__); ++ ++ psta->dot118021XPrivacy = _NO_PRIVACY_; ++ } ++ ++ rtw_ap_set_pairwise_key(padapter, psta); ++ ++ psta->ieee8021x_blocked = _FALSE; ++ ++ psta->bpairwise_key_installed = _TRUE; ++ ++ } else { /* group key??? */ ++ if (strcmp(param->u.crypt.alg, "WEP") == 0) { ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; ++ if (param->u.crypt.key_len == 13) ++ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; ++ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { ++ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ ++ /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ ++ /* set mic key */ ++ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); ++ ++ psecuritypriv->busetkipkey = _TRUE; ++ ++ } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { ++ psecuritypriv->dot118021XGrpPrivacy = _AES_; ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); ++ } else ++ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; ++ ++ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; ++ ++ psecuritypriv->binstallGrpkey = _TRUE; ++ ++ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ ++ ++ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); ++ ++ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); ++ if (pbcmc_sta) { ++ pbcmc_sta->ieee8021x_blocked = _FALSE; ++ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ ++ } ++ ++ } ++ ++ } ++ ++ } ++ ++exit: ++ ++ if (pwep) ++ rtw_mfree((u8 *)pwep, wep_total_len); ++ ++ return ret; ++ ++} ++ ++static int rtw_set_beacon(struct net_device *dev, struct ieee_param *param, int len) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ unsigned char *pbuf = param->u.bcn_ie.buf; ++ ++ ++ RTW_INFO("%s, len=%d\n", __FUNCTION__, len); ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ return -EINVAL; ++ ++ _rtw_memcpy(&pstapriv->max_num_sta, param->u.bcn_ie.reserved, 2); ++ ++ if ((pstapriv->max_num_sta > NUM_STA) || (pstapriv->max_num_sta <= 0)) ++ pstapriv->max_num_sta = NUM_STA; ++ ++ ++ if (rtw_check_beacon_data(padapter, pbuf, (len - 12 - 2)) == _SUCCESS) /* 12 = param header, 2:no packed */ ++ ret = 0; ++ else ++ ret = -EINVAL; ++ ++ ++ return ret; ++ ++} ++ ++static int rtw_hostapd_sta_flush(struct net_device *dev) ++{ ++ /* _irqL irqL; */ ++ /* _list *phead, *plist; */ ++ int ret = 0; ++ /* struct sta_info *psta = NULL; */ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ /* struct sta_priv *pstapriv = &padapter->stapriv; */ ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ flush_all_cam_entry(padapter); /* clear CAM */ ++ ++ ret = rtw_sta_flush(padapter, _TRUE); ++ ++ return ret; ++ ++} ++ ++static int rtw_add_sta(struct net_device *dev, struct ieee_param *param) ++{ ++ _irqL irqL; ++ int ret = 0; ++ struct sta_info *psta = NULL; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ RTW_INFO("rtw_add_sta(aid=%d)=" MAC_FMT "\n", param->u.add_sta.aid, MAC_ARG(param->sta_addr)); ++ ++ if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE) ++ return -EINVAL; ++ ++ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && ++ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ return -EINVAL; ++ ++#if 0 ++ psta = rtw_get_stainfo(pstapriv, param->sta_addr); ++ if (psta) { ++ RTW_INFO("rtw_add_sta(), free has been added psta=%p\n", psta); ++ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ rtw_free_stainfo(padapter, psta); ++ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ ++ ++ psta = NULL; ++ } ++#endif ++ /* psta = rtw_alloc_stainfo(pstapriv, param->sta_addr); */ ++ psta = rtw_get_stainfo(pstapriv, param->sta_addr); ++ if (psta) { ++ int flags = param->u.add_sta.flags; ++ ++ /* RTW_INFO("rtw_add_sta(), init sta's variables, psta=%p\n", psta); */ ++ ++ psta->aid = param->u.add_sta.aid;/* aid=1~2007 */ ++ ++ _rtw_memcpy(psta->bssrateset, param->u.add_sta.tx_supp_rates, 16); ++ ++ ++ /* check wmm cap. */ ++ if (WLAN_STA_WME & flags) ++ psta->qos_option = 1; ++ else ++ psta->qos_option = 0; ++ ++ if (pmlmepriv->qospriv.qos_option == 0) ++ psta->qos_option = 0; ++ ++ ++#ifdef CONFIG_80211N_HT ++ /* chec 802.11n ht cap. */ ++ if (WLAN_STA_HT & flags) { ++ psta->htpriv.ht_option = _TRUE; ++ psta->qos_option = 1; ++ _rtw_memcpy((void *)&psta->htpriv.ht_cap, (void *)¶m->u.add_sta.ht_cap, sizeof(struct rtw_ieee80211_ht_cap)); ++ } else ++ psta->htpriv.ht_option = _FALSE; ++ ++ if (pmlmepriv->htpriv.ht_option == _FALSE) ++ psta->htpriv.ht_option = _FALSE; ++#endif ++ ++ ++ update_sta_info_apmode(padapter, psta); ++ ++ ++ } else ++ ret = -ENOMEM; ++ ++ return ret; ++ ++} ++ ++static int rtw_del_sta(struct net_device *dev, struct ieee_param *param) ++{ ++ _irqL irqL; ++ int ret = 0; ++ struct sta_info *psta = NULL; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ RTW_INFO("rtw_del_sta=" MAC_FMT "\n", MAC_ARG(param->sta_addr)); ++ ++ if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE) ++ return -EINVAL; ++ ++ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && ++ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ return -EINVAL; ++ ++ psta = rtw_get_stainfo(pstapriv, param->sta_addr); ++ if (psta) { ++ u8 updated = _FALSE; ++ ++ /* RTW_INFO("free psta=%p, aid=%d\n", psta, psta->aid); */ ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { ++ rtw_list_delete(&psta->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ updated = ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); ++ ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); ++ ++ psta = NULL; ++ ++ } else { ++ RTW_INFO("rtw_del_sta(), sta has already been removed or never been added\n"); ++ ++ /* ret = -1; */ ++ } ++ ++ ++ return ret; ++ ++} ++ ++static int rtw_ioctl_get_sta_data(struct net_device *dev, struct ieee_param *param, int len) ++{ ++ int ret = 0; ++ struct sta_info *psta = NULL; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct ieee_param_ex *param_ex = (struct ieee_param_ex *)param; ++ struct sta_data *psta_data = (struct sta_data *)param_ex->data; ++ ++ RTW_INFO("rtw_ioctl_get_sta_info, sta_addr: " MAC_FMT "\n", MAC_ARG(param_ex->sta_addr)); ++ ++ if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE) ++ return -EINVAL; ++ ++ if (param_ex->sta_addr[0] == 0xff && param_ex->sta_addr[1] == 0xff && ++ param_ex->sta_addr[2] == 0xff && param_ex->sta_addr[3] == 0xff && ++ param_ex->sta_addr[4] == 0xff && param_ex->sta_addr[5] == 0xff) ++ return -EINVAL; ++ ++ psta = rtw_get_stainfo(pstapriv, param_ex->sta_addr); ++ if (psta) { ++#if 0 ++ struct { ++ u16 aid; ++ u16 capability; ++ int flags; ++ u32 sta_set; ++ u8 tx_supp_rates[16]; ++ u32 tx_supp_rates_len; ++ struct rtw_ieee80211_ht_cap ht_cap; ++ u64 rx_pkts; ++ u64 rx_bytes; ++ u64 rx_drops; ++ u64 tx_pkts; ++ u64 tx_bytes; ++ u64 tx_drops; ++ } get_sta; ++#endif ++ psta_data->aid = (u16)psta->aid; ++ psta_data->capability = psta->capability; ++ psta_data->flags = psta->flags; ++ ++ /* ++ nonerp_set : BIT(0) ++ no_short_slot_time_set : BIT(1) ++ no_short_preamble_set : BIT(2) ++ no_ht_gf_set : BIT(3) ++ no_ht_set : BIT(4) ++ ht_20mhz_set : BIT(5) ++ */ ++ ++ psta_data->sta_set = ((psta->nonerp_set) | ++ (psta->no_short_slot_time_set << 1) | ++ (psta->no_short_preamble_set << 2) | ++ (psta->no_ht_gf_set << 3) | ++ (psta->no_ht_set << 4) | ++ (psta->ht_20mhz_set << 5)); ++ ++ psta_data->tx_supp_rates_len = psta->bssratelen; ++ _rtw_memcpy(psta_data->tx_supp_rates, psta->bssrateset, psta->bssratelen); ++#ifdef CONFIG_80211N_HT ++ _rtw_memcpy(&psta_data->ht_cap, &psta->htpriv.ht_cap, sizeof(struct rtw_ieee80211_ht_cap)); ++#endif /* CONFIG_80211N_HT */ ++ psta_data->rx_pkts = psta->sta_stats.rx_data_pkts; ++ psta_data->rx_bytes = psta->sta_stats.rx_bytes; ++ psta_data->rx_drops = psta->sta_stats.rx_drops; ++ ++ psta_data->tx_pkts = psta->sta_stats.tx_pkts; ++ psta_data->tx_bytes = psta->sta_stats.tx_bytes; ++ psta_data->tx_drops = psta->sta_stats.tx_drops; ++ ++ ++ } else ++ ret = -1; ++ ++ return ret; ++ ++} ++ ++static int rtw_get_sta_wpaie(struct net_device *dev, struct ieee_param *param) ++{ ++ int ret = 0; ++ struct sta_info *psta = NULL; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ RTW_INFO("rtw_get_sta_wpaie, sta_addr: " MAC_FMT "\n", MAC_ARG(param->sta_addr)); ++ ++ if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE) ++ return -EINVAL; ++ ++ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && ++ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ return -EINVAL; ++ ++ psta = rtw_get_stainfo(pstapriv, param->sta_addr); ++ if (psta) { ++ if ((psta->wpa_ie[0] == WLAN_EID_RSN) || (psta->wpa_ie[0] == WLAN_EID_GENERIC)) { ++ int wpa_ie_len; ++ int copy_len; ++ ++ wpa_ie_len = psta->wpa_ie[1]; ++ ++ copy_len = ((wpa_ie_len + 2) > sizeof(psta->wpa_ie)) ? (sizeof(psta->wpa_ie)) : (wpa_ie_len + 2); ++ ++ param->u.wpa_ie.len = copy_len; ++ ++ _rtw_memcpy(param->u.wpa_ie.reserved, psta->wpa_ie, copy_len); ++ } else { ++ /* ret = -1; */ ++ RTW_INFO("sta's wpa_ie is NONE\n"); ++ } ++ } else ++ ret = -1; ++ ++ return ret; ++ ++} ++ ++static int rtw_set_wps_beacon(struct net_device *dev, struct ieee_param *param, int len) ++{ ++ int ret = 0; ++ unsigned char wps_oui[4] = {0x0, 0x50, 0xf2, 0x04}; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ int ie_len; ++ ++ RTW_INFO("%s, len=%d\n", __FUNCTION__, len); ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ return -EINVAL; ++ ++ ie_len = len - 12 - 2; /* 12 = param header, 2:no packed */ ++ ++ ++ if (pmlmepriv->wps_beacon_ie) { ++ rtw_mfree(pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len); ++ pmlmepriv->wps_beacon_ie = NULL; ++ } ++ ++ if (ie_len > 0) { ++ pmlmepriv->wps_beacon_ie = rtw_malloc(ie_len); ++ pmlmepriv->wps_beacon_ie_len = ie_len; ++ if (pmlmepriv->wps_beacon_ie == NULL) { ++ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ } ++ ++ _rtw_memcpy(pmlmepriv->wps_beacon_ie, param->u.bcn_ie.buf, ie_len); ++ ++ update_beacon(padapter, _VENDOR_SPECIFIC_IE_, wps_oui, _TRUE); ++ ++ pmlmeext->bstart_bss = _TRUE; ++ ++ } ++ ++ ++ return ret; ++ ++} ++ ++static int rtw_set_wps_probe_resp(struct net_device *dev, struct ieee_param *param, int len) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ int ie_len; ++ ++ RTW_INFO("%s, len=%d\n", __FUNCTION__, len); ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ return -EINVAL; ++ ++ ie_len = len - 12 - 2; /* 12 = param header, 2:no packed */ ++ ++ ++ if (pmlmepriv->wps_probe_resp_ie) { ++ rtw_mfree(pmlmepriv->wps_probe_resp_ie, pmlmepriv->wps_probe_resp_ie_len); ++ pmlmepriv->wps_probe_resp_ie = NULL; ++ } ++ ++ if (ie_len > 0) { ++ pmlmepriv->wps_probe_resp_ie = rtw_malloc(ie_len); ++ pmlmepriv->wps_probe_resp_ie_len = ie_len; ++ if (pmlmepriv->wps_probe_resp_ie == NULL) { ++ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ } ++ _rtw_memcpy(pmlmepriv->wps_probe_resp_ie, param->u.bcn_ie.buf, ie_len); ++ } ++ ++ ++ return ret; ++ ++} ++ ++static int rtw_set_wps_assoc_resp(struct net_device *dev, struct ieee_param *param, int len) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ int ie_len; ++ ++ RTW_INFO("%s, len=%d\n", __FUNCTION__, len); ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ return -EINVAL; ++ ++ ie_len = len - 12 - 2; /* 12 = param header, 2:no packed */ ++ ++ ++ if (pmlmepriv->wps_assoc_resp_ie) { ++ rtw_mfree(pmlmepriv->wps_assoc_resp_ie, pmlmepriv->wps_assoc_resp_ie_len); ++ pmlmepriv->wps_assoc_resp_ie = NULL; ++ } ++ ++ if (ie_len > 0) { ++ pmlmepriv->wps_assoc_resp_ie = rtw_malloc(ie_len); ++ pmlmepriv->wps_assoc_resp_ie_len = ie_len; ++ if (pmlmepriv->wps_assoc_resp_ie == NULL) { ++ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ } ++ ++ _rtw_memcpy(pmlmepriv->wps_assoc_resp_ie, param->u.bcn_ie.buf, ie_len); ++ } ++ ++ ++ return ret; ++ ++} ++ ++static int rtw_set_hidden_ssid(struct net_device *dev, struct ieee_param *param, int len) ++{ ++ int ret = 0; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *mlmepriv = &(adapter->mlmepriv); ++ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); ++ struct mlme_ext_info *mlmeinfo = &(mlmeext->mlmext_info); ++ int ie_len; ++ u8 *ssid_ie; ++ char ssid[NDIS_802_11_LENGTH_SSID + 1]; ++ sint ssid_len = 0; ++ u8 ignore_broadcast_ssid; ++ ++ if (check_fwstate(mlmepriv, WIFI_AP_STATE) != _TRUE) ++ return -EPERM; ++ ++ if (param->u.bcn_ie.reserved[0] != 0xea) ++ return -EINVAL; ++ ++ mlmeinfo->hidden_ssid_mode = ignore_broadcast_ssid = param->u.bcn_ie.reserved[1]; ++ ++ ie_len = len - 12 - 2; /* 12 = param header, 2:no packed */ ++ ssid_ie = rtw_get_ie(param->u.bcn_ie.buf, WLAN_EID_SSID, &ssid_len, ie_len); ++ ++ if (ssid_ie && ssid_len > 0 && ssid_len <= NDIS_802_11_LENGTH_SSID) { ++ WLAN_BSSID_EX *pbss_network = &mlmepriv->cur_network.network; ++ WLAN_BSSID_EX *pbss_network_ext = &mlmeinfo->network; ++ ++ _rtw_memcpy(ssid, ssid_ie + 2, ssid_len); ++ ssid[ssid_len] = 0x0; ++ ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" ssid:(%s,%d), from ie:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), ++ ssid, ssid_len, ++ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, ++ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); ++ ++ _rtw_memcpy(pbss_network->Ssid.Ssid, (void *)ssid, ssid_len); ++ pbss_network->Ssid.SsidLength = ssid_len; ++ _rtw_memcpy(pbss_network_ext->Ssid.Ssid, (void *)ssid, ssid_len); ++ pbss_network_ext->Ssid.SsidLength = ssid_len; ++ ++ if (0) ++ RTW_INFO(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), ++ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, ++ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); ++ } ++ ++ RTW_INFO(FUNC_ADPT_FMT" ignore_broadcast_ssid:%d, %s,%d\n", FUNC_ADPT_ARG(adapter), ++ ignore_broadcast_ssid, ssid, ssid_len); ++ ++ return ret; ++} ++ ++#if CONFIG_RTW_MACADDR_ACL ++static int rtw_ioctl_acl_remove_sta(struct net_device *dev, struct ieee_param *param, int len) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ return -EINVAL; ++ ++ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && ++ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ return -EINVAL; ++ ++ ret = rtw_acl_remove_sta(padapter, param->sta_addr); ++ ++ return ret; ++ ++} ++ ++static int rtw_ioctl_acl_add_sta(struct net_device *dev, struct ieee_param *param, int len) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ return -EINVAL; ++ ++ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && ++ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ return -EINVAL; ++ ++ ret = rtw_acl_add_sta(padapter, param->sta_addr); ++ ++ return ret; ++ ++} ++ ++static int rtw_ioctl_set_macaddr_acl(struct net_device *dev, struct ieee_param *param, int len) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ return -EINVAL; ++ ++ rtw_set_macaddr_acl(padapter, param->u.mlme.command); ++ ++ return ret; ++} ++#endif /* CONFIG_RTW_MACADDR_ACL */ ++ ++static int rtw_hostapd_ioctl(struct net_device *dev, struct iw_point *p) ++{ ++ struct ieee_param *param; ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ /* ++ * this function is expect to call in master mode, which allows no power saving ++ * so, we just check hw_init_completed ++ */ ++ ++ if (!rtw_is_hw_init_completed(padapter)) { ++ ret = -EPERM; ++ goto out; ++ } ++ ++ ++ /* if (p->length < sizeof(struct ieee_param) || !p->pointer){ */ ++ if (!p->pointer) { ++ ret = -EINVAL; ++ goto out; ++ } ++ ++ param = (struct ieee_param *)rtw_malloc(p->length); ++ if (param == NULL) { ++ ret = -ENOMEM; ++ goto out; ++ } ++ ++ if (copy_from_user(param, p->pointer, p->length)) { ++ rtw_mfree((u8 *)param, p->length); ++ ret = -EFAULT; ++ goto out; ++ } ++ ++ /* RTW_INFO("%s, cmd=%d\n", __FUNCTION__, param->cmd); */ ++ ++ switch (param->cmd) { ++ case RTL871X_HOSTAPD_FLUSH: ++ ++ ret = rtw_hostapd_sta_flush(dev); ++ ++ break; ++ ++ case RTL871X_HOSTAPD_ADD_STA: ++ ++ ret = rtw_add_sta(dev, param); ++ ++ break; ++ ++ case RTL871X_HOSTAPD_REMOVE_STA: ++ ++ ret = rtw_del_sta(dev, param); ++ ++ break; ++ ++ case RTL871X_HOSTAPD_SET_BEACON: ++ ++ ret = rtw_set_beacon(dev, param, p->length); ++ ++ break; ++ ++ case RTL871X_SET_ENCRYPTION: ++ ++ ret = rtw_set_encryption(dev, param, p->length); ++ ++ break; ++ ++ case RTL871X_HOSTAPD_GET_WPAIE_STA: ++ ++ ret = rtw_get_sta_wpaie(dev, param); ++ ++ break; ++ ++ case RTL871X_HOSTAPD_SET_WPS_BEACON: ++ ++ ret = rtw_set_wps_beacon(dev, param, p->length); ++ ++ break; ++ ++ case RTL871X_HOSTAPD_SET_WPS_PROBE_RESP: ++ ++ ret = rtw_set_wps_probe_resp(dev, param, p->length); ++ ++ break; ++ ++ case RTL871X_HOSTAPD_SET_WPS_ASSOC_RESP: ++ ++ ret = rtw_set_wps_assoc_resp(dev, param, p->length); ++ ++ break; ++ ++ case RTL871X_HOSTAPD_SET_HIDDEN_SSID: ++ ++ ret = rtw_set_hidden_ssid(dev, param, p->length); ++ ++ break; ++ ++ case RTL871X_HOSTAPD_GET_INFO_STA: ++ ++ ret = rtw_ioctl_get_sta_data(dev, param, p->length); ++ ++ break; ++ ++#if CONFIG_RTW_MACADDR_ACL ++ case RTL871X_HOSTAPD_SET_MACADDR_ACL: ++ ret = rtw_ioctl_set_macaddr_acl(dev, param, p->length); ++ break; ++ case RTL871X_HOSTAPD_ACL_ADD_STA: ++ ret = rtw_ioctl_acl_add_sta(dev, param, p->length); ++ break; ++ case RTL871X_HOSTAPD_ACL_REMOVE_STA: ++ ret = rtw_ioctl_acl_remove_sta(dev, param, p->length); ++ break; ++#endif /* CONFIG_RTW_MACADDR_ACL */ ++ ++ default: ++ RTW_INFO("Unknown hostapd request: %d\n", param->cmd); ++ ret = -EOPNOTSUPP; ++ break; ++ ++ } ++ ++ if (ret == 0 && copy_to_user(p->pointer, param, p->length)) ++ ret = -EFAULT; ++ ++ ++ rtw_mfree((u8 *)param, p->length); ++ ++out: ++ ++ return ret; ++ ++} ++#endif ++ ++static int rtw_wx_set_priv(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *awrq, ++ char *extra) ++{ ++ ++#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV ++ char *ext_dbg; ++#endif ++ ++ int ret = 0; ++ int len = 0; ++ char *ext; ++ int i; ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *dwrq = (struct iw_point *)awrq; ++ ++ if (dwrq->length == 0) ++ return -EFAULT; ++ ++ len = dwrq->length; ++ ext = rtw_vmalloc(len); ++ if (!ext) ++ return -ENOMEM; ++ ++ if (copy_from_user(ext, dwrq->pointer, len)) { ++ rtw_vmfree(ext, len); ++ return -EFAULT; ++ } ++ ++ ++ ++#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV ++ ext_dbg = rtw_vmalloc(len); ++ if (!ext_dbg) { ++ rtw_vmfree(ext, len); ++ return -ENOMEM; ++ } ++ ++ _rtw_memcpy(ext_dbg, ext, len); ++#endif ++ ++ /* added for wps2.0 @20110524 */ ++ if (dwrq->flags == 0x8766 && len > 8) { ++ u32 cp_sz; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u8 *probereq_wpsie = ext; ++ int probereq_wpsie_len = len; ++ u8 wps_oui[4] = {0x0, 0x50, 0xf2, 0x04}; ++ ++ if ((_VENDOR_SPECIFIC_IE_ == probereq_wpsie[0]) && ++ (_rtw_memcmp(&probereq_wpsie[2], wps_oui, 4) == _TRUE)) { ++ cp_sz = probereq_wpsie_len > MAX_WPS_IE_LEN ? MAX_WPS_IE_LEN : probereq_wpsie_len; ++ ++ if (pmlmepriv->wps_probe_req_ie) { ++ u32 free_len = pmlmepriv->wps_probe_req_ie_len; ++ pmlmepriv->wps_probe_req_ie_len = 0; ++ rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len); ++ pmlmepriv->wps_probe_req_ie = NULL; ++ } ++ ++ pmlmepriv->wps_probe_req_ie = rtw_malloc(cp_sz); ++ if (pmlmepriv->wps_probe_req_ie == NULL) { ++ printk("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ ret = -EINVAL; ++ goto FREE_EXT; ++ ++ } ++ ++ _rtw_memcpy(pmlmepriv->wps_probe_req_ie, probereq_wpsie, cp_sz); ++ pmlmepriv->wps_probe_req_ie_len = cp_sz; ++ ++ } ++ ++ goto FREE_EXT; ++ ++ } ++ ++ if (len >= WEXT_CSCAN_HEADER_SIZE ++ && _rtw_memcmp(ext, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == _TRUE ++ ) { ++ ret = rtw_wx_set_scan(dev, info, awrq, ext); ++ goto FREE_EXT; ++ } ++ ++#ifdef CONFIG_ANDROID ++ /* RTW_INFO("rtw_wx_set_priv: %s req=%s\n", dev->name, ext); */ ++ ++ i = rtw_android_cmdstr_to_num(ext); ++ ++ switch (i) { ++ case ANDROID_WIFI_CMD_START: ++ indicate_wx_custom_event(padapter, "START"); ++ break; ++ case ANDROID_WIFI_CMD_STOP: ++ indicate_wx_custom_event(padapter, "STOP"); ++ break; ++ case ANDROID_WIFI_CMD_RSSI: { ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct wlan_network *pcur_network = &pmlmepriv->cur_network; ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ sprintf(ext, "%s rssi %d", pcur_network->network.Ssid.Ssid, padapter->recvpriv.rssi); ++ else ++ sprintf(ext, "OK"); ++ } ++ break; ++ case ANDROID_WIFI_CMD_LINKSPEED: { ++ u16 mbps = rtw_get_cur_max_rate(padapter) / 10; ++ sprintf(ext, "LINKSPEED %d", mbps); ++ } ++ break; ++ case ANDROID_WIFI_CMD_MACADDR: ++ sprintf(ext, "MACADDR = " MAC_FMT, MAC_ARG(dev->dev_addr)); ++ break; ++ case ANDROID_WIFI_CMD_SCAN_ACTIVE: { ++ /* rtw_set_scan_mode(padapter, SCAN_ACTIVE); */ ++ sprintf(ext, "OK"); ++ } ++ break; ++ case ANDROID_WIFI_CMD_SCAN_PASSIVE: { ++ /* rtw_set_scan_mode(padapter, SCAN_PASSIVE); */ ++ sprintf(ext, "OK"); ++ } ++ break; ++ ++ case ANDROID_WIFI_CMD_COUNTRY: { ++ char country_code[10]; ++ sscanf(ext, "%*s %s", country_code); ++ rtw_set_country(padapter, country_code); ++ sprintf(ext, "OK"); ++ } ++ break; ++ default: ++ #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV ++ RTW_INFO("%s: %s unknowned req=%s\n", __FUNCTION__, ++ dev->name, ext_dbg); ++ #endif ++ ++ sprintf(ext, "OK"); ++ ++ } ++ ++ if (copy_to_user(dwrq->pointer, ext, min(dwrq->length, (u16)(strlen(ext) + 1)))) ++ ret = -EFAULT; ++ ++#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV ++ RTW_INFO("%s: %s req=%s rep=%s dwrq->length=%d, strlen(ext)+1=%d\n", __FUNCTION__, ++ dev->name, ext_dbg , ext, dwrq->length, (u16)(strlen(ext) + 1)); ++#endif ++#endif /* end of CONFIG_ANDROID */ ++ ++ ++FREE_EXT: ++ ++ rtw_vmfree(ext, len); ++ #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV ++ rtw_vmfree(ext_dbg, len); ++ #endif ++ ++ /* RTW_INFO("rtw_wx_set_priv: (SIOCSIWPRIV) %s ret=%d\n", */ ++ /* dev->name, ret); */ ++ ++ return ret; ++ ++} ++#ifdef CONFIG_WOWLAN ++static int rtw_wowlan_ctrl(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wowlan_ioctl_param poidparam; ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct sta_info *psta = NULL; ++ int ret = 0; ++ u32 start_time = rtw_get_current_time(); ++ poidparam.subcode = 0; ++ ++ RTW_INFO("+rtw_wowlan_ctrl: %s\n", extra); ++ ++ if (!check_fwstate(pmlmepriv, _FW_LINKED) && ++ check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { ++#ifdef CONFIG_PNO_SUPPORT ++ pwrctrlpriv->wowlan_pno_enable = _TRUE; ++#else ++ RTW_INFO("[%s] WARNING: Please Connect With AP First!!\n", __func__); ++ goto _rtw_wowlan_ctrl_exit_free; ++#endif /* CONFIG_PNO_SUPPORT */ ++ } ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) ++ rtw_scan_abort(padapter); ++ ++ if (_rtw_memcmp(extra, "enable", 6)) ++ ++ ++ rtw_suspend_common(padapter); ++ ++ else if (_rtw_memcmp(extra, "disable", 7)) { ++#ifdef CONFIG_USB_HCI ++ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); ++ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); ++#endif ++ rtw_resume_common(padapter); ++ ++#ifdef CONFIG_PNO_SUPPORT ++ pwrctrlpriv->wowlan_pno_enable = _FALSE; ++#endif /* CONFIG_PNO_SUPPORT */ ++ ++ } else { ++ RTW_INFO("[%s] Invalid Parameter.\n", __func__); ++ goto _rtw_wowlan_ctrl_exit_free; ++ } ++ /* mutex_lock(&ioctl_mutex); */ ++_rtw_wowlan_ctrl_exit_free: ++ RTW_INFO("-rtw_wowlan_ctrl( subcode = %d)\n", poidparam.subcode); ++ RTW_PRINT("%s in %d ms\n", __func__, ++ rtw_get_passing_time_ms(start_time)); ++_rtw_wowlan_ctrl_exit: ++ return ret; ++} ++ ++/* ++ * IP filter This pattern if for a frame containing a ip packet: ++ * AA:AA:AA:AA:AA:AA:BB:BB:BB:BB:BB:BB:CC:CC:DD:-:-:-:-:-:-:-:-:EE:-:-:FF:FF:FF:FF:GG:GG:GG:GG:HH:HH:II:II ++ * ++ * A: Ethernet destination address ++ * B: Ethernet source address ++ * C: Ethernet protocol type ++ * D: IP header VER+Hlen, use: 0x45 (4 is for ver 4, 5 is for len 20) ++ * E: IP protocol ++ * F: IP source address ( 192.168.0.4: C0:A8:00:2C ) ++ * G: IP destination address ( 192.168.0.4: C0:A8:00:2C ) ++ * H: Source port (1024: 04:00) ++ * I: Destination port (1024: 04:00) ++ */ ++ ++static int rtw_wowlan_set_pattern(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wowlan_ioctl_param poidparam; ++ int ret = 0, len = 0, i = 0; ++ u32 start_time = rtw_get_current_time(); ++ u8 input[wrqu->data.length]; ++ u8 index = 0; ++ ++ poidparam.subcode = 0; ++ ++ if (!check_fwstate(pmlmepriv, _FW_LINKED) && ++ check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { ++ ret = -EFAULT; ++ RTW_INFO("Please Connect With AP First!!\n"); ++ goto _rtw_wowlan_set_pattern_exit; ++ } ++ ++ if (wrqu->data.length <= 0) { ++ ret = -EFAULT; ++ RTW_INFO("ERROR: parameter length <= 0\n"); ++ goto _rtw_wowlan_set_pattern_exit; ++ } else { ++ /* set pattern */ ++ if (copy_from_user(input, ++ wrqu->data.pointer, wrqu->data.length)) ++ return -EFAULT; ++ /* leave PS first */ ++ rtw_ps_deny(padapter, PS_DENY_IOCTL); ++ LeaveAllPowerSaveModeDirect(padapter); ++ if (strncmp(input, "pattern=", 8) == 0) { ++ if (pwrpriv->wowlan_pattern_idx >= MAX_WKFM_NUM) { ++ RTW_INFO("WARNING: priv-pattern is full(idx: %d)\n", ++ pwrpriv->wowlan_pattern_idx); ++ RTW_INFO("WARNING: please clean priv-pattern first\n"); ++ ret = -EINVAL; ++ goto _rtw_wowlan_set_pattern_exit; ++ } else { ++ index = pwrpriv->wowlan_pattern_idx; ++ ret = rtw_wowlan_parser_pattern_cmd(input, ++ pwrpriv->patterns[index].content, ++ &pwrpriv->patterns[index].len, ++ pwrpriv->patterns[index].mask); ++ ++ if (ret == _TRUE) ++ pwrpriv->wowlan_pattern_idx++; ++ } ++ } else if (strncmp(input, "clean", 5) == 0) { ++ poidparam.subcode = WOWLAN_PATTERN_CLEAN; ++ rtw_hal_set_hwreg(padapter, ++ HW_VAR_WOWLAN, (u8 *)&poidparam); ++ } else if (strncmp(input, "show", 4) == 0) { ++ for (i = 0 ; i < MAX_WKFM_NUM ; i++) { ++ RTW_INFO("=======[%d]=======\n", i); ++ rtw_read_from_frame_mask(padapter, i); ++ } ++ ++ RTW_INFO("********[RTK priv-patterns]*********\n"); ++ for (i = 0 ; i < MAX_WKFM_NUM ; i++) ++ rtw_dump_priv_pattern(padapter, i); ++ } else { ++ RTW_INFO("ERROR: incorrect parameter!\n"); ++ ret = -EINVAL; ++ } ++ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); ++ } ++_rtw_wowlan_set_pattern_exit: ++ return ret; ++} ++#endif /* CONFIG_WOWLAN */ ++ ++#ifdef CONFIG_AP_WOWLAN ++static int rtw_ap_wowlan_ctrl(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wowlan_ioctl_param poidparam; ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct sta_info *psta = NULL; ++ int ret = 0; ++ u32 start_time = rtw_get_current_time(); ++ poidparam.subcode = 0; ++ ++ RTW_INFO("+rtw_ap_wowlan_ctrl: %s\n", extra); ++ ++ if (!check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ RTW_INFO("[%s] It is not AP mode!!\n", __func__); ++ goto _rtw_ap_wowlan_ctrl_exit_free; ++ } ++ ++ if (_rtw_memcmp(extra, "enable", 6)) { ++ ++ pwrctrlpriv->wowlan_ap_mode = _TRUE; ++ ++ rtw_suspend_common(padapter); ++ } else if (_rtw_memcmp(extra, "disable", 7)) { ++#ifdef CONFIG_USB_HCI ++ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); ++ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); ++#endif ++ rtw_resume_common(padapter); ++ } else { ++ RTW_INFO("[%s] Invalid Parameter.\n", __func__); ++ goto _rtw_ap_wowlan_ctrl_exit_free; ++ } ++ /* mutex_lock(&ioctl_mutex); */ ++_rtw_ap_wowlan_ctrl_exit_free: ++ RTW_INFO("-rtw_ap_wowlan_ctrl( subcode = %d)\n", poidparam.subcode); ++ RTW_PRINT("%s in %d ms\n", __func__, ++ rtw_get_passing_time_ms(start_time)); ++_rtw_ap_wowlan_ctrl_exit: ++ return ret; ++} ++#endif /* CONFIG_AP_WOWLAN */ ++ ++static int rtw_pm_set(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ unsigned mode = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_INFO("[%s] extra = %s\n", __FUNCTION__, extra); ++ ++ if (_rtw_memcmp(extra, "lps=", 4)) { ++ sscanf(extra + 4, "%u", &mode); ++ ret = rtw_pm_set_lps(padapter, mode); ++ } else if (_rtw_memcmp(extra, "ips=", 4)) { ++ sscanf(extra + 4, "%u", &mode); ++ ret = rtw_pm_set_ips(padapter, mode); ++ } else ++ ret = -EINVAL; ++ ++ return ret; ++} ++#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE ++ ++int rtw_vendor_ie_get(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0, vendor_ie_num = 0 , j , len = 0 , cmdlen; ++ char *pstring; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct iw_point *p; ++ u8 *ptmp; ++ u32 vendor_ie_mask = 0; ++ ++ p = &wrqu->data; ++ cmdlen = p->length; ++ if (0 == cmdlen) ++ return -EINVAL; ++ ++ ptmp = (u8 *)rtw_malloc(cmdlen); ++ if (NULL == ptmp) ++ return -ENOMEM; ++ ++ if (copy_from_user(ptmp, p->pointer, cmdlen)) { ++ ret = -EFAULT; ++ goto exit; ++ } ++ ret = sscanf(ptmp , "%d", &vendor_ie_num); ++ if (vendor_ie_num > WLAN_MAX_VENDOR_IE_NUM - 1) { ++ ret = -EFAULT; ++ goto exit; ++ } ++ vendor_ie_mask = pmlmepriv->vendor_ie_mask[vendor_ie_num]; ++ pstring = extra; ++ pstring += sprintf(pstring , "\nVendor IE num %d , Mask:%x " , vendor_ie_num , vendor_ie_mask); ++ ++ if (vendor_ie_mask & WIFI_BEACON_VENDOR_IE_BIT) ++ pstring += sprintf(pstring , "[Beacon]"); ++ if (vendor_ie_mask & WIFI_PROBEREQ_VENDOR_IE_BIT) ++ pstring += sprintf(pstring , "[Probe Req]"); ++ if (vendor_ie_mask & WIFI_PROBERESP_VENDOR_IE_BIT) ++ pstring += sprintf(pstring , "[Probe Resp]"); ++ if (vendor_ie_mask & WIFI_ASSOCREQ_VENDOR_IE_BIT) ++ pstring += sprintf(pstring , "[Assoc Req]"); ++ if (vendor_ie_mask & WIFI_ASSOCRESP_VENDOR_IE_BIT) ++ pstring += sprintf(pstring , "[Assoc Resp]"); ++ ++ pstring += sprintf(pstring , "\nVendor IE:\n"); ++ for (j = 0 ; j < pmlmepriv->vendor_ielen[vendor_ie_num] ; j++) ++ pstring += sprintf(pstring , "%02x" , pmlmepriv->vendor_ie[vendor_ie_num][j]); ++ ++ wrqu->data.length = pstring - extra; ++ ++exit: ++ rtw_mfree(ptmp, cmdlen); ++ ++ return 0; ++} ++ ++int rtw_vendor_ie_set(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0, i , len = 0 , totoal_ie_len = 0 , total_ie_len_byte = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u32 vendor_ie_mask = 0; ++ u32 vendor_ie_num = 0; ++ u32 id, elen; ++ ++ ret = sscanf(extra, "%d,%x,%*s", &vendor_ie_num , &vendor_ie_mask); ++ if (strrchr(extra , ',')) ++ extra = strrchr(extra , ',') + 1; ++ else ++ return -EINVAL; ++ totoal_ie_len = strlen(extra); ++ RTW_INFO("[%s] vendor_ie_num = %d , vendor_ie_mask = %x , vendor_ie = %s , len = %d\n", __func__ , vendor_ie_num , vendor_ie_mask , extra , totoal_ie_len); ++ ++ if (vendor_ie_num > WLAN_MAX_VENDOR_IE_NUM - 1) { ++ RTW_INFO("[%s] only support %d vendor ie\n", __func__ , WLAN_MAX_VENDOR_IE_NUM); ++ return -EFAULT; ++ } ++ ++ if (totoal_ie_len > WLAN_MAX_VENDOR_IE_LEN) { ++ RTW_INFO("[%s] Fail , not support ie length extend %d\n", __func__ , WLAN_MAX_VENDOR_IE_LEN); ++ return -EFAULT; ++ } ++ ++ if (vendor_ie_mask == 0) { ++ RTW_INFO("[%s] Clear vendor_ie_num %d group\n", __func__ , vendor_ie_num); ++ goto _clear_path; ++ } ++ ++ if (totoal_ie_len % 2 != 0) { ++ RTW_INFO("[%s] Fail , IE length = %zu is odd\n" , __func__ , strlen(extra)); ++ return -EFAULT; ++ } ++ ++ if (totoal_ie_len > 0) { ++ for (i = 0 ; i < strlen(extra) ; i += 2) { ++ pmlmepriv->vendor_ie[vendor_ie_num][len] = key_2char2num(extra[i] , extra[i + 1]); ++ if (len == 0) { ++ id = pmlmepriv->vendor_ie[vendor_ie_num][len]; ++ if (id != WLAN_EID_VENDOR_SPECIFIC) { ++ RTW_INFO("[%s] Fail , VENDOR SPECIFIC IE ID \"%x\" was not correct\n", __func__ , id); ++ goto _clear_path; ++ } ++ } else if (len == 1) { ++ total_ie_len_byte = (totoal_ie_len / 2) - 2; ++ elen = pmlmepriv->vendor_ie[vendor_ie_num][len]; ++ if (elen != total_ie_len_byte) { ++ RTW_INFO("[%s] Fail , Input IE length = \"%d\"(hex:%x) bytes , not match input total IE context length \"%d\" bytes\n", __func__ , elen , elen , ++ total_ie_len_byte); ++ goto _clear_path; ++ } ++ } ++ len++; ++ } ++ pmlmepriv->vendor_ielen[vendor_ie_num] = len; ++ } else ++ pmlmepriv->vendor_ielen[vendor_ie_num] = 0; ++ ++ ++ ++ if (vendor_ie_mask & WIFI_BEACON_VENDOR_IE_BIT) ++ RTW_INFO("[%s] Beacon append vendor ie\n", __func__); ++ if (vendor_ie_mask & WIFI_PROBEREQ_VENDOR_IE_BIT) ++ RTW_INFO("[%s] Probe Req append vendor ie\n", __func__); ++ if (vendor_ie_mask & WIFI_PROBERESP_VENDOR_IE_BIT) ++ RTW_INFO("[%s] Probe Resp append vendor ie\n", __func__); ++ if (vendor_ie_mask & WIFI_ASSOCREQ_VENDOR_IE_BIT) ++ RTW_INFO("[%s] Assoc Req append vendor ie\n", __func__); ++ if (vendor_ie_mask & WIFI_ASSOCRESP_VENDOR_IE_BIT) ++ RTW_INFO("[%s] Assoc Resp append vendor ie\n", __func__); ++ ++ pmlmepriv->vendor_ie_mask[vendor_ie_num] = vendor_ie_mask; ++ ++ return ret; ++ ++_clear_path: ++ _rtw_memset(pmlmepriv->vendor_ie[vendor_ie_num] , 0 , sizeof(u32) * WLAN_MAX_VENDOR_IE_LEN); ++ pmlmepriv->vendor_ielen[vendor_ie_num] = 0; ++ pmlmepriv->vendor_ie_mask[vendor_ie_num] = 0; ++ return -EFAULT; ++} ++#endif ++ ++static int rtw_mp_efuse_get(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wdata, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ PEFUSE_HAL pEfuseHal; ++ struct iw_point *wrqu; ++ ++ u8 *PROMContent = pHalData->efuse_eeprom_data; ++ u8 ips_mode = IPS_NUM; /* init invalid value */ ++ u8 lps_mode = PS_MODE_NUM; /* init invalid value */ ++ struct pwrctrl_priv *pwrctrlpriv ; ++ u8 *data = NULL; ++ u8 *rawdata = NULL; ++ char *pch, *ptmp, *token, *tmp[3] = {0x00, 0x00, 0x00}; ++ u16 i = 0, j = 0, mapLen = 0, addr = 0, cnts = 0; ++ u16 max_available_len = 0, raw_cursize = 0, raw_maxsize = 0; ++ u16 mask_len; ++ u8 mask_buf[64] = ""; ++ int err; ++#ifdef CONFIG_IOL ++ u8 org_fw_iol = padapter->registrypriv.fw_iol;/* 0:Disable, 1:enable, 2:by usb speed */ ++#endif ++ ++ wrqu = (struct iw_point *)wdata; ++ pwrctrlpriv = adapter_to_pwrctl(padapter); ++ pEfuseHal = &pHalData->EfuseHal; ++ ++ err = 0; ++ data = rtw_zmalloc(EFUSE_BT_MAX_MAP_LEN); ++ if (data == NULL) { ++ err = -ENOMEM; ++ goto exit; ++ } ++ rawdata = rtw_zmalloc(EFUSE_BT_MAX_MAP_LEN); ++ if (rawdata == NULL) { ++ err = -ENOMEM; ++ goto exit; ++ } ++ ++ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) { ++ err = -EFAULT; ++ goto exit; ++ } ++#ifdef CONFIG_LPS ++ lps_mode = pwrctrlpriv->power_mgnt;/* keep org value */ ++ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); ++#endif ++ ++#ifdef CONFIG_IPS ++ ips_mode = pwrctrlpriv->ips_mode;/* keep org value */ ++ rtw_pm_set_ips(padapter, IPS_NONE); ++#endif ++ ++ pch = extra; ++ RTW_INFO("%s: in=%s\n", __FUNCTION__, extra); ++ ++ i = 0; ++ /* mac 16 "00e04c871200" rmap,00,2 */ ++ while ((token = strsep(&pch, ",")) != NULL) { ++ if (i > 2) ++ break; ++ tmp[i] = token; ++ i++; ++ } ++#ifdef CONFIG_IOL ++ padapter->registrypriv.fw_iol = 0;/* 0:Disable, 1:enable, 2:by usb speed */ ++#endif ++ ++ if (strcmp(tmp[0], "status") == 0) { ++ sprintf(extra, "Load File efuse=%s,Load File MAC=%s" ++ , pHalData->efuse_file_status == EFUSE_FILE_FAILED ? "FAIL" : "OK" ++ , pHalData->macaddr_file_status == MACADDR_FILE_FAILED ? "FAIL" : "OK" ++ ); ++ goto exit; ++ } else if (strcmp(tmp[0], "drvmap") == 0) { ++ static u8 drvmaporder = 0; ++ u8 *efuse; ++ u32 shift, cnt; ++ u32 blksz = 0x200; /* The size of one time show, default 512 */ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, _FALSE); ++ ++ efuse = pHalData->efuse_eeprom_data; ++ ++ shift = blksz * drvmaporder; ++ efuse += shift; ++ cnt = mapLen - shift; ++ ++ if (cnt > blksz) { ++ cnt = blksz; ++ drvmaporder++; ++ } else ++ drvmaporder = 0; ++ ++ sprintf(extra, "\n"); ++ for (i = 0; i < cnt; i += 16) { ++ sprintf(extra, "%s0x%02x\t", extra, shift + i); ++ for (j = 0; j < 8; j++) ++ sprintf(extra, "%s%02X ", extra, efuse[i + j]); ++ sprintf(extra, "%s\t", extra); ++ for (; j < 16; j++) ++ sprintf(extra, "%s%02X ", extra, efuse[i + j]); ++ sprintf(extra, "%s\n", extra); ++ } ++ if ((shift + cnt) < mapLen) ++ sprintf(extra, "%s\t...more (left:%d/%d)\n", extra, mapLen-(shift + cnt), mapLen); ++ ++ } else if (strcmp(tmp[0], "realmap") == 0) { ++ static u8 order = 0; ++ u8 *efuse; ++ u32 shift, cnt; ++ u32 blksz = 0x200; /* The size of one time show, default 512 */ ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&mapLen, _FALSE); ++ efuse = pEfuseHal->fakeEfuseInitMap; ++ if (rtw_efuse_mask_map_read(padapter, 0, mapLen, efuse) == _FAIL) { ++ RTW_INFO("%s: read realmap Fail!!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++#if 0 ++ RTW_INFO("OFFSET\tVALUE(hex)\n"); ++ for (i = 0; i < mapLen; i += 16) { ++ RTW_INFO("0x%02x\t", i); ++ for (j = 0; j < 8; j++) ++ RTW_INFO("%02X ", efuse[i + j]); ++ RTW_INFO("\t"); ++ for (; j < 16; j++) ++ RTW_INFO("%02X ", efuse[i + j]); ++ RTW_INFO("\n"); ++ } ++ RTW_INFO("\n"); ++#endif ++ ++ shift = blksz * order; ++ efuse += shift; ++ cnt = mapLen - shift; ++ if (cnt > blksz) { ++ cnt = blksz; ++ order++; ++ } else ++ order = 0; ++ ++ sprintf(extra, "\n"); ++ for (i = 0; i < cnt; i += 16) { ++ sprintf(extra, "%s0x%02x\t", extra, shift + i); ++ for (j = 0; j < 8; j++) ++ sprintf(extra, "%s%02X ", extra, efuse[i + j]); ++ sprintf(extra, "%s\t", extra); ++ for (; j < 16; j++) ++ sprintf(extra, "%s%02X ", extra, efuse[i + j]); ++ sprintf(extra, "%s\n", extra); ++ } ++ if ((shift + cnt) < mapLen) ++ sprintf(extra, "%s\t...more\n", extra); ++ } else if (strcmp(tmp[0], "rmap") == 0) { ++ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { ++ RTW_INFO("%s: rmap Fail!! Parameters error!\n", __FUNCTION__); ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ /* rmap addr cnts */ ++ addr = simple_strtoul(tmp[1], &ptmp, 16); ++ RTW_INFO("%s: addr=%x\n", __FUNCTION__, addr); ++ ++ cnts = simple_strtoul(tmp[2], &ptmp, 10); ++ if (cnts == 0) { ++ RTW_INFO("%s: rmap Fail!! cnts error!\n", __FUNCTION__); ++ err = -EINVAL; ++ goto exit; ++ } ++ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (PVOID)&max_available_len, _FALSE); ++ if ((addr + cnts) > max_available_len) { ++ RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ if (rtw_efuse_mask_map_read(padapter, addr, cnts, data) == _FAIL) { ++ RTW_INFO("%s: rtw_efuse_mask_map_read error!\n", __func__); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ /* RTW_INFO("%s: data={", __FUNCTION__); */ ++ *extra = 0; ++ for (i = 0; i < cnts; i++) { ++ /* RTW_INFO("0x%02x ", data[i]); */ ++ sprintf(extra, "%s0x%02X ", extra, data[i]); ++ } ++ /* RTW_INFO("}\n"); */ ++ } else if (strcmp(tmp[0], "realraw") == 0) { ++ addr = 0; ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN , (PVOID)&mapLen, _FALSE); ++ RTW_INFO("EFUSE_MAX_SIZE = %d\n", EFUSE_MAX_SIZE); ++ ++ if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) { ++ RTW_INFO("%s: rtw_efuse_access Fail!!\n", __func__); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ if (mapLen >= 512) ++ mapLen = 512; ++ ++ _rtw_memset(extra, '\0', strlen(extra)); ++ ++ sprintf(extra, "\n0x00\t"); ++ ++ for (i = 0; i < mapLen ; i++) { ++ sprintf(extra, "%s%02X", extra, rawdata[i]); ++ if ((i & 0xF) == 0xF) { ++ sprintf(extra, "%s\n", extra); ++ sprintf(extra, "%s0x%02x\t", extra, i + 1); ++ } else if ((i & 0x7) == 0x7) ++ sprintf(extra, "%s \t", extra); ++ else ++ sprintf(extra, "%s ", extra); ++ } ++ ++ } else if (strcmp(tmp[0], "realrawb") == 0) { ++ addr = 0; ++ mapLen = EFUSE_MAX_SIZE; ++ RTW_INFO("EFUSE_MAX_SIZE =%d\n", EFUSE_MAX_SIZE); ++ if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) { ++ RTW_INFO("%s: rtw_efuse_access Fail!!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++ _rtw_memset(extra, '\0', strlen(extra)); ++ /* RTW_INFO("%s: realraw={\n", __FUNCTION__); */ ++ sprintf(extra, "\n0x00\t"); ++ for (i = 512; i < mapLen; i++) { ++ /* RTW_INFO("%02X", rawdata[i]); */ ++ sprintf(extra, "%s%02X", extra, rawdata[i]); ++ if ((i & 0xF) == 0xF) { ++ /* RTW_INFO("\n"); */ ++ sprintf(extra, "%s\n", extra); ++ sprintf(extra, "%s0x%02x\t", extra, i + 1); ++ } else if ((i & 0x7) == 0x7) { ++ /* RTW_INFO("\t"); */ ++ sprintf(extra, "%s \t", extra); ++ } else { ++ /* RTW_INFO(" "); */ ++ sprintf(extra, "%s ", extra); ++ } ++ } ++ /* RTW_INFO("}\n"); */ ++ } else if (strcmp(tmp[0], "mac") == 0) { ++ if (hal_efuse_macaddr_offset(padapter) == -1) { ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ addr = hal_efuse_macaddr_offset(padapter); ++ cnts = 6; ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); ++ if ((addr + cnts) > max_available_len) { ++ RTW_INFO("%s: addr(0x%02x)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ if (rtw_efuse_mask_map_read(padapter, addr, cnts, data) == _FAIL) { ++ RTW_INFO("%s: rtw_efuse_mask_map_read error!\n", __func__); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ /* RTW_INFO("%s: MAC address={", __FUNCTION__); */ ++ *extra = 0; ++ for (i = 0; i < cnts; i++) { ++ /* RTW_INFO("%02X", data[i]); */ ++ sprintf(extra, "%s%02X", extra, data[i]); ++ if (i != (cnts - 1)) { ++ /* RTW_INFO(":"); */ ++ sprintf(extra, "%s:", extra); ++ } ++ } ++ /* RTW_INFO("}\n"); */ ++ } else if (strcmp(tmp[0], "vidpid") == 0) { ++#ifdef CONFIG_RTL8188E ++#ifdef CONFIG_USB_HCI ++ addr = EEPROM_VID_88EU; ++#endif ++#ifdef CONFIG_PCI_HCI ++ addr = EEPROM_VID_88EE; ++#endif ++#endif /* CONFIG_RTL8188E */ ++ ++#ifdef CONFIG_RTL8192E ++#ifdef CONFIG_USB_HCI ++ addr = EEPROM_VID_8192EU; ++#endif ++#ifdef CONFIG_PCI_HCI ++ addr = EEPROM_VID_8192EE; ++#endif ++#endif /* CONFIG_RTL8192E */ ++#ifdef CONFIG_RTL8723B ++ addr = EEPROM_VID_8723BU; ++#endif /* CONFIG_RTL8192E */ ++ ++#ifdef CONFIG_RTL8188F ++ addr = EEPROM_VID_8188FU; ++#endif /* CONFIG_RTL8188F */ ++ ++#ifdef CONFIG_RTL8703B ++#ifdef CONFIG_USB_HCI ++ addr = EEPROM_VID_8703BU; ++#endif ++#endif /* CONFIG_RTL8703B */ ++ ++#ifdef CONFIG_RTL8723D ++#ifdef CONFIG_USB_HCI ++ addr = EEPROM_VID_8723DU; ++#endif /* CONFIG_USB_HCI */ ++#endif /* CONFIG_RTL8723D */ ++ ++ cnts = 4; ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); ++ if ((addr + cnts) > max_available_len) { ++ RTW_INFO("%s: addr(0x%02x)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); ++ err = -EFAULT; ++ goto exit; ++ } ++ if (rtw_efuse_mask_map_read(padapter, addr, cnts, data) == _FAIL) { ++ RTW_INFO("%s: rtw_efuse_access error!!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ /* RTW_INFO("%s: {VID,PID}={", __FUNCTION__); */ ++ *extra = 0; ++ for (i = 0; i < cnts; i++) { ++ /* RTW_INFO("0x%02x", data[i]); */ ++ sprintf(extra, "%s0x%02X", extra, data[i]); ++ if (i != (cnts - 1)) { ++ /* RTW_INFO(","); */ ++ sprintf(extra, "%s,", extra); ++ } ++ } ++ /* RTW_INFO("}\n"); */ ++ } else if (strcmp(tmp[0], "ableraw") == 0) { ++ efuse_GetCurrentSize(padapter, &raw_cursize); ++ raw_maxsize = efuse_GetMaxSize(padapter); ++ sprintf(extra, "[available raw size]= %d bytes\n", raw_maxsize - raw_cursize); ++ } else if (strcmp(tmp[0], "btableraw") == 0) { ++ efuse_bt_GetCurrentSize(padapter, &raw_cursize); ++ raw_maxsize = efuse_bt_GetMaxSize(padapter); ++ sprintf(extra, "[available raw size]= %d bytes\n", raw_maxsize - raw_cursize); ++ } else if (strcmp(tmp[0], "btfmap") == 0) { ++ ++ BTEfuse_PowerSwitch(padapter, 1, _TRUE); ++ ++ mapLen = EFUSE_BT_MAX_MAP_LEN; ++ if (rtw_BT_efuse_map_read(padapter, 0, mapLen, pEfuseHal->BTEfuseInitMap) == _FAIL) { ++ RTW_INFO("%s: rtw_BT_efuse_map_read Fail!!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ /* RTW_INFO("OFFSET\tVALUE(hex)\n"); */ ++ sprintf(extra, "\n"); ++ for (i = 0; i < 512; i += 16) { /* set 512 because the iwpriv's extra size have limit 0x7FF */ ++ /* RTW_INFO("0x%03x\t", i); */ ++ sprintf(extra, "%s0x%03x\t", extra, i); ++ for (j = 0; j < 8; j++) { ++ /* RTW_INFO("%02X ", pEfuseHal->BTEfuseInitMap[i+j]); */ ++ sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i + j]); ++ } ++ /* RTW_INFO("\t"); */ ++ sprintf(extra, "%s\t", extra); ++ for (; j < 16; j++) { ++ /* RTW_INFO("%02X ", pEfuseHal->BTEfuseInitMap[i+j]); */ ++ sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i + j]); ++ } ++ /* RTW_INFO("\n"); */ ++ sprintf(extra, "%s\n", extra); ++ } ++ /* RTW_INFO("\n"); */ ++ } else if (strcmp(tmp[0], "btbmap") == 0) { ++ BTEfuse_PowerSwitch(padapter, 1, _TRUE); ++ ++ mapLen = EFUSE_BT_MAX_MAP_LEN; ++ if (rtw_BT_efuse_map_read(padapter, 0, mapLen, pEfuseHal->BTEfuseInitMap) == _FAIL) { ++ RTW_INFO("%s: rtw_BT_efuse_map_read Fail!!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ /* RTW_INFO("OFFSET\tVALUE(hex)\n"); */ ++ sprintf(extra, "\n"); ++ for (i = 512; i < 1024 ; i += 16) { ++ /* RTW_INFO("0x%03x\t", i); */ ++ sprintf(extra, "%s0x%03x\t", extra, i); ++ for (j = 0; j < 8; j++) { ++ /* RTW_INFO("%02X ", data[i+j]); */ ++ sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i + j]); ++ } ++ /* RTW_INFO("\t"); */ ++ sprintf(extra, "%s\t", extra); ++ for (; j < 16; j++) { ++ /* RTW_INFO("%02X ", data[i+j]); */ ++ sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i + j]); ++ } ++ /* RTW_INFO("\n"); */ ++ sprintf(extra, "%s\n", extra); ++ } ++ /* RTW_INFO("\n"); */ ++ } else if (strcmp(tmp[0], "btrmap") == 0) { ++ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ BTEfuse_PowerSwitch(padapter, 1, _TRUE); ++ ++ /* rmap addr cnts */ ++ addr = simple_strtoul(tmp[1], &ptmp, 16); ++ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); ++ ++ cnts = simple_strtoul(tmp[2], &ptmp, 10); ++ if (cnts == 0) { ++ RTW_INFO("%s: btrmap Fail!! cnts error!\n", __FUNCTION__); ++ err = -EINVAL; ++ goto exit; ++ } ++ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); ++ if ((addr + cnts) > max_available_len) { ++ RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ if (rtw_BT_efuse_map_read(padapter, addr, cnts, data) == _FAIL) { ++ RTW_INFO("%s: rtw_BT_efuse_map_read error!!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ *extra = 0; ++ /* RTW_INFO("%s: bt efuse data={", __FUNCTION__); */ ++ for (i = 0; i < cnts; i++) { ++ /* RTW_INFO("0x%02x ", data[i]); */ ++ sprintf(extra, "%s 0x%02X ", extra, data[i]); ++ } ++ /* RTW_INFO("}\n"); */ ++ RTW_INFO(FUNC_ADPT_FMT ": BT MAC=[%s]\n", FUNC_ADPT_ARG(padapter), extra); ++ } else if (strcmp(tmp[0], "btffake") == 0) { ++ /* RTW_INFO("OFFSET\tVALUE(hex)\n"); */ ++ sprintf(extra, "\n"); ++ for (i = 0; i < 512; i += 16) { ++ /* RTW_INFO("0x%03x\t", i); */ ++ sprintf(extra, "%s0x%03x\t", extra, i); ++ for (j = 0; j < 8; j++) { ++ /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ ++ sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i + j]); ++ } ++ /* RTW_INFO("\t"); */ ++ sprintf(extra, "%s\t", extra); ++ for (; j < 16; j++) { ++ /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ ++ sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i + j]); ++ } ++ /* RTW_INFO("\n"); */ ++ sprintf(extra, "%s\n", extra); ++ } ++ /* RTW_INFO("\n"); */ ++ } else if (strcmp(tmp[0], "btbfake") == 0) { ++ /* RTW_INFO("OFFSET\tVALUE(hex)\n"); */ ++ sprintf(extra, "\n"); ++ for (i = 512; i < 1024; i += 16) { ++ /* RTW_INFO("0x%03x\t", i); */ ++ sprintf(extra, "%s0x%03x\t", extra, i); ++ for (j = 0; j < 8; j++) { ++ /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ ++ sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i + j]); ++ } ++ /* RTW_INFO("\t"); */ ++ sprintf(extra, "%s\t", extra); ++ for (; j < 16; j++) { ++ /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ ++ sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i + j]); ++ } ++ /* RTW_INFO("\n"); */ ++ sprintf(extra, "%s\n", extra); ++ } ++ /* RTW_INFO("\n"); */ ++ } else if (strcmp(tmp[0], "wlrfkmap") == 0) { ++ static u8 fk_order = 0; ++ u8 *efuse; ++ u32 shift, cnt; ++ u32 blksz = 0x200; /* The size of one time show, default 512 */ ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&mapLen, _FALSE); ++ efuse = pEfuseHal->fakeEfuseModifiedMap; ++ ++ shift = blksz * fk_order; ++ efuse += shift; ++ cnt = mapLen - shift; ++ if (cnt > blksz) { ++ cnt = blksz; ++ fk_order++; ++ } else ++ fk_order = 0; ++ ++ sprintf(extra, "\n"); ++ for (i = 0; i < cnt; i += 16) { ++ sprintf(extra, "%s0x%02x\t", extra, shift + i); ++ for (j = 0; j < 8; j++) ++ sprintf(extra, "%s%02X ", extra, efuse[i + j]); ++ sprintf(extra, "%s\t", extra); ++ for (; j < 16; j++) ++ sprintf(extra, "%s%02X ", extra, efuse[i + j]); ++ sprintf(extra, "%s\n", extra); ++ } ++ if ((shift + cnt) < mapLen) ++ sprintf(extra, "%s\t...more\n", extra); ++ ++ } else if (strcmp(tmp[0], "wlrfkrmap") == 0) { ++ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { ++ RTW_INFO("%s: rmap Fail!! Parameters error!\n", __FUNCTION__); ++ err = -EINVAL; ++ goto exit; ++ } ++ /* rmap addr cnts */ ++ addr = simple_strtoul(tmp[1], &ptmp, 16); ++ RTW_INFO("%s: addr=%x\n", __FUNCTION__, addr); ++ ++ cnts = simple_strtoul(tmp[2], &ptmp, 10); ++ if (cnts == 0) { ++ RTW_INFO("%s: rmap Fail!! cnts error!\n", __FUNCTION__); ++ err = -EINVAL; ++ goto exit; ++ } ++ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); ++ ++ /* RTW_INFO("%s: data={", __FUNCTION__); */ ++ *extra = 0; ++ for (i = 0; i < cnts; i++) { ++ RTW_INFO("wlrfkrmap = 0x%02x\n", pEfuseHal->fakeEfuseModifiedMap[addr + i]); ++ sprintf(extra, "%s0x%02X ", extra, pEfuseHal->fakeEfuseModifiedMap[addr + i]); ++ } ++ } else if (strcmp(tmp[0], "btrfkrmap") == 0) { ++ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { ++ RTW_INFO("%s: rmap Fail!! Parameters error!\n", __FUNCTION__); ++ err = -EINVAL; ++ goto exit; ++ } ++ /* rmap addr cnts */ ++ addr = simple_strtoul(tmp[1], &ptmp, 16); ++ RTW_INFO("%s: addr=%x\n", __FUNCTION__, addr); ++ ++ cnts = simple_strtoul(tmp[2], &ptmp, 10); ++ if (cnts == 0) { ++ RTW_INFO("%s: rmap Fail!! cnts error!\n", __FUNCTION__); ++ err = -EINVAL; ++ goto exit; ++ } ++ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); ++ ++ /* RTW_INFO("%s: data={", __FUNCTION__); */ ++ *extra = 0; ++ for (i = 0; i < cnts; i++) { ++ RTW_INFO("wlrfkrmap = 0x%02x\n", pEfuseHal->fakeBTEfuseModifiedMap[addr + i]); ++ sprintf(extra, "%s0x%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[addr + i]); ++ } ++ } else if (strcmp(tmp[0], "mask") == 0) { ++ *extra = 0; ++ mask_len = sizeof(u8) * rtw_get_efuse_mask_arraylen(padapter); ++ rtw_efuse_mask_array(padapter, mask_buf); ++ ++ if (padapter->registrypriv.bFileMaskEfuse == _TRUE) ++ _rtw_memcpy(mask_buf, maskfileBuffer, mask_len); ++ ++ sprintf(extra, "\n"); ++ for (i = 0; i < mask_len; i++) ++ sprintf(extra, "%s0x%02X\n", extra, mask_buf[i]); ++ ++ } else ++ sprintf(extra, "Command not found!"); ++ ++exit: ++ if (data) ++ rtw_mfree(data, EFUSE_BT_MAX_MAP_LEN); ++ if (rawdata) ++ rtw_mfree(rawdata, EFUSE_BT_MAX_MAP_LEN); ++ if (!err) ++ wrqu->length = strlen(extra); ++ ++ if (padapter->registrypriv.mp_mode == 0) { ++#ifdef CONFIG_IPS ++ rtw_pm_set_ips(padapter, ips_mode); ++#endif /* CONFIG_IPS */ ++ ++#ifdef CONFIG_LPS ++ rtw_pm_set_lps(padapter, lps_mode); ++#endif /* CONFIG_LPS */ ++ } ++ ++#ifdef CONFIG_IOL ++ padapter->registrypriv.fw_iol = org_fw_iol;/* 0:Disable, 1:enable, 2:by usb speed */ ++#endif ++ return err; ++} ++ ++static int rtw_mp_efuse_set(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wdata, char *extra) ++{ ++ struct iw_point *wrqu; ++ PADAPTER padapter; ++ struct pwrctrl_priv *pwrctrlpriv ; ++ PHAL_DATA_TYPE pHalData; ++ PEFUSE_HAL pEfuseHal; ++ struct hal_ops *pHalFunc; ++ struct mp_priv *pmp_priv; ++ ++ u8 ips_mode = IPS_NUM; /* init invalid value */ ++ u8 lps_mode = PS_MODE_NUM; /* init invalid value */ ++ u32 i = 0, j = 0, jj, kk; ++ u8 *setdata = NULL; ++ u8 *ShadowMapBT = NULL; ++ u8 *ShadowMapWiFi = NULL; ++ u8 *setrawdata = NULL; ++ char *pch, *ptmp, *token, *tmp[3] = {0x00, 0x00, 0x00}; ++ u16 addr = 0xFF, cnts = 0, BTStatus = 0 , max_available_len = 0; ++ u16 wifimaplen; ++ int err; ++ ++ wrqu = (struct iw_point *)wdata; ++ padapter = rtw_netdev_priv(dev); ++ pwrctrlpriv = adapter_to_pwrctl(padapter); ++ pHalData = GET_HAL_DATA(padapter); ++ pEfuseHal = &pHalData->EfuseHal; ++ pHalFunc = &padapter->HalFunc; ++ pmp_priv = &padapter->mppriv; ++ ++ err = 0; ++ ++ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&wifimaplen, _FALSE); ++ ++ setdata = rtw_zmalloc(1024); ++ if (setdata == NULL) { ++ err = -ENOMEM; ++ goto exit; ++ } ++ ShadowMapBT = rtw_malloc(EFUSE_BT_MAX_MAP_LEN); ++ if (ShadowMapBT == NULL) { ++ err = -ENOMEM; ++ goto exit; ++ } ++ ShadowMapWiFi = rtw_malloc(wifimaplen); ++ if (ShadowMapWiFi == NULL) { ++ err = -ENOMEM; ++ goto exit; ++ } ++ setrawdata = rtw_malloc(EFUSE_MAX_SIZE); ++ if (setrawdata == NULL) { ++ err = -ENOMEM; ++ goto exit; ++ } ++ ++#ifdef CONFIG_LPS ++ lps_mode = pwrctrlpriv->power_mgnt;/* keep org value */ ++ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); ++#endif ++ ++#ifdef CONFIG_IPS ++ ips_mode = pwrctrlpriv->ips_mode;/* keep org value */ ++ rtw_pm_set_ips(padapter, IPS_NONE); ++#endif ++ ++ pch = extra; ++ RTW_INFO("%s: in=%s\n", __FUNCTION__, extra); ++ ++ i = 0; ++ while ((token = strsep(&pch, ",")) != NULL) { ++ if (i > 2) ++ break; ++ tmp[i] = token; ++ i++; ++ } ++ ++ /* tmp[0],[1],[2] */ ++ /* wmap,addr,00e04c871200 */ ++ if (strcmp(tmp[0], "wmap") == 0) { ++ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++#ifndef RTW_HALMAC ++ /* unknown bug workaround, need to fix later */ ++ addr = 0x1ff; ++ rtw_write8(padapter, EFUSE_CTRL + 1, (addr & 0xff)); ++ rtw_msleep_os(10); ++ rtw_write8(padapter, EFUSE_CTRL + 2, ((addr >> 8) & 0x03)); ++ rtw_msleep_os(10); ++ rtw_write8(padapter, EFUSE_CTRL + 3, 0x72); ++ rtw_msleep_os(10); ++ rtw_read8(padapter, EFUSE_CTRL); ++#endif /* RTW_HALMAC */ ++ ++ addr = simple_strtoul(tmp[1], &ptmp, 16); ++ addr &= 0xFFF; ++ ++ cnts = strlen(tmp[2]); ++ if (cnts % 2) { ++ err = -EINVAL; ++ goto exit; ++ } ++ cnts /= 2; ++ if (cnts == 0) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); ++ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); ++ RTW_INFO("%s: map data=%s\n", __FUNCTION__, tmp[2]); ++ ++ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) ++ setdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]); ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); ++ ++ if ((addr + cnts) > max_available_len) { ++ RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ if (rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) { ++ RTW_INFO("%s: rtw_efuse_map_write error!!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++ *extra = 0; ++ RTW_INFO("%s: after rtw_efuse_map_write to _rtw_memcmp\n", __func__); ++ if (rtw_efuse_mask_map_read(padapter, addr, cnts, ShadowMapWiFi) == _SUCCESS) { ++ if (_rtw_memcmp((void *)ShadowMapWiFi , (void *)setdata, cnts)) { ++ RTW_INFO("%s: WiFi write map afterf compare success\n", __FUNCTION__); ++ sprintf(extra, "WiFi write map compare OK\n"); ++ err = 0; ++ goto exit; ++ } else { ++ sprintf(extra, "WiFi write map compare FAIL\n"); ++ RTW_INFO("%s: WiFi write map compare Fail\n", __FUNCTION__); ++ err = 0; ++ goto exit; ++ } ++ } ++ } else if (strcmp(tmp[0], "wraw") == 0) { ++ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ addr = simple_strtoul(tmp[1], &ptmp, 16); ++ addr &= 0xFFF; ++ ++ cnts = strlen(tmp[2]); ++ if (cnts % 2) { ++ err = -EINVAL; ++ goto exit; ++ } ++ cnts /= 2; ++ if (cnts == 0) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); ++ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); ++ RTW_INFO("%s: raw data=%s\n", __FUNCTION__, tmp[2]); ++ ++ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) ++ setrawdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]); ++ ++ if (rtw_efuse_access(padapter, _TRUE, addr, cnts, setrawdata) == _FAIL) { ++ RTW_INFO("%s: rtw_efuse_access error!!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++ } else if (strcmp(tmp[0], "btwraw") == 0) { ++ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ addr = simple_strtoul(tmp[1], &ptmp, 16); ++ addr &= 0xFFF; ++ ++ cnts = strlen(tmp[2]); ++ if (cnts % 2) { ++ err = -EINVAL; ++ goto exit; ++ } ++ cnts /= 2; ++ if (cnts == 0) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); ++ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); ++ RTW_INFO("%s: raw data=%s\n", __FUNCTION__, tmp[2]); ++ ++ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) ++ setrawdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]); ++#ifdef RTW_HALMAC ++ if (rtw_efuse_bt_access(padapter, _TRUE, addr, cnts, setrawdata) == _FAIL) { ++ RTW_INFO("%s: rtw_efuse_access error!!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++#else ++ rtw_write8(padapter, 0x35, 1); /* switch bank 1 (BT)*/ ++ if (rtw_efuse_access(padapter, _TRUE, addr, cnts, setrawdata) == _FAIL) { ++ RTW_INFO("%s: rtw_efuse_access error!!\n", __FUNCTION__); ++ rtw_write8(padapter, 0x35, 0); /* switch bank 0 (WiFi)*/ ++ err = -EFAULT; ++ goto exit; ++ } ++ rtw_write8(padapter, 0x35, 0); /* switch bank 0 (WiFi)*/ ++#endif ++ } else if (strcmp(tmp[0], "mac") == 0) { ++ if (tmp[1] == NULL) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ /* mac,00e04c871200 */ ++ ++ if (hal_efuse_macaddr_offset(padapter) == -1) { ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ addr = hal_efuse_macaddr_offset(padapter); ++ cnts = strlen(tmp[1]); ++ if (cnts % 2) { ++ err = -EINVAL; ++ goto exit; ++ } ++ cnts /= 2; ++ if (cnts == 0) { ++ err = -EINVAL; ++ goto exit; ++ } ++ if (cnts > 6) { ++ RTW_INFO("%s: error data for mac addr=\"%s\"\n", __FUNCTION__, tmp[1]); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); ++ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); ++ RTW_INFO("%s: MAC address=%s\n", __FUNCTION__, tmp[1]); ++ ++ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) ++ setdata[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); ++ ++ if ((addr + cnts) > max_available_len) { ++ RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ if (rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) { ++ RTW_INFO("%s: rtw_efuse_map_write error!!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++ } else if (strcmp(tmp[0], "vidpid") == 0) { ++ if (tmp[1] == NULL) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ /* pidvid,da0b7881 */ ++#ifdef CONFIG_RTL8188E ++#ifdef CONFIG_USB_HCI ++ addr = EEPROM_VID_88EU; ++#endif ++#ifdef CONFIG_PCI_HCI ++ addr = EEPROM_VID_88EE; ++#endif ++#endif /* CONFIG_RTL8188E */ ++ ++#ifdef CONFIG_RTL8192E ++#ifdef CONFIG_USB_HCI ++ addr = EEPROM_VID_8192EU; ++#endif ++#ifdef CONFIG_PCI_HCI ++ addr = EEPROM_VID_8192EE; ++#endif ++#endif /* CONFIG_RTL8188E */ ++ ++#ifdef CONFIG_RTL8723B ++ addr = EEPROM_VID_8723BU; ++#endif ++ ++#ifdef CONFIG_RTL8188F ++ addr = EEPROM_VID_8188FU; ++#endif ++ ++#ifdef CONFIG_RTL8703B ++#ifdef CONFIG_USB_HCI ++ addr = EEPROM_VID_8703BU; ++#endif /* CONFIG_USB_HCI */ ++#endif /* CONFIG_RTL8703B */ ++ ++#ifdef CONFIG_RTL8723D ++#ifdef CONFIG_USB_HCI ++ addr = EEPROM_VID_8723DU; ++#endif /* CONFIG_USB_HCI */ ++#endif /* CONFIG_RTL8723D */ ++ ++ cnts = strlen(tmp[1]); ++ if (cnts % 2) { ++ err = -EINVAL; ++ goto exit; ++ } ++ cnts /= 2; ++ if (cnts == 0) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); ++ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); ++ RTW_INFO("%s: VID/PID=%s\n", __FUNCTION__, tmp[1]); ++ ++ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) ++ setdata[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); ++ if ((addr + cnts) > max_available_len) { ++ RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ if (rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) { ++ RTW_INFO("%s: rtw_efuse_map_write error!!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++ } else if (strcmp(tmp[0], "wldumpfake") == 0) { ++ if (wifimaplen > EFUSE_MAX_MAP_LEN) ++ cnts = EFUSE_MAX_MAP_LEN; ++ else ++ cnts = wifimaplen; ++ if (rtw_efuse_mask_map_read(padapter, 0, cnts, pEfuseHal->fakeEfuseModifiedMap) == _SUCCESS) ++ RTW_INFO("%s: WiFi hw efuse dump to Fake map success\n", __func__); ++ else { ++ RTW_INFO("%s: WiFi hw efuse dump to Fake map Fail\n", __func__); ++ err = -EFAULT; ++ } ++ } else if (strcmp(tmp[0], "btwmap") == 0) { ++ rtw_write8(padapter, 0xa3, 0x05); /* For 8723AB ,8821S ? */ ++ BTStatus = rtw_read8(padapter, 0xa0); ++ RTW_INFO("%s: btwmap before read 0xa0 BT Status =0x%x\n", __FUNCTION__, BTStatus); ++ if (BTStatus != 0x04) { ++ sprintf(extra, "BT Status not Active ,can't do Write\n"); ++ goto exit; ++ } ++ ++ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++#ifndef RTW_HALMAC ++ BTEfuse_PowerSwitch(padapter, 1, _TRUE); ++ addr = 0x1ff; ++ rtw_write8(padapter, EFUSE_CTRL + 1, (addr & 0xff)); ++ rtw_msleep_os(10); ++ rtw_write8(padapter, EFUSE_CTRL + 2, ((addr >> 8) & 0x03)); ++ rtw_msleep_os(10); ++ rtw_write8(padapter, EFUSE_CTRL + 3, 0x72); ++ rtw_msleep_os(10); ++ rtw_read8(padapter, EFUSE_CTRL); ++ BTEfuse_PowerSwitch(padapter, 1, _FALSE); ++#endif /* RTW_HALMAC */ ++ ++ addr = simple_strtoul(tmp[1], &ptmp, 16); ++ addr &= 0xFFF; ++ ++ cnts = strlen(tmp[2]); ++ if (cnts % 2) { ++ err = -EINVAL; ++ goto exit; ++ } ++ cnts /= 2; ++ if (cnts == 0) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); ++ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); ++ RTW_INFO("%s: BT data=%s\n", __FUNCTION__, tmp[2]); ++ ++ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) ++ setdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]); ++#ifdef CONFIG_RTL8703B ++ if (cnts == 1 && addr == 0x189) { ++ setdata[1] = setdata[0]; ++ setdata[0] = 0x00; ++ cnts += 1; ++ addr = 0x188; ++ RTW_INFO("addr 0x%x ,setdata=0x%X 0x%X\n", addr, setdata[0], setdata[1]); ++ } else if (cnts == 1 && addr == 0x161) { ++ setdata[1] = setdata[0]; ++ setdata[0] = 0xFE; ++ cnts += 1; ++ addr = 0x160; ++ RTW_INFO("addr 0x%x ,setdata=0x%X 0x%X\n", addr, setdata[0], setdata[1]); ++ } ++#endif ++#ifndef RTW_HALMAC ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); ++ if ((addr + cnts) > max_available_len) { ++ RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); ++ err = -EFAULT; ++ goto exit; ++ } ++#endif ++ if (rtw_BT_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) { ++ RTW_INFO("%s: rtw_BT_efuse_map_write error!!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++ *extra = 0; ++ RTW_INFO("%s: after rtw_BT_efuse_map_write to _rtw_memcmp\n", __FUNCTION__); ++ if ((rtw_BT_efuse_map_read(padapter, addr, cnts, ShadowMapBT) == _SUCCESS)) { ++ if (_rtw_memcmp((void *)ShadowMapBT , (void *)setdata, cnts)) { ++ RTW_INFO("%s: BT write map compare OK BTStatus=0x%x\n", __FUNCTION__, BTStatus); ++ sprintf(extra, "BT write map compare OK"); ++ err = 0; ++ goto exit; ++ } else { ++ sprintf(extra, "BT write map compare FAIL"); ++ RTW_INFO("%s: BT write map compare FAIL BTStatus=0x%x\n", __FUNCTION__, BTStatus); ++ err = 0; ++ goto exit; ++ } ++ } ++ } else if (strcmp(tmp[0], "btwfake") == 0) { ++ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ addr = simple_strtoul(tmp[1], &ptmp, 16); ++ addr &= 0xFFF; ++ ++ cnts = strlen(tmp[2]); ++ if (cnts % 2) { ++ err = -EINVAL; ++ goto exit; ++ } ++ cnts /= 2; ++ if (cnts == 0) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); ++ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); ++ RTW_INFO("%s: BT tmp data=%s\n", __FUNCTION__, tmp[2]); ++ ++ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) ++ pEfuseHal->fakeBTEfuseModifiedMap[addr + jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]); ++ } else if (strcmp(tmp[0], "btdumpfake") == 0) { ++ if (rtw_BT_efuse_map_read(padapter, 0, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseModifiedMap) == _SUCCESS) ++ RTW_INFO("%s: BT read all map success\n", __FUNCTION__); ++ else { ++ RTW_INFO("%s: BT read all map Fail!\n", __FUNCTION__); ++ err = -EFAULT; ++ } ++ } else if (strcmp(tmp[0], "btfk2map") == 0) { ++ rtw_write8(padapter, 0xa3, 0x05); ++ BTStatus = rtw_read8(padapter, 0xa0); ++ RTW_INFO("%s: btwmap before read 0xa0 BT Status =0x%x\n", __FUNCTION__, BTStatus); ++ if (BTStatus != 0x04) { ++ sprintf(extra, "BT Status not Active Write FAIL\n"); ++ goto exit; ++ } ++#ifndef RTW_HALMAC ++ BTEfuse_PowerSwitch(padapter, 1, _TRUE); ++ addr = 0x1ff; ++ rtw_write8(padapter, EFUSE_CTRL + 1, (addr & 0xff)); ++ rtw_msleep_os(10); ++ rtw_write8(padapter, EFUSE_CTRL + 2, ((addr >> 8) & 0x03)); ++ rtw_msleep_os(10); ++ rtw_write8(padapter, EFUSE_CTRL + 3, 0x72); ++ rtw_msleep_os(10); ++ rtw_read8(padapter, EFUSE_CTRL); ++ BTEfuse_PowerSwitch(padapter, 1, _FALSE); ++#endif /* RTW_HALMAC */ ++ _rtw_memcpy(pEfuseHal->BTEfuseModifiedMap, pEfuseHal->fakeBTEfuseModifiedMap, EFUSE_BT_MAX_MAP_LEN); ++ ++ if (rtw_BT_efuse_map_write(padapter, 0x00, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseModifiedMap) == _FAIL) { ++ RTW_INFO("%s: rtw_BT_efuse_map_write error!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ RTW_INFO("pEfuseHal->fakeBTEfuseModifiedMap OFFSET\tVALUE(hex)\n"); ++ for (i = 0; i < EFUSE_BT_MAX_MAP_LEN; i += 16) { ++ printk("0x%02x\t", i); ++ for (j = 0; j < 8; j++) ++ printk("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i + j]); ++ printk("\t"); ++ ++ for (; j < 16; j++) ++ printk("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i + j]); ++ printk("\n"); ++ } ++ printk("\n"); ++#if 1 ++ err = -EFAULT; ++ RTW_INFO("%s: rtw_BT_efuse_map_read _rtw_memcmp\n", __FUNCTION__); ++ if ((rtw_BT_efuse_map_read(padapter, 0x00, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseInitMap) == _SUCCESS)) { ++ if (_rtw_memcmp((void *)pEfuseHal->fakeBTEfuseModifiedMap, (void *)pEfuseHal->fakeBTEfuseInitMap, EFUSE_BT_MAX_MAP_LEN)) { ++ sprintf(extra, "BT write map compare OK"); ++ RTW_INFO("%s: BT write map afterf compare success BTStatus=0x%x\n", __FUNCTION__, BTStatus); ++ err = 0; ++ goto exit; ++ } else { ++ sprintf(extra, "BT write map compare FAIL"); ++ if (rtw_BT_efuse_map_write(padapter, 0x00, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseModifiedMap) == _FAIL) ++ RTW_INFO("%s: rtw_BT_efuse_map_write compare error,retry = %d!\n", __FUNCTION__, i); ++ ++ if (rtw_BT_efuse_map_read(padapter, EFUSE_BT, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseInitMap) == _SUCCESS) { ++ RTW_INFO("pEfuseHal->fakeBTEfuseInitMap OFFSET\tVALUE(hex)\n"); ++ ++ for (i = 0; i < EFUSE_BT_MAX_MAP_LEN; i += 16) { ++ printk("0x%02x\t", i); ++ for (j = 0; j < 8; j++) ++ printk("%02X ", pEfuseHal->fakeBTEfuseInitMap[i + j]); ++ printk("\t"); ++ for (; j < 16; j++) ++ printk("%02X ", pEfuseHal->fakeBTEfuseInitMap[i + j]); ++ printk("\n"); ++ } ++ printk("\n"); ++ } ++ RTW_INFO("%s: BT write map afterf compare not match to write efuse try write Map again , BTStatus=0x%x\n", __FUNCTION__, BTStatus); ++ goto exit; ++ } ++ } ++#endif ++ ++ } else if (strcmp(tmp[0], "wlfk2map") == 0) { ++ *extra = 0; ++ ++ if (padapter->registrypriv.bFileMaskEfuse != _TRUE && pmp_priv->bloadefusemap == _TRUE) { ++ RTW_INFO("%s: File eFuse mask file not to be loaded\n", __FUNCTION__); ++ sprintf(extra, "Not load eFuse mask file yet, Please use the efuse_mask CMD.\n"); ++ err = 0; ++ goto exit; ++ } ++ ++ if (wifimaplen > EFUSE_MAX_MAP_LEN) ++ cnts = EFUSE_MAX_MAP_LEN; ++ else ++ cnts = wifimaplen; ++ if (rtw_efuse_map_write(padapter, 0x00, cnts, pEfuseHal->fakeEfuseModifiedMap) == _FAIL) { ++ RTW_INFO("%s: rtw_efuse_map_write fakeEfuseModifiedMap error!\n", __FUNCTION__); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ if (rtw_efuse_mask_map_read(padapter, 0x00, wifimaplen, ShadowMapWiFi) == _SUCCESS) { ++ if (_rtw_memcmp((void *)ShadowMapWiFi , (void *)pEfuseHal->fakeEfuseModifiedMap, cnts)) { ++ RTW_INFO("%s: WiFi write map afterf compare OK\n", __FUNCTION__); ++ sprintf(extra, "WiFi write map compare OK\n"); ++ err = 0; ++ goto exit; ++ } else { ++ sprintf(extra, "WiFi write map compare FAIL\n"); ++ RTW_INFO("%s: WiFi write map compare Fail\n", __FUNCTION__); ++ err = 0; ++ goto exit; ++ } ++ } ++ } else if (strcmp(tmp[0], "wlwfake") == 0) { ++ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ addr = simple_strtoul(tmp[1], &ptmp, 16); ++ addr &= 0xFFF; ++ ++ cnts = strlen(tmp[2]); ++ if (cnts % 2) { ++ err = -EINVAL; ++ goto exit; ++ } ++ cnts /= 2; ++ if (cnts == 0) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); ++ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); ++ RTW_INFO("%s: map tmp data=%s\n", __FUNCTION__, tmp[2]); ++ ++ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) ++ pEfuseHal->fakeEfuseModifiedMap[addr + jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]); ++ _rtw_memset(extra, '\0', strlen(extra)); ++ sprintf(extra, "wlwfake OK\n"); ++ ++ } ++ else if (strcmp(tmp[0], "wfakemac") == 0) { ++ if (tmp[1] == NULL) { ++ err = -EINVAL; ++ goto exit; ++ } ++ /* wfakemac,00e04c871200 */ ++ if (hal_efuse_macaddr_offset(padapter) == -1) { ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ addr = hal_efuse_macaddr_offset(padapter); ++ cnts = strlen(tmp[1]); ++ if (cnts % 2) { ++ err = -EINVAL; ++ goto exit; ++ } ++ cnts /= 2; ++ if (cnts == 0) { ++ err = -EINVAL; ++ goto exit; ++ } ++ if (cnts > 6) { ++ RTW_INFO("%s: error data for mac addr=\"%s\"\n", __FUNCTION__, tmp[1]); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); ++ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); ++ RTW_INFO("%s: MAC address=%s\n", __FUNCTION__, tmp[1]); ++ ++ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) ++ pEfuseHal->fakeEfuseModifiedMap[addr + jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); ++ ++ _rtw_memset(extra, '\0', strlen(extra)); ++ sprintf(extra, "write mac addr to fake map OK\n"); ++ } else if(strcmp(tmp[0], "update") == 0) { ++ RTW_INFO("To Use new eFuse map\n"); ++ /*step read efuse/eeprom data and get mac_addr*/ ++ rtw_hal_read_chip_info(padapter); ++ /* set mac addr*/ ++ rtw_macaddr_cfg(adapter_mac_addr(padapter), get_hal_mac_addr(padapter)); ++ _rtw_memcpy(padapter->pnetdev->dev_addr, get_hal_mac_addr(padapter), ETH_ALEN); /* set mac addr to net_device */ ++ ++#ifdef CONFIG_P2P ++ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); ++#endif ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ rtw_hal_change_macaddr_mbid(padapter, adapter_mac_addr(padapter)); ++#else ++ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, adapter_mac_addr(padapter)); /* set mac addr to mac register */ ++#endif ++ /*pHalFunc->hal_deinit(padapter);*/ ++ if (pHalFunc->hal_init(padapter) == _FAIL) { ++ err = -EINVAL; ++ goto exit; ++ } ++ _rtw_memset(extra, '\0', strlen(extra)); ++ sprintf(extra, "eFuse Update OK\n"); ++ } ++ ++exit: ++ if (setdata) ++ rtw_mfree(setdata, 1024); ++ if (ShadowMapBT) ++ rtw_mfree(ShadowMapBT, EFUSE_BT_MAX_MAP_LEN); ++ if (ShadowMapWiFi) ++ rtw_mfree(ShadowMapWiFi, wifimaplen); ++ if (setrawdata) ++ rtw_mfree(setrawdata, EFUSE_MAX_SIZE); ++ ++ wrqu->length = strlen(extra); ++ ++ if (padapter->registrypriv.mp_mode == 0) { ++#ifdef CONFIG_IPS ++ rtw_pm_set_ips(padapter, ips_mode); ++#endif /* CONFIG_IPS */ ++ ++#ifdef CONFIG_LPS ++ rtw_pm_set_lps(padapter, lps_mode); ++#endif /* CONFIG_LPS */ ++ } ++ ++ return err; ++} ++ ++#ifdef CONFIG_MP_INCLUDED ++ ++#ifdef CONFIG_RTW_CUSTOMER_STR ++static int rtw_mp_customer_str( ++ struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ _adapter *adapter = rtw_netdev_priv(dev); ++ u32 len; ++ u8 *pbuf = NULL, *pch; ++ char *ptmp; ++ u8 param[RTW_CUSTOMER_STR_LEN]; ++ u8 count = 0; ++ u8 tmp; ++ u8 i; ++ u32 pos; ++ u8 ret; ++ u8 read = 0; ++ ++ if (adapter->registrypriv.mp_mode != 1 ++ || !adapter->registrypriv.mp_customer_str) ++ return -EFAULT; ++ ++ len = wrqu->data.length; ++ ++ pbuf = (u8 *)rtw_zmalloc(len); ++ if (pbuf == NULL) { ++ RTW_WARN("%s: no memory!\n", __func__); ++ return -ENOMEM; ++ } ++ ++ if (copy_from_user(pbuf, wrqu->data.pointer, len)) { ++ rtw_mfree(pbuf, len); ++ RTW_WARN("%s: copy from user fail!\n", __func__); ++ return -EFAULT; ++ } ++ RTW_INFO("%s: string=\"%s\"\n", __func__, pbuf); ++ ++ ptmp = (char *)pbuf; ++ pch = strsep(&ptmp, ","); ++ if ((pch == NULL) || (strlen(pch) == 0)) { ++ rtw_mfree(pbuf, len); ++ RTW_INFO("%s: parameter error(no cmd)!\n", __func__); ++ return -EFAULT; ++ } ++ ++ _rtw_memset(param, 0xFF, RTW_CUSTOMER_STR_LEN); ++ ++ if (strcmp(pch, "read") == 0) { ++ read = 1; ++ ret = rtw_hal_customer_str_read(adapter, param); ++ ++ } else if (strcmp(pch, "write") == 0) { ++ do { ++ pch = strsep(&ptmp, ":"); ++ if ((pch == NULL) || (strlen(pch) == 0)) ++ break; ++ if (strlen(pch) != 2 ++ || IsHexDigit(*pch) == _FALSE ++ || IsHexDigit(*(pch + 1)) == _FALSE ++ || sscanf(pch, "%hhx", &tmp) != 1 ++ ) { ++ RTW_WARN("%s: invalid 8-bit hex!\n", __func__); ++ rtw_mfree(pbuf, len); ++ return -EFAULT; ++ } ++ ++ param[count++] = tmp; ++ ++ } while (count < RTW_CUSTOMER_STR_LEN); ++ ++ if (count == 0) { ++ rtw_mfree(pbuf, len); ++ RTW_WARN("%s: no input!\n", __func__); ++ return -EFAULT; ++ } ++ ret = rtw_hal_customer_str_write(adapter, param); ++ } else { ++ rtw_mfree(pbuf, len); ++ RTW_INFO("%s: parameter error(unknown cmd)!\n", __func__); ++ return -EFAULT; ++ } ++ ++ pos = sprintf(extra, "%s: ", read ? "read" : "write"); ++ if (read == 0 || ret == _SUCCESS) { ++ for (i = 0; i < RTW_CUSTOMER_STR_LEN; i++) ++ pos += sprintf(extra + pos, "%02x:", param[i]); ++ extra[pos] = 0; ++ pos--; ++ } ++ pos += sprintf(extra + pos, " %s", ret == _SUCCESS ? "OK" : "FAIL"); ++ ++ wrqu->data.length = strlen(extra) + 1; ++ ++free_buf: ++ rtw_mfree(pbuf, len); ++ return 0; ++} ++#endif /* CONFIG_RTW_CUSTOMER_STR */ ++ ++static int rtw_priv_mp_set(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wdata, char *extra) ++{ ++ ++ struct iw_point *wrqu = (struct iw_point *)wdata; ++ u32 subcmd = wrqu->flags; ++ ++ switch (subcmd) { ++ case CTA_TEST: ++ RTW_INFO("set CTA_TEST\n"); ++ rtw_cta_test_start(dev, info, wdata, extra); ++ break; ++ case MP_DISABLE_BT_COEXIST: ++ RTW_INFO("set case MP_DISABLE_BT_COEXIST\n"); ++ rtw_mp_disable_bt_coexist(dev, info, wdata, extra); ++ break; ++ case MP_IQK: ++ RTW_INFO("set MP_IQK\n"); ++ rtw_mp_iqk(dev, info, wrqu, extra); ++ break; ++ case MP_LCK: ++ RTW_INFO("set MP_LCK\n"); ++ rtw_mp_lck(dev, info, wrqu, extra); ++ break; ++ ++ default: ++ return -EIO; ++ } ++ ++ return 0; ++} ++ ++static int rtw_priv_mp_get(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wdata, char *extra) ++{ ++ ++ struct iw_point *wrqu = (struct iw_point *)wdata; ++ u32 subcmd = wrqu->flags; ++ ++ switch (subcmd) { ++ case MP_START: ++ RTW_INFO("set case mp_start\n"); ++ rtw_mp_start(dev, info, wrqu, extra); ++ break; ++ case MP_STOP: ++ RTW_INFO("set case mp_stop\n"); ++ rtw_mp_stop(dev, info, wrqu, extra); ++ break; ++ case MP_BANDWIDTH: ++ RTW_INFO("set case mp_bandwidth\n"); ++ rtw_mp_bandwidth(dev, info, wrqu, extra); ++ break; ++ case MP_RESET_STATS: ++ RTW_INFO("set case MP_RESET_STATS\n"); ++ rtw_mp_reset_stats(dev, info, wrqu, extra); ++ break; ++ case MP_SetRFPathSwh: ++ RTW_INFO("set MP_SetRFPathSwitch\n"); ++ rtw_mp_SetRFPath(dev, info, wrqu, extra); ++ break; ++ case WRITE_REG: ++ rtw_mp_write_reg(dev, info, wrqu, extra); ++ break; ++ case WRITE_RF: ++ rtw_mp_write_rf(dev, info, wrqu, extra); ++ break; ++ case MP_PHYPARA: ++ RTW_INFO("mp_get MP_PHYPARA\n"); ++ rtw_mp_phypara(dev, info, wrqu, extra); ++ break; ++ case MP_CHANNEL: ++ RTW_INFO("set case mp_channel\n"); ++ rtw_mp_channel(dev , info, wrqu, extra); ++ break; ++ case READ_REG: ++ RTW_INFO("mp_get READ_REG\n"); ++ rtw_mp_read_reg(dev, info, wrqu, extra); ++ break; ++ case READ_RF: ++ RTW_INFO("mp_get READ_RF\n"); ++ rtw_mp_read_rf(dev, info, wrqu, extra); ++ break; ++ case MP_RATE: ++ RTW_INFO("set case mp_rate\n"); ++ rtw_mp_rate(dev, info, wrqu, extra); ++ break; ++ case MP_TXPOWER: ++ RTW_INFO("set case MP_TXPOWER\n"); ++ rtw_mp_txpower(dev, info, wrqu, extra); ++ break; ++ case MP_ANT_TX: ++ RTW_INFO("set case MP_ANT_TX\n"); ++ rtw_mp_ant_tx(dev, info, wrqu, extra); ++ break; ++ case MP_ANT_RX: ++ RTW_INFO("set case MP_ANT_RX\n"); ++ rtw_mp_ant_rx(dev, info, wrqu, extra); ++ break; ++ case MP_QUERY: ++ rtw_mp_trx_query(dev, info, wrqu, extra); ++ break; ++ case MP_CTX: ++ RTW_INFO("set case MP_CTX\n"); ++ rtw_mp_ctx(dev, info, wrqu, extra); ++ break; ++ case MP_ARX: ++ RTW_INFO("set case MP_ARX\n"); ++ rtw_mp_arx(dev, info, wrqu, extra); ++ break; ++ case MP_DUMP: ++ RTW_INFO("set case MP_DUMP\n"); ++ rtw_mp_dump(dev, info, wrqu, extra); ++ break; ++ case MP_PSD: ++ RTW_INFO("set case MP_PSD\n"); ++ rtw_mp_psd(dev, info, wrqu, extra); ++ break; ++ case MP_THER: ++ RTW_INFO("set case MP_THER\n"); ++ rtw_mp_thermal(dev, info, wrqu, extra); ++ break; ++ case MP_PwrCtlDM: ++ RTW_INFO("set MP_PwrCtlDM\n"); ++ rtw_mp_PwrCtlDM(dev, info, wrqu, extra); ++ break; ++ case MP_QueryDrvStats: ++ RTW_INFO("mp_get MP_QueryDrvStats\n"); ++ rtw_mp_QueryDrv(dev, info, wdata, extra); ++ break; ++ case MP_PWRTRK: ++ RTW_INFO("set case MP_PWRTRK\n"); ++ rtw_mp_pwrtrk(dev, info, wrqu, extra); ++ break; ++ case EFUSE_SET: ++ RTW_INFO("set case efuse set\n"); ++ rtw_mp_efuse_set(dev, info, wdata, extra); ++ break; ++ case EFUSE_GET: ++ RTW_INFO("efuse get EFUSE_GET\n"); ++ rtw_mp_efuse_get(dev, info, wdata, extra); ++ break; ++ case MP_GET_TXPOWER_INX: ++ RTW_INFO("mp_get MP_GET_TXPOWER_INX\n"); ++ rtw_mp_txpower_index(dev, info, wrqu, extra); ++ break; ++ case MP_GETVER: ++ RTW_INFO("mp_get MP_GETVER\n"); ++ rtw_mp_getver(dev, info, wdata, extra); ++ break; ++ case MP_MON: ++ RTW_INFO("mp_get MP_MON\n"); ++ rtw_mp_mon(dev, info, wdata, extra); ++ break; ++ case EFUSE_MASK: ++ RTW_INFO("mp_get EFUSE_MASK\n"); ++ rtw_efuse_mask_file(dev, info, wdata, extra); ++ break; ++ case EFUSE_FILE: ++ RTW_INFO("mp_get EFUSE_FILE\n"); ++ rtw_efuse_file_map(dev, info, wdata, extra); ++ break; ++ case MP_TX: ++ RTW_INFO("mp_get MP_TX\n"); ++ rtw_mp_tx(dev, info, wdata, extra); ++ break; ++ case MP_RX: ++ RTW_INFO("mp_get MP_RX\n"); ++ rtw_mp_rx(dev, info, wdata, extra); ++ break; ++ case MP_HW_TX_MODE: ++ RTW_INFO("mp_get MP_HW_TX_MODE\n"); ++ rtw_mp_hwtx(dev, info, wdata, extra); ++ break; ++#ifdef CONFIG_RTW_CUSTOMER_STR ++ case MP_CUSTOMER_STR: ++ RTW_INFO("customer str\n"); ++ rtw_mp_customer_str(dev, info, wdata, extra); ++ break; ++#endif ++ default: ++ return -EIO; ++ } ++ ++ return 0; ++} ++#endif /*#if defined(CONFIG_MP_INCLUDED)*/ ++ ++ ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++#define DBG_MP_SDIO_INDIRECT_ACCESS 1 ++static int rtw_mp_sd_iread(struct net_device *dev ++ , struct iw_request_info *info ++ , struct iw_point *wrqu ++ , char *extra) ++{ ++ char input[16]; ++ u8 width; ++ unsigned long addr; ++ u32 ret = 0; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ if (wrqu->length > 16) { ++ RTW_INFO(FUNC_ADPT_FMT" wrqu->length:%d\n", FUNC_ADPT_ARG(padapter), wrqu->length); ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) { ++ RTW_INFO(FUNC_ADPT_FMT" copy_from_user fail\n", FUNC_ADPT_ARG(padapter)); ++ ret = -EFAULT; ++ goto exit; ++ } ++ ++ _rtw_memset(extra, 0, wrqu->length); ++ ++ if (sscanf(input, "%hhu,%lx", &width, &addr) != 2) { ++ RTW_INFO(FUNC_ADPT_FMT" sscanf fail\n", FUNC_ADPT_ARG(padapter)); ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (addr > 0x3FFF) { ++ RTW_INFO(FUNC_ADPT_FMT" addr:0x%lx\n", FUNC_ADPT_ARG(padapter), addr); ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (DBG_MP_SDIO_INDIRECT_ACCESS) ++ RTW_INFO(FUNC_ADPT_FMT" width:%u, addr:0x%lx\n", FUNC_ADPT_ARG(padapter), width, addr); ++ ++ switch (width) { ++ case 1: ++ sprintf(extra, "0x%02x", rtw_sd_iread8(padapter, addr)); ++ wrqu->length = strlen(extra); ++ break; ++ case 2: ++ sprintf(extra, "0x%04x", rtw_sd_iread16(padapter, addr)); ++ wrqu->length = strlen(extra); ++ break; ++ case 4: ++ sprintf(extra, "0x%08x", rtw_sd_iread32(padapter, addr)); ++ wrqu->length = strlen(extra); ++ break; ++ default: ++ wrqu->length = 0; ++ ret = -EINVAL; ++ break; ++ } ++ ++exit: ++ return ret; ++} ++ ++static int rtw_mp_sd_iwrite(struct net_device *dev ++ , struct iw_request_info *info ++ , struct iw_point *wrqu ++ , char *extra) ++{ ++ char width; ++ unsigned long addr, data; ++ int ret = 0; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ char input[32]; ++ ++ if (wrqu->length > 32) { ++ RTW_INFO(FUNC_ADPT_FMT" wrqu->length:%d\n", FUNC_ADPT_ARG(padapter), wrqu->length); ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) { ++ RTW_INFO(FUNC_ADPT_FMT" copy_from_user fail\n", FUNC_ADPT_ARG(padapter)); ++ ret = -EFAULT; ++ goto exit; ++ } ++ ++ _rtw_memset(extra, 0, wrqu->length); ++ ++ if (sscanf(input, "%hhu,%lx,%lx", &width, &addr, &data) != 3) { ++ RTW_INFO(FUNC_ADPT_FMT" sscanf fail\n", FUNC_ADPT_ARG(padapter)); ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (addr > 0x3FFF) { ++ RTW_INFO(FUNC_ADPT_FMT" addr:0x%lx\n", FUNC_ADPT_ARG(padapter), addr); ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (DBG_MP_SDIO_INDIRECT_ACCESS) ++ RTW_INFO(FUNC_ADPT_FMT" width:%u, addr:0x%lx, data:0x%lx\n", FUNC_ADPT_ARG(padapter), width, addr, data); ++ ++ switch (width) { ++ case 1: ++ if (data > 0xFF) { ++ ret = -EINVAL; ++ break; ++ } ++ rtw_sd_iwrite8(padapter, addr, data); ++ break; ++ case 2: ++ if (data > 0xFFFF) { ++ ret = -EINVAL; ++ break; ++ } ++ rtw_sd_iwrite16(padapter, addr, data); ++ break; ++ case 4: ++ rtw_sd_iwrite32(padapter, addr, data); ++ break; ++ default: ++ wrqu->length = 0; ++ ret = -EINVAL; ++ break; ++ } ++ ++exit: ++ return ret; ++} ++#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ ++ ++static int rtw_priv_set(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wdata, char *extra) ++{ ++ struct iw_point *wrqu = (struct iw_point *)wdata; ++ u32 subcmd = wrqu->flags; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ if (padapter == NULL) ++ return -ENETDOWN; ++ ++ if (padapter->bup == _FALSE) { ++ RTW_INFO(" %s fail =>(padapter->bup == _FALSE )\n", __FUNCTION__); ++ return -ENETDOWN; ++ } ++ ++ if (RTW_CANNOT_RUN(padapter)) { ++ RTW_INFO("%s fail =>(bSurpriseRemoved == _TRUE) || ( bDriverStopped == _TRUE)\n", __func__); ++ return -ENETDOWN; ++ } ++ ++ if (extra == NULL) { ++ wrqu->length = 0; ++ return -EIO; ++ } ++ ++ if (subcmd < MP_NULL) { ++#ifdef CONFIG_MP_INCLUDED ++ rtw_priv_mp_set(dev, info, wdata, extra); ++#endif ++ return 0; ++ } ++ ++ switch (subcmd) { ++#ifdef CONFIG_WOWLAN ++ case MP_WOW_ENABLE: ++ RTW_INFO("set case MP_WOW_ENABLE: %s\n", extra); ++ ++ rtw_wowlan_ctrl(dev, info, wdata, extra); ++ break; ++ case MP_WOW_SET_PATTERN: ++ RTW_INFO("set case MP_WOW_SET_PATTERN: %s\n", extra); ++ rtw_wowlan_set_pattern(dev, info, wdata, extra); ++ break; ++#endif ++#ifdef CONFIG_AP_WOWLAN ++ case MP_AP_WOW_ENABLE: ++ RTW_INFO("set case MP_AP_WOW_ENABLE: %s\n", extra); ++ rtw_ap_wowlan_ctrl(dev, info, wdata, extra); ++ break; ++#endif ++#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE ++ case VENDOR_IE_SET: ++ RTW_INFO("set case VENDOR_IE_SET\n"); ++ rtw_vendor_ie_set(dev , info , wdata , extra); ++ break; ++#endif ++ default: ++ return -EIO; ++ } ++ ++ return 0; ++} ++ ++ ++static int rtw_priv_get(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wdata, char *extra) ++{ ++ struct iw_point *wrqu = (struct iw_point *)wdata; ++ u32 subcmd = wrqu->flags; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ ++ if (padapter == NULL) ++ return -ENETDOWN; ++ ++ if (padapter->bup == _FALSE) { ++ RTW_INFO(" %s fail =>(padapter->bup == _FALSE )\n", __FUNCTION__); ++ return -ENETDOWN; ++ } ++ ++ if (RTW_CANNOT_RUN(padapter)) { ++ RTW_INFO("%s fail =>(padapter->bSurpriseRemoved == _TRUE) || ( padapter->bDriverStopped == _TRUE)\n", __func__); ++ return -ENETDOWN; ++ } ++ ++ if (extra == NULL) { ++ wrqu->length = 0; ++ return -EIO; ++ } ++ ++ if (subcmd < MP_NULL) { ++#ifdef CONFIG_MP_INCLUDED ++ rtw_priv_mp_get(dev, info, wdata, extra); ++#endif ++ return 0; ++ } ++ ++ switch (subcmd) { ++#if defined(CONFIG_RTL8723B) ++ case MP_SetBT: ++ RTW_INFO("set MP_SetBT\n"); ++ rtw_mp_SetBT(dev, info, wdata, extra); ++ break; ++#endif ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++ case MP_SD_IREAD: ++ rtw_mp_sd_iread(dev, info, wrqu, extra); ++ break; ++ case MP_SD_IWRITE: ++ rtw_mp_sd_iwrite(dev, info, wrqu, extra); ++ break; ++#endif ++#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE ++ case VENDOR_IE_GET: ++ RTW_INFO("get case VENDOR_IE_GET\n"); ++ rtw_vendor_ie_get(dev , info , wdata , extra); ++ break; ++#endif ++ default: ++ return -EIO; ++ } ++ ++ rtw_msleep_os(10); /* delay 5ms for sending pkt before exit adb shell operation */ ++ return 0; ++} ++ ++ ++ ++static int rtw_wx_tdls_wfd_enable(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_WFD ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ ++ if (extra[0] == '0') ++ rtw_tdls_wfd_enable(padapter, 0); ++ else ++ rtw_tdls_wfd_enable(padapter, 1); ++ ++#endif /* CONFIG_WFD */ ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_weaksec(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++ ++ u8 i, j; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ ++ if (extra[0] == '0') ++ padapter->wdinfo.wfd_tdls_weaksec = 0; ++ else ++ padapter->wdinfo.wfd_tdls_weaksec = 1; ++ ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++ ++static int rtw_tdls_enable(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ _irqL irqL; ++ _list *plist, *phead; ++ s32 index; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 tdls_sta[NUM_STA][ETH_ALEN]; ++ u8 empty_hwaddr[ETH_ALEN] = { 0x00 }; ++ struct tdls_txmgmt txmgmt; ++ ++ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ ++ _rtw_memset(tdls_sta, 0x00, sizeof(tdls_sta)); ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ ++ if (extra[0] == '0') { ++ ptdlsinfo->tdls_enable = 0; ++ ++ if (pstapriv->asoc_sta_count == 1) ++ return ret; ++ ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ for (index = 0; index < NUM_STA; index++) { ++ phead = &(pstapriv->sta_hash[index]); ++ plist = get_next(phead); ++ ++ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ psta = LIST_CONTAINOR(plist, struct sta_info , hash_list); ++ ++ plist = get_next(plist); ++ ++ if (psta->tdls_sta_state != TDLS_STATE_NONE) ++ _rtw_memcpy(tdls_sta[index], psta->hwaddr, ETH_ALEN); ++ } ++ } ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ for (index = 0; index < NUM_STA; index++) { ++ if (!_rtw_memcmp(tdls_sta[index], empty_hwaddr, ETH_ALEN)) { ++ RTW_INFO("issue tear down to "MAC_FMT"\n", MAC_ARG(tdls_sta[index])); ++ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; ++ _rtw_memcpy(txmgmt.peer, tdls_sta[index], ETH_ALEN); ++ issue_tdls_teardown(padapter, &txmgmt, _TRUE); ++ } ++ } ++ rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR); ++ rtw_reset_tdls_info(padapter); ++ } else if (extra[0] == '1') ++ ptdlsinfo->tdls_enable = 1; ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_setup(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++#ifdef CONFIG_TDLS ++ u8 i, j; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_txmgmt txmgmt; ++#ifdef CONFIG_WFD ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif /* CONFIG_WFD */ ++ ++ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ ++ if (wrqu->data.length - 1 != 17) { ++ RTW_INFO("[%s] length:%d != 17\n", __FUNCTION__, (wrqu->data.length - 1)); ++ return ret; ++ } ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3) ++ txmgmt.peer[i] = key_2char2num(*(extra + j), *(extra + j + 1)); ++ ++#ifdef CONFIG_WFD ++ if (_AES_ != padapter->securitypriv.dot11PrivacyAlgrthm) { ++ /* Weak Security situation with AP. */ ++ if (0 == pwdinfo->wfd_tdls_weaksec) { ++ /* Can't send the tdls setup request out!! */ ++ RTW_INFO("[%s] Current link is not AES, " ++ "SKIP sending the tdls setup request!!\n", __FUNCTION__); ++ } else ++ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); ++ } else ++#endif /* CONFIG_WFD */ ++ { ++ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); ++ } ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_teardown(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++ ++ u8 i, j; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct sta_info *ptdls_sta = NULL; ++ struct tdls_txmgmt txmgmt; ++ ++ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ ++ if (wrqu->data.length - 1 != 17 && wrqu->data.length - 1 != 19) { ++ RTW_INFO("[%s] length:%d != 17 or 19\n", ++ __FUNCTION__, (wrqu->data.length - 1)); ++ return ret; ++ } ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ for (i = 0, j = 0; i < ETH_ALEN; i++, j += 3) ++ txmgmt.peer[i] = key_2char2num(*(extra + j), *(extra + j + 1)); ++ ++ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), txmgmt.peer); ++ ++ if (ptdls_sta != NULL) { ++ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; ++ if (wrqu->data.length - 1 == 19) ++ issue_tdls_teardown(padapter, &txmgmt, _FALSE); ++ else ++ issue_tdls_teardown(padapter, &txmgmt, _TRUE); ++ } else ++ RTW_INFO("TDLS peer not found\n"); ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_discovery(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_txmgmt txmgmt; ++ int i = 0, j = 0; ++ ++ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3) ++ txmgmt.peer[i] = key_2char2num(*(extra + j), *(extra + j + 1)); ++ ++ issue_tdls_dis_req(padapter, &txmgmt); ++ ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_ch_switch(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_TDLS_CH_SW ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; ++ u8 i, j; ++ struct sta_info *ptdls_sta = NULL; ++ u8 take_care_iqk; ++ ++ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ ++ if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) { ++ RTW_INFO("TDLS channel switch is not allowed\n"); ++ return ret; ++ } ++ ++ for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3) ++ pchsw_info->addr[i] = key_2char2num(*(extra + j), *(extra + j + 1)); ++ ++ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pchsw_info->addr); ++ if (ptdls_sta == NULL) ++ return ret; ++ ++ pchsw_info->ch_sw_state |= TDLS_CH_SW_INITIATOR_STATE; ++ ++ if (ptdls_sta != NULL) { ++ if (pchsw_info->off_ch_num == 0) ++ pchsw_info->off_ch_num = 11; ++ } else ++ RTW_INFO("TDLS peer not found\n"); ++ ++ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, &take_care_iqk); ++ if (take_care_iqk == _TRUE) { ++ u8 central_chnl; ++ u8 bw_mode; ++ ++ bw_mode = (pchsw_info->ch_offset) ? CHANNEL_WIDTH_40 : CHANNEL_WIDTH_20; ++ central_chnl = rtw_get_center_ch(pchsw_info->off_ch_num, bw_mode, pchsw_info->ch_offset); ++ if (rtw_hal_ch_sw_iqk_info_search(padapter, central_chnl, bw_mode) >= 0) ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_START); ++ else ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_PREPARE); ++ } else ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_START); ++ ++ /* issue_tdls_ch_switch_req(padapter, ptdls_sta); */ ++ /* RTW_INFO("issue tdls ch switch req\n"); */ ++ ++#endif /* CONFIG_TDLS_CH_SW */ ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_ch_switch_off(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_TDLS_CH_SW ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; ++ u8 i, j, mac_addr[ETH_ALEN]; ++ struct sta_info *ptdls_sta = NULL; ++ struct tdls_txmgmt txmgmt; ++ ++ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); ++ ++ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ ++ if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) { ++ RTW_INFO("TDLS channel switch is not allowed\n"); ++ return ret; ++ } ++ ++ if (wrqu->data.length >= 17) { ++ for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3) ++ mac_addr[i] = key_2char2num(*(extra + j), *(extra + j + 1)); ++ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); ++ } ++ ++ if (ptdls_sta == NULL) ++ return ret; ++ ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END_TO_BASE_CHNL); ++ ++ pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE | ++ TDLS_CH_SWITCH_ON_STATE | ++ TDLS_PEER_AT_OFF_STATE); ++ _rtw_memset(pchsw_info->addr, 0x00, ETH_ALEN); ++ ++ ptdls_sta->ch_switch_time = 0; ++ ptdls_sta->ch_switch_timeout = 0; ++ _cancel_timer_ex(&ptdls_sta->ch_sw_timer); ++ _cancel_timer_ex(&ptdls_sta->delay_timer); ++ _cancel_timer_ex(&ptdls_sta->stay_on_base_chnl_timer); ++ _cancel_timer_ex(&ptdls_sta->ch_sw_monitor_timer); ++ ++ rtw_pm_set_lps(padapter, PS_MODE_MAX); ++#endif /* CONFIG_TDLS_CH_SW */ ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_dump_ch(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_TDLS_CH_SW ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ ++ RTW_INFO("[%s] dump_stack:%s\n", __FUNCTION__, extra); ++ ++ extra[wrqu->data.length] = 0x00; ++ ptdlsinfo->chsw_info.dump_stack = rtw_atoi(extra); ++ ++ return ret; ++ ++#endif ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_off_ch_num(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_TDLS_CH_SW ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ ++ RTW_INFO("[%s] off_ch_num:%s\n", __FUNCTION__, extra); ++ ++ extra[wrqu->data.length] = 0x00; ++ ptdlsinfo->chsw_info.off_ch_num = rtw_atoi(extra); ++ ++ return ret; ++ ++#endif ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_ch_offset(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_TDLS_CH_SW ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ ++ RTW_INFO("[%s] ch_offset:%s\n", __FUNCTION__, extra); ++ ++ extra[wrqu->data.length] = 0x00; ++ switch (rtw_atoi(extra)) { ++ case SCA: ++ ptdlsinfo->chsw_info.ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ break; ++ ++ case SCB: ++ ptdlsinfo->chsw_info.ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ ++ default: ++ ptdlsinfo->chsw_info.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ } ++ ++ return ret; ++ ++#endif ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_pson(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 i, j, mac_addr[ETH_ALEN]; ++ struct sta_info *ptdls_sta = NULL; ++ ++ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ ++ for (i = 0, j = 0; i < ETH_ALEN; i++, j += 3) ++ mac_addr[i] = key_2char2num(*(extra + j), *(extra + j + 1)); ++ ++ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); ++ ++ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 1, 3, 500); ++ ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_psoff(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 i, j, mac_addr[ETH_ALEN]; ++ struct sta_info *ptdls_sta = NULL; ++ ++ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ ++ for (i = 0, j = 0; i < ETH_ALEN; i++, j += 3) ++ mac_addr[i] = key_2char2num(*(extra + j), *(extra + j + 1)); ++ ++ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); ++ ++ if (ptdls_sta) ++ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 0, 3, 500); ++ ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_setip(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_WFD ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; ++ u8 i = 0, j = 0, k = 0, tag = 0; ++ ++ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ ++ while (i < 4) { ++ for (j = 0; j < 4; j++) { ++ if (*(extra + j + tag) == '.' || *(extra + j + tag) == '\0') { ++ if (j == 1) ++ pwfd_info->ip_address[i] = convert_ip_addr('0', '0', *(extra + (j - 1) + tag)); ++ if (j == 2) ++ pwfd_info->ip_address[i] = convert_ip_addr('0', *(extra + (j - 2) + tag), *(extra + (j - 1) + tag)); ++ if (j == 3) ++ pwfd_info->ip_address[i] = convert_ip_addr(*(extra + (j - 3) + tag), *(extra + (j - 2) + tag), *(extra + (j - 1) + tag)); ++ ++ tag += j + 1; ++ break; ++ } ++ } ++ i++; ++ } ++ ++ RTW_INFO("[%s] Set IP = %u.%u.%u.%u\n", __FUNCTION__, ++ ptdlsinfo->wfd_info->ip_address[0], ++ ptdlsinfo->wfd_info->ip_address[1], ++ ptdlsinfo->wfd_info->ip_address[2], ++ ptdlsinfo->wfd_info->ip_address[3]); ++ ++#endif /* CONFIG_WFD */ ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_getip(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_WFD ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; ++ ++ RTW_INFO("[%s]\n", __FUNCTION__); ++ ++ sprintf(extra, "\n\n%u.%u.%u.%u\n", ++ pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1], ++ pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3]); ++ ++ RTW_INFO("[%s] IP=%u.%u.%u.%u\n", __FUNCTION__, ++ pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1], ++ pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3]); ++ ++ wrqu->data.length = strlen(extra); ++ ++#endif /* CONFIG_WFD */ ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++static int rtw_tdls_getport(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_WFD ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; ++ ++ RTW_INFO("[%s]\n", __FUNCTION__); ++ ++ sprintf(extra, "\n\n%d\n", pwfd_info->peer_rtsp_ctrlport); ++ RTW_INFO("[%s] remote port = %d\n", ++ __FUNCTION__, pwfd_info->peer_rtsp_ctrlport); ++ ++ wrqu->data.length = strlen(extra); ++ ++#endif /* CONFIG_WFD */ ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++ ++} ++ ++/* WFDTDLS, for sigma test */ ++static int rtw_tdls_dis_result(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++#ifdef CONFIG_WFD ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ ++ RTW_INFO("[%s]\n", __FUNCTION__); ++ ++ if (ptdlsinfo->dev_discovered == _TRUE) { ++ sprintf(extra, "\n\nDis=1\n"); ++ ptdlsinfo->dev_discovered = _FALSE; ++ } ++ ++ wrqu->data.length = strlen(extra); ++ ++#endif /* CONFIG_WFD */ ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++ ++} ++ ++/* WFDTDLS, for sigma test */ ++static int rtw_wfd_tdls_status(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ ++ RTW_INFO("[%s]\n", __FUNCTION__); ++ ++ sprintf(extra, "\nlink_established:%d\n" ++ "sta_cnt:%d\n" ++ "sta_maximum:%d\n" ++ "cur_channel:%d\n" ++ "tdls_enable:%d" ++#ifdef CONFIG_TDLS_CH_SW ++ "ch_sw_state:%08x\n" ++ "chsw_on:%d\n" ++ "off_ch_num:%d\n" ++ "cur_time:%d\n" ++ "ch_offset:%d\n" ++ "delay_swtich_back:%d" ++#endif ++ , ++ ptdlsinfo->link_established, ptdlsinfo->sta_cnt, ++ ptdlsinfo->sta_maximum, ptdlsinfo->cur_channel, ++ ptdlsinfo->tdls_enable ++#ifdef CONFIG_TDLS_CH_SW ++ , ++ ptdlsinfo->chsw_info.ch_sw_state, ++ ATOMIC_READ(&padapter->tdlsinfo.chsw_info.chsw_on), ++ ptdlsinfo->chsw_info.off_ch_num, ++ ptdlsinfo->chsw_info.cur_time, ++ ptdlsinfo->chsw_info.ch_offset, ++ ptdlsinfo->chsw_info.delay_switch_back ++#endif ++ ); ++ ++ wrqu->data.length = strlen(extra); ++ ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++ ++} ++ ++static int rtw_tdls_getsta(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ ++ int ret = 0; ++#ifdef CONFIG_TDLS ++ u8 i, j; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 addr[ETH_ALEN] = {0}; ++ char charmac[17]; ++ struct sta_info *ptdls_sta = NULL; ++ ++ RTW_INFO("[%s] %s %d\n", __FUNCTION__, ++ (char *)wrqu->data.pointer, wrqu->data.length - 1); ++ ++ if (copy_from_user(charmac, wrqu->data.pointer + 9, 17)) { ++ ret = -EFAULT; ++ goto exit; ++ } ++ ++ RTW_INFO("[%s] %d, charmac:%s\n", __FUNCTION__, __LINE__, charmac); ++ for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3) ++ addr[i] = key_2char2num(*(charmac + j), *(charmac + j + 1)); ++ ++ RTW_INFO("[%s] %d, charmac:%s, addr:"MAC_FMT"\n", ++ __FUNCTION__, __LINE__, charmac, MAC_ARG(addr)); ++ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, addr); ++ if (ptdls_sta) { ++ sprintf(extra, "\n\ntdls_sta_state=0x%08x\n", ptdls_sta->tdls_sta_state); ++ RTW_INFO("\n\ntdls_sta_state=%d\n", ptdls_sta->tdls_sta_state); ++ } else { ++ sprintf(extra, "\n\nNot found this sta\n"); ++ RTW_INFO("\n\nNot found this sta\n"); ++ } ++ wrqu->data.length = strlen(extra); ++ ++#endif /* CONFIG_TDLS */ ++exit: ++ return ret; ++ ++} ++ ++static int rtw_tdls_get_best_ch(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++#ifdef CONFIG_FIND_BEST_CHANNEL ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ u32 i, best_channel_24G = 1, best_channel_5G = 36, index_24G = 0, index_5G = 0; ++ ++ for (i = 0; pmlmeext->channel_set[i].ChannelNum != 0; i++) { ++ if (pmlmeext->channel_set[i].ChannelNum == 1) ++ index_24G = i; ++ if (pmlmeext->channel_set[i].ChannelNum == 36) ++ index_5G = i; ++ } ++ ++ for (i = 0; pmlmeext->channel_set[i].ChannelNum != 0; i++) { ++ /* 2.4G */ ++ if (pmlmeext->channel_set[i].ChannelNum == 6 || pmlmeext->channel_set[i].ChannelNum == 11) { ++ if (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_24G].rx_count) { ++ index_24G = i; ++ best_channel_24G = pmlmeext->channel_set[i].ChannelNum; ++ } ++ } ++ ++ /* 5G */ ++ if (pmlmeext->channel_set[i].ChannelNum >= 36 ++ && pmlmeext->channel_set[i].ChannelNum < 140) { ++ /* Find primary channel */ ++ if (((pmlmeext->channel_set[i].ChannelNum - 36) % 8 == 0) ++ && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { ++ index_5G = i; ++ best_channel_5G = pmlmeext->channel_set[i].ChannelNum; ++ } ++ } ++ ++ if (pmlmeext->channel_set[i].ChannelNum >= 149 ++ && pmlmeext->channel_set[i].ChannelNum < 165) { ++ /* Find primary channel */ ++ if (((pmlmeext->channel_set[i].ChannelNum - 149) % 8 == 0) ++ && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { ++ index_5G = i; ++ best_channel_5G = pmlmeext->channel_set[i].ChannelNum; ++ } ++ } ++#if 1 /* debug */ ++ RTW_INFO("The rx cnt of channel %3d = %d\n", ++ pmlmeext->channel_set[i].ChannelNum, ++ pmlmeext->channel_set[i].rx_count); ++#endif ++ } ++ ++ sprintf(extra, "\nbest_channel_24G = %d\n", best_channel_24G); ++ RTW_INFO("best_channel_24G = %d\n", best_channel_24G); ++ ++ if (index_5G != 0) { ++ sprintf(extra, "best_channel_5G = %d\n", best_channel_5G); ++ RTW_INFO("best_channel_5G = %d\n", best_channel_5G); ++ } ++ ++ wrqu->data.length = strlen(extra); ++ ++#endif ++ ++ return 0; ++ ++} ++ ++static int rtw_tdls(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_INFO("[%s] extra = %s\n", __FUNCTION__, extra); ++ ++ if (hal_chk_wl_func(padapter, WL_FUNC_TDLS) == _FALSE) { ++ RTW_INFO("Discard tdls oper since hal doesn't support tdls\n"); ++ return 0; ++ } ++ ++ if (padapter->tdlsinfo.tdls_enable == 0) { ++ RTW_INFO("tdls haven't enabled\n"); ++ return 0; ++ } ++ ++ /* WFD Sigma will use the tdls enable command to let the driver know we want to test the tdls now! */ ++ ++ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) { ++ if (_rtw_memcmp(extra, "wfdenable=", 10)) { ++ wrqu->data.length -= 10; ++ rtw_wx_tdls_wfd_enable(dev, info, wrqu, &extra[10]); ++ return ret; ++ } ++ } ++ ++ if (_rtw_memcmp(extra, "weaksec=", 8)) { ++ wrqu->data.length -= 8; ++ rtw_tdls_weaksec(dev, info, wrqu, &extra[8]); ++ return ret; ++ } else if (_rtw_memcmp(extra, "tdlsenable=", 11)) { ++ wrqu->data.length -= 11; ++ rtw_tdls_enable(dev, info, wrqu, &extra[11]); ++ return ret; ++ } ++ ++ if (_rtw_memcmp(extra, "setup=", 6)) { ++ wrqu->data.length -= 6; ++ rtw_tdls_setup(dev, info, wrqu, &extra[6]); ++ } else if (_rtw_memcmp(extra, "tear=", 5)) { ++ wrqu->data.length -= 5; ++ rtw_tdls_teardown(dev, info, wrqu, &extra[5]); ++ } else if (_rtw_memcmp(extra, "dis=", 4)) { ++ wrqu->data.length -= 4; ++ rtw_tdls_discovery(dev, info, wrqu, &extra[4]); ++ } else if (_rtw_memcmp(extra, "swoff=", 6)) { ++ wrqu->data.length -= 6; ++ rtw_tdls_ch_switch_off(dev, info, wrqu, &extra[6]); ++ } else if (_rtw_memcmp(extra, "sw=", 3)) { ++ wrqu->data.length -= 3; ++ rtw_tdls_ch_switch(dev, info, wrqu, &extra[3]); ++ } else if (_rtw_memcmp(extra, "dumpstack=", 10)) { ++ wrqu->data.length -= 10; ++ rtw_tdls_dump_ch(dev, info, wrqu, &extra[10]); ++ } else if (_rtw_memcmp(extra, "offchnum=", 9)) { ++ wrqu->data.length -= 9; ++ rtw_tdls_off_ch_num(dev, info, wrqu, &extra[9]); ++ } else if (_rtw_memcmp(extra, "choffset=", 9)) { ++ wrqu->data.length -= 9; ++ rtw_tdls_ch_offset(dev, info, wrqu, &extra[9]); ++ } else if (_rtw_memcmp(extra, "pson=", 5)) { ++ wrqu->data.length -= 5; ++ rtw_tdls_pson(dev, info, wrqu, &extra[5]); ++ } else if (_rtw_memcmp(extra, "psoff=", 6)) { ++ wrqu->data.length -= 6; ++ rtw_tdls_psoff(dev, info, wrqu, &extra[6]); ++ } ++ ++#ifdef CONFIG_WFD ++ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) { ++ if (_rtw_memcmp(extra, "setip=", 6)) { ++ wrqu->data.length -= 6; ++ rtw_tdls_setip(dev, info, wrqu, &extra[6]); ++ } else if (_rtw_memcmp(extra, "tprobe=", 6)) ++ issue_tunneled_probe_req((_adapter *)rtw_netdev_priv(dev)); ++ } ++#endif /* CONFIG_WFD */ ++ ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++ ++static int rtw_tdls_get(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++ ++ RTW_INFO("[%s] extra = %s\n", __FUNCTION__, (char *) wrqu->data.pointer); ++ ++ if (_rtw_memcmp(wrqu->data.pointer, "ip", 2)) ++ rtw_tdls_getip(dev, info, wrqu, extra); ++ else if (_rtw_memcmp(wrqu->data.pointer, "port", 4)) ++ rtw_tdls_getport(dev, info, wrqu, extra); ++ /* WFDTDLS, for sigma test */ ++ else if (_rtw_memcmp(wrqu->data.pointer, "dis", 3)) ++ rtw_tdls_dis_result(dev, info, wrqu, extra); ++ else if (_rtw_memcmp(wrqu->data.pointer, "status", 6)) ++ rtw_wfd_tdls_status(dev, info, wrqu, extra); ++ else if (_rtw_memcmp(wrqu->data.pointer, "tdls_sta=", 9)) ++ rtw_tdls_getsta(dev, info, wrqu, extra); ++ else if (_rtw_memcmp(wrqu->data.pointer, "best_ch", 7)) ++ rtw_tdls_get_best_ch(dev, info, wrqu, extra); ++#endif /* CONFIG_TDLS */ ++ ++ return ret; ++} ++ ++ ++ ++ ++ ++#ifdef CONFIG_INTEL_WIDI ++static int rtw_widi_set(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ process_intel_widi_cmd(padapter, extra); ++ ++ return ret; ++} ++ ++static int rtw_widi_set_probe_request(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ int ret = 0; ++ u8 *pbuf = NULL; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ pbuf = rtw_malloc(sizeof(l2_msg_t)); ++ if (pbuf) { ++ if (copy_from_user(pbuf, wrqu->data.pointer, wrqu->data.length)) ++ ret = -EFAULT; ++ /* _rtw_memcpy(pbuf, wrqu->data.pointer, wrqu->data.length); */ ++ ++ if (wrqu->data.flags == 0) ++ intel_widi_wk_cmd(padapter, INTEL_WIDI_ISSUE_PROB_WK, pbuf, sizeof(l2_msg_t)); ++ else if (wrqu->data.flags == 1) ++ rtw_set_wfd_rds_sink_info(padapter, (l2_msg_t *)pbuf); ++ } ++ return ret; ++} ++#endif /* CONFIG_INTEL_WIDI */ ++ ++#ifdef CONFIG_MAC_LOOPBACK_DRIVER ++ ++#if defined(CONFIG_RTL8188E) ++#include ++extern void rtl8188e_cal_txdesc_chksum(struct tx_desc *ptxdesc); ++#define cal_txdesc_chksum rtl8188e_cal_txdesc_chksum ++#ifdef CONFIG_SDIO_HCI || defined(CONFIG_GSPI_HCI) ++extern void rtl8188es_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); ++#define fill_default_txdesc rtl8188es_fill_default_txdesc ++#endif /* CONFIG_SDIO_HCI */ ++#endif /* CONFIG_RTL8188E */ ++#if defined(CONFIG_RTL8723B) ++extern void rtl8723b_cal_txdesc_chksum(struct tx_desc *ptxdesc); ++#define cal_txdesc_chksum rtl8723b_cal_txdesc_chksum ++extern void rtl8723b_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); ++#define fill_default_txdesc rtl8723b_fill_default_txdesc ++#endif /* CONFIG_RTL8723B */ ++ ++#if defined(CONFIG_RTL8703B) ++/* extern void rtl8703b_cal_txdesc_chksum(struct tx_desc *ptxdesc); */ ++#define cal_txdesc_chksum rtl8703b_cal_txdesc_chksum ++/* extern void rtl8703b_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); */ ++#define fill_default_txdesc rtl8703b_fill_default_txdesc ++#endif /* CONFIG_RTL8703B */ ++ ++#if defined(CONFIG_RTL8723D) ++/* extern void rtl8723d_cal_txdesc_chksum(struct tx_desc *ptxdesc); */ ++#define cal_txdesc_chksum rtl8723d_cal_txdesc_chksum ++/* extern void rtl8723d_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); */ ++#define fill_default_txdesc rtl8723d_fill_default_txdesc ++#endif /* CONFIG_RTL8723D */ ++ ++#if defined(CONFIG_RTL8192E) ++extern void rtl8192e_cal_txdesc_chksum(struct tx_desc *ptxdesc); ++#define cal_txdesc_chksum rtl8192e_cal_txdesc_chksum ++#ifdef CONFIG_SDIO_HCI || defined(CONFIG_GSPI_HCI) ++extern void rtl8192es_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); ++#define fill_default_txdesc rtl8192es_fill_default_txdesc ++#endif /* CONFIG_SDIO_HCI */ ++#endif /* CONFIG_RTL8192E */ ++ ++static s32 initLoopback(PADAPTER padapter) ++{ ++ PLOOPBACKDATA ploopback; ++ ++ ++ if (padapter->ploopback == NULL) { ++ ploopback = (PLOOPBACKDATA)rtw_zmalloc(sizeof(LOOPBACKDATA)); ++ if (ploopback == NULL) ++ return -ENOMEM; ++ ++ _rtw_init_sema(&ploopback->sema, 0); ++ ploopback->bstop = _TRUE; ++ ploopback->cnt = 0; ++ ploopback->size = 300; ++ _rtw_memset(ploopback->msg, 0, sizeof(ploopback->msg)); ++ ++ padapter->ploopback = ploopback; ++ } ++ ++ return 0; ++} ++ ++static void freeLoopback(PADAPTER padapter) ++{ ++ PLOOPBACKDATA ploopback; ++ ++ ++ ploopback = padapter->ploopback; ++ if (ploopback) { ++ rtw_mfree((u8 *)ploopback, sizeof(LOOPBACKDATA)); ++ padapter->ploopback = NULL; ++ } ++} ++ ++static s32 initpseudoadhoc(PADAPTER padapter) ++{ ++ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType; ++ s32 err; ++ ++ networkType = Ndis802_11IBSS; ++ err = rtw_set_802_11_infrastructure_mode(padapter, networkType); ++ if (err == _FALSE) ++ return _FAIL; ++ ++ err = rtw_setopmode_cmd(padapter, networkType, _TRUE); ++ if (err == _FAIL) ++ return _FAIL; ++ ++ return _SUCCESS; ++} ++ ++static s32 createpseudoadhoc(PADAPTER padapter) ++{ ++ NDIS_802_11_AUTHENTICATION_MODE authmode; ++ struct mlme_priv *pmlmepriv; ++ NDIS_802_11_SSID *passoc_ssid; ++ WLAN_BSSID_EX *pdev_network; ++ u8 *pibss; ++ u8 ssid[] = "pseduo_ad-hoc"; ++ s32 err; ++ _irqL irqL; ++ ++ ++ pmlmepriv = &padapter->mlmepriv; ++ ++ authmode = Ndis802_11AuthModeOpen; ++ err = rtw_set_802_11_authentication_mode(padapter, authmode); ++ if (err == _FALSE) ++ return _FAIL; ++ ++ passoc_ssid = &pmlmepriv->assoc_ssid; ++ _rtw_memset(passoc_ssid, 0, sizeof(NDIS_802_11_SSID)); ++ passoc_ssid->SsidLength = sizeof(ssid) - 1; ++ _rtw_memcpy(passoc_ssid->Ssid, ssid, passoc_ssid->SsidLength); ++ ++ pdev_network = &padapter->registrypriv.dev_network; ++ pibss = padapter->registrypriv.dev_network.MacAddress; ++ _rtw_memcpy(&pdev_network->Ssid, passoc_ssid, sizeof(NDIS_802_11_SSID)); ++ ++ rtw_update_registrypriv_dev_network(padapter); ++ rtw_generate_random_ibss(pibss); ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ /*pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;*/ ++ init_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++#if 0 ++ err = rtw_create_ibss_cmd(padapter, 0); ++ if (err == _FAIL) ++ return _FAIL; ++#else ++ { ++ struct wlan_network *pcur_network; ++ struct sta_info *psta; ++ ++ /* 3 create a new psta */ ++ pcur_network = &pmlmepriv->cur_network; ++ ++ /* clear psta in the cur_network, if any */ ++ psta = rtw_get_stainfo(&padapter->stapriv, pcur_network->network.MacAddress); ++ if (psta) ++ rtw_free_stainfo(padapter, psta); ++ ++ psta = rtw_alloc_stainfo(&padapter->stapriv, pibss); ++ if (psta == NULL) ++ return _FAIL; ++ ++ /* 3 join psudo AdHoc */ ++ pcur_network->join_res = 1; ++ pcur_network->aid = psta->aid = 1; ++ _rtw_memcpy(&pcur_network->network, pdev_network, get_WLAN_BSSID_EX_sz(pdev_network)); ++ ++ /* set msr to WIFI_FW_ADHOC_STATE */ ++ padapter->hw_port = HW_PORT0; ++ Set_MSR(padapter, WIFI_FW_ADHOC_STATE); ++ ++ } ++#endif ++ ++ return _SUCCESS; ++} ++ ++static struct xmit_frame *createloopbackpkt(PADAPTER padapter, u32 size) ++{ ++ struct xmit_priv *pxmitpriv; ++ struct xmit_frame *pframe; ++ struct xmit_buf *pxmitbuf; ++ struct pkt_attrib *pattrib; ++ struct tx_desc *desc; ++ u8 *pkt_start, *pkt_end, *ptr; ++ struct rtw_ieee80211_hdr *hdr; ++ s32 bmcast; ++ _irqL irqL; ++ ++ ++ if ((TXDESC_SIZE + WLANHDR_OFFSET + size) > MAX_XMITBUF_SZ) ++ return NULL; ++ ++ pxmitpriv = &padapter->xmitpriv; ++ pframe = NULL; ++ ++ /* 2 1. allocate xmit frame */ ++ pframe = rtw_alloc_xmitframe(pxmitpriv); ++ if (pframe == NULL) ++ return NULL; ++ pframe->padapter = padapter; ++ ++ /* 2 2. allocate xmit buffer */ ++ _enter_critical_bh(&pxmitpriv->lock, &irqL); ++ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ if (pxmitbuf == NULL) { ++ rtw_free_xmitframe(pxmitpriv, pframe); ++ return NULL; ++ } ++ ++ pframe->pxmitbuf = pxmitbuf; ++ pframe->buf_addr = pxmitbuf->pbuf; ++ pxmitbuf->priv_data = pframe; ++ ++ /* 2 3. update_attrib() */ ++ pattrib = &pframe->attrib; ++ ++ /* init xmitframe attribute */ ++ _rtw_memset(pattrib, 0, sizeof(struct pkt_attrib)); ++ ++ pattrib->ether_type = 0x8723; ++ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ _rtw_memset(pattrib->dst, 0xFF, ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); ++ ++ /* pattrib->dhcp_pkt = 0; ++ * pattrib->pktlen = 0; */ ++ pattrib->ack_policy = 0; ++ /* pattrib->pkt_hdrlen = ETH_HLEN; */ ++ pattrib->hdrlen = WLAN_HDR_A3_LEN; ++ pattrib->subtype = WIFI_DATA; ++ pattrib->priority = 0; ++ pattrib->qsel = pattrib->priority; ++ /* do_queue_select(padapter, pattrib); */ ++ pattrib->nr_frags = 1; ++ pattrib->encrypt = 0; ++ pattrib->bswenc = _FALSE; ++ pattrib->qos_en = _FALSE; ++ ++ bmcast = IS_MCAST(pattrib->ra); ++ if (bmcast) { ++ pattrib->mac_id = 1; ++ pattrib->psta = rtw_get_bcmc_stainfo(padapter); ++ } else { ++ pattrib->mac_id = 0; ++ pattrib->psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); ++ } ++ ++ pattrib->pktlen = size; ++ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->pktlen; ++ ++ /* 2 4. fill TX descriptor */ ++ desc = (struct tx_desc *)pframe->buf_addr; ++ _rtw_memset(desc, 0, TXDESC_SIZE); ++ ++ fill_default_txdesc(pframe, (u8 *)desc); ++ ++ /* Hw set sequence number */ ++ ((PTXDESC)desc)->hwseq_en = 0; /* HWSEQ_EN, 0:disable, 1:enable ++ * ((PTXDESC)desc)->hwseq_sel = 0; */ /* HWSEQ_SEL */ ++ ++ ((PTXDESC)desc)->disdatafb = 1; ++ ++ /* convert to little endian */ ++ desc->txdw0 = cpu_to_le32(desc->txdw0); ++ desc->txdw1 = cpu_to_le32(desc->txdw1); ++ desc->txdw2 = cpu_to_le32(desc->txdw2); ++ desc->txdw3 = cpu_to_le32(desc->txdw3); ++ desc->txdw4 = cpu_to_le32(desc->txdw4); ++ desc->txdw5 = cpu_to_le32(desc->txdw5); ++ desc->txdw6 = cpu_to_le32(desc->txdw6); ++ desc->txdw7 = cpu_to_le32(desc->txdw7); ++#ifdef CONFIG_PCI_HCI ++ desc->txdw8 = cpu_to_le32(desc->txdw8); ++ desc->txdw9 = cpu_to_le32(desc->txdw9); ++ desc->txdw10 = cpu_to_le32(desc->txdw10); ++ desc->txdw11 = cpu_to_le32(desc->txdw11); ++ desc->txdw12 = cpu_to_le32(desc->txdw12); ++ desc->txdw13 = cpu_to_le32(desc->txdw13); ++ desc->txdw14 = cpu_to_le32(desc->txdw14); ++ desc->txdw15 = cpu_to_le32(desc->txdw15); ++#endif ++ ++ cal_txdesc_chksum(desc); ++ ++ /* 2 5. coalesce */ ++ pkt_start = pframe->buf_addr + TXDESC_SIZE; ++ pkt_end = pkt_start + pattrib->last_txcmdsz; ++ ++ /* 3 5.1. make wlan header, make_wlanhdr() */ ++ hdr = (struct rtw_ieee80211_hdr *)pkt_start; ++ SetFrameSubType(&hdr->frame_ctl, pattrib->subtype); ++ _rtw_memcpy(hdr->addr1, pattrib->dst, ETH_ALEN); /* DA */ ++ _rtw_memcpy(hdr->addr2, pattrib->src, ETH_ALEN); /* SA */ ++ _rtw_memcpy(hdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN); /* RA, BSSID */ ++ ++ /* 3 5.2. make payload */ ++ ptr = pkt_start + pattrib->hdrlen; ++ get_random_bytes(ptr, pkt_end - ptr); ++ ++ pxmitbuf->len = TXDESC_SIZE + pattrib->last_txcmdsz; ++ pxmitbuf->ptail += pxmitbuf->len; ++ ++ return pframe; ++} ++ ++static void freeloopbackpkt(PADAPTER padapter, struct xmit_frame *pframe) ++{ ++ struct xmit_priv *pxmitpriv; ++ struct xmit_buf *pxmitbuf; ++ ++ ++ pxmitpriv = &padapter->xmitpriv; ++ pxmitbuf = pframe->pxmitbuf; ++ ++ rtw_free_xmitframe(pxmitpriv, pframe); ++ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); ++} ++ ++static void printdata(u8 *pbuf, u32 len) ++{ ++ u32 i, val; ++ ++ ++ for (i = 0; (i + 4) <= len; i += 4) { ++ printk("%08X", *(u32 *)(pbuf + i)); ++ if ((i + 4) & 0x1F) ++ printk(" "); ++ else ++ printk("\n"); ++ } ++ ++ if (i < len) { ++#ifdef CONFIG_BIG_ENDIAN ++ for (; i < len, i++) ++ printk("%02X", pbuf + i); ++#else /* CONFIG_LITTLE_ENDIAN */ ++#if 0 ++ val = 0; ++ _rtw_memcpy(&val, pbuf + i, len - i); ++ printk("%8X", val); ++#else ++ u8 str[9]; ++ u8 n; ++ val = 0; ++ n = len - i; ++ _rtw_memcpy(&val, pbuf + i, n); ++ sprintf(str, "%08X", val); ++ n = (4 - n) * 2; ++ printk("%8s", str + n); ++#endif ++#endif /* CONFIG_LITTLE_ENDIAN */ ++ } ++ printk("\n"); ++} ++ ++static u8 pktcmp(PADAPTER padapter, u8 *txbuf, u32 txsz, u8 *rxbuf, u32 rxsz) ++{ ++ PHAL_DATA_TYPE phal; ++ struct recv_stat *prxstat; ++ struct recv_stat report; ++ PRXREPORT prxreport; ++ u32 drvinfosize; ++ u32 rxpktsize; ++ u8 fcssize; ++ u8 ret = _FALSE; ++ ++ prxstat = (struct recv_stat *)rxbuf; ++ report.rxdw0 = le32_to_cpu(prxstat->rxdw0); ++ report.rxdw1 = le32_to_cpu(prxstat->rxdw1); ++ report.rxdw2 = le32_to_cpu(prxstat->rxdw2); ++ report.rxdw3 = le32_to_cpu(prxstat->rxdw3); ++ report.rxdw4 = le32_to_cpu(prxstat->rxdw4); ++ report.rxdw5 = le32_to_cpu(prxstat->rxdw5); ++ ++ prxreport = (PRXREPORT)&report; ++ drvinfosize = prxreport->drvinfosize << 3; ++ rxpktsize = prxreport->pktlen; ++ ++ phal = GET_HAL_DATA(padapter); ++ if (phal->ReceiveConfig & RCR_APPFCS) ++ fcssize = IEEE80211_FCS_LEN; ++ else ++ fcssize = 0; ++ ++ if ((txsz - TXDESC_SIZE) != (rxpktsize - fcssize)) { ++ RTW_INFO("%s: ERROR! size not match tx/rx=%d/%d !\n", ++ __func__, txsz - TXDESC_SIZE, rxpktsize - fcssize); ++ ret = _FALSE; ++ } else { ++ ret = _rtw_memcmp(txbuf + TXDESC_SIZE, \ ++ rxbuf + RXDESC_SIZE + drvinfosize, \ ++ txsz - TXDESC_SIZE); ++ if (ret == _FALSE) ++ RTW_INFO("%s: ERROR! pkt content mismatch!\n", __func__); ++ } ++ ++ if (ret == _FALSE) { ++ RTW_INFO("\n%s: TX PKT total=%d, desc=%d, content=%d\n", ++ __func__, txsz, TXDESC_SIZE, txsz - TXDESC_SIZE); ++ RTW_INFO("%s: TX DESC size=%d\n", __func__, TXDESC_SIZE); ++ printdata(txbuf, TXDESC_SIZE); ++ RTW_INFO("%s: TX content size=%d\n", __func__, txsz - TXDESC_SIZE); ++ printdata(txbuf + TXDESC_SIZE, txsz - TXDESC_SIZE); ++ ++ RTW_INFO("\n%s: RX PKT read=%d offset=%d(%d,%d) content=%d\n", ++ __func__, rxsz, RXDESC_SIZE + drvinfosize, RXDESC_SIZE, drvinfosize, rxpktsize); ++ if (rxpktsize != 0) { ++ RTW_INFO("%s: RX DESC size=%d\n", __func__, RXDESC_SIZE); ++ printdata(rxbuf, RXDESC_SIZE); ++ RTW_INFO("%s: RX drvinfo size=%d\n", __func__, drvinfosize); ++ printdata(rxbuf + RXDESC_SIZE, drvinfosize); ++ RTW_INFO("%s: RX content size=%d\n", __func__, rxpktsize); ++ printdata(rxbuf + RXDESC_SIZE + drvinfosize, rxpktsize); ++ } else { ++ RTW_INFO("%s: RX data size=%d\n", __func__, rxsz); ++ printdata(rxbuf, rxsz); ++ } ++ } ++ ++ return ret; ++} ++ ++thread_return lbk_thread(thread_context context) ++{ ++ s32 err; ++ PADAPTER padapter; ++ PLOOPBACKDATA ploopback; ++ struct xmit_frame *pxmitframe; ++ u32 cnt, ok, fail, headerlen; ++ u32 pktsize; ++ u32 ff_hwaddr; ++ ++ ++ padapter = (PADAPTER)context; ++ ploopback = padapter->ploopback; ++ if (ploopback == NULL) ++ return -1; ++ cnt = 0; ++ ok = 0; ++ fail = 0; ++ ++ daemonize("%s", "RTW_LBK_THREAD"); ++ allow_signal(SIGTERM); ++ ++ do { ++ if (ploopback->size == 0) { ++ get_random_bytes(&pktsize, 4); ++ pktsize = (pktsize % 1535) + 1; /* 1~1535 */ ++ } else ++ pktsize = ploopback->size; ++ ++ pxmitframe = createloopbackpkt(padapter, pktsize); ++ if (pxmitframe == NULL) { ++ sprintf(ploopback->msg, "loopback FAIL! 3. create Packet FAIL!"); ++ break; ++ } ++ ++ ploopback->txsize = TXDESC_SIZE + pxmitframe->attrib.last_txcmdsz; ++ _rtw_memcpy(ploopback->txbuf, pxmitframe->buf_addr, ploopback->txsize); ++ ff_hwaddr = rtw_get_ff_hwaddr(pxmitframe); ++ cnt++; ++ RTW_INFO("%s: wirte port cnt=%d size=%d\n", __func__, cnt, ploopback->txsize); ++ pxmitframe->pxmitbuf->pdata = ploopback->txbuf; ++ rtw_write_port(padapter, ff_hwaddr, ploopback->txsize, (u8 *)pxmitframe->pxmitbuf); ++ ++ /* wait for rx pkt */ ++ _rtw_down_sema(&ploopback->sema); ++ ++ err = pktcmp(padapter, ploopback->txbuf, ploopback->txsize, ploopback->rxbuf, ploopback->rxsize); ++ if (err == _TRUE) ++ ok++; ++ else ++ fail++; ++ ++ ploopback->txsize = 0; ++ _rtw_memset(ploopback->txbuf, 0, 0x8000); ++ ploopback->rxsize = 0; ++ _rtw_memset(ploopback->rxbuf, 0, 0x8000); ++ ++ freeloopbackpkt(padapter, pxmitframe); ++ pxmitframe = NULL; ++ ++ flush_signals_thread(); ++ ++ if ((ploopback->bstop == _TRUE) || ++ ((ploopback->cnt != 0) && (ploopback->cnt == cnt))) { ++ u32 ok_rate, fail_rate, all; ++ all = cnt; ++ ok_rate = (ok * 100) / all; ++ fail_rate = (fail * 100) / all; ++ sprintf(ploopback->msg, \ ++ "loopback result: ok=%d%%(%d/%d),error=%d%%(%d/%d)", \ ++ ok_rate, ok, all, fail_rate, fail, all); ++ break; ++ } ++ } while (1); ++ ++ ploopback->bstop = _TRUE; ++ ++ thread_exit(NULL); ++ return 0; ++} ++ ++static void loopbackTest(PADAPTER padapter, u32 cnt, u32 size, u8 *pmsg) ++{ ++ PLOOPBACKDATA ploopback; ++ u32 len; ++ s32 err; ++ ++ ++ ploopback = padapter->ploopback; ++ ++ if (ploopback) { ++ if (ploopback->bstop == _FALSE) { ++ ploopback->bstop = _TRUE; ++ _rtw_up_sema(&ploopback->sema); ++ } ++ len = 0; ++ do { ++ len = strlen(ploopback->msg); ++ if (len) ++ break; ++ rtw_msleep_os(1); ++ } while (1); ++ _rtw_memcpy(pmsg, ploopback->msg, len + 1); ++ freeLoopback(padapter); ++ ++ return; ++ } ++ ++ /* disable dynamic algorithm */ ++ rtw_phydm_ability_backup(padapter); ++ rtw_phydm_func_disable_all(padapter); ++ ++ /* create pseudo ad-hoc connection */ ++ err = initpseudoadhoc(padapter); ++ if (err == _FAIL) { ++ sprintf(pmsg, "loopback FAIL! 1.1 init ad-hoc FAIL!"); ++ return; ++ } ++ ++ err = createpseudoadhoc(padapter); ++ if (err == _FAIL) { ++ sprintf(pmsg, "loopback FAIL! 1.2 create ad-hoc master FAIL!"); ++ return; ++ } ++ ++ err = initLoopback(padapter); ++ if (err) { ++ sprintf(pmsg, "loopback FAIL! 2. init FAIL! error code=%d", err); ++ return; ++ } ++ ++ ploopback = padapter->ploopback; ++ ++ ploopback->bstop = _FALSE; ++ ploopback->cnt = cnt; ++ ploopback->size = size; ++ ploopback->lbkthread = kthread_run(lbk_thread, padapter, "RTW_LBK_THREAD"); ++ if (IS_ERR(padapter->lbkthread)) { ++ freeLoopback(padapter); ++ sprintf(pmsg, "loopback start FAIL! cnt=%d", cnt); ++ return; ++ } ++ ++ sprintf(pmsg, "loopback start! cnt=%d", cnt); ++} ++#endif /* CONFIG_MAC_LOOPBACK_DRIVER */ ++ ++static int rtw_test( ++ struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ u32 len; ++ u8 *pbuf, *pch; ++ char *ptmp; ++ u8 *delim = ","; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ ++ RTW_INFO("+%s\n", __func__); ++ len = wrqu->data.length; ++ ++ pbuf = (u8 *)rtw_zmalloc(len); ++ if (pbuf == NULL) { ++ RTW_INFO("%s: no memory!\n", __func__); ++ return -ENOMEM; ++ } ++ ++ if (copy_from_user(pbuf, wrqu->data.pointer, len)) { ++ rtw_mfree(pbuf, len); ++ RTW_INFO("%s: copy from user fail!\n", __func__); ++ return -EFAULT; ++ } ++ RTW_INFO("%s: string=\"%s\"\n", __func__, pbuf); ++ ++ ptmp = (char *)pbuf; ++ pch = strsep(&ptmp, delim); ++ if ((pch == NULL) || (strlen(pch) == 0)) { ++ rtw_mfree(pbuf, len); ++ RTW_INFO("%s: parameter error(level 1)!\n", __func__); ++ return -EFAULT; ++ } ++ ++#ifdef CONFIG_MAC_LOOPBACK_DRIVER ++ if (strcmp(pch, "loopback") == 0) { ++ s32 cnt = 0; ++ u32 size = 64; ++ ++ pch = strsep(&ptmp, delim); ++ if ((pch == NULL) || (strlen(pch) == 0)) { ++ rtw_mfree(pbuf, len); ++ RTW_INFO("%s: parameter error(level 2)!\n", __func__); ++ return -EFAULT; ++ } ++ ++ sscanf(pch, "%d", &cnt); ++ RTW_INFO("%s: loopback cnt=%d\n", __func__, cnt); ++ ++ pch = strsep(&ptmp, delim); ++ if ((pch == NULL) || (strlen(pch) == 0)) { ++ rtw_mfree(pbuf, len); ++ RTW_INFO("%s: parameter error(level 2)!\n", __func__); ++ return -EFAULT; ++ } ++ ++ sscanf(pch, "%d", &size); ++ RTW_INFO("%s: loopback size=%d\n", __func__, size); ++ ++ loopbackTest(padapter, cnt, size, extra); ++ wrqu->data.length = strlen(extra) + 1; ++ ++ goto free_buf; ++ } ++#endif ++ ++ ++#ifdef CONFIG_BT_COEXIST ++ if (strcmp(pch, "bton") == 0) { ++ rtw_btcoex_SetManualControl(padapter, _FALSE); ++ goto free_buf; ++ } else if (strcmp(pch, "btoff") == 0) { ++ rtw_btcoex_SetManualControl(padapter, _TRUE); ++ goto free_buf; ++ } ++#endif ++ ++ if (strcmp(pch, "h2c") == 0) { ++ u8 param[8]; ++ u8 count = 0; ++ u32 tmp; ++ u8 i; ++ u32 pos; ++ u8 ret; ++ ++ do { ++ pch = strsep(&ptmp, delim); ++ if ((pch == NULL) || (strlen(pch) == 0)) ++ break; ++ ++ sscanf(pch, "%x", &tmp); ++ param[count++] = (u8)tmp; ++ } while (count < 8); ++ ++ if (count == 0) { ++ rtw_mfree(pbuf, len); ++ RTW_INFO("%s: parameter error(level 2)!\n", __func__); ++ return -EFAULT; ++ } ++ ++ ret = rtw_test_h2c_cmd(padapter, param, count); ++ ++ pos = sprintf(extra, "H2C ID=0x%02x content=", param[0]); ++ for (i = 1; i < count; i++) ++ pos += sprintf(extra + pos, "%02x,", param[i]); ++ extra[pos] = 0; ++ pos--; ++ pos += sprintf(extra + pos, " %s", ret == _FAIL ? "FAIL" : "OK"); ++ ++ wrqu->data.length = strlen(extra) + 1; ++ ++ goto free_buf; ++ } ++ ++free_buf: ++ rtw_mfree(pbuf, len); ++ return 0; ++} ++ ++static iw_handler rtw_handlers[] = { ++ NULL, /* SIOCSIWCOMMIT */ ++ rtw_wx_get_name, /* SIOCGIWNAME */ ++ dummy, /* SIOCSIWNWID */ ++ dummy, /* SIOCGIWNWID */ ++ rtw_wx_set_freq, /* SIOCSIWFREQ */ ++ rtw_wx_get_freq, /* SIOCGIWFREQ */ ++ rtw_wx_set_mode, /* SIOCSIWMODE */ ++ rtw_wx_get_mode, /* SIOCGIWMODE */ ++ dummy, /* SIOCSIWSENS */ ++ rtw_wx_get_sens, /* SIOCGIWSENS */ ++ NULL, /* SIOCSIWRANGE */ ++ rtw_wx_get_range, /* SIOCGIWRANGE */ ++ rtw_wx_set_priv, /* SIOCSIWPRIV */ ++ NULL, /* SIOCGIWPRIV */ ++ NULL, /* SIOCSIWSTATS */ ++ NULL, /* SIOCGIWSTATS */ ++ dummy, /* SIOCSIWSPY */ ++ dummy, /* SIOCGIWSPY */ ++ NULL, /* SIOCGIWTHRSPY */ ++ NULL, /* SIOCWIWTHRSPY */ ++ rtw_wx_set_wap, /* SIOCSIWAP */ ++ rtw_wx_get_wap, /* SIOCGIWAP */ ++ rtw_wx_set_mlme, /* request MLME operation; uses struct iw_mlme */ ++ dummy, /* SIOCGIWAPLIST -- depricated */ ++ rtw_wx_set_scan, /* SIOCSIWSCAN */ ++ rtw_wx_get_scan, /* SIOCGIWSCAN */ ++ rtw_wx_set_essid, /* SIOCSIWESSID */ ++ rtw_wx_get_essid, /* SIOCGIWESSID */ ++ dummy, /* SIOCSIWNICKN */ ++ rtw_wx_get_nick, /* SIOCGIWNICKN */ ++ NULL, /* -- hole -- */ ++ NULL, /* -- hole -- */ ++ rtw_wx_set_rate, /* SIOCSIWRATE */ ++ rtw_wx_get_rate, /* SIOCGIWRATE */ ++ rtw_wx_set_rts, /* SIOCSIWRTS */ ++ rtw_wx_get_rts, /* SIOCGIWRTS */ ++ rtw_wx_set_frag, /* SIOCSIWFRAG */ ++ rtw_wx_get_frag, /* SIOCGIWFRAG */ ++ dummy, /* SIOCSIWTXPOW */ ++ dummy, /* SIOCGIWTXPOW */ ++ dummy, /* SIOCSIWRETRY */ ++ rtw_wx_get_retry, /* SIOCGIWRETRY */ ++ rtw_wx_set_enc, /* SIOCSIWENCODE */ ++ rtw_wx_get_enc, /* SIOCGIWENCODE */ ++ dummy, /* SIOCSIWPOWER */ ++ rtw_wx_get_power, /* SIOCGIWPOWER */ ++ NULL, /*---hole---*/ ++ NULL, /*---hole---*/ ++ rtw_wx_set_gen_ie, /* SIOCSIWGENIE */ ++ NULL, /* SIOCGWGENIE */ ++ rtw_wx_set_auth, /* SIOCSIWAUTH */ ++ NULL, /* SIOCGIWAUTH */ ++ rtw_wx_set_enc_ext, /* SIOCSIWENCODEEXT */ ++ NULL, /* SIOCGIWENCODEEXT */ ++ rtw_wx_set_pmkid, /* SIOCSIWPMKSA */ ++ NULL, /*---hole---*/ ++}; ++ ++ ++static const struct iw_priv_args rtw_private_args[] = { ++ { ++ SIOCIWFIRSTPRIV + 0x0, ++ IW_PRIV_TYPE_CHAR | 0x7FF, 0, "write" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x1, ++ IW_PRIV_TYPE_CHAR | 0x7FF, ++ IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ, "read" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x2, 0, 0, "driver_ext" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x3, 0, 0, "mp_ioctl" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x4, ++ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "apinfo" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x5, ++ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "setpid" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x6, ++ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_start" ++ }, ++ /* for PLATFORM_MT53XX */ ++ { ++ SIOCIWFIRSTPRIV + 0x7, ++ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "get_sensitivity" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x8, ++ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_prob_req_ie" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x9, ++ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_assoc_req_ie" ++ }, ++ ++ /* for RTK_DMP_PLATFORM */ ++ { ++ SIOCIWFIRSTPRIV + 0xA, ++ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "channel_plan" ++ }, ++ ++ { ++ SIOCIWFIRSTPRIV + 0xB, ++ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "dbg" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0xC, ++ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 3, 0, "rfw" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0xD, ++ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ, "rfr" ++ }, ++#if 0 ++ { ++ SIOCIWFIRSTPRIV + 0xE, 0, 0, "wowlan_ctrl" ++ }, ++#endif ++ { ++ SIOCIWFIRSTPRIV + 0x10, ++ IW_PRIV_TYPE_CHAR | 1024, 0, "p2p_set" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x11, ++ IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , "p2p_get" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x12, 0, 0, "NULL" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x13, ++ IW_PRIV_TYPE_CHAR | 64, IW_PRIV_TYPE_CHAR | 64 , "p2p_get2" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x14, ++ IW_PRIV_TYPE_CHAR | 64, 0, "tdls" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x15, ++ IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | 1024 , "tdls_get" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x16, ++ IW_PRIV_TYPE_CHAR | 64, 0, "pm_set" ++ }, ++ ++ {SIOCIWFIRSTPRIV + 0x18, IW_PRIV_TYPE_CHAR | IFNAMSIZ , 0 , "rereg_nd_name"}, ++#ifdef CONFIG_MP_INCLUDED ++ {SIOCIWFIRSTPRIV + 0x1A, IW_PRIV_TYPE_CHAR | 1024, 0, "NULL"}, ++ {SIOCIWFIRSTPRIV + 0x1B, IW_PRIV_TYPE_CHAR | 128, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "NULL"}, ++#else ++ {SIOCIWFIRSTPRIV + 0x1A, IW_PRIV_TYPE_CHAR | 1024, 0, "efuse_set"}, ++ {SIOCIWFIRSTPRIV + 0x1B, IW_PRIV_TYPE_CHAR | 128, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_get"}, ++#endif ++ { ++ SIOCIWFIRSTPRIV + 0x1D, ++ IW_PRIV_TYPE_CHAR | 40, IW_PRIV_TYPE_CHAR | 0x7FF, "test" ++ }, ++ ++#ifdef CONFIG_INTEL_WIDI ++ { ++ SIOCIWFIRSTPRIV + 0x1E, ++ IW_PRIV_TYPE_CHAR | 1024, 0, "widi_set" ++ }, ++ { ++ SIOCIWFIRSTPRIV + 0x1F, ++ IW_PRIV_TYPE_CHAR | 128, 0, "widi_prob_req" ++ }, ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ { SIOCIWFIRSTPRIV + 0x0E, IW_PRIV_TYPE_CHAR | 1024, 0 , ""}, /* set */ ++ { SIOCIWFIRSTPRIV + 0x0F, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , ""},/* get ++ * --- sub-ioctls definitions --- */ ++ ++#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE ++ { VENDOR_IE_SET, IW_PRIV_TYPE_CHAR | 1024 , 0 , "vendor_ie_set" }, ++ { VENDOR_IE_GET, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "vendor_ie_get" }, ++#endif ++#if defined(CONFIG_RTL8723B) ++ { MP_SetBT, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_setbt" }, ++ { MP_DISABLE_BT_COEXIST, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_disa_btcoex"}, ++#endif ++#ifdef CONFIG_WOWLAN ++ { MP_WOW_ENABLE , IW_PRIV_TYPE_CHAR | 1024, 0, "wow_mode" }, ++ { MP_WOW_SET_PATTERN , IW_PRIV_TYPE_CHAR | 1024, 0, "wow_set_pattern" }, ++#endif ++#ifdef CONFIG_AP_WOWLAN ++ { MP_AP_WOW_ENABLE , IW_PRIV_TYPE_CHAR | 1024, 0, "ap_wow_mode" }, /* set */ ++#endif ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++ { MP_SD_IREAD, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "sd_iread" }, ++ { MP_SD_IWRITE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "sd_iwrite" }, ++#endif ++}; ++ ++ ++static const struct iw_priv_args rtw_mp_private_args[] = { ++ /* --- sub-ioctls definitions --- */ ++#ifdef CONFIG_MP_INCLUDED ++ { MP_START , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_start" }, ++ { MP_PHYPARA, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_phypara" }, ++ { MP_STOP , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_stop" }, ++ { MP_CHANNEL , IW_PRIV_TYPE_CHAR | 1024 , IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_channel" }, ++ { MP_BANDWIDTH , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_bandwidth"}, ++ { MP_RATE , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rate" }, ++ { MP_RESET_STATS , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_reset_stats"}, ++ { MP_QUERY , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , "mp_query"}, ++ { READ_REG , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "read_reg" }, ++ { MP_RATE , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rate" }, ++ { READ_RF , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "read_rf" }, ++ { MP_PSD , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_psd"}, ++ { MP_DUMP, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_dump" }, ++ { MP_TXPOWER , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_txpower"}, ++ { MP_ANT_TX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ant_tx"}, ++ { MP_ANT_RX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ant_rx"}, ++ { WRITE_REG , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "write_reg" }, ++ { WRITE_RF , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "write_rf" }, ++ { MP_CTX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ctx"}, ++ { MP_ARX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_arx"}, ++ { MP_THER , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ther"}, ++ { EFUSE_SET, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_set" }, ++ { EFUSE_GET, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_get" }, ++ { MP_PWRTRK , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_pwrtrk"}, ++ { MP_QueryDrvStats, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_drvquery" }, ++ { MP_IOCTL, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_ioctl"}, ++ { MP_SetRFPathSwh, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_setrfpath" }, ++ { MP_PwrCtlDM, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_pwrctldm" }, ++ { MP_GET_TXPOWER_INX, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_get_txpower" }, ++ { MP_GETVER, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_priv_ver" }, ++ { MP_MON, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_mon" }, ++ { EFUSE_MASK, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_mask" }, ++ { EFUSE_FILE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_file" }, ++ { MP_TX, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_tx" }, ++ { MP_RX, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rx" }, ++ { MP_HW_TX_MODE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_hxtx" }, ++ { CTA_TEST, IW_PRIV_TYPE_CHAR | 1024, 0, "cta_test"}, ++ { MP_IQK, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_iqk"}, ++ { MP_LCK, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_lck"}, ++#ifdef CONFIG_RTW_CUSTOMER_STR ++ { MP_CUSTOMER_STR, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "customer_str" }, ++#endif ++ ++#endif /* CONFIG_MP_INCLUDED */ ++}; ++ ++static iw_handler rtw_private_handler[] = { ++ rtw_wx_write32, /* 0x00 */ ++ rtw_wx_read32, /* 0x01 */ ++ rtw_drvext_hdl, /* 0x02 */ ++#ifdef MP_IOCTL_HDL ++ rtw_mp_ioctl_hdl, /* 0x03 */ ++#else ++ rtw_wx_priv_null, ++#endif ++ /* for MM DTV platform */ ++ rtw_get_ap_info, /* 0x04 */ ++ ++ rtw_set_pid, /* 0x05 */ ++ rtw_wps_start, /* 0x06 */ ++ ++ /* for PLATFORM_MT53XX */ ++ rtw_wx_get_sensitivity, /* 0x07 */ ++ rtw_wx_set_mtk_wps_probe_ie, /* 0x08 */ ++ rtw_wx_set_mtk_wps_ie, /* 0x09 */ ++ ++ /* for RTK_DMP_PLATFORM ++ * Set Channel depend on the country code */ ++ rtw_wx_set_channel_plan, /* 0x0A */ ++ ++ rtw_dbg_port, /* 0x0B */ ++ rtw_wx_write_rf, /* 0x0C */ ++ rtw_wx_read_rf, /* 0x0D */ ++ ++ rtw_priv_set, /*0x0E*/ ++ rtw_priv_get, /*0x0F*/ ++ ++ rtw_p2p_set, /* 0x10 */ ++ rtw_p2p_get, /* 0x11 */ ++ NULL, /* 0x12 */ ++ rtw_p2p_get2, /* 0x13 */ ++ ++ rtw_tdls, /* 0x14 */ ++ rtw_tdls_get, /* 0x15 */ ++ ++ rtw_pm_set, /* 0x16 */ ++ rtw_wx_priv_null, /* 0x17 */ ++ rtw_rereg_nd_name, /* 0x18 */ ++ rtw_wx_priv_null, /* 0x19 */ ++#ifdef CONFIG_MP_INCLUDED ++ rtw_wx_priv_null, /* 0x1A */ ++ rtw_wx_priv_null, /* 0x1B */ ++#else ++ rtw_mp_efuse_set, /* 0x1A */ ++ rtw_mp_efuse_get, /* 0x1B */ ++#endif ++ NULL, /* 0x1C is reserved for hostapd */ ++ rtw_test, /* 0x1D */ ++#ifdef CONFIG_INTEL_WIDI ++ rtw_widi_set, /* 0x1E */ ++ rtw_widi_set_probe_request, /* 0x1F */ ++#endif /* CONFIG_INTEL_WIDI */ ++}; ++ ++#if WIRELESS_EXT >= 17 ++static struct iw_statistics *rtw_get_wireless_stats(struct net_device *dev) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_statistics *piwstats = &padapter->iwstats; ++ int tmp_level = 0; ++ int tmp_qual = 0; ++ int tmp_noise = 0; ++ ++ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) != _TRUE) { ++ piwstats->qual.qual = 0; ++ piwstats->qual.level = 0; ++ piwstats->qual.noise = 0; ++ /* RTW_INFO("No link level:%d, qual:%d, noise:%d\n", tmp_level, tmp_qual, tmp_noise); */ ++ } else { ++#ifdef CONFIG_SIGNAL_DISPLAY_DBM ++ tmp_level = translate_percentage_to_dbm(padapter->recvpriv.signal_strength); ++#else ++#ifdef CONFIG_SIGNAL_SCALE_MAPPING ++ tmp_level = padapter->recvpriv.signal_strength; ++#else ++ { ++ /* Do signal scale mapping when using percentage as the unit of signal strength, since the scale mapping is skipped in odm */ ++ ++ HAL_DATA_TYPE *pHal = GET_HAL_DATA(padapter); ++ ++ tmp_level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, padapter->recvpriv.signal_strength); ++ } ++#endif ++#endif ++ ++ tmp_qual = padapter->recvpriv.signal_qual; ++ rtw_get_noise(padapter); ++ tmp_noise = padapter->recvpriv.noise; ++ /* RTW_INFO("level:%d, qual:%d, noise:%d, rssi (%d)\n", tmp_level, tmp_qual, tmp_noise,padapter->recvpriv.rssi); */ ++ ++ piwstats->qual.level = tmp_level; ++ piwstats->qual.qual = tmp_qual; ++ piwstats->qual.noise = tmp_noise; ++ } ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 14)) ++ piwstats->qual.updated = IW_QUAL_ALL_UPDATED ;/* |IW_QUAL_DBM; */ ++#else ++#ifdef RTK_DMP_PLATFORM ++ /* IW_QUAL_DBM= 0x8, if driver use this flag, wireless extension will show value of dbm. */ ++ /* remove this flag for show percentage 0~100 */ ++ piwstats->qual.updated = 0x07; ++#else ++ piwstats->qual.updated = 0x0f; ++#endif ++#endif ++ ++#ifdef CONFIG_SIGNAL_DISPLAY_DBM ++ piwstats->qual.updated = piwstats->qual.updated | IW_QUAL_DBM; ++#endif ++ ++ return &padapter->iwstats; ++} ++#endif ++ ++#ifdef CONFIG_WIRELESS_EXT ++struct iw_handler_def rtw_handlers_def = { ++ .standard = rtw_handlers, ++ .num_standard = sizeof(rtw_handlers) / sizeof(iw_handler), ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 33)) || defined(CONFIG_WEXT_PRIV) ++ .private = rtw_private_handler, ++ .private_args = (struct iw_priv_args *)rtw_private_args, ++ .num_private = sizeof(rtw_private_handler) / sizeof(iw_handler), ++ .num_private_args = sizeof(rtw_private_args) / sizeof(struct iw_priv_args), ++#endif ++#if WIRELESS_EXT >= 17 ++ .get_wireless_stats = rtw_get_wireless_stats, ++#endif ++}; ++#endif ++ ++/* copy from net/wireless/wext.c start ++ * ---------------------------------------------------------------- ++ * ++ * Calculate size of private arguments ++ */ ++static const char iw_priv_type_size[] = { ++ 0, /* IW_PRIV_TYPE_NONE */ ++ 1, /* IW_PRIV_TYPE_BYTE */ ++ 1, /* IW_PRIV_TYPE_CHAR */ ++ 0, /* Not defined */ ++ sizeof(__u32), /* IW_PRIV_TYPE_INT */ ++ sizeof(struct iw_freq), /* IW_PRIV_TYPE_FLOAT */ ++ sizeof(struct sockaddr), /* IW_PRIV_TYPE_ADDR */ ++ 0, /* Not defined */ ++}; ++ ++static int get_priv_size(__u16 args) ++{ ++ int num = args & IW_PRIV_SIZE_MASK; ++ int type = (args & IW_PRIV_TYPE_MASK) >> 12; ++ ++ return num * iw_priv_type_size[type]; ++} ++/* copy from net/wireless/wext.c end */ ++ ++ ++static int _rtw_ioctl_wext_private(struct net_device *dev, union iwreq_data *wrq_data) ++{ ++ int err = 0; ++ u8 *input = NULL; ++ u32 input_len = 0; ++ const char delim[] = " "; ++ u8 *output = NULL; ++ u32 output_len = 0; ++ u32 count = 0; ++ u8 *buffer = NULL; ++ u32 buffer_len = 0; ++ char *ptr = NULL; ++ u8 cmdname[17] = {0}; /* IFNAMSIZ+1 */ ++ u32 cmdlen; ++ s32 len; ++ u8 *extra = NULL; ++ u32 extra_size = 0; ++ ++ s32 k; ++ const iw_handler *priv; /* Private ioctl */ ++ const struct iw_priv_args *priv_args; /* Private ioctl description */ ++ const struct iw_priv_args *mp_priv_args; /*MP Private ioctl description */ ++ const struct iw_priv_args *sel_priv_args; /*Selected Private ioctl description */ ++ u32 num_priv; /* Number of ioctl */ ++ u32 num_priv_args; /* Number of descriptions */ ++ u32 num_mp_priv_args; /*Number of MP descriptions */ ++ u32 num_sel_priv_args; /*Number of Selected descriptions */ ++ iw_handler handler; ++ int temp; ++ int subcmd = 0; /* sub-ioctl index */ ++ int offset = 0; /* Space for sub-ioctl index */ ++ ++ union iwreq_data wdata; ++ ++ _rtw_memcpy(&wdata, wrq_data, sizeof(wdata)); ++ ++ input_len = wdata.data.length; ++ if (!input_len) ++ return -EINVAL; ++ input = rtw_zmalloc(input_len); ++ if (NULL == input) ++ return -ENOMEM; ++ if (copy_from_user(input, wdata.data.pointer, input_len)) { ++ err = -EFAULT; ++ goto exit; ++ } ++ input[input_len - 1] = '\0'; ++ ptr = input; ++ len = input_len; ++ ++ if (ptr == NULL) { ++ err = -EOPNOTSUPP; ++ goto exit; ++ } ++ ++ sscanf(ptr, "%16s", cmdname); ++ cmdlen = strlen(cmdname); ++ RTW_INFO("%s: cmd=%s\n", __func__, cmdname); ++ ++ /* skip command string */ ++ if (cmdlen > 0) ++ cmdlen += 1; /* skip one space */ ++ ptr += cmdlen; ++ len -= cmdlen; ++ RTW_INFO("%s: parameters=%s\n", __func__, ptr); ++ ++ priv = rtw_private_handler; ++ priv_args = rtw_private_args; ++ mp_priv_args = rtw_mp_private_args; ++ num_priv = sizeof(rtw_private_handler) / sizeof(iw_handler); ++ num_priv_args = sizeof(rtw_private_args) / sizeof(struct iw_priv_args); ++ num_mp_priv_args = sizeof(rtw_mp_private_args) / sizeof(struct iw_priv_args); ++ ++ if (num_priv_args == 0) { ++ err = -EOPNOTSUPP; ++ goto exit; ++ } ++ ++ /* Search the correct ioctl */ ++ k = -1; ++ sel_priv_args = priv_args; ++ num_sel_priv_args = num_priv_args; ++ while ++ ((++k < num_sel_priv_args) && strcmp(sel_priv_args[k].name, cmdname)) ++ ; ++ ++ /* If not found... */ ++ if (k == num_sel_priv_args) { ++ k = -1; ++ sel_priv_args = mp_priv_args; ++ num_sel_priv_args = num_mp_priv_args; ++ while ++ ((++k < num_sel_priv_args) && strcmp(sel_priv_args[k].name, cmdname)) ++ ; ++ ++ if (k == num_sel_priv_args) { ++ err = -EOPNOTSUPP; ++ goto exit; ++ } ++ } ++ ++ /* Watch out for sub-ioctls ! */ ++ if (sel_priv_args[k].cmd < SIOCDEVPRIVATE) { ++ int j = -1; ++ ++ /* Find the matching *real* ioctl */ ++ while ((++j < num_priv_args) && ((priv_args[j].name[0] != '\0') || ++ (priv_args[j].set_args != sel_priv_args[k].set_args) || ++ (priv_args[j].get_args != sel_priv_args[k].get_args))) ++ ; ++ ++ /* If not found... */ ++ if (j == num_priv_args) { ++ err = -EINVAL; ++ goto exit; ++ } ++ ++ /* Save sub-ioctl number */ ++ subcmd = sel_priv_args[k].cmd; ++ /* Reserve one int (simplify alignment issues) */ ++ offset = sizeof(__u32); ++ /* Use real ioctl definition from now on */ ++ k = j; ++ } ++ ++ buffer = rtw_zmalloc(4096); ++ if (NULL == buffer) { ++ err = -ENOMEM; ++ goto exit; ++ } ++ ++ /* If we have to set some data */ ++ if ((priv_args[k].set_args & IW_PRIV_TYPE_MASK) && ++ (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) { ++ u8 *str; ++ ++ switch (priv_args[k].set_args & IW_PRIV_TYPE_MASK) { ++ case IW_PRIV_TYPE_BYTE: ++ /* Fetch args */ ++ count = 0; ++ do { ++ str = strsep(&ptr, delim); ++ if (NULL == str) ++ break; ++ sscanf(str, "%i", &temp); ++ buffer[count++] = (u8)temp; ++ } while (1); ++ buffer_len = count; ++ ++ /* Number of args to fetch */ ++ wdata.data.length = count; ++ if (wdata.data.length > (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) ++ wdata.data.length = priv_args[k].set_args & IW_PRIV_SIZE_MASK; ++ ++ break; ++ ++ case IW_PRIV_TYPE_INT: ++ /* Fetch args */ ++ count = 0; ++ do { ++ str = strsep(&ptr, delim); ++ if (NULL == str) ++ break; ++ sscanf(str, "%i", &temp); ++ ((s32 *)buffer)[count++] = (s32)temp; ++ } while (1); ++ buffer_len = count * sizeof(s32); ++ ++ /* Number of args to fetch */ ++ wdata.data.length = count; ++ if (wdata.data.length > (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) ++ wdata.data.length = priv_args[k].set_args & IW_PRIV_SIZE_MASK; ++ ++ break; ++ ++ case IW_PRIV_TYPE_CHAR: ++ if (len > 0) { ++ /* Size of the string to fetch */ ++ wdata.data.length = len; ++ if (wdata.data.length > (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) ++ wdata.data.length = priv_args[k].set_args & IW_PRIV_SIZE_MASK; ++ ++ /* Fetch string */ ++ _rtw_memcpy(buffer, ptr, wdata.data.length); ++ } else { ++ wdata.data.length = 1; ++ buffer[0] = '\0'; ++ } ++ buffer_len = wdata.data.length; ++ break; ++ ++ default: ++ RTW_INFO("%s: Not yet implemented...\n", __func__); ++ err = -1; ++ goto exit; ++ } ++ ++ if ((priv_args[k].set_args & IW_PRIV_SIZE_FIXED) && ++ (wdata.data.length != (priv_args[k].set_args & IW_PRIV_SIZE_MASK))) { ++ RTW_INFO("%s: The command %s needs exactly %d argument(s)...\n", ++ __func__, cmdname, priv_args[k].set_args & IW_PRIV_SIZE_MASK); ++ err = -EINVAL; ++ goto exit; ++ } ++ } /* if args to set */ ++ else ++ wdata.data.length = 0L; ++ ++ /* Those two tests are important. They define how the driver ++ * will have to handle the data */ ++ if ((priv_args[k].set_args & IW_PRIV_SIZE_FIXED) && ++ ((get_priv_size(priv_args[k].set_args) + offset) <= IFNAMSIZ)) { ++ /* First case : all SET args fit within wrq */ ++ if (offset) ++ wdata.mode = subcmd; ++ _rtw_memcpy(wdata.name + offset, buffer, IFNAMSIZ - offset); ++ } else { ++ if ((priv_args[k].set_args == 0) && ++ (priv_args[k].get_args & IW_PRIV_SIZE_FIXED) && ++ (get_priv_size(priv_args[k].get_args) <= IFNAMSIZ)) { ++ /* Second case : no SET args, GET args fit within wrq */ ++ if (offset) ++ wdata.mode = subcmd; ++ } else { ++ /* Third case : args won't fit in wrq, or variable number of args */ ++ if (copy_to_user(wdata.data.pointer, buffer, buffer_len)) { ++ err = -EFAULT; ++ goto exit; ++ } ++ wdata.data.flags = subcmd; ++ } ++ } ++ ++ rtw_mfree(input, input_len); ++ input = NULL; ++ ++ extra_size = 0; ++ if (IW_IS_SET(priv_args[k].cmd)) { ++ /* Size of set arguments */ ++ extra_size = get_priv_size(priv_args[k].set_args); ++ ++ /* Does it fits in iwr ? */ ++ if ((priv_args[k].set_args & IW_PRIV_SIZE_FIXED) && ++ ((extra_size + offset) <= IFNAMSIZ)) ++ extra_size = 0; ++ } else { ++ /* Size of get arguments */ ++ extra_size = get_priv_size(priv_args[k].get_args); ++ ++ /* Does it fits in iwr ? */ ++ if ((priv_args[k].get_args & IW_PRIV_SIZE_FIXED) && ++ (extra_size <= IFNAMSIZ)) ++ extra_size = 0; ++ } ++ ++ if (extra_size == 0) { ++ extra = (u8 *)&wdata; ++ rtw_mfree(buffer, 4096); ++ buffer = NULL; ++ } else ++ extra = buffer; ++ ++ handler = priv[priv_args[k].cmd - SIOCIWFIRSTPRIV]; ++ err = handler(dev, NULL, &wdata, extra); ++ ++ /* If we have to get some data */ ++ if ((priv_args[k].get_args & IW_PRIV_TYPE_MASK) && ++ (priv_args[k].get_args & IW_PRIV_SIZE_MASK)) { ++ int j; ++ int n = 0; /* number of args */ ++ u8 str[20] = {0}; ++ ++ /* Check where is the returned data */ ++ if ((priv_args[k].get_args & IW_PRIV_SIZE_FIXED) && ++ (get_priv_size(priv_args[k].get_args) <= IFNAMSIZ)) ++ n = priv_args[k].get_args & IW_PRIV_SIZE_MASK; ++ else ++ n = wdata.data.length; ++ ++ output = rtw_zmalloc(4096); ++ if (NULL == output) { ++ err = -ENOMEM; ++ goto exit; ++ } ++ ++ switch (priv_args[k].get_args & IW_PRIV_TYPE_MASK) { ++ case IW_PRIV_TYPE_BYTE: ++ /* Display args */ ++ for (j = 0; j < n; j++) { ++ sprintf(str, "%d ", extra[j]); ++ len = strlen(str); ++ output_len = strlen(output); ++ if ((output_len + len + 1) > 4096) { ++ err = -E2BIG; ++ goto exit; ++ } ++ _rtw_memcpy(output + output_len, str, len); ++ } ++ break; ++ ++ case IW_PRIV_TYPE_INT: ++ /* Display args */ ++ for (j = 0; j < n; j++) { ++ sprintf(str, "%d ", ((__s32 *)extra)[j]); ++ len = strlen(str); ++ output_len = strlen(output); ++ if ((output_len + len + 1) > 4096) { ++ err = -E2BIG; ++ goto exit; ++ } ++ _rtw_memcpy(output + output_len, str, len); ++ } ++ break; ++ ++ case IW_PRIV_TYPE_CHAR: ++ /* Display args */ ++ _rtw_memcpy(output, extra, n); ++ break; ++ ++ default: ++ RTW_INFO("%s: Not yet implemented...\n", __func__); ++ err = -1; ++ goto exit; ++ } ++ ++ output_len = strlen(output) + 1; ++ wrq_data->data.length = output_len; ++ if (copy_to_user(wrq_data->data.pointer, output, output_len)) { ++ err = -EFAULT; ++ goto exit; ++ } ++ } /* if args to set */ ++ else ++ wrq_data->data.length = 0; ++ ++exit: ++ if (input) ++ rtw_mfree(input, input_len); ++ if (buffer) ++ rtw_mfree(buffer, 4096); ++ if (output) ++ rtw_mfree(output, 4096); ++ ++ return err; ++} ++ ++#ifdef CONFIG_COMPAT ++static int rtw_ioctl_compat_wext_private(struct net_device *dev, struct ifreq *rq) ++{ ++ struct compat_iw_point iwp_compat; ++ union iwreq_data wrq_data; ++ int err = 0; ++ RTW_INFO("%s:...\n", __func__); ++ if (copy_from_user(&iwp_compat, rq->ifr_ifru.ifru_data, sizeof(struct compat_iw_point))) ++ return -EFAULT; ++ ++ wrq_data.data.pointer = compat_ptr(iwp_compat.pointer); ++ wrq_data.data.length = iwp_compat.length; ++ wrq_data.data.flags = iwp_compat.flags; ++ ++ err = _rtw_ioctl_wext_private(dev, &wrq_data); ++ ++ iwp_compat.pointer = ptr_to_compat(wrq_data.data.pointer); ++ iwp_compat.length = wrq_data.data.length; ++ iwp_compat.flags = wrq_data.data.flags; ++ if (copy_to_user(rq->ifr_ifru.ifru_data, &iwp_compat, sizeof(struct compat_iw_point))) ++ return -EFAULT; ++ ++ return err; ++} ++#endif /* CONFIG_COMPAT */ ++ ++static int rtw_ioctl_standard_wext_private(struct net_device *dev, struct ifreq *rq) ++{ ++ struct iw_point *iwp; ++ struct ifreq ifrq; ++ union iwreq_data wrq_data; ++ int err = 0; ++ iwp = &wrq_data.data; ++ RTW_INFO("%s:...\n", __func__); ++ if (copy_from_user(iwp, rq->ifr_ifru.ifru_data, sizeof(struct iw_point))) ++ return -EFAULT; ++ ++ err = _rtw_ioctl_wext_private(dev, &wrq_data); ++ ++ if (copy_to_user(rq->ifr_ifru.ifru_data, iwp, sizeof(struct iw_point))) ++ return -EFAULT; ++ ++ return err; ++} ++ ++static int rtw_ioctl_wext_private(struct net_device *dev, struct ifreq *rq) ++{ ++#ifdef CONFIG_COMPAT ++#if (KERNEL_VERSION(4, 6, 0) > LINUX_VERSION_CODE) ++ if (is_compat_task()) ++#else ++ if (in_compat_syscall()) ++#endif ++ return rtw_ioctl_compat_wext_private(dev, rq); ++ else ++#endif /* CONFIG_COMPAT */ ++ return rtw_ioctl_standard_wext_private(dev, rq); ++} ++ ++int rtw_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) ++{ ++ struct iwreq *wrq = (struct iwreq *)rq; ++ int ret = 0; ++ ++ switch (cmd) { ++ case RTL_IOCTL_WPA_SUPPLICANT: ++ ret = wpa_supplicant_ioctl(dev, &wrq->u.data); ++ break; ++#ifdef CONFIG_AP_MODE ++ case RTL_IOCTL_HOSTAPD: ++ ret = rtw_hostapd_ioctl(dev, &wrq->u.data); ++ break; ++#ifdef CONFIG_WIRELESS_EXT ++ case SIOCSIWMODE: ++ ret = rtw_wx_set_mode(dev, NULL, &wrq->u, NULL); ++ break; ++#endif ++#endif /* CONFIG_AP_MODE */ ++ case SIOCDEVPRIVATE: ++ ret = rtw_ioctl_wext_private(dev, rq); ++ break; ++ case (SIOCDEVPRIVATE+1): ++ ret = rtw_android_priv_cmd(dev, rq, cmd); ++ break; ++ default: ++ ret = -EOPNOTSUPP; ++ break; ++ } ++ ++ return ret; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_mp.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_mp.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_mp.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_mp.c 2018-02-11 21:44:27.175146513 +0200 +@@ -0,0 +1,2411 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#if defined(CONFIG_MP_INCLUDED) ++ ++#include ++#include ++#include ++#include "../../hal/phydm/phydm_precomp.h" ++ ++ ++#if defined(CONFIG_RTL8723B) ++ #include ++#endif ++ ++/* ++ * Input Format: %s,%d,%d ++ * %s is width, could be ++ * "b" for 1 byte ++ * "w" for WORD (2 bytes) ++ * "dw" for DWORD (4 bytes) ++ * 1st %d is address(offset) ++ * 2st %d is data to write ++ */ ++int rtw_mp_write_reg(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ char *pch, *pnext, *ptmp; ++ char *width_str; ++ char width, buf[5]; ++ u32 addr, data; ++ int ret; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ char input[wrqu->length]; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ _rtw_memset(extra, 0, wrqu->length); ++ ++ pch = input; ++ ++ pnext = strpbrk(pch, " ,.-"); ++ if (pnext == NULL) ++ return -EINVAL; ++ *pnext = 0; ++ width_str = pch; ++ ++ pch = pnext + 1; ++ pnext = strpbrk(pch, " ,.-"); ++ if (pnext == NULL) ++ return -EINVAL; ++ *pnext = 0; ++ /*addr = simple_strtoul(pch, &ptmp, 16); ++ _rtw_memset(buf, '\0', sizeof(buf)); ++ _rtw_memcpy(buf, pch, pnext-pch); ++ ret = kstrtoul(buf, 16, &addr);*/ ++ ret = sscanf(pch, "%x", &addr); ++ if (addr > 0x3FFF) ++ return -EINVAL; ++ ++ pch = pnext + 1; ++ pnext = strpbrk(pch, " ,.-"); ++ if ((pch - input) >= wrqu->length) ++ return -EINVAL; ++ /*data = simple_strtoul(pch, &ptmp, 16);*/ ++ ret = sscanf(pch, "%x", &data); ++ RTW_INFO("data=%x,addr=%x\n", (u32)data, (u32)addr); ++ ret = 0; ++ width = width_str[0]; ++ switch (width) { ++ case 'b': ++ /* 1 byte*/ ++ if (data > 0xFF) { ++ ret = -EINVAL; ++ break; ++ } ++ rtw_write8(padapter, addr, data); ++ break; ++ case 'w': ++ /* 2 bytes*/ ++ if (data > 0xFFFF) { ++ ret = -EINVAL; ++ break; ++ } ++ rtw_write16(padapter, addr, data); ++ break; ++ case 'd': ++ /* 4 bytes*/ ++ rtw_write32(padapter, addr, data); ++ break; ++ default: ++ ret = -EINVAL; ++ break; ++ } ++ ++ return ret; ++} ++ ++ ++/* ++ * Input Format: %s,%d ++ * %s is width, could be ++ * "b" for 1 byte ++ * "w" for WORD (2 bytes) ++ * "dw" for DWORD (4 bytes) ++ * %d is address(offset) ++ * ++ * Return: ++ * %d for data readed ++ */ ++int rtw_mp_read_reg(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ char input[wrqu->length]; ++ char *pch, *pnext, *ptmp; ++ char *width_str; ++ char width; ++ char data[20], tmp[20], buf[3]; ++ u32 addr = 0, strtout = 0; ++ u32 i = 0, j = 0, ret = 0, data32 = 0; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ ++ if (wrqu->length > 128) ++ return -EFAULT; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ _rtw_memset(extra, 0, wrqu->length); ++ _rtw_memset(data, '\0', sizeof(data)); ++ _rtw_memset(tmp, '\0', sizeof(tmp)); ++ pch = input; ++ pnext = strpbrk(pch, " ,.-"); ++ if (pnext == NULL) ++ return -EINVAL; ++ *pnext = 0; ++ width_str = pch; ++ ++ pch = pnext + 1; ++ ++ ret = sscanf(pch, "%x", &addr); ++ if (addr > 0x3FFF) ++ return -EINVAL; ++ ++ ret = 0; ++ width = width_str[0]; ++ ++ switch (width) { ++ case 'b': ++ data32 = rtw_read8(padapter, addr); ++ RTW_INFO("%x\n", data32); ++ sprintf(extra, "%d", data32); ++ wrqu->length = strlen(extra); ++ break; ++ case 'w': ++ /* 2 bytes*/ ++ sprintf(data, "%04x\n", rtw_read16(padapter, addr)); ++ ++ for (i = 0 ; i <= strlen(data) ; i++) { ++ if (i % 2 == 0) { ++ tmp[j] = ' '; ++ j++; ++ } ++ if (data[i] != '\0') ++ tmp[j] = data[i]; ++ ++ j++; ++ } ++ pch = tmp; ++ RTW_INFO("pch=%s", pch); ++ ++ while (*pch != '\0') { ++ pnext = strpbrk(pch, " "); ++ if (!pnext || ((pnext - tmp) > 4)) ++ break; ++ ++ pnext++; ++ if (*pnext != '\0') { ++ /*strtout = simple_strtoul(pnext , &ptmp, 16);*/ ++ ret = sscanf(pnext, "%x", &strtout); ++ sprintf(extra, "%s %d" , extra , strtout); ++ } else ++ break; ++ pch = pnext; ++ } ++ wrqu->length = strlen(extra); ++ break; ++ case 'd': ++ /* 4 bytes */ ++ sprintf(data, "%08x", rtw_read32(padapter, addr)); ++ /*add read data format blank*/ ++ for (i = 0 ; i <= strlen(data) ; i++) { ++ if (i % 2 == 0) { ++ tmp[j] = ' '; ++ j++; ++ } ++ if (data[i] != '\0') ++ tmp[j] = data[i]; ++ ++ j++; ++ } ++ pch = tmp; ++ RTW_INFO("pch=%s", pch); ++ ++ while (*pch != '\0') { ++ pnext = strpbrk(pch, " "); ++ if (!pnext) ++ break; ++ ++ pnext++; ++ if (*pnext != '\0') { ++ ret = sscanf(pnext, "%x", &strtout); ++ sprintf(extra, "%s %d" , extra , strtout); ++ } else ++ break; ++ pch = pnext; ++ } ++ wrqu->length = strlen(extra); ++ break; ++ ++ default: ++ wrqu->length = 0; ++ ret = -EINVAL; ++ break; ++ } ++ ++ return ret; ++} ++ ++ ++/* ++ * Input Format: %d,%x,%x ++ * %d is RF path, should be smaller than MAX_RF_PATH_NUMS ++ * 1st %x is address(offset) ++ * 2st %x is data to write ++ */ ++int rtw_mp_write_rf(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ ++ u32 path, addr, data; ++ int ret; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ char input[wrqu->length]; ++ ++ ++ _rtw_memset(input, 0, wrqu->length); ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ ++ ret = sscanf(input, "%d,%x,%x", &path, &addr, &data); ++ if (ret < 3) ++ return -EINVAL; ++ ++ if (path >= GET_HAL_RFPATH_NUM(padapter)) ++ return -EINVAL; ++ if (addr > 0xFF) ++ return -EINVAL; ++ if (data > 0xFFFFF) ++ return -EINVAL; ++ ++ _rtw_memset(extra, 0, wrqu->length); ++ ++ write_rfreg(padapter, path, addr, data); ++ ++ sprintf(extra, "write_rf completed\n"); ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++ ++/* ++ * Input Format: %d,%x ++ * %d is RF path, should be smaller than MAX_RF_PATH_NUMS ++ * %x is address(offset) ++ * ++ * Return: ++ * %d for data readed ++ */ ++int rtw_mp_read_rf(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ char input[wrqu->length]; ++ char *pch, *pnext, *ptmp; ++ char data[20], tmp[20], buf[3]; ++ u32 path, addr, strtou; ++ u32 ret, i = 0 , j = 0; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ if (wrqu->length > 128) ++ return -EFAULT; ++ _rtw_memset(input, 0, wrqu->length); ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ ret = sscanf(input, "%d,%x", &path, &addr); ++ if (ret < 2) ++ return -EINVAL; ++ ++ if (path >= GET_HAL_RFPATH_NUM(padapter)) ++ return -EINVAL; ++ if (addr > 0xFF) ++ return -EINVAL; ++ ++ _rtw_memset(extra, 0, wrqu->length); ++ ++ sprintf(data, "%08x", read_rfreg(padapter, path, addr)); ++ /*add read data format blank*/ ++ for (i = 0 ; i <= strlen(data) ; i++) { ++ if (i % 2 == 0) { ++ tmp[j] = ' '; ++ j++; ++ } ++ tmp[j] = data[i]; ++ j++; ++ } ++ pch = tmp; ++ RTW_INFO("pch=%s", pch); ++ ++ while (*pch != '\0') { ++ pnext = strpbrk(pch, " "); ++ if (!pnext) ++ break; ++ pnext++; ++ if (*pnext != '\0') { ++ /*strtou =simple_strtoul(pnext , &ptmp, 16);*/ ++ ret = sscanf(pnext, "%x", &strtou); ++ sprintf(extra, "%s %d" , extra , strtou); ++ } else ++ break; ++ pch = pnext; ++ } ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++ ++int rtw_mp_start(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u8 val8; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct hal_ops *pHalFunc = &padapter->HalFunc; ++ ++ rtw_pm_set_ips(padapter, IPS_NONE); ++ LeaveAllPowerSaveMode(padapter); ++ ++ if (rtw_mi_check_fwstate(padapter, _FW_UNDER_SURVEY)) ++ rtw_mi_scan_abort(padapter, _FALSE); ++ ++ if (padapter->registrypriv.mp_mode == 0) { ++ rtw_hal_deinit(padapter); ++ padapter->registrypriv.mp_mode = 1; ++#ifdef CONFIG_RF_POWER_TRIM ++ if (!IS_HARDWARE_TYPE_8814A(padapter) && !IS_HARDWARE_TYPE_8822B(padapter)) { ++ padapter->registrypriv.RegPwrTrimEnable = 1; ++ rtw_hal_read_chip_info(padapter); ++ } ++#endif /*CONFIG_RF_POWER_TRIM*/ ++ rtw_hal_init(padapter); ++ } ++ ++ if (padapter->registrypriv.mp_mode == 0) ++ return -EPERM; ++ ++ if (padapter->mppriv.mode == MP_OFF) { ++ if (mp_start_test(padapter) == _FAIL) ++ return -EPERM; ++ padapter->mppriv.mode = MP_ON; ++ MPT_PwrCtlDM(padapter, 0); ++ } ++ padapter->mppriv.bmac_filter = _FALSE; ++#ifdef CONFIG_RTL8723B ++#ifdef CONFIG_USB_HCI ++ rtw_write32(padapter, 0x765, 0x0000); ++ rtw_write32(padapter, 0x948, 0x0280); ++#else ++ rtw_write32(padapter, 0x765, 0x0000); ++ rtw_write32(padapter, 0x948, 0x0000); ++#endif ++#ifdef CONFIG_FOR_RTL8723BS_VQ0 ++ rtw_write32(padapter, 0x765, 0x0000); ++ rtw_write32(padapter, 0x948, 0x0280); ++#endif ++ rtw_write8(padapter, 0x66, 0x27); /*Open BT uart Log*/ ++ rtw_write8(padapter, 0xc50, 0x20); /*for RX init Gain*/ ++#endif ++ ODM_Write_DIG(&pHalData->odmpriv, 0x20); ++ ++ _rtw_memset(extra, 0, wrqu->length); ++ sprintf(extra, "mp_start ok\n"); ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++ ++ ++int rtw_mp_stop(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ struct hal_ops *pHalFunc = &padapter->HalFunc; ++ ++ if (padapter->registrypriv.mp_mode == 1) { ++ ++ MPT_DeInitAdapter(padapter); ++ pHalFunc->hal_deinit(padapter); ++ padapter->registrypriv.mp_mode = 0; ++ pHalFunc->hal_init(padapter); ++ } ++ ++ if (padapter->mppriv.mode != MP_OFF) { ++ mp_stop_test(padapter); ++ padapter->mppriv.mode = MP_OFF; ++ } ++ _rtw_memset(extra, 0, wrqu->length); ++ sprintf(extra, "mp_stop ok\n"); ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++ ++int rtw_mp_rate(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u32 rate = MPT_RATE_1M; ++ u8 input[wrqu->length]; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ rate = rtw_mpRateParseFunc(padapter, input); ++ padapter->mppriv.rateidx = rate; ++ ++ if (rate == 0 && strcmp(input, "1M") != 0) { ++ rate = rtw_atoi(input); ++ padapter->mppriv.rateidx = MRateToHwRate(rate); ++ /*if (rate <= 0x7f) ++ rate = wifirate2_ratetbl_inx((u8)rate); ++ else if (rate < 0xC8) ++ rate = (rate - 0x79 + MPT_RATE_MCS0); ++ HT rate 0x80(MCS0) ~ 0x8F(MCS15) ~ 0x9F(MCS31) 128~159 ++ VHT1SS~2SS rate 0xA0 (VHT1SS_MCS0 44) ~ 0xB3 (VHT2SS_MCS9 #63) 160~179 ++ VHT rate 0xB4 (VHT3SS_MCS0 64) ~ 0xC7 (VHT2SS_MCS9 #83) 180~199 ++ else ++ VHT rate 0x90(VHT1SS_MCS0) ~ 0x99(VHT1SS_MCS9) 144~153 ++ rate =(rate - MPT_RATE_VHT1SS_MCS0); ++ */ ++ } ++ _rtw_memset(extra, 0, wrqu->length); ++ ++ sprintf(extra, "Set data rate to %s index %d" , input, padapter->mppriv.rateidx); ++ RTW_INFO("%s: %s rate index=%d\n", __func__, input, padapter->mppriv.rateidx); ++ ++ if (padapter->mppriv.rateidx >= DESC_RATEVHTSS4MCS9) ++ return -EINVAL; ++ ++ pMptCtx->MptRateIndex = HwRateToMPTRate(padapter->mppriv.rateidx); ++ SetDataRate(padapter); ++ ++ wrqu->length = strlen(extra); ++ return 0; ++} ++ ++ ++int rtw_mp_channel(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 input[wrqu->length]; ++ u32 channel = 1; ++ int cur_ch_offset; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ channel = rtw_atoi(input); ++ /*RTW_INFO("%s: channel=%d\n", __func__, channel);*/ ++ _rtw_memset(extra, 0, wrqu->length); ++ sprintf(extra, "Change channel %d to channel %d", padapter->mppriv.channel , channel); ++ padapter->mppriv.channel = channel; ++ SetChannel(padapter); ++ pHalData->CurrentChannel = channel; ++ ++ wrqu->length = strlen(extra); ++ return 0; ++} ++ ++ ++int rtw_mp_bandwidth(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u32 bandwidth = 0, sg = 0; ++ int cur_ch_offset; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 input[wrqu->length]; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ if (sscanf(input, "40M=%d,shortGI=%d", &bandwidth, &sg) > 0) ++ RTW_INFO("%s: bw=%d sg=%d\n", __func__, bandwidth , sg); ++ ++ if (bandwidth == 1) ++ bandwidth = CHANNEL_WIDTH_40; ++ else if (bandwidth == 2) ++ bandwidth = CHANNEL_WIDTH_80; ++ ++ padapter->mppriv.bandwidth = (u8)bandwidth; ++ padapter->mppriv.preamble = sg; ++ _rtw_memset(extra, 0, wrqu->length); ++ sprintf(extra, "Change BW %d to BW %d\n", pHalData->CurrentChannelBW , bandwidth); ++ ++ SetBandwidth(padapter); ++ pHalData->CurrentChannelBW = bandwidth; ++ /*cur_ch_offset = rtw_get_offset_by_ch(padapter->mppriv.channel);*/ ++ /*set_channel_bwmode(padapter, padapter->mppriv.channel, cur_ch_offset, bandwidth);*/ ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++ ++int rtw_mp_txpower_index(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ char input[wrqu->length]; ++ u32 rfpath; ++ u32 txpower_inx; ++ ++ if (wrqu->length > 128) ++ return -EFAULT; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ rfpath = rtw_atoi(input); ++ txpower_inx = mpt_ProQueryCalTxPower(padapter, rfpath); ++ sprintf(extra, " %d", txpower_inx); ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++ ++int rtw_mp_txpower(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u32 idx_a = 0, idx_b = 0, idx_c = 0, idx_d = 0, status = 0; ++ int MsetPower = 1; ++ u8 input[wrqu->length]; ++ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ MsetPower = strncmp(input, "off", 3); ++ if (MsetPower == 0) { ++ padapter->mppriv.bSetTxPower = 0; ++ sprintf(extra, "MP Set power off"); ++ } else { ++ if (sscanf(input, "patha=%d,pathb=%d,pathc=%d,pathd=%d", &idx_a, &idx_b, &idx_c, &idx_d) < 3) ++ RTW_INFO("Invalid format on line %s ,patha=%d,pathb=%d,pathc=%d,pathd=%d\n", input , idx_a , idx_b , idx_c , idx_d); ++ ++ sprintf(extra, "Set power level path_A:%d path_B:%d path_C:%d path_D:%d", idx_a , idx_b , idx_c , idx_d); ++ padapter->mppriv.txpoweridx = (u8)idx_a; ++ ++ pMptCtx->TxPwrLevel[ODM_RF_PATH_A] = (u8)idx_a; ++ pMptCtx->TxPwrLevel[ODM_RF_PATH_B] = (u8)idx_b; ++ pMptCtx->TxPwrLevel[ODM_RF_PATH_C] = (u8)idx_c; ++ pMptCtx->TxPwrLevel[ODM_RF_PATH_D] = (u8)idx_d; ++ padapter->mppriv.bSetTxPower = 1; ++ ++ SetTxPower(padapter); ++ } ++ ++ wrqu->length = strlen(extra); ++ return 0; ++} ++ ++ ++int rtw_mp_ant_tx(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u8 i; ++ u8 input[wrqu->length]; ++ u16 antenna = 0; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ sprintf(extra, "switch Tx antenna to %s", input); ++ ++ for (i = 0; i < strlen(input); i++) { ++ switch (input[i]) { ++ case 'a': ++ antenna |= ANTENNA_A; ++ break; ++ case 'b': ++ antenna |= ANTENNA_B; ++ break; ++ case 'c': ++ antenna |= ANTENNA_C; ++ break; ++ case 'd': ++ antenna |= ANTENNA_D; ++ break; ++ } ++ } ++ /*antenna |= BIT(extra[i]-'a');*/ ++ RTW_INFO("%s: antenna=0x%x\n", __func__, antenna); ++ padapter->mppriv.antenna_tx = antenna; ++ padapter->mppriv.antenna_rx = antenna; ++ /*RTW_INFO("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_tx);*/ ++ pHalData->AntennaTxPath = antenna; ++ ++ SetAntenna(padapter); ++ ++ wrqu->length = strlen(extra); ++ return 0; ++} ++ ++ ++int rtw_mp_ant_rx(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u8 i; ++ u16 antenna = 0; ++ u8 input[wrqu->length]; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ /*RTW_INFO("%s: input=%s\n", __func__, input);*/ ++ _rtw_memset(extra, 0, wrqu->length); ++ ++ sprintf(extra, "switch Rx antenna to %s", input); ++ ++ for (i = 0; i < strlen(input); i++) { ++ switch (input[i]) { ++ case 'a': ++ antenna |= ANTENNA_A; ++ break; ++ case 'b': ++ antenna |= ANTENNA_B; ++ break; ++ case 'c': ++ antenna |= ANTENNA_C; ++ break; ++ case 'd': ++ antenna |= ANTENNA_D; ++ break; ++ } ++ } ++ ++ RTW_INFO("%s: antenna=0x%x\n", __func__, antenna); ++ padapter->mppriv.antenna_tx = antenna; ++ padapter->mppriv.antenna_rx = antenna; ++ pHalData->AntennaRxPath = antenna; ++ /*RTW_INFO("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_rx);*/ ++ SetAntenna(padapter); ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++ ++int rtw_set_ctx_destAddr(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ int jj, kk = 0; ++ ++ struct pkt_attrib *pattrib; ++ struct mp_priv *pmp_priv; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ pmp_priv = &padapter->mppriv; ++ pattrib = &pmp_priv->tx.attrib; ++ ++ if (strlen(extra) < 5) ++ return _FAIL; ++ ++ RTW_INFO("%s: in=%s\n", __func__, extra); ++ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) ++ pattrib->dst[jj] = key_2char2num(extra[kk], extra[kk + 1]); ++ ++ RTW_INFO("pattrib->dst:%x %x %x %x %x %x\n", pattrib->dst[0], pattrib->dst[1], pattrib->dst[2], pattrib->dst[3], pattrib->dst[4], pattrib->dst[5]); ++ return 0; ++} ++ ++ ++ ++int rtw_mp_ctx(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u32 pkTx = 1; ++ int countPkTx = 1, cotuTx = 1, CarrSprTx = 1, scTx = 1, sgleTx = 1, stop = 1; ++ u32 bStartTest = 1; ++ u32 count = 0, pktinterval = 0, pktlen = 0; ++ u8 status; ++ struct mp_priv *pmp_priv; ++ struct pkt_attrib *pattrib; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ pmp_priv = &padapter->mppriv; ++ pattrib = &pmp_priv->tx.attrib; ++ ++ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ RTW_INFO("%s: in=%s\n", __func__, extra); ++#ifdef CONFIG_CONCURRENT_MODE ++ if (!is_primary_adapter(padapter)) { ++ sprintf(extra, "Error: MP mode can't support Virtual Adapter, Please to use main Adapter.\n"); ++ wrqu->length = strlen(extra); ++ return 0; ++ } ++#endif ++ countPkTx = strncmp(extra, "count=", 5); /* strncmp TRUE is 0*/ ++ cotuTx = strncmp(extra, "background", 20); ++ CarrSprTx = strncmp(extra, "background,cs", 20); ++ scTx = strncmp(extra, "background,sc", 20); ++ sgleTx = strncmp(extra, "background,stone", 20); ++ pkTx = strncmp(extra, "background,pkt", 20); ++ stop = strncmp(extra, "stop", 4); ++ if (sscanf(extra, "count=%d,pkt", &count) > 0) ++ RTW_INFO("count= %d\n", count); ++ if (sscanf(extra, "pktinterval=%d", &pktinterval) > 0) ++ RTW_INFO("pktinterval= %d\n", pktinterval); ++ ++ if (sscanf(extra, "pktlen=%d", &pktlen) > 0) ++ RTW_INFO("pktlen= %d\n", pktlen); ++ ++ if (_rtw_memcmp(extra, "destmac=", 8)) { ++ wrqu->length -= 8; ++ rtw_set_ctx_destAddr(dev, info, wrqu, &extra[8]); ++ sprintf(extra, "Set dest mac OK !\n"); ++ return 0; ++ } ++ ++ /*RTW_INFO("%s: count=%d countPkTx=%d cotuTx=%d CarrSprTx=%d scTx=%d sgleTx=%d pkTx=%d stop=%d\n", __func__, count, countPkTx, cotuTx, CarrSprTx, pkTx, sgleTx, scTx, stop);*/ ++ _rtw_memset(extra, '\0', strlen(extra)); ++ ++ if (pktinterval != 0) { ++ sprintf(extra, "Pkt Interval = %d", pktinterval); ++ padapter->mppriv.pktInterval = pktinterval; ++ wrqu->length = strlen(extra); ++ return 0; ++ } ++ if (pktlen != 0) { ++ sprintf(extra, "Pkt len = %d", pktlen); ++ pattrib->pktlen = pktlen; ++ wrqu->length = strlen(extra); ++ return 0; ++ } ++ if (stop == 0) { ++ bStartTest = 0; /* To set Stop*/ ++ pmp_priv->tx.stop = 1; ++ sprintf(extra, "Stop continuous Tx"); ++ ODM_Write_DIG(&pHalData->odmpriv, 0x20); ++ } else { ++ bStartTest = 1; ++ ODM_Write_DIG(&pHalData->odmpriv, 0x7f); ++ if (pmp_priv->mode != MP_ON) { ++ if (pmp_priv->tx.stop != 1) { ++ RTW_INFO("%s: MP_MODE != ON %d\n", __func__, pmp_priv->mode); ++ return -EFAULT; ++ } ++ } ++ } ++ ++ pmp_priv->tx.count = count; ++ ++ if (pkTx == 0 || countPkTx == 0) ++ pmp_priv->mode = MP_PACKET_TX; ++ if (sgleTx == 0) ++ pmp_priv->mode = MP_SINGLE_TONE_TX; ++ if (cotuTx == 0) ++ pmp_priv->mode = MP_CONTINUOUS_TX; ++ if (CarrSprTx == 0) ++ pmp_priv->mode = MP_CARRIER_SUPPRISSION_TX; ++ if (scTx == 0) ++ pmp_priv->mode = MP_SINGLE_CARRIER_TX; ++ ++ status = rtw_mp_pretx_proc(padapter, bStartTest, extra); ++ ++ wrqu->length = strlen(extra); ++ return status; ++} ++ ++ ++ ++int rtw_mp_disable_bt_coexist(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct hal_ops *pHalFunc = &padapter->HalFunc; ++ ++ u8 input[wrqu->data.length]; ++ u32 bt_coexist; ++ ++ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) ++ return -EFAULT; ++ ++ bt_coexist = rtw_atoi(input); ++ ++ if (bt_coexist == 0) { ++ RTW_INFO("Set OID_RT_SET_DISABLE_BT_COEXIST: disable BT_COEXIST\n"); ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_HaltNotify(padapter); ++ rtw_btcoex_SetManualControl(padapter, _TRUE); ++ /* Force to switch Antenna to WiFi*/ ++ rtw_write16(padapter, 0x870, 0x300); ++ rtw_write16(padapter, 0x860, 0x110); ++#endif ++ /* CONFIG_BT_COEXIST */ ++ } else { ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_SetManualControl(padapter, _FALSE); ++#endif ++ } ++ ++ return 0; ++} ++ ++ ++int rtw_mp_arx(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ int bStartRx = 0, bStopRx = 0, bQueryPhy = 0, bQueryMac = 0, bSetBssid = 0; ++ int bmac_filter = 0, bfilter_init = 0, bmon = 0, bSmpCfg = 0, bloopbk = 0; ++ u8 input[wrqu->length]; ++ char *pch, *ptmp, *token, *tmp[2] = {0x00, 0x00}; ++ u32 i = 0, ii = 0, jj = 0, kk = 0, cnts = 0, ret; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ struct mp_priv *pmppriv = &padapter->mppriv; ++ struct dbg_rx_counter rx_counter; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ RTW_INFO("%s: %s\n", __func__, input); ++#ifdef CONFIG_CONCURRENT_MODE ++ if (!is_primary_adapter(padapter)) { ++ sprintf(extra, "Error: MP mode can't support Virtual Adapter, Please to use main Adapter.\n"); ++ wrqu->length = strlen(extra); ++ return 0; ++ } ++#endif ++ bStartRx = (strncmp(input, "start", 5) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ ++ bStopRx = (strncmp(input, "stop", 5) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ ++ bQueryPhy = (strncmp(input, "phy", 3) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ ++ bQueryMac = (strncmp(input, "mac", 3) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ ++ bSetBssid = (strncmp(input, "setbssid=", 8) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ ++ /*bfilter_init = (strncmp(input, "filter_init",11)==0)?1:0;*/ ++ bmac_filter = (strncmp(input, "accept_mac", 10) == 0) ? 1 : 0; ++ bmon = (strncmp(input, "mon=", 4) == 0) ? 1 : 0; ++ bSmpCfg = (strncmp(input , "smpcfg=" , 7) == 0) ? 1 : 0; ++ pmppriv->bloopback = (strncmp(input, "loopbk", 6) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ ++ ++ if (bSetBssid == 1) { ++ pch = input; ++ while ((token = strsep(&pch, "=")) != NULL) { ++ if (i > 1) ++ break; ++ tmp[i] = token; ++ i++; ++ } ++ if ((tmp[0] != NULL) && (tmp[1] != NULL)) { ++ cnts = strlen(tmp[1]) / 2; ++ if (cnts < 1) ++ return -EFAULT; ++ RTW_INFO("%s: cnts=%d\n", __func__, cnts); ++ RTW_INFO("%s: data=%s\n", __func__, tmp[1]); ++ for (jj = 0, kk = 0; jj < cnts ; jj++, kk += 2) { ++ pmppriv->network_macaddr[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); ++ RTW_INFO("network_macaddr[%d]=%x\n", jj, pmppriv->network_macaddr[jj]); ++ } ++ } else ++ return -EFAULT; ++ ++ pmppriv->bSetRxBssid = _TRUE; ++ } ++ ++ if (bmac_filter) { ++ pmppriv->bmac_filter = bmac_filter; ++ pch = input; ++ while ((token = strsep(&pch, "=")) != NULL) { ++ if (i > 1) ++ break; ++ tmp[i] = token; ++ i++; ++ } ++ if ((tmp[0] != NULL) && (tmp[1] != NULL)) { ++ cnts = strlen(tmp[1]) / 2; ++ if (cnts < 1) ++ return -EFAULT; ++ RTW_INFO("%s: cnts=%d\n", __func__, cnts); ++ RTW_INFO("%s: data=%s\n", __func__, tmp[1]); ++ for (jj = 0, kk = 0; jj < cnts ; jj++, kk += 2) { ++ pmppriv->mac_filter[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); ++ RTW_INFO("%s mac_filter[%d]=%x\n", __func__, jj, pmppriv->mac_filter[jj]); ++ } ++ } else ++ return -EFAULT; ++ ++ } ++ ++ if (bStartRx) { ++ sprintf(extra, "start"); ++ SetPacketRx(padapter, bStartRx, _FALSE); ++ } else if (bStopRx) { ++ SetPacketRx(padapter, bStartRx, _FALSE); ++ pmppriv->bmac_filter = _FALSE; ++ pmppriv->bSetRxBssid = _FALSE; ++ sprintf(extra, "Received packet OK:%d CRC error:%d ,Filter out:%d", padapter->mppriv.rx_pktcount, padapter->mppriv.rx_crcerrpktcount, padapter->mppriv.rx_pktcount_filter_out); ++ } else if (bQueryPhy) { ++ _rtw_memset(&rx_counter, 0, sizeof(struct dbg_rx_counter)); ++ rtw_dump_phy_rx_counters(padapter, &rx_counter); ++ ++ RTW_INFO("%s: OFDM_FA =%d\n", __func__, rx_counter.rx_ofdm_fa); ++ RTW_INFO("%s: CCK_FA =%d\n", __func__, rx_counter.rx_cck_fa); ++ sprintf(extra, "Phy Received packet OK:%d CRC error:%d FA Counter: %d", rx_counter.rx_pkt_ok, rx_counter.rx_pkt_crc_error, rx_counter.rx_cck_fa + rx_counter.rx_ofdm_fa); ++ ++ ++ } else if (bQueryMac) { ++ _rtw_memset(&rx_counter, 0, sizeof(struct dbg_rx_counter)); ++ rtw_dump_mac_rx_counters(padapter, &rx_counter); ++ sprintf(extra, "Mac Received packet OK: %d , CRC error: %d , Drop Packets: %d\n", ++ rx_counter.rx_pkt_ok, rx_counter.rx_pkt_crc_error, rx_counter.rx_pkt_drop); ++ ++ } ++ ++ if (bmon == 1) { ++ ret = sscanf(input, "mon=%d", &bmon); ++ ++ if (bmon == 1) { ++ pmppriv->rx_bindicatePkt = _TRUE; ++ sprintf(extra, "Indicating Receive Packet to network start\n"); ++ } else { ++ pmppriv->rx_bindicatePkt = _FALSE; ++ sprintf(extra, "Indicating Receive Packet to network Stop\n"); ++ } ++ } ++ if (bSmpCfg == 1) { ++ ret = sscanf(input, "smpcfg=%d", &bSmpCfg); ++ ++ if (bSmpCfg == 1) { ++ pmppriv->bRTWSmbCfg = _TRUE; ++ sprintf(extra , "Indicate By Simple Config Format\n"); ++ SetPacketRx(padapter, _TRUE, _TRUE); ++ } else { ++ pmppriv->bRTWSmbCfg = _FALSE; ++ sprintf(extra , "Indicate By Normal Format\n"); ++ SetPacketRx(padapter, _TRUE, _FALSE); ++ } ++ } ++ ++ if (pmppriv->bloopback == _TRUE) { ++ sprintf(extra , "Enter MAC LoopBack mode\n"); ++ _rtw_write32(padapter, 0x100, 0xB0106FF); ++ RTW_INFO("0x100 :0x%x" , _rtw_read32(padapter, 0x100)); ++ _rtw_write16(padapter, 0x608, 0x30c); ++ RTW_INFO("0x100 :0x%x" , _rtw_read32(padapter, 0x608)); ++ } ++ ++ wrqu->length = strlen(extra) + 1; ++ ++ return 0; ++} ++ ++ ++int rtw_mp_trx_query(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u32 txok, txfail, rxok, rxfail, rxfilterout; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); ++ RT_PMAC_TX_INFO PMacTxInfo = pMptCtx->PMacTxInfo; ++ ++ if (PMacTxInfo.bEnPMacTx == TRUE) ++ txok = hal_mpt_query_phytxok(padapter); ++ else ++ txok = padapter->mppriv.tx.sended; ++ ++ txfail = 0; ++ rxok = padapter->mppriv.rx_pktcount; ++ rxfail = padapter->mppriv.rx_crcerrpktcount; ++ rxfilterout = padapter->mppriv.rx_pktcount_filter_out; ++ ++ _rtw_memset(extra, '\0', 128); ++ ++ sprintf(extra, "Tx OK:%d, Tx Fail:%d, Rx OK:%d, CRC error:%d ,Rx Filter out:%d\n", txok, txfail, rxok, rxfail, rxfilterout); ++ ++ wrqu->length = strlen(extra) + 1; ++ ++ return 0; ++} ++ ++ ++int rtw_mp_pwrtrk(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u8 enable; ++ u32 thermal; ++ s32 ret; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 input[wrqu->length]; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ _rtw_memset(extra, 0, wrqu->length); ++ ++ enable = 1; ++ if (wrqu->length > 1) { ++ /* not empty string*/ ++ if (strncmp(input, "stop", 4) == 0) { ++ enable = 0; ++ sprintf(extra, "mp tx power tracking stop"); ++ } else if (sscanf(input, "ther=%d", &thermal) == 1) { ++ ret = SetThermalMeter(padapter, (u8)thermal); ++ if (ret == _FAIL) ++ return -EPERM; ++ sprintf(extra, "mp tx power tracking start,target value=%d ok", thermal); ++ } else ++ return -EINVAL; ++ } ++ ++ ret = SetPowerTracking(padapter, enable); ++ if (ret == _FAIL) ++ return -EPERM; ++ ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++ ++ ++int rtw_mp_psd(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ u8 input[wrqu->length]; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ strcpy(extra, input); ++ ++ wrqu->length = mp_query_psd(padapter, extra); ++ ++ return 0; ++} ++ ++ ++int rtw_mp_thermal(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u8 val; ++ int bwrite = 1; ++ ++#ifdef CONFIG_RTL8188E ++ u16 addr = EEPROM_THERMAL_METER_88E; ++#endif ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) ++ u16 addr = EEPROM_THERMAL_METER_8812; ++#endif ++#ifdef CONFIG_RTL8192E ++ u16 addr = EEPROM_THERMAL_METER_8192E; ++#endif ++#ifdef CONFIG_RTL8723B ++ u16 addr = EEPROM_THERMAL_METER_8723B; ++#endif ++#ifdef CONFIG_RTL8703B ++ u16 addr = EEPROM_THERMAL_METER_8703B; ++#endif ++#ifdef CONFIG_RTL8723D ++ u16 addr = EEPROM_THERMAL_METER_8723D; ++#endif ++#ifdef CONFIG_RTL8188F ++ u16 addr = EEPROM_THERMAL_METER_8188F; ++#endif ++#ifdef CONFIG_RTL8822B ++ u16 addr = EEPROM_THERMAL_METER_8822B; ++#endif ++#ifdef CONFIG_RTL8821C ++ u16 addr = EEPROM_THERMAL_METER_8821C; ++#endif ++ u16 cnt = 1; ++ u16 max_available_size = 0; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ bwrite = strncmp(extra, "write", 6);/* strncmp TRUE is 0*/ ++ ++ GetThermalMeter(padapter, &val); ++ ++ if (bwrite == 0) { ++ /*RTW_INFO("to write val:%d",val);*/ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); ++ if (2 > max_available_size) { ++ RTW_INFO("no available efuse!\n"); ++ return -EFAULT; ++ } ++ if (rtw_efuse_map_write(padapter, addr, cnt, &val) == _FAIL) { ++ RTW_INFO("rtw_efuse_map_write error\n"); ++ return -EFAULT; ++ } ++ sprintf(extra, " efuse write ok :%d", val); ++ } else ++ sprintf(extra, "%d", val); ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++ ++ ++int rtw_mp_reset_stats(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ struct mp_priv *pmp_priv; ++ struct pkt_attrib *pattrib; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ pmp_priv = &padapter->mppriv; ++ ++ pmp_priv->tx.sended = 0; ++ pmp_priv->tx_pktcount = 0; ++ pmp_priv->rx_pktcount = 0; ++ pmp_priv->rx_pktcount_filter_out = 0; ++ pmp_priv->rx_crcerrpktcount = 0; ++ ++ rtw_reset_phy_rx_counters(padapter); ++ rtw_reset_mac_rx_counters(padapter); ++ ++ _rtw_memset(extra, 0, wrqu->length); ++ sprintf(extra, "mp_reset_stats ok\n"); ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++ ++int rtw_mp_dump(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ struct mp_priv *pmp_priv; ++ struct pkt_attrib *pattrib; ++ u32 value; ++ u8 input[wrqu->length]; ++ u8 rf_type, path_nums = 0; ++ u32 i, j = 1, path; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ pmp_priv = &padapter->mppriv; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ if (strncmp(input, "all", 4) == 0) { ++ mac_reg_dump(RTW_DBGDUMP, padapter); ++ bb_reg_dump(RTW_DBGDUMP, padapter); ++ rf_reg_dump(RTW_DBGDUMP, padapter); ++ } ++ return 0; ++} ++ ++ ++int rtw_mp_phypara(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ char input[wrqu->length]; ++ u32 valxcap, ret; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ RTW_INFO("%s:iwpriv in=%s\n", __func__, input); ++ ++ ret = sscanf(input, "xcap=%d", &valxcap); ++ ++ pHalData->CrystalCap = (u8)valxcap; ++ hal_set_crystal_cap(padapter , valxcap); ++ ++ sprintf(extra, "Set xcap=%d", valxcap); ++ wrqu->length = strlen(extra) + 1; ++ ++ return 0; ++ ++} ++ ++ ++int rtw_mp_SetRFPath(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ char input[wrqu->length]; ++ int bMain = 1, bTurnoff = 1; ++ ++ RTW_INFO("%s:iwpriv in=%s\n", __func__, input); ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ bMain = strncmp(input, "1", 2); /* strncmp TRUE is 0*/ ++ bTurnoff = strncmp(input, "0", 3); /* strncmp TRUE is 0*/ ++ ++ _rtw_memset(extra, 0, wrqu->length); ++ ++ if (bMain == 0) { ++ MP_PHY_SetRFPathSwitch(padapter, _TRUE); ++ RTW_INFO("%s:PHY_SetRFPathSwitch=TRUE\n", __func__); ++ sprintf(extra, "mp_setrfpath Main\n"); ++ ++ } else if (bTurnoff == 0) { ++ MP_PHY_SetRFPathSwitch(padapter, _FALSE); ++ RTW_INFO("%s:PHY_SetRFPathSwitch=FALSE\n", __func__); ++ sprintf(extra, "mp_setrfpath Aux\n"); ++ } ++ ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++ ++int rtw_mp_QueryDrv(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ char input[wrqu->data.length]; ++ int qAutoLoad = 1; ++ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ ++ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) ++ return -EFAULT; ++ RTW_INFO("%s:iwpriv in=%s\n", __func__, input); ++ ++ qAutoLoad = strncmp(input, "autoload", 8); /* strncmp TRUE is 0*/ ++ ++ if (qAutoLoad == 0) { ++ RTW_INFO("%s:qAutoLoad\n", __func__); ++ ++ if (pHalData->bautoload_fail_flag) ++ sprintf(extra, "fail"); ++ else ++ sprintf(extra, "ok"); ++ } ++ wrqu->data.length = strlen(extra) + 1; ++ return 0; ++} ++ ++ ++int rtw_mp_PwrCtlDM(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ u8 input[wrqu->length]; ++ int bstart = 1; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ bstart = strncmp(input, "start", 5); /* strncmp TRUE is 0*/ ++ if (bstart == 0) { ++ sprintf(extra, "PwrCtlDM start\n"); ++ MPT_PwrCtlDM(padapter, 1); ++ } else { ++ sprintf(extra, "PwrCtlDM stop\n"); ++ MPT_PwrCtlDM(padapter, 0); ++ } ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++int rtw_mp_iqk(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ rtw_mp_trigger_iqk(padapter); ++ ++ return 0; ++} ++ ++int rtw_mp_lck(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ rtw_mp_trigger_lck(padapter); ++ ++ return 0; ++} ++ ++int rtw_mp_getver(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ struct mp_priv *pmp_priv; ++ ++ pmp_priv = &padapter->mppriv; ++ ++ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) ++ return -EFAULT; ++ ++ sprintf(extra, "rtwpriv=%d\n", RTWPRIV_VER_INFO); ++ wrqu->data.length = strlen(extra); ++ return 0; ++} ++ ++ ++int rtw_mp_mon(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct hal_ops *pHalFunc = &padapter->HalFunc; ++ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType; ++ int bstart = 1, bstop = 1; ++ ++ networkType = Ndis802_11Infrastructure; ++ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) ++ return -EFAULT; ++ ++ rtw_pm_set_ips(padapter, IPS_NONE); ++ LeaveAllPowerSaveMode(padapter); ++ ++#ifdef CONFIG_MP_INCLUDED ++ if (init_mp_priv(padapter) == _FAIL) ++ RTW_INFO("%s: initialize MP private data Fail!\n", __func__); ++ padapter->mppriv.channel = 6; ++ ++ bstart = strncmp(extra, "start", 5); /* strncmp TRUE is 0*/ ++ bstop = strncmp(extra, "stop", 4); /* strncmp TRUE is 0*/ ++ if (bstart == 0) { ++ mp_join(padapter, WIFI_FW_ADHOC_STATE); ++ SetPacketRx(padapter, _TRUE, _FALSE); ++ SetChannel(padapter); ++ pmp_priv->rx_bindicatePkt = _TRUE; ++ pmp_priv->bRTWSmbCfg = _TRUE; ++ sprintf(extra, "monitor mode start\n"); ++ } else if (bstop == 0) { ++ SetPacketRx(padapter, _FALSE, _FALSE); ++ pmp_priv->rx_bindicatePkt = _FALSE; ++ pmp_priv->bRTWSmbCfg = _FALSE; ++ padapter->registrypriv.mp_mode = 1; ++ pHalFunc->hal_deinit(padapter); ++ padapter->registrypriv.mp_mode = 0; ++ pHalFunc->hal_init(padapter); ++ /*rtw_disassoc_cmd(padapter, 0, _TRUE);*/ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ rtw_disassoc_cmd(padapter, 500, _TRUE); ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ /*rtw_free_assoc_resources(padapter, 1);*/ ++ } ++ rtw_pm_set_ips(padapter, IPS_NORMAL); ++ sprintf(extra, "monitor mode Stop\n"); ++ } ++#endif ++ wrqu->data.length = strlen(extra); ++ return 0; ++} ++ ++int rtw_mp_pretx_proc(PADAPTER padapter, u8 bStartTest, char *extra) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); ++ ++ switch (pmp_priv->mode) { ++ ++ case MP_PACKET_TX: ++ if (bStartTest == 0) { ++ pmp_priv->tx.stop = 1; ++ pmp_priv->mode = MP_ON; ++ sprintf(extra, "Stop continuous Tx"); ++ } else if (pmp_priv->tx.stop == 1) { ++ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500 count=%u\n", extra, pmp_priv->tx.count); ++ pmp_priv->tx.stop = 0; ++ SetPacketTx(padapter); ++ } else ++ return -EFAULT; ++ return 0; ++ case MP_SINGLE_TONE_TX: ++ if (bStartTest != 0) ++ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); ++ SetSingleToneTx(padapter, (u8)bStartTest); ++ break; ++ case MP_CONTINUOUS_TX: ++ if (bStartTest != 0) ++ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); ++ SetContinuousTx(padapter, (u8)bStartTest); ++ break; ++ case MP_CARRIER_SUPPRISSION_TX: ++ if (bStartTest != 0) { ++ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_11M) ++ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); ++ else ++ sprintf(extra, "%s\nSpecify carrier suppression but not CCK rate", extra); ++ } ++ SetCarrierSuppressionTx(padapter, (u8)bStartTest); ++ break; ++ case MP_SINGLE_CARRIER_TX: ++ if (bStartTest != 0) ++ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); ++ SetSingleCarrierTx(padapter, (u8)bStartTest); ++ break; ++ ++ default: ++ sprintf(extra, "Error! Continuous-Tx is not on-going."); ++ return -EFAULT; ++ } ++ ++ if (bStartTest == 1 && pmp_priv->mode != MP_ON) { ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ ++ if (pmp_priv->tx.stop == 0) { ++ pmp_priv->tx.stop = 1; ++ rtw_msleep_os(5); ++ } ++#ifdef CONFIG_80211N_HT ++ pmp_priv->tx.attrib.ht_en = 1; ++#endif ++ pmp_priv->tx.stop = 0; ++ pmp_priv->tx.count = 1; ++ SetPacketTx(padapter); ++ } else ++ pmp_priv->mode = MP_ON; ++ ++#if defined(CONFIG_RTL8812A) ++ if (IS_HARDWARE_TYPE_8812AU(padapter)) { ++ /* <20130425, Kordan> Turn off OFDM Rx to prevent from CCA causing Tx hang.*/ ++ if (pmp_priv->mode == MP_PACKET_TX) ++ PHY_SetBBReg(padapter, rCCAonSec_Jaguar, BIT3, 1); ++ else ++ PHY_SetBBReg(padapter, rCCAonSec_Jaguar, BIT3, 0); ++ } ++#endif ++ ++ return 0; ++} ++ ++ ++int rtw_mp_tx(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ ++ u32 bandwidth = 0, sg = 0, channel = 6, txpower = 40, rate = 108, ant = 0, txmode = 1, count = 0; ++ u8 i = 0, j = 0, bStartTest = 1, status = 0, Idx = 0, tmpU1B = 0; ++ u16 antenna = 0; ++ ++ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) ++ return -EFAULT; ++ RTW_INFO("extra = %s\n", extra); ++#ifdef CONFIG_CONCURRENT_MODE ++ if (!is_primary_adapter(padapter)) { ++ sprintf(extra, "Error: MP mode can't support Virtual Adapter, Please to use main Adapter.\n"); ++ wrqu->data.length = strlen(extra); ++ return 0; ++ } ++#endif ++ ++ if (strncmp(extra, "stop", 3) == 0) { ++ bStartTest = 0; /* To set Stop*/ ++ pmp_priv->tx.stop = 1; ++ sprintf(extra, "Stop continuous Tx"); ++ status = rtw_mp_pretx_proc(padapter, bStartTest, extra); ++ wrqu->data.length = strlen(extra); ++ return status; ++ } else if (strncmp(extra, "count", 5) == 0) { ++ if (sscanf(extra, "count=%d", &count) < 1) ++ RTW_INFO("Got Count=%d]\n", count); ++ pmp_priv->tx.count = count; ++ return 0; ++ } else if (strncmp(extra, "setting", 7) == 0) { ++ _rtw_memset(extra, 0, wrqu->data.length); ++ sprintf(extra, "Current Setting :\n Channel:%d", pmp_priv->channel); ++ sprintf(extra, "%s\n Bandwidth:%d", extra, pmp_priv->bandwidth); ++ sprintf(extra, "%s\n Rate index:%d", extra, pmp_priv->rateidx); ++ sprintf(extra, "%s\n TxPower index:%d", extra, pmp_priv->txpoweridx); ++ sprintf(extra, "%s\n Antenna TxPath:%d", extra, pmp_priv->antenna_tx); ++ sprintf(extra, "%s\n Antenna RxPath:%d", extra, pmp_priv->antenna_rx); ++ sprintf(extra, "%s\n MP Mode:%d", extra, pmp_priv->mode); ++ wrqu->data.length = strlen(extra); ++ return 0; ++#ifdef CONFIG_MP_VHT_HW_TX_MODE ++ } else if (strncmp(extra, "pmact", 5) == 0) { ++ if (strncmp(extra, "pmact=", 6) == 0) { ++ _rtw_memset(&pMptCtx->PMacTxInfo, 0, sizeof(pMptCtx->PMacTxInfo)); ++ if (strncmp(extra, "pmact=start", 11) == 0) { ++ pMptCtx->PMacTxInfo.bEnPMacTx = _TRUE; ++ sprintf(extra, "Set PMac Tx Mode start\n"); ++ } else { ++ pMptCtx->PMacTxInfo.bEnPMacTx = _FALSE; ++ sprintf(extra, "Set PMac Tx Mode Stop\n"); ++ } ++ if (pMptCtx->bldpc == TRUE) ++ pMptCtx->PMacTxInfo.bLDPC = _TRUE; ++ ++ if (pMptCtx->bstbc == TRUE) ++ pMptCtx->PMacTxInfo.bSTBC = _TRUE; ++ ++ pMptCtx->PMacTxInfo.bSPreamble = pmp_priv->preamble; ++ pMptCtx->PMacTxInfo.bSGI = pmp_priv->preamble; ++ pMptCtx->PMacTxInfo.BandWidth = pmp_priv->bandwidth; ++ pMptCtx->PMacTxInfo.TX_RATE = HwRateToMPTRate(pmp_priv->rateidx); ++ ++ pMptCtx->PMacTxInfo.Mode = pMptCtx->HWTxmode; ++ ++ pMptCtx->PMacTxInfo.NDP_sound = FALSE;/*(Adapter.PacketType == NDP_PKT)?TRUE:FALSE;*/ ++ ++ if (padapter->mppriv.pktInterval == 0) ++ pMptCtx->PMacTxInfo.PacketPeriod = 100; ++ else ++ pMptCtx->PMacTxInfo.PacketPeriod = padapter->mppriv.pktInterval; ++ ++ if (padapter->mppriv.pktLength < 1000) ++ pMptCtx->PMacTxInfo.PacketLength = 1000; ++ else ++ pMptCtx->PMacTxInfo.PacketLength = padapter->mppriv.pktLength; ++ ++ pMptCtx->PMacTxInfo.PacketPattern = rtw_random32() % 0xFF; ++ ++ if (padapter->mppriv.tx_pktcount != 0) ++ pMptCtx->PMacTxInfo.PacketCount = padapter->mppriv.tx_pktcount; ++ ++ pMptCtx->PMacTxInfo.Ntx = 0; ++ for (Idx = 16; Idx < 20; Idx++) { ++ tmpU1B = (padapter->mppriv.antenna_tx >> Idx) & 1; ++ if (tmpU1B) ++ pMptCtx->PMacTxInfo.Ntx++; ++ } ++ ++ _rtw_memset(pMptCtx->PMacTxInfo.MacAddress, 0xFF, ETH_ALEN); ++ ++ PMAC_Get_Pkt_Param(&pMptCtx->PMacTxInfo, &pMptCtx->PMacPktInfo); ++ ++ if (MPT_IS_CCK_RATE(pMptCtx->PMacTxInfo.TX_RATE)) ++ ++ CCK_generator(&pMptCtx->PMacTxInfo, &pMptCtx->PMacPktInfo); ++ else { ++ PMAC_Nsym_generator(&pMptCtx->PMacTxInfo, &pMptCtx->PMacPktInfo); ++ /* 24 BIT*/ ++ L_SIG_generator(pMptCtx->PMacPktInfo.N_sym, &pMptCtx->PMacTxInfo, &pMptCtx->PMacPktInfo); ++ } ++ /* 48BIT*/ ++ if (MPT_IS_HT_RATE(pMptCtx->PMacTxInfo.TX_RATE)) ++ HT_SIG_generator(&pMptCtx->PMacTxInfo, &pMptCtx->PMacPktInfo); ++ else if (MPT_IS_VHT_RATE(pMptCtx->PMacTxInfo.TX_RATE)) { ++ /* 48BIT*/ ++ VHT_SIG_A_generator(&pMptCtx->PMacTxInfo, &pMptCtx->PMacPktInfo); ++ ++ /* 26/27/29 BIT & CRC 8 BIT*/ ++ VHT_SIG_B_generator(&pMptCtx->PMacTxInfo); ++ ++ /* 32 BIT*/ ++ VHT_Delimiter_generator(&pMptCtx->PMacTxInfo); ++ } ++ ++ mpt_ProSetPMacTx(padapter); ++ ++ } else if (strncmp(extra, "pmact,mode=", 11) == 0) { ++ int txmode = 0; ++ ++ if (sscanf(extra, "pmact,mode=%d", &txmode) > 0) { ++ if (txmode == 1) { ++ pMptCtx->HWTxmode = CONTINUOUS_TX; ++ sprintf(extra, "\t Config HW Tx mode = CONTINUOUS_TX\n"); ++ } else if (txmode == 2) { ++ pMptCtx->HWTxmode = OFDM_Single_Tone_TX; ++ sprintf(extra, "\t Config HW Tx mode = OFDM_Single_Tone_TX\n"); ++ } else { ++ pMptCtx->HWTxmode = PACKETS_TX; ++ sprintf(extra, "\t Config HW Tx mode = PACKETS_TX\n"); ++ } ++ } else { ++ pMptCtx->HWTxmode = PACKETS_TX; ++ sprintf(extra, "\t Config HW Tx mode=\n 0 = PACKETS_TX\n 1 = CONTINUOUS_TX\n 2 = OFDM_Single_Tone_TX"); ++ } ++ } else if (strncmp(extra, "pmact,", 6) == 0) { ++ int PacketPeriod = 0, PacketLength = 0, PacketCout = 0; ++ int bldpc = 0, bstbc = 0; ++ ++ if (sscanf(extra, "pmact,period=%d", &PacketPeriod) > 0) { ++ padapter->mppriv.pktInterval = PacketPeriod; ++ RTW_INFO("PacketPeriod=%d\n", padapter->mppriv.pktInterval); ++ sprintf(extra, "PacketPeriod [1~255]= %d\n", padapter->mppriv.pktInterval); ++ ++ } else if (sscanf(extra, "pmact,length=%d", &PacketLength) > 0) { ++ padapter->mppriv.pktLength = PacketLength; ++ RTW_INFO("PacketPeriod=%d\n", padapter->mppriv.pktLength); ++ sprintf(extra, "PacketLength[~65535]=%d\n", padapter->mppriv.pktLength); ++ ++ } else if (sscanf(extra, "pmact,count=%d", &PacketCout) > 0) { ++ padapter->mppriv.tx_pktcount = PacketCout; ++ RTW_INFO("Packet Cout =%d\n", padapter->mppriv.tx_pktcount); ++ sprintf(extra, "Packet Cout =%d\n", padapter->mppriv.tx_pktcount); ++ ++ } else if (sscanf(extra, "pmact,ldpc=%d", &bldpc) > 0) { ++ pMptCtx->bldpc = bldpc; ++ RTW_INFO("Set LDPC =%d\n", pMptCtx->bldpc); ++ sprintf(extra, "Set LDPC =%d\n", pMptCtx->bldpc); ++ ++ } else if (sscanf(extra, "pmact,stbc=%d", &bstbc) > 0) { ++ pMptCtx->bstbc = bstbc; ++ RTW_INFO("Set STBC =%d\n", pMptCtx->bstbc); ++ sprintf(extra, "Set STBC =%d\n", pMptCtx->bstbc); ++ } else ++ sprintf(extra, "\n period={1~255}\n length={1000~65535}\n count={0~}\n ldpc={0/1}\n stbc={0/1}"); ++ ++ } ++ ++ wrqu->data.length = strlen(extra); ++ return 0; ++#endif ++ } else { ++ ++ if (sscanf(extra, "ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d", &channel, &bandwidth, &rate, &txpower, &ant, &txmode) < 6) { ++ RTW_INFO("Invalid format [ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d]\n", channel, bandwidth, rate, txpower, ant, txmode); ++ _rtw_memset(extra, 0, wrqu->data.length); ++ sprintf(extra, "\n Please input correct format as bleow:\n"); ++ sprintf(extra, "%s\t ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d\n", extra, channel, bandwidth, rate, txpower, ant, txmode); ++ sprintf(extra, "%s\n [ ch : BGN = <1~14> , A or AC = <36~165> ]", extra); ++ sprintf(extra, "%s\n [ bw : Bandwidth: 0 = 20M, 1 = 40M, 2 = 80M ]", extra); ++ sprintf(extra, "%s\n [ rate : CCK: 1 2 5.5 11M X 2 = < 2 4 11 22 >]", extra); ++ sprintf(extra, "%s\n [ OFDM: 6 9 12 18 24 36 48 54M X 2 = < 12 18 24 36 48 72 96 108>", extra); ++ sprintf(extra, "%s\n [ HT 1S2SS MCS0 ~ MCS15 : < [MCS0]=128 ~ [MCS7]=135 ~ [MCS15]=143 >", extra); ++ sprintf(extra, "%s\n [ HT 3SS MCS16 ~ MCS32 : < [MCS16]=144 ~ [MCS23]=151 ~ [MCS32]=159 >", extra); ++ sprintf(extra, "%s\n [ VHT 1SS MCS0 ~ MCS9 : < [MCS0]=160 ~ [MCS9]=169 >", extra); ++ sprintf(extra, "%s\n [ txpower : 1~63 power index", extra); ++ sprintf(extra, "%s\n [ ant : ,2T ex: AB=3 BC=6 CD=12", extra); ++ sprintf(extra, "%s\n [ txmode : < 0 = CONTINUOUS_TX, 1 = PACKET_TX, 2 = SINGLE_TONE_TX, 3 = CARRIER_SUPPRISSION_TX, 4 = SINGLE_CARRIER_TX>\n", extra); ++ wrqu->data.length = strlen(extra); ++ return status; ++ ++ } else { ++ RTW_INFO("Got format [ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d]\n", channel, bandwidth, rate, txpower, ant, txmode); ++ _rtw_memset(extra, 0, wrqu->data.length); ++ sprintf(extra, "Change Current channel %d to channel %d", padapter->mppriv.channel , channel); ++ padapter->mppriv.channel = channel; ++ SetChannel(padapter); ++ pHalData->CurrentChannel = channel; ++ ++ if (bandwidth == 1) ++ bandwidth = CHANNEL_WIDTH_40; ++ else if (bandwidth == 2) ++ bandwidth = CHANNEL_WIDTH_80; ++ sprintf(extra, "%s\nChange Current Bandwidth %d to Bandwidth %d", extra, padapter->mppriv.bandwidth , bandwidth); ++ padapter->mppriv.bandwidth = (u8)bandwidth; ++ padapter->mppriv.preamble = sg; ++ SetBandwidth(padapter); ++ pHalData->CurrentChannelBW = bandwidth; ++ ++ sprintf(extra, "%s\nSet power level :%d", extra, txpower); ++ padapter->mppriv.txpoweridx = (u8)txpower; ++ pMptCtx->TxPwrLevel[ODM_RF_PATH_A] = (u8)txpower; ++ pMptCtx->TxPwrLevel[ODM_RF_PATH_B] = (u8)txpower; ++ pMptCtx->TxPwrLevel[ODM_RF_PATH_C] = (u8)txpower; ++ pMptCtx->TxPwrLevel[ODM_RF_PATH_D] = (u8)txpower; ++ ++ RTW_INFO("%s: bw=%d sg=%d\n", __func__, bandwidth, sg); ++ ++ if (rate <= 0x7f) ++ rate = wifirate2_ratetbl_inx((u8)rate); ++ else if (rate < 0xC8) ++ rate = (rate - 0x80 + MPT_RATE_MCS0); ++ /*HT rate 0x80(MCS0) ~ 0x8F(MCS15) ~ 0x9F(MCS31) 128~159 ++ VHT1SS~2SS rate 0xA0 (VHT1SS_MCS0 44) ~ 0xB3 (VHT2SS_MCS9 #63) 160~179 ++ VHT rate 0xB4 (VHT3SS_MCS0 64) ~ 0xC7 (VHT2SS_MCS9 #83) 180~199 ++ else ++ VHT rate 0x90(VHT1SS_MCS0) ~ 0x99(VHT1SS_MCS9) 144~153 ++ rate =(rate - MPT_RATE_VHT1SS_MCS0); ++ */ ++ RTW_INFO("%s: rate index=%d\n", __func__, rate); ++ if (rate >= MPT_RATE_LAST) ++ return -EINVAL; ++ sprintf(extra, "%s\nSet data rate to %d index %d", extra, padapter->mppriv.rateidx, rate); ++ ++ padapter->mppriv.rateidx = rate; ++ pMptCtx->MptRateIndex = rate; ++ SetDataRate(padapter); ++ ++ sprintf(extra, "%s\nSet Antenna Path :%d", extra, ant); ++ switch (ant) { ++ case 1: ++ antenna = ANTENNA_A; ++ break; ++ case 2: ++ antenna = ANTENNA_B; ++ break; ++ case 4: ++ antenna = ANTENNA_C; ++ break; ++ case 8: ++ antenna = ANTENNA_D; ++ break; ++ case 3: ++ antenna = ANTENNA_AB; ++ break; ++ case 5: ++ antenna = ANTENNA_AC; ++ break; ++ case 9: ++ antenna = ANTENNA_AD; ++ break; ++ case 6: ++ antenna = ANTENNA_BC; ++ break; ++ case 10: ++ antenna = ANTENNA_BD; ++ break; ++ case 12: ++ antenna = ANTENNA_CD; ++ break; ++ case 7: ++ antenna = ANTENNA_ABC; ++ break; ++ case 14: ++ antenna = ANTENNA_BCD; ++ break; ++ case 11: ++ antenna = ANTENNA_ABD; ++ break; ++ case 15: ++ antenna = ANTENNA_ABCD; ++ break; ++ } ++ RTW_INFO("%s: antenna=0x%x\n", __func__, antenna); ++ padapter->mppriv.antenna_tx = antenna; ++ padapter->mppriv.antenna_rx = antenna; ++ pHalData->AntennaTxPath = antenna; ++ SetAntenna(padapter); ++ ++ if (txmode == 0) ++ pmp_priv->mode = MP_CONTINUOUS_TX; ++ else if (txmode == 1) { ++ pmp_priv->mode = MP_PACKET_TX; ++ pmp_priv->tx.count = count; ++ } else if (txmode == 2) ++ pmp_priv->mode = MP_SINGLE_TONE_TX; ++ else if (txmode == 3) ++ pmp_priv->mode = MP_CARRIER_SUPPRISSION_TX; ++ else if (txmode == 4) ++ pmp_priv->mode = MP_SINGLE_CARRIER_TX; ++ ++ status = rtw_mp_pretx_proc(padapter, bStartTest, extra); ++ } ++ ++ } ++ ++ wrqu->data.length = strlen(extra); ++ return status; ++} ++ ++ ++int rtw_mp_rx(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); ++ ++ u32 bandwidth = 0, sg = 0, channel = 6, ant = 0; ++ u16 antenna = 0; ++ u8 bStartRx = 0; ++ ++ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) ++ return -EFAULT; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (!is_primary_adapter(padapter)) { ++ sprintf(extra, "Error: MP mode can't support Virtual Adapter, Please to use main Adapter.\n"); ++ wrqu->data.length = strlen(extra); ++ return 0; ++ } ++#endif ++ ++ if (strncmp(extra, "stop", 4) == 0) { ++ _rtw_memset(extra, 0, wrqu->data.length); ++ SetPacketRx(padapter, bStartRx, _FALSE); ++ pmp_priv->bmac_filter = _FALSE; ++ sprintf(extra, "Received packet OK:%d CRC error:%d ,Filter out:%d", padapter->mppriv.rx_pktcount, padapter->mppriv.rx_crcerrpktcount, padapter->mppriv.rx_pktcount_filter_out); ++ wrqu->data.length = strlen(extra); ++ return 0; ++ ++ } else if (sscanf(extra, "ch=%d,bw=%d,ant=%d", &channel, &bandwidth, &ant) < 3) { ++ RTW_INFO("Invalid format [ch=%d,bw=%d,ant=%d]\n", channel, bandwidth, ant); ++ _rtw_memset(extra, 0, wrqu->data.length); ++ sprintf(extra, "\n Please input correct format as bleow:\n"); ++ sprintf(extra, "%s\t ch=%d,bw=%d,ant=%d\n", extra, channel, bandwidth, ant); ++ sprintf(extra, "%s\n [ ch : BGN = <1~14> , A or AC = <36~165> ]", extra); ++ sprintf(extra, "%s\n [ bw : Bandwidth: 0 = 20M, 1 = 40M, 2 = 80M ]", extra); ++ sprintf(extra, "%s\n [ ant : ,2T ex: AB=3 BC=6 CD=12", extra); ++ wrqu->data.length = strlen(extra); ++ return 0; ++ ++ } else { ++ bStartRx = 1; ++ RTW_INFO("Got format [ch=%d,bw=%d,ant=%d]\n", channel, bandwidth, ant); ++ _rtw_memset(extra, 0, wrqu->data.length); ++ sprintf(extra, "Change Current channel %d to channel %d", padapter->mppriv.channel , channel); ++ padapter->mppriv.channel = channel; ++ SetChannel(padapter); ++ pHalData->CurrentChannel = channel; ++ ++ if (bandwidth == 1) ++ bandwidth = CHANNEL_WIDTH_40; ++ else if (bandwidth == 2) ++ bandwidth = CHANNEL_WIDTH_80; ++ sprintf(extra, "%s\nChange Current Bandwidth %d to Bandwidth %d", extra, padapter->mppriv.bandwidth , bandwidth); ++ padapter->mppriv.bandwidth = (u8)bandwidth; ++ padapter->mppriv.preamble = sg; ++ SetBandwidth(padapter); ++ pHalData->CurrentChannelBW = bandwidth; ++ ++ sprintf(extra, "%s\nSet Antenna Path :%d", extra, ant); ++ switch (ant) { ++ case 1: ++ antenna = ANTENNA_A; ++ break; ++ case 2: ++ antenna = ANTENNA_B; ++ break; ++ case 4: ++ antenna = ANTENNA_C; ++ break; ++ case 8: ++ antenna = ANTENNA_D; ++ break; ++ case 3: ++ antenna = ANTENNA_AB; ++ break; ++ case 5: ++ antenna = ANTENNA_AC; ++ break; ++ case 9: ++ antenna = ANTENNA_AD; ++ break; ++ case 6: ++ antenna = ANTENNA_BC; ++ break; ++ case 10: ++ antenna = ANTENNA_BD; ++ break; ++ case 12: ++ antenna = ANTENNA_CD; ++ break; ++ case 7: ++ antenna = ANTENNA_ABC; ++ break; ++ case 14: ++ antenna = ANTENNA_BCD; ++ break; ++ case 11: ++ antenna = ANTENNA_ABD; ++ break; ++ case 15: ++ antenna = ANTENNA_ABCD; ++ break; ++ } ++ RTW_INFO("%s: antenna=0x%x\n", __func__, antenna); ++ padapter->mppriv.antenna_tx = antenna; ++ padapter->mppriv.antenna_rx = antenna; ++ pHalData->AntennaTxPath = antenna; ++ SetAntenna(padapter); ++ ++ sprintf(extra, "%s\nstart Rx", extra); ++ SetPacketRx(padapter, bStartRx, _FALSE); ++ } ++ wrqu->data.length = strlen(extra); ++ return 0; ++} ++ ++ ++int rtw_mp_hwtx(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); ++ ++#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821B) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++ u8 input[wrqu->data.length]; ++ ++ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) ++ return -EFAULT; ++ ++ _rtw_memset(&pMptCtx->PMacTxInfo, 0, sizeof(RT_PMAC_TX_INFO)); ++ _rtw_memcpy((void *)&pMptCtx->PMacTxInfo, (void *)input, sizeof(RT_PMAC_TX_INFO)); ++ ++ mpt_ProSetPMacTx(padapter); ++ sprintf(extra, "Set PMac Tx Mode start\n"); ++ ++ wrqu->data.length = strlen(extra); ++#endif ++ return 0; ++ ++} ++ ++int rtw_efuse_mask_file(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ char *rtw_efuse_mask_file_path; ++ u8 Status; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ _rtw_memset(maskfileBuffer, 0x00, sizeof(maskfileBuffer)); ++ ++ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) ++ return -EFAULT; ++ ++ if (strncmp(extra, "off", 3) == 0 && strlen(extra) < 4) { ++ padapter->registrypriv.boffefusemask = 1; ++ sprintf(extra, "Turn off Efuse Mask\n"); ++ wrqu->data.length = strlen(extra); ++ return 0; ++ } ++ if (strncmp(extra, "on", 2) == 0 && strlen(extra) < 3) { ++ padapter->registrypriv.boffefusemask = 0; ++ sprintf(extra, "Turn on Efuse Mask\n"); ++ wrqu->data.length = strlen(extra); ++ return 0; ++ } ++ rtw_efuse_mask_file_path = extra; ++ ++ if (rtw_is_file_readable(rtw_efuse_mask_file_path) == _TRUE) { ++ RTW_INFO("%s do rtw_efuse_mask_file_read = %s! ,sizeof maskfileBuffer %zu\n", __func__, rtw_efuse_mask_file_path, sizeof(maskfileBuffer)); ++ Status = rtw_efuse_file_read(padapter, rtw_efuse_mask_file_path, maskfileBuffer, sizeof(maskfileBuffer)); ++ if (Status == _TRUE) ++ padapter->registrypriv.bFileMaskEfuse = _TRUE; ++ sprintf(extra, "efuse mask file read OK\n"); ++ } else { ++ padapter->registrypriv.bFileMaskEfuse = _FALSE; ++ sprintf(extra, "efuse mask file readable FAIL\n"); ++ RTW_INFO("%s rtw_is_file_readable fail!\n", __func__); ++ } ++ wrqu->data.length = strlen(extra); ++ return 0; ++} ++ ++ ++int rtw_efuse_file_map(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ char *rtw_efuse_file_map_path; ++ u8 Status; ++ PEFUSE_HAL pEfuseHal; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ ++ pEfuseHal = &pHalData->EfuseHal; ++ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) ++ return -EFAULT; ++ ++ rtw_efuse_file_map_path = extra; ++ ++ _rtw_memset(pEfuseHal->fakeEfuseModifiedMap, 0xFF, EFUSE_MAX_MAP_LEN); ++ ++ if (rtw_is_file_readable(rtw_efuse_file_map_path) == _TRUE) { ++ RTW_INFO("%s do rtw_efuse_mask_file_read = %s!\n", __func__, rtw_efuse_file_map_path); ++ Status = rtw_efuse_file_read(padapter, rtw_efuse_file_map_path, pEfuseHal->fakeEfuseModifiedMap, sizeof(pEfuseHal->fakeEfuseModifiedMap)); ++ if (Status == _TRUE) { ++ pmp_priv->bloadefusemap = _TRUE; ++ sprintf(extra, "efuse file file_read OK\n"); ++ } else { ++ pmp_priv->bloadefusemap = _FALSE; ++ sprintf(extra, "efuse file file_read FAIL\n"); ++ } ++ } else { ++ sprintf(extra, "efuse file readable FAIL\n"); ++ RTW_INFO("%s rtw_is_file_readable fail!\n", __func__); ++ } ++ wrqu->data.length = strlen(extra); ++ return 0; ++} ++ ++#if defined(CONFIG_RTL8723B) ++int rtw_mp_SetBT(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ struct hal_ops *pHalFunc = &padapter->HalFunc; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ BT_REQ_CMD BtReq; ++ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); ++ PBT_RSP_CMD pBtRsp = (PBT_RSP_CMD)&pMptCtx->mptOutBuf[0]; ++ char input[128]; ++ char *pch, *ptmp, *token, *tmp[2] = {0x00, 0x00}; ++ u8 setdata[100]; ++ u8 resetbt = 0x00; ++ u8 tempval, BTStatus; ++ u8 H2cSetbtmac[6]; ++ u8 u1H2CBtMpOperParm[4] = {0x01}; ++ int testmode = 1, ready = 1, trxparam = 1, setgen = 1, getgen = 1, testctrl = 1, testbt = 1, readtherm = 1, setbtmac = 1; ++ u32 i = 0, ii = 0, jj = 0, kk = 0, cnts = 0, status = 0; ++ PRT_MP_FIRMWARE pBTFirmware = NULL; ++ ++ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) ++ return -EFAULT; ++ if (strlen(extra) < 1) ++ return -EFAULT; ++ ++ RTW_INFO("%s:iwpriv in=%s\n", __func__, extra); ++ ready = strncmp(extra, "ready", 5); ++ testmode = strncmp(extra, "testmode", 8); /* strncmp TRUE is 0*/ ++ trxparam = strncmp(extra, "trxparam", 8); ++ setgen = strncmp(extra, "setgen", 6); ++ getgen = strncmp(extra, "getgen", 6); ++ testctrl = strncmp(extra, "testctrl", 8); ++ testbt = strncmp(extra, "testbt", 6); ++ readtherm = strncmp(extra, "readtherm", 9); ++ setbtmac = strncmp(extra, "setbtmac", 8); ++ ++ if (strncmp(extra, "dlbt", 4) == 0) { ++ pHalData->LastHMEBoxNum = 0; ++ padapter->bBTFWReady = _FALSE; ++ rtw_write8(padapter, 0xa3, 0x05); ++ BTStatus = rtw_read8(padapter, 0xa0); ++ RTW_INFO("%s: btwmap before read 0xa0 BT Status =0x%x\n", __func__, BTStatus); ++ if (BTStatus != 0x04) { ++ sprintf(extra, "BT Status not Active DLFW FAIL\n"); ++ goto exit; ++ } ++ ++ tempval = rtw_read8(padapter, 0x6B); ++ tempval |= BIT7; ++ rtw_write8(padapter, 0x6B, tempval); ++ ++ /* Attention!! Between 0x6A[14] and 0x6A[15] setting need 100us delay*/ ++ /* So don't write 0x6A[14]=1 and 0x6A[15]=0 together!*/ ++ rtw_usleep_os(100); ++ /* disable BT power cut*/ ++ /* 0x6A[14] = 0*/ ++ tempval = rtw_read8(padapter, 0x6B); ++ tempval &= ~BIT6; ++ rtw_write8(padapter, 0x6B, tempval); ++ rtw_usleep_os(100); ++ MPT_PwrCtlDM(padapter, 0); ++ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) | 0x00000004)); ++ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) & 0xFFFFFFEF)); ++ rtw_msleep_os(600); ++ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) | 0x00000010)); ++ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) & 0xFFFFFFFB)); ++ rtw_msleep_os(1200); ++ pBTFirmware = (PRT_MP_FIRMWARE)rtw_zmalloc(sizeof(RT_MP_FIRMWARE)); ++ if (pBTFirmware == NULL) ++ goto exit; ++ padapter->bBTFWReady = _FALSE; ++ FirmwareDownloadBT(padapter, pBTFirmware); ++ if (pBTFirmware) ++ rtw_mfree((u8 *)pBTFirmware, sizeof(RT_MP_FIRMWARE)); ++ ++ RTW_INFO("Wait for FirmwareDownloadBT fw boot!\n"); ++ rtw_msleep_os(2000); ++ _rtw_memset(extra, '\0', wrqu->data.length); ++ BtReq.opCodeVer = 1; ++ BtReq.OpCode = 0; ++ BtReq.paraLength = 0; ++ mptbt_BtControlProcess(padapter, &BtReq); ++ rtw_msleep_os(100); ++ ++ RTW_INFO("FirmwareDownloadBT ready = 0x%x 0x%x", pMptCtx->mptOutBuf[4], pMptCtx->mptOutBuf[5]); ++ if ((pMptCtx->mptOutBuf[4] == 0x00) && (pMptCtx->mptOutBuf[5] == 0x00)) { ++ ++ if (padapter->mppriv.bTxBufCkFail == _TRUE) ++ sprintf(extra, "check TxBuf Fail.\n"); ++ else ++ sprintf(extra, "download FW Fail.\n"); ++ } else { ++ sprintf(extra, "download FW OK.\n"); ++ goto exit; ++ } ++ goto exit; ++ } ++ if (strncmp(extra, "dlfw", 4) == 0) { ++ pHalData->LastHMEBoxNum = 0; ++ padapter->bBTFWReady = _FALSE; ++ rtw_write8(padapter, 0xa3, 0x05); ++ BTStatus = rtw_read8(padapter, 0xa0); ++ RTW_INFO("%s: btwmap before read 0xa0 BT Status =0x%x\n", __func__, BTStatus); ++ if (BTStatus != 0x04) { ++ sprintf(extra, "BT Status not Active DLFW FAIL\n"); ++ goto exit; ++ } ++ ++ tempval = rtw_read8(padapter, 0x6B); ++ tempval |= BIT7; ++ rtw_write8(padapter, 0x6B, tempval); ++ ++ /* Attention!! Between 0x6A[14] and 0x6A[15] setting need 100us delay*/ ++ /* So don't write 0x6A[14]=1 and 0x6A[15]=0 together!*/ ++ rtw_usleep_os(100); ++ /* disable BT power cut*/ ++ /* 0x6A[14] = 0*/ ++ tempval = rtw_read8(padapter, 0x6B); ++ tempval &= ~BIT6; ++ rtw_write8(padapter, 0x6B, tempval); ++ rtw_usleep_os(100); ++ ++ MPT_PwrCtlDM(padapter, 0); ++ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) | 0x00000004)); ++ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) & 0xFFFFFFEF)); ++ rtw_msleep_os(600); ++ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) | 0x00000010)); ++ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) & 0xFFFFFFFB)); ++ rtw_msleep_os(1200); ++ ++#if defined(CONFIG_PLATFORM_SPRD) && (MP_DRIVER == 1) ++ /* Pull up BT reset pin.*/ ++ RTW_INFO("%s: pull up BT reset pin when bt start mp test\n", __func__); ++ rtw_wifi_gpio_wlan_ctrl(WLAN_BT_PWDN_ON); ++#endif ++ RTW_INFO(" FirmwareDownload!\n"); ++ ++#if defined(CONFIG_RTL8723B) ++ status = rtl8723b_FirmwareDownload(padapter, _FALSE); ++#endif ++ RTW_INFO("Wait for FirmwareDownloadBT fw boot!\n"); ++ rtw_msleep_os(1000); ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_HaltNotify(padapter); ++ RTW_INFO("SetBT btcoex HaltNotify !\n"); ++ /*hal_btcoex1ant_SetAntPath(padapter);*/ ++ rtw_btcoex_SetManualControl(padapter, _TRUE); ++#endif ++ _rtw_memset(extra, '\0', wrqu->data.length); ++ BtReq.opCodeVer = 1; ++ BtReq.OpCode = 0; ++ BtReq.paraLength = 0; ++ mptbt_BtControlProcess(padapter, &BtReq); ++ rtw_msleep_os(200); ++ ++ RTW_INFO("FirmwareDownloadBT ready = 0x%x 0x%x", pMptCtx->mptOutBuf[4], pMptCtx->mptOutBuf[5]); ++ if ((pMptCtx->mptOutBuf[4] == 0x00) && (pMptCtx->mptOutBuf[5] == 0x00)) { ++ if (padapter->mppriv.bTxBufCkFail == _TRUE) ++ sprintf(extra, "check TxBuf Fail.\n"); ++ else ++ sprintf(extra, "download FW Fail.\n"); ++ } else { ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_SwitchBtTRxMask(padapter); ++#endif ++ rtw_msleep_os(200); ++ sprintf(extra, "download FW OK.\n"); ++ goto exit; ++ } ++ goto exit; ++ } ++ ++ if (strncmp(extra, "down", 4) == 0) { ++ RTW_INFO("SetBT down for to hal_init !\n"); ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_SetManualControl(padapter, _FALSE); ++ rtw_btcoex_Initialize(padapter); ++#endif ++ pHalFunc->read_adapter_info(padapter); ++ pHalFunc->hal_deinit(padapter); ++ pHalFunc->hal_init(padapter); ++ rtw_pm_set_ips(padapter, IPS_NONE); ++ LeaveAllPowerSaveMode(padapter); ++ MPT_PwrCtlDM(padapter, 0); ++ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) | 0x00000004)); ++ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) & 0xFFFFFFEF)); ++ rtw_msleep_os(600); ++ /*rtw_write32(padapter, 0x6a, (rtw_read32(padapter, 0x6a)& 0xFFFFFFFE));*/ ++ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) | 0x00000010)); ++ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) & 0xFFFFFFFB)); ++ rtw_msleep_os(1200); ++ goto exit; ++ } ++ if (strncmp(extra, "disable", 7) == 0) { ++ RTW_INFO("SetBT disable !\n"); ++ rtw_write32(padapter, 0x6a, (rtw_read32(padapter, 0x6a) & 0xFFFFFFFB)); ++ rtw_msleep_os(500); ++ goto exit; ++ } ++ if (strncmp(extra, "enable", 6) == 0) { ++ RTW_INFO("SetBT enable !\n"); ++ rtw_write32(padapter, 0x6a, (rtw_read32(padapter, 0x6a) | 0x00000004)); ++ rtw_msleep_os(500); ++ goto exit; ++ } ++ if (strncmp(extra, "h2c", 3) == 0) { ++ RTW_INFO("SetBT h2c !\n"); ++ padapter->bBTFWReady = _TRUE; ++ rtw_hal_fill_h2c_cmd(padapter, 0x63, 1, u1H2CBtMpOperParm); ++ goto exit; ++ } ++ if (strncmp(extra, "2ant", 4) == 0) { ++ RTW_INFO("Set BT 2ant use!\n"); ++ PHY_SetMacReg(padapter, 0x67, BIT5, 0x1); ++ rtw_write32(padapter, 0x948, 0000); ++ ++ goto exit; ++ } ++ ++ if (ready != 0 && testmode != 0 && trxparam != 0 && setgen != 0 && getgen != 0 && testctrl != 0 && testbt != 0 && readtherm != 0 && setbtmac != 0) ++ return -EFAULT; ++ ++ if (testbt == 0) { ++ BtReq.opCodeVer = 1; ++ BtReq.OpCode = 6; ++ BtReq.paraLength = cnts / 2; ++ goto todo; ++ } ++ if (ready == 0) { ++ BtReq.opCodeVer = 1; ++ BtReq.OpCode = 0; ++ BtReq.paraLength = 0; ++ goto todo; ++ } ++ ++ pch = extra; ++ i = 0; ++ while ((token = strsep(&pch, ",")) != NULL) { ++ if (i > 1) ++ break; ++ tmp[i] = token; ++ i++; ++ } ++ ++ if ((tmp[0] != NULL) && (tmp[1] != NULL)) { ++ cnts = strlen(tmp[1]); ++ if (cnts < 1) ++ return -EFAULT; ++ ++ RTW_INFO("%s: cnts=%d\n", __func__, cnts); ++ RTW_INFO("%s: data=%s\n", __func__, tmp[1]); ++ ++ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) { ++ BtReq.pParamStart[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); ++ /* RTW_INFO("BtReq.pParamStart[%d]=0x%02x\n", jj, BtReq.pParamStart[jj]);*/ ++ } ++ } else ++ return -EFAULT; ++ ++ if (testmode == 0) { ++ BtReq.opCodeVer = 1; ++ BtReq.OpCode = 1; ++ BtReq.paraLength = 1; ++ } ++ if (trxparam == 0) { ++ BtReq.opCodeVer = 1; ++ BtReq.OpCode = 2; ++ BtReq.paraLength = cnts / 2; ++ } ++ if (setgen == 0) { ++ RTW_INFO("%s: BT_SET_GENERAL\n", __func__); ++ BtReq.opCodeVer = 1; ++ BtReq.OpCode = 3;/*BT_SET_GENERAL 3*/ ++ BtReq.paraLength = cnts / 2; ++ } ++ if (getgen == 0) { ++ RTW_INFO("%s: BT_GET_GENERAL\n", __func__); ++ BtReq.opCodeVer = 1; ++ BtReq.OpCode = 4;/*BT_GET_GENERAL 4*/ ++ BtReq.paraLength = cnts / 2; ++ } ++ if (readtherm == 0) { ++ RTW_INFO("%s: BT_GET_GENERAL\n", __func__); ++ BtReq.opCodeVer = 1; ++ BtReq.OpCode = 4;/*BT_GET_GENERAL 4*/ ++ BtReq.paraLength = cnts / 2; ++ } ++ ++ if (testctrl == 0) { ++ RTW_INFO("%s: BT_TEST_CTRL\n", __func__); ++ BtReq.opCodeVer = 1; ++ BtReq.OpCode = 5;/*BT_TEST_CTRL 5*/ ++ BtReq.paraLength = cnts / 2; ++ } ++ ++ RTW_INFO("%s: Req opCodeVer=%d OpCode=%d paraLength=%d\n", ++ __func__, BtReq.opCodeVer, BtReq.OpCode, BtReq.paraLength); ++ ++ if (BtReq.paraLength < 1) ++ goto todo; ++ for (i = 0; i < BtReq.paraLength; i++) { ++ RTW_INFO("%s: BtReq.pParamStart[%d] = 0x%02x\n", ++ __func__, i, BtReq.pParamStart[i]); ++ } ++ ++todo: ++ _rtw_memset(extra, '\0', wrqu->data.length); ++ ++ if (padapter->bBTFWReady == _FALSE) { ++ sprintf(extra, "BTFWReady = FALSE.\n"); ++ goto exit; ++ } ++ ++ mptbt_BtControlProcess(padapter, &BtReq); ++ ++ if (readtherm == 0) { ++ sprintf(extra, "BT thermal="); ++ for (i = 4; i < pMptCtx->mptOutLen; i++) { ++ if ((pMptCtx->mptOutBuf[i] == 0x00) && (pMptCtx->mptOutBuf[i + 1] == 0x00)) ++ goto exit; ++ ++ sprintf(extra, "%s %d ", extra, (pMptCtx->mptOutBuf[i] & 0x1f)); ++ } ++ } else { ++ for (i = 4; i < pMptCtx->mptOutLen; i++) ++ sprintf(extra, "%s 0x%x ", extra, pMptCtx->mptOutBuf[i]); ++ } ++ ++exit: ++ wrqu->data.length = strlen(extra) + 1; ++ RTW_INFO("-%s: output len=%d data=%s\n", __func__, wrqu->data.length, extra); ++ ++ return status; ++} ++ ++#endif /*#ifdef CONFIG_RTL8723B*/ ++ ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/mlme_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/mlme_linux.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/mlme_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/mlme_linux.c 2018-02-11 21:44:27.175146513 +0200 +@@ -0,0 +1,604 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ ++#define _MLME_OSDEP_C_ ++ ++#include ++ ++ ++#ifdef RTK_DMP_PLATFORM ++void Linkup_workitem_callback(struct work_struct *work) ++{ ++ struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkup_workitem); ++ _adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv); ++ ++ ++ ++#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 12)) ++ kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKUP); ++#else ++ kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKUP); ++#endif ++ ++} ++ ++void Linkdown_workitem_callback(struct work_struct *work) ++{ ++ struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkdown_workitem); ++ _adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv); ++ ++ ++ ++#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 12)) ++ kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKDOWN); ++#else ++ kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKDOWN); ++#endif ++ ++} ++#endif ++ ++ ++/* ++void sitesurvey_ctrl_handler(void *FunctionContext) ++{ ++ _adapter *adapter = (_adapter *)FunctionContext; ++ ++ _sitesurvey_ctrl_handler(adapter); ++ ++ _set_timer(&adapter->mlmepriv.sitesurveyctrl.sitesurvey_ctrl_timer, 3000); ++} ++*/ ++ ++void rtw_join_timeout_handler(void *FunctionContext) ++{ ++ _adapter *adapter = (_adapter *)FunctionContext; ++ _rtw_join_timeout_handler(adapter); ++} ++ ++ ++void _rtw_scan_timeout_handler(void *FunctionContext) ++{ ++ _adapter *adapter = (_adapter *)FunctionContext; ++ rtw_scan_timeout_handler(adapter); ++} ++ ++ ++void _dynamic_check_timer_handlder(void *FunctionContext) ++{ ++ struct dvobj_priv *pdvobj = (struct dvobj_priv *)FunctionContext; ++ _adapter *adapter = dvobj_get_primary_adapter(pdvobj); ++ ++#if (MP_DRIVER == 1) ++ if (adapter->registrypriv.mp_mode == 1 && adapter->mppriv.mp_dm == 0) { /* for MP ODM dynamic Tx power tracking */ ++ /* RTW_INFO("_dynamic_check_timer_handlder mp_dm =0 return\n"); */ ++ _set_timer(&pdvobj->dynamic_chk_timer, 2000); ++ return; ++ } ++#endif ++ ++ rtw_dynamic_check_timer_handlder(adapter); ++ ++ _set_timer(&pdvobj->dynamic_chk_timer, 2000); ++} ++ ++#ifdef CONFIG_SET_SCAN_DENY_TIMER ++void _rtw_set_scan_deny_timer_hdl(void *FunctionContext) ++{ ++ _adapter *adapter = (_adapter *)FunctionContext; ++ rtw_set_scan_deny_timer_hdl(adapter); ++} ++#endif ++ ++ ++void rtw_init_mlme_timer(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ _init_timer(&(pmlmepriv->assoc_timer), padapter->pnetdev, rtw_join_timeout_handler, padapter); ++ /* _init_timer(&(pmlmepriv->sitesurveyctrl.sitesurvey_ctrl_timer), padapter->pnetdev, sitesurvey_ctrl_handler, padapter); */ ++ _init_timer(&(pmlmepriv->scan_to_timer), padapter->pnetdev, _rtw_scan_timeout_handler, padapter); ++ ++#ifdef CONFIG_DFS_MASTER ++ _init_timer(&(pmlmepriv->dfs_master_timer), padapter->pnetdev, rtw_dfs_master_timer_hdl, padapter); ++#endif ++ ++#ifdef CONFIG_SET_SCAN_DENY_TIMER ++ _init_timer(&(pmlmepriv->set_scan_deny_timer), padapter->pnetdev, _rtw_set_scan_deny_timer_hdl, padapter); ++#endif ++ ++#ifdef RTK_DMP_PLATFORM ++ _init_workitem(&(pmlmepriv->Linkup_workitem), Linkup_workitem_callback, padapter); ++ _init_workitem(&(pmlmepriv->Linkdown_workitem), Linkdown_workitem_callback, padapter); ++#endif ++ ++} ++ ++extern void rtw_indicate_wx_assoc_event(_adapter *padapter); ++extern void rtw_indicate_wx_disassoc_event(_adapter *padapter); ++ ++void rtw_os_indicate_connect(_adapter *adapter) ++{ ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) ++ rtw_cfg80211_ibss_indicate_connect(adapter); ++ else ++ rtw_cfg80211_indicate_connect(adapter); ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++ rtw_indicate_wx_assoc_event(adapter); ++ netif_carrier_on(adapter->pnetdev); ++ ++ if (adapter->pid[2] != 0) ++ rtw_signal_process(adapter->pid[2], SIGALRM); ++ ++#ifdef RTK_DMP_PLATFORM ++ _set_workitem(&adapter->mlmepriv.Linkup_workitem); ++#endif ++ ++ ++} ++ ++extern void indicate_wx_scan_complete_event(_adapter *padapter); ++void rtw_os_indicate_scan_done(_adapter *padapter, bool aborted) ++{ ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_cfg80211_indicate_scan_done(padapter, aborted); ++#endif ++ indicate_wx_scan_complete_event(padapter); ++} ++ ++static RT_PMKID_LIST backupPMKIDList[NUM_PMKID_CACHE]; ++void rtw_reset_securitypriv(_adapter *adapter) ++{ ++ u8 backupPMKIDIndex = 0; ++ u8 backupTKIPCountermeasure = 0x00; ++ u32 backupTKIPcountermeasure_time = 0; ++ /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ _irqL irqL; ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ ++ _enter_critical_bh(&adapter->security_key_mutex, &irqL); ++ ++ if (adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { /* 802.1x */ ++ /* Added by Albert 2009/02/18 */ ++ /* We have to backup the PMK information for WiFi PMK Caching test item. */ ++ /* */ ++ /* Backup the btkip_countermeasure information. */ ++ /* When the countermeasure is trigger, the driver have to disconnect with AP for 60 seconds. */ ++ ++ _rtw_memset(&backupPMKIDList[0], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); ++ ++ _rtw_memcpy(&backupPMKIDList[0], &adapter->securitypriv.PMKIDList[0], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); ++ backupPMKIDIndex = adapter->securitypriv.PMKIDIndex; ++ backupTKIPCountermeasure = adapter->securitypriv.btkip_countermeasure; ++ backupTKIPcountermeasure_time = adapter->securitypriv.btkip_countermeasure_time; ++#ifdef CONFIG_IEEE80211W ++ /* reset RX BIP packet number */ ++ pmlmeext->mgnt_80211w_IPN_rx = 0; ++#endif /* CONFIG_IEEE80211W */ ++ _rtw_memset((unsigned char *)&adapter->securitypriv, 0, sizeof(struct security_priv)); ++ /* _init_timer(&(adapter->securitypriv.tkip_timer),adapter->pnetdev, rtw_use_tkipkey_handler, adapter); */ ++ ++ /* Added by Albert 2009/02/18 */ ++ /* Restore the PMK information to securitypriv structure for the following connection. */ ++ _rtw_memcpy(&adapter->securitypriv.PMKIDList[0], &backupPMKIDList[0], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); ++ adapter->securitypriv.PMKIDIndex = backupPMKIDIndex; ++ adapter->securitypriv.btkip_countermeasure = backupTKIPCountermeasure; ++ adapter->securitypriv.btkip_countermeasure_time = backupTKIPcountermeasure_time; ++ ++ adapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; ++ adapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled; ++ ++ } else { /* reset values in securitypriv */ ++ /* if(adapter->mlmepriv.fw_state & WIFI_STATION_STATE) */ ++ /* { */ ++ struct security_priv *psec_priv = &adapter->securitypriv; ++ ++ psec_priv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ ++ psec_priv->dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ psec_priv->dot11PrivacyKeyIndex = 0; ++ ++ psec_priv->dot118021XGrpPrivacy = _NO_PRIVACY_; ++ psec_priv->dot118021XGrpKeyid = 1; ++ ++ psec_priv->ndisauthtype = Ndis802_11AuthModeOpen; ++ psec_priv->ndisencryptstatus = Ndis802_11WEPDisabled; ++ /* } */ ++ } ++ /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ _exit_critical_bh(&adapter->security_key_mutex, &irqL); ++ ++ RTW_INFO(FUNC_ADPT_FMT" - End to Disconnect\n", FUNC_ADPT_ARG(adapter)); ++} ++ ++void rtw_os_indicate_disconnect(_adapter *adapter, u16 reason, u8 locally_generated) ++{ ++ /* RT_PMKID_LIST backupPMKIDList[NUM_PMKID_CACHE]; */ ++ ++ ++ netif_carrier_off(adapter->pnetdev); /* Do it first for tx broadcast pkt after disconnection issue! */ ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_cfg80211_indicate_disconnect(adapter, reason, locally_generated); ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++ rtw_indicate_wx_disassoc_event(adapter); ++ ++#ifdef RTK_DMP_PLATFORM ++ _set_workitem(&adapter->mlmepriv.Linkdown_workitem); ++#endif ++ /* modify for CONFIG_IEEE80211W, none 11w also can use the same command */ ++ rtw_reset_securitypriv_cmd(adapter); ++ ++ ++} ++ ++void rtw_report_sec_ie(_adapter *adapter, u8 authmode, u8 *sec_ie) ++{ ++ uint len; ++ u8 *buff, *p, i; ++ union iwreq_data wrqu; ++ ++ ++ ++ buff = NULL; ++ if (authmode == _WPA_IE_ID_) { ++ ++ buff = rtw_zmalloc(IW_CUSTOM_MAX); ++ if (NULL == buff) { ++ RTW_INFO(FUNC_ADPT_FMT ": alloc memory FAIL!!\n", ++ FUNC_ADPT_ARG(adapter)); ++ return; ++ } ++ p = buff; ++ ++ p += sprintf(p, "ASSOCINFO(ReqIEs="); ++ ++ len = sec_ie[1] + 2; ++ len = (len < IW_CUSTOM_MAX) ? len : IW_CUSTOM_MAX; ++ ++ for (i = 0; i < len; i++) ++ p += sprintf(p, "%02x", sec_ie[i]); ++ ++ p += sprintf(p, ")"); ++ ++ _rtw_memset(&wrqu, 0, sizeof(wrqu)); ++ ++ wrqu.data.length = p - buff; ++ ++ wrqu.data.length = (wrqu.data.length < IW_CUSTOM_MAX) ? wrqu.data.length : IW_CUSTOM_MAX; ++ ++#ifndef CONFIG_IOCTL_CFG80211 ++ wireless_send_event(adapter->pnetdev, IWEVCUSTOM, &wrqu, buff); ++#endif ++ ++ rtw_mfree(buff, IW_CUSTOM_MAX); ++ } ++ ++ ++} ++ ++void _survey_timer_hdl(void *FunctionContext) ++{ ++ _adapter *padapter = (_adapter *)FunctionContext; ++ ++ survey_timer_hdl(padapter); ++} ++ ++void _link_timer_hdl(void *FunctionContext) ++{ ++ _adapter *padapter = (_adapter *)FunctionContext; ++ link_timer_hdl(padapter); ++} ++ ++#ifdef CONFIG_RTW_80211R ++void _ft_link_timer_hdl(void *FunctionContext) ++{ ++ _adapter *padapter = (_adapter *)FunctionContext; ++ ++ ft_link_timer_hdl(padapter); ++} ++ ++void _ft_roam_timer_hdl(void *FunctionContext) ++{ ++ _adapter *padapter = (_adapter *)FunctionContext; ++ ++ ft_roam_timer_hdl(padapter); ++} ++#endif ++ ++void _addba_timer_hdl(void *FunctionContext) ++{ ++ struct sta_info *psta = (struct sta_info *)FunctionContext; ++ addba_timer_hdl(psta); ++} ++ ++#ifdef CONFIG_IEEE80211W ++ ++void _sa_query_timer_hdl(void *FunctionContext) ++{ ++ struct sta_info *psta = (struct sta_info *)FunctionContext; ++ ++ sa_query_timer_hdl(psta); ++} ++ ++void init_dot11w_expire_timer(_adapter *padapter, struct sta_info *psta) ++{ ++ _init_timer(&psta->dot11w_expire_timer, padapter->pnetdev, _sa_query_timer_hdl, psta); ++} ++ ++#endif /* CONFIG_IEEE80211W */ ++ ++void init_addba_retry_timer(_adapter *padapter, struct sta_info *psta) ++{ ++ ++ _init_timer(&psta->addba_retry_timer, padapter->pnetdev, _addba_timer_hdl, psta); ++} ++ ++/* ++void _reauth_timer_hdl(void *FunctionContext) ++{ ++ _adapter *padapter = (_adapter *)FunctionContext; ++ reauth_timer_hdl(padapter); ++} ++ ++void _reassoc_timer_hdl(void *FunctionContext) ++{ ++ _adapter *padapter = (_adapter *)FunctionContext; ++ reassoc_timer_hdl(padapter); ++} ++*/ ++ ++void init_mlme_ext_timer(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ _init_timer(&pmlmeext->survey_timer, padapter->pnetdev, _survey_timer_hdl, padapter); ++ _init_timer(&pmlmeext->link_timer, padapter->pnetdev, _link_timer_hdl, padapter); ++#ifdef CONFIG_RTW_80211R ++ _init_timer(&pmlmeext->ft_link_timer, padapter->pnetdev, _ft_link_timer_hdl, padapter); ++ _init_timer(&pmlmeext->ft_roam_timer, padapter->pnetdev, _ft_roam_timer_hdl, padapter); ++#endif ++ ++ /* _init_timer(&pmlmeext->ADDBA_timer, padapter->pnetdev, _addba_timer_hdl, padapter); */ ++ ++ /* _init_timer(&pmlmeext->reauth_timer, padapter->pnetdev, _reauth_timer_hdl, padapter); */ ++ /* _init_timer(&pmlmeext->reassoc_timer, padapter->pnetdev, _reassoc_timer_hdl, padapter); */ ++} ++ ++#ifdef CONFIG_AP_MODE ++ ++void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta) ++{ ++ union iwreq_data wrqu; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ if (psta == NULL) ++ return; ++ ++ if (psta->aid > NUM_STA) ++ return; ++ ++ if (pstapriv->sta_aid[psta->aid - 1] != psta) ++ return; ++ ++ ++ wrqu.addr.sa_family = ARPHRD_ETHER; ++ ++ _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN); ++ ++ RTW_INFO("+rtw_indicate_sta_assoc_event\n"); ++ ++#ifndef CONFIG_IOCTL_CFG80211 ++ wireless_send_event(padapter->pnetdev, IWEVREGISTERED, &wrqu, NULL); ++#endif ++ ++} ++ ++void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta) ++{ ++ union iwreq_data wrqu; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ if (psta == NULL) ++ return; ++ ++ if (psta->aid > NUM_STA) ++ return; ++ ++ if (pstapriv->sta_aid[psta->aid - 1] != psta) ++ return; ++ ++ ++ wrqu.addr.sa_family = ARPHRD_ETHER; ++ ++ _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN); ++ ++ RTW_INFO("+rtw_indicate_sta_disassoc_event\n"); ++ ++#ifndef CONFIG_IOCTL_CFG80211 ++ wireless_send_event(padapter->pnetdev, IWEVEXPIRED, &wrqu, NULL); ++#endif ++ ++} ++ ++ ++#ifdef CONFIG_HOSTAPD_MLME ++ ++static int mgnt_xmit_entry(struct sk_buff *skb, struct net_device *pnetdev) ++{ ++ struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev); ++ _adapter *padapter = (_adapter *)phostapdpriv->padapter; ++ ++ /* RTW_INFO("%s\n", __FUNCTION__); */ ++ ++ return rtw_hal_hostap_mgnt_xmit_entry(padapter, skb); ++} ++ ++static int mgnt_netdev_open(struct net_device *pnetdev) ++{ ++ struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev); ++ ++ RTW_INFO("mgnt_netdev_open: MAC Address:" MAC_FMT "\n", MAC_ARG(pnetdev->dev_addr)); ++ ++ ++ init_usb_anchor(&phostapdpriv->anchored); ++ ++ rtw_netif_wake_queue(pnetdev); ++ ++ netif_carrier_on(pnetdev); ++ ++ /* rtw_write16(phostapdpriv->padapter, 0x0116, 0x0100); */ /* only excluding beacon */ ++ ++ return 0; ++} ++static int mgnt_netdev_close(struct net_device *pnetdev) ++{ ++ struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev); ++ ++ RTW_INFO("%s\n", __FUNCTION__); ++ ++ usb_kill_anchored_urbs(&phostapdpriv->anchored); ++ ++ netif_carrier_off(pnetdev); ++ ++ rtw_netif_stop_queue(pnetdev); ++ ++ /* rtw_write16(phostapdpriv->padapter, 0x0116, 0x3f3f); */ ++ ++ return 0; ++} ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) ++static const struct net_device_ops rtl871x_mgnt_netdev_ops = { ++ .ndo_open = mgnt_netdev_open, ++ .ndo_stop = mgnt_netdev_close, ++ .ndo_start_xmit = mgnt_xmit_entry, ++ #if 0 ++ .ndo_set_mac_address = r871x_net_set_mac_address, ++ .ndo_get_stats = r871x_net_get_stats, ++ .ndo_do_ioctl = r871x_mp_ioctl, ++ #endif ++}; ++#endif ++ ++int hostapd_mode_init(_adapter *padapter) ++{ ++ unsigned char mac[ETH_ALEN]; ++ struct hostapd_priv *phostapdpriv; ++ struct net_device *pnetdev; ++ ++ pnetdev = rtw_alloc_etherdev(sizeof(struct hostapd_priv)); ++ if (!pnetdev) ++ return -ENOMEM; ++ ++ /* SET_MODULE_OWNER(pnetdev); */ ++ ether_setup(pnetdev); ++ ++ /* pnetdev->type = ARPHRD_IEEE80211; */ ++ ++ phostapdpriv = rtw_netdev_priv(pnetdev); ++ phostapdpriv->pmgnt_netdev = pnetdev; ++ phostapdpriv->padapter = padapter; ++ padapter->phostapdpriv = phostapdpriv; ++ ++ /* pnetdev->init = NULL; */ ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) ++ ++ RTW_INFO("register rtl871x_mgnt_netdev_ops to netdev_ops\n"); ++ ++ pnetdev->netdev_ops = &rtl871x_mgnt_netdev_ops; ++ ++#else ++ ++ pnetdev->open = mgnt_netdev_open; ++ ++ pnetdev->stop = mgnt_netdev_close; ++ ++ pnetdev->hard_start_xmit = mgnt_xmit_entry; ++ ++ /* pnetdev->set_mac_address = r871x_net_set_mac_address; */ ++ ++ /* pnetdev->get_stats = r871x_net_get_stats; */ ++ ++ /* pnetdev->do_ioctl = r871x_mp_ioctl; */ ++ ++#endif ++ ++ pnetdev->watchdog_timeo = HZ; /* 1 second timeout */ ++ ++ /* pnetdev->wireless_handlers = NULL; */ ++ ++#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX ++ pnetdev->features |= NETIF_F_IP_CSUM; ++#endif ++ ++ ++ ++ if (dev_alloc_name(pnetdev, "mgnt.wlan%d") < 0) ++ RTW_INFO("hostapd_mode_init(): dev_alloc_name, fail!\n"); ++ ++ ++ /* SET_NETDEV_DEV(pnetdev, pintfpriv->udev); */ ++ ++ ++ mac[0] = 0x00; ++ mac[1] = 0xe0; ++ mac[2] = 0x4c; ++ mac[3] = 0x87; ++ mac[4] = 0x11; ++ mac[5] = 0x12; ++ ++ _rtw_memcpy(pnetdev->dev_addr, mac, ETH_ALEN); ++ ++ ++ netif_carrier_off(pnetdev); ++ ++ ++ /* Tell the network stack we exist */ ++ if (register_netdev(pnetdev) != 0) { ++ RTW_INFO("hostapd_mode_init(): register_netdev fail!\n"); ++ ++ if (pnetdev) ++ rtw_free_netdev(pnetdev); ++ } ++ ++ return 0; ++ ++} ++ ++void hostapd_mode_unload(_adapter *padapter) ++{ ++ struct hostapd_priv *phostapdpriv = padapter->phostapdpriv; ++ struct net_device *pnetdev = phostapdpriv->pmgnt_netdev; ++ ++ unregister_netdev(pnetdev); ++ rtw_free_netdev(pnetdev); ++ ++} ++ ++#endif ++#endif +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/os_intfs.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/os_intfs.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/os_intfs.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/os_intfs.c 2018-02-11 21:44:27.176146528 +0200 +@@ -0,0 +1,4414 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _OS_INTFS_C_ ++ ++#include ++#include ++ ++#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) ++ ++ #error "Shall be Linux or Windows, but not both!\n" ++ ++#endif ++ ++ ++MODULE_LICENSE("GPL"); ++MODULE_DESCRIPTION("Realtek Wireless Lan Driver"); ++MODULE_AUTHOR("Realtek Semiconductor Corp."); ++MODULE_VERSION(DRIVERVERSION); ++ ++/* module param defaults */ ++int rtw_chip_version = 0x00; ++int rtw_rfintfs = HWPI; ++int rtw_lbkmode = 0;/* RTL8712_AIR_TRX; */ ++ ++ ++int rtw_network_mode = Ndis802_11IBSS;/* Ndis802_11Infrastructure; */ /* infra, ad-hoc, auto */ ++/* NDIS_802_11_SSID ssid; */ ++int rtw_channel = 1;/* ad-hoc support requirement */ ++#ifdef CONFIG_80211N_HT ++int rtw_wireless_mode = WIRELESS_11BG_24N; ++#else ++int rtw_wireless_mode = WIRELESS_11BG; ++#endif ++int rtw_vrtl_carrier_sense = AUTO_VCS; ++int rtw_vcs_type = RTS_CTS; ++int rtw_rts_thresh = 2347; ++int rtw_frag_thresh = 2346; ++int rtw_preamble = PREAMBLE_LONG;/* long, short, auto */ ++int rtw_scan_mode = 1;/* active, passive */ ++int rtw_adhoc_tx_pwr = 1; ++int rtw_soft_ap = 0; ++/* int smart_ps = 1; */ ++#ifdef CONFIG_POWER_SAVING ++ int rtw_power_mgnt = PS_MODE_MAX; ++ #ifdef CONFIG_IPS_LEVEL_2 ++ int rtw_ips_mode = IPS_LEVEL_2; ++ #else ++ int rtw_ips_mode = IPS_NORMAL; ++ #endif ++#else ++ int rtw_power_mgnt = PS_MODE_ACTIVE; ++ int rtw_ips_mode = IPS_NONE; ++#endif ++module_param(rtw_ips_mode, int, 0644); ++MODULE_PARM_DESC(rtw_ips_mode, "The default IPS mode"); ++ ++int rtw_smart_ps = 2; ++ ++int rtw_check_fw_ps = 1; ++ ++#ifdef CONFIG_TX_EARLY_MODE ++int rtw_early_mode = 1; ++#endif ++ ++int rtw_usb_rxagg_mode = 2;/* RX_AGG_DMA=1, RX_AGG_USB=2 */ ++module_param(rtw_usb_rxagg_mode, int, 0644); ++ ++/* set log level when inserting driver module, default log level is _DRV_INFO_ = 4, ++* please refer to "How_to_set_driver_debug_log_level.doc" to set the available level. ++*/ ++#ifdef RTW_LOG_LEVEL ++ uint rtw_drv_log_level = (uint)RTW_LOG_LEVEL; /* from Makefile */ ++#else ++ uint rtw_drv_log_level = _DRV_INFO_; ++#endif ++module_param(rtw_drv_log_level, uint, 0644); ++MODULE_PARM_DESC(rtw_drv_log_level, "set log level when insert driver module, default log level is _DRV_INFO_ = 4"); ++ ++int rtw_radio_enable = 1; ++int rtw_long_retry_lmt = 7; ++int rtw_short_retry_lmt = 7; ++int rtw_busy_thresh = 40; ++/* int qos_enable = 0; */ /* * */ ++int rtw_ack_policy = NORMAL_ACK; ++ ++int rtw_mp_mode = 0; ++ ++#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTW_CUSTOMER_STR) ++uint rtw_mp_customer_str = 0; ++module_param(rtw_mp_customer_str, uint, 0644); ++MODULE_PARM_DESC(rtw_mp_customer_str, "Whether or not to enable customer str support on MP mode"); ++#endif ++ ++int rtw_software_encrypt = 0; ++int rtw_software_decrypt = 0; ++ ++int rtw_acm_method = 0;/* 0:By SW 1:By HW. */ ++ ++int rtw_wmm_enable = 1;/* default is set to enable the wmm. */ ++int rtw_uapsd_enable = 0; ++int rtw_uapsd_max_sp = NO_LIMIT; ++int rtw_uapsd_acbk_en = 0; ++int rtw_uapsd_acbe_en = 0; ++int rtw_uapsd_acvi_en = 0; ++int rtw_uapsd_acvo_en = 0; ++#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ++ int rtw_pwrtrim_enable = 2; /* disable kfree , rename to power trim disable */ ++#else ++ int rtw_pwrtrim_enable = 0; /* Default Enalbe power trim by efuse config */ ++#endif ++ ++uint rtw_tx_bw_mode = 0x21; ++module_param(rtw_tx_bw_mode, uint, 0644); ++MODULE_PARM_DESC(rtw_tx_bw_mode, "The max tx bw for 2.4G and 5G. format is the same as rtw_bw_mode"); ++ ++#ifdef CONFIG_80211N_HT ++int rtw_ht_enable = 1; ++/* 0: 20 MHz, 1: 40 MHz, 2: 80 MHz, 3: 160MHz, 4: 80+80MHz ++* 2.4G use bit 0 ~ 3, 5G use bit 4 ~ 7 ++* 0x21 means enable 2.4G 40MHz & 5G 80MHz */ ++int rtw_bw_mode = 0x21; ++int rtw_ampdu_enable = 1;/* for enable tx_ampdu , */ /* 0: disable, 0x1:enable */ ++int rtw_rx_stbc = 1;/* 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ */ ++int rtw_ampdu_amsdu = 0;/* 0: disabled, 1:enabled, 2:auto . There is an IOT issu with DLINK DIR-629 when the flag turn on */ ++/* Short GI support Bit Map ++* BIT0 - 20MHz, 0: non-support, 1: support ++* BIT1 - 40MHz, 0: non-support, 1: support ++* BIT2 - 80MHz, 0: non-support, 1: support ++* BIT3 - 160MHz, 0: non-support, 1: support */ ++int rtw_short_gi = 0xf; ++/* BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx */ ++int rtw_ldpc_cap = 0x33; ++/* BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx */ ++int rtw_stbc_cap = 0x13; ++/* ++* BIT0: Enable VHT SU Beamformer ++* BIT1: Enable VHT SU Beamformee ++* BIT2: Enable VHT MU Beamformer, depend on VHT SU Beamformer ++* BIT3: Enable VHT MU Beamformee, depend on VHT SU Beamformee ++* BIT4: Enable HT Beamformer ++* BIT5: Enable HT Beamformee ++*/ ++int rtw_beamform_cap = BIT(1) | BIT(3); ++int rtw_bfer_rf_number = 0; /*BeamformerCapRfNum Rf path number, 0 for auto, others for manual*/ ++int rtw_bfee_rf_number = 0; /*BeamformeeCapRfNum Rf path number, 0 for auto, others for manual*/ ++ ++#endif /* CONFIG_80211N_HT */ ++ ++#ifdef CONFIG_80211AC_VHT ++int rtw_vht_enable = 1; /* 0:disable, 1:enable, 2:force auto enable */ ++int rtw_ampdu_factor = 7; ++int rtw_vht_rate_sel = 0; ++#endif /* CONFIG_80211AC_VHT */ ++ ++int rtw_lowrate_two_xmit = 1;/* Use 2 path Tx to transmit MCS0~7 and legacy mode */ ++ ++/* int rf_config = RF_1T2R; */ /* 1T2R */ ++int rtw_rf_config = RF_MAX_TYPE; /* auto */ ++ ++/* 0: not check in watch dog, 1: check in watch dog */ ++int rtw_check_hw_status = 0; ++ ++int rtw_low_power = 0; ++#ifdef CONFIG_WIFI_TEST ++ int rtw_wifi_spec = 1;/* for wifi test */ ++#else ++ int rtw_wifi_spec = 0; ++#endif ++ ++#ifdef CONFIG_DEFAULT_PATTERNS_EN ++ bool rtw_support_default_patterns = _TRUE; ++#else ++ bool rtw_support_default_patterns = _FALSE; ++#endif ++ ++int rtw_special_rf_path = 0; /* 0: 2T2R ,1: only turn on path A 1T1R */ ++ ++char rtw_country_unspecified[] = {0xFF, 0xFF, 0x00}; ++char *rtw_country_code = rtw_country_unspecified; ++module_param(rtw_country_code, charp, 0644); ++MODULE_PARM_DESC(rtw_country_code, "The default country code (in alpha2)"); ++ ++int rtw_channel_plan = RTW_CHPLAN_MAX; ++module_param(rtw_channel_plan, int, 0644); ++MODULE_PARM_DESC(rtw_channel_plan, "The default chplan ID when rtw_alpha2 is not specified or valid"); ++ ++static uint rtw_excl_chs[MAX_CHANNEL_NUM] = CONFIG_RTW_EXCL_CHS; ++static int rtw_excl_chs_num = 0; ++module_param_array(rtw_excl_chs, uint, &rtw_excl_chs_num, 0644); ++MODULE_PARM_DESC(rtw_excl_chs, "exclusive channel array"); ++ ++/*if concurrent softap + p2p(GO) is needed, this param lets p2p response full channel list. ++But Softap must be SHUT DOWN once P2P decide to set up connection and become a GO.*/ ++#ifdef CONFIG_FULL_CH_IN_P2P_HANDSHAKE ++ int rtw_full_ch_in_p2p_handshake = 1; /* reply full channel list*/ ++#else ++ int rtw_full_ch_in_p2p_handshake = 0; /* reply only softap channel*/ ++#endif ++ ++#ifdef CONFIG_BT_COEXIST ++int rtw_btcoex_enable = 2; ++module_param(rtw_btcoex_enable, int, 0644); ++MODULE_PARM_DESC(rtw_btcoex_enable, "BT co-existence on/off, 0:off, 1:on, 2:by efuse"); ++ ++int rtw_ant_num = 0; ++module_param(rtw_ant_num, int, 0644); ++MODULE_PARM_DESC(rtw_ant_num, "Antenna number setting, 0:by efuse"); ++ ++int rtw_bt_iso = 2;/* 0:Low, 1:High, 2:From Efuse */ ++int rtw_bt_sco = 3;/* 0:Idle, 1:None-SCO, 2:SCO, 3:From Counter, 4.Busy, 5.OtherBusy */ ++int rtw_bt_ampdu = 1 ; /* 0:Disable BT control A-MPDU, 1:Enable BT control A-MPDU. */ ++#endif /* CONFIG_BT_COEXIST */ ++ ++int rtw_AcceptAddbaReq = _TRUE;/* 0:Reject AP's Add BA req, 1:Accept AP's Add BA req. */ ++ ++int rtw_antdiv_cfg = 2; /* 0:OFF , 1:ON, 2:decide by Efuse config */ ++int rtw_antdiv_type = 0 ++ ; /* 0:decide by efuse 1: for 88EE, 1Tx and 1RxCG are diversity.(2 Ant with SPDT), 2: for 88EE, 1Tx and 2Rx are diversity.( 2 Ant, Tx and RxCG are both on aux port, RxCS is on main port ), 3: for 88EE, 1Tx and 1RxCG are fixed.(1Ant, Tx and RxCG are both on aux port) */ ++ ++int rtw_drv_ant_band_switch = 1; /* 0:OFF , 1:ON, Driver control antenna band switch*/ ++ ++/* 0: doesn't switch, 1: switch from usb2.0 to usb 3.0 2: switch from usb3.0 to usb 2.0 */ ++int rtw_switch_usb_mode = 0; ++ ++#ifdef CONFIG_USB_AUTOSUSPEND ++int rtw_enusbss = 1;/* 0:disable,1:enable */ ++#else ++int rtw_enusbss = 0;/* 0:disable,1:enable */ ++#endif ++ ++int rtw_hwpdn_mode = 2; /* 0:disable,1:enable,2: by EFUSE config */ ++ ++#ifdef CONFIG_HW_PWRP_DETECTION ++int rtw_hwpwrp_detect = 1; ++#else ++int rtw_hwpwrp_detect = 0; /* HW power ping detect 0:disable , 1:enable */ ++#endif ++ ++#ifdef CONFIG_USB_HCI ++int rtw_hw_wps_pbc = 1; ++#else ++int rtw_hw_wps_pbc = 0; ++#endif ++ ++#ifdef CONFIG_TX_MCAST2UNI ++int rtw_mc2u_disable = 0; ++#endif /* CONFIG_TX_MCAST2UNI */ ++ ++#ifdef CONFIG_80211D ++int rtw_80211d = 0; ++#endif ++ ++#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV ++int rtw_force_ant = 2;/* 0 :normal, 1:Main ant, 2:Aux ant */ ++int rtw_force_igi = 0; /* 0 :normal */ ++module_param(rtw_force_ant, int, 0644); ++module_param(rtw_force_igi, int, 0644); ++#endif ++ ++int rtw_force_igi_lb = CONFIG_RTW_FORCE_IGI_LB; ++module_param(rtw_force_igi_lb, int, 0644); ++MODULE_PARM_DESC(rtw_force_igi_lb, "force IGI low-bound, 0:no specified"); ++ ++#ifdef CONFIG_QOS_OPTIMIZATION ++int rtw_qos_opt_enable = 1; /* 0: disable,1:enable */ ++#else ++int rtw_qos_opt_enable = 0; /* 0: disable,1:enable */ ++#endif ++module_param(rtw_qos_opt_enable, int, 0644); ++ ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++int rtw_acs_mode = 1; /*0:disable, 1:enable*/ ++module_param(rtw_acs_mode, int, 0644); ++ ++int rtw_acs_auto_scan = 0; /*0:disable, 1:enable*/ ++module_param(rtw_acs_auto_scan, int, 0644); ++ ++#endif ++ ++char *ifname = "wlan%d"; ++module_param(ifname, charp, 0644); ++MODULE_PARM_DESC(ifname, "The default name to allocate for first interface"); ++ ++#ifdef CONFIG_PLATFORM_ANDROID ++ char *if2name = "p2p%d"; ++#else /* CONFIG_PLATFORM_ANDROID */ ++ char *if2name = "wlan%d"; ++#endif /* CONFIG_PLATFORM_ANDROID */ ++module_param(if2name, charp, 0644); ++MODULE_PARM_DESC(if2name, "The default name to allocate for second interface"); ++ ++char *rtw_initmac = 0; /* temp mac address if users want to use instead of the mac address in Efuse */ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ ++ #if (CONFIG_IFACE_NUMBER > 2) ++ int rtw_virtual_iface_num = CONFIG_IFACE_NUMBER - 1; ++ module_param(rtw_virtual_iface_num, int, 0644); ++ #else ++ int rtw_virtual_iface_num = 1; ++ #endif ++ ++#endif ++ ++module_param(rtw_pwrtrim_enable, int, 0644); ++module_param(rtw_initmac, charp, 0644); ++module_param(rtw_special_rf_path, int, 0644); ++module_param(rtw_chip_version, int, 0644); ++module_param(rtw_rfintfs, int, 0644); ++module_param(rtw_lbkmode, int, 0644); ++module_param(rtw_network_mode, int, 0644); ++module_param(rtw_channel, int, 0644); ++module_param(rtw_mp_mode, int, 0644); ++module_param(rtw_wmm_enable, int, 0644); ++module_param(rtw_vrtl_carrier_sense, int, 0644); ++module_param(rtw_vcs_type, int, 0644); ++module_param(rtw_busy_thresh, int, 0644); ++ ++#ifdef CONFIG_80211N_HT ++module_param(rtw_ht_enable, int, 0644); ++module_param(rtw_bw_mode, int, 0644); ++module_param(rtw_ampdu_enable, int, 0644); ++module_param(rtw_rx_stbc, int, 0644); ++module_param(rtw_ampdu_amsdu, int, 0644); ++#endif /* CONFIG_80211N_HT */ ++#ifdef CONFIG_80211AC_VHT ++module_param(rtw_vht_enable, int, 0644); ++#endif /* CONFIG_80211AC_VHT */ ++#ifdef CONFIG_BEAMFORMING ++module_param(rtw_beamform_cap, int, 0644); ++#endif ++module_param(rtw_lowrate_two_xmit, int, 0644); ++ ++module_param(rtw_rf_config, int, 0644); ++module_param(rtw_power_mgnt, int, 0644); ++module_param(rtw_smart_ps, int, 0644); ++module_param(rtw_low_power, int, 0644); ++module_param(rtw_wifi_spec, int, 0644); ++ ++module_param(rtw_full_ch_in_p2p_handshake, int, 0644); ++module_param(rtw_antdiv_cfg, int, 0644); ++module_param(rtw_antdiv_type, int, 0644); ++ ++module_param(rtw_drv_ant_band_switch, int, 0644); ++ ++module_param(rtw_switch_usb_mode, int, 0644); ++ ++module_param(rtw_enusbss, int, 0644); ++module_param(rtw_hwpdn_mode, int, 0644); ++module_param(rtw_hwpwrp_detect, int, 0644); ++ ++module_param(rtw_hw_wps_pbc, int, 0644); ++module_param(rtw_check_hw_status, int, 0644); ++ ++#ifdef CONFIG_TX_EARLY_MODE ++module_param(rtw_early_mode, int, 0644); ++#endif ++#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE ++char *rtw_adaptor_info_caching_file_path = "/data/misc/wifi/rtw_cache"; ++module_param(rtw_adaptor_info_caching_file_path, charp, 0644); ++MODULE_PARM_DESC(rtw_adaptor_info_caching_file_path, "The path of adapter info cache file"); ++#endif /* CONFIG_ADAPTOR_INFO_CACHING_FILE */ ++ ++#ifdef CONFIG_LAYER2_ROAMING ++uint rtw_max_roaming_times = 2; ++module_param(rtw_max_roaming_times, uint, 0644); ++MODULE_PARM_DESC(rtw_max_roaming_times, "The max roaming times to try"); ++#endif /* CONFIG_LAYER2_ROAMING */ ++ ++#ifdef CONFIG_IOL ++int rtw_fw_iol = 1; ++module_param(rtw_fw_iol, int, 0644); ++MODULE_PARM_DESC(rtw_fw_iol, "FW IOL. 0:Disable, 1:enable, 2:by usb speed"); ++#endif /* CONFIG_IOL */ ++ ++#ifdef CONFIG_FILE_FWIMG ++char *rtw_fw_file_path = "/system/etc/firmware/rtlwifi/FW_NIC.BIN"; ++module_param(rtw_fw_file_path, charp, 0644); ++MODULE_PARM_DESC(rtw_fw_file_path, "The path of fw image"); ++ ++char *rtw_fw_wow_file_path = "/system/etc/firmware/rtlwifi/FW_WoWLAN.BIN"; ++module_param(rtw_fw_wow_file_path, charp, 0644); ++MODULE_PARM_DESC(rtw_fw_wow_file_path, "The path of fw for Wake on Wireless image"); ++ ++#ifdef CONFIG_MP_INCLUDED ++char *rtw_fw_mp_bt_file_path = ""; ++module_param(rtw_fw_mp_bt_file_path, charp, 0644); ++MODULE_PARM_DESC(rtw_fw_mp_bt_file_path, "The path of fw for MP-BT image"); ++#endif /* CONFIG_MP_INCLUDED */ ++#endif /* CONFIG_FILE_FWIMG */ ++ ++#ifdef CONFIG_TX_MCAST2UNI ++module_param(rtw_mc2u_disable, int, 0644); ++#endif /* CONFIG_TX_MCAST2UNI */ ++ ++#ifdef CONFIG_80211D ++module_param(rtw_80211d, int, 0644); ++MODULE_PARM_DESC(rtw_80211d, "Enable 802.11d mechanism"); ++#endif ++ ++uint rtw_notch_filter = RTW_NOTCH_FILTER; ++module_param(rtw_notch_filter, uint, 0644); ++MODULE_PARM_DESC(rtw_notch_filter, "0:Disable, 1:Enable, 2:Enable only for P2P"); ++ ++uint rtw_hiq_filter = CONFIG_RTW_HIQ_FILTER; ++module_param(rtw_hiq_filter, uint, 0644); ++MODULE_PARM_DESC(rtw_hiq_filter, "0:allow all, 1:allow special, 2:deny all"); ++ ++uint rtw_adaptivity_en = CONFIG_RTW_ADAPTIVITY_EN; ++module_param(rtw_adaptivity_en, uint, 0644); ++MODULE_PARM_DESC(rtw_adaptivity_en, "0:disable, 1:enable"); ++ ++uint rtw_adaptivity_mode = CONFIG_RTW_ADAPTIVITY_MODE; ++module_param(rtw_adaptivity_mode, uint, 0644); ++MODULE_PARM_DESC(rtw_adaptivity_mode, "0:normal, 1:carrier sense"); ++ ++uint rtw_adaptivity_dml = CONFIG_RTW_ADAPTIVITY_DML; ++module_param(rtw_adaptivity_dml, uint, 0644); ++MODULE_PARM_DESC(rtw_adaptivity_dml, "0:disable, 1:enable"); ++ ++uint rtw_adaptivity_dc_backoff = CONFIG_RTW_ADAPTIVITY_DC_BACKOFF; ++module_param(rtw_adaptivity_dc_backoff, uint, 0644); ++MODULE_PARM_DESC(rtw_adaptivity_dc_backoff, "DC backoff for Adaptivity"); ++ ++int rtw_adaptivity_th_l2h_ini = CONFIG_RTW_ADAPTIVITY_TH_L2H_INI; ++module_param(rtw_adaptivity_th_l2h_ini, int, 0644); ++MODULE_PARM_DESC(rtw_adaptivity_th_l2h_ini, "TH_L2H_ini for Adaptivity"); ++ ++int rtw_adaptivity_th_edcca_hl_diff = CONFIG_RTW_ADAPTIVITY_TH_EDCCA_HL_DIFF; ++module_param(rtw_adaptivity_th_edcca_hl_diff, int, 0644); ++MODULE_PARM_DESC(rtw_adaptivity_th_edcca_hl_diff, "TH_EDCCA_HL_diff for Adaptivity"); ++ ++#ifdef CONFIG_DFS_MASTER ++uint rtw_dfs_region_domain = CONFIG_RTW_DFS_REGION_DOMAIN; ++module_param(rtw_dfs_region_domain, uint, 0644); ++MODULE_PARM_DESC(rtw_dfs_region_domain, "1:FCC, 2:MKK, 3:ETSI"); ++#endif ++ ++uint rtw_amplifier_type_2g = CONFIG_RTW_AMPLIFIER_TYPE_2G; ++module_param(rtw_amplifier_type_2g, uint, 0644); ++MODULE_PARM_DESC(rtw_amplifier_type_2g, "BIT3:2G ext-PA, BIT4:2G ext-LNA"); ++ ++uint rtw_amplifier_type_5g = CONFIG_RTW_AMPLIFIER_TYPE_5G; ++module_param(rtw_amplifier_type_5g, uint, 0644); ++MODULE_PARM_DESC(rtw_amplifier_type_5g, "BIT6:5G ext-PA, BIT7:5G ext-LNA"); ++ ++uint rtw_RFE_type = CONFIG_RTW_RFE_TYPE; ++module_param(rtw_RFE_type, uint, 0644); ++MODULE_PARM_DESC(rtw_RFE_type, "default init value:64"); ++ ++uint rtw_powertracking_type = 64; ++module_param(rtw_powertracking_type, uint, 0644); ++MODULE_PARM_DESC(rtw_powertracking_type, "default init value:64"); ++ ++uint rtw_GLNA_type = CONFIG_RTW_GLNA_TYPE; ++module_param(rtw_GLNA_type, uint, 0644); ++MODULE_PARM_DESC(rtw_GLNA_type, "default init value:0"); ++ ++uint rtw_TxBBSwing_2G = 0xFF; ++module_param(rtw_TxBBSwing_2G, uint, 0644); ++MODULE_PARM_DESC(rtw_TxBBSwing_2G, "default init value:0xFF"); ++ ++uint rtw_TxBBSwing_5G = 0xFF; ++module_param(rtw_TxBBSwing_5G, uint, 0644); ++MODULE_PARM_DESC(rtw_TxBBSwing_5G, "default init value:0xFF"); ++ ++uint rtw_OffEfuseMask = 0; ++module_param(rtw_OffEfuseMask, uint, 0644); ++MODULE_PARM_DESC(rtw_OffEfuseMask, "default open Efuse Mask value:0"); ++ ++uint rtw_FileMaskEfuse = 0; ++module_param(rtw_FileMaskEfuse, uint, 0644); ++MODULE_PARM_DESC(rtw_FileMaskEfuse, "default drv Mask Efuse value:0"); ++ ++uint rtw_rxgain_offset_2g = 0; ++module_param(rtw_rxgain_offset_2g, uint, 0644); ++MODULE_PARM_DESC(rtw_rxgain_offset_2g, "default RF Gain 2G Offset value:0"); ++ ++uint rtw_rxgain_offset_5gl = 0; ++module_param(rtw_rxgain_offset_5gl, uint, 0644); ++MODULE_PARM_DESC(rtw_rxgain_offset_5gl, "default RF Gain 5GL Offset value:0"); ++ ++uint rtw_rxgain_offset_5gm = 0; ++module_param(rtw_rxgain_offset_5gm, uint, 0644); ++MODULE_PARM_DESC(rtw_rxgain_offset_5gm, "default RF Gain 5GM Offset value:0"); ++ ++uint rtw_rxgain_offset_5gh = 0; ++module_param(rtw_rxgain_offset_5gh, uint, 0644); ++MODULE_PARM_DESC(rtw_rxgain_offset_5gm, "default RF Gain 5GL Offset value:0"); ++ ++ ++uint rtw_pll_ref_clk_sel = CONFIG_RTW_PLL_REF_CLK_SEL; ++module_param(rtw_pll_ref_clk_sel, uint, 0644); ++MODULE_PARM_DESC(rtw_pll_ref_clk_sel, "force pll_ref_clk_sel, 0xF:use autoload value"); ++ ++int rtw_tx_pwr_by_rate = CONFIG_TXPWR_BY_RATE_EN; ++module_param(rtw_tx_pwr_by_rate, int, 0644); ++MODULE_PARM_DESC(rtw_tx_pwr_by_rate, "0:Disable, 1:Enable, 2: Depend on efuse"); ++ ++int rtw_tx_pwr_lmt_enable = CONFIG_TXPWR_LIMIT_EN; ++module_param(rtw_tx_pwr_lmt_enable, int, 0644); ++MODULE_PARM_DESC(rtw_tx_pwr_lmt_enable, "0:Disable, 1:Enable, 2: Depend on efuse"); ++ ++static int rtw_target_tx_pwr_2g_a[RATE_SECTION_NUM] = CONFIG_RTW_TARGET_TX_PWR_2G_A; ++static int rtw_target_tx_pwr_2g_a_num = 0; ++module_param_array(rtw_target_tx_pwr_2g_a, int, &rtw_target_tx_pwr_2g_a_num, 0644); ++MODULE_PARM_DESC(rtw_target_tx_pwr_2g_a, "2.4G target tx power (unit:dBm) of RF path A for each rate section, should match the real calibrate power, -1: undefined"); ++ ++static int rtw_target_tx_pwr_2g_b[RATE_SECTION_NUM] = CONFIG_RTW_TARGET_TX_PWR_2G_B; ++static int rtw_target_tx_pwr_2g_b_num = 0; ++module_param_array(rtw_target_tx_pwr_2g_b, int, &rtw_target_tx_pwr_2g_b_num, 0644); ++MODULE_PARM_DESC(rtw_target_tx_pwr_2g_b, "2.4G target tx power (unit:dBm) of RF path B for each rate section, should match the real calibrate power, -1: undefined"); ++ ++static int rtw_target_tx_pwr_2g_c[RATE_SECTION_NUM] = CONFIG_RTW_TARGET_TX_PWR_2G_C; ++static int rtw_target_tx_pwr_2g_c_num = 0; ++module_param_array(rtw_target_tx_pwr_2g_c, int, &rtw_target_tx_pwr_2g_c_num, 0644); ++MODULE_PARM_DESC(rtw_target_tx_pwr_2g_c, "2.4G target tx power (unit:dBm) of RF path C for each rate section, should match the real calibrate power, -1: undefined"); ++ ++static int rtw_target_tx_pwr_2g_d[RATE_SECTION_NUM] = CONFIG_RTW_TARGET_TX_PWR_2G_D; ++static int rtw_target_tx_pwr_2g_d_num = 0; ++module_param_array(rtw_target_tx_pwr_2g_d, int, &rtw_target_tx_pwr_2g_d_num, 0644); ++MODULE_PARM_DESC(rtw_target_tx_pwr_2g_d, "2.4G target tx power (unit:dBm) of RF path D for each rate section, should match the real calibrate power, -1: undefined"); ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++static int rtw_target_tx_pwr_5g_a[RATE_SECTION_NUM - 1] = CONFIG_RTW_TARGET_TX_PWR_5G_A; ++static int rtw_target_tx_pwr_5g_a_num = 0; ++module_param_array(rtw_target_tx_pwr_5g_a, int, &rtw_target_tx_pwr_5g_a_num, 0644); ++MODULE_PARM_DESC(rtw_target_tx_pwr_5g_a, "5G target tx power (unit:dBm) of RF path A for each rate section, should match the real calibrate power, -1: undefined"); ++ ++static int rtw_target_tx_pwr_5g_b[RATE_SECTION_NUM - 1] = CONFIG_RTW_TARGET_TX_PWR_5G_B; ++static int rtw_target_tx_pwr_5g_b_num = 0; ++module_param_array(rtw_target_tx_pwr_5g_b, int, &rtw_target_tx_pwr_5g_b_num, 0644); ++MODULE_PARM_DESC(rtw_target_tx_pwr_5g_b, "5G target tx power (unit:dBm) of RF path B for each rate section, should match the real calibrate power, -1: undefined"); ++ ++static int rtw_target_tx_pwr_5g_c[RATE_SECTION_NUM - 1] = CONFIG_RTW_TARGET_TX_PWR_5G_C; ++static int rtw_target_tx_pwr_5g_c_num = 0; ++module_param_array(rtw_target_tx_pwr_5g_c, int, &rtw_target_tx_pwr_5g_c_num, 0644); ++MODULE_PARM_DESC(rtw_target_tx_pwr_5g_c, "5G target tx power (unit:dBm) of RF path C for each rate section, should match the real calibrate power, -1: undefined"); ++ ++static int rtw_target_tx_pwr_5g_d[RATE_SECTION_NUM - 1] = CONFIG_RTW_TARGET_TX_PWR_5G_D; ++static int rtw_target_tx_pwr_5g_d_num = 0; ++module_param_array(rtw_target_tx_pwr_5g_d, int, &rtw_target_tx_pwr_5g_d_num, 0644); ++MODULE_PARM_DESC(rtw_target_tx_pwr_5g_d, "5G target tx power (unit:dBm) of RF path D for each rate section, should match the real calibrate power, -1: undefined"); ++#endif /* CONFIG_IEEE80211_BAND_5GHZ */ ++ ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++char *rtw_phy_file_path = REALTEK_CONFIG_PATH; ++module_param(rtw_phy_file_path, charp, 0644); ++MODULE_PARM_DESC(rtw_phy_file_path, "The path of phy parameter"); ++/* PHY FILE Bit Map ++* BIT0 - MAC, 0: non-support, 1: support ++* BIT1 - BB, 0: non-support, 1: support ++* BIT2 - BB_PG, 0: non-support, 1: support ++* BIT3 - BB_MP, 0: non-support, 1: support ++* BIT4 - RF, 0: non-support, 1: support ++* BIT5 - RF_TXPWR_TRACK, 0: non-support, 1: support ++* BIT6 - RF_TXPWR_LMT, 0: non-support, 1: support */ ++int rtw_load_phy_file = (BIT2 | BIT6); ++module_param(rtw_load_phy_file, int, 0644); ++MODULE_PARM_DESC(rtw_load_phy_file, "PHY File Bit Map"); ++int rtw_decrypt_phy_file = 0; ++module_param(rtw_decrypt_phy_file, int, 0644); ++MODULE_PARM_DESC(rtw_decrypt_phy_file, "Enable Decrypt PHY File"); ++#endif ++ ++#ifdef CONFIG_SUPPORT_TRX_SHARED ++#ifdef DFT_TRX_SHARE_MODE ++int rtw_trx_share_mode = DFT_TRX_SHARE_MODE; ++#else ++int rtw_trx_share_mode = 0; ++#endif ++module_param(rtw_trx_share_mode, int, 0644); ++MODULE_PARM_DESC(rtw_trx_share_mode, "TRx FIFO Shared"); ++#endif ++ ++int _netdev_open(struct net_device *pnetdev); ++int netdev_open(struct net_device *pnetdev); ++static int netdev_close(struct net_device *pnetdev); ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++extern int rtw_sdio_set_power(int on); ++#endif /* CONFIG_PLATFORM_INTEL_BYT */ ++ ++#ifdef CONFIG_MCC_MODE ++/* enable MCC mode or not */ ++int rtw_en_mcc = 1; ++/* can referece following value before insmod driver */ ++int rtw_mcc_ap_bw20_target_tx_tp = MCC_AP_BW20_TARGET_TX_TP; ++int rtw_mcc_ap_bw40_target_tx_tp = MCC_AP_BW40_TARGET_TX_TP; ++int rtw_mcc_ap_bw80_target_tx_tp = MCC_AP_BW80_TARGET_TX_TP; ++int rtw_mcc_sta_bw20_target_tx_tp = MCC_STA_BW20_TARGET_TX_TP; ++int rtw_mcc_sta_bw40_target_tx_tp = MCC_STA_BW40_TARGET_TX_TP; ++int rtw_mcc_sta_bw80_target_tx_tp = MCC_STA_BW80_TARGET_TX_TP; ++int rtw_mcc_single_tx_cri = MCC_SINGLE_TX_CRITERIA; ++module_param(rtw_en_mcc, int, 0644); ++module_param(rtw_mcc_single_tx_cri, int, 0644); ++module_param(rtw_mcc_ap_bw20_target_tx_tp, int, 0644); ++module_param(rtw_mcc_ap_bw40_target_tx_tp, int, 0644); ++module_param(rtw_mcc_ap_bw80_target_tx_tp, int, 0644); ++module_param(rtw_mcc_sta_bw20_target_tx_tp, int, 0644); ++module_param(rtw_mcc_sta_bw40_target_tx_tp, int, 0644); ++module_param(rtw_mcc_sta_bw80_target_tx_tp, int, 0644); ++#endif /*CONFIG_MCC_MODE */ ++ ++#ifdef CONFIG_RTW_NAPI ++/*following setting should define NAPI in Makefile ++enable napi only = 1, disable napi = 0*/ ++int rtw_en_napi = 1; ++module_param(rtw_en_napi, int, 0644); ++#ifdef CONFIG_RTW_GRO ++/*following setting should define GRO in Makefile ++enable gro = 1, disable gro = 0*/ ++int rtw_en_gro = 1; ++module_param(rtw_en_gro, int, 0644); ++#endif /* CONFIG_RTW_GRO */ ++#endif /* CONFIG_RTW_NAPI */ ++ ++void rtw_regsty_load_target_tx_power(struct registry_priv *regsty) ++{ ++ int path, rs; ++ int *target_tx_pwr; ++ ++ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { ++ if (path == RF_PATH_A) ++ target_tx_pwr = rtw_target_tx_pwr_2g_a; ++ else if (path == RF_PATH_B) ++ target_tx_pwr = rtw_target_tx_pwr_2g_b; ++ else if (path == RF_PATH_C) ++ target_tx_pwr = rtw_target_tx_pwr_2g_c; ++ else if (path == RF_PATH_D) ++ target_tx_pwr = rtw_target_tx_pwr_2g_d; ++ ++ for (rs = CCK; rs < RATE_SECTION_NUM; rs++) ++ regsty->target_tx_pwr_2g[path][rs] = target_tx_pwr[rs]; ++ } ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { ++ if (path == RF_PATH_A) ++ target_tx_pwr = rtw_target_tx_pwr_5g_a; ++ else if (path == RF_PATH_B) ++ target_tx_pwr = rtw_target_tx_pwr_5g_b; ++ else if (path == RF_PATH_C) ++ target_tx_pwr = rtw_target_tx_pwr_5g_c; ++ else if (path == RF_PATH_D) ++ target_tx_pwr = rtw_target_tx_pwr_5g_d; ++ ++ for (rs = OFDM; rs < RATE_SECTION_NUM; rs++) ++ regsty->target_tx_pwr_5g[path][rs - 1] = target_tx_pwr[rs - 1]; ++ } ++#endif /* CONFIG_IEEE80211_BAND_5GHZ */ ++} ++ ++inline void rtw_regsty_load_excl_chs(struct registry_priv *regsty) ++{ ++ int i; ++ int ch_num = 0; ++ ++ for (i = 0; i < MAX_CHANNEL_NUM; i++) ++ if (((u8)rtw_excl_chs[i]) != 0) ++ regsty->excl_chs[ch_num++] = (u8)rtw_excl_chs[i]; ++ ++ if (ch_num < MAX_CHANNEL_NUM) ++ regsty->excl_chs[ch_num] = 0; ++} ++ ++uint loadparam(_adapter *padapter) ++{ ++ uint status = _SUCCESS; ++ struct registry_priv *registry_par = &padapter->registrypriv; ++ ++ ++#ifdef CONFIG_RTW_DEBUG ++ if (rtw_drv_log_level >= _DRV_MAX_) ++ rtw_drv_log_level = _DRV_DEBUG_; ++#endif ++ ++ registry_par->chip_version = (u8)rtw_chip_version; ++ registry_par->rfintfs = (u8)rtw_rfintfs; ++ registry_par->lbkmode = (u8)rtw_lbkmode; ++ /* registry_par->hci = (u8)hci; */ ++ registry_par->network_mode = (u8)rtw_network_mode; ++ ++ _rtw_memcpy(registry_par->ssid.Ssid, "ANY", 3); ++ registry_par->ssid.SsidLength = 3; ++ ++ registry_par->channel = (u8)rtw_channel; ++ registry_par->wireless_mode = (u8)rtw_wireless_mode; ++ ++ if (IsSupported24G(registry_par->wireless_mode) && (!IsSupported5G(registry_par->wireless_mode)) ++ && (registry_par->channel > 14)) ++ registry_par->channel = 1; ++ else if (IsSupported5G(registry_par->wireless_mode) && (!IsSupported24G(registry_par->wireless_mode)) ++ && (registry_par->channel <= 14)) ++ registry_par->channel = 36; ++ ++ registry_par->vrtl_carrier_sense = (u8)rtw_vrtl_carrier_sense ; ++ registry_par->vcs_type = (u8)rtw_vcs_type; ++ registry_par->rts_thresh = (u16)rtw_rts_thresh; ++ registry_par->frag_thresh = (u16)rtw_frag_thresh; ++ registry_par->preamble = (u8)rtw_preamble; ++ registry_par->scan_mode = (u8)rtw_scan_mode; ++ registry_par->adhoc_tx_pwr = (u8)rtw_adhoc_tx_pwr; ++ registry_par->soft_ap = (u8)rtw_soft_ap; ++ registry_par->smart_ps = (u8)rtw_smart_ps; ++ registry_par->check_fw_ps = (u8)rtw_check_fw_ps; ++ registry_par->power_mgnt = (u8)rtw_power_mgnt; ++ registry_par->ips_mode = (u8)rtw_ips_mode; ++ registry_par->radio_enable = (u8)rtw_radio_enable; ++ registry_par->long_retry_lmt = (u8)rtw_long_retry_lmt; ++ registry_par->short_retry_lmt = (u8)rtw_short_retry_lmt; ++ registry_par->busy_thresh = (u16)rtw_busy_thresh; ++ /* registry_par->qos_enable = (u8)rtw_qos_enable; */ ++ registry_par->ack_policy = (u8)rtw_ack_policy; ++ registry_par->mp_mode = (u8)rtw_mp_mode; ++#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTW_CUSTOMER_STR) ++ registry_par->mp_customer_str = (u8)rtw_mp_customer_str; ++#endif ++ registry_par->software_encrypt = (u8)rtw_software_encrypt; ++ registry_par->software_decrypt = (u8)rtw_software_decrypt; ++ ++ registry_par->acm_method = (u8)rtw_acm_method; ++ registry_par->usb_rxagg_mode = (u8)rtw_usb_rxagg_mode; ++ ++ /* UAPSD */ ++ registry_par->wmm_enable = (u8)rtw_wmm_enable; ++ registry_par->uapsd_enable = (u8)rtw_uapsd_enable; ++ registry_par->uapsd_max_sp = (u8)rtw_uapsd_max_sp; ++ registry_par->uapsd_acbk_en = (u8)rtw_uapsd_acbk_en; ++ registry_par->uapsd_acbe_en = (u8)rtw_uapsd_acbe_en; ++ registry_par->uapsd_acvi_en = (u8)rtw_uapsd_acvi_en; ++ registry_par->uapsd_acvo_en = (u8)rtw_uapsd_acvo_en; ++ ++ registry_par->RegPwrTrimEnable = (u8)rtw_pwrtrim_enable; ++ ++ registry_par->tx_bw_mode = (u8)rtw_tx_bw_mode; ++ ++#ifdef CONFIG_80211N_HT ++ registry_par->ht_enable = (u8)rtw_ht_enable; ++ registry_par->bw_mode = (u8)rtw_bw_mode; ++ registry_par->ampdu_enable = (u8)rtw_ampdu_enable; ++ registry_par->rx_stbc = (u8)rtw_rx_stbc; ++ registry_par->ampdu_amsdu = (u8)rtw_ampdu_amsdu; ++ registry_par->short_gi = (u8)rtw_short_gi; ++ registry_par->ldpc_cap = (u8)rtw_ldpc_cap; ++ registry_par->stbc_cap = (u8)rtw_stbc_cap; ++ registry_par->beamform_cap = (u8)rtw_beamform_cap; ++ registry_par->beamformer_rf_num = (u8)rtw_bfer_rf_number; ++ registry_par->beamformee_rf_num = (u8)rtw_bfee_rf_number; ++#endif ++ ++#ifdef CONFIG_80211AC_VHT ++ registry_par->vht_enable = (u8)rtw_vht_enable; ++ registry_par->ampdu_factor = (u8)rtw_ampdu_factor; ++ registry_par->vht_rate_sel = (u8)rtw_vht_rate_sel; ++#endif ++ ++#ifdef CONFIG_TX_EARLY_MODE ++ registry_par->early_mode = (u8)rtw_early_mode; ++#endif ++ registry_par->lowrate_two_xmit = (u8)rtw_lowrate_two_xmit; ++ registry_par->rf_config = (u8)rtw_rf_config; ++ registry_par->low_power = (u8)rtw_low_power; ++ ++ registry_par->check_hw_status = (u8)rtw_check_hw_status; ++ ++ registry_par->wifi_spec = (u8)rtw_wifi_spec; ++ ++ if (strlen(rtw_country_code) != 2 ++ || is_alpha(rtw_country_code[0]) == _FALSE ++ || is_alpha(rtw_country_code[1]) == _FALSE ++ ) { ++ if (rtw_country_code != rtw_country_unspecified) ++ RTW_ERR("%s discard rtw_country_code not in alpha2\n", __func__); ++ _rtw_memset(registry_par->alpha2, 0xFF, 2); ++ } else ++ _rtw_memcpy(registry_par->alpha2, rtw_country_code, 2); ++ ++ registry_par->channel_plan = (u8)rtw_channel_plan; ++ rtw_regsty_load_excl_chs(registry_par); ++ ++ registry_par->special_rf_path = (u8)rtw_special_rf_path; ++ ++ registry_par->full_ch_in_p2p_handshake = (u8)rtw_full_ch_in_p2p_handshake; ++#ifdef CONFIG_BT_COEXIST ++ registry_par->btcoex = (u8)rtw_btcoex_enable; ++ registry_par->bt_iso = (u8)rtw_bt_iso; ++ registry_par->bt_sco = (u8)rtw_bt_sco; ++ registry_par->bt_ampdu = (u8)rtw_bt_ampdu; ++ registry_par->ant_num = (u8)rtw_ant_num; ++#endif ++ ++ registry_par->bAcceptAddbaReq = (u8)rtw_AcceptAddbaReq; ++ ++ registry_par->antdiv_cfg = (u8)rtw_antdiv_cfg; ++ registry_par->antdiv_type = (u8)rtw_antdiv_type; ++ ++ registry_par->drv_ant_band_switch = (u8) rtw_drv_ant_band_switch; ++ ++ registry_par->switch_usb_mode = (u8)rtw_switch_usb_mode; ++ ++#ifdef CONFIG_AUTOSUSPEND ++ registry_par->usbss_enable = (u8)rtw_enusbss;/* 0:disable,1:enable */ ++#endif ++#ifdef SUPPORT_HW_RFOFF_DETECTED ++ registry_par->hwpdn_mode = (u8)rtw_hwpdn_mode;/* 0:disable,1:enable,2:by EFUSE config */ ++ registry_par->hwpwrp_detect = (u8)rtw_hwpwrp_detect;/* 0:disable,1:enable */ ++#endif ++ ++ registry_par->hw_wps_pbc = (u8)rtw_hw_wps_pbc; ++ ++#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE ++ snprintf(registry_par->adaptor_info_caching_file_path, PATH_LENGTH_MAX, "%s", rtw_adaptor_info_caching_file_path); ++ registry_par->adaptor_info_caching_file_path[PATH_LENGTH_MAX - 1] = 0; ++#endif ++ ++#ifdef CONFIG_LAYER2_ROAMING ++ registry_par->max_roaming_times = (u8)rtw_max_roaming_times; ++#ifdef CONFIG_INTEL_WIDI ++ registry_par->max_roaming_times = (u8)rtw_max_roaming_times + 2; ++#endif /* CONFIG_INTEL_WIDI */ ++#endif ++ ++#ifdef CONFIG_IOL ++ registry_par->fw_iol = rtw_fw_iol; ++#endif ++ ++#ifdef CONFIG_80211D ++ registry_par->enable80211d = (u8)rtw_80211d; ++#endif ++ ++ snprintf(registry_par->ifname, 16, "%s", ifname); ++ snprintf(registry_par->if2name, 16, "%s", if2name); ++ ++ registry_par->notch_filter = (u8)rtw_notch_filter; ++ ++#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV ++ registry_par->force_ant = (u8)rtw_force_ant; ++ registry_par->force_igi = (u8)rtw_force_igi; ++#endif ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ registry_par->virtual_iface_num = (u8)rtw_virtual_iface_num; ++#endif ++ ++ registry_par->force_igi_lb = (u8)rtw_force_igi_lb; ++ ++ registry_par->pll_ref_clk_sel = (u8)rtw_pll_ref_clk_sel; ++ ++ registry_par->RegEnableTxPowerLimit = (u8)rtw_tx_pwr_lmt_enable; ++ registry_par->RegEnableTxPowerByRate = (u8)rtw_tx_pwr_by_rate; ++ ++ rtw_regsty_load_target_tx_power(registry_par); ++ ++ registry_par->RegPowerBase = 14; ++ registry_par->TxBBSwing_2G = (s8)rtw_TxBBSwing_2G; ++ registry_par->TxBBSwing_5G = (s8)rtw_TxBBSwing_5G; ++ registry_par->bEn_RFE = 1; ++ registry_par->RFE_Type = (u8)rtw_RFE_type; ++ registry_par->PowerTracking_Type = (u8)rtw_powertracking_type; ++ registry_par->AmplifierType_2G = (u8)rtw_amplifier_type_2g; ++ registry_par->AmplifierType_5G = (u8)rtw_amplifier_type_5g; ++ registry_par->GLNA_Type = (u8)rtw_GLNA_type; ++#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ registry_par->load_phy_file = (u8)rtw_load_phy_file; ++ registry_par->RegDecryptCustomFile = (u8)rtw_decrypt_phy_file; ++#endif ++ registry_par->qos_opt_enable = (u8)rtw_qos_opt_enable; ++ ++ registry_par->hiq_filter = (u8)rtw_hiq_filter; ++ ++ registry_par->adaptivity_en = (u8)rtw_adaptivity_en; ++ registry_par->adaptivity_mode = (u8)rtw_adaptivity_mode; ++ registry_par->adaptivity_dml = (u8)rtw_adaptivity_dml; ++ registry_par->adaptivity_dc_backoff = (u8)rtw_adaptivity_dc_backoff; ++ registry_par->adaptivity_th_l2h_ini = (s8)rtw_adaptivity_th_l2h_ini; ++ registry_par->adaptivity_th_edcca_hl_diff = (s8)rtw_adaptivity_th_edcca_hl_diff; ++ ++ registry_par->boffefusemask = (u8)rtw_OffEfuseMask; ++ registry_par->bFileMaskEfuse = (u8)rtw_FileMaskEfuse; ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++ registry_par->acs_mode = (u8)rtw_acs_mode; ++ registry_par->acs_auto_scan = (u8)rtw_acs_auto_scan; ++#endif ++ registry_par->reg_rxgain_offset_2g = (u32) rtw_rxgain_offset_2g; ++ registry_par->reg_rxgain_offset_5gl = (u32) rtw_rxgain_offset_5gl; ++ registry_par->reg_rxgain_offset_5gm = (u32) rtw_rxgain_offset_5gm; ++ registry_par->reg_rxgain_offset_5gh = (u32) rtw_rxgain_offset_5gh; ++ ++#ifdef CONFIG_DFS_MASTER ++ registry_par->dfs_region_domain = (u8)rtw_dfs_region_domain; ++#endif ++ ++#ifdef CONFIG_MCC_MODE ++ registry_par->en_mcc = (u8)rtw_en_mcc; ++ registry_par->rtw_mcc_ap_bw20_target_tx_tp = (u32)rtw_mcc_ap_bw20_target_tx_tp; ++ registry_par->rtw_mcc_ap_bw40_target_tx_tp = (u32)rtw_mcc_ap_bw40_target_tx_tp; ++ registry_par->rtw_mcc_ap_bw80_target_tx_tp = (u32)rtw_mcc_ap_bw80_target_tx_tp; ++ registry_par->rtw_mcc_sta_bw20_target_tx_tp = (u32)rtw_mcc_sta_bw20_target_tx_tp; ++ registry_par->rtw_mcc_sta_bw40_target_tx_tp = (u32)rtw_mcc_sta_bw40_target_tx_tp; ++ registry_par->rtw_mcc_sta_bw80_target_tx_tp = (u32)rtw_mcc_sta_bw80_target_tx_tp; ++ registry_par->rtw_mcc_single_tx_cri = (u32)rtw_mcc_single_tx_cri; ++#endif /*CONFIG_MCC_MODE */ ++#ifdef CONFIG_DEFAULT_PATTERNS_EN ++ registry_par->default_patterns_en = rtw_support_default_patterns; ++#endif ++ ++#ifdef CONFIG_SUPPORT_TRX_SHARED ++ registry_par->trx_share_mode = rtw_trx_share_mode; ++#endif ++ ++#ifdef CONFIG_RTW_NAPI ++ registry_par->en_napi = (u8)rtw_en_napi; ++#ifdef CONFIG_RTW_GRO ++ registry_par->en_gro = (u8)rtw_en_gro; ++ if (!registry_par->en_napi && registry_par->en_gro) { ++ registry_par->en_gro = 0; ++ RTW_WARN("Disable GRO because NAPI is not enabled\n"); ++ } ++#endif /* CONFIG_RTW_GRO */ ++#endif /* CONFIG_RTW_NAPI */ ++ ++ return status; ++} ++ ++/** ++ * rtw_net_set_mac_address ++ * This callback function is used for the Media Access Control address ++ * of each net_device needs to be changed. ++ * ++ * Arguments: ++ * @pnetdev: net_device pointer. ++ * @addr: new MAC address. ++ * ++ * Return: ++ * ret = 0: Permit to change net_device's MAC address. ++ * ret = -1 (Default): Operation not permitted. ++ * ++ * Auther: Arvin Liu ++ * Date: 2015/05/29 ++ */ ++static int rtw_net_set_mac_address(struct net_device *pnetdev, void *addr) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct sockaddr *sa = (struct sockaddr *)addr; ++ int ret = -1; ++ ++ /* only the net_device is in down state to permit modifying mac addr */ ++ if ((pnetdev->flags & IFF_UP) == _TRUE) { ++ RTW_INFO(FUNC_ADPT_FMT": The net_device's is not in down state\n" ++ , FUNC_ADPT_ARG(padapter)); ++ ++ return ret; ++ } ++ ++ /* if the net_device is linked, it's not permit to modify mac addr */ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) || ++ check_fwstate(pmlmepriv, _FW_LINKED) || ++ check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { ++ RTW_INFO(FUNC_ADPT_FMT": The net_device's is not idle currently\n" ++ , FUNC_ADPT_ARG(padapter)); ++ ++ return ret; ++ } ++ ++ /* check whether the input mac address is valid to permit modifying mac addr */ ++ if (rtw_check_invalid_mac_address(sa->sa_data, _FALSE) == _TRUE) { ++ RTW_INFO(FUNC_ADPT_FMT": Invalid Mac Addr for "MAC_FMT"\n" ++ , FUNC_ADPT_ARG(padapter), MAC_ARG(sa->sa_data)); ++ ++ return ret; ++ } ++ ++ _rtw_memcpy(adapter_mac_addr(padapter), sa->sa_data, ETH_ALEN); /* set mac addr to adapter */ ++ _rtw_memcpy(pnetdev->dev_addr, sa->sa_data, ETH_ALEN); /* set mac addr to net_device */ ++ ++#if 0 ++ if (rtw_is_hw_init_completed(padapter)) { ++ rtw_ps_deny(padapter, PS_DENY_IOCTL); ++ LeaveAllPowerSaveModeDirect(padapter); /* leave PS mode for guaranteeing to access hw register successfully */ ++ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ rtw_hal_change_macaddr_mbid(padapter, sa->sa_data); ++#else ++ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, sa->sa_data); /* set mac addr to mac register */ ++#endif ++ ++ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); ++ } ++#else ++ rtw_ps_deny(padapter, PS_DENY_IOCTL); ++ LeaveAllPowerSaveModeDirect(padapter); /* leave PS mode for guaranteeing to access hw register successfully */ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ rtw_hal_change_macaddr_mbid(padapter, sa->sa_data); ++#else ++ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, sa->sa_data); /* set mac addr to mac register */ ++#endif ++ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); ++#endif ++ ++ RTW_INFO(FUNC_ADPT_FMT": Set Mac Addr to "MAC_FMT" Successfully\n" ++ , FUNC_ADPT_ARG(padapter), MAC_ARG(sa->sa_data)); ++ ++ ret = 0; ++ ++ return ret; ++} ++ ++static struct net_device_stats *rtw_net_get_stats(struct net_device *pnetdev) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct recv_priv *precvpriv = &(padapter->recvpriv); ++ ++ padapter->stats.tx_packets = pxmitpriv->tx_pkts;/* pxmitpriv->tx_pkts++; */ ++ padapter->stats.rx_packets = precvpriv->rx_pkts;/* precvpriv->rx_pkts++; */ ++ padapter->stats.tx_dropped = pxmitpriv->tx_drop; ++ padapter->stats.rx_dropped = precvpriv->rx_drop; ++ padapter->stats.tx_bytes = pxmitpriv->tx_bytes; ++ padapter->stats.rx_bytes = precvpriv->rx_bytes; ++ ++ return &padapter->stats; ++} ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++/* ++ * AC to queue mapping ++ * ++ * AC_VO -> queue 0 ++ * AC_VI -> queue 1 ++ * AC_BE -> queue 2 ++ * AC_BK -> queue 3 ++ */ ++static const u16 rtw_1d_to_queue[8] = { 2, 3, 3, 2, 1, 1, 0, 0 }; ++ ++/* Given a data frame determine the 802.1p/1d tag to use. */ ++unsigned int rtw_classify8021d(struct sk_buff *skb) ++{ ++ unsigned int dscp; ++ ++ /* skb->priority values from 256->263 are magic values to ++ * directly indicate a specific 802.1d priority. This is used ++ * to allow 802.1d priority to be passed directly in from VLAN ++ * tags, etc. ++ */ ++ if (skb->priority >= 256 && skb->priority <= 263) ++ return skb->priority - 256; ++ ++ switch (skb->protocol) { ++ case htons(ETH_P_IP): ++ dscp = ip_hdr(skb)->tos & 0xfc; ++ break; ++ default: ++ return 0; ++ } ++ ++ return dscp >> 5; ++} ++ ++ ++static u16 rtw_select_queue(struct net_device *dev, struct sk_buff *skb ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0) ++ , void *accel_priv ++ #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0) ++ , select_queue_fallback_t fallback ++ #endif ++#endif ++) ++{ ++ _adapter *padapter = rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ skb->priority = rtw_classify8021d(skb); ++ ++ if (pmlmepriv->acm_mask != 0) ++ skb->priority = qos_acm(pmlmepriv->acm_mask, skb->priority); ++ ++ return rtw_1d_to_queue[skb->priority]; ++} ++ ++u16 rtw_recv_select_queue(struct sk_buff *skb) ++{ ++ struct iphdr *piphdr; ++ unsigned int dscp; ++ u16 eth_type; ++ u32 priority; ++ u8 *pdata = skb->data; ++ ++ _rtw_memcpy(ð_type, pdata + (ETH_ALEN << 1), 2); ++ ++ switch (eth_type) { ++ case htons(ETH_P_IP): ++ ++ piphdr = (struct iphdr *)(pdata + ETH_HLEN); ++ ++ dscp = piphdr->tos & 0xfc; ++ ++ priority = dscp >> 5; ++ ++ break; ++ default: ++ priority = 0; ++ } ++ ++ return rtw_1d_to_queue[priority]; ++ ++} ++ ++#endif ++static int rtw_ndev_notifier_call(struct notifier_block *nb, unsigned long state, void *ptr) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) ++ struct net_device *dev = netdev_notifier_info_to_dev(ptr); ++#else ++ struct net_device *dev = ptr; ++#endif ++ ++ if (dev == NULL) ++ return NOTIFY_DONE; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) ++ if (dev->netdev_ops == NULL) ++ return NOTIFY_DONE; ++ ++ if (dev->netdev_ops->ndo_do_ioctl == NULL) ++ return NOTIFY_DONE; ++ ++ if (dev->netdev_ops->ndo_do_ioctl != rtw_ioctl) ++#else ++ if (dev->do_ioctl == NULL) ++ return NOTIFY_DONE; ++ ++ if (dev->do_ioctl != rtw_ioctl) ++#endif ++ return NOTIFY_DONE; ++ ++ RTW_INFO(FUNC_NDEV_FMT" state:%lu\n", FUNC_NDEV_ARG(dev), state); ++ ++ switch (state) { ++ case NETDEV_CHANGENAME: ++ rtw_adapter_proc_replace(dev); ++ break; ++ } ++ ++ return NOTIFY_DONE; ++} ++ ++static struct notifier_block rtw_ndev_notifier = { ++ .notifier_call = rtw_ndev_notifier_call, ++}; ++ ++int rtw_ndev_notifier_register(void) ++{ ++ return register_netdevice_notifier(&rtw_ndev_notifier); ++} ++ ++void rtw_ndev_notifier_unregister(void) ++{ ++ unregister_netdevice_notifier(&rtw_ndev_notifier); ++} ++ ++ ++int rtw_ndev_init(struct net_device *dev) ++{ ++ _adapter *adapter = rtw_netdev_priv(dev); ++ ++ RTW_PRINT(FUNC_ADPT_FMT" if%d mac_addr="MAC_FMT"\n" ++ , FUNC_ADPT_ARG(adapter), (adapter->iface_id + 1), MAC_ARG(dev->dev_addr)); ++ strncpy(adapter->old_ifname, dev->name, IFNAMSIZ); ++ adapter->old_ifname[IFNAMSIZ - 1] = '\0'; ++ rtw_adapter_proc_init(dev); ++ ++ return 0; ++} ++ ++void rtw_ndev_uninit(struct net_device *dev) ++{ ++ _adapter *adapter = rtw_netdev_priv(dev); ++ ++ RTW_PRINT(FUNC_ADPT_FMT" if%d\n" ++ , FUNC_ADPT_ARG(adapter), (adapter->iface_id + 1)); ++ rtw_adapter_proc_deinit(dev); ++} ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) ++static const struct net_device_ops rtw_netdev_ops = { ++ .ndo_init = rtw_ndev_init, ++ .ndo_uninit = rtw_ndev_uninit, ++ .ndo_open = netdev_open, ++ .ndo_stop = netdev_close, ++ .ndo_start_xmit = rtw_xmit_entry, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ .ndo_select_queue = rtw_select_queue, ++#endif ++ .ndo_set_mac_address = rtw_net_set_mac_address, ++ .ndo_get_stats = rtw_net_get_stats, ++ .ndo_do_ioctl = rtw_ioctl, ++}; ++#endif ++ ++int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname) ++{ ++ _adapter *padapter = rtw_netdev_priv(pnetdev); ++ ++#ifdef CONFIG_EASY_REPLACEMENT ++ struct net_device *TargetNetdev = NULL; ++ _adapter *TargetAdapter = NULL; ++ struct net *devnet = NULL; ++ ++ if (padapter->bDongle == 1) { ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) ++ TargetNetdev = dev_get_by_name("wlan0"); ++#else ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) ++ devnet = pnetdev->nd_net; ++#else ++ devnet = dev_net(pnetdev); ++#endif ++ TargetNetdev = dev_get_by_name(devnet, "wlan0"); ++#endif ++ if (TargetNetdev) { ++ RTW_INFO("Force onboard module driver disappear !!!\n"); ++ TargetAdapter = rtw_netdev_priv(TargetNetdev); ++ TargetAdapter->DriverState = DRIVER_DISAPPEAR; ++ ++ padapter->pid[0] = TargetAdapter->pid[0]; ++ padapter->pid[1] = TargetAdapter->pid[1]; ++ padapter->pid[2] = TargetAdapter->pid[2]; ++ ++ dev_put(TargetNetdev); ++ unregister_netdev(TargetNetdev); ++ ++ padapter->DriverState = DRIVER_REPLACE_DONGLE; ++ } ++ } ++#endif /* CONFIG_EASY_REPLACEMENT */ ++ ++ if (dev_alloc_name(pnetdev, ifname) < 0) ++ RTW_ERR("dev_alloc_name, fail!\n"); ++ ++ netif_carrier_off(pnetdev); ++ /* rtw_netif_stop_queue(pnetdev); */ ++ ++ return 0; ++} ++ ++void rtw_hook_if_ops(struct net_device *ndev) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) ++ ndev->netdev_ops = &rtw_netdev_ops; ++#else ++ ndev->init = rtw_ndev_init; ++ ndev->uninit = rtw_ndev_uninit; ++ ndev->open = netdev_open; ++ ndev->stop = netdev_close; ++ ndev->hard_start_xmit = rtw_xmit_entry; ++ ndev->set_mac_address = rtw_net_set_mac_address; ++ ndev->get_stats = rtw_net_get_stats; ++ ndev->do_ioctl = rtw_ioctl; ++#endif ++} ++ ++#ifdef CONFIG_CONCURRENT_MODE ++static void rtw_hook_vir_if_ops(struct net_device *ndev); ++#endif ++struct net_device *rtw_init_netdev(_adapter *old_padapter) ++{ ++ _adapter *padapter; ++ struct net_device *pnetdev; ++ ++ if (old_padapter != NULL) { ++ rtw_os_ndev_free(old_padapter); ++ pnetdev = rtw_alloc_etherdev_with_old_priv(sizeof(_adapter), (void *)old_padapter); ++ } else ++ pnetdev = rtw_alloc_etherdev(sizeof(_adapter)); ++ ++ if (!pnetdev) ++ return NULL; ++ ++ padapter = rtw_netdev_priv(pnetdev); ++ padapter->pnetdev = pnetdev; ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24) ++ SET_MODULE_OWNER(pnetdev); ++#endif ++ ++ rtw_hook_if_ops(pnetdev); ++#ifdef CONFIG_CONCURRENT_MODE ++ if (!is_primary_adapter(padapter)) ++ rtw_hook_vir_if_ops(pnetdev); ++#endif /* CONFIG_CONCURRENT_MODE */ ++ ++#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX ++ pnetdev->features |= NETIF_F_IP_CSUM; ++#endif ++ ++ /* pnetdev->tx_timeout = NULL; */ ++ pnetdev->watchdog_timeo = HZ * 3; /* 3 second timeout */ ++ ++#ifdef CONFIG_WIRELESS_EXT ++ pnetdev->wireless_handlers = (struct iw_handler_def *)&rtw_handlers_def; ++#endif ++ ++#ifdef WIRELESS_SPY ++ /* priv->wireless_data.spy_data = &priv->spy_data; */ ++ /* pnetdev->wireless_data = &priv->wireless_data; */ ++#endif ++ ++ return pnetdev; ++} ++ ++int rtw_os_ndev_alloc(_adapter *adapter) ++{ ++ int ret = _FAIL; ++ struct net_device *ndev = NULL; ++ ++ ndev = rtw_init_netdev(adapter); ++ if (ndev == NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++#if LINUX_VERSION_CODE > KERNEL_VERSION(2, 5, 0) ++ SET_NETDEV_DEV(ndev, dvobj_to_dev(adapter_to_dvobj(adapter))); ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ if (adapter_to_dvobj(adapter)->bdma64) ++ ndev->features |= NETIF_F_HIGHDMA; ++ ndev->irq = adapter_to_dvobj(adapter)->irq; ++#endif ++ ++#if defined(CONFIG_IOCTL_CFG80211) ++ if (rtw_cfg80211_ndev_res_alloc(adapter) != _SUCCESS) { ++ rtw_warn_on(1); ++ goto free_ndev; ++ } ++#endif ++ ++ ret = _SUCCESS; ++ ++free_ndev: ++ if (ret != _SUCCESS && ndev) ++ rtw_free_netdev(ndev); ++exit: ++ return ret; ++} ++ ++void rtw_os_ndev_free(_adapter *adapter) ++{ ++#if defined(CONFIG_IOCTL_CFG80211) ++ rtw_cfg80211_ndev_res_free(adapter); ++#endif ++ ++ if (adapter->pnetdev) { ++ rtw_free_netdev(adapter->pnetdev); ++ adapter->pnetdev = NULL; ++ } ++} ++ ++int rtw_os_ndev_register(_adapter *adapter, const char *name) ++{ ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ int ret = _SUCCESS; ++ struct net_device *ndev = adapter->pnetdev; ++ u8 rtnl_lock_needed = rtw_rtnl_lock_needed(dvobj); ++ ++#ifdef CONFIG_RTW_NAPI ++ netif_napi_add(ndev, &adapter->napi, rtw_recv_napi_poll, RTL_NAPI_WEIGHT); ++#endif /* CONFIG_RTW_NAPI */ ++ ++#if defined(CONFIG_IOCTL_CFG80211) ++ if (rtw_cfg80211_ndev_res_register(adapter) != _SUCCESS) { ++ rtw_warn_on(1); ++ ret = _FAIL; ++ goto exit; ++ } ++#endif ++ ++ /* alloc netdev name */ ++ rtw_init_netdev_name(ndev, name); ++ ++ _rtw_memcpy(ndev->dev_addr, adapter_mac_addr(adapter), ETH_ALEN); ++ ++ /* Tell the network stack we exist */ ++ ++ if (rtnl_lock_needed) ++ ret = (register_netdev(ndev) == 0) ? _SUCCESS : _FAIL; ++ else ++ ret = (register_netdevice(ndev) == 0) ? _SUCCESS : _FAIL; ++ ++ if (ret == _SUCCESS) ++ adapter->registered = 1; ++ else ++ RTW_INFO(FUNC_NDEV_FMT" if%d Failed!\n", FUNC_NDEV_ARG(ndev), (adapter->iface_id + 1)); ++ ++#if defined(CONFIG_IOCTL_CFG80211) ++ if (ret != _SUCCESS) { ++ rtw_cfg80211_ndev_res_unregister(adapter); ++ #if !defined(RTW_SINGLE_WIPHY) ++ rtw_wiphy_unregister(adapter_to_wiphy(adapter)); ++ #endif ++ } ++#endif ++ ++exit: ++#ifdef CONFIG_RTW_NAPI ++ if (ret != _SUCCESS) ++ netif_napi_del(&adapter->napi); ++#endif /* CONFIG_RTW_NAPI */ ++ ++ return ret; ++} ++ ++void rtw_os_ndev_unregister(_adapter *adapter) ++{ ++ struct net_device *netdev = NULL; ++ ++ if (adapter == NULL || adapter->registered == 0) ++ return; ++ ++ adapter->ndev_unregistering = 1; ++ ++ netdev = adapter->pnetdev; ++ ++#if defined(CONFIG_IOCTL_CFG80211) ++ rtw_cfg80211_ndev_res_unregister(adapter); ++#endif ++ ++ if ((adapter->DriverState != DRIVER_DISAPPEAR) && netdev) { ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ u8 rtnl_lock_needed = rtw_rtnl_lock_needed(dvobj); ++ ++ if (rtnl_lock_needed) ++ unregister_netdev(netdev); ++ else ++ unregister_netdevice(netdev); ++ } ++ ++#if defined(CONFIG_IOCTL_CFG80211) && !defined(RTW_SINGLE_WIPHY) ++ rtw_wiphy_unregister(adapter_to_wiphy(adapter)); ++#endif ++ ++#ifdef CONFIG_RTW_NAPI ++ if (adapter->napi_state == NAPI_ENABLE) { ++ napi_disable(&adapter->napi); ++ adapter->napi_state = NAPI_DISABLE; ++ } ++ netif_napi_del(&adapter->napi); ++#endif /* CONFIG_RTW_NAPI */ ++ ++ adapter->registered = 0; ++ adapter->ndev_unregistering = 0; ++} ++ ++/** ++ * rtw_os_ndev_init - Allocate and register OS layer net device and relating structures for @adapter ++ * @adapter: the adapter on which this function applies ++ * @name: the requesting net device name ++ * ++ * Returns: ++ * _SUCCESS or _FAIL ++ */ ++int rtw_os_ndev_init(_adapter *adapter, const char *name) ++{ ++ int ret = _FAIL; ++ ++ if (rtw_os_ndev_alloc(adapter) != _SUCCESS) ++ goto exit; ++ ++ if (rtw_os_ndev_register(adapter, name) != _SUCCESS) ++ goto os_ndev_free; ++ ++ ret = _SUCCESS; ++ ++os_ndev_free: ++ if (ret != _SUCCESS) ++ rtw_os_ndev_free(adapter); ++exit: ++ return ret; ++} ++ ++/** ++ * rtw_os_ndev_deinit - Unregister and free OS layer net device and relating structures for @adapter ++ * @adapter: the adapter on which this function applies ++ */ ++void rtw_os_ndev_deinit(_adapter *adapter) ++{ ++ rtw_os_ndev_unregister(adapter); ++ rtw_os_ndev_free(adapter); ++} ++ ++int rtw_os_ndevs_alloc(struct dvobj_priv *dvobj) ++{ ++ int i, status = _SUCCESS; ++ _adapter *adapter; ++ ++#if defined(CONFIG_IOCTL_CFG80211) ++ if (rtw_cfg80211_dev_res_alloc(dvobj) != _SUCCESS) { ++ rtw_warn_on(1); ++ status = _FAIL; ++ goto exit; ++ } ++#endif ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ ++ if (i >= CONFIG_IFACE_NUMBER) { ++ RTW_ERR("%s %d >= CONFIG_IFACE_NUMBER(%d)\n", __func__, i, CONFIG_IFACE_NUMBER); ++ rtw_warn_on(1); ++ continue; ++ } ++ ++ adapter = dvobj->padapters[i]; ++ if (adapter && !adapter->pnetdev) { ++ ++ #ifdef CONFIG_RTW_DYNAMIC_NDEV ++ if (!is_primary_adapter(adapter)) ++ continue; ++ #endif ++ ++ status = rtw_os_ndev_alloc(adapter); ++ if (status != _SUCCESS) { ++ rtw_warn_on(1); ++ break; ++ } ++ } ++ } ++ ++ if (status != _SUCCESS) { ++ for (; i >= 0; i--) { ++ adapter = dvobj->padapters[i]; ++ if (adapter && adapter->pnetdev) ++ rtw_os_ndev_free(adapter); ++ } ++ } ++ ++#if defined(CONFIG_IOCTL_CFG80211) ++ if (status != _SUCCESS) ++ rtw_cfg80211_dev_res_free(dvobj); ++#endif ++exit: ++ return status; ++} ++ ++void rtw_os_ndevs_free(struct dvobj_priv *dvobj) ++{ ++ int i; ++ _adapter *adapter = NULL; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ ++ if (i >= CONFIG_IFACE_NUMBER) { ++ RTW_ERR("%s %d >= CONFIG_IFACE_NUMBER(%d)\n", __func__, i, CONFIG_IFACE_NUMBER); ++ rtw_warn_on(1); ++ continue; ++ } ++ ++ adapter = dvobj->padapters[i]; ++ ++ if (adapter == NULL) ++ continue; ++ ++ rtw_os_ndev_free(adapter); ++ } ++ ++#if defined(CONFIG_IOCTL_CFG80211) ++ rtw_cfg80211_dev_res_free(dvobj); ++#endif ++} ++ ++u32 rtw_start_drv_threads(_adapter *padapter) ++{ ++ u32 _status = _SUCCESS; ++ ++ ++#ifdef CONFIG_XMIT_THREAD_MODE ++#if defined(CONFIG_SDIO_HCI) ++ if (is_primary_adapter(padapter)) ++#endif ++ { ++ padapter->xmitThread = kthread_run(rtw_xmit_thread, padapter, "RTW_XMIT_THREAD"); ++ if (IS_ERR(padapter->xmitThread)) ++ _status = _FAIL; ++ } ++#endif /* #ifdef CONFIG_XMIT_THREAD_MODE */ ++ ++#ifdef CONFIG_RECV_THREAD_MODE ++ padapter->recvThread = kthread_run(rtw_recv_thread, padapter, "RTW_RECV_THREAD"); ++ if (IS_ERR(padapter->recvThread)) ++ _status = _FAIL; ++#endif ++ ++ if (is_primary_adapter(padapter)) { ++ padapter->cmdThread = kthread_run(rtw_cmd_thread, padapter, "RTW_CMD_THREAD"); ++ if (IS_ERR(padapter->cmdThread)) ++ _status = _FAIL; ++ else ++ _rtw_down_sema(&padapter->cmdpriv.start_cmdthread_sema); /* wait for cmd_thread to run */ ++ } ++ ++ ++#ifdef CONFIG_EVENT_THREAD_MODE ++ padapter->evtThread = kthread_run(event_thread, padapter, "RTW_EVENT_THREAD"); ++ if (IS_ERR(padapter->evtThread)) ++ _status = _FAIL; ++#endif ++ ++ rtw_hal_start_thread(padapter); ++ return _status; ++ ++} ++ ++void rtw_stop_drv_threads(_adapter *padapter) ++{ ++ ++ if (is_primary_adapter(padapter)) ++ rtw_stop_cmd_thread(padapter); ++ ++#ifdef CONFIG_EVENT_THREAD_MODE ++ _rtw_up_sema(&padapter->evtpriv.evt_notify); ++ if (padapter->evtThread) ++ _rtw_down_sema(&padapter->evtpriv.terminate_evtthread_sema); ++#endif ++ ++#ifdef CONFIG_XMIT_THREAD_MODE ++ /* Below is to termindate tx_thread... */ ++#if defined(CONFIG_SDIO_HCI) ++ /* Only wake-up primary adapter */ ++ if (is_primary_adapter(padapter)) ++#endif /*SDIO_HCI */ ++ { ++ if (padapter->xmitpriv.stop_req == 0) { ++ _rtw_up_sema(&padapter->xmitpriv.xmit_sema); ++ /*_rtw_down_sema(&padapter->xmitpriv.terminate_xmitthread_sema);*/ ++ rtw_wait_for_thread_stop(&padapter->xmitpriv.xmitthread_comp); ++ padapter->xmitpriv.stop_req = 1; ++ } ++ } ++#endif ++ ++#ifdef CONFIG_RECV_THREAD_MODE ++ if (is_primary_adapter(padapter)) { ++ /* Below is to termindate rx_thread... */ ++ _rtw_up_sema(&padapter->recvpriv.recv_sema); ++ /*_rtw_down_sema(&padapter->recvpriv.terminate_recvthread_sema);*/ ++ rtw_wait_for_thread_stop(&padapter->recvpriv.recvthread_comp); ++ } ++#endif ++ ++ rtw_hal_stop_thread(padapter); ++} ++ ++u8 rtw_init_default_value(_adapter *padapter); ++u8 rtw_init_default_value(_adapter *padapter) ++{ ++ u8 ret = _SUCCESS; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++ /* xmit_priv */ ++ pxmitpriv->vcs_setting = pregistrypriv->vrtl_carrier_sense; ++ pxmitpriv->vcs = pregistrypriv->vcs_type; ++ pxmitpriv->vcs_type = pregistrypriv->vcs_type; ++ /* pxmitpriv->rts_thresh = pregistrypriv->rts_thresh; */ ++ pxmitpriv->frag_len = pregistrypriv->frag_thresh; ++ ++ /* security_priv */ ++ /* rtw_get_encrypt_decrypt_from_registrypriv(padapter); */ ++ psecuritypriv->binstallGrpkey = _FAIL; ++#ifdef CONFIG_GTK_OL ++ psecuritypriv->binstallKCK_KEK = _FAIL; ++#endif /* CONFIG_GTK_OL */ ++ psecuritypriv->sw_encrypt = pregistrypriv->software_encrypt; ++ psecuritypriv->sw_decrypt = pregistrypriv->software_decrypt; ++ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ ++ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ ++ psecuritypriv->dot11PrivacyKeyIndex = 0; ++ ++ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; ++ psecuritypriv->dot118021XGrpKeyid = 1; ++ ++ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; ++ psecuritypriv->ndisencryptstatus = Ndis802_11WEPDisabled; ++#ifdef CONFIG_CONCURRENT_MODE ++ psecuritypriv->dot118021x_bmc_cam_id = INVALID_SEC_MAC_CAM_ID; ++#endif ++ ++ ++ /* pwrctrl_priv */ ++ ++ ++ /* registry_priv */ ++ rtw_init_registrypriv_dev_network(padapter); ++ rtw_update_registrypriv_dev_network(padapter); ++ ++ ++ /* hal_priv */ ++ rtw_hal_def_value_init(padapter); ++ ++ /* misc. */ ++ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); ++ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); ++ padapter->bLinkInfoDump = 0; ++ padapter->bNotifyChannelChange = _FALSE; ++#ifdef CONFIG_P2P ++ padapter->bShowGetP2PState = 1; ++#endif ++ ++ /* for debug purpose */ ++ padapter->fix_rate = 0xFF; ++ padapter->data_fb = 0; ++ padapter->fix_bw = 0xFF; ++ ++ padapter->driver_tx_bw_mode = pregistrypriv->tx_bw_mode; ++ ++ padapter->driver_ampdu_spacing = 0xFF; ++ padapter->driver_rx_ampdu_factor = 0xFF; ++ padapter->driver_rx_ampdu_spacing = 0xFF; ++ padapter->fix_rx_ampdu_accept = RX_AMPDU_ACCEPT_INVALID; ++ padapter->fix_rx_ampdu_size = RX_AMPDU_SIZE_INVALID; ++#ifdef DBG_RX_COUNTER_DUMP ++ padapter->dump_rx_cnt_mode = 0; ++ padapter->drv_rx_cnt_ok = 0; ++ padapter->drv_rx_cnt_crcerror = 0; ++ padapter->drv_rx_cnt_drop = 0; ++#endif ++#ifdef CONFIG_RTW_NAPI ++ padapter->napi_state = NAPI_DISABLE; ++#endif ++ return ret; ++} ++ ++#ifdef CONFIG_SWTIMER_BASED_TXBCN ++void _tx_beacon_timer_handlder(void *FunctionContext) ++{ ++ struct dvobj_priv *pdvobj = (struct dvobj_priv *)FunctionContext; ++ ++ tx_beacon_timer_handlder(pdvobj); ++} ++#endif ++ ++struct dvobj_priv *devobj_init(void) ++{ ++ struct dvobj_priv *pdvobj = NULL; ++ ++ pdvobj = (struct dvobj_priv *)rtw_zmalloc(sizeof(*pdvobj)); ++ if (pdvobj == NULL) ++ return NULL; ++ ++ _rtw_mutex_init(&pdvobj->hw_init_mutex); ++ _rtw_mutex_init(&pdvobj->h2c_fwcmd_mutex); ++ _rtw_mutex_init(&pdvobj->setch_mutex); ++ _rtw_mutex_init(&pdvobj->setbw_mutex); ++ _rtw_mutex_init(&pdvobj->rf_read_reg_mutex); ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++ _rtw_mutex_init(&pdvobj->sd_indirect_access_mutex); ++#endif ++ ++#ifdef CONFIG_RTW_CUSTOMER_STR ++ _rtw_mutex_init(&pdvobj->customer_str_mutex); ++ _rtw_memset(pdvobj->customer_str, 0xFF, RTW_CUSTOMER_STR_LEN); ++#endif ++ ++ pdvobj->processing_dev_remove = _FALSE; ++ ++ ATOMIC_SET(&pdvobj->disable_func, 0); ++ ++ rtw_macid_ctl_init(&pdvobj->macid_ctl); ++ _rtw_spinlock_init(&pdvobj->cam_ctl.lock); ++ _rtw_mutex_init(&pdvobj->cam_ctl.sec_cam_access_mutex); ++#if defined(RTK_129X_PLATFORM) && defined(CONFIG_PCI_HCI) ++ _rtw_spinlock_init(&pdvobj->io_reg_lock); ++#endif ++#ifdef CONFIG_MBSSID_CAM ++ rtw_mbid_cam_init(pdvobj); ++#endif ++ ++#ifdef CONFIG_AP_MODE ++ pdvobj->nr_ap_if = 0; ++ pdvobj->inter_bcn_space = DEFAULT_BCN_INTERVAL; /* default value is equal to the default beacon_interval (100ms) */ ++ _rtw_init_queue(&pdvobj->ap_if_q); ++#ifdef CONFIG_SWTIMER_BASED_TXBCN ++ _init_timer(&(pdvobj->txbcn_timer), NULL, _tx_beacon_timer_handlder, pdvobj); ++#endif ++#endif ++ ++ _init_timer(&(pdvobj->dynamic_chk_timer), NULL, _dynamic_check_timer_handlder, pdvobj); ++ ++#ifdef CONFIG_MCC_MODE ++ _rtw_mutex_init(&(pdvobj->mcc_objpriv.mcc_mutex)); ++ _rtw_spinlock_init(&pdvobj->mcc_objpriv.mcc_lock); ++#endif /* CONFIG_MCC_MODE */ ++ ++ return pdvobj; ++ ++} ++ ++void devobj_deinit(struct dvobj_priv *pdvobj) ++{ ++ if (!pdvobj) ++ return; ++ ++ /* TODO: use rtw_os_ndevs_deinit instead at the first stage of driver's dev deinit function */ ++#if defined(CONFIG_IOCTL_CFG80211) ++ rtw_cfg80211_dev_res_free(pdvobj); ++#endif ++ ++#ifdef CONFIG_MCC_MODE ++ _rtw_mutex_free(&(pdvobj->mcc_objpriv.mcc_mutex)); ++ _rtw_spinlock_free(&pdvobj->mcc_objpriv.mcc_lock); ++#endif /* CONFIG_MCC_MODE */ ++ ++ _rtw_mutex_free(&pdvobj->hw_init_mutex); ++ _rtw_mutex_free(&pdvobj->h2c_fwcmd_mutex); ++ ++#ifdef CONFIG_RTW_CUSTOMER_STR ++ _rtw_mutex_free(&pdvobj->customer_str_mutex); ++#endif ++ ++ _rtw_mutex_free(&pdvobj->setch_mutex); ++ _rtw_mutex_free(&pdvobj->setbw_mutex); ++ _rtw_mutex_free(&pdvobj->rf_read_reg_mutex); ++#ifdef CONFIG_SDIO_INDIRECT_ACCESS ++ _rtw_mutex_free(&pdvobj->sd_indirect_access_mutex); ++#endif ++ ++ rtw_macid_ctl_deinit(&pdvobj->macid_ctl); ++ _rtw_spinlock_free(&pdvobj->cam_ctl.lock); ++ _rtw_mutex_free(&pdvobj->cam_ctl.sec_cam_access_mutex); ++ ++#if defined(RTK_129X_PLATFORM) && defined(CONFIG_PCI_HCI) ++ _rtw_spinlock_free(&pdvobj->io_reg_lock); ++#endif ++#ifdef CONFIG_MBSSID_CAM ++ rtw_mbid_cam_deinit(pdvobj); ++#endif ++ ++#ifdef CONFIG_AP_MODE ++ _rtw_spinlock_free(&(pdvobj->ap_if_q.lock)); ++#endif /* CONFIG_AP_MODE */ ++ ++ rtw_mfree((u8 *)pdvobj, sizeof(*pdvobj)); ++} ++ ++inline u8 rtw_rtnl_lock_needed(struct dvobj_priv *dvobj) ++{ ++ if (dvobj->rtnl_lock_holder && dvobj->rtnl_lock_holder == current) ++ return 0; ++ return 1; ++} ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) ++static inline int rtnl_is_locked(void) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 17)) ++ if (unlikely(rtnl_trylock())) { ++ rtnl_unlock(); ++#else ++ if (unlikely(down_trylock(&rtnl_sem) == 0)) { ++ up(&rtnl_sem); ++#endif ++ return 0; ++ } ++ return 1; ++} ++#endif ++ ++inline void rtw_set_rtnl_lock_holder(struct dvobj_priv *dvobj, _thread_hdl_ thd_hdl) ++{ ++ rtw_warn_on(!rtnl_is_locked()); ++ ++ if (!thd_hdl || rtnl_is_locked()) ++ dvobj->rtnl_lock_holder = thd_hdl; ++ ++ if (dvobj->rtnl_lock_holder && 0) ++ RTW_INFO("rtnl_lock_holder: %s:%d\n", current->comm, current->pid); ++} ++ ++u8 rtw_reset_drv_sw(_adapter *padapter) ++{ ++ u8 ret8 = _SUCCESS; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++ ++ /* hal_priv */ ++ if (is_primary_adapter(padapter)) ++ rtw_hal_def_value_init(padapter); ++ ++ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); ++ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); ++ padapter->bLinkInfoDump = 0; ++ ++ padapter->xmitpriv.tx_pkts = 0; ++ padapter->recvpriv.rx_pkts = 0; ++ ++ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; ++ ++ /* pmlmepriv->LinkDetectInfo.TrafficBusyState = _FALSE; */ ++ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; ++ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; ++ ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING); ++ ++#ifdef CONFIG_AUTOSUSPEND ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 22) && LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 34)) ++ adapter_to_dvobj(padapter)->pusbdev->autosuspend_disabled = 1;/* autosuspend disabled by the user */ ++#endif ++#endif ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++ if (is_primary_adapter(padapter)) ++ rtw_hal_sreset_reset_value(padapter); ++#endif ++ pwrctrlpriv->pwr_state_check_cnts = 0; ++ ++ /* mlmeextpriv */ ++ mlmeext_set_scan_state(&padapter->mlmeextpriv, SCAN_DISABLE); ++ ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ rtw_set_signal_stat_timer(&padapter->recvpriv); ++#endif ++ ++ return ret8; ++} ++ ++ ++u8 rtw_init_drv_sw(_adapter *padapter) ++{ ++ ++ u8 ret8 = _SUCCESS; ++ ++ ++ ++ _rtw_init_listhead(&padapter->list); ++ ++ ret8 = rtw_init_default_value(padapter); ++ ++ if ((rtw_init_cmd_priv(&padapter->cmdpriv)) == _FAIL) { ++ ret8 = _FAIL; ++ goto exit; ++ } ++ ++ padapter->cmdpriv.padapter = padapter; ++ ++ if ((rtw_init_evt_priv(&padapter->evtpriv)) == _FAIL) { ++ ret8 = _FAIL; ++ goto exit; ++ } ++ ++ rtw_rfctl_init(padapter); ++ ++ if (rtw_init_mlme_priv(padapter) == _FAIL) { ++ ret8 = _FAIL; ++ goto exit; ++ } ++ ++#ifdef CONFIG_P2P ++ rtw_init_wifidirect_timers(padapter); ++ init_wifidirect_info(padapter, P2P_ROLE_DISABLE); ++ reset_global_wifidirect_info(padapter); ++ #ifdef CONFIG_IOCTL_CFG80211 ++ rtw_init_cfg80211_wifidirect_info(padapter); ++ #endif ++#ifdef CONFIG_WFD ++ if (rtw_init_wifi_display_info(padapter) == _FAIL) ++ RTW_ERR("Can't init init_wifi_display_info\n"); ++#endif ++#endif /* CONFIG_P2P */ ++ ++ if (init_mlme_ext_priv(padapter) == _FAIL) { ++ ret8 = _FAIL; ++ goto exit; ++ } ++ ++#ifdef CONFIG_TDLS ++ if (rtw_init_tdls_info(padapter) == _FAIL) { ++ RTW_INFO("Can't rtw_init_tdls_info\n"); ++ ret8 = _FAIL; ++ goto exit; ++ } ++#endif /* CONFIG_TDLS */ ++ ++ if (_rtw_init_xmit_priv(&padapter->xmitpriv, padapter) == _FAIL) { ++ RTW_INFO("Can't _rtw_init_xmit_priv\n"); ++ ret8 = _FAIL; ++ goto exit; ++ } ++ ++ if (_rtw_init_recv_priv(&padapter->recvpriv, padapter) == _FAIL) { ++ RTW_INFO("Can't _rtw_init_recv_priv\n"); ++ ret8 = _FAIL; ++ goto exit; ++ } ++ /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ _rtw_spinlock_init(&padapter->security_key_mutex); ++ ++ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). */ ++ /* _rtw_memset((unsigned char *)&padapter->securitypriv, 0, sizeof (struct security_priv)); */ ++ ++ /* _init_timer(&(padapter->securitypriv.tkip_timer), padapter->pifp, rtw_use_tkipkey_handler, padapter); */ ++ ++ if (_rtw_init_sta_priv(&padapter->stapriv) == _FAIL) { ++ RTW_INFO("Can't _rtw_init_sta_priv\n"); ++ ret8 = _FAIL; ++ goto exit; ++ } ++ ++ padapter->stapriv.padapter = padapter; ++ padapter->setband = WIFI_FREQUENCY_BAND_AUTO; ++ padapter->fix_rate = 0xFF; ++ padapter->data_fb = 0; ++ padapter->fix_rx_ampdu_accept = RX_AMPDU_ACCEPT_INVALID; ++ padapter->fix_rx_ampdu_size = RX_AMPDU_SIZE_INVALID; ++#ifdef DBG_RX_COUNTER_DUMP ++ padapter->dump_rx_cnt_mode = 0; ++ padapter->drv_rx_cnt_ok = 0; ++ padapter->drv_rx_cnt_crcerror = 0; ++ padapter->drv_rx_cnt_drop = 0; ++#endif ++ rtw_init_bcmc_stainfo(padapter); ++ ++ rtw_init_pwrctrl_priv(padapter); ++ ++ /* _rtw_memset((u8 *)&padapter->qospriv, 0, sizeof (struct qos_priv)); */ /* move to mlme_priv */ ++ ++#ifdef CONFIG_MP_INCLUDED ++ if (init_mp_priv(padapter) == _FAIL) ++ RTW_INFO("%s: initialize MP private data Fail!\n", __func__); ++#endif ++ ++ rtw_hal_dm_init(padapter); ++#ifdef CONFIG_SW_LED ++ rtw_hal_sw_led_init(padapter); ++#endif ++#ifdef DBG_CONFIG_ERROR_DETECT ++ rtw_hal_sreset_init(padapter); ++#endif ++ ++#ifdef CONFIG_INTEL_WIDI ++ if (rtw_init_intel_widi(padapter) == _FAIL) { ++ RTW_INFO("Can't rtw_init_intel_widi\n"); ++ ret8 = _FAIL; ++ goto exit; ++ } ++#endif /* CONFIG_INTEL_WIDI */ ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ padapter->WapiSupport = true; /* set true temp, will revise according to Efuse or Registry value later. */ ++ rtw_wapi_init(padapter); ++#endif ++ ++#ifdef CONFIG_BR_EXT ++ _rtw_spinlock_init(&padapter->br_ext_lock); ++#endif /* CONFIG_BR_EXT */ ++ ++exit: ++ ++ ++ ++ return ret8; ++ ++} ++ ++#ifdef CONFIG_WOWLAN ++void rtw_cancel_dynamic_chk_timer(_adapter *padapter) ++{ ++ _cancel_timer_ex(&adapter_to_dvobj(padapter)->dynamic_chk_timer); ++} ++#endif ++ ++void rtw_cancel_all_timer(_adapter *padapter) ++{ ++ ++ _cancel_timer_ex(&padapter->mlmepriv.assoc_timer); ++ ++#if 0 ++ _cancel_timer_ex(&padapter->securitypriv.tkip_timer); ++#endif ++ ++ _cancel_timer_ex(&padapter->mlmepriv.scan_to_timer); ++ ++#ifdef CONFIG_DFS_MASTER ++ _cancel_timer_ex(&padapter->mlmepriv.dfs_master_timer); ++#endif ++ ++ _cancel_timer_ex(&adapter_to_dvobj(padapter)->dynamic_chk_timer); ++ ++ /* cancel sw led timer */ ++ rtw_hal_sw_led_deinit(padapter); ++ ++ _cancel_timer_ex(&(adapter_to_pwrctl(padapter)->pwr_state_check_timer)); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++#ifdef CONFIG_P2P ++ _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); ++#endif /* CONFIG_P2P */ ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++#ifdef CONFIG_SET_SCAN_DENY_TIMER ++ _cancel_timer_ex(&padapter->mlmepriv.set_scan_deny_timer); ++ rtw_clear_scan_deny(padapter); ++#endif ++ ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ _cancel_timer_ex(&padapter->recvpriv.signal_stat_timer); ++#endif ++ /* cancel dm timer */ ++ rtw_hal_dm_deinit(padapter); ++ ++#ifdef CONFIG_PLATFORM_FS_MX61 ++ msleep(50); ++#endif ++} ++ ++u8 rtw_free_drv_sw(_adapter *padapter) ++{ ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ rtw_wapi_free(padapter); ++#endif ++ ++ /* we can call rtw_p2p_enable here, but: */ ++ /* 1. rtw_p2p_enable may have IO operation */ ++ /* 2. rtw_p2p_enable is bundled with wext interface */ ++ #ifdef CONFIG_P2P ++ { ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { ++ _cancel_timer_ex(&pwdinfo->find_phase_timer); ++ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); ++ _cancel_timer_ex(&pwdinfo->pre_tx_scan_timer); ++ #ifdef CONFIG_CONCURRENT_MODE ++ _cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer); ++ #endif /* CONFIG_CONCURRENT_MODE */ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE); ++ } ++ } ++ #endif ++ /* add for CONFIG_IEEE80211W, none 11w also can use */ ++ _rtw_spinlock_free(&padapter->security_key_mutex); ++ ++#ifdef CONFIG_BR_EXT ++ _rtw_spinlock_free(&padapter->br_ext_lock); ++#endif /* CONFIG_BR_EXT */ ++ ++#ifdef CONFIG_INTEL_WIDI ++ rtw_free_intel_widi(padapter); ++#endif /* CONFIG_INTEL_WIDI */ ++ ++ free_mlme_ext_priv(&padapter->mlmeextpriv); ++ ++#ifdef CONFIG_TDLS ++ /* rtw_free_tdls_info(&padapter->tdlsinfo); */ ++#endif /* CONFIG_TDLS */ ++ ++ rtw_free_cmd_priv(&padapter->cmdpriv); ++ ++ rtw_free_evt_priv(&padapter->evtpriv); ++ ++ rtw_free_mlme_priv(&padapter->mlmepriv); ++ ++ /* free_io_queue(padapter); */ ++ ++ _rtw_free_xmit_priv(&padapter->xmitpriv); ++ ++ _rtw_free_sta_priv(&padapter->stapriv); /* will free bcmc_stainfo here */ ++ ++ _rtw_free_recv_priv(&padapter->recvpriv); ++ ++ rtw_free_pwrctrl_priv(padapter); ++ ++ /* rtw_mfree((void *)padapter, sizeof (padapter)); */ ++ ++#ifdef CONFIG_DRVEXT_MODULE ++ free_drvext(&padapter->drvextpriv); ++#endif ++ ++ rtw_hal_free_data(padapter); ++ ++ ++ /* free the old_pnetdev */ ++ if (padapter->rereg_nd_name_priv.old_pnetdev) { ++ free_netdev(padapter->rereg_nd_name_priv.old_pnetdev); ++ padapter->rereg_nd_name_priv.old_pnetdev = NULL; ++ } ++ ++ return _SUCCESS; ++ ++} ++void rtw_intf_start(_adapter *adapter) ++{ ++ if (adapter->intf_start) ++ adapter->intf_start(adapter); ++} ++void rtw_intf_stop(_adapter *adapter) ++{ ++ if (adapter->intf_stop) ++ adapter->intf_stop(adapter); ++} ++ ++#ifdef CONFIG_CONCURRENT_MODE ++int _netdev_vir_if_open(struct net_device *pnetdev) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); ++ _adapter *primary_padapter = GET_PRIMARY_ADAPTER(padapter); ++ ++ RTW_INFO(FUNC_NDEV_FMT" , bup=%d\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); ++ ++ if (!primary_padapter) ++ goto _netdev_virtual_iface_open_error; ++ ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++ if (padapter->bup == _FALSE) { ++ u8 mac[ETH_ALEN]; ++ ++ /* get mac address from primary_padapter */ ++ if (primary_padapter->bup == _FALSE) ++ rtw_macaddr_cfg(adapter_mac_addr(primary_padapter), get_hal_mac_addr(primary_padapter)); ++ ++ _rtw_memcpy(mac, adapter_mac_addr(primary_padapter), ETH_ALEN); ++ ++ /* ++ * If the BIT1 is 0, the address is universally administered. ++ * If it is 1, the address is locally administered ++ */ ++ mac[0] |= BIT(1); ++ ++ _rtw_memcpy(adapter_mac_addr(padapter), mac, ETH_ALEN); ++ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ rtw_mbid_camid_alloc(padapter, adapter_mac_addr(padapter)); ++#endif ++ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); ++ _rtw_memcpy(pnetdev->dev_addr, adapter_mac_addr(padapter), ETH_ALEN); ++ } ++#endif /*CONFIG_PLATFORM_INTEL_BYT*/ ++ ++ if (primary_padapter->bup == _FALSE || !rtw_is_hw_init_completed(primary_padapter)) ++ _netdev_open(primary_padapter->pnetdev); ++ ++ if (padapter->bup == _FALSE && primary_padapter->bup == _TRUE && ++ rtw_is_hw_init_completed(primary_padapter)) { ++ padapter->bFWReady = primary_padapter->bFWReady; ++#if 0 /*#ifdef CONFIG_MI_WITH_MBSSID_CAM*/ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, adapter_mac_addr(padapter)); /* set mac addr to mac register */ ++#endif ++ ++ } ++ ++ if (padapter->bup == _FALSE) { ++ if (rtw_start_drv_threads(padapter) == _FAIL) ++ goto _netdev_virtual_iface_open_error; ++ } ++ ++#ifdef CONFIG_RTW_NAPI ++ if (padapter->napi_state == NAPI_DISABLE) { ++ napi_enable(&padapter->napi); ++ padapter->napi_state = NAPI_ENABLE; ++ } ++#endif ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_cfg80211_init_wiphy(padapter); ++ rtw_cfg80211_init_wdev_data(padapter); ++#endif ++ ++ padapter->bup = _TRUE; ++ ++ padapter->net_closed = _FALSE; ++ ++ rtw_netif_wake_queue(pnetdev); ++ ++ RTW_INFO(FUNC_NDEV_FMT" (bup=%d) exit\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); ++ ++ return 0; ++ ++_netdev_virtual_iface_open_error: ++ ++ padapter->bup = _FALSE; ++ ++#ifdef CONFIG_RTW_NAPI ++ if(padapter->napi_state == NAPI_ENABLE) { ++ napi_disable(&padapter->napi); ++ padapter->napi_state = NAPI_DISABLE; ++ } ++#endif ++ ++ netif_carrier_off(pnetdev); ++ rtw_netif_stop_queue(pnetdev); ++ ++ return -1; ++ ++} ++ ++int netdev_vir_if_open(struct net_device *pnetdev) ++{ ++ int ret; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); ++ ++ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); ++ ret = _netdev_vir_if_open(pnetdev); ++ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); ++ ++#ifdef CONFIG_AUTO_AP_MODE ++ /* if(padapter->iface_id == 2) */ ++ /* rtw_start_auto_ap(padapter); */ ++#endif ++ ++ return ret; ++} ++ ++static int netdev_vir_if_close(struct net_device *pnetdev) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ RTW_INFO(FUNC_NDEV_FMT" , bup=%d\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); ++ padapter->net_closed = _TRUE; ++ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; ++ ++ if (pnetdev) ++ rtw_netif_stop_queue(pnetdev); ++ ++#ifdef CONFIG_P2P ++ if (!rtw_p2p_chk_role(&padapter->wdinfo, P2P_ROLE_DISABLE)) ++ rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); ++#endif ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_scan_abort(padapter); ++ rtw_cfg80211_wait_scan_req_empty(padapter, 200); ++ adapter_wdev_data(padapter)->bandroid_scan = _FALSE; ++#endif ++ ++ return 0; ++} ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) ++static const struct net_device_ops rtw_netdev_vir_if_ops = { ++ .ndo_init = rtw_ndev_init, ++ .ndo_uninit = rtw_ndev_uninit, ++ .ndo_open = netdev_vir_if_open, ++ .ndo_stop = netdev_vir_if_close, ++ .ndo_start_xmit = rtw_xmit_entry, ++ .ndo_set_mac_address = rtw_net_set_mac_address, ++ .ndo_get_stats = rtw_net_get_stats, ++ .ndo_do_ioctl = rtw_ioctl, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ .ndo_select_queue = rtw_select_queue, ++#endif ++}; ++#endif ++ ++static void rtw_hook_vir_if_ops(struct net_device *ndev) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) ++ ndev->netdev_ops = &rtw_netdev_vir_if_ops; ++#else ++ ndev->init = rtw_ndev_init; ++ ndev->uninit = rtw_ndev_uninit; ++ ndev->open = netdev_vir_if_open; ++ ndev->stop = netdev_vir_if_close; ++ ndev->set_mac_address = rtw_net_set_mac_address; ++#endif ++} ++_adapter *rtw_drv_add_vir_if(_adapter *primary_padapter, ++ void (*set_intf_ops)(_adapter *primary_padapter, struct _io_ops *pops)) ++{ ++ int res = _FAIL; ++ _adapter *padapter = NULL; ++ struct dvobj_priv *pdvobjpriv; ++ u8 mac[ETH_ALEN]; ++ ++ /****** init adapter ******/ ++ padapter = (_adapter *)rtw_zvmalloc(sizeof(*padapter)); ++ if (padapter == NULL) ++ goto exit; ++ ++ if (loadparam(padapter) != _SUCCESS) ++ goto free_adapter; ++ ++ _rtw_memcpy(padapter, primary_padapter, sizeof(_adapter)); ++ ++ /* */ ++ padapter->bup = _FALSE; ++ padapter->net_closed = _TRUE; ++ padapter->dir_dev = NULL; ++ padapter->dir_odm = NULL; ++ ++ /*set adapter_type/iface type*/ ++ padapter->isprimary = _FALSE; ++ padapter->adapter_type = VIRTUAL_ADAPTER; ++ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ padapter->hw_port = HW_PORT0; ++#else ++ padapter->hw_port = HW_PORT1; ++#endif ++ ++ ++ /****** hook vir if into dvobj ******/ ++ pdvobjpriv = adapter_to_dvobj(padapter); ++ padapter->iface_id = pdvobjpriv->iface_nums; ++ pdvobjpriv->padapters[pdvobjpriv->iface_nums++] = padapter; ++ ++ padapter->intf_start = primary_padapter->intf_start; ++ padapter->intf_stop = primary_padapter->intf_stop; ++ ++ /* step init_io_priv */ ++ if ((rtw_init_io_priv(padapter, set_intf_ops)) == _FAIL) { ++ goto free_adapter; ++ } ++ ++ /*init drv data*/ ++ if (rtw_init_drv_sw(padapter) != _SUCCESS) ++ goto free_drv_sw; ++ ++ ++ /*get mac address from primary_padapter*/ ++ _rtw_memcpy(mac, adapter_mac_addr(primary_padapter), ETH_ALEN); ++ ++ /* ++ * If the BIT1 is 0, the address is universally administered. ++ * If it is 1, the address is locally administered ++ */ ++ mac[0] |= BIT(1); ++ if (padapter->iface_id > IFACE_ID1) ++ mac[4] ^= BIT(padapter->iface_id); ++ ++ _rtw_memcpy(adapter_mac_addr(padapter), mac, ETH_ALEN); ++ /* update mac-address to mbsid-cam cache*/ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ rtw_mbid_camid_alloc(padapter, adapter_mac_addr(padapter)); ++#endif ++ RTW_INFO("%s if%d mac_addr : "MAC_FMT"\n", __func__, padapter->iface_id + 1, MAC_ARG(adapter_mac_addr(padapter))); ++#ifdef CONFIG_P2P ++ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); ++#endif ++ res = _SUCCESS; ++ ++free_drv_sw: ++ if (res != _SUCCESS && padapter) ++ rtw_free_drv_sw(padapter); ++free_adapter: ++ if (res != _SUCCESS && padapter) { ++ rtw_vmfree((u8 *)padapter, sizeof(*padapter)); ++ padapter = NULL; ++ } ++exit: ++ return padapter; ++} ++ ++void rtw_drv_stop_vir_if(_adapter *padapter) ++{ ++ struct net_device *pnetdev = NULL; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ if (padapter == NULL) ++ return; ++ ++ pnetdev = padapter->pnetdev; ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED)) ++ rtw_disassoc_cmd(padapter, 0, _FALSE); ++ ++#ifdef CONFIG_AP_MODE ++ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { ++ free_mlme_ap_info(padapter); ++ #ifdef CONFIG_HOSTAPD_MLME ++ hostapd_mode_unload(padapter); ++ #endif ++ } ++#endif ++ ++ if (padapter->bup == _TRUE) { ++ #ifdef CONFIG_XMIT_ACK ++ if (padapter->xmitpriv.ack_tx) ++ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP); ++ #endif ++ ++ rtw_intf_stop(padapter); ++ ++ rtw_stop_drv_threads(padapter); ++ ++ padapter->bup = _FALSE; ++ } ++ /* cancel timer after thread stop */ ++ rtw_cancel_all_timer(padapter); ++} ++ ++void rtw_drv_free_vir_if(_adapter *padapter) ++{ ++ if (padapter == NULL) ++ return; ++ ++ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ rtw_free_drv_sw(padapter); ++ ++ /* TODO: use rtw_os_ndevs_deinit instead at the first stage of driver's dev deinit function */ ++ rtw_os_ndev_free(padapter); ++ ++ rtw_vmfree((u8 *)padapter, sizeof(_adapter)); ++} ++ ++ ++void rtw_drv_stop_vir_ifaces(struct dvobj_priv *dvobj) ++{ ++ int i; ++ ++ for (i = VIF_START_ID; i < dvobj->iface_nums; i++) ++ rtw_drv_stop_vir_if(dvobj->padapters[i]); ++} ++ ++void rtw_drv_free_vir_ifaces(struct dvobj_priv *dvobj) ++{ ++ int i; ++ ++ for (i = VIF_START_ID; i < dvobj->iface_nums; i++) ++ rtw_drv_free_vir_if(dvobj->padapters[i]); ++} ++ ++void rtw_drv_del_vir_if(_adapter *padapter) ++{ ++ rtw_drv_stop_vir_if(padapter); ++ rtw_drv_free_vir_if(padapter); ++} ++ ++void rtw_drv_del_vir_ifaces(_adapter *primary_padapter) ++{ ++ int i; ++ struct dvobj_priv *dvobj = primary_padapter->dvobj; ++ ++ for (i = VIF_START_ID; i < dvobj->iface_nums; i++) ++ rtw_drv_del_vir_if(dvobj->padapters[i]); ++ ++} ++ ++#endif /*end of CONFIG_CONCURRENT_MODE*/ ++ ++int rtw_os_ndevs_register(struct dvobj_priv *dvobj) ++{ ++ int i, status = _SUCCESS; ++ struct registry_priv *regsty = dvobj_to_regsty(dvobj); ++ _adapter *adapter; ++ ++#if defined(CONFIG_IOCTL_CFG80211) ++ if (rtw_cfg80211_dev_res_register(dvobj) != _SUCCESS) { ++ rtw_warn_on(1); ++ status = _FAIL; ++ goto exit; ++ } ++#endif ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ ++ if (i >= CONFIG_IFACE_NUMBER) { ++ RTW_ERR("%s %d >= CONFIG_IFACE_NUMBER(%d)\n", __func__, i, CONFIG_IFACE_NUMBER); ++ rtw_warn_on(1); ++ continue; ++ } ++ ++ adapter = dvobj->padapters[i]; ++ if (adapter) { ++ char *name; ++ ++ #ifdef CONFIG_RTW_DYNAMIC_NDEV ++ if (!is_primary_adapter(adapter)) ++ continue; ++ #endif ++ ++ if (adapter->iface_id == IFACE_ID0) ++ name = regsty->ifname; ++ else if (adapter->iface_id == IFACE_ID1) ++ name = regsty->if2name; ++ else ++ name = "wlan%d"; ++ ++ status = rtw_os_ndev_register(adapter, name); ++ ++ if (status != _SUCCESS) { ++ rtw_warn_on(1); ++ break; ++ } ++ } ++ } ++ ++ if (status != _SUCCESS) { ++ for (; i >= 0; i--) { ++ adapter = dvobj->padapters[i]; ++ if (adapter) ++ rtw_os_ndev_unregister(adapter); ++ } ++ } ++ ++#if defined(CONFIG_IOCTL_CFG80211) ++ if (status != _SUCCESS) ++ rtw_cfg80211_dev_res_unregister(dvobj); ++#endif ++exit: ++ return status; ++} ++ ++void rtw_os_ndevs_unregister(struct dvobj_priv *dvobj) ++{ ++ int i; ++ _adapter *adapter = NULL; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ adapter = dvobj->padapters[i]; ++ ++ if (adapter == NULL) ++ continue; ++ ++ rtw_os_ndev_unregister(adapter); ++ } ++ ++#if defined(CONFIG_IOCTL_CFG80211) ++ rtw_cfg80211_dev_res_unregister(dvobj); ++#endif ++} ++ ++/** ++ * rtw_os_ndevs_init - Allocate and register OS layer net devices and relating structures for @dvobj ++ * @dvobj: the dvobj on which this function applies ++ * ++ * Returns: ++ * _SUCCESS or _FAIL ++ */ ++int rtw_os_ndevs_init(struct dvobj_priv *dvobj) ++{ ++ int ret = _FAIL; ++ ++ if (rtw_os_ndevs_alloc(dvobj) != _SUCCESS) ++ goto exit; ++ ++ if (rtw_os_ndevs_register(dvobj) != _SUCCESS) ++ goto os_ndevs_free; ++ ++ ret = _SUCCESS; ++ ++os_ndevs_free: ++ if (ret != _SUCCESS) ++ rtw_os_ndevs_free(dvobj); ++exit: ++ return ret; ++} ++ ++/** ++ * rtw_os_ndevs_deinit - Unregister and free OS layer net devices and relating structures for @dvobj ++ * @dvobj: the dvobj on which this function applies ++ */ ++void rtw_os_ndevs_deinit(struct dvobj_priv *dvobj) ++{ ++ rtw_os_ndevs_unregister(dvobj); ++ rtw_os_ndevs_free(dvobj); ++} ++ ++#ifdef CONFIG_BR_EXT ++void netdev_br_init(struct net_device *netdev) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); ++ ++#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) ++ rcu_read_lock(); ++#endif /* (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) */ ++ ++ /* if(check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == _TRUE) */ ++ { ++ /* struct net_bridge *br = netdev->br_port->br; */ /* ->dev->dev_addr; */ ++#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) ++ if (netdev->br_port) ++#else /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ ++ if (rcu_dereference(adapter->pnetdev->rx_handler_data)) ++#endif /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ ++ { ++ struct net_device *br_netdev; ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) ++ br_netdev = dev_get_by_name(CONFIG_BR_EXT_BRNAME); ++#else /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) */ ++ struct net *devnet = NULL; ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) ++ devnet = netdev->nd_net; ++#else /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) */ ++ devnet = dev_net(netdev); ++#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) */ ++ ++ br_netdev = dev_get_by_name(devnet, CONFIG_BR_EXT_BRNAME); ++#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) */ ++ ++ if (br_netdev) { ++ memcpy(adapter->br_mac, br_netdev->dev_addr, ETH_ALEN); ++ dev_put(br_netdev); ++ } else ++ printk("%s()-%d: dev_get_by_name(%s) failed!", __FUNCTION__, __LINE__, CONFIG_BR_EXT_BRNAME); ++ } ++ ++ adapter->ethBrExtInfo.addPPPoETag = 1; ++ } ++ ++#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) ++ rcu_read_unlock(); ++#endif /* (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) */ ++} ++#endif /* CONFIG_BR_EXT */ ++ ++int _netdev_open(struct net_device *pnetdev) ++{ ++ uint status; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++ ++ ++ RTW_INFO(FUNC_NDEV_FMT" , bup=%d\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); ++ ++ padapter->netif_up = _TRUE; ++ ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++ rtw_sdio_set_power(1); ++#endif /* CONFIG_PLATFORM_INTEL_BYT */ ++ ++ if (pwrctrlpriv->ps_flag == _TRUE) { ++ padapter->net_closed = _FALSE; ++ goto netdev_open_normal_process; ++ } ++ ++ if (padapter->bup == _FALSE) { ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++ rtw_macaddr_cfg(adapter_mac_addr(padapter), get_hal_mac_addr(padapter)); ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ rtw_mbid_camid_alloc(padapter, adapter_mac_addr(padapter)); ++#endif ++ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); ++ _rtw_memcpy(pnetdev->dev_addr, adapter_mac_addr(padapter), ETH_ALEN); ++#endif /* CONFIG_PLATFORM_INTEL_BYT */ ++ ++ rtw_clr_surprise_removed(padapter); ++ rtw_clr_drv_stopped(padapter); ++ ++ status = rtw_hal_init(padapter); ++ if (status == _FAIL) { ++ goto netdev_open_error; ++ } ++#if 0/*#ifdef CONFIG_MI_WITH_MBSSID_CAM*/ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, adapter_mac_addr(padapter)); /* set mac addr to mac register */ ++#endif ++ ++ RTW_INFO("MAC Address = "MAC_FMT"\n", MAC_ARG(pnetdev->dev_addr)); ++ ++ status = rtw_start_drv_threads(padapter); ++ if (status == _FAIL) { ++ RTW_INFO("Initialize driver software resource Failed!\n"); ++ goto netdev_open_error; ++ } ++ ++#ifdef CONFIG_RTW_NAPI ++ if(padapter->napi_state == NAPI_DISABLE) { ++ napi_enable(&padapter->napi); ++ padapter->napi_state = NAPI_ENABLE; ++ } ++#endif ++ ++#ifdef CONFIG_DRVEXT_MODULE ++ init_drvext(padapter); ++#endif ++ rtw_intf_start(padapter); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_cfg80211_init_wiphy(padapter); ++ rtw_cfg80211_init_wdev_data(padapter); ++#endif ++ ++ rtw_led_control(padapter, LED_CTL_NO_LINK); ++ ++ padapter->bup = _TRUE; ++ pwrctrlpriv->bips_processing = _FALSE; ++ ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_IpsNotify(padapter, IPS_NONE); ++#endif /* CONFIG_BT_COEXIST */ ++#endif /* CONFIG_PLATFORM_INTEL_BYT */ ++ } ++ padapter->net_closed = _FALSE; ++ ++ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); ++ ++#ifndef CONFIG_IPS_CHECK_IN_WD ++ rtw_set_pwr_state_check_timer(pwrctrlpriv); ++#endif ++ ++ /* netif_carrier_on(pnetdev); */ /* call this func when rtw_joinbss_event_callback return success */ ++ rtw_netif_wake_queue(pnetdev); ++ ++#ifdef CONFIG_BR_EXT ++ netdev_br_init(pnetdev); ++#endif /* CONFIG_BR_EXT */ ++ ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ if (is_primary_adapter(padapter) && (_TRUE == pHalData->EEPROMBluetoothCoexist)) { ++ rtw_btcoex_init_socket(padapter); ++ padapter->coex_info.BtMgnt.ExtConfig.HCIExtensionVer = 0x04; ++ rtw_btcoex_SetHciVersion(padapter, 0x04); ++ } else ++ RTW_INFO("CONFIG_BT_COEXIST: VIRTUAL_ADAPTER\n"); ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++ ++ ++netdev_open_normal_process: ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ { ++ _adapter *sec_adapter = adapter_to_dvobj(padapter)->padapters[IFACE_ID1]; ++ ++ #ifndef CONFIG_RTW_DYNAMIC_NDEV ++ if (sec_adapter && (sec_adapter->bup == _FALSE)) ++ _netdev_vir_if_open(sec_adapter->pnetdev); ++ #endif ++ } ++#endif ++ ++ RTW_INFO("-871x_drv - drv_open, bup=%d\n", padapter->bup); ++ ++ return 0; ++ ++netdev_open_error: ++ ++ padapter->bup = _FALSE; ++ ++#ifdef CONFIG_RTW_NAPI ++ if(padapter->napi_state == NAPI_ENABLE) { ++ napi_disable(&padapter->napi); ++ padapter->napi_state = NAPI_DISABLE; ++ } ++#endif ++ ++ netif_carrier_off(pnetdev); ++ rtw_netif_stop_queue(pnetdev); ++ ++ RTW_INFO("-871x_drv - drv_open fail, bup=%d\n", padapter->bup); ++ ++ return -1; ++ ++} ++ ++int netdev_open(struct net_device *pnetdev) ++{ ++ int ret = _FALSE; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); ++ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++ ++ if (pwrctrlpriv->bInSuspend == _TRUE) { ++ RTW_INFO(" [WARN] "ADPT_FMT" %s failed, bInSuspend=%d\n", ADPT_ARG(padapter), __func__, pwrctrlpriv->bInSuspend); ++ return 0; ++ } ++ ++ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); ++ if (is_primary_adapter(padapter)) ++ ret = _netdev_open(pnetdev); ++#ifdef CONFIG_CONCURRENT_MODE ++ else ++ ret = _netdev_vir_if_open(pnetdev); ++#endif ++ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); ++ ++ ++#ifdef CONFIG_AUTO_AP_MODE ++ if (padapter->iface_id == IFACE_ID2) ++ rtw_start_auto_ap(padapter); ++#endif ++ ++ return ret; ++} ++ ++#ifdef CONFIG_IPS ++int ips_netdrv_open(_adapter *padapter) ++{ ++ int status = _SUCCESS; ++ /* struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); */ ++ ++ padapter->net_closed = _FALSE; ++ ++ RTW_INFO("===> %s.........\n", __FUNCTION__); ++ ++ ++ rtw_clr_drv_stopped(padapter); ++ /* padapter->bup = _TRUE; */ ++ ++ status = rtw_hal_init(padapter); ++ if (status == _FAIL) { ++ goto netdev_open_error; ++ } ++#if 0 ++ rtw_restore_mac_addr(padapter); ++#endif ++ rtw_intf_start(padapter); ++ ++#ifndef CONFIG_IPS_CHECK_IN_WD ++ rtw_set_pwr_state_check_timer(adapter_to_pwrctl(padapter)); ++#endif ++ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); ++ ++ return _SUCCESS; ++ ++netdev_open_error: ++ /* padapter->bup = _FALSE; */ ++ RTW_INFO("-ips_netdrv_open - drv_open failure, bup=%d\n", padapter->bup); ++ ++ return _FAIL; ++} ++ ++ ++int rtw_ips_pwr_up(_adapter *padapter) ++{ ++ int result; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++#ifdef DBG_CONFIG_ERROR_DETECT ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++#endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ ++ u32 start_time = rtw_get_current_time(); ++ RTW_INFO("===> rtw_ips_pwr_up..............\n"); ++ ++#if defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) ++#ifdef DBG_CONFIG_ERROR_DETECT ++ if (psrtpriv->silent_reset_inprogress == _TRUE) ++#endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ ++#endif /* defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) */ ++ rtw_reset_drv_sw(padapter); ++ ++ result = ips_netdrv_open(padapter); ++ ++ rtw_led_control(padapter, LED_CTL_NO_LINK); ++ ++ RTW_INFO("<=== rtw_ips_pwr_up.............. in %dms\n", rtw_get_passing_time_ms(start_time)); ++ return result; ++ ++} ++ ++void rtw_ips_pwr_down(_adapter *padapter) ++{ ++ u32 start_time = rtw_get_current_time(); ++ RTW_INFO("===> rtw_ips_pwr_down...................\n"); ++ ++ padapter->net_closed = _TRUE; ++ ++ rtw_ips_dev_unload(padapter); ++ RTW_INFO("<=== rtw_ips_pwr_down..................... in %dms\n", rtw_get_passing_time_ms(start_time)); ++} ++#endif ++void rtw_ips_dev_unload(_adapter *padapter) ++{ ++ struct net_device *pnetdev = (struct net_device *)padapter->pnetdev; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++#ifdef DBG_CONFIG_ERROR_DETECT ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++#endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ ++ RTW_INFO("====> %s...\n", __FUNCTION__); ++ ++ ++#if defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) ++#ifdef DBG_CONFIG_ERROR_DETECT ++ if (psrtpriv->silent_reset_inprogress == _TRUE) ++#endif /* #ifdef DBG_CONFIG_ERROR_DETECT */ ++#endif /* defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) */ ++ { ++ rtw_hal_set_hwreg(padapter, HW_VAR_FIFO_CLEARN_UP, 0); ++ rtw_intf_stop(padapter); ++ } ++ ++ if (!rtw_is_surprise_removed(padapter)) ++ rtw_hal_deinit(padapter); ++ ++} ++ ++ ++int pm_netdev_open(struct net_device *pnetdev, u8 bnormal) ++{ ++ int status = 0; ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); ++ ++ if (_TRUE == bnormal) { ++ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); ++ status = _netdev_open(pnetdev); ++#if 0 ++ rtw_restore_mac_addr(padapter); ++#endif ++ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); ++ } ++#ifdef CONFIG_IPS ++ else ++ status = (_SUCCESS == ips_netdrv_open(padapter)) ? (0) : (-1); ++#endif ++ ++ return status; ++} ++ ++static int netdev_close(struct net_device *pnetdev) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++ ++ RTW_INFO(FUNC_NDEV_FMT" , bup=%d\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); ++#ifndef CONFIG_PLATFORM_INTEL_BYT ++ if (pwrctl->bInternalAutoSuspend == _TRUE) { ++ /* rtw_pwr_wakeup(padapter); */ ++ if (pwrctl->rf_pwrstate == rf_off) ++ pwrctl->ps_flag = _TRUE; ++ } ++ padapter->net_closed = _TRUE; ++ padapter->netif_up = _FALSE; ++ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; ++ ++ /* if (!rtw_is_hw_init_completed(padapter)) { ++ RTW_INFO("(1)871x_drv - drv_close, bup=%d, hw_init_completed=%s\n", padapter->bup, rtw_is_hw_init_completed(padapter)?"_TRUE":"_FALSE"); ++ ++ rtw_set_drv_stopped(padapter); ++ ++ rtw_dev_unload(padapter); ++ } ++ else*/ ++ if (pwrctl->rf_pwrstate == rf_on) { ++ RTW_INFO("(2)871x_drv - drv_close, bup=%d, hw_init_completed=%s\n", padapter->bup, rtw_is_hw_init_completed(padapter) ? "_TRUE" : "_FALSE"); ++ ++ /* s1. */ ++ if (pnetdev) ++ rtw_netif_stop_queue(pnetdev); ++ ++#ifndef CONFIG_ANDROID ++ /* s2. */ ++ LeaveAllPowerSaveMode(padapter); ++ rtw_disassoc_cmd(padapter, 500, _FALSE); ++ /* s2-2. indicate disconnect to os */ ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ /* s2-3. */ ++ rtw_free_assoc_resources(padapter, 1); ++ /* s2-4. */ ++ rtw_free_network_queue(padapter, _TRUE); ++#endif ++ /* Close LED */ ++ rtw_led_control(padapter, LED_CTL_POWER_OFF); ++ } ++ ++#ifdef CONFIG_BR_EXT ++ /* if (OPMODE & (WIFI_STATION_STATE | WIFI_ADHOC_STATE)) */ ++ { ++ /* void nat25_db_cleanup(_adapter *priv); */ ++ nat25_db_cleanup(padapter); ++ } ++#endif /* CONFIG_BR_EXT */ ++ ++#ifdef CONFIG_P2P ++ if (!rtw_p2p_chk_role(&padapter->wdinfo, P2P_ROLE_DISABLE)) ++ rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); ++#endif /* CONFIG_P2P */ ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_scan_abort(padapter); ++ rtw_cfg80211_wait_scan_req_empty(padapter, 200); ++ adapter_wdev_data(padapter)->bandroid_scan = _FALSE; ++ /* padapter->rtw_wdev->iftype = NL80211_IFTYPE_MONITOR; */ /* set this at the end */ ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ rtw_wapi_disable_tx(padapter); ++#endif ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ if (is_primary_adapter(padapter) && (_TRUE == pHalData->EEPROMBluetoothCoexist)) ++ rtw_btcoex_close_socket(padapter); ++ else ++ RTW_INFO("CONFIG_BT_COEXIST: VIRTUAL_ADAPTER\n"); ++#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ ++#else /* !CONFIG_PLATFORM_INTEL_BYT */ ++ ++ if (pwrctl->bInSuspend == _TRUE) { ++ RTW_INFO("+871x_drv - drv_close, bInSuspend=%d\n", pwrctl->bInSuspend); ++ return 0; ++ } ++ ++ rtw_scan_abort(padapter); /* stop scanning process before wifi is going to down */ ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_cfg80211_wait_scan_req_empty(padapter, 200); ++#endif ++ ++ RTW_INFO("netdev_close, bips_processing=%d\n", pwrctl->bips_processing); ++ while (pwrctl->bips_processing == _TRUE) /* waiting for ips_processing done before call rtw_dev_unload() */ ++ rtw_msleep_os(1); ++ ++ rtw_dev_unload(padapter); ++ rtw_sdio_set_power(0); ++ ++#endif /* !CONFIG_PLATFORM_INTEL_BYT */ ++ ++ RTW_INFO("-871x_drv - drv_close, bup=%d\n", padapter->bup); ++ ++ return 0; ++ ++} ++ ++int pm_netdev_close(struct net_device *pnetdev, u8 bnormal) ++{ ++ int status = 0; ++ ++ status = netdev_close(pnetdev); ++ ++ return status; ++} ++ ++void rtw_ndev_destructor(struct net_device *ndev) ++{ ++ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (ndev->ieee80211_ptr) ++ rtw_mfree((u8 *)ndev->ieee80211_ptr, sizeof(struct wireless_dev)); ++#endif ++ free_netdev(ndev); ++} ++ ++#ifdef CONFIG_ARP_KEEP_ALIVE ++struct route_info { ++ struct in_addr dst_addr; ++ struct in_addr src_addr; ++ struct in_addr gateway; ++ unsigned int dev_index; ++}; ++ ++static void parse_routes(struct nlmsghdr *nl_hdr, struct route_info *rt_info) ++{ ++ struct rtmsg *rt_msg; ++ struct rtattr *rt_attr; ++ int rt_len; ++ ++ rt_msg = (struct rtmsg *) NLMSG_DATA(nl_hdr); ++ if ((rt_msg->rtm_family != AF_INET) || (rt_msg->rtm_table != RT_TABLE_MAIN)) ++ return; ++ ++ rt_attr = (struct rtattr *) RTM_RTA(rt_msg); ++ rt_len = RTM_PAYLOAD(nl_hdr); ++ ++ for (; RTA_OK(rt_attr, rt_len); rt_attr = RTA_NEXT(rt_attr, rt_len)) { ++ switch (rt_attr->rta_type) { ++ case RTA_OIF: ++ rt_info->dev_index = *(int *) RTA_DATA(rt_attr); ++ break; ++ case RTA_GATEWAY: ++ rt_info->gateway.s_addr = *(u_int *) RTA_DATA(rt_attr); ++ break; ++ case RTA_PREFSRC: ++ rt_info->src_addr.s_addr = *(u_int *) RTA_DATA(rt_attr); ++ break; ++ case RTA_DST: ++ rt_info->dst_addr.s_addr = *(u_int *) RTA_DATA(rt_attr); ++ break; ++ } ++ } ++} ++ ++static int route_dump(u32 *gw_addr , int *gw_index) ++{ ++ int err = 0; ++ struct socket *sock; ++ struct { ++ struct nlmsghdr nlh; ++ struct rtgenmsg g; ++ } req; ++ struct msghdr msg; ++ struct iovec iov; ++ struct sockaddr_nl nladdr; ++ mm_segment_t oldfs; ++ char *pg; ++ int size = 0; ++ ++ err = sock_create(AF_NETLINK, SOCK_DGRAM, NETLINK_ROUTE, &sock); ++ if (err) { ++ printk(": Could not create a datagram socket, error = %d\n", -ENXIO); ++ return err; ++ } ++ ++ memset(&nladdr, 0, sizeof(nladdr)); ++ nladdr.nl_family = AF_NETLINK; ++ ++ req.nlh.nlmsg_len = sizeof(req); ++ req.nlh.nlmsg_type = RTM_GETROUTE; ++ req.nlh.nlmsg_flags = NLM_F_ROOT | NLM_F_MATCH | NLM_F_REQUEST; ++ req.nlh.nlmsg_pid = 0; ++ req.g.rtgen_family = AF_INET; ++ ++ iov.iov_base = &req; ++ iov.iov_len = sizeof(req); ++ ++ msg.msg_name = &nladdr; ++ msg.msg_namelen = sizeof(nladdr); ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) ++ /* referece:sock_xmit in kernel code ++ * WRITE for sock_sendmsg, READ for sock_recvmsg ++ * third parameter for msg_iovlen ++ * last parameter for iov_len ++ */ ++ iov_iter_init(&msg.msg_iter, WRITE, &iov, 1, sizeof(req)); ++#else ++ msg.msg_iov = &iov; ++ msg.msg_iovlen = 1; ++#endif ++ msg.msg_control = NULL; ++ msg.msg_controllen = 0; ++ msg.msg_flags = MSG_DONTWAIT; ++ ++ oldfs = get_fs(); ++ set_fs(KERNEL_DS); ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) ++ err = sock_sendmsg(sock, &msg); ++#else ++ err = sock_sendmsg(sock, &msg, sizeof(req)); ++#endif ++ set_fs(oldfs); ++ ++ if (err < 0) ++ goto out_sock; ++ ++ pg = (char *) __get_free_page(GFP_KERNEL); ++ if (pg == NULL) { ++ err = -ENOMEM; ++ goto out_sock; ++ } ++ ++#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE) ++restart: ++#endif ++ ++ for (;;) { ++ struct nlmsghdr *h; ++ ++ iov.iov_base = pg; ++ iov.iov_len = PAGE_SIZE; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) ++ iov_iter_init(&msg.msg_iter, READ, &iov, 1, PAGE_SIZE); ++#endif ++ ++ oldfs = get_fs(); ++ set_fs(KERNEL_DS); ++ err = sock_recvmsg(sock, &msg, PAGE_SIZE, MSG_DONTWAIT); ++ set_fs(oldfs); ++ ++ if (err < 0) ++ goto out_sock_pg; ++ ++ if (msg.msg_flags & MSG_TRUNC) { ++ err = -ENOBUFS; ++ goto out_sock_pg; ++ } ++ ++ h = (struct nlmsghdr *) pg; ++ ++ while (NLMSG_OK(h, err)) { ++ struct route_info rt_info; ++ if (h->nlmsg_type == NLMSG_DONE) { ++ err = 0; ++ goto done; ++ } ++ ++ if (h->nlmsg_type == NLMSG_ERROR) { ++ struct nlmsgerr *errm = (struct nlmsgerr *) NLMSG_DATA(h); ++ err = errm->error; ++ printk("NLMSG error: %d\n", errm->error); ++ goto done; ++ } ++ ++ if (h->nlmsg_type == RTM_GETROUTE) ++ printk("RTM_GETROUTE: NLMSG: %d\n", h->nlmsg_type); ++ if (h->nlmsg_type != RTM_NEWROUTE) { ++ printk("NLMSG: %d\n", h->nlmsg_type); ++ err = -EINVAL; ++ goto done; ++ } ++ ++ memset(&rt_info, 0, sizeof(struct route_info)); ++ parse_routes(h, &rt_info); ++ if (!rt_info.dst_addr.s_addr && rt_info.gateway.s_addr && rt_info.dev_index) { ++ *gw_addr = rt_info.gateway.s_addr; ++ *gw_index = rt_info.dev_index; ++ ++ } ++ h = NLMSG_NEXT(h, err); ++ } ++ ++ if (err) { ++ printk("!!!Remnant of size %d %d %d\n", err, h->nlmsg_len, h->nlmsg_type); ++ err = -EINVAL; ++ break; ++ } ++ } ++ ++done: ++#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE) ++ if (!err && req.g.rtgen_family == AF_INET) { ++ req.g.rtgen_family = AF_INET6; ++ ++ iov.iov_base = &req; ++ iov.iov_len = sizeof(req); ++ ++ msg.msg_name = &nladdr; ++ msg.msg_namelen = sizeof(nladdr); ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) ++ iov_iter_init(&msg.msg_iter, WRITE, &iov, 1, sizeof(req)); ++#else ++ msg.msg_iov = &iov; ++ msg.msg_iovlen = 1; ++#endif ++ msg.msg_control = NULL; ++ msg.msg_controllen = 0; ++ msg.msg_flags = MSG_DONTWAIT; ++ ++ oldfs = get_fs(); ++ set_fs(KERNEL_DS); ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) ++ err = sock_sendmsg(sock, &msg); ++#else ++ err = sock_sendmsg(sock, &msg, sizeof(req)); ++#endif ++ set_fs(oldfs); ++ ++ if (err > 0) ++ goto restart; ++ } ++#endif ++ ++out_sock_pg: ++ free_page((unsigned long) pg); ++ ++out_sock: ++ sock_release(sock); ++ return err; ++} ++ ++static int arp_query(unsigned char *haddr, u32 paddr, ++ struct net_device *dev) ++{ ++ struct neighbour *neighbor_entry; ++ int ret = 0; ++ ++ neighbor_entry = neigh_lookup(&arp_tbl, &paddr, dev); ++ ++ if (neighbor_entry != NULL) { ++ neighbor_entry->used = jiffies; ++ if (neighbor_entry->nud_state & NUD_VALID) { ++ _rtw_memcpy(haddr, neighbor_entry->ha, dev->addr_len); ++ ret = 1; ++ } ++ neigh_release(neighbor_entry); ++ } ++ return ret; ++} ++ ++static int get_defaultgw(u32 *ip_addr , char mac[]) ++{ ++ int gw_index = 0; /* oif device index */ ++ struct net_device *gw_dev = NULL; /* oif device */ ++ ++ route_dump(ip_addr, &gw_index); ++ ++ if (!(*ip_addr) || !gw_index) { ++ /* RTW_INFO("No default GW\n"); */ ++ return -1; ++ } ++ ++ gw_dev = dev_get_by_index(&init_net, gw_index); ++ ++ if (gw_dev == NULL) { ++ /* RTW_INFO("get Oif Device Fail\n"); */ ++ return -1; ++ } ++ ++ if (!arp_query(mac, *ip_addr, gw_dev)) { ++ /* RTW_INFO( "arp query failed\n"); */ ++ dev_put(gw_dev); ++ return -1; ++ ++ } ++ dev_put(gw_dev); ++ ++ return 0; ++} ++ ++int rtw_gw_addr_query(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ u32 gw_addr = 0; /* default gw address */ ++ unsigned char gw_mac[32] = {0}; /* default gw mac */ ++ int i; ++ int res; ++ ++ res = get_defaultgw(&gw_addr, gw_mac); ++ if (!res) { ++ pmlmepriv->gw_ip[0] = gw_addr & 0xff; ++ pmlmepriv->gw_ip[1] = (gw_addr & 0xff00) >> 8; ++ pmlmepriv->gw_ip[2] = (gw_addr & 0xff0000) >> 16; ++ pmlmepriv->gw_ip[3] = (gw_addr & 0xff000000) >> 24; ++ _rtw_memcpy(pmlmepriv->gw_mac_addr, gw_mac, 6); ++ RTW_INFO("%s Gateway Mac:\t" MAC_FMT "\n", __FUNCTION__, MAC_ARG(pmlmepriv->gw_mac_addr)); ++ RTW_INFO("%s Gateway IP:\t" IP_FMT "\n", __FUNCTION__, IP_ARG(pmlmepriv->gw_ip)); ++ } else ++ RTW_INFO("Get Gateway IP/MAC fail!\n"); ++ ++ return res; ++} ++#endif ++ ++void rtw_dev_unload(PADAPTER padapter) ++{ ++ struct net_device *pnetdev = (struct net_device *)padapter->pnetdev; ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ struct dvobj_priv *pobjpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &pobjpriv->drv_dbg; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ u8 cnt = 0; ++ ++ ++ if (padapter->bup == _TRUE) { ++ RTW_INFO("===> %s\n", __FUNCTION__); ++ ++ rtw_set_drv_stopped(padapter); ++#ifdef CONFIG_XMIT_ACK ++ if (padapter->xmitpriv.ack_tx) ++ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP); ++#endif ++ ++ rtw_intf_stop(padapter); ++ ++ ++ if (!pwrctl->bInternalAutoSuspend) ++ rtw_stop_drv_threads(padapter); ++ ++ while (ATOMIC_READ(&(pcmdpriv->cmdthd_running)) == _TRUE) { ++ if (cnt > 5) { ++ RTW_INFO("stop cmdthd timeout\n"); ++ break; ++ } else { ++ cnt++; ++ RTW_INFO("cmdthd is running(%d)\n", cnt); ++ rtw_msleep_os(10); ++ } ++ } ++ ++ ++ /* check the status of IPS */ ++ if (rtw_hal_check_ips_status(padapter) == _TRUE || pwrctl->rf_pwrstate == rf_off) { /* check HW status and SW state */ ++ RTW_PRINT("%s: driver in IPS-FWLPS\n", __func__); ++ pdbgpriv->dbg_dev_unload_inIPS_cnt++; ++ } else ++ RTW_PRINT("%s: driver not in IPS\n", __func__); ++ ++ if (!rtw_is_surprise_removed(padapter)) { ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_IpsNotify(padapter, pwrctl->ips_mode_req); ++#endif ++#ifdef CONFIG_WOWLAN ++ if (pwrctl->bSupportRemoteWakeup == _TRUE && ++ pwrctl->wowlan_mode == _TRUE) ++ RTW_PRINT("%s bSupportRemoteWakeup==_TRUE do not run rtw_hal_deinit()\n", __FUNCTION__); ++ else ++#endif ++ { ++ /* amy modify 20120221 for power seq is different between driver open and ips */ ++ rtw_hal_deinit(padapter); ++ } ++ rtw_set_surprise_removed(padapter); ++ } ++ ++ padapter->bup = _FALSE; ++ ++ RTW_INFO("<=== %s\n", __FUNCTION__); ++ } else { ++ RTW_INFO("%s: bup==_FALSE\n", __FUNCTION__); ++ } ++ rtw_cancel_all_timer(padapter); ++} ++ ++int rtw_suspend_free_assoc_resource(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct net_device *pnetdev = padapter->pnetdev; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++#endif /* CONFIG_P2P */ ++ ++ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); ++ ++ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) ++ && check_fwstate(pmlmepriv, _FW_LINKED) ++#ifdef CONFIG_P2P ++ && rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) ++#endif /* CONFIG_P2P */ ++ ) { ++ RTW_INFO("%s %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n", __FUNCTION__, ++ pmlmepriv->cur_network.network.Ssid.Ssid, ++ MAC_ARG(pmlmepriv->cur_network.network.MacAddress), ++ pmlmepriv->cur_network.network.Ssid.SsidLength, ++ pmlmepriv->assoc_ssid.SsidLength); ++ rtw_set_to_roam(padapter, 1); ++ } ++ } ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && check_fwstate(pmlmepriv, _FW_LINKED)) { ++ rtw_disassoc_cmd(padapter, 0, _FALSE); ++ /* s2-2. indicate disconnect to os */ ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ } ++#ifdef CONFIG_AP_MODE ++ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) ++ rtw_sta_flush(padapter, _TRUE); ++#endif ++ ++ /* s2-3. */ ++ rtw_free_assoc_resources(padapter, 1); ++ ++ /* s2-4. */ ++#ifdef CONFIG_AUTOSUSPEND ++ if (is_primary_adapter(padapter) && (!adapter_to_pwrctl(padapter)->bInternalAutoSuspend)) ++#endif ++ rtw_free_network_queue(padapter, _TRUE); ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { ++ RTW_PRINT("%s: fw_under_survey\n", __func__); ++ rtw_indicate_scan_done(padapter, 1); ++ clr_fwstate(pmlmepriv, _FW_UNDER_SURVEY); ++ } ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { ++ RTW_PRINT("%s: fw_under_linking\n", __FUNCTION__); ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ } ++ ++ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); ++ return _SUCCESS; ++} ++ ++#ifdef CONFIG_WOWLAN ++int rtw_suspend_wow(_adapter *padapter) ++{ ++ u8 ch, bw, offset; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct net_device *pnetdev = padapter->pnetdev; ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct wowlan_ioctl_param poidparam; ++ int i; ++ _adapter *iface = NULL; ++ u8 ps_mode; ++ int ret = _SUCCESS; ++ ++ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); ++ ++ ++ RTW_INFO("wowlan_mode: %d\n", pwrpriv->wowlan_mode); ++ RTW_INFO("wowlan_pno_enable: %d\n", pwrpriv->wowlan_pno_enable); ++#ifdef CONFIG_P2P_WOWLAN ++ RTW_INFO("wowlan_p2p_enable: %d\n", pwrpriv->wowlan_p2p_enable); ++#endif ++ ++ if (pwrpriv->wowlan_mode == _TRUE) { ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT); ++#endif ++ ++ if (pnetdev) ++ rtw_netif_stop_queue(pnetdev); ++ rtw_mi_buddy_netif_stop_queue(padapter, _TRUE); ++ ++ /* 0. Power off LED */ ++ rtw_led_control(padapter, LED_CTL_POWER_OFF); ++ /* 1. stop thread */ ++ rtw_set_drv_stopped(padapter); /*for stop thread*/ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && (iface->bup == _TRUE)) ++ rtw_stop_drv_threads(iface); ++ } ++ rtw_clr_drv_stopped(padapter); /*for 32k command*/ ++ ++ /* #ifdef CONFIG_LPS */ ++ /* rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "WOWLAN"); */ ++ /* #endif */ ++ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ /* 2. disable interrupt */ ++ rtw_mi_intf_stop(padapter); ++ ++ /* 2.1 clean interupt */ ++ rtw_hal_clear_interrupt(padapter); ++#endif /* CONFIG_SDIO_HCI */ ++ ++ /* 2.2 free irq */ ++ /* sdio_free_irq(adapter_to_dvobj(padapter)); */ ++#ifndef CONFIG_RTW_SDIO_KEEP_IRQ ++ if (padapter->intf_free_irq) ++ padapter->intf_free_irq(adapter_to_dvobj(padapter)); ++#endif ++ ++#ifdef CONFIG_RUNTIME_PORT_SWITCH ++ if (rtw_port_switch_chk(padapter)) { ++ RTW_INFO(" ### PORT SWITCH ###\n"); ++ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); ++ } ++#endif ++ ++ poidparam.subcode = WOWLAN_ENABLE; ++ rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); ++ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) ++ && check_fwstate(pmlmepriv, _FW_LINKED)) { ++ RTW_INFO("%s %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n", __FUNCTION__, ++ pmlmepriv->cur_network.network.Ssid.Ssid, ++ MAC_ARG(pmlmepriv->cur_network.network.MacAddress), ++ pmlmepriv->cur_network.network.Ssid.SsidLength, ++ pmlmepriv->assoc_ssid.SsidLength); ++ ++ rtw_set_to_roam(padapter, 0); ++ } ++ } ++ ++ RTW_PRINT("%s: wowmode suspending\n", __func__); ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { ++ RTW_PRINT("%s: fw_under_survey\n", __func__); ++ rtw_indicate_scan_done(padapter, 1); ++ clr_fwstate(pmlmepriv, _FW_UNDER_SURVEY); ++ } ++ ++#if 1 ++ if (rtw_mi_check_status(padapter, MI_LINKED)) { ++ ch = rtw_mi_get_union_chan(padapter); ++ bw = rtw_mi_get_union_bw(padapter); ++ offset = rtw_mi_get_union_offset(padapter); ++ RTW_INFO(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", ++ FUNC_ADPT_ARG(padapter), ch, bw, offset); ++ set_channel_bwmode(padapter, ch, offset, bw); ++ } ++#else ++ if (rtw_mi_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { ++ RTW_INFO(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", ++ FUNC_ADPT_ARG(padapter), ch, bw, offset); ++ set_channel_bwmode(padapter, ch, offset, bw); ++ rtw_mi_update_union_chan_inf(padapter, ch, offset, bw); ++ } ++#endif ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ rtw_mi_buddy_suspend_free_assoc_resource(padapter); ++#endif ++ ++ if (pwrpriv->wowlan_pno_enable) { ++ RTW_PRINT("%s: pno: %d\n", __func__, ++ pwrpriv->wowlan_pno_enable); ++#ifdef CONFIG_FWLPS_IN_IPS ++ rtw_set_fw_in_ips_mode(padapter, _TRUE); ++#endif ++ } ++#ifdef CONFIG_LPS ++ else ++ rtw_set_ps_mode(padapter, PS_MODE_MAX, 0, 0, "WOWLAN"); ++#endif /* #ifdef CONFIG_LPS */ ++ ++ } else ++ RTW_PRINT("%s: ### ERROR ### wowlan_mode=%d\n", __FUNCTION__, pwrpriv->wowlan_mode); ++ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); ++ return ret; ++} ++#endif /* #ifdef CONFIG_WOWLAN */ ++ ++#ifdef CONFIG_AP_WOWLAN ++int rtw_suspend_ap_wow(_adapter *padapter) ++{ ++ u8 ch, bw, offset; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ struct wowlan_ioctl_param poidparam; ++ int i; ++ _adapter *iface = NULL; ++ u8 ps_mode; ++ int ret = _SUCCESS; ++ ++ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); ++ ++ pwrpriv->wowlan_ap_mode = _TRUE; ++ ++ RTW_INFO("wowlan_ap_mode: %d\n", pwrpriv->wowlan_ap_mode); ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT); ++#endif ++ ++ rtw_mi_netif_stop_queue(padapter, _FALSE); ++ ++ /* 0. Power off LED */ ++ rtw_led_control(padapter, LED_CTL_POWER_OFF); ++ /* 1. stop thread */ ++ rtw_set_drv_stopped(padapter); /*for stop thread*/ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && (iface->bup == _TRUE)) ++ rtw_stop_drv_threads(iface); ++ } ++ rtw_clr_drv_stopped(padapter); /*for 32k command*/ ++ ++#ifdef CONFIG_SDIO_HCI ++ /* 2. disable interrupt*/ ++ rtw_mi_intf_stop(padapter); ++ ++ /* 2.1 clean interupt */ ++ rtw_hal_clear_interrupt(padapter); ++#endif /* CONFIG_SDIO_HCI */ ++ ++ /* 2.2 free irq */ ++ if (padapter->intf_free_irq) ++ padapter->intf_free_irq(adapter_to_dvobj(padapter)); ++ ++#ifdef CONFIG_RUNTIME_PORT_SWITCH ++ if (rtw_port_switch_chk(padapter)) { ++ RTW_INFO(" ### PORT SWITCH ###\n"); ++ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); ++ } ++#endif ++ ++ poidparam.subcode = WOWLAN_AP_ENABLE; ++ rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); ++ ++ RTW_PRINT("%s: wowmode suspending\n", __func__); ++#if 1 ++ if (rtw_mi_check_status(padapter, MI_LINKED)) { ++ ch = rtw_mi_get_union_chan(padapter); ++ bw = rtw_mi_get_union_bw(padapter); ++ offset = rtw_mi_get_union_offset(padapter); ++ RTW_INFO("back to linked/linking union - ch:%u, bw:%u, offset:%u\n", ch, bw, offset); ++ set_channel_bwmode(padapter, ch, offset, bw); ++ } ++#else ++ if (rtw_mi_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { ++ RTW_INFO("back to linked/linking union - ch:%u, bw:%u, offset:%u\n", ch, bw, offset); ++ set_channel_bwmode(padapter, ch, offset, bw); ++ rtw_mi_update_union_chan_inf(padapter, ch, offset, bw); ++ } ++#endif ++ ++ /*FOR ONE AP - TODO :Multi-AP*/ ++ { ++ int i; ++ _adapter *iface; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE | _FW_LINKED)) ++ rtw_mi_buddy_suspend_free_assoc_resource(iface); ++ } ++ } ++ ++ } ++ ++#ifdef CONFIG_LPS ++ rtw_set_ps_mode(padapter, PS_MODE_MIN, 0, 0, "AP-WOWLAN"); ++#endif ++ ++ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); ++ return ret; ++} ++#endif /* #ifdef CONFIG_AP_WOWLAN */ ++ ++ ++int rtw_suspend_normal(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ int ret = _SUCCESS; ++#ifdef CONFIG_RTW_SDIO_KEEP_IRQ ++ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); ++ struct sdio_func *func = pdvobj->intf_data.func; ++#endif ++ ++ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_SUSPEND); ++#endif ++ ++ rtw_mi_netif_stop_queue(padapter, _TRUE); ++ ++ rtw_mi_suspend_free_assoc_resource(padapter); ++ ++ rtw_led_control(padapter, LED_CTL_POWER_OFF); ++ ++#if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) ++ if ((rtw_hal_check_ips_status(padapter) == _TRUE) ++ || (adapter_to_pwrctl(padapter)->rf_pwrstate == rf_off)) ++ RTW_PRINT("%s: ### ERROR #### driver in IPS ####ERROR###!!!\n", __FUNCTION__); ++#endif ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ rtw_mi_buddy_dev_unload(padapter); ++#endif ++ rtw_dev_unload(padapter); ++ ++ /* sdio_deinit(adapter_to_dvobj(padapter)); */ ++#ifdef CONFIG_RTW_SDIO_KEEP_IRQ ++ if (func) { ++ int err; ++ ++ sdio_claim_host(func); ++ err = sdio_disable_func(func); ++ if (err) { ++ pdvobj->drv_dbg.dbg_sdio_deinit_error_cnt++; ++ RTW_INFO("%s: sdio_disable_func(%d)\n", __func__, err); ++ } ++ ++ sdio_release_host(func); ++ } ++#else ++ if (padapter->intf_deinit) ++ padapter->intf_deinit(adapter_to_dvobj(padapter)); ++#endif ++ ++ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); ++ return ret; ++} ++ ++int rtw_suspend_common(_adapter *padapter) ++{ ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(psdpriv); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ int ret = 0; ++ u32 start_time = rtw_get_current_time(); ++ ++ RTW_PRINT(" suspend start\n"); ++ RTW_INFO("==> %s (%s:%d)\n", __FUNCTION__, current->comm, current->pid); ++ ++ pdbgpriv->dbg_suspend_cnt++; ++ ++ pwrpriv->bInSuspend = _TRUE; ++ ++ while (pwrpriv->bips_processing == _TRUE) ++ rtw_msleep_os(1); ++ ++#ifdef CONFIG_IOL_READ_EFUSE_MAP ++ if (!padapter->bup) { ++ u8 bMacPwrCtrlOn = _FALSE; ++ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); ++ if (bMacPwrCtrlOn) ++ rtw_hal_power_off(padapter); ++ } ++#endif ++ ++ if ((!padapter->bup) || RTW_CANNOT_RUN(padapter)) { ++ RTW_INFO("%s bup=%d bDriverStopped=%s bSurpriseRemoved = %s\n", __func__ ++ , padapter->bup ++ , rtw_is_drv_stopped(padapter) ? "True" : "False" ++ , rtw_is_surprise_removed(padapter) ? "True" : "False"); ++ pdbgpriv->dbg_suspend_error_cnt++; ++ goto exit; ++ } ++ rtw_ps_deny(padapter, PS_DENY_SUSPEND); ++ ++ rtw_mi_cancel_all_timer(padapter); ++ LeaveAllPowerSaveModeDirect(padapter); ++ rtw_stop_cmd_thread(padapter); ++ ++ rtw_ps_deny_cancel(padapter, PS_DENY_SUSPEND); ++ ++ if (rtw_mi_check_status(padapter, MI_AP_MODE) == _FALSE) { ++#ifdef CONFIG_WOWLAN ++ if (check_fwstate(pmlmepriv, _FW_LINKED)) ++ pwrpriv->wowlan_mode = _TRUE; ++ else if (pwrpriv->wowlan_pno_enable == _TRUE) ++ pwrpriv->wowlan_mode |= pwrpriv->wowlan_pno_enable; ++ ++#ifdef CONFIG_P2P_WOWLAN ++ if (!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE) || P2P_ROLE_DISABLE != padapter->wdinfo.role) ++ pwrpriv->wowlan_p2p_mode = _TRUE; ++ if (_TRUE == pwrpriv->wowlan_p2p_mode) ++ pwrpriv->wowlan_mode |= pwrpriv->wowlan_p2p_mode; ++#endif /* CONFIG_P2P_WOWLAN */ ++ ++ if (pwrpriv->wowlan_mode == _TRUE) ++ rtw_suspend_wow(padapter); ++ else ++#endif /* CONFIG_WOWLAN */ ++ rtw_suspend_normal(padapter); ++ } else if (rtw_mi_check_status(padapter, MI_AP_MODE)) { ++#ifdef CONFIG_AP_WOWLAN ++ rtw_suspend_ap_wow(padapter); ++#else ++ rtw_suspend_normal(padapter); ++#endif /*CONFIG_AP_WOWLAN*/ ++ } ++ ++ ++ RTW_PRINT("rtw suspend success in %d ms\n", ++ rtw_get_passing_time_ms(start_time)); ++ ++exit: ++ RTW_INFO("<=== %s return %d.............. in %dms\n", __FUNCTION__ ++ , ret, rtw_get_passing_time_ms(start_time)); ++ ++ return ret; ++} ++ ++#ifdef CONFIG_WOWLAN ++int rtw_resume_process_wow(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct net_device *pnetdev = padapter->pnetdev; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ struct wowlan_ioctl_param poidparam; ++ struct sta_info *psta = NULL; ++ int ret = _SUCCESS; ++ ++ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); ++ ++ if (padapter) { ++ pnetdev = padapter->pnetdev; ++ pwrpriv = adapter_to_pwrctl(padapter); ++ } else { ++ pdbgpriv->dbg_resume_error_cnt++; ++ ret = -1; ++ goto exit; ++ } ++ ++ if (RTW_CANNOT_RUN(padapter)) { ++ RTW_INFO("%s pdapter %p bDriverStopped %s bSurpriseRemoved %s\n" ++ , __func__, padapter ++ , rtw_is_drv_stopped(padapter) ? "True" : "False" ++ , rtw_is_surprise_removed(padapter) ? "True" : "False"); ++ goto exit; ++ } ++ ++ pwrpriv->wowlan_in_resume = _TRUE; ++#ifdef CONFIG_PNO_SUPPORT ++#ifdef CONFIG_FWLPS_IN_IPS ++ if (pwrpriv->wowlan_pno_enable) ++ rtw_set_fw_in_ips_mode(padapter, _FALSE); ++#endif /* CONFIG_FWLPS_IN_IPS */ ++#endif/* CONFIG_PNO_SUPPORT */ ++ ++ if (pwrpriv->wowlan_mode == _TRUE) { ++#ifdef CONFIG_LPS ++ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "WOWLAN"); ++#endif /* CONFIG_LPS */ ++ ++ pwrpriv->bFwCurrentInPSMode = _FALSE; ++ ++#ifdef CONFIG_SDIO_HCI ++ rtw_mi_intf_stop(padapter); ++ rtw_hal_clear_interrupt(padapter); ++#endif /* CONFIG_SDIO_HCI */ ++ ++#ifndef CONFIG_RTW_SDIO_KEEP_IRQ ++ /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { */ ++ if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) { ++ ret = -1; ++ goto exit; ++ } ++#endif ++ ++ /* Disable WOW, set H2C command */ ++ poidparam.subcode = WOWLAN_DISABLE; ++ rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ rtw_mi_buddy_reset_drv_sw(padapter); ++#endif ++ ++ psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); ++ if (psta) ++ set_sta_rate(padapter, psta); ++ ++ ++ rtw_clr_drv_stopped(padapter); ++ RTW_INFO("%s: wowmode resuming, DriverStopped:%s\n", __func__, rtw_is_drv_stopped(padapter) ? "True" : "False"); ++ ++ rtw_mi_start_drv_threads(padapter); ++ ++ rtw_mi_intf_start(padapter); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ rtw_mi_buddy_netif_carrier_on(padapter); ++#endif ++ ++ /* start netif queue */ ++ if (pnetdev) ++ rtw_netif_wake_queue(pnetdev); ++ } else ++ ++ RTW_PRINT("%s: ### ERROR ### wowlan_mode=%d\n", __FUNCTION__, pwrpriv->wowlan_mode); ++ ++ if (padapter->pid[1] != 0) { ++ RTW_INFO("pid[1]:%d\n", padapter->pid[1]); ++ rtw_signal_process(padapter->pid[1], SIGUSR2); ++ } ++ ++ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { ++ if (pwrpriv->wowlan_wake_reason == FW_DECISION_DISCONNECT || ++ pwrpriv->wowlan_wake_reason == RX_DISASSOC|| ++ pwrpriv->wowlan_wake_reason == RX_DEAUTH) { ++ ++ RTW_INFO("%s: disconnect reason: %02x\n", __func__, ++ pwrpriv->wowlan_wake_reason); ++ rtw_indicate_disconnect(padapter, 0, _FALSE); ++ ++ rtw_sta_media_status_rpt(padapter, ++ rtw_get_stainfo(&padapter->stapriv, ++ get_bssid(&padapter->mlmepriv)), 0); ++ ++ rtw_free_assoc_resources(padapter, 1); ++ pmlmeinfo->state = WIFI_FW_NULL_STATE; ++ ++ } else { ++ RTW_INFO("%s: do roaming\n", __func__); ++ rtw_roaming(padapter, NULL); ++ } ++ } ++ ++ if (pwrpriv->wowlan_wake_reason == FW_DECISION_DISCONNECT) ++ rtw_lock_ext_suspend_timeout(2000); ++ ++ if (pwrpriv->wowlan_wake_reason == RX_GTK || ++ pwrpriv->wowlan_wake_reason == RX_DISASSOC|| ++ pwrpriv->wowlan_wake_reason == RX_DEAUTH) ++ rtw_lock_ext_suspend_timeout(8000); ++ ++ if (pwrpriv->wowlan_wake_reason == RX_PNO) { ++ #ifdef CONFIG_IOCTL_CFG80211 ++ rtw_cfg80211_disconnected(padapter->rtw_wdev, 0, NULL, 0, 1, GFP_ATOMIC); ++ #endif ++ rtw_lock_ext_suspend_timeout(10000); ++ } ++ ++ if (pwrpriv->wowlan_mode == _TRUE) { ++ pwrpriv->bips_processing = _FALSE; ++ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); ++#ifndef CONFIG_IPS_CHECK_IN_WD ++ rtw_set_pwr_state_check_timer(pwrpriv); ++#endif ++ } else ++ RTW_PRINT("do not reset timer\n"); ++ ++ pwrpriv->wowlan_mode = _FALSE; ++ ++ /* Power On LED */ ++#ifdef CONFIG_SW_LED ++ ++ if (pwrpriv->wowlan_wake_reason == RX_DISASSOC|| ++ pwrpriv->wowlan_wake_reason == RX_DEAUTH|| ++ pwrpriv->wowlan_wake_reason == FW_DECISION_DISCONNECT) ++ rtw_led_control(padapter, LED_CTL_NO_LINK); ++ else ++ rtw_led_control(padapter, LED_CTL_LINK); ++#endif ++ /* clean driver side wake up reason. */ ++ pwrpriv->wowlan_last_wake_reason = pwrpriv->wowlan_wake_reason; ++ pwrpriv->wowlan_wake_reason = 0; ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_RESUME); ++#endif /* CONFIG_BT_COEXIST */ ++ ++exit: ++ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); ++ return ret; ++} ++#endif /* #ifdef CONFIG_WOWLAN */ ++ ++#ifdef CONFIG_AP_WOWLAN ++int rtw_resume_process_ap_wow(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct net_device *pnetdev = padapter->pnetdev; ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct dvobj_priv *psdpriv = padapter->dvobj; ++ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ struct wowlan_ioctl_param poidparam; ++ struct sta_info *psta = NULL; ++ int ret = _SUCCESS; ++ u8 ch, bw, offset; ++ ++ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); ++ ++ if (padapter) { ++ pnetdev = padapter->pnetdev; ++ pwrpriv = adapter_to_pwrctl(padapter); ++ } else { ++ pdbgpriv->dbg_resume_error_cnt++; ++ ret = -1; ++ goto exit; ++ } ++ ++ ++#ifdef CONFIG_LPS ++ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "AP-WOWLAN"); ++#endif /* CONFIG_LPS */ ++ ++ pwrpriv->bFwCurrentInPSMode = _FALSE; ++ ++ rtw_hal_disable_interrupt(padapter); ++ ++ rtw_hal_clear_interrupt(padapter); ++ ++ /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { */ ++ if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) { ++ ret = -1; ++ goto exit; ++ } ++ ++ /* Disable WOW, set H2C command */ ++ poidparam.subcode = WOWLAN_AP_DISABLE; ++ rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); ++ pwrpriv->wowlan_ap_mode = _FALSE; ++ ++ rtw_clr_drv_stopped(padapter); ++ RTW_INFO("%s: wowmode resuming, DriverStopped:%s\n", __func__, rtw_is_drv_stopped(padapter) ? "True" : "False"); ++ ++ rtw_mi_start_drv_threads(padapter); ++ ++#if 1 ++ if (rtw_mi_check_status(padapter, MI_LINKED)) { ++ ch = rtw_mi_get_union_chan(padapter); ++ bw = rtw_mi_get_union_bw(padapter); ++ offset = rtw_mi_get_union_offset(padapter); ++ RTW_INFO(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", FUNC_ADPT_ARG(padapter), ch, bw, offset); ++ set_channel_bwmode(padapter, ch, offset, bw); ++ } ++#else ++ if (rtw_mi_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { ++ RTW_INFO(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", FUNC_ADPT_ARG(padapter), ch, bw, offset); ++ set_channel_bwmode(padapter, ch, offset, bw); ++ rtw_mi_update_union_chan_inf(padapter, ch, offset, bw); ++ } ++#endif ++ ++ /*FOR ONE AP - TODO :Multi-AP*/ ++ { ++ int i; ++ _adapter *iface; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE | _FW_LINKED)) ++ rtw_mi_buddy_reset_drv_sw(iface); ++ } ++ } ++ ++ } ++ rtw_mi_intf_start(padapter); ++ rtw_mi_netif_wake_queue(padapter); ++ ++ if (padapter->pid[1] != 0) { ++ RTW_INFO("pid[1]:%d\n", padapter->pid[1]); ++ rtw_signal_process(padapter->pid[1], SIGUSR2); ++ } ++ ++#ifdef CONFIG_RESUME_IN_WORKQUEUE ++ /* rtw_unlock_suspend(); */ ++#endif /* CONFIG_RESUME_IN_WORKQUEUE */ ++ ++ if (pwrpriv->wowlan_wake_reason == AP_OFFLOAD_WAKEUP) ++ rtw_lock_ext_suspend_timeout(8000); ++ ++ pwrpriv->bips_processing = _FALSE; ++ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); ++#ifndef CONFIG_IPS_CHECK_IN_WD ++ rtw_set_pwr_state_check_timer(pwrpriv); ++#endif ++ /* clean driver side wake up reason. */ ++ pwrpriv->wowlan_wake_reason = 0; ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_RESUME); ++#endif /* CONFIG_BT_COEXIST */ ++ ++ /* Power On LED */ ++#ifdef CONFIG_SW_LED ++ ++ rtw_led_control(padapter, LED_CTL_LINK); ++#endif ++exit: ++ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); ++ return ret; ++} ++#endif /* #ifdef CONFIG_APWOWLAN */ ++ ++void rtw_mi_resume_process_normal(_adapter *padapter) ++{ ++ int i; ++ _adapter *iface; ++ struct mlme_priv *pmlmepriv; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ pmlmepriv = &iface->mlmepriv; ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { ++ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); ++ ++ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) ++ rtw_roaming(padapter, NULL); ++#ifdef CONFIG_AP_MODE ++ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); ++ rtw_ap_restore_network(padapter); ++#endif /* CONFIG_AP_MODE */ ++ } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) ++ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); ++ else ++ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); ++ } ++ } ++} ++ ++int rtw_resume_process_normal(_adapter *padapter) ++{ ++ struct net_device *pnetdev; ++ struct pwrctrl_priv *pwrpriv; ++ struct dvobj_priv *psdpriv; ++ struct debug_priv *pdbgpriv; ++ ++ int ret = _SUCCESS; ++ ++ if (!padapter) { ++ ret = -1; ++ goto exit; ++ } ++ ++ pnetdev = padapter->pnetdev; ++ pwrpriv = adapter_to_pwrctl(padapter); ++ psdpriv = padapter->dvobj; ++ pdbgpriv = &psdpriv->drv_dbg; ++ ++ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); ++ /* interface init */ ++ /* if (sdio_init(adapter_to_dvobj(padapter)) != _SUCCESS) */ ++ if ((padapter->intf_init) && (padapter->intf_init(adapter_to_dvobj(padapter)) != _SUCCESS)) { ++ ret = -1; ++ goto exit; ++ } ++ rtw_hal_disable_interrupt(padapter); ++#ifndef CONFIG_RTW_SDIO_KEEP_IRQ ++ /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) */ ++ if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) { ++ ret = -1; ++ goto exit; ++ } ++#endif ++ ++ rtw_mi_reset_drv_sw(padapter); ++ ++ pwrpriv->bkeepfwalive = _FALSE; ++ ++ RTW_INFO("bkeepfwalive(%x)\n", pwrpriv->bkeepfwalive); ++ if (pm_netdev_open(pnetdev, _TRUE) != 0) { ++ ret = -1; ++ pdbgpriv->dbg_resume_error_cnt++; ++ goto exit; ++ } ++ ++ rtw_mi_netif_carrier_on(padapter); ++ ++ if (padapter->pid[1] != 0) { ++ RTW_INFO("pid[1]:%d\n", padapter->pid[1]); ++ rtw_signal_process(padapter->pid[1], SIGUSR2); ++ } ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_RESUME); ++#endif /* CONFIG_BT_COEXIST */ ++ ++ rtw_mi_resume_process_normal(padapter); ++ ++#ifdef CONFIG_RESUME_IN_WORKQUEUE ++ /* rtw_unlock_suspend(); */ ++#endif /* CONFIG_RESUME_IN_WORKQUEUE */ ++ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); ++ ++exit: ++ return ret; ++} ++ ++int rtw_resume_common(_adapter *padapter) ++{ ++ int ret = 0; ++ u32 start_time = rtw_get_current_time(); ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ ++ if (pwrpriv->bInSuspend == _FALSE) ++ return 0; ++ ++ RTW_PRINT("resume start\n"); ++ RTW_INFO("==> %s (%s:%d)\n", __FUNCTION__, current->comm, current->pid); ++ ++ if (rtw_mi_check_status(padapter, WIFI_AP_STATE) == _FALSE) { ++#ifdef CONFIG_WOWLAN ++ if (pwrpriv->wowlan_mode == _TRUE) ++ rtw_resume_process_wow(padapter); ++ else ++#endif ++ rtw_resume_process_normal(padapter); ++ ++ } else if (rtw_mi_check_status(padapter, WIFI_AP_STATE)) { ++#ifdef CONFIG_AP_WOWLAN ++ rtw_resume_process_ap_wow(padapter); ++#else ++ rtw_resume_process_normal(padapter); ++#endif /* CONFIG_AP_WOWLAN */ ++ } ++ ++ if (pwrpriv) { ++ pwrpriv->bInSuspend = _FALSE; ++#ifdef CONFIG_WOWLAN ++ pwrpriv->wowlan_in_resume = _FALSE; ++#endif ++ } ++ RTW_PRINT("%s:%d in %d ms\n", __FUNCTION__ , ret, ++ rtw_get_passing_time_ms(start_time)); ++ ++ ++ return ret; ++} ++ ++#ifdef CONFIG_GPIO_API ++u8 rtw_get_gpio(struct net_device *netdev, u8 gpio_num) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); ++ return rtw_hal_get_gpio(adapter, gpio_num); ++} ++EXPORT_SYMBOL(rtw_get_gpio); ++ ++int rtw_set_gpio_output_value(struct net_device *netdev, u8 gpio_num, bool isHigh) ++{ ++ u8 direction = 0; ++ u8 res = -1; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); ++ return rtw_hal_set_gpio_output_value(adapter, gpio_num, isHigh); ++} ++EXPORT_SYMBOL(rtw_set_gpio_output_value); ++ ++int rtw_config_gpio(struct net_device *netdev, u8 gpio_num, bool isOutput) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); ++ return rtw_hal_config_gpio(adapter, gpio_num, isOutput); ++} ++EXPORT_SYMBOL(rtw_config_gpio); ++int rtw_register_gpio_interrupt(struct net_device *netdev, int gpio_num, void(*callback)(u8 level)) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); ++ return rtw_hal_register_gpio_interrupt(adapter, gpio_num, callback); ++} ++EXPORT_SYMBOL(rtw_register_gpio_interrupt); ++ ++int rtw_disable_gpio_interrupt(struct net_device *netdev, int gpio_num) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); ++ return rtw_hal_disable_gpio_interrupt(adapter, gpio_num); ++} ++EXPORT_SYMBOL(rtw_disable_gpio_interrupt); ++ ++#endif /* #ifdef CONFIG_GPIO_API */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/pci_intf.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/pci_intf.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/pci_intf.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/pci_intf.c 2018-02-11 21:44:27.176146528 +0200 +@@ -0,0 +1,1834 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _HCI_INTF_C_ ++ ++#include ++#include ++ ++#include ++ ++#ifndef CONFIG_PCI_HCI ++ ++ #error "CONFIG_PCI_HCI shall be on!\n" ++ ++#endif ++ ++ ++#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) ++ ++ #error "Shall be Linux or Windows, but not both!\n" ++ ++#endif ++ ++#ifdef CONFIG_80211N_HT ++ extern int rtw_ht_enable; ++ extern int rtw_bw_mode; ++ extern int rtw_ampdu_enable;/* for enable tx_ampdu */ ++#endif ++ ++#ifdef CONFIG_GLOBAL_UI_PID ++int ui_pid[3] = {0, 0, 0}; ++#endif ++ ++extern int pm_netdev_open(struct net_device *pnetdev, u8 bnormal); ++int rtw_resume_process(_adapter *padapter); ++ ++#ifdef CONFIG_PM ++ static int rtw_pci_suspend(struct pci_dev *pdev, pm_message_t state); ++ static int rtw_pci_resume(struct pci_dev *pdev); ++#endif ++ ++static int rtw_drv_init(struct pci_dev *pdev, const struct pci_device_id *pdid); ++static void rtw_dev_remove(struct pci_dev *pdev); ++static void rtw_dev_shutdown(struct pci_dev *pdev); ++ ++static struct specific_device_id specific_device_id_tbl[] = { ++ {.idVendor = 0x0b05, .idProduct = 0x1791, .flags = SPEC_DEV_ID_DISABLE_HT}, ++ {.idVendor = 0x13D3, .idProduct = 0x3311, .flags = SPEC_DEV_ID_DISABLE_HT}, ++ {} ++}; ++ ++struct pci_device_id rtw_pci_id_tbl[] = { ++#ifdef CONFIG_RTL8188E ++ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0x8179), .driver_data = RTL8188E}, ++#endif ++#ifdef CONFIG_RTL8812A ++ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0x8812), .driver_data = RTL8812}, ++#endif ++#ifdef CONFIG_RTL8821A ++ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0x8821), .driver_data = RTL8821}, ++#endif ++#ifdef CONFIG_RTL8192E ++ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0x818B), .driver_data = RTL8192E}, ++#endif ++#ifdef CONFIG_RTL8723B ++ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0xb723), .driver_data = RTL8723B}, ++#endif ++#ifdef CONFIG_RTL8723D ++ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0xd723), .driver_data = RTL8723D}, ++#endif ++#ifdef CONFIG_RTL8814A ++ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0x8813), .driver_data = RTL8814A}, ++#endif ++#ifdef CONFIG_RTL8822B ++ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0xB822), .driver_data = RTL8822B}, ++#endif ++ {}, ++}; ++ ++struct pci_drv_priv { ++ struct pci_driver rtw_pci_drv; ++ int drv_registered; ++}; ++ ++ ++static struct pci_drv_priv pci_drvpriv = { ++ .rtw_pci_drv.name = (char *)DRV_NAME, ++ .rtw_pci_drv.probe = rtw_drv_init, ++ .rtw_pci_drv.remove = rtw_dev_remove, ++ .rtw_pci_drv.shutdown = rtw_dev_shutdown, ++ .rtw_pci_drv.id_table = rtw_pci_id_tbl, ++#ifdef CONFIG_PM ++ .rtw_pci_drv.suspend = rtw_pci_suspend, ++ .rtw_pci_drv.resume = rtw_pci_resume, ++#endif ++}; ++ ++ ++MODULE_DEVICE_TABLE(pci, rtw_pci_id_tbl); ++ ++ ++static u16 pcibridge_vendors[PCI_BRIDGE_VENDOR_MAX] = { ++ INTEL_VENDOR_ID, ++ ATI_VENDOR_ID, ++ AMD_VENDOR_ID, ++ SIS_VENDOR_ID ++}; ++ ++#define PCI_PM_CAP_ID 0x01 /* The Capability ID for PME function */ ++void PlatformClearPciPMEStatus(PADAPTER Adapter) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); ++ struct pci_dev *pdev = pdvobjpriv->ppcidev; ++ BOOLEAN PCIClkReq = _FALSE; ++ u8 CapId = 0xff; ++ u8 CapPointer = 0; ++ /* u16 CapHdr; */ ++ RT_PCI_CAPABILITIES_HEADER CapHdr; ++ u8 PMCSReg; ++ int result; ++ ++ /* Get the Capability pointer first, */ ++ /* the Capability Pointer is located at offset 0x34 from the Function Header */ ++ ++ result = pci_read_config_byte(pdev, 0x34, &CapPointer); ++ if (result != 0) ++ RTW_INFO("%s() pci_read_config_byte 0x34 Failed!\n", __FUNCTION__); ++ else { ++ RTW_INFO("PlatformClearPciPMEStatus(): PCI configration 0x34 = 0x%2x\n", CapPointer); ++ do { ++ /* end of pci capability */ ++ if (CapPointer == 0x00) { ++ CapId = 0xff; ++ break; ++ } ++ ++ /* result = pci_read_config_word(pdev, CapPointer, &CapHdr); */ ++ result = pci_read_config_byte(pdev, CapPointer, &CapHdr.CapabilityID); ++ if (result != 0) { ++ RTW_INFO("%s() pci_read_config_byte %x Failed!\n", __FUNCTION__, CapPointer); ++ CapId = 0xff; ++ break; ++ } ++ ++ result = pci_read_config_byte(pdev, CapPointer + 1, &CapHdr.Next); ++ if (result != 0) { ++ RTW_INFO("%s() pci_read_config_byte %x Failed!\n", __FUNCTION__, CapPointer); ++ CapId = 0xff; ++ break; ++ } ++ ++ /* CapId = CapHdr & 0xFF; */ ++ CapId = CapHdr.CapabilityID; ++ ++ RTW_INFO("PlatformClearPciPMEStatus(): in pci configration1, CapPointer%x = %x\n", CapPointer, CapId); ++ ++ if (CapId == PCI_PM_CAP_ID) ++ break; ++ else { ++ /* point to next Capability */ ++ /* CapPointer = (CapHdr >> 8) & 0xFF; */ ++ CapPointer = CapHdr.Next; ++ } ++ } while (_TRUE); ++ ++ if (CapId == PCI_PM_CAP_ID) { ++ /* Get the PM CSR (Control/Status Register), */ ++ /* The PME_Status is located at PM Capatibility offset 5, bit 7 */ ++ result = pci_read_config_byte(pdev, CapPointer + 5, &PMCSReg); ++ if (PMCSReg & BIT7) { ++ /* PME event occured, clear the PM_Status by write 1 */ ++ PMCSReg = PMCSReg | BIT7; ++ ++ pci_write_config_byte(pdev, CapPointer + 5, PMCSReg); ++ PCIClkReq = _TRUE; ++ /* Read it back to check */ ++ pci_read_config_byte(pdev, CapPointer + 5, &PMCSReg); ++ RTW_INFO("PlatformClearPciPMEStatus(): Clear PME status 0x%2x to 0x%2x\n", CapPointer + 5, PMCSReg); ++ } else ++ RTW_INFO("PlatformClearPciPMEStatus(): PME status(0x%2x) = 0x%2x\n", CapPointer + 5, PMCSReg); ++ } else ++ RTW_INFO("PlatformClearPciPMEStatus(): Cannot find PME Capability\n"); ++ } ++ ++ RTW_INFO("PME, value_offset = %x, PME EN = %x\n", CapPointer + 5, PCIClkReq); ++} ++ ++static u8 rtw_pci_platform_switch_device_pci_aspm(_adapter *padapter, u8 value) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct pci_priv *pcipriv = &(pdvobjpriv->pcipriv); ++ BOOLEAN bResult = _FALSE; ++ int Result = 0; ++ int error; ++ ++ Result = pci_write_config_byte(pdvobjpriv->ppcidev, pcipriv->pciehdr_offset + 0x10, value); /* enable I/O space */ ++ RTW_INFO("PlatformSwitchDevicePciASPM(0x%x) = 0x%x\n", pcipriv->pciehdr_offset + 0x10, value); ++ if (Result != 0) { ++ RTW_INFO("PlatformSwitchDevicePciASPM() Failed!\n"); ++ bResult = _FALSE; ++ } else ++ bResult = _TRUE; ++ ++ return bResult; ++} ++ ++/* ++ * When we set 0x01 to enable clk request. Set 0x0 to disable clk req. ++ * */ ++static u8 rtw_pci_switch_clk_req(_adapter *padapter, u8 value) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ u8 buffer, bResult = _FALSE; ++ int error; ++ ++ buffer = value; ++ ++ if (!rtw_is_hw_init_completed(padapter)) ++ return bResult; ++ ++ /* the clock request is located at offset 0x81, suppose the PCIE Capability register is located at offset 0x70 */ ++ /* the correct code should be: search the PCIE capability register first and then the clock request is located offset 0x11 */ ++ error = pci_write_config_byte(pdvobjpriv->ppcidev, 0x81, buffer); ++ if (error != 0) ++ RTW_INFO("rtw_pci_switch_clk_req error (%d)\n", error); ++ else ++ bResult = _TRUE; ++ ++ return bResult; ++} ++ ++/*Disable RTL8192SE ASPM & Disable Pci Bridge ASPM*/ ++void rtw_pci_disable_aspm(_adapter *padapter) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(pdvobjpriv); ++ struct pci_dev *pdev = pdvobjpriv->ppcidev; ++ struct pci_dev *bridge_pdev = pdev->bus->self; ++ struct pci_priv *pcipriv = &(pdvobjpriv->pcipriv); ++ u8 linkctrl_reg; ++ u8 pcibridge_linkctrlreg, aspmlevel = 0; ++ ++ ++ /* We shall check RF Off Level for ASPM function instead of registry settings, revised by Roger, 2013.03.29. */ ++ if (!(pwrpriv->reg_rfps_level & (RT_RF_LPS_LEVEL_ASPM | RT_RF_PS_LEVEL_ALWAYS_ASPM))) ++ return; ++ ++ if (!rtw_is_hw_init_completed(padapter)) ++ return; ++ ++ if (pcipriv->pcibridge_vendor == PCI_BRIDGE_VENDOR_UNKNOWN) { ++ return; ++ } ++ ++ linkctrl_reg = pcipriv->linkctrl_reg; ++ pcibridge_linkctrlreg = pcipriv->pcibridge_linkctrlreg; ++ ++ /* Set corresponding value. */ ++ aspmlevel |= BIT(0) | BIT(1); ++ linkctrl_reg &= ~aspmlevel; ++ pcibridge_linkctrlreg &= ~aspmlevel; ++ ++ /* */ ++ /* 09/08/21 MH From Sd1 suggestion. we need to adjust ASPM enable sequence */ ++ /* CLK_REQ ==> delay 50us ==> Device ==> Host ==> delay 50us */ ++ /* */ ++ ++ if (pwrpriv->reg_rfps_level & RT_RF_OFF_LEVL_CLK_REQ) { ++ RT_CLEAR_PS_LEVEL(pwrpriv, RT_RF_OFF_LEVL_CLK_REQ); ++ rtw_pci_switch_clk_req(padapter, 0x0); ++ } ++ ++ { ++ /*for promising device will in L0 state after an I/O.*/ ++ u8 tmp_u1b; ++ pci_read_config_byte(pdev, (pcipriv->pciehdr_offset + 0x10), &tmp_u1b); ++ } ++ ++ rtw_pci_platform_switch_device_pci_aspm(padapter, linkctrl_reg); ++ ++ rtw_udelay_os(50); ++ ++ /* When there exists anyone's BusNum, DevNum, and FuncNum that are set to 0xff, */ ++ /* we do not execute any action and return. Added by tynli. */ ++ if ((pcipriv->busnumber == 0xff && pcipriv->devnumber == 0xff && pcipriv->funcnumber == 0xff) || ++ (pcipriv->pcibridge_busnum == 0xff && pcipriv->pcibridge_devnum == 0xff && pcipriv->pcibridge_funcnum == 0xff)) { ++ /* Do Nothing!! */ ++ } else { ++ /* 4 */ /* Disable Pci Bridge ASPM */ ++ pci_write_config_byte(bridge_pdev, (pcipriv->pcibridge_pciehdr_offset + 0x10), pcibridge_linkctrlreg); ++ RTW_INFO("PlatformDisableASPM():PciBridge Write reg[%x] = %x\n", ++ (pcipriv->pcibridge_pciehdr_offset + 0x10), pcibridge_linkctrlreg); ++ rtw_udelay_os(50); ++ } ++ ++} ++ ++/*Enable RTL8192SE ASPM & Enable Pci Bridge ASPM for ++power saving We should follow the sequence to enable ++RTL8192SE first then enable Pci Bridge ASPM ++or the system will show bluescreen.*/ ++void rtw_pci_enable_aspm(_adapter *padapter) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(pdvobjpriv); ++ struct pci_dev *pdev = pdvobjpriv->ppcidev; ++ struct pci_dev *bridge_pdev = pdev->bus->self; ++ struct pci_priv *pcipriv = &(pdvobjpriv->pcipriv); ++ u16 aspmlevel = 0; ++ u8 u_pcibridge_aspmsetting = 0; ++ u8 u_device_aspmsetting = 0; ++ u32 u_device_aspmsupportsetting = 0; ++ ++ ++ /* We shall check RF Off Level for ASPM function instead of registry settings, revised by Roger, 2013.03.29. */ ++ if (!(pwrpriv->reg_rfps_level & (RT_RF_LPS_LEVEL_ASPM | RT_RF_PS_LEVEL_ALWAYS_ASPM))) ++ return; ++ ++ /* When there exists anyone's BusNum, DevNum, and FuncNum that are set to 0xff, */ ++ /* we do not execute any action and return. Added by tynli. */ ++ if ((pcipriv->busnumber == 0xff && pcipriv->devnumber == 0xff && pcipriv->funcnumber == 0xff) || ++ (pcipriv->pcibridge_busnum == 0xff && pcipriv->pcibridge_devnum == 0xff && pcipriv->pcibridge_funcnum == 0xff)) { ++ RTW_INFO("rtw_pci_enable_aspm(): Fail to enable ASPM. Cannot find the Bus of PCI(Bridge).\n"); ++ return; ++ } ++ ++ /* Get Bridge ASPM Support ++ * not to enable bridge aspm if bridge does not support ++ * Added by sherry 20100803 */ ++ { ++ /* Get the Link Capability, it ls located at offset 0x0c from the PCIE Capability */ ++ pci_read_config_dword(bridge_pdev, (pcipriv->pcibridge_pciehdr_offset + 0x0C), &u_device_aspmsupportsetting); ++ ++ RTW_INFO("rtw_pci_enable_aspm(): Bridge ASPM support %x\n", u_device_aspmsupportsetting); ++ if (((u_device_aspmsupportsetting & BIT(11)) != BIT(11)) || ((u_device_aspmsupportsetting & BIT(10)) != BIT(10))) { ++ if (pdvobjpriv->const_devicepci_aspm_setting == 3) { ++ RTW_INFO("rtw_pci_enable_aspm(): Bridge not support L0S or L1\n"); ++ return; ++ } else if (pdvobjpriv->const_devicepci_aspm_setting == 2) { ++ if ((u_device_aspmsupportsetting & BIT(11)) != BIT(11)) { ++ RTW_INFO("rtw_pci_enable_aspm(): Bridge not support L1\n"); ++ return; ++ } ++ } else if (pdvobjpriv->const_devicepci_aspm_setting == 1) { ++ if ((u_device_aspmsupportsetting & BIT(10)) != BIT(10)) { ++ RTW_INFO("rtw_pci_enable_aspm(): Bridge not support L0s\n"); ++ return; ++ } ++ ++ } ++ } else ++ RTW_INFO("rtw_pci_enable_aspm(): Bridge support L0s and L1\n"); ++ } ++ ++ /* ++ * Skip following settings if ASPM has already enabled, added by Roger, 2013.03.15. ++ * */ ++ if ((pcipriv->pcibridge_linkctrlreg & (BIT0 | BIT1)) && ++ (pcipriv->linkctrl_reg & (BIT0 | BIT1))) { ++ /* BIT0: L0S, BIT1:L1 */ ++ ++ RTW_INFO("PlatformEnableASPM(): ASPM is already enabled, skip incoming settings!!\n"); ++ return; ++ } ++ ++ /* 4 Enable Pci Bridge ASPM */ ++ /* Write PCI bridge PCIE-capability Link Control Register */ ++ /* Justin: Can we change the ASPM Control register ? */ ++ /* The system BIOS should set this register with a correct value */ ++ /* If we change the force enable the ASPM L1/L0s, this may cause the system hang */ ++ u_pcibridge_aspmsetting = pcipriv->pcibridge_linkctrlreg; ++ u_pcibridge_aspmsetting |= pdvobjpriv->const_hostpci_aspm_setting; ++ ++ if (pcipriv->pcibridge_vendor == PCI_BRIDGE_VENDOR_INTEL || ++ pcipriv->pcibridge_vendor == PCI_BRIDGE_VENDOR_SIS) ++ u_pcibridge_aspmsetting &= ~BIT(0); /* for intel host 42 device 43 */ ++ ++ pci_write_config_byte(bridge_pdev, (pcipriv->pcibridge_pciehdr_offset + 0x10), u_pcibridge_aspmsetting); ++ RTW_INFO("PlatformEnableASPM():PciBridge Write reg[%x] = %x\n", ++ (pcipriv->pcibridge_pciehdr_offset + 0x10), ++ u_pcibridge_aspmsetting); ++ ++ rtw_udelay_os(50); ++ ++ /*Get ASPM level (with/without Clock Req)*/ ++ aspmlevel |= pdvobjpriv->const_devicepci_aspm_setting; ++ u_device_aspmsetting = pcipriv->linkctrl_reg; ++ u_device_aspmsetting |= aspmlevel; /* device 43 */ ++ ++ rtw_pci_platform_switch_device_pci_aspm(padapter, u_device_aspmsetting); ++ ++ if (pwrpriv->reg_rfps_level & RT_RF_OFF_LEVL_CLK_REQ) { ++ rtw_pci_switch_clk_req(padapter, (pwrpriv->reg_rfps_level & RT_RF_OFF_LEVL_CLK_REQ) ? 1 : 0); ++ RT_SET_PS_LEVEL(pwrpriv, RT_RF_OFF_LEVL_CLK_REQ); ++ } ++ ++ rtw_udelay_os(50); ++} ++ ++static u8 rtw_pci_get_amd_l1_patch(struct dvobj_priv *pdvobjpriv, struct pci_dev *pdev) ++{ ++ u8 status = _FALSE; ++ u8 offset_e0; ++ u32 offset_e4; ++ ++ pci_write_config_byte(pdev, 0xE0, 0xA0); ++ pci_read_config_byte(pdev, 0xE0, &offset_e0); ++ ++ if (offset_e0 == 0xA0) { ++ pci_read_config_dword(pdev, 0xE4, &offset_e4); ++ if (offset_e4 & BIT(23)) ++ status = _TRUE; ++ } ++ ++ return status; ++} ++ ++static s32 rtw_pci_get_linkcontrol_reg(struct pci_dev *pdev, u8 *LinkCtrlReg, u8 *HdrOffset) ++{ ++ u8 CapabilityPointer; ++ RT_PCI_CAPABILITIES_HEADER CapabilityHdr; ++ s32 status = _FAIL; ++ ++ /* get CapabilityOffset */ ++ pci_read_config_byte(pdev, 0x34, &CapabilityPointer); /* the capability pointer is located offset 0x34 */ ++ ++ /* Loop through the capabilities in search of the power management capability. */ ++ /* The list is NULL-terminated, so the last offset will always be zero. */ ++ ++ while (CapabilityPointer != 0) { ++ /* Read the header of the capability at this offset. If the retrieved capability is not */ ++ /* the power management capability that we are looking for, follow the link to the */ ++ /* next capability and continue looping. */ ++ ++ /* 4 get CapabilityHdr */ ++ /* pci_read_config_word(pdev, CapabilityPointer, (u16 *)&CapabilityHdr); */ ++ pci_read_config_byte(pdev, CapabilityPointer, (u8 *)&CapabilityHdr.CapabilityID); ++ pci_read_config_byte(pdev, CapabilityPointer + 1, (u8 *)&CapabilityHdr.Next); ++ ++ /* Found the PCI express capability */ ++ if (CapabilityHdr.CapabilityID == PCI_CAPABILITY_ID_PCI_EXPRESS) ++ break; ++ else { ++ /* This is some other capability. Keep looking for the PCI express capability. */ ++ CapabilityPointer = CapabilityHdr.Next; ++ } ++ } ++ ++ /* Get the Link Control Register, it located at offset 0x10 from the Capability Header */ ++ if (CapabilityHdr.CapabilityID == PCI_CAPABILITY_ID_PCI_EXPRESS) { ++ *HdrOffset = CapabilityPointer; ++ pci_read_config_byte(pdev, CapabilityPointer + 0x10, LinkCtrlReg); ++ ++ status = _SUCCESS; ++ } else { ++ /* We didn't find a PCIe capability. */ ++ RTW_INFO("GetPciLinkCtrlReg(): Cannot Find PCIe Capability\n"); ++ } ++ ++ return status; ++} ++ ++static s32 rtw_set_pci_cache_line_size(struct pci_dev *pdev, u8 CacheLineSizeToSet) ++{ ++ u8 ucPciCacheLineSize; ++ s32 Result; ++ ++ /* ucPciCacheLineSize = pPciConfig->CacheLineSize; */ ++ pci_read_config_byte(pdev, PCI_CACHE_LINE_SIZE, &ucPciCacheLineSize); ++ ++ if (ucPciCacheLineSize < 8 || ucPciCacheLineSize > 16) { ++ RTW_INFO("Driver Sets default Cache Line Size...\n"); ++ ++ ucPciCacheLineSize = CacheLineSizeToSet; ++ ++ Result = pci_write_config_byte(pdev, PCI_CACHE_LINE_SIZE, ucPciCacheLineSize); ++ ++ if (Result != 0) { ++ RTW_INFO("pci_write_config_byte (CacheLineSize) Result=%d\n", Result); ++ goto _SET_CACHELINE_SIZE_FAIL; ++ } ++ ++ Result = pci_read_config_byte(pdev, PCI_CACHE_LINE_SIZE, &ucPciCacheLineSize); ++ if (Result != 0) { ++ RTW_INFO("pci_read_config_byte (PciCacheLineSize) Result=%d\n", Result); ++ goto _SET_CACHELINE_SIZE_FAIL; ++ } ++ ++ if ((ucPciCacheLineSize != CacheLineSizeToSet)) { ++ RTW_INFO("Failed to set Cache Line Size to 0x%x! ucPciCacheLineSize=%x\n", CacheLineSizeToSet, ucPciCacheLineSize); ++ goto _SET_CACHELINE_SIZE_FAIL; ++ } ++ } ++ ++ return _SUCCESS; ++ ++_SET_CACHELINE_SIZE_FAIL: ++ ++ return _FAIL; ++} ++ ++ ++#define PCI_CMD_ENABLE_BUS_MASTER BIT(2) ++#define PCI_CMD_DISABLE_INTERRUPT BIT(10) ++#define CMD_BUS_MASTER BIT(2) ++ ++static s32 rtw_pci_parse_configuration(struct pci_dev *pdev, struct dvobj_priv *pdvobjpriv) ++{ ++ struct pci_priv *pcipriv = &(pdvobjpriv->pcipriv); ++ /* PPCI_COMMON_CONFIG pPciConfig = (PPCI_COMMON_CONFIG) pucBuffer; */ ++ /* u16 usPciCommand = pPciConfig->Command; */ ++ u16 usPciCommand = 0; ++ int Result, ret; ++ u8 CapabilityOffset; ++ RT_PCI_CAPABILITIES_HEADER CapabilityHdr; ++ u8 PCIeCap; ++ u8 LinkCtrlReg; ++ u8 ClkReqReg; ++ ++ /* RTW_INFO("%s==>\n", __FUNCTION__); */ ++ ++ pci_read_config_word(pdev, PCI_COMMAND, &usPciCommand); ++ ++ do { ++ /* 3 Enable bus matering if it isn't enabled by the BIOS */ ++ if (!(usPciCommand & PCI_CMD_ENABLE_BUS_MASTER)) { ++ RTW_INFO("Bus master is not enabled by BIOS! usPciCommand=%x\n", usPciCommand); ++ ++ usPciCommand |= CMD_BUS_MASTER; ++ ++ Result = pci_write_config_word(pdev, PCI_COMMAND, usPciCommand); ++ if (Result != 0) { ++ RTW_INFO("pci_write_config_word (Command) Result=%d\n", Result); ++ ret = _FAIL; ++ break; ++ } ++ ++ Result = pci_read_config_word(pdev, PCI_COMMAND, &usPciCommand); ++ if (Result != 0) { ++ RTW_INFO("pci_read_config_word (Command) Result=%d\n", Result); ++ ret = _FAIL; ++ break; ++ } ++ ++ if (!(usPciCommand & PCI_CMD_ENABLE_BUS_MASTER)) { ++ RTW_INFO("Failed to enable bus master! usPciCommand=%x\n", usPciCommand); ++ ret = _FAIL; ++ break; ++ } ++ } ++ RTW_INFO("Bus master is enabled. usPciCommand=%x\n", usPciCommand); ++ ++ /* 3 Enable interrupt */ ++ if ((usPciCommand & PCI_CMD_DISABLE_INTERRUPT)) { ++ RTW_INFO("INTDIS==1 usPciCommand=%x\n", usPciCommand); ++ ++ usPciCommand &= (~PCI_CMD_DISABLE_INTERRUPT); ++ ++ Result = pci_write_config_word(pdev, PCI_COMMAND, usPciCommand); ++ if (Result != 0) { ++ RTW_INFO("pci_write_config_word (Command) Result=%d\n", Result); ++ ret = _FAIL; ++ break; ++ } ++ ++ Result = pci_read_config_word(pdev, PCI_COMMAND, &usPciCommand); ++ if (Result != 0) { ++ RTW_INFO("pci_read_config_word (Command) Result=%d\n", Result); ++ ret = _FAIL; ++ break; ++ } ++ ++ if ((usPciCommand & PCI_CMD_DISABLE_INTERRUPT)) { ++ RTW_INFO("Failed to set INTDIS to 0! usPciCommand=%x\n", usPciCommand); ++ ret = _FAIL; ++ break; ++ } ++ } ++ ++ /* */ ++ /* Description: Find PCI express capability offset. Porting from 818xB by tynli 2008.12.19 */ ++ /* */ ++ /* ------------------------------------------------------------- */ ++ ++ /* 3 PCIeCap */ ++ /* The device supports capability lists. Find the capabilities. */ ++ ++ /* CapabilityOffset = pPciConfig->u.type0.CapabilitiesPtr; */ ++ pci_read_config_byte(pdev, PCI_CAPABILITY_LIST, &CapabilityOffset); ++ ++ /* Loop through the capabilities in search of the power management capability. */ ++ /* The list is NULL-terminated, so the last offset will always be zero. */ ++ ++ while (CapabilityOffset != 0) { ++ /* Read the header of the capability at this offset. If the retrieved capability is not */ ++ /* the power management capability that we are looking for, follow the link to the */ ++ /* next capability and continue looping. */ ++ ++ /* Result = pci_read_config_word(pdev, CapabilityOffset, (u16 *)&CapabilityHdr); */ ++ Result = pci_read_config_byte(pdev, CapabilityOffset, (u8 *)&CapabilityHdr.CapabilityID); ++ if (Result != 0) ++ break; ++ ++ Result = pci_read_config_byte(pdev, CapabilityOffset + 1, (u8 *)&CapabilityHdr.Next); ++ if (Result != 0) ++ break; ++ ++ /* Found the PCI express capability */ ++ if (CapabilityHdr.CapabilityID == PCI_CAPABILITY_ID_PCI_EXPRESS) ++ break; ++ else { ++ /* This is some other capability. Keep looking for the PCI express capability. */ ++ CapabilityOffset = CapabilityHdr.Next; ++ } ++ } ++ ++ if (Result != 0) { ++ RTW_INFO("pci_read_config_word (RT_PCI_CAPABILITIES_HEADER) Result=%d\n", Result); ++ break; ++ } ++ ++ if (CapabilityHdr.CapabilityID == PCI_CAPABILITY_ID_PCI_EXPRESS) { ++ pcipriv->pciehdr_offset = CapabilityOffset; ++ RTW_INFO("PCIe Header Offset =%x\n", CapabilityOffset); ++ ++ /* Skip past the capabilities header and read the PCI express capability */ ++ /* Justin: The PCI-e capability size should be 2 bytes, why we just get 1 byte */ ++ /* Beside, this PCIeCap seems no one reference it in the driver code */ ++ Result = pci_read_config_byte(pdev, CapabilityOffset + 2, &PCIeCap); ++ ++ if (Result != 0) { ++ RTW_INFO("pci_read_config_byte (PCIE Capability) Result=%d\n", Result); ++ break; ++ } ++ ++ pcipriv->pcie_cap = PCIeCap; ++ RTW_INFO("PCIe Capability =%x\n", PCIeCap); ++ ++ /* 3 Link Control Register */ ++ /* Read "Link Control Register" Field (80h ~81h) */ ++ Result = pci_read_config_byte(pdev, CapabilityOffset + 0x10, &LinkCtrlReg); ++ if (Result != 0) { ++ RTW_INFO("pci_read_config_byte (Link Control Register) Result=%d\n", Result); ++ break; ++ } ++ ++ pcipriv->linkctrl_reg = LinkCtrlReg; ++ RTW_INFO("Link Control Register =%x\n", LinkCtrlReg); ++ ++ /* 3 Get Capability of PCI Clock Request */ ++ /* The clock request setting is located at 0x81[0] */ ++ Result = pci_read_config_byte(pdev, CapabilityOffset + 0x11, &ClkReqReg); ++ if (Result != 0) { ++ pcipriv->pci_clk_req = _FALSE; ++ RTW_INFO("pci_read_config_byte (Clock Request Register) Result=%d\n", Result); ++ break; ++ } ++ if (ClkReqReg & BIT(0)) ++ pcipriv->pci_clk_req = _TRUE; ++ else ++ pcipriv->pci_clk_req = _FALSE; ++ RTW_INFO("Clock Request =%x\n", pcipriv->pci_clk_req); ++ } else { ++ /* We didn't find a PCIe capability. */ ++ RTW_INFO("Didn't Find PCIe Capability\n"); ++ break; ++ } ++ ++ /* 3 Fill Cacheline */ ++ ret = rtw_set_pci_cache_line_size(pdev, 8); ++ if (ret != _SUCCESS) { ++ RTW_INFO("rtw_set_pci_cache_line_size fail\n"); ++ break; ++ } ++ ++ /* Include 92C suggested by SD1. Added by tynli. 2009.11.25. ++ * Enable the Backdoor */ ++ { ++ u8 tmp; ++ ++ Result = pci_read_config_byte(pdev, 0x98, &tmp); ++ ++ tmp |= BIT4; ++ ++ Result = pci_write_config_byte(pdev, 0x98, tmp); ++ ++ } ++ ret = _SUCCESS; ++ } while (_FALSE); ++ ++ return ret; ++} ++ ++/* ++ * Update PCI dependent default settings. ++ * */ ++static void rtw_pci_update_default_setting(_adapter *padapter) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct pci_priv *pcipriv = &(pdvobjpriv->pcipriv); ++ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(pdvobjpriv); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ /* reset pPSC->reg_rfps_level & priv->b_support_aspm */ ++ pwrpriv->reg_rfps_level = 0; ++ ++ /* Update PCI ASPM setting */ ++ /* pwrpriv->const_amdpci_aspm = pdvobjpriv->const_amdpci_aspm; */ ++ switch (pdvobjpriv->const_pci_aspm) { ++ case 0: /* No ASPM */ ++ break; ++ ++ case 1: /* ASPM dynamically enabled/disable. */ ++ pwrpriv->reg_rfps_level |= RT_RF_LPS_LEVEL_ASPM; ++ break; ++ ++ case 2: /* ASPM with Clock Req dynamically enabled/disable. */ ++ pwrpriv->reg_rfps_level |= (RT_RF_LPS_LEVEL_ASPM | RT_RF_OFF_LEVL_CLK_REQ); ++ break; ++ ++ case 3: /* Always enable ASPM and Clock Req from initialization to halt. */ ++ pwrpriv->reg_rfps_level &= ~(RT_RF_LPS_LEVEL_ASPM); ++ pwrpriv->reg_rfps_level |= (RT_RF_PS_LEVEL_ALWAYS_ASPM | RT_RF_OFF_LEVL_CLK_REQ); ++ break; ++ ++ case 4: /* Always enable ASPM without Clock Req from initialization to halt. */ ++ pwrpriv->reg_rfps_level &= ~(RT_RF_LPS_LEVEL_ASPM | RT_RF_OFF_LEVL_CLK_REQ); ++ pwrpriv->reg_rfps_level |= RT_RF_PS_LEVEL_ALWAYS_ASPM; ++ break; ++ ++ case 5: /* Linux do not support ASPM OSC, added by Roger, 2013.03.27. */ ++ break; ++ } ++ ++ pwrpriv->reg_rfps_level |= RT_RF_OFF_LEVL_HALT_NIC; ++ ++ /* Update Radio OFF setting */ ++ switch (pdvobjpriv->const_hwsw_rfoff_d3) { ++ case 1: ++ if (pwrpriv->reg_rfps_level & RT_RF_LPS_LEVEL_ASPM) ++ pwrpriv->reg_rfps_level |= RT_RF_OFF_LEVL_ASPM; ++ break; ++ ++ case 2: ++ if (pwrpriv->reg_rfps_level & RT_RF_LPS_LEVEL_ASPM) ++ pwrpriv->reg_rfps_level |= RT_RF_OFF_LEVL_ASPM; ++ pwrpriv->reg_rfps_level |= RT_RF_OFF_LEVL_HALT_NIC; ++ break; ++ ++ case 3: ++ pwrpriv->reg_rfps_level |= RT_RF_OFF_LEVL_PCI_D3; ++ break; ++ } ++ ++ /* Update Rx 2R setting */ ++ /* pPSC->reg_rfps_level |= ((pDevice->RegLPS2RDisable) ? RT_RF_LPS_DISALBE_2R : 0); */ ++ ++ /* */ ++ /* Set HW definition to determine if it supports ASPM. */ ++ /* */ ++ switch (pdvobjpriv->const_support_pciaspm) { ++ case 1: { /* Support ASPM. */ ++ u8 b_support_backdoor = _TRUE; ++ u8 b_support_l1_on_amd = _FALSE; ++ ++ rtw_hal_get_def_var(padapter, HAL_DEF_PCI_AMD_L1_SUPPORT, &b_support_l1_on_amd); ++ ++ if (pHalData->CustomerID == RT_CID_TOSHIBA && ++ pcipriv->pcibridge_vendor == PCI_BRIDGE_VENDOR_AMD && ++ !pcipriv->amd_l1_patch && !b_support_l1_on_amd) { ++ RTW_INFO("%s(): Disable L1 Backdoor!!\n", __FUNCTION__); ++ b_support_backdoor = _FALSE; ++ } ++ rtw_hal_set_def_var(padapter, HAL_DEF_PCI_SUUPORT_L1_BACKDOOR, &b_support_backdoor); ++ } ++ break; ++ ++ default: ++ /* Do nothing. Set when finding the chipset. */ ++ break; ++ } ++} ++ ++static void rtw_pci_initialize_adapter_common(_adapter *padapter) ++{ ++ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ ++ rtw_pci_update_default_setting(padapter); ++ ++ if (pwrpriv->reg_rfps_level & RT_RF_PS_LEVEL_ALWAYS_ASPM) { ++ /* Always enable ASPM & Clock Req. */ ++ rtw_pci_enable_aspm(padapter); ++ RT_SET_PS_LEVEL(pwrpriv, RT_RF_PS_LEVEL_ALWAYS_ASPM); ++ } ++ ++} ++ ++/* ++ * 2009/10/28 MH Enable rtl8192ce DMA64 function. We need to enable 0x719 BIT5 ++ * */ ++#ifdef CONFIG_64BIT_DMA ++u8 PlatformEnableDMA64(PADAPTER Adapter) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); ++ struct pci_dev *pdev = pdvobjpriv->ppcidev; ++ u8 bResult = _TRUE; ++ u8 value; ++ ++ pci_read_config_byte(pdev, 0x719, &value); ++ ++ /* 0x719 Bit5 is DMA64 bit fetch. */ ++ value |= (BIT5); ++ ++ pci_write_config_byte(pdev, 0x719, value); ++ ++ return bResult; ++} ++#endif ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 5, 0)) || (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 18)) ++ #define rtw_pci_interrupt(x, y, z) rtw_pci_interrupt(x, y) ++#endif ++ ++static irqreturn_t rtw_pci_interrupt(int irq, void *priv, struct pt_regs *regs) ++{ ++ struct dvobj_priv *dvobj = (struct dvobj_priv *)priv; ++ _adapter *adapter = dvobj->padapters[IFACE_ID0]; ++ ++ if (dvobj->irq_enabled == 0) ++ return IRQ_HANDLED; ++ ++ if (rtw_hal_interrupt_handler(adapter) == _FAIL) ++ return IRQ_HANDLED; ++ /* return IRQ_NONE; */ ++ ++ return IRQ_HANDLED; ++} ++ ++#ifdef RTK_DMP_PLATFORM ++ #define pci_iounmap(x, y) iounmap(y) ++#endif ++ ++int pci_alloc_irq(struct dvobj_priv *dvobj) ++{ ++ int err; ++ struct pci_dev *pdev = dvobj->ppcidev; ++ int ret; ++ ++ ret = pci_enable_msi(pdev); ++ ++ RTW_INFO("pci_enable_msi ret=%d\n", ret); ++ ++#if defined(IRQF_SHARED) ++ err = request_irq(pdev->irq, &rtw_pci_interrupt, IRQF_SHARED, DRV_NAME, dvobj); ++#else ++ err = request_irq(pdev->irq, &rtw_pci_interrupt, SA_SHIRQ, DRV_NAME, dvobj); ++#endif ++ if (err) ++ RTW_INFO("Error allocating IRQ %d", pdev->irq); ++ else { ++ dvobj->irq_alloc = 1; ++ dvobj->irq = pdev->irq; ++ RTW_INFO("Request_irq OK, IRQ %d\n", pdev->irq); ++ } ++ ++ return err ? _FAIL : _SUCCESS; ++} ++ ++static void rtw_decide_chip_type_by_pci_driver_data(struct dvobj_priv *pdvobj, const struct pci_device_id *pdid) ++{ ++ pdvobj->chip_type = pdid->driver_data; ++ ++#ifdef CONFIG_RTL8188E ++ if (pdvobj->chip_type == RTL8188E) { ++ pdvobj->HardwareType = HARDWARE_TYPE_RTL8188EE; ++ RTW_INFO("CHIP TYPE: RTL8188E\n"); ++ } ++#endif ++ ++#ifdef CONFIG_RTL8812A ++ if (pdvobj->chip_type == RTL8812) { ++ pdvobj->HardwareType = HARDWARE_TYPE_RTL8812E; ++ RTW_INFO("CHIP TYPE: RTL8812AE\n"); ++ } ++#endif ++ ++#ifdef CONFIG_RTL8821A ++ if (pdvobj->chip_type == RTL8821) { ++ pdvobj->HardwareType = HARDWARE_TYPE_RTL8821E; ++ RTW_INFO("CHIP TYPE: RTL8821AE\n"); ++ } ++#endif ++ ++#ifdef CONFIG_RTL8723B ++ if (pdvobj->chip_type == RTL8723B) { ++ pdvobj->HardwareType = HARDWARE_TYPE_RTL8723BE; ++ RTW_INFO("CHIP TYPE: RTL8723BE\n"); ++ } ++#endif ++#ifdef CONFIG_RTL8723D ++ if (pdvobj->chip_type == RTL8723D) { ++ pdvobj->HardwareType = HARDWARE_TYPE_RTL8723DE; ++ RTW_INFO("CHIP TYPE: RTL8723DE\n"); ++ } ++#endif ++#ifdef CONFIG_RTL8192E ++ if (pdvobj->chip_type == RTL8192E) { ++ pdvobj->HardwareType = HARDWARE_TYPE_RTL8192EE; ++ RTW_INFO("CHIP TYPE: RTL8192EE\n"); ++ } ++#endif ++ ++#ifdef CONFIG_RTL8814A ++ if (pdvobj->chip_type == RTL8814A) { ++ pdvobj->HardwareType = HARDWARE_TYPE_RTL8814AE; ++ RTW_INFO("CHIP TYPE: RTL8814AE\n"); ++ } ++#endif ++ ++#if defined(CONFIG_RTL8822B) ++ if (pdvobj->chip_type == RTL8822B) { ++ pdvobj->HardwareType = HARDWARE_TYPE_RTL8822BE; ++ RTW_INFO("CHIP TYPE: RTL8822BE\n"); ++ } ++#endif ++} ++ ++static struct dvobj_priv *pci_dvobj_init(struct pci_dev *pdev, const struct pci_device_id *pdid) ++{ ++ int err; ++ u32 status = _FAIL; ++ struct dvobj_priv *dvobj = NULL; ++ struct pci_priv *pcipriv = NULL; ++ struct pci_dev *bridge_pdev = pdev->bus->self; ++ /* u32 pci_cfg_space[16]; */ ++ unsigned long pmem_start, pmem_len, pmem_flags; ++ u8 tmp; ++ u8 PciBgVIdIdx; ++ int i; ++ ++ ++ dvobj = devobj_init(); ++ if (dvobj == NULL) ++ goto exit; ++ ++ ++ dvobj->ppcidev = pdev; ++ pcipriv = &(dvobj->pcipriv); ++ pci_set_drvdata(pdev, dvobj); ++ ++ ++ err = pci_enable_device(pdev); ++ if (err != 0) { ++ RTW_ERR("%s : Cannot enable new PCI device\n", pci_name(pdev)); ++ goto free_dvobj; ++ } ++ ++#ifdef CONFIG_64BIT_DMA ++ if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64))) { ++ RTW_INFO("RTL819xCE: Using 64bit DMA\n"); ++ err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); ++ if (err != 0) { ++ RTW_ERR("Unable to obtain 64bit DMA for consistent allocations\n"); ++ goto disable_picdev; ++ } ++ dvobj->bdma64 = _TRUE; ++ } else ++#endif ++ { ++ if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32))) { ++ err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)); ++ if (err != 0) { ++ RTW_ERR("Unable to obtain 32bit DMA for consistent allocations\n"); ++ goto disable_picdev; ++ } ++ } ++ } ++ ++ pci_set_master(pdev); ++ ++ err = pci_request_regions(pdev, DRV_NAME); ++ if (err != 0) { ++ RTW_ERR("Can't obtain PCI resources\n"); ++ goto disable_picdev; ++ } ++ ++#ifdef RTK_129X_PLATFORM ++ if (pdev->bus->number == 0x00) { ++ pmem_start = PCIE_SLOT1_MEM_START; ++ pmem_len = PCIE_SLOT1_MEM_LEN; ++ pmem_flags = 0; ++ RTW_PRINT("RTD129X: PCIE SLOT1\n"); ++ } else if (pdev->bus->number == 0x01) { ++ pmem_start = PCIE_SLOT2_MEM_START; ++ pmem_len = PCIE_SLOT2_MEM_LEN; ++ pmem_flags = 0; ++ RTW_PRINT("RTD129X: PCIE SLOT2\n"); ++ } else { ++ RTW_ERR(KERN_ERR "RTD129X: Wrong Slot Num\n"); ++ goto release_regions; ++ } ++#else ++ /* Search for memory map resource (index 0~5) */ ++ for (i = 0 ; i < 6 ; i++) { ++ pmem_start = pci_resource_start(pdev, i); ++ pmem_len = pci_resource_len(pdev, i); ++ pmem_flags = pci_resource_flags(pdev, i); ++ ++ if (pmem_flags & IORESOURCE_MEM) ++ break; ++ } ++ ++ if (i == 6) { ++ RTW_ERR("%s: No MMIO resource found, abort!\n", __func__); ++ goto release_regions; ++ } ++#endif /* RTK_DMP_PLATFORM */ ++ ++#ifdef RTK_DMP_PLATFORM ++ dvobj->pci_mem_start = (unsigned long)ioremap_nocache(pmem_start, pmem_len); ++#elif defined(RTK_129X_PLATFORM) ++ if (pdev->bus->number == 0x00) ++ dvobj->mask_addr = ++ (unsigned long)ioremap(PCIE_SLOT1_MASK, 0x100); ++ else if (pdev->bus->number == 0x01) ++ dvobj->mask_addr = ++ (unsigned long)ioremap(PCIE_SLOT2_MASK, 0x100); ++ ++ if (dvobj->mask_addr == 0) { ++ RTW_ERR("Can't map TRAN/MASK mem\n"); ++ goto release_regions; ++ } ++ ++ dvobj->tran_addr = dvobj->mask_addr + PCIE_TRANSLATE_OFFSET; ++ ++ dvobj->pci_mem_start = ++ (unsigned long)ioremap_nocache(pmem_start, pmem_len); ++#else ++ /* shared mem start */ ++ dvobj->pci_mem_start = (unsigned long)pci_iomap(pdev, i, pmem_len); ++#endif ++ if (dvobj->pci_mem_start == 0) { ++ RTW_ERR("Can't map PCI mem\n"); ++ goto release_regions; ++ } ++ ++ RTW_INFO("Memory mapped space start: 0x%08lx len:%08lx flags:%08lx, after map:0x%08lx\n", ++ pmem_start, pmem_len, pmem_flags, dvobj->pci_mem_start); ++ ++ /*find bus info*/ ++ pcipriv->busnumber = pdev->bus->number; ++ pcipriv->devnumber = PCI_SLOT(pdev->devfn); ++ pcipriv->funcnumber = PCI_FUNC(pdev->devfn); ++ ++ /*find bridge info*/ ++ if (bridge_pdev) { ++ pcipriv->pcibridge_busnum = bridge_pdev->bus->number; ++ pcipriv->pcibridge_devnum = PCI_SLOT(bridge_pdev->devfn); ++ pcipriv->pcibridge_funcnum = PCI_FUNC(bridge_pdev->devfn); ++ pcipriv->pcibridge_vendor = PCI_BRIDGE_VENDOR_UNKNOWN; ++ pcipriv->pcibridge_vendorid = bridge_pdev->vendor; ++ pcipriv->pcibridge_deviceid = bridge_pdev->device; ++ } ++ ++#if 0 ++ /* Read PCI configuration Space Header */ ++ for (i = 0; i < 16; i++) ++ pci_read_config_dword(pdev, (i << 2), &pci_cfg_space[i]); ++#endif ++ ++ /*step 1-1., decide the chip_type via device info*/ ++ dvobj->interface_type = RTW_PCIE; ++ rtw_decide_chip_type_by_pci_driver_data(dvobj, pdid); ++ ++ ++ /* rtw_pci_parse_configuration(pdev, dvobj, (u8 *)&pci_cfg_space); */ ++ rtw_pci_parse_configuration(pdev, dvobj); ++ ++ for (PciBgVIdIdx = 0; PciBgVIdIdx < PCI_BRIDGE_VENDOR_MAX; PciBgVIdIdx++) { ++ if (pcipriv->pcibridge_vendorid == pcibridge_vendors[PciBgVIdIdx]) { ++ pcipriv->pcibridge_vendor = PciBgVIdIdx; ++ RTW_INFO("Pci Bridge Vendor is found: VID=0x%x, VendorIdx=%d\n", pcipriv->pcibridge_vendorid, PciBgVIdIdx); ++ break; ++ } ++ } ++ ++ if (pcipriv->pcibridge_vendor != PCI_BRIDGE_VENDOR_UNKNOWN) { ++ rtw_pci_get_linkcontrol_reg(bridge_pdev, &pcipriv->pcibridge_linkctrlreg, &pcipriv->pcibridge_pciehdr_offset); ++ ++ if (pcipriv->pcibridge_vendor == PCI_BRIDGE_VENDOR_AMD) ++ pcipriv->amd_l1_patch = rtw_pci_get_amd_l1_patch(dvobj, bridge_pdev); ++ } ++ ++ status = _SUCCESS; ++ ++iounmap: ++ if (status != _SUCCESS && dvobj->pci_mem_start != 0) { ++#if 1/* def RTK_DMP_PLATFORM */ ++ pci_iounmap(pdev, (void *)dvobj->pci_mem_start); ++#endif ++ dvobj->pci_mem_start = 0; ++ } ++ ++#ifdef RTK_129X_PLATFORM ++ if (status != _SUCCESS && dvobj->mask_addr != 0) { ++ pci_iounmap(pdev, (void *)dvobj->mask_addr); ++ dvobj->mask_addr = 0; ++ } ++#endif ++ ++release_regions: ++ if (status != _SUCCESS) ++ pci_release_regions(pdev); ++disable_picdev: ++ if (status != _SUCCESS) ++ pci_disable_device(pdev); ++free_dvobj: ++ if (status != _SUCCESS && dvobj) { ++ pci_set_drvdata(pdev, NULL); ++ devobj_deinit(dvobj); ++ dvobj = NULL; ++ } ++exit: ++ return dvobj; ++} ++ ++ ++static void pci_dvobj_deinit(struct pci_dev *pdev) ++{ ++ struct dvobj_priv *dvobj = pci_get_drvdata(pdev); ++ ++ pci_set_drvdata(pdev, NULL); ++ if (dvobj) { ++ if (dvobj->irq_alloc) { ++ free_irq(pdev->irq, dvobj); ++ pci_disable_msi(pdev); ++ dvobj->irq_alloc = 0; ++ } ++ ++ if (dvobj->pci_mem_start != 0) { ++#if 1/* def RTK_DMP_PLATFORM */ ++ pci_iounmap(pdev, (void *)dvobj->pci_mem_start); ++#endif ++ dvobj->pci_mem_start = 0; ++ } ++ ++#ifdef RTK_129X_PLATFORM ++ if (dvobj->mask_addr != 0) { ++ pci_iounmap(pdev, (void *)dvobj->mask_addr); ++ dvobj->mask_addr = 0; ++ } ++#endif ++ devobj_deinit(dvobj); ++ } ++ ++ pci_release_regions(pdev); ++ pci_disable_device(pdev); ++ ++} ++ ++ ++u8 rtw_set_hal_ops(_adapter *padapter) ++{ ++ /* alloc memory for HAL DATA */ ++ if (rtw_hal_data_init(padapter) == _FAIL) ++ return _FAIL; ++ ++#ifdef CONFIG_RTL8188E ++ if (rtw_get_chip_type(padapter) == RTL8188E) ++ rtl8188ee_set_hal_ops(padapter); ++#endif ++ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ++ if ((rtw_get_chip_type(padapter) == RTL8812) || (rtw_get_chip_type(padapter) == RTL8821)) ++ rtl8812ae_set_hal_ops(padapter); ++#endif ++ ++#ifdef CONFIG_RTL8723B ++ if (rtw_get_chip_type(padapter) == RTL8723B) ++ rtl8723be_set_hal_ops(padapter); ++#endif ++ ++#ifdef CONFIG_RTL8723D ++ if (rtw_get_chip_type(padapter) == RTL8723D) ++ rtl8723de_set_hal_ops(padapter); ++#endif ++ ++#ifdef CONFIG_RTL8192E ++ if (rtw_get_chip_type(padapter) == RTL8192E) ++ rtl8192ee_set_hal_ops(padapter); ++#endif ++ ++#ifdef CONFIG_RTL8814A ++ if (rtw_get_chip_type(padapter) == RTL8814A) ++ rtl8814ae_set_hal_ops(padapter); ++#endif ++ ++#if defined(CONFIG_RTL8822B) ++ if (rtw_get_chip_type(padapter) == RTL8822B) ++ rtl8822be_set_hal_ops(padapter); ++#endif ++ ++ if (rtw_hal_ops_check(padapter) == _FAIL) ++ return _FAIL; ++ ++ if (hal_spec_init(padapter) == _FAIL) ++ return _FAIL; ++ ++ return _SUCCESS; ++} ++ ++void pci_set_intf_ops(_adapter *padapter, struct _io_ops *pops) ++{ ++#ifdef CONFIG_RTL8188E ++ if (rtw_get_chip_type(padapter) == RTL8188E) ++ rtl8188ee_set_intf_ops(pops); ++#endif ++ ++#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ++ if ((rtw_get_chip_type(padapter) == RTL8812) || (rtw_get_chip_type(padapter) == RTL8821)) ++ rtl8812ae_set_intf_ops(pops); ++#endif ++ ++#ifdef CONFIG_RTL8723B ++ if (rtw_get_chip_type(padapter) == RTL8723B) ++ rtl8723be_set_intf_ops(pops); ++#endif ++ ++#ifdef CONFIG_RTL8723D ++ if (rtw_get_chip_type(padapter) == RTL8723D) ++ rtl8723de_set_intf_ops(pops); ++#endif ++ ++#ifdef CONFIG_RTL8192E ++ if (rtw_get_chip_type(padapter) == RTL8192E) ++ rtl8192ee_set_intf_ops(pops); ++#endif ++ ++#ifdef CONFIG_RTL8814A ++ if (rtw_get_chip_type(padapter) == RTL8814A) ++ rtl8814ae_set_intf_ops(pops); ++#endif ++ ++#if defined(CONFIG_RTL8822B) ++ if (rtw_get_chip_type(padapter) == RTL8822B) ++ rtl8822be_set_intf_ops(pops); ++#endif ++ ++} ++ ++static void pci_intf_start(_adapter *padapter) ++{ ++ ++ RTW_INFO("+pci_intf_start\n"); ++ ++ /* Enable hw interrupt */ ++ rtw_hal_enable_interrupt(padapter); ++ ++ RTW_INFO("-pci_intf_start\n"); ++} ++static void rtw_mi_pci_tasklets_kill(_adapter *padapter) ++{ ++ int i; ++ _adapter *iface; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); ++ ++ for (i = 0; i < dvobj->iface_nums; i++) { ++ iface = dvobj->padapters[i]; ++ if ((iface) && rtw_is_adapter_up(iface)) { ++ tasklet_kill(&(padapter->recvpriv.recv_tasklet)); ++ tasklet_kill(&(padapter->recvpriv.irq_prepare_beacon_tasklet)); ++ tasklet_kill(&(padapter->xmitpriv.xmit_tasklet)); ++ } ++ } ++} ++ ++static void pci_intf_stop(_adapter *padapter) ++{ ++ ++ ++ /* Disable hw interrupt */ ++ if (!rtw_is_surprise_removed(padapter)) { ++ /* device still exists, so driver can do i/o operation */ ++ rtw_hal_disable_interrupt(padapter); ++ rtw_mi_pci_tasklets_kill(padapter); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_PCIE_STOP_TX_DMA, 0); ++ ++ rtw_hal_irp_reset(padapter); ++ ++ } else { ++ /* Clear irq_enabled to prevent handle interrupt function. */ ++ adapter_to_dvobj(padapter)->irq_enabled = 0; ++ } ++ ++ ++} ++ ++static void disable_ht_for_spec_devid(const struct pci_device_id *pdid) ++{ ++#ifdef CONFIG_80211N_HT ++ u16 vid, pid; ++ u32 flags; ++ int i; ++ int num = sizeof(specific_device_id_tbl) / sizeof(struct specific_device_id); ++ ++ for (i = 0; i < num; i++) { ++ vid = specific_device_id_tbl[i].idVendor; ++ pid = specific_device_id_tbl[i].idProduct; ++ flags = specific_device_id_tbl[i].flags; ++ ++ if ((pdid->vendor == vid) && (pdid->device == pid) && (flags & SPEC_DEV_ID_DISABLE_HT)) { ++ rtw_ht_enable = 0; ++ rtw_bw_mode = 0; ++ rtw_ampdu_enable = 0; ++ } ++ ++ } ++#endif ++} ++ ++#ifdef CONFIG_PM ++static int rtw_pci_suspend(struct pci_dev *pdev, pm_message_t state) ++{ ++ int ret = 0; ++ struct dvobj_priv *dvobj = pci_get_drvdata(pdev); ++ _adapter *padapter = dvobj->padapters[IFACE_ID0]; ++ ++ ret = rtw_suspend_common(padapter); ++ ret = pci_save_state(pdev); ++ if (ret != 0) { ++ RTW_INFO("%s Failed on pci_save_state (%d)\n", __FUNCTION__, ret); ++ goto exit; ++ } ++ ++#ifdef CONFIG_WOWLAN ++ device_set_wakeup_enable(&pdev->dev, true); ++#endif ++ pci_disable_device(pdev); ++ ++#ifdef CONFIG_WOWLAN ++ ret = pci_enable_wake(pdev, pci_choose_state(pdev, state), true); ++ if (ret != 0) ++ RTW_INFO("%s Failed on pci_enable_wake (%d)\n", __FUNCTION__, ret); ++#endif ++ ret = pci_set_power_state(pdev, pci_choose_state(pdev, state)); ++ if (ret != 0) ++ RTW_INFO("%s Failed on pci_set_power_state (%d)\n", __FUNCTION__, ret); ++ ++exit: ++ return ret; ++ ++} ++ ++int rtw_resume_process(_adapter *padapter) ++{ ++ return rtw_resume_common(padapter); ++} ++ ++static int rtw_pci_resume(struct pci_dev *pdev) ++{ ++ struct dvobj_priv *dvobj = pci_get_drvdata(pdev); ++ _adapter *padapter = dvobj->padapters[IFACE_ID0]; ++ struct net_device *pnetdev = padapter->pnetdev; ++ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); ++ int err = 0; ++ ++ err = pci_set_power_state(pdev, PCI_D0); ++ if (err != 0) { ++ RTW_INFO("%s Failed on pci_set_power_state (%d)\n", __FUNCTION__, err); ++ goto exit; ++ } ++ ++ err = pci_enable_device(pdev); ++ if (err != 0) { ++ RTW_INFO("%s Failed on pci_enable_device (%d)\n", __FUNCTION__, err); ++ goto exit; ++ } ++ ++ ++#ifdef CONFIG_WOWLAN ++ err = pci_enable_wake(pdev, PCI_D0, 0); ++ if (err != 0) { ++ RTW_INFO("%s Failed on pci_enable_wake (%d)\n", __FUNCTION__, err); ++ goto exit; ++ } ++#endif ++#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 37)) ++ pci_restore_state(pdev); ++#else ++ err = pci_restore_state(pdev); ++ if (err != 0) { ++ RTW_INFO("%s Failed on pci_restore_state (%d)\n", __FUNCTION__, err); ++ goto exit; ++ } ++#endif ++ ++#ifdef CONFIG_WOWLAN ++ device_set_wakeup_enable(&pdev->dev, false); ++#endif ++ ++ if (pwrpriv->bInternalAutoSuspend) ++ err = rtw_resume_process(padapter); ++ else { ++ if (pwrpriv->wowlan_mode || pwrpriv->wowlan_ap_mode) { ++ rtw_resume_lock_suspend(); ++ err = rtw_resume_process(padapter); ++ rtw_resume_unlock_suspend(); ++ } else { ++#ifdef CONFIG_RESUME_IN_WORKQUEUE ++ rtw_resume_in_workqueue(pwrpriv); ++#else ++ if (rtw_is_earlysuspend_registered(pwrpriv)) { ++ /* jeff: bypass resume here, do in late_resume */ ++ rtw_set_do_late_resume(pwrpriv, _TRUE); ++ } else { ++ rtw_resume_lock_suspend(); ++ err = rtw_resume_process(padapter); ++ rtw_resume_unlock_suspend(); ++ } ++#endif ++ } ++ } ++ ++exit: ++ ++ return err; ++} ++#endif/* CONFIG_PM */ ++ ++_adapter *rtw_pci_primary_adapter_init(struct dvobj_priv *dvobj, struct pci_dev *pdev) ++{ ++ _adapter *padapter = NULL; ++ int status = _FAIL; ++ ++ padapter = (_adapter *)rtw_zvmalloc(sizeof(*padapter)); ++ if (padapter == NULL) ++ goto exit; ++ ++ if (loadparam(padapter) != _SUCCESS) ++ goto free_adapter; ++ ++ padapter->dvobj = dvobj; ++ ++ rtw_set_drv_stopped(padapter);/*init*/ ++ ++ dvobj->padapters[dvobj->iface_nums++] = padapter; ++ padapter->iface_id = IFACE_ID0; ++ ++ /* set adapter_type/iface type for primary padapter */ ++ padapter->isprimary = _TRUE; ++ padapter->adapter_type = PRIMARY_ADAPTER; ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ padapter->hw_port = HW_PORT0; ++#else ++ padapter->hw_port = HW_PORT0; ++#endif ++ ++ if (rtw_init_io_priv(padapter, pci_set_intf_ops) == _FAIL) ++ goto free_adapter; ++ ++ /* step 2. hook HalFunc, allocate HalData */ ++ /* hal_set_hal_ops(padapter); */ ++ if (rtw_set_hal_ops(padapter) == _FAIL) { ++ goto free_hal_data; ++ } ++ ++ /* step 3. */ ++ padapter->intf_start = &pci_intf_start; ++ padapter->intf_stop = &pci_intf_stop; ++ ++ /* .3 */ ++ rtw_hal_read_chip_version(padapter); ++ ++ /* .4 */ ++ rtw_hal_chip_configure(padapter); ++ ++ /* step 4. read efuse/eeprom data and get mac_addr */ ++ rtw_hal_read_chip_info(padapter); ++ ++ /* step 5. */ ++ if (rtw_init_drv_sw(padapter) == _FAIL) { ++ goto free_hal_data; ++ } ++ ++#ifdef CONFIG_BT_COEXIST ++ rtw_btcoex_Initialize(padapter); ++#endif /* CONFIG_BT_COEXIST */ ++ ++ if (rtw_hal_inirp_init(padapter) == _FAIL) { ++ goto free_hal_data; ++ } ++ rtw_macaddr_cfg(adapter_mac_addr(padapter), get_hal_mac_addr(padapter)); ++ ++#ifdef CONFIG_MI_WITH_MBSSID_CAM ++ rtw_mbid_camid_alloc(padapter, adapter_mac_addr(padapter)); ++#endif ++#ifdef CONFIG_P2P ++ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); ++#endif /* CONFIG_P2P */ ++ ++ rtw_hal_disable_interrupt(padapter); ++ ++ /* step 6. Init pci related configuration */ ++ rtw_pci_initialize_adapter_common(padapter); ++ ++ RTW_INFO("bDriverStopped:%s, bSurpriseRemoved:%s, bup:%d, hw_init_completed:%s\n" ++ , rtw_is_drv_stopped(padapter) ? "True" : "False" ++ , rtw_is_surprise_removed(padapter) ? "True" : "False" ++ , padapter->bup ++ , rtw_is_hw_init_completed(padapter) ? "True" : "False" ++ ); ++ ++ status = _SUCCESS; ++ ++free_hal_data: ++ if (status != _SUCCESS && padapter->HalData) ++ rtw_hal_free_data(padapter); ++ ++free_adapter: ++ if (status != _SUCCESS && padapter) { ++ rtw_vmfree((u8 *)padapter, sizeof(*padapter)); ++ padapter = NULL; ++ } ++exit: ++ return padapter; ++} ++ ++static void rtw_pci_primary_adapter_deinit(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ /* padapter->intf_stop(padapter); */ ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED)) ++ rtw_disassoc_cmd(padapter, 0, _FALSE); ++ ++#ifdef CONFIG_AP_MODE ++ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { ++ free_mlme_ap_info(padapter); ++#ifdef CONFIG_HOSTAPD_MLME ++ hostapd_mode_unload(padapter); ++#endif ++ } ++#endif ++ ++ /*rtw_cancel_all_timer(padapte);*/ ++#ifdef CONFIG_WOWLAN ++ adapter_to_pwrctl(padapter)->wowlan_mode = _FALSE; ++#endif /* CONFIG_WOWLAN */ ++ rtw_dev_unload(padapter); ++ ++ RTW_INFO("%s, hw_init_completed=%s\n", __func__, rtw_is_hw_init_completed(padapter) ? "_TRUE" : "_FALSE"); ++ ++ rtw_hal_inirp_deinit(padapter); ++ rtw_free_drv_sw(padapter); ++ ++ /* TODO: use rtw_os_ndevs_deinit instead at the first stage of driver's dev deinit function */ ++ rtw_os_ndev_free(padapter); ++ ++#ifdef RTW_HALMAC ++ rtw_halmac_deinit_adapter(adapter_to_dvobj(padapter)); ++#endif /* RTW_HALMAC */ ++ ++ rtw_vmfree((u8 *)padapter, sizeof(_adapter)); ++ ++#ifdef CONFIG_PLATFORM_RTD2880B ++ RTW_INFO("wlan link down\n"); ++ rtd2885_wlan_netlink_sendMsg("linkdown", "8712"); ++#endif ++} ++ ++/* ++ * drv_init() - a device potentially for us ++ * ++ * notes: drv_init() is called when the bus driver has located a card for us to support. ++ * We accept the new device by returning 0. ++*/ ++static int rtw_drv_init(struct pci_dev *pdev, const struct pci_device_id *pdid) ++{ ++ int i, err = -ENODEV; ++ ++ int status = _FAIL; ++ _adapter *padapter = NULL; ++ struct dvobj_priv *dvobj; ++ struct net_device *pnetdev; ++ ++ /* RTW_INFO("+rtw_drv_init\n"); */ ++ ++ /* step 0. */ ++ disable_ht_for_spec_devid(pdid); ++ ++ /* Initialize dvobj_priv */ ++ dvobj = pci_dvobj_init(pdev, pdid); ++ if (dvobj == NULL) { ++ goto exit; ++ } ++ ++ /* Initialize primary adapter */ ++ padapter = rtw_pci_primary_adapter_init(dvobj, pdev); ++ if (padapter == NULL) { ++ RTW_INFO("rtw_pci_primary_adapter_init Failed!\n"); ++ goto free_dvobj; ++ } ++ ++ /* Initialize virtual interface */ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->registrypriv.virtual_iface_num > (CONFIG_IFACE_NUMBER - 1)) ++ padapter->registrypriv.virtual_iface_num = (CONFIG_IFACE_NUMBER - 1); ++ ++ for (i = 0; i < padapter->registrypriv.virtual_iface_num; i++) { ++ if (rtw_drv_add_vir_if(padapter, pci_set_intf_ops) == NULL) { ++ RTW_INFO("rtw_drv_add_iface failed! (%d)\n", i); ++ goto free_if_vir; ++ } ++ } ++#endif ++ ++#ifdef CONFIG_GLOBAL_UI_PID ++ if (ui_pid[1] != 0) { ++ RTW_INFO("ui_pid[1]:%d\n", ui_pid[1]); ++ rtw_signal_process(ui_pid[1], SIGUSR2); ++ } ++#endif ++ ++ /* dev_alloc_name && register_netdev */ ++ if (rtw_os_ndevs_init(dvobj) != _SUCCESS) ++ goto free_if_vir; ++ ++#ifdef CONFIG_HOSTAPD_MLME ++ hostapd_mode_init(padapter); ++#endif ++ ++#ifdef CONFIG_PLATFORM_RTD2880B ++ RTW_INFO("wlan link up\n"); ++ rtd2885_wlan_netlink_sendMsg("linkup", "8712"); ++#endif ++ ++ /* alloc irq */ ++ if (pci_alloc_irq(dvobj) != _SUCCESS) ++ goto os_ndevs_deinit; ++ ++ /* RTW_INFO("-871x_drv - drv_init, success!\n"); */ ++ ++ status = _SUCCESS; ++ ++os_ndevs_deinit: ++ if (status != _SUCCESS) ++ rtw_os_ndevs_deinit(dvobj); ++free_if_vir: ++ if (status != _SUCCESS) { ++#ifdef CONFIG_CONCURRENT_MODE ++ rtw_drv_stop_vir_ifaces(dvobj); ++ rtw_drv_free_vir_ifaces(dvobj); ++#endif ++ } ++ ++ if (status != _SUCCESS && padapter) ++ rtw_pci_primary_adapter_deinit(padapter); ++ ++free_dvobj: ++ if (status != _SUCCESS) ++ pci_dvobj_deinit(pdev); ++exit: ++ return status == _SUCCESS ? 0 : -ENODEV; ++} ++ ++/* ++ * dev_remove() - our device is being removed ++*/ ++/* rmmod module & unplug(SurpriseRemoved) will call r871xu_dev_remove() => how to recognize both */ ++static void rtw_dev_remove(struct pci_dev *pdev) ++{ ++ struct dvobj_priv *pdvobjpriv = pci_get_drvdata(pdev); ++ _adapter *padapter = pdvobjpriv->padapters[IFACE_ID0]; ++ struct net_device *pnetdev = padapter->pnetdev; ++ ++ if (pdvobjpriv->processing_dev_remove == _TRUE) { ++ RTW_WARN("%s-line%d: Warning! device has been removed!\n", __FUNCTION__, __LINE__); ++ return; ++ } ++ ++ RTW_INFO("+rtw_dev_remove\n"); ++ ++ pdvobjpriv->processing_dev_remove = _TRUE; ++ ++ if (unlikely(!padapter)) ++ return; ++ ++ /* TODO: use rtw_os_ndevs_deinit instead at the first stage of driver's dev deinit function */ ++ rtw_os_ndevs_unregister(pdvobjpriv); ++ ++#if 0 ++#ifdef RTK_DMP_PLATFORM ++ rtw_clr_surprise_removed(padapter); /* always trate as device exists*/ ++ /* this will let the driver to disable it's interrupt */ ++#else ++ if (pci_drvpriv.drv_registered == _TRUE) { ++ /* RTW_INFO("r871xu_dev_remove():padapter->bSurpriseRemoved == _TRUE\n"); */ ++ rtw_set_surprise_removed(padapter); ++ } ++ /*else ++ { ++ ++ GET_HAL_DATA(padapter)->hw_init_completed = _FALSE; ++ ++ }*/ ++#endif ++#endif ++ ++#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) ++ rtw_unregister_early_suspend(dvobj_to_pwrctl(pdvobjpriv)); ++#endif ++ ++ if (padapter->bFWReady == _TRUE) { ++ rtw_pm_set_ips(padapter, IPS_NONE); ++ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); ++ ++ LeaveAllPowerSaveMode(padapter); ++ } ++ ++ rtw_set_drv_stopped(padapter); /*for stop thread*/ ++ rtw_stop_cmd_thread(padapter); ++#ifdef CONFIG_CONCURRENT_MODE ++ rtw_drv_stop_vir_ifaces(pdvobjpriv); ++#endif ++ ++#ifdef CONFIG_BT_COEXIST ++#ifdef CONFIG_BT_COEXIST_SOCKET_TRX ++ if (GET_HAL_DATA(padapter)->EEPROMBluetoothCoexist) ++ rtw_btcoex_close_socket(padapter); ++#endif ++ rtw_btcoex_HaltNotify(padapter); ++#endif ++ ++ rtw_pci_primary_adapter_deinit(padapter); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ rtw_drv_free_vir_ifaces(pdvobjpriv); ++#endif ++ ++ pci_dvobj_deinit(pdev); ++ ++ RTW_INFO("-r871xu_dev_remove, done\n"); ++ ++ return; ++} ++ ++static void rtw_dev_shutdown(struct pci_dev *pdev) ++{ ++ struct dvobj_priv *pdvobjpriv = pci_get_drvdata(pdev); ++ _adapter *padapter = pdvobjpriv->padapters[IFACE_ID0]; ++ struct net_device *pnetdev = padapter->pnetdev; ++ ++ if (IS_HARDWARE_TYPE_8723DE(padapter)) { ++ u1Byte u1Tmp; ++ ++ u1Tmp = PlatformEFIORead1Byte(padapter, 0x75 /*REG_HCI_OPT_CTRL_8723D+1*/); ++ PlatformEFIOWrite1Byte(padapter, 0x75 /*REG_HCI_OPT_CTRL_8723D+1*/, (u1Tmp|BIT0));/*Disable USB Suspend Signal*/ ++ } ++ ++ rtw_dev_remove(pdev); ++} ++ ++static int __init rtw_drv_entry(void) ++{ ++ int ret = 0; ++ ++ RTW_PRINT("module init start\n"); ++ dump_drv_version(RTW_DBGDUMP); ++#ifdef BTCOEXVERSION ++ RTW_PRINT(DRV_NAME" BT-Coex version = %s\n", BTCOEXVERSION); ++#endif /* BTCOEXVERSION */ ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) ++ /* console_suspend_enabled=0; */ ++#endif ++ ++ pci_drvpriv.drv_registered = _TRUE; ++ rtw_suspend_lock_init(); ++ rtw_drv_proc_init(); ++ rtw_ndev_notifier_register(); ++ ++ ret = pci_register_driver(&pci_drvpriv.rtw_pci_drv); ++ ++ if (ret != 0) { ++ pci_drvpriv.drv_registered = _FALSE; ++ rtw_suspend_lock_uninit(); ++ rtw_drv_proc_deinit(); ++ rtw_ndev_notifier_unregister(); ++ goto exit; ++ } ++ ++exit: ++ RTW_PRINT("module init ret=%d\n", ret); ++ return ret; ++} ++ ++static void __exit rtw_drv_halt(void) ++{ ++ RTW_PRINT("module exit start\n"); ++ ++ pci_drvpriv.drv_registered = _FALSE; ++ ++ pci_unregister_driver(&pci_drvpriv.rtw_pci_drv); ++ ++ rtw_suspend_lock_uninit(); ++ rtw_drv_proc_deinit(); ++ rtw_ndev_notifier_unregister(); ++ ++ RTW_PRINT("module exit success\n"); ++ ++ rtw_mstat_dump(RTW_DBGDUMP); ++} ++ ++ ++module_init(rtw_drv_entry); ++module_exit(rtw_drv_halt); +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/pci_ops_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/pci_ops_linux.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/pci_ops_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/pci_ops_linux.c 2018-02-11 21:44:27.176146528 +0200 +@@ -0,0 +1,21 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ *******************************************************************************/ ++#define _PCI_OPS_LINUX_C_ ++ ++#include +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/recv_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/recv_linux.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/recv_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/recv_linux.c 2018-02-11 21:44:27.176146528 +0200 +@@ -0,0 +1,885 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _RECV_OSDEP_C_ ++ ++#include ++ ++int rtw_os_recvframe_duplicate_skb(_adapter *padapter, union recv_frame *pcloneframe, _pkt *pskb) ++{ ++ int res = _SUCCESS; ++ _pkt *pkt_copy = NULL; ++ struct rx_pkt_attrib *pattrib = &pcloneframe->u.hdr.attrib; ++ ++ if (pskb == NULL) { ++ RTW_INFO("%s [WARN] skb == NULL, drop frag frame\n", __func__); ++ return _FAIL; ++ } ++#if 1 ++ pkt_copy = rtw_skb_copy(pskb); ++ ++ if (pkt_copy == NULL) { ++ RTW_INFO("%s [WARN] rtw_skb_copy fail , drop frag frame\n", __func__); ++ return _FAIL; ++ } ++#else ++ pkt_copy = rtw_skb_clone(pskb); ++ ++ if (pkt_copy == NULL) { ++ RTW_INFO("%s [WARN] rtw_skb_clone fail , drop frag frame\n", __func__); ++ return _FAIL; ++ } ++#endif ++ pkt_copy->dev = padapter->pnetdev; ++ ++ pcloneframe->u.hdr.pkt = pkt_copy; ++ pcloneframe->u.hdr.rx_head = pkt_copy->head; ++ pcloneframe->u.hdr.rx_data = pkt_copy->data; ++ pcloneframe->u.hdr.rx_end = skb_end_pointer(pkt_copy); ++ pcloneframe->u.hdr.rx_tail = skb_tail_pointer(pkt_copy); ++ pcloneframe->u.hdr.len = pkt_copy->len; ++ ++ return res; ++} ++ ++int rtw_os_alloc_recvframe(_adapter *padapter, union recv_frame *precvframe, u8 *pdata, _pkt *pskb) ++{ ++ int res = _SUCCESS; ++ u8 shift_sz = 0; ++ u32 skb_len, alloc_sz; ++ _pkt *pkt_copy = NULL; ++ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; ++ ++ ++ if (pdata == NULL) { ++ precvframe->u.hdr.pkt = NULL; ++ res = _FAIL; ++ return res; ++ } ++ ++ ++ /* Modified by Albert 20101213 */ ++ /* For 8 bytes IP header alignment. */ ++ shift_sz = pattrib->qos ? 6 : 0; /* Qos data, wireless lan header length is 26 */ ++ ++ skb_len = pattrib->pkt_len; ++ ++ /* for first fragment packet, driver need allocate 1536+drvinfo_sz+RXDESC_SIZE to defrag packet. */ ++ /* modify alloc_sz for recvive crc error packet by thomas 2011-06-02 */ ++ if ((pattrib->mfrag == 1) && (pattrib->frag_num == 0)) { ++ /* alloc_sz = 1664; */ /* 1664 is 128 alignment. */ ++ alloc_sz = (skb_len <= 1650) ? 1664 : (skb_len + 14); ++ } else { ++ alloc_sz = skb_len; ++ /* 6 is for IP header 8 bytes alignment in QoS packet case. */ ++ /* 8 is for skb->data 4 bytes alignment. */ ++ alloc_sz += 14; ++ } ++ ++ pkt_copy = rtw_skb_alloc(alloc_sz); ++ ++ if (pkt_copy) { ++ pkt_copy->dev = padapter->pnetdev; ++ pkt_copy->len = skb_len; ++ precvframe->u.hdr.pkt = pkt_copy; ++ precvframe->u.hdr.rx_head = pkt_copy->head; ++ precvframe->u.hdr.rx_end = pkt_copy->data + alloc_sz; ++ skb_reserve(pkt_copy, 8 - ((SIZE_PTR)(pkt_copy->data) & 7)); /* force pkt_copy->data at 8-byte alignment address */ ++ skb_reserve(pkt_copy, shift_sz);/* force ip_hdr at 8-byte alignment address according to shift_sz. */ ++ _rtw_memcpy(pkt_copy->data, pdata, skb_len); ++ precvframe->u.hdr.rx_data = precvframe->u.hdr.rx_tail = pkt_copy->data; ++ } else { ++#if 0 ++ { ++ rtw_free_recvframe(precvframe_if2, &precvpriv->free_recv_queue); ++ rtw_enqueue_recvbuf_to_head(precvbuf, &precvpriv->recv_buf_pending_queue); ++ ++ /* The case of can't allocate skb is serious and may never be recovered, ++ once bDriverStopped is enable, this task should be stopped.*/ ++ if (!rtw_is_drv_stopped(secondary_padapter)) ++#ifdef PLATFORM_LINUX ++ tasklet_schedule(&precvpriv->recv_tasklet); ++#endif ++ return ret; ++ } ++ ++#endif ++ ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX ++ RTW_INFO("%s:can not allocate memory for skb copy\n", __func__); ++ ++ precvframe->u.hdr.pkt = NULL; ++ ++ /* rtw_free_recvframe(precvframe, pfree_recv_queue); */ ++ /*exit_rtw_os_recv_resource_alloc;*/ ++ ++ res = _FAIL; ++#else ++ if ((pattrib->mfrag == 1) && (pattrib->frag_num == 0)) { ++ RTW_INFO("%s: alloc_skb fail , drop frag frame\n", __FUNCTION__); ++ /* rtw_free_recvframe(precvframe, pfree_recv_queue); */ ++ res = _FAIL; ++ goto exit_rtw_os_recv_resource_alloc; ++ } ++ ++ if (pskb == NULL) { ++ res = _FAIL; ++ goto exit_rtw_os_recv_resource_alloc; ++ } ++ ++ precvframe->u.hdr.pkt = rtw_skb_clone(pskb); ++ if (precvframe->u.hdr.pkt) { ++ precvframe->u.hdr.pkt->dev = padapter->pnetdev; ++ precvframe->u.hdr.rx_head = precvframe->u.hdr.rx_data = precvframe->u.hdr.rx_tail = pdata; ++ precvframe->u.hdr.rx_end = pdata + alloc_sz; ++ } else { ++ RTW_INFO("%s: rtw_skb_clone fail\n", __FUNCTION__); ++ /* rtw_free_recvframe(precvframe, pfree_recv_queue); */ ++ /*exit_rtw_os_recv_resource_alloc;*/ ++ res = _FAIL; ++ } ++#endif ++ } ++ ++exit_rtw_os_recv_resource_alloc: ++ ++ return res; ++ ++} ++ ++void rtw_os_free_recvframe(union recv_frame *precvframe) ++{ ++ if (precvframe->u.hdr.pkt) { ++ rtw_skb_free(precvframe->u.hdr.pkt);/* free skb by driver */ ++ ++ precvframe->u.hdr.pkt = NULL; ++ } ++} ++ ++/* init os related resource in struct recv_priv */ ++int rtw_os_recv_resource_init(struct recv_priv *precvpriv, _adapter *padapter) ++{ ++ int res = _SUCCESS; ++ ++ ++#ifdef CONFIG_RTW_NAPI ++ skb_queue_head_init(&precvpriv->rx_napi_skb_queue); ++#endif /* CONFIG_RTW_NAPI */ ++ ++ return res; ++} ++ ++/* alloc os related resource in union recv_frame */ ++int rtw_os_recv_resource_alloc(_adapter *padapter, union recv_frame *precvframe) ++{ ++ int res = _SUCCESS; ++ ++ precvframe->u.hdr.pkt_newalloc = precvframe->u.hdr.pkt = NULL; ++ ++ return res; ++} ++ ++/* free os related resource in union recv_frame */ ++void rtw_os_recv_resource_free(struct recv_priv *precvpriv) ++{ ++ sint i; ++ union recv_frame *precvframe; ++ precvframe = (union recv_frame *) precvpriv->precv_frame_buf; ++ ++ ++#ifdef CONFIG_RTW_NAPI ++ if (skb_queue_len(&precvpriv->rx_napi_skb_queue)) ++ RTW_WARN("rx_napi_skb_queue not empty\n"); ++ rtw_skb_queue_purge(&precvpriv->rx_napi_skb_queue); ++#endif /* CONFIG_RTW_NAPI */ ++ ++ for (i = 0; i < NR_RECVFRAME; i++) { ++ if (precvframe->u.hdr.pkt) { ++ rtw_skb_free(precvframe->u.hdr.pkt);/* free skb by driver */ ++ precvframe->u.hdr.pkt = NULL; ++ } ++ precvframe++; ++ } ++} ++ ++/* alloc os related resource in struct recv_buf */ ++int rtw_os_recvbuf_resource_alloc(_adapter *padapter, struct recv_buf *precvbuf) ++{ ++ int res = _SUCCESS; ++ ++#ifdef CONFIG_USB_HCI ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct usb_device *pusbd = pdvobjpriv->pusbdev; ++ ++ precvbuf->irp_pending = _FALSE; ++ precvbuf->purb = usb_alloc_urb(0, GFP_KERNEL); ++ if (precvbuf->purb == NULL) ++ res = _FAIL; ++ ++ precvbuf->pskb = NULL; ++ ++ precvbuf->pallocated_buf = precvbuf->pbuf = NULL; ++ ++ precvbuf->pdata = precvbuf->phead = precvbuf->ptail = precvbuf->pend = NULL; ++ ++ precvbuf->transfer_len = 0; ++ ++ precvbuf->len = 0; ++ ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX ++ precvbuf->pallocated_buf = rtw_usb_buffer_alloc(pusbd, (size_t)precvbuf->alloc_sz, &precvbuf->dma_transfer_addr); ++ precvbuf->pbuf = precvbuf->pallocated_buf; ++ if (precvbuf->pallocated_buf == NULL) ++ return _FAIL; ++#endif /* CONFIG_USE_USB_BUFFER_ALLOC_RX */ ++ ++#endif /* CONFIG_USB_HCI */ ++ ++ return res; ++} ++ ++/* free os related resource in struct recv_buf */ ++int rtw_os_recvbuf_resource_free(_adapter *padapter, struct recv_buf *precvbuf) ++{ ++ int ret = _SUCCESS; ++ ++#ifdef CONFIG_USB_HCI ++ ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX ++ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct usb_device *pusbd = pdvobjpriv->pusbdev; ++ ++ rtw_usb_buffer_free(pusbd, (size_t)precvbuf->alloc_sz, precvbuf->pallocated_buf, precvbuf->dma_transfer_addr); ++ precvbuf->pallocated_buf = NULL; ++ precvbuf->dma_transfer_addr = 0; ++ ++#endif /* CONFIG_USE_USB_BUFFER_ALLOC_RX */ ++ ++ if (precvbuf->purb) { ++ /* usb_kill_urb(precvbuf->purb); */ ++ usb_free_urb(precvbuf->purb); ++ } ++ ++#endif /* CONFIG_USB_HCI */ ++ ++ ++ if (precvbuf->pskb) { ++#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER ++ if (rtw_free_skb_premem(precvbuf->pskb) != 0) ++#endif ++ rtw_skb_free(precvbuf->pskb); ++ } ++ return ret; ++ ++} ++ ++_pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, u16 nSubframe_Length, u8 *pdata) ++{ ++ u16 eth_type; ++ u8 *data_ptr; ++ _pkt *sub_skb; ++ struct rx_pkt_attrib *pattrib; ++ ++ pattrib = &prframe->u.hdr.attrib; ++ ++#ifdef CONFIG_SKB_COPY ++ sub_skb = rtw_skb_alloc(nSubframe_Length + 12); ++ if (sub_skb) { ++ skb_reserve(sub_skb, 12); ++ data_ptr = (u8 *)skb_put(sub_skb, nSubframe_Length); ++ _rtw_memcpy(data_ptr, (pdata + ETH_HLEN), nSubframe_Length); ++ } else ++#endif /* CONFIG_SKB_COPY */ ++ { ++ sub_skb = rtw_skb_clone(prframe->u.hdr.pkt); ++ if (sub_skb) { ++ sub_skb->data = pdata + ETH_HLEN; ++ sub_skb->len = nSubframe_Length; ++ skb_set_tail_pointer(sub_skb, nSubframe_Length); ++ } else { ++ RTW_INFO("%s(): rtw_skb_clone() Fail!!!\n", __FUNCTION__); ++ return NULL; ++ } ++ } ++ ++ eth_type = RTW_GET_BE16(&sub_skb->data[6]); ++ ++ if (sub_skb->len >= 8 && ++ ((_rtw_memcmp(sub_skb->data, rtw_rfc1042_header, SNAP_SIZE) && ++ eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) || ++ _rtw_memcmp(sub_skb->data, rtw_bridge_tunnel_header, SNAP_SIZE))) { ++ /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ ++ skb_pull(sub_skb, SNAP_SIZE); ++ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->src, ETH_ALEN); ++ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->dst, ETH_ALEN); ++ } else { ++ u16 len; ++ /* Leave Ethernet header part of hdr and full payload */ ++ len = htons(sub_skb->len); ++ _rtw_memcpy(skb_push(sub_skb, 2), &len, 2); ++ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->src, ETH_ALEN); ++ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->dst, ETH_ALEN); ++ } ++ ++ return sub_skb; ++} ++ ++#ifdef CONFIG_RTW_NAPI ++static int napi_recv(_adapter *padapter, int budget) ++{ ++ _pkt *pskb; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ int work_done = 0; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ u8 rx_ok; ++ ++ ++ while ((work_done < budget) && ++ (!skb_queue_empty(&precvpriv->rx_napi_skb_queue))) { ++ pskb = skb_dequeue(&precvpriv->rx_napi_skb_queue); ++ if (!pskb) ++ break; ++ ++ rx_ok = _FALSE; ++ ++#ifdef CONFIG_RTW_GRO ++ if (pregistrypriv->en_gro) { ++ if (rtw_napi_gro_receive(&padapter->napi, pskb) != GRO_DROP) ++ rx_ok = _TRUE; ++ goto next; ++ } ++#endif /* CONFIG_RTW_GRO */ ++ ++ if (rtw_netif_receive_skb(padapter->pnetdev, pskb) == NET_RX_SUCCESS) ++ rx_ok = _TRUE; ++ ++next: ++ if (rx_ok == _TRUE) { ++ work_done++; ++ DBG_COUNTER(padapter->rx_logs.os_netif_ok); ++ } else { ++ DBG_COUNTER(padapter->rx_logs.os_netif_err); ++ } ++ } ++ ++ return work_done; ++} ++ ++int rtw_recv_napi_poll(struct napi_struct *napi, int budget) ++{ ++ _adapter *padapter = container_of(napi, _adapter, napi); ++ int work_done = 0; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ ++ ++ work_done = napi_recv(padapter, budget); ++ if (work_done < budget) { ++ napi_complete(napi); ++ if (!skb_queue_empty(&precvpriv->rx_napi_skb_queue)) ++ napi_schedule(napi); ++ } ++ ++ return work_done; ++} ++#endif /* CONFIG_RTW_NAPI */ ++ ++#ifdef DBG_UDP_PKT_LOSE_11AC ++ #define PAYLOAD_LEN_LOC_OF_IP_HDR 0x10 /*ethernet payload length location of ip header (DA + SA+eth_type+(version&hdr_len)) */ ++#endif ++ ++void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, struct rx_pkt_attrib *pattrib) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct recv_priv *precvpriv = &(padapter->recvpriv); ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++#ifdef CONFIG_BR_EXT ++ void *br_port = NULL; ++#endif ++ int ret; ++ ++ /* Indicat the packets to upper layer */ ++ if (pkt) { ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { ++ _pkt *pskb2 = NULL; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ int bmcast = IS_MCAST(pattrib->dst); ++ ++ /* RTW_INFO("bmcast=%d\n", bmcast); */ ++ ++ if (_rtw_memcmp(pattrib->dst, adapter_mac_addr(padapter), ETH_ALEN) == _FALSE) { ++ /* RTW_INFO("not ap psta=%p, addr=%pM\n", psta, pattrib->dst); */ ++ ++ if (bmcast) { ++ psta = rtw_get_bcmc_stainfo(padapter); ++ pskb2 = rtw_skb_clone(pkt); ++ } else ++ psta = rtw_get_stainfo(pstapriv, pattrib->dst); ++ ++ if (psta) { ++ struct net_device *pnetdev = (struct net_device *)padapter->pnetdev; ++ ++ /* RTW_INFO("directly forwarding to the rtw_xmit_entry\n"); */ ++ ++ /* skb->ip_summed = CHECKSUM_NONE; */ ++ pkt->dev = pnetdev; ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ skb_set_queue_mapping(pkt, rtw_recv_select_queue(pkt)); ++#endif /* LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35) */ ++ ++ _rtw_xmit_entry(pkt, pnetdev); ++ ++ if (bmcast && (pskb2 != NULL)) { ++ pkt = pskb2; ++ DBG_COUNTER(padapter->rx_logs.os_indicate_ap_mcast); ++ } else { ++ DBG_COUNTER(padapter->rx_logs.os_indicate_ap_forward); ++ return; ++ } ++ } ++ } else { /* to APself */ ++ /* RTW_INFO("to APSelf\n"); */ ++ DBG_COUNTER(padapter->rx_logs.os_indicate_ap_self); ++ } ++ } ++ ++#ifdef CONFIG_BR_EXT ++ /* Insert NAT2.5 RX here! */ ++#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) ++ br_port = padapter->pnetdev->br_port; ++#else /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ ++ rcu_read_lock(); ++ br_port = rcu_dereference(padapter->pnetdev->rx_handler_data); ++ rcu_read_unlock(); ++#endif /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ ++ ++ ++ if (br_port && (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) == _TRUE)) { ++ int nat25_handle_frame(_adapter *priv, struct sk_buff *skb); ++ if (nat25_handle_frame(padapter, pkt) == -1) { ++ /* priv->ext_stats.rx_data_drops++; */ ++ /* DEBUG_ERR("RX DROP: nat25_handle_frame fail!\n"); */ ++ /* return FAIL; */ ++ ++#if 1 ++ /* bypass this frame to upper layer!! */ ++#else ++ rtw_skb_free(sub_skb); ++ continue; ++#endif ++ } ++ } ++#endif /* CONFIG_BR_EXT */ ++ if (precvpriv->sink_udpport > 0) ++ rtw_sink_rtp_seq_dbg(padapter, pkt); ++#ifdef DBG_UDP_PKT_LOSE_11AC ++ /* After eth_type_trans process , pkt->data pointer will move from ethrnet header to ip header , ++ * we have to check ethernet type , so this debug must be print before eth_type_trans ++ */ ++ if (*((unsigned short *)(pkt->data + ETH_ALEN * 2)) == htons(ETH_P_ARP)) { ++ /* ARP Payload length will be 42bytes or 42+18(tailer)=60bytes*/ ++ if (pkt->len != 42 && pkt->len != 60) ++ RTW_INFO("Error !!%s,ARP Payload length %u not correct\n" , __func__ , pkt->len); ++ } else if (*((unsigned short *)(pkt->data + ETH_ALEN * 2)) == htons(ETH_P_IP)) { ++ if (be16_to_cpu(*((u16 *)(pkt->data + PAYLOAD_LEN_LOC_OF_IP_HDR))) != (pkt->len) - ETH_HLEN) { ++ RTW_INFO("Error !!%s,Payload length not correct\n" , __func__); ++ RTW_INFO("%s, IP header describe Total length=%u\n" , __func__ , be16_to_cpu(*((u16 *)(pkt->data + PAYLOAD_LEN_LOC_OF_IP_HDR)))); ++ RTW_INFO("%s, Pkt real length=%u\n" , __func__ , (pkt->len) - ETH_HLEN); ++ } ++ } ++#endif ++ /* After eth_type_trans process , pkt->data pointer will move from ethrnet header to ip header */ ++ pkt->protocol = eth_type_trans(pkt, padapter->pnetdev); ++ pkt->dev = padapter->pnetdev; ++ ++#ifdef CONFIG_TCP_CSUM_OFFLOAD_RX ++ if ((pattrib->tcpchk_valid == 1) && (pattrib->tcp_chkrpt == 1)) ++ pkt->ip_summed = CHECKSUM_UNNECESSARY; ++ else ++ pkt->ip_summed = CHECKSUM_NONE; ++#else /* !CONFIG_TCP_CSUM_OFFLOAD_RX */ ++ pkt->ip_summed = CHECKSUM_NONE; ++#endif /* CONFIG_TCP_CSUM_OFFLOAD_RX */ ++ ++#ifdef CONFIG_RTW_NAPI ++ if (pregistrypriv->en_napi) { ++ skb_queue_tail(&precvpriv->rx_napi_skb_queue, pkt); ++ napi_schedule(&padapter->napi); ++ return; ++ } ++#endif /* CONFIG_RTW_NAPI */ ++ ++ ret = rtw_netif_rx(padapter->pnetdev, pkt); ++ if (ret == NET_RX_SUCCESS) ++ DBG_COUNTER(padapter->rx_logs.os_netif_ok); ++ else ++ DBG_COUNTER(padapter->rx_logs.os_netif_err); ++ } ++} ++ ++void rtw_handle_tkip_mic_err(_adapter *padapter, struct sta_info *sta, u8 bgroup) ++{ ++#ifdef CONFIG_IOCTL_CFG80211 ++ enum nl80211_key_type key_type = 0; ++#endif ++ union iwreq_data wrqu; ++ struct iw_michaelmicfailure ev; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ u32 cur_time = 0; ++ ++ if (psecuritypriv->last_mic_err_time == 0) ++ psecuritypriv->last_mic_err_time = rtw_get_current_time(); ++ else { ++ cur_time = rtw_get_current_time(); ++ ++ if (cur_time - psecuritypriv->last_mic_err_time < 60 * HZ) { ++ psecuritypriv->btkip_countermeasure = _TRUE; ++ psecuritypriv->last_mic_err_time = 0; ++ psecuritypriv->btkip_countermeasure_time = cur_time; ++ } else ++ psecuritypriv->last_mic_err_time = rtw_get_current_time(); ++ } ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if (bgroup) ++ key_type |= NL80211_KEYTYPE_GROUP; ++ else ++ key_type |= NL80211_KEYTYPE_PAIRWISE; ++ ++ cfg80211_michael_mic_failure(padapter->pnetdev, sta->hwaddr, key_type, -1, NULL, GFP_ATOMIC); ++#endif ++ ++ _rtw_memset(&ev, 0x00, sizeof(ev)); ++ if (bgroup) ++ ev.flags |= IW_MICFAILURE_GROUP; ++ else ++ ev.flags |= IW_MICFAILURE_PAIRWISE; ++ ++ ev.src_addr.sa_family = ARPHRD_ETHER; ++ _rtw_memcpy(ev.src_addr.sa_data, sta->hwaddr, ETH_ALEN); ++ ++ _rtw_memset(&wrqu, 0x00, sizeof(wrqu)); ++ wrqu.data.length = sizeof(ev); ++ ++#ifndef CONFIG_IOCTL_CFG80211 ++ wireless_send_event(padapter->pnetdev, IWEVMICHAELMICFAILURE, &wrqu, (char *) &ev); ++#endif ++} ++ ++void rtw_hostapd_mlme_rx(_adapter *padapter, union recv_frame *precv_frame) ++{ ++#ifdef CONFIG_HOSTAPD_MLME ++ _pkt *skb; ++ struct hostapd_priv *phostapdpriv = padapter->phostapdpriv; ++ struct net_device *pmgnt_netdev = phostapdpriv->pmgnt_netdev; ++ ++ ++ skb = precv_frame->u.hdr.pkt; ++ ++ if (skb == NULL) ++ return; ++ ++ skb->data = precv_frame->u.hdr.rx_data; ++ skb->tail = precv_frame->u.hdr.rx_tail; ++ skb->len = precv_frame->u.hdr.len; ++ ++ /* pskb_copy = rtw_skb_copy(skb); ++ * if(skb == NULL) goto _exit; */ ++ ++ skb->dev = pmgnt_netdev; ++ skb->ip_summed = CHECKSUM_NONE; ++ skb->pkt_type = PACKET_OTHERHOST; ++ /* skb->protocol = __constant_htons(0x0019); ETH_P_80211_RAW */ ++ skb->protocol = __constant_htons(0x0003); /*ETH_P_80211_RAW*/ ++ ++ /* RTW_INFO("(1)data=0x%x, head=0x%x, tail=0x%x, mac_header=0x%x, len=%d\n", skb->data, skb->head, skb->tail, skb->mac_header, skb->len); */ ++ ++ /* skb->mac.raw = skb->data; */ ++ skb_reset_mac_header(skb); ++ ++ /* skb_pull(skb, 24); */ ++ _rtw_memset(skb->cb, 0, sizeof(skb->cb)); ++ ++ rtw_netif_rx(pmgnt_netdev, skb); ++ ++ precv_frame->u.hdr.pkt = NULL; /* set pointer to NULL before rtw_free_recvframe() if call rtw_netif_rx() */ ++#endif ++} ++ ++#ifdef CONFIG_AUTO_AP_MODE ++static void rtw_os_ksocket_send(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ _pkt *skb = precv_frame->u.hdr.pkt; ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ struct sta_info *psta = precv_frame->u.hdr.psta; ++ ++ RTW_INFO("eth rx: got eth_type=0x%x\n", pattrib->eth_type); ++ ++ if (psta && psta->isrc && psta->pid > 0) { ++ u16 rx_pid; ++ ++ rx_pid = *(u16 *)(skb->data + ETH_HLEN); ++ ++ RTW_INFO("eth rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", ++ rx_pid, MAC_ARG(psta->hwaddr), psta->pid); ++ ++ if (rx_pid == psta->pid) { ++ int i; ++ u16 len = *(u16 *)(skb->data + ETH_HLEN + 2); ++ /* u16 ctrl_type = *(u16*)(skb->data+ETH_HLEN+4); */ ++ ++ /* RTW_INFO("eth, RC: len=0x%x, ctrl_type=0x%x\n", len, ctrl_type); */ ++ RTW_INFO("eth, RC: len=0x%x\n", len); ++ ++ for (i = 0; i < len; i++) ++ RTW_INFO("0x%x\n", *(skb->data + ETH_HLEN + 4 + i)); ++ /* RTW_INFO("0x%x\n", *(skb->data+ETH_HLEN+6+i)); */ ++ ++ RTW_INFO("eth, RC-end\n"); ++ ++#if 0 ++ /* send_sz = ksocket_send(padapter->ksock_send, &padapter->kaddr_send, (skb->data+ETH_HLEN+2), len); */ ++ rtw_recv_ksocket_send_cmd(padapter, (skb->data + ETH_HLEN + 2), len); ++ ++ /* RTW_INFO("ksocket_send size=%d\n", send_sz); */ ++#endif ++ } ++ ++ } ++ ++} ++#endif /* CONFIG_AUTO_AP_MODE */ ++ ++int rtw_recv_monitor(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ int ret = _FAIL; ++ struct recv_priv *precvpriv; ++ _queue *pfree_recv_queue; ++ _pkt *skb; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct rx_pkt_attrib *pattrib; ++ ++ if (NULL == precv_frame) ++ goto _recv_drop; ++ ++ pattrib = &precv_frame->u.hdr.attrib; ++ precvpriv = &(padapter->recvpriv); ++ pfree_recv_queue = &(precvpriv->free_recv_queue); ++ ++ skb = precv_frame->u.hdr.pkt; ++ if (skb == NULL) { ++ RTW_INFO("%s :skb==NULL something wrong!!!!\n", __func__); ++ goto _recv_drop; ++ } ++ ++ skb->data = precv_frame->u.hdr.rx_data; ++ skb_set_tail_pointer(skb, precv_frame->u.hdr.len); ++ skb->len = precv_frame->u.hdr.len; ++ skb->ip_summed = CHECKSUM_NONE; ++ skb->pkt_type = PACKET_OTHERHOST; ++ skb->protocol = htons(0x0019); /* ETH_P_80211_RAW */ ++ ++ rtw_netif_rx(padapter->pnetdev, skb); ++ ++ /* pointers to NULL before rtw_free_recvframe() */ ++ precv_frame->u.hdr.pkt = NULL; ++ ++ ret = _SUCCESS; ++ ++_recv_drop: ++ ++ /* enqueue back to free_recv_queue */ ++ if (precv_frame) ++ rtw_free_recvframe(precv_frame, pfree_recv_queue); ++ ++ return ret; ++ ++} ++ ++int rtw_recv_indicatepkt(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct recv_priv *precvpriv; ++ _queue *pfree_recv_queue; ++ _pkt *skb; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct rx_pkt_attrib *pattrib; ++ ++ if (NULL == precv_frame) ++ goto _recv_indicatepkt_drop; ++ ++ DBG_COUNTER(padapter->rx_logs.os_indicate); ++ pattrib = &precv_frame->u.hdr.attrib; ++ precvpriv = &(padapter->recvpriv); ++ pfree_recv_queue = &(precvpriv->free_recv_queue); ++ ++#ifdef CONFIG_DRVEXT_MODULE ++ if (drvext_rx_handler(padapter, precv_frame->u.hdr.rx_data, precv_frame->u.hdr.len) == _SUCCESS) ++ goto _recv_indicatepkt_drop; ++#endif ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (rtw_wapi_check_for_drop(padapter, precv_frame)) { ++ WAPI_TRACE(WAPI_ERR, "%s(): Rx Reorder Drop case!!\n", __FUNCTION__); ++ goto _recv_indicatepkt_drop; ++ } ++#endif ++ ++ skb = precv_frame->u.hdr.pkt; ++ if (skb == NULL) { ++ goto _recv_indicatepkt_drop; ++ } ++ ++ ++ skb->data = precv_frame->u.hdr.rx_data; ++ ++ skb_set_tail_pointer(skb, precv_frame->u.hdr.len); ++ ++ skb->len = precv_frame->u.hdr.len; ++ ++ ++ if (pattrib->eth_type == 0x888e) ++ RTW_PRINT("recv eapol packet\n"); ++ ++#ifdef CONFIG_AUTO_AP_MODE ++#if 1 /* for testing */ ++#if 1 ++ if (0x8899 == pattrib->eth_type) { ++ rtw_os_ksocket_send(padapter, precv_frame); ++ ++ /* goto _recv_indicatepkt_drop; */ ++ } ++#else ++ if (0x8899 == pattrib->eth_type) { ++ rtw_auto_ap_mode_rx(padapter, precv_frame); ++ ++ goto _recv_indicatepkt_end; ++ } ++#endif ++#endif ++#endif /* CONFIG_AUTO_AP_MODE */ ++ ++ /* TODO: move to core */ ++ { ++ _pkt *pkt = skb; ++ struct ethhdr *etherhdr = (struct ethhdr *)pkt->data; ++ struct sta_info *sta = precv_frame->u.hdr.psta; ++ ++ if (!sta) ++ goto bypass_session_tracker; ++ ++ if (ntohs(etherhdr->h_proto) == ETH_P_IP) { ++ u8 *ip = pkt->data + 14; ++ ++ if (GET_IPV4_PROTOCOL(ip) == 0x06 /* TCP */ ++ && rtw_st_ctl_chk_reg_s_proto(&sta->st_ctl, 0x06) == _TRUE ++ ) { ++ u8 *tcp = ip + GET_IPV4_IHL(ip) * 4; ++ ++ if (rtw_st_ctl_chk_reg_rule(&sta->st_ctl, padapter, IPV4_DST(ip), TCP_DST(tcp), IPV4_SRC(ip), TCP_SRC(tcp)) == _TRUE) { ++ if (GET_TCP_SYN(tcp) && GET_TCP_ACK(tcp)) { ++ session_tracker_add_cmd(padapter, sta ++ , IPV4_DST(ip), TCP_DST(tcp) ++ , IPV4_SRC(ip), TCP_SRC(tcp)); ++ if (DBG_SESSION_TRACKER) ++ RTW_INFO(FUNC_ADPT_FMT" local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT" SYN-ACK\n" ++ , FUNC_ADPT_ARG(padapter) ++ , IP_ARG(IPV4_DST(ip)), PORT_ARG(TCP_DST(tcp)) ++ , IP_ARG(IPV4_SRC(ip)), PORT_ARG(TCP_SRC(tcp))); ++ } ++ if (GET_TCP_FIN(tcp)) { ++ session_tracker_del_cmd(padapter, sta ++ , IPV4_DST(ip), TCP_DST(tcp) ++ , IPV4_SRC(ip), TCP_SRC(tcp)); ++ if (DBG_SESSION_TRACKER) ++ RTW_INFO(FUNC_ADPT_FMT" local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT" FIN\n" ++ , FUNC_ADPT_ARG(padapter) ++ , IP_ARG(IPV4_DST(ip)), PORT_ARG(TCP_DST(tcp)) ++ , IP_ARG(IPV4_SRC(ip)), PORT_ARG(TCP_SRC(tcp))); ++ } ++ } ++ ++ } ++ } ++bypass_session_tracker: ++ ; ++ } ++ ++ rtw_os_recv_indicate_pkt(padapter, skb, pattrib); ++ ++_recv_indicatepkt_end: ++ ++ precv_frame->u.hdr.pkt = NULL; /* pointers to NULL before rtw_free_recvframe() */ ++ ++ rtw_free_recvframe(precv_frame, pfree_recv_queue); ++ ++ ++ ++ return _SUCCESS; ++ ++_recv_indicatepkt_drop: ++ ++ /* enqueue back to free_recv_queue */ ++ if (precv_frame) ++ rtw_free_recvframe(precv_frame, pfree_recv_queue); ++ ++ DBG_COUNTER(padapter->rx_logs.os_indicate_err); ++ ++ return _FAIL; ++ ++} ++ ++void rtw_os_read_port(_adapter *padapter, struct recv_buf *precvbuf) ++{ ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ ++#ifdef CONFIG_USB_HCI ++ ++ precvbuf->ref_cnt--; ++ ++ /* free skb in recv_buf */ ++ rtw_skb_free(precvbuf->pskb); ++ ++ precvbuf->pskb = NULL; ++ ++ if (precvbuf->irp_pending == _FALSE) ++ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); ++ ++ ++#endif ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ precvbuf->pskb = NULL; ++#endif ++ ++} ++void _rtw_reordering_ctrl_timeout_handler(void *FunctionContext); ++void _rtw_reordering_ctrl_timeout_handler(void *FunctionContext) ++{ ++ struct recv_reorder_ctrl *preorder_ctrl = (struct recv_reorder_ctrl *)FunctionContext; ++ rtw_reordering_ctrl_timeout_handler(preorder_ctrl); ++} ++ ++void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl) ++{ ++ _adapter *padapter = preorder_ctrl->padapter; ++ ++ _init_timer(&(preorder_ctrl->reordering_ctrl_timer), padapter->pnetdev, _rtw_reordering_ctrl_timeout_handler, preorder_ctrl); ++ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_android.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_android.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_android.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_android.c 2018-02-11 21:44:27.176146528 +0200 +@@ -0,0 +1,1280 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#if defined(CONFIG_GPIO_WAKEUP) || defined(CONFIG_RTW_SDIO_OOB_INT) ++#include ++#endif ++ ++#include ++ ++#if defined(RTW_ENABLE_WIFI_CONTROL_FUNC) ++#include ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ #include ++#else ++ #include ++#endif ++#endif /* defined(RTW_ENABLE_WIFI_CONTROL_FUNC) */ ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) ++#define strnicmp strncasecmp ++#endif /* Linux kernel >= 4.0.0 */ ++ ++#if defined(CONFIG_GPIO_WAKEUP) || defined(CONFIG_RTW_SDIO_OOB_INT) ++#include ++#include ++#endif ++ ++#include "rtw_version.h" ++ ++extern void macstr2num(u8 *dst, u8 *src); ++ ++const char *android_wifi_cmd_str[ANDROID_WIFI_CMD_MAX] = { ++ "START", ++ "STOP", ++ "SCAN-ACTIVE", ++ "SCAN-PASSIVE", ++ "RSSI", ++ "LINKSPEED", ++ "RXFILTER-START", ++ "RXFILTER-STOP", ++ "RXFILTER-ADD", ++ "RXFILTER-REMOVE", ++ "BTCOEXSCAN-START", ++ "BTCOEXSCAN-STOP", ++ "BTCOEXMODE", ++ "SETSUSPENDOPT", ++ "P2P_DEV_ADDR", ++ "SETFWPATH", ++ "SETBAND", ++ "GETBAND", ++ "COUNTRY", ++ "P2P_SET_NOA", ++ "P2P_GET_NOA", ++ "P2P_SET_PS", ++ "SET_AP_WPS_P2P_IE", ++ ++ "MIRACAST", ++ ++#ifdef CONFIG_PNO_SUPPORT ++ "PNOSSIDCLR", ++ "PNOSETUP", ++ "PNOFORCE", ++ "PNODEBUG", ++#endif ++ ++ "MACADDR", ++ ++ "BLOCK_SCAN", ++ "BLOCK", ++ "WFD-ENABLE", ++ "WFD-DISABLE", ++ "WFD-SET-TCPPORT", ++ "WFD-SET-MAXTPUT", ++ "WFD-SET-DEVTYPE", ++ "SET_DTIM", ++ "HOSTAPD_SET_MACADDR_ACL", ++ "HOSTAPD_ACL_ADD_STA", ++ "HOSTAPD_ACL_REMOVE_STA", ++#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 1, 0)) ++ "GTK_REKEY_OFFLOAD", ++#endif /* CONFIG_GTK_OL */ ++/* Private command for P2P disable*/ ++ "P2P_DISABLE", ++ "DRIVER_VERSION" ++}; ++ ++#ifdef CONFIG_PNO_SUPPORT ++#define PNO_TLV_PREFIX 'S' ++#define PNO_TLV_VERSION '1' ++#define PNO_TLV_SUBVERSION '2' ++#define PNO_TLV_RESERVED '0' ++#define PNO_TLV_TYPE_SSID_IE 'S' ++#define PNO_TLV_TYPE_TIME 'T' ++#define PNO_TLV_FREQ_REPEAT 'R' ++#define PNO_TLV_FREQ_EXPO_MAX 'M' ++ ++typedef struct cmd_tlv { ++ char prefix; ++ char version; ++ char subver; ++ char reserved; ++} cmd_tlv_t; ++ ++#ifdef CONFIG_PNO_SET_DEBUG ++char pno_in_example[] = { ++ 'P', 'N', 'O', 'S', 'E', 'T', 'U', 'P', ' ', ++ 'S', '1', '2', '0', ++ 'S', /* 1 */ ++ 0x05, ++ 'd', 'l', 'i', 'n', 'k', ++ 'S', /* 2 */ ++ 0x06, ++ 'B', 'U', 'F', 'B', 'U', 'F', ++ 'S', /* 3 */ ++ 0x20, ++ 'a', 'b', 'c', 'd', 'e', 'f', 'g', 'h', 'i', 'j', 'k', 'l', 'm', 'n', 'o', 'p', 'q', 'r', 's', 't', 'u', 'v', 'w', 'x', 'y', 'z', '!', '@', '#', '$', '%', '^', ++ 'S', /* 4 */ ++ 0x0a, ++ '!', '@', '#', '$', '%', '^', '&', '*', '(', ')', ++ 'T', ++ '0', '5', ++ 'R', ++ '2', ++ 'M', ++ '2', ++ 0x00 ++}; ++#endif /* CONFIG_PNO_SET_DEBUG */ ++#endif /* PNO_SUPPORT */ ++ ++typedef struct android_wifi_priv_cmd { ++ char *buf; ++ int used_len; ++ int total_len; ++} android_wifi_priv_cmd; ++ ++#ifdef CONFIG_COMPAT ++typedef struct compat_android_wifi_priv_cmd { ++ compat_uptr_t buf; ++ int used_len; ++ int total_len; ++} compat_android_wifi_priv_cmd; ++#endif /* CONFIG_COMPAT */ ++ ++/** ++ * Local (static) functions and variables ++ */ ++ ++/* Initialize g_wifi_on to 1 so dhd_bus_start will be called for the first ++ * time (only) in dhd_open, subsequential wifi on will be handled by ++ * wl_android_wifi_on ++ */ ++static int g_wifi_on = _TRUE; ++ ++unsigned int oob_irq = 0; ++unsigned int oob_gpio = 0; ++ ++#ifdef CONFIG_PNO_SUPPORT ++/* ++ * rtw_android_pno_setup ++ * Description: ++ * This is used for private command. ++ * ++ * Parameter: ++ * net: net_device ++ * command: parameters from private command ++ * total_len: the length of the command. ++ * ++ * */ ++static int rtw_android_pno_setup(struct net_device *net, char *command, int total_len) ++{ ++ pno_ssid_t pno_ssids_local[MAX_PNO_LIST_COUNT]; ++ int res = -1; ++ int nssid = 0; ++ cmd_tlv_t *cmd_tlv_temp; ++ char *str_ptr; ++ int tlv_size_left; ++ int pno_time = 0; ++ int pno_repeat = 0; ++ int pno_freq_expo_max = 0; ++ int cmdlen = strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_PNOSETUP_SET]) + 1; ++ ++#ifdef CONFIG_PNO_SET_DEBUG ++ int i; ++ char *p; ++ p = pno_in_example; ++ ++ total_len = sizeof(pno_in_example); ++ str_ptr = p + cmdlen; ++#else ++ str_ptr = command + cmdlen; ++#endif ++ ++ if (total_len < (cmdlen + sizeof(cmd_tlv_t))) { ++ RTW_INFO("%s argument=%d less min size\n", __func__, total_len); ++ goto exit_proc; ++ } ++ ++ tlv_size_left = total_len - cmdlen; ++ ++ cmd_tlv_temp = (cmd_tlv_t *)str_ptr; ++ memset(pno_ssids_local, 0, sizeof(pno_ssids_local)); ++ ++ if ((cmd_tlv_temp->prefix == PNO_TLV_PREFIX) && ++ (cmd_tlv_temp->version == PNO_TLV_VERSION) && ++ (cmd_tlv_temp->subver == PNO_TLV_SUBVERSION)) { ++ ++ str_ptr += sizeof(cmd_tlv_t); ++ tlv_size_left -= sizeof(cmd_tlv_t); ++ ++ nssid = rtw_parse_ssid_list_tlv(&str_ptr, pno_ssids_local, ++ MAX_PNO_LIST_COUNT, &tlv_size_left); ++ if (nssid <= 0) { ++ RTW_INFO("SSID is not presented or corrupted ret=%d\n", nssid); ++ goto exit_proc; ++ } else { ++ if ((str_ptr[0] != PNO_TLV_TYPE_TIME) || (tlv_size_left <= 1)) { ++ RTW_INFO("%s scan duration corrupted field size %d\n", ++ __func__, tlv_size_left); ++ goto exit_proc; ++ } ++ str_ptr++; ++ pno_time = simple_strtoul(str_ptr, &str_ptr, 16); ++ RTW_INFO("%s: pno_time=%d\n", __func__, pno_time); ++ ++ if (str_ptr[0] != 0) { ++ if ((str_ptr[0] != PNO_TLV_FREQ_REPEAT)) { ++ RTW_INFO("%s pno repeat : corrupted field\n", ++ __func__); ++ goto exit_proc; ++ } ++ str_ptr++; ++ pno_repeat = simple_strtoul(str_ptr, &str_ptr, 16); ++ RTW_INFO("%s :got pno_repeat=%d\n", __FUNCTION__, pno_repeat); ++ if (str_ptr[0] != PNO_TLV_FREQ_EXPO_MAX) { ++ RTW_INFO("%s FREQ_EXPO_MAX corrupted field size\n", ++ __func__); ++ goto exit_proc; ++ } ++ str_ptr++; ++ pno_freq_expo_max = simple_strtoul(str_ptr, &str_ptr, 16); ++ RTW_INFO("%s: pno_freq_expo_max=%d\n", ++ __func__, pno_freq_expo_max); ++ } ++ } ++ } else { ++ RTW_INFO("%s get wrong TLV command\n", __FUNCTION__); ++ goto exit_proc; ++ } ++ ++ res = rtw_dev_pno_set(net, pno_ssids_local, nssid, pno_time, pno_repeat, pno_freq_expo_max); ++ ++#ifdef CONFIG_PNO_SET_DEBUG ++ rtw_dev_pno_debug(net); ++#endif ++ ++exit_proc: ++ return res; ++} ++ ++/* ++ * rtw_android_cfg80211_pno_setup ++ * Description: ++ * This is used for cfg80211 sched_scan. ++ * ++ * Parameter: ++ * net: net_device ++ * request: cfg80211_request ++ * */ ++ ++int rtw_android_cfg80211_pno_setup(struct net_device *net, ++ struct cfg80211_ssid *ssids, int n_ssids, int interval) ++{ ++ int res = -1; ++ int nssid = 0; ++ int pno_time = 0; ++ int pno_repeat = 0; ++ int pno_freq_expo_max = 0; ++ int index = 0; ++ pno_ssid_t pno_ssids_local[MAX_PNO_LIST_COUNT]; ++ ++ if (n_ssids > MAX_PNO_LIST_COUNT || n_ssids < 0) { ++ RTW_INFO("%s: nssids(%d) is invalid.\n", __func__, n_ssids); ++ return -EINVAL; ++ } ++ ++ memset(pno_ssids_local, 0, sizeof(pno_ssids_local)); ++ ++ nssid = n_ssids; ++ ++ for (index = 0 ; index < nssid ; index++) { ++ pno_ssids_local[index].SSID_len = ssids[index].ssid_len; ++ memcpy(pno_ssids_local[index].SSID, ssids[index].ssid, ++ ssids[index].ssid_len); ++ } ++ ++ pno_time = (interval / 1000); ++ ++ RTW_INFO("%s: nssids: %d, pno_time=%d\n", __func__, nssid, pno_time); ++ ++ res = rtw_dev_pno_set(net, pno_ssids_local, nssid, pno_time, ++ pno_repeat, pno_freq_expo_max); ++ ++#ifdef CONFIG_PNO_SET_DEBUG ++ rtw_dev_pno_debug(net); ++#endif ++exit_proc: ++ return res; ++} ++ ++int rtw_android_pno_enable(struct net_device *net, int pno_enable) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); ++ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); ++ ++ if (pwrctl) { ++ pwrctl->wowlan_pno_enable = pno_enable; ++ RTW_INFO("%s: wowlan_pno_enable: %d\n", __func__, pwrctl->wowlan_pno_enable); ++ if (pwrctl->wowlan_pno_enable == 0) { ++ if (pwrctl->pnlo_info != NULL) { ++ rtw_mfree((u8 *)pwrctl->pnlo_info, sizeof(pno_nlo_info_t)); ++ pwrctl->pnlo_info = NULL; ++ } ++ if (pwrctl->pno_ssid_list != NULL) { ++ rtw_mfree((u8 *)pwrctl->pno_ssid_list, sizeof(pno_ssid_list_t)); ++ pwrctl->pno_ssid_list = NULL; ++ } ++ if (pwrctl->pscan_info != NULL) { ++ rtw_mfree((u8 *)pwrctl->pscan_info, sizeof(pno_scan_info_t)); ++ pwrctl->pscan_info = NULL; ++ } ++ } ++ return 0; ++ } else ++ return -1; ++} ++#endif /* CONFIG_PNO_SUPPORT */ ++ ++int rtw_android_cmdstr_to_num(char *cmdstr) ++{ ++ int cmd_num; ++ for (cmd_num = 0 ; cmd_num < ANDROID_WIFI_CMD_MAX; cmd_num++) ++ if (0 == strnicmp(cmdstr , android_wifi_cmd_str[cmd_num], strlen(android_wifi_cmd_str[cmd_num]))) ++ break; ++ ++ return cmd_num; ++} ++ ++int rtw_android_get_rssi(struct net_device *net, char *command, int total_len) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct wlan_network *pcur_network = &pmlmepriv->cur_network; ++ int bytes_written = 0; ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ bytes_written += snprintf(&command[bytes_written], total_len, "%s rssi %d", ++ pcur_network->network.Ssid.Ssid, padapter->recvpriv.rssi); ++ } ++ ++ return bytes_written; ++} ++ ++int rtw_android_get_link_speed(struct net_device *net, char *command, int total_len) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct wlan_network *pcur_network = &pmlmepriv->cur_network; ++ int bytes_written = 0; ++ u16 link_speed = 0; ++ ++ link_speed = rtw_get_cur_max_rate(padapter) / 10; ++ bytes_written = snprintf(command, total_len, "LinkSpeed %d", link_speed); ++ ++ return bytes_written; ++} ++ ++int rtw_android_get_macaddr(struct net_device *net, char *command, int total_len) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); ++ int bytes_written = 0; ++ ++ bytes_written = snprintf(command, total_len, "Macaddr = "MAC_FMT, MAC_ARG(net->dev_addr)); ++ return bytes_written; ++} ++ ++int rtw_android_set_country(struct net_device *net, char *command, int total_len) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); ++ char *country_code = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_COUNTRY]) + 1; ++ int ret = _FAIL; ++ ++ ret = rtw_set_country(adapter, country_code); ++ ++ return (ret == _SUCCESS) ? 0 : -1; ++} ++ ++int rtw_android_get_p2p_dev_addr(struct net_device *net, char *command, int total_len) ++{ ++ int bytes_written = 0; ++ ++ /* We use the same address as our HW MAC address */ ++ _rtw_memcpy(command, net->dev_addr, ETH_ALEN); ++ ++ bytes_written = ETH_ALEN; ++ return bytes_written; ++} ++ ++int rtw_android_set_block_scan(struct net_device *net, char *command, int total_len) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); ++ char *block_value = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_BLOCK_SCAN]) + 1; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ adapter_wdev_data(adapter)->block_scan = (*block_value == '0') ? _FALSE : _TRUE; ++#endif ++ ++ return 0; ++} ++ ++int rtw_android_set_block(struct net_device *net, char *command, int total_len) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); ++ char *block_value = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_BLOCK]) + 1; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ adapter_wdev_data(adapter)->block = (*block_value == '0') ? _FALSE : _TRUE; ++#endif ++ ++ return 0; ++} ++ ++int rtw_android_setband(struct net_device *net, char *command, int total_len) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); ++ char *arg = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_SETBAND]) + 1; ++ u32 band = WIFI_FREQUENCY_BAND_AUTO; ++ int ret = _FAIL; ++ ++ if (sscanf(arg, "%u", &band) >= 1) ++ ret = rtw_set_band(adapter, band); ++ ++ return (ret == _SUCCESS) ? 0 : -1; ++} ++ ++int rtw_android_getband(struct net_device *net, char *command, int total_len) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); ++ int bytes_written = 0; ++ ++ bytes_written = snprintf(command, total_len, "%u", adapter->setband); ++ ++ return bytes_written; ++} ++ ++#ifdef CONFIG_WFD ++int rtw_android_set_miracast_mode(struct net_device *net, char *command, int total_len) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); ++ struct wifi_display_info *wfd_info = &adapter->wfd_info; ++ char *arg = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_MIRACAST]) + 1; ++ u8 mode; ++ int num; ++ int ret = _FAIL; ++ ++ num = sscanf(arg, "%hhu", &mode); ++ ++ if (num < 1) ++ goto exit; ++ ++ switch (mode) { ++ case 1: /* soruce */ ++ mode = MIRACAST_SOURCE; ++ break; ++ case 2: /* sink */ ++ mode = MIRACAST_SINK; ++ break; ++ case 0: /* disabled */ ++ default: ++ mode = MIRACAST_DISABLED; ++ break; ++ } ++ wfd_info->stack_wfd_mode = mode; ++ RTW_INFO("stack miracast mode: %s\n", get_miracast_mode_str(wfd_info->stack_wfd_mode)); ++ ++ ret = _SUCCESS; ++ ++exit: ++ return (ret == _SUCCESS) ? 0 : -1; ++} ++#endif /* CONFIG_WFD */ ++ ++int get_int_from_command(char *pcmd) ++{ ++ int i = 0; ++ ++ for (i = 0; i < strlen(pcmd); i++) { ++ if (pcmd[i] == '=') { ++ /* Skip the '=' and space characters. */ ++ i += 2; ++ break; ++ } ++ } ++ return rtw_atoi(pcmd + i) ; ++} ++ ++#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 1, 0)) ++int rtw_gtk_offload(struct net_device *net, u8 *cmd_ptr) ++{ ++ int i; ++ /* u8 *cmd_ptr = priv_cmd.buf; */ ++ struct sta_info *psta; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct security_priv *psecuritypriv = &(padapter->securitypriv); ++ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); ++ ++ ++ if (psta == NULL) ++ RTW_INFO("%s, : Obtain Sta_info fail\n", __func__); ++ else { ++ /* string command length of "GTK_REKEY_OFFLOAD" */ ++ cmd_ptr += 18; ++ ++ _rtw_memcpy(psta->kek, cmd_ptr, RTW_KEK_LEN); ++ cmd_ptr += RTW_KEK_LEN; ++ /* ++ printk("supplicant KEK: "); ++ for(i=0;ikek[i]); ++ printk("\n supplicant KCK: "); ++ */ ++ _rtw_memcpy(psta->kck, cmd_ptr, RTW_KCK_LEN); ++ cmd_ptr += RTW_KCK_LEN; ++ /* ++ for(i=0;ikck[i]); ++ */ ++ _rtw_memcpy(psta->replay_ctr, cmd_ptr, RTW_REPLAY_CTR_LEN); ++ psecuritypriv->binstallKCK_KEK = _TRUE; ++ ++ /* printk("\nREPLAY_CTR: "); */ ++ /* for(i=0;ireplay_ctr[i]); */ ++ } ++ ++ return _SUCCESS; ++} ++#endif /* CONFIG_GTK_OL */ ++ ++int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) ++{ ++ int ret = 0; ++ char *command = NULL; ++ int cmd_num; ++ int bytes_written = 0; ++#ifdef CONFIG_PNO_SUPPORT ++ uint cmdlen = 0; ++ uint pno_enable = 0; ++#endif ++ android_wifi_priv_cmd priv_cmd; ++ _adapter *padapter = (_adapter *) rtw_netdev_priv(net); ++#ifdef CONFIG_WFD ++ struct wifi_display_info *pwfd_info; ++#endif ++ ++ rtw_lock_suspend(); ++ ++ if (!ifr->ifr_data) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ if (padapter->registrypriv.mp_mode == 1) { ++ ret = -EINVAL; ++ goto exit; ++ } ++#ifdef CONFIG_COMPAT ++#if (KERNEL_VERSION(4, 6, 0) > LINUX_VERSION_CODE) ++ if (is_compat_task()) { ++#else ++ if (in_compat_syscall()) { ++#endif ++ /* User space is 32-bit, use compat ioctl */ ++ compat_android_wifi_priv_cmd compat_priv_cmd; ++ ++ if (copy_from_user(&compat_priv_cmd, ifr->ifr_data, sizeof(compat_android_wifi_priv_cmd))) { ++ ret = -EFAULT; ++ goto exit; ++ } ++ priv_cmd.buf = compat_ptr(compat_priv_cmd.buf); ++ priv_cmd.used_len = compat_priv_cmd.used_len; ++ priv_cmd.total_len = compat_priv_cmd.total_len; ++ } else ++#endif /* CONFIG_COMPAT */ ++ if (copy_from_user(&priv_cmd, ifr->ifr_data, sizeof(android_wifi_priv_cmd))) { ++ ret = -EFAULT; ++ goto exit; ++ } ++ if (padapter->registrypriv.mp_mode == 1) { ++ ret = -EFAULT; ++ goto exit; ++ } ++ /*RTW_INFO("%s priv_cmd.buf=%p priv_cmd.total_len=%d priv_cmd.used_len=%d\n",__func__,priv_cmd.buf,priv_cmd.total_len,priv_cmd.used_len);*/ ++ command = rtw_zmalloc(priv_cmd.total_len); ++ if (!command) { ++ RTW_INFO("%s: failed to allocate memory\n", __FUNCTION__); ++ ret = -ENOMEM; ++ goto exit; ++ } ++ ++ if (!access_ok(VERIFY_READ, priv_cmd.buf, priv_cmd.total_len)) { ++ RTW_INFO("%s: failed to access memory\n", __FUNCTION__); ++ ret = -EFAULT; ++ goto exit; ++ } ++ if (copy_from_user(command, (void *)priv_cmd.buf, priv_cmd.total_len)) { ++ ret = -EFAULT; ++ goto exit; ++ } ++ ++ RTW_INFO("%s: Android private cmd \"%s\" on %s\n" ++ , __FUNCTION__, command, ifr->ifr_name); ++ ++ cmd_num = rtw_android_cmdstr_to_num(command); ++ ++ switch (cmd_num) { ++ case ANDROID_WIFI_CMD_START: ++ /* bytes_written = wl_android_wifi_on(net); */ ++ goto response; ++ case ANDROID_WIFI_CMD_SETFWPATH: ++ goto response; ++ } ++ ++ if (!g_wifi_on) { ++ RTW_INFO("%s: Ignore private cmd \"%s\" - iface %s is down\n" ++ , __FUNCTION__, command, ifr->ifr_name); ++ ret = 0; ++ goto exit; ++ } ++ ++ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) { ++ switch (cmd_num) { ++ case ANDROID_WIFI_CMD_WFD_ENABLE: ++ case ANDROID_WIFI_CMD_WFD_DISABLE: ++ case ANDROID_WIFI_CMD_WFD_SET_TCPPORT: ++ case ANDROID_WIFI_CMD_WFD_SET_MAX_TPUT: ++ case ANDROID_WIFI_CMD_WFD_SET_DEVTYPE: ++ goto response; ++ } ++ } ++ ++ switch (cmd_num) { ++ ++ case ANDROID_WIFI_CMD_STOP: ++ /* bytes_written = wl_android_wifi_off(net); */ ++ break; ++ ++ case ANDROID_WIFI_CMD_SCAN_ACTIVE: ++ /* rtw_set_scan_mode((_adapter *)rtw_netdev_priv(net), SCAN_ACTIVE); */ ++#ifdef CONFIG_PLATFORM_MSTAR ++#ifdef CONFIG_IOCTL_CFG80211 ++ adapter_wdev_data((_adapter *)rtw_netdev_priv(net))->bandroid_scan = _TRUE; ++#endif /* CONFIG_IOCTL_CFG80211 */ ++#endif /* CONFIG_PLATFORM_MSTAR */ ++ break; ++ case ANDROID_WIFI_CMD_SCAN_PASSIVE: ++ /* rtw_set_scan_mode((_adapter *)rtw_netdev_priv(net), SCAN_PASSIVE); */ ++ break; ++ ++ case ANDROID_WIFI_CMD_RSSI: ++ bytes_written = rtw_android_get_rssi(net, command, priv_cmd.total_len); ++ break; ++ case ANDROID_WIFI_CMD_LINKSPEED: ++ bytes_written = rtw_android_get_link_speed(net, command, priv_cmd.total_len); ++ break; ++ ++ case ANDROID_WIFI_CMD_MACADDR: ++ bytes_written = rtw_android_get_macaddr(net, command, priv_cmd.total_len); ++ break; ++ ++ case ANDROID_WIFI_CMD_BLOCK_SCAN: ++ bytes_written = rtw_android_set_block_scan(net, command, priv_cmd.total_len); ++ break; ++ ++ case ANDROID_WIFI_CMD_BLOCK: ++ bytes_written = rtw_android_set_block(net, command, priv_cmd.total_len); ++ break; ++ ++ case ANDROID_WIFI_CMD_RXFILTER_START: ++ /* bytes_written = net_os_set_packet_filter(net, 1); */ ++ break; ++ case ANDROID_WIFI_CMD_RXFILTER_STOP: ++ /* bytes_written = net_os_set_packet_filter(net, 0); */ ++ break; ++ case ANDROID_WIFI_CMD_RXFILTER_ADD: ++ /* int filter_num = *(command + strlen(CMD_RXFILTER_ADD) + 1) - '0'; */ ++ /* bytes_written = net_os_rxfilter_add_remove(net, TRUE, filter_num); */ ++ break; ++ case ANDROID_WIFI_CMD_RXFILTER_REMOVE: ++ /* int filter_num = *(command + strlen(CMD_RXFILTER_REMOVE) + 1) - '0'; */ ++ /* bytes_written = net_os_rxfilter_add_remove(net, FALSE, filter_num); */ ++ break; ++ ++ case ANDROID_WIFI_CMD_BTCOEXSCAN_START: ++ /* TBD: BTCOEXSCAN-START */ ++ break; ++ case ANDROID_WIFI_CMD_BTCOEXSCAN_STOP: ++ /* TBD: BTCOEXSCAN-STOP */ ++ break; ++ case ANDROID_WIFI_CMD_BTCOEXMODE: ++#if 0 ++ uint mode = *(command + strlen(CMD_BTCOEXMODE) + 1) - '0'; ++ if (mode == 1) ++ net_os_set_packet_filter(net, 0); /* DHCP starts */ ++ else ++ net_os_set_packet_filter(net, 1); /* DHCP ends */ ++#ifdef WL_CFG80211 ++ bytes_written = wl_cfg80211_set_btcoex_dhcp(net, command); ++#endif ++#endif ++ break; ++ ++ case ANDROID_WIFI_CMD_SETSUSPENDOPT: ++ /* bytes_written = wl_android_set_suspendopt(net, command, priv_cmd.total_len); */ ++ break; ++ ++ case ANDROID_WIFI_CMD_SETBAND: ++ bytes_written = rtw_android_setband(net, command, priv_cmd.total_len); ++ break; ++ ++ case ANDROID_WIFI_CMD_GETBAND: ++ bytes_written = rtw_android_getband(net, command, priv_cmd.total_len); ++ break; ++ ++ case ANDROID_WIFI_CMD_COUNTRY: ++ bytes_written = rtw_android_set_country(net, command, priv_cmd.total_len); ++ break; ++ ++#ifdef CONFIG_PNO_SUPPORT ++ case ANDROID_WIFI_CMD_PNOSSIDCLR_SET: ++ /* bytes_written = dhd_dev_pno_reset(net); */ ++ break; ++ case ANDROID_WIFI_CMD_PNOSETUP_SET: ++ bytes_written = rtw_android_pno_setup(net, command, priv_cmd.total_len); ++ break; ++ case ANDROID_WIFI_CMD_PNOENABLE_SET: ++ cmdlen = strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_PNOENABLE_SET]); ++ pno_enable = *(command + cmdlen + 1) - '0'; ++ bytes_written = rtw_android_pno_enable(net, pno_enable); ++ break; ++#endif ++ ++ case ANDROID_WIFI_CMD_P2P_DEV_ADDR: ++ bytes_written = rtw_android_get_p2p_dev_addr(net, command, priv_cmd.total_len); ++ break; ++ case ANDROID_WIFI_CMD_P2P_SET_NOA: ++ /* int skip = strlen(CMD_P2P_SET_NOA) + 1; */ ++ /* bytes_written = wl_cfg80211_set_p2p_noa(net, command + skip, priv_cmd.total_len - skip); */ ++ break; ++ case ANDROID_WIFI_CMD_P2P_GET_NOA: ++ /* bytes_written = wl_cfg80211_get_p2p_noa(net, command, priv_cmd.total_len); */ ++ break; ++ case ANDROID_WIFI_CMD_P2P_SET_PS: ++ /* int skip = strlen(CMD_P2P_SET_PS) + 1; */ ++ /* bytes_written = wl_cfg80211_set_p2p_ps(net, command + skip, priv_cmd.total_len - skip); */ ++ break; ++ ++#if defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_P2P) ++ case ANDROID_WIFI_CMD_SET_AP_WPS_P2P_IE: { ++ int skip = strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_SET_AP_WPS_P2P_IE]) + 3; ++ bytes_written = rtw_cfg80211_set_mgnt_wpsp2pie(net, command + skip, priv_cmd.total_len - skip, *(command + skip - 2) - '0'); ++ break; ++ } ++#endif /* CONFIG_IOCTL_CFG80211 && CONFIG_P2P */ ++ ++#ifdef CONFIG_WFD ++ ++ case ANDROID_WIFI_CMD_MIRACAST: ++ bytes_written = rtw_android_set_miracast_mode(net, command, priv_cmd.total_len); ++ break; ++ ++ case ANDROID_WIFI_CMD_WFD_ENABLE: { ++ /* Commented by Albert 2012/07/24 */ ++ /* We can enable the WFD function by using the following command: */ ++ /* wpa_cli driver wfd-enable */ ++ ++ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) ++ rtw_wfd_enable(padapter, 1); ++ break; ++ } ++ ++ case ANDROID_WIFI_CMD_WFD_DISABLE: { ++ /* Commented by Albert 2012/07/24 */ ++ /* We can disable the WFD function by using the following command: */ ++ /* wpa_cli driver wfd-disable */ ++ ++ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) ++ rtw_wfd_enable(padapter, 0); ++ break; ++ } ++ case ANDROID_WIFI_CMD_WFD_SET_TCPPORT: { ++ /* Commented by Albert 2012/07/24 */ ++ /* We can set the tcp port number by using the following command: */ ++ /* wpa_cli driver wfd-set-tcpport = 554 */ ++ ++ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) ++ rtw_wfd_set_ctrl_port(padapter, (u16)get_int_from_command(priv_cmd.buf)); ++ break; ++ } ++ case ANDROID_WIFI_CMD_WFD_SET_MAX_TPUT: { ++ break; ++ } ++ case ANDROID_WIFI_CMD_WFD_SET_DEVTYPE: { ++ /* Commented by Albert 2012/08/28 */ ++ /* Specify the WFD device type ( WFD source/primary sink ) */ ++ ++ pwfd_info = &padapter->wfd_info; ++ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) { ++ pwfd_info->wfd_device_type = (u8) get_int_from_command(priv_cmd.buf); ++ pwfd_info->wfd_device_type &= WFD_DEVINFO_DUAL; ++ } ++ break; ++ } ++#endif ++ case ANDROID_WIFI_CMD_CHANGE_DTIM: { ++#ifdef CONFIG_LPS ++ u8 dtim; ++ u8 *ptr = (u8 *) &priv_cmd.buf; ++ ++ ptr += 9;/* string command length of "SET_DTIM"; */ ++ ++ dtim = rtw_atoi(ptr); ++ ++ RTW_INFO("DTIM=%d\n", dtim); ++ ++ rtw_lps_change_dtim_cmd(padapter, dtim); ++#endif ++ } ++ break; ++ ++#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) ++ case ANDROID_WIFI_CMD_HOSTAPD_SET_MACADDR_ACL: { ++ rtw_set_macaddr_acl(padapter, get_int_from_command(command)); ++ break; ++ } ++ case ANDROID_WIFI_CMD_HOSTAPD_ACL_ADD_STA: { ++ u8 addr[ETH_ALEN] = {0x00}; ++ macstr2num(addr, command + strlen("HOSTAPD_ACL_ADD_STA") + 3); /* 3 is space bar + "=" + space bar these 3 chars */ ++ rtw_acl_add_sta(padapter, addr); ++ break; ++ } ++ case ANDROID_WIFI_CMD_HOSTAPD_ACL_REMOVE_STA: { ++ u8 addr[ETH_ALEN] = {0x00}; ++ macstr2num(addr, command + strlen("HOSTAPD_ACL_REMOVE_STA") + 3); /* 3 is space bar + "=" + space bar these 3 chars */ ++ rtw_acl_remove_sta(padapter, addr); ++ break; ++ } ++#endif /* CONFIG_RTW_MACADDR_ACL */ ++#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 1, 0)) ++ case ANDROID_WIFI_CMD_GTK_REKEY_OFFLOAD: ++ rtw_gtk_offload(net, (u8 *)command); ++ break; ++#endif /* CONFIG_GTK_OL */ ++ case ANDROID_WIFI_CMD_P2P_DISABLE: { ++#ifdef CONFIG_P2P ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ u8 channel, ch_offset; ++ u16 bwmode; ++ ++ rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); ++#endif /* CONFIG_P2P */ ++ break; ++ } ++ case ANDROID_WIFI_CMD_DRIVERVERSION: { ++ bytes_written = strlen(DRIVERVERSION); ++ snprintf(command, bytes_written + 1, DRIVERVERSION); ++ break; ++ } ++ default: ++ RTW_INFO("Unknown PRIVATE command %s - ignored\n", command); ++ snprintf(command, 3, "OK"); ++ bytes_written = strlen("OK"); ++ } ++ ++response: ++ if (bytes_written >= 0) { ++ if ((bytes_written == 0) && (priv_cmd.total_len > 0)) ++ command[0] = '\0'; ++ if (bytes_written >= priv_cmd.total_len) { ++ RTW_INFO("%s: bytes_written = %d\n", __FUNCTION__, bytes_written); ++ bytes_written = priv_cmd.total_len; ++ } else ++ bytes_written++; ++ priv_cmd.used_len = bytes_written; ++ if (copy_to_user((void *)priv_cmd.buf, command, bytes_written)) { ++ RTW_INFO("%s: failed to copy data to user buffer\n", __FUNCTION__); ++ ret = -EFAULT; ++ } ++ } else ++ ret = bytes_written; ++ ++exit: ++ rtw_unlock_suspend(); ++ if (command) ++ rtw_mfree(command, priv_cmd.total_len); ++ ++ return ret; ++} ++ ++ ++/** ++ * Functions for Android WiFi card detection ++ */ ++#if defined(RTW_ENABLE_WIFI_CONTROL_FUNC) ++ ++static int g_wifidev_registered = 0; ++static struct semaphore wifi_control_sem; ++static struct wifi_platform_data *wifi_control_data = NULL; ++static struct resource *wifi_irqres = NULL; ++ ++static int wifi_add_dev(void); ++static void wifi_del_dev(void); ++ ++int rtw_android_wifictrl_func_add(void) ++{ ++ int ret = 0; ++ sema_init(&wifi_control_sem, 0); ++ ++ ret = wifi_add_dev(); ++ if (ret) { ++ RTW_INFO("%s: platform_driver_register failed\n", __FUNCTION__); ++ return ret; ++ } ++ g_wifidev_registered = 1; ++ ++ /* Waiting callback after platform_driver_register is done or exit with error */ ++ if (down_timeout(&wifi_control_sem, msecs_to_jiffies(1000)) != 0) { ++ ret = -EINVAL; ++ RTW_INFO("%s: platform_driver_register timeout\n", __FUNCTION__); ++ } ++ ++ return ret; ++} ++ ++void rtw_android_wifictrl_func_del(void) ++{ ++ if (g_wifidev_registered) { ++ wifi_del_dev(); ++ g_wifidev_registered = 0; ++ } ++} ++ ++void *wl_android_prealloc(int section, unsigned long size) ++{ ++ void *alloc_ptr = NULL; ++ if (wifi_control_data && wifi_control_data->mem_prealloc) { ++ alloc_ptr = wifi_control_data->mem_prealloc(section, size); ++ if (alloc_ptr) { ++ RTW_INFO("success alloc section %d\n", section); ++ if (size != 0L) ++ memset(alloc_ptr, 0, size); ++ return alloc_ptr; ++ } ++ } ++ ++ RTW_INFO("can't alloc section %d\n", section); ++ return NULL; ++} ++ ++int wifi_get_irq_number(unsigned long *irq_flags_ptr) ++{ ++ if (wifi_irqres) { ++ *irq_flags_ptr = wifi_irqres->flags & IRQF_TRIGGER_MASK; ++ return (int)wifi_irqres->start; ++ } ++#ifdef CUSTOM_OOB_GPIO_NUM ++ return CUSTOM_OOB_GPIO_NUM; ++#else ++ return -1; ++#endif ++} ++ ++int wifi_set_power(int on, unsigned long msec) ++{ ++ RTW_INFO("%s = %d\n", __FUNCTION__, on); ++ if (wifi_control_data && wifi_control_data->set_power) ++ wifi_control_data->set_power(on); ++ if (msec) ++ msleep(msec); ++ return 0; ++} ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++int wifi_get_mac_addr(unsigned char *buf) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ if (!buf) ++ return -EINVAL; ++ if (wifi_control_data && wifi_control_data->get_mac_addr) ++ return wifi_control_data->get_mac_addr(buf); ++ return -EOPNOTSUPP; ++} ++#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) */ ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39)) || defined(COMPAT_KERNEL_RELEASE) ++void *wifi_get_country_code(char *ccode) ++{ ++ RTW_INFO("%s\n", __FUNCTION__); ++ if (!ccode) ++ return NULL; ++ if (wifi_control_data && wifi_control_data->get_country_code) ++ return wifi_control_data->get_country_code(ccode); ++ return NULL; ++} ++#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39)) */ ++ ++static int wifi_set_carddetect(int on) ++{ ++ RTW_INFO("%s = %d\n", __FUNCTION__, on); ++ if (wifi_control_data && wifi_control_data->set_carddetect) ++ wifi_control_data->set_carddetect(on); ++ return 0; ++} ++ ++static int wifi_probe(struct platform_device *pdev) ++{ ++ struct wifi_platform_data *wifi_ctrl = ++ (struct wifi_platform_data *)(pdev->dev.platform_data); ++ int wifi_wake_gpio = 0; ++ ++ RTW_INFO("## %s\n", __FUNCTION__); ++ wifi_irqres = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "bcmdhd_wlan_irq"); ++ ++ if (wifi_irqres == NULL) ++ wifi_irqres = platform_get_resource_byname(pdev, ++ IORESOURCE_IRQ, "bcm4329_wlan_irq"); ++ else ++ wifi_wake_gpio = wifi_irqres->start; ++ ++#if defined(CONFIG_GPIO_WAKEUP) || defined(CONFIG_RTW_SDIO_OOB_INT) ++ RTW_INFO("%s: gpio:%d wifi_wake_gpio:%d\n", __func__, ++ (int)wifi_irqres->start, wifi_wake_gpio); ++ ++ if (wifi_wake_gpio > 0) { ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++ wifi_configure_gpio(); ++#else /* CONFIG_PLATFORM_INTEL_BYT */ ++ gpio_request(wifi_wake_gpio, "oob_irq"); ++ gpio_direction_input(wifi_wake_gpio); ++ oob_irq = gpio_to_irq(wifi_wake_gpio); ++#endif /* CONFIG_PLATFORM_INTEL_BYT */ ++ printk("%s oob_irq:%d\n", __func__, oob_irq); ++ } else if (wifi_irqres) { ++ oob_irq = wifi_irqres->start; ++ printk("%s oob_irq:%d\n", __func__, oob_irq); ++ } ++#endif ++ wifi_control_data = wifi_ctrl; ++ ++ wifi_set_power(1, 0); /* Power On */ ++ wifi_set_carddetect(1); /* CardDetect (0->1) */ ++ ++ if (oob_irq != 0) ++ enable_irq_wake(oob_irq); ++ ++ up(&wifi_control_sem); ++ return 0; ++} ++ ++#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN ++extern PADAPTER g_test_adapter; ++ ++static void shutdown_card(void) ++{ ++ u32 addr; ++ u8 tmp8, cnt = 0; ++ ++ if (NULL == g_test_adapter) { ++ RTW_INFO("%s: padapter==NULL\n", __FUNCTION__); ++ return; ++ } ++ ++#ifdef CONFIG_FWLPS_IN_IPS ++ LeaveAllPowerSaveMode(g_test_adapter); ++#endif /* CONFIG_FWLPS_IN_IPS */ ++ ++ /* Leave SDIO HCI Suspend */ ++ addr = 0x10250086; ++ rtw_write8(g_test_adapter, addr, 0); ++ do { ++ tmp8 = rtw_read8(g_test_adapter, addr); ++ cnt++; ++ RTW_INFO(FUNC_ADPT_FMT ": polling SDIO_HSUS_CTRL(0x%x)=0x%x, cnt=%d\n", ++ FUNC_ADPT_ARG(g_test_adapter), addr, tmp8, cnt); ++ ++ if (tmp8 & BIT(1)) ++ break; ++ ++ if (cnt >= 100) { ++ RTW_INFO(FUNC_ADPT_FMT ": polling 0x%x[1]==1 FAIL!!\n", ++ FUNC_ADPT_ARG(g_test_adapter), addr); ++ break; ++ } ++ ++ rtw_mdelay_os(10); ++ } while (1); ++ ++ /* unlock register I/O */ ++ rtw_write8(g_test_adapter, 0x1C, 0); ++ ++ /* enable power down function */ ++ /* 0x04[4] = 1 */ ++ /* 0x05[7] = 1 */ ++ addr = 0x04; ++ tmp8 = rtw_read8(g_test_adapter, addr); ++ tmp8 |= BIT(4); ++ rtw_write8(g_test_adapter, addr, tmp8); ++ RTW_INFO(FUNC_ADPT_FMT ": read after write 0x%x=0x%x\n", ++ FUNC_ADPT_ARG(g_test_adapter), addr, rtw_read8(g_test_adapter, addr)); ++ ++ addr = 0x05; ++ tmp8 = rtw_read8(g_test_adapter, addr); ++ tmp8 |= BIT(7); ++ rtw_write8(g_test_adapter, addr, tmp8); ++ RTW_INFO(FUNC_ADPT_FMT ": read after write 0x%x=0x%x\n", ++ FUNC_ADPT_ARG(g_test_adapter), addr, rtw_read8(g_test_adapter, addr)); ++ ++ /* lock register page0 0x0~0xB read/write */ ++ rtw_write8(g_test_adapter, 0x1C, 0x0E); ++ ++ rtw_set_surprise_removed(g_test_adapter); ++ RTW_INFO(FUNC_ADPT_FMT ": bSurpriseRemoved=%s\n", ++ FUNC_ADPT_ARG(g_test_adapter), rtw_is_surprise_removed(g_test_adapter) ? "True" : "False"); ++} ++#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ ++ ++static int wifi_remove(struct platform_device *pdev) ++{ ++ struct wifi_platform_data *wifi_ctrl = ++ (struct wifi_platform_data *)(pdev->dev.platform_data); ++ ++ RTW_INFO("## %s\n", __FUNCTION__); ++ wifi_control_data = wifi_ctrl; ++ ++ if (oob_irq != 0) ++ disable_irq_wake(oob_irq); ++ ++ wifi_set_power(0, 0); /* Power Off */ ++ wifi_set_carddetect(0); /* CardDetect (1->0) */ ++ ++ up(&wifi_control_sem); ++ return 0; ++} ++ ++#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN ++static void wifi_shutdown(struct platform_device *pdev) ++{ ++ struct wifi_platform_data *wifi_ctrl = ++ (struct wifi_platform_data *)(pdev->dev.platform_data); ++ ++ ++ RTW_INFO("## %s\n", __FUNCTION__); ++ ++ wifi_control_data = wifi_ctrl; ++ ++ shutdown_card(); ++ wifi_set_power(0, 0); /* Power Off */ ++ wifi_set_carddetect(0); /* CardDetect (1->0) */ ++} ++#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ ++ ++static int wifi_suspend(struct platform_device *pdev, pm_message_t state) ++{ ++ RTW_INFO("##> %s\n", __FUNCTION__); ++#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 39)) && defined(OOB_INTR_ONLY) ++ bcmsdh_oob_intr_set(0); ++#endif ++ return 0; ++} ++ ++static int wifi_resume(struct platform_device *pdev) ++{ ++ RTW_INFO("##> %s\n", __FUNCTION__); ++#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 39)) && defined(OOB_INTR_ONLY) ++ if (dhd_os_check_if_up(bcmsdh_get_drvdata())) ++ bcmsdh_oob_intr_set(1); ++#endif ++ return 0; ++} ++ ++/* temporarily use these two */ ++static struct platform_driver wifi_device = { ++ .probe = wifi_probe, ++ .remove = wifi_remove, ++ .suspend = wifi_suspend, ++ .resume = wifi_resume, ++#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN ++ .shutdown = wifi_shutdown, ++#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ ++ .driver = { ++ .name = "bcmdhd_wlan", ++ } ++}; ++ ++static struct platform_driver wifi_device_legacy = { ++ .probe = wifi_probe, ++ .remove = wifi_remove, ++ .suspend = wifi_suspend, ++ .resume = wifi_resume, ++ .driver = { ++ .name = "bcm4329_wlan", ++ } ++}; ++ ++static int wifi_add_dev(void) ++{ ++ RTW_INFO("## Calling platform_driver_register\n"); ++ platform_driver_register(&wifi_device); ++ platform_driver_register(&wifi_device_legacy); ++ return 0; ++} ++ ++static void wifi_del_dev(void) ++{ ++ RTW_INFO("## Unregister platform_driver_register\n"); ++ platform_driver_unregister(&wifi_device); ++ platform_driver_unregister(&wifi_device_legacy); ++} ++#endif /* defined(RTW_ENABLE_WIFI_CONTROL_FUNC) */ ++ ++#if defined (CONFIG_GPIO_WAKEUP) || defined (CONFIG_RTW_SDIO_OOB_INT) ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++int wifi_configure_gpio(void) ++{ ++ if (gpio_request(oob_gpio, "oob_irq")) { ++ RTW_INFO("## %s Cannot request GPIO\n", __FUNCTION__); ++ return -1; ++ } ++ gpio_export(oob_gpio, 0); ++ if (gpio_direction_input(oob_gpio)) { ++ RTW_INFO("## %s Cannot set GPIO direction input\n", __FUNCTION__); ++ return -1; ++ } ++ oob_irq = gpio_to_irq(oob_gpio); ++ if (oob_irq < 0) { ++ RTW_INFO("## %s Cannot convert GPIO to IRQ\n", __FUNCTION__); ++ return -1; ++ } ++ ++ RTW_INFO("## %s OOB_IRQ=%d\n", __FUNCTION__, oob_irq); ++ ++ return 0; ++} ++#endif /* CONFIG_PLATFORM_INTEL_BYT */ ++void wifi_free_gpio(unsigned int gpio) ++{ ++#ifdef CONFIG_PLATFORM_INTEL_BYT ++ if (gpio) ++ gpio_free(gpio); ++#endif /* CONFIG_PLATFORM_INTEL_BYT */ ++} ++#endif /* CONFIG_GPIO_WAKEUP */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.c 2018-02-11 21:44:27.176146528 +0200 +@@ -0,0 +1,1328 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2014 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#include ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) ++ ++/* ++#include ++#include ++#include ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++*/ ++ ++#include ++ ++#ifdef DBG_MEM_ALLOC ++extern bool match_mstat_sniff_rules(const enum mstat_f flags, const size_t size); ++struct sk_buff *dbg_rtw_cfg80211_vendor_event_alloc(struct wiphy *wiphy, struct wireless_dev *wdev, int len, int event_id, gfp_t gfp ++ , const enum mstat_f flags, const char *func, const int line) ++{ ++ struct sk_buff *skb; ++ unsigned int truesize = 0; ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 1, 0)) ++ skb = cfg80211_vendor_event_alloc(wiphy, len, event_id, gfp); ++#else ++ skb = cfg80211_vendor_event_alloc(wiphy, wdev, len, event_id, gfp); ++#endif ++ ++ if (skb) ++ truesize = skb->truesize; ++ ++ if (!skb || truesize < len || match_mstat_sniff_rules(flags, truesize)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d), skb:%p, truesize=%u\n", func, line, __FUNCTION__, len, skb, truesize); ++ ++ rtw_mstat_update( ++ flags ++ , skb ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL ++ , truesize ++ ); ++ ++ return skb; ++} ++ ++void dbg_rtw_cfg80211_vendor_event(struct sk_buff *skb, gfp_t gfp ++ , const enum mstat_f flags, const char *func, const int line) ++{ ++ unsigned int truesize = skb->truesize; ++ ++ if (match_mstat_sniff_rules(flags, truesize)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); ++ ++ cfg80211_vendor_event(skb, gfp); ++ ++ rtw_mstat_update( ++ flags ++ , MSTAT_FREE ++ , truesize ++ ); ++} ++ ++struct sk_buff *dbg_rtw_cfg80211_vendor_cmd_alloc_reply_skb(struct wiphy *wiphy, int len ++ , const enum mstat_f flags, const char *func, const int line) ++{ ++ struct sk_buff *skb; ++ unsigned int truesize = 0; ++ ++ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len); ++ ++ if (skb) ++ truesize = skb->truesize; ++ ++ if (!skb || truesize < len || match_mstat_sniff_rules(flags, truesize)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d), skb:%p, truesize=%u\n", func, line, __FUNCTION__, len, skb, truesize); ++ ++ rtw_mstat_update( ++ flags ++ , skb ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL ++ , truesize ++ ); ++ ++ return skb; ++} ++ ++int dbg_rtw_cfg80211_vendor_cmd_reply(struct sk_buff *skb ++ , const enum mstat_f flags, const char *func, const int line) ++{ ++ unsigned int truesize = skb->truesize; ++ int ret; ++ ++ if (match_mstat_sniff_rules(flags, truesize)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); ++ ++ ret = cfg80211_vendor_cmd_reply(skb); ++ ++ rtw_mstat_update( ++ flags ++ , MSTAT_FREE ++ , truesize ++ ); ++ ++ return ret; ++} ++ ++#define rtw_cfg80211_vendor_event_alloc(wiphy, wdev, len, event_id, gfp) \ ++ dbg_rtw_cfg80211_vendor_event_alloc(wiphy, wdev, len, event_id, gfp, MSTAT_FUNC_CFG_VENDOR | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++ ++#define rtw_cfg80211_vendor_event(skb, gfp) \ ++ dbg_rtw_cfg80211_vendor_event(skb, gfp, MSTAT_FUNC_CFG_VENDOR | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++ ++#define rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len) \ ++ dbg_rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len, MSTAT_FUNC_CFG_VENDOR | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++ ++#define rtw_cfg80211_vendor_cmd_reply(skb) \ ++ dbg_rtw_cfg80211_vendor_cmd_reply(skb, MSTAT_FUNC_CFG_VENDOR | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) ++#else ++ ++struct sk_buff *rtw_cfg80211_vendor_event_alloc( ++ struct wiphy *wiphy, struct wireless_dev *wdev, int len, int event_id, gfp_t gfp) ++{ ++ struct sk_buff *skb; ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 1, 0)) ++ skb = cfg80211_vendor_event_alloc(wiphy, len, event_id, gfp); ++#else ++ skb = cfg80211_vendor_event_alloc(wiphy, wdev, len, event_id, gfp); ++#endif ++ return skb; ++} ++ ++#define rtw_cfg80211_vendor_event(skb, gfp) \ ++ cfg80211_vendor_event(skb, gfp) ++ ++#define rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len) \ ++ cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len) ++ ++#define rtw_cfg80211_vendor_cmd_reply(skb) \ ++ cfg80211_vendor_cmd_reply(skb) ++#endif /* DBG_MEM_ALLOC */ ++ ++/* ++ * This API is to be used for asynchronous vendor events. This ++ * shouldn't be used in response to a vendor command from its ++ * do_it handler context (instead rtw_cfgvendor_send_cmd_reply should ++ * be used). ++ */ ++int rtw_cfgvendor_send_async_event(struct wiphy *wiphy, ++ struct net_device *dev, int event_id, const void *data, int len) ++{ ++ u16 kflags; ++ struct sk_buff *skb; ++ ++ kflags = in_atomic() ? GFP_ATOMIC : GFP_KERNEL; ++ ++ /* Alloc the SKB for vendor_event */ ++ skb = rtw_cfg80211_vendor_event_alloc(wiphy, ndev_to_wdev(dev), len, event_id, kflags); ++ if (!skb) { ++ RTW_ERR(FUNC_NDEV_FMT" skb alloc failed", FUNC_NDEV_ARG(dev)); ++ return -ENOMEM; ++ } ++ ++ /* Push the data to the skb */ ++ nla_put_nohdr(skb, len, data); ++ ++ rtw_cfg80211_vendor_event(skb, kflags); ++ ++ return 0; ++} ++ ++static int rtw_cfgvendor_send_cmd_reply(struct wiphy *wiphy, ++ struct net_device *dev, const void *data, int len) ++{ ++ struct sk_buff *skb; ++ ++ /* Alloc the SKB for vendor_event */ ++ skb = rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len); ++ if (unlikely(!skb)) { ++ RTW_ERR(FUNC_NDEV_FMT" skb alloc failed", FUNC_NDEV_ARG(dev)); ++ return -ENOMEM; ++ } ++ ++ /* Push the data to the skb */ ++ nla_put_nohdr(skb, len, data); ++ ++ return rtw_cfg80211_vendor_cmd_reply(skb); ++} ++ ++#define WIFI_FEATURE_INFRA 0x0001 /* Basic infrastructure mode */ ++#define WIFI_FEATURE_INFRA_5G 0x0002 /* Support for 5 GHz Band */ ++#define WIFI_FEATURE_HOTSPOT 0x0004 /* Support for GAS/ANQP */ ++#define WIFI_FEATURE_P2P 0x0008 /* Wifi-Direct */ ++#define WIFI_FEATURE_SOFT_AP 0x0010 /* Soft AP */ ++#define WIFI_FEATURE_GSCAN 0x0020 /* Google-Scan APIs */ ++#define WIFI_FEATURE_NAN 0x0040 /* Neighbor Awareness Networking */ ++#define WIFI_FEATURE_D2D_RTT 0x0080 /* Device-to-device RTT */ ++#define WIFI_FEATURE_D2AP_RTT 0x0100 /* Device-to-AP RTT */ ++#define WIFI_FEATURE_BATCH_SCAN 0x0200 /* Batched Scan (legacy) */ ++#define WIFI_FEATURE_PNO 0x0400 /* Preferred network offload */ ++#define WIFI_FEATURE_ADDITIONAL_STA 0x0800 /* Support for two STAs */ ++#define WIFI_FEATURE_TDLS 0x1000 /* Tunnel directed link setup */ ++#define WIFI_FEATURE_TDLS_OFFCHANNEL 0x2000 /* Support for TDLS off channel */ ++#define WIFI_FEATURE_EPR 0x4000 /* Enhanced power reporting */ ++#define WIFI_FEATURE_AP_STA 0x8000 /* Support for AP STA Concurrency */ ++ ++#define MAX_FEATURE_SET_CONCURRRENT_GROUPS 3 ++ ++#include ++int rtw_dev_get_feature_set(struct net_device *dev) ++{ ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); ++ HAL_VERSION *hal_ver = &HalData->VersionID; ++ ++ int feature_set = 0; ++ ++ feature_set |= WIFI_FEATURE_INFRA; ++ ++ if (IS_8814A_SERIES(*hal_ver) || IS_8812_SERIES(*hal_ver) || ++ IS_8821_SERIES(*hal_ver)) ++ feature_set |= WIFI_FEATURE_INFRA_5G; ++ ++ feature_set |= WIFI_FEATURE_P2P; ++ feature_set |= WIFI_FEATURE_SOFT_AP; ++ ++ feature_set |= WIFI_FEATURE_ADDITIONAL_STA; ++ ++ return feature_set; ++} ++ ++int *rtw_dev_get_feature_set_matrix(struct net_device *dev, int *num) ++{ ++ int feature_set_full, mem_needed; ++ int *ret; ++ ++ *num = 0; ++ mem_needed = sizeof(int) * MAX_FEATURE_SET_CONCURRRENT_GROUPS; ++ ret = (int *)rtw_malloc(mem_needed); ++ ++ if (!ret) { ++ RTW_ERR(FUNC_NDEV_FMT" failed to allocate %d bytes\n" ++ , FUNC_NDEV_ARG(dev), mem_needed); ++ return ret; ++ } ++ ++ feature_set_full = rtw_dev_get_feature_set(dev); ++ ++ ret[0] = (feature_set_full & WIFI_FEATURE_INFRA) | ++ (feature_set_full & WIFI_FEATURE_INFRA_5G) | ++ (feature_set_full & WIFI_FEATURE_NAN) | ++ (feature_set_full & WIFI_FEATURE_D2D_RTT) | ++ (feature_set_full & WIFI_FEATURE_D2AP_RTT) | ++ (feature_set_full & WIFI_FEATURE_PNO) | ++ (feature_set_full & WIFI_FEATURE_BATCH_SCAN) | ++ (feature_set_full & WIFI_FEATURE_GSCAN) | ++ (feature_set_full & WIFI_FEATURE_HOTSPOT) | ++ (feature_set_full & WIFI_FEATURE_ADDITIONAL_STA) | ++ (feature_set_full & WIFI_FEATURE_EPR); ++ ++ ret[1] = (feature_set_full & WIFI_FEATURE_INFRA) | ++ (feature_set_full & WIFI_FEATURE_INFRA_5G) | ++ /* Not yet verified NAN with P2P */ ++ /* (feature_set_full & WIFI_FEATURE_NAN) | */ ++ (feature_set_full & WIFI_FEATURE_P2P) | ++ (feature_set_full & WIFI_FEATURE_D2AP_RTT) | ++ (feature_set_full & WIFI_FEATURE_D2D_RTT) | ++ (feature_set_full & WIFI_FEATURE_EPR); ++ ++ ret[2] = (feature_set_full & WIFI_FEATURE_INFRA) | ++ (feature_set_full & WIFI_FEATURE_INFRA_5G) | ++ (feature_set_full & WIFI_FEATURE_NAN) | ++ (feature_set_full & WIFI_FEATURE_D2D_RTT) | ++ (feature_set_full & WIFI_FEATURE_D2AP_RTT) | ++ (feature_set_full & WIFI_FEATURE_TDLS) | ++ (feature_set_full & WIFI_FEATURE_TDLS_OFFCHANNEL) | ++ (feature_set_full & WIFI_FEATURE_EPR); ++ *num = MAX_FEATURE_SET_CONCURRRENT_GROUPS; ++ ++ return ret; ++} ++ ++static int rtw_cfgvendor_get_feature_set(struct wiphy *wiphy, ++ struct wireless_dev *wdev, const void *data, int len) ++{ ++ int err = 0; ++ int reply; ++ ++ reply = rtw_dev_get_feature_set(wdev_to_ndev(wdev)); ++ ++ err = rtw_cfgvendor_send_cmd_reply(wiphy, wdev_to_ndev(wdev), &reply, sizeof(int)); ++ ++ if (unlikely(err)) ++ RTW_ERR(FUNC_NDEV_FMT" Vendor Command reply failed ret:%d\n" ++ , FUNC_NDEV_ARG(wdev_to_ndev(wdev)), err); ++ ++ return err; ++} ++ ++static int rtw_cfgvendor_get_feature_set_matrix(struct wiphy *wiphy, ++ struct wireless_dev *wdev, const void *data, int len) ++{ ++ int err = 0; ++ struct sk_buff *skb; ++ int *reply; ++ int num, mem_needed, i; ++ ++ reply = rtw_dev_get_feature_set_matrix(wdev_to_ndev(wdev), &num); ++ ++ if (!reply) { ++ RTW_ERR(FUNC_NDEV_FMT" Could not get feature list matrix\n" ++ , FUNC_NDEV_ARG(wdev_to_ndev(wdev))); ++ err = -EINVAL; ++ return err; ++ } ++ ++ mem_needed = VENDOR_REPLY_OVERHEAD + (ATTRIBUTE_U32_LEN * num) + ++ ATTRIBUTE_U32_LEN; ++ ++ /* Alloc the SKB for vendor_event */ ++ skb = rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, mem_needed); ++ if (unlikely(!skb)) { ++ RTW_ERR(FUNC_NDEV_FMT" skb alloc failed", FUNC_NDEV_ARG(wdev_to_ndev(wdev))); ++ err = -ENOMEM; ++ goto exit; ++ } ++ ++ nla_put_u32(skb, ANDR_WIFI_ATTRIBUTE_NUM_FEATURE_SET, num); ++ for (i = 0; i < num; i++) ++ nla_put_u32(skb, ANDR_WIFI_ATTRIBUTE_FEATURE_SET, reply[i]); ++ ++ err = rtw_cfg80211_vendor_cmd_reply(skb); ++ ++ if (unlikely(err)) ++ RTW_ERR(FUNC_NDEV_FMT" Vendor Command reply failed ret:%d\n" ++ , FUNC_NDEV_ARG(wdev_to_ndev(wdev)), err); ++exit: ++ rtw_mfree((u8 *)reply, sizeof(int) * num); ++ return err; ++} ++ ++#if defined(GSCAN_SUPPORT) && 0 ++int wl_cfgvendor_send_hotlist_event(struct wiphy *wiphy, ++ struct net_device *dev, void *data, int len, wl_vendor_event_t event) ++{ ++ u16 kflags; ++ const void *ptr; ++ struct sk_buff *skb; ++ int malloc_len, total, iter_cnt_to_send, cnt; ++ gscan_results_cache_t *cache = (gscan_results_cache_t *)data; ++ ++ total = len / sizeof(wifi_gscan_result_t); ++ while (total > 0) { ++ malloc_len = (total * sizeof(wifi_gscan_result_t)) + VENDOR_DATA_OVERHEAD; ++ if (malloc_len > NLMSG_DEFAULT_SIZE) ++ malloc_len = NLMSG_DEFAULT_SIZE; ++ iter_cnt_to_send = ++ (malloc_len - VENDOR_DATA_OVERHEAD) / sizeof(wifi_gscan_result_t); ++ total = total - iter_cnt_to_send; ++ ++ kflags = in_atomic() ? GFP_ATOMIC : GFP_KERNEL; ++ ++ /* Alloc the SKB for vendor_event */ ++ skb = rtw_cfg80211_vendor_event_alloc(wiphy, ndev_to_wdev(dev), malloc_len, event, kflags); ++ if (!skb) { ++ WL_ERR(("skb alloc failed")); ++ return -ENOMEM; ++ } ++ ++ while (cache && iter_cnt_to_send) { ++ ptr = (const void *) &cache->results[cache->tot_consumed]; ++ ++ if (iter_cnt_to_send < (cache->tot_count - cache->tot_consumed)) ++ cnt = iter_cnt_to_send; ++ else ++ cnt = (cache->tot_count - cache->tot_consumed); ++ ++ iter_cnt_to_send -= cnt; ++ cache->tot_consumed += cnt; ++ /* Push the data to the skb */ ++ nla_append(skb, cnt * sizeof(wifi_gscan_result_t), ptr); ++ if (cache->tot_consumed == cache->tot_count) ++ cache = cache->next; ++ ++ } ++ ++ rtw_cfg80211_vendor_event(skb, kflags); ++ } ++ ++ return 0; ++} ++ ++ ++static int wl_cfgvendor_gscan_get_capabilities(struct wiphy *wiphy, ++ struct wireless_dev *wdev, const void *data, int len) ++{ ++ int err = 0; ++ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); ++ dhd_pno_gscan_capabilities_t *reply = NULL; ++ uint32 reply_len = 0; ++ ++ ++ reply = dhd_dev_pno_get_gscan(bcmcfg_to_prmry_ndev(cfg), ++ DHD_PNO_GET_CAPABILITIES, NULL, &reply_len); ++ if (!reply) { ++ WL_ERR(("Could not get capabilities\n")); ++ err = -EINVAL; ++ return err; ++ } ++ ++ err = rtw_cfgvendor_send_cmd_reply(wiphy, bcmcfg_to_prmry_ndev(cfg), ++ reply, reply_len); ++ ++ if (unlikely(err)) ++ WL_ERR(("Vendor Command reply failed ret:%d\n", err)); ++ ++ kfree(reply); ++ return err; ++} ++ ++static int wl_cfgvendor_gscan_get_channel_list(struct wiphy *wiphy, ++ struct wireless_dev *wdev, const void *data, int len) ++{ ++ int err = 0, type, band; ++ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); ++ uint16 *reply = NULL; ++ uint32 reply_len = 0, num_channels, mem_needed; ++ struct sk_buff *skb; ++ ++ type = nla_type(data); ++ ++ if (type == GSCAN_ATTRIBUTE_BAND) ++ band = nla_get_u32(data); ++ else ++ return -1; ++ ++ reply = dhd_dev_pno_get_gscan(bcmcfg_to_prmry_ndev(cfg), ++ DHD_PNO_GET_CHANNEL_LIST, &band, &reply_len); ++ ++ if (!reply) { ++ WL_ERR(("Could not get channel list\n")); ++ err = -EINVAL; ++ return err; ++ } ++ num_channels = reply_len / sizeof(uint32); ++ mem_needed = reply_len + VENDOR_REPLY_OVERHEAD + (ATTRIBUTE_U32_LEN * 2); ++ ++ /* Alloc the SKB for vendor_event */ ++ skb = rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, mem_needed); ++ if (unlikely(!skb)) { ++ WL_ERR(("skb alloc failed")); ++ err = -ENOMEM; ++ goto exit; ++ } ++ ++ nla_put_u32(skb, GSCAN_ATTRIBUTE_NUM_CHANNELS, num_channels); ++ nla_put(skb, GSCAN_ATTRIBUTE_CHANNEL_LIST, reply_len, reply); ++ ++ err = rtw_cfg80211_vendor_cmd_reply(skb); ++ ++ if (unlikely(err)) ++ WL_ERR(("Vendor Command reply failed ret:%d\n", err)); ++exit: ++ kfree(reply); ++ return err; ++} ++ ++static int wl_cfgvendor_gscan_get_batch_results(struct wiphy *wiphy, ++ struct wireless_dev *wdev, const void *data, int len) ++{ ++ int err = 0; ++ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); ++ gscan_results_cache_t *results, *iter; ++ uint32 reply_len, complete = 0, num_results_iter; ++ int32 mem_needed; ++ wifi_gscan_result_t *ptr; ++ uint16 num_scan_ids, num_results; ++ struct sk_buff *skb; ++ struct nlattr *scan_hdr; ++ ++ dhd_dev_wait_batch_results_complete(bcmcfg_to_prmry_ndev(cfg)); ++ dhd_dev_pno_lock_access_batch_results(bcmcfg_to_prmry_ndev(cfg)); ++ results = dhd_dev_pno_get_gscan(bcmcfg_to_prmry_ndev(cfg), ++ DHD_PNO_GET_BATCH_RESULTS, NULL, &reply_len); ++ ++ if (!results) { ++ WL_ERR(("No results to send %d\n", err)); ++ err = rtw_cfgvendor_send_cmd_reply(wiphy, bcmcfg_to_prmry_ndev(cfg), ++ results, 0); ++ ++ if (unlikely(err)) ++ WL_ERR(("Vendor Command reply failed ret:%d\n", err)); ++ dhd_dev_pno_unlock_access_batch_results(bcmcfg_to_prmry_ndev(cfg)); ++ return err; ++ } ++ num_scan_ids = reply_len & 0xFFFF; ++ num_results = (reply_len & 0xFFFF0000) >> 16; ++ mem_needed = (num_results * sizeof(wifi_gscan_result_t)) + ++ (num_scan_ids * GSCAN_BATCH_RESULT_HDR_LEN) + ++ VENDOR_REPLY_OVERHEAD + SCAN_RESULTS_COMPLETE_FLAG_LEN; ++ ++ if (mem_needed > (int32)NLMSG_DEFAULT_SIZE) { ++ mem_needed = (int32)NLMSG_DEFAULT_SIZE; ++ complete = 0; ++ } else ++ complete = 1; ++ ++ WL_TRACE(("complete %d mem_needed %d max_mem %d\n", complete, mem_needed, ++ (int)NLMSG_DEFAULT_SIZE)); ++ /* Alloc the SKB for vendor_event */ ++ skb = rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, mem_needed); ++ if (unlikely(!skb)) { ++ WL_ERR(("skb alloc failed")); ++ dhd_dev_pno_unlock_access_batch_results(bcmcfg_to_prmry_ndev(cfg)); ++ return -ENOMEM; ++ } ++ iter = results; ++ ++ nla_put_u32(skb, GSCAN_ATTRIBUTE_SCAN_RESULTS_COMPLETE, complete); ++ ++ mem_needed = mem_needed - (SCAN_RESULTS_COMPLETE_FLAG_LEN + VENDOR_REPLY_OVERHEAD); ++ ++ while (iter && ((mem_needed - GSCAN_BATCH_RESULT_HDR_LEN) > 0)) { ++ scan_hdr = nla_nest_start(skb, GSCAN_ATTRIBUTE_SCAN_RESULTS); ++ nla_put_u32(skb, GSCAN_ATTRIBUTE_SCAN_ID, iter->scan_id); ++ nla_put_u8(skb, GSCAN_ATTRIBUTE_SCAN_FLAGS, iter->flag); ++ num_results_iter = ++ (mem_needed - GSCAN_BATCH_RESULT_HDR_LEN) / sizeof(wifi_gscan_result_t); ++ ++ if ((iter->tot_count - iter->tot_consumed) < num_results_iter) ++ num_results_iter = iter->tot_count - iter->tot_consumed; ++ ++ nla_put_u32(skb, GSCAN_ATTRIBUTE_NUM_OF_RESULTS, num_results_iter); ++ if (num_results_iter) { ++ ptr = &iter->results[iter->tot_consumed]; ++ iter->tot_consumed += num_results_iter; ++ nla_put(skb, GSCAN_ATTRIBUTE_SCAN_RESULTS, ++ num_results_iter * sizeof(wifi_gscan_result_t), ptr); ++ } ++ nla_nest_end(skb, scan_hdr); ++ mem_needed -= GSCAN_BATCH_RESULT_HDR_LEN + ++ (num_results_iter * sizeof(wifi_gscan_result_t)); ++ iter = iter->next; ++ } ++ ++ dhd_dev_gscan_batch_cache_cleanup(bcmcfg_to_prmry_ndev(cfg)); ++ dhd_dev_pno_unlock_access_batch_results(bcmcfg_to_prmry_ndev(cfg)); ++ ++ return rtw_cfg80211_vendor_cmd_reply(skb); ++} ++ ++static int wl_cfgvendor_initiate_gscan(struct wiphy *wiphy, ++ struct wireless_dev *wdev, const void *data, int len) ++{ ++ int err = 0; ++ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); ++ int type, tmp = len; ++ int run = 0xFF; ++ int flush = 0; ++ const struct nlattr *iter; ++ ++ nla_for_each_attr(iter, data, len, tmp) { ++ type = nla_type(iter); ++ if (type == GSCAN_ATTRIBUTE_ENABLE_FEATURE) ++ run = nla_get_u32(iter); ++ else if (type == GSCAN_ATTRIBUTE_FLUSH_FEATURE) ++ flush = nla_get_u32(iter); ++ } ++ ++ if (run != 0xFF) { ++ err = dhd_dev_pno_run_gscan(bcmcfg_to_prmry_ndev(cfg), run, flush); ++ ++ if (unlikely(err)) ++ WL_ERR(("Could not run gscan:%d\n", err)); ++ return err; ++ } else ++ return -1; ++ ++ ++} ++ ++static int wl_cfgvendor_enable_full_scan_result(struct wiphy *wiphy, ++ struct wireless_dev *wdev, const void *data, int len) ++{ ++ int err = 0; ++ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); ++ int type; ++ bool real_time = FALSE; ++ ++ type = nla_type(data); ++ ++ if (type == GSCAN_ATTRIBUTE_ENABLE_FULL_SCAN_RESULTS) { ++ real_time = nla_get_u32(data); ++ ++ err = dhd_dev_pno_enable_full_scan_result(bcmcfg_to_prmry_ndev(cfg), real_time); ++ ++ if (unlikely(err)) ++ WL_ERR(("Could not run gscan:%d\n", err)); ++ ++ } else ++ err = -1; ++ ++ return err; ++} ++ ++static int wl_cfgvendor_set_scan_cfg(struct wiphy *wiphy, ++ struct wireless_dev *wdev, const void *data, int len) ++{ ++ int err = 0; ++ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); ++ gscan_scan_params_t *scan_param; ++ int j = 0; ++ int type, tmp, tmp1, tmp2, k = 0; ++ const struct nlattr *iter, *iter1, *iter2; ++ struct dhd_pno_gscan_channel_bucket *ch_bucket; ++ ++ scan_param = kzalloc(sizeof(gscan_scan_params_t), GFP_KERNEL); ++ if (!scan_param) { ++ WL_ERR(("Could not set GSCAN scan cfg, mem alloc failure\n")); ++ err = -EINVAL; ++ return err; ++ ++ } ++ ++ scan_param->scan_fr = PNO_SCAN_MIN_FW_SEC; ++ nla_for_each_attr(iter, data, len, tmp) { ++ type = nla_type(iter); ++ ++ if (j >= GSCAN_MAX_CH_BUCKETS) ++ break; ++ ++ switch (type) { ++ case GSCAN_ATTRIBUTE_BASE_PERIOD: ++ scan_param->scan_fr = nla_get_u32(iter) / 1000; ++ break; ++ case GSCAN_ATTRIBUTE_NUM_BUCKETS: ++ scan_param->nchannel_buckets = nla_get_u32(iter); ++ break; ++ case GSCAN_ATTRIBUTE_CH_BUCKET_1: ++ case GSCAN_ATTRIBUTE_CH_BUCKET_2: ++ case GSCAN_ATTRIBUTE_CH_BUCKET_3: ++ case GSCAN_ATTRIBUTE_CH_BUCKET_4: ++ case GSCAN_ATTRIBUTE_CH_BUCKET_5: ++ case GSCAN_ATTRIBUTE_CH_BUCKET_6: ++ case GSCAN_ATTRIBUTE_CH_BUCKET_7: ++ nla_for_each_nested(iter1, iter, tmp1) { ++ type = nla_type(iter1); ++ ch_bucket = ++ scan_param->channel_bucket; ++ ++ switch (type) { ++ case GSCAN_ATTRIBUTE_BUCKET_ID: ++ break; ++ case GSCAN_ATTRIBUTE_BUCKET_PERIOD: ++ ch_bucket[j].bucket_freq_multiple = ++ nla_get_u32(iter1) / 1000; ++ break; ++ case GSCAN_ATTRIBUTE_BUCKET_NUM_CHANNELS: ++ ch_bucket[j].num_channels = ++ nla_get_u32(iter1); ++ break; ++ case GSCAN_ATTRIBUTE_BUCKET_CHANNELS: ++ nla_for_each_nested(iter2, iter1, tmp2) { ++ if (k >= PFN_SWC_RSSI_WINDOW_MAX) ++ break; ++ ch_bucket[j].chan_list[k] = ++ nla_get_u32(iter2); ++ k++; ++ } ++ k = 0; ++ break; ++ case GSCAN_ATTRIBUTE_BUCKETS_BAND: ++ ch_bucket[j].band = (uint16) ++ nla_get_u32(iter1); ++ break; ++ case GSCAN_ATTRIBUTE_REPORT_EVENTS: ++ ch_bucket[j].report_flag = (uint8) ++ nla_get_u32(iter1); ++ break; ++ } ++ } ++ j++; ++ break; ++ } ++ } ++ ++ if (dhd_dev_pno_set_cfg_gscan(bcmcfg_to_prmry_ndev(cfg), ++ DHD_PNO_SCAN_CFG_ID, scan_param, 0) < 0) { ++ WL_ERR(("Could not set GSCAN scan cfg\n")); ++ err = -EINVAL; ++ } ++ ++ kfree(scan_param); ++ return err; ++ ++} ++ ++static int wl_cfgvendor_hotlist_cfg(struct wiphy *wiphy, ++ struct wireless_dev *wdev, const void *data, int len) ++{ ++ int err = 0; ++ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); ++ gscan_hotlist_scan_params_t *hotlist_params; ++ int tmp, tmp1, tmp2, type, j = 0, dummy; ++ const struct nlattr *outer, *inner, *iter; ++ uint8 flush = 0; ++ struct bssid_t *pbssid; ++ ++ hotlist_params = (gscan_hotlist_scan_params_t *)kzalloc(len, GFP_KERNEL); ++ if (!hotlist_params) { ++ WL_ERR(("Cannot Malloc mem to parse config commands size - %d bytes\n", len)); ++ return -1; ++ } ++ ++ hotlist_params->lost_ap_window = GSCAN_LOST_AP_WINDOW_DEFAULT; ++ ++ nla_for_each_attr(iter, data, len, tmp2) { ++ type = nla_type(iter); ++ switch (type) { ++ case GSCAN_ATTRIBUTE_HOTLIST_BSSIDS: ++ pbssid = hotlist_params->bssid; ++ nla_for_each_nested(outer, iter, tmp) { ++ nla_for_each_nested(inner, outer, tmp1) { ++ type = nla_type(inner); ++ ++ switch (type) { ++ case GSCAN_ATTRIBUTE_BSSID: ++ memcpy(&(pbssid[j].macaddr), ++ nla_data(inner), ETHER_ADDR_LEN); ++ break; ++ case GSCAN_ATTRIBUTE_RSSI_LOW: ++ pbssid[j].rssi_reporting_threshold = ++ (int8) nla_get_u8(inner); ++ break; ++ case GSCAN_ATTRIBUTE_RSSI_HIGH: ++ dummy = (int8) nla_get_u8(inner); ++ break; ++ } ++ } ++ j++; ++ } ++ hotlist_params->nbssid = j; ++ break; ++ case GSCAN_ATTRIBUTE_HOTLIST_FLUSH: ++ flush = nla_get_u8(iter); ++ break; ++ case GSCAN_ATTRIBUTE_LOST_AP_SAMPLE_SIZE: ++ hotlist_params->lost_ap_window = nla_get_u32(iter); ++ break; ++ } ++ ++ } ++ ++ if (dhd_dev_pno_set_cfg_gscan(bcmcfg_to_prmry_ndev(cfg), ++ DHD_PNO_GEOFENCE_SCAN_CFG_ID, hotlist_params, flush) < 0) { ++ WL_ERR(("Could not set GSCAN HOTLIST cfg\n")); ++ err = -EINVAL; ++ goto exit; ++ } ++exit: ++ kfree(hotlist_params); ++ return err; ++} ++static int wl_cfgvendor_set_batch_scan_cfg(struct wiphy *wiphy, ++ struct wireless_dev *wdev, const void *data, int len) ++{ ++ int err = 0, tmp, type; ++ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); ++ gscan_batch_params_t batch_param; ++ const struct nlattr *iter; ++ ++ batch_param.mscan = batch_param.bestn = 0; ++ batch_param.buffer_threshold = GSCAN_BATCH_NO_THR_SET; ++ ++ nla_for_each_attr(iter, data, len, tmp) { ++ type = nla_type(iter); ++ ++ switch (type) { ++ case GSCAN_ATTRIBUTE_NUM_AP_PER_SCAN: ++ batch_param.bestn = nla_get_u32(iter); ++ break; ++ case GSCAN_ATTRIBUTE_NUM_SCANS_TO_CACHE: ++ batch_param.mscan = nla_get_u32(iter); ++ break; ++ case GSCAN_ATTRIBUTE_REPORT_THRESHOLD: ++ batch_param.buffer_threshold = nla_get_u32(iter); ++ break; ++ } ++ } ++ ++ if (dhd_dev_pno_set_cfg_gscan(bcmcfg_to_prmry_ndev(cfg), ++ DHD_PNO_BATCH_SCAN_CFG_ID, &batch_param, 0) < 0) { ++ WL_ERR(("Could not set batch cfg\n")); ++ err = -EINVAL; ++ return err; ++ } ++ ++ return err; ++} ++ ++static int wl_cfgvendor_significant_change_cfg(struct wiphy *wiphy, ++ struct wireless_dev *wdev, const void *data, int len) ++{ ++ int err = 0; ++ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); ++ gscan_swc_params_t *significant_params; ++ int tmp, tmp1, tmp2, type, j = 0; ++ const struct nlattr *outer, *inner, *iter; ++ uint8 flush = 0; ++ wl_pfn_significant_bssid_t *pbssid; ++ ++ significant_params = (gscan_swc_params_t *) kzalloc(len, GFP_KERNEL); ++ if (!significant_params) { ++ WL_ERR(("Cannot Malloc mem to parse config commands size - %d bytes\n", len)); ++ return -1; ++ } ++ ++ ++ nla_for_each_attr(iter, data, len, tmp2) { ++ type = nla_type(iter); ++ ++ switch (type) { ++ case GSCAN_ATTRIBUTE_SIGNIFICANT_CHANGE_FLUSH: ++ flush = nla_get_u8(iter); ++ break; ++ case GSCAN_ATTRIBUTE_RSSI_SAMPLE_SIZE: ++ significant_params->rssi_window = nla_get_u16(iter); ++ break; ++ case GSCAN_ATTRIBUTE_LOST_AP_SAMPLE_SIZE: ++ significant_params->lost_ap_window = nla_get_u16(iter); ++ break; ++ case GSCAN_ATTRIBUTE_MIN_BREACHING: ++ significant_params->swc_threshold = nla_get_u16(iter); ++ break; ++ case GSCAN_ATTRIBUTE_SIGNIFICANT_CHANGE_BSSIDS: ++ pbssid = significant_params->bssid_elem_list; ++ nla_for_each_nested(outer, iter, tmp) { ++ nla_for_each_nested(inner, outer, tmp1) { ++ switch (nla_type(inner)) { ++ case GSCAN_ATTRIBUTE_BSSID: ++ memcpy(&(pbssid[j].macaddr), ++ nla_data(inner), ++ ETHER_ADDR_LEN); ++ break; ++ case GSCAN_ATTRIBUTE_RSSI_HIGH: ++ pbssid[j].rssi_high_threshold = ++ (int8) nla_get_u8(inner); ++ break; ++ case GSCAN_ATTRIBUTE_RSSI_LOW: ++ pbssid[j].rssi_low_threshold = ++ (int8) nla_get_u8(inner); ++ break; ++ } ++ } ++ j++; ++ } ++ break; ++ } ++ } ++ significant_params->nbssid = j; ++ ++ if (dhd_dev_pno_set_cfg_gscan(bcmcfg_to_prmry_ndev(cfg), ++ DHD_PNO_SIGNIFICANT_SCAN_CFG_ID, significant_params, flush) < 0) { ++ WL_ERR(("Could not set GSCAN significant cfg\n")); ++ err = -EINVAL; ++ goto exit; ++ } ++exit: ++ kfree(significant_params); ++ return err; ++} ++#endif /* GSCAN_SUPPORT */ ++ ++#if defined(RTT_SUPPORT) && 0 ++void wl_cfgvendor_rtt_evt(void *ctx, void *rtt_data) ++{ ++ struct wireless_dev *wdev = (struct wireless_dev *)ctx; ++ struct wiphy *wiphy; ++ struct sk_buff *skb; ++ uint32 tot_len = NLMSG_DEFAULT_SIZE, entry_len = 0; ++ gfp_t kflags; ++ rtt_report_t *rtt_report = NULL; ++ rtt_result_t *rtt_result = NULL; ++ struct list_head *rtt_list; ++ wiphy = wdev->wiphy; ++ ++ WL_DBG(("In\n")); ++ /* Push the data to the skb */ ++ if (!rtt_data) { ++ WL_ERR(("rtt_data is NULL\n")); ++ goto exit; ++ } ++ rtt_list = (struct list_head *)rtt_data; ++ kflags = in_atomic() ? GFP_ATOMIC : GFP_KERNEL; ++ /* Alloc the SKB for vendor_event */ ++ skb = rtw_cfg80211_vendor_event_alloc(wiphy, wdev, tot_len, GOOGLE_RTT_COMPLETE_EVENT, kflags); ++ if (!skb) { ++ WL_ERR(("skb alloc failed")); ++ goto exit; ++ } ++ /* fill in the rtt results on each entry */ ++ list_for_each_entry(rtt_result, rtt_list, list) { ++ entry_len = 0; ++ if (rtt_result->TOF_type == TOF_TYPE_ONE_WAY) { ++ entry_len = sizeof(rtt_report_t); ++ rtt_report = kzalloc(entry_len, kflags); ++ if (!rtt_report) { ++ WL_ERR(("rtt_report alloc failed")); ++ goto exit; ++ } ++ rtt_report->addr = rtt_result->peer_mac; ++ rtt_report->num_measurement = 1; /* ONE SHOT */ ++ rtt_report->status = rtt_result->err_code; ++ rtt_report->type = (rtt_result->TOF_type == TOF_TYPE_ONE_WAY) ? RTT_ONE_WAY : RTT_TWO_WAY; ++ rtt_report->peer = rtt_result->target_info->peer; ++ rtt_report->channel = rtt_result->target_info->channel; ++ rtt_report->rssi = rtt_result->avg_rssi; ++ /* tx_rate */ ++ rtt_report->tx_rate = rtt_result->tx_rate; ++ /* RTT */ ++ rtt_report->rtt = rtt_result->meanrtt; ++ rtt_report->rtt_sd = rtt_result->sdrtt; ++ /* convert to centi meter */ ++ if (rtt_result->distance != 0xffffffff) ++ rtt_report->distance = (rtt_result->distance >> 2) * 25; ++ else /* invalid distance */ ++ rtt_report->distance = -1; ++ ++ rtt_report->ts = rtt_result->ts; ++ nla_append(skb, entry_len, rtt_report); ++ kfree(rtt_report); ++ } ++ } ++ rtw_cfg80211_vendor_event(skb, kflags); ++exit: ++ return; ++} ++ ++static int wl_cfgvendor_rtt_set_config(struct wiphy *wiphy, struct wireless_dev *wdev, ++ const void *data, int len) ++{ ++ int err = 0, rem, rem1, rem2, type; ++ rtt_config_params_t rtt_param; ++ rtt_target_info_t *rtt_target = NULL; ++ const struct nlattr *iter, *iter1, *iter2; ++ int8 eabuf[ETHER_ADDR_STR_LEN]; ++ int8 chanbuf[CHANSPEC_STR_LEN]; ++ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); ++ ++ WL_DBG(("In\n")); ++ err = dhd_dev_rtt_register_noti_callback(wdev->netdev, wdev, wl_cfgvendor_rtt_evt); ++ if (err < 0) { ++ WL_ERR(("failed to register rtt_noti_callback\n")); ++ goto exit; ++ } ++ memset(&rtt_param, 0, sizeof(rtt_param)); ++ nla_for_each_attr(iter, data, len, rem) { ++ type = nla_type(iter); ++ switch (type) { ++ case RTT_ATTRIBUTE_TARGET_CNT: ++ rtt_param.rtt_target_cnt = nla_get_u8(iter); ++ if (rtt_param.rtt_target_cnt > RTT_MAX_TARGET_CNT) { ++ WL_ERR(("exceed max target count : %d\n", ++ rtt_param.rtt_target_cnt)); ++ err = BCME_RANGE; ++ } ++ break; ++ case RTT_ATTRIBUTE_TARGET_INFO: ++ rtt_target = rtt_param.target_info; ++ nla_for_each_nested(iter1, iter, rem1) { ++ nla_for_each_nested(iter2, iter1, rem2) { ++ type = nla_type(iter2); ++ switch (type) { ++ case RTT_ATTRIBUTE_TARGET_MAC: ++ memcpy(&rtt_target->addr, nla_data(iter2), ETHER_ADDR_LEN); ++ break; ++ case RTT_ATTRIBUTE_TARGET_TYPE: ++ rtt_target->type = nla_get_u8(iter2); ++ break; ++ case RTT_ATTRIBUTE_TARGET_PEER: ++ rtt_target->peer = nla_get_u8(iter2); ++ break; ++ case RTT_ATTRIBUTE_TARGET_CHAN: ++ memcpy(&rtt_target->channel, nla_data(iter2), ++ sizeof(rtt_target->channel)); ++ break; ++ case RTT_ATTRIBUTE_TARGET_MODE: ++ rtt_target->continuous = nla_get_u8(iter2); ++ break; ++ case RTT_ATTRIBUTE_TARGET_INTERVAL: ++ rtt_target->interval = nla_get_u32(iter2); ++ break; ++ case RTT_ATTRIBUTE_TARGET_NUM_MEASUREMENT: ++ rtt_target->measure_cnt = nla_get_u32(iter2); ++ break; ++ case RTT_ATTRIBUTE_TARGET_NUM_PKT: ++ rtt_target->ftm_cnt = nla_get_u32(iter2); ++ break; ++ case RTT_ATTRIBUTE_TARGET_NUM_RETRY: ++ rtt_target->retry_cnt = nla_get_u32(iter2); ++ } ++ } ++ /* convert to chanspec value */ ++ rtt_target->chanspec = dhd_rtt_convert_to_chspec(rtt_target->channel); ++ if (rtt_target->chanspec == 0) { ++ WL_ERR(("Channel is not valid\n")); ++ goto exit; ++ } ++ WL_INFORM(("Target addr %s, Channel : %s for RTT\n", ++ bcm_ether_ntoa((const struct ether_addr *)&rtt_target->addr, eabuf), ++ wf_chspec_ntoa(rtt_target->chanspec, chanbuf))); ++ rtt_target++; ++ } ++ break; ++ } ++ } ++ WL_DBG(("leave :target_cnt : %d\n", rtt_param.rtt_target_cnt)); ++ if (dhd_dev_rtt_set_cfg(bcmcfg_to_prmry_ndev(cfg), &rtt_param) < 0) { ++ WL_ERR(("Could not set RTT configuration\n")); ++ err = -EINVAL; ++ } ++exit: ++ return err; ++} ++ ++static int wl_cfgvendor_rtt_cancel_config(struct wiphy *wiphy, struct wireless_dev *wdev, ++ const void *data, int len) ++{ ++ int err = 0, rem, type, target_cnt = 0; ++ const struct nlattr *iter; ++ struct ether_addr *mac_list = NULL, *mac_addr = NULL; ++ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); ++ ++ nla_for_each_attr(iter, data, len, rem) { ++ type = nla_type(iter); ++ switch (type) { ++ case RTT_ATTRIBUTE_TARGET_CNT: ++ target_cnt = nla_get_u8(iter); ++ mac_list = (struct ether_addr *)kzalloc(target_cnt * ETHER_ADDR_LEN , GFP_KERNEL); ++ if (mac_list == NULL) { ++ WL_ERR(("failed to allocate mem for mac list\n")); ++ goto exit; ++ } ++ mac_addr = &mac_list[0]; ++ break; ++ case RTT_ATTRIBUTE_TARGET_MAC: ++ if (mac_addr) ++ memcpy(mac_addr++, nla_data(iter), ETHER_ADDR_LEN); ++ else { ++ WL_ERR(("mac_list is NULL\n")); ++ goto exit; ++ } ++ break; ++ } ++ if (dhd_dev_rtt_cancel_cfg(bcmcfg_to_prmry_ndev(cfg), mac_list, target_cnt) < 0) { ++ WL_ERR(("Could not cancel RTT configuration\n")); ++ err = -EINVAL; ++ goto exit; ++ } ++ } ++exit: ++ if (mac_list) ++ kfree(mac_list); ++ return err; ++} ++static int wl_cfgvendor_rtt_get_capability(struct wiphy *wiphy, struct wireless_dev *wdev, ++ const void *data, int len) ++{ ++ int err = 0; ++ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); ++ rtt_capabilities_t capability; ++ ++ err = dhd_dev_rtt_capability(bcmcfg_to_prmry_ndev(cfg), &capability); ++ if (unlikely(err)) { ++ WL_ERR(("Vendor Command reply failed ret:%d\n", err)); ++ goto exit; ++ } ++ err = rtw_cfgvendor_send_cmd_reply(wiphy, bcmcfg_to_prmry_ndev(cfg), ++ &capability, sizeof(capability)); ++ ++ if (unlikely(err)) ++ WL_ERR(("Vendor Command reply failed ret:%d\n", err)); ++exit: ++ return err; ++} ++ ++#endif /* RTT_SUPPORT */ ++static int wl_cfgvendor_priv_string_handler(struct wiphy *wiphy, ++ struct wireless_dev *wdev, const void *data, int len) ++{ ++ int err = 0; ++ u8 resp[1] = {'\0'}; ++ ++ RTW_PRINT(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(wdev_to_ndev(wdev)), (char *)data); ++ err = rtw_cfgvendor_send_cmd_reply(wiphy, wdev_to_ndev(wdev), resp, 1); ++ if (unlikely(err)) ++ RTW_ERR(FUNC_NDEV_FMT"Vendor Command reply failed ret:%d\n" ++ , FUNC_NDEV_ARG(wdev_to_ndev(wdev)), err); ++ ++ return err; ++#if 0 ++ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); ++ int err = 0; ++ int data_len = 0; ++ ++ bzero(cfg->ioctl_buf, WLC_IOCTL_MAXLEN); ++ ++ if (strncmp((char *)data, BRCM_VENDOR_SCMD_CAPA, strlen(BRCM_VENDOR_SCMD_CAPA)) == 0) { ++ err = wldev_iovar_getbuf(bcmcfg_to_prmry_ndev(cfg), "cap", NULL, 0, ++ cfg->ioctl_buf, WLC_IOCTL_MAXLEN, &cfg->ioctl_buf_sync); ++ if (unlikely(err)) { ++ WL_ERR(("error (%d)\n", err)); ++ return err; ++ } ++ data_len = strlen(cfg->ioctl_buf); ++ cfg->ioctl_buf[data_len] = '\0'; ++ } ++ ++ err = rtw_cfgvendor_send_cmd_reply(wiphy, bcmcfg_to_prmry_ndev(cfg), ++ cfg->ioctl_buf, data_len + 1); ++ if (unlikely(err)) ++ WL_ERR(("Vendor Command reply failed ret:%d\n", err)); ++ else ++ WL_INFORM(("Vendor Command reply sent successfully!\n")); ++ ++ return err; ++#endif ++} ++ ++static const struct wiphy_vendor_command rtw_vendor_cmds[] = { ++ { ++ { ++ .vendor_id = OUI_BRCM, ++ .subcmd = BRCM_VENDOR_SCMD_PRIV_STR ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = wl_cfgvendor_priv_string_handler ++ }, ++#if defined(GSCAN_SUPPORT) && 0 ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = GSCAN_SUBCMD_GET_CAPABILITIES ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = wl_cfgvendor_gscan_get_capabilities ++ }, ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = GSCAN_SUBCMD_SET_CONFIG ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = wl_cfgvendor_set_scan_cfg ++ }, ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = GSCAN_SUBCMD_SET_SCAN_CONFIG ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = wl_cfgvendor_set_batch_scan_cfg ++ }, ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = GSCAN_SUBCMD_ENABLE_GSCAN ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = wl_cfgvendor_initiate_gscan ++ }, ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = GSCAN_SUBCMD_ENABLE_FULL_SCAN_RESULTS ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = wl_cfgvendor_enable_full_scan_result ++ }, ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = GSCAN_SUBCMD_SET_HOTLIST ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = wl_cfgvendor_hotlist_cfg ++ }, ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = GSCAN_SUBCMD_SET_SIGNIFICANT_CHANGE_CONFIG ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = wl_cfgvendor_significant_change_cfg ++ }, ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = GSCAN_SUBCMD_GET_SCAN_RESULTS ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = wl_cfgvendor_gscan_get_batch_results ++ }, ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = GSCAN_SUBCMD_GET_CHANNEL_LIST ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = wl_cfgvendor_gscan_get_channel_list ++ }, ++#endif /* GSCAN_SUPPORT */ ++#if defined(RTT_SUPPORT) && 0 ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = RTT_SUBCMD_SET_CONFIG ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = wl_cfgvendor_rtt_set_config ++ }, ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = RTT_SUBCMD_CANCEL_CONFIG ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = wl_cfgvendor_rtt_cancel_config ++ }, ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = RTT_SUBCMD_GETCAPABILITY ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = wl_cfgvendor_rtt_get_capability ++ }, ++#endif /* RTT_SUPPORT */ ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = ANDR_WIFI_SUBCMD_GET_FEATURE_SET ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = rtw_cfgvendor_get_feature_set ++ }, ++ { ++ { ++ .vendor_id = OUI_GOOGLE, ++ .subcmd = ANDR_WIFI_SUBCMD_GET_FEATURE_SET_MATRIX ++ }, ++ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, ++ .doit = rtw_cfgvendor_get_feature_set_matrix ++ } ++}; ++ ++static const struct nl80211_vendor_cmd_info rtw_vendor_events[] = { ++ { OUI_BRCM, BRCM_VENDOR_EVENT_UNSPEC }, ++ { OUI_BRCM, BRCM_VENDOR_EVENT_PRIV_STR }, ++#if defined(GSCAN_SUPPORT) && 0 ++ { OUI_GOOGLE, GOOGLE_GSCAN_SIGNIFICANT_EVENT }, ++ { OUI_GOOGLE, GOOGLE_GSCAN_GEOFENCE_FOUND_EVENT }, ++ { OUI_GOOGLE, GOOGLE_GSCAN_BATCH_SCAN_EVENT }, ++ { OUI_GOOGLE, GOOGLE_SCAN_FULL_RESULTS_EVENT }, ++#endif /* GSCAN_SUPPORT */ ++#if defined(RTT_SUPPORT) && 0 ++ { OUI_GOOGLE, GOOGLE_RTT_COMPLETE_EVENT }, ++#endif /* RTT_SUPPORT */ ++#if defined(GSCAN_SUPPORT) && 0 ++ { OUI_GOOGLE, GOOGLE_SCAN_COMPLETE_EVENT }, ++ { OUI_GOOGLE, GOOGLE_GSCAN_GEOFENCE_LOST_EVENT } ++#endif /* GSCAN_SUPPORT */ ++}; ++ ++int rtw_cfgvendor_attach(struct wiphy *wiphy) ++{ ++ ++ RTW_INFO("Register RTW cfg80211 vendor cmd(0x%x) interface\n", NL80211_CMD_VENDOR); ++ ++ wiphy->vendor_commands = rtw_vendor_cmds; ++ wiphy->n_vendor_commands = ARRAY_SIZE(rtw_vendor_cmds); ++ wiphy->vendor_events = rtw_vendor_events; ++ wiphy->n_vendor_events = ARRAY_SIZE(rtw_vendor_events); ++ ++ return 0; ++} ++ ++int rtw_cfgvendor_detach(struct wiphy *wiphy) ++{ ++ RTW_INFO("Vendor: Unregister RTW cfg80211 vendor interface\n"); ++ ++ wiphy->vendor_commands = NULL; ++ wiphy->vendor_events = NULL; ++ wiphy->n_vendor_commands = 0; ++ wiphy->n_vendor_events = 0; ++ ++ return 0; ++} ++#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) */ ++ ++#endif /* CONFIG_IOCTL_CFG80211 */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.h linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.h +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.h 2018-02-11 21:44:27.176146528 +0200 +@@ -0,0 +1,245 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2014 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#ifndef _RTW_CFGVENDOR_H_ ++#define _RTW_CFGVENDOR_H_ ++ ++#define OUI_BRCM 0x001018 ++#define OUI_GOOGLE 0x001A11 ++#define BRCM_VENDOR_SUBCMD_PRIV_STR 1 ++#define ATTRIBUTE_U32_LEN (NLA_HDRLEN + 4) ++#define VENDOR_ID_OVERHEAD ATTRIBUTE_U32_LEN ++#define VENDOR_SUBCMD_OVERHEAD ATTRIBUTE_U32_LEN ++#define VENDOR_DATA_OVERHEAD (NLA_HDRLEN) ++ ++#define SCAN_RESULTS_COMPLETE_FLAG_LEN ATTRIBUTE_U32_LEN ++#define SCAN_INDEX_HDR_LEN (NLA_HDRLEN) ++#define SCAN_ID_HDR_LEN ATTRIBUTE_U32_LEN ++#define SCAN_FLAGS_HDR_LEN ATTRIBUTE_U32_LEN ++#define GSCAN_NUM_RESULTS_HDR_LEN ATTRIBUTE_U32_LEN ++#define GSCAN_RESULTS_HDR_LEN (NLA_HDRLEN) ++#define GSCAN_BATCH_RESULT_HDR_LEN (SCAN_INDEX_HDR_LEN + SCAN_ID_HDR_LEN + \ ++ SCAN_FLAGS_HDR_LEN + \ ++ GSCAN_NUM_RESULTS_HDR_LEN + \ ++ GSCAN_RESULTS_HDR_LEN) ++ ++#define VENDOR_REPLY_OVERHEAD (VENDOR_ID_OVERHEAD + \ ++ VENDOR_SUBCMD_OVERHEAD + \ ++ VENDOR_DATA_OVERHEAD) ++typedef enum { ++ /* don't use 0 as a valid subcommand */ ++ VENDOR_NL80211_SUBCMD_UNSPECIFIED, ++ ++ /* define all vendor startup commands between 0x0 and 0x0FFF */ ++ VENDOR_NL80211_SUBCMD_RANGE_START = 0x0001, ++ VENDOR_NL80211_SUBCMD_RANGE_END = 0x0FFF, ++ ++ /* define all GScan related commands between 0x1000 and 0x10FF */ ++ ANDROID_NL80211_SUBCMD_GSCAN_RANGE_START = 0x1000, ++ ANDROID_NL80211_SUBCMD_GSCAN_RANGE_END = 0x10FF, ++ ++ /* define all NearbyDiscovery related commands between 0x1100 and 0x11FF */ ++ ANDROID_NL80211_SUBCMD_NBD_RANGE_START = 0x1100, ++ ANDROID_NL80211_SUBCMD_NBD_RANGE_END = 0x11FF, ++ ++ /* define all RTT related commands between 0x1100 and 0x11FF */ ++ ANDROID_NL80211_SUBCMD_RTT_RANGE_START = 0x1100, ++ ANDROID_NL80211_SUBCMD_RTT_RANGE_END = 0x11FF, ++ ++ ANDROID_NL80211_SUBCMD_LSTATS_RANGE_START = 0x1200, ++ ANDROID_NL80211_SUBCMD_LSTATS_RANGE_END = 0x12FF, ++ ++ ANDROID_NL80211_SUBCMD_TDLS_RANGE_START = 0x1300, ++ ANDROID_NL80211_SUBCMD_TDLS_RANGE_END = 0x13FF, ++ /* This is reserved for future usage */ ++ ++} ANDROID_VENDOR_SUB_COMMAND; ++ ++enum wl_vendor_subcmd { ++ BRCM_VENDOR_SCMD_UNSPEC, ++ BRCM_VENDOR_SCMD_PRIV_STR, ++ GSCAN_SUBCMD_GET_CAPABILITIES = ANDROID_NL80211_SUBCMD_GSCAN_RANGE_START, ++ GSCAN_SUBCMD_SET_CONFIG, ++ GSCAN_SUBCMD_SET_SCAN_CONFIG, ++ GSCAN_SUBCMD_ENABLE_GSCAN, ++ GSCAN_SUBCMD_GET_SCAN_RESULTS, ++ GSCAN_SUBCMD_SCAN_RESULTS, ++ GSCAN_SUBCMD_SET_HOTLIST, ++ GSCAN_SUBCMD_SET_SIGNIFICANT_CHANGE_CONFIG, ++ GSCAN_SUBCMD_ENABLE_FULL_SCAN_RESULTS, ++ GSCAN_SUBCMD_GET_CHANNEL_LIST, ++ ANDR_WIFI_SUBCMD_GET_FEATURE_SET, ++ ANDR_WIFI_SUBCMD_GET_FEATURE_SET_MATRIX, ++ RTT_SUBCMD_SET_CONFIG = ANDROID_NL80211_SUBCMD_RTT_RANGE_START, ++ RTT_SUBCMD_CANCEL_CONFIG, ++ RTT_SUBCMD_GETCAPABILITY, ++ /* Add more sub commands here */ ++ VENDOR_SUBCMD_MAX ++}; ++ ++enum gscan_attributes { ++ GSCAN_ATTRIBUTE_NUM_BUCKETS = 10, ++ GSCAN_ATTRIBUTE_BASE_PERIOD, ++ GSCAN_ATTRIBUTE_BUCKETS_BAND, ++ GSCAN_ATTRIBUTE_BUCKET_ID, ++ GSCAN_ATTRIBUTE_BUCKET_PERIOD, ++ GSCAN_ATTRIBUTE_BUCKET_NUM_CHANNELS, ++ GSCAN_ATTRIBUTE_BUCKET_CHANNELS, ++ GSCAN_ATTRIBUTE_NUM_AP_PER_SCAN, ++ GSCAN_ATTRIBUTE_REPORT_THRESHOLD, ++ GSCAN_ATTRIBUTE_NUM_SCANS_TO_CACHE, ++ GSCAN_ATTRIBUTE_BAND = GSCAN_ATTRIBUTE_BUCKETS_BAND, ++ ++ GSCAN_ATTRIBUTE_ENABLE_FEATURE = 20, ++ GSCAN_ATTRIBUTE_SCAN_RESULTS_COMPLETE, ++ GSCAN_ATTRIBUTE_FLUSH_FEATURE, ++ GSCAN_ATTRIBUTE_ENABLE_FULL_SCAN_RESULTS, ++ GSCAN_ATTRIBUTE_REPORT_EVENTS, ++ /* remaining reserved for additional attributes */ ++ GSCAN_ATTRIBUTE_NUM_OF_RESULTS = 30, ++ GSCAN_ATTRIBUTE_FLUSH_RESULTS, ++ GSCAN_ATTRIBUTE_SCAN_RESULTS, /* flat array of wifi_scan_result */ ++ GSCAN_ATTRIBUTE_SCAN_ID, /* indicates scan number */ ++ GSCAN_ATTRIBUTE_SCAN_FLAGS, /* indicates if scan was aborted */ ++ GSCAN_ATTRIBUTE_AP_FLAGS, /* flags on significant change event */ ++ GSCAN_ATTRIBUTE_NUM_CHANNELS, ++ GSCAN_ATTRIBUTE_CHANNEL_LIST, ++ ++ /* remaining reserved for additional attributes */ ++ ++ GSCAN_ATTRIBUTE_SSID = 40, ++ GSCAN_ATTRIBUTE_BSSID, ++ GSCAN_ATTRIBUTE_CHANNEL, ++ GSCAN_ATTRIBUTE_RSSI, ++ GSCAN_ATTRIBUTE_TIMESTAMP, ++ GSCAN_ATTRIBUTE_RTT, ++ GSCAN_ATTRIBUTE_RTTSD, ++ ++ /* remaining reserved for additional attributes */ ++ ++ GSCAN_ATTRIBUTE_HOTLIST_BSSIDS = 50, ++ GSCAN_ATTRIBUTE_RSSI_LOW, ++ GSCAN_ATTRIBUTE_RSSI_HIGH, ++ GSCAN_ATTRIBUTE_HOSTLIST_BSSID_ELEM, ++ GSCAN_ATTRIBUTE_HOTLIST_FLUSH, ++ ++ /* remaining reserved for additional attributes */ ++ GSCAN_ATTRIBUTE_RSSI_SAMPLE_SIZE = 60, ++ GSCAN_ATTRIBUTE_LOST_AP_SAMPLE_SIZE, ++ GSCAN_ATTRIBUTE_MIN_BREACHING, ++ GSCAN_ATTRIBUTE_SIGNIFICANT_CHANGE_BSSIDS, ++ GSCAN_ATTRIBUTE_SIGNIFICANT_CHANGE_FLUSH, ++ GSCAN_ATTRIBUTE_MAX ++}; ++ ++enum gscan_bucket_attributes { ++ GSCAN_ATTRIBUTE_CH_BUCKET_1, ++ GSCAN_ATTRIBUTE_CH_BUCKET_2, ++ GSCAN_ATTRIBUTE_CH_BUCKET_3, ++ GSCAN_ATTRIBUTE_CH_BUCKET_4, ++ GSCAN_ATTRIBUTE_CH_BUCKET_5, ++ GSCAN_ATTRIBUTE_CH_BUCKET_6, ++ GSCAN_ATTRIBUTE_CH_BUCKET_7 ++}; ++ ++enum gscan_ch_attributes { ++ GSCAN_ATTRIBUTE_CH_ID_1, ++ GSCAN_ATTRIBUTE_CH_ID_2, ++ GSCAN_ATTRIBUTE_CH_ID_3, ++ GSCAN_ATTRIBUTE_CH_ID_4, ++ GSCAN_ATTRIBUTE_CH_ID_5, ++ GSCAN_ATTRIBUTE_CH_ID_6, ++ GSCAN_ATTRIBUTE_CH_ID_7 ++}; ++ ++enum rtt_attributes { ++ RTT_ATTRIBUTE_TARGET_CNT, ++ RTT_ATTRIBUTE_TARGET_INFO, ++ RTT_ATTRIBUTE_TARGET_MAC, ++ RTT_ATTRIBUTE_TARGET_TYPE, ++ RTT_ATTRIBUTE_TARGET_PEER, ++ RTT_ATTRIBUTE_TARGET_CHAN, ++ RTT_ATTRIBUTE_TARGET_MODE, ++ RTT_ATTRIBUTE_TARGET_INTERVAL, ++ RTT_ATTRIBUTE_TARGET_NUM_MEASUREMENT, ++ RTT_ATTRIBUTE_TARGET_NUM_PKT, ++ RTT_ATTRIBUTE_TARGET_NUM_RETRY ++}; ++ ++typedef enum wl_vendor_event { ++ BRCM_VENDOR_EVENT_UNSPEC, ++ BRCM_VENDOR_EVENT_PRIV_STR, ++ GOOGLE_GSCAN_SIGNIFICANT_EVENT, ++ GOOGLE_GSCAN_GEOFENCE_FOUND_EVENT, ++ GOOGLE_GSCAN_BATCH_SCAN_EVENT, ++ GOOGLE_SCAN_FULL_RESULTS_EVENT, ++ GOOGLE_RTT_COMPLETE_EVENT, ++ GOOGLE_SCAN_COMPLETE_EVENT, ++ GOOGLE_GSCAN_GEOFENCE_LOST_EVENT ++} wl_vendor_event_t; ++ ++enum andr_wifi_feature_set_attr { ++ ANDR_WIFI_ATTRIBUTE_NUM_FEATURE_SET, ++ ANDR_WIFI_ATTRIBUTE_FEATURE_SET ++}; ++ ++typedef enum wl_vendor_gscan_attribute { ++ ATTR_START_GSCAN, ++ ATTR_STOP_GSCAN, ++ ATTR_SET_SCAN_BATCH_CFG_ID, /* set batch scan params */ ++ ATTR_SET_SCAN_GEOFENCE_CFG_ID, /* set list of bssids to track */ ++ ATTR_SET_SCAN_SIGNIFICANT_CFG_ID, /* set list of bssids, rssi threshold etc.. */ ++ ATTR_SET_SCAN_CFG_ID, /* set common scan config params here */ ++ ATTR_GET_GSCAN_CAPABILITIES_ID, ++ /* Add more sub commands here */ ++ ATTR_GSCAN_MAX ++} wl_vendor_gscan_attribute_t; ++ ++typedef enum gscan_batch_attribute { ++ ATTR_GSCAN_BATCH_BESTN, ++ ATTR_GSCAN_BATCH_MSCAN, ++ ATTR_GSCAN_BATCH_BUFFER_THRESHOLD ++} gscan_batch_attribute_t; ++ ++typedef enum gscan_geofence_attribute { ++ ATTR_GSCAN_NUM_HOTLIST_BSSID, ++ ATTR_GSCAN_HOTLIST_BSSID ++} gscan_geofence_attribute_t; ++ ++typedef enum gscan_complete_event { ++ WIFI_SCAN_BUFFER_FULL, ++ WIFI_SCAN_COMPLETE ++} gscan_complete_event_t; ++ ++/* Capture the BRCM_VENDOR_SUBCMD_PRIV_STRINGS* here */ ++#define BRCM_VENDOR_SCMD_CAPA "cap" ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) ++extern int rtw_cfgvendor_attach(struct wiphy *wiphy); ++extern int rtw_cfgvendor_detach(struct wiphy *wiphy); ++extern int rtw_cfgvendor_send_async_event(struct wiphy *wiphy, ++ struct net_device *dev, int event_id, const void *data, int len); ++#if defined(GSCAN_SUPPORT) && 0 ++extern int wl_cfgvendor_send_hotlist_event(struct wiphy *wiphy, ++ struct net_device *dev, void *data, int len, wl_vendor_event_t event); ++#endif ++#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) */ ++ ++#endif /* _RTW_CFGVENDOR_H_ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_proc.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_proc.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_proc.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_proc.c 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,3004 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#include /* tolower() */ ++#include ++#include ++#include "rtw_proc.h" ++#ifdef CONFIG_BT_COEXIST ++#include ++#endif ++ ++#ifdef CONFIG_PROC_DEBUG ++ ++static struct proc_dir_entry *rtw_proc = NULL; ++ ++inline struct proc_dir_entry *get_rtw_drv_proc(void) ++{ ++ return rtw_proc; ++} ++ ++#define RTW_PROC_NAME DRV_NAME ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 9, 0)) ++#define file_inode(file) ((file)->f_dentry->d_inode) ++#endif ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 0)) ++#define PDE_DATA(inode) PDE((inode))->data ++#define proc_get_parent_data(inode) PDE((inode))->parent->data ++#endif ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) ++#define get_proc_net proc_net ++#else ++#define get_proc_net init_net.proc_net ++#endif ++ ++inline struct proc_dir_entry *rtw_proc_create_dir(const char *name, struct proc_dir_entry *parent, void *data) ++{ ++ struct proc_dir_entry *entry; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) ++ entry = proc_mkdir_data(name, S_IRUGO | S_IXUGO, parent, data); ++#else ++ /* entry = proc_mkdir_mode(name, S_IRUGO|S_IXUGO, parent); */ ++ entry = proc_mkdir(name, parent); ++ if (entry) ++ entry->data = data; ++#endif ++ ++ return entry; ++} ++ ++inline struct proc_dir_entry *rtw_proc_create_entry(const char *name, struct proc_dir_entry *parent, ++ const struct file_operations *fops, void * data) ++{ ++ struct proc_dir_entry *entry; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)) ++ entry = proc_create_data(name, S_IFREG | S_IRUGO | S_IWUGO, parent, fops, data); ++#else ++ entry = create_proc_entry(name, S_IFREG | S_IRUGO | S_IWUGO, parent); ++ if (entry) { ++ entry->data = data; ++ entry->proc_fops = fops; ++ } ++#endif ++ ++ return entry; ++} ++ ++static int proc_get_dummy(struct seq_file *m, void *v) ++{ ++ return 0; ++} ++ ++static int proc_get_drv_version(struct seq_file *m, void *v) ++{ ++ dump_drv_version(m); ++ return 0; ++} ++ ++static int proc_get_log_level(struct seq_file *m, void *v) ++{ ++ dump_log_level(m); ++ return 0; ++} ++ ++static int proc_get_drv_cfg(struct seq_file *m, void *v) ++{ ++ dump_drv_cfg(m); ++ return 0; ++} ++ ++static ssize_t proc_set_log_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ char tmp[32]; ++ int log_level; ++ ++ if (count < 1) ++ return -EINVAL; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++#ifdef CONFIG_RTW_DEBUG ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%d ", &log_level); ++ ++ if (log_level >= _DRV_NONE_ && log_level <= _DRV_MAX_) { ++ rtw_drv_log_level = log_level; ++ printk("rtw_drv_log_level:%d\n", rtw_drv_log_level); ++ } ++ } else ++ return -EFAULT; ++#else ++ printk("CONFIG_RTW_DEBUG is disabled\n"); ++#endif ++ ++ return count; ++} ++ ++#ifdef DBG_MEM_ALLOC ++static int proc_get_mstat(struct seq_file *m, void *v) ++{ ++ rtw_mstat_dump(m); ++ return 0; ++} ++#endif /* DBG_MEM_ALLOC */ ++ ++static int proc_get_country_chplan_map(struct seq_file *m, void *v) ++{ ++ dump_country_chplan_map(m); ++ return 0; ++} ++ ++static int proc_get_chplan_id_list(struct seq_file *m, void *v) ++{ ++ dump_chplan_id_list(m); ++ return 0; ++} ++ ++static int proc_get_chplan_test(struct seq_file *m, void *v) ++{ ++ dump_chplan_test(m); ++ return 0; ++} ++ ++/* ++* rtw_drv_proc: ++* init/deinit when register/unregister driver ++*/ ++const struct rtw_proc_hdl drv_proc_hdls[] = { ++ RTW_PROC_HDL_SSEQ("ver_info", proc_get_drv_version, NULL), ++ RTW_PROC_HDL_SSEQ("log_level", proc_get_log_level, proc_set_log_level), ++ RTW_PROC_HDL_SSEQ("drv_cfg", proc_get_drv_cfg, NULL), ++#ifdef DBG_MEM_ALLOC ++ RTW_PROC_HDL_SSEQ("mstat", proc_get_mstat, NULL), ++#endif /* DBG_MEM_ALLOC */ ++ RTW_PROC_HDL_SSEQ("country_chplan_map", proc_get_country_chplan_map, NULL), ++ RTW_PROC_HDL_SSEQ("chplan_id_list", proc_get_chplan_id_list, NULL), ++ RTW_PROC_HDL_SSEQ("chplan_test", proc_get_chplan_test, NULL), ++}; ++ ++const int drv_proc_hdls_num = sizeof(drv_proc_hdls) / sizeof(struct rtw_proc_hdl); ++ ++static int rtw_drv_proc_open(struct inode *inode, struct file *file) ++{ ++ /* struct net_device *dev = proc_get_parent_data(inode); */ ++ ssize_t index = (ssize_t)PDE_DATA(inode); ++ const struct rtw_proc_hdl *hdl = drv_proc_hdls + index; ++ void *private = NULL; ++ ++ if (hdl->type == RTW_PROC_HDL_TYPE_SEQ) { ++ int res = seq_open(file, hdl->u.seq_op); ++ ++ if (res == 0) ++ ((struct seq_file *)file->private_data)->private = private; ++ ++ return res; ++ } else if (hdl->type == RTW_PROC_HDL_TYPE_SSEQ) { ++ int (*show)(struct seq_file *, void *) = hdl->u.show ? hdl->u.show : proc_get_dummy; ++ ++ return single_open(file, show, private); ++ } else { ++ return -EROFS; ++ } ++} ++ ++static ssize_t rtw_drv_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) ++{ ++ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); ++ const struct rtw_proc_hdl *hdl = drv_proc_hdls + index; ++ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; ++ ++ if (write) ++ return write(file, buffer, count, pos, NULL); ++ ++ return -EROFS; ++} ++ ++static const struct file_operations rtw_drv_proc_seq_fops = { ++ .owner = THIS_MODULE, ++ .open = rtw_drv_proc_open, ++ .read = seq_read, ++ .llseek = seq_lseek, ++ .release = seq_release, ++ .write = rtw_drv_proc_write, ++}; ++ ++static const struct file_operations rtw_drv_proc_sseq_fops = { ++ .owner = THIS_MODULE, ++ .open = rtw_drv_proc_open, ++ .read = seq_read, ++ .llseek = seq_lseek, ++ .release = single_release, ++ .write = rtw_drv_proc_write, ++}; ++ ++int rtw_drv_proc_init(void) ++{ ++ int ret = _FAIL; ++ ssize_t i; ++ struct proc_dir_entry *entry = NULL; ++ ++ if (rtw_proc != NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ rtw_proc = rtw_proc_create_dir(RTW_PROC_NAME, get_proc_net, NULL); ++ ++ if (rtw_proc == NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ for (i = 0; i < drv_proc_hdls_num; i++) { ++ if (drv_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SEQ) ++ entry = rtw_proc_create_entry(drv_proc_hdls[i].name, rtw_proc, &rtw_drv_proc_seq_fops, (void *)i); ++ else if (drv_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SSEQ) ++ entry = rtw_proc_create_entry(drv_proc_hdls[i].name, rtw_proc, &rtw_drv_proc_sseq_fops, (void *)i); ++ else ++ entry = NULL; ++ ++ if (!entry) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ } ++ ++ ret = _SUCCESS; ++ ++exit: ++ return ret; ++} ++ ++void rtw_drv_proc_deinit(void) ++{ ++ int i; ++ ++ if (rtw_proc == NULL) ++ return; ++ ++ for (i = 0; i < drv_proc_hdls_num; i++) ++ remove_proc_entry(drv_proc_hdls[i].name, rtw_proc); ++ ++ remove_proc_entry(RTW_PROC_NAME, get_proc_net); ++ rtw_proc = NULL; ++} ++ ++#ifndef RTW_SEQ_FILE_TEST ++#define RTW_SEQ_FILE_TEST 0 ++#endif ++ ++#if RTW_SEQ_FILE_TEST ++#define RTW_SEQ_FILE_TEST_SHOW_LIMIT 300 ++static void *proc_start_seq_file_test(struct seq_file *m, loff_t *pos) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_PRINT(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); ++ if (*pos >= RTW_SEQ_FILE_TEST_SHOW_LIMIT) { ++ RTW_PRINT(FUNC_ADPT_FMT" pos:%llu, out of range return\n", FUNC_ADPT_ARG(adapter), *pos); ++ return NULL; ++ } ++ ++ RTW_PRINT(FUNC_ADPT_FMT" return pos:%lld\n", FUNC_ADPT_ARG(adapter), *pos); ++ return pos; ++} ++void proc_stop_seq_file_test(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_PRINT(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); ++} ++ ++void *proc_next_seq_file_test(struct seq_file *m, void *v, loff_t *pos) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ (*pos)++; ++ if (*pos >= RTW_SEQ_FILE_TEST_SHOW_LIMIT) { ++ RTW_PRINT(FUNC_ADPT_FMT" pos:%lld, out of range return\n", FUNC_ADPT_ARG(adapter), *pos); ++ return NULL; ++ } ++ ++ RTW_PRINT(FUNC_ADPT_FMT" return pos:%lld\n", FUNC_ADPT_ARG(adapter), *pos); ++ return pos; ++} ++ ++static int proc_get_seq_file_test(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ u32 pos = *((loff_t *)(v)); ++ RTW_PRINT(FUNC_ADPT_FMT" pos:%d\n", FUNC_ADPT_ARG(adapter), pos); ++ RTW_PRINT_SEL(m, FUNC_ADPT_FMT" pos:%d\n", FUNC_ADPT_ARG(adapter), pos); ++ return 0; ++} ++ ++struct seq_operations seq_file_test = { ++ .start = proc_start_seq_file_test, ++ .stop = proc_stop_seq_file_test, ++ .next = proc_next_seq_file_test, ++ .show = proc_get_seq_file_test, ++}; ++#endif /* RTW_SEQ_FILE_TEST */ ++ ++#ifdef CONFIG_SDIO_HCI ++static int proc_get_sd_f0_reg_dump(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ sd_f0_reg_dump(m, adapter); ++ ++ return 0; ++} ++ ++static int proc_get_sdio_local_reg_dump(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ sdio_local_reg_dump(m, adapter); ++ ++ return 0; ++} ++#endif /* CONFIG_SDIO_HCI */ ++ ++static int proc_get_mac_reg_dump(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ mac_reg_dump(m, adapter); ++ ++ return 0; ++} ++ ++static int proc_get_bb_reg_dump(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ bb_reg_dump(m, adapter); ++ ++ return 0; ++} ++ ++static int proc_get_rf_reg_dump(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ rf_reg_dump(m, adapter); ++ ++ return 0; ++} ++ ++static int proc_get_dump_tx_rate_bmp(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ dump_tx_rate_bmp(m, adapter_to_dvobj(adapter)); ++ ++ return 0; ++} ++ ++static int proc_get_dump_adapters_status(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ dump_adapters_status(m, adapter_to_dvobj(adapter)); ++ ++ return 0; ++} ++ ++#ifdef CONFIG_RTW_CUSTOMER_STR ++static int proc_get_customer_str(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 cstr[RTW_CUSTOMER_STR_LEN]; ++ ++ rtw_ps_deny(adapter, PS_DENY_IOCTL); ++ if (rtw_pwr_wakeup(adapter) == _FAIL) ++ goto exit; ++ ++ if (rtw_hal_customer_str_read(adapter, cstr) != _SUCCESS) ++ goto exit; ++ ++ RTW_PRINT_SEL(m, RTW_CUSTOMER_STR_FMT"\n", RTW_CUSTOMER_STR_ARG(cstr)); ++ ++exit: ++ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); ++ return 0; ++} ++#endif /* CONFIG_RTW_CUSTOMER_STR */ ++ ++/* gpio setting */ ++#ifdef CONFIG_GPIO_API ++static ssize_t proc_set_config_gpio(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32] = {0}; ++ int num = 0, gpio_pin = 0, gpio_mode = 0; /* gpio_mode:0 input 1:output; */ ++ ++ if (count < 2) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ num = sscanf(tmp, "%d %d", &gpio_pin, &gpio_mode); ++ RTW_INFO("num=%d gpio_pin=%d mode=%d\n", num, gpio_pin, gpio_mode); ++ padapter->pre_gpio_pin = gpio_pin; ++ ++ if (gpio_mode == 0 || gpio_mode == 1) ++ rtw_hal_config_gpio(padapter, gpio_pin, gpio_mode); ++ } ++ return count; ++ ++} ++static ssize_t proc_set_gpio_output_value(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32] = {0}; ++ int num = 0, gpio_pin = 0, pin_mode = 0; /* pin_mode: 1 high 0:low */ ++ ++ if (count < 2) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ num = sscanf(tmp, "%d %d", &gpio_pin, &pin_mode); ++ RTW_INFO("num=%d gpio_pin=%d pin_high=%d\n", num, gpio_pin, pin_mode); ++ padapter->pre_gpio_pin = gpio_pin; ++ ++ if (pin_mode == 0 || pin_mode == 1) ++ rtw_hal_set_gpio_output_value(padapter, gpio_pin, pin_mode); ++ } ++ return count; ++} ++static int proc_get_gpio(struct seq_file *m, void *v) ++{ ++ u8 gpioreturnvalue = 0; ++ struct net_device *dev = m->private; ++ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ if (!padapter) ++ return -EFAULT; ++ gpioreturnvalue = rtw_hal_get_gpio(padapter, padapter->pre_gpio_pin); ++ RTW_PRINT_SEL(m, "get_gpio %d:%d\n", padapter->pre_gpio_pin, gpioreturnvalue); ++ ++ return 0; ++ ++} ++static ssize_t proc_set_gpio(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32] = {0}; ++ int num = 0, gpio_pin = 0; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ num = sscanf(tmp, "%d", &gpio_pin); ++ RTW_INFO("num=%d gpio_pin=%d\n", num, gpio_pin); ++ padapter->pre_gpio_pin = gpio_pin; ++ ++ } ++ return count; ++} ++#endif ++static ssize_t proc_set_rx_info_msg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct recv_priv *precvpriv = &(padapter->recvpriv); ++ char tmp[32] = {0}; ++ int phy_info_flag = 0; ++ ++ if (!padapter) ++ return -EFAULT; ++ ++ if (count < 1) { ++ RTW_INFO("argument size is less than 1\n"); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int num = sscanf(tmp, "%d", &phy_info_flag); ++ ++ precvpriv->store_law_data_flag = (BOOLEAN) phy_info_flag; ++ ++ /*RTW_INFO("precvpriv->store_law_data_flag = %d\n",( BOOLEAN )(precvpriv->store_law_data_flag));*/ ++ } ++ return count; ++} ++static int proc_get_rx_info_msg(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_RX_Dframe_INFO, m, _FALSE); ++ return 0; ++} ++static int proc_get_tx_info_msg(struct seq_file *m, void *v) ++{ ++ _irqL irqL; ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ struct sta_info *psta; ++ u8 bc_addr[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ u8 null_addr[6] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ int i; ++ _list *plist, *phead; ++ u8 current_rate_id = 0, current_sgi = 0; ++ ++ char *BW, *status; ++ ++ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE)) ++ status = "station mode"; ++ else if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE)) ++ status = "AP mode"; ++ else ++ status = " "; ++ _RTW_PRINT_SEL(m, "status=%s\n", status); ++ for (i = 0; i < NUM_STA; i++) { ++ phead = &(pstapriv->sta_hash[i]); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ ++ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); ++ ++ plist = get_next(plist); ++ ++ if ((_rtw_memcmp(psta->hwaddr, bc_addr, 6) != _TRUE) ++ && (_rtw_memcmp(psta->hwaddr, null_addr, 6) != _TRUE) ++ && (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), 6) != _TRUE)) { ++ ++ switch (psta->bw_mode) { ++ ++ case CHANNEL_WIDTH_20: ++ BW = "20M"; ++ break; ++ ++ case CHANNEL_WIDTH_40: ++ BW = "40M"; ++ break; ++ ++ case CHANNEL_WIDTH_80: ++ BW = "80M"; ++ break; ++ ++ case CHANNEL_WIDTH_160: ++ BW = "160M"; ++ break; ++ ++ default: ++ BW = ""; ++ break; ++ } ++ current_rate_id = rtw_get_current_tx_rate(adapter, psta->mac_id); ++ current_sgi = rtw_get_current_tx_sgi(adapter, psta->mac_id); ++ ++ RTW_PRINT_SEL(m, "==============================\n"); ++ _RTW_PRINT_SEL(m, "macaddr=" MAC_FMT"\n", MAC_ARG(psta->hwaddr)); ++ _RTW_PRINT_SEL(m, "Tx_Data_Rate=%s\n", HDATA_RATE(current_rate_id)); ++ _RTW_PRINT_SEL(m, "BW=%s,sgi=%u\n", BW, current_sgi); ++ ++ } ++ } ++ } ++ ++ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); ++ ++ return 0; ++ ++} ++ ++ ++static int proc_get_linked_info_dump(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ if (padapter) ++ RTW_PRINT_SEL(m, "linked_info_dump :%s\n", (padapter->bLinkInfoDump) ? "enable" : "disable"); ++ ++ return 0; ++} ++ ++ ++static ssize_t proc_set_linked_info_dump(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ char tmp[32] = {0}; ++ int mode = 0, pre_mode = 0; ++ int num = 0; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ pre_mode = padapter->bLinkInfoDump; ++ RTW_INFO("pre_mode=%d\n", pre_mode); ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ num = sscanf(tmp, "%d ", &mode); ++ RTW_INFO("num=%d mode=%d\n", num, mode); ++ ++ if (num != 1) { ++ RTW_INFO("argument number is wrong\n"); ++ return -EFAULT; ++ } ++ ++ if (mode == 1 || (mode == 0 && pre_mode == 1)) /* not consider pwr_saving 0: */ ++ padapter->bLinkInfoDump = mode; ++ ++ else if ((mode == 2) || (mode == 0 && pre_mode == 2)) { /* consider power_saving */ ++ /* RTW_INFO("linked_info_dump =%s\n", (padapter->bLinkInfoDump)?"enable":"disable") */ ++ linked_info_dump(padapter, mode); ++ } ++ } ++ return count; ++} ++ ++static int proc_get_mac_qinfo(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ rtw_hal_get_hwreg(adapter, HW_VAR_DUMP_MAC_QUEUE_INFO, (u8 *)m); ++ ++ return 0; ++} ++ ++int proc_get_wifi_spec(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ ++ RTW_PRINT_SEL(m, "wifi_spec=%d\n", pregpriv->wifi_spec); ++ return 0; ++} ++ ++static int proc_get_chan_plan(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ dump_cur_chset(m, adapter); ++ ++ return 0; ++} ++ ++static ssize_t proc_set_chan_plan(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u8 chan_plan = RTW_CHPLAN_MAX; ++ ++ if (!padapter) ++ return -EFAULT; ++ ++ if (count < 1) { ++ RTW_INFO("argument size is less than 1\n"); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int num = sscanf(tmp, "%hhx", &chan_plan); ++ if (num != 1) ++ return count; ++ } ++ ++ rtw_set_channel_plan(padapter, chan_plan); ++ ++ return count; ++} ++ ++static int proc_get_country_code(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ if (adapter->mlmepriv.country_ent) ++ dump_country_chplan(m, adapter->mlmepriv.country_ent); ++ else ++ RTW_PRINT_SEL(m, "unspecified\n"); ++ ++ return 0; ++} ++ ++static ssize_t proc_set_country_code(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ char alpha2[2]; ++ int num; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (!buffer || copy_from_user(tmp, buffer, count)) ++ goto exit; ++ ++ num = sscanf(tmp, "%c%c", &alpha2[0], &alpha2[1]); ++ if (num != 2) ++ return count; ++ ++ rtw_set_country(padapter, alpha2); ++ ++exit: ++ return count; ++} ++ ++#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) ++static int proc_get_macaddr_acl(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ dump_macaddr_acl(m, adapter); ++ return 0; ++} ++ ++ssize_t proc_set_macaddr_acl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ char tmp[17 * NUM_ACL + 32] = {0}; ++ u8 mode; ++ u8 addr[ETH_ALEN]; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ /* mode [] */ ++ char *c, *next; ++ ++ next = tmp; ++ c = strsep(&next, " \t"); ++ ++ if (sscanf(c, "%hhu", &mode) != 1) ++ return count; ++ ++ if (mode >= RTW_ACL_MODE_MAX) ++ mode = RTW_ACL_MODE_DISABLED; ++ ++ rtw_set_macaddr_acl(adapter, RTW_ACL_MODE_DISABLED); /* deinit first */ ++ if (mode == RTW_ACL_MODE_DISABLED) ++ return count; ++ ++ rtw_set_macaddr_acl(adapter, mode); ++ ++ /* macaddr list */ ++ c = strsep(&next, " \t"); ++ while (c != NULL) { ++ if (sscanf(c, MAC_SFMT, MAC_SARG(addr)) != 6) ++ break; ++ ++ if (rtw_check_invalid_mac_address(addr, 0) == _FALSE) ++ rtw_acl_add_sta(adapter, addr); ++ ++ c = strsep(&next, " \t"); ++ } ++ ++ } ++ ++exit: ++ return count; ++} ++#endif /* CONFIG_RTW_MACADDR_ACL && CONFIG_AP_MODE */ ++ ++#ifdef CONFIG_DFS_MASTER ++ssize_t proc_set_update_non_ocp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *mlme = &adapter->mlmepriv; ++ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; ++ char tmp[32]; ++ u8 ch, bw = CHANNEL_WIDTH_20, offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ int ms = -1; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhu %hhu %hhu %d", &ch, &bw, &offset, &ms); ++ ++ if (num < 1 || (bw != CHANNEL_WIDTH_20 && num < 3)) ++ goto exit; ++ ++ if (bw == CHANNEL_WIDTH_20) ++ rtw_chset_update_non_ocp_ms(mlmeext->channel_set ++ , ch, bw, HAL_PRIME_CHNL_OFFSET_DONT_CARE, ms); ++ else ++ rtw_chset_update_non_ocp_ms(mlmeext->channel_set ++ , ch, bw, offset, ms); ++ } ++ ++exit: ++ return count; ++} ++ ++ssize_t proc_set_radar_detect(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ char tmp[32]; ++ u8 fake_radar_detect_cnt = 0; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhu", &fake_radar_detect_cnt); ++ ++ if (num < 1) ++ goto exit; ++ ++ rfctl->dbg_dfs_master_fake_radar_detect_cnt = fake_radar_detect_cnt; ++ } ++ ++exit: ++ return count; ++} ++ ++static int proc_get_dfs_ch_sel_d_flags(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ ++ RTW_PRINT_SEL(m, "0x%02x\n", rfctl->dfs_ch_sel_d_flags); ++ ++ return 0; ++} ++ ++static ssize_t proc_set_dfs_ch_sel_d_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); ++ char tmp[32]; ++ u8 d_flags; ++ int num; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (!buffer || copy_from_user(tmp, buffer, count)) ++ goto exit; ++ ++ num = sscanf(tmp, "%hhx", &d_flags); ++ if (num != 1) ++ goto exit; ++ ++ rfctl->dfs_ch_sel_d_flags = d_flags; ++ ++exit: ++ return count; ++} ++#endif /* CONFIG_DFS_MASTER */ ++ ++static int proc_get_udpport(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct recv_priv *precvpriv = &(padapter->recvpriv); ++ ++ RTW_PRINT_SEL(m, "%d\n", precvpriv->sink_udpport); ++ return 0; ++} ++static ssize_t proc_set_udpport(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct recv_priv *precvpriv = &(padapter->recvpriv); ++ int sink_udpport = 0; ++ char tmp[32]; ++ ++ ++ if (!padapter) ++ return -EFAULT; ++ ++ if (count < 1) { ++ RTW_INFO("argument size is less than 1\n"); ++ return -EFAULT; ++ } ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%d", &sink_udpport); ++ ++ if (num != 1) { ++ RTW_INFO("invalid input parameter number!\n"); ++ return count; ++ } ++ ++ } ++ precvpriv->sink_udpport = sink_udpport; ++ ++ return count; ++ ++} ++ ++static int proc_get_mi_ap_bc_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ u8 i; ++ ++ for (i = 0; i < dvobj->iface_nums; i++) ++ RTW_PRINT_SEL(m, "iface_id:%d, mac_id && sec_cam_id = %d\n", i, macid_ctl->iface_bmc[i]); ++ ++ return 0; ++} ++static int proc_get_macid_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ u8 chip_type = rtw_get_chip_type(adapter); ++ u8 i; ++ u8 null_addr[ETH_ALEN] = {0}; ++ u8 *macaddr; ++ ++ RTW_PRINT_SEL(m, "max_num:%u\n", macid_ctl->num); ++ RTW_PRINT_SEL(m, "\n"); ++ ++ RTW_PRINT_SEL(m, "used:\n"); ++ dump_macid_map(m, &macid_ctl->used, macid_ctl->num); ++ RTW_PRINT_SEL(m, "\n"); ++ ++ RTW_PRINT_SEL(m, "%-3s %-3s %-4s %-4s %-17s %-6s %-3s" ++ , "id", "bmc", "if_g", "ch_g", "macaddr", "bw", "vht"); ++ ++ if (chip_type == RTL8814A) ++ _RTW_PRINT_SEL(m, " %-10s", "rate_bmp1"); ++ ++ _RTW_PRINT_SEL(m, " %-10s %s\n", "rate_bmp0", "status"); ++ ++ for (i = 0; i < macid_ctl->num; i++) { ++ if (rtw_macid_is_used(macid_ctl, i) ++ || macid_ctl->h2c_msr[i] ++ ) { ++ if (macid_ctl->sta[i]) ++ macaddr = macid_ctl->sta[i]->hwaddr; ++ else ++ macaddr = null_addr; ++ ++ RTW_PRINT_SEL(m, "%3u %3u %4d %4d "MAC_FMT" %6s %3u" ++ , i ++ , rtw_macid_is_bmc(macid_ctl, i) ++ , rtw_macid_get_if_g(macid_ctl, i) ++ , rtw_macid_get_ch_g(macid_ctl, i) ++ , MAC_ARG(macaddr) ++ , ch_width_str(macid_ctl->bw[i]) ++ , macid_ctl->vht_en[i] ++ ); ++ ++ if (chip_type == RTL8814A) ++ _RTW_PRINT_SEL(m, " 0x%08X", macid_ctl->rate_bmp1[i]); ++ ++ _RTW_PRINT_SEL(m, " 0x%08X "H2C_MSR_FMT" %s\n" ++ , macid_ctl->rate_bmp0[i] ++ , H2C_MSR_ARG(&macid_ctl->h2c_msr[i]) ++ , rtw_macid_is_used(macid_ctl, i) ? "" : "[unused]" ++ ); ++ } ++ } ++ ++ return 0; ++} ++ ++static int proc_get_sec_cam(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ ++ RTW_PRINT_SEL(m, "sec_cap:0x%02x\n", cam_ctl->sec_cap); ++ RTW_PRINT_SEL(m, "flags:0x%08x\n", cam_ctl->flags); ++ RTW_PRINT_SEL(m, "\n"); ++ ++ RTW_PRINT_SEL(m, "max_num:%u\n", cam_ctl->num); ++ RTW_PRINT_SEL(m, "used:\n"); ++ dump_sec_cam_map(m, &cam_ctl->used, cam_ctl->num); ++ RTW_PRINT_SEL(m, "\n"); ++ ++ RTW_PRINT_SEL(m, "reg_scr:0x%04x\n", rtw_read16(adapter, 0x680)); ++ RTW_PRINT_SEL(m, "\n"); ++ ++ dump_sec_cam(m, adapter); ++ ++ return 0; ++} ++ ++static ssize_t proc_set_sec_cam(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); ++ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; ++ char tmp[32] = {0}; ++ char cmd[4]; ++ u8 id_1 = 0, id_2 = 0; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ /* c : clear specific cam entry */ ++ /* wfc : write specific cam entry from cam cache */ ++ /* sw : sec_cam 1/2 swap */ ++ ++ int num = sscanf(tmp, "%s %hhu %hhu", cmd, &id_1, &id_2); ++ ++ if (num < 2) ++ return count; ++ ++ if ((id_1 >= cam_ctl->num) || (id_2 >= cam_ctl->num)) { ++ RTW_ERR(FUNC_ADPT_FMT" invalid id_1:%u id_2:%u\n", FUNC_ADPT_ARG(adapter), id_1, id_2); ++ return count; ++ } ++ ++ if (strcmp("c", cmd) == 0) { ++ _clear_cam_entry(adapter, id_1); ++ adapter->securitypriv.hw_decrypted = _FALSE; /* temporarily set this for TX path to use SW enc */ ++ } else if (strcmp("wfc", cmd) == 0) ++ write_cam_from_cache(adapter, id_1); ++ else if (strcmp("sw", cmd) == 0) ++ rtw_sec_cam_swap(adapter, id_1, id_2); ++ else if (strcmp("cdk", cmd) == 0) ++ rtw_clean_dk_section(adapter); ++#ifdef DBG_SEC_CAM_MOVE ++ else if (strcmp("sgd", cmd) == 0) ++ rtw_hal_move_sta_gk_to_dk(adapter); ++ else if (strcmp("rsd", cmd) == 0) ++ rtw_hal_read_sta_dk_key(adapter, id_1); ++#endif ++ } ++ ++ return count; ++} ++ ++static int proc_get_sec_cam_cache(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ dump_sec_cam_cache(m, adapter); ++ return 0; ++} ++ ++static ssize_t proc_set_change_bss_chbw(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *mlme = &(adapter->mlmepriv); ++ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); ++ char tmp[32]; ++ s16 ch; ++ s8 bw = -1, offset = -1; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hd %hhd %hhd", &ch, &bw, &offset); ++ ++ if (num < 1 || (bw != CHANNEL_WIDTH_20 && num < 3)) ++ goto exit; ++ ++ if (check_fwstate(mlme, WIFI_AP_STATE) && check_fwstate(mlme, WIFI_ASOC_STATE)) ++ rtw_change_bss_chbw_cmd(adapter, RTW_CMDF_WAIT_ACK, ch, bw, offset); ++ } ++ ++exit: ++ return count; ++} ++ ++#ifdef CONFIG_80211N_HT ++static int proc_get_tx_bw_mode(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_PRINT_SEL(m, "0x%02x\n", adapter->driver_tx_bw_mode); ++ RTW_PRINT_SEL(m, "2.4G:%s\n", ch_width_str(ADAPTER_TX_BW_2G(adapter))); ++ RTW_PRINT_SEL(m, "5G:%s\n", ch_width_str(ADAPTER_TX_BW_5G(adapter))); ++ ++ return 0; ++} ++ ++static ssize_t proc_set_tx_bw_mode(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; ++ struct mlme_priv *mlme = &(adapter->mlmepriv); ++ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); ++ char tmp[32]; ++ u8 bw_mode; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ u8 update = _FALSE; ++ int num = sscanf(tmp, "%hhx", &bw_mode); ++ ++ if (num < 1 || bw_mode == adapter->driver_tx_bw_mode) ++ goto exit; ++ ++ if ((MLME_STATE(adapter) & WIFI_ASOC_STATE) ++ && ((mlmeext->cur_channel <= 14 && BW_MODE_2G(bw_mode) != ADAPTER_TX_BW_2G(adapter)) ++ || (mlmeext->cur_channel >= 36 && BW_MODE_5G(bw_mode) != ADAPTER_TX_BW_5G(adapter))) ++ ) { ++ /* RA mask update needed */ ++ update = _TRUE; ++ } ++ adapter->driver_tx_bw_mode = bw_mode; ++ ++ if (update == _TRUE) { ++ struct sta_info *sta; ++ int i; ++ ++ for (i = 0; i < MACID_NUM_SW_LIMIT; i++) { ++ sta = macid_ctl->sta[i]; ++ if (sta && !is_broadcast_mac_addr(sta->hwaddr)) ++ rtw_dm_ra_mask_wk_cmd(adapter, (u8 *)sta); ++ } ++ } ++ } ++ ++exit: ++ return count; ++} ++#endif /* CONFIG_80211N_HT */ ++ ++static int proc_get_hal_txpwr_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); ++ ++ if (hal_is_band_support(adapter, BAND_ON_2_4G)) ++ dump_hal_txpwr_info_2g(m, adapter, hal_spec->rfpath_num_2g, hal_spec->max_tx_cnt); ++ ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ if (hal_is_band_support(adapter, BAND_ON_5G)) ++ dump_hal_txpwr_info_5g(m, adapter, hal_spec->rfpath_num_5g, hal_spec->max_tx_cnt); ++#endif ++ ++ return 0; ++} ++ ++static int proc_get_target_tx_power(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ dump_target_tx_power(m, adapter); ++ ++ return 0; ++} ++ ++static int proc_get_tx_power_by_rate(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ dump_tx_power_by_rate(m, adapter); ++ ++ return 0; ++} ++ ++static int proc_get_tx_power_limit(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ dump_tx_power_limit(m, adapter); ++ ++ return 0; ++} ++ ++static int proc_get_tx_power_ext_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ dump_tx_power_ext_info(m, adapter); ++ ++ return 0; ++} ++ ++static ssize_t proc_set_tx_power_ext_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ char tmp[32] = {0}; ++ char cmd[16] = {0}; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%s", cmd); ++ ++ if (num < 1) ++ return count; ++ ++ #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE ++ phy_free_filebuf_mask(adapter, LOAD_BB_PG_PARA_FILE | LOAD_RF_TXPWR_LMT_PARA_FILE); ++ #endif ++ ++ rtw_ps_deny(adapter, PS_DENY_IOCTL); ++ LeaveAllPowerSaveModeDirect(adapter); ++ ++ if (strcmp("default", cmd) == 0) ++ rtw_run_in_thread_cmd(adapter, ((void *)(phy_reload_default_tx_power_ext_info)), adapter); ++ else ++ rtw_run_in_thread_cmd(adapter, ((void *)(phy_reload_tx_power_ext_info)), adapter); ++ ++ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); ++ } ++ ++ return count; ++} ++ ++static void *proc_start_tx_power_idx(struct seq_file *m, loff_t *pos) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 path = ((*pos) & 0xFF00) >> 8; ++ u8 rs = *pos & 0xFF; ++ ++ if (path >= RF_PATH_MAX) ++ return NULL; ++ ++ return pos; ++} ++static void proc_stop_tx_power_idx(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++} ++ ++static void *proc_next_tx_power_idx(struct seq_file *m, void *v, loff_t *pos) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 path = ((*pos) & 0xFF00) >> 8; ++ u8 rs = *pos & 0xFF; ++ ++ rs++; ++ if (rs >= RATE_SECTION_NUM) { ++ rs = 0; ++ path++; ++ } ++ ++ if (path >= RF_PATH_MAX) ++ return NULL; ++ ++ *pos = (path << 8) | rs; ++ ++ return pos; ++} ++ ++static int proc_get_tx_power_idx(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ u32 pos = *((loff_t *)(v)); ++ u8 path = (pos & 0xFF00) >> 8; ++ u8 rs = pos & 0xFF; ++ ++ if (0) ++ RTW_INFO("%s path=%u, rs=%u\n", __func__, path, rs); ++ ++ if (path == RF_PATH_A && rs == CCK) ++ dump_tx_power_idx_title(m, adapter); ++ dump_tx_power_idx_by_path_rs(m, adapter, path, rs); ++ ++ return 0; ++} ++ ++static struct seq_operations seq_ops_tx_power_idx = { ++ .start = proc_start_tx_power_idx, ++ .stop = proc_stop_tx_power_idx, ++ .next = proc_next_tx_power_idx, ++ .show = proc_get_tx_power_idx, ++}; ++ ++#ifdef CONFIG_RF_POWER_TRIM ++static int proc_get_kfree_flag(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); ++ ++ RTW_PRINT_SEL(m, "0x%02x\n", kfree_data->flag); ++ ++ return 0; ++} ++ ++static ssize_t proc_set_kfree_flag(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); ++ char tmp[32] = {0}; ++ u8 flag; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhx", &flag); ++ ++ if (num < 1) ++ return count; ++ ++ kfree_data->flag = flag; ++ } ++ ++ return count; ++} ++ ++static int proc_get_kfree_bb_gain(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); ++ u8 i, j; ++ ++ for (i = 0; i < BB_GAIN_NUM; i++) { ++ if (i == 0) ++ _RTW_PRINT_SEL(m, "2G: "); ++ else if (i == 1) ++ _RTW_PRINT_SEL(m, "5GLB1: "); ++ else if (i == 2) ++ _RTW_PRINT_SEL(m, "5GLB2: "); ++ else if (i == 3) ++ _RTW_PRINT_SEL(m, "5GMB1: "); ++ else if (i == 4) ++ _RTW_PRINT_SEL(m, "5GMB2: "); ++ else if (i == 5) ++ _RTW_PRINT_SEL(m, "5GHB: "); ++ ++ for (j = 0; j < hal_data->NumTotalRFPath; j++) ++ _RTW_PRINT_SEL(m, "%d ", kfree_data->bb_gain[i][j]); ++ _RTW_PRINT_SEL(m, "\n"); ++ } ++ ++ return 0; ++} ++ ++static ssize_t proc_set_kfree_bb_gain(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); ++ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); ++ char tmp[BB_GAIN_NUM * RF_PATH_MAX] = {0}; ++ u8 path, chidx; ++ s8 bb_gain[BB_GAIN_NUM]; ++ char ch_band_Group[6]; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ char *c, *next; ++ int i = 0; ++ ++ next = tmp; ++ c = strsep(&next, " \t"); ++ ++ if (sscanf(c, "%s", ch_band_Group) != 1) { ++ RTW_INFO("Error Head Format, channel Group select\n,Please input:\t 2G , 5GLB1 , 5GLB2 , 5GMB1 , 5GMB2 , 5GHB\n"); ++ return count; ++ } ++ if (strcmp("2G", ch_band_Group) == 0) ++ chidx = BB_GAIN_2G; ++#ifdef CONFIG_IEEE80211_BAND_5GHZ ++ else if (strcmp("5GLB1", ch_band_Group) == 0) ++ chidx = BB_GAIN_5GLB1; ++ else if (strcmp("5GLB2", ch_band_Group) == 0) ++ chidx = BB_GAIN_5GLB2; ++ else if (strcmp("5GMB1", ch_band_Group) == 0) ++ chidx = BB_GAIN_5GMB1; ++ else if (strcmp("5GMB2", ch_band_Group) == 0) ++ chidx = BB_GAIN_5GMB2; ++ else if (strcmp("5GHB", ch_band_Group) == 0) ++ chidx = BB_GAIN_5GHB; ++#endif /*CONFIG_IEEE80211_BAND_5GHZ*/ ++ else { ++ RTW_INFO("Error Head Format, channel Group select\n,Please input:\t 2G , 5GLB1 , 5GLB2 , 5GMB1 , 5GMB2 , 5GHB\n"); ++ return count; ++ } ++ c = strsep(&next, " \t"); ++ ++ while (c != NULL) { ++ if (sscanf(c, "%hhx", &bb_gain[i]) != 1) ++ break; ++ ++ kfree_data->bb_gain[chidx][i] = bb_gain[i]; ++ RTW_INFO("%s,kfree_data->bb_gain[%d][%d]=%x\n", __func__, chidx, i, kfree_data->bb_gain[chidx][i]); ++ ++ c = strsep(&next, " \t"); ++ i++; ++ } ++ ++ } ++ ++ return count; ++ ++} ++ ++static int proc_get_kfree_thermal(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); ++ ++ _RTW_PRINT_SEL(m, "%d\n", kfree_data->thermal); ++ ++ return 0; ++} ++ ++static ssize_t proc_set_kfree_thermal(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); ++ char tmp[32] = {0}; ++ s8 thermal; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhd", &thermal); ++ ++ if (num < 1) ++ return count; ++ ++ kfree_data->thermal = thermal; ++ } ++ ++ return count; ++} ++ ++static ssize_t proc_set_tx_gain_offset(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter; ++ char tmp[32] = {0}; ++ u8 rf_path; ++ s8 offset; ++ ++ adapter = (_adapter *)rtw_netdev_priv(dev); ++ if (!adapter) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ u8 write_value; ++ int num = sscanf(tmp, "%hhu %hhd", &rf_path, &offset); ++ ++ if (num < 2) ++ return count; ++ ++ RTW_INFO("write rf_path:%u tx gain offset:%d\n", rf_path, offset); ++ rtw_rf_set_tx_gain_offset(adapter, rf_path, offset); ++ } ++ ++ return count; ++} ++#endif /* CONFIG_RF_POWER_TRIM */ ++ ++#ifdef CONFIG_BT_COEXIST ++ssize_t proc_set_btinfo_evt(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u8 btinfo[8]; ++ ++ if (count < 6) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ int num = 0; ++ ++ _rtw_memset(btinfo, 0, 8); ++ ++ num = sscanf(tmp, "%hhx %hhx %hhx %hhx %hhx %hhx %hhx %hhx" ++ , &btinfo[0], &btinfo[1], &btinfo[2], &btinfo[3] ++ , &btinfo[4], &btinfo[5], &btinfo[6], &btinfo[7]); ++ ++ if (num < 6) ++ return -EINVAL; ++ ++ btinfo[1] = num - 2; ++ ++ rtw_btinfo_cmd(padapter, btinfo, btinfo[1] + 2); ++ } ++ ++ return count; ++} ++ ++static u8 btreg_read_type = 0; ++static u16 btreg_read_addr = 0; ++static int btreg_read_error = 0; ++static u8 btreg_write_type = 0; ++static u16 btreg_write_addr = 0; ++static int btreg_write_error = 0; ++ ++static u8 *btreg_type[] = { ++ "rf", ++ "modem", ++ "bluewize", ++ "vendor", ++ "le" ++}; ++ ++static int btreg_parse_str(char const *input, u8 *type, u16 *addr, u16 *val) ++{ ++ u32 num; ++ u8 str[80] = {0}; ++ u8 t = 0; ++ u32 a, v; ++ u8 i, n; ++ u8 *p; ++ ++ ++ num = sscanf(input, "%s %x %x", str, &a, &v); ++ if (num < 2) { ++ RTW_INFO("%s: INVALID input!(%s)\n", __FUNCTION__, input); ++ return -EINVAL; ++ } ++ if ((num < 3) && val) { ++ RTW_INFO("%s: INVALID input!(%s)\n", __FUNCTION__, input); ++ return -EINVAL; ++ } ++ ++ /* convert to lower case for following type compare */ ++ p = str; ++ for (; *p; ++p) ++ *p = tolower(*p); ++ n = sizeof(btreg_type) / sizeof(btreg_type[0]); ++ for (i = 0; i < n; i++) { ++ if (!strcmp(str, btreg_type[i])) { ++ t = i; ++ break; ++ } ++ } ++ if (i == n) { ++ RTW_INFO("%s: unknown type(%s)!\n", __FUNCTION__, str); ++ return -EINVAL; ++ } ++ ++ switch (t) { ++ case 0: ++ /* RF */ ++ if (a & 0xFFFFFF80) { ++ RTW_INFO("%s: INVALID address(0x%X) for type %s(%d)!\n", ++ __FUNCTION__, a, btreg_type[t], t); ++ return -EINVAL; ++ } ++ break; ++ case 1: ++ /* Modem */ ++ if (a & 0xFFFFFE00) { ++ RTW_INFO("%s: INVALID address(0x%X) for type %s(%d)!\n", ++ __FUNCTION__, a, btreg_type[t], t); ++ return -EINVAL; ++ } ++ break; ++ default: ++ /* Others(Bluewize, Vendor, LE) */ ++ if (a & 0xFFFFF000) { ++ RTW_INFO("%s: INVALID address(0x%X) for type %s(%d)!\n", ++ __FUNCTION__, a, btreg_type[t], t); ++ return -EINVAL; ++ } ++ break; ++ } ++ ++ if (val) { ++ if (v & 0xFFFF0000) { ++ RTW_INFO("%s: INVALID value(0x%x)!\n", __FUNCTION__, v); ++ return -EINVAL; ++ } ++ *val = (u16)v; ++ } ++ ++ *type = (u8)t; ++ *addr = (u16)a; ++ ++ return 0; ++} ++ ++int proc_get_btreg_read(struct seq_file *m, void *v) ++{ ++ struct net_device *dev; ++ PADAPTER padapter; ++ u16 ret; ++ u32 data; ++ ++ ++ if (btreg_read_error) ++ return btreg_read_error; ++ ++ dev = m->private; ++ padapter = (PADAPTER)rtw_netdev_priv(dev); ++ ++ ret = rtw_btcoex_btreg_read(padapter, btreg_read_type, btreg_read_addr, &data); ++ if (CHECK_STATUS_CODE_FROM_BT_MP_OPER_RET(ret, BT_STATUS_BT_OP_SUCCESS)) ++ RTW_PRINT_SEL(m, "BTREG read: (%s)0x%04X = 0x%08x\n", btreg_type[btreg_read_type], btreg_read_addr, data); ++ else ++ RTW_PRINT_SEL(m, "BTREG read: (%s)0x%04X read fail. error code = 0x%04x.\n", btreg_type[btreg_read_type], btreg_read_addr, ret); ++ ++ return 0; ++} ++ ++ssize_t proc_set_btreg_read(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ PADAPTER padapter; ++ u8 tmp[80] = {0}; ++ u32 num; ++ int err; ++ ++ ++ padapter = (PADAPTER)rtw_netdev_priv(dev); ++ ++ if (NULL == buffer) { ++ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", ++ FUNC_ADPT_ARG(padapter)); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ if (count < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", ++ FUNC_ADPT_ARG(padapter)); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ num = count; ++ if (num > (sizeof(tmp) - 1)) ++ num = (sizeof(tmp) - 1); ++ ++ if (copy_from_user(tmp, buffer, num)) { ++ RTW_INFO(FUNC_ADPT_FMT ": copy buffer from user space FAIL!\n", ++ FUNC_ADPT_ARG(padapter)); ++ err = -EFAULT; ++ goto exit; ++ } ++ /* [Coverity] sure tmp end with '\0'(string terminal) */ ++ tmp[sizeof(tmp) - 1] = 0; ++ ++ err = btreg_parse_str(tmp, &btreg_read_type, &btreg_read_addr, NULL); ++ if (err) ++ goto exit; ++ ++ RTW_INFO(FUNC_ADPT_FMT ": addr=(%s)0x%X\n", ++ FUNC_ADPT_ARG(padapter), btreg_type[btreg_read_type], btreg_read_addr); ++ ++exit: ++ btreg_read_error = err; ++ ++ return count; ++} ++ ++int proc_get_btreg_write(struct seq_file *m, void *v) ++{ ++ struct net_device *dev; ++ PADAPTER padapter; ++ u16 ret; ++ u32 data; ++ ++ ++ if (btreg_write_error < 0) ++ return btreg_write_error; ++ else if (btreg_write_error > 0) { ++ RTW_PRINT_SEL(m, "BTREG write: (%s)0x%04X write fail. error code = 0x%04x.\n", btreg_type[btreg_write_type], btreg_write_addr, btreg_write_error); ++ return 0; ++ } ++ ++ dev = m->private; ++ padapter = (PADAPTER)rtw_netdev_priv(dev); ++ ++ ret = rtw_btcoex_btreg_read(padapter, btreg_write_type, btreg_write_addr, &data); ++ if (CHECK_STATUS_CODE_FROM_BT_MP_OPER_RET(ret, BT_STATUS_BT_OP_SUCCESS)) ++ RTW_PRINT_SEL(m, "BTREG read: (%s)0x%04X = 0x%08x\n", btreg_type[btreg_write_type], btreg_write_addr, data); ++ else ++ RTW_PRINT_SEL(m, "BTREG read: (%s)0x%04X read fail. error code = 0x%04x.\n", btreg_type[btreg_write_type], btreg_write_addr, ret); ++ ++ return 0; ++} ++ ++ssize_t proc_set_btreg_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ PADAPTER padapter; ++ u8 tmp[80] = {0}; ++ u32 num; ++ u16 val; ++ u16 ret; ++ int err; ++ ++ ++ padapter = (PADAPTER)rtw_netdev_priv(dev); ++ ++ if (NULL == buffer) { ++ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", ++ FUNC_ADPT_ARG(padapter)); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ if (count < 1) { ++ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", ++ FUNC_ADPT_ARG(padapter)); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ num = count; ++ if (num > (sizeof(tmp) - 1)) ++ num = (sizeof(tmp) - 1); ++ ++ if (copy_from_user(tmp, buffer, num)) { ++ RTW_INFO(FUNC_ADPT_FMT ": copy buffer from user space FAIL!\n", ++ FUNC_ADPT_ARG(padapter)); ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ err = btreg_parse_str(tmp, &btreg_write_type, &btreg_write_addr, &val); ++ if (err) ++ goto exit; ++ ++ RTW_INFO(FUNC_ADPT_FMT ": Set (%s)0x%X = 0x%x\n", ++ FUNC_ADPT_ARG(padapter), btreg_type[btreg_write_type], btreg_write_addr, val); ++ ++ ret = rtw_btcoex_btreg_write(padapter, btreg_write_type, btreg_write_addr, val); ++ if (!CHECK_STATUS_CODE_FROM_BT_MP_OPER_RET(ret, BT_STATUS_BT_OP_SUCCESS)) ++ err = ret; ++ ++exit: ++ btreg_write_error = err; ++ ++ return count; ++} ++#endif /* CONFIG_BT_COEXIST */ ++ ++#ifdef CONFIG_MBSSID_CAM ++int proc_get_mbid_cam_cache(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ rtw_mbid_cam_cache_dump(m, __func__, adapter); ++ rtw_mbid_cam_dump(m, __func__, adapter); ++ return 0; ++} ++#endif /* CONFIG_MBSSID_CAM */ ++ ++int proc_get_mac_addr(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ rtw_hal_dump_macaddr(m, adapter); ++ return 0; ++} ++ ++static int proc_get_skip_band(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ int bandskip; ++ ++ bandskip = RTW_GET_SCAN_BAND_SKIP(adapter); ++ RTW_PRINT_SEL(m, "bandskip:0x%02x\n", bandskip); ++ return 0; ++} ++ ++static ssize_t proc_set_skip_band(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[6]; ++ u8 skip_band; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhu", &skip_band); ++ ++ if (num < 1) ++ return -EINVAL; ++ ++ if (1 == skip_band) ++ RTW_SET_SCAN_BAND_SKIP(padapter, BAND_24G); ++ else if (2 == skip_band) ++ RTW_SET_SCAN_BAND_SKIP(padapter, BAND_5G); ++ else if (3 == skip_band) ++ RTW_CLR_SCAN_BAND_SKIP(padapter, BAND_24G); ++ else if (4 == skip_band) ++ RTW_CLR_SCAN_BAND_SKIP(padapter, BAND_5G); ++ } ++ return count; ++ ++} ++ ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++static int proc_get_best_chan(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ u8 best_24g_ch = 0, best_5g_ch = 0; ++ ++ rtw_hal_get_odm_var(adapter, HAL_ODM_AUTO_CHNL_SEL, &(best_24g_ch), &(best_5g_ch)); ++ ++ RTW_PRINT_SEL(m, "Best 2.4G CH:%u\n", best_24g_ch); ++ RTW_PRINT_SEL(m, "Best 5G CH:%u\n", best_5g_ch); ++ return 0; ++} ++ ++static ssize_t proc_set_acs(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u8 acs_satae = 0; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhu", &acs_satae); ++ ++ if (num < 1) ++ return -EINVAL; ++ ++ if (1 == acs_satae) ++ rtw_acs_start(padapter, _TRUE); ++ else ++ rtw_acs_start(padapter, _FALSE); ++ ++ } ++ return count; ++} ++#endif ++ ++static int proc_get_hal_spec(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ dump_hal_spec(m, adapter); ++ return 0; ++} ++ ++#ifdef CONFIG_SUPPORT_TRX_SHARED ++#include "../../hal/hal_halmac.h" ++static int proc_get_trx_share_mode(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ dump_trx_share_mode(m, adapter); ++ return 0; ++} ++#endif ++ ++static int proc_get_napi_info(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregistrypriv = &adapter->registrypriv; ++ u8 napi = 0, gro = 0; ++ u32 weight = 0; ++ ++ ++#ifdef CONFIG_RTW_NAPI ++ if (pregistrypriv->en_napi) { ++ napi = 1; ++ weight = RTL_NAPI_WEIGHT; ++ } ++ ++#ifdef CONFIG_RTW_GRO ++ if (pregistrypriv->en_gro) ++ gro = 1; ++#endif /* CONFIG_RTW_GRO */ ++#endif /* CONFIG_RTW_NAPI */ ++ ++ if (napi) ++ RTW_PRINT_SEL(m, "NAPI enable, weight=%d\n", weight); ++ else ++ RTW_PRINT_SEL(m, "NAPI disable\n"); ++ RTW_PRINT_SEL(m, "GRO %s\n", gro?"enable":"disable"); ++ ++ return 0; ++} ++ ++/* ++* rtw_adapter_proc: ++* init/deinit when register/unregister net_device ++*/ ++const struct rtw_proc_hdl adapter_proc_hdls[] = { ++#if RTW_SEQ_FILE_TEST ++ RTW_PROC_HDL_SEQ("seq_file_test", &seq_file_test, NULL), ++#endif ++ RTW_PROC_HDL_SSEQ("write_reg", NULL, proc_set_write_reg), ++ RTW_PROC_HDL_SSEQ("read_reg", proc_get_read_reg, proc_set_read_reg), ++ RTW_PROC_HDL_SSEQ("tx_rate_bmp", proc_get_dump_tx_rate_bmp, NULL), ++ RTW_PROC_HDL_SSEQ("adapters_status", proc_get_dump_adapters_status, NULL), ++#ifdef CONFIG_RTW_CUSTOMER_STR ++ RTW_PROC_HDL_SSEQ("customer_str", proc_get_customer_str, NULL), ++#endif ++ RTW_PROC_HDL_SSEQ("fwstate", proc_get_fwstate, NULL), ++ RTW_PROC_HDL_SSEQ("sec_info", proc_get_sec_info, NULL), ++ RTW_PROC_HDL_SSEQ("mlmext_state", proc_get_mlmext_state, NULL), ++ RTW_PROC_HDL_SSEQ("qos_option", proc_get_qos_option, NULL), ++ RTW_PROC_HDL_SSEQ("ht_option", proc_get_ht_option, NULL), ++ RTW_PROC_HDL_SSEQ("rf_info", proc_get_rf_info, NULL), ++ RTW_PROC_HDL_SSEQ("scan_param", proc_get_scan_param, proc_set_scan_param), ++ RTW_PROC_HDL_SSEQ("scan_abort", proc_get_scan_abort, NULL), ++#ifdef CONFIG_SCAN_BACKOP ++ RTW_PROC_HDL_SSEQ("backop_flags_sta", proc_get_backop_flags_sta, proc_set_backop_flags_sta), ++ RTW_PROC_HDL_SSEQ("backop_flags_ap", proc_get_backop_flags_ap, proc_set_backop_flags_ap), ++#endif ++ RTW_PROC_HDL_SSEQ("survey_info", proc_get_survey_info, proc_set_survey_info), ++ RTW_PROC_HDL_SSEQ("ap_info", proc_get_ap_info, NULL), ++ RTW_PROC_HDL_SSEQ("trx_info", proc_get_trx_info, proc_reset_trx_info), ++ RTW_PROC_HDL_SSEQ("rate_ctl", proc_get_rate_ctl, proc_set_rate_ctl), ++ RTW_PROC_HDL_SSEQ("bw_ctl", proc_get_bw_ctl, proc_set_bw_ctl), ++ RTW_PROC_HDL_SSEQ("dis_pwt_ctl", proc_get_dis_pwt, proc_set_dis_pwt), ++ RTW_PROC_HDL_SSEQ("mac_qinfo", proc_get_mac_qinfo, NULL), ++ RTW_PROC_HDL_SSEQ("macid_info", proc_get_macid_info, NULL), ++ RTW_PROC_HDL_SSEQ("bcmc_info", proc_get_mi_ap_bc_info, NULL), ++ RTW_PROC_HDL_SSEQ("sec_cam", proc_get_sec_cam, proc_set_sec_cam), ++ RTW_PROC_HDL_SSEQ("sec_cam_cache", proc_get_sec_cam_cache, NULL), ++ RTW_PROC_HDL_SSEQ("suspend_info", proc_get_suspend_resume_info, NULL), ++ RTW_PROC_HDL_SSEQ("wifi_spec", proc_get_wifi_spec, NULL), ++#ifdef CONFIG_LAYER2_ROAMING ++ RTW_PROC_HDL_SSEQ("roam_flags", proc_get_roam_flags, proc_set_roam_flags), ++ RTW_PROC_HDL_SSEQ("roam_param", proc_get_roam_param, proc_set_roam_param), ++ RTW_PROC_HDL_SSEQ("roam_tgt_addr", NULL, proc_set_roam_tgt_addr), ++#endif /* CONFIG_LAYER2_ROAMING */ ++ ++#ifdef CONFIG_RTW_80211R ++ RTW_PROC_HDL_SSEQ("ft_flags", proc_get_ft_flags, proc_set_ft_flags), ++#endif ++ ++#ifdef CONFIG_SDIO_HCI ++ RTW_PROC_HDL_SSEQ("sd_f0_reg_dump", proc_get_sd_f0_reg_dump, NULL), ++ RTW_PROC_HDL_SSEQ("sdio_local_reg_dump", proc_get_sdio_local_reg_dump, NULL), ++#endif /* CONFIG_SDIO_HCI */ ++ ++ RTW_PROC_HDL_SSEQ("fwdl_test_case", NULL, proc_set_fwdl_test_case), ++ RTW_PROC_HDL_SSEQ("del_rx_ampdu_test_case", NULL, proc_set_del_rx_ampdu_test_case), ++ RTW_PROC_HDL_SSEQ("wait_hiq_empty", NULL, proc_set_wait_hiq_empty), ++ ++ RTW_PROC_HDL_SSEQ("mac_reg_dump", proc_get_mac_reg_dump, NULL), ++ RTW_PROC_HDL_SSEQ("bb_reg_dump", proc_get_bb_reg_dump, NULL), ++ RTW_PROC_HDL_SSEQ("rf_reg_dump", proc_get_rf_reg_dump, NULL), ++ ++#ifdef CONFIG_AP_MODE ++ RTW_PROC_HDL_SSEQ("all_sta_info", proc_get_all_sta_info, NULL), ++#endif /* CONFIG_AP_MODE */ ++ ++#ifdef DBG_MEMORY_LEAK ++ RTW_PROC_HDL_SSEQ("_malloc_cnt", proc_get_malloc_cnt, NULL), ++#endif /* DBG_MEMORY_LEAK */ ++ ++#ifdef CONFIG_FIND_BEST_CHANNEL ++ RTW_PROC_HDL_SSEQ("best_channel", proc_get_best_channel, proc_set_best_channel), ++#endif ++ ++ RTW_PROC_HDL_SSEQ("rx_signal", proc_get_rx_signal, proc_set_rx_signal), ++ RTW_PROC_HDL_SSEQ("hw_info", proc_get_hw_status, proc_set_hw_status), ++ ++#ifdef CONFIG_80211N_HT ++ RTW_PROC_HDL_SSEQ("ht_enable", proc_get_ht_enable, proc_set_ht_enable), ++ RTW_PROC_HDL_SSEQ("bw_mode", proc_get_bw_mode, proc_set_bw_mode), ++ RTW_PROC_HDL_SSEQ("ampdu_enable", proc_get_ampdu_enable, proc_set_ampdu_enable), ++ RTW_PROC_HDL_SSEQ("rx_stbc", proc_get_rx_stbc, proc_set_rx_stbc), ++ RTW_PROC_HDL_SSEQ("rx_ampdu", proc_get_rx_ampdu, proc_set_rx_ampdu), ++ RTW_PROC_HDL_SSEQ("rx_ampdu_factor", proc_get_rx_ampdu_factor, proc_set_rx_ampdu_factor), ++ RTW_PROC_HDL_SSEQ("rx_ampdu_density", proc_get_rx_ampdu_density, proc_set_rx_ampdu_density), ++ RTW_PROC_HDL_SSEQ("tx_ampdu_density", proc_get_tx_ampdu_density, proc_set_tx_ampdu_density), ++#endif /* CONFIG_80211N_HT */ ++ ++ RTW_PROC_HDL_SSEQ("en_fwps", proc_get_en_fwps, proc_set_en_fwps), ++ RTW_PROC_HDL_SSEQ("mac_rptbuf", proc_get_mac_rptbuf, NULL), ++ ++ /* RTW_PROC_HDL_SSEQ("path_rssi", proc_get_two_path_rssi, NULL), ++ * RTW_PROC_HDL_SSEQ("rssi_disp",proc_get_rssi_disp, proc_set_rssi_disp), */ ++ ++#ifdef CONFIG_BT_COEXIST ++ RTW_PROC_HDL_SSEQ("btcoex_dbg", proc_get_btcoex_dbg, proc_set_btcoex_dbg), ++ RTW_PROC_HDL_SSEQ("btcoex", proc_get_btcoex_info, NULL), ++ RTW_PROC_HDL_SSEQ("btinfo_evt", NULL, proc_set_btinfo_evt), ++ RTW_PROC_HDL_SSEQ("btreg_read", proc_get_btreg_read, proc_set_btreg_read), ++ RTW_PROC_HDL_SSEQ("btreg_write", proc_get_btreg_write, proc_set_btreg_write), ++#endif /* CONFIG_BT_COEXIST */ ++ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++ RTW_PROC_HDL_SSEQ("sreset", proc_get_sreset, proc_set_sreset), ++#endif /* DBG_CONFIG_ERROR_DETECT */ ++ RTW_PROC_HDL_SSEQ("trx_info_debug", proc_get_trx_info_debug, NULL), ++ RTW_PROC_HDL_SSEQ("linked_info_dump", proc_get_linked_info_dump, proc_set_linked_info_dump), ++ RTW_PROC_HDL_SSEQ("tx_info_msg", proc_get_tx_info_msg, NULL), ++ RTW_PROC_HDL_SSEQ("rx_info_msg", proc_get_rx_info_msg, proc_set_rx_info_msg), ++#ifdef CONFIG_GPIO_API ++ RTW_PROC_HDL_SSEQ("gpio_info", proc_get_gpio, proc_set_gpio), ++ RTW_PROC_HDL_SSEQ("gpio_set_output_value", NULL, proc_set_gpio_output_value), ++ RTW_PROC_HDL_SSEQ("gpio_set_direction", NULL, proc_set_config_gpio), ++#endif ++ ++#ifdef CONFIG_DBG_COUNTER ++ RTW_PROC_HDL_SSEQ("rx_logs", proc_get_rx_logs, NULL), ++ RTW_PROC_HDL_SSEQ("tx_logs", proc_get_tx_logs, NULL), ++ RTW_PROC_HDL_SSEQ("int_logs", proc_get_int_logs, NULL), ++#endif ++ ++#ifdef CONFIG_PCI_HCI ++ RTW_PROC_HDL_SSEQ("rx_ring", proc_get_rx_ring, NULL), ++ RTW_PROC_HDL_SSEQ("tx_ring", proc_get_tx_ring, NULL), ++#endif ++ ++#ifdef CONFIG_WOWLAN ++ RTW_PROC_HDL_SSEQ("wow_pattern_info", proc_get_pattern_info, proc_set_pattern_info), ++ RTW_PROC_HDL_SSEQ("wowlan_last_wake_reason", proc_get_wakeup_reason, NULL), ++#endif ++ ++#ifdef CONFIG_GPIO_WAKEUP ++ RTW_PROC_HDL_SSEQ("wowlan_gpio_info", proc_get_wowlan_gpio_info, proc_set_wowlan_gpio_info), ++#endif ++#ifdef CONFIG_P2P_WOWLAN ++ RTW_PROC_HDL_SSEQ("p2p_wowlan_info", proc_get_p2p_wowlan_info, NULL), ++#endif ++ RTW_PROC_HDL_SSEQ("country_code", proc_get_country_code, proc_set_country_code), ++ RTW_PROC_HDL_SSEQ("chan_plan", proc_get_chan_plan, proc_set_chan_plan), ++#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) ++ RTW_PROC_HDL_SSEQ("macaddr_acl", proc_get_macaddr_acl, proc_set_macaddr_acl), ++#endif ++#ifdef CONFIG_DFS_MASTER ++ RTW_PROC_HDL_SSEQ("dfs_master_test_case", proc_get_dfs_master_test_case, proc_set_dfs_master_test_case), ++ RTW_PROC_HDL_SSEQ("update_non_ocp", NULL, proc_set_update_non_ocp), ++ RTW_PROC_HDL_SSEQ("radar_detect", NULL, proc_set_radar_detect), ++ RTW_PROC_HDL_SSEQ("dfs_ch_sel_d_flags", proc_get_dfs_ch_sel_d_flags, proc_set_dfs_ch_sel_d_flags), ++#endif ++ RTW_PROC_HDL_SSEQ("new_bcn_max", proc_get_new_bcn_max, proc_set_new_bcn_max), ++ RTW_PROC_HDL_SSEQ("sink_udpport", proc_get_udpport, proc_set_udpport), ++#ifdef DBG_RX_COUNTER_DUMP ++ RTW_PROC_HDL_SSEQ("dump_rx_cnt_mode", proc_get_rx_cnt_dump, proc_set_rx_cnt_dump), ++#endif ++ RTW_PROC_HDL_SSEQ("change_bss_chbw", NULL, proc_set_change_bss_chbw), ++#ifdef CONFIG_80211N_HT ++ RTW_PROC_HDL_SSEQ("tx_bw_mode", proc_get_tx_bw_mode, proc_set_tx_bw_mode), ++#endif /* CONFIG_80211N_HT */ ++ RTW_PROC_HDL_SSEQ("hal_txpwr_info", proc_get_hal_txpwr_info, NULL), ++ RTW_PROC_HDL_SSEQ("target_tx_power", proc_get_target_tx_power, NULL), ++ RTW_PROC_HDL_SSEQ("tx_power_by_rate", proc_get_tx_power_by_rate, NULL), ++ RTW_PROC_HDL_SSEQ("tx_power_limit", proc_get_tx_power_limit, NULL), ++ RTW_PROC_HDL_SSEQ("tx_power_ext_info", proc_get_tx_power_ext_info, proc_set_tx_power_ext_info), ++ RTW_PROC_HDL_SEQ("tx_power_idx", &seq_ops_tx_power_idx, NULL), ++#ifdef CONFIG_RF_POWER_TRIM ++ RTW_PROC_HDL_SSEQ("tx_gain_offset", NULL, proc_set_tx_gain_offset), ++ RTW_PROC_HDL_SSEQ("kfree_flag", proc_get_kfree_flag, proc_set_kfree_flag), ++ RTW_PROC_HDL_SSEQ("kfree_bb_gain", proc_get_kfree_bb_gain, proc_set_kfree_bb_gain), ++ RTW_PROC_HDL_SSEQ("kfree_thermal", proc_get_kfree_thermal, proc_set_kfree_thermal), ++#endif ++#ifdef CONFIG_POWER_SAVING ++ RTW_PROC_HDL_SSEQ("ps_info", proc_get_ps_info, NULL), ++#endif ++#ifdef CONFIG_TDLS ++ RTW_PROC_HDL_SSEQ("tdls_info", proc_get_tdls_info, NULL), ++#endif ++ RTW_PROC_HDL_SSEQ("monitor", proc_get_monitor, proc_set_monitor), ++ ++#ifdef CONFIG_AUTO_CHNL_SEL_NHM ++ RTW_PROC_HDL_SSEQ("acs", proc_get_best_chan, proc_set_acs), ++#endif ++#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER ++ RTW_PROC_HDL_SSEQ("rtkm_info", proc_get_rtkm_info, NULL), ++#endif ++ RTW_PROC_HDL_SSEQ("efuse_map", proc_get_efuse_map, NULL), ++#ifdef CONFIG_IEEE80211W ++ RTW_PROC_HDL_SSEQ("11w_tx_sa_query", proc_get_tx_sa_query, proc_set_tx_sa_query), ++ RTW_PROC_HDL_SSEQ("11w_tx_deauth", proc_get_tx_deauth, proc_set_tx_deauth), ++ RTW_PROC_HDL_SSEQ("11w_tx_auth", proc_get_tx_auth, proc_set_tx_auth), ++#endif /* CONFIG_IEEE80211W */ ++ ++#ifdef CONFIG_MBSSID_CAM ++ RTW_PROC_HDL_SSEQ("mbid_cam", proc_get_mbid_cam_cache, NULL), ++#endif ++ RTW_PROC_HDL_SSEQ("mac_addr", proc_get_mac_addr, NULL), ++ RTW_PROC_HDL_SSEQ("skip_band", proc_get_skip_band, proc_set_skip_band), ++ RTW_PROC_HDL_SSEQ("hal_spec", proc_get_hal_spec, NULL), ++#ifdef CONFIG_SUPPORT_TRX_SHARED ++ RTW_PROC_HDL_SSEQ("trx_share_mode", proc_get_trx_share_mode, NULL), ++#endif ++ RTW_PROC_HDL_SSEQ("napi_info", proc_get_napi_info, NULL), ++}; ++ ++const int adapter_proc_hdls_num = sizeof(adapter_proc_hdls) / sizeof(struct rtw_proc_hdl); ++ ++static int rtw_adapter_proc_open(struct inode *inode, struct file *file) ++{ ++ ssize_t index = (ssize_t)PDE_DATA(inode); ++ const struct rtw_proc_hdl *hdl = adapter_proc_hdls + index; ++ void *private = proc_get_parent_data(inode); ++ ++ if (hdl->type == RTW_PROC_HDL_TYPE_SEQ) { ++ int res = seq_open(file, hdl->u.seq_op); ++ ++ if (res == 0) ++ ((struct seq_file *)file->private_data)->private = private; ++ ++ return res; ++ } else if (hdl->type == RTW_PROC_HDL_TYPE_SSEQ) { ++ int (*show)(struct seq_file *, void *) = hdl->u.show ? hdl->u.show : proc_get_dummy; ++ ++ return single_open(file, show, private); ++ } else { ++ return -EROFS; ++ } ++} ++ ++static ssize_t rtw_adapter_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) ++{ ++ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); ++ const struct rtw_proc_hdl *hdl = adapter_proc_hdls + index; ++ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; ++ ++ if (write) ++ return write(file, buffer, count, pos, ((struct seq_file *)file->private_data)->private); ++ ++ return -EROFS; ++} ++ ++static const struct file_operations rtw_adapter_proc_seq_fops = { ++ .owner = THIS_MODULE, ++ .open = rtw_adapter_proc_open, ++ .read = seq_read, ++ .llseek = seq_lseek, ++ .release = seq_release, ++ .write = rtw_adapter_proc_write, ++}; ++ ++static const struct file_operations rtw_adapter_proc_sseq_fops = { ++ .owner = THIS_MODULE, ++ .open = rtw_adapter_proc_open, ++ .read = seq_read, ++ .llseek = seq_lseek, ++ .release = single_release, ++ .write = rtw_adapter_proc_write, ++}; ++ ++int proc_get_odm_dbg_comp(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ rtw_odm_dbg_comp_msg(m, adapter); ++ ++ return 0; ++} ++ ++ssize_t proc_set_odm_dbg_comp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ ++ u64 dbg_comp; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%llx", &dbg_comp); ++ ++ if (num != 1) ++ return count; ++ ++ rtw_odm_dbg_comp_set(adapter, dbg_comp); ++ } ++ ++ return count; ++} ++ ++int proc_get_odm_dbg_level(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ rtw_odm_dbg_level_msg(m, adapter); ++ ++ return 0; ++} ++ ++ssize_t proc_set_odm_dbg_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ ++ u32 dbg_level; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%u", &dbg_level); ++ ++ if (num != 1) ++ return count; ++ ++ rtw_odm_dbg_level_set(adapter, dbg_level); ++ } ++ ++ return count; ++} ++ ++int proc_get_odm_ability(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ rtw_odm_ability_msg(m, adapter); ++ ++ return 0; ++} ++ ++ssize_t proc_set_odm_ability(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ ++ u32 ability; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%x", &ability); ++ ++ if (num != 1) ++ return count; ++ ++ rtw_odm_ability_set(adapter, ability); ++ } ++ ++ return count; ++} ++ ++int proc_get_odm_force_igi_lb(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ RTW_PRINT_SEL(m, "force_igi_lb:0x%02x\n", rtw_odm_get_force_igi_lb(padapter)); ++ ++ return 0; ++} ++ ++ssize_t proc_set_odm_force_igi_lb(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u8 force_igi_lb; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%hhx", &force_igi_lb); ++ ++ if (num != 1) ++ return count; ++ ++ rtw_odm_set_force_igi_lb(padapter, force_igi_lb); ++ } ++ ++ return count; ++} ++ ++int proc_get_odm_adaptivity(struct seq_file *m, void *v) ++{ ++ struct net_device *dev = m->private; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ rtw_odm_adaptivity_parm_msg(m, padapter); ++ ++ return 0; ++} ++ ++ssize_t proc_set_odm_adaptivity(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ char tmp[32]; ++ u32 TH_L2H_ini; ++ u32 TH_L2H_ini_mode2; ++ s8 TH_EDCCA_HL_diff; ++ s8 TH_EDCCA_HL_diff_mode2; ++ u8 EDCCA_enable; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) { ++ rtw_warn_on(1); ++ return -EFAULT; ++ } ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ ++ int num = sscanf(tmp, "%x %hhd %x %hhd %hhu", &TH_L2H_ini, &TH_EDCCA_HL_diff, &TH_L2H_ini_mode2, &TH_EDCCA_HL_diff_mode2, &EDCCA_enable); ++ ++ if (num != 5) ++ return count; ++ ++ rtw_odm_adaptivity_parm_set(padapter, (s8)TH_L2H_ini, TH_EDCCA_HL_diff, (s8)TH_L2H_ini_mode2, TH_EDCCA_HL_diff_mode2, EDCCA_enable); ++ } ++ ++ return count; ++} ++ ++static char *phydm_msg = NULL; ++#define PHYDM_MSG_LEN 80*24 ++ ++int proc_get_phydm_cmd(struct seq_file *m, void *v) ++{ ++ struct net_device *netdev; ++ PADAPTER padapter; ++ PHAL_DATA_TYPE pHalData; ++ PDM_ODM_T phydm; ++ ++ ++ netdev = m->private; ++ padapter = (PADAPTER)rtw_netdev_priv(netdev); ++ pHalData = GET_HAL_DATA(padapter); ++ phydm = &pHalData->odmpriv; ++ ++ if (NULL == phydm_msg) { ++ phydm_msg = rtw_zmalloc(PHYDM_MSG_LEN); ++ if (NULL == phydm_msg) ++ return -ENOMEM; ++ ++ phydm_cmd(phydm, NULL, 0, 0, phydm_msg, PHYDM_MSG_LEN); ++ } ++ ++ _RTW_PRINT_SEL(m, "%s\n", phydm_msg); ++ ++ rtw_mfree(phydm_msg, PHYDM_MSG_LEN); ++ phydm_msg = NULL; ++ ++ return 0; ++} ++ ++ssize_t proc_set_phydm_cmd(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++{ ++ struct net_device *netdev; ++ PADAPTER padapter; ++ PHAL_DATA_TYPE pHalData; ++ PDM_ODM_T phydm; ++ char tmp[64] = {0}; ++ ++ ++ netdev = (struct net_device *)data; ++ padapter = (PADAPTER)rtw_netdev_priv(netdev); ++ pHalData = GET_HAL_DATA(padapter); ++ phydm = &pHalData->odmpriv; ++ ++ if (count < 1) ++ return -EFAULT; ++ ++ if (count > sizeof(tmp)) ++ return -EFAULT; ++ ++ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ if (NULL == phydm_msg) { ++ phydm_msg = rtw_zmalloc(PHYDM_MSG_LEN); ++ if (NULL == phydm_msg) ++ return -ENOMEM; ++ } else ++ _rtw_memset(phydm_msg, 0, PHYDM_MSG_LEN); ++ ++ phydm_cmd(phydm, tmp, count, 1, phydm_msg, PHYDM_MSG_LEN); ++ ++ if (strlen(phydm_msg) == 0) { ++ rtw_mfree(phydm_msg, PHYDM_MSG_LEN); ++ phydm_msg = NULL; ++ } ++ } ++ ++ return count; ++} ++ ++/* ++* rtw_odm_proc: ++* init/deinit when register/unregister net_device, along with rtw_adapter_proc ++*/ ++const struct rtw_proc_hdl odm_proc_hdls[] = { ++ RTW_PROC_HDL_SSEQ("dbg_comp", proc_get_odm_dbg_comp, proc_set_odm_dbg_comp), ++ RTW_PROC_HDL_SSEQ("dbg_level", proc_get_odm_dbg_level, proc_set_odm_dbg_level), ++ RTW_PROC_HDL_SSEQ("ability", proc_get_odm_ability, proc_set_odm_ability), ++ RTW_PROC_HDL_SSEQ("adaptivity", proc_get_odm_adaptivity, proc_set_odm_adaptivity), ++ RTW_PROC_HDL_SSEQ("force_igi_lb", proc_get_odm_force_igi_lb, proc_set_odm_force_igi_lb), ++ RTW_PROC_HDL_SSEQ("cmd", proc_get_phydm_cmd, proc_set_phydm_cmd), ++}; ++ ++const int odm_proc_hdls_num = sizeof(odm_proc_hdls) / sizeof(struct rtw_proc_hdl); ++ ++static int rtw_odm_proc_open(struct inode *inode, struct file *file) ++{ ++ ssize_t index = (ssize_t)PDE_DATA(inode); ++ const struct rtw_proc_hdl *hdl = odm_proc_hdls + index; ++ void *private = proc_get_parent_data(inode); ++ ++ if (hdl->type == RTW_PROC_HDL_TYPE_SEQ) { ++ int res = seq_open(file, hdl->u.seq_op); ++ ++ if (res == 0) ++ ((struct seq_file *)file->private_data)->private = private; ++ ++ return res; ++ } else if (hdl->type == RTW_PROC_HDL_TYPE_SSEQ) { ++ int (*show)(struct seq_file *, void *) = hdl->u.show ? hdl->u.show : proc_get_dummy; ++ ++ return single_open(file, show, private); ++ } else { ++ return -EROFS; ++ } ++} ++ ++static ssize_t rtw_odm_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) ++{ ++ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); ++ const struct rtw_proc_hdl *hdl = odm_proc_hdls + index; ++ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; ++ ++ if (write) ++ return write(file, buffer, count, pos, ((struct seq_file *)file->private_data)->private); ++ ++ return -EROFS; ++} ++ ++static const struct file_operations rtw_odm_proc_seq_fops = { ++ .owner = THIS_MODULE, ++ .open = rtw_odm_proc_open, ++ .read = seq_read, ++ .llseek = seq_lseek, ++ .release = seq_release, ++ .write = rtw_odm_proc_write, ++}; ++ ++static const struct file_operations rtw_odm_proc_sseq_fops = { ++ .owner = THIS_MODULE, ++ .open = rtw_odm_proc_open, ++ .read = seq_read, ++ .llseek = seq_lseek, ++ .release = single_release, ++ .write = rtw_odm_proc_write, ++}; ++ ++struct proc_dir_entry *rtw_odm_proc_init(struct net_device *dev) ++{ ++ struct proc_dir_entry *dir_odm = NULL; ++ struct proc_dir_entry *entry = NULL; ++ _adapter *adapter = rtw_netdev_priv(dev); ++ ssize_t i; ++ ++ if (adapter->dir_dev == NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (adapter->dir_odm != NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ dir_odm = rtw_proc_create_dir("odm", adapter->dir_dev, dev); ++ if (dir_odm == NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ adapter->dir_odm = dir_odm; ++ ++ for (i = 0; i < odm_proc_hdls_num; i++) { ++ if (odm_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SEQ) ++ entry = rtw_proc_create_entry(odm_proc_hdls[i].name, dir_odm, &rtw_odm_proc_seq_fops, (void *)i); ++ else if (odm_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SSEQ) ++ entry = rtw_proc_create_entry(odm_proc_hdls[i].name, dir_odm, &rtw_odm_proc_sseq_fops, (void *)i); ++ else ++ entry = NULL; ++ ++ if (!entry) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ } ++ ++exit: ++ return dir_odm; ++} ++ ++void rtw_odm_proc_deinit(_adapter *adapter) ++{ ++ struct proc_dir_entry *dir_odm = NULL; ++ int i; ++ ++ dir_odm = adapter->dir_odm; ++ ++ if (dir_odm == NULL) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ for (i = 0; i < odm_proc_hdls_num; i++) ++ remove_proc_entry(odm_proc_hdls[i].name, dir_odm); ++ ++ remove_proc_entry("odm", adapter->dir_dev); ++ ++ adapter->dir_odm = NULL; ++ ++ if (phydm_msg) { ++ rtw_mfree(phydm_msg, PHYDM_MSG_LEN); ++ phydm_msg = NULL; ++ } ++} ++ ++#ifdef CONFIG_MCC_MODE ++/* ++* rtw_mcc_proc: ++* init/deinit when register/unregister net_device, along with rtw_adapter_proc ++*/ ++const struct rtw_proc_hdl mcc_proc_hdls[] = { ++ RTW_PROC_HDL_SSEQ("mcc_info", proc_get_mcc_info, NULL), ++ RTW_PROC_HDL_SSEQ("mcc_enable", proc_get_mcc_info, proc_set_mcc_enable), ++ RTW_PROC_HDL_SSEQ("mcc_single_tx_criteria", proc_get_mcc_info, proc_set_mcc_single_tx_criteria), ++ RTW_PROC_HDL_SSEQ("mcc_ap_bw20_target_tp", proc_get_mcc_info, proc_set_mcc_ap_bw20_target_tp), ++ RTW_PROC_HDL_SSEQ("mcc_ap_bw40_target_tp", proc_get_mcc_info, proc_set_mcc_ap_bw40_target_tp), ++ RTW_PROC_HDL_SSEQ("mcc_ap_bw80_target_tp", proc_get_mcc_info, proc_set_mcc_ap_bw80_target_tp), ++ RTW_PROC_HDL_SSEQ("mcc_sta_bw20_target_tp", proc_get_mcc_info, proc_set_mcc_sta_bw20_target_tp), ++ RTW_PROC_HDL_SSEQ("mcc_sta_bw40_target_tp", proc_get_mcc_info, proc_set_mcc_sta_bw40_target_tp), ++ RTW_PROC_HDL_SSEQ("mcc_sta_bw80_target_tp", proc_get_mcc_info, proc_set_mcc_sta_bw80_target_tp), ++}; ++ ++const int mcc_proc_hdls_num = sizeof(mcc_proc_hdls) / sizeof(struct rtw_proc_hdl); ++ ++static int rtw_mcc_proc_open(struct inode *inode, struct file *file) ++{ ++ ssize_t index = (ssize_t)PDE_DATA(inode); ++ const struct rtw_proc_hdl *hdl = mcc_proc_hdls + index; ++ void *private = proc_get_parent_data(inode); ++ ++ if (hdl->type == RTW_PROC_HDL_TYPE_SEQ) { ++ int res = seq_open(file, hdl->u.seq_op); ++ ++ if (res == 0) ++ ((struct seq_file *)file->private_data)->private = private; ++ ++ return res; ++ } else if (hdl->type == RTW_PROC_HDL_TYPE_SSEQ) { ++ int (*show)(struct seq_file *, void *) = hdl->u.show ? hdl->u.show : proc_get_dummy; ++ ++ return single_open(file, show, private); ++ } else { ++ return -EROFS; ++ } ++} ++ ++static ssize_t rtw_mcc_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) ++{ ++ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); ++ const struct rtw_proc_hdl *hdl = mcc_proc_hdls + index; ++ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; ++ ++ if (write) ++ return write(file, buffer, count, pos, ((struct seq_file *)file->private_data)->private); ++ ++ return -EROFS; ++} ++ ++static const struct file_operations rtw_mcc_proc_seq_fops = { ++ .owner = THIS_MODULE, ++ .open = rtw_mcc_proc_open, ++ .read = seq_read, ++ .llseek = seq_lseek, ++ .release = seq_release, ++ .write = rtw_mcc_proc_write, ++}; ++ ++static const struct file_operations rtw_mcc_proc_sseq_fops = { ++ .owner = THIS_MODULE, ++ .open = rtw_mcc_proc_open, ++ .read = seq_read, ++ .llseek = seq_lseek, ++ .release = single_release, ++ .write = rtw_mcc_proc_write, ++}; ++ ++struct proc_dir_entry *rtw_mcc_proc_init(struct net_device *dev) ++{ ++ struct proc_dir_entry *dir_mcc = NULL; ++ struct proc_dir_entry *entry = NULL; ++ _adapter *adapter = rtw_netdev_priv(dev); ++ ssize_t i; ++ ++ if (adapter->dir_dev == NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (adapter->dir_mcc != NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ dir_mcc = rtw_proc_create_dir("mcc", adapter->dir_dev, dev); ++ if (dir_mcc == NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ adapter->dir_mcc = dir_mcc; ++ ++ for (i = 0; i < mcc_proc_hdls_num; i++) { ++ if (mcc_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SEQ) ++ entry = rtw_proc_create_entry(mcc_proc_hdls[i].name, dir_mcc, &rtw_mcc_proc_seq_fops, (void *)i); ++ else if (mcc_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SSEQ) ++ entry = rtw_proc_create_entry(mcc_proc_hdls[i].name, dir_mcc, &rtw_mcc_proc_sseq_fops, (void *)i); ++ else ++ entry = NULL; ++ ++ if (!entry) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ } ++ ++exit: ++ return dir_mcc; ++} ++ ++void rtw_mcc_proc_deinit(_adapter *adapter) ++{ ++ struct proc_dir_entry *dir_mcc = NULL; ++ int i; ++ ++ dir_mcc = adapter->dir_mcc; ++ ++ if (dir_mcc == NULL) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ for (i = 0; i < mcc_proc_hdls_num; i++) ++ remove_proc_entry(mcc_proc_hdls[i].name, dir_mcc); ++ ++ remove_proc_entry("mcc", adapter->dir_dev); ++ ++ adapter->dir_mcc = NULL; ++} ++#endif /* CONFIG_MCC_MODE */ ++ ++struct proc_dir_entry *rtw_adapter_proc_init(struct net_device *dev) ++{ ++ struct proc_dir_entry *drv_proc = get_rtw_drv_proc(); ++ struct proc_dir_entry *dir_dev = NULL; ++ struct proc_dir_entry *entry = NULL; ++ _adapter *adapter = rtw_netdev_priv(dev); ++ u8 rf_type; ++ ssize_t i; ++ ++ if (drv_proc == NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (adapter->dir_dev != NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ dir_dev = rtw_proc_create_dir(dev->name, drv_proc, dev); ++ if (dir_dev == NULL) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ adapter->dir_dev = dir_dev; ++ ++ for (i = 0; i < adapter_proc_hdls_num; i++) { ++ if (adapter_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SEQ) ++ entry = rtw_proc_create_entry(adapter_proc_hdls[i].name, dir_dev, &rtw_adapter_proc_seq_fops, (void *)i); ++ else if (adapter_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SSEQ) ++ entry = rtw_proc_create_entry(adapter_proc_hdls[i].name, dir_dev, &rtw_adapter_proc_sseq_fops, (void *)i); ++ else ++ entry = NULL; ++ ++ if (!entry) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ } ++ ++ rtw_odm_proc_init(dev); ++ ++#ifdef CONFIG_MCC_MODE ++ rtw_mcc_proc_init(dev); ++#endif /* CONFIG_MCC_MODE */ ++ ++exit: ++ return dir_dev; ++} ++ ++void rtw_adapter_proc_deinit(struct net_device *dev) ++{ ++ struct proc_dir_entry *drv_proc = get_rtw_drv_proc(); ++ struct proc_dir_entry *dir_dev = NULL; ++ _adapter *adapter = rtw_netdev_priv(dev); ++ int i; ++ ++ dir_dev = adapter->dir_dev; ++ ++ if (dir_dev == NULL) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ for (i = 0; i < adapter_proc_hdls_num; i++) ++ remove_proc_entry(adapter_proc_hdls[i].name, dir_dev); ++ ++ rtw_odm_proc_deinit(adapter); ++ ++#ifdef CONFIG_MCC_MODE ++ rtw_mcc_proc_deinit(adapter); ++#endif /* CONFIG_MCC_MODE */ ++ ++ remove_proc_entry(dev->name, drv_proc); ++ ++ adapter->dir_dev = NULL; ++} ++ ++void rtw_adapter_proc_replace(struct net_device *dev) ++{ ++ struct proc_dir_entry *drv_proc = get_rtw_drv_proc(); ++ struct proc_dir_entry *dir_dev = NULL; ++ _adapter *adapter = rtw_netdev_priv(dev); ++ int i; ++ ++ dir_dev = adapter->dir_dev; ++ ++ if (dir_dev == NULL) { ++ rtw_warn_on(1); ++ return; ++ } ++ ++ for (i = 0; i < adapter_proc_hdls_num; i++) ++ remove_proc_entry(adapter_proc_hdls[i].name, dir_dev); ++ ++ rtw_odm_proc_deinit(adapter); ++ ++#ifdef CONFIG_MCC_MODE ++ rtw_mcc_proc_deinit(adapter); ++#endif /* CONIG_MCC_MODE */ ++ ++ remove_proc_entry(adapter->old_ifname, drv_proc); ++ ++ adapter->dir_dev = NULL; ++ ++ rtw_adapter_proc_init(dev); ++ ++} ++ ++#endif /* CONFIG_PROC_DEBUG */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_proc.h linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_proc.h +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_proc.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_proc.h 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,65 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __RTW_PROC_H__ ++#define __RTW_PROC_H__ ++ ++#include ++#include ++ ++#define RTW_PROC_HDL_TYPE_SEQ 0 ++#define RTW_PROC_HDL_TYPE_SSEQ 1 ++ ++struct rtw_proc_hdl { ++ char *name; ++ u8 type; ++ union { ++ int (*show)(struct seq_file *, void *); ++ struct seq_operations *seq_op; ++ } u; ++ ssize_t (*write)(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++}; ++ ++#define RTW_PROC_HDL_SEQ(_name, _seq_op, _write) \ ++ { .name = _name, .type = RTW_PROC_HDL_TYPE_SEQ, .u.seq_op = _seq_op, .write = _write} ++ ++#define RTW_PROC_HDL_SSEQ(_name, _show, _write) \ ++ { .name = _name, .type = RTW_PROC_HDL_TYPE_SSEQ, .u.show = _show, .write = _write} ++ ++#ifdef CONFIG_PROC_DEBUG ++ ++struct proc_dir_entry *get_rtw_drv_proc(void); ++int rtw_drv_proc_init(void); ++void rtw_drv_proc_deinit(void); ++struct proc_dir_entry *rtw_adapter_proc_init(struct net_device *dev); ++void rtw_adapter_proc_deinit(struct net_device *dev); ++void rtw_adapter_proc_replace(struct net_device *dev); ++ ++#else /* !CONFIG_PROC_DEBUG */ ++ ++#define get_rtw_drv_proc() NULL ++#define rtw_drv_proc_init() 0 ++#define rtw_drv_proc_deinit() do {} while (0) ++#define rtw_adapter_proc_init(dev) NULL ++#define rtw_adapter_proc_deinit(dev) do {} while (0) ++#define rtw_adapter_proc_replace(dev) do {} while (0) ++ ++#endif /* !CONFIG_PROC_DEBUG */ ++ ++#endif /* __RTW_PROC_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/wifi_regd.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/wifi_regd.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/wifi_regd.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/wifi_regd.c 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,545 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2009-2010 Realtek Corporation. ++ * ++ *****************************************************************************/ ++ ++#include ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ ++#include ++ ++static struct country_code_to_enum_rd allCountries[] = { ++ {COUNTRY_CODE_USER, "RD"}, ++}; ++ ++/* ++ * REG_RULE(freq start, freq end, bandwidth, max gain, eirp, reg_flags) ++ */ ++ ++/* ++ *Only these channels all allow active ++ *scan on all world regulatory domains ++ */ ++ ++/* 2G chan 01 - chan 11 */ ++#define RTW_2GHZ_CH01_11 \ ++ REG_RULE(2412-10, 2462+10, 40, 0, 20, 0) ++ ++/* ++ *We enable active scan on these a case ++ *by case basis by regulatory domain ++ */ ++ ++/* 2G chan 12 - chan 13, PASSIV SCAN */ ++#define RTW_2GHZ_CH12_13 \ ++ REG_RULE(2467-10, 2472+10, 40, 0, 20, \ ++ NL80211_RRF_PASSIVE_SCAN) ++ ++/* 2G chan 14, PASSIVS SCAN, NO OFDM (B only) */ ++#define RTW_2GHZ_CH14 \ ++ REG_RULE(2484-10, 2484+10, 40, 0, 20, \ ++ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_OFDM) ++ ++/* 5G chan 36 - chan 64 */ ++#define RTW_5GHZ_5150_5350 \ ++ REG_RULE(5150-10, 5350+10, 40, 0, 30, \ ++ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_IBSS) ++ ++/* 5G chan 100 - chan 165 */ ++#define RTW_5GHZ_5470_5850 \ ++ REG_RULE(5470-10, 5850+10, 40, 0, 30, \ ++ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_IBSS) ++ ++/* 5G chan 149 - chan 165 */ ++#define RTW_5GHZ_5725_5850 \ ++ REG_RULE(5725-10, 5850+10, 40, 0, 30, \ ++ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_IBSS) ++ ++/* 5G chan 36 - chan 165 */ ++#define RTW_5GHZ_5150_5850 \ ++ REG_RULE(5150-10, 5850+10, 40, 0, 30, \ ++ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_IBSS) ++ ++static const struct ieee80211_regdomain rtw_regdom_rd = { ++ .n_reg_rules = 3, ++ .alpha2 = "99", ++ .reg_rules = { ++ RTW_2GHZ_CH01_11, ++ RTW_2GHZ_CH12_13, ++ RTW_5GHZ_5150_5850, ++ } ++}; ++ ++static const struct ieee80211_regdomain rtw_regdom_11 = { ++ .n_reg_rules = 1, ++ .alpha2 = "99", ++ .reg_rules = { ++ RTW_2GHZ_CH01_11, ++ } ++}; ++ ++static const struct ieee80211_regdomain rtw_regdom_12_13 = { ++ .n_reg_rules = 2, ++ .alpha2 = "99", ++ .reg_rules = { ++ RTW_2GHZ_CH01_11, ++ RTW_2GHZ_CH12_13, ++ } ++}; ++ ++static const struct ieee80211_regdomain rtw_regdom_no_midband = { ++ .n_reg_rules = 3, ++ .alpha2 = "99", ++ .reg_rules = { ++ RTW_2GHZ_CH01_11, ++ RTW_5GHZ_5150_5350, ++ RTW_5GHZ_5725_5850, ++ } ++}; ++ ++static const struct ieee80211_regdomain rtw_regdom_60_64 = { ++ .n_reg_rules = 3, ++ .alpha2 = "99", ++ .reg_rules = { ++ RTW_2GHZ_CH01_11, ++ RTW_2GHZ_CH12_13, ++ RTW_5GHZ_5725_5850, ++ } ++}; ++ ++static const struct ieee80211_regdomain rtw_regdom_14_60_64 = { ++ .n_reg_rules = 4, ++ .alpha2 = "99", ++ .reg_rules = { ++ RTW_2GHZ_CH01_11, ++ RTW_2GHZ_CH12_13, ++ RTW_2GHZ_CH14, ++ RTW_5GHZ_5725_5850, ++ } ++}; ++ ++static const struct ieee80211_regdomain rtw_regdom_14 = { ++ .n_reg_rules = 3, ++ .alpha2 = "99", ++ .reg_rules = { ++ RTW_2GHZ_CH01_11, ++ RTW_2GHZ_CH12_13, ++ RTW_2GHZ_CH14, ++ } ++}; ++ ++#if 0 ++static struct rtw_regulatory *rtw_regd; ++#endif ++ ++static bool _rtw_is_radar_freq(u16 center_freq) ++{ ++ return center_freq >= 5260 && center_freq <= 5700; ++} ++ ++#if 0 /* not_yet */ ++static void _rtw_reg_apply_beaconing_flags(struct wiphy *wiphy, ++ enum nl80211_reg_initiator initiator) ++{ ++ enum nl80211_band band; ++ struct ieee80211_supported_band *sband; ++ const struct ieee80211_reg_rule *reg_rule; ++ struct ieee80211_channel *ch; ++ unsigned int i; ++ u32 bandwidth = 0; ++ int r; ++ ++ for (band = 0; band < IEEE80211_NUM_BANDS; band++) { ++ ++ if (!wiphy->bands[band]) ++ continue; ++ ++ sband = wiphy->bands[band]; ++ ++ for (i = 0; i < sband->n_channels; i++) { ++ ch = &sband->channels[i]; ++ if (_rtw_is_radar_freq(ch->center_freq) || ++ (ch->flags & IEEE80211_CHAN_RADAR)) ++ continue; ++ if (initiator == NL80211_REGDOM_SET_BY_COUNTRY_IE) { ++ r = freq_reg_info(wiphy, ch->center_freq, ++ bandwidth, ®_rule); ++ if (r) ++ continue; ++ ++ /* ++ *If 11d had a rule for this channel ensure ++ *we enable adhoc/beaconing if it allows us to ++ *use it. Note that we would have disabled it ++ *by applying our static world regdomain by ++ *default during init, prior to calling our ++ *regulatory_hint(). ++ */ ++ ++ if (!(reg_rule->flags & NL80211_RRF_NO_IBSS)) ++ ch->flags &= ~IEEE80211_CHAN_NO_IBSS; ++ if (! ++ (reg_rule->flags & ++ NL80211_RRF_PASSIVE_SCAN)) ++ ch->flags &= ++ ~IEEE80211_CHAN_PASSIVE_SCAN; ++ } else { ++ if (ch->beacon_found) ++ ch->flags &= ~(IEEE80211_CHAN_NO_IBSS | ++ IEEE80211_CHAN_PASSIVE_SCAN); ++ } ++ } ++ } ++} ++ ++/* Allows active scan scan on Ch 12 and 13 */ ++static void _rtw_reg_apply_active_scan_flags(struct wiphy *wiphy, ++ enum nl80211_reg_initiator ++ initiator) ++{ ++ struct ieee80211_supported_band *sband; ++ struct ieee80211_channel *ch; ++ const struct ieee80211_reg_rule *reg_rule; ++ u32 bandwidth = 0; ++ int r; ++ ++ if (!wiphy->bands[NL80211_BAND_2GHZ]) ++ return; ++ sband = wiphy->bands[NL80211_BAND_2GHZ]; ++ ++ /* ++ * If no country IE has been received always enable active scan ++ * on these channels. This is only done for specific regulatory SKUs ++ */ ++ if (initiator != NL80211_REGDOM_SET_BY_COUNTRY_IE) { ++ ch = &sband->channels[11]; /* CH 12 */ ++ if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN) ++ ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN; ++ ch = &sband->channels[12]; /* CH 13 */ ++ if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN) ++ ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN; ++ return; ++ } ++ ++ /* ++ * If a country IE has been received check its rule for this ++ * channel first before enabling active scan. The passive scan ++ * would have been enforced by the initial processing of our ++ * custom regulatory domain. ++ */ ++ ++ ch = &sband->channels[11]; /* CH 12 */ ++ r = freq_reg_info(wiphy, ch->center_freq, bandwidth, ®_rule); ++ if (!r) { ++ if (!(reg_rule->flags & NL80211_RRF_PASSIVE_SCAN)) ++ if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN) ++ ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN; ++ } ++ ++ ch = &sband->channels[12]; /* CH 13 */ ++ r = freq_reg_info(wiphy, ch->center_freq, bandwidth, ®_rule); ++ if (!r) { ++ if (!(reg_rule->flags & NL80211_RRF_PASSIVE_SCAN)) ++ if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN) ++ ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN; ++ } ++} ++#endif ++ ++/* ++ * Always apply Radar/DFS rules on ++ * freq range 5260 MHz - 5700 MHz ++ */ ++static void _rtw_reg_apply_radar_flags(struct wiphy *wiphy) ++{ ++ struct ieee80211_supported_band *sband; ++ struct ieee80211_channel *ch; ++ unsigned int i; ++ ++ if (!wiphy->bands[NL80211_BAND_5GHZ]) ++ return; ++ ++ sband = wiphy->bands[NL80211_BAND_5GHZ]; ++ ++ for (i = 0; i < sband->n_channels; i++) { ++ ch = &sband->channels[i]; ++ if (!_rtw_is_radar_freq(ch->center_freq)) ++ continue; ++#ifdef CONFIG_DFS ++ #if !defined(CONFIG_DFS_MASTER) ++ if (!(ch->flags & IEEE80211_CHAN_DISABLED)) { ++ ch->flags |= IEEE80211_CHAN_RADAR; ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) ++ ch->flags |= (IEEE80211_CHAN_NO_IBSS | IEEE80211_CHAN_PASSIVE_SCAN); ++ #else ++ ch->flags |= IEEE80211_CHAN_NO_IR; ++ #endif ++ } ++ #endif ++#endif /* CONFIG_DFS */ ++ ++#if 0 ++ /* ++ * We always enable radar detection/DFS on this ++ * frequency range. Additionally we also apply on ++ * this frequency range: ++ * - If STA mode does not yet have DFS supports disable ++ * active scanning ++ * - If adhoc mode does not support DFS yet then disable ++ * adhoc in the frequency. ++ * - If AP mode does not yet support radar detection/DFS ++ * do not allow AP mode ++ */ ++ if (!(ch->flags & IEEE80211_CHAN_DISABLED)) ++ ch->flags |= IEEE80211_CHAN_RADAR | ++ IEEE80211_CHAN_NO_IBSS | ++ IEEE80211_CHAN_PASSIVE_SCAN; ++#endif ++ } ++} ++ ++static void _rtw_reg_apply_flags(struct wiphy *wiphy) ++{ ++#if 1 /* by channel plan */ ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ u8 channel_plan = padapter->mlmepriv.ChannelPlan; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ RT_CHANNEL_INFO *channel_set = pmlmeext->channel_set; ++ u8 max_chan_nums = pmlmeext->max_chan_nums; ++ ++ struct ieee80211_supported_band *sband; ++ struct ieee80211_channel *ch; ++ unsigned int i, j; ++ u16 channel; ++ u32 freq; ++ ++ /* all channels disable */ ++ for (i = 0; i < NUM_NL80211_BANDS; i++) { ++ sband = wiphy->bands[i]; ++ ++ if (sband) { ++ for (j = 0; j < sband->n_channels; j++) { ++ ch = &sband->channels[j]; ++ ++ if (ch) ++ ch->flags = IEEE80211_CHAN_DISABLED; ++ } ++ } ++ } ++ ++ /* channels apply by channel plans. */ ++ for (i = 0; i < max_chan_nums; i++) { ++ channel = channel_set[i].ChannelNum; ++ freq = rtw_ch2freq(channel); ++ ++ ch = ieee80211_get_channel(wiphy, freq); ++ if (ch) { ++ if (channel_set[i].ScanType == SCAN_PASSIVE) { ++ #if defined(CONFIG_DFS_MASTER) ++ ch->flags = 0; ++ #elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) ++ ch->flags = (IEEE80211_CHAN_NO_IBSS | IEEE80211_CHAN_PASSIVE_SCAN); ++ #else ++ ch->flags = IEEE80211_CHAN_NO_IR; ++ #endif ++ } else ++ ch->flags = 0; ++ } ++ } ++ ++#else ++ struct ieee80211_supported_band *sband; ++ struct ieee80211_channel *ch; ++ unsigned int i, j; ++ u16 channels[37] = { ++ 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, ++ 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, ++ 149, 153, ++ 157, 161, 165 ++ }; ++ u16 channel; ++ u32 freq; ++ ++ for (i = 0; i < NUM_NL80211_BANDS; i++) { ++ sband = wiphy->bands[i]; ++ ++ if (sband) ++ for (j = 0; j < sband->n_channels; j++) { ++ ch = &sband->channels[j]; ++ ++ if (ch) ++ ch->flags = IEEE80211_CHAN_DISABLED; ++ } ++ } ++ ++ for (i = 0; i < 37; i++) { ++ channel = channels[i]; ++ freq = rtw_ch2freq(channel); ++ ++ ch = ieee80211_get_channel(wiphy, freq); ++ if (ch) { ++ if (channel <= 11) ++ ch->flags = 0; ++ else ++ ch->flags = 0; /* IEEE80211_CHAN_PASSIVE_SCAN; */ ++ } ++ /* printk("%s: freq %d(%d) flag 0x%02X\n", __func__, freq, channel, ch->flags); */ ++ } ++#endif ++} ++ ++static void _rtw_reg_apply_world_flags(struct wiphy *wiphy, ++ enum nl80211_reg_initiator initiator, ++ struct rtw_regulatory *reg) ++{ ++ /* _rtw_reg_apply_beaconing_flags(wiphy, initiator); */ ++ /* _rtw_reg_apply_active_scan_flags(wiphy, initiator); */ ++ return; ++} ++ ++static int _rtw_reg_notifier_apply(struct wiphy *wiphy, ++ struct regulatory_request *request, ++ struct rtw_regulatory *reg) ++{ ++ ++ /* Hard code flags */ ++ _rtw_reg_apply_flags(wiphy); ++ ++ /* We always apply this */ ++ _rtw_reg_apply_radar_flags(wiphy); ++ ++ switch (request->initiator) { ++ case NL80211_REGDOM_SET_BY_DRIVER: ++ RTW_INFO("%s: %s\n", __func__, "NL80211_REGDOM_SET_BY_DRIVER"); ++ _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, ++ reg); ++ break; ++ case NL80211_REGDOM_SET_BY_CORE: ++ RTW_INFO("%s: %s\n", __func__, ++ "NL80211_REGDOM_SET_BY_CORE to DRV"); ++ _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, ++ reg); ++ break; ++ case NL80211_REGDOM_SET_BY_USER: ++ RTW_INFO("%s: %s\n", __func__, ++ "NL80211_REGDOM_SET_BY_USER to DRV"); ++ _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, ++ reg); ++ break; ++ case NL80211_REGDOM_SET_BY_COUNTRY_IE: ++ RTW_INFO("%s: %s\n", __func__, ++ "NL80211_REGDOM_SET_BY_COUNTRY_IE"); ++ _rtw_reg_apply_world_flags(wiphy, request->initiator, reg); ++ break; ++ } ++ ++ return 0; ++} ++ ++static const struct ieee80211_regdomain *_rtw_regdomain_select(struct ++ rtw_regulatory ++ *reg) ++{ ++#if 0 ++ switch (reg->country_code) { ++ case COUNTRY_CODE_USER: ++ default: ++ return &rtw_regdom_rd; ++ } ++#else ++ return &rtw_regdom_rd; ++#endif ++} ++ ++void _rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) ++{ ++ struct rtw_regulatory *reg = NULL; ++ ++ RTW_INFO("%s\n", __func__); ++ ++ _rtw_reg_notifier_apply(wiphy, request, reg); ++} ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 9, 0)) ++int rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) ++#else ++void rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) ++#endif ++{ ++ _rtw_reg_notifier(wiphy, request); ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 9, 0)) ++ return 0; ++#endif ++} ++ ++void rtw_reg_notify_by_driver(_adapter *adapter) ++{ ++ if ((adapter->rtw_wdev != NULL) && (adapter->rtw_wdev->wiphy)) { ++ struct regulatory_request request; ++ request.initiator = NL80211_REGDOM_SET_BY_DRIVER; ++ rtw_reg_notifier(adapter->rtw_wdev->wiphy, &request); ++ } ++} ++ ++static void _rtw_regd_init_wiphy(struct rtw_regulatory *reg, struct wiphy *wiphy) ++{ ++ const struct ieee80211_regdomain *regd; ++ ++ wiphy->reg_notifier = rtw_reg_notifier; ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) ++ wiphy->flags |= WIPHY_FLAG_CUSTOM_REGULATORY; ++ wiphy->flags &= ~WIPHY_FLAG_STRICT_REGULATORY; ++ wiphy->flags &= ~WIPHY_FLAG_DISABLE_BEACON_HINTS; ++#else ++ wiphy->regulatory_flags |= REGULATORY_CUSTOM_REG; ++ wiphy->regulatory_flags &= ~REGULATORY_STRICT_REG; ++ wiphy->regulatory_flags &= ~REGULATORY_DISABLE_BEACON_HINTS; ++#endif ++ ++ regd = _rtw_regdomain_select(reg); ++ wiphy_apply_custom_regulatory(wiphy, regd); ++ ++ /* Hard code flags */ ++ _rtw_reg_apply_flags(wiphy); ++ _rtw_reg_apply_radar_flags(wiphy); ++ _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, reg); ++} ++ ++static struct country_code_to_enum_rd *_rtw_regd_find_country(u16 countrycode) ++{ ++ int i; ++ ++ for (i = 0; i < ARRAY_SIZE(allCountries); i++) { ++ if (allCountries[i].countrycode == countrycode) ++ return &allCountries[i]; ++ } ++ return NULL; ++} ++ ++int rtw_regd_init(_adapter *padapter) ++{ ++ struct wiphy *wiphy = padapter->rtw_wdev->wiphy; ++ ++#if 0 ++ if (rtw_regd == NULL) { ++ rtw_regd = (struct rtw_regulatory *) ++ rtw_malloc(sizeof(struct rtw_regulatory)); ++ ++ rtw_regd->alpha2[0] = '9'; ++ rtw_regd->alpha2[1] = '9'; ++ ++ rtw_regd->country_code = COUNTRY_CODE_USER; ++ } ++ ++ RTW_INFO("%s: Country alpha2 being used: %c%c\n", ++ __func__, rtw_regd->alpha2[0], rtw_regd->alpha2[1]); ++#endif ++ ++ _rtw_regd_init_wiphy(NULL, wiphy); ++ ++ return 0; ++} ++#endif /* CONFIG_IOCTL_CFG80211 */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/xmit_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/xmit_linux.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/xmit_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/xmit_linux.c 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,528 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#define _XMIT_OSDEP_C_ ++ ++#include ++ ++#define DBG_DUMP_OS_QUEUE_CTL 0 ++ ++uint rtw_remainder_len(struct pkt_file *pfile) ++{ ++ return pfile->buf_len - ((SIZE_PTR)(pfile->cur_addr) - (SIZE_PTR)(pfile->buf_start)); ++} ++ ++void _rtw_open_pktfile(_pkt *pktptr, struct pkt_file *pfile) ++{ ++ ++ pfile->pkt = pktptr; ++ pfile->cur_addr = pfile->buf_start = pktptr->data; ++ pfile->pkt_len = pfile->buf_len = pktptr->len; ++ ++ pfile->cur_buffer = pfile->buf_start ; ++ ++} ++ ++uint _rtw_pktfile_read(struct pkt_file *pfile, u8 *rmem, uint rlen) ++{ ++ uint len = 0; ++ ++ ++ len = rtw_remainder_len(pfile); ++ len = (rlen > len) ? len : rlen; ++ ++ if (rmem) ++ skb_copy_bits(pfile->pkt, pfile->buf_len - pfile->pkt_len, rmem, len); ++ ++ pfile->cur_addr += len; ++ pfile->pkt_len -= len; ++ ++ ++ return len; ++} ++ ++sint rtw_endofpktfile(struct pkt_file *pfile) ++{ ++ ++ if (pfile->pkt_len == 0) { ++ return _TRUE; ++ } ++ ++ ++ return _FALSE; ++} ++ ++void rtw_set_tx_chksum_offload(_pkt *pkt, struct pkt_attrib *pattrib) ++{ ++ ++#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX ++ struct sk_buff *skb = (struct sk_buff *)pkt; ++ pattrib->hw_tcp_csum = 0; ++ ++ if (skb->ip_summed == CHECKSUM_PARTIAL) { ++ if (skb_shinfo(skb)->nr_frags == 0) { ++ const struct iphdr *ip = ip_hdr(skb); ++ if (ip->protocol == IPPROTO_TCP) { ++ /* TCP checksum offload by HW */ ++ RTW_INFO("CHECKSUM_PARTIAL TCP\n"); ++ pattrib->hw_tcp_csum = 1; ++ /* skb_checksum_help(skb); */ ++ } else if (ip->protocol == IPPROTO_UDP) { ++ /* RTW_INFO("CHECKSUM_PARTIAL UDP\n"); */ ++#if 1 ++ skb_checksum_help(skb); ++#else ++ /* Set UDP checksum = 0 to skip checksum check */ ++ struct udphdr *udp = skb_transport_header(skb); ++ udp->check = 0; ++#endif ++ } else { ++ RTW_INFO("%s-%d TCP CSUM offload Error!!\n", __FUNCTION__, __LINE__); ++ WARN_ON(1); /* we need a WARN() */ ++ } ++ } else { /* IP fragmentation case */ ++ RTW_INFO("%s-%d nr_frags != 0, using skb_checksum_help(skb);!!\n", __FUNCTION__, __LINE__); ++ skb_checksum_help(skb); ++ } ++ } ++#endif ++ ++} ++ ++int rtw_os_xmit_resource_alloc(_adapter *padapter, struct xmit_buf *pxmitbuf, u32 alloc_sz, u8 flag) ++{ ++ if (alloc_sz > 0) { ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_TX ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct usb_device *pusbd = pdvobjpriv->pusbdev; ++ ++ pxmitbuf->pallocated_buf = rtw_usb_buffer_alloc(pusbd, (size_t)alloc_sz, &pxmitbuf->dma_transfer_addr); ++ pxmitbuf->pbuf = pxmitbuf->pallocated_buf; ++ if (pxmitbuf->pallocated_buf == NULL) ++ return _FAIL; ++#else /* CONFIG_USE_USB_BUFFER_ALLOC_TX */ ++ ++ pxmitbuf->pallocated_buf = rtw_zmalloc(alloc_sz); ++ if (pxmitbuf->pallocated_buf == NULL) ++ return _FAIL; ++ ++ pxmitbuf->pbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitbuf->pallocated_buf), XMITBUF_ALIGN_SZ); ++ ++#endif /* CONFIG_USE_USB_BUFFER_ALLOC_TX */ ++ } ++ ++ if (flag) { ++#ifdef CONFIG_USB_HCI ++ int i; ++ for (i = 0; i < 8; i++) { ++ pxmitbuf->pxmit_urb[i] = usb_alloc_urb(0, GFP_KERNEL); ++ if (pxmitbuf->pxmit_urb[i] == NULL) { ++ RTW_INFO("pxmitbuf->pxmit_urb[i]==NULL"); ++ return _FAIL; ++ } ++ } ++#endif ++ } ++ ++ return _SUCCESS; ++} ++ ++void rtw_os_xmit_resource_free(_adapter *padapter, struct xmit_buf *pxmitbuf, u32 free_sz, u8 flag) ++{ ++ if (flag) { ++#ifdef CONFIG_USB_HCI ++ int i; ++ ++ for (i = 0; i < 8; i++) { ++ if (pxmitbuf->pxmit_urb[i]) { ++ /* usb_kill_urb(pxmitbuf->pxmit_urb[i]); */ ++ usb_free_urb(pxmitbuf->pxmit_urb[i]); ++ } ++ } ++#endif ++ } ++ ++ if (free_sz > 0) { ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_TX ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct usb_device *pusbd = pdvobjpriv->pusbdev; ++ ++ rtw_usb_buffer_free(pusbd, (size_t)free_sz, pxmitbuf->pallocated_buf, pxmitbuf->dma_transfer_addr); ++ pxmitbuf->pallocated_buf = NULL; ++ pxmitbuf->dma_transfer_addr = 0; ++#else /* CONFIG_USE_USB_BUFFER_ALLOC_TX */ ++ if (pxmitbuf->pallocated_buf) ++ rtw_mfree(pxmitbuf->pallocated_buf, free_sz); ++#endif /* CONFIG_USE_USB_BUFFER_ALLOC_TX */ ++ } ++} ++ ++void dump_os_queue(void *sel, _adapter *padapter) ++{ ++ struct net_device *ndev = padapter->pnetdev; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ int i; ++ ++ for (i = 0; i < 4; i++) { ++ RTW_PRINT_SEL(sel, "os_queue[%d]:%s\n" ++ , i, __netif_subqueue_stopped(ndev, i) ? "stopped" : "waked"); ++ } ++#else ++ RTW_PRINT_SEL(sel, "os_queue:%s\n" ++ , netif_queue_stopped(ndev) ? "stopped" : "waked"); ++#endif ++} ++ ++#define WMM_XMIT_THRESHOLD (NR_XMITFRAME*2/5) ++ ++static inline bool rtw_os_need_wake_queue(_adapter *padapter, u16 qidx) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ if (padapter->registrypriv.wifi_spec) { ++ if (pxmitpriv->hwxmits[qidx].accnt < WMM_XMIT_THRESHOLD) ++ return _TRUE; ++ } else { ++#ifdef CONFIG_MCC_MODE ++ if (MCC_EN(padapter)) { ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC) ++ && MCC_STOP(padapter)) ++ return _FALSE; ++ } ++#endif /* CONFIG_MCC_MODE */ ++ return _TRUE; ++ } ++ return _FALSE; ++#else ++#ifdef CONFIG_MCC_MODE ++ if (MCC_EN(padapter)) { ++ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC) ++ && MCC_STOP(padapter)) ++ return _FALSE; ++ } ++#endif /* CONFIG_MCC_MODE */ ++ return _TRUE; ++#endif ++} ++ ++static inline bool rtw_os_need_stop_queue(_adapter *padapter, u16 qidx) ++{ ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ if (padapter->registrypriv.wifi_spec) { ++ /* No free space for Tx, tx_worker is too slow */ ++ if (pxmitpriv->hwxmits[qidx].accnt > WMM_XMIT_THRESHOLD) ++ return _TRUE; ++ } else { ++ if (pxmitpriv->free_xmitframe_cnt <= 4) ++ return _TRUE; ++ } ++#else ++ if (pxmitpriv->free_xmitframe_cnt <= 4) ++ return _TRUE; ++#endif ++ return _FALSE; ++} ++ ++void rtw_os_pkt_complete(_adapter *padapter, _pkt *pkt) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ u16 qidx; ++ ++ qidx = skb_get_queue_mapping(pkt); ++ if (rtw_os_need_wake_queue(padapter, qidx)) { ++ if (DBG_DUMP_OS_QUEUE_CTL) ++ RTW_INFO(FUNC_ADPT_FMT": netif_wake_subqueue[%d]\n", FUNC_ADPT_ARG(padapter), qidx); ++ netif_wake_subqueue(padapter->pnetdev, qidx); ++ } ++#else ++ if (rtw_os_need_wake_queue(padapter, 0)) { ++ if (DBG_DUMP_OS_QUEUE_CTL) ++ RTW_INFO(FUNC_ADPT_FMT": netif_wake_queue\n", FUNC_ADPT_ARG(padapter)); ++ netif_wake_queue(padapter->pnetdev); ++ } ++#endif ++ ++ rtw_skb_free(pkt); ++} ++ ++void rtw_os_xmit_complete(_adapter *padapter, struct xmit_frame *pxframe) ++{ ++ if (pxframe->pkt) ++ rtw_os_pkt_complete(padapter, pxframe->pkt); ++ ++ pxframe->pkt = NULL; ++} ++ ++void rtw_os_xmit_schedule(_adapter *padapter) ++{ ++#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) ++ _adapter *pri_adapter = GET_PRIMARY_ADAPTER(padapter); ++ ++ if (!padapter) ++ return; ++ ++ if (_rtw_queue_empty(&padapter->xmitpriv.pending_xmitbuf_queue) == _FALSE) ++ _rtw_up_sema(&pri_adapter->xmitpriv.xmit_sema); ++ ++ ++#else ++ _irqL irqL; ++ struct xmit_priv *pxmitpriv; ++ ++ if (!padapter) ++ return; ++ ++ pxmitpriv = &padapter->xmitpriv; ++ ++ _enter_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ if (rtw_txframes_pending(padapter)) ++ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); ++ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++#endif ++} ++ ++static bool rtw_check_xmit_resource(_adapter *padapter, _pkt *pkt) ++{ ++ bool busy = _FALSE; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ u16 qidx; ++ ++ qidx = skb_get_queue_mapping(pkt); ++ if (rtw_os_need_stop_queue(padapter, qidx)) { ++ if (DBG_DUMP_OS_QUEUE_CTL) ++ RTW_INFO(FUNC_ADPT_FMT": netif_stop_subqueue[%d]\n", FUNC_ADPT_ARG(padapter), qidx); ++ netif_stop_subqueue(padapter->pnetdev, qidx); ++ busy = _TRUE; ++ } ++#else ++ if (rtw_os_need_stop_queue(padapter, 0)) { ++ if (DBG_DUMP_OS_QUEUE_CTL) ++ RTW_INFO(FUNC_ADPT_FMT": netif_stop_queue\n", FUNC_ADPT_ARG(padapter)); ++ rtw_netif_stop_queue(padapter->pnetdev); ++ busy = _TRUE; ++ } ++#endif ++ return busy; ++} ++ ++void rtw_os_wake_queue_at_free_stainfo(_adapter *padapter, int *qcnt_freed) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ int i; ++ ++ for (i = 0; i < 4; i++) { ++ if (qcnt_freed[i] == 0) ++ continue; ++ ++ if (rtw_os_need_wake_queue(padapter, i)) { ++ if (DBG_DUMP_OS_QUEUE_CTL) ++ RTW_INFO(FUNC_ADPT_FMT": netif_wake_subqueue[%d]\n", FUNC_ADPT_ARG(padapter), i); ++ netif_wake_subqueue(padapter->pnetdev, i); ++ } ++ } ++#else ++ if (qcnt_freed[0] || qcnt_freed[1] || qcnt_freed[2] || qcnt_freed[3]) { ++ if (rtw_os_need_wake_queue(padapter, 0)) { ++ if (DBG_DUMP_OS_QUEUE_CTL) ++ RTW_INFO(FUNC_ADPT_FMT": netif_wake_queue\n", FUNC_ADPT_ARG(padapter)); ++ netif_wake_queue(padapter->pnetdev); ++ } ++ } ++#endif ++} ++ ++#ifdef CONFIG_TX_MCAST2UNI ++int rtw_mlcst2unicst(_adapter *padapter, struct sk_buff *skb) ++{ ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ _irqL irqL; ++ _list *phead, *plist; ++ struct sk_buff *newskb; ++ struct sta_info *psta = NULL; ++ u8 chk_alive_num = 0; ++ char chk_alive_list[NUM_STA]; ++ u8 bc_addr[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ u8 null_addr[6] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; ++ ++ int i; ++ s32 res; ++ ++ DBG_COUNTER(padapter->tx_logs.os_tx_m2u); ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ /* free sta asoc_queue */ ++ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ int stainfo_offset; ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ plist = get_next(plist); ++ ++ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); ++ if (stainfo_offset_valid(stainfo_offset)) ++ chk_alive_list[chk_alive_num++] = stainfo_offset; ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ for (i = 0; i < chk_alive_num; i++) { ++ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); ++ if (!(psta->state & _FW_LINKED)) { ++ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_ignore_fw_linked); ++ continue; ++ } ++ ++ /* avoid come from STA1 and send back STA1 */ ++ if (_rtw_memcmp(psta->hwaddr, &skb->data[6], 6) == _TRUE ++ || _rtw_memcmp(psta->hwaddr, null_addr, 6) == _TRUE ++ || _rtw_memcmp(psta->hwaddr, bc_addr, 6) == _TRUE ++ ) { ++ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_ignore_self); ++ continue; ++ } ++ ++ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry); ++ ++ newskb = rtw_skb_copy(skb); ++ ++ if (newskb) { ++ _rtw_memcpy(newskb->data, psta->hwaddr, 6); ++ res = rtw_xmit(padapter, &newskb); ++ if (res < 0) { ++ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry_err_xmit); ++ RTW_INFO("%s()-%d: rtw_xmit() return error! res=%d\n", __FUNCTION__, __LINE__, res); ++ pxmitpriv->tx_drop++; ++ rtw_skb_free(newskb); ++ } ++ } else { ++ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry_err_skb); ++ RTW_INFO("%s-%d: rtw_skb_copy() failed!\n", __FUNCTION__, __LINE__); ++ pxmitpriv->tx_drop++; ++ /* rtw_skb_free(skb); */ ++ return _FALSE; /* Caller shall tx this multicast frame via normal way. */ ++ } ++ } ++ ++ rtw_skb_free(skb); ++ return _TRUE; ++} ++#endif /* CONFIG_TX_MCAST2UNI */ ++ ++ ++int _rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++#ifdef CONFIG_TX_MCAST2UNI ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ extern int rtw_mc2u_disable; ++#endif /* CONFIG_TX_MCAST2UNI */ ++ s32 res = 0; ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ u16 queue; ++#endif ++ ++ ++ if (padapter->registrypriv.mp_mode) { ++ RTW_INFO("MP_TX_DROP_OS_FRAME\n"); ++ goto drop_packet; ++ } ++ DBG_COUNTER(padapter->tx_logs.os_tx); ++ ++ if (rtw_if_up(padapter) == _FALSE) { ++ DBG_COUNTER(padapter->tx_logs.os_tx_err_up); ++ #ifdef DBG_TX_DROP_FRAME ++ RTW_INFO("DBG_TX_DROP_FRAME %s if_up fail\n", __FUNCTION__); ++ #endif ++ goto drop_packet; ++ } ++ ++ rtw_check_xmit_resource(padapter, pkt); ++ ++#ifdef CONFIG_TX_MCAST2UNI ++ if (!rtw_mc2u_disable ++ && check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE ++ && (IP_MCAST_MAC(pkt->data) ++ || ICMPV6_MCAST_MAC(pkt->data) ++ #ifdef CONFIG_TX_BCAST2UNI ++ || is_broadcast_mac_addr(pkt->data) ++ #endif ++ ) ++ && (padapter->registrypriv.wifi_spec == 0) ++ ) { ++ if (pxmitpriv->free_xmitframe_cnt > (NR_XMITFRAME / 4)) { ++ res = rtw_mlcst2unicst(padapter, pkt); ++ if (res == _TRUE) ++ goto exit; ++ } else { ++ /* RTW_INFO("Stop M2U(%d, %d)! ", pxmitpriv->free_xmitframe_cnt, pxmitpriv->free_xmitbuf_cnt); */ ++ /* RTW_INFO("!m2u ); */ ++ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_stop); ++ } ++ } ++#endif /* CONFIG_TX_MCAST2UNI */ ++ ++ res = rtw_xmit(padapter, &pkt); ++ if (res < 0) { ++ #ifdef DBG_TX_DROP_FRAME ++ RTW_INFO("DBG_TX_DROP_FRAME %s rtw_xmit fail\n", __FUNCTION__); ++ #endif ++ goto drop_packet; ++ } ++ ++ goto exit; ++ ++drop_packet: ++ pxmitpriv->tx_drop++; ++ rtw_os_pkt_complete(padapter, pkt); ++ ++exit: ++ ++ ++ return 0; ++} ++ ++int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ int ret = 0; ++ ++ if (pkt) { ++ if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) == _TRUE) { ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) ++ rtw_monitor_xmit_entry((struct sk_buff *)pkt, pnetdev); ++#endif ++ } ++ else { ++ rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, pkt->truesize); ++ ret = _rtw_xmit_entry(pkt, pnetdev); ++ } ++ ++ } ++ ++ return ret; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/osdep_service.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/osdep_service.c +--- linux-4.14.18/3rdparty/rtl8723de/os_dep/osdep_service.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/osdep_service.c 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,2809 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++ ++#define _OSDEP_SERVICE_C_ ++ ++#include ++ ++#define RT_TAG '1178' ++ ++#ifdef DBG_MEMORY_LEAK ++#ifdef PLATFORM_LINUX ++atomic_t _malloc_cnt = ATOMIC_INIT(0); ++atomic_t _malloc_size = ATOMIC_INIT(0); ++#endif ++#endif /* DBG_MEMORY_LEAK */ ++ ++ ++#if defined(PLATFORM_LINUX) ++/* ++* Translate the OS dependent @param error_code to OS independent RTW_STATUS_CODE ++* @return: one of RTW_STATUS_CODE ++*/ ++inline int RTW_STATUS_CODE(int error_code) ++{ ++ if (error_code >= 0) ++ return _SUCCESS; ++ ++ switch (error_code) { ++ /* case -ETIMEDOUT: */ ++ /* return RTW_STATUS_TIMEDOUT; */ ++ default: ++ return _FAIL; ++ } ++} ++#else ++inline int RTW_STATUS_CODE(int error_code) ++{ ++ return error_code; ++} ++#endif ++ ++u32 rtw_atoi(u8 *s) ++{ ++ ++ int num = 0, flag = 0; ++ int i; ++ for (i = 0; i <= strlen(s); i++) { ++ if (s[i] >= '0' && s[i] <= '9') ++ num = num * 10 + s[i] - '0'; ++ else if (s[0] == '-' && i == 0) ++ flag = 1; ++ else ++ break; ++ } ++ ++ if (flag == 1) ++ num = num * -1; ++ ++ return num; ++ ++} ++ ++inline u8 *_rtw_vmalloc(u32 sz) ++{ ++ u8 *pbuf; ++#ifdef PLATFORM_LINUX ++ pbuf = vmalloc(sz); ++#endif ++#ifdef PLATFORM_FREEBSD ++ pbuf = malloc(sz, M_DEVBUF, M_NOWAIT); ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ NdisAllocateMemoryWithTag(&pbuf, sz, RT_TAG); ++#endif ++ ++#ifdef DBG_MEMORY_LEAK ++#ifdef PLATFORM_LINUX ++ if (pbuf != NULL) { ++ atomic_inc(&_malloc_cnt); ++ atomic_add(sz, &_malloc_size); ++ } ++#endif ++#endif /* DBG_MEMORY_LEAK */ ++ ++ return pbuf; ++} ++ ++inline u8 *_rtw_zvmalloc(u32 sz) ++{ ++ u8 *pbuf; ++#ifdef PLATFORM_LINUX ++ pbuf = _rtw_vmalloc(sz); ++ if (pbuf != NULL) ++ memset(pbuf, 0, sz); ++#endif ++#ifdef PLATFORM_FREEBSD ++ pbuf = malloc(sz, M_DEVBUF, M_ZERO | M_NOWAIT); ++#endif ++#ifdef PLATFORM_WINDOWS ++ NdisAllocateMemoryWithTag(&pbuf, sz, RT_TAG); ++ if (pbuf != NULL) ++ NdisFillMemory(pbuf, sz, 0); ++#endif ++ ++ return pbuf; ++} ++ ++inline void _rtw_vmfree(u8 *pbuf, u32 sz) ++{ ++#ifdef PLATFORM_LINUX ++ vfree(pbuf); ++#endif ++#ifdef PLATFORM_FREEBSD ++ free(pbuf, M_DEVBUF); ++#endif ++#ifdef PLATFORM_WINDOWS ++ NdisFreeMemory(pbuf, sz, 0); ++#endif ++ ++#ifdef DBG_MEMORY_LEAK ++#ifdef PLATFORM_LINUX ++ atomic_dec(&_malloc_cnt); ++ atomic_sub(sz, &_malloc_size); ++#endif ++#endif /* DBG_MEMORY_LEAK */ ++} ++ ++u8 *_rtw_malloc(u32 sz) ++{ ++ ++ u8 *pbuf = NULL; ++ ++#ifdef PLATFORM_LINUX ++#ifdef RTK_DMP_PLATFORM ++ if (sz > 0x4000) ++ pbuf = (u8 *)dvr_malloc(sz); ++ else ++#endif ++ pbuf = kmalloc(sz, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ pbuf = malloc(sz, M_DEVBUF, M_NOWAIT); ++#endif ++#ifdef PLATFORM_WINDOWS ++ ++ NdisAllocateMemoryWithTag(&pbuf, sz, RT_TAG); ++ ++#endif ++ ++#ifdef DBG_MEMORY_LEAK ++#ifdef PLATFORM_LINUX ++ if (pbuf != NULL) { ++ atomic_inc(&_malloc_cnt); ++ atomic_add(sz, &_malloc_size); ++ } ++#endif ++#endif /* DBG_MEMORY_LEAK */ ++ ++ return pbuf; ++ ++} ++ ++ ++u8 *_rtw_zmalloc(u32 sz) ++{ ++#ifdef PLATFORM_FREEBSD ++ return malloc(sz, M_DEVBUF, M_ZERO | M_NOWAIT); ++#else /* PLATFORM_FREEBSD */ ++ u8 *pbuf = _rtw_malloc(sz); ++ ++ if (pbuf != NULL) { ++ ++#ifdef PLATFORM_LINUX ++ memset(pbuf, 0, sz); ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ NdisFillMemory(pbuf, sz, 0); ++#endif ++ ++ } ++ ++ return pbuf; ++#endif /* PLATFORM_FREEBSD */ ++} ++ ++void _rtw_mfree(u8 *pbuf, u32 sz) ++{ ++ ++#ifdef PLATFORM_LINUX ++#ifdef RTK_DMP_PLATFORM ++ if (sz > 0x4000) ++ dvr_free(pbuf); ++ else ++#endif ++ kfree(pbuf); ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ free(pbuf, M_DEVBUF); ++#endif ++#ifdef PLATFORM_WINDOWS ++ ++ NdisFreeMemory(pbuf, sz, 0); ++ ++#endif ++ ++#ifdef DBG_MEMORY_LEAK ++#ifdef PLATFORM_LINUX ++ atomic_dec(&_malloc_cnt); ++ atomic_sub(sz, &_malloc_size); ++#endif ++#endif /* DBG_MEMORY_LEAK */ ++ ++} ++ ++#ifdef PLATFORM_FREEBSD ++/* review again */ ++struct sk_buff *dev_alloc_skb(unsigned int size) ++{ ++ struct sk_buff *skb = NULL; ++ u8 *data = NULL; ++ ++ /* skb = (struct sk_buff *)_rtw_zmalloc(sizeof(struct sk_buff)); */ /* for skb->len, etc. */ ++ skb = (struct sk_buff *)_rtw_malloc(sizeof(struct sk_buff)); ++ if (!skb) ++ goto out; ++ data = _rtw_malloc(size); ++ if (!data) ++ goto nodata; ++ ++ skb->head = (unsigned char *)data; ++ skb->data = (unsigned char *)data; ++ skb->tail = (unsigned char *)data; ++ skb->end = (unsigned char *)data + size; ++ skb->len = 0; ++ /* printf("%s()-%d: skb=%p, skb->head = %p\n", __FUNCTION__, __LINE__, skb, skb->head); */ ++ ++out: ++ return skb; ++nodata: ++ _rtw_mfree((u8 *)skb, sizeof(struct sk_buff)); ++ skb = NULL; ++ goto out; ++ ++} ++ ++void dev_kfree_skb_any(struct sk_buff *skb) ++{ ++ /* printf("%s()-%d: skb->head = %p\n", __FUNCTION__, __LINE__, skb->head); */ ++ if (skb->head) ++ _rtw_mfree(skb->head, 0); ++ /* printf("%s()-%d: skb = %p\n", __FUNCTION__, __LINE__, skb); */ ++ if (skb) ++ _rtw_mfree((u8 *)skb, 0); ++} ++struct sk_buff *skb_clone(const struct sk_buff *skb) ++{ ++ return NULL; ++} ++ ++#endif /* PLATFORM_FREEBSD */ ++ ++inline struct sk_buff *_rtw_skb_alloc(u32 sz) ++{ ++#ifdef PLATFORM_LINUX ++ return __dev_alloc_skb(sz, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); ++#endif /* PLATFORM_LINUX */ ++ ++#ifdef PLATFORM_FREEBSD ++ return dev_alloc_skb(sz); ++#endif /* PLATFORM_FREEBSD */ ++} ++ ++inline void _rtw_skb_free(struct sk_buff *skb) ++{ ++ dev_kfree_skb_any(skb); ++} ++ ++inline struct sk_buff *_rtw_skb_copy(const struct sk_buff *skb) ++{ ++#ifdef PLATFORM_LINUX ++ return skb_copy(skb, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); ++#endif /* PLATFORM_LINUX */ ++ ++#ifdef PLATFORM_FREEBSD ++ return NULL; ++#endif /* PLATFORM_FREEBSD */ ++} ++ ++inline struct sk_buff *_rtw_skb_clone(struct sk_buff *skb) ++{ ++#ifdef PLATFORM_LINUX ++ return skb_clone(skb, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); ++#endif /* PLATFORM_LINUX */ ++ ++#ifdef PLATFORM_FREEBSD ++ return skb_clone(skb); ++#endif /* PLATFORM_FREEBSD */ ++} ++inline struct sk_buff *_rtw_pskb_copy(struct sk_buff *skb) ++{ ++#ifdef PLATFORM_LINUX ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) ++ return pskb_copy(skb, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); ++#else ++ return skb_clone(skb, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); ++#endif ++#endif /* PLATFORM_LINUX */ ++ ++#ifdef PLATFORM_FREEBSD ++ return NULL; ++#endif /* PLATFORM_FREEBSD */ ++} ++ ++inline int _rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb) ++{ ++#if defined(PLATFORM_LINUX) ++ skb->dev = ndev; ++ return netif_rx(skb); ++#elif defined(PLATFORM_FREEBSD) ++ return (*ndev->if_input)(ndev, skb); ++#else ++ rtw_warn_on(1); ++ return -1; ++#endif ++} ++ ++#ifdef CONFIG_RTW_NAPI ++inline int _rtw_netif_receive_skb(_nic_hdl ndev, struct sk_buff *skb) ++{ ++#if defined(PLATFORM_LINUX) ++ skb->dev = ndev; ++ return netif_receive_skb(skb); ++#else ++ rtw_warn_on(1); ++ return -1; ++#endif ++} ++ ++#ifdef CONFIG_RTW_GRO ++inline gro_result_t _rtw_napi_gro_receive(struct napi_struct *napi, struct sk_buff *skb) ++{ ++#if defined(PLATFORM_LINUX) ++ return napi_gro_receive(napi, skb); ++#else ++ rtw_warn_on(1); ++ return -1; ++#endif ++} ++#endif /* CONFIG_RTW_GRO */ ++#endif /* CONFIG_RTW_NAPI */ ++ ++void _rtw_skb_queue_purge(struct sk_buff_head *list) ++{ ++ struct sk_buff *skb; ++ ++ while ((skb = skb_dequeue(list)) != NULL) ++ _rtw_skb_free(skb); ++} ++ ++#ifdef CONFIG_USB_HCI ++inline void *_rtw_usb_buffer_alloc(struct usb_device *dev, size_t size, dma_addr_t *dma) ++{ ++#ifdef PLATFORM_LINUX ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ return usb_alloc_coherent(dev, size, (in_interrupt() ? GFP_ATOMIC : GFP_KERNEL), dma); ++#else ++ return usb_buffer_alloc(dev, size, (in_interrupt() ? GFP_ATOMIC : GFP_KERNEL), dma); ++#endif ++#endif /* PLATFORM_LINUX */ ++ ++#ifdef PLATFORM_FREEBSD ++ return malloc(size, M_USBDEV, M_NOWAIT | M_ZERO); ++#endif /* PLATFORM_FREEBSD */ ++} ++inline void _rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dma_addr_t dma) ++{ ++#ifdef PLATFORM_LINUX ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ usb_free_coherent(dev, size, addr, dma); ++#else ++ usb_buffer_free(dev, size, addr, dma); ++#endif ++#endif /* PLATFORM_LINUX */ ++ ++#ifdef PLATFORM_FREEBSD ++ free(addr, M_USBDEV); ++#endif /* PLATFORM_FREEBSD */ ++} ++#endif /* CONFIG_USB_HCI */ ++ ++#if defined(DBG_MEM_ALLOC) ++ ++struct rtw_mem_stat { ++ ATOMIC_T alloc; /* the memory bytes we allocate currently */ ++ ATOMIC_T peak; /* the peak memory bytes we allocate */ ++ ATOMIC_T alloc_cnt; /* the alloc count for alloc currently */ ++ ATOMIC_T alloc_err_cnt; /* the error times we fail to allocate memory */ ++}; ++ ++struct rtw_mem_stat rtw_mem_type_stat[mstat_tf_idx(MSTAT_TYPE_MAX)]; ++#ifdef RTW_MEM_FUNC_STAT ++struct rtw_mem_stat rtw_mem_func_stat[mstat_ff_idx(MSTAT_FUNC_MAX)]; ++#endif ++ ++char *MSTAT_TYPE_str[] = { ++ "VIR", ++ "PHY", ++ "SKB", ++ "USB", ++}; ++ ++#ifdef RTW_MEM_FUNC_STAT ++char *MSTAT_FUNC_str[] = { ++ "UNSP", ++ "IO", ++ "TXIO", ++ "RXIO", ++ "TX", ++ "RX", ++}; ++#endif ++ ++void rtw_mstat_dump(void *sel) ++{ ++ int i; ++ int value_t[4][mstat_tf_idx(MSTAT_TYPE_MAX)]; ++#ifdef RTW_MEM_FUNC_STAT ++ int value_f[4][mstat_ff_idx(MSTAT_FUNC_MAX)]; ++#endif ++ ++ int vir_alloc, vir_peak, vir_alloc_err, phy_alloc, phy_peak, phy_alloc_err; ++ int tx_alloc, tx_peak, tx_alloc_err, rx_alloc, rx_peak, rx_alloc_err; ++ ++ for (i = 0; i < mstat_tf_idx(MSTAT_TYPE_MAX); i++) { ++ value_t[0][i] = ATOMIC_READ(&(rtw_mem_type_stat[i].alloc)); ++ value_t[1][i] = ATOMIC_READ(&(rtw_mem_type_stat[i].peak)); ++ value_t[2][i] = ATOMIC_READ(&(rtw_mem_type_stat[i].alloc_cnt)); ++ value_t[3][i] = ATOMIC_READ(&(rtw_mem_type_stat[i].alloc_err_cnt)); ++ } ++ ++#ifdef RTW_MEM_FUNC_STAT ++ for (i = 0; i < mstat_ff_idx(MSTAT_FUNC_MAX); i++) { ++ value_f[0][i] = ATOMIC_READ(&(rtw_mem_func_stat[i].alloc)); ++ value_f[1][i] = ATOMIC_READ(&(rtw_mem_func_stat[i].peak)); ++ value_f[2][i] = ATOMIC_READ(&(rtw_mem_func_stat[i].alloc_cnt)); ++ value_f[3][i] = ATOMIC_READ(&(rtw_mem_func_stat[i].alloc_err_cnt)); ++ } ++#endif ++ ++ RTW_PRINT_SEL(sel, "===================== MSTAT =====================\n"); ++ RTW_PRINT_SEL(sel, "%4s %10s %10s %10s %10s\n", "TAG", "alloc", "peak", "aloc_cnt", "err_cnt"); ++ RTW_PRINT_SEL(sel, "-------------------------------------------------\n"); ++ for (i = 0; i < mstat_tf_idx(MSTAT_TYPE_MAX); i++) ++ RTW_PRINT_SEL(sel, "%4s %10d %10d %10d %10d\n", MSTAT_TYPE_str[i], value_t[0][i], value_t[1][i], value_t[2][i], value_t[3][i]); ++#ifdef RTW_MEM_FUNC_STAT ++ RTW_PRINT_SEL(sel, "-------------------------------------------------\n"); ++ for (i = 0; i < mstat_ff_idx(MSTAT_FUNC_MAX); i++) ++ RTW_PRINT_SEL(sel, "%4s %10d %10d %10d %10d\n", MSTAT_FUNC_str[i], value_f[0][i], value_f[1][i], value_f[2][i], value_f[3][i]); ++#endif ++} ++ ++void rtw_mstat_update(const enum mstat_f flags, const MSTAT_STATUS status, u32 sz) ++{ ++ static u32 update_time = 0; ++ int peak, alloc; ++ int i; ++ ++ /* initialization */ ++ if (!update_time) { ++ for (i = 0; i < mstat_tf_idx(MSTAT_TYPE_MAX); i++) { ++ ATOMIC_SET(&(rtw_mem_type_stat[i].alloc), 0); ++ ATOMIC_SET(&(rtw_mem_type_stat[i].peak), 0); ++ ATOMIC_SET(&(rtw_mem_type_stat[i].alloc_cnt), 0); ++ ATOMIC_SET(&(rtw_mem_type_stat[i].alloc_err_cnt), 0); ++ } ++ #ifdef RTW_MEM_FUNC_STAT ++ for (i = 0; i < mstat_ff_idx(MSTAT_FUNC_MAX); i++) { ++ ATOMIC_SET(&(rtw_mem_func_stat[i].alloc), 0); ++ ATOMIC_SET(&(rtw_mem_func_stat[i].peak), 0); ++ ATOMIC_SET(&(rtw_mem_func_stat[i].alloc_cnt), 0); ++ ATOMIC_SET(&(rtw_mem_func_stat[i].alloc_err_cnt), 0); ++ } ++ #endif ++ } ++ ++ switch (status) { ++ case MSTAT_ALLOC_SUCCESS: ++ ATOMIC_INC(&(rtw_mem_type_stat[mstat_tf_idx(flags)].alloc_cnt)); ++ alloc = ATOMIC_ADD_RETURN(&(rtw_mem_type_stat[mstat_tf_idx(flags)].alloc), sz); ++ peak = ATOMIC_READ(&(rtw_mem_type_stat[mstat_tf_idx(flags)].peak)); ++ if (peak < alloc) ++ ATOMIC_SET(&(rtw_mem_type_stat[mstat_tf_idx(flags)].peak), alloc); ++ ++ #ifdef RTW_MEM_FUNC_STAT ++ ATOMIC_INC(&(rtw_mem_func_stat[mstat_ff_idx(flags)].alloc_cnt)); ++ alloc = ATOMIC_ADD_RETURN(&(rtw_mem_func_stat[mstat_ff_idx(flags)].alloc), sz); ++ peak = ATOMIC_READ(&(rtw_mem_func_stat[mstat_ff_idx(flags)].peak)); ++ if (peak < alloc) ++ ATOMIC_SET(&(rtw_mem_func_stat[mstat_ff_idx(flags)].peak), alloc); ++ #endif ++ break; ++ ++ case MSTAT_ALLOC_FAIL: ++ ATOMIC_INC(&(rtw_mem_type_stat[mstat_tf_idx(flags)].alloc_err_cnt)); ++ #ifdef RTW_MEM_FUNC_STAT ++ ATOMIC_INC(&(rtw_mem_func_stat[mstat_ff_idx(flags)].alloc_err_cnt)); ++ #endif ++ break; ++ ++ case MSTAT_FREE: ++ ATOMIC_DEC(&(rtw_mem_type_stat[mstat_tf_idx(flags)].alloc_cnt)); ++ ATOMIC_SUB(&(rtw_mem_type_stat[mstat_tf_idx(flags)].alloc), sz); ++ #ifdef RTW_MEM_FUNC_STAT ++ ATOMIC_DEC(&(rtw_mem_func_stat[mstat_ff_idx(flags)].alloc_cnt)); ++ ATOMIC_SUB(&(rtw_mem_func_stat[mstat_ff_idx(flags)].alloc), sz); ++ #endif ++ break; ++ }; ++ ++ /* if (rtw_get_passing_time_ms(update_time) > 5000) { */ ++ /* rtw_mstat_dump(RTW_DBGDUMP); */ ++ update_time = rtw_get_current_time(); ++ /* } */ ++} ++ ++#ifndef SIZE_MAX ++ #define SIZE_MAX (~(size_t)0) ++#endif ++ ++struct mstat_sniff_rule { ++ enum mstat_f flags; ++ size_t lb; ++ size_t hb; ++}; ++ ++struct mstat_sniff_rule mstat_sniff_rules[] = { ++ {MSTAT_TYPE_PHY, 4097, SIZE_MAX}, ++}; ++ ++int mstat_sniff_rule_num = sizeof(mstat_sniff_rules) / sizeof(struct mstat_sniff_rule); ++ ++bool match_mstat_sniff_rules(const enum mstat_f flags, const size_t size) ++{ ++ int i; ++ for (i = 0; i < mstat_sniff_rule_num; i++) { ++ if (mstat_sniff_rules[i].flags == flags ++ && mstat_sniff_rules[i].lb <= size ++ && mstat_sniff_rules[i].hb >= size) ++ return _TRUE; ++ } ++ ++ return _FALSE; ++} ++ ++inline u8 *dbg_rtw_vmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) ++{ ++ u8 *p; ++ ++ if (match_mstat_sniff_rules(flags, sz)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); ++ ++ p = _rtw_vmalloc((sz)); ++ ++ rtw_mstat_update( ++ flags ++ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL ++ , sz ++ ); ++ ++ return p; ++} ++ ++inline u8 *dbg_rtw_zvmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) ++{ ++ u8 *p; ++ ++ if (match_mstat_sniff_rules(flags, sz)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); ++ ++ p = _rtw_zvmalloc((sz)); ++ ++ rtw_mstat_update( ++ flags ++ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL ++ , sz ++ ); ++ ++ return p; ++} ++ ++inline void dbg_rtw_vmfree(u8 *pbuf, u32 sz, const enum mstat_f flags, const char *func, const int line) ++{ ++ ++ if (match_mstat_sniff_rules(flags, sz)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); ++ ++ _rtw_vmfree((pbuf), (sz)); ++ ++ rtw_mstat_update( ++ flags ++ , MSTAT_FREE ++ , sz ++ ); ++} ++ ++inline u8 *dbg_rtw_malloc(u32 sz, const enum mstat_f flags, const char *func, const int line) ++{ ++ u8 *p; ++ ++ if (match_mstat_sniff_rules(flags, sz)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); ++ ++ p = _rtw_malloc((sz)); ++ ++ rtw_mstat_update( ++ flags ++ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL ++ , sz ++ ); ++ ++ return p; ++} ++ ++inline u8 *dbg_rtw_zmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) ++{ ++ u8 *p; ++ ++ if (match_mstat_sniff_rules(flags, sz)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); ++ ++ p = _rtw_zmalloc((sz)); ++ ++ rtw_mstat_update( ++ flags ++ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL ++ , sz ++ ); ++ ++ return p; ++} ++ ++inline void dbg_rtw_mfree(u8 *pbuf, u32 sz, const enum mstat_f flags, const char *func, const int line) ++{ ++ if (match_mstat_sniff_rules(flags, sz)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); ++ ++ _rtw_mfree((pbuf), (sz)); ++ ++ rtw_mstat_update( ++ flags ++ , MSTAT_FREE ++ , sz ++ ); ++} ++ ++inline struct sk_buff *dbg_rtw_skb_alloc(unsigned int size, const enum mstat_f flags, const char *func, int line) ++{ ++ struct sk_buff *skb; ++ unsigned int truesize = 0; ++ ++ skb = _rtw_skb_alloc(size); ++ ++ if (skb) ++ truesize = skb->truesize; ++ ++ if (!skb || truesize < size || match_mstat_sniff_rules(flags, truesize)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d), skb:%p, truesize=%u\n", func, line, __FUNCTION__, size, skb, truesize); ++ ++ rtw_mstat_update( ++ flags ++ , skb ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL ++ , truesize ++ ); ++ ++ return skb; ++} ++ ++inline void dbg_rtw_skb_free(struct sk_buff *skb, const enum mstat_f flags, const char *func, int line) ++{ ++ unsigned int truesize = skb->truesize; ++ ++ if (match_mstat_sniff_rules(flags, truesize)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); ++ ++ _rtw_skb_free(skb); ++ ++ rtw_mstat_update( ++ flags ++ , MSTAT_FREE ++ , truesize ++ ); ++} ++ ++inline struct sk_buff *dbg_rtw_skb_copy(const struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line) ++{ ++ struct sk_buff *skb_cp; ++ unsigned int truesize = skb->truesize; ++ unsigned int cp_truesize = 0; ++ ++ skb_cp = _rtw_skb_copy(skb); ++ if (skb_cp) ++ cp_truesize = skb_cp->truesize; ++ ++ if (!skb_cp || cp_truesize < truesize || match_mstat_sniff_rules(flags, cp_truesize)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%u), skb_cp:%p, cp_truesize=%u\n", func, line, __FUNCTION__, truesize, skb_cp, cp_truesize); ++ ++ rtw_mstat_update( ++ flags ++ , skb_cp ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL ++ , cp_truesize ++ ); ++ ++ return skb_cp; ++} ++ ++inline struct sk_buff *dbg_rtw_skb_clone(struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line) ++{ ++ struct sk_buff *skb_cl; ++ unsigned int truesize = skb->truesize; ++ unsigned int cl_truesize = 0; ++ ++ skb_cl = _rtw_skb_clone(skb); ++ if (skb_cl) ++ cl_truesize = skb_cl->truesize; ++ ++ if (!skb_cl || cl_truesize < truesize || match_mstat_sniff_rules(flags, cl_truesize)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%u), skb_cl:%p, cl_truesize=%u\n", func, line, __FUNCTION__, truesize, skb_cl, cl_truesize); ++ ++ rtw_mstat_update( ++ flags ++ , skb_cl ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL ++ , cl_truesize ++ ); ++ ++ return skb_cl; ++} ++ ++inline int dbg_rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line) ++{ ++ int ret; ++ unsigned int truesize = skb->truesize; ++ ++ if (match_mstat_sniff_rules(flags, truesize)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); ++ ++ ret = _rtw_netif_rx(ndev, skb); ++ ++ rtw_mstat_update( ++ flags ++ , MSTAT_FREE ++ , truesize ++ ); ++ ++ return ret; ++} ++ ++#ifdef CONFIG_RTW_NAPI ++inline int dbg_rtw_netif_receive_skb(_nic_hdl ndev, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line) ++{ ++ int ret; ++ unsigned int truesize = skb->truesize; ++ ++ if (match_mstat_sniff_rules(flags, truesize)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); ++ ++ ret = _rtw_netif_receive_skb(ndev, skb); ++ ++ rtw_mstat_update( ++ flags ++ , MSTAT_FREE ++ , truesize ++ ); ++ ++ return ret; ++} ++ ++#ifdef CONFIG_RTW_GRO ++inline gro_result_t dbg_rtw_napi_gro_receive(struct napi_struct *napi, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line) ++{ ++ int ret; ++ unsigned int truesize = skb->truesize; ++ ++ if (match_mstat_sniff_rules(flags, truesize)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); ++ ++ ret = _rtw_napi_gro_receive(napi, skb); ++ ++ rtw_mstat_update( ++ flags ++ , MSTAT_FREE ++ , truesize ++ ); ++ ++ return ret; ++} ++#endif /* CONFIG_RTW_GRO */ ++#endif /* CONFIG_RTW_NAPI */ ++ ++inline void dbg_rtw_skb_queue_purge(struct sk_buff_head *list, enum mstat_f flags, const char *func, int line) ++{ ++ struct sk_buff *skb; ++ ++ while ((skb = skb_dequeue(list)) != NULL) ++ dbg_rtw_skb_free(skb, flags, func, line); ++} ++ ++#ifdef CONFIG_USB_HCI ++inline void *dbg_rtw_usb_buffer_alloc(struct usb_device *dev, size_t size, dma_addr_t *dma, const enum mstat_f flags, const char *func, int line) ++{ ++ void *p; ++ ++ if (match_mstat_sniff_rules(flags, size)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%zu)\n", func, line, __FUNCTION__, size); ++ ++ p = _rtw_usb_buffer_alloc(dev, size, dma); ++ ++ rtw_mstat_update( ++ flags ++ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL ++ , size ++ ); ++ ++ return p; ++} ++ ++inline void dbg_rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dma_addr_t dma, const enum mstat_f flags, const char *func, int line) ++{ ++ ++ if (match_mstat_sniff_rules(flags, size)) ++ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%zu)\n", func, line, __FUNCTION__, size); ++ ++ _rtw_usb_buffer_free(dev, size, addr, dma); ++ ++ rtw_mstat_update( ++ flags ++ , MSTAT_FREE ++ , size ++ ); ++} ++#endif /* CONFIG_USB_HCI */ ++ ++#endif /* defined(DBG_MEM_ALLOC) */ ++ ++void *rtw_malloc2d(int h, int w, size_t size) ++{ ++ int j; ++ ++ void **a = (void **) rtw_zmalloc(h * sizeof(void *) + h * w * size); ++ if (a == NULL) { ++ RTW_INFO("%s: alloc memory fail!\n", __FUNCTION__); ++ return NULL; ++ } ++ ++ for (j = 0; j < h; j++) ++ a[j] = ((char *)(a + h)) + j * w * size; ++ ++ return a; ++} ++ ++void rtw_mfree2d(void *pbuf, int h, int w, int size) ++{ ++ rtw_mfree((u8 *)pbuf, h * sizeof(void *) + w * h * size); ++} ++ ++void _rtw_memcpy(void *dst, const void *src, u32 sz) ++{ ++ ++#if defined(PLATFORM_LINUX) || defined (PLATFORM_FREEBSD) ++ ++ memcpy(dst, src, sz); ++ ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ ++ NdisMoveMemory(dst, src, sz); ++ ++#endif ++ ++} ++ ++inline void _rtw_memmove(void *dst, const void *src, u32 sz) ++{ ++#if defined(PLATFORM_LINUX) ++ memmove(dst, src, sz); ++#else ++ #warning "no implementation\n" ++#endif ++} ++ ++int _rtw_memcmp(const void *dst, const void *src, u32 sz) ++{ ++ ++#if defined(PLATFORM_LINUX) || defined (PLATFORM_FREEBSD) ++ /* under Linux/GNU/GLibc, the return value of memcmp for two same mem. chunk is 0 */ ++ ++ if (!(memcmp(dst, src, sz))) ++ return _TRUE; ++ else ++ return _FALSE; ++#endif ++ ++ ++#ifdef PLATFORM_WINDOWS ++ /* under Windows, the return value of NdisEqualMemory for two same mem. chunk is 1 */ ++ ++ if (NdisEqualMemory(dst, src, sz)) ++ return _TRUE; ++ else ++ return _FALSE; ++ ++#endif ++ ++ ++ ++} ++ ++void _rtw_memset(void *pbuf, int c, u32 sz) ++{ ++ ++#if defined(PLATFORM_LINUX) || defined (PLATFORM_FREEBSD) ++ ++ memset(pbuf, c, sz); ++ ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++#if 0 ++ NdisZeroMemory(pbuf, sz); ++ if (c != 0) ++ memset(pbuf, c, sz); ++#else ++ NdisFillMemory(pbuf, sz, c); ++#endif ++#endif ++ ++} ++ ++#ifdef PLATFORM_FREEBSD ++static inline void __list_add(_list *pnew, _list *pprev, _list *pnext) ++{ ++ pnext->prev = pnew; ++ pnew->next = pnext; ++ pnew->prev = pprev; ++ pprev->next = pnew; ++} ++#endif /* PLATFORM_FREEBSD */ ++ ++ ++void _rtw_init_listhead(_list *list) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ INIT_LIST_HEAD(list); ++ ++#endif ++ ++#ifdef PLATFORM_FREEBSD ++ list->next = list; ++ list->prev = list; ++#endif ++#ifdef PLATFORM_WINDOWS ++ ++ NdisInitializeListHead(list); ++ ++#endif ++ ++} ++ ++ ++/* ++For the following list_xxx operations, ++caller must guarantee the atomic context. ++Otherwise, there will be racing condition. ++*/ ++u32 rtw_is_list_empty(_list *phead) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ if (list_empty(phead)) ++ return _TRUE; ++ else ++ return _FALSE; ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ ++ if (phead->next == phead) ++ return _TRUE; ++ else ++ return _FALSE; ++ ++#endif ++ ++ ++#ifdef PLATFORM_WINDOWS ++ ++ if (IsListEmpty(phead)) ++ return _TRUE; ++ else ++ return _FALSE; ++ ++#endif ++ ++ ++} ++ ++void rtw_list_insert_head(_list *plist, _list *phead) ++{ ++ ++#ifdef PLATFORM_LINUX ++ list_add(plist, phead); ++#endif ++ ++#ifdef PLATFORM_FREEBSD ++ __list_add(plist, phead, phead->next); ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ InsertHeadList(phead, plist); ++#endif ++} ++ ++void rtw_list_insert_tail(_list *plist, _list *phead) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ list_add_tail(plist, phead); ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ ++ __list_add(plist, phead->prev, phead); ++ ++#endif ++#ifdef PLATFORM_WINDOWS ++ ++ InsertTailList(phead, plist); ++ ++#endif ++ ++} ++ ++void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc) ++{ ++ _adapter *adapter = (_adapter *)padapter; ++ ++#ifdef PLATFORM_LINUX ++ _init_timer(ptimer, adapter->pnetdev, pfunc, adapter); ++#endif ++#ifdef PLATFORM_FREEBSD ++ _init_timer(ptimer, adapter->pifp, pfunc, adapter->mlmepriv.nic_hdl); ++#endif ++#ifdef PLATFORM_WINDOWS ++ _init_timer(ptimer, adapter->hndis_adapter, pfunc, adapter->mlmepriv.nic_hdl); ++#endif ++} ++ ++/* ++ ++Caller must check if the list is empty before calling rtw_list_delete ++ ++*/ ++ ++ ++void _rtw_init_sema(_sema *sema, int init_val) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ sema_init(sema, init_val); ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ sema_init(sema, init_val, "rtw_drv"); ++#endif ++#ifdef PLATFORM_OS_XP ++ ++ KeInitializeSemaphore(sema, init_val, SEMA_UPBND); /* count=0; */ ++ ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ if (*sema == NULL) ++ *sema = CreateSemaphore(NULL, init_val, SEMA_UPBND, NULL); ++#endif ++ ++} ++ ++void _rtw_free_sema(_sema *sema) ++{ ++#ifdef PLATFORM_FREEBSD ++ sema_destroy(sema); ++#endif ++#ifdef PLATFORM_OS_CE ++ CloseHandle(*sema); ++#endif ++ ++} ++ ++void _rtw_up_sema(_sema *sema) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ up(sema); ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ sema_post(sema); ++#endif ++#ifdef PLATFORM_OS_XP ++ ++ KeReleaseSemaphore(sema, IO_NETWORK_INCREMENT, 1, FALSE); ++ ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ ReleaseSemaphore(*sema, 1, NULL); ++#endif ++} ++ ++u32 _rtw_down_sema(_sema *sema) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ if (down_interruptible(sema)) ++ return _FAIL; ++ else ++ return _SUCCESS; ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ sema_wait(sema); ++ return _SUCCESS; ++#endif ++#ifdef PLATFORM_OS_XP ++ ++ if (STATUS_SUCCESS == KeWaitForSingleObject(sema, Executive, KernelMode, TRUE, NULL)) ++ return _SUCCESS; ++ else ++ return _FAIL; ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ if (WAIT_OBJECT_0 == WaitForSingleObject(*sema, INFINITE)) ++ return _SUCCESS; ++ else ++ return _FAIL; ++#endif ++} ++ ++inline void thread_exit(_completion *comp) ++{ ++#ifdef PLATFORM_LINUX ++ complete_and_exit(comp, 0); ++#endif ++ ++#ifdef PLATFORM_FREEBSD ++ printf("%s", "RTKTHREAD_exit"); ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ ExitThread(STATUS_SUCCESS); ++#endif ++ ++#ifdef PLATFORM_OS_XP ++ PsTerminateSystemThread(STATUS_SUCCESS); ++#endif ++} ++ ++inline void _rtw_init_completion(_completion *comp) ++{ ++#ifdef PLATFORM_LINUX ++ init_completion(comp); ++#endif ++} ++inline void _rtw_wait_for_comp_timeout(_completion *comp) ++{ ++#ifdef PLATFORM_LINUX ++ wait_for_completion_timeout(comp, msecs_to_jiffies(3000)); ++#endif ++} ++inline void _rtw_wait_for_comp(_completion *comp) ++{ ++#ifdef PLATFORM_LINUX ++ wait_for_completion(comp); ++#endif ++} ++ ++inline bool rtw_thread_stop(_thread_hdl_ th) ++{ ++#ifdef PLATFORM_LINUX ++ return kthread_stop(th); ++#endif ++} ++ ++inline bool rtw_thread_should_stop(void) ++{ ++#ifdef PLATFORM_LINUX ++ return kthread_should_stop(); ++#endif ++} ++ ++void _rtw_mutex_init(_mutex *pmutex) ++{ ++#ifdef PLATFORM_LINUX ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) ++ mutex_init(pmutex); ++#else ++ init_MUTEX(pmutex); ++#endif ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ mtx_init(pmutex, "", NULL, MTX_DEF | MTX_RECURSE); ++#endif ++#ifdef PLATFORM_OS_XP ++ ++ KeInitializeMutex(pmutex, 0); ++ ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ *pmutex = CreateMutex(NULL, _FALSE, NULL); ++#endif ++} ++ ++void _rtw_mutex_free(_mutex *pmutex); ++void _rtw_mutex_free(_mutex *pmutex) ++{ ++#ifdef PLATFORM_LINUX ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) ++ mutex_destroy(pmutex); ++#else ++#endif ++ ++#ifdef PLATFORM_FREEBSD ++ sema_destroy(pmutex); ++#endif ++ ++#endif ++ ++#ifdef PLATFORM_OS_XP ++ ++#endif ++ ++#ifdef PLATFORM_OS_CE ++ ++#endif ++} ++ ++void _rtw_spinlock_init(_lock *plock) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ spin_lock_init(plock); ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ mtx_init(plock, "", NULL, MTX_DEF | MTX_RECURSE); ++#endif ++#ifdef PLATFORM_WINDOWS ++ ++ NdisAllocateSpinLock(plock); ++ ++#endif ++ ++} ++ ++void _rtw_spinlock_free(_lock *plock) ++{ ++#ifdef PLATFORM_FREEBSD ++ mtx_destroy(plock); ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ ++ NdisFreeSpinLock(plock); ++ ++#endif ++ ++} ++#ifdef PLATFORM_FREEBSD ++extern PADAPTER prtw_lock; ++ ++void rtw_mtx_lock(_lock *plock) ++{ ++ if (prtw_lock) ++ mtx_lock(&prtw_lock->glock); ++ else ++ printf("%s prtw_lock==NULL", __FUNCTION__); ++} ++void rtw_mtx_unlock(_lock *plock) ++{ ++ if (prtw_lock) ++ mtx_unlock(&prtw_lock->glock); ++ else ++ printf("%s prtw_lock==NULL", __FUNCTION__); ++ ++} ++#endif /* PLATFORM_FREEBSD */ ++ ++ ++void _rtw_spinlock(_lock *plock) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ spin_lock(plock); ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ mtx_lock(plock); ++#endif ++#ifdef PLATFORM_WINDOWS ++ ++ NdisAcquireSpinLock(plock); ++ ++#endif ++ ++} ++ ++void _rtw_spinunlock(_lock *plock) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ spin_unlock(plock); ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ mtx_unlock(plock); ++#endif ++#ifdef PLATFORM_WINDOWS ++ ++ NdisReleaseSpinLock(plock); ++ ++#endif ++} ++ ++ ++void _rtw_spinlock_ex(_lock *plock) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ spin_lock(plock); ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ mtx_lock(plock); ++#endif ++#ifdef PLATFORM_WINDOWS ++ ++ NdisDprAcquireSpinLock(plock); ++ ++#endif ++ ++} ++ ++void _rtw_spinunlock_ex(_lock *plock) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ spin_unlock(plock); ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ mtx_unlock(plock); ++#endif ++#ifdef PLATFORM_WINDOWS ++ ++ NdisDprReleaseSpinLock(plock); ++ ++#endif ++} ++ ++ ++ ++void _rtw_init_queue(_queue *pqueue) ++{ ++ _rtw_init_listhead(&(pqueue->queue)); ++ _rtw_spinlock_init(&(pqueue->lock)); ++} ++ ++void _rtw_deinit_queue(_queue *pqueue) ++{ ++ _rtw_spinlock_free(&(pqueue->lock)); ++} ++ ++u32 _rtw_queue_empty(_queue *pqueue) ++{ ++ return rtw_is_list_empty(&(pqueue->queue)); ++} ++ ++ ++u32 rtw_end_of_queue_search(_list *head, _list *plist) ++{ ++ if (head == plist) ++ return _TRUE; ++ else ++ return _FALSE; ++} ++ ++ ++u32 rtw_get_current_time(void) ++{ ++ ++#ifdef PLATFORM_LINUX ++ return jiffies; ++#endif ++#ifdef PLATFORM_FREEBSD ++ struct timeval tvp; ++ getmicrotime(&tvp); ++ return tvp.tv_sec; ++#endif ++#ifdef PLATFORM_WINDOWS ++ LARGE_INTEGER SystemTime; ++ NdisGetCurrentSystemTime(&SystemTime); ++ return (u32)(SystemTime.LowPart);/* count of 100-nanosecond intervals */ ++#endif ++} ++ ++inline u32 rtw_systime_to_ms(u32 systime) ++{ ++#ifdef PLATFORM_LINUX ++ return systime * 1000 / HZ; ++#endif ++#ifdef PLATFORM_FREEBSD ++ return systime * 1000; ++#endif ++#ifdef PLATFORM_WINDOWS ++ return systime / 10000 ; ++#endif ++} ++ ++inline u32 rtw_ms_to_systime(u32 ms) ++{ ++#ifdef PLATFORM_LINUX ++ return ms * HZ / 1000; ++#endif ++#ifdef PLATFORM_FREEBSD ++ return ms / 1000; ++#endif ++#ifdef PLATFORM_WINDOWS ++ return ms * 10000 ; ++#endif ++} ++ ++/* the input parameter start use the same unit as returned by rtw_get_current_time */ ++inline s32 rtw_get_passing_time_ms(u32 start) ++{ ++#ifdef PLATFORM_LINUX ++ return rtw_systime_to_ms(jiffies - start); ++#endif ++#ifdef PLATFORM_FREEBSD ++ return rtw_systime_to_ms(rtw_get_current_time()); ++#endif ++#ifdef PLATFORM_WINDOWS ++ LARGE_INTEGER SystemTime; ++ NdisGetCurrentSystemTime(&SystemTime); ++ return rtw_systime_to_ms((u32)(SystemTime.LowPart) - start) ; ++#endif ++} ++ ++inline s32 rtw_get_time_interval_ms(u32 start, u32 end) ++{ ++#ifdef PLATFORM_LINUX ++ return rtw_systime_to_ms(end - start); ++#endif ++#ifdef PLATFORM_FREEBSD ++ return rtw_systime_to_ms(rtw_get_current_time()); ++#endif ++#ifdef PLATFORM_WINDOWS ++ return rtw_systime_to_ms(end - start); ++#endif ++} ++ ++ ++void rtw_sleep_schedulable(int ms) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ u32 delta; ++ ++ delta = (ms * HZ) / 1000; /* (ms) */ ++ if (delta == 0) { ++ delta = 1;/* 1 ms */ ++ } ++ set_current_state(TASK_INTERRUPTIBLE); ++ if (schedule_timeout(delta) != 0) ++ return ; ++ return; ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ DELAY(ms * 1000); ++ return ; ++#endif ++ ++#ifdef PLATFORM_WINDOWS ++ ++ NdisMSleep(ms * 1000); /* (us)*1000=(ms) */ ++ ++#endif ++ ++} ++ ++ ++void rtw_msleep_os(int ms) ++{ ++ ++#ifdef PLATFORM_LINUX ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) ++ if (ms < 20) { ++ unsigned long us = ms * 1000UL; ++ usleep_range(us, us + 1000UL); ++ } else ++#endif ++ msleep((unsigned int)ms); ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ /* Delay for delay microseconds */ ++ DELAY(ms * 1000); ++ return ; ++#endif ++#ifdef PLATFORM_WINDOWS ++ ++ NdisMSleep(ms * 1000); /* (us)*1000=(ms) */ ++ ++#endif ++ ++ ++} ++void rtw_usleep_os(int us) ++{ ++#ifdef PLATFORM_LINUX ++ ++ /* msleep((unsigned int)us); */ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) ++ usleep_range(us, us + 1); ++#else ++ if (1 < (us / 1000)) ++ msleep(1); ++ else ++ msleep((us / 1000) + 1); ++#endif ++#endif ++ ++#ifdef PLATFORM_FREEBSD ++ /* Delay for delay microseconds */ ++ DELAY(us); ++ ++ return ; ++#endif ++#ifdef PLATFORM_WINDOWS ++ ++ NdisMSleep(us); /* (us) */ ++ ++#endif ++ ++ ++} ++ ++ ++#ifdef DBG_DELAY_OS ++void _rtw_mdelay_os(int ms, const char *func, const int line) ++{ ++#if 0 ++ if (ms > 10) ++ RTW_INFO("%s:%d %s(%d)\n", func, line, __FUNCTION__, ms); ++ rtw_msleep_os(ms); ++ return; ++#endif ++ ++ ++ RTW_INFO("%s:%d %s(%d)\n", func, line, __FUNCTION__, ms); ++ ++#if defined(PLATFORM_LINUX) ++ ++ mdelay((unsigned long)ms); ++ ++#elif defined(PLATFORM_WINDOWS) ++ ++ NdisStallExecution(ms * 1000); /* (us)*1000=(ms) */ ++ ++#endif ++ ++ ++} ++void _rtw_udelay_os(int us, const char *func, const int line) ++{ ++ ++#if 0 ++ if (us > 1000) { ++ RTW_INFO("%s:%d %s(%d)\n", func, line, __FUNCTION__, us); ++ rtw_usleep_os(us); ++ return; ++ } ++#endif ++ ++ ++ RTW_INFO("%s:%d %s(%d)\n", func, line, __FUNCTION__, us); ++ ++ ++#if defined(PLATFORM_LINUX) ++ ++ udelay((unsigned long)us); ++ ++#elif defined(PLATFORM_WINDOWS) ++ ++ NdisStallExecution(us); /* (us) */ ++ ++#endif ++ ++} ++#else ++void rtw_mdelay_os(int ms) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ mdelay((unsigned long)ms); ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ DELAY(ms * 1000); ++ return ; ++#endif ++#ifdef PLATFORM_WINDOWS ++ ++ NdisStallExecution(ms * 1000); /* (us)*1000=(ms) */ ++ ++#endif ++ ++ ++} ++void rtw_udelay_os(int us) ++{ ++ ++#ifdef PLATFORM_LINUX ++ ++ udelay((unsigned long)us); ++ ++#endif ++#ifdef PLATFORM_FREEBSD ++ /* Delay for delay microseconds */ ++ DELAY(us); ++ return ; ++#endif ++#ifdef PLATFORM_WINDOWS ++ ++ NdisStallExecution(us); /* (us) */ ++ ++#endif ++ ++} ++#endif ++ ++void rtw_yield_os(void) ++{ ++#ifdef PLATFORM_LINUX ++ yield(); ++#endif ++#ifdef PLATFORM_FREEBSD ++ yield(); ++#endif ++#ifdef PLATFORM_WINDOWS ++ SwitchToThread(); ++#endif ++} ++ ++#define RTW_SUSPEND_LOCK_NAME "rtw_wifi" ++#define RTW_SUSPEND_EXT_LOCK_NAME "rtw_wifi_ext" ++#define RTW_SUSPEND_RX_LOCK_NAME "rtw_wifi_rx" ++#define RTW_SUSPEND_TRAFFIC_LOCK_NAME "rtw_wifi_traffic" ++#define RTW_SUSPEND_RESUME_LOCK_NAME "rtw_wifi_resume" ++#define RTW_RESUME_SCAN_LOCK_NAME "rtw_wifi_scan" ++#ifdef CONFIG_WAKELOCK ++static struct wake_lock rtw_suspend_lock; ++static struct wake_lock rtw_suspend_ext_lock; ++static struct wake_lock rtw_suspend_rx_lock; ++static struct wake_lock rtw_suspend_traffic_lock; ++static struct wake_lock rtw_suspend_resume_lock; ++static struct wake_lock rtw_resume_scan_lock; ++#elif defined(CONFIG_ANDROID_POWER) ++static android_suspend_lock_t rtw_suspend_lock = { ++ .name = RTW_SUSPEND_LOCK_NAME ++}; ++static android_suspend_lock_t rtw_suspend_ext_lock = { ++ .name = RTW_SUSPEND_EXT_LOCK_NAME ++}; ++static android_suspend_lock_t rtw_suspend_rx_lock = { ++ .name = RTW_SUSPEND_RX_LOCK_NAME ++}; ++static android_suspend_lock_t rtw_suspend_traffic_lock = { ++ .name = RTW_SUSPEND_TRAFFIC_LOCK_NAME ++}; ++static android_suspend_lock_t rtw_suspend_resume_lock = { ++ .name = RTW_SUSPEND_RESUME_LOCK_NAME ++}; ++static android_suspend_lock_t rtw_resume_scan_lock = { ++ .name = RTW_RESUME_SCAN_LOCK_NAME ++}; ++#endif ++ ++inline void rtw_suspend_lock_init(void) ++{ ++#ifdef CONFIG_WAKELOCK ++ wake_lock_init(&rtw_suspend_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_LOCK_NAME); ++ wake_lock_init(&rtw_suspend_ext_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_EXT_LOCK_NAME); ++ wake_lock_init(&rtw_suspend_rx_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_RX_LOCK_NAME); ++ wake_lock_init(&rtw_suspend_traffic_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_TRAFFIC_LOCK_NAME); ++ wake_lock_init(&rtw_suspend_resume_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_RESUME_LOCK_NAME); ++ wake_lock_init(&rtw_resume_scan_lock, WAKE_LOCK_SUSPEND, RTW_RESUME_SCAN_LOCK_NAME); ++#elif defined(CONFIG_ANDROID_POWER) ++ android_init_suspend_lock(&rtw_suspend_lock); ++ android_init_suspend_lock(&rtw_suspend_ext_lock); ++ android_init_suspend_lock(&rtw_suspend_rx_lock); ++ android_init_suspend_lock(&rtw_suspend_traffic_lock); ++ android_init_suspend_lock(&rtw_suspend_resume_lock); ++ android_init_suspend_lock(&rtw_resume_scan_lock); ++#endif ++} ++ ++inline void rtw_suspend_lock_uninit(void) ++{ ++#ifdef CONFIG_WAKELOCK ++ wake_lock_destroy(&rtw_suspend_lock); ++ wake_lock_destroy(&rtw_suspend_ext_lock); ++ wake_lock_destroy(&rtw_suspend_rx_lock); ++ wake_lock_destroy(&rtw_suspend_traffic_lock); ++ wake_lock_destroy(&rtw_suspend_resume_lock); ++ wake_lock_destroy(&rtw_resume_scan_lock); ++#elif defined(CONFIG_ANDROID_POWER) ++ android_uninit_suspend_lock(&rtw_suspend_lock); ++ android_uninit_suspend_lock(&rtw_suspend_ext_lock); ++ android_uninit_suspend_lock(&rtw_suspend_rx_lock); ++ android_uninit_suspend_lock(&rtw_suspend_traffic_lock); ++ android_uninit_suspend_lock(&rtw_suspend_resume_lock); ++ android_uninit_suspend_lock(&rtw_resume_scan_lock); ++#endif ++} ++ ++inline void rtw_lock_suspend(void) ++{ ++#ifdef CONFIG_WAKELOCK ++ wake_lock(&rtw_suspend_lock); ++#elif defined(CONFIG_ANDROID_POWER) ++ android_lock_suspend(&rtw_suspend_lock); ++#endif ++ ++#if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) ++ /* RTW_INFO("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); */ ++#endif ++} ++ ++inline void rtw_unlock_suspend(void) ++{ ++#ifdef CONFIG_WAKELOCK ++ wake_unlock(&rtw_suspend_lock); ++#elif defined(CONFIG_ANDROID_POWER) ++ android_unlock_suspend(&rtw_suspend_lock); ++#endif ++ ++#if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) ++ /* RTW_INFO("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); */ ++#endif ++} ++ ++inline void rtw_resume_lock_suspend(void) ++{ ++#ifdef CONFIG_WAKELOCK ++ wake_lock(&rtw_suspend_resume_lock); ++#elif defined(CONFIG_ANDROID_POWER) ++ android_lock_suspend(&rtw_suspend_resume_lock); ++#endif ++ ++#if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) ++ /* RTW_INFO("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); */ ++#endif ++} ++ ++inline void rtw_resume_unlock_suspend(void) ++{ ++#ifdef CONFIG_WAKELOCK ++ wake_unlock(&rtw_suspend_resume_lock); ++#elif defined(CONFIG_ANDROID_POWER) ++ android_unlock_suspend(&rtw_suspend_resume_lock); ++#endif ++ ++#if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) ++ /* RTW_INFO("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); */ ++#endif ++} ++ ++inline void rtw_lock_suspend_timeout(u32 timeout_ms) ++{ ++#ifdef CONFIG_WAKELOCK ++ wake_lock_timeout(&rtw_suspend_lock, rtw_ms_to_systime(timeout_ms)); ++#elif defined(CONFIG_ANDROID_POWER) ++ android_lock_suspend_auto_expire(&rtw_suspend_lock, rtw_ms_to_systime(timeout_ms)); ++#endif ++} ++ ++inline void rtw_lock_ext_suspend_timeout(u32 timeout_ms) ++{ ++#ifdef CONFIG_WAKELOCK ++ wake_lock_timeout(&rtw_suspend_ext_lock, rtw_ms_to_systime(timeout_ms)); ++#elif defined(CONFIG_ANDROID_POWER) ++ android_lock_suspend_auto_expire(&rtw_suspend_ext_lock, rtw_ms_to_systime(timeout_ms)); ++#endif ++ /* RTW_INFO("EXT lock timeout:%d\n", timeout_ms); */ ++} ++ ++inline void rtw_lock_rx_suspend_timeout(u32 timeout_ms) ++{ ++#ifdef CONFIG_WAKELOCK ++ wake_lock_timeout(&rtw_suspend_rx_lock, rtw_ms_to_systime(timeout_ms)); ++#elif defined(CONFIG_ANDROID_POWER) ++ android_lock_suspend_auto_expire(&rtw_suspend_rx_lock, rtw_ms_to_systime(timeout_ms)); ++#endif ++ /* RTW_INFO("RX lock timeout:%d\n", timeout_ms); */ ++} ++ ++ ++inline void rtw_lock_traffic_suspend_timeout(u32 timeout_ms) ++{ ++#ifdef CONFIG_WAKELOCK ++ wake_lock_timeout(&rtw_suspend_traffic_lock, rtw_ms_to_systime(timeout_ms)); ++#elif defined(CONFIG_ANDROID_POWER) ++ android_lock_suspend_auto_expire(&rtw_suspend_traffic_lock, rtw_ms_to_systime(timeout_ms)); ++#endif ++ /* RTW_INFO("traffic lock timeout:%d\n", timeout_ms); */ ++} ++ ++inline void rtw_lock_resume_scan_timeout(u32 timeout_ms) ++{ ++#ifdef CONFIG_WAKELOCK ++ wake_lock_timeout(&rtw_resume_scan_lock, rtw_ms_to_systime(timeout_ms)); ++#elif defined(CONFIG_ANDROID_POWER) ++ android_lock_suspend_auto_expire(&rtw_resume_scan_lock, rtw_ms_to_systime(timeout_ms)); ++#endif ++ /* RTW_INFO("resume scan lock:%d\n", timeout_ms); */ ++} ++ ++inline void ATOMIC_SET(ATOMIC_T *v, int i) ++{ ++#ifdef PLATFORM_LINUX ++ atomic_set(v, i); ++#elif defined(PLATFORM_WINDOWS) ++ *v = i; /* other choice???? */ ++#elif defined(PLATFORM_FREEBSD) ++ atomic_set_int(v, i); ++#endif ++} ++ ++inline int ATOMIC_READ(ATOMIC_T *v) ++{ ++#ifdef PLATFORM_LINUX ++ return atomic_read(v); ++#elif defined(PLATFORM_WINDOWS) ++ return *v; /* other choice???? */ ++#elif defined(PLATFORM_FREEBSD) ++ return atomic_load_acq_32(v); ++#endif ++} ++ ++inline void ATOMIC_ADD(ATOMIC_T *v, int i) ++{ ++#ifdef PLATFORM_LINUX ++ atomic_add(i, v); ++#elif defined(PLATFORM_WINDOWS) ++ InterlockedAdd(v, i); ++#elif defined(PLATFORM_FREEBSD) ++ atomic_add_int(v, i); ++#endif ++} ++inline void ATOMIC_SUB(ATOMIC_T *v, int i) ++{ ++#ifdef PLATFORM_LINUX ++ atomic_sub(i, v); ++#elif defined(PLATFORM_WINDOWS) ++ InterlockedAdd(v, -i); ++#elif defined(PLATFORM_FREEBSD) ++ atomic_subtract_int(v, i); ++#endif ++} ++ ++inline void ATOMIC_INC(ATOMIC_T *v) ++{ ++#ifdef PLATFORM_LINUX ++ atomic_inc(v); ++#elif defined(PLATFORM_WINDOWS) ++ InterlockedIncrement(v); ++#elif defined(PLATFORM_FREEBSD) ++ atomic_add_int(v, 1); ++#endif ++} ++ ++inline void ATOMIC_DEC(ATOMIC_T *v) ++{ ++#ifdef PLATFORM_LINUX ++ atomic_dec(v); ++#elif defined(PLATFORM_WINDOWS) ++ InterlockedDecrement(v); ++#elif defined(PLATFORM_FREEBSD) ++ atomic_subtract_int(v, 1); ++#endif ++} ++ ++inline int ATOMIC_ADD_RETURN(ATOMIC_T *v, int i) ++{ ++#ifdef PLATFORM_LINUX ++ return atomic_add_return(i, v); ++#elif defined(PLATFORM_WINDOWS) ++ return InterlockedAdd(v, i); ++#elif defined(PLATFORM_FREEBSD) ++ atomic_add_int(v, i); ++ return atomic_load_acq_32(v); ++#endif ++} ++ ++inline int ATOMIC_SUB_RETURN(ATOMIC_T *v, int i) ++{ ++#ifdef PLATFORM_LINUX ++ return atomic_sub_return(i, v); ++#elif defined(PLATFORM_WINDOWS) ++ return InterlockedAdd(v, -i); ++#elif defined(PLATFORM_FREEBSD) ++ atomic_subtract_int(v, i); ++ return atomic_load_acq_32(v); ++#endif ++} ++ ++inline int ATOMIC_INC_RETURN(ATOMIC_T *v) ++{ ++#ifdef PLATFORM_LINUX ++ return atomic_inc_return(v); ++#elif defined(PLATFORM_WINDOWS) ++ return InterlockedIncrement(v); ++#elif defined(PLATFORM_FREEBSD) ++ atomic_add_int(v, 1); ++ return atomic_load_acq_32(v); ++#endif ++} ++ ++inline int ATOMIC_DEC_RETURN(ATOMIC_T *v) ++{ ++#ifdef PLATFORM_LINUX ++ return atomic_dec_return(v); ++#elif defined(PLATFORM_WINDOWS) ++ return InterlockedDecrement(v); ++#elif defined(PLATFORM_FREEBSD) ++ atomic_subtract_int(v, 1); ++ return atomic_load_acq_32(v); ++#endif ++} ++ ++ ++#ifdef PLATFORM_LINUX ++/* ++* Open a file with the specific @param path, @param flag, @param mode ++* @param fpp the pointer of struct file pointer to get struct file pointer while file opening is success ++* @param path the path of the file to open ++* @param flag file operation flags, please refer to linux document ++* @param mode please refer to linux document ++* @return Linux specific error code ++*/ ++static int openFile(struct file **fpp, const char *path, int flag, int mode) ++{ ++ struct file *fp; ++ ++ fp = filp_open(path, flag, mode); ++ if (IS_ERR(fp)) { ++ *fpp = NULL; ++ return PTR_ERR(fp); ++ } else { ++ *fpp = fp; ++ return 0; ++ } ++} ++ ++/* ++* Close the file with the specific @param fp ++* @param fp the pointer of struct file to close ++* @return always 0 ++*/ ++static int closeFile(struct file *fp) ++{ ++ filp_close(fp, NULL); ++ return 0; ++} ++ ++static int readFile(struct file *fp, char *buf, int len) ++{ ++ int rlen = 0, sum = 0; ++ ++ if (!fp->f_op || !fp->f_op->read) ++ return -EPERM; ++ ++ while (sum < len) { ++ rlen = fp->f_op->read(fp, buf + sum, len - sum, &fp->f_pos); ++ if (rlen > 0) ++ sum += rlen; ++ else if (0 != rlen) ++ return rlen; ++ else ++ break; ++ } ++ ++ return sum; ++ ++} ++ ++static int writeFile(struct file *fp, char *buf, int len) ++{ ++ int wlen = 0, sum = 0; ++ ++ if (!fp->f_op || !fp->f_op->write) ++ return -EPERM; ++ ++ while (sum < len) { ++ wlen = fp->f_op->write(fp, buf + sum, len - sum, &fp->f_pos); ++ if (wlen > 0) ++ sum += wlen; ++ else if (0 != wlen) ++ return wlen; ++ else ++ break; ++ } ++ ++ return sum; ++ ++} ++ ++/* ++* Test if the specifi @param path is a file and readable ++* If readable, @param sz is got ++* @param path the path of the file to test ++* @return Linux specific error code ++*/ ++static int isFileReadable(const char *path, u32 *sz) ++{ ++ struct file *fp; ++ int ret = 0; ++ mm_segment_t oldfs; ++ char buf; ++ ++ fp = filp_open(path, O_RDONLY, 0); ++ if (IS_ERR(fp)) ++ ret = PTR_ERR(fp); ++ else { ++ oldfs = get_fs(); ++ set_fs(get_ds()); ++ ++ if (1 != readFile(fp, &buf, 1)) ++ ret = PTR_ERR(fp); ++ ++ if (ret == 0 && sz) { ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) ++ *sz = i_size_read(fp->f_path.dentry->d_inode); ++ #else ++ *sz = i_size_read(fp->f_dentry->d_inode); ++ #endif ++ } ++ ++ set_fs(oldfs); ++ filp_close(fp, NULL); ++ } ++ return ret; ++} ++ ++/* ++* Open the file with @param path and retrive the file content into memory starting from @param buf for @param sz at most ++* @param path the path of the file to open and read ++* @param buf the starting address of the buffer to store file content ++* @param sz how many bytes to read at most ++* @return the byte we've read, or Linux specific error code ++*/ ++static int retriveFromFile(const char *path, u8 *buf, u32 sz) ++{ ++ int ret = -1; ++ mm_segment_t oldfs; ++ struct file *fp; ++ ++ if (path && buf) { ++ ret = openFile(&fp, path, O_RDONLY, 0); ++ if (0 == ret) { ++ RTW_INFO("%s openFile path:%s fp=%p\n", __FUNCTION__, path , fp); ++ ++ oldfs = get_fs(); ++ set_fs(get_ds()); ++ ret = readFile(fp, buf, sz); ++ set_fs(oldfs); ++ closeFile(fp); ++ ++ RTW_INFO("%s readFile, ret:%d\n", __FUNCTION__, ret); ++ ++ } else ++ RTW_INFO("%s openFile path:%s Fail, ret:%d\n", __FUNCTION__, path, ret); ++ } else { ++ RTW_INFO("%s NULL pointer\n", __FUNCTION__); ++ ret = -EINVAL; ++ } ++ return ret; ++} ++ ++/* ++* Open the file with @param path and wirte @param sz byte of data starting from @param buf into the file ++* @param path the path of the file to open and write ++* @param buf the starting address of the data to write into file ++* @param sz how many bytes to write at most ++* @return the byte we've written, or Linux specific error code ++*/ ++static int storeToFile(const char *path, u8 *buf, u32 sz) ++{ ++ int ret = 0; ++ mm_segment_t oldfs; ++ struct file *fp; ++ ++ if (path && buf) { ++ ret = openFile(&fp, path, O_CREAT | O_WRONLY, 0666); ++ if (0 == ret) { ++ RTW_INFO("%s openFile path:%s fp=%p\n", __FUNCTION__, path , fp); ++ ++ oldfs = get_fs(); ++ set_fs(get_ds()); ++ ret = writeFile(fp, buf, sz); ++ set_fs(oldfs); ++ closeFile(fp); ++ ++ RTW_INFO("%s writeFile, ret:%d\n", __FUNCTION__, ret); ++ ++ } else ++ RTW_INFO("%s openFile path:%s Fail, ret:%d\n", __FUNCTION__, path, ret); ++ } else { ++ RTW_INFO("%s NULL pointer\n", __FUNCTION__); ++ ret = -EINVAL; ++ } ++ return ret; ++} ++#endif /* PLATFORM_LINUX */ ++ ++/* ++* Test if the specifi @param path is a file and readable ++* @param path the path of the file to test ++* @return _TRUE or _FALSE ++*/ ++int rtw_is_file_readable(const char *path) ++{ ++#ifdef PLATFORM_LINUX ++ if (isFileReadable(path, NULL) == 0) ++ return _TRUE; ++ else ++ return _FALSE; ++#else ++ /* Todo... */ ++ return _FALSE; ++#endif ++} ++ ++/* ++* Test if the specifi @param path is a file and readable. ++* If readable, @param sz is got ++* @param path the path of the file to test ++* @return _TRUE or _FALSE ++*/ ++int rtw_is_file_readable_with_size(const char *path, u32 *sz) ++{ ++#ifdef PLATFORM_LINUX ++ if (isFileReadable(path, sz) == 0) ++ return _TRUE; ++ else ++ return _FALSE; ++#else ++ /* Todo... */ ++ return _FALSE; ++#endif ++} ++ ++/* ++* Open the file with @param path and retrive the file content into memory starting from @param buf for @param sz at most ++* @param path the path of the file to open and read ++* @param buf the starting address of the buffer to store file content ++* @param sz how many bytes to read at most ++* @return the byte we've read ++*/ ++int rtw_retrieve_from_file(const char *path, u8 *buf, u32 sz) ++{ ++#ifdef PLATFORM_LINUX ++ int ret = retriveFromFile(path, buf, sz); ++ return ret >= 0 ? ret : 0; ++#else ++ /* Todo... */ ++ return 0; ++#endif ++} ++ ++/* ++* Open the file with @param path and wirte @param sz byte of data starting from @param buf into the file ++* @param path the path of the file to open and write ++* @param buf the starting address of the data to write into file ++* @param sz how many bytes to write at most ++* @return the byte we've written ++*/ ++int rtw_store_to_file(const char *path, u8 *buf, u32 sz) ++{ ++#ifdef PLATFORM_LINUX ++ int ret = storeToFile(path, buf, sz); ++ return ret >= 0 ? ret : 0; ++#else ++ /* Todo... */ ++ return 0; ++#endif ++} ++ ++#ifdef PLATFORM_LINUX ++struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv) ++{ ++ struct net_device *pnetdev; ++ struct rtw_netdev_priv_indicator *pnpi; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ pnetdev = alloc_etherdev_mq(sizeof(struct rtw_netdev_priv_indicator), 4); ++#else ++ pnetdev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); ++#endif ++ if (!pnetdev) ++ goto RETURN; ++ ++ pnpi = netdev_priv(pnetdev); ++ pnpi->priv = old_priv; ++ pnpi->sizeof_priv = sizeof_priv; ++ ++RETURN: ++ return pnetdev; ++} ++ ++struct net_device *rtw_alloc_etherdev(int sizeof_priv) ++{ ++ struct net_device *pnetdev; ++ struct rtw_netdev_priv_indicator *pnpi; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) ++ pnetdev = alloc_etherdev_mq(sizeof(struct rtw_netdev_priv_indicator), 4); ++#else ++ pnetdev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); ++#endif ++ if (!pnetdev) ++ goto RETURN; ++ ++ pnpi = netdev_priv(pnetdev); ++ ++ pnpi->priv = rtw_zvmalloc(sizeof_priv); ++ if (!pnpi->priv) { ++ free_netdev(pnetdev); ++ pnetdev = NULL; ++ goto RETURN; ++ } ++ ++ pnpi->sizeof_priv = sizeof_priv; ++RETURN: ++ return pnetdev; ++} ++ ++void rtw_free_netdev(struct net_device *netdev) ++{ ++ struct rtw_netdev_priv_indicator *pnpi; ++ ++ if (!netdev) ++ goto RETURN; ++ ++ pnpi = netdev_priv(netdev); ++ ++ if (!pnpi->priv) ++ goto RETURN; ++ ++ free_netdev(netdev); ++ ++RETURN: ++ return; ++} ++ ++int rtw_change_ifname(_adapter *padapter, const char *ifname) ++{ ++ struct dvobj_priv *dvobj; ++ struct net_device *pnetdev; ++ struct net_device *cur_pnetdev; ++ struct rereg_nd_name_data *rereg_priv; ++ int ret; ++ u8 rtnl_lock_needed; ++ ++ if (!padapter) ++ goto error; ++ ++ dvobj = adapter_to_dvobj(padapter); ++ cur_pnetdev = padapter->pnetdev; ++ rereg_priv = &padapter->rereg_nd_name_priv; ++ ++ /* free the old_pnetdev */ ++ if (rereg_priv->old_pnetdev) { ++ free_netdev(rereg_priv->old_pnetdev); ++ rereg_priv->old_pnetdev = NULL; ++ } ++ ++ rtnl_lock_needed = rtw_rtnl_lock_needed(dvobj); ++ ++ if (rtnl_lock_needed) ++ unregister_netdev(cur_pnetdev); ++ else ++ unregister_netdevice(cur_pnetdev); ++ ++ rereg_priv->old_pnetdev = cur_pnetdev; ++ ++ pnetdev = rtw_init_netdev(padapter); ++ if (!pnetdev) { ++ ret = -1; ++ goto error; ++ } ++ ++ SET_NETDEV_DEV(pnetdev, dvobj_to_dev(adapter_to_dvobj(padapter))); ++ ++ rtw_init_netdev_name(pnetdev, ifname); ++ ++ _rtw_memcpy(pnetdev->dev_addr, adapter_mac_addr(padapter), ETH_ALEN); ++ ++ if (rtnl_lock_needed) ++ ret = register_netdev(pnetdev); ++ else ++ ret = register_netdevice(pnetdev); ++ ++ if (ret != 0) { ++ goto error; ++ } ++ ++ return 0; ++ ++error: ++ ++ return -1; ++ ++} ++#endif ++ ++#ifdef PLATFORM_FREEBSD ++/* ++ * Copy a buffer from userspace and write into kernel address ++ * space. ++ * ++ * This emulation just calls the FreeBSD copyin function (to ++ * copy data from user space buffer into a kernel space buffer) ++ * and is designed to be used with the above io_write_wrapper. ++ * ++ * This function should return the number of bytes not copied. ++ * I.e. success results in a zero value. ++ * Negative error values are not returned. ++ */ ++unsigned long ++copy_from_user(void *to, const void *from, unsigned long n) ++{ ++ if (copyin(from, to, n) != 0) { ++ /* Any errors will be treated as a failure ++ to copy any of the requested bytes */ ++ return n; ++ } ++ ++ return 0; ++} ++ ++unsigned long ++copy_to_user(void *to, const void *from, unsigned long n) ++{ ++ if (copyout(from, to, n) != 0) { ++ /* Any errors will be treated as a failure ++ to copy any of the requested bytes */ ++ return n; ++ } ++ ++ return 0; ++} ++ ++ ++/* ++ * The usb_register and usb_deregister functions are used to register ++ * usb drivers with the usb subsystem. In this compatibility layer ++ * emulation a list of drivers (struct usb_driver) is maintained ++ * and is used for probing/attaching etc. ++ * ++ * usb_register and usb_deregister simply call these functions. ++ */ ++int ++usb_register(struct usb_driver *driver) ++{ ++ rtw_usb_linux_register(driver); ++ return 0; ++} ++ ++ ++int ++usb_deregister(struct usb_driver *driver) ++{ ++ rtw_usb_linux_deregister(driver); ++ return 0; ++} ++ ++void module_init_exit_wrapper(void *arg) ++{ ++ int (*func)(void) = arg; ++ func(); ++ return; ++} ++ ++#endif /* PLATFORM_FREEBSD */ ++ ++#ifdef CONFIG_PLATFORM_SPRD ++ #ifdef do_div ++ #undef do_div ++ #endif ++ #include ++#endif ++ ++u64 rtw_modular64(u64 x, u64 y) ++{ ++#ifdef PLATFORM_LINUX ++ return do_div(x, y); ++#elif defined(PLATFORM_WINDOWS) ++ return x % y; ++#elif defined(PLATFORM_FREEBSD) ++ return x % y; ++#endif ++} ++ ++u64 rtw_division64(u64 x, u64 y) ++{ ++#ifdef PLATFORM_LINUX ++ do_div(x, y); ++ return x; ++#elif defined(PLATFORM_WINDOWS) ++ return x / y; ++#elif defined(PLATFORM_FREEBSD) ++ return x / y; ++#endif ++} ++ ++inline u32 rtw_random32(void) ++{ ++#ifdef PLATFORM_LINUX ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) ++ return prandom_u32(); ++#elif (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 18)) ++ u32 random_int; ++ get_random_bytes(&random_int , 4); ++ return random_int; ++#else ++ return random32(); ++#endif ++#elif defined(PLATFORM_WINDOWS) ++#error "to be implemented\n" ++#elif defined(PLATFORM_FREEBSD) ++#error "to be implemented\n" ++#endif ++} ++ ++void rtw_buf_free(u8 **buf, u32 *buf_len) ++{ ++ u32 ori_len; ++ ++ if (!buf || !buf_len) ++ return; ++ ++ ori_len = *buf_len; ++ ++ if (*buf) { ++ u32 tmp_buf_len = *buf_len; ++ *buf_len = 0; ++ rtw_mfree(*buf, tmp_buf_len); ++ *buf = NULL; ++ } ++} ++ ++void rtw_buf_update(u8 **buf, u32 *buf_len, u8 *src, u32 src_len) ++{ ++ u32 ori_len = 0, dup_len = 0; ++ u8 *ori = NULL; ++ u8 *dup = NULL; ++ ++ if (!buf || !buf_len) ++ return; ++ ++ if (!src || !src_len) ++ goto keep_ori; ++ ++ /* duplicate src */ ++ dup = rtw_malloc(src_len); ++ if (dup) { ++ dup_len = src_len; ++ _rtw_memcpy(dup, src, dup_len); ++ } ++ ++keep_ori: ++ ori = *buf; ++ ori_len = *buf_len; ++ ++ /* replace buf with dup */ ++ *buf_len = 0; ++ *buf = dup; ++ *buf_len = dup_len; ++ ++ /* free ori */ ++ if (ori && ori_len > 0) ++ rtw_mfree(ori, ori_len); ++} ++ ++ ++/** ++ * rtw_cbuf_full - test if cbuf is full ++ * @cbuf: pointer of struct rtw_cbuf ++ * ++ * Returns: _TRUE if cbuf is full ++ */ ++inline bool rtw_cbuf_full(struct rtw_cbuf *cbuf) ++{ ++ return (cbuf->write == cbuf->read - 1) ? _TRUE : _FALSE; ++} ++ ++/** ++ * rtw_cbuf_empty - test if cbuf is empty ++ * @cbuf: pointer of struct rtw_cbuf ++ * ++ * Returns: _TRUE if cbuf is empty ++ */ ++inline bool rtw_cbuf_empty(struct rtw_cbuf *cbuf) ++{ ++ return (cbuf->write == cbuf->read) ? _TRUE : _FALSE; ++} ++ ++/** ++ * rtw_cbuf_push - push a pointer into cbuf ++ * @cbuf: pointer of struct rtw_cbuf ++ * @buf: pointer to push in ++ * ++ * Lock free operation, be careful of the use scheme ++ * Returns: _TRUE push success ++ */ ++bool rtw_cbuf_push(struct rtw_cbuf *cbuf, void *buf) ++{ ++ if (rtw_cbuf_full(cbuf)) ++ return _FAIL; ++ ++ if (0) ++ RTW_INFO("%s on %u\n", __func__, cbuf->write); ++ cbuf->bufs[cbuf->write] = buf; ++ cbuf->write = (cbuf->write + 1) % cbuf->size; ++ ++ return _SUCCESS; ++} ++ ++/** ++ * rtw_cbuf_pop - pop a pointer from cbuf ++ * @cbuf: pointer of struct rtw_cbuf ++ * ++ * Lock free operation, be careful of the use scheme ++ * Returns: pointer popped out ++ */ ++void *rtw_cbuf_pop(struct rtw_cbuf *cbuf) ++{ ++ void *buf; ++ if (rtw_cbuf_empty(cbuf)) ++ return NULL; ++ ++ if (0) ++ RTW_INFO("%s on %u\n", __func__, cbuf->read); ++ buf = cbuf->bufs[cbuf->read]; ++ cbuf->read = (cbuf->read + 1) % cbuf->size; ++ ++ return buf; ++} ++ ++/** ++ * rtw_cbuf_alloc - allocte a rtw_cbuf with given size and do initialization ++ * @size: size of pointer ++ * ++ * Returns: pointer of srtuct rtw_cbuf, NULL for allocation failure ++ */ ++struct rtw_cbuf *rtw_cbuf_alloc(u32 size) ++{ ++ struct rtw_cbuf *cbuf; ++ ++ cbuf = (struct rtw_cbuf *)rtw_malloc(sizeof(*cbuf) + sizeof(void *) * size); ++ ++ if (cbuf) { ++ cbuf->write = cbuf->read = 0; ++ cbuf->size = size; ++ } ++ ++ return cbuf; ++} ++ ++/** ++ * rtw_cbuf_free - free the given rtw_cbuf ++ * @cbuf: pointer of struct rtw_cbuf to free ++ */ ++void rtw_cbuf_free(struct rtw_cbuf *cbuf) ++{ ++ rtw_mfree((u8 *)cbuf, sizeof(*cbuf) + sizeof(void *) * cbuf->size); ++} ++ ++/** ++ * map_readN - read a range of map data ++ * @map: map to read ++ * @offset: start address to read ++ * @len: length to read ++ * @buf: pointer of buffer to store data read ++ * ++ * Returns: _SUCCESS or _FAIL ++ */ ++int map_readN(const struct map_t *map, u16 offset, u16 len, u8 *buf) ++{ ++ const struct map_seg_t *seg; ++ int ret = _FAIL; ++ int i; ++ ++ if (len == 0) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ if (offset + len > map->len) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ _rtw_memset(buf, map->init_value, len); ++ ++ for (i = 0; i < map->seg_num; i++) { ++ u8 *c_dst, *c_src; ++ u16 c_len; ++ ++ seg = map->segs + i; ++ if (seg->sa + seg->len <= offset || seg->sa >= offset + len) ++ continue; ++ ++ if (seg->sa >= offset) { ++ c_dst = buf + (seg->sa - offset); ++ c_src = seg->c; ++ if (seg->sa + seg->len <= offset + len) ++ c_len = seg->len; ++ else ++ c_len = offset + len - seg->sa; ++ } else { ++ c_dst = buf; ++ c_src = seg->c + (offset - seg->sa); ++ if (seg->sa + seg->len >= offset + len) ++ c_len = len; ++ else ++ c_len = seg->sa + seg->len - offset; ++ } ++ ++ _rtw_memcpy(c_dst, c_src, c_len); ++ } ++ ++exit: ++ return ret; ++} ++ ++/** ++ * map_read8 - read 1 byte of map data ++ * @map: map to read ++ * @offset: address to read ++ * ++ * Returns: value of data of specified offset. map.init_value if offset is out of range ++ */ ++u8 map_read8(const struct map_t *map, u16 offset) ++{ ++ const struct map_seg_t *seg; ++ u8 val = map->init_value; ++ int i; ++ ++ if (offset + 1 > map->len) { ++ rtw_warn_on(1); ++ goto exit; ++ } ++ ++ for (i = 0; i < map->seg_num; i++) { ++ seg = map->segs + i; ++ if (seg->sa + seg->len <= offset || seg->sa >= offset + 1) ++ continue; ++ ++ val = *(seg->c + offset - seg->sa); ++ break; ++ } ++ ++exit: ++ return val; ++} ++ ++/** ++* is_null - ++* ++* Return TRUE if c is null character ++* FALSE otherwise. ++*/ ++inline BOOLEAN is_null(char c) ++{ ++ if (c == '\0') ++ return _TRUE; ++ else ++ return _FALSE; ++} ++ ++/** ++* is_eol - ++* ++* Return TRUE if c is represent for EOL (end of line) ++* FALSE otherwise. ++*/ ++inline BOOLEAN is_eol(char c) ++{ ++ if (c == '\r' || c == '\n') ++ return _TRUE; ++ else ++ return _FALSE; ++} ++ ++/** ++* is_space - ++* ++* Return TRUE if c is represent for space ++* FALSE otherwise. ++*/ ++inline BOOLEAN is_space(char c) ++{ ++ if (c == ' ' || c == '\t') ++ return _TRUE; ++ else ++ return _FALSE; ++} ++ ++/** ++* IsHexDigit - ++* ++* Return TRUE if chTmp is represent for hex digit ++* FALSE otherwise. ++*/ ++inline BOOLEAN IsHexDigit(char chTmp) ++{ ++ if ((chTmp >= '0' && chTmp <= '9') || ++ (chTmp >= 'a' && chTmp <= 'f') || ++ (chTmp >= 'A' && chTmp <= 'F')) ++ return _TRUE; ++ else ++ return _FALSE; ++} ++ ++/** ++* is_alpha - ++* ++* Return TRUE if chTmp is represent for alphabet ++* FALSE otherwise. ++*/ ++inline BOOLEAN is_alpha(char chTmp) ++{ ++ if ((chTmp >= 'a' && chTmp <= 'z') || ++ (chTmp >= 'A' && chTmp <= 'Z')) ++ return _TRUE; ++ else ++ return _FALSE; ++} ++ ++inline char alpha_to_upper(char c) ++{ ++ if ((c >= 'a' && c <= 'z')) ++ c = 'A' + (c - 'a'); ++ return c; ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/custom_country_chplan.h linux-4.14.18-rtl/3rdparty/rtl8723de/platform/custom_country_chplan.h +--- linux-4.14.18/3rdparty/rtl8723de/platform/custom_country_chplan.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/custom_country_chplan.h 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,28 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++ ++#error "You have defined CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP to use a customized map of your own instead of the default one" ++#error "Before removing these error notifications, please make sure regulatory certification requirements of your target markets" ++ ++static const struct country_chplan CUSTOMIZED_country_chplan_map[] = { ++ COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0xFF), /* Taiwan */ ++}; ++ ++static const u16 CUSTOMIZED_country_chplan_map_sz = sizeof(CUSTOMIZED_country_chplan_map) / sizeof(struct country_chplan); +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_arm_act_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_arm_act_sdio.c +--- linux-4.14.18/3rdparty/rtl8723de/platform/platform_arm_act_sdio.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_arm_act_sdio.c 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,58 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++/* ++ * Description: ++ * This file can be applied to following platforms: ++ * CONFIG_PLATFORM_ACTIONS_ATM703X ++ */ ++#include ++ ++#ifdef CONFIG_PLATFORM_ACTIONS_ATM705X ++extern int acts_wifi_init(void); ++extern void acts_wifi_cleanup(void); ++#endif ++ ++/* ++ * Return: ++ * 0: power on successfully ++ * others: power on failed ++ */ ++int platform_wifi_power_on(void) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_PLATFORM_ACTIONS_ATM705X ++ ret = acts_wifi_init(); ++ if (unlikely(ret < 0)) { ++ pr_err("%s Failed to register the power control driver.\n", __FUNCTION__); ++ goto exit; ++ } ++#endif ++ ++exit: ++ return ret; ++} ++ ++void platform_wifi_power_off(void) ++{ ++#ifdef CONFIG_PLATFORM_ACTIONS_ATM705X ++ acts_wifi_cleanup(); ++#endif ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUN50IW1P1_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUN50IW1P1_sdio.c +--- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUN50IW1P1_sdio.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUN50IW1P1_sdio.c 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,91 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++/* ++ * Description: ++ * This file can be applied to following platforms: ++ * CONFIG_PLATFORM_ARM_SUN50IW1P1 ++ */ ++#include ++#ifdef CONFIG_GPIO_WAKEUP ++#include ++#endif ++ ++#ifdef CONFIG_MMC ++#if defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) ++extern void sunxi_mmc_rescan_card(unsigned ids); ++extern void sunxi_wlan_set_power(int on); ++extern int sunxi_wlan_get_bus_index(void); ++extern int sunxi_wlan_get_oob_irq(void); ++extern int sunxi_wlan_get_oob_irq_flags(void); ++#endif ++#ifdef CONFIG_GPIO_WAKEUP ++extern unsigned int oob_irq; ++#endif ++#endif /* CONFIG_MMC */ ++ ++/* ++ * Return: ++ * 0: power on successfully ++ * others: power on failed ++ */ ++int platform_wifi_power_on(void) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_MMC ++ { ++ ++#if defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) ++ int wlan_bus_index = sunxi_wlan_get_bus_index(); ++ if (wlan_bus_index < 0) ++ return wlan_bus_index; ++ ++ sunxi_wlan_set_power(1); ++ mdelay(100); ++ sunxi_mmc_rescan_card(wlan_bus_index); ++#endif ++ RTW_INFO("%s: power up, rescan card.\n", __FUNCTION__); ++ ++#ifdef CONFIG_GPIO_WAKEUP ++#if defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) ++ oob_irq = sunxi_wlan_get_oob_irq(); ++#endif ++#endif /* CONFIG_GPIO_WAKEUP */ ++ } ++#endif /* CONFIG_MMC */ ++ ++ return ret; ++} ++ ++void platform_wifi_power_off(void) ++{ ++#ifdef CONFIG_MMC ++#if defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) ++ int wlan_bus_index = sunxi_wlan_get_bus_index(); ++ if (wlan_bus_index < 0) ++ return; ++ ++ sunxi_mmc_rescan_card(wlan_bus_index); ++ mdelay(100); ++ sunxi_wlan_set_power(0); ++#endif ++ RTW_INFO("%s: remove card, power off.\n", __FUNCTION__); ++#endif /* CONFIG_MMC */ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUNnI_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUNnI_sdio.c +--- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUNnI_sdio.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUNnI_sdio.c 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,135 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++/* ++ * Description: ++ * This file can be applied to following platforms: ++ * CONFIG_PLATFORM_ARM_SUN6I ++ * CONFIG_PLATFORM_ARM_SUN7I ++ * CONFIG_PLATFORM_ARM_SUN8I ++ */ ++#include ++#include ++#ifdef CONFIG_GPIO_WAKEUP ++#include ++#endif ++ ++#ifdef CONFIG_MMC ++static int sdc_id = -1; ++static signed int gpio_eint_wlan = -1; ++static u32 eint_wlan_handle = 0; ++ ++#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) ++extern void sw_mci_rescan_card(unsigned id, unsigned insert); ++#elif defined(CONFIG_PLATFORM_ARM_SUN8I) ++extern void sunxi_mci_rescan_card(unsigned id, unsigned insert); ++#endif ++ ++#ifdef CONFIG_PLATFORM_ARM_SUN8I_W5P1 ++extern int get_rf_mod_type(void); ++#else ++extern int wifi_pm_get_mod_type(void); ++#endif ++ ++extern void wifi_pm_power(int on); ++#ifdef CONFIG_GPIO_WAKEUP ++extern unsigned int oob_irq; ++#endif ++#endif /* CONFIG_MMC */ ++ ++/* ++ * Return: ++ * 0: power on successfully ++ * others: power on failed ++ */ ++int platform_wifi_power_on(void) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_MMC ++ { ++ script_item_u val; ++ script_item_value_type_e type; ++ ++#ifdef CONFIG_PLATFORM_ARM_SUN8I_W5P1 ++ unsigned int mod_sel = get_rf_mod_type(); ++#else ++ unsigned int mod_sel = wifi_pm_get_mod_type(); ++#endif ++ ++ type = script_get_item("wifi_para", "wifi_sdc_id", &val); ++ if (SCIRPT_ITEM_VALUE_TYPE_INT != type) { ++ RTW_INFO("get wifi_sdc_id failed\n"); ++ ret = -1; ++ } else { ++ sdc_id = val.val; ++ RTW_INFO("----- %s sdc_id: %d, mod_sel: %d\n", __FUNCTION__, sdc_id, mod_sel); ++ ++#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) ++ sw_mci_rescan_card(sdc_id, 1); ++#elif defined(CONFIG_PLATFORM_ARM_SUN8I) ++ sunxi_mci_rescan_card(sdc_id, 1); ++#endif ++ mdelay(100); ++ wifi_pm_power(1); ++ ++ RTW_INFO("%s: power up, rescan card.\n", __FUNCTION__); ++ } ++ ++#ifdef CONFIG_GPIO_WAKEUP ++#ifdef CONFIG_PLATFORM_ARM_SUN8I_W5P1 ++ type = script_get_item("wifi_para", "wl_host_wake", &val); ++#else ++#ifdef CONFIG_RTL8723B ++ type = script_get_item("wifi_para", "rtl8723bs_wl_host_wake", &val); ++#endif ++#ifdef CONFIG_RTL8188E ++ type = script_get_item("wifi_para", "rtl8189es_host_wake", &val); ++#endif ++#endif /* CONFIG_PLATFORM_ARM_SUN8I_W5P1 */ ++ if (SCIRPT_ITEM_VALUE_TYPE_PIO != type) { ++ RTW_INFO("No definition of wake up host PIN\n"); ++ ret = -1; ++ } else { ++ gpio_eint_wlan = val.gpio.gpio; ++#ifdef CONFIG_PLATFORM_ARM_SUN8I ++ oob_irq = gpio_to_irq(gpio_eint_wlan); ++#endif ++ } ++#endif /* CONFIG_GPIO_WAKEUP */ ++ } ++#endif /* CONFIG_MMC */ ++ ++ return ret; ++} ++ ++void platform_wifi_power_off(void) ++{ ++#ifdef CONFIG_MMC ++#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) ++ sw_mci_rescan_card(sdc_id, 0); ++#elif defined(CONFIG_PLATFORM_ARM_SUN8I) ++ sunxi_mci_rescan_card(sdc_id, 0); ++#endif ++ mdelay(100); ++ wifi_pm_power(0); ++ ++ RTW_INFO("%s: remove card, power off.\n", __FUNCTION__); ++#endif /* CONFIG_MMC */ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_sdio.c +--- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_sdio.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_sdio.c 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,95 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#include ++ ++#ifdef CONFIG_MMC_SUNXI_POWER_CONTROL ++#ifdef CONFIG_WITS_EVB_V13 ++ #define SDIOID 0 ++#else /* !CONFIG_WITS_EVB_V13 */ ++ #define SDIOID (CONFIG_CHIP_ID == 1123 ? 3 : 1) ++#endif /* !CONFIG_WITS_EVB_V13 */ ++ ++#define SUNXI_SDIO_WIFI_NUM_RTL8189ES 10 ++extern void sunximmc_rescan_card(unsigned id, unsigned insert); ++extern int mmc_pm_get_mod_type(void); ++extern int mmc_pm_gpio_ctrl(char *name, int level); ++/* ++ * rtl8189es_shdn = port:PH09<1><0> ++ * rtl8189es_wakeup = port:PH10<1><1> ++ * rtl8189es_vdd_en = port:PH11<1><0> ++ * rtl8189es_vcc_en = port:PH12<1><0> ++ */ ++ ++int rtl8189es_sdio_powerup(void) ++{ ++ mmc_pm_gpio_ctrl("rtl8189es_vdd_en", 1); ++ udelay(100); ++ mmc_pm_gpio_ctrl("rtl8189es_vcc_en", 1); ++ udelay(50); ++ mmc_pm_gpio_ctrl("rtl8189es_shdn", 1); ++ return 0; ++} ++ ++int rtl8189es_sdio_poweroff(void) ++{ ++ mmc_pm_gpio_ctrl("rtl8189es_shdn", 0); ++ mmc_pm_gpio_ctrl("rtl8189es_vcc_en", 0); ++ mmc_pm_gpio_ctrl("rtl8189es_vdd_en", 0); ++ return 0; ++} ++#endif /* CONFIG_MMC_SUNXI_POWER_CONTROL */ ++ ++/* ++ * Return: ++ * 0: power on successfully ++ * others: power on failed ++ */ ++int platform_wifi_power_on(void) ++{ ++ int ret = 0; ++#ifdef CONFIG_MMC_SUNXI_POWER_CONTROL ++ unsigned int mod_sel = mmc_pm_get_mod_type(); ++#endif /* CONFIG_MMC_SUNXI_POWER_CONTROL */ ++ ++ ++#ifdef CONFIG_MMC_SUNXI_POWER_CONTROL ++ if (mod_sel == SUNXI_SDIO_WIFI_NUM_RTL8189ES) { ++ rtl8189es_sdio_powerup(); ++ sunximmc_rescan_card(SDIOID, 1); ++ printk("[rtl8189es] %s: power up, rescan card.\n", __FUNCTION__); ++ } else { ++ ret = -1; ++ printk("[rtl8189es] %s: mod_sel = %d is incorrect.\n", __FUNCTION__, mod_sel); ++ } ++#endif /* CONFIG_MMC_SUNXI_POWER_CONTROL */ ++ ++ return ret; ++} ++ ++void platform_wifi_power_off(void) ++{ ++#ifdef CONFIG_MMC_SUNXI_POWER_CONTROL ++ sunximmc_rescan_card(SDIOID, 0); ++#ifdef CONFIG_RTL8188E ++ rtl8189es_sdio_poweroff(); ++ printk("[rtl8189es] %s: remove card, power off.\n", __FUNCTION__); ++#endif /* CONFIG_RTL8188E */ ++#endif /* CONFIG_MMC_SUNXI_POWER_CONTROL */ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_usb.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_usb.c +--- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_usb.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_usb.c 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,141 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++/* ++ * Description: ++ * This file can be applied to following platforms: ++ * CONFIG_PLATFORM_ARM_SUNXI Series platform ++ * ++ */ ++ ++#include ++#include ++ ++#ifdef CONFIG_PLATFORM_ARM_SUNxI ++extern int sw_usb_disable_hcd(__u32 usbc_no); ++extern int sw_usb_enable_hcd(__u32 usbc_no); ++static int usb_wifi_host = 2; ++#endif ++ ++#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) ++extern int sw_usb_disable_hcd(__u32 usbc_no); ++extern int sw_usb_enable_hcd(__u32 usbc_no); ++extern void wifi_pm_power(int on); ++static script_item_u item; ++#endif ++ ++#ifdef CONFIG_PLATFORM_ARM_SUN8I ++extern int sunxi_usb_disable_hcd(__u32 usbc_no); ++extern int sunxi_usb_enable_hcd(__u32 usbc_no); ++extern void wifi_pm_power(int on); ++static script_item_u item; ++#endif ++ ++ ++int platform_wifi_power_on(void) ++{ ++ int ret = 0; ++ ++#ifdef CONFIG_PLATFORM_ARM_SUNxI ++#ifndef CONFIG_RTL8723A ++ { ++ /* ----------get usb_wifi_usbc_num------------- */ ++ ret = script_parser_fetch("usb_wifi_para", "usb_wifi_usbc_num", (int *)&usb_wifi_host, 64); ++ if (ret != 0) { ++ RTW_INFO("ERR: script_parser_fetch usb_wifi_usbc_num failed\n"); ++ ret = -ENOMEM; ++ goto exit; ++ } ++ RTW_INFO("sw_usb_enable_hcd: usbc_num = %d\n", usb_wifi_host); ++ sw_usb_enable_hcd(usb_wifi_host); ++ } ++#endif /* CONFIG_RTL8723A */ ++#endif /* CONFIG_PLATFORM_ARM_SUNxI */ ++ ++#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) ++ { ++ script_item_value_type_e type; ++ ++ type = script_get_item("wifi_para", "wifi_usbc_id", &item); ++ if (SCIRPT_ITEM_VALUE_TYPE_INT != type) { ++ printk("ERR: script_get_item wifi_usbc_id failed\n"); ++ ret = -ENOMEM; ++ goto exit; ++ } ++ ++ printk("sw_usb_enable_hcd: usbc_num = %d\n", item.val); ++ wifi_pm_power(1); ++ mdelay(10); ++ ++#if !(defined(CONFIG_RTL8723A)) && !(defined(CONFIG_RTL8723B)) ++ sw_usb_enable_hcd(item.val); ++#endif ++ } ++#endif /* defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) */ ++ ++#if defined(CONFIG_PLATFORM_ARM_SUN8I) ++ { ++ script_item_value_type_e type; ++ ++ type = script_get_item("wifi_para", "wifi_usbc_id", &item); ++ if (SCIRPT_ITEM_VALUE_TYPE_INT != type) { ++ printk("ERR: script_get_item wifi_usbc_id failed\n"); ++ ret = -ENOMEM; ++ goto exit; ++ } ++ ++ printk("sw_usb_enable_hcd: usbc_num = %d\n", item.val); ++ wifi_pm_power(1); ++ mdelay(10); ++ ++#if !(defined(CONFIG_RTL8723A)) && !(defined(CONFIG_RTL8723B)) ++ sunxi_usb_enable_hcd(item.val); ++#endif ++ } ++#endif /* CONFIG_PLATFORM_ARM_SUN8I */ ++ ++exit: ++ return ret; ++} ++ ++void platform_wifi_power_off(void) ++{ ++ ++#ifdef CONFIG_PLATFORM_ARM_SUNxI ++#ifndef CONFIG_RTL8723A ++ RTW_INFO("sw_usb_disable_hcd: usbc_num = %d\n", usb_wifi_host); ++ sw_usb_disable_hcd(usb_wifi_host); ++#endif /* ifndef CONFIG_RTL8723A */ ++#endif /* CONFIG_PLATFORM_ARM_SUNxI */ ++ ++#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) ++ #if !(defined(CONFIG_RTL8723A)) && !(defined(CONFIG_RTL8723B)) ++ sw_usb_disable_hcd(item.val); ++ #endif ++ wifi_pm_power(0); ++#endif /* defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) */ ++ ++#if defined(CONFIG_PLATFORM_ARM_SUN8I) ++ #if !(defined(CONFIG_RTL8723A)) && !(defined(CONFIG_RTL8723B)) ++ sunxi_usb_disable_hcd(item.val); ++ #endif ++ wifi_pm_power(0); ++#endif /* defined(CONFIG_PLATFORM_ARM_SUN8I) */ ++ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_WMT_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_WMT_sdio.c +--- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_WMT_sdio.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_WMT_sdio.c 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,51 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#include ++#include ++#include ++ ++extern void wmt_detect_sdio2(void); ++extern void force_remove_sdio2(void); ++ ++int platform_wifi_power_on(void) ++{ ++ int err = 0; ++ err = gpio_request(WMT_PIN_GP62_SUSGPIO1, "wifi_chip_en"); ++ if (err < 0) { ++ printk("request gpio for rtl8188eu failed!\n"); ++ return err; ++ } ++ gpio_direction_output(WMT_PIN_GP62_SUSGPIO1, 0);/* pull sus_gpio1 to 0 to open vcc_wifi. */ ++ printk("power on rtl8189.\n"); ++ msleep(500); ++ wmt_detect_sdio2(); ++ printk("[rtl8189es] %s: new card, power on.\n", __FUNCTION__); ++ return err; ++} ++ ++void platform_wifi_power_off(void) ++{ ++ force_remove_sdio2(); ++ ++ gpio_direction_output(WMT_PIN_GP62_SUSGPIO1, 1);/* pull sus_gpio1 to 1 to close vcc_wifi. */ ++ printk("power off rtl8189.\n"); ++ gpio_free(WMT_PIN_GP62_SUSGPIO1); ++ printk("[rtl8189es] %s: remove card, power off.\n", __FUNCTION__); ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ops.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ops.c +--- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ops.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ops.c 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,37 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef CONFIG_PLATFORM_OPS ++/* ++ * Return: ++ * 0: power on successfully ++ * others: power on failed ++ */ ++int platform_wifi_power_on(void) ++{ ++ int ret = 0; ++ ++ ++ return ret; ++} ++ ++void platform_wifi_power_off(void) ++{ ++} ++#endif /* !CONFIG_PLATFORM_OPS */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ops.h linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ops.h +--- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ops.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ops.h 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,31 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#ifndef __PLATFORM_OPS_H__ ++#define __PLATFORM_OPS_H__ ++ ++/* ++ * Return: ++ * 0: power on successfully ++ * others: power on failed ++ */ ++int platform_wifi_power_on(void); ++void platform_wifi_power_off(void); ++ ++#endif /* __PLATFORM_OPS_H__ */ +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_RTK_DMP_usb.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_RTK_DMP_usb.c +--- linux-4.14.18/3rdparty/rtl8723de/platform/platform_RTK_DMP_usb.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_RTK_DMP_usb.c 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,35 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#include ++ ++int platform_wifi_power_on(void) ++{ ++ int ret = 0; ++ u32 tmp; ++ tmp = readl((volatile unsigned int *)0xb801a608); ++ tmp &= 0xffffff00; ++ tmp |= 0x55; ++ writel(tmp, (volatile unsigned int *)0xb801a608); /* write dummy register for 1055 */ ++ return ret; ++} ++ ++void platform_wifi_power_off(void) ++{ ++} +diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_sprd_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_sprd_sdio.c +--- linux-4.14.18/3rdparty/rtl8723de/platform/platform_sprd_sdio.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_sprd_sdio.c 2018-02-11 21:44:27.177146543 +0200 +@@ -0,0 +1,89 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ * You should have received a copy of the GNU General Public License along with ++ * this program; if not, write to the Free Software Foundation, Inc., ++ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ * ++ * ++ ******************************************************************************/ ++#include ++ ++extern void sdhci_bus_scan(void); ++#ifndef ANDROID_2X ++extern int sdhci_device_attached(void); ++#endif ++ ++/* ++ * Return: ++ * 0: power on successfully ++ * others: power on failed ++ */ ++int platform_wifi_power_on(void) ++{ ++ int ret = 0; ++ ++ ++#ifdef CONFIG_RTL8188E ++ rtw_wifi_gpio_wlan_ctrl(WLAN_POWER_ON); ++#endif /* CONFIG_RTL8188E */ ++ ++ /* Pull up pwd pin, make wifi leave power down mode. */ ++ rtw_wifi_gpio_init(); ++ rtw_wifi_gpio_wlan_ctrl(WLAN_PWDN_ON); ++ ++#if (MP_DRIVER == 1) && (defined(CONFIG_RTL8723A) || defined(CONFIG_RTL8723B)) ++ /* Pull up BT reset pin. */ ++ rtw_wifi_gpio_wlan_ctrl(WLAN_BT_PWDN_ON); ++#endif ++ rtw_mdelay_os(5); ++ ++ sdhci_bus_scan(); ++#ifdef CONFIG_RTL8723B ++ /* YJ,test,130305 */ ++ rtw_mdelay_os(1000); ++#endif ++#ifdef ANDROID_2X ++ rtw_mdelay_os(200); ++#else /* !ANDROID_2X */ ++ if (1) { ++ int i = 0; ++ ++ for (i = 0; i <= 50; i++) { ++ msleep(10); ++ if (sdhci_device_attached()) ++ break; ++ printk("%s delay times:%d\n", __func__, i); ++ } ++ } ++#endif /* !ANDROID_2X */ ++ ++ return ret; ++} ++ ++void platform_wifi_power_off(void) ++{ ++ /* Pull down pwd pin, make wifi enter power down mode. */ ++ rtw_wifi_gpio_wlan_ctrl(WLAN_PWDN_OFF); ++ rtw_mdelay_os(5); ++ rtw_wifi_gpio_deinit(); ++ ++#ifdef CONFIG_RTL8188E ++ rtw_wifi_gpio_wlan_ctrl(WLAN_POWER_OFF); ++#endif /* CONFIG_RTL8188E */ ++ ++#ifdef CONFIG_WOWLAN ++ if (mmc_host) ++ mmc_host->pm_flags &= ~MMC_PM_KEEP_POWER; ++#endif /* CONFIG_WOWLAN */ ++} diff --git a/kernel/tools/cpupowertools/files/patches/mageia/3rd-rtl8812au.patch b/kernel/tools/cpupowertools/files/patches/mageia/3rd-rtl8812au.patch index 680a95b4..23d622c1 100644 --- a/kernel/tools/cpupowertools/files/patches/mageia/3rd-rtl8812au.patch +++ b/kernel/tools/cpupowertools/files/patches/mageia/3rd-rtl8812au.patch @@ -1,7 +1,7 @@ -diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rtl8812au/core/efuse/rtw_efuse.c ---- linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/efuse/rtw_efuse.c 2017-06-07 23:07:20.997686300 +0300 -@@ -0,0 +1,1672 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/efuse/rtw_efuse.c +--- linux-4.14.17/3rdparty/rtl8812au/core/efuse/rtw_efuse.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/efuse/rtw_efuse.c 2018-02-06 17:42:30.692966898 +0200 +@@ -0,0 +1,1304 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -15,18 +15,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_EFUSE_C_ + +#include -+#include + -+#include "../hal/efuse/efuse_mask.h" ++ + +/*------------------------Define local variable------------------------------*/ +u8 fakeEfuseBank=0; @@ -44,8 +38,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt +u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; +u8 fakeBTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN]={0}; +u8 fakeBTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN]={0}; -+ -+u8 maskfileBuffer[32]; +/*------------------------Define local variable------------------------------*/ + +//------------------------------------------------------------------------------ @@ -53,43 +45,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt +#define EFUSE_CTRL REG_EFUSE_CTRL // E-Fuse Control. +//------------------------------------------------------------------------------ + -+BOOLEAN ++bool +Efuse_Read1ByteFromFakeContent( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN OUT u8 *Value ); -+BOOLEAN -+Efuse_Read1ByteFromFakeContent( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN OUT u8 *Value ) ++ PADAPTER pAdapter, ++ u16 Offset, ++ u8 *Value ) +{ + if(Offset >= EFUSE_MAX_HW_SIZE) + { -+ return _FALSE; ++ return false; + } + //DbgPrint("Read fake content, offset = %d\n", Offset); + if(fakeEfuseBank == 0) + *Value = fakeEfuseContent[Offset]; + else + *Value = fakeBTEfuseContent[fakeEfuseBank-1][Offset]; -+ return _TRUE; ++ return true; +} + -+BOOLEAN ++bool +Efuse_Write1ByteToFakeContent( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN u8 Value ); -+BOOLEAN ++ PADAPTER pAdapter, ++ u16 Offset, ++ u8 Value ); ++bool +Efuse_Write1ByteToFakeContent( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN u8 Value ) ++ PADAPTER pAdapter, ++ u16 Offset, ++ u8 Value ) +{ + if(Offset >= EFUSE_MAX_HW_SIZE) + { -+ return _FALSE; ++ return false; + } + if(fakeEfuseBank == 0) + fakeEfuseContent[Offset] = Value; @@ -97,7 +84,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + { + fakeBTEfuseContent[fakeEfuseBank-1][Offset] = Value; + } -+ return _TRUE; ++ return true; +} + +/*----------------------------------------------------------------------------- @@ -118,24 +105,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + * 11/17/2008 MHC Create Version 0. + * + *---------------------------------------------------------------------------*/ -+VOID ++void +Efuse_PowerSwitch( -+ IN PADAPTER pAdapter, -+ IN u8 bWrite, -+ IN u8 PwrState) ++ PADAPTER pAdapter, ++ u8 bWrite, ++ u8 PwrState) +{ + pAdapter->HalFunc.EfusePowerSwitch(pAdapter, bWrite, PwrState); +} + -+VOID -+BTEfuse_PowerSwitch( -+ IN PADAPTER pAdapter, -+ IN u8 bWrite, -+ IN u8 PwrState) -+{ -+ if(pAdapter->HalFunc.BTEfusePowerSwitch) -+ pAdapter->HalFunc.BTEfusePowerSwitch(pAdapter, bWrite, PwrState); -+} + +/*----------------------------------------------------------------------------- + * Function: efuse_GetCurrentSize @@ -155,9 +133,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + *---------------------------------------------------------------------------*/ +u16 +Efuse_GetCurrentSize( -+ IN PADAPTER pAdapter, -+ IN u8 efuseType, -+ IN BOOLEAN bPseudoTest) ++ PADAPTER pAdapter, ++ u8 efuseType, ++ bool bPseudoTest) +{ + u16 ret=0; + @@ -168,7 +146,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + +/* 11/16/2008 MH Add description. Get current efuse area enabled word!!. */ +u8 -+Efuse_CalculateWordCnts(IN u8 word_en) ++Efuse_CalculateWordCnts(u8 word_en) +{ + u8 word_cnts = 0; + if(!(word_en & BIT(0))) word_cnts++; // 0 : write enable @@ -189,12 +167,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt +// +// Created by Roger, 2008.10.21. +// -+VOID ++void +ReadEFuseByte( + PADAPTER Adapter, + u16 _offset, + u8 *pbuf, -+ IN BOOLEAN bPseudoTest) ++ bool bPseudoTest) +{ + u32 value32; + u8 readbyte; @@ -206,12 +184,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + Efuse_Read1ByteFromFakeContent(Adapter, _offset, pbuf); + return; + } -+ if (IS_HARDWARE_TYPE_8723B(Adapter)) -+ { -+ // <20130121, Kordan> For SMIC S55 EFUSE specificatoin. -+ //0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) -+ PHY_SetMacReg(Adapter, EFUSE_TEST, BIT11, 0); -+ } ++ + //Write Address + rtw_write8(Adapter, EFUSE_CTRL+1, (_offset & 0xff)); + readbyte = rtw_read8(Adapter, EFUSE_CTRL+2); @@ -243,6 +216,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + +} + ++ +// +// Description: +// 1. Execute E-Fuse read byte operation according as map offset and @@ -261,35 +235,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt +// write addr must be after sec5. +// + -+VOID ++void +efuse_ReadEFuse( + PADAPTER Adapter, + u8 efuseType, + u16 _offset, + u16 _size_byte, + u8 *pbuf, -+ IN BOOLEAN bPseudoTest ++ bool bPseudoTest + ); -+VOID ++void +efuse_ReadEFuse( + PADAPTER Adapter, + u8 efuseType, + u16 _offset, + u16 _size_byte, + u8 *pbuf, -+ IN BOOLEAN bPseudoTest ++ bool bPseudoTest + ) +{ + Adapter->HalFunc.ReadEFuse(Adapter, efuseType, _offset, _size_byte, pbuf, bPseudoTest); +} + -+VOID ++void +EFUSE_GetEfuseDefinition( -+ IN PADAPTER pAdapter, -+ IN u8 efuseType, -+ IN u8 type, -+ OUT void *pOut, -+ IN BOOLEAN bPseudoTest ++ PADAPTER pAdapter, ++ u8 efuseType, ++ u8 type, ++ void *pOut, ++ bool bPseudoTest + ) +{ + pAdapter->HalFunc.EFUSEGetEfuseDefinition(pAdapter, efuseType, type, pOut, bPseudoTest); @@ -313,8 +287,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + *---------------------------------------------------------------------------*/ +u8 +EFUSE_Read1Byte( -+ IN PADAPTER Adapter, -+ IN u16 Address) ++ PADAPTER Adapter, ++ u16 Address) +{ + u8 data; + u8 Bytetemp = {0x00}; @@ -322,7 +296,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + u32 k=0; + u16 contentLen=0; + -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI , TYPE_EFUSE_REAL_CONTENT_LEN, (PVOID)&contentLen, _FALSE); ++ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI , TYPE_EFUSE_REAL_CONTENT_LEN, (void *)&contentLen, false); + + if (Address < contentLen) //E-fuse 512Byte + { @@ -378,14 +352,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + +void +EFUSE_Write1Byte( -+ IN PADAPTER Adapter, -+ IN u16 Address, -+ IN u8 Value); ++ PADAPTER Adapter, ++ u16 Address, ++ u8 Value); +void +EFUSE_Write1Byte( -+ IN PADAPTER Adapter, -+ IN u16 Address, -+ IN u8 Value) ++ PADAPTER Adapter, ++ u16 Address, ++ u8 Value) +{ + u8 Bytetemp = {0x00}; + u8 temp = {0x00}; @@ -393,7 +367,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + u16 contentLen=0; + + //RT_TRACE(COMP_EFUSE, DBG_LOUD, ("Addr=%x Data =%x\n", Address, Value)); -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI , TYPE_EFUSE_REAL_CONTENT_LEN, (PVOID)&contentLen, _FALSE); ++ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI , TYPE_EFUSE_REAL_CONTENT_LEN, (void *)&contentLen, false); + + if( Address < contentLen) //E-fuse 512Byte + { @@ -432,16 +406,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt +/* 11/16/2008 MH Read one byte from real Efuse. */ +u8 +efuse_OneByteRead( -+ IN PADAPTER pAdapter, -+ IN u16 addr, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) ++ PADAPTER pAdapter, ++ u16 addr, ++ u8 *data, ++ bool bPseudoTest) +{ -+ u32 tmpidx = 0; ++ u8 tmpidx = 0; + u8 bResult; -+ u8 readbyte; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ ++ + //DBG_871X("===> EFUSE_OneByteRead(), addr = %x\n", addr); + //DBG_871X("===> EFUSE_OneByteRead() start, 0x34 = 0x%X\n", rtw_read32(pAdapter, EFUSE_TEST)); + @@ -450,45 +422,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + bResult = Efuse_Read1ByteFromFakeContent(pAdapter, addr, data); + return bResult; + } -+ -+ if( IS_HARDWARE_TYPE_8723B(pAdapter) || -+ (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->VersionID))) || -+ (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->VersionID)) -+ ) ++ ++ // <20130227, Kordan> 8192E MP chip A-cut had better not set 0x34[11] until B-Cut. ++/* ++ if ( IS_HARDWARE_TYPE_8723B(pAdapter)) + { + // <20130121, Kordan> For SMIC EFUSE specificatoin. + //0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) + //PHY_SetMacReg(pAdapter, 0x34, BIT11, 0); + rtw_write16(pAdapter, 0x34, rtw_read16(pAdapter,0x34)& (~BIT11) ); + } -+ ++*/ + // -----------------e-fuse reg ctrl --------------------------------- + //address + rtw_write8(pAdapter, EFUSE_CTRL+1, (u8)(addr&0xff)); + rtw_write8(pAdapter, EFUSE_CTRL+2, ((u8)((addr>>8) &0x03) ) | + (rtw_read8(pAdapter, EFUSE_CTRL+2)&0xFC )); + -+ //rtw_write8(pAdapter, EFUSE_CTRL+3, 0x72);//read cmd -+ //Write bit 32 0 -+ readbyte = rtw_read8(pAdapter, EFUSE_CTRL+3); -+ rtw_write8(pAdapter, EFUSE_CTRL+3, (readbyte & 0x7f)); ++ rtw_write8(pAdapter, EFUSE_CTRL+3, 0x72);//read cmd + + while(!(0x80 &rtw_read8(pAdapter, EFUSE_CTRL+3))&&(tmpidx<1000)) + { + rtw_mdelay_os(1); + tmpidx++; + } -+ if(tmpidx<100) ++ if(tmpidx<1000) + { + *data=rtw_read8(pAdapter, EFUSE_CTRL); -+ bResult = _TRUE; ++ bResult = true; + } + else + { + *data = 0xff; -+ bResult = _FALSE; -+ DBG_871X("%s: [ERROR] addr=0x%x bResult=%d time out 1s !!!\n", __FUNCTION__, addr, bResult); -+ DBG_871X("%s: [ERROR] EFUSE_CTRL =0x%08x !!!\n", __FUNCTION__, rtw_read32(pAdapter, EFUSE_CTRL)); ++ bResult = false; + } + + return bResult; @@ -497,16 +463,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt +/* 11/16/2008 MH Write one byte to reald Efuse. */ +u8 +efuse_OneByteWrite( -+ IN PADAPTER pAdapter, -+ IN u16 addr, -+ IN u8 data, -+ IN BOOLEAN bPseudoTest) ++ PADAPTER pAdapter, ++ u16 addr, ++ u8 data, ++ bool bPseudoTest) +{ + u8 tmpidx = 0; -+ u8 bResult=_FALSE; ++ u8 bResult=false; + u32 efuseValue = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ ++ + //DBG_871X("===> EFUSE_OneByteWrite(), addr = %x data=%x\n", addr, data); + //DBG_871X("===> EFUSE_OneByteWrite() start, 0x34 = 0x%X\n", rtw_read32(pAdapter, EFUSE_TEST)); + @@ -520,24 +485,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + // -----------------e-fuse reg ctrl --------------------------------- + //address + ++ // <20121213, Kordan> 8723BE SMIC TestChip workaround. ++/* ++ if (IS_HARDWARE_TYPE_8723B(pAdapter) && ! pHalData->bIsMPChip) ++ { ++ //PlatformEFIOWrite1Byte(pAdapter, REG_MULTI_FUNC_CTRL+1, 0x69); // Turn off EFUSE protection. ++ rtw_write16(pAdapter, REG_SYS_ISO_CTRL, rtw_read16(pAdapter, REG_SYS_ISO_CTRL)| BIT14); // Turn on power cut ++ ++ EFUSE_PowerSwitch(pAdapter,TRUE, TRUE); // LDO 2.6V, this must follows after power cut. ++ } ++*/ + + efuseValue = rtw_read32(pAdapter, EFUSE_CTRL); + efuseValue |= (BIT21|BIT31); + efuseValue &= ~(0x3FFFF); + efuseValue |= ((addr<<8 | data) & 0x3FFFF); + ++/* + // <20130227, Kordan> 8192E MP chip A-cut had better not set 0x34[11] until B-Cut. -+ if ( IS_HARDWARE_TYPE_8723B(pAdapter) || -+ (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->VersionID))) || -+ (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->VersionID)) -+ ) { ++ if (IS_HARDWARE_TYPE_8723B(pAdapter) && pHalData->bIsMPChip) ++ { + // <20130121, Kordan> For SMIC EFUSE specificatoin. + //0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) -+ //PHY_SetMacReg(pAdapter, 0x34, BIT11, 1); -+ rtw_write16(pAdapter, 0x34, rtw_read16(pAdapter,0x34)| (BIT11) ); -+ rtw_write32(pAdapter, EFUSE_CTRL, 0x90600000|((addr<<8 | data)) ); ++ PHY_SetMacReg(pAdapter, 0x34, BIT11, 1); ++ PlatformEFIOWrite4Byte(pAdapter, EFUSE_CTRL, 0x90600000|((addr<<8 | data)) ); + } + else ++*/ + { + rtw_write32(pAdapter, EFUSE_CTRL, efuseValue); + } @@ -549,32 +523,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + + if(tmpidx<100) + { -+ bResult = _TRUE; ++ bResult = true; + } + else + { -+ bResult = _FALSE; -+ DBG_871X("%s: [ERROR] addr=0x%x ,efuseValue=0x%x ,bResult=%d time out 1s !!! \n", -+ __FUNCTION__, addr, efuseValue, bResult); -+ DBG_871X("%s: [ERROR] EFUSE_CTRL =0x%08x !!!\n", __FUNCTION__, rtw_read32(pAdapter, EFUSE_CTRL)); -+ } -+ -+ // disable Efuse program enable -+ if ( IS_HARDWARE_TYPE_8723B(pAdapter) || -+ (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->VersionID))) || -+ (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->VersionID)) -+ ) { -+ PHY_SetMacReg(pAdapter, EFUSE_TEST, BIT(11), 0); ++ bResult = false; + } + + return bResult; +} + +int -+Efuse_PgPacketRead( IN PADAPTER pAdapter, -+ IN u8 offset, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) ++Efuse_PgPacketRead(PADAPTER pAdapter, ++ u8 offset, ++ u8 *data, ++ bool bPseudoTest) +{ + int ret=0; + @@ -584,11 +547,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt +} + +int -+Efuse_PgPacketWrite(IN PADAPTER pAdapter, -+ IN u8 offset, -+ IN u8 word_en, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) ++Efuse_PgPacketWrite(PADAPTER pAdapter, ++ u8 offset, ++ u8 word_en, ++ u8 *data, ++ bool bPseudoTest) +{ + int ret; + @@ -599,11 +562,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + + +int -+Efuse_PgPacketWrite_BT(IN PADAPTER pAdapter, -+ IN u8 offset, -+ IN u8 word_en, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) ++Efuse_PgPacketWrite_BT(PADAPTER pAdapter, ++ u8 offset, ++ u8 word_en, ++ u8 *data, ++ bool bPseudoTest) +{ + int ret; + @@ -630,9 +593,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + * + *---------------------------------------------------------------------------*/ +void -+efuse_WordEnableDataRead(IN u8 word_en, -+ IN u8 *sourdata, -+ IN u8 *targetdata) ++efuse_WordEnableDataRead(u8 word_en, ++ u8 *sourdata, ++ u8 *targetdata) +{ + if (!(word_en&BIT(0))) + { @@ -658,11 +621,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + + +u8 -+Efuse_WordEnableDataWrite( IN PADAPTER pAdapter, -+ IN u16 efuse_addr, -+ IN u8 word_en, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) ++Efuse_WordEnableDataWrite(PADAPTER pAdapter, ++ u16 efuse_addr, ++ u8 word_en, ++ u8 *data, ++ bool bPseudoTest) +{ + u8 ret=0; + @@ -673,12 +636,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + +static u8 efuse_read8(PADAPTER padapter, u16 address, u8 *value) +{ -+ return efuse_OneByteRead(padapter,address, value, _FALSE); ++ return efuse_OneByteRead(padapter,address, value, false); +} + +static u8 efuse_write8(PADAPTER padapter, u16 address, u8 *value) +{ -+ return efuse_OneByteWrite(padapter,address, *value, _FALSE); ++ return efuse_OneByteWrite(padapter,address, *value, false); +} + +/* @@ -691,20 +654,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + u8 res = _FAIL ; + u8 (*rw8)(PADAPTER, u16, u8*); + -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN, (PVOID)&real_content_len, _FALSE); -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN, (void *)&real_content_len, false); ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); + + if (start_addr > real_content_len) + return _FAIL; + -+ if (_TRUE == bWrite) { ++ if (true == bWrite) { + if ((start_addr + cnts) > max_available_size) + return _FAIL; + rw8 = &efuse_write8; + } else + rw8 = &efuse_read8; + -+ Efuse_PowerSwitch(padapter, bWrite, _TRUE); ++ Efuse_PowerSwitch(padapter, bWrite, true); + + // e-fuse one byte read / write + for (i = 0; i < cnts; i++) { @@ -717,7 +680,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + if (_FAIL == res) break; + } + -+ Efuse_PowerSwitch(padapter, bWrite, _FALSE); ++ Efuse_PowerSwitch(padapter, bWrite, false); + + return res; +} @@ -725,17 +688,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt +u16 efuse_GetMaxSize(PADAPTER padapter) +{ + u16 max_size; -+ -+ max_size = 0; -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI , TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_size, _FALSE); ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI , TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_size, false); + return max_size; +} +//------------------------------------------------------------------------------ +u8 efuse_GetCurrentSize(PADAPTER padapter, u16 *size) +{ -+ Efuse_PowerSwitch(padapter, _FALSE, _TRUE); -+ *size = Efuse_GetCurrentSize(padapter, EFUSE_WIFI, _FALSE); -+ Efuse_PowerSwitch(padapter, _FALSE, _FALSE); ++ Efuse_PowerSwitch(padapter, false, true); ++ *size = Efuse_GetCurrentSize(padapter, EFUSE_WIFI, false); ++ Efuse_PowerSwitch(padapter, false, false); + + return _SUCCESS; +} @@ -744,16 +705,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt +{ + u16 mapLen=0; + -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, false); + + if ((addr + cnts) > mapLen) + return _FAIL; + -+ Efuse_PowerSwitch(padapter, _FALSE, _TRUE); ++ Efuse_PowerSwitch(padapter, false, true); + -+ efuse_ReadEFuse(padapter, EFUSE_WIFI, addr, cnts, data, _FALSE); ++ efuse_ReadEFuse(padapter, EFUSE_WIFI, addr, cnts, data, false); + -+ Efuse_PowerSwitch(padapter, _FALSE, _FALSE); ++ Efuse_PowerSwitch(padapter, false, false); + + return _SUCCESS; +} @@ -762,260 +723,88 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt +{ + u16 mapLen=0; + -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, false); + + if ((addr + cnts) > mapLen) + return _FAIL; + -+ Efuse_PowerSwitch(padapter, _FALSE, _TRUE); ++ Efuse_PowerSwitch(padapter, false, true); + -+ efuse_ReadEFuse(padapter, EFUSE_BT, addr, cnts, data, _FALSE); ++ efuse_ReadEFuse(padapter, EFUSE_BT, addr, cnts, data, false); + -+ Efuse_PowerSwitch(padapter, _FALSE, _FALSE); ++ Efuse_PowerSwitch(padapter, false, false); + + return _SUCCESS; +} -+ -+BOOLEAN rtw_file_efuse_IsMasked( -+ PADAPTER pAdapter, -+ u16 Offset -+ ) -+{ -+ int r = Offset/16; -+ int c = (Offset%16) / 2; -+ int result = 0; -+ -+ if(pAdapter->registrypriv.boffefusemask) -+ return FALSE; -+ -+ //DBG_871X(" %s ,Offset=%x r= %d , c=%d , maskfileBuffer[r]= %x \n",__func__,Offset,r,c,maskfileBuffer[r]); -+ if (c < 4) // Upper double word -+ result = (maskfileBuffer[r] & (0x10 << c)); -+ else -+ result = (maskfileBuffer[r] & (0x01 << (c-4))); -+ -+ return (result > 0) ? 0 : 1; -+ -+} -+ -+ -+u8 rtw_efuse_file_read(PADAPTER padapter,u8 *filepatch,u8 *buf,u32 len) -+{ -+ char *ptmp; -+ char *ptmpbuf=NULL; -+ u32 rtStatus; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ ptmpbuf = rtw_zmalloc(2048); -+ -+ if (ptmpbuf == NULL) -+ return _FALSE; -+ -+ _rtw_memset(ptmpbuf,'\0',2048); -+ -+ rtStatus = rtw_retrieve_from_file(filepatch, ptmpbuf, 2048); -+ -+ if( rtStatus > 100 ) -+ { -+ u32 i,j; -+ for(i=0,j=0;jregistrypriv.boffefusemask) -+ return FALSE; -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+#if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ return (IS_MASKED(8188E,_MUSB,Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8812A) -+ if (IS_HARDWARE_TYPE_8812(pAdapter)) -+ return (IS_MASKED(8812A,_MUSB,Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8821A) -+ //if (IS_HARDWARE_TYPE_8811AU(pAdapter)) -+ // return (IS_MASKED(8811A,_MUSB,Offset)) ? TRUE : FALSE; -+ if (IS_HARDWARE_TYPE_8821(pAdapter)) -+ return (IS_MASKED(8821A,_MUSB,Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8192E) -+ if (IS_HARDWARE_TYPE_8192E(pAdapter)) -+ return (IS_MASKED(8192E,_MUSB,Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8723B) -+ if (IS_HARDWARE_TYPE_8723B(pAdapter)) -+ return (IS_MASKED(8723B,_MUSB,Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8814A) -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ return (IS_MASKED(8814A, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8188F) -+ if (IS_HARDWARE_TYPE_8188F(pAdapter)) -+ return (IS_MASKED(8188F, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#elif DEV_BUS_TYPE == RT_PCI_INTERFACE -+#if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ return (IS_MASKED(8188E,_MPCIE,Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8192E) -+ if (IS_HARDWARE_TYPE_8192E(pAdapter)) -+ return (IS_MASKED(8192E,_MPCIE,Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8812A) -+ if (IS_HARDWARE_TYPE_8812(pAdapter)) -+ return (IS_MASKED(8812A,_MPCIE,Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8821A) -+ if (IS_HARDWARE_TYPE_8821(pAdapter)) -+ return (IS_MASKED(8821A,_MPCIE,Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8723B) -+ if (IS_HARDWARE_TYPE_8723B(pAdapter)) -+ return (IS_MASKED(8723B,_MPCIE,Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8814A) -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ return (IS_MASKED(8814A, _MPCIE, Offset)) ? TRUE : FALSE; -+#endif -+ //else if (IS_HARDWARE_TYPE_8821B(pAdapter)) -+ // return (IS_MASKED(8821B,_MPCIE,Offset)) ? TRUE : FALSE; -+ -+#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE -+#ifdef CONFIG_RTL8188E_SDIO -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ return (IS_MASKED(8188E,_MSDIO,Offset)) ? TRUE : FALSE; -+#endif -+#ifdef CONFIG_RTL8188F_SDIO -+ if (IS_HARDWARE_TYPE_8188F(pAdapter)) -+ return (IS_MASKED(8188F, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#endif -+ -+ return FALSE; -+} -+ +//------------------------------------------------------------------------------ +u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) +{ -+#define RT_ASSERT_RET(expr) \ -+ if(!(expr)) { \ -+ printk( "Assertion failed! %s at ......\n", #expr); \ -+ printk( " ......%s,%s,line=%d\n",__FILE__,__FUNCTION__,__LINE__); \ -+ return _FAIL; \ -+ } -+ + u8 offset, word_en; + u8 *map; + u8 newdata[PGPKT_DATA_SIZE]; + s32 i, j, idx; + u8 ret = _SUCCESS; + u16 mapLen=0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, false); + + if ((addr + cnts) > mapLen) + return _FAIL; + -+ RT_ASSERT_RET(PGPKT_DATA_SIZE == 8); // have to be 8 byte alignment -+ RT_ASSERT_RET((mapLen & 0x7) == 0); // have to be PGPKT_DATA_SIZE alignment for memcpy -+ + map = rtw_zmalloc(mapLen); + if(map == NULL){ + return _FAIL; + } -+ -+ _rtw_memset(map, 0xFF, mapLen); -+ ++ + ret = rtw_efuse_map_read(padapter, 0, mapLen, map); + if (ret == _FAIL) goto exit; + -+ if(padapter->registrypriv.boffefusemask==0) -+ { -+ for (i =0; i < cnts; i++) -+ { -+ if(padapter->registrypriv.bFileMaskEfuse==_TRUE) -+ { -+ if (rtw_file_efuse_IsMasked(padapter, addr+i)) /*use file efuse mask. */ -+ data[i] = map[addr+i]; -+ } -+ else -+ { -+ if ( efuse_IsMasked(padapter, addr+i )) -+ data[i] = map[addr+i]; -+ } -+ DBG_8192C("%s , data[%d] = %x, map[addr+i]= %x\n", __func__, i, data[i], map[addr+i]); -+ } -+ } -+ Efuse_PowerSwitch(padapter, _TRUE, _TRUE); ++ Efuse_PowerSwitch(padapter, true, true); + -+ idx = 0; + offset = (addr >> 3); -+ while (idx < cnts) -+ { -+ word_en = 0xF; -+ j = (addr + idx) & 0x7; -+ _rtw_memcpy(newdata, &map[offset << 3], PGPKT_DATA_SIZE); -+ for (i = j; i> 1); ++ newdata[i-1] = map[addr+idx-1]; ++ newdata[i] = data[idx]; ++ } ++ i++; ++ idx++; ++ } ++ do { ++ for (; i < PGPKT_DATA_SIZE; i += 2) + { -+ if (data[idx] != map[addr + idx]) -+ { -+ word_en &= ~BIT(i >> 1); -+ newdata[i] = data[idx]; -+#ifdef CONFIG_RTL8723B -+ if( addr + idx == 0x8) -+ { -+ if (IS_C_CUT(pHalData->VersionID) || IS_B_CUT(pHalData->VersionID)) -+ { -+ if(pHalData->adjuseVoltageVal == 6) -+ { -+ newdata[i] = map[addr + idx]; -+ DBG_8192C(" %s ,\n adjuseVoltageVal = %d ,newdata[%d] = %x \n",__func__,pHalData->adjuseVoltageVal,i,newdata[i]); -+ } -+ } -+ } -+#endif ++ if (cnts == idx) break; ++ if ((cnts - idx) == 1) { ++ if (data[idx] != map[addr+idx]) { ++ word_en &= ~BIT(i >> 1); ++ newdata[i] = data[idx]; ++ newdata[i+1] = map[addr+idx+1]; ++ } ++ idx++; ++ break; ++ } else { ++ if ((data[idx] != map[addr+idx]) || ++ (data[idx+1] != map[addr+idx+1])) ++ { ++ word_en &= ~BIT(i >> 1); ++ newdata[i] = data[idx]; ++ newdata[i+1] = data[idx + 1]; ++ } ++ idx += 2; + } ++ if (idx == cnts) break; + } + + if (word_en != 0xF) { -+ ret = Efuse_PgPacketWrite(padapter, offset, word_en, newdata, _FALSE); ++ ret = Efuse_PgPacketWrite(padapter, offset, word_en, newdata, false); + DBG_871X("offset=%x \n",offset); + DBG_871X("word_en=%x \n",word_en); + @@ -1026,10 +815,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + if (ret == _FAIL) break; + } + -+ offset++; -+ } ++ if (idx == cnts) break; + -+ Efuse_PowerSwitch(padapter, _TRUE, _FALSE); ++ offset++; ++ i = 0; ++ j = 0; ++ word_en = 0xF; ++ _rtw_memset(newdata, 0xFF, PGPKT_DATA_SIZE); ++ } while (1); ++ ++ Efuse_PowerSwitch(padapter, true, false); + +exit: + @@ -1038,59 +833,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + return ret; +} + -+u8 rtw_efuse_mask_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) -+{ -+ u8 ret = _SUCCESS; -+ u16 mapLen = 0, i = 0; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); -+ -+ ret = rtw_efuse_map_read(padapter, addr, cnts , data); -+ -+ if (padapter->registrypriv.boffefusemask == 0) { -+ -+ for (i = 0; i < cnts; i++) { -+ if (padapter->registrypriv.bFileMaskEfuse == _TRUE) { -+ if (rtw_file_efuse_IsMasked(padapter, addr+i)) /*use file efuse mask.*/ -+ data[i] = 0xff; -+ } else { -+ /*DBG_8192C(" %s , data[%d] = %x\n", __func__, i, data[i]);*/ -+ if (efuse_IsMasked(padapter, addr+i)) { -+ data[i] = 0xff; -+ /*DBG_8192C(" %s ,mask data[%d] = %x\n", __func__, i, data[i]);*/ -+ } -+ } -+ } -+ -+ } -+ return ret; -+ -+} + ++//------------------------------------------------------------------------------ +u8 rtw_BT_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) +{ -+#define RT_ASSERT_RET(expr) \ -+ if(!(expr)) { \ -+ printk( "Assertion failed! %s at ......\n", #expr); \ -+ printk( " ......%s,%s,line=%d\n",__FILE__,__FUNCTION__,__LINE__); \ -+ return _FAIL; \ -+ } -+ + u8 offset, word_en; + u8 *map; + u8 newdata[PGPKT_DATA_SIZE]; -+ s32 i=0, j=0, idx; ++ s32 i, j, idx; + u8 ret = _SUCCESS; + u16 mapLen=0; + -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, false); + + if ((addr + cnts) > mapLen) + return _FAIL; + -+ RT_ASSERT_RET(PGPKT_DATA_SIZE == 8); // have to be 8 byte alignment -+ RT_ASSERT_RET((mapLen & 0x7) == 0); // have to be PGPKT_DATA_SIZE alignment for memcpy -+ + map = rtw_zmalloc(mapLen); + if(map == NULL){ + return _FAIL; @@ -1098,55 +856,76 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + + ret = rtw_BT_efuse_map_read(padapter, 0, mapLen, map); + if (ret == _FAIL) goto exit; -+ DBG_871X("OFFSET\tVALUE(hex)\n"); -+ for (i=0; i<1024; i+=16) // set 512 because the iwpriv's extra size have limit 0x7FF -+ { -+ DBG_871X("0x%03x\t", i); -+ for (j=0; j<8; j++) { -+ DBG_871X("%02X ", map[i+j]); -+ } -+ DBG_871X("\t"); -+ for (; j<16; j++) { -+ DBG_871X("%02X ", map[i+j]); -+ } -+ DBG_871X("\n"); -+ } -+ DBG_871X("\n"); -+ Efuse_PowerSwitch(padapter, _TRUE, _TRUE); + -+ idx = 0; ++ Efuse_PowerSwitch(padapter, true, true); ++ + offset = (addr >> 3); -+ while (idx < cnts) -+ { -+ word_en = 0xF; -+ j = (addr + idx) & 0x7; -+ _rtw_memcpy(newdata, &map[offset << 3], PGPKT_DATA_SIZE); -+ for (i = j; i> 1); ++ newdata[i-1] = map[addr+idx-1]; ++ newdata[i] = data[idx]; ++ } ++ i++; ++ idx++; ++ } ++ do { ++ for (; i < PGPKT_DATA_SIZE; i += 2) + { -+ if (data[idx] != map[addr + idx]) -+ { -+ word_en &= ~BIT(i >> 1); -+ newdata[i] = data[idx]; ++ if (cnts == idx) break; ++ if ((cnts - idx) == 1) { ++ if (data[idx] != map[addr+idx]) { ++ word_en &= ~BIT(i >> 1); ++ newdata[i] = data[idx]; ++ newdata[i+1] = map[addr+idx+1]; ++ } ++ idx++; ++ break; ++ } else { ++ if ((data[idx] != map[addr+idx]) || ++ (data[idx+1] != map[addr+idx+1])) ++ { ++ word_en &= ~BIT(i >> 1); ++ newdata[i] = data[idx]; ++ newdata[i+1] = data[idx + 1]; ++ } ++ idx += 2; + } ++ if (idx == cnts) break; + } + -+ if (word_en != 0xF) { -+ DBG_871X("offset=%x \n",offset); -+ DBG_871X("word_en=%x \n",word_en); ++ if (word_en != 0xF) ++ { ++ DBG_871X("%s: offset=%#X\n", __FUNCTION__, offset); ++ DBG_871X("%s: word_en=%#X\n", __FUNCTION__, word_en); + DBG_871X("%s: data=", __FUNCTION__); -+ for(i=0;iefuse_eeprom_data[Offset]; ++ *Value = pEEPROM->efuse_eeprom_data[Offset]; + +} // EFUSE_ShadowRead1Byte + +//---------------Read Two Bytes -+static VOID ++static void +efuse_ShadowRead2Byte( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN OUT u16 *Value) ++ PADAPTER pAdapter, ++ u16 Offset, ++ u16 *Value) +{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); + -+ *Value = pHalData->efuse_eeprom_data[Offset]; -+ *Value |= pHalData->efuse_eeprom_data[Offset+1]<<8; ++ *Value = pEEPROM->efuse_eeprom_data[Offset]; ++ *Value |= pEEPROM->efuse_eeprom_data[Offset+1]<<8; + +} // EFUSE_ShadowRead2Byte + +//---------------Read Four Bytes -+static VOID ++static void +efuse_ShadowRead4Byte( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN OUT u32 *Value) ++ PADAPTER pAdapter, ++ u16 Offset, ++ u32 *Value) +{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); + -+ *Value = pHalData->efuse_eeprom_data[Offset]; -+ *Value |= pHalData->efuse_eeprom_data[Offset+1]<<8; -+ *Value |= pHalData->efuse_eeprom_data[Offset+2]<<16; -+ *Value |= pHalData->efuse_eeprom_data[Offset+3]<<24; ++ *Value = pEEPROM->efuse_eeprom_data[Offset]; ++ *Value |= pEEPROM->efuse_eeprom_data[Offset+1]<<8; ++ *Value |= pEEPROM->efuse_eeprom_data[Offset+2]<<16; ++ *Value |= pEEPROM->efuse_eeprom_data[Offset+3]<<24; + +} // efuse_ShadowRead4Byte + @@ -1274,54 +1053,46 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + * 11/12/2008 MHC Create Version 0. + * + *---------------------------------------------------------------------------*/ -+#ifdef PLATFORM -+static VOID -+efuse_ShadowWrite1Byte( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN u8 Value); -+#endif //PLATFORM -+static VOID -+efuse_ShadowWrite1Byte( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN u8 Value) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); + -+ pHalData->efuse_eeprom_data[Offset] = Value; ++static void ++efuse_ShadowWrite1Byte( ++ PADAPTER pAdapter, ++ u16 Offset, ++ u8 Value) ++{ ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); ++ ++ pEEPROM->efuse_eeprom_data[Offset] = Value; + +} // efuse_ShadowWrite1Byte + +//---------------Write Two Bytes -+static VOID ++static void +efuse_ShadowWrite2Byte( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN u16 Value) ++ PADAPTER pAdapter, ++ u16 Offset, ++ u16 Value) +{ -+ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); + -+ pHalData->efuse_eeprom_data[Offset] = Value&0x00FF; -+ pHalData->efuse_eeprom_data[Offset+1] = Value>>8; ++ pEEPROM->efuse_eeprom_data[Offset] = Value&0x00FF; ++ pEEPROM->efuse_eeprom_data[Offset+1] = Value>>8; + +} // efuse_ShadowWrite1Byte + +//---------------Write Four Bytes -+static VOID ++static void +efuse_ShadowWrite4Byte( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN u32 Value) ++ PADAPTER pAdapter, ++ u16 Offset, ++ u32 Value) +{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); + -+ pHalData->efuse_eeprom_data[Offset] = (u8)(Value&0x000000FF); -+ pHalData->efuse_eeprom_data[Offset+1] = (u8)((Value>>8)&0x0000FF); -+ pHalData->efuse_eeprom_data[Offset+2] = (u8)((Value>>16)&0x00FF); -+ pHalData->efuse_eeprom_data[Offset+3] = (u8)((Value>>24)&0xFF); ++ pEEPROM->efuse_eeprom_data[Offset] = (u8)(Value&0x000000FF); ++ pEEPROM->efuse_eeprom_data[Offset+1] = (u8)((Value>>8)&0x0000FF); ++ pEEPROM->efuse_eeprom_data[Offset+2] = (u8)((Value>>16)&0x00FF); ++ pEEPROM->efuse_eeprom_data[Offset+3] = (u8)((Value>>24)&0xFF); + +} // efuse_ShadowWrite1Byte + @@ -1342,35 +1113,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + * + *---------------------------------------------------------------------------*/ +void EFUSE_ShadowMapUpdate( -+ IN PADAPTER pAdapter, -+ IN u8 efuseType, -+ IN BOOLEAN bPseudoTest) ++ PADAPTER pAdapter, ++ u8 efuseType, ++ bool bPseudoTest) +{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); + u16 mapLen=0; + -+ EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, bPseudoTest); ++ EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, bPseudoTest); + -+ if (pHalData->bautoload_fail_flag == _TRUE) ++ if (pEEPROM->bautoload_fail_flag == true) + { -+ _rtw_memset(pHalData->efuse_eeprom_data, 0xFF, mapLen); ++ _rtw_memset(pEEPROM->efuse_eeprom_data, 0xFF, mapLen); + } + else + { + #ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+ if(_SUCCESS != retriveAdaptorInfoFile(pAdapter->registrypriv.adaptor_info_caching_file_path, pHalData->efuse_eeprom_data)) { ++ if(_SUCCESS != retriveAdaptorInfoFile(pAdapter->registrypriv.adaptor_info_caching_file_path, pEEPROM)) { + #endif + -+ Efuse_ReadAllMap(pAdapter, efuseType, pHalData->efuse_eeprom_data, bPseudoTest); ++ Efuse_ReadAllMap(pAdapter, efuseType, pEEPROM->efuse_eeprom_data, bPseudoTest); + + #ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+ storeAdaptorInfoFile(pAdapter->registrypriv.adaptor_info_caching_file_path, pHalData->efuse_eeprom_data); ++ storeAdaptorInfoFile(pAdapter->registrypriv.adaptor_info_caching_file_path, pEEPROM); + } + #endif + } + -+ //PlatformMoveMemory((PVOID)&pHalData->EfuseMap[EFUSE_MODIFY_MAP][0], -+ //(PVOID)&pHalData->EfuseMap[EFUSE_INIT_MAP][0], mapLen); ++ //PlatformMoveMemory((void *)&pHalData->EfuseMap[EFUSE_MODIFY_MAP][0], ++ //(void *)&pHalData->EfuseMap[EFUSE_INIT_MAP][0], mapLen); +}// EFUSE_ShadowMapUpdate + + @@ -1392,10 +1163,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + *---------------------------------------------------------------------------*/ +void +EFUSE_ShadowRead( -+ IN PADAPTER pAdapter, -+ IN u8 Type, -+ IN u16 Offset, -+ IN OUT u32 *Value ) ++ PADAPTER pAdapter, ++ u8 Type, ++ u16 Offset, ++ u32 *Value ) +{ + if (Type == 1) + efuse_ShadowRead1Byte(pAdapter, Offset, (u8 *)Value); @@ -1422,18 +1193,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + * 11/12/2008 MHC Create Version 0. + * + *---------------------------------------------------------------------------*/ -+VOID ++void +EFUSE_ShadowWrite( -+ IN PADAPTER pAdapter, -+ IN u8 Type, -+ IN u16 Offset, -+ IN OUT u32 Value); -+VOID ++ PADAPTER pAdapter, ++ u8 Type, ++ u16 Offset, ++ u32 Value); ++void +EFUSE_ShadowWrite( -+ IN PADAPTER pAdapter, -+ IN u8 Type, -+ IN u16 Offset, -+ IN OUT u32 Value) ++ PADAPTER pAdapter, ++ u8 Type, ++ u16 Offset, ++ u32 Value) +{ +#if (MP_DRIVER == 0) + return; @@ -1451,51 +1222,49 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + +} // EFUSE_ShadowWrite + -+VOID ++void +Efuse_InitSomeVar( -+ IN PADAPTER pAdapter ++ PADAPTER pAdapter + ); -+VOID ++void +Efuse_InitSomeVar( -+ IN PADAPTER pAdapter ++ PADAPTER pAdapter + ) +{ + u8 i; + -+ _rtw_memset((PVOID)&fakeEfuseContent[0], 0xff, EFUSE_MAX_HW_SIZE); -+ _rtw_memset((PVOID)&fakeEfuseInitMap[0], 0xff, EFUSE_MAX_MAP_LEN); -+ _rtw_memset((PVOID)&fakeEfuseModifiedMap[0], 0xff, EFUSE_MAX_MAP_LEN); ++ _rtw_memset((void *)&fakeEfuseContent[0], 0xff, EFUSE_MAX_HW_SIZE); ++ _rtw_memset((void *)&fakeEfuseInitMap[0], 0xff, EFUSE_MAX_MAP_LEN); ++ _rtw_memset((void *)&fakeEfuseModifiedMap[0], 0xff, EFUSE_MAX_MAP_LEN); + + for(i=0; i + + int isAdaptorInfoFileValid(void) +{ -+ return _TRUE; ++ return true; +} + -+int storeAdaptorInfoFile(char *path, u8* efuse_data) ++int storeAdaptorInfoFile(char *path, struct eeprom_priv * eeprom_priv) +{ + int ret =_SUCCESS; + -+ if(path && efuse_data) { -+ ret = rtw_store_to_file(path, efuse_data, EEPROM_MAX_SIZE_512); ++ if(path && eeprom_priv) { ++ ret = rtw_store_to_file(path, eeprom_priv->efuse_eeprom_data, EEPROM_MAX_SIZE_512); + if(ret == EEPROM_MAX_SIZE) + ret = _SUCCESS; + else @@ -1507,15 +1276,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + return ret; +} + -+int retriveAdaptorInfoFile(char *path, u8* efuse_data) ++int retriveAdaptorInfoFile(char *path, struct eeprom_priv * eeprom_priv) +{ + int ret = _SUCCESS; + mm_segment_t oldfs; + struct file *fp; + -+ if(path && efuse_data) { ++ if(path && eeprom_priv) { + -+ ret = rtw_retrieve_from_file(path, efuse_data, EEPROM_MAX_SIZE); ++ ret = rtw_retrive_from_file(path, eeprom_priv->efuse_eeprom_data, EEPROM_MAX_SIZE); + + if(ret == EEPROM_MAX_SIZE) + ret = _SUCCESS; @@ -1536,5634 +1305,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux/3rdparty/rt + } + return ret; +} -+#endif /* CONFIG_ADAPTOR_INFO_CACHING_FILE */ -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+u32 rtw_read_efuse_from_file(const char *path, u8 *buf) -+{ -+ u32 i; -+ u8 temp[3]; -+ u32 ret = _FAIL; -+ -+ struct file *fp; -+ mm_segment_t fs; -+ loff_t pos = 0; -+ -+ fp = filp_open(path, O_RDONLY, 0); -+ if (fp == NULL || IS_ERR(fp)) { -+ if (fp != NULL) -+ DBG_871X_LEVEL(_drv_always_, "%s open %s fail, err:%ld\n" -+ , __func__, path, PTR_ERR(fp)); -+ else -+ DBG_871X_LEVEL(_drv_always_, "%s open %s fail, fp is NULL\n" -+ , __func__, path); -+ -+ goto exit; -+ } -+ -+ temp[2] = 0; /* add end of string '\0' */ -+ -+ fs = get_fs(); -+ set_fs(KERNEL_DS); -+ -+ for (i = 0 ; i < HWSET_MAX_SIZE ; i++) { -+ vfs_read(fp, temp, 2, &pos); -+ if (sscanf(temp, "%hhx", &buf[i]) != 1) { -+ if (0) -+ DBG_871X_LEVEL(_drv_err_, "%s sscanf fail\n", __func__); -+ buf[i] = 0xFF; -+ } -+ if ((i % EFUSE_FILE_COLUMN_NUM) == (EFUSE_FILE_COLUMN_NUM - 1)) { -+ /* Filter the lates space char. */ -+ vfs_read(fp, temp, 1, &pos); -+ if (strchr(temp, ' ') == NULL) { -+ pos--; -+ vfs_read(fp, temp, 2, &pos); -+ } -+ } else { -+ pos += 1; /* Filter the space character */ -+ } -+ } -+ -+ set_fs(fs); -+ -+ DBG_871X_LEVEL(_drv_always_, "efuse file: %s\n", path); -+#ifdef CONFIG_DEBUG -+ for (i = 0; i < HWSET_MAX_SIZE; i++) { -+ if (i % 16 == 0) -+ DBG_871X_SEL_NL(RTW_DBGDUMP, "0x%03x: ", i); -+ -+ DBG_871X_SEL(RTW_DBGDUMP, "%02X%s" -+ , buf[i] -+ , ((i + 1) % 16 == 0) ? "\n" : (((i + 1) % 8 == 0) ? " " : " ") -+ ); -+ } -+ DBG_871X_SEL(RTW_DBGDUMP, "\n"); -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+u32 rtw_read_macaddr_from_file(const char *path, u8 *buf) -+{ -+ struct file *fp; -+ mm_segment_t fs; -+ loff_t pos = 0; -+ -+ u8 source_addr[18]; -+ u8 *head, *end; -+ int i; -+ u32 ret = _FAIL; -+ -+ _rtw_memset(source_addr, 0, 18); -+ -+ fp = filp_open(path, O_RDONLY, 0); -+ if (fp == NULL || IS_ERR(fp)) { -+ if (fp != NULL) -+ DBG_871X_LEVEL(_drv_always_, "%s open %s fail, err:%ld\n" -+ , __func__, path, PTR_ERR(fp)); -+ else -+ DBG_871X_LEVEL(_drv_always_, "%s open %s fail, fp is NULL\n" -+ , __func__, path); -+ -+ goto exit; -+ } -+ -+ fs = get_fs(); -+ set_fs(KERNEL_DS); -+ -+ vfs_read(fp, source_addr, 18, &pos); -+ source_addr[17] = ':'; -+ -+ head = end = source_addr; -+ for (i = 0; i < ETH_ALEN; i++) { -+ while (end && (*end != ':')) -+ end++; -+ -+ if (end && (*end == ':')) -+ *end = '\0'; -+ -+ if (sscanf(head, "%hhx", &buf[i]) != 1) { -+ if (0) -+ DBG_871X_LEVEL(_drv_err_, "%s sscanf fail\n", __func__); -+ buf[i] = 0xFF; -+ } -+ -+ if (end) { -+ end++; -+ head = end; -+ } -+ } -+ -+ set_fs(fs); -+ -+ DBG_871X_LEVEL(_drv_always_, "wifi_mac file: %s\n", path); -+#ifdef CONFIG_DEBUG -+ DBG_871X(MAC_FMT"\n", MAC_ARG(buf)); -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_EFUSE_CONFIG_FILE */ -+ -+#endif /* PLATFORM_LINUX */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ap.c linux/3rdparty/rtl8812au/core/rtw_ap.c ---- linux.old/3rdparty/rtl8812au/core/rtw_ap.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_ap.c 2017-06-07 23:07:20.998686391 +0300 -@@ -0,0 +1,4230 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_AP_C_ -+ -+#include -+ -+ -+#ifdef CONFIG_AP_MODE -+ -+extern unsigned char RTW_WPA_OUI[]; -+extern unsigned char WMM_OUI[]; -+extern unsigned char WPS_OUI[]; -+extern unsigned char P2P_OUI[]; -+extern unsigned char WFD_OUI[]; -+ -+void init_mlme_ap_info(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ -+ -+ _rtw_spinlock_init(&pmlmepriv->bcn_update_lock); -+ -+ //for ACL -+ _rtw_init_queue(&pacl_list->acl_node_q); -+ -+ //pmlmeext->bstart_bss = _FALSE; -+ -+ start_ap_mode(padapter); -+} -+ -+void free_mlme_ap_info(_adapter *padapter) -+{ -+ _irqL irqL; -+ struct sta_info *psta=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ //stop_ap_mode(padapter); -+ -+ pmlmepriv->update_bcn = _FALSE; -+ pmlmeext->bstart_bss = _FALSE; -+ -+ rtw_sta_flush(padapter, _TRUE); -+ -+ pmlmeinfo->state = _HW_STATE_NOLINK_; -+ -+ //free_assoc_sta_resources -+ rtw_free_all_stainfo(padapter); -+ -+ //free bc/mc sta_info -+ psta = rtw_get_bcmc_stainfo(padapter); -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ rtw_free_stainfo(padapter, psta); -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ -+ _rtw_spinlock_free(&pmlmepriv->bcn_update_lock); -+ -+} -+ -+static void update_BCNTIM(_adapter *padapter) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork_mlmeext = &(pmlmeinfo->network); -+ unsigned char *pie = pnetwork_mlmeext->IEs; -+ -+/* -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ //update TIM IE -+ //if(pstapriv->tim_bitmap) -+*/ -+ if (_TRUE) { -+ u8 *p, *dst_ie, *premainder_ie = NULL, *pbackup_remainder_ie = NULL; -+ u16 tim_bitmap_le; -+ uint offset, tmp_len, tim_ielen, tim_ie_offset, remainder_ielen; -+ -+ tim_bitmap_le = cpu_to_le16(pstapriv->tim_bitmap); -+ -+ p = rtw_get_ie(pie + _FIXED_IE_LENGTH_, _TIM_IE_, &tim_ielen, pnetwork_mlmeext->IELength - _FIXED_IE_LENGTH_); -+ if (p != NULL && tim_ielen > 0) { -+ tim_ielen += 2; -+ -+ premainder_ie = p + tim_ielen; -+ -+ tim_ie_offset = (sint)(p -pie); -+ -+ remainder_ielen = pnetwork_mlmeext->IELength - tim_ie_offset - tim_ielen; -+ -+ /*append TIM IE from dst_ie offset*/ -+ dst_ie = p; -+ } else { -+ tim_ielen = 0; -+ -+ /*calculate head_len*/ -+ offset = _FIXED_IE_LENGTH_; -+ -+ /* get ssid_ie len */ -+ p = rtw_get_ie(pie + _BEACON_IE_OFFSET_, _SSID_IE_, &tmp_len, (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_)); -+ if (p != NULL) -+ offset += tmp_len+2; -+ -+ /*get supported rates len*/ -+ p = rtw_get_ie(pie + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &tmp_len, (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_)); -+ if (p != NULL) -+ { -+ offset += tmp_len+2; -+ } -+ -+ /*DS Parameter Set IE, len=3*/ -+ offset += 3; -+ -+ premainder_ie = pie + offset; -+ -+ remainder_ielen = pnetwork_mlmeext->IELength - offset - tim_ielen; -+ -+ /*append TIM IE from offset*/ -+ dst_ie = pie + offset; -+ -+ } -+ -+ if (remainder_ielen > 0) { -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if(pbackup_remainder_ie && premainder_ie) -+ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ *dst_ie++=_TIM_IE_; -+ -+ if ((pstapriv->tim_bitmap&0xff00) && (pstapriv->tim_bitmap&0x00fe)) -+ tim_ielen = 5; -+ else -+ tim_ielen = 4; -+ -+ *dst_ie++ = tim_ielen; -+ -+ *dst_ie++ = 0;/*DTIM count*/ -+ *dst_ie++ = 1;/*DTIM period*/ -+ -+ if (pstapriv->tim_bitmap & BIT(0))/*for bc/mc frames*/ -+ *dst_ie++ = BIT(0);/*bitmap ctrl */ -+ else -+ *dst_ie++ = 0; -+ -+ if (tim_ielen == 4) { -+ u8 pvb = 0; -+ -+ if (pstapriv->tim_bitmap & 0x00fe) -+ pvb = (u8)tim_bitmap_le; -+ else if (pstapriv->tim_bitmap & 0xff00) -+ pvb = (u8)(tim_bitmap_le >> 8); -+ else -+ pvb = (u8)tim_bitmap_le; -+ -+ *dst_ie++ = pvb; -+ -+ } else if (tim_ielen == 5) { -+ _rtw_memcpy(dst_ie, &tim_bitmap_le, 2); -+ dst_ie += 2; -+ } -+ -+ /*copy remainder IE*/ -+ if (pbackup_remainder_ie) { -+ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ rtw_mfree(pbackup_remainder_ie, remainder_ielen); -+ } -+ -+ offset = (uint)(dst_ie - pie); -+ pnetwork_mlmeext->IELength = offset + remainder_ielen; -+ -+ } -+} -+ -+void rtw_add_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index, u8 *data, u8 len) -+{ -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 bmatch = _FALSE; -+ u8 *pie = pnetwork->IEs; -+ u8 *p=NULL, *dst_ie=NULL, *premainder_ie=NULL, *pbackup_remainder_ie=NULL; -+ u32 i, offset, ielen, ie_offset, remainder_ielen = 0; -+ -+ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pnetwork->IELength;) -+ { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pnetwork->IEs + i); -+ -+ if (pIE->ElementID > index) -+ { -+ break; -+ } -+ else if(pIE->ElementID == index) // already exist the same IE -+ { -+ p = (u8 *)pIE; -+ ielen = pIE->Length; -+ bmatch = _TRUE; -+ break; -+ } -+ -+ p = (u8 *)pIE; -+ ielen = pIE->Length; -+ i += (pIE->Length + 2); -+ } -+ -+ if (p != NULL && ielen>0) -+ { -+ ielen += 2; -+ -+ premainder_ie = p+ielen; -+ -+ ie_offset = (sint)(p -pie); -+ -+ remainder_ielen = pnetwork->IELength - ie_offset - ielen; -+ -+ if(bmatch) -+ dst_ie = p; -+ else -+ dst_ie = (p+ielen); -+ } -+ -+ if(dst_ie == NULL) -+ return; -+ -+ if(remainder_ielen>0) -+ { -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if(pbackup_remainder_ie && premainder_ie) -+ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ *dst_ie++=index; -+ *dst_ie++=len; -+ -+ _rtw_memcpy(dst_ie, data, len); -+ dst_ie+=len; -+ -+ //copy remainder IE -+ if(pbackup_remainder_ie) -+ { -+ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ rtw_mfree(pbackup_remainder_ie, remainder_ielen); -+ } -+ -+ offset = (uint)(dst_ie - pie); -+ pnetwork->IELength = offset + remainder_ielen; -+} -+ -+void rtw_remove_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index) -+{ -+ u8 *p, *dst_ie=NULL, *premainder_ie=NULL, *pbackup_remainder_ie=NULL; -+ uint offset, ielen, ie_offset, remainder_ielen = 0; -+ u8 *pie = pnetwork->IEs; -+ -+ p = rtw_get_ie(pie + _FIXED_IE_LENGTH_, index, &ielen, pnetwork->IELength - _FIXED_IE_LENGTH_); -+ if (p != NULL && ielen>0) -+ { -+ ielen += 2; -+ -+ premainder_ie = p+ielen; -+ -+ ie_offset = (sint)(p -pie); -+ -+ remainder_ielen = pnetwork->IELength - ie_offset - ielen; -+ -+ dst_ie = p; -+ } -+ else { -+ return; -+ } -+ -+ if(remainder_ielen>0) -+ { -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if(pbackup_remainder_ie && premainder_ie) -+ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ //copy remainder IE -+ if(pbackup_remainder_ie) -+ { -+ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ rtw_mfree(pbackup_remainder_ie, remainder_ielen); -+ } -+ -+ offset = (uint)(dst_ie - pie); -+ pnetwork->IELength = offset + remainder_ielen; -+} -+ -+ -+u8 chk_sta_is_alive(struct sta_info *psta); -+u8 chk_sta_is_alive(struct sta_info *psta) -+{ -+ u8 ret = _FALSE; -+ #ifdef DBG_EXPIRATION_CHK -+ DBG_871X("sta:"MAC_FMT", rssi:%d, rx:"STA_PKTS_FMT", expire_to:%u, %s%ssq_len:%u\n" -+ , MAC_ARG(psta->hwaddr) -+ , psta->rssi_stat.UndecoratedSmoothedPWDB -+ //, STA_RX_PKTS_ARG(psta) -+ , STA_RX_PKTS_DIFF_ARG(psta) -+ , psta->expire_to -+ , psta->state&WIFI_SLEEP_STATE?"PS, ":"" -+ , psta->state&WIFI_STA_ALIVE_CHK_STATE?"SAC, ":"" -+ , psta->sleepq_len -+ ); -+ #endif -+ -+ //if(sta_last_rx_pkts(psta) == sta_rx_pkts(psta)) -+ if((psta->sta_stats.last_rx_data_pkts + psta->sta_stats.last_rx_ctrl_pkts) == (psta->sta_stats.rx_data_pkts + psta->sta_stats.rx_ctrl_pkts)) -+ { -+ #if 0 -+ if(psta->state&WIFI_SLEEP_STATE) -+ ret = _TRUE; -+ #endif -+ } -+ else -+ { -+ ret = _TRUE; -+ } -+ -+ sta_update_last_rx_pkts(psta); -+ -+ return ret; -+} -+ -+void expire_timeout_chk(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ u8 updated = _FALSE; -+ struct sta_info *psta=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 chk_alive_num = 0; -+ char chk_alive_list[NUM_STA]; -+ int i; -+ -+ -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ -+ phead = &pstapriv->auth_list; -+ plist = get_next(phead); -+ -+ //check auth_queue -+ #ifdef DBG_EXPIRATION_CHK -+ if (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ DBG_871X(FUNC_NDEV_FMT" auth_list, cnt:%u\n" -+ , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->auth_list_cnt); -+ } -+ #endif -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, auth_list); -+ -+ plist = get_next(plist); -+ -+ -+#ifdef CONFIG_ATMEL_RC_PATCH -+ if (_TRUE == _rtw_memcmp((void *)(pstapriv->atmel_rc_pattern), (void *)(psta->hwaddr), ETH_ALEN)) -+ continue; -+ if (psta->flag_atmel_rc) -+ continue; -+#endif -+ if(psta->expire_to>0) -+ { -+ psta->expire_to--; -+ if (psta->expire_to == 0) -+ { -+ rtw_list_delete(&psta->auth_list); -+ pstapriv->auth_list_cnt--; -+ -+ DBG_871X("auth expire %02X%02X%02X%02X%02X%02X\n", -+ psta->hwaddr[0],psta->hwaddr[1],psta->hwaddr[2],psta->hwaddr[3],psta->hwaddr[4],psta->hwaddr[5]); -+ -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ rtw_free_stainfo(padapter, psta); -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ } -+ } -+ -+ } -+ -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ psta = NULL; -+ -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ //check asoc_queue -+ #ifdef DBG_EXPIRATION_CHK -+ if (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ DBG_871X(FUNC_NDEV_FMT" asoc_list, cnt:%u\n" -+ , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->asoc_list_cnt); -+ } -+ #endif -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+#ifdef CONFIG_ATMEL_RC_PATCH -+ DBG_871X("%s:%d psta=%p, %02x,%02x||%02x,%02x \n\n", __func__, __LINE__, -+ psta,pstapriv->atmel_rc_pattern[0], pstapriv->atmel_rc_pattern[5], psta->hwaddr[0], psta->hwaddr[5]); -+ if (_TRUE == _rtw_memcmp((void *)pstapriv->atmel_rc_pattern, (void *)(psta->hwaddr), ETH_ALEN)) -+ continue; -+ if (psta->flag_atmel_rc) -+ continue; -+ DBG_871X("%s: debug line:%d \n", __func__, __LINE__); -+#endif -+#ifdef CONFIG_AUTO_AP_MODE -+ if(psta->isrc) -+ continue; -+#endif -+ if (chk_sta_is_alive(psta) || !psta->expire_to) { -+ psta->expire_to = pstapriv->expire_to; -+ psta->keep_alive_trycnt = 0; -+ #ifdef CONFIG_TX_MCAST2UNI -+ psta->under_exist_checking = 0; -+ #endif // CONFIG_TX_MCAST2UNI -+ } else { -+ psta->expire_to--; -+ } -+ -+#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+#ifdef CONFIG_80211N_HT -+#ifdef CONFIG_TX_MCAST2UNI -+ if ( (psta->flags & WLAN_STA_HT) && (psta->htpriv.agg_enable_bitmap || psta->under_exist_checking) ) { -+ // check sta by delba(addba) for 11n STA -+ // ToDo: use CCX report to check for all STAs -+ //DBG_871X("asoc check by DELBA/ADDBA! (pstapriv->expire_to=%d s)(psta->expire_to=%d s), [%02x, %d]\n", pstapriv->expire_to*2, psta->expire_to*2, psta->htpriv.agg_enable_bitmap, psta->under_exist_checking); -+ -+ if ( psta->expire_to <= (pstapriv->expire_to - 50 ) ) { -+ DBG_871X("asoc expire by DELBA/ADDBA! (%d s)\n", (pstapriv->expire_to-psta->expire_to)*2); -+ psta->under_exist_checking = 0; -+ psta->expire_to = 0; -+ } else if ( psta->expire_to <= (pstapriv->expire_to - 3) && (psta->under_exist_checking==0)) { -+ DBG_871X("asoc check by DELBA/ADDBA! (%d s)\n", (pstapriv->expire_to-psta->expire_to)*2); -+ psta->under_exist_checking = 1; -+ //tear down TX AMPDU -+ send_delba(padapter, 1, psta->hwaddr);// // originator -+ psta->htpriv.agg_enable_bitmap = 0x0;//reset -+ psta->htpriv.candidate_tid_bitmap = 0x0;//reset -+ } -+ } -+#endif //CONFIG_TX_MCAST2UNI -+#endif //CONFIG_80211N_HT -+#endif //CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ -+ if (psta->expire_to <= 0) -+ { -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (padapter->registrypriv.wifi_spec == 1) -+ { -+ psta->expire_to = pstapriv->expire_to; -+ continue; -+ } -+ -+#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+#ifdef CONFIG_80211N_HT -+ -+#define KEEP_ALIVE_TRYCNT (3) -+ -+ if(psta->keep_alive_trycnt > 0 && psta->keep_alive_trycnt <= KEEP_ALIVE_TRYCNT) -+ { -+ if(psta->state & WIFI_STA_ALIVE_CHK_STATE) -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ else -+ psta->keep_alive_trycnt = 0; -+ -+ } -+ else if((psta->keep_alive_trycnt > KEEP_ALIVE_TRYCNT) && !(psta->state & WIFI_STA_ALIVE_CHK_STATE)) -+ { -+ psta->keep_alive_trycnt = 0; -+ } -+ if((psta->htpriv.ht_option==_TRUE) && (psta->htpriv.ampdu_enable==_TRUE)) -+ { -+ uint priority = 1; //test using BK -+ u8 issued=0; -+ -+ //issued = (psta->htpriv.agg_enable_bitmap>>priority)&0x1; -+ issued |= (psta->htpriv.candidate_tid_bitmap>>priority)&0x1; -+ -+ if(0==issued) -+ { -+ if (!(psta->state & WIFI_STA_ALIVE_CHK_STATE)) -+ { -+ psta->htpriv.candidate_tid_bitmap |= BIT((u8)priority); -+ -+ if (psta->state & WIFI_SLEEP_STATE) -+ psta->expire_to = 2; // 2x2=4 sec -+ else -+ psta->expire_to = 1; // 2 sec -+ -+ psta->state |= WIFI_STA_ALIVE_CHK_STATE; -+ -+ //add_ba_hdl(padapter, (u8*)paddbareq_parm); -+ -+ DBG_871X("issue addba_req to check if sta alive, keep_alive_trycnt=%d\n", psta->keep_alive_trycnt); -+ -+ issue_addba_req(padapter, psta->hwaddr, (u8)priority); -+ -+ _set_timer(&psta->addba_retry_timer, ADDBA_TO); -+ -+ psta->keep_alive_trycnt++; -+ -+ continue; -+ } -+ } -+ } -+ if(psta->keep_alive_trycnt > 0 && psta->state & WIFI_STA_ALIVE_CHK_STATE) -+ { -+ psta->keep_alive_trycnt = 0; -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ DBG_871X("change to another methods to check alive if staion is at ps mode\n"); -+ } -+ -+#endif //CONFIG_80211N_HT -+#endif //CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ if (psta->state & WIFI_SLEEP_STATE) { -+ if (!(psta->state & WIFI_STA_ALIVE_CHK_STATE)) { -+ //to check if alive by another methods if staion is at ps mode. -+ psta->expire_to = pstapriv->expire_to; -+ psta->state |= WIFI_STA_ALIVE_CHK_STATE; -+ -+ //DBG_871X("alive chk, sta:" MAC_FMT " is at ps mode!\n", MAC_ARG(psta->hwaddr)); -+ -+ //to update bcn with tim_bitmap for this station -+ pstapriv->tim_bitmap |= BIT(psta->aid); -+ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); -+ -+ if(!pmlmeext->active_keep_alive_check) -+ continue; -+ } -+ } -+ #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ if (pmlmeext->active_keep_alive_check) { -+ int stainfo_offset; -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) { -+ chk_alive_list[chk_alive_num++] = stainfo_offset; -+ } -+ -+ continue; -+ } -+ #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ DBG_871X("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state); -+ updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); -+ } -+ else -+ { -+ /* TODO: Aging mechanism to digest frames in sleep_q to avoid running out of xmitframe */ -+ if (psta->sleepq_len > (NR_XMITFRAME/pstapriv->asoc_list_cnt) -+ && padapter->xmitpriv.free_xmitframe_cnt < ((NR_XMITFRAME/pstapriv->asoc_list_cnt)/2) -+ ){ -+ DBG_871X("%s sta:"MAC_FMT", sleepq_len:%u, free_xmitframe_cnt:%u, asoc_list_cnt:%u, clear sleep_q\n", __func__ -+ , MAC_ARG(psta->hwaddr) -+ , psta->sleepq_len, padapter->xmitpriv.free_xmitframe_cnt, pstapriv->asoc_list_cnt); -+ wakeup_sta_to_xmit(padapter, psta); -+ } -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+if (chk_alive_num) { -+ -+ u8 backup_oper_channel=0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ /* switch to correct channel of current network before issue keep-alive frames */ -+ if (rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) { -+ backup_oper_channel = rtw_get_oper_ch(padapter); -+ SelectChannel(padapter, pmlmeext->cur_channel); -+ } -+ -+ /* issue null data to check sta alive*/ -+ for (i = 0; i < chk_alive_num; i++) { -+ int ret = _FAIL; -+ -+ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); -+#ifdef CONFIG_ATMEL_RC_PATCH -+ if (_TRUE == _rtw_memcmp( pstapriv->atmel_rc_pattern, psta->hwaddr, ETH_ALEN)) -+ continue; -+ if (psta->flag_atmel_rc) -+ continue; -+#endif -+ if(!(psta->state &_FW_LINKED)) -+ continue; -+ -+ if (psta->state & WIFI_SLEEP_STATE) -+ ret = issue_nulldata(padapter, psta->hwaddr, 0, 1, 50); -+ else -+ ret = issue_nulldata(padapter, psta->hwaddr, 0, 3, 50); -+ -+ psta->keep_alive_trycnt++; -+ if (ret == _SUCCESS) -+ { -+ DBG_871X("asoc check, sta(" MAC_FMT ") is alive\n", MAC_ARG(psta->hwaddr)); -+ psta->expire_to = pstapriv->expire_to; -+ psta->keep_alive_trycnt = 0; -+ continue; -+ } -+ else if (psta->keep_alive_trycnt <= 3) -+ { -+ DBG_871X("ack check for asoc expire, keep_alive_trycnt=%d\n", psta->keep_alive_trycnt); -+ psta->expire_to = 1; -+ continue; -+ } -+ -+ psta->keep_alive_trycnt = 0; -+ DBG_871X("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state); -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&psta->asoc_list)==_FALSE) { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ } -+ -+ if (backup_oper_channel>0) /* back to the original operation channel */ -+ SelectChannel(padapter, backup_oper_channel); -+} -+#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); -+} -+ -+void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level) -+{ -+ int i; -+ u8 rf_type; -+ unsigned char sta_band = 0, shortGIrate = _FALSE; -+ u64 tx_ra_bitmap = 0; -+ struct ht_priv *psta_ht = NULL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ -+#ifdef CONFIG_80211N_HT -+ if(psta) -+ psta_ht = &psta->htpriv; -+ else -+ return; -+#endif //CONFIG_80211N_HT -+ -+ if(!(psta->state & _FW_LINKED)) -+ return; -+ -+#if 0//gtest -+ if(get_rf_mimo_mode(padapter) == RTL8712_RF_2T2R) -+ { -+ //is this a 2r STA? -+ if((pstat->tx_ra_bitmap & 0x0ff00000) != 0 && !(priv->pshare->has_2r_sta & BIT(pstat->aid))) -+ { -+ priv->pshare->has_2r_sta |= BIT(pstat->aid); -+ if(rtw_read16(padapter, 0x102501f6) != 0xffff) -+ { -+ rtw_write16(padapter, 0x102501f6, 0xffff); -+ reset_1r_sta_RA(priv, 0xffff); -+ Switch_1SS_Antenna(priv, 3); -+ } -+ } -+ else// bg or 1R STA? -+ { -+ if((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) && pstat->ht_cap_len && priv->pshare->has_2r_sta == 0) -+ { -+ if(rtw_read16(padapter, 0x102501f6) != 0x7777) -+ { // MCS7 SGI -+ rtw_write16(padapter, 0x102501f6,0x7777); -+ reset_1r_sta_RA(priv, 0x7777); -+ Switch_1SS_Antenna(priv, 2); -+ } -+ } -+ } -+ -+ } -+ -+ if ((pstat->rssi_level < 1) || (pstat->rssi_level > 3)) -+ { -+ if (pstat->rssi >= priv->pshare->rf_ft_var.raGoDownUpper) -+ pstat->rssi_level = 1; -+ else if ((pstat->rssi >= priv->pshare->rf_ft_var.raGoDown20MLower) || -+ ((priv->pshare->is_40m_bw) && (pstat->ht_cap_len) && -+ (pstat->rssi >= priv->pshare->rf_ft_var.raGoDown40MLower) && -+ (pstat->ht_cap_buf.ht_cap_info & cpu_to_le16(_HTCAP_SUPPORT_CH_WDTH_)))) -+ pstat->rssi_level = 2; -+ else -+ pstat->rssi_level = 3; -+ } -+ -+ // rate adaptive by rssi -+ if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) && pstat->ht_cap_len) -+ { -+ if ((get_rf_mimo_mode(priv) == MIMO_1T2R) || (get_rf_mimo_mode(priv) == MIMO_1T1R)) -+ { -+ switch (pstat->rssi_level) { -+ case 1: -+ pstat->tx_ra_bitmap &= 0x100f0000; -+ break; -+ case 2: -+ pstat->tx_ra_bitmap &= 0x100ff000; -+ break; -+ case 3: -+ if (priv->pshare->is_40m_bw) -+ pstat->tx_ra_bitmap &= 0x100ff005; -+ else -+ pstat->tx_ra_bitmap &= 0x100ff001; -+ -+ break; -+ } -+ } -+ else -+ { -+ switch (pstat->rssi_level) { -+ case 1: -+ pstat->tx_ra_bitmap &= 0x1f0f0000; -+ break; -+ case 2: -+ pstat->tx_ra_bitmap &= 0x1f0ff000; -+ break; -+ case 3: -+ if (priv->pshare->is_40m_bw) -+ pstat->tx_ra_bitmap &= 0x000ff005; -+ else -+ pstat->tx_ra_bitmap &= 0x000ff001; -+ -+ break; -+ } -+ -+ // Don't need to mask high rates due to new rate adaptive parameters -+ //if (pstat->is_broadcom_sta) // use MCS12 as the highest rate vs. Broadcom sta -+ // pstat->tx_ra_bitmap &= 0x81ffffff; -+ -+ // NIC driver will report not supporting MCS15 and MCS14 in asoc req -+ //if (pstat->is_rtl8190_sta && !pstat->is_2t_mimo_sta) -+ // pstat->tx_ra_bitmap &= 0x83ffffff; // if Realtek 1x2 sta, don't use MCS15 and MCS14 -+ } -+ } -+ else if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) && isErpSta(pstat)) -+ { -+ switch (pstat->rssi_level) { -+ case 1: -+ pstat->tx_ra_bitmap &= 0x00000f00; -+ break; -+ case 2: -+ pstat->tx_ra_bitmap &= 0x00000ff0; -+ break; -+ case 3: -+ pstat->tx_ra_bitmap &= 0x00000ff5; -+ break; -+ } -+ } -+ else -+ { -+ pstat->tx_ra_bitmap &= 0x0000000d; -+ } -+ -+ // disable tx short GI when station cannot rx MCS15(AP is 2T2R) -+ // disable tx short GI when station cannot rx MCS7 (AP is 1T2R or 1T1R) -+ // if there is only 1r STA and we are 2T2R, DO NOT mask SGI rate -+ if ((!(pstat->tx_ra_bitmap & 0x8000000) && (priv->pshare->has_2r_sta > 0) && (get_rf_mimo_mode(padapter) == RTL8712_RF_2T2R)) || -+ (!(pstat->tx_ra_bitmap & 0x80000) && (get_rf_mimo_mode(padapter) != RTL8712_RF_2T2R))) -+ { -+ pstat->tx_ra_bitmap &= ~BIT(28); -+ } -+#endif -+ -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ tx_ra_bitmap = psta->ra_mask; -+ -+ shortGIrate = query_ra_short_GI(psta); -+ -+ if ( pcur_network->Configuration.DSConfig > 14 ) { -+ -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_5N ; -+ -+ if (tx_ra_bitmap & 0xff0) -+ sta_band |= WIRELESS_11A; -+ -+ // 5G band -+ #ifdef CONFIG_80211AC_VHT -+ if (psta->vhtpriv.vht_option) { -+ sta_band = WIRELESS_11_5AC; -+ } -+ #endif -+ -+ } else { -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_24N; -+ -+ if (tx_ra_bitmap & 0xff0) -+ sta_band |= WIRELESS_11G; -+ -+ if (tx_ra_bitmap & 0x0f) -+ sta_band |= WIRELESS_11B; -+ } -+ -+ psta->wireless_mode = sta_band; -+ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); -+ -+ if (psta->aid < NUM_STA) -+ { -+ u8 arg[4] = {0}; -+ -+ arg[0] = psta->mac_id; -+ arg[1] = psta->raid; -+ arg[2] = shortGIrate; -+ arg[3] = psta->init_rate; -+ -+ DBG_871X("%s=> mac_id:%d , raid:%d , shortGIrate=%d, tx_ra_bitmap:0x%016llx, networkType:0x%02x\n", -+ __FUNCTION__, psta->mac_id, psta->raid, shortGIrate, tx_ra_bitmap, psta->wireless_mode); -+ -+ rtw_hal_add_ra_tid(padapter, tx_ra_bitmap, arg, rssi_level); -+ } -+ else -+ { -+ DBG_871X("station aid %d exceed the max number\n", psta->aid); -+ } -+ -+} -+ -+void update_bmc_sta(_adapter *padapter) -+{ -+ _irqL irqL; -+ unsigned char network_type; -+ int supportRateNum = 0; -+ u64 tx_ra_bitmap = 0; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ struct sta_info *psta = rtw_get_bcmc_stainfo(padapter); -+ -+ if(psta) -+ { -+ psta->aid = 0;//default set to 0 -+ -+ pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta; -+ -+ psta->qos_option = 0; -+#ifdef CONFIG_80211N_HT -+ psta->htpriv.ht_option = _FALSE; -+#endif //CONFIG_80211N_HT -+ -+ psta->ieee8021x_blocked = 0; -+ -+ _rtw_memset((void*)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); -+ -+ //psta->dot118021XPrivacy = _NO_PRIVACY_;//!!! remove it, because it has been set before this. -+ -+ //prepare for add_RATid -+ supportRateNum = rtw_get_rateset_len((u8*)&pcur_network->SupportedRates); -+ network_type = rtw_check_network_type((u8*)&pcur_network->SupportedRates, supportRateNum, pcur_network->Configuration.DSConfig); -+ if (IsSupportedTxCCK(network_type)) { -+ network_type = WIRELESS_11B; -+ } -+ else if (network_type == WIRELESS_INVALID) { // error handling -+ if ( pcur_network->Configuration.DSConfig > 14 ) -+ network_type = WIRELESS_11A; -+ else -+ network_type = WIRELESS_11B; -+ } -+ update_sta_basic_rate(psta, network_type); -+ psta->wireless_mode = network_type; -+ -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ tx_ra_bitmap = psta->ra_mask; -+ -+ psta->raid = rtw_hal_networktype_to_raid(padapter,psta); -+ -+ //ap mode -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); -+ -+ //if(pHalData->fw_ractrl == _TRUE) -+ { -+ u8 arg[4] = {0}; -+ -+ arg[0] = psta->mac_id; -+ arg[1] = psta->raid; -+ arg[2] = 0; -+ arg[3] = psta->init_rate; -+ -+ DBG_871X("%s=> mac_id:%d , raid:%d , bitmap=0x%016llx\n", -+ __FUNCTION__ , psta->mac_id, psta->raid , tx_ra_bitmap); -+ -+ rtw_hal_add_ra_tid(padapter, tx_ra_bitmap, arg, 0); -+ } -+ -+ rtw_sta_media_status_rpt(padapter, psta, 1); -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state = _FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ } -+ else -+ { -+ DBG_871X("add_RATid_bmc_sta error!\n"); -+ } -+ -+} -+ -+//notes: -+//AID: 1~MAX for sta and 0 for bc/mc in ap/adhoc mode -+//MAC_ID = AID+1 for sta in ap/adhoc mode -+//MAC_ID = 1 for bc/mc for sta/ap/adhoc -+//MAC_ID = 0 for bssid for sta/ap/adhoc -+//CAM_ID = //0~3 for default key, cmd_id=macid + 3, macid=aid+1; -+ -+void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+#ifdef CONFIG_80211N_HT -+ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; -+ struct ht_priv *phtpriv_sta = &psta->htpriv; -+#endif //CONFIG_80211N_HT -+ u8 cur_ldpc_cap=0, cur_stbc_cap=0, cur_beamform_cap=0; -+ //set intf_tag to if1 -+ //psta->intf_tag = 0; -+ -+ DBG_871X("%s\n",__FUNCTION__); -+ -+ //psta->mac_id = psta->aid+4; -+ //psta->mac_id = psta->aid+1;//alloc macid when call rtw_alloc_stainfo(), -+ //release macid when call rtw_free_stainfo() -+ -+ //ap mode -+ rtw_hal_set_odm_var(padapter,HAL_ODM_STA_INFO,psta,_TRUE); -+ -+ if(psecuritypriv->dot11AuthAlgrthm==dot11AuthAlgrthm_8021X) -+ psta->ieee8021x_blocked = _TRUE; -+ else -+ psta->ieee8021x_blocked = _FALSE; -+ -+ -+ //update sta's cap -+ -+ //ERP -+ VCS_update(padapter, psta); -+#ifdef CONFIG_80211N_HT -+ //HT related cap -+ if(phtpriv_sta->ht_option) -+ { -+ //check if sta supports rx ampdu -+ phtpriv_sta->ampdu_enable = phtpriv_ap->ampdu_enable; -+ -+ phtpriv_sta->rx_ampdu_min_spacing = (phtpriv_sta->ht_cap.ampdu_params_info&IEEE80211_HT_CAP_AMPDU_DENSITY)>>2; -+ -+ // bwmode -+ if((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) -+ { -+ psta->bw_mode = CHANNEL_WIDTH_40; -+ } -+ else -+ { -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ } -+ -+ if (psta->ht_40mhz_intolerant) -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ -+ if(pmlmeext->cur_bwmode < psta->bw_mode) -+ { -+ psta->bw_mode = pmlmeext->cur_bwmode; -+ } -+ -+ phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; -+ -+ -+ //check if sta support s Short GI 20M -+ if((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_20)) -+ { -+ phtpriv_sta->sgi_20m = _TRUE; -+ } -+ -+ //check if sta support s Short GI 40M -+ if((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_40)) -+ { -+ if(psta->bw_mode == CHANNEL_WIDTH_40) //according to psta->bw_mode -+ phtpriv_sta->sgi_40m = _TRUE; -+ else -+ phtpriv_sta->sgi_40m = _FALSE; -+ } -+ -+ psta->qos_option = _TRUE; -+ -+ // B0 Config LDPC Coding Capability -+ if (TEST_FLAG(phtpriv_ap->ldpc_cap, LDPC_HT_ENABLE_TX) && -+ GET_HT_CAP_ELE_LDPC_CAP((u8 *)(&phtpriv_sta->ht_cap))) -+ { -+ SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX)); -+ DBG_871X("Enable HT Tx LDPC for STA(%d)\n",psta->aid); -+ } -+ -+ // B7 B8 B9 Config STBC setting -+ if (TEST_FLAG(phtpriv_ap->stbc_cap, STBC_HT_ENABLE_TX) && -+ GET_HT_CAP_ELE_RX_STBC((u8 *)(&phtpriv_sta->ht_cap))) -+ { -+ SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX) ); -+ DBG_871X("Enable HT Tx STBC for STA(%d)\n",psta->aid); -+ } -+ -+#ifdef CONFIG_BEAMFORMING -+ /*Config Tx beamforming setting*/ -+ if (TEST_FLAG(phtpriv_ap->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP((u8 *)(&phtpriv_sta->ht_cap))) -+ { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); -+ /*Shift to BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP*/ -+ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS((u8 *)(&phtpriv_sta->ht_cap)) << 6); -+ } -+ -+ if (TEST_FLAG(phtpriv_ap->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP((u8 *)(&phtpriv_sta->ht_cap))) -+ { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); -+ /*Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ -+ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS((u8 *)(&phtpriv_sta->ht_cap)) << 4); -+ } -+ if (cur_beamform_cap) { -+ DBG_871X("Client STA(%d) HT Beamforming Cap = 0x%02X\n", psta->aid, cur_beamform_cap); -+ } -+#endif /*CONFIG_BEAMFORMING*/ -+ } -+ else -+ { -+ phtpriv_sta->ampdu_enable = _FALSE; -+ -+ phtpriv_sta->sgi_20m = _FALSE; -+ phtpriv_sta->sgi_40m = _FALSE; -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ phtpriv_sta->ldpc_cap = cur_ldpc_cap; -+ phtpriv_sta->stbc_cap = cur_stbc_cap; -+ phtpriv_sta->beamform_cap = cur_beamform_cap; -+ -+ //Rx AMPDU -+ send_delba(padapter, 0, psta->hwaddr);// recipient -+ -+ //TX AMPDU -+ send_delba(padapter, 1, psta->hwaddr);// // originator -+ phtpriv_sta->agg_enable_bitmap = 0x0;//reset -+ phtpriv_sta->candidate_tid_bitmap = 0x0;//reset -+#endif //CONFIG_80211N_HT -+ -+#ifdef CONFIG_80211AC_VHT -+ update_sta_vht_info_apmode(padapter, psta); -+#endif -+ -+ update_ldpc_stbc_cap(psta); -+ -+ //todo: init other variables -+ -+ _rtw_memset((void*)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); -+ -+ -+ //add ratid -+ //add_RATid(padapter, psta);//move to ap_sta_info_defer_update() -+ -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state |= _FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ -+} -+ -+static void update_ap_info(_adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+#ifdef CONFIG_80211N_HT -+ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; -+#endif //CONFIG_80211N_HT -+ -+ psta->wireless_mode = pmlmeext->cur_wireless_mode; -+ -+ psta->bssratelen = rtw_get_rateset_len(pnetwork->SupportedRates); -+ _rtw_memcpy(psta->bssrateset, pnetwork->SupportedRates, psta->bssratelen); -+ -+#ifdef CONFIG_80211N_HT -+ //HT related cap -+ if(phtpriv_ap->ht_option) -+ { -+ //check if sta supports rx ampdu -+ //phtpriv_ap->ampdu_enable = phtpriv_ap->ampdu_enable; -+ -+ //check if sta support s Short GI 20M -+ if((phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_20)) -+ { -+ phtpriv_ap->sgi_20m = _TRUE; -+ } -+ //check if sta support s Short GI 40M -+ if((phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_40)) -+ { -+ phtpriv_ap->sgi_40m = _TRUE; -+ } -+ -+ psta->qos_option = _TRUE; -+ } -+ else -+ { -+ phtpriv_ap->ampdu_enable = _FALSE; -+ -+ phtpriv_ap->sgi_20m = _FALSE; -+ phtpriv_ap->sgi_40m = _FALSE; -+ } -+ -+ psta->bw_mode = pmlmeext->cur_bwmode; -+ phtpriv_ap->ch_offset = pmlmeext->cur_ch_offset; -+ -+ phtpriv_ap->agg_enable_bitmap = 0x0;//reset -+ phtpriv_ap->candidate_tid_bitmap = 0x0;//reset -+ -+ _rtw_memcpy(&psta->htpriv, &pmlmepriv->htpriv, sizeof(struct ht_priv)); -+ -+#ifdef CONFIG_80211AC_VHT -+ _rtw_memcpy(&psta->vhtpriv, &pmlmepriv->vhtpriv, sizeof(struct vht_priv)); -+#endif //CONFIG_80211AC_VHT -+ -+#endif //CONFIG_80211N_HT -+ -+ psta->state |= WIFI_AP_STATE; /* Aries, add,fix bug of flush_cam_entry at STOP AP mode , 0724 */ -+} -+ -+static void rtw_set_hw_wmm_param(_adapter *padapter) -+{ -+ u8 ACI, ACM, AIFS, ECWMin, ECWMax, aSifsTime; -+ u8 acm_mask; -+ u16 TXOP; -+ u32 acParm, i; -+ u32 edca[4], inx[4]; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ acm_mask = 0; -+ -+ if (IsSupported5G(pmlmeext->cur_wireless_mode) || -+ (pmlmeext->cur_wireless_mode & WIRELESS_11_24N)) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ if (pmlmeinfo->WMM_enable == 0) { -+ padapter->mlmepriv.acm_mask = 0; -+ -+ AIFS = aSifsTime + (2 * pmlmeinfo->slotTime); -+ -+ if (pmlmeext->cur_wireless_mode & (WIRELESS_11G | WIRELESS_11A)) { -+ ECWMin = 4; -+ ECWMax = 10; -+ } else if (pmlmeext->cur_wireless_mode & WIRELESS_11B) { -+ ECWMin = 5; -+ ECWMax = 10; -+ } else { -+ ECWMin = 4; -+ ECWMax = 10; -+ } -+ -+ TXOP = 0; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); -+ -+ ECWMin = 2; -+ ECWMax = 3; -+ TXOP = 0x2f; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); -+ -+ } else { -+ edca[0] = edca[1] = edca[2] = edca[3] = 0; -+ -+ /*TODO:*/ -+ acm_mask = 0; -+ padapter->mlmepriv.acm_mask = acm_mask; -+ -+ /* -+ //BK -+ //AIFS = AIFSN * slot time + SIFS - r2t phy delay -+ */ -+ AIFS = (7 * pmlmeinfo->slotTime) + aSifsTime; -+ ECWMin = 4; -+ ECWMax = 10; -+ TXOP = 0; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); -+ edca[XMIT_BK_QUEUE] = acParm; -+ DBG_871X("WMM(BK): %x\n", acParm); -+ -+ /* BE */ -+ AIFS = (3 * pmlmeinfo->slotTime) + aSifsTime; -+ ECWMin = 4; -+ ECWMax = 6; -+ TXOP = 0; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); -+ edca[XMIT_BE_QUEUE] = acParm; -+ DBG_871X("WMM(BE): %x\n", acParm); -+ -+ /* VI */ -+ AIFS = (1 * pmlmeinfo->slotTime) + aSifsTime; -+ ECWMin = 3; -+ ECWMax = 4; -+ TXOP = 94; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); -+ edca[XMIT_VI_QUEUE] = acParm; -+ DBG_871X("WMM(VI): %x\n", acParm); -+ -+ /* VO */ -+ AIFS = (1 * pmlmeinfo->slotTime) + aSifsTime; -+ ECWMin = 2; -+ ECWMax = 3; -+ TXOP = 47; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); -+ edca[XMIT_VO_QUEUE] = acParm; -+ DBG_871X("WMM(VO): %x\n", acParm); -+ -+ -+ if (padapter->registrypriv.acm_method == 1) -+ rtw_hal_set_hwreg(padapter, HW_VAR_ACM_CTRL, (u8 *)(&acm_mask)); -+ else -+ padapter->mlmepriv.acm_mask = acm_mask; -+ -+ inx[0] = 0; inx[1] = 1; inx[2] = 2; inx[3] = 3; -+ -+ if (pregpriv->wifi_spec == 1) { -+ u32 j, tmp, change_inx = _FALSE; -+ -+ /* entry indx: 0->vo, 1->vi, 2->be, 3->bk. */ -+ for (i = 0 ; i < 4 ; i++) { -+ for (j = i+1 ; j < 4 ; j++) { -+ /* compare CW and AIFS */ -+ if ((edca[j] & 0xFFFF) < (edca[i] & 0xFFFF)) { -+ change_inx = _TRUE; -+ } else if ((edca[j] & 0xFFFF) == (edca[i] & 0xFFFF)) { -+ /* compare TXOP */ -+ if ((edca[j] >> 16) > (edca[i] >> 16)) -+ change_inx = _TRUE; -+ } -+ -+ if (change_inx) { -+ tmp = edca[i]; -+ edca[i] = edca[j]; -+ edca[j] = tmp; -+ -+ tmp = inx[i]; -+ inx[i] = inx[j]; -+ inx[j] = tmp; -+ -+ change_inx = _FALSE; -+ } -+ } -+ } -+ } -+ -+ for (i = 0 ; i < 4 ; i++) { -+ pxmitpriv->wmm_para_seq[i] = inx[i]; -+ DBG_871X("wmm_para_seq(%d): %d\n", i, pxmitpriv->wmm_para_seq[i]); -+ } -+ -+ } -+ -+} -+ -+static void update_hw_ht_param(_adapter *padapter) -+{ -+ unsigned char max_AMPDU_len; -+ unsigned char min_MPDU_spacing; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ -+ //handle A-MPDU parameter field -+ /* -+ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k -+ AMPDU_para [4:2]:Min MPDU Start Spacing -+ */ -+ max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; -+ -+ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MIN_SPACE, (u8 *)(&min_MPDU_spacing)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len)); -+ -+ // -+ // Config SM Power Save setting -+ // -+ pmlmeinfo->SM_PS = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & 0x0C) >> 2; -+ if(pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC) -+ { -+ /*u8 i; -+ //update the MCS rates -+ for (i = 0; i < 16; i++) -+ { -+ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; -+ }*/ -+ DBG_871X("%s(): WLAN_HT_CAP_SM_PS_STATIC\n",__FUNCTION__); -+ } -+ -+ // -+ // Config current HT Protection mode. -+ // -+ //pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; -+ -+} -+ -+static void rtw_ap_check_scan(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ u32 delta_time, lifetime; -+ struct wlan_network *pnetwork = NULL; -+ WLAN_BSSID_EX *pbss = NULL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ u8 do_scan = _FALSE; -+ -+ lifetime = SCANQUEUE_LIFETIME; /* 20 sec */ -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ phead = get_list_head(queue); -+ if (rtw_end_of_queue_search(phead, get_next(phead)) == _TRUE) -+ if (padapter->registrypriv.wifi_spec) -+ do_scan = _TRUE; -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ if (padapter->registrypriv.acs_auto_scan) { -+ do_scan = _TRUE; -+ rtw_acs_start(padapter, _TRUE); -+ } -+#endif -+ -+ if (_TRUE == do_scan) { -+ DBG_871X("%s : drv scans by itself and wait_completed\n", __func__); -+ rtw_drv_scan_by_self(padapter); -+ rtw_scan_wait_completed(padapter); -+ } -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ if (padapter->registrypriv.acs_auto_scan) -+ rtw_acs_start(padapter, _FALSE); -+#endif -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 -+ && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE -+ && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid))) { -+ delta_time = (u32) rtw_get_passing_time_ms(pnetwork->last_scanned); -+ -+ if (delta_time < lifetime) { -+ -+ uint ie_len = 0; -+ u8 *pbuf = NULL; -+ u8 *ie = NULL; -+ -+ pbss = &pnetwork->network; -+ ie = pbss->IEs; -+ -+ /*check if HT CAP INFO IE exists or not*/ -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pbss->IELength - _BEACON_IE_OFFSET_)); -+ if (pbuf == NULL) { -+ /* HT CAP INFO IE don't exist, it is b/g mode bss.*/ -+ -+ if (pmlmepriv->olbc == _FALSE) -+ pmlmepriv->olbc = _TRUE; -+ -+ if (pmlmepriv->olbc_ht == _FALSE) -+ pmlmepriv->olbc_ht = _TRUE; -+ } -+ } -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ pmlmepriv->num_sta_no_ht = 0; /* reset to 0 after ap do scanning*/ -+ -+} -+ -+void rtw_start_bss_hdl_after_chbw_decided(_adapter *adapter) -+{ -+ WLAN_BSSID_EX *pnetwork = &(adapter->mlmepriv.cur_network.network); -+ struct sta_info *sta = NULL; -+ -+ /* update cur_wireless_mode */ -+ update_wireless_mode(adapter); -+ -+ /* update RRSR and RTS_INIT_RATE register after set channel and bandwidth */ -+ UpdateBrateTbl(adapter, pnetwork->SupportedRates); -+ rtw_hal_set_hwreg(adapter, HW_VAR_BASIC_RATE, pnetwork->SupportedRates); -+ -+ /* update capability after cur_wireless_mode updated */ -+ update_capinfo(adapter, rtw_get_capability(pnetwork)); -+ -+ /* update bc/mc sta_info */ -+ update_bmc_sta(adapter); -+ -+ /* update AP's sta info */ -+ sta = rtw_get_stainfo(&adapter->stapriv, pnetwork->MacAddress); -+ if (!sta) { -+ DBG_871X(FUNC_ADPT_FMT" !sta for macaddr="MAC_FMT"\n", FUNC_ADPT_ARG(adapter), MAC_ARG(pnetwork->MacAddress)); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ update_ap_info(adapter, sta); -+} -+ -+void start_bss_network(_adapter *padapter, struct createbss_parm *parm) -+{ -+#define DUMP_ADAPTERS_STATUS 0 -+ -+ u8 val8; -+ u16 bcn_interval; -+ u32 acparm; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; /* used as input */ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork_mlmeext = &(pmlmeinfo->network); -+ u8 req_ch, req_bw, req_offset; -+ bool ch_setting_changed = _FALSE; -+ u8 ch_to_set = 0, bw_to_set, offset_to_set; -+ -+ if (parm->req_ch == 0) { -+ /* change to unspecificed ch, bw, offset, get from IE */ -+ goto get_cbhw_from_ie; -+ } else if (parm->req_ch > 0) { -+ /* change ch, bw, offset */ -+ req_ch = parm->req_ch; -+ req_bw = parm->req_bw; -+ req_offset = parm->req_offset; -+ goto change_chbw; -+ } -+ -+ bcn_interval = (u16)pnetwork->Configuration.BeaconPeriod; -+ -+ //check if there is wps ie, -+ //if there is wpsie in beacon, the hostapd will update beacon twice when stating hostapd, -+ //and at first time the security ie ( RSN/WPA IE) will not include in beacon. -+ if(NULL == rtw_get_wps_ie(pnetwork->IEs+_FIXED_IE_LENGTH_, pnetwork->IELength-_FIXED_IE_LENGTH_, NULL, NULL)) -+ { -+ pmlmeext->bstart_bss = _TRUE; -+ } -+ -+ //todo: update wmm, ht cap -+ //pmlmeinfo->WMM_enable; -+ //pmlmeinfo->HT_enable; -+ if(pmlmepriv->qospriv.qos_option) -+ pmlmeinfo->WMM_enable = _TRUE; -+#ifdef CONFIG_80211N_HT -+ if(pmlmepriv->htpriv.ht_option) -+ { -+ pmlmeinfo->WMM_enable = _TRUE; -+ pmlmeinfo->HT_enable = _TRUE; -+ //pmlmeinfo->HT_info_enable = _TRUE; -+ //pmlmeinfo->HT_caps_enable = _TRUE; -+ -+ update_hw_ht_param(padapter); -+ } -+#endif //#CONFIG_80211N_HT -+ -+#ifdef CONFIG_80211AC_VHT -+ if(pmlmepriv->vhtpriv.vht_option) { -+ pmlmeinfo->VHT_enable = _TRUE; -+ update_hw_vht_param(padapter); -+ } -+#endif //CONFIG_80211AC_VHT -+ -+ if(pmlmepriv->cur_network.join_res != _TRUE) //setting only at first time -+ { -+ //WEP Key will be set before this function, do not clear CAM. -+ if ((psecuritypriv->dot11PrivacyAlgrthm != _WEP40_) && (psecuritypriv->dot11PrivacyAlgrthm != _WEP104_)) -+ flush_all_cam_entry(padapter); //clear CAM -+ } -+ -+ //set MSR to AP_Mode -+ Set_MSR(padapter, _HW_STATE_AP_); -+ -+ //Set BSSID REG -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pnetwork->MacAddress); -+ -+ //Set EDCA param reg -+#ifdef CONFIG_CONCURRENT_MODE -+ acparm = 0x005ea42b; -+#else -+ acparm = 0x002F3217; // VO -+#endif -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm)); -+ acparm = 0x005E4317; // VI -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm)); -+ //acparm = 0x00105320; // BE -+ acparm = 0x005ea42b; -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); -+ acparm = 0x0000A444; // BK -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); -+ -+ //Set Security -+ val8 = (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X)? 0xcc: 0xcf; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ -+ //Beacon Control related register -+ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&bcn_interval)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, NULL); -+ -+#if 0 -+ if(pmlmepriv->cur_network.join_res != _TRUE) //setting only at first time -+ { -+ //u32 initialgain; -+ -+ //initialgain = 0x1e; -+ -+ -+ //disable dynamic functions, such as high power, DIG -+ /*rtw_phydm_ability_backup(padapter);*/ -+ /*rtw_phydm_func_disable_all(padapter);*/ -+ -+ //turn on all dynamic functions -+ /* Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, _TRUE);*/ -+ -+ /*rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE);*/ -+ -+ } -+#endif -+ -+get_cbhw_from_ie: -+ rtw_ies_get_chbw(pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs) -+ , pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs) -+ , &req_ch, &req_bw, &req_offset); -+ -+change_chbw: -+ rtw_warn_on(req_ch == 0); -+ -+ ch_setting_changed = rtw_ap_chbw_decision(padapter, req_ch, req_bw, req_offset -+ , &ch_to_set, &bw_to_set, &offset_to_set); -+ -+ //let pnetwork_mlmeext == pnetwork_mlme. -+ _rtw_memcpy(pnetwork_mlmeext, pnetwork, pnetwork->Length); -+ -+ rtw_start_bss_hdl_after_chbw_decided(padapter); -+ -+ #if defined(CONFIG_DFS_MASTER) -+ rtw_dfs_master_status_apply(padapter, MLME_AP_STARTED); -+ #endif -+ -+ if (ch_to_set != 0) -+ set_channel_bwmode(padapter, ch_to_set, offset_to_set, bw_to_set); -+ -+ if (DUMP_ADAPTERS_STATUS) { -+ DBG_871X(FUNC_ADPT_FMT" done\n", FUNC_ADPT_ARG(padapter)); -+ dump_adapters_status(RTW_DBGDUMP , adapter_to_dvobj(padapter)); -+ } -+ -+ if (_TRUE == pmlmeext->bstart_bss -+ && !check_fwstate(pmlmepriv, WIFI_SITE_MONITOR) -+ && !check_fwstate(pmlmepriv, WIFI_OP_CH_SWITCHING) -+ #ifdef CONFIG_CONCURRENT_MODE -+ && !check_buddy_fwstate(padapter, WIFI_SITE_MONITOR) -+ #endif -+ ) { -+ -+ if ((pmlmepriv->olbc == _TRUE) || (pmlmepriv->olbc_ht == _TRUE)) { -+ -+ /* AP is not starting a 40 MHz BSS in presence of an 802.11g BSS. */ -+ -+ pmlmepriv->ht_op_mode &= (~HT_INFO_OPERATION_MODE_OP_MODE_MASK); -+ pmlmepriv->ht_op_mode |= OP_MODE_MAY_BE_LEGACY_STAS; -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _FALSE); -+ } -+ -+ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); -+ -+ #if !defined(CONFIG_INTERRUPT_BASED_TXBCN) -+ #if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ /* other case will tx beacon when bcn interrupt coming in. */ -+ if (send_beacon(padapter) == _FAIL) -+ DBG_871X("issue_beacon, fail!\n"); -+ #endif -+ #endif /* !defined(CONFIG_INTERRUPT_BASED_TXBCN) */ -+ } -+ -+ /*Set EDCA param reg after update cur_wireless_mode & update_capinfo*/ -+ if (pregpriv->wifi_spec == 1) -+ rtw_set_hw_wmm_param(padapter); -+ -+ /*pmlmeext->bstart_bss = _TRUE;*/ -+} -+ -+int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) -+{ -+ int ret=_SUCCESS; -+ u8 *p; -+ u8 *pHT_caps_ie=NULL; -+ u8 *pHT_info_ie=NULL; -+ u16 cap, ht_cap=_FALSE; -+ uint ie_len = 0; -+ int group_cipher, pairwise_cipher; -+ u8 channel, network_type, supportRate[NDIS_802_11_LENGTH_RATES_EX]; -+ int supportRateNum = 0; -+ u8 OUI1[] = {0x00, 0x50, 0xf2,0x01}; -+ u8 wps_oui[4]={0x0,0x50,0xf2,0x04}; -+ u8 WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pbss_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *ie = pbss_network->IEs; -+ u8 vht_cap=_FALSE; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 rf_num = 0; -+ -+ /* SSID */ -+ /* Supported rates */ -+ /* DS Params */ -+ /* WLAN_EID_COUNTRY */ -+ /* ERP Information element */ -+ /* Extended supported rates */ -+ /* WPA/WPA2 */ -+ /* Wi-Fi Wireless Multimedia Extensions */ -+ /* ht_capab, ht_oper */ -+ /* WPS IE */ -+ -+ DBG_871X("%s, len=%d\n", __FUNCTION__, len); -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return _FAIL; -+ -+ -+ if(len>MAX_IE_SZ) -+ return _FAIL; -+ -+ pbss_network->IELength = len; -+ -+ _rtw_memset(ie, 0, MAX_IE_SZ); -+ -+ _rtw_memcpy(ie, pbuf, pbss_network->IELength); -+ -+ -+ if(pbss_network->InfrastructureMode!=Ndis802_11APMode) -+ return _FAIL; -+ -+ -+ rtw_ap_check_scan(padapter); -+ -+ -+ pbss_network->Rssi = 0; -+ -+ _rtw_memcpy(pbss_network->MacAddress, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ //beacon interval -+ p = rtw_get_beacon_interval_from_ie(ie);//ie + 8; // 8: TimeStamp, 2: Beacon Interval 2:Capability -+ //pbss_network->Configuration.BeaconPeriod = le16_to_cpu(*(unsigned short*)p); -+ pbss_network->Configuration.BeaconPeriod = RTW_GET_LE16(p); -+ -+ //capability -+ //cap = *(unsigned short *)rtw_get_capability_from_ie(ie); -+ //cap = le16_to_cpu(cap); -+ cap = RTW_GET_LE16(ie); -+ -+ //SSID -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _SSID_IE_, &ie_len, (pbss_network->IELength -_BEACON_IE_OFFSET_)); -+ if(p && ie_len>0) -+ { -+ _rtw_memset(&pbss_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); -+ _rtw_memcpy(pbss_network->Ssid.Ssid, (p + 2), ie_len); -+ pbss_network->Ssid.SsidLength = ie_len; -+ #ifdef CONFIG_P2P -+ _rtw_memcpy(padapter->wdinfo.p2p_group_ssid, pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength); -+ padapter->wdinfo.p2p_group_ssid_len = pbss_network->Ssid.SsidLength; -+ #endif -+ } -+ -+ //chnnel -+ channel = 0; -+ pbss_network->Configuration.Length = 0; -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _DSSET_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if(p && ie_len>0) -+ channel = *(p + 2); -+ -+ pbss_network->Configuration.DSConfig = channel; -+ -+ -+ _rtw_memset(supportRate, 0, NDIS_802_11_LENGTH_RATES_EX); -+ // get supported rates -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if (p != NULL) -+ { -+ _rtw_memcpy(supportRate, p+2, ie_len); -+ supportRateNum = ie_len; -+ } -+ -+ //get ext_supported rates -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ie_len, pbss_network->IELength - _BEACON_IE_OFFSET_); -+ if (p != NULL) -+ { -+ _rtw_memcpy(supportRate+supportRateNum, p+2, ie_len); -+ supportRateNum += ie_len; -+ -+ } -+ -+ network_type = rtw_check_network_type(supportRate, supportRateNum, channel); -+ -+ rtw_set_supported_rate(pbss_network->SupportedRates, network_type); -+ -+ -+ //parsing ERP_IE -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _ERPINFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if(p && ie_len>0) -+ { -+ ERP_IE_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)p); -+ } -+ -+ //update privacy/security -+ if (cap & BIT(4)) -+ pbss_network->Privacy = 1; -+ else -+ pbss_network->Privacy = 0; -+ -+ psecuritypriv->wpa_psk = 0; -+ -+ //wpa2 -+ group_cipher = 0; pairwise_cipher = 0; -+ psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_; -+ psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_; -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if(p && ie_len>0) -+ { -+ if(rtw_parse_wpa2_ie(p, ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ psecuritypriv->dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; -+ -+ psecuritypriv->dot8021xalg = 1;//psk, todo:802.1x -+ psecuritypriv->wpa_psk |= BIT(1); -+ -+ psecuritypriv->wpa2_group_cipher = group_cipher; -+ psecuritypriv->wpa2_pairwise_cipher = pairwise_cipher; -+#if 0 -+ switch(group_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_; -+ break; -+ case WPA_CIPHER_WEP40: -+ psecuritypriv->wpa2_group_cipher = _WEP40_; -+ break; -+ case WPA_CIPHER_TKIP: -+ psecuritypriv->wpa2_group_cipher = _TKIP_; -+ break; -+ case WPA_CIPHER_CCMP: -+ psecuritypriv->wpa2_group_cipher = _AES_; -+ break; -+ case WPA_CIPHER_WEP104: -+ psecuritypriv->wpa2_group_cipher = _WEP104_; -+ break; -+ } -+ -+ switch(pairwise_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_; -+ break; -+ case WPA_CIPHER_WEP40: -+ psecuritypriv->wpa2_pairwise_cipher = _WEP40_; -+ break; -+ case WPA_CIPHER_TKIP: -+ psecuritypriv->wpa2_pairwise_cipher = _TKIP_; -+ break; -+ case WPA_CIPHER_CCMP: -+ psecuritypriv->wpa2_pairwise_cipher = _AES_; -+ break; -+ case WPA_CIPHER_WEP104: -+ psecuritypriv->wpa2_pairwise_cipher = _WEP104_; -+ break; -+ } -+#endif -+ } -+ -+ } -+ -+ //wpa -+ ie_len = 0; -+ group_cipher = 0; pairwise_cipher = 0; -+ psecuritypriv->wpa_group_cipher = _NO_PRIVACY_; -+ psecuritypriv->wpa_pairwise_cipher = _NO_PRIVACY_; -+ for (p = ie + _BEACON_IE_OFFSET_; ;p += (ie_len + 2)) -+ { -+ p = rtw_get_ie(p, _SSN_IE_1_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); -+ if ((p) && (_rtw_memcmp(p+2, OUI1, 4))) -+ { -+ if(rtw_parse_wpa_ie(p, ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ psecuritypriv->dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; -+ -+ psecuritypriv->dot8021xalg = 1;//psk, todo:802.1x -+ -+ psecuritypriv->wpa_psk |= BIT(0); -+ -+ psecuritypriv->wpa_group_cipher = group_cipher; -+ psecuritypriv->wpa_pairwise_cipher = pairwise_cipher; -+ -+#if 0 -+ switch(group_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ psecuritypriv->wpa_group_cipher = _NO_PRIVACY_; -+ break; -+ case WPA_CIPHER_WEP40: -+ psecuritypriv->wpa_group_cipher = _WEP40_; -+ break; -+ case WPA_CIPHER_TKIP: -+ psecuritypriv->wpa_group_cipher = _TKIP_; -+ break; -+ case WPA_CIPHER_CCMP: -+ psecuritypriv->wpa_group_cipher = _AES_; -+ break; -+ case WPA_CIPHER_WEP104: -+ psecuritypriv->wpa_group_cipher = _WEP104_; -+ break; -+ } -+ -+ switch(pairwise_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ psecuritypriv->wpa_pairwise_cipher = _NO_PRIVACY_; -+ break; -+ case WPA_CIPHER_WEP40: -+ psecuritypriv->wpa_pairwise_cipher = _WEP40_; -+ break; -+ case WPA_CIPHER_TKIP: -+ psecuritypriv->wpa_pairwise_cipher = _TKIP_; -+ break; -+ case WPA_CIPHER_CCMP: -+ psecuritypriv->wpa_pairwise_cipher = _AES_; -+ break; -+ case WPA_CIPHER_WEP104: -+ psecuritypriv->wpa_pairwise_cipher = _WEP104_; -+ break; -+ } -+#endif -+ } -+ -+ break; -+ -+ } -+ -+ if ((p == NULL) || (ie_len == 0)) -+ { -+ break; -+ } -+ -+ } -+ -+ //wmm -+ ie_len = 0; -+ pmlmepriv->qospriv.qos_option = 0; -+ if(pregistrypriv->wmm_enable) -+ { -+ for (p = ie + _BEACON_IE_OFFSET_; ;p += (ie_len + 2)) -+ { -+ p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); -+ if((p) && _rtw_memcmp(p+2, WMM_PARA_IE, 6)) -+ { -+ pmlmepriv->qospriv.qos_option = 1; -+ -+ *(p+8) |= BIT(7);//QoS Info, support U-APSD -+ -+ /* disable all ACM bits since the WMM admission control is not supported */ -+ *(p + 10) &= ~BIT(4); /* BE */ -+ *(p + 14) &= ~BIT(4); /* BK */ -+ *(p + 18) &= ~BIT(4); /* VI */ -+ *(p + 22) &= ~BIT(4); /* VO */ -+ -+ break; -+ } -+ -+ if ((p == NULL) || (ie_len == 0)) -+ { -+ break; -+ } -+ } -+ } -+#ifdef CONFIG_80211N_HT -+ //parsing HT_CAP_IE -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if(p && ie_len>0) -+ { -+ u8 rf_type=0; -+ HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor=MAX_AMPDU_FACTOR_64K; -+ struct rtw_ieee80211_ht_cap *pht_cap = (struct rtw_ieee80211_ht_cap *)(p+2); -+ -+ if (0) { -+ DBG_871X(FUNC_ADPT_FMT" HT_CAP_IE from upper layer:\n", FUNC_ADPT_ARG(padapter)); -+ dump_ht_cap_ie_content(RTW_DBGDUMP, p+2, ie_len); -+ } -+ -+ pHT_caps_ie=p; -+ -+ ht_cap = _TRUE; -+ network_type |= WIRELESS_11_24N; -+ -+ rtw_ht_use_default_setting(padapter); -+ -+ /* Update HT Capabilities Info field */ -+ if (pmlmepriv->htpriv.sgi_20m == _FALSE) -+ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_SGI_20); -+ -+ if (pmlmepriv->htpriv.sgi_40m == _FALSE) -+ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_SGI_40); -+ -+ if (!TEST_FLAG(pmlmepriv->htpriv.ldpc_cap, LDPC_HT_ENABLE_RX)) -+ { -+ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_LDPC_CODING); -+ } -+ -+ if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_TX)) -+ { -+ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_TX_STBC); -+ } -+ -+ if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_RX)) -+ { -+ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_RX_STBC_3R); -+ } -+ -+ /* Update A-MPDU Parameters field */ -+ pht_cap->ampdu_params_info &= ~(IEEE80211_HT_CAP_AMPDU_FACTOR|IEEE80211_HT_CAP_AMPDU_DENSITY); -+ -+ if((psecuritypriv->wpa_pairwise_cipher & WPA_CIPHER_CCMP) || -+ (psecuritypriv->wpa2_pairwise_cipher & WPA_CIPHER_CCMP)) -+ { -+ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&(0x07<<2)); -+ } -+ else -+ { -+ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&0x00); -+ } -+ -+ rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); -+ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_FACTOR & max_rx_ampdu_factor); //set Max Rx AMPDU size to 64K -+ -+ _rtw_memcpy(&(pmlmeinfo->HT_caps), pht_cap, sizeof(struct HT_caps_element)); -+ -+ /* Update Supported MCS Set field */ -+ { -+ int i; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ /* RX MCS Bitmask */ -+ switch(rf_type) -+ { -+ case RF_1T1R: -+ case RF_1T2R: //? -+ set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_1R); -+ break; -+ case RF_2T2R: -+ set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_2R); -+ break; -+ case RF_3T3R: -+ set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_3R); -+ break; -+ default: -+ DBG_871X("[warning] rf_type %d is not expected\n", rf_type); -+ } -+ for (i = 0; i < 10; i++) -+ *(HT_CAP_ELE_RX_MCS_MAP(pht_cap)+i) &= padapter->mlmeextpriv.default_supported_mcs_set[i]; -+ } -+ -+#ifdef CONFIG_BEAMFORMING -+ // Use registry value to enable HT Beamforming. -+ // ToDo: use configure file to set these capability. -+ pht_cap->tx_BF_cap_info = 0; -+ -+ // HT Beamformer -+ if(TEST_FLAG(pmlmepriv->htpriv.beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) -+ { -+ // Transmit NDP Capable -+ SET_HT_CAP_TXBF_TRANSMIT_NDP_CAP(pht_cap, 1); -+ // Explicit Compressed Steering Capable -+ SET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pht_cap, 1); -+ // Compressed Steering Number Antennas -+ SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pht_cap, 1); -+ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMER_CAP, (u8 *)&rf_num); -+ SET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(pht_cap, rf_num); -+ } -+ -+ // HT Beamformee -+ if(TEST_FLAG(pmlmepriv->htpriv.beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) -+ { -+ // Receive NDP Capable -+ SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(pht_cap, 1); -+ // Explicit Compressed Beamforming Feedback Capable -+ SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(pht_cap, 2); -+ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); -+ SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pht_cap, rf_num); -+ } -+#endif //CONFIG_BEAMFORMING -+ -+ _rtw_memcpy(&pmlmepriv->htpriv.ht_cap, p+2, ie_len); -+ -+ if (0) { -+ DBG_871X(FUNC_ADPT_FMT" HT_CAP_IE driver masked:\n", FUNC_ADPT_ARG(padapter)); -+ dump_ht_cap_ie_content(RTW_DBGDUMP, p+2, ie_len); -+ } -+ } -+ -+ //parsing HT_INFO_IE -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if(p && ie_len>0) -+ { -+ pHT_info_ie=p; -+ } -+#endif //CONFIG_80211N_HT -+ switch(network_type) -+ { -+ case WIRELESS_11B: -+ pbss_network->NetworkTypeInUse = Ndis802_11DS; -+ break; -+ case WIRELESS_11G: -+ case WIRELESS_11BG: -+ case WIRELESS_11G_24N: -+ case WIRELESS_11BG_24N: -+ pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; -+ break; -+ case WIRELESS_11A: -+ pbss_network->NetworkTypeInUse = Ndis802_11OFDM5; -+ break; -+ default : -+ pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; -+ break; -+ } -+ -+ pmlmepriv->cur_network.network_type = network_type; -+ -+#ifdef CONFIG_80211N_HT -+ pmlmepriv->htpriv.ht_option = _FALSE; -+ -+ if( (psecuritypriv->wpa2_pairwise_cipher&WPA_CIPHER_TKIP) || -+ (psecuritypriv->wpa_pairwise_cipher&WPA_CIPHER_TKIP)) -+ { -+ //todo: -+ //ht_cap = _FALSE; -+ } -+ -+ //ht_cap -+ if(pregistrypriv->ht_enable && ht_cap==_TRUE) -+ { -+ pmlmepriv->htpriv.ht_option = _TRUE; -+ pmlmepriv->qospriv.qos_option = 1; -+ -+ if(pregistrypriv->ampdu_enable==1) -+ { -+ pmlmepriv->htpriv.ampdu_enable = _TRUE; -+ } -+ -+ HT_caps_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)pHT_caps_ie); -+ -+ HT_info_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)pHT_info_ie); -+ } -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ -+ //Parsing VHT CAP IE -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, EID_VHTCapability, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if(p && ie_len>0) -+ { -+ vht_cap = _TRUE; -+ } -+ //Parsing VHT OPERATION IE -+ -+ -+ pmlmepriv->vhtpriv.vht_option = _FALSE; -+ // if channel in 5G band, then add vht ie . -+ if ((pbss_network->Configuration.DSConfig > 14) && -+ (pmlmepriv->htpriv.ht_option == _TRUE) && -+ (pregistrypriv->vht_enable)) -+ { -+ if(vht_cap == _TRUE) -+ { -+ pmlmepriv->vhtpriv.vht_option = _TRUE; -+ } -+ else if(pregistrypriv->vht_enable == 2) // auto enabled -+ { -+ u8 cap_len, operation_len; -+ -+ rtw_vht_use_default_setting(padapter); -+ -+ { -+ /* VHT Operation mode notifiy bit in Extended IE (127) */ -+ uint len = 0; -+ -+ SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(pmlmepriv->ext_capab_ie_data, 1); -+ pmlmepriv->ext_capab_ie_len = 10; -+ rtw_set_ie(pbss_network->IEs + pbss_network->IELength, EID_EXTCapability, 8, pmlmepriv->ext_capab_ie_data, &len); -+ pbss_network->IELength += pmlmepriv->ext_capab_ie_len; -+ } -+ -+ // VHT Capabilities element -+ cap_len = rtw_build_vht_cap_ie(padapter, pbss_network->IEs + pbss_network->IELength); -+ pbss_network->IELength += cap_len; -+ -+ // VHT Operation element -+ operation_len = rtw_build_vht_operation_ie(padapter, pbss_network->IEs + pbss_network->IELength, pbss_network->Configuration.DSConfig); -+ pbss_network->IELength += operation_len; -+ -+ pmlmepriv->vhtpriv.vht_option = _TRUE; -+ } -+ } -+#endif //CONFIG_80211AC_VHT -+ -+ pbss_network->Length = get_WLAN_BSSID_EX_sz((WLAN_BSSID_EX *)pbss_network); -+ -+ rtw_ies_get_chbw(pbss_network->IEs + _BEACON_IE_OFFSET_, pbss_network->IELength - _BEACON_IE_OFFSET_ -+ , &pmlmepriv->ori_ch, &pmlmepriv->ori_bw, &pmlmepriv->ori_offset); -+ rtw_warn_on(pmlmepriv->ori_ch == 0); -+ -+{ -+ /* alloc sta_info for ap itself */ -+ -+ struct sta_info *sta; -+ -+ sta = rtw_get_stainfo(&padapter->stapriv, pbss_network->MacAddress); -+ if (!sta) { -+ sta = rtw_alloc_stainfo(&padapter->stapriv, pbss_network->MacAddress); -+ if (sta == NULL) -+ return _FAIL; -+ } -+} -+ -+ rtw_startbss_cmd(padapter, RTW_CMDF_WAIT_ACK); -+ -+ rtw_indicate_connect( padapter); -+ -+ pmlmepriv->cur_network.join_res = _TRUE;//for check if already set beacon -+ -+ //update bc/mc sta_info -+ //update_bmc_sta(padapter); -+ -+ return ret; -+ -+} -+ -+void rtw_set_macaddr_acl(_adapter *padapter, int mode) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ -+ DBG_871X("%s, mode=%d\n", __func__, mode); -+ -+ pacl_list->mode = mode; -+} -+ -+int rtw_acl_add_sta(_adapter *padapter, u8 *addr) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ u8 added = _FALSE; -+ int i, ret=0; -+ struct rtw_wlan_acl_node *paclnode; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ _queue *pacl_node_q =&pacl_list->acl_node_q; -+ -+ DBG_871X("%s(acl_num=%d)=" MAC_FMT "\n", __func__, pacl_list->num, MAC_ARG(addr)); -+ -+ if((NUM_ACL-1) < pacl_list->num) -+ return (-1); -+ -+ -+ _enter_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ phead = get_list_head(pacl_node_q); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { -+ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); -+ plist = get_next(plist); -+ -+ if(_rtw_memcmp(paclnode->addr, addr, ETH_ALEN)) -+ { -+ if(paclnode->valid == _TRUE) -+ { -+ added = _TRUE; -+ DBG_871X("%s, sta has been added\n", __func__); -+ break; -+ } -+ } -+ } -+ -+ _exit_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ -+ if(added == _TRUE) -+ return ret; -+ -+ -+ _enter_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ for(i=0; i< NUM_ACL; i++) -+ { -+ paclnode = &pacl_list->aclnode[i]; -+ -+ if(paclnode->valid == _FALSE) -+ { -+ _rtw_init_listhead(&paclnode->list); -+ -+ _rtw_memcpy(paclnode->addr, addr, ETH_ALEN); -+ -+ paclnode->valid = _TRUE; -+ -+ rtw_list_insert_tail(&paclnode->list, get_list_head(pacl_node_q)); -+ -+ pacl_list->num++; -+ -+ break; -+ } -+ } -+ -+ DBG_871X("%s, acl_num=%d\n", __func__, pacl_list->num); -+ -+ _exit_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ return ret; -+} -+ -+int rtw_acl_remove_sta(_adapter *padapter, u8 *addr) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ int i, ret=0; -+ struct rtw_wlan_acl_node *paclnode; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ _queue *pacl_node_q =&pacl_list->acl_node_q; -+ u8 baddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; //Baddr is used for clearing acl_list -+ -+ DBG_871X("%s(acl_num=%d)=" MAC_FMT "\n", __func__, pacl_list->num, MAC_ARG(addr)); -+ -+ _enter_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ phead = get_list_head(pacl_node_q); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { -+ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); -+ plist = get_next(plist); -+ -+ if(_rtw_memcmp(paclnode->addr, addr, ETH_ALEN) || _rtw_memcmp(baddr, addr, ETH_ALEN)) -+ { -+ if(paclnode->valid == _TRUE) -+ { -+ paclnode->valid = _FALSE; -+ -+ rtw_list_delete(&paclnode->list); -+ -+ pacl_list->num--; -+ } -+ } -+ } -+ -+ _exit_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ DBG_871X("%s, acl_num=%d\n", __func__, pacl_list->num); -+ -+ return ret; -+ -+} -+ -+u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta) -+{ -+ struct cmd_obj* ph2c; -+ struct set_stakey_parm *psetstakey_para; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ u8 res=_SUCCESS; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if ( ph2c == NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ psetstakey_para = (struct set_stakey_parm*)rtw_zmalloc(sizeof(struct set_stakey_parm)); -+ if(psetstakey_para==NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res=_FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); -+ -+ -+ psetstakey_para->algorithm = (u8)psta->dot118021XPrivacy; -+ -+ _rtw_memcpy(psetstakey_para->addr, psta->hwaddr, ETH_ALEN); -+ -+ _rtw_memcpy(psetstakey_para->key, &psta->dot118021x_UncstKey, 16); -+ -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+ -+static int rtw_ap_set_key(_adapter *padapter, u8 *key, u8 alg, int keyid, u8 set_tx) -+{ -+ u8 keylen; -+ struct cmd_obj* pcmd; -+ struct setkey_parm *psetkeyparm; -+ struct cmd_priv *pcmdpriv=&(padapter->cmdpriv); -+ int res=_SUCCESS; -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(pcmd==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ psetkeyparm=(struct setkey_parm*)rtw_zmalloc(sizeof(struct setkey_parm)); -+ if(psetkeyparm==NULL){ -+ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memset(psetkeyparm, 0, sizeof(struct setkey_parm)); -+ -+ psetkeyparm->keyid=(u8)keyid; -+ if (is_wep_enc(alg)) -+ padapter->securitypriv.key_mask |= BIT(psetkeyparm->keyid); -+ -+ psetkeyparm->algorithm = alg; -+ -+ psetkeyparm->set_tx = set_tx; -+ -+ switch(alg) -+ { -+ case _WEP40_: -+ keylen = 5; -+ break; -+ case _WEP104_: -+ keylen = 13; -+ break; -+ case _TKIP_: -+ case _TKIP_WTMIC_: -+ case _AES_: -+ default: -+ keylen = 16; -+ } -+ -+ _rtw_memcpy(&(psetkeyparm->key[0]), key, keylen); -+ -+ pcmd->cmdcode = _SetKey_CMD_; -+ pcmd->parmbuf = (u8 *)psetkeyparm; -+ pcmd->cmdsz = (sizeof(struct setkey_parm)); -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ -+ _rtw_init_listhead(&pcmd->list); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ -+ return res; -+} -+ -+int rtw_ap_set_group_key(_adapter *padapter, u8 *key, u8 alg, int keyid) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ return rtw_ap_set_key(padapter, key, alg, keyid, 1); -+} -+ -+int rtw_ap_set_wep_key(_adapter *padapter, u8 *key, u8 keylen, int keyid, u8 set_tx) -+{ -+ u8 alg; -+ -+ switch(keylen) -+ { -+ case 5: -+ alg =_WEP40_; -+ break; -+ case 13: -+ alg =_WEP104_; -+ break; -+ default: -+ alg =_NO_PRIVACY_; -+ } -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ return rtw_ap_set_key(padapter, key, alg, keyid, set_tx); -+} -+ -+u8 rtw_ap_bmc_frames_hdl(_adapter *padapter) -+{ -+#define HIQ_XMIT_COUNTS (6) -+ _irqL irqL; -+ struct sta_info *psta_bmc; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe = NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ bool update_tim = _FALSE; -+ -+ -+ if (padapter->registrypriv.wifi_spec != 1) -+ return H2C_SUCCESS; -+ -+ -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ if (!psta_bmc) -+ return H2C_SUCCESS; -+ -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ if ((pstapriv->tim_bitmap & BIT(0)) && (psta_bmc->sleepq_len > 0)) { -+ int tx_counts = 0; -+ -+ _update_beacon(padapter, _TIM_IE_, NULL, _FALSE, "update TIM with TIB=1"); -+ -+ DBG_871X("sleepq_len of bmc_sta = %d\n", psta_bmc->sleepq_len); -+ -+ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ psta_bmc->sleepq_len--; -+ tx_counts++; -+ -+ if (psta_bmc->sleepq_len > 0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ if (tx_counts == HIQ_XMIT_COUNTS) -+ pxmitframe->attrib.mdata = 0; -+ -+ pxmitframe->attrib.triggered = 1; -+ -+ if (xmitframe_hiq_filter(pxmitframe) == _TRUE) -+ pxmitframe->attrib.qsel = QSLT_HIGH;/*HIQ*/ -+ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ if (tx_counts == HIQ_XMIT_COUNTS) -+ break; -+ -+ } -+ -+ } else { -+ if (psta_bmc->sleepq_len == 0) { -+ -+ /*DBG_871X("sleepq_len of bmc_sta = %d\n", psta_bmc->sleepq_len);*/ -+ -+ if (pstapriv->tim_bitmap & BIT(0)) -+ update_tim = _TRUE; -+ -+ pstapriv->tim_bitmap &= ~BIT(0); -+ pstapriv->sta_dz_bitmap &= ~BIT(0); -+ -+ if (update_tim == _TRUE) { -+ DBG_871X("clear TIB\n"); -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "bmc sleepq and HIQ empty"); -+ } -+ } -+ } -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+/* -+ //HIQ Check -+ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); -+ -+ while (_FALSE == empty && rtw_get_passing_time_ms(start) < 3000) -+ { -+ rtw_msleep_os(100); -+ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); -+ } -+ -+ -+ printk("check if hiq empty=%d\n", empty); -+*/ -+ -+ return H2C_SUCCESS; -+} -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ -+static void associated_stainfo_update(_adapter *padapter, struct sta_info *psta, u32 sta_info_type) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ DBG_871X("%s: "MAC_FMT", updated_type=0x%x\n", __func__, MAC_ARG(psta->hwaddr), sta_info_type); -+ -+ if (sta_info_type & STA_INFO_UPDATE_BW) { -+ -+ if ((psta->flags & WLAN_STA_HT) && !psta->ht_20mhz_set) { -+ if (pmlmepriv->sw_to_20mhz) { -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ /*psta->htpriv.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;*/ -+ psta->htpriv.sgi_40m = _FALSE; -+ } else { -+ /*TODO: Switch back to 40MHZ?80MHZ*/ -+ } -+ } -+ } -+ -+/* -+ if (sta_info_type & STA_INFO_UPDATE_RATE) { -+ -+ } -+*/ -+ -+ if (sta_info_type & STA_INFO_UPDATE_PROTECTION_MODE) -+ VCS_update(padapter, psta); -+ -+/* -+ if (sta_info_type & STA_INFO_UPDATE_CAP) { -+ -+ } -+ -+ if (sta_info_type & STA_INFO_UPDATE_HT_CAP) { -+ -+ } -+ -+ if (sta_info_type & STA_INFO_UPDATE_VHT_CAP) { -+ -+ } -+*/ -+ -+} -+ -+static void update_bcn_ext_capab_ie(_adapter *padapter) -+{ -+ sint ie_len = 0; -+ unsigned char *pbuf; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ u8 *ie = pnetwork->IEs; -+ u8 null_extcap_data[8] = {0}; -+ -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_CAP_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (pbuf && ie_len > 0) -+ rtw_remove_bcn_ie(padapter, pnetwork, _EXT_CAP_IE_); -+ -+ if ((pmlmepriv->ext_capab_ie_len > 0) && -+ (_rtw_memcmp(pmlmepriv->ext_capab_ie_data, null_extcap_data, sizeof(null_extcap_data)) == _FALSE)) -+ rtw_add_bcn_ie(padapter, pnetwork, _EXT_CAP_IE_, pmlmepriv->ext_capab_ie_data, pmlmepriv->ext_capab_ie_len); -+ -+} -+ -+static void update_bcn_fixed_ie(_adapter *padapter) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_erpinfo_ie(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ unsigned char *p, *ie = pnetwork->IEs; -+ u32 len = 0; -+ -+ DBG_871X("%s, ERP_enable=%d\n", __FUNCTION__, pmlmeinfo->ERP_enable); -+ -+ if(!pmlmeinfo->ERP_enable) -+ return; -+ -+ //parsing ERP_IE -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _ERPINFO_IE_, &len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if(p && len>0) -+ { -+ PNDIS_802_11_VARIABLE_IEs pIE = (PNDIS_802_11_VARIABLE_IEs)p; -+ -+ if (pmlmepriv->num_sta_non_erp == 1) -+ pIE->data[0] |= RTW_ERP_INFO_NON_ERP_PRESENT|RTW_ERP_INFO_USE_PROTECTION; -+ else -+ pIE->data[0] &= ~(RTW_ERP_INFO_NON_ERP_PRESENT|RTW_ERP_INFO_USE_PROTECTION); -+ -+ if(pmlmepriv->num_sta_no_short_preamble > 0) -+ pIE->data[0] |= RTW_ERP_INFO_BARKER_PREAMBLE_MODE; -+ else -+ pIE->data[0] &= ~(RTW_ERP_INFO_BARKER_PREAMBLE_MODE); -+ -+ ERP_IE_handler(padapter, pIE); -+ } -+ -+} -+ -+static void update_bcn_htcap_ie(_adapter *padapter) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_htinfo_ie(_adapter *padapter) -+{ -+ /* -+ u8 beacon_updated = _FALSE; -+ u32 sta_info_update_type = STA_INFO_UPDATE_NONE; -+ */ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ unsigned char *p, *ie = pnetwork->IEs; -+ u32 len = 0; -+ -+ if (pmlmepriv->htpriv.ht_option == _FALSE) -+ return; -+ -+ if (pmlmeinfo->HT_info_enable != 1) -+ return; -+ -+ -+ DBG_871X("%s current operation mode=0x%X\n", -+ __FUNCTION__, pmlmepriv->ht_op_mode); -+ -+ DBG_871X("num_sta_40mhz_intolerant(%d), 20mhz_width_req(%d), intolerant_ch_rpt(%d), olbc(%d)\n", -+ pmlmepriv->num_sta_40mhz_intolerant, pmlmepriv->ht_20mhz_width_req, pmlmepriv->ht_intolerant_ch_reported, pmlmepriv->olbc); -+ -+ /*parsing HT_INFO_IE, currently only update ht_op_mode - pht_info->infos[1] & pht_info->infos[2] for wifi logo test*/ -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (p && len > 0) { -+ struct HT_info_element *pht_info = NULL; -+ -+ pht_info = (struct HT_info_element *)(p + 2); -+ -+ /* for STA Channel Width/Secondary Channel Offset*/ -+ if ((pmlmepriv->sw_to_20mhz == 0) && (pmlmeext->cur_channel <= 14)) { -+ if ((pmlmepriv->num_sta_40mhz_intolerant > 0) || (pmlmepriv->ht_20mhz_width_req == _TRUE) -+ || (pmlmepriv->ht_intolerant_ch_reported == _TRUE) || (pmlmepriv->olbc == _TRUE)) { -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(pht_info, 0); -+ SET_HT_OP_ELE_STA_CHL_WIDTH(pht_info, 0); -+ -+ pmlmepriv->sw_to_20mhz = 1; -+ /* -+ sta_info_update_type |= STA_INFO_UPDATE_BW; -+ beacon_updated = _TRUE; -+ */ -+ -+ DBG_871X("%s:switching to 20Mhz\n", __FUNCTION__); -+ -+ /*TODO : cur_bwmode/cur_ch_offset switches to 20Mhz*/ -+ } -+ } else { -+ -+ if ((pmlmepriv->num_sta_40mhz_intolerant == 0) && (pmlmepriv->ht_20mhz_width_req == _FALSE) -+ && (pmlmepriv->ht_intolerant_ch_reported == _FALSE) && (pmlmepriv->olbc == _FALSE)) { -+ -+ if (pmlmeext->cur_bwmode >= CHANNEL_WIDTH_40) { -+ -+ SET_HT_OP_ELE_STA_CHL_WIDTH(pht_info, 1); -+ -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(pht_info, -+ (pmlmeext->cur_ch_offset == HAL_PRIME_CHNL_OFFSET_LOWER) ? -+ HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE : HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW); -+ -+ pmlmepriv->sw_to_20mhz = 0; -+ /* -+ sta_info_update_type |= STA_INFO_UPDATE_BW; -+ beacon_updated = _TRUE; -+ */ -+ -+ DBG_871X("%s:switching back to 40Mhz\n", __FUNCTION__); -+ } -+ } -+ } -+ -+ /* to update ht_op_mode*/ -+ *(u16 *)(pht_info->infos + 1) = cpu_to_le16(pmlmepriv->ht_op_mode); -+ -+ } -+ -+ /*associated_clients_update(padapter, beacon_updated, sta_info_update_type);*/ -+ -+} -+ -+static void update_bcn_rsn_ie(_adapter *padapter) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_wpa_ie(_adapter *padapter) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_wmm_ie(_adapter *padapter) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_wps_ie(_adapter *padapter) -+{ -+ u8 *pwps_ie=NULL, *pwps_ie_src, *premainder_ie, *pbackup_remainder_ie=NULL; -+ uint wps_ielen=0, wps_offset, remainder_ielen; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ unsigned char *ie = pnetwork->IEs; -+ u32 ielen = pnetwork->IELength; -+ -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ pwps_ie = rtw_get_wps_ie(ie+_FIXED_IE_LENGTH_, ielen-_FIXED_IE_LENGTH_, NULL, &wps_ielen); -+ -+ if(pwps_ie==NULL || wps_ielen==0) -+ return; -+ -+ pwps_ie_src = pmlmepriv->wps_beacon_ie; -+ if(pwps_ie_src == NULL) -+ return; -+ -+ wps_offset = (uint)(pwps_ie-ie); -+ -+ premainder_ie = pwps_ie + wps_ielen; -+ -+ remainder_ielen = ielen - wps_offset - wps_ielen; -+ -+ if(remainder_ielen>0) -+ { -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if(pbackup_remainder_ie) -+ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ wps_ielen = (uint)pwps_ie_src[1];//to get ie data len -+ if((wps_offset+wps_ielen+2+remainder_ielen)<=MAX_IE_SZ) -+ { -+ _rtw_memcpy(pwps_ie, pwps_ie_src, wps_ielen+2); -+ pwps_ie += (wps_ielen+2); -+ -+ if(pbackup_remainder_ie) -+ _rtw_memcpy(pwps_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ //update IELength -+ pnetwork->IELength = wps_offset + (wps_ielen+2) + remainder_ielen; -+ } -+ -+ if(pbackup_remainder_ie) -+ rtw_mfree(pbackup_remainder_ie, remainder_ielen); -+ -+ // deal with the case without set_tx_beacon_cmd() in update_beacon() -+#if defined( CONFIG_INTERRUPT_BASED_TXBCN ) || defined( CONFIG_PCI_HCI ) -+ if( (pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ { -+ u8 sr = 0; -+ rtw_get_wps_attr_content(pwps_ie_src, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8*)(&sr), NULL); -+ -+ if( sr ) { -+ set_fwstate(pmlmepriv, WIFI_UNDER_WPS); -+ DBG_871X("%s, set WIFI_UNDER_WPS\n", __func__); -+ } -+ } -+#endif -+} -+ -+static void update_bcn_p2p_ie(_adapter *padapter) -+{ -+ -+} -+ -+static void update_bcn_vendor_spec_ie(_adapter *padapter, u8*oui) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ if(_rtw_memcmp(RTW_WPA_OUI, oui, 4)) -+ { -+ update_bcn_wpa_ie(padapter); -+ } -+ else if(_rtw_memcmp(WMM_OUI, oui, 4)) -+ { -+ update_bcn_wmm_ie(padapter); -+ } -+ else if(_rtw_memcmp(WPS_OUI, oui, 4)) -+ { -+ update_bcn_wps_ie(padapter); -+ } -+ else if(_rtw_memcmp(P2P_OUI, oui, 4)) -+ { -+ update_bcn_p2p_ie(padapter); -+ } -+ else -+ { -+ DBG_871X("unknown OUI type!\n"); -+ } -+ -+ -+} -+ -+void _update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx, const char *tag) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv; -+ struct mlme_ext_priv *pmlmeext; -+ //struct mlme_ext_info *pmlmeinfo; -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ if(!padapter) -+ return; -+ -+ pmlmepriv = &(padapter->mlmepriv); -+ pmlmeext = &(padapter->mlmeextpriv); -+ //pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if(_FALSE == pmlmeext->bstart_bss) -+ return; -+ -+ _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+ -+ switch(ie_id) -+ { -+ case 0xFF: -+ -+ update_bcn_fixed_ie(padapter);//8: TimeStamp, 2: Beacon Interval 2:Capability -+ -+ break; -+ -+ case _TIM_IE_: -+ -+ update_BCNTIM(padapter); -+ -+ break; -+ -+ case _ERPINFO_IE_: -+ -+ update_bcn_erpinfo_ie(padapter); -+ -+ break; -+ -+ case _HT_CAPABILITY_IE_: -+ -+ update_bcn_htcap_ie(padapter); -+ -+ break; -+ -+ case _RSN_IE_2_: -+ -+ update_bcn_rsn_ie(padapter); -+ -+ break; -+ -+ case _HT_ADD_INFO_IE_: -+ -+ update_bcn_htinfo_ie(padapter); -+ -+ break; -+ -+ case _EXT_CAP_IE_: -+ -+ update_bcn_ext_capab_ie(padapter); -+ -+ break; -+ -+ case _VENDOR_SPECIFIC_IE_: -+ -+ update_bcn_vendor_spec_ie(padapter, oui); -+ -+ break; -+ -+ default: -+ break; -+ } -+ -+ pmlmepriv->update_bcn = _TRUE; -+ -+ _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+ -+#ifndef CONFIG_INTERRUPT_BASED_TXBCN -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ if(tx) -+ { -+ //send_beacon(padapter);//send_beacon must execute on TSR level -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" ie_id:%u - %s\n", FUNC_ADPT_ARG(padapter), ie_id, tag); -+ set_tx_beacon_cmd(padapter); -+ } -+#else -+ { -+ //PCI will issue beacon when BCN interrupt occurs. -+ } -+#endif -+#endif //!CONFIG_INTERRUPT_BASED_TXBCN -+ -+} -+ -+#ifdef CONFIG_80211N_HT -+ -+void rtw_process_public_act_bsscoex(_adapter *padapter, u8 *pframe, uint frame_len) -+{ -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 beacon_updated = _FALSE; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ uint frame_body_len = frame_len - sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 category, action; -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta == NULL) -+ return; -+ -+ -+ category = frame_body[0]; -+ action = frame_body[1]; -+ -+ if (frame_body_len > 0) { -+ if ((frame_body[2] == EID_BSSCoexistence) && (frame_body[3] > 0)) { -+ u8 ie_data = frame_body[4]; -+ -+ if (ie_data & RTW_WLAN_20_40_BSS_COEX_40MHZ_INTOL) { -+ if (psta->ht_40mhz_intolerant == 0) { -+ psta->ht_40mhz_intolerant = 1; -+ pmlmepriv->num_sta_40mhz_intolerant++; -+ beacon_updated = _TRUE; -+ } -+ } else if (ie_data & RTW_WLAN_20_40_BSS_COEX_20MHZ_WIDTH_REQ) { -+ if (pmlmepriv->ht_20mhz_width_req == _FALSE) { -+ pmlmepriv->ht_20mhz_width_req = _TRUE; -+ beacon_updated = _TRUE; -+ } -+ } else -+ beacon_updated = _FALSE; -+ } -+ } -+ -+ if (frame_body_len > 8) { -+ /* if EID_BSSIntolerantChlReport ie exists */ -+ if ((frame_body[5] == EID_BSSIntolerantChlReport) && (frame_body[6] > 0)) { -+ /*todo:*/ -+ if (pmlmepriv->ht_intolerant_ch_reported == _FALSE) { -+ pmlmepriv->ht_intolerant_ch_reported = _TRUE; -+ beacon_updated = _TRUE; -+ } -+ } -+ } -+ -+ if (beacon_updated) { -+ -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); -+ -+ associated_stainfo_update(padapter, psta, STA_INFO_UPDATE_BW); -+ } -+ -+ -+ -+} -+ -+void rtw_process_ht_action_smps(_adapter *padapter, u8 *ta, u8 ctrl_field) -+{ -+ u8 e_field, m_field; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ psta = rtw_get_stainfo(pstapriv, ta); -+ if (psta == NULL) -+ return; -+ -+ e_field = (ctrl_field & BIT(0)) ? 1 : 0; -+ m_field = (ctrl_field & BIT(1)) ? 1 : 0; -+ -+ if (e_field) { -+ -+ /* enable */ -+ /* 0:static SMPS, 1:dynamic SMPS, 3:SMPS disabled, 2:reserved*/ -+ -+ if (m_field) /*mode*/ -+ psta->htpriv.smps_cap = 1; -+ else -+ psta->htpriv.smps_cap = 0; -+ } else { -+ /*disable*/ -+ psta->htpriv.smps_cap = 3; -+ } -+ -+ rtw_dm_ra_mask_wk_cmd(padapter, (u8 *)psta); -+ -+} -+ -+/* -+op_mode -+Set to 0 (HT pure) under the followign conditions -+ - all STAs in the BSS are 20/40 MHz HT in 20/40 MHz BSS or -+ - all STAs in the BSS are 20 MHz HT in 20 MHz BSS -+Set to 1 (HT non-member protection) if there may be non-HT STAs -+ in both the primary and the secondary channel -+Set to 2 if only HT STAs are associated in BSS, -+ however and at least one 20 MHz HT STA is associated -+Set to 3 (HT mixed mode) when one or more non-HT STAs are associated -+ (currently non-GF HT station is considered as non-HT STA also) -+*/ -+static int rtw_ht_operation_update(_adapter *padapter) -+{ -+ u16 cur_op_mode, new_op_mode; -+ int op_mode_changes = 0; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; -+ -+ if (pmlmepriv->htpriv.ht_option == _FALSE) -+ return 0; -+ -+ /*if (!iface->conf->ieee80211n || iface->conf->ht_op_mode_fixed) -+ return 0;*/ -+ -+ DBG_871X("%s current operation mode=0x%X\n", -+ __FUNCTION__, pmlmepriv->ht_op_mode); -+ -+ if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT) -+ && pmlmepriv->num_sta_ht_no_gf) { -+ pmlmepriv->ht_op_mode |= -+ HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT; -+ op_mode_changes++; -+ } else if ((pmlmepriv->ht_op_mode & -+ HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT) && -+ pmlmepriv->num_sta_ht_no_gf == 0) { -+ pmlmepriv->ht_op_mode &= -+ ~HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT; -+ op_mode_changes++; -+ } -+ -+ if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) && -+ (pmlmepriv->num_sta_no_ht || pmlmepriv->olbc_ht)) { -+ pmlmepriv->ht_op_mode |= HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT; -+ op_mode_changes++; -+ } else if ((pmlmepriv->ht_op_mode & -+ HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) && -+ (pmlmepriv->num_sta_no_ht == 0 && !pmlmepriv->olbc_ht)) { -+ pmlmepriv->ht_op_mode &= -+ ~HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT; -+ op_mode_changes++; -+ } -+ -+ /* Note: currently we switch to the MIXED op mode if HT non-greenfield -+ * station is associated. Probably it's a theoretical case, since -+ * it looks like all known HT STAs support greenfield. -+ */ -+ new_op_mode = 0; -+ if (pmlmepriv->num_sta_no_ht /*|| -+ (pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT)*/) -+ new_op_mode = OP_MODE_MIXED; -+ else if ((phtpriv_ap->ht_cap.cap_info & IEEE80211_HT_CAP_SUP_WIDTH) -+ && pmlmepriv->num_sta_ht_20mhz) -+ new_op_mode = OP_MODE_20MHZ_HT_STA_ASSOCED; -+ else if (pmlmepriv->olbc_ht) -+ new_op_mode = OP_MODE_MAY_BE_LEGACY_STAS; -+ else -+ new_op_mode = OP_MODE_PURE; -+ -+ cur_op_mode = pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_OP_MODE_MASK; -+ if (cur_op_mode != new_op_mode) { -+ pmlmepriv->ht_op_mode &= ~HT_INFO_OPERATION_MODE_OP_MODE_MASK; -+ pmlmepriv->ht_op_mode |= new_op_mode; -+ op_mode_changes++; -+ } -+ -+ DBG_871X("%s new operation mode=0x%X changes=%d\n", -+ __FUNCTION__, pmlmepriv->ht_op_mode, op_mode_changes); -+ -+ return op_mode_changes; -+ -+} -+ -+#endif /* CONFIG_80211N_HT */ -+ -+void associated_clients_update(_adapter *padapter, u8 updated, u32 sta_info_type) -+{ -+ //update associcated stations cap. -+ if(updated == _TRUE) -+ { -+ _irqL irqL; -+ _list *phead, *plist; -+ struct sta_info *psta=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ //check asoc_queue -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ associated_stainfo_update(padapter, psta, sta_info_type); -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ } -+ -+} -+ -+/* called > TSR LEVEL for USB or SDIO Interface*/ -+void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) -+{ -+ u8 beacon_updated = _FALSE; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ -+#if 0 -+ if (!(psta->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) && -+ !psta->no_short_preamble_set) { -+ psta->no_short_preamble_set = 1; -+ pmlmepriv->num_sta_no_short_preamble++; -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_preamble == 1)) -+ ieee802_11_set_beacons(hapd->iface); -+ } -+#endif -+ -+ -+ if(!(psta->flags & WLAN_STA_SHORT_PREAMBLE)) -+ { -+ if(!psta->no_short_preamble_set) -+ { -+ psta->no_short_preamble_set = 1; -+ -+ pmlmepriv->num_sta_no_short_preamble++; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_preamble == 1)) -+ { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, 0xFF, NULL, _TRUE); -+ } -+ -+ } -+ } -+ else -+ { -+ if(psta->no_short_preamble_set) -+ { -+ psta->no_short_preamble_set = 0; -+ -+ pmlmepriv->num_sta_no_short_preamble--; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_preamble == 0)) -+ { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, 0xFF, NULL, _TRUE); -+ } -+ -+ } -+ } -+ -+#if 0 -+ if (psta->flags & WLAN_STA_NONERP && !psta->nonerp_set) { -+ psta->nonerp_set = 1; -+ pmlmepriv->num_sta_non_erp++; -+ if (pmlmepriv->num_sta_non_erp == 1) -+ ieee802_11_set_beacons(hapd->iface); -+ } -+#endif -+ -+ if(psta->flags & WLAN_STA_NONERP) -+ { -+ if(!psta->nonerp_set) -+ { -+ psta->nonerp_set = 1; -+ -+ pmlmepriv->num_sta_non_erp++; -+ -+ if (pmlmepriv->num_sta_non_erp == 1) -+ { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE); -+ } -+ } -+ -+ } -+ else -+ { -+ if(psta->nonerp_set) -+ { -+ psta->nonerp_set = 0; -+ -+ pmlmepriv->num_sta_non_erp--; -+ -+ if (pmlmepriv->num_sta_non_erp == 0) -+ { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE); -+ } -+ } -+ -+ } -+ -+ -+#if 0 -+ if (!(psta->capability & WLAN_CAPABILITY_SHORT_SLOT) && -+ !psta->no_short_slot_time_set) { -+ psta->no_short_slot_time_set = 1; -+ pmlmepriv->num_sta_no_short_slot_time++; -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_slot_time == 1)) -+ ieee802_11_set_beacons(hapd->iface); -+ } -+#endif -+ -+ if(!(psta->capability & WLAN_CAPABILITY_SHORT_SLOT)) -+ { -+ if(!psta->no_short_slot_time_set) -+ { -+ psta->no_short_slot_time_set = 1; -+ -+ pmlmepriv->num_sta_no_short_slot_time++; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_slot_time == 1)) -+ { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, 0xFF, NULL, _TRUE); -+ } -+ -+ } -+ } -+ else -+ { -+ if(psta->no_short_slot_time_set) -+ { -+ psta->no_short_slot_time_set = 0; -+ -+ pmlmepriv->num_sta_no_short_slot_time--; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_slot_time == 0)) -+ { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, 0xFF, NULL, _TRUE); -+ } -+ } -+ } -+ -+#ifdef CONFIG_80211N_HT -+ -+ if (psta->flags & WLAN_STA_HT) -+ { -+ u16 ht_capab = le16_to_cpu(psta->htpriv.ht_cap.cap_info); -+ -+ DBG_871X("HT: STA " MAC_FMT " HT Capabilities " -+ "Info: 0x%04x\n", MAC_ARG(psta->hwaddr), ht_capab); -+ -+ if (psta->no_ht_set) { -+ psta->no_ht_set = 0; -+ pmlmepriv->num_sta_no_ht--; -+ } -+ -+ if ((ht_capab & IEEE80211_HT_CAP_GRN_FLD) == 0) { -+ if (!psta->no_ht_gf_set) { -+ psta->no_ht_gf_set = 1; -+ pmlmepriv->num_sta_ht_no_gf++; -+ } -+ DBG_871X("%s STA " MAC_FMT " - no " -+ "greenfield, num of non-gf stations %d\n", -+ __FUNCTION__, MAC_ARG(psta->hwaddr), -+ pmlmepriv->num_sta_ht_no_gf); -+ } -+ -+ if ((ht_capab & IEEE80211_HT_CAP_SUP_WIDTH) == 0) { -+ if (!psta->ht_20mhz_set) { -+ psta->ht_20mhz_set = 1; -+ pmlmepriv->num_sta_ht_20mhz++; -+ } -+ DBG_871X("%s STA " MAC_FMT " - 20 MHz HT, " -+ "num of 20MHz HT STAs %d\n", -+ __FUNCTION__, MAC_ARG(psta->hwaddr), -+ pmlmepriv->num_sta_ht_20mhz); -+ } -+ -+ -+ if (ht_capab & RTW_IEEE80211_HT_CAP_40MHZ_INTOLERANT) { -+ -+ if (!psta->ht_40mhz_intolerant) { -+ psta->ht_40mhz_intolerant = 1; -+ pmlmepriv->num_sta_40mhz_intolerant++; -+ DBG_871X("%s STA " MAC_FMT " - HT_CAP_40MHZ_INTOLERANT is set\n" , -+ __FUNCTION__, MAC_ARG(psta->hwaddr)); -+ beacon_updated = _TRUE; -+ } -+ -+/* -+ if (pmlmepriv->ht_40mhz_intolerant == _FALSE) { -+ -+ pmlmepriv->ht_40mhz_intolerant = _TRUE; -+ -+ DBG_871X("%s STA " MAC_FMT " - HT_CAP_40MHZ_INTOLERANT is set\n" , -+ __FUNCTION__, MAC_ARG(psta->hwaddr)); -+ -+ beacon_updated = _TRUE; -+ } -+*/ -+ -+ /*update ext_capab_ie_len & ext_capab_ie_data for beacon, probersp, assocrsp.*/ -+ if (pmlmepriv->ext_capab_ie_len == 0) -+ pmlmepriv->ext_capab_ie_len = 1; -+ SET_EXT_CAPABILITY_ELE_BSS_COEXIST(pmlmepriv->ext_capab_ie_data, 1); -+ -+ update_beacon(padapter, _EXT_CAP_IE_, NULL, _FALSE); -+ } -+ -+ } -+ else -+ { -+ if (!psta->no_ht_set) { -+ psta->no_ht_set = 1; -+ pmlmepriv->num_sta_no_ht++; -+ } -+ if(pmlmepriv->htpriv.ht_option == _TRUE) { -+ DBG_871X("%s STA " MAC_FMT -+ " - no HT, num of non-HT stations %d\n", -+ __FUNCTION__, MAC_ARG(psta->hwaddr), -+ pmlmepriv->num_sta_no_ht); -+ } -+ } -+ -+ if (rtw_ht_operation_update(padapter) > 0) { -+ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); -+ /*beacon_updated = _TRUE;*/ -+ } -+ -+#endif /* CONFIG_80211N_HT */ -+ -+ //update associcated stations cap. -+ associated_clients_update(padapter, beacon_updated, STA_INFO_UPDATE_ALL); -+ -+ DBG_871X("%s, updated=%d\n", __func__, beacon_updated); -+ -+} -+ -+u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta) -+{ -+ u8 beacon_updated = _FALSE; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ if(!psta) -+ return beacon_updated; -+ -+ if (psta->no_short_preamble_set) { -+ psta->no_short_preamble_set = 0; -+ pmlmepriv->num_sta_no_short_preamble--; -+ if (pmlmeext->cur_wireless_mode > WIRELESS_11B -+ && pmlmepriv->num_sta_no_short_preamble == 0) -+ { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, 0xFF, NULL, _TRUE); -+ } -+ } -+ -+ if (psta->nonerp_set) { -+ psta->nonerp_set = 0; -+ pmlmepriv->num_sta_non_erp--; -+ if (pmlmepriv->num_sta_non_erp == 0) -+ { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE); -+ } -+ } -+ -+ if (psta->no_short_slot_time_set) { -+ psta->no_short_slot_time_set = 0; -+ pmlmepriv->num_sta_no_short_slot_time--; -+ if (pmlmeext->cur_wireless_mode > WIRELESS_11B -+ && pmlmepriv->num_sta_no_short_slot_time == 0) -+ { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, 0xFF, NULL, _TRUE); -+ } -+ } -+ -+#ifdef CONFIG_80211N_HT -+ -+ if (psta->no_ht_gf_set) { -+ psta->no_ht_gf_set = 0; -+ pmlmepriv->num_sta_ht_no_gf--; -+ } -+ -+ if (psta->no_ht_set) { -+ psta->no_ht_set = 0; -+ pmlmepriv->num_sta_no_ht--; -+ } -+ -+ if (psta->ht_20mhz_set) { -+ psta->ht_20mhz_set = 0; -+ pmlmepriv->num_sta_ht_20mhz--; -+ } -+ -+ if (psta->ht_40mhz_intolerant) { -+ psta->ht_40mhz_intolerant = 0; -+ pmlmepriv->num_sta_40mhz_intolerant--; -+ -+ /*update ext_capab_ie_len & ext_capab_ie_data for beacon, probersp, assocrsp.*/ -+ if ((pmlmepriv->ext_capab_ie_len > 0) && (pmlmepriv->num_sta_40mhz_intolerant == 0)) { -+ SET_EXT_CAPABILITY_ELE_BSS_COEXIST(pmlmepriv->ext_capab_ie_data, 0); -+ update_beacon(padapter, _EXT_CAP_IE_, NULL, _FALSE); -+ } -+ -+ beacon_updated = _TRUE; -+ -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _FALSE); -+ } -+ -+ if (rtw_ht_operation_update(padapter) > 0) { -+ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); -+ } -+ -+#endif /* CONFIG_80211N_HT */ -+ -+ /* update associated stations cap. -+ associated_clients_update(padapter, beacon_updated, STA_INFO_UPDATE_ALL); //move it to avoid deadlock -+ */ -+ -+ DBG_871X("%s, updated=%d\n", __func__, beacon_updated); -+ -+ return beacon_updated; -+ -+} -+ -+u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reason, bool enqueue) -+{ -+ _irqL irqL; -+ u8 beacon_updated = _FALSE; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ if(!psta) -+ return beacon_updated; -+ -+ if (active == _TRUE) -+ { -+#ifdef CONFIG_80211N_HT -+ //tear down Rx AMPDU -+ send_delba(padapter, 0, psta->hwaddr);// recipient -+ -+ //tear down TX AMPDU -+ send_delba(padapter, 1, psta->hwaddr);// // originator -+ -+#endif //CONFIG_80211N_HT -+ -+ issue_deauth(padapter, psta->hwaddr, reason); -+ } -+ -+#ifdef CONFIG_BEAMFORMING -+ beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_LEAVE, psta->hwaddr, ETH_ALEN, 1); -+#endif -+ -+ psta->htpriv.agg_enable_bitmap = 0x0;//reset -+ psta->htpriv.candidate_tid_bitmap = 0x0;//reset -+ -+ //clear cam entry / key -+ rtw_clearstakey_cmd(padapter, psta, enqueue); -+ -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state &= ~_FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ #ifdef CONFIG_IOCTL_CFG80211 -+ if (1) { -+ #ifdef COMPAT_KERNEL_RELEASE -+ rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason); -+ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason); -+ #else //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ /* will call rtw_cfg80211_indicate_sta_disassoc() in cmd_thread for old API context */ -+ #endif //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ } else -+ #endif //CONFIG_IOCTL_CFG80211 -+ { -+ rtw_indicate_sta_disassoc_event(padapter, psta); -+ } -+ -+ report_del_sta_event(padapter, psta->hwaddr, reason, enqueue); -+ -+ beacon_updated = bss_cap_update_on_sta_leave(padapter, psta); -+ -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ rtw_free_stainfo(padapter, psta); -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ -+ return beacon_updated; -+ -+} -+ -+int rtw_ap_inform_ch_switch(_adapter *padapter, u8 new_ch, u8 ch_offset) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ int ret=0; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+ -+ if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) -+ return ret; -+ -+ DBG_871X(FUNC_NDEV_FMT" with ch:%u, offset:%u\n", -+ FUNC_NDEV_ARG(padapter->pnetdev), new_ch, ch_offset); -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* for each sta in asoc_queue */ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ issue_action_spct_ch_switch(padapter, psta->hwaddr, new_ch, ch_offset); -+ psta->expire_to = ((pstapriv->expire_to * 2) > 5) ? 5 : (pstapriv->expire_to * 2); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ issue_action_spct_ch_switch(padapter, bc_addr, new_ch, ch_offset); -+ -+ return ret; -+} -+ -+int rtw_sta_flush(_adapter *padapter, bool enqueue) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ int ret = 0; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+ u8 flush_num = 0; -+ char flush_list[NUM_STA]; -+ int i; -+ -+ if ((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) -+ return ret; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev)); -+ -+ /* pick sta from sta asoc_queue */ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ int stainfo_offset; -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ flush_list[flush_num++] = stainfo_offset; -+ else -+ rtw_warn_on(1); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ /* call ap_free_sta() for each sta picked */ -+ for (i = 0; i < flush_num; i++) { -+ psta = rtw_get_stainfo_by_offset(pstapriv, flush_list[i]); -+ ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, enqueue); -+ } -+ -+ issue_deauth(padapter, bc_addr, WLAN_REASON_DEAUTH_LEAVING); -+ -+ associated_clients_update(padapter, _TRUE, STA_INFO_UPDATE_ALL); -+ -+ return ret; -+} -+ -+/* called > TSR LEVEL for USB or SDIO Interface*/ -+void sta_info_update(_adapter *padapter, struct sta_info *psta) -+{ -+ int flags = psta->flags; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ -+ //update wmm cap. -+ if(WLAN_STA_WME&flags) -+ psta->qos_option = 1; -+ else -+ psta->qos_option = 0; -+ -+ if(pmlmepriv->qospriv.qos_option == 0) -+ psta->qos_option = 0; -+ -+ -+#ifdef CONFIG_80211N_HT -+ //update 802.11n ht cap. -+ if(WLAN_STA_HT&flags) -+ { -+ psta->htpriv.ht_option = _TRUE; -+ psta->qos_option = 1; -+ -+ psta->htpriv.smps_cap = (psta->htpriv.ht_cap.cap_info & IEEE80211_HT_CAP_SM_PS)>>2; -+ } -+ else -+ { -+ psta->htpriv.ht_option = _FALSE; -+ } -+ -+ if(pmlmepriv->htpriv.ht_option == _FALSE) -+ psta->htpriv.ht_option = _FALSE; -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ //update 802.11AC vht cap. -+ if(WLAN_STA_VHT&flags) -+ { -+ psta->vhtpriv.vht_option = _TRUE; -+ } -+ else -+ { -+ psta->vhtpriv.vht_option = _FALSE; -+ } -+ -+ if(pmlmepriv->vhtpriv.vht_option == _FALSE) -+ psta->vhtpriv.vht_option = _FALSE; -+#endif -+ -+ -+ update_sta_info_apmode(padapter, psta); -+ -+ -+} -+ -+/* called >= TSR LEVEL for USB or SDIO Interface*/ -+void ap_sta_info_defer_update(_adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if(psta->state & _FW_LINKED) -+ { -+ pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta; -+ -+ //add ratid -+ add_RATid(padapter, psta, 0);//DM_RATR_STA_INIT -+ } -+} -+/* restore hw setting from sw data structures */ -+void rtw_ap_restore_network(_adapter *padapter) -+{ -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv * pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ _irqL irqL; -+ _list *phead, *plist; -+ u8 chk_alive_num = 0; -+ char chk_alive_list[NUM_STA]; -+ int i; -+ -+ rtw_setopmode_cmd(padapter, Ndis802_11APMode,_FALSE); -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ rtw_startbss_cmd(padapter, RTW_CMDF_DIRECTLY); -+ -+ if((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) -+ { -+ /* restore group key, WEP keys is restored in ips_leave() */ -+ rtw_set_key(padapter, psecuritypriv, psecuritypriv->dot118021XGrpKeyid, 0,_FALSE); -+ } -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ int stainfo_offset; -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) { -+ chk_alive_list[chk_alive_num++] = stainfo_offset; -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ for (i = 0; i < chk_alive_num; i++) { -+ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); -+ -+ if (psta == NULL) { -+ DBG_871X(FUNC_ADPT_FMT" sta_info is null\n", FUNC_ADPT_ARG(padapter)); -+ } else if (psta->state &_FW_LINKED) { -+ rtw_sta_media_status_rpt(padapter, psta, 1); -+ Update_RA_Entry(padapter, psta); -+ //pairwise key -+ /* per sta pairwise key and settings */ -+ if( (padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) -+ { -+ rtw_setstakey_cmd(padapter, psta, UNICAST_KEY,_FALSE); -+ } -+ } -+ } -+ -+} -+ -+void start_ap_mode(_adapter *padapter) -+{ -+ int i; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ -+ pmlmepriv->update_bcn = _FALSE; -+ -+ /*init_mlme_ap_info(padapter);*/ -+ -+ pmlmeext->bstart_bss = _FALSE; -+ -+ pmlmepriv->num_sta_non_erp = 0; -+ -+ pmlmepriv->num_sta_no_short_slot_time = 0; -+ -+ pmlmepriv->num_sta_no_short_preamble = 0; -+ -+ pmlmepriv->num_sta_ht_no_gf = 0; -+#ifdef CONFIG_80211N_HT -+ pmlmepriv->num_sta_no_ht = 0; -+#endif //CONFIG_80211N_HT -+ pmlmeinfo->HT_info_enable = 0; -+ pmlmeinfo->HT_caps_enable = 0; -+ pmlmeinfo->HT_enable = 0; -+ -+ pmlmepriv->num_sta_ht_20mhz = 0; -+ pmlmepriv->num_sta_40mhz_intolerant = 0; -+ pmlmepriv->olbc = _FALSE; -+ pmlmepriv->olbc_ht = _FALSE; -+ -+#ifdef CONFIG_80211N_HT -+ pmlmepriv->ht_20mhz_width_req = _FALSE; -+ pmlmepriv->ht_intolerant_ch_reported = _FALSE; -+ pmlmepriv->ht_op_mode = 0; -+ pmlmepriv->sw_to_20mhz = 0; -+#endif -+ -+ _rtw_memset(pmlmepriv->ext_capab_ie_data, 0, sizeof(pmlmepriv->ext_capab_ie_data)); -+ pmlmepriv->ext_capab_ie_len = 0; -+ -+ for (i = 0 ; i < NUM_STA ; i++) -+ pstapriv->sta_aid[i] = NULL; -+ -+/* to avoid memory leak issue, don't set to NULL directly -+ pmlmepriv->wps_beacon_ie = NULL; -+ pmlmepriv->wps_probe_resp_ie = NULL; -+ pmlmepriv->wps_assoc_resp_ie = NULL; -+ -+ pmlmepriv->p2p_beacon_ie = NULL; -+ pmlmepriv->p2p_probe_resp_ie = NULL; -+*/ -+ -+ //for ACL -+ _rtw_init_listhead(&(pacl_list->acl_node_q.queue)); -+ pacl_list->num = 0; -+ pacl_list->mode = 0; -+ for(i = 0; i < NUM_ACL; i++) -+ { -+ _rtw_init_listhead(&pacl_list->aclnode[i].list); -+ pacl_list->aclnode[i].valid = _FALSE; -+ } -+ -+} -+ -+void stop_ap_mode(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ struct rtw_wlan_acl_node *paclnode; -+ struct sta_info *psta=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ _queue *pacl_node_q =&pacl_list->acl_node_q; -+ -+ pmlmepriv->update_bcn = _FALSE; -+ pmlmeext->bstart_bss = _FALSE; -+ padapter->netif_up = _FALSE; -+ //_rtw_spinlock_free(&pmlmepriv->bcn_update_lock); -+ -+ //reset and init security priv , this can refine with rtw_reset_securitypriv -+ _rtw_memset((unsigned char *)&padapter->securitypriv, 0, sizeof (struct security_priv)); -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled; -+ -+ #ifdef CONFIG_DFS_MASTER -+ rtw_dfs_master_status_apply(padapter, MLME_AP_STOPPED); -+ #endif -+ -+ /* free scan queue */ -+ rtw_free_network_queue(padapter, _TRUE); -+ -+ //for ACL -+ _enter_critical_bh(&(pacl_node_q->lock), &irqL); -+ phead = get_list_head(pacl_node_q); -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { -+ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); -+ plist = get_next(plist); -+ -+ if(paclnode->valid == _TRUE) -+ { -+ paclnode->valid = _FALSE; -+ -+ rtw_list_delete(&paclnode->list); -+ -+ pacl_list->num--; -+ } -+ } -+ _exit_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ DBG_871X("%s, free acl_node_queue, num=%d\n", __func__, pacl_list->num); -+ -+ rtw_sta_flush(padapter, _TRUE); -+ -+ //free_assoc_sta_resources -+ rtw_free_all_stainfo(padapter); -+ -+ psta = rtw_get_bcmc_stainfo(padapter); -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ rtw_free_stainfo(padapter, psta); -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ rtw_init_bcmc_stainfo(padapter); -+ -+ rtw_free_mlme_priv_ie_data(pmlmepriv); -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_MediaStatusNotify(padapter, 0); //disconnect -+#endif -+ -+} -+ -+#endif //CONFIG_NATIVEAP_MLME -+ -+void rtw_ap_update_bss_chbw(_adapter *adapter, WLAN_BSSID_EX *bss, u8 ch, u8 bw, u8 offset) -+{ -+#define UPDATE_VHT_CAP 1 -+#define UPDATE_HT_CAP 1 -+ -+#ifdef CONFIG_80211AC_VHT -+ { -+ struct vht_priv *vhtpriv = &adapter->mlmepriv.vhtpriv; -+ u8 *vht_cap_ie, *vht_op_ie; -+ int vht_cap_ielen, vht_op_ielen; -+ u8 center_freq; -+ -+ vht_cap_ie = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_VHTCapability, &vht_cap_ielen, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ vht_op_ie = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_VHTOperation, &vht_op_ielen, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ center_freq = rtw_get_center_ch(ch, bw, offset); -+ -+ /* update vht cap ie */ -+ if (vht_cap_ie && vht_cap_ielen) { -+ #if UPDATE_VHT_CAP -+ /* if ((bw == CHANNEL_WIDTH_160 || bw == CHANNEL_WIDTH_80_80) && pvhtpriv->sgi_160m) -+ SET_VHT_CAPABILITY_ELE_SHORT_GI160M(pvht_cap_ie + 2, 1); -+ else */ -+ SET_VHT_CAPABILITY_ELE_SHORT_GI160M(vht_cap_ie + 2, 0); -+ -+ if (bw >= CHANNEL_WIDTH_80 && vhtpriv->sgi_80m) -+ SET_VHT_CAPABILITY_ELE_SHORT_GI80M(vht_cap_ie + 2, 1); -+ else -+ SET_VHT_CAPABILITY_ELE_SHORT_GI80M(vht_cap_ie + 2, 0); -+ #endif -+ } -+ -+ /* update vht op ie */ -+ if (vht_op_ie && vht_op_ielen) { -+ if (bw < CHANNEL_WIDTH_80) { -+ SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2, 0); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op_ie + 2, 0); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op_ie + 2, 0); -+ } else if (bw == CHANNEL_WIDTH_80) { -+ SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2, 1); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op_ie + 2, center_freq); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op_ie + 2, 0); -+ } else { -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT" unsupported BW:%u\n", FUNC_ADPT_ARG(adapter), bw); -+ rtw_warn_on(1); -+ } -+ } -+ } -+#endif /* CONFIG_80211AC_VHT */ -+#ifdef CONFIG_80211N_HT -+ { -+ struct ht_priv *htpriv = &adapter->mlmepriv.htpriv; -+ u8 *ht_cap_ie, *ht_op_ie; -+ int ht_cap_ielen, ht_op_ielen; -+ -+ ht_cap_ie = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_HTCapability, &ht_cap_ielen, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ ht_op_ie = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_HTInfo, &ht_op_ielen, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ -+ /* update ht cap ie */ -+ if (ht_cap_ie && ht_cap_ielen) { -+ #if UPDATE_HT_CAP -+ if (bw >= CHANNEL_WIDTH_40) -+ SET_HT_CAP_ELE_CHL_WIDTH(ht_cap_ie + 2, 1); -+ else -+ SET_HT_CAP_ELE_CHL_WIDTH(ht_cap_ie + 2, 0); -+ -+ if (bw >= CHANNEL_WIDTH_40 && htpriv->sgi_40m) -+ SET_HT_CAP_ELE_SHORT_GI40M(ht_cap_ie + 2, 1); -+ else -+ SET_HT_CAP_ELE_SHORT_GI40M(ht_cap_ie + 2, 0); -+ -+ if (htpriv->sgi_20m) -+ SET_HT_CAP_ELE_SHORT_GI20M(ht_cap_ie + 2, 1); -+ else -+ SET_HT_CAP_ELE_SHORT_GI20M(ht_cap_ie + 2, 0); -+ #endif -+ } -+ -+ /* update ht op ie */ -+ if (ht_op_ie && ht_op_ielen) { -+ SET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2, ch); -+ switch (offset) { -+ case HAL_PRIME_CHNL_OFFSET_LOWER: -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2, SCA); -+ break; -+ case HAL_PRIME_CHNL_OFFSET_UPPER: -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2, SCB); -+ break; -+ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: -+ default: -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2, SCN); -+ break; -+ } -+ -+ if (bw >= CHANNEL_WIDTH_40) -+ SET_HT_OP_ELE_STA_CHL_WIDTH(ht_op_ie + 2, 1); -+ else -+ SET_HT_OP_ELE_STA_CHL_WIDTH(ht_op_ie + 2, 0); -+ } -+ } -+#endif /* CONFIG_80211N_HT */ -+ -+{ -+ u8 *p; -+ int ie_len; -+ u8 old_ch = bss->Configuration.DSConfig; -+ bool change_band = _FALSE; -+ -+ if ((ch <= 14 && old_ch >= 36) || (ch >= 36 && old_ch <= 14)) -+ change_band = _TRUE; -+ -+ /* update channel in IE */ -+ p = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if (p && ie_len > 0) -+ *(p + 2) = ch; -+ -+ bss->Configuration.DSConfig = ch; -+ -+ /* band is changed, update ERP, support rate, ext support rate IE */ -+ if (change_band == _TRUE) -+ change_band_update_ie(adapter, bss, ch); -+} -+ -+} -+ -+bool rtw_ap_chbw_decision(_adapter *adapter, u8 req_ch, u8 req_bw, u8 req_offset -+ , u8 *ch, u8 *bw, u8 *offset) -+{ -+ u8 dec_ch, dec_bw, dec_offset; -+ u8 u_ch = 0, u_offset, u_bw; -+ bool changed = _FALSE; -+ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); -+ u8 sta_num; -+ u8 ld_sta_num; -+ u8 lg_sta_num; -+ u8 ap_num; -+ u8 ld_ap_num; -+ bool set_u_ch = _FALSE, set_dec_ch = _FALSE; -+ -+ dec_ch = req_ch; -+ dec_bw = req_bw; -+ dec_offset = req_offset; -+ -+ rtw_dev_iface_status_no_self(adapter, &sta_num, &ld_sta_num, &lg_sta_num, &ap_num, &ld_ap_num); -+ DBG_871X(FUNC_ADPT_FMT" ld_sta_num:%u, lg_sta_num%u, ap_num:%u\n" -+ , FUNC_ADPT_ARG(adapter), ld_sta_num, lg_sta_num, ap_num); -+ -+ if (ld_sta_num || ap_num) { -+ /* has linked STA or AP mode, follow */ -+ -+ rtw_warn_on(!rtw_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset)); -+ -+ DBG_871X(FUNC_ADPT_FMT" union no self: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); -+ DBG_871X(FUNC_ADPT_FMT" req: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), req_ch, req_bw, req_offset); -+ -+ rtw_regsty_adjust_chbw(&adapter->registrypriv, u_ch, &dec_bw, &dec_offset); -+ -+ rtw_sync_chbw(&dec_ch, &dec_bw, &dec_offset -+ , &u_ch, &u_bw, &u_offset); -+ -+ rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) -+ , dec_ch, dec_bw, dec_offset); -+ -+ set_u_ch = _TRUE; -+ } else if (lg_sta_num) { -+ /* has linking STA */ -+ -+ rtw_warn_on(!rtw_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset)); -+ -+ DBG_871X(FUNC_ADPT_FMT" union no self: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); -+ DBG_871X(FUNC_ADPT_FMT" req: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), req_ch, req_bw, req_offset); -+ -+ rtw_regsty_adjust_chbw(&adapter->registrypriv, dec_ch, &dec_bw, &dec_offset); -+ -+ if (rtw_is_chbw_grouped(u_ch, u_bw, u_offset, dec_ch, dec_bw, dec_offset)) { -+ -+ rtw_sync_chbw(&dec_ch, &dec_bw, &dec_offset -+ , &u_ch, &u_bw, &u_offset); -+ -+ rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) -+ , dec_ch, dec_bw, dec_offset); -+ -+ set_u_ch = _TRUE; -+ } else { -+ /* set this for possible ch change when join down*/ -+ set_fwstate(&adapter->mlmepriv, WIFI_OP_CH_SWITCHING); -+ } -+ } else { -+ /* single AP mode */ -+ -+ DBG_871X(FUNC_ADPT_FMT" req: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), req_ch, req_bw, req_offset); -+ rtw_regsty_adjust_chbw(&adapter->registrypriv, dec_ch, &dec_bw, &dec_offset); -+ -+ #if defined(CONFIG_DFS_MASTER) -+ /* check NOL */ -+ if (rtw_chset_is_ch_non_ocp(mlmeext->channel_set, dec_ch, dec_bw, dec_offset)) { -+ /* choose 5G DFS channel for debug */ -+ if (adapter_to_rfctl(adapter)->dbg_dfs_master_choose_dfs_ch_first -+ && rtw_choose_available_chbw(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, RTW_CHF_2G|RTW_CHF_NON_DFS) == _TRUE) { -+ DBG_871X(FUNC_ADPT_FMT" choose 5G DFS channel for debug\n", FUNC_ADPT_ARG(adapter)); -+ } else -+ /* choose from 5G no DFS */ -+ if (rtw_choose_available_chbw(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, RTW_CHF_2G|RTW_CHF_DFS) == _FALSE) { -+ /* including 5G DFS, not long CAC */ -+ if (rtw_choose_available_chbw(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, RTW_CHF_2G|RTW_CHF_LONG_CAC) == _FALSE) { -+ /* including 5G DFS, long CAC */ -+ if (rtw_choose_available_chbw(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, RTW_CHF_2G) == _FALSE) { -+ /* including 2.4G channel */ -+ if (rtw_choose_available_chbw(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, RTW_CHF_5G) == _FALSE) { -+ DBG_871X(FUNC_ADPT_FMT" no available ch\n", FUNC_ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ } -+ } -+ } -+ } -+ } -+ #endif /* defined(CONFIG_DFS_MASTER) */ -+ -+ rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) -+ , dec_ch, dec_bw, dec_offset); -+ -+ set_dec_ch = _TRUE; -+ } -+ -+ if (check_fwstate(&adapter->mlmepriv, _FW_UNDER_SURVEY) -+ #ifdef CONFIG_CONCURRENT_MODE -+ || check_buddy_fwstate(adapter, _FW_UNDER_SURVEY) -+ #endif -+ ) { -+ /* scanning, leave ch setting to scan state machine */ -+ set_u_ch = set_dec_ch = _FALSE; -+ } -+ -+ if (mlmeext->cur_channel != dec_ch -+ || mlmeext->cur_bwmode != dec_bw -+ || mlmeext->cur_ch_offset != dec_offset) -+ changed = _TRUE; -+ -+ if (changed == _TRUE && rtw_linked_check(adapter) == _TRUE) { -+ #ifdef CONFIG_SPCT_CH_SWITCH -+ if (1) -+ rtw_ap_inform_ch_switch(adapter, dec_ch, dec_offset); -+ else -+ #endif -+ rtw_sta_flush(adapter, _FALSE); -+ } -+ -+ mlmeext->cur_channel = dec_ch; -+ mlmeext->cur_bwmode = dec_bw; -+ mlmeext->cur_ch_offset = dec_offset; -+ -+ if (u_ch != 0) -+ DBG_871X(FUNC_ADPT_FMT" union: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); -+ -+ DBG_871X(FUNC_ADPT_FMT" dec: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), dec_ch, dec_bw, dec_offset); -+ -+ if (set_u_ch == _TRUE) { -+ *ch = u_ch; -+ *bw = u_bw; -+ *offset = u_offset; -+ } else if (set_dec_ch == _TRUE) { -+ *ch = dec_ch; -+ *bw = dec_bw; -+ *offset = dec_offset; -+ } -+ -+ return changed; -+} -+ -+#endif //CONFIG_AP_MODE -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_beamforming.c linux/3rdparty/rtl8812au/core/rtw_beamforming.c ---- linux.old/3rdparty/rtl8812au/core/rtw_beamforming.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_beamforming.c 2017-06-07 23:07:20.998686391 +0300 -@@ -0,0 +1,1244 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_BEAMFORMING_C_ -+ -+#include -+#include -+ -+#ifdef CONFIG_BEAMFORMING -+ -+#if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ -+struct beamforming_entry *beamforming_get_entry_by_addr(struct mlme_priv *pmlmepriv, u8* ra,u8* idx) -+{ -+ u8 i = 0; -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ -+ for(i = 0; i < BEAMFORMING_ENTRY_NUM; i++) -+ { -+ if( pBeamInfo->beamforming_entry[i].bUsed && -+ (_rtw_memcmp(ra,pBeamInfo->beamforming_entry[i].mac_addr, ETH_ALEN))) -+ { -+ *idx = i; -+ return &(pBeamInfo->beamforming_entry[i]); -+ } -+ } -+ -+ return NULL; -+} -+ -+BEAMFORMING_CAP beamforming_get_entry_beam_cap_by_mac_id(PVOID pmlmepriv ,u8 mac_id) -+{ -+ u8 i = 0; -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO((struct mlme_priv *)pmlmepriv); -+ BEAMFORMING_CAP BeamformEntryCap = BEAMFORMING_CAP_NONE; -+ -+ for(i = 0; i < BEAMFORMING_ENTRY_NUM; i++) -+ { -+ if( pBeamInfo->beamforming_entry[i].bUsed && -+ (mac_id == pBeamInfo->beamforming_entry[i].mac_id)) -+ { -+ BeamformEntryCap = pBeamInfo->beamforming_entry[i].beamforming_entry_cap; -+ i = BEAMFORMING_ENTRY_NUM; -+ } -+ } -+ -+ return BeamformEntryCap; -+} -+ -+struct beamforming_entry *beamforming_get_free_entry(struct mlme_priv *pmlmepriv, u8* idx) -+{ -+ u8 i = 0; -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ -+ for(i = 0; i < BEAMFORMING_ENTRY_NUM; i++) -+ { -+ if(pBeamInfo->beamforming_entry[i].bUsed == _FALSE) -+ { -+ *idx = i; -+ return &(pBeamInfo->beamforming_entry[i]); -+ } -+ } -+ return NULL; -+} -+ -+ -+struct beamforming_entry *beamforming_add_entry(PADAPTER adapter, u8* ra, u16 aid, -+ u16 mac_id, CHANNEL_WIDTH bw, BEAMFORMING_CAP beamfrom_cap, u8* idx) -+{ -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct beamforming_entry *pEntry = beamforming_get_free_entry(pmlmepriv, idx); -+ -+ if(pEntry != NULL) -+ { -+ pEntry->bUsed = _TRUE; -+ pEntry->aid = aid; -+ pEntry->mac_id = mac_id; -+ pEntry->sound_bw = bw; -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ { -+ u16 BSSID = ((*(adapter_mac_addr(adapter) + 5) & 0xf0) >> 4) ^ -+ (*(adapter_mac_addr(adapter) + 5) & 0xf); /* BSSID[44:47] xor BSSID[40:43] */ -+ pEntry->p_aid = (aid + BSSID * 32) & 0x1ff; // (dec(A) + dec(B)*32) mod 512 -+ pEntry->g_id = 63; -+ } -+ else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) -+ { -+ pEntry->p_aid = 0; -+ pEntry->g_id = 63; -+ } -+ else -+ { -+ pEntry->p_aid = ra[5]; // BSSID[39:47] -+ pEntry->p_aid = (pEntry->p_aid << 1) | (ra[4] >> 7 ); -+ pEntry->g_id = 0; -+ } -+ _rtw_memcpy(pEntry->mac_addr, ra, ETH_ALEN); -+ pEntry->bSound = _FALSE; -+ -+ //3 TODO SW/FW sound period -+ pEntry->sound_period = 200; -+ pEntry->beamforming_entry_cap = beamfrom_cap; -+ pEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ -+ -+ pEntry->PreLogSeq = 0; /*Modified by Jeffery @2015-04-13*/ -+ pEntry->LogSeq = 0; /*Modified by Jeffery @2014-10-29*/ -+ pEntry->LogRetryCnt = 0; /*Modified by Jeffery @2014-10-29*/ -+ pEntry->LogSuccess = 0; /*LogSuccess is NOT needed to be accumulated, so LogSuccessCnt->LogSuccess, 2015-04-13, Jeffery*/ -+ pEntry->ClockResetTimes = 0; /*Modified by Jeffery @2015-04-13*/ -+ pEntry->LogStatusFailCnt = 0; -+ -+ return pEntry; -+ } -+ else -+ return NULL; -+} -+ -+BOOLEAN beamforming_remove_entry(struct mlme_priv *pmlmepriv, u8* ra, u8* idx) -+{ -+ struct beamforming_entry *pEntry = beamforming_get_entry_by_addr(pmlmepriv, ra, idx); -+ -+ if(pEntry != NULL) -+ { -+ pEntry->bUsed = _FALSE; -+ pEntry->beamforming_entry_cap = BEAMFORMING_CAP_NONE; -+ pEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ return _TRUE; -+ } -+ else -+ return _FALSE; -+} -+ -+/* Used for BeamformingStart_V1 */ -+void beamforming_dym_ndpa_rate(PADAPTER adapter) -+{ -+ u16 NDPARate = MGN_6M; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); -+ -+ if(pHalData->MinUndecoratedPWDBForDM > 30) // link RSSI > 30% -+ NDPARate = MGN_24M; -+ else -+ NDPARate = MGN_6M; -+ -+ //BW = CHANNEL_WIDTH_20; -+ NDPARate = NDPARate << 8; -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_RATE, (u8 *)&NDPARate); -+} -+ -+void beamforming_dym_period(PADAPTER Adapter) -+{ -+ u8 Idx; -+ BOOLEAN bChangePeriod = _FALSE; -+ u16 SoundPeriod_SW, SoundPeriod_FW; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ struct beamforming_entry *pBeamformEntry; -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(( &Adapter->mlmepriv)); -+ struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); -+ -+ //3 TODO per-client throughput caculation. -+ -+ if(pdvobjpriv->traffic_stat.cur_tx_tp + pdvobjpriv->traffic_stat.cur_rx_tp > 2) -+ { -+ SoundPeriod_SW = 32*20; -+ SoundPeriod_FW = 2; -+ } -+ else -+ { -+ SoundPeriod_SW = 32*2000; -+ SoundPeriod_FW = 200; -+ } -+ -+ for(Idx = 0; Idx < BEAMFORMING_ENTRY_NUM; Idx++) -+ { -+ pBeamformEntry = pBeamInfo->beamforming_entry+Idx; -+ if(pBeamformEntry->bDefaultCSI) -+ { -+ SoundPeriod_SW = 32*2000; -+ SoundPeriod_FW = 200; -+ } -+ -+ if(pBeamformEntry->beamforming_entry_cap & (BEAMFORMER_CAP_HT_EXPLICIT |BEAMFORMER_CAP_VHT_SU)) -+ { -+ if(pSoundInfo->sound_mode == SOUNDING_FW_VHT_TIMER || pSoundInfo->sound_mode == SOUNDING_FW_HT_TIMER) -+ { -+ if(pBeamformEntry->sound_period != SoundPeriod_FW) -+ { -+ pBeamformEntry->sound_period = SoundPeriod_FW; -+ bChangePeriod = _TRUE; // Only FW sounding need to send H2C packet to change sound period. -+ } -+ } -+ else if(pBeamformEntry->sound_period != SoundPeriod_SW) -+ { -+ pBeamformEntry->sound_period = SoundPeriod_SW; -+ } -+ } -+ } -+ -+ if(bChangePeriod) -+ rtw_hal_set_hwreg(Adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&Idx); -+} -+ -+BOOLEAN issue_ht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; -+ u8 *pframe; -+ u16 *fctrl; -+ u16 duration = 0; -+ u8 aSifsTime = 0; -+ u8 NDPTxRate = 0; -+ -+ DBG_871X("%s: issue_ht_sw_ndpa_packet!\n", __func__); -+ -+ NDPTxRate = MGN_MCS8; -+ DBG_871X("%s: NDPTxRate =%d\n", __func__, NDPTxRate); -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) -+ return _FALSE; -+ -+ /*update attribute*/ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ pattrib->qsel = QSLT_MGNT; -+ pattrib->rate = NDPTxRate; -+ pattrib->bwmode = bw; -+ pattrib->order = 1; -+ pattrib->subtype = WIFI_ACTION_NOACK; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetOrderBit(pframe); -+ SetFrameSubType(pframe, WIFI_ACTION_NOACK); -+ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ if (pmlmeext->cur_wireless_mode == WIRELESS_11B) -+ aSifsTime = 10; -+ else -+ aSifsTime = 16; -+ -+ duration = 2*aSifsTime + 40; -+ -+ if (bw == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ SetDuration(pframe, duration); -+ -+ /*HT control field*/ -+ SET_HT_CTRL_CSI_STEERING(pframe+24, 3); -+ SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe+24, 1); -+ -+ _rtw_memcpy(pframe+28, ActionHdr, 4); -+ -+ pattrib->pktlen = 32; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ return _TRUE; -+ -+ -+} -+BOOLEAN issue_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; -+ u8 *pframe; -+ u16 *fctrl; -+ u16 duration = 0; -+ u8 aSifsTime = 0; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) -+ return _FALSE; -+ -+ /*update attribute*/ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ -+ if (qidx == BCN_QUEUE_INX) -+ pattrib->qsel = QSLT_BEACON; -+ pattrib->rate = MGN_MCS8; -+ pattrib->bwmode = bw; -+ pattrib->order = 1; -+ pattrib->subtype = WIFI_ACTION_NOACK; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetOrderBit(pframe); -+ SetFrameSubType(pframe, WIFI_ACTION_NOACK); -+ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ if( pmlmeext->cur_wireless_mode == WIRELESS_11B) -+ aSifsTime = 10; -+ else -+ aSifsTime = 16; -+ -+ duration = 2*aSifsTime + 40; -+ -+ if(bw == CHANNEL_WIDTH_40) -+ duration+= 87; -+ else -+ duration+= 180; -+ -+ SetDuration(pframe, duration); -+ -+ //HT control field -+ SET_HT_CTRL_CSI_STEERING(pframe+24, 3); -+ SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe+24, 1); -+ -+ _rtw_memcpy(pframe+28, ActionHdr, 4); -+ -+ pattrib->pktlen = 32; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+BOOLEAN beamforming_send_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx) -+{ -+ return issue_ht_ndpa_packet(Adapter, ra, bw, qidx); -+} -+BOOLEAN issue_vht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct rtw_ndpa_sta_info sta_info; -+ u8 NDPTxRate = 0; -+ -+ u8 *pframe; -+ u16 *fctrl; -+ u16 duration = 0; -+ u8 sequence = 0, aSifsTime = 0; -+ -+ DBG_871X("%s: issue_vht_sw_ndpa_packet!\n", __func__); -+ -+ -+ NDPTxRate = MGN_VHT2SS_MCS0; -+ DBG_871X("%s: NDPTxRate =%d\n", __func__, NDPTxRate); -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ DBG_871X("%s, alloc mgnt frame fail\n", __func__); -+ return _FALSE; -+ } -+ -+ /*update attribute*/ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ pattrib->qsel = QSLT_MGNT; -+ pattrib->rate = NDPTxRate; -+ pattrib->bwmode = bw; -+ pattrib->subtype = WIFI_NDPA; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetFrameSubType(pframe, WIFI_NDPA); -+ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); -+ -+ if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ duration = 2*aSifsTime + 44; -+ -+ if (bw == CHANNEL_WIDTH_80) -+ duration += 40; -+ else if (bw == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ SetDuration(pframe, duration); -+ -+ sequence = pBeamInfo->sounding_sequence << 2; -+ if (pBeamInfo->sounding_sequence >= 0x3f) -+ pBeamInfo->sounding_sequence = 0; -+ else -+ pBeamInfo->sounding_sequence++; -+ -+ _rtw_memcpy(pframe+16, &sequence, 1); -+ if (((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ aid = 0; -+ -+ sta_info.aid = aid; -+ sta_info.feedback_type = 0; -+ sta_info.nc_index = 0; -+ -+ _rtw_memcpy(pframe+17, (u8 *)&sta_info, 2); -+ -+ pattrib->pktlen = 19; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ -+ return _TRUE; -+ -+} -+BOOLEAN issue_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct rtw_ndpa_sta_info sta_info; -+ u8 *pframe; -+ u16 *fctrl; -+ u16 duration = 0; -+ u8 sequence = 0, aSifsTime = 0; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ return _FALSE; -+ -+ /*update attribute*/ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ -+ if (qidx == BCN_QUEUE_INX) -+ pattrib->qsel = QSLT_BEACON; -+ pattrib->rate = MGN_VHT2SS_MCS0; -+ pattrib->bwmode = bw; -+ pattrib->subtype = WIFI_NDPA; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetFrameSubType(pframe, WIFI_NDPA); -+ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); -+ -+ if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ duration = 2*aSifsTime + 44; -+ -+ if(bw == CHANNEL_WIDTH_80) -+ duration += 40; -+ else if(bw == CHANNEL_WIDTH_40) -+ duration+= 87; -+ else -+ duration+= 180; -+ -+ SetDuration(pframe, duration); -+ -+ sequence = pBeamInfo->sounding_sequence<< 2; -+ if (pBeamInfo->sounding_sequence >= 0x3f) -+ pBeamInfo->sounding_sequence = 0; -+ else -+ pBeamInfo->sounding_sequence++; -+ -+ _rtw_memcpy(pframe+16, &sequence,1); -+ -+ if(((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ aid = 0; -+ -+ sta_info.aid = aid; -+ sta_info.feedback_type = 0; -+ sta_info.nc_index= 0; -+ -+ _rtw_memcpy(pframe+17, (u8 *)&sta_info, 2); -+ -+ pattrib->pktlen = 19; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+BOOLEAN beamforming_send_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) -+{ -+ return issue_vht_ndpa_packet(Adapter, ra, aid, bw, qidx); -+} -+ -+BOOLEAN beamfomring_bSounding(struct beamforming_info *pBeamInfo) -+{ -+ BOOLEAN bSounding = _FALSE; -+ -+ if(( beamforming_get_beamform_cap(pBeamInfo) & BEAMFORMER_CAP) == 0) -+ bSounding = _FALSE; -+ else -+ bSounding = _TRUE; -+ -+ return bSounding; -+} -+ -+u8 beamforming_sounding_idx(struct beamforming_info *pBeamInfo) -+{ -+ u8 idx = 0; -+ u8 i; -+ -+ for(i = 0; i < BEAMFORMING_ENTRY_NUM; i++) -+ { -+ if (pBeamInfo->beamforming_entry[i].bUsed && -+ (_FALSE == pBeamInfo->beamforming_entry[i].bSound)) -+ { -+ idx = i; -+ break; -+ } -+ } -+ -+ return idx; -+} -+ -+SOUNDING_MODE beamforming_sounding_mode(struct beamforming_info *pBeamInfo, u8 idx) -+{ -+ struct beamforming_entry BeamEntry = pBeamInfo->beamforming_entry[idx]; -+ SOUNDING_MODE mode; -+ -+ if(BeamEntry.beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) -+ { -+ mode = SOUNDING_FW_VHT_TIMER; -+ } -+ else if(BeamEntry.beamforming_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT) -+ { -+ mode = SOUNDING_FW_HT_TIMER; -+ } -+ else -+ { -+ mode = SOUNDING_STOP_All_TIMER; -+ } -+ -+ return mode; -+} -+ -+u16 beamforming_sounding_time(struct beamforming_info *pBeamInfo, SOUNDING_MODE mode, u8 idx) -+{ -+ u16 sounding_time = 0xffff; -+ struct beamforming_entry BeamEntry = pBeamInfo->beamforming_entry[idx]; -+ -+ sounding_time = BeamEntry.sound_period; -+ -+ return sounding_time; -+} -+ -+CHANNEL_WIDTH beamforming_sounding_bw(struct beamforming_info *pBeamInfo, SOUNDING_MODE mode, u8 idx) -+{ -+ CHANNEL_WIDTH sounding_bw = CHANNEL_WIDTH_20; -+ struct beamforming_entry BeamEntry = pBeamInfo->beamforming_entry[idx]; -+ -+ sounding_bw = BeamEntry.sound_bw; -+ -+ return sounding_bw; -+} -+ -+BOOLEAN beamforming_select_beam_entry(struct beamforming_info *pBeamInfo) -+{ -+ struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); -+ -+ pSoundInfo->sound_idx = beamforming_sounding_idx(pBeamInfo); -+ -+ if(pSoundInfo->sound_idx < BEAMFORMING_ENTRY_NUM) -+ pSoundInfo->sound_mode = beamforming_sounding_mode(pBeamInfo, pSoundInfo->sound_idx); -+ else -+ pSoundInfo->sound_mode = SOUNDING_STOP_All_TIMER; -+ -+ if(SOUNDING_STOP_All_TIMER == pSoundInfo->sound_mode) -+ { -+ return _FALSE; -+ } -+ else -+ { -+ pSoundInfo->sound_bw = beamforming_sounding_bw(pBeamInfo, pSoundInfo->sound_mode, pSoundInfo->sound_idx ); -+ pSoundInfo->sound_period = beamforming_sounding_time(pBeamInfo, pSoundInfo->sound_mode, pSoundInfo->sound_idx ); -+ return _TRUE; -+ } -+} -+ -+BOOLEAN beamforming_start_fw(PADAPTER adapter, u8 idx) -+{ -+ u8 *RA = NULL; -+ struct beamforming_entry *pEntry; -+ BOOLEAN ret = _TRUE; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ -+ pEntry = &(pBeamInfo->beamforming_entry[idx]); -+ if(pEntry->bUsed == _FALSE) -+ { -+ DBG_871X("Skip Beamforming, no entry for Idx =%d\n", idx); -+ return _FALSE; -+ } -+ -+ pEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; -+ pEntry->bSound = _TRUE; -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&idx); -+ -+ return _TRUE; -+} -+ -+void beamforming_end_fw(PADAPTER adapter) -+{ -+ u8 idx = 0; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&idx); -+ -+ DBG_871X("%s\n", __FUNCTION__); -+} -+ -+BOOLEAN beamforming_start_period(PADAPTER adapter) -+{ -+ BOOLEAN ret = _TRUE; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); -+ -+ beamforming_dym_ndpa_rate(adapter); -+ -+ beamforming_select_beam_entry(pBeamInfo); -+ -+ if(pSoundInfo->sound_mode == SOUNDING_FW_VHT_TIMER || pSoundInfo->sound_mode == SOUNDING_FW_HT_TIMER) -+ { -+ ret = beamforming_start_fw(adapter, pSoundInfo->sound_idx); -+ } -+ else -+ { -+ ret = _FALSE; -+ } -+ -+ DBG_871X("%s Idx %d Mode %d BW %d Period %d\n", __FUNCTION__, -+ pSoundInfo->sound_idx, pSoundInfo->sound_mode, pSoundInfo->sound_bw, pSoundInfo->sound_period); -+ -+ return ret; -+} -+ -+void beamforming_end_period(PADAPTER adapter) -+{ -+ u8 idx = 0; -+ struct beamforming_entry *pBeamformEntry; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); -+ -+ -+ if(pSoundInfo->sound_mode == SOUNDING_FW_VHT_TIMER || pSoundInfo->sound_mode == SOUNDING_FW_HT_TIMER) -+ { -+ beamforming_end_fw(adapter); -+ } -+} -+ -+void beamforming_notify(PADAPTER adapter) -+{ -+ BOOLEAN bSounding = _FALSE; -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(&(adapter->mlmepriv)); -+ -+ bSounding = beamfomring_bSounding(pBeamInfo); -+ -+ if(pBeamInfo->beamforming_state == BEAMFORMING_STATE_IDLE) -+ { -+ if(bSounding) -+ { -+ if(beamforming_start_period(adapter) == _TRUE) -+ pBeamInfo->beamforming_state = BEAMFORMING_STATE_START; -+ } -+ } -+ else if(pBeamInfo->beamforming_state == BEAMFORMING_STATE_START) -+ { -+ if(bSounding) -+ { -+ if(beamforming_start_period(adapter) == _FALSE) -+ pBeamInfo->beamforming_state = BEAMFORMING_STATE_END; -+ } -+ else -+ { -+ beamforming_end_period(adapter); -+ pBeamInfo->beamforming_state = BEAMFORMING_STATE_END; -+ } -+ } -+ else if(pBeamInfo->beamforming_state == BEAMFORMING_STATE_END) -+ { -+ if(bSounding) -+ { -+ if(beamforming_start_period(adapter) == _TRUE) -+ pBeamInfo->beamforming_state = BEAMFORMING_STATE_START; -+ } -+ } -+ else -+ { -+ DBG_871X("%s BeamformState %d\n", __FUNCTION__, pBeamInfo->beamforming_state); -+ } -+ -+ DBG_871X("%s BeamformState %d bSounding %d\n", __FUNCTION__, pBeamInfo->beamforming_state, bSounding); -+} -+ -+BOOLEAN beamforming_init_entry(PADAPTER adapter, struct sta_info *psta, u8* idx) -+{ -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct ht_priv *phtpriv = &(pmlmepriv->htpriv); -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv *pvhtpriv = &(pmlmepriv->vhtpriv); -+#endif -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct beamforming_entry *pBeamformEntry = NULL; -+ u8 *ra; -+ u16 aid, mac_id; -+ u8 wireless_mode; -+ CHANNEL_WIDTH bw = CHANNEL_WIDTH_20; -+ BEAMFORMING_CAP beamform_cap = BEAMFORMING_CAP_NONE; -+ -+ // The current setting does not support Beaforming -+ if (0 == phtpriv->beamform_cap -+#ifdef CONFIG_80211AC_VHT -+ && 0 == pvhtpriv->beamform_cap -+#endif -+ ) { -+ DBG_871X("The configuration disabled Beamforming! Skip...\n"); -+ return _FALSE; -+ } -+ -+ aid = psta->aid; -+ ra = psta->hwaddr; -+ mac_id = psta->mac_id; -+ wireless_mode = psta->wireless_mode; -+ bw = psta->bw_mode; -+ -+ if (IsSupportedHT(wireless_mode) || IsSupportedVHT(wireless_mode)) { -+ //3 // HT -+ u8 cur_beamform; -+ -+ cur_beamform = psta->htpriv.beamform_cap; -+ -+ // We are Beamformee because the STA is Beamformer -+ if(TEST_FLAG(cur_beamform, BEAMFORMING_HT_BEAMFORMER_ENABLE)) -+ beamform_cap =(BEAMFORMING_CAP)(beamform_cap |BEAMFORMEE_CAP_HT_EXPLICIT); -+ -+ // We are Beamformer because the STA is Beamformee -+ if(TEST_FLAG(cur_beamform, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) -+ beamform_cap =(BEAMFORMING_CAP)(beamform_cap | BEAMFORMER_CAP_HT_EXPLICIT); -+#ifdef CONFIG_80211AC_VHT -+ if (IsSupportedVHT(wireless_mode)) { -+ //3 // VHT -+ cur_beamform = psta->vhtpriv.beamform_cap; -+ -+ // We are Beamformee because the STA is Beamformer -+ if(TEST_FLAG(cur_beamform, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) -+ beamform_cap =(BEAMFORMING_CAP)(beamform_cap |BEAMFORMEE_CAP_VHT_SU); -+ // We are Beamformer because the STA is Beamformee -+ if(TEST_FLAG(cur_beamform, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) -+ beamform_cap =(BEAMFORMING_CAP)(beamform_cap |BEAMFORMER_CAP_VHT_SU); -+ } -+#endif //CONFIG_80211AC_VHT -+ -+ if(beamform_cap == BEAMFORMING_CAP_NONE) -+ return _FALSE; -+ -+ DBG_871X("Beamforming Config Capability = 0x%02X\n", beamform_cap); -+ -+ pBeamformEntry = beamforming_get_entry_by_addr(pmlmepriv, ra, idx); -+ if (pBeamformEntry == NULL) { -+ pBeamformEntry = beamforming_add_entry(adapter, ra, aid, mac_id, bw, beamform_cap, idx); -+ if(pBeamformEntry == NULL) -+ return _FALSE; -+ else -+ pBeamformEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; -+ } else { -+ // Entry has been created. If entry is initialing or progressing then errors occur. -+ if (pBeamformEntry->beamforming_entry_state != BEAMFORMING_ENTRY_STATE_INITIALIZED && -+ pBeamformEntry->beamforming_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ DBG_871X("Error State of Beamforming"); -+ return _FALSE; -+ } else { -+ pBeamformEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; -+ } -+ } -+ -+ pBeamformEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ psta->txbf_paid = pBeamformEntry->p_aid; -+ psta->txbf_gid = pBeamformEntry->g_id; -+ -+ DBG_871X("%s Idx %d\n", __FUNCTION__, *idx); -+ } else { -+ return _FALSE; -+ } -+ -+ return _SUCCESS; -+} -+ -+void beamforming_deinit_entry(PADAPTER adapter, u8* ra) -+{ -+ u8 idx = 0; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ if(beamforming_remove_entry(pmlmepriv, ra, &idx) == _TRUE) -+ { -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_LEAVE, (u8 *)&idx); -+ } -+ -+ DBG_871X("%s Idx %d\n", __FUNCTION__, idx); -+} -+ -+void beamforming_reset(PADAPTER adapter) -+{ -+ u8 idx = 0; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ -+ for(idx = 0; idx < BEAMFORMING_ENTRY_NUM; idx++) -+ { -+ if(pBeamInfo->beamforming_entry[idx].bUsed == _TRUE) -+ { -+ pBeamInfo->beamforming_entry[idx].bUsed = _FALSE; -+ pBeamInfo->beamforming_entry[idx].beamforming_entry_cap = BEAMFORMING_CAP_NONE; -+ pBeamInfo->beamforming_entry[idx].beamforming_entry_state= BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_LEAVE, (u8 *)&idx); -+ } -+ } -+ -+ DBG_871X("%s\n", __FUNCTION__); -+} -+ -+void beamforming_sounding_fail(PADAPTER Adapter) -+{ -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct beamforming_entry *pEntry = &(pBeamInfo->beamforming_entry[pBeamInfo->beamforming_cur_idx]); -+ -+ pEntry->bSound = _FALSE; -+ rtw_hal_set_hwreg(Adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&pBeamInfo->beamforming_cur_idx); -+ beamforming_deinit_entry(Adapter, pEntry->mac_addr); -+} -+ -+void beamforming_check_sounding_success(PADAPTER Adapter,BOOLEAN status) -+{ -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct beamforming_entry *pEntry = &(pBeamInfo->beamforming_entry[pBeamInfo->beamforming_cur_idx]); -+ -+ if(status == 1) -+ { -+ pEntry->LogStatusFailCnt = 0; -+ } -+ else -+ { -+ pEntry->LogStatusFailCnt++; -+ DBG_871X("%s LogStatusFailCnt %d\n", __FUNCTION__, pEntry->LogStatusFailCnt); -+ } -+ if(pEntry->LogStatusFailCnt > 20) -+ { -+ DBG_871X("%s LogStatusFailCnt > 20, Stop SOUNDING\n", __FUNCTION__); -+ //pEntry->bSound = _FALSE; -+ //rtw_hal_set_hwreg(Adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&pBeamInfo->beamforming_cur_idx); -+ //beamforming_deinit_entry(Adapter, pEntry->mac_addr); -+ beamforming_wk_cmd(Adapter, BEAMFORMING_CTRL_SOUNDING_FAIL, NULL, 0, 1); -+ } -+} -+ -+void beamforming_enter(PADAPTER adapter, PVOID psta) -+{ -+ u8 idx = 0xff; -+ -+ if(beamforming_init_entry(adapter, (struct sta_info *)psta, &idx)) -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_ENTER, (u8 *)&idx); -+ -+ //DBG_871X("%s Idx %d\n", __FUNCTION__, idx); -+} -+ -+void beamforming_leave(PADAPTER adapter,u8* ra) -+{ -+ if(ra == NULL) -+ beamforming_reset(adapter); -+ else -+ beamforming_deinit_entry(adapter, ra); -+ -+ beamforming_notify(adapter); -+} -+ -+BEAMFORMING_CAP beamforming_get_beamform_cap(struct beamforming_info *pBeamInfo) -+{ -+ u8 i; -+ BOOLEAN bSelfBeamformer = _FALSE; -+ BOOLEAN bSelfBeamformee = _FALSE; -+ struct beamforming_entry beamforming_entry; -+ BEAMFORMING_CAP beamform_cap = BEAMFORMING_CAP_NONE; -+ -+ for(i = 0; i < BEAMFORMING_ENTRY_NUM; i++) -+ { -+ beamforming_entry = pBeamInfo->beamforming_entry[i]; -+ -+ if(beamforming_entry.bUsed) -+ { -+ if( (beamforming_entry.beamforming_entry_cap & BEAMFORMEE_CAP_VHT_SU) || -+ (beamforming_entry.beamforming_entry_cap & BEAMFORMEE_CAP_HT_EXPLICIT)) -+ bSelfBeamformee = _TRUE; -+ if( (beamforming_entry.beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) || -+ (beamforming_entry.beamforming_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT)) -+ bSelfBeamformer = _TRUE; -+ } -+ -+ if(bSelfBeamformer && bSelfBeamformee) -+ i = BEAMFORMING_ENTRY_NUM; -+ } -+ -+ if(bSelfBeamformer) -+ beamform_cap |= BEAMFORMER_CAP; -+ if(bSelfBeamformee) -+ beamform_cap |= BEAMFORMEE_CAP; -+ -+ return beamform_cap; -+} -+ -+void beamforming_watchdog(PADAPTER Adapter) -+{ -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(( &(Adapter->mlmepriv))); -+ -+ if(pBeamInfo->beamforming_state != BEAMFORMING_STATE_START) -+ return; -+ -+ beamforming_dym_period(Adapter); -+ beamforming_dym_ndpa_rate(Adapter); -+} -+#endif/* #if (BEAMFORMING_SUPPORT ==0) - for diver defined beamforming*/ -+ -+u32 beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_frame) -+{ -+ u32 ret = _SUCCESS; -+#if (BEAMFORMING_SUPPORT == 1) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ ret = Beamforming_GetReportFrame(pDM_Odm, precv_frame); -+ -+#else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ -+ struct beamforming_entry *pBeamformEntry = NULL; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ u32 frame_len = precv_frame->u.hdr.len; -+ u8 *ta; -+ u8 idx, offset; -+ -+ /*DBG_871X("beamforming_get_report_frame\n");*/ -+ -+ /*Memory comparison to see if CSI report is the same with previous one*/ -+ ta = GetAddr2Ptr(pframe); -+ pBeamformEntry = beamforming_get_entry_by_addr(pmlmepriv, ta, &idx); -+ if (pBeamformEntry->beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) -+ offset = 31; /*24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ -+ else if (pBeamformEntry->beamforming_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT) -+ offset = 34; /*24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ -+ else -+ return ret; -+ -+ /*DBG_871X("%s MacId %d offset=%d\n", __FUNCTION__, pBeamformEntry->mac_id, offset);*/ -+ -+ if (_rtw_memcmp(pBeamformEntry->PreCsiReport + offset, pframe+offset, frame_len-offset) == _FALSE) -+ pBeamformEntry->DefaultCsiCnt = 0; -+ else -+ pBeamformEntry->DefaultCsiCnt++; -+ -+ _rtw_memcpy(&pBeamformEntry->PreCsiReport, pframe, frame_len); -+ -+ pBeamformEntry->bDefaultCSI = _FALSE; -+ -+ if (pBeamformEntry->DefaultCsiCnt > 20) -+ pBeamformEntry->bDefaultCSI = _TRUE; -+ else -+ pBeamformEntry->bDefaultCSI = _FALSE; -+#endif -+ return ret; -+} -+ -+void beamforming_get_ndpa_frame(PADAPTER Adapter, union recv_frame *precv_frame) -+{ -+#if (BEAMFORMING_SUPPORT == 1) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ Beamforming_GetNDPAFrame(pDM_Odm, precv_frame); -+ -+#else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ -+ u8 *ta; -+ u8 idx, Sequence; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct beamforming_entry *pBeamformEntry = NULL; -+ -+ /*DBG_871X("beamforming_get_ndpa_frame\n");*/ -+ -+ if (IS_HARDWARE_TYPE_8812(Adapter) == _FALSE) -+ return; -+ else if (GetFrameSubType(pframe) != WIFI_NDPA) -+ return; -+ -+ ta = GetAddr2Ptr(pframe); -+ /*Remove signaling TA. */ -+ ta[0] = ta[0] & 0xFE; -+ -+ pBeamformEntry = beamforming_get_entry_by_addr(pmlmepriv, ta, &idx); -+ -+ if (pBeamformEntry == NULL) -+ return; -+ else if (!(pBeamformEntry->beamforming_entry_cap & BEAMFORMEE_CAP_VHT_SU)) -+ return; -+ /*LogSuccess: As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is NO LONGER needed !2015-04-10, Jeffery*/ -+ /*ClockResetTimes: While BFer entry always doesn't receive our CSI, clock will reset again and again.So ClockResetTimes is limited to 5 times.2015-04-13, Jeffery*/ -+ else if ((pBeamformEntry->LogSuccess == 1) || (pBeamformEntry->ClockResetTimes == 5)) { -+ DBG_871X("[%s] LogSeq=%d, PreLogSeq=%d\n", __func__, pBeamformEntry->LogSeq, pBeamformEntry->PreLogSeq); -+ return; -+ } -+ -+ Sequence = (pframe[16]) >> 2; -+ DBG_871X("[%s] Start, Sequence=%d, LogSeq=%d, PreLogSeq=%d, LogRetryCnt=%d, ClockResetTimes=%d, LogSuccess=%d\n", -+ __func__, Sequence, pBeamformEntry->LogSeq, pBeamformEntry->PreLogSeq, pBeamformEntry->LogRetryCnt, pBeamformEntry->ClockResetTimes, pBeamformEntry->LogSuccess); -+ -+ if ((pBeamformEntry->LogSeq != 0) && (pBeamformEntry->PreLogSeq != 0)) { -+ /*Success condition*/ -+ if ((pBeamformEntry->LogSeq != Sequence) && (pBeamformEntry->PreLogSeq != pBeamformEntry->LogSeq)) { -+ /* break option for clcok reset, 2015-03-30, Jeffery */ -+ pBeamformEntry->LogRetryCnt = 0; -+ /*As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is no longer needed.*/ -+ /*That is, LogSuccess is NOT needed to be reset to zero, 2015-04-13, Jeffery*/ -+ pBeamformEntry->LogSuccess = 1; -+ -+ } else {/*Fail condition*/ -+ -+ if (pBeamformEntry->LogRetryCnt == 5) { -+ pBeamformEntry->ClockResetTimes++; -+ pBeamformEntry->LogRetryCnt = 0; -+ -+ DBG_871X("[%s] Clock Reset!!! ClockResetTimes=%d\n", __func__, pBeamformEntry->ClockResetTimes); -+ beamforming_wk_cmd(Adapter, BEAMFORMING_CTRL_SOUNDING_CLK, NULL, 0, 1); -+ -+ } else -+ pBeamformEntry->LogRetryCnt++; -+ } -+ } -+ -+ /*Update LogSeq & PreLogSeq*/ -+ pBeamformEntry->PreLogSeq = pBeamformEntry->LogSeq; -+ pBeamformEntry->LogSeq = Sequence; -+ -+#endif -+ -+} -+ -+ -+ -+ -+void beamforming_wk_hdl(_adapter *padapter, u8 type, u8 *pbuf) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+_func_enter_; -+ -+#if (BEAMFORMING_SUPPORT == 1) /*(BEAMFORMING_SUPPORT == 1)- for PHYDM beamfoming*/ -+ switch (type) { -+ case BEAMFORMING_CTRL_ENTER: -+ { -+ struct sta_info *psta = (PVOID)pbuf; -+ u16 staIdx = psta->mac_id; -+ -+ Beamforming_Enter(pDM_Odm, staIdx); -+ break; -+ } -+ case BEAMFORMING_CTRL_LEAVE: -+ Beamforming_Leave(pDM_Odm, pbuf); -+ break; -+ default: -+ break; -+ -+ } -+#else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ -+ switch (type) { -+ case BEAMFORMING_CTRL_ENTER: -+ beamforming_enter(padapter, (PVOID)pbuf); -+ break; -+ -+ case BEAMFORMING_CTRL_LEAVE: -+ beamforming_leave(padapter, pbuf); -+ break; -+ -+ case BEAMFORMING_CTRL_SOUNDING_FAIL: -+ beamforming_sounding_fail(padapter); -+ break; -+ -+ case BEAMFORMING_CTRL_SOUNDING_CLK: -+ rtw_hal_set_hwreg(padapter, HW_VAR_SOUNDING_CLK, NULL); -+ break; -+ -+ default: -+ break; -+ } -+#endif -+_func_exit_; -+} -+ -+u8 beamforming_wk_cmd(_adapter*padapter, s32 type, u8 *pbuf, s32 size, u8 enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+_func_enter_; -+ -+ if(enqueue) -+ { -+ u8 *wk_buf; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ if (pbuf != NULL) { -+ wk_buf = rtw_zmalloc(size); -+ if(wk_buf==NULL){ -+ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memcpy(wk_buf, pbuf, size); -+ } else { -+ wk_buf = NULL; -+ size = 0; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = BEAMFORMING_WK_CID; -+ pdrvextra_cmd_parm->type = type; -+ pdrvextra_cmd_parm->size = size; -+ pdrvextra_cmd_parm->pbuf = wk_buf; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } -+ else -+ { -+ beamforming_wk_hdl(padapter, type, pbuf); -+ } -+ -+exit: -+ -+_func_exit_; -+ -+ return res; -+} -+ -+void update_attrib_txbf_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) -+{ -+ if (psta) { -+ pattrib->txbf_g_id = psta->txbf_gid; -+ pattrib->txbf_p_aid = psta->txbf_paid; -+ } -+} -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812au/core/rtw_br_ext.c ---- linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_br_ext.c 2017-06-07 23:07:20.998686391 +0300 -@@ -0,0 +1,1699 @@ ++#endif //CONFIG_ADAPTOR_INFO_CACHING_FILE +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_ap.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ap.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_ap.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ap.c 2018-02-06 17:42:30.693966912 +0200 +@@ -0,0 +1,3158 @@ +/****************************************************************************** + * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -7173,10 +1323,3167 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++#define _RTW_AP_C_ ++ ++#include ++ ++ ++#ifdef CONFIG_AP_MODE ++ ++extern unsigned char RTW_WPA_OUI[]; ++extern unsigned char WMM_OUI[]; ++extern unsigned char WPS_OUI[]; ++extern unsigned char P2P_OUI[]; ++extern unsigned char WFD_OUI[]; ++ ++void init_mlme_ap_info(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; ++ ++ ++ _rtw_spinlock_init(&pmlmepriv->bcn_update_lock); ++ ++ //for ACL ++ _rtw_init_queue(&pacl_list->acl_node_q); ++ ++ //pmlmeext->bstart_bss = false; ++ ++ start_ap_mode(padapter); ++} ++ ++void free_mlme_ap_info(_adapter *padapter) ++{ ++ _irqL irqL; ++ struct sta_info *psta=NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ //stop_ap_mode(padapter); ++ ++ pmlmepriv->update_bcn = false; ++ pmlmeext->bstart_bss = false; ++ ++ rtw_sta_flush(padapter); ++ ++ pmlmeinfo->state = _HW_STATE_NOLINK_; ++ ++ //free_assoc_sta_resources ++ rtw_free_all_stainfo(padapter); ++ ++ //free bc/mc sta_info ++ psta = rtw_get_bcmc_stainfo(padapter); ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ rtw_free_stainfo(padapter, psta); ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ ++ ++ _rtw_spinlock_free(&pmlmepriv->bcn_update_lock); ++ ++} ++ ++static void update_BCNTIM(_adapter *padapter) ++{ ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork_mlmeext = &(pmlmeinfo->network); ++ unsigned char *pie = pnetwork_mlmeext->IEs; ++ ++ //DBG_871X("%s\n", __FUNCTION__); ++ ++ //update TIM IE ++ //if(pstapriv->tim_bitmap) ++ if(true) ++ { ++ u8 *p, *dst_ie, *premainder_ie=NULL, *pbackup_remainder_ie=NULL; ++ u16 tim_bitmap_le; ++ uint offset, tmp_len, tim_ielen, tim_ie_offset, remainder_ielen; ++ ++ tim_bitmap_le = cpu_to_le16(pstapriv->tim_bitmap); ++ ++ p = rtw_get_ie(pie + _FIXED_IE_LENGTH_, _TIM_IE_, &tim_ielen, pnetwork_mlmeext->IELength - _FIXED_IE_LENGTH_); ++ if (p != NULL && tim_ielen>0) ++ { ++ tim_ielen += 2; ++ ++ premainder_ie = p+tim_ielen; ++ ++ tim_ie_offset = (sint)(p -pie); ++ ++ remainder_ielen = pnetwork_mlmeext->IELength - tim_ie_offset - tim_ielen; ++ ++ //append TIM IE from dst_ie offset ++ dst_ie = p; ++ } ++ else ++ { ++ tim_ielen = 0; ++ ++ //calucate head_len ++ offset = _FIXED_IE_LENGTH_; ++ ++ /* get ssid_ie len */ ++ p = rtw_get_ie(pie + _BEACON_IE_OFFSET_, _SSID_IE_, &tmp_len, (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_)); ++ if (p != NULL) ++ offset += tmp_len+2; ++ ++ // get supported rates len ++ p = rtw_get_ie(pie + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &tmp_len, (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_)); ++ if (p != NULL) ++ { ++ offset += tmp_len+2; ++ } ++ ++ //DS Parameter Set IE, len=3 ++ offset += 3; ++ ++ premainder_ie = pie + offset; ++ ++ remainder_ielen = pnetwork_mlmeext->IELength - offset - tim_ielen; ++ ++ //append TIM IE from offset ++ dst_ie = pie + offset; ++ ++ } ++ ++ ++ if(remainder_ielen>0) ++ { ++ pbackup_remainder_ie = rtw_malloc(remainder_ielen); ++ if(pbackup_remainder_ie && premainder_ie) ++ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); ++ } ++ ++ *dst_ie++=_TIM_IE_; ++ ++ if((pstapriv->tim_bitmap&0xff00) && (pstapriv->tim_bitmap&0x00fe)) ++ tim_ielen = 5; ++ else ++ tim_ielen = 4; ++ ++ *dst_ie++= tim_ielen; ++ ++ *dst_ie++=0;//DTIM count ++ *dst_ie++=1;//DTIM peroid ++ ++ if(pstapriv->tim_bitmap&BIT(0))//for bc/mc frames ++ *dst_ie++ = BIT(0);//bitmap ctrl ++ else ++ *dst_ie++ = 0; ++ ++ if(tim_ielen==4) ++ { ++ u8 pvb=0; ++ ++ if(pstapriv->tim_bitmap&0x00fe) ++ pvb = (u8)tim_bitmap_le; ++ else if(pstapriv->tim_bitmap&0xff00) ++ pvb = (u8)(tim_bitmap_le>>8); ++ else ++ pvb = (u8)tim_bitmap_le; ++ ++ *dst_ie++ = pvb; ++ ++ } ++ else if(tim_ielen==5) ++ { ++ _rtw_memcpy(dst_ie, &tim_bitmap_le, 2); ++ dst_ie+=2; ++ } ++ ++ //copy remainder IE ++ if(pbackup_remainder_ie) ++ { ++ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); ++ ++ rtw_mfree(pbackup_remainder_ie, remainder_ielen); ++ } ++ ++ offset = (uint)(dst_ie - pie); ++ pnetwork_mlmeext->IELength = offset + remainder_ielen; ++ ++ } ++ ++#ifndef CONFIG_INTERRUPT_BASED_TXBCN ++ set_tx_beacon_cmd(padapter); ++#endif //!CONFIG_INTERRUPT_BASED_TXBCN ++} ++ ++void rtw_add_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index, u8 *data, u8 len) ++{ ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 bmatch = false; ++ u8 *pie = pnetwork->IEs; ++ u8 *p, *dst_ie, *premainder_ie=NULL, *pbackup_remainder_ie=NULL; ++ u32 i, offset, ielen, ie_offset, remainder_ielen = 0; ++ ++ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pnetwork->IELength;) ++ { ++ pIE = (PNDIS_802_11_VARIABLE_IEs)(pnetwork->IEs + i); ++ ++ if (pIE->ElementID > index) ++ { ++ break; ++ } ++ else if(pIE->ElementID == index) // already exist the same IE ++ { ++ p = (u8 *)pIE; ++ ielen = pIE->Length; ++ bmatch = true; ++ break; ++ } ++ ++ p = (u8 *)pIE; ++ ielen = pIE->Length; ++ i += (pIE->Length + 2); ++ } ++ ++ if (p != NULL && ielen>0) ++ { ++ ielen += 2; ++ ++ premainder_ie = p+ielen; ++ ++ ie_offset = (sint)(p -pie); ++ ++ remainder_ielen = pnetwork->IELength - ie_offset - ielen; ++ ++ if(bmatch) ++ dst_ie = p; ++ else ++ dst_ie = (p+ielen); ++ } ++ ++ if(remainder_ielen>0) ++ { ++ pbackup_remainder_ie = rtw_malloc(remainder_ielen); ++ if(pbackup_remainder_ie && premainder_ie) ++ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); ++ } ++ ++ *dst_ie++=index; ++ *dst_ie++=len; ++ ++ _rtw_memcpy(dst_ie, data, len); ++ dst_ie+=len; ++ ++ //copy remainder IE ++ if(pbackup_remainder_ie) ++ { ++ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); ++ ++ rtw_mfree(pbackup_remainder_ie, remainder_ielen); ++ } ++ ++ offset = (uint)(dst_ie - pie); ++ pnetwork->IELength = offset + remainder_ielen; ++} ++ ++void rtw_remove_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index) ++{ ++ u8 *p, *dst_ie, *premainder_ie=NULL, *pbackup_remainder_ie=NULL; ++ uint offset, ielen, ie_offset, remainder_ielen = 0; ++ u8 *pie = pnetwork->IEs; ++ ++ p = rtw_get_ie(pie + _FIXED_IE_LENGTH_, index, &ielen, pnetwork->IELength - _FIXED_IE_LENGTH_); ++ if (p != NULL && ielen>0) ++ { ++ ielen += 2; ++ ++ premainder_ie = p+ielen; ++ ++ ie_offset = (sint)(p -pie); ++ ++ remainder_ielen = pnetwork->IELength - ie_offset - ielen; ++ ++ dst_ie = p; ++ } ++ ++ if(remainder_ielen>0) ++ { ++ pbackup_remainder_ie = rtw_malloc(remainder_ielen); ++ if(pbackup_remainder_ie && premainder_ie) ++ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); ++ } ++ ++ //copy remainder IE ++ if(pbackup_remainder_ie) ++ { ++ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); ++ ++ rtw_mfree(pbackup_remainder_ie, remainder_ielen); ++ } ++ ++ offset = (uint)(dst_ie - pie); ++ pnetwork->IELength = offset + remainder_ielen; ++} ++ ++ ++u8 chk_sta_is_alive(struct sta_info *psta); ++u8 chk_sta_is_alive(struct sta_info *psta) ++{ ++ u8 ret = false; ++ #ifdef DBG_EXPIRATION_CHK ++ DBG_871X("sta:"MAC_FMT", rssi:%d, rx:"STA_PKTS_FMT", expire_to:%u, %s%ssq_len:%u\n" ++ , MAC_ARG(psta->hwaddr) ++ , psta->rssi_stat.UndecoratedSmoothedPWDB ++ //, STA_RX_PKTS_ARG(psta) ++ , STA_RX_PKTS_DIFF_ARG(psta) ++ , psta->expire_to ++ , psta->state&WIFI_SLEEP_STATE?"PS, ":"" ++ , psta->state&WIFI_STA_ALIVE_CHK_STATE?"SAC, ":"" ++ , psta->sleepq_len ++ ); ++ #endif ++ ++ //if(sta_last_rx_pkts(psta) == sta_rx_pkts(psta)) ++ if((psta->sta_stats.last_rx_data_pkts + psta->sta_stats.last_rx_ctrl_pkts) == (psta->sta_stats.rx_data_pkts + psta->sta_stats.rx_ctrl_pkts)) ++ { ++ #if 0 ++ if(psta->state&WIFI_SLEEP_STATE) ++ ret = true; ++ #endif ++ } ++ else ++ { ++ ret = true; ++ } ++ ++ sta_update_last_rx_pkts(psta); ++ ++ return ret; ++} ++ ++void expire_timeout_chk(_adapter *padapter) ++{ ++ _irqL irqL; ++ _list *phead, *plist; ++ u8 updated; ++ struct sta_info *psta=NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 chk_alive_num = 0; ++ char chk_alive_list[NUM_STA]; ++ int i; ++ ++ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ ++ phead = &pstapriv->auth_list; ++ plist = get_next(phead); ++ ++ //check auth_queue ++ #ifdef DBG_EXPIRATION_CHK ++ if (rtw_end_of_queue_search(phead, plist) == false) { ++ DBG_871X(FUNC_NDEV_FMT" auth_list, cnt:%u\n" ++ , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->auth_list_cnt); ++ } ++ #endif ++ while ((rtw_end_of_queue_search(phead, plist)) == false) ++ { ++ psta = LIST_CONTAINOR(plist, struct sta_info, auth_list); ++ plist = get_next(plist); ++ ++ if(psta->expire_to>0) ++ { ++ psta->expire_to--; ++ if (psta->expire_to == 0) ++ { ++ rtw_list_delete(&psta->auth_list); ++ pstapriv->auth_list_cnt--; ++ ++ DBG_871X("auth expire %02X%02X%02X%02X%02X%02X\n", ++ psta->hwaddr[0],psta->hwaddr[1],psta->hwaddr[2],psta->hwaddr[3],psta->hwaddr[4],psta->hwaddr[5]); ++ ++ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ rtw_free_stainfo(padapter, psta); ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ ++ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ } ++ } ++ ++ } ++ ++ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ ++ psta = NULL; ++ ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ //check asoc_queue ++ #ifdef DBG_EXPIRATION_CHK ++ if (rtw_end_of_queue_search(phead, plist) == false) { ++ DBG_871X(FUNC_NDEV_FMT" asoc_list, cnt:%u\n" ++ , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->asoc_list_cnt); ++ } ++ #endif ++ while ((rtw_end_of_queue_search(phead, plist)) == false) ++ { ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ plist = get_next(plist); ++ ++#ifdef CONFIG_AUTO_AP_MODE ++ if(psta->isrc) ++ continue; ++#endif ++ ++ if (chk_sta_is_alive(psta) || !psta->expire_to) { ++ psta->expire_to = pstapriv->expire_to; ++ psta->keep_alive_trycnt = 0; ++ #ifdef CONFIG_TX_MCAST2UNI ++ psta->under_exist_checking = 0; ++ #endif // CONFIG_TX_MCAST2UNI ++ } else { ++ psta->expire_to--; ++ } ++ ++#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++#ifdef CONFIG_TX_MCAST2UNI ++#ifdef CONFIG_80211N_HT ++ if ( (psta->flags & WLAN_STA_HT) && (psta->htpriv.agg_enable_bitmap || psta->under_exist_checking) ) { ++ // check sta by delba(addba) for 11n STA ++ // ToDo: use CCX report to check for all STAs ++ //DBG_871X("asoc check by DELBA/ADDBA! (pstapriv->expire_to=%d s)(psta->expire_to=%d s), [%02x, %d]\n", pstapriv->expire_to*2, psta->expire_to*2, psta->htpriv.agg_enable_bitmap, psta->under_exist_checking); ++ ++ if ( psta->expire_to <= (pstapriv->expire_to - 50 ) ) { ++ DBG_871X("asoc expire by DELBA/ADDBA! (%d s)\n", (pstapriv->expire_to-psta->expire_to)*2); ++ psta->under_exist_checking = 0; ++ psta->expire_to = 0; ++ } else if ( psta->expire_to <= (pstapriv->expire_to - 3) && (psta->under_exist_checking==0)) { ++ DBG_871X("asoc check by DELBA/ADDBA! (%d s)\n", (pstapriv->expire_to-psta->expire_to)*2); ++ psta->under_exist_checking = 1; ++ //tear down TX AMPDU ++ send_delba(padapter, 1, psta->hwaddr);// // originator ++ psta->htpriv.agg_enable_bitmap = 0x0;//reset ++ psta->htpriv.candidate_tid_bitmap = 0x0;//reset ++ } ++ } ++#endif //CONFIG_80211N_HT ++#endif // CONFIG_TX_MCAST2UNI ++#endif //CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++ ++ if (psta->expire_to <= 0) ++ { ++ #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ if (padapter->registrypriv.wifi_spec == 1) ++ { ++ psta->expire_to = pstapriv->expire_to; ++ continue; ++ } ++ ++ if (psta->state & WIFI_SLEEP_STATE) { ++ if (!(psta->state & WIFI_STA_ALIVE_CHK_STATE)) { ++ //to check if alive by another methods if staion is at ps mode. ++ psta->expire_to = pstapriv->expire_to; ++ psta->state |= WIFI_STA_ALIVE_CHK_STATE; ++ ++ //DBG_871X("alive chk, sta:" MAC_FMT " is at ps mode!\n", MAC_ARG(psta->hwaddr)); ++ ++ //to update bcn with tim_bitmap for this station ++ pstapriv->tim_bitmap |= BIT(psta->aid); ++ update_beacon(padapter, _TIM_IE_, NULL, false); ++ ++ if(!pmlmeext->active_keep_alive_check) ++ continue; ++ } ++ } ++ ++ if (pmlmeext->active_keep_alive_check) { ++ int stainfo_offset; ++ ++ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); ++ if (stainfo_offset_valid(stainfo_offset)) { ++ chk_alive_list[chk_alive_num++] = stainfo_offset; ++ } ++ ++ continue; ++ } ++ #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ ++ ++ rtw_list_delete(&psta->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ ++ DBG_871X("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state); ++ updated = ap_free_sta(padapter, psta, false, WLAN_REASON_DEAUTH_LEAVING); ++ } ++ else ++ { ++ /* TODO: Aging mechanism to digest frames in sleep_q to avoid running out of xmitframe */ ++ if (psta->sleepq_len > (NR_XMITFRAME/pstapriv->asoc_list_cnt) ++ && padapter->xmitpriv.free_xmitframe_cnt < ((NR_XMITFRAME/pstapriv->asoc_list_cnt)/2) ++ ){ ++ DBG_871X("%s sta:"MAC_FMT", sleepq_len:%u, free_xmitframe_cnt:%u, asoc_list_cnt:%u, clear sleep_q\n", __func__ ++ , MAC_ARG(psta->hwaddr) ++ , psta->sleepq_len, padapter->xmitpriv.free_xmitframe_cnt, pstapriv->asoc_list_cnt); ++ wakeup_sta_to_xmit(padapter, psta); ++ } ++ } ++ } ++ ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++if (chk_alive_num) { ++ ++ u8 backup_oper_channel=0; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ /* switch to correct channel of current network before issue keep-alive frames */ ++ if (rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) { ++ backup_oper_channel = rtw_get_oper_ch(padapter); ++ SelectChannel(padapter, pmlmeext->cur_channel); ++ } ++ ++ /* issue null data to check sta alive*/ ++ for (i = 0; i < chk_alive_num; i++) { ++ ++ int ret = _FAIL; ++ ++ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); ++ if(!(psta->state &_FW_LINKED)) ++ continue; ++ ++ if (psta->state & WIFI_SLEEP_STATE) ++ ret = issue_nulldata(padapter, psta->hwaddr, 0, 1, 50); ++ else ++ ret = issue_nulldata(padapter, psta->hwaddr, 0, 3, 50); ++ ++ psta->keep_alive_trycnt++; ++ if (ret == _SUCCESS) ++ { ++ DBG_871X("asoc check, sta(" MAC_FMT ") is alive\n", MAC_ARG(psta->hwaddr)); ++ psta->expire_to = pstapriv->expire_to; ++ psta->keep_alive_trycnt = 0; ++ continue; ++ } ++ else if (psta->keep_alive_trycnt <= 3) ++ { ++ DBG_871X("ack check for asoc expire, keep_alive_trycnt=%d\n", psta->keep_alive_trycnt); ++ psta->expire_to = 1; ++ continue; ++ } ++ ++ psta->keep_alive_trycnt = 0; ++ ++ DBG_871X("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state); ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ if (rtw_is_list_empty(&psta->asoc_list)==false) { ++ rtw_list_delete(&psta->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ updated = ap_free_sta(padapter, psta, false, WLAN_REASON_DEAUTH_LEAVING); ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ } ++ ++ if (backup_oper_channel>0) /* back to the original operation channel */ ++ SelectChannel(padapter, backup_oper_channel); ++} ++#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ ++ ++ associated_clients_update(padapter, updated); ++} ++ ++void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level) ++{ ++ int i; ++ u8 rf_type; ++ u32 init_rate=0; ++ unsigned char sta_band = 0, raid, shortGIrate = false; ++ unsigned char limit; ++ unsigned int tx_ra_bitmap=0; ++ struct ht_priv *psta_ht = NULL; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; ++ ++#ifdef CONFIG_80211N_HT ++ if(psta) ++ psta_ht = &psta->htpriv; ++ else ++ return; ++#endif //CONFIG_80211N_HT ++ ++ if(!(psta->state & _FW_LINKED)) ++ return; ++ ++ //b/g mode ra_bitmap ++ for (i=0; ibssrateset); i++) ++ { ++ if (psta->bssrateset[i]) ++ tx_ra_bitmap |= rtw_get_bit_value_from_ieee_value(psta->bssrateset[i]&0x7f); ++ } ++#ifdef CONFIG_80211N_HT ++#ifdef CONFIG_80211AC_VHT ++ //AC mode ra_bitmap ++ if(psta->vhtpriv.vht_option) ++ { ++ u32 vht_bitmap = 0; ++ ++ vht_bitmap = rtw_vht_rate_to_bitmap(psta->vhtpriv.vht_mcs_map); ++ tx_ra_bitmap |= (vht_bitmap << 12); ++ ++ //max short GI rate ++ shortGIrate = psta->vhtpriv.sgi; ++ } ++ else ++#endif //CONFIG_80211AC_VHT ++ { ++ //n mode ra_bitmap ++ if(psta_ht->ht_option) ++ { ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ if(rf_type == RF_2T2R) ++ limit=16;// 2R ++ else ++ limit=8;// 1R ++ ++ for (i=0; iht_cap.supp_mcs_set[i/8] & BIT(i%8)) ++ tx_ra_bitmap |= BIT(i+12); ++ } ++ ++ //max short GI rate ++ shortGIrate = psta_ht->sgi; ++ } ++ } ++#endif //CONFIG_80211N_HT ++ ++#if 0//gtest ++ if(get_rf_mimo_mode(padapter) == RTL8712_RF_2T2R) ++ { ++ //is this a 2r STA? ++ if((pstat->tx_ra_bitmap & 0x0ff00000) != 0 && !(priv->pshare->has_2r_sta & BIT(pstat->aid))) ++ { ++ priv->pshare->has_2r_sta |= BIT(pstat->aid); ++ if(rtw_read16(padapter, 0x102501f6) != 0xffff) ++ { ++ rtw_write16(padapter, 0x102501f6, 0xffff); ++ reset_1r_sta_RA(priv, 0xffff); ++ Switch_1SS_Antenna(priv, 3); ++ } ++ } ++ else// bg or 1R STA? ++ { ++ if((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) && pstat->ht_cap_len && priv->pshare->has_2r_sta == 0) ++ { ++ if(rtw_read16(padapter, 0x102501f6) != 0x7777) ++ { // MCS7 SGI ++ rtw_write16(padapter, 0x102501f6,0x7777); ++ reset_1r_sta_RA(priv, 0x7777); ++ Switch_1SS_Antenna(priv, 2); ++ } ++ } ++ } ++ ++ } ++ ++ if ((pstat->rssi_level < 1) || (pstat->rssi_level > 3)) ++ { ++ if (pstat->rssi >= priv->pshare->rf_ft_var.raGoDownUpper) ++ pstat->rssi_level = 1; ++ else if ((pstat->rssi >= priv->pshare->rf_ft_var.raGoDown20MLower) || ++ ((priv->pshare->is_40m_bw) && (pstat->ht_cap_len) && ++ (pstat->rssi >= priv->pshare->rf_ft_var.raGoDown40MLower) && ++ (pstat->ht_cap_buf.ht_cap_info & cpu_to_le16(_HTCAP_SUPPORT_CH_WDTH_)))) ++ pstat->rssi_level = 2; ++ else ++ pstat->rssi_level = 3; ++ } ++ ++ // rate adaptive by rssi ++ if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) && pstat->ht_cap_len) ++ { ++ if ((get_rf_mimo_mode(priv) == MIMO_1T2R) || (get_rf_mimo_mode(priv) == MIMO_1T1R)) ++ { ++ switch (pstat->rssi_level) { ++ case 1: ++ pstat->tx_ra_bitmap &= 0x100f0000; ++ break; ++ case 2: ++ pstat->tx_ra_bitmap &= 0x100ff000; ++ break; ++ case 3: ++ if (priv->pshare->is_40m_bw) ++ pstat->tx_ra_bitmap &= 0x100ff005; ++ else ++ pstat->tx_ra_bitmap &= 0x100ff001; ++ ++ break; ++ } ++ } ++ else ++ { ++ switch (pstat->rssi_level) { ++ case 1: ++ pstat->tx_ra_bitmap &= 0x1f0f0000; ++ break; ++ case 2: ++ pstat->tx_ra_bitmap &= 0x1f0ff000; ++ break; ++ case 3: ++ if (priv->pshare->is_40m_bw) ++ pstat->tx_ra_bitmap &= 0x000ff005; ++ else ++ pstat->tx_ra_bitmap &= 0x000ff001; ++ ++ break; ++ } ++ ++ // Don't need to mask high rates due to new rate adaptive parameters ++ //if (pstat->is_broadcom_sta) // use MCS12 as the highest rate vs. Broadcom sta ++ // pstat->tx_ra_bitmap &= 0x81ffffff; ++ ++ // NIC driver will report not supporting MCS15 and MCS14 in asoc req ++ //if (pstat->is_rtl8190_sta && !pstat->is_2t_mimo_sta) ++ // pstat->tx_ra_bitmap &= 0x83ffffff; // if Realtek 1x2 sta, don't use MCS15 and MCS14 ++ } ++ } ++ else if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) && isErpSta(pstat)) ++ { ++ switch (pstat->rssi_level) { ++ case 1: ++ pstat->tx_ra_bitmap &= 0x00000f00; ++ break; ++ case 2: ++ pstat->tx_ra_bitmap &= 0x00000ff0; ++ break; ++ case 3: ++ pstat->tx_ra_bitmap &= 0x00000ff5; ++ break; ++ } ++ } ++ else ++ { ++ pstat->tx_ra_bitmap &= 0x0000000d; ++ } ++ ++ // disable tx short GI when station cannot rx MCS15(AP is 2T2R) ++ // disable tx short GI when station cannot rx MCS7 (AP is 1T2R or 1T1R) ++ // if there is only 1r STA and we are 2T2R, DO NOT mask SGI rate ++ if ((!(pstat->tx_ra_bitmap & 0x8000000) && (priv->pshare->has_2r_sta > 0) && (get_rf_mimo_mode(padapter) == RTL8712_RF_2T2R)) || ++ (!(pstat->tx_ra_bitmap & 0x80000) && (get_rf_mimo_mode(padapter) != RTL8712_RF_2T2R))) ++ { ++ pstat->tx_ra_bitmap &= ~BIT(28); ++ } ++#endif ++ ++ if ( pcur_network->Configuration.DSConfig > 14 ) { ++ // 5G band ++#ifdef CONFIG_80211AC_VHT ++ if (psta->vhtpriv.vht_option) { ++ sta_band = WIRELESS_11_5AC; ++ } ++ else ++#endif ++ { ++ if (tx_ra_bitmap & 0xffff000) ++ sta_band |= WIRELESS_11_5N | WIRELESS_11A; ++ else ++ sta_band |= WIRELESS_11A; ++ } ++ } else { ++ if (tx_ra_bitmap & 0xffff000) ++ sta_band |= WIRELESS_11_24N | WIRELESS_11G | WIRELESS_11B; ++ else if (tx_ra_bitmap & 0xff0) ++ sta_band |= WIRELESS_11G |WIRELESS_11B; ++ else ++ sta_band |= WIRELESS_11B; ++ } ++ ++ psta->wireless_mode = sta_band; ++ ++ //raid = networktype_to_raid(sta_band); ++ raid = rtw_hal_networktype_to_raid(padapter,sta_band); ++ ++ init_rate = get_highest_rate_idx(tx_ra_bitmap)&0x3f; ++ ++ if (psta->aid < NUM_STA) ++ { ++ u8 arg[4] = {0}; ++ ++ //arg[0] = macid ++ //arg[1] = raid ++ //arg[2] = shortGIrate ++ //arg[3] = init_rate ++ ++ arg[0] = psta->mac_id; ++ arg[1] = raid; ++ arg[2] = shortGIrate; ++ arg[3] = init_rate; ++ ++ DBG_871X("%s=> mac_id:%d , raid:%d , shortGIrate=%d, bitmap=0x%x\n", ++ __FUNCTION__ , psta->mac_id, raid ,shortGIrate, tx_ra_bitmap); ++ ++ rtw_hal_add_ra_tid(padapter, tx_ra_bitmap, arg, rssi_level); ++ ++ if (shortGIrate==true) ++ init_rate |= BIT(6); ++ ++ //set ra_id, init_rate ++ psta->raid = raid; ++ psta->init_rate = init_rate; ++ } ++ else ++ { ++ DBG_871X("station aid %d exceed the max number\n", psta->aid); ++ } ++ ++} ++ ++static void update_bmc_sta(_adapter *padapter) ++{ ++ _irqL irqL; ++ u32 init_rate=0; ++ unsigned char network_type, raid; ++ int i, supportRateNum = 0; ++ unsigned int tx_ra_bitmap=0; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; ++ struct sta_info *psta = rtw_get_bcmc_stainfo(padapter); ++ ++ if(psta) ++ { ++ psta->aid = 0;//default set to 0 ++ //psta->mac_id = psta->aid+4; ++ psta->mac_id = psta->aid + 1;//mac_id=1 for bc/mc stainfo ++ ++ pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta; ++ ++ psta->qos_option = 0; ++#ifdef CONFIG_80211N_HT ++ psta->htpriv.ht_option = false; ++#endif //CONFIG_80211N_HT ++ ++ psta->ieee8021x_blocked = 0; ++ ++ _rtw_memset((void*)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); ++ ++ //psta->dot118021XPrivacy = _NO_PRIVACY_;//!!! remove it, because it has been set before this. ++ ++ ++ ++ //prepare for add_RATid ++ supportRateNum = rtw_get_rateset_len((u8*)&pcur_network->SupportedRates); ++ network_type = rtw_check_network_type((u8*)&pcur_network->SupportedRates, supportRateNum, 1); ++ ++ _rtw_memcpy(psta->bssrateset, &pcur_network->SupportedRates, supportRateNum); ++ psta->bssratelen = supportRateNum; ++ ++ //b/g mode ra_bitmap ++ for (i=0; ibssrateset[i]) ++ tx_ra_bitmap |= rtw_get_bit_value_from_ieee_value(psta->bssrateset[i]&0x7f); ++ } ++ ++ if ( pcur_network->Configuration.DSConfig > 14 ) { ++ //force to A mode. 5G doesn't support CCK rates ++ network_type = WIRELESS_11A; ++ tx_ra_bitmap = 0x150; // 6, 12, 24 Mbps ++ } else { ++ //force to b mode ++ network_type = WIRELESS_11B; ++ tx_ra_bitmap = 0xf; ++ } ++ ++ //tx_ra_bitmap = update_basic_rate(pcur_network->SupportedRates, supportRateNum); ++ ++ //raid = networktype_to_raid(network_type); ++ raid = rtw_hal_networktype_to_raid(padapter,network_type); ++ ++ init_rate = get_highest_rate_idx(tx_ra_bitmap&0x0fffffff)&0x3f; ++ ++ //DBG_871X("Add id %d val %08x to ratr for bmc sta\n", psta->aid, tx_ra_bitmap); ++ //ap mode ++ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, true); ++ ++ //if(pHalData->fw_ractrl == true) ++ { ++ u8 arg[4] = {0}; ++ ++ //arg[0] = macid ++ //arg[1] = raid ++ //arg[2] = shortGIrate ++ //arg[3] = init_rate ++ ++ arg[0] = psta->mac_id; ++ arg[1] = raid; ++ arg[2] = 0; ++ arg[3] = init_rate; ++ ++ DBG_871X("%s=> mac_id:%d , raid:%d , bitmap=0x%x\n", ++ __FUNCTION__ , psta->mac_id, raid , tx_ra_bitmap); ++ ++ rtw_hal_add_ra_tid(padapter, tx_ra_bitmap, arg, 0); ++ } ++ ++ //set ra_id, init_rate ++ psta->raid = raid; ++ psta->init_rate = init_rate; ++ ++ rtw_stassoc_hw_rpt(padapter, psta); ++ ++ _enter_critical_bh(&psta->lock, &irqL); ++ psta->state = _FW_LINKED; ++ _exit_critical_bh(&psta->lock, &irqL); ++ ++ } ++ else ++ { ++ DBG_871X("add_RATid_bmc_sta error!\n"); ++ } ++ ++} ++ ++//notes: ++//AID: 1~MAX for sta and 0 for bc/mc in ap/adhoc mode ++//MAC_ID = AID+1 for sta in ap/adhoc mode ++//MAC_ID = 1 for bc/mc for sta/ap/adhoc ++//MAC_ID = 0 for bssid for sta/ap/adhoc ++//CAM_ID = //0~3 for default key, cmd_id=macid + 3, macid=aid+1; ++ ++void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++#ifdef CONFIG_80211N_HT ++ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; ++ struct ht_priv *phtpriv_sta = &psta->htpriv; ++#endif //CONFIG_80211N_HT ++ //set intf_tag to if1 ++ //psta->intf_tag = 0; ++ ++ DBG_871X("%s\n",__FUNCTION__); ++ ++ //psta->mac_id = psta->aid+4; ++ //psta->mac_id = psta->aid+1;//alloc macid when call rtw_alloc_stainfo(), ++ //release macid when call rtw_free_stainfo() ++ ++ //ap mode ++ rtw_hal_set_odm_var(padapter,HAL_ODM_STA_INFO,psta,true); ++ ++ if(psecuritypriv->dot11AuthAlgrthm==dot11AuthAlgrthm_8021X) ++ psta->ieee8021x_blocked = true; ++ else ++ psta->ieee8021x_blocked = false; ++ ++ ++ //update sta's cap ++ ++ //ERP ++ VCS_update(padapter, psta); ++#ifdef CONFIG_80211N_HT ++ //HT related cap ++ if(phtpriv_sta->ht_option) ++ { ++ //check if sta supports rx ampdu ++ phtpriv_sta->ampdu_enable = phtpriv_ap->ampdu_enable; ++ ++ //check if sta support s Short GI ++ if((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_20|IEEE80211_HT_CAP_SGI_40)) ++ { ++ phtpriv_sta->sgi = true; ++ } ++ ++ // bwmode ++ if((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) ++ { ++ //phtpriv_sta->bwmode = CHANNEL_WIDTH_40; ++ phtpriv_sta->bwmode = pmlmeext->cur_bwmode; ++ phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; ++ ++ } ++ ++ psta->qos_option = true; ++ ++ } ++ else ++ { ++ phtpriv_sta->ampdu_enable = false; ++ ++ phtpriv_sta->sgi = false; ++ phtpriv_sta->bwmode = CHANNEL_WIDTH_20; ++ phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ } ++ ++ //Rx AMPDU ++ send_delba(padapter, 0, psta->hwaddr);// recipient ++ ++ //TX AMPDU ++ send_delba(padapter, 1, psta->hwaddr);// // originator ++ phtpriv_sta->agg_enable_bitmap = 0x0;//reset ++ phtpriv_sta->candidate_tid_bitmap = 0x0;//reset ++#endif //CONFIG_80211N_HT ++ ++#ifdef CONFIG_80211AC_VHT ++ update_sta_vht_info_apmode(padapter, psta); ++#endif ++ ++ //todo: init other variables ++ ++ _rtw_memset((void*)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); ++ ++ ++ //add ratid ++ //add_RATid(padapter, psta);//move to ap_sta_info_defer_update() ++ ++ ++ _enter_critical_bh(&psta->lock, &irqL); ++ psta->state |= _FW_LINKED; ++ _exit_critical_bh(&psta->lock, &irqL); ++ ++ ++} ++ ++static void update_hw_ht_param(_adapter *padapter) ++{ ++ unsigned char max_AMPDU_len; ++ unsigned char min_MPDU_spacing; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ DBG_871X("%s\n", __FUNCTION__); ++ ++ ++ //handle A-MPDU parameter field ++ /* ++ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k ++ AMPDU_para [4:2]:Min MPDU Start Spacing ++ */ ++ max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; ++ ++ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2; ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MIN_SPACE, (u8 *)(&min_MPDU_spacing)); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len)); ++ ++ // ++ // Config SM Power Save setting ++ // ++ pmlmeinfo->SM_PS = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & 0x0C) >> 2; ++ if(pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC) ++ { ++ /*u8 i; ++ //update the MCS rates ++ for (i = 0; i < 16; i++) ++ { ++ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; ++ }*/ ++ DBG_871X("%s(): WLAN_HT_CAP_SM_PS_STATIC\n",__FUNCTION__); ++ } ++ ++ // ++ // Config current HT Protection mode. ++ // ++ //pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; ++ ++} ++ ++static void start_bss_network(_adapter *padapter, u8 *pbuf) ++{ ++ u8 *p; ++ u8 val8, cur_channel, cur_bwmode, cur_ch_offset; ++ u16 bcn_interval; ++ u32 acparm; ++ int ie_len; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct security_priv* psecuritypriv=&(padapter->securitypriv); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork_mlmeext = &(pmlmeinfo->network); ++ struct HT_info_element *pht_info=NULL; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++#endif //CONFIG_P2P ++ u8 cbw40_enable=0; ++ u8 change_band = false; ++ ++ //DBG_871X("%s\n", __FUNCTION__); ++ ++ bcn_interval = (u16)pnetwork->Configuration.BeaconPeriod; ++ cur_channel = pnetwork->Configuration.DSConfig; ++ cur_bwmode = CHANNEL_WIDTH_20; ++ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ ++ //check if there is wps ie, ++ //if there is wpsie in beacon, the hostapd will update beacon twice when stating hostapd, ++ //and at first time the security ie ( RSN/WPA IE) will not include in beacon. ++ if(NULL == rtw_get_wps_ie(pnetwork->IEs+_FIXED_IE_LENGTH_, pnetwork->IELength-_FIXED_IE_LENGTH_, NULL, NULL)) ++ { ++ pmlmeext->bstart_bss = true; ++ } ++ ++ //todo: update wmm, ht cap ++ //pmlmeinfo->WMM_enable; ++ //pmlmeinfo->HT_enable; ++ if(pmlmepriv->qospriv.qos_option) ++ pmlmeinfo->WMM_enable = true; ++#ifdef CONFIG_80211N_HT ++ if(pmlmepriv->htpriv.ht_option) ++ { ++ pmlmeinfo->WMM_enable = true; ++ pmlmeinfo->HT_enable = true; ++ //pmlmeinfo->HT_info_enable = true; ++ //pmlmeinfo->HT_caps_enable = true; ++ ++ update_hw_ht_param(padapter); ++ } ++#endif //#CONFIG_80211N_HT ++ ++#ifdef CONFIG_80211AC_VHT ++ if(pmlmepriv->vhtpriv.vht_option) { ++ pmlmeinfo->VHT_enable = true; ++ update_hw_vht_param(padapter); ++ } ++#endif //CONFIG_80211AC_VHT ++ ++ if(pmlmepriv->cur_network.join_res != true) //setting only at first time ++ { ++ //WEP Key will be set before this function, do not clear CAM. ++ if ((psecuritypriv->dot11PrivacyAlgrthm != _WEP40_) && (psecuritypriv->dot11PrivacyAlgrthm != _WEP104_)) ++ flush_all_cam_entry(padapter); //clear CAM ++ } ++ ++ //set MSR to AP_Mode ++ Set_MSR(padapter, _HW_STATE_AP_); ++ ++ //Set BSSID REG ++ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pnetwork->MacAddress); ++ ++ //Set EDCA param reg ++#ifdef CONFIG_CONCURRENT_MODE ++ acparm = 0x005ea42b; ++#else ++ acparm = 0x002F3217; // VO ++#endif ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm)); ++ acparm = 0x005E4317; // VI ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm)); ++ //acparm = 0x00105320; // BE ++ acparm = 0x005ea42b; ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); ++ acparm = 0x0000A444; // BK ++ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); ++ ++ //Set Security ++ val8 = (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X)? 0xcc: 0xcf; ++ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); ++ ++ //Beacon Control related register ++ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&bcn_interval)); ++ ++ if(pmlmepriv->cur_network.join_res != true) //setting only at first time ++ { ++ //u32 initialgain; ++ ++ //initialgain = 0x1e; ++ ++ ++ //disable dynamic functions, such as high power, DIG ++ //Save_DM_Func_Flag(padapter); ++ //Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if(padapter->adapter_type > PRIMARY_ADAPTER) ++ { ++ if(rtw_buddy_adapter_up(padapter)) ++ { ++ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; ++ ++ //turn on all dynamic functions on PRIMARY_ADAPTER, dynamic functions only runs at PRIMARY_ADAPTER ++ Switch_DM_Func(pbuddy_adapter, DYNAMIC_ALL_FUNC_ENABLE, true); ++ ++ //rtw_hal_set_hwreg(pbuddy_adapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); ++ } ++ } ++ else ++#endif ++ { ++ //turn on all dynamic functions ++ Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, true); ++ ++ //rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); ++ } ++ ++ } ++#ifdef CONFIG_80211N_HT ++ //set channel, bwmode ++ p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if( p && ie_len) ++ { ++ pht_info = (struct HT_info_element *)(p+2); ++ ++ if (cur_channel > 14) { ++ if ((pregpriv->bw_mode & 0xf0) > 0) ++ cbw40_enable = 1; ++ } else { ++ if ((pregpriv->bw_mode & 0x0f) > 0) ++ cbw40_enable = 1; ++ } ++ ++ if ((cbw40_enable) && (pht_info->infos[0] & BIT(2))) ++ { ++ //switch to the 40M Hz mode ++ //pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; ++ cur_bwmode = CHANNEL_WIDTH_40; ++ switch (pht_info->infos[0] & 0x3) ++ { ++ case 1: ++ //pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ break; ++ ++ case 3: ++ //pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ ++ default: ++ //pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ } ++ ++ } ++ ++ } ++#endif //CONFIG_80211N_HT ++ ++#ifdef CONFIG_80211AC_VHT ++ p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_VHTOperation, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if( p && ie_len) ++ { ++ if(GET_VHT_OPERATION_ELE_CHL_WIDTH(p+2) >= 1) { ++ cur_bwmode = CHANNEL_WIDTH_80; ++ } ++ } ++#endif ++ ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ dc_set_ap_channel_bandwidth(padapter, cur_channel, cur_ch_offset, cur_bwmode); ++#else ++ //TODO: need to judge the phy parameters on concurrent mode for single phy ++ //set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++#ifdef CONFIG_CONCURRENT_MODE ++ if(!check_buddy_fwstate(padapter, _FW_LINKED|_FW_UNDER_LINKING|_FW_UNDER_SURVEY)) ++ { ++ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); ++ } ++ else if(check_buddy_fwstate(padapter, _FW_LINKED)==true)//only second adapter can enter AP Mode ++ { ++ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; ++ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; ++ ++ //To sync cur_channel/cur_bwmode/cur_ch_offset with primary adapter ++ DBG_871X("primary iface is at linked state, sync cur_channel/cur_bwmode/cur_ch_offset\n"); ++ DBG_871X("primary adapter, CH=%d, BW=%d, offset=%d\n", pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_bwmode, pbuddy_mlmeext->cur_ch_offset); ++ DBG_871X("second adapter, CH=%d, BW=%d, offset=%d\n", cur_channel, cur_bwmode, cur_ch_offset); ++ ++ if((cur_channel <= 14 && pbuddy_mlmeext->cur_channel >= 36) || ++ (cur_channel >= 36 && pbuddy_mlmeext->cur_channel <= 14)) ++ change_band = true; ++ ++ cur_channel = pbuddy_mlmeext->cur_channel; ++ if(cur_bwmode == CHANNEL_WIDTH_40) ++ { ++ if(pht_info) ++ pht_info->infos[0] &= ~(BIT(0)|BIT(1)); ++ ++ if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) ++ { ++ cur_ch_offset = pbuddy_mlmeext->cur_ch_offset; ++ ++ //to update cur_ch_offset value in beacon ++ if(pht_info) ++ { ++ switch(cur_ch_offset) ++ { ++ case HAL_PRIME_CHNL_OFFSET_LOWER: ++ pht_info->infos[0] |= 0x1; ++ break; ++ case HAL_PRIME_CHNL_OFFSET_UPPER: ++ pht_info->infos[0] |= 0x3; ++ break; ++ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: ++ default: ++ break; ++ } ++ } ++ ++ } ++ else if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_20) ++ { ++ cur_bwmode = CHANNEL_WIDTH_20; ++ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ if(cur_channel>0 && cur_channel<5) ++ { ++ if(pht_info) ++ pht_info->infos[0] |= 0x1; ++ ++ cur_bwmode = CHANNEL_WIDTH_40; ++ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ } ++ ++ if(cur_channel>7 && cur_channel<(14+1)) ++ { ++ if(pht_info) ++ pht_info->infos[0] |= 0x3; ++ ++ cur_bwmode = CHANNEL_WIDTH_40; ++ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ } ++ } ++ ++ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); ++ ++ } ++ else ++ { ++ //follow buddy's ch/bw/ch_offset setting, needn't set ch_bw again. ++ //set_channel_bwmode(padapter, cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); ++ } ++ ++ // to update channel value in beacon ++ pnetwork->Configuration.DSConfig = cur_channel; ++ p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if(p && ie_len>0) ++ *(p + 2) = cur_channel; ++ ++ if(pht_info) ++ pht_info->primary_channel = cur_channel; ++ } ++#else ++ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); ++#endif //CONFIG_CONCURRENT_MODE ++ ++ DBG_871X("CH=%d, BW=%d, offset=%d\n", cur_channel, cur_bwmode, cur_ch_offset); ++ ++ pmlmeext->cur_channel = cur_channel; ++ pmlmeext->cur_bwmode = cur_bwmode; ++ pmlmeext->cur_ch_offset = cur_ch_offset; ++ ++ //buddy interface band is different from current interface, update ERP, support rate, ext support rate IE ++ if(change_band == true) ++ change_band_update_ie(padapter, pnetwork); ++#endif //CONFIG_DUALMAC_CONCURRENT ++ ++ pmlmeext->cur_wireless_mode = pmlmepriv->cur_network.network_type; ++ ++ //update cur_wireless_mode ++ update_wireless_mode(padapter); ++ ++ //update RRSR after set channel and bandwidth ++ UpdateBrateTbl(padapter, pnetwork->SupportedRates); ++ rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, pnetwork->SupportedRates); ++ ++ //udpate capability after cur_wireless_mode updated ++ update_capinfo(padapter, rtw_get_capability((WLAN_BSSID_EX *)pnetwork)); ++ ++ //let pnetwork_mlmeext == pnetwork_mlme. ++ _rtw_memcpy(pnetwork_mlmeext, pnetwork, pnetwork->Length); ++ ++#ifdef CONFIG_P2P ++ _rtw_memcpy(pwdinfo->p2p_group_ssid, pnetwork->Ssid.Ssid, pnetwork->Ssid.SsidLength); ++ pwdinfo->p2p_group_ssid_len = pnetwork->Ssid.SsidLength; ++#endif //CONFIG_P2P ++ ++ if(true == pmlmeext->bstart_bss) ++ { ++ update_beacon(padapter, _TIM_IE_, NULL, false); ++ ++#ifndef CONFIG_INTERRUPT_BASED_TXBCN //other case will tx beacon when bcn interrupt coming in. ++ //issue beacon frame ++ if(send_beacon(padapter)==_FAIL) ++ { ++ DBG_871X("issue_beacon, fail!\n"); ++ } ++#endif //!CONFIG_INTERRUPT_BASED_TXBCN ++ ++ } ++ ++ ++ //update bc/mc sta_info ++ update_bmc_sta(padapter); ++ ++ //pmlmeext->bstart_bss = true; ++ ++} ++ ++int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) ++{ ++ int ret=_SUCCESS; ++ u8 *p; ++ u8 *pHT_caps_ie=NULL; ++ u8 *pHT_info_ie=NULL; ++ struct sta_info *psta = NULL; ++ u16 cap, ht_cap=false; ++ uint ie_len = 0; ++ int group_cipher, pairwise_cipher; ++ u8 channel, network_type, supportRate[NDIS_802_11_LENGTH_RATES_EX]; ++ int supportRateNum = 0; ++ u8 OUI1[] = {0x00, 0x50, 0xf2,0x01}; ++ u8 wps_oui[4]={0x0,0x50,0xf2,0x04}; ++ u8 WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ WLAN_BSSID_EX *pbss_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ u8 *ie = pbss_network->IEs; ++ ++ ++ /* SSID */ ++ /* Supported rates */ ++ /* DS Params */ ++ /* WLAN_EID_COUNTRY */ ++ /* ERP Information element */ ++ /* Extended supported rates */ ++ /* WPA/WPA2 */ ++ /* Wi-Fi Wireless Multimedia Extensions */ ++ /* ht_capab, ht_oper */ ++ /* WPS IE */ ++ ++ DBG_871X("%s, len=%d\n", __FUNCTION__, len); ++ ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) ++ return _FAIL; ++ ++ ++ if(len>MAX_IE_SZ) ++ return _FAIL; ++ ++ pbss_network->IELength = len; ++ ++ _rtw_memset(ie, 0, MAX_IE_SZ); ++ ++ _rtw_memcpy(ie, pbuf, pbss_network->IELength); ++ ++ ++ if(pbss_network->InfrastructureMode!=Ndis802_11APMode) ++ return _FAIL; ++ ++ pbss_network->Rssi = 0; ++ ++ _rtw_memcpy(pbss_network->MacAddress, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ ++ //beacon interval ++ p = rtw_get_beacon_interval_from_ie(ie);//ie + 8; // 8: TimeStamp, 2: Beacon Interval 2:Capability ++ //pbss_network->Configuration.BeaconPeriod = le16_to_cpu(*(unsigned short*)p); ++ pbss_network->Configuration.BeaconPeriod = RTW_GET_LE16(p); ++ ++ //capability ++ //cap = *(unsigned short *)rtw_get_capability_from_ie(ie); ++ //cap = le16_to_cpu(cap); ++ cap = RTW_GET_LE16(ie); ++ ++ //SSID ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _SSID_IE_, &ie_len, (pbss_network->IELength -_BEACON_IE_OFFSET_)); ++ if(p && ie_len>0) ++ { ++ _rtw_memset(&pbss_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); ++ _rtw_memcpy(pbss_network->Ssid.Ssid, (p + 2), ie_len); ++ pbss_network->Ssid.SsidLength = ie_len; ++ } ++ ++ //chnnel ++ channel = 0; ++ pbss_network->Configuration.Length = 0; ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _DSSET_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if(p && ie_len>0) ++ channel = *(p + 2); ++ ++ pbss_network->Configuration.DSConfig = channel; ++ ++ ++ _rtw_memset(supportRate, 0, NDIS_802_11_LENGTH_RATES_EX); ++ // get supported rates ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if (p != NULL) ++ { ++ _rtw_memcpy(supportRate, p+2, ie_len); ++ supportRateNum = ie_len; ++ } ++ ++ //get ext_supported rates ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ie_len, pbss_network->IELength - _BEACON_IE_OFFSET_); ++ if (p != NULL) ++ { ++ _rtw_memcpy(supportRate+supportRateNum, p+2, ie_len); ++ supportRateNum += ie_len; ++ ++ } ++ ++ network_type = rtw_check_network_type(supportRate, supportRateNum, channel); ++ ++ rtw_set_supported_rate(pbss_network->SupportedRates, network_type); ++ ++ ++ //parsing ERP_IE ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _ERPINFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if(p && ie_len>0) ++ { ++ ERP_IE_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)p); ++ } ++ ++ //update privacy/security ++ if (cap & BIT(4)) ++ pbss_network->Privacy = 1; ++ else ++ pbss_network->Privacy = 0; ++ ++ psecuritypriv->wpa_psk = 0; ++ ++ //wpa2 ++ group_cipher = 0; pairwise_cipher = 0; ++ psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_; ++ psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_; ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if(p && ie_len>0) ++ { ++ if(rtw_parse_wpa2_ie(p, ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) ++ { ++ psecuritypriv->dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; ++ ++ psecuritypriv->dot8021xalg = 1;//psk, todo:802.1x ++ psecuritypriv->wpa_psk |= BIT(1); ++ ++ psecuritypriv->wpa2_group_cipher = group_cipher; ++ psecuritypriv->wpa2_pairwise_cipher = pairwise_cipher; ++#if 0 ++ switch(group_cipher) ++ { ++ case WPA_CIPHER_NONE: ++ psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_; ++ break; ++ case WPA_CIPHER_WEP40: ++ psecuritypriv->wpa2_group_cipher = _WEP40_; ++ break; ++ case WPA_CIPHER_TKIP: ++ psecuritypriv->wpa2_group_cipher = _TKIP_; ++ break; ++ case WPA_CIPHER_CCMP: ++ psecuritypriv->wpa2_group_cipher = _AES_; ++ break; ++ case WPA_CIPHER_WEP104: ++ psecuritypriv->wpa2_group_cipher = _WEP104_; ++ break; ++ } ++ ++ switch(pairwise_cipher) ++ { ++ case WPA_CIPHER_NONE: ++ psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_; ++ break; ++ case WPA_CIPHER_WEP40: ++ psecuritypriv->wpa2_pairwise_cipher = _WEP40_; ++ break; ++ case WPA_CIPHER_TKIP: ++ psecuritypriv->wpa2_pairwise_cipher = _TKIP_; ++ break; ++ case WPA_CIPHER_CCMP: ++ psecuritypriv->wpa2_pairwise_cipher = _AES_; ++ break; ++ case WPA_CIPHER_WEP104: ++ psecuritypriv->wpa2_pairwise_cipher = _WEP104_; ++ break; ++ } ++#endif ++ } ++ ++ } ++ ++ //wpa ++ ie_len = 0; ++ group_cipher = 0; pairwise_cipher = 0; ++ psecuritypriv->wpa_group_cipher = _NO_PRIVACY_; ++ psecuritypriv->wpa_pairwise_cipher = _NO_PRIVACY_; ++ for (p = ie + _BEACON_IE_OFFSET_; ;p += (ie_len + 2)) ++ { ++ p = rtw_get_ie(p, _SSN_IE_1_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); ++ if ((p) && (_rtw_memcmp(p+2, OUI1, 4))) ++ { ++ if(rtw_parse_wpa_ie(p, ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) ++ { ++ psecuritypriv->dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; ++ ++ psecuritypriv->dot8021xalg = 1;//psk, todo:802.1x ++ ++ psecuritypriv->wpa_psk |= BIT(0); ++ ++ psecuritypriv->wpa_group_cipher = group_cipher; ++ psecuritypriv->wpa_pairwise_cipher = pairwise_cipher; ++ ++#if 0 ++ switch(group_cipher) ++ { ++ case WPA_CIPHER_NONE: ++ psecuritypriv->wpa_group_cipher = _NO_PRIVACY_; ++ break; ++ case WPA_CIPHER_WEP40: ++ psecuritypriv->wpa_group_cipher = _WEP40_; ++ break; ++ case WPA_CIPHER_TKIP: ++ psecuritypriv->wpa_group_cipher = _TKIP_; ++ break; ++ case WPA_CIPHER_CCMP: ++ psecuritypriv->wpa_group_cipher = _AES_; ++ break; ++ case WPA_CIPHER_WEP104: ++ psecuritypriv->wpa_group_cipher = _WEP104_; ++ break; ++ } ++ ++ switch(pairwise_cipher) ++ { ++ case WPA_CIPHER_NONE: ++ psecuritypriv->wpa_pairwise_cipher = _NO_PRIVACY_; ++ break; ++ case WPA_CIPHER_WEP40: ++ psecuritypriv->wpa_pairwise_cipher = _WEP40_; ++ break; ++ case WPA_CIPHER_TKIP: ++ psecuritypriv->wpa_pairwise_cipher = _TKIP_; ++ break; ++ case WPA_CIPHER_CCMP: ++ psecuritypriv->wpa_pairwise_cipher = _AES_; ++ break; ++ case WPA_CIPHER_WEP104: ++ psecuritypriv->wpa_pairwise_cipher = _WEP104_; ++ break; ++ } ++#endif ++ } ++ ++ break; ++ ++ } ++ ++ if ((p == NULL) || (ie_len == 0)) ++ { ++ break; ++ } ++ ++ } ++ ++ //wmm ++ ie_len = 0; ++ pmlmepriv->qospriv.qos_option = 0; ++ if(pregistrypriv->wmm_enable) ++ { ++ for (p = ie + _BEACON_IE_OFFSET_; ;p += (ie_len + 2)) ++ { ++ p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); ++ if((p) && _rtw_memcmp(p+2, WMM_PARA_IE, 6)) ++ { ++ pmlmepriv->qospriv.qos_option = 1; ++ ++ *(p+8) |= BIT(7);//QoS Info, support U-APSD ++ ++ /* disable all ACM bits since the WMM admission control is not supported */ ++ *(p + 10) &= ~BIT(4); /* BE */ ++ *(p + 14) &= ~BIT(4); /* BK */ ++ *(p + 18) &= ~BIT(4); /* VI */ ++ *(p + 22) &= ~BIT(4); /* VO */ ++ ++ break; ++ } ++ ++ if ((p == NULL) || (ie_len == 0)) ++ { ++ break; ++ } ++ } ++ } ++#ifdef CONFIG_80211N_HT ++ //parsing HT_CAP_IE ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if(p && ie_len>0) ++ { ++ u8 rf_type; ++ ++ struct rtw_ieee80211_ht_cap *pht_cap = (struct rtw_ieee80211_ht_cap *)(p+2); ++ ++ pHT_caps_ie=p; ++ ++ ++ ht_cap = true; ++ network_type |= WIRELESS_11_24N; ++ ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ if((psecuritypriv->wpa_pairwise_cipher & WPA_CIPHER_CCMP) || ++ (psecuritypriv->wpa2_pairwise_cipher & WPA_CIPHER_CCMP)) ++ { ++ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&(0x07<<2)); ++ } ++ else ++ { ++ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&0x00); ++ } ++ ++ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_FACTOR & 0x03); //set Max Rx AMPDU size to 64K ++ ++ if(rf_type == RF_1T1R) ++ { ++ pht_cap->supp_mcs_set[0] = 0xff; ++ pht_cap->supp_mcs_set[1] = 0x0; ++ } ++ ++ _rtw_memcpy(&pmlmepriv->htpriv.ht_cap, p+2, ie_len); ++ ++ } ++ ++ //parsing HT_INFO_IE ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); ++ if(p && ie_len>0) ++ { ++ pHT_info_ie=p; ++ } ++#endif //CONFIG_80211N_HT ++ switch(network_type) ++ { ++ case WIRELESS_11B: ++ pbss_network->NetworkTypeInUse = Ndis802_11DS; ++ break; ++ case WIRELESS_11G: ++ case WIRELESS_11BG: ++ case WIRELESS_11G_24N: ++ case WIRELESS_11BG_24N: ++ pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; ++ break; ++ case WIRELESS_11A: ++ pbss_network->NetworkTypeInUse = Ndis802_11OFDM5; ++ break; ++ default : ++ pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; ++ break; ++ } ++ ++ pmlmepriv->cur_network.network_type = network_type; ++ ++#ifdef CONFIG_80211N_HT ++ pmlmepriv->htpriv.ht_option = false; ++ ++ if( (psecuritypriv->wpa2_pairwise_cipher&WPA_CIPHER_TKIP) || ++ (psecuritypriv->wpa_pairwise_cipher&WPA_CIPHER_TKIP)) ++ { ++ //todo: ++ //ht_cap = false; ++ } ++ ++ //ht_cap ++ if(pregistrypriv->ht_enable && ht_cap==true) ++ { ++ pmlmepriv->htpriv.ht_option = true; ++ pmlmepriv->qospriv.qos_option = 1; ++ ++ if(pregistrypriv->ampdu_enable==1) ++ { ++ pmlmepriv->htpriv.ampdu_enable = true; ++ } ++ ++ HT_caps_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)pHT_caps_ie); ++ ++ HT_info_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)pHT_info_ie); ++ } ++#endif ++ ++//#ifdef CONFIG_80211AC_VHT ++#if 0 ++ // if channel in 5G band, then add vht ie . ++ if ((pbss_network->Configuration.DSConfig > 14) && ++ (pmlmepriv->htpriv.ht_option == true) && ++ (pregistrypriv->vht_enable)) { ++ u8 cap_len, operation_len; ++ ++ rtw_vht_use_default_setting(padapter); ++ ++ // VHT Capabilities element ++ cap_len = rtw_build_vht_cap_ie(padapter, pbss_network->IEs + pbss_network->IELength); ++ pbss_network->IELength += cap_len; ++ ++ // VHT Operation element ++ operation_len = rtw_build_vht_operation_ie(padapter, pbss_network->IEs + pbss_network->IELength, pbss_network->Configuration.DSConfig); ++ pbss_network->IELength += operation_len; ++ ++ pmlmepriv->vhtpriv.vht_option = true; ++ } ++#endif //CONFIG_80211AC_VHT ++ ++ pbss_network->Length = get_WLAN_BSSID_EX_sz((WLAN_BSSID_EX *)pbss_network); ++ ++ //issue beacon to start bss network ++ start_bss_network(padapter, (u8*)pbss_network); ++ ++ ++ //alloc sta_info for ap itself ++ psta = rtw_get_stainfo(&padapter->stapriv, pbss_network->MacAddress); ++ if(!psta) ++ { ++ psta = rtw_alloc_stainfo(&padapter->stapriv, pbss_network->MacAddress); ++ if (psta == NULL) ++ { ++ return _FAIL; ++ } ++ } ++ psta->state |= WIFI_AP_STATE; //Aries, add,fix bug of flush_cam_entry at STOP AP mode , 0724 ++ rtw_indicate_connect( padapter); ++ ++ pmlmepriv->cur_network.join_res = true;//for check if already set beacon ++ ++ //update bc/mc sta_info ++ //update_bmc_sta(padapter); ++ ++ return ret; ++ ++} ++ ++void rtw_set_macaddr_acl(_adapter *padapter, int mode) ++{ ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; ++ ++ DBG_871X("%s, mode=%d\n", __func__, mode); ++ ++ pacl_list->mode = mode; ++} ++ ++int rtw_acl_add_sta(_adapter *padapter, u8 *addr) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ u8 added = false; ++ int i, ret=0; ++ struct rtw_wlan_acl_node *paclnode; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; ++ _queue *pacl_node_q =&pacl_list->acl_node_q; ++ ++ DBG_871X("%s(acl_num=%d)=" MAC_FMT "\n", __func__, pacl_list->num, MAC_ARG(addr)); ++ ++ if((NUM_ACL-1) < pacl_list->num) ++ return (-1); ++ ++ ++ _enter_critical_bh(&(pacl_node_q->lock), &irqL); ++ ++ phead = get_list_head(pacl_node_q); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == false) ++ { ++ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); ++ plist = get_next(plist); ++ ++ if(_rtw_memcmp(paclnode->addr, addr, ETH_ALEN)) ++ { ++ if(paclnode->valid == true) ++ { ++ added = true; ++ DBG_871X("%s, sta has been added\n", __func__); ++ break; ++ } ++ } ++ } ++ ++ _exit_critical_bh(&(pacl_node_q->lock), &irqL); ++ ++ ++ if(added == true) ++ return ret; ++ ++ ++ _enter_critical_bh(&(pacl_node_q->lock), &irqL); ++ ++ for(i=0; i< NUM_ACL; i++) ++ { ++ paclnode = &pacl_list->aclnode[i]; ++ ++ if(paclnode->valid == false) ++ { ++ _rtw_init_listhead(&paclnode->list); ++ ++ _rtw_memcpy(paclnode->addr, addr, ETH_ALEN); ++ ++ paclnode->valid = true; ++ ++ rtw_list_insert_tail(&paclnode->list, get_list_head(pacl_node_q)); ++ ++ pacl_list->num++; ++ ++ break; ++ } ++ } ++ ++ DBG_871X("%s, acl_num=%d\n", __func__, pacl_list->num); ++ ++ _exit_critical_bh(&(pacl_node_q->lock), &irqL); ++ ++ return ret; ++} ++ ++int rtw_acl_remove_sta(_adapter *padapter, u8 *addr) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ int i, ret=0; ++ struct rtw_wlan_acl_node *paclnode; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; ++ _queue *pacl_node_q =&pacl_list->acl_node_q; ++ ++ DBG_871X("%s(acl_num=%d)=" MAC_FMT "\n", __func__, pacl_list->num, MAC_ARG(addr)); ++ ++ _enter_critical_bh(&(pacl_node_q->lock), &irqL); ++ ++ phead = get_list_head(pacl_node_q); ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == false) ++ { ++ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); ++ plist = get_next(plist); ++ ++ if(_rtw_memcmp(paclnode->addr, addr, ETH_ALEN)) ++ { ++ if(paclnode->valid == true) ++ { ++ paclnode->valid = false; ++ ++ rtw_list_delete(&paclnode->list); ++ ++ pacl_list->num--; ++ } ++ } ++ } ++ ++ _exit_critical_bh(&(pacl_node_q->lock), &irqL); ++ ++ DBG_871X("%s, acl_num=%d\n", __func__, pacl_list->num); ++ ++ return ret; ++ ++} ++ ++u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta) ++{ ++ struct cmd_obj* ph2c; ++ struct set_stakey_parm *psetstakey_para; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ u8 res=_SUCCESS; ++ ++ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if ( ph2c == NULL){ ++ res= _FAIL; ++ goto exit; ++ } ++ ++ psetstakey_para = (struct set_stakey_parm*)rtw_zmalloc(sizeof(struct set_stakey_parm)); ++ if(psetstakey_para==NULL){ ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ res=_FAIL; ++ goto exit; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); ++ ++ ++ psetstakey_para->algorithm = (u8)psta->dot118021XPrivacy; ++ ++ _rtw_memcpy(psetstakey_para->addr, psta->hwaddr, ETH_ALEN); ++ ++ _rtw_memcpy(psetstakey_para->key, &psta->dot118021x_UncstKey, 16); ++ ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ return res; ++ ++} ++ ++static int rtw_ap_set_key(_adapter *padapter, u8 *key, u8 alg, int keyid, u8 set_tx) ++{ ++ u8 keylen; ++ struct cmd_obj* pcmd; ++ struct setkey_parm *psetkeyparm; ++ struct cmd_priv *pcmdpriv=&(padapter->cmdpriv); ++ int res=_SUCCESS; ++ ++ //DBG_871X("%s\n", __FUNCTION__); ++ ++ pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if(pcmd==NULL){ ++ res= _FAIL; ++ goto exit; ++ } ++ psetkeyparm=(struct setkey_parm*)rtw_zmalloc(sizeof(struct setkey_parm)); ++ if(psetkeyparm==NULL){ ++ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); ++ res= _FAIL; ++ goto exit; ++ } ++ ++ _rtw_memset(psetkeyparm, 0, sizeof(struct setkey_parm)); ++ ++ psetkeyparm->keyid=(u8)keyid; ++ if (is_wep_enc(alg)) ++ padapter->mlmepriv.key_mask |= BIT(psetkeyparm->keyid); ++ ++ psetkeyparm->algorithm = alg; ++ ++ psetkeyparm->set_tx = set_tx; ++ ++ switch(alg) ++ { ++ case _WEP40_: ++ keylen = 5; ++ break; ++ case _WEP104_: ++ keylen = 13; ++ break; ++ case _TKIP_: ++ case _TKIP_WTMIC_: ++ case _AES_: ++ keylen = 16; ++ default: ++ keylen = 16; ++ } ++ ++ _rtw_memcpy(&(psetkeyparm->key[0]), key, keylen); ++ ++ pcmd->cmdcode = _SetKey_CMD_; ++ pcmd->parmbuf = (u8 *)psetkeyparm; ++ pcmd->cmdsz = (sizeof(struct setkey_parm)); ++ pcmd->rsp = NULL; ++ pcmd->rspsz = 0; ++ ++ ++ _rtw_init_listhead(&pcmd->list); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, pcmd); ++ ++exit: ++ ++ return res; ++} ++ ++int rtw_ap_set_group_key(_adapter *padapter, u8 *key, u8 alg, int keyid) ++{ ++ DBG_871X("%s\n", __FUNCTION__); ++ ++ return rtw_ap_set_key(padapter, key, alg, keyid, 1); ++} ++ ++int rtw_ap_set_wep_key(_adapter *padapter, u8 *key, u8 keylen, int keyid, u8 set_tx) ++{ ++ u8 alg; ++ ++ switch(keylen) ++ { ++ case 5: ++ alg =_WEP40_; ++ break; ++ case 13: ++ alg =_WEP104_; ++ break; ++ default: ++ alg =_NO_PRIVACY_; ++ } ++ ++ DBG_871X("%s\n", __FUNCTION__); ++ ++ return rtw_ap_set_key(padapter, key, alg, keyid, set_tx); ++} ++ ++#ifdef CONFIG_NATIVEAP_MLME ++ ++static void update_bcn_fixed_ie(_adapter *padapter) ++{ ++ DBG_871X("%s\n", __FUNCTION__); ++ ++} ++ ++static void update_bcn_erpinfo_ie(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); ++ unsigned char *p, *ie = pnetwork->IEs; ++ u32 len = 0; ++ ++ DBG_871X("%s, ERP_enable=%d\n", __FUNCTION__, pmlmeinfo->ERP_enable); ++ ++ if(!pmlmeinfo->ERP_enable) ++ return; ++ ++ //parsing ERP_IE ++ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _ERPINFO_IE_, &len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); ++ if(p && len>0) ++ { ++ PNDIS_802_11_VARIABLE_IEs pIE = (PNDIS_802_11_VARIABLE_IEs)p; ++ ++ if (pmlmepriv->num_sta_non_erp == 1) ++ pIE->data[0] |= RTW_ERP_INFO_NON_ERP_PRESENT|RTW_ERP_INFO_USE_PROTECTION; ++ else ++ pIE->data[0] &= ~(RTW_ERP_INFO_NON_ERP_PRESENT|RTW_ERP_INFO_USE_PROTECTION); ++ ++ if(pmlmepriv->num_sta_no_short_preamble > 0) ++ pIE->data[0] |= RTW_ERP_INFO_BARKER_PREAMBLE_MODE; ++ else ++ pIE->data[0] &= ~(RTW_ERP_INFO_BARKER_PREAMBLE_MODE); ++ ++ ERP_IE_handler(padapter, pIE); ++ } ++ ++} ++ ++static void update_bcn_htcap_ie(_adapter *padapter) ++{ ++ DBG_871X("%s\n", __FUNCTION__); ++ ++} ++ ++static void update_bcn_htinfo_ie(_adapter *padapter) ++{ ++ DBG_871X("%s\n", __FUNCTION__); ++ ++} ++ ++static void update_bcn_rsn_ie(_adapter *padapter) ++{ ++ DBG_871X("%s\n", __FUNCTION__); ++ ++} ++ ++static void update_bcn_wpa_ie(_adapter *padapter) ++{ ++ DBG_871X("%s\n", __FUNCTION__); ++ ++} ++ ++static void update_bcn_wmm_ie(_adapter *padapter) ++{ ++ DBG_871X("%s\n", __FUNCTION__); ++ ++} ++ ++static void update_bcn_wps_ie(_adapter *padapter) ++{ ++ u8 *pwps_ie=NULL, *pwps_ie_src, *premainder_ie, *pbackup_remainder_ie=NULL; ++ uint wps_ielen=0, wps_offset, remainder_ielen; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); ++ unsigned char *ie = pnetwork->IEs; ++ u32 ielen = pnetwork->IELength; ++ ++ ++ DBG_871X("%s\n", __FUNCTION__); ++ ++ pwps_ie = rtw_get_wps_ie(ie+_FIXED_IE_LENGTH_, ielen-_FIXED_IE_LENGTH_, NULL, &wps_ielen); ++ ++ if(pwps_ie==NULL || wps_ielen==0) ++ return; ++ ++ wps_offset = (uint)(pwps_ie-ie); ++ ++ premainder_ie = pwps_ie + wps_ielen; ++ ++ remainder_ielen = ielen - wps_offset - wps_ielen; ++ ++ if(remainder_ielen>0) ++ { ++ pbackup_remainder_ie = rtw_malloc(remainder_ielen); ++ if(pbackup_remainder_ie) ++ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); ++ } ++ ++ ++ pwps_ie_src = pmlmepriv->wps_beacon_ie; ++ if(pwps_ie_src == NULL) ++ return; ++ ++ ++ wps_ielen = (uint)pwps_ie_src[1];//to get ie data len ++ if((wps_offset+wps_ielen+2+remainder_ielen)<=MAX_IE_SZ) ++ { ++ _rtw_memcpy(pwps_ie, pwps_ie_src, wps_ielen+2); ++ pwps_ie += (wps_ielen+2); ++ ++ if(pbackup_remainder_ie) ++ _rtw_memcpy(pwps_ie, pbackup_remainder_ie, remainder_ielen); ++ ++ //update IELength ++ pnetwork->IELength = wps_offset + (wps_ielen+2) + remainder_ielen; ++ } ++ ++ if(pbackup_remainder_ie) ++ rtw_mfree(pbackup_remainder_ie, remainder_ielen); ++ ++} ++ ++static void update_bcn_p2p_ie(_adapter *padapter) ++{ ++ ++} ++ ++static void update_bcn_vendor_spec_ie(_adapter *padapter, u8*oui) ++{ ++ DBG_871X("%s\n", __FUNCTION__); ++ ++ if(_rtw_memcmp(RTW_WPA_OUI, oui, 4)) ++ { ++ update_bcn_wpa_ie(padapter); ++ } ++ else if(_rtw_memcmp(WMM_OUI, oui, 4)) ++ { ++ update_bcn_wmm_ie(padapter); ++ } ++ else if(_rtw_memcmp(WPS_OUI, oui, 4)) ++ { ++ update_bcn_wps_ie(padapter); ++ } ++ else if(_rtw_memcmp(P2P_OUI, oui, 4)) ++ { ++ update_bcn_p2p_ie(padapter); ++ } ++ else ++ { ++ DBG_871X("unknown OUI type!\n"); ++ } ++ ++ ++} ++ ++void update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx) ++{ ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv; ++ struct mlme_ext_priv *pmlmeext; ++ //struct mlme_ext_info *pmlmeinfo; ++ ++ //DBG_871X("%s\n", __FUNCTION__); ++ ++ if(!padapter) ++ return; ++ ++ pmlmepriv = &(padapter->mlmepriv); ++ pmlmeext = &(padapter->mlmeextpriv); ++ //pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if(false == pmlmeext->bstart_bss) ++ return; ++ ++ _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); ++ ++ switch(ie_id) ++ { ++ case 0xFF: ++ ++ update_bcn_fixed_ie(padapter);//8: TimeStamp, 2: Beacon Interval 2:Capability ++ ++ break; ++ ++ case _TIM_IE_: ++ ++ update_BCNTIM(padapter); ++ ++ break; ++ ++ case _ERPINFO_IE_: ++ ++ update_bcn_erpinfo_ie(padapter); ++ ++ break; ++ ++ case _HT_CAPABILITY_IE_: ++ ++ update_bcn_htcap_ie(padapter); ++ ++ break; ++ ++ case _RSN_IE_2_: ++ ++ update_bcn_rsn_ie(padapter); ++ ++ break; ++ ++ case _HT_ADD_INFO_IE_: ++ ++ update_bcn_htinfo_ie(padapter); ++ ++ break; ++ ++ case _VENDOR_SPECIFIC_IE_: ++ ++ update_bcn_vendor_spec_ie(padapter, oui); ++ ++ break; ++ ++ default: ++ break; ++ } ++ ++ pmlmepriv->update_bcn = true; ++ ++ _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); ++ ++#ifndef CONFIG_INTERRUPT_BASED_TXBCN ++ if(tx) ++ set_tx_beacon_cmd(padapter); ++#endif //!CONFIG_INTERRUPT_BASED_TXBCN ++ ++} ++ ++#ifdef CONFIG_80211N_HT ++ ++/* ++op_mode ++Set to 0 (HT pure) under the followign conditions ++ - all STAs in the BSS are 20/40 MHz HT in 20/40 MHz BSS or ++ - all STAs in the BSS are 20 MHz HT in 20 MHz BSS ++Set to 1 (HT non-member protection) if there may be non-HT STAs ++ in both the primary and the secondary channel ++Set to 2 if only HT STAs are associated in BSS, ++ however and at least one 20 MHz HT STA is associated ++Set to 3 (HT mixed mode) when one or more non-HT STAs are associated ++ (currently non-GF HT station is considered as non-HT STA also) ++*/ ++static int rtw_ht_operation_update(_adapter *padapter) ++{ ++ u16 cur_op_mode, new_op_mode; ++ int op_mode_changes = 0; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; ++ ++ if(pmlmepriv->htpriv.ht_option == true) ++ return 0; ++ ++ //if (!iface->conf->ieee80211n || iface->conf->ht_op_mode_fixed) ++ // return 0; ++ ++ DBG_871X("%s current operation mode=0x%X\n", ++ __FUNCTION__, pmlmepriv->ht_op_mode); ++ ++ if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT) ++ && pmlmepriv->num_sta_ht_no_gf) { ++ pmlmepriv->ht_op_mode |= ++ HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT; ++ op_mode_changes++; ++ } else if ((pmlmepriv->ht_op_mode & ++ HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT) && ++ pmlmepriv->num_sta_ht_no_gf == 0) { ++ pmlmepriv->ht_op_mode &= ++ ~HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT; ++ op_mode_changes++; ++ } ++ ++ if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) && ++ (pmlmepriv->num_sta_no_ht || pmlmepriv->olbc_ht)) { ++ pmlmepriv->ht_op_mode |= HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT; ++ op_mode_changes++; ++ } else if ((pmlmepriv->ht_op_mode & ++ HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) && ++ (pmlmepriv->num_sta_no_ht == 0 && !pmlmepriv->olbc_ht)) { ++ pmlmepriv->ht_op_mode &= ++ ~HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT; ++ op_mode_changes++; ++ } ++ ++ /* Note: currently we switch to the MIXED op mode if HT non-greenfield ++ * station is associated. Probably it's a theoretical case, since ++ * it looks like all known HT STAs support greenfield. ++ */ ++ new_op_mode = 0; ++ if (pmlmepriv->num_sta_no_ht || ++ (pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT)) ++ new_op_mode = OP_MODE_MIXED; ++ else if ((phtpriv_ap->ht_cap.cap_info & IEEE80211_HT_CAP_SUP_WIDTH) ++ && pmlmepriv->num_sta_ht_20mhz) ++ new_op_mode = OP_MODE_20MHZ_HT_STA_ASSOCED; ++ else if (pmlmepriv->olbc_ht) ++ new_op_mode = OP_MODE_MAY_BE_LEGACY_STAS; ++ else ++ new_op_mode = OP_MODE_PURE; ++ ++ cur_op_mode = pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_OP_MODE_MASK; ++ if (cur_op_mode != new_op_mode) { ++ pmlmepriv->ht_op_mode &= ~HT_INFO_OPERATION_MODE_OP_MODE_MASK; ++ pmlmepriv->ht_op_mode |= new_op_mode; ++ op_mode_changes++; ++ } ++ ++ DBG_871X("%s new operation mode=0x%X changes=%d\n", ++ __FUNCTION__, pmlmepriv->ht_op_mode, op_mode_changes); ++ ++ return op_mode_changes; ++ ++} ++ ++#endif /* CONFIG_80211N_HT */ ++ ++void associated_clients_update(_adapter *padapter, u8 updated) ++{ ++ //update associcated stations cap. ++ if(updated == true) ++ { ++ _irqL irqL; ++ _list *phead, *plist; ++ struct sta_info *psta=NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ //check asoc_queue ++ while ((rtw_end_of_queue_search(phead, plist)) == false) ++ { ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ ++ plist = get_next(plist); ++ ++ VCS_update(padapter, psta); ++ } ++ ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ } ++ ++} ++ ++/* called > TSR LEVEL for USB or SDIO Interface*/ ++void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) ++{ ++ u8 beacon_updated = false; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ ++ ++#if 0 ++ if (!(psta->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) && ++ !psta->no_short_preamble_set) { ++ psta->no_short_preamble_set = 1; ++ pmlmepriv->num_sta_no_short_preamble++; ++ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && ++ (pmlmepriv->num_sta_no_short_preamble == 1)) ++ ieee802_11_set_beacons(hapd->iface); ++ } ++#endif ++ ++ ++ if(!(psta->flags & WLAN_STA_SHORT_PREAMBLE)) ++ { ++ if(!psta->no_short_preamble_set) ++ { ++ psta->no_short_preamble_set = 1; ++ ++ pmlmepriv->num_sta_no_short_preamble++; ++ ++ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && ++ (pmlmepriv->num_sta_no_short_preamble == 1)) ++ { ++ beacon_updated = true; ++ update_beacon(padapter, 0xFF, NULL, true); ++ } ++ ++ } ++ } ++ else ++ { ++ if(psta->no_short_preamble_set) ++ { ++ psta->no_short_preamble_set = 0; ++ ++ pmlmepriv->num_sta_no_short_preamble--; ++ ++ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && ++ (pmlmepriv->num_sta_no_short_preamble == 0)) ++ { ++ beacon_updated = true; ++ update_beacon(padapter, 0xFF, NULL, true); ++ } ++ ++ } ++ } ++ ++#if 0 ++ if (psta->flags & WLAN_STA_NONERP && !psta->nonerp_set) { ++ psta->nonerp_set = 1; ++ pmlmepriv->num_sta_non_erp++; ++ if (pmlmepriv->num_sta_non_erp == 1) ++ ieee802_11_set_beacons(hapd->iface); ++ } ++#endif ++ ++ if(psta->flags & WLAN_STA_NONERP) ++ { ++ if(!psta->nonerp_set) ++ { ++ psta->nonerp_set = 1; ++ ++ pmlmepriv->num_sta_non_erp++; ++ ++ if (pmlmepriv->num_sta_non_erp == 1) ++ { ++ beacon_updated = true; ++ update_beacon(padapter, _ERPINFO_IE_, NULL, true); ++ } ++ } ++ ++ } ++ else ++ { ++ if(psta->nonerp_set) ++ { ++ psta->nonerp_set = 0; ++ ++ pmlmepriv->num_sta_non_erp--; ++ ++ if (pmlmepriv->num_sta_non_erp == 0) ++ { ++ beacon_updated = true; ++ update_beacon(padapter, _ERPINFO_IE_, NULL, true); ++ } ++ } ++ ++ } ++ ++ ++#if 0 ++ if (!(psta->capability & WLAN_CAPABILITY_SHORT_SLOT) && ++ !psta->no_short_slot_time_set) { ++ psta->no_short_slot_time_set = 1; ++ pmlmepriv->num_sta_no_short_slot_time++; ++ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && ++ (pmlmepriv->num_sta_no_short_slot_time == 1)) ++ ieee802_11_set_beacons(hapd->iface); ++ } ++#endif ++ ++ if(!(psta->capability & WLAN_CAPABILITY_SHORT_SLOT)) ++ { ++ if(!psta->no_short_slot_time_set) ++ { ++ psta->no_short_slot_time_set = 1; ++ ++ pmlmepriv->num_sta_no_short_slot_time++; ++ ++ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && ++ (pmlmepriv->num_sta_no_short_slot_time == 1)) ++ { ++ beacon_updated = true; ++ update_beacon(padapter, 0xFF, NULL, true); ++ } ++ ++ } ++ } ++ else ++ { ++ if(psta->no_short_slot_time_set) ++ { ++ psta->no_short_slot_time_set = 0; ++ ++ pmlmepriv->num_sta_no_short_slot_time--; ++ ++ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && ++ (pmlmepriv->num_sta_no_short_slot_time == 0)) ++ { ++ beacon_updated = true; ++ update_beacon(padapter, 0xFF, NULL, true); ++ } ++ } ++ } ++ ++#ifdef CONFIG_80211N_HT ++ ++ if (psta->flags & WLAN_STA_HT) ++ { ++ u16 ht_capab = le16_to_cpu(psta->htpriv.ht_cap.cap_info); ++ ++ DBG_871X("HT: STA " MAC_FMT " HT Capabilities " ++ "Info: 0x%04x\n", MAC_ARG(psta->hwaddr), ht_capab); ++ ++ if (psta->no_ht_set) { ++ psta->no_ht_set = 0; ++ pmlmepriv->num_sta_no_ht--; ++ } ++ ++ if ((ht_capab & IEEE80211_HT_CAP_GRN_FLD) == 0) { ++ if (!psta->no_ht_gf_set) { ++ psta->no_ht_gf_set = 1; ++ pmlmepriv->num_sta_ht_no_gf++; ++ } ++ DBG_871X("%s STA " MAC_FMT " - no " ++ "greenfield, num of non-gf stations %d\n", ++ __FUNCTION__, MAC_ARG(psta->hwaddr), ++ pmlmepriv->num_sta_ht_no_gf); ++ } ++ ++ if ((ht_capab & IEEE80211_HT_CAP_SUP_WIDTH) == 0) { ++ if (!psta->ht_20mhz_set) { ++ psta->ht_20mhz_set = 1; ++ pmlmepriv->num_sta_ht_20mhz++; ++ } ++ DBG_871X("%s STA " MAC_FMT " - 20 MHz HT, " ++ "num of 20MHz HT STAs %d\n", ++ __FUNCTION__, MAC_ARG(psta->hwaddr), ++ pmlmepriv->num_sta_ht_20mhz); ++ } ++ ++ } ++ else ++ { ++ if (!psta->no_ht_set) { ++ psta->no_ht_set = 1; ++ pmlmepriv->num_sta_no_ht++; ++ } ++ if(pmlmepriv->htpriv.ht_option == true) { ++ DBG_871X("%s STA " MAC_FMT ++ " - no HT, num of non-HT stations %d\n", ++ __FUNCTION__, MAC_ARG(psta->hwaddr), ++ pmlmepriv->num_sta_no_ht); ++ } ++ } ++ ++ if (rtw_ht_operation_update(padapter) > 0) ++ { ++ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, false); ++ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, true); ++ } ++ ++#endif /* CONFIG_80211N_HT */ ++ ++ //update associcated stations cap. ++ associated_clients_update(padapter, beacon_updated); ++ ++ DBG_871X("%s, updated=%d\n", __func__, beacon_updated); ++ ++} ++ ++u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta) ++{ ++ u8 beacon_updated = false; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ ++ if(!psta) ++ return beacon_updated; ++ ++ if (psta->no_short_preamble_set) { ++ psta->no_short_preamble_set = 0; ++ pmlmepriv->num_sta_no_short_preamble--; ++ if (pmlmeext->cur_wireless_mode > WIRELESS_11B ++ && pmlmepriv->num_sta_no_short_preamble == 0) ++ { ++ beacon_updated = true; ++ update_beacon(padapter, 0xFF, NULL, true); ++ } ++ } ++ ++ if (psta->nonerp_set) { ++ psta->nonerp_set = 0; ++ pmlmepriv->num_sta_non_erp--; ++ if (pmlmepriv->num_sta_non_erp == 0) ++ { ++ beacon_updated = true; ++ update_beacon(padapter, _ERPINFO_IE_, NULL, true); ++ } ++ } ++ ++ if (psta->no_short_slot_time_set) { ++ psta->no_short_slot_time_set = 0; ++ pmlmepriv->num_sta_no_short_slot_time--; ++ if (pmlmeext->cur_wireless_mode > WIRELESS_11B ++ && pmlmepriv->num_sta_no_short_slot_time == 0) ++ { ++ beacon_updated = true; ++ update_beacon(padapter, 0xFF, NULL, true); ++ } ++ } ++ ++#ifdef CONFIG_80211N_HT ++ ++ if (psta->no_ht_gf_set) { ++ psta->no_ht_gf_set = 0; ++ pmlmepriv->num_sta_ht_no_gf--; ++ } ++ ++ if (psta->no_ht_set) { ++ psta->no_ht_set = 0; ++ pmlmepriv->num_sta_no_ht--; ++ } ++ ++ if (psta->ht_20mhz_set) { ++ psta->ht_20mhz_set = 0; ++ pmlmepriv->num_sta_ht_20mhz--; ++ } ++ ++ if (rtw_ht_operation_update(padapter) > 0) ++ { ++ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, false); ++ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, true); ++ } ++ ++#endif /* CONFIG_80211N_HT */ ++ ++ //update associcated stations cap. ++ //associated_clients_update(padapter, beacon_updated); //move it to avoid deadlock ++ ++ DBG_871X("%s, updated=%d\n", __func__, beacon_updated); ++ ++ return beacon_updated; ++ ++} ++ ++u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reason) ++{ ++ _irqL irqL; ++ u8 beacon_updated = false; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ if(!psta) ++ return beacon_updated; ++ ++ if (active == true) ++ { ++#ifdef CONFIG_80211N_HT ++ //tear down Rx AMPDU ++ send_delba(padapter, 0, psta->hwaddr);// recipient ++ ++ //tear down TX AMPDU ++ send_delba(padapter, 1, psta->hwaddr);// // originator ++ ++#endif //CONFIG_80211N_HT ++ ++ issue_deauth(padapter, psta->hwaddr, reason); ++ } ++ ++ psta->htpriv.agg_enable_bitmap = 0x0;//reset ++ psta->htpriv.candidate_tid_bitmap = 0x0;//reset ++ ++ ++ //report_del_sta_event(padapter, psta->hwaddr, reason); ++ ++ //clear cam entry / key ++ //clear_cam_entry(padapter, (psta->mac_id + 3)); ++ rtw_clearstakey_cmd(padapter, (u8*)psta, (u8)rtw_get_camid(psta->mac_id), true); ++ ++ ++ _enter_critical_bh(&psta->lock, &irqL); ++ psta->state &= ~_FW_LINKED; ++ _exit_critical_bh(&psta->lock, &irqL); ++ ++ #ifdef CONFIG_IOCTL_CFG80211 ++ if (1) { ++ #ifdef COMPAT_KERNEL_RELEASE ++ rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason); ++ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) ++ rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason); ++ #else //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) ++ /* will call rtw_cfg80211_indicate_sta_disassoc() in cmd_thread for old API context */ ++ #endif //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) ++ } else ++ #endif //CONFIG_IOCTL_CFG80211 ++ { ++ rtw_indicate_sta_disassoc_event(padapter, psta); ++ } ++ ++ report_del_sta_event(padapter, psta->hwaddr, reason); ++ ++ beacon_updated = bss_cap_update_on_sta_leave(padapter, psta); ++ ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ rtw_free_stainfo(padapter, psta); ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ ++ ++ return beacon_updated; ++ ++} ++ ++int rtw_ap_inform_ch_switch(_adapter *padapter, u8 new_ch, u8 ch_offset) ++{ ++ _irqL irqL; ++ _list *phead, *plist; ++ int ret=0; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; ++ ++ if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) ++ return ret; ++ ++ DBG_871X(FUNC_NDEV_FMT" with ch:%u, offset:%u\n", ++ FUNC_NDEV_ARG(padapter->pnetdev), new_ch, ch_offset); ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ /* for each sta in asoc_queue */ ++ while ((rtw_end_of_queue_search(phead, plist)) == false) ++ { ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ plist = get_next(plist); ++ ++ issue_action_spct_ch_switch(padapter, psta->hwaddr, new_ch, ch_offset); ++ psta->expire_to = ((pstapriv->expire_to * 2) > 5) ? 5 : (pstapriv->expire_to * 2); ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ issue_action_spct_ch_switch(padapter, bc_addr, new_ch, ch_offset); ++ ++ return ret; ++} ++ ++int rtw_sta_flush(_adapter *padapter) ++{ ++ _irqL irqL; ++ _list *phead, *plist; ++ int ret=0; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; ++ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev)); ++ ++ if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) ++ return ret; ++ ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ //free sta asoc_queue ++ while ((rtw_end_of_queue_search(phead, plist)) == false) ++ { ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ ++ plist = get_next(plist); ++ ++ rtw_list_delete(&psta->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ ++ //_exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ap_free_sta(padapter, psta, true, WLAN_REASON_DEAUTH_LEAVING); ++ //_enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ ++ issue_deauth(padapter, bc_addr, WLAN_REASON_DEAUTH_LEAVING); ++ ++ associated_clients_update(padapter, true); ++ ++ return ret; ++ ++} ++ ++/* called > TSR LEVEL for USB or SDIO Interface*/ ++void sta_info_update(_adapter *padapter, struct sta_info *psta) ++{ ++ int flags = psta->flags; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ ++ //update wmm cap. ++ if(WLAN_STA_WME&flags) ++ psta->qos_option = 1; ++ else ++ psta->qos_option = 0; ++ ++ if(pmlmepriv->qospriv.qos_option == 0) ++ psta->qos_option = 0; ++ ++ ++#ifdef CONFIG_80211N_HT ++ //update 802.11n ht cap. ++ if(WLAN_STA_HT&flags) ++ { ++ psta->htpriv.ht_option = true; ++ psta->qos_option = 1; ++ } ++ else ++ { ++ psta->htpriv.ht_option = false; ++ } ++ ++ if(pmlmepriv->htpriv.ht_option == false) ++ psta->htpriv.ht_option = false; ++#endif ++ ++#ifdef CONFIG_80211AC_VHT ++ //update 802.11AC vht cap. ++ if(WLAN_STA_VHT&flags) ++ { ++ psta->vhtpriv.vht_option = true; ++ } ++ else ++ { ++ psta->vhtpriv.vht_option = false; ++ } ++ ++ if(pmlmepriv->vhtpriv.vht_option == false) ++ psta->vhtpriv.vht_option = false; ++#endif ++ ++ ++ update_sta_info_apmode(padapter, psta); ++ ++ ++} ++ ++/* called >= TSR LEVEL for USB or SDIO Interface*/ ++void ap_sta_info_defer_update(_adapter *padapter, struct sta_info *psta) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if(psta->state & _FW_LINKED) ++ { ++ pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta; ++ ++ //add ratid ++ add_RATid(padapter, psta, 0);//DM_RATR_STA_INIT ++ } ++} ++ ++/* restore hw setting from sw data structures */ ++void rtw_ap_restore_network(_adapter *padapter) ++{ ++ struct mlme_priv *mlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct sta_priv * pstapriv = &padapter->stapriv; ++ struct sta_info *psta; ++ struct security_priv* psecuritypriv=&(padapter->securitypriv); ++ _irqL irqL; ++ _list *phead, *plist; ++ u8 chk_alive_num = 0; ++ char chk_alive_list[NUM_STA]; ++ int i; ++ ++ rtw_setopmode_cmd(padapter, Ndis802_11APMode); ++ ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ ++ start_bss_network(padapter, (u8*)&mlmepriv->cur_network.network); ++ ++ if((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || ++ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) ++ { ++ /* restore group key, WEP keys is restored in ips_leave() */ ++ rtw_set_key(padapter, psecuritypriv, psecuritypriv->dot118021XGrpKeyid, 0); ++ } ++ ++ /* per sta pairwise key and settings */ ++ if((padapter->securitypriv.dot11PrivacyAlgrthm != _TKIP_) && ++ (padapter->securitypriv.dot11PrivacyAlgrthm != _AES_)) { ++ return; ++ } ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == false) { ++ int stainfo_offset; ++ ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ plist = get_next(plist); ++ ++ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); ++ if (stainfo_offset_valid(stainfo_offset)) { ++ chk_alive_list[chk_alive_num++] = stainfo_offset; ++ } ++ } ++ ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ for (i = 0; i < chk_alive_num; i++) { ++ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); ++ ++ if (psta == NULL) { ++ DBG_871X(FUNC_ADPT_FMT" sta_info is null\n", FUNC_ADPT_ARG(padapter)); ++ } else if (psta->state &_FW_LINKED) { ++ Update_RA_Entry(padapter, psta); ++ //pairwise key ++ rtw_setstakey_cmd(padapter, (unsigned char *)psta, true); ++ } ++ } ++ ++} ++ ++void start_ap_mode(_adapter *padapter) ++{ ++ int i; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; ++ ++ pmlmepriv->update_bcn = false; ++ ++ //init_mlme_ap_info(padapter); ++ pmlmeext->bstart_bss = false; ++ ++ pmlmepriv->num_sta_non_erp = 0; ++ ++ pmlmepriv->num_sta_no_short_slot_time = 0; ++ ++ pmlmepriv->num_sta_no_short_preamble = 0; ++ ++ pmlmepriv->num_sta_ht_no_gf = 0; ++#ifdef CONFIG_80211N_HT ++ pmlmepriv->num_sta_no_ht = 0; ++#endif //CONFIG_80211N_HT ++ pmlmepriv->num_sta_ht_20mhz = 0; ++ ++ pmlmepriv->olbc = false; ++ ++ pmlmepriv->olbc_ht = false; ++ ++#ifdef CONFIG_80211N_HT ++ pmlmepriv->ht_op_mode = 0; ++#endif ++ ++ for(i=0; ista_aid[i] = NULL; ++ ++ pmlmepriv->wps_beacon_ie = NULL; ++ pmlmepriv->wps_probe_resp_ie = NULL; ++ pmlmepriv->wps_assoc_resp_ie = NULL; ++ ++ pmlmepriv->p2p_beacon_ie = NULL; ++ pmlmepriv->p2p_probe_resp_ie = NULL; ++ ++ ++ //for ACL ++ _rtw_init_listhead(&(pacl_list->acl_node_q.queue)); ++ pacl_list->num = 0; ++ pacl_list->mode = 0; ++ for(i = 0; i < NUM_ACL; i++) ++ { ++ _rtw_init_listhead(&pacl_list->aclnode[i].list); ++ pacl_list->aclnode[i].valid = false; ++ } ++ ++} ++ ++void stop_ap_mode(_adapter *padapter) ++{ ++ _irqL irqL; ++ _list *phead, *plist; ++ struct rtw_wlan_acl_node *paclnode; ++ struct sta_info *psta=NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; ++ _queue *pacl_node_q =&pacl_list->acl_node_q; ++ ++ pmlmepriv->update_bcn = false; ++ pmlmeext->bstart_bss = false; ++ //_rtw_spinlock_free(&pmlmepriv->bcn_update_lock); ++ ++ //reset and init security priv , this can refine with rtw_reset_securitypriv ++ _rtw_memset((unsigned char *)&padapter->securitypriv, 0, sizeof (struct security_priv)); ++ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled; ++ ++ //for ACL ++ _enter_critical_bh(&(pacl_node_q->lock), &irqL); ++ phead = get_list_head(pacl_node_q); ++ plist = get_next(phead); ++ while ((rtw_end_of_queue_search(phead, plist)) == false) ++ { ++ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); ++ plist = get_next(plist); ++ ++ if(paclnode->valid == true) ++ { ++ paclnode->valid = false; ++ ++ rtw_list_delete(&paclnode->list); ++ ++ pacl_list->num--; ++ } ++ } ++ _exit_critical_bh(&(pacl_node_q->lock), &irqL); ++ ++ DBG_871X("%s, free acl_node_queue, num=%d\n", __func__, pacl_list->num); ++ ++ rtw_sta_flush(padapter); ++ ++ //free_assoc_sta_resources ++ rtw_free_all_stainfo(padapter); ++ ++ psta = rtw_get_bcmc_stainfo(padapter); ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ rtw_free_stainfo(padapter, psta); ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ ++ rtw_init_bcmc_stainfo(padapter); ++ ++ rtw_free_mlme_priv_ie_data(pmlmepriv); ++ ++} ++ ++#endif //CONFIG_NATIVEAP_MLME ++#endif //CONFIG_AP_MODE +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_br_ext.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_br_ext.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_br_ext.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_br_ext.c 2018-02-06 17:42:30.693966912 +0200 +@@ -0,0 +1,1693 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#define _RTW_BR_EXT_C_ @@ -7210,11 +4517,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 +#include +#include +#include -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) -+#include -+#else +#include -+#endif ++#include +#endif +#endif + @@ -7395,10 +4699,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 +{ + while (len > 0) { + if (*data == tag && *(data+1) == len8b && len >= len8b*8) -+ return data+2; -+ -+ len -= (*(data+1))*8; -+ data += (*(data+1))*8; ++ return data+2; ++ ++ len -= (*(data+1))*8; ++ data += (*(data+1))*8; + } + return NULL; +} @@ -7408,16 +4712,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 +{ + struct icmp6hdr *icmphdr = (struct icmp6hdr *)data; + unsigned char *mac; -+ -+ if (icmphdr->icmp6_type == NDISC_ROUTER_SOLICITATION) { ++ ++ if (icmphdr->icmp6_type == NDISC_ROUTER_SOLICITATION) { + if (len >= 8) { + mac = scan_tlv(&data[8], len-8, 1, 1); + if (mac) { -+ DBG_871X("Router Solicitation, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], ++ _DEBUG_INFO("Router Solicitation, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", ++ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], + replace_mac[0],replace_mac[1],replace_mac[2],replace_mac[3],replace_mac[4],replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; ++ memcpy(mac, replace_mac, 6); ++ return 1; + } + } + } @@ -7425,56 +4729,56 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + if (len >= 16) { + mac = scan_tlv(&data[16], len-16, 1, 1); + if (mac) { -+ DBG_871X("Router Advertisement, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], ++ _DEBUG_INFO("Router Advertisement, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", ++ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], + replace_mac[0],replace_mac[1],replace_mac[2],replace_mac[3],replace_mac[4],replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; ++ memcpy(mac, replace_mac, 6); ++ return 1; + } -+ } ++ } + } + else if (icmphdr->icmp6_type == NDISC_NEIGHBOUR_SOLICITATION) { + if (len >= 24) { + mac = scan_tlv(&data[24], len-24, 1, 1); -+ if (mac) { -+ DBG_871X("Neighbor Solicitation, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], ++ if (mac) { ++ _DEBUG_INFO("Neighbor Solicitation, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", ++ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], + replace_mac[0],replace_mac[1],replace_mac[2],replace_mac[3],replace_mac[4],replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; ++ memcpy(mac, replace_mac, 6); ++ return 1; + } -+ } ++ } + } + else if (icmphdr->icmp6_type == NDISC_NEIGHBOUR_ADVERTISEMENT) { + if (len >= 24) { + mac = scan_tlv(&data[24], len-24, 2, 1); + if (mac) { -+ DBG_871X("Neighbor Advertisement, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], ++ _DEBUG_INFO("Neighbor Advertisement, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", ++ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], + replace_mac[0],replace_mac[1],replace_mac[2],replace_mac[3],replace_mac[4],replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; ++ memcpy(mac, replace_mac, 6); ++ return 1; + } -+ } ++ } + } + else if (icmphdr->icmp6_type == NDISC_REDIRECT) { + if (len >= 40) { + mac = scan_tlv(&data[40], len-40, 2, 1); -+ if (mac) { -+ DBG_871X("Redirect, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], ++ if (mac) { ++ _DEBUG_INFO("Redirect, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", ++ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], + replace_mac[0],replace_mac[1],replace_mac[2],replace_mac[3],replace_mac[4],replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; ++ memcpy(mac, replace_mac, 6); ++ return 1; + } -+ } -+ } ++ } ++ } + return 0; +} + + +static void convert_ipv6_mac_to_mc(struct sk_buff *skb) -+{ ++{ + struct ipv6hdr *iph = (struct ipv6hdr *)(skb->data + ETH_HLEN); + unsigned char *dst_mac = skb->data; + @@ -7484,7 +4788,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + dst_mac[0] = 0x33; + dst_mac[1] = 0x33; + memcpy(&dst_mac[2], &iph->daddr.s6_addr32[3], 4); -+ #if defined(__LINUX_2_6__) ++ #if defined(__LINUX_2_6__) + /*modified by qinjunjie,warning:should not remove next line*/ + skb->pkt_type = PACKET_MULTICAST; + #endif @@ -7536,10 +4840,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + networkAddr[6] ^ networkAddr[7] ^ networkAddr[8] ^ networkAddr[9] ^ networkAddr[10] ^ + networkAddr[11] ^ networkAddr[12] ^ networkAddr[13] ^ networkAddr[14] ^ networkAddr[15] ^ + networkAddr[16]; -+ ++ + return x & (NAT25_HASH_SIZE - 1); + } -+#endif ++#endif + else + { + unsigned long x = 0; @@ -7605,8 +4909,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + atomic_inc(&db->use_count); + +#ifdef CL_IPV6_PASS -+ DBG_871X("NAT25: Lookup M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" -+ "%02x%02x%02x%02x%02x%02x\n", ++ DEBUG_INFO("NAT25: Lookup M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" ++ "%02x%02x%02x%02x%02x%02x\n", + db->macAddr[0], + db->macAddr[1], + db->macAddr[2], @@ -7630,8 +4934,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + db->networkAddr[14], + db->networkAddr[15], + db->networkAddr[16]); -+#else -+ DBG_871X("NAT25: Lookup M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n", ++#else ++ DEBUG_INFO("NAT25: Lookup M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n", + db->macAddr[0], + db->macAddr[1], + db->macAddr[2], @@ -7797,7 +5101,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + int i; + _irqL irqL; + _enter_critical_bh(&priv->br_ext_lock, &irqL); -+ ++ + for(i=0; ibr_ext_lock, &irqL); -+ ++ + //if(!priv->ethBrExtInfo.nat25_disable) + { + for (i=0; i= NAT25_MAX)) + return -1; + -+ protocol = *((unsigned short *)(skb->data + 2 * ETH_ALEN)); ++ protocol = *((__be16 *)(skb->data + 2 * ETH_ALEN)); + + /*---------------------------------------------------*/ + /* Handle IP frame */ @@ -7981,7 +5285,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + //in class A, B, C, host address is all zero or all one is illegal + if (iph->saddr == 0) + return 0; -+ DBG_871X("NAT25: Insert IP, SA=%08x, DA=%08x\n", iph->saddr, iph->daddr); ++ DEBUG_INFO("NAT25: Insert IP, SA=%08x, DA=%08x\n", iph->saddr, iph->daddr); + __nat25_generate_ipv4_network_addr(networkAddr, &iph->saddr); + //record source IP address and , source mac address into db + __nat25_db_network_insert(priv, skb->data+ETH_ALEN, networkAddr); @@ -7992,7 +5296,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + + case NAT25_LOOKUP: + { -+ DBG_871X("NAT25: Lookup IP, SA=%08x, DA=%08x\n", iph->saddr, iph->daddr); ++ DEBUG_INFO("NAT25: Lookup IP, SA=%08x, DA=%08x\n", iph->saddr, iph->daddr); +#ifdef SUPPORT_TX_MCAST2UNI + if (priv->pshare->rf_ft_var.mc2u_disable || + ((((OPMODE & (WIFI_STATION_STATE|WIFI_ASOC_STATE)) @@ -8006,12 +5310,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + if (!__nat25_db_network_lookup_and_replace(priv, skb, networkAddr)) { + if (*((unsigned char *)&iph->daddr + 3) == 0xff) { + // L2 is unicast but L3 is broadcast, make L2 bacome broadcast -+ DBG_871X("NAT25: Set DA as boardcast\n"); ++ DEBUG_INFO("NAT25: Set DA as boardcast\n"); + memset(skb->data, 0xff, ETH_ALEN); + } + else { + // forward unknow IP packet to upper TCP/IP -+ DBG_871X("NAT25: Replace DA with BR's MAC\n"); ++ DEBUG_INFO("NAT25: Replace DA with BR's MAC\n"); + if ( (*(u32 *)priv->br_mac) == 0 && (*(u16 *)(priv->br_mac+4)) == 0 ) { + void netdev_br_init(struct net_device *netdev); + printk("Re-init netdev_br_init() due to br_mac==0!\n"); @@ -8051,7 +5355,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + + case NAT25_INSERT: + { -+ DBG_871X("NAT25: Insert ARP, MAC=%02x%02x%02x%02x%02x%02x\n", arp_ptr[0], ++ DEBUG_INFO("NAT25: Insert ARP, MAC=%02x%02x%02x%02x%02x%02x\n", arp_ptr[0], + arp_ptr[1], arp_ptr[2], arp_ptr[3], arp_ptr[4], arp_ptr[5]); + + // change to ARP sender mac address to wlan STA address @@ -8070,7 +5374,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + + case NAT25_LOOKUP: + { -+ DBG_871X("NAT25: Lookup ARP\n"); ++ DEBUG_INFO("NAT25: Lookup ARP\n"); + + arp_ptr += arp->ar_hln; + sender = (unsigned int *)arp_ptr; @@ -8096,9 +5400,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + /*---------------------------------------------------*/ + /* Handle IPX and Apple Talk frame */ + /*---------------------------------------------------*/ -+ else if((protocol == __constant_htons(ETH_P_IPX)) || -+ (protocol == __constant_htons(ETH_P_ATALK)) || -+ (protocol == __constant_htons(ETH_P_AARP))) ++ else if((protocol == __constant_htons(ETH_P_IPX)) || ++ (protocol <= __constant_htons(ETH_FRAME_LEN))) + { + unsigned char ipx_header[2] = {0xFF, 0xFF}; + struct ipxhdr *ipx = NULL; @@ -8108,14 +5411,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + + if(protocol == __constant_htons(ETH_P_IPX)) + { -+ DBG_871X("NAT25: Protocol=IPX (Ethernet II)\n"); ++ DEBUG_INFO("NAT25: Protocol=IPX (Ethernet II)\n"); + ipx = (struct ipxhdr *)framePtr; + } -+ else //if(protocol <= __constant_htons(ETH_FRAME_LEN)) ++ else if(protocol <= __constant_htons(ETH_FRAME_LEN)) + { + if(!memcmp(ipx_header, framePtr, 2)) + { -+ DBG_871X("NAT25: Protocol=IPX (Ethernet 802.3)\n"); ++ DEBUG_INFO("NAT25: Protocol=IPX (Ethernet 802.3)\n"); + ipx = (struct ipxhdr *)framePtr; + } + else @@ -8135,7 +5438,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + { + framePtr += 5; // eliminate the SNAP header + -+ DBG_871X("NAT25: Protocol=IPX (Ethernet SNAP)\n"); ++ DEBUG_INFO("NAT25: Protocol=IPX (Ethernet SNAP)\n"); + ipx = (struct ipxhdr *)framePtr; + } + else if(!memcmp(aarp_snap_id, framePtr, 5)) @@ -8163,14 +5466,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + + if(!memcmp(ipx_header, framePtr, 2)) + { -+ DBG_871X("NAT25: Protocol=IPX (Ethernet 802.2)\n"); ++ DEBUG_INFO("NAT25: Protocol=IPX (Ethernet 802.2)\n"); + ipx = (struct ipxhdr *)framePtr; + } + else + return -1; + } ++ else ++ return -1; + } + } ++ else ++ return -1; + + /* IPX */ + if(ipx != NULL) @@ -8180,14 +5487,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + case NAT25_CHECK: + if(!memcmp(skb->data+ETH_ALEN, ipx->ipx_source.node, ETH_ALEN)) + { -+ DBG_871X("NAT25: Check IPX skb_copy\n"); ++ DEBUG_INFO("NAT25: Check IPX skb_copy\n"); + return 0; + } + return -1; + + case NAT25_INSERT: + { -+ DBG_871X("NAT25: Insert IPX, Dest=%08x,%02x%02x%02x%02x%02x%02x,%04x Source=%08x,%02x%02x%02x%02x%02x%02x,%04x\n", ++ DEBUG_INFO("NAT25: Insert IPX, Dest=%08x,%02x%02x%02x%02x%02x%02x,%04x Source=%08x,%02x%02x%02x%02x%02x%02x,%04x\n", + ipx->ipx_dest.net, + ipx->ipx_dest.node[0], + ipx->ipx_dest.node[1], @@ -8207,7 +5514,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + + if(!memcmp(skb->data+ETH_ALEN, ipx->ipx_source.node, ETH_ALEN)) + { -+ DBG_871X("NAT25: Use IPX Net, and Socket as network addr\n"); ++ DEBUG_INFO("NAT25: Use IPX Net, and Socket as network addr\n"); + + __nat25_generate_ipx_network_addr_with_socket(networkAddr, &ipx->ipx_source.net, &ipx->ipx_source.sock); + @@ -8229,7 +5536,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + { + if(!memcmp(GET_MY_HWADDR(priv), ipx->ipx_dest.node, ETH_ALEN)) + { -+ DBG_871X("NAT25: Lookup IPX, Modify Destination IPX Node addr\n"); ++ DEBUG_INFO("NAT25: Lookup IPX, Modify Destination IPX Node addr\n"); + + __nat25_generate_ipx_network_addr_with_socket(networkAddr, &ipx->ipx_dest.net, &ipx->ipx_dest.sock); + @@ -8272,7 +5579,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + // change to AARP source mac address to wlan STA address + memcpy(ea->hw_src, GET_MY_HWADDR(priv), ETH_ALEN); + -+ DBG_871X("NAT25: Insert AARP, Source=%d,%d Destination=%d,%d\n", ++ DEBUG_INFO("NAT25: Insert AARP, Source=%d,%d Destination=%d,%d\n", + ea->pa_src_net, + ea->pa_src_node, + ea->pa_dst_net, @@ -8288,7 +5595,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + + case NAT25_LOOKUP: + { -+ DBG_871X("NAT25: Lookup AARP, Source=%d,%d Destination=%d,%d\n", ++ DEBUG_INFO("NAT25: Lookup AARP, Source=%d,%d Destination=%d,%d\n", + ea->pa_src_net, + ea->pa_src_node, + ea->pa_dst_net, @@ -8318,7 +5625,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + + case NAT25_INSERT: + { -+ DBG_871X("NAT25: Insert DDP, Source=%d,%d Destination=%d,%d\n", ++ DEBUG_INFO("NAT25: Insert DDP, Source=%d,%d Destination=%d,%d\n", + ddp->deh_snet, + ddp->deh_snode, + ddp->deh_dnet, @@ -8334,7 +5641,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + + case NAT25_LOOKUP: + { -+ DBG_871X("NAT25: Lookup DDP, Source=%d,%d Destination=%d,%d\n", ++ DEBUG_INFO("NAT25: Lookup DDP, Source=%d,%d Destination=%d,%d\n", + ddp->deh_snet, + ddp->deh_snode, + ddp->deh_dnet, @@ -8411,7 +5718,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + if(__nat25_add_pppoe_tag(skb, tag) < 0) + return -1; + -+ DBG_871X("NAT25: Insert PPPoE, forward %s packet\n", ++ DEBUG_INFO("NAT25: Insert PPPoE, forward %s packet\n", + (ph->code == PADI_CODE ? "PADI" : "PADR")); + } + else { // not add relay tag @@ -8432,7 +5739,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + } + else // session phase + { -+ DBG_871X("NAT25: Insert PPPoE, insert session packet to %s\n", skb->dev->name); ++ DEBUG_INFO("NAT25: Insert PPPoE, insert session packet to %s\n", skb->dev->name); + + __nat25_generate_pppoe_network_addr(networkAddr, skb->data, &(ph->sid)); + @@ -8490,7 +5797,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + if (offset > 0) + tag->tag_len = htons(tagLen-MAGIC_CODE_LEN-RTL_RELAY_TAG_LEN); + -+ DBG_871X("NAT25: Lookup PPPoE, forward %s Packet from %s\n", ++ DEBUG_INFO("NAT25: Lookup PPPoE, forward %s Packet from %s\n", + (ph->code == PADO_CODE ? "PADO" : "PADS"), skb->dev->name); + } + else { // not add relay tag @@ -8505,7 +5812,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + else { + if(ph->sid != 0) + { -+ DBG_871X("NAT25: Lookup PPPoE, lookup session packet from %s\n", skb->dev->name); ++ DEBUG_INFO("NAT25: Lookup PPPoE, lookup session packet from %s\n", skb->dev->name); + __nat25_generate_pppoe_network_addr(networkAddr, skb->data+ETH_ALEN, &(ph->sid)); + + __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); @@ -8567,7 +5874,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + } + + /*---------------------------------------------------*/ -+ /* Handle IPV6 frame */ ++ /* Handle IPV6 frame */ + /*---------------------------------------------------*/ +#ifdef CL_IPV6_PASS + else if(protocol == __constant_htons(ETH_P_IPV6)) @@ -8584,13 +5891,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + { + case NAT25_CHECK: + if (skb->data[0] & 1) -+ return 0; ++ return 0; + return -1; + + case NAT25_INSERT: + { -+ DBG_871X("NAT25: Insert IP, SA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x," -+ " DA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x\n", ++ DEBUG_INFO("NAT25: Insert IP, SA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x," ++ " DA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x\n", + iph->saddr.s6_addr16[0],iph->saddr.s6_addr16[1],iph->saddr.s6_addr16[2],iph->saddr.s6_addr16[3], + iph->saddr.s6_addr16[4],iph->saddr.s6_addr16[5],iph->saddr.s6_addr16[6],iph->saddr.s6_addr16[7], + iph->daddr.s6_addr16[0],iph->daddr.s6_addr16[1],iph->daddr.s6_addr16[2],iph->daddr.s6_addr16[3], @@ -8601,10 +5908,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + __nat25_db_network_insert(priv, skb->data+ETH_ALEN, networkAddr); + __nat25_db_print(priv); + -+ if (iph->nexthdr == IPPROTO_ICMPV6 && ++ if (iph->nexthdr == IPPROTO_ICMPV6 && + skb->len > (ETH_HLEN + sizeof(*iph) + 4)) { -+ if (update_nd_link_layer_addr(skb->data + ETH_HLEN + sizeof(*iph), -+ skb->len - ETH_HLEN - sizeof(*iph), GET_MY_HWADDR(priv))) { ++ if (update_nd_link_layer_addr(skb->data + ETH_HLEN + sizeof(*iph), ++ skb->len - ETH_HLEN - sizeof(*iph), GET_MY_HWADDR(priv))) { + struct icmp6hdr *hdr = (struct icmp6hdr *)(skb->data + ETH_HLEN + sizeof(*iph)); + hdr->icmp6_cksum = 0; + hdr->icmp6_cksum = csum_ipv6_magic(&iph->saddr, &iph->daddr, @@ -8612,26 +5919,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + IPPROTO_ICMPV6, + csum_partial((__u8 *)hdr, iph->payload_len, 0)); + } -+ } ++ } + } + } + return 0; + + case NAT25_LOOKUP: -+ DBG_871X("NAT25: Lookup IP, SA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x," -+ " DA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x\n", ++ DEBUG_INFO("NAT25: Lookup IP, SA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x," ++ " DA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x\n", + iph->saddr.s6_addr16[0],iph->saddr.s6_addr16[1],iph->saddr.s6_addr16[2],iph->saddr.s6_addr16[3], + iph->saddr.s6_addr16[4],iph->saddr.s6_addr16[5],iph->saddr.s6_addr16[6],iph->saddr.s6_addr16[7], + iph->daddr.s6_addr16[0],iph->daddr.s6_addr16[1],iph->daddr.s6_addr16[2],iph->daddr.s6_addr16[3], + iph->daddr.s6_addr16[4],iph->daddr.s6_addr16[5],iph->daddr.s6_addr16[6],iph->daddr.s6_addr16[7]); -+ ++ + + __nat25_generate_ipv6_network_addr(networkAddr, (unsigned int *)&iph->daddr); + if (!__nat25_db_network_lookup_and_replace(priv, skb, networkAddr)) { -+#ifdef SUPPORT_RX_UNI2MCAST ++#ifdef SUPPORT_RX_UNI2MCAST + if (iph->daddr.s6_addr[0] == 0xff) -+ convert_ipv6_mac_to_mc(skb); -+#endif ++ convert_ipv6_mac_to_mc(skb); ++#endif + } + return 0; + @@ -8671,7 +5978,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + int is_vlan_tag=0, i, retval=0; + unsigned short vlan_hdr=0; + -+ if (*((unsigned short *)(skb->data+ETH_ALEN*2)) == __constant_htons(ETH_P_8021Q)) { ++ if (*((__be16 *)(skb->data+ETH_ALEN*2)) == __constant_htons(ETH_P_8021Q)) { + is_vlan_tag = 1; + vlan_hdr = *((unsigned short *)(skb->data+ETH_ALEN*2+2)); + for (i=0; i<6; i++) @@ -8692,12 +5999,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + (*((unsigned short *)(skb->data+ETH_ALEN*2)) == __constant_htons(ETH_P_IP)) && + !memcmp(priv->scdb_ip, skb->data+ETH_HLEN+16, 4)) { + memcpy(skb->data, priv->scdb_mac, ETH_ALEN); -+ ++ + _exit_critical_bh(&priv->br_ext_lock, &irqL); + } + else { + _exit_critical_bh(&priv->br_ext_lock, &irqL); -+ ++ + retval = nat25_db_handle(priv, skb, NAT25_LOOKUP); + } + } @@ -8715,8 +6022,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + skb_push(skb, 4); + for (i=0; i<6; i++) + *((unsigned short *)(skb->data+i*2)) = *((unsigned short *)(skb->data+4+i*2)); -+ *((unsigned short *)(skb->data+ETH_ALEN*2)) = __constant_htons(ETH_P_8021Q); -+ *((unsigned short *)(skb->data+ETH_ALEN*2+2)) = vlan_hdr; ++ *((__be16 *)(skb->data+ETH_ALEN*2)) = __constant_htons(ETH_P_8021Q); ++ *((__be16 *)(skb->data+ETH_ALEN*2+2)) = vlan_hdr; + } + + if(retval == -1) { @@ -8734,7 +6041,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + struct sockaddr sa; + + memcpy(sa.sa_data, addr, ETH_ALEN); -+ DBG_871X("MAC Clone: Addr=%02x%02x%02x%02x%02x%02x\n", ++ DEBUG_INFO("MAC Clone: Addr=%02x%02x%02x%02x%02x%02x\n", + addr[0], addr[1], addr[2], addr[3], addr[4], addr[5]); + rtl8192cd_set_hwaddr(priv->dev, &sa); +} @@ -8791,7 +6098,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + + if(!priv->ethBrExtInfo.dhcp_bcst_disable) + { -+ unsigned short protocol = *((unsigned short *)(skb->data + 2 * ETH_ALEN)); ++ __be16 protocol = *((unsigned short *)(skb->data + 2 * ETH_ALEN)); + + if(protocol == __constant_htons(ETH_P_IP)) // IP + { @@ -8813,7 +6120,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 + { + register int sum = 0; + -+ DBG_871X("DHCP: change flag of DHCP request to broadcast.\n"); ++ DEBUG_INFO("DHCP: change flag of DHCP request to broadcast.\n"); + // or BROADCAST flag + dhcph->flags |= htons(BROADCAST_FLAG); + // recalculate checksum @@ -8858,3485 +6165,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_br_ext.c linux/3rdparty/rtl8812 +} + +#endif // CONFIG_BR_EXT -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_btcoex.c linux/3rdparty/rtl8812au/core/rtw_btcoex.c ---- linux.old/3rdparty/rtl8812au/core/rtw_btcoex.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_btcoex.c 2017-06-07 23:07:20.999686482 +0300 -@@ -0,0 +1,1709 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifdef CONFIG_BT_COEXIST -+ -+#include -+#include -+#include -+ -+ -+void rtw_btcoex_Initialize(PADAPTER padapter) -+{ -+ hal_btcoex_Initialize(padapter); -+} -+ -+void rtw_btcoex_PowerOnSetting(PADAPTER padapter) -+{ -+ hal_btcoex_PowerOnSetting(padapter); -+} -+ -+void rtw_btcoex_PreLoadFirmware(PADAPTER padapter) -+{ -+ hal_btcoex_PreLoadFirmware(padapter); -+} -+ -+void rtw_btcoex_HAL_Initialize(PADAPTER padapter, u8 bWifiOnly) -+{ -+ hal_btcoex_InitHwConfig(padapter, bWifiOnly); -+} -+ -+void rtw_btcoex_IpsNotify(PADAPTER padapter, u8 type) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_IpsNotify(padapter, type); -+} -+ -+void rtw_btcoex_LpsNotify(PADAPTER padapter, u8 type) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_LpsNotify(padapter, type); -+} -+ -+void rtw_btcoex_ScanNotify(PADAPTER padapter, u8 type) -+{ -+ PHAL_DATA_TYPE pHalData; -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ PBT_MGNT pBtMgnt=&pcoex_info->BtMgnt; -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ((_FALSE == type) && (padapter->pbuddy_adapter)) -+ { -+ PADAPTER pbuddy = padapter->pbuddy_adapter; -+ if (check_fwstate(&pbuddy->mlmepriv, WIFI_SITE_MONITOR) == _TRUE) -+ return; -+ } -+#endif -+ -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ if(pBtMgnt->ExtConfig.bEnableWifiScanNotify) -+ rtw_btcoex_SendScanNotify(padapter, type); -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+ -+ hal_btcoex_ScanNotify(padapter, type); -+} -+ -+void rtw_btcoex_ConnectNotify(PADAPTER padapter, u8 action) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+#ifdef DBG_CONFIG_ERROR_RESET -+ if (_TRUE == rtw_hal_sreset_inprogress(padapter)) -+ { -+ DBG_8192C(FUNC_ADPT_FMT ": [BTCoex] under reset, skip notify!\n", -+ FUNC_ADPT_ARG(padapter)); -+ return; -+ } -+#endif // DBG_CONFIG_ERROR_RESET -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ((_FALSE == action) && (padapter->pbuddy_adapter)) -+ { -+ PADAPTER pbuddy = padapter->pbuddy_adapter; -+ if (check_fwstate(&pbuddy->mlmepriv, WIFI_UNDER_LINKING) == _TRUE) -+ return; -+ } -+#endif -+ -+ hal_btcoex_ConnectNotify(padapter, action); -+} -+ -+void rtw_btcoex_MediaStatusNotify(PADAPTER padapter, u8 mediaStatus) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+#ifdef DBG_CONFIG_ERROR_RESET -+ if (_TRUE == rtw_hal_sreset_inprogress(padapter)) -+ { -+ DBG_8192C(FUNC_ADPT_FMT ": [BTCoex] under reset, skip notify!\n", -+ FUNC_ADPT_ARG(padapter)); -+ return; -+ } -+#endif // DBG_CONFIG_ERROR_RESET -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ((RT_MEDIA_DISCONNECT == mediaStatus) && (padapter->pbuddy_adapter)) -+ { -+ PADAPTER pbuddy = padapter->pbuddy_adapter; -+ if (check_fwstate(&pbuddy->mlmepriv, WIFI_ASOC_STATE) == _TRUE) -+ return; -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ -+ if ((RT_MEDIA_CONNECT == mediaStatus) -+ && (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE)) -+ { -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_RSVD_PAGE, NULL); -+ } -+ -+ hal_btcoex_MediaStatusNotify(padapter, mediaStatus); -+} -+ -+void rtw_btcoex_SpecialPacketNotify(PADAPTER padapter, u8 pktType) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_SpecialPacketNotify(padapter, pktType); -+} -+ -+void rtw_btcoex_IQKNotify(PADAPTER padapter, u8 state) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_IQKNotify(padapter, state); -+} -+ -+void rtw_btcoex_BtInfoNotify(PADAPTER padapter, u8 length, u8 *tmpBuf) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_BtInfoNotify(padapter, length, tmpBuf); -+} -+ -+void rtw_btcoex_SuspendNotify(PADAPTER padapter, u8 state) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_SuspendNotify(padapter, state); -+} -+ -+void rtw_btcoex_HaltNotify(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ if (_FALSE == padapter->bup) -+ { -+ DBG_871X(FUNC_ADPT_FMT ": bup=%d Skip!\n", -+ FUNC_ADPT_ARG(padapter), padapter->bup); -+ -+ return; -+ } -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ DBG_871X(FUNC_ADPT_FMT ": bSurpriseRemoved=%s Skip!\n", -+ FUNC_ADPT_ARG(padapter), rtw_is_surprise_removed(padapter)?"True":"False"); -+ -+ return; -+ } -+ -+ hal_btcoex_HaltNotify(padapter); -+} -+ -+void rtw_btcoex_SwitchBtTRxMask(PADAPTER padapter) -+{ -+ hal_btcoex_SwitchBtTRxMask(padapter); -+} -+ -+void rtw_btcoex_Switch(PADAPTER padapter, u8 enable) -+{ -+ hal_btcoex_SetBTCoexist(padapter, enable); -+} -+ -+u8 rtw_btcoex_IsBtDisabled(PADAPTER padapter) -+{ -+ return hal_btcoex_IsBtDisabled(padapter); -+} -+ -+void rtw_btcoex_Handler(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (padapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif -+ -+ -+ -+ hal_btcoex_Hanlder(padapter); -+} -+ -+s32 rtw_btcoex_IsBTCoexRejectAMPDU(PADAPTER padapter) -+{ -+ s32 coexctrl; -+ -+ coexctrl = hal_btcoex_IsBTCoexRejectAMPDU(padapter); -+ -+ return coexctrl; -+} -+ -+s32 rtw_btcoex_IsBTCoexCtrlAMPDUSize(PADAPTER padapter) -+{ -+ s32 coexctrl; -+ -+ coexctrl = hal_btcoex_IsBTCoexCtrlAMPDUSize(padapter); -+ -+ return coexctrl; -+} -+ -+u32 rtw_btcoex_GetAMPDUSize(PADAPTER padapter) -+{ -+ u32 size; -+ -+ size = hal_btcoex_GetAMPDUSize(padapter); -+ -+ return size; -+} -+ -+void rtw_btcoex_SetManualControl(PADAPTER padapter, u8 manual) -+{ -+ if (_TRUE == manual) -+ { -+ hal_btcoex_SetManualControl(padapter, _TRUE); -+ } -+ else -+ { -+ hal_btcoex_SetManualControl(padapter, _FALSE); -+ } -+} -+ -+u8 rtw_btcoex_1Ant(PADAPTER padapter) -+{ -+ return hal_btcoex_1Ant(padapter); -+} -+ -+u8 rtw_btcoex_IsBtControlLps(PADAPTER padapter) -+{ -+ return hal_btcoex_IsBtControlLps(padapter); -+} -+ -+u8 rtw_btcoex_IsLpsOn(PADAPTER padapter) -+{ -+ return hal_btcoex_IsLpsOn(padapter); -+} -+ -+u8 rtw_btcoex_RpwmVal(PADAPTER padapter) -+{ -+ return hal_btcoex_RpwmVal(padapter); -+} -+ -+u8 rtw_btcoex_LpsVal(PADAPTER padapter) -+{ -+ return hal_btcoex_LpsVal(padapter); -+} -+ -+void rtw_btcoex_SetBTCoexist(PADAPTER padapter, u8 bBtExist) -+{ -+ hal_btcoex_SetBTCoexist(padapter, bBtExist); -+} -+ -+void rtw_btcoex_SetChipType(PADAPTER padapter, u8 chipType) -+{ -+ hal_btcoex_SetChipType(padapter, chipType); -+} -+ -+void rtw_btcoex_SetPGAntNum(PADAPTER padapter, u8 antNum) -+{ -+ hal_btcoex_SetPgAntNum(padapter, antNum); -+} -+ -+u8 rtw_btcoex_GetPGAntNum(PADAPTER padapter) -+{ -+ return hal_btcoex_GetPgAntNum(padapter); -+} -+ -+void rtw_btcoex_SetSingleAntPath(PADAPTER padapter, u8 singleAntPath) -+{ -+ hal_btcoex_SetSingleAntPath(padapter, singleAntPath); -+} -+ -+u32 rtw_btcoex_GetRaMask(PADAPTER padapter) -+{ -+ return hal_btcoex_GetRaMask(padapter); -+} -+ -+void rtw_btcoex_RecordPwrMode(PADAPTER padapter, u8 *pCmdBuf, u8 cmdLen) -+{ -+ hal_btcoex_RecordPwrMode(padapter, pCmdBuf, cmdLen); -+} -+ -+void rtw_btcoex_DisplayBtCoexInfo(PADAPTER padapter, u8 *pbuf, u32 bufsize) -+{ -+ hal_btcoex_DisplayBtCoexInfo(padapter, pbuf, bufsize); -+} -+ -+void rtw_btcoex_SetDBG(PADAPTER padapter, u32 *pDbgModule) -+{ -+ hal_btcoex_SetDBG(padapter, pDbgModule); -+} -+ -+u32 rtw_btcoex_GetDBG(PADAPTER padapter, u8 *pStrBuf, u32 bufSize) -+{ -+ return hal_btcoex_GetDBG(padapter, pStrBuf, bufSize); -+} -+ -+u8 rtw_btcoex_IncreaseScanDeviceNum(PADAPTER padapter) -+{ -+ return hal_btcoex_IncreaseScanDeviceNum(padapter); -+} -+ -+u8 rtw_btcoex_IsBtLinkExist(PADAPTER padapter) -+{ -+ return hal_btcoex_IsBtLinkExist(padapter); -+} -+ -+void rtw_btcoex_SetBtPatchVersion(PADAPTER padapter,u16 btHciVer, u16 btPatchVer) -+{ -+ hal_btcoex_SetBtPatchVersion(padapter,btHciVer,btPatchVer); -+} -+ -+void rtw_btcoex_SetHciVersion(PADAPTER padapter, u16 hciVersion) -+{ -+ hal_btcoex_SetHciVersion(padapter, hciVersion); -+} -+ -+void rtw_btcoex_StackUpdateProfileInfo(void) -+{ -+ hal_btcoex_StackUpdateProfileInfo(); -+} -+ -+void rtw_btcoex_PTAOffOnNotify(PADAPTER padapter, u8 bBTON) -+{ -+ hal_btcoex_PTAOffOnNotify(padapter, bBTON); -+} -+ -+// ================================================== -+// Below Functions are called by BT-Coex -+// ================================================== -+void rtw_btcoex_rx_ampdu_apply(PADAPTER padapter) -+{ -+ rtw_rx_ampdu_apply(padapter); -+} -+ -+void rtw_btcoex_LPS_Enter(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ u8 lpsVal; -+ -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ pwrpriv->bpower_saving = _TRUE; -+ lpsVal = rtw_btcoex_LpsVal(padapter); -+ rtw_set_ps_mode(padapter, PS_MODE_MIN, 0, lpsVal, "BTCOEX"); -+} -+ -+void rtw_btcoex_LPS_Leave(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) -+ { -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "BTCOEX"); -+ LPS_RF_ON_check(padapter, 100); -+ pwrpriv->bpower_saving = _FALSE; -+ } -+} -+ -+ -+// ================================================== -+// Below Functions are BT-Coex socket related function -+// ================================================== -+ -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+_adapter *pbtcoexadapter = NULL; -+u8 rtw_btcoex_btinfo_cmd(_adapter *adapter, u8 *buf, u16 len) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ u8 *btinfo; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((u8*)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ btinfo = rtw_zmalloc(len); -+ if (btinfo == NULL) { -+ rtw_mfree((u8*)ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8*)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = BTINFO_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = len; -+ pdrvextra_cmd_parm->pbuf = btinfo; -+ -+ _rtw_memcpy(btinfo, buf, len); -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+u8 rtw_btcoex_send_event_to_BT(_adapter *padapter, u8 status, u8 event_code, u8 opcode_low, u8 opcode_high,u8 *dbg_msg) -+{ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len=0,tx_event_length = 0; -+ rtw_HCI_event *pEvent; -+ -+ pEvent = (rtw_HCI_event*)(&localBuf[0]); -+ -+ pEvent->EventCode = event_code; -+ pEvent->Data[0] = 0x1; //packet # -+ pEvent->Data[1] = opcode_low; -+ pEvent->Data[2] = opcode_high; -+ len = len + 3; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; //status -+ -+ len++; -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+#if 0 -+ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, dbg_msg); -+#endif -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ -+ return status; -+} -+ -+/* -+Ref: -+Realtek Wi-Fi Driver -+Host Controller Interface for -+Bluetooth 3.0 + HS V1.4 2013/02/07 -+ -+Window team code & BT team code -+ */ -+ -+ -+u8 rtw_btcoex_parse_BT_info_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ #define BT_INFO_LENGTH 8 -+ -+ u8 curPollEnable = pcmd[0]; -+ u8 curPollTime = pcmd[1]; -+ u8 btInfoReason = pcmd[2]; -+ u8 btInfoLen = pcmd[3]; -+ u8 btinfo[BT_INFO_LENGTH]; -+ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len=0,tx_event_length = 0; -+ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; -+ rtw_HCI_event *pEvent; -+ -+ /* DBG_871X("%s\n",__func__); -+ DBG_871X("current Poll Enable: %d, currrent Poll Time: %d\n",curPollEnable,curPollTime); -+ DBG_871X("BT Info reason: %d, BT Info length: %d\n",btInfoReason,btInfoLen); -+ DBG_871X("%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x\n" -+ ,pcmd[4],pcmd[5],pcmd[6],pcmd[7],pcmd[8],pcmd[9],pcmd[10],pcmd[11]);*/ -+ -+ _rtw_memset(btinfo, 0, BT_INFO_LENGTH); -+ -+#if 1 -+ if(BT_INFO_LENGTH != btInfoLen) -+ { -+ status = HCI_STATUS_INVALID_HCI_CMD_PARA_VALUE; -+ DBG_871X("Error BT Info Length: %d\n",btInfoLen); -+ //return _FAIL; -+ } -+ else -+#endif -+ { -+ if(0x1 == btInfoReason || 0x2 == btInfoReason) -+ { -+ _rtw_memcpy(btinfo, &pcmd[4], btInfoLen); -+ btinfo[0] = btInfoReason; -+ rtw_btcoex_btinfo_cmd(padapter,btinfo,btInfoLen); -+ } -+ else -+ { -+ DBG_871X("Other BT info reason\n"); -+ } -+ } -+ -+ //send complete event to BT -+ { -+ -+ pEvent = (rtw_HCI_event*)(&localBuf[0]); -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; //packet # -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_INFO_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_INFO_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; //status -+ -+ len++; -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+#if 0 -+ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length,"BT_info_event"); -+#endif -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ -+ return status; -+ //bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); -+ } -+} -+ -+u8 rtw_btcoex_parse_BT_patch_ver_info_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ RTW_HCI_STATUS status=HCI_STATUS_SUCCESS; -+ u16 btPatchVer=0x0, btHciVer=0x0; -+ //u16 *pU2tmp; -+ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len=0, tx_event_length =0; -+ rtw_HCI_event *pEvent; -+ -+ btHciVer = pcmd[0] | pcmd[1]<<8; -+ btPatchVer = pcmd[2] | pcmd[3]<<8; -+ -+ -+ DBG_871X("%s, cmd:%02x %02x %02x %02x\n",__func__, pcmd[0] ,pcmd[1] ,pcmd[2] ,pcmd[3]); -+ DBG_871X("%s, HCI Ver:%d, Patch Ver:%d\n",__func__, btHciVer,btPatchVer); -+ -+ rtw_btcoex_SetBtPatchVersion(padapter,btHciVer,btPatchVer); -+ -+ -+ //send complete event to BT -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; //packet # -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_PATCH_VERSION_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_PATCH_VERSION_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; //status -+ -+ len++; -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+#if 0 -+ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length,"BT_patch_event"); -+#endif -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ //bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); -+ } -+} -+ -+u8 rtw_btcoex_parse_HCI_Ver_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ RTW_HCI_STATUS status=HCI_STATUS_SUCCESS; -+ u16 hciver = pcmd[0] | pcmd[1] <<8; -+ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len=0, tx_event_length =0; -+ rtw_HCI_event *pEvent; -+ -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ PBT_MGNT pBtMgnt=&pcoex_info->BtMgnt; -+ pBtMgnt->ExtConfig.HCIExtensionVer = hciver; -+ DBG_871X("%s, HCI Version: %d\n",__func__,pBtMgnt->ExtConfig.HCIExtensionVer); -+ if(pBtMgnt->ExtConfig.HCIExtensionVer < 4) -+ { -+ status = HCI_STATUS_INVALID_HCI_CMD_PARA_VALUE; -+ DBG_871X("%s, Version = %d, HCI Version < 4\n",__func__,pBtMgnt->ExtConfig.HCIExtensionVer ); -+ } -+ else -+ { -+ rtw_btcoex_SetHciVersion(padapter,hciver); -+ } -+ //send complete event to BT -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; //packet # -+ pEvent->Data[1] = HCIOPCODELOW(HCI_EXTENSION_VERSION_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_EXTENSION_VERSION_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; //status -+ -+ len++; -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ //bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); -+ } -+ -+} -+ -+u8 rtw_btcoex_parse_WIFI_scan_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ RTW_HCI_STATUS status=HCI_STATUS_SUCCESS; -+ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len=0, tx_event_length =0; -+ rtw_HCI_event *pEvent; -+ -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ PBT_MGNT pBtMgnt=&pcoex_info->BtMgnt; -+ pBtMgnt->ExtConfig.bEnableWifiScanNotify= pcmd[0]; -+ DBG_871X("%s, bEnableWifiScanNotify: %d\n",__func__,pBtMgnt->ExtConfig.bEnableWifiScanNotify); -+ -+ //send complete event to BT -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; //packet # -+ pEvent->Data[1] = HCIOPCODELOW(HCI_ENABLE_WIFI_SCAN_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_ENABLE_WIFI_SCAN_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; //status -+ -+ len++; -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ //bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); -+ } -+} -+ -+u8 rtw_btcoex_parse_HCI_link_status_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ RTW_HCI_STATUS status=HCI_STATUS_SUCCESS; -+ struct bt_coex_info *pcoex_info=&padapter->coex_info; -+ PBT_MGNT pBtMgnt=&pcoex_info->BtMgnt; -+ //PBT_DBG pBtDbg=&padapter->MgntInfo.BtInfo.BtDbg; -+ u8 i, numOfHandle=0, numOfAcl=0; -+ u16 conHandle; -+ u8 btProfile, btCoreSpec, linkRole; -+ u8 *pTriple; -+ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len=0, tx_event_length =0; -+ rtw_HCI_event *pEvent; -+ -+ //pBtDbg->dbgHciInfo.hciCmdCntLinkStatusNotify++; -+ //RT_DISP_DATA(FIOCTL, IOCTL_BT_HCICMD_EXT, "LinkStatusNotify, Hex Data :\n", -+ // &pHciCmd->Data[0], pHciCmd->Length); -+ -+ DBG_871X("BTLinkStatusNotify\n"); -+ -+ // Current only RTL8723 support this command. -+ //pBtMgnt->bSupportProfile = TRUE; -+ pBtMgnt->bSupportProfile = _FALSE; -+ -+ pBtMgnt->ExtConfig.NumberOfACL = 0; -+ pBtMgnt->ExtConfig.NumberOfSCO = 0; -+ -+ numOfHandle = pcmd[0]; -+ //RT_DISP(FIOCTL, IOCTL_BT_HCICMD_EXT, ("numOfHandle = 0x%x\n", numOfHandle)); -+ //RT_DISP(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCIExtensionVer = %d\n", pBtMgnt->ExtConfig.HCIExtensionVer)); -+ DBG_871X("numOfHandle = 0x%x\n", numOfHandle); -+ DBG_871X("HCIExtensionVer = %d\n", pBtMgnt->ExtConfig.HCIExtensionVer); -+ -+ pTriple = &pcmd[1]; -+ for(i=0; iExtConfig.HCIExtensionVer < 1) -+ { -+ conHandle = *((u8 *)&pTriple[0]); -+ btProfile = pTriple[2]; -+ btCoreSpec = pTriple[3]; -+ if(BT_PROFILE_SCO == btProfile) -+ { -+ pBtMgnt->ExtConfig.NumberOfSCO++; -+ } -+ else -+ { -+ pBtMgnt->ExtConfig.NumberOfACL++; -+ pBtMgnt->ExtConfig.aclLink[i].ConnectHandle = conHandle; -+ pBtMgnt->ExtConfig.aclLink[i].BTProfile = btProfile; -+ pBtMgnt->ExtConfig.aclLink[i].BTCoreSpec = btCoreSpec; -+ } -+ //RT_DISP(FIOCTL, IOCTL_BT_HCICMD_EXT, -+ // ("Connection_Handle=0x%x, BTProfile=%d, BTSpec=%d\n", -+ // conHandle, btProfile, btCoreSpec)); -+ DBG_871X("Connection_Handle=0x%x, BTProfile=%d, BTSpec=%d\n", conHandle, btProfile, btCoreSpec); -+ pTriple += 4; -+ } -+ else if(pBtMgnt->ExtConfig.HCIExtensionVer >= 1) -+ { -+ conHandle = *((pu2Byte)&pTriple[0]); -+ btProfile = pTriple[2]; -+ btCoreSpec = pTriple[3]; -+ linkRole = pTriple[4]; -+ if(BT_PROFILE_SCO == btProfile) -+ { -+ pBtMgnt->ExtConfig.NumberOfSCO++; -+ } -+ else -+ { -+ pBtMgnt->ExtConfig.NumberOfACL++; -+ pBtMgnt->ExtConfig.aclLink[i].ConnectHandle = conHandle; -+ pBtMgnt->ExtConfig.aclLink[i].BTProfile = btProfile; -+ pBtMgnt->ExtConfig.aclLink[i].BTCoreSpec = btCoreSpec; -+ pBtMgnt->ExtConfig.aclLink[i].linkRole = linkRole; -+ } -+ //RT_DISP(FIOCTL, IOCTL_BT_HCICMD_EXT, -+ DBG_871X("Connection_Handle=0x%x, BTProfile=%d, BTSpec=%d, LinkRole=%d\n", -+ conHandle, btProfile, btCoreSpec, linkRole); -+ pTriple += 5; -+ } -+ } -+ rtw_btcoex_StackUpdateProfileInfo(); -+ -+ //send complete event to BT -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; //packet # -+ pEvent->Data[1] = HCIOPCODELOW(HCI_LINK_STATUS_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_LINK_STATUS_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; //status -+ -+ len++; -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ //bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); -+ } -+ -+ -+} -+ -+u8 rtw_btcoex_parse_HCI_BT_coex_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len=0, tx_event_length =0; -+ rtw_HCI_event *pEvent; -+ RTW_HCI_STATUS status=HCI_STATUS_SUCCESS; -+ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; //packet # -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_COEX_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_COEX_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; //status -+ -+ len++; -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ //bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); -+ } -+} -+ -+u8 rtw_btcoex_parse_HCI_BT_operation_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len=0, tx_event_length =0; -+ rtw_HCI_event *pEvent; -+ RTW_HCI_STATUS status=HCI_STATUS_SUCCESS; -+ -+ DBG_871X("%s, OP code: %d\n",__func__,pcmd[0]); -+ -+ switch(pcmd[0]) -+ { -+ case HCI_BT_OP_NONE: -+ DBG_871X("[bt operation] : Operation None!!\n"); -+ break; -+ case HCI_BT_OP_INQUIRY_START: -+ DBG_871X("[bt operation] : Inquiry start!!\n"); -+ break; -+ case HCI_BT_OP_INQUIRY_FINISH: -+ DBG_871X("[bt operation] : Inquiry finished!!\n"); -+ break; -+ case HCI_BT_OP_PAGING_START: -+ DBG_871X("[bt operation] : Paging is started!!\n"); -+ break; -+ case HCI_BT_OP_PAGING_SUCCESS: -+ DBG_871X("[bt operation] : Paging complete successfully!!\n"); -+ break; -+ case HCI_BT_OP_PAGING_UNSUCCESS: -+ DBG_871X("[bt operation] : Paging complete unsuccessfully!!\n"); -+ break; -+ case HCI_BT_OP_PAIRING_START: -+ DBG_871X("[bt operation] : Pairing start!!\n"); -+ break; -+ case HCI_BT_OP_PAIRING_FINISH: -+ DBG_871X("[bt operation] : Pairing finished!!\n"); -+ break; -+ case HCI_BT_OP_BT_DEV_ENABLE: -+ DBG_871X("[bt operation] : BT Device is enabled!!\n"); -+ break; -+ case HCI_BT_OP_BT_DEV_DISABLE: -+ DBG_871X("[bt operation] : BT Device is disabled!!\n"); -+ break; -+ default: -+ DBG_871X("[bt operation] : Unknown, error!!\n"); -+ break; -+ } -+ -+ //send complete event to BT -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; //packet # -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_OPERATION_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_OPERATION_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; //status -+ -+ len++; -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ //bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); -+ } -+} -+ -+u8 rtw_btcoex_parse_BT_AFH_MAP_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len=0, tx_event_length =0; -+ rtw_HCI_event *pEvent; -+ RTW_HCI_STATUS status=HCI_STATUS_SUCCESS; -+ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; //packet # -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_AFH_MAP_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_AFH_MAP_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; //status -+ -+ len++; -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ //bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); -+ } -+} -+ -+u8 rtw_btcoex_parse_BT_register_val_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len=0, tx_event_length =0; -+ rtw_HCI_event *pEvent; -+ RTW_HCI_STATUS status=HCI_STATUS_SUCCESS; -+ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; //packet # -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_REGISTER_VALUE_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_REGISTER_VALUE_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; //status -+ -+ len++; -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ //bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); -+ } -+} -+ -+u8 rtw_btcoex_parse_HCI_BT_abnormal_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len=0, tx_event_length =0; -+ rtw_HCI_event *pEvent; -+ RTW_HCI_STATUS status=HCI_STATUS_SUCCESS; -+ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; //packet # -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_ABNORMAL_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_ABNORMAL_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; //status -+ -+ len++; -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ //bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); -+ } -+} -+ -+u8 rtw_btcoex_parse_HCI_query_RF_status_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len=0, tx_event_length =0; -+ rtw_HCI_event *pEvent; -+ RTW_HCI_STATUS status=HCI_STATUS_SUCCESS; -+ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; //packet # -+ pEvent->Data[1] = HCIOPCODELOW(HCI_QUERY_RF_STATUS, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_QUERY_RF_STATUS, OGF_EXTENSION); -+ len = len + 3; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; //status -+ -+ len++; -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ //bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); -+ } -+} -+ -+/***************************************** -+* HCI cmd format : -+*| 15 - 0 | -+*| OPcode (OCF|OGF<<10) | -+*| 15 - 8 |7 - 0 | -+*|Cmd para |Cmd para Length | -+*|Cmd para...... | -+******************************************/ -+ -+//bit 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 -+// | OCF | OGF | -+void rtw_btcoex_parse_hci_extend_cmd(_adapter *padapter, u8 *pcmd, u16 len,const u16 hci_OCF) -+{ -+ -+ DBG_871X("%s: OCF: %x\n",__func__,hci_OCF); -+ switch(hci_OCF) -+ { -+ case HCI_EXTENSION_VERSION_NOTIFY: -+ DBG_871X("HCI_EXTENSION_VERSION_NOTIFY\n"); -+ rtw_btcoex_parse_HCI_Ver_notify_cmd(padapter,pcmd, len); -+ break; -+ case HCI_LINK_STATUS_NOTIFY: -+ DBG_871X("HCI_LINK_STATUS_NOTIFY\n"); -+ rtw_btcoex_parse_HCI_link_status_notify_cmd(padapter,pcmd, len); -+ break; -+ case HCI_BT_OPERATION_NOTIFY: -+ // only for 8723a 2ant -+ DBG_871X("HCI_BT_OPERATION_NOTIFY\n"); -+ rtw_btcoex_parse_HCI_BT_operation_notify_cmd(padapter,pcmd, len); -+ // -+ break; -+ case HCI_ENABLE_WIFI_SCAN_NOTIFY: -+ DBG_871X("HCI_ENABLE_WIFI_SCAN_NOTIFY\n"); -+ rtw_btcoex_parse_WIFI_scan_notify_cmd(padapter,pcmd, len); -+ break; -+ case HCI_QUERY_RF_STATUS: -+ // only for 8723b 2ant -+ DBG_871X("HCI_QUERY_RF_STATUS\n"); -+ rtw_btcoex_parse_HCI_query_RF_status_cmd(padapter,pcmd, len); -+ break; -+ case HCI_BT_ABNORMAL_NOTIFY: -+ DBG_871X("HCI_BT_ABNORMAL_NOTIFY\n"); -+ rtw_btcoex_parse_HCI_BT_abnormal_notify_cmd(padapter,pcmd, len); -+ break; -+ case HCI_BT_INFO_NOTIFY: -+ DBG_871X("HCI_BT_INFO_NOTIFY\n"); -+ rtw_btcoex_parse_BT_info_notify_cmd(padapter,pcmd, len); -+ break; -+ case HCI_BT_COEX_NOTIFY: -+ DBG_871X("HCI_BT_COEX_NOTIFY\n"); -+ rtw_btcoex_parse_HCI_BT_coex_notify_cmd(padapter,pcmd, len); -+ break; -+ case HCI_BT_PATCH_VERSION_NOTIFY: -+ DBG_871X("HCI_BT_PATCH_VERSION_NOTIFY\n"); -+ rtw_btcoex_parse_BT_patch_ver_info_cmd(padapter,pcmd, len); -+ break; -+ case HCI_BT_AFH_MAP_NOTIFY: -+ DBG_871X("HCI_BT_AFH_MAP_NOTIFY\n"); -+ rtw_btcoex_parse_BT_AFH_MAP_notify_cmd(padapter,pcmd, len); -+ break; -+ case HCI_BT_REGISTER_VALUE_NOTIFY: -+ DBG_871X("HCI_BT_REGISTER_VALUE_NOTIFY\n"); -+ rtw_btcoex_parse_BT_register_val_notify_cmd(padapter,pcmd, len); -+ break; -+ default: -+ DBG_871X("ERROR!!! Unknown OCF: %x\n",hci_OCF); -+ break; -+ -+ } -+} -+ -+void rtw_btcoex_parse_hci_cmd(_adapter *padapter, u8 *pcmd, u16 len) -+{ -+ u16 opcode = pcmd[0] | pcmd[1]<<8; -+ u16 hci_OGF = HCI_OGF(opcode); -+ u16 hci_OCF = HCI_OCF(opcode); -+ u8 cmdlen = len -3; -+ u8 pare_len = pcmd[2]; -+ -+ DBG_871X("%s OGF: %x,OCF: %x\n", __func__, hci_OGF, hci_OCF); -+ switch(hci_OGF) -+ { -+ case OGF_EXTENSION: -+ DBG_871X("HCI_EXTENSION_CMD_OGF\n"); -+ rtw_btcoex_parse_hci_extend_cmd(padapter, &pcmd[3], cmdlen, hci_OCF); -+ break; -+ default: -+ DBG_871X("Other OGF: %x\n",hci_OGF); -+ break; -+ } -+} -+ -+u16 rtw_btcoex_parse_recv_data(u8 *msg, u8 msg_size) -+{ -+ u8 cmp_msg1[32] = attend_ack; -+ u8 cmp_msg2[32] = leave_ack; -+ u8 cmp_msg3[32] = bt_leave; -+ u8 cmp_msg4[32] = invite_req; -+ u8 cmp_msg5[32] = attend_req; -+ u8 cmp_msg6[32] = invite_rsp; -+ u8 res = OTHER; -+ -+ if (_rtw_memcmp(cmp_msg1, msg, msg_size) == _TRUE) { -+ /*DBG_871X("%s, msg:%s\n",__func__,msg);*/ -+ res = RX_ATTEND_ACK; -+ } else if (_rtw_memcmp(cmp_msg2, msg, msg_size) == _TRUE) { -+ /*DBG_871X("%s, msg:%s\n",__func__,msg);*/ -+ res = RX_LEAVE_ACK; -+ } else if (_rtw_memcmp(cmp_msg3, msg, msg_size) == _TRUE) { -+ /*DBG_871X("%s, msg:%s\n",__func__,msg);*/ -+ res = RX_BT_LEAVE; -+ } else if (_rtw_memcmp(cmp_msg4, msg, msg_size) == _TRUE) { -+ /*DBG_871X("%s, msg:%s\n",__func__,msg);*/ -+ res = RX_INVITE_REQ; -+ } else if (_rtw_memcmp(cmp_msg5, msg, msg_size) == _TRUE) { -+ res = RX_ATTEND_REQ; -+ } else if (_rtw_memcmp(cmp_msg6, msg, msg_size) == _TRUE) { -+ res = RX_INVITE_RSP; -+ } else { -+ /*DBG_871X("%s, %s\n", __func__, msg);*/ -+ res = OTHER; -+ } -+ -+ /*DBG_871X("%s, res:%d\n", __func__, res);*/ -+ -+ return res; -+} -+ -+void rtw_btcoex_recvmsgbysocket(void *data) -+{ -+ u8 recv_data[255]; -+ u8 tx_msg[255] = leave_ack; -+ u32 len = 0; -+ u16 recv_length = 0; -+ u16 parse_res = 0; -+#if 0 -+ u8 para_len = 0, polling_enable = 0, poling_interval = 0, reason = 0, btinfo_len = 0; -+ u8 btinfo[BT_INFO_LEN] = {0}; -+#endif -+ -+ struct bt_coex_info *pcoex_info = NULL; -+ struct sock *sk = NULL; -+ struct sk_buff *skb = NULL; -+ -+ /*DBG_871X("%s\n",__func__);*/ -+ -+ if (pbtcoexadapter == NULL) { -+ DBG_871X("%s: btcoexadapter NULL!\n", __func__); -+ return; -+ } -+ -+ pcoex_info = &pbtcoexadapter->coex_info; -+ sk = pcoex_info->sk_store; -+ -+ if (sk == NULL) { -+ DBG_871X("%s: critical error when receive socket data!\n", __func__); -+ return; -+ } -+ -+ len = skb_queue_len(&sk->sk_receive_queue); -+ while (len > 0) { -+ skb = skb_dequeue(&sk->sk_receive_queue); -+ -+ /*important: cut the udp header from skb->data! header length is 8 byte*/ -+ recv_length = skb->len-8; -+ _rtw_memset(recv_data, 0, sizeof(recv_data)); -+ _rtw_memcpy(recv_data, skb->data+8, recv_length); -+ -+ parse_res = rtw_btcoex_parse_recv_data(recv_data, recv_length); -+/* -+ if (RX_ATTEND_ACK == parse_res) { -+ //attend ack -+ pcoex_info->BT_attend = _TRUE; -+ DBG_871X("RX_ATTEND_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ } else if (RX_ATTEND_REQ == parse_res) { -+ //attend req from BT -+ pcoex_info->BT_attend = _TRUE; -+ DBG_871X("RX_BT_ATTEND_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, attend_ack, sizeof(attend_ack), _FALSE); -+ } else if (RX_INVITE_REQ == parse_res) { -+ //invite req from BT -+ pcoex_info->BT_attend = _TRUE; -+ DBG_871X("RX_INVITE_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, invite_rsp, sizeof(invite_rsp), _FALSE); -+ } else if (RX_INVITE_RSP == parse_res) { -+ //invite rsp -+ pcoex_info->BT_attend = _TRUE; -+ DBG_871X("RX_INVITE_RSP!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ } else if (RX_LEAVE_ACK == parse_res) { -+ //mean BT know wifi will leave -+ pcoex_info->BT_attend = _FALSE; -+ DBG_871X("RX_LEAVE_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ } else if (RX_BT_LEAVE == parse_res) { -+ //BT leave -+ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, leave_ack, sizeof(leave_ack), _FALSE); // no ack -+ pcoex_info->BT_attend = _FALSE; -+ DBG_871X("RX_BT_LEAVE!sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ } else { -+ //todo: check if recv data are really hci cmds -+ if (_TRUE == pcoex_info->BT_attend) -+ rtw_btcoex_parse_hci_cmd(pbtcoexadapter, recv_data, recv_length); -+ } -+*/ -+ switch (parse_res) { -+ case RX_ATTEND_ACK: -+ /* attend ack */ -+ pcoex_info->BT_attend = _TRUE; -+ DBG_871X("RX_ATTEND_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_PTAOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); -+ break; -+ -+ case RX_ATTEND_REQ: -+ pcoex_info->BT_attend = _TRUE; -+ DBG_871X("RX_BT_ATTEND_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, attend_ack, sizeof(attend_ack), _FALSE); -+ rtw_btcoex_PTAOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); -+ break; -+ -+ case RX_INVITE_REQ: -+ /* invite req from BT */ -+ pcoex_info->BT_attend = _TRUE; -+ DBG_871X("RX_INVITE_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, invite_rsp, sizeof(invite_rsp), _FALSE); -+ rtw_btcoex_PTAOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); -+ break; -+ -+ case RX_INVITE_RSP: -+ /*invite rsp*/ -+ pcoex_info->BT_attend = _TRUE; -+ DBG_871X("RX_INVITE_RSP!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_PTAOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); -+ break; -+ -+ case RX_LEAVE_ACK: -+ /* mean BT know wifi will leave */ -+ pcoex_info->BT_attend = _FALSE; -+ DBG_871X("RX_LEAVE_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ #ifndef CONFIG_PCI_HCI -+ rtw_btcoex_PTAOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); -+ #endif -+ break; -+ -+ case RX_BT_LEAVE: -+ /* BT leave */ -+ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, leave_ack, sizeof(leave_ack), _FALSE); /* no ack */ -+ pcoex_info->BT_attend = _FALSE; -+ DBG_871X("RX_BT_LEAVE!sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_PTAOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); -+ break; -+ -+ default: -+ if (_TRUE == pcoex_info->BT_attend) -+ rtw_btcoex_parse_hci_cmd(pbtcoexadapter, recv_data, recv_length); -+ else -+ DBG_871X("ERROR!! BT is UP\n"); -+ break; -+ -+ } -+ -+ len--; -+ kfree_skb(skb); -+ } -+} -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0)) -+void rtw_btcoex_recvmsg_init(struct sock *sk_in, s32 bytes) -+#else -+void rtw_btcoex_recvmsg_init(struct sock *sk_in) -+#endif -+{ -+ struct bt_coex_info *pcoex_info = NULL; -+ -+ if (pbtcoexadapter == NULL) { -+ DBG_871X("%s: btcoexadapter NULL\n", __func__); -+ return; -+ } -+ pcoex_info = &pbtcoexadapter->coex_info; -+ pcoex_info->sk_store = sk_in; -+ if (pcoex_info->btcoex_wq != NULL) -+ queue_delayed_work(pcoex_info->btcoex_wq, &pcoex_info->recvmsg_work, 0); -+ else -+ DBG_871X("%s: BTCOEX workqueue NULL\n", __func__); -+} -+ -+u8 rtw_btcoex_sendmsgbysocket(_adapter *padapter, u8 *msg, u8 msg_size, bool force) -+{ -+ u8 error; -+ struct msghdr udpmsg; -+ mm_segment_t oldfs; -+ struct iovec iov; -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ -+ //DBG_871X("%s: msg:%s, force:%s\n", __func__, msg, force == _TRUE?"TRUE":"FALSE"); -+ if (_FALSE == force) { -+ if (_FALSE == pcoex_info->BT_attend) { -+ DBG_871X("TX Blocked: WiFi-BT disconnected\n"); -+ return _FAIL; -+ } -+ } -+ -+ iov.iov_base = (void *)msg; -+ iov.iov_len = msg_size; -+ udpmsg.msg_name = &pcoex_info->bt_sockaddr; -+ udpmsg.msg_namelen = sizeof(struct sockaddr_in); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+ /* referece:sock_xmit in kernel code -+ * WRITE for sock_sendmsg, READ for sock_recvmsg -+ * third parameter for msg_iovlen -+ * last parameter for iov_len -+ */ -+ iov_iter_init(&udpmsg.msg_iter, WRITE, &iov, 1, msg_size); -+#else -+ udpmsg.msg_iov = &iov; -+ udpmsg.msg_iovlen = 1; -+#endif -+ udpmsg.msg_control = NULL; -+ udpmsg.msg_controllen = 0; -+ udpmsg.msg_flags = MSG_DONTWAIT | MSG_NOSIGNAL; -+ oldfs = get_fs(); -+ set_fs(KERNEL_DS); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) -+ error = sock_sendmsg(pcoex_info->udpsock, &udpmsg); -+#else -+ error = sock_sendmsg(pcoex_info->udpsock, &udpmsg, msg_size); -+#endif -+ set_fs(oldfs); -+ if (error < 0) { -+ DBG_871X("Error when sendimg msg, error:%d\n", error); -+ return _FAIL; -+ } else -+ return _SUCCESS; -+} -+ -+u8 rtw_btcoex_create_kernel_socket(_adapter *padapter) -+{ -+ s8 kernel_socket_err; -+ u8 tx_msg[255] = attend_req; -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ s32 sock_reuse = 1; -+ u8 status = _FAIL; -+ -+ DBG_871X("%s CONNECT_PORT %d\n", __func__, CONNECT_PORT); -+ -+ if (NULL == pcoex_info) { -+ DBG_871X("coex_info: NULL\n"); -+ status = _FAIL; -+ } -+ -+ kernel_socket_err = sock_create(PF_INET, SOCK_DGRAM, 0, &pcoex_info->udpsock); -+ -+ if (kernel_socket_err < 0) { -+ DBG_871X("Error during creation of socket error:%d\n", kernel_socket_err); -+ status = _FAIL; -+ } else { -+ _rtw_memset(&(pcoex_info->wifi_sockaddr), 0, sizeof(pcoex_info->wifi_sockaddr)); -+ pcoex_info->wifi_sockaddr.sin_family = AF_INET; -+ pcoex_info->wifi_sockaddr.sin_port = htons(CONNECT_PORT); -+ pcoex_info->wifi_sockaddr.sin_addr.s_addr = htonl(INADDR_LOOPBACK); -+ -+ _rtw_memset(&(pcoex_info->bt_sockaddr), 0, sizeof(pcoex_info->bt_sockaddr)); -+ pcoex_info->bt_sockaddr.sin_family = AF_INET; -+ pcoex_info->bt_sockaddr.sin_port = htons(CONNECT_PORT_BT); -+ pcoex_info->bt_sockaddr.sin_addr.s_addr = htonl(INADDR_LOOPBACK); -+ -+ pcoex_info->sk_store = NULL; -+ kernel_socket_err = pcoex_info->udpsock->ops->bind(pcoex_info->udpsock, (struct sockaddr *)&pcoex_info->wifi_sockaddr, -+ sizeof(pcoex_info->wifi_sockaddr)); -+ if (kernel_socket_err == 0) { -+ DBG_871X("binding socket success\n"); -+ pcoex_info->udpsock->sk->sk_data_ready = rtw_btcoex_recvmsg_init; -+ pcoex_info->sock_open |= KERNEL_SOCKET_OK; -+ pcoex_info->BT_attend = _FALSE; -+ DBG_871X("WIFI sending attend_req\n"); -+ rtw_btcoex_sendmsgbysocket(padapter, attend_req, sizeof(attend_req), _TRUE); -+ status = _SUCCESS; -+ } else { -+ pcoex_info->BT_attend = _FALSE; -+ sock_release(pcoex_info->udpsock); /* bind fail release socket */ -+ DBG_871X("Error binding socket: %d\n", kernel_socket_err); -+ status = _FAIL; -+ } -+ -+ } -+ -+ return status; -+} -+ -+void rtw_btcoex_close_kernel_socket(_adapter *padapter) -+{ -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ if (pcoex_info->sock_open & KERNEL_SOCKET_OK) { -+ DBG_871X("release kernel socket\n"); -+ sock_release(pcoex_info->udpsock); -+ pcoex_info->sock_open &= ~(KERNEL_SOCKET_OK); -+ if (_TRUE == pcoex_info->BT_attend) -+ pcoex_info->BT_attend = _FALSE; -+ -+ DBG_871X("sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ } -+} -+ -+void rtw_btcoex_init_socket(_adapter *padapter) -+{ -+ -+ u8 is_invite = _FALSE; -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ DBG_871X("%s\n", __func__); -+ if (_FALSE == pcoex_info->is_exist) { -+ _rtw_memset(pcoex_info,0,sizeof(struct bt_coex_info)); -+ pcoex_info->btcoex_wq = create_workqueue("BTCOEX"); -+ INIT_DELAYED_WORK(&pcoex_info->recvmsg_work, -+ (void *)rtw_btcoex_recvmsgbysocket); -+ pbtcoexadapter = padapter; -+ /* We expect BT is off if BT don't send ack to wifi */ -+ DBG_871X("We expect BT is off if BT send ack to wifi\n"); -+ rtw_btcoex_PTAOffOnNotify(pbtcoexadapter, _FALSE); -+ #ifdef CONFIG_PCI_HCI -+ rtw_btcoex_PTAOffOnNotify(pbtcoexadapter, _TRUE); -+ #endif -+ if (rtw_btcoex_create_kernel_socket(padapter) == _SUCCESS) { -+ pcoex_info->is_exist = _TRUE; -+ } else { -+ pcoex_info->is_exist = _FALSE; -+ pbtcoexadapter = NULL; -+ } -+ -+ DBG_871X("%s: pbtcoexadapter:%p, coex_info->is_exist: %s\n" -+ , __func__, pbtcoexadapter, pcoex_info->is_exist == _TRUE?"TRUE":"FALSE"); -+ } -+} -+ -+void rtw_btcoex_close_socket(_adapter *padapter) -+{ -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ -+ DBG_871X("%s--coex_info->is_exist: %s, pcoex_info->BT_attend:%s\n" -+ , __func__, pcoex_info->is_exist == _TRUE?"TRUE":"FALSE", pcoex_info->BT_attend == _TRUE?"TRUE":"FALSE"); -+ -+ if (_TRUE == pcoex_info->is_exist) { -+ if (_TRUE == pcoex_info->BT_attend) { -+ /*inform BT wifi leave*/ -+ rtw_btcoex_sendmsgbysocket(padapter, wifi_leave, sizeof(wifi_leave), _FALSE); -+ msleep(50); -+ } -+ -+ if (pcoex_info->btcoex_wq != NULL) { -+ flush_workqueue(pcoex_info->btcoex_wq); -+ destroy_workqueue(pcoex_info->btcoex_wq); -+ } -+ -+ rtw_btcoex_close_kernel_socket(padapter); -+ pbtcoexadapter = NULL; -+ pcoex_info->is_exist = _FALSE; -+ } -+} -+ -+void rtw_btcoex_dump_tx_msg(u8 *tx_msg, u8 len, u8 *msg_name) -+{ -+ u8 i = 0; -+ DBG_871X("======> Msg name: %s\n", msg_name); -+ for(i=0;iEventCode = HCI_EVENT_EXTENSION_RTK; -+ pEvent->Data[0] = HCI_EVENT_EXT_BT_COEX_CONTROL; //extension event code -+ len ++; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ _rtw_memcpy(&pRetPar[0], pData, dataLen); -+ -+ len += dataLen; -+ -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+#if 0 -+ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, "BT COEX CONTROL", _FALSE); -+#endif -+ rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ -+} -+ -+/* Porting from Windows team */ -+void rtw_btcoex_SendEventExtBtInfoControl(PADAPTER padapter, u8 dataLen, void *pData) -+{ -+ rtw_HCI_event *pEvent; -+ u8 *pRetPar; -+ u8 len=0, tx_event_length = 0; -+ u8 localBuf[32] = ""; -+ -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; -+ -+ //DBG_871X("%s\n",__func__); -+ if(pBtMgnt->ExtConfig.HCIExtensionVer < 4) //not support -+ { -+ DBG_871X("ERROR: HCIExtensionVer = %d, HCIExtensionVer<4 !!!!\n",pBtMgnt->ExtConfig.HCIExtensionVer); -+ return; -+ } -+ -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ //len += bthci_ExtensionEventHeaderRtk(&localBuf[0], -+ // HCI_EVENT_EXT_BT_INFO_CONTROL); -+ pEvent->EventCode = HCI_EVENT_EXTENSION_RTK; -+ pEvent->Data[0] = HCI_EVENT_EXT_BT_INFO_CONTROL; //extension event code -+ len ++; -+ -+ // Return parameters starts from here -+ pRetPar = &pEvent->Data[len]; -+ _rtw_memcpy(&pRetPar[0], pData, dataLen); -+ -+ len += dataLen; -+ -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+#if 0 -+ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, "BT INFO CONTROL"); -+#endif -+ rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ -+} -+ -+void rtw_btcoex_SendScanNotify(PADAPTER padapter, u8 scanType) -+{ -+ u8 len=0, tx_event_length=0; -+ u8 localBuf[7] = ""; -+ u8 *pRetPar; -+ u8 *pu1Temp; -+ rtw_HCI_event *pEvent; -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; -+ -+// if(!pBtMgnt->BtOperationOn) -+// return; -+ -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+// len += bthci_ExtensionEventHeaderRtk(&localBuf[0], -+// HCI_EVENT_EXT_WIFI_SCAN_NOTIFY); -+ -+ pEvent->EventCode = HCI_EVENT_EXTENSION_RTK; -+ pEvent->Data[0] = HCI_EVENT_EXT_WIFI_SCAN_NOTIFY; //extension event code -+ len ++; -+ -+ // Return parameters starts from here -+ //pRetPar = &PPacketIrpEvent->Data[len]; -+ //pu1Temp = (u8 *)&pRetPar[0]; -+ //*pu1Temp = scanType; -+ pEvent->Data[len] = scanType; -+ len += 1; -+ -+ pEvent->Length = len; -+ -+ //total tx event length + EventCode length + sizeof(length) -+ tx_event_length = pEvent->Length + 2; -+#if 0 -+ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, "WIFI SCAN OPERATION"); -+#endif -+ rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+} -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+#endif // CONFIG_BT_COEXIST -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_bt_mp.c linux/3rdparty/rtl8812au/core/rtw_bt_mp.c ---- linux.old/3rdparty/rtl8812au/core/rtw_bt_mp.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_bt_mp.c 2017-06-07 23:07:20.998686391 +0300 -@@ -0,0 +1,1753 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#include -+#include -+ -+#if defined(CONFIG_RTL8723B) -+#include -+#endif -+ -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8821A) -+void MPh2c_timeout_handle(void *FunctionContext) -+{ -+ PADAPTER pAdapter; -+ PMPT_CONTEXT pMptCtx; -+ -+ -+ DBG_8192C("[MPT], MPh2c_timeout_handle \n"); -+ -+ pAdapter = (PADAPTER)FunctionContext; -+ pMptCtx = &pAdapter->mppriv.MptCtx; -+ -+ pMptCtx->bMPh2c_timeout = _TRUE; -+ -+ if ((_FALSE == pMptCtx->MptH2cRspEvent) -+ || ((_TRUE == pMptCtx->MptH2cRspEvent) -+ && (_FALSE == pMptCtx->MptBtC2hEvent))) -+ { -+ _rtw_up_sema(&pMptCtx->MPh2c_Sema); -+ } -+} -+ -+u32 WaitC2Hevent(PADAPTER pAdapter, u8 *C2H_event, u32 delay_time) -+{ -+ PMPT_CONTEXT pMptCtx=&(pAdapter->mppriv.MptCtx); -+ pMptCtx->bMPh2c_timeout=_FALSE; -+ -+ if( pAdapter->registrypriv.mp_mode == 0 ) -+ { -+ DBG_8192C("[MPT], Error!! WaitC2Hevent mp_mode == 0!!\n"); -+ return _FALSE; -+ } -+ -+ _set_timer( &pMptCtx->MPh2c_timeout_timer, delay_time ); -+ -+ _rtw_down_sema(&pMptCtx->MPh2c_Sema); -+ -+ if (pMptCtx->bMPh2c_timeout == _TRUE) -+ { -+ *C2H_event = _FALSE; -+ -+ return _FALSE; -+ } -+ -+ // for safty, cancel timer here again -+ _cancel_timer_ex(&pMptCtx->MPh2c_timeout_timer); -+ -+ return _TRUE; -+} -+ -+BT_CTRL_STATUS -+mptbt_CheckC2hFrame( -+ PADAPTER Adapter, -+ PBT_H2C pH2c, -+ PBT_EXT_C2H pExtC2h -+ ) -+{ -+ BT_CTRL_STATUS c2hStatus = BT_STATUS_C2H_SUCCESS; -+ -+ //DBG_8192C("[MPT], MPT rsp C2H hex: %x %x %x %x %x %x \n"), pExtC2h , pExtC2h+1 ,pExtC2h+2 ,pExtC2h+3 ,pExtC2h+4 ,pExtC2h+5); -+ -+ DBG_8192C("[MPT], statusCode = 0x%x\n", pExtC2h->statusCode); -+ DBG_8192C("[MPT], retLen = %d\n", pExtC2h->retLen); -+ DBG_8192C("[MPT], opCodeVer : req/rsp=%d/%d\n", pH2c->opCodeVer, pExtC2h->opCodeVer); -+ DBG_8192C("[MPT], reqNum : req/rsp=%d/%d\n", pH2c->reqNum, pExtC2h->reqNum); -+ if(pExtC2h->reqNum != pH2c->reqNum) -+ { -+ c2hStatus = BT_STATUS_C2H_REQNUM_MISMATCH; -+ DBG_8192C("[MPT], Error!! C2H reqNum Mismatch!!\n"); -+ } -+ else if(pExtC2h->opCodeVer != pH2c->opCodeVer) -+ { -+ c2hStatus = BT_STATUS_OPCODE_L_VERSION_MISMATCH; -+ DBG_8192C("[MPT], Error!! OPCode version L mismatch!!\n"); -+ } -+ -+ return c2hStatus; -+} -+ -+BT_CTRL_STATUS -+mptbt_SendH2c( -+ PADAPTER Adapter, -+ PBT_H2C pH2c, -+ u2Byte h2cCmdLen -+ ) -+{ -+ //KIRQL OldIrql = KeGetCurrentIrql(); -+ BT_CTRL_STATUS h2cStatus=BT_STATUS_H2C_SUCCESS; -+ PMPT_CONTEXT pMptCtx=&(Adapter->mppriv.MptCtx); -+ u1Byte i; -+ -+ DBG_8192C("[MPT], mptbt_SendH2c()=========>\n"); -+ -+ //PlatformResetEvent(&pMptCtx->MptH2cRspEvent); -+ //PlatformResetEvent(&pMptCtx->MptBtC2hEvent); -+ -+// if(OldIrql == PASSIVE_LEVEL) -+// { -+ //RTPRINT_DATA(FMPBT, FMPBT_H2C_CONTENT, ("[MPT], MPT H2C hex: \n"), pH2c, h2cCmdLen); -+ -+ for(i=0; iMptH2cRspEvent = _FALSE; -+ pMptCtx->MptBtC2hEvent = _FALSE; -+ -+#if defined(CONFIG_RTL8723B) -+ rtl8723b_set_FwBtMpOper_cmd(Adapter, pH2c->opCode, pH2c->opCodeVer, pH2c->reqNum, pH2c->buf); -+#endif -+ pMptCtx->h2cReqNum++; -+ pMptCtx->h2cReqNum %= 16; -+ -+ if(WaitC2Hevent(Adapter, &pMptCtx->MptH2cRspEvent, 100)) -+ { -+ DBG_8192C("[MPT], Received WiFi MptH2cRspEvent!!!\n"); -+ if(WaitC2Hevent(Adapter, &pMptCtx->MptBtC2hEvent, 400)) -+ { -+ DBG_8192C("[MPT], Received MptBtC2hEvent!!!\n"); -+ break; -+ } -+ else -+ { -+ DBG_8192C("[MPT], Error!!BT MptBtC2hEvent timeout!!\n"); -+ h2cStatus = BT_STATUS_H2C_BT_NO_RSP; -+ } -+ } -+ else -+ { -+ DBG_8192C("[MPT], Error!!WiFi MptH2cRspEvent timeout!!\n"); -+ h2cStatus = BT_STATUS_H2C_TIMTOUT; -+ } -+ } -+// } -+// else -+// { -+// RT_ASSERT(FALSE, ("[MPT], mptbt_SendH2c() can only run under PASSIVE_LEVEL!!\n")); -+// h2cStatus = BT_STATUS_WRONG_LEVEL; -+// } -+ -+ DBG_8192C("[MPT], mptbt_SendH2c()<=========\n"); -+ return h2cStatus; -+} -+ -+ -+ -+BT_CTRL_STATUS -+mptbt_CheckBtRspStatus( -+ PADAPTER Adapter, -+ PBT_EXT_C2H pExtC2h -+ ) -+{ -+ BT_CTRL_STATUS retStatus=BT_OP_STATUS_SUCCESS; -+ -+ switch(pExtC2h->statusCode) -+ { -+ case BT_OP_STATUS_SUCCESS: -+ retStatus = BT_STATUS_BT_OP_SUCCESS; -+ DBG_8192C("[MPT], BT status : BT_STATUS_SUCCESS\n"); -+ break; -+ case BT_OP_STATUS_VERSION_MISMATCH: -+ retStatus = BT_STATUS_OPCODE_L_VERSION_MISMATCH; -+ DBG_8192C("[MPT], BT status : BT_STATUS_OPCODE_L_VERSION_MISMATCH\n"); -+ break; -+ case BT_OP_STATUS_UNKNOWN_OPCODE: -+ retStatus = BT_STATUS_UNKNOWN_OPCODE_L; -+ DBG_8192C("[MPT], BT status : BT_STATUS_UNKNOWN_OPCODE_L\n"); -+ break; -+ case BT_OP_STATUS_ERROR_PARAMETER: -+ retStatus = BT_STATUS_PARAMETER_FORMAT_ERROR_L; -+ DBG_8192C("[MPT], BT status : BT_STATUS_PARAMETER_FORMAT_ERROR_L\n"); -+ break; -+ default: -+ retStatus = BT_STATUS_UNKNOWN_STATUS_L; -+ DBG_8192C("[MPT], BT status : BT_STATUS_UNKNOWN_STATUS_L\n"); -+ break; -+ } -+ -+ return retStatus; -+} -+ -+ -+ -+BT_CTRL_STATUS -+mptbt_BtFwOpCodeProcess( -+ PADAPTER Adapter, -+ u1Byte btFwOpCode, -+ u1Byte opCodeVer, -+ pu1Byte pH2cPar, -+ u1Byte h2cParaLen -+ ) -+{ -+ u1Byte H2C_Parameter[6] ={0}; -+ PBT_H2C pH2c=(PBT_H2C)&H2C_Parameter[0]; -+ PMPT_CONTEXT pMptCtx=&(Adapter->mppriv.MptCtx); -+ PBT_EXT_C2H pExtC2h=(PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; -+ u2Byte paraLen=0,i; -+ BT_CTRL_STATUS h2cStatus=BT_STATUS_H2C_SUCCESS, c2hStatus=BT_STATUS_C2H_SUCCESS; -+ BT_CTRL_STATUS retStatus=BT_STATUS_H2C_BT_NO_RSP; -+ -+ if( Adapter->registrypriv.mp_mode == 0 ) -+ { -+ DBG_8192C("[MPT], Error!! mptbt_BtFwOpCodeProces mp_mode == 0!!\n"); -+ return _FALSE; -+ } -+ -+ pH2c->opCode = btFwOpCode; -+ pH2c->opCodeVer = opCodeVer; -+ pH2c->reqNum = pMptCtx->h2cReqNum; -+ //PlatformMoveMemory(&pH2c->buf[0], pH2cPar, h2cParaLen); -+ //_rtw_memcpy(&pH2c->buf[0], pH2cPar, h2cParaLen); -+ _rtw_memcpy(pH2c->buf, pH2cPar, h2cParaLen); -+ -+ DBG_8192C("[MPT], pH2c->opCode=%d\n", pH2c->opCode); -+ DBG_8192C("[MPT], pH2c->opCodeVer=%d\n", pH2c->opCodeVer); -+ DBG_8192C("[MPT], pH2c->reqNum=%d\n", pH2c->reqNum); -+ DBG_8192C("[MPT], h2c parameter length=%d\n", h2cParaLen); -+ for (i=0; ibuf[i]); -+ } -+ -+ h2cStatus = mptbt_SendH2c(Adapter, pH2c, h2cParaLen+2); -+ if(BT_STATUS_H2C_SUCCESS == h2cStatus) -+ { -+ // if reach here, it means H2C get the correct c2h response, -+ c2hStatus = mptbt_CheckC2hFrame(Adapter, pH2c, pExtC2h); -+ if(BT_STATUS_C2H_SUCCESS == c2hStatus) -+ { -+ retStatus = mptbt_CheckBtRspStatus(Adapter, pExtC2h); -+ } -+ else -+ { -+ DBG_8192C("[MPT], Error!! C2H failed for pH2c->opCode=%d\n", pH2c->opCode); -+ // check c2h status error, return error status code to upper layer. -+ retStatus = c2hStatus; -+ } -+ } -+ else -+ { -+ DBG_8192C("[MPT], Error!! H2C failed for pH2c->opCode=%d\n", pH2c->opCode); -+ // check h2c status error, return error status code to upper layer. -+ retStatus = h2cStatus; -+ } -+ -+ return retStatus; -+} -+ -+ -+ -+ -+u2Byte -+mptbt_BtReady( -+ PADAPTER Adapter, -+ PBT_REQ_CMD pBtReq, -+ PBT_RSP_CMD pBtRsp -+ ) -+{ -+ u1Byte h2cParaBuf[6] ={0}; -+ u1Byte h2cParaLen=0; -+ u2Byte paraLen=0; -+ u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode; -+ u1Byte btOpcodeVer=0; -+ PMPT_CONTEXT pMptCtx=&(Adapter->mppriv.MptCtx); -+ PBT_EXT_C2H pExtC2h=(PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; -+ u1Byte i; -+ u1Byte btFwVer=0, bdAddr[6]={0}; -+ u2Byte btRealFwVer=0; -+ pu2Byte pu2Tmp=NULL; -+ -+ // -+ // check upper layer parameters -+ // -+ -+ // 1. check upper layer opcode version -+ if(pBtReq->opCodeVer != 1) -+ { -+ DBG_8192C("[MPT], Error!! Upper OP code version not match!!!\n"); -+ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; -+ return paraLen; -+ } -+ -+ pBtRsp->pParamStart[0] = MP_BT_NOT_READY; -+ paraLen = 10; -+ // -+ // execute lower layer opcodes -+ // -+ -+ // Get BT FW version -+ // fill h2c parameters -+ btOpcode = BT_LO_OP_GET_BT_VERSION; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ else -+ { -+ pu2Tmp = (pu2Byte)&pExtC2h->buf[0]; -+ btRealFwVer = *pu2Tmp; -+ btFwVer = pExtC2h->buf[1]; -+ DBG_8192C("[MPT], btRealFwVer=0x%x, btFwVer=0x%x\n", btRealFwVer, btFwVer); -+ } -+ -+ // Get BD Address -+ // fill h2c parameters -+ btOpcode = BT_LO_OP_GET_BD_ADDR_L; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ else -+ { -+ bdAddr[5] = pExtC2h->buf[0]; -+ bdAddr[4] = pExtC2h->buf[1]; -+ bdAddr[3] = pExtC2h->buf[2]; -+ } -+ -+ // fill h2c parameters -+ btOpcode = BT_LO_OP_GET_BD_ADDR_H; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ else -+ { -+ bdAddr[2] = pExtC2h->buf[0]; -+ bdAddr[1] = pExtC2h->buf[1]; -+ bdAddr[0] = pExtC2h->buf[2]; -+ } -+ DBG_8192C("[MPT], Local BDAddr:"); -+ for(i=0; i<6; i++) -+ { -+ DBG_8192C(" 0x%x ", bdAddr[i]); -+ } -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ pBtRsp->pParamStart[0] = MP_BT_READY; -+ pu2Tmp = (pu2Byte)&pBtRsp->pParamStart[1]; -+ *pu2Tmp = btRealFwVer; -+ pBtRsp->pParamStart[3] = btFwVer; -+ for(i=0; i<6; i++) -+ { -+ pBtRsp->pParamStart[4+i] = bdAddr[5-i]; -+ } -+ -+ return paraLen; -+} -+ -+void mptbt_close_WiFiRF(PADAPTER Adapter) -+{ -+ PHY_SetBBReg(Adapter, 0x824, 0xF, 0x0); -+ PHY_SetBBReg(Adapter, 0x824, 0x700000, 0x0); -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x0); -+} -+ -+void mptbt_open_WiFiRF(PADAPTER Adapter) -+{ -+ PHY_SetBBReg(Adapter, 0x824, 0x700000, 0x3); -+ PHY_SetBBReg(Adapter, 0x824, 0xF, 0x2); -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x3); -+} -+ -+u4Byte mptbt_switch_RF(PADAPTER Adapter, u1Byte Enter) -+{ -+ u2Byte tmp_2byte = 0; -+ -+ //Enter test mode -+ if (Enter) { -+ ////1>. close WiFi RF -+ mptbt_close_WiFiRF(Adapter); -+ -+ ////2>. change ant switch to BT -+ tmp_2byte = rtw_read16(Adapter, 0x860); -+ tmp_2byte = tmp_2byte | BIT(9); -+ tmp_2byte = tmp_2byte & (~BIT(8)); -+ rtw_write16(Adapter, 0x860, tmp_2byte); -+ rtw_write16(Adapter, 0x870, 0x300); -+ } else { -+ ////1>. Open WiFi RF -+ mptbt_open_WiFiRF(Adapter); -+ -+ ////2>. change ant switch back -+ tmp_2byte = rtw_read16(Adapter, 0x860); -+ tmp_2byte = tmp_2byte | BIT(8); -+ tmp_2byte = tmp_2byte & (~BIT(9)); -+ rtw_write16(Adapter, 0x860, tmp_2byte); -+ rtw_write16(Adapter, 0x870, 0x300); -+ } -+ -+ return 0; -+} -+ -+u2Byte -+mptbt_BtSetMode( -+ PADAPTER Adapter, -+ PBT_REQ_CMD pBtReq, -+ PBT_RSP_CMD pBtRsp -+ ) -+{ -+ u1Byte h2cParaBuf[6] ={0}; -+ u1Byte h2cParaLen=0; -+ u2Byte paraLen=0; -+ u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode; -+ u1Byte btOpcodeVer=0; -+ u1Byte btModeToSet=0; -+ -+ // -+ // check upper layer parameters -+ // -+ // 1. check upper layer opcode version -+ if(pBtReq->opCodeVer != 1) -+ { -+ DBG_8192C("[MPT], Error!! Upper OP code version not match!!!\n"); -+ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; -+ return paraLen; -+ } -+ // 2. check upper layer parameter length -+ if(1 == pBtReq->paraLength) -+ { -+ btModeToSet = pBtReq->pParamStart[0]; -+ DBG_8192C("[MPT], BtTestMode=%d \n", btModeToSet); -+ } -+ else -+ { -+ DBG_8192C("[MPT], Error!! wrong parameter length=%d (should be 1)\n", pBtReq->paraLength); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ -+ // -+ // execute lower layer opcodes -+ // -+ -+ // 1. fill h2c parameters -+ // check bt mode -+ btOpcode = BT_LO_OP_SET_BT_MODE; -+ if(btModeToSet >= MP_BT_MODE_MAX) -+ { -+ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ else -+ { -+ mptbt_switch_RF(Adapter, 1); -+ -+ h2cParaBuf[0] = btModeToSet; -+ h2cParaLen = 1; -+ // 2. execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ // 3. construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS == retStatus) -+ { -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ } -+ else -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ } -+ -+ return paraLen; -+} -+ -+ -+VOID -+MPTBT_FwC2hBtMpCtrl( -+ PADAPTER Adapter, -+ pu1Byte tmpBuf, -+ u1Byte length -+ ) -+{ -+ u32 i; -+ PMPT_CONTEXT pMptCtx=&(Adapter->mppriv.MptCtx); -+ PBT_EXT_C2H pExtC2h=(PBT_EXT_C2H)tmpBuf; -+ -+ if(Adapter->bBTFWReady == _FALSE || Adapter->registrypriv.mp_mode == 0 ) -+ { -+ //DBG_8192C("Ignore C2H BT MP Info since not in MP mode \n"); -+ return; -+ } -+ if( length > 32 || length < 3 ) -+ { -+ DBG_8192C("\n [MPT], pExtC2h->buf hex: length=%d > 32 || < 3\n",length); -+ return; -+ } -+ -+ //cancel_timeout for h2c handle -+ _cancel_timer_ex(&pMptCtx->MPh2c_timeout_timer); -+ -+ for (i=0; iextendId=0x%x\n", pExtC2h->extendId); -+ -+ switch(pExtC2h->extendId) -+ { -+ case EXT_C2H_WIFI_FW_ACTIVE_RSP: -+ DBG_8192C("[MPT], EXT_C2H_WIFI_FW_ACTIVE_RSP\n"); -+#if 0 -+ DBG_8192C("[MPT], pExtC2h->buf hex: \n"); -+ for (i=0; i<(length-3); i++) -+ { -+ DBG_8192C(" 0x%x ", pExtC2h->buf[i]); -+ } -+#endif -+ if ((_FALSE == pMptCtx->bMPh2c_timeout) -+ && (_FALSE == pMptCtx->MptH2cRspEvent)) -+ { -+ pMptCtx->MptH2cRspEvent = _TRUE; -+ _rtw_up_sema(&pMptCtx->MPh2c_Sema); -+ } -+ break; -+ -+ case EXT_C2H_TRIG_BY_BT_FW: -+ DBG_8192C("[MPT], EXT_C2H_TRIG_BY_BT_FW\n"); -+ _rtw_memcpy(&pMptCtx->c2hBuf[0], tmpBuf, length); -+ DBG_8192C("[MPT], pExtC2h->statusCode=0x%x\n", pExtC2h->statusCode); -+ DBG_8192C("[MPT], pExtC2h->retLen=0x%x\n", pExtC2h->retLen); -+ DBG_8192C("[MPT], pExtC2h->opCodeVer=0x%x\n", pExtC2h->opCodeVer); -+ DBG_8192C("[MPT], pExtC2h->reqNum=0x%x\n", pExtC2h->reqNum); -+ for (i=0; i<(length-3); i++) -+ { -+ DBG_8192C("[MPT], pExtC2h->buf[%d]=0x%02x\n", i, pExtC2h->buf[i]); -+ } -+ -+ if ((_FALSE == pMptCtx->bMPh2c_timeout) -+ && (_TRUE == pMptCtx->MptH2cRspEvent) -+ && (_FALSE == pMptCtx->MptBtC2hEvent)) -+ { -+ pMptCtx->MptBtC2hEvent = _TRUE; -+ _rtw_up_sema(&pMptCtx->MPh2c_Sema); -+ } -+ break; -+ -+ default: -+ DBG_8192C("[MPT], EXT_C2H Target not found,pExtC2h->extendId =%d ,pExtC2h->reqNum=%d\n",pExtC2h->extendId,pExtC2h->reqNum); -+ break; -+ } -+ -+ -+ -+} -+ -+ -+u2Byte -+mptbt_BtGetGeneral( -+ IN PADAPTER Adapter, -+ IN PBT_REQ_CMD pBtReq, -+ IN PBT_RSP_CMD pBtRsp -+ ) -+{ -+ PMPT_CONTEXT pMptCtx=&(Adapter->mppriv.MptCtx); -+ PBT_EXT_C2H pExtC2h=(PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; -+ u1Byte h2cParaBuf[6] ={0}; -+ u1Byte h2cParaLen=0; -+ u2Byte paraLen=0; -+ u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode, bdAddr[6]={0}; -+ u1Byte btOpcodeVer=0; -+ u1Byte getType=0, i; -+ u2Byte getParaLen=0, validParaLen=0; -+ u1Byte regType=0, reportType=0; -+ u4Byte regAddr=0, regValue=0; -+ pu4Byte pu4Tmp; -+ pu2Byte pu2Tmp; -+ pu1Byte pu1Tmp; -+ -+ // -+ // check upper layer parameters -+ // -+ -+ // check upper layer opcode version -+ if(pBtReq->opCodeVer != 1) -+ { -+ DBG_8192C("[MPT], Error!! Upper OP code version not match!!!\n"); -+ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; -+ return paraLen; -+ } -+ // check upper layer parameter length -+ if(pBtReq->paraLength < 1) -+ { -+ DBG_8192C("[MPT], Error!! wrong parameter length=%d (should larger than 1)\n", pBtReq->paraLength); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ getParaLen = pBtReq->paraLength - 1; -+ getType = pBtReq->pParamStart[0]; -+ -+ DBG_8192C("[MPT], getType=%d, getParaLen=%d\n", getType, getParaLen); -+ -+ // check parameter first -+ switch(getType) -+ { -+ case BT_GGET_REG: -+ DBG_8192C("[MPT], [BT_GGET_REG]\n"); -+ validParaLen = 5; -+ if(getParaLen == validParaLen) -+ { -+ btOpcode = BT_LO_OP_READ_REG; -+ regType = pBtReq->pParamStart[1]; -+ pu4Tmp = (pu4Byte)&pBtReq->pParamStart[2]; -+ regAddr = *pu4Tmp; -+ DBG_8192C("[MPT], BT_GGET_REG regType=0x%02x, regAddr=0x%08x!!\n", -+ regType, regAddr); -+ if(regType >= BT_REG_MAX) -+ { -+ pBtRsp->status = (btOpcode<<8)| BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ else -+ { -+ if( ((BT_REG_RF==regType)&&(regAddr>0x7f)) || -+ ((BT_REG_MODEM==regType)&&(regAddr>0x1ff)) || -+ ((BT_REG_BLUEWIZE==regType)&&(regAddr>0xfff)) || -+ ((BT_REG_VENDOR==regType)&&(regAddr>0xfff)) || -+ ((BT_REG_LE==regType)&&(regAddr>0xfff)) ) -+ { -+ pBtRsp->status = (btOpcode<<8)| BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ } -+ } -+ break; -+ case BT_GGET_STATUS: -+ DBG_8192C("[MPT], [BT_GGET_STATUS]\n"); -+ validParaLen = 0; -+ break; -+ case BT_GGET_REPORT: -+ DBG_8192C("[MPT], [BT_GGET_REPORT]\n"); -+ validParaLen = 1; -+ if(getParaLen == validParaLen) -+ { -+ reportType = pBtReq->pParamStart[1]; -+ DBG_8192C("[MPT], BT_GGET_REPORT reportType=0x%x!!\n", reportType); -+ if(reportType >= BT_REPORT_MAX) -+ { -+ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ } -+ break; -+ default: -+ { -+ DBG_8192C("[MPT], Error!! getType=%d, out of range\n", getType); -+ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ break; -+ } -+ if(getParaLen != validParaLen) -+ { -+ DBG_8192C("[MPT], Error!! wrong parameter length=%d for BT_GET_GEN_CMD cmd id=0x%x, paraLen should=0x%x\n", -+ getParaLen, getType, validParaLen); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ -+ // -+ // execute lower layer opcodes -+ // -+ if(BT_GGET_REG == getType) -+ { -+ // fill h2c parameters -+ // here we should write reg value first then write the address, adviced by Austin -+ btOpcode = BT_LO_OP_READ_REG; -+ h2cParaBuf[0] = regType; -+ h2cParaBuf[1] = pBtReq->pParamStart[2]; -+ h2cParaBuf[2] = pBtReq->pParamStart[3]; -+ h2cParaLen = 3; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ pu2Tmp = (pu2Byte)&pExtC2h->buf[0]; -+ regValue = *pu2Tmp; -+ DBG_8192C("[MPT], read reg regType=0x%02x, regAddr=0x%08x, regValue=0x%04x\n", -+ regType, regAddr, regValue); -+ -+ pu4Tmp = (pu4Byte)&pBtRsp->pParamStart[0]; -+ *pu4Tmp = regValue; -+ paraLen = 4; -+ } -+ else if(BT_GGET_STATUS == getType) -+ { -+ btOpcode = BT_LO_OP_GET_BT_STATUS; -+ h2cParaLen = 0; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; -+ DBG_8192C("[MPT], read bt status, testMode=0x%x, testStatus=0x%x\n", -+ pBtRsp->pParamStart[0], pBtRsp->pParamStart[1]); -+ paraLen = 2; -+ } -+ else if(BT_GGET_REPORT == getType) -+ { -+ switch(reportType) -+ { -+ case BT_REPORT_RX_PACKET_CNT: -+ { -+ DBG_8192C("[MPT], [Rx Packet Counts]\n"); -+ btOpcode = BT_LO_OP_GET_RX_PKT_CNT_L; -+ h2cParaLen = 0; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; -+ -+ btOpcode = BT_LO_OP_GET_RX_PKT_CNT_H; -+ h2cParaLen = 0; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[2] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[3] = pExtC2h->buf[1]; -+ paraLen = 4; -+ } -+ break; -+ case BT_REPORT_RX_ERROR_BITS: -+ { -+ DBG_8192C("[MPT], [Rx Error Bits]\n"); -+ btOpcode = BT_LO_OP_GET_RX_ERROR_BITS_L; -+ h2cParaLen = 0; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; -+ -+ btOpcode = BT_LO_OP_GET_RX_ERROR_BITS_H; -+ h2cParaLen = 0; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[2] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[3] = pExtC2h->buf[1]; -+ paraLen = 4; -+ } -+ break; -+ case BT_REPORT_RSSI: -+ { -+ DBG_8192C("[MPT], [RSSI]\n"); -+ btOpcode = BT_LO_OP_GET_RSSI; -+ h2cParaLen = 0; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; -+ paraLen = 2; -+ } -+ break; -+ case BT_REPORT_CFO_HDR_QUALITY: -+ { -+ DBG_8192C("[MPT], [CFO & Header Quality]\n"); -+ btOpcode = BT_LO_OP_GET_CFO_HDR_QUALITY_L; -+ h2cParaLen = 0; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; -+ -+ btOpcode = BT_LO_OP_GET_CFO_HDR_QUALITY_H; -+ h2cParaLen = 0; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[2] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[3] = pExtC2h->buf[1]; -+ paraLen = 4; -+ } -+ break; -+ case BT_REPORT_CONNECT_TARGET_BD_ADDR: -+ { -+ DBG_8192C("[MPT], [Connected Target BD ADDR]\n"); -+ btOpcode = BT_LO_OP_GET_TARGET_BD_ADDR_L; -+ h2cParaLen = 0; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ bdAddr[5] = pExtC2h->buf[0]; -+ bdAddr[4] = pExtC2h->buf[1]; -+ bdAddr[3] = pExtC2h->buf[2]; -+ -+ btOpcode = BT_LO_OP_GET_TARGET_BD_ADDR_H; -+ h2cParaLen = 0; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ bdAddr[2] = pExtC2h->buf[0]; -+ bdAddr[1] = pExtC2h->buf[1]; -+ bdAddr[0] = pExtC2h->buf[2]; -+ -+ DBG_8192C("[MPT], Connected Target BDAddr:%s", bdAddr); -+ for(i=0; i<6; i++) -+ { -+ pBtRsp->pParamStart[i] = bdAddr[5-i]; -+ } -+ paraLen = 6; -+ } -+ break; -+ default: -+ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ break; -+ } -+ } -+ -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ return paraLen; -+} -+ -+ -+ -+u2Byte -+mptbt_BtSetGeneral( -+ IN PADAPTER Adapter, -+ IN PBT_REQ_CMD pBtReq, -+ IN PBT_RSP_CMD pBtRsp -+ ) -+{ -+ u1Byte h2cParaBuf[6] ={0}; -+ u1Byte h2cParaLen=0; -+ u2Byte paraLen=0; -+ u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode; -+ u1Byte btOpcodeVer=0; -+ u1Byte setType=0; -+ u2Byte setParaLen=0, validParaLen=0; -+ u1Byte regType=0, bdAddr[6]={0}, calVal=0; -+ u4Byte regAddr=0, regValue=0; -+ pu4Byte pu4Tmp; -+ pu2Byte pu2Tmp; -+ pu1Byte pu1Tmp; -+ -+ // -+ // check upper layer parameters -+ // -+ -+ // check upper layer opcode version -+ if(pBtReq->opCodeVer != 1) -+ { -+ DBG_8192C("[MPT], Error!! Upper OP code version not match!!!\n"); -+ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; -+ return paraLen; -+ } -+ // check upper layer parameter length -+ if(pBtReq->paraLength < 1) -+ { -+ DBG_8192C("[MPT], Error!! wrong parameter length=%d (should larger than 1)\n", pBtReq->paraLength); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ setParaLen = pBtReq->paraLength - 1; -+ setType = pBtReq->pParamStart[0]; -+ -+ DBG_8192C("[MPT], setType=%d, setParaLen=%d\n", setType, setParaLen); -+ -+ // check parameter first -+ switch(setType) -+ { -+ case BT_GSET_REG: -+ DBG_8192C ("[MPT], [BT_GSET_REG]\n"); -+ validParaLen = 9; -+ if(setParaLen == validParaLen) -+ { -+ btOpcode = BT_LO_OP_WRITE_REG_VALUE; -+ regType = pBtReq->pParamStart[1]; -+ pu4Tmp = (pu4Byte)&pBtReq->pParamStart[2]; -+ regAddr = *pu4Tmp; -+ pu4Tmp = (pu4Byte)&pBtReq->pParamStart[6]; -+ regValue = *pu4Tmp; -+ DBG_8192C("[MPT], BT_GSET_REG regType=0x%x, regAddr=0x%x, regValue=0x%x!!\n", -+ regType, regAddr, regValue); -+ if(regType >= BT_REG_MAX) -+ { -+ pBtRsp->status = (btOpcode<<8)| BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ else -+ { -+ if( ((BT_REG_RF==regType)&&(regAddr>0x7f)) || -+ ((BT_REG_MODEM==regType)&&(regAddr>0x1ff)) || -+ ((BT_REG_BLUEWIZE==regType)&&(regAddr>0xfff)) || -+ ((BT_REG_VENDOR==regType)&&(regAddr>0xfff)) || -+ ((BT_REG_LE==regType)&&(regAddr>0xfff)) ) -+ { -+ pBtRsp->status = (btOpcode<<8)| BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ } -+ } -+ break; -+ case BT_GSET_RESET: -+ DBG_8192C("[MPT], [BT_GSET_RESET]\n"); -+ validParaLen = 0; -+ break; -+ case BT_GSET_TARGET_BD_ADDR: -+ DBG_8192C("[MPT], [BT_GSET_TARGET_BD_ADDR]\n"); -+ validParaLen = 6; -+ if(setParaLen == validParaLen) -+ { -+ btOpcode = BT_LO_OP_SET_TARGET_BD_ADDR_H; -+ if( (pBtReq->pParamStart[1]==0) && -+ (pBtReq->pParamStart[2]==0) && -+ (pBtReq->pParamStart[3]==0) && -+ (pBtReq->pParamStart[4]==0) && -+ (pBtReq->pParamStart[5]==0) && -+ (pBtReq->pParamStart[6]==0) ) -+ { -+ DBG_8192C("[MPT], Error!! targetBDAddr=all zero\n"); -+ pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ if( (pBtReq->pParamStart[1]==0xff) && -+ (pBtReq->pParamStart[2]==0xff) && -+ (pBtReq->pParamStart[3]==0xff) && -+ (pBtReq->pParamStart[4]==0xff) && -+ (pBtReq->pParamStart[5]==0xff) && -+ (pBtReq->pParamStart[6]==0xff) ) -+ { -+ DBG_8192C("[MPT], Error!! targetBDAddr=all 0xf\n"); -+ pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ bdAddr[0] = pBtReq->pParamStart[6]; -+ bdAddr[1] = pBtReq->pParamStart[5]; -+ bdAddr[2] = pBtReq->pParamStart[4]; -+ bdAddr[3] = pBtReq->pParamStart[3]; -+ bdAddr[4] = pBtReq->pParamStart[2]; -+ bdAddr[5] = pBtReq->pParamStart[1]; -+ DBG_8192C ("[MPT], target BDAddr:%x,%x,%x,%x,%x,%x\n", -+ bdAddr[0],bdAddr[1],bdAddr[2],bdAddr[3],bdAddr[4],bdAddr[5]); -+ } -+ break; -+ case BT_GSET_TX_PWR_FINETUNE: -+ DBG_8192C("[MPT], [BT_GSET_TX_PWR_FINETUNE]\n"); -+ validParaLen = 1; -+ if(setParaLen == validParaLen) -+ { -+ btOpcode = BT_LO_OP_SET_TX_POWER_CALIBRATION; -+ calVal = pBtReq->pParamStart[1]; -+ if( (calVal<1) || (calVal>9) ) -+ { -+ pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ DBG_8192C ("[MPT], calVal=%d\n", calVal); -+ } -+ break; -+ case BT_SET_TRACKING_INTERVAL: -+ DBG_871X("[MPT], [BT_SET_TRACKING_INTERVAL] setParaLen =%d \n",setParaLen); -+ -+ validParaLen = 1; -+ if(setParaLen == validParaLen) -+ calVal = pBtReq->pParamStart[1]; -+ break; -+ case BT_SET_THERMAL_METER: -+ DBG_871X("[MPT], [BT_SET_THERMAL_METER] setParaLen =%d \n",setParaLen); -+ validParaLen = 1; -+ if(setParaLen == validParaLen) -+ calVal = pBtReq->pParamStart[1]; -+ break; -+ case BT_ENABLE_CFO_TRACKING: -+ DBG_871X("[MPT], [BT_ENABLE_CFO_TRACKING] setParaLen =%d \n",setParaLen); -+ validParaLen = 1; -+ if(setParaLen == validParaLen) -+ calVal = pBtReq->pParamStart[1]; -+ break; -+ case BT_GSET_UPDATE_BT_PATCH: -+ -+ break; -+ default: -+ { -+ DBG_8192C ("[MPT], Error!! setType=%d, out of range\n", setType); -+ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ break; -+ } -+ if(setParaLen != validParaLen) -+ { -+ DBG_8192C("[MPT], Error!! wrong parameter length=%d for BT_SET_GEN_CMD cmd id=0x%x, paraLen should=0x%x\n", -+ setParaLen, setType, validParaLen); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ -+ // -+ // execute lower layer opcodes -+ // -+ if(BT_GSET_REG == setType) -+ { -+ // fill h2c parameters -+ // here we should write reg value first then write the address, adviced by Austin -+ btOpcode = BT_LO_OP_WRITE_REG_VALUE; -+ h2cParaBuf[0] = pBtReq->pParamStart[6]; -+ h2cParaBuf[1] = pBtReq->pParamStart[7]; -+ h2cParaBuf[2] = pBtReq->pParamStart[8]; -+ h2cParaLen = 3; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ // write reg address -+ btOpcode = BT_LO_OP_WRITE_REG_ADDR; -+ h2cParaBuf[0] = regType; -+ h2cParaBuf[1] = pBtReq->pParamStart[2]; -+ h2cParaBuf[2] = pBtReq->pParamStart[3]; -+ h2cParaLen = 3; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ } -+ else if(BT_GSET_RESET == setType) -+ { -+ btOpcode = BT_LO_OP_RESET; -+ h2cParaLen = 0; -+ // execute h2c and check respond c2h from bt fw is correct or not -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ } -+ else if(BT_GSET_TARGET_BD_ADDR == setType) -+ { -+ // fill h2c parameters -+ btOpcode = BT_LO_OP_SET_TARGET_BD_ADDR_L; -+ h2cParaBuf[0] = pBtReq->pParamStart[1]; -+ h2cParaBuf[1] = pBtReq->pParamStart[2]; -+ h2cParaBuf[2] = pBtReq->pParamStart[3]; -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ btOpcode = BT_LO_OP_SET_TARGET_BD_ADDR_H; -+ h2cParaBuf[0] = pBtReq->pParamStart[4]; -+ h2cParaBuf[1] = pBtReq->pParamStart[5]; -+ h2cParaBuf[2] = pBtReq->pParamStart[6]; -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ } -+ else if(BT_GSET_TX_PWR_FINETUNE == setType) -+ { -+ // fill h2c parameters -+ btOpcode = BT_LO_OP_SET_TX_POWER_CALIBRATION; -+ h2cParaBuf[0] = calVal; -+ h2cParaLen = 1; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ } -+ else if(BT_SET_TRACKING_INTERVAL == setType) -+ { -+ // BT_LO_OP_SET_TRACKING_INTERVAL = 0x22, -+ // BT_LO_OP_SET_THERMAL_METER = 0x23, -+ // BT_LO_OP_ENABLE_CFO_TRACKING = 0x24, -+ btOpcode = BT_LO_OP_SET_TRACKING_INTERVAL; -+ h2cParaBuf[0] = calVal; -+ h2cParaLen = 1; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ } -+ else if(BT_SET_THERMAL_METER == setType) -+ { -+ btOpcode = BT_LO_OP_SET_THERMAL_METER; -+ h2cParaBuf[0] = calVal; -+ h2cParaLen = 1; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ } -+ else if(BT_ENABLE_CFO_TRACKING == setType) -+ { -+ btOpcode = BT_LO_OP_ENABLE_CFO_TRACKING; -+ h2cParaBuf[0] = calVal; -+ h2cParaLen = 1; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ } -+ -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ return paraLen; -+} -+ -+ -+ -+u2Byte -+mptbt_BtSetTxRxPars( -+ IN PADAPTER Adapter, -+ IN PBT_REQ_CMD pBtReq, -+ IN PBT_RSP_CMD pBtRsp -+ ) -+{ -+ u1Byte h2cParaBuf[6] ={0}; -+ u1Byte h2cParaLen=0; -+ u2Byte paraLen=0; -+ u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode; -+ u1Byte btOpcodeVer=0; -+ PBT_TXRX_PARAMETERS pTxRxPars=(PBT_TXRX_PARAMETERS)&pBtReq->pParamStart[0]; -+ u2Byte lenTxRx=sizeof(BT_TXRX_PARAMETERS); -+ u1Byte i; -+ u1Byte bdAddr[6]={0}; -+ -+ // -+ // check upper layer parameters -+ // -+ -+ // 1. check upper layer opcode version -+ if(pBtReq->opCodeVer != 1) -+ { -+ DBG_8192C("[MPT], Error!! Upper OP code version not match!!!\n"); -+ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; -+ return paraLen; -+ } -+ // 2. check upper layer parameter length -+ if(pBtReq->paraLength == sizeof(BT_TXRX_PARAMETERS)) -+ { -+ DBG_8192C ("[MPT], pTxRxPars->txrxChannel=0x%x \n", pTxRxPars->txrxChannel); -+ DBG_8192C ("[MPT], pTxRxPars->txrxTxPktCnt=0x%8x \n", pTxRxPars->txrxTxPktCnt); -+ DBG_8192C ("[MPT], pTxRxPars->txrxTxPktInterval=0x%x \n", pTxRxPars->txrxTxPktInterval); -+ DBG_8192C ("[MPT], pTxRxPars->txrxPayloadType=0x%x \n", pTxRxPars->txrxPayloadType); -+ DBG_8192C ("[MPT], pTxRxPars->txrxPktType=0x%x \n", pTxRxPars->txrxPktType); -+ DBG_8192C ("[MPT], pTxRxPars->txrxPayloadLen=0x%x \n", pTxRxPars->txrxPayloadLen); -+ DBG_8192C ("[MPT], pTxRxPars->txrxPktHeader=0x%x \n", pTxRxPars->txrxPktHeader); -+ DBG_8192C ("[MPT], pTxRxPars->txrxWhitenCoeff=0x%x \n", pTxRxPars->txrxWhitenCoeff); -+ bdAddr[0] = pTxRxPars->txrxBdaddr[5]; -+ bdAddr[1] = pTxRxPars->txrxBdaddr[4]; -+ bdAddr[2] = pTxRxPars->txrxBdaddr[3]; -+ bdAddr[3] = pTxRxPars->txrxBdaddr[2]; -+ bdAddr[4] = pTxRxPars->txrxBdaddr[1]; -+ bdAddr[5] = pTxRxPars->txrxBdaddr[0]; -+ DBG_8192C ("[MPT], pTxRxPars->txrxBdaddr: %s", &bdAddr[0]); -+ DBG_8192C ("[MPT], pTxRxPars->txrxTxGainIndex=0x%x \n", pTxRxPars->txrxTxGainIndex); -+ } -+ else -+ { -+ DBG_8192C ("[MPT], Error!! pBtReq->paraLength=%d, correct Len=%d\n", pBtReq->paraLength, lenTxRx); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ -+ // -+ // execute lower layer opcodes -+ // -+ -+ // fill h2c parameters -+ btOpcode = BT_LO_OP_SET_PKT_HEADER; -+ if(pTxRxPars->txrxPktHeader > 0x3ffff) -+ { -+ DBG_8192C ("[MPT], Error!! pTxRxPars->txrxPktHeader=0x%x is out of range, (should be between 0x0~0x3ffff)\n", pTxRxPars->txrxPktHeader); -+ pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ else -+ { -+ h2cParaBuf[0] = (u1Byte)(pTxRxPars->txrxPktHeader&0xff); -+ h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxPktHeader&0xff00)>>8); -+ h2cParaBuf[2] = (u1Byte)((pTxRxPars->txrxPktHeader&0xff0000)>>16); -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ // fill h2c parameters -+ btOpcode = BT_LO_OP_SET_PKT_TYPE_LEN; -+ { -+ u2Byte payloadLenLimit=0; -+ switch(pTxRxPars->txrxPktType) -+ { -+ case MP_BT_PKT_DH1: -+ payloadLenLimit = 27*8; -+ break; -+ case MP_BT_PKT_DH3: -+ payloadLenLimit = 183*8; -+ break; -+ case MP_BT_PKT_DH5: -+ payloadLenLimit = 339*8; -+ break; -+ case MP_BT_PKT_2DH1: -+ payloadLenLimit = 54*8; -+ break; -+ case MP_BT_PKT_2DH3: -+ payloadLenLimit = 367*8; -+ break; -+ case MP_BT_PKT_2DH5: -+ payloadLenLimit = 679*8; -+ break; -+ case MP_BT_PKT_3DH1: -+ payloadLenLimit = 83*8; -+ break; -+ case MP_BT_PKT_3DH3: -+ payloadLenLimit = 552*8; -+ break; -+ case MP_BT_PKT_3DH5: -+ payloadLenLimit = 1021*8; -+ break; -+ case MP_BT_PKT_LE: -+ payloadLenLimit = 39*8; -+ break; -+ default: -+ { -+ DBG_8192C ("[MPT], Error!! Unknown pTxRxPars->txrxPktType=0x%x\n", pTxRxPars->txrxPktType); -+ pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ break; -+ } -+ -+ if(pTxRxPars->txrxPayloadLen > payloadLenLimit) -+ { -+ DBG_8192C ("[MPT], Error!! pTxRxPars->txrxPayloadLen=0x%x, (should smaller than %d)\n", -+ pTxRxPars->txrxPayloadLen, payloadLenLimit); -+ pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ -+ h2cParaBuf[0] = pTxRxPars->txrxPktType; -+ h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxPayloadLen&0xff)); -+ h2cParaBuf[2] = (u1Byte)((pTxRxPars->txrxPayloadLen&0xff00)>>8); -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ // fill h2c parameters -+ btOpcode = BT_LO_OP_SET_PKT_CNT_L_PL_TYPE; -+ if(pTxRxPars->txrxPayloadType > MP_BT_PAYLOAD_MAX) -+ { -+ DBG_8192C ("[MPT], Error!! pTxRxPars->txrxPayloadType=0x%x, (should be between 0~4)\n", pTxRxPars->txrxPayloadType); -+ pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ else -+ { -+ h2cParaBuf[0] = (u1Byte)((pTxRxPars->txrxTxPktCnt&0xff)); -+ h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxTxPktCnt&0xff00)>>8); -+ h2cParaBuf[2] = pTxRxPars->txrxPayloadType; -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ // fill h2c parameters -+ btOpcode = BT_LO_OP_SET_PKT_CNT_H_PKT_INTV; -+ if(pTxRxPars->txrxTxPktInterval > 15) -+ { -+ DBG_8192C ("[MPT], Error!! pTxRxPars->txrxTxPktInterval=0x%x, (should be between 0~15)\n", pTxRxPars->txrxTxPktInterval); -+ pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ else -+ { -+ h2cParaBuf[0] = (u1Byte)((pTxRxPars->txrxTxPktCnt&0xff0000)>>16); -+ h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxTxPktCnt&0xff000000)>>24); -+ h2cParaBuf[2] = pTxRxPars->txrxTxPktInterval; -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ // fill h2c parameters -+ btOpcode = BT_LO_OP_SET_WHITENCOEFF; -+ { -+ h2cParaBuf[0] = pTxRxPars->txrxWhitenCoeff; -+ h2cParaLen = 1; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ -+ // fill h2c parameters -+ btOpcode = BT_LO_OP_SET_CHNL_TX_GAIN; -+ if( (pTxRxPars->txrxChannel > 78) || -+ (pTxRxPars->txrxTxGainIndex > 7) ) -+ { -+ DBG_8192C ("[MPT], Error!! pTxRxPars->txrxChannel=0x%x, (should be between 0~78)\n", pTxRxPars->txrxChannel); -+ DBG_8192C ("[MPT], Error!! pTxRxPars->txrxTxGainIndex=0x%x, (should be between 0~7)\n", pTxRxPars->txrxTxGainIndex); -+ pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ else -+ { -+ h2cParaBuf[0] = pTxRxPars->txrxChannel; -+ h2cParaBuf[1] = pTxRxPars->txrxTxGainIndex; -+ h2cParaLen = 2; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ // fill h2c parameters -+ btOpcode = BT_LO_OP_SET_BD_ADDR_L; -+ if( (pTxRxPars->txrxBdaddr[0]==0) && -+ (pTxRxPars->txrxBdaddr[1]==0) && -+ (pTxRxPars->txrxBdaddr[2]==0) && -+ (pTxRxPars->txrxBdaddr[3]==0) && -+ (pTxRxPars->txrxBdaddr[4]==0) && -+ (pTxRxPars->txrxBdaddr[5]==0) ) -+ { -+ DBG_8192C ("[MPT], Error!! pTxRxPars->txrxBdaddr=all zero\n"); -+ pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ if( (pTxRxPars->txrxBdaddr[0]==0xff) && -+ (pTxRxPars->txrxBdaddr[1]==0xff) && -+ (pTxRxPars->txrxBdaddr[2]==0xff) && -+ (pTxRxPars->txrxBdaddr[3]==0xff) && -+ (pTxRxPars->txrxBdaddr[4]==0xff) && -+ (pTxRxPars->txrxBdaddr[5]==0xff) ) -+ { -+ DBG_8192C ("[MPT], Error!! pTxRxPars->txrxBdaddr=all 0xf\n"); -+ pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ -+ { -+ h2cParaBuf[0] = pTxRxPars->txrxBdaddr[0]; -+ h2cParaBuf[1] = pTxRxPars->txrxBdaddr[1]; -+ h2cParaBuf[2] = pTxRxPars->txrxBdaddr[2]; -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ btOpcode = BT_LO_OP_SET_BD_ADDR_H; -+ { -+ h2cParaBuf[0] = pTxRxPars->txrxBdaddr[3]; -+ h2cParaBuf[1] = pTxRxPars->txrxBdaddr[4]; -+ h2cParaBuf[2] = pTxRxPars->txrxBdaddr[5]; -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ // ckeck bt return status. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ return paraLen; -+} -+ -+ -+ -+u2Byte -+mptbt_BtTestCtrl( -+ IN PADAPTER Adapter, -+ IN PBT_REQ_CMD pBtReq, -+ IN PBT_RSP_CMD pBtRsp -+ ) -+{ -+ u1Byte h2cParaBuf[6] ={0}; -+ u1Byte h2cParaLen=0; -+ u2Byte paraLen=0; -+ u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode; -+ u1Byte btOpcodeVer=0; -+ u1Byte testCtrl=0; -+ -+ // -+ // check upper layer parameters -+ // -+ -+ // 1. check upper layer opcode version -+ if(pBtReq->opCodeVer != 1) -+ { -+ DBG_8192C("[MPT], Error!! Upper OP code version not match!!!\n"); -+ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; -+ return paraLen; -+ } -+ // 2. check upper layer parameter length -+ if(1 == pBtReq->paraLength) -+ { -+ testCtrl = pBtReq->pParamStart[0]; -+ DBG_8192C("[MPT], testCtrl=%d \n", testCtrl); -+ } -+ else -+ { -+ DBG_8192C("[MPT], Error!! wrong parameter length=%d (should be 1)\n", pBtReq->paraLength); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ -+ // -+ // execute lower layer opcodes -+ // -+ -+ // 1. fill h2c parameters -+ // check bt mode -+ btOpcode = BT_LO_OP_TEST_CTRL; -+ if(testCtrl >= MP_BT_TEST_MAX) -+ { -+ DBG_8192C("[MPT], Error!! testCtrl=0x%x, (should be between smaller or equal to 0x%x)\n", -+ testCtrl, MP_BT_TEST_MAX-1); -+ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ else -+ { -+ h2cParaBuf[0] = testCtrl; -+ h2cParaLen = 1; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ // 3. construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ return paraLen; -+} -+ -+ -+u2Byte -+mptbt_TestBT( -+ IN PADAPTER Adapter, -+ IN PBT_REQ_CMD pBtReq, -+ IN PBT_RSP_CMD pBtRsp -+ ) -+{ -+ -+ u1Byte h2cParaBuf[6] ={0}; -+ u1Byte h2cParaLen=0; -+ u2Byte paraLen=0; -+ u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode; -+ u1Byte btOpcodeVer=0; -+ u1Byte testCtrl=0; -+ -+ // 1. fill h2c parameters -+ btOpcode = 0x11; -+ h2cParaBuf[0] = 0x11; -+ h2cParaBuf[1] = 0x0; -+ h2cParaBuf[2] = 0x0; -+ h2cParaBuf[3] = 0x0; -+ h2cParaBuf[4] = 0x0; -+ h2cParaLen = 1; -+ // retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, h2cParaBuf, h2cParaLen); -+ -+ -+ // 3. construct respond status code and data. -+ if(BT_STATUS_BT_OP_SUCCESS != retStatus) -+ { -+ pBtRsp->status = ((btOpcode<<8)|retStatus); -+ DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ return paraLen; -+} -+ -+VOID -+mptbt_BtControlProcess( -+ PADAPTER Adapter, -+ PVOID pInBuf -+ ) -+{ -+ u1Byte H2C_Parameter[6] ={0}; -+ PBT_H2C pH2c=(PBT_H2C)&H2C_Parameter[0]; -+ PMPT_CONTEXT pMptCtx=&(Adapter->mppriv.MptCtx); -+ PBT_REQ_CMD pBtReq=(PBT_REQ_CMD)pInBuf; -+ PBT_RSP_CMD pBtRsp; -+ u1Byte i; -+ -+ -+ DBG_8192C("[MPT], mptbt_BtControlProcess()=========>\n"); -+ -+ DBG_8192C("[MPT], input opCodeVer=%d\n", pBtReq->opCodeVer); -+ DBG_8192C("[MPT], input OpCode=%d\n", pBtReq->OpCode); -+ DBG_8192C("[MPT], paraLength=%d \n", pBtReq->paraLength); -+ if(pBtReq->paraLength) -+ { -+ //DBG_8192C("[MPT], parameters(hex):0x%x %d \n",&pBtReq->pParamStart[0], pBtReq->paraLength); -+ } -+ -+ _rtw_memset((void*)pMptCtx->mptOutBuf, 0, 100); -+ pMptCtx->mptOutLen = 4; //length of (BT_RSP_CMD.status+BT_RSP_CMD.paraLength) -+ -+ pBtRsp = (PBT_RSP_CMD)pMptCtx->mptOutBuf; -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ pBtRsp->paraLength = 0x0; -+ -+ // The following we should maintain the User OP codes sent by upper layer -+ switch(pBtReq->OpCode) -+ { -+ case BT_UP_OP_BT_READY: -+ DBG_8192C("[MPT], OPcode : [BT_READY]\n"); -+ pBtRsp->paraLength = mptbt_BtReady(Adapter, pBtReq, pBtRsp); -+ break; -+ case BT_UP_OP_BT_SET_MODE: -+ DBG_8192C("[MPT], OPcode : [BT_SET_MODE]\n"); -+ pBtRsp->paraLength = mptbt_BtSetMode(Adapter, pBtReq, pBtRsp); -+ break; -+ case BT_UP_OP_BT_SET_TX_RX_PARAMETER: -+ DBG_8192C("[MPT], OPcode : [BT_SET_TXRX_PARAMETER]\n"); -+ pBtRsp->paraLength = mptbt_BtSetTxRxPars(Adapter, pBtReq, pBtRsp); -+ break; -+ case BT_UP_OP_BT_SET_GENERAL: -+ DBG_8192C("[MPT], OPcode : [BT_SET_GENERAL]\n"); -+ pBtRsp->paraLength = mptbt_BtSetGeneral(Adapter, pBtReq, pBtRsp); -+ break; -+ case BT_UP_OP_BT_GET_GENERAL: -+ DBG_8192C("[MPT], OPcode : [BT_GET_GENERAL]\n"); -+ pBtRsp->paraLength = mptbt_BtGetGeneral(Adapter, pBtReq, pBtRsp); -+ break; -+ case BT_UP_OP_BT_TEST_CTRL: -+ DBG_8192C("[MPT], OPcode : [BT_TEST_CTRL]\n"); -+ pBtRsp->paraLength = mptbt_BtTestCtrl(Adapter, pBtReq, pBtRsp); -+ break; -+ case BT_UP_OP_TEST_BT: -+ DBG_8192C("[MPT], OPcode : [TEST_BT]\n"); -+ pBtRsp->paraLength = mptbt_TestBT(Adapter, pBtReq, pBtRsp); -+ break; -+ default: -+ DBG_8192C("[MPT], Error!! OPcode : UNDEFINED!!!!\n"); -+ pBtRsp->status = BT_STATUS_UNKNOWN_OPCODE_U; -+ pBtRsp->paraLength = 0x0; -+ break; -+ } -+ -+ pMptCtx->mptOutLen += pBtRsp->paraLength; -+ -+ DBG_8192C("[MPT], pMptCtx->mptOutLen=%d, pBtRsp->paraLength=%d\n", pMptCtx->mptOutLen, pBtRsp->paraLength); -+ DBG_8192C("[MPT], mptbt_BtControlProcess()<=========\n"); -+} -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/core/rtw_cmd.c ---- linux.old/3rdparty/rtl8812au/core/rtw_cmd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_cmd.c 2017-06-07 23:07:20.999686482 +0300 -@@ -0,0 +1,4246 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_cmd.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_cmd.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_cmd.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_cmd.c 2018-02-06 17:42:30.693966912 +0200 +@@ -0,0 +1,2960 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -12346,16 +6182,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_CMD_C_ + +#include -+#include + +/* +Caller and the rtw_cmd_thread can protect cmd_q by spin_lock. @@ -12365,48 +6195,47 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +sint _rtw_init_cmd_priv (struct cmd_priv *pcmdpriv) +{ + sint res=_SUCCESS; -+ -+_func_enter_; ++ ++ + + _rtw_init_sema(&(pcmdpriv->cmd_queue_sema), 0); + //_rtw_init_sema(&(pcmdpriv->cmd_done_sema), 0); + _rtw_init_sema(&(pcmdpriv->terminate_cmdthread_sema), 0); -+ -+ ++ ++ + _rtw_init_queue(&(pcmdpriv->cmd_queue)); -+ ++ + //allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf -+ ++ + pcmdpriv->cmd_seq = 1; -+ ++ + pcmdpriv->cmd_allocated_buf = rtw_zmalloc(MAX_CMDSZ + CMDBUFF_ALIGN_SZ); -+ ++ + if (pcmdpriv->cmd_allocated_buf == NULL){ + res= _FAIL; + goto exit; + } -+ ++ + pcmdpriv->cmd_buf = pcmdpriv->cmd_allocated_buf + CMDBUFF_ALIGN_SZ - ( (SIZE_PTR)(pcmdpriv->cmd_allocated_buf) & (CMDBUFF_ALIGN_SZ-1)); -+ ++ + pcmdpriv->rsp_allocated_buf = rtw_zmalloc(MAX_RSPSZ + 4); -+ ++ + if (pcmdpriv->rsp_allocated_buf == NULL){ + res= _FAIL; + goto exit; + } -+ ++ + pcmdpriv->rsp_buf = pcmdpriv->rsp_allocated_buf + 4 - ( (SIZE_PTR)(pcmdpriv->rsp_allocated_buf) & 3); + + pcmdpriv->cmd_issued_cnt = pcmdpriv->cmd_done_cnt = pcmdpriv->rsp_cnt = 0; + -+ _rtw_mutex_init(&pcmdpriv->sctx_mutex); +exit: -+ -+_func_exit_; ++ ++ + + return res; -+ -+} ++ ++} + +#ifdef CONFIG_C2H_WK +static void c2h_wk_callback(_workitem *work); @@ -12415,15 +6244,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +{ + sint res=_SUCCESS; + -+_func_enter_; ++ + +#ifdef CONFIG_H2CLBK + _rtw_init_sema(&(pevtpriv->lbkevt_done), 0); + pevtpriv->lbkevt_limit = 0; + pevtpriv->lbkevt_num = 0; -+ pevtpriv->cmdevt_parm = NULL; -+#endif -+ ++ pevtpriv->cmdevt_parm = NULL; ++#endif ++ + //allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf + ATOMIC_SET(&pevtpriv->event_seq, 0); + pevtpriv->evt_done_cnt = 0; @@ -12433,55 +6262,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + _rtw_init_sema(&(pevtpriv->evt_notify), 0); + _rtw_init_sema(&(pevtpriv->terminate_evtthread_sema), 0); + -+ pevtpriv->evt_allocated_buf = rtw_zmalloc(MAX_EVTSZ + 4); ++ pevtpriv->evt_allocated_buf = rtw_zmalloc(MAX_EVTSZ + 4); + if (pevtpriv->evt_allocated_buf == NULL){ + res= _FAIL; + goto exit; + } + pevtpriv->evt_buf = pevtpriv->evt_allocated_buf + 4 - ((unsigned int)(pevtpriv->evt_allocated_buf) & 3); -+ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pevtpriv->allocated_c2h_mem = rtw_zmalloc(C2H_MEM_SZ +4); -+ -+ if (pevtpriv->allocated_c2h_mem == NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pevtpriv->c2h_mem = pevtpriv->allocated_c2h_mem + 4\ -+ - ( (u32)(pevtpriv->allocated_c2h_mem) & 3); -+#ifdef PLATFORM_OS_XP -+ pevtpriv->pc2h_mdl= IoAllocateMdl((u8 *)pevtpriv->c2h_mem, C2H_MEM_SZ , FALSE, FALSE, NULL); -+ -+ if(pevtpriv->pc2h_mdl == NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ MmBuildMdlForNonPagedPool(pevtpriv->pc2h_mdl); -+#endif -+#endif //end of CONFIG_SDIO_HCI + + _rtw_init_queue(&(pevtpriv->evt_queue)); + -+exit: ++exit: + +#endif //end of CONFIG_EVENT_THREAD_MODE + +#ifdef CONFIG_C2H_WK + _init_workitem(&pevtpriv->c2h_wk, c2h_wk_callback, NULL); -+ pevtpriv->c2h_wk_alive = _FALSE; ++ pevtpriv->c2h_wk_alive = false; + pevtpriv->c2h_queue = rtw_cbuf_alloc(C2H_QUEUE_MAX_LEN+1); +#endif + -+_func_exit_; ++ + + return res; +} + +void _rtw_free_evt_priv (struct evt_priv *pevtpriv) +{ -+_func_enter_; ++ + + RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("+_rtw_free_evt_priv \n")); + @@ -12506,18 +6313,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + rtw_mfree(c2h, 16); + } + } -+ rtw_cbuf_free(pevtpriv->c2h_queue); +#endif + + RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("-_rtw_free_evt_priv \n")); + -+_func_exit_; ++ + +} + +void _rtw_free_cmd_priv (struct cmd_priv *pcmdpriv) +{ -+_func_enter_; ++ + + if(pcmdpriv){ + _rtw_spinlock_free(&(pcmdpriv->cmd_queue.lock)); @@ -12527,89 +6333,43 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + + if (pcmdpriv->cmd_allocated_buf) + rtw_mfree(pcmdpriv->cmd_allocated_buf, MAX_CMDSZ + CMDBUFF_ALIGN_SZ); -+ ++ + if (pcmdpriv->rsp_allocated_buf) + rtw_mfree(pcmdpriv->rsp_allocated_buf, MAX_RSPSZ + 4); -+ -+ _rtw_mutex_free(&pcmdpriv->sctx_mutex); + } -+_func_exit_; ++ +} + +/* +Calling Context: + -+rtw_enqueue_cmd can only be called between kernel thread, ++rtw_enqueue_cmd can only be called between kernel thread, +since only spin_lock is used. + +ISR/Call-Back functions can't call this sub-function. + +*/ -+#ifdef DBG_CMD_QUEUE -+extern u8 dump_cmd_id; -+#endif + +sint _rtw_enqueue_cmd(_queue *queue, struct cmd_obj *obj) +{ + _irqL irqL; + -+_func_enter_; ++ + + if (obj == NULL) + goto exit; + -+ if(obj->cmdsz > MAX_CMDSZ ){ -+ DBG_871X("%s failed due to obj->cmdsz(%d) > MAX_CMDSZ(%d) \n",__FUNCTION__, obj->cmdsz,MAX_CMDSZ); -+ goto exit; -+ } + //_enter_critical_bh(&queue->lock, &irqL); -+ _enter_critical(&queue->lock, &irqL); ++ _enter_critical(&queue->lock, &irqL); + + rtw_list_insert_tail(&obj->list, &queue->queue); + -+ #ifdef DBG_CMD_QUEUE -+ if(dump_cmd_id){ -+ printk("%s===> cmdcode:0x%02x\n",__FUNCTION__,obj->cmdcode); -+ if(obj->cmdcode == GEN_CMD_CODE(_Set_MLME_EVT)){ -+ if(obj->parmbuf){ -+ struct C2HEvent_Header *pc2h_evt_hdr = (struct C2HEvent_Header *)(obj->parmbuf); -+ printk("pc2h_evt_hdr->ID:0x%02x(%d)\n",pc2h_evt_hdr->ID,pc2h_evt_hdr->ID); -+ } -+ } -+ if(obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)){ -+ if(obj->parmbuf){ -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm =(struct drvextra_cmd_parm*)(obj->parmbuf); -+ printk("pdrvextra_cmd_parm->ec_id:0x%02x\n",pdrvextra_cmd_parm->ec_id); -+ } -+ } -+ } -+ -+ if (queue->queue.prev->next != &queue->queue) -+ { -+ DBG_871X("[%d] head %p, tail %p, tail->prev->next %p[tail], tail->next %p[head]\n", __LINE__, -+ &queue->queue, queue->queue.prev, queue->queue.prev->prev->next, queue->queue.prev->next); -+ -+ DBG_871X("==========%s============\n",__FUNCTION__); -+ DBG_871X("head:%p,obj_addr:%p\n",&queue->queue,obj); -+ DBG_871X("padapter: %p\n",obj->padapter); -+ DBG_871X("cmdcode: 0x%02x\n",obj->cmdcode); -+ DBG_871X("res: %d\n",obj->res); -+ DBG_871X("parmbuf: %p\n",obj->parmbuf); -+ DBG_871X("cmdsz: %d\n",obj->cmdsz); -+ DBG_871X("rsp: %p\n",obj->rsp); -+ DBG_871X("rspsz: %d\n",obj->rspsz); -+ DBG_871X("sctx: %p\n",obj->sctx); -+ DBG_871X("list->next: %p\n",obj->list.next); -+ DBG_871X("list->prev: %p\n",obj->list.prev); -+ } -+ #endif //DBG_CMD_QUEUE -+ -+ //_exit_critical_bh(&queue->lock, &irqL); ++ //_exit_critical_bh(&queue->lock, &irqL); + _exit_critical(&queue->lock, &irqL); + -+exit: ++exit: ++ + -+_func_exit_; + + return _SUCCESS; +} @@ -12619,62 +6379,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + _irqL irqL; + struct cmd_obj *obj; + -+_func_enter_; ++ + + //_enter_critical_bh(&(queue->lock), &irqL); + _enter_critical(&queue->lock, &irqL); -+ -+ #ifdef DBG_CMD_QUEUE -+ if (queue->queue.prev->next != &queue->queue) -+ { -+ DBG_871X("[%d] head %p, tail %p, tail->prev->next %p[tail], tail->next %p[head]\n", __LINE__, -+ &queue->queue, queue->queue.prev, queue->queue.prev->prev->next, queue->queue.prev->next); -+ } -+ #endif //DBG_CMD_QUEUE -+ -+ -+ if (rtw_is_list_empty(&(queue->queue))){ ++ if (rtw_is_list_empty(&(queue->queue))) + obj = NULL; -+ } + else + { + obj = LIST_CONTAINOR(get_next(&(queue->queue)), struct cmd_obj, list); -+ -+ #ifdef DBG_CMD_QUEUE -+ if (queue->queue.prev->next != &queue->queue){ -+ DBG_871X("==========%s============\n",__FUNCTION__); -+ DBG_871X("head:%p,obj_addr:%p\n",&queue->queue,obj); -+ DBG_871X("padapter: %p\n",obj->padapter); -+ DBG_871X("cmdcode: 0x%02x\n",obj->cmdcode); -+ DBG_871X("res: %d\n",obj->res); -+ DBG_871X("parmbuf: %p\n",obj->parmbuf); -+ DBG_871X("cmdsz: %d\n",obj->cmdsz); -+ DBG_871X("rsp: %p\n",obj->rsp); -+ DBG_871X("rspsz: %d\n",obj->rspsz); -+ DBG_871X("sctx: %p\n",obj->sctx); -+ DBG_871X("list->next: %p\n",obj->list.next); -+ DBG_871X("list->prev: %p\n",obj->list.prev); -+ } -+ -+ if(dump_cmd_id){ -+ DBG_871X("%s===> cmdcode:0x%02x\n",__FUNCTION__,obj->cmdcode); -+ if(obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)){ -+ if(obj->parmbuf){ -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm =(struct drvextra_cmd_parm*)(obj->parmbuf); -+ printk("pdrvextra_cmd_parm->ec_id:0x%02x\n",pdrvextra_cmd_parm->ec_id); -+ } -+ } -+ -+ } -+ #endif //DBG_CMD_QUEUE -+ + rtw_list_delete(&obj->list); + } + + //_exit_critical_bh(&(queue->lock), &irqL); + _exit_critical(&queue->lock, &irqL); + -+_func_exit_; ++ + + return obj; +} @@ -12682,84 +6402,75 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +u32 rtw_init_cmd_priv(struct cmd_priv *pcmdpriv) +{ + u32 res; -+_func_enter_; ++ + res = _rtw_init_cmd_priv (pcmdpriv); -+_func_exit_; -+ return res; ++ ++ return res; +} + +u32 rtw_init_evt_priv (struct evt_priv *pevtpriv) +{ + int res; -+_func_enter_; ++ + res = _rtw_init_evt_priv(pevtpriv); -+_func_exit_; ++ + return res; +} + +void rtw_free_evt_priv (struct evt_priv *pevtpriv) +{ -+_func_enter_; ++ + RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("rtw_free_evt_priv\n")); + _rtw_free_evt_priv(pevtpriv); -+_func_exit_; -+} ++ ++} + +void rtw_free_cmd_priv (struct cmd_priv *pcmdpriv) +{ -+_func_enter_; ++ + RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("rtw_free_cmd_priv\n")); + _rtw_free_cmd_priv(pcmdpriv); -+_func_exit_; -+} ++ ++} + +int rtw_cmd_filter(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj); +int rtw_cmd_filter(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj) +{ -+ u8 bAllow = _FALSE; //set to _TRUE to allow enqueuing cmd when hw_init_completed is _FALSE -+ ++ u8 bAllow = false; //set to true to allow enqueuing cmd when hw_init_completed is false ++ + #ifdef SUPPORT_HW_RFOFF_DETECTED + //To decide allow or not -+ if( (adapter_to_pwrctl(pcmdpriv->padapter)->bHWPwrPindetect) ++ if( (pcmdpriv->padapter->pwrctrlpriv.bHWPwrPindetect) + &&(!pcmdpriv->padapter->registrypriv.usbss_enable) -+ ) ++ ) + { -+ if(cmd_obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra) ) ++ if(cmd_obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra) ) + { -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)cmd_obj->parmbuf; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)cmd_obj->parmbuf; + if(pdrvextra_cmd_parm->ec_id == POWER_SAVING_CTRL_WK_CID) -+ { ++ { + //DBG_871X("==>enqueue POWER_SAVING_CTRL_WK_CID\n"); -+ bAllow = _TRUE; ++ bAllow = true; + } + } + } + #endif + -+#ifndef CONFIG_C2H_PACKET_EN -+ /* C2H should be always allowed */ -+ if(cmd_obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)cmd_obj->parmbuf; -+ if(pdrvextra_cmd_parm->ec_id == C2H_WK_CID) { -+ bAllow = _TRUE; -+ } -+ } -+#endif -+ + if(cmd_obj->cmdcode == GEN_CMD_CODE(_SetChannelPlan)) -+ bAllow = _TRUE; ++ bAllow = true; + -+ if ((!rtw_is_hw_init_completed(pcmdpriv->padapter) && (bAllow == _FALSE)) -+ || ATOMIC_READ(&(pcmdpriv->cmdthd_running)) == _FALSE //com_thread not running -+ ) { -+ /*DBG_871X("%s:%s: drop cmdcode:%u, hw_init_completed:%u, cmdthd_running:%u\n", caller_func, __FUNCTION__, -+ cmd_obj->cmdcode, -+ rtw_get_hw_init_completed(cmd_obj->padapter), -+ pcmdpriv->cmdthd_running -+ );*/ ++ if( (pcmdpriv->padapter->hw_init_completed ==false && bAllow == false) ++ || pcmdpriv->cmdthd_running== false //com_thread not running ++ ) ++ { ++ //DBG_871X("%s:%s: drop cmdcode:%u, hw_init_completed:%u, cmdthd_running:%u\n", caller_func, __FUNCTION__, ++ // cmd_obj->cmdcode, ++ // pcmdpriv->padapter->hw_init_completed, ++ // pcmdpriv->cmdthd_running ++ //); + + return _FAIL; -+ } ++ } + return _SUCCESS; +} + @@ -12769,9 +6480,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +{ + int res = _FAIL; + PADAPTER padapter = pcmdpriv->padapter; -+ -+_func_enter_; -+ ++ ++ ++ + if (cmd_obj == NULL) { + goto exit; + } @@ -12782,7 +6493,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + //change pcmdpriv to primary's pcmdpriv + if (padapter->adapter_type != PRIMARY_ADAPTER && padapter->pbuddy_adapter) + pcmdpriv = &(padapter->pbuddy_adapter->cmdpriv); -+#endif ++#endif + + if( _FAIL == (res=rtw_cmd_filter(pcmdpriv, cmd_obj)) ) { + rtw_free_cmd_obj(cmd_obj); @@ -12793,10 +6504,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + + if(res == _SUCCESS) + _rtw_up_sema(&pcmdpriv->cmd_queue_sema); -+ -+exit: -+ -+_func_exit_; ++ ++exit: ++ ++ + + return res; +} @@ -12804,58 +6515,46 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +struct cmd_obj *rtw_dequeue_cmd(struct cmd_priv *pcmdpriv) +{ + struct cmd_obj *cmd_obj; -+ -+_func_enter_; ++ ++ + + cmd_obj = _rtw_dequeue_cmd(&pcmdpriv->cmd_queue); -+ -+_func_exit_; ++ ++ + return cmd_obj; +} + +void rtw_cmd_clr_isr(struct cmd_priv *pcmdpriv) +{ -+_func_enter_; ++ + pcmdpriv->cmd_done_cnt++; + //_rtw_up_sema(&(pcmdpriv->cmd_done_sema)); -+_func_exit_; ++ +} + +void rtw_free_cmd_obj(struct cmd_obj *pcmd) +{ -+ struct drvextra_cmd_parm *extra_parm = NULL; -+_func_enter_; + -+ if (pcmd->parmbuf != NULL) { -+ /* free parmbuf in cmd_obj */ -+ rtw_mfree((unsigned char *)pcmd->parmbuf, pcmd->cmdsz); ++ ++ if((pcmd->cmdcode!=_JoinBss_CMD_) &&(pcmd->cmdcode!= _CreateBss_CMD_)) ++ { ++ //free parmbuf in cmd_obj ++ rtw_mfree((unsigned char*)pcmd->parmbuf, pcmd->cmdsz); + } ++ + if(pcmd->rsp!=NULL) + { + if(pcmd->rspsz!= 0) + { + //free rsp in cmd_obj + rtw_mfree((unsigned char*)pcmd->rsp, pcmd->rspsz); -+ } -+ } ++ } ++ } + + //free cmd_obj + rtw_mfree((unsigned char*)pcmd, sizeof(struct cmd_obj)); -+ -+_func_exit_; -+} + + -+void rtw_stop_cmd_thread(_adapter *adapter) -+{ -+ if(adapter->cmdThread && -+ ATOMIC_READ(&(adapter->cmdpriv.cmdthd_running)) == _TRUE && -+ adapter->cmdpriv.stop_req == 0) -+ { -+ adapter->cmdpriv.stop_req = 1; -+ _rtw_up_sema(&adapter->cmdpriv.cmd_queue_sema); -+ _rtw_down_sema(&adapter->cmdpriv.terminate_cmdthread_sema); -+ } +} + +thread_return rtw_cmd_thread(thread_context context) @@ -12863,56 +6562,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + u8 ret; + struct cmd_obj *pcmd; + u8 *pcmdbuf, *prspbuf; -+ u32 cmd_start_time; -+ u32 cmd_process_time; + u8 (*cmd_hdl)(_adapter *padapter, u8* pbuf); + void (*pcmd_callback)(_adapter *dev, struct cmd_obj *pcmd); + PADAPTER padapter = (PADAPTER)context; + struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ struct drvextra_cmd_parm *extra_parm = NULL; -+ _irqL irqL; -+_func_enter_; ++ ++ + + thread_enter("RTW_CMD_THREAD"); + + pcmdbuf = pcmdpriv->cmd_buf; + prspbuf = pcmdpriv->rsp_buf; + -+ pcmdpriv->stop_req = 0; -+ ATOMIC_SET(&(pcmdpriv->cmdthd_running), _TRUE); ++ pcmdpriv->cmdthd_running=true; + _rtw_up_sema(&pcmdpriv->terminate_cmdthread_sema); + + RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("start r871x rtw_cmd_thread !!!!\n")); + + while(1) + { -+ if (_rtw_down_sema(&pcmdpriv->cmd_queue_sema) == _FAIL) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" _rtw_down_sema(&pcmdpriv->cmd_queue_sema) return _FAIL, break\n", FUNC_ADPT_ARG(padapter)); ++ if (_rtw_down_sema(&pcmdpriv->cmd_queue_sema) == _FAIL) + break; -+ } + -+ if (RTW_CANNOT_RUN(padapter)) { -+ DBG_871X_LEVEL(_drv_always_, "%s: DriverStopped(%s) SurpriseRemoved(%s) break at line %d\n", -+ __func__ -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False" -+ , __LINE__); -+ break; -+ } -+ -+ if (pcmdpriv->stop_req) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" stop_req:%u, break\n", FUNC_ADPT_ARG(padapter), pcmdpriv->stop_req); -+ break; -+ } -+ -+ _enter_critical(&pcmdpriv->cmd_queue.lock, &irqL); -+ if(rtw_is_list_empty(&(pcmdpriv->cmd_queue.queue))) ++ if ((padapter->bDriverStopped == true)||(padapter->bSurpriseRemoved == true)) + { -+ //DBG_871X("%s: cmd queue is empty!\n", __func__); -+ _exit_critical(&pcmdpriv->cmd_queue.lock, &irqL); -+ continue; ++ DBG_871X("%s: DriverStopped(%d) SurpriseRemoved(%d) break at line %d\n", ++ __FUNCTION__, padapter->bDriverStopped, padapter->bSurpriseRemoved, __LINE__); ++ break; + } -+ _exit_critical(&pcmdpriv->cmd_queue.lock, &irqL); + +#ifdef CONFIG_LPS_LCLK + if (rtw_register_cmd_alive(padapter) != _SUCCESS) @@ -12924,12 +6601,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +#endif + +_next: -+ if (RTW_CANNOT_RUN(padapter)) { -+ DBG_871X_LEVEL(_drv_always_, "%s: DriverStopped(%s) SurpriseRemoved(%s) break at line %d\n", -+ __func__ -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False" -+ , __LINE__); ++ if ((padapter->bDriverStopped == true)||(padapter->bSurpriseRemoved== true)) ++ { ++ DBG_871X("%s: DriverStopped(%d) SurpriseRemoved(%d) break at line %d\n", ++ __FUNCTION__, padapter->bDriverStopped, padapter->bSurpriseRemoved, __LINE__); + break; + } + @@ -12940,28 +6615,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + continue; + } + -+ cmd_start_time = rtw_get_current_time(); -+ + if( _FAIL == rtw_cmd_filter(pcmdpriv, pcmd) ) + { + pcmd->res = H2C_DROPPED; -+ if (pcmd->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { -+ extra_parm = (struct drvextra_cmd_parm *)pcmd->parmbuf; -+ if (extra_parm && extra_parm->pbuf && extra_parm->size > 0) -+ rtw_mfree(extra_parm->pbuf, extra_parm->size); -+ } + goto post_process; + } + + pcmdpriv->cmd_issued_cnt++; + -+ if(pcmd->cmdsz > MAX_CMDSZ ){ -+ DBG_871X("%s cmdsz:%d > MAX_CMDSZ:%d\n",__FUNCTION__,pcmd->cmdsz,MAX_CMDSZ); -+ } ++ pcmd->cmdsz = _RND4((pcmd->cmdsz));//_RND4 + + _rtw_memcpy(pcmdbuf, pcmd->parmbuf, pcmd->cmdsz); + -+ if(pcmd->cmdcode < (sizeof(wlancmds) /sizeof(struct cmd_hdl))) ++ if(pcmd->cmdcode <= (sizeof(wlancmds) /sizeof(struct cmd_hdl))) + { + cmd_hdl = wlancmds[pcmd->cmdcode].h2cfuns; + @@ -12982,40 +6648,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + +post_process: + -+ _enter_critical_mutex(&(pcmd->padapter->cmdpriv.sctx_mutex), NULL); -+ if (pcmd->sctx) { -+ if (0) -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" pcmd->sctx\n", -+ FUNC_ADPT_ARG(pcmd->padapter)); -+ if (pcmd->res == H2C_SUCCESS) -+ rtw_sctx_done(&pcmd->sctx); -+ else -+ rtw_sctx_done_err(&pcmd->sctx, RTW_SCTX_DONE_CMD_ERROR); -+ } -+ _exit_critical_mutex(&(pcmd->padapter->cmdpriv.sctx_mutex), NULL); -+ -+ -+ if((cmd_process_time = rtw_get_passing_time_ms(cmd_start_time)) > 1000) -+ { -+ if (pcmd->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { -+ struct drvextra_cmd_parm *drvextra_parm = (struct drvextra_cmd_parm *)pcmdbuf; -+ DBG_871X(ADPT_FMT" cmd=%d,%d,%d process_time=%d > 1 sec\n", -+ ADPT_ARG(pcmd->padapter), pcmd->cmdcode, drvextra_parm->ec_id, drvextra_parm->type, cmd_process_time); -+ //rtw_warn_on(1); -+ } else if(pcmd->cmdcode == GEN_CMD_CODE(_Set_MLME_EVT)){ -+ struct C2HEvent_Header *pc2h_evt_hdr = (struct C2HEvent_Header *)pcmdbuf; -+ DBG_871X(ADPT_FMT" cmd=%d,%d, process_time=%d > 1 sec\n", -+ ADPT_ARG(pcmd->padapter), pcmd->cmdcode, pc2h_evt_hdr->ID, cmd_process_time); -+ //rtw_warn_on(1); -+ } else { -+ DBG_871X(ADPT_FMT" cmd=%d, process_time=%d > 1 sec\n", -+ ADPT_ARG(pcmd->padapter), pcmd->cmdcode, cmd_process_time); -+ //rtw_warn_on(1); -+ } -+ } -+ + //call callback function for post-processed -+ if(pcmd->cmdcode < (sizeof(rtw_cmd_callback) /sizeof(struct _cmd_callback))) ++ if(pcmd->cmdcode <= (sizeof(rtw_cmd_callback) /sizeof(struct _cmd_callback))) + { + pcmd_callback = rtw_cmd_callback[pcmd->cmdcode].callback; + if(pcmd_callback == NULL) @@ -13040,9 +6674,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + goto _next; + + } ++ pcmdpriv->cmdthd_running=false; + -+ /* to avoid enqueue cmd after free all cmd_obj */ -+ ATOMIC_SET(&(pcmdpriv->cmdthd_running), _FALSE); + + // free all cmd_obj resources + do{ @@ -13053,21 +6686,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +#endif + break; + } -+ //DBG_871X("%s: leaving... drop cmdcode:%u size:%d\n", __FUNCTION__, pcmd->cmdcode, pcmd->cmdsz); + -+ if (pcmd->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { -+ extra_parm = (struct drvextra_cmd_parm *)pcmd->parmbuf; -+ if(extra_parm->pbuf && extra_parm->size > 0) { -+ rtw_mfree(extra_parm->pbuf, extra_parm->size); -+ } -+ } ++ //DBG_871X("%s: leaving... drop cmdcode:%u\n", __FUNCTION__, pcmd->cmdcode); + -+ rtw_free_cmd_obj(pcmd); ++ rtw_free_cmd_obj(pcmd); + }while(1); + + _rtw_up_sema(&pcmdpriv->terminate_cmdthread_sema); + -+_func_exit_; ++ + + thread_exit(); + @@ -13080,37 +6707,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + _irqL irqL; + int res; + _queue *queue = &pevtpriv->evt_queue; -+ -+_func_enter_; + -+ res = _SUCCESS; ++ ++ ++ res = _SUCCESS; + + if (obj == NULL) { + res = _FAIL; + goto exit; -+ } ++ } + + _enter_critical_bh(&queue->lock, &irqL); + + rtw_list_insert_tail(&obj->list, &queue->queue); -+ ++ + _exit_critical_bh(&queue->lock, &irqL); + + //rtw_evt_notify_isr(pevtpriv); + +exit: -+ -+_func_exit_; + -+ return res; ++ ++ ++ return res; +} + +struct evt_obj *rtw_dequeue_evt(_queue *queue) +{ + _irqL irqL; + struct evt_obj *pevtobj; -+ -+_func_enter_; ++ ++ + + _enter_critical_bh(&queue->lock, &irqL); + @@ -13123,54 +6750,54 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } + + _exit_critical_bh(&queue->lock, &irqL); -+ -+_func_exit_; + -+ return pevtobj; ++ ++ ++ return pevtobj; +} + +void rtw_free_evt_obj(struct evt_obj *pevtobj) +{ -+_func_enter_; ++ + + if(pevtobj->parmbuf) + rtw_mfree((unsigned char*)pevtobj->parmbuf, pevtobj->evtsz); -+ ++ + rtw_mfree((unsigned char*)pevtobj, sizeof(struct evt_obj)); -+ -+_func_exit_; ++ ++ +} + +void rtw_evt_notify_isr(struct evt_priv *pevtpriv) +{ -+_func_enter_; ++ + pevtpriv->evt_done_cnt++; + _rtw_up_sema(&(pevtpriv->evt_notify)); -+_func_exit_; ++ +} +#endif + + +/* -+u8 rtw_setstandby_cmd(unsigned char *adapter) ++u8 rtw_setstandby_cmd(unsigned char *adapter) +*/ +u8 rtw_setstandby_cmd(_adapter *padapter, uint action) +{ + struct cmd_obj* ph2c; + struct usb_suspend_parm* psetusbsuspend; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; + + u8 ret = _SUCCESS; -+ -+_func_enter_; ++ ++ + + ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if (ph2c == NULL) { + ret = _FAIL; + goto exit; + } -+ -+ psetusbsuspend = (struct usb_suspend_parm*)rtw_zmalloc(sizeof(struct usb_suspend_parm)); ++ ++ psetusbsuspend = (struct usb_suspend_parm*)rtw_zmalloc(sizeof(struct usb_suspend_parm)); + if (psetusbsuspend == NULL) { + rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); + ret = _FAIL; @@ -13181,11 +6808,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + + init_h2fwcmd_w_parm_no_rsp(ph2c, psetusbsuspend, GEN_CMD_CODE(_SetUsbSuspend)); + -+ ret = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+_func_exit_; ++ ret = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++exit: ++ ++ + + return ret; +} @@ -13201,22 +6828,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + u8 res = _FAIL; + struct cmd_obj *ph2c; + struct sitesurvey_parm *psurveyPara; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; +#ifdef CONFIG_P2P + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); +#endif //CONFIG_P2P + -+_func_enter_; ++ + +#ifdef CONFIG_LPS -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE){ ++ if(check_fwstate(pmlmepriv, _FW_LINKED) == true){ + rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SCAN, 1); + } +#endif + +#ifdef CONFIG_P2P_PS -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { + p2p_ps_wk_cmd(padapter, P2P_PS_SCAN, 1); + } +#endif //CONFIG_P2P_PS @@ -13225,13 +6852,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + if (ph2c == NULL) + return _FAIL; + -+ psurveyPara = (struct sitesurvey_parm*)rtw_zmalloc(sizeof(struct sitesurvey_parm)); ++ psurveyPara = (struct sitesurvey_parm*)rtw_zmalloc(sizeof(struct sitesurvey_parm)); + if (psurveyPara == NULL) { + rtw_mfree((unsigned char*) ph2c, sizeof(struct cmd_obj)); + return _FAIL; + } + -+ rtw_free_network_queue(padapter, _FALSE); ++ rtw_free_network_queue(padapter, false); + + RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, ("%s: flush network queue\n", __FUNCTION__)); + @@ -13248,8 +6875,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + _rtw_memcpy(&psurveyPara->ssid[i], &ssid[i], sizeof(NDIS_802_11_SSID)); + psurveyPara->ssid_num++; + if (0) -+ DBG_871X(FUNC_ADPT_FMT" ssid:(%s, %d)\n", FUNC_ADPT_ARG(padapter), -+ psurveyPara->ssid[i].Ssid, psurveyPara->ssid[i].SsidLength); ++ DBG_871X(FUNC_ADPT_FMT" ssid:(%s, %d)\n", FUNC_ADPT_ARG(padapter), ++ psurveyPara->ssid[i].Ssid, psurveyPara->ssid[i].SsidLength); + } + } + } @@ -13262,8 +6889,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + _rtw_memcpy(&psurveyPara->ch[i], &ch[i], sizeof(struct rtw_ieee80211_channel)); + psurveyPara->ch_num++; + if (0) -+ DBG_871X(FUNC_ADPT_FMT" ch:%u\n", FUNC_ADPT_ARG(padapter), -+ psurveyPara->ch[i].hw_value); ++ DBG_871X(FUNC_ADPT_FMT" ch:%u\n", FUNC_ADPT_ARG(padapter), ++ psurveyPara->ch[i].hw_value); + } + } + } @@ -13276,25 +6903,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + + pmlmepriv->scan_start_time = rtw_get_current_time(); + -+#ifdef CONFIG_SCAN_BACKOP ++#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE + if((padapter->pbuddy_adapter->mlmeextpriv.mlmext_info.state&0x03) == WIFI_FW_AP_STATE) -+ { -+ if(IsSupported5G(padapter->registrypriv.wireless_mode) -+ && IsSupported24G(padapter->registrypriv.wireless_mode)) //dual band -+ mlme_set_scan_to_timer(pmlmepriv, CONC_SCANNING_TIMEOUT_DUAL_BAND); -+ else //single band -+ mlme_set_scan_to_timer(pmlmepriv, CONC_SCANNING_TIMEOUT_SINGLE_BAND); -+ } ++ _set_timer(&pmlmepriv->scan_to_timer, SURVEY_TO * ( 38 + ( 38 / RTW_SCAN_NUM_OF_CH ) * RTW_STAY_AP_CH_MILLISECOND ) + 1000 ); + else -+#endif /* CONFIG_SCAN_BACKOP */ -+ mlme_set_scan_to_timer(pmlmepriv, SCANNING_TIMEOUT); ++#endif //CONFIG_STA_MODE_SCAN_UNDER_AP_MODE ++ _set_timer(&pmlmepriv->scan_to_timer, SCANNING_TIMEOUT); + + rtw_led_control(padapter, LED_CTL_SITE_SURVEY); ++ ++ pmlmepriv->scan_interval = SCAN_INTERVAL;// 30*2 sec = 60sec + } else { + _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); + } + -+_func_exit_; ++ + + return res; +} @@ -13306,7 +6929,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + struct cmd_priv* pcmdpriv = &padapter->cmdpriv; + u8 res = _SUCCESS; + -+_func_enter_; ++ + + ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if (ph2c == NULL) { @@ -13314,7 +6937,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + goto exit; + } + -+ pbsetdataratepara = (struct setdatarate_parm*)rtw_zmalloc(sizeof(struct setdatarate_parm)); ++ pbsetdataratepara = (struct setdatarate_parm*)rtw_zmalloc(sizeof(struct setdatarate_parm)); + if (pbsetdataratepara == NULL) { + rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); + res = _FAIL; @@ -13332,7 +6955,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + res = rtw_enqueue_cmd(pcmdpriv, ph2c); +exit: + -+_func_exit_; ++ + + return res; +} @@ -13344,14 +6967,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + struct cmd_priv* pcmdpriv=&padapter->cmdpriv; + u8 res = _SUCCESS; + -+_func_enter_; ++ + + ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if (ph2c == NULL) { + res= _FAIL; + goto exit; + } -+ pssetbasicratepara = (struct setbasicrate_parm*)rtw_zmalloc(sizeof(struct setbasicrate_parm)); ++ pssetbasicratepara = (struct setbasicrate_parm*)rtw_zmalloc(sizeof(struct setbasicrate_parm)); + + if (pssetbasicratepara == NULL) { + rtw_mfree((u8*) ph2c, sizeof(struct cmd_obj)); @@ -13361,19 +6984,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + + init_h2fwcmd_w_parm_no_rsp(ph2c, pssetbasicratepara, _SetBasicRate_CMD_); + -+ _rtw_memcpy(pssetbasicratepara->basicrates, rateset, NumRates); ++ _rtw_memcpy(pssetbasicratepara->basicrates, rateset, NumRates); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++exit: + -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: + -+_func_exit_; + + return res; +} + + +/* -+unsigned char rtw_setphy_cmd(unsigned char *adapter) ++unsigned char rtw_setphy_cmd(unsigned char *adapter) + +1. be called only after rtw_update_registrypriv_dev_network( ~) or mp testing program +2. for AdHoc/Ap mode or mp mode? @@ -13383,19 +7006,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +{ + struct cmd_obj* ph2c; + struct setphy_parm* psetphypara; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; +// struct mlme_priv *pmlmepriv = &padapter->mlmepriv; +// struct registry_priv* pregistry_priv = &padapter->registrypriv; + u8 res=_SUCCESS; + -+_func_enter_; ++ + + ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ + res= _FAIL; + goto exit; + } -+ psetphypara = (struct setphy_parm*)rtw_zmalloc(sizeof(struct setphy_parm)); ++ psetphypara = (struct setphy_parm*)rtw_zmalloc(sizeof(struct setphy_parm)); + + if(psetphypara==NULL){ + rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); @@ -13410,64 +7033,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + psetphypara->modem = modem; + psetphypara->rfchannel = ch; + -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+_func_exit_; -+ return res; -+} -+ -+u8 rtw_getmacreg_cmd(_adapter *padapter, u8 len, u32 addr) -+{ -+ struct cmd_obj *ph2c; -+ struct readMAC_parm *preadmacparm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+_func_enter_; -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ preadmacparm = (struct readMAC_parm *)rtw_zmalloc(sizeof(struct readMAC_parm)); -+ -+ if (preadmacparm == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, preadmacparm, GEN_CMD_CODE(_GetMACReg)); -+ -+ preadmacparm->len = len; -+ preadmacparm->addr = addr; -+ + res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ +exit: -+_func_exit_; -+ return res; -+} + -+void rtw_usb_catc_trigger_cmd(_adapter *padapter, const char *caller) -+{ -+ DBG_871X("%s caller:%s\n", __func__, caller); -+ rtw_getmacreg_cmd(padapter, 1, 0x1c4); ++ return res; +} + +u8 rtw_setbbreg_cmd(_adapter*padapter, u8 offset, u8 val) -+{ ++{ + struct cmd_obj* ph2c; + struct writeBB_parm* pwritebbparm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; + u8 res=_SUCCESS; -+_func_enter_; ++ + ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ + res= _FAIL; + goto exit; + } -+ pwritebbparm = (struct writeBB_parm*)rtw_zmalloc(sizeof(struct writeBB_parm)); ++ pwritebbparm = (struct writeBB_parm*)rtw_zmalloc(sizeof(struct writeBB_parm)); + + if(pwritebbparm==NULL){ + rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); @@ -13475,31 +7059,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + goto exit; + } + -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pwritebbparm, GEN_CMD_CODE(_SetBBReg)); ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pwritebbparm, GEN_CMD_CODE(_SetBBReg)); + + pwritebbparm->offset = offset; + pwritebbparm->value = val; + -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+_func_exit_; ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++exit: ++ + return res; +} + +u8 rtw_getbbreg_cmd(_adapter *padapter, u8 offset, u8 *pval) -+{ ++{ + struct cmd_obj* ph2c; + struct readBB_parm* prdbbparm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; + u8 res=_SUCCESS; -+ -+_func_enter_; ++ ++ + ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ + res=_FAIL; + goto exit; + } -+ prdbbparm = (struct readBB_parm*)rtw_zmalloc(sizeof(struct readBB_parm)); ++ prdbbparm = (struct readBB_parm*)rtw_zmalloc(sizeof(struct readBB_parm)); + + if(prdbbparm ==NULL){ + rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); @@ -13512,28 +7096,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + ph2c->cmdsz = sizeof(struct readBB_parm); + ph2c->rsp = pval; + ph2c->rspsz = sizeof(struct readBB_rsp); -+ ++ + prdbbparm ->offset = offset; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); +exit: -+_func_exit_; ++ + return res; +} + +u8 rtw_setrfreg_cmd(_adapter *padapter, u8 offset, u32 val) -+{ ++{ + struct cmd_obj* ph2c; + struct writeRF_parm* pwriterfparm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; + u8 res=_SUCCESS; -+_func_enter_; ++ + ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ -+ res= _FAIL; ++ res= _FAIL; + goto exit; + } -+ pwriterfparm = (struct writeRF_parm*)rtw_zmalloc(sizeof(struct writeRF_parm)); ++ pwriterfparm = (struct writeRF_parm*)rtw_zmalloc(sizeof(struct writeRF_parm)); + + if(pwriterfparm==NULL){ + rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); @@ -13541,25 +7125,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + goto exit; + } + -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pwriterfparm, GEN_CMD_CODE(_SetRFReg)); ++ init_h2fwcmd_w_parm_no_rsp(ph2c, pwriterfparm, GEN_CMD_CODE(_SetRFReg)); + + pwriterfparm->offset = offset; + pwriterfparm->value = val; + -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); +exit: -+_func_exit_; ++ + return res; +} + +u8 rtw_getrfreg_cmd(_adapter *padapter, u8 offset, u8 *pval) -+{ ++{ + struct cmd_obj* ph2c; + struct readRF_parm* prdrfparm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; + u8 res=_SUCCESS; + -+_func_enter_; ++ + + ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ @@ -13567,7 +7151,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + goto exit; + } + -+ prdrfparm = (struct readRF_parm*)rtw_zmalloc(sizeof(struct readRF_parm)); ++ prdrfparm = (struct readRF_parm*)rtw_zmalloc(sizeof(struct readRF_parm)); + if(prdrfparm ==NULL){ + rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); + res= _FAIL; @@ -13580,133 +7164,115 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + ph2c->cmdsz = sizeof(struct readRF_parm); + ph2c->rsp = pval; + ph2c->rspsz = sizeof(struct readRF_rsp); -+ ++ + prdrfparm ->offset = offset; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); + +exit: + -+_func_exit_; ++ + + return res; +} + +void rtw_getbbrfreg_cmdrsp_callback(_adapter* padapter, struct cmd_obj *pcmd) -+{ -+ _func_enter_; -+ ++{ ++ ++ + //rtw_free_cmd_obj(pcmd); + rtw_mfree((unsigned char*) pcmd->parmbuf, pcmd->cmdsz); + rtw_mfree((unsigned char*) pcmd, sizeof(struct cmd_obj)); -+ ++ +#ifdef CONFIG_MP_INCLUDED + if (padapter->registrypriv.mp_mode == 1) -+ padapter->mppriv.workparam.bcompleted= _TRUE; -+#endif -+_func_exit_; ++ padapter->mppriv.workparam.bcompleted= true; ++#endif ++ +} + +void rtw_readtssi_cmdrsp_callback(_adapter* padapter, struct cmd_obj *pcmd) +{ -+ _func_enter_; ++ + + rtw_mfree((unsigned char*) pcmd->parmbuf, pcmd->cmdsz); + rtw_mfree((unsigned char*) pcmd, sizeof(struct cmd_obj)); -+ ++ +#ifdef CONFIG_MP_INCLUDED + if (padapter->registrypriv.mp_mode == 1) -+ padapter->mppriv.workparam.bcompleted= _TRUE; ++ padapter->mppriv.workparam.bcompleted= true; +#endif + -+_func_exit_; ++ +} + -+static u8 rtw_createbss_cmd(_adapter *adapter, int flags, bool adhoc -+ , s16 req_ch, u8 req_bw, u8 req_offset) ++u8 rtw_createbss_cmd(_adapter *padapter) +{ -+ struct cmd_obj *cmdobj; -+ struct createbss_parm *parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; ++ struct cmd_obj* pcmd; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ WLAN_BSSID_EX *pdev_network = &padapter->registrypriv.dev_network; ++ u8 res=_SUCCESS; + -+ /* prepare cmd parameter */ -+ parm = (struct createbss_parm *)rtw_zmalloc(sizeof(*parm)); -+ if (parm == NULL) { -+ res = _FAIL; ++ ++ ++ rtw_led_control(padapter, LED_CTL_START_TO_LINK); ++ ++ if (pmlmepriv->assoc_ssid.SsidLength == 0){ ++ RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,(" createbss for Any SSid:%s\n",pmlmepriv->assoc_ssid.Ssid)); ++ } else { ++ RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,(" createbss for SSid:%s\n", pmlmepriv->assoc_ssid.Ssid)); ++ } ++ ++ pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if(pcmd==NULL){ ++ res= _FAIL; + goto exit; + } + -+ if (adhoc) { -+ /* for now, adhoc doesn't support ch,bw,offset request */ -+ parm->adhoc = 1; -+ } else { -+ parm->adhoc = 0; -+ parm->req_ch = req_ch; -+ parm->req_bw = req_bw; -+ parm->req_offset = req_offset; -+ } ++ _rtw_init_listhead(&pcmd->list); ++ pcmd->cmdcode = _CreateBss_CMD_; ++ pcmd->parmbuf = (unsigned char *)pdev_network; ++ pcmd->cmdsz = get_WLAN_BSSID_EX_sz((WLAN_BSSID_EX*)pdev_network); ++ pcmd->rsp = NULL; ++ pcmd->rspsz = 0; + -+ if (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != createbss_hdl(adapter, (u8 *)parm)) -+ res = _FAIL; -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ } else { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ goto exit; -+ } ++ pdev_network->Length = pcmd->cmdsz; + -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_CreateBss)); -+ -+ if (flags & RTW_CMDF_WAIT_ACK) { -+ cmdobj->sctx = &sctx; -+ rtw_sctx_init(&sctx, 2000); -+ } -+ -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ -+ if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { -+ rtw_sctx_wait(&sctx, __func__); -+ _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ if (sctx.status == RTW_SCTX_SUBMITTED) -+ cmdobj->sctx = NULL; -+ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ } -+ } ++ res = rtw_enqueue_cmd(pcmdpriv, pcmd); + +exit: + return res; +} + -+inline u8 rtw_create_ibss_cmd(_adapter *adapter, int flags) ++u8 rtw_createbss_cmd_ex(_adapter *padapter, unsigned char *pbss, unsigned int sz) +{ -+ return rtw_createbss_cmd(adapter, flags -+ , 1 -+ , -1, 0, 0 /* for now, adhoc doesn't support ch,bw,offset request */ -+ ); -+} ++ struct cmd_obj* pcmd; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ u8 res=_SUCCESS; + -+inline u8 rtw_startbss_cmd(_adapter *adapter, int flags) -+{ -+ return rtw_createbss_cmd(adapter, flags -+ , 0 -+ , -1, 0, 0 /* doesn't request ch, bw, offset */ -+ ); -+} + -+inline u8 rtw_change_bss_chbw_cmd(_adapter *adapter, int flags, u8 req_ch, u8 req_bw, u8 req_offset) -+{ -+ return rtw_createbss_cmd(adapter, flags -+ , 0 -+ , req_ch, req_bw, req_offset -+ ); ++ ++ pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if(pcmd==NULL){ ++ res= _FAIL; ++ goto exit; ++ } ++ ++ _rtw_init_listhead(&pcmd->list); ++ pcmd->cmdcode = GEN_CMD_CODE(_CreateBss); ++ pcmd->parmbuf = pbss; ++ pcmd->cmdsz = sz; ++ pcmd->rsp = NULL; ++ pcmd->rspsz = 0; ++ ++ res = rtw_enqueue_cmd(pcmdpriv, pcmd); ++ ++exit: ++ ++ ++ ++ return res; +} + +u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network* pnetwork) @@ -13729,9 +7295,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + NDIS_802_11_NETWORK_INFRASTRUCTURE ndis_network_mode = pnetwork->network.InfrastructureMode; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u32 tmp_len; -+ u8 *ptmp=NULL; -+_func_enter_; ++ ++ + + rtw_led_control(padapter, LED_CTL_START_TO_LINK); + @@ -13747,20 +7312,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("rtw_joinbss_cmd: memory allocate for cmd_obj fail!!!\n")); + goto exit; + } -+ /* // for IEs is pointer -+ t_len = sizeof (ULONG) + sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + -+ sizeof (NDIS_802_11_SSID) + sizeof (ULONG) + -+ sizeof (NDIS_802_11_RSSI) + sizeof (NDIS_802_11_NETWORK_TYPE) + -+ sizeof (NDIS_802_11_CONFIGURATION) + -+ sizeof (NDIS_802_11_NETWORK_INFRASTRUCTURE) + -+ sizeof (NDIS_802_11_RATES_EX)+ sizeof(WLAN_PHY_INFO)+ sizeof (ULONG) + MAX_IE_SZ; ++ /* // for IEs is pointer ++ t_len = sizeof (u32) + sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + ++ sizeof (NDIS_802_11_SSID) + sizeof (u32) + ++ sizeof (NDIS_802_11_RSSI) + sizeof (NDIS_802_11_NETWORK_TYPE) + ++ sizeof (NDIS_802_11_CONFIGURATION) + ++ sizeof (NDIS_802_11_NETWORK_INFRASTRUCTURE) + ++ sizeof (NDIS_802_11_RATES_EX)+ sizeof(WLAN_PHY_INFO)+ sizeof (u32) + MAX_IE_SZ; + */ + //for IEs is fix buf size + t_len = sizeof(WLAN_BSSID_EX); + + + //for hidden ap to set fw_state here -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) != _TRUE) ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) != true) + { + switch(ndis_network_mode) + { @@ -13775,35 +7340,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + case Ndis802_11APMode: + case Ndis802_11AutoUnknown: + case Ndis802_11InfrastructureMax: -+ case Ndis802_11Monitor: + break; + + } + } + -+ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->network.IEs, pnetwork->network.IELength); -+ -+ /* -+ Modified by Arvin 2015/05/13 -+ Solution for allocating a new WLAN_BSSID_EX to avoid race condition issue between disconnect and joinbss -+ */ -+ psecnetwork = (WLAN_BSSID_EX *)rtw_zmalloc(sizeof(WLAN_BSSID_EX)); ++ psecnetwork=(WLAN_BSSID_EX *)&psecuritypriv->sec_bss; + if(psecnetwork==NULL) + { + if(pcmd !=NULL) + rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); -+ ++ + res=_FAIL; -+ ++ + RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("rtw_joinbss_cmd :psecnetwork==NULL!!!\n")); -+ ++ + goto exit; + } + + _rtw_memset(psecnetwork, 0, t_len); + + _rtw_memcpy(psecnetwork, &pnetwork->network, get_WLAN_BSSID_EX_sz(&pnetwork->network)); -+ ++ + auth=&psecuritypriv->authenticator_ie[0]; + psecuritypriv->authenticator_ie[0]=(unsigned char)psecnetwork->IELength; + @@ -13812,14 +7370,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } else { + _rtw_memcpy(&psecuritypriv->authenticator_ie[1], &psecnetwork->IEs[12], (256-1)); + } -+ ++ + psecnetwork->IELength = 0; + // Added by Albert 2009/02/18 + // If the the driver wants to use the bssid to create the connection. + // If not, we have to copy the connecting AP's MAC address to it so that + // the driver just has the bssid information for PMKIDList searching. -+ -+ if ( pmlmepriv->assoc_by_bssid == _FALSE ) ++ ++ if ( pmlmepriv->assoc_by_bssid == false ) + { + _rtw_memcpy( &pmlmepriv->assoc_bssid[ 0 ], &pnetwork->network.MacAddress[ 0 ], ETH_ALEN ); + } @@ -13828,26 +7386,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + + + pqospriv->qos_option = 0; -+ -+ if(pregistrypriv->wmm_enable) -+ { -+ tmp_len = rtw_restruct_wmm_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], pnetwork->network.IELength, psecnetwork->IELength); + -+ if (psecnetwork->IELength != tmp_len) ++ if(pregistrypriv->wmm_enable) ++ { ++ u32 tmp_len; ++ ++ tmp_len = rtw_restruct_wmm_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], pnetwork->network.IELength, psecnetwork->IELength); ++ ++ if (psecnetwork->IELength != tmp_len) + { + psecnetwork->IELength = tmp_len; + pqospriv->qos_option = 1; //There is WMM IE in this corresp. beacon + } -+ else ++ else + { + pqospriv->qos_option = 0;//There is no WMM IE in this corresp. beacon -+ } -+ } ++ } ++ } + +#ifdef CONFIG_80211N_HT -+ phtpriv->ht_option = _FALSE; -+ ptmp = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &tmp_len, pnetwork->network.IELength-12); -+ if(pregistrypriv->ht_enable && ptmp && tmp_len>0) ++ phtpriv->ht_option = false; ++ if(pregistrypriv->ht_enable) + { + // Added by Albert 2010/06/23 + // For the WEP mode, we will use the bg mode to do the connection to avoid some IOT issue. @@ -13856,28 +7415,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + ( padapter->securitypriv.dot11PrivacyAlgrthm != _WEP104_ ) && + ( padapter->securitypriv.dot11PrivacyAlgrthm != _TKIP_ )) + { -+ rtw_ht_use_default_setting(padapter); -+ -+ rtw_build_wmm_ie_ht(padapter, &psecnetwork->IEs[0], &psecnetwork->IELength); -+ + //rtw_restructure_ht_ie -+ rtw_restructure_ht_ie(padapter, &pnetwork->network.IEs[12], &psecnetwork->IEs[0], -+ pnetwork->network.IELength-12, &psecnetwork->IELength, -+ pnetwork->network.Configuration.DSConfig); ++ rtw_restructure_ht_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], ++ pnetwork->network.IELength, &psecnetwork->IELength); + } + } + ++#endif ++ +#ifdef CONFIG_80211AC_VHT -+ pvhtpriv->vht_option = _FALSE; ++ pvhtpriv->vht_option = false; + if (phtpriv->ht_option && pregistrypriv->vht_enable) { -+ rtw_restructure_vht_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], ++ rtw_restructure_vht_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], + pnetwork->network.IELength, &psecnetwork->IELength); + } +#endif + -+ rtw_append_exented_cap(padapter, &psecnetwork->IEs[0], &psecnetwork->IELength); -+ -+#endif //CONFIG_80211N_HT ++ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->network.IEs, pnetwork->network.IELength); + + #if 0 + psecuritypriv->supplicant_ie[0]=(u8)psecnetwork->IELength; @@ -13891,27 +7445,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + _rtw_memcpy(&psecuritypriv->supplicant_ie[1], &psecnetwork->IEs[0], (256-1)); + } + #endif -+ -+ pcmd->cmdsz = sizeof(WLAN_BSSID_EX); + -+#ifdef CONFIG_RTL8712 -+ //wlan_network endian conversion -+ psecnetwork->Length = cpu_to_le32(psecnetwork->Length); -+ psecnetwork->Ssid.SsidLength= cpu_to_le32(psecnetwork->Ssid.SsidLength); -+ psecnetwork->Privacy = cpu_to_le32(psecnetwork->Privacy); -+ psecnetwork->Rssi = cpu_to_le32(psecnetwork->Rssi); -+ psecnetwork->NetworkTypeInUse = cpu_to_le32(psecnetwork->NetworkTypeInUse); -+ psecnetwork->Configuration.ATIMWindow = cpu_to_le32(psecnetwork->Configuration.ATIMWindow); -+ psecnetwork->Configuration.BeaconPeriod = cpu_to_le32(psecnetwork->Configuration.BeaconPeriod); -+ psecnetwork->Configuration.DSConfig = cpu_to_le32(psecnetwork->Configuration.DSConfig); -+ psecnetwork->Configuration.FHConfig.DwellTime=cpu_to_le32(psecnetwork->Configuration.FHConfig.DwellTime); -+ psecnetwork->Configuration.FHConfig.HopPattern=cpu_to_le32(psecnetwork->Configuration.FHConfig.HopPattern); -+ psecnetwork->Configuration.FHConfig.HopSet=cpu_to_le32(psecnetwork->Configuration.FHConfig.HopSet); -+ psecnetwork->Configuration.FHConfig.Length=cpu_to_le32(psecnetwork->Configuration.FHConfig.Length); -+ psecnetwork->Configuration.Length = cpu_to_le32(psecnetwork->Configuration.Length); -+ psecnetwork->InfrastructureMode = cpu_to_le32(psecnetwork->InfrastructureMode); -+ psecnetwork->IELength = cpu_to_le32(psecnetwork->IELength); -+#endif ++ pcmd->cmdsz = get_WLAN_BSSID_EX_sz(psecnetwork);//get cmdsz before endian conversion + + _rtw_init_listhead(&pcmd->list); + pcmd->cmdcode = _JoinBss_CMD_;//GEN_CMD_CODE(_JoinBss) @@ -13922,9 +7457,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + res = rtw_enqueue_cmd(pcmdpriv, pcmd); + +exit: -+ -+_func_exit_; -+ + return res; +} + @@ -13935,7 +7467,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + struct cmd_priv *cmdpriv = &padapter->cmdpriv; + u8 res = _SUCCESS; + -+_func_enter_; ++ + + RT_TRACE(_module_rtl871x_cmd_c_, _drv_notice_, ("+rtw_disassoc_cmd\n")); + @@ -13966,12 +7498,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + +exit: + -+_func_exit_; ++ + + return res; +} + -+u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, bool enqueue) ++u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype) +{ + struct cmd_obj* ph2c; + struct setopmode_parm* psetop; @@ -13979,133 +7511,124 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + struct cmd_priv *pcmdpriv= &padapter->cmdpriv; + u8 res=_SUCCESS; + -+_func_enter_; -+ psetop = (struct setopmode_parm*)rtw_zmalloc(sizeof(struct setopmode_parm)); + -+ if(psetop==NULL){ -+ res=_FAIL; ++ ++ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if(ph2c==NULL){ ++ res= false; + goto exit; + } -+ psetop->mode = (u8)networktype; -+ -+ if(enqueue){ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ rtw_mfree((u8 *)psetop, sizeof(*psetop)); -+ res= _FAIL; -+ goto exit; -+ } ++ psetop = (struct setopmode_parm*)rtw_zmalloc(sizeof(struct setopmode_parm)); + -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetop, _SetOpMode_CMD_); -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } -+ else{ -+ setopmode_hdl(padapter, (u8 *)psetop); -+ rtw_mfree((u8 *)psetop, sizeof(*psetop)); ++ if(psetop==NULL){ ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ res=false; ++ goto exit; + } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, psetop, _SetOpMode_CMD_); ++ psetop->mode = (u8)networktype; ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ +exit: + -+_func_exit_; ++ + + return res; +} + -+u8 rtw_setstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 key_type, bool enqueue) ++u8 rtw_setstakey_cmd(_adapter *padapter, u8 *psta, u8 unicast_key) +{ + struct cmd_obj* ph2c; + struct set_stakey_parm *psetstakey_para; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; + struct set_stakey_rsp *psetstakey_rsp = NULL; -+ ++ + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct sta_info* sta = (struct sta_info* )psta; + u8 res=_SUCCESS; + -+_func_enter_; ++ ++ ++ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if ( ph2c == NULL){ ++ res= _FAIL; ++ goto exit; ++ } + + psetstakey_para = (struct set_stakey_parm*)rtw_zmalloc(sizeof(struct set_stakey_parm)); -+ if(psetstakey_para==NULL){ ++ if(psetstakey_para==NULL){ ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); + res=_FAIL; + goto exit; + } -+ -+ _rtw_memcpy(psetstakey_para->addr, sta->hwaddr,ETH_ALEN); -+ -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE)){ -+ psetstakey_para->algorithm =(unsigned char) psecuritypriv->dot11PrivacyAlgrthm; -+ }else{ -+ GET_ENCRY_ALGO(psecuritypriv, sta, psetstakey_para->algorithm, _FALSE); ++ ++ psetstakey_rsp = (struct set_stakey_rsp*)rtw_zmalloc(sizeof(struct set_stakey_rsp)); ++ if(psetstakey_rsp == NULL){ ++ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); ++ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); ++ res=_FAIL; ++ goto exit; + } + -+ if (key_type == GROUP_KEY) { -+ _rtw_memcpy(&psetstakey_para->key, &psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey, 16); -+ } -+ else if (key_type == UNICAST_KEY) { -+ _rtw_memcpy(&psetstakey_para->key, &sta->dot118021x_UncstKey, 16); -+ } ++ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); ++ ph2c->rsp = (u8 *) psetstakey_rsp; ++ ph2c->rspsz = sizeof(struct set_stakey_rsp); ++ ++ _rtw_memcpy(psetstakey_para->addr, sta->hwaddr,ETH_ALEN); ++ ++ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE)){ +#ifdef CONFIG_TDLS -+ else if(key_type == TDLS_KEY){ ++ if(sta->tdls_sta_state&TDLS_LINKED_STATE) ++ psetstakey_para->algorithm=(u8)sta->dot118021XPrivacy; ++ else ++#endif //CONFIG_TDLS ++ psetstakey_para->algorithm =(unsigned char) psecuritypriv->dot11PrivacyAlgrthm; ++ }else{ ++ GET_ENCRY_ALGO(psecuritypriv, sta, psetstakey_para->algorithm, false); ++ } ++ ++ if (unicast_key == true) { ++#ifdef CONFIG_TDLS ++ if((sta->tdls_sta_state&TDLS_LINKED_STATE)==TDLS_LINKED_STATE) + _rtw_memcpy(&psetstakey_para->key, sta->tpk.tk, 16); -+ psetstakey_para->algorithm=(u8)sta->dot118021XPrivacy; -+ } -+#endif /* CONFIG_TDLS */ ++ else ++#endif //CONFIG_TDLS ++ _rtw_memcpy(&psetstakey_para->key, &sta->dot118021x_UncstKey, 16); ++ } else { ++ _rtw_memcpy(&psetstakey_para->key, &psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey, 16); ++ } + + //jeff: set this becasue at least sw key is ready -+ padapter->securitypriv.busetkipkey=_TRUE; ++ padapter->securitypriv.busetkipkey=true; + -+ if(enqueue) -+ { -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if ( ph2c == NULL){ -+ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); -+ res= _FAIL; -+ goto exit; -+ } ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); + -+ psetstakey_rsp = (struct set_stakey_rsp*)rtw_zmalloc(sizeof(struct set_stakey_rsp)); -+ if(psetstakey_rsp == NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); -+ res=_FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); -+ ph2c->rsp = (u8 *) psetstakey_rsp; -+ ph2c->rspsz = sizeof(struct set_stakey_rsp); -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } -+ else{ -+ set_stakey_hdl(padapter, (u8 *)psetstakey_para); -+ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); -+ } +exit: + -+_func_exit_; ++ + + return res; +} + -+u8 rtw_clearstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 enqueue) ++u8 rtw_clearstakey_cmd(_adapter *padapter, u8 *psta, u8 entry, u8 enqueue) +{ + struct cmd_obj* ph2c; + struct set_stakey_parm *psetstakey_para; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ struct set_stakey_rsp *psetstakey_rsp = NULL; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ struct set_stakey_rsp *psetstakey_rsp = NULL; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ s16 cam_id = 0; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct sta_info* sta = (struct sta_info* )psta; + u8 res=_SUCCESS; + -+_func_enter_; ++ + + if(!enqueue) + { -+ while ((cam_id = rtw_camid_search(padapter, sta->hwaddr, -1, -1)) >= 0) { -+ DBG_871X_LEVEL(_drv_always_, "clear key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(sta->hwaddr), cam_id); -+ clear_cam_entry(padapter, cam_id); -+ rtw_camid_free(padapter, cam_id); -+ } ++ clear_cam_entry(padapter, entry); + } + else + { @@ -14122,7 +7645,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + goto exit; + } + -+ psetstakey_rsp = (struct set_stakey_rsp*)rtw_zmalloc(sizeof(struct set_stakey_rsp)); ++ psetstakey_rsp = (struct set_stakey_rsp*)rtw_zmalloc(sizeof(struct set_stakey_rsp)); + if(psetstakey_rsp == NULL){ + rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); + rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); @@ -14137,14 +7660,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + _rtw_memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN); + + psetstakey_para->algorithm = _NO_PRIVACY_; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ ++ ++ psetstakey_para->id = entry; ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ + } -+ ++ +exit: + -+_func_exit_; ++ + + return res; +} @@ -14152,17 +7677,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +u8 rtw_setrttbl_cmd(_adapter *padapter, struct setratable_parm *prate_table) +{ + struct cmd_obj* ph2c; -+ struct setratable_parm * psetrttblparm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ struct setratable_parm * psetrttblparm; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; + u8 res=_SUCCESS; -+_func_enter_; ++ + + ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ + res= _FAIL; + goto exit; + } -+ psetrttblparm = (struct setratable_parm*)rtw_zmalloc(sizeof(struct setratable_parm)); ++ psetrttblparm = (struct setratable_parm*)rtw_zmalloc(sizeof(struct setratable_parm)); + + if(psetrttblparm==NULL){ + rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); @@ -14174,9 +7699,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + + _rtw_memcpy(psetrttblparm,prate_table,sizeof(struct setratable_parm)); + -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); +exit: -+_func_exit_; ++ + return res; + +} @@ -14184,17 +7709,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +u8 rtw_getrttbl_cmd(_adapter *padapter, struct getratable_rsp *pval) +{ + struct cmd_obj* ph2c; -+ struct getratable_parm * pgetrttblparm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ struct getratable_parm * pgetrttblparm; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; + u8 res=_SUCCESS; -+_func_enter_; ++ + + ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ + res= _FAIL; + goto exit; + } -+ pgetrttblparm = (struct getratable_parm*)rtw_zmalloc(sizeof(struct getratable_parm)); ++ pgetrttblparm = (struct getratable_parm*)rtw_zmalloc(sizeof(struct getratable_parm)); + + if(pgetrttblparm==NULL){ + rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); @@ -14210,26 +7735,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + ph2c->cmdsz = sizeof(struct getratable_parm); + ph2c->rsp = (u8*)pval; + ph2c->rspsz = sizeof(struct getratable_rsp); -+ ++ + pgetrttblparm ->rsvd = 0x0; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); +exit: -+_func_exit_; ++ + return res; + +} + +u8 rtw_setassocsta_cmd(_adapter *padapter, u8 *mac_addr) +{ -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + struct cmd_obj* ph2c; -+ struct set_assocsta_parm *psetassocsta_para; ++ struct set_assocsta_parm *psetassocsta_para; + struct set_stakey_rsp *psetassocsta_rsp = NULL; + + u8 res=_SUCCESS; + -+_func_enter_; ++ + + ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ @@ -14244,7 +7769,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + goto exit; + } + -+ psetassocsta_rsp = (struct set_stakey_rsp*)rtw_zmalloc(sizeof(struct set_assocsta_rsp)); ++ psetassocsta_rsp = (struct set_stakey_rsp*)rtw_zmalloc(sizeof(struct set_assocsta_rsp)); + if(psetassocsta_rsp==NULL){ + rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); + rtw_mfree((u8 *) psetassocsta_para, sizeof(struct set_assocsta_parm)); @@ -14256,12 +7781,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + ph2c->rspsz = sizeof(struct set_assocsta_rsp); + + _rtw_memcpy(psetassocsta_para->addr, mac_addr,ETH_ALEN); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, ph2c); + +exit: + -+_func_exit_; ++ + + return res; + } @@ -14273,16 +7798,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + struct addBaReq_parm *paddbareq_parm; + + u8 res=_SUCCESS; -+ -+_func_enter_; + -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ ++ ++ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ + res= _FAIL; + goto exit; + } -+ -+ paddbareq_parm = (struct addBaReq_parm*)rtw_zmalloc(sizeof(struct addBaReq_parm)); ++ ++ paddbareq_parm = (struct addBaReq_parm*)rtw_zmalloc(sizeof(struct addBaReq_parm)); + if(paddbareq_parm==NULL){ + rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); + res= _FAIL; @@ -14296,162 +7821,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + + //DBG_871X("rtw_addbareq_cmd, tid=%d\n", tid); + -+ //rtw_enqueue_cmd(pcmdpriv, ph2c); -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+_func_exit_; -+ -+ return res; -+} -+ -+u8 rtw_addbarsp_cmd(_adapter *padapter, u8 *addr, u16 tid, u8 status, u8 size, u16 start_seq) -+{ -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct cmd_obj *ph2c; -+ struct addBaRsp_parm *paddBaRsp_parm; -+ u8 res = _SUCCESS; -+ -+_func_enter_; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ paddBaRsp_parm = (struct addBaRsp_parm *)rtw_zmalloc(sizeof(struct addBaRsp_parm)); -+ -+ if (paddBaRsp_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memcpy(paddBaRsp_parm->addr, addr, ETH_ALEN); -+ paddBaRsp_parm->tid = tid; -+ paddBaRsp_parm->status = status; -+ paddBaRsp_parm->size = size; -+ paddBaRsp_parm->start_seq = start_seq; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, paddBaRsp_parm, GEN_CMD_CODE(_AddBARsp)); -+ ++ //rtw_enqueue_cmd(pcmdpriv, ph2c); + res = rtw_enqueue_cmd(pcmdpriv, ph2c); + +exit: + -+_func_exit_; ++ + + return res; +} -+//add for CONFIG_IEEE80211W, none 11w can use it -+u8 rtw_reset_securitypriv_cmd(_adapter*padapter) -+{ -+ struct cmd_obj* ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ u8 res=_SUCCESS; -+ -+_func_enter_; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = RESET_SECURITYPRIV; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ -+ //rtw_enqueue_cmd(pcmdpriv, ph2c); -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+_func_exit_; -+ -+ return res; -+ -+} -+ -+u8 rtw_free_assoc_resources_cmd(_adapter*padapter) -+{ -+ struct cmd_obj* ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ u8 res=_SUCCESS; -+ -+_func_enter_; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = FREE_ASSOC_RESOURCES; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ -+ //rtw_enqueue_cmd(pcmdpriv, ph2c); -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+_func_exit_; -+ -+ return res; -+ -+} + +u8 rtw_dynamic_chk_wk_cmd(_adapter*padapter) +{ + struct cmd_obj* ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; + struct cmd_priv *pcmdpriv=&padapter->cmdpriv; + u8 res=_SUCCESS; -+ -+_func_enter_; + -+ //only primary padapter does this cmd -+/* ++ ++ +#ifdef CONFIG_CONCURRENT_MODE + if (padapter->adapter_type != PRIMARY_ADAPTER && padapter->pbuddy_adapter) + pcmdpriv = &(padapter->pbuddy_adapter->cmdpriv); +#endif -+*/ + -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ + res= _FAIL; + goto exit; + } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if(pdrvextra_cmd_parm==NULL){ + rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); + res= _FAIL; @@ -14459,18 +7859,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } + + pdrvextra_cmd_parm->ec_id = DYNAMIC_CHK_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; ++ pdrvextra_cmd_parm->type_size = 0; ++ pdrvextra_cmd_parm->pbuf = (u8 *)padapter; ++ + init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + -+ -+ //rtw_enqueue_cmd(pcmdpriv, ph2c); ++ ++ //rtw_enqueue_cmd(pcmdpriv, ph2c); + res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ ++ +exit: -+ -+_func_exit_; ++ ++ + + return res; + @@ -14484,7 +7884,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + + u8 res=_SUCCESS; + -+_func_enter_; ++ + + DBG_871X(FUNC_NDEV_FMT" ch:%u, bw:%u, ch_offset:%u\n", + FUNC_NDEV_ARG(padapter->pnetdev), ch, bw, ch_offset); @@ -14516,7 +7916,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ + if( H2C_SUCCESS !=set_ch_hdl(padapter, (u8 *)set_ch_parm) ) + res = _FAIL; -+ ++ + rtw_mfree((u8 *)set_ch_parm, sizeof(*set_ch_parm)); + } + @@ -14526,87 +7926,71 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + + DBG_871X(FUNC_NDEV_FMT" res:%u\n", FUNC_NDEV_ARG(padapter->pnetdev), res); + -+_func_exit_; ++ + + return res; +} + -+u8 rtw_set_chplan_cmd(_adapter *adapter, int flags, u8 chplan, u8 swconfig) ++u8 rtw_set_chplan_cmd(_adapter*padapter, u8 chplan, u8 enqueue) +{ -+ struct cmd_obj *cmdobj; -+ struct SetChannelPlan_param *parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; ++ struct cmd_obj* pcmdobj; ++ struct SetChannelPlan_param *setChannelPlan_param; ++ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + -+_func_enter_; ++ u8 res=_SUCCESS; + -+ /* check if allow software config */ -+ if (swconfig && rtw_hal_is_disable_sw_channel_plan(adapter) == _TRUE) { ++ ++ ++ RT_TRACE(_module_rtl871x_cmd_c_, _drv_notice_, ("+rtw_set_chplan_cmd\n")); ++ ++ //check input parameter ++ if(!rtw_is_channel_plan_valid(chplan)) { + res = _FAIL; + goto exit; + } + -+ /* check input parameter */ -+ if (!rtw_is_channel_plan_valid(chplan)) { -+ res = _FAIL; ++ //prepare cmd parameter ++ setChannelPlan_param = (struct SetChannelPlan_param *)rtw_zmalloc(sizeof(struct SetChannelPlan_param)); ++ if(setChannelPlan_param == NULL) { ++ res= _FAIL; + goto exit; + } ++ setChannelPlan_param->channel_plan=chplan; + -+ if (rtw_chplan_is_empty(chplan) == _TRUE) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ /* prepare cmd parameter */ -+ parm = (struct SetChannelPlan_param *)rtw_zmalloc(sizeof(*parm)); -+ if (parm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ parm->channel_plan = chplan; -+ -+ if (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != set_chplan_hdl(adapter, (u8 *)parm)) -+ res = _FAIL; -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ } else { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ rtw_mfree((u8 *)parm, sizeof(*parm)); ++ if(enqueue) ++ { ++ //need enqueue, prepare cmd_obj and enqueue ++ pcmdobj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if(pcmdobj == NULL){ ++ rtw_mfree((u8 *)setChannelPlan_param, sizeof(struct SetChannelPlan_param)); ++ res=_FAIL; + goto exit; + } + -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_SetChannelPlan)); -+ -+ if (flags & RTW_CMDF_WAIT_ACK) { -+ cmdobj->sctx = &sctx; -+ rtw_sctx_init(&sctx, 2000); -+ } -+ -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ -+ if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { -+ rtw_sctx_wait(&sctx, __func__); -+ _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ if (sctx.status == RTW_SCTX_SUBMITTED) -+ cmdobj->sctx = NULL; -+ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ } ++ init_h2fwcmd_w_parm_no_rsp(pcmdobj, setChannelPlan_param, GEN_CMD_CODE(_SetChannelPlan)); ++ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); + } -+ ++ else ++ { ++ //no need to enqueue, do the cmd hdl directly and free cmd parameter ++ if( H2C_SUCCESS !=set_chplan_hdl(padapter, (unsigned char *)setChannelPlan_param) ) ++ res = _FAIL; ++ ++ rtw_mfree((u8 *)setChannelPlan_param, sizeof(struct SetChannelPlan_param)); ++ } ++ ++ //do something based on res... ++ if(res == _SUCCESS) ++ padapter->mlmepriv.ChannelPlan = chplan; ++ +exit: + -+_func_exit_; ++ + + return res; +} + -+u8 rtw_led_blink_cmd(_adapter*padapter, PVOID pLed) ++u8 rtw_led_blink_cmd(_adapter*padapter, void * pLed) +{ + struct cmd_obj* pcmdobj; + struct LedBlink_param *ledBlink_param; @@ -14614,10 +7998,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + + u8 res=_SUCCESS; + -+_func_enter_; ++ + + RT_TRACE(_module_rtl871x_cmd_c_, _drv_notice_, ("+rtw_led_blink_cmd\n")); -+ ++ + pcmdobj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(pcmdobj == NULL){ + res=_FAIL; @@ -14632,13 +8016,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } + + ledBlink_param->pLed=pLed; -+ ++ + init_h2fwcmd_w_parm_no_rsp(pcmdobj, ledBlink_param, GEN_CMD_CODE(_LedBlink)); + res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ ++ +exit: + -+_func_exit_; ++ + + return res; +} @@ -14647,15 +8031,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +{ + struct cmd_obj* pcmdobj; + struct SetChannelSwitch_param*setChannelSwitch_param; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + + u8 res=_SUCCESS; + -+_func_enter_; ++ + + RT_TRACE(_module_rtl871x_cmd_c_, _drv_notice_, ("+rtw_set_csa_cmd\n")); -+ ++ + pcmdobj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(pcmdobj == NULL){ + res=_FAIL; @@ -14670,13 +8054,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } + + setChannelSwitch_param->new_ch_no=new_ch_no; -+ ++ + init_h2fwcmd_w_parm_no_rsp(pcmdobj, setChannelSwitch_param, GEN_CMD_CODE(_SetChannelSwitch)); + res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ ++ +exit: + -+_func_exit_; ++ + + return res; +} @@ -14685,12 +8069,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +{ + struct cmd_obj* pcmdobj; + struct TDLSoption_param *TDLSoption; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + + u8 res=_SUCCESS; + -+_func_enter_; ++ + +#ifdef CONFIG_TDLS + @@ -14710,287 +8094,133 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } + + _rtw_spinlock(&(padapter->tdlsinfo.cmd_lock)); -+ if (addr != NULL) -+ _rtw_memcpy(TDLSoption->addr, addr, 6); ++ _rtw_memcpy(TDLSoption->addr, addr, 6); + TDLSoption->option = option; + _rtw_spinunlock(&(padapter->tdlsinfo.cmd_lock)); + init_h2fwcmd_w_parm_no_rsp(pcmdobj, TDLSoption, GEN_CMD_CODE(_TDLS)); + res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); + +#endif //CONFIG_TDLS -+ ++ +exit: + + -+_func_exit_; ++ + + return res; +} + -+static void collect_traffic_statistics(_adapter *padapter) ++static void traffic_status_watchdog(_adapter *padapter) +{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->adapter_type != PRIMARY_ADAPTER) -+ return; ++#ifdef CONFIG_LPS ++ u8 bEnterPS; +#endif -+ -+ // Tx -+ pdvobjpriv->traffic_stat.tx_bytes = padapter->xmitpriv.tx_bytes; -+ pdvobjpriv->traffic_stat.tx_pkts = padapter->xmitpriv.tx_pkts; -+ pdvobjpriv->traffic_stat.tx_drop = padapter->xmitpriv.tx_drop; -+ -+ // Rx -+ pdvobjpriv->traffic_stat.rx_bytes = padapter->recvpriv.rx_bytes; -+ pdvobjpriv->traffic_stat.rx_pkts = padapter->recvpriv.rx_pkts; -+ pdvobjpriv->traffic_stat.rx_drop = padapter->recvpriv.rx_drop; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ // Add secondary adapter statistics -+ if(rtw_buddy_adapter_up(padapter)) -+ { -+ // Tx -+ pdvobjpriv->traffic_stat.tx_bytes += padapter->pbuddy_adapter->xmitpriv.tx_bytes; -+ pdvobjpriv->traffic_stat.tx_pkts += padapter->pbuddy_adapter->xmitpriv.tx_pkts; -+ pdvobjpriv->traffic_stat.tx_drop += padapter->pbuddy_adapter->xmitpriv.tx_drop; -+ -+ // Rx -+ pdvobjpriv->traffic_stat.rx_bytes += padapter->pbuddy_adapter->recvpriv.rx_bytes; -+ pdvobjpriv->traffic_stat.rx_pkts += padapter->pbuddy_adapter->recvpriv.rx_pkts; -+ pdvobjpriv->traffic_stat.rx_drop += padapter->pbuddy_adapter->recvpriv.rx_drop; -+ } ++ u16 BusyThreshold = 100; ++ u8 bBusyTraffic = false, bTxBusyTraffic = false, bRxBusyTraffic = false; ++ u8 bHigherBusyTraffic = false, bHigherBusyRxTraffic = false, bHigherBusyTxTraffic = false; ++#ifdef CONFIG_FTP_PROTECT ++ u16 bPktCount = 0; +#endif -+ -+ // Calculate throughput in last interval -+ pdvobjpriv->traffic_stat.cur_tx_bytes = pdvobjpriv->traffic_stat.tx_bytes - pdvobjpriv->traffic_stat.last_tx_bytes; -+ pdvobjpriv->traffic_stat.cur_rx_bytes = pdvobjpriv->traffic_stat.rx_bytes - pdvobjpriv->traffic_stat.last_rx_bytes; -+ pdvobjpriv->traffic_stat.last_tx_bytes = pdvobjpriv->traffic_stat.tx_bytes; -+ pdvobjpriv->traffic_stat.last_rx_bytes = pdvobjpriv->traffic_stat.rx_bytes; -+ -+ pdvobjpriv->traffic_stat.cur_tx_tp = (u32)(pdvobjpriv->traffic_stat.cur_tx_bytes *8/2/1024/1024); -+ pdvobjpriv->traffic_stat.cur_rx_tp = (u32)(pdvobjpriv->traffic_stat.cur_rx_bytes *8/2/1024/1024); -+} -+ -+//from_timer == 1 means driver is in LPS -+u8 traffic_status_watchdog(_adapter *padapter, u8 from_timer) -+{ -+ u8 bEnterPS = _FALSE; -+ u16 BusyThresholdHigh; -+ u16 BusyThresholdLow; -+ u16 BusyThreshold; -+ u8 bBusyTraffic = _FALSE, bTxBusyTraffic = _FALSE, bRxBusyTraffic = _FALSE; -+ u8 bHigherBusyTraffic = _FALSE, bHigherBusyRxTraffic = _FALSE, bHigherBusyTxTraffic = _FALSE; -+ + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); +#ifdef CONFIG_TDLS + struct tdls_info *ptdlsinfo = &(padapter->tdlsinfo); -+ struct tdls_txmgmt txmgmt; -+ u8 baddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; +#endif //CONFIG_TDLS + -+ RT_LINK_DETECT_T * link_detect = &pmlmepriv->LinkDetectInfo; -+ -+#ifdef CONFIG_BT_COEXIST -+ if (padapter->registrypriv.wifi_spec != 1) { -+ BusyThresholdHigh = 25; -+ BusyThresholdLow = 10; -+ } else -+#endif /* CONFIG_BT_COEXIST */ -+ { -+ BusyThresholdHigh = 100; -+ BusyThresholdLow = 75; -+ } -+ BusyThreshold = BusyThresholdHigh; -+ -+ collect_traffic_statistics(padapter); -+ + // + // Determine if our traffic is busy now + // -+ if((check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) ++ if((check_fwstate(pmlmepriv, _FW_LINKED)== true) + /*&& !MgntInitAdapterInProgress(pMgntInfo)*/) + { ++ ++#ifdef CONFIG_BT_COEXIST ++ if( pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > 50 || ++ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > 50 ) ++#else // !CONFIG_BT_COEXIST + // if we raise bBusyTraffic in last watchdog, using lower threshold. + if (pmlmepriv->LinkDetectInfo.bBusyTraffic) -+ BusyThreshold = BusyThresholdLow; -+ ++ BusyThreshold = 75; + if( pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > BusyThreshold || + pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > BusyThreshold ) ++#endif // !CONFIG_BT_COEXIST + { -+ bBusyTraffic = _TRUE; ++ bBusyTraffic = true; + + if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) -+ bRxBusyTraffic = _TRUE; ++ bRxBusyTraffic = true; + else -+ bTxBusyTraffic = _TRUE; ++ bTxBusyTraffic = true; + } + + // Higher Tx/Rx data. + if( pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > 4000 || + pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > 4000 ) + { -+ bHigherBusyTraffic = _TRUE; ++ bHigherBusyTraffic = true; + + if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) -+ bHigherBusyRxTraffic = _TRUE; ++ bHigherBusyRxTraffic = true; + else -+ bHigherBusyTxTraffic = _TRUE; ++ bHigherBusyTxTraffic = true; + } + -+#ifdef CONFIG_TRAFFIC_PROTECT -+#define TX_ACTIVE_TH 10 -+#define RX_ACTIVE_TH 20 -+#define TRAFFIC_PROTECT_PERIOD_MS 4500 ++#ifdef CONFIG_FTP_PROTECT ++ DBG_871X("RX in period:%d, TX in period:%d, ftp_lock_flag:%d\n", ++ pmlmepriv->LinkDetectInfo.NumRxOkInPeriod, ++ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, ++ pmlmepriv->ftp_lock_flag); + -+ if (link_detect->NumTxOkInPeriod > TX_ACTIVE_TH -+ || link_detect->NumRxUnicastOkInPeriod > RX_ACTIVE_TH) { -+ -+ DBG_871X_LEVEL(_drv_info_, FUNC_ADPT_FMT" acqiure wake_lock for %u ms(tx:%d,rx_unicast:%d)\n", -+ FUNC_ADPT_ARG(padapter), -+ TRAFFIC_PROTECT_PERIOD_MS, -+ link_detect->NumTxOkInPeriod, -+ link_detect->NumRxUnicastOkInPeriod); ++ bPktCount = pmlmepriv->LinkDetectInfo.NumRxOkInPeriod + pmlmepriv->LinkDetectInfo.NumTxOkInPeriod; ++ if (bPktCount > 20 && !pmlmepriv->ftp_lock_flag) { ++ pmlmepriv->ftp_lock_flag = 1; ++ rtw_lock_suspend(); ++ } else if(bPktCount == 0 && pmlmepriv->ftp_lock_flag) { ++ pmlmepriv->ftp_lock_flag = 0; ++ rtw_unlock_suspend(); ++ } ++#endif //CONFIG_KEEP_FTP_TRANSMIT + -+ rtw_lock_traffic_suspend_timeout(TRAFFIC_PROTECT_PERIOD_MS); -+ } -+#endif -+ +#ifdef CONFIG_TDLS +#ifdef CONFIG_TDLS_AUTOSETUP -+ /* TDLS_WATCHDOG_PERIOD * 2sec, periodically send */ -+ if ((ptdlsinfo->watchdog_count % TDLS_WATCHDOG_PERIOD ) == 0) { -+ _rtw_memcpy(txmgmt.peer, baddr, ETH_ALEN); -+ issue_tdls_dis_req( padapter, &txmgmt ); -+ } ++ if( ( ptdlsinfo->watchdog_count % TDLS_WATCHDOG_PERIOD ) == 0 ) //10 * 2sec, periodically sending ++ issue_tdls_dis_req( padapter, NULL ); + ptdlsinfo->watchdog_count++; +#endif //CONFIG_TDLS_AUTOSETUP +#endif //CONFIG_TDLS + +#ifdef CONFIG_LPS ++#ifdef CONFIG_BT_COEXIST ++ if (BT_1Ant(padapter) == false) ++#endif ++ { + // check traffic for powersaving. + if( ((pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod + pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) > 8 ) || -+#ifdef CONFIG_LPS_SLOW_TRANSITION -+ (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 2) -+#else //CONFIG_LPS_SLOW_TRANSITION -+ (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 4) -+#endif //CONFIG_LPS_SLOW_TRANSITION -+ ) ++ (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 2) ) + { -+#ifdef DBG_RX_COUNTER_DUMP -+ if( padapter->dump_rx_cnt_mode & DUMP_DRV_TRX_COUNTER_DATA) -+ DBG_871X("(-)Tx = %d, Rx = %d \n",pmlmepriv->LinkDetectInfo.NumTxOkInPeriod,pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); -+#endif -+ bEnterPS= _FALSE; -+#ifdef CONFIG_LPS_SLOW_TRANSITION -+ if(bBusyTraffic == _TRUE) -+ { -+ if(pmlmepriv->LinkDetectInfo.TrafficTransitionCount <= 4) -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 4; -+ -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount++; -+ -+ //DBG_871X("Set TrafficTransitionCount to %d\n", pmlmepriv->LinkDetectInfo.TrafficTransitionCount); -+ -+ if(pmlmepriv->LinkDetectInfo.TrafficTransitionCount > 30/*TrafficTransitionLevel*/) -+ { -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 30; -+ } -+ } -+#endif //CONFIG_LPS_SLOW_TRANSITION -+ ++ //DBG_871X("Tx = %d, Rx = %d \n",pmlmepriv->LinkDetectInfo.NumTxOkInPeriod,pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); ++ bEnterPS= false; + } + else + { -+#ifdef DBG_RX_COUNTER_DUMP -+ if( padapter->dump_rx_cnt_mode & DUMP_DRV_TRX_COUNTER_DATA) -+ DBG_871X("(+)Tx = %d, Rx = %d \n",pmlmepriv->LinkDetectInfo.NumTxOkInPeriod,pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); -+#endif -+#ifdef CONFIG_LPS_SLOW_TRANSITION -+ if(pmlmepriv->LinkDetectInfo.TrafficTransitionCount>=2) -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount -=2; -+ else -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; -+ -+ if(pmlmepriv->LinkDetectInfo.TrafficTransitionCount == 0) -+ bEnterPS= _TRUE; -+#else //CONFIG_LPS_SLOW_TRANSITION -+ bEnterPS= _TRUE; -+#endif //CONFIG_LPS_SLOW_TRANSITION ++ bEnterPS= true; + } + -+#ifdef CONFIG_DYNAMIC_DTIM -+ if(pmlmepriv->LinkDetectInfo.LowPowerTransitionCount == 8) -+ bEnterPS= _FALSE; -+ -+ DBG_871X("LowPowerTransitionCount=%d\n", pmlmepriv->LinkDetectInfo.LowPowerTransitionCount); -+#endif //CONFIG_DYNAMIC_DTIM -+ + // LeisurePS only work in infra mode. + if(bEnterPS) + { -+ if(!from_timer) -+ { -+#ifdef CONFIG_DYNAMIC_DTIM -+ if(pmlmepriv->LinkDetectInfo.LowPowerTransitionCount < 8) -+ { -+ adapter_to_pwrctl(padapter)->dtim = 1; -+ } -+ else -+ { -+ adapter_to_pwrctl(padapter)->dtim = 3; -+ } -+#endif //CONFIG_DYNAMIC_DTIM -+ LPS_Enter(padapter, "TRAFFIC_IDLE"); -+ } -+ else -+ { -+ //do this at caller -+ //rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_ENTER, 1); -+ //rtw_hal_dm_watchdog_in_lps(padapter); -+ } -+#ifdef CONFIG_DYNAMIC_DTIM -+ if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode ==_TRUE ) -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount++; -+#endif //CONFIG_DYNAMIC_DTIM ++ LPS_Enter(padapter); + } + else + { -+#ifdef CONFIG_DYNAMIC_DTIM -+ if(pmlmepriv->LinkDetectInfo.LowPowerTransitionCount != 8) -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; -+ else -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount++; -+#endif //CONFIG_DYNAMIC_DTIM -+ if(!from_timer) -+ { -+ LPS_Leave(padapter, "TRAFFIC_BUSY"); -+ } -+ else -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->iface_type == IFACE_PORT0) -+#endif -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_TRAFFIC_BUSY, 1); -+ } ++ LPS_Leave(padapter); ++ } + } -+ +#endif // CONFIG_LPS + } + else + { +#ifdef CONFIG_LPS -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ int n_assoc_iface = 0; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) -+ n_assoc_iface++; -+ } -+ -+ if(!from_timer && n_assoc_iface == 0) -+ LPS_Leave(padapter, "NON_LINKED"); ++ LPS_Leave(padapter); +#endif + } + @@ -15003,66 +8233,44 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + pmlmepriv->LinkDetectInfo.bHigherBusyTraffic = bHigherBusyTraffic; + pmlmepriv->LinkDetectInfo.bHigherBusyRxTraffic = bHigherBusyRxTraffic; + pmlmepriv->LinkDetectInfo.bHigherBusyTxTraffic = bHigherBusyTxTraffic; -+ -+ return bEnterPS; -+ +} + -+void dynamic_chk_wk_hdl(_adapter *padapter) ++void dynamic_chk_wk_hdl(_adapter *padapter, u8 *pbuf, int sz); ++void dynamic_chk_wk_hdl(_adapter *padapter, u8 *pbuf, int sz) +{ + struct mlme_priv *pmlmepriv; ++ ++ padapter = (_adapter *)pbuf; + pmlmepriv = &(padapter->mlmepriv); + +#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK +#ifdef CONFIG_AP_MODE -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ { ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) ++ { + expire_timeout_chk(padapter); + } +#endif +#endif //CONFIG_ACTIVE_KEEP_ALIVE_CHECK + -+#ifdef DBG_CONFIG_ERROR_DETECT -+ rtw_hal_sreset_xmit_status_check(padapter); -+ rtw_hal_sreset_linked_status_check(padapter); -+#endif ++ #ifdef DBG_CONFIG_ERROR_DETECT ++ rtw_hal_sreset_xmit_status_check(padapter); ++ #endif + -+ //for debug purpose -+ _linked_info_dump(padapter); -+ -+ -+ //if(check_fwstate(pmlmepriv, _FW_UNDER_LINKING|_FW_UNDER_SURVEY)==_FALSE) ++ //if(check_fwstate(pmlmepriv, _FW_UNDER_LINKING|_FW_UNDER_SURVEY)==false) + { -+ linked_status_chk(padapter, 0); -+ traffic_status_watchdog(padapter, 0); -+ #ifdef DBG_RX_COUNTER_DUMP -+ rtw_dump_rx_counters(padapter); -+ #endif -+ dm_DynamicUsbTxAgg(padapter, 0); ++ linked_status_chk(padapter); ++ traffic_status_watchdog(padapter); + } + -+#ifdef CONFIG_BEAMFORMING -+#if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ -+ beamforming_watchdog(padapter); -+#endif -+#endif -+ + rtw_hal_dm_watchdog(padapter); + -+ //check_hw_pbc(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->type); ++ //check_hw_pbc(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->type_size); + +#ifdef CONFIG_BT_COEXIST + // + // BT-Coexist + // -+ rtw_btcoex_Handler(padapter); -+#endif -+ -+ -+#ifdef CONFIG_IPS_CHECK_IN_WD -+ //always call rtw_ps_processor() at last one. -+ if (is_primary_adapter(padapter)) -+ rtw_ps_processor(padapter); ++ BT_CoexistMechanism(padapter); +#endif +} + @@ -15071,14 +8279,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type); +void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type) +{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + u8 mstatus; -+ -+_func_enter_; + -+ if((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) -+ || (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) ++ ++ ++ if((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) ++ || (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true)) + { + return; + } @@ -15088,66 +8296,69 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + case LPS_CTRL_SCAN: + //DBG_871X("LPS_CTRL_SCAN \n"); +#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_ScanNotify(padapter, _TRUE); -+#endif // CONFIG_BT_COEXIST -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ BT_WifiScanNotify(padapter, true); ++ if (BT_1Ant(padapter) == false) ++#endif + { -+ // connect -+ LPS_Leave(padapter, "LPS_CTRL_SCAN"); ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) ++ { //connect ++ LPS_Leave(padapter); ++ } + } + break; + case LPS_CTRL_JOINBSS: + //DBG_871X("LPS_CTRL_JOINBSS \n"); -+ LPS_Leave(padapter, "LPS_CTRL_JOINBSS"); ++ LPS_Leave(padapter); + break; + case LPS_CTRL_CONNECT: + //DBG_871X("LPS_CTRL_CONNECT \n"); + mstatus = 1;//connect + // Reset LPS Setting -+ pwrpriv->LpsIdleCount = 0; ++ padapter->pwrctrlpriv.LpsIdleCount = 0; + rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus)); +#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_MediaStatusNotify(padapter, mstatus); -+#endif // CONFIG_BT_COEXIST ++ BT_WifiMediaStatusNotify(padapter, mstatus); ++#endif + break; + case LPS_CTRL_DISCONNECT: + //DBG_871X("LPS_CTRL_DISCONNECT \n"); + mstatus = 0;//disconnect +#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_MediaStatusNotify(padapter, mstatus); -+#endif // CONFIG_BT_COEXIST -+ LPS_Leave(padapter, "LPS_CTRL_DISCONNECT"); ++ BT_WifiMediaStatusNotify(padapter, mstatus); ++ if (BT_1Ant(padapter) == false) ++#endif ++ { ++ LPS_Leave(padapter); ++ } + rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus)); + break; + case LPS_CTRL_SPECIAL_PACKET: + //DBG_871X("LPS_CTRL_SPECIAL_PACKET \n"); + pwrpriv->DelayLPSLastTimeStamp = rtw_get_current_time(); +#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SpecialPacketNotify(padapter, PACKET_DHCP); -+#endif // CONFIG_BT_COEXIST -+ LPS_Leave(padapter, "LPS_CTRL_SPECIAL_PACKET"); ++ BT_SpecialPacketNotify(padapter); ++ if (BT_1Ant(padapter) == false) ++#endif ++ { ++ LPS_Leave(padapter); ++ } + break; + case LPS_CTRL_LEAVE: + //DBG_871X("LPS_CTRL_LEAVE \n"); -+ LPS_Leave(padapter, "LPS_CTRL_LEAVE"); -+ break; -+ case LPS_CTRL_TRAFFIC_BUSY: -+ LPS_Leave(padapter, "LPS_CTRL_TRAFFIC_BUSY"); -+ break; -+ case LPS_CTRL_TX_TRAFFIC_LEAVE: -+ LPS_Leave(padapter, "LPS_CTRL_TX_TRAFFIC_LEAVE"); -+ break; -+ case LPS_CTRL_RX_TRAFFIC_LEAVE: -+ LPS_Leave(padapter, "LPS_CTRL_RX_TRAFFIC_LEAVE"); -+ break; -+ case LPS_CTRL_ENTER: -+ LPS_Enter(padapter, "TRAFFIC_IDLE_1"); ++#ifdef CONFIG_BT_COEXIST ++ BT_LpsLeave(padapter); ++ if (BT_1Ant(padapter) == false) ++#endif ++ { ++ LPS_Leave(padapter); ++ } + break; ++ + default: + break; + } + -+_func_exit_; ++ +} + +u8 rtw_lps_ctrl_wk_cmd(_adapter*padapter, u8 lps_ctrl_type, u8 enqueue) @@ -15155,23 +8366,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + struct cmd_obj *ph2c; + struct drvextra_cmd_parm *pdrvextra_cmd_parm; + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ //struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++ //struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; + u8 res = _SUCCESS; -+ -+_func_enter_; ++ ++ + + //if(!pwrctrlpriv->bLeisurePs) + // return res; + ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->iface_type != IFACE_PORT0) ++ return res; ++#endif ++ + if(enqueue) + { -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ + res= _FAIL; + goto exit; + } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if(pdrvextra_cmd_parm==NULL){ + rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); + res= _FAIL; @@ -15179,8 +8395,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } + + pdrvextra_cmd_parm->ec_id = LPS_CTRL_WK_CID; -+ pdrvextra_cmd_parm->type = lps_ctrl_type; -+ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->type_size = lps_ctrl_type; + pdrvextra_cmd_parm->pbuf = NULL; + + init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); @@ -15191,139 +8406,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + { + lps_ctrl_wk_hdl(padapter, lps_ctrl_type); + } -+ ++ +exit: -+ -+_func_exit_; ++ ++ + + return res; + +} + -+void rtw_dm_in_lps_hdl(_adapter*padapter) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_IN_LPS, NULL); -+} -+ -+u8 rtw_dm_in_lps_wk_cmd(_adapter*padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = DM_IN_LPS_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+ -+void rtw_lps_change_dtim_hdl(_adapter *padapter, u8 dtim) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ -+ if(dtim <=0 || dtim > 16) -+ return; -+ -+#ifdef CONFIG_BT_COEXIST -+ if (rtw_btcoex_IsBtControlLps(padapter) == _TRUE) -+ return; +#endif + -+#ifdef CONFIG_LPS_LCLK -+ _enter_pwrlock(&pwrpriv->lock); -+#endif -+ -+ if(pwrpriv->dtim!=dtim) -+ { -+ DBG_871X("change DTIM from %d to %d, bFwCurrentInPSMode=%d, ps_mode=%d\n", pwrpriv->dtim, dtim, -+ pwrpriv->bFwCurrentInPSMode, pwrpriv->pwr_mode); -+ -+ pwrpriv->dtim = dtim; -+ } -+ -+ if((pwrpriv->bFwCurrentInPSMode ==_TRUE) && (pwrpriv->pwr_mode > PS_MODE_ACTIVE)) -+ { -+ u8 ps_mode = pwrpriv->pwr_mode; -+ -+ //DBG_871X("change DTIM from %d to %d, ps_mode=%d\n", pwrpriv->dtim, dtim, ps_mode); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); -+ } -+ -+#ifdef CONFIG_LPS_LCLK -+ _exit_pwrlock(&pwrpriv->lock); -+#endif -+ -+} -+ -+#endif -+ -+u8 rtw_lps_change_dtim_cmd(_adapter*padapter, u8 dtim) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+/* -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->iface_type != IFACE_PORT0) -+ return res; -+#endif -+*/ -+ { -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = LPS_CHANGE_DTIM_CID; -+ pdrvextra_cmd_parm->type = dtim; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } -+ -+exit: -+ -+ return res; -+ -+} -+ +#if (RATE_ADAPTIVE_SUPPORT==1) +void rpt_timer_setting_wk_hdl(_adapter *padapter, u16 minRptTime) +{ @@ -15333,13 +8426,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +u8 rtw_rpt_timer_cfg_cmd(_adapter*padapter, u16 minRptTime) +{ + struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + + u8 res = _SUCCESS; + -+_func_enter_; -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ ++ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ + res= _FAIL; + goto exit; @@ -15353,14 +8446,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } + + pdrvextra_cmd_parm->ec_id = RTP_TIMER_CFG_WK_CID; -+ pdrvextra_cmd_parm->type = minRptTime; -+ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->type_size = minRptTime; + pdrvextra_cmd_parm->pbuf = NULL; + init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + res = rtw_enqueue_cmd(pcmdpriv, ph2c); +exit: + -+_func_exit_; ++ + + return res; + @@ -15377,18 +8469,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +u8 rtw_antenna_select_cmd(_adapter*padapter, u8 antenna,u8 enqueue) +{ + struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 bSupportAntDiv = _FALSE; ++ u8 bSupportAntDiv = false; + u8 res = _SUCCESS; + -+_func_enter_; -+ rtw_hal_get_def_var(padapter, HAL_DEF_IS_SUPPORT_ANT_DIV, &(bSupportAntDiv)); -+ if(_FALSE == bSupportAntDiv ) return res; + -+ if(_TRUE == enqueue) ++ rtw_hal_get_def_var(padapter, HAL_DEF_IS_SUPPORT_ANT_DIV, &(bSupportAntDiv)); ++ if(false == bSupportAntDiv ) return res; ++ ++ if(true == enqueue) + { -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ + res= _FAIL; + goto exit; @@ -15402,8 +8494,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } + + pdrvextra_cmd_parm->ec_id = ANT_SELECT_WK_CID; -+ pdrvextra_cmd_parm->type = antenna; -+ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->type_size = antenna; + pdrvextra_cmd_parm->pbuf = NULL; + init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + @@ -15414,72 +8505,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } +exit: + -+_func_exit_; ++ + + return res; + +} +#endif + -+void rtw_dm_ra_mask_hdl(_adapter *padapter, struct sta_info *psta) -+{ -+ if (psta) { -+ set_sta_rate(padapter, psta); -+ } -+} -+ -+u8 rtw_dm_ra_mask_wk_cmd(_adapter*padapter, u8 *psta) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = DM_RA_MSK_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = psta; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+ -+void power_saving_wk_hdl(_adapter *padapter) ++void power_saving_wk_hdl(_adapter *padapter, u8 *pbuf, int sz); ++void power_saving_wk_hdl(_adapter *padapter, u8 *pbuf, int sz) +{ + rtw_ps_processor(padapter); +} + -+//add for CONFIG_IEEE80211W, none 11w can use it -+void reset_securitypriv_hdl(_adapter *padapter) -+{ -+ rtw_reset_securitypriv(padapter); -+} -+ -+void free_assoc_resources_hdl(_adapter *padapter) -+{ -+ rtw_free_assoc_resources(padapter, 1); -+} -+ +#ifdef CONFIG_P2P +u8 p2p_protocol_wk_cmd(_adapter*padapter, int intCmdType ) +{ @@ -15488,21 +8526,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + u8 res = _SUCCESS; -+ -+_func_enter_; ++ ++ + + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) + { + return res; + } + -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ + res= _FAIL; + goto exit; + } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if(pdrvextra_cmd_parm==NULL){ + rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); + res= _FAIL; @@ -15510,17 +8548,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } + + pdrvextra_cmd_parm->ec_id = P2P_PROTO_WK_CID; -+ pdrvextra_cmd_parm->type = intCmdType; // As the command tppe. -+ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->type_size = intCmdType; // As the command tppe. + pdrvextra_cmd_parm->pbuf = NULL; // Must be NULL here + + init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + + res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ ++ +exit: -+ -+_func_exit_; ++ ++ + + return res; + @@ -15530,24 +8567,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +u8 rtw_ps_cmd(_adapter*padapter) +{ + struct cmd_obj *ppscmd; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ ++ + u8 res = _SUCCESS; -+_func_enter_; ++ + +#ifdef CONFIG_CONCURRENT_MODE + if (padapter->adapter_type != PRIMARY_ADAPTER) + goto exit; +#endif -+ -+ ppscmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ ++ ppscmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ppscmd==NULL){ + res= _FAIL; + goto exit; + } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if(pdrvextra_cmd_parm==NULL){ + rtw_mfree((unsigned char *)ppscmd, sizeof(struct cmd_obj)); + res= _FAIL; @@ -15555,16 +8592,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } + + pdrvextra_cmd_parm->ec_id = POWER_SAVING_CTRL_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; + pdrvextra_cmd_parm->pbuf = NULL; + init_h2fwcmd_w_parm_no_rsp(ppscmd, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + + res = rtw_enqueue_cmd(pcmdpriv, ppscmd); -+ ++ +exit: -+ -+_func_exit_; ++ ++ + + return res; + @@ -15574,61 +8609,65 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + +static void rtw_chk_hi_queue_hdl(_adapter *padapter) +{ ++ int cnt=0; + struct sta_info *psta_bmc; + struct sta_priv *pstapriv = &padapter->stapriv; -+ u32 start = rtw_get_current_time(); -+ u8 empty = _FALSE; + + psta_bmc = rtw_get_bcmc_stainfo(padapter); + if(!psta_bmc) + return; + -+ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); -+ -+ while(_FALSE == empty && rtw_get_passing_time_ms(start) < rtw_get_wait_hiq_empty_ms()) -+ { -+ rtw_msleep_os(100); -+ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); -+ } -+ + if(psta_bmc->sleepq_len==0) + { -+ if(empty == _SUCCESS) ++ u8 val = 0; ++ ++ //while((rtw_read32(padapter, 0x414)&0x00ffff00)!=0) ++ //while((rtw_read32(padapter, 0x414)&0x0000ff00)!=0) ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &val); ++ ++ while(false == val) + { -+ bool update_tim = _FALSE; ++ rtw_msleep_os(100); + -+ if (pstapriv->tim_bitmap & BIT(0)) -+ update_tim = _TRUE; ++ cnt++; + ++ if(cnt>10) ++ break; ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &val); ++ } ++ ++ if(cnt<=10) ++ { + pstapriv->tim_bitmap &= ~BIT(0); + pstapriv->sta_dz_bitmap &= ~BIT(0); + -+ if (update_tim == _TRUE) -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "bmc sleepq and HIQ empty"); ++ update_beacon(padapter, _TIM_IE_, NULL, false); + } + else //re check again + { + rtw_chk_hi_queue_cmd(padapter); + } -+ -+ } -+ ++ ++ } ++ +} + +u8 rtw_chk_hi_queue_cmd(_adapter*padapter) +{ + struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; ++ struct drvextra_cmd_parm *pdrvextra_cmd_parm; + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ ++ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ + res= _FAIL; + goto exit; + } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if(pdrvextra_cmd_parm==NULL){ + rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); + res= _FAIL; @@ -15636,476 +8675,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } + + pdrvextra_cmd_parm->ec_id = CHECK_HIQ_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->type_size = 0; + pdrvextra_cmd_parm->pbuf = NULL; + + init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + + res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ ++ +exit: -+ ++ + return res; + +} -+ -+#ifdef CONFIG_DFS_MASTER -+u8 rtw_dfs_master_hdl(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ -+ if (!rfctl->dfs_master_enabled) -+ goto exit; -+ -+ if (rtw_get_on_cur_ch_time(adapter) == 0 -+ || rtw_get_passing_time_ms(rtw_get_on_cur_ch_time(adapter)) < 300 -+ ) { -+ /* offchannel , by pass radar detect */ -+ goto cac_status_chk; -+ } -+ -+ if (rfctl->dbg_dfs_master_fake_radar_detect_cnt -+ || rtw_odm_radar_detect(adapter) == _TRUE -+ ) { -+ if (rfctl->dbg_dfs_master_fake_radar_detect_cnt != 0) { -+ DBG_871X(FUNC_ADPT_FMT" fake radar detect, cnt:%d\n", FUNC_ADPT_ARG(adapter) -+ , rfctl->dbg_dfs_master_fake_radar_detect_cnt); -+ rfctl->dbg_dfs_master_fake_radar_detect_cnt--; -+ } -+ -+ if (rfctl->dbg_dfs_master_radar_detect_trigger_non) { -+ /* radar detect debug mode, trigger no mlme flow */ -+ DBG_871X(FUNC_ADPT_FMT" radar detected, trigger no mlme flow for debug\n", FUNC_ADPT_ARG(adapter)); -+ } else { -+ /* TODO: move timer to rfctl */ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!dvobj->padapters[i]) -+ continue; -+ if (check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_AP_STATE) -+ && check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_AP_STATE)) -+ break; -+ } -+ -+ if (i >= dvobj->iface_nums) { -+ /* what? */ -+ rtw_warn_on(1); -+ } else { -+ rtw_chset_update_non_ocp(dvobj->padapters[i]->mlmeextpriv.channel_set -+ , rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset); -+ -+ /* change op ch, inform ch switch */ -+ rtw_change_bss_chbw_cmd(dvobj->padapters[i], RTW_CMDF_DIRECTLY, 0, 0, 0); -+ } -+ -+ if (rfctl->dfs_master_enabled) -+ goto set_timer; -+ goto exit; -+ } -+ } -+ -+cac_status_chk: -+ -+ if (!IS_UNDER_CAC(rfctl) && !IS_CAC_STOPPED(rfctl)) { -+ u8 pause = 0x00; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_TXPAUSE, &pause); -+ rfctl->cac_end_time = RTW_CAC_STOPPED; -+ } -+ -+set_timer: -+ _set_timer(&mlme->dfs_master_timer, DFS_MASTER_TIMER_MS); -+ -+exit: -+ return H2C_SUCCESS; -+} -+ -+u8 rtw_dfs_master_cmd(_adapter *adapter, bool enqueue) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ u8 res = _FAIL; -+ -+ if (enqueue) { -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmdobj == NULL) -+ goto exit; -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = DFS_MASTER_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ } else { -+ rtw_dfs_master_hdl(adapter); -+ res = _SUCCESS; -+ } -+ -+exit: -+ return res; -+} -+ -+void rtw_dfs_master_timer_hdl(RTW_TIMER_HDL_ARGS) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ -+ rtw_dfs_master_cmd(adapter, _TRUE); -+} -+ -+void rtw_dfs_master_enable(_adapter *adapter, u8 ch, u8 bw, u8 offset) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ /* TODO: move timer to rfctl */ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ -+ DBG_871X(FUNC_ADPT_FMT" on %u,%u,%u\n", FUNC_ADPT_ARG(adapter), ch, bw, offset); -+ -+ rfctl->pre_radar_detect_by_sta_link = rfctl->radar_detect_by_sta_link; -+ rfctl->radar_detect_by_sta_link = _FALSE; -+ -+ rfctl->pre_radar_detect_ch = rfctl->radar_detect_ch; -+ rfctl->pre_radar_detect_bw = rfctl->radar_detect_bw; -+ rfctl->pre_radar_detect_offset = rfctl->radar_detect_offset; -+ rfctl->radar_detect_ch = ch; -+ rfctl->radar_detect_bw = bw; -+ rfctl->radar_detect_offset = offset; -+ -+ if (rtw_is_cac_reset_needed(adapter) == _TRUE) -+ rtw_rfctl_reset_cac(adapter_to_rfctl(adapter)); -+ -+ if (!rfctl->dfs_master_enabled) { -+ DBG_871X(FUNC_ADPT_FMT" set dfs_master_enabled\n", FUNC_ADPT_ARG(adapter)); -+ rfctl->dfs_master_enabled = 1; -+ _set_timer(&adapter->mlmepriv.dfs_master_timer, DFS_MASTER_TIMER_MS); -+ -+ if (rtw_rfctl_overlap_radar_detect_ch(rfctl)) { -+ if (IS_UNDER_CAC(rfctl)) { -+ u8 pause = 0xFF; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_TXPAUSE, &pause); -+ } -+ rtw_odm_radar_detect_enable(adapter); -+ } -+ } -+} -+ -+void rtw_dfs_master_disable(_adapter *adapter, bool ld_sta_in_dfs) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ /* TODO: move timer to rfctl */ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ -+ rfctl->pre_radar_detect_by_sta_link = rfctl->radar_detect_by_sta_link; -+ rfctl->radar_detect_by_sta_link = ld_sta_in_dfs; -+ -+ if (rfctl->dfs_master_enabled) { -+ bool overlap_radar_detect_ch = rtw_rfctl_overlap_radar_detect_ch(rfctl); -+ -+ DBG_871X(FUNC_ADPT_FMT" clear dfs_master_enabled\n", FUNC_ADPT_ARG(adapter)); -+ -+ rfctl->dfs_master_enabled = 0; -+ rfctl->radar_detect_ch = rfctl->pre_radar_detect_ch = 0; -+ rfctl->radar_detect_bw = rfctl->pre_radar_detect_bw = 0; -+ rfctl->radar_detect_offset = rfctl->pre_radar_detect_offset = 0; -+ rfctl->cac_end_time = RTW_CAC_STOPPED; -+ _cancel_timer_ex(&adapter->mlmepriv.dfs_master_timer); -+ -+ if (overlap_radar_detect_ch) { -+ u8 pause = 0x00; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_TXPAUSE, &pause); -+ rtw_odm_radar_detect_disable(adapter); -+ } -+ } -+} -+ -+void rtw_dfs_master_status_apply(_adapter *adapter, u8 self_action) -+{ -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ u8 ld_sta_num, lg_sta_num, ap_num; -+ u8 u_ch, u_bw, u_offset; -+ bool ld_sta_in_dfs = _FALSE; -+ bool sync_ch = _FALSE; /* _FALSE: asign channel directly */ -+ bool needed = _FALSE; -+ -+ rtw_dev_iface_status_no_self(adapter, NULL, &ld_sta_num, &lg_sta_num, &ap_num, NULL); -+ rtw_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset); -+ if (u_ch != 0) -+ sync_ch = _TRUE; -+ -+ switch (self_action) { -+ case MLME_STA_CONNECTING: -+ lg_sta_num++; -+ break; -+ case MLME_STA_CONNECTED: -+ ld_sta_num++; -+ break; -+ case MLME_AP_STARTED: -+ ap_num++; -+ break; -+ case MLME_AP_STOPPED: -+ case MLME_STA_DISCONNECTED: -+ default: -+ break; -+ } -+ -+ if (sync_ch == _TRUE) { -+ if (!rtw_is_chbw_grouped(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset, u_ch, u_bw, u_offset)) { -+ DBG_871X(FUNC_ADPT_FMT" can't sync %u,%u,%u with %u,%u,%u\n", FUNC_ADPT_ARG(adapter) -+ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset, u_ch, u_bw, u_offset); -+ goto apply; -+ } -+ -+ rtw_sync_chbw(&mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset -+ , &u_ch, &u_bw, &u_offset); -+ } else { -+ u_ch = mlmeext->cur_channel; -+ u_bw = mlmeext->cur_bwmode; -+ u_offset = mlmeext->cur_ch_offset; -+ } -+ -+ if (ld_sta_num > 0) { -+ /* rely on AP on which STA mode connects */ -+ if (rtw_is_dfs_ch(u_ch, u_bw, u_offset)) -+ ld_sta_in_dfs = _TRUE; -+ goto apply; -+ } -+ -+ if (lg_sta_num > 0) { -+ /* STA mode is linking */ -+ goto apply; -+ } -+ -+ if (ap_num == 0) { -+ /* No working AP mode */ -+ goto apply; -+ } -+ -+ if (rtw_is_dfs_ch(u_ch, u_bw, u_offset)) -+ needed = _TRUE; -+ -+apply: -+ -+ DBG_871X(FUNC_ADPT_FMT" needed:%d, self_action:%u\n" -+ , FUNC_ADPT_ARG(adapter), needed, self_action); -+ DBG_871X(FUNC_ADPT_FMT" ld_sta_num:%u, lg_sta_num:%u, ap_num:%u, %u,%u,%u\n" -+ , FUNC_ADPT_ARG(adapter), ld_sta_num, lg_sta_num, ap_num, u_ch, u_bw, u_offset); -+ -+ if (needed == _TRUE) -+ rtw_dfs_master_enable(adapter, u_ch, u_bw, u_offset); -+ else -+ rtw_dfs_master_disable(adapter, ld_sta_in_dfs); -+} -+#endif /* CONFIG_DFS_MASTER */ -+ -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_BT_COEXIST -+struct btinfo { -+ u8 cid; -+ u8 len; -+ -+ u8 bConnection:1; -+ u8 bSCOeSCO:1; -+ u8 bInQPage:1; -+ u8 bACLBusy:1; -+ u8 bSCOBusy:1; -+ u8 bHID:1; -+ u8 bA2DP:1; -+ u8 bFTP:1; -+ -+ u8 retry_cnt:4; -+ u8 rsvd_34:1; -+ u8 rsvd_35:1; -+ u8 rsvd_36:1; -+ u8 rsvd_37:1; -+ -+ u8 rssi; -+ -+ u8 rsvd_50:1; -+ u8 rsvd_51:1; -+ u8 rsvd_52:1; -+ u8 rsvd_53:1; -+ u8 rsvd_54:1; -+ u8 rsvd_55:1; -+ u8 eSCO_SCO:1; -+ u8 Master_Slave:1; -+ -+ u8 rsvd_6; -+ u8 rsvd_7; -+}; -+ -+void btinfo_evt_dump(void *sel, void *buf) -+{ -+ struct btinfo *info = (struct btinfo *)buf; -+ -+ DBG_871X_SEL_NL(sel, "cid:0x%02x, len:%u\n", info->cid, info->len); -+ -+ if (info->len > 2) -+ DBG_871X_SEL_NL(sel, "byte2:%s%s%s%s%s%s%s%s\n" -+ , info->bConnection?"bConnection ":"" -+ , info->bSCOeSCO?"bSCOeSCO ":"" -+ , info->bInQPage?"bInQPage ":"" -+ , info->bACLBusy?"bACLBusy ":"" -+ , info->bSCOBusy?"bSCOBusy ":"" -+ , info->bHID?"bHID ":"" -+ , info->bA2DP?"bA2DP ":"" -+ , info->bFTP?"bFTP":"" -+ ); -+ -+ if (info->len > 3) -+ DBG_871X_SEL_NL(sel, "retry_cnt:%u\n", info->retry_cnt); -+ -+ if (info->len > 4) -+ DBG_871X_SEL_NL(sel, "rssi:%u\n", info->rssi); -+ -+ if (info->len > 5) -+ DBG_871X_SEL_NL(sel, "byte5:%s%s\n" -+ , info->eSCO_SCO?"eSCO_SCO ":"" -+ , info->Master_Slave?"Master_Slave ":"" -+ ); -+} -+ -+static void rtw_btinfo_hdl(_adapter *adapter, u8 *buf, u16 buf_len) -+{ -+ #define BTINFO_WIFI_FETCH 0x23 -+ #define BTINFO_BT_AUTO_RPT 0x27 -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ struct btinfo_8761ATV *info = (struct btinfo_8761ATV *)buf; -+#else //!CONFIG_BT_COEXIST_SOCKET_TRX -+ struct btinfo *info = (struct btinfo *)buf; -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+ u8 cmd_idx; -+ u8 len; -+ -+ cmd_idx = info->cid; -+ -+ if (info->len > buf_len-2) { -+ rtw_warn_on(1); -+ len = buf_len-2; -+ } else { -+ len = info->len; -+ } -+ -+//#define DBG_PROC_SET_BTINFO_EVT -+#ifdef DBG_PROC_SET_BTINFO_EVT -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ DBG_871X("%s: btinfo[0]=%x,btinfo[1]=%x,btinfo[2]=%x,btinfo[3]=%x btinfo[4]=%x,btinfo[5]=%x,btinfo[6]=%x,btinfo[7]=%x\n" -+ , __func__, buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6], buf[7]); -+#else//!CONFIG_BT_COEXIST_SOCKET_TRX -+ btinfo_evt_dump(RTW_DBGDUMP, info); -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+#endif // DBG_PROC_SET_BTINFO_EVT -+ -+ /* transform BT-FW btinfo to WiFI-FW C2H format and notify */ -+ if (cmd_idx == BTINFO_WIFI_FETCH) -+ buf[1] = 0; -+ else if (cmd_idx == BTINFO_BT_AUTO_RPT) -+ buf[1] = 2; -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ else if(0x01 == cmd_idx || 0x02 == cmd_idx) -+ buf[1] = buf[0]; -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+ rtw_btcoex_BtInfoNotify(adapter ,len+1, &buf[1]); -+} -+ -+u8 rtw_btinfo_cmd(_adapter *adapter, u8 *buf, u16 len) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ u8 *btinfo; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((u8*)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ btinfo = rtw_zmalloc(len); -+ if (btinfo == NULL) { -+ rtw_mfree((u8*)ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8*)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = BTINFO_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = len; -+ pdrvextra_cmd_parm->pbuf = btinfo; -+ -+ _rtw_memcpy(btinfo, buf, len); -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+#endif //CONFIG_BT_COEXIST -+ -+//#ifdef CONFIG_C2H_PACKET_EN -+u8 rtw_c2h_packet_wk_cmd(PADAPTER padapter, u8 *pbuf, u16 length) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((u8*)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = C2H_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = length; -+ pdrvextra_cmd_parm->pbuf = pbuf; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+//#else //CONFIG_C2H_PACKET_EN -+/* dont call R/W in this function, beucase SDIO interrupt have claim host */ -+/* or deadlock will happen and cause special-systemserver-died in android */ ++#endif + +u8 rtw_c2h_wk_cmd(PADAPTER padapter, u8 *c2h_evt) +{ @@ -16128,74 +8710,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } + + pdrvextra_cmd_parm->ec_id = C2H_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = c2h_evt?16:0; ++ pdrvextra_cmd_parm->type_size = c2h_evt?16:0; + pdrvextra_cmd_parm->pbuf = c2h_evt; + + init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + + res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ ++ +exit: -+ -+ return res; -+} -+//#endif //CONFIG_C2H_PACKET_EN -+ -+u8 rtw_run_in_thread_cmd(PADAPTER padapter, void (*func)(void*), void* context) -+{ -+ struct cmd_priv *pcmdpriv; -+ struct cmd_obj *ph2c; -+ struct RunInThread_param *parm; -+ s32 res = _SUCCESS; -+ -+_func_enter_; -+ -+ pcmdpriv = &padapter->cmdpriv; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (NULL == ph2c) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm = (struct RunInThread_param*)rtw_zmalloc(sizeof(struct RunInThread_param)); -+ if (NULL == parm) { -+ rtw_mfree((u8*)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm->func = func; -+ parm->context = context; -+ init_h2fwcmd_w_parm_no_rsp(ph2c, parm, GEN_CMD_CODE(_RunInThreadCMD)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+_func_exit_; + + return res; +} + -+s32 c2h_evt_hdl(_adapter *adapter, u8 *c2h_evt, c2h_id_filter filter) ++static s32 c2h_evt_hdl(_adapter *adapter, struct c2h_evt_hdr *c2h_evt, c2h_id_filter filter) +{ + s32 ret = _FAIL; + u8 buf[16]; + + if (!c2h_evt) { + /* No c2h event in cmd_obj, read c2h event before handling*/ -+ if (rtw_hal_c2h_evt_read(adapter, buf) == _SUCCESS) { -+ c2h_evt = buf; -+ -+ if (filter && filter(c2h_evt) == _FALSE) ++ if (c2h_evt_read(adapter, buf) == _SUCCESS) { ++ c2h_evt = (struct c2h_evt_hdr *)buf; ++ ++ if (filter && filter(c2h_evt->id) == false) + goto exit; + + ret = rtw_hal_c2h_handler(adapter, c2h_evt); + } + } else { + -+ if (filter && filter(c2h_evt) == _FALSE) ++ if (filter && filter(c2h_evt->id) == false) + goto exit; + + ret = rtw_hal_c2h_handler(adapter, c2h_evt); @@ -16209,46 +8753,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +{ + struct evt_priv *evtpriv = container_of(work, struct evt_priv, c2h_wk); + _adapter *adapter = container_of(evtpriv, _adapter, evtpriv); -+ u8 *c2h_evt; ++ struct c2h_evt_hdr *c2h_evt; + c2h_id_filter ccx_id_filter = rtw_hal_c2h_id_filter_ccx(adapter); + -+ evtpriv->c2h_wk_alive = _TRUE; ++ evtpriv->c2h_wk_alive = true; + + while (!rtw_cbuf_empty(evtpriv->c2h_queue)) { -+ if ((c2h_evt = (u8 *)rtw_cbuf_pop(evtpriv->c2h_queue)) != NULL) { ++ if ((c2h_evt = (struct c2h_evt_hdr *)rtw_cbuf_pop(evtpriv->c2h_queue)) != NULL) { + /* This C2H event is read, clear it */ + c2h_evt_clear(adapter); -+ } else if ((c2h_evt = (u8 *)rtw_malloc(16)) != NULL) { ++ } else if ((c2h_evt = (struct c2h_evt_hdr *)rtw_malloc(16)) != NULL) { + /* This C2H event is not read, read & clear now */ -+ if (rtw_hal_c2h_evt_read(adapter, c2h_evt) != _SUCCESS) { -+ rtw_mfree(c2h_evt, 16); ++ if (c2h_evt_read(adapter, (u8*)c2h_evt) != _SUCCESS) + continue; -+ } -+ } else { -+ rtw_warn_on(1); -+ continue; + } + + /* Special pointer to trigger c2h_evt_clear only */ + if ((void *)c2h_evt == (void *)evtpriv) + continue; + -+ if (!rtw_hal_c2h_valid(adapter, c2h_evt)) { -+ rtw_mfree(c2h_evt, 16); ++ if (!c2h_evt_exist(c2h_evt)) { ++ rtw_mfree((u8*)c2h_evt, 16); + continue; + } -+ -+ if (ccx_id_filter(c2h_evt) == _TRUE) { ++ ++ if (ccx_id_filter(c2h_evt->id) == true) { + /* Handle CCX report here */ + rtw_hal_c2h_handler(adapter, c2h_evt); -+ rtw_mfree(c2h_evt, 16); ++ rtw_mfree((u8*)c2h_evt, 16); + } else { + /* Enqueue into cmd_thread for others */ -+ rtw_c2h_wk_cmd(adapter, c2h_evt); ++ rtw_c2h_wk_cmd(adapter, (u8 *)c2h_evt); + } + } + -+ evtpriv->c2h_wk_alive = _FALSE; ++ evtpriv->c2h_wk_alive = false; +} +#endif + @@ -16260,54 +8799,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + return H2C_PARAMETERS_ERROR; + + pdrvextra_cmd = (struct drvextra_cmd_parm*)pbuf; -+ ++ + switch(pdrvextra_cmd->ec_id) + { -+ case DYNAMIC_CHK_WK_CID://only primary padapter go to this cmd, but execute dynamic_chk_wk_hdl() for two interfaces -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->pbuddy_adapter) -+ { -+ dynamic_chk_wk_hdl(padapter->pbuddy_adapter); -+ } -+#endif //CONFIG_CONCURRENT_MODE -+ dynamic_chk_wk_hdl(padapter); ++ case DYNAMIC_CHK_WK_CID: ++ dynamic_chk_wk_hdl(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->type_size); + break; + case POWER_SAVING_CTRL_WK_CID: -+ power_saving_wk_hdl(padapter); ++ power_saving_wk_hdl(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->type_size); + break; +#ifdef CONFIG_LPS + case LPS_CTRL_WK_CID: -+ lps_ctrl_wk_hdl(padapter, (u8)pdrvextra_cmd->type); -+ break; -+ case DM_IN_LPS_WK_CID: -+ rtw_dm_in_lps_hdl(padapter); -+ break; -+ case LPS_CHANGE_DTIM_CID: -+ rtw_lps_change_dtim_hdl(padapter, (u8)pdrvextra_cmd->type); ++ lps_ctrl_wk_hdl(padapter, (u8)pdrvextra_cmd->type_size); + break; +#endif +#if (RATE_ADAPTIVE_SUPPORT==1) + case RTP_TIMER_CFG_WK_CID: -+ rpt_timer_setting_wk_hdl(padapter, pdrvextra_cmd->type); ++ rpt_timer_setting_wk_hdl(padapter, pdrvextra_cmd->type_size); + break; +#endif +#ifdef CONFIG_ANTENNA_DIVERSITY + case ANT_SELECT_WK_CID: -+ antenna_select_wk_hdl(padapter, pdrvextra_cmd->type); ++ antenna_select_wk_hdl(padapter, pdrvextra_cmd->type_size); + break; +#endif +#ifdef CONFIG_P2P_PS + case P2P_PS_WK_CID: -+ p2p_ps_wk_hdl(padapter, pdrvextra_cmd->type); ++ p2p_ps_wk_hdl(padapter, pdrvextra_cmd->type_size); + break; -+#endif //CONFIG_P2P_PS -+#ifdef CONFIG_P2P ++#endif // CONFIG_P2P_PS + case P2P_PROTO_WK_CID: + // Commented by Albert 2011/07/01 + // I used the type_size as the type command -+ p2p_protocol_wk_hdl( padapter, pdrvextra_cmd->type ); ++ p2p_protocol_wk_hdl( padapter, pdrvextra_cmd->type_size ); + break; -+#endif //CONFIG_P2P +#ifdef CONFIG_AP_MODE + case CHECK_HIQ_WK_CID: + rtw_chk_hi_queue_hdl(padapter); @@ -16315,48 +8840,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +#endif //CONFIG_AP_MODE +#ifdef CONFIG_INTEL_WIDI + case INTEl_WIDI_WK_CID: -+ intel_widi_wk_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); ++ intel_widi_wk_hdl(padapter, pdrvextra_cmd->type_size, pdrvextra_cmd->pbuf); + break; +#endif //CONFIG_INTEL_WIDI -+ //add for CONFIG_IEEE80211W, none 11w can use it -+ case RESET_SECURITYPRIV: -+ reset_securitypriv_hdl(padapter); -+ break; -+ case FREE_ASSOC_RESOURCES: -+ free_assoc_resources_hdl(padapter); -+ break; ++ + case C2H_WK_CID: -+#ifdef CONFIG_C2H_PACKET_EN -+ rtw_hal_set_hwreg_with_buf(padapter, HW_VAR_C2H_HANDLE, pdrvextra_cmd->pbuf, pdrvextra_cmd->size); -+#else -+ c2h_evt_hdl(padapter, pdrvextra_cmd->pbuf, NULL); -+#endif ++ c2h_evt_hdl(padapter, (struct c2h_evt_hdr *)pdrvextra_cmd->pbuf, NULL); + break; -+#ifdef CONFIG_BEAMFORMING -+ case BEAMFORMING_WK_CID: -+ beamforming_wk_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); -+ break; -+#endif /*CONFIG_BEAMFORMING*/ -+ case DM_RA_MSK_WK_CID: -+ rtw_dm_ra_mask_hdl(padapter, (struct sta_info *)pdrvextra_cmd->pbuf); -+ break; -+#ifdef CONFIG_BT_COEXIST -+ case BTINFO_WK_CID: -+ rtw_btinfo_hdl(padapter ,pdrvextra_cmd->pbuf, pdrvextra_cmd->size); -+ break; -+#endif -+#ifdef CONFIG_DFS_MASTER -+ case DFS_MASTER_WK_CID: -+ rtw_dfs_master_hdl(padapter); -+ break; -+#endif ++ + default: + break; + } + -+ if (pdrvextra_cmd->pbuf && pdrvextra_cmd->size>0) ++ if (pdrvextra_cmd->pbuf && pdrvextra_cmd->type_size>0) + { -+ rtw_mfree(pdrvextra_cmd->pbuf, pdrvextra_cmd->size); ++ rtw_mfree(pdrvextra_cmd->pbuf, pdrvextra_cmd->type_size); + } + + return H2C_SUCCESS; @@ -16364,42 +8862,42 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + +void rtw_survey_cmd_callback(_adapter* padapter , struct cmd_obj *pcmd) +{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ + -+_func_enter_; + + if(pcmd->res == H2C_DROPPED) + { + //TODO: cancel timer and do timeout handler directly... + //need to make timeout handlerOS independent -+ mlme_set_scan_to_timer(pmlmepriv, 1); ++ _set_timer(&pmlmepriv->scan_to_timer, 1); + } + else if (pcmd->res != H2C_SUCCESS) { -+ mlme_set_scan_to_timer(pmlmepriv, 1); ++ _set_timer(&pmlmepriv->scan_to_timer, 1); + RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\n ********Error: MgntActrtw_set_802_11_bssid_LIST_SCAN Fail ************\n\n.")); -+ } ++ } + + // free cmd + rtw_free_cmd_obj(pcmd); + -+_func_exit_; ++ +} +void rtw_disassoc_cmd_callback(_adapter* padapter, struct cmd_obj *pcmd) +{ + _irqL irqL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+_func_enter_; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ + + if (pcmd->res != H2C_SUCCESS) + { + _enter_critical_bh(&pmlmepriv->lock, &irqL); + set_fwstate(pmlmepriv, _FW_LINKED); + _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ ++ + RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\n ***Error: disconnect_cmd_callback Fail ***\n.")); + -+ goto exit; ++ return; + } +#ifdef CONFIG_BR_EXT + else //clear bridge database @@ -16408,28 +8906,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + + // free cmd + rtw_free_cmd_obj(pcmd); -+ -+exit: -+ -+_func_exit_; -+} -+ -+ -+void rtw_getmacreg_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd) -+{ -+ -+_func_enter_; -+ -+ rtw_free_cmd_obj(pcmd); -+ -+_func_exit_; +} + +void rtw_joinbss_cmd_callback(_adapter* padapter, struct cmd_obj *pcmd) +{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ + -+_func_enter_; + + if(pcmd->res == H2C_DROPPED) + { @@ -16439,120 +8922,188 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ + } + else if(pcmd->res != H2C_SUCCESS) + { ++ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("********Error:rtw_select_and_join_from_scanned_queue Wait Sema Fail ************\n")); + _set_timer(&pmlmepriv->assoc_timer, 1); + } + + rtw_free_cmd_obj(pcmd); -+ -+_func_exit_; ++ ++ +} + -+void rtw_create_ibss_post_hdl(_adapter *padapter, int status) -+{ ++void rtw_createbss_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd) ++{ + _irqL irqL; + u8 timer_cancelled; + struct sta_info *psta = NULL; -+ struct wlan_network *pwlan = NULL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ WLAN_BSSID_EX *pdev_network = &padapter->registrypriv.dev_network; -+ struct wlan_network *mlme_cur_network = &(pmlmepriv->cur_network); ++ struct wlan_network *pwlan = NULL; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)pcmd->parmbuf; ++ struct wlan_network *tgt_network = &(pmlmepriv->cur_network); + -+ if (status != H2C_SUCCESS) -+ _set_timer(&pmlmepriv->assoc_timer, 1); ++ ++ ++ if((pcmd->res != H2C_SUCCESS)) ++ { ++ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\n ********Error: rtw_createbss_cmd_callback Fail ************\n\n.")); ++ _set_timer(&pmlmepriv->assoc_timer, 1 ); ++ } + + _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled); + ++#ifdef CONFIG_FW_MLMLE ++ //endian_convert ++ pnetwork->Length = le32_to_cpu(pnetwork->Length); ++ pnetwork->Ssid.SsidLength = le32_to_cpu(pnetwork->Ssid.SsidLength); ++ pnetwork->Privacy =le32_to_cpu(pnetwork->Privacy); ++ pnetwork->Rssi = le32_to_cpu(pnetwork->Rssi); ++ pnetwork->NetworkTypeInUse =le32_to_cpu(pnetwork->NetworkTypeInUse); ++ pnetwork->Configuration.ATIMWindow = le32_to_cpu(pnetwork->Configuration.ATIMWindow); ++ //pnetwork->Configuration.BeaconPeriod = le32_to_cpu(pnetwork->Configuration.BeaconPeriod); ++ pnetwork->Configuration.DSConfig =le32_to_cpu(pnetwork->Configuration.DSConfig); ++ pnetwork->Configuration.FHConfig.DwellTime=le32_to_cpu(pnetwork->Configuration.FHConfig.DwellTime); ++ pnetwork->Configuration.FHConfig.HopPattern=le32_to_cpu(pnetwork->Configuration.FHConfig.HopPattern); ++ pnetwork->Configuration.FHConfig.HopSet=le32_to_cpu(pnetwork->Configuration.FHConfig.HopSet); ++ pnetwork->Configuration.FHConfig.Length=le32_to_cpu(pnetwork->Configuration.FHConfig.Length); ++ pnetwork->Configuration.Length = le32_to_cpu(pnetwork->Configuration.Length); ++ pnetwork->InfrastructureMode = le32_to_cpu(pnetwork->InfrastructureMode); ++ pnetwork->IELength = le32_to_cpu(pnetwork->IELength); ++#endif ++ + _enter_critical_bh(&pmlmepriv->lock, &irqL); + -+ { -+ _irqL irqL; ++ ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) ) ++ { ++ psta = rtw_get_stainfo(&padapter->stapriv, pnetwork->MacAddress); ++ if(!psta) ++ { ++ psta = rtw_alloc_stainfo(&padapter->stapriv, pnetwork->MacAddress); ++ if (psta == NULL) ++ { ++ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\nCan't alloc sta_info when createbss_cmd_callback\n")); ++ goto createbss_cmd_fail ; ++ } ++ } ++ ++ rtw_indicate_connect( padapter); ++ } ++ else ++ { ++ _irqL irqL; + + pwlan = _rtw_alloc_network(pmlmepriv); + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ if (pwlan == NULL) { ++ if ( pwlan == NULL) ++ { + pwlan = rtw_get_oldest_wlan_network(&pmlmepriv->scanned_queue); -+ if (pwlan == NULL) { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("Error: can't get pwlan in rtw_joinbss_event_callback\n")); ++ if( pwlan == NULL) ++ { ++ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\n Error: can't get pwlan in rtw_joinbss_event_callback \n")); + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + goto createbss_cmd_fail; + } + pwlan->last_scanned = rtw_get_current_time(); -+ } else { ++ } ++ else ++ { + rtw_list_insert_tail(&(pwlan->list), &pmlmepriv->scanned_queue.queue); + } + -+ pdev_network->Length = get_WLAN_BSSID_EX_sz(pdev_network); -+ _rtw_memcpy(&(pwlan->network), pdev_network, pdev_network->Length); -+ //pwlan->fixed = _TRUE; ++ pnetwork->Length = get_WLAN_BSSID_EX_sz(pnetwork); ++ _rtw_memcpy(&(pwlan->network), pnetwork, pnetwork->Length); ++ //pwlan->fixed = true; + -+ /* copy pdev_network information to pmlmepriv->cur_network */ -+ _rtw_memcpy(&mlme_cur_network->network, pdev_network, (get_WLAN_BSSID_EX_sz(pdev_network))); ++ //rtw_list_insert_tail(&(pwlan->list), &pmlmepriv->scanned_queue.queue); + -+ #if 0 -+ /* reset DSConfig */ -+ mlme_cur_network->network.Configuration.DSConfig = (u32)rtw_ch2freq(pdev_network->Configuration.DSConfig); -+ #endif ++ // copy pdev_network information to pmlmepriv->cur_network ++ _rtw_memcpy(&tgt_network->network, pnetwork, (get_WLAN_BSSID_EX_sz(pnetwork))); ++ ++ // reset DSConfig ++ //tgt_network->network.Configuration.DSConfig = (u32)rtw_ch2freq(pnetwork->Configuration.DSConfig); + + _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); + ++#if 0 ++ if((pmlmepriv->fw_state) & WIFI_AP_STATE) ++ { ++ psta = rtw_alloc_stainfo(&padapter->stapriv, pnetwork->MacAddress); ++ ++ if (psta == NULL) { // for AP Mode & Adhoc Master Mode ++ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\nCan't alloc sta_info when createbss_cmd_callback\n")); ++ goto createbss_cmd_fail ; ++ } ++ ++ rtw_indicate_connect( padapter); ++ } ++ else { ++ ++ //rtw_indicate_disconnect(dev); ++ } ++#endif + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ /* we will set _FW_LINKED when there is one more sat to join us (rtw_stassoc_event_callback) */ ++ // we will set _FW_LINKED when there is one more sat to join us (rtw_stassoc_event_callback) ++ + } + +createbss_cmd_fail: ++ + _exit_critical_bh(&pmlmepriv->lock, &irqL); -+exit: -+ return; ++ ++ rtw_free_cmd_obj(pcmd); ++ ++ ++ +} + + + +void rtw_setstaKey_cmdrsp_callback(_adapter* padapter , struct cmd_obj *pcmd) +{ -+ ++ + struct sta_priv * pstapriv = &padapter->stapriv; + struct set_stakey_rsp* psetstakey_rsp = (struct set_stakey_rsp*) (pcmd->rsp); + struct sta_info* psta = rtw_get_stainfo(pstapriv, psetstakey_rsp->addr); + -+_func_enter_; ++ + + if(psta==NULL) + { + RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\nERROR: rtw_setstaKey_cmdrsp_callback => can't get sta_info \n\n")); + goto exit; + } -+ ++ + //psta->aid = psta->mac_id = psetstakey_rsp->keyid; //CAM_ID(CAM_ENTRY) -+ -+exit: ++ ++exit: + + rtw_free_cmd_obj(pcmd); -+ -+_func_exit_; ++ ++ + +} +void rtw_setassocsta_cmdrsp_callback(_adapter* padapter, struct cmd_obj *pcmd) +{ + _irqL irqL; + struct sta_priv * pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct set_assocsta_parm* passocsta_parm = (struct set_assocsta_parm*)(pcmd->parmbuf); -+ struct set_assocsta_rsp* passocsta_rsp = (struct set_assocsta_rsp*) (pcmd->rsp); ++ struct set_assocsta_rsp* passocsta_rsp = (struct set_assocsta_rsp*) (pcmd->rsp); + struct sta_info* psta = rtw_get_stainfo(pstapriv, passocsta_parm->addr); + -+_func_enter_; -+ ++ ++ + if(psta==NULL) + { + RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\nERROR: setassocsta_cmdrsp_callbac => can't get sta_info \n\n")); + goto exit; + } -+ ++ + psta->aid = psta->mac_id = passocsta_rsp->cam_id; + + _enter_critical_bh(&pmlmepriv->lock, &irqL); + -+ if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) && (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE)) ++ if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) && (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true)) + _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); + + set_fwstate(pmlmepriv, _FW_LINKED); @@ -16561,32 +9112,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_cmd.c linux/3rdparty/rtl8812au/ +exit: + rtw_free_cmd_obj(pcmd); + -+_func_exit_; ++ +} + +void rtw_getrttbl_cmd_cmdrsp_callback(_adapter* padapter, struct cmd_obj *pcmd); +void rtw_getrttbl_cmd_cmdrsp_callback(_adapter* padapter, struct cmd_obj *pcmd) +{ -+_func_enter_; ++ + + rtw_free_cmd_obj(pcmd); +#ifdef CONFIG_MP_INCLUDED + if (padapter->registrypriv.mp_mode == 1) -+ padapter->mppriv.workparam.bcompleted=_TRUE; ++ padapter->mppriv.workparam.bcompleted=true; +#endif + -+_func_exit_; ++ + +} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812au/core/rtw_debug.c ---- linux.old/3rdparty/rtl8812au/core/rtw_debug.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_debug.c 2017-06-07 23:07:20.999686482 +0300 -@@ -0,0 +1,3853 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_debug.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_debug.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_debug.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_debug.c 2018-02-06 17:42:30.693966912 +0200 +@@ -0,0 +1,1209 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -16596,21 +9146,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_DEBUG_C_ + +#include -+#include -+ -+u32 GlobalDebugLevel = _drv_err_; + +#ifdef CONFIG_DEBUG_RTL871X + ++ u32 GlobalDebugLevel = _drv_err_; ++ + u64 GlobalDebugComponents = \ + _module_rtl871x_xmit_c_ | + _module_xmit_osdep_c_ | @@ -16642,428 +9186,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + _module_mp_ | + _module_efuse_; + -+#endif /* CONFIG_DEBUG_RTL871X */ -+ -+#include -+ -+#ifdef CONFIG_TDLS -+#define TDLS_DBG_INFO_SPACE_BTWN_ITEM_AND_VALUE 41 +#endif + -+void dump_drv_version(void *sel) -+{ -+ DBG_871X_SEL_NL(sel, "%s %s\n", DRV_NAME, DRIVERVERSION); -+ DBG_871X_SEL_NL(sel, "build time: %s %s\n", __DATE__, __TIME__); -+} -+ -+void dump_drv_cfg(void *sel) -+{ -+ char *kernel_version = utsname()->release; -+ -+ DBG_871X_SEL_NL(sel, "\nKernel Version: %s\n", kernel_version); -+ DBG_871X_SEL_NL(sel, "Driver Version: %s\n", DRIVERVERSION); -+ DBG_871X_SEL_NL(sel, "------------------------------------------------\n"); -+#ifdef CONFIG_IOCTL_CFG80211 -+ DBG_871X_SEL_NL(sel, "CFG80211\n"); -+ #ifdef RTW_USE_CFG80211_STA_EVENT -+ DBG_871X_SEL_NL(sel, "RTW_USE_CFG80211_STA_EVENT\n"); -+ #endif -+#else -+ DBG_871X_SEL_NL(sel, "WEXT\n"); -+#endif -+ -+ DBG_871X_SEL_NL(sel, "DBG:%d\n", DBG); -+#ifdef CONFIG_DEBUG -+ DBG_871X_SEL_NL(sel, "CONFIG_DEBUG\n"); -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ DBG_871X_SEL_NL(sel, "CONFIG_CONCURRENT_MODE\n"); -+#endif -+ -+#ifdef CONFIG_POWER_SAVING -+ DBG_871X_SEL_NL(sel, "CONFIG_POWER_SAVING\n"); -+#endif -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ DBG_871X_SEL_NL(sel, "LOAD_PHY_PARA_FROM_FILE - REALTEK_CONFIG_PATH=%s\n", REALTEK_CONFIG_PATH); -+ #ifdef CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY -+ DBG_871X_SEL_NL(sel, "CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY\n"); -+ #endif -+ #ifdef CONFIG_CALIBRATE_TX_POWER_TO_MAX -+ DBG_871X_SEL_NL(sel, "CONFIG_CALIBRATE_TX_POWER_TO_MAX\n"); -+ #endif -+#endif -+ -+#ifdef CONFIG_DISABLE_ODM -+ DBG_871X_SEL_NL(sel, "CONFIG_DISABLE_ODM\n"); -+#endif -+ -+#ifdef CONFIG_MINIMAL_MEMORY_USAGE -+ DBG_871X_SEL_NL(sel, "CONFIG_MINIMAL_MEMORY_USAGE\n"); -+#endif -+ -+ DBG_871X_SEL_NL(sel, "CONFIG_RTW_ADAPTIVITY_EN = %d\n", CONFIG_RTW_ADAPTIVITY_EN); -+#if (CONFIG_RTW_ADAPTIVITY_EN) -+ DBG_871X_SEL_NL(sel, "ADAPTIVITY_MODE = %s\n", (CONFIG_RTW_ADAPTIVITY_MODE) ? "carrier_sense" : "normal"); -+#endif -+ -+#ifdef CONFIG_WOWLAN -+ DBG_871X_SEL_NL(sel, "CONFIG_WOWLAN - "); -+ -+ #ifdef CONFIG_GPIO_WAKEUP -+ DBG_871X_SEL_NL(sel, "CONFIG_GPIO_WAKEUP - WAKEUP_GPIO_IDX:%d\n", WAKEUP_GPIO_IDX); -+ #endif -+#endif -+ -+#ifdef CONFIG_TDLS -+ DBG_871X_SEL_NL(sel, "CONFIG_TDLS\n"); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ #ifdef CONFIG_SUPPORT_USB_INT -+ DBG_871X_SEL_NL(sel, "CONFIG_SUPPORT_USB_INT\n"); -+ #endif -+ #ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+ DBG_871X_SEL_NL(sel, "CONFIG_USB_INTERRUPT_IN_PIPE\n"); -+ #endif -+ #ifdef CONFIG_USB_TX_AGGREGATION -+ DBG_871X_SEL_NL(sel, "CONFIG_USB_TX_AGGREGATION\n"); -+ #endif -+ #ifdef CONFIG_USB_RX_AGGREGATION -+ DBG_871X_SEL_NL(sel, "CONFIG_USB_RX_AGGREGATION\n"); -+ #endif -+ #ifdef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ DBG_871X_SEL_NL(sel, "CONFIG_USE_USB_BUFFER_ALLOC_TX\n"); -+ #endif -+ #ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ DBG_871X_SEL_NL(sel, "CONFIG_USE_USB_BUFFER_ALLOC_RX\n"); -+ #endif -+ #ifdef CONFIG_PREALLOC_RECV_SKB -+ DBG_871X_SEL_NL(sel, "CONFIG_PREALLOC_RECV_SKB\n"); -+ #endif -+ #ifdef CONFIG_FIX_NR_BULKIN_BUFFER -+ DBG_871X_SEL_NL(sel, "CONFIG_FIX_NR_BULKIN_BUFFER\n"); -+ #endif -+#endif /*CONFIG_USB_HCI*/ -+ -+#ifdef CONFIG_SDIO_HCI -+ #ifdef CONFIG_TX_AGGREGATION -+ DBG_871X_SEL_NL(sel, "CONFIG_TX_AGGREGATION\n"); -+ #endif -+ #ifdef CONFIG_RX_AGGREGATION -+ DBG_871X_SEL_NL(sel, "CONFIG_RX_AGGREGATION\n"); -+ #endif -+#endif /*CONFIG_SDIO_HCI*/ -+ -+#ifdef CONFIG_PCI_HCI -+#endif -+ -+ DBG_871X_SEL_NL(sel, "MAX_XMITBUF_SZ = %d\n", MAX_XMITBUF_SZ); -+ DBG_871X_SEL_NL(sel, "MAX_RECVBUF_SZ = %d\n", MAX_RECVBUF_SZ); -+ -+} -+ -+void dump_log_level(void *sel) -+{ -+ DBG_871X_SEL_NL(sel, "log_level:%d\n", GlobalDebugLevel); -+} -+ -+#ifdef CONFIG_SDIO_HCI -+void sd_f0_reg_dump(void *sel, _adapter *adapter) -+{ -+ int i; -+ -+ for(i=0x0;i<=0xff;i++) -+ { -+ if(i%16==0) -+ DBG_871X_SEL_NL(sel, "0x%02x ",i); -+ -+ DBG_871X_SEL(sel, "%02x ", rtw_sd_f0_read8(adapter, i)); -+ -+ if(i%16==15) -+ DBG_871X_SEL(sel, "\n"); -+ else if(i%8==7) -+ DBG_871X_SEL(sel, "\t"); -+ } -+} -+ -+void sdio_local_reg_dump(void *sel, _adapter *adapter) -+{ -+ int i, j = 1; -+ -+ for (i = 0x0; i < 0x100; i += 4) { -+ if (j % 4 == 1) -+ DBG_871X_SEL_NL(sel, "0x%02x", i); -+ DBG_871X_SEL(sel, " 0x%08x ", rtw_read32(adapter, (0x1025 << 16) | i)); -+ if ((j++) % 4 == 0) -+ DBG_871X_SEL(sel, "\n"); -+ } -+} -+#endif /* CONFIG_SDIO_HCI */ -+ -+void mac_reg_dump(void *sel, _adapter *adapter) -+{ -+ int i, j = 1; -+ -+ DBG_871X_SEL_NL(sel, "======= MAC REG =======\n"); -+ -+ for(i=0x0;i<0x800;i+=4) -+ { -+ if(j%4==1) -+ DBG_871X_SEL_NL(sel, "0x%03x",i); -+ DBG_871X_SEL(sel, " 0x%08x ", rtw_read32(adapter,i)); -+ if((j++)%4 == 0) -+ DBG_871X_SEL(sel, "\n"); -+ } -+ -+#ifdef CONFIG_RTL8814A -+ { -+ for(i=0x1000;i<0x1650;i+=4) -+ { -+ if(j%4==1) -+ DBG_871X_SEL_NL(sel, "0x%03x",i); -+ DBG_871X_SEL(sel, " 0x%08x ", rtw_read32(adapter,i)); -+ if((j++)%4 == 0) -+ DBG_871X_SEL(sel, "\n"); -+ } -+ } -+#endif /* CONFIG_RTL8814A */ -+} -+ -+void bb_reg_dump(void *sel, _adapter *adapter) -+{ -+ int i, j = 1; -+ -+ DBG_871X_SEL_NL(sel, "======= BB REG =======\n"); -+ for(i=0x800;i<0x1000;i+=4) -+ { -+ if(j%4==1) -+ DBG_871X_SEL_NL(sel, "0x%03x",i); -+ DBG_871X_SEL(sel, " 0x%08x ", rtw_read32(adapter,i)); -+ if((j++)%4 == 0) -+ DBG_871X_SEL(sel, "\n"); -+ } -+} -+ -+void rf_reg_dump(void *sel, _adapter *adapter) -+{ -+ int i, j = 1, path; -+ u32 value; -+ u8 rf_type = 0; -+ u8 path_nums = 0; -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if((RF_1T2R == rf_type) ||(RF_1T1R ==rf_type )) -+ path_nums = 1; -+ else -+ path_nums = 2; -+ -+ DBG_871X_SEL_NL(sel, "======= RF REG =======\n"); -+ -+ for (path=0;pathrecvpriv); -+ if( precvpriv->sink_udpport > 0) -+ { -+ if(*((u16*)((pkt->data)+0x24)) == cpu_to_be16(precvpriv->sink_udpport)) -+ { -+ precvpriv->pre_rtp_rxseq= precvpriv->cur_rtp_rxseq; -+ precvpriv->cur_rtp_rxseq = be16_to_cpu(*((u16*)((pkt->data)+0x2C))); -+ if( precvpriv->pre_rtp_rxseq+1 != precvpriv->cur_rtp_rxseq) -+ DBG_871X("%s : RTP Seq num from %d to %d\n",__FUNCTION__,precvpriv->pre_rtp_rxseq,precvpriv->cur_rtp_rxseq); -+ } -+ } -+} -+ -+void sta_rx_reorder_ctl_dump(void *sel, struct sta_info *sta) -+{ -+ struct recv_reorder_ctrl *reorder_ctl; -+ int i; -+ -+ for (i = 0; i < 16; i++) { -+ reorder_ctl = &sta->recvreorder_ctrl[i]; -+ if (reorder_ctl->ampdu_size != RX_AMPDU_SIZE_INVALID || reorder_ctl->indicate_seq != 0xFFFF) { -+ DBG_871X_SEL_NL(sel, "tid=%d, enable=%d, ampdu_size=%u, indicate_seq=%u\n" -+ , i, reorder_ctl->enable, reorder_ctl->ampdu_size, reorder_ctl->indicate_seq -+ ); -+ } -+ } -+} -+ -+void dump_adapters_status(void *sel, struct dvobj_priv *dvobj) -+{ -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ int i; -+ _adapter *iface; -+ u8 u_ch, u_bw, u_offset; -+ -+ DBG_871X_SEL_NL(sel, "%-2s %-8s %-17s %-4s %-7s %s\n" -+ , "id", "ifname", "macaddr", "port", "ch", "status"); -+ -+ DBG_871X_SEL_NL(sel, "------------------------------------------\n"); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface) { -+ DBG_871X_SEL_NL(sel, "%2d %-8s "MAC_FMT" %4hhu %3u,%u,%u "MLME_STATE_FMT" %s%s\n" -+ , i, ADPT_ARG(iface) -+ , MAC_ARG(adapter_mac_addr(iface)) -+ , get_iface_type(iface) -+ , iface->mlmeextpriv.cur_channel -+ , iface->mlmeextpriv.cur_bwmode -+ , iface->mlmeextpriv.cur_ch_offset -+ , ADPT_MLME_S_ARG(iface) -+ , rtw_is_surprise_removed(iface)?" SR":"" -+ , rtw_is_drv_stopped(iface)?" DS":"" -+ ); -+ } -+ } -+ -+ DBG_871X_SEL_NL(sel, "------------------------------------------\n"); -+ -+ rtw_get_ch_setting_union(dvobj->padapters[IFACE_ID0], &u_ch, &u_bw, &u_offset); -+ DBG_871X_SEL_NL(sel, "%34s %3u,%u,%u\n" -+ , "union:" -+ , u_ch, u_bw, u_offset -+ ); -+ -+ DBG_871X_SEL_NL(sel, "%34s %3u,%u,%u\n" -+ , "oper:" -+ , dvobj->oper_channel -+ , dvobj->oper_bwmode -+ , dvobj->oper_ch_offset -+ ); -+ -+ #ifdef CONFIG_DFS_MASTER -+ if (rfctl->radar_detect_ch != 0) { -+ DBG_871X_SEL_NL(sel, "%34s %3u,%u,%u" -+ , "radar_detect:" -+ , rfctl->radar_detect_ch -+ , rfctl->radar_detect_bw -+ , rfctl->radar_detect_offset -+ ); -+ -+ if (IS_UNDER_CAC(rfctl)) -+ DBG_871X_SEL(sel, ", cac:%d\n", rtw_systime_to_ms(rfctl->cac_end_time - rtw_get_current_time())); -+ else -+ DBG_871X_SEL(sel, "\n"); -+ } -+ #endif -+} -+ -+#define SEC_CAM_ENT_ID_TITLE_FMT "%-2s" -+#define SEC_CAM_ENT_ID_TITLE_ARG "id" -+#define SEC_CAM_ENT_ID_VALUE_FMT "%2u" -+#define SEC_CAM_ENT_ID_VALUE_ARG(id) (id) -+ -+#define SEC_CAM_ENT_TITLE_FMT "%-6s %-17s %-32s %-3s %-7s %-2s %-2s %-5s" -+#define SEC_CAM_ENT_TITLE_ARG "ctrl", "addr", "key", "kid", "type", "MK", "GK", "valid" -+#define SEC_CAM_ENT_VALUE_FMT "0x%04x "MAC_FMT" "KEY_FMT" %3u %-7s %2u %2u %5u" -+#define SEC_CAM_ENT_VALUE_ARG(ent) \ -+ (ent)->ctrl \ -+ , MAC_ARG((ent)->mac) \ -+ , KEY_ARG((ent)->key) \ -+ , ((ent)->ctrl) & 0x03 \ -+ , security_type_str((((ent)->ctrl) >> 2) & 0x07) \ -+ , (((ent)->ctrl) >> 5) & 0x01 \ -+ , (((ent)->ctrl) >> 6) & 0x01 \ -+ , (((ent)->ctrl) >> 15) & 0x01 -+ -+void dump_sec_cam_ent(void *sel, struct sec_cam_ent *ent, int id) -+{ -+ if (id >= 0) { -+ DBG_871X_SEL_NL(sel, SEC_CAM_ENT_ID_VALUE_FMT " " SEC_CAM_ENT_VALUE_FMT"\n" -+ , SEC_CAM_ENT_ID_VALUE_ARG(id), SEC_CAM_ENT_VALUE_ARG(ent)); -+ } else { -+ DBG_871X_SEL_NL(sel, SEC_CAM_ENT_VALUE_FMT"\n", SEC_CAM_ENT_VALUE_ARG(ent)); -+ } -+} -+ -+void dump_sec_cam_ent_title(void *sel, u8 has_id) -+{ -+ if (has_id) { -+ DBG_871X_SEL_NL(sel, SEC_CAM_ENT_ID_TITLE_FMT " " SEC_CAM_ENT_TITLE_FMT"\n" -+ , SEC_CAM_ENT_ID_TITLE_ARG, SEC_CAM_ENT_TITLE_ARG); -+ } else { -+ DBG_871X_SEL_NL(sel, SEC_CAM_ENT_TITLE_FMT"\n", SEC_CAM_ENT_TITLE_ARG); -+ } -+} -+ -+void dump_sec_cam(void *sel, _adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ struct sec_cam_ent ent; -+ int i; -+ -+ DBG_871X_SEL_NL(sel, "HW sec cam:\n"); -+ dump_sec_cam_ent_title(sel, 1); -+ for (i = 0; i < cam_ctl->num; i++) { -+ rtw_sec_read_cam_ent(adapter, i, (u8 *)(&ent.ctrl), ent.mac, ent.key); -+ dump_sec_cam_ent(sel , &ent, i); -+ } -+} -+ +#ifdef CONFIG_PROC_DEBUG -+ssize_t proc_set_write_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++#include ++ ++int proc_get_drv_version(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ + struct net_device *dev = data; ++ ++ int len = 0; ++ ++ len += snprintf(page + len, count - len, "%s\n", DRIVERVERSION); ++ ++ *eof = 1; ++ return len; ++} ++ ++int proc_get_write_reg(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) ++{ ++ *eof = 1; ++ return 0; ++} ++ ++int proc_set_write_reg(struct file *file, const char *buffer, ++ unsigned long count, void *data) ++{ ++ struct net_device *dev = (struct net_device *)data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u32 addr, val, len; @@ -17072,14 +9225,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + { + DBG_871X("argument size is less than 3\n"); + return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; + } + -+ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { + + int num = sscanf(tmp, "%x %x %x", &addr, &val, &len); + @@ -17091,60 +9239,67 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + switch(len) + { + case 1: -+ rtw_write8(padapter, addr, (u8)val); ++ rtw_write8(padapter, addr, (u8)val); + break; + case 2: -+ rtw_write16(padapter, addr, (u16)val); ++ rtw_write16(padapter, addr, (u16)val); + break; + case 4: -+ rtw_write32(padapter, addr, val); ++ rtw_write32(padapter, addr, val); + break; + default: + DBG_871X("error write length=%d", len); + break; -+ } -+ ++ } ++ + } -+ ++ + return count; -+ ++ +} + +static u32 proc_get_read_addr=0xeeeeeeee; +static u32 proc_get_read_len=0x4; + -+int proc_get_read_reg(struct seq_file *m, void *v) ++int proc_get_read_reg(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + -+ if (proc_get_read_addr==0xeeeeeeee) { -+ DBG_871X_SEL_NL(m, "address not initialized\n"); -+ return 0; -+ } ++ int len = 0; ++ ++ if(proc_get_read_addr==0xeeeeeeee) ++ { ++ *eof = 1; ++ return len; ++ } + + switch(proc_get_read_len) + { -+ case 1: -+ DBG_871X_SEL_NL(m, "rtw_read8(0x%x)=0x%x\n", proc_get_read_addr, rtw_read8(padapter, proc_get_read_addr)); ++ case 1: ++ len += snprintf(page + len, count - len, "rtw_read8(0x%x)=0x%x\n", proc_get_read_addr, rtw_read8(padapter, proc_get_read_addr)); + break; + case 2: -+ DBG_871X_SEL_NL(m, "rtw_read16(0x%x)=0x%x\n", proc_get_read_addr, rtw_read16(padapter, proc_get_read_addr)); ++ len += snprintf(page + len, count - len, "rtw_read16(0x%x)=0x%x\n", proc_get_read_addr, rtw_read16(padapter, proc_get_read_addr)); + break; + case 4: -+ DBG_871X_SEL_NL(m, "rtw_read32(0x%x)=0x%x\n", proc_get_read_addr, rtw_read32(padapter, proc_get_read_addr)); ++ len += snprintf(page + len, count - len, "rtw_read32(0x%x)=0x%x\n", proc_get_read_addr, rtw_read32(padapter, proc_get_read_addr)); + break; + default: -+ DBG_871X_SEL_NL(m, "error read length=%d\n", proc_get_read_len); ++ len += snprintf(page + len, count - len, "error read length=%d\n", proc_get_read_len); + break; + } + -+ return 0; ++ *eof = 1; ++ return len; ++ +} + -+ssize_t proc_set_read_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_set_read_reg(struct file *file, const char *buffer, ++ unsigned long count, void *data) +{ -+ struct net_device *dev = data; + char tmp[16]; + u32 addr, len; + @@ -17152,14 +9307,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + { + DBG_871X("argument size is less than 2\n"); + return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; + } + -+ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { + + int num = sscanf(tmp, "%x %x", &addr, &len); + @@ -17169,1304 +9319,484 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + } + + proc_get_read_addr = addr; -+ ++ + proc_get_read_len = len; + } -+ ++ + return count; + +} + -+int proc_get_fwstate(struct seq_file *m, void *v) ++int proc_get_fwstate(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + -+ DBG_871X_SEL_NL(m, "fwstate=0x%x\n", get_fwstate(pmlmepriv)); ++ int len = 0; + -+ return 0; ++ len += snprintf(page + len, count - len, "fwstate=0x%x\n", get_fwstate(pmlmepriv)); ++ ++ *eof = 1; ++ return len; +} + -+int proc_get_sec_info(struct seq_file *m, void *v) ++int proc_get_sec_info(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct security_priv *sec = &padapter->securitypriv; ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; + -+ DBG_871X_SEL_NL(m, "auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", -+ sec->dot11AuthAlgrthm, sec->dot11PrivacyAlgrthm, -+ sec->ndisauthtype, sec->ndisencryptstatus); ++ int len = 0; + -+ DBG_871X_SEL_NL(m, "hw_decrypted=%d\n", sec->hw_decrypted); ++ len += snprintf(page + len, count - len, "auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", ++ psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, ++ psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus); + -+#ifdef DBG_SW_SEC_CNT -+ DBG_871X_SEL_NL(m, "wep_sw_enc_cnt=%llu, %llu, %llu\n" -+ , sec->wep_sw_enc_cnt_bc , sec->wep_sw_enc_cnt_mc, sec->wep_sw_enc_cnt_uc); -+ DBG_871X_SEL_NL(m, "wep_sw_dec_cnt=%llu, %llu, %llu\n" -+ , sec->wep_sw_dec_cnt_bc , sec->wep_sw_dec_cnt_mc, sec->wep_sw_dec_cnt_uc); -+ -+ DBG_871X_SEL_NL(m, "tkip_sw_enc_cnt=%llu, %llu, %llu\n" -+ , sec->tkip_sw_enc_cnt_bc , sec->tkip_sw_enc_cnt_mc, sec->tkip_sw_enc_cnt_uc); -+ DBG_871X_SEL_NL(m, "tkip_sw_dec_cnt=%llu, %llu, %llu\n" -+ , sec->tkip_sw_dec_cnt_bc , sec->tkip_sw_dec_cnt_mc, sec->tkip_sw_dec_cnt_uc); -+ -+ DBG_871X_SEL_NL(m, "aes_sw_enc_cnt=%llu, %llu, %llu\n" -+ , sec->aes_sw_enc_cnt_bc , sec->aes_sw_enc_cnt_mc, sec->aes_sw_enc_cnt_uc); -+ DBG_871X_SEL_NL(m, "aes_sw_dec_cnt=%llu, %llu, %llu\n" -+ , sec->aes_sw_dec_cnt_bc , sec->aes_sw_dec_cnt_mc, sec->aes_sw_dec_cnt_uc); -+#endif /* DBG_SW_SEC_CNT */ -+ -+ return 0; ++ *eof = 1; ++ return len; +} + -+int proc_get_mlmext_state(struct seq_file *m, void *v) ++int proc_get_mlmext_state(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + -+ DBG_871X_SEL_NL(m, "pmlmeinfo->state=0x%x\n", pmlmeinfo->state); ++ int len = 0; + -+ return 0; ++ len += snprintf(page + len, count - len, "pmlmeinfo->state=0x%x\n", pmlmeinfo->state); ++ ++ *eof = 1; ++ return len; +} + -+#ifdef CONFIG_LAYER2_ROAMING -+int proc_get_roam_flags(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X_SEL_NL(m, "0x%02x\n", rtw_roam_flags(adapter)); -+ -+ return 0; -+} -+ -+ssize_t proc_set_roam_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_get_qos_option(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ + struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ char tmp[32]; -+ u8 flags; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx", &flags); -+ -+ if (num == 1) -+ rtw_assign_roam_flags(adapter, flags); -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_roam_param(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ -+ DBG_871X_SEL_NL(m, "%12s %12s %11s\n", "rssi_diff_th", "scanr_exp_ms", "scan_int_ms"); -+ DBG_871X_SEL_NL(m, "%-12u %-12u %-11u\n" -+ , mlme->roam_rssi_diff_th -+ , mlme->roam_scanr_exp_ms -+ , mlme->roam_scan_int_ms -+ ); -+ -+ return 0; -+} -+ -+ssize_t proc_set_roam_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ -+ char tmp[32]; -+ u8 rssi_diff_th; -+ u32 scanr_exp_ms; -+ u32 scan_int_ms; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhu %u %u", &rssi_diff_th, &scanr_exp_ms, &scan_int_ms); -+ -+ if (num >= 1) -+ mlme->roam_rssi_diff_th = rssi_diff_th; -+ if (num >= 2) -+ mlme->roam_scanr_exp_ms = scanr_exp_ms; -+ if (num >= 3) -+ mlme->roam_scan_int_ms = scan_int_ms; -+ } -+ -+ return count; -+ -+} -+ -+ssize_t proc_set_roam_tgt_addr(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ char tmp[32]; -+ u8 addr[ETH_ALEN]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx:%hhx:%hhx:%hhx:%hhx:%hhx", addr, addr+1, addr+2, addr+3, addr+4, addr+5); -+ if (num == 6) -+ _rtw_memcpy(adapter->mlmepriv.roam_tgt_addr, addr, ETH_ALEN); -+ -+ DBG_871X("set roam_tgt_addr to "MAC_FMT"\n", MAC_ARG(adapter->mlmepriv.roam_tgt_addr)); -+ } -+ -+ return count; -+} -+#endif /* CONFIG_LAYER2_ROAMING */ -+ -+int proc_get_qos_option(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + -+ DBG_871X_SEL_NL(m, "qos_option=%d\n", pmlmepriv->qospriv.qos_option); ++ int len = 0; ++ ++ len += snprintf(page + len, count - len, "qos_option=%d\n", pmlmepriv->qospriv.qos_option); ++ ++ *eof = 1; ++ return len; + -+ return 0; +} + -+int proc_get_ht_option(struct seq_file *m, void *v) ++int proc_get_ht_option(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ ++ ++ int len = 0; +#ifdef CONFIG_80211N_HT -+ DBG_871X_SEL_NL(m, "ht_option=%d\n", pmlmepriv->htpriv.ht_option); ++ len += snprintf(page + len, count - len, "ht_option=%d\n", pmlmepriv->htpriv.ht_option); +#endif //CONFIG_80211N_HT -+ -+ return 0; ++ *eof = 1; ++ return len; +} + -+int proc_get_rf_info(struct seq_file *m, void *v) ++int proc_get_rf_info(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ int len = 0; + -+ DBG_871X_SEL_NL(m, "cur_ch=%d, cur_bw=%d, cur_ch_offet=%d\n", ++ len += snprintf(page + len, count - len, "cur_ch=%d, cur_bw=%d, cur_ch_offet=%d\n", + pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ -+ DBG_871X_SEL_NL(m, "oper_ch=%d, oper_bw=%d, oper_ch_offet=%d\n", ++ ++ len += snprintf(page + len, count - len, "oper_ch=%d, oper_bw=%d, oper_ch_offet=%d\n", + rtw_get_oper_ch(padapter), rtw_get_oper_bw(padapter), rtw_get_oper_choffset(padapter)); + -+ return 0; ++ *eof = 1; ++ return len; ++ +} + -+int proc_get_scan_param(struct seq_file *m, void *v) ++int proc_get_ap_info(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ struct ss_res *ss = &mlmeext->sitesurvey_res; -+ -+#define SCAN_PARAM_TITLE_FMT "%10s" -+#define SCAN_PARAM_VALUE_FMT "%-10u" -+#define SCAN_PARAM_TITLE_ARG , "scan_ch_ms" -+#define SCAN_PARAM_VALUE_ARG , ss->scan_ch_ms -+#ifdef CONFIG_80211N_HT -+ #define SCAN_PARAM_TITLE_FMT_HT " %15s %13s" -+ #define SCAN_PARAM_VALUE_FMT_HT " %-15u %-13u" -+ #define SCAN_PARAM_TITLE_ARG_HT , "rx_ampdu_accept", "rx_ampdu_size" -+ #define SCAN_PARAM_VALUE_ARG_HT , ss->rx_ampdu_accept, ss->rx_ampdu_size -+#else -+ #define SCAN_PARAM_TITLE_FMT_HT "" -+ #define SCAN_PARAM_VALUE_FMT_HT "" -+ #define SCAN_PARAM_TITLE_ARG_HT -+ #define SCAN_PARAM_VALUE_ARG_HT -+#endif -+#ifdef CONFIG_SCAN_BACKOP -+ #define SCAN_PARAM_TITLE_FMT_BACKOP " %9s %12s" -+ #define SCAN_PARAM_VALUE_FMT_BACKOP " %-9u %-12u" -+ #define SCAN_PARAM_TITLE_ARG_BACKOP , "backop_ms", "scan_cnt_max" -+ #define SCAN_PARAM_VALUE_ARG_BACKOP , ss->backop_ms, ss->scan_cnt_max -+#else -+ #define SCAN_PARAM_TITLE_FMT_BACKOP "" -+ #define SCAN_PARAM_VALUE_FMT_BACKOP "" -+ #define SCAN_PARAM_TITLE_ARG_BACKOP -+ #define SCAN_PARAM_VALUE_ARG_BACKOP -+#endif -+ -+ DBG_871X_SEL_NL(m, -+ SCAN_PARAM_TITLE_FMT -+ SCAN_PARAM_TITLE_FMT_HT -+ SCAN_PARAM_TITLE_FMT_BACKOP -+ "\n" -+ SCAN_PARAM_TITLE_ARG -+ SCAN_PARAM_TITLE_ARG_HT -+ SCAN_PARAM_TITLE_ARG_BACKOP -+ ); -+ -+ DBG_871X_SEL_NL(m, -+ SCAN_PARAM_VALUE_FMT -+ SCAN_PARAM_VALUE_FMT_HT -+ SCAN_PARAM_VALUE_FMT_BACKOP -+ "\n" -+ SCAN_PARAM_VALUE_ARG -+ SCAN_PARAM_VALUE_ARG_HT -+ SCAN_PARAM_VALUE_ARG_BACKOP -+ ); -+ -+ return 0; -+} -+ -+ssize_t proc_set_scan_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ struct ss_res *ss = &mlmeext->sitesurvey_res; -+ -+ char tmp[32] = {0}; -+ -+u16 scan_ch_ms; -+#define SCAN_PARAM_INPUT_FMT "%hu" -+#define SCAN_PARAM_INPUT_ARG , &scan_ch_ms -+#ifdef CONFIG_80211N_HT -+ u8 rx_ampdu_accept; -+ u8 rx_ampdu_size; -+ #define SCAN_PARAM_INPUT_FMT_HT " %hhu %hhu" -+ #define SCAN_PARAM_INPUT_ARG_HT , &rx_ampdu_accept, &rx_ampdu_size -+#else -+ #define SCAN_PARAM_INPUT_FMT_HT "" -+ #define SCAN_PARAM_INPUT_ARG_HT -+#endif -+#ifdef CONFIG_SCAN_BACKOP -+ u16 backop_ms; -+ u8 scan_cnt_max; -+ #define SCAN_PARAM_INPUT_FMT_BACKOP " %hu %hhu" -+ #define SCAN_PARAM_INPUT_ARG_BACKOP , &backop_ms, &scan_cnt_max -+#else -+ #define SCAN_PARAM_INPUT_FMT_BACKOP "" -+ #define SCAN_PARAM_INPUT_ARG_BACKOP -+#endif -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, -+ SCAN_PARAM_INPUT_FMT -+ SCAN_PARAM_INPUT_FMT_HT -+ SCAN_PARAM_INPUT_FMT_BACKOP -+ SCAN_PARAM_INPUT_ARG -+ SCAN_PARAM_INPUT_ARG_HT -+ SCAN_PARAM_INPUT_ARG_BACKOP -+ ); -+ -+ if (num-- > 0) -+ ss->scan_ch_ms = scan_ch_ms; -+ #ifdef CONFIG_80211N_HT -+ if (num-- > 0) -+ ss->rx_ampdu_accept = rx_ampdu_accept; -+ if (num-- > 0) -+ ss->rx_ampdu_size = rx_ampdu_size; -+ #endif -+ #ifdef CONFIG_SCAN_BACKOP -+ if (num-- > 0) -+ ss->backop_ms = backop_ms; -+ if (num-- > 0) -+ ss->scan_cnt_max = scan_cnt_max; -+ #endif -+ } -+ -+ return count; -+} -+ -+int proc_get_scan_abort(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ u32 pass_ms; -+ -+ pass_ms = rtw_scan_abort_timeout(adapter, 10000); -+ -+ DBG_871X_SEL_NL(m, "%u\n", pass_ms); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_SCAN_BACKOP -+int proc_get_backop_flags_sta(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ -+ DBG_871X_SEL_NL(m, "0x%02x\n", mlmeext_scan_backop_flags_sta(mlmeext)); -+ -+ return 0; -+} -+ -+ssize_t proc_set_backop_flags_sta(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ -+ char tmp[32]; -+ u8 flags; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx", &flags); -+ -+ if (num == 1) -+ mlmeext_assign_scan_backop_flags_sta(mlmeext, flags); -+ } -+ -+ return count; -+} -+ -+int proc_get_backop_flags_ap(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ -+ DBG_871X_SEL_NL(m, "0x%02x\n", mlmeext_scan_backop_flags_ap(mlmeext)); -+ -+ return 0; -+} -+ -+ssize_t proc_set_backop_flags_ap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ -+ char tmp[32]; -+ u8 flags; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx", &flags); -+ -+ if (num == 1) -+ mlmeext_assign_scan_backop_flags_ap(mlmeext, flags); -+ } -+ -+ return count; -+} -+ -+#endif /* CONFIG_SCAN_BACKOP */ -+ -+int proc_get_survey_info(struct seq_file *m, void *v) -+{ -+ _irqL irqL; -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ _list *plist, *phead; -+ s32 notify_signal; -+ s16 notify_noise = 0; -+ u16 index = 0, ie_cap = 0; -+ unsigned char *ie_wpa = NULL, *ie_wpa2 = NULL, *ie_wps = NULL; -+ unsigned char *ie_p2p = NULL, *ssid = NULL; -+ char flag_str[64]; -+ int ielen = 0; -+ u32 wpsielen = 0; -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ phead = get_list_head(queue); -+ if(!phead) -+ return 0; -+ plist = get_next(phead); -+ if (!plist) -+ return 0; -+ -+ DBG_871X_SEL_NL(m, "%5s %-17s %3s %-3s %-4s %-4s %5s %32s %32s\n", "index", "bssid", "ch", "RSSI", "SdBm", "Noise", "age", "flag", "ssid"); -+ while(1) -+ { -+ if (rtw_end_of_queue_search(phead,plist)== _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (!pnetwork) -+ break; -+ -+ if ( check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE && -+ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { -+ notify_signal = translate_percentage_to_dbm(padapter->recvpriv.signal_strength);//dbm -+ } else { -+ notify_signal = translate_percentage_to_dbm(pnetwork->network.PhyInfo.SignalStrength);//dbm -+ } -+ -+ #if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR,&(pnetwork->network.Configuration.DSConfig), &(notify_noise)); -+ #endif -+ -+ ie_wpa = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &ielen, pnetwork->network.IELength-12); -+ ie_wpa2 = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &ielen, pnetwork->network.IELength-12); -+ ie_cap = rtw_get_capability(&pnetwork->network); -+ ie_wps = rtw_get_wps_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength-12, NULL, &wpsielen); -+ ie_p2p = rtw_get_p2p_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength-12, NULL, &ielen); -+ ssid = pnetwork->network.Ssid.Ssid; -+ sprintf(flag_str, "%s%s%s%s%s%s%s", -+ (ie_wpa) ? "[WPA]":"", -+ (ie_wpa2) ? "[WPA2]":"", -+ (!ie_wpa && !ie_wpa && ie_cap & BIT(4)) ? "[WEP]":"", -+ (ie_wps) ? "[WPS]":"", -+ (pnetwork->network.InfrastructureMode == Ndis802_11IBSS) ? "[IBSS]":"", -+ (ie_cap & BIT(0)) ? "[ESS]":"", -+ (ie_p2p) ? "[P2P]":""); -+ DBG_871X_SEL_NL(m, "%5d "MAC_FMT" %3d %3d %4d %4d %5d %32s %32s\n", -+ ++index, -+ MAC_ARG(pnetwork->network.MacAddress), -+ pnetwork->network.Configuration.DSConfig, -+ (int)pnetwork->network.Rssi, -+ notify_signal, -+ notify_noise, -+ rtw_get_passing_time_ms((u32)pnetwork->last_scanned), -+ flag_str, -+ pnetwork->network.Ssid.Ssid); -+ plist = get_next(plist); -+ } -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ return 0; -+} -+ -+ssize_t proc_set_survey_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ _irqL irqL; -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ bool need_indicate_scan_done = _FALSE; -+ u8 _status = _FALSE; -+ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+#ifdef CONFIG_MP_INCLUDED -+ if ((padapter->registrypriv.mp_mode == 1) -+#ifdef CONFIG_CONCURRENT_MODE -+ || ((padapter->pbuddy_adapter) && (padapter->pbuddy_adapter->registrypriv.mp_mode == 1)) -+#endif -+ ){ -+ DBG_871X(FUNC_ADPT_FMT ": MP mode block Scan request\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+#endif -+ rtw_ps_deny(padapter, PS_DENY_SCAN); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) -+ goto exit; -+ -+ if (rtw_is_drv_stopped(padapter)) { -+ DBG_871X("scan abort!! bDriverStopped=_TRUE\n"); -+ goto exit; -+ } -+ -+ if (!padapter->bup) { -+ DBG_871X("scan abort!! bup=%d\n", padapter->bup); -+ goto exit; -+ } -+ -+ if (!rtw_is_hw_init_completed(padapter)) { -+ DBG_871X("scan abort!! hw_init_completed=FALSE\n"); -+ goto exit; -+ } -+ -+ if (rtw_is_scan_deny(padapter)) { -+ DBG_871X(FUNC_ADPT_FMT ": scan deny\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ -+ if ((pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE) -+#ifdef CONFIG_CONCURRENT_MODE -+ || (rtw_get_buddy_bBusyTraffic(padapter) == _TRUE) -+#endif -+ ) { -+ DBG_871X("scan abort!! BusyTraffic == _TRUE\n"); -+ goto exit; -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == _TRUE) { -+ DBG_8192C("scan abort!! fwstate=0x%x\n", pmlmepriv->fw_state); -+ goto exit; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, -+ _FW_UNDER_SURVEY|_FW_UNDER_LINKING|WIFI_UNDER_WPS) == _TRUE) { -+ DBG_871X("scan abort!! buddy_fwstate=0x%x\n", -+ get_fwstate(&(padapter->pbuddy_adapter->mlmepriv))); -+ goto exit; -+ } -+#endif -+ _status = rtw_set_802_11_bssid_list_scan(padapter, NULL, 0); -+ -+exit: -+ rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); -+ return count; -+} -+ -+int proc_get_ap_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; + struct sta_info *psta; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct wlan_network *cur_network = &(pmlmepriv->cur_network); + struct sta_priv *pstapriv = &padapter->stapriv; ++ int len = 0; + + psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); + if(psta) + { + int i; + struct recv_reorder_ctrl *preorder_ctrl; -+ -+ DBG_871X_SEL_NL(m, "SSID=%s\n", cur_network->network.Ssid.Ssid); -+ DBG_871X_SEL_NL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ DBG_871X_SEL_NL(m, "cur_channel=%d, cur_bwmode=%d, cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ DBG_871X_SEL_NL(m, "wireless_mode=0x%x, rtsen=%d, cts2slef=%d\n", psta->wireless_mode, psta->rtsen, psta->cts2self); -+ DBG_871X_SEL_NL(m, "state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); -+#ifdef CONFIG_80211N_HT -+ DBG_871X_SEL_NL(m, "qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ DBG_871X_SEL_NL(m, "bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); -+ DBG_871X_SEL_NL(m, "ampdu_enable = %d\n", psta->htpriv.ampdu_enable); -+ DBG_871X_SEL_NL(m, "agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); -+ DBG_871X_SEL_NL(m, "ldpc_cap=0x%x, stbc_cap=0x%x, beamform_cap=0x%x\n", psta->htpriv.ldpc_cap, psta->htpriv.stbc_cap, psta->htpriv.beamform_cap); -+#endif //CONFIG_80211N_HT -+#ifdef CONFIG_80211AC_VHT -+ DBG_871X_SEL_NL(m, "vht_en=%d, vht_sgi_80m=%d\n", psta->vhtpriv.vht_option, psta->vhtpriv.sgi_80m); -+ DBG_871X_SEL_NL(m, "vht_ldpc_cap=0x%x, vht_stbc_cap=0x%x, vht_beamform_cap=0x%x\n", psta->vhtpriv.ldpc_cap, psta->vhtpriv.stbc_cap, psta->vhtpriv.beamform_cap); -+ DBG_871X_SEL_NL(m, "vht_mcs_map=0x%x, vht_highest_rate=0x%x, vht_ampdu_len=%d\n", *(u16*)psta->vhtpriv.vht_mcs_map, psta->vhtpriv.vht_highest_rate, psta->vhtpriv.ampdu_len); -+#endif + -+ sta_rx_reorder_ctl_dump(m, psta); ++ len += snprintf(page + len, count - len, "SSID=%s\n", cur_network->network.Ssid.Ssid); ++ len += snprintf(page + len, count - len, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); ++ len += snprintf(page + len, count - len, "cur_channel=%d, cur_bwmode=%d, cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); ++ len += snprintf(page + len, count - len, "rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); ++ len += snprintf(page + len, count - len, "state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); ++#ifdef CONFIG_80211N_HT ++ len += snprintf(page + len, count - len, "qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); ++ len += snprintf(page + len, count - len, "bwmode=%d, ch_offset=%d, sgi=%d\n", psta->htpriv.bwmode, psta->htpriv.ch_offset, psta->htpriv.sgi); ++ len += snprintf(page + len, count - len, "ampdu_enable = %d\n", psta->htpriv.ampdu_enable); ++ len += snprintf(page + len, count - len, "agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); ++#endif //CONFIG_80211N_HT ++ ++ for(i=0;i<16;i++) ++ { ++ preorder_ctrl = &psta->recvreorder_ctrl[i]; ++ if(preorder_ctrl->enable) ++ { ++ len += snprintf(page + len, count - len, "tid=%d, indicate_seq=%d\n", i, preorder_ctrl->indicate_seq); ++ } ++ } ++ + } + else -+ { -+ DBG_871X_SEL_NL(m, "can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); ++ { ++ len += snprintf(page + len, count - len, "can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); + } + -+ return 0; ++ *eof = 1; ++ return len; ++ +} + -+ssize_t proc_reset_trx_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_get_adapter_state(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ char cmd[32] = {0}; -+ u8 cnt = 0; ++ int len = 0; + -+ if (count > sizeof(cmd)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } ++ len += snprintf(page + len, count - len, "bSurpriseRemoved=%d, bDriverStopped=%d\n", ++ padapter->bSurpriseRemoved, padapter->bDriverStopped); + -+ if (buffer && !copy_from_user(cmd, buffer, count)) { -+ int num = sscanf(cmd, "%hhx", &cnt); ++ *eof = 1; ++ return len; + -+ if (0 == cnt) { -+ pdbgpriv->dbg_rx_ampdu_drop_count = 0; -+ pdbgpriv->dbg_rx_ampdu_forced_indicate_count = 0; -+ pdbgpriv->dbg_rx_ampdu_loss_count = 0; -+ pdbgpriv->dbg_rx_dup_mgt_frame_drop_count = 0; -+ pdbgpriv->dbg_rx_ampdu_window_shift_cnt = 0; -+ pdbgpriv->dbg_rx_conflic_mac_addr_cnt = 0; -+ } -+ } -+ -+ return count; +} -+ -+int proc_get_trx_info(struct seq_file *m, void *v) ++ ++int proc_get_trx_info(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; + int i; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; + struct hw_xmit *phwxmit; ++ int len = 0; + -+ dump_os_queue(m, padapter); ++ len += snprintf(page + len, count - len, "free_xmitbuf_cnt=%d, free_xmitframe_cnt=%d" ++ ", free_ext_xmitbuf_cnt=%d, free_xframe_ext_cnt=%d" ++ ", free_recvframe_cnt=%d\n", ++ pxmitpriv->free_xmitbuf_cnt, pxmitpriv->free_xmitframe_cnt, ++ pxmitpriv->free_xmit_extbuf_cnt, pxmitpriv->free_xframe_ext_cnt, ++ precvpriv->free_recvframe_cnt); + -+ DBG_871X_SEL_NL(m, "free_xmitbuf_cnt=%d, free_xmitframe_cnt=%d\n" -+ , pxmitpriv->free_xmitbuf_cnt, pxmitpriv->free_xmitframe_cnt); -+ DBG_871X_SEL_NL(m, "free_ext_xmitbuf_cnt=%d, free_xframe_ext_cnt=%d\n" -+ , pxmitpriv->free_xmit_extbuf_cnt, pxmitpriv->free_xframe_ext_cnt); -+ DBG_871X_SEL_NL(m, "free_recvframe_cnt=%d\n" -+ , precvpriv->free_recvframe_cnt); -+ -+ for(i = 0; i < 4; i++) ++ for(i = 0; i < 4; i++) + { + phwxmit = pxmitpriv->hwxmits + i; -+ DBG_871X_SEL_NL(m, "%d, hwq.accnt=%d\n", i, phwxmit->accnt); ++ len += snprintf(page + len, count - len, "%d, hwq.accnt=%d\n", i, phwxmit->accnt); + } + -+#ifdef CONFIG_USB_HCI -+ DBG_871X_SEL_NL(m, "rx_urb_pending_cn=%d\n", ATOMIC_READ(&(precvpriv->rx_pending_cnt))); -+#endif ++ len += snprintf(page + len, count - len, "rx_urb_pending_cn=%d\n", precvpriv->rx_pending_cnt); ++ ++ *eof = 1; ++ return len; + -+ //Folowing are RX info -+ //Counts of packets whose seq_num is less than preorder_ctrl->indicate_seq, Ex delay, retransmission, redundant packets and so on -+ DBG_871X_SEL_NL(m,"Rx: Counts of Packets Whose Seq_Num Less Than Reorder Control Seq_Num: %llu\n",(unsigned long long)pdbgpriv->dbg_rx_ampdu_drop_count); -+ //How many times the Rx Reorder Timer is triggered. -+ DBG_871X_SEL_NL(m,"Rx: Reorder Time-out Trigger Counts: %llu\n",(unsigned long long)pdbgpriv->dbg_rx_ampdu_forced_indicate_count); -+ //Total counts of packets loss -+ DBG_871X_SEL_NL(m,"Rx: Packet Loss Counts: %llu\n",(unsigned long long)pdbgpriv->dbg_rx_ampdu_loss_count); -+ DBG_871X_SEL_NL(m,"Rx: Duplicate Management Frame Drop Count: %llu\n",(unsigned long long)pdbgpriv->dbg_rx_dup_mgt_frame_drop_count); -+ DBG_871X_SEL_NL(m,"Rx: AMPDU BA window shift Count: %llu\n",(unsigned long long)pdbgpriv->dbg_rx_ampdu_window_shift_cnt); -+ /*The same mac addr counts*/ -+ DBG_871X_SEL_NL(m, "Rx: Conflict MAC Address Frames Count: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_conflic_mac_addr_cnt); -+ return 0; +} + -+int proc_get_dis_pwt(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 dis_pwt = 0; -+ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DIS_PWT, &(dis_pwt)); -+ DBG_871X_SEL_NL(m, " Tx Power training mode:%s \n",(dis_pwt==_TRUE)?"Disable":"Enable"); -+ return 0; -+} -+ssize_t proc_set_dis_pwt(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_get_mac_reg_dump1(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[4]={0}; -+ u8 dis_pwt = 0; -+ -+ if (count < 1) -+ return -EFAULT; ++ int len = 0; ++ int i,j=1; + -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; ++ len += snprintf(page + len, count - len, "\n======= MAC REG =======\n"); ++ ++ for(i=0x0;i<0x300;i+=4) ++ { ++ if(j%4==1) len += snprintf(page + len, count - len,"0x%02x",i); ++ len += snprintf(page + len, count - len," 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) len += snprintf(page + len, count - len,"\n"); + } + -+ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ *eof = 1; ++ return len; + -+ int num = sscanf(tmp, "%hhx", &dis_pwt); -+ DBG_871X("Set Tx Power training mode:%s\n", (dis_pwt == _TRUE)?"Disable":"Enable"); -+ -+ if (num >= 1) -+ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DIS_PWT, &(dis_pwt)); -+ } -+ -+ return count; -+ +} + -+int proc_get_rate_ctl(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ int i; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 data_rate = 0, sgi=0, data_fb = 0; -+ -+ if (adapter->fix_rate != 0xff) { -+ data_rate = adapter->fix_rate & 0x7F; -+ sgi = adapter->fix_rate >>7; -+ data_fb = adapter->data_fb?1:0; -+ DBG_871X_SEL_NL(m, "FIXED %s%s%s\n" -+ , HDATA_RATE(data_rate) -+ , data_rate>DESC_RATE54M?(sgi?" SGI":" LGI"):"" -+ , data_fb?" FB":"" -+ ); -+ DBG_871X_SEL_NL(m, "0x%02x %u\n", adapter->fix_rate, adapter->data_fb); -+ } else { -+ DBG_871X_SEL_NL(m, "RA\n"); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_rate_ctl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 fix_rate; -+ u8 data_fb; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx %hhu", &fix_rate, &data_fb); -+ -+ if (num >= 1) -+ adapter->fix_rate = fix_rate; -+ if (num >= 2) -+ adapter->data_fb = data_fb?1:0; -+ } -+ -+ return count; -+} -+#ifdef DBG_RX_COUNTER_DUMP -+int proc_get_rx_cnt_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ int i; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X_SEL_NL(m, "BIT0- Dump RX counters of DRV \n"); -+ DBG_871X_SEL_NL(m, "BIT1- Dump RX counters of MAC \n"); -+ DBG_871X_SEL_NL(m, "BIT2- Dump RX counters of PHY \n"); -+ DBG_871X_SEL_NL(m, "BIT3- Dump TRX data frame of DRV \n"); -+ DBG_871X_SEL_NL(m, "dump_rx_cnt_mode = 0x%02x \n", adapter->dump_rx_cnt_mode); -+ -+ return 0; -+} -+ssize_t proc_set_rx_cnt_dump(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 dump_rx_cnt_mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx", &dump_rx_cnt_mode); -+ -+ rtw_dump_phy_rxcnts_preprocess(adapter,dump_rx_cnt_mode); -+ adapter->dump_rx_cnt_mode = dump_rx_cnt_mode; -+ -+ } -+ -+ return count; -+} -+#endif -+ssize_t proc_set_fwdl_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_get_mac_reg_dump2(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ int num; ++ int len = 0; ++ int i,j=1; + -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; ++ len += snprintf(page + len, count - len, "\n======= MAC REG =======\n"); ++ memset(page, 0, count); ++ for(i=0x300;i<0x600;i+=4) ++ { ++ if(j%4==1) len += snprintf(page + len, count - len,"0x%02x",i); ++ len += snprintf(page + len, count - len," 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) len += snprintf(page + len, count - len,"\n"); + } + -+ if (buffer && !copy_from_user(tmp, buffer, count)) -+ num = sscanf(tmp, "%hhu %hhu", &fwdl_test_chksum_fail, &fwdl_test_wintint_rdy_fail); ++ *eof = 1; ++ return len; + -+ return count; +} + -+ssize_t proc_set_del_rx_ampdu_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_get_mac_reg_dump3(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ int num; ++ int len = 0; ++ int i,j=1; + -+ if (count < 1) -+ return -EFAULT; ++ len += snprintf(page + len, count - len, "\n======= MAC REG =======\n"); + -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; ++ for(i=0x600;i<0x800;i+=4) ++ { ++ if(j%4==1) len += snprintf(page + len, count - len,"0x%02x",i); ++ len += snprintf(page + len, count - len," 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) len += snprintf(page + len, count - len,"\n"); + } + -+ if (buffer && !copy_from_user(tmp, buffer, count)) -+ num = sscanf(tmp, "%hhu", &del_rx_ampdu_test_no_tx_fail); ++ *eof = 1; ++ return len; + -+ return count; +} + -+#ifdef CONFIG_DFS_MASTER -+int proc_get_dfs_master_test_case(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ DBG_871X_SEL_NL(m, "%-24s %-19s\n", "radar_detect_trigger_non", "choose_dfs_ch_first"); -+ DBG_871X_SEL_NL(m, "%24hhu %19hhu\n" -+ , rfctl->dbg_dfs_master_radar_detect_trigger_non -+ , rfctl->dbg_dfs_master_choose_dfs_ch_first -+ ); -+ -+ return 0; -+} -+ -+ssize_t proc_set_dfs_master_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ char tmp[32]; -+ u8 radar_detect_trigger_non; -+ u8 choose_dfs_ch_first; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%hhu %hhu", &radar_detect_trigger_non, &choose_dfs_ch_first); -+ -+ if (num >= 1) -+ rfctl->dbg_dfs_master_radar_detect_trigger_non = radar_detect_trigger_non; -+ if (num >= 2) -+ rfctl->dbg_dfs_master_choose_dfs_ch_first = choose_dfs_ch_first; -+ } -+ -+ return count; -+} -+#endif /* CONFIG_DFS_MASTER */ -+ -+ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_get_bb_reg_dump1(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ int num; ++ int len = 0; ++ int i,j=1; + -+ if (count < 1) -+ return -EFAULT; ++ len += snprintf(page + len, count - len, "\n======= BB REG =======\n"); ++ for(i=0x800;i<0xB00;i+=4) ++ { ++ if(j%4==1) len += snprintf(page + len, count - len,"0x%02x",i); ++ len += snprintf(page + len, count - len," 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) len += snprintf(page + len, count - len,"\n"); ++ } ++ *eof = 1; ++ return len; ++} + -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; ++int proc_get_bb_reg_dump2(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ int len = 0; ++ int i,j=1; ++ ++ len += snprintf(page + len, count - len, "\n======= BB REG =======\n"); ++ for(i=0xB00;i<0xE00;i+=4) ++ { ++ if(j%4==1) len += snprintf(page + len, count - len,"0x%02x",i); ++ len += snprintf(page + len, count - len," 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) len += snprintf(page + len, count - len,"\n"); ++ } ++ *eof = 1; ++ return len; ++} ++ ++int proc_get_bb_reg_dump3(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ int len = 0; ++ int i,j=1; ++ ++ len += snprintf(page + len, count - len, "\n======= BB REG =======\n"); ++ for(i=0xE00;i<0x1000;i+=4) ++ { ++ if(j%4==1) len += snprintf(page + len, count - len,"0x%02x",i); ++ len += snprintf(page + len, count - len," 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) len += snprintf(page + len, count - len,"\n"); ++ } ++ *eof = 1; ++ return len; ++} ++ ++int proc_get_rf_reg_dump1(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) ++{ ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ int len = 0; ++ int i,j=1,path; ++ u32 value; ++ ++ len += snprintf(page + len, count - len, "\n======= RF REG =======\n"); ++ path = 1; ++ len += snprintf(page + len, count - len, "\nRF_Path(%x)\n",path); ++ for(i=0;i<0xC0;i++) ++ { ++ //value = PHY_QueryRFReg(padapter, (RF90_RADIO_PATH_E)path,i, bMaskDWord); ++ value = rtw_hal_read_rfreg(padapter, path, i, 0xffffffff); ++ if(j%4==1) len += snprintf(page + len, count - len, "0x%02x ",i); ++ len += snprintf(page + len, count - len, " 0x%08x ",value); ++ if((j++)%4==0) len += snprintf(page + len, count - len, "\n"); + } + -+ if (buffer && !copy_from_user(tmp, buffer, count)) -+ num = sscanf(tmp, "%u", &g_wait_hiq_empty_ms); -+ -+ return count; ++ *eof = 1; ++ return len; +} + -+int proc_get_suspend_resume_info(struct seq_file *m, void *v) ++ ++int proc_get_rf_reg_dump2(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; ++ int len = 0; ++ int i,j=1,path; ++ u32 value; + -+ DBG_871X_SEL_NL(m, "dbg_sdio_alloc_irq_cnt=%d\n", pdbgpriv->dbg_sdio_alloc_irq_cnt); -+ DBG_871X_SEL_NL(m, "dbg_sdio_free_irq_cnt=%d\n", pdbgpriv->dbg_sdio_free_irq_cnt); -+ DBG_871X_SEL_NL(m, "dbg_sdio_alloc_irq_error_cnt=%d\n",pdbgpriv->dbg_sdio_alloc_irq_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_sdio_free_irq_error_cnt=%d\n", pdbgpriv->dbg_sdio_free_irq_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_sdio_init_error_cnt=%d\n",pdbgpriv->dbg_sdio_init_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_sdio_deinit_error_cnt=%d\n", pdbgpriv->dbg_sdio_deinit_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_suspend_error_cnt=%d\n", pdbgpriv->dbg_suspend_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_suspend_cnt=%d\n",pdbgpriv->dbg_suspend_cnt); -+ DBG_871X_SEL_NL(m, "dbg_resume_cnt=%d\n", pdbgpriv->dbg_resume_cnt); -+ DBG_871X_SEL_NL(m, "dbg_resume_error_cnt=%d\n", pdbgpriv->dbg_resume_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_deinit_fail_cnt=%d\n",pdbgpriv->dbg_deinit_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_carddisable_cnt=%d\n", pdbgpriv->dbg_carddisable_cnt); -+ DBG_871X_SEL_NL(m, "dbg_ps_insuspend_cnt=%d\n",pdbgpriv->dbg_ps_insuspend_cnt); -+ DBG_871X_SEL_NL(m, "dbg_dev_unload_inIPS_cnt=%d\n", pdbgpriv->dbg_dev_unload_inIPS_cnt); -+ DBG_871X_SEL_NL(m, "dbg_scan_pwr_state_cnt=%d\n", pdbgpriv->dbg_scan_pwr_state_cnt); -+ DBG_871X_SEL_NL(m, "dbg_downloadfw_pwr_state_cnt=%d\n", pdbgpriv->dbg_downloadfw_pwr_state_cnt); -+ DBG_871X_SEL_NL(m, "dbg_carddisable_error_cnt=%d\n", pdbgpriv->dbg_carddisable_error_cnt); -+ DBG_871X_SEL_NL(m, "dbg_fw_read_ps_state_fail_cnt=%d\n", pdbgpriv->dbg_fw_read_ps_state_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_leave_ips_fail_cnt=%d\n", pdbgpriv->dbg_leave_ips_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_leave_lps_fail_cnt=%d\n", pdbgpriv->dbg_leave_lps_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_h2c_leave32k_fail_cnt=%d\n", pdbgpriv->dbg_h2c_leave32k_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_diswow_dload_fw_fail_cnt=%d\n", pdbgpriv->dbg_diswow_dload_fw_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_enwow_dload_fw_fail_cnt=%d\n", pdbgpriv->dbg_enwow_dload_fw_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_ips_drvopen_fail_cnt=%d\n", pdbgpriv->dbg_ips_drvopen_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_poll_fail_cnt=%d\n", pdbgpriv->dbg_poll_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_rpwm_toogle_cnt=%d\n", pdbgpriv->dbg_rpwm_toogle_cnt); -+ DBG_871X_SEL_NL(m, "dbg_rpwm_timeout_fail_cnt=%d\n", pdbgpriv->dbg_rpwm_timeout_fail_cnt); -+ DBG_871X_SEL_NL(m, "dbg_sreset_cnt=%d\n", pdbgpriv->dbg_sreset_cnt); -+ -+ return 0; ++ len += snprintf(page + len, count - len, "\n======= RF REG =======\n"); ++ path = 1; ++ len += snprintf(page + len, count - len, "\nRF_Path(%x)\n",path); ++ for(i=0xC0;i<0x100;i++) ++ { ++ //value = PHY_QueryRFReg(padapter, (RF90_RADIO_PATH_E)path,i, bMaskDWord); ++ value = rtw_hal_read_rfreg(padapter, path, i, 0xffffffff); ++ if(j%4==1) len += snprintf(page + len, count - len, "0x%02x ",i); ++ len += snprintf(page + len, count - len, " 0x%08x ",value); ++ if((j++)%4==0) len += snprintf(page + len, count - len, "\n"); ++ } ++ *eof = 1; ++ return len; +} + -+#ifdef CONFIG_DBG_COUNTER + -+int proc_get_rx_logs(struct seq_file *m, void *v) ++int proc_get_rf_reg_dump3(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rx_logs *rx_logs = &padapter->rx_logs; ++ int len = 0; ++ int i,j=1,path; ++ u32 value; + -+ DBG_871X_SEL_NL(m, -+ "intf_rx=%d\n" -+ "intf_rx_err_recvframe=%d\n" -+ "intf_rx_err_skb=%d\n" -+ "intf_rx_report=%d\n" -+ "core_rx=%d\n" -+ "core_rx_pre=%d\n" -+ "core_rx_pre_ver_err=%d\n" -+ "core_rx_pre_mgmt=%d\n" -+ "core_rx_pre_mgmt_err_80211w=%d\n" -+ "core_rx_pre_mgmt_err=%d\n" -+ "core_rx_pre_ctrl=%d\n" -+ "core_rx_pre_ctrl_err=%d\n" -+ "core_rx_pre_data=%d\n" -+ "core_rx_pre_data_wapi_seq_err=%d\n" -+ "core_rx_pre_data_wapi_key_err=%d\n" -+ "core_rx_pre_data_handled=%d\n" -+ "core_rx_pre_data_err=%d\n" -+ "core_rx_pre_data_unknown=%d\n" -+ "core_rx_pre_unknown=%d\n" -+ "core_rx_enqueue=%d\n" -+ "core_rx_dequeue=%d\n" -+ "core_rx_post=%d\n" -+ "core_rx_post_decrypt=%d\n" -+ "core_rx_post_decrypt_wep=%d\n" -+ "core_rx_post_decrypt_tkip=%d\n" -+ "core_rx_post_decrypt_aes=%d\n" -+ "core_rx_post_decrypt_wapi=%d\n" -+ "core_rx_post_decrypt_hw=%d\n" -+ "core_rx_post_decrypt_unknown=%d\n" -+ "core_rx_post_decrypt_err=%d\n" -+ "core_rx_post_defrag_err=%d\n" -+ "core_rx_post_portctrl_err=%d\n" -+ "core_rx_post_indicate=%d\n" -+ "core_rx_post_indicate_in_oder=%d\n" -+ "core_rx_post_indicate_reoder=%d\n" -+ "core_rx_post_indicate_err=%d\n" -+ "os_indicate=%d\n" -+ "os_indicate_ap_mcast=%d\n" -+ "os_indicate_ap_forward=%d\n" -+ "os_indicate_ap_self=%d\n" -+ "os_indicate_err=%d\n" -+ "os_netif_ok=%d\n" -+ "os_netif_err=%d\n", -+ rx_logs->intf_rx, -+ rx_logs->intf_rx_err_recvframe, -+ rx_logs->intf_rx_err_skb, -+ rx_logs->intf_rx_report, -+ rx_logs->core_rx, -+ rx_logs->core_rx_pre, -+ rx_logs->core_rx_pre_ver_err, -+ rx_logs->core_rx_pre_mgmt, -+ rx_logs->core_rx_pre_mgmt_err_80211w, -+ rx_logs->core_rx_pre_mgmt_err, -+ rx_logs->core_rx_pre_ctrl, -+ rx_logs->core_rx_pre_ctrl_err, -+ rx_logs->core_rx_pre_data, -+ rx_logs->core_rx_pre_data_wapi_seq_err, -+ rx_logs->core_rx_pre_data_wapi_key_err, -+ rx_logs->core_rx_pre_data_handled, -+ rx_logs->core_rx_pre_data_err, -+ rx_logs->core_rx_pre_data_unknown, -+ rx_logs->core_rx_pre_unknown, -+ rx_logs->core_rx_enqueue, -+ rx_logs->core_rx_dequeue, -+ rx_logs->core_rx_post, -+ rx_logs->core_rx_post_decrypt, -+ rx_logs->core_rx_post_decrypt_wep, -+ rx_logs->core_rx_post_decrypt_tkip, -+ rx_logs->core_rx_post_decrypt_aes, -+ rx_logs->core_rx_post_decrypt_wapi, -+ rx_logs->core_rx_post_decrypt_hw, -+ rx_logs->core_rx_post_decrypt_unknown, -+ rx_logs->core_rx_post_decrypt_err, -+ rx_logs->core_rx_post_defrag_err, -+ rx_logs->core_rx_post_portctrl_err, -+ rx_logs->core_rx_post_indicate, -+ rx_logs->core_rx_post_indicate_in_oder, -+ rx_logs->core_rx_post_indicate_reoder, -+ rx_logs->core_rx_post_indicate_err, -+ rx_logs->os_indicate, -+ rx_logs->os_indicate_ap_mcast, -+ rx_logs->os_indicate_ap_forward, -+ rx_logs->os_indicate_ap_self, -+ rx_logs->os_indicate_err, -+ rx_logs->os_netif_ok, -+ rx_logs->os_netif_err -+ ); -+ -+ return 0; -+} -+ -+int proc_get_tx_logs(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tx_logs *tx_logs = &padapter->tx_logs; -+ -+ DBG_871X_SEL_NL(m, -+ "os_tx=%d\n" -+ "os_tx_err_up=%d\n" -+ "os_tx_err_xmit=%d\n" -+ "os_tx_m2u=%d\n" -+ "os_tx_m2u_ignore_fw_linked=%d\n" -+ "os_tx_m2u_ignore_self=%d\n" -+ "os_tx_m2u_entry=%d\n" -+ "os_tx_m2u_entry_err_xmit=%d\n" -+ "os_tx_m2u_entry_err_skb=%d\n" -+ "os_tx_m2u_stop=%d\n" -+ "core_tx=%d\n" -+ "core_tx_err_pxmitframe=%d\n" -+ "core_tx_err_brtx=%d\n" -+ "core_tx_upd_attrib=%d\n" -+ "core_tx_upd_attrib_adhoc=%d\n" -+ "core_tx_upd_attrib_sta=%d\n" -+ "core_tx_upd_attrib_ap=%d\n" -+ "core_tx_upd_attrib_unknown=%d\n" -+ "core_tx_upd_attrib_dhcp=%d\n" -+ "core_tx_upd_attrib_icmp=%d\n" -+ "core_tx_upd_attrib_active=%d\n" -+ "core_tx_upd_attrib_err_ucast_sta=%d\n" -+ "core_tx_upd_attrib_err_ucast_ap_link=%d\n" -+ "core_tx_upd_attrib_err_sta=%d\n" -+ "core_tx_upd_attrib_err_link=%d\n" -+ "core_tx_upd_attrib_err_sec=%d\n" -+ "core_tx_ap_enqueue_warn_fwstate=%d\n" -+ "core_tx_ap_enqueue_warn_sta=%d\n" -+ "core_tx_ap_enqueue_warn_nosta=%d\n" -+ "core_tx_ap_enqueue_warn_link=%d\n" -+ "core_tx_ap_enqueue_warn_trigger=%d\n" -+ "core_tx_ap_enqueue_mcast=%d\n" -+ "core_tx_ap_enqueue_ucast=%d\n" -+ "core_tx_ap_enqueue=%d\n" -+ "intf_tx=%d\n" -+ "intf_tx_pending_ac=%d\n" -+ "intf_tx_pending_fw_under_survey=%d\n" -+ "intf_tx_pending_fw_under_linking=%d\n" -+ "intf_tx_pending_xmitbuf=%d\n" -+ "intf_tx_enqueue=%d\n" -+ "core_tx_enqueue=%d\n" -+ "core_tx_enqueue_class=%d\n" -+ "core_tx_enqueue_class_err_sta=%d\n" -+ "core_tx_enqueue_class_err_nosta=%d\n" -+ "core_tx_enqueue_class_err_fwlink=%d\n" -+ "intf_tx_direct=%d\n" -+ "intf_tx_direct_err_coalesce=%d\n" -+ "intf_tx_dequeue=%d\n" -+ "intf_tx_dequeue_err_coalesce=%d\n" -+ "intf_tx_dump_xframe=%d\n" -+ "intf_tx_dump_xframe_err_txdesc=%d\n" -+ "intf_tx_dump_xframe_err_port=%d\n", -+ tx_logs->os_tx, -+ tx_logs->os_tx_err_up, -+ tx_logs->os_tx_err_xmit, -+ tx_logs->os_tx_m2u, -+ tx_logs->os_tx_m2u_ignore_fw_linked, -+ tx_logs->os_tx_m2u_ignore_self, -+ tx_logs->os_tx_m2u_entry, -+ tx_logs->os_tx_m2u_entry_err_xmit, -+ tx_logs->os_tx_m2u_entry_err_skb, -+ tx_logs->os_tx_m2u_stop, -+ tx_logs->core_tx, -+ tx_logs->core_tx_err_pxmitframe, -+ tx_logs->core_tx_err_brtx, -+ tx_logs->core_tx_upd_attrib, -+ tx_logs->core_tx_upd_attrib_adhoc, -+ tx_logs->core_tx_upd_attrib_sta, -+ tx_logs->core_tx_upd_attrib_ap, -+ tx_logs->core_tx_upd_attrib_unknown, -+ tx_logs->core_tx_upd_attrib_dhcp, -+ tx_logs->core_tx_upd_attrib_icmp, -+ tx_logs->core_tx_upd_attrib_active, -+ tx_logs->core_tx_upd_attrib_err_ucast_sta, -+ tx_logs->core_tx_upd_attrib_err_ucast_ap_link, -+ tx_logs->core_tx_upd_attrib_err_sta, -+ tx_logs->core_tx_upd_attrib_err_link, -+ tx_logs->core_tx_upd_attrib_err_sec, -+ tx_logs->core_tx_ap_enqueue_warn_fwstate, -+ tx_logs->core_tx_ap_enqueue_warn_sta, -+ tx_logs->core_tx_ap_enqueue_warn_nosta, -+ tx_logs->core_tx_ap_enqueue_warn_link, -+ tx_logs->core_tx_ap_enqueue_warn_trigger, -+ tx_logs->core_tx_ap_enqueue_mcast, -+ tx_logs->core_tx_ap_enqueue_ucast, -+ tx_logs->core_tx_ap_enqueue, -+ tx_logs->intf_tx, -+ tx_logs->intf_tx_pending_ac, -+ tx_logs->intf_tx_pending_fw_under_survey, -+ tx_logs->intf_tx_pending_fw_under_linking, -+ tx_logs->intf_tx_pending_xmitbuf, -+ tx_logs->intf_tx_enqueue, -+ tx_logs->core_tx_enqueue, -+ tx_logs->core_tx_enqueue_class, -+ tx_logs->core_tx_enqueue_class_err_sta, -+ tx_logs->core_tx_enqueue_class_err_nosta, -+ tx_logs->core_tx_enqueue_class_err_fwlink, -+ tx_logs->intf_tx_direct, -+ tx_logs->intf_tx_direct_err_coalesce, -+ tx_logs->intf_tx_dequeue, -+ tx_logs->intf_tx_dequeue_err_coalesce, -+ tx_logs->intf_tx_dump_xframe, -+ tx_logs->intf_tx_dump_xframe_err_txdesc, -+ tx_logs->intf_tx_dump_xframe_err_port -+ ); -+ -+ return 0; -+} -+ -+int proc_get_int_logs(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X_SEL_NL(m, -+ "all=%d\n" -+ "err=%d\n" -+ "tbdok=%d\n" -+ "tbder=%d\n" -+ "bcnderr=%d\n" -+ "bcndma=%d\n" -+ "bcndma_e=%d\n" -+ "rx=%d\n" -+ "rx_rdu=%d\n" -+ "rx_fovw=%d\n" -+ "txfovw=%d\n" -+ "mgntok=%d\n" -+ "highdok=%d\n" -+ "bkdok=%d\n" -+ "bedok=%d\n" -+ "vidok=%d\n" -+ "vodok=%d\n", -+ padapter->int_logs.all, -+ padapter->int_logs.err, -+ padapter->int_logs.tbdok, -+ padapter->int_logs.tbder, -+ padapter->int_logs.bcnderr, -+ padapter->int_logs.bcndma, -+ padapter->int_logs.bcndma_e, -+ padapter->int_logs.rx, -+ padapter->int_logs.rx_rdu, -+ padapter->int_logs.rx_fovw, -+ padapter->int_logs.txfovw, -+ padapter->int_logs.mgntok, -+ padapter->int_logs.highdok, -+ padapter->int_logs.bkdok, -+ padapter->int_logs.bedok, -+ padapter->int_logs.vidok, -+ padapter->int_logs.vodok -+ ); -+ -+ return 0; -+} -+ -+#endif // CONFIG_DBG_COUNTER -+ -+int proc_get_hw_status(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; -+ -+ if (pdbgpriv->dbg_rx_fifo_last_overflow == 1 -+ && pdbgpriv->dbg_rx_fifo_curr_overflow == 1 -+ && pdbgpriv->dbg_rx_fifo_diff_overflow == 1 -+ ) { -+ DBG_871X_SEL_NL(m, "RX FIFO full count: no implementation\n"); -+ } else { -+ DBG_871X_SEL_NL(m, "RX FIFO full count: last_time=%llu, current_time=%llu, differential=%llu\n" -+ , pdbgpriv->dbg_rx_fifo_last_overflow, pdbgpriv->dbg_rx_fifo_curr_overflow, pdbgpriv->dbg_rx_fifo_diff_overflow); ++ len += snprintf(page + len, count - len, "\n======= RF REG =======\n"); ++ path = 2; ++ len += snprintf(page + len, count - len, "\nRF_Path(%x)\n",path); ++ for(i=0;i<0xC0;i++) ++ { ++ //value = PHY_QueryRFReg(padapter, (RF90_RADIO_PATH_E)path,i, bMaskDWord); ++ value = rtw_hal_read_rfreg(padapter, path, i, 0xffffffff); ++ if(j%4==1) len += snprintf(page + len, count - len, "0x%02x ",i); ++ len += snprintf(page + len, count - len, " 0x%08x ",value); ++ if((j++)%4==0) len += snprintf(page + len, count - len, "\n"); + } + -+ return 0; ++ *eof = 1; ++ return len; +} + -+int proc_get_rx_signal(struct seq_file *m, void *v) ++ ++int proc_get_rf_reg_dump4(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; ++ struct net_device *dev = data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ int len = 0; ++ int i,j=1,path; ++ u32 value; ++ ++ len += snprintf(page + len, count - len, "\n======= RF REG =======\n"); ++ path = 2; ++ len += snprintf(page + len, count - len, "\nRF_Path(%x)\n",path); ++ for(i=0xC0;i<0x100;i++) ++ { ++ //value = PHY_QueryRFReg(padapter, (RF90_RADIO_PATH_E)path,i, bMaskDWord); ++ value = rtw_hal_read_rfreg(padapter, path, i, 0xffffffff); ++ if(j%4==1) len += snprintf(page + len, count - len, "0x%02x ",i); ++ len += snprintf(page + len, count - len, " 0x%08x ",value); ++ if((j++)%4==0) len += snprintf(page + len, count - len, "\n"); ++ } ++ *eof = 1; ++ return len; ++} ++ ++ ++ ++int proc_get_rx_signal(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) ++{ ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + -+ DBG_871X_SEL_NL(m, "rssi:%d\n", padapter->recvpriv.rssi); -+ //DBG_871X_SEL_NL(m, "rxpwdb:%d\n", padapter->recvpriv.rxpwdb); -+ DBG_871X_SEL_NL(m, "signal_strength:%u\n", padapter->recvpriv.signal_strength); -+ DBG_871X_SEL_NL(m, "signal_qual:%u\n", padapter->recvpriv.signal_qual); ++ int len = 0; + -+ rtw_get_noise(padapter); -+ DBG_871X_SEL_NL(m, "noise:%d\n", padapter->recvpriv.noise); -+ #ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ rtw_odm_get_perpkt_rssi(m,padapter); -+ rtw_get_raw_rssi_info(m,padapter); -+ #endif -+ return 0; ++ len += snprintf(page + len, count - len, ++ "rssi:%d\n" ++ "rxpwdb:%d\n" ++ "signal_strength:%u\n" ++ "signal_qual:%u\n" ++ "noise:%u\n", ++ padapter->recvpriv.rssi, ++ padapter->recvpriv.rxpwdb, ++ padapter->recvpriv.signal_strength, ++ padapter->recvpriv.signal_qual, ++ padapter->recvpriv.noise ++ ); ++ ++ *eof = 1; ++ return len; +} + -+ssize_t proc_set_rx_signal(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_set_rx_signal(struct file *file, const char *buffer, ++ unsigned long count, void *data) +{ -+ struct net_device *dev = data; ++ struct net_device *dev = (struct net_device *)data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u32 is_signal_dbg, signal_strength; @@ -18474,21 +9804,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + if (count < 1) + return -EFAULT; + -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { + + int num = sscanf(tmp, "%u %u", &is_signal_dbg, &signal_strength); + + is_signal_dbg = is_signal_dbg==0?0:1; -+ ++ + if(is_signal_dbg && num!=2) + return count; -+ ++ + signal_strength = signal_strength>100?100:signal_strength; ++ signal_strength = signal_strength<0?0:signal_strength; + + padapter->recvpriv.is_signal_dbg = is_signal_dbg; + padapter->recvpriv.signal_strength_dbg=signal_strength; @@ -18497,29 +9823,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + DBG_871X("set %s %u\n", "DBG_SIGNAL_STRENGTH", signal_strength); + else + DBG_871X("set %s\n", "HW_SIGNAL_STRENGTH"); -+ ++ + } -+ ++ + return count; -+ ++ +} +#ifdef CONFIG_80211N_HT + -+int proc_get_ht_enable(struct seq_file *m, void *v) ++int proc_get_ht_enable(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + -+ if(pregpriv) -+ DBG_871X_SEL_NL(m, "%d\n", pregpriv->ht_enable); ++ int len = 0; + -+ return 0; ++ if(pregpriv) ++ len += snprintf(page + len, count - len, ++ "%d\n", ++ pregpriv->ht_enable ++ ); ++ ++ *eof = 1; ++ return len; +} + -+ssize_t proc_set_ht_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_set_ht_enable(struct file *file, const char *buffer, ++ unsigned long count, void *data) +{ -+ struct net_device *dev = data; ++ struct net_device *dev = (struct net_device *)data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + char tmp[32]; @@ -18528,41 +9863,45 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + if (count < 1) + return -EFAULT; + -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { + + int num = sscanf(tmp, "%d ", &mode); + -+ if( pregpriv && mode < 2 ) ++ if( pregpriv && mode >= 0 && mode < 2 ) + { + pregpriv->ht_enable= mode; -+ DBG_871X("ht_enable=%d\n", pregpriv->ht_enable); ++ printk("ht_enable=%d\n", pregpriv->ht_enable); + } + } -+ ++ + return count; -+ ++ +} + -+int proc_get_bw_mode(struct seq_file *m, void *v) ++int proc_get_bw_mode(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + -+ if(pregpriv) -+ DBG_871X_SEL_NL(m, "0x%02x\n", pregpriv->bw_mode); ++ int len = 0; + -+ return 0; ++ if(pregpriv) ++ len += snprintf(page + len, count - len, ++ "%d\n", ++ pregpriv->bw_mode ++ ); ++ ++ *eof = 1; ++ return len; +} + -+ssize_t proc_set_bw_mode(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_set_bw_mode(struct file *file, const char *buffer, ++ unsigned long count, void *data) +{ -+ struct net_device *dev = data; ++ struct net_device *dev = (struct net_device *)data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + char tmp[32]; @@ -18571,16 +9910,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + if (count < 1) + return -EFAULT; + -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { + + int num = sscanf(tmp, "%d ", &mode); + -+ if( pregpriv && mode < 2 ) ++ if( pregpriv && mode >= 0 && mode < 2 ) + { + + pregpriv->bw_mode = mode; @@ -18588,26 +9922,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + + } + } -+ ++ + return count; -+ ++ +} + -+int proc_get_ampdu_enable(struct seq_file *m, void *v) ++int proc_get_ampdu_enable(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + -+ if(pregpriv) -+ DBG_871X_SEL_NL(m, "%d\n", pregpriv->ampdu_enable); ++ int len = 0; + -+ return 0; ++ if(pregpriv) ++ len += snprintf(page + len, count - len, ++ "%d\n", ++ pregpriv->ampdu_enable ++ ); ++ ++ *eof = 1; ++ return len; +} + -+ssize_t proc_set_ampdu_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_set_ampdu_enable(struct file *file, const char *buffer, ++ unsigned long count, void *data) +{ -+ struct net_device *dev = data; ++ struct net_device *dev = (struct net_device *)data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + char tmp[32]; @@ -18616,337 +9959,67 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + if (count < 1) + return -EFAULT; + -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { + + int num = sscanf(tmp, "%d ", &mode); + -+ if( pregpriv && mode < 3 ) ++ if( pregpriv && mode >= 0 && mode < 3 ) + { + pregpriv->ampdu_enable= mode; + printk("ampdu_enable=%d\n", mode); + } + + } -+ -+ return count; -+ -+} -+ -+int proc_get_mac_rptbuf(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u16 i; -+ u16 mac_id; -+ u32 shcut_addr = 0; -+ u32 read_addr = 0; -+#ifdef CONFIG_RTL8814A -+ DBG_871X_SEL_NL(m, "TX ShortCut:\n"); -+ for (mac_id = 0; mac_id < 64; mac_id++) { -+ rtw_write16(padapter, 0x140, 0x662 | ((mac_id & BIT5)>>5)); -+ shcut_addr = 0x8000; -+ shcut_addr = shcut_addr | ((mac_id&0x1f) << 7); -+ DBG_871X_SEL_NL(m, "mac_id=%d, 0x140=%x =>\n", mac_id, 0x662 | ((mac_id & BIT5)>>5)); -+ for (i = 0; i < 30; i++) { -+ read_addr = 0; -+ read_addr = shcut_addr | (i<<2); -+ DBG_871X_SEL_NL(m, "i=%02d: MAC_%04x= %08x ", i, read_addr, rtw_read32(padapter, read_addr)); -+ if (!((i+1) % 4)) -+ DBG_871X_SEL_NL(m, "\n"); -+ if (i == 29) -+ DBG_871X_SEL_NL(m, "\n"); -+ } -+ } -+#endif /* CONFIG_RTL8814A */ -+ return 0; -+} -+ -+ -+int proc_get_rx_ampdu(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X_SEL(m, "accept: "); -+ if (padapter->fix_rx_ampdu_accept == RX_AMPDU_ACCEPT_INVALID) -+ DBG_871X_SEL_NL(m, "%u%s\n", rtw_rx_ampdu_is_accept(padapter), "(auto)"); -+ else -+ DBG_871X_SEL_NL(m, "%u%s\n", padapter->fix_rx_ampdu_accept, "(fixed)"); -+ -+ DBG_871X_SEL(m, "size: "); -+ if (padapter->fix_rx_ampdu_size == RX_AMPDU_SIZE_INVALID) -+ DBG_871X_SEL_NL(m, "%u%s\n", rtw_rx_ampdu_size(padapter), "(auto)"); -+ else -+ DBG_871X_SEL_NL(m, "%u%s\n", padapter->fix_rx_ampdu_size, "(fixed)"); -+ -+ DBG_871X_SEL_NL(m, "%19s %17s\n", "fix_rx_ampdu_accept", "fix_rx_ampdu_size"); -+ -+ DBG_871X_SEL(m, "%-19d %-17u\n" -+ , padapter->fix_rx_ampdu_accept -+ , padapter->fix_rx_ampdu_size); -+ -+ return 0; -+} -+ -+ssize_t proc_set_rx_ampdu(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ char tmp[32]; -+ u8 accept; -+ u8 size; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhu %hhu", &accept, &size); -+ -+ if (num >= 1) -+ rtw_rx_ampdu_set_accept(padapter, accept, RX_AMPDU_DRV_FIXED); -+ if (num >= 2) -+ rtw_rx_ampdu_set_size(padapter, size, RX_AMPDU_DRV_FIXED); -+ -+ rtw_rx_ampdu_apply(padapter); -+ } -+ -+exit: -+ return count; -+} -+int proc_get_rx_ampdu_factor(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ if(padapter) -+ { -+ DBG_871X_SEL_NL(m,"rx ampdu factor = %x\n",padapter->driver_rx_ampdu_factor); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_rx_ampdu_factor(struct file *file, const char __user *buffer -+ , size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 factor; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &factor); -+ -+ if( padapter && (num == 1) ) -+ { -+ DBG_871X("padapter->driver_rx_ampdu_factor = %x\n", factor); -+ -+ if(factor > 0x03) -+ padapter->driver_rx_ampdu_factor = 0xFF; -+ else -+ padapter->driver_rx_ampdu_factor = factor; -+ } -+ } + + return count; -+} + -+int proc_get_rx_ampdu_density(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ if(padapter) -+ { -+ DBG_871X_SEL_NL(m,"rx ampdu densityg = %x\n",padapter->driver_rx_ampdu_spacing); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_rx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 density; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &density); -+ -+ if( padapter && (num == 1) ) -+ { -+ DBG_871X("padapter->driver_rx_ampdu_spacing = %x\n", density); -+ -+ if(density > 0x07) -+ padapter->driver_rx_ampdu_spacing = 0xFF; -+ else -+ padapter->driver_rx_ampdu_spacing = density; -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_tx_ampdu_density(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ if(padapter) -+ { -+ DBG_871X_SEL_NL(m,"tx ampdu density = %x\n",padapter->driver_ampdu_spacing); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_tx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 density; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &density); -+ -+ if( padapter && (num == 1) ) -+ { -+ DBG_871X("padapter->driver_ampdu_spacing = %x\n", density); -+ -+ if(density > 0x07) -+ padapter->driver_ampdu_spacing = 0xFF; -+ else -+ padapter->driver_ampdu_spacing = density; -+ } -+ } -+ -+ return count; +} +#endif //CONFIG_80211N_HT + -+int proc_get_en_fwps(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if(pregpriv) -+ DBG_871X_SEL_NL(m, "check_fw_ps = %d , 1:enable get FW PS state , 0: disable get FW PS state\n" -+ , pregpriv->check_fw_ps); -+ -+ return 0; -+} -+ -+ssize_t proc_set_en_fwps(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_get_two_path_rssi(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ char tmp[32]; -+ u32 mode; + -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &mode); -+ -+ if( pregpriv && mode < 2 ) -+ { -+ pregpriv->check_fw_ps = mode; -+ DBG_871X("pregpriv->check_fw_ps=%d \n",pregpriv->check_fw_ps); -+ } -+ -+ } -+ -+ return count; -+} -+ -+/* -+int proc_get_two_path_rssi(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ int len = 0; + + if(padapter) -+ DBG_871X_SEL_NL(m, "%d %d\n", -+ padapter->recvpriv.RxRssi[0], padapter->recvpriv.RxRssi[1]); ++ len += snprintf(page + len, count - len, ++ "%d %d\n", ++ padapter->recvpriv.RxRssi[0], ++ padapter->recvpriv.RxRssi[1] ++ ); + -+ return 0; ++ *eof = 1; ++ return len; +} -+*/ +#ifdef CONFIG_80211N_HT -+int proc_get_rx_stbc(struct seq_file *m, void *v) ++int proc_get_rx_stbc(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + -+ if(pregpriv) -+ DBG_871X_SEL_NL(m, "%d\n", pregpriv->rx_stbc); ++ int len = 0; + -+ return 0; ++ if(pregpriv) ++ len += snprintf(page + len, count - len, ++ "%d\n", ++ pregpriv->rx_stbc ++ ); ++ ++ *eof = 1; ++ return len; +} + -+ssize_t proc_set_rx_stbc(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_set_rx_stbc(struct file *file, const char *buffer, ++ unsigned long count, void *data) +{ -+ struct net_device *dev = data; ++ struct net_device *dev = (struct net_device *)data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + char tmp[32]; @@ -18955,12 +10028,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + if (count < 1) + return -EFAULT; + -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { + + int num = sscanf(tmp, "%d ", &mode); + @@ -18970,22 +10038,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + printk("rx_stbc=%d\n", mode); + } + } -+ ++ + return count; -+ ++ +} +#endif //CONFIG_80211N_HT + -+/*int proc_get_rssi_disp(struct seq_file *m, void *v) ++int proc_get_rssi_disp(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; ++ *eof = 1; + return 0; +} -+*/ + -+/*ssize_t proc_set_rssi_disp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_set_rssi_disp(struct file *file, const char *buffer, ++ unsigned long count, void *data) +{ -+ struct net_device *dev = data; ++ struct net_device *dev = (struct net_device *)data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u32 enable=0; @@ -18994,14 +10064,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + { + DBG_8192C("argument size is less than 1\n"); + return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; + } + -+ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { + + int num = sscanf(tmp, "%x", &enable); + @@ -19009,38 +10074,43 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + DBG_8192C("invalid set_rssi_disp parameter!\n"); + return count; + } -+ ++ + if(enable) -+ { ++ { + DBG_8192C("Linked info Function Enable\n"); -+ padapter->bLinkInfoDump = enable ; ++ padapter->bLinkInfoDump = enable ; + } + else + { + DBG_8192C("Linked info Function Disable\n"); + padapter->bLinkInfoDump = 0 ; + } -+ -+ } -+ -+ return count; -+ -+} + -+*/ ++ } ++ ++ return count; ++ ++} ++ ++ +#ifdef CONFIG_AP_MODE + -+int proc_get_all_sta_info(struct seq_file *m, void *v) ++int proc_get_all_sta_info(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; + _irqL irqL; + struct sta_info *psta; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct sta_priv *pstapriv = &padapter->stapriv; -+ int i; ++ int i, j; + _list *plist, *phead; ++ struct recv_reorder_ctrl *preorder_ctrl; ++ int len = 0; + -+ DBG_871X_SEL_NL(m, "sta_dz_bitmap=0x%x, tim_bitmap=0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap); ++ ++ len += snprintf(page + len, count - len, "sta_dz_bitmap=0x%x, tim_bitmap=0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap); + + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); + @@ -19048,8 +10118,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + { + phead = &(pstapriv->sta_hash[i]); + plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == false) + { + psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); + @@ -19057,41 +10127,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + + //if(extra_arg == psta->aid) + { -+ DBG_871X_SEL_NL(m, "==============================\n"); -+ DBG_871X_SEL_NL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ DBG_871X_SEL_NL(m, "rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); -+ DBG_871X_SEL_NL(m, "state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); ++ len += snprintf(page + len, count - len, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); ++ len += snprintf(page + len, count - len, "rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); ++ len += snprintf(page + len, count - len, "state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); +#ifdef CONFIG_80211N_HT -+ DBG_871X_SEL_NL(m, "qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ DBG_871X_SEL_NL(m, "bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); -+ DBG_871X_SEL_NL(m, "ampdu_enable = %d\n", psta->htpriv.ampdu_enable); -+ DBG_871X_SEL_NL(m, "agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); ++ len += snprintf(page + len, count - len, "qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); ++ len += snprintf(page + len, count - len, "bwmode=%d, ch_offset=%d, sgi=%d\n", psta->htpriv.bwmode, psta->htpriv.ch_offset, psta->htpriv.sgi); ++ len += snprintf(page + len, count - len, "ampdu_enable = %d\n", psta->htpriv.ampdu_enable); ++ len += snprintf(page + len, count - len, "agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); +#endif //CONFIG_80211N_HT -+ DBG_871X_SEL_NL(m, "sleepq_len=%d\n", psta->sleepq_len); -+ DBG_871X_SEL_NL(m, "sta_xmitpriv.vo_q_qcnt=%d\n", psta->sta_xmitpriv.vo_q.qcnt); -+ DBG_871X_SEL_NL(m, "sta_xmitpriv.vi_q_qcnt=%d\n", psta->sta_xmitpriv.vi_q.qcnt); -+ DBG_871X_SEL_NL(m, "sta_xmitpriv.be_q_qcnt=%d\n", psta->sta_xmitpriv.be_q.qcnt); -+ DBG_871X_SEL_NL(m, "sta_xmitpriv.bk_q_qcnt=%d\n", psta->sta_xmitpriv.bk_q.qcnt); ++ len += snprintf(page + len, count - len, "sleepq_len=%d\n", psta->sleepq_len); ++ len += snprintf(page + len, count - len, "capability=0x%x\n", psta->capability); ++ len += snprintf(page + len, count - len, "flags=0x%x\n", psta->flags); ++ len += snprintf(page + len, count - len, "wpa_psk=0x%x\n", psta->wpa_psk); ++ len += snprintf(page + len, count - len, "wpa2_group_cipher=0x%x\n", psta->wpa2_group_cipher); ++ len += snprintf(page + len, count - len, "wpa2_pairwise_cipher=0x%x\n", psta->wpa2_pairwise_cipher); ++ len += snprintf(page + len, count - len, "qos_info=0x%x\n", psta->qos_info); ++ len += snprintf(page + len, count - len, "dot118021XPrivacy=0x%x\n", psta->dot118021XPrivacy); + -+ DBG_871X_SEL_NL(m, "capability=0x%x\n", psta->capability); -+ DBG_871X_SEL_NL(m, "flags=0x%x\n", psta->flags); -+ DBG_871X_SEL_NL(m, "wpa_psk=0x%x\n", psta->wpa_psk); -+ DBG_871X_SEL_NL(m, "wpa2_group_cipher=0x%x\n", psta->wpa2_group_cipher); -+ DBG_871X_SEL_NL(m, "wpa2_pairwise_cipher=0x%x\n", psta->wpa2_pairwise_cipher); -+ DBG_871X_SEL_NL(m, "qos_info=0x%x\n", psta->qos_info); -+ DBG_871X_SEL_NL(m, "dot118021XPrivacy=0x%x\n", psta->dot118021XPrivacy); ++ for(j=0;j<16;j++) ++ { ++ preorder_ctrl = &psta->recvreorder_ctrl[j]; ++ if(preorder_ctrl->enable) ++ { ++ len += snprintf(page + len, count - len, "tid=%d, indicate_seq=%d\n", j, preorder_ctrl->indicate_seq); ++ } ++ } + -+ sta_rx_reorder_ctl_dump(m, psta); -+ -+#ifdef CONFIG_TDLS -+ DBG_871X_SEL_NL(m, "tdls_sta_state=0x%08x\n", psta->tdls_sta_state); -+ DBG_871X_SEL_NL(m, "PeerKey_Lifetime=%d\n", psta->TDLS_PeerKey_Lifetime); -+ DBG_871X_SEL_NL(m, "rx_data_pkts=%llu\n", psta->sta_stats.rx_data_pkts); -+ DBG_871X_SEL_NL(m, "rx_bytes=%llu\n", psta->sta_stats.rx_bytes); -+ DBG_871X_SEL_NL(m, "tx_data_pkts=%llu\n", psta->sta_stats.tx_pkts); -+ DBG_871X_SEL_NL(m, "tx_bytes=%llu\n", psta->sta_stats.tx_bytes); -+#endif //CONFIG_TDLS -+ DBG_871X_SEL_NL(m, "==============================\n"); + } + + } @@ -19100,53 +10162,42 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); + -+ return 0; ++ *eof = 1; ++ return len; ++ +} + -+#endif -+ -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+int proc_get_rtkm_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct recv_buf *precvbuf; -+ -+ precvbuf = (struct recv_buf *)precvpriv->precv_buf; -+ -+ DBG_871X_SEL_NL(m, "============[RTKM Info]============\n"); -+ DBG_871X_SEL_NL(m, "MAX_RTKM_NR_PREALLOC_RECV_SKB: %d\n", rtw_rtkm_get_nr_recv_skb()); -+ DBG_871X_SEL_NL(m, "MAX_RTKM_RECVBUF_SZ: %d\n", rtw_rtkm_get_buff_size()); -+ -+ DBG_871X_SEL_NL(m, "============[Driver Info]============\n"); -+ DBG_871X_SEL_NL(m, "NR_PREALLOC_RECV_SKB: %d\n", NR_PREALLOC_RECV_SKB); -+ DBG_871X_SEL_NL(m, "MAX_RECVBUF_SZ: %d\n", precvbuf->alloc_sz); -+ -+ return 0; -+} -+#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ ++#endif + +#ifdef DBG_MEMORY_LEAK +#include +extern atomic_t _malloc_cnt;; +extern atomic_t _malloc_size;; + -+int proc_get_malloc_cnt(struct seq_file *m, void *v) ++int proc_get_malloc_cnt(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ DBG_871X_SEL_NL(m, "_malloc_cnt=%d\n", atomic_read(&_malloc_cnt)); -+ DBG_871X_SEL_NL(m, "_malloc_size=%d\n", atomic_read(&_malloc_size)); + -+ return 0; ++ int len = 0; ++ ++ len += snprintf(page + len, count - len, "_malloc_cnt=%d\n", atomic_read(&_malloc_cnt)); ++ len += snprintf(page + len, count - len, "_malloc_size=%d\n", atomic_read(&_malloc_size)); ++ ++ *eof = 1; ++ return len; +} +#endif /* DBG_MEMORY_LEAK */ + +#ifdef CONFIG_FIND_BEST_CHANNEL -+int proc_get_best_channel(struct seq_file *m, void *v) ++int proc_get_best_channel(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ -+ struct net_device *dev = m->private; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ int len = 0; + u32 i, best_channel_24G = 1, best_channel_5G = 36, index_24G = 0, index_5G = 0; + + for (i=0; pmlmeext->channel_set[i].ChannelNum !=0; i++) { @@ -19154,9 +10205,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + index_24G = i; + if ( pmlmeext->channel_set[i].ChannelNum == 36) + index_5G = i; -+ } -+ -+ for (i=0; (i < MAX_CHANNEL_NUM) && (pmlmeext->channel_set[i].ChannelNum !=0) ; i++) { ++ } ++ ++ for (i=0; pmlmeext->channel_set[i].ChannelNum !=0; i++) { + // 2.4G + if ( pmlmeext->channel_set[i].ChannelNum == 6 ) { + if ( pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_24G].rx_count ) { @@ -19186,162 +10237,88 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + } + } +#if 1 // debug -+ DBG_871X_SEL_NL(m, "The rx cnt of channel %3d = %d\n", ++ len += snprintf(page + len, count - len, "The rx cnt of channel %3d = %d\n", + pmlmeext->channel_set[i].ChannelNum, pmlmeext->channel_set[i].rx_count); +#endif + } -+ -+ DBG_871X_SEL_NL(m, "best_channel_5G = %d\n", best_channel_5G); -+ DBG_871X_SEL_NL(m, "best_channel_24G = %d\n", best_channel_24G); + -+ return 0; ++ len += snprintf(page + len, count - len, "best_channel_5G = %d\n", best_channel_5G); ++ len += snprintf(page + len, count - len, "best_channel_24G = %d\n", best_channel_24G); ++ ++ *eof = 1; ++ return len; ++ +} ++#endif /* CONFIG_FIND_BEST_CHANNEL */ ++#ifdef CONFIG_BT_COEXIST ++#define _bt_dbg_off_ 0 ++#define _bt_dbg_on_ 1 + -+ssize_t proc_set_best_channel(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++extern u32 BTCoexDbgLevel; ++int proc_get_btcoex_dbg(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ ++ int len = 0; ++ ++ if(pregpriv) ++ len += snprintf(page + len, count - len, ++ "%d\n", ++ BTCoexDbgLevel ++ ); ++ ++ *eof = 1; ++ return len; ++} ++ ++int proc_set_btcoex_dbg(struct file *file, const char *buffer, ++ unsigned long count, void *data) ++{ ++ struct net_device *dev = (struct net_device *)data; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregpriv = &padapter->registrypriv; + char tmp[32]; -+ -+ if(count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int i; -+ for(i = 0; pmlmeext->channel_set[i].ChannelNum != 0; i++) -+ { -+ pmlmeext->channel_set[i].rx_count = 0; -+ } -+ -+ DBG_871X("set %s\n", "Clean Best Channel Count"); -+ } -+ -+ return count; -+} -+#endif /* CONFIG_FIND_BEST_CHANNEL */ -+ -+#ifdef CONFIG_BT_COEXIST -+int proc_get_btcoex_dbg(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ PADAPTER padapter; -+ char buf[512] = {0}; -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+ rtw_btcoex_GetDBG(padapter, buf, 512); -+ -+ DBG_871X_SEL(m, "%s", buf); -+ -+ return 0; -+} -+ -+ssize_t proc_set_btcoex_dbg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ PADAPTER padapter; -+ u8 tmp[80] = {0}; -+ u32 module[2] = {0}; -+ u32 num; -+ -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+// DBG_871X("+" FUNC_ADPT_FMT "\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (NULL == buffer) -+ { -+ DBG_871X(FUNC_ADPT_FMT ": input buffer is NULL!\n", -+ FUNC_ADPT_ARG(padapter)); -+ -+ return -EFAULT; -+ } ++ u32 mode; + + if (count < 1) -+ { -+ DBG_871X(FUNC_ADPT_FMT ": input length is 0!\n", -+ FUNC_ADPT_ARG(padapter)); -+ + return -EFAULT; ++ ++ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { ++ ++ int num = sscanf(tmp, "%d ", &mode); ++ ++ if( pregpriv && (mode == 0 || mode == 1|| mode == 2|| mode == 3)) ++ { ++ BTCoexDbgLevel= mode; ++ printk("btcoex_dbg=%d\n", BTCoexDbgLevel); ++ } + } + -+ num = count; -+ if (num > (sizeof(tmp) - 1)) -+ num = (sizeof(tmp) - 1); -+ -+ if (copy_from_user(tmp, buffer, num)) -+ { -+ DBG_871X(FUNC_ADPT_FMT ": copy buffer from user space FAIL!\n", -+ FUNC_ADPT_ARG(padapter)); -+ -+ return -EFAULT; -+ } -+ -+ num = sscanf(tmp, "%x %x", module, module+1); -+ if (1 == num) -+ { -+ if (0 == module[0]) -+ _rtw_memset(module, 0, sizeof(module)); -+ else -+ _rtw_memset(module, 0xFF, sizeof(module)); -+ } -+ else if (2 != num) -+ { -+ DBG_871X(FUNC_ADPT_FMT ": input(\"%s\") format incorrect!\n", -+ FUNC_ADPT_ARG(padapter), tmp); -+ -+ if (0 == num) -+ return -EFAULT; -+ } -+ -+ DBG_871X(FUNC_ADPT_FMT ": input 0x%08X 0x%08X\n", -+ FUNC_ADPT_ARG(padapter), module[0], module[1]); -+ rtw_btcoex_SetDBG(padapter, module); -+ + return count; -+} + -+int proc_get_btcoex_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ PADAPTER padapter; -+ const u32 bufsize = 30*100; -+ u8 *pbuf = NULL; -+ -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+ pbuf = rtw_zmalloc(bufsize); -+ if (NULL == pbuf) { -+ return -ENOMEM; -+ } -+ -+ rtw_btcoex_DisplayBtCoexInfo(padapter, pbuf, bufsize); -+ -+ DBG_871X_SEL(m, "%s\n", pbuf); -+ -+ rtw_mfree(pbuf, bufsize); -+ -+ return 0; +} +#endif /* CONFIG_BT_COEXIST */ + +#if defined(DBG_CONFIG_ERROR_DETECT) -+int proc_get_sreset(struct seq_file *m, void *v) ++int proc_get_sreset(char *page, char **start, off_t offset, int count, int *eof, void *data) +{ -+ struct net_device *dev = m->private; ++ struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + -+ return 0; ++ int len = 0; ++ ++ *eof = 1; ++ return len; +} + -+ssize_t proc_set_sreset(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) ++int proc_set_sreset(struct file *file, const char *buffer, unsigned long count, void *data) +{ -+ struct net_device *dev = data; ++ struct net_device *dev = (struct net_device *)data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + s32 trigger_point; @@ -19349,12 +10326,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + if (count < 1) + return -EFAULT; + -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { ++ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { + + int num = sscanf(tmp, "%d", &trigger_point); + @@ -19363,1087 +10335,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_debug.c linux/3rdparty/rtl8812a + else + sreset_set_trigger_point(padapter, trigger_point); + } -+ ++ + return count; -+ ++ +} +#endif /* DBG_CONFIG_ERROR_DETECT */ + -+#ifdef CONFIG_PCI_HCI -+ -+int proc_get_rx_ring(struct seq_file *m, void *v) -+{ -+ _irqL irqL; -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct rtw_rx_ring *rx_ring = &precvpriv->rx_ring[RX_MPDU_QUEUE]; -+ int i, j; -+ -+ DBG_871X_SEL_NL(m, "rx ring (%p)\n", rx_ring); -+ DBG_871X_SEL_NL(m, " dma: 0x%08x\n", (int) rx_ring->dma); -+ DBG_871X_SEL_NL(m, " idx: %d\n", rx_ring->idx); -+ -+ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ for (i=0; irxringcount; i++) -+ { -+ struct recv_stat *entry = &rx_ring->desc[i]; -+ struct sk_buff *skb = rx_ring->rx_buf[i]; -+ -+ DBG_871X_SEL_NL(m, " desc[%03d]: %p, rx_buf[%03d]: 0x%08x\n", -+ i, entry, i, cpu_to_le32(*((dma_addr_t *)skb->cb))); -+ -+ for (j=0; jirq_th_lock, &irqL); -+ -+ return 0; -+} -+ -+int proc_get_tx_ring(struct seq_file *m, void *v) -+{ -+ _irqL irqL; -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ int i, j, k; -+ -+ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ for (i = 0; i < PCI_MAX_TX_QUEUE_COUNT; i++) -+ { -+ struct rtw_tx_ring *tx_ring = &pxmitpriv->tx_ring[i]; -+ -+ DBG_871X_SEL_NL(m, "tx ring[%d] (%p)\n", i, tx_ring); -+ DBG_871X_SEL_NL(m, " dma: 0x%08x\n", (int) tx_ring->dma); -+ DBG_871X_SEL_NL(m, " idx: %d\n", tx_ring->idx); -+ DBG_871X_SEL_NL(m, " entries: %d\n", tx_ring->entries); -+// DBG_871X_SEL_NL(m, " queue: %d\n", tx_ring->queue); -+ DBG_871X_SEL_NL(m, " qlen: %d\n", tx_ring->qlen); -+ -+ for (j=0; j < pxmitpriv->txringcount[i]; j++) -+ { -+ struct tx_desc *entry = &tx_ring->desc[j]; -+ -+ DBG_871X_SEL_NL(m, " desc[%03d]: %p\n", j, entry); -+ for (k=0; k < sizeof(*entry)/4; k++) -+ { -+ if ((k % 4) == 0) -+ DBG_871X_SEL_NL(m, " 0x%03x", k); -+ -+ DBG_871X_SEL_NL(m, " 0x%08x ", ((int *) entry)[k]); -+ -+ if ((k % 4) == 3) -+ DBG_871X_SEL_NL(m, "\n"); -+ } -+ } -+ } -+ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ -+ return 0; -+} +#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+int proc_get_wowlan_gpio_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8 val = pwrpriv->is_high_active; -+ -+ DBG_871X_SEL_NL(m, "wakeup_gpio_idx: %d\n", WAKEUP_GPIO_IDX); -+ DBG_871X_SEL_NL(m, "high_active: %d\n", val); -+ -+ return 0; -+} -+ -+ssize_t proc_set_wowlan_gpio_info(struct file *file, const char __user *buffer, -+ size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ char tmp[32] = {0}; -+ int num = 0; -+ u32 is_high_active = 0; -+ u8 val8 = 0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ num = sscanf(tmp, "%u", &is_high_active); -+ -+ is_high_active = is_high_active == 0 ? 0 : 1; -+ -+ pwrpriv->is_high_active = is_high_active; -+ -+ rtw_ps_deny(padapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(padapter); -+ val8 = (pwrpriv->is_high_active == 0) ? 1 : 0; -+ rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, val8); -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+ -+ DBG_871X("set %s %d\n", "gpio_high_active", -+ pwrpriv->is_high_active); -+ DBG_871X("%s: set GPIO_%d %d as default.\n", -+ __func__, WAKEUP_GPIO_IDX, val8); -+ } -+ -+ return count; -+} -+#endif /* CONFIG_GPIO_WAKEUP */ -+ -+#ifdef CONFIG_P2P_WOWLAN -+int proc_get_p2p_wowlan_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ struct p2p_wowlan_info peerinfo = pwdinfo->p2p_wow_info; -+ if(_TRUE == peerinfo.is_trigger) -+ { -+ DBG_871X_SEL_NL(m,"is_trigger: TRUE\n"); -+ switch(peerinfo.wowlan_recv_frame_type) -+ { -+ case P2P_WOWLAN_RECV_NEGO_REQ: -+ DBG_871X_SEL_NL(m,"Frame Type: Nego Request\n"); -+ break; -+ case P2P_WOWLAN_RECV_INVITE_REQ: -+ DBG_871X_SEL_NL(m,"Frame Type: Invitation Request\n"); -+ break; -+ case P2P_WOWLAN_RECV_PROVISION_REQ: -+ DBG_871X_SEL_NL(m,"Frame Type: Provision Request\n"); -+ break; -+ default: -+ break; -+ } -+ DBG_871X_SEL_NL(m,"Peer Addr: "MAC_FMT"\n", MAC_ARG(peerinfo.wowlan_peer_addr)); -+ DBG_871X_SEL_NL(m,"Peer WPS Config: %x\n", peerinfo.wowlan_peer_wpsconfig); -+ DBG_871X_SEL_NL(m,"Persistent Group: %d\n", peerinfo.wowlan_peer_is_persistent); -+ DBG_871X_SEL_NL(m,"Intivation Type: %d\n", peerinfo.wowlan_peer_invitation_type); -+ } -+ else -+ { -+ DBG_871X_SEL_NL(m,"is_trigger: False\n"); -+ } -+ return 0; -+} -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+int proc_get_new_bcn_max(struct seq_file *m, void *v) -+{ -+ extern int new_bcn_max; -+ -+ DBG_871X_SEL_NL(m, "%d", new_bcn_max); -+ return 0; -+} -+ -+ssize_t proc_set_new_bcn_max(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ char tmp[32]; -+ extern int new_bcn_max; -+ -+ if(count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) -+ sscanf(tmp, "%d ", &new_bcn_max); -+ -+ return count; -+} -+ -+#ifdef CONFIG_POWER_SAVING -+int proc_get_ps_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8 ips_mode = pwrpriv->ips_mode; -+ u8 lps_mode = pwrpriv->power_mgnt; -+ char *str = ""; -+ -+ DBG_871X_SEL_NL(m, "======Power Saving Info:======\n"); -+ DBG_871X_SEL_NL(m, "*IPS:\n"); -+ -+ if (ips_mode == IPS_NORMAL) { -+#ifdef CONFIG_FWLPS_IN_IPS -+ str = "FW_LPS_IN_IPS"; -+#else -+ str = "Card Disable"; -+#endif -+ } else if (ips_mode == IPS_NONE) { -+ str = "NO IPS"; -+ } else if (ips_mode == IPS_LEVEL_2) { -+ str = "IPS_LEVEL_2"; -+ } else { -+ str = "invalid ips_mode"; -+ } -+ -+ DBG_871X_SEL_NL(m, " IPS mode: %s\n", str); -+ DBG_871X_SEL_NL(m, " IPS enter count:%d, IPS leave count:%d\n", -+ pwrpriv->ips_enter_cnts, pwrpriv->ips_leave_cnts); -+ DBG_871X_SEL_NL(m, "------------------------------\n"); -+ DBG_871X_SEL_NL(m, "*LPS:\n"); -+ -+ if (lps_mode == PS_MODE_ACTIVE) { -+ str = "NO LPS"; -+ } else if (lps_mode == PS_MODE_MIN) { -+ str = "MIN"; -+ } else if (lps_mode == PS_MODE_MAX) { -+ str = "MAX"; -+ } else if (lps_mode == PS_MODE_DTIM) { -+ str = "DTIM"; -+ } else { -+ sprintf(str, "%d", lps_mode); -+ } -+ -+ DBG_871X_SEL_NL(m, " LPS mode: %s\n", str); -+ -+ if (pwrpriv->dtim != 0) -+ DBG_871X_SEL_NL(m, " DTIM: %d\n", pwrpriv->dtim); -+ DBG_871X_SEL_NL(m, " LPS enter count:%d, LPS leave count:%d\n", -+ pwrpriv->lps_enter_cnts, pwrpriv->lps_leave_cnts); -+ DBG_871X_SEL_NL(m, "=============================\n"); -+ return 0; -+} -+#endif //CONFIG_POWER_SAVING -+ -+#ifdef CONFIG_TDLS -+static int proc_tdls_display_tdls_function_info(struct seq_file *m) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ u8 SpaceBtwnItemAndValue = TDLS_DBG_INFO_SPACE_BTWN_ITEM_AND_VALUE; -+ u8 SpaceBtwnItemAndValueTmp = 0; -+ BOOLEAN FirstMatchFound = _FALSE; -+ int j= 0; -+ -+ DBG_871X_SEL_NL(m, "============[TDLS Function Info]============\n"); -+ DBG_871X_SEL_NL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Prohibited", (ptdlsinfo->ap_prohibited == _TRUE) ? "_TRUE" : "_FALSE"); -+ DBG_871X_SEL_NL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Channel Switch Prohibited", (ptdlsinfo->ch_switch_prohibited == _TRUE) ? "_TRUE" : "_FALSE"); -+ DBG_871X_SEL_NL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Link Established", (ptdlsinfo->link_established == _TRUE) ? "_TRUE" : "_FALSE"); -+ DBG_871X_SEL_NL(m, "%-*s = %d/%d\n", SpaceBtwnItemAndValue, "TDLS STA Num (Linked/Allowed)", ptdlsinfo->sta_cnt, MAX_ALLOWED_TDLS_STA_NUM); -+ DBG_871X_SEL_NL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Allowed STA Num Reached", (ptdlsinfo->sta_maximum == _TRUE) ? "_TRUE" : "_FALSE"); -+ -+#ifdef CONFIG_TDLS_CH_SW -+ DBG_871X_SEL_NL(m, "%-*s =", SpaceBtwnItemAndValue, "TDLS CH SW State"); -+ if (ptdlsinfo->chsw_info.ch_sw_state == TDLS_STATE_NONE) -+ { -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_STATE_NONE"); -+ } -+ else -+ { -+ for (j = 0; j < 32; j++) -+ { -+ if (ptdlsinfo->chsw_info.ch_sw_state & BIT(j)) -+ { -+ if (FirstMatchFound == _FALSE) -+ { -+ SpaceBtwnItemAndValueTmp = 1; -+ FirstMatchFound = _TRUE; -+ } -+ else -+ { -+ SpaceBtwnItemAndValueTmp = SpaceBtwnItemAndValue + 3; -+ } -+ switch (BIT(j)) -+ { -+ case TDLS_INITIATOR_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_INITIATOR_STATE"); -+ break; -+ case TDLS_RESPONDER_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_RESPONDER_STATE"); -+ break; -+ case TDLS_LINKED_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_LINKED_STATE"); -+ break; -+ case TDLS_WAIT_PTR_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_WAIT_PTR_STATE"); -+ break; -+ case TDLS_ALIVE_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_ALIVE_STATE"); -+ break; -+ case TDLS_CH_SWITCH_ON_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_CH_SWITCH_ON_STATE"); -+ break; -+ case TDLS_PEER_AT_OFF_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_PEER_AT_OFF_STATE"); -+ break; -+ case TDLS_CH_SW_INITIATOR_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_CH_SW_INITIATOR_STATE"); -+ break; -+ case TDLS_WAIT_CH_RSP_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValue, " ", "TDLS_WAIT_CH_RSP_STATE"); -+ break; -+ default: -+ DBG_871X_SEL_NL(m, "%-*sBIT(%d)\n", SpaceBtwnItemAndValueTmp, " ", j); -+ break; -+ } -+ } -+ } -+ } -+ -+ DBG_871X_SEL_NL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS CH SW On", (ATOMIC_READ(&ptdlsinfo->chsw_info.chsw_on) == _TRUE) ? "_TRUE" : "_FALSE"); -+ DBG_871X_SEL_NL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "TDLS CH SW Off-Channel Num", ptdlsinfo->chsw_info.off_ch_num); -+ DBG_871X_SEL_NL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "TDLS CH SW Channel Offset", ptdlsinfo->chsw_info.ch_offset); -+ DBG_871X_SEL_NL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "TDLS CH SW Current Time", ptdlsinfo->chsw_info.cur_time); -+ DBG_871X_SEL_NL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS CH SW Delay Switch Back", (ptdlsinfo->chsw_info.delay_switch_back == _TRUE) ? "_TRUE" : "_FALSE"); -+ DBG_871X_SEL_NL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "TDLS CH SW Dump Back", ptdlsinfo->chsw_info.dump_stack); -+#endif -+ -+ DBG_871X_SEL_NL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Device Discovered", (ptdlsinfo->dev_discovered == _TRUE) ? "_TRUE" : "_FALSE"); -+ DBG_871X_SEL_NL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Enable", (ptdlsinfo->tdls_enable == _TRUE) ? "_TRUE" : "_FALSE"); -+ DBG_871X_SEL_NL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Driver Setup", (ptdlsinfo->driver_setup == _TRUE) ? "_TRUE" : "_FALSE"); -+ -+ return 0; -+} -+ -+static int proc_tdls_display_network_info(struct seq_file *m) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ int i = 0; -+ u8 SpaceBtwnItemAndValue = TDLS_DBG_INFO_SPACE_BTWN_ITEM_AND_VALUE; -+ -+ /* Display the linked AP/GO info */ -+ DBG_871X_SEL_NL(m, "============[Associated AP/GO Info]============\n"); -+ -+ if ((pmlmepriv->fw_state & WIFI_STATION_STATE) && (pmlmepriv->fw_state & _FW_LINKED)) -+ { -+ DBG_871X_SEL_NL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "BSSID", cur_network->network.Ssid.Ssid); -+ DBG_871X_SEL_NL(m, "%-*s = "MAC_FMT"\n", SpaceBtwnItemAndValue, "Mac Address", MAC_ARG(cur_network->network.MacAddress)); -+ -+ DBG_871X_SEL_NL(m, "%-*s = ", SpaceBtwnItemAndValue, "Wireless Mode"); -+ for (i = 0; i < 8; i++) -+ { -+ if (pmlmeext->cur_wireless_mode & BIT(i)) -+ { -+ switch (BIT(i)) -+ { -+ case WIRELESS_11B: -+ DBG_871X_SEL_NL(m, "%4s", "11B "); -+ break; -+ case WIRELESS_11G: -+ DBG_871X_SEL_NL(m, "%4s", "11G "); -+ break; -+ case WIRELESS_11A: -+ DBG_871X_SEL_NL(m, "%4s", "11A "); -+ break; -+ case WIRELESS_11_24N: -+ DBG_871X_SEL_NL(m, "%7s", "11_24N "); -+ break; -+ case WIRELESS_11_5N: -+ DBG_871X_SEL_NL(m, "%6s", "11_5N "); -+ break; -+ case WIRELESS_AUTO: -+ DBG_871X_SEL_NL(m, "%5s", "AUTO "); -+ break; -+ case WIRELESS_11AC: -+ DBG_871X_SEL_NL(m, "%5s", "11AC "); -+ break; -+ } -+ } -+ } -+ DBG_871X_SEL_NL(m, "\n"); -+ -+ DBG_871X_SEL_NL(m, "%-*s = ", SpaceBtwnItemAndValue, "Privacy"); -+ switch (padapter->securitypriv.dot11PrivacyAlgrthm) -+ { -+ case _NO_PRIVACY_: -+ DBG_871X_SEL_NL(m, "%s\n", "NO PRIVACY"); -+ break; -+ case _WEP40_: -+ DBG_871X_SEL_NL(m, "%s\n", "WEP 40"); -+ break; -+ case _TKIP_: -+ DBG_871X_SEL_NL(m, "%s\n", "TKIP"); -+ break; -+ case _TKIP_WTMIC_: -+ DBG_871X_SEL_NL(m, "%s\n", "TKIP WTMIC"); -+ break; -+ case _AES_: -+ DBG_871X_SEL_NL(m, "%s\n", "AES"); -+ break; -+ case _WEP104_: -+ DBG_871X_SEL_NL(m, "%s\n", "WEP 104"); -+ break; -+ case _WEP_WPA_MIXED_: -+ DBG_871X_SEL_NL(m, "%s\n", "WEP/WPA Mixed"); -+ break; -+ case _SMS4_: -+ DBG_871X_SEL_NL(m, "%s\n", "SMS4"); -+ break; -+#ifdef CONFIG_IEEE80211W -+ case _BIP_: -+ DBG_871X_SEL_NL(m, "%s\n", "BIP"); -+ break; -+#endif //CONFIG_IEEE80211W -+ } -+ -+ DBG_871X_SEL_NL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "Channel", pmlmeext->cur_channel); -+ DBG_871X_SEL_NL(m, "%-*s = ", SpaceBtwnItemAndValue, "Channel Offset"); -+ switch (pmlmeext->cur_ch_offset) -+ { -+ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: -+ DBG_871X_SEL_NL(m, "%s\n", "N/A"); -+ break; -+ case HAL_PRIME_CHNL_OFFSET_LOWER: -+ DBG_871X_SEL_NL(m, "%s\n", "Lower"); -+ break; -+ case HAL_PRIME_CHNL_OFFSET_UPPER: -+ DBG_871X_SEL_NL(m, "%s\n", "Upper"); -+ break; -+ } -+ -+ DBG_871X_SEL_NL(m, "%-*s = ", SpaceBtwnItemAndValue, "Bandwidth Mode"); -+ switch (pmlmeext->cur_bwmode) -+ { -+ case CHANNEL_WIDTH_20: -+ DBG_871X_SEL_NL(m, "%s\n", "20MHz"); -+ break; -+ case CHANNEL_WIDTH_40: -+ DBG_871X_SEL_NL(m, "%s\n", "40MHz"); -+ break; -+ case CHANNEL_WIDTH_80: -+ DBG_871X_SEL_NL(m, "%s\n", "80MHz"); -+ break; -+ case CHANNEL_WIDTH_160: -+ DBG_871X_SEL_NL(m, "%s\n", "160MHz"); -+ break; -+ case CHANNEL_WIDTH_80_80: -+ DBG_871X_SEL_NL(m, "%s\n", "80MHz + 80MHz"); -+ break; -+ } -+ } -+ else -+ { -+ DBG_871X_SEL_NL(m, "No association with AP/GO exists!\n"); -+ } -+ -+ return 0; -+} -+ -+static int proc_tdls_display_tdls_sta_info(struct seq_file *m) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct sta_info *psta; -+ int i = 0, j = 0; -+ _irqL irqL; -+ _list *plist, *phead; -+ u8 SpaceBtwnItemAndValue = TDLS_DBG_INFO_SPACE_BTWN_ITEM_AND_VALUE; -+ u8 SpaceBtwnItemAndValueTmp = 0; -+ u8 NumOfTdlsStaToShow = 0; -+ BOOLEAN FirstMatchFound = _FALSE; -+ -+ /* Search for TDLS sta info to display */ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for (i=0; i< NUM_STA; i++) -+ { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ plist = get_next(plist); -+ if (psta->tdls_sta_state != TDLS_STATE_NONE) -+ { -+ /* We got one TDLS sta info to show */ -+ DBG_871X_SEL_NL(m, "============[TDLS Peer STA Info: STA %d]============\n", ++NumOfTdlsStaToShow); -+ DBG_871X_SEL_NL(m, "%-*s = "MAC_FMT"\n", SpaceBtwnItemAndValue, "Mac Address", MAC_ARG(psta->hwaddr)); -+ DBG_871X_SEL_NL(m, "%-*s =", SpaceBtwnItemAndValue, "TDLS STA State"); -+ SpaceBtwnItemAndValueTmp = 0; -+ FirstMatchFound = _FALSE; -+ for (j = 0; j < 32; j++) -+ { -+ if (psta->tdls_sta_state & BIT(j)) -+ { -+ if (FirstMatchFound == _FALSE) -+ { -+ SpaceBtwnItemAndValueTmp = 1; -+ FirstMatchFound = _TRUE; -+ } -+ else -+ { -+ SpaceBtwnItemAndValueTmp = SpaceBtwnItemAndValue + 3; -+ } -+ switch (BIT(j)) -+ { -+ case TDLS_INITIATOR_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_INITIATOR_STATE"); -+ break; -+ case TDLS_RESPONDER_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_RESPONDER_STATE"); -+ break; -+ case TDLS_LINKED_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_LINKED_STATE"); -+ break; -+ case TDLS_WAIT_PTR_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_WAIT_PTR_STATE"); -+ break; -+ case TDLS_ALIVE_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_ALIVE_STATE"); -+ break; -+ case TDLS_CH_SWITCH_ON_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_CH_SWITCH_ON_STATE"); -+ break; -+ case TDLS_PEER_AT_OFF_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_PEER_AT_OFF_STATE"); -+ break; -+ case TDLS_CH_SW_INITIATOR_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_CH_SW_INITIATOR_STATE"); -+ break; -+ case TDLS_WAIT_CH_RSP_STATE: -+ DBG_871X_SEL_NL(m, "%-*s%s\n", SpaceBtwnItemAndValue, " ", "TDLS_WAIT_CH_RSP_STATE"); -+ break; -+ default: -+ DBG_871X_SEL_NL(m, "%-*sBIT(%d)\n", SpaceBtwnItemAndValueTmp, " ", j); -+ break; -+ } -+ } -+ } -+ -+ DBG_871X_SEL_NL(m, "%-*s = ", SpaceBtwnItemAndValue, "Wireless Mode"); -+ for (j = 0; j < 8; j++) -+ { -+ if (psta->wireless_mode & BIT(j)) -+ { -+ switch (BIT(j)) -+ { -+ case WIRELESS_11B: -+ DBG_871X_SEL_NL(m, "%4s", "11B "); -+ break; -+ case WIRELESS_11G: -+ DBG_871X_SEL_NL(m, "%4s", "11G "); -+ break; -+ case WIRELESS_11A: -+ DBG_871X_SEL_NL(m, "%4s", "11A "); -+ break; -+ case WIRELESS_11_24N: -+ DBG_871X_SEL_NL(m, "%7s", "11_24N "); -+ break; -+ case WIRELESS_11_5N: -+ DBG_871X_SEL_NL(m, "%6s", "11_5N "); -+ break; -+ case WIRELESS_AUTO: -+ DBG_871X_SEL_NL(m, "%5s", "AUTO "); -+ break; -+ case WIRELESS_11AC: -+ DBG_871X_SEL_NL(m, "%5s", "11AC "); -+ break; -+ } -+ } -+ } -+ DBG_871X_SEL_NL(m, "\n"); -+ -+ DBG_871X_SEL_NL(m, "%-*s = ", SpaceBtwnItemAndValue, "Bandwidth Mode"); -+ switch (psta->bw_mode) -+ { -+ case CHANNEL_WIDTH_20: -+ DBG_871X_SEL_NL(m, "%s\n", "20MHz"); -+ break; -+ case CHANNEL_WIDTH_40: -+ DBG_871X_SEL_NL(m, "%s\n", "40MHz"); -+ break; -+ case CHANNEL_WIDTH_80: -+ DBG_871X_SEL_NL(m, "%s\n", "80MHz"); -+ break; -+ case CHANNEL_WIDTH_160: -+ DBG_871X_SEL_NL(m, "%s\n", "160MHz"); -+ break; -+ case CHANNEL_WIDTH_80_80: -+ DBG_871X_SEL_NL(m, "%s\n", "80MHz + 80MHz"); -+ break; -+ } -+ -+ DBG_871X_SEL_NL(m, "%-*s = ", SpaceBtwnItemAndValue, "Privacy"); -+ switch (psta->dot118021XPrivacy) -+ { -+ case _NO_PRIVACY_: -+ DBG_871X_SEL_NL(m, "%s\n", "NO PRIVACY"); -+ break; -+ case _WEP40_: -+ DBG_871X_SEL_NL(m, "%s\n", "WEP 40"); -+ break; -+ case _TKIP_: -+ DBG_871X_SEL_NL(m, "%s\n", "TKIP"); -+ break; -+ case _TKIP_WTMIC_: -+ DBG_871X_SEL_NL(m, "%s\n", "TKIP WTMIC"); -+ break; -+ case _AES_: -+ DBG_871X_SEL_NL(m, "%s\n", "AES"); -+ break; -+ case _WEP104_: -+ DBG_871X_SEL_NL(m, "%s\n", "WEP 104"); -+ break; -+ case _WEP_WPA_MIXED_: -+ DBG_871X_SEL_NL(m, "%s\n", "WEP/WPA Mixed"); -+ break; -+ case _SMS4_: -+ DBG_871X_SEL_NL(m, "%s\n", "SMS4"); -+ break; -+#ifdef CONFIG_IEEE80211W -+ case _BIP_: -+ DBG_871X_SEL_NL(m, "%s\n", "BIP"); -+ break; -+#endif //CONFIG_IEEE80211W -+ } -+ -+ DBG_871X_SEL_NL(m, "%-*s = %d sec/%d sec\n", SpaceBtwnItemAndValue, "TPK Lifetime (Current/Expire)", psta->TPK_count, psta->TDLS_PeerKey_Lifetime); -+ DBG_871X_SEL_NL(m, "%-*s = %llu\n", SpaceBtwnItemAndValue, "Tx Packets Over Direct Link", psta->sta_stats.tx_pkts); -+ DBG_871X_SEL_NL(m, "%-*s = %llu\n", SpaceBtwnItemAndValue, "Rx Packets Over Direct Link", psta->sta_stats.rx_data_pkts); -+ } -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ if (NumOfTdlsStaToShow == 0) -+ { -+ DBG_871X_SEL_NL(m, "============[TDLS Peer STA Info]============\n"); -+ DBG_871X_SEL_NL(m, "No TDLS direct link exists!\n"); -+ } -+ -+ return 0; -+} -+ -+int proc_get_tdls_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct sta_info *psta; -+ int i = 0, j = 0; -+ _irqL irqL; -+ _list *plist, *phead; -+ u8 SpaceBtwnItemAndValue = 41; -+ u8 SpaceBtwnItemAndValueTmp = 0; -+ u8 NumOfTdlsStaToShow = 0; -+ BOOLEAN FirstMatchFound = _FALSE; -+ -+ proc_tdls_display_tdls_function_info(m); -+ proc_tdls_display_network_info(m); -+ proc_tdls_display_tdls_sta_info(m); -+ -+ return 0; -+} -+#endif -+ -+int proc_get_monitor(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (WIFI_MONITOR_STATE == get_fwstate(pmlmepriv)) { -+ DBG_871X_SEL_NL(m, "Monitor mode : Enable\n"); -+ -+ DBG_871X_SEL_NL(m, "ch=%d, ch_offset=%d, bw=%d\n", -+ rtw_get_oper_ch(padapter), rtw_get_oper_choffset(padapter), rtw_get_oper_bw(padapter)); -+ } else { -+ DBG_871X_SEL_NL(m, "Monitor mode : Disable\n"); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_monitor(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ char tmp[32]; -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 target_chan, target_offset, target_bw; -+ -+ if (count < 3) { -+ DBG_871X("argument size is less than 3\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%hhu %hhu %hhu", &target_chan, &target_offset, &target_bw); -+ -+ if (num != 3) { -+ DBG_871X("invalid write_reg parameter!\n"); -+ return count; -+ } -+ -+ padapter->mlmeextpriv.cur_channel = target_chan; -+ set_channel_bwmode(padapter, target_chan, target_offset, target_bw); -+ } -+ -+ return count; -+} -+ -+#include -+int proc_get_efuse_map(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+ int i, j; -+ u8 ips_mode = IPS_NUM; -+ int mapLen = EFUSE_MAP_SIZE; -+ -+ ips_mode = pwrctrlpriv->ips_mode; -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ if (rtw_efuse_map_read(padapter, EFUSE_WIFI, mapLen, pEfuseHal->fakeEfuseInitMap) == _FAIL) -+ DBG_871X_SEL_NL(m, "WARN - Read Realmap Failed\n"); -+ -+ DBG_871X_SEL_NL(m, "\n"); -+ for (i = 0; i < EFUSE_MAP_SIZE; i += 16) { -+ DBG_871X_SEL_NL(m, "0x%02x\t", i); -+ for (j = 0; j < 8; j++) -+ DBG_871X_SEL_NL(m, "%02X ", pEfuseHal->fakeEfuseInitMap[i+j]); -+ -+ DBG_871X_SEL_NL(m, "\t"); -+ -+ for (; j < 16; j++) -+ DBG_871X_SEL_NL(m, "%02X ", pEfuseHal->fakeEfuseInitMap[i+j]); -+ -+ DBG_871X_SEL_NL(m, "\n"); -+ -+ } -+ rtw_pm_set_ips(padapter, ips_mode); -+ return 0; -+} -+ -+ssize_t proc_set_efuse_map(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+#if 0 -+ char tmp[256] = {0}; -+ u32 addr, cnts; -+ u8 efuse_data; -+ -+ int jj, kk; -+ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ u8 ips_mode = IPS_NUM; -+ -+ if (count < 3) { -+ DBG_871X("argument size is less than 3\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%x %d %x", &addr, &cnts, &efuse_data); -+ -+ if (num != 3) { -+ DBG_871X("invalid write_reg parameter!\n"); -+ return count; -+ } -+ } -+ ips_mode = pwrctrlpriv->ips_mode; -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ if (rtw_efuse_map_write(padapter, addr, cnts, &efuse_data) == _FAIL) -+ DBG_871X("WARN - rtw_efuse_map_write error!!\n"); -+ rtw_pm_set_ips(padapter, ips_mode); -+#endif -+ return count; -+} -+ -+#ifdef CONFIG_IEEE80211W -+ssize_t proc_set_tx_sa_query(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ struct sta_info *psta; -+ _list *plist, *phead; -+ _irqL irqL; -+ char tmp[16]; -+ u8 mac_addr[NUM_STA][ETH_ALEN]; -+ u32 key_type; -+ u8 index; -+ -+ if (count > 2) { -+ DBG_871X("argument size is more than 2\n"); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%x", &key_type); -+ -+ if (num != 1) { -+ DBG_871X("invalid read_reg parameter!\n"); -+ return count; -+ } -+ DBG_871X("0: set sa query request , key_type=%d\n", key_type); -+ } -+ -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) && padapter->securitypriv.binstallBIPkey == _TRUE) { -+ DBG_871X("STA:"MAC_FMT"\n", MAC_ARG(get_my_bssid(&(pmlmeinfo->network)))); -+ /* TX unicast sa_query to AP */ -+ issue_action_SA_Query(padapter, get_my_bssid(&(pmlmeinfo->network)), 0, 0, (u8)key_type); -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE && padapter->securitypriv.binstallBIPkey == _TRUE) { -+ /* TX unicast sa_query to every client STA */ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for (index = 0; index < NUM_STA; index++) { -+ psta = NULL; -+ -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ plist = get_next(plist); -+ _rtw_memcpy(&mac_addr[psta->mac_id][0], psta->hwaddr, ETH_ALEN); -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for (index = 0; index < macid_ctl->num && index < NUM_STA; index++) { -+ if (rtw_macid_is_used(macid_ctl, index) && !rtw_macid_is_bmc(macid_ctl, index)) { -+ if (!_rtw_memcmp(get_my_bssid(&(pmlmeinfo->network)), &mac_addr[index][0], ETH_ALEN) -+ && !IS_MCAST(&mac_addr[index][0])) { -+ issue_action_SA_Query(padapter, &mac_addr[index][0], 0, 0, (u8)key_type); -+ DBG_871X("STA[%u]:"MAC_FMT"\n", index , MAC_ARG(&mac_addr[index][0])); -+ } -+ } -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_tx_sa_query(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X_SEL_NL(m, "%s\n", __func__); -+ return 0; -+} -+ -+ssize_t proc_set_tx_deauth(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ struct sta_info *psta; -+ _list *plist, *phead; -+ _irqL irqL; -+ char tmp[16]; -+ u8 mac_addr[NUM_STA][ETH_ALEN]; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u32 key_type; -+ u8 index; -+ -+ -+ if (count > 2) { -+ DBG_871X("argument size is more than 2\n"); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%x", &key_type); -+ -+ if (num != 1) { -+ DBG_871X("invalid read_reg parameter!\n"); -+ return count; -+ } -+ DBG_871X("key_type=%d\n", key_type); -+ } -+ if (key_type < 0 || key_type > 4) -+ return count; -+ -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { -+ if (key_type == 3) /* key_type 3 only for AP mode */ -+ return count; -+ /* TX unicast deauth to AP */ -+ issue_deauth_11w(padapter, get_my_bssid(&(pmlmeinfo->network)), 0, (u8)key_type); -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+ -+ if (key_type == 3) -+ issue_deauth_11w(padapter, bc_addr, 0, IEEE80211W_RIGHT_KEY); -+ -+ /* TX unicast deauth to every client STA */ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for (index = 0; index < NUM_STA; index++) { -+ psta = NULL; -+ -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ plist = get_next(plist); -+ _rtw_memcpy(&mac_addr[psta->mac_id][0], psta->hwaddr, ETH_ALEN); -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for (index = 0; index < macid_ctl->num && index < NUM_STA; index++) { -+ if (rtw_macid_is_used(macid_ctl, index) && !rtw_macid_is_bmc(macid_ctl, index)) { -+ if (!_rtw_memcmp(get_my_bssid(&(pmlmeinfo->network)), &mac_addr[index][0], ETH_ALEN)) { -+ if (key_type != 3) -+ issue_deauth_11w(padapter, &mac_addr[index][0], 0, (u8)key_type); -+ -+ psta = rtw_get_stainfo(pstapriv, &mac_addr[index][0]); -+ if (psta && key_type != IEEE80211W_WRONG_KEY && key_type != IEEE80211W_NO_KEY) { -+ u8 updated = _FALSE; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_PREV_AUTH_NOT_VALID, _TRUE); -+ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); -+ } -+ -+ DBG_871X("STA[%u]:"MAC_FMT"\n", index , MAC_ARG(&mac_addr[index][0])); -+ } -+ } -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_tx_deauth(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X_SEL_NL(m, "%s\n", __func__); -+ return 0; -+} -+ -+ssize_t proc_set_tx_auth(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ struct sta_info *psta; -+ _list *plist, *phead; -+ _irqL irqL; -+ char tmp[16]; -+ u8 mac_addr[NUM_STA][ETH_ALEN]; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u32 tx_auth; -+ u8 index; -+ -+ -+ if (count > 2) { -+ DBG_871X("argument size is more than 2\n"); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%x", &tx_auth); -+ -+ if (num != 1) { -+ DBG_871X("invalid read_reg parameter!\n"); -+ return count; -+ } -+ DBG_871X("1: setnd auth, 2: send assoc request. tx_auth=%d\n", tx_auth); -+ } -+ -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { -+ if (tx_auth == 1) { -+ /* TX unicast auth to AP */ -+ issue_auth(padapter, NULL, 0); -+ } else if (tx_auth == 2) { -+ /* TX unicast auth to AP */ -+ issue_assocreq(padapter); -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_tx_auth(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X_SEL_NL(m, "%s\n", __func__); -+ return 0; -+} -+#endif /* CONFIG_IEEE80211W */ -+ -+#endif /* CONFIG_PROC_DEBUG */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_eeprom.c linux/3rdparty/rtl8812au/core/rtw_eeprom.c ---- linux.old/3rdparty/rtl8812au/core/rtw_eeprom.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_eeprom.c 2017-06-07 23:07:20.999686482 +0300 -@@ -0,0 +1,423 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_ieee80211.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ieee80211.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_ieee80211.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ieee80211.c 2018-02-06 17:42:30.694966927 +0200 +@@ -0,0 +1,2022 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -20453,444 +10359,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_eeprom.c linux/3rdparty/rtl8812 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_EEPROM_C_ -+ -+#include -+#include -+#include -+ -+void up_clk(_adapter* padapter, u16 *x) -+{ -+_func_enter_; -+ *x = *x | _EESK; -+ rtw_write8(padapter, EE_9346CR, (u8)*x); -+ rtw_udelay_os(CLOCK_RATE); -+ -+_func_exit_; -+ -+} -+ -+void down_clk(_adapter * padapter, u16 *x ) -+{ -+_func_enter_; -+ *x = *x & ~_EESK; -+ rtw_write8(padapter, EE_9346CR, (u8)*x); -+ rtw_udelay_os(CLOCK_RATE); -+_func_exit_; -+} -+ -+void shift_out_bits(_adapter * padapter, u16 data, u16 count) -+{ -+ u16 x,mask; -+_func_enter_; -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==_TRUE")); -+ goto out; -+ } -+ mask = 0x01 << (count - 1); -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EEDO | _EEDI); -+ -+ do -+ { -+ x &= ~_EEDI; -+ if(data & mask) -+ x |= _EEDI; -+ if (rtw_is_surprise_removed(padapter)) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==_TRUE")); -+ goto out; -+ } -+ rtw_write8(padapter, EE_9346CR, (u8)x); -+ rtw_udelay_os(CLOCK_RATE); -+ up_clk(padapter, &x); -+ down_clk(padapter, &x); -+ mask = mask >> 1; -+ } while(mask); -+ if (rtw_is_surprise_removed(padapter)) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==_TRUE")); -+ goto out; -+ } -+ x &= ~_EEDI; -+ rtw_write8(padapter, EE_9346CR, (u8)x); -+out: -+_func_exit_; -+} -+ -+u16 shift_in_bits (_adapter * padapter) -+{ -+ u16 x,d=0,i; -+_func_enter_; -+ if (rtw_is_surprise_removed(padapter)) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==_TRUE")); -+ goto out; -+ } -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~( _EEDO | _EEDI); -+ d = 0; -+ -+ for(i=0; i<16; i++) -+ { -+ d = d << 1; -+ up_clk(padapter, &x); -+ if (rtw_is_surprise_removed(padapter)) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==_TRUE")); -+ goto out; -+ } -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EEDI); -+ if(x & _EEDO) -+ d |= 1; -+ -+ down_clk(padapter, &x); -+ } -+out: -+_func_exit_; -+ -+ return d; -+} -+ -+void standby(_adapter * padapter ) -+{ -+ u8 x; -+_func_enter_; -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EECS | _EESK); -+ rtw_write8(padapter, EE_9346CR,x); -+ -+ rtw_udelay_os(CLOCK_RATE); -+ x |= _EECS; -+ rtw_write8(padapter, EE_9346CR, x); -+ rtw_udelay_os(CLOCK_RATE); -+_func_exit_; -+} -+ -+u16 wait_eeprom_cmd_done(_adapter* padapter) -+{ -+ u8 x; -+ u16 i,res=_FALSE; -+_func_enter_; -+ standby(padapter ); -+ for (i=0; i<200; i++) -+ { -+ x = rtw_read8(padapter, EE_9346CR); -+ if (x & _EEDO){ -+ res=_TRUE; -+ goto exit; -+ } -+ rtw_udelay_os(CLOCK_RATE); -+ } -+exit: -+_func_exit_; -+ return res; -+} -+ -+void eeprom_clean(_adapter * padapter) -+{ -+ u16 x; -+_func_enter_; -+ if (rtw_is_surprise_removed(padapter)) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==_TRUE")); -+ goto out; -+ } -+ x = rtw_read8(padapter, EE_9346CR); -+ if (rtw_is_surprise_removed(padapter)) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==_TRUE")); -+ goto out; -+ } -+ x &= ~(_EECS | _EEDI); -+ rtw_write8(padapter, EE_9346CR, (u8)x); -+ if (rtw_is_surprise_removed(padapter)) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==_TRUE")); -+ goto out; -+ } -+ up_clk(padapter, &x); -+ if (rtw_is_surprise_removed(padapter)) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==_TRUE")); -+ goto out; -+ } -+ down_clk(padapter, &x); -+out: -+_func_exit_; -+} -+ -+void eeprom_write16(_adapter * padapter, u16 reg, u16 data) -+{ -+ u8 x; -+#ifdef CONFIG_RTL8712 -+ u8 tmp8_ori,tmp8_new,tmp8_clk_ori,tmp8_clk_new; -+ tmp8_ori=rtw_read8(padapter, 0x102502f1); -+ tmp8_new=tmp8_ori & 0xf7; -+ if(tmp8_ori != tmp8_new){ -+ rtw_write8(padapter, 0x102502f1, tmp8_new); -+ RT_TRACE(_module_rtl871x_mp_ioctl_c_,_drv_err_,("====write 0x102502f1=====\n")); -+ } -+ tmp8_clk_ori=rtw_read8(padapter,0x10250003); -+ tmp8_clk_new=tmp8_clk_ori|0x20; -+ if(tmp8_clk_new!=tmp8_clk_ori){ -+ RT_TRACE(_module_rtl871x_mp_ioctl_c_,_drv_err_,("====write 0x10250003=====\n")); -+ rtw_write8(padapter, 0x10250003, tmp8_clk_new); -+ } -+#endif -+_func_enter_; -+ -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EEDI | _EEDO | _EESK | _EEM0); -+ x |= _EEM1 | _EECS; -+ rtw_write8(padapter, EE_9346CR, x); -+ -+ shift_out_bits(padapter, EEPROM_EWEN_OPCODE, 5); -+ -+ if(padapter->EepromAddressSize==8) //CF+ and SDIO -+ shift_out_bits(padapter, 0, 6); -+ else //USB -+ shift_out_bits(padapter, 0, 4); -+ -+ standby( padapter); -+ -+// Commented out by rcnjko, 2004.0 -+// // Erase this particular word. Write the erase opcode and register -+// // number in that order. The opcode is 3bits in length; reg is 6 bits long. -+// shift_out_bits(Adapter, EEPROM_ERASE_OPCODE, 3); -+// shift_out_bits(Adapter, reg, Adapter->EepromAddressSize); -+// -+// if (wait_eeprom_cmd_done(Adapter ) == FALSE) -+// { -+// return; -+// } -+ -+ -+ standby(padapter ); -+ -+ // write the new word to the EEPROM -+ -+ // send the write opcode the EEPORM -+ shift_out_bits(padapter, EEPROM_WRITE_OPCODE, 3); -+ -+ // select which word in the EEPROM that we are writing to. -+ shift_out_bits(padapter, reg, padapter->EepromAddressSize); -+ -+ // write the data to the selected EEPROM word. -+ shift_out_bits(padapter, data, 16); -+ -+ if (wait_eeprom_cmd_done(padapter ) == _FALSE) -+ { -+ -+ goto exit; -+ } -+ -+ standby(padapter ); -+ -+ shift_out_bits(padapter, EEPROM_EWDS_OPCODE, 5); -+ shift_out_bits(padapter, reg, 4); -+ -+ eeprom_clean(padapter ); -+exit: -+#ifdef CONFIG_RTL8712 -+ if(tmp8_clk_new!=tmp8_clk_ori) -+ rtw_write8(padapter, 0x10250003, tmp8_clk_ori); -+ if(tmp8_new!=tmp8_ori) -+ rtw_write8(padapter, 0x102502f1, tmp8_ori); -+ -+#endif -+_func_exit_; -+ return; -+} -+ -+u16 eeprom_read16(_adapter * padapter, u16 reg) //ReadEEprom -+{ -+ -+ u16 x; -+ u16 data=0; -+#ifdef CONFIG_RTL8712 -+ u8 tmp8_ori,tmp8_new,tmp8_clk_ori,tmp8_clk_new; -+ tmp8_ori= rtw_read8(padapter, 0x102502f1); -+ tmp8_new = tmp8_ori & 0xf7; -+ if(tmp8_ori != tmp8_new){ -+ rtw_write8(padapter, 0x102502f1, tmp8_new); -+ RT_TRACE(_module_rtl871x_mp_ioctl_c_,_drv_err_,("====write 0x102502f1=====\n")); -+ } -+ tmp8_clk_ori=rtw_read8(padapter,0x10250003); -+ tmp8_clk_new=tmp8_clk_ori|0x20; -+ if(tmp8_clk_new!=tmp8_clk_ori){ -+ RT_TRACE(_module_rtl871x_mp_ioctl_c_,_drv_err_,("====write 0x10250003=====\n")); -+ rtw_write8(padapter, 0x10250003, tmp8_clk_new); -+ } -+#endif -+_func_enter_; -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==_TRUE")); -+ goto out; -+ } -+ // select EEPROM, reset bits, set _EECS -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==_TRUE")); -+ goto out; -+ } -+ -+ x &= ~(_EEDI | _EEDO | _EESK | _EEM0); -+ x |= _EEM1 | _EECS; -+ rtw_write8(padapter, EE_9346CR, (unsigned char)x); -+ -+ // write the read opcode and register number in that order -+ // The opcode is 3bits in length, reg is 6 bits long -+ shift_out_bits(padapter, EEPROM_READ_OPCODE, 3); -+ shift_out_bits(padapter, reg, padapter->EepromAddressSize); -+ -+ // Now read the data (16 bits) in from the selected EEPROM word -+ data = shift_in_bits(padapter); -+ -+ eeprom_clean(padapter); -+out: -+#ifdef CONFIG_RTL8712 -+ if(tmp8_clk_new!=tmp8_clk_ori) -+ rtw_write8(padapter, 0x10250003, tmp8_clk_ori); -+ if(tmp8_new!=tmp8_ori) -+ rtw_write8(padapter, 0x102502f1, tmp8_ori); -+ -+#endif -+_func_exit_; -+ return data; -+ -+ -+} -+ -+ -+ -+ -+//From even offset -+void eeprom_read_sz(_adapter * padapter, u16 reg, u8* data, u32 sz) -+{ -+ -+ u16 x, data16; -+ u32 i; -+_func_enter_; -+ if (rtw_is_surprise_removed(padapter)) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==_TRUE")); -+ goto out; -+ } -+ // select EEPROM, reset bits, set _EECS -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==_TRUE")); -+ goto out; -+ } -+ -+ x &= ~(_EEDI | _EEDO | _EESK | _EEM0); -+ x |= _EEM1 | _EECS; -+ rtw_write8(padapter, EE_9346CR, (unsigned char)x); -+ -+ // write the read opcode and register number in that order -+ // The opcode is 3bits in length, reg is 6 bits long -+ shift_out_bits(padapter, EEPROM_READ_OPCODE, 3); -+ shift_out_bits(padapter, reg, padapter->EepromAddressSize); -+ -+ -+ for(i=0; i>8; -+ } -+ -+ eeprom_clean(padapter); -+out: -+_func_exit_; -+ -+ -+ -+} -+ -+ -+//addr_off : address offset of the entry in eeprom (not the tuple number of eeprom (reg); that is addr_off !=reg) -+u8 eeprom_read(_adapter * padapter, u32 addr_off, u8 sz, u8* rbuf) -+{ -+ u8 quotient, remainder, addr_2align_odd; -+ u16 reg, stmp , i=0, idx = 0; -+_func_enter_; -+ reg = (u16)(addr_off >> 1); -+ addr_2align_odd = (u8)(addr_off & 0x1); -+ -+ if(addr_2align_odd) //read that start at high part: e.g 1,3,5,7,9,... -+ { -+ stmp = eeprom_read16(padapter, reg); -+ rbuf[idx++] = (u8) ((stmp>>8)&0xff); //return hogh-part of the short -+ reg++; sz--; -+ } -+ -+ quotient = sz >> 1; -+ remainder = sz & 0x1; -+ -+ for( i=0 ; i < quotient; i++) -+ { -+ stmp = eeprom_read16(padapter, reg+i); -+ rbuf[idx++] = (u8) (stmp&0xff); -+ rbuf[idx++] = (u8) ((stmp>>8)&0xff); -+ } -+ -+ reg = reg+i; -+ if(remainder){ //end of read at lower part of short : 0,2,4,6,... -+ stmp = eeprom_read16(padapter, reg); -+ rbuf[idx] = (u8)(stmp & 0xff); -+ } -+_func_exit_; -+ return _TRUE; -+} -+ -+ -+ -+VOID read_eeprom_content(_adapter * padapter) -+{ -+ -+_func_enter_; -+ -+ -+_func_exit_; -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8812au/core/rtw_ieee80211.c ---- linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_ieee80211.c 2017-06-07 23:07:21.000686574 +0300 -@@ -0,0 +1,2618 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _IEEE80211_C + -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+#include -+#endif +#include + + @@ -20916,16 +10387,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 +u8 RSN_CIPHER_SUITE_CCMP[] = { 0x00, 0x0f, 0xac, 4 }; +u8 RSN_CIPHER_SUITE_WEP104[] = { 0x00, 0x0f, 0xac, 5 }; +//----------------------------------------------------------- -+// for adhoc-master to generate ie and provide supported-rate to fw ++// for adhoc-master to generate ie and provide supported-rate to fw +//----------------------------------------------------------- + -+static u8 WIFI_CCKRATES[] = ++static u8 WIFI_CCKRATES[] = +{(IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK), + (IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK), + (IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK), + (IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK)}; + -+static u8 WIFI_OFDMRATES[] = ++static u8 WIFI_OFDMRATES[] = +{(IEEE80211_OFDM_RATE_6MB), + (IEEE80211_OFDM_RATE_9MB), + (IEEE80211_OFDM_RATE_12MB), @@ -20935,53 +10406,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + IEEE80211_OFDM_RATE_48MB, + IEEE80211_OFDM_RATE_54MB}; + -+u8 mgn_rates_cck[4] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}; -+u8 mgn_rates_ofdm[8] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M}; -+u8 mgn_rates_mcs0_7[8] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}; -+u8 mgn_rates_mcs8_15[8] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}; -+u8 mgn_rates_mcs16_23[8] = {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23}; -+u8 mgn_rates_mcs24_31[8] = {MGN_MCS24, MGN_MCS25, MGN_MCS26, MGN_MCS27, MGN_MCS28, MGN_MCS29, MGN_MCS30, MGN_MCS31}; -+u8 mgn_rates_vht1ss[10] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4 -+ , MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9}; -+u8 mgn_rates_vht2ss[10] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4 -+ , MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9}; -+u8 mgn_rates_vht3ss[10] = {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4 -+ , MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9}; -+u8 mgn_rates_vht4ss[10] = {MGN_VHT4SS_MCS0, MGN_VHT4SS_MCS1, MGN_VHT4SS_MCS2, MGN_VHT4SS_MCS3, MGN_VHT4SS_MCS4 -+ , MGN_VHT4SS_MCS5, MGN_VHT4SS_MCS6, MGN_VHT4SS_MCS7, MGN_VHT4SS_MCS8, MGN_VHT4SS_MCS9}; -+ -+static const char * const _rate_section_str[] = { -+ "CCK", -+ "OFDM", -+ "HT_1SS", -+ "HT_2SS", -+ "HT_3SS", -+ "HT_4SS", -+ "VHT_1SS", -+ "VHT_2SS", -+ "VHT_3SS", -+ "VHT_4SS", -+ "RATE_SECTION_UNKNOWN", -+}; -+ -+const char *rate_section_str(u8 section) -+{ -+ section = (section >= RATE_SECTION_NUM) ? RATE_SECTION_NUM : section; -+ return _rate_section_str[section]; -+} -+ -+struct rate_section_ent rates_by_sections[RATE_SECTION_NUM] = { -+ {RF_1TX, 4, mgn_rates_cck}, -+ {RF_1TX, 8, mgn_rates_ofdm}, -+ {RF_1TX, 8, mgn_rates_mcs0_7}, -+ {RF_2TX, 8, mgn_rates_mcs8_15}, -+ {RF_3TX, 8, mgn_rates_mcs16_23}, -+ {RF_4TX, 8, mgn_rates_mcs24_31}, -+ {RF_1TX, 10, mgn_rates_vht1ss}, -+ {RF_2TX, 10, mgn_rates_vht2ss}, -+ {RF_3TX, 10, mgn_rates_vht3ss}, -+ {RF_4TX, 10, mgn_rates_vht4ss}, -+}; + +int rtw_get_bit_value_from_ieee_value(u8 val) +{ @@ -20997,18 +10421,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 +} + +uint rtw_is_cckrates_included(u8 *rate) -+{ -+ u32 i = 0; ++{ ++ u32 i = 0; + + while(rate[i]!=0) -+ { -+ if ( (((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || -+ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22) ) -+ return _TRUE; ++ { ++ if ( (((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || ++ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22) ) ++ return true; + i++; + } -+ -+ return _FALSE; ++ ++ return false; +} + +uint rtw_is_cckratesonly_included(u8 *rate) @@ -21020,12 +10444,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + { + if ( (((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && + (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22) ) -+ return _FALSE; ++ ++ return false; + + i++; + } -+ -+ return _TRUE; ++ ++ return true; + +} + @@ -21033,21 +10458,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 +{ + if (channel > 14) + { -+ if ((rtw_is_cckrates_included(rate)) == _TRUE) ++ if ((rtw_is_cckrates_included(rate)) == true) + return WIRELESS_INVALID; + else + return WIRELESS_11A; -+ } ++ } + else // could be pure B, pure G, or B/G + { -+ if ((rtw_is_cckratesonly_included(rate)) == _TRUE) ++ if ((rtw_is_cckratesonly_included(rate)) == true) + return WIRELESS_11B; -+ else if((rtw_is_cckrates_included(rate)) == _TRUE) -+ return WIRELESS_11BG; ++ else if((rtw_is_cckrates_included(rate)) == true) ++ return WIRELESS_11BG; + else + return WIRELESS_11G; + } -+ ++ +} + +u8 *rtw_set_fixed_ie(unsigned char *pbuf, unsigned int len, unsigned char *source, @@ -21061,23 +10486,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 +// rtw_set_ie will update frame length +u8 *rtw_set_ie +( -+ u8 *pbuf, -+ sint index, ++ u8 *pbuf, ++ sint index, + uint len, -+ u8 *source, ++ u8 *source, + uint *frlen //frame length +) +{ ++ + *pbuf = (u8)index; + + *(pbuf + 1) = (u8)len; + + if (len > 0) + _rtw_memcpy((void *)(pbuf + 2), (void *)source, len); -+ ++ + *frlen = *frlen + (len + 2); -+ ++ + return (pbuf + len + 2); ++ +} + +inline u8 *rtw_set_ie_ch_switch(u8 *buf, u32 *buf_len, u8 ch_switch_mode, @@ -21140,9 +10567,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 +{ + sint tmp,i; + u8 *p; -+_func_enter_; ++ + if (limit < 1){ -+ _func_exit_; ++ + return NULL; + } + @@ -21165,7 +10592,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + if (i >= limit) + break; + } -+_func_exit_; ++ + return NULL; +} + @@ -21198,13 +10625,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + while(cnt 12) + break; -+ -+ i++; ++ ++ i++; + } -+_func_exit_; ++ + return i; +} + +int rtw_generate_ie(struct registry_priv *pregistrypriv) +{ + u8 wireless_mode; -+ int sz = 0, rateLen; ++ int sz = 0, rateLen; + WLAN_BSSID_EX* pdev_network = &pregistrypriv->dev_network; + u8* ie = pdev_network->IEs; -+ -+_func_enter_; ++ ++ + + //timestamp will be inserted by hardware -+ sz += 8; ++ sz += 8; + ie += sz; -+ -+ //beacon interval : 2bytes -+ *(u16*)ie = cpu_to_le16((u16)pdev_network->Configuration.BeaconPeriod);//BCN_INTERVAL; -+ sz += 2; -+ ie += 2; -+ -+ //capability info -+ *(u16*)ie = 0; -+ -+ *(u16*)ie |= cpu_to_le16(cap_IBSS); + -+ if(pregistrypriv->preamble == PREAMBLE_SHORT) -+ *(u16*)ie |= cpu_to_le16(cap_ShortPremble); -+ -+ if (pdev_network->Privacy) -+ *(u16*)ie |= cpu_to_le16(cap_Privacy); -+ ++ //beacon interval : 2bytes ++ *(__le16*)ie = cpu_to_le16((u16)pdev_network->Configuration.BeaconPeriod);//BCN_INTERVAL; + sz += 2; + ie += 2; -+ ++ ++ //capability info ++ *(__le16*)ie = 0; ++ ++ *(__le16*)ie |= cpu_to_le16(cap_IBSS); ++ ++ if(pregistrypriv->preamble == PREAMBLE_SHORT) ++ *(__le16*)ie |= cpu_to_le16(cap_ShortPremble); ++ ++ if (pdev_network->Privacy) ++ *(__le16*)ie |= cpu_to_le16(cap_Privacy); ++ ++ sz += 2; ++ ie += 2; ++ + //SSID + ie = rtw_set_ie(ie, _SSID_IE_, pdev_network->Ssid.SsidLength, pdev_network->Ssid.Ssid, &sz); -+ ++ + //supported rates + if(pregistrypriv->wireless_mode == WIRELESS_11ABGN) + { @@ -21364,9 +10791,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + { + wireless_mode = pregistrypriv->wireless_mode; + } -+ ++ + rtw_set_supported_rate(pdev_network->SupportedRates, wireless_mode) ; -+ ++ + rateLen = rtw_get_rateset_len(pdev_network->SupportedRates); + + if (rateLen > 8) @@ -21384,18 +10811,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + + + //IBSS Parameter Set -+ ++ + ie = rtw_set_ie(ie, _IBSS_PARA_IE_, 2, (u8 *)&(pdev_network->Configuration.ATIMWindow), &sz); + + if (rateLen > 8) -+ { ++ { + ie = rtw_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rateLen - 8), (pdev_network->SupportedRates + 8), &sz); + } -+ ++ +#ifdef CONFIG_80211N_HT + //HT Cap. -+ if(((pregistrypriv->wireless_mode&WIRELESS_11_5N)||(pregistrypriv->wireless_mode&WIRELESS_11_24N)) -+ && (pregistrypriv->ht_enable==_TRUE)) ++ if(((pregistrypriv->wireless_mode&WIRELESS_11_5N)||(pregistrypriv->wireless_mode&WIRELESS_11_24N)) ++ && (pregistrypriv->ht_enable==true)) + { + //todo: + } @@ -21403,7 +10830,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + + //pdev_network->IELength = sz; //update IELength + -+_func_exit_; ++ + + //return _SUCCESS; + @@ -21411,28 +10838,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + +} + -+bool rtw_regsty_adjust_chbw(struct registry_priv *regsty, u8 req_ch, u8 *req_bw, u8 *req_offset) -+{ -+ u8 regsty_allowed_bw; -+ -+ if (req_ch <= 14) -+ regsty_allowed_bw = regsty->bw_mode & 0x0F; -+ else -+ regsty_allowed_bw = regsty->bw_mode >> 4; -+ -+ if (regsty_allowed_bw == 2 && *req_bw > CHANNEL_WIDTH_80) -+ *req_bw = CHANNEL_WIDTH_80; -+ else if (regsty_allowed_bw == 1 && *req_bw > CHANNEL_WIDTH_40) -+ *req_bw = CHANNEL_WIDTH_40; -+ else if (regsty_allowed_bw == 0 && *req_bw > CHANNEL_WIDTH_20) { -+ *req_bw = CHANNEL_WIDTH_20; -+ *req_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } else -+ return _FALSE; -+ -+ return _TRUE; -+} -+ +unsigned char *rtw_get_wpa_ie(unsigned char *pie, int *wpa_ie_len, int limit) +{ + int len; @@ -21441,14 +10846,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + u8 *pbuf = pie; + int limit_new = limit; + -+ while(1) ++ while(1) + { + pbuf = rtw_get_ie(pbuf, _WPA_IE_ID_, &len, limit_new); + + if (pbuf) { + + //check if oui matches... -+ if (_rtw_memcmp((pbuf + 2), wpa_oui_type, sizeof (wpa_oui_type)) == _FALSE) { ++ if (_rtw_memcmp((pbuf + 2), wpa_oui_type, sizeof (wpa_oui_type)) == false) { + + goto check_next_ie; + } @@ -21456,7 +10861,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + //check version... + _rtw_memcpy((u8 *)&val16, (pbuf + 6), sizeof(val16)); + -+ val16 = le16_to_cpu(val16); ++ le16_to_cpup((__le16 *)&val16); + if (val16 != 0x0001) + goto check_next_ie; + @@ -21489,7 +10894,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 +} + +unsigned char *rtw_get_wpa2_ie(unsigned char *pie, int *rsn_ie_len, int limit) -+{ ++{ + + return rtw_get_ie(pie, _WPA2_IE_ID_,rsn_ie_len, limit); + @@ -21497,15 +10902,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + +int rtw_get_wpa_cipher_suite(u8 *s) +{ -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_NONE, WPA_SELECTOR_LEN) == _TRUE) ++ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_NONE, WPA_SELECTOR_LEN) == true) + return WPA_CIPHER_NONE; -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_WEP40, WPA_SELECTOR_LEN) == _TRUE) ++ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_WEP40, WPA_SELECTOR_LEN) == true) + return WPA_CIPHER_WEP40; -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_TKIP, WPA_SELECTOR_LEN) == _TRUE) ++ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_TKIP, WPA_SELECTOR_LEN) == true) + return WPA_CIPHER_TKIP; -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_CCMP, WPA_SELECTOR_LEN) == _TRUE) ++ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_CCMP, WPA_SELECTOR_LEN) == true) + return WPA_CIPHER_CCMP; -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_WEP104, WPA_SELECTOR_LEN) == _TRUE) ++ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_WEP104, WPA_SELECTOR_LEN) == true) + return WPA_CIPHER_WEP104; + + return 0; @@ -21513,15 +10918,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + +int rtw_get_wpa2_cipher_suite(u8 *s) +{ -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_NONE, RSN_SELECTOR_LEN) == _TRUE) ++ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_NONE, RSN_SELECTOR_LEN) == true) + return WPA_CIPHER_NONE; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_WEP40, RSN_SELECTOR_LEN) == _TRUE) ++ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_WEP40, RSN_SELECTOR_LEN) == true) + return WPA_CIPHER_WEP40; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_TKIP, RSN_SELECTOR_LEN) == _TRUE) ++ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_TKIP, RSN_SELECTOR_LEN) == true) + return WPA_CIPHER_TKIP; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_CCMP, RSN_SELECTOR_LEN) == _TRUE) ++ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_CCMP, RSN_SELECTOR_LEN) == true) + return WPA_CIPHER_CCMP; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_WEP104, RSN_SELECTOR_LEN) == _TRUE) ++ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_WEP104, RSN_SELECTOR_LEN) == true) + return WPA_CIPHER_WEP104; + + return 0; @@ -21540,59 +10945,59 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + return _FAIL; + } + -+ ++ + if ((*wpa_ie != _WPA_IE_ID_) || (*(wpa_ie+1) != (u8)(wpa_ie_len - 2)) || -+ (_rtw_memcmp(wpa_ie+2, RTW_WPA_OUI_TYPE, WPA_SELECTOR_LEN) != _TRUE) ) -+ { ++ (_rtw_memcmp(wpa_ie+2, RTW_WPA_OUI_TYPE, WPA_SELECTOR_LEN) != true) ) ++ { + return _FAIL; + } + + pos = wpa_ie; + + pos += 8; -+ left = wpa_ie_len - 8; ++ left = wpa_ie_len - 8; + + + //group_cipher + if (left >= WPA_SELECTOR_LEN) { + + *group_cipher = rtw_get_wpa_cipher_suite(pos); -+ ++ + pos += WPA_SELECTOR_LEN; + left -= WPA_SELECTOR_LEN; -+ -+ } ++ ++ } + else if (left > 0) + { + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s: ie length mismatch, %u too much", __FUNCTION__, left)); -+ ++ + return _FAIL; + } + + + //pairwise_cipher + if (left >= 2) -+ { -+ //count = le16_to_cpu(*(u16*)pos); ++ { ++ //count = le16_to_cpu(*(u16*)pos); + count = RTW_GET_LE16(pos); + pos += 2; + left -= 2; -+ ++ + if (count == 0 || left < count * WPA_SELECTOR_LEN) { + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s: ie count botch (pairwise), " -+ "count %u left %u", __FUNCTION__, count, left)); ++ "count %u left %u", __FUNCTION__, count, left)); + return _FAIL; + } -+ ++ + for (i = 0; i < count; i++) + { + *pairwise_cipher |= rtw_get_wpa_cipher_suite(pos); -+ ++ + pos += WPA_SELECTOR_LEN; + left -= WPA_SELECTOR_LEN; + } -+ -+ } ++ ++ } + else if (left == 1) + { + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s: ie too short (for key mgmt)", __FUNCTION__)); @@ -21608,9 +11013,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + } + } + } -+ ++ + return ret; -+ ++ +} + +int rtw_parse_wpa2_ie(u8* rsn_ie, int rsn_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x) @@ -21627,22 +11032,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + + + if ((*rsn_ie!= _WPA2_IE_ID_) || (*(rsn_ie+1) != (u8)(rsn_ie_len - 2))) -+ { ++ { + return _FAIL; + } -+ ++ + pos = rsn_ie; + pos += 4; -+ left = rsn_ie_len - 4; ++ left = rsn_ie_len - 4; + + //group_cipher + if (left >= RSN_SELECTOR_LEN) { + + *group_cipher = rtw_get_wpa2_cipher_suite(pos); -+ ++ + pos += RSN_SELECTOR_LEN; + left -= RSN_SELECTOR_LEN; -+ ++ + } else if (left > 0) { + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s: ie length mismatch, %u too much", __FUNCTION__, left)); + return _FAIL; @@ -21650,7 +11055,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + + //pairwise_cipher + if (left >= 2) -+ { ++ { + //count = le16_to_cpu(*(u16*)pos); + count = RTW_GET_LE16(pos); + pos += 2; @@ -21658,23 +11063,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + + if (count == 0 || left < count * RSN_SELECTOR_LEN) { + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s: ie count botch (pairwise), " -+ "count %u left %u", __FUNCTION__, count, left)); ++ "count %u left %u", __FUNCTION__, count, left)); + return _FAIL; + } -+ ++ + for (i = 0; i < count; i++) -+ { ++ { + *pairwise_cipher |= rtw_get_wpa2_cipher_suite(pos); -+ ++ + pos += RSN_SELECTOR_LEN; + left -= RSN_SELECTOR_LEN; + } + -+ } ++ } + else if (left == 1) + { + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s: ie too short (for key mgmt)", __FUNCTION__)); -+ ++ + return _FAIL; + } + @@ -21689,35 +11094,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + } + + return ret; -+ ++ +} + -+//#ifdef CONFIG_WAPI_SUPPORT ++#ifdef CONFIG_WAPI_SUPPORT +int rtw_get_wapi_ie(u8 *in_ie,uint in_len,u8 *wapi_ie,u16 *wapi_len) +{ -+ int len = 0; + u8 authmode, i; -+ uint cnt; ++ uint cnt; + u8 wapi_oui1[4]={0x0,0x14,0x72,0x01}; + u8 wapi_oui2[4]={0x0,0x14,0x72,0x02}; + -+_func_enter_; -+ -+ if(wapi_len) -+ *wapi_len = 0; -+ -+ if(!in_ie || in_len<=0) -+ return len; + + cnt = (_TIMESTAMP_ + _BEACON_ITERVAL_ + _CAPABILITY_); -+ + while(cnt found WPS_IE.....\n"); -+ *wps_ielen = ie_ptr[1]+2; -+ match=_TRUE; -+ } -+ return match; -+} -+ -+u8 *rtw_get_wps_ie_from_scan_queue(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen, u8 frame_type) +{ -+ u8* wps = NULL; ++ u8 match = false; ++ u8 eid, wps_oui[4]={0x0,0x50,0xf2,0x04}; + -+ DBG_871X( "[%s] frame_type = %d\n", __FUNCTION__, frame_type ); -+ switch( frame_type ) ++ if(ie_ptr == NULL) return match; ++ ++ eid = ie_ptr[0]; ++ ++ if((eid==_WPA_IE_ID_)&&(_rtw_memcmp(&ie_ptr[2], wps_oui, 4)==true)) + { -+ case 1: -+ case 3: -+ { // Beacon or Probe Response -+ wps = rtw_get_wps_ie(in_ie + _PROBERSP_IE_OFFSET_, in_len - _PROBERSP_IE_OFFSET_, wps_ie, wps_ielen); -+ break; -+ } -+ case 2: -+ { // Probe Request -+ wps = rtw_get_wps_ie(in_ie + _PROBEREQ_IE_OFFSET_ , in_len - _PROBEREQ_IE_OFFSET_ , wps_ie, wps_ielen); -+ break; -+ } ++ //DBG_8192C("==> found WPS_IE.....\n"); ++ *wps_ielen = ie_ptr[1]+2; ++ match=true; + } -+ return wps; ++ return match; +} + +/** @@ -21870,42 +11239,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 +u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen) +{ + uint cnt; -+ u8 *wpsie_ptr = NULL; -+ u8 eid, wps_oui[4] = {0x00, 0x50, 0xf2, 0x04}; ++ u8 *wpsie_ptr=NULL; ++ u8 eid, wps_oui[4]={0x0,0x50,0xf2,0x04}; + -+ if (wps_ielen) ++ if(wps_ielen) + *wps_ielen = 0; + -+ if (!in_ie) { -+ rtw_warn_on(1); -+ return wpsie_ptr; -+ } -+ -+ if (in_len <= 0) ++ if(!in_ie || in_len<=0) + return wpsie_ptr; + + cnt = 0; + -+ while (cnt + 1 + 4 < in_len) { ++ while(cnt= MAX_IE_SZ) { -+ rtw_warn_on(1); -+ return NULL; -+ } ++ if((eid==_WPA_IE_ID_)&&(_rtw_memcmp(&in_ie[cnt+2], wps_oui, 4)==true)) ++ { ++ wpsie_ptr = &in_ie[cnt]; + -+ if (eid == WLAN_EID_VENDOR_SPECIFIC && _rtw_memcmp(&in_ie[cnt + 2], wps_oui, 4) == _TRUE) { -+ wpsie_ptr = in_ie + cnt; ++ if(wps_ie) ++ _rtw_memcpy(wps_ie, &in_ie[cnt], in_ie[cnt+1]+2); + -+ if (wps_ie) -+ _rtw_memcpy(wps_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); ++ if(wps_ielen) ++ *wps_ielen = in_ie[cnt+1]+2; + -+ if (wps_ielen) -+ *wps_ielen = in_ie[cnt + 1] + 2; ++ cnt+=in_ie[cnt+1]+2; + + break; -+ } else { -+ cnt += in_ie[cnt + 1] + 2; ++ } ++ else ++ { ++ cnt+=in_ie[cnt+1]+2; //goto next + } + + } @@ -21933,40 +11298,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + *len_attr = 0; + + if ( ( wps_ie[0] != _VENDOR_SPECIFIC_IE_ ) || -+ ( _rtw_memcmp( wps_ie + 2, wps_oui , 4 ) != _TRUE ) ) ++ ( _rtw_memcmp( wps_ie + 2, wps_oui , 4 ) != true ) ) + { + return attr_ptr; + } + + // 6 = 1(Element ID) + 1(Length) + 4(WPS OUI) + attr_ptr = wps_ie + 6; //goto first attr -+ ++ + while(attr_ptr - wps_ie < wps_ielen) + { + // 4 = 2(Attribute ID) + 2(Length) + u16 attr_id = RTW_GET_BE16(attr_ptr); + u16 attr_data_len = RTW_GET_BE16(attr_ptr + 2); + u16 attr_len = attr_data_len + 4; -+ ++ + //DBG_871X("%s attr_ptr:%p, id:%u, length:%u\n", __FUNCTION__, attr_ptr, attr_id, attr_data_len); + if( attr_id == target_attr_id ) + { + target_attr_ptr = attr_ptr; -+ ++ + if(buf_attr) + _rtw_memcpy(buf_attr, attr_ptr, attr_len); -+ ++ + if(len_attr) + *len_attr = attr_len; -+ ++ + break; + } + else + { + attr_ptr += attr_len; //goto next -+ } -+ -+ } ++ } ++ ++ } + + return target_attr_ptr; +} @@ -21988,7 +11353,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + + if(len_content) + *len_content = 0; -+ ++ + attr_ptr = rtw_get_wps_attr(wps_ie, wps_ielen, target_attr_id, NULL, &attr_len); + + if(attr_ptr && attr_len) @@ -22054,7 +11419,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + elems->wme_tspec_len = elen; + break; + default: -+ DBG_871X_LEVEL(_drv_warning_, "unknown WME " ++ DBG_871X("unknown WME " + "information element ignored " + "(subtype=%d len=%lu)\n", + pos[4], (unsigned long) elen); @@ -22067,7 +11432,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + elems->wps_ie_len = elen; + break; + default: -+ DBG_871X_LEVEL(_drv_warning_, "Unknown Microsoft " ++ DBG_871X("Unknown Microsoft " + "information element ignored " + "(type=%d len=%lu)\n", + pos[3], (unsigned long) elen); @@ -22082,7 +11447,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + elems->vendor_ht_cap_len = elen; + break; + default: -+ DBG_871X_LEVEL(_drv_warning_, "Unknown Broadcom " ++ DBG_871X("Unknown Broadcom " + "information element ignored " + "(type=%d len=%lu)\n", + pos[3], (unsigned long) elen); @@ -22091,7 +11456,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + break; + + default: -+ DBG_871X_LEVEL(_drv_warning_, "unknown vendor specific information " ++ DBG_871X("unknown vendor specific information " + "element ignored (vendor OUI %02x:%02x:%02x " + "len=%lu)\n", + pos[0], pos[1], pos[2], (unsigned long) elen); @@ -22099,7 +11464,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + } + + return 0; -+ ++ +} + +/** @@ -22132,7 +11497,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + DBG_871X("IEEE 802.11 element " + "parse failed (id=%d elen=%d " + "left=%lu)\n", -+ id, elen, (unsigned long) left); ++ id, elen, (unsigned long) left); + } + return ParseFailed; + } @@ -22232,10 +11597,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + unknown++; + if (!show_errors) + break; -+ DBG_871X_LEVEL(_drv_warning_, -+ "IEEE 802.11 element parse " -+ "ignored unknown element (id=%d elen=%d)\n", -+ id, elen); ++ DBG_871X("IEEE 802.11 element parse " ++ "ignored unknown element (id=%d elen=%d)\n", ++ id, elen); + break; + } + @@ -22247,7 +11611,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + return ParseFailed; + + return unknown ? ParseUnknown : ParseOK; -+ ++ +} + +static u8 key_char2num(u8 ch); @@ -22275,221 +11639,70 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + return ((key_char2num(hch) << 4) | key_char2num(lch)); +} + -+void macstr2num(u8 *dst, u8 *src); -+void macstr2num(u8 *dst, u8 *src) -+{ -+ int jj, kk; -+ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) -+ { -+ dst[jj] = key_2char2num(src[kk], src[kk + 1]); -+ } -+} -+ -+u8 convert_ip_addr(u8 hch, u8 mch, u8 lch) ++static u8 convert_ip_addr(u8 hch, u8 mch, u8 lch) +{ + return ((key_char2num(hch) * 100) + (key_char2num(mch) * 10 ) + key_char2num(lch)); +} + -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+#define MAC_ADDRESS_LEN 12 -+ -+int rtw_get_mac_addr_intel(unsigned char *buf) -+{ -+ int ret = 0; -+ int i; -+ struct file *fp = NULL; -+ mm_segment_t oldfs; -+ unsigned char c_mac[MAC_ADDRESS_LEN]; -+ char fname[]="/config/wifi/mac.txt"; -+ int jj,kk; -+ -+ DBG_871X("%s Enter\n", __FUNCTION__); -+ -+ ret = rtw_retrieve_from_file(fname, c_mac, MAC_ADDRESS_LEN); -+ if(ret < MAC_ADDRESS_LEN) -+ { -+ return -1; -+ } -+ -+ for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 2 ) -+ { -+ buf[jj] = key_2char2num(c_mac[kk], c_mac[kk+ 1]); -+ } -+ -+ DBG_871X("%s: read from file mac address: "MAC_FMT"\n", -+ __FUNCTION__, MAC_ARG(buf)); -+ -+ return 0; -+} -+#endif //CONFIG_PLATFORM_INTEL_BYT -+ -+/* -+ * Description: -+ * rtw_check_invalid_mac_address: -+ * This is only used for checking mac address valid or not. -+ * -+ * Input: -+ * adapter: mac_address pointer. -+ * check_local_bit: check locally bit or not. -+ * -+ * Output: -+ * _TRUE: The mac address is invalid. -+ * _FALSE: The mac address is valid. -+ * -+ * Auther: Isaac.Li -+ */ -+u8 rtw_check_invalid_mac_address(u8 *mac_addr, u8 check_local_bit) -+{ -+ u8 null_mac_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; -+ u8 multi_mac_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 res = _FALSE; -+ -+ if (_rtw_memcmp(mac_addr, null_mac_addr, ETH_ALEN)) { -+ res = _TRUE; -+ goto func_exit; -+ } -+ -+ if (_rtw_memcmp(mac_addr, multi_mac_addr, ETH_ALEN)) { -+ res = _TRUE; -+ goto func_exit; -+ } -+ -+ if (mac_addr[0] & BIT0) { -+ res = _TRUE; -+ goto func_exit; -+ } -+ -+ if (check_local_bit == _TRUE) { -+ if (mac_addr[0] & BIT1) { -+ res = _TRUE; -+ goto func_exit; -+ } -+ } -+ -+func_exit: -+ return res; -+} -+ +extern char* rtw_initmac; -+/** -+ * rtw_macaddr_cfg - Decide the mac address used -+ * @out: buf to store mac address decided -+ * @hw_mac_addr: mac address from efuse/epprom -+ */ -+void rtw_macaddr_cfg(u8 *out, const u8 *hw_mac_addr) ++void rtw_macaddr_cfg(u8 *mac_addr) +{ -+#define DEFAULT_RANDOM_MACADDR 1 + u8 mac[ETH_ALEN]; ++ if(mac_addr == NULL) return; + -+ if (out == NULL) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ /* Users specify the mac address */ -+ if (rtw_initmac) { ++ if ( rtw_initmac ) ++ { // Users specify the mac address + int jj,kk; + -+ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) -+ mac[jj] = key_2char2num(rtw_initmac[kk], rtw_initmac[kk + 1]); -+ -+ goto err_chk; ++ for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 ) ++ { ++ mac[jj] = key_2char2num(rtw_initmac[kk], rtw_initmac[kk+ 1]); ++ } ++ _rtw_memcpy(mac_addr, mac, ETH_ALEN); ++ } ++ else ++ { // Use the mac address stored in the Efuse ++ _rtw_memcpy(mac, mac_addr, ETH_ALEN); + } + -+ /* platform specified */ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ if (rtw_get_mac_addr_intel(mac) == 0) -+ goto err_chk; -+#endif -+ -+ /* Use the mac address stored in the Efuse */ -+ if (hw_mac_addr) { -+ _rtw_memcpy(mac, hw_mac_addr, ETH_ALEN); -+ goto err_chk; -+ } -+ -+err_chk: -+ if (rtw_check_invalid_mac_address(mac, _TRUE) == _TRUE) { -+ #if DEFAULT_RANDOM_MACADDR -+ DBG_871X_LEVEL(_drv_err_, "invalid mac addr:"MAC_FMT", assign random MAC\n", MAC_ARG(mac)); -+ *((u32 *)(&mac[2])) = rtw_random32(); -+ mac[0] = 0x00; -+ mac[1] = 0xe0; -+ mac[2] = 0x4c; -+ #else -+ DBG_871X_LEVEL(_drv_err_, "invalid mac addr:"MAC_FMT", assign default one\n", MAC_ARG(mac)); ++ if (((mac[0]==0xff) &&(mac[1]==0xff) && (mac[2]==0xff) && ++ (mac[3]==0xff) && (mac[4]==0xff) &&(mac[5]==0xff)) || ++ ((mac[0]==0x0) && (mac[1]==0x0) && (mac[2]==0x0) && ++ (mac[3]==0x0) && (mac[4]==0x0) &&(mac[5]==0x0))) ++ { + mac[0] = 0x00; + mac[1] = 0xe0; + mac[2] = 0x4c; + mac[3] = 0x87; + mac[4] = 0x00; + mac[5] = 0x00; -+ #endif ++ // use default mac addresss ++ _rtw_memcpy(mac_addr, mac, ETH_ALEN); ++ DBG_871X("MAC Address from efuse error, assign default one !!!\n"); + } + -+ _rtw_memcpy(out, mac, ETH_ALEN); -+ DBG_871X("%s mac addr:"MAC_FMT"\n", __func__, MAC_ARG(out)); ++ DBG_871X("rtw_macaddr_cfg MAC Address = "MAC_FMT"\n", MAC_ARG(mac_addr)); +} + -+#ifdef CONFIG_80211N_HT -+void dump_ht_cap_ie_content(void *sel, u8 *buf, u32 buf_len) -+{ -+ if (buf_len != 26) { -+ DBG_871X_SEL_NL(sel, "Invalid HT capability IE len:%d != %d\n", buf_len, 26); -+ return; -+ } -+ -+ DBG_871X_SEL_NL(sel, "HT Capabilities Info:%02x%02x\n", *(buf), *(buf+1)); -+ DBG_871X_SEL_NL(sel, "A-MPDU Parameters:"HT_AMPDU_PARA_FMT"\n" -+ , HT_AMPDU_PARA_ARG(HT_CAP_ELE_AMPDU_PARA(buf))); -+ DBG_871X_SEL_NL(sel, "Supported MCS Set:"HT_SUP_MCS_SET_FMT"\n" -+ , HT_SUP_MCS_SET_ARG(HT_CAP_ELE_SUP_MCS_SET(buf))); -+} -+ -+void dump_ht_cap_ie(void *sel, u8 *ie, u32 ie_len) -+{ -+ u8* pos = (u8*)ie; -+ u16 id; -+ u16 len; -+ -+ u8 *ht_cap_ie; -+ sint ht_cap_ielen; -+ -+ ht_cap_ie = rtw_get_ie(ie, _HT_CAPABILITY_IE_, &ht_cap_ielen, ie_len); -+ if(!ie || ht_cap_ie != ie) -+ return; -+ -+ dump_ht_cap_ie_content(sel, ht_cap_ie+2, ht_cap_ielen); -+} -+#endif /* CONFIG_80211N_HT */ -+ -+void dump_ies(void *sel, u8 *buf, u32 buf_len) -+{ ++void dump_ies(u8 *buf, u32 buf_len) { + u8* pos = (u8*)buf; + u8 id, len; + -+ while(pos-buf+1 0) -+ *ch = *(p + 2); -+ -+#ifdef CONFIG_80211N_HT -+{ -+ u8 *ht_cap_ie, *ht_op_ie; -+ int ht_cap_ielen, ht_op_ielen; -+ -+ ht_cap_ie = rtw_get_ie(ies, EID_HTCapability, &ht_cap_ielen, ies_len); -+ if (ht_cap_ie && ht_cap_ielen) { -+ if (GET_HT_CAP_ELE_CHL_WIDTH(ht_cap_ie + 2)) -+ *bw = CHANNEL_WIDTH_40; -+ } -+ -+ ht_op_ie = rtw_get_ie(ies, EID_HTInfo, &ht_op_ielen, ies_len); -+ if (ht_op_ie && ht_op_ielen) { -+ if (*ch == 0) { -+ *ch = GET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2); -+ } else if (*ch != 0 && *ch != GET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2)) { -+ DBG_871X("%s ch inconsistent, DSSS:%u, HT primary:%u\n" -+ , __func__, *ch, GET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2)); -+ } -+ -+ if (!GET_HT_OP_ELE_STA_CHL_WIDTH(ht_op_ie + 2)) -+ *bw = CHANNEL_WIDTH_20; -+ -+ if (*bw == CHANNEL_WIDTH_40) { -+ switch (GET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2)) { -+ case SCA: -+ *offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ case SCB: -+ *offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ } -+ } -+ } -+} -+#endif /* CONFIG_80211N_HT */ -+#ifdef CONFIG_80211AC_VHT -+{ -+ u8 *vht_op_ie; -+ int vht_op_ielen; -+ -+ vht_op_ie = rtw_get_ie(ies, EID_VHTOperation, &vht_op_ielen, ies_len); -+ if (vht_op_ie && vht_op_ielen) { -+ if (GET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2) >= 1) -+ *bw = CHANNEL_WIDTH_80; -+ } -+} -+#endif -+} -+ -+void rtw_bss_get_chbw(WLAN_BSSID_EX *bss, u8 *ch, u8 *bw, u8 *offset) -+{ -+ rtw_ies_get_chbw(bss->IEs + sizeof(NDIS_802_11_FIXED_IEs) -+ , bss->IELength - sizeof(NDIS_802_11_FIXED_IEs) -+ , ch, bw, offset); -+ -+ if (*ch == 0) { -+ *ch = bss->Configuration.DSConfig; -+ } else if (*ch != bss->Configuration.DSConfig) { -+ DBG_871X("inconsistent ch - ies:%u bss->Configuration.DSConfig:%u\n" -+ , *ch, bss->Configuration.DSConfig); -+ *ch = bss->Configuration.DSConfig; -+ rtw_warn_on(1); -+ } -+} -+ -+/** -+ * rtw_is_chbw_grouped - test if the two ch settings can be grouped together -+ * @ch_a: ch of set a -+ * @bw_a: bw of set a -+ * @offset_a: offset of set a -+ * @ch_b: ch of set b -+ * @bw_b: bw of set b -+ * @offset_b: offset of set b -+ */ -+bool rtw_is_chbw_grouped(u8 ch_a, u8 bw_a, u8 offset_a -+ , u8 ch_b, u8 bw_b, u8 offset_b) -+{ -+ bool is_grouped = _FALSE; -+ -+ if (ch_a != ch_b) { -+ /* ch is different */ -+ goto exit; -+ } else if ((bw_a == CHANNEL_WIDTH_40 || bw_a == CHANNEL_WIDTH_80) -+ && (bw_b == CHANNEL_WIDTH_40 || bw_b == CHANNEL_WIDTH_80) -+ ) { -+ if (offset_a != offset_b) -+ goto exit; -+ } -+ -+ is_grouped = _TRUE; -+ -+exit: -+ return is_grouped; -+} -+ -+/** -+ * rtw_sync_chbw - obey g_ch, adjust g_bw, g_offset, bw, offset -+ * @req_ch: pointer of the request ch, may be modified further -+ * @req_bw: pointer of the request bw, may be modified further -+ * @req_offset: pointer of the request offset, may be modified further -+ * @g_ch: pointer of the ongoing group ch -+ * @g_bw: pointer of the ongoing group bw, may be modified further -+ * @g_offset: pointer of the ongoing group offset, may be modified further -+ */ -+void rtw_sync_chbw(u8 *req_ch, u8 *req_bw, u8 *req_offset -+ , u8 *g_ch, u8 *g_bw, u8 *g_offset) -+{ -+ -+ *req_ch = *g_ch; -+ -+ if (*req_bw == CHANNEL_WIDTH_80 && *g_ch <= 14) { -+ /*2.4G ch, downgrade to 40Mhz */ -+ *req_bw = CHANNEL_WIDTH_40; -+ } -+ -+ switch (*req_bw) { -+ case CHANNEL_WIDTH_80: -+ if (*g_bw == CHANNEL_WIDTH_40 || *g_bw == CHANNEL_WIDTH_80) -+ *req_offset = *g_offset; -+ else if (*g_bw == CHANNEL_WIDTH_20) -+ *req_offset = rtw_get_offset_by_ch(*req_ch); -+ -+ if (*req_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) { -+ DBG_871X_LEVEL(_drv_err_, "%s req 80MHz BW without offset, down to 20MHz\n", __func__); -+ rtw_warn_on(1); -+ *req_bw = CHANNEL_WIDTH_20; -+ } -+ break; -+ case CHANNEL_WIDTH_40: -+ if (*g_bw == CHANNEL_WIDTH_40 || *g_bw == CHANNEL_WIDTH_80) -+ *req_offset = *g_offset; -+ else if (*g_bw == CHANNEL_WIDTH_20) -+ *req_offset = rtw_get_offset_by_ch(*req_ch); -+ -+ if (*req_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) { -+ DBG_871X_LEVEL(_drv_err_, "%s req 40MHz BW without offset, down to 20MHz\n", __func__); -+ rtw_warn_on(1); -+ *req_bw = CHANNEL_WIDTH_20; -+ } -+ break; -+ case CHANNEL_WIDTH_20: -+ *req_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ default: -+ DBG_871X_LEVEL(_drv_err_, "%s req unsupported BW:%u\n", __func__, *req_bw); -+ rtw_warn_on(1); -+ } -+ -+ if (*req_bw > *g_bw) { -+ *g_bw = *req_bw; -+ *g_offset = *req_offset; -+ } -+} -+ +#ifdef CONFIG_P2P -+/** -+ * rtw_get_p2p_merged_len - Get merged ie length from muitiple p2p ies. -+ * @in_ie: Pointer of the first p2p ie -+ * @in_len: Total len of muiltiple p2p ies -+ * Returns: Length of merged p2p ie length -+ */ -+u32 rtw_get_p2p_merged_ies_len(u8 *in_ie, u32 in_len) -+{ -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 OUI[4] = { 0x50, 0x6f, 0x9a, 0x09 }; -+ int i=0; -+ int j=0, len=0; -+ -+ while( i < in_len) -+ { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(in_ie+ i); -+ -+ if( pIE->ElementID == _VENDOR_SPECIFIC_IE_ && _rtw_memcmp(pIE->data, OUI, 4) ) -+ { -+ len += pIE->Length-4; // 4 is P2P OUI length, don't count it in this loop -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ return len + 4; // Append P2P OUI length at last. -+} -+ -+/** -+ * rtw_p2p_merge_ies - Merge muitiple p2p ies into one -+ * @in_ie: Pointer of the first p2p ie -+ * @in_len: Total len of muiltiple p2p ies -+ * @merge_ie: Pointer of merged ie -+ * Returns: Length of merged p2p ie -+ */ -+int rtw_p2p_merge_ies(u8 *in_ie, u32 in_len, u8 *merge_ie) -+{ -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 len = 0; -+ u8 OUI[4] = { 0x50, 0x6f, 0x9a, 0x09 }; -+ u8 ELOUI[6] = { 0xDD, 0x00, 0x50, 0x6f, 0x9a, 0x09 }; //EID;Len;OUI, Len would copy at the end of function -+ int i=0; -+ -+ if( merge_ie != NULL) -+ { -+ //Set first P2P OUI -+ _rtw_memcpy(merge_ie, ELOUI, 6); -+ merge_ie += 6; -+ -+ while( i < in_len) -+ { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(in_ie+ i); -+ -+ // Take out the rest of P2P OUIs -+ if( pIE->ElementID == _VENDOR_SPECIFIC_IE_ && _rtw_memcmp(pIE->data, OUI, 4) ) -+ { -+ _rtw_memcpy( merge_ie, pIE->data +4, pIE->Length -4); -+ len += pIE->Length-4; -+ merge_ie += pIE->Length-4; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ return len + 4; // 4 is for P2P OUI -+ -+ } -+ -+ return 0; -+} -+ -+void dump_p2p_ie(void *sel, u8 *ie, u32 ie_len) { ++void dump_p2p_ie(u8 *ie, u32 ie_len) { + u8* pos = (u8*)ie; + u8 id; + u16 len; + + u8 *p2p_ie; + uint p2p_ielen; -+ ++ + p2p_ie = rtw_get_p2p_ie(ie, ie_len, NULL, &p2p_ielen); + if(p2p_ie != ie || p2p_ielen == 0) + return; @@ -22777,32 +11743,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + id = *pos; + len = RTW_GET_LE16(pos+1); + -+ DBG_871X_SEL_NL(sel, "%s ID:%u, LEN:%u\n", __FUNCTION__, id, len); ++ DBG_871X("%s ID:%u, LEN:%u\n", __FUNCTION__, id, len); + + pos+=(3+len); -+ } -+} -+ -+u8 *rtw_get_p2p_ie_from_scan_queue(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen, u8 frame_type) -+{ -+ u8* p2p = NULL; -+ -+ DBG_871X( "[%s] frame_type = %d\n", __FUNCTION__, frame_type ); -+ switch( frame_type ) -+ { -+ case 1: -+ case 3: -+ { // Beacon or Probe Response -+ p2p = rtw_get_p2p_ie(in_ie + _PROBERSP_IE_OFFSET_, in_len - _PROBERSP_IE_OFFSET_, p2p_ie, p2p_ielen); -+ break; -+ } -+ case 2: -+ { // Probe Request -+ p2p = rtw_get_p2p_ie(in_ie + _PROBEREQ_IE_OFFSET_ , in_len - _PROBEREQ_IE_OFFSET_ , p2p_ie, p2p_ielen); -+ break; -+ } + } -+ return p2p; +} + +/** @@ -22816,48 +11760,47 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + */ +u8 *rtw_get_p2p_ie(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen) +{ -+ uint cnt; -+ u8 *p2p_ie_ptr = NULL; -+ u8 eid, p2p_oui[4] = {0x50, 0x6F, 0x9A, 0x09}; ++ uint cnt = 0; ++ u8 *p2p_ie_ptr; ++ u8 eid, p2p_oui[4]={0x50,0x6F,0x9A,0x09}; + -+ if (p2p_ielen) ++ if ( p2p_ielen != NULL ) + *p2p_ielen = 0; + -+ if (!in_ie || in_len < 0) { -+ rtw_warn_on(1); -+ return p2p_ie_ptr; -+ } -+ -+ if (in_len <= 0) -+ return p2p_ie_ptr; -+ -+ cnt = 0; -+ -+ while (cnt + 1 + 4 < in_len) { ++ while(cnt= MAX_IE_SZ) { -+ rtw_warn_on(1); ++ if ((in_len < 0) || (cnt > MAX_IE_SZ)) { ++ rtw_dump_stack(); + return NULL; + } -+ -+ if (eid == WLAN_EID_VENDOR_SPECIFIC && _rtw_memcmp(&in_ie[cnt + 2], p2p_oui, 4) == _TRUE) { ++ if( ( eid == _VENDOR_SPECIFIC_IE_ ) && ( _rtw_memcmp( &in_ie[cnt+2], p2p_oui, 4) == true ) ) ++ { + p2p_ie_ptr = in_ie + cnt; + -+ if (p2p_ie) -+ _rtw_memcpy(p2p_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); ++ if ( p2p_ie != NULL ) ++ { ++ _rtw_memcpy( p2p_ie, &in_ie[ cnt ], in_ie[ cnt + 1 ] + 2 ); ++ } + -+ if (p2p_ielen) -+ *p2p_ielen = in_ie[cnt + 1] + 2; ++ if ( p2p_ielen != NULL ) ++ { ++ *p2p_ielen = in_ie[ cnt + 1 ] + 2; ++ } ++ ++ return p2p_ie_ptr; + + break; -+ } else { -+ cnt += in_ie[cnt + 1] + 2; ++ } ++ else ++ { ++ cnt += in_ie[ cnt + 1 ] +2; //goto next + } + + } + -+ return p2p_ie_ptr; ++ return NULL; ++ +} + +/** @@ -22880,40 +11823,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + *len_attr = 0; + + if ( !p2p_ie || ( p2p_ie[0] != _VENDOR_SPECIFIC_IE_ ) || -+ ( _rtw_memcmp( p2p_ie + 2, p2p_oui , 4 ) != _TRUE ) ) ++ ( _rtw_memcmp( p2p_ie + 2, p2p_oui , 4 ) != true ) ) + { + return attr_ptr; + } + + // 6 = 1(Element ID) + 1(Length) + 3 (OUI) + 1(OUI Type) + attr_ptr = p2p_ie + 6; //goto first attr -+ ++ + while(attr_ptr - p2p_ie < p2p_ielen) + { + // 3 = 1(Attribute ID) + 2(Length) + u8 attr_id = *attr_ptr; + u16 attr_data_len = RTW_GET_LE16(attr_ptr + 1); + u16 attr_len = attr_data_len + 3; -+ ++ + //DBG_871X("%s attr_ptr:%p, id:%u, length:%u\n", __FUNCTION__, attr_ptr, attr_id, attr_data_len); + if( attr_id == target_attr_id ) + { + target_attr_ptr = attr_ptr; -+ ++ + if(buf_attr) + _rtw_memcpy(buf_attr, attr_ptr, attr_len); -+ ++ + if(len_attr) + *len_attr = attr_len; -+ ++ + break; + } + else + { + attr_ptr += attr_len; //goto next -+ } -+ -+ } ++ } ++ ++ } + + return target_attr_ptr; +} @@ -22935,7 +11878,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + + if(len_content) + *len_content = 0; -+ ++ + attr_ptr = rtw_get_p2p_attr(p2p_ie, p2p_ielen, target_attr_id, NULL, &attr_len); + + if(attr_ptr && attr_len) @@ -22953,19 +11896,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 +} + +u32 rtw_set_p2p_attr_content(u8 *pbuf, u8 attr_id, u16 attr_len, u8 *pdata_attr) -+{ ++{ + u32 a_len; + + *pbuf = attr_id; -+ ++ + //*(u16*)(pbuf + 1) = cpu_to_le16(attr_len); + RTW_PUT_LE16(pbuf + 1, attr_len); + + if(pdata_attr) -+ _rtw_memcpy(pbuf + 3, pdata_attr, attr_len); -+ ++ _rtw_memcpy(pbuf + 3, pdata_attr, attr_len); ++ + a_len = attr_len + 3; -+ ++ + return a_len; +} + @@ -22982,7 +11925,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + { + u8 *next_attr = target_attr+target_attr_len; + uint remain_len = ielen-(next_attr-ie); -+ //dump_ies(RTW_DBGDUMP, ie, ielen); ++ //dump_ies(ie, ielen); + #if 0 + DBG_871X("[%d] ie:%p, ielen:%u\n" + "target_attr:%p, target_attr_len:%u\n" @@ -23003,7 +11946,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + else + { + //if(index>0) -+ // dump_ies(RTW_DBGDUMP, ie, ielen); ++ // dump_ies(ie, ielen); + break; + } + } @@ -23016,18 +11959,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + u8 *p2p_ie; + uint p2p_ielen, p2p_ielen_ori; + int cnt; -+ -+ if( (p2p_ie=rtw_get_p2p_ie(bss_ex->IEs+_FIXED_IE_LENGTH_, bss_ex->IELength-_FIXED_IE_LENGTH_, NULL, &p2p_ielen_ori)) ) ++ ++ if( (p2p_ie=rtw_get_p2p_ie(bss_ex->IEs+_FIXED_IE_LENGTH_, bss_ex->IELength-_FIXED_IE_LENGTH_, NULL, &p2p_ielen_ori)) ) + { -+ if (0) -+ if(rtw_get_p2p_attr(p2p_ie, p2p_ielen_ori, attr_id, NULL, NULL)) { -+ DBG_871X("rtw_get_p2p_attr: GOT P2P_ATTR:%u!!!!!!!!\n", attr_id); -+ dump_ies(RTW_DBGDUMP, bss_ex->IEs+_FIXED_IE_LENGTH_, bss_ex->IELength-_FIXED_IE_LENGTH_); -+ } ++ #if 0 ++ if(rtw_get_p2p_attr(p2p_ie, p2p_ielen_ori, attr_id, NULL, NULL)) { ++ DBG_871X("rtw_get_p2p_attr: GOT P2P_ATTR:%u!!!!!!!!\n", attr_id); ++ dump_ies(bss_ex->IEs+_FIXED_IE_LENGTH_, bss_ex->IELength-_FIXED_IE_LENGTH_); ++ } ++ #endif + + p2p_ielen=rtw_p2p_attr_remove(p2p_ie, p2p_ielen_ori, attr_id); + if(p2p_ielen != p2p_ielen_ori) { -+ ++ + u8 *next_ie_ori = p2p_ie+p2p_ielen_ori; + u8 *next_ie = p2p_ie+p2p_ielen; + uint remain_len = bss_ex->IELength-(next_ie_ori-bss_ex->IEs); @@ -23036,10 +11980,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + _rtw_memset(next_ie+remain_len, 0, p2p_ielen_ori-p2p_ielen); + bss_ex->IELength -= p2p_ielen_ori-p2p_ielen; + -+ if (0) { -+ DBG_871X("remove P2P_ATTR:%u!\n", attr_id); -+ dump_ies(RTW_DBGDUMP, bss_ex->IEs+_FIXED_IE_LENGTH_, bss_ex->IELength-_FIXED_IE_LENGTH_); -+ } ++ #if 0 ++ DBG_871X("remove P2P_ATTR:%u!\n", attr_id); ++ dump_ies(bss_ex->IEs+_FIXED_IE_LENGTH_, bss_ex->IELength-_FIXED_IE_LENGTH_); ++ #endif + } + } +} @@ -23047,37 +11991,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 +#endif //CONFIG_P2P + +#ifdef CONFIG_WFD -+void dump_wfd_ie(void *sel, u8 *ie, u32 ie_len) -+{ -+ u8* pos = (u8*)ie; -+ u8 id; -+ u16 len; -+ -+ u8 *wfd_ie; -+ uint wfd_ielen; -+ -+ if(rtw_get_wfd_ie(ie, ie_len, NULL, &wfd_ielen) == _FALSE) -+ return; -+ -+ pos+=6; -+ while(pos-ie < ie_len){ -+ id = *pos; -+ len = RTW_GET_BE16(pos+1); -+ -+ DBG_871X_SEL_NL(sel, "%s ID:%u, LEN:%u\n", __FUNCTION__, id, len); -+ -+ pos+=(3+len); -+ } -+} -+ +int rtw_get_wfd_ie(u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen) +{ + int match; -+ uint cnt = 0; ++ uint cnt = 0; + u8 eid, wfd_oui[4]={0x50,0x6F,0x9A,0x0A}; + + -+ match=_FALSE; ++ match=false; + + if ( in_len < 0 ) + { @@ -23087,13 +12008,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + while(cnt 1 byte for attribute ID field, 2 bytes for length field + if(attr_content) + _rtw_memcpy( attr_content, &wfd_ie[ cnt + 3 ], attrlen ); -+ ++ + if(attr_contentlen) + *attr_contentlen = attrlen; -+ ++ + cnt += attrlen + 3; + -+ match = _TRUE; ++ match = true; + break; + } + else + { -+ cnt += attrlen + 3; //goto next -+ } -+ -+ } ++ cnt += attrlen + 3; //goto next ++ } ++ ++ } + + return match; + @@ -23247,7 +12144,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + return hdrlen; +} + -+int rtw_get_cipher_info(struct wlan_network *pnetwork) ++static int rtw_get_cipher_info(struct wlan_network *pnetwork) +{ + u32 wpa_ielen; + unsigned char *pbuf; @@ -23300,7 +12197,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + unsigned char *p; + + _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); -+ cap = le16_to_cpu(cap); ++ le16_to_cpup((__le16 *)&cap); + if (cap & WLAN_CAPABILITY_PRIVACY) { + bencrypt = 1; + pnetwork->network.Privacy = 1; @@ -23332,7 +12229,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + p = rtw_get_ie(pnetwork->network.IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, pnetwork->network.IELength - _FIXED_IE_LENGTH_); + if(p && len>0) { + pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); -+ pnetwork->BcnInfo.ht_cap_info = pht_cap->cap_info; ++ pnetwork->BcnInfo.ht_cap_info = le16_to_cpu(pht_cap->cap_info); + } else { + pnetwork->BcnInfo.ht_cap_info = 0; + } @@ -23346,83 +12243,71 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + } +} + -+u8 rtw_ht_mcsset_to_nss(u8 *supp_mcs_set) -+{ -+ u8 nss = 1; -+ -+ if (supp_mcs_set[3]) -+ nss = 4; -+ else if (supp_mcs_set[2]) -+ nss = 3; -+ else if (supp_mcs_set[1]) -+ nss = 2; -+ else if (supp_mcs_set[0]) -+ nss = 1; -+ else -+ DBG_871X("%s,%d, warning! supp_mcs_set is zero\n", __func__, __LINE__); -+ /* DBG_871X("%s HT: %dSS\n", __FUNCTION__, nss); */ -+ return nss; -+} -+ +//show MCS rate, unit: 100Kbps -+u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI, unsigned char * MCS_rate) ++u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI_20, u8 short_GI_40, unsigned char * MCS_rate) +{ + u16 max_rate = 0; + -+ /*MCS_rate[2] = 3T3R , MCS_rate[1] = 2T2R , MCS_rate[0] = 1T1R*/ -+ if (MCS_rate[2]) { -+ if (MCS_rate[2] & BIT(7)) -+ max_rate = (bw_40MHz) ? ((short_GI)?4500:4050):((short_GI)?2167:1950); -+ else if (MCS_rate[2] & BIT(6)) -+ max_rate = (bw_40MHz) ? ((short_GI)?4050:3645):((short_GI)?1950:1750); -+ else if (MCS_rate[2] & BIT(5)) -+ max_rate = (bw_40MHz) ? ((short_GI)?3600:3240):((short_GI)?1733:1560); -+ else if (MCS_rate[2] & BIT(4)) -+ max_rate = (bw_40MHz) ? ((short_GI)?2700:2430):((short_GI)?1300:1170); -+ else if (MCS_rate[2] & BIT(3)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1800:1620):((short_GI)?867:780); -+ else if (MCS_rate[2] & BIT(2)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1350:1215):((short_GI)?650:585); -+ else if (MCS_rate[2] & BIT(1)) -+ max_rate = (bw_40MHz) ? ((short_GI)?900:810):((short_GI)?433:390); -+ else if (MCS_rate[2] & BIT(0)) -+ max_rate = (bw_40MHz) ? ((short_GI)?450:405):((short_GI)?217:195); -+ } else if (MCS_rate[1]) { ++ if(rf_type == RF_1T1R) ++ { ++ if(MCS_rate[0] & BIT(7)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?1500:1350):((short_GI_20)?722:650); ++ else if(MCS_rate[0] & BIT(6)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?1350:1215):((short_GI_20)?650:585); ++ else if(MCS_rate[0] & BIT(5)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?1200:1080):((short_GI_20)?578:520); ++ else if(MCS_rate[0] & BIT(4)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?900:810):((short_GI_20)?433:390); ++ else if(MCS_rate[0] & BIT(3)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?600:540):((short_GI_20)?289:260); ++ else if(MCS_rate[0] & BIT(2)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?450:405):((short_GI_20)?217:195); ++ else if(MCS_rate[0] & BIT(1)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?300:270):((short_GI_20)?144:130); ++ else if(MCS_rate[0] & BIT(0)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?150:135):((short_GI_20)?72:65); ++ } ++ else ++ { ++ if(MCS_rate[1]) ++ { + if(MCS_rate[1] & BIT(7)) -+ max_rate = (bw_40MHz) ? ((short_GI)?3000:2700):((short_GI)?1444:1300); ++ max_rate = (bw_40MHz) ? ((short_GI_40)?3000:2700):((short_GI_20)?1444:1300); + else if(MCS_rate[1] & BIT(6)) -+ max_rate = (bw_40MHz) ? ((short_GI)?2700:2430):((short_GI)?1300:1170); ++ max_rate = (bw_40MHz) ? ((short_GI_40)?2700:2430):((short_GI_20)?1300:1170); + else if(MCS_rate[1] & BIT(5)) -+ max_rate = (bw_40MHz) ? ((short_GI)?2400:2160):((short_GI)?1156:1040); ++ max_rate = (bw_40MHz) ? ((short_GI_40)?2400:2160):((short_GI_20)?1156:1040); + else if(MCS_rate[1] & BIT(4)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1800:1620):((short_GI)?867:780); ++ max_rate = (bw_40MHz) ? ((short_GI_40)?1800:1620):((short_GI_20)?867:780); + else if(MCS_rate[1] & BIT(3)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1200:1080):((short_GI)?578:520); ++ max_rate = (bw_40MHz) ? ((short_GI_40)?1200:1080):((short_GI_20)?578:520); + else if(MCS_rate[1] & BIT(2)) -+ max_rate = (bw_40MHz) ? ((short_GI)?900:810):((short_GI)?433:390); ++ max_rate = (bw_40MHz) ? ((short_GI_40)?900:810):((short_GI_20)?433:390); + else if(MCS_rate[1] & BIT(1)) -+ max_rate = (bw_40MHz) ? ((short_GI)?600:540):((short_GI)?289:260); ++ max_rate = (bw_40MHz) ? ((short_GI_40)?600:540):((short_GI_20)?289:260); + else if(MCS_rate[1] & BIT(0)) -+ max_rate = (bw_40MHz) ? ((short_GI)?300:270):((short_GI)?144:130); -+ } else { -+ if(MCS_rate[0] & BIT(7)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1500:1350):((short_GI)?722:650); -+ else if(MCS_rate[0] & BIT(6)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1350:1215):((short_GI)?650:585); -+ else if(MCS_rate[0] & BIT(5)) -+ max_rate = (bw_40MHz) ? ((short_GI)?1200:1080):((short_GI)?578:520); -+ else if(MCS_rate[0] & BIT(4)) -+ max_rate = (bw_40MHz) ? ((short_GI)?900:810):((short_GI)?433:390); -+ else if(MCS_rate[0] & BIT(3)) -+ max_rate = (bw_40MHz) ? ((short_GI)?600:540):((short_GI)?289:260); -+ else if(MCS_rate[0] & BIT(2)) -+ max_rate = (bw_40MHz) ? ((short_GI)?450:405):((short_GI)?217:195); -+ else if(MCS_rate[0] & BIT(1)) -+ max_rate = (bw_40MHz) ? ((short_GI)?300:270):((short_GI)?144:130); -+ else if(MCS_rate[0] & BIT(0)) -+ max_rate = (bw_40MHz) ? ((short_GI)?150:135):((short_GI)?72:65); ++ max_rate = (bw_40MHz) ? ((short_GI_40)?300:270):((short_GI_20)?144:130); + } -+ ++ else ++ { ++ if(MCS_rate[0] & BIT(7)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?1500:1350):((short_GI_20)?722:650); ++ else if(MCS_rate[0] & BIT(6)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?1350:1215):((short_GI_20)?650:585); ++ else if(MCS_rate[0] & BIT(5)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?1200:1080):((short_GI_20)?578:520); ++ else if(MCS_rate[0] & BIT(4)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?900:810):((short_GI_20)?433:390); ++ else if(MCS_rate[0] & BIT(3)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?600:540):((short_GI_20)?289:260); ++ else if(MCS_rate[0] & BIT(2)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?450:405):((short_GI_20)?217:195); ++ else if(MCS_rate[0] & BIT(1)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?300:270):((short_GI_20)?144:130); ++ else if(MCS_rate[0] & BIT(0)) ++ max_rate = (bw_40MHz) ? ((short_GI_40)?150:135):((short_GI_20)?72:65); ++ } ++ } + return max_rate; +} + @@ -23430,8 +12315,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 +{ + const u8 *frame_body = frame + sizeof(struct rtw_ieee80211_hdr_3addr); + u16 fc; -+ u8 c; -+ u8 a = ACT_PUBLIC_MAX; ++ u8 c, a; + + fc = le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)frame)->frame_ctl); + @@ -23439,7 +12323,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + != (RTW_IEEE80211_FTYPE_MGMT|RTW_IEEE80211_STYPE_ACTION) + ) + { -+ return _FALSE; ++ return false; + } + + c = frame_body[0]; @@ -23456,7 +12340,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + if (action) + *action = a; + -+ return _TRUE; ++ return true; +} + +static const char *_action_public_str[] = { @@ -23484,11 +12368,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ieee80211.c linux/3rdparty/rtl8 + action = (action >= ACT_PUBLIC_MAX) ? ACT_PUBLIC_MAX : action; + return _action_public_str[action]; +} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/core/rtw_io.c ---- linux.old/3rdparty/rtl8812au/core/rtw_io.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_io.c 2017-06-07 23:07:21.000686574 +0300 -@@ -0,0 +1,737 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_io.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_io.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_io.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_io.c 2018-02-06 17:42:30.694966927 +0200 +@@ -0,0 +1,426 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -23502,11 +12385,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/c + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +/* + @@ -23521,16 +12399,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/c + +Compiler Flag Option: + -+1. CONFIG_SDIO_HCI: -+ a. USE_SYNC_IRP: Only sync operations are provided. -+ b. USE_ASYNC_IRP:Both sync/async operations are provided. -+ -+2. CONFIG_USB_HCI: -+ a. USE_ASYNC_IRP: Both sync/async operations are provided. -+ -+3. CONFIG_CFIO_HCI: -+ b. USE_SYNC_IRP: Only sync operations are provided. -+ ++USE_ASYNC_IRP: Both sync/async operations are provided. + +Only sync read/rtw_write_mem operations are provided. + @@ -23541,303 +12410,154 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/c +#define _RTW_IO_C_ + +#include -+#include + -+#if defined (PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+#error "Shall be Linux or Windows, but not both!\n" -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+#define rtw_le16_to_cpu(val) val -+#define rtw_le32_to_cpu(val) val -+#define rtw_cpu_to_le16(val) val -+#define rtw_cpu_to_le32(val) val -+#else -+#define rtw_le16_to_cpu(val) le16_to_cpu(val) ++#define rtw_le16_to_cpu(val) le16_to_cpu(val) +#define rtw_le32_to_cpu(val) le32_to_cpu(val) +#define rtw_cpu_to_le16(val) cpu_to_le16(val) +#define rtw_cpu_to_le32(val) cpu_to_le32(val) -+#endif -+ + +u8 _rtw_read8(_adapter *adapter, u32 addr) +{ + u8 r_val; -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; ++ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = &(pio_priv->intf); + u8 (*_read8)(struct intf_hdl *pintfhdl, u32 addr); -+ _func_enter_; ++ + _read8 = pintfhdl->io_ops._read8; + + r_val = _read8(pintfhdl, addr); -+ _func_exit_; ++ + return r_val; +} + +u16 _rtw_read16(_adapter *adapter, u32 addr) +{ + u16 r_val; -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u16 (*_read16)(struct intf_hdl *pintfhdl, u32 addr); -+ _func_enter_; ++ u16 (*_read16)(struct intf_hdl *pintfhdl, u32 addr); ++ + _read16 = pintfhdl->io_ops._read16; + + r_val = _read16(pintfhdl, addr); -+ _func_exit_; -+ return rtw_le16_to_cpu(r_val); ++ ++ return r_val; +} + +u32 _rtw_read32(_adapter *adapter, u32 addr) +{ + u32 r_val; -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u32 (*_read32)(struct intf_hdl *pintfhdl, u32 addr); -+ _func_enter_; ++ u32 (*_read32)(struct intf_hdl *pintfhdl, u32 addr); ++ + _read32 = pintfhdl->io_ops._read32; + + r_val = _read32(pintfhdl, addr); -+ _func_exit_; -+ return rtw_le32_to_cpu(r_val); + ++ return r_val; +} + +int _rtw_write8(_adapter *adapter, u32 addr, u8 val) +{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; ++ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = &(pio_priv->intf); + int (*_write8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); + int ret; -+ _func_enter_; ++ + _write8 = pintfhdl->io_ops._write8; + + ret = _write8(pintfhdl, addr, val); -+ _func_exit_; -+ ++ ++ + return RTW_STATUS_CODE(ret); +} +int _rtw_write16(_adapter *adapter, u32 addr, u16 val) +{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; ++ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = &(pio_priv->intf); + int (*_write16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); + int ret; -+ _func_enter_; ++ + _write16 = pintfhdl->io_ops._write16; + -+ val = rtw_cpu_to_le16(val); + ret = _write16(pintfhdl, addr, val); -+ _func_exit_; ++ + + return RTW_STATUS_CODE(ret); +} +int _rtw_write32(_adapter *adapter, u32 addr, u32 val) +{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; ++ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = &(pio_priv->intf); + int (*_write32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); + int ret; -+ _func_enter_; ++ + _write32 = pintfhdl->io_ops._write32; -+ -+ val = rtw_cpu_to_le32(val); ++ + ret = _write32(pintfhdl, addr, val); -+ _func_exit_; + + return RTW_STATUS_CODE(ret); +} + +int _rtw_writeN(_adapter *adapter, u32 addr ,u32 length , u8 *pdata) +{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; ++ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = (struct intf_hdl*)(&(pio_priv->intf)); + int (*_writeN)(struct intf_hdl *pintfhdl, u32 addr,u32 length, u8 *pdata); + int ret; -+ _func_enter_; ++ + _writeN = pintfhdl->io_ops._writeN; + + ret = _writeN(pintfhdl, addr,length,pdata); -+ _func_exit_; ++ + + return RTW_STATUS_CODE(ret); +} -+ -+#ifdef CONFIG_SDIO_HCI -+u8 _rtw_sd_f0_read8(_adapter *adapter, u32 addr) -+{ -+ u8 r_val = 0x00; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u8 (*_sd_f0_read8)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _func_enter_; -+ _sd_f0_read8 = pintfhdl->io_ops._sd_f0_read8; -+ -+ if (_sd_f0_read8) -+ r_val = _sd_f0_read8(pintfhdl, addr); -+ else -+ DBG_871X_LEVEL(_drv_warning_, FUNC_ADPT_FMT" _sd_f0_read8 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ _func_exit_; -+ return r_val; -+} -+ -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+u8 _rtw_sd_iread8(_adapter *adapter, u32 addr) -+{ -+ u8 r_val = 0x00; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u8 (*_sd_iread8)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _sd_iread8 = pintfhdl->io_ops._sd_iread8; -+ -+ if (_sd_iread8) -+ r_val = _sd_iread8(pintfhdl, addr); -+ else -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT" _sd_iread8 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return r_val; -+} -+ -+u16 _rtw_sd_iread16(_adapter *adapter, u32 addr) -+{ -+ u16 r_val = 0x00; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u16 (*_sd_iread16)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _sd_iread16 = pintfhdl->io_ops._sd_iread16; -+ -+ if (_sd_iread16) -+ r_val = _sd_iread16(pintfhdl, addr); -+ else -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT" _sd_iread16 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return r_val; -+} -+ -+u32 _rtw_sd_iread32(_adapter *adapter, u32 addr) -+{ -+ u32 r_val = 0x00; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u32 (*_sd_iread32)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _sd_iread32 = pintfhdl->io_ops._sd_iread32; -+ -+ if (_sd_iread32) -+ r_val = _sd_iread32(pintfhdl, addr); -+ else -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT" _sd_iread32 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return r_val; -+} -+ -+int _rtw_sd_iwrite8(_adapter *adapter, u32 addr, u8 val) -+{ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_sd_iwrite8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int ret = -1; -+ -+ _sd_iwrite8 = pintfhdl->io_ops._sd_iwrite8; -+ -+ if (_sd_iwrite8) -+ ret = _sd_iwrite8(pintfhdl, addr, val); -+ else -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT" _sd_iwrite8 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return RTW_STATUS_CODE(ret); -+} -+ -+int _rtw_sd_iwrite16(_adapter *adapter, u32 addr, u16 val) -+{ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_sd_iwrite16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int ret = -1; -+ -+ _sd_iwrite16 = pintfhdl->io_ops._sd_iwrite16; -+ -+ if (_sd_iwrite16) -+ ret = _sd_iwrite16(pintfhdl, addr, val); -+ else -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT" _sd_iwrite16 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return RTW_STATUS_CODE(ret); -+} -+int _rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val) -+{ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_sd_iwrite32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ int ret = -1; -+ -+ _sd_iwrite32 = pintfhdl->io_ops._sd_iwrite32; -+ -+ if (_sd_iwrite32) -+ ret = _sd_iwrite32(pintfhdl, addr, val); -+ else -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT" _sd_iwrite32 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return RTW_STATUS_CODE(ret); -+} -+ -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+ -+#endif /* CONFIG_SDIO_HCI */ -+ +int _rtw_write8_async(_adapter *adapter, u32 addr, u8 val) +{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; ++ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = &(pio_priv->intf); + int (*_write8_async)(struct intf_hdl *pintfhdl, u32 addr, u8 val); + int ret; -+ _func_enter_; ++ + _write8_async = pintfhdl->io_ops._write8_async; + + ret = _write8_async(pintfhdl, addr, val); -+ _func_exit_; ++ + + return RTW_STATUS_CODE(ret); +} +int _rtw_write16_async(_adapter *adapter, u32 addr, u16 val) +{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; ++ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = &(pio_priv->intf); + int (*_write16_async)(struct intf_hdl *pintfhdl, u32 addr, u16 val); + int ret; -+ _func_enter_; ++ + _write16_async = pintfhdl->io_ops._write16_async; -+ val = rtw_cpu_to_le16(val); + ret = _write16_async(pintfhdl, addr, val); -+ _func_exit_; + + return RTW_STATUS_CODE(ret); +} ++ +int _rtw_write32_async(_adapter *adapter, u32 addr, u32 val) +{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; ++ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = &(pio_priv->intf); + int (*_write32_async)(struct intf_hdl *pintfhdl, u32 addr, u32 val); + int ret; -+ _func_enter_; ++ + _write32_async = pintfhdl->io_ops._write32_async; -+ val = rtw_cpu_to_le32(val); + ret = _write32_async(pintfhdl, addr, val); -+ _func_exit_; + + return RTW_STATUS_CODE(ret); +} @@ -23845,57 +12565,55 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/c +void _rtw_read_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) +{ + void (*_read_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; ++ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = &(pio_priv->intf); + -+ _func_enter_; + -+ if (RTW_CANNOT_RUN(adapter)) { -+ RT_TRACE(_module_rtl871x_io_c_, _drv_info_, ("rtw_read_mem:bDriverStopped(%s) OR bSurpriseRemoved(%s)" -+ , rtw_is_drv_stopped(adapter)?"True":"False" -+ , rtw_is_surprise_removed(adapter)?"True":"False")); -+ return; ++ ++ if( (adapter->bDriverStopped ==true) || (adapter->bSurpriseRemoved == true)) ++ { ++ RT_TRACE(_module_rtl871x_io_c_, _drv_info_, ("rtw_read_mem:bDriverStopped(%d) OR bSurpriseRemoved(%d)", adapter->bDriverStopped, adapter->bSurpriseRemoved)); ++ return; + } + + _read_mem = pintfhdl->io_ops._read_mem; + + _read_mem(pintfhdl, addr, cnt, pmem); + -+ _func_exit_; ++ + +} + +void _rtw_write_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) +{ + void (*_write_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; ++ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = &(pio_priv->intf); + -+ _func_enter_; ++ + + _write_mem = pintfhdl->io_ops._write_mem; + + _write_mem(pintfhdl, addr, cnt, pmem); + -+ _func_exit_; ++ + +} + +void _rtw_read_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) +{ + u32 (*_read_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; ++ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = &(pio_priv->intf); + -+ _func_enter_; + -+ if (RTW_CANNOT_RUN(adapter)) { -+ RT_TRACE(_module_rtl871x_io_c_, _drv_info_, ("rtw_read_port:bDriverStopped(%s) OR bSurpriseRemoved(%s)" -+ , rtw_is_drv_stopped(adapter)?"True":"False" -+ , rtw_is_surprise_removed(adapter)?"True":"False")); ++ ++ if( (adapter->bDriverStopped ==true) || (adapter->bSurpriseRemoved == true)) ++ { ++ RT_TRACE(_module_rtl871x_io_c_, _drv_info_, ("rtw_read_port:bDriverStopped(%d) OR bSurpriseRemoved(%d)", adapter->bDriverStopped, adapter->bSurpriseRemoved)); + return; + } + @@ -23903,7 +12621,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/c + + _read_port(pintfhdl, addr, cnt, pmem); + -+ _func_exit_; ++ + +} + @@ -23915,27 +12633,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/c + + _read_port_cancel = pintfhdl->io_ops._read_port_cancel; + -+ RTW_DISABLE_FUNC(adapter, DF_RX_BIT); -+ + if(_read_port_cancel) + _read_port_cancel(pintfhdl); ++ +} + +u32 _rtw_write_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) +{ + u32 (*_write_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; ++ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; + struct io_priv *pio_priv = &adapter->iopriv; + struct intf_hdl *pintfhdl = &(pio_priv->intf); + u32 ret = _SUCCESS; + -+ _func_enter_; ++ + + _write_port = pintfhdl->io_ops._write_port; -+ ++ + ret = _write_port(pintfhdl, addr, cnt, pmem); + -+ _func_exit_; ++ + + return ret; +} @@ -23952,7 +12669,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/c + ret = _rtw_write_port(adapter, addr, cnt, pmem); + + if (ret == _SUCCESS) -+ ret = rtw_sctx_wait(&sctx, __func__); ++ ret = rtw_sctx_wait(&sctx); + + return ret; +} @@ -23965,10 +12682,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/c + + _write_port_cancel = pintfhdl->io_ops._write_port_cancel; + -+ RTW_DISABLE_FUNC(adapter, DF_TX_BIT); -+ + if(_write_port_cancel) + _write_port_cancel(pintfhdl); ++ +} +int rtw_init_io_priv(_adapter *padapter, void (*set_intf_ops)(_adapter *padapter,struct _io_ops *pops)) +{ @@ -23981,117 +12697,46 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/c + piopriv->padapter = padapter; + pintf->padapter = padapter; + pintf->pintf_dev = adapter_to_dvobj(padapter); -+ -+ set_intf_ops(padapter,&pintf->io_ops); ++ ++ set_intf_ops(padapter,&pintf->io_ops); + + return _SUCCESS; +} + -+/* -+* Increase and check if the continual_io_error of this @param dvobjprive is larger than MAX_CONTINUAL_IO_ERR -+* @return _TRUE: -+* @return _FALSE: -+*/ -+int rtw_inc_and_chk_continual_io_error(struct dvobj_priv *dvobj) -+{ -+ int ret = _FALSE; -+ int value; -+ if( (value=ATOMIC_INC_RETURN(&dvobj->continual_io_error)) > MAX_CONTINUAL_IO_ERR) { -+ DBG_871X("[dvobj:%p][ERROR] continual_io_error:%d > %d\n", dvobj, value, MAX_CONTINUAL_IO_ERR); -+ ret = _TRUE; -+ } else { -+ //DBG_871X("[dvobj:%p] continual_io_error:%d\n", dvobj, value); -+ } -+ return ret; -+} -+ -+/* -+* Set the continual_io_error of this @param dvobjprive to 0 -+*/ -+void rtw_reset_continual_io_error(struct dvobj_priv *dvobj) -+{ -+ ATOMIC_SET(&dvobj->continual_io_error, 0); -+} -+ +#ifdef DBG_IO + -+u32 read_sniff_ranges[][2] = { -+ //{0x520, 0x523}, -+}; ++u16 read_sniff_ranges[][2] = { ++ //{0x550, 0x551}, ++}; + -+u32 write_sniff_ranges[][2] = { -+ //{0x520, 0x523}, ++u16 write_sniff_ranges[][2] = { ++ //{0x550, 0x551}, + //{0x4c, 0x4c}, -+}; ++}; + -+int read_sniff_num = sizeof(read_sniff_ranges)/sizeof(u32)/2; -+int write_sniff_num = sizeof(write_sniff_ranges)/sizeof(u32)/2; ++int read_sniff_num = sizeof(read_sniff_ranges)/sizeof(u16)/2; ++int write_sniff_num = sizeof(write_sniff_ranges)/sizeof(u16)/2; + -+bool match_read_sniff_ranges(u32 addr, u16 len) ++bool match_read_sniff_ranges(u16 addr, u16 len) +{ + int i; + for (i = 0; i read_sniff_ranges[i][0] && addr <= read_sniff_ranges[i][1]) -+ return _TRUE; ++ return true; + } -+ -+ return _FALSE; ++ ++ return false; +} + -+bool match_write_sniff_ranges(u32 addr, u16 len) ++bool match_write_sniff_ranges(u16 addr, u16 len) +{ + int i; + for (i = 0; i write_sniff_ranges[i][0] && addr <= write_sniff_ranges[i][1]) -+ return _TRUE; -+ } -+ -+ return _FALSE; -+} -+ -+struct rf_sniff_ent { -+ u8 path; -+ u16 reg; -+ u32 mask; -+}; -+ -+struct rf_sniff_ent rf_read_sniff_ranges[] = { -+ /* example for all path addr 0x55 with all RF Reg mask */ -+ /* {MAX_RF_PATH, 0x55, bRFRegOffsetMask}, */ -+}; -+ -+struct rf_sniff_ent rf_write_sniff_ranges[] = { -+ /* example for all path addr 0x55 with all RF Reg mask */ -+ /* {MAX_RF_PATH, 0x55, bRFRegOffsetMask}, */ -+}; -+ -+int rf_read_sniff_num = sizeof(rf_read_sniff_ranges)/sizeof(struct rf_sniff_ent); -+int rf_write_sniff_num = sizeof(rf_write_sniff_ranges)/sizeof(struct rf_sniff_ent); -+ -+bool match_rf_read_sniff_ranges(u8 path, u32 addr, u32 mask) -+{ -+ int i; -+ -+ for (i = 0; i < rf_read_sniff_num; i++) { -+ if (rf_read_sniff_ranges[i].path == MAX_RF_PATH || rf_read_sniff_ranges[i].path == path) -+ if (addr == rf_read_sniff_ranges[i].reg && (mask & rf_read_sniff_ranges[i].mask)) -+ return _TRUE; ++ return true; + } + -+ return _FALSE; -+} -+ -+bool match_rf_write_sniff_ranges(u8 path, u32 addr, u32 mask) -+{ -+ int i; -+ -+ for (i = 0; i < rf_write_sniff_num; i++) { -+ if (rf_write_sniff_ranges[i].path == MAX_RF_PATH || rf_write_sniff_ranges[i].path == path) -+ if (addr == rf_write_sniff_ranges[i].reg && (mask & rf_write_sniff_ranges[i].mask)) -+ return _TRUE; -+ } -+ -+ return _FALSE; ++ return false; +} + +u8 dbg_rtw_read8(_adapter *adapter, u32 addr, const char *caller, const int line) @@ -24107,7 +12752,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/c +u16 dbg_rtw_read16(_adapter *adapter, u32 addr, const char *caller, const int line) +{ + u16 val = _rtw_read16(adapter, addr); -+ ++ + if (match_read_sniff_ranges(addr, 2)) + DBG_871X("DBG_IO %s:%d rtw_read16(0x%04x) return 0x%04x\n", caller, line, addr, val); + @@ -24117,7 +12762,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/c +u32 dbg_rtw_read32(_adapter *adapter, u32 addr, const char *caller, const int line) +{ + u32 val = _rtw_read32(adapter, addr); -+ ++ + if (match_read_sniff_ranges(addr, 4)) + DBG_871X("DBG_IO %s:%d rtw_read32(0x%04x) return 0x%08x\n", caller, line, addr, val); + @@ -24128,21 +12773,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/c +{ + if (match_write_sniff_ranges(addr, 1)) + DBG_871X("DBG_IO %s:%d rtw_write8(0x%04x, 0x%02x)\n", caller, line, addr, val); -+ ++ + return _rtw_write8(adapter, addr, val); +} +int dbg_rtw_write16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line) +{ + if (match_write_sniff_ranges(addr, 2)) + DBG_871X("DBG_IO %s:%d rtw_write16(0x%04x, 0x%04x)\n", caller, line, addr, val); -+ ++ + return _rtw_write16(adapter, addr, val); +} +int dbg_rtw_write32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line) +{ + if (match_write_sniff_ranges(addr, 4)) + DBG_871X("DBG_IO %s:%d rtw_write32(0x%04x, 0x%08x)\n", caller, line, addr, val); -+ ++ + return _rtw_write32(adapter, addr, val); +} +int dbg_rtw_writeN(_adapter *adapter, u32 addr ,u32 length , u8 *data, const char *caller, const int line) @@ -24152,88 +12797,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_io.c linux/3rdparty/rtl8812au/c + + return _rtw_writeN(adapter, addr, length, data); +} -+ -+#ifdef CONFIG_SDIO_HCI -+u8 dbg_rtw_sd_f0_read8(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u8 val = _rtw_sd_f0_read8(adapter, addr); -+ -+ #if 0 -+ if (match_read_sniff_ranges(addr, 1)) -+ DBG_871X("DBG_IO %s:%d rtw_sd_f0_read8(0x%04x) return 0x%02x\n", caller, line, addr, val); -+ #endif -+ -+ return val; -+} -+ -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+u8 dbg_rtw_sd_iread8(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u8 val = rtw_sd_iread8(adapter, addr); -+ -+ if (match_read_sniff_ranges(addr, 1)) -+ DBG_871X("DBG_IO %s:%d rtw_sd_iread8(0x%04x) return 0x%02x\n", caller, line, addr, val); -+ -+ return val; -+} -+ -+u16 dbg_rtw_sd_iread16(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u16 val = _rtw_sd_iread16(adapter, addr); -+ -+ if (match_read_sniff_ranges(addr, 2)) -+ DBG_871X("DBG_IO %s:%d rtw_sd_iread16(0x%04x) return 0x%04x\n", caller, line, addr, val); -+ -+ return val; -+} -+ -+u32 dbg_rtw_sd_iread32(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u32 val = _rtw_sd_iread32(adapter, addr); -+ -+ if (match_read_sniff_ranges(addr, 4)) -+ DBG_871X("DBG_IO %s:%d rtw_sd_iread32(0x%04x) return 0x%08x\n", caller, line, addr, val); -+ -+ return val; -+} -+ -+int dbg_rtw_sd_iwrite8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 1)) -+ DBG_871X("DBG_IO %s:%d rtw_sd_iwrite8(0x%04x, 0x%02x)\n", caller, line, addr, val); -+ -+ return _rtw_sd_iwrite8(adapter, addr, val); -+} -+int dbg_rtw_sd_iwrite16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 2)) -+ DBG_871X("DBG_IO %s:%d rtw_sd_iwrite16(0x%04x, 0x%04x)\n", caller, line, addr, val); -+ -+ return _rtw_sd_iwrite16(adapter, addr, val); -+} -+int dbg_rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 4)) -+ DBG_871X("DBG_IO %s:%d rtw_sd_iwrite32(0x%04x, 0x%08x)\n", caller, line, addr, val); -+ -+ return _rtw_sd_iwrite32(adapter, addr, val); -+} -+ -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+ -+#endif /* CONFIG_SDIO_HCI */ -+ +#endif -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_query.c linux/3rdparty/rtl8812au/core/rtw_ioctl_query.c ---- linux.old/3rdparty/rtl8812au/core/rtw_ioctl_query.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_ioctl_query.c 2017-06-07 23:07:21.000686574 +0300 -@@ -0,0 +1,192 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_ioctl_query.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ioctl_query.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_ioctl_query.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ioctl_query.c 2018-02-06 17:42:30.694966927 +0200 +@@ -0,0 +1,20 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -24243,193 +12815,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_query.c linux/3rdparty/rt + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_IOCTL_QUERY_C_ + +#include + + -+#ifdef PLATFORM_WINDOWS -+// -+// Added for WPA2-PSK, by Annie, 2005-09-20. -+// -+u8 -+query_802_11_capability( -+ _adapter* Adapter, -+ u8* pucBuf, -+ u32 * pulOutLen -+) -+{ -+ static NDIS_802_11_AUTHENTICATION_ENCRYPTION szAuthEnc[] = -+ { -+ {Ndis802_11AuthModeOpen, Ndis802_11EncryptionDisabled}, -+ {Ndis802_11AuthModeOpen, Ndis802_11Encryption1Enabled}, -+ {Ndis802_11AuthModeShared, Ndis802_11EncryptionDisabled}, -+ {Ndis802_11AuthModeShared, Ndis802_11Encryption1Enabled}, -+ {Ndis802_11AuthModeWPA, Ndis802_11Encryption2Enabled}, -+ {Ndis802_11AuthModeWPA, Ndis802_11Encryption3Enabled}, -+ {Ndis802_11AuthModeWPAPSK, Ndis802_11Encryption2Enabled}, -+ {Ndis802_11AuthModeWPAPSK, Ndis802_11Encryption3Enabled}, -+ {Ndis802_11AuthModeWPANone, Ndis802_11Encryption2Enabled}, -+ {Ndis802_11AuthModeWPANone, Ndis802_11Encryption3Enabled}, -+ {Ndis802_11AuthModeWPA2, Ndis802_11Encryption2Enabled}, -+ {Ndis802_11AuthModeWPA2, Ndis802_11Encryption3Enabled}, -+ {Ndis802_11AuthModeWPA2PSK, Ndis802_11Encryption2Enabled}, -+ {Ndis802_11AuthModeWPA2PSK, Ndis802_11Encryption3Enabled} -+ }; -+ static ULONG ulNumOfPairSupported = sizeof(szAuthEnc)/sizeof(NDIS_802_11_AUTHENTICATION_ENCRYPTION); -+ NDIS_802_11_CAPABILITY * pCap = (NDIS_802_11_CAPABILITY *)pucBuf; -+ u8* pucAuthEncryptionSupported = (u8*) pCap->AuthenticationEncryptionSupported; + -+ -+ pCap->Length = sizeof(NDIS_802_11_CAPABILITY); -+ if(ulNumOfPairSupported > 1 ) -+ pCap->Length += (ulNumOfPairSupported-1) * sizeof(NDIS_802_11_AUTHENTICATION_ENCRYPTION); -+ -+ pCap->Version = 2; -+ pCap->NoOfPMKIDs = NUM_PMKID_CACHE; -+ pCap->NoOfAuthEncryptPairsSupported = ulNumOfPairSupported; -+ -+ if( sizeof (szAuthEnc) <= 240 ) // 240 = 256 - 4*4 // SecurityInfo.szCapability: only 256 bytes in size. -+ { -+ _rtw_memcpy( pucAuthEncryptionSupported, (u8*)szAuthEnc, sizeof (szAuthEnc) ); -+ *pulOutLen = pCap->Length; -+ return _TRUE; -+ } -+ else -+ { -+ *pulOutLen = 0; -+ RT_TRACE(_module_rtl871x_ioctl_query_c_,_drv_info_,("_query_802_11_capability(): szAuthEnc size is too large.\n")); -+ return _FALSE; -+ } -+} -+ -+u8 query_802_11_association_information( _adapter *padapter,PNDIS_802_11_ASSOCIATION_INFORMATION pAssocInfo) -+{ -+ struct wlan_network *tgt_network; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct security_priv *psecuritypriv=&(padapter->securitypriv); -+ WLAN_BSSID_EX *psecnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ u8 * pDest = (u8 *)pAssocInfo + sizeof(NDIS_802_11_ASSOCIATION_INFORMATION); -+ unsigned char i,*auth_ie,*supp_ie; -+ -+ //NdisZeroMemory(pAssocInfo, sizeof(NDIS_802_11_ASSOCIATION_INFORMATION)); -+ _rtw_memset(pAssocInfo, 0, sizeof(NDIS_802_11_ASSOCIATION_INFORMATION)); -+ //pAssocInfo->Length = sizeof(NDIS_802_11_ASSOCIATION_INFORMATION); -+ -+ //------------------------------------------------------ -+ // Association Request related information -+ //------------------------------------------------------ -+ // Req_1. AvailableRequestFixedIEs -+ if(psecnetwork!=NULL){ -+ -+ pAssocInfo->AvailableRequestFixedIEs |= NDIS_802_11_AI_REQFI_CAPABILITIES|NDIS_802_11_AI_REQFI_CURRENTAPADDRESS; -+ pAssocInfo->RequestFixedIEs.Capabilities = (unsigned short)* & psecnetwork->IEs[10]; -+ _rtw_memcpy(pAssocInfo->RequestFixedIEs.CurrentAPAddress, -+ & psecnetwork->MacAddress, 6); -+ -+ pAssocInfo->OffsetRequestIEs = sizeof(NDIS_802_11_ASSOCIATION_INFORMATION); -+ -+ if(check_fwstate( pmlmepriv, _FW_UNDER_LINKING|_FW_LINKED)==_TRUE) -+ { -+ -+ if(psecuritypriv->ndisauthtype>=Ndis802_11AuthModeWPA2) -+ pDest[0] =48; //RSN Information Element -+ else -+ pDest[0] =221; //WPA(SSN) Information Element -+ -+ RT_TRACE(_module_rtl871x_ioctl_query_c_,_drv_info_,("\n Adapter->ndisauthtype==Ndis802_11AuthModeWPA)?0xdd:0x30 [%d]",pDest[0])); -+ supp_ie=&psecuritypriv->supplicant_ie[0]; -+ for(i=0;inetwork.IELength=%d\n\n", i,(int)psecnetwork->IELength)); -+ while((iRequestIELength += (2 + supp_ie[1+i]);// (2 + psecnetwork->IEs[1+i]+4); -+ -+ } -+ -+ -+ RT_TRACE(_module_rtl871x_ioctl_query_c_,_drv_info_,("\n psecnetwork != NULL,fwstate==_FW_UNDER_LINKING \n")); -+ -+ } -+ -+ -+ //------------------------------------------------------ -+ // Association Response related information -+ //------------------------------------------------------ -+ -+ if(check_fwstate( pmlmepriv, _FW_LINKED)==_TRUE) -+ { -+ tgt_network =&(pmlmepriv->cur_network); -+ if(tgt_network!=NULL){ -+ pAssocInfo->AvailableResponseFixedIEs = -+ NDIS_802_11_AI_RESFI_CAPABILITIES -+ |NDIS_802_11_AI_RESFI_ASSOCIATIONID -+ ; -+ -+ pAssocInfo->ResponseFixedIEs.Capabilities =(unsigned short)* & tgt_network->network.IEs[10]; -+ pAssocInfo->ResponseFixedIEs.StatusCode = 0; -+ pAssocInfo->ResponseFixedIEs.AssociationId =(unsigned short) tgt_network->aid; -+ -+ pDest = (u8 *)pAssocInfo + sizeof(NDIS_802_11_ASSOCIATION_INFORMATION)+pAssocInfo->RequestIELength; -+ auth_ie=&psecuritypriv->authenticator_ie[0]; -+ -+ for(i=0;i0){ -+ _rtw_memcpy((u8 *)&pDest[0],&auth_ie[1],i); -+ pAssocInfo->ResponseIELength =i; -+ } -+ -+ -+ pAssocInfo->OffsetResponseIEs = sizeof(NDIS_802_11_ASSOCIATION_INFORMATION) + pAssocInfo->RequestIELength; -+ -+ -+ RT_TRACE(_module_rtl871x_ioctl_query_c_,_drv_info_,("\n tgt_network != NULL,fwstate==_FW_LINKED \n")); -+ } -+ } -+ RT_TRACE(_module_rtl871x_ioctl_query_c_,_drv_info_,("\n exit query_802_11_association_information \n")); -+_func_exit_; -+ -+ return _TRUE; -+} -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c ---- linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c 2017-06-07 23:07:21.000686574 +0300 -@@ -0,0 +1,1021 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c 2018-02-06 17:42:30.694966927 +0200 +@@ -0,0 +1,1017 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -24439,11 +12839,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_IOCTL_RTL_C_ + @@ -24480,8 +12875,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 + {1, &oid_rt_get_preamble_mode_hdl}, //0x96 + {1, &oid_null_function}, //0x97 + {1, &oid_rt_get_ap_ip_hdl}, //0x98 -+ {1, &oid_rt_get_channelplan_hdl}, //0x99 -+ {1, &oid_rt_set_preamble_mode_hdl}, //0x9A ++ {1, &oid_rt_get_channelplan_hdl}, //0x99 ++ {1, &oid_rt_set_preamble_mode_hdl}, //0x9A + {1, &oid_rt_set_bcn_intvl_hdl}, //0x9B + {1, &oid_null_function}, //0x9C + {1, &oid_rt_dedicate_probe_hdl}, //0x9D @@ -24496,8 +12891,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 + {1, &oid_null_function}, //0xA6 + {1, &oid_rt_get_total_tx_bytes_hdl}, //0xA7 + {1, &oid_rt_get_total_rx_bytes_hdl}, //0xA8 -+ {1, &oid_rt_current_tx_power_level_hdl}, //0xA9 -+ {1, &oid_rt_get_enc_key_mismatch_count_hdl}, //0xAA ++ {1, &oid_rt_current_tx_power_level_hdl}, //0xA9 ++ {1, &oid_rt_get_enc_key_mismatch_count_hdl}, //0xAA + {1, &oid_rt_get_enc_key_match_count_hdl}, //0xAB + {1, &oid_rt_get_channel_hdl}, //0xAC + {1, &oid_rt_set_channelplan_hdl}, //0xAD @@ -24512,8 +12907,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 + {1, &oid_null_function}, //0xB6 + {1, &oid_null_function}, //0xB7 + {1, &oid_null_function}, //0xB8 -+ {1, &oid_null_function}, //0xB9 -+ {1, &oid_null_function}, //0xBA ++ {1, &oid_null_function}, //0xB9 ++ {1, &oid_null_function}, //0xBA + {1, &oid_rt_supported_wireless_mode_hdl}, //0xBB + {1, &oid_rt_get_channel_list_hdl}, //0xBC + {1, &oid_rt_get_scan_in_progress_hdl}, //0xBD @@ -24528,14 +12923,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 + {1, &oid_null_function}, //0xC6 + {1, &oid_null_function}, //0xC7 + {1, &oid_null_function}, //0xC8 -+ {1, &oid_null_function}, //0xC9 -+ {1, &oid_null_function}, //0xCA ++ {1, &oid_null_function}, //0xC9 ++ {1, &oid_null_function}, //0xCA + {1, &oid_null_function}, //0xCB + {1, &oid_null_function}, //0xCC + {1, &oid_null_function}, //0xCD + {1, &oid_null_function}, //0xCE + {1, &oid_null_function}, //0xCF -+ ++ +}; + +struct oid_obj_priv oid_rtl_seg_01_03[] = @@ -24551,7 +12946,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 + +struct oid_obj_priv oid_rtl_seg_01_11[] = +{ -+ {1, &oid_null_function}, //0xC0 OID_RT_PRO_RX_FILTER ++ {1, &oid_null_function}, //0xC0 OID_RT_PRO_RX_FILTER + {1, &oid_null_function}, //0xC1 OID_CE_USB_WRITE_REGISTRY + {1, &oid_null_function}, //0xC2 OID_CE_USB_READ_REGISTRY + {1, &oid_null_function}, //0xC3 OID_RT_PRO_SET_INITIAL_GAIN @@ -24559,10 +12954,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 + {1, &oid_null_function}, //0xC5 OID_RT_PRO_SET_BB_RF_SHUTDOWN_MODE + {1, &oid_null_function}, //0xC6 OID_RT_PRO_SET_TX_CHARGE_PUMP + {1, &oid_null_function}, //0xC7 OID_RT_PRO_SET_RX_CHARGE_PUMP -+ {1, &oid_rt_pro_rf_write_registry_hdl}, //0xC8 -+ {1, &oid_rt_pro_rf_read_registry_hdl}, //0xC9 ++ {1, &oid_rt_pro_rf_write_registry_hdl}, //0xC8 ++ {1, &oid_rt_pro_rf_read_registry_hdl}, //0xC9 + {1, &oid_null_function} //0xCA OID_RT_PRO_QUERY_RF_TYPE -+ ++ +}; + +struct oid_obj_priv oid_rtl_seg_03_00[] = @@ -24573,93 +12968,93 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 + {1, &oid_null_function}, //0x03 + {1, &oid_rt_set_default_key_id_hdl}, //0x04 + -+ ++ +}; + + -+//************** oid_rtl_seg_01_01 section start ************** ++//************** oid_rtl_seg_01_01 section start ************** + -+NDIS_STATUS oid_rt_pro_set_fw_dig_state_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_pro_set_fw_dig_state_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; +#if 0 + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + _irqL oldirql; -+ -+ _func_enter_; -+ -+ if(poid_par_priv->type_of_oid != SET_OID) ++ ++ ++ ++ if(poid_par_priv->type_of_oid != SET_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } -+ ++ + _irqlevel_changed_(&oldirql,LOWER); + if(poid_par_priv->information_buf_len >= sizeof(struct setdig_parm)) + { -+ //DEBUG_ERR(("===> oid_rt_pro_set_fw_dig_state_hdl. type:0x%02x.\n",*((unsigned char*)poid_par_priv->information_buf ))); -+ if(!rtw_setfwdig_cmd(Adapter,*((unsigned char*)poid_par_priv->information_buf ))) ++ //DEBUG_ERR(("===> oid_rt_pro_set_fw_dig_state_hdl. type:0x%02x.\n",*((unsigned char*)poid_par_priv->information_buf ))); ++ if(!rtw_setfwdig_cmd(Adapter,*((unsigned char*)poid_par_priv->information_buf ))) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + } -+ ++ + } + else{ -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ } ++ status = uint_NOT_ACCEPTED; ++ } + _irqlevel_changed_(&oldirql,RAISE); -+ _func_exit_; ++ +#endif + return status; +} +//----------------------------------------------------------------------------- -+NDIS_STATUS oid_rt_pro_set_fw_ra_state_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_pro_set_fw_ra_state_hdl(struct oid_par_priv* poid_par_priv) +{ + -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; +#if 0 + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + _irqL oldirql; -+ -+ _func_enter_; -+ if(poid_par_priv->type_of_oid != SET_OID) ++ ++ ++ if(poid_par_priv->type_of_oid != SET_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } + -+ ++ + _irqlevel_changed_(&oldirql,LOWER); -+ ++ + if(poid_par_priv->information_buf_len >= sizeof(struct setra_parm)) + { -+ //DEBUG_ERR(("===> oid_rt_pro_set_fw_ra_state_hdl. type:0x%02x.\n",*((unsigned char*)poid_par_priv->information_buf ))); -+ if(!rtw_setfwra_cmd(Adapter,*((unsigned char*)poid_par_priv->information_buf ))) ++ //DEBUG_ERR(("===> oid_rt_pro_set_fw_ra_state_hdl. type:0x%02x.\n",*((unsigned char*)poid_par_priv->information_buf ))); ++ if(!rtw_setfwra_cmd(Adapter,*((unsigned char*)poid_par_priv->information_buf ))) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + } -+ ++ + } + else{ -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ } ++ status = uint_NOT_ACCEPTED; ++ } + _irqlevel_changed_(&oldirql,RAISE); -+ _func_exit_; ++ +#endif + return status; +} +//----------------------------------------------------------------------------- -+NDIS_STATUS oid_rt_get_signal_quality_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_signal_quality_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + //DEBUG_ERR(("<**********************oid_rt_get_signal_quality_hdl \n")); + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + +#if 0 + if(pMgntInfo->mAssoc || pMgntInfo->mIbss) @@ -24679,74 +13074,74 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 + +//------------------------------------------------------------------------------ + -+NDIS_STATUS oid_rt_get_small_packet_crc_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_small_packet_crc_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } -+ -+ if(poid_par_priv->information_buf_len >= sizeof(ULONG) ) -+ { -+ *(ULONG *)poid_par_priv->information_buf = padapter->recvpriv.rx_smallpacket_crcerr; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ } ++ ++ if(poid_par_priv->information_buf_len >= sizeof(u32) ) ++ { ++ *(u32 *)poid_par_priv->information_buf = padapter->recvpriv.rx_smallpacket_crcerr; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + } + else + { -+ status = NDIS_STATUS_INVALID_LENGTH; ++ status = uint_INVALID_LENGTH; + } + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_middle_packet_crc_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_middle_packet_crc_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + -+ if(poid_par_priv->information_buf_len >= sizeof(ULONG) ) -+ { -+ *(ULONG *)poid_par_priv->information_buf = padapter->recvpriv.rx_middlepacket_crcerr; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ if(poid_par_priv->information_buf_len >= sizeof(u32) ) ++ { ++ *(u32 *)poid_par_priv->information_buf = padapter->recvpriv.rx_middlepacket_crcerr; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + } + else + { -+ status = NDIS_STATUS_INVALID_LENGTH; ++ status = uint_INVALID_LENGTH; + } + + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_large_packet_crc_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_large_packet_crc_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + -+ if(poid_par_priv->information_buf_len >= sizeof(ULONG) ) -+ { -+ *(ULONG *)poid_par_priv->information_buf = padapter->recvpriv.rx_largepacket_crcerr; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ if(poid_par_priv->information_buf_len >= sizeof(u32) ) ++ { ++ *(u32 *)poid_par_priv->information_buf = padapter->recvpriv.rx_largepacket_crcerr; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + } + else + { -+ status = NDIS_STATUS_INVALID_LENGTH; ++ status = uint_INVALID_LENGTH; + } + + @@ -24754,92 +13149,92 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 +} + +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_tx_retry_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_tx_retry_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} -+NDIS_STATUS oid_rt_get_rx_retry_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_rx_retry_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_rx_total_packet_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_rx_total_packet_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } -+ if(poid_par_priv->information_buf_len >= sizeof(ULONG) ) -+ { ++ } ++ if(poid_par_priv->information_buf_len >= sizeof(u32) ) ++ { + *(u64 *)poid_par_priv->information_buf = padapter->recvpriv.rx_pkts + padapter->recvpriv.rx_drop; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; ++ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + } + else + { -+ status = NDIS_STATUS_INVALID_LENGTH; ++ status = uint_INVALID_LENGTH; + } + + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_tx_beacon_ok_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_tx_beacon_ok_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} -+NDIS_STATUS oid_rt_get_tx_beacon_err_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_tx_beacon_err_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_rx_icv_err_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_rx_icv_err_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } + if(poid_par_priv->information_buf_len>= sizeof(u32)) @@ -24850,191 +13245,193 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 + } + else + { -+ status = NDIS_STATUS_INVALID_LENGTH ; ++ status = uint_INVALID_LENGTH ; + } -+ ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_set_encryption_algorithm_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_set_encryption_algorithm_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != SET_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_preamble_mode_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_preamble_mode_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ ULONG preamblemode = 0 ; -+ ++ u32 preamblemode = 0 ; ++ + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } -+ if(poid_par_priv->information_buf_len>= sizeof(ULONG)) -+ { ++ } ++ if(poid_par_priv->information_buf_len>= sizeof(u32)) ++ { + if(padapter->registrypriv.preamble == PREAMBLE_LONG) + preamblemode = 0; + else if (padapter->registrypriv.preamble == PREAMBLE_AUTO) + preamblemode = 1; + else if (padapter->registrypriv.preamble == PREAMBLE_SHORT) + preamblemode = 2; -+ -+ -+ *(ULONG *)poid_par_priv->information_buf = preamblemode ; ++ ++ ++ *(u32 *)poid_par_priv->information_buf = preamblemode ; + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + } + else + { -+ status = NDIS_STATUS_INVALID_LENGTH ; ++ status = uint_INVALID_LENGTH ; + } + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_ap_ip_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_ap_ip_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} + -+NDIS_STATUS oid_rt_get_channelplan_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_channelplan_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); ++ struct eeprom_priv* peeprompriv = &padapter->eeprompriv; + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ *(u16 *)poid_par_priv->information_buf = padapter->mlmepriv.ChannelPlan ; ++ *(u16 *)poid_par_priv->information_buf = peeprompriv->channel_plan ; + + return status; +} -+NDIS_STATUS oid_rt_set_channelplan_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_set_channelplan_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ ++ struct eeprom_priv* peeprompriv = &padapter->eeprompriv; ++ + if(poid_par_priv->type_of_oid != SET_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } -+ -+ padapter->mlmepriv.ChannelPlan = *(u16 *)poid_par_priv->information_buf ; ++ } ++ ++ peeprompriv->channel_plan = *(u16 *)poid_par_priv->information_buf ; + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_set_preamble_mode_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_set_preamble_mode_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ ULONG preamblemode = 0; ++ u32 preamblemode = 0; + if(poid_par_priv->type_of_oid != SET_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } -+ -+ if(poid_par_priv->information_buf_len>= sizeof(ULONG)) -+ { -+ preamblemode = *(ULONG *)poid_par_priv->information_buf ; ++ ++ if(poid_par_priv->information_buf_len>= sizeof(u32)) ++ { ++ preamblemode = *(u32 *)poid_par_priv->information_buf ; + if( preamblemode == 0) + padapter->registrypriv.preamble = PREAMBLE_LONG; + else if (preamblemode==1 ) + padapter->registrypriv.preamble = PREAMBLE_AUTO; + else if ( preamblemode==2 ) -+ padapter->registrypriv.preamble = PREAMBLE_SHORT; -+ -+ *(ULONG *)poid_par_priv->information_buf = preamblemode ; ++ padapter->registrypriv.preamble = PREAMBLE_SHORT; ++ ++ *(u32 *)poid_par_priv->information_buf = preamblemode ; + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + } + else + { -+ status = NDIS_STATUS_INVALID_LENGTH ; -+ } ++ status = uint_INVALID_LENGTH ; ++ } + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_set_bcn_intvl_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_set_bcn_intvl_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != SET_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } + + return status; +} -+NDIS_STATUS oid_rt_dedicate_probe_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_dedicate_probe_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_total_tx_bytes_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_total_tx_bytes_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } -+ if(poid_par_priv->information_buf_len>= sizeof(ULONG)) -+ { ++ } ++ if(poid_par_priv->information_buf_len>= sizeof(u32)) ++ { + *(u64 *)poid_par_priv->information_buf = padapter->xmitpriv.tx_bytes; + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + } + else + { -+ status = NDIS_STATUS_INVALID_LENGTH ; ++ status = uint_INVALID_LENGTH ; + } -+ ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_total_rx_bytes_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_total_rx_bytes_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } -+ if(poid_par_priv->information_buf_len>= sizeof(ULONG)) ++ if(poid_par_priv->information_buf_len>= sizeof(u32)) + { + //_rtw_memcpy(*(uint *)poid_par_priv->information_buf,padapter->recvpriv.rx_icv_err,sizeof(u32)); + *(u64 *)poid_par_priv->information_buf = padapter->recvpriv.rx_bytes; @@ -25042,339 +13439,339 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 + } + else + { -+ status = NDIS_STATUS_INVALID_LENGTH ; ++ status = uint_INVALID_LENGTH ; + } + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_current_tx_power_level_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_current_tx_power_level_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + return status; +} -+NDIS_STATUS oid_rt_get_enc_key_mismatch_count_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_enc_key_mismatch_count_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} -+NDIS_STATUS oid_rt_get_enc_key_match_count_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_enc_key_match_count_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} -+NDIS_STATUS oid_rt_get_channel_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_channel_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + NDIS_802_11_CONFIGURATION *pnic_Config; + -+ ULONG channelnum; ++ u32 channelnum; ++ + -+ _func_enter_; + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + -+ if ( (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) ++ if ( (check_fwstate(pmlmepriv, _FW_LINKED) == true) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) + pnic_Config = &pmlmepriv->cur_network.network.Configuration; + else + pnic_Config = &padapter->registrypriv.dev_network.Configuration; + + channelnum = pnic_Config->DSConfig; -+ *(ULONG *)poid_par_priv->information_buf = channelnum; -+ ++ *(u32 *)poid_par_priv->information_buf = channelnum; ++ + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + -+ _func_exit_; ++ + + + + return status; +} -+NDIS_STATUS oid_rt_get_hardware_radio_off_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_hardware_radio_off_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} -+NDIS_STATUS oid_rt_get_key_mismatch_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_key_mismatch_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} -+NDIS_STATUS oid_rt_supported_wireless_mode_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_supported_wireless_mode_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ ULONG ulInfo = 0 ; -+ //DEBUG_ERR(("<**********************oid_rt_supported_wireless_mode_hdl \n")); ++ u32 ulInfo = 0 ; ++ //DEBUG_ERR(("<**********************oid_rt_supported_wireless_mode_hdl \n")); + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } -+ if(poid_par_priv->information_buf_len >= sizeof(ULONG)){ ++ } ++ if(poid_par_priv->information_buf_len >= sizeof(u32)){ + ulInfo |= 0x0100; //WIRELESS_MODE_B + ulInfo |= 0x0200; //WIRELESS_MODE_G + ulInfo |= 0x0400; //WIRELESS_MODE_A + -+ *(ULONG *) poid_par_priv->information_buf = ulInfo; -+ //DEBUG_ERR(("<===oid_rt_supported_wireless_mode %x\n",ulInfo)); ++ *(u32 *) poid_par_priv->information_buf = ulInfo; ++ //DEBUG_ERR(("<===oid_rt_supported_wireless_mode %x\n",ulInfo)); + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + } + else{ -+ status = NDIS_STATUS_INVALID_LENGTH; -+ } ++ status = uint_INVALID_LENGTH; ++ } + + return status; +} -+NDIS_STATUS oid_rt_get_channel_list_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_channel_list_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} -+NDIS_STATUS oid_rt_get_scan_in_progress_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_scan_in_progress_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} + + -+NDIS_STATUS oid_rt_forced_data_rate_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_forced_data_rate_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + return status; +} -+NDIS_STATUS oid_rt_wireless_mode_for_scan_list_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_wireless_mode_for_scan_list_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + return status; +} -+NDIS_STATUS oid_rt_get_bss_wireless_mode_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_bss_wireless_mode_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} + -+NDIS_STATUS oid_rt_scan_with_magic_packet_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_scan_with_magic_packet_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + return status; +} -+//************** oid_rtl_seg_01_01 section end ************** ++//************** oid_rtl_seg_01_01 section end ************** + -+//************** oid_rtl_seg_01_03 section start ************** -+NDIS_STATUS oid_rt_ap_get_associated_station_list_hdl(struct oid_par_priv* poid_par_priv) ++//************** oid_rtl_seg_01_03 section start ************** ++uint oid_rt_ap_get_associated_station_list_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} -+NDIS_STATUS oid_rt_ap_switch_into_ap_mode_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_ap_switch_into_ap_mode_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + return status; +} -+NDIS_STATUS oid_rt_ap_supported_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_ap_supported_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + return status; +} -+NDIS_STATUS oid_rt_ap_set_passphrase_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_ap_set_passphrase_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != SET_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + return status; +} + -+//************** oid_rtl_seg_01_03 section end ************** ++//************** oid_rtl_seg_01_03 section end ************** + +//**************** oid_rtl_seg_01_11 section start **************** -+NDIS_STATUS oid_rt_pro_rf_write_registry_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_pro_rf_write_registry_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + _irqL oldirql; -+ _func_enter_; ++ + //DEBUG_ERR(("<**********************oid_rt_pro_rf_write_registry_hdl \n")); + if(poid_par_priv->type_of_oid != SET_OID) //QUERY_OID + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } -+ ++ + _irqlevel_changed_(&oldirql,LOWER); + if(poid_par_priv->information_buf_len== (sizeof(unsigned long)*3)) -+ { ++ { + //RegOffsetValue - The offset of RF register to write. + //RegDataWidth - The data width of RF register to write. -+ //RegDataValue - The value to write. ++ //RegDataValue - The value to write. + //RegOffsetValue = *((unsigned long*)InformationBuffer); -+ //RegDataWidth = *((unsigned long*)InformationBuffer+1); -+ //RegDataValue = *((unsigned long*)InformationBuffer+2); -+ if(!rtw_setrfreg_cmd(Adapter, -+ *(unsigned char*)poid_par_priv->information_buf, ++ //RegDataWidth = *((unsigned long*)InformationBuffer+1); ++ //RegDataValue = *((unsigned long*)InformationBuffer+2); ++ if(!rtw_setrfreg_cmd(Adapter, ++ *(unsigned char*)poid_par_priv->information_buf, + (unsigned long)(*((unsigned long*)poid_par_priv->information_buf+2)))) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + } -+ ++ + } + else{ -+ status = NDIS_STATUS_INVALID_LENGTH; -+ } ++ status = uint_INVALID_LENGTH; ++ } + _irqlevel_changed_(&oldirql,RAISE); -+ _func_exit_; ++ + + return status; +} + +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_rf_read_registry_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_pro_rf_read_registry_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; +#if 0 + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + _irqL oldirql; -+ _func_enter_; ++ + + //DEBUG_ERR(("<**********************oid_rt_pro_rf_read_registry_hdl \n")); + if(poid_par_priv->type_of_oid != SET_OID) //QUERY_OID + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } -+ ++ } ++ + _irqlevel_changed_(&oldirql,LOWER); + if(poid_par_priv->information_buf_len== (sizeof(unsigned long)*3)) + { -+ if(Adapter->mppriv.act_in_progress == _TRUE) ++ if(Adapter->mppriv.act_in_progress == true) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + } + else + { + //init workparam -+ Adapter->mppriv.act_in_progress = _TRUE; -+ Adapter->mppriv.workparam.bcompleted= _FALSE; ++ Adapter->mppriv.act_in_progress = true; ++ Adapter->mppriv.workparam.bcompleted= false; + Adapter->mppriv.workparam.act_type = MPT_READ_RF; -+ Adapter->mppriv.workparam.io_offset = *(unsigned long*)poid_par_priv->information_buf; ++ Adapter->mppriv.workparam.io_offset = *(unsigned long*)poid_par_priv->information_buf; + Adapter->mppriv.workparam.io_value = 0xcccccccc; -+ ++ + //RegOffsetValue - The offset of RF register to read. + //RegDataWidth - The data width of RF register to read. -+ //RegDataValue - The value to read. ++ //RegDataValue - The value to read. + //RegOffsetValue = *((unsigned long*)InformationBuffer); -+ //RegDataWidth = *((unsigned long*)InformationBuffer+1); -+ //RegDataValue = *((unsigned long*)InformationBuffer+2); -+ if(!rtw_getrfreg_cmd(Adapter, -+ *(unsigned char*)poid_par_priv->information_buf, ++ //RegDataWidth = *((unsigned long*)InformationBuffer+1); ++ //RegDataValue = *((unsigned long*)InformationBuffer+2); ++ if(!rtw_getrfreg_cmd(Adapter, ++ *(unsigned char*)poid_par_priv->information_buf, + (unsigned char*)&Adapter->mppriv.workparam.io_value)) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + } + } -+ -+ ++ ++ + } + else { -+ status = NDIS_STATUS_INVALID_LENGTH; ++ status = uint_INVALID_LENGTH; + } + _irqlevel_changed_(&oldirql,RAISE); -+ _func_exit_; ++ +#endif + return status; +} + -+//**************** oid_rtl_seg_01_11 section end**************** ++//**************** oid_rtl_seg_01_11 section end**************** + + -+//************** oid_rtl_seg_03_00 section start ************** ++//************** oid_rtl_seg_03_00 section start ************** +enum _CONNECT_STATE_{ + CHECKINGSTATUS, + ASSOCIATED, @@ -25382,36 +13779,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 + NOTASSOCIATED +}; + -+NDIS_STATUS oid_rt_get_connect_state_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_get_connect_state_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + -+ ULONG ulInfo; -+ ++ u32 ulInfo; ++ + if(poid_par_priv->type_of_oid != QUERY_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; -+ } ++ } + + // nStatus==0 CheckingStatus + // nStatus==1 Associated + // nStatus==2 AdHocMode + // nStatus==3 NotAssociated -+ -+ if(check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) ++ ++ if(check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) + ulInfo = CHECKINGSTATUS; -+ else if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ else if(check_fwstate(pmlmepriv, _FW_LINKED) == true) + ulInfo = ASSOCIATED; -+ else if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)== _TRUE) ++ else if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)== true) + ulInfo = ADHOCMODE; + else + ulInfo = NOTASSOCIATED ; + -+ *(ULONG *)poid_par_priv->information_buf = ulInfo; ++ *(u32 *)poid_par_priv->information_buf = ulInfo; + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + +#if 0 @@ -25425,36 +13822,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux/3rdparty/rtl8 + ulInfo = 0; + else + ulInfo = 3; -+ ulInfoLen = sizeof(ULONG); ++ ulInfoLen = sizeof(u32); + RT_TRACE(COMP_OID_QUERY, DBG_LOUD, ("<=== Query OID_RT_GET_CONNECT_STATE: %d\n", ulInfo)); +#endif + + return status; +} + -+NDIS_STATUS oid_rt_set_default_key_id_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_set_default_key_id_hdl(struct oid_par_priv* poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + + if(poid_par_priv->type_of_oid != SET_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } -+ ++ + return status; +} -+//************** oid_rtl_seg_03_00 section end ************** -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8812au/core/rtw_ioctl_set.c ---- linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_ioctl_set.c 2017-06-07 23:07:21.000686574 +0300 -@@ -0,0 +1,1483 @@ ++//************** oid_rtl_seg_03_00 section end ************** +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ioctl_set.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_ioctl_set.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ioctl_set.c 2018-02-06 17:42:30.694966927 +0200 +@@ -0,0 +1,1292 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -25464,16 +13860,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_IOCTL_SET_C_ + +#include -+#include + + +extern void indicate_wx_scan_complete_event(_adapter *padapter); @@ -25482,51 +13872,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 +( \ + ( (addr[0] == 0xff) && (addr[1] == 0xff) && \ + (addr[2] == 0xff) && (addr[3] == 0xff) && \ -+ (addr[4] == 0xff) && (addr[5] == 0xff) ) ? _TRUE : _FALSE \ ++ (addr[4] == 0xff) && (addr[5] == 0xff) ) ? true : false \ +) + -+u8 rtw_validate_bssid(u8 *bssid) -+{ -+ u8 ret = _TRUE; -+ -+ if (is_zero_mac_addr(bssid) -+ || is_broadcast_mac_addr(bssid) -+ || is_multicast_mac_addr(bssid) -+ ) { -+ ret = _FALSE; -+ } -+ -+ return ret; -+} -+ +u8 rtw_validate_ssid(NDIS_802_11_SSID *ssid) +{ + u8 i; -+ u8 ret=_TRUE; ++ u8 ret=true; ++ + -+_func_enter_; + + if (ssid->SsidLength > 32) { + RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid length >32\n")); -+ ret= _FALSE; ++ ret= false; + goto exit; + } + -+#ifdef CONFIG_VALIDATE_SSID + for(i = 0; i < ssid->SsidLength; i++) + { + //wifi, printable ascii code must be supported + if(!( (ssid->Ssid[i] >= 0x20) && (ssid->Ssid[i] <= 0x7e) )){ + RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid has nonprintabl ascii\n")); -+ ret= _FALSE; ++ ret= false; + break; + } + } -+#endif /* CONFIG_VALIDATE_SSID */ + -+exit: ++exit: ++ + -+_func_exit_; + + return ret; +} @@ -25541,7 +13915,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + _queue *queue = &(pmlmepriv->scanned_queue); + u8 ret=_SUCCESS; + -+_func_enter_; ++ + + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + phead = get_list_head(queue); @@ -25550,235 +13924,140 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("\n rtw_do_join: phead = %p; plist = %p \n\n\n", phead, plist)); + + pmlmepriv->cur_network.join_res = -2; -+ ++ + set_fwstate(pmlmepriv, _FW_UNDER_LINKING); + + pmlmepriv->pscanned = plist; + -+ pmlmepriv->to_join = _TRUE; ++ pmlmepriv->to_join = true; + -+ if(_rtw_queue_empty(queue)== _TRUE) -+ { ++ if(_rtw_queue_empty(queue)== true) ++ { + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ ++ + //when set_ssid/set_bssid for rtw_do_join(), but scanning queue is empty -+ //we try to issue sitesurvey firstly -+ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic ==_FALSE -+ || rtw_to_roam(padapter) > 0 ++ //we try to issue sitesurvey firstly ++ ++ if (pmlmepriv->LinkDetectInfo.bBusyTraffic ==false ++ || rtw_to_roaming(padapter) > 0 + ) + { + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_do_join(): site survey if scanned_queue is empty\n.")); + // submit site_survey_cmd + if(_SUCCESS!=(ret=rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0)) ) { -+ pmlmepriv->to_join = _FALSE; ++ pmlmepriv->to_join = false; + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_do_join(): site survey return error\n.")); + } + } + else + { -+ pmlmepriv->to_join = _FALSE; ++ pmlmepriv->to_join = false; + ret = _FAIL; + } -+ ++ + goto exit; -+ } -+ else ++ } ++ else + { + int select_ret; + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + if((select_ret=rtw_select_and_join_from_scanned_queue(pmlmepriv))==_SUCCESS) + { -+ pmlmepriv->to_join = _FALSE; ++ pmlmepriv->to_join = false; + _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); + } -+ else ++ else + { -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==_TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==true) + { + // submit createbss_cmd to change to a ADHOC_MASTER + -+ //pmlmepriv->lock has been acquired by caller... ++ //pmlmepriv->lock has been acquired by caller... + WLAN_BSSID_EX *pdev_network = &(padapter->registrypriv.dev_network); + + pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE; -+ ++ + pibss = padapter->registrypriv.dev_network.MacAddress; + + _rtw_memset(&pdev_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); + _rtw_memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); -+ ++ + rtw_update_registrypriv_dev_network(padapter); + + rtw_generate_random_ibss(pibss); -+ -+ if (rtw_create_ibss_cmd(padapter, 0) != _SUCCESS) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("***Error=>do_goin: rtw_create_ibss_cmd status FAIL***\n")); -+ ret = _FALSE; ++ ++ if(rtw_createbss_cmd(padapter)!=_SUCCESS) ++ { ++ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("***Error=>do_goin: rtw_createbss_cmd status FAIL*** \n ")); ++ ret = false; + goto exit; + } + -+ pmlmepriv->to_join = _FALSE; ++ pmlmepriv->to_join = false; + -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("***Error=> rtw_select_and_join_from_scanned_queue FAIL under STA_Mode*** \n ")); ++ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("***Error=> rtw_select_and_join_from_scanned_queue FAIL under STA_Mode*** \n ")); + -+ } ++ } + else -+ { -+ // can't associate ; reset under-linking ++ { ++ // can't associate ; reset under-linking + _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); + -+#if 0 -+ if((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)) ++#if 0 ++ if((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true)) + { + if(_rtw_memcmp(pmlmepriv->cur_network.network.Ssid.Ssid, pmlmepriv->assoc_ssid.Ssid, pmlmepriv->assoc_ssid.SsidLength)) -+ { ++ { + // for funk to do roaming + // funk will reconnect, but funk will not sitesurvey before reconnect + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("for funk to do roaming")); -+ if(pmlmepriv->sitesurveyctrl.traffic_busy==_FALSE) ++ if(pmlmepriv->sitesurveyctrl.traffic_busy==false) + rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); + } -+ -+ } ++ ++ } +#endif + + //when set_ssid/set_bssid for rtw_do_join(), but there are no desired bss in scanning queue -+ //we try to issue sitesurvey firstly -+ if(pmlmepriv->LinkDetectInfo.bBusyTraffic==_FALSE -+ || rtw_to_roam(padapter) > 0 ++ //we try to issue sitesurvey firstly ++ if(pmlmepriv->LinkDetectInfo.bBusyTraffic==false ++ || rtw_to_roaming(padapter) > 0 + ) + { + //DBG_871X("rtw_do_join() when no desired bss in scanning queue \n"); + if( _SUCCESS!=(ret=rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0)) ){ -+ pmlmepriv->to_join = _FALSE; ++ pmlmepriv->to_join = false; + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("do_join(): site survey return error\n.")); + } -+ } ++ } + else + { + ret = _FAIL; -+ pmlmepriv->to_join = _FALSE; ++ pmlmepriv->to_join = false; + } + } + + } + + } -+ ++ +exit: -+ -+_func_exit_; + -+ return ret; -+} + -+#ifdef PLATFORM_WINDOWS -+u8 rtw_pnp_set_power_wakeup(_adapter* padapter) -+{ -+ u8 res=_SUCCESS; -+ -+_func_enter_; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("==>rtw_pnp_set_power_wakeup!!!\n")); -+ -+ res = rtw_setstandby_cmd(padapter, 0); -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("<==rtw_pnp_set_power_wakeup!!!\n")); -+ -+_func_exit_; -+ -+ return res; -+} -+ -+u8 rtw_pnp_set_power_sleep(_adapter* padapter) -+{ -+ u8 res=_SUCCESS; -+ -+_func_enter_; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("==>rtw_pnp_set_power_sleep!!!\n")); -+ //DbgPrint("+rtw_pnp_set_power_sleep\n"); -+ -+ res = rtw_setstandby_cmd(padapter, 1); -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("<==rtw_pnp_set_power_sleep!!!\n")); -+ -+_func_exit_; -+ -+ return res; -+} -+ -+u8 rtw_set_802_11_reload_defaults(_adapter * padapter, NDIS_802_11_RELOAD_DEFAULTS reloadDefaults) -+{ -+_func_enter_; -+ -+ switch( reloadDefaults) -+ { -+ case Ndis802_11ReloadWEPKeys: -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("SetInfo OID_802_11_RELOAD_DEFAULTS : Ndis802_11ReloadWEPKeys\n")); -+ break; -+ } -+ -+ // SecClearAllKeys(Adapter); -+ // 8711 CAM was not for En/Decrypt only -+ // so, we can't clear all keys. -+ // should we disable WPAcfg (ox0088) bit 1-2, instead of clear all CAM -+ -+ //TO DO... -+ -+_func_exit_; -+ -+ return _TRUE; -+} -+ -+u8 set_802_11_test(_adapter* padapter, NDIS_802_11_TEST *test) -+{ -+ u8 ret=_TRUE; -+ -+_func_enter_; -+ -+ switch(test->Type) -+ { -+ case 1: -+ NdisMIndicateStatus(padapter->hndis_adapter, NDIS_STATUS_MEDIA_SPECIFIC_INDICATION, (PVOID)&test->AuthenticationEvent, test->Length - 8); -+ NdisMIndicateStatusComplete(padapter->hndis_adapter); -+ break; -+ -+ case 2: -+ NdisMIndicateStatus(padapter->hndis_adapter, NDIS_STATUS_MEDIA_SPECIFIC_INDICATION, (PVOID)&test->RssiTrigger, sizeof(NDIS_802_11_RSSI)); -+ NdisMIndicateStatusComplete(padapter->hndis_adapter); -+ break; -+ -+ default: -+ ret=_FALSE; -+ break; -+ } -+ -+_func_exit_; -+ -+ return ret; -+} -+ -+u8 rtw_set_802_11_pmkid(_adapter* padapter, NDIS_802_11_PMKID *pmkid) -+{ -+ u8 ret=_SUCCESS; + + return ret; +} + -+#endif -+ +u8 rtw_set_802_11_bssid(_adapter* padapter, u8 *bssid) -+{ -+ _irqL irqL; ++{ ++ _irqL irqL; + u8 status=_SUCCESS; + + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+_func_enter_; -+ ++ ++ ++ + DBG_871X_LEVEL(_drv_always_, "set bssid:%pM\n", bssid); + + if ((bssid[0]==0x00 && bssid[1]==0x00 && bssid[2]==0x00 && bssid[3]==0x00 && bssid[4]==0x00 &&bssid[5]==0x00) || @@ -25787,56 +14066,54 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + status = _FAIL; + goto exit; + } -+ ++ + _enter_critical_bh(&pmlmepriv->lock, &irqL); + + + DBG_871X("Set BSSID under fw_state=0x%08x\n", get_fwstate(pmlmepriv)); -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { + goto handle_tkip_countermeasure; -+ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { ++ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) { + goto release_mlme_lock; + } + -+ if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == _TRUE) ++ if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) + { + RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_bssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n")); + -+ if (_rtw_memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid, ETH_ALEN) == _TRUE) -+ { -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _FALSE) ++ if (_rtw_memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid, ETH_ALEN) == true) ++ { ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == false) + goto release_mlme_lock;//it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. + } else { + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("Set BSSID not the same bssid\n")); + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("set_bssid="MAC_FMT"\n", MAC_ARG(bssid) )); + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("cur_bssid="MAC_FMT"\n", MAC_ARG(pmlmepriv->cur_network.network.MacAddress) )); + -+ rtw_disassoc_cmd(padapter, 0, _TRUE); ++ rtw_disassoc_cmd(padapter, 0, true); + -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) + rtw_indicate_disconnect(padapter); + + rtw_free_assoc_resources(padapter, 1); + -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) { + _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); + set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ } ++ } + } + } + +handle_tkip_countermeasure: -+ if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { -+ status = _FAIL; ++ //should we add something here...? ++ if((status=rtw_handle_tkip_countermeasure(padapter)) == _FAIL) + goto release_mlme_lock; -+ } + -+ _rtw_memset(&pmlmepriv->assoc_ssid, 0, sizeof(NDIS_802_11_SSID)); + _rtw_memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN); -+ pmlmepriv->assoc_by_bssid=_TRUE; ++ pmlmepriv->assoc_by_bssid=true; + -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { -+ pmlmepriv->to_join = _TRUE; ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { ++ pmlmepriv->to_join = true; + } + else { + status = rtw_do_join(padapter); @@ -25844,71 +14121,71 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + +release_mlme_lock: + _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ ++ +exit: + RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, + ("rtw_set_802_11_bssid: status=%d\n", status)); -+ -+_func_exit_; ++ ++ + + return status; +} + +u8 rtw_set_802_11_ssid(_adapter* padapter, NDIS_802_11_SSID *ssid) -+{ ++{ + _irqL irqL; + u8 status = _SUCCESS; + u32 cur_time = 0; + + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct wlan_network *pnetwork = &pmlmepriv->cur_network; -+ -+_func_enter_; -+ -+ DBG_871X_LEVEL(_drv_always_, "set ssid [%s] fw_state=0x%08x\n", -+ ssid->Ssid, get_fwstate(pmlmepriv)); + -+ if (!rtw_is_hw_init_completed(padapter)) { ++ ++ ++ DBG_871X_LEVEL(_drv_always_, "set ssid [%s] fw_state=0x%08x\n", ++ ssid->Ssid, get_fwstate(pmlmepriv)); ++ ++ if(padapter->hw_init_completed==false){ + RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, -+ ("set_ssid: hw_init_completed==_FALSE=>exit!!!\n")); ++ ("set_ssid: hw_init_completed==false=>exit!!!\n")); + status = _FAIL; + goto exit; + } -+ ++ + _enter_critical_bh(&pmlmepriv->lock, &irqL); + + DBG_871X("Set SSID under fw_state=0x%08x\n", get_fwstate(pmlmepriv)); -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { + goto handle_tkip_countermeasure; -+ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { ++ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) { + goto release_mlme_lock; + } + -+ if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == _TRUE) ++ if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) + { + RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, + ("set_ssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n")); + + if ((pmlmepriv->assoc_ssid.SsidLength == ssid->SsidLength) && -+ (_rtw_memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid, ssid->SsidLength) == _TRUE)) -+ { -+ if((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _FALSE)) ++ (_rtw_memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid, ssid->SsidLength) == true)) ++ { ++ if((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == false)) + { + RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, + ("Set SSID is the same ssid, fw_state=0x%08x\n", + get_fwstate(pmlmepriv))); + -+ if(rtw_is_same_ibss(padapter, pnetwork) == _FALSE) -+ { ++ if(rtw_is_same_ibss(padapter, pnetwork) == false) ++ { + //if in WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE, create bss or rejoin again -+ rtw_disassoc_cmd(padapter, 0, _TRUE); ++ rtw_disassoc_cmd(padapter, 0, true); + -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) + rtw_indicate_disconnect(padapter); -+ ++ + rtw_free_assoc_resources(padapter, 1); + -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) { ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) { + _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); + set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); + } @@ -25930,36 +14207,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("set_ssid=[%s] len=0x%x\n", ssid->Ssid, (unsigned int)ssid->SsidLength)); + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("assoc_ssid=[%s] len=0x%x\n", pmlmepriv->assoc_ssid.Ssid, (unsigned int)pmlmepriv->assoc_ssid.SsidLength)); + -+ rtw_disassoc_cmd(padapter, 0, _TRUE); ++ rtw_disassoc_cmd(padapter, 0, true); + -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) + rtw_indicate_disconnect(padapter); -+ ++ + rtw_free_assoc_resources(padapter, 1); + -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) { ++ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) { + _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); + set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); + } -+ } ++ } + } + +handle_tkip_countermeasure: -+ if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { -+ status = _FAIL; -+ goto release_mlme_lock; -+ } + -+ if (rtw_validate_ssid(ssid) == _FALSE) { ++ if((status=rtw_handle_tkip_countermeasure(padapter)) == _FAIL) ++ goto release_mlme_lock; ++ ++ #ifdef CONFIG_VALIDATE_SSID ++ if (rtw_validate_ssid(ssid) == false) { + status = _FAIL; + goto release_mlme_lock; + } ++ #endif + + _rtw_memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(NDIS_802_11_SSID)); -+ pmlmepriv->assoc_by_bssid=_FALSE; ++ pmlmepriv->assoc_by_bssid=false; + -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { -+ pmlmepriv->to_join = _TRUE; ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { ++ pmlmepriv->to_join = true; + } + else { + status = rtw_do_join(padapter); @@ -25971,178 +14249,98 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 +exit: + RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, + ("-rtw_set_802_11_ssid: status=%d\n", status)); -+ -+_func_exit_; ++ ++ + + return status; -+ ++ +} + -+u8 rtw_set_802_11_connect(_adapter* padapter, u8 *bssid, NDIS_802_11_SSID *ssid) -+{ -+ _irqL irqL; -+ u8 status = _SUCCESS; -+ u32 cur_time = 0; -+ bool bssid_valid = _TRUE; -+ bool ssid_valid = _TRUE; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+_func_enter_; -+ -+ if (!ssid || rtw_validate_ssid(ssid) == _FALSE) -+ ssid_valid = _FALSE; -+ -+ if (!bssid || rtw_validate_bssid(bssid) == _FALSE) -+ bssid_valid = _FALSE; -+ -+ if (ssid_valid == _FALSE && bssid_valid == _FALSE) { -+ DBG_871X(FUNC_ADPT_FMT" ssid:%p, ssid_valid:%d, bssid:%p, bssid_valid:%d\n", -+ FUNC_ADPT_ARG(padapter), ssid, ssid_valid, bssid, bssid_valid); -+ status = _FAIL; -+ goto exit; -+ } -+ -+ if (!rtw_is_hw_init_completed(padapter)) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, -+ ("set_ssid: hw_init_completed==_FALSE=>exit!!!\n")); -+ status = _FAIL; -+ goto exit; -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" fw_state=0x%08x\n", -+ FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { -+ goto handle_tkip_countermeasure; -+ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { -+ goto release_mlme_lock; -+ } -+ -+handle_tkip_countermeasure: -+ if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { -+ status = _FAIL; -+ goto release_mlme_lock; -+ } -+ -+ if (ssid && ssid_valid) -+ _rtw_memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(NDIS_802_11_SSID)); -+ else -+ _rtw_memset(&pmlmepriv->assoc_ssid, 0, sizeof(NDIS_802_11_SSID)); -+ -+ if (bssid && bssid_valid) { -+ _rtw_memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN); -+ pmlmepriv->assoc_by_bssid = _TRUE; -+ } else { -+ pmlmepriv->assoc_by_bssid = _FALSE; -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { -+ pmlmepriv->to_join = _TRUE; -+ } -+ else { -+ status = rtw_do_join(padapter); -+ } -+ -+release_mlme_lock: -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+exit: -+ -+_func_exit_; -+ -+ return status; -+} -+ -+u8 rtw_set_802_11_infrastructure_mode(_adapter* padapter, ++u8 rtw_set_802_11_infrastructure_mode(_adapter* padapter, + NDIS_802_11_NETWORK_INFRASTRUCTURE networktype) +{ + _irqL irqL; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct wlan_network *cur_network = &pmlmepriv->cur_network; + NDIS_802_11_NETWORK_INFRASTRUCTURE* pold_state = &(cur_network->network.InfrastructureMode); -+ -+_func_enter_; ++ ++ + + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_notice_, + ("+rtw_set_802_11_infrastructure_mode: old=%d new=%d fw_state=0x%08x\n", + *pold_state, networktype, get_fwstate(pmlmepriv))); -+ ++ + if(*pold_state != networktype) + { ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,(" change mode!")); + //DBG_871X("change mode, old_mode=%d, new_mode=%d, fw_state=0x%x\n", *pold_state, networktype, get_fwstate(pmlmepriv)); + + if(*pold_state==Ndis802_11APMode) -+ { -+ //change to other mode from Ndis802_11APMode ++ { ++ //change to other mode from Ndis802_11APMode + cur_network->join_res = -1; -+ ++ +#ifdef CONFIG_NATIVEAP_MLME + stop_ap_mode(padapter); +#endif + } + -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if((check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) ||(*pold_state==Ndis802_11IBSS)) -+ rtw_disassoc_cmd(padapter, 0, _TRUE); ++ if((check_fwstate(pmlmepriv, _FW_LINKED)== true) ||(*pold_state==Ndis802_11IBSS)) ++ rtw_disassoc_cmd(padapter, 0, true); + -+ if((check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)== _TRUE) ) ++ if((check_fwstate(pmlmepriv, _FW_LINKED)== true) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)== true) ) + rtw_free_assoc_resources(padapter, 1); + + if((*pold_state == Ndis802_11Infrastructure) ||(*pold_state == Ndis802_11IBSS)) + { -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ { ++ if(check_fwstate(pmlmepriv, _FW_LINKED) == true) ++ { + rtw_indicate_disconnect(padapter); //will clr Linked_state; before this function, we must have chked whether issue dis-assoc_cmd or not + } + } -+ ++ + *pold_state = networktype; + + _clr_fwstate_(pmlmepriv, ~WIFI_NULL_STATE); -+ ++ + switch(networktype) + { + case Ndis802_11IBSS: + set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); + break; -+ ++ + case Ndis802_11Infrastructure: + set_fwstate(pmlmepriv, WIFI_STATION_STATE); + break; -+ ++ + case Ndis802_11APMode: + set_fwstate(pmlmepriv, WIFI_AP_STATE); +#ifdef CONFIG_NATIVEAP_MLME + start_ap_mode(padapter); + //rtw_indicate_connect(padapter); -+#endif -+ ++#endif ++ + break; + + case Ndis802_11AutoUnknown: + case Ndis802_11InfrastructureMax: + break; -+ case Ndis802_11Monitor: -+ set_fwstate(pmlmepriv, WIFI_MONITOR_STATE); -+ break; + } + + //SecClearAllKeys(adapter); -+ ++ + //RT_TRACE(COMP_OID_SET, DBG_LOUD, ("set_infrastructure: fw_state:%x after changing mode\n", + // get_fwstate(pmlmepriv) )); + + _exit_critical_bh(&pmlmepriv->lock, &irqL); + } + -+_func_exit_; + -+ return _TRUE; ++ ++ return true; +} + + @@ -26151,111 +14349,109 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + _irqL irqL; + struct mlme_priv * pmlmepriv = &padapter->mlmepriv; + -+_func_enter_; ++ + + _enter_critical_bh(&pmlmepriv->lock, &irqL); + -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) + { + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("MgntActrtw_set_802_11_disassociate: rtw_indicate_disconnect\n")); + -+ rtw_disassoc_cmd(padapter, 0, _TRUE); ++ rtw_disassoc_cmd(padapter, 0, true); + rtw_indicate_disconnect(padapter); -+ //modify for CONFIG_IEEE80211W, none 11w can use it -+ rtw_free_assoc_resources_cmd(padapter); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) -+ DBG_871X("%s(): rtw_pwr_wakeup fail !!!\n",__FUNCTION__); ++ rtw_free_assoc_resources(padapter, 1); ++ rtw_pwr_wakeup(padapter); + } + + _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+_func_exit_; + -+ return _TRUE; ++ ++ ++ return true; +} + +u8 rtw_set_802_11_bssid_list_scan(_adapter* padapter, NDIS_802_11_SSID *pssid, int ssid_max_num) -+{ ++{ + _irqL irqL; + struct mlme_priv *pmlmepriv= &padapter->mlmepriv; -+ u8 res=_TRUE; -+ -+_func_enter_; ++ u8 res=true; ++ ++ + + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("+rtw_set_802_11_bssid_list_scan(), fw_state=%x\n", get_fwstate(pmlmepriv))); + + if (padapter == NULL) { -+ res=_FALSE; ++ res=false; + goto exit; + } -+ if (!rtw_is_hw_init_completed(padapter)) { -+ res = _FALSE; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n===rtw_set_802_11_bssid_list_scan:hw_init_completed==_FALSE===\n")); ++ if (padapter->hw_init_completed==false){ ++ res = false; ++ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n===rtw_set_802_11_bssid_list_scan:hw_init_completed==false===\n")); + goto exit; + } -+ -+ if ((check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == _TRUE) || -+ (pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE)) ++ ++ if ((check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) || ++ (pmlmepriv->LinkDetectInfo.bBusyTraffic == true)) + { + // Scan or linking is in progress, do nothing. + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_set_802_11_bssid_list_scan fail since fw_state = %x\n", get_fwstate(pmlmepriv))); -+ res = _TRUE; ++ res = true; + -+ if(check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING))== _TRUE){ ++ if(check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING))== true){ + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n###_FW_UNDER_SURVEY|_FW_UNDER_LINKING\n\n")); + } else { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n###pmlmepriv->sitesurveyctrl.traffic_busy==_TRUE\n\n")); ++ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n###pmlmepriv->sitesurveyctrl.traffic_busy==true\n\n")); + } -+ } else { ++ } else { + if (rtw_is_scan_deny(padapter)) { + DBG_871X(FUNC_ADPT_FMT": scan deny\n", FUNC_ADPT_ARG(padapter)); + indicate_wx_scan_complete_event(padapter); + return _SUCCESS; + } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ + res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, NULL, 0); -+ ++ + _exit_critical_bh(&pmlmepriv->lock, &irqL); + } +exit: -+ -+_func_exit_; + -+ return res; ++ ++ ++ return res; +} + -+u8 rtw_set_802_11_authentication_mode(_adapter* padapter, NDIS_802_11_AUTHENTICATION_MODE authmode) ++u8 rtw_set_802_11_authentication_mode(_adapter* padapter, NDIS_802_11_AUTHENTICATION_MODE authmode) +{ + struct security_priv *psecuritypriv = &padapter->securitypriv; + int res; + u8 ret; -+ -+_func_enter_; ++ ++ + + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("set_802_11_auth.mode(): mode=%x\n", authmode)); + + psecuritypriv->ndisauthtype=authmode; -+ ++ + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_authentication_mode:psecuritypriv->ndisauthtype=%d", psecuritypriv->ndisauthtype)); -+ ++ + if(psecuritypriv->ndisauthtype>3) + psecuritypriv->dot11AuthAlgrthm=dot11AuthAlgrthm_8021X; -+ ++ +#ifdef CONFIG_WAPI_SUPPORT + if(psecuritypriv->ndisauthtype == 6) + psecuritypriv->dot11AuthAlgrthm=dot11AuthAlgrthm_WAPI; +#endif + + res=rtw_set_auth(padapter,psecuritypriv); -+ ++ + if(res==_SUCCESS) -+ ret=_TRUE; ++ ret=true; + else -+ ret=_FALSE; -+ -+_func_exit_; ++ ret=false; ++ ++ + + return ret; +} @@ -26268,19 +14464,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + struct security_priv* psecuritypriv=&(padapter->securitypriv); + u8 ret=_SUCCESS; + -+_func_enter_; + -+ bdefaultkey=(wep->KeyIndex & 0x40000000) > 0 ? _FALSE : _TRUE; //for ??? -+ btransmitkey= (wep->KeyIndex & 0x80000000) > 0 ? _TRUE : _FALSE; //for ??? ++ ++ bdefaultkey=(wep->KeyIndex & 0x40000000) > 0 ? false : true; //for ??? ++ btransmitkey= (wep->KeyIndex & 0x80000000) > 0 ? true : false; //for ??? + keyid=wep->KeyIndex & 0x3fffffff; + -+ if(keyid>=4) ++ if(keyid>4) + { + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("MgntActrtw_set_802_11_add_wep:keyid>4=>fail\n")); -+ ret=_FALSE; ++ ret=false; + goto exit; + } -+ ++ + switch(wep->KeyLength) + { + case 5: @@ -26296,7 +14492,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("MgntActrtw_set_802_11_add_wep:wep->KeyLength!=5 or 13\n")); + break; + } -+ ++ + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_wep:befor memcpy, wep->KeyLength=0x%x wep->KeyIndex=0x%x keyid =%x\n",wep->KeyLength,wep->KeyIndex,keyid)); + + _rtw_memcpy(&(psecuritypriv->dot11DefKey[keyid].skey[0]),&(wep->KeyMaterial),wep->KeyLength); @@ -26312,59 +14508,59 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + psecuritypriv->dot11DefKey[keyid].skey[9],psecuritypriv->dot11DefKey[keyid].skey[10],psecuritypriv->dot11DefKey[keyid].skey[11], + psecuritypriv->dot11DefKey[keyid].skey[12])); + -+ res=rtw_set_key(padapter,psecuritypriv, keyid, 1, _TRUE); -+ ++ res=rtw_set_key(padapter,psecuritypriv, keyid, 1); ++ + if(res==_FAIL) -+ ret= _FALSE; ++ ret= false; +exit: -+ -+_func_exit_; ++ ++ + + return ret; -+ ++ +} + +u8 rtw_set_802_11_remove_wep(_adapter* padapter, u32 keyindex){ -+ ++ + u8 ret=_SUCCESS; -+ -+_func_enter_; ++ ++ + + if (keyindex >= 0x80000000 || padapter == NULL){ -+ -+ ret=_FALSE; ++ ++ ret=false; + goto exit; + + } -+ else ++ else + { + int res; + struct security_priv* psecuritypriv=&(padapter->securitypriv); + if( keyindex < 4 ){ -+ ++ + _rtw_memset(&psecuritypriv->dot11DefKey[keyindex], 0, 16); -+ -+ res=rtw_set_key(padapter,psecuritypriv,keyindex, 0, _TRUE); -+ ++ ++ res=rtw_set_key(padapter,psecuritypriv,keyindex, 0); ++ + psecuritypriv->dot11DefKeylen[keyindex]=0; -+ ++ + if(res==_FAIL) + ret=_FAIL; -+ ++ + } + else -+ { ++ { + ret=_FAIL; + } -+ ++ + } -+ -+exit: -+ -+_func_exit_; ++ ++exit: ++ ++ + + return ret; -+ ++ +} + +u8 rtw_set_802_11_add_key(_adapter* padapter, NDIS_802_11_KEY *key){ @@ -26372,16 +14568,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + uint encryptionalgo; + u8 * pbssid; + struct sta_info *stainfo; -+ u8 bgroup = _FALSE; -+ u8 bgrouptkey = _FALSE;//can be remove later ++ u8 bgroup = false; ++ u8 bgrouptkey = false;//can be remove later + u8 ret=_SUCCESS; -+ -+_func_enter_; ++ ++ + + if (((key->KeyIndex & 0x80000000) == 0) && ((key->KeyIndex & 0x40000000) > 0)){ + -+ // It is invalid to clear bit 31 and set bit 30. If the miniport driver encounters this combination, -+ // it must fail the request and return NDIS_STATUS_INVALID_DATA. ++ // It is invalid to clear bit 31 and set bit 30. If the miniport driver encounters this combination, ++ // it must fail the request and return uint_INVALID_DATA. + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_key: ((key->KeyIndex & 0x80000000) == 0)[=%d] ",(int)(key->KeyIndex & 0x80000000) == 0)); + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_key:((key->KeyIndex & 0x40000000) > 0)[=%d]" , (int)(key->KeyIndex & 0x40000000) > 0)); + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_key: key->KeyIndex=%d \n" ,(int)key->KeyIndex)); @@ -26390,11 +14586,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + } + + if(key->KeyIndex & 0x40000000) -+ { ++ { + // Pairwise key + + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: +++++ Pairwise key +++++\n")); -+ ++ + pbssid=get_bssid(&padapter->mlmepriv); + stainfo=rtw_get_stainfo(&padapter->stapriv, pbssid); + @@ -26414,21 +14610,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + if((stainfo!=NULL)){ + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_set_802_11_add_key: (stainfo->dot118021XPrivacy ==%d)!\n", stainfo->dot118021XPrivacy)); + } -+ ++ + if(key->KeyIndex & 0x000000FF){ + // The key index is specified in the lower 8 bits by values of zero to 255. + // The key index should be set to zero for a Pairwise key, and the driver should fail with -+ // NDIS_STATUS_INVALID_DATA if the lower 8 bits is not zero ++ // uint_INVALID_DATA if the lower 8 bits is not zero + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,(" key->KeyIndex & 0x000000FF.\n")); + ret= _FAIL; + goto exit; + } + + // check BSSID -+ if (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == _TRUE){ ++ if (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == true){ + + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("MacAddr_isBcst(key->BSSID)\n")); -+ ret= _FALSE; ++ ret= false; + goto exit; + } + @@ -26445,21 +14641,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + if((encryptionalgo== _AES_)&& (key->KeyLength != 16)) { + // For our supplicant, EAPPkt9x.vxd, cannot differentiate TKIP and AES case. + if(key->KeyLength == 32) { -+ key->KeyLength = 16; ++ key->KeyLength = 16; + } else { + ret= _FAIL; + goto exit; + } + } + -+ /* Check key length for WEP. For NDTEST, 2005.01.27, by rcnjko. -> modify checking condition*/ -+ if (((encryptionalgo == _WEP40_) && (key->KeyLength != 5)) || ((encryptionalgo == _WEP104_) && (key->KeyLength != 13))) { ++ // Check key length for WEP. For NDTEST, 2005.01.27, by rcnjko. ++ if( (encryptionalgo== _WEP40_|| encryptionalgo== _WEP104_) && (key->KeyLength != 5 || key->KeyLength != 13)) { + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("WEP KeyLength:0x%x != 5 or 13\n", key->KeyLength)); + ret=_FAIL; + goto exit; + } + -+ bgroup = _FALSE; ++ bgroup = false; + + // Check the pairwise key. Added by Annie, 2005-07-06. + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n")); @@ -26468,10 +14664,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("key index: 0x%8x(0x%8x)\n", key->KeyIndex,(key->KeyIndex&0x3))); + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("key Length: %d\n", key->KeyLength)); + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n")); -+ ++ + } -+ else -+ { ++ else ++ { + // Group key - KeyIndex(BIT30==0) + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: +++++ Group key +++++\n")); + @@ -26496,20 +14692,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("Adapter->securitypriv.dot11PrivacyAlgrthm= %x key->KeyLength=%u \n", padapter->securitypriv.dot11PrivacyAlgrthm,key->KeyLength)); + break; + } -+ ++ + encryptionalgo=padapter->securitypriv.dot11PrivacyAlgrthm; -+ ++ + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,(" Adapter->securitypriv.dot11PrivacyAlgrthm=%x\n", padapter->securitypriv.dot11PrivacyAlgrthm)); -+ ++ + } -+ else ++ else + { + encryptionalgo=padapter->securitypriv.dot118021XGrpPrivacy; + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("( Adapter->securitypriv.dot11PrivacyAlgrthm=%x )encryptionalgo(%x)=padapter->securitypriv.dot118021XGrpPrivacy(%x)keylen=%d\n", padapter->securitypriv.dot11PrivacyAlgrthm,encryptionalgo,padapter->securitypriv.dot118021XGrpPrivacy,key->KeyLength)); + + } -+ -+ if((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE)==_TRUE) && (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == _FALSE)) { ++ ++ if((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE)==true) && (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == false)) { + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,(" IBSS but BSSID is not Broadcast Address.\n")); + ret= _FAIL; + goto exit; @@ -26523,7 +14719,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + goto exit; + + } else if(encryptionalgo== _AES_ && (key->KeyLength != 16 && key->KeyLength != 32) ) { -+ ++ + // Check key length for AES + // For NDTEST, we allow keylen=32 in this case. 2005.01.27, by rcnjko. + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("<=== SetInfo, OID_802_11_ADD_KEY: AES GTK KeyLength:%u != 16 or 32\n", key->KeyLength)); @@ -26533,20 +14729,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + + // Change the key length for EAPPkt9x.vxd. Added by Annie, 2005-11-03. + if((encryptionalgo== _AES_) && (key->KeyLength == 32) ) { -+ key->KeyLength = 16; ++ key->KeyLength = 16; + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("AES key length changed: %u\n", key->KeyLength) ); + } + + if(key->KeyIndex & 0x8000000) {//error ??? 0x8000_0000 -+ bgrouptkey = _TRUE; ++ bgrouptkey = true; + } + -+ if((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE)==_TRUE)&&(check_fwstate(&padapter->mlmepriv, _FW_LINKED)==_TRUE)) ++ if((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE)==true)&&(check_fwstate(&padapter->mlmepriv, _FW_LINKED)==true)) + { -+ bgrouptkey = _TRUE; ++ bgrouptkey = true; + } + -+ bgroup = _TRUE; ++ bgroup = true; + + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n") ); + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("[Group Key set]\n") ); @@ -26554,79 +14750,79 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("key index: 0x%8x(0x%8x)\n", key->KeyIndex,(key->KeyIndex&0x3))); + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("key Length: %d\n", key->KeyLength)) ; + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n")); -+ -+ } ++ ++ } + + // If WEP encryption algorithm, just call rtw_set_802_11_add_wep(). + if((padapter->securitypriv.dot11AuthAlgrthm !=dot11AuthAlgrthm_8021X)&&(encryptionalgo== _WEP40_ || encryptionalgo== _WEP104_)) + { -+ u8 ret; -+ u32 keyindex; ++ u8 ret; ++ u32 keyindex; + u32 len = FIELD_OFFSET(NDIS_802_11_KEY, KeyMaterial) + key->KeyLength; + NDIS_802_11_WEP *wep = &padapter->securitypriv.ndiswep; -+ ++ + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: +++++ WEP key +++++\n")); + + wep->Length = len; + keyindex = key->KeyIndex&0x7fffffff; + wep->KeyIndex = keyindex ; + wep->KeyLength = key->KeyLength; -+ ++ + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY:Before memcpy \n")); + -+ _rtw_memcpy(wep->KeyMaterial, key->KeyMaterial, key->KeyLength); ++ _rtw_memcpy(wep->KeyMaterial, key->KeyMaterial, key->KeyLength); + _rtw_memcpy(&(padapter->securitypriv.dot11DefKey[keyindex].skey[0]), key->KeyMaterial, key->KeyLength); + -+ padapter->securitypriv.dot11DefKeylen[keyindex]=key->KeyLength; ++ padapter->securitypriv.dot11DefKeylen[keyindex]=key->KeyLength; + padapter->securitypriv.dot11PrivacyKeyIndex=keyindex; -+ ++ + ret = rtw_set_802_11_add_wep(padapter, wep); -+ ++ + goto exit; -+ ++ + } + + if(key->KeyIndex & 0x20000000){ + // SetRSC + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: +++++ SetRSC+++++\n")); -+ if(bgroup == _TRUE) ++ if(bgroup == true) + { + NDIS_802_11_KEY_RSC keysrc=key->KeyRSC & 0x00FFFFFFFFFFFFULL; -+ _rtw_memcpy(&padapter->securitypriv.dot11Grprxpn, &keysrc, 8); -+ } -+ else -+ { -+ NDIS_802_11_KEY_RSC keysrc=key->KeyRSC & 0x00FFFFFFFFFFFFULL; -+ _rtw_memcpy(&padapter->securitypriv.dot11Grptxpn, &keysrc, 8); ++ _rtw_memcpy(&padapter->securitypriv.dot11Grprxpn, &keysrc, 8); + } -+ ++ else ++ { ++ NDIS_802_11_KEY_RSC keysrc=key->KeyRSC & 0x00FFFFFFFFFFFFULL; ++ _rtw_memcpy(&padapter->securitypriv.dot11Grptxpn, &keysrc, 8); ++ } ++ + } + + // Indicate this key idx is used for TX + // Save the key in KeyMaterial -+ if(bgroup == _TRUE) // Group transmit key ++ if(bgroup == true) // Group transmit key + { + int res; -+ -+ if(bgrouptkey == _TRUE) -+ { ++ ++ if(bgrouptkey == true) ++ { + padapter->securitypriv.dot118021XGrpKeyid=(u8)key->KeyIndex; + } -+ ++ + if((key->KeyIndex&0x3) == 0){ + ret = _FAIL; + goto exit; -+ } -+ ++ } ++ + _rtw_memset(&padapter->securitypriv.dot118021XGrpKey[(u8)((key->KeyIndex) & 0x03)], 0, 16); + _rtw_memset(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], 0, 16); + _rtw_memset(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], 0, 16); -+ ++ + if((key->KeyIndex & 0x10000000)) + { + _rtw_memcpy(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 16, 8); + _rtw_memcpy(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 24, 8); -+ ++ + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:rx mic :0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x\n", + padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[0],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[1], + padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[2],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[3], @@ -26639,56 +14835,56 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + { + _rtw_memcpy(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 24, 8); + _rtw_memcpy(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 16, 8); -+ ++ + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:rx mic :0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x\n", + padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[0],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[1], + padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[2],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[3], + padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[4],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[5], + padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[6],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[7])); + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:set Group mic key!!!!!!!!\n")); -+ ++ + } + + //set group key by index + _rtw_memcpy(&padapter->securitypriv.dot118021XGrpKey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial, key->KeyLength); -+ ++ + key->KeyIndex=key->KeyIndex & 0x03; -+ -+ padapter->securitypriv.binstallGrpkey=_TRUE; -+ -+ padapter->securitypriv.bcheck_grpkey=_FALSE; -+ ++ ++ padapter->securitypriv.binstallGrpkey=true; ++ ++ padapter->securitypriv.bcheck_grpkey=false; ++ + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("reset group key")); -+ -+ res=rtw_set_key(padapter,&padapter->securitypriv, key->KeyIndex, 1, _TRUE); ++ ++ res=rtw_set_key(padapter,&padapter->securitypriv, key->KeyIndex, 1); + + if(res==_FAIL) + ret= _FAIL; + + goto exit; -+ ++ + } + else // Pairwise Key + { + u8 res; -+ ++ + pbssid=get_bssid(&padapter->mlmepriv); + stainfo=rtw_get_stainfo(&padapter->stapriv , pbssid ); -+ ++ + if(stainfo!=NULL) -+ { ++ { + _rtw_memset( &stainfo->dot118021x_UncstKey, 0, 16);// clear keybuffer -+ ++ + _rtw_memcpy(&stainfo->dot118021x_UncstKey, key->KeyMaterial, 16); -+ ++ + if(encryptionalgo== _TKIP_) + { -+ padapter->securitypriv.busetkipkey=_FALSE; -+ ++ padapter->securitypriv.busetkipkey=false; ++ + //_set_timer(&padapter->securitypriv.tkip_timer, 50); -+ ++ + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n ==========_set_timer\n")); -+ ++ + // if TKIP, save the Receive/Transmit MIC key in KeyMaterial[128-255] + if((key->KeyIndex & 0x10000000)){ + _rtw_memcpy(&stainfo->dot11tkiptxmickey, key->KeyMaterial + 16, 8); @@ -26699,73 +14895,67 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + _rtw_memcpy(&stainfo->dot11tkiprxmickey, key->KeyMaterial + 16, 8); + + } -+ ++ + } + else if(encryptionalgo == _AES_) -+ { -+ ++ { ++ + } + -+ ++ + //Set key to CAM through H2C command -+ #if 0 + if(bgrouptkey)//never go to here + { -+ res=rtw_setstakey_cmd(padapter, stainfo, GROUP_KEY, _TRUE); ++ res=rtw_setstakey_cmd(padapter, (unsigned char *)stainfo, false); + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:rtw_setstakey_cmd(group)\n")); + } + else{ -+ res=rtw_setstakey_cmd(padapter, stainfo, UNICAST_KEY, _TRUE); ++ res=rtw_setstakey_cmd(padapter, (unsigned char *)stainfo, true); + RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:rtw_setstakey_cmd(unicast)\n")); + } -+ #else -+ -+ res = rtw_setstakey_cmd(padapter, stainfo, UNICAST_KEY, _TRUE); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n rtw_set_802_11_add_key:rtw_setstakey_cmd(unicast)\n")); -+ #endif + -+ if(res ==_FALSE) ++ if(res ==false) + ret= _FAIL; -+ ++ + } + + } + +exit: -+ -+_func_exit_; + -+ return ret; ++ ++ ++ return ret; +} + +u8 rtw_set_802_11_remove_key(_adapter* padapter, NDIS_802_11_REMOVE_KEY *key){ -+ ++ + uint encryptionalgo; + u8 * pbssid; + struct sta_info *stainfo; -+ u8 bgroup = (key->KeyIndex & 0x4000000) > 0 ? _FALSE: _TRUE; ++ u8 bgroup = (key->KeyIndex & 0x4000000) > 0 ? false: true; + u8 keyIndex = (u8)key->KeyIndex & 0x03; + u8 ret=_SUCCESS; -+ -+_func_enter_; ++ ++ + + if ((key->KeyIndex & 0xbffffffc) > 0) { + ret=_FAIL; + goto exit; + } + -+ if (bgroup == _TRUE) { ++ if (bgroup == true) { + encryptionalgo= padapter->securitypriv.dot118021XGrpPrivacy; + // clear group key by index + //NdisZeroMemory(Adapter->MgntInfo.SecurityInfo.KeyBuf[keyIndex], MAX_WEP_KEY_LEN); + //Adapter->MgntInfo.SecurityInfo.KeyLen[keyIndex] = 0; -+ ++ + _rtw_memset(&padapter->securitypriv.dot118021XGrpKey[keyIndex], 0, 16); -+ ++ + //! \todo Send a H2C Command to Firmware for removing this Key in CAM Entry. -+ ++ + } else { -+ ++ + pbssid=get_bssid(&padapter->mlmepriv); + stainfo=rtw_get_stainfo(&padapter->stapriv , pbssid ); + if(stainfo !=NULL){ @@ -26773,7 +14963,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + + // clear key by BSSID + _rtw_memset(&stainfo->dot118021x_UncstKey, 0, 16); -+ ++ + //! \todo Send a H2C Command to Firmware for disable this Key in CAM Entry. + + } @@ -26784,66 +14974,94 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + } + +exit: -+ -+_func_exit_; + -+ return _TRUE; -+ ++ ++ ++ return true; ++ +} + +/* -+* rtw_get_cur_max_rate - ++* rtw_get_cur_max_rate - +* @adapter: pointer to _adapter structure -+* ++* +* Return 0 or 100Kbps +*/ +u16 rtw_get_cur_max_rate(_adapter *adapter) +{ + int i = 0; ++ u8 *p; + u16 rate = 0, max_rate = 0; ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct registry_priv *pregistrypriv = &adapter->registrypriv; + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+ struct sta_info *psta = NULL; -+ u8 short_GI=0; ++ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; +#ifdef CONFIG_80211N_HT ++ struct rtw_ieee80211_ht_cap *pht_capie; + u8 rf_type = 0; ++ u8 bw_40MHz=0, short_GI_20=0, short_GI_40=0, cbw40_enable=0; ++ u16 mcs_rate=0; ++ u32 ht_ielen = 0; ++#endif ++#ifdef CONFIG_80211AC_VHT ++ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; +#endif + +#ifdef CONFIG_MP_INCLUDED + if (adapter->registrypriv.mp_mode == 1) -+ { -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) ++ { ++ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) + return 0; + } +#endif + -+ if((check_fwstate(pmlmepriv, _FW_LINKED) != _TRUE) -+ && (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != _TRUE)) ++ if((check_fwstate(pmlmepriv, _FW_LINKED) != true) ++ && (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != true)) + return 0; + -+ psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) -+ return 0; -+ -+ short_GI = query_ra_short_GI(psta); -+ +#ifdef CONFIG_80211N_HT -+ if (IsSupportedHT(psta->wireless_mode)) { -+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ if (IsSupportedTxHT(pmlmeext->cur_wireless_mode)) { ++ p = rtw_get_ie(&pcur_bss->IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pcur_bss->IELength-12); ++ if(p && ht_ielen>0) ++ { ++ pht_capie = (struct rtw_ieee80211_ht_cap *)(p+2); + -+ max_rate = rtw_mcs_rate( -+ rf_type, -+ ((psta->bw_mode == CHANNEL_WIDTH_40)?1:0), -+ short_GI, -+ psta->htpriv.ht_cap.supp_mcs_set -+ ); ++ _rtw_memcpy(&mcs_rate , pht_capie->supp_mcs_set, 2); ++ ++ //bw_40MHz = (pht_capie->cap_info&IEEE80211_HT_CAP_SUP_WIDTH) ? 1:0; ++ //cur_bwmod is updated by beacon, pmlmeinfo is updated by association response ++ bw_40MHz = (pmlmeext->cur_bwmode && (HT_INFO_HT_PARAM_REC_TRANS_CHNL_WIDTH & pmlmeinfo->HT_info.infos[0])) ? 1:0; ++ ++ //short_GI = (pht_capie->cap_info&(IEEE80211_HT_CAP_SGI_20|IEEE80211_HT_CAP_SGI_40)) ? 1:0; ++ short_GI_20 = (le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info)&IEEE80211_HT_CAP_SGI_20) ? 1:0; ++ short_GI_40 = (le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info)&IEEE80211_HT_CAP_SGI_40) ? 1:0; ++ ++ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ if (pmlmeext->cur_channel > 14) { ++ if ((pregistrypriv->bw_mode & 0xf0) > 0) ++ cbw40_enable = 1; ++ } else { ++ if ((pregistrypriv->bw_mode & 0x0f) > 0) ++ cbw40_enable = 1; ++ } ++ ++ max_rate = rtw_mcs_rate( ++ rf_type, ++ bw_40MHz & cbw40_enable, ++ short_GI_20, ++ short_GI_40, ++ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate ++ ); ++ } + } +#ifdef CONFIG_80211AC_VHT -+ else if (IsSupportedVHT(psta->wireless_mode)) { -+ max_rate = ((rtw_vht_mcs_to_data_rate(psta->bw_mode, short_GI, pmlmepriv->vhtpriv.vht_highest_rate) + 1) >> 1) * 10; ++ else if (IsSupportedVHT(pmlmeext->cur_wireless_mode)) { ++ max_rate = ((rtw_vht_data_rate(pvhtpriv->bwmode, pvhtpriv->sgi, pvhtpriv->vht_highest_rate) + 1) >> 1) * 10; + } +#endif //CONFIG_80211AC_VHT -+ else ++ else +#endif //CONFIG_80211N_HT + { + while( (pcur_bss->SupportedRates[i]!=0) && (pcur_bss->SupportedRates[i]!=0xFF)) @@ -26853,7 +15071,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + max_rate = rate; + i++; + } -+ ++ + max_rate = max_rate*10/2; + } + @@ -26861,27 +15079,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 +} + +/* -+* rtw_set_scan_mode - ++* rtw_set_scan_mode - +* @adapter: pointer to _adapter structure -+* @scan_mode: -+* ++* @scan_mode: ++* +* Return _SUCCESS or _FAIL +*/ +int rtw_set_scan_mode(_adapter *adapter, RT_SCAN_TYPE scan_mode) +{ + if(scan_mode != SCAN_ACTIVE && scan_mode != SCAN_PASSIVE) + return _FAIL; -+ ++ + adapter->mlmepriv.scan_mode = scan_mode; + + return _SUCCESS; +} + +/* -+* rtw_set_channel_plan - ++* rtw_set_channel_plan - +* @adapter: pointer to _adapter structure -+* @channel_plan: -+* ++* @channel_plan: ++* +* Return _SUCCESS or _FAIL +*/ +int rtw_set_channel_plan(_adapter *adapter, u8 channel_plan) @@ -26890,58 +15108,45 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux/3rdparty/rtl8 + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + + //handle by cmd_thread to sync with scan operation -+ return rtw_set_chplan_cmd(adapter, RTW_CMDF_WAIT_ACK, channel_plan, 1); ++ return rtw_set_chplan_cmd(adapter, channel_plan, 1); +} + +/* -+* rtw_set_country - ++* rtw_set_country - +* @adapter: pointer to _adapter structure +* @country_code: string of country code -+* ++* +* Return _SUCCESS or _FAIL +*/ +int rtw_set_country(_adapter *adapter, const char *country_code) +{ -+ int channel_plan; ++ int channel_plan = RT_CHANNEL_DOMAIN_WORLD_WIDE_5G; + -+ channel_plan = rtw_get_chplan_from_country(country_code); ++ DBG_871X("%s country_code:%s\n", __func__, country_code); + -+ if (channel_plan == -1) { -+ DBG_871X_LEVEL(_drv_always_, "%s unsupported country_code:%s\n", __func__, country_code); -+ return _FAIL; -+ } ++ //TODO: should have a table to match country code and RT_CHANNEL_DOMAIN ++ //TODO: should consider 2-character and 3-character country code ++ if(0 == strcmp(country_code, "US")) ++ channel_plan = RT_CHANNEL_DOMAIN_FCC; ++ else if(0 == strcmp(country_code, "EU")) ++ channel_plan = RT_CHANNEL_DOMAIN_ETSI; ++ else if(0 == strcmp(country_code, "JP")) ++ channel_plan = RT_CHANNEL_DOMAIN_MKK; ++ else if(0 == strcmp(country_code, "CN")) ++ channel_plan = RT_CHANNEL_DOMAIN_CHINA; ++ else ++ DBG_871X("%s unknown country_code:%s\n", __FUNCTION__, country_code); + -+ DBG_871X_LEVEL(_drv_always_, "%s country_code:%s mapping to chplan:0x%02x\n", __func__, country_code, channel_plan); + return rtw_set_channel_plan(adapter, channel_plan); +} -+ -+/* -+* rtw_set_band - -+* @adapter: pointer to _adapter structure -+* @band: band to set -+* -+* Return _SUCCESS or _FAIL -+*/ -+int rtw_set_band(_adapter *adapter, u8 band) -+{ -+ if (rtw_band_valid(band)) { -+ DBG_871X(FUNC_ADPT_FMT" band:%d\n", FUNC_ADPT_ARG(adapter), band); -+ adapter->setband = band; -+ return _SUCCESS; -+ } -+ -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" band:%d fail\n", FUNC_ADPT_ARG(adapter), band); -+ return _FAIL; -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/core/rtw_iol.c ---- linux.old/3rdparty/rtl8812au/core/rtw_iol.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_iol.c 2017-06-07 23:07:21.000686574 +0300 -@@ -0,0 +1,390 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_iol.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_iol.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_iol.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_iol.c 2018-02-06 17:42:30.694966927 +0200 +@@ -0,0 +1,382 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -26951,11 +15156,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ + +#include @@ -26974,7 +15174,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ + DBG_871X("%s rtw_alloc_xmitframe return null\n", __FUNCTION__); + goto exit; + } -+ ++ + if ((xmitbuf = rtw_alloc_xmitbuf(pxmitpriv)) == NULL) + { + DBG_871X("%s rtw_alloc_xmitbuf return null\n", __FUNCTION__); @@ -26982,7 +15182,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ + xmit_frame=NULL; + goto exit; + } -+ ++ + xmit_frame->frame_tag = MGNT_FRAMETAG; + xmit_frame->pxmitbuf = xmitbuf; + xmit_frame->buf_addr = xmitbuf->pbuf; @@ -26990,8 +15190,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ + + pattrib = &xmit_frame->attrib; + update_mgntframe_attrib(adapter, pattrib); -+ pattrib->qsel = QSLT_BEACON;//Beacon -+ pattrib->subtype = WIFI_BEACON; ++ pattrib->qsel = 0x10;//Beacon ++ pattrib->subtype = WIFI_BEACON; + pattrib->pktlen = pattrib->last_txcmdsz = 0; + +#else @@ -27002,7 +15202,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ + else { + pattrib = &xmit_frame->attrib; + update_mgntframe_attrib(adapter, pattrib); -+ pattrib->qsel = QSLT_BEACON; ++ pattrib->qsel = 0x10; + pattrib->pktlen = pattrib->last_txcmdsz = 0; + } +#endif @@ -27033,21 +15233,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ + pattrib->last_txcmdsz += cmd_len; + + //DBG_871X("%s ori:%u + cmd_len:%u = %u\n", __FUNCTION__, ori_len, cmd_len, buf_offset+pattrib->pktlen); -+ ++ + return _SUCCESS; +} + +bool rtw_IOL_applied(ADAPTER *adapter) -+{ ++{ + if(1 == adapter->registrypriv.fw_iol) -+ return _TRUE; ++ return true; + -+#ifdef CONFIG_USB_HCI + if((2 == adapter->registrypriv.fw_iol) && (IS_FULL_SPEED_USB(adapter))) -+ return _TRUE; -+#endif ++ return true; + -+ return _FALSE; ++ return false; +} + +int rtw_IOL_exec_cmds_sync(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt) @@ -27064,18 +15262,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ +{ + struct ioreg_cfg cmd = {8,IOREG_CMD_WB_REG,0x0, 0x0,0x0}; + -+ //RTW_PUT_LE16((u8*)&cmd.address, addr); -+ //RTW_PUT_LE32((u8*)&cmd.value, (u32)value); -+ cmd.address = cpu_to_le16(addr); ++ //RTW_PUT_LE16((u8*)&cmd.address, addr); ++ //RTW_PUT_LE32((u8*)&cmd.value, (u32)value); ++ cmd.address = cpu_to_le16(addr); + cmd.data = cpu_to_le32(value); -+ ++ + if(mask!=0xFF) + { + cmd.length = 12; -+ //RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); ++ //RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); + cmd.mask = cpu_to_le32(mask); -+ } -+ ++ } ++ + //DBG_871X("%s addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FUNCTION__, addr,value,mask); + + return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, cmd.length); @@ -27085,65 +15283,65 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ +{ + struct ioreg_cfg cmd = {8,IOREG_CMD_WW_REG,0x0, 0x0,0x0}; + -+ //RTW_PUT_LE16((u8*)&cmd.address, addr); -+ //RTW_PUT_LE32((u8*)&cmd.value, (u32)value); -+ cmd.address = cpu_to_le16(addr); ++ //RTW_PUT_LE16((u8*)&cmd.address, addr); ++ //RTW_PUT_LE32((u8*)&cmd.value, (u32)value); ++ cmd.address = cpu_to_le16(addr); + cmd.data = cpu_to_le32(value); -+ ++ + if(mask!=0xFFFF) + { + cmd.length = 12; -+ //RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); ++ //RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); + cmd.mask = cpu_to_le32(mask); -+ } -+ ++ } ++ + //DBG_871X("%s addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FUNCTION__, addr,value,mask); + + return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, cmd.length); -+ ++ +} +int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, u32 mask) +{ + struct ioreg_cfg cmd = {8,IOREG_CMD_WD_REG,0x0, 0x0,0x0}; + -+ //RTW_PUT_LE16((u8*)&cmd.address, addr); -+ //RTW_PUT_LE32((u8*)&cmd.value, (u32)value); -+ cmd.address = cpu_to_le16(addr); ++ //RTW_PUT_LE16((u8*)&cmd.address, addr); ++ //RTW_PUT_LE32((u8*)&cmd.value, (u32)value); ++ cmd.address = cpu_to_le16(addr); + cmd.data = cpu_to_le32(value); -+ ++ + if(mask!=0xFFFFFFFF) + { + cmd.length = 12; -+ //RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); ++ //RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); + cmd.mask = cpu_to_le32(mask); -+ } -+ ++ } ++ + //DBG_871X("%s addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FU2NCTION__, addr,value,mask); + + return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, cmd.length); -+ ++ +} + +int _rtw_IOL_append_WRF_cmd(struct xmit_frame *xmit_frame, u8 rf_path, u16 addr, u32 value, u32 mask) +{ + struct ioreg_cfg cmd = {8,IOREG_CMD_W_RF,0x0, 0x0,0x0}; + -+ //RTW_PUT_LE16((u8*)&cmd.address, addr); -+ //RTW_PUT_LE32((u8*)&cmd.value, (u32)value); -+ cmd.address = (rf_path<<8) |((addr) &0xFF); ++ //RTW_PUT_LE16((u8*)&cmd.address, addr); ++ //RTW_PUT_LE32((u8*)&cmd.value, (u32)value); ++ cmd.address = (rf_path<<8) |((addr) &0xFF); + cmd.data = cpu_to_le32(value); -+ ++ + if(mask!=0x000FFFFF) + { + cmd.length = 12; -+ //RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); ++ //RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); + cmd.mask = cpu_to_le32(mask); -+ } -+ ++ } ++ + //DBG_871X("%s rf_path:0x%02x addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FU2NCTION__,rf_path, addr,value,mask); + + return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, cmd.length); -+ ++ +} + + @@ -27151,8 +15349,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ +int rtw_IOL_append_DELAY_US_cmd(struct xmit_frame *xmit_frame, u16 us) +{ + struct ioreg_cfg cmd = {4,IOREG_CMD_DELAY_US,0x0, 0x0,0x0}; -+ //RTW_PUT_LE16((u8*)&cmd.address, us); -+ cmd.address = cpu_to_le16(us); ++ //RTW_PUT_LE16((u8*)&cmd.address, us); ++ cmd.address = cpu_to_le16(us); + + //DBG_871X("%s %u\n", __FUNCTION__, us); + return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, 4); @@ -27162,29 +15360,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ +{ + struct ioreg_cfg cmd = {4,IOREG_CMD_DELAY_US,0x0, 0x0,0x0}; + -+ //RTW_PUT_LE16((u8*)&cmd.address, ms); -+ cmd.address = cpu_to_le16(ms); ++ //RTW_PUT_LE16((u8*)&cmd.address, ms); ++ cmd.address = cpu_to_le16(ms); + + //DBG_871X("%s %u\n", __FUNCTION__, ms); + return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, 4); +} +int rtw_IOL_append_END_cmd(struct xmit_frame *xmit_frame) -+{ ++{ + struct ioreg_cfg cmd = {4,IOREG_CMD_END,0xFFFF, 0xFF,0x0}; + return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, 4); + +} + +u8 rtw_IOL_cmd_boundary_handle(struct xmit_frame *pxmit_frame) -+{ -+ u8 is_cmd_bndy = _FALSE; ++{ ++ u8 is_cmd_bndy = false; + if(((pxmit_frame->attrib.pktlen+32)%256) + 8 >= 256){ + rtw_IOL_append_END_cmd(pxmit_frame); + pxmit_frame->attrib.pktlen = ((((pxmit_frame->attrib.pktlen+32)/256)+1)*256 ); -+ ++ + //printk("==> %s, pktlen(%d)\n",__FUNCTION__,pxmit_frame->attrib.pktlen); + pxmit_frame->attrib.last_txcmdsz = pxmit_frame->attrib.pktlen; -+ is_cmd_bndy = _TRUE; ++ is_cmd_bndy = true; + } + return is_cmd_bndy; +} @@ -27193,23 +15391,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ +{ + int i; + int j=1; -+ ++ + printk("###### %s ######\n",__FUNCTION__); + for(i=0;i< buf_len;i++){ + printk("%02x-",*(pbuf+i)); -+ -+ if(j%32 ==0) printk("\n");j++; ++ ++ if(j%32 ==0) printk("\n");j++; + } + printk("\n"); -+ printk("============= ioreg_cmd len = %d =============== \n",buf_len); ++ printk("============= ioreg_cmd len = %d =============== \n",buf_len); +} + + +#else //CONFIG_IOL_NEW_GENERATION +int rtw_IOL_append_LLT_cmd(struct xmit_frame *xmit_frame, u8 page_boundary) -+{ ++{ + IOL_CMD cmd = {0x0, IOL_CMD_LLT, 0x0, 0x0}; -+ ++ + RTW_PUT_BE32((u8*)&cmd.value, (u32)page_boundary); + + return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, 8); @@ -27218,7 +15416,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ +int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value) +{ + IOL_CMD cmd = {0x0, IOL_CMD_WB_REG, 0x0, 0x0}; -+ ++ + RTW_PUT_BE16((u8*)&cmd.address, (u16)addr); + RTW_PUT_BE32((u8*)&cmd.value, (u32)value); + @@ -27228,7 +15426,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ +int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value) +{ + IOL_CMD cmd = {0x0, IOL_CMD_WW_REG, 0x0, 0x0}; -+ ++ + RTW_PUT_BE16((u8*)&cmd.address, (u16)addr); + RTW_PUT_BE32((u8*)&cmd.value, (u32)value); + @@ -27239,7 +15437,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ +{ + IOL_CMD cmd = {0x0, IOL_CMD_WD_REG, 0x0, 0x0}; + u8* pos = (u8 *)&cmd; -+ ++ + RTW_PUT_BE16((u8*)&cmd.address, (u16)addr); + RTW_PUT_BE32((u8*)&cmd.value, (u32)value); + @@ -27275,7 +15473,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ +int rtw_IOL_append_DELAY_US_cmd(struct xmit_frame *xmit_frame, u16 us) +{ + IOL_CMD cmd = {0x0, IOL_CMD_DELAY_US, 0x0, 0x0}; -+ ++ + RTW_PUT_BE32((u8*)&cmd.value, (u32)us); + + //DBG_871X("%s %u\n", __FUNCTION__, us); @@ -27286,7 +15484,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ +int rtw_IOL_append_DELAY_MS_cmd(struct xmit_frame *xmit_frame, u16 ms) +{ + IOL_CMD cmd = {0x0, IOL_CMD_DELAY_MS, 0x0, 0x0}; -+ ++ + RTW_PUT_BE32((u8*)&cmd.value, (u32)ms); + + //DBG_871X("%s %u\n", __FUNCTION__, ms); @@ -27295,7 +15493,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ +} + +int rtw_IOL_append_END_cmd(struct xmit_frame *xmit_frame) -+{ ++{ + IOL_CMD end_cmd = {0x0, IOL_CMD_END, 0x0, 0x0}; + + @@ -27327,141 +15525,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_iol.c linux/3rdparty/rtl8812au/ + + +#endif //CONFIG_IOL -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mem.c linux/3rdparty/rtl8812au/core/rtw_mem.c ---- linux.old/3rdparty/rtl8812au/core/rtw_mem.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_mem.c 2017-06-07 23:07:21.000686574 +0300 -@@ -0,0 +1,122 @@ -+ -+#include -+#include -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Realtek Wireless Lan Driver"); -+MODULE_AUTHOR("Realtek Semiconductor Corp."); -+MODULE_VERSION("DRIVERVERSION"); -+ -+struct sk_buff_head rtk_skb_mem_q; -+struct u8* rtk_buf_mem[NR_RECVBUFF]; -+ -+struct u8 * rtw_get_buf_premem(int index) -+{ -+ printk("%s, rtk_buf_mem index : %d\n", __func__, index); -+ return rtk_buf_mem[index]; -+} -+ -+u16 rtw_rtkm_get_buff_size(void) -+{ -+ return MAX_RTKM_RECVBUF_SZ; -+} -+EXPORT_SYMBOL(rtw_rtkm_get_buff_size); -+ -+u8 rtw_rtkm_get_nr_recv_skb(void) -+{ -+ return MAX_RTKM_NR_PREALLOC_RECV_SKB; -+} -+EXPORT_SYMBOL(rtw_rtkm_get_nr_recv_skb); -+ -+struct sk_buff *rtw_alloc_skb_premem(u16 in_size) -+{ -+ struct sk_buff *skb = NULL; -+ -+ if (in_size > MAX_RTKM_RECVBUF_SZ) { -+ pr_info("warning %s: driver buffer size(%d) > rtkm buffer size(%d)\n", __func__, in_size, MAX_RTKM_RECVBUF_SZ); -+ WARN_ON(1); -+ return skb; -+ } -+ -+ skb = skb_dequeue(&rtk_skb_mem_q); -+ -+ printk("%s, rtk_skb_mem_q len : %d\n", __func__, skb_queue_len(&rtk_skb_mem_q)); -+ -+ return skb; -+} -+EXPORT_SYMBOL(rtw_alloc_skb_premem); -+ -+int rtw_free_skb_premem(struct sk_buff *pskb) -+{ -+ if(!pskb) -+ return -1; -+ -+ if (skb_queue_len(&rtk_skb_mem_q) >= MAX_RTKM_NR_PREALLOC_RECV_SKB) -+ return -1; -+ -+ skb_queue_tail(&rtk_skb_mem_q, pskb); -+ -+ printk("%s, rtk_skb_mem_q len : %d\n", __func__, skb_queue_len(&rtk_skb_mem_q)); -+ -+ return 0; -+} -+EXPORT_SYMBOL(rtw_free_skb_premem); -+ -+static int __init rtw_mem_init(void) -+{ -+ int i; -+ SIZE_PTR tmpaddr=0; -+ SIZE_PTR alignment=0; -+ struct sk_buff *pskb=NULL; -+ -+ printk("%s\n", __func__); -+ pr_info("MAX_RTKM_NR_PREALLOC_RECV_SKB: %d\n", MAX_RTKM_NR_PREALLOC_RECV_SKB); -+ pr_info("MAX_RTKM_RECVBUF_SZ: %d\n", MAX_RTKM_RECVBUF_SZ); -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ for(i=0; idata; -+ alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1); -+ skb_reserve(pskb, (RECVBUFF_ALIGN_SZ - alignment)); -+ -+ skb_queue_tail(&rtk_skb_mem_q, pskb); -+ } -+ else -+ { -+ printk("%s, alloc skb memory fail!\n", __func__); -+ } -+ -+ pskb=NULL; -+ } -+ -+ printk("%s, rtk_skb_mem_q len : %d\n", __func__, skb_queue_len(&rtk_skb_mem_q)); -+ -+ return 0; -+ -+} -+ -+static void __exit rtw_mem_exit(void) -+{ -+ if (skb_queue_len(&rtk_skb_mem_q)) { -+ printk("%s, rtk_skb_mem_q len : %d\n", __func__, skb_queue_len(&rtk_skb_mem_q)); -+ } -+ -+ skb_queue_purge(&rtk_skb_mem_q); -+ -+ printk("%s\n", __func__); -+} -+ -+module_init(rtw_mem_init); -+module_exit(rtw_mem_exit); -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au/core/rtw_mlme.c ---- linux.old/3rdparty/rtl8812au/core/rtw_mlme.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_mlme.c 2017-06-07 23:07:21.001686665 +0300 -@@ -0,0 +1,4645 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_mlme.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mlme.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_mlme.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mlme.c 2018-02-06 17:42:30.695966942 +0200 +@@ -0,0 +1,3626 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -27471,19 +15542,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_MLME_C_ + -+#include -+ -+extern void indicate_wx_scan_complete_event(_adapter *padapter); -+extern u8 rtw_do_join(_adapter * padapter); -+ ++#include ++#include "rtw_mlme.h" + +sint _rtw_init_mlme_priv (_adapter* padapter) +{ @@ -27493,7 +15556,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + sint res = _SUCCESS; + -+_func_enter_; ++ + + // We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). + //_rtw_memset((u8 *)pmlmepriv, 0, sizeof(struct mlme_priv)); @@ -27501,31 +15564,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + pmlmepriv->nic_hdl = (u8 *)padapter; + + pmlmepriv->pscanned = NULL; -+ pmlmepriv->fw_state = WIFI_STATION_STATE; // Must sync with rtw_wdev_alloc() -+ // wdev->iftype = NL80211_IFTYPE_STATION ++ pmlmepriv->fw_state = 0; + pmlmepriv->cur_network.network.InfrastructureMode = Ndis802_11AutoUnknown; + pmlmepriv->scan_mode=SCAN_ACTIVE;// 1: active, 0: pasive. Maybe someday we should rename this varable to "active_mode" (Jeff) + -+ _rtw_spinlock_init(&(pmlmepriv->lock)); ++ _rtw_spinlock_init(&(pmlmepriv->lock)); + _rtw_init_queue(&(pmlmepriv->free_bss_pool)); + _rtw_init_queue(&(pmlmepriv->scanned_queue)); + + set_scanned_network_val(pmlmepriv, 0); -+ ++ + _rtw_memset(&pmlmepriv->assoc_ssid,0,sizeof(NDIS_802_11_SSID)); + + pbuf = rtw_zvmalloc(MAX_BSS_CNT * (sizeof(struct wlan_network))); -+ ++ + if (pbuf == NULL){ + res=_FAIL; + goto exit; + } + pmlmepriv->free_bss_buf = pbuf; -+ ++ + pnetwork = (struct wlan_network *)pbuf; -+ ++ + for(i = 0; i < MAX_BSS_CNT; i++) -+ { ++ { + _rtw_init_listhead(&(pnetwork->list)); + + rtw_list_insert_tail(&(pnetwork->list), &(pmlmepriv->free_bss_pool.queue)); @@ -27536,38 +15598,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + //allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf + + rtw_clear_scan_deny(padapter); -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ pmlmepriv->bGetGateway = 0; -+#endif + -+#ifdef CONFIG_LAYER2_ROAMING -+ #define RTW_ROAM_SCAN_RESULT_EXP_MS 5*1000 -+ #define RTW_ROAM_RSSI_DIFF_TH 10 -+ #define RTW_ROAM_SCAN_INTERVAL_MS 10*1000 -+ -+ pmlmepriv->roam_flags = 0 -+ | RTW_ROAM_ON_EXPIRED -+ #ifdef CONFIG_LAYER2_ROAMING_RESUME -+ | RTW_ROAM_ON_RESUME -+ #endif -+ #ifdef CONFIG_LAYER2_ROAMING_ACTIVE -+ | RTW_ROAM_ACTIVE -+ #endif -+ ; -+ -+ pmlmepriv->roam_scanr_exp_ms = RTW_ROAM_SCAN_RESULT_EXP_MS; -+ pmlmepriv->roam_rssi_diff_th = RTW_ROAM_RSSI_DIFF_TH; -+ pmlmepriv->roam_scan_int_ms = RTW_ROAM_SCAN_INTERVAL_MS; -+#endif /* CONFIG_LAYER2_ROAMING */ ++ #ifdef CONFIG_FTP_PROTECT ++ pmlmepriv->ftp_lock_flag = 0; ++ #endif //CONFIG_FTP_PROTECT + + rtw_init_mlme_timer(padapter); + +exit: + -+_func_exit_; ++ + + return res; -+} ++} + +void rtw_mfree_mlme_priv_lock (struct mlme_priv *pmlmepriv); +void rtw_mfree_mlme_priv_lock (struct mlme_priv *pmlmepriv) @@ -27580,11 +15623,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +static void rtw_free_mlme_ie_data(u8 **ppie, u32 *plen) +{ + if(*ppie) -+ { -+ rtw_mfree(*ppie, *plen); ++ { ++ _rtw_mfree(*ppie, *plen); + *plen = 0; + *ppie=NULL; -+ } ++ } +} + +void rtw_free_mlme_priv_ie_data(struct mlme_priv *pmlmepriv) @@ -27596,7 +15639,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + rtw_free_mlme_ie_data(&pmlmepriv->wps_probe_req_ie, &pmlmepriv->wps_probe_req_ie_len); + rtw_free_mlme_ie_data(&pmlmepriv->wps_probe_resp_ie, &pmlmepriv->wps_probe_resp_ie_len); + rtw_free_mlme_ie_data(&pmlmepriv->wps_assoc_resp_ie, &pmlmepriv->wps_assoc_resp_ie_len); -+ ++ + rtw_free_mlme_ie_data(&pmlmepriv->p2p_beacon_ie, &pmlmepriv->p2p_beacon_ie_len); + rtw_free_mlme_ie_data(&pmlmepriv->p2p_probe_req_ie, &pmlmepriv->p2p_probe_req_ie_len); + rtw_free_mlme_ie_data(&pmlmepriv->p2p_probe_resp_ie, &pmlmepriv->p2p_probe_resp_ie_len); @@ -27604,7 +15647,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + rtw_free_mlme_ie_data(&pmlmepriv->p2p_assoc_req_ie, &pmlmepriv->p2p_assoc_req_ie_len); +#endif + -+#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) ++#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) + rtw_free_mlme_ie_data(&pmlmepriv->wfd_beacon_ie, &pmlmepriv->wfd_beacon_ie_len); + rtw_free_mlme_ie_data(&pmlmepriv->wfd_probe_req_ie, &pmlmepriv->wfd_probe_req_ie_len); + rtw_free_mlme_ie_data(&pmlmepriv->wfd_probe_resp_ie, &pmlmepriv->wfd_probe_resp_ie_len); @@ -27616,11 +15659,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + +void _rtw_free_mlme_priv (struct mlme_priv *pmlmepriv) +{ -+_func_enter_; -+ if (NULL == pmlmepriv){ -+ rtw_warn_on(1); -+ goto exit; -+ } ++ ++ + rtw_free_mlme_priv_ie_data(pmlmepriv); + + if(pmlmepriv){ @@ -27630,28 +15670,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + rtw_vmfree(pmlmepriv->free_bss_buf, MAX_BSS_CNT * sizeof(struct wlan_network)); + } + } -+exit: -+_func_exit_; ++ +} + +sint _rtw_enqueue_network(_queue *queue, struct wlan_network *pnetwork) +{ + _irqL irqL; + -+_func_enter_; ++ + + if (pnetwork == NULL) + goto exit; -+ ++ + _enter_critical_bh(&queue->lock, &irqL); + + rtw_list_insert_tail(&pnetwork->list, &queue->queue); + + _exit_critical_bh(&queue->lock, &irqL); + -+exit: ++exit: ++ + -+_func_exit_; + + return _SUCCESS; +} @@ -27663,24 +15702,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + + struct wlan_network *pnetwork; + -+_func_enter_; ++ + + _enter_critical_bh(&queue->lock, &irqL); + -+ if (_rtw_queue_empty(queue) == _TRUE) ++ if (_rtw_queue_empty(queue) == true) + + pnetwork = NULL; -+ ++ + else + { + pnetwork = LIST_CONTAINOR(get_next(&queue->queue), struct wlan_network, list); -+ ++ + rtw_list_delete(&(pnetwork->list)); + } -+ ++ + _exit_critical_bh(&queue->lock, &irqL); + -+_func_exit_; ++ + + return pnetwork; +} @@ -27689,113 +15728,95 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +struct wlan_network *_rtw_alloc_network(struct mlme_priv *pmlmepriv )//(_queue *free_queue) +{ + _irqL irqL; -+ struct wlan_network *pnetwork; ++ struct wlan_network *pnetwork; + _queue *free_queue = &pmlmepriv->free_bss_pool; + _list* plist = NULL; -+ -+_func_enter_; ++ ++ + + _enter_critical_bh(&free_queue->lock, &irqL); -+ -+ if (_rtw_queue_empty(free_queue) == _TRUE) { ++ ++ if (_rtw_queue_empty(free_queue) == true) { + pnetwork=NULL; + goto exit; + } + plist = get_next(&(free_queue->queue)); -+ ++ + pnetwork = LIST_CONTAINOR(plist , struct wlan_network, list); -+ ++ + rtw_list_delete(&pnetwork->list); -+ ++ + RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("_rtw_alloc_network: ptr=%p\n", plist)); + pnetwork->network_type = 0; -+ pnetwork->fixed = _FALSE; ++ pnetwork->fixed = false; + pnetwork->last_scanned = rtw_get_current_time(); -+ pnetwork->aid=0; ++ pnetwork->aid=0; + pnetwork->join_res=0; + + pmlmepriv->num_of_scanned ++; -+ ++ +exit: + _exit_critical_bh(&free_queue->lock, &irqL); + -+_func_exit_; + -+ return pnetwork; ++ ++ return pnetwork; +} + +void _rtw_free_network(struct mlme_priv *pmlmepriv ,struct wlan_network *pnetwork, u8 isfreeall) +{ + u32 delta_time; + u32 lifetime = SCANQUEUE_LIFETIME; -+ _irqL irqL; ++ _irqL irqL; + _queue *free_queue = &(pmlmepriv->free_bss_pool); -+ -+_func_enter_; + + if (pnetwork == NULL) -+ goto exit; ++ return; + -+ if (pnetwork->fixed == _TRUE) -+ goto exit; ++ if (pnetwork->fixed == true) ++ return; + -+ if ( (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)==_TRUE ) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==_TRUE ) ) ++ if ( (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)==true ) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==true ) ) + lifetime = 1; + -+ if(!isfreeall) -+ { ++ if(!isfreeall) { + delta_time = (u32) rtw_get_passing_time_ms(pnetwork->last_scanned); + if(delta_time < lifetime)// unit:msec -+ goto exit; ++ return; + } + + _enter_critical_bh(&free_queue->lock, &irqL); -+ ++ + rtw_list_delete(&(pnetwork->list)); + + rtw_list_insert_tail(&(pnetwork->list),&(free_queue->queue)); -+ ++ + pmlmepriv->num_of_scanned --; -+ ++ + + //DBG_871X("_rtw_free_network:SSID=%s\n", pnetwork->network.Ssid.Ssid); -+ -+ _exit_critical_bh(&free_queue->lock, &irqL); -+ -+exit: -+ -+_func_exit_; + ++ _exit_critical_bh(&free_queue->lock, &irqL); +} + +void _rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork) +{ -+ + _queue *free_queue = &(pmlmepriv->free_bss_pool); + -+_func_enter_; -+ + if (pnetwork == NULL) -+ goto exit; ++ return; + -+ if (pnetwork->fixed == _TRUE) -+ goto exit; ++ if (pnetwork->fixed == true) ++ return; + + //_enter_critical(&free_queue->lock, &irqL); -+ ++ + rtw_list_delete(&(pnetwork->list)); + + rtw_list_insert_tail(&(pnetwork->list), get_list_head(free_queue)); -+ ++ + pmlmepriv->num_of_scanned --; -+ -+ //_exit_critical(&free_queue->lock, &irqL); -+ -+exit: -+ -+_func_exit_; -+ +} + + @@ -27811,40 +15832,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + _list *phead, *plist; + struct wlan_network *pnetwork = NULL; + u8 zero_addr[ETH_ALEN] = {0,0,0,0,0,0}; -+ -+_func_enter_; ++ ++ + + if(_rtw_memcmp(zero_addr, addr, ETH_ALEN)){ + pnetwork=NULL; + goto exit; + } -+ ++ + //_enter_critical_bh(&scanned_queue->lock, &irqL); -+ ++ + phead = get_list_head(scanned_queue); + plist = get_next(phead); -+ ++ + while (plist != phead) + { + pnetwork = LIST_CONTAINOR(plist, struct wlan_network ,list); + -+ if (_rtw_memcmp(addr, pnetwork->network.MacAddress, ETH_ALEN) == _TRUE) ++ if (_rtw_memcmp(addr, pnetwork->network.MacAddress, ETH_ALEN) == true) + break; -+ ++ + plist = get_next(plist); + } + + if(plist == phead) + pnetwork = NULL; + -+ //_exit_critical_bh(&scanned_queue->lock, &irqL); -+ -+exit: -+ -+_func_exit_; -+ ++exit: + return pnetwork; -+ +} + + @@ -27856,15 +15871,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + struct mlme_priv* pmlmepriv = &padapter->mlmepriv; + _queue *scanned_queue = &pmlmepriv->scanned_queue; + -+_func_enter_; -+ ++ ++ + + _enter_critical_bh(&scanned_queue->lock, &irqL); + + phead = get_list_head(scanned_queue); + plist = get_next(phead); + -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) ++ while (rtw_end_of_queue_search(phead, plist) == false) + { + + pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); @@ -27872,12 +15887,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + plist = get_next(plist); + + _rtw_free_network(pmlmepriv,pnetwork, isfreeall); -+ ++ + } + + _exit_critical_bh(&scanned_queue->lock, &irqL); -+ -+_func_exit_; ++ ++ + +} + @@ -27887,19 +15902,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +sint rtw_if_up(_adapter *padapter) { + + sint res; -+_func_enter_; + -+ if (RTW_CANNOT_RUN(padapter) || -+ (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _FALSE)) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_if_up:bDriverStopped(%s) OR bSurpriseRemoved(%s)" -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False")); -+ res=_FALSE; ++ ++ if( padapter->bDriverStopped || padapter->bSurpriseRemoved || ++ (check_fwstate(&padapter->mlmepriv, _FW_LINKED)== false)){ ++ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_if_up:bDriverStopped(%d) OR bSurpriseRemoved(%d)", padapter->bDriverStopped, padapter->bSurpriseRemoved)); ++ res=false; + } + else -+ res= _TRUE; -+ -+_func_exit_; ++ res= true; ++ ++ + return res; +} + @@ -27908,14 +15921,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +{ + u32 curtime = rtw_get_current_time(); + -+_func_enter_; ++ + pibss[0] = 0x02; //in ad-hoc mode bit1 must set to 1 + pibss[1] = 0x11; + pibss[2] = 0x87; + pibss[3] = (u8)(curtime & 0xff) ;//p[0]; + pibss[4] = (u8)((curtime>>8) & 0xff) ;//p[1]; + pibss[5] = (u8)((curtime>>16) & 0xff) ;//p[2]; -+_func_exit_; ++ + return; +} + @@ -27928,49 +15941,49 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +u16 rtw_get_capability(WLAN_BSSID_EX *bss) +{ + u16 val; -+_func_enter_; + -+ _rtw_memcpy((u8 *)&val, rtw_get_capability_from_ie(bss->IEs), 2); + -+_func_exit_; ++ _rtw_memcpy((u8 *)&val, rtw_get_capability_from_ie(bss->IEs), 2); ++ ++ + return le16_to_cpu(val); +} + +u8 *rtw_get_timestampe_from_ie(u8 *ie) +{ -+ return (ie + 0); ++ return (ie + 0); +} + +u8 *rtw_get_beacon_interval_from_ie(u8 *ie) +{ -+ return (ie + 8); ++ return (ie + 8); +} + + +int rtw_init_mlme_priv (_adapter *padapter)//(struct mlme_priv *pmlmepriv) +{ + int res; -+_func_enter_; ++ + res = _rtw_init_mlme_priv(padapter);// (pmlmepriv); -+_func_exit_; ++ + return res; +} + +void rtw_free_mlme_priv (struct mlme_priv *pmlmepriv) +{ -+_func_enter_; ++ + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("rtw_free_mlme_priv\n")); + _rtw_free_mlme_priv (pmlmepriv); -+_func_exit_; ++ +} + +int rtw_enqueue_network(_queue *queue, struct wlan_network *pnetwork); +int rtw_enqueue_network(_queue *queue, struct wlan_network *pnetwork) +{ + int res; -+_func_enter_; ++ + res = _rtw_enqueue_network(queue, pnetwork); -+_func_exit_; ++ + return res; +} + @@ -27978,9 +15991,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +static struct wlan_network *rtw_dequeue_network(_queue *queue) +{ + struct wlan_network *pnetwork; -+_func_enter_; ++ + pnetwork = _rtw_dequeue_network(queue); -+_func_exit_; ++ + return pnetwork; +} +*/ @@ -27989,39 +16002,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +struct wlan_network *rtw_alloc_network(struct mlme_priv *pmlmepriv )//(_queue *free_queue) +{ + struct wlan_network *pnetwork; -+_func_enter_; ++ + pnetwork = _rtw_alloc_network(pmlmepriv); -+_func_exit_; ++ + return pnetwork; +} + +void rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 is_freeall); +void rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 is_freeall)//(struct wlan_network *pnetwork, _queue *free_queue) +{ -+_func_enter_; ++ + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("rtw_free_network==> ssid = %s \n\n" , pnetwork->network.Ssid.Ssid)); + _rtw_free_network(pmlmepriv, pnetwork, is_freeall); -+_func_exit_; ++ +} + -+void rtw_free_network_nolock(_adapter * padapter, struct wlan_network *pnetwork ); -+void rtw_free_network_nolock(_adapter * padapter, struct wlan_network *pnetwork ) ++void rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork ); ++void rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork ) +{ -+_func_enter_; ++ + //RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("rtw_free_network==> ssid = %s \n\n" , pnetwork->network.Ssid.Ssid)); -+ _rtw_free_network_nolock(&(padapter->mlmepriv), pnetwork); -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_unlink_bss(padapter, pnetwork); -+#endif //CONFIG_IOCTL_CFG80211 -+_func_exit_; ++ _rtw_free_network_nolock(pmlmepriv, pnetwork); ++ +} + + +void rtw_free_network_queue(_adapter* dev, u8 isfreeall) +{ -+_func_enter_; ++ + _rtw_free_network_queue(dev, isfreeall); -+_func_exit_; ++ +} + +/* @@ -28038,143 +16048,97 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + +int rtw_is_same_ibss(_adapter *adapter, struct wlan_network *pnetwork) +{ -+ int ret=_TRUE; ++ int ret=true; + struct security_priv *psecuritypriv = &adapter->securitypriv; + + if ( (psecuritypriv->dot11PrivacyAlgrthm != _NO_PRIVACY_ ) && + ( pnetwork->network.Privacy == 0 ) ) + { -+ ret=_FALSE; ++ ret=false; + } + else if((psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_ ) && + ( pnetwork->network.Privacy == 1 ) ) + { -+ ret=_FALSE; ++ ret=false; + } + else + { -+ ret=_TRUE; ++ ret=true; + } -+ ++ + return ret; -+ ++ +} + ++inline int is_same_ess(WLAN_BSSID_EX *a, WLAN_BSSID_EX *b); +inline int is_same_ess(WLAN_BSSID_EX *a, WLAN_BSSID_EX *b) +{ + //RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("(%s,%d)(%s,%d)\n", + // a->Ssid.Ssid,a->Ssid.SsidLength,b->Ssid.Ssid,b->Ssid.SsidLength)); -+ return (a->Ssid.SsidLength == b->Ssid.SsidLength) -+ && _rtw_memcmp(a->Ssid.Ssid, b->Ssid.Ssid, a->Ssid.SsidLength)==_TRUE; ++ return (a->Ssid.SsidLength == b->Ssid.SsidLength) ++ && _rtw_memcmp(a->Ssid.Ssid, b->Ssid.Ssid, a->Ssid.SsidLength)==true; +} + -+int is_same_network(WLAN_BSSID_EX *src, WLAN_BSSID_EX *dst, u8 feature) ++int is_same_network(WLAN_BSSID_EX *src, WLAN_BSSID_EX *dst) +{ + u16 s_cap, d_cap; -+ -+_func_enter_; + -+ if(rtw_bug_check(dst, src, &s_cap, &d_cap)==_FALSE) -+ return _FALSE; ++ ++ ++ if(rtw_bug_check(dst, src, &s_cap, &d_cap)==false) ++ return false; + + _rtw_memcpy((u8 *)&s_cap, rtw_get_capability_from_ie(src->IEs), 2); + _rtw_memcpy((u8 *)&d_cap, rtw_get_capability_from_ie(dst->IEs), 2); + -+ ++ + s_cap = le16_to_cpu(s_cap); + d_cap = le16_to_cpu(d_cap); -+ -+_func_exit_; + -+#ifdef CONFIG_P2P -+ if ((feature == 1) && // 1: P2P supported -+ (_rtw_memcmp(src->MacAddress, dst->MacAddress, ETH_ALEN) == _TRUE) -+ ) { -+ return _TRUE; -+ } -+#endif ++ + + return ((src->Ssid.SsidLength == dst->Ssid.SsidLength) && + // (src->Configuration.DSConfig == dst->Configuration.DSConfig) && -+ ( (_rtw_memcmp(src->MacAddress, dst->MacAddress, ETH_ALEN)) == _TRUE) && -+ ( (_rtw_memcmp(src->Ssid.Ssid, dst->Ssid.Ssid, src->Ssid.SsidLength)) == _TRUE) && -+ ((s_cap & WLAN_CAPABILITY_IBSS) == ++ ( (_rtw_memcmp(src->MacAddress, dst->MacAddress, ETH_ALEN)) == true) && ++ ( (_rtw_memcmp(src->Ssid.Ssid, dst->Ssid.Ssid, src->Ssid.SsidLength)) == true) && ++ ((s_cap & WLAN_CAPABILITY_IBSS) == + (d_cap & WLAN_CAPABILITY_IBSS)) && -+ ((s_cap & WLAN_CAPABILITY_BSS) == ++ ((s_cap & WLAN_CAPABILITY_BSS) == + (d_cap & WLAN_CAPABILITY_BSS))); -+ -+} + -+struct wlan_network *_rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network) -+{ -+ _list *phead, *plist; -+ struct wlan_network *found = NULL; -+ -+ phead = get_list_head(scanned_queue); -+ plist = get_next(phead); -+ -+ while (plist != phead) { -+ found = LIST_CONTAINOR(plist, struct wlan_network ,list); -+ -+ if (is_same_network(&network->network, &found->network,0)) -+ break; -+ -+ plist = get_next(plist); -+ } -+ -+ if(plist == phead) -+ found = NULL; -+exit: -+ return found; -+} -+ -+struct wlan_network *rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network) -+{ -+ _irqL irqL; -+ struct wlan_network *found = NULL; -+ -+ if (scanned_queue == NULL || network == NULL) -+ goto exit; -+ -+ _enter_critical_bh(&scanned_queue->lock, &irqL); -+ found = _rtw_find_same_network(scanned_queue, network); -+ _exit_critical_bh(&scanned_queue->lock, &irqL); -+ -+exit: -+ return found; +} + +struct wlan_network * rtw_get_oldest_wlan_network(_queue *scanned_queue) +{ + _list *plist, *phead; + -+ ++ + struct wlan_network *pwlan = NULL; + struct wlan_network *oldest = NULL; -+_func_enter_; ++ + phead = get_list_head(scanned_queue); -+ ++ + plist = get_next(phead); + + while(1) + { -+ -+ if (rtw_end_of_queue_search(phead,plist)== _TRUE) ++ ++ if (rtw_end_of_queue_search(phead,plist)== true) + break; -+ ++ + pwlan= LIST_CONTAINOR(plist, struct wlan_network, list); + -+ if(pwlan->fixed!=_TRUE) -+ { ++ if(pwlan->fixed!=true) ++ { + if (oldest == NULL ||time_after(oldest->last_scanned, pwlan->last_scanned)) + oldest = pwlan; + } -+ ++ + plist = get_next(plist); + } -+_func_exit_; ++ + return oldest; -+ ++ +} + +void update_network(WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src, @@ -28192,16 +16156,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + u8 sq_final; + long rssi_final; + -+_func_enter_; ++ + +#ifdef CONFIG_ANTENNA_DIVERSITY + rtw_hal_antdiv_rssi_compared(padapter, dst, src); //this will update src.Rssi, need consider again +#endif + -+ #if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) && 1 ++ #if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 + if(strcmp(dst->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { -+ DBG_871X(FUNC_ADPT_FMT" %s("MAC_FMT", ch%u) ss_ori:%3u, sq_ori:%3u, rssi_ori:%3ld, ss_smp:%3u, sq_smp:%3u, rssi_smp:%3ld\n" -+ , FUNC_ADPT_ARG(padapter) ++ DBG_871X("%s %s("MAC_FMT", ch%u) ss_ori:%3u, sq_ori:%3u, rssi_ori:%3ld, ss_smp:%3u, sq_smp:%3u, rssi_smp:%3ld\n" ++ , __FUNCTION__ + , src->Ssid.Ssid, MAC_ARG(src->MacAddress), src->Configuration.DSConfig + ,ss_ori, sq_ori, rssi_ori + ,ss_smp, sq_smp, rssi_smp @@ -28210,7 +16174,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + #endif + + /* The rule below is 1/5 for sample value, 4/5 for history value */ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) && is_same_network(&(padapter->mlmepriv.cur_network.network), src, 0)) { ++ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) && is_same_network(&(padapter->mlmepriv.cur_network.network), src)) { + /* Take the recvpriv's value for the connected AP*/ + ss_final = padapter->recvpriv.signal_strength; + sq_final = padapter->recvpriv.signal_qual; @@ -28231,23 +16195,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + sq_final = dst->PhyInfo.SignalQuality; + rssi_final = dst->Rssi; + } -+ ++ + } + -+ if (update_ie) { -+ dst->Reserved[0] = src->Reserved[0]; -+ dst->Reserved[1] = src->Reserved[1]; ++ if (update_ie) + _rtw_memcpy((u8 *)dst, (u8 *)src, get_WLAN_BSSID_EX_sz(src)); -+ } + + dst->PhyInfo.SignalStrength = ss_final; + dst->PhyInfo.SignalQuality = sq_final; + dst->Rssi = rssi_final; + -+ #if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) && 1 ++ #if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 + if(strcmp(dst->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { -+ DBG_871X(FUNC_ADPT_FMT" %s("MAC_FMT"), SignalStrength:%u, SignalQuality:%u, RawRSSI:%ld\n" -+ , FUNC_ADPT_ARG(padapter) ++ DBG_871X("%s %s("MAC_FMT"), SignalStrength:%u, SignalQuality:%u, RawRSSI:%ld\n" ++ , __FUNCTION__ + , dst->Ssid.Ssid, MAC_ARG(dst->MacAddress), dst->PhyInfo.SignalStrength, dst->PhyInfo.SignalQuality, dst->Rssi); + } + #endif @@ -28256,7 +16217,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +// DBG_871X("update_network: rssi=0x%lx dst->Rssi=%d ,dst->Rssi=0x%lx , src->Rssi=0x%lx",(dst->Rssi+src->Rssi)/2,dst->Rssi,dst->Rssi,src->Rssi); + if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) && is_same_network(&(padapter->mlmepriv.cur_network.network), src)) + { -+ ++ + //DBG_871X("b:ssid=%s update_network: src->rssi=0x%d padapter->recvpriv.ui_rssi=%d\n",src->Ssid.Ssid,src->Rssi,padapter->recvpriv.signal); + if(padapter->recvpriv.signal_qual_data.total_num++ >= PHY_LINKQUALITY_SLID_WIN_MAX) + { @@ -28264,9 +16225,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + last_evm = padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index]; + padapter->recvpriv.signal_qual_data.total_val -= last_evm; + } -+ padapter->recvpriv.signal_qual_data.total_val += query_rx_pwr_percentage(src->Rssi); ++ padapter->recvpriv.signal_qual_data.total_val += query_rx_pwr_percentage(src->Rssi); + -+ padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = query_rx_pwr_percentage(src->Rssi); ++ padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = query_rx_pwr_percentage(src->Rssi); + if(padapter->recvpriv.signal_qual_data.index >= PHY_LINKQUALITY_SLID_WIN_MAX) + padapter->recvpriv.signal_qual_data.index = 0; + @@ -28281,39 +16242,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + else{ +// DBG_871X("ELSE:ssid=%s update_network: src->rssi=0x%d dst->rssi=%d\n",src->Ssid.Ssid,src->Rssi,dst->Rssi); + src->Rssi=(src->Rssi +dst->Rssi)/2;//dBM -+ } ++ } + +// DBG_871X("a:update_network: src->rssi=0x%d padapter->recvpriv.ui_rssi=%d\n",src->Rssi,padapter->recvpriv.signal); + +#endif + -+_func_exit_; ++ +} + +static void update_current_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork) +{ + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+_func_enter_; + -+ rtw_bug_check(&(pmlmepriv->cur_network.network), -+ &(pmlmepriv->cur_network.network), -+ &(pmlmepriv->cur_network.network), ++ ++ ++ rtw_bug_check(&(pmlmepriv->cur_network.network), ++ &(pmlmepriv->cur_network.network), ++ &(pmlmepriv->cur_network.network), + &(pmlmepriv->cur_network.network)); + -+ if ( (check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) && (is_same_network(&(pmlmepriv->cur_network.network), pnetwork, 0))) ++ if ( (check_fwstate(pmlmepriv, _FW_LINKED)== true) && (is_same_network(&(pmlmepriv->cur_network.network), pnetwork))) + { + //RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,"Same Network\n"); + + //if(pmlmepriv->cur_network.network.IELength<= pnetwork->IELength) + { -+ update_network(&(pmlmepriv->cur_network.network), pnetwork,adapter, _TRUE); -+ rtw_update_protection(adapter, (pmlmepriv->cur_network.network.IEs) + sizeof (NDIS_802_11_FIXED_IEs), ++ update_network(&(pmlmepriv->cur_network.network), pnetwork,adapter, true); ++ rtw_update_protection(adapter, (pmlmepriv->cur_network.network.IEs) + sizeof (NDIS_802_11_FIXED_IEs), + pmlmepriv->cur_network.network.IELength); + } + } + -+_func_exit_; ++ + +} + @@ -28328,77 +16289,48 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +{ + _irqL irqL; + _list *plist, *phead; -+ ULONG bssid_ex_sz; ++ u32 bssid_ex_sz; + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(adapter->wdinfo); -+#endif // CONFIG_P2P + _queue *queue = &(pmlmepriv->scanned_queue); + struct wlan_network *pnetwork = NULL; + struct wlan_network *oldest = NULL; -+ int target_find = 0; -+ u8 feature = 0; + -+_func_enter_; ++ + + _enter_critical_bh(&queue->lock, &irqL); + phead = get_list_head(queue); + plist = get_next(phead); + -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ feature = 1; // p2p enable -+#endif -+ + while(1) + { -+ if (rtw_end_of_queue_search(phead,plist)== _TRUE) ++ if (rtw_end_of_queue_search(phead,plist)== true) + break; + -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); + + rtw_bug_check(pnetwork, pnetwork, pnetwork, pnetwork); + -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && -+ (_rtw_memcmp(pnetwork->network.MacAddress, target->MacAddress, ETH_ALEN) == _TRUE)) -+ { -+ target_find = 1; ++ if (is_same_network(&(pnetwork->network), target)) + break; -+ } -+#endif + -+ if (is_same_network(&(pnetwork->network), target, feature)) -+ { -+ target_find = 1; -+ break; -+ } -+ -+ if (rtw_roam_flags(adapter)) { -+ /* TODO: don't select netowrk in the same ess as oldest if it's new enough*/ -+ } -+ -+ if (oldest == NULL || time_after(oldest->last_scanned, pnetwork->last_scanned)) ++ if ((oldest == ((struct wlan_network *)0)) || ++ time_after(oldest->last_scanned, pnetwork->last_scanned)) + oldest = pnetwork; + + plist = get_next(plist); + + } -+ -+ ++ ++ + /* If we didn't find a match, then get a new network slot to initialize + * with this beacon's information */ -+ //if (rtw_end_of_queue_search(phead,plist)== _TRUE) { -+ if (!target_find) { -+ if (_rtw_queue_empty(&(pmlmepriv->free_bss_pool)) == _TRUE) { ++ if (rtw_end_of_queue_search(phead,plist)== true) { ++ ++ if (_rtw_queue_empty(&(pmlmepriv->free_bss_pool)) == true) { + /* If there are no more slots, expire the oldest */ + //list_del_init(&oldest->list); + pnetwork = oldest; -+ if(pnetwork==NULL){ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n\n\nsomething wrong here\n\n\n")); -+ goto exit; -+ } ++ +#ifdef CONFIG_ANTENNA_DIVERSITY + //target->PhyInfo.Optimum_antenna = pHalData->CurAntenna;//optimum_antenna=>For antenna diversity + rtw_hal_get_def_var(adapter, HAL_DEF_CURRENT_ANTENNA, &(target->PhyInfo.Optimum_antenna)); @@ -28406,11 +16338,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + _rtw_memcpy(&(pnetwork->network), target, get_WLAN_BSSID_EX_sz(target)); + //pnetwork->last_scanned = rtw_get_current_time(); + // variable initialize -+ pnetwork->fixed = _FALSE; ++ pnetwork->fixed = false; + pnetwork->last_scanned = rtw_get_current_time(); + -+ pnetwork->network_type = 0; -+ pnetwork->aid=0; ++ pnetwork->network_type = 0; ++ pnetwork->aid=0; + pnetwork->join_res=0; + + /* bss info not receving from the right channel */ @@ -28422,7 +16354,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + + pnetwork = rtw_alloc_network(pmlmepriv); // will update scan_time + -+ if(pnetwork==NULL){ ++ if(pnetwork==NULL){ + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n\n\nsomething wrong here\n\n\n")); + goto exit; + } @@ -28441,32 +16373,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + if (pnetwork->network.PhyInfo.SignalQuality == 101) + pnetwork->network.PhyInfo.SignalQuality = 0; + -+ rtw_list_insert_tail(&(pnetwork->list),&(queue->queue)); ++ rtw_list_insert_tail(&(pnetwork->list),&(queue->queue)); + + } + } + else { + /* we have an entry and we are going to update it. But this entry may -+ * be already expired. In this case we do the same as we found a new ++ * be already expired. In this case we do the same as we found a new + * net and call the new_net handler + */ -+ bool update_ie = _TRUE; ++ bool update_ie = true; + + pnetwork->last_scanned = rtw_get_current_time(); + + //target.Reserved[0]==1, means that scaned network is a bcn frame. + if((pnetwork->network.IELength>target->IELength) && (target->Reserved[0]==1)) -+ update_ie = _FALSE; -+ -+ // probe resp(3) > beacon(1) > probe req(2) -+ if ((target->Reserved[0] != 2) && -+ (target->Reserved[0] >= pnetwork->network.Reserved[0]) -+ ) { -+ update_ie = _TRUE; -+ } -+ else { -+ update_ie = _FALSE; -+ } ++ update_ie = false; + + update_network(&(pnetwork->network), target,adapter, update_ie); + } @@ -28474,7 +16396,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +exit: + _exit_critical_bh(&queue->lock, &irqL); + -+_func_exit_; ++ +} + +void rtw_add_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork); @@ -28484,22 +16406,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + struct mlme_priv *pmlmepriv = &(((_adapter *)adapter)->mlmepriv); + //_queue *queue = &(pmlmepriv->scanned_queue); + -+_func_enter_; ++ + + //_enter_critical_bh(&queue->lock, &irqL); + + #if defined(CONFIG_P2P) && defined(CONFIG_P2P_REMOVE_GROUP_INFO) -+ if (adapter->registrypriv.wifi_spec == 0) -+ rtw_WLAN_BSSID_EX_remove_p2p_attr(pnetwork, P2P_ATTR_GROUP_INFO); ++ rtw_WLAN_BSSID_EX_remove_p2p_attr(pnetwork, P2P_ATTR_GROUP_INFO); + #endif -+ ++ + update_current_network(adapter, pnetwork); -+ ++ + rtw_update_scanned_network(adapter, pnetwork); + + //_exit_critical_bh(&queue->lock, &irqL); -+ -+_func_exit_; ++ ++ +} + +//select the desired network based on the capability of the (i)bss. @@ -28519,8 +16440,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + //u8 wps_ie[512]; + uint wps_ielen; + -+ int bselected = _TRUE; -+ ++ int bselected = true; ++ + desired_encmode = psecuritypriv->ndisencryptstatus; + privacy = pnetwork->network.Privacy; + @@ -28528,43 +16449,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + { + if(rtw_get_wps_ie(pnetwork->network.IEs+_FIXED_IE_LENGTH_, pnetwork->network.IELength-_FIXED_IE_LENGTH_, NULL, &wps_ielen)!=NULL) + { -+ return _TRUE; ++ return true; + } + else -+ { -+ return _FALSE; -+ } ++ { ++ return false; ++ } + } + if (adapter->registrypriv.wifi_spec == 1) //for correct flow of 8021X to do.... + { -+ u8 *p=NULL; -+ uint ie_len=0; -+ + if ((desired_encmode == Ndis802_11EncryptionDisabled) && (privacy != 0)) -+ bselected = _FALSE; -+ -+ if ( psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) { -+ p = rtw_get_ie(pnetwork->network.IEs + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pnetwork->network.IELength - _BEACON_IE_OFFSET_)); -+ if (p && ie_len>0) { -+ bselected = _TRUE; -+ } else { -+ bselected = _FALSE; -+ } -+ } ++ bselected = false; + } -+ + -+ if ((desired_encmode != Ndis802_11EncryptionDisabled) && (privacy == 0)) { ++ ++ if ((desired_encmode != Ndis802_11EncryptionDisabled) && (privacy == 0)) { + DBG_871X("desired_encmode: %d, privacy: %d\n", desired_encmode, privacy); -+ bselected = _FALSE; -+ } ++ bselected = false; ++ } + -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) + { + if(pnetwork->network.InfrastructureMode != pmlmepriv->cur_network.network.InfrastructureMode) -+ bselected = _FALSE; -+ } -+ ++ bselected = false; ++ } ++ + + return bselected; +} @@ -28573,10 +16482,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +void rtw_atimdone_event_callback(_adapter *adapter , u8 *pbuf) +{ + -+_func_enter_; -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("receive atimdone_evet\n")); -+_func_exit_; -+ return; ++ ++ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("receive atimdone_evet\n")); ++ ++ return; +} + + @@ -28587,31 +16496,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + WLAN_BSSID_EX *pnetwork; + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + -+_func_enter_; ++ + + pnetwork = (WLAN_BSSID_EX *)pbuf; + + RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_survey_event_callback, ssid=%s\n", pnetwork->Ssid.Ssid)); + -+#ifdef CONFIG_RTL8712 -+ //endian_convert -+ pnetwork->Length = le32_to_cpu(pnetwork->Length); -+ pnetwork->Ssid.SsidLength = le32_to_cpu(pnetwork->Ssid.SsidLength); -+ pnetwork->Privacy =le32_to_cpu( pnetwork->Privacy); -+ pnetwork->Rssi = le32_to_cpu(pnetwork->Rssi); -+ pnetwork->NetworkTypeInUse =le32_to_cpu(pnetwork->NetworkTypeInUse); -+ pnetwork->Configuration.ATIMWindow = le32_to_cpu(pnetwork->Configuration.ATIMWindow); -+ pnetwork->Configuration.BeaconPeriod = le32_to_cpu(pnetwork->Configuration.BeaconPeriod); -+ pnetwork->Configuration.DSConfig =le32_to_cpu(pnetwork->Configuration.DSConfig); -+ pnetwork->Configuration.FHConfig.DwellTime=le32_to_cpu(pnetwork->Configuration.FHConfig.DwellTime); -+ pnetwork->Configuration.FHConfig.HopPattern=le32_to_cpu(pnetwork->Configuration.FHConfig.HopPattern); -+ pnetwork->Configuration.FHConfig.HopSet=le32_to_cpu(pnetwork->Configuration.FHConfig.HopSet); -+ pnetwork->Configuration.FHConfig.Length=le32_to_cpu(pnetwork->Configuration.FHConfig.Length); -+ pnetwork->Configuration.Length = le32_to_cpu(pnetwork->Configuration.Length); -+ pnetwork->InfrastructureMode = le32_to_cpu(pnetwork->InfrastructureMode); -+ pnetwork->IELength = le32_to_cpu(pnetwork->IELength); -+#endif -+ + len = get_WLAN_BSSID_EX_sz(pnetwork); + if(len > (sizeof(WLAN_BSSID_EX))) + { @@ -28623,21 +16513,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + _enter_critical_bh(&pmlmepriv->lock, &irqL); + + // update IBSS_network 's timestamp -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == _TRUE) ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == true) + { + //RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,"rtw_survey_event_callback : WIFI_ADHOC_MASTER_STATE \n\n"); + if(_rtw_memcmp(&(pmlmepriv->cur_network.network.MacAddress), pnetwork->MacAddress, ETH_ALEN)) + { + struct wlan_network* ibss_wlan = NULL; + _irqL irqL; -+ ++ + _rtw_memcpy(pmlmepriv->cur_network.network.IEs, pnetwork->IEs, 8); + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + ibss_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->MacAddress); + if(ibss_wlan) + { -+ _rtw_memcpy(ibss_wlan->network.IEs , pnetwork->IEs, 8); -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ _rtw_memcpy(ibss_wlan->network.IEs , pnetwork->IEs, 8); ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + goto exit; + } + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); @@ -28645,38 +16535,43 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + } + + // lock pmlmepriv->lock when you accessing network_q -+ if ((check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) == _FALSE) -+ { -+ if( pnetwork->Ssid.Ssid[0] == 0 ) ++ if ((check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) == false) ++ { ++ if( pnetwork->Ssid.Ssid[0] == 0 ) + { + pnetwork->Ssid.SsidLength = 0; -+ } ++ } + rtw_add_network(adapter, pnetwork); -+ } ++ } ++ ++exit: + -+exit: -+ + _exit_critical_bh(&pmlmepriv->lock, &irqL); + -+_func_exit_; + -+ return; ++ ++ return; +} + ++ ++ +void rtw_surveydone_event_callback(_adapter *adapter, u8 *pbuf) +{ + _irqL irqL; -+ u8 timer_cancelled; + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + +#ifdef CONFIG_MLME_EXT ++ + mlmeext_surveydone_event_callback(adapter); ++ +#endif + -+_func_enter_; ++ + + _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ if (pmlmepriv->wps_probe_req_ie) { ++ ++ if(pmlmepriv->wps_probe_req_ie) ++ { + u32 free_len = pmlmepriv->wps_probe_req_ie_len; + pmlmepriv->wps_probe_req_ie_len = 0; + rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len); @@ -28685,68 +16580,70 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + + RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_surveydone_event_callback: fw_state:%x\n\n", get_fwstate(pmlmepriv))); + -+ if (check_fwstate(pmlmepriv,_FW_UNDER_SURVEY) == _FALSE) { -+ DBG_871X(FUNC_ADPT_FMT" fw_state:0x%x\n", FUNC_ADPT_ARG(adapter), get_fwstate(pmlmepriv)); -+ //rtw_warn_on(1); ++ if (check_fwstate(pmlmepriv,_FW_UNDER_SURVEY)) ++ { ++ u8 timer_cancelled; ++ ++ _cancel_timer(&pmlmepriv->scan_to_timer, &timer_cancelled); ++ ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); + } ++ else { + -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ _cancel_timer(&pmlmepriv->scan_to_timer, &timer_cancelled); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("nic status =%x, survey done event comes too late!\n", get_fwstate(pmlmepriv))); ++ } + + #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS + rtw_set_signal_stat_timer(&adapter->recvpriv); + #endif + -+ if(pmlmepriv->to_join == _TRUE) ++ if(pmlmepriv->to_join == true) + { -+ if((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==_TRUE) ) ++ if((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==true) ) + { -+ if(check_fwstate(pmlmepriv, _FW_LINKED)==_FALSE) ++ if(check_fwstate(pmlmepriv, _FW_LINKED)==false) + { -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ ++ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); ++ + if(rtw_select_and_join_from_scanned_queue(pmlmepriv)==_SUCCESS) + { -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); ++ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT ); + } + else + { -+ WLAN_BSSID_EX *pdev_network = &(adapter->registrypriv.dev_network); ++ WLAN_BSSID_EX *pdev_network = &(adapter->registrypriv.dev_network); + u8 *pibss = adapter->registrypriv.dev_network.MacAddress; + + //pmlmepriv->fw_state ^= _FW_UNDER_SURVEY;//because don't set assoc_timer + _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); + + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("switching to adhoc master\n")); -+ ++ + _rtw_memset(&pdev_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); + _rtw_memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); -+ ++ + rtw_update_registrypriv_dev_network(adapter); + rtw_generate_random_ibss(pibss); + -+ + pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE; -+ -+ if (rtw_create_ibss_cmd(adapter, 0) != _SUCCESS) -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("Error=>rtw_create_ibss_cmd status FAIL\n")); + -+ pmlmepriv->to_join = _FALSE; -+ } -+ } ++ if(rtw_createbss_cmd(adapter)!=_SUCCESS) ++ { ++ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Error=>rtw_createbss_cmd status FAIL\n")); ++ } ++ ++ pmlmepriv->to_join = false; ++ } ++ } + } + else + { + int s_ret; + set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ pmlmepriv->to_join = _FALSE; ++ pmlmepriv->to_join = false; + if(_SUCCESS == (s_ret=rtw_select_and_join_from_scanned_queue(pmlmepriv))) + { -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); ++ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); + } + else if(s_ret == 2)//there is no need to wait for join + { @@ -28755,61 +16652,51 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + } + else + { -+ DBG_871X("try_to_join, but select scanning queue fail, to_roam:%d\n", rtw_to_roam(adapter)); -+ -+ if (rtw_to_roam(adapter) != 0) { -+ if(rtw_dec_to_roam(adapter) == 0 ++ DBG_871X("try_to_join, but select scanning queue fail, to_roaming:%d\n", rtw_to_roaming(adapter)); ++ #ifdef CONFIG_LAYER2_ROAMING ++ if (rtw_to_roaming(adapter) != 0) { ++ if( --pmlmepriv->to_roaming == 0 + || _SUCCESS != rtw_sitesurvey_cmd(adapter, &pmlmepriv->assoc_ssid, 1, NULL, 0) + ) { -+ rtw_set_to_roam(adapter, 0); ++ rtw_set_roaming(adapter, 0); +#ifdef CONFIG_INTEL_WIDI + if(adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) + { + _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); -+ intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL, 0); ++ intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL); + DBG_871X("change to widi listen\n"); + } +#endif // CONFIG_INTEL_WIDI + rtw_free_assoc_resources(adapter, 1); + rtw_indicate_disconnect(adapter); + } else { -+ pmlmepriv->to_join = _TRUE; ++ pmlmepriv->to_join = true; + } + } -+ else -+ { -+ rtw_indicate_disconnect(adapter); -+ } ++ #endif + _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); + } + } -+ } else { -+ if (rtw_chk_roam_flags(adapter, RTW_ROAM_ACTIVE)) { -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, _FW_LINKED)) -+ { -+ if (rtw_select_roaming_candidate(pmlmepriv) == _SUCCESS) { -+ receive_disconnect(adapter, pmlmepriv->cur_network.network.MacAddress -+ , WLAN_REASON_ACTIVE_ROAM); -+ } -+ } -+ } + } -+ ++ ++ indicate_wx_scan_complete_event(adapter); + //DBG_871X("scan complete in %dms\n",rtw_get_passing_time_ms(pmlmepriv->scan_start_time)); + + _exit_critical_bh(&pmlmepriv->lock, &irqL); + +#ifdef CONFIG_P2P_PS -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { + p2p_ps_wk_cmd(adapter, P2P_PS_SCAN_DONE, 0); + } +#endif // CONFIG_P2P_PS + + rtw_os_xmit_schedule(adapter); -+#ifdef CONFIG_CONCURRENT_MODE ++#ifdef CONFIG_CONCURRENT_MODE + rtw_os_xmit_schedule(adapter->pbuddy_adapter); +#endif ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ dc_resume_xmit(adapter); ++#endif + +#ifdef CONFIG_DRVEXT_MODULE_WSC + drvext_surveydone_callback(&adapter->drvextpriv); @@ -28817,9 +16704,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + +#ifdef DBG_CONFIG_ERROR_DETECT + { -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + if(pmlmeext->sitesurvey_res.bss_cnt == 0){ -+ //rtw_hal_sreset_reset(adapter); ++ rtw_hal_sreset_reset(adapter); + } + } +#endif @@ -28828,33 +16715,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + rtw_cfg80211_surveydone_event_callback(adapter); +#endif //CONFIG_IOCTL_CFG80211 + -+ rtw_indicate_scan_done(adapter, _FALSE); + -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_IOCTL_CFG80211) -+ if (adapter->pbuddy_adapter) { -+ _adapter *buddy_adapter = adapter->pbuddy_adapter; -+ struct mlme_priv *buddy_mlme = &(buddy_adapter->mlmepriv); -+ struct rtw_wdev_priv *buddy_wdev_priv = adapter_wdev_data(buddy_adapter); -+ bool indicate_buddy_scan = _FALSE; -+ -+ _enter_critical_bh(&buddy_wdev_priv->scan_req_lock, &irqL); -+ if (buddy_wdev_priv->scan_request && buddy_mlme->scanning_via_buddy_intf == _TRUE) { -+ buddy_mlme->scanning_via_buddy_intf = _FALSE; -+ clr_fwstate(buddy_mlme, _FW_UNDER_SURVEY); -+ indicate_buddy_scan = _TRUE; -+ } -+ _exit_critical_bh(&buddy_wdev_priv->scan_req_lock, &irqL); -+ -+ if (indicate_buddy_scan == _TRUE) { -+ #ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_surveydone_event_callback(buddy_adapter); -+ #endif -+ rtw_indicate_scan_done(buddy_adapter, _FALSE); -+ } -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+_func_exit_; + +} + @@ -28874,9 +16735,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + _queue *free_queue = &pmlmepriv->free_bss_pool; + _queue *scan_queue = &pmlmepriv->scanned_queue; + _list *plist, *phead, *ptemp; -+ -+_func_enter_; -+ ++ ++ ++ + RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, ("+free_scanqueue\n")); + _enter_critical_bh(&scan_queue->lock, &irqL0); + _enter_critical_bh(&free_queue->lock, &irqL); @@ -28892,21 +16753,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + plist =ptemp; + pmlmepriv->num_of_scanned --; + } -+ ++ + _exit_critical_bh(&free_queue->lock, &irqL); + _exit_critical_bh(&scan_queue->lock, &irqL0); -+ -+_func_exit_; ++ ++ +} + -+void rtw_reset_rx_info(struct debug_priv *pdbgpriv){ -+ pdbgpriv->dbg_rx_ampdu_drop_count = 0; -+ pdbgpriv->dbg_rx_ampdu_forced_indicate_count = 0; -+ pdbgpriv->dbg_rx_ampdu_loss_count = 0; -+ pdbgpriv->dbg_rx_dup_mgt_frame_drop_count = 0; -+ pdbgpriv->dbg_rx_ampdu_window_shift_cnt = 0; -+} -+ +/* +*rtw_free_assoc_resources: the caller has to lock pmlmepriv->lock +*/ @@ -28917,73 +16770,63 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct sta_priv *pstapriv = &adapter->stapriv; + struct wlan_network *tgt_network = &pmlmepriv->cur_network; -+ struct dvobj_priv *psdpriv = adapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; + -+ +#ifdef CONFIG_TDLS + struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; +#endif //CONFIG_TDLS -+_func_enter_; ++ + + RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, ("+rtw_free_assoc_resources\n")); + RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("tgt_network->network.MacAddress="MAC_FMT" ssid=%s\n", + MAC_ARG(tgt_network->network.MacAddress), tgt_network->network.Ssid.Ssid)); + -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { ++ if(check_fwstate( pmlmepriv, WIFI_STATION_STATE|WIFI_AP_STATE)) ++ { + struct sta_info* psta; -+ ++ + psta = rtw_get_stainfo(&adapter->stapriv, tgt_network->network.MacAddress); + +#ifdef CONFIG_TDLS -+ if (ptdlsinfo->link_established == _TRUE) { -+ rtw_tdls_cmd(adapter, NULL, TDLS_RS_RCR); ++ if(ptdlsinfo->setup_state != TDLS_STATE_NONE) ++ { ++ rtw_tdls_cmd(adapter, myid(&(adapter->eeprompriv)), TDLS_RS_RCR); + rtw_reset_tdls_info(adapter); + rtw_free_all_stainfo(adapter); -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); + } + else +#endif //CONFIG_TDLS + { -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); + rtw_free_stainfo(adapter, psta); + } + -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ + } + -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE)) { ++ if(check_fwstate( pmlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE|WIFI_AP_STATE)) ++ { + struct sta_info* psta; -+ ++ + rtw_free_all_stainfo(adapter); + + psta = rtw_get_bcmc_stainfo(adapter); -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); + rtw_free_stainfo(adapter, psta); -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); + -+ rtw_init_bcmc_stainfo(adapter); ++ rtw_init_bcmc_stainfo(adapter); + } + + if(lock_scanned_queue) + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ pwlan = _rtw_find_same_network(&pmlmepriv->scanned_queue, tgt_network); -+ if(pwlan) -+ { -+ pwlan->fixed = _FALSE; + -+ DBG_871X("free disconnecting network\n"); -+ rtw_free_network_nolock(adapter, pwlan); -+#ifdef CONFIG_P2P -+ if(!rtw_p2p_chk_state(&adapter->wdinfo, P2P_STATE_NONE)) -+ { -+ rtw_set_scan_deny(adapter, 2000); -+ //rtw_clear_scan_deny(adapter); -+ } -+#endif //CONFIG_P2P -+ } ++ pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); ++ if(pwlan) ++ { ++ pwlan->fixed = false; ++ } + else + { + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("rtw_free_assoc_resources : pwlan== NULL \n\n")); @@ -28993,19 +16836,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + if((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) && (adapter->stapriv.asoc_sta_count== 1)) + /*||check_fwstate(pmlmepriv, WIFI_STATION_STATE)*/) + { -+ if (pwlan) -+ rtw_free_network_nolock(adapter, pwlan); ++ rtw_free_network_nolock(pmlmepriv, pwlan); + } + + if(lock_scanned_queue) + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ adapter->securitypriv.key_mask = 0; + -+ rtw_reset_rx_info(pdbgpriv); ++ pmlmepriv->key_mask = 0; ++ ++ + -+_func_exit_; -+ +} + +/* @@ -29015,14 +16855,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +{ + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+_func_enter_; ++ ++ + + RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("+rtw_indicate_connect\n")); -+ -+ pmlmepriv->to_join = _FALSE; + -+ if(!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) ++ pmlmepriv->to_join = false; ++ ++ if(!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) + { + +#ifdef CONFIG_SW_ANTENNA_DIVERSITY @@ -29033,7 +16873,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + + rtw_led_control(padapter, LED_CTL_LINK); + -+ ++ +#ifdef CONFIG_DRVEXT_MODULE + if(padapter->drvextpriv.enable_wpa) + { @@ -29047,12 +16887,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + + } + -+ rtw_set_to_roam(padapter, 0); ++ rtw_set_roaming(padapter, 0); +#ifdef CONFIG_INTEL_WIDI + if(padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) + { + _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_WK, NULL, 0); ++ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_WK, NULL); + DBG_871X("change to widi listen\n"); + } +#endif // CONFIG_INTEL_WIDI @@ -29060,8 +16900,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + rtw_set_scan_deny(padapter, 3000); + + RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("-rtw_indicate_connect: fw_state=0x%08x\n", get_fwstate(pmlmepriv))); -+ -+_func_exit_; ++ ++ + +} + @@ -29071,40 +16911,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +*/ +void rtw_indicate_disconnect( _adapter *padapter ) +{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + struct sta_info *psta; + struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *wps_ie=NULL; -+ uint wpsie_len=0; + -+_func_enter_; -+ ++ ++ + RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("+rtw_indicate_disconnect\n")); + + _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING|WIFI_UNDER_WPS); + -+ // force to clear cur_network_scanned's SELECTED REGISTRAR -+ if (pmlmepriv->cur_network_scanned) { -+ WLAN_BSSID_EX *current_joined_bss = &(pmlmepriv->cur_network_scanned->network); -+ if (current_joined_bss) { -+ wps_ie=rtw_get_wps_ie(current_joined_bss->IEs +_FIXED_IE_LENGTH_, -+ current_joined_bss->IELength-_FIXED_IE_LENGTH_, NULL, &wpsie_len); -+ if (wps_ie && wpsie_len>0) { -+ u8 *attr = NULL; -+ u32 attr_len; -+ attr=rtw_get_wps_attr(wps_ie, wpsie_len, WPS_ATTR_SELECTED_REGISTRAR, -+ NULL, &attr_len); -+ if (attr) -+ *(attr + 4) = 0; -+ } -+ } -+ } + //DBG_871X("clear wps when %s\n", __func__); + -+ if(rtw_to_roam(padapter) > 0) ++ if(rtw_to_roaming(padapter) > 0) + _clr_fwstate_(pmlmepriv, _FW_LINKED); + +#ifdef CONFIG_WAPI_SUPPORT @@ -29120,20 +16942,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + } +#endif + -+ if(check_fwstate(&padapter->mlmepriv, _FW_LINKED) -+ || (rtw_to_roam(padapter) <= 0) ++ if(check_fwstate(&padapter->mlmepriv, _FW_LINKED) ++ || (rtw_to_roaming(padapter) <= 0) + ) + { + rtw_os_indicate_disconnect(padapter); + + //set ips_deny_time to avoid enter IPS before LPS leave -+ rtw_set_ips_deny(padapter, 3000); ++ padapter->pwrctrlpriv.ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(3000); + + _clr_fwstate_(pmlmepriv, _FW_LINKED); + + rtw_led_control(padapter, LED_CTL_NO_LINK); + + rtw_clear_scan_deny(padapter); ++ + } + +#ifdef CONFIG_P2P_PS @@ -29141,113 +16964,45 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +#endif // CONFIG_P2P_PS + +#ifdef CONFIG_LPS ++#ifdef CONFIG_WOWLAN ++ if(padapter->pwrctrlpriv.wowlan_mode==false) ++#endif //CONFIG_WOWLAN + rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_DISCONNECT, 1); +#endif + -+#ifdef CONFIG_BEAMFORMING -+ beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_LEAVE, cur_network->MacAddress, ETH_ALEN, 1); -+#endif /*CONFIG_BEAMFORMING*/ + -+_func_exit_; +} + +inline void rtw_indicate_scan_done( _adapter *padapter, bool aborted) +{ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ + rtw_os_indicate_scan_done(padapter, aborted); -+ -+#ifdef CONFIG_IPS -+ if (is_primary_adapter(padapter) -+ && (_FALSE == adapter_to_pwrctl(padapter)->bInSuspend) -+ && (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE|WIFI_UNDER_LINKING) == _FALSE)) -+ { -+ struct pwrctrl_priv *pwrpriv; -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ rtw_set_ips_deny(padapter, 0); -+#ifdef CONFIG_IPS_CHECK_IN_WD -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 1); -+#else // !CONFIG_IPS_CHECK_IN_WD -+ _rtw_set_pwr_state_check_timer(pwrpriv, 1); -+#endif // !CONFIG_IPS_CHECK_IN_WD -+ } -+#endif // CONFIG_IPS +} + -+static u32 _rtw_wait_scan_done(_adapter *adapter, u8 abort, u32 timeout_ms) ++void rtw_scan_abort(_adapter *adapter) +{ ++ u32 cnt=0; + u32 start; -+ u32 pass_ms; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + + start = rtw_get_current_time(); -+ -+ pmlmeext->scan_abort = abort; -+ ++ pmlmeext->scan_abort = true; + while (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) -+ && rtw_get_passing_time_ms(start) <= timeout_ms) { ++ && rtw_get_passing_time_ms(start) <= 200) { + -+ if (RTW_CANNOT_RUN(adapter)) ++ if (adapter->bDriverStopped || adapter->bSurpriseRemoved) + break; + + DBG_871X(FUNC_NDEV_FMT"fw_state=_FW_UNDER_SURVEY!\n", FUNC_NDEV_ARG(adapter->pnetdev)); + rtw_msleep_os(20); + } + -+ if (_TRUE == abort) { -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { -+ if (!RTW_CANNOT_RUN(adapter)) -+ DBG_871X(FUNC_NDEV_FMT"waiting for scan_abort time out!\n", FUNC_NDEV_ARG(adapter->pnetdev)); -+ #ifdef CONFIG_PLATFORM_MSTAR -+ /*_clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY);*/ -+ set_survey_timer(pmlmeext, 0); -+ mlme_set_scan_to_timer(pmlmepriv, 50); -+ #endif -+ rtw_indicate_scan_done(adapter, _TRUE); -+ } ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { ++ if (!adapter->bDriverStopped && !adapter->bSurpriseRemoved) ++ DBG_871X(FUNC_NDEV_FMT"waiting for scan_abort time out!\n", FUNC_NDEV_ARG(adapter->pnetdev)); ++ rtw_indicate_scan_done(adapter, true); + } -+ -+ pmlmeext->scan_abort = _FALSE; -+ pass_ms = rtw_get_passing_time_ms(start); -+ -+ return pass_ms; -+ -+} -+ -+void rtw_scan_wait_completed(_adapter *adapter) -+{ -+ u32 scan_to = SCANNING_TIMEOUT; -+ -+#ifdef CONFIG_SCAN_BACKOP -+ if (IsSupported5G(adapter->registrypriv.wireless_mode) -+ && IsSupported24G(adapter->registrypriv.wireless_mode)) /*dual band*/ -+ scan_to = CONC_SCANNING_TIMEOUT_DUAL_BAND; -+ else /*single band*/ -+ scan_to = CONC_SCANNING_TIMEOUT_SINGLE_BAND; -+#endif /* CONFIG_SCAN_BACKOP */ -+ -+ _rtw_wait_scan_done(adapter, _FALSE, scan_to); -+} -+ -+u32 rtw_scan_abort_timeout(_adapter *adapter, u32 timeout_ms) -+{ -+ return _rtw_wait_scan_done(adapter, _TRUE, timeout_ms); -+} -+ -+void rtw_scan_abort_no_wait(_adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) -+ pmlmeext->scan_abort = _TRUE; -+} -+ -+void rtw_scan_abort(_adapter *adapter) -+{ -+ rtw_scan_abort_timeout(adapter, 200); ++ pmlmeext->scan_abort = false; +} + +static struct sta_info *rtw_joinbss_update_stainfo(_adapter *padapter, struct wlan_network *pnetwork) @@ -29266,11 +17021,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + if(psta) //update ptarget_sta + { + DBG_871X("%s\n", __FUNCTION__); -+ ++ + psta->aid = pnetwork->join_res; + +#if 0 //alloc macid when call rtw_alloc_stainfo(), and release macid when call rtw_free_stainfo() -+#ifdef CONFIG_CONCURRENT_MODE ++#ifdef CONFIG_CONCURRENT_MODE + + if(PRIMARY_ADAPTER == padapter->adapter_type) + psta->mac_id=0; @@ -29280,42 +17035,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + psta->mac_id=0; +#endif +#endif //removed -+ -+ update_sta_info(padapter, psta); -+ -+ //update station supportRate -+ psta->bssratelen = rtw_get_rateset_len(pnetwork->network.SupportedRates); -+ _rtw_memcpy(psta->bssrateset, pnetwork->network.SupportedRates, psta->bssratelen); -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ -+ psta->wireless_mode = pmlmeext->cur_wireless_mode; -+ psta->raid = rtw_hal_networktype_to_raid(padapter,psta); ++ //psta->raid = networktype_to_raid(pmlmeext->cur_wireless_mode); ++ psta->raid = rtw_hal_networktype_to_raid(padapter,pmlmeext->cur_wireless_mode); + + + //sta mode -+ rtw_hal_set_odm_var(padapter,HAL_ODM_STA_INFO,psta,_TRUE); ++ rtw_hal_set_odm_var(padapter,HAL_ODM_STA_INFO,psta,true); + + //security related + if(padapter->securitypriv.dot11AuthAlgrthm== dot11AuthAlgrthm_8021X) -+ { -+ padapter->securitypriv.binstallGrpkey=_FALSE; -+ padapter->securitypriv.busetkipkey=_FALSE; -+ padapter->securitypriv.bgrpkey_handshake=_FALSE; ++ { ++ padapter->securitypriv.binstallGrpkey=false; ++ padapter->securitypriv.busetkipkey=false; ++ padapter->securitypriv.bgrpkey_handshake=false; + -+ psta->ieee8021x_blocked=_TRUE; ++ psta->ieee8021x_blocked=true; + psta->dot118021XPrivacy=padapter->securitypriv.dot11PrivacyAlgrthm; -+ ++ + _rtw_memset((u8 *)&psta->dot118021x_UncstKey, 0, sizeof (union Keytype)); -+ ++ + _rtw_memset((u8 *)&psta->dot11tkiprxmickey, 0, sizeof (union Keytype)); + _rtw_memset((u8 *)&psta->dot11tkiptxmickey, 0, sizeof (union Keytype)); -+ ++ + _rtw_memset((u8 *)&psta->dot11txpn, 0, sizeof (union pn48)); -+ psta->dot11txpn.val = psta->dot11txpn.val + 1; -+#ifdef CONFIG_IEEE80211W -+ _rtw_memset((u8 *)&psta->dot11wtxpn, 0, sizeof (union pn48)); -+#endif //CONFIG_IEEE80211W -+ _rtw_memset((u8 *)&psta->dot11rxpn, 0, sizeof (union pn48)); ++ _rtw_memset((u8 *)&psta->dot11rxpn, 0, sizeof (union pn48)); + } + + // Commented by Albert 2012/07/21 @@ -29323,7 +17066,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + // And the Wi-Fi driver shouldn't allow the data packet to be tramsmitted. + if ( padapter->securitypriv.wps_ie_len != 0 ) + { -+ psta->ieee8021x_blocked=_TRUE; ++ psta->ieee8021x_blocked=true; + padapter->securitypriv.wps_ie_len = 0; + } + @@ -29335,7 +17078,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + { + //preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; + preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = _FALSE; ++ preorder_ctrl->enable = false; + preorder_ctrl->indicate_seq = 0xffff; + #ifdef DBG_RX_SEQ + DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u \n", __FUNCTION__, __LINE__, @@ -29343,10 +17086,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + #endif + preorder_ctrl->wend_b= 0xffff; + preorder_ctrl->wsize_b = 64;//max_ampdu_sz;//ex. 32(kbytes) -> wsize_b=32 -+ preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; + } + -+ ++ + bmc_sta = rtw_get_bcmc_stainfo(padapter); + if(bmc_sta) + { @@ -29354,7 +17096,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + { + //preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; + preorder_ctrl = &bmc_sta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = _FALSE; ++ preorder_ctrl->enable = false; + preorder_ctrl->indicate_seq = 0xffff; + #ifdef DBG_RX_SEQ + DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u \n", __FUNCTION__, __LINE__, @@ -29362,28 +17104,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + #endif + preorder_ctrl->wend_b= 0xffff; + preorder_ctrl->wsize_b = 64;//max_ampdu_sz;//ex. 32(kbytes) -> wsize_b=32 -+ preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; + } + } ++ ++ ++ //misc. ++ update_sta_info(padapter, psta); ++ + } -+ ++ + return psta; -+ ++ +} + +//pnetwork : returns from rtw_joinbss_event_callback +//ptarget_wlan: found from scanned_queue +static void rtw_joinbss_update_network(_adapter *padapter, struct wlan_network *ptarget_wlan, struct wlan_network *pnetwork) +{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct wlan_network *cur_network = &(pmlmepriv->cur_network); + + DBG_871X("%s\n", __FUNCTION__); -+ ++ + RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("\nfw_state:%x, BSSID:"MAC_FMT"\n" + ,get_fwstate(pmlmepriv), MAC_ARG(pnetwork->network.MacAddress))); + -+ ++ + // why not use ptarget_wlan?? + _rtw_memcpy(&cur_network->network, &pnetwork->network, pnetwork->network.Length); + // some IEs in pnetwork is wrong, so we should use ptarget_wlan IEs @@ -29392,7 +17138,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + + cur_network->aid = pnetwork->join_res; + -+ ++ +#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS + rtw_set_signal_stat_timer(&padapter->recvpriv); +#endif @@ -29401,9 +17147,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + //the ptarget_wlan->network.Rssi is raw data, we use ptarget_wlan->network.PhyInfo.SignalStrength instead (has scaled) + padapter->recvpriv.rssi = translate_percentage_to_dbm(ptarget_wlan->network.PhyInfo.SignalStrength); + #if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 -+ DBG_871X(FUNC_ADPT_FMT" signal_strength:%3u, rssi:%3d, signal_qual:%3u" ++ DBG_871X("%s signal_strength:%3u, rssi:%3d, signal_qual:%3u" + "\n" -+ , FUNC_ADPT_ARG(padapter) ++ , __FUNCTION__ + , padapter->recvpriv.signal_strength + , padapter->recvpriv.rssi + , padapter->recvpriv.signal_qual @@ -29412,19 +17158,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS + rtw_set_signal_stat_timer(&padapter->recvpriv); +#endif -+ ++ + //update fw_state //will clr _FW_UNDER_LINKING here indirectly + switch(pnetwork->network.InfrastructureMode) -+ { -+ case Ndis802_11Infrastructure: -+ ++ { ++ case Ndis802_11Infrastructure: ++ + if(pmlmepriv->fw_state&WIFI_UNDER_WPS) + pmlmepriv->fw_state = WIFI_STATION_STATE|WIFI_UNDER_WPS; + else + pmlmepriv->fw_state = WIFI_STATION_STATE; -+ ++ + break; -+ case Ndis802_11IBSS: ++ case Ndis802_11IBSS: + pmlmepriv->fw_state = WIFI_ADHOC_STATE; + break; + default: @@ -29433,10 +17179,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + break; + } + -+ rtw_update_protection(padapter, (cur_network->network.IEs) + sizeof (NDIS_802_11_FIXED_IEs), ++ rtw_update_protection(padapter, (cur_network->network.IEs) + sizeof (NDIS_802_11_FIXED_IEs), + (cur_network->network.IELength)); + -+#ifdef CONFIG_80211N_HT ++#ifdef CONFIG_80211N_HT + rtw_update_ht_cap(padapter, cur_network->network.IEs, cur_network->network.IELength, (u8) cur_network->network.Configuration.DSConfig); +#endif +} @@ -29444,7 +17190,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +//Notes: the fucntion could be > passive_level (the same context as Rx tasklet) +//pnetwork : returns from rtw_joinbss_event_callback +//ptarget_wlan: found from scanned_queue -+//if join_res > 0, for (fw_state==WIFI_STATION_STATE), we check if "ptarget_sta" & "ptarget_wlan" exist. ++//if join_res > 0, for (fw_state==WIFI_STATION_STATE), we check if "ptarget_sta" & "ptarget_wlan" exist. +//if join_res > 0, for (fw_state==WIFI_ADHOC_STATE), we only check if "ptarget_wlan" exist. +//if join_res > 0, update "cur_network->network" from "pnetwork->network" if (ptarget_wlan !=NULL). +// @@ -29455,50 +17201,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + static u8 retry=0; + u8 timer_cancelled; + struct sta_info *ptarget_sta= NULL, *pcur_sta = NULL; -+ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct sta_priv *pstapriv = &adapter->stapriv; + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct wlan_network *pnetwork = (struct wlan_network *)pbuf; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ struct wlan_network *pnetwork = (struct wlan_network *)pbuf; ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); + struct wlan_network *pcur_wlan = NULL, *ptarget_wlan = NULL; -+ unsigned int the_same_macaddr = _FALSE; -+ -+_func_enter_; -+ -+#ifdef CONFIG_RTL8712 -+ //endian_convert -+ pnetwork->join_res = le32_to_cpu(pnetwork->join_res); -+ pnetwork->network_type = le32_to_cpu(pnetwork->network_type); -+ pnetwork->network.Length = le32_to_cpu(pnetwork->network.Length); -+ pnetwork->network.Ssid.SsidLength = le32_to_cpu(pnetwork->network.Ssid.SsidLength); -+ pnetwork->network.Privacy =le32_to_cpu( pnetwork->network.Privacy); -+ pnetwork->network.Rssi = le32_to_cpu(pnetwork->network.Rssi); -+ pnetwork->network.NetworkTypeInUse =le32_to_cpu(pnetwork->network.NetworkTypeInUse) ; -+ pnetwork->network.Configuration.ATIMWindow = le32_to_cpu(pnetwork->network.Configuration.ATIMWindow); -+ pnetwork->network.Configuration.BeaconPeriod = le32_to_cpu(pnetwork->network.Configuration.BeaconPeriod); -+ pnetwork->network.Configuration.DSConfig = le32_to_cpu(pnetwork->network.Configuration.DSConfig); -+ pnetwork->network.Configuration.FHConfig.DwellTime=le32_to_cpu(pnetwork->network.Configuration.FHConfig.DwellTime); -+ pnetwork->network.Configuration.FHConfig.HopPattern=le32_to_cpu(pnetwork->network.Configuration.FHConfig.HopPattern); -+ pnetwork->network.Configuration.FHConfig.HopSet=le32_to_cpu(pnetwork->network.Configuration.FHConfig.HopSet); -+ pnetwork->network.Configuration.FHConfig.Length=le32_to_cpu(pnetwork->network.Configuration.FHConfig.Length); -+ pnetwork->network.Configuration.Length = le32_to_cpu(pnetwork->network.Configuration.Length); -+ pnetwork->network.InfrastructureMode = le32_to_cpu(pnetwork->network.InfrastructureMode); -+ pnetwork->network.IELength = le32_to_cpu(pnetwork->network.IELength ); -+#endif ++ unsigned int the_same_macaddr = false; + + RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("joinbss event call back received with res=%d\n", pnetwork->join_res)); + + rtw_get_encrypt_decrypt_from_registrypriv(adapter); -+ ++ + + if (pmlmepriv->assoc_ssid.SsidLength == 0) -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("@@@@@ joinbss event call back for Any SSid\n")); -+ } ++ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("@@@@@ joinbss event call back for Any SSid\n")); + else -+ { + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("@@@@@ rtw_joinbss_event_callback for SSid:%s\n", pmlmepriv->assoc_ssid.Ssid)); -+ } -+ ++ + the_same_macaddr = _rtw_memcmp(pnetwork->network.MacAddress, cur_network->network.MacAddress, ETH_ALEN); + + pnetwork->network.Length = get_WLAN_BSSID_EX_sz(&pnetwork->network); @@ -29507,12 +17226,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n\n ***joinbss_evt_callback return a wrong bss ***\n\n")); + goto ignore_joinbss_callback; + } -+ ++ + _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; -+ ++ + RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("\n rtw_joinbss_event_callback !! _enter_critical \n")); + + if(pnetwork->join_res > 0) @@ -29524,53 +17240,53 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + //s1. find ptarget_wlan + if(check_fwstate(pmlmepriv, _FW_LINKED) ) + { -+ if(the_same_macaddr == _TRUE) ++ if(the_same_macaddr == true) + { -+ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); ++ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); + } + else + { + pcur_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); -+ if(pcur_wlan) pcur_wlan->fixed = _FALSE; ++ if(pcur_wlan) pcur_wlan->fixed = false; + + pcur_sta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); + if(pcur_sta){ -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); + rtw_free_stainfo(adapter, pcur_sta); -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); + } + + ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->network.MacAddress); -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE){ -+ if(ptarget_wlan) ptarget_wlan->fixed = _TRUE; ++ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true){ ++ if(ptarget_wlan) ptarget_wlan->fixed = true; + } + } + + } + else + { -+ ptarget_wlan = _rtw_find_same_network(&pmlmepriv->scanned_queue, pnetwork); -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE){ -+ if(ptarget_wlan) ptarget_wlan->fixed = _TRUE; ++ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->network.MacAddress); ++ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true){ ++ if(ptarget_wlan) ptarget_wlan->fixed = true; + } + } -+ -+ //s2. update cur_network ++ ++ //s2. update cur_network + if(ptarget_wlan) -+ { ++ { + rtw_joinbss_update_network(adapter, ptarget_wlan, pnetwork); + } + else -+ { -+ DBG_871X_LEVEL(_drv_always_, "Can't find ptarget_wlan when joinbss_event callback\n"); ++ { ++ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Can't find ptarget_wlan when joinbss_event callback\n")); + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + goto ignore_joinbss_callback; + } -+ -+ -+ //s3. find ptarget_sta & update ptarget_sta after update cur_network only for station mode -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ { ++ ++ ++ //s3. find ptarget_sta & update ptarget_sta after update cur_network only for station mode ++ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) ++ { + ptarget_sta = rtw_joinbss_update_stainfo(adapter, pnetwork); + if(ptarget_sta==NULL) + { @@ -29580,52 +17296,51 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + } + } + -+ //s4. indicate connect -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ { -+ pmlmepriv->cur_network_scanned = ptarget_wlan; -+ rtw_indicate_connect(adapter); -+ } -+ else -+ { -+ //adhoc mode will rtw_indicate_connect when rtw_stassoc_event_callback -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("adhoc mode, fw_state:%x", get_fwstate(pmlmepriv))); -+ } ++ //s4. indicate connect ++ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) ++ { ++ rtw_indicate_connect(adapter); ++ } ++ else ++ { ++ //adhoc mode will rtw_indicate_connect when rtw_stassoc_event_callback ++ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("adhoc mode, fw_state:%x", get_fwstate(pmlmepriv))); ++ } + -+ -+ //s5. Cancle assoc_timer ++ ++ //s5. Cancle assoc_timer + _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("Cancle assoc_timer \n")); -+ ++ ++ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("Cancle assoc_timer \n")); ++ + } + else + { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("rtw_joinbss_event_callback err: fw_state:%x", get_fwstate(pmlmepriv))); ++ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("rtw_joinbss_event_callback err: fw_state:%x", get_fwstate(pmlmepriv))); + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + goto ignore_joinbss_callback; + } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ + } -+ else if(pnetwork->join_res == -4) ++ else if(pnetwork->join_res == -4) + { + rtw_reset_securitypriv(adapter); -+ _set_timer(&pmlmepriv->assoc_timer, 1); ++ _set_timer(&pmlmepriv->assoc_timer, 1); + + //rtw_free_assoc_resources(adapter, 1); + -+ if((check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) == _TRUE) -+ { ++ if((check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) == true) ++ { + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("fail! clear _FW_UNDER_LINKING ^^^fw_state=%x\n", get_fwstate(pmlmepriv))); + _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ } -+ ++ } ++ + } + else //if join_res < 0 (join fails), then try again + { -+ ++ + #ifdef REJOIN + res = _FAIL; + if(retry < 2) { @@ -29643,18 +17358,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + { + _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); + rtw_indicate_connect(adapter); -+ } ++ } + else + { + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Set Assoc_Timer = 1; can't find match ssid in scanned_q \n")); + #endif -+ ++ + _set_timer(&pmlmepriv->assoc_timer, 1); + //rtw_free_assoc_resources(adapter, 1); + _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ ++ + #ifdef REJOIN -+ retry = 0; ++ retry = 0; + } + #endif + } @@ -29662,46 +17377,49 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +ignore_joinbss_callback: + + _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ _func_exit_; ++ +} + +void rtw_joinbss_event_callback(_adapter *adapter, u8 *pbuf) +{ -+ struct wlan_network *pnetwork = (struct wlan_network *)pbuf; ++ struct wlan_network *pnetwork = (struct wlan_network *)pbuf; ++ + -+_func_enter_; + + mlmeext_joinbss_event_callback(adapter, pnetwork->join_res); + + rtw_os_xmit_schedule(adapter); + -+#ifdef CONFIG_CONCURRENT_MODE ++#ifdef CONFIG_CONCURRENT_MODE + rtw_os_xmit_schedule(adapter->pbuddy_adapter); -+#endif ++#endif ++ ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ dc_resume_xmit(adapter); ++#endif ++ + -+_func_exit_; +} + -+#if 0 -+//#if (RATE_ADAPTIVE_SUPPORT==1) //for 88E RA +u8 search_max_mac_id(_adapter *padapter) +{ + u8 mac_id, aid; ++#if (RATE_ADAPTIVE_SUPPORT==1) //for 88E RA + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct sta_priv *pstapriv = &padapter->stapriv; + -+#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)){ -+ ++#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)){ ++ +#if 1 + _irqL irqL; + struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); + + _enter_critical_bh(&pdvobj->lock, &irqL); + for(mac_id=(NUM_STA-1); mac_id>0; mac_id--) -+ if(pdvobj->macid[mac_id] == _TRUE) ++ if(pdvobj->macid[mac_id] == true) + break; + _exit_critical_bh(&pdvobj->lock, &irqL); + @@ -29712,14 +17430,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + { + psta = pstapriv->sta_aid[aid-1]; + break; -+ } ++ } + } +/* + for (mac_id = (pstapriv->max_num_sta-1); mac_id >= 0; mac_id--) + { + if (pstapriv->sta_aid[mac_id] != NULL) + break; -+ } ++ } +*/ + mac_id = aid + 1; +#endif @@ -29735,196 +17453,145 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + } + } + } ++#endif + + DBG_871X("max mac_id=%d\n", mac_id); + + return mac_id; + -+} -+#endif ++} + -+//FOR STA, AP ,AD-HOC mode -+void rtw_sta_media_status_rpt(_adapter *adapter,struct sta_info *psta, u32 mstatus) ++//FOR AP ,AD-HOC mode ++void rtw_stassoc_hw_rpt(_adapter *adapter,struct sta_info *psta) +{ -+ u16 media_status_rpt; ++ u16 media_status; + + if(psta==NULL) return; + -+ #if (RATE_ADAPTIVE_SUPPORT==1) //for 88E RA ++ #if (RATE_ADAPTIVE_SUPPORT==1) //for 88E RA + { -+ u8 macid = rtw_search_max_mac_id(adapter); ++ u8 macid = search_max_mac_id(adapter); + rtw_hal_set_hwreg(adapter,HW_VAR_TX_RPT_MAX_MACID, (u8*)&macid); + } + #endif -+ media_status_rpt = (u16)((psta->mac_id<<8)|mstatus); // MACID|OPMODE:1 connect -+ rtw_hal_set_hwreg(adapter,HW_VAR_H2C_MEDIA_STATUS_RPT,(u8 *)&media_status_rpt); ++ media_status = (psta->mac_id<<8)|1; // MACID|OPMODE:1 connect ++ rtw_hal_set_hwreg(adapter,HW_VAR_H2C_MEDIA_STATUS_RPT,(u8 *)&media_status); +} + +void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf) +{ -+ _irqL irqL; ++ _irqL irqL; + struct sta_info *psta; + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + struct stassoc_event *pstassoc = (struct stassoc_event*)pbuf; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); + struct wlan_network *ptarget_wlan = NULL; -+ -+_func_enter_; -+ -+ if(rtw_access_ctrl(adapter, pstassoc->macaddr) == _FALSE) ++ ++ if(rtw_access_ctrl(adapter, pstassoc->macaddr) == false) + return; + +#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ { -+ psta = rtw_get_stainfo(&adapter->stapriv, pstassoc->macaddr); -+ if(psta) -+ { -+ u8 *passoc_req = NULL; -+ u32 assoc_req_len = 0; -+ -+ rtw_sta_media_status_rpt(adapter, psta, 1); -+ -+#ifndef CONFIG_AUTO_AP_MODE -+ -+ ap_sta_info_defer_update(adapter, psta); -+ -+ //report to upper layer -+ DBG_871X("indicate_sta_assoc_event to upper layer - hostapd\n"); ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ psta = rtw_get_stainfo(&adapter->stapriv, pstassoc->macaddr); ++ if(psta) { ++#ifdef CONFIG_AUTO_AP_MODE ++ rtw_stassoc_hw_rpt(adapter, psta); ++#else //CONFIG_AUTO_AP_MODE +#ifdef CONFIG_IOCTL_CFG80211 ++ #ifdef COMPAT_KERNEL_RELEASE ++ ++ #elif (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)) || defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) ++ u8 *passoc_req = NULL; ++ u32 assoc_req_len; ++ + _enter_critical_bh(&psta->lock, &irqL); + if(psta->passoc_req && psta->assoc_req_len>0) -+ { ++ { + passoc_req = rtw_zmalloc(psta->assoc_req_len); + if(passoc_req) + { + assoc_req_len = psta->assoc_req_len; + _rtw_memcpy(passoc_req, psta->passoc_req, assoc_req_len); -+ -+ rtw_mfree(psta->passoc_req , psta->assoc_req_len); ++ ++ _rtw_mfree(psta->passoc_req , psta->assoc_req_len); + psta->passoc_req = NULL; + psta->assoc_req_len = 0; + } -+ } ++ } + _exit_critical_bh(&psta->lock, &irqL); + + if(passoc_req && assoc_req_len>0) + { + rtw_cfg80211_indicate_sta_assoc(adapter, passoc_req, assoc_req_len); + -+ rtw_mfree(passoc_req, assoc_req_len); -+ } -+#else //!CONFIG_IOCTL_CFG80211 -+ rtw_indicate_sta_assoc_event(adapter, psta); -+#endif //!CONFIG_IOCTL_CFG80211 -+#endif //!CONFIG_AUTO_AP_MODE ++ _rtw_mfree(passoc_req, assoc_req_len); ++ } ++ #endif //(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)) || defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) ++#endif //CONFIG_IOCTL_CFG80211 + -+#ifdef CONFIG_BEAMFORMING -+ beamforming_wk_cmd(adapter, BEAMFORMING_CTRL_ENTER, (u8 *)psta, sizeof(struct sta_info), 0); -+#endif/*CONFIG_BEAMFORMING*/ -+ } -+ goto exit; -+ } -+#endif //defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) ++ //bss_cap_update_on_sta_join(adapter, psta); ++ //sta_info_update(adapter, psta); ++ ap_sta_info_defer_update(adapter, psta); + ++ rtw_stassoc_hw_rpt(adapter,psta); ++#endif //CONFIG_AUTO_AP_MODE ++ } ++ return; ++ } ++#endif + //for AD-HOC mode -+ psta = rtw_get_stainfo(&adapter->stapriv, pstassoc->macaddr); ++ psta = rtw_get_stainfo(&adapter->stapriv, pstassoc->macaddr); + if( psta != NULL) + { -+ //the sta have been in sta_info_queue => do nothing -+ ++ //the sta have been in sta_info_queue => do nothing ++ + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Error: rtw_stassoc_event_callback: sta has been in sta_hash_queue \n")); -+ -+ goto exit; //(between drv has received this event before and fw have not yet to set key to CAM_ENTRY) ++ ++ return; //(between drv has received this event before and fw have not yet to set key to CAM_ENTRY) + } + -+ psta = rtw_alloc_stainfo(&adapter->stapriv, pstassoc->macaddr); ++ psta = rtw_alloc_stainfo(&adapter->stapriv, pstassoc->macaddr); + if (psta == NULL) { + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Can't alloc sta_info when rtw_stassoc_event_callback\n")); -+ goto exit; -+ } -+ ++ return; ++ } ++ + //to do : init sta_info variable + psta->qos_option = 0; + psta->mac_id = (uint)pstassoc->cam_id; + //psta->aid = (uint)pstassoc->cam_id; + DBG_871X("%s\n",__FUNCTION__); + //for ad-hoc mode -+ rtw_hal_set_odm_var(adapter,HAL_ODM_STA_INFO,psta,_TRUE); ++ rtw_hal_set_odm_var(adapter,HAL_ODM_STA_INFO,psta,true); ++ ++ rtw_stassoc_hw_rpt(adapter,psta); + -+ rtw_sta_media_status_rpt(adapter, psta, 1); -+ + if(adapter->securitypriv.dot11AuthAlgrthm==dot11AuthAlgrthm_8021X) + psta->dot118021XPrivacy = adapter->securitypriv.dot11PrivacyAlgrthm; -+ + -+ psta->ieee8021x_blocked = _FALSE; -+ ++ ++ psta->ieee8021x_blocked = false; ++ + _enter_critical_bh(&pmlmepriv->lock, &irqL); + -+ if ( (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)==_TRUE ) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==_TRUE ) ) ++ if ( (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)==true ) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==true ) ) + { + if(adapter->stapriv.asoc_sta_count== 2) + { + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); -+ pmlmepriv->cur_network_scanned = ptarget_wlan; -+ if(ptarget_wlan) ptarget_wlan->fixed = _TRUE; ++ if(ptarget_wlan) ptarget_wlan->fixed = true; + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + // a sta + bc/mc_stainfo (not Ibss_stainfo) + rtw_indicate_connect(adapter); + } + } -+ + _exit_critical_bh(&pmlmepriv->lock, &irqL); + -+ + mlmeext_sta_add_event_callback(adapter, psta); -+ -+#ifdef CONFIG_RTL8711 -+ //submit SetStaKey_cmd to tell fw, fw will allocate an CAM entry for this sta -+ rtw_setstakey_cmd(adapter, psta, GROUP_KEY, _TRUE); -+#endif -+ -+exit: -+ -+_func_exit_; -+ +} + -+#ifdef CONFIG_IEEE80211W -+void rtw_sta_timeout_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+ _irqL irqL; -+ struct sta_info *psta; -+ struct stadel_event *pstadel = (struct stadel_event *)pbuf; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ -+_func_enter_; -+ -+ psta = rtw_get_stainfo(&adapter->stapriv, pstadel->macaddr); -+ -+ if (psta) { -+ u8 updated = _FALSE; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(adapter, psta, _TRUE, WLAN_REASON_PREV_AUTH_NOT_VALID, _TRUE); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(adapter, updated, STA_INFO_UPDATE_ALL); -+ } -+ -+ -+_func_exit_; -+ -+} -+#endif /* CONFIG_IEEE80211W */ -+ +void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf) +{ + _irqL irqL,irqL2; @@ -29934,14 +17601,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + WLAN_BSSID_EX *pdev_network=NULL; + u8* pibss = NULL; + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct stadel_event *pstadel = (struct stadel_event*)pbuf; -+ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct stadel_event *pstadel = (struct stadel_event*)pbuf; ++ struct sta_priv *pstapriv = &adapter->stapriv; + struct wlan_network *tgt_network = &(pmlmepriv->cur_network); -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+_func_enter_; -+ ++ ++ ++ + psta = rtw_get_stainfo(&adapter->stapriv, pstadel->macaddr); + if(psta) + mac_id = psta->mac_id; @@ -29955,11 +17620,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + media_status = (mac_id<<8)|0; // MACID|OPMODE:0 means disconnect + //for STA,AP,ADHOC mode, report disconnect stauts to FW + rtw_hal_set_hwreg(adapter, HW_VAR_H2C_MEDIA_STATUS_RPT, (u8 *)&media_status); -+ } ++ } + -+ //if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ if((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ { ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) ++ { +#ifdef CONFIG_IOCTL_CFG80211 + #ifdef COMPAT_KERNEL_RELEASE + @@ -29969,7 +17633,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +#endif //CONFIG_IOCTL_CFG80211 + + return; -+ } ++ } + + + mlmeext_sta_del_event_callback(adapter); @@ -29978,108 +17642,96 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + + if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) ) + { -+ u16 reason = *((unsigned short *)(pstadel->rsvd)); -+ bool roam = _FALSE; -+ struct wlan_network *roam_target = NULL; -+ + #ifdef CONFIG_LAYER2_ROAMING -+ if(adapter->registrypriv.wifi_spec==1) { -+ roam = _FALSE; -+ } else if (reason == WLAN_REASON_EXPIRATION_CHK && rtw_chk_roam_flags(adapter, RTW_ROAM_ON_EXPIRED)) { -+ roam = _TRUE; -+ } else if (reason == WLAN_REASON_ACTIVE_ROAM && rtw_chk_roam_flags(adapter, RTW_ROAM_ACTIVE)) { -+ roam = _TRUE; -+ roam_target = pmlmepriv->roam_network; -+ } ++ if (rtw_to_roaming(adapter) > 0) ++ pmlmepriv->to_roaming--; /* this stadel_event is caused by roaming, decrease to_roaming */ ++ else if (rtw_to_roaming(adapter) == 0) ++ rtw_set_roaming(adapter, adapter->registrypriv.max_roaming_times); +#ifdef CONFIG_INTEL_WIDI -+ else if (adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_CONNECTED) { -+ roam = _TRUE; -+ } ++ if(adapter->mlmepriv.widi_state != INTEL_WIDI_STATE_CONNECTED) +#endif // CONFIG_INTEL_WIDI -+ -+ if (roam == _TRUE) { -+ if (rtw_to_roam(adapter) > 0) -+ rtw_dec_to_roam(adapter); /* this stadel_event is caused by roaming, decrease to_roam */ -+ else if (rtw_to_roam(adapter) == 0) -+ rtw_set_to_roam(adapter, adapter->registrypriv.max_roaming_times); -+ } else { -+ rtw_set_to_roam(adapter, 0); -+ } -+ #endif /* CONFIG_LAYER2_ROAMING */ ++ if(*((unsigned short *)(pstadel->rsvd)) != WLAN_REASON_EXPIRATION_CHK) ++ rtw_set_roaming(adapter, 0); /* don't roam */ ++ #endif + + rtw_free_uc_swdec_pending_queue(adapter); + + rtw_free_assoc_resources(adapter, 1); + rtw_indicate_disconnect(adapter); -+ rtw_free_mlme_priv_ie_data(pmlmepriv); -+ + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + // remove the network entry in scanned_queue -+ pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); -+ if (pwlan) { -+ pwlan->fixed = _FALSE; -+ rtw_free_network_nolock(adapter, pwlan); ++ pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); ++ if (pwlan) { ++ pwlan->fixed = false; ++ rtw_free_network_nolock(pmlmepriv, pwlan); + } + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + ++ #ifdef CONFIG_LAYER2_ROAMING ++ _rtw_roaming(adapter, tgt_network); ++ #else +#ifdef CONFIG_INTEL_WIDI -+ if (!rtw_to_roam(adapter)) -+ process_intel_widi_disconnect(adapter, 1); ++ process_intel_widi_disconnect(adapter, 1); +#endif // CONFIG_INTEL_WIDI ++ #endif //CONFIG_LAYER2_ROAMING + -+ _rtw_roaming(adapter, roam_target); + } + -+ if ( check_fwstate(pmlmepriv,WIFI_ADHOC_MASTER_STATE) || ++ if ( check_fwstate(pmlmepriv,WIFI_ADHOC_MASTER_STATE) || + check_fwstate(pmlmepriv,WIFI_ADHOC_STATE)) + { -+ -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); + rtw_free_stainfo(adapter, psta); -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ + if(adapter->stapriv.asoc_sta_count== 1) //a sta + bc/mc_stainfo (not Ibss_stainfo) -+ { ++ { + //rtw_indicate_disconnect(adapter);//removed@20091105 + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + //free old ibss network + //pwlan = rtw_find_network(&pmlmepriv->scanned_queue, pstadel->macaddr); + pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); -+ if(pwlan) ++ if(pwlan) + { -+ pwlan->fixed = _FALSE; -+ rtw_free_network_nolock(adapter, pwlan); ++ pwlan->fixed = false; ++ rtw_free_network_nolock(pmlmepriv, pwlan); + } + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + //re-create ibss -+ pdev_network = &(adapter->registrypriv.dev_network); ++ pdev_network = &(adapter->registrypriv.dev_network); + pibss = adapter->registrypriv.dev_network.MacAddress; + + _rtw_memcpy(pdev_network, &tgt_network->network, get_WLAN_BSSID_EX_sz(&tgt_network->network)); -+ ++ + _rtw_memset(&pdev_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); + _rtw_memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); -+ -+ rtw_update_registrypriv_dev_network(adapter); ++ ++ rtw_update_registrypriv_dev_network(adapter); + + rtw_generate_random_ibss(pibss); -+ ++ + if(check_fwstate(pmlmepriv,WIFI_ADHOC_STATE)) + { + set_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); + _clr_fwstate_(pmlmepriv, WIFI_ADHOC_STATE); + } + -+ if (rtw_create_ibss_cmd(adapter, 0) != _SUCCESS) -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("***Error=>stadel_event_callback: rtw_create_ibss_cmd status FAIL***\n")); ++ if(rtw_createbss_cmd(adapter)!=_SUCCESS) ++ { ++ ++ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("***Error=>stadel_event_callback: rtw_createbss_cmd status FAIL*** \n ")); ++ ++ } ++ + + } -+ ++ + } -+ ++ + _exit_critical_bh(&pmlmepriv->lock, &irqL2); -+ -+_func_exit_; ++ ++ + +} + @@ -30090,27 +17742,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + struct reportpwrstate_parm *preportpwrstate; +#endif + -+_func_enter_; ++ + + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("+rtw_cpwm_event_callback !!!\n")); +#ifdef CONFIG_LPS_LCLK + preportpwrstate = (struct reportpwrstate_parm*)pbuf; -+ preportpwrstate->state |= (u8)(adapter_to_pwrctl(padapter)->cpwm_tog + 0x80); ++ preportpwrstate->state |= (u8)(padapter->pwrctrlpriv.cpwm_tog + 0x80); + cpwm_int_hdl(padapter, preportpwrstate); +#endif + -+_func_exit_; + -+} -+ -+ -+void rtw_wmm_event_callback(PADAPTER padapter, u8 *pbuf) -+{ -+_func_enter_; -+ -+ WMMOnAssocRsp(padapter); -+ -+_func_exit_; + +} + @@ -30122,31 +17763,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +{ + _irqL irqL; + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++#ifdef CONFIG_LAYER2_ROAMING ++ int do_join_r; ++#endif //CONFIG_LAYER2_ROAMING + +#if 0 -+ if (rtw_is_drv_stopped(adapter)) { ++ if (adapter->bDriverStopped == true){ + _rtw_up_sema(&pmlmepriv->assoc_terminate); + return; + } -+#endif ++#endif ++ + -+_func_enter_; + + + DBG_871X("%s, fw_state=%x\n", __FUNCTION__, get_fwstate(pmlmepriv)); -+ -+ if (RTW_CANNOT_RUN(adapter)) ++ ++ if(adapter->bDriverStopped ||adapter->bSurpriseRemoved) + return; + -+ ++ + _enter_critical_bh(&pmlmepriv->lock, &irqL); + + #ifdef CONFIG_LAYER2_ROAMING -+ if (rtw_to_roam(adapter) > 0) { /* join timeout caused by roaming */ ++ if (rtw_to_roaming(adapter) > 0) { /* join timeout caused by roaming */ + while(1) { -+ rtw_dec_to_roam(adapter); -+ if (rtw_to_roam(adapter) != 0) { /* try another */ -+ int do_join_r; ++ pmlmepriv->to_roaming--; ++ if (rtw_to_roaming(adapter) != 0) { /* try another */ + DBG_871X("%s try another roaming\n", __FUNCTION__); + if( _SUCCESS!=(do_join_r=rtw_do_join(adapter)) ) { + DBG_871X("%s roaming do_join return %d\n", __FUNCTION__ ,do_join_r); @@ -30158,7 +17801,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + if(adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) + { + _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); -+ intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL, 0); ++ intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL); + DBG_871X("change to widi listen\n"); + } +#endif // CONFIG_INTEL_WIDI @@ -30167,8 +17810,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + break; + } + } -+ -+ } else ++ ++ } else + #endif + { + rtw_indicate_disconnect(adapter); @@ -30179,17 +17822,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + rtw_cfg80211_indicate_disconnect(adapter); +#endif //CONFIG_IOCTL_CFG80211 + -+ } ++ } + + _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ + -+#ifdef CONFIG_DRVEXT_MODULE_WSC -+ drvext_assoc_fail_indicate(&adapter->drvextpriv); -+#endif + -+ -+_func_exit_; ++#ifdef CONFIG_DRVEXT_MODULE_WSC ++ drvext_assoc_fail_indicate(&adapter->drvextpriv); ++#endif ++ ++ ++ + +} + @@ -30198,119 +17841,69 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +* @adapter: pointer to _adapter structure +*/ +void rtw_scan_timeout_handler (_adapter *adapter) -+{ ++{ + _irqL irqL; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ + DBG_871X(FUNC_ADPT_FMT" fw_state=%x\n", FUNC_ADPT_ARG(adapter), get_fwstate(pmlmepriv)); + + _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ ++ + _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ ++ + _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_surveydone_event_callback(adapter); -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ rtw_indicate_scan_done(adapter, _TRUE); + -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_IOCTL_CFG80211) -+ if (adapter->pbuddy_adapter) { -+ _adapter *buddy_adapter = adapter->pbuddy_adapter; -+ struct mlme_priv *buddy_mlme = &(buddy_adapter->mlmepriv); -+ struct rtw_wdev_priv *buddy_wdev_priv = adapter_wdev_data(buddy_adapter); -+ bool indicate_buddy_scan = _FALSE; ++ rtw_indicate_scan_done(adapter, true); + -+ _enter_critical_bh(&buddy_wdev_priv->scan_req_lock, &irqL); -+ if (buddy_wdev_priv->scan_request && buddy_mlme->scanning_via_buddy_intf == _TRUE) { -+ buddy_mlme->scanning_via_buddy_intf = _FALSE; -+ clr_fwstate(buddy_mlme, _FW_UNDER_SURVEY); -+ indicate_buddy_scan = _TRUE; -+ } -+ _exit_critical_bh(&buddy_wdev_priv->scan_req_lock, &irqL); -+ -+ if (indicate_buddy_scan == _TRUE) { -+ rtw_indicate_scan_done(buddy_adapter, _TRUE); -+ } -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+} -+ -+void rtw_mlme_reset_auto_scan_int(_adapter *adapter) -+{ -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+#ifdef CONFIG_P2P -+ if(!rtw_p2p_chk_state(&adapter->wdinfo, P2P_STATE_NONE)) { -+ mlme->auto_scan_int_ms = 0; /* disabled */ -+ goto exit; -+ } -+#endif -+ if(pmlmeinfo->VHT_enable) //disable auto scan when connect to 11AC AP -+ { -+ mlme->auto_scan_int_ms = 0; -+ } -+ else if(adapter->registrypriv.wifi_spec && is_client_associated_to_ap(adapter) == _TRUE) { -+ mlme->auto_scan_int_ms = 60*1000; -+#ifdef CONFIG_LAYER2_ROAMING -+ } else if(rtw_chk_roam_flags(adapter, RTW_ROAM_ACTIVE)) { -+ if (check_fwstate(mlme, WIFI_STATION_STATE) && check_fwstate(mlme, _FW_LINKED)) -+ mlme->auto_scan_int_ms = mlme->roam_scan_int_ms; -+#endif -+ } else { -+ mlme->auto_scan_int_ms = 0; /* disabled */ -+ } -+exit: -+ return; -+} -+ -+void rtw_drv_scan_by_self(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (!padapter->registrypriv.wifi_spec) { -+ if (check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY | _FW_UNDER_LINKING)) == _TRUE) { -+ DBG_871X(FUNC_ADPT_FMT" _FW_UNDER_SURVEY|_FW_UNDER_LINKING\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE) { -+ DBG_871X(FUNC_ADPT_FMT" exit BusyTraffic\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) { -+ if ((check_buddy_fwstate(padapter, (_FW_UNDER_SURVEY | _FW_UNDER_LINKING)) == _TRUE) || -+ (padapter->pbuddy_adapter->mlmepriv.LinkDetectInfo.bBusyTraffic == _TRUE)) { -+ DBG_871X(FUNC_ADPT_FMT", but buddy_intf is under scanning or linking or BusyTraffic\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ } -+#endif -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ rtw_set_802_11_bssid_list_scan(padapter, NULL, 0); -+ -+exit: -+ return; +} + +static void rtw_auto_scan_handler(_adapter *padapter) +{ + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; + -+ rtw_mlme_reset_auto_scan_int(padapter); ++ //auto site survey per 60sec ++ if(pmlmepriv->scan_interval >0) ++ { ++ pmlmepriv->scan_interval--; ++ if(pmlmepriv->scan_interval==0) ++ { ++/* ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) ++ { ++ DBG_871X("exit %s when _FW_UNDER_SURVEY|_FW_UNDER_LINKING -> \n", __FUNCTION__); ++ return; ++ } ++ ++ if(pmlmepriv->sitesurveyctrl.traffic_busy == true) ++ { ++ DBG_871X("%s exit cause traffic_busy(%x)\n",__FUNCTION__, pmlmepriv->sitesurveyctrl.traffic_busy); ++ return; ++ } ++*/ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (rtw_buddy_adapter_up(padapter)) ++ { ++ if ((check_buddy_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) || ++ (padapter->pbuddy_adapter->mlmepriv.LinkDetectInfo.bBusyTraffic == true)) ++ { ++ DBG_871X("%s, but buddy_intf is under scanning or linking or BusyTraffic\n", __FUNCTION__); ++ return; ++ } ++ } ++#endif ++ ++ DBG_871X("%s\n", __FUNCTION__); ++ ++ rtw_set_802_11_bssid_list_scan(padapter, NULL, 0); ++ ++ pmlmepriv->scan_interval = SCAN_INTERVAL;// 30*2 sec = 60sec ++ ++ } ++ ++ } + -+ if (pmlmepriv->auto_scan_int_ms != 0 -+ && rtw_get_passing_time_ms(pmlmepriv->scan_start_time) > pmlmepriv->auto_scan_int_ms) -+ rtw_drv_scan_by_self(padapter); -+ +} + +void rtw_dynamic_check_timer_handlder(_adapter *adapter) @@ -30319,83 +17912,55 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; +#endif //CONFIG_AP_MODE + struct registry_priv *pregistrypriv = &adapter->registrypriv; -+#ifdef CONFIG_CONCURRENT_MODE ++#ifdef CONFIG_CONCURRENT_MODE + PADAPTER pbuddy_adapter = adapter->pbuddy_adapter; +#endif + + if(!adapter) -+ return; -+ -+ if (!rtw_is_hw_init_completed(adapter)) + return; + -+ if (RTW_CANNOT_RUN(adapter)) ++ if(adapter->hw_init_completed == false) + return; + -+ ++ if ((adapter->bDriverStopped == true)||(adapter->bSurpriseRemoved== true)) ++ return; ++ ++ +#ifdef CONFIG_CONCURRENT_MODE + if(pbuddy_adapter) + { -+ if(adapter->net_closed == _TRUE && pbuddy_adapter->net_closed == _TRUE) ++ if(adapter->net_closed == true && pbuddy_adapter->net_closed == true) + { + return; -+ } ++ } + } + else +#endif //CONFIG_CONCURRENT_MODE -+ if(adapter->net_closed == _TRUE) ++ if(adapter->net_closed == true) + { + return; -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ if (is_primary_adapter(adapter)) { -+ if (GET_HAL_DATA(adapter)->EEPROMBluetoothCoexist == 1) -+ DBG_871X("IsBtDisabled=%d, IsBtControlLps=%d\n" , rtw_btcoex_IsBtDisabled(adapter) , rtw_btcoex_IsBtControlLps(adapter)); + } ++ ++ rtw_dynamic_chk_wk_cmd(adapter); ++ ++ if(pregistrypriv->wifi_spec==1) ++ { ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo = &adapter->wdinfo; ++ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) +#endif -+ -+#ifdef CONFIG_LPS_LCLK_WD_TIMER /* to avoid leaving lps 32k frequently*/ -+ if ((adapter_to_pwrctl(adapter)->bFwCurrentInPSMode ==_TRUE ) -+#ifdef CONFIG_BT_COEXIST -+ && (rtw_btcoex_IsBtControlLps(adapter) == _FALSE) -+#endif -+ ) -+ { -+ u8 bEnterPS; -+ -+ linked_status_chk(adapter, 1); -+ -+ bEnterPS = traffic_status_watchdog(adapter, 1); -+ if(bEnterPS) + { -+ //rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_ENTER, 1); -+ rtw_hal_dm_watchdog_in_lps(adapter); ++ //auto site survey ++ rtw_auto_scan_handler(adapter); + } -+ else -+ { -+ //call rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1) in traffic_status_watchdog() -+ } -+ + } -+ else -+#endif //CONFIG_LPS_LCLK_WD_TIMER -+ { -+ if(is_primary_adapter(adapter)) -+ { -+ rtw_dynamic_chk_wk_cmd(adapter); -+ } -+ } -+ -+ /* auto site survey */ -+ rtw_auto_scan_handler(adapter); + +#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK +#ifdef CONFIG_AP_MODE -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) + { + expire_timeout_chk(adapter); -+ } ++ } +#endif +#endif //!CONFIG_ACTIVE_KEEP_ALIVE_CHECK + @@ -30405,21 +17970,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + rcu_read_lock(); +#endif // (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) + -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ if( adapter->pnetdev->br_port ++#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) ++ if( adapter->pnetdev->br_port +#else // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) + if( rcu_dereference(adapter->pnetdev->rx_handler_data) +#endif // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ && (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == _TRUE) ) ++ && (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == true) ) + { + // expire NAT2.5 entry -+ void nat25_db_expire(_adapter *priv); + nat25_db_expire(adapter); + + if (adapter->pppoe_connection_in_progress > 0) { + adapter->pppoe_connection_in_progress--; + } -+ ++ + // due to rtw_dynamic_check_timer_handlder() is called every 2 seconds + if (adapter->pppoe_connection_in_progress > 0) { + adapter->pppoe_connection_in_progress--; @@ -30431,7 +17995,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +#endif // (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) + +#endif // CONFIG_BR_EXT -+ ++ +} + + @@ -30439,7 +18003,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +inline bool rtw_is_scan_deny(_adapter *adapter) +{ + struct mlme_priv *mlmepriv = &adapter->mlmepriv; -+ return (ATOMIC_READ(&mlmepriv->set_scan_deny) != 0) ? _TRUE : _FALSE; ++ return (ATOMIC_READ(&mlmepriv->set_scan_deny) != 0) ? true : false; +} + +inline void rtw_clear_scan_deny(_adapter *adapter) @@ -30447,7 +18011,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + struct mlme_priv *mlmepriv = &adapter->mlmepriv; + ATOMIC_SET(&mlmepriv->set_scan_deny, 0); + if (0) -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); ++ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); +} + +void rtw_set_scan_deny_timer_hdl(_adapter *adapter) @@ -30463,201 +18027,87 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +#endif + + if (0) -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); ++ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); + ATOMIC_SET(&mlmepriv->set_scan_deny, 1); + _set_timer(&mlmepriv->set_scan_deny_timer, ms); -+ ++ +#ifdef CONFIG_CONCURRENT_MODE + if (!adapter->pbuddy_adapter) + return; + + if (0) -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter->pbuddy_adapter)); -+ b_mlmepriv = &adapter->pbuddy_adapter->mlmepriv; ++ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter->pbuddy_adapter)); ++ b_mlmepriv = &adapter->pbuddy_adapter->mlmepriv; + ATOMIC_SET(&b_mlmepriv->set_scan_deny, 1); -+ _set_timer(&b_mlmepriv->set_scan_deny_timer, ms); ++ _set_timer(&b_mlmepriv->set_scan_deny_timer, ms); +#endif -+ ++ +} +#endif + -+#ifdef CONFIG_LAYER2_ROAMING -+/* -+* Select a new roaming candidate from the original @param candidate and @param competitor -+* @return _TRUE: candidate is updated -+* @return _FALSE: candidate is not updated -+*/ -+static int rtw_check_roaming_candidate(struct mlme_priv *mlme -+ , struct wlan_network **candidate, struct wlan_network *competitor) -+{ -+ int updated = _FALSE; -+ _adapter *adapter = container_of(mlme, _adapter, mlmepriv); -+ -+ if(is_same_ess(&competitor->network, &mlme->cur_network.network) == _FALSE) -+ goto exit; -+ -+ if(rtw_is_desired_network(adapter, competitor) == _FALSE) -+ goto exit; -+ -+ DBG_871X("roam candidate:%s %s("MAC_FMT", ch%3u) rssi:%d, age:%5d\n", -+ (competitor == mlme->cur_network_scanned)?"*":" " , -+ competitor->network.Ssid.Ssid, -+ MAC_ARG(competitor->network.MacAddress), -+ competitor->network.Configuration.DSConfig, -+ (int)competitor->network.Rssi, -+ rtw_get_passing_time_ms(competitor->last_scanned) -+ ); -+ -+ /* got specific addr to roam */ -+ if (!is_zero_mac_addr(mlme->roam_tgt_addr)) { -+ if(_rtw_memcmp(mlme->roam_tgt_addr, competitor->network.MacAddress, ETH_ALEN) == _TRUE) -+ goto update; -+ else -+ goto exit; -+ } -+ #if 1 -+ if(rtw_get_passing_time_ms((u32)competitor->last_scanned) >= mlme->roam_scanr_exp_ms) -+ goto exit; -+ -+ if (competitor->network.Rssi - mlme->cur_network_scanned->network.Rssi < mlme->roam_rssi_diff_th) -+ goto exit; -+ -+ if(*candidate != NULL && (*candidate)->network.Rssi>=competitor->network.Rssi) -+ goto exit; -+ #else -+ goto exit; -+ #endif -+ -+update: -+ *candidate = competitor; -+ updated = _TRUE; -+ -+exit: -+ return updated; -+} -+ -+int rtw_select_roaming_candidate(struct mlme_priv *mlme) -+{ -+ _irqL irqL; -+ int ret = _FAIL; -+ _list *phead; -+ _adapter *adapter; -+ _queue *queue = &(mlme->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ struct wlan_network *candidate = NULL; -+ u8 bSupportAntDiv = _FALSE; -+ -+_func_enter_; -+ -+ if (mlme->cur_network_scanned == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ _enter_critical_bh(&(mlme->scanned_queue.lock), &irqL); -+ phead = get_list_head(queue); -+ adapter = (_adapter *)mlme->nic_hdl; -+ -+ mlme->pscanned = get_next(phead); -+ -+ while (!rtw_end_of_queue_search(phead, mlme->pscanned)) { -+ -+ pnetwork = LIST_CONTAINOR(mlme->pscanned, struct wlan_network, list); -+ if(pnetwork==NULL){ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s return _FAIL:(pnetwork==NULL)\n", __FUNCTION__)); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ mlme->pscanned = get_next(mlme->pscanned); -+ -+ if (0) -+ DBG_871X("%s("MAC_FMT", ch%u) rssi:%d\n" -+ , pnetwork->network.Ssid.Ssid -+ , MAC_ARG(pnetwork->network.MacAddress) -+ , pnetwork->network.Configuration.DSConfig -+ , (int)pnetwork->network.Rssi); -+ -+ rtw_check_roaming_candidate(mlme, &candidate, pnetwork); -+ -+ } -+ -+ if(candidate == NULL) { -+ DBG_871X("%s: return _FAIL(candidate == NULL)\n", __FUNCTION__); -+ ret = _FAIL; -+ goto exit; -+ } else { -+ DBG_871X("%s: candidate: %s("MAC_FMT", ch:%u)\n", __FUNCTION__, -+ candidate->network.Ssid.Ssid, MAC_ARG(candidate->network.MacAddress), -+ candidate->network.Configuration.DSConfig); -+ -+ mlme->roam_network = candidate; -+ -+ if (_rtw_memcmp(candidate->network.MacAddress, mlme->roam_tgt_addr, ETH_ALEN) == _TRUE) -+ _rtw_memset(mlme->roam_tgt_addr,0, ETH_ALEN); -+ } -+ -+ ret = _SUCCESS; -+exit: -+ _exit_critical_bh(&(mlme->scanned_queue.lock), &irqL); -+ -+ return ret; -+} -+#endif /* CONFIG_LAYER2_ROAMING */ ++#if defined(IEEE80211_SCAN_RESULT_EXPIRE) ++#define RTW_SCAN_RESULT_EXPIRE IEEE80211_SCAN_RESULT_EXPIRE/HZ*1000 -1000 //3000 -1000 ++#else ++#define RTW_SCAN_RESULT_EXPIRE 2000 ++#endif + +/* +* Select a new join candidate from the original @param candidate and @param competitor -+* @return _TRUE: candidate is updated -+* @return _FALSE: candidate is not updated ++* @return true: candidate is updated ++* @return false: candidate is not updated +*/ -+static int rtw_check_join_candidate(struct mlme_priv *mlme ++static int rtw_check_join_candidate(struct mlme_priv *pmlmepriv + , struct wlan_network **candidate, struct wlan_network *competitor) +{ -+ int updated = _FALSE; -+ _adapter *adapter = container_of(mlme, _adapter, mlmepriv); ++ int updated = false; ++ _adapter *adapter = container_of(pmlmepriv, _adapter, mlmepriv); + + + //check bssid, if needed -+ if(mlme->assoc_by_bssid==_TRUE) { -+ if(_rtw_memcmp(competitor->network.MacAddress, mlme->assoc_bssid, ETH_ALEN) ==_FALSE) ++ if(pmlmepriv->assoc_by_bssid==true) { ++ if(_rtw_memcmp(competitor->network.MacAddress, pmlmepriv->assoc_bssid, ETH_ALEN) ==false) + goto exit; + } + + //check ssid, if needed -+ if(mlme->assoc_ssid.Ssid[0] && mlme->assoc_ssid.SsidLength) { -+ if( competitor->network.Ssid.SsidLength != mlme->assoc_ssid.SsidLength -+ || _rtw_memcmp(competitor->network.Ssid.Ssid, mlme->assoc_ssid.Ssid, mlme->assoc_ssid.SsidLength) == _FALSE ++ if(pmlmepriv->assoc_ssid.Ssid && pmlmepriv->assoc_ssid.SsidLength) { ++ if( competitor->network.Ssid.SsidLength != pmlmepriv->assoc_ssid.SsidLength ++ || _rtw_memcmp(competitor->network.Ssid.Ssid, pmlmepriv->assoc_ssid.Ssid, pmlmepriv->assoc_ssid.SsidLength) == false + ) + goto exit; + } + -+ if(rtw_is_desired_network(adapter, competitor) == _FALSE) ++ if(rtw_is_desired_network(adapter, competitor) == false) + goto exit; + +#ifdef CONFIG_LAYER2_ROAMING -+ if(rtw_to_roam(adapter) > 0) { -+ if( rtw_get_passing_time_ms((u32)competitor->last_scanned) >= mlme->roam_scanr_exp_ms -+ || is_same_ess(&competitor->network, &mlme->cur_network.network) == _FALSE ++ if(rtw_to_roaming(adapter) > 0) { ++ if( rtw_get_passing_time_ms((u32)competitor->last_scanned) >= RTW_SCAN_RESULT_EXPIRE ++ || is_same_ess(&competitor->network, &pmlmepriv->cur_network.network) == false + ) + goto exit; + } +#endif -+ ++ + if(*candidate == NULL ||(*candidate)->network.Rssinetwork.Rssi ) + { + *candidate = competitor; -+ updated = _TRUE; ++ updated = true; + } + + if(updated){ -+ DBG_871X("[by_bssid:%u][assoc_ssid:%s][to_roam:%u] " -+ "new candidate: %s("MAC_FMT", ch%u) rssi:%d\n", -+ mlme->assoc_by_bssid, -+ mlme->assoc_ssid.Ssid, -+ rtw_to_roam(adapter), ++ DBG_871X("[by_bssid:%u][assoc_ssid:%s]" ++ #ifdef CONFIG_LAYER2_ROAMING ++ "[to_roaming:%u] " ++ #endif ++ "new candidate: %s("MAC_FMT") rssi:%d\n", ++ pmlmepriv->assoc_by_bssid, ++ pmlmepriv->assoc_ssid.Ssid, ++ #ifdef CONFIG_LAYER2_ROAMING ++ rtw_to_roaming(adapter), ++ #endif + (*candidate)->network.Ssid.Ssid, + MAC_ARG((*candidate)->network.MacAddress), -+ (*candidate)->network.Configuration.DSConfig, + (int)(*candidate)->network.Rssi + ); + } @@ -30682,28 +18132,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + _irqL irqL; + int ret; + _list *phead; -+ _adapter *adapter; ++ _adapter *adapter; + _queue *queue = &(pmlmepriv->scanned_queue); + struct wlan_network *pnetwork = NULL; + struct wlan_network *candidate = NULL; -+ u8 bSupportAntDiv = _FALSE; ++ u8 bSupportAntDiv = false; + -+_func_enter_; + -+ adapter = (_adapter *)pmlmepriv->nic_hdl; + + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ #ifdef CONFIG_LAYER2_ROAMING -+ if (pmlmepriv->roam_network) { -+ candidate = pmlmepriv->roam_network; -+ pmlmepriv->roam_network = NULL; -+ goto candidate_exist; -+ } -+ #endif -+ + phead = get_list_head(queue); -+ pmlmepriv->pscanned = get_next(phead); ++ adapter = (_adapter *)pmlmepriv->nic_hdl; ++ ++ pmlmepriv->pscanned = get_next( phead ); + + while (!rtw_end_of_queue_search(phead, pmlmepriv->pscanned)) { + @@ -30713,19 +18154,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + ret = _FAIL; + goto exit; + } -+ ++ + pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); + -+ if (0) -+ DBG_871X("%s("MAC_FMT", ch%u) rssi:%d\n" -+ , pnetwork->network.Ssid.Ssid -+ , MAC_ARG(pnetwork->network.MacAddress) -+ , pnetwork->network.Configuration.DSConfig -+ , (int)pnetwork->network.Rssi); ++ #if 0 ++ DBG_871X("MacAddress:"MAC_FMT" ssid:%s\n", MAC_ARG(pnetwork->network.MacAddress), pnetwork->network.Ssid.Ssid); ++ #endif + + rtw_check_join_candidate(pmlmepriv, &candidate, pnetwork); -+ -+ } ++ ++ } + + if(candidate == NULL) { + DBG_871X("%s: return _FAIL(candidate == NULL)\n", __FUNCTION__); @@ -30738,13 +18176,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + DBG_871X("%s: candidate: %s("MAC_FMT", ch:%u)\n", __FUNCTION__, + candidate->network.Ssid.Ssid, MAC_ARG(candidate->network.MacAddress), + candidate->network.Configuration.DSConfig); -+ goto candidate_exist; + } -+ -+candidate_exist: + -+ // check for situation of _FW_LINKED -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ ++ // check for situation of _FW_LINKED ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) + { + DBG_871X("%s: _FW_LINKED while ask_for_joinbss!!!\n", __FUNCTION__); + @@ -30754,25 +18190,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + DBG_871X("%s: _FW_LINKED and is same network, it needn't join again\n", __FUNCTION__); + + rtw_indicate_connect(adapter);//rtw_indicate_connect again -+ ++ + ret = 2; + goto exit; + } + else + #endif + { -+ rtw_disassoc_cmd(adapter, 0, _TRUE); ++ rtw_disassoc_cmd(adapter, 0, true); + rtw_indicate_disconnect(adapter); + rtw_free_assoc_resources(adapter, 0); + } + } -+ ++ + #ifdef CONFIG_ANTENNA_DIVERSITY + rtw_hal_get_def_var(adapter, HAL_DEF_IS_SUPPORT_ANT_DIV, &(bSupportAntDiv)); -+ if(_TRUE == bSupportAntDiv) ++ if(true == bSupportAntDiv) + { + u8 CurrentAntenna; -+ rtw_hal_get_def_var(adapter, HAL_DEF_CURRENT_ANTENNA, &(CurrentAntenna)); ++ rtw_hal_get_def_var(adapter, HAL_DEF_CURRENT_ANTENNA, &(CurrentAntenna)); + DBG_871X("#### Opt_Ant_(%s) , cur_Ant(%s)\n", + (2==candidate->network.PhyInfo.Optimum_antenna)?"A":"B", + (2==CurrentAntenna)?"A":"B" @@ -30781,30 +18217,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + #endif + set_fwstate(pmlmepriv, _FW_UNDER_LINKING); + ret = rtw_joinbss_cmd(adapter, candidate); -+ ++ +exit: + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+_func_exit_; -+ + return ret; +} + +sint rtw_set_auth(_adapter * adapter,struct security_priv *psecuritypriv) +{ + struct cmd_obj* pcmd; -+ struct setauth_parm *psetauthparm; ++ struct setauth_parm *psetauthparm; + struct cmd_priv *pcmdpriv=&(adapter->cmdpriv); + sint res=_SUCCESS; -+ -+_func_enter_; + + pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(pcmd==NULL){ + res= _FAIL; //try again + goto exit; + } -+ ++ + psetauthparm=(struct setauth_parm*)rtw_zmalloc(sizeof(struct setauth_parm)); + if(psetauthparm==NULL){ + rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); @@ -30814,10 +18245,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + + _rtw_memset(psetauthparm, 0, sizeof(struct setauth_parm)); + psetauthparm->mode=(unsigned char)psecuritypriv->dot11AuthAlgrthm; -+ ++ + pcmd->cmdcode = _SetAuth_CMD_; -+ pcmd->parmbuf = (unsigned char *)psetauthparm; -+ pcmd->cmdsz = (sizeof(struct setauth_parm)); ++ pcmd->parmbuf = (unsigned char *)psetauthparm; ++ pcmd->cmdsz = (sizeof(struct setauth_parm)); + pcmd->rsp = NULL; + pcmd->rspsz = 0; + @@ -30830,14 +18261,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + +exit: + -+_func_exit_; ++ + + return res; + +} + + -+sint rtw_set_key(_adapter * adapter,struct security_priv *psecuritypriv,sint keyid, u8 set_tx, bool enqueue) ++sint rtw_set_key(_adapter * adapter,struct security_priv *psecuritypriv,sint keyid, u8 set_tx) +{ + u8 keylen; + struct cmd_obj *pcmd; @@ -30845,20 +18276,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + struct cmd_priv *pcmdpriv = &(adapter->cmdpriv); + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + sint res=_SUCCESS; -+ -+_func_enter_; + ++ ++ ++ pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ if(pcmd==NULL){ ++ res= _FAIL; //try again ++ goto exit; ++ } + psetkeyparm=(struct setkey_parm*)rtw_zmalloc(sizeof(struct setkey_parm)); -+ if(psetkeyparm==NULL){ ++ if(psetkeyparm==NULL){ ++ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); + res= _FAIL; + goto exit; + } ++ + _rtw_memset(psetkeyparm, 0, sizeof(struct setkey_parm)); + -+ if(psecuritypriv->dot11AuthAlgrthm ==dot11AuthAlgrthm_8021X){ -+ psetkeyparm->algorithm=(unsigned char)psecuritypriv->dot118021XGrpPrivacy; ++ if(psecuritypriv->dot11AuthAlgrthm ==dot11AuthAlgrthm_8021X){ ++ psetkeyparm->algorithm=(unsigned char)psecuritypriv->dot118021XGrpPrivacy; + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n rtw_set_key: psetkeyparm->algorithm=(unsigned char)psecuritypriv->dot118021XGrpPrivacy=%d \n", psetkeyparm->algorithm)); -+ } ++ } + else{ + psetkeyparm->algorithm=(u8)psecuritypriv->dot11PrivacyAlgrthm; + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n rtw_set_key: psetkeyparm->algorithm=(u8)psecuritypriv->dot11PrivacyAlgrthm=%d \n", psetkeyparm->algorithm)); @@ -30867,13 +18305,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + psetkeyparm->keyid = (u8)keyid;//0~3 + psetkeyparm->set_tx = set_tx; + if (is_wep_enc(psetkeyparm->algorithm)) -+ adapter->securitypriv.key_mask |= BIT(psetkeyparm->keyid); ++ pmlmepriv->key_mask |= BIT(psetkeyparm->keyid); + -+ DBG_871X("==> rtw_set_key algorithm(%x),keyid(%x),key_mask(%x)\n",psetkeyparm->algorithm,psetkeyparm->keyid, adapter->securitypriv.key_mask); ++#ifdef CONFIG_AUTOSUSPEND ++ if( true == adapter->pwrctrlpriv.bInternalAutoSuspend) ++ { ++ adapter->pwrctrlpriv.wepkeymask = pmlmepriv->key_mask; ++ DBG_871X("....AutoSuspend pwrctrlpriv.wepkeymask(%x)\n",adapter->pwrctrlpriv.wepkeymask); ++ } ++#endif ++ DBG_871X("==> rtw_set_key algorithm(%x),keyid(%x),key_mask(%x)\n",psetkeyparm->algorithm,psetkeyparm->keyid,pmlmepriv->key_mask); + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n rtw_set_key: psetkeyparm->algorithm=%d psetkeyparm->keyid=(u8)keyid=%d \n",psetkeyparm->algorithm, keyid)); + + switch(psetkeyparm->algorithm){ -+ ++ + case _WEP40_: + keylen=5; + _rtw_memcpy(&(psetkeyparm->key[0]), &(psecuritypriv->dot11DefKey[keyid].skey[0]), keylen); @@ -30883,49 +18328,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + _rtw_memcpy(&(psetkeyparm->key[0]), &(psecuritypriv->dot11DefKey[keyid].skey[0]), keylen); + break; + case _TKIP_: -+ keylen=16; ++ keylen=16; + _rtw_memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); + psetkeyparm->grpkey=1; + break; + case _AES_: -+ keylen=16; ++ keylen=16; + _rtw_memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); + psetkeyparm->grpkey=1; + break; + default: + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n rtw_set_key:psecuritypriv->dot11PrivacyAlgrthm = %x (must be 1 or 2 or 4 or 5)\n",psecuritypriv->dot11PrivacyAlgrthm)); + res= _FAIL; -+ rtw_mfree((unsigned char *)psetkeyparm, sizeof(struct setkey_parm)); + goto exit; + } -+ -+ -+ if(enqueue){ -+ pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(pcmd==NULL){ -+ rtw_mfree((unsigned char *)psetkeyparm, sizeof(struct setkey_parm)); -+ res= _FAIL; //try again -+ goto exit; -+ } -+ -+ pcmd->cmdcode = _SetKey_CMD_; -+ pcmd->parmbuf = (u8 *)psetkeyparm; -+ pcmd->cmdsz = (sizeof(struct setkey_parm)); -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; + -+ _rtw_init_listhead(&pcmd->list); + -+ //_rtw_init_sema(&(pcmd->cmd_sem), 0); ++ pcmd->cmdcode = _SetKey_CMD_; ++ pcmd->parmbuf = (u8 *)psetkeyparm; ++ pcmd->cmdsz = (sizeof(struct setkey_parm)); ++ pcmd->rsp = NULL; ++ pcmd->rspsz = 0; ++ ++ ++ _rtw_init_listhead(&pcmd->list); ++ ++ //_rtw_init_sema(&(pcmd->cmd_sem), 0); ++ ++ res = rtw_enqueue_cmd(pcmdpriv, pcmd); + -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ } -+ else{ -+ setkey_hdl(adapter, (u8 *)psetkeyparm); -+ rtw_mfree((u8 *) psetkeyparm, sizeof(struct setkey_parm)); -+ } +exit: -+_func_exit_; ++ + return res; + +} @@ -30940,8 +18373,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + i = 12; //after the fixed IE + while(i=0 :if there is pre-auth key, and return the entry id +// +// @@ -30993,30 +18426,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + + do + { -+ if( ( psecuritypriv->PMKIDList[i].bUsed ) && -+ ( _rtw_memcmp( psecuritypriv->PMKIDList[i].Bssid, bssid, ETH_ALEN ) == _TRUE ) ) ++ if( ( psecuritypriv->PMKIDList[i].bUsed ) && ++ ( _rtw_memcmp( psecuritypriv->PMKIDList[i].Bssid, bssid, ETH_ALEN ) == true ) ) + { + break; + } + else -+ { ++ { + i++; + //continue; + } -+ ++ + }while(isecuritypriv; ++ struct security_priv *psecuritypriv=&Adapter->securitypriv; + -+ if (ie[13] > 20) { -+ int i; -+ u16 pmkid_cnt = RTW_GET_LE16(ie+14+20); -+ if (pmkid_cnt == 1 && _rtw_memcmp(ie+14+20+2, &sec->PMKIDList[iEntry].PMKID, 16)) { -+ DBG_871X(FUNC_ADPT_FMT" has carried the same PMKID:"KEY_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), KEY_ARG(&sec->PMKIDList[iEntry].PMKID)); -+ goto exit; -+ } ++ if(ie[13]<=20){ ++ // The RSN IE didn't include the PMK ID, append the PMK information ++ ie[ie_len]=1; ++ ie_len++; ++ ie[ie_len]=0; //PMKID count = 0x0100 ++ ie_len++; ++ _rtw_memcpy( &ie[ie_len], &psecuritypriv->PMKIDList[iEntry].PMKID, 16); + -+ DBG_871X(FUNC_ADPT_FMT" remove original PMKID, count:%u\n" -+ , FUNC_ADPT_ARG(adapter), pmkid_cnt); ++ ie_len+=16; ++ ie[13]+=18;//PMKID length = 2+16 + -+ for (i=0;iPMKIDList[iEntry].PMKID)); -+ -+ RTW_PUT_LE16(&ie[ie_len], 1); -+ ie_len += 2; -+ -+ _rtw_memcpy(&ie[ie_len], &sec->PMKIDList[iEntry].PMKID, 16); -+ ie_len += 16; -+ -+ ie[13] += 18;//PMKID length = 2+16 -+ } -+ -+exit: + return (ie_len); ++ +} -+ -+static int rtw_remove_pmkid(_adapter *adapter, u8 *ie, uint ie_len) -+{ -+ struct security_priv *sec=&adapter->securitypriv; -+ int i; -+ u16 pmkid_cnt = RTW_GET_LE16(ie+14+20); -+ -+ if (ie[13] <= 20) -+ goto exit; -+ -+ DBG_871X(FUNC_ADPT_FMT" remove original PMKID, count:%u\n" -+ , FUNC_ADPT_ARG(adapter), pmkid_cnt); -+ -+ for (i=0;imlmepriv; + struct security_priv *psecuritypriv=&adapter->securitypriv; -+ uint ndisauthmode=psecuritypriv->ndisauthtype; ++ uint ndisauthmode=psecuritypriv->ndisauthtype; + uint ndissecuritytype = psecuritypriv->ndisencryptstatus; -+ -+_func_enter_; ++ ++ + + RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, + ("+rtw_restruct_sec_ie: ndisauthmode=%d ndissecuritytype=%d\n", + ndisauthmode, ndissecuritytype)); -+ ++ + //copy fixed ie only + _rtw_memcpy(out_ie, in_ie,12); + ielength=12; @@ -31121,81 +18509,74 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + if(check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) + { + _rtw_memcpy(out_ie+ielength, psecuritypriv->wps_ie, psecuritypriv->wps_ie_len); -+ ++ + ielength += psecuritypriv->wps_ie_len; + } + else if((authmode==_WPA_IE_ID_)||(authmode==_WPA2_IE_ID_)) -+ { -+ //copy RSN or SSN ++ { ++ //copy RSN or SSN + _rtw_memcpy(&out_ie[ielength], &psecuritypriv->supplicant_ie[0], psecuritypriv->supplicant_ie[1]+2); -+ /* debug for CONFIG_IEEE80211W -+ { -+ int jj; -+ printk("supplicant_ie_length=%d &&&&&&&&&&&&&&&&&&&\n", psecuritypriv->supplicant_ie[1]+2); -+ for(jj=0; jj < psecuritypriv->supplicant_ie[1]+2; jj++) -+ printk(" %02x ", psecuritypriv->supplicant_ie[jj]); -+ printk("\n"); -+ }*/ + ielength+=psecuritypriv->supplicant_ie[1]+2; + rtw_report_sec_ie(adapter, authmode, psecuritypriv->supplicant_ie); -+ ++ +#ifdef CONFIG_DRVEXT_MODULE -+ drvext_report_sec_ie(&adapter->drvextpriv, authmode, sec_ie); ++ drvext_report_sec_ie(&adapter->drvextpriv, authmode, sec_ie); +#endif + } + + iEntry = SecIsInPMKIDList(adapter, pmlmepriv->assoc_bssid); + if(iEntry<0) + { -+ if(authmode == _WPA2_IE_ID_) -+ ielength = rtw_remove_pmkid(adapter, out_ie, ielength); ++ return ielength; + } + else + { + if(authmode == _WPA2_IE_ID_) ++ { + ielength=rtw_append_pmkid(adapter, iEntry, out_ie, ielength); ++ } + } + -+_func_exit_; -+ -+ return ielength; ++ ++ ++ return ielength; +} + +void rtw_init_registrypriv_dev_network( _adapter* adapter) +{ + struct registry_priv* pregistrypriv = &adapter->registrypriv; ++ struct eeprom_priv* peepriv = &adapter->eeprompriv; + WLAN_BSSID_EX *pdev_network = &pregistrypriv->dev_network; -+ u8 *myhwaddr = adapter_mac_addr(adapter); -+ -+_func_enter_; ++ u8 *myhwaddr = myid(peepriv); ++ ++ + + _rtw_memcpy(pdev_network->MacAddress, myhwaddr, ETH_ALEN); + + _rtw_memcpy(&pdev_network->Ssid, &pregistrypriv->ssid, sizeof(NDIS_802_11_SSID)); -+ ++ + pdev_network->Configuration.Length=sizeof(NDIS_802_11_CONFIGURATION); -+ pdev_network->Configuration.BeaconPeriod = 100; ++ pdev_network->Configuration.BeaconPeriod = 100; + pdev_network->Configuration.FHConfig.Length = 0; + pdev_network->Configuration.FHConfig.HopPattern = 0; + pdev_network->Configuration.FHConfig.HopSet = 0; + pdev_network->Configuration.FHConfig.DwellTime = 0; -+ -+ -+_func_exit_; -+ ++ ++ ++ ++ +} + -+void rtw_update_registrypriv_dev_network(_adapter* adapter) ++void rtw_update_registrypriv_dev_network(_adapter* adapter) +{ + int sz=0; -+ struct registry_priv* pregistrypriv = &adapter->registrypriv; ++ struct registry_priv* pregistrypriv = &adapter->registrypriv; + WLAN_BSSID_EX *pdev_network = &pregistrypriv->dev_network; + struct security_priv* psecuritypriv = &adapter->securitypriv; + struct wlan_network *cur_network = &adapter->mlmepriv.cur_network; + //struct xmit_priv *pxmitpriv = &adapter->xmitpriv; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + -+_func_enter_; ++ + +#if 0 + pxmitpriv->vcs_setting = pregistrypriv->vrtl_carrier_sense; @@ -31203,9 +18584,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + pxmitpriv->vcs_type = pregistrypriv->vcs_type; + //pxmitpriv->rts_thresh = pregistrypriv->rts_thresh; + pxmitpriv->frag_len = pregistrypriv->frag_thresh; -+ ++ + adapter->qospriv.qos_option = pregistrypriv->wmm_enable; -+#endif ++#endif + + pdev_network->Privacy = (psecuritypriv->dot11PrivacyAlgrthm > 0 ? 1 : 0) ; // adhoc no 802.1x + @@ -31215,7 +18596,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + { + case WIRELESS_11B: + pdev_network->NetworkTypeInUse = (Ndis802_11DS); -+ break; ++ break; + case WIRELESS_11G: + case WIRELESS_11BG: + case WIRELESS_11_24N: @@ -31237,19 +18618,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + // TODO + break; + } -+ ++ + pdev_network->Configuration.DSConfig = (pregistrypriv->channel); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("pregistrypriv->channel=%d, pdev_network->Configuration.DSConfig=0x%x\n", pregistrypriv->channel, pdev_network->Configuration.DSConfig)); ++ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("pregistrypriv->channel=%d, pdev_network->Configuration.DSConfig=0x%x\n", pregistrypriv->channel, pdev_network->Configuration.DSConfig)); + -+ if (cur_network->network.InfrastructureMode == Ndis802_11IBSS) { ++ if(cur_network->network.InfrastructureMode == Ndis802_11IBSS) + pdev_network->Configuration.ATIMWindow = (0); + -+ if (pmlmeext->cur_channel != 0) -+ pdev_network->Configuration.DSConfig = pmlmeext->cur_channel; -+ else -+ pdev_network->Configuration.DSConfig = 1; -+ } -+ + pdev_network->InfrastructureMode = (cur_network->network.InfrastructureMode); + + // 1. Supported rates @@ -31264,45 +18639,51 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + + //notes: translate IELength & Length after assign the Length to cmdsz in createbss_cmd(); + //pdev_network->IELength = cpu_to_le32(sz); -+ -+_func_exit_; ++ ++ + +} + +void rtw_get_encrypt_decrypt_from_registrypriv(_adapter* adapter) +{ -+_func_enter_; + + -+_func_exit_; -+ ++ ++ ++ +} + -+//the fucntion is at passive_level ++//the fucntion is at passive_level +void rtw_joinbss_reset(_adapter *padapter) +{ + u8 threshold; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++#ifdef CONFIG_80211N_HT ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++#endif ++ + //todo: if you want to do something io/reg/hw setting before join_bss, please add code here -+ -+#ifdef CONFIG_80211N_HT -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; ++ ++ ++ ++ ++#ifdef CONFIG_80211N_HT + + pmlmepriv->num_FortyMHzIntolerant = 0; + + pmlmepriv->num_sta_no_ht = 0; + -+ phtpriv->ampdu_enable = _FALSE;//reset to disabled ++ phtpriv->ampdu_enable = false;//reset to disabled + -+#if defined( CONFIG_USB_HCI) || defined (CONFIG_SDIO_HCI) + // TH=1 => means that invalidate usb rx aggregation + // TH=0 => means that validate usb rx aggregation, use init value. + if(phtpriv->ht_option) + { -+ if(padapter->registrypriv.wifi_spec==1) ++ if(padapter->registrypriv.wifi_spec==1) + threshold = 1; + else -+ threshold = 0; ++ threshold = 0; + rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); + } + else @@ -31310,337 +18691,97 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + threshold = 1; + rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); + } -+#endif//#if defined( CONFIG_USB_HCI) || defined (CONFIG_SDIO_HCI) + -+#endif//#ifdef CONFIG_80211N_HT ++#endif + +} + + +#ifdef CONFIG_80211N_HT -+void rtw_ht_use_default_setting(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ BOOLEAN bHwLDPCSupport = _FALSE, bHwSTBCSupport = _FALSE; -+ BOOLEAN bHwSupportBeamformer = _FALSE, bHwSupportBeamformee = _FALSE; + -+ if (pregistrypriv->wifi_spec) -+ phtpriv->bss_coexist = 1; -+ else -+ phtpriv->bss_coexist = 0; -+ -+ phtpriv->sgi_40m = TEST_FLAG(pregistrypriv->short_gi, BIT1) ? _TRUE : _FALSE; -+ phtpriv->sgi_20m = TEST_FLAG(pregistrypriv->short_gi, BIT0) ? _TRUE : _FALSE; -+ -+ // LDPC support -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_LDPC, (u8 *)&bHwLDPCSupport); -+ CLEAR_FLAGS(phtpriv->ldpc_cap); -+ if(bHwLDPCSupport) -+ { -+ if(TEST_FLAG(pregistrypriv->ldpc_cap, BIT4)) -+ SET_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_RX); -+ } -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_LDPC, (u8 *)&bHwLDPCSupport); -+ if(bHwLDPCSupport) -+ { -+ if(TEST_FLAG(pregistrypriv->ldpc_cap, BIT5)) -+ SET_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX); -+ } -+ if (phtpriv->ldpc_cap) -+ DBG_871X("[HT] HAL Support LDPC = 0x%02X\n", phtpriv->ldpc_cap); -+ -+ // STBC -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_STBC, (u8 *)&bHwSTBCSupport); -+ CLEAR_FLAGS(phtpriv->stbc_cap); -+ if(bHwSTBCSupport) -+ { -+ if(TEST_FLAG(pregistrypriv->stbc_cap, BIT5)) -+ SET_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX); -+ } -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_STBC, (u8 *)&bHwSTBCSupport); -+ if(bHwSTBCSupport) -+ { -+ if(TEST_FLAG(pregistrypriv->stbc_cap, BIT4)) -+ SET_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX); -+ } -+ if (phtpriv->stbc_cap) -+ DBG_871X("[HT] HAL Support STBC = 0x%02X\n", phtpriv->stbc_cap); -+ -+ // Beamforming setting -+ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMER, (u8 *)&bHwSupportBeamformer); -+ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMEE, (u8 *)&bHwSupportBeamformee); -+ CLEAR_FLAGS(phtpriv->beamform_cap); -+ if(TEST_FLAG(pregistrypriv->beamform_cap, BIT4) && bHwSupportBeamformer) -+ { -+ SET_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); -+ DBG_871X("[HT] HAL Support Beamformer\n"); -+ } -+ if(TEST_FLAG(pregistrypriv->beamform_cap, BIT5) && bHwSupportBeamformee) -+ { -+ SET_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); -+ DBG_871X("[HT] HAL Support Beamformee\n"); -+ } -+} -+void rtw_build_wmm_ie_ht(_adapter *padapter, u8 *out_ie, uint *pout_len) -+{ -+ unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01, 0x00}; -+ int out_len; -+ u8 *pframe; -+ -+ if(padapter->mlmepriv.qospriv.qos_option == 0) -+ { -+ out_len = *pout_len; -+ pframe = rtw_set_ie(out_ie+out_len, _VENDOR_SPECIFIC_IE_, -+ _WMM_IE_Length_, WMM_IE, pout_len); -+ -+ padapter->mlmepriv.qospriv.qos_option = 1; -+ } -+} -+ -+/* the fucntion is >= passive_level */ -+unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len, u8 channel) ++//the fucntion is >= passive_level ++unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len) +{ + u32 ielen, out_len; + HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor; -+ HT_CAP_AMPDU_DENSITY best_ampdu_density; + unsigned char *p, *pframe; + struct rtw_ieee80211_ht_cap ht_capie; -+ u8 cbw40_enable = 0, stbc_rx_enable = 0, rf_type = 0, operation_bw = 0, rf_num = 0; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01, 0x00}; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct qos_priv *pqospriv= &pmlmepriv->qospriv; + struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + -+ phtpriv->ht_option = _FALSE; + -+ out_len = *pout_len; ++ phtpriv->ht_option = false; + -+ _rtw_memset(&ht_capie, 0, sizeof(struct rtw_ieee80211_ht_cap)); ++ p = rtw_get_ie(in_ie+12, _HT_CAPABILITY_IE_, &ielen, in_len-12); + -+ ht_capie.cap_info = IEEE80211_HT_CAP_DSSSCCK40; -+ -+ if (phtpriv->sgi_20m) -+ ht_capie.cap_info |= IEEE80211_HT_CAP_SGI_20; -+ -+ /* Get HT BW */ -+ if (in_ie == NULL) { -+ /* TDLS: TODO 20/40 issue */ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ operation_bw = padapter->mlmeextpriv.cur_bwmode; -+ if (operation_bw > CHANNEL_WIDTH_40) -+ operation_bw = CHANNEL_WIDTH_40; -+ } else -+ /* TDLS: TODO 40? */ -+ operation_bw = CHANNEL_WIDTH_40; -+ } else { -+ p = rtw_get_ie(in_ie, _HT_ADD_INFO_IE_, &ielen, in_len); -+ if (p && (ielen == sizeof(struct ieee80211_ht_addt_info))) { -+ struct HT_info_element *pht_info = (struct HT_info_element *)(p+2); -+ if (pht_info->infos[0] & BIT(2)) { -+ switch (pht_info->infos[0] & 0x3) { -+ case 1: -+ case 3: -+ operation_bw = CHANNEL_WIDTH_40; -+ break; -+ default: -+ operation_bw = CHANNEL_WIDTH_20; -+ break; -+ } -+ } else { -+ operation_bw = CHANNEL_WIDTH_20; -+ } -+ } -+ } -+ -+ /* to disable 40M Hz support while gd_bw_40MHz_en = 0 */ -+ if (channel > 14) { -+ if ((pregistrypriv->bw_mode & 0xf0) > 0) -+ cbw40_enable = 1; -+ } else { -+ if ((pregistrypriv->bw_mode & 0x0f) > 0) -+ cbw40_enable = 1; -+ } -+ -+ if ((cbw40_enable == 1) && (operation_bw == CHANNEL_WIDTH_40)) { -+ ht_capie.cap_info |= IEEE80211_HT_CAP_SUP_WIDTH; -+ if (phtpriv->sgi_40m) -+ ht_capie.cap_info |= IEEE80211_HT_CAP_SGI_40; -+ } -+ -+ /* todo: disable SM power save mode */ -+ ht_capie.cap_info |= IEEE80211_HT_CAP_SM_PS; -+ -+ /* RX LDPC */ -+ if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_RX)) { -+ ht_capie.cap_info |= IEEE80211_HT_CAP_LDPC_CODING; -+ DBG_871X("[HT] Declare supporting RX LDPC\n"); -+ } -+ -+ /* TX STBC */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX)) { -+ ht_capie.cap_info |= IEEE80211_HT_CAP_TX_STBC; -+ DBG_871X("[HT] Declare supporting TX STBC\n"); -+ } -+ -+ /* RX STBC */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX)) { -+ if((pregistrypriv->rx_stbc == 0x3) || /* enable for 2.4/5 GHz */ -+ ((channel <= 14) && (pregistrypriv->rx_stbc == 0x1)) || /* enable for 2.4GHz */ -+ ((channel > 14) && (pregistrypriv->rx_stbc == 0x2)) || /* enable for 5GHz */ -+ (pregistrypriv->wifi_spec == 1)) { -+ stbc_rx_enable = 1; -+ } -+ } -+ -+ //fill default supported_mcs_set -+ _rtw_memcpy(ht_capie.supp_mcs_set, pmlmeext->default_supported_mcs_set, 16); -+ -+ //update default supported_mcs_set -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ switch(rf_type) ++ if(p && ielen>0) + { -+ case RF_1T1R: -+ -+ if (stbc_rx_enable) { -+ ht_capie.cap_info |= IEEE80211_HT_CAP_RX_STBC_1R;//RX STBC One spatial stream -+ DBG_871X("[HT] Declare supporting RX STBC_1R\n"); ++ if(pqospriv->qos_option == 0) ++ { ++ out_len = *pout_len; ++ pframe = rtw_set_ie(out_ie+out_len, _VENDOR_SPECIFIC_IE_, ++ _WMM_IE_Length_, WMM_IE, pout_len); ++ ++ pqospriv->qos_option = 1; + } + -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_1R); -+ break; ++ out_len = *pout_len; + -+ case RF_2T2R: -+ case RF_1T2R: -+ if (stbc_rx_enable) { -+ ht_capie.cap_info |= IEEE80211_HT_CAP_RX_STBC_1R;/* RX STBC one spatial stream */ -+ DBG_871X("[HT] Declare supporting RX STBC_1R\n"); ++ _rtw_memset(&ht_capie, 0, sizeof(struct rtw_ieee80211_ht_cap)); ++ ++ ht_capie.cap_info = IEEE80211_HT_CAP_SUP_WIDTH |IEEE80211_HT_CAP_SGI_20 | ++ IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_TX_STBC | ++ IEEE80211_HT_CAP_DSSSCCK40; ++ ++ ++ { ++ u32 rx_packet_offset, max_recvbuf_sz; ++ rtw_hal_get_def_var(padapter, HAL_DEF_RX_PACKET_OFFSET, &rx_packet_offset); ++ rtw_hal_get_def_var(padapter, HAL_DEF_MAX_RECVBUF_SZ, &max_recvbuf_sz); ++ //if(max_recvbuf_sz-rx_packet_offset>(8191-256)) { ++ // DBG_871X("%s IEEE80211_HT_CAP_MAX_AMSDU is set\n", __FUNCTION__); ++ // ht_capie.cap_info = ht_capie.cap_info |IEEE80211_HT_CAP_MAX_AMSDU; ++ //} + } ++ /* ++ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k ++ AMPDU_para [4:2]:Min MPDU Start Spacing ++ */ + -+ #ifdef CONFIG_DISABLE_MCS13TO15 -+ if(((cbw40_enable == 1) && (operation_bw == CHANNEL_WIDTH_40)) && (pregistrypriv->wifi_spec!=1)) -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R_13TO15_OFF); -+ else -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R); -+ #else //CONFIG_DISABLE_MCS13TO15 -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R); -+ #endif //CONFIG_DISABLE_MCS13TO15 -+ break; -+ case RF_3T3R: -+ if (stbc_rx_enable) { -+ ht_capie.cap_info |= IEEE80211_HT_CAP_RX_STBC_1R;/* RX STBC one spatial stream */ -+ DBG_871X("[HT] Declare supporting RX STBC_1R\n"); -+ } -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_3R); -+ break; -+ default: -+ if (stbc_rx_enable) { -+ ht_capie.cap_info |= IEEE80211_HT_CAP_RX_STBC_1R;/* RX STBC one spatial stream */ -+ DBG_871X("[HT] Declare supporting RX STBC_1R\n"); -+ } -+ DBG_871X("[warning] rf_type %d is not expected\n", rf_type); -+ } -+ -+ { -+ u32 rx_packet_offset, max_recvbuf_sz; -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_PACKET_OFFSET, &rx_packet_offset); -+ rtw_hal_get_def_var(padapter, HAL_DEF_MAX_RECVBUF_SZ, &max_recvbuf_sz); -+ //if(max_recvbuf_sz-rx_packet_offset>(8191-256)) { -+ // DBG_871X("%s IEEE80211_HT_CAP_MAX_AMSDU is set\n", __FUNCTION__); -+ // ht_capie.cap_info = ht_capie.cap_info |IEEE80211_HT_CAP_MAX_AMSDU; -+ //} -+ } -+ /* -+ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k -+ AMPDU_para [4:2]:Min MPDU Start Spacing -+ */ -+ -+ /* -+ #if defined(CONFIG_RTL8188E )&& defined (CONFIG_SDIO_HCI) -+ ht_capie.ampdu_params_info = 2; -+ #else -+ ht_capie.ampdu_params_info = (IEEE80211_HT_CAP_AMPDU_FACTOR&0x03); -+ #endif -+ */ -+ -+ if(padapter->driver_rx_ampdu_factor != 0xFF) -+ max_rx_ampdu_factor = (HT_CAP_AMPDU_FACTOR)padapter->driver_rx_ampdu_factor; -+ else + rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); -+ -+ //rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); -+ ht_capie.ampdu_params_info = (max_rx_ampdu_factor&0x03); ++ ht_capie.ampdu_params_info = (max_rx_ampdu_factor&0x03); + -+ if(padapter->driver_rx_ampdu_spacing != 0xFF) -+ { -+ ht_capie.ampdu_params_info |= (( padapter->driver_rx_ampdu_spacing&0x07) <<2); -+ } -+ else -+ { -+ if (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) { -+ /* -+ * Todo : Each chip must to ask DD , this chip best ampdu_density setting -+ * By yiwei.sun -+ */ -+ rtw_hal_get_def_var(padapter, HW_VAR_BEST_AMPDU_DENSITY, &best_ampdu_density); -+ -+ ht_capie.ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & (best_ampdu_density << 2)); -+ -+ } else ++ if(padapter->securitypriv.dot11PrivacyAlgrthm == _AES_ ) ++ ht_capie.ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&(0x07<<2)); ++ else + ht_capie.ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&0x00); -+ } -+#ifdef CONFIG_BEAMFORMING -+ ht_capie.tx_BF_cap_info = 0; + -+ /* HT Beamformer*/ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { -+ /* Transmit NDP Capable */ -+ SET_HT_CAP_TXBF_TRANSMIT_NDP_CAP(&ht_capie, 1); -+ /* Explicit Compressed Steering Capable */ -+ SET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(&ht_capie, 1); -+ /* Compressed Steering Number Antennas */ -+ SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(&ht_capie, 1); -+ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMER_CAP, (u8 *)&rf_num); -+ SET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(&ht_capie, rf_num); -+ } + -+ /* HT Beamformee */ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) { -+ /* Receive NDP Capable */ -+ SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(&ht_capie, 1); -+ /* Explicit Compressed Beamforming Feedback Capable */ -+ SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(&ht_capie, 2); -+ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); -+ SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(&ht_capie, rf_num); -+ } -+#endif/*CONFIG_BEAMFORMING*/ ++ pframe = rtw_set_ie(out_ie+out_len, _HT_CAPABILITY_IE_, ++ sizeof(struct rtw_ieee80211_ht_cap), (unsigned char*)&ht_capie, pout_len); + -+ pframe = rtw_set_ie(out_ie+out_len, _HT_CAPABILITY_IE_, -+ sizeof(struct rtw_ieee80211_ht_cap), (unsigned char*)&ht_capie, pout_len); ++ phtpriv->ht_option = true; + -+ phtpriv->ht_option = _TRUE; -+ -+ if(in_ie!=NULL) -+ { -+ p = rtw_get_ie(in_ie, _HT_ADD_INFO_IE_, &ielen, in_len); ++ p = rtw_get_ie(in_ie+12, _HT_ADD_INFO_IE_, &ielen, in_len-12); + if(p && (ielen==sizeof(struct ieee80211_ht_addt_info))) + { -+ out_len = *pout_len; ++ out_len = *pout_len; + pframe = rtw_set_ie(out_ie+out_len, _HT_ADD_INFO_IE_, ielen, p+2 , pout_len); + } ++ + } + + return (phtpriv->ht_option); -+ ++ +} + +//the fucntion is > passive_level (in critical_section) +void rtw_update_ht_cap(_adapter *padapter, u8 *pie, uint ie_len, u8 channel) -+{ ++{ + u8 *p, max_ampdu_sz; -+ int len; ++ int len; + //struct sta_info *bmc_sta, *psta; + struct rtw_ieee80211_ht_cap *pht_capie; + struct ieee80211_ht_addt_info *pht_addtinfo; @@ -31653,7 +18794,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u8 cbw40_enable=0; -+ ++ + + if(!phtpriv->ht_option) + return; @@ -31664,44 +18805,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + DBG_871X("+rtw_update_ht_cap()\n"); + + //maybe needs check if ap supports rx ampdu. -+ if((phtpriv->ampdu_enable==_FALSE) &&(pregistrypriv->ampdu_enable==1)) ++ if((phtpriv->ampdu_enable==false) &&(pregistrypriv->ampdu_enable==1)) + { + if(pregistrypriv->wifi_spec==1) + { -+ //remove this part because testbed AP should disable RX AMPDU -+ //phtpriv->ampdu_enable = _FALSE; -+ phtpriv->ampdu_enable = _TRUE; ++ phtpriv->ampdu_enable = false; + } + else + { -+ phtpriv->ampdu_enable = _TRUE; ++ phtpriv->ampdu_enable = true; + } + } + else if(pregistrypriv->ampdu_enable==2) + { -+ //remove this part because testbed AP should disable RX AMPDU -+ //phtpriv->ampdu_enable = _TRUE; ++ phtpriv->ampdu_enable = true; + } + -+ -+ //check Max Rx A-MPDU Size ++ ++ //check Max Rx A-MPDU Size + len = 0; + p = rtw_get_ie(pie+sizeof (NDIS_802_11_FIXED_IEs), _HT_CAPABILITY_IE_, &len, ie_len-sizeof (NDIS_802_11_FIXED_IEs)); -+ if(p && len>0) ++ if(p && len>0) + { + pht_capie = (struct rtw_ieee80211_ht_cap *)(p+2); + max_ampdu_sz = (pht_capie->ampdu_params_info & IEEE80211_HT_CAP_AMPDU_FACTOR); + max_ampdu_sz = 1 << (max_ampdu_sz+3); // max_ampdu_sz (kbytes); -+ ++ + //DBG_871X("rtw_update_ht_cap(): max_ampdu_sz=%d\n", max_ampdu_sz); + phtpriv->rx_ampdu_maxlen = max_ampdu_sz; -+ ++ + } + + + len=0; + p = rtw_get_ie(pie+sizeof (NDIS_802_11_FIXED_IEs), _HT_ADD_INFO_IE_, &len, ie_len-sizeof (NDIS_802_11_FIXED_IEs)); -+ if(p && len>0) ++ if(p && len>0) + { + pht_addtinfo = (struct ieee80211_ht_addt_info *)(p+2); + //todo: @@ -31717,58 +18855,56 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + + //update cur_bwmode & cur_ch_offset + if ((cbw40_enable) && -+ (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & BIT(1)) && ++ (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & BIT(1)) && + (pmlmeinfo->HT_info.infos[0] & BIT(2))) + { + int i; -+ u8 rf_type = RF_1T1R; ++ u8 rf_type; + -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ //update the MCS set -+ for (i = 0; i < 16; i++) -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= pmlmeext->default_supported_mcs_set[i]; ++ padapter->HalFunc.GetHwRegHandler(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); + + //update the MCS rates -+ switch(rf_type) ++ for (i = 0; i < 16; i++) + { -+ case RF_1T1R: -+ case RF_1T2R: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_1R); -+ break; -+ case RF_2T2R: ++ if((rf_type == RF_1T1R) || (rf_type == RF_1T2R)) ++ { ++ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; ++ } ++ else ++ { + #ifdef CONFIG_DISABLE_MCS13TO15 -+ if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && pregistrypriv->wifi_spec != 1 ) -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R_13TO15_OFF); ++ if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && pregistrypriv->wifi_spec != 1 ) ++ { ++ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_2R_MCS13TO15_OFF[i]; ++ } + else -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+#else //CONFIG_DISABLE_MCS13TO15 -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+#endif //CONFIG_DISABLE_MCS13TO15 -+ break; -+ case RF_3T3R: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_3R); -+ break; -+ default: -+ DBG_871X("[warning] rf_type %d is not expected\n", rf_type); ++ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_2R[i]; ++ #else ++ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_2R[i]; ++ #endif //CONFIG_DISABLE_MCS13TO15 ++ } ++ #ifdef RTL8192C_RECONFIG_TO_1T1R ++ { ++ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; ++ } ++ #endif + } -+ + //switch to the 40M Hz mode accoring to the AP -+ //pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; ++ pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; + switch ((pmlmeinfo->HT_info.infos[0] & 0x3)) + { + case EXTCHNL_OFFSET_UPPER: + pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; + break; -+ ++ + case EXTCHNL_OFFSET_LOWER: + pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; + break; -+ ++ + default: + pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + break; -+ } ++ } + } + + // @@ -31791,8 +18927,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + // + pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; + -+ -+ ++ ++ +#if 0 //move to rtw_update_sta_info_client() + //for A-MPDU Rx reordering buffer control for bmc_sta & sta_info + //if A-MPDU Rx is enabled, reseting rx_ordering_ctrl wstart_b(indicate_seq) to default value=0xffff @@ -31804,7 +18940,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + { + //preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; + preorder_ctrl = &bmc_sta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = _FALSE; ++ preorder_ctrl->enable = false; + preorder_ctrl->indicate_seq = 0xffff; + #ifdef DBG_RX_SEQ + DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u \n", __FUNCTION__, __LINE__, @@ -31822,7 +18958,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + { + //preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; + preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = _FALSE; ++ preorder_ctrl->enable = false; + preorder_ctrl->indicate_seq = 0xffff; + #ifdef DBG_RX_SEQ + DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u \n", __FUNCTION__, __LINE__, @@ -31832,41 +18968,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + preorder_ctrl->wsize_b = 64;//max_ampdu_sz;//ex. 32(kbytes) -> wsize_b=32 + } + } -+#endif ++#endif + +} + -+#ifdef CONFIG_TDLS -+void rtw_issue_addbareq_cmd_tdls(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ struct pkt_attrib *pattrib =&pxmitframe->attrib; -+ struct sta_info *ptdls_sta = NULL; -+ u8 issued; -+ int priority; -+ struct ht_priv *phtpriv; -+ -+ priority = pattrib->priority; -+ -+ if (pattrib->direct_link == _TRUE) { -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); -+ if ((ptdls_sta != NULL) && (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) { -+ phtpriv = &ptdls_sta->htpriv; -+ -+ if ((phtpriv->ht_option == _TRUE) && (phtpriv->ampdu_enable == _TRUE)) { -+ issued = (phtpriv->agg_enable_bitmap>>priority)&0x1; -+ issued |= (phtpriv->candidate_tid_bitmap>>priority)&0x1; -+ -+ if (0 == issued) { -+ DBG_871X("[%s], p=%d\n", __FUNCTION__, priority); -+ ptdls_sta->htpriv.candidate_tid_bitmap |= BIT((u8)priority); -+ rtw_addbareq_cmd(padapter,(u8)priority, pattrib->dst); -+ } -+ } -+ } -+ } -+} -+#endif //CONFIG_TDLS -+ +void rtw_issue_addbareq_cmd(_adapter *padapter, struct xmit_frame *pxmitframe) +{ + u8 issued; @@ -31876,15 +18981,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + struct pkt_attrib *pattrib =&pxmitframe->attrib; + s32 bmcst = IS_MCAST(pattrib->ra); + -+ //if(bmcst || (padapter->mlmepriv.LinkDetectInfo.bTxBusyTraffic == _FALSE)) -+ if(bmcst || (padapter->mlmepriv.LinkDetectInfo.NumTxOkInPeriod<100)) ++ //if(bmcst || (padapter->mlmepriv.LinkDetectInfo.bTxBusyTraffic == false)) ++ if(bmcst || (padapter->mlmepriv.LinkDetectInfo.NumTxOkInPeriod<100)) + return; -+ -+ priority = pattrib->priority; + -+#ifdef CONFIG_TDLS -+ rtw_issue_addbareq_cmd_tdls(padapter, pxmitframe); -+#endif //CONFIG_TDLS ++ priority = pattrib->priority; + + psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); + if(pattrib->psta != psta) @@ -31892,7 +18993,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + DBG_871X("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); + return; + } -+ ++ + if(psta==NULL) + { + DBG_871X("%s, psta==NUL\n", __func__); @@ -31903,12 +19004,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + { + DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); + return; -+ } ++ } + + + phtpriv = &psta->htpriv; + -+ if((phtpriv->ht_option==_TRUE) && (phtpriv->ampdu_enable==_TRUE)) ++ if((phtpriv->ht_option==true) && (phtpriv->ampdu_enable==true)) + { + issued = (phtpriv->agg_enable_bitmap>>priority)&0x1; + issued |= (phtpriv->candidate_tid_bitmap>>priority)&0x1; @@ -31923,53 +19024,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + +} + -+void rtw_append_exented_cap(_adapter *padapter, u8 *out_ie, uint *pout_len) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+#endif //CONFIG_80211AC_VHT -+ u8 cap_content[8] = { 0 }; -+ u8 *pframe; -+ u8 null_content[8] = {0}; -+ -+ if (phtpriv->bss_coexist) { -+ SET_EXT_CAPABILITY_ELE_BSS_COEXIST(cap_content, 1); -+ } -+ -+#ifdef CONFIG_80211AC_VHT -+ if (pvhtpriv->vht_option) { -+ SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(cap_content, 1); -+ } -+#endif //CONFIG_80211AC_VHT -+ /* -+ From 802.11 specification,if a STA does not support any of capabilities defined -+ in the Extended Capabilities element, then the STA is not required to -+ transmit the Extended Capabilities element. -+ */ -+ if (_FALSE == _rtw_memcmp(cap_content, null_content, 8)) -+ pframe = rtw_set_ie(out_ie + *pout_len, EID_EXTCapability, 8, cap_content , pout_len); -+} +#endif + +#ifdef CONFIG_LAYER2_ROAMING -+inline void rtw_set_to_roam(_adapter *adapter, u8 to_roam) ++inline void rtw_set_roaming(_adapter *adapter, u8 to_roaming) +{ -+ if (to_roam == 0) -+ adapter->mlmepriv.to_join = _FALSE; -+ adapter->mlmepriv.to_roam = to_roam; ++ if (to_roaming == 0) ++ adapter->mlmepriv.to_join = false; ++ adapter->mlmepriv.to_roaming = to_roaming; +} + -+inline u8 rtw_dec_to_roam(_adapter *adapter) ++inline u8 rtw_to_roaming(_adapter *adapter) +{ -+ adapter->mlmepriv.to_roam--; -+ return adapter->mlmepriv.to_roam; -+} -+ -+inline u8 rtw_to_roam(_adapter *adapter) -+{ -+ return adapter->mlmepriv.to_roam; ++ return adapter->mlmepriv.to_roaming; +} + +void rtw_roaming(_adapter *padapter, struct wlan_network *tgt_network) @@ -31984,16 +19051,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au +void _rtw_roaming(_adapter *padapter, struct wlan_network *tgt_network) +{ + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; + int do_join_r; -+ -+ if(0 < rtw_to_roam(padapter)) { -+ DBG_871X("roaming from %s("MAC_FMT"), length:%d\n", -+ cur_network->network.Ssid.Ssid, MAC_ARG(cur_network->network.MacAddress), -+ cur_network->network.Ssid.SsidLength); -+ _rtw_memcpy(&pmlmepriv->assoc_ssid, &cur_network->network.Ssid, sizeof(NDIS_802_11_SSID)); + -+ pmlmepriv->assoc_by_bssid = _FALSE; ++ struct wlan_network *pnetwork; ++ ++ if(tgt_network != NULL) ++ pnetwork = tgt_network; ++ else ++ pnetwork = &pmlmepriv->cur_network; ++ ++ if(0 < rtw_to_roaming(padapter)) { ++ DBG_871X("roaming from %s("MAC_FMT"), length:%d\n", ++ pnetwork->network.Ssid.Ssid, MAC_ARG(pnetwork->network.MacAddress), ++ pnetwork->network.Ssid.SsidLength); ++ _rtw_memcpy(&pmlmepriv->assoc_ssid, &pnetwork->network.Ssid, sizeof(NDIS_802_11_SSID)); ++ ++ pmlmepriv->assoc_by_bssid = false; + +#ifdef CONFIG_WAPI_SUPPORT + rtw_wapi_return_all_sta_info(padapter); @@ -32004,9 +19077,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + break; + } else { + DBG_871X("roaming do_join return %d\n", do_join_r); -+ rtw_dec_to_roam(padapter); -+ -+ if(rtw_to_roam(padapter) > 0) { ++ pmlmepriv->to_roaming--; ++ ++ if(0< rtw_to_roaming(padapter)) { + continue; + } else { + DBG_871X("%s(%d) -to roaming fail, indicate_disconnect\n", __FUNCTION__,__LINE__); @@ -32016,101 +19089,80 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme.c linux/3rdparty/rtl8812au + } + } + } -+ ++ +} -+#endif /* CONFIG_LAYER2_ROAMING */ ++#endif + +sint rtw_linked_check(_adapter *padapter) +{ -+ if( (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) || -+ (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE) == _TRUE)) ++ if( (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == true) || ++ (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE) == true)) + { + if(padapter->stapriv.asoc_sta_count > 2) -+ return _TRUE; ++ return true; + } + else + { //Station mode -+ if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)== _TRUE) -+ return _TRUE; ++ if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)== true) ++ return true; + } -+ return _FALSE; ++ return false; +} + +#ifdef CONFIG_CONCURRENT_MODE +sint rtw_buddy_adapter_up(_adapter *padapter) -+{ -+ sint res = _FALSE; -+ ++{ ++ sint res = false; ++ + if(padapter == NULL) + return res; + + + if(padapter->pbuddy_adapter == NULL) -+ res = _FALSE; -+ else if (RTW_CANNOT_RUN(padapter) || -+ (padapter->pbuddy_adapter->bup == _FALSE) || (!rtw_is_hw_init_completed(padapter))) -+ res = _FALSE; ++ { ++ res = false; ++ } ++ else if( (padapter->pbuddy_adapter->bDriverStopped) || (padapter->pbuddy_adapter->bSurpriseRemoved) || ++ (padapter->pbuddy_adapter->bup == false) || (padapter->pbuddy_adapter->hw_init_completed == false)) ++ { ++ res = false; ++ } + else -+ res = _TRUE; ++ { ++ res = true; ++ } + -+ return res; ++ return res; + +} + +sint check_buddy_fwstate(_adapter *padapter, sint state) +{ + if(padapter == NULL) -+ return _FALSE; -+ ++ return false; ++ + if(padapter->pbuddy_adapter == NULL) -+ return _FALSE; -+ -+ if ((state == WIFI_FW_NULL_STATE) && ++ return false; ++ ++ if ((state == WIFI_FW_NULL_STATE) && + (padapter->pbuddy_adapter->mlmepriv.fw_state == WIFI_FW_NULL_STATE)) -+ return _TRUE; -+ ++ return true; ++ + if (padapter->pbuddy_adapter->mlmepriv.fw_state & state) -+ return _TRUE; ++ return true; + -+ return _FALSE; -+} -+ -+u8 rtw_get_buddy_bBusyTraffic(_adapter *padapter) -+{ -+ if(padapter == NULL) -+ return _FALSE; -+ -+ if(padapter->pbuddy_adapter == NULL) -+ return _FALSE; -+ -+ return padapter->pbuddy_adapter->mlmepriv.LinkDetectInfo.bBusyTraffic; ++ return false; +} + +#endif //CONFIG_CONCURRENT_MODE -+ -+static const char *miracast_mode_str[] = { -+ "DISABLED", -+ "SOURCE", -+ "SINK", -+ "INVALID", -+}; -+ -+const char *get_miracast_mode_str(int mode) -+{ -+ if (mode < MIRACAST_DISABLED || mode >= MIRACAST_INVALID) -+ mode = MIRACAST_INVALID; -+ -+ return miracast_mode_str[mode]; -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl8812au/core/rtw_mlme_ext.c ---- linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_mlme_ext.c 2017-06-07 23:07:21.002686756 +0300 -@@ -0,0 +1,15527 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mlme_ext.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_mlme_ext.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mlme_ext.c 2018-02-06 17:42:30.697966972 +0200 +@@ -0,0 +1,13271 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -32120,22 +19172,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_MLME_EXT_C_ + +#include -+#ifdef CONFIG_IOCTL_CFG80211 -+#include -+#endif //CONFIG_IOCTL_CFG80211 -+#include ++#include "rtw_mlme.h" + -+ -+struct mlme_handler mlme_sta_tbl[]={ ++static struct mlme_handler mlme_sta_tbl[]={ + {WIFI_ASSOCREQ, "OnAssocReq", &OnAssocReq}, + {WIFI_ASSOCRSP, "OnAssocRsp", &OnAssocRsp}, + {WIFI_REASSOCREQ, "OnReAssocReq", &OnAssocReq}, @@ -32154,7 +19197,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + {WIFI_AUTH, "OnAuth", &OnAuthClient}, + {WIFI_DEAUTH, "OnDeAuth", &OnDeAuth}, + {WIFI_ACTION, "OnAction", &OnAction}, -+ {WIFI_ACTION_NOACK,"OnActionNoAck", &OnAction}, +}; + +#ifdef _CONFIG_NATIVEAP_MLME_ @@ -32177,11 +19219,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + {WIFI_AUTH, "OnAuth", &OnAuth}, + {WIFI_DEAUTH, "OnDeAuth", &OnDeAuth}, + {WIFI_ACTION, "OnAction", &OnAction}, -+ {WIFI_ACTION_NOACK,"OnActionNoAck", &OnAction}, +}; +#endif + -+struct action_handler OnAction_tbl[]={ ++static struct action_handler OnAction_tbl[]={ + {RTW_WLAN_CATEGORY_SPECTRUM_MGMT, "ACTION_SPECTRUM_MGMT", on_action_spct}, + {RTW_WLAN_CATEGORY_QOS, "ACTION_QOS", &OnAction_qos}, + {RTW_WLAN_CATEGORY_DLS, "ACTION_DLS", &OnAction_dls}, @@ -32190,21 +19231,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + {RTW_WLAN_CATEGORY_RADIO_MEASUREMENT, "ACTION_RADIO_MEASUREMENT", &DoReserved}, + {RTW_WLAN_CATEGORY_FT, "ACTION_FT", &DoReserved}, + {RTW_WLAN_CATEGORY_HT, "ACTION_HT", &OnAction_ht}, -+#ifdef CONFIG_IEEE80211W -+ {RTW_WLAN_CATEGORY_SA_QUERY, "ACTION_SA_QUERY", &OnAction_sa_query}, -+#else + {RTW_WLAN_CATEGORY_SA_QUERY, "ACTION_SA_QUERY", &DoReserved}, -+#endif //CONFIG_IEEE80211W -+ //add for CONFIG_IEEE80211W -+ {RTW_WLAN_CATEGORY_UNPROTECTED_WNM, "ACTION_UNPROTECTED_WNM", &DoReserved}, -+ {RTW_WLAN_CATEGORY_SELF_PROTECTED, "ACTION_SELF_PROTECTED", &DoReserved}, + {RTW_WLAN_CATEGORY_WMM, "ACTION_WMM", &OnAction_wmm}, -+ {RTW_WLAN_CATEGORY_VHT, "ACTION_VHT", &OnAction_vht}, -+ {RTW_WLAN_CATEGORY_P2P, "ACTION_P2P", &OnAction_p2p}, ++ {RTW_WLAN_CATEGORY_P2P, "ACTION_P2P", &OnAction_p2p}, +}; + + -+u8 null_addr[ETH_ALEN]= {0,0,0,0,0,0}; ++static u8 null_addr[ETH_ALEN]= {0,0,0,0,0,0}; + +/************************************************** +OUI definitions for the vendor specific IE @@ -32221,538 +19254,158 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +unsigned char WPA_TKIP_CIPHER[4] = {0x00, 0x50, 0xf2, 0x02}; +unsigned char RSN_TKIP_CIPHER[4] = {0x00, 0x0f, 0xac, 0x02}; + -+extern unsigned char REALTEK_96B_IE[]; ++static unsigned char REALTEK_96B_IE[] = {0x00, 0xe0, 0x4c, 0x02, 0x01, 0x20}; ++ ++/******************************************************** ++MCS rate definitions ++*********************************************************/ ++#ifdef CONFIG_DISABLE_MCS13TO15 ++unsigned char MCS_rate_2R_MCS13TO15_OFF[16] = {0xff, 0x1f, 0x0, 0x0, 0x01, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; ++unsigned char MCS_rate_2R[16] = {0xff, 0xff, 0x0, 0x0, 0x01, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; ++#else //CONFIG_DISABLE_MCS13TO15 ++unsigned char MCS_rate_2R[16] = {0xff, 0xff, 0x0, 0x0, 0x01, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; ++#endif //CONFIG_DISABLE_MCS13TO15 ++unsigned char MCS_rate_1R[16] = {0xff, 0x00, 0x0, 0x0, 0x01, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; + -+#ifdef LEGACY_CHANNEL_PLAN_REF +/******************************************************** +ChannelPlan definitions +*********************************************************/ -+static RT_CHANNEL_PLAN legacy_channel_plan[] = { -+ /* 0x00, RTW_CHPLAN_FCC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165}, 32}, -+ /* 0x01, RTW_CHPLAN_IC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 31}, -+ /* 0x02, RTW_CHPLAN_ETSI */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 32}, -+ /* 0x03, RTW_CHPLAN_SPAIN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, -+ /* 0x04, RTW_CHPLAN_FRANCE */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, -+ /* 0x05, RTW_CHPLAN_MKK */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, -+ /* 0x06, RTW_CHPLAN_MKK1 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, -+ /* 0x07, RTW_CHPLAN_ISRAEL */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64}, 21}, -+ /* 0x08, RTW_CHPLAN_TELEC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52, 56, 60, 64}, 22}, -+ /* 0x09, RTW_CHPLAN_GLOBAL_DOAMIN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14}, -+ /* 0x0A, RTW_CHPLAN_WORLD_WIDE_13 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, -+ /* 0x0B, RTW_CHPLAN_TAIWAN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 26}, -+ /* 0x0C, RTW_CHPLAN_CHINA */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 149, 153, 157, 161, 165}, 18}, -+ /* 0x0D, RTW_CHPLAN_SINGAPORE_INDIA_MEXICO */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165}, 24}, -+ /* 0x0E, RTW_CHPLAN_KOREA */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161, 165}, 31}, -+ /* 0x0F, RTW_CHPLAN_TURKEY */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64}, 19}, -+ /* 0x10, RTW_CHPLAN_JAPAN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 32}, -+ /* 0x11, RTW_CHPLAN_FCC_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 149, 153, 157, 161, 165}, 20}, -+ /* 0x12, RTW_CHPLAN_JAPAN_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48}, 17}, -+ /* 0x13, RTW_CHPLAN_WORLD_WIDE_5G */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165}, 37}, -+ /* 0x14, RTW_CHPLAN_TAIWAN_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 56, 60, 64, 149, 153, 157, 161, 165}, 19}, -+}; -+#endif ++/*static RT_CHANNEL_PLAN DefaultChannelPlan[RT_CHANNEL_DOMAIN_MAX] = { ++ {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,52,56,60,64,100,104,108,112,116,132,136,140,149,153,157,161,165},32}, // 0x00, RT_CHANNEL_DOMAIN_FCC ++ {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165},31}, // 0x01, RT_CHANNEL_DOMAIN_IC ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140},32}, // 0x02, RT_CHANNEL_DOMAIN_ETSI ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x03, RT_CHANNEL_DOMAIN_SPAIN ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x04, RT_CHANNEL_DOMAIN_FRANCE ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x05, RT_CHANNEL_DOMAIN_MKK ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x06, RT_CHANNEL_DOMAIN_MKK1 ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64},21}, // 0x07, RT_CHANNEL_DOMAIN_ISRAEL ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,40,44,48,52,56,60,64},22}, // 0x08, RT_CHANNEL_DOMAIN_TELEC ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13,14},14}, // 0x09, RT_CHANNEL_DOMAIN_GLOBAL_DOAMIN ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x0A, RT_CHANNEL_DOMAIN_WORLD_WIDE_13 ++ {{1,2,3,4,5,6,7,8,9,10,11,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165},26}, // 0x0B, RT_CHANNEL_DOMAIN_TAIWAN ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13,149,153,157,161,165},18}, // 0x0C, RT_CHANNEL_DOMAIN_CHINA ++ {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,52,56,60,64,149,153,157,161,165},24}, // 0x0D, RT_CHANNEL_DOMAIN_SINGAPORE_INDIA_MEXICO ++ {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165},31}, // 0x0E, RT_CHANNEL_DOMAIN_KOREA ++ {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,52,56,60,64},19}, // 0x0F, RT_CHANNEL_DOMAIN_TURKEY ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140},32}, // 0x10, RT_CHANNEL_DOMAIN_JAPAN ++ {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,149,153,157,161,165},20}, // 0x11, RT_CHANNEL_DOMAIN_FCC_NO_DFS ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48},17}, // 0x12, RT_CHANNEL_DOMAIN_JAPAN_NO_DFS ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165},37}, // 0x13, RT_CHANNEL_DOMAIN_WORLD_WIDE_5G ++ {{1,2,3,4,5,6,7,8,9,10,11,56,60,64,149,153,157,161,165},19}, // 0x14, RT_CHANNEL_DOMAIN_TAIWAN_NO_DFS ++};*/ + -+static RT_CHANNEL_PLAN_2G RTW_ChannelPlan2G[] = { -+ /* 0, RTW_RD_2G_NULL */ {{}, 0}, -+ /* 1, RTW_RD_2G_WORLD */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, -+ /* 2, RTW_RD_2G_ETSI1 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, -+ /* 3, RTW_RD_2G_FCC1 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11}, 11}, -+ /* 4, RTW_RD_2G_MKK1 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14}, -+ /* 5, RTW_RD_2G_ETSI2 */ {{10, 11, 12, 13}, 4}, -+ /* 6, RTW_RD_2G_GLOBAL */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14}, -+ /* 7, RTW_RD_2G_MKK2 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, ++static RT_CHANNEL_PLAN_2G RTW_ChannelPlan2G[RT_CHANNEL_DOMAIN_2G_MAX] = { ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x00, RT_CHANNEL_DOMAIN_2G_WORLD , Passive scan CH 12, 13 ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x01, RT_CHANNEL_DOMAIN_2G_ETSI1 ++ {{1,2,3,4,5,6,7,8,9,10,11},11}, // 0x02, RT_CHANNEL_DOMAIN_2G_FCC1 ++ {{1,2,3,4,5,6,7,8,9,10,11,12,13,14},14}, // 0x03, RT_CHANNEL_DOMAIN_2G_MIKK1 ++ {{10,11,12,13},4}, // 0x04, RT_CHANNEL_DOMAIN_2G_ETSI2 ++ {{},0}, // 0x05, RT_CHANNEL_DOMAIN_2G_NULL +}; + -+static RT_CHANNEL_PLAN_5G RTW_ChannelPlan5G[] = { -+ /* 0, RTW_RD_5G_NULL */ {{}, 0}, -+ /* 1, RTW_RD_5G_ETSI1 */ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 19}, -+ /* 2, RTW_RD_5G_ETSI2 */ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165}, 24}, -+ /* 3, RTW_RD_5G_ETSI3 */ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 149, 153, 157, 161, 165}, 22}, -+ /* 4, RTW_RD_5G_FCC1 */ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165}, 24}, -+ /* 5, RTW_RD_5G_FCC2 */ {{36, 40, 44, 48, 149, 153, 157, 161, 165}, 9}, -+ /* 6, RTW_RD_5G_FCC3 */ {{36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165}, 13}, -+ /* 7, RTW_RD_5G_FCC4 */ {{36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161}, 12}, -+ /* 8, RTW_RD_5G_FCC5 */ {{149, 153, 157, 161, 165}, 5}, -+ /* 9, RTW_RD_5G_FCC6 */ {{36, 40, 44, 48, 52, 56, 60, 64}, 8}, -+ /* 10, RTW_RD_5G_FCC7 */ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165}, 21}, -+ /* 11, RTW_RD_5G_KCC1 */ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161}, 19}, -+ /* 12, RTW_RD_5G_MKK1 */ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 19}, -+ /* 13, RTW_RD_5G_MKK2 */ {{36, 40, 44, 48, 52, 56, 60, 64}, 8}, -+ /* 14, RTW_RD_5G_MKK3 */ {{100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 11}, -+ /* 15, RTW_RD_5G_NCC1 */ {{56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165}, 16}, -+ /* 16, RTW_RD_5G_NCC2 */ {{56, 60, 64, 149, 153, 157, 161, 165}, 8}, -+ /* 17, RTW_RD_5G_NCC3 */ {{149, 153, 157, 161, 165}, 5}, -+ /* 18, RTW_RD_5G_ETSI4 */ {{36, 40, 44, 48}, 4}, -+ /* 19, RTW_RD_5G_ETSI5 */ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165}, 21}, -+ /* 20, RTW_RD_5G_FCC8 */ {{149, 153, 157, 161}, 4}, -+ /* 21, RTW_RD_5G_ETSI6 */ {{36, 40, 44, 48, 52, 56, 60, 64}, 8}, -+ /* 22, RTW_RD_5G_ETSI7 */ {{36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165}, 13}, -+ /* 23, RTW_RD_5G_ETSI8 */ {{36, 40, 44, 48, 149, 153, 157, 161, 165}, 9}, -+ /* 24, RTW_RD_5G_ETSI9 */ {{100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 11}, -+ /* 25, RTW_RD_5G_ETSI10 */ {{149, 153, 157, 161, 165}, 5}, -+ /* 26, RTW_RD_5G_ETSI11 */ {{36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140, 149, 153, 157, 161, 165}, 16}, -+ /* 27, RTW_RD_5G_NCC4 */ {{52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165}, 17}, -+ /* 28, RTW_RD_5G_ETSI12 */ {{149, 153, 157, 161}, 4}, -+ /* 29, RTW_RD_5G_FCC9 */ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165}, 21}, -+ /* 30, RTW_RD_5G_ETSI13 */ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140}, 16}, -+ /* 31, RTW_RD_5G_FCC10 */ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161}, 20}, -+ /* 32, RTW_RD_5G_MKK4 */ {{36, 40, 44, 48}, 4}, -+ /* 33, RTW_RD_5G_ETSI14 */ {{36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140}, 11}, ++static RT_CHANNEL_PLAN_5G RTW_ChannelPlan5G[RT_CHANNEL_DOMAIN_5G_MAX] = { ++ {{},0}, // 0x00, RT_CHANNEL_DOMAIN_5G_NULL ++ {{36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140},19}, // 0x01, RT_CHANNEL_DOMAIN_5G_ETSI1 ++ {{36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165},24}, // 0x02, RT_CHANNEL_DOMAIN_5G_ETSI2 ++ {{36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165},22}, // 0x03, RT_CHANNEL_DOMAIN_5G_ETSI3 ++ {{36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165},24}, // 0x04, RT_CHANNEL_DOMAIN_5G_FCC1 ++ {{36,40,44,48,149,153,157,161,165},9}, // 0x05, RT_CHANNEL_DOMAIN_5G_FCC2 ++ {{36,40,44,48,52,56,60,64,149,153,157,161,165},13}, // 0x06, RT_CHANNEL_DOMAIN_5G_FCC3 ++ {{36,40,44,48,52,56,60,64,149,153,157,161},12}, // 0x07, RT_CHANNEL_DOMAIN_5G_FCC4 ++ {{149,153,157,161,165},5}, // 0x08, RT_CHANNEL_DOMAIN_5G_FCC5 ++ {{36,40,44,48,52,56,60,64},8}, // 0x09, RT_CHANNEL_DOMAIN_5G_FCC6 ++ {{36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165},20}, // 0x0A, RT_CHANNEL_DOMAIN_5G_FCC7_IC1 ++ {{36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165},20}, // 0x0B, RT_CHANNEL_DOMAIN_5G_KCC1 ++ {{36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140},19}, // 0x0C, RT_CHANNEL_DOMAIN_5G_MKK1 ++ {{36,40,44,48,52,56,60,64},8}, // 0x0D, RT_CHANNEL_DOMAIN_5G_MKK2 ++ {{100,104,108,112,116,120,124,128,132,136,140},11}, // 0x0E, RT_CHANNEL_DOMAIN_5G_MKK3 ++ {{56,60,64,100,104,108,112,116,136,140,149,153,157,161,165},15}, // 0x0F, RT_CHANNEL_DOMAIN_5G_NCC1 ++ {{56,60,64,149,153,157,161,165},8}, // 0x10, RT_CHANNEL_DOMAIN_5G_NCC2 + -+ /* === Below are driver defined for legacy channel plan compatible, NO static index assigned ==== */ -+ /* RTW_RD_5G_OLD_FCC1 */ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 20}, -+ /* RTW_RD_5G_OLD_NCC1 */ {{56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 15}, -+ /* RTW_RD_5G_OLD_KCC1 */ {{36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161, 165}, 20}, ++ //===== Driver self defined for old channel plan Compatible ,Remember to modify if have new channel plan definition ===== ++ {{36,40,44,48,52,56,60,64,100,104,108,112,116,132,136,140,149,153,157,161,165},21}, // 0x11, RT_CHANNEL_DOMAIN_5G_FCC ++ {{36,40,44,48},4}, // 0x12, RT_CHANNEL_DOMAIN_5G_JAPAN_NO_DFS ++ {{36,40,44,48,149,153,157,161},8}, // 0x13, RT_CHANNEL_DOMAIN_5G_FCC4_NO_DFS +}; + -+static RT_CHANNEL_PLAN_MAP RTW_ChannelPlanMap[] = { -+ /* ===== 0x00 ~ 0x1F, legacy channel plan ===== */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_KCC1, TXPWR_LMT_FCC}, /* 0x00, RTW_CHPLAN_FCC */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_OLD_FCC1, TXPWR_LMT_FCC}, /* 0x01, RTW_CHPLAN_IC */ -+ {RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI1, TXPWR_LMT_ETSI}, /* 0x02, RTW_CHPLAN_ETSI */ -+ {RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI}, /* 0x03, RTW_CHPLAN_SPAIN */ -+ {RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI}, /* 0x04, RTW_CHPLAN_FRANCE */ -+ {RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK}, /* 0x05, RTW_CHPLAN_MKK */ -+ {RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK}, /* 0x06, RTW_CHPLAN_MKK1 */ -+ {RTW_RD_2G_ETSI1, RTW_RD_5G_FCC6, TXPWR_LMT_ETSI}, /* 0x07, RTW_CHPLAN_ISRAEL */ -+ {RTW_RD_2G_MKK1, RTW_RD_5G_FCC6, TXPWR_LMT_MKK}, /* 0x08, RTW_CHPLAN_TELEC */ -+ {RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x09, RTW_CHPLAN_GLOBAL_DOAMIN */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x0A, RTW_CHPLAN_WORLD_WIDE_13 */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_OLD_NCC1, TXPWR_LMT_FCC}, /* 0x0B, RTW_CHPLAN_TAIWAN */ -+ {RTW_RD_2G_ETSI1, RTW_RD_5G_FCC5, TXPWR_LMT_ETSI}, /* 0x0C, RTW_CHPLAN_CHINA */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_FCC3, TXPWR_LMT_WW}, /* 0x0D, RTW_CHPLAN_SINGAPORE_INDIA_MEXICO */ /* ETSI:Singapore, India. FCC:Mexico => WW */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_OLD_KCC1, TXPWR_LMT_ETSI}, /* 0x0E, RTW_CHPLAN_KOREA */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_FCC6, TXPWR_LMT_ETSI}, /* 0x0F, RTW_CHPLAN_TURKEY */ -+ {RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI1, TXPWR_LMT_MKK}, /* 0x10, RTW_CHPLAN_JAPAN */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_FCC2, TXPWR_LMT_FCC}, /* 0x11, RTW_CHPLAN_FCC_NO_DFS */ -+ {RTW_RD_2G_ETSI1, RTW_RD_5G_FCC7, TXPWR_LMT_MKK}, /* 0x12, RTW_CHPLAN_JAPAN_NO_DFS */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_FCC1, TXPWR_LMT_WW}, /* 0x13, RTW_CHPLAN_WORLD_WIDE_5G */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_NCC2, TXPWR_LMT_FCC}, /* 0x14, RTW_CHPLAN_TAIWAN_NO_DFS */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_FCC7, TXPWR_LMT_ETSI}, /* 0x15, RTW_CHPLAN_ETSI_NO_DFS */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_NCC1, TXPWR_LMT_ETSI}, /* 0x16, RTW_CHPLAN_KOREA_NO_DFS */ -+ {RTW_RD_2G_MKK1, RTW_RD_5G_FCC7, TXPWR_LMT_MKK}, /* 0x17, RTW_CHPLAN_JAPAN_NO_DFS */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_FCC5, TXPWR_LMT_ETSI}, /* 0x18, RTW_CHPLAN_PAKISTAN_NO_DFS */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_FCC5, TXPWR_LMT_FCC}, /* 0x19, RTW_CHPLAN_TAIWAN2_NO_DFS */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x1A, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x1B, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x1C, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x1D, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x1E, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_FCC1, TXPWR_LMT_WW}, /* 0x1F, RTW_CHPLAN_WORLD_WIDE_ONLY_5G */ -+ -+ /* ===== 0x20 ~ 0x7F, new channel plan ===== */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x20, RTW_CHPLAN_WORLD_NULL */ -+ {RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI}, /* 0x21, RTW_CHPLAN_ETSI1_NULL */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_NULL, TXPWR_LMT_FCC}, /* 0x22, RTW_CHPLAN_FCC1_NULL */ -+ {RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK}, /* 0x23, RTW_CHPLAN_MKK1_NULL */ -+ {RTW_RD_2G_ETSI2, RTW_RD_5G_NULL, TXPWR_LMT_ETSI}, /* 0x24, RTW_CHPLAN_ETSI2_NULL */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_FCC1, TXPWR_LMT_FCC}, /* 0x25, RTW_CHPLAN_FCC1_FCC1 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_ETSI1, TXPWR_LMT_ETSI}, /* 0x26, RTW_CHPLAN_WORLD_ETSI1 */ -+ {RTW_RD_2G_MKK1, RTW_RD_5G_MKK1, TXPWR_LMT_MKK}, /* 0x27, RTW_CHPLAN_MKK1_MKK1 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_KCC1, TXPWR_LMT_ETSI}, /* 0x28, RTW_CHPLAN_WORLD_KCC1 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_FCC2, TXPWR_LMT_FCC}, /* 0x29, RTW_CHPLAN_WORLD_FCC2 */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x2A, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x2B, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x2C, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x2D, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x2E, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x2F, */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_FCC3, TXPWR_LMT_FCC}, /* 0x30, RTW_CHPLAN_WORLD_FCC3 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_FCC4, TXPWR_LMT_FCC}, /* 0x31, RTW_CHPLAN_WORLD_FCC4 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_FCC5, TXPWR_LMT_FCC}, /* 0x32, RTW_CHPLAN_WORLD_FCC5 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_FCC6, TXPWR_LMT_FCC}, /* 0x33, RTW_CHPLAN_WORLD_FCC6 */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_FCC7, TXPWR_LMT_FCC}, /* 0x34, RTW_CHPLAN_FCC1_FCC7 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_ETSI2, TXPWR_LMT_ETSI}, /* 0x35, RTW_CHPLAN_WORLD_ETSI2 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_ETSI3, TXPWR_LMT_ETSI}, /* 0x36, RTW_CHPLAN_WORLD_ETSI3 */ -+ {RTW_RD_2G_MKK1, RTW_RD_5G_MKK2, TXPWR_LMT_MKK}, /* 0x37, RTW_CHPLAN_MKK1_MKK2 */ -+ {RTW_RD_2G_MKK1, RTW_RD_5G_MKK3, TXPWR_LMT_MKK}, /* 0x38, RTW_CHPLAN_MKK1_MKK3 */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_NCC1, TXPWR_LMT_FCC}, /* 0x39, RTW_CHPLAN_FCC1_NCC1 */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x3A, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x3B, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x3C, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x3D, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x3E, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x3F, */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_NCC2, TXPWR_LMT_FCC}, /* 0x40, RTW_CHPLAN_FCC1_NCC2 */ -+ {RTW_RD_2G_GLOBAL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x41, RTW_CHPLAN_GLOBAL_NULL */ -+ {RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI4, TXPWR_LMT_ETSI}, /* 0x42, RTW_CHPLAN_ETSI1_ETSI4 */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_FCC2, TXPWR_LMT_FCC}, /* 0x43, RTW_CHPLAN_FCC1_FCC2 */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_NCC3, TXPWR_LMT_FCC}, /* 0x44, RTW_CHPLAN_FCC1_NCC3 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_ETSI5, TXPWR_LMT_ETSI}, /* 0x45, RTW_CHPLAN_WORLD_ETSI5 */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_FCC8, TXPWR_LMT_FCC}, /* 0x46, RTW_CHPLAN_FCC1_FCC8 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_ETSI6, TXPWR_LMT_ETSI}, /* 0x47, RTW_CHPLAN_WORLD_ETSI6 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_ETSI7, TXPWR_LMT_ETSI}, /* 0x48, RTW_CHPLAN_WORLD_ETSI7 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_ETSI8, TXPWR_LMT_ETSI}, /* 0x49, RTW_CHPLAN_WORLD_ETSI8 */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x4A, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x4B, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x4C, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x4D, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x4E, */ -+ {RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW}, /* 0x4F, */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_ETSI9, TXPWR_LMT_ETSI}, /* 0x50, RTW_CHPLAN_WORLD_ETSI9 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_ETSI10, TXPWR_LMT_ETSI}, /* 0x51, RTW_CHPLAN_WORLD_ETSI10 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_ETSI11, TXPWR_LMT_ETSI}, /* 0x52, RTW_CHPLAN_WORLD_ETSI11 */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_NCC4, TXPWR_LMT_FCC}, /* 0x53, RTW_CHPLAN_FCC1_NCC4 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_ETSI12, TXPWR_LMT_ETSI}, /* 0x54, RTW_CHPLAN_WORLD_ETSI12 */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_FCC9, TXPWR_LMT_FCC}, /* 0x55, RTW_CHPLAN_FCC1_FCC9 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_ETSI13, TXPWR_LMT_ETSI}, /* 0x56, RTW_CHPLAN_WORLD_ETSI13 */ -+ {RTW_RD_2G_FCC1, RTW_RD_5G_FCC10, TXPWR_LMT_FCC}, /* 0x57, RTW_CHPLAN_FCC1_FCC10 */ -+ {RTW_RD_2G_MKK2, RTW_RD_5G_MKK4, TXPWR_LMT_MKK}, /* 0x58, RTW_CHPLAN_MKK2_MKK4 */ -+ {RTW_RD_2G_WORLD, RTW_RD_5G_ETSI14, TXPWR_LMT_ETSI}, /* 0x59, RTW_CHPLAN_WORLD_ETSI14 */ ++static RT_CHANNEL_PLAN_MAP RTW_ChannelPlanMap[RT_CHANNEL_DOMAIN_MAX] = { ++ //===== 0x00 ~ 0x1F , Old Define ===== ++ {0x02,0x11}, //0x00, RT_CHANNEL_DOMAIN_FCC ++ {0x02,0x0A}, //0x01, RT_CHANNEL_DOMAIN_IC ++ {0x01,0x01}, //0x02, RT_CHANNEL_DOMAIN_ETSI ++ {0x01,0x00}, //0x03, RT_CHANNEL_DOMAIN_SPAIN ++ {0x01,0x00}, //0x04, RT_CHANNEL_DOMAIN_FRANCE ++ {0x03,0x00}, //0x05, RT_CHANNEL_DOMAIN_MKK ++ {0x03,0x00}, //0x06, RT_CHANNEL_DOMAIN_MKK1 ++ {0x01,0x09}, //0x07, RT_CHANNEL_DOMAIN_ISRAEL ++ {0x03,0x09}, //0x08, RT_CHANNEL_DOMAIN_TELEC ++ {0x03,0x00}, //0x09, RT_CHANNEL_DOMAIN_GLOBAL_DOAMIN ++ {0x00,0x00}, //0x0A, RT_CHANNEL_DOMAIN_WORLD_WIDE_13 ++ {0x02,0x0F}, //0x0B, RT_CHANNEL_DOMAIN_TAIWAN ++ {0x01,0x08}, //0x0C, RT_CHANNEL_DOMAIN_CHINA ++ {0x02,0x06}, //0x0D, RT_CHANNEL_DOMAIN_SINGAPORE_INDIA_MEXICO ++ {0x02,0x0B}, //0x0E, RT_CHANNEL_DOMAIN_KOREA ++ {0x02,0x09}, //0x0F, RT_CHANNEL_DOMAIN_TURKEY ++ {0x01,0x01}, //0x10, RT_CHANNEL_DOMAIN_JAPAN ++ {0x02,0x05}, //0x11, RT_CHANNEL_DOMAIN_FCC_NO_DFS ++ {0x01,0x12}, //0x12, RT_CHANNEL_DOMAIN_JAPAN_NO_DFS ++ {0x00,0x04}, //0x13, RT_CHANNEL_DOMAIN_WORLD_WIDE_5G ++ {0x02,0x10}, //0x14, RT_CHANNEL_DOMAIN_TAIWAN_NO_DFS ++ {0x00,0x12}, //0x15, RT_CHANNEL_DOMAIN_ETSI_NO_DFS ++ {0x00,0x13}, //0x16, RT_CHANNEL_DOMAIN_KOREA_NO_DFS ++ {0x03,0x12}, //0x17, RT_CHANNEL_DOMAIN_JAPAN_NO_DFS ++ {0x05,0x08}, //0x18, RT_CHANNEL_DOMAIN_PAKISTAN_NO_DFS ++ {0x02,0x08}, //0x19, RT_CHANNEL_DOMAIN_TAIWAN2_NO_DFS ++ {0x00,0x00}, //0x1A, ++ {0x00,0x00}, //0x1B, ++ {0x00,0x00}, //0x1C, ++ {0x00,0x00}, //0x1D, ++ {0x00,0x00}, //0x1E, ++ {0x05,0x04}, //0x1F, RT_CHANNEL_DOMAIN_WORLD_WIDE_ONLY_5G ++ //===== 0x20 ~ 0x7F ,New Define ===== ++ {0x00,0x00}, //0x20, RT_CHANNEL_DOMAIN_WORLD_NULL ++ {0x01,0x00}, //0x21, RT_CHANNEL_DOMAIN_ETSI1_NULL ++ {0x02,0x00}, //0x22, RT_CHANNEL_DOMAIN_FCC1_NULL ++ {0x03,0x00}, //0x23, RT_CHANNEL_DOMAIN_MKK1_NULL ++ {0x04,0x00}, //0x24, RT_CHANNEL_DOMAIN_ETSI2_NULL ++ {0x02,0x04}, //0x25, RT_CHANNEL_DOMAIN_FCC1_FCC1 ++ {0x00,0x01}, //0x26, RT_CHANNEL_DOMAIN_WORLD_ETSI1 ++ {0x03,0x0C}, //0x27, RT_CHANNEL_DOMAIN_MKK1_MKK1 ++ {0x00,0x0B}, //0x28, RT_CHANNEL_DOMAIN_WORLD_KCC1 ++ {0x00,0x05}, //0x29, RT_CHANNEL_DOMAIN_WORLD_FCC2 ++ {0x00,0x00}, //0x2A, ++ {0x00,0x00}, //0x2B, ++ {0x00,0x00}, //0x2C, ++ {0x00,0x00}, //0x2D, ++ {0x00,0x00}, //0x2E, ++ {0x00,0x00}, //0x2F, ++ {0x00,0x06}, //0x30, RT_CHANNEL_DOMAIN_WORLD_FCC3 ++ {0x00,0x07}, //0x31, RT_CHANNEL_DOMAIN_WORLD_FCC4 ++ {0x00,0x08}, //0x32, RT_CHANNEL_DOMAIN_WORLD_FCC5 ++ {0x00,0x09}, //0x33, RT_CHANNEL_DOMAIN_WORLD_FCC6 ++ {0x02,0x0A}, //0x34, RT_CHANNEL_DOMAIN_FCC1_FCC7 ++ {0x00,0x02}, //0x35, RT_CHANNEL_DOMAIN_WORLD_ETSI2 ++ {0x00,0x03}, //0x36, RT_CHANNEL_DOMAIN_WORLD_ETSI3 ++ {0x03,0x0D}, //0x37, RT_CHANNEL_DOMAIN_MKK1_MKK2 ++ {0x03,0x0E}, //0x38, RT_CHANNEL_DOMAIN_MKK1_MKK3 ++ {0x02,0x0F}, //0x39, RT_CHANNEL_DOMAIN_FCC1_NCC1 ++ {0x00,0x00}, //0x3A, ++ {0x00,0x00}, //0x3B, ++ {0x00,0x00}, //0x3C, ++ {0x00,0x00}, //0x3D, ++ {0x00,0x00}, //0x3E, ++ {0x00,0x00}, //0x3F, ++ {0x02,0x10}, //0x40, RT_CHANNEL_DOMAIN_FCC1_NCC2 ++ {0x03,0x00}, //0x41, RT_CHANNEL_DOMAIN_GLOBAL_DOAMIN_2G +}; + -+static RT_CHANNEL_PLAN_MAP RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE = { -+ RTW_RD_2G_WORLD, RTW_RD_5G_FCC1, TXPWR_LMT_FCC /* 0x7F, Realtek Define */ -+}; -+ -+bool rtw_chplan_is_empty(u8 id) -+{ -+ RT_CHANNEL_PLAN_MAP *chplan_map; -+ -+ if (!rtw_is_channel_plan_valid(id)) { -+ rtw_warn_on(1); -+ return _FALSE; -+ } -+ -+ if (id == RTW_CHPLAN_REALTEK_DEFINE) -+ chplan_map = &RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE; -+ else -+ chplan_map = &RTW_ChannelPlanMap[id]; -+ -+ if (chplan_map->Index2G == RTW_RD_2G_NULL -+ && chplan_map->Index5G == RTW_RD_5G_NULL) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+#ifdef CONFIG_DFS_MASTER -+void rtw_rfctl_reset_cac(struct rf_ctl_t *rfctl) -+{ -+ if (rtw_is_long_cac_ch(rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset)) -+ rfctl->cac_end_time = rtw_get_current_time() + rtw_ms_to_systime(CAC_TIME_CE_MS); -+ else -+ rfctl->cac_end_time = rtw_get_current_time() + rtw_ms_to_systime(CAC_TIME_MS); -+} ++static RT_CHANNEL_PLAN_MAP RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE = {0x03,0x02}; //use the conbination for max channel numbers + +/* -+* check if channel coverage includes new range and the new range is in DFS range -+* called after radar_detect_ch,bw,offset is updated -+*/ -+bool rtw_is_cac_reset_needed(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ bool needed = _FALSE; -+ u32 pre_hi, pre_lo, hi, lo; -+ -+ if (0) -+ DBG_871X("pre_radar_detect_ch:%d, pre_radar_detect_by_sta_link:%d\n" -+ , rfctl->pre_radar_detect_ch, rfctl->pre_radar_detect_by_sta_link); -+ -+ if (rfctl->pre_radar_detect_by_sta_link == _TRUE) -+ goto exit; -+ -+ if (rfctl->pre_radar_detect_ch == 0) { -+ needed = _TRUE; -+ goto exit; -+ } -+ -+ if (rtw_chbw_to_freq_range(rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset, &hi, &lo) == _FALSE) -+ rtw_warn_on(1); -+ if (rtw_chbw_to_freq_range(rfctl->pre_radar_detect_ch, rfctl->pre_radar_detect_bw, rfctl->pre_radar_detect_offset, &pre_hi, &pre_lo) == _FALSE) -+ rtw_warn_on(1); -+ -+ if (!rtw_is_range_a_in_b(hi, lo, pre_hi, pre_lo)) { -+ if (rtw_is_range_a_in_b(pre_hi, pre_lo, hi, lo)) { -+ /* currrent is supper set of previous */ -+ if (rtw_is_dfs_range(hi, lo)) -+ needed = _TRUE; -+ } else if (rtw_is_range_overlap(hi, lo, pre_hi, pre_lo)) { -+ /* currrent is not supper set of previous, but has overlap */ -+ u32 new_hi, new_lo; -+ -+ if (lo < pre_lo) { -+ new_hi = pre_lo; -+ new_lo = lo; -+ if (hi <= pre_lo || hi >= pre_hi) { -+ DBG_871X_LEVEL(_drv_err_, "hi:%u, lo:%u, pre_hi:%u, pre_lo:%u\n" -+ , hi, lo, pre_hi, pre_lo); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ } else if (hi > pre_hi) { -+ new_hi = hi; -+ new_lo = pre_hi; -+ if (lo >= pre_hi && lo <= pre_lo) { -+ DBG_871X_LEVEL(_drv_err_, "hi:%u, lo:%u, pre_hi:%u, pre_lo:%u\n" -+ , hi, lo, pre_hi, pre_lo); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ } else { -+ DBG_871X_LEVEL(_drv_err_, "hi:%u, lo:%u, pre_hi:%u, pre_lo:%u\n" -+ , hi, lo, pre_hi, pre_lo); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (rtw_is_dfs_range(new_hi, new_lo)) -+ needed = _TRUE; -+ -+ } else { -+ /* no overlap */ -+ if (rtw_is_dfs_range(hi, lo)) -+ needed = _TRUE; -+ } -+ } -+ -+exit: -+ return needed; -+} -+ -+bool _rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset) -+{ -+ bool ret = _FALSE; -+ u32 hi = 0, lo = 0; -+ u32 r_hi = 0, r_lo = 0; -+ int i; -+ -+ if (rfctl->radar_detect_ch == 0) -+ goto exit; -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (rtw_chbw_to_freq_range(rfctl->radar_detect_ch -+ , rfctl->radar_detect_bw, rfctl->radar_detect_offset -+ , &r_hi, &r_lo) == _FALSE) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (rtw_is_range_overlap(hi, lo, r_hi, r_lo)) -+ ret = _TRUE; -+ -+exit: -+ return ret; -+} -+ -+bool rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl) -+{ -+ return _rtw_rfctl_overlap_radar_detect_ch(rfctl -+ , rfctl_to_dvobj(rfctl)->oper_channel -+ , rfctl_to_dvobj(rfctl)->oper_bwmode -+ , rfctl_to_dvobj(rfctl)->oper_ch_offset); -+} -+ -+bool rtw_rfctl_is_tx_blocked_by_cac(struct rf_ctl_t *rfctl) -+{ -+ return (rtw_rfctl_overlap_radar_detect_ch(rfctl) && IS_UNDER_CAC(rfctl)); -+} -+ -+bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) -+{ -+ bool ret = _FALSE; -+ u32 hi = 0, lo = 0; -+ int i; -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) -+ goto exit; -+ -+ for (i = 0; ch_set[i].ChannelNum != 0; i++) { -+ if (!rtw_ch2freq(ch_set[i].ChannelNum)) { -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ if (!CH_IS_NON_OCP(&ch_set[i])) -+ continue; -+ -+ if (lo <= rtw_ch2freq(ch_set[i].ChannelNum) -+ && rtw_ch2freq(ch_set[i].ChannelNum) <= hi -+ ) { -+ ret = _TRUE; -+ break; -+ } -+ } -+ -+exit: -+ return ret; -+} -+ -+/** -+ * rtw_chset_update_non_ocp - update non_ocp_end_time according to the given @ch, @bw, @offset into @ch_set -+ * @ch_set: the given channel set -+ * @ch: channel number on which radar is detected -+ * @bw: bandwidth on which radar is detected -+ * @offset: bandwidth offset on which radar is detected -+ * @ms: ms to add from now to update non_ocp_end_time, ms < 0 means use NON_OCP_TIME_MS -+ */ -+static void _rtw_chset_update_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset, int ms) -+{ -+ u32 hi = 0, lo = 0; -+ int i; -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) -+ goto exit; -+ -+ for (i = 0; ch_set[i].ChannelNum != 0; i++) { -+ if (!rtw_ch2freq(ch_set[i].ChannelNum)) { -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ if (lo <= rtw_ch2freq(ch_set[i].ChannelNum) -+ && rtw_ch2freq(ch_set[i].ChannelNum) <= hi -+ ) { -+ if (ms >= 0) -+ ch_set[i].non_ocp_end_time = rtw_get_current_time() + rtw_ms_to_systime(ms); -+ else -+ ch_set[i].non_ocp_end_time = rtw_get_current_time() + rtw_ms_to_systime(NON_OCP_TIME_MS); -+ } -+ } -+ -+exit: -+ return; -+} -+ -+inline void rtw_chset_update_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) -+{ -+ _rtw_chset_update_non_ocp(ch_set, ch, bw, offset, -1); -+} -+ -+inline void rtw_chset_update_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset, int ms) -+{ -+ _rtw_chset_update_non_ocp(ch_set, ch, bw, offset, ms); -+} -+#endif /* CONFIG_DFS_MASTER */ -+ -+bool rtw_choose_available_chbw(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 *dec_bw, u8 *dec_offset, u8 d_flags) -+{ -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ int i; -+ -+ if (!dec_ch || !dec_bw || !dec_offset) { -+ rtw_warn_on(1); -+ return _FAIL; -+ } -+ -+ for (i = 0; i < mlmeext->max_chan_nums; i++) { -+ -+ *dec_ch = mlmeext->channel_set[i].ChannelNum; -+ *dec_bw = req_bw; -+ if (*dec_bw == CHANNEL_WIDTH_20) -+ *dec_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ else -+ *dec_offset = rtw_get_offset_by_ch(*dec_ch); -+ -+ if ((d_flags & RTW_CHF_2G) && *dec_ch <= 14) -+ continue; -+ -+ if ((d_flags & RTW_CHF_5G) && *dec_ch > 14) -+ continue; -+ -+ rtw_regsty_adjust_chbw(&adapter->registrypriv, *dec_ch, dec_bw, dec_offset); -+ -+ if ((d_flags & RTW_CHF_DFS) && rtw_is_dfs_ch(*dec_ch, *dec_bw, *dec_offset)) -+ continue; -+ -+ if ((d_flags & RTW_CHF_LONG_CAC) && rtw_is_long_cac_ch(*dec_ch, *dec_bw, *dec_offset)) -+ continue; -+ -+ if ((d_flags & RTW_CHF_NON_DFS) && !rtw_is_dfs_ch(*dec_ch, *dec_bw, *dec_offset)) -+ continue; -+ -+ if ((d_flags & RTW_CHF_NON_LONG_CAC) && !rtw_is_long_cac_ch(*dec_ch, *dec_bw, *dec_offset)) -+ continue; -+ -+ if (!rtw_chset_is_ch_non_ocp(mlmeext->channel_set, *dec_ch, *dec_bw, *dec_offset)) -+ break; -+ } -+ -+ return (i < mlmeext->max_chan_nums)?_TRUE:_FALSE; -+} -+ -+void dump_chplan_id_list(void *sel) -+{ -+ int i; -+ -+ for (i = 0; i < RTW_CHPLAN_MAX; i++) { -+ if (rtw_chplan_is_empty(i)) -+ continue; -+ -+ DBG_871X_SEL(sel, "0x%02X ", i); -+ } -+ -+ DBG_871X_SEL_NL(sel, "0x7F\n"); -+} -+ -+void dump_chplan_test(void *sel) -+{ -+ int i, j; -+ -+ /* check invalid channel */ -+ for (i = 0; i < RTW_RD_2G_MAX; i++) { -+ for (j = 0; j < RTW_ChannelPlan2G[i].Len; j++) { -+ if (rtw_ch2freq(RTW_ChannelPlan2G[i].Channel[j]) == 0) -+ DBG_871X_SEL_NL(sel, "invalid ch:%u at (%d,%d)\n", RTW_ChannelPlan2G[i].Channel[j], i, j); -+ } -+ } -+ -+ for (i = 0; i < RTW_RD_5G_MAX; i++) { -+ for (j = 0; j < RTW_ChannelPlan5G[i].Len; j++) { -+ if (rtw_ch2freq(RTW_ChannelPlan5G[i].Channel[j]) == 0) -+ DBG_871X_SEL_NL(sel, "invalid ch:%u at (%d,%d)\n", RTW_ChannelPlan5G[i].Channel[j], i, j); -+ } -+ } -+} -+ -+void dump_chset(void *sel, RT_CHANNEL_INFO *ch_set) -+{ -+ u8 i; -+ -+ for (i = 0; ch_set[i].ChannelNum != 0; i++) { -+ DBG_871X_SEL_NL(sel, "ch:%3u, freq:%u, scan_type:%d" -+ , ch_set[i].ChannelNum, rtw_ch2freq(ch_set[i].ChannelNum), ch_set[i].ScanType); -+ -+ #ifdef CONFIG_FIND_BEST_CHANNEL -+ DBG_871X_SEL(sel, ", rx_count:%u", ch_set[i].rx_count); -+ #endif -+ -+ #ifdef CONFIG_DFS_MASTER -+ if (rtw_is_dfs_ch(ch_set[i].ChannelNum, CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE)) { -+ if (CH_IS_NON_OCP(&ch_set[i])) -+ DBG_871X_SEL(sel, ", non_ocp:%d" -+ , rtw_systime_to_ms(ch_set[i].non_ocp_end_time - rtw_get_current_time())); -+ else -+ DBG_871X_SEL(sel, ", non_ocp:N/A"); -+ } -+ #endif -+ -+ DBG_871X_SEL(sel, "\n"); -+ } -+ -+ DBG_871X_SEL_NL(sel, "total ch number:%d\n", i); -+} -+ -+void dump_cur_chset(void *sel, _adapter *adapter) -+{ -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ DBG_871X_SEL_NL(sel, "Channel plan ID:0x%02X, 2G_PLS:%u, 5G_PLS:%u\n" -+ , mlme->ChannelPlan, hal_data->Regulation2_4G, hal_data->Regulation5G); -+ dump_chset(sel, mlmeext->channel_set); -+} -+ -+/* -+ * Search the @param ch in given @param ch_set ++ * Search the @param channel_num in given @param channel_set + * @ch_set: the given channel set + * @ch: the given channel number -+ * ++ * + * return the index of channel_num in channel_set, -1 if not found + */ +int rtw_ch_set_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch) @@ -32762,30 +19415,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if(ch == ch_set[i].ChannelNum) + break; + } -+ ++ + if(i >= ch_set[i].ChannelNum) + return -1; + return i; +} + -+/* -+ * Check the @param ch is fit with setband setting of @param adapter -+ * @adapter: the given adapter -+ * @ch: the given channel number -+ * -+ * return _TRUE when check valid, _FALSE not valid -+ */ -+bool rtw_mlme_band_check(_adapter *adapter, const u32 ch) -+{ -+ if (adapter->setband == WIFI_FREQUENCY_BAND_AUTO /* 2.4G and 5G */ -+ || (adapter->setband == WIFI_FREQUENCY_BAND_2GHZ && ch < 35) /* 2.4G only */ -+ || (adapter->setband == WIFI_FREQUENCY_BAND_5GHZ && ch > 35) /* 5G only */ -+ ) { -+ return _TRUE; -+ } -+ return _FALSE; -+} -+ +/**************************************************************************** + +Following are the initialization functions for WiFi MLME @@ -32803,64 +19438,44 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return _SUCCESS; +} + -+void init_mlme_default_rate_set(_adapter* padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ unsigned char mixed_datarate[NumRates] = {_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_, _6M_RATE_,_9M_RATE_, _12M_RATE_, _18M_RATE_, _24M_RATE_, _36M_RATE_, _48M_RATE_, _54M_RATE_, 0xff}; -+ unsigned char mixed_basicrate[NumRates] ={_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_, _6M_RATE_, _12M_RATE_, _24M_RATE_, 0xff,}; -+ unsigned char supported_mcs_set[16] = {0xff, 0xff, 0xff, 0x00, 0x00, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; -+ -+ _rtw_memcpy(pmlmeext->datarate, mixed_datarate, NumRates); -+ _rtw_memcpy(pmlmeext->basicrate, mixed_basicrate, NumRates); -+ -+ _rtw_memcpy(pmlmeext->default_supported_mcs_set, supported_mcs_set, sizeof(pmlmeext->default_supported_mcs_set)); -+} -+ +static void init_mlme_ext_priv_value(_adapter* padapter) +{ + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + ++#ifdef CONFIG_TDLS ++ u8 i; ++#endif ++ ++ //unsigned char default_channel_set[MAX_CHANNEL_NUM] = {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 0, 0}; ++ unsigned char mixed_datarate[NumRates] = {_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_, _6M_RATE_,_9M_RATE_, _12M_RATE_, _18M_RATE_, _24M_RATE_, _36M_RATE_, _48M_RATE_, _54M_RATE_, 0xff}; ++ unsigned char mixed_basicrate[NumRates] ={_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_, _6M_RATE_, _12M_RATE_, _24M_RATE_, 0xff,}; ++ + ATOMIC_SET(&pmlmeext->event_seq, 0); + pmlmeext->mgnt_seq = 0;//reset to zero when disconnect at client mode -+#ifdef CONFIG_IEEE80211W -+ pmlmeext->sa_query_seq = 0; -+ pmlmeext->mgnt_80211w_IPN=0; -+ pmlmeext->mgnt_80211w_IPN_rx=0; -+#endif //CONFIG_IEEE80211W ++ + pmlmeext->cur_channel = padapter->registrypriv.channel; + pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; + pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ ++ + pmlmeext->retry = 0; + + pmlmeext->cur_wireless_mode = padapter->registrypriv.wireless_mode; + -+ init_mlme_default_rate_set(padapter); ++ //_rtw_memcpy(pmlmeext->channel_set, DefaultChannelPlan[padapter->mlmepriv.ChannelPlan].Channel, DefaultChannelPlan[padapter->mlmepriv.ChannelPlan].Len); ++ //_rtw_memcpy(pmlmeext->channel_set, default_channel_set, MAX_CHANNEL_NUM); ++ _rtw_memcpy(pmlmeext->datarate, mixed_datarate, NumRates); ++ _rtw_memcpy(pmlmeext->basicrate, mixed_basicrate, NumRates); + + if(pmlmeext->cur_channel > 14) + pmlmeext->tx_rate = IEEE80211_OFDM_RATE_6MB; + else + pmlmeext->tx_rate = IEEE80211_CCK_RATE_1MB; + -+ mlmeext_set_scan_state(pmlmeext, SCAN_DISABLE); ++ pmlmeext->sitesurvey_res.state = SCAN_DISABLE; + pmlmeext->sitesurvey_res.channel_idx = 0; + pmlmeext->sitesurvey_res.bss_cnt = 0; -+ pmlmeext->sitesurvey_res.scan_ch_ms = SURVEY_TO; -+ pmlmeext->sitesurvey_res.rx_ampdu_accept = RX_AMPDU_ACCEPT_INVALID; -+ pmlmeext->sitesurvey_res.rx_ampdu_size = RX_AMPDU_SIZE_INVALID; -+ #ifdef CONFIG_SCAN_BACKOP -+ mlmeext_assign_scan_backop_flags_sta(pmlmeext, /*SS_BACKOP_EN|*/SS_BACKOP_PS_ANNC|SS_BACKOP_TX_RESUME); -+ mlmeext_assign_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN|SS_BACKOP_PS_ANNC|SS_BACKOP_TX_RESUME); -+ pmlmeext->sitesurvey_res.scan_cnt = 0; -+ pmlmeext->sitesurvey_res.scan_cnt_max = RTW_SCAN_NUM_OF_CH; -+ pmlmeext->sitesurvey_res.backop_ms = RTW_BACK_OP_CH_MS; -+ #endif -+ #if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) -+ pmlmeext->sitesurvey_res.is_sw_antdiv_bl_scan = 0; -+ #endif -+ pmlmeext->scan_abort = _FALSE; ++ pmlmeext->scan_abort = false; + + pmlmeinfo->state = WIFI_FW_NULL_STATE; + pmlmeinfo->reauth_count = 0; @@ -32958,50 +19573,60 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +static u8 init_channel_set(_adapter* padapter, u8 ChannelPlan, RT_CHANNEL_INFO *channel_set) +{ + u8 index,chanset_size = 0; -+ u8 b5GBand = _FALSE, b2_4GBand = _FALSE; ++ u8 b5GBand = false, b2_4GBand = false; + u8 Index2G = 0, Index5G=0; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); + -+ if (!rtw_is_channel_plan_valid(ChannelPlan)) { ++ _rtw_memset(channel_set, 0, sizeof(RT_CHANNEL_INFO)*MAX_CHANNEL_NUM); ++ ++ if(ChannelPlan >= RT_CHANNEL_DOMAIN_MAX && ChannelPlan != RT_CHANNEL_DOMAIN_REALTEK_DEFINE) ++ { + DBG_871X("ChannelPlan ID %x error !!!!!\n",ChannelPlan); + return chanset_size; + } + -+ _rtw_memset(channel_set, 0, sizeof(RT_CHANNEL_INFO)*MAX_CHANNEL_NUM); -+ -+ if (IsSupported24G(padapter->registrypriv.wireless_mode)) -+ b2_4GBand = _TRUE; -+ -+ if (IsSupported5G(padapter->registrypriv.wireless_mode)) -+ b5GBand = _TRUE; -+ -+ if (b2_4GBand) { -+ if (RTW_CHPLAN_REALTEK_DEFINE == ChannelPlan) ++ if(IsSupported24G(padapter->registrypriv.wireless_mode)) ++ { ++ b2_4GBand = true; ++ if(RT_CHANNEL_DOMAIN_REALTEK_DEFINE == ChannelPlan) + Index2G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index2G; + else + Index2G = RTW_ChannelPlanMap[ChannelPlan].Index2G; ++ } + -+ for (index = 0; index < RTW_ChannelPlan2G[Index2G].Len; index++) { ++ if(IsSupported5G(padapter->registrypriv.wireless_mode)) ++ { ++ b5GBand = true; ++ if(RT_CHANNEL_DOMAIN_REALTEK_DEFINE == ChannelPlan) ++ Index5G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index5G; ++ else ++ Index5G = RTW_ChannelPlanMap[ChannelPlan].Index5G; ++ } ++ ++ if(b2_4GBand) ++ { ++ for(index=0;index= 1 && channel_set[chanset_size].ChannelNum <= 11) + channel_set[chanset_size].ScanType = SCAN_ACTIVE; + else if((channel_set[chanset_size].ChannelNum >= 12 && channel_set[chanset_size].ChannelNum <= 14)) -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ } else if (RTW_CHPLAN_WORLD_WIDE_13 == ChannelPlan -+ || RTW_CHPLAN_WORLD_WIDE_5G == ChannelPlan -+ || RTW_RD_2G_WORLD == Index2G -+ ) { -+ /* channel 12~13, passive scan */ ++ channel_set[chanset_size].ScanType = SCAN_PASSIVE; ++ } ++ else if(RT_CHANNEL_DOMAIN_WORLD_WIDE_13 == ChannelPlan || ++ RT_CHANNEL_DOMAIN_WORLD_WIDE_5G == ChannelPlan || ++ RT_CHANNEL_DOMAIN_2G_WORLD == Index2G)// channel 12~13, passive scan ++ { + if(channel_set[chanset_size].ChannelNum <= 11) + channel_set[chanset_size].ScanType = SCAN_ACTIVE; + else + channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ } else { ++ } ++ else ++ { + channel_set[chanset_size].ScanType = SCAN_ACTIVE; + } + @@ -33009,19 +19634,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + } + -+ if (b5GBand) { -+ if (RTW_CHPLAN_REALTEK_DEFINE == ChannelPlan) -+ Index5G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index5G; -+ else -+ Index5G = RTW_ChannelPlanMap[ChannelPlan].Index5G; -+ -+ for (index = 0; index < RTW_ChannelPlan5G[Index5G].Len; index++) { ++ if(b5GBand) ++ { ++ for(index=0;index= 149 ) + { -+ if (RTW_CHPLAN_WORLD_WIDE_5G == ChannelPlan) /* passive scan for all 5G channels */ ++ if(RT_CHANNEL_DOMAIN_WORLD_WIDE_5G == ChannelPlan)//passive scan for all 5G channels + channel_set[chanset_size].ScanType = SCAN_PASSIVE; + else + channel_set[chanset_size].ScanType = SCAN_ACTIVE; @@ -33032,11 +19654,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + chanset_size++; +#else /* CONFIG_DFS */ -+ if (RTW_ChannelPlan5G[Index5G].Channel[index] <= 48 -+ || RTW_ChannelPlan5G[Index5G].Channel[index] >= 149 -+ ) { ++ if ( RTW_ChannelPlan5G[Index5G].Channel[index] <= 48 ++ || RTW_ChannelPlan5G[Index5G].Channel[index] >= 149 ) { + channel_set[chanset_size].ChannelNum = RTW_ChannelPlan5G[Index5G].Channel[index]; -+ if (RTW_CHPLAN_WORLD_WIDE_5G == ChannelPlan) /* passive scan for all 5G channels */ ++ if(RT_CHANNEL_DOMAIN_WORLD_WIDE_5G == ChannelPlan)//passive scan for all 5G channels + channel_set[chanset_size].ScanType = SCAN_PASSIVE; + else + channel_set[chanset_size].ScanType = SCAN_ACTIVE; @@ -33047,17 +19668,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + } + -+ if (RTW_CHPLAN_REALTEK_DEFINE == ChannelPlan) { -+ hal_data->Regulation2_4G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.regd; -+ hal_data->Regulation5G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.regd; -+ } else { -+ hal_data->Regulation2_4G = RTW_ChannelPlanMap[ChannelPlan].regd; -+ hal_data->Regulation5G = RTW_ChannelPlanMap[ChannelPlan].regd; -+ } -+ -+ DBG_871X(FUNC_ADPT_FMT" ChannelPlan ID:0x%02x, ch num:%d\n" -+ , FUNC_ADPT_ARG(padapter), ChannelPlan, chanset_size); -+ ++ DBG_871X("%s ChannelPlan ID %x Chan num:%d \n",__FUNCTION__,ChannelPlan,chanset_size); + return chanset_size; +} + @@ -33078,27 +19689,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + init_mlme_ext_priv_value(padapter); + pmlmeinfo->bAcceptAddbaReq = pregistrypriv->bAcceptAddbaReq; -+ ++ + init_mlme_ext_timer(padapter); + +#ifdef CONFIG_AP_MODE -+ init_mlme_ap_info(padapter); ++ init_mlme_ap_info(padapter); +#endif + + pmlmeext->max_chan_nums = init_channel_set(padapter, pmlmepriv->ChannelPlan,pmlmeext->channel_set); + init_channel_list(padapter, pmlmeext->channel_set, pmlmeext->max_chan_nums, &pmlmeext->channel_list); -+ pmlmeext->last_scan_time = 0; -+ pmlmeext->mlmeext_init = _TRUE; ++ ++ pmlmeext->chan_scan_time = SURVEY_TO; ++ pmlmeext->mlmeext_init = true; + + -+#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ pmlmeext->active_keep_alive_check = _TRUE; -+#else -+ pmlmeext->active_keep_alive_check = _FALSE; ++#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++ pmlmeext->active_keep_alive_check = true; +#endif + -+#ifdef DBG_FIXED_CHAN -+ pmlmeext->fixed_chan = 0xFF; ++#ifdef DBG_FIXED_CHAN ++ pmlmeext->fixed_chan = 0xFF; +#endif + + return res; @@ -33112,7 +19722,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if (!padapter) + return; + -+ if (rtw_is_drv_stopped(padapter)) { ++ if (padapter->bDriverStopped == true) ++ { + _cancel_timer_ex(&pmlmeext->survey_timer); + _cancel_timer_ex(&pmlmeext->link_timer); + //_cancel_timer_ex(&pmlmeext->ADDBA_timer); @@ -33120,46 +19731,46 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +} + +static u8 cmp_pkt_chnl_diff(_adapter *padapter,u8* pframe,uint packet_len) -+{ // if the channel is same, return 0. else return channel differential ++{ // if the channel is same, return 0. else return channel differential + uint len; -+ u8 channel; -+ u8 *p; -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_, _DSSET_IE_, &len, packet_len - _BEACON_IE_OFFSET_); -+ if (p) -+ { -+ channel = *(p + 2); -+ if(padapter->mlmeextpriv.cur_channel >= channel) -+ { -+ return (padapter->mlmeextpriv.cur_channel - channel); -+ } -+ else -+ { -+ return (channel-padapter->mlmeextpriv.cur_channel); -+ } -+ } ++ u8 channel; ++ u8 *p; ++ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_, _DSSET_IE_, &len, packet_len - _BEACON_IE_OFFSET_); ++ if (p) ++ { ++ channel = *(p + 2); ++ if(padapter->mlmeextpriv.cur_channel >= channel) ++ { ++ return (padapter->mlmeextpriv.cur_channel - channel); ++ } ++ else ++ { ++ return (channel-padapter->mlmeextpriv.cur_channel); ++ } ++ } + else -+ { -+ return 0; ++ { ++ return 0; + } +} + +static void _mgt_dispatcher(_adapter *padapter, struct mlme_handler *ptable, union recv_frame *precv_frame) +{ + u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+ u8 *pframe = precv_frame->u.hdr.rx_data; ++ u8 *pframe = precv_frame->u.hdr.rx_data; + + if(ptable->func) + { -+ //receive the frames that ra(a1) is my address or ra(a1) is bc address. -+ if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_mac_addr(padapter), ETH_ALEN) && -+ !_rtw_memcmp(GetAddr1Ptr(pframe), bc_addr, ETH_ALEN)) ++ //receive the frames that ra(a1) is my address or ra(a1) is bc address. ++ if (!_rtw_memcmp(GetAddr1Ptr(pframe), myid(&padapter->eeprompriv), ETH_ALEN) && ++ !_rtw_memcmp(GetAddr1Ptr(pframe), bc_addr, ETH_ALEN)) + { + return; + } -+ ++ + ptable->func(padapter, precv_frame); + } -+ ++ +} + +void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) @@ -33172,8 +19783,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; + u8 *pframe = precv_frame->u.hdr.rx_data; + struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, GetAddr2Ptr(pframe)); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; + + RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, + ("+mgt_dispatcher: type(0x%x) subtype(0x%x)\n", @@ -33198,7 +19807,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + + //receive the frames that ra(a1) is my address or ra(a1) is bc address. -+ if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_mac_addr(padapter), ETH_ALEN) && ++ if (!_rtw_memcmp(GetAddr1Ptr(pframe), myid(&padapter->eeprompriv), ETH_ALEN) && + !_rtw_memcmp(GetAddr1Ptr(pframe), bc_addr, ETH_ALEN)) + { + return; @@ -33210,15 +19819,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +#ifdef CONFIG_TDLS + if((index << 4)==WIFI_ACTION){ -+ /* category==public (4), action==TDLS_DISCOVERY_RESPONSE */ -+ if (*(pframe+24) == RTW_WLAN_CATEGORY_PUBLIC && *(pframe+25) == TDLS_DISCOVERY_RESPONSE) { -+ DBG_871X("[TDLS] Recv %s from "MAC_FMT"\n", rtw_tdls_action_txt(TDLS_DISCOVERY_RESPONSE), MAC_ARG(GetAddr2Ptr(pframe))); ++ //category==public (4), action==TDLS_DISCOVERY_RESPONSE ++ if(*(pframe+24)==0x04 && *(pframe+25)==TDLS_DISCOVERY_RESPONSE){ ++ DBG_871X("recv tdls discovery response frame\n"); + On_TDLS_Dis_Rsp(padapter, precv_frame); + } + } +#endif //CONFIG_TDLS + -+ if (index >= (sizeof(mlme_sta_tbl) /sizeof(struct mlme_handler))) ++ if (index > 13) + { + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Currently we do not support reserved sub-fr-type=%d\n", index)); + return; @@ -33233,7 +19842,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if (precv_frame->u.hdr.attrib.seq_num == psta->RxMgmtFrameSeqNum) + { + /* drop the duplicate management frame */ -+ pdbgpriv->dbg_rx_dup_mgt_frame_drop_count++; + DBG_871X("Drop duplicate management frame with seq_num = %d.\n", precv_frame->u.hdr.attrib.seq_num); + return; + } @@ -33250,27 +19858,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#endif + +#ifdef CONFIG_AP_MODE -+ switch (GetFrameSubType(pframe)) ++ switch (GetFrameSubType(pframe)) + { + case WIFI_AUTH: -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) + ptable->func = &OnAuth; + else + ptable->func = &OnAuthClient; + //pass through + case WIFI_ASSOCREQ: + case WIFI_REASSOCREQ: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+#ifdef CONFIG_HOSTAPD_MLME -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ _mgt_dispatcher(padapter, ptable, precv_frame); ++#ifdef CONFIG_HOSTAPD_MLME ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) + rtw_hostapd_mlme_rx(padapter, precv_frame); -+#endif ++#endif + break; + case WIFI_PROBEREQ: -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) + { -+#ifdef CONFIG_HOSTAPD_MLME -+ rtw_hostapd_mlme_rx(padapter, precv_frame); ++#ifdef CONFIG_HOSTAPD_MLME ++ rtw_hostapd_mlme_rx(padapter, precv_frame); +#else + _mgt_dispatcher(padapter, ptable, precv_frame); +#endif @@ -33278,53 +19886,45 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + else + _mgt_dispatcher(padapter, ptable, precv_frame); + break; -+ case WIFI_BEACON: ++ case WIFI_BEACON: + _mgt_dispatcher(padapter, ptable, precv_frame); + break; + case WIFI_ACTION: -+ //if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ _mgt_dispatcher(padapter, ptable, precv_frame); ++ //if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) ++ _mgt_dispatcher(padapter, ptable, precv_frame); + break; + default: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ rtw_hostapd_mlme_rx(padapter, precv_frame); ++ _mgt_dispatcher(padapter, ptable, precv_frame); ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) ++ rtw_hostapd_mlme_rx(padapter, precv_frame); + break; + } +#else + -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ ++ _mgt_dispatcher(padapter, ptable, precv_frame); ++ +#endif + +} + +#ifdef CONFIG_P2P -+u32 p2p_listen_state_process(_adapter *padapter, unsigned char *da) ++static u32 p2p_listen_state_process(_adapter *padapter, unsigned char *da) +{ -+ bool response = _TRUE; ++ bool response = true; + +#ifdef CONFIG_IOCTL_CFG80211 + if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 ) + { -+ if(padapter->cfg80211_wdinfo.is_ro_ch == _FALSE -+ || rtw_get_oper_ch(padapter) != padapter->wdinfo.listen_channel -+ || adapter_wdev_data(padapter)->p2p_enabled == _FALSE ++ if (wdev_to_priv(padapter->rtw_wdev)->p2p_enabled == false + || padapter->mlmepriv.wps_probe_resp_ie == NULL + || padapter->mlmepriv.p2p_probe_resp_ie == NULL + ) + { -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("DON'T issue_probersp_p2p: p2p_enabled:%d, wps_probe_resp_ie:%p, p2p_probe_resp_ie:%p, ", -+ adapter_wdev_data(padapter)->p2p_enabled, ++ DBG_871X("DON'T issue_probersp_p2p: p2p_enabled:%d, wps_probe_resp_ie:%p, p2p_probe_resp_ie:%p\n", ++ wdev_to_priv(padapter->rtw_wdev)->p2p_enabled, + padapter->mlmepriv.wps_probe_resp_ie, + padapter->mlmepriv.p2p_probe_resp_ie); -+ DBG_871X("is_ro_ch:%d, op_ch:%d, p2p_listen_channel:%d\n", -+ padapter->cfg80211_wdinfo.is_ro_ch, -+ rtw_get_oper_ch(padapter), -+ padapter->wdinfo.listen_channel); -+#endif -+ response = _FALSE; ++ response = false; + } + } + else @@ -33334,13 +19934,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // do nothing if the device name is empty + if ( !padapter->wdinfo.device_name_len ) + { -+ response = _FALSE; ++ response = false; + } + } + -+ if (response == _TRUE) ++ if (response == true) + issue_probersp_p2p( padapter, da); -+ ++ + return _SUCCESS; +} +#endif //CONFIG_P2P @@ -33359,37 +19959,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur = &(pmlmeinfo->network); ++ WLAN_BSSID_EX *cur = &(pmlmeinfo->network); + u8 *pframe = precv_frame->u.hdr.rx_data; + uint len = precv_frame->u.hdr.len; -+ u8 is_valid_p2p_probereq = _FALSE; -+ -+#ifdef CONFIG_ATMEL_RC_PATCH -+ u8 *target_ie=NULL, *wps_ie=NULL; -+ u8 *start; -+ uint search_len = 0, wps_ielen = 0, target_ielen = 0; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+#endif -+ ++ u8 is_valid_p2p_probereq = false; + +#ifdef CONFIG_P2P + struct wifidirect_info *pwdinfo = &(padapter->wdinfo); + struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; + u8 wifi_test_chk_rate = 1; + -+#ifdef CONFIG_IOCTL_CFG80211 -+ if ((pwdinfo->driver_interface == DRIVER_CFG80211) -+ && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) -+ && (GET_CFG80211_REPORT_MGMT(adapter_wdev_data(padapter), IEEE80211_STYPE_PROBE_REQ) == _TRUE) -+ ) { -+ rtw_cfg80211_rx_probe_request(padapter, pframe, len); -+ return _SUCCESS; -+ } -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ if ( !rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && -+ !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE) && ++ if ( !rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && ++ !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE) && + !rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) && + !rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH) && + !rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) @@ -33404,27 +19985,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Commented by Kurt 2012/10/16 + // IOT issue: Google Nexus7 use 1M rate to send p2p_probe_req after GO nego completed and Nexus7 is client -+ if (padapter->registrypriv.wifi_spec == 1) -+ { -+ if ( pattrib->data_rate <= 3 ) -+ { -+ wifi_test_chk_rate = 0; -+ } -+ } ++#ifdef CONFIG_WIFI_TEST ++ if ( pattrib->mcs_rate <= 3 ) ++ { ++ wifi_test_chk_rate = 0; ++ } ++#endif //CONFIG_WIFI_TEST + + if( wifi_test_chk_rate == 1 ) + { -+ if((is_valid_p2p_probereq = process_probe_req_p2p_ie(pwdinfo, pframe, len)) == _TRUE) ++ if((is_valid_p2p_probereq = process_probe_req_p2p_ie(pwdinfo, pframe, len)) == true) + { + if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE)) + { -+ // FIXME -+ if( padapter->wdinfo.driver_interface == DRIVER_WEXT ) -+ report_survey_event(padapter, precv_frame); -+ + p2p_listen_state_process( padapter, get_sa(pframe)); + -+ return _SUCCESS; ++ return _SUCCESS; + } + + if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) @@ -33443,8 +20019,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return _SUCCESS; + } + -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == _FALSE && -+ check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE|WIFI_AP_STATE)==_FALSE) ++ if(check_fwstate(pmlmepriv, _FW_LINKED) == false && ++ check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE|WIFI_AP_STATE)==false) + { + return _SUCCESS; + } @@ -33452,28 +20028,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + //DBG_871X("+OnProbeReq\n"); + -+ -+#ifdef CONFIG_ATMEL_RC_PATCH -+ if ((wps_ie = rtw_get_wps_ie( -+ pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_, -+ NULL, &wps_ielen))) { -+ -+ target_ie = rtw_get_wps_attr_content( wps_ie, wps_ielen, WPS_ATTR_MANUFACTURER, NULL, &target_ielen); -+ } -+ if ((target_ie && (target_ielen == 4)) && (_TRUE ==_rtw_memcmp((void *)target_ie, "Ozmo",4 ))) { -+ //psta->flag_atmel_rc = 1; -+ unsigned char *sa_addr = get_sa(pframe); -+ printk("%s: Find Ozmo RC -- %02x:%02x:%02x:%02x:%02x:%02x \n\n", -+ __func__, *sa_addr, *(sa_addr+1), *(sa_addr+2), *(sa_addr+3), *(sa_addr+4), *(sa_addr+5)); -+ _rtw_memcpy( pstapriv->atmel_rc_pattern, get_sa(pframe), ETH_ALEN); -+ } -+#endif -+ -+ +#ifdef CONFIG_AUTO_AP_MODE -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && -+ pmlmepriv->cur_network.join_res == _TRUE) ++ if(check_fwstate(pmlmepriv, _FW_LINKED) == true && ++ pmlmepriv->cur_network.join_res == true) + { + _irqL irqL; + struct sta_info *psta; @@ -33525,12 +20082,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); + + //generate pairing ID -+ mac_addr = adapter_mac_addr(padapter); ++ mac_addr = myid(&(padapter->eeprompriv)); + peer_addr = psta->hwaddr; + psta->pid = (u16)(((mac_addr[4]<<8) + mac_addr[5]) + ((peer_addr[4]<<8) + peer_addr[5])); + + //update peer stainfo -+ psta->isrc = _TRUE; ++ psta->isrc = true; + //psta->aid = 0; + //psta->mac_id = 2; + @@ -33551,21 +20108,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + DBG_871X("allocate new AID = (%d)\n", psta->aid); + } + } -+ ++ + psta->qos_option = 1; -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ psta->ieee8021x_blocked = _FALSE; -+#ifdef CONFIG_80211N_HT -+ psta->htpriv.ht_option = _TRUE; -+ psta->htpriv.ampdu_enable = _FALSE; -+ psta->htpriv.sgi_20m = _FALSE; -+ psta->htpriv.sgi_40m = _FALSE; ++ psta->htpriv.ht_option = true; ++ psta->ieee8021x_blocked = false; ++ psta->htpriv.ampdu_enable = false; ++ psta->htpriv.sgi = false; ++ psta->htpriv.bwmode = CHANNEL_WIDTH_20; + psta->htpriv.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, true); ++ + psta->htpriv.agg_enable_bitmap = 0x0;//reset + psta->htpriv.candidate_tid_bitmap = 0x0;//reset -+#endif -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); + + _rtw_memset((void*)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); + @@ -33577,7 +20132,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + } + -+ issue_probersp(padapter, get_sa(pframe), _FALSE); ++ issue_probersp(padapter, get_sa(pframe), false); + + return _SUCCESS; + @@ -33588,7 +20143,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return _SUCCESS; + +#endif //CONFIG_AUTO_AP_MODE -+ ++ + +#ifdef CONFIG_CONCURRENT_MODE + if(((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) && @@ -33597,21 +20152,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + //don't process probe req + return _SUCCESS; + } -+#endif ++#endif + + p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _SSID_IE_, (int *)&ielen, + len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); + + -+ //check (wildcard) SSID ++ //check (wildcard) SSID + if (p != NULL) + { -+ if(is_valid_p2p_probereq == _TRUE) ++ if(is_valid_p2p_probereq == true) + { + goto _issue_probersp; + } + -+ if ( (ielen != 0 && _FALSE ==_rtw_memcmp((void *)(p+2), (void *)cur->Ssid.Ssid, cur->Ssid.SsidLength)) ++ if ( (ielen != 0 && false ==_rtw_memcmp((void *)(p+2), (void *)cur->Ssid.Ssid, cur->Ssid.SsidLength)) + || (ielen == 0 && pmlmeinfo->hidden_ssid_mode) + ) + { @@ -33619,11 +20174,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + +_issue_probersp: -+ if(((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && -+ pmlmepriv->cur_network.join_res == _TRUE)) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) ++ ++ if(check_fwstate(pmlmepriv, _FW_LINKED) == true && ++ pmlmepriv->cur_network.join_res == true) + { + //DBG_871X("+issue_probersp during ap mode\n"); -+ issue_probersp(padapter, get_sa(pframe), is_valid_p2p_probereq); ++ issue_probersp(padapter, get_sa(pframe), is_valid_p2p_probereq); + } + + } @@ -33647,50 +20203,50 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_P2P + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) + { -+ if ( _TRUE == pwdinfo->tx_prov_disc_info.benable ) ++ if ( true == pwdinfo->tx_prov_disc_info.benable ) + { + if( _rtw_memcmp( pwdinfo->tx_prov_disc_info.peerIFAddr, GetAddr2Ptr(pframe), ETH_ALEN ) ) + { + if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) + { -+ pwdinfo->tx_prov_disc_info.benable = _FALSE; ++ pwdinfo->tx_prov_disc_info.benable = false; + issue_p2p_provision_request( padapter, -+ pwdinfo->tx_prov_disc_info.ssid.Ssid, ++ pwdinfo->tx_prov_disc_info.ssid.Ssid, + pwdinfo->tx_prov_disc_info.ssid.SsidLength, + pwdinfo->tx_prov_disc_info.peerDevAddr ); + } + else if ( rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) ) + { -+ pwdinfo->tx_prov_disc_info.benable = _FALSE; ++ pwdinfo->tx_prov_disc_info.benable = false; + issue_p2p_provision_request( padapter, -+ NULL, ++ NULL, + 0, + pwdinfo->tx_prov_disc_info.peerDevAddr ); + } -+ } ++ } + } + return _SUCCESS; + } + else if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) + { -+ if ( _TRUE == pwdinfo->nego_req_info.benable ) ++ if ( true == pwdinfo->nego_req_info.benable ) + { + DBG_871X( "[%s] P2P State is GONEGO ING!\n", __FUNCTION__ ); + if( _rtw_memcmp( pwdinfo->nego_req_info.peerDevAddr, GetAddr2Ptr(pframe), ETH_ALEN ) ) + { -+ pwdinfo->nego_req_info.benable = _FALSE; ++ pwdinfo->nego_req_info.benable = false; + issue_p2p_GO_request( padapter, pwdinfo->nego_req_info.peerDevAddr); + } + } + } + else if( rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ ) ) + { -+ if ( _TRUE == pwdinfo->invitereq_info.benable ) ++ if ( true == pwdinfo->invitereq_info.benable ) + { + DBG_871X( "[%s] P2P_STATE_TX_INVITE_REQ!\n", __FUNCTION__ ); + if( _rtw_memcmp( pwdinfo->invitereq_info.peer_macaddr, GetAddr2Ptr(pframe), ETH_ALEN ) ) + { -+ pwdinfo->invitereq_info.benable = _FALSE; ++ pwdinfo->invitereq_info.benable = false; + issue_p2p_invitation_request( padapter, pwdinfo->invitereq_info.peer_macaddr ); + } + } @@ -33698,10 +20254,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#endif + + -+ if (mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS)) { -+ report_survey_event(padapter, precv_frame); ++ if (pmlmeext->sitesurvey_res.state == SCAN_PROCESS) ++ { ++ report_survey_event(padapter, precv_frame); +#ifdef CONFIG_CONCURRENT_MODE -+ report_survey_event(padapter->pbuddy_adapter, precv_frame); ++ report_survey_event(padapter->pbuddy_adapter, precv_frame); ++#endif ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ dc_report_survey_event(padapter, precv_frame); +#endif + return _SUCCESS; + } @@ -33718,9 +20278,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + } + #endif -+ ++ + return _SUCCESS; -+ ++ +} + +unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) @@ -33737,10 +20297,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + int ret = _SUCCESS; + u8 *p = NULL; + u32 ielen = 0; -+#ifdef CONFIG_TDLS -+ struct sta_info *ptdls_sta; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+#endif /* CONFIG_TDLS */ + +#ifdef CONFIG_ATTEMPT_TO_FIX_AP_BEACON_ERROR + p = rtw_get_ie(pframe + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ielen, precv_frame->u.hdr.len -sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_); @@ -33748,18 +20304,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + if ((*(p + 1 + ielen) == 0x2D) && (*(p + 2 + ielen) != 0x2D)) + { -+ /* Invalid value 0x2D is detected in Extended Supported Rates (ESR) IE. Try to fix the IE length to avoid failed Beacon parsing. */ -+ DBG_871X("[WIFIDBG] Error in ESR IE is detected in Beacon of BSSID:"MAC_FMT". Fix the length of ESR IE to avoid failed Beacon parsing.\n", MAC_ARG(GetAddr3Ptr(pframe))); -+ *(p + 1) = ielen - 1; ++ /* Invalid value 0x2D is detected in Extended Supported Rates (ESR) IE. Try to fix the IE length to avoid failed Beacon parsing. */ ++ DBG_871X("[WIFIDBG] Error in ESR IE is detected in Beacon of BSSID:"MAC_FMT". Fix the length of ESR IE to avoid failed Beacon parsing.\n", MAC_ARG(GetAddr3Ptr(pframe))); ++ *(p + 1) = ielen - 1; + } + } +#endif + -+ if (mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS)) { ++ if (pmlmeext->sitesurvey_res.state == SCAN_PROCESS) ++ { + report_survey_event(padapter, precv_frame); +#ifdef CONFIG_CONCURRENT_MODE -+ report_survey_event(padapter->pbuddy_adapter, precv_frame); ++ report_survey_event(padapter->pbuddy_adapter, precv_frame); +#endif ++ ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ dc_report_survey_event(padapter, precv_frame); ++#endif ++ + return _SUCCESS; + } + @@ -33771,56 +20333,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pbss = (WLAN_BSSID_EX*)rtw_malloc(sizeof(WLAN_BSSID_EX)); + if (pbss) { + if (collect_bss_info(padapter, precv_frame, pbss) == _SUCCESS) { -+ struct beacon_keys recv_beacon; -+ -+ update_network(&(pmlmepriv->cur_network.network), pbss, padapter, _TRUE); ++ update_network(&(pmlmepriv->cur_network.network), pbss, padapter, true); + rtw_get_bcn_info(&(pmlmepriv->cur_network)); -+ -+ // update bcn keys -+ if (rtw_get_bcn_keys(padapter, pframe, len, &recv_beacon) == _TRUE) { -+ DBG_871X("%s: beacon keys ready\n", __func__); -+ _rtw_memcpy(&pmlmepriv->cur_beacon_keys, -+ &recv_beacon, sizeof(recv_beacon)); -+ pmlmepriv->new_beacon_cnts = 0; -+ } -+ else { -+ DBG_871X_LEVEL(_drv_err_, "%s: get beacon keys failed\n", __func__); -+ _rtw_memset(&pmlmepriv->cur_beacon_keys, 0, sizeof(recv_beacon)); -+ pmlmepriv->new_beacon_cnts = 0; -+ } + } + rtw_mfree((u8*)pbss, sizeof(WLAN_BSSID_EX)); + } + + //check the vendor of the assoc AP -+ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pframe+sizeof(struct rtw_ieee80211_hdr_3addr), len-sizeof(struct rtw_ieee80211_hdr_3addr)); ++ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pframe+sizeof(struct rtw_ieee80211_hdr_3addr), len-sizeof(struct rtw_ieee80211_hdr_3addr)); + + //update TSF Value + update_TSF(pmlmeext, pframe, len); + -+ //reset for adaptive_early_32k -+ pmlmeext->adaptive_tsf_done = _FALSE; -+ pmlmeext->DrvBcnEarly = 0xff; -+ pmlmeext->DrvBcnTimeOut = 0xff; -+ pmlmeext->bcn_cnt = 0; -+ _rtw_memset(pmlmeext->bcn_delay_cnt, 0, sizeof(pmlmeext->bcn_delay_cnt)); -+ _rtw_memset(pmlmeext->bcn_delay_ratio, 0, sizeof(pmlmeext->bcn_delay_ratio)); -+ -+#ifdef CONFIG_P2P_PS -+ process_p2p_ps_ie(padapter, (pframe + WLAN_HDR_A3_LEN), (len - WLAN_HDR_A3_LEN)); -+#endif //CONFIG_P2P_PS -+ -+#if defined(CONFIG_P2P)&&defined(CONFIG_CONCURRENT_MODE) -+ if (padapter->registrypriv.wifi_spec) { -+ if (process_p2p_cross_connect_ie(padapter, (pframe + WLAN_HDR_A3_LEN), (len - WLAN_HDR_A3_LEN)) == _FALSE) { -+ if((padapter->pbuddy_adapter->mlmeextpriv.mlmext_info.state&0x03) == WIFI_FW_AP_STATE) { -+ DBG_871X_LEVEL(_drv_always_, "no issue auth, P2P cross-connect does not permit\n "); -+ return _SUCCESS; -+ } -+ } -+ } -+#endif // CONFIG_P2P CONFIG_P2P and CONFIG_CONCURRENT_MODE -+ + //start auth + start_clnt_auth(padapter); + @@ -33831,22 +20355,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + if ((psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe))) != NULL) + { -+ #ifdef CONFIG_PATCH_JOIN_WRONG_CHANNEL ++ #ifdef CONFIG_PATCH_JOIN_WRONG_CHANNEL + //Merge from 8712 FW code -+ if (cmp_pkt_chnl_diff(padapter,pframe,len) != 0) -+ { // join wrong channel, deauth and reconnect ++ if (cmp_pkt_chnl_diff(padapter,pframe,len) != 0) ++ { // join wrong channel, deauth and reconnect + issue_deauth(padapter, (&(pmlmeinfo->network))->MacAddress, WLAN_REASON_DEAUTH_LEAVING); + -+ report_del_sta_event(padapter, (&(pmlmeinfo->network))->MacAddress, WLAN_REASON_JOIN_WRONG_CHANNEL, _TRUE); -+ pmlmeinfo->state &= (~WIFI_FW_ASSOC_SUCCESS); ++ report_del_sta_event(padapter,(&(pmlmeinfo->network))->MacAddress, WLAN_REASON_JOIN_WRONG_CHANNEL); ++ pmlmeinfo->state &= (~WIFI_FW_ASSOC_SUCCESS); + return _SUCCESS; -+ } ++ } + #endif //CONFIG_PATCH_JOIN_WRONG_CHANNEL + + ret = rtw_check_bcn_info(padapter, pframe, len); + if (!ret) { + DBG_871X_LEVEL(_drv_always_, "ap has changed, disconnect now\n "); -+ receive_disconnect(padapter, pmlmeinfo->network.MacAddress , 0); ++ receive_disconnect(padapter, pmlmeinfo->network.MacAddress , 65535); + return _SUCCESS; + } + //update WMM, ERP in the beacon @@ -33857,26 +20381,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + update_beacon_info(padapter, pframe, len, psta); + } + -+ adaptive_early_32k(pmlmeext, pframe, len); -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ if (padapter->tdlsinfo.ch_switch_prohibited == _FALSE) -+ { -+ /* Send TDLS Channel Switch Request when receiving Beacon */ -+ if ((padapter->tdlsinfo.chsw_info.ch_sw_state & TDLS_CH_SW_INITIATOR_STATE) && (pmlmeext->cur_channel == rtw_get_oper_ch(padapter))) { -+ ptdlsinfo->chsw_info.ch_sw_state |= TDLS_WAIT_CH_RSP_STATE; -+ /* DBG_871X("[%s] issue_tdls_ch_switch_req to "MAC_FMT"\n", __FUNCTION__, MAC_ARG(padapter->tdlsinfo.chsw_info.addr)); */ -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, padapter->tdlsinfo.chsw_info.addr); -+ if (ptdls_sta != NULL) { -+ if (ptdls_sta->tdls_sta_state | TDLS_LINKED_STATE) -+ issue_tdls_ch_switch_req(padapter, ptdls_sta); -+ } -+ } -+ } -+#endif -+#endif /* CONFIG_TDLS */ -+ +#ifdef CONFIG_DFS + process_csa_ie(padapter, pframe, len); //channel switch announcement +#endif //CONFIG_DFS @@ -33922,7 +20426,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + + //update TSF Value -+ update_TSF(pmlmeext, pframe, len); ++ update_TSF(pmlmeext, pframe, len); + + //report sta add event + report_add_sta_event(padapter, GetAddr2Ptr(pframe), cam_idx); @@ -33941,21 +20445,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_AP_MODE + _irqL irqL; + unsigned int auth_mode, seq, ie_len; -+ unsigned char *sa, *p; ++ unsigned char *sa, *p; + u16 algorithm; + int status; -+ static struct sta_info stat; -+ struct sta_info *pstat=NULL; ++ static struct sta_info stat; ++ struct sta_info *pstat=NULL; + struct sta_priv *pstapriv = &padapter->stapriv; + struct security_priv *psecuritypriv = &padapter->securitypriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; ++ u8 *pframe = precv_frame->u.hdr.rx_data; + uint len = precv_frame->u.hdr.len; + u8 offset = 0; + -+ -+#ifdef CONFIG_CONCURRENT_MODE ++ ++#ifdef CONFIG_CONCURRENT_MODE + if(((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) && + check_buddy_fwstate(padapter, _FW_UNDER_LINKING|_FW_UNDER_SURVEY)) + { @@ -33992,8 +20496,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + offset = 4; + } + -+ algorithm = le16_to_cpu(*(u16*)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset)); -+ seq = le16_to_cpu(*(u16*)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 2)); ++ algorithm = le16_to_cpu(*(__le16*)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset)); ++ seq = le16_to_cpu(*(__le16*)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 2)); + + DBG_871X("auth alg=%x, seq=%X\n", algorithm, seq); + @@ -34004,16 +20508,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + if ((algorithm > 0 && auth_mode == 0) || // rx a shared-key auth but shared not enabled + (algorithm == 0 && auth_mode == 1) ) // rx a open-system auth but shared-key is enabled -+ { ++ { + DBG_871X("auth rejected due to bad alg [alg=%d, auth_mib=%d] %02X%02X%02X%02X%02X%02X\n", + algorithm, auth_mode, sa[0], sa[1], sa[2], sa[3], sa[4], sa[5]); -+ ++ + status = _STATS_NO_SUPP_ALG_; -+ ++ + goto auth_fail; + } -+ -+#if 0 //ACL control ++ ++#if 0 //ACL control + phead = &priv->wlan_acl_list; + plist = phead->next; + //check sa @@ -34043,17 +20547,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return FAIL; + } +#else -+ if(rtw_access_ctrl(padapter, sa) == _FALSE) ++ if(rtw_access_ctrl(padapter, sa) == false) + { + status = _STATS_UNABLE_HANDLE_STA_; + goto auth_fail; -+ } ++ } +#endif + + pstat = rtw_get_stainfo(pstapriv, sa); + if (pstat == NULL) + { -+ + // allocate a new one + DBG_871X("going to alloc stainfo for sa="MAC_FMT"\n", MAC_ARG(sa)); + pstat = rtw_alloc_stainfo(pstapriv, sa); @@ -34063,50 +20566,43 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + status = _STATS_UNABLE_HANDLE_STA_; + goto auth_fail; + } -+ ++ + pstat->state = WIFI_FW_AUTH_NULL; + pstat->auth_seq = 0; -+ ++ + //pstat->flags = 0; + //pstat->capability = 0; -+ } else { -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) -+#endif /* CONFIG_IEEE80211W */ ++ } ++ else ++ { ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ if(rtw_is_list_empty(&pstat->asoc_list)==false) + { -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&pstat->asoc_list) == _FALSE) { -+ rtw_list_delete(&pstat->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ if (pstat->expire_to > 0) -+ ;/* TODO: STA re_auth within expire_to */ ++ rtw_list_delete(&pstat->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ if (pstat->expire_to > 0) ++ { ++ //TODO: STA re_auth within expire_to + } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ if (seq == 1) -+ ; /* TODO: STA re_auth and auth timeout */ ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); + ++ if (seq==1) { ++ //TODO: STA re_auth and auth timeout + } + } + -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) -+#endif /* CONFIG_IEEE80211W */ ++ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ if (rtw_is_list_empty(&pstat->auth_list)) + { -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ if (rtw_is_list_empty(&pstat->auth_list)) { -+ -+ rtw_list_insert_tail(&pstat->auth_list, &pstapriv->auth_list); -+ pstapriv->auth_list_cnt++; -+ } -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ rtw_list_insert_tail(&pstat->auth_list, &pstapriv->auth_list); ++ pstapriv->auth_list_cnt++; + } ++ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); + + if (pstat->auth_seq == 0) + pstat->expire_to = pstapriv->auth_to; + -+ + if ((pstat->auth_seq + 1) != seq) + { + DBG_871X("(1)auth rejected because out of seq [rx_seq=%d, exp_seq=%d]!\n", @@ -34119,14 +20615,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + if (seq == 1) + { -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ pstat->state &= ~WIFI_FW_AUTH_NULL; -+ pstat->state |= WIFI_FW_AUTH_SUCCESS; -+ pstat->expire_to = pstapriv->assoc_to; -+ } ++ pstat->state &= ~WIFI_FW_AUTH_NULL; ++ pstat->state |= WIFI_FW_AUTH_SUCCESS; ++ pstat->expire_to = pstapriv->assoc_to; + pstat->authalg = algorithm; + } + else @@ -34145,13 +20636,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + //get_random_bytes((void *)pstat->chg_txt, 128);//TODO: + _rtw_memset((void *)pstat->chg_txt, 78, 128); -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ pstat->state &= ~WIFI_FW_AUTH_NULL; -+ pstat->state |= WIFI_FW_AUTH_STATE; -+ } ++ ++ pstat->state &= ~WIFI_FW_AUTH_NULL; ++ pstat->state |= WIFI_FW_AUTH_STATE; + pstat->authalg = algorithm; + pstat->auth_seq = 2; + } @@ -34159,7 +20646,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + //checking for challenging txt... + DBG_871X("checking for challenging txt...\n"); -+ ++ + p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + 4 + _AUTH_IE_OFFSET_ , _CHLGETXT_IE_, (int *)&ie_len, + len - WLAN_HDR_A3_LEN - _AUTH_IE_OFFSET_ - 4); + @@ -34169,18 +20656,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + status = _STATS_CHALLENGE_FAIL_; + goto auth_fail; + } -+ ++ + if (_rtw_memcmp((void *)(p + 2), pstat->chg_txt, 128)) + { -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ pstat->state &= (~WIFI_FW_AUTH_STATE); -+ pstat->state |= WIFI_FW_AUTH_SUCCESS; -+ /* challenging txt is correct... */ -+ pstat->expire_to = pstapriv->assoc_to; -+ } ++ pstat->state &= (~WIFI_FW_AUTH_STATE); ++ pstat->state |= WIFI_FW_AUTH_SUCCESS; ++ // challenging txt is correct... ++ pstat->expire_to = pstapriv->assoc_to; + } + else + { @@ -34200,30 +20682,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + + // Now, we are going to issue_auth... -+ pstat->auth_seq = seq + 1; -+ ++ pstat->auth_seq = seq + 1; ++ +#ifdef CONFIG_NATIVEAP_MLME + issue_auth(padapter, pstat, (unsigned short)(_STATS_SUCCESSFUL_)); +#endif + -+ if ((pstat->state & WIFI_FW_AUTH_SUCCESS) || (pstat->state & WIFI_FW_ASSOC_SUCCESS)) ++ if (pstat->state & WIFI_FW_AUTH_SUCCESS) + pstat->auth_seq = 0; + -+ ++ + return _SUCCESS; + +auth_fail: + + if(pstat) + rtw_free_stainfo(padapter , pstat); -+ ++ + pstat = &stat; + _rtw_memset((char *)pstat, '\0', sizeof(stat)); + pstat->auth_seq = 2; -+ _rtw_memcpy(pstat->hwaddr, sa, 6); -+ ++ _rtw_memcpy(pstat->hwaddr, sa, 6); ++ +#ifdef CONFIG_NATIVEAP_MLME -+ issue_auth(padapter, pstat, (unsigned short)status); ++ issue_auth(padapter, pstat, (unsigned short)status); +#endif + +#endif @@ -34244,7 +20726,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + DBG_871X("%s\n", __FUNCTION__); + + //check A1 matches or not -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), get_da(pframe), ETH_ALEN)) ++ if (!_rtw_memcmp(myid(&(padapter->eeprompriv)), get_da(pframe), ETH_ALEN)) + return _SUCCESS; + + if (!(pmlmeinfo->state & WIFI_FW_AUTH_STATE)) @@ -34252,9 +20734,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + offset = (GetPrivacy(pframe))? 4: 0; + -+ algthm = le16_to_cpu(*(unsigned short *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset)); -+ seq = le16_to_cpu(*(unsigned short *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 2)); -+ status = le16_to_cpu(*(unsigned short *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 4)); ++ algthm = le16_to_cpu(*(__le16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset)); ++ seq = le16_to_cpu(*(__le16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 2)); ++ status = le16_to_cpu(*(__le16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 4)); + + if (status != 0) + { @@ -34267,7 +20749,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pmlmeinfo->auth_algo = dot11AuthAlgrthm_Shared; + //pmlmeinfo->reauth_count = 0; + } -+ ++ + set_link_timer(pmlmeext, 1); + goto authclnt_fail; + } @@ -34337,7 +20819,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_AP_MODE + _irqL irqL; + u16 capab_info, listen_interval; -+ struct rtw_ieee802_11_elems elems; ++ struct rtw_ieee802_11_elems elems; + struct sta_info *pstat; + unsigned char reassoc, *p, *pos, *wpa_ie; + unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01}; @@ -34345,12 +20827,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + unsigned char supportRate[16]; + int supportRateNum; + unsigned short status = _STATS_SUCCESSFUL_; -+ unsigned short frame_type, ie_offset=0; ++ unsigned short frame_type, ie_offset=0; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct security_priv *psecuritypriv = &padapter->securitypriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur = &(pmlmeinfo->network); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur = &(pmlmeinfo->network); + struct sta_priv *pstapriv = &padapter->stapriv; + u8 *pframe = precv_frame->u.hdr.rx_data; + uint pkt_len = precv_frame->u.hdr.len; @@ -34376,26 +20858,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) + return _FAIL; -+ ++ + frame_type = GetFrameSubType(pframe); + if (frame_type == WIFI_ASSOCREQ) + { + reassoc = 0; + ie_offset = _ASOCREQ_IE_OFFSET_; -+ } ++ } + else // WIFI_REASSOCREQ + { + reassoc = 1; + ie_offset = _REASOCREQ_IE_OFFSET_; + } -+ ++ + + if (pkt_len < IEEE80211_3ADDR_LEN + ie_offset) { + DBG_871X("handle_assoc(reassoc=%d) - too short payload (len=%lu)" + "\n", reassoc, (unsigned long)pkt_len); + return _FAIL; + } -+ ++ + pstat = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); + if (pstat == (struct sta_info *)NULL) + { @@ -34404,13 +20886,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + + capab_info = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN); -+ //capab_info = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); ++ //capab_info = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); + //listen_interval = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN+2)); + listen_interval = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN+2); + + left = pkt_len - (IEEE80211_3ADDR_LEN + ie_offset); + pos = pframe + (IEEE80211_3ADDR_LEN + ie_offset); -+ ++ + + DBG_871X("%s\n", __FUNCTION__); + @@ -34425,7 +20907,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + else + { + pstat->state &= (~WIFI_FW_ASSOC_SUCCESS); -+ pstat->state |= WIFI_FW_ASSOC_STATE; ++ pstat->state |= WIFI_FW_ASSOC_STATE; + } + } + else @@ -34454,7 +20936,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + resp = WLAN_STATUS_ASSOC_DENIED_LISTEN_INT_TOO_LARGE; + goto fail; + } -+ ++ + pstat->listen_interval = listen_interval; +#endif + @@ -34463,7 +20945,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + !elems.ssid) { + DBG_871X("STA " MAC_FMT " sent invalid association request\n", + MAC_ARG(pstat->hwaddr)); -+ status = _STATS_FAILURE_; ++ status = _STATS_FAILURE_; + goto OnAssocReqFail; + } + @@ -34474,7 +20956,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pkt_len - WLAN_HDR_A3_LEN - ie_offset); + if (p == NULL) + { -+ status = _STATS_FAILURE_; ++ status = _STATS_FAILURE_; + } + + if (ie_len == 0) // broadcast ssid, however it is not allowed in assocreq @@ -34499,7 +20981,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // use our own rate set as statoin used + //_rtw_memcpy(supportRate, AP_BSSRATE, AP_BSSRATE_LEN); + //supportRateNum = AP_BSSRATE_LEN; -+ ++ + status = _STATS_FAILURE_; + goto OnAssocReqFail; + } @@ -34510,26 +20992,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + ie_offset, _EXT_SUPPORTEDRATES_IE_ , &ie_len, + pkt_len - WLAN_HDR_A3_LEN - ie_offset); + if (p != NULL) { -+ ++ + if(supportRateNum<=sizeof(supportRate)) + { + _rtw_memcpy(supportRate+supportRateNum, p+2, ie_len); + supportRateNum += ie_len; -+ } ++ } + } + } + + //todo: mask supportRate between AP & STA -> move to update raid + //get_matched_rate(pmlmeext, supportRate, &supportRateNum, 0); + -+ //update station supportRate ++ //update station supportRate + pstat->bssratelen = supportRateNum; + _rtw_memcpy(pstat->bssrateset, supportRate, supportRateNum); + UpdateBrateTblForSoftAP(pstat->bssrateset, pstat->bssratelen); + + //check RSN/WPA/WPS + pstat->dot8021xalg = 0; -+ pstat->wpa_psk = 0; ++ pstat->wpa_psk = 0; + pstat->wpa_group_cipher = 0; + pstat->wpa2_group_cipher = 0; + pstat->wpa_pairwise_cipher = 0; @@ -34537,19 +21019,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + _rtw_memset(pstat->wpa_ie, 0, sizeof(pstat->wpa_ie)); + if((psecuritypriv->wpa_psk & BIT(1)) && elems.rsn_ie) { + -+ int group_cipher=0, pairwise_cipher=0; -+ ++ int group_cipher=0, pairwise_cipher=0; ++ + wpa_ie = elems.rsn_ie; + wpa_ie_len = elems.rsn_ie_len; + + if(rtw_parse_wpa2_ie(wpa_ie-2, wpa_ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) + { -+ pstat->dot8021xalg = 1;//psk, todo:802.1x ++ pstat->dot8021xalg = 1;//psk, todo:802.1x + pstat->wpa_psk |= BIT(1); + -+ pstat->wpa2_group_cipher = group_cipher&psecuritypriv->wpa2_group_cipher; ++ pstat->wpa2_group_cipher = group_cipher&psecuritypriv->wpa2_group_cipher; + pstat->wpa2_pairwise_cipher = pairwise_cipher&psecuritypriv->wpa2_pairwise_cipher; -+ ++ + if(!pstat->wpa2_group_cipher) + status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; + @@ -34559,35 +21041,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + else + { + status = WLAN_STATUS_INVALID_IE; -+ } -+ ++ } ++ + } else if ((psecuritypriv->wpa_psk & BIT(0)) && elems.wpa_ie) { + -+ int group_cipher=0, pairwise_cipher=0; -+ ++ int group_cipher=0, pairwise_cipher=0; ++ + wpa_ie = elems.wpa_ie; + wpa_ie_len = elems.wpa_ie_len; + + if(rtw_parse_wpa_ie(wpa_ie-2, wpa_ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) + { -+ pstat->dot8021xalg = 1;//psk, todo:802.1x ++ pstat->dot8021xalg = 1;//psk, todo:802.1x + pstat->wpa_psk |= BIT(0); + -+ pstat->wpa_group_cipher = group_cipher&psecuritypriv->wpa_group_cipher; ++ pstat->wpa_group_cipher = group_cipher&psecuritypriv->wpa_group_cipher; + pstat->wpa_pairwise_cipher = pairwise_cipher&psecuritypriv->wpa_pairwise_cipher; -+ ++ + if(!pstat->wpa_group_cipher) + status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; + + if(!pstat->wpa_pairwise_cipher) + status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; -+ ++ + } + else + { + status = WLAN_STATUS_INVALID_IE; + } -+ ++ + } else { + wpa_ie = NULL; + wpa_ie_len = 0; @@ -34617,26 +21099,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // AP support WPA/RSN, and sta is going to do WPS, but AP is not ready + // that the selected registrar of AP is _FLASE -+ if((psecuritypriv->wpa_psk >0) ++ if((psecuritypriv->wpa_psk >0) + && (pstat->flags & (WLAN_STA_WPS|WLAN_STA_MAYBE_WPS))) + { + if(pmlmepriv->wps_beacon_ie) -+ { ++ { + u8 selected_registrar = 0; -+ ++ + rtw_get_wps_attr_content(pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len, WPS_ATTR_SELECTED_REGISTRAR , &selected_registrar, NULL); + + if(!selected_registrar) -+ { -+ DBG_871X("selected_registrar is _FALSE , or AP is not ready to do WPS\n"); -+ ++ { ++ DBG_871X("selected_registrar is false , or AP is not ready to do WPS\n"); ++ + status = _STATS_UNABLE_HANDLE_STA_; -+ ++ + goto OnAssocReqFail; -+ } -+ } ++ } ++ } + } -+ ++ + } + else + { @@ -34645,10 +21127,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if(psecuritypriv->wpa_psk == 0) + { + DBG_871X("STA " MAC_FMT ": WPA/RSN IE in association " -+ "request, but AP don't support WPA/RSN\n", MAC_ARG(pstat->hwaddr)); -+ ++ "request, but AP don't support WPA/RSN\n", MAC_ARG(pstat->hwaddr)); ++ + status = WLAN_STATUS_INVALID_IE; -+ ++ + goto OnAssocReqFail; + + } @@ -34665,10 +21147,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + copy_len = ((wpa_ie_len+2) > sizeof(pstat->wpa_ie)) ? (sizeof(pstat->wpa_ie)):(wpa_ie_len+2); + } + -+ ++ + if(copy_len>0) + _rtw_memcpy(pstat->wpa_ie, wpa_ie-2, copy_len); -+ ++ + } + + @@ -34676,56 +21158,56 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pstat->flags &= ~WLAN_STA_WME; + pstat->qos_option = 0; + pstat->qos_info = 0; -+ pstat->has_legacy_ac = _TRUE; ++ pstat->has_legacy_ac = true; + pstat->uapsd_vo = 0; + pstat->uapsd_vi = 0; + pstat->uapsd_be = 0; + pstat->uapsd_bk = 0; -+ if (pmlmepriv->qospriv.qos_option) ++ if (pmlmepriv->qospriv.qos_option) + { + p = pframe + WLAN_HDR_A3_LEN + ie_offset; ie_len = 0; -+ for (;;) ++ for (;;) + { + p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &ie_len, pkt_len - WLAN_HDR_A3_LEN - ie_offset); + if (p != NULL) { + if (_rtw_memcmp(p+2, WMM_IE, 6)) { + + pstat->flags |= WLAN_STA_WME; -+ -+ pstat->qos_option = 1; ++ ++ pstat->qos_option = 1; + pstat->qos_info = *(p+8); -+ ++ + pstat->max_sp_len = (pstat->qos_info>>5)&0x3; + + if((pstat->qos_info&0xf) !=0xf) -+ pstat->has_legacy_ac = _TRUE; ++ pstat->has_legacy_ac = true; + else -+ pstat->has_legacy_ac = _FALSE; -+ ++ pstat->has_legacy_ac = false; ++ + if(pstat->qos_info&0xf) + { + if(pstat->qos_info&BIT(0)) + pstat->uapsd_vo = BIT(0)|BIT(1); + else + pstat->uapsd_vo = 0; -+ ++ + if(pstat->qos_info&BIT(1)) + pstat->uapsd_vi = BIT(0)|BIT(1); + else + pstat->uapsd_vi = 0; -+ ++ + if(pstat->qos_info&BIT(2)) + pstat->uapsd_bk = BIT(0)|BIT(1); + else + pstat->uapsd_bk = 0; -+ -+ if(pstat->qos_info&BIT(3)) ++ ++ if(pstat->qos_info&BIT(3)) + pstat->uapsd_be = BIT(0)|BIT(1); + else + pstat->uapsd_be = 0; -+ ++ + } -+ ++ + break; + } + } @@ -34740,24 +21222,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_80211N_HT + /* save HT capabilities in the sta object */ + _rtw_memset(&pstat->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap)); -+ if (elems.ht_capabilities && elems.ht_capabilities_len >= sizeof(struct rtw_ieee80211_ht_cap)) ++ if (elems.ht_capabilities && elems.ht_capabilities_len >= sizeof(struct rtw_ieee80211_ht_cap)) + { + pstat->flags |= WLAN_STA_HT; -+ ++ + pstat->flags |= WLAN_STA_WME; -+ -+ _rtw_memcpy(&pstat->htpriv.ht_cap, elems.ht_capabilities, sizeof(struct rtw_ieee80211_ht_cap)); -+ ++ ++ _rtw_memcpy(&pstat->htpriv.ht_cap, elems.ht_capabilities, sizeof(struct rtw_ieee80211_ht_cap)); ++ + } else + pstat->flags &= ~WLAN_STA_HT; + -+ -+ if((pmlmepriv->htpriv.ht_option == _FALSE) && (pstat->flags&WLAN_STA_HT)) ++ ++ if((pmlmepriv->htpriv.ht_option == false) && (pstat->flags&WLAN_STA_HT)) + { + status = _STATS_FAILURE_; + goto OnAssocReqFail; + } -+ ++ ++ ++ if ((pstat->flags & WLAN_STA_HT) && ++ ((pstat->wpa2_pairwise_cipher&WPA_CIPHER_TKIP) || ++ (pstat->wpa_pairwise_cipher&WPA_CIPHER_TKIP))) ++ { ++ DBG_871X("HT: " MAC_FMT " tried to " ++ "use TKIP with HT association\n", MAC_ARG(pstat->hwaddr)); ++ ++ //status = WLAN_STATUS_CIPHER_REJECTED_PER_POLICY; ++ //goto OnAssocReqFail; ++ } +#endif /* CONFIG_80211N_HT */ + +#ifdef CONFIG_80211AC_VHT @@ -34768,41 +21261,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + _rtw_memcpy(pstat->vhtpriv.vht_cap, elems.vht_capabilities, 12); + + if (elems.vht_op_mode_notify && elems.vht_op_mode_notify_len == 1) { -+ _rtw_memcpy(&pstat->vhtpriv.vht_op_mode_notify, elems.vht_op_mode_notify, 1); -+ } -+ else // for Frame without Operating Mode notify ie; default: 80M -+ { -+ pstat->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80; ++ pstat->vhtpriv.bwmode = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(elems.vht_op_mode_notify); + } + } + else { -+ pstat->flags &= ~WLAN_STA_VHT; ++ pstat->flags &= ~WLAN_STA_HT; + } + -+ if((pmlmepriv->vhtpriv.vht_option == _FALSE) && (pstat->flags&WLAN_STA_VHT)) ++ if((pmlmepriv->vhtpriv.vht_option == false) && (pstat->flags&WLAN_STA_VHT)) + { + status = _STATS_FAILURE_; + goto OnAssocReqFail; + } +#endif /* CONFIG_80211AC_VHT */ + -+ if (((pstat->flags & WLAN_STA_HT) || (pstat->flags & WLAN_STA_VHT)) && -+ ((pstat->wpa2_pairwise_cipher & WPA_CIPHER_TKIP) || -+ (pstat->wpa_pairwise_cipher & WPA_CIPHER_TKIP))) { -+ -+ DBG_871X("(V)HT: " MAC_FMT " tried to use TKIP with (V)HT association\n", MAC_ARG(pstat->hwaddr)); -+ -+ pstat->flags &= ~WLAN_STA_HT; -+ pstat->flags &= ~WLAN_STA_VHT; -+ /*status = WLAN_STATUS_CIPHER_REJECTED_PER_POLICY; -+ * goto OnAssocReqFail; -+ */ -+ } -+ -+ + // + //if (hapd->iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G)//? -+ pstat->flags |= WLAN_STA_NONERP; ++ pstat->flags |= WLAN_STA_NONERP; + for (i = 0; i < pstat->bssratelen; i++) { + if ((pstat->bssrateset[i] & 0x7f) > 22) { + pstat->flags &= ~WLAN_STA_NONERP; @@ -34815,18 +21290,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + else + pstat->flags &= ~WLAN_STA_SHORT_PREAMBLE; + -+ -+ ++ ++ + if (status != _STATS_SUCCESSFUL_) + goto OnAssocReqFail; + +#ifdef CONFIG_P2P -+ pstat->is_p2p_device = _FALSE; ++ pstat->is_p2p_device = false; + if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { ++ { + if( (p2pie=rtw_get_p2p_ie(pframe + WLAN_HDR_A3_LEN + ie_offset , pkt_len - WLAN_HDR_A3_LEN - ie_offset , NULL, &p2pielen))) + { -+ pstat->is_p2p_device = _TRUE; ++ pstat->is_p2p_device = true; + if((p2p_status_code=(u8)process_assoc_req_p2p_ie(pwdinfo, pframe, pkt_len, pstat))>0) + { + pstat->p2p_status_code = p2p_status_code; @@ -34859,81 +21334,77 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // identify if this is ralink sta + // Customer proprietary IE + -+ ++ + + /* get a unique AID */ + if (pstat->aid > 0) { + DBG_871X(" old AID %d\n", pstat->aid); + } else { -+ for (pstat->aid = 1; pstat->aid <= NUM_STA; pstat->aid++) { -+ if (pstapriv->sta_aid[pstat->aid - 1] == NULL) { -+ if (pstat->aid > pstapriv->max_num_sta) { -+ pstat->aid = 0; -+ -+ DBG_871X(" no room for more AIDs\n"); ++ for (pstat->aid = 1; pstat->aid <= NUM_STA; pstat->aid++) ++ if (pstapriv->sta_aid[pstat->aid - 1] == NULL) ++ break; + -+ status = WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA; -+ -+ goto OnAssocReqFail; -+ -+ -+ } else { -+ pstapriv->sta_aid[pstat->aid - 1] = pstat; -+ DBG_871X("allocate new AID = (%d)\n", pstat->aid); -+ break; -+ } -+ } -+ } ++ //if (pstat->aid > NUM_STA) { ++ if (pstat->aid > pstapriv->max_num_sta) { ++ ++ pstat->aid = 0; ++ ++ DBG_871X(" no room for more AIDs\n"); ++ ++ status = WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA; ++ ++ goto OnAssocReqFail; ++ ++ ++ } else { ++ pstapriv->sta_aid[pstat->aid - 1] = pstat; ++ DBG_871X("allocate new AID = (%d)\n", pstat->aid); ++ } + } + + -+ pstat->state &= (~WIFI_FW_ASSOC_STATE); ++ pstat->state &= (~WIFI_FW_ASSOC_STATE); + pstat->state |= WIFI_FW_ASSOC_SUCCESS; -+ /* DBG_871X("==================%s, %d, (%x), bpairwise_key_installed=%d, MAC:"MAC_FMT"\n" -+ , __func__, __LINE__, pstat->state, pstat->bpairwise_key_installed, MAC_ARG(pstat->hwaddr)); */ -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ if (!rtw_is_list_empty(&pstat->auth_list)) { -+ rtw_list_delete(&pstat->auth_list); -+ pstapriv->auth_list_cnt--; -+ } -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&pstat->asoc_list)) { -+ pstat->expire_to = pstapriv->expire_to; -+ rtw_list_insert_tail(&pstat->asoc_list, &pstapriv->asoc_list); -+ pstapriv->asoc_list_cnt++; -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ } + -+ // now the station is qualified to join our BSS... ++ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ if (!rtw_is_list_empty(&pstat->auth_list)) ++ { ++ rtw_list_delete(&pstat->auth_list); ++ pstapriv->auth_list_cnt--; ++ } ++ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ if (rtw_is_list_empty(&pstat->asoc_list)) ++ { ++ pstat->expire_to = pstapriv->expire_to; ++ rtw_list_insert_tail(&pstat->asoc_list, &pstapriv->asoc_list); ++ pstapriv->asoc_list_cnt++; ++ } ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ // now the station is qualified to join our BSS... + if(pstat && (pstat->state & WIFI_FW_ASSOC_SUCCESS) && (_STATS_SUCCESSFUL_==status)) + { +#ifdef CONFIG_NATIVEAP_MLME -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ /* .1 bss_cap_update & sta_info_update */ -+ bss_cap_update_on_sta_join(padapter, pstat); -+ sta_info_update(padapter, pstat); -+ } -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed == _TRUE) -+ status = _STATS_REFUSED_TEMPORARILY_; -+#endif /* CONFIG_IEEE80211W */ -+ //.2 issue assoc rsp before notify station join event. ++ //.1 bss_cap_update & sta_info_update ++ bss_cap_update_on_sta_join(padapter, pstat); ++ sta_info_update(padapter, pstat); ++ ++ //issue assoc rsp before notify station join event. + if (frame_type == WIFI_ASSOCREQ) + issue_asocrsp(padapter, status, pstat, WIFI_ASSOCRSP); + else + issue_asocrsp(padapter, status, pstat, WIFI_REASSOCRSP); + ++ //.2 - report to upper layer ++ DBG_871X("indicate_sta_join_event to upper layer - hostapd\n"); +#ifdef CONFIG_IOCTL_CFG80211 ++ #ifdef COMPAT_KERNEL_RELEASE ++ rtw_cfg80211_indicate_sta_assoc(padapter, pframe, pkt_len); ++ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) ++ rtw_cfg80211_indicate_sta_assoc(padapter, pframe, pkt_len); ++ #else //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) + _enter_critical_bh(&pstat->lock, &irqL); + if(pstat->passoc_req) + { @@ -34949,21 +21420,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pstat->assoc_req_len = pkt_len; + } + _exit_critical_bh(&pstat->lock, &irqL); ++ #endif //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) ++#else ++ rtw_indicate_sta_assoc_event(padapter, pstat); +#endif //CONFIG_IOCTL_CFG80211 -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ /* .3-(1) report sta add event */ -+ report_add_sta_event(padapter, pstat->hwaddr, pstat->aid); -+ } -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed == _TRUE && padapter->securitypriv.binstallBIPkey == _TRUE) { -+ DBG_871X(MAC_FMT"\n", MAC_ARG(pstat->hwaddr)); -+ issue_action_SA_Query(padapter, pstat->hwaddr, 0, 0, IEEE80211W_RIGHT_KEY); -+ } -+#endif /* CONFIG_IEEE80211W */ -+#endif //CONFIG_NATIVEAP_MLME ++ ++ //.3-(1) report sta add event ++ report_add_sta_event(padapter, pstat->hwaddr, pstat->aid); ++ ++/* ++ //issue assoc rsp before notify station join event. ++ if (frame_type == WIFI_ASSOCREQ) ++ issue_asocrsp(padapter, status, pstat, WIFI_ASSOCRSP); ++ else ++ issue_asocrsp(padapter, status, pstat, WIFI_REASSOCRSP); ++*/ ++ ++#endif + } + + return _SUCCESS; @@ -34974,7 +21447,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + issue_deauth(padapter, (void *)GetAddr2Ptr(pframe), status); +#endif + -+ return _FAIL; ++ return _FAIL; + +OnAssocReqFail: + @@ -34990,7 +21463,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +#endif /* CONFIG_AP_MODE */ + -+ return _FAIL; ++ return _FAIL; + +} + @@ -35003,15 +21476,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ //WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ //WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + u8 *pframe = precv_frame->u.hdr.rx_data; + uint pkt_len = precv_frame->u.hdr.len; + PNDIS_802_11_VARIABLE_IEs pWapiIE = NULL; + + DBG_871X("%s\n", __FUNCTION__); -+ ++ + //check A1 matches or not -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), get_da(pframe), ETH_ALEN)) ++ if (!_rtw_memcmp(myid(&(padapter->eeprompriv)), get_da(pframe), ETH_ALEN)) + return _SUCCESS; + + if (!(pmlmeinfo->state & (WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE))) @@ -35023,7 +21496,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + _cancel_timer_ex(&pmlmeext->link_timer); + + //status -+ if ((status = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN + 2))) > 0) ++ if ((status = le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN + 2))) > 0) + { + DBG_871X("assoc reject, status code: %d\n", status); + pmlmeinfo->state = WIFI_FW_NULL_STATE; @@ -35032,13 +21505,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + + //get capabilities -+ pmlmeinfo->capability = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); ++ pmlmeinfo->capability = le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN)); + + //set slot time + pmlmeinfo->slotTime = (pmlmeinfo->capability & BIT(10))? 9: 20; + + //AID -+ res = pmlmeinfo->aid = (int)(le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN + 4))&0x3fff); ++ res = pmlmeinfo->aid = (int)(le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN + 4))&0x3fff); + + //following are moved to join event callback function + //to handle HT, WMM, rate adaptive, update MAC reg @@ -35060,7 +21533,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + DBG_871X( "[%s] Found WFD IE\n", __FUNCTION__ ); + WFD_info_handler( padapter, pIE ); + } -+#endif ++#endif + break; + +#ifdef CONFIG_WAPI_SUPPORT @@ -35089,15 +21562,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + case _ERPINFO_IE_: + ERP_IE_handler(padapter, pIE); -+ break; -+#ifdef CONFIG_TDLS -+ case _EXT_CAP_IE_: -+ if (check_ap_tdls_prohibited(pIE->data, pIE->Length) == _TRUE) -+ padapter->tdlsinfo.ap_prohibited = _TRUE; -+ if (check_ap_tdls_ch_switching_prohibited(pIE->data, pIE->Length) == _TRUE) -+ padapter->tdlsinfo.ch_switch_prohibited = _TRUE; -+ break; -+#endif /* CONFIG_TDLS */ ++ + default: + break; + } @@ -35142,8 +21607,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if (!(_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) + return _SUCCESS; + -+ DBG_871X(FUNC_ADPT_FMT" - Start to Disconnect\n", FUNC_ADPT_ARG(padapter)); -+ +#ifdef CONFIG_P2P + if ( pwdinfo->rx_invitereq_info.scan_op_ch_only ) + { @@ -35152,76 +21615,54 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } +#endif //CONFIG_P2P + -+ reason = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); ++ reason = le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN)); + -+ rtw_lock_rx_suspend_timeout(8000); ++ DBG_871X("%s Reason code(%d)\n", __FUNCTION__,reason); + +#ifdef CONFIG_AP_MODE -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ { ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) ++ { + _irqL irqL; + struct sta_info *psta; + struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ ++ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); + //rtw_free_stainfo(padapter, psta); -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); + -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" reason=%u, ta=%pM\n" -+ , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe)); ++ DBG_871X_LEVEL(_drv_always_, "ap recv deauth reason code(%d) sta:%pM\n", ++ reason, GetAddr2Ptr(pframe)); + -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); + if(psta) + { -+ u8 updated = _FALSE; -+ ++ u8 updated; ++ + _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if(rtw_is_list_empty(&psta->asoc_list)==_FALSE) -+ { ++ if(rtw_is_list_empty(&psta->asoc_list)==false) ++ { + rtw_list_delete(&psta->asoc_list); + pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, _FALSE, reason, _TRUE); ++ updated = ap_free_sta(padapter, psta, false, reason); + + } + _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); + -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); ++ associated_clients_update(padapter, updated); + } -+ ++ + + return _SUCCESS; + } + else +#endif + { -+ int ignore_received_deauth = 0; ++ DBG_871X_LEVEL(_drv_always_, "sta recv deauth reason code(%d) sta:%pM\n", ++ reason, GetAddr3Ptr(pframe)); + -+ // Commented by Albert 20130604 -+ // Before sending the auth frame to start the STA/GC mode connection with AP/GO, -+ // we will send the deauth first. -+ // However, the Win8.1 with BRCM Wi-Fi will send the deauth with reason code 6 to us after receieving our deauth. -+ // Added the following code to avoid this case. -+ if ( ( pmlmeinfo->state & WIFI_FW_AUTH_STATE ) || -+ ( pmlmeinfo->state & WIFI_FW_ASSOC_STATE ) ) -+ { -+ if ( reason == WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA ) -+ { -+ ignore_received_deauth = 1; -+ } else if (WLAN_REASON_PREV_AUTH_NOT_VALID == reason) { -+ // TODO: 802.11r -+ ignore_received_deauth = 1; -+ } -+ } -+ -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" reason=%u, ta=%pM, ignore=%d\n" -+ , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe), ignore_received_deauth); -+ -+ if ( 0 == ignore_received_deauth ) -+ { -+ receive_disconnect(padapter, GetAddr2Ptr(pframe), reason); -+ } -+ } -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; ++ receive_disconnect(padapter, GetAddr3Ptr(pframe) ,reason); ++ } ++ pmlmepriv->LinkDetectInfo.bBusyTraffic = false; + return _SUCCESS; + +} @@ -35241,8 +21682,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if (!(_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) + return _SUCCESS; + -+ DBG_871X(FUNC_ADPT_FMT" - Start to Disconnect\n", FUNC_ADPT_ARG(padapter)); -+ +#ifdef CONFIG_P2P + if ( pwdinfo->rx_invitereq_info.scan_op_ch_only ) + { @@ -35251,40 +21690,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } +#endif //CONFIG_P2P + -+ reason = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); ++ reason = le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN)); ++ ++ DBG_871X("%s Reason code(%d)\n", __FUNCTION__,reason); + -+ rtw_lock_rx_suspend_timeout(8000); -+ +#ifdef CONFIG_AP_MODE -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ { ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) ++ { + _irqL irqL; + struct sta_info *psta; + struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ ++ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); + //rtw_free_stainfo(padapter, psta); -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); + -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" reason=%u, ta=%pM\n" -+ , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe)); ++ DBG_871X_LEVEL(_drv_always_, "ap recv disassoc reason code(%d) sta:%pM\n", ++ reason, GetAddr2Ptr(pframe)); + -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); + if(psta) + { -+ u8 updated = _FALSE; -+ ++ u8 updated; ++ + _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if(rtw_is_list_empty(&psta->asoc_list)==_FALSE) ++ if(rtw_is_list_empty(&psta->asoc_list)==false) + { + rtw_list_delete(&psta->asoc_list); + pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, _FALSE, reason, _TRUE); -+ ++ updated = ap_free_sta(padapter, psta, false, reason); ++ + } + _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); + -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); ++ associated_clients_update(padapter, updated); + } + + return _SUCCESS; @@ -35292,12 +21731,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + else +#endif + { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" reason=%u, ta=%pM\n" -+ , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe)); ++ DBG_871X_LEVEL(_drv_always_, "ap recv disassoc reason code(%d) sta:%pM\n", ++ reason, GetAddr3Ptr(pframe)); + -+ receive_disconnect(padapter, GetAddr2Ptr(pframe), reason); -+ } -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; ++ receive_disconnect(padapter, GetAddr3Ptr(pframe), reason); ++ } ++ pmlmepriv->LinkDetectInfo.bBusyTraffic = false; + return _SUCCESS; + +} @@ -35308,19 +21747,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return _SUCCESS; +} + -+unsigned int on_action_spct_ch_switch(_adapter *padapter, struct sta_info *psta, u8 *ies, uint ies_len) ++static unsigned int on_action_spct_ch_switch(_adapter *padapter, struct sta_info *psta, u8 *ies, uint ies_len) +{ + unsigned int ret = _FAIL; + struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(mlmeext->mlmext_info); + + if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { -+ ret = _SUCCESS; ++ ret = _SUCCESS; + goto exit; + } + + if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) { -+ ++ + int ch_switch_mode = -1, ch = -1, ch_switch_cnt = -1; + int ch_offset = -1; + u8 bwmode; @@ -35359,7 +21798,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + * 2. things after channel switching + */ + -+ ret = rtw_set_ch_cmd(padapter, ch, bwmode, ch_offset, _TRUE); ++ ret = rtw_set_ch_cmd(padapter, ch, bwmode, ch_offset, true); + } + +exit: @@ -35419,293 +21858,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return _SUCCESS; +} + -+/** -+ * rtw_rx_ampdu_size - Get the target RX AMPDU buffer size for the specific @adapter -+ * @adapter: the adapter to get target RX AMPDU buffer size -+ * -+ * Returns: the target RX AMPDU buffer size -+ */ -+u8 rtw_rx_ampdu_size(_adapter *adapter) -+{ -+ u8 size; -+ HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor; -+ -+ if (adapter->fix_rx_ampdu_size != RX_AMPDU_SIZE_INVALID) { -+ size = adapter->fix_rx_ampdu_size; -+ goto exit; -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ if (rtw_btcoex_IsBTCoexCtrlAMPDUSize(adapter) == _TRUE) { -+ size = rtw_btcoex_GetAMPDUSize(adapter); -+ goto exit; -+ } -+#endif -+ -+ /* for scan */ -+ if (!mlmeext_chk_scan_state(&adapter->mlmeextpriv, SCAN_DISABLE) -+ && !mlmeext_chk_scan_state(&adapter->mlmeextpriv, SCAN_COMPLETE) -+ && adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_size != RX_AMPDU_SIZE_INVALID -+ ) { -+ size = adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_size; -+ goto exit; -+ } -+ -+ /* default value based on max_rx_ampdu_factor */ -+ if (adapter->driver_rx_ampdu_factor != 0xFF) -+ max_rx_ampdu_factor = (HT_CAP_AMPDU_FACTOR)adapter->driver_rx_ampdu_factor; -+ else -+ rtw_hal_get_def_var(adapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); -+ -+ if (MAX_AMPDU_FACTOR_64K == max_rx_ampdu_factor) -+ size = 64; -+ else if (MAX_AMPDU_FACTOR_32K == max_rx_ampdu_factor) -+ size = 32; -+ else if (MAX_AMPDU_FACTOR_16K == max_rx_ampdu_factor) -+ size = 16; -+ else if (MAX_AMPDU_FACTOR_8K == max_rx_ampdu_factor) -+ size = 8; -+ else -+ size = 64; -+ -+exit: -+ -+ if (size > 127) -+ size = 127; -+ -+ return size; -+} -+ -+/** -+ * rtw_rx_ampdu_is_accept - Get the permission if RX AMPDU should be set up for the specific @adapter -+ * @adapter: the adapter to get the permission if RX AMPDU should be set up -+ * -+ * Returns: accept or not -+ */ -+bool rtw_rx_ampdu_is_accept(_adapter *adapter) -+{ -+ bool accept; -+ -+ if (adapter->fix_rx_ampdu_accept != RX_AMPDU_ACCEPT_INVALID) { -+ accept = adapter->fix_rx_ampdu_accept; -+ goto exit; -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ if (rtw_btcoex_IsBTCoexRejectAMPDU(adapter) == _TRUE) { -+ accept = _FALSE; -+ goto exit; -+ } -+#endif -+ -+ /* for scan */ -+ if (!mlmeext_chk_scan_state(&adapter->mlmeextpriv, SCAN_DISABLE) -+ && !mlmeext_chk_scan_state(&adapter->mlmeextpriv, SCAN_COMPLETE) -+ && adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_accept != RX_AMPDU_ACCEPT_INVALID -+ ) { -+ accept = adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_accept; -+ goto exit; -+ } -+ -+ /* default value for other cases */ -+ accept = adapter->mlmeextpriv.mlmext_info.bAcceptAddbaReq; -+ -+exit: -+ return accept; -+} -+ -+/** -+ * rtw_rx_ampdu_set_size - Set the target RX AMPDU buffer size for the specific @adapter and specific @reason -+ * @adapter: the adapter to set target RX AMPDU buffer size -+ * @size: the target RX AMPDU buffer size to set -+ * @reason: reason for the target RX AMPDU buffer size setting -+ * -+ * Returns: whether the target RX AMPDU buffer size is changed -+ */ -+bool rtw_rx_ampdu_set_size(_adapter *adapter, u8 size, u8 reason) -+{ -+ bool is_adj = _FALSE; -+ struct mlme_ext_priv *mlmeext; -+ struct mlme_ext_info *mlmeinfo; -+ -+ mlmeext = &adapter->mlmeextpriv; -+ mlmeinfo = &mlmeext->mlmext_info; -+ -+ if (reason == RX_AMPDU_DRV_FIXED) { -+ if (adapter->fix_rx_ampdu_size != size) { -+ adapter->fix_rx_ampdu_size = size; -+ is_adj = _TRUE; -+ DBG_871X(FUNC_ADPT_FMT" fix_rx_ampdu_size:%u\n", FUNC_ADPT_ARG(adapter), size); -+ } -+ } else if (reason == RX_AMPDU_DRV_SCAN) { -+ struct ss_res *ss = &adapter->mlmeextpriv.sitesurvey_res; -+ -+ if (ss->rx_ampdu_size != size) { -+ ss->rx_ampdu_size = size; -+ is_adj = _TRUE; -+ DBG_871X(FUNC_ADPT_FMT" ss.rx_ampdu_size:%u\n", FUNC_ADPT_ARG(adapter), size); -+ } -+ } -+ -+ return is_adj; -+} -+ -+/** -+ * rtw_rx_ampdu_set_accept - Set the permission if RX AMPDU should be set up for the specific @adapter and specific @reason -+ * @adapter: the adapter to set if RX AMPDU should be set up -+ * @accept: if RX AMPDU should be set up -+ * @reason: reason for the permission if RX AMPDU should be set up -+ * -+ * Returns: whether the permission if RX AMPDU should be set up is changed -+ */ -+bool rtw_rx_ampdu_set_accept(_adapter *adapter, u8 accept, u8 reason) -+{ -+ bool is_adj = _FALSE; -+ struct mlme_ext_priv *mlmeext; -+ struct mlme_ext_info *mlmeinfo; -+ -+ mlmeext = &adapter->mlmeextpriv; -+ mlmeinfo = &mlmeext->mlmext_info; -+ -+ if (reason == RX_AMPDU_DRV_FIXED) { -+ if (adapter->fix_rx_ampdu_accept != accept) { -+ adapter->fix_rx_ampdu_accept = accept; -+ is_adj = _TRUE; -+ DBG_871X(FUNC_ADPT_FMT" fix_rx_ampdu_accept:%u\n", FUNC_ADPT_ARG(adapter), accept); -+ } -+ } else if (reason == RX_AMPDU_DRV_SCAN) { -+ if (adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_accept != accept) { -+ adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_accept = accept; -+ is_adj = _TRUE; -+ DBG_871X(FUNC_ADPT_FMT" ss.rx_ampdu_accept:%u\n", FUNC_ADPT_ARG(adapter), accept); -+ } -+ } -+ -+ return is_adj; -+} -+ -+/** -+ * rx_ampdu_apply_sta_tid - Apply RX AMPDU setting to the specific @sta and @tid -+ * @adapter: the adapter to which @sta belongs -+ * @sta: the sta to be checked -+ * @tid: the tid to be checked -+ * @accept: the target permission if RX AMPDU should be set up -+ * @size: the target RX AMPDU buffer size -+ * -+ * Returns: -+ * 0: no canceled -+ * 1: canceled by no permission -+ * 2: canceled by different buffer size -+ * 3: canceled by potential mismatched status -+ * -+ * Blocking function, may sleep -+ */ -+u8 rx_ampdu_apply_sta_tid(_adapter *adapter, struct sta_info *sta, u8 tid, u8 accept, u8 size) -+{ -+ u8 ret = 0; -+ struct recv_reorder_ctrl *reorder_ctl = &sta->recvreorder_ctrl[tid]; -+ -+ if (reorder_ctl->enable == _FALSE) { -+ if (reorder_ctl->ampdu_size != RX_AMPDU_SIZE_INVALID) { -+ send_delba_sta_tid_wait_ack(adapter, 0, sta, tid, 1); -+ ret = 3; -+ } -+ goto exit; -+ } -+ -+ if (accept == _FALSE) { -+ send_delba_sta_tid_wait_ack(adapter, 0, sta, tid, 0); -+ ret = 1; -+ } else if (reorder_ctl->ampdu_size != size) { -+ send_delba_sta_tid_wait_ack(adapter, 0, sta, tid, 0); -+ ret = 2; -+ } -+ -+exit: -+ return ret; -+} -+ -+/** -+ * rx_ampdu_apply_sta - Apply RX AMPDU setting to the specific @sta -+ * @adapter: the adapter to which @sta belongs -+ * @sta: the sta to be checked -+ * @accept: the target permission if RX AMPDU should be set up -+ * @size: the target RX AMPDU buffer size -+ * -+ * Returns: number of the RX AMPDU assciation canceled for applying current target setting -+ * -+ * Blocking function, may sleep -+ */ -+u8 rx_ampdu_apply_sta(_adapter *adapter, struct sta_info *sta, u8 accept, u8 size) -+{ -+ u8 change_cnt = 0; -+ int i; -+ -+ for (i = 0; i < TID_NUM; i++) { -+ if (rx_ampdu_apply_sta_tid(adapter, sta, i, accept, size) != 0) -+ change_cnt++; -+ } -+ -+ return change_cnt; -+} -+ -+/** -+ * rtw_rx_ampdu_apply - Apply the current target RX AMPDU setting for the specific @adapter -+ * @adapter: the adapter to be applied -+ * -+ * Returns: number of the RX AMPDU assciation canceled for applying current target setting -+ */ -+u16 rtw_rx_ampdu_apply(_adapter *adapter) -+{ -+ u16 adj_cnt = 0; -+ struct mlme_ext_priv *mlmeext; -+ struct sta_info *sta; -+ u8 accept = rtw_rx_ampdu_is_accept(adapter); -+ u8 size = rtw_rx_ampdu_size(adapter); -+ -+ mlmeext = &adapter->mlmeextpriv; -+ -+ if (mlmeext_msr(mlmeext) == WIFI_FW_STATION_STATE) { -+ sta = rtw_get_stainfo(&adapter->stapriv, get_bssid(&adapter->mlmepriv)); -+ if (sta) -+ adj_cnt += rx_ampdu_apply_sta(adapter, sta, accept, size); -+ -+ } else if (mlmeext_msr(mlmeext) == WIFI_FW_AP_STATE) { -+ _irqL irqL; -+ _list *phead, *plist; -+ u8 peer_num = 0; -+ char peers[NUM_STA]; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ int i; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ int stainfo_offset; -+ -+ sta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, sta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ peers[peer_num++] = stainfo_offset; -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ for (i = 0; i < peer_num; i++) { -+ sta = rtw_get_stainfo_by_offset(pstapriv, peers[i]); -+ if (sta) -+ adj_cnt += rx_ampdu_apply_sta(adapter, sta, accept, size); -+ } -+ } -+ -+ return adj_cnt; -+} -+ +unsigned int OnAction_back(_adapter *padapter, union recv_frame *precv_frame) +{ + u8 *addr; @@ -35719,20 +21871,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + u8 *pframe = precv_frame->u.hdr.rx_data; + struct sta_priv *pstapriv = &padapter->stapriv; +#ifdef CONFIG_80211N_HT -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ //check RA matches or not -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) ++ //check RA matches or not ++ if (!_rtw_memcmp(myid(&(padapter->eeprompriv)), GetAddr1Ptr(pframe), ETH_ALEN))//for if1, sta/ap mode + return _SUCCESS; + +/* + //check A1 matches or not -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), get_da(pframe), ETH_ALEN)) ++ if (!_rtw_memcmp(myid(&(padapter->eeprompriv)), get_da(pframe), ETH_ALEN)) + return _SUCCESS; +*/ ++ DBG_871X("%s\n", __FUNCTION__); + -+ if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) ++ if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) + if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) + return _SUCCESS; + @@ -35748,11 +21898,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if (category == RTW_WLAN_CATEGORY_BACK)// representing Block Ack + { +#ifdef CONFIG_TDLS -+ if((psta->tdls_sta_state & TDLS_LINKED_STATE) && -+ (psta->htpriv.ht_option==_TRUE) && -+ (psta->htpriv.ampdu_enable==_TRUE)) ++ if((psta->tdls_sta_state & TDLS_LINKED_STATE) && ++ (psta->htpriv.ht_option==true) && ++ (psta->htpriv.ampdu_enable==true) ) + { -+ DBG_871X("Recv [%s] from direc link\n", __FUNCTION__); ++ //do nothing; just don't want to return _SUCCESS; + } + else +#endif //CONFIG_TDLS @@ -35770,7 +21920,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + _rtw_memcpy(&(pmlmeinfo->ADDBA_req), &(frame_body[2]), sizeof(struct ADDBA_request)); + //process_addba_req(padapter, (u8*)&(pmlmeinfo->ADDBA_req), GetAddr3Ptr(pframe)); + process_addba_req(padapter, (u8*)&(pmlmeinfo->ADDBA_req), addr); -+ ++ ++ if(pmlmeinfo->bAcceptAddbaReq == true) ++ { ++ issue_action_BA(padapter, addr, RTW_WLAN_ACTION_ADDBA_RESP, 0); ++ } ++ else ++ { ++ issue_action_BA(padapter, addr, RTW_WLAN_ACTION_ADDBA_RESP, 37);//reject ADDBA Req ++ } ++ + break; + + case RTW_WLAN_ACTION_ADDBA_RESP: //ADDBA response @@ -35780,22 +21939,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + tid = ((frame_body[5] >> 2) & 0x7); + + if (status == 0) -+ { //successful ++ { //successful + DBG_871X("agg_enable for TID=%d\n", tid); -+ psta->htpriv.agg_enable_bitmap |= 1 << tid; -+ psta->htpriv.candidate_tid_bitmap &= ~BIT(tid); ++ psta->htpriv.agg_enable_bitmap |= 1 << tid; ++ psta->htpriv.candidate_tid_bitmap &= ~BIT(tid); + } + else -+ { -+ psta->htpriv.agg_enable_bitmap &= ~BIT(tid); -+ } -+ -+ if(psta->state & WIFI_STA_ALIVE_CHK_STATE) + { -+ DBG_871X("%s alive check - rx ADDBA response\n", __func__); + psta->htpriv.agg_enable_bitmap &= ~BIT(tid); -+ psta->expire_to = pstapriv->expire_to; -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; + } + + //DBG_871X("marc: ADDBA RSP: %x\n", pmlmeinfo->agg_enable_bitmap); @@ -35806,19 +21957,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + psta->htpriv.agg_enable_bitmap &= ~(1 << ((frame_body[3] >> 4) & 0xf)); + psta->htpriv.candidate_tid_bitmap &= ~(1 << ((frame_body[3] >> 4) & 0xf)); -+ ++ + //reason_code = frame_body[4] | (frame_body[5] << 8); + reason_code = RTW_GET_LE16(&frame_body[4]); + } + else if((frame_body[3] & BIT(3)) == BIT(3)) -+ { ++ { + tid = (frame_body[3] >> 4) & 0x0F; -+ -+ preorder_ctrl = &psta->recvreorder_ctrl[tid]; -+ preorder_ctrl->enable = _FALSE; -+ preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; ++ ++ preorder_ctrl = &psta->recvreorder_ctrl[tid]; ++ preorder_ctrl->enable = false; ++ preorder_ctrl->indicate_seq = 0xffff; ++ #ifdef DBG_RX_SEQ ++ DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u \n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq); ++ #endif + } -+ ++ + DBG_871X("%s(): DELBA: %x(%x)\n", __FUNCTION__,pmlmeinfo->agg_enable_bitmap, reason_code); + //todo: how to notify the host while receiving DELETE BA + break; @@ -35850,8 +22005,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + *p24g_cnt = 0; + *p5gl_cnt = 0; -+ *p5gh_cnt = 0; -+ ++ *p5gh_cnt = 0; ++ + for( i = 0; i < pmlmeext->max_chan_nums; i++ ) + { + if ( pmlmeext->channel_set[ i ].ChannelNum <= 14 ) @@ -35876,7 +22031,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; + u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); ++ __be32 p2poui = cpu_to_be32(P2POUI); + u8 oui_subtype = P2P_GO_NEGO_REQ; + u8 wpsie[ 255 ] = { 0x00 }, p2pie[ 255 ] = { 0x00 }; + u8 wpsielen = 0, p2pielen = 0, i; @@ -35884,13 +22039,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + u16 len_channellist_attr = 0; +#ifdef CONFIG_WFD + u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ ++#endif //CONFIG_WFD ++ + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -35916,8 +22071,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); + pmlmeext->mgnt_seq++; @@ -35929,25 +22084,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); + pwdinfo->negotiation_dialog_token = 1; // Initialize the dialog value + pframe = rtw_set_fixed_ie(pframe, 1, &pwdinfo->negotiation_dialog_token, &(pattrib->pktlen)); + -+ ++ + + // WPS Section + wpsielen = 0; + // WPS OUI -+ *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); ++ *(__be32*) ( wpsie ) = cpu_to_be32( WPSOUI ); + wpsielen += 4; + + // WPS version + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); + wpsielen += 2; + + // Value: @@ -35955,26 +22110,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Device Password ID + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_PWID ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_PWID ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); + wpsielen += 2; + + // Value: + + if ( pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PEER_DISPLAY_PIN ) + { -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_USER_SPEC ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_USER_SPEC ); + } + else if ( pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_SELF_DISPLAY_PIN ) + { -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_REGISTRAR_SPEC ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_REGISTRAR_SPEC ); + } + else if ( pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PBC ) + { -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_PBC ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_PBC ); + } + + wpsielen += 2; @@ -36009,7 +22164,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); + p2pielen += 2; + + // Value: @@ -36032,19 +22187,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_GO_INTENT; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); + p2pielen += 2; + + // Value: + // Todo the tie breaker bit. -+ p2pie[ p2pielen++ ] = ( ( pwdinfo->intent << 1 ) & 0xFE ); ++ p2pie[ p2pielen++ ] = ( ( pwdinfo->intent << 1 ) | BIT(0) ); + + // Configuration Timeout + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_CONF_TIMEOUT; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); + p2pielen += 2; + + // Value: @@ -36057,40 +22212,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_LISTEN_CH; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); + p2pielen += 2; + + // Value: + // Country String + p2pie[ p2pielen++ ] = 'X'; + p2pie[ p2pielen++ ] = 'X'; -+ ++ + // The third byte should be set to 0x04. + // Described in the "Operating Channel Attribute" section. + p2pie[ p2pielen++ ] = 0x04; + + // Operating Class + p2pie[ p2pielen++ ] = 0x51; // Copy from SD7 -+ ++ + // Channel Number + p2pie[ p2pielen++ ] = pwdinfo->listen_channel; // listening channel number -+ ++ + + // Extended Listen Timing ATTR + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_EX_LISTEN_TIMING; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0004 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0004 ); + p2pielen += 2; + + // Value: + // Availability Period -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); + p2pielen += 2; + + // Availability Interval -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); + p2pielen += 2; + + @@ -36099,11 +22254,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_INTENTED_IF_ADDR; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); + p2pielen += 2; + + // Value: -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); + p2pielen += ETH_ALEN; + + @@ -36122,15 +22277,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_CONCURRENT_MODE + if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) + { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); + } + else + { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); + } +#else + -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); + +#endif + p2pielen += 2; @@ -36139,7 +22294,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // Country String + p2pie[ p2pielen++ ] = 'X'; + p2pie[ p2pielen++ ] = 'X'; -+ ++ + // The third byte should be set to 0x04. + // Described in the "Operating Channel Attribute" section. + p2pie[ p2pielen++ ] = 0x04; @@ -36149,7 +22304,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_CONCURRENT_MODE + if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) + { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; ++ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; + struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; + + // Operating Class @@ -36215,34 +22370,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; + + // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) ++ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) + // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); + p2pielen += 2; + + // Value: + // P2P Device Address -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); + p2pielen += ETH_ALEN; + + // Config Method + // This field should be big endian. Noted by P2P specification. + -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); + + p2pielen += 2; + + // Primary Device Type + // Category ID -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); + p2pielen += 2; + + // OUI -+ *(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); ++ *(__be32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); + p2pielen += 4; + + // Sub Category ID -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); + p2pielen += 2; + + // Number of Secondary Device Types @@ -36250,31 +22405,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Device Name + // Type: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); + p2pielen += 2; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); + p2pielen += 2; + + // Value: + _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_name , pwdinfo->device_name_len ); -+ p2pielen += pwdinfo->device_name_len; -+ ++ p2pielen += pwdinfo->device_name_len; ++ + + // Operating Channel + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); + p2pielen += 2; + + // Value: + // Country String + p2pie[ p2pielen++ ] = 'X'; + p2pie[ p2pielen++ ] = 'X'; -+ ++ + // The third byte should be set to 0x04. + // Described in the "Operating Channel Attribute" section. + p2pie[ p2pielen++ ] = 0x04; @@ -36299,7 +22454,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // Channel Number + p2pie[ p2pielen++ ] = pwdinfo->operating_channel; // operating channel number + -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); + +#ifdef CONFIG_WFD + wfdielen = build_nego_req_wfd_ie(pwdinfo, pframe); @@ -36316,26 +22471,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +} + + -+void issue_p2p_GO_response(_adapter *padapter, u8* raddr, u8* frame_body,uint len, u8 result) ++static void issue_p2p_GO_response(_adapter *padapter, u8* raddr, u8* frame_body,uint len, u8 result) +{ + + unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; + u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); ++ __be32 p2poui = cpu_to_be32(P2POUI); + u8 oui_subtype = P2P_GO_NEGO_RESP; + u8 wpsie[ 255 ] = { 0x00 }, p2pie[ 255 ] = { 0x00 }; + u8 p2pielen = 0, i; + uint wpsielen = 0; + u16 wps_devicepassword_id = 0x0000; ++ __be16 be_tmp; + uint wps_devicepassword_id_len = 0; + u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh; + u16 len_channellist_attr = 0; -+ ++ + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -36364,8 +22520,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); + pmlmeext->mgnt_seq++; @@ -36377,7 +22533,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); + pwdinfo->negotiation_dialog_token = frame_body[7]; // The Dialog Token of provisioning discovery request frame. + pframe = rtw_set_fixed_ie(pframe, 1, &(pwdinfo->negotiation_dialog_token), &(pattrib->pktlen)); + @@ -36385,8 +22541,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // Try to get the device password ID from the WPS IE of group negotiation request frame + // WiFi Direct test plan 5.1.15 + rtw_get_wps_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, wpsie, &wpsielen); -+ rtw_get_wps_attr_content( wpsie, wpsielen, WPS_ATTR_DEVICE_PWID, (u8*) &wps_devicepassword_id, &wps_devicepassword_id_len); -+ wps_devicepassword_id = be16_to_cpu( wps_devicepassword_id ); ++ rtw_get_wps_attr_content( wpsie, wpsielen, WPS_ATTR_DEVICE_PWID, (u8*) &be_tmp, &wps_devicepassword_id_len); ++ wps_devicepassword_id = be16_to_cpu(be_tmp); + + _rtw_memset( wpsie, 0x00, 255 ); + wpsielen = 0; @@ -36394,16 +22550,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // WPS Section + wpsielen = 0; + // WPS OUI -+ *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); ++ *(__be32*) ( wpsie ) = cpu_to_be32( WPSOUI ); + wpsielen += 4; + + // WPS version + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); + wpsielen += 2; + + // Value: @@ -36411,25 +22567,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Device Password ID + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_PWID ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_PWID ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); + wpsielen += 2; + + // Value: + if ( wps_devicepassword_id == WPS_DPID_USER_SPEC ) + { -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_REGISTRAR_SPEC ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_REGISTRAR_SPEC ); + } + else if ( wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC ) + { -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_USER_SPEC ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_USER_SPEC ); + } + else + { -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_PBC ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_PBC ); + } + wpsielen += 2; + @@ -36444,11 +22600,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + else if ( wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC ) + { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pad", 3 ); ++ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pad", 3 ); + } + else + { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pbc", 3 ); ++ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pbc", 3 ); + } + } + @@ -36484,18 +22640,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_STATUS; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); + p2pielen += 2; + + // Value: + p2pie[ p2pielen++ ] = result; -+ ++ + // P2P Capability + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); + p2pielen += 2; + + // Value: @@ -36513,7 +22669,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // Be group owner or meet the error case + p2pie[ p2pielen++ ] = DMP_P2P_DEVCAP_SUPPORT; + } -+ ++ + // Group Capability Bitmap, 1 byte + if ( pwdinfo->persistent_supported ) + { @@ -36529,7 +22685,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_GO_INTENT; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); + p2pielen += 2; + + // Value: @@ -36550,7 +22706,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_CONF_TIMEOUT; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); + p2pielen += 2; + + // Value: @@ -36562,14 +22718,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); + p2pielen += 2; + + // Value: + // Country String + p2pie[ p2pielen++ ] = 'X'; + p2pie[ p2pielen++ ] = 'X'; -+ ++ + // The third byte should be set to 0x04. + // Described in the "Operating Channel Attribute" section. + p2pie[ p2pielen++ ] = 0x04; @@ -36590,20 +22746,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // Operating Class + p2pie[ p2pielen++ ] = 0x7c; + } -+ ++ + // Channel Number + p2pie[ p2pielen++ ] = pwdinfo->operating_channel; // operating channel number + -+ // Intended P2P Interface Address ++ // Intended P2P Interface Address + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_INTENTED_IF_ADDR; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); + p2pielen += 2; + + // Value: -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); + p2pielen += ETH_ALEN; + + // Channel List @@ -36620,15 +22776,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_CONCURRENT_MODE + if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) + { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); + } + else + { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); + } +#else + -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); + + #endif + p2pielen += 2; @@ -36637,7 +22793,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // Country String + p2pie[ p2pielen++ ] = 'X'; + p2pie[ p2pielen++ ] = 'X'; -+ ++ + // The third byte should be set to 0x04. + // Described in the "Operating Channel Attribute" section. + p2pie[ p2pielen++ ] = 0x04; @@ -36647,7 +22803,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_CONCURRENT_MODE + if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) + { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; ++ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; + struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; + + // Operating Class @@ -36708,40 +22864,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } +#endif // CONFIG_CONCURRENT_MODE + -+ ++ + // Device Info + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; + + // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) ++ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) + // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); + p2pielen += 2; + + // Value: + // P2P Device Address -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); + p2pielen += ETH_ALEN; + + // Config Method + // This field should be big endian. Noted by P2P specification. + -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); + + p2pielen += 2; + + // Primary Device Type + // Category ID -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); + p2pielen += 2; + + // OUI -+ *(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); ++ *(__be32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); + p2pielen += 4; + + // Sub Category ID -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); + p2pielen += 2; + + // Number of Secondary Device Types @@ -36749,17 +22905,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Device Name + // Type: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); + p2pielen += 2; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); + p2pielen += 2; + + // Value: + _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_name , pwdinfo->device_name_len ); -+ p2pielen += pwdinfo->device_name_len; -+ ++ p2pielen += pwdinfo->device_name_len; ++ + if ( rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) ) + { + // Group ID Attribute @@ -36767,7 +22923,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_ID; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN + pwdinfo->nego_ssidlen ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN + pwdinfo->nego_ssidlen ); + p2pielen += 2; + + // Value: @@ -36778,11 +22934,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // SSID + _rtw_memcpy( p2pie + p2pielen, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen ); + p2pielen += pwdinfo->nego_ssidlen; -+ ++ + } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); -+ ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); ++ +#ifdef CONFIG_WFD + wfdielen = build_nego_resp_wfd_ie(pwdinfo, pframe); + pframe += wfdielen; @@ -36797,21 +22953,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +} + -+void issue_p2p_GO_confirm(_adapter *padapter, u8* raddr, u8 result) ++static void issue_p2p_GO_confirm(_adapter *padapter, u8* raddr, u8 result) +{ + + unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; + u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); ++ __be32 p2poui = cpu_to_be32(P2POUI); + u8 oui_subtype = P2P_GO_NEGO_CONF; + u8 wpsie[ 255 ] = { 0x00 }, p2pie[ 255 ] = { 0x00 }; + u8 wpsielen = 0, p2pielen = 0; -+ ++ + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -36839,8 +22995,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); + pmlmeext->mgnt_seq++; @@ -36852,10 +23008,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(pwdinfo->negotiation_dialog_token), &(pattrib->pktlen)); + -+ ++ + + // P2P IE Section. + @@ -36879,7 +23035,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_STATUS; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); + p2pielen += 2; + + // Value: @@ -36890,13 +23046,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); + p2pielen += 2; + + // Value: + // Device Capability Bitmap, 1 byte + p2pie[ p2pielen++ ] = DMP_P2P_DEVCAP_SUPPORT; -+ ++ + // Group Capability Bitmap, 1 byte + if ( pwdinfo->persistent_supported ) + { @@ -36913,14 +23069,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); + p2pielen += 2; + + // Value: + // Country String + p2pie[ p2pielen++ ] = 'X'; + p2pie[ p2pielen++ ] = 'X'; -+ ++ + // The third byte should be set to 0x04. + // Described in the "Operating Channel Attribute" section. + p2pie[ p2pielen++ ] = 0x04; @@ -36943,7 +23099,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // Operating Class + p2pie[ p2pielen++ ] = 0x7c; + } -+ ++ + p2pie[ p2pielen++ ] = pwdinfo->peer_operating_ch; + } + else @@ -36963,7 +23119,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // Operating Class + p2pie[ p2pielen++ ] = 0x7c; + } -+ ++ + // Channel Number + p2pie[ p2pielen++ ] = pwdinfo->operating_channel; // Use the listen channel as the operating channel + } @@ -36973,60 +23129,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_CH_LIST; + -+ *(u16*) ( p2pie + p2pielen ) = 6; ++ // Length: ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( pwdinfo->channel_list_attr_len ); + p2pielen += 2; + -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ + // Value: -+ if ( rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) ) -+ { -+ if ( pwdinfo->peer_operating_ch <= 14 ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x51; -+ } -+ else if ( ( pwdinfo->peer_operating_ch >= 36 ) && ( pwdinfo->peer_operating_ch <= 48 ) ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x73; -+ } -+ else -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x7c; -+ } -+ p2pie[ p2pielen++ ] = 1; -+ p2pie[ p2pielen++ ] = pwdinfo->peer_operating_ch; -+ } -+ else -+ { -+ if ( pwdinfo->operating_channel <= 14 ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x51; -+ } -+ else if ( ( pwdinfo->operating_channel >= 36 ) && ( pwdinfo->operating_channel <= 48 ) ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x73; -+ } -+ else -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x7c; -+ } -+ -+ // Channel Number -+ p2pie[ p2pielen++ ] = 1; -+ p2pie[ p2pielen++ ] = pwdinfo->operating_channel; // Use the listen channel as the operating channel -+ } ++ _rtw_memcpy( p2pie + p2pielen, pwdinfo->channel_list_attr, pwdinfo->channel_list_attr_len ); ++ p2pielen += pwdinfo->channel_list_attr_len; + + if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) ) + { @@ -37035,7 +23144,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_ID; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN + pwdinfo->nego_ssidlen ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN + pwdinfo->nego_ssidlen ); + p2pielen += 2; + + // Value: @@ -37047,9 +23156,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + _rtw_memcpy( p2pie + p2pielen, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen ); + p2pielen += pwdinfo->nego_ssidlen; + } -+ ++ + pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); -+ ++ +#ifdef CONFIG_WFD + wfdielen = build_nego_confirm_wfd_ie(pwdinfo, pframe); + pframe += wfdielen; @@ -37069,13 +23178,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; + u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); ++ __be32 p2poui = cpu_to_be32(P2POUI); + u8 oui_subtype = P2P_INVIT_REQ; + u8 p2pie[ 255 ] = { 0x00 }; + u8 p2pielen = 0, i; + u8 dialogToken = 3; + u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; -+ u16 len_channellist_attr = 0; ++ u16 len_channellist_attr = 0; +#ifdef CONFIG_WFD + u32 wfdielen = 0; +#endif //CONFIG_WFD @@ -37090,7 +23199,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -37115,7 +23224,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, raddr, ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); @@ -37128,7 +23237,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); + + // P2P IE Section. @@ -37155,7 +23264,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_CONF_TIMEOUT; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); + p2pielen += 2; + + // Value: @@ -37167,7 +23276,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_INVITATION_FLAGS; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); + p2pielen += 2; + + // Value: @@ -37179,14 +23288,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); + p2pielen += 2; + + // Value: + // Country String + p2pie[ p2pielen++ ] = 'X'; + p2pie[ p2pielen++ ] = 'X'; -+ ++ + // The third byte should be set to 0x04. + // Described in the "Operating Channel Attribute" section. + p2pie[ p2pielen++ ] = 0x04; @@ -37198,18 +23307,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = 0x73; + else + p2pie[ p2pielen++ ] = 0x7c; -+ ++ + // Channel Number + p2pie[ p2pielen++ ] = pwdinfo->invitereq_info.operating_ch; // operating channel number + -+ if (_rtw_memcmp(adapter_mac_addr(padapter), pwdinfo->invitereq_info.go_bssid, ETH_ALEN)) ++ if ( _rtw_memcmp( myid( &padapter->eeprompriv ), pwdinfo->invitereq_info.go_bssid, ETH_ALEN ) ) + { + // P2P Group BSSID + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_BSSID; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); + p2pielen += 2; + + // Value: @@ -37222,7 +23331,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_CH_LIST; + -+ ++ + // Length: + // Country String(3) + // + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) @@ -37234,15 +23343,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_CONCURRENT_MODE + if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) + { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); + } + else + { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); + } +#else + -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); + + #endif + p2pielen += 2; @@ -37251,7 +23360,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // Country String + p2pie[ p2pielen++ ] = 'X'; + p2pie[ p2pielen++ ] = 'X'; -+ ++ + // The third byte should be set to 0x04. + // Described in the "Operating Channel Attribute" section. + p2pie[ p2pielen++ ] = 0x04; @@ -37260,7 +23369,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_CONCURRENT_MODE + if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) + { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; ++ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; + struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; + + // Operating Class @@ -37327,7 +23436,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_ID; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 6 + pwdinfo->invitereq_info.ssidlen ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 6 + pwdinfo->invitereq_info.ssidlen ); + p2pielen += 2; + + // Value: @@ -37338,39 +23447,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // SSID + _rtw_memcpy( p2pie + p2pielen, pwdinfo->invitereq_info.go_ssid, pwdinfo->invitereq_info.ssidlen ); + p2pielen += pwdinfo->invitereq_info.ssidlen; -+ ++ + + // Device Info + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; + + // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) ++ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) + // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); + p2pielen += 2; -+ ++ + // Value: + // P2P Device Address -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); + p2pielen += ETH_ALEN; + + // Config Method + // This field should be big endian. Noted by P2P specification. -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_DISPLAY ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_DISPLAY ); + p2pielen += 2; + + // Primary Device Type + // Category ID -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); + p2pielen += 2; + + // OUI -+ *(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); ++ *(__be32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); + p2pielen += 4; + + // Sub Category ID -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); + p2pielen += 2; + + // Number of Secondary Device Types @@ -37378,24 +23487,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Device Name + // Type: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); + p2pielen += 2; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); + p2pielen += 2; + + // Value: + _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len ); + p2pielen += pwdinfo->device_name_len; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); + +#ifdef CONFIG_WFD + wfdielen = build_invitation_req_wfd_ie(pwdinfo, pframe); + pframe += wfdielen; + pattrib->pktlen += wfdielen; -+#endif //CONFIG_WFD ++#endif //CONFIG_WFD + + pattrib->last_txcmdsz = pattrib->pktlen; + @@ -37410,7 +23519,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; + u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); ++ __be32 p2poui = cpu_to_be32(P2POUI); + u8 oui_subtype = P2P_INVIT_RESP; + u8 p2pie[ 255 ] = { 0x00 }; + u8 p2pielen = 0, i; @@ -37421,16 +23530,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct wifidirect_info *pbuddy_wdinfo = &pbuddy_adapter->wdinfo; + struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; + struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif ++#endif +#ifdef CONFIG_WFD + u32 wfdielen = 0; +#endif //CONFIG_WFD -+ ++ + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -37455,7 +23564,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, raddr, ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); @@ -37468,7 +23577,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); + + // P2P IE Section. @@ -37493,7 +23602,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_STATUS; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); + p2pielen += 2; + + // Value: @@ -37504,13 +23613,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // If the UI found the corresponding profile, the WiFi driver sends the P2P Invitation Req + // to NB to rebuild the persistent group. + p2pie[ p2pielen++ ] = status_code; -+ ++ + // Configuration Timeout + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_CONF_TIMEOUT; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); + p2pielen += 2; + + // Value: @@ -37531,36 +23640,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); + p2pielen += 2; + + // Value: + // Country String + p2pie[ p2pielen++ ] = 'X'; + p2pie[ p2pielen++ ] = 'X'; -+ ++ + // The third byte should be set to 0x04. + // Described in the "Operating Channel Attribute" section. + p2pie[ p2pielen++ ] = 0x04; + + // Operating Class + p2pie[ p2pielen++ ] = 0x51; // Copy from SD7 -+ ++ + // Channel Number + p2pie[ p2pielen++ ] = pwdinfo->operating_channel; // operating channel number -+ ++ + + // P2P Group BSSID + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_BSSID; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); + p2pielen += 2; + + // Value: + // P2P Device Address for GO -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); + p2pielen += ETH_ALEN; + + } @@ -37580,15 +23689,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_CONCURRENT_MODE + if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) + { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); + } + else + { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); + } +#else + -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); + +#endif + p2pielen += 2; @@ -37606,7 +23715,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_CONCURRENT_MODE + if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) + { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; ++ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; + struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; + + // Operating Class @@ -37667,9 +23776,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } +#endif // CONFIG_CONCURRENT_MODE + } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); -+ ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); ++ +#ifdef CONFIG_WFD + wfdielen = build_invitation_resp_wfd_ie(pwdinfo, pframe); + pframe += wfdielen; @@ -37689,20 +23798,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; + u8 action = P2P_PUB_ACTION_ACTION; + u8 dialogToken = 1; -+ u32 p2poui = cpu_to_be32(P2POUI); ++ __be32 p2poui = cpu_to_be32(P2POUI); + u8 oui_subtype = P2P_PROVISION_DISC_REQ; + u8 wpsie[ 100 ] = { 0x00 }; + u8 wpsielen = 0; + u32 p2pielen = 0; +#ifdef CONFIG_WFD + u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ ++#endif //CONFIG_WFD ++ + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -37728,7 +23837,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, pdev_raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, pdev_raddr, ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); @@ -37741,8 +23850,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); + + p2pielen = build_prov_disc_request_p2p_ie( pwdinfo, pframe, pssid, ussidlen, pdev_raddr ); + @@ -37751,16 +23860,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + wpsielen = 0; + // WPS OUI -+ *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); ++ *(__be32*) ( wpsie ) = cpu_to_be32( WPSOUI ); + wpsielen += 4; + + // WPS version + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); + wpsielen += 2; + + // Value: @@ -37768,15 +23877,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Config Method + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); + wpsielen += 2; + + // Value: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->tx_prov_disc_info.wps_config_method_request ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->tx_prov_disc_info.wps_config_method_request ); + wpsielen += 2; + + pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); @@ -37797,17 +23906,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +} + + -+u8 is_matched_in_profilelist( u8* peermacaddr, struct profile_info* profileinfo ) ++static u8 is_matched_in_profilelist( u8* peermacaddr, struct profile_info* profileinfo ) +{ + u8 i, match_result = 0; + + DBG_871X( "[%s] peermac = %.2X %.2X %.2X %.2X %.2X %.2X\n", __FUNCTION__, -+ peermacaddr[0], peermacaddr[1],peermacaddr[2],peermacaddr[3],peermacaddr[4],peermacaddr[5]); -+ ++ peermacaddr[0], peermacaddr[1],peermacaddr[2],peermacaddr[3],peermacaddr[4],peermacaddr[5]); ++ + for( i = 0; i < P2P_MAX_PERSISTENT_GROUP_NUM; i++, profileinfo++ ) + { + DBG_871X( "[%s] profileinfo_mac = %.2X %.2X %.2X %.2X %.2X %.2X\n", __FUNCTION__, -+ profileinfo->peermac[0], profileinfo->peermac[1],profileinfo->peermac[2],profileinfo->peermac[3],profileinfo->peermac[4],profileinfo->peermac[5]); ++ profileinfo->peermac[0], profileinfo->peermac[1],profileinfo->peermac[2],profileinfo->peermac[3],profileinfo->peermac[4],profileinfo->peermac[5]); + if ( _rtw_memcmp( peermacaddr, profileinfo->peermac, ETH_ALEN ) ) + { + match_result = 1; @@ -37815,7 +23924,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + break; + } + } -+ ++ + return (match_result ); +} + @@ -37825,13 +23934,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + unsigned char *mac; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ //WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ //WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + u16 beacon_interval = 100; + u16 capInfo = 0; + struct wifidirect_info *pwdinfo = &(padapter->wdinfo); @@ -37840,40 +23949,45 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_WFD + u32 wfdielen = 0; +#endif //CONFIG_WFD ++#ifdef CONFIG_IOCTL_CFG80211 ++ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; ++ struct ieee80211_channel *ieee_ch = &pcfg80211_wdinfo->remain_on_ch_channel; ++ u8 listen_channel = (u8) ieee80211_frequency_to_channel(ieee_ch->center_freq); ++#endif //CONFIG_IOCTL_CFG80211 +#ifdef CONFIG_INTEL_WIDI + u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; +#endif //CONFIG_INTEL_WIDI + + //DBG_871X("%s\n", __FUNCTION__); -+ ++ + if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) + { + return; + } -+ ++ + //update attribute + pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ ++ update_mgntframe_attrib(padapter, pattrib); ++ + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ ++ + pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = adapter_mac_addr(padapter); -+ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ mac = myid(&(padapter->eeprompriv)); ++ + fctrl = &(pwlanhdr->frame_ctl); + *(fctrl) = 0; + _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ -+ // Use the device address for BSSID field. ++ ++ // Use the device address for BSSID field. + _rtw_memcpy(pwlanhdr->addr3, mac, ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); + pmlmeext->mgnt_seq++; + SetFrameSubType(fctrl, WIFI_PROBERSP); -+ ++ + pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); + pattrib->pktlen = pattrib->hdrlen; + pframe += pattrib->hdrlen; @@ -37883,7 +23997,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pattrib->pktlen += 8; + + // beacon interval: 2 bytes -+ _rtw_memcpy(pframe, (unsigned char *) &beacon_interval, 2); ++ _rtw_memcpy(pframe, (unsigned char *) &beacon_interval, 2); + pframe += 2; + pattrib->pktlen += 2; + @@ -37891,7 +24005,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // ESS and IBSS bits must be 0 (defined in the 3.1.2.1.1 of WiFi Direct Spec) + capInfo |= cap_ShortPremble; + capInfo |= cap_ShortSlot; -+ ++ + _rtw_memcpy(pframe, (unsigned char *) &capInfo, 2); + pframe += 2; + pattrib->pktlen += 2; @@ -37905,10 +24019,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pwdinfo->support_rate, &pattrib->pktlen); + + // DS parameter set -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&pwdinfo->listen_channel, &pattrib->pktlen); ++#ifdef CONFIG_IOCTL_CFG80211 ++ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && listen_channel !=0 && pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ { ++ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&listen_channel, &pattrib->pktlen); ++ } ++ else ++#endif //CONFIG_IOCTL_CFG80211 ++ { ++ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&pwdinfo->listen_channel, &pattrib->pktlen); ++ } ++ + +#ifdef CONFIG_IOCTL_CFG80211 -+ if(adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) + { + if( pmlmepriv->wps_probe_resp_ie != NULL && pmlmepriv->p2p_probe_resp_ie != NULL ) + { @@ -37924,7 +24048,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + } + else -+#endif //CONFIG_IOCTL_CFG80211 ++#endif //CONFIG_IOCTL_CFG80211 + { + + // Todo: WPS IE @@ -37933,16 +24057,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + wpsielen = 0; + // WPS OUI -+ *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); ++ *(__be32*) ( wpsie ) = cpu_to_be32( WPSOUI ); + wpsielen += 4; + + // WPS version + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); + wpsielen += 2; + + // Value: @@ -37951,45 +24075,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_INTEL_WIDI + // Commented by Kurt + // Appended WiDi info. only if we did issued_probereq_widi(), and then we saved ven. ext. in pmlmepriv->sa_ext. -+ if( _rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE -+ || pmlmepriv->num_p2p_sdt != 0 ) ++ if( _rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == false ) + { + //Sec dev type -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_SEC_DEV_TYPE_LIST ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_SEC_DEV_TYPE_LIST ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0008 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0008 ); + wpsielen += 2; + + // Value: + // Category ID -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_CID_DISPLAYS ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_CID_DISPLAYS ); + wpsielen += 2; + + // OUI + *(u32*) ( wpsie + wpsielen ) = cpu_to_be32( INTEL_DEV_TYPE_OUI ); + wpsielen += 4; + -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_SCID_WIDI_CONSUMER_SINK ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_SCID_WIDI_CONSUMER_SINK ); + wpsielen += 2; + -+ if( _rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE ) -+ { -+ // Vendor Extension -+ _rtw_memcpy( wpsie + wpsielen, pmlmepriv->sa_ext, L2SDTA_SERVICE_VE_LEN ); -+ wpsielen += L2SDTA_SERVICE_VE_LEN; -+ } ++ // Vendor Extension ++ _rtw_memcpy( wpsie + wpsielen, pmlmepriv->sa_ext, L2SDTA_SERVICE_VE_LEN ); ++ wpsielen += L2SDTA_SERVICE_VE_LEN; + } +#endif //CONFIG_INTEL_WIDI + + // WiFi Simple Config State + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_SIMPLE_CONF_STATE ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_SIMPLE_CONF_STATE ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); + wpsielen += 2; + + // Value: @@ -37997,11 +24117,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Response Type + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_RESP_TYPE ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_RESP_TYPE ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); + wpsielen += 2; + + // Value: @@ -38009,29 +24129,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // UUID-E + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_UUID_E ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_UUID_E ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0010 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0010 ); + wpsielen += 2; + + // Value: -+ if (pwdinfo->external_uuid == 0) { -+ _rtw_memset( wpsie + wpsielen, 0x0, 16 ); -+ _rtw_memcpy(wpsie + wpsielen, mac, ETH_ALEN); -+ } else { -+ _rtw_memcpy( wpsie + wpsielen, pwdinfo->uuid, 0x10 ); -+ } ++ _rtw_memcpy( wpsie + wpsielen, myid( &padapter->eeprompriv ), ETH_ALEN ); + wpsielen += 0x10; + + // Manufacturer + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_MANUFACTURER ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_MANUFACTURER ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0007 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0007 ); + wpsielen += 2; + + // Value: @@ -38040,12 +24155,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Model Name + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_MODEL_NAME ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_MODEL_NAME ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0006 ); -+ wpsielen += 2; ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0006 ); ++ wpsielen += 2; + + // Value: + _rtw_memcpy( wpsie + wpsielen, "8192CU", 6 ); @@ -38053,11 +24168,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Model Number + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_MODEL_NUMBER ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_MODEL_NUMBER ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); + wpsielen += 2; + + // Value: @@ -38065,11 +24180,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Serial Number + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_SERIAL_NUMBER ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_SERIAL_NUMBER ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( ETH_ALEN ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( ETH_ALEN ); + wpsielen += 2; + + // Value: @@ -38078,33 +24193,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Primary Device Type + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_PRIMARY_DEV_TYPE ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_PRIMARY_DEV_TYPE ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0008 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0008 ); + wpsielen += 2; + + // Value: + // Category ID -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); + wpsielen += 2; + + // OUI -+ *(u32*) ( wpsie + wpsielen ) = cpu_to_be32( WPSOUI ); ++ *(__be32*) ( wpsie + wpsielen ) = cpu_to_be32( WPSOUI ); + wpsielen += 4; + + // Sub Category ID -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); + wpsielen += 2; + + // Device Name + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->device_name_len ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->device_name_len ); + wpsielen += 2; + + // Value: @@ -38113,20 +24228,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Config Method + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); + wpsielen += 2; + + // Value: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); + wpsielen += 2; -+ ++ + + pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); -+ ++ + + p2pielen = build_probe_resp_p2p_ie(pwdinfo, pframe); + pframe += p2pielen; @@ -38135,7 +24250,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +#ifdef CONFIG_WFD +#ifdef CONFIG_IOCTL_CFG80211 -+ if ( _TRUE == pwdinfo->wfd_info->wfd_enable ) ++ if ( true == pwdinfo->wfd_info->wfd_enable ) +#endif //CONFIG_IOCTL_CFG80211 + { + wfdielen = build_probe_resp_wfd_ie(pwdinfo, pframe, 0); @@ -38148,28 +24263,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + //WFD IE + _rtw_memcpy(pframe, pmlmepriv->wfd_probe_resp_ie, pmlmepriv->wfd_probe_resp_ie_len); + pattrib->pktlen += pmlmepriv->wfd_probe_resp_ie_len; -+ pframe += pmlmepriv->wfd_probe_resp_ie_len; ++ pframe += pmlmepriv->wfd_probe_resp_ie_len; + } +#endif //CONFIG_IOCTL_CFG80211 -+#endif //CONFIG_WFD ++#endif //CONFIG_WFD + + pattrib->last_txcmdsz = pattrib->pktlen; -+ ++ + + dump_mgntframe(padapter, pmgntframe); -+ ++ + return; + +} + -+int _issue_probereq_p2p(_adapter *padapter, u8 *da, int wait_ack) ++static int _issue_probereq_p2p(_adapter *padapter, u8 *da, int wait_ack) +{ + int ret = _FAIL; + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + unsigned char *mac; + unsigned char bssrate[NumRates]; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); @@ -38177,7 +24292,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + int bssrate_len = 0; + u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); + u8 wpsie[255] = { 0x00 }, p2pie[ 255 ] = { 0x00 }; + u16 wpsielen = 0, p2pielen = 0; +#ifdef CONFIG_WFD @@ -38202,7 +24317,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + -+ mac = adapter_mac_addr(padapter); ++ mac = myid(&(padapter->eeprompriv)); + + fctrl = &(pwlanhdr->frame_ctl); + *(fctrl) = 0; @@ -38245,7 +24360,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pwdinfo->support_rate, &pattrib->pktlen); + +#ifdef CONFIG_IOCTL_CFG80211 -+ if(adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) + { + if( pmlmepriv->wps_probe_req_ie != NULL && pmlmepriv->p2p_probe_req_ie != NULL ) + { @@ -38270,16 +24385,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + wpsielen = 0; + // WPS OUI -+ *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); ++ *(__be32*) ( wpsie ) = cpu_to_be32( WPSOUI ); + wpsielen += 4; + + // WPS version + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); + wpsielen += 2; + + // Value: @@ -38289,43 +24404,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + // UUID-E + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_UUID_E ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_UUID_E ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0010 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0010 ); + wpsielen += 2; + + // Value: -+ if (pwdinfo->external_uuid == 0) { -+ _rtw_memset( wpsie + wpsielen, 0x0, 16 ); -+ _rtw_memcpy(wpsie + wpsielen, mac, ETH_ALEN); -+ } else { -+ _rtw_memcpy( wpsie + wpsielen, pwdinfo->uuid, 0x10 ); -+ } ++ _rtw_memcpy( wpsie + wpsielen, myid( &padapter->eeprompriv ), ETH_ALEN ); + wpsielen += 0x10; + + // Config Method + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); + wpsielen += 2; + + // Value: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); + wpsielen += 2; + } + + // Device Name + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->device_name_len ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->device_name_len ); + wpsielen += 2; + + // Value: @@ -38334,41 +24444,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Primary Device Type + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_PRIMARY_DEV_TYPE ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_PRIMARY_DEV_TYPE ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0008 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0008 ); + wpsielen += 2; + + // Value: + // Category ID -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_CID_RTK_WIDI ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_CID_RTK_WIDI ); + wpsielen += 2; + + // OUI -+ *(u32*) ( wpsie + wpsielen ) = cpu_to_be32( WPSOUI ); ++ *(__be32 *) ( wpsie + wpsielen ) = cpu_to_be32( WPSOUI ); + wpsielen += 4; + + // Sub Category ID -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_SCID_RTK_DMP ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_SCID_RTK_DMP ); + wpsielen += 2; + + // Device Password ID + // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_PWID ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_PWID ); + wpsielen += 2; + + // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); + wpsielen += 2; + + // Value: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_REGISTRAR_SPEC ); // Registrar-specified -+ wpsielen += 2; ++ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_REGISTRAR_SPEC ); // Registrar-specified ++ wpsielen += 2; + + pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); -+ ++ + // P2P OUI + p2pielen = 0; + p2pie[ p2pielen++ ] = 0x50; @@ -38389,13 +24499,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); + p2pielen += 2; + + // Value: + // Device Capability Bitmap, 1 byte + p2pie[ p2pielen++ ] = DMP_P2P_DEVCAP_SUPPORT; -+ ++ + // Group Capability Bitmap, 1 byte + if ( pwdinfo->persistent_supported ) + p2pie[ p2pielen++ ] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; @@ -38407,40 +24517,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_LISTEN_CH; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); + p2pielen += 2; + + // Value: + // Country String + p2pie[ p2pielen++ ] = 'X'; + p2pie[ p2pielen++ ] = 'X'; -+ ++ + // The third byte should be set to 0x04. + // Described in the "Operating Channel Attribute" section. + p2pie[ p2pielen++ ] = 0x04; + + // Operating Class + p2pie[ p2pielen++ ] = 0x51; // Copy from SD7 -+ ++ + // Channel Number + p2pie[ p2pielen++ ] = pwdinfo->listen_channel; // listen channel -+ ++ + + // Extended Listen Timing + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_EX_LISTEN_TIMING; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0004 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0004 ); + p2pielen += 2; + + // Value: + // Availability Period -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); + p2pielen += 2; + + // Availability Interval -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); + p2pielen += 2; + + if ( rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) ) @@ -38450,33 +24560,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); + p2pielen += 2; + + // Value: + // Country String + p2pie[ p2pielen++ ] = 'X'; + p2pie[ p2pielen++ ] = 'X'; -+ ++ + // The third byte should be set to 0x04. + // Described in the "Operating Channel Attribute" section. + p2pie[ p2pielen++ ] = 0x04; + + // Operating Class + p2pie[ p2pielen++ ] = 0x51; // Copy from SD7 -+ ++ + // Channel Number + p2pie[ p2pielen++ ] = pwdinfo->operating_channel; // operating channel number -+ ++ + } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); + + } + +#ifdef CONFIG_WFD +#ifdef CONFIG_IOCTL_CFG80211 -+ if ( _TRUE == pwdinfo->wfd_info->wfd_enable ) ++ if ( true == pwdinfo->wfd_info->wfd_enable ) +#endif + { + wfdielen = build_probe_req_wfd_ie(pwdinfo, pframe); @@ -38484,15 +24594,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pattrib->pktlen += wfdielen; + } +#ifdef CONFIG_IOCTL_CFG80211 -+ else if (pmlmepriv->wfd_probe_req_ie != NULL && pmlmepriv->wfd_probe_req_ie_len>0) ++ else if (pmlmepriv->wfd_probe_req_ie != NULL && pmlmepriv->wfd_probe_req_ie_len>0) + { + //WFD IE + _rtw_memcpy(pframe, pmlmepriv->wfd_probe_req_ie, pmlmepriv->wfd_probe_req_ie_len); + pattrib->pktlen += pmlmepriv->wfd_probe_req_ie_len; -+ pframe += pmlmepriv->wfd_probe_req_ie_len; ++ pframe += pmlmepriv->wfd_probe_req_ie_len; + } +#endif //CONFIG_IOCTL_CFG80211 -+#endif //CONFIG_WFD ++#endif //CONFIG_WFD + + pattrib->last_txcmdsz = pattrib->pktlen; + @@ -38511,14 +24621,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +inline void issue_probereq_p2p(_adapter *adapter, u8 *da) +{ -+ _issue_probereq_p2p(adapter, da, _FALSE); ++ _issue_probereq_p2p(adapter, da, false); +} + -+/* -+ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ * try_cnt means the maximal TX count to try -+ */ +int issue_probereq_p2p_ex(_adapter *adapter, u8 *da, int try_cnt, int wait_ms) +{ + int ret; @@ -38527,11 +24632,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + do + { -+ ret = _issue_probereq_p2p(adapter, da, wait_ms>0?_TRUE:_FALSE); ++ ret = _issue_probereq_p2p(adapter, da, wait_ms>0?true:false); + + i++; + -+ if (RTW_CANNOT_RUN(adapter)) ++ if (adapter->bDriverStopped || adapter->bSurpriseRemoved) + break; + + if(i < try_cnt && wait_ms > 0 && ret==_FAIL) @@ -38562,14 +24667,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +#endif //CONFIG_P2P + -+s32 rtw_action_public_decache(union recv_frame *recv_frame, s32 token) ++static s32 rtw_action_public_decache(union recv_frame *recv_frame, s32 token) +{ + _adapter *adapter = recv_frame->u.hdr.adapter; + struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); + u8 *frame = recv_frame->u.hdr.rx_data; + u16 seq_ctrl = ( (recv_frame->u.hdr.attrib.seq_num&0xffff) << 4) | + (recv_frame->u.hdr.attrib.frag_num & 0xf); -+ ++ + if (GetRetry(frame)) { + if (token >= 0) { + if ((seq_ctrl == mlmeext->action_public_rxseq) @@ -38587,16 +24692,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + } + } -+ ++ + mlmeext->action_public_rxseq = seq_ctrl; -+ ++ + if (token >= 0) + mlmeext->action_public_dialog_token = token; + + return _SUCCESS; +} + -+unsigned int on_action_public_p2p(union recv_frame *precv_frame) ++static unsigned int on_action_public_p2p(union recv_frame *precv_frame) +{ + _adapter *padapter = precv_frame->u.hdr.adapter; + u8 *pframe = precv_frame->u.hdr.rx_data; @@ -38609,8 +24714,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + u8 result = P2P_STATUS_SUCCESS; + u8 empty_addr[ETH_ALEN] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; -+ u8 *merged_p2pie = NULL; -+ u32 merged_p2p_ielen= 0; +#endif //CONFIG_P2P + + frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); @@ -38619,11 +24722,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + if (rtw_action_public_decache(precv_frame, dialogToken) == _FAIL) + return _FAIL; -+ ++ +#ifdef CONFIG_P2P + _cancel_timer_ex( &pwdinfo->reset_ch_sitesurvey ); +#ifdef CONFIG_IOCTL_CFG80211 -+ if(adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) ++ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) + { + rtw_cfg80211_rx_p2p_action_public(padapter, pframe, len); + } @@ -38655,8 +24758,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); + // Restore the previous p2p state + rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ DBG_871X( "[%s] Restore the previous p2p state to %d\n", __FUNCTION__, rtw_p2p_state(pwdinfo) ); -+ } ++ DBG_871X( "[%s] Restore the previous p2p state to %d\n", __FUNCTION__, rtw_p2p_state(pwdinfo) ); ++ } +#ifdef CONFIG_CONCURRENT_MODE + if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) + { @@ -38677,10 +24780,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + result = process_p2p_group_negotation_req( pwdinfo, frame_body, len ); + issue_p2p_GO_response( padapter, GetAddr2Ptr(pframe), frame_body, len, result ); +#ifdef CONFIG_INTEL_WIDI -+ if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) { ++ if( (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) && (padapter->mlmepriv.widi_state != INTEL_WIDI_STATE_WFD_CONNECTION) ) ++ { + padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; + _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL, 0); ++ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL); + } +#endif //CONFIG_INTEL_WIDI + @@ -38692,7 +24796,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#else // CONFIG_CONCURRENT_MODE + _set_timer( &pwdinfo->restore_p2p_state_timer, 5000 ); +#endif // CONFIG_CONCURRENT_MODE -+ break; ++ break; + } + case P2P_GO_NEGO_RESP: + { @@ -38703,7 +24807,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // Commented by Albert 20110425 + // The restore timer is enabled when issuing the nego request frame of rtw_p2p_connect function. + _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); -+ pwdinfo->nego_req_info.benable = _FALSE; ++ pwdinfo->nego_req_info.benable = false; + result = process_p2p_group_negotation_resp( pwdinfo, frame_body, len); + issue_p2p_GO_confirm( pwdinfo->padapter, GetAddr2Ptr(pframe), result); + if ( P2P_STATUS_SUCCESS == result ) @@ -38711,11 +24815,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if ( rtw_p2p_role(pwdinfo) == P2P_ROLE_CLIENT ) + { + pwdinfo->p2p_info.operation_ch[ 0 ] = pwdinfo->peer_operating_ch; -+ #ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->p2p_info.operation_ch[ 1 ] = 1; //Check whether GO is operating in channel 1; -+ pwdinfo->p2p_info.operation_ch[ 2 ] = 6; //Check whether GO is operating in channel 6; -+ pwdinfo->p2p_info.operation_ch[ 3 ] = 11; //Check whether GO is operating in channel 11; -+ #endif //CONFIG_P2P_OP_CHK_SOCIAL_CH + pwdinfo->p2p_info.scan_op_ch_only = 1; + _set_timer( &pwdinfo->reset_ch_sitesurvey2, P2P_RESET_SCAN_CH ); + } @@ -38733,7 +24832,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + DBG_871X( "[%s] Skipped GO Nego Resp Frame (p2p_state != P2P_STATE_GONEGO_ING)\n", __FUNCTION__); + } -+ ++ + break; + } + case P2P_GO_NEGO_CONF: @@ -38745,11 +24844,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if ( rtw_p2p_role(pwdinfo) == P2P_ROLE_CLIENT ) + { + pwdinfo->p2p_info.operation_ch[ 0 ] = pwdinfo->peer_operating_ch; -+ #ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->p2p_info.operation_ch[ 1 ] = 1; //Check whether GO is operating in channel 1; -+ pwdinfo->p2p_info.operation_ch[ 2 ] = 6; //Check whether GO is operating in channel 6; -+ pwdinfo->p2p_info.operation_ch[ 3 ] = 11; //Check whether GO is operating in channel 11; -+ #endif //CONFIG_P2P_OP_CHK_SOCIAL_CH + pwdinfo->p2p_info.scan_op_ch_only = 1; + _set_timer( &pwdinfo->reset_ch_sitesurvey2, P2P_RESET_SCAN_CH ); + } @@ -38760,7 +24854,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + // Added by Albert 2010/10/05 + // Received the P2P Invite Request frame. -+ ++ + DBG_871X( "[%s] Got invite request frame!\n", __FUNCTION__ ); + if ( (p2p_ie=rtw_get_p2p_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen)) ) + { @@ -38770,25 +24864,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + u8 status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; + struct group_id_info group_id; + u8 invitation_flag = 0; -+ int j=0; + -+ merged_p2p_ielen = rtw_get_p2p_merged_ies_len(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_); -+ -+ merged_p2pie = rtw_zmalloc(merged_p2p_ielen + 2); // 2 is for EID and Length -+ if (merged_p2pie == NULL) -+ { -+ DBG_871X( "[%s] Malloc p2p ie fail\n", __FUNCTION__); -+ goto exit; -+ } -+ _rtw_memset(merged_p2pie, 0x00, merged_p2p_ielen); -+ -+ merged_p2p_ielen = rtw_p2p_merge_ies(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, merged_p2pie); -+ -+ rtw_get_p2p_attr_content( merged_p2pie, merged_p2p_ielen, P2P_ATTR_INVITATION_FLAGS, &invitation_flag, &attr_contentlen); ++ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_INVITATION_FLAGS, &invitation_flag, &attr_contentlen); + if ( attr_contentlen ) + { + -+ rtw_get_p2p_attr_content( merged_p2pie, merged_p2p_ielen, P2P_ATTR_GROUP_BSSID, pwdinfo->p2p_peer_interface_addr, &attr_contentlen); ++ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_GROUP_BSSID, pwdinfo->p2p_peer_interface_addr, &attr_contentlen); + // Commented by Albert 20120510 + // Copy to the pwdinfo->p2p_peer_interface_addr. + // So that the WFD UI ( or Sigma ) can get the peer interface address by using the following command. @@ -38801,17 +24882,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], + pwdinfo->p2p_peer_interface_addr[2], pwdinfo->p2p_peer_interface_addr[3], + pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5] ); -+ } ++ } + + if ( invitation_flag & P2P_INVITATION_FLAGS_PERSISTENT ) + { + // Re-invoke the persistent group. -+ ++ + _rtw_memset( &group_id, 0x00, sizeof( struct group_id_info ) ); -+ rtw_get_p2p_attr_content( merged_p2pie, merged_p2p_ielen, P2P_ATTR_GROUP_ID, ( u8* ) &group_id, &attr_contentlen); ++ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, ( u8* ) &group_id, &attr_contentlen); + if ( attr_contentlen ) + { -+ if (_rtw_memcmp(group_id.go_device_addr, adapter_mac_addr(padapter), ETH_ALEN)) ++ if ( _rtw_memcmp( group_id.go_device_addr, myid( &padapter->eeprompriv ), ETH_ALEN ) ) + { + // The p2p device sending this p2p invitation request wants this Wi-Fi device to be the persistent GO. + rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_GO ); @@ -38824,23 +24905,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if ( is_matched_in_profilelist( pwdinfo->p2p_peer_interface_addr, &pwdinfo->profileinfo[ 0 ] ) ) + { + u8 operatingch_info[5] = { 0x00 }; -+ if ( rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen) ) ++ if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen) ) + { -+ if( rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, (u32)operatingch_info[4] ) >= 0 ) ++ if( rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, (u32)operatingch_info[4] ) ) + { + // The operating channel is acceptable for this device. + pwdinfo->rx_invitereq_info.operation_ch[0]= operatingch_info[4]; -+ #ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->rx_invitereq_info.operation_ch[1]= 1; //Check whether GO is operating in channel 1; -+ pwdinfo->rx_invitereq_info.operation_ch[2]= 6; //Check whether GO is operating in channel 6; -+ pwdinfo->rx_invitereq_info.operation_ch[3]= 11; //Check whether GO is operating in channel 11; -+ #endif //CONFIG_P2P_OP_CHK_SOCIAL_CH + pwdinfo->rx_invitereq_info.scan_op_ch_only = 1; + _set_timer( &pwdinfo->reset_ch_sitesurvey, P2P_RESET_SCAN_CH ); + rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_MATCH ); + rtw_p2p_set_role( pwdinfo, P2P_ROLE_CLIENT ); + status_code = P2P_STATUS_SUCCESS; -+ } ++ } + else + { + // The operating channel isn't supported by this device. @@ -38858,7 +24934,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_MATCH ); + rtw_p2p_set_role( pwdinfo, P2P_ROLE_CLIENT ); + status_code = P2P_STATUS_SUCCESS; -+ } ++ } + } + else + { @@ -38876,17 +24952,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + DBG_871X( "[%s] P2P Group ID Attribute NOT FOUND!\n", __FUNCTION__ ); + status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ } ++ } + } + else + { + // Received the invitation to join a P2P group. + + _rtw_memset( &group_id, 0x00, sizeof( struct group_id_info ) ); -+ rtw_get_p2p_attr_content( merged_p2pie, merged_p2p_ielen, P2P_ATTR_GROUP_ID, ( u8* ) &group_id, &attr_contentlen); ++ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, ( u8* ) &group_id, &attr_contentlen); + if ( attr_contentlen ) + { -+ if (_rtw_memcmp(group_id.go_device_addr, adapter_mac_addr(padapter), ETH_ALEN)) ++ if ( _rtw_memcmp( group_id.go_device_addr, myid( &padapter->eeprompriv ), ETH_ALEN ) ) + { + // In this case, the GO can't be myself. + rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_DISMATCH ); @@ -38900,7 +24976,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // The peer device address should be the destination address for the provisioning discovery request. + // Then, this Wi-Fi device should use the iwpriv command to get the peer interface address. + // The peer interface address should be the address for WPS mac address -+ _rtw_memcpy( pwdinfo->p2p_peer_device_addr, group_id.go_device_addr , ETH_ALEN ); ++ _rtw_memcpy( pwdinfo->p2p_peer_device_addr, group_id.go_device_addr , ETH_ALEN ); + rtw_p2p_set_role( pwdinfo, P2P_ROLE_CLIENT ); + rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_JOIN ); + status_code = P2P_STATUS_SUCCESS; @@ -38917,19 +24993,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + DBG_871X( "[%s] P2P Invitation Flags Attribute NOT FOUND!\n", __FUNCTION__ ); + status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ } ++ } + + DBG_871X( "[%s] status_code = %d\n", __FUNCTION__, status_code ); + + pwdinfo->inviteresp_info.token = frame_body[ 7 ]; + issue_p2p_invitation_response( padapter, GetAddr2Ptr(pframe), pwdinfo->inviteresp_info.token, status_code ); -+ _set_timer( &pwdinfo->restore_p2p_state_timer, 3000 ); + } +#ifdef CONFIG_INTEL_WIDI -+ if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) { ++ if( (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) && (padapter->mlmepriv.widi_state != INTEL_WIDI_STATE_WFD_CONNECTION) ) ++ { + padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; + _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL, 0); ++ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL); + } +#endif //CONFIG_INTEL_WIDI + break; @@ -38938,25 +25014,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + u8 attr_content = 0x00; + u32 attr_contentlen = 0; -+ ++ + DBG_871X( "[%s] Got invite response frame!\n", __FUNCTION__ ); + _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); + if ( (p2p_ie=rtw_get_p2p_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen)) ) + { + rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, &attr_content, &attr_contentlen); -+ ++ + if ( attr_contentlen == 1 ) + { + DBG_871X( "[%s] Status = %d\n", __FUNCTION__, attr_content ); -+ pwdinfo->invitereq_info.benable = _FALSE; ++ pwdinfo->invitereq_info.benable = false; + + if ( attr_content == P2P_STATUS_SUCCESS ) + { -+ if (_rtw_memcmp(pwdinfo->invitereq_info.go_bssid, adapter_mac_addr(padapter), ETH_ALEN)) ++ if ( _rtw_memcmp( pwdinfo->invitereq_info.go_bssid, myid( &padapter->eeprompriv ), ETH_ALEN )) ++ { + rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO ); ++ } + else ++ { + rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ ++ } + rtw_p2p_set_state( pwdinfo, P2P_STATE_RX_INVITE_RESP_OK ); + } + else @@ -39004,14 +25083,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + //Add the following statement to avoid receiving duplicate prov disc req. such that pre_p2p_state would be covered. + if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ)) + rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ ++ + rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ); + _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT ); +#ifdef CONFIG_INTEL_WIDI -+ if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) { ++ if( (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) && (padapter->mlmepriv.widi_state != INTEL_WIDI_STATE_WFD_CONNECTION) ) ++ { + padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; + _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL, 0); ++ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL); + } +#endif //CONFIG_INTEL_WIDI + break; @@ -39030,33 +25110,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + } + } -+ -+ -+exit: -+ -+ if(merged_p2pie) -+ { -+ rtw_mfree(merged_p2pie, merged_p2p_ielen + 2); -+ } +#endif //CONFIG_P2P ++ + return _SUCCESS; +} + -+unsigned int on_action_public_vendor(union recv_frame *precv_frame) ++static unsigned int on_action_public_vendor(union recv_frame *precv_frame) +{ + unsigned int ret = _FAIL; + u8 *pframe = precv_frame->u.hdr.rx_data; + uint frame_len = precv_frame->u.hdr.len; + u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); + -+ if (_rtw_memcmp(frame_body + 2, P2P_OUI, 4) == _TRUE) { ++ if (_rtw_memcmp(frame_body + 2, P2P_OUI, 4) == true) { + ret = on_action_public_p2p(precv_frame); + } + + return ret; +} + -+unsigned int on_action_public_default(union recv_frame *precv_frame, u8 action) ++static unsigned int on_action_public_default(union recv_frame *precv_frame, u8 action) +{ + unsigned int ret = _FAIL; + u8 *pframe = precv_frame->u.hdr.rx_data; @@ -39078,7 +25151,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + #endif + + ret = _SUCCESS; -+ ++ +exit: + return ret; +} @@ -39092,24 +25165,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + u8 category, action; + + /* check RA matches or not */ -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) ++ if (!_rtw_memcmp(myid(&(padapter->eeprompriv)), GetAddr1Ptr(pframe), ETH_ALEN)) + goto exit; + + category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_PUBLIC) ++ if(category != RTW_WLAN_CATEGORY_PUBLIC) + goto exit; + + action = frame_body[1]; + switch (action) { -+ case ACT_PUBLIC_BSSCOEXIST: -+#ifdef CONFIG_80211N_HT -+#ifdef CONFIG_AP_MODE -+ /*20/40 BSS Coexistence Management frame is a Public Action frame*/ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) -+ rtw_process_public_act_bsscoex(padapter, pframe, frame_len); -+#endif /*CONFIG_AP_MODE*/ -+#endif /*CONFIG_80211N_HT*/ -+ break; + case ACT_PUBLIC_VENDOR: + ret = on_action_public_vendor(precv_frame); + break; @@ -39124,140 +25188,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +unsigned int OnAction_ht(_adapter *padapter, union recv_frame *precv_frame) +{ -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint frame_len = precv_frame->u.hdr.len; -+ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 category, action; -+ -+ /* check RA matches or not */ -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) -+ goto exit; -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_HT) -+ goto exit; -+ -+ action = frame_body[1]; -+ switch (action) { -+ case RTW_WLAN_ACTION_HT_SM_PS: -+#ifdef CONFIG_80211N_HT -+#ifdef CONFIG_AP_MODE -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) -+ rtw_process_ht_action_smps(padapter, GetAddr2Ptr(pframe), frame_body[2]); -+#endif /*CONFIG_AP_MODE*/ -+#endif /*CONFIG_80211N_HT*/ -+ break; -+ case RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING: -+#ifdef CONFIG_BEAMFORMING -+ /*DBG_871X("RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING\n");*/ -+ beamforming_get_report_frame(padapter, precv_frame); -+#endif /*CONFIG_BEAMFORMING*/ -+ break; -+ default: -+ break; -+ } -+ -+exit: -+ + return _SUCCESS; +} + -+#ifdef CONFIG_IEEE80211W -+unsigned int OnAction_sa_query(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u16 tid; -+ //Baron -+ -+ DBG_871X("OnAction_sa_query\n"); -+ -+ switch (pframe[WLAN_HDR_A3_LEN+1]) -+ { -+ case 0: //SA Query req -+ _rtw_memcpy(&tid, &pframe[WLAN_HDR_A3_LEN+2], sizeof(u16)); -+ DBG_871X("OnAction_sa_query request,action=%d, tid=%04x, pframe=%02x-%02x\n" -+ , pframe[WLAN_HDR_A3_LEN+1], tid, pframe[WLAN_HDR_A3_LEN+2], pframe[WLAN_HDR_A3_LEN+3]); -+ issue_action_SA_Query(padapter, GetAddr2Ptr(pframe), 1, tid, IEEE80211W_RIGHT_KEY); -+ break; -+ -+ case 1: //SA Query rsp -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta != NULL) -+ _cancel_timer_ex(&psta->dot11w_expire_timer); -+ -+ _rtw_memcpy(&tid, &pframe[WLAN_HDR_A3_LEN+2], sizeof(u16)); -+ DBG_871X("OnAction_sa_query response,action=%d, tid=%04x, cancel timer\n", pframe[WLAN_HDR_A3_LEN+1], tid); -+ break; -+ default: -+ break; -+ } -+ if(0) -+ { -+ int pp; -+ printk("pattrib->pktlen = %d =>", pattrib->pkt_len); -+ for(pp=0;pp< pattrib->pkt_len; pp++) -+ printk(" %02x ", pframe[pp]); -+ printk("\n"); -+ } -+ -+ return _SUCCESS; -+} -+#endif //CONFIG_IEEE80211W -+ +unsigned int OnAction_wmm(_adapter *padapter, union recv_frame *precv_frame) +{ + return _SUCCESS; +} + -+unsigned int OnAction_vht(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_80211AC_VHT -+ struct rx_pkt_attrib *prxattrib = &precv_frame->u.hdr.attrib; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint frame_len = precv_frame->u.hdr.len; -+ struct rtw_ieee80211_hdr_3addr *whdr = (struct rtw_ieee80211_hdr_3addr *)pframe; -+ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 category, action; -+ struct sta_info *psta = NULL; -+ -+ /* check RA matches or not */ -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) -+ goto exit; -+ -+ category = frame_body[0]; -+ if(category != RTW_WLAN_CATEGORY_VHT) -+ goto exit; -+ -+ action = frame_body[1]; -+ switch (action) { -+ case RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING: -+#ifdef CONFIG_BEAMFORMING -+ /*DBG_871X("RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING\n");*/ -+ beamforming_get_report_frame(padapter, precv_frame); -+#endif /*CONFIG_BEAMFORMING*/ -+ break; -+ case RTW_WLAN_ACTION_VHT_OPMODE_NOTIFICATION: -+ // CategoryCode(1) + ActionCode(1) + OpModeNotification(1) -+ //DBG_871X("RTW_WLAN_ACTION_VHT_OPMODE_NOTIFICATION\n"); -+ psta = rtw_get_stainfo(&padapter->stapriv, whdr->addr2); -+ if (psta) -+ rtw_process_vht_op_mode_notify(padapter, &frame_body[2], psta); -+ break; -+ default: -+ break; -+ } -+ -+exit: -+#endif //CONFIG_80211AC_VHT -+ -+ return _SUCCESS; -+} -+ +unsigned int OnAction_p2p(_adapter *padapter, union recv_frame *precv_frame) +{ +#ifdef CONFIG_P2P @@ -39267,8 +25205,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + uint len = precv_frame->u.hdr.len; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + ++ ++ DBG_871X("%s\n", __FUNCTION__); ++ + //check RA matches or not -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) ++ if (!_rtw_memcmp(myid(&(padapter->eeprompriv)), GetAddr1Ptr(pframe), ETH_ALEN))//for if1, sta/ap mode + return _SUCCESS; + + frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); @@ -39277,13 +25218,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if(category != RTW_WLAN_CATEGORY_P2P) + return _SUCCESS; + -+ if ( cpu_to_be32( *( ( u32* ) ( frame_body + 1 ) ) ) != P2POUI ) ++ if (be32_to_cpu(*((__be32 *)(frame_body + 1))) != P2POUI ) + return _SUCCESS; + +#ifdef CONFIG_IOCTL_CFG80211 -+ if (adapter_wdev_data(padapter)->p2p_enabled -+ && pwdinfo->driver_interface == DRIVER_CFG80211 -+ ) { ++ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ { + rtw_cfg80211_rx_action_p2p(padapter, pframe, len); + return _SUCCESS; + } @@ -39297,26 +25237,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + switch(OUI_Subtype) + { + case P2P_NOTICE_OF_ABSENCE: -+ ++ + break; -+ ++ + case P2P_PRESENCE_REQUEST: + -+ process_p2p_presence_req(pwdinfo, pframe, len); -+ ++ process_p2p_presence_req(pwdinfo, pframe, len); ++ + break; -+ ++ + case P2P_PRESENCE_RESPONSE: -+ ++ + break; -+ ++ + case P2P_GO_DISC_REQUEST: -+ ++ + break; -+ ++ + default: + break; -+ ++ + } + } +#endif //CONFIG_P2P @@ -39331,19 +25271,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + unsigned char category; + struct action_handler *ptable; + unsigned char *frame_body; -+ u8 *pframe = precv_frame->u.hdr.rx_data; ++ u8 *pframe = precv_frame->u.hdr.rx_data; + + frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ ++ + category = frame_body[0]; -+ -+ for(i = 0; i < sizeof(OnAction_tbl)/sizeof(struct action_handler); i++) ++ ++ for(i = 0; i < sizeof(OnAction_tbl)/sizeof(struct action_handler); i++) + { + ptable = &OnAction_tbl[i]; -+ ++ + if(category == ptable->num) + ptable->func(padapter, precv_frame); -+ ++ + } + + return _SUCCESS; @@ -39357,7 +25297,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return _SUCCESS; +} + -+struct xmit_frame *_alloc_mgtxmitframe(struct xmit_priv *pxmitpriv, bool once) ++static struct xmit_frame *_alloc_mgtxmitframe(struct xmit_priv *pxmitpriv, bool once) +{ + struct xmit_frame *pmgntframe; + struct xmit_buf *pxmitbuf; @@ -39391,12 +25331,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +inline struct xmit_frame *alloc_mgtxmitframe(struct xmit_priv *pxmitpriv) +{ -+ return _alloc_mgtxmitframe(pxmitpriv, _FALSE); ++ return _alloc_mgtxmitframe(pxmitpriv, false); +} + +inline struct xmit_frame *alloc_mgtxmitframe_once(struct xmit_priv *pxmitpriv) +{ -+ return _alloc_mgtxmitframe(pxmitpriv, _TRUE); ++ return _alloc_mgtxmitframe(pxmitpriv, true); +} + + @@ -39418,25 +25358,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +{ + u8 wireless_mode; + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *pbcmc_sta = NULL; -+ //_rtw_memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib)); + -+ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); ++ //_rtw_memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib)); + + pattrib->hdrlen = 24; + pattrib->nr_frags = 1; + pattrib->priority = 7; -+ -+ if (pbcmc_sta) -+ pattrib->mac_id = pbcmc_sta->mac_id; -+ else { -+ pattrib->mac_id = 0; -+ DBG_871X("mgmt use mac_id 0 will affect RA\n"); -+ } -+ pattrib->qsel = QSLT_MGNT; ++ pattrib->mac_id = 0; ++ pattrib->qsel = 0x12; + + pattrib->pktlen = 0; + @@ -39445,29 +25374,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + else + wireless_mode = WIRELESS_11G; + pattrib->raid = rtw_get_mgntframe_raid(padapter, wireless_mode); -+ pattrib->rate = pmlmeext->tx_rate; + + pattrib->encrypt = _NO_PRIVACY_; -+ pattrib->bswenc = _FALSE; ++ pattrib->bswenc = false; + -+ pattrib->qos_en = _FALSE; -+ pattrib->ht_en = _FALSE; ++ pattrib->qos_en = false; ++ pattrib->ht_en = false; + pattrib->bwmode = CHANNEL_WIDTH_20; + pattrib->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ pattrib->sgi = _FALSE; ++ pattrib->sgi = false; + + pattrib->seqnum = pmlmeext->mgnt_seq; + -+ pattrib->retry_ctrl = _TRUE; ++ pattrib->retry_ctrl = true; + + pattrib->mbssid = 0; -+ pattrib->hw_ssn_sel = pxmitpriv->hw_ssn_seq_no; -+ -+ #ifdef CONFIG_BEAMFORMING -+ psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ if (psta) -+ update_attrib_txbf_info(padapter, pattrib, psta); -+ #endif + +} + @@ -39484,11 +25405,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +void dump_mgntframe(_adapter *padapter, struct xmit_frame *pmgntframe) +{ -+ if (RTW_CANNOT_RUN(padapter)) { -+ rtw_free_xmitbuf(&padapter->xmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(&padapter->xmitpriv, pmgntframe); ++ if(padapter->bSurpriseRemoved == true || ++ padapter->bDriverStopped == true) + return; -+ } + + rtw_hal_mgnt_xmit(padapter, pmgntframe); +} @@ -39497,15 +25416,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +{ + s32 ret = _FAIL; + _irqL irqL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + struct xmit_buf *pxmitbuf = pmgntframe->pxmitbuf; + struct submit_ctx sctx; + -+ if (RTW_CANNOT_RUN(padapter)) { -+ rtw_free_xmitbuf(&padapter->xmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(&padapter->xmitpriv, pmgntframe); ++ if(padapter->bSurpriseRemoved == true || ++ padapter->bDriverStopped == true) + return ret; -+ } + + rtw_sctx_init(&sctx, timeout_ms); + pxmitbuf->sctx = &sctx; @@ -39513,7 +25430,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + ret = rtw_hal_mgnt_xmit(padapter, pmgntframe); + + if (ret == _SUCCESS) -+ ret = rtw_sctx_wait(&sctx, __func__); ++ ret = rtw_sctx_wait(&sctx); + + _enter_critical(&pxmitpriv->lock_sctx, &irqL); + pxmitbuf->sctx = NULL; @@ -39525,7 +25442,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +s32 dump_mgntframe_and_wait_ack(_adapter *padapter, struct xmit_frame *pmgntframe) +{ +#ifdef CONFIG_XMIT_ACK -+ static u8 seq_no = 0; + s32 ret = _FAIL; + u32 timeout_ms = 500;// 500ms + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; @@ -39534,26 +25450,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pxmitpriv = &(padapter->pbuddy_adapter->xmitpriv); + #endif + -+ if (RTW_CANNOT_RUN(padapter)) { -+ rtw_free_xmitbuf(&padapter->xmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(&padapter->xmitpriv, pmgntframe); ++ if(padapter->bSurpriseRemoved == true || ++ padapter->bDriverStopped == true) + return -1; -+ } + + _enter_critical_mutex(&pxmitpriv->ack_tx_mutex, NULL); -+ pxmitpriv->ack_tx = _TRUE; -+ pxmitpriv->seq_no = seq_no++; ++ pxmitpriv->ack_tx = true; ++ + pmgntframe->ack_report = 1; -+ rtw_sctx_init(&(pxmitpriv->ack_tx_ops), timeout_ms); + if (rtw_hal_mgnt_xmit(padapter, pmgntframe) == _SUCCESS) { -+#ifdef CONFIG_XMIT_ACK_POLLING -+ ret = rtw_ack_tx_polling(pxmitpriv, timeout_ms); -+#else -+ ret = rtw_sctx_wait(&(pxmitpriv->ack_tx_ops), __func__); -+#endif ++ ret = rtw_ack_tx_wait(pxmitpriv, timeout_ms); + } + -+ pxmitpriv->ack_tx = _FALSE; ++ pxmitpriv->ack_tx = false; + _exit_critical_mutex(&pxmitpriv->ack_tx_mutex, NULL); + + return ret; @@ -39561,19 +25470,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + dump_mgntframe(padapter, pmgntframe); + rtw_msleep_os(50); + return _SUCCESS; -+#endif //!CONFIG_XMIT_ACK ++#endif //!CONFIG_XMIT_ACK +} + -+int update_hidden_ssid(u8 *ies, u32 ies_len, u8 hidden_ssid_mode) ++static int update_hidden_ssid(u8 *ies, u32 ies_len, u8 hidden_ssid_mode) +{ + u8 *ssid_ie; + sint ssid_len_ori; + int len_diff = 0; -+ ++ + ssid_ie = rtw_get_ie(ies, WLAN_EID_SSID, &ssid_len_ori, ies_len); + + //DBG_871X("%s hidden_ssid_mode:%u, ssid_ie:%p, ssid_len_ori:%d\n", __FUNCTION__, hidden_ssid_mode, ssid_ie, ssid_len_ori); -+ ++ + if(ssid_ie && ssid_len_ori>0) + { + switch(hidden_ssid_mode) @@ -39582,15 +25491,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + u8 *next_ie = ssid_ie + 2 + ssid_len_ori; + u32 remain_len = 0; -+ ++ + remain_len = ies_len -(next_ie-ies); -+ -+ ssid_ie[1] = 0; ++ ++ ssid_ie[1] = 0; + _rtw_memcpy(ssid_ie+2, next_ie, remain_len); + len_diff -= ssid_len_ori; -+ ++ + break; -+ } ++ } + case 2: + _rtw_memset(&ssid_ie[2], 0, ssid_len_ori); + break; @@ -39608,7 +25517,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + unsigned int rate_len; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); +#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) @@ -39617,7 +25526,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#endif //#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; +#ifdef CONFIG_P2P + struct wifidirect_info *pwdinfo = &(padapter->wdinfo); @@ -39626,11 +25535,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + //DBG_871X("%s\n", __FUNCTION__); + -+#ifdef CONFIG_BCN_ICF -+ if ((pmgntframe = rtw_alloc_bcnxmitframe(pxmitpriv)) == NULL) -+#else + if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+#endif + { + DBG_871X("%s, alloc mgnt frame fail\n", __FUNCTION__); + return; @@ -39642,46 +25547,46 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + //update attribute + pattrib = &pmgntframe->attrib; + update_mgntframe_attrib(padapter, pattrib); -+ pattrib->qsel = QSLT_BEACON; ++ pattrib->qsel = 0x10; + #ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->iface_type == IFACE_PORT1) ++ if(padapter->iface_type == IFACE_PORT1) + pattrib->mbssid = 1; -+ #endif -+ ++ #endif ++ + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ ++ + pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ + fctrl = &(pwlanhdr->frame_ctl); + *(fctrl) = 0; -+ ++ + _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); + + SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); + //pmlmeext->mgnt_seq++; + SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); + pattrib->pktlen = sizeof (struct rtw_ieee80211_hdr_3addr); -+ ++ + if( (pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) + { + //DBG_871X("ie len=%d\n", cur_network->IELength); +#ifdef CONFIG_P2P + // for P2P : Primary Device Type & Device Name + u32 wpsielen=0, insert_len=0; -+ u8 *wpsie=NULL; ++ u8 *wpsie=NULL; + wpsie = rtw_get_wps_ie(cur_network->IEs+_FIXED_IE_LENGTH_, cur_network->IELength-_FIXED_IE_LENGTH_, NULL, &wpsielen); -+ ++ + if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && wpsie && wpsielen>0) + { + uint wps_offset, remainder_ielen; + u8 *premainder_ie, *pframe_wscie; -+ ++ + wps_offset = (uint)(wpsie - cur_network->IEs); + + premainder_ie = wpsie + wpsielen; @@ -39689,7 +25594,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + remainder_ielen = cur_network->IELength - wps_offset - wpsielen; + +#ifdef CONFIG_IOCTL_CFG80211 -+ if(adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) + { + if(pmlmepriv->wps_beacon_ie && pmlmepriv->wps_beacon_ie_len>0) + { @@ -39703,7 +25608,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + //copy remainder_ie to pframe + _rtw_memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; ++ pframe += remainder_ielen; + pattrib->pktlen += remainder_ielen; + } + else @@ -39717,41 +25622,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#endif //CONFIG_IOCTL_CFG80211 + { + pframe_wscie = pframe + wps_offset; -+ _rtw_memcpy(pframe, cur_network->IEs, wps_offset+wpsielen); -+ pframe += (wps_offset + wpsielen); ++ _rtw_memcpy(pframe, cur_network->IEs, wps_offset+wpsielen); ++ pframe += (wps_offset + wpsielen); + pattrib->pktlen += (wps_offset + wpsielen); + + //now pframe is end of wsc ie, insert Primary Device Type & Device Name + // Primary Device Type + // Type: -+ *(u16*) ( pframe + insert_len) = cpu_to_be16( WPS_ATTR_PRIMARY_DEV_TYPE ); ++ *(__be16*) ( pframe + insert_len) = cpu_to_be16( WPS_ATTR_PRIMARY_DEV_TYPE ); + insert_len += 2; -+ ++ + // Length: -+ *(u16*) ( pframe + insert_len ) = cpu_to_be16( 0x0008 ); ++ *(__be16*) ( pframe + insert_len ) = cpu_to_be16( 0x0008 ); + insert_len += 2; -+ ++ + // Value: + // Category ID -+ *(u16*) ( pframe + insert_len ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); ++ *(__be16*) ( pframe + insert_len ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); + insert_len += 2; + + // OUI -+ *(u32*) ( pframe + insert_len ) = cpu_to_be32( WPSOUI ); ++ *(__be32*) ( pframe + insert_len ) = cpu_to_be32( WPSOUI ); + insert_len += 4; + + // Sub Category ID -+ *(u16*) ( pframe + insert_len ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); ++ *(__be16*) ( pframe + insert_len ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); + insert_len += 2; + + + // Device Name + // Type: -+ *(u16*) ( pframe + insert_len ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); ++ *(__be16*) ( pframe + insert_len ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); + insert_len += 2; + + // Length: -+ *(u16*) ( pframe + insert_len ) = cpu_to_be16( pwdinfo->device_name_len ); ++ *(__be16*) ( pframe + insert_len ) = cpu_to_be16( pwdinfo->device_name_len ); + insert_len += 2; + + // Value: @@ -39768,7 +25673,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + //copy remainder_ie to pframe + _rtw_memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; ++ pframe += remainder_ielen; + pattrib->pktlen += remainder_ielen; + } + } @@ -39806,10 +25711,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + u32 len; +#ifdef CONFIG_IOCTL_CFG80211 -+ if(adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) + { + len = pmlmepriv->p2p_beacon_ie_len; -+ if(pmlmepriv->p2p_beacon_ie && len>0) ++ if(pmlmepriv->p2p_beacon_ie && len>0) + _rtw_memcpy(pframe, pmlmepriv->p2p_beacon_ie, len); + } + else @@ -39822,21 +25727,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pattrib->pktlen += len; +#ifdef CONFIG_WFD +#ifdef CONFIG_IOCTL_CFG80211 -+ if(_TRUE == pwdinfo->wfd_info->wfd_enable) ++ if(true == pwdinfo->wfd_info->wfd_enable) +#endif //CONFIG_IOCTL_CFG80211 + { + len = build_beacon_wfd_ie( pwdinfo, pframe ); + } +#ifdef CONFIG_IOCTL_CFG80211 + else -+ { ++ { + len = 0; + if(pmlmepriv->wfd_beacon_ie && pmlmepriv->wfd_beacon_ie_len>0) + { + len = pmlmepriv->wfd_beacon_ie_len; -+ _rtw_memcpy(pframe, pmlmepriv->wfd_beacon_ie, len); ++ _rtw_memcpy(pframe, pmlmepriv->wfd_beacon_ie, len); + } -+ } ++ } +#endif //CONFIG_IOCTL_CFG80211 + pframe += len; + pattrib->pktlen += len; @@ -39856,7 +25761,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // beacon interval: 2 bytes + -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); + + pframe += 2; + pattrib->pktlen += 2; @@ -39889,7 +25794,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + //ERP IE + pframe = rtw_set_ie(pframe, _ERPINFO_IE_, 1, &erpinfo, &pattrib->pktlen); -+ } ++ } + + + // EXTERNDED SUPPORTED RATE @@ -39904,9 +25809,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +_issue_bcn: + +#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ pmlmepriv->update_bcn = _FALSE; -+ -+ _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); ++ pmlmepriv->update_bcn = false; ++ ++ _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); +#endif //#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) + + if ((pattrib->pktlen + TXDESC_SIZE) > 512) @@ -39914,7 +25819,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + DBG_871X("beacon frame too large\n"); + return; + } -+ ++ + pattrib->last_txcmdsz = pattrib->pktlen; + + //DBG_871X("issue bcn_sz=%d\n", pattrib->last_txcmdsz); @@ -39931,7 +25836,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + unsigned char *mac, *bssid; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); +#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) @@ -39941,7 +25846,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#endif //#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + unsigned int rate_len; +#ifdef CONFIG_P2P + struct wifidirect_info *pwdinfo = &(padapter->wdinfo); @@ -39955,9 +25860,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if(da == NULL) + return; + -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ return; -+ + if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) + { + DBG_871X("%s, alloc mgnt frame fail\n", __FUNCTION__); @@ -39967,16 +25869,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + //update attribute + pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ ++ update_mgntframe_attrib(padapter, pattrib); ++ + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ ++ + pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = adapter_mac_addr(padapter); ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ mac = myid(&(padapter->eeprompriv)); + bssid = cur_network->MacAddress; -+ ++ + fctrl = &(pwlanhdr->frame_ctl); + *(fctrl) = 0; + _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); @@ -39986,7 +25888,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); + pmlmeext->mgnt_seq++; + SetFrameSubType(fctrl, WIFI_PROBERSP); -+ ++ + pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); + pattrib->pktlen = pattrib->hdrlen; + pframe += pattrib->hdrlen; @@ -39994,41 +25896,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + if(cur_network->IELength>MAX_IE_SZ) + return; -+ ++ +#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) + if( (pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) + { + pwps_ie = rtw_get_wps_ie(cur_network->IEs+_FIXED_IE_LENGTH_, cur_network->IELength-_FIXED_IE_LENGTH_, NULL, &wps_ielen); -+ ++ + //inerset & update wps_probe_resp_ie + if((pmlmepriv->wps_probe_resp_ie!=NULL) && pwps_ie && (wps_ielen>0)) + { + uint wps_offset, remainder_ielen; -+ u8 *premainder_ie; -+ ++ u8 *premainder_ie; ++ + wps_offset = (uint)(pwps_ie - cur_network->IEs); + + premainder_ie = pwps_ie + wps_ielen; + + remainder_ielen = cur_network->IELength - wps_offset - wps_ielen; + -+ _rtw_memcpy(pframe, cur_network->IEs, wps_offset); -+ pframe += wps_offset; -+ pattrib->pktlen += wps_offset; ++ _rtw_memcpy(pframe, cur_network->IEs, wps_offset); ++ pframe += wps_offset; ++ pattrib->pktlen += wps_offset; + + wps_ielen = (uint)pmlmepriv->wps_probe_resp_ie[1];//to get ie data len + if((wps_offset+wps_ielen+2)<=MAX_IE_SZ) + { + _rtw_memcpy(pframe, pmlmepriv->wps_probe_resp_ie, wps_ielen+2); -+ pframe += wps_ielen+2; -+ pattrib->pktlen += wps_ielen+2; ++ pframe += wps_ielen+2; ++ pattrib->pktlen += wps_ielen+2; + } + + if((wps_offset+wps_ielen+2+remainder_ielen)<=MAX_IE_SZ) + { + _rtw_memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; -+ pattrib->pktlen += remainder_ielen; ++ pframe += remainder_ielen; ++ pattrib->pktlen += remainder_ielen; + } + } + else @@ -40057,8 +25959,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + remainder_ie = ssid_ie+2; + remainder_ielen = (pframe-remainder_ie); + ++ DBG_871X_LEVEL(_drv_warning_, FUNC_ADPT_FMT" remainder_ielen > MAX_IE_SZ\n", FUNC_ADPT_ARG(padapter)); + if (remainder_ielen > MAX_IE_SZ) { -+ DBG_871X_LEVEL(_drv_warning_, FUNC_ADPT_FMT" remainder_ielen > MAX_IE_SZ\n", FUNC_ADPT_ARG(padapter)); + remainder_ielen = MAX_IE_SZ; + } + @@ -40071,18 +25973,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pattrib->pktlen += ssid_ielen_diff; + } + } -+ } -+ else -+#endif ++ } ++ else ++#endif + { -+ ++ + //timestamp will be inserted by hardware + pframe += 8; + pattrib->pktlen += 8; + + // beacon interval: 2 bytes + -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); + + pframe += 2; + pattrib->pktlen += 2; @@ -40119,7 +26021,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = rtw_set_ie(pframe, _ERPINFO_IE_, 1, &erpinfo, &pattrib->pktlen); + } + -+ ++ + // EXTERNDED SUPPORTED RATE + if (rate_len > 8) + { @@ -40129,16 +26031,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + //todo:HT for adhoc + -+ } ++ } + +#ifdef CONFIG_P2P -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) -+ /* IOT issue, When wifi_spec is not set, send probe_resp with P2P IE even if probe_req has no P2P IE */ -+ && (is_valid_p2p_probereq || !padapter->registrypriv.wifi_spec)) ++ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && is_valid_p2p_probereq) + { + u32 len; +#ifdef CONFIG_IOCTL_CFG80211 -+ if(adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) + { + //if pwdinfo->role == P2P_ROLE_DEVICE will call issue_probersp_p2p() + len = pmlmepriv->p2p_go_probe_resp_ie_len; @@ -40153,25 +26053,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + pframe += len; + pattrib->pktlen += len; -+ ++ +#ifdef CONFIG_WFD +#ifdef CONFIG_IOCTL_CFG80211 -+ if(_TRUE == pwdinfo->wfd_info->wfd_enable) ++ if(true == pwdinfo->wfd_info->wfd_enable) +#endif //CONFIG_IOCTL_CFG80211 + { + len = build_probe_resp_wfd_ie(pwdinfo, pframe, 0); + } +#ifdef CONFIG_IOCTL_CFG80211 + else -+ { ++ { + len = 0; + if(pmlmepriv->wfd_probe_resp_ie && pmlmepriv->wfd_probe_resp_ie_len>0) + { + len = pmlmepriv->wfd_probe_resp_ie_len; -+ _rtw_memcpy(pframe, pmlmepriv->wfd_probe_resp_ie, len); -+ } ++ _rtw_memcpy(pframe, pmlmepriv->wfd_probe_resp_ie, len); ++ } + } -+#endif //CONFIG_IOCTL_CFG80211 ++#endif //CONFIG_IOCTL_CFG80211 + pframe += len; + pattrib->pktlen += len; +#endif //CONFIG_WFD @@ -40194,7 +26094,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + u8 RC_OUI[4]={0x00,0xE0,0x4C,0x0A}; + u8 RC_INFO[14] = {0}; + //EID[1] + EID_LEN[1] + RC_OUI[4] + MAC[6] + PairingID[2] + ChannelNum[2] -+ u16 cu_ch = (u16)cur_network->Configuration.DSConfig; ++ u16 cu_ch = le16_to_cpu(cur_network->Configuration.DSConfig) + + DBG_871X("%s, reply rc(pid=0x%x) device "MAC_FMT" in ch=%d\n", __FUNCTION__, + psta->pid, MAC_ARG(psta->hwaddr), cu_ch); @@ -40212,22 +26112,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + + pattrib->last_txcmdsz = pattrib->pktlen; -+ ++ + + dump_mgntframe(padapter, pmgntframe); -+ ++ + return; + +} + -+int _issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, bool append_wps, int wait_ack) ++static int _issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, int wait_ack) +{ + int ret = _FAIL; + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + unsigned char *mac; + unsigned char bssrate[NumRates]; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); @@ -40237,8 +26137,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + int bssrate_len = 0; + u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; + -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ goto exit; ++ RT_TRACE(_module_rtl871x_mlme_c_,_drv_notice_,("+issue_probereq\n")); + + if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) + { @@ -40255,7 +26154,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + -+ mac = adapter_mac_addr(padapter); ++ mac = myid(&(padapter->eeprompriv)); + + fctrl = &(pwlanhdr->frame_ctl); + *(fctrl) = 0; @@ -40299,19 +26198,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); + } + -+ if (ch) -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, &ch, &pattrib->pktlen); -+ -+ if (append_wps) { -+ //add wps_ie for wps2.0 -+ if(pmlmepriv->wps_probe_req_ie_len>0 && pmlmepriv->wps_probe_req_ie) -+ { -+ _rtw_memcpy(pframe, pmlmepriv->wps_probe_req_ie, pmlmepriv->wps_probe_req_ie_len); -+ pframe += pmlmepriv->wps_probe_req_ie_len; -+ pattrib->pktlen += pmlmepriv->wps_probe_req_ie_len; -+ //pmlmepriv->wps_probe_req_ie_len = 0 ;//reset to zero -+ } ++#if 0 ++ //add wps_ie for wps2.0 ++ if(pmlmepriv->probereq_wpsie_len>0 && pmlmepriv->probereq_wpsie_lenprobereq_wpsie, pmlmepriv->probereq_wpsie_len); ++ pframe += pmlmepriv->probereq_wpsie_len; ++ pattrib->pktlen += pmlmepriv->probereq_wpsie_len; ++ //pmlmepriv->probereq_wpsie_len = 0 ;//reset to zero + } ++#else ++ //add wps_ie for wps2.0 ++ if(pmlmepriv->wps_probe_req_ie_len>0 && pmlmepriv->wps_probe_req_ie) ++ { ++ _rtw_memcpy(pframe, pmlmepriv->wps_probe_req_ie, pmlmepriv->wps_probe_req_ie_len); ++ pframe += pmlmepriv->wps_probe_req_ie_len; ++ pattrib->pktlen += pmlmepriv->wps_probe_req_ie_len; ++ //pmlmepriv->wps_probe_req_ie_len = 0 ;//reset to zero ++ } ++#endif + + pattrib->last_txcmdsz = pattrib->pktlen; + @@ -40330,31 +26235,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +inline void issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da) +{ -+ _issue_probereq(padapter, pssid, da, 0, 1, _FALSE); ++ _issue_probereq(padapter, pssid, da, false); +} + -+/* -+ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ * try_cnt means the maximal TX count to try -+ */ -+int issue_probereq_ex(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, bool append_wps, ++int issue_probereq_ex(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, + int try_cnt, int wait_ms) +{ -+ int ret = _FAIL; ++ int ret; + int i = 0; + u32 start = rtw_get_current_time(); + -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ goto exit; -+ + do + { -+ ret = _issue_probereq(padapter, pssid, da, ch, append_wps, wait_ms>0?_TRUE:_FALSE); ++ ret = _issue_probereq(padapter, pssid, da, wait_ms>0?true:false); + + i++; + -+ if (RTW_CANNOT_RUN(padapter)) ++ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) + break; + + if(i < try_cnt && wait_ms > 0 && ret==_FAIL) @@ -40390,17 +26287,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned int val32; ++ __le16 *fctrl; ++ __le32 val32; + unsigned short val16; ++ __le16 le_tmp; + int use_shared_key = 0; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ return; -+ + if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) + { + return; @@ -40430,11 +26325,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { +#ifdef CONFIG_NATIVEAP_MLME + -+ _rtw_memcpy(pwlanhdr->addr1, psta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr1, psta->hwaddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ + -+ + // setting auth algo number + val16 = (u16)psta->authalg; + @@ -40442,21 +26337,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + val16 = 0; + + if (val16) { -+ val16 = cpu_to_le16(val16); ++ le_tmp = cpu_to_le16(val16); + use_shared_key = 1; ++ } else { ++ le_tmp = 0; + } -+ -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_ALGM_NUM_, (unsigned char *)&val16, &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, _AUTH_ALGM_NUM_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); + + // setting auth seq number + val16 =(u16)psta->auth_seq; -+ val16 = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_SEQ_NUM_, (unsigned char *)&val16, &(pattrib->pktlen)); ++ le_tmp = cpu_to_le16(val16); ++ pframe = rtw_set_fixed_ie(pframe, _AUTH_SEQ_NUM_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); + + // setting status code... + val16 = status; -+ val16 = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&val16, &(pattrib->pktlen)); ++ le_tmp = cpu_to_le16(val16); ++ pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); + + // added challenging text... + if ((psta->auth_seq == 2) && (psta->state & WIFI_FW_AUTH_STATE) && (use_shared_key==1)) @@ -40466,42 +26362,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#endif + } + else -+ { ++ { + _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&padapter->eeprompriv), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ -+ // setting auth algo number ++ ++ // setting auth algo number + val16 = (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared)? 1: 0;// 0:OPEN System, 1:Shared key + if (val16) { -+ val16 = cpu_to_le16(val16); ++ le_tmp = cpu_to_le16(val16); + use_shared_key = 1; -+ } -+ //DBG_871X("%s auth_algo= %s auth_seq=%d\n",__FUNCTION__,(pmlmeinfo->auth_algo==0)?"OPEN":"SHARED",pmlmeinfo->auth_seq); -+ ++ } else { ++ le_tmp = 0; ++ } + //setting IV for auth seq #3 + if ((pmlmeinfo->auth_seq == 3) && (pmlmeinfo->state & WIFI_FW_AUTH_STATE) && (use_shared_key==1)) + { + //DBG_871X("==> iv(%d),key_index(%d)\n",pmlmeinfo->iv,pmlmeinfo->key_index); -+ val32 = ((pmlmeinfo->iv++) | (pmlmeinfo->key_index << 30)); -+ val32 = cpu_to_le32(val32); ++ val32 = cpu_to_le32(((pmlmeinfo->iv++) | (pmlmeinfo->key_index << 30))); + pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *)&val32, &(pattrib->pktlen)); + + pattrib->iv_len = 4; + } + -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_ALGM_NUM_, (unsigned char *)&val16, &(pattrib->pktlen)); -+ ++ pframe = rtw_set_fixed_ie(pframe, _AUTH_ALGM_NUM_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); ++ + // setting auth seq number + val16 = pmlmeinfo->auth_seq; -+ val16 = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_SEQ_NUM_, (unsigned char *)&val16, &(pattrib->pktlen)); ++ le_tmp = cpu_to_le16(val16); ++ pframe = rtw_set_fixed_ie(pframe, _AUTH_SEQ_NUM_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); ++ + -+ + // setting status code... + val16 = status; -+ val16 = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&val16, &(pattrib->pktlen)); ++ le_tmp = cpu_to_le16(val16); ++ pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); + + // then checking to see if sending challenging text... + if ((pmlmeinfo->auth_seq == 3) && (pmlmeinfo->state & WIFI_FW_AUTH_STATE) && (use_shared_key==1)) @@ -40509,17 +26404,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = rtw_set_ie(pframe, _CHLGETXT_IE_, 128, pmlmeinfo->chg_txt, &(pattrib->pktlen)); + + SetPrivacy(fctrl); -+ -+ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ ++ ++ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ + pattrib->encrypt = _WEP40_; + + pattrib->icv_len = 4; -+ -+ pattrib->pktlen += pattrib->icv_len; -+ ++ ++ pattrib->pktlen += pattrib->icv_len; ++ + } -+ ++ + } + + pattrib->last_txcmdsz = pattrib->pktlen; @@ -40539,14 +26434,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct rtw_ieee80211_hdr *pwlanhdr; + struct pkt_attrib *pattrib; + unsigned char *pbuf, *pframe; -+ unsigned short val, ie_status; -+ unsigned short *fctrl; ++ unsigned short val; ++ __le16 *fctrl, le_tmp; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ u8 *ie = pnetwork->IEs; ++ u8 *ie = pnetwork->IEs; +#ifdef CONFIG_P2P + struct wifidirect_info *pwdinfo = &(padapter->wdinfo); +#ifdef CONFIG_WFD @@ -40555,9 +26450,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +#endif //CONFIG_P2P + -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ return; -+ + DBG_871X("%s\n", __FUNCTION__); + + if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) @@ -40579,14 +26471,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + *(fctrl) = 0; + + _rtw_memcpy((void *)GetAddr1Ptr(pwlanhdr), pstat->hwaddr, ETH_ALEN); -+ _rtw_memcpy((void *)GetAddr2Ptr(pwlanhdr), adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy((void *)GetAddr2Ptr(pwlanhdr), myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy((void *)GetAddr3Ptr(pwlanhdr), get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); + pmlmeext->mgnt_seq++; + if ((pkt_type == WIFI_ASSOCRSP) || (pkt_type == WIFI_REASSOCRSP)) -+ SetFrameSubType(pwlanhdr, pkt_type); ++ SetFrameSubType(pwlanhdr, pkt_type); + else + return; + @@ -40599,39 +26491,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + pframe = rtw_set_fixed_ie(pframe, _CAPABILITY_ , (unsigned char *)&val, &(pattrib->pktlen)); + -+ ie_status = cpu_to_le16(status); -+ pframe = rtw_set_fixed_ie(pframe , _STATUS_CODE_ , (unsigned char *)&ie_status, &(pattrib->pktlen)); -+ -+ val = cpu_to_le16(pstat->aid | BIT(14) | BIT(15)); -+ pframe = rtw_set_fixed_ie(pframe, _ASOC_ID_ , (unsigned char *)&val, &(pattrib->pktlen)); ++ le_tmp = cpu_to_le16(status); ++ pframe = rtw_set_fixed_ie(pframe , _STATUS_CODE_ , (unsigned char *)&le_tmp, &(pattrib->pktlen)); ++ ++ le_tmp = cpu_to_le16(pstat->aid | BIT(14) | BIT(15)); ++ pframe = rtw_set_fixed_ie(pframe, _ASOC_ID_ , (unsigned char *)&le_tmp, &(pattrib->pktlen)); + + if (pstat->bssratelen <= 8) + { + pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, pstat->bssratelen, pstat->bssrateset, &(pattrib->pktlen)); -+ } -+ else ++ } ++ else + { + pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pstat->bssrateset, &(pattrib->pktlen)); + pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (pstat->bssratelen-8), pstat->bssrateset+8, &(pattrib->pktlen)); + } + -+#ifdef CONFIG_IEEE80211W -+ if (status == _STATS_REFUSED_TEMPORARILY_) { -+ u8 timeout_itvl[5]; -+ u32 timeout_interval = 3000; -+ /* Association Comeback time */ -+ timeout_itvl[0] = 0x03; -+ timeout_interval = cpu_to_le32(timeout_interval); -+ _rtw_memcpy(timeout_itvl+1, &timeout_interval, 4); -+ pframe = rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); -+ } -+#endif /* CONFIG_IEEE80211W */ -+ +#ifdef CONFIG_80211N_HT + if ((pstat->flags & WLAN_STA_HT) && (pmlmepriv->htpriv.ht_option)) + { + uint ie_len=0; -+ ++ + //FILL HT CAP INFO IE + //p = hostapd_eid_ht_capabilities_info(hapd, p); + pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); @@ -40651,26 +26531,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe += (ie_len+2); + pattrib->pktlen +=(ie_len+2); + } -+ -+ } ++ ++ } +#endif + -+ /*adding EXT_CAPAB_IE */ -+ if (pmlmepriv->ext_capab_ie_len > 0) { -+ uint ie_len = 0; -+ -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_CAP_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (pbuf && ie_len > 0) { -+ _rtw_memcpy(pframe, pbuf, ie_len+2); -+ pframe += (ie_len+2); -+ pattrib->pktlen += (ie_len+2); -+ } -+ } -+ +#ifdef CONFIG_80211AC_VHT -+ if ((pstat->flags & WLAN_STA_VHT) && (pmlmepriv->vhtpriv.vht_option) -+ && (pstat->wpa_pairwise_cipher != WPA_CIPHER_TKIP) -+ && (pstat->wpa2_pairwise_cipher != WPA_CIPHER_TKIP)) ++ if ((pstat->flags & WLAN_STA_VHT) && (pmlmepriv->vhtpriv.vht_option)) + { + u32 ie_len=0; + @@ -40698,26 +26564,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if ((pstat->flags & WLAN_STA_WME) && (pmlmepriv->qospriv.qos_option)) + { + uint ie_len=0; -+ unsigned char WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; -+ ++ unsigned char WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; ++ + for (pbuf = ie + _BEACON_IE_OFFSET_; ;pbuf+= (ie_len + 2)) -+ { -+ pbuf = rtw_get_ie(pbuf, _VENDOR_SPECIFIC_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); -+ if(pbuf && _rtw_memcmp(pbuf+2, WMM_PARA_IE, 6)) -+ { ++ { ++ pbuf = rtw_get_ie(pbuf, _VENDOR_SPECIFIC_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); ++ if(pbuf && _rtw_memcmp(pbuf+2, WMM_PARA_IE, 6)) ++ { + _rtw_memcpy(pframe, pbuf, ie_len+2); + pframe += (ie_len+2); + pattrib->pktlen +=(ie_len+2); -+ -+ break; ++ ++ break; + } -+ ++ + if ((pbuf == NULL) || (ie_len == 0)) + { + break; -+ } ++ } + } -+ ++ + } + + @@ -40730,7 +26596,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if(pmlmepriv->wps_assoc_resp_ie && pmlmepriv->wps_assoc_resp_ie_len>0) + { + _rtw_memcpy(pframe, pmlmepriv->wps_assoc_resp_ie, pmlmepriv->wps_assoc_resp_ie_len); -+ ++ + pframe += pmlmepriv->wps_assoc_resp_ie_len; + pattrib->pktlen += pmlmepriv->wps_assoc_resp_ie_len; + } @@ -40738,7 +26604,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_P2P + if( padapter->wdinfo.driver_interface == DRIVER_WEXT ) + { -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && (pstat->is_p2p_device == _TRUE)) ++ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && (pstat->is_p2p_device == true)) + { + u32 len; + @@ -40750,9 +26616,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } +#ifdef CONFIG_WFD + if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) -+#ifdef CONFIG_IOCTL_CFG80211 -+ && (_TRUE == pwdinfo->wfd_info->wfd_enable) -+#endif //CONFIG_IOCTL_CFG80211 ++#ifdef CONFIG_IOCTL_CFG80211 ++ && (true == pwdinfo->wfd_info->wfd_enable) ++#endif //CONFIG_IOCTL_CFG80211 + ) + { + wfdielen = build_assoc_resp_wfd_ie(pwdinfo, pframe); @@ -40763,9 +26629,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#endif //CONFIG_P2P + + pattrib->last_txcmdsz = pattrib->pktlen; -+ ++ + dump_mgntframe(padapter, pmgntframe); -+ ++ +#endif +} + @@ -40776,7 +26642,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct pkt_attrib *pattrib; + unsigned char *pframe, *p; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl, le_tmp; + unsigned short val16; + unsigned int i, j, ie_len, index=0; + unsigned char rf_type, bssrate[NumRates], sta_bssrate[NumRates]; @@ -40787,11 +26653,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + int bssrate_len = 0, sta_bssrate_len = 0; -+ u8 vs_ie_length = 0; ++ u8 cbw40_enable = 0; +#ifdef CONFIG_P2P + struct wifidirect_info *pwdinfo = &(padapter->wdinfo); + u8 p2pie[ 255 ] = { 0x00 }; -+ u16 p2pielen = 0; ++ u16 p2pielen = 0; +#ifdef CONFIG_WFD + u32 wfdielen = 0; +#endif //CONFIG_WFD @@ -40799,15 +26665,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +#ifdef CONFIG_DFS + u16 cap; -+ -+ /* Dot H */ -+ u8 pow_cap_ele[2] = { 0x00 }; -+ u8 sup_ch[ 30 * 2 ] = {0x00 }, sup_ch_idx = 0, idx_5g = 2; //For supported channel +#endif //CONFIG_DFS + -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ goto exit; -+ + if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) + goto exit; + @@ -40824,7 +26683,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + fctrl = &(pwlanhdr->frame_ctl); + *(fctrl) = 0; + _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); @@ -40838,7 +26697,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +#ifdef CONFIG_DFS + _rtw_memcpy(&cap, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); -+ cap |= cap_SpecMgmt; ++ cap |= BIT(8); + _rtw_memcpy(pframe, &cap, 2); +#else + _rtw_memcpy(pframe, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); @@ -40849,53 +26708,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + //listen interval + //todo: listen interval for power saving -+ val16 = cpu_to_le16(3); -+ _rtw_memcpy(pframe ,(unsigned char *)&val16, 2); ++ le_tmp = cpu_to_le16(3); ++ _rtw_memcpy(pframe ,(unsigned char *)&le_tmp, 2); + pframe += 2; + pattrib->pktlen += 2; + + //SSID + pframe = rtw_set_ie(pframe, _SSID_IE_, pmlmeinfo->network.Ssid.SsidLength, pmlmeinfo->network.Ssid.Ssid, &(pattrib->pktlen)); + -+#ifdef CONFIG_DFS -+ /* Dot H */ -+ if(pmlmeext->cur_channel > 14) -+ { -+ pow_cap_ele[0] = 13; // Minimum transmit power capability -+ pow_cap_ele[1] = 21; // Maximum transmit power capability -+ pframe = rtw_set_ie(pframe, EID_PowerCap, 2, pow_cap_ele, &(pattrib->pktlen)); -+ -+ //supported channels -+ do{ -+ if( pmlmeext->channel_set[sup_ch_idx].ChannelNum <= 14 ) -+ { -+ sup_ch[0] = 1; //First channel number -+ sup_ch[1] = pmlmeext->channel_set[sup_ch_idx].ChannelNum; //Number of channel -+ } -+ else -+ { -+ sup_ch[idx_5g++] = pmlmeext->channel_set[sup_ch_idx].ChannelNum; -+ sup_ch[idx_5g++] = 1; -+ } -+ sup_ch_idx++; -+ } -+ while( pmlmeext->channel_set[sup_ch_idx].ChannelNum != 0 ); -+ pframe = rtw_set_ie(pframe, EID_SupportedChannels, idx_5g, sup_ch, &(pattrib->pktlen)); -+ } -+#endif //CONFIG_DFS -+ + //supported rate & extended supported rate + +#if 1 // Check if the AP's supported rates are also supported by STA. + get_rate_set(padapter, sta_bssrate, &sta_bssrate_len); + //DBG_871X("sta_bssrate_len=%d\n", sta_bssrate_len); -+ -+ if(pmlmeext->cur_channel == 14)// for JAPAN, channel 14 can only uses B Mode(CCK) ++ ++ if(pmlmeext->cur_channel == 14)// for JAPAN, channel 14 can only uses B Mode(CCK) + { + sta_bssrate_len = 4; + } + -+ ++ + //for (i = 0; i < sta_bssrate_len; i++) { + // DBG_871X("sta_bssrate[%d]=%02X\n", i, sta_bssrate[i]); + //} @@ -40904,16 +26736,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if (pmlmeinfo->network.SupportedRates[i] == 0) break; + DBG_871X("network.SupportedRates[%d]=%02X\n", i, pmlmeinfo->network.SupportedRates[i]); + } -+ ++ + + for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { + if (pmlmeinfo->network.SupportedRates[i] == 0) break; + -+ ++ + // Check if the AP's supported rates are also supported by STA. + for (j=0; j < sta_bssrate_len; j++) { + // Avoid the proprietary data rate (22Mbps) of Handlink WSG-4000 AP -+ if ( (pmlmeinfo->network.SupportedRates[i]|IEEE80211_BASIC_RATE_MASK) ++ if ( (pmlmeinfo->network.SupportedRates[i]|IEEE80211_BASIC_RATE_MASK) + == (sta_bssrate[j]|IEEE80211_BASIC_RATE_MASK)) { + //DBG_871X("match i = %d, j=%d\n", i, j); + break; @@ -40921,7 +26753,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + //DBG_871X("not match: %02X != %02X\n", (pmlmeinfo->network.SupportedRates[i]|IEEE80211_BASIC_RATE_MASK), (sta_bssrate[j]|IEEE80211_BASIC_RATE_MASK)); + } + } -+ ++ + if (j == sta_bssrate_len) { + // the rate is not supported by STA + DBG_871X("%s(): the rate[%d]=%02X is not supported by STA!\n",__FUNCTION__, i, pmlmeinfo->network.SupportedRates[i]); @@ -40930,7 +26762,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + bssrate[index++] = pmlmeinfo->network.SupportedRates[i]; + } + } -+ ++ + bssrate_len = index; + DBG_871X("bssrate_len = %d\n", bssrate_len); + @@ -40949,7 +26781,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#endif +#endif // Check if the AP's supported rates are also supported by STA. + -+ if ((bssrate_len == 0) && (pmlmeinfo->network.SupportedRates[0] != 0)) { ++ if (bssrate_len == 0) { + rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); + rtw_free_xmitframe(pxmitpriv, pmgntframe); + goto exit; //don't connect to AP if no joint supported rate @@ -40961,13 +26793,110 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); + pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); + } -+ else if (bssrate_len > 0) ++ else + { + pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); -+ } else { -+ DBG_871X("%s: Connect to AP without 11b and 11g data rate!\n",__FUNCTION__); + } + ++ //RSN ++ p = rtw_get_ie((pmlmeinfo->network.IEs + sizeof(NDIS_802_11_FIXED_IEs)), _RSN_IE_2_, &ie_len, (pmlmeinfo->network.IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if (p != NULL) ++ { ++ pframe = rtw_set_ie(pframe, _RSN_IE_2_, ie_len, (p + 2), &(pattrib->pktlen)); ++ } ++ ++#ifdef CONFIG_80211N_HT ++ //HT caps ++ if(padapter->mlmepriv.htpriv.ht_option==true) ++ { ++ p = rtw_get_ie((pmlmeinfo->network.IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_CAPABILITY_IE_, &ie_len, (pmlmeinfo->network.IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if ((p != NULL) && (!(is_ap_in_tkip(padapter)))) ++ { ++ u16 HT_caps_info; ++ ++ _rtw_memcpy(&(pmlmeinfo->HT_caps), (p + 2), sizeof(struct HT_caps_element)); ++ HT_caps_info = le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info); ++ ++ //to disable 40M Hz support while gd_bw_40MHz_en = 0 ++ if (pmlmeext->cur_channel > 14) { ++ if ((pregpriv->bw_mode & 0xf0) > 0) ++ cbw40_enable = 1; ++ } else { ++ if ((pregpriv->bw_mode & 0x0f) > 0) ++ cbw40_enable = 1; ++ } ++ ++ if (cbw40_enable == 0) ++ { ++ HT_caps_info &= (~(BIT(6) | BIT(1))); ++ } ++ else ++ { ++ HT_caps_info |= BIT(1); ++ } ++ ++ //todo: disable SM power save mode ++ HT_caps_info |= 0x000c; ++ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info = cpu_to_le16(HT_caps_info); ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ //switch (pregpriv->rf_config) ++ switch(rf_type) ++ { ++ case RF_1T1R: ++ ++ if(pregpriv->rx_stbc) ++ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info |= cpu_to_le16(0x0100);//RX STBC One spatial stream ++ ++ _rtw_memcpy(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_rate_1R, 16); ++ break; ++ ++ case RF_2T2R: ++ case RF_1T2R: ++ default: ++ ++ if((pregpriv->rx_stbc == 0x3) ||//enable for 2.4/5 GHz ++ ((pmlmeext->cur_wireless_mode & WIRELESS_11_24N) && (pregpriv->rx_stbc == 0x1)) || //enable for 2.4GHz ++ ((pmlmeext->cur_wireless_mode & WIRELESS_11_5N) && (pregpriv->rx_stbc == 0x2)) || //enable for 5GHz ++ (pregpriv->wifi_spec==1)) ++ { ++ DBG_871X("declare supporting RX STBC\n"); ++ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info |= cpu_to_le16(0x0200);//RX STBC two spatial stream ++ } ++ #ifdef CONFIG_DISABLE_MCS13TO15 ++ if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && (pregpriv->wifi_spec!=1)) ++ _rtw_memcpy(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_rate_2R_MCS13TO15_OFF, 16); ++ else ++ _rtw_memcpy(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_rate_2R, 16); ++ #else //CONFIG_DISABLE_MCS13TO15 ++ _rtw_memcpy(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_rate_2R, 16); ++ #endif //CONFIG_DISABLE_MCS13TO15 ++ break; ++ } ++#ifdef RTL8192C_RECONFIG_TO_1T1R ++ { ++ if(pregpriv->rx_stbc) ++ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info |= cpu_to_le16(0x0100);//RX STBC One spatial stream ++ ++ _rtw_memcpy(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_rate_1R, 16); ++ } ++#endif ++ ++#ifdef CONFIG_BT_COEXIST ++ if (BT_1Ant(padapter) == true) ++ { ++ // set to 8K ++ pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para &= (u8)~IEEE80211_HT_CAP_AMPDU_FACTOR; ++// pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para |= MAX_AMPDU_FACTOR_8K ++ } ++#endif ++ ++ pframe = rtw_set_ie(pframe, _HT_CAPABILITY_IE_, ie_len , (u8 *)(&(pmlmeinfo->HT_caps)), &(pattrib->pktlen)); ++ ++ } ++ } ++#endif ++ + //vendor specific IE, such as WPA, WMM, WPS + for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pmlmeinfo->network.IELength;) + { @@ -40979,53 +26908,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if ((_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4)) || + (_rtw_memcmp(pIE->data, WMM_OUI, 4)) || + (_rtw_memcmp(pIE->data, WPS_OUI, 4))) -+ { -+ vs_ie_length = pIE->Length; -+ if((!padapter->registrypriv.wifi_spec) && (_rtw_memcmp(pIE->data, WPS_OUI, 4))) ++ { ++ if(!padapter->registrypriv.wifi_spec) + { + //Commented by Kurt 20110629 + //In some older APs, WPS handshake + //would be fail if we append vender extensions informations to AP -+ -+ vs_ie_length = 14; ++ if(_rtw_memcmp(pIE->data, WPS_OUI, 4)){ ++ pIE->Length=14; ++ } + } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, vs_ie_length, pIE->data, &(pattrib->pktlen)); ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, pIE->Length, pIE->data, &(pattrib->pktlen)); + } + break; -+ -+ case EID_WPA2: -+ pframe = rtw_set_ie(pframe, EID_WPA2, pIE->Length, pIE->data, &(pattrib->pktlen)); -+ break; -+#ifdef CONFIG_80211N_HT -+ case EID_HTCapability: -+ if(padapter->mlmepriv.htpriv.ht_option==_TRUE) { -+ if (!(is_ap_in_tkip(padapter))) -+ { -+ _rtw_memcpy(&(pmlmeinfo->HT_caps), pIE->data, sizeof(struct HT_caps_element)); -+ -+ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info = cpu_to_le16(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info); -+ -+ pframe = rtw_set_ie(pframe, EID_HTCapability, pIE->Length , (u8 *)(&(pmlmeinfo->HT_caps)), &(pattrib->pktlen)); -+ } -+ } -+ break; -+ -+ case EID_EXTCapability: -+ if(padapter->mlmepriv.htpriv.ht_option==_TRUE) { -+ pframe = rtw_set_ie(pframe, EID_EXTCapability, pIE->Length, pIE->data, &(pattrib->pktlen)); -+ } -+ break; -+#endif //CONFIG_80211N_HT +#ifdef CONFIG_80211AC_VHT + case EID_VHTCapability: -+ if (padapter->mlmepriv.vhtpriv.vht_option ==_TRUE) { ++ if (padapter->mlmepriv.vhtpriv.vht_option ==true) { + pframe = rtw_set_ie(pframe, EID_VHTCapability, pIE->Length, pIE->data, &(pattrib->pktlen)); + } + break; + + case EID_OpModeNotification: -+ if (padapter->mlmepriv.vhtpriv.vht_option ==_TRUE) { ++ if (padapter->mlmepriv.vhtpriv.vht_option ==true) { + pframe = rtw_set_ie(pframe, EID_OpModeNotification, pIE->Length, pIE->data, &(pattrib->pktlen)); + } + break; @@ -41051,7 +26955,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#ifdef CONFIG_P2P + +#ifdef CONFIG_IOCTL_CFG80211 -+ if(adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) + { + if(pmlmepriv->p2p_assoc_req_ie && pmlmepriv->p2p_assoc_req_ie_len>0) + { @@ -41065,9 +26969,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) + { -+ // Should add the P2P IE in the association request frame. ++ // Should add the P2P IE in the association request frame. + // P2P OUI -+ ++ + p2pielen = 0; + p2pie[ p2pielen++ ] = 0x50; + p2pie[ p2pielen++ ] = 0x6F; @@ -41087,7 +26991,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); + p2pielen += 2; + + // Value: @@ -41105,16 +27009,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_EX_LISTEN_TIMING; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0004 ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0004 ); + p2pielen += 2; + + // Value: + // Availability Period -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); + p2pielen += 2; + + // Availability Interval -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); + p2pielen += 2; + + // Device Info @@ -41122,14 +27026,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + p2pie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; + + // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) ++ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) + // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); + p2pielen += 2; + + // Value: + // P2P Device Address -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); + p2pielen += ETH_ALEN; + + // Config Method @@ -41137,26 +27041,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if ( ( pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PEER_DISPLAY_PIN ) || + ( pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_SELF_DISPLAY_PIN ) ) + { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_DISPLAY ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_DISPLAY ); + } + else + { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_PBC ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_PBC ); + } + + p2pielen += 2; + + // Primary Device Type + // Category ID -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); + p2pielen += 2; + + // OUI -+ *(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); ++ *(__be32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); + p2pielen += 4; + + // Sub Category ID -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); + p2pielen += 2; + + // Number of Secondary Device Types @@ -41164,34 +27068,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + // Device Name + // Type: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); + p2pielen += 2; + + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); ++ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); + p2pielen += 2; + + // Value: + _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len ); + p2pielen += pwdinfo->device_name_len; -+ ++ + // P2P Interface + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_INTERFACE; -+ ++ + // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x000D ); ++ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x000D ); + p2pielen += 2; -+ ++ + // Value: + _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN ); // P2P Device Address + p2pielen += ETH_ALEN; + + p2pie[ p2pielen++ ] = 1; // P2P Interface Address Count -+ ++ + _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN ); // P2P Interface Address List + p2pielen += ETH_ALEN; -+ ++ + pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); + +#ifdef CONFIG_WFD @@ -41206,7 +27110,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +#ifdef CONFIG_WFD +#ifdef CONFIG_IOCTL_CFG80211 -+ if ( _TRUE == pwdinfo->wfd_info->wfd_enable ) ++ if ( true == pwdinfo->wfd_info->wfd_enable ) +#endif //CONFIG_IOCTL_CFG80211 + { + wfdielen = build_assoc_req_wfd_ie(pwdinfo, pframe); @@ -41214,15 +27118,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pattrib->pktlen += wfdielen; + } +#ifdef CONFIG_IOCTL_CFG80211 -+ else if (pmlmepriv->wfd_assoc_req_ie != NULL && pmlmepriv->wfd_assoc_req_ie_len>0) ++ else if (pmlmepriv->wfd_assoc_req_ie != NULL && pmlmepriv->wfd_assoc_req_ie_len>0) + { + //WFD IE + _rtw_memcpy(pframe, pmlmepriv->wfd_assoc_req_ie, pmlmepriv->wfd_assoc_req_ie_len); + pattrib->pktlen += pmlmepriv->wfd_assoc_req_ie_len; -+ pframe += pmlmepriv->wfd_assoc_req_ie_len; ++ pframe += pmlmepriv->wfd_assoc_req_ie_len; + } +#endif //CONFIG_IOCTL_CFG80211 -+#endif //CONFIG_WFD ++#endif //CONFIG_WFD + + pattrib->last_txcmdsz = pattrib->pktlen; + dump_mgntframe(padapter, pmgntframe); @@ -41246,7 +27150,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + struct xmit_priv *pxmitpriv; + struct mlme_ext_priv *pmlmeext; + struct mlme_ext_info *pmlmeinfo; @@ -41256,9 +27160,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if(!padapter) + goto exit; + -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ goto exit; -+ + pxmitpriv = &(padapter->xmitpriv); + pmlmeext = &(padapter->mlmeextpriv); + pmlmeinfo = &(pmlmeext->mlmext_info); @@ -41271,7 +27172,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + //update attribute + pattrib = &pmgntframe->attrib; + update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = _FALSE; ++ pattrib->retry_ctrl = false; + + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); + @@ -41289,14 +27190,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + SetToDs(fctrl); + } -+ ++ + if (power_mode) + { + SetPwrMgt(fctrl); + } + + _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); @@ -41322,49 +27223,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return ret; +} + -+/* -+ * [IMPORTANT] Don't call this function in interrupt context -+ * -+ * When wait_ms > 0, this function should be called at process context -+ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ * try_cnt means the maximal TX count to try -+ * da == NULL for station mode -+ */ ++ ++//when wait_ms >0 , this function shoule be called at process context ++//da == NULL for station mode +int issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) +{ -+ int ret = _FAIL; ++ int ret; + int i = 0; + u32 start = rtw_get_current_time(); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_info *psta; -+ -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ goto exit; + + /* da == NULL, assum it's null data for sta to ap*/ + if (da == NULL) + da = get_my_bssid(&(pmlmeinfo->network)); + -+ psta = rtw_get_stainfo(&padapter->stapriv, da); -+ if (psta) { -+ if (power_mode) -+ rtw_hal_macid_sleep(padapter, psta->mac_id); -+ else -+ rtw_hal_macid_wakeup(padapter, psta->mac_id); -+ } else { -+ DBG_871X(FUNC_ADPT_FMT ": Can't find sta info for " MAC_FMT ", skip macid %s!!\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), power_mode?"sleep":"wakeup"); -+ rtw_warn_on(1); -+ } -+ -+ do { -+ ret = _issue_nulldata(padapter, da, power_mode, wait_ms>0?_TRUE:_FALSE); ++ do ++ { ++ ret = _issue_nulldata(padapter, da, power_mode, wait_ms>0?true:false); + + i++; + -+ if (RTW_CANNOT_RUN(padapter)) ++ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) + break; + + if(i < try_cnt && wait_ms > 0 && ret==_FAIL) @@ -41393,31 +27273,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return ret; +} + -+/* -+ * [IMPORTANT] This function run in interrupt context -+ * -+ * The null data packet would be sent without power bit, -+ * and not guarantee success. -+ */ -+s32 issue_nulldata_in_interrupt(PADAPTER padapter, u8 *da, unsigned int power_mode) -+{ -+ int ret; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ /* da == NULL, assum it's null data for sta to ap*/ -+ if (da == NULL) -+ da = get_my_bssid(&(pmlmeinfo->network)); -+ -+ ret = _issue_nulldata(padapter, da, power_mode, _FALSE); -+ -+ return ret; -+} -+ +//when wait_ack is ture, this function shoule be called at process context +static int _issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int wait_ack) +{ @@ -41426,14 +27281,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl, *qc; ++ __le16 *fctrl, *qc; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ goto exit; -+ + DBG_871X("%s\n", __FUNCTION__); + + if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) @@ -41446,7 +27298,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + update_mgntframe_attrib(padapter, pattrib); + + pattrib->hdrlen +=2; -+ pattrib->qos_en = _TRUE; ++ pattrib->qos_en = true; + pattrib->eosp = 1; + pattrib->ack_policy = 0; + pattrib->mdata = 0; @@ -41471,8 +27323,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if(pattrib->mdata) + SetMData(fctrl); + -+ qc = (unsigned short *)(pframe + pattrib->hdrlen - 2); -+ ++ qc = (__le16 *)(pframe + pattrib->hdrlen - 2); ++ + SetPriority(qc, tid); + + SetEOSP(qc, pattrib->eosp); @@ -41480,7 +27332,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + SetAckpolicy(qc, pattrib->ack_policy); + + _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); @@ -41491,7 +27343,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); + + pattrib->last_txcmdsz = pattrib->pktlen; -+ ++ + if(wait_ack) + { + ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); @@ -41506,35 +27358,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return ret; +} + -+/* -+ * when wait_ms >0 , this function should be called at process context -+ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ * try_cnt means the maximal TX count to try -+ * da == NULL for station mode -+ */ ++//when wait_ms >0 , this function shoule be called at process context ++//da == NULL for station mode +int issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int try_cnt, int wait_ms) +{ -+ int ret = _FAIL; ++ int ret; + int i = 0; + u32 start = rtw_get_current_time(); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ goto exit; -+ + /* da == NULL, assum it's null data for sta to ap*/ + if (da == NULL) + da = get_my_bssid(&(pmlmeinfo->network)); -+ ++ + do + { -+ ret = _issue_qos_nulldata(padapter, da, tid, wait_ms>0?_TRUE:_FALSE); ++ ret = _issue_qos_nulldata(padapter, da, tid, wait_ms>0?true:false); + + i++; + -+ if (RTW_CANNOT_RUN(padapter)) ++ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) + break; + + if(i < try_cnt && wait_ms > 0 && ret==_FAIL) @@ -41563,20 +27407,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return ret; +} + -+static int _issue_deauth(_adapter *padapter, unsigned char *da, unsigned short reason, u8 wait_ack, u8 key_type) ++static int _issue_deauth(_adapter *padapter, unsigned char *da, unsigned short reason, u8 wait_ack) +{ + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + int ret = _FAIL; +#ifdef CONFIG_P2P + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif //CONFIG_P2P ++#endif //CONFIG_P2P + + //DBG_871X("%s to "MAC_FMT"\n", __func__, MAC_ARG(da)); + @@ -41588,9 +27432,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } +#endif //CONFIG_P2P + -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ goto exit; -+ + if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) + { + goto exit; @@ -41599,8 +27440,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + //update attribute + pattrib = &pmgntframe->attrib; + update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = _FALSE; -+ pattrib->key_type = key_type; ++ pattrib->retry_ctrl = false; ++ + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); + + pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; @@ -41610,7 +27451,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); @@ -41620,7 +27461,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe += sizeof(struct rtw_ieee80211_hdr_3addr); + pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); + -+ reason = cpu_to_le16(reason); ++ cpu_to_le16p(&reason); + pframe = rtw_set_fixed_ie(pframe, _RSON_CODE_ , (unsigned char *)&reason, &(pattrib->pktlen)); + + pattrib->last_txcmdsz = pattrib->pktlen; @@ -41643,39 +27484,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +int issue_deauth(_adapter *padapter, unsigned char *da, unsigned short reason) +{ + DBG_871X("%s to "MAC_FMT"\n", __func__, MAC_ARG(da)); -+ return _issue_deauth(padapter, da, reason, _FALSE, IEEE80211W_RIGHT_KEY); ++ return _issue_deauth(padapter, da, reason, false); +} + -+#ifdef CONFIG_IEEE80211W -+int issue_deauth_11w(_adapter *padapter, unsigned char *da, unsigned short reason, u8 key_type) -+{ -+ DBG_871X("%s to "MAC_FMT"\n", __func__, MAC_ARG(da)); -+ return _issue_deauth(padapter, da, reason, _FALSE, key_type); -+} -+#endif /* CONFIG_IEEE80211W */ -+ -+/* -+ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ * try_cnt means the maximal TX count to try -+ */ +int issue_deauth_ex(_adapter *padapter, u8 *da, unsigned short reason, int try_cnt, + int wait_ms) +{ -+ int ret = _FAIL; ++ int ret; + int i = 0; + u32 start = rtw_get_current_time(); + -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ goto exit; -+ + do + { -+ ret = _issue_deauth(padapter, da, reason, wait_ms > 0 ? _TRUE:_FALSE, IEEE80211W_RIGHT_KEY); ++ ret = _issue_deauth(padapter, da, reason, wait_ms>0?true:false); + + i++; + -+ if (RTW_CANNOT_RUN(padapter)) ++ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) + break; + + if(i < try_cnt && wait_ms > 0 && ret==_FAIL) @@ -41705,21 +27530,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +} + +void issue_action_spct_ch_switch(_adapter *padapter, u8 *ra, u8 new_ch, u8 ch_offset) -+{ ++{ + _irqL irqL; + _list *plist, *phead; + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ return; + + DBG_871X(FUNC_NDEV_FMT" ra="MAC_FMT", ch:%u, offset:%u\n", + FUNC_NDEV_ARG(padapter->pnetdev), MAC_ARG(ra), new_ch, ch_offset); @@ -41740,7 +27563,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); /* RA */ -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); /* TA */ ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); /* TA */ + _rtw_memcpy(pwlanhdr->addr3, ra, ETH_ALEN); /* DA = RA */ + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); @@ -41770,137 +27593,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +} + -+#ifdef CONFIG_IEEE80211W -+void issue_action_SA_Query(_adapter *padapter, unsigned char *raddr, unsigned char action, unsigned short tid, u8 key_type) ++void issue_action_BA(_adapter *padapter, unsigned char *raddr, unsigned char action, unsigned short status) +{ -+ u8 category = RTW_WLAN_CATEGORY_SA_QUERY; -+ u16 reason_code; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ u8 *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ return; -+ -+ DBG_871X("%s, %04x\n", __FUNCTION__, tid); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ DBG_871X("%s: alloc_mgtxmitframe fail\n", __FUNCTION__); -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->key_type = key_type; -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ if(raddr) -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ else -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &category, &pattrib->pktlen); -+ pframe = rtw_set_fixed_ie(pframe, 1, &action, &pattrib->pktlen); -+ -+ switch (action) -+ { -+ case 0: //SA Query req -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)&pmlmeext->sa_query_seq, &pattrib->pktlen); -+ pmlmeext->sa_query_seq++; -+ /* send sa query request to AP, AP should reply sa query response in 1 second */ -+ if (pattrib->key_type == IEEE80211W_RIGHT_KEY) { -+ psta = rtw_get_stainfo(pstapriv, raddr); -+ if (psta != NULL) { -+ /* DBG_871X("%s, %d, set dot11w_expire_timer\n", __func__, __LINE__); */ -+ _set_timer(&psta->dot11w_expire_timer, 1000); -+ } -+ } -+ break; -+ -+ case 1: //SA Query rsp -+ tid = cpu_to_le16(tid); -+ /* DBG_871X("rtw_set_fixed_ie, %04x\n", tid); */ -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)&tid, &pattrib->pktlen); -+ break; -+ default: -+ break; -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+} -+#endif //CONFIG_IEEE80211W -+ -+/** -+ * issue_action_ba - internal function to TX Block Ack action frame -+ * @padapter: the adapter to TX -+ * @raddr: receiver address -+ * @action: Block Ack Action -+ * @tid: tid -+ * @size: the announced AMPDU buffer size. used by ADDBA_RESP -+ * @status: status/reason code. used by ADDBA_RESP, DELBA -+ * @initiator: if we are the initiator of AMPDU association. used by DELBA -+ * @wait_ack: used xmit ack -+ * -+ * Returns: -+ * _SUCCESS: No xmit ack is used or acked -+ * _FAIL: not acked when using xmit ack -+ */ -+static int issue_action_ba(_adapter *padapter, unsigned char *raddr, unsigned char action -+ , u8 tid, u8 size, u16 status, u8 initiator, int wait_ack) -+{ -+ int ret = _FAIL; + u8 category = RTW_WLAN_CATEGORY_BACK; + u16 start_seq; + u16 BA_para_set; ++ __le16 le_tmp; ++ u16 reason_code; + u16 BA_timeout_value; + u16 BA_starting_seqctrl; ++ HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor; + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + u8 *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; ++ __le16 *fctrl, le_status; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct sta_info *psta; + struct sta_priv *pstapriv = &padapter->stapriv; -+ struct registry_priv *pregpriv = &padapter->registrypriv; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++#ifdef CONFIG_BT_COEXIST ++ u8 tendaAPMac[] = {0xC8, 0x3A, 0x35}; ++#endif + +#ifdef CONFIG_80211N_HT -+ -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ goto exit; ++ DBG_871X("%s, category=%d, action=%d, status=%d\n", __FUNCTION__, category, action, status); + + if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; ++ { ++ return; ++ } + + //update attribute + pattrib = &pmgntframe->attrib; @@ -41916,7 +27640,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + //_rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); @@ -41929,81 +27653,107 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); + ++ le32_to_cpup((__le32*)&status); ++ ++ + if (category == 3) + { + switch (action) + { -+ case RTW_WLAN_ACTION_ADDBA_REQ: ++ case 0: //ADDBA req + do { + pmlmeinfo->dialogToken++; + } while (pmlmeinfo->dialogToken == 0); + pframe = rtw_set_fixed_ie(pframe, 1, &(pmlmeinfo->dialogToken), &(pattrib->pktlen)); + -+ #if defined(CONFIG_RTL8188E) && defined(CONFIG_SDIO_HCI) -+ BA_para_set = (0x0802 | ((tid & 0xf) << 2)); /* immediate ack & 16 buffer size */ -+ #else -+ BA_para_set = (0x1002 | ((tid & 0xf) << 2)); /* immediate ack & 64 buffer size */ -+ #endif -+ -+ BA_para_set = cpu_to_le16(BA_para_set); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_para_set)), &(pattrib->pktlen)); ++#ifdef CONFIG_BT_COEXIST ++ if ((BT_1Ant(padapter) == true) && ++ ((pmlmeinfo->assoc_AP_vendor != broadcomAP) || ++ (_rtw_memcmp(raddr, tendaAPMac, 3) == false))) ++ { ++ // A-MSDU NOT Supported ++ BA_para_set = 0; ++ // immediate Block Ack ++ BA_para_set |= (1 << 1) & IEEE80211_ADDBA_PARAM_POLICY_MASK; ++ // TID ++ BA_para_set |= (status << 2) & IEEE80211_ADDBA_PARAM_TID_MASK; ++ // max buffer size is 8 MSDU ++ BA_para_set |= (8 << 6) & RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; ++ } ++ else ++#endif ++ { ++ BA_para_set = (0x1002 | ((status & 0xf) << 2)); //immediate ack & 64 buffer size ++ } ++ //sys_mib.BA_para_set = 0x0802; //immediate ack & 32 buffer size ++ le_tmp = cpu_to_le16(BA_para_set); ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); + + //BA_timeout_value = 0xffff;//max: 65535 TUs(~ 65 ms) + BA_timeout_value = 5000;//~ 5ms -+ BA_timeout_value = cpu_to_le16(BA_timeout_value); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_timeout_value)), &(pattrib->pktlen)); ++ le_tmp = cpu_to_le16(BA_timeout_value); ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&le_tmp), &(pattrib->pktlen)); + + //if ((psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress)) != NULL) + if ((psta = rtw_get_stainfo(pstapriv, raddr)) != NULL) + { -+ start_seq = (psta->sta_xmitpriv.txseq_tid[tid & 0x07]&0xfff) + 1; ++ start_seq = (psta->sta_xmitpriv.txseq_tid[status & 0x07]&0xfff) + 1; ++ ++ DBG_871X("BA_starting_seqctrl = %d for TID=%d\n", start_seq, status & 0x07); ++ ++ psta->BA_starting_seqctrl[status & 0x07] = start_seq; + -+ DBG_871X("BA_starting_seqctrl = %d for TID=%d\n", start_seq, tid & 0x07); -+ -+ psta->BA_starting_seqctrl[tid & 0x07] = start_seq; -+ + BA_starting_seqctrl = start_seq << 4; + } -+ -+ BA_starting_seqctrl = cpu_to_le16(BA_starting_seqctrl); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_starting_seqctrl)), &(pattrib->pktlen)); ++ ++ le_tmp = cpu_to_le16(BA_starting_seqctrl); ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); + break; + -+ case RTW_WLAN_ACTION_ADDBA_RESP: ++ case 1: //ADDBA rsp + pframe = rtw_set_fixed_ie(pframe, 1, &(pmlmeinfo->ADDBA_req.dialog_token), &(pattrib->pktlen)); -+ status = cpu_to_le16(status); + pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&status), &(pattrib->pktlen)); ++ rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); ++ if(MAX_AMPDU_FACTOR_64K == max_rx_ampdu_factor) ++ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x1000); //64 buffer size ++ else if(MAX_AMPDU_FACTOR_32K == max_rx_ampdu_factor) ++ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x0800); //32 buffer size ++ else if(MAX_AMPDU_FACTOR_16K == max_rx_ampdu_factor) ++ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x0400); //16 buffer size ++ else if(MAX_AMPDU_FACTOR_8K == max_rx_ampdu_factor) ++ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x0200); //8 buffer size ++ else ++ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x1000); //64 buffer size + -+ BA_para_set = le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set); -+ -+ BA_para_set &= ~IEEE80211_ADDBA_PARAM_TID_MASK; -+ BA_para_set |= (tid << 2) & IEEE80211_ADDBA_PARAM_TID_MASK; -+ -+ BA_para_set &= ~RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; -+ BA_para_set |= (size << 6) & RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; -+ -+ if (!padapter->registrypriv.wifi_spec) { -+ if(pregpriv->ampdu_amsdu==0)//disabled -+ BA_para_set &= ~BIT(0); -+ else if(pregpriv->ampdu_amsdu==1)//enabled -+ BA_para_set |= BIT(0); ++#ifdef CONFIG_BT_COEXIST ++ if ((BT_1Ant(padapter) == true) && ++ ((pmlmeinfo->assoc_AP_vendor != broadcomAP) || ++ (_rtw_memcmp(raddr, tendaAPMac, 3) == false))) ++ { ++ // max buffer size is 8 MSDU ++ BA_para_set &= ~RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; ++ BA_para_set |= (8 << 6) & RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; + } ++#endif + -+ BA_para_set = cpu_to_le16(BA_para_set); ++ if(pregpriv->ampdu_amsdu==0)//disabled ++ le_tmp = cpu_to_le16(BA_para_set & ~BIT(0)); ++ else if(pregpriv->ampdu_amsdu==1)//enabled ++ le_tmp = cpu_to_le16(BA_para_set | BIT(0)); ++ else //auto ++ le_tmp = cpu_to_le16(BA_para_set); + -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_para_set)), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(pmlmeinfo->ADDBA_req.BA_timeout_value)), &(pattrib->pktlen)); + break; ++ case 2://DELBA ++ BA_para_set = (status & 0x1F) << 3; ++ le_tmp = cpu_to_le16(BA_para_set); ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); + -+ case RTW_WLAN_ACTION_DELBA: -+ BA_para_set = 0; -+ BA_para_set |= (tid << 12) & IEEE80211_DELBA_PARAM_TID_MASK; -+ BA_para_set |= (initiator << 11) & IEEE80211_DELBA_PARAM_INITIATOR_MASK; -+ -+ BA_para_set = cpu_to_le16(BA_para_set); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_para_set)), &(pattrib->pktlen)); -+ status = cpu_to_le16(status); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(status)), &(pattrib->pktlen)); ++ reason_code = 37;//Requested from peer STA as it does not want to use the mechanism ++ le_tmp = cpu_to_le16(reason_code); ++ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); + break; + default: + break; @@ -42012,194 +27762,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + pattrib->last_txcmdsz = pattrib->pktlen; + -+ if (wait_ack) { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: ++ dump_mgntframe(padapter, pmgntframe); +#endif //CONFIG_80211N_HT -+ return ret; -+} -+ -+/** -+ * issue_addba_req - TX ADDBA_REQ -+ * @adapter: the adapter to TX -+ * @ra: receiver address -+ * @tid: tid -+ */ -+inline void issue_addba_req(_adapter *adapter, unsigned char *ra, u8 tid) -+{ -+ issue_action_ba(adapter, ra, RTW_WLAN_ACTION_ADDBA_REQ -+ , tid -+ , 0 /* unused */ -+ , 0 /* unused */ -+ , 0 /* unused */ -+ , _FALSE -+ ); -+ DBG_871X(FUNC_ADPT_FMT" ra="MAC_FMT" tid=%u\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), tid); -+ -+} -+ -+/** -+ * issue_addba_rsp - TX ADDBA_RESP -+ * @adapter: the adapter to TX -+ * @ra: receiver address -+ * @tid: tid -+ * @status: status code -+ * @size: the announced AMPDU buffer size -+ */ -+inline void issue_addba_rsp(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u8 size) -+{ -+ issue_action_ba(adapter, ra, RTW_WLAN_ACTION_ADDBA_RESP -+ , tid -+ , size -+ , status -+ , 0 /* unused */ -+ , _FALSE -+ ); -+ DBG_871X(FUNC_ADPT_FMT" ra="MAC_FMT" status=%u, tid=%u, size=%u\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), status, tid, size); -+} -+ -+/** -+ * issue_addba_rsp_wait_ack - TX ADDBA_RESP and wait ack -+ * @adapter: the adapter to TX -+ * @ra: receiver address -+ * @tid: tid -+ * @status: status code -+ * @size: the announced AMPDU buffer size -+ * @try_cnt: the maximal TX count to try -+ * @wait_ms: == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ */ -+inline u8 issue_addba_rsp_wait_ack(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u8 size, int try_cnt, int wait_ms) -+{ -+ int ret = _FAIL; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(adapter))) -+ goto exit; -+ -+ do { -+ ret = issue_action_ba(adapter, ra, RTW_WLAN_ACTION_ADDBA_RESP -+ , tid -+ , size -+ , status -+ , 0 /* unused */ -+ , _TRUE -+ ); -+ -+ i++; -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+ #ifndef DBG_XMIT_ACK -+ /* goto exit; */ -+ #endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ DBG_871X(FUNC_ADPT_FMT" ra="MAC_FMT" tid=%u%s, %d/%d in %u ms\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), tid -+ , ret == _SUCCESS?", acked":"", i, try_cnt, rtw_get_passing_time_ms(start)); -+ } -+ -+exit: -+ return ret; -+} -+ -+/** -+ * issue_del_ba - TX DELBA -+ * @adapter: the adapter to TX -+ * @ra: receiver address -+ * @tid: tid -+ * @reason: reason code -+ * @initiator: if we are the initiator of AMPDU association. used by DELBA -+ */ -+inline void issue_del_ba(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator) -+{ -+ issue_action_ba(adapter, ra, RTW_WLAN_ACTION_DELBA -+ , tid -+ , 0 /* unused */ -+ , reason -+ , initiator -+ , _FALSE -+ ); -+ DBG_871X(FUNC_ADPT_FMT" ra="MAC_FMT" reason=%u, tid=%u, initiator=%u\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), reason, tid, initiator); -+} -+ -+/** -+ * issue_del_ba_ex - TX DELBA with xmit ack options -+ * @adapter: the adapter to TX -+ * @ra: receiver address -+ * @tid: tid -+ * @reason: reason code -+ * @initiator: if we are the initiator of AMPDU association. used by DELBA -+ * @try_cnt: the maximal TX count to try -+ * @wait_ms: == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ */ -+int issue_del_ba_ex(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator -+ , int try_cnt, int wait_ms) -+{ -+ int ret = _FAIL; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(adapter))) -+ goto exit; -+ -+ do { -+ ret = issue_action_ba(adapter, ra, RTW_WLAN_ACTION_DELBA -+ , tid -+ , 0 /* unused */ -+ , reason -+ , initiator -+ , wait_ms > 0?_TRUE:_FALSE -+ ); -+ -+ i++; -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+ #ifndef DBG_XMIT_ACK -+ /* goto exit; */ -+ #endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ DBG_871X(FUNC_ADPT_FMT" ra="MAC_FMT" reason=%u, tid=%u, initiator=%u%s, %d/%d in %u ms\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), reason, tid, initiator -+ , ret == _SUCCESS?", acked":"", i, try_cnt, rtw_get_passing_time_ms(start)); -+ } -+exit: -+ return ret; +} + +static void issue_action_BSSCoexistPacket(_adapter *padapter) -+{ ++{ + _irqL irqL; + _list *plist, *phead; + unsigned char category, action; @@ -42207,7 +27775,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + struct wlan_network *pnetwork = NULL; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -42216,15 +27784,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + _queue *queue = &(pmlmepriv->scanned_queue); + u8 InfoContent[16] = {0}; + u8 ICS[8][15]; -+#ifdef CONFIG_80211N_HT ++#ifdef CONFIG_80211N_HT + if((pmlmepriv->num_FortyMHzIntolerant==0) || (pmlmepriv->num_sta_no_ht==0)) + return; + -+ if(_TRUE == pmlmeinfo->bwmode_updated) ++ if(true == pmlmeinfo->bwmode_updated) + return; + -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ return; + + DBG_871X("%s\n", __FUNCTION__); + @@ -42250,7 +27816,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); @@ -42268,36 +27834,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if(pmlmepriv->num_FortyMHzIntolerant>0) + { + u8 iedata=0; -+ ++ + iedata |= BIT(2);//20 MHz BSS Width Request + + pframe = rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); -+ ++ + } -+ ++ + + // + _rtw_memset(ICS, 0, sizeof(ICS)); + if(pmlmepriv->num_sta_no_ht>0) -+ { ++ { + int i; -+ ++ + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + + phead = get_list_head(queue); + plist = get_next(phead); -+ ++ + while(1) + { + int len; + u8 *p; + WLAN_BSSID_EX *pbss_network; -+ -+ if (rtw_end_of_queue_search(phead,plist)== _TRUE) -+ break; + -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ ++ if (rtw_end_of_queue_search(phead,plist)== true) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ + plist = get_next(plist); + + pbss_network = (WLAN_BSSID_EX *)&pnetwork->network; @@ -42307,14 +27873,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + if((pbss_network->Configuration.DSConfig<=0) || (pbss_network->Configuration.DSConfig>14)) + continue; -+ ++ + ICS[0][pbss_network->Configuration.DSConfig]=1; -+ ++ + if(ICS[0][0] == 0) -+ ICS[0][0] = 1; -+ } -+ -+ } ++ ICS[0][0] = 1; ++ } ++ ++ } + + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + @@ -42324,11 +27890,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if(ICS[i][0] == 1) + { + int j, k = 0; -+ -+ InfoContent[k] = i; ++ ++ InfoContent[k] = i; + //SET_BSS_INTOLERANT_ELE_REG_CLASS(InfoContent,i); + k++; -+ ++ + for(j=1;j<=14;j++) + { + if(ICS[i][j]==1) @@ -42338,19 +27904,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + InfoContent[k] = j; //channel number + //SET_BSS_INTOLERANT_ELE_CHANNEL(InfoContent+k, j); + k++; -+ } -+ } -+ } ++ } ++ } ++ } + + pframe = rtw_set_ie(pframe, EID_BSSIntolerantChlReport, k, InfoContent, &(pattrib->pktlen)); -+ ++ + } -+ ++ + } -+ ++ + + } -+ ++ + + pattrib->last_txcmdsz = pattrib->pktlen; + @@ -42358,229 +27924,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#endif //CONFIG_80211N_HT +} + -+// Spatial Multiplexing Powersave (SMPS) action frame -+int _issue_action_SM_PS(_adapter *padapter , unsigned char *raddr , u8 NewMimoPsMode , u8 wait_ack) -+{ -+ -+ int ret = _FAIL; -+ unsigned char category = RTW_WLAN_CATEGORY_HT; -+ u8 action = RTW_WLAN_ACTION_HT_SM_PS; -+ u8 sm_power_control=0; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ if(NewMimoPsMode==WLAN_HT_CAP_SM_PS_DISABLED) -+ { -+ sm_power_control = sm_power_control & ~(BIT(0)); // SM Power Save Enable = 0 SM Power Save Disable -+ } -+ else if(NewMimoPsMode==WLAN_HT_CAP_SM_PS_STATIC) -+ { -+ sm_power_control = sm_power_control | BIT(0); // SM Power Save Enable = 1 SM Power Save Enable -+ sm_power_control = sm_power_control & ~(BIT(1)); // SM Mode = 0 Static Mode -+ } -+ else if(NewMimoPsMode==WLAN_HT_CAP_SM_PS_DYNAMIC) -+ { -+ sm_power_control = sm_power_control | BIT(0); // SM Power Save Enable = 1 SM Power Save Enable -+ sm_power_control = sm_power_control | BIT(1); // SM Mode = 1 Dynamic Mode -+ } -+ else -+ return ret; -+ -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ return ret; -+ -+ DBG_871X("%s, sm_power_control=%u, NewMimoPsMode=%u\n", __FUNCTION__ , sm_power_control , NewMimoPsMode ); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ return ret; -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); /* RA */ -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); /* TA */ -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); /* DA = RA */ -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /* category, action */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(sm_power_control), &(pattrib->pktlen)); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if(wait_ack) -+ { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } -+ else -+ { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+ if (ret != _SUCCESS) -+ DBG_8192C("%s, ack to\n", __func__); -+ -+ return ret; -+} -+ -+/* -+ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ * try_cnt means the maximal TX count to try -+ */ -+int issue_action_SM_PS_wait_ack(_adapter *padapter, unsigned char *raddr, u8 NewMimoPsMode, int try_cnt, int wait_ms) -+{ -+ int ret = _FAIL; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ -+ if (rtw_rfctl_is_tx_blocked_by_cac(adapter_to_rfctl(padapter))) -+ goto exit; -+ -+ do { -+ ret = _issue_action_SM_PS(padapter, raddr, NewMimoPsMode , wait_ms>0?_TRUE:_FALSE ); -+ -+ i++; -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ break; -+ -+ if(i < try_cnt && wait_ms > 0 && ret==_FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ }while((irecvreorder_ctrl[tid].enable == _TRUE) { -+ u8 ampdu_size_bak = sta->recvreorder_ctrl[tid].ampdu_size; -+ -+ sta->recvreorder_ctrl[tid].enable = _FALSE; -+ sta->recvreorder_ctrl[tid].ampdu_size = RX_AMPDU_SIZE_INVALID; -+ -+ if (rtw_del_rx_ampdu_test_trigger_no_tx_fail()) -+ ret = _FAIL; -+ else if (wait_ack) -+ ret = issue_del_ba_ex(adapter, sta->hwaddr, tid, 37, initiator, 3, 1); -+ else -+ issue_del_ba(adapter, sta->hwaddr, tid, 37, initiator); -+ -+ if (ret == _FAIL && sta->recvreorder_ctrl[tid].enable == _FALSE) -+ sta->recvreorder_ctrl[tid].ampdu_size = ampdu_size_bak; -+ } -+ } else if (initiator == 1) { -+ /* originator */ -+#ifdef CONFIG_80211N_HT -+ if (force || sta->htpriv.agg_enable_bitmap & BIT(tid)) { -+ sta->htpriv.agg_enable_bitmap &= ~BIT(tid); -+ sta->htpriv.candidate_tid_bitmap &= ~BIT(tid); -+ issue_del_ba(adapter, sta->hwaddr, tid, 37, initiator); -+ } -+#endif -+ } -+ -+exit: -+ return ret; -+} -+ -+inline unsigned int send_delba_sta_tid(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid -+ , u8 force) -+{ -+ return _send_delba_sta_tid(adapter, initiator, sta, tid, force, 0); -+} -+ -+inline unsigned int send_delba_sta_tid_wait_ack(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid -+ , u8 force) -+{ -+ return _send_delba_sta_tid(adapter, initiator, sta, tid, force, 1); -+} -+ +unsigned int send_delba(_adapter *padapter, u8 initiator, u8 *addr) +{ + struct sta_priv *pstapriv = &padapter->stapriv; + struct sta_info *psta = NULL; ++ //struct recv_reorder_ctrl *preorder_ctrl; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u16 tid; + -+ if ((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) ++ if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) + if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) + return _SUCCESS; + @@ -42588,44 +27941,53 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if(psta==NULL) + return _SUCCESS; + -+ #if 0 -+ DBG_871X("%s:%s\n", __func__, (initiator == 0)?"RX_DIR":"TX_DIR"); -+ if (initiator == 1) /* originator */ -+ DBG_871X("tx agg_enable_bitmap(0x%08x)\n", psta->htpriv.agg_enable_bitmap); -+ #endif ++ //DBG_871X("%s:%s\n", __FUNCTION__, (initiator==0)?"RX_DIR":"TX_DIR"); + -+ for (tid = 0; tid < TID_NUM; tid++) -+ send_delba_sta_tid(padapter, initiator, psta, tid, 0); ++ if(initiator==0) // recipient ++ { ++ for(tid = 0;tidrecvreorder_ctrl[tid].enable == true) ++ { ++ DBG_871X("rx agg disable tid(%d)\n",tid); ++ issue_action_BA(padapter, addr, RTW_WLAN_ACTION_DELBA, (((tid <<1) |initiator)&0x1F)); ++ psta->recvreorder_ctrl[tid].enable = false; ++ psta->recvreorder_ctrl[tid].indicate_seq = 0xffff; ++ #ifdef DBG_RX_SEQ ++ DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u \n", __FUNCTION__, __LINE__, ++ psta->recvreorder_ctrl[tid].indicate_seq); ++ #endif ++ } ++ } ++ } ++ else if(initiator == 1)// originator ++ { ++#ifdef CONFIG_80211N_HT ++ //DBG_871X("tx agg_enable_bitmap(0x%08x)\n", psta->htpriv.agg_enable_bitmap); ++ for(tid = 0;tidhtpriv.agg_enable_bitmap & BIT(tid)) ++ { ++ DBG_871X("tx agg disable tid(%d)\n",tid); ++ issue_action_BA(padapter, addr, RTW_WLAN_ACTION_DELBA, (((tid <<1) |initiator)&0x1F) ); ++ psta->htpriv.agg_enable_bitmap &= ~BIT(tid); ++ psta->htpriv.candidate_tid_bitmap &= ~BIT(tid); ++ ++ } ++ } ++#endif //CONFIG_80211N_HT ++ } + + return _SUCCESS; ++ +} + +unsigned int send_beacon(_adapter *padapter) +{ -+ u8 bxmitok = _FALSE; ++ u8 bxmitok = false; + int issue=0; + int poll = 0; -+//#ifdef CONFIG_CONCURRENT_MODE -+ //struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ //struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ //_adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ //struct mlme_priv *pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); -+//#endif + -+#ifdef CONFIG_PCI_HCI -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ -+ /* 8192EE Port select for Beacon DL */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ -+ issue_beacon(padapter, 0); -+ -+ return _SUCCESS; -+#endif -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) + u32 start = rtw_get_current_time(); + + rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); @@ -42637,15 +27999,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + rtw_yield_os(); + rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8 *)(&bxmitok)); + poll++; -+ } while ((poll%10) != 0 && _FALSE == bxmitok && !RTW_CANNOT_RUN(padapter)); ++ }while((poll%10)!=0 && false == bxmitok && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); + -+ } while (_FALSE == bxmitok && issue < 100 && !RTW_CANNOT_RUN(padapter)); ++ }while(false == bxmitok && issue<100 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); + -+ if (RTW_CANNOT_RUN(padapter)) ++ if(padapter->bSurpriseRemoved || padapter->bDriverStopped) ++ { + return _FAIL; ++ } + -+ -+ if(_FALSE == bxmitok) ++ ++ if(false == bxmitok) + { + DBG_871X("%s fail! %u ms\n", __FUNCTION__, rtw_get_passing_time_ms(start)); + return _FAIL; @@ -42658,12 +28022,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + DBG_871X("%s success, issue:%d, poll:%d, %u ms\n", __FUNCTION__, issue, poll, rtw_get_passing_time_ms(start)); + //else + // DBG_871X("%s success, issue:%d, poll:%d, %u ms\n", __FUNCTION__, issue, poll, rtw_get_passing_time_ms(start)); -+ ++ + return _SUCCESS; + } -+ -+#endif -+ +} + +/**************************************************************************** @@ -42672,11 +28033,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +*****************************************************************************/ + -+BOOLEAN IsLegal5GChannel( -+ IN PADAPTER Adapter, -+ IN u8 channel) ++bool IsLegal5GChannel( ++ PADAPTER Adapter, ++ u8 channel) +{ -+ ++ + int i=0; + u8 Channel_5G[45] = {36,38,40,42,44,46,48,50,52,54,56,58, + 60,62,64,100,102,104,106,108,110,112,114,116,118,120,122, @@ -42684,11 +28045,387 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + 161,163,165}; + for(i=0;imlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u32 initialgain = 0; ++ ++#ifdef CONFIG_P2P ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ ++#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE ++ u8 stay_buddy_ch = 0; ++#endif //CONFIG_STA_MODE_SCAN_UNDER_AP_MODE ++ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; ++ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; ++ ++#endif //CONFIG_CONCURRENT_MODE ++ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); ++ static unsigned char prev_survey_channel = 0; ++ static unsigned int p2p_scan_count = 0; ++ ++ if ( ( pwdinfo->rx_invitereq_info.scan_op_ch_only ) || ( pwdinfo->p2p_info.scan_op_ch_only ) ) ++ { ++ if ( pwdinfo->rx_invitereq_info.scan_op_ch_only ) ++ { ++ survey_channel = pwdinfo->rx_invitereq_info.operation_ch[pmlmeext->sitesurvey_res.channel_idx]; ++ } ++ else ++ { ++ survey_channel = pwdinfo->p2p_info.operation_ch[pmlmeext->sitesurvey_res.channel_idx]; ++ } ++ ScanType = SCAN_ACTIVE; ++ } ++ else if(rtw_p2p_findphase_ex_is_social(pwdinfo)) ++ { ++ // Commented by Albert 2011/06/03 ++ // The driver is in the find phase, it should go through the social channel. ++ int ch_set_idx; ++ survey_channel = pwdinfo->social_chan[pmlmeext->sitesurvey_res.channel_idx]; ++ ch_set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, survey_channel); ++ if (ch_set_idx >= 0) ++ ScanType = pmlmeext->channel_set[ch_set_idx].ScanType; ++ else ++ ScanType = SCAN_ACTIVE; ++ } ++ else ++#endif //CONFIG_P2P ++ { ++ struct rtw_ieee80211_channel *ch; ++ if (pmlmeext->sitesurvey_res.channel_idx < pmlmeext->sitesurvey_res.ch_num) { ++ ch = &pmlmeext->sitesurvey_res.ch[pmlmeext->sitesurvey_res.channel_idx]; ++ survey_channel = ch->hw_value; ++ ScanType = (ch->flags & RTW_IEEE80211_CHAN_PASSIVE_SCAN) ? SCAN_PASSIVE : SCAN_ACTIVE; ++ } ++ } ++ ++ if (0){ ++ DBG_871X(FUNC_ADPT_FMT" ch:%u (cnt:%u,idx:%d) at %dms, %c%c%c\n" ++ , FUNC_ADPT_ARG(padapter) ++ , survey_channel ++ , pwdinfo->find_phase_state_exchange_cnt, pmlmeext->sitesurvey_res.channel_idx ++ , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) ++ , ScanType?'A':'P', pmlmeext->sitesurvey_res.scan_mode?'A':'P' ++ , pmlmeext->sitesurvey_res.ssid[0].SsidLength?'S':' ' ++ ); ++ #ifdef DBG_FIXED_CHAN ++ DBG_871X(FUNC_ADPT_FMT" fixed_chan:%u\n", pmlmeext->fixed_chan); ++ #endif ++ } ++ ++ if(survey_channel != 0) ++ { ++ //PAUSE 4-AC Queue when site_survey ++ //rtw_hal_get_hwreg(padapter, HW_VAR_TXPAUSE, (u8 *)(&val8)); ++ //val8 |= 0x0f; ++ //rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, (u8 *)(&val8)); ++#ifdef CONFIG_CONCURRENT_MODE ++#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE ++ if((padapter->pbuddy_adapter->mlmeextpriv.mlmext_info.state&0x03) == WIFI_FW_AP_STATE) ++ { ++ if( pmlmeinfo->scan_cnt == RTW_SCAN_NUM_OF_CH ) ++ { ++ pmlmeinfo->scan_cnt = 0; ++ survey_channel = pbuddy_mlmeext->cur_channel; ++ ScanType = SCAN_ACTIVE; ++ stay_buddy_ch = 1; ++ } ++ else ++ { ++ if( pmlmeinfo->scan_cnt == 0 ) ++ stay_buddy_ch = 2; ++ pmlmeinfo->scan_cnt++; ++ } ++ } ++#endif //CONFIG_STA_MODE_SCAN_UNDER_AP_MODE ++#endif //CONFIG_CONCURRENT_MODE ++ if(pmlmeext->sitesurvey_res.channel_idx == 0) ++ { ++#ifdef DBG_FIXED_CHAN ++ if(pmlmeext->fixed_chan !=0xff) ++ set_channel_bwmode(padapter, pmlmeext->fixed_chan, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ else ++#endif ++ set_channel_bwmode(padapter, survey_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ } ++ else ++ { ++#ifdef DBG_FIXED_CHAN ++ if(pmlmeext->fixed_chan!=0xff) ++ SelectChannel(padapter, pmlmeext->fixed_chan); ++ else ++#endif ++ SelectChannel(padapter, survey_channel); ++ } ++ ++#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE ++ if( stay_buddy_ch == 1 ) ++ { ++ val8 = 0; //survey done ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ ++ if(check_buddy_mlmeinfo_state(padapter, WIFI_FW_AP_STATE) && ++ check_buddy_fwstate(padapter, _FW_LINKED)) ++ { ++ update_beacon(padapter->pbuddy_adapter, 0, NULL, true); ++ } ++ } ++ else if( stay_buddy_ch == 2 ) ++ { ++ val8 = 1; //under site survey ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ } ++#endif //CONFIG_STA_MODE_SCAN_UNDER_AP_MODE ++ ++ if(ScanType == SCAN_ACTIVE) //obey the channel plan setting... ++ { ++ #ifdef CONFIG_P2P ++ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) || ++ rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH) ++ ) ++ { ++ issue_probereq_p2p(padapter, NULL); ++ issue_probereq_p2p(padapter, NULL); ++ issue_probereq_p2p(padapter, NULL); ++ } ++ else ++ #endif //CONFIG_P2P ++ { ++ int i; ++ for(i=0;isitesurvey_res.ssid[i].SsidLength) { ++ //todo: to issue two probe req??? ++ issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); ++ //rtw_msleep_os(SURVEY_TO>>1); ++ issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); ++ } ++ } ++ ++ if(pmlmeext->sitesurvey_res.scan_mode == SCAN_ACTIVE) { ++ //todo: to issue two probe req??? ++ issue_probereq(padapter, NULL, NULL); ++ //rtw_msleep_os(SURVEY_TO>>1); ++ issue_probereq(padapter, NULL, NULL); ++ } ++ } ++ } ++ ++#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE ++ if( stay_buddy_ch == 1 ) ++ set_survey_timer(pmlmeext, pmlmeext->chan_scan_time * RTW_STAY_AP_CH_MILLISECOND ); ++ else ++#endif //CONFIG_STA_MODE_SCAN_UNDER_AP_MODE ++ set_survey_timer(pmlmeext, pmlmeext->chan_scan_time); ++ ++ } ++ else ++ { ++ ++ // channel number is 0 or this channel is not valid. ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ u8 cur_channel; ++ u8 cur_bwmode; ++ u8 cur_ch_offset; ++ ++ if(check_fwstate(pmlmepriv, _FW_LINKED)) ++ { ++ cur_channel = pmlmeext->cur_channel; ++ cur_bwmode = pmlmeext->cur_bwmode; ++ cur_ch_offset = pmlmeext->cur_ch_offset; ++ } ++ //else if((pbuddy_mlmeinfo->state&0x03) == WIFI_FW_AP_STATE) ++ else if(check_buddy_fwstate(padapter, _FW_LINKED)) // for AP or STA ++ { ++ cur_channel = pbuddy_mlmeext->cur_channel; ++ cur_bwmode = pbuddy_mlmeext->cur_bwmode; ++ cur_ch_offset = pbuddy_mlmeext->cur_ch_offset; ++ } ++ else ++ { ++ cur_channel = pmlmeext->cur_channel; ++ cur_bwmode = pmlmeext->cur_bwmode; ++ cur_ch_offset = pmlmeext->cur_ch_offset; ++ } ++#endif ++ ++ ++#ifdef CONFIG_P2P ++ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH)) ++ { ++ if( ( pwdinfo->rx_invitereq_info.scan_op_ch_only ) || ( pwdinfo->p2p_info.scan_op_ch_only ) ) ++ { ++ // Set the find_phase_state_exchange_cnt to P2P_FINDPHASE_EX_CNT. ++ // This will let the following flow to run the scanning end. ++ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_MAX); ++ } ++ #ifdef CONFIG_DBG_P2P ++ DBG_871X( "[%s] find phase exchange cnt = %d\n", __FUNCTION__, pwdinfo->find_phase_state_exchange_cnt ); ++ #endif ++ } ++ ++ if(rtw_p2p_findphase_ex_is_needed(pwdinfo)) ++ { ++ // Set the P2P State to the listen state of find phase and set the current channel to the listen channel ++ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_LISTEN); ++ pmlmeext->sitesurvey_res.state = SCAN_DISABLE; ++ ++ initialgain = 0xff; //restore RX GAIN ++ rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); ++ //turn on dynamic functions ++ Restore_DM_Func_Flag(padapter); ++ //Switch_DM_Func(padapter, DYNAMIC_FUNC_DIG|DYNAMIC_FUNC_HP|DYNAMIC_FUNC_SS, true); ++ ++ _set_timer( &pwdinfo->find_phase_timer, ( u32 ) ( ( u32 ) ( pwdinfo->listen_dwell ) * 100 ) ); ++ } ++ else ++#endif //CONFIG_P2P ++ { ++ ++#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE ++ pmlmeinfo->scan_cnt = 0; ++#endif //CONFIG_DMP_STA_NODE_SCAN_UNDER_AP_MODE ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++ // 20100721:Interrupt scan operation here. ++ // For SW antenna diversity before link, it needs to switch to another antenna and scan again. ++ // It compares the scan result and select beter one to do connection. ++ if(rtw_hal_antdiv_before_linked(padapter)) ++ { ++ pmlmeext->sitesurvey_res.bss_cnt = 0; ++ pmlmeext->sitesurvey_res.channel_idx = -1; ++ pmlmeext->chan_scan_time = SURVEY_TO /2; ++ set_survey_timer(pmlmeext, pmlmeext->chan_scan_time); ++ return; ++ } ++#endif ++ ++#ifdef CONFIG_P2P ++ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH)) ++ { ++ #ifdef CONFIG_CONCURRENT_MODE ++ if( pwdinfo->driver_interface == DRIVER_WEXT ) ++ { ++ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) ++ { ++ _set_timer( &pwdinfo->ap_p2p_switch_timer, 500 ); ++ } ++ } ++ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); ++ #else ++ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); ++ #endif ++ } ++ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); ++#endif //CONFIG_P2P ++ ++ pmlmeext->sitesurvey_res.state = SCAN_COMPLETE; ++ ++ //switch back to the original channel ++ //SelectChannel(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset); ++ ++ { ++#ifdef CONFIG_CONCURRENT_MODE ++ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); ++#else ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ dc_set_channel_bwmode_survey_done(padapter); ++#else ++ if( pwdinfo->driver_interface == DRIVER_WEXT ) ++ { ++ if( rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) ) ++ { ++ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ } ++ else ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ } ++ else if( pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ { ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ } ++#endif //CONFIG_DUALMAC_CONCURRENT ++#endif //CONFIG_CONCURRENT_MODE ++ } ++ ++ //flush 4-AC Queue after site_survey ++ //val8 = 0; ++ //rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, (u8 *)(&val8)); ++ ++ //config MSR ++ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); ++ ++ initialgain = 0xff; //restore RX GAIN ++ rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); ++ //turn on dynamic functions ++ Restore_DM_Func_Flag(padapter); ++ //Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, true); ++ ++ if (is_client_associated_to_ap(padapter) == true) ++ { ++ issue_nulldata(padapter, NULL, 0, 3, 500); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if(is_client_associated_to_ap(padapter->pbuddy_adapter) == true) ++ { ++ DBG_871X("adapter is surveydone(buddy_adapter is linked), issue nulldata(pwrbit=0)\n"); ++ ++ issue_nulldata(padapter->pbuddy_adapter, NULL, 0, 3, 500); ++ } ++#endif ++ } ++#ifdef CONFIG_CONCURRENT_MODE ++ else if(is_client_associated_to_ap(padapter->pbuddy_adapter) == true) ++ { ++ issue_nulldata(padapter->pbuddy_adapter, NULL, 0, 3, 500); ++ } ++#endif ++ ++ val8 = 0; //survey done ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ ++ report_surveydone_event(padapter); ++ ++ pmlmeext->chan_scan_time = SURVEY_TO; ++ pmlmeext->sitesurvey_res.state = SCAN_DISABLE; ++ ++ issue_action_BSSCoexistPacket(padapter); ++ issue_action_BSSCoexistPacket(padapter); ++ issue_action_BSSCoexistPacket(padapter); ++ ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if(check_buddy_mlmeinfo_state(padapter, WIFI_FW_AP_STATE) && ++ check_buddy_fwstate(padapter, _FW_LINKED)) ++ { ++ ++ DBG_871X("survey done, current CH=%d, BW=%d, offset=%d\n", cur_channel, cur_bwmode, cur_ch_offset); ++ ++ DBG_871X("restart pbuddy_adapter's beacon\n"); ++ ++ update_beacon(padapter->pbuddy_adapter, 0, NULL, true); ++ } ++#endif ++ ++ } ++ ++ return; ++ ++} ++ ++//collect bss info from Beacon and Probe response frames. +u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSID_EX *bssid) +{ + int i; @@ -42697,8 +28434,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + u16 val16, subtype; + u8 *pframe = precv_frame->u.hdr.rx_data; + u32 packet_len = precv_frame->u.hdr.len; -+ u8 ie_offset; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + @@ -42714,25 +28450,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + subtype = GetFrameSubType(pframe); + -+ if(subtype==WIFI_BEACON) { ++ if(subtype==WIFI_BEACON) + bssid->Reserved[0] = 1; -+ ie_offset = _BEACON_IE_OFFSET_; -+ } else { -+ // FIXME : more type -+ if (subtype == WIFI_PROBERSP) { -+ ie_offset = _PROBERSP_IE_OFFSET_; -+ bssid->Reserved[0] = 3; -+ } -+ else if (subtype == WIFI_PROBEREQ) { -+ ie_offset = _PROBEREQ_IE_OFFSET_; -+ bssid->Reserved[0] = 2; -+ } -+ else { -+ bssid->Reserved[0] = 0; -+ ie_offset = _FIXED_IE_LENGTH_; -+ } -+ } -+ ++ else ++ bssid->Reserved[0] = 0; ++ + bssid->Length = sizeof(WLAN_BSSID_EX) - MAX_IE_SZ + len; + + //below is to copy the information element @@ -42741,8 +28463,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + //get the signal strength + //bssid->Rssi = precv_frame->u.hdr.attrib.SignalStrength; // 0-100 index. -+ bssid->Rssi = precv_frame->u.hdr.attrib.phy_info.RecvSignalPower; // in dBM.raw data -+ bssid->PhyInfo.SignalQuality = precv_frame->u.hdr.attrib.phy_info.SignalQuality;//in percentage ++ bssid->Rssi = precv_frame->u.hdr.attrib.phy_info.RecvSignalPower; // in dBM.raw data ++ bssid->PhyInfo.SignalQuality = precv_frame->u.hdr.attrib.phy_info.SignalQuality;//in percentage + bssid->PhyInfo.SignalStrength = precv_frame->u.hdr.attrib.phy_info.SignalStrength;//in percentage +#ifdef CONFIG_ANTENNA_DIVERSITY + //rtw_hal_get_hwreg(padapter, HW_VAR_CURRENT_ANTENNA, (u8 *)(&bssid->PhyInfo.Optimum_antenna)); @@ -42750,7 +28472,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#endif + + // checking SSID -+ if ((p = rtw_get_ie(bssid->IEs + ie_offset, _SSID_IE_, &len, bssid->IELength - ie_offset)) == NULL) ++ if ((p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _SSID_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_)) == NULL) + { + DBG_871X("marc: cannot find SSID for survey event\n"); + return _FAIL; @@ -42775,7 +28497,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + //checking rate info... + i = 0; -+ p = rtw_get_ie(bssid->IEs + ie_offset, _SUPPORTEDRATES_IE_, &len, bssid->IELength - ie_offset); ++ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _SUPPORTEDRATES_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); + if (p != NULL) + { + if (len > NDIS_802_11_LENGTH_RATES_EX) @@ -42787,7 +28509,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + i = len; + } + -+ p = rtw_get_ie(bssid->IEs + ie_offset, _EXT_SUPPORTEDRATES_IE_, &len, bssid->IELength - ie_offset); ++ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _EXT_SUPPORTEDRATES_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); + if (p != NULL) + { + if (len > (NDIS_802_11_LENGTH_RATES_EX-i)) @@ -42810,38 +28532,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + bssid->NetworkTypeInUse = Ndis802_11OFDM24; + } + -+#ifdef CONFIG_P2P -+ if (subtype == WIFI_PROBEREQ) -+ { -+ u8 *p2p_ie; -+ u32 p2p_ielen; -+ // Set Listion Channel -+ if ((p2p_ie = rtw_get_p2p_ie(bssid->IEs, bssid->IELength, NULL, &p2p_ielen))) -+ { -+ u32 attr_contentlen = 0; -+ u8 listen_ch[5] = { 0x00 }; -+ -+ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_LISTEN_CH, listen_ch, &attr_contentlen); -+ bssid->Configuration.DSConfig = listen_ch[4]; -+ } else -+ { // use current channel -+ bssid->Configuration.DSConfig = padapter->mlmeextpriv.cur_channel; -+ DBG_871X("%s()-%d: Cannot get p2p_ie. set DSconfig to op_ch(%d)\n", __FUNCTION__, __LINE__, bssid->Configuration.DSConfig); -+ } -+ -+ // FIXME -+ bssid->InfrastructureMode = Ndis802_11Infrastructure; -+ _rtw_memcpy(bssid->MacAddress, GetAddr2Ptr(pframe), ETH_ALEN); -+ bssid->Privacy = 1; -+ return _SUCCESS; -+ } -+#endif //CONFIG_P2P -+ + if (bssid->IELength < 12) + return _FAIL; + + // Checking for DSConfig -+ p = rtw_get_ie(bssid->IEs + ie_offset, _DSSET_IE_, &len, bssid->IELength - ie_offset); ++ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _DSSET_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); + + bssid->Configuration.DSConfig = 0; + bssid->Configuration.Length = 0; @@ -42853,7 +28548,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + else + {// In 5G, some ap do not have DSSET IE + // checking HT info for channel -+ p = rtw_get_ie(bssid->IEs + ie_offset, _HT_ADD_INFO_IE_, &len, bssid->IELength - ie_offset); ++ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); + if(p) + { + struct HT_info_element *HT_info = (struct HT_info_element *)(p + 2); @@ -42866,7 +28561,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + + _rtw_memcpy(&bssid->Configuration.BeaconPeriod, rtw_get_beacon_interval_from_ie(bssid->IEs), 2); -+ bssid->Configuration.BeaconPeriod = le32_to_cpu(bssid->Configuration.BeaconPeriod); ++ le16_to_cpup((__le16 *)&bssid->Configuration.BeaconPeriod); + + val16 = rtw_get_capability((WLAN_BSSID_EX *)bssid); + @@ -42889,27 +28584,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + bssid->Configuration.ATIMWindow = 0; + + //20/40 BSS Coexistence check -+ if((pregistrypriv->wifi_spec==1) && (_FALSE == pmlmeinfo->bwmode_updated)) -+ { ++ if((pregistrypriv->wifi_spec==1) && (false == pmlmeinfo->bwmode_updated)) ++ { + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; +#ifdef CONFIG_80211N_HT -+ p = rtw_get_ie(bssid->IEs + ie_offset, _HT_CAPABILITY_IE_, &len, bssid->IELength - ie_offset); -+ if(p && len>0) -+ { ++ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); ++ if(p && len>0) { + struct HT_caps_element *pHT_caps; + pHT_caps = (struct HT_caps_element *)(p + 2); -+ -+ if(pHT_caps->u.HT_cap_element.HT_caps_info&BIT(14)) -+ { ++ ++ if(le16_to_cpu(pHT_caps->u.HT_cap_element.HT_caps_info) & BIT(14)) + pmlmepriv->num_FortyMHzIntolerant++; -+ } + } + else + { + pmlmepriv->num_sta_no_ht++; + } +#endif //CONFIG_80211N_HT -+ ++ + } + +#ifdef CONFIG_INTEL_WIDI @@ -42920,7 +28612,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } +#endif // CONFIG_INTEL_WIDI + -+ #if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) & 1 ++ #if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) & 1 + if(strcmp(bssid->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { + DBG_871X("Receiving %s("MAC_FMT", DSConfig:%u) from ch%u with ss:%3u, sq:%3u, RawRSSI:%3ld\n" + , bssid->Ssid.Ssid, MAC_ARG(bssid->MacAddress), bssid->Configuration.DSConfig @@ -42963,8 +28655,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + val8 = 0xcf; + rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); + -+ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, NULL); -+ + //switch channel + //SelectChannel(padapter, pmlmeext->cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE); + set_channel_bwmode(padapter, pmlmeext->cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); @@ -42991,7 +28681,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + report_join_res(padapter, 1); + pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; -+ rtw_indicate_connect(padapter); + } + } + else @@ -42999,8 +28688,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + DBG_871X("start_create_ibss, invalid cap:%x\n", caps); + return; + } -+ //update bc/mc sta_info -+ update_bmc_sta(padapter); + +} + @@ -43012,7 +28699,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX*)(&(pmlmeinfo->network)); + int beacon_timeout; -+ u8 ASIX_ID[]= {0x00, 0x0E, 0xC6}; ++ ++ pmlmeext->cur_channel = (u8)pnetwork->Configuration.DSConfig; ++ pmlmeinfo->bcn_interval = get_beacon_interval(pnetwork); ++ ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ if(dc_handle_join_request(padapter) == _FAIL) ++ { ++ DBG_871X("dc_handle_join_request fail !!!\n"); ++ return; ++ } ++ //switch channel ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++#elif defined (CONFIG_CONCURRENT_MODE) ++ if(concurrent_chk_start_clnt_join(padapter) == _FAIL) ++ return; ++#else //NON CONCURRENT_MODE ++ //switch channel ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++#endif + + //update wireless mode + update_wireless_mode(padapter); @@ -43020,13 +28725,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + //udpate capability + caps = rtw_get_capability((WLAN_BSSID_EX *)pnetwork); + update_capinfo(padapter, caps); -+ -+ //check if sta is ASIX peer and fix IOT issue if it is. -+ if (_rtw_memcmp(get_my_bssid(&pmlmeinfo->network) ,ASIX_ID ,3)) { -+ u8 iot_flag = _TRUE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_ASIX_IOT, (u8 *)(&iot_flag)); -+ } -+ + if (caps&cap_ESS) + { + Set_MSR(padapter, WIFI_FW_STATION_STATE); @@ -43042,55 +28740,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +#endif + rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); + -+ #ifdef CONFIG_DEAUTH_BEFORE_CONNECT -+ // Because of AP's not receiving deauth before -+ // AP may: 1)not response auth or 2)deauth us after link is complete -+ // issue deauth before issuing auth to deal with the situation -+ -+ // Commented by Albert 2012/07/21 -+ // For the Win8 P2P connection, it will be hard to have a successful connection if this Wi-Fi doesn't connect to it. -+ { -+ #ifdef CONFIG_P2P -+ _queue *queue = &(padapter->mlmepriv.scanned_queue); -+ _list *head = get_list_head(queue); -+ _list *pos = get_next(head); -+ struct wlan_network *scanned = NULL; -+ u8 ie_offset = 0; -+ _irqL irqL; -+ bool has_p2p_ie = _FALSE; -+ -+ _enter_critical_bh(&(padapter->mlmepriv.scanned_queue.lock), &irqL); -+ -+ for (pos = get_next(head);!rtw_end_of_queue_search(head, pos); pos = get_next(pos)) { -+ -+ scanned = LIST_CONTAINOR(pos, struct wlan_network, list); -+ -+ if (_rtw_memcmp(&(scanned->network.Ssid), &(pnetwork->Ssid), sizeof(NDIS_802_11_SSID)) == _TRUE -+ && _rtw_memcmp(scanned->network.MacAddress, pnetwork->MacAddress, sizeof(NDIS_802_11_MAC_ADDRESS)) == _TRUE -+ ) { -+ ie_offset = (scanned->network.Reserved[0] == 2? 0:12); -+ if (rtw_get_p2p_ie(scanned->network.IEs+ie_offset, scanned->network.IELength-ie_offset, NULL, NULL)) -+ has_p2p_ie = _TRUE; -+ break; -+ } -+ } -+ -+ _exit_critical_bh(&(padapter->mlmepriv.scanned_queue.lock), &irqL); -+ -+ if (scanned == NULL || rtw_end_of_queue_search(head, pos) || has_p2p_ie == _FALSE) -+ #endif /* CONFIG_P2P */ -+ //To avoid connecting to AP fail during resume process, change retry count from 5 to 1 -+ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 1, 100); -+ } -+ #endif /* CONFIG_DEAUTH_BEFORE_CONNECT */ ++ //switch channel ++ //set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); + + //here wait for receiving the beacon to start auth + //and enable a timer + beacon_timeout = decide_wait_for_beacon_timeout(pmlmeinfo->bcn_interval); -+ set_link_timer(pmlmeext, beacon_timeout); -+ _set_timer( &padapter->mlmepriv.assoc_timer, ++ set_link_timer(pmlmeext, beacon_timeout); ++ _set_timer( &padapter->mlmepriv.assoc_timer, + (REAUTH_TO * REAUTH_LIMIT) + (REASSOC_TO*REASSOC_LIMIT) +beacon_timeout); -+ ++ + pmlmeinfo->state = WIFI_FW_AUTH_NULL | WIFI_FW_STATION_STATE; + } + else if (caps&cap_IBSS) //adhoc client @@ -43100,6 +28759,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + val8 = 0xcf; + rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); + ++ //switch channel ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ + beacon_timing_control(padapter); + + pmlmeinfo->state = WIFI_FW_ADHOC_STATE; @@ -43131,6 +28793,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pmlmeext->retry = 0; + + ++ // Because of AP's not receiving deauth before ++ // AP may: 1)not response auth or 2)deauth us after link is complete ++ // issue deauth before issuing auth to deal with the situation ++ // Commented by Albert 2012/07/21 ++ // For the Win8 P2P connection, it will be hard to have a successful connection if this Wi-Fi doesn't connect to it. ++ issue_deauth(padapter, (&(pmlmeinfo->network))->MacAddress, WLAN_REASON_DEAUTH_LEAVING); ++ + DBG_871X_LEVEL(_drv_always_, "start auth\n"); + issue_auth(padapter, NULL, 0); + @@ -43159,6 +28828,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + ++ //check A3 + if (!(_rtw_memcmp(MacAddr, get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) + return _SUCCESS; + @@ -43169,15 +28839,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) + { + pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ report_del_sta_event(padapter, MacAddr, reason, _TRUE); ++ report_del_sta_event(padapter, MacAddr, reason); + + } + else if (pmlmeinfo->state & WIFI_FW_LINKING_STATE) + { + pmlmeinfo->state = WIFI_FW_NULL_STATE; + report_join_res(padapter, -2); -+ } else -+ DBG_871X(FUNC_ADPT_FMT" - End to Disconnect\n", FUNC_ADPT_ARG(padapter)); ++ } + } + + return _SUCCESS; @@ -43347,7 +29016,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + if (pregistrypriv->wireless_mode & WIRELESS_11A) + { + do { -+ if ((i >= MAX_CHANNEL_NUM) || ++ if ((i == MAX_CHANNEL_NUM) || + (chplan_sta[i].ChannelNum == 0)) + break; + @@ -43454,7 +29123,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + //5G Bnad 2, 3 (DFS) doesn't change to active scan + if(channel >= 52 && channel <= 144) + break; -+ ++ + chplan_new[i].ScanType = SCAN_ACTIVE; + RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, + ("%s: change channel %d scan type from passive to active\n", @@ -43490,7 +29159,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + pmlmeext = &padapter->mlmeextpriv; + pcmdpriv = &padapter->cmdpriv; -+ ++ + + if ((pcmd_obj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) + { @@ -43578,7 +29247,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + psurveydone_evt = (struct surveydone_event*)(pevtcmd + sizeof(struct C2HEvent_Header)); + psurveydone_evt->bss_cnt = pmlmeext->sitesurvey_res.bss_cnt; + -+ DBG_871X("survey done event(%x) band:%d for "ADPT_FMT"\n", psurveydone_evt->bss_cnt, padapter->setband, ADPT_ARG(padapter)); ++ DBG_871X("survey done event(%x)\n", psurveydone_evt->bss_cnt); + + rtw_enqueue_cmd(pcmdpriv, pcmd_obj); + @@ -43625,29 +29294,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + pjoinbss_evt = (struct joinbss_event*)(pevtcmd + sizeof(struct C2HEvent_Header)); + _rtw_memcpy((unsigned char *)(&(pjoinbss_evt->network.network)), &(pmlmeinfo->network), sizeof(WLAN_BSSID_EX)); -+ pjoinbss_evt->network.join_res = pjoinbss_evt->network.aid = res; ++ pjoinbss_evt->network.join_res = pjoinbss_evt->network.aid = res; + + DBG_871X("report_join_res(%d)\n", res); -+ -+ ++ ++ + rtw_joinbss_event_prehandle(padapter, (u8 *)&pjoinbss_evt->network); -+ -+ ++ ++ + rtw_enqueue_cmd(pcmdpriv, pcmd_obj); + + return; + +} + -+void report_wmm_edca_update(_adapter *padapter) ++void report_del_sta_event(_adapter *padapter, unsigned char* MacAddr, unsigned short reason) +{ + struct cmd_obj *pcmd_obj; + u8 *pevtcmd; + u32 cmdsz; -+ struct wmm_event *pwmm_event; ++ struct sta_info *psta; ++ int mac_id; ++ struct stadel_event *pdel_sta_evt; + struct C2HEvent_Header *pc2h_evt_hdr; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + + if ((pcmd_obj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) @@ -43655,7 +29325,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return; + } + -+ cmdsz = (sizeof(struct wmm_event) + sizeof(struct C2HEvent_Header)); ++ cmdsz = (sizeof(struct stadel_event) + sizeof(struct C2HEvent_Header)); + if ((pevtcmd = (u8*)rtw_zmalloc(cmdsz)) == NULL) + { + rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); @@ -43672,41 +29342,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pcmd_obj->rspsz = 0; + + pc2h_evt_hdr = (struct C2HEvent_Header*)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct wmm_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_WMM); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ pwmm_event = (struct wmm_event*)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ pwmm_event->wmm =0; -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+ -+} -+ -+void report_del_sta_event(_adapter *padapter, unsigned char *MacAddr, unsigned short reason, bool enqueue) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct sta_info *psta; -+ int mac_id = -1; -+ struct stadel_event *pdel_sta_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ /* prepare cmd parameter */ -+ cmdsz = (sizeof(struct stadel_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header*)(pevtcmd); + pc2h_evt_hdr->len = sizeof(struct stadel_event); + pc2h_evt_hdr->ID = GEN_EVT_CODE(_DelSTA); + pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); @@ -43714,40 +29349,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pdel_sta_evt = (struct stadel_event*)(pevtcmd + sizeof(struct C2HEvent_Header)); + _rtw_memcpy((unsigned char *)(&(pdel_sta_evt->macaddr)), MacAddr, ETH_ALEN); + _rtw_memcpy((unsigned char *)(pdel_sta_evt->rsvd),(unsigned char *)(&reason),2); ++ ++ + psta = rtw_get_stainfo(&padapter->stapriv, MacAddr); + if(psta) -+ mac_id = (int)psta->mac_id; ++ mac_id = (int)psta->mac_id; + else + mac_id = (-1); ++ + pdel_sta_evt->mac_id = mac_id; + -+ if (!enqueue) { -+ /* do directly */ -+ rtw_stadel_event_callback(padapter, (u8 *)pdel_sta_evt); -+ rtw_mfree(pevtcmd, cmdsz); -+ } else { -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) { -+ rtw_mfree(pevtcmd, cmdsz); -+ res = _FAIL; -+ goto exit; -+ } ++ DBG_871X("report_del_sta_event: delete STA, mac_id=%d\n", mac_id); + -+ _rtw_init_listhead(&pcmd_obj->list); -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ } -+ -+exit: -+ -+ DBG_871X(FUNC_ADPT_FMT" "MAC_FMT" mac_id=%d, enqueue:%d, res:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(MacAddr), mac_id, enqueue, res); ++ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); + + return; +} @@ -43800,97 +29414,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +} + + -+bool rtw_port_switch_chk(_adapter *adapter) -+{ -+ bool switch_needed = _FALSE; -+#ifdef CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_RUNTIME_PORT_SWITCH -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(dvobj); -+ _adapter *if_port0 = NULL; -+ _adapter *if_port1 = NULL; -+ struct mlme_ext_info *if_port0_mlmeinfo = NULL; -+ struct mlme_ext_info *if_port1_mlmeinfo = NULL; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (get_iface_type(dvobj->padapters[i]) == IFACE_PORT0) { -+ if_port0 = dvobj->padapters[i]; -+ if_port0_mlmeinfo = &(if_port0->mlmeextpriv.mlmext_info); -+ } -+ else if (get_iface_type(dvobj->padapters[i]) == IFACE_PORT1) { -+ if_port1 = dvobj->padapters[i]; -+ if_port1_mlmeinfo = &(if_port1->mlmeextpriv.mlmext_info); -+ } -+ } -+ -+ if (if_port0 == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (if_port1 == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+#ifdef DBG_RUNTIME_PORT_SWITCH -+ DBG_871X(FUNC_ADPT_FMT" wowlan_mode:%u\n" -+ ADPT_FMT", port0, mlmeinfo->state:0x%08x, p2p_state:%d, %d\n" -+ ADPT_FMT", port1, mlmeinfo->state:0x%08x, p2p_state:%d, %d\n", -+ FUNC_ADPT_ARG(adapter), pwrctl->wowlan_mode, -+ ADPT_ARG(if_port0), if_port0_mlmeinfo->state, rtw_p2p_state(&if_port0->wdinfo), rtw_p2p_chk_state(&if_port0->wdinfo, P2P_STATE_NONE), -+ ADPT_ARG(if_port1), if_port1_mlmeinfo->state, rtw_p2p_state(&if_port1->wdinfo), rtw_p2p_chk_state(&if_port1->wdinfo, P2P_STATE_NONE)); -+#endif /* DBG_RUNTIME_PORT_SWITCH */ -+ -+#ifdef CONFIG_WOWLAN -+ /* WOWLAN interface(primary, for now) should be port0 */ -+ if (pwrctl->wowlan_mode == _TRUE) { -+ if(!is_primary_adapter(if_port0)) { -+ DBG_871X("%s "ADPT_FMT" enable WOWLAN\n", __func__, ADPT_ARG(if_port1)); -+ switch_needed = _TRUE; -+ } -+ goto exit; -+ } -+#endif /* CONFIG_WOWLAN */ -+ -+ /* AP should use port0 for ctl frame's ack */ -+ if ((if_port1_mlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { -+ DBG_871X("%s "ADPT_FMT" is AP/GO\n", __func__, ADPT_ARG(if_port1)); -+ switch_needed = _TRUE; -+ goto exit; -+ } -+ -+ /* GC should use port0 for p2p ps */ -+ if (((if_port1_mlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) -+ && (if_port1_mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ && !rtw_p2p_chk_state(&if_port1->wdinfo, P2P_STATE_NONE) -+ && !check_fwstate(&if_port1->mlmepriv, WIFI_UNDER_WPS) -+ ) { -+ DBG_871X("%s "ADPT_FMT" is GC\n", __func__, ADPT_ARG(if_port1)); -+ switch_needed = _TRUE; -+ goto exit; -+ } -+ -+ /* port1 linked, but port0 not linked */ -+ if ((if_port1_mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ && !(if_port0_mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ && ((if_port0_mlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) -+ ) { -+ DBG_871X("%s "ADPT_FMT" is SINGLE_LINK\n", __func__, ADPT_ARG(if_port1)); -+ switch_needed = _TRUE; -+ goto exit; -+ } -+ -+exit: -+#ifdef DBG_RUNTIME_PORT_SWITCH -+ DBG_871X(FUNC_ADPT_FMT" ret:%d\n", FUNC_ADPT_ARG(adapter), switch_needed); -+#endif /* DBG_RUNTIME_PORT_SWITCH */ -+#endif /* CONFIG_RUNTIME_PORT_SWITCH */ -+#endif /* CONFIG_CONCURRENT_MODE */ -+ return switch_needed; -+} -+ +/**************************************************************************** + +Following are the event callback functions @@ -43912,174 +29435,62 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + //HT + if(pmlmepriv->htpriv.ht_option) + { -+ psta->htpriv.ht_option = _TRUE; ++ psta->htpriv.ht_option = true; + + psta->htpriv.ampdu_enable = pmlmepriv->htpriv.ampdu_enable; + -+ psta->htpriv.rx_ampdu_min_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para&IEEE80211_HT_CAP_AMPDU_DENSITY)>>2; ++ if (support_short_GI(padapter, &(pmlmeinfo->HT_caps))) ++ psta->htpriv.sgi = true; + -+ if (support_short_GI(padapter, &(pmlmeinfo->HT_caps), CHANNEL_WIDTH_20)) -+ psta->htpriv.sgi_20m = _TRUE; ++ psta->qos_option = true; + -+ if (support_short_GI(padapter, &(pmlmeinfo->HT_caps), CHANNEL_WIDTH_40)) -+ psta->htpriv.sgi_40m = _TRUE; -+ -+ psta->qos_option = _TRUE; -+ -+ psta->htpriv.ldpc_cap = pmlmepriv->htpriv.ldpc_cap; -+ psta->htpriv.stbc_cap = pmlmepriv->htpriv.stbc_cap; -+ psta->htpriv.beamform_cap = pmlmepriv->htpriv.beamform_cap; -+ -+ _rtw_memcpy(&psta->htpriv.ht_cap, &pmlmeinfo->HT_caps, sizeof(struct rtw_ieee80211_ht_cap)); + } + else +#endif //CONFIG_80211N_HT + { +#ifdef CONFIG_80211N_HT -+ psta->htpriv.ht_option = _FALSE; ++ psta->htpriv.ht_option = false; + -+ psta->htpriv.ampdu_enable = _FALSE; -+ -+ psta->htpriv.sgi_20m = _FALSE; -+ psta->htpriv.sgi_40m = _FALSE; ++ psta->htpriv.ampdu_enable = false; ++ ++ psta->htpriv.sgi = false; +#endif //CONFIG_80211N_HT -+ psta->qos_option = _FALSE; ++ psta->qos_option = false; + + } -+ +#ifdef CONFIG_80211N_HT ++ psta->htpriv.bwmode = pmlmeext->cur_bwmode; + psta->htpriv.ch_offset = pmlmeext->cur_ch_offset; -+ ++ + psta->htpriv.agg_enable_bitmap = 0x0;//reset + psta->htpriv.candidate_tid_bitmap = 0x0;//reset +#endif //CONFIG_80211N_HT + -+ psta->bw_mode = pmlmeext->cur_bwmode; -+ + //QoS + if(pmlmepriv->qospriv.qos_option) -+ psta->qos_option = _TRUE; ++ psta->qos_option = true; + +#ifdef CONFIG_80211AC_VHT ++ if (pmlmepriv->vhtpriv.bwmode < CHANNEL_WIDTH_80) ++ pmlmepriv->vhtpriv.sgi = psta->htpriv.sgi; + _rtw_memcpy(&psta->vhtpriv, &pmlmepriv->vhtpriv, sizeof(struct vht_priv)); +#endif //CONFIG_80211AC_VHT + -+ update_ldpc_stbc_cap(psta); -+ + _enter_critical_bh(&psta->lock, &irqL); + psta->state = _FW_LINKED; + _exit_critical_bh(&psta->lock, &irqL); + +} + -+static void rtw_mlmeext_disconnect(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX*)(&(pmlmeinfo->network)); -+ u8 state_backup = (pmlmeinfo->state&0x03); -+ u8 ASIX_ID[]= {0x00, 0x0E, 0xC6}; -+ -+ //set_opmode_cmd(padapter, infra_client_with_mlme); -+ -+#if 1 -+ /* -+ * For safety, prevent from keeping macid sleep. -+ * If we can sure all power mode enter/leave are paired, -+ * this check can be removed. -+ * Lucas@20131113 -+ */ -+ /* wakeup macid after disconnect. */ -+ { -+ struct sta_info *psta; -+ psta = rtw_get_stainfo(&padapter->stapriv, get_my_bssid(pnetwork)); -+ if (psta) -+ rtw_hal_macid_wakeup(padapter, psta->mac_id); -+ } -+#endif -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, 0); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); -+ -+ //set MSR to no link state -> infra. mode -+ Set_MSR(padapter, _HW_STATE_STATION_); -+ -+ //check if sta is ASIX peer and fix IOT issue if it is. -+ if (_rtw_memcmp(get_my_bssid(&pmlmeinfo->network) ,ASIX_ID ,3)) { -+ u8 iot_flag = _FALSE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_ASIX_IOT, (u8 *)(&iot_flag)); -+ } -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+ if(state_backup == WIFI_FW_STATION_STATE) -+ { -+ if (rtw_port_switch_chk(padapter) == _TRUE) { -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); -+ #ifdef CONFIG_LPS -+ { -+ _adapter *port0_iface = dvobj_get_port0_adapter(adapter_to_dvobj(padapter)); -+ if (port0_iface) -+ rtw_lps_ctrl_wk_cmd(port0_iface, LPS_CTRL_CONNECT, 0); -+ } -+ #endif -+ } -+ } -+ -+ /* switch to the 20M Hz mode after disconnect */ -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+#ifdef CONFIG_FCS_MODE -+ if (EN_FCS(padapter)) -+ rtw_hal_set_hwreg(padapter, HW_VAR_STOP_FCS_MODE, NULL); -+#endif -+ -+#ifdef CONFIG_DFS_MASTER -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ rtw_dfs_master_status_apply(padapter, MLME_AP_STOPPED); -+ else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ rtw_dfs_master_status_apply(padapter, MLME_STA_DISCONNECTED); -+#endif -+ -+ { -+ u8 ch, bw, offset; -+ -+ if (rtw_get_ch_setting_union_no_self(padapter, &ch, &bw, &offset) != 0) -+ set_channel_bwmode(padapter, ch, offset, bw); -+ } -+ -+ flush_all_cam_entry(padapter); -+ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ //pmlmepriv->LinkDetectInfo.TrafficBusyState = _FALSE; -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; -+ -+#ifdef CONFIG_TDLS -+ padapter->tdlsinfo.ap_prohibited = _FALSE; -+ -+ /* For TDLS channel switch, currently we only allow it to work in wifi logo test mode */ -+ if (padapter->registrypriv.wifi_spec == 1) -+ { -+ padapter->tdlsinfo.ch_switch_prohibited = _FALSE; -+ } -+#endif /* CONFIG_TDLS */ -+ -+} -+ +void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) +{ + struct sta_info *psta, *psta_bmc; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + struct sta_priv *pstapriv = &padapter->stapriv; + u8 join_type; -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#endif ++ u16 media_status; + + if(join_res < 0) + { @@ -44089,19 +29500,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + goto exit_mlmeext_joinbss_event_callback; + } -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ pmlmepriv->bGetGateway = 1; -+#endif + + if((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) + { -+ //update bc/mc sta_info -+ update_bmc_sta(padapter); ++ //for bc/mc ++ psta_bmc = rtw_get_bcmc_stainfo(padapter); ++ if(psta_bmc) ++ { ++ pmlmeinfo->FW_sta_info[psta_bmc->mac_id].psta = psta_bmc; ++ update_bmc_sta_support_rate(padapter, psta_bmc->mac_id); ++ Update_RA_Entry(padapter, psta_bmc); ++ } + } + + + //turn on dynamic functions -+ /* Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, _TRUE); */ ++ Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, true); + + // update IOT-releated issue + update_IOT_info(padapter); @@ -44125,6 +29539,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + VHTOnAssocRsp(padapter); +#endif + ++#ifndef CONFIG_CONCURRENT_MODE ++ // Call set_channel_bwmode when the CONFIG_CONCURRENT_MODE doesn't be defined. ++ //Set cur_channel&cur_bwmode&cur_ch_offset ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++#endif ++ + psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); + if (psta) //only for infra. mode + { @@ -44133,20 +29553,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + //DBG_871X("set_sta_rate\n"); + + psta->wireless_mode = pmlmeext->cur_wireless_mode; -+ ++ + //set per sta rate after updating HT cap. + set_sta_rate(padapter, psta); -+ -+ rtw_sta_media_status_rpt(padapter, psta, 1); + -+ /* wakeup macid after join bss successfully to ensure -+ the subsequent data frames can be sent out normally */ -+ rtw_hal_macid_wakeup(padapter, psta->mac_id); ++ #if (RATE_ADAPTIVE_SUPPORT==1) //for 88E RA ++ rtw_hal_set_hwreg(padapter,HW_VAR_TX_RPT_MAX_MACID, (u8*)&psta->mac_id); ++ #endif ++ media_status = (psta->mac_id<<8)|1; // MACID|OPMODE: 1 means connect ++ rtw_hal_set_hwreg(padapter,HW_VAR_H2C_MEDIA_STATUS_RPT,(u8 *)&media_status); + } + -+ if (rtw_port_switch_chk(padapter) == _TRUE) -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); -+ + join_type = 2; + rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); + @@ -44154,25 +29571,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + // correcting TSF + correct_TSF(padapter, pmlmeext); -+ ++ + //set_link_timer(pmlmeext, DISCONNECT_TO); + } + +#ifdef CONFIG_LPS -+ if(get_iface_type(padapter) == IFACE_PORT0) ++#ifdef CONFIG_CONCURRENT_MODE ++ if(padapter->iface_type == IFACE_PORT0) ++#endif + rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_CONNECT, 0); +#endif + -+#ifdef CONFIG_BEAMFORMING -+ if (psta) -+ beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_ENTER, (u8 *)psta, sizeof(struct sta_info), 0); -+#endif/*CONFIG_BEAMFORMING*/ -+ +exit_mlmeext_joinbss_event_callback: + -+ rtw_join_done_chk_ch(padapter, join_res); ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ dc_handle_join_done(padapter, join_res); ++#endif ++#ifdef CONFIG_CONCURRENT_MODE ++ concurrent_chk_joinbss_done(padapter, join_res); ++#endif ++ ++ DBG_871X("=>%s\n", __FUNCTION__); + -+ DBG_871X("=>%s - End to Connection without 4-way\n", __FUNCTION__); +} + +//currently only adhoc mode will go here @@ -44193,7 +29613,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + else//adhoc client + { + //update TSF Value -+ //update_TSF(pmlmeext, pframe, len); ++ //update_TSF(pmlmeext, pframe, len); + + // correcting TSF + correct_TSF(padapter, pmlmeext); @@ -44209,7 +29629,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + + pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; -+ ++ + } + + join_type = 2; @@ -44218,20 +29638,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta; + -+ psta->bssratelen = rtw_get_rateset_len(pmlmeinfo->FW_sta_info[psta->mac_id].SupportedRates); -+ _rtw_memcpy(psta->bssrateset, pmlmeinfo->FW_sta_info[psta->mac_id].SupportedRates, psta->bssratelen); ++ //rate radaptive ++ Update_RA_Entry(padapter, psta); + + //update adhoc sta_info + update_sta_info(padapter, psta); + -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ -+ // ToDo: HT for Ad-hoc -+ psta->wireless_mode = rtw_check_network_type(psta->bssrateset, psta->bssratelen, pmlmeext->cur_channel); -+ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); -+ -+ //rate radaptive -+ Update_RA_Entry(padapter, psta); +} + +void mlmeext_sta_del_event_callback(_adapter *padapter) @@ -44241,7 +29653,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + if (is_client_associated_to_ap(padapter) || is_IBSS_empty(padapter)) + { -+ rtw_mlmeext_disconnect(padapter); ++ //set_opmode_cmd(padapter, infra_client_with_mlme); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, NULL); ++ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); ++ ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ dc_set_channel_bwmode_disconnect(padapter); ++#else ++#ifdef CONFIG_CONCURRENT_MODE ++ if((check_buddy_fwstate(padapter, _FW_LINKED)) != true) ++ { ++#endif //CONFIG_CONCURRENT_MODE ++ ++ //switch to the 20M Hz mode after disconnect ++ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ //SelectChannel(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset); ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ } ++#endif //CONFIG_CONCURRENT_MODE ++#endif //CONFIG_DUALMAC_CONCURRENT ++ ++ flush_all_cam_entry(padapter); ++ ++ pmlmeinfo->state = WIFI_FW_NULL_STATE; ++ ++ //set MSR to no link state -> infra. mode ++ Set_MSR(padapter, _HW_STATE_STATION_); ++ ++ _cancel_timer_ex(&pmlmeext->link_timer); ++ + } + +} @@ -44251,112 +29696,63 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +Following are the functions for the timer handlers + +*****************************************************************************/ ++void _linked_info_dump(_adapter *padapter); +void _linked_info_dump(_adapter *padapter) +{ -+ int i; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int UndecoratedSmoothedPWDB = 0; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ u8 mac_id; ++ int UndecoratedSmoothedPWDB; ++ #if 0 ++ DBG_871X("============ linked status check ===================\n"); ++ DBG_871X("pathA Rx SNRdb:%d, pathB Rx SNRdb:%d\n",padapter->recvpriv.RxSNRdB[0], padapter->recvpriv.RxSNRdB[1]); ++ DBG_871X("pathA Rx PWDB:%d\n",padapter->recvpriv.rxpwdb); ++ rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); ++ DBG_871X("UndecoratedSmoothedPWDB:%d\n",UndecoratedSmoothedPWDB); ++ DBG_871X("Rx RSSI:%d\n",padapter->recvpriv.rssi); ++ DBG_871X("Rx Signal_strength:%d\n",padapter->recvpriv.signal_strength); ++ DBG_871X("Rx Signal_qual:%d \n",padapter->recvpriv.signal_qual); ++ if ( check_fwstate( &padapter->mlmepriv, _FW_LINKED ) ) ++ { ++ DBG_871X("bw mode: %d, channel: %d\n", padapter->mlmeextpriv.cur_bwmode, padapter->mlmeextpriv.cur_channel ); ++ DBG_871X("received bytes = %d\n", (u32) (padapter->recvpriv.rx_bytes - padapter->recvpriv.last_rx_bytes ) ); ++ } ++ DBG_871X("============ linked status check ===================\n"); ++ DBG_871X("============ RX GAIN / false ALARM ===================\n"); ++ DBG_871X(" DIG PATH-A(0x%02x), PATH-B(0x%02x)\n",rtw_read8(padapter,0xc50),rtw_read8(padapter,0xc58)); ++ DBG_871X(" OFDM -Alarm DA2(0x%04x),DA4(0x%04x),DA6(0x%04x),DA8(0x%04x)\n", ++ rtw_read16(padapter,0xDA2),rtw_read16(padapter,0xDA4),rtw_read16(padapter,0xDA6),rtw_read16(padapter,0xDA8)); ++ ++ DBG_871X(" CCK -Alarm A5B(0x%02x),A5C(0x%02x)\n",rtw_read8(padapter,0xA5B),rtw_read8(padapter,0xA5C)); ++ #endif ++ ++ if((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) ++ { ++ mac_id=0; ++ } ++ else if((pmlmeinfo->state&0x03) == _HW_STATE_AP_) ++ { ++ mac_id=2; ++ } + if(padapter->bLinkInfoDump){ -+ -+ DBG_871X("\n============["ADPT_FMT"] linked status check ===================\n",ADPT_ARG(padapter)); -+ -+ if((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) -+ { -+ rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); -+ -+ DBG_871X("AP[" MAC_FMT "] - UndecoratedSmoothedPWDB:%d\n", -+ MAC_ARG(padapter->mlmepriv.cur_network.network.MacAddress),UndecoratedSmoothedPWDB); -+ } -+ else if((pmlmeinfo->state&0x03) == _HW_STATE_AP_) -+ { -+ _irqL irqL; -+ _list *phead, *plist; -+ -+ struct sta_info *psta=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ DBG_871X("STA[" MAC_FMT "]:UndecoratedSmoothedPWDB:%d\n", -+ MAC_ARG(psta->hwaddr),psta->rssi_stat.UndecoratedSmoothedPWDB); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ } -+ for(i=0; inum; i++) -+ { -+ if(rtw_macid_is_used(macid_ctl, i) -+ && !rtw_macid_is_bmc(macid_ctl, i) /* skip bc/mc sta */ -+ ) { -+ //============ tx info ============ -+ rtw_hal_get_def_var(padapter, HW_DEF_RA_INFO_DUMP, &i); -+ } -+ } -+ rtw_hal_set_odm_var(padapter, HAL_ODM_RX_INFO_DUMP, NULL, _FALSE); -+ ++ DBG_871X("\n============ linked status check ===================\n"); ++ rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); ++ DBG_871X("UndecoratedSmoothedPWDB:%d\n",UndecoratedSmoothedPWDB); + } -+ ++ ++ //============ tx info ============ ++ rtw_hal_get_def_var(padapter, HW_DEF_RA_INFO_DUMP,&mac_id); ++ ++ //============ rx info ============ ++ rtw_hal_set_def_var(padapter, HW_DEF_FA_CNT_DUMP,&mac_id); ++ ++ + +} -+void rtw_delba_check(_adapter *padapter, struct sta_info *psta, u8 from_timer) ++ ++static u8 chk_ap_is_alive(_adapter *padapter, struct sta_info *psta) +{ -+ int i = 0; -+ int ret = _SUCCESS; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* -+ IOT issue,occur Broadcom ap(Buffalo WZR-D1800H,Netgear R6300). -+ AP is originator.AP does not transmit unicast packets when STA response its BAR. -+ This case probably occur ap issue BAR after AP builds BA. -+ -+ Follow 802.11 spec, STA shall maintain an inactivity timer for every negotiated Block Ack setup. -+ The inactivity timer is not reset when MPDUs corresponding to other TIDs are received. -+ */ -+ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_BROADCOM) { -+ for (i = 0; i < TID_NUM ; i++) { -+ if (sta_rx_data_qos_pkts(psta, i) == sta_last_rx_data_qos_pkts(psta, i)) { -+ if (_TRUE == rtw_inc_and_chk_continual_no_rx_packet(psta, i)) { -+ if (psta->recvreorder_ctrl[i].enable) { -+ /* send a DELBA frame to the peer STA with the Reason Code field set to TIMEOUT */ -+ if (!from_timer) -+ ret = issue_del_ba_ex(padapter, psta->hwaddr, i, 39, 0, 3, 1); -+ else -+ { -+ issue_del_ba(padapter, psta->hwaddr, i, 39, 0); -+ psta->recvreorder_ctrl[i].enable = _FALSE; -+ } -+ -+ if (ret != _FAIL) -+ { -+ psta->recvreorder_ctrl[i].ampdu_size = RX_AMPDU_SIZE_INVALID; -+ rtw_reset_continual_no_rx_packet(psta, i); -+ } -+ } -+ } -+ } -+ else{ -+ /* The inactivity timer is reset when MPDUs to the TID is received. */ -+ rtw_reset_continual_no_rx_packet(psta, i); -+ } -+ } -+ } -+} -+ -+u8 chk_ap_is_alive(_adapter *padapter, struct sta_info *psta) -+{ -+ u8 ret = _FALSE; -+ int i = 0; ++ u8 ret = false; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + @@ -44386,124 +29782,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + && sta_rx_probersp_pkts(psta) == sta_last_rx_probersp_pkts(psta) + ) + { -+ ret = _FALSE; ++ ret = false; + } + else + { -+ ret = _TRUE; ++ ret = true; + } + + sta_update_last_rx_pkts(psta); + -+ /* -+ record last rx data packets for every tid. -+ */ -+ for (i = 0; i < TID_NUM; i++) -+ psta->sta_stats.last_rx_data_qos_pkts[i] = psta->sta_stats.rx_data_qos_pkts[i]; -+ + return ret; +} + -+#ifdef CONFIG_TDLS -+u8 chk_tdls_peer_sta_is_alive(_adapter *padapter, struct sta_info *psta) -+{ -+ if ((psta->sta_stats.rx_data_pkts == psta->sta_stats.last_rx_data_pkts) -+ && (psta->sta_stats.rx_tdls_disc_rsp_pkts == psta->sta_stats.last_rx_tdls_disc_rsp_pkts)) -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+void linked_status_chk_tdls(_adapter *padapter) -+{ -+struct candidate_pool{ -+ struct sta_info *psta; -+ u8 addr[ETH_ALEN]; -+}; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ _irqL irqL; -+ u8 ack_chk; -+ struct sta_info *psta; -+ int i, num_teardown=0, num_checkalive=0; -+ _list *plist, *phead; -+ struct tdls_txmgmt txmgmt; -+ struct candidate_pool checkalive[NUM_STA]; -+ struct candidate_pool teardown[NUM_STA]; -+#define ALIVE_MIN 2 -+#define ALIVE_MAX 5 -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ _rtw_memset(checkalive, 0x00, sizeof(checkalive)); -+ _rtw_memset(teardown, 0x00, sizeof(teardown)); -+ -+ if((padapter->tdlsinfo.link_established == _TRUE)){ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for(i=0; i< NUM_STA; i++) -+ { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ plist = get_next(plist); -+ -+ if(psta->tdls_sta_state & TDLS_LINKED_STATE) -+ { -+ psta->alive_count++; -+ if(psta->alive_count >= ALIVE_MIN) -+ { -+ if (chk_tdls_peer_sta_is_alive(padapter, psta) == _FALSE) { -+ if (psta->alive_count < ALIVE_MAX) { -+ _rtw_memcpy(checkalive[num_checkalive].addr, psta->hwaddr, ETH_ALEN); -+ checkalive[num_checkalive].psta = psta; -+ num_checkalive++; -+ } -+ else -+ { -+ _rtw_memcpy(teardown[num_teardown].addr, psta->hwaddr, ETH_ALEN); -+ teardown[num_teardown].psta = psta; -+ num_teardown++; -+ } -+ } -+ else -+ { -+ psta->alive_count = 0; -+ } -+ } -+ psta->sta_stats.last_rx_data_pkts = psta->sta_stats.rx_data_pkts; -+ psta->sta_stats.last_rx_tdls_disc_rsp_pkts = psta->sta_stats.rx_tdls_disc_rsp_pkts; -+ } -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ if (num_checkalive > 0) { -+ for (i = 0; i < num_checkalive; i++) { -+ _rtw_memcpy(txmgmt.peer, checkalive[i].addr, ETH_ALEN); -+ issue_tdls_dis_req(padapter, &txmgmt); -+ issue_tdls_dis_req(padapter, &txmgmt); -+ issue_tdls_dis_req(padapter, &txmgmt); -+ } -+ } -+ -+ if(num_teardown > 0) -+ { -+ for(i=0; i< num_teardown; i++) -+ { -+ DBG_871X("[%s %d] Send teardown to "MAC_FMT" \n", __FUNCTION__, __LINE__, MAC_ARG(teardown[i].addr)); -+ txmgmt.status_code = _RSON_TDLS_TEAR_TOOFAR_; -+ _rtw_memcpy(txmgmt.peer, teardown[i].addr, ETH_ALEN); -+ issue_tdls_teardown(padapter, &txmgmt, _FALSE); -+ } -+ } -+ } -+ -+} -+#endif //CONFIG_TDLS -+ -+//from_timer == 1 means driver is in LPS -+void linked_status_chk(_adapter *padapter, u8 from_timer) ++void linked_status_chk(_adapter *padapter) +{ + u32 i; + struct sta_info *psta; @@ -44511,10 +29802,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct sta_priv *pstapriv = &padapter->stapriv; -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#endif -+ ++ ++ _linked_info_dump(padapter); ++ ++ #ifdef DBG_CONFIG_ERROR_DETECT ++ rtw_hal_sreset_linked_status_check(padapter); ++ #endif + + if (is_client_associated_to_ap(padapter)) + { @@ -44522,71 +29815,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + int tx_chk = _SUCCESS, rx_chk = _SUCCESS; + int rx_chk_limit; -+ int link_count_limit; + + #if defined(DBG_ROAMING_TEST) + rx_chk_limit = 1; -+ #elif defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && !defined(CONFIG_LPS_LCLK_WD_TIMER) ++ #elif defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) + rx_chk_limit = 4; + #else + rx_chk_limit = 8; + #endif -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ if (!from_timer && pmlmepriv->bGetGateway == 1) { -+ DBG_871X("do rtw_gw_addr_query()"); -+ if (rtw_gw_addr_query(padapter) == 0) { -+ pmlmepriv->bGetGateway = 0; -+ } else { -+ _rtw_memset(pmlmepriv->gw_ip, 0, 4); -+ _rtw_memset(pmlmepriv->gw_mac_addr, 0, 6); -+ } -+ } -+#endif -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE)) -+ { -+ if(!from_timer) -+ link_count_limit = 3; // 8 sec -+ else -+ link_count_limit = 15; // 32 sec -+ } -+ else -+#endif // CONFIG_P2P -+ { -+ if(!from_timer) -+ link_count_limit = 7; // 16 sec -+ else -+ link_count_limit = 29; // 60 sec -+ } + -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ if (ATOMIC_READ(&padapter->tdlsinfo.chsw_info.chsw_on) == _TRUE) -+ return; -+#endif /* CONFIG_TDLS_CH_SW */ -+ -+#ifdef CONFIG_TDLS_AUTOCHECKALIVE -+ linked_status_chk_tdls(padapter); -+#endif /* CONFIG_TDLS_AUTOCHECKALIVE */ -+#endif /* CONFIG_TDLS */ ++ #ifdef CONFIG_INTEL_WIDI ++ if (padapter->mlmepriv.widi_state != INTEL_WIDI_STATE_NONE) ++ rx_chk_limit = 1; ++ #endif + + if ((psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress)) != NULL) + { -+ bool is_p2p_enable = _FALSE; ++ bool is_p2p_enable = false; + #ifdef CONFIG_P2P + is_p2p_enable = !rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE); + #endif + -+ /*issue delba when ap does not tx data packet that is Broadcom ap */ -+ rtw_delba_check(padapter, psta, from_timer); -+ -+ if (chk_ap_is_alive(padapter, psta) == _FALSE) ++ if (chk_ap_is_alive(padapter, psta) == false) + rx_chk = _FAIL; + + if (pxmitpriv->last_tx_pkts == pxmitpriv->tx_pkts) + tx_chk = _FAIL; + -+ #if defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && !defined(CONFIG_LPS_LCLK_WD_TIMER) ++ #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK + if (pmlmeext->active_keep_alive_check && (rx_chk == _FAIL || tx_chk == _FAIL)) { + u8 backup_oper_channel=0; + @@ -44597,9 +29853,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + + if (rx_chk != _SUCCESS) -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, psta->hwaddr, 0, 0, 3, 1); ++ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, psta->hwaddr, 3, 1); + -+ if ((tx_chk != _SUCCESS && pmlmeinfo->link_count++ == link_count_limit) || rx_chk != _SUCCESS) { ++ if ((tx_chk != _SUCCESS && pmlmeinfo->link_count++ == 0xf) || rx_chk != _SUCCESS) { + tx_chk = issue_nulldata(padapter, psta->hwaddr, 0, 3, 1); + /* if tx acked and p2p disabled, set rx_chk _SUCCESS to reset retry count */ + if (tx_chk == _SUCCESS && !is_p2p_enable) @@ -44619,17 +29875,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + #ifdef DBG_EXPIRATION_CHK + DBG_871X("issue_probereq to trigger probersp, retry=%d\n", pmlmeext->retry); + #endif -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); ++ issue_probereq(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress); ++ issue_probereq(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress); ++ issue_probereq(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress); + } + } + -+ if (tx_chk != _SUCCESS && pmlmeinfo->link_count++ == link_count_limit) { ++ if (tx_chk != _SUCCESS && pmlmeinfo->link_count++ == 0xf) { + #ifdef DBG_EXPIRATION_CHK -+ DBG_871X("%s issue_nulldata(%d)\n", __FUNCTION__, from_timer?1:0); ++ DBG_871X("%s issue_nulldata 0\n", __FUNCTION__); + #endif -+ tx_chk = issue_nulldata_in_interrupt(padapter, NULL, from_timer?1:0); ++ tx_chk = issue_nulldata(padapter, NULL, 0, 1, 0); + } + } + @@ -44647,14 +29903,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + + if (tx_chk == _FAIL) { -+ pmlmeinfo->link_count %= (link_count_limit+1); ++ pmlmeinfo->link_count &= 0xf; + } else { + pxmitpriv->last_tx_pkts = pxmitpriv->tx_pkts; + pmlmeinfo->link_count = 0; + } + + } //end of if ((psta = rtw_get_stainfo(pstapriv, passoc_res->network.MacAddress)) != NULL) -+ + } + else if (is_client_associated_to_ibss(padapter)) + { @@ -44679,8 +29934,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + pmlmeinfo->FW_sta_info[i].retry = 0; + pmlmeinfo->FW_sta_info[i].status = 0; -+ report_del_sta_event(padapter, psta->hwaddr, WLAN_REASON_EXPIRATION_CHK, _TRUE); -+ } ++ report_del_sta_event(padapter, psta->hwaddr ++ , 65535// indicate disconnect caused by no rx ++ ); ++ } + } + else + { @@ -44698,33 +29955,69 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + +void survey_timer_hdl(_adapter *padapter) +{ -+ struct cmd_obj *cmd; -+ struct sitesurvey_parm *psurveyPara; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct cmd_obj *ph2c; ++ struct sitesurvey_parm *psurveyPara; ++ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; +#ifdef CONFIG_P2P + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); +#endif + -+ if (mlmeext_scan_state(pmlmeext) > SCAN_DISABLE) { -+ cmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmd == NULL) { -+ rtw_warn_on(1); -+ goto exit; ++ //DBG_871X("marc: survey timer\n"); ++ ++ //issue rtw_sitesurvey_cmd ++ if (pmlmeext->sitesurvey_res.state > SCAN_START) ++ { ++ if(pmlmeext->sitesurvey_res.state == SCAN_PROCESS) ++ { ++#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE ++ if( padapter->mlmeextpriv.mlmext_info.scan_cnt != RTW_SCAN_NUM_OF_CH ) ++#endif //CONFIG_STA_MODE_SCAN_UNDER_AP_MODE ++ pmlmeext->sitesurvey_res.channel_idx++; + } + -+ psurveyPara = (struct sitesurvey_parm *)rtw_zmalloc(sizeof(struct sitesurvey_parm)); -+ if (psurveyPara == NULL) { -+ rtw_warn_on(1); -+ rtw_mfree((unsigned char *)cmd, sizeof(struct cmd_obj)); -+ goto exit; ++ if(pmlmeext->scan_abort == true) ++ { ++ #ifdef CONFIG_P2P ++ if(!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE)) ++ { ++ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_MAX); ++ pmlmeext->sitesurvey_res.channel_idx = 3; ++ DBG_871X("%s idx:%d, cnt:%u\n", __FUNCTION__ ++ , pmlmeext->sitesurvey_res.channel_idx ++ , pwdinfo->find_phase_state_exchange_cnt ++ ); ++ } ++ else ++ #endif ++ { ++ pmlmeext->sitesurvey_res.channel_idx = pmlmeext->sitesurvey_res.ch_num; ++ DBG_871X("%s idx:%d\n", __FUNCTION__ ++ , pmlmeext->sitesurvey_res.channel_idx ++ ); ++ } ++ ++ pmlmeext->scan_abort = false;//reset + } + -+ init_h2fwcmd_w_parm_no_rsp(cmd, psurveyPara, GEN_CMD_CODE(_SiteSurvey)); -+ rtw_enqueue_cmd(pcmdpriv, cmd); ++ if ((ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) ++ { ++ goto exit_survey_timer_hdl; ++ } ++ ++ if ((psurveyPara = (struct sitesurvey_parm*)rtw_zmalloc(sizeof(struct sitesurvey_parm))) == NULL) ++ { ++ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); ++ goto exit_survey_timer_hdl; ++ } ++ ++ init_h2fwcmd_w_parm_no_rsp(ph2c, psurveyPara, GEN_CMD_CODE(_SiteSurvey)); ++ rtw_enqueue_cmd(pcmdpriv, ph2c); + } + -+exit: ++ ++exit_survey_timer_hdl: ++ + return; +} + @@ -44761,7 +30054,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + // pmlmeinfo->reauth_count = 0; + //} + } -+ ++ + DBG_871X("link_timer_hdl: auth timeout and try again\n"); + pmlmeinfo->auth_seq = 1; + issue_auth(padapter, NULL, 0); @@ -44811,7 +30104,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + if (tx_cnt == pxmitpriv->tx_pkts) + { -+ issue_nulldata_in_interrupt(padapter, NULL, 0); ++ issue_nulldata(padapter, NULL, 0, 0, 0); + } + + tx_cnt = pxmitpriv->tx_pkts; @@ -44854,102 +30147,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + if(!psta) + return; -+ ++ + phtpriv = &psta->htpriv; + -+ if((phtpriv->ht_option==_TRUE) && (phtpriv->ampdu_enable==_TRUE)) ++ if((phtpriv->ht_option==true) && (phtpriv->ampdu_enable==true)) + { + if(phtpriv->candidate_tid_bitmap) + phtpriv->candidate_tid_bitmap=0x0; -+ ++ + } +#endif //CONFIG_80211N_HT +} + -+#ifdef CONFIG_IEEE80211W -+void report_sta_timeout_event(_adapter *padapter, u8 *MacAddr, unsigned short reason) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct sta_info *psta; -+ int mac_id; -+ struct stadel_event *pdel_sta_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) -+ return; -+ -+ cmdsz = (sizeof(struct stadel_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct stadel_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_TimeoutSTA); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ pdel_sta_evt = (struct stadel_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ _rtw_memcpy((unsigned char *)(&(pdel_sta_evt->macaddr)), MacAddr, ETH_ALEN); -+ _rtw_memcpy((unsigned char *)(pdel_sta_evt->rsvd), (unsigned char *)(&reason), 2); -+ -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, MacAddr); -+ if (psta) -+ mac_id = (int)psta->mac_id; -+ else -+ mac_id = (-1); -+ -+ pdel_sta_evt->mac_id = mac_id; -+ -+ DBG_871X("report_del_sta_event: delete STA, mac_id=%d\n", mac_id); -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+} -+ -+void clnt_sa_query_timeout(_adapter *padapter) -+{ -+ -+ rtw_disassoc_cmd(padapter, 0, _TRUE); -+ rtw_indicate_disconnect(padapter); -+ rtw_free_assoc_resources(padapter, 1); -+ -+ DBG_871X("SA query timeout client disconnect\n"); -+} -+ -+void sa_query_timer_hdl(struct sta_info *psta) -+{ -+ _adapter *padapter = psta->padapter; -+ _irqL irqL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE && -+ check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ clnt_sa_query_timeout(padapter); -+ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ report_sta_timeout_event(padapter, psta->hwaddr, WLAN_REASON_PREV_AUTH_NOT_VALID); -+} -+ -+#endif //CONFIG_IEEE80211W -+ +u8 NULL_hdl(_adapter *padapter, u8 *pbuf) +{ + return H2C_SUCCESS; @@ -44962,7 +30171,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + rtw_set_802_11_infrastructure_mode(adapter, Ndis802_11APMode); + -+ rtw_setopmode_cmd(adapter, Ndis802_11APMode,_TRUE); ++ rtw_setopmode_cmd(adapter, Ndis802_11APMode); +} + +static int rtw_auto_ap_start_beacon(_adapter *adapter) @@ -44971,7 +30180,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + u8 *pbuf = NULL; + uint len; + u8 supportRate[16]; -+ int sz = 0, rateLen; ++ int sz = 0, rateLen; + u8 * ie; + u8 wireless_mode, oper_channel; + u8 ssid[3] = {0}; //hidden ssid @@ -44979,7 +30188,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + + -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) + return -EINVAL; + + @@ -44997,14 +30206,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + ie += sz; + + //beacon interval : 2bytes -+ *(u16*)ie = cpu_to_le16((u16)100);//BCN_INTERVAL=100; ++ *(__le16*)ie = cpu_to_le16((u16)100);//BCN_INTERVAL=100; + sz += 2; + ie += 2; + + //capability info -+ *(u16*)ie = 0; -+ *(u16*)ie |= cpu_to_le16(cap_ESS); -+ *(u16*)ie |= cpu_to_le16(cap_ShortPremble); ++ *(__le16*)ie = 0; ++ *(__le16*)ie |= cpu_to_le16(cap_ESS); ++ *(__le16*)ie |= cpu_to_le16(cap_ShortPremble); + //*(u16*)ie |= cpu_to_le16(cap_Privacy); + sz += 2; + ie += 2; @@ -45085,14 +30294,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + else if(psetop->mode == Ndis802_11Infrastructure) + { + pmlmeinfo->state &= ~(BIT(0)|BIT(1));// clear state -+ pmlmeinfo->state |= WIFI_FW_STATION_STATE;//set to STATION_STATE ++ pmlmeinfo->state |= WIFI_FW_STATION_STATE;//set to STATION_STATE + type = _HW_STATE_STATION_; + } + else if(psetop->mode == Ndis802_11IBSS) + { + type = _HW_STATE_ADHOC_; -+ } else if (psetop->mode == Ndis802_11Monitor) { -+ type = _HW_STATE_MONITOR_; + } + else + { @@ -45108,32 +30315,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + rtw_auto_ap_start_beacon(padapter); +#endif + -+ if (rtw_port_switch_chk(padapter) == _TRUE) -+ { -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); -+ -+ if(psetop->mode == Ndis802_11APMode) -+ adapter_to_pwrctl(padapter)->fw_psmode_iface_id = 0xff; //ap mode won't dowload rsvd pages -+ else if (psetop->mode == Ndis802_11Infrastructure) { -+ #ifdef CONFIG_LPS -+ _adapter *port0_iface = dvobj_get_port0_adapter(adapter_to_dvobj(padapter)); -+ if (port0_iface) -+ rtw_lps_ctrl_wk_cmd(port0_iface, LPS_CTRL_CONNECT, 0); -+ #endif -+ } -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ if (psetop->mode == Ndis802_11APMode) -+ { -+ // Do this after port switch to -+ // prevent from downloading rsvd page to wrong port -+ rtw_btcoex_MediaStatusNotify(padapter, 1); //connect -+ } -+#endif // CONFIG_BT_COEXIST -+ + return H2C_SUCCESS; -+ ++ +} + +u8 createbss_hdl(_adapter *padapter, u8 *pbuf) @@ -45141,25 +30324,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX*)(&(pmlmeinfo->network)); -+ WLAN_BSSID_EX *pdev_network = &padapter->registrypriv.dev_network; -+ struct createbss_parm *parm = (struct createbss_parm *)pbuf; -+ u8 ret = H2C_SUCCESS; -+ //u8 initialgain; -+ -+#ifdef CONFIG_AP_MODE -+ if (pmlmeinfo->state == WIFI_FW_AP_STATE) { -+ start_bss_network(padapter, parm); -+ goto exit; -+ } -+#endif ++ struct joinbss_parm *pparm = (struct joinbss_parm *)pbuf; ++ //u32 initialgain; + -+ /* below is for ad-hoc master */ -+ if (parm->adhoc) { -+ rtw_warn_on(pdev_network->InfrastructureMode != Ndis802_11IBSS); ++ ++ if(pparm->network.InfrastructureMode == Ndis802_11APMode) ++ { ++#ifdef CONFIG_AP_MODE ++ ++ if(pmlmeinfo->state == WIFI_FW_AP_STATE) ++ { ++ //todo: ++ return H2C_SUCCESS; ++ } ++#endif ++ } ++ ++ //below is for ad-hoc master ++ if(pparm->network.InfrastructureMode == Ndis802_11IBSS) ++ { + rtw_joinbss_reset(padapter); -+ ++ + pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset= HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ pmlmeext->cur_ch_offset= HAL_PRIME_CHNL_OFFSET_DONT_CARE; + pmlmeinfo->ERP_enable = 0; + pmlmeinfo->WMM_enable = 0; + pmlmeinfo->HT_enable = 0; @@ -45168,41 +30355,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pmlmeinfo->agg_enable_bitmap = 0; + pmlmeinfo->candidate_tid_bitmap = 0; + ++ //disable dynamic functions, such as high power, DIG ++ Save_DM_Func_Flag(padapter); ++ Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); ++ + //config the initial gain under linking, need to write the BB registers + //initialgain = 0x1E; -+ /*rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE);*/ ++ //rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); + -+ //disable dynamic functions, such as high power, DIG -+ rtw_phydm_ability_backup(padapter); -+ rtw_phydm_func_disable_all(padapter); -+ -+ //cancel link timer ++ //cancel link timer + _cancel_timer_ex(&pmlmeext->link_timer); + + //clear CAM -+ flush_all_cam_entry(padapter); ++ flush_all_cam_entry(padapter); + -+ pdev_network->Length = get_WLAN_BSSID_EX_sz(pdev_network); -+ _rtw_memcpy(pnetwork, pdev_network, FIELD_OFFSET(WLAN_BSSID_EX, IELength)); -+ pnetwork->IELength = pdev_network->IELength; ++ _rtw_memcpy(pnetwork, pbuf, FIELD_OFFSET(WLAN_BSSID_EX, IELength)); ++ pnetwork->IELength = ((WLAN_BSSID_EX *)pbuf)->IELength; + -+ if (pnetwork->IELength > MAX_IE_SZ) { -+ ret = H2C_PARAMETERS_ERROR; -+ goto ibss_post_hdl; -+ } ++ if(pnetwork->IELength>MAX_IE_SZ)//Check pbuf->IELength ++ return H2C_PARAMETERS_ERROR; ++ ++ _rtw_memcpy(pnetwork->IEs, ((WLAN_BSSID_EX *)pbuf)->IEs, pnetwork->IELength); + -+ _rtw_memcpy(pnetwork->IEs, pdev_network->IEs, pnetwork->IELength); + start_create_ibss(padapter); -+ } else { -+ rtw_warn_on(1); -+ ret = H2C_PARAMETERS_ERROR; ++ + } + -+ibss_post_hdl: -+ rtw_create_ibss_post_hdl(padapter, ret); ++ return H2C_SUCCESS; + -+exit: -+ return ret; +} + +u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) @@ -45217,34 +30397,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct joinbss_parm *pparm = (struct joinbss_parm *)pbuf; +#endif //CONFIG_ANTENNA_DIVERSITY + u32 i; -+ //u8 initialgain; ++ u8 cbw40_enable=0; ++ //u32 initialgain; + //u32 acparm; -+ u8 u_ch, u_bw, u_offset; + + //check already connecting to AP or not + if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) + { + if (pmlmeinfo->state & WIFI_FW_STATION_STATE) + { -+ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 1, 100); ++ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 5, 100); + } -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+ //clear CAM -+ flush_all_cam_entry(padapter); -+ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ //set MSR to nolink -> infra. mode -+ //Set_MSR(padapter, _HW_STATE_NOLINK_); -+ Set_MSR(padapter, _HW_STATE_STATION_); -+ + -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, 0); ++ pmlmeinfo->state = WIFI_FW_NULL_STATE; ++ ++ //clear CAM ++ flush_all_cam_entry(padapter); ++ ++ _cancel_timer_ex(&pmlmeext->link_timer); ++ ++ //set MSR to nolink -> infra. mode ++ //Set_MSR(padapter, _HW_STATE_NOLINK_); ++ Set_MSR(padapter, _HW_STATE_STATION_); ++ ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, NULL); + } + +#ifdef CONFIG_ANTENNA_DIVERSITY -+ rtw_antenna_select_cmd(padapter, pparm->network.PhyInfo.Optimum_antenna, _FALSE); ++ rtw_antenna_select_cmd(padapter, pparm->network.PhyInfo.Optimum_antenna, false); +#endif + +#ifdef CONFIG_WAPI_SUPPORT @@ -45253,6 +30434,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + rtw_joinbss_reset(padapter); + ++ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; ++ pmlmeext->cur_ch_offset= HAL_PRIME_CHNL_OFFSET_DONT_CARE; + pmlmeinfo->ERP_enable = 0; + pmlmeinfo->WMM_enable = 0; + pmlmeinfo->HT_enable = 0; @@ -45260,29 +30443,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + pmlmeinfo->HT_info_enable = 0; + pmlmeinfo->agg_enable_bitmap = 0; + pmlmeinfo->candidate_tid_bitmap = 0; -+ pmlmeinfo->bwmode_updated = _FALSE; ++ pmlmeinfo->bwmode_updated = false; + //pmlmeinfo->assoc_AP_vendor = HT_IOT_PEER_MAX; + pmlmeinfo->VHT_enable = 0; + -+ _rtw_memcpy(pnetwork, pbuf, FIELD_OFFSET(WLAN_BSSID_EX, IELength)); ++ _rtw_memcpy(pnetwork, pbuf, FIELD_OFFSET(WLAN_BSSID_EX, IELength)); + pnetwork->IELength = ((WLAN_BSSID_EX *)pbuf)->IELength; -+ -+ if(pnetwork->IELength>MAX_IE_SZ)//Check pbuf->IELength -+ return H2C_PARAMETERS_ERROR; -+ -+ if (pnetwork->IELength < 2) { -+ report_join_res(padapter, (-4)); -+ return H2C_SUCCESS; -+ } -+ _rtw_memcpy(pnetwork->IEs, ((WLAN_BSSID_EX *)pbuf)->IEs, pnetwork->IELength); + -+ pmlmeinfo->bcn_interval = get_beacon_interval(pnetwork); ++ if(pnetwork->IELength>MAX_IE_SZ)//Check pbuf->IELength ++ return H2C_PARAMETERS_ERROR; ++ ++ _rtw_memcpy(pnetwork->IEs, ((WLAN_BSSID_EX *)pbuf)->IEs, pnetwork->IELength); + + //Check AP vendor to move rtw_joinbss_cmd() + //pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->IEs, pnetwork->IELength); + -+ //sizeof(NDIS_802_11_FIXED_IEs) -+ for (i = _FIXED_IE_LENGTH_ ; i < pnetwork->IELength - 2 ;) { ++ //sizeof(NDIS_802_11_FIXED_IEs) ++ for (i = _FIXED_IE_LENGTH_; i < pnetwork->IELength;) ++ { + pIE = (PNDIS_802_11_VARIABLE_IEs)(pnetwork->IEs + i); + + switch (pIE->ElementID) @@ -45294,36 +30472,75 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + } + break; + -+#ifdef CONFIG_80211N_HT + case _HT_CAPABILITY_IE_: //Get HT Cap IE. + pmlmeinfo->HT_caps_enable = 1; + break; + + case _HT_EXTRA_INFO_IE_: //Get HT Info IE. ++#ifdef CONFIG_80211N_HT + pmlmeinfo->HT_info_enable = 1; -+ break; -+#endif /* CONFIG_80211N_HT */ + ++ //spec case only for cisco's ap because cisco's ap issue assoc rsp using mcs rate @40MHz or @20MHz ++//#if !defined(CONFIG_CONCURRENT_MODE) && !defined(CONFIG_DUALMAC_CONCURRENT) ++// if(pmlmeinfo->assoc_AP_vendor == ciscoAP) ++//#endif ++ { ++ struct HT_info_element *pht_info = (struct HT_info_element *)(pIE->data); ++ ++ if (pnetwork->Configuration.DSConfig > 14) { ++ if ((pregpriv->bw_mode & 0xf0) > CHANNEL_WIDTH_20) ++ cbw40_enable = 1; ++ } else { ++ if ((pregpriv->bw_mode & 0x0f) > CHANNEL_WIDTH_20) ++ cbw40_enable = 1; ++ } ++ ++ if ((cbw40_enable) && (pht_info->infos[0] & BIT(2))) ++ { ++ //switch to the 40M Hz mode according to the AP ++ pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; ++ switch (pht_info->infos[0] & 0x3) ++ { ++ case 1: ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ break; ++ ++ case 3: ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ ++ default: ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ } ++ ++ DBG_871X("set HT ch/bw before connected\n"); ++ } ++ } ++#endif //CONFIG_80211N_HT ++ break; +#ifdef CONFIG_80211AC_VHT + case EID_VHTCapability://Get VHT Cap IE. + pmlmeinfo->VHT_enable = 1; + break; + + case EID_VHTOperation://Get VHT Operation IE. ++ if (pmlmeext->cur_bwmode == CHANNEL_WIDTH_40) { ++ if((GET_VHT_OPERATION_ELE_CHL_WIDTH(pIE->data) >= 1) ++ && ((pregpriv->bw_mode & 0xf0) >= CHANNEL_WIDTH_80)) { ++ pmlmeext->cur_bwmode = CHANNEL_WIDTH_80; ++ DBG_871X("VHT center ch = %d\n", GET_VHT_OPERATION_ELE_CENTER_FREQ1(pIE->data)); ++ DBG_871X("set VHT ch/bw before connected\n"); ++ } ++ } + break; -+#endif /* CONFIG_80211AC_VHT */ ++#endif + default: + break; + } + + i += (pIE->Length + 2); + } -+ -+ rtw_bss_get_chbw(pnetwork -+ , &pmlmeext->cur_channel, &pmlmeext->cur_bwmode, &pmlmeext->cur_ch_offset); -+ -+ rtw_regsty_adjust_chbw(pregpriv, pmlmeext->cur_channel, &pmlmeext->cur_bwmode, &pmlmeext->cur_ch_offset); -+ +#if 0 + if (padapter->registrypriv.wifi_spec) { + // for WiFi test, follow WMM test plan spec @@ -45335,9 +30552,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); + acparm = 0x0000A549; // BK + rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); -+ ++ + // for WiFi test, mixed mode with intel STA under bg mode throughput issue -+ if (padapter->mlmepriv.htpriv.ht_option == _FALSE){ ++ if (padapter->mlmepriv.htpriv.ht_option == false){ + acparm = 0x00004320; + rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); + } @@ -45353,34 +30570,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); + } +#endif -+ -+ /* check channel, bandwidth, offset and switch */ -+ if (rtw_chk_start_clnt_join(padapter, &u_ch, &u_bw, &u_offset) == _FAIL) { -+ report_join_res(padapter, (-4)); -+ return H2C_SUCCESS; -+ } -+ + //disable dynamic functions, such as high power, DIG -+ /*rtw_phydm_func_disable_all(padapter);*/ ++ //Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); + + //config the initial gain under linking, need to write the BB registers + //initialgain = 0x1E; -+ /*rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE);*/ ++ //rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); + + rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress); + join_type = 0; + rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, NULL); + -+ set_channel_bwmode(padapter, u_ch, u_offset, u_bw); -+ -+ //cancel link timer ++ //cancel link timer + _cancel_timer_ex(&pmlmeext->link_timer); -+ ++ + start_clnt_join(padapter); -+ ++ + return H2C_SUCCESS; -+ ++ +} + +u8 disconnect_hdl(_adapter *padapter, unsigned char *pbuf) @@ -45389,25 +30596,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX*)(&(pmlmeinfo->network)); -+ u8 val8; ++ u8 val8; + + if (is_client_associated_to_ap(padapter)) + { -+#ifdef CONFIG_DFS -+ if(padapter->mlmepriv.handle_dfs == _FALSE) -+#endif //CONFIG_DFS -+#ifdef CONFIG_PLATFORM_ROCKCHIPS -+ //To avoid connecting to AP fail during resume process, change retry count from 5 to 1 -+ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 1, 100); -+#else -+ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, param->deauth_timeout_ms/100, 100); -+#endif //CONFIG_PLATFORM_ROCKCHIPS ++ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, param->deauth_timeout_ms/100, 100); + } + -+#ifdef CONFIG_DFS -+ if( padapter->mlmepriv.handle_dfs == _TRUE ) -+ padapter->mlmepriv.handle_dfs = _FALSE; -+#endif //CONFIG_DFS ++ //set_opmode_cmd(padapter, infra_client_with_mlme); ++ ++ //pmlmeinfo->state = WIFI_FW_NULL_STATE; ++ ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, NULL); ++ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); + + if(((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) + { @@ -45416,168 +30618,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + rtw_hal_set_hwreg(padapter, HW_VAR_BCN_FUNC, (u8 *)(&val8)); + } + -+ rtw_mlmeext_disconnect(padapter); ++ ++ //set MSR to no link state -> infra. mode ++ Set_MSR(padapter, _HW_STATE_STATION_); ++ ++ pmlmeinfo->state = WIFI_FW_NULL_STATE; ++ ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ dc_set_channel_bwmode_disconnect(padapter); ++#else ++#ifdef CONFIG_CONCURRENT_MODE ++ if((check_buddy_fwstate(padapter, _FW_LINKED)) != true) ++ { ++#endif //CONFIG_CONCURRENT_MODE ++ //switch to the 20M Hz mode after disconnect ++ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++#ifdef CONFIG_CONCURRENT_MODE ++ } ++#endif //CONFIG_CONCURRENT_MODE ++#endif //CONFIG_DUALMAC_CONCURRENT ++ ++ flush_all_cam_entry(padapter); ++ ++ _cancel_timer_ex(&pmlmeext->link_timer); + + rtw_free_uc_swdec_pending_queue(padapter); + -+ return H2C_SUCCESS; -+} -+ -+static const char * const _scan_state_str[] = { -+ "SCAN_DISABLE", -+ "SCAN_START", -+ "SCAN_PS_ANNC_WAIT", -+ "SCAN_ENTER", -+ "SCAN_PROCESS", -+ "SCAN_BACKING_OP", -+ "SCAN_BACK_OP", -+ "SCAN_LEAVING_OP", -+ "SCAN_LEAVE_OP", -+ "SCAN_SW_ANTDIV_BL", -+ "SCAN_TO_P2P_LISTEN", -+ "SCAN_P2P_LISTEN", -+ "SCAN_COMPLETE", -+ "SCAN_STATE_MAX", -+}; -+ -+const char *scan_state_str(u8 state) -+{ -+ state = (state >= SCAN_STATE_MAX) ? SCAN_STATE_MAX : state; -+ return _scan_state_str[state]; -+} -+ -+static bool scan_abort_hdl(_adapter *adapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct ss_res *ss = &pmlmeext->sitesurvey_res; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+#endif -+ bool ret = _FALSE; -+ -+ if (pmlmeext->scan_abort == _TRUE) { -+ #ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(&adapter->wdinfo, P2P_STATE_NONE)) { -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_MAX); -+ ss->channel_idx = 3; -+ DBG_871X("%s idx:%d, cnt:%u\n", __FUNCTION__ -+ , ss->channel_idx -+ , pwdinfo->find_phase_state_exchange_cnt -+ ); -+ } else -+ #endif -+ { -+ ss->channel_idx = ss->ch_num; -+ DBG_871X("%s idx:%d\n", __FUNCTION__ -+ , ss->channel_idx -+ ); -+ } -+ pmlmeext->scan_abort = _FALSE; -+ ret = _TRUE; -+ } -+ -+ return ret; -+} -+ -+u8 rtw_scan_sparse(_adapter *adapter, struct rtw_ieee80211_channel *ch, u8 ch_num) -+{ -+/* interval larger than this is treated as backgroud scan */ -+#ifndef RTW_SCAN_SPARSE_BG_INTERVAL_MS -+#define RTW_SCAN_SPARSE_BG_INTERVAL_MS 12000 -+#endif -+ -+#ifndef RTW_SCAN_SPARSE_CH_NUM_MIRACAST -+#define RTW_SCAN_SPARSE_CH_NUM_MIRACAST 1 -+#endif -+#ifndef RTW_SCAN_SPARSE_CH_NUM_BG -+#define RTW_SCAN_SPARSE_CH_NUM_BG 4 -+#endif -+ -+#define SCAN_SPARSE_CH_NUM_INVALID 255 -+ -+ static u8 token = 255; -+ u32 interval; -+ bool busy_traffic = _FALSE; -+ bool miracast_enabled = _FALSE; -+ bool bg_scan = _FALSE; -+ u8 max_allow_ch = SCAN_SPARSE_CH_NUM_INVALID; -+ u8 scan_division_num; -+ u8 ret_num = ch_num; -+ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ -+ if (regsty->wifi_spec) -+ goto exit; -+ -+ /* assume ch_num > 6 is normal scan */ -+ if (ch_num <= 6) -+ goto exit; -+ -+ if (mlmeext->last_scan_time == 0) -+ mlmeext->last_scan_time = rtw_get_current_time(); -+ -+ interval = rtw_get_passing_time_ms(mlmeext->last_scan_time); -+ -+ if (adapter->mlmepriv.LinkDetectInfo.bBusyTraffic == _TRUE -+ #ifdef CONFIG_CONCURRENT_MODE -+ || (adapter->pbuddy_adapter && adapter->pbuddy_adapter->mlmepriv.LinkDetectInfo.bBusyTraffic == _TRUE) -+ #endif -+ ) -+ busy_traffic = _TRUE; -+ -+ #ifdef CONFIG_WFD -+ if (is_miracast_enabled(adapter->wfd_info.stack_wfd_mode) -+ #ifdef CONFIG_CONCURRENT_MODE -+ || (adapter->pbuddy_adapter && is_miracast_enabled(adapter->pbuddy_adapter->wfd_info.stack_wfd_mode)) -+ #endif -+ ) -+ miracast_enabled = _TRUE; -+ #endif -+ -+ if (interval > RTW_SCAN_SPARSE_BG_INTERVAL_MS) -+ bg_scan = _TRUE; -+ -+ /* max_allow_ch by conditions*/ -+ -+ #if RTW_SCAN_SPARSE_MIRACAST -+ if (miracast_enabled == _TRUE && busy_traffic == _TRUE) -+ max_allow_ch = rtw_min(max_allow_ch, RTW_SCAN_SPARSE_CH_NUM_MIRACAST); -+ #endif -+ -+ #if RTW_SCAN_SPARSE_BG -+ if (bg_scan == _TRUE) -+ max_allow_ch = rtw_min(max_allow_ch, RTW_SCAN_SPARSE_CH_NUM_BG); -+ #endif -+ -+ -+ if (max_allow_ch != SCAN_SPARSE_CH_NUM_INVALID) { -+ int i; -+ int k = 0; -+ -+ scan_division_num = (ch_num / max_allow_ch) + ((ch_num % max_allow_ch)?1:0); -+ token = (token + 1) % scan_division_num; -+ -+ if (0) -+ DBG_871X("scan_division_num:%u, token:%u\n", scan_division_num, token); -+ -+ for (i = 0; i < ch_num; i++) { -+ if (ch[i].hw_value && (i % scan_division_num) == token -+ ) { -+ if (i != k) -+ _rtw_memcpy(&ch[k], &ch[i], sizeof(struct rtw_ieee80211_channel)); -+ k++; -+ } -+ } -+ -+ _rtw_memset(&ch[k], 0, sizeof(struct rtw_ieee80211_channel)); -+ -+ ret_num = k; -+ mlmeext->last_scan_time = rtw_get_current_time(); -+ } -+ -+exit: -+ return ret_num; ++ return H2C_SUCCESS; +} + +static int rtw_scan_ch_decision(_adapter *padapter, struct rtw_ieee80211_channel *out, @@ -45588,781 +30658,190 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + int set_idx; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + -+ /* clear first */ ++ /* clear out first */ + _rtw_memset(out, 0, sizeof(struct rtw_ieee80211_channel)*out_num); + + /* acquire channels from in */ + j = 0; + for (i=0;ichannel_set, in[i].hw_value)) >=0 -+ && rtw_mlme_band_check(padapter, in[i].hw_value) == _TRUE + ) + { -+ if (j >= out_num) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" out_num:%u not enough\n", -+ FUNC_ADPT_ARG(padapter), out_num); -+ break; -+ } -+ + _rtw_memcpy(&out[j], &in[i], sizeof(struct rtw_ieee80211_channel)); -+ ++ + if(pmlmeext->channel_set[set_idx].ScanType == SCAN_PASSIVE) -+ out[j].flags |= RTW_IEEE80211_CHAN_PASSIVE_SCAN; -+ ++ out[j].flags &= RTW_IEEE80211_CHAN_PASSIVE_SCAN; ++ + j++; + } + if(j>=out_num) + break; + } -+ ++ + /* if out is empty, use channel_set as default */ + if(j == 0) { + for (i=0;imax_chan_nums;i++) { ++ out[i].hw_value = pmlmeext->channel_set[i].ChannelNum; + -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" ch:%u\n", FUNC_ADPT_ARG(padapter), pmlmeext->channel_set[i].ChannelNum); ++ if(pmlmeext->channel_set[i].ScanType == SCAN_PASSIVE) ++ out[i].flags &= RTW_IEEE80211_CHAN_PASSIVE_SCAN; + -+ if (rtw_mlme_band_check(padapter, pmlmeext->channel_set[i].ChannelNum) == _TRUE) { -+ -+ if (j >= out_num) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" out_num:%u not enough\n", -+ FUNC_ADPT_ARG(padapter), out_num); -+ break; -+ } -+ -+ out[j].hw_value = pmlmeext->channel_set[i].ChannelNum; -+ -+ if(pmlmeext->channel_set[i].ScanType == SCAN_PASSIVE) -+ out[j].flags |= RTW_IEEE80211_CHAN_PASSIVE_SCAN; -+ -+ j++; -+ } ++ j++; + } + } + -+ /* scan_sparse */ -+ j = rtw_scan_sparse(padapter, out, j); ++ if (padapter->setband == GHZ_24) { // 2.4G ++ for (i=0; i < j ; i++) { ++ if (out[i].hw_value > 35) ++ _rtw_memset(&out[i], 0 , sizeof(struct rtw_ieee80211_channel)); ++ else ++ scan_ch_num++; ++ } ++ j = scan_ch_num; ++ } else if (padapter->setband == GHZ_50) { // 5G ++ for (i=0; i < j ; i++) { ++ if (out[i].hw_value > 35) { ++ _rtw_memcpy(&out[scan_ch_num++], &out[i], sizeof(struct rtw_ieee80211_channel)); ++ } ++ } ++ j = scan_ch_num; ++ } else ++ {} + + return j; +} + -+static void sitesurvey_res_reset(_adapter *adapter, struct sitesurvey_parm *parm) -+{ -+ struct ss_res *ss = &adapter->mlmeextpriv.sitesurvey_res; -+ int i; -+ -+ ss->bss_cnt = 0; -+ ss->channel_idx = 0; -+#ifdef CONFIG_SCAN_BACKOP -+ ss->scan_cnt = 0; -+#endif -+#if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) -+ ss->is_sw_antdiv_bl_scan = 0; -+#endif -+ -+ for (i = 0; i < RTW_SSID_SCAN_AMOUNT; i++) { -+ if (parm->ssid[i].SsidLength) { -+ _rtw_memcpy(ss->ssid[i].Ssid, parm->ssid[i].Ssid, IW_ESSID_MAX_SIZE); -+ ss->ssid[i].SsidLength = parm->ssid[i].SsidLength; -+ } else { -+ ss->ssid[i].SsidLength = 0; -+ } -+ } -+ -+ ss->ch_num = rtw_scan_ch_decision(adapter -+ , ss->ch, RTW_CHANNEL_SCAN_AMOUNT -+ , parm->ch, parm->ch_num -+ ); -+ -+ ss->scan_mode = parm->scan_mode; -+} -+ -+static u8 sitesurvey_pick_ch_behavior(_adapter *padapter, u8 *ch, RT_SCAN_TYPE *type) -+{ -+ u8 next_state; -+ u8 scan_ch = 0; -+ RT_SCAN_TYPE scan_type = SCAN_PASSIVE; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ struct ss_res *ss = &pmlmeext->sitesurvey_res; -+ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif -+ -+ /* handle scan abort request */ -+ scan_abort_hdl(padapter); -+ -+#ifdef CONFIG_P2P -+ if (pwdinfo->rx_invitereq_info.scan_op_ch_only || pwdinfo->p2p_info.scan_op_ch_only) { -+ if (pwdinfo->rx_invitereq_info.scan_op_ch_only) -+ scan_ch = pwdinfo->rx_invitereq_info.operation_ch[ss->channel_idx]; -+ else -+ scan_ch = pwdinfo->p2p_info.operation_ch[ss->channel_idx]; -+ scan_type = SCAN_ACTIVE; -+ } else if (rtw_p2p_findphase_ex_is_social(pwdinfo)) { -+ /* -+ * Commented by Albert 2011/06/03 -+ * The driver is in the find phase, it should go through the social channel. -+ */ -+ int ch_set_idx; -+ -+ scan_ch = pwdinfo->social_chan[ss->channel_idx]; -+ ch_set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, scan_ch); -+ if (ch_set_idx >= 0) -+ scan_type = pmlmeext->channel_set[ch_set_idx].ScanType; -+ else -+ scan_type = SCAN_ACTIVE; -+ } else -+#endif /* CONFIG_P2P */ -+ { -+ struct rtw_ieee80211_channel *ch; -+ -+ if (ss->channel_idx < ss->ch_num) { -+ ch = &ss->ch[ss->channel_idx]; -+ scan_ch = ch->hw_value; -+ scan_type = (ch->flags & RTW_IEEE80211_CHAN_PASSIVE_SCAN) ? SCAN_PASSIVE : SCAN_ACTIVE; -+ } -+ } -+ -+ if (scan_ch != 0) { -+ next_state = SCAN_PROCESS; -+ #ifdef CONFIG_SCAN_BACKOP -+ { -+ u8 sta_num; -+ u8 ld_sta_num; -+ u8 ap_num; -+ u8 ld_ap_num; -+ u8 backop_flags = 0; -+ -+ rtw_dev_iface_status(padapter, &sta_num, &ld_sta_num, NULL, &ap_num, &ld_ap_num); -+ -+ if ((ld_sta_num > 0 && mlmeext_chk_scan_backop_flags_sta(pmlmeext, SS_BACKOP_EN)) -+ || (sta_num > 0 && mlmeext_chk_scan_backop_flags_sta(pmlmeext, SS_BACKOP_EN_NL)) -+ ) { -+ backop_flags |= mlmeext_scan_backop_flags_sta(pmlmeext); -+ } -+ -+ if ((ld_ap_num > 0 && mlmeext_chk_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN)) -+ || (ap_num > 0 && mlmeext_chk_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN_NL)) -+ ) { -+ backop_flags |= mlmeext_scan_backop_flags_ap(pmlmeext); -+ } -+ -+ if (backop_flags) { -+ if (ss->scan_cnt < ss->scan_cnt_max) { -+ ss->scan_cnt++; -+ } else { -+ mlmeext_assign_scan_backop_flags(pmlmeext, backop_flags); -+ next_state = SCAN_BACKING_OP; -+ } -+ } -+ } -+ #endif /* CONFIG_SCAN_BACKOP */ -+ } else if (rtw_p2p_findphase_ex_is_needed(pwdinfo)) { -+ /* go p2p listen */ -+ next_state = SCAN_TO_P2P_LISTEN; -+ -+ #ifdef CONFIG_ANTENNA_DIVERSITY -+ } else if (rtw_hal_antdiv_before_linked(padapter)) { -+ /* go sw antdiv before link */ -+ next_state = SCAN_SW_ANTDIV_BL; -+ #endif -+ } else { -+ next_state = SCAN_COMPLETE; -+ -+ #if defined(DBG_SCAN_SW_ANTDIV_BL) -+ { -+ /* for SCAN_SW_ANTDIV_BL state testing */ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ int i; -+ bool is_linked = _FALSE; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (rtw_linked_check(dvobj->padapters[i])) -+ is_linked = _TRUE; -+ } -+ -+ if (!is_linked) { -+ static bool fake_sw_antdiv_bl_state = 0; -+ -+ if (fake_sw_antdiv_bl_state == 0) { -+ next_state = SCAN_SW_ANTDIV_BL; -+ fake_sw_antdiv_bl_state = 1; -+ } else { -+ fake_sw_antdiv_bl_state = 0; -+ } -+ } -+ } -+ #endif /* defined(DBG_SCAN_SW_ANTDIV_BL) */ -+ } -+ -+ #ifdef CONFIG_SCAN_BACKOP -+ if (next_state != SCAN_PROCESS) -+ ss->scan_cnt = 0; -+ #endif -+ -+ -+#ifdef DBG_FIXED_CHAN -+ if (pmlmeext->fixed_chan != 0xff && next_state == SCAN_PROCESS) -+ scan_ch = pmlmeext->fixed_chan; -+#endif -+ -+ if (ch) -+ *ch = scan_ch; -+ if (type) -+ *type = scan_type; -+ -+ return next_state; -+} -+ -+void site_survey(_adapter *padapter, u8 survey_channel, RT_SCAN_TYPE ScanType) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif -+ -+ if (survey_channel != 0) { -+ set_channel_bwmode(padapter, survey_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ -+ #ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ if (ACS_ENABLE == GET_ACS_STATE(padapter)) { -+ ACS_OP acs_op = ACS_RESET; -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &acs_op, _TRUE); -+ rtw_set_acs_channel(padapter, survey_channel); -+ #ifdef DBG_AUTO_CHNL_SEL_NHM -+ DBG_871X("[ACS-"ADPT_FMT"]-set ch:%u\n", -+ ADPT_ARG(padapter), rtw_get_acs_channel(padapter)); -+ #endif -+ } -+ #endif -+ -+ if (ScanType == SCAN_ACTIVE) { -+ #ifdef CONFIG_P2P -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) || -+ rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH) -+ ) { -+ issue_probereq_p2p(padapter, NULL); -+ issue_probereq_p2p(padapter, NULL); -+ issue_probereq_p2p(padapter, NULL); -+ } else -+ #endif /* CONFIG_P2P */ -+ { -+ int i; -+ -+ for (i = 0; i < RTW_SSID_SCAN_AMOUNT; i++) { -+ if (pmlmeext->sitesurvey_res.ssid[i].SsidLength) { -+ /* IOT issue, When wifi_spec is not set, send one probe req without WPS IE. */ -+ if (padapter->registrypriv.wifi_spec) -+ issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); -+ else -+ issue_probereq_ex(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL, 0, 0, 0, 0); -+ issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); -+ } -+ } -+ -+ if (pmlmeext->sitesurvey_res.scan_mode == SCAN_ACTIVE) { -+ /* IOT issue, When wifi_spec is not set, send one probe req without WPS IE. */ -+ if (padapter->registrypriv.wifi_spec) -+ issue_probereq(padapter, NULL, NULL); -+ else -+ issue_probereq_ex(padapter, NULL, NULL, 0, 0, 0, 0); -+ issue_probereq(padapter, NULL, NULL); -+ } -+ } -+ } -+ } else { -+ /* channel number is 0 or this channel is not valid. */ -+ rtw_warn_on(1); -+ } -+ -+ return; -+} -+ -+void survey_done_set_ch_bw(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u8 cur_channel = 0; -+ u8 cur_bwmode; -+ u8 cur_ch_offset; -+ -+ if (rtw_get_ch_setting_union(padapter, &cur_channel, &cur_bwmode, &cur_ch_offset) != 0) { -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), cur_channel, cur_bwmode, cur_ch_offset); -+ } else { -+ #ifdef CONFIG_P2P -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ #ifdef CONFIG_IOCTL_CFG80211 -+ if (iface->wdinfo.driver_interface == DRIVER_CFG80211 && !adapter_wdev_data(iface)->p2p_enabled) -+ continue; -+ #endif -+ -+ if (rtw_p2p_chk_state(&iface->wdinfo, P2P_STATE_LISTEN)) { -+ cur_channel = iface->wdinfo.listen_channel; -+ cur_bwmode = CHANNEL_WIDTH_20; -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" back to "ADPT_FMT"'s listen ch - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ADPT_ARG(iface), cur_channel, cur_bwmode, cur_ch_offset); -+ break; -+ } -+ } -+ #endif /* CONFIG_P2P */ -+ -+ if (cur_channel == 0) { -+ cur_channel = pmlmeext->cur_channel; -+ cur_bwmode = pmlmeext->cur_bwmode; -+ cur_ch_offset = pmlmeext->cur_ch_offset; -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" back to ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), cur_channel, cur_bwmode, cur_ch_offset); -+ } -+ } -+ -+ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); -+} -+ -+/** -+ * sitesurvey_ps_annc - check and doing ps announcement for all the adapters of given @dvobj -+ * @dvobj: the dvobj to check -+ * @ps: power saving or not -+ * -+ * Returns: 0: no ps announcement is doing. 1: ps announcement is doing -+ */ -+u8 sitesurvey_ps_annc(struct dvobj_priv *dvobj, bool ps) -+{ -+ _adapter *adapter; -+ int i; -+ u8 ps_anc = 0; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ adapter = dvobj->padapters[i]; -+ if (!adapter) -+ continue; -+ -+ if (ps) { -+ if (is_client_associated_to_ap(adapter) == _TRUE) { -+ /* TODO: TDLS peers */ -+ issue_nulldata(adapter, NULL, 1, 3, 500); -+ ps_anc = 1; -+ } -+ } else { -+ if (is_client_associated_to_ap(adapter) == _TRUE) { -+ /* TODO: TDLS peers */ -+ issue_nulldata(adapter, NULL, 0, 3, 500); -+ ps_anc = 1; -+ } -+ } -+ } -+ -+ return ps_anc; -+} -+ -+void sitesurvey_set_igi(_adapter *adapter, bool enter) -+{ -+ u8 igi; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+#endif -+ -+ if (enter) { -+#ifdef CONFIG_P2P -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (adapter_wdev_data(adapter)->p2p_enabled == _TRUE && pwdinfo->driver_interface == DRIVER_CFG80211) -+ igi = 0x30; -+ else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ igi = 0x28; -+ else -+#endif /* CONFIG_P2P */ -+ igi = 0x1e; -+ } else { -+ igi = 0xff; /* restore RX GAIN */ -+ } -+ -+ rtw_hal_set_odm_var(adapter, HAL_ODM_INITIAL_GAIN, &igi, _FALSE); -+} -+ +u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) +{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct sitesurvey_parm *pparm = (struct sitesurvey_parm *)pbuf; -+ struct dvobj_priv *dvobj = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct ss_res *ss = &pmlmeext->sitesurvey_res; -+ u8 val8; ++ u8 bdelayscan = false; ++ u8 val8; ++ u32 initialgain; ++ u32 i; + +#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ struct wifidirect_info* pwdinfo = &padapter->wdinfo; +#endif + -+#ifdef DBG_CHECK_FW_PS_STATE -+ if (rtw_fw_ps_state(padapter) == _FAIL) { -+ DBG_871X("scan without leave 32k\n"); -+ pdbgpriv->dbg_scan_pwr_state_cnt++; -+ } -+#endif /* DBG_CHECK_FW_PS_STATE */ -+ -+ /* increase channel idx */ -+ if (mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS)) -+ ss->channel_idx++; -+ -+ /* update scan state to next state (assigned by previous cmd hdl) */ -+ if (mlmeext_scan_state(pmlmeext) != mlmeext_scan_next_state(pmlmeext)) -+ mlmeext_set_scan_state(pmlmeext, mlmeext_scan_next_state(pmlmeext)); -+ -+operation_by_state: -+ switch (mlmeext_scan_state(pmlmeext)) { -+ -+ case SCAN_DISABLE: -+ /* -+ * SW parameter initialization -+ */ -+ -+ sitesurvey_res_reset(padapter, pparm); -+ mlmeext_set_scan_state(pmlmeext, SCAN_START); -+ goto operation_by_state; -+ -+ case SCAN_START: -+ /* -+ * prepare to leave operating channel -+ */ -+ -+ /* apply rx ampdu setting */ -+ if (ss->rx_ampdu_accept != RX_AMPDU_ACCEPT_INVALID -+ || ss->rx_ampdu_size != RX_AMPDU_SIZE_INVALID -+ ) { -+ rtw_rx_ampdu_apply(padapter); -+ } -+ -+ /* clear HW TX queue before scan */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); -+ -+ /* power save state announcement */ -+ if (sitesurvey_ps_annc(adapter_to_dvobj(padapter), 1)) { -+ mlmeext_set_scan_state(pmlmeext, SCAN_PS_ANNC_WAIT); -+ mlmeext_set_scan_next_state(pmlmeext, SCAN_ENTER); -+ set_survey_timer(pmlmeext, 50); /* delay 50ms to protect nulldata(1) */ -+ } else { -+ mlmeext_set_scan_state(pmlmeext, SCAN_ENTER); -+ goto operation_by_state; -+ } -+ -+ break; -+ -+ case SCAN_ENTER: -+ /* -+ * HW register and DM setting for enter scan -+ */ -+ -+ /* config the initial gain under scanning */ -+ sitesurvey_set_igi(padapter, 1); -+ -+ /* disable dynamic functions, such as high power, DIG */ -+ rtw_phydm_ability_backup(padapter); -+ rtw_phydm_func_for_offchannel(padapter); -+ -+ /* set MSR to no link state */ -+ Set_MSR(padapter, _HW_STATE_NOLINK_); -+ val8 = 1; /* under site survey */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ -+ mlmeext_set_scan_state(pmlmeext, SCAN_PROCESS); -+ goto operation_by_state; -+ -+ case SCAN_PROCESS: ++ if (pmlmeext->sitesurvey_res.state == SCAN_DISABLE) + { -+ u8 scan_ch; -+ RT_SCAN_TYPE scan_type; -+ u8 next_state; -+ u32 scan_ms; ++#ifdef CONFIG_CONCURRENT_MODE ++ //for first time sitesurvey_cmd ++ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); ++#endif //CONFIG_CONCURRENT_MODE + -+ #ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ if ((ACS_ENABLE == GET_ACS_STATE(padapter)) && (0 != rtw_get_acs_channel(padapter))) { -+ ACS_OP acs_op = ACS_SELECT; ++ pmlmeext->sitesurvey_res.state = SCAN_START; ++ pmlmeext->sitesurvey_res.bss_cnt = 0; ++ pmlmeext->sitesurvey_res.channel_idx = 0; + -+ rtw_hal_set_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &acs_op, _TRUE); -+ } -+ #endif -+ -+ next_state = sitesurvey_pick_ch_behavior(padapter, &scan_ch, &scan_type); -+ if (next_state != SCAN_PROCESS) { -+ #ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ if (ACS_ENABLE == GET_ACS_STATE(padapter)) { -+ rtw_set_acs_channel(padapter, 0); -+ #ifdef DBG_AUTO_CHNL_SEL_NHM -+ DBG_871X("[ACS-"ADPT_FMT"]-set ch:%u\n", ADPT_ARG(padapter), rtw_get_acs_channel(padapter)); -+ #endif ++ for(i=0;issid[i].SsidLength) { ++ _rtw_memcpy(pmlmeext->sitesurvey_res.ssid[i].Ssid, pparm->ssid[i].Ssid, IW_ESSID_MAX_SIZE); ++ pmlmeext->sitesurvey_res.ssid[i].SsidLength= pparm->ssid[i].SsidLength; ++ } else { ++ pmlmeext->sitesurvey_res.ssid[i].SsidLength= 0; + } -+ #endif -+ -+ mlmeext_set_scan_state(pmlmeext, next_state); -+ goto operation_by_state; + } + -+ /* still SCAN_PROCESS state */ -+ if (0) -+ #ifdef CONFIG_P2P -+ DBG_871X(FUNC_ADPT_FMT" %s ch:%u (cnt:%u,idx:%d) at %dms, %c%c%c\n" -+ , FUNC_ADPT_ARG(padapter) -+ , mlmeext_scan_state_str(pmlmeext) -+ , scan_ch -+ , pwdinfo->find_phase_state_exchange_cnt, ss->channel_idx -+ , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) -+ , scan_type?'A':'P', ss->scan_mode?'A':'P' -+ , ss->ssid[0].SsidLength?'S':' ' -+ ); -+ #else -+ DBG_871X(FUNC_ADPT_FMT" %s ch:%u (idx:%d) at %dms, %c%c%c\n" -+ , FUNC_ADPT_ARG(padapter) -+ , mlmeext_scan_state_str(pmlmeext) -+ , scan_ch -+ , ss->channel_idx -+ , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) -+ , scan_type?'A':'P', ss->scan_mode?'A':'P' -+ , ss->ssid[0].SsidLength?'S':' ' -+ ); -+ #endif /* CONFIG_P2P */ ++ pmlmeext->sitesurvey_res.ch_num = rtw_scan_ch_decision(padapter ++ , pmlmeext->sitesurvey_res.ch, RTW_CHANNEL_SCAN_AMOUNT ++ , pparm->ch, pparm->ch_num ++ ); + -+ #ifdef DBG_FIXED_CHAN -+ if (pmlmeext->fixed_chan != 0xff) -+ DBG_871X(FUNC_ADPT_FMT" fixed_chan:%u\n", pmlmeext->fixed_chan); -+ #endif ++ pmlmeext->sitesurvey_res.scan_mode = pparm->scan_mode; + -+ site_survey(padapter, scan_ch, scan_type); ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ bdelayscan = dc_handle_site_survey(padapter); ++#endif + -+ #if defined(CONFIG_ATMEL_RC_PATCH) -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ scan_ms = 20; -+ else -+ scan_ms = 40; -+ #else -+ scan_ms = ss->scan_ch_ms; -+ #endif -+ -+ #if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) -+ if (ss->is_sw_antdiv_bl_scan) -+ scan_ms = scan_ms/2; -+ #endif -+ -+ #if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) ++ //issue null data if associating to the AP ++ if (is_client_associated_to_ap(padapter) == true) + { -+ struct noise_info info; ++ pmlmeext->sitesurvey_res.state = SCAN_TXNULL; + -+ info.bPauseDIG = _FALSE; -+ info.IGIValue = 0; -+ info.max_time = scan_ms/2; -+ info.chan = scan_ch; -+ rtw_hal_set_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &info, _FALSE); -+ } -+ #endif ++ issue_nulldata(padapter, NULL, 1, 3, 500); + -+ set_survey_timer(pmlmeext, scan_ms); -+ break; -+ } ++#ifdef CONFIG_CONCURRENT_MODE ++ if(is_client_associated_to_ap(padapter->pbuddy_adapter) == true) ++ { ++ DBG_871X("adapter is scanning(buddy_adapter is linked), issue nulldata(pwrbit=1)\n"); + -+ #ifdef CONFIG_SCAN_BACKOP -+ case SCAN_BACKING_OP: -+ { -+ u8 back_ch, back_bw, back_ch_offset; -+ -+ if (rtw_get_ch_setting_union(padapter, &back_ch, &back_bw, &back_ch_offset) == 0) -+ rtw_warn_on(1); -+ -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" %s ch:%u, bw:%u, offset:%u at %dms\n" -+ , FUNC_ADPT_ARG(padapter) -+ , mlmeext_scan_state_str(pmlmeext) -+ , back_ch, back_bw, back_ch_offset -+ , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) -+ ); -+ -+ set_channel_bwmode(padapter, back_ch, back_ch_offset, back_bw); -+ -+ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); -+ val8 = 0; /* survey done */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ -+ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC)) { -+ sitesurvey_set_igi(padapter, 0); -+ sitesurvey_ps_annc(adapter_to_dvobj(padapter), 0); -+ } -+ -+ mlmeext_set_scan_state(pmlmeext, SCAN_BACK_OP); -+ ss->backop_time = rtw_get_current_time(); -+ -+ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_TX_RESUME)) { -+ int i; -+ -+ /* resume TX */ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!dvobj->padapters[i]) -+ continue; -+ -+ rtw_os_xmit_schedule(dvobj->padapters[i]); ++ issue_nulldata(padapter->pbuddy_adapter, NULL, 1, 3, 500); + } ++#endif ++ bdelayscan = true; + } ++#ifdef CONFIG_CONCURRENT_MODE ++ else if(is_client_associated_to_ap(padapter->pbuddy_adapter) == true) ++ { ++ #ifdef CONFIG_TDLS ++ if(padapter->pbuddy_adapter->wdinfo.wfd_tdls_enable == 1) ++ { ++ issue_tunneled_probe_req(padapter->pbuddy_adapter); ++ } ++ #endif //CONFIG_TDLS + -+ goto operation_by_state; ++ pmlmeext->sitesurvey_res.state = SCAN_TXNULL; ++ ++ issue_nulldata(padapter->pbuddy_adapter, NULL, 1, 3, 500); ++ ++ bdelayscan = true; ++ } ++#endif ++ if(bdelayscan) ++ { ++ //delay 50ms to protect nulldata(1). ++ set_survey_timer(pmlmeext, 50); ++ return H2C_SUCCESS; ++ } + } -+ -+ case SCAN_BACK_OP: -+ if (rtw_get_passing_time_ms(ss->backop_time) >= ss->backop_ms -+ || pmlmeext->scan_abort -+ ) { -+ mlmeext_set_scan_state(pmlmeext, SCAN_LEAVING_OP); -+ goto operation_by_state; ++ ++ if ((pmlmeext->sitesurvey_res.state == SCAN_START) || (pmlmeext->sitesurvey_res.state == SCAN_TXNULL)) ++ { ++#ifdef CONFIG_FIND_BEST_CHANNEL ++#if 0 ++ for (i=0; pmlmeext->channel_set[i].ChannelNum !=0; i++) { ++ pmlmeext->channel_set[i].rx_count = 0; + } -+ set_survey_timer(pmlmeext, 50); -+ break; ++#endif ++#endif /* CONFIG_FIND_BEST_CHANNEL */ + -+ case SCAN_LEAVING_OP: -+ /* -+ * prepare to leave operating channel -+ */ ++ //disable dynamic functions, such as high power, DIG ++ Save_DM_Func_Flag(padapter); ++ Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); + -+ /* clear HW TX queue before scan */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); ++ //config the initial gain under scaning, need to write the BB registers ++#ifdef CONFIG_P2P ++#ifdef CONFIG_IOCTL_CFG80211 ++ if((wdev_to_priv(padapter->rtw_wdev))->p2p_enabled == true && pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ initialgain = 0x30; ++ else ++#endif //CONFIG_IOCTL_CFG80211 ++ if ( !rtw_p2p_chk_state( pwdinfo, P2P_STATE_NONE ) ) ++ initialgain = 0x28; ++ else ++#endif //CONFIG_P2P ++ initialgain = 0x1e; + -+ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC) -+ && sitesurvey_ps_annc(adapter_to_dvobj(padapter), 1) -+ ) { -+ mlmeext_set_scan_state(pmlmeext, SCAN_PS_ANNC_WAIT); -+ mlmeext_set_scan_next_state(pmlmeext, SCAN_LEAVE_OP); -+ set_survey_timer(pmlmeext, 50); /* delay 50ms to protect nulldata(1) */ -+ } else { -+ mlmeext_set_scan_state(pmlmeext, SCAN_LEAVE_OP); -+ goto operation_by_state; -+ } ++ rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); + -+ break; -+ -+ case SCAN_LEAVE_OP: -+ /* -+ * HW register and DM setting for enter scan -+ */ -+ -+ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC)) { -+ /* config the initial gain under scanning */ -+ sitesurvey_set_igi(padapter, 1); -+ } -+ -+ /* set MSR to no link state */ ++ //set MSR to no link state + Set_MSR(padapter, _HW_STATE_NOLINK_); ++ + val8 = 1; //under site survey + rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); + -+ mlmeext_set_scan_state(pmlmeext, SCAN_PROCESS); -+ goto operation_by_state; -+ -+ #endif /* CONFIG_SCAN_BACKOP */ -+ -+ #if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) -+ case SCAN_SW_ANTDIV_BL: -+ /* -+ * 20100721 -+ * For SW antenna diversity before link, it needs to switch to another antenna and scan again. -+ * It compares the scan result and select better one to do connection. -+ */ -+ ss->bss_cnt = 0; -+ ss->channel_idx = 0; -+ ss->is_sw_antdiv_bl_scan = 1; -+ -+ mlmeext_set_scan_next_state(pmlmeext, SCAN_PROCESS); -+ set_survey_timer(pmlmeext, ss->scan_ch_ms); -+ break; -+ #endif -+ -+ #ifdef CONFIG_P2P -+ case SCAN_TO_P2P_LISTEN: -+ /* -+ * Set the P2P State to the listen state of find phase -+ * and set the current channel to the listen channel -+ */ -+ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_LISTEN); -+ -+ /* turn on phy-dynamic functions */ -+ rtw_phydm_ability_restore(padapter); -+ -+ sitesurvey_set_igi(padapter, 0); -+ -+ mlmeext_set_scan_state(pmlmeext, SCAN_P2P_LISTEN); -+ _set_timer(&pwdinfo->find_phase_timer, (u32)((u32)pwdinfo->listen_dwell * 100)); -+ break; -+ -+ case SCAN_P2P_LISTEN: -+ mlmeext_set_scan_state(pmlmeext, SCAN_PROCESS); -+ ss->channel_idx = 0; -+ goto operation_by_state; -+ #endif /* CONFIG_P2P */ -+ -+ case SCAN_COMPLETE: -+ #ifdef CONFIG_P2P -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) -+ || rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH) -+ ) { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (pwdinfo->driver_interface == DRIVER_WEXT) { -+ if (check_buddy_fwstate(padapter, _FW_LINKED)) -+ _set_timer(&pwdinfo->ap_p2p_switch_timer, 500); -+ } -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ #else -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ #endif -+ } -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); -+ #endif /* CONFIG_P2P */ -+ -+ /* switch channel */ -+ survey_done_set_ch_bw(padapter); -+ -+ /* config MSR */ -+ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); -+ val8 = 0; /* survey done */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ -+ /* turn on phy-dynamic functions */ -+ rtw_phydm_ability_restore(padapter); -+ -+ sitesurvey_set_igi(padapter, 0); -+ -+ sitesurvey_ps_annc(adapter_to_dvobj(padapter), 0); -+ -+ /* apply rx ampdu setting */ -+ rtw_rx_ampdu_apply(padapter); -+ -+ mlmeext_set_scan_state(pmlmeext, SCAN_DISABLE); -+ -+ report_surveydone_event(padapter); -+ -+ issue_action_BSSCoexistPacket(padapter); -+ issue_action_BSSCoexistPacket(padapter); -+ issue_action_BSSCoexistPacket(padapter); ++ pmlmeext->sitesurvey_res.state = SCAN_PROCESS; + } + ++ site_survey(padapter); ++ + return H2C_SUCCESS; ++ +} + +u8 setauth_hdl(_adapter *padapter, unsigned char *pbuf) @@ -46370,265 +30849,197 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct setauth_parm *pparm = (struct setauth_parm *)pbuf; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ ++ + if (pparm->mode < 4) + { + pmlmeinfo->auth_algo = pparm->mode; + } + -+ return H2C_SUCCESS; ++ return H2C_SUCCESS; +} + +u8 setkey_hdl(_adapter *padapter, u8 *pbuf) +{ -+ u16 ctrl = 0; -+ s16 cam_id = 0; ++ unsigned short ctrl; + struct setkey_parm *pparm = (struct setkey_parm *)pbuf; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ unsigned char null_addr[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ u8 *addr; -+ bool used; ++ unsigned char null_sta[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; + + //main tx key for wep. + if(pparm->set_tx) + pmlmeinfo->key_index = pparm->keyid; + -+ cam_id = rtw_camid_alloc(padapter, NULL, pparm->keyid, &used); ++ //write cam ++ ctrl = BIT(15) | ((pparm->algorithm) << 2) | pparm->keyid; + -+ if (cam_id < 0) -+ goto enable_mc; ++ DBG_871X_LEVEL(_drv_always_, "set group key to hw: alg:%d(WEP40-1 WEP104-5 TKIP-2 AES-4) " ++ "keyid:%d\n", pparm->algorithm, pparm->keyid); ++ write_cam(padapter, pparm->keyid, ctrl, null_sta, pparm->key); + -+ if (cam_id > 3) /* not default key, searched by A2 */ -+ addr = get_bssid(&padapter->mlmepriv); -+ else -+ addr = null_addr; -+ -+ #ifdef DYNAMIC_CAMID_ALLOC -+ /* cam entry searched is pairwise key */ -+ if (used == _TRUE && rtw_camid_is_gk(padapter, cam_id) == _FALSE) { -+ s16 camid_clr; -+ -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" group key with "MAC_FMT" id:%u the same key id as pairwise key\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(addr), pparm->keyid); -+ -+ /* HW has problem to distinguish this group key with existing pairwise key, stop HW enc and dec for BMC */ -+ rtw_camctl_set_flags(padapter, SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH); -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, NULL); -+ -+ /* clear group key */ -+ while ((camid_clr = rtw_camid_search(padapter, addr, -1, 1)) >= 0) { -+ DBG_871X_LEVEL(_drv_always_, "clear group key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(addr), camid_clr); -+ clear_cam_entry(padapter, camid_clr); -+ rtw_camid_free(padapter, camid_clr); -+ } -+ -+ goto enable_mc; -+ } -+ #endif -+ -+ ctrl = BIT(15) | BIT6 | ((pparm->algorithm) << 2) | pparm->keyid; -+ DBG_871X_LEVEL(_drv_always_, "set group key camid:%d, addr:"MAC_FMT", kid:%d, type:%s\n" -+ , cam_id, MAC_ARG(addr), pparm->keyid, security_type_str(pparm->algorithm)); -+ write_cam(padapter, cam_id, ctrl, addr, pparm->key); -+ -+ #ifdef DYNAMIC_CAMID_ALLOC -+ if (cam_id >=0 && cam_id <=3) -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_DK_CFG, (u8*)_TRUE); -+ #endif -+ -+enable_mc: + //allow multicast packets to driver -+ rtw_hal_set_hwreg(padapter, HW_VAR_ON_RCR_AM, null_addr); ++ padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_ON_RCR_AM, null_addr); + + return H2C_SUCCESS; +} + +u8 set_stakey_hdl(_adapter *padapter, u8 *pbuf) +{ -+ u16 ctrl = 0; -+ s16 cam_id = 0; -+ bool used; ++ u16 ctrl=0; ++ u8 cam_id = 0;//cam_entry + u8 ret = H2C_SUCCESS; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct set_stakey_parm *pparm = (struct set_stakey_parm *)pbuf; + struct sta_priv *pstapriv = &padapter->stapriv; + struct sta_info *psta; ++#ifdef CONFIG_TDLS ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++#endif //CONFIG_TDLS + -+ if(pparm->algorithm == _NO_PRIVACY_) -+ goto write_to_cam; ++ //cam_entry: ++ //0~3 for default key + -+ psta = rtw_get_stainfo(pstapriv, pparm->addr); -+ if (!psta) { -+ DBG_871X_LEVEL(_drv_always_, "%s sta:"MAC_FMT" not found\n", __func__, MAC_ARG(pparm->addr)); -+ ret = H2C_REJECTED; -+ goto exit; ++ //for concurrent mode (ap+sta, sta+sta): ++ //default key is disable, using sw encrypt/decrypt ++ //camid 0, 1, 2, 3 is default entry for default key/group key ++ //macid = 1 is for bc/mc stainfo, no mapping to camid ++ //macid = 0 mapping to camid 4 ++ //for macid >=2, camid = macid+3; ++ ++ ++ if(pparm->algorithm == _NO_PRIVACY_) // clear cam entry ++ { ++ clear_cam_entry(padapter, pparm->id); ++ ret = H2C_SUCCESS; ++ goto exit_set_stakey_hdl; + } + ++ if((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) ++ { ++ psta = rtw_get_stainfo(pstapriv, pparm->addr); ++ if(psta) ++ { ++ ctrl = (BIT(15) | ((pparm->algorithm) << 2)); ++ ++ DBG_871X("r871x_set_stakey_hdl(): enc_algorithm=%d\n", pparm->algorithm); ++ ++ if((psta->mac_id == 1) || (psta->mac_id>(NUM_STA-4))) ++ { ++ DBG_871X("r871x_set_stakey_hdl():set_stakey failed, mac_id(aid)=%d\n", psta->mac_id); ++ ret = H2C_REJECTED; ++ goto exit_set_stakey_hdl; ++ } ++ ++ cam_id = (u8)rtw_get_camid(psta->mac_id);//0~3 for default key, cmd_id=macid + 3; ++ ++ DBG_871X("Write CAM, mac_addr=%x:%x:%x:%x:%x:%x, cam_entry=%d\n", pparm->addr[0], ++ pparm->addr[1], pparm->addr[2], pparm->addr[3], pparm->addr[4], ++ pparm->addr[5], cam_id); ++ ++ write_cam(padapter, cam_id, ctrl, pparm->addr, pparm->key); ++ ++ ret = H2C_SUCCESS_RSP; ++ goto exit_set_stakey_hdl; ++ ++ } ++ else ++ { ++ DBG_871X("r871x_set_stakey_hdl(): sta has been free\n"); ++ ret = H2C_REJECTED; ++ goto exit_set_stakey_hdl; ++ } ++ ++ } ++ ++ ++ //below for sta mode ++ ++ if((psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress))) ++ cam_id = (u8)rtw_get_camid(psta->mac_id); ++ else ++ cam_id = 4; ++ ++ ctrl = BIT(15) | ((pparm->algorithm) << 2); ++ ++#ifdef CONFIG_TDLS ++ if(ptdlsinfo->clear_cam!=0){ ++ clear_cam_entry(padapter, ptdlsinfo->clear_cam); ++ ptdlsinfo->clear_cam=0; ++ ret = H2C_SUCCESS; ++ goto exit_set_stakey_hdl; ++ } ++ ++ psta = rtw_get_stainfo(pstapriv, pparm->addr);//Get TDLS Peer STA ++ if( psta->tdls_sta_state&TDLS_LINKED_STATE ){ ++ write_cam(padapter, psta->mac_id, ctrl, pparm->addr, pparm->key); ++ } ++ else ++#endif //CONFIG_TDLS ++ write_cam(padapter, cam_id, ctrl, pparm->addr, pparm->key); ++ + pmlmeinfo->enc_algo = pparm->algorithm; -+ cam_id = rtw_camid_alloc(padapter, psta, 0, &used); -+ if (cam_id < 0) -+ goto exit; + -+ #ifdef DYNAMIC_CAMID_ALLOC -+ /* cam entry searched is group key */ -+ if (used == _TRUE && rtw_camid_is_gk(padapter, cam_id) == _TRUE) { -+ s16 camid_clr; ++exit_set_stakey_hdl: + -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" pairwise key with "MAC_FMT" id:%u the same key id as group key\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(pparm->addr), pparm->keyid); ++ DBG_871X_LEVEL(_drv_always_, "set pairwise key to hw: alg:%d(WEP40-1 WEP104-5 TKIP-2 AES-4) camid:%d\n", ++ pparm->algorithm, cam_id); + -+ /* HW has problem to distinguish this pairwise key with existing group key, stop HW enc and dec for BMC */ -+ rtw_camctl_set_flags(padapter, SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH); -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, NULL); -+ -+ /* clear group key */ -+ while ((camid_clr = rtw_camid_search(padapter, pparm->addr, -1, 1)) >= 0) { -+ DBG_871X_LEVEL(_drv_always_, "clear group key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(pparm->addr), camid_clr); -+ clear_cam_entry(padapter, camid_clr); -+ rtw_camid_free(padapter, camid_clr); -+ } -+ } -+ #endif -+ -+write_to_cam: -+ if(pparm->algorithm == _NO_PRIVACY_) { -+ while ((cam_id = rtw_camid_search(padapter, pparm->addr, -1, -1)) >= 0) { -+ DBG_871X_LEVEL(_drv_always_, "clear key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(pparm->addr), cam_id); -+ clear_cam_entry(padapter, cam_id); -+ rtw_camid_free(padapter,cam_id); -+ } -+ } else { -+ DBG_871X_LEVEL(_drv_always_, "set pairwise key camid:%d, addr:"MAC_FMT", kid:%d, type:%s\n", -+ cam_id, MAC_ARG(pparm->addr), pparm->keyid, security_type_str(pparm->algorithm)); -+ ctrl = BIT(15) | ((pparm->algorithm) << 2) | pparm->keyid; -+ write_cam(padapter, cam_id, ctrl, pparm->addr, pparm->key); -+ } -+ ret = H2C_SUCCESS_RSP; -+ -+exit: + return ret; ++ +} + +u8 add_ba_hdl(_adapter *padapter, unsigned char *pbuf) +{ -+ struct addBaReq_parm *pparm = (struct addBaReq_parm *)pbuf; ++ struct addBaReq_parm *pparm = (struct addBaReq_parm *)pbuf; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + + struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, pparm->addr); -+ ++ + if(!psta) -+ return H2C_SUCCESS; -+ ++ return H2C_SUCCESS; ++ +#ifdef CONFIG_80211N_HT + if (((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && (pmlmeinfo->HT_enable)) || + ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) + { + //pmlmeinfo->ADDBA_retry_count = 0; -+ //pmlmeinfo->candidate_tid_bitmap |= (0x1 << pparm->tid); ++ //pmlmeinfo->candidate_tid_bitmap |= (0x1 << pparm->tid); + //psta->htpriv.candidate_tid_bitmap |= BIT(pparm->tid); -+ issue_addba_req(padapter, pparm->addr, (u8)pparm->tid); ++ issue_action_BA(padapter, pparm->addr, RTW_WLAN_ACTION_ADDBA_REQ, (u16)pparm->tid); + //_set_timer(&pmlmeext->ADDBA_timer, ADDBA_TO); + _set_timer(&psta->addba_retry_timer, ADDBA_TO); + } +#ifdef CONFIG_TDLS -+ else if((psta->tdls_sta_state & TDLS_LINKED_STATE)&& -+ (psta->htpriv.ht_option==_TRUE) && -+ (psta->htpriv.ampdu_enable==_TRUE) ) ++ else if((psta->tdls_sta_state & TDLS_LINKED_STATE)&& ++ (psta->htpriv.ht_option==true) && ++ (psta->htpriv.ampdu_enable==true) ) + { -+ issue_addba_req(padapter, pparm->addr, (u8)pparm->tid); ++ issue_action_BA(padapter, pparm->addr, RTW_WLAN_ACTION_ADDBA_REQ, (u16)pparm->tid); ++ //_set_timer(&pmlmeext->ADDBA_timer, ADDBA_TO); + _set_timer(&psta->addba_retry_timer, ADDBA_TO); + } +#endif //CONFIG + else -+ { -+ psta->htpriv.candidate_tid_bitmap &= ~BIT(pparm->tid); ++ { ++ psta->htpriv.candidate_tid_bitmap &= ~BIT(pparm->tid); + } +#endif //CONFIG_80211N_HT -+ return H2C_SUCCESS; -+} -+ -+ -+u8 add_ba_rsp_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct addBaRsp_parm *pparm = (struct addBaRsp_parm *)pbuf; -+ u8 ret = _TRUE, i = 0, try_cnt = 3, wait_ms = 50; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ -+ psta = rtw_get_stainfo(pstapriv, pparm->addr); -+ if (!psta) -+ goto exit; -+ -+ preorder_ctrl = &psta->recvreorder_ctrl[pparm->tid]; -+ ret = issue_addba_rsp_wait_ack(padapter, pparm->addr, pparm->tid, pparm->status, pparm->size, 3, 50); -+ -+ #ifdef CONFIG_UPDATE_INDICATE_SEQ_WHILE_PROCESS_ADDBA_REQ -+ /* status = 0 means accept this addba req, so update indicate seq = start_seq under this compile flag */ -+ if (pparm->status == 0) { -+ preorder_ctrl->indicate_seq = pparm->start_seq; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, start_seq: %d\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq, pparm->start_seq); -+ #endif -+ } -+ #else -+ preorder_ctrl->indicate_seq = 0xffff; -+ #endif -+ -+ /* -+ * status = 0 means accept this addba req -+ * status = 37 means reject this addba req -+ */ -+ if (pparm->status == 0) { -+ preorder_ctrl->enable = _TRUE; -+ preorder_ctrl->ampdu_size = pparm->size; -+ } else if (pparm->status == 37) -+ preorder_ctrl->enable = _FALSE; -+ -+exit: -+ return H2C_SUCCESS; -+} -+ -+u8 chk_bmc_sleepq_cmd(_adapter* padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ u8 res = _SUCCESS; -+ -+_func_enter_; -+ -+ if ((ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) -+ { -+ res= _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_parm_rsp(ph2c, GEN_CMD_CODE(_ChkBMCSleepq)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+_func_exit_; -+ -+ return res; ++ return H2C_SUCCESS; +} + +u8 set_tx_beacon_cmd(_adapter* padapter) +{ + struct cmd_obj *ph2c; -+ struct Tx_Beacon_param *ptxBeacon_parm; ++ struct Tx_Beacon_param *ptxBeacon_parm; + struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u8 res = _SUCCESS; + int len_diff = 0; -+ -+_func_enter_; ++ ++ + + if ((ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) + { @@ -46656,10 +31067,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + res = rtw_enqueue_cmd(pcmdpriv, ph2c); + -+ ++ +exit: -+ -+_func_exit_; ++ ++ + + return res; +} @@ -46669,25 +31080,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 +{ + u8 evt_code, evt_seq; + u16 evt_sz; -+ uint *peventbuf; ++ uint *peventbuf; + void (*event_callback)(_adapter *dev, u8 *pbuf); + struct evt_priv *pevt_priv = &(padapter->evtpriv); + -+ if (pbuf == NULL) -+ goto _abort_event_; -+ + peventbuf = (uint*)pbuf; + evt_sz = (u16)(*peventbuf&0xffff); + evt_seq = (u8)((*peventbuf>>24)&0x7f); + evt_code = (u8)((*peventbuf>>16)&0xff); -+ -+ ++ ++ + #ifdef CHECK_EVENT_SEQ -+ // checking event sequence... ++ // checking event sequence... + if (evt_seq != (ATOMIC_READ(&pevt_priv->event_seq) & 0x7f) ) + { + RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("Evetn Seq Error! %d vs %d\n", (evt_seq & 0x7f), (ATOMIC_READ(&pevt_priv->event_seq) & 0x7f))); -+ ++ + pevt_priv->event_seq = (evt_seq+1)&0x7f; + + goto _abort_event_; @@ -46701,21 +31109,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + goto _abort_event_; + } + -+ // checking if event size match the event parm size -+ if ((wlanevents[evt_code].parmsize != 0) && ++ // checking if event size match the event parm size ++ if ((wlanevents[evt_code].parmsize != 0) && + (wlanevents[evt_code].parmsize != evt_sz)) + { -+ -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\nEvent(%d) Parm Size mismatch (%d vs %d)!\n", ++ ++ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\nEvent(%d) Parm Size mismatch (%d vs %d)!\n", + evt_code, wlanevents[evt_code].parmsize, evt_sz)); -+ goto _abort_event_; -+ ++ goto _abort_event_; ++ + } + + ATOMIC_INC(&pevt_priv->event_seq); + + peventbuf += 2; -+ ++ + if(peventbuf) + { + event_callback = wlanevents[evt_code].event_callback; @@ -46729,7 +31137,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + + return H2C_SUCCESS; -+ ++ +} + +u8 h2c_msg_hdl(_adapter *padapter, unsigned char *pbuf) @@ -46740,75 +31148,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return H2C_SUCCESS; +} + -+u8 chk_bmc_sleepq_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+#ifdef CONFIG_AP_MODE -+ _irqL irqL; -+ struct sta_info *psta_bmc; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe=NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ //for BC/MC Frames -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ if(!psta_bmc) -+ return H2C_SUCCESS; -+ -+ if((pstapriv->tim_bitmap&BIT(0)) && (psta_bmc->sleepq_len>0)) -+ { -+#ifndef CONFIG_PCI_HCI -+ rtw_msleep_os(10);// 10ms, ATIM(HIQ) Windows -+#endif -+ //_enter_critical_bh(&psta_bmc->sleep_q.lock, &irqL); -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) -+ { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ psta_bmc->sleepq_len--; -+ if(psta_bmc->sleepq_len>0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ pxmitframe->attrib.triggered=1; -+ -+ if (xmitframe_hiq_filter(pxmitframe) == _TRUE) -+ pxmitframe->attrib.qsel = QSLT_HIGH;//HIQ -+ -+ #if 0 -+ _exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); -+ if(rtw_hal_xmit(padapter, pxmitframe) == _TRUE) -+ { -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ } -+ _enter_critical_bh(&psta_bmc->sleep_q.lock, &irqL); -+ #endif -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ } -+ -+ //_exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ if (rtw_get_intf_type(padapter) != RTW_PCIE) { -+ /* check hi queue and bmc_sleepq */ -+ rtw_chk_hi_queue_cmd(padapter); -+ } -+ } -+#endif -+ -+ return H2C_SUCCESS; -+} -+ +u8 tx_beacon_hdl(_adapter *padapter, unsigned char *pbuf) +{ + if(send_beacon(padapter)==_FAIL) @@ -46816,43 +31155,86 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + DBG_871X("issue_beacon, fail!\n"); + return H2C_PARAMETERS_ERROR; + } ++#ifdef CONFIG_AP_MODE ++ else //tx bc/mc frames after update TIM ++ { ++ _irqL irqL; ++ struct sta_info *psta_bmc; ++ _list *xmitframe_plist, *xmitframe_phead; ++ struct xmit_frame *pxmitframe=NULL; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct sta_priv *pstapriv = &padapter->stapriv; + ++ //for BC/MC Frames ++ psta_bmc = rtw_get_bcmc_stainfo(padapter); ++ if(!psta_bmc) ++ return H2C_SUCCESS; + -+ if (padapter->registrypriv.wifi_spec == 1) -+ return H2C_SUCCESS; -+ -+ /* tx bc/mc frames after update TIM */ -+ chk_bmc_sleepq_hdl(padapter, NULL); ++ if((pstapriv->tim_bitmap&BIT(0)) && (psta_bmc->sleepq_len>0)) ++ { ++ rtw_msleep_os(10);// 10ms, ATIM(HIQ) Windows ++ _enter_critical_bh(&pxmitpriv->lock, &irqL); ++ ++ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); ++ xmitframe_plist = get_next(xmitframe_phead); ++ ++ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) ++ { ++ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); ++ ++ xmitframe_plist = get_next(xmitframe_plist); ++ ++ rtw_list_delete(&pxmitframe->list); ++ ++ psta_bmc->sleepq_len--; ++ if(psta_bmc->sleepq_len>0) ++ pxmitframe->attrib.mdata = 1; ++ else ++ pxmitframe->attrib.mdata = 0; ++ ++ pxmitframe->attrib.triggered=1; ++ ++ pxmitframe->attrib.qsel = 0x11;//HIQ ++ ++ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); ++ } ++ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ } ++ ++ } ++#endif + + return H2C_SUCCESS; ++ +} + -+/* -+* according to channel -+* add/remove WLAN_BSSID_EX.IEs's ERP ie -+* set WLAN_BSSID_EX.SupportedRates -+* update WLAN_BSSID_EX.IEs's Supported Rate and Extended Supported Rate ie -+*/ -+void change_band_update_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 ch) ++void change_band_update_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork) +{ + u8 network_type,rate_len, total_rate_len,remainder_rate_len; + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u8 erpinfo=0x4; + -+ if (ch >= 36) { ++ if(pmlmeext->cur_channel >= 36) ++ { + network_type = WIRELESS_11A; + total_rate_len = IEEE80211_NUM_OFDM_RATESLEN; ++ DBG_871X("%s(): change to 5G Band\n",__FUNCTION__); + rtw_remove_bcn_ie(padapter, pnetwork, _ERPINFO_IE_); -+ } else { ++ } ++ else ++ { + network_type = WIRELESS_11BG; + total_rate_len = IEEE80211_CCK_RATE_LEN+IEEE80211_NUM_OFDM_RATESLEN; ++ DBG_871X("%s(): change to 2.4G Band\n",__FUNCTION__); + rtw_add_bcn_ie(padapter, pnetwork, _ERPINFO_IE_, &erpinfo, 1); + } + + rtw_set_supported_rate(pnetwork->SupportedRates, network_type); + + UpdateBrateTbl(padapter, pnetwork->SupportedRates); ++ rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, pnetwork->SupportedRates); + + if(total_rate_len > 8) + { @@ -46875,10 +31257,562 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + { + rtw_remove_bcn_ie(padapter, pnetwork, _EXT_SUPPORTEDRATES_IE_); + } -+ -+ pnetwork->Length = get_WLAN_BSSID_EX_sz(pnetwork); +} + ++#ifdef CONFIG_DUALMAC_CONCURRENT ++void dc_SelectChannel(_adapter *padapter, unsigned char channel) ++{ ++ PADAPTER ptarget_adapter; ++ ++ if( (padapter->pbuddy_adapter != NULL) && ++ (padapter->DualMacConcurrent == true) && ++ (padapter->adapter_type == SECONDARY_ADAPTER)) ++ { ++ // only mac0 could control BB&RF ++ ptarget_adapter = padapter->pbuddy_adapter; ++ } ++ else ++ { ++ ptarget_adapter = padapter; ++ } ++ ++ _enter_critical_mutex(&(adapter_to_dvobj(ptarget_adapter)->setch_mutex), NULL); ++ ++ rtw_hal_set_chan(ptarget_adapter, channel); ++ ++ _exit_critical_mutex(&(adapter_to_dvobj(ptarget_adapter)->setch_mutex), NULL); ++} ++ ++void dc_SetBWMode(_adapter *padapter, unsigned short bwmode, unsigned char channel_offset) ++{ ++ PADAPTER ptarget_adapter; ++ ++ if( (padapter->pbuddy_adapter != NULL) && ++ (padapter->DualMacConcurrent == true) && ++ (padapter->adapter_type == SECONDARY_ADAPTER)) ++ { ++ // only mac0 could control BB&RF ++ ptarget_adapter = padapter->pbuddy_adapter; ++ } ++ else ++ { ++ ptarget_adapter = padapter; ++ } ++ ++ _enter_critical_mutex(&(adapter_to_dvobj(ptarget_adapter)->setbw_mutex), NULL); ++ ++ rtw_hal_set_bwmode(ptarget_adapter, (CHANNEL_WIDTH)bwmode, channel_offset); ++ ++ _exit_critical_mutex(&(adapter_to_dvobj(ptarget_adapter)->setbw_mutex), NULL); ++} ++ ++void dc_set_channel_bwmode_disconnect(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; ++ struct mlme_priv *pbuddy_mlmepriv = NULL; ++ ++ if(pbuddy_adapter != NULL && ++ padapter->DualMacConcurrent == true) ++ { ++ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); ++ if((check_fwstate(pbuddy_mlmepriv, _FW_LINKED)) != true) ++ { ++ //switch to the 20M Hz mode after disconnect ++ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ } ++ } ++ else ++ { ++ //switch to the 20M Hz mode after disconnect ++ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; ++ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ } ++} ++ ++u8 dc_handle_join_request(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX*)(&(pmlmeinfo->network)); ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; ++ struct mlme_ext_priv *pbuddy_mlmeext = NULL; ++ struct mlme_priv *pbuddy_mlmepriv = NULL; ++ u8 ret = _SUCCESS; ++ ++ if(pbuddy_adapter != NULL && ++ padapter->DualMacConcurrent == true) ++ { ++ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; ++ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); ++ ++ if(pmlmeext->cur_channel != pbuddy_mlmeext->cur_channel || ++ pmlmeext->cur_bwmode != pbuddy_mlmeext->cur_bwmode || ++ pmlmeext->cur_ch_offset != pbuddy_mlmeext->cur_ch_offset) ++ { ++ if((check_fwstate(pbuddy_mlmepriv, WIFI_AP_STATE)) == true) ++ { ++ //issue deauth to all stas if if2 is at ap mode ++ rtw_sta_flush(pbuddy_adapter); ++ ++ //rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); ++ rtw_hal_set_hwreg(pbuddy_adapter, HW_VAR_CHECK_TXBUF, 0); ++ } ++ else if(check_fwstate(pbuddy_mlmepriv, _FW_LINKED) == true) ++ { ++ if(pmlmeext->cur_channel == pbuddy_mlmeext->cur_channel) ++ { ++ // CHANNEL_WIDTH_40 or CHANNEL_WIDTH_20 but channel offset is different ++ if((pmlmeext->cur_bwmode == pbuddy_mlmeext->cur_bwmode) && ++ (pmlmeext->cur_ch_offset != pbuddy_mlmeext->cur_ch_offset) ) ++ { ++ report_join_res(padapter, -4); ++ ret = _FAIL; ++ } ++ } ++ else ++ { ++ report_join_res(padapter, -4); ++ ret = _FAIL; ++ } ++ } ++ } ++ else if (is_client_associated_to_ap(pbuddy_adapter) == true) ++ { ++ issue_nulldata(pbuddy_adapter, NULL, 1, 0, 0); ++ } ++ } ++ ++ return ret; ++} ++ ++void dc_handle_join_done(_adapter *padapter, u8 join_res) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; ++ struct mlme_priv *pbuddy_mlmepriv = NULL; ++ struct mlme_ext_priv *pbuddy_mlmeext = NULL; ++ struct mlme_ext_info *pbuddy_mlmeinfo = NULL; ++ WLAN_BSSID_EX *pbuddy_network_mlmeext = NULL; ++ u8 change_band = false; ++ ++ ++ if(pbuddy_adapter != NULL && ++ padapter->DualMacConcurrent == true) ++ { ++ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); ++ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; ++ pbuddy_mlmeinfo = &(pbuddy_mlmeext->mlmext_info); ++ pbuddy_network_mlmeext = &(pbuddy_mlmeinfo->network); ++ ++ if(((pbuddy_mlmeinfo->state&0x03) == WIFI_FW_AP_STATE) && ++ check_fwstate(pbuddy_mlmepriv, _FW_LINKED)) ++ { ++ //restart and update beacon ++ DBG_871X("after join, current adapter, CH=%d, BW=%d, offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); ++ ++ if(join_res >= 0) ++ { ++ u8 *p; ++ int ie_len; ++ struct HT_info_element *pht_info=NULL; ++ ++ if((pbuddy_mlmeext->cur_channel <= 14 && pmlmeext->cur_channel >= 36) || ++ (pbuddy_mlmeext->cur_channel >= 36 && pmlmeext->cur_channel <= 14)) ++ { ++ change_band = true; ++ } ++ ++ //sync channel/bwmode/ch_offset with another adapter ++ pbuddy_mlmeext->cur_channel = pmlmeext->cur_channel; ++ ++ if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) ++ { ++ p = rtw_get_ie((pbuddy_network_mlmeext->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pbuddy_network_mlmeext->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if( p && ie_len) ++ { ++ pht_info = (struct HT_info_element *)(p+2); ++ pht_info->infos[0] &= ~(BIT(0)|BIT(1)); //no secondary channel is present ++ } ++ ++ if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40) ++ { ++ pbuddy_mlmeext->cur_ch_offset = pmlmeext->cur_ch_offset; ++ ++ //to update cur_ch_offset value in beacon ++ if( pht_info ) ++ { ++ switch(pmlmeext->cur_ch_offset) ++ { ++ case HAL_PRIME_CHNL_OFFSET_LOWER: ++ pht_info->infos[0] |= 0x1; ++ break; ++ case HAL_PRIME_CHNL_OFFSET_UPPER: ++ pht_info->infos[0] |= 0x3; ++ break; ++ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: ++ default: ++ break; ++ } ++ } ++ } ++ else if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_20) ++ { ++ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_20; ++ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ if(pmlmeext->cur_channel>0 && pmlmeext->cur_channel<5) ++ { ++ if(pht_info) ++ pht_info->infos[0] |= 0x1; ++ ++ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_40; ++ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ } ++ ++ if(pmlmeext->cur_channel>7 && pmlmeext->cur_channel<(14+1)) ++ { ++ if(pht_info) ++ pht_info->infos[0] |= 0x3; ++ ++ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_40; ++ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ } ++ ++ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); ++ } ++ } ++ ++ // to update channel value in beacon ++ pbuddy_network_mlmeext->Configuration.DSConfig = pmlmeext->cur_channel; ++ p = rtw_get_ie((pbuddy_network_mlmeext->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (pbuddy_network_mlmeext->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if(p && ie_len>0) ++ *(p + 2) = pmlmeext->cur_channel; ++ ++ p = rtw_get_ie((pbuddy_network_mlmeext->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pbuddy_network_mlmeext->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if( p && ie_len) ++ { ++ pht_info = (struct HT_info_element *)(p+2); ++ pht_info->primary_channel = pmlmeext->cur_channel; ++ } ++ ++ // update mlmepriv's cur_network ++ _rtw_memcpy(&pbuddy_mlmepriv->cur_network.network, pbuddy_network_mlmeext, pbuddy_network_mlmeext->Length); ++ } ++ else ++ { ++ // switch back to original channel/bwmode/ch_offset; ++ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); ++ } ++ ++ DBG_871X("after join, another adapter, CH=%d, BW=%d, offset=%d\n", pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_bwmode, pbuddy_mlmeext->cur_ch_offset); ++ ++ if(change_band == true) ++ change_band_update_ie(pbuddy_adapter, pbuddy_network_mlmeext); ++ ++ DBG_871X("update pbuddy_adapter's beacon\n"); ++ ++ update_beacon(pbuddy_adapter, 0, NULL, true); ++ } ++ else if (is_client_associated_to_ap(pbuddy_adapter) == true) ++ { ++ if((pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) && ++ (pmlmeext->cur_bwmode == CHANNEL_WIDTH_20)) ++ { ++ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); ++ } ++ ++ issue_nulldata(pbuddy_adapter, NULL, 0, 0, 0); ++ } ++ } ++} ++ ++sint dc_check_fwstate(_adapter *padapter, sint fw_state) ++{ ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; ++ struct mlme_priv *pbuddy_mlmepriv = NULL; ++ ++ if(padapter->pbuddy_adapter != NULL && ++ padapter->DualMacConcurrent == true) ++ ++ { ++ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); ++ ++ return check_fwstate(pbuddy_mlmepriv, fw_state); ++ } ++ ++ return false; ++} ++ ++u8 dc_handle_site_survey(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; ++ ++ // only mac0 can do scan request, help issue nulldata(1) for mac1 ++ if(pbuddy_adapter != NULL && ++ padapter->DualMacConcurrent == true) ++ { ++ if (is_client_associated_to_ap(pbuddy_adapter) == true) ++ { ++ pmlmeext->sitesurvey_res.state = SCAN_TXNULL; ++ ++ issue_nulldata(pbuddy_adapter, NULL, 1, 2, 0); ++ ++ return true; ++ } ++ } ++ ++ return false; ++} ++ ++void dc_report_survey_event(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ if(padapter->pbuddy_adapter != NULL && ++ padapter->DualMacConcurrent == true) ++ { ++ report_survey_event(padapter->pbuddy_adapter, precv_frame); ++ } ++} ++ ++void dc_set_channel_bwmode_survey_done(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; ++ struct mlme_priv *pbuddy_mlmepriv = NULL; ++ struct mlme_ext_priv *pbuddy_mlmeext = NULL; ++ struct mlme_ext_info *pbuddy_mlmeinfo = NULL; ++ u8 cur_channel; ++ u8 cur_bwmode; ++ u8 cur_ch_offset; ++ ++ if(pbuddy_adapter != NULL && ++ padapter->DualMacConcurrent == true) ++ { ++ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); ++ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; ++ pbuddy_mlmeinfo = &(pbuddy_mlmeext->mlmext_info); ++ ++ if(check_fwstate(pbuddy_mlmepriv, _FW_LINKED)) ++ { ++ if(check_fwstate(pmlmepriv, _FW_LINKED) && ++ (pmlmeext->cur_bwmode == CHANNEL_WIDTH_40)) ++ { ++ cur_channel = pmlmeext->cur_channel; ++ cur_bwmode = pmlmeext->cur_bwmode; ++ cur_ch_offset = pmlmeext->cur_ch_offset; ++ } ++ else ++ { ++ cur_channel = pbuddy_mlmeext->cur_channel; ++ cur_bwmode = pbuddy_mlmeext->cur_bwmode; ++ cur_ch_offset = pbuddy_mlmeext->cur_ch_offset; ++ } ++ } ++ else ++ { ++ cur_channel = pmlmeext->cur_channel; ++ cur_bwmode = pmlmeext->cur_bwmode; ++ cur_ch_offset = pmlmeext->cur_ch_offset; ++ } ++ ++ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); ++ ++ if (is_client_associated_to_ap(pbuddy_adapter) == true) ++ { ++ //issue null data ++ issue_nulldata(pbuddy_adapter, NULL, 0, 0, 0); ++ } ++ ++ if(((pbuddy_mlmeinfo->state&0x03) == WIFI_FW_AP_STATE) && ++ check_fwstate(pbuddy_mlmepriv, _FW_LINKED)) ++ { ++ ++ DBG_871X("survey done, current CH=%d, BW=%d, offset=%d\n", cur_channel, cur_bwmode, cur_ch_offset); ++ ++ DBG_871X("restart pbuddy_adapter's beacon\n"); ++ ++ update_beacon(pbuddy_adapter, 0, NULL, true); ++ } ++ } ++ else ++ { ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ } ++} ++ ++void dc_set_ap_channel_bandwidth(_adapter *padapter, u8 channel, u8 channel_offset, u8 bwmode) ++{ ++ u8 *p; ++ u8 val8, cur_channel, cur_bwmode, cur_ch_offset, change_band; ++ int ie_len; ++ struct registry_priv *pregpriv = &padapter->registrypriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct HT_info_element *pht_info=NULL; ++ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; ++ struct mlme_priv *pbuddy_mlmepriv = NULL; ++ struct mlme_ext_priv *pbuddy_mlmeext = NULL; ++ ++ DBG_871X("dualmac_concurrent_ap_set_channel_bwmode ==>\n"); ++ ++ cur_channel = channel; ++ cur_bwmode = bwmode; ++ cur_ch_offset = channel_offset; ++ change_band = false; ++ ++ p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if( p && ie_len) ++ { ++ pht_info = (struct HT_info_element *)(p+2); ++ } ++ ++ if(pbuddy_adapter != NULL && ++ padapter->DualMacConcurrent == true) ++ { ++ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); ++ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; ++ ++ if(!check_fwstate(pbuddy_mlmepriv, _FW_LINKED|_FW_UNDER_LINKING|_FW_UNDER_SURVEY)) ++ { ++ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); ++ } ++ else if(check_fwstate(pbuddy_mlmepriv, _FW_LINKED)==true) ++ { ++ //To sync cur_channel/cur_bwmode/cur_ch_offset with another adapter ++ DBG_871X("Another iface is at linked state, sync cur_channel/cur_bwmode/cur_ch_offset\n"); ++ DBG_871X("Another adapter, CH=%d, BW=%d, offset=%d\n", pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_bwmode, pbuddy_mlmeext->cur_ch_offset); ++ DBG_871X("Current adapter, CH=%d, BW=%d, offset=%d\n", cur_channel, cur_bwmode, cur_ch_offset); ++ ++ cur_channel = pbuddy_mlmeext->cur_channel; ++ if(cur_bwmode == CHANNEL_WIDTH_40) ++ { ++ if(pht_info) ++ pht_info->infos[0] &= ~(BIT(0)|BIT(1)); ++ ++ if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) ++ { ++ cur_ch_offset = pbuddy_mlmeext->cur_ch_offset; ++ ++ //to update cur_ch_offset value in beacon ++ if(pht_info) ++ { ++ switch(cur_ch_offset) ++ { ++ case HAL_PRIME_CHNL_OFFSET_LOWER: ++ pht_info->infos[0] |= 0x1; ++ break; ++ case HAL_PRIME_CHNL_OFFSET_UPPER: ++ pht_info->infos[0] |= 0x3; ++ break; ++ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: ++ default: ++ break; ++ } ++ } ++ } ++ else if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_20) ++ { ++ cur_bwmode = CHANNEL_WIDTH_20; ++ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ if(cur_channel>0 && cur_channel<5) ++ { ++ if(pht_info) ++ pht_info->infos[0] |= 0x1; ++ ++ cur_bwmode = CHANNEL_WIDTH_40; ++ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ } ++ ++ if(cur_channel>7 && cur_channel<(14+1)) ++ { ++ if(pht_info) ++ pht_info->infos[0] |= 0x3; ++ ++ cur_bwmode = CHANNEL_WIDTH_40; ++ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ } ++ ++ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); ++ } ++ } ++ ++ // to update channel value in beacon ++ pnetwork->Configuration.DSConfig = cur_channel; ++ p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if(p && ie_len>0) ++ *(p + 2) = cur_channel; ++ ++ if(pht_info) ++ pht_info->primary_channel = cur_channel; ++ } ++ } ++ else ++ { ++ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); ++ } ++ ++ DBG_871X("CH=%d, BW=%d, offset=%d\n", cur_channel, cur_bwmode, cur_ch_offset); ++ ++ if((channel <= 14 && cur_channel >= 36) || ++ (channel >= 36 && cur_channel <= 14)) ++ { ++ change_band = true; ++ } ++ ++ pmlmeext->cur_channel = cur_channel; ++ pmlmeext->cur_bwmode = cur_bwmode; ++ pmlmeext->cur_ch_offset = cur_ch_offset; ++ ++ if(change_band == true) ++ change_band_update_ie(padapter, pnetwork); ++ ++ DBG_871X("dualmac_concurrent_ap_set_channel_bwmode <==\n"); ++} ++ ++void dc_resume_xmit(_adapter *padapter) ++{ ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; ++ ++ if(pbuddy_adapter != NULL && ++ padapter->DualMacConcurrent == true) ++ { ++ DBG_871X("dc_resume_xmit, resume pbuddy_adapter Tx\n"); ++ rtw_os_xmit_schedule(pbuddy_adapter); ++ } ++} ++ ++u8 dc_check_xmit(_adapter *padapter) ++{ ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; ++ struct mlme_priv *pbuddy_mlmepriv = NULL; ++ ++ if(pbuddy_adapter != NULL && ++ padapter->DualMacConcurrent == true) ++ { ++ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); ++ if (check_fwstate(pbuddy_mlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) ++ { ++ DBG_871X("dc_check_xmit pbuddy_adapter is under survey or under linking\n"); ++ return false; ++ } ++ } ++ ++ return true; ++} ++#endif ++ +#ifdef CONFIG_CONCURRENT_MODE +sint check_buddy_mlmeinfo_state(_adapter *padapter, u32 state) +{ @@ -46887,419 +31821,343 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + struct mlme_ext_info *pbuddy_mlmeinfo; + + if(padapter == NULL) -+ return _FALSE; -+ ++ return false; ++ + pbuddy_adapter = padapter->pbuddy_adapter; + + if(pbuddy_adapter == NULL) -+ return _FALSE; ++ return false; + + + pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; + pbuddy_mlmeinfo = &(pbuddy_mlmeext->mlmext_info); -+ ++ + if((pbuddy_mlmeinfo->state&0x03) == state) -+ return _TRUE; ++ return true; ++ ++ return false; + -+ return _FALSE; -+ +} -+#endif /* CONFIG_CONCURRENT_MODE */ + -+void rtw_join_done_chk_ch(_adapter *adapter, int join_res) ++int concurrent_chk_start_clnt_join(_adapter *padapter) +{ -+#define DUMP_ADAPTERS_STATUS 0 ++ int ret = _FAIL; ++ PADAPTER pbuddy_adapter; ++ struct mlme_ext_priv *pbuddy_mlmeext; ++ struct mlme_ext_info *pbuddy_pmlmeinfo; ++ struct mlme_priv *pbuddy_mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ unsigned char cur_ch = pmlmeext->cur_channel; ++ unsigned char cur_bw = pmlmeext->cur_bwmode; ++ unsigned char cur_ch_offset = pmlmeext->cur_ch_offset; + -+ struct dvobj_priv *dvobj; -+ _adapter *iface; -+ struct mlme_priv *mlme; -+ struct mlme_ext_priv *mlmeext; -+ u8 u_ch, u_offset, u_bw; -+ int i; -+ -+ dvobj = adapter_to_dvobj(adapter); -+ -+ if (DUMP_ADAPTERS_STATUS) { -+ DBG_871X(FUNC_ADPT_FMT" enter\n", FUNC_ADPT_ARG(adapter)); -+ dump_adapters_status(RTW_DBGDUMP , dvobj); ++ if(!rtw_buddy_adapter_up(padapter)) ++ { ++ goto start_join_set_ch_bw; + } + -+ if (join_res >= 0) { -+ if (rtw_get_ch_setting_union(adapter, &u_ch, &u_bw, &u_offset) <= 0) { -+ dump_adapters_status(RTW_DBGDUMP , dvobj); -+ rtw_warn_on(1); ++ pbuddy_adapter = padapter->pbuddy_adapter; ++ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; ++ pbuddy_pmlmeinfo = &(pbuddy_mlmeext->mlmext_info); ++ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); ++ ++ if((pbuddy_pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)//for AP MODE ++ { ++ bool inform_ch_switch = false; ++ if(pmlmeext->cur_channel != pbuddy_mlmeext->cur_channel) ++ { ++ inform_ch_switch = true; ++ } ++ else if((pmlmeext->cur_bwmode == CHANNEL_WIDTH_40) && ++ (pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) && ++ (pmlmeext->cur_ch_offset != pbuddy_mlmeext->cur_ch_offset)) ++ { ++ inform_ch_switch = true; ++ } ++ else if((pmlmeext->cur_bwmode == CHANNEL_WIDTH_20) && ++ (pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40)) ++ { ++ inform_ch_switch = false; ++ cur_ch = pmlmeext->cur_channel; ++ cur_bw = pbuddy_mlmeext->cur_bwmode; ++ cur_ch_offset = pbuddy_mlmeext->cur_ch_offset; + } + -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ mlme = &iface->mlmepriv; -+ mlmeext = &iface->mlmeextpriv; + -+ if (!iface || iface == adapter) -+ continue; ++ if (inform_ch_switch) { ++ #ifdef CONFIG_SPCT_CH_SWITCH ++ if (1) { ++ rtw_ap_inform_ch_switch(pbuddy_adapter, pmlmeext->cur_channel , pmlmeext->cur_ch_offset); ++ } else ++ #endif ++ { ++ //issue deauth to all stas if if2 is at ap mode ++ rtw_sta_flush(pbuddy_adapter); ++ } ++ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); ++ } ++ } ++ else if(check_fwstate(pbuddy_mlmepriv, _FW_LINKED) == true && ++ check_fwstate(pbuddy_mlmepriv, WIFI_STATION_STATE) == true) //for Client Mode/p2p client ++ { ++#if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) ++ struct wifidirect_info *pbuddy_wdinfo = &(pbuddy_adapter->wdinfo); ++ if(!rtw_p2p_chk_state(pbuddy_wdinfo, P2P_STATE_NONE) && pbuddy_wdinfo->driver_interface == DRIVER_CFG80211 ) ++ { ++ goto start_join_set_ch_bw;//wlan0-sta mode has higher priority than p2p0-p2p client ++ } ++#endif //CONFIG_P2P && CONFIG_IOCTL_CFG80211 + -+ if (check_fwstate(mlme, WIFI_AP_STATE) -+ && check_fwstate(mlme, WIFI_ASOC_STATE) -+ ) { -+ bool is_grouped = rtw_is_chbw_grouped(u_ch, u_bw, u_offset -+ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); ++ if(pmlmeext->cur_channel != pbuddy_mlmeext->cur_channel) ++ { ++ DBG_871X("start_clnt_join(ch=%d), but channel mismatch with buddy(ch=%d) interface\n", ++ pmlmeext->cur_channel, pbuddy_mlmeext->cur_channel); + -+ if (is_grouped == _FALSE) { -+ /* handle AP which need to switch ch setting */ ++ report_join_res(padapter, (-4)); + -+ /* restore original bw, adjust bw by registry setting on target ch */ -+ mlmeext->cur_bwmode = mlme->ori_bw; -+ mlmeext->cur_channel = u_ch; -+ rtw_regsty_adjust_chbw(&iface->registrypriv -+ , mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset); -+ -+ rtw_sync_chbw(&mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset -+ , &u_ch, &u_bw, &u_offset); ++ return ret; ++ } + -+ rtw_ap_update_bss_chbw(iface, &(mlmeext->mlmext_info.network) -+ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); ++ if((pmlmeext->cur_bwmode == CHANNEL_WIDTH_40) && ++ (pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) && ++ (pmlmeext->cur_ch_offset != pbuddy_mlmeext->cur_ch_offset)) ++ { ++ DBG_871X("start_clnt_join(bwmode=%d, ch_offset=%d), but bwmode & ch_offset mismatch with buddy(bwmode=%d, ch_offset=%d) interface\n", ++ pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode, pbuddy_mlmeext->cur_ch_offset); + -+ _rtw_memcpy(&(mlme->cur_network.network), &(mlmeext->mlmext_info.network), sizeof(WLAN_BSSID_EX)); ++ report_join_res(padapter, (-4)); + -+ rtw_start_bss_hdl_after_chbw_decided(iface); ++ return ret; ++ } ++ ++ } ++ ++ ++start_join_set_ch_bw: ++ ++ set_channel_bwmode(padapter, cur_ch, cur_ch_offset, cur_bw); ++ ++ return _SUCCESS; ++ ++} ++ ++void concurrent_chk_joinbss_done(_adapter *padapter, int join_res) ++{ ++ struct mlme_ext_priv *pmlmeext; ++ struct mlme_ext_info *pmlmeinfo; ++ PADAPTER pbuddy_adapter; ++ struct mlme_priv *pbuddy_mlmepriv; ++ struct mlme_ext_priv *pbuddy_mlmeext; ++ struct mlme_ext_info *pbuddy_mlmeinfo; ++ WLAN_BSSID_EX *pbuddy_network_mlmeext; ++ ++ pmlmeext = &padapter->mlmeextpriv; ++ pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ ++ if(!rtw_buddy_adapter_up(padapter)) ++ { ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ return; ++ } ++ ++ pbuddy_adapter = padapter->pbuddy_adapter; ++ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); ++ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; ++ pbuddy_mlmeinfo = &(pbuddy_mlmeext->mlmext_info); ++ pbuddy_network_mlmeext = &(pbuddy_mlmeinfo->network); ++ ++ if(((pbuddy_mlmeinfo->state&0x03) == WIFI_FW_AP_STATE) && ++ check_fwstate(pbuddy_mlmepriv, _FW_LINKED)) ++ { ++ //restart and update beacon ++ ++ DBG_871X("after join,primary adapter, CH=%d, BW=%d, offset=%d\n" ++ , pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); ++ ++ ++ if(join_res >= 0) ++ { ++ u8 *p; ++ int ie_len; ++ u8 change_band = false; ++ struct HT_info_element *pht_info=NULL; ++ ++ if((pmlmeext->cur_channel <= 14 && pbuddy_mlmeext->cur_channel >= 36) || ++ (pmlmeext->cur_channel >= 36 && pbuddy_mlmeext->cur_channel <= 14)) ++ change_band = true; ++ ++ //sync channel/bwmode/ch_offset with primary adapter ++ pbuddy_mlmeext->cur_channel = pmlmeext->cur_channel; ++ if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) ++ { ++ p = rtw_get_ie((pbuddy_network_mlmeext->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pbuddy_network_mlmeext->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if( p && ie_len) ++ { ++ pht_info = (struct HT_info_element *)(p+2); ++ pht_info->infos[0] &= ~(BIT(0)|BIT(1)); //no secondary channel is present + } + -+ update_beacon(iface, 0, NULL, _TRUE); ++ if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40) ++ { ++ pbuddy_mlmeext->cur_ch_offset = pmlmeext->cur_ch_offset; ++ ++ //to update cur_ch_offset value in beacon ++ if( pht_info ) ++ { ++ switch(pmlmeext->cur_ch_offset) ++ { ++ case HAL_PRIME_CHNL_OFFSET_LOWER: ++ pht_info->infos[0] |= 0x1; ++ break; ++ case HAL_PRIME_CHNL_OFFSET_UPPER: ++ pht_info->infos[0] |= 0x3; ++ break; ++ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: ++ default: ++ break; ++ } ++ ++ } ++ ++ } ++ else if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_20) ++ { ++ if(pmlmeext->cur_channel>=1 && pmlmeext->cur_channel<=4) ++ { ++ if(pht_info) ++ pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE; ++ ++ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_40; ++ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ } ++ else if(pmlmeext->cur_channel>=5 && pmlmeext->cur_channel<=14) ++ { ++ if(pht_info) ++ pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW; ++ ++ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_40; ++ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ } ++ else ++ { ++ switch(pmlmeext->cur_channel) ++ { ++ case 36: ++ case 44: ++ case 52: ++ case 60: ++ case 100: ++ case 108: ++ case 116: ++ case 124: ++ case 132: ++ case 149: ++ case 157: ++ { ++ if(pht_info) ++ pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE; ++ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_40; ++ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; ++ break; ++ } ++ case 40: ++ case 48: ++ case 56: ++ case 64: ++ case 104: ++ case 112: ++ case 120: ++ case 128: ++ case 136: ++ case 153: ++ case 161: ++ { ++ if(pht_info) ++ pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW; ++ ++ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_40; ++ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; ++ break; ++ } ++ default: ++ if(pht_info) ++ pht_info->infos[0] &= ~HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW; ++ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_20; ++ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ break; ++ ++ } ++ ++ } ++ ++ } ++ ++ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); ++ ++ } ++ else ++ { ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); + } + -+ clr_fwstate(mlme, WIFI_OP_CH_SWITCHING); -+ } + -+ #ifdef CONFIG_DFS_MASTER -+ rtw_dfs_master_status_apply(adapter, MLME_STA_CONNECTED); -+ #endif -+ } else { -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ mlme = &iface->mlmepriv; -+ mlmeext = &iface->mlmeextpriv; ++ // to update channel value in beacon ++ pbuddy_network_mlmeext->Configuration.DSConfig = pmlmeext->cur_channel; ++ p = rtw_get_ie((pbuddy_network_mlmeext->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (pbuddy_network_mlmeext->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if(p && ie_len>0) ++ *(p + 2) = pmlmeext->cur_channel; + -+ if (!iface || iface == adapter) -+ continue; -+ -+ if (check_fwstate(mlme, WIFI_AP_STATE) -+ && check_fwstate(mlme, WIFI_ASOC_STATE)) -+ update_beacon(iface, 0, NULL, _TRUE); -+ -+ clr_fwstate(mlme, WIFI_OP_CH_SWITCHING); -+ } -+ #ifdef CONFIG_DFS_MASTER -+ rtw_dfs_master_status_apply(adapter, MLME_STA_DISCONNECTED); -+ #endif -+ } -+ -+ if (rtw_get_ch_setting_union(adapter, &u_ch, &u_bw, &u_offset)) -+ set_channel_bwmode(adapter, u_ch, u_offset, u_bw); -+ -+ if (DUMP_ADAPTERS_STATUS) { -+ DBG_871X(FUNC_ADPT_FMT" exit\n", FUNC_ADPT_ARG(adapter)); -+ dump_adapters_status(RTW_DBGDUMP , dvobj); -+ } -+} -+ -+int rtw_chk_start_clnt_join(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) -+{ -+ bool chbw_allow = _TRUE; -+ bool connect_allow = _TRUE; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ u8 cur_ch, cur_bw, cur_ch_offset; -+ u8 u_ch, u_offset, u_bw; -+ -+ u_ch = cur_ch = pmlmeext->cur_channel; -+ u_bw = cur_bw = pmlmeext->cur_bwmode; -+ u_offset = cur_ch_offset = pmlmeext->cur_ch_offset; -+ -+ if (!ch || !bw || !offset) { -+ connect_allow = _FALSE; -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (cur_ch == 0) { -+ connect_allow = _FALSE; -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT" cur_ch:%u\n" -+ , FUNC_ADPT_ARG(adapter), cur_ch); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ DBG_871X(FUNC_ADPT_FMT" req: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+{ -+ struct dvobj_priv *dvobj; -+ _adapter *iface; -+ struct mlme_priv *mlme; -+ struct mlme_ext_priv *mlmeext; -+ u8 sta_num; -+ u8 ld_sta_num; -+ u8 lg_sta_num; -+ u8 ap_num; -+ u8 ld_ap_num; -+ int i; -+ -+ dvobj = adapter_to_dvobj(adapter); -+ -+ rtw_dev_iface_status_no_self(adapter, &sta_num, &ld_sta_num, &lg_sta_num, &ap_num, &ld_ap_num); -+ DBG_871X(FUNC_ADPT_FMT" ld_sta_num:%u, ap_num:%u\n" -+ , FUNC_ADPT_ARG(adapter), ld_sta_num, ap_num); -+ -+ if (!ld_sta_num && !ap_num) { -+ /* consider linking STA? */ -+ goto connect_allow_hdl; -+ } -+ -+ if (rtw_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset) <= 0) { -+ dump_adapters_status(RTW_DBGDUMP , dvobj); -+ rtw_warn_on(1); -+ } -+ DBG_871X(FUNC_ADPT_FMT" union no self: %u,%u,%u\n" -+ , FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); -+ -+ /* chbw_allow? */ -+ chbw_allow = rtw_is_chbw_grouped(pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset -+ , u_ch, u_bw, u_offset); -+ -+ DBG_871X(FUNC_ADPT_FMT" chbw_allow:%d\n" -+ , FUNC_ADPT_ARG(adapter), chbw_allow); -+ -+ if (chbw_allow == _TRUE) { -+ rtw_sync_chbw(&cur_ch, &cur_bw, &cur_ch_offset, &u_ch, &u_bw, &u_offset); -+ rtw_warn_on(cur_ch != pmlmeext->cur_channel); -+ rtw_warn_on(cur_bw != pmlmeext->cur_bwmode); -+ rtw_warn_on(cur_ch_offset != pmlmeext->cur_ch_offset); -+ goto connect_allow_hdl; -+ } -+ -+ /* chbw_allow is _FALSE, connect allow? */ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ mlme = &iface->mlmepriv; -+ mlmeext = &iface->mlmeextpriv; -+ -+ #ifdef CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT -+ if (check_fwstate(mlme, WIFI_STATION_STATE) -+ && check_fwstate(mlme, WIFI_ASOC_STATE) -+ #if defined(CONFIG_P2P) -+ && rtw_p2p_chk_state(&(iface->wdinfo), P2P_STATE_NONE) -+ #endif -+ ) { -+ connect_allow = _FALSE; -+ break; -+ } -+ #endif /* CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT */ -+ } -+ DBG_871X(FUNC_ADPT_FMT" connect_allow:%d\n" -+ , FUNC_ADPT_ARG(adapter), connect_allow); -+ -+ if (connect_allow == _FALSE) -+ goto exit; -+ -+connect_allow_hdl: -+ /* connect_allow == _TRUE */ -+ -+ #ifdef CONFIG_DFS_MASTER -+ rtw_dfs_master_status_apply(adapter, MLME_STA_CONNECTING); -+ #endif -+ -+ if (chbw_allow == _FALSE) { -+ u_ch = cur_ch; -+ u_bw = cur_bw; -+ u_offset = cur_ch_offset; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ mlme = &iface->mlmepriv; -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (!iface || iface == adapter) -+ continue; -+ -+ if (check_fwstate(mlme, WIFI_AP_STATE) -+ && check_fwstate(mlme, WIFI_ASOC_STATE) -+ ) { -+ #ifdef CONFIG_SPCT_CH_SWITCH -+ if (1) -+ rtw_ap_inform_ch_switch(iface, pmlmeext->cur_channel , pmlmeext->cur_ch_offset); -+ else -+ #endif -+ rtw_sta_flush(iface, _FALSE); -+ -+ rtw_hal_set_hwreg(iface, HW_VAR_CHECK_TXBUF, 0); -+ set_fwstate(mlme, WIFI_OP_CH_SWITCHING); -+ } else if (check_fwstate(mlme, WIFI_STATION_STATE) -+ && check_fwstate(mlme, WIFI_ASOC_STATE) -+ ) { -+ rtw_disassoc_cmd(iface, 500, _FALSE); -+ rtw_indicate_disconnect(iface); -+ rtw_free_assoc_resources(iface, 1); ++ p = rtw_get_ie((pbuddy_network_mlmeext->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pbuddy_network_mlmeext->IELength - sizeof(NDIS_802_11_FIXED_IEs))); ++ if( p && ie_len) ++ { ++ pht_info = (struct HT_info_element *)(p+2); ++ pht_info->primary_channel = pmlmeext->cur_channel; + } ++ ++ //buddy interface band is different from current interface, update ERP, support rate, ext support rate IE ++ if(change_band == true) ++ change_band_update_ie(pbuddy_adapter, pbuddy_network_mlmeext); ++ } ++ else ++ { ++ // switch back to original channel/bwmode/ch_offset; ++ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); ++ } ++ ++ DBG_871X("after join, second adapter, CH=%d, BW=%d, offset=%d\n", pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_bwmode, pbuddy_mlmeext->cur_ch_offset); ++ ++ DBG_871X("update pbuddy_adapter's beacon\n"); ++ ++ update_beacon(pbuddy_adapter, 0, NULL, true); ++ ++ } ++ else if(((pbuddy_mlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) && ++ check_fwstate(pbuddy_mlmepriv, _FW_LINKED)) ++ { ++ if(join_res >= 0) ++ { ++ pbuddy_mlmeext->cur_channel = pmlmeext->cur_channel; ++ if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) ++ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); ++ else if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40) ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ else ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ } ++ else ++ { ++ // switch back to original channel/bwmode/ch_offset; ++ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); + } + } -+} -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+exit: -+ -+ if (connect_allow == _TRUE) { -+ DBG_871X(FUNC_ADPT_FMT" union: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); -+ *ch = u_ch; -+ *bw = u_bw; -+ *offset = u_offset; ++ else ++ { ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); + } + -+ return connect_allow == _TRUE ? _SUCCESS : _FAIL; -+} -+ -+/* Find union about ch, bw, ch_offset of all linked/linking interfaces */ -+int _rtw_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset, bool include_self) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+ struct mlme_ext_priv *mlmeext; -+ int i; -+ u8 ch_ret = 0; -+ u8 bw_ret = CHANNEL_WIDTH_20; -+ u8 offset_ret = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ int num = 0; -+ -+ if (ch) *ch = 0; -+ if (bw) *bw = CHANNEL_WIDTH_20; -+ if (offset) *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ for (i = 0; iiface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (!check_fwstate(&iface->mlmepriv, _FW_LINKED|_FW_UNDER_LINKING)) -+ continue; -+ -+ if (check_fwstate(&iface->mlmepriv, WIFI_OP_CH_SWITCHING)) -+ continue; -+ -+ if (include_self == _FALSE && adapter == iface) -+ continue; -+ -+ if (num == 0) { -+ ch_ret = mlmeext->cur_channel; -+ bw_ret = mlmeext->cur_bwmode; -+ offset_ret = mlmeext->cur_ch_offset; -+ num++; -+ continue; -+ } -+ -+ if (ch_ret != mlmeext->cur_channel) { -+ num = 0; -+ break; -+ } -+ -+ if (bw_ret < mlmeext->cur_bwmode) { -+ bw_ret = mlmeext->cur_bwmode; -+ offset_ret = mlmeext->cur_ch_offset; -+ } else if (bw_ret == mlmeext->cur_bwmode && offset_ret != mlmeext->cur_ch_offset) { -+ num = 0; -+ break; -+ } -+ -+ num++; -+ } -+ -+ if (num) { -+ if (ch) *ch = ch_ret; -+ if (bw) *bw = bw_ret; -+ if (offset) *offset = offset_ret; -+ } -+ -+ return num; -+} -+ -+inline int rtw_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) -+{ -+ return _rtw_get_ch_setting_union(adapter, ch, bw, offset, 1); -+} -+ -+inline int rtw_get_ch_setting_union_no_self(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) -+{ -+ return _rtw_get_ch_setting_union(adapter, ch, bw, offset, 0); -+} -+ -+void _rtw_dev_iface_status(_adapter *adapter, u8 *sta_num, u8 *ld_sta_num, u8 *lg_sta_num -+ , u8 *ap_num, u8 *ld_ap_num, bool include_self) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+ struct mlme_ext_priv *mlmeext; -+ struct mlme_ext_info *mlmeextinfo; -+ int i; -+ u8 sta_num_ret = 0; -+ u8 ld_sta_num_ret = 0; -+ u8 lg_sta_num_ret = 0; -+ u8 ap_num_ret = 0; -+ u8 ld_ap_num_ret = 0; -+ -+ if (sta_num) -+ *sta_num = 0; -+ if (ld_sta_num) -+ *ld_sta_num = 0; -+ if (lg_sta_num) -+ *lg_sta_num = 0; -+ if (ap_num) -+ *ap_num = 0; -+ if (ld_ap_num) -+ *ld_ap_num = 0; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ -+ if (include_self == _FALSE && iface == adapter) -+ continue; -+ -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (mlmeext_msr(mlmeext) == WIFI_FW_STATION_STATE) { -+ sta_num_ret++; -+ if (check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE) -+ ld_sta_num_ret++; -+ if (check_fwstate(&iface->mlmepriv, _FW_UNDER_LINKING) == _TRUE) -+ lg_sta_num_ret++; -+ } -+ -+ if (mlmeext_msr(mlmeext) == WIFI_FW_AP_STATE -+ && check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE -+ ) { -+ ap_num_ret++; -+ if (iface->stapriv.asoc_sta_count > 2) -+ ld_ap_num_ret++; -+ } -+ } -+ -+ if (sta_num) -+ *sta_num = sta_num_ret; -+ if (ld_sta_num) -+ *ld_sta_num = ld_sta_num_ret; -+ if (lg_sta_num) -+ *lg_sta_num = lg_sta_num_ret; -+ if (ap_num) -+ *ap_num = ap_num_ret; -+ if (ld_ap_num) -+ *ld_ap_num = ld_ap_num_ret; -+} -+ -+inline void rtw_dev_iface_status(_adapter *adapter, u8 *sta_num, u8 *ld_sta_num, u8 *lg_sta_num -+ , u8 *ap_num, u8 *ld_ap_num) -+{ -+ return _rtw_dev_iface_status(adapter, sta_num, ld_sta_num, lg_sta_num, ap_num, ld_ap_num, 1); -+} -+ -+inline void rtw_dev_iface_status_no_self(_adapter *adapter, u8 *sta_num, u8 *ld_sta_num, u8 *lg_sta_num -+ , u8 *ap_num, u8 *ld_ap_num) -+{ -+ return _rtw_dev_iface_status(adapter, sta_num, ld_sta_num, lg_sta_num, ap_num, ld_ap_num, 0); +} ++#endif //CONFIG_CONCURRENT_MODE + +u8 set_ch_hdl(_adapter *padapter, u8 *pbuf) +{ @@ -47322,36 +32180,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + set_channel_bwmode(padapter, set_ch_parm->ch, set_ch_parm->ch_offset, set_ch_parm->bw); + -+ return H2C_SUCCESS; ++ return H2C_SUCCESS; +} + +u8 set_chplan_hdl(_adapter *padapter, unsigned char *pbuf) +{ + struct SetChannelPlan_param *setChannelPlan_param; -+ struct mlme_priv *mlme = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + + if(!pbuf) + return H2C_PARAMETERS_ERROR; + + setChannelPlan_param = (struct SetChannelPlan_param *)pbuf; + -+ if(!rtw_is_channel_plan_valid(setChannelPlan_param->channel_plan)) { -+ return H2C_PARAMETERS_ERROR; -+ } -+ -+ mlme->ChannelPlan = setChannelPlan_param->channel_plan; -+ + pmlmeext->max_chan_nums = init_channel_set(padapter, setChannelPlan_param->channel_plan, pmlmeext->channel_set); -+ init_channel_list(padapter, pmlmeext->channel_set, pmlmeext->max_chan_nums, &pmlmeext->channel_list); ++ init_channel_list(padapter, pmlmeext->channel_set, pmlmeext->max_chan_nums, &pmlmeext->channel_list); + -+ rtw_hal_set_odm_var(padapter,HAL_ODM_REGULATION,NULL,_TRUE); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_reg_notify_by_driver(padapter); -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ return H2C_SUCCESS; ++ return H2C_SUCCESS; +} + +u8 led_blink_hdl(_adapter *padapter, unsigned char *pbuf) @@ -47367,13 +32213,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + BlinkHandler((PLED_DATA)ledBlink_param->pLed); + #endif + -+ return H2C_SUCCESS; ++ return H2C_SUCCESS; +} + +u8 set_csa_hdl(_adapter *padapter, unsigned char *pbuf) +{ +#ifdef CONFIG_DFS + struct SetChannelSwitch_param *setChannelSwitch_param; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; + u8 new_ch_no; + u8 gval8 = 0x00, sval8 = 0xff; + @@ -47392,187 +32241,185 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + + rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &gval8); + -+ rtw_disassoc_cmd(padapter, 0, _FALSE); ++ rtw_free_network_queue(padapter, true); + rtw_indicate_disconnect(padapter); -+ rtw_free_assoc_resources(padapter, 1); -+ rtw_free_network_queue(padapter, _TRUE); + + if ( ((new_ch_no >= 52) && (new_ch_no <= 64)) ||((new_ch_no >= 100) && (new_ch_no <= 140)) ) { + DBG_871X("Switched to DFS band (ch %02x) again!!\n", new_ch_no); + } + -+ return H2C_SUCCESS; ++ return H2C_SUCCESS; +#else + return H2C_REJECTED; +#endif //CONFIG_DFS + +} + ++// TDLS_WRCR : write RCR DATA BIT ++// TDLS_SD_PTI : issue peer traffic indication ++// TDLS_CS_OFF : go back to the channel linked with AP, terminating channel switch procedure ++// TDLS_INIT_CH_SEN : init channel sensing, receive all data and mgnt frame ++// TDLS_DONE_CH_SEN: channel sensing and report candidate channel ++// TDLS_OFF_CH : first time set channel to off channel ++// TDLS_BASE_CH : go back tp the channel linked with AP when set base channel as target channel ++// TDLS_P_OFF_CH : periodically go to off channel ++// TDLS_P_BASE_CH : periodically go back to base channel ++// TDLS_RS_RCR : restore RCR ++// TDLS_CKALV_PH1 : check alive timer phase1 ++// TDLS_CKALV_PH2 : check alive timer phase2 ++// TDLS_FREE_STA : free tdls sta +u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) +{ +#ifdef CONFIG_TDLS + _irqL irqL; + struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+#ifdef CONFIG_TDLS_CH_SW -+ struct tdls_ch_switch *pchsw_info = &ptdlsinfo->chsw_info; -+#endif + struct TDLSoption_param *TDLSoption; -+ struct sta_info *ptdls_sta = NULL; ++ struct sta_info *ptdls_sta; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; + u8 survey_channel, i, min, option; -+ struct tdls_txmgmt txmgmt; -+ u32 setchtime, resp_sleep = 0, wait_time; -+ u8 zaddr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; + -+ if (!pbuf) ++ if(!pbuf) + return H2C_PARAMETERS_ERROR; + + TDLSoption = (struct TDLSoption_param *)pbuf; ++ ++ ptdls_sta = rtw_get_stainfo( &(padapter->stapriv), TDLSoption->addr ); + option = TDLSoption->option; + -+ if (!_rtw_memcmp(TDLSoption->addr, zaddr, ETH_ALEN)) { -+ ptdls_sta = rtw_get_stainfo( &(padapter->stapriv), TDLSoption->addr ); -+ if (ptdls_sta == NULL) { -+ return H2C_REJECTED; -+ } -+ } else { -+ if (!(option == TDLS_RS_RCR || option == TDLS_CH_SW_BACK)) ++ if( ptdls_sta == NULL ) ++ { ++ if( option != TDLS_RS_RCR ) + return H2C_REJECTED; + } + + //_enter_critical_bh(&(ptdlsinfo->hdl_lock), &irqL); -+ //DBG_871X("[%s] option:%d\n", __FUNCTION__, option); -+ -+ switch (option) { -+ case TDLS_ESTABLISHED: -+ { -+ /* As long as TDLS handshake success, we should set RCR_CBSSID_DATA bit to 0 */ -+ /* So we can receive all kinds of data frames. */ -+ u8 sta_band = 0; ++ DBG_871X("[%s] option:%d\n", __FUNCTION__, option); + -+ //leave ALL PS when TDLS is established -+ rtw_pwr_wakeup(padapter); ++ switch(option){ ++ case TDLS_WRCR: ++ //As long as TDLS handshake success, we should set RCR_CBSSID_DATA bit to 0 ++ //such we can receive all kinds of data frames. ++ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_WRCR, 0); ++ DBG_871X("TDLS with "MAC_FMT"\n", MAC_ARG(ptdls_sta->hwaddr)); + -+ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_WRCR, 0); -+ DBG_871X("Created Direct Link with "MAC_FMT"\n", MAC_ARG(ptdls_sta->hwaddr)); -+ -+ pmlmeinfo->FW_sta_info[ptdls_sta->mac_id].psta = ptdls_sta; -+ /* Set TDLS sta rate. */ -+ /* Update station supportRate */ -+ rtw_hal_update_sta_rate_mask(padapter, ptdls_sta); -+ if (pmlmeext->cur_channel > 14) { -+ if (ptdls_sta->ra_mask & 0xffff000) -+ sta_band |= WIRELESS_11_5N ; -+ -+ if (ptdls_sta->ra_mask & 0xff0) -+ sta_band |= WIRELESS_11A; -+ -+ /* 5G band */ -+ #ifdef CONFIG_80211AC_VHT -+ if (ptdls_sta->vhtpriv.vht_option) -+ sta_band = WIRELESS_11_5AC; -+ #endif -+ -+ } else { -+ if (ptdls_sta->ra_mask & 0xffff000) -+ sta_band |= WIRELESS_11_24N; -+ -+ if (ptdls_sta->ra_mask & 0xff0) -+ sta_band |= WIRELESS_11G; -+ -+ if (ptdls_sta->ra_mask & 0x0f) -+ sta_band |= WIRELESS_11B; -+ } -+ ptdls_sta->wireless_mode = sta_band; -+ ptdls_sta->raid = rtw_hal_networktype_to_raid(padapter,ptdls_sta); -+ set_sta_rate(padapter, ptdls_sta); -+ rtw_sta_media_status_rpt(padapter, ptdls_sta, 1); -+ /* Sta mode */ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, ptdls_sta,_TRUE); -+ break; -+ } -+ case TDLS_ISSUE_PTI: -+ ptdls_sta->tdls_sta_state |= TDLS_WAIT_PTR_STATE; -+ issue_tdls_peer_traffic_indication(padapter, ptdls_sta); -+ _set_timer(&ptdls_sta->pti_timer, TDLS_PTI_TIME); -+ break; -+#ifdef CONFIG_TDLS_CH_SW -+ case TDLS_CH_SW_RESP: -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ txmgmt.status_code = 0; -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); -+ -+ issue_nulldata(padapter, NULL, 1, 0, 0); -+ -+ DBG_871X("issue tdls channel switch response\n"); -+ issue_tdls_ch_switch_rsp(padapter, &txmgmt, _FALSE); -+ resp_sleep = 5; -+ rtw_msleep_os(resp_sleep); -+ -+ /* If we receive TDLS_CH_SW_REQ at off channel which it's target is AP's channel */ -+ /* then we just SelectChannel to AP's channel*/ -+ if (padapter->mlmeextpriv.cur_channel == pchsw_info->off_ch_num) { -+ SelectChannel(padapter, padapter->mlmeextpriv.cur_channel); -+ issue_nulldata(padapter, NULL, 0, 0, 0); -+ pchsw_info->ch_sw_state &= ~(TDLS_PEER_AT_OFF_STATE); -+ ATOMIC_SET(&pchsw_info->chsw_on, _FALSE); ++ pmlmeinfo->FW_sta_info[ptdls_sta->mac_id].psta = ptdls_sta; ++ //set TDLS sta rate. ++ set_sta_rate(padapter, ptdls_sta); + break; -+ } -+ -+ _set_timer(&ptdls_sta->delay_timer, pmlmeinfo->bcn_interval - 40); -+ -+ /* Continue following actions */ -+ -+ case TDLS_CH_SW: -+ issue_nulldata(padapter, NULL, 1, 0, 0); -+ _set_timer(&ptdls_sta->ch_sw_timer, (u32)(ptdls_sta->ch_switch_timeout)/1000); -+ -+ setchtime = rtw_systime_to_ms(rtw_get_current_time()); -+ SelectChannel(padapter, pchsw_info->off_ch_num); -+ setchtime = rtw_systime_to_ms(rtw_get_current_time()) - setchtime; -+ setchtime += resp_sleep; -+ -+ if (pmlmeext->cur_channel != rtw_get_oper_ch(padapter)) ++ case TDLS_SD_PTI: ++ issue_tdls_peer_traffic_indication(padapter, ptdls_sta); ++ break; ++ case TDLS_CS_OFF: ++ _cancel_timer_ex(&ptdls_sta->base_ch_timer); ++ _cancel_timer_ex(&ptdls_sta->off_ch_timer); ++ SelectChannel(padapter, pmlmeext->cur_channel); ++ ptdls_sta->tdls_sta_state &= ~(TDLS_CH_SWITCH_ON_STATE | ++ TDLS_PEER_AT_OFF_STATE | ++ TDLS_AT_OFF_CH_STATE); ++ DBG_871X("go back to base channel\n "); + issue_nulldata(padapter, NULL, 0, 0, 0); -+ pchsw_info->ch_sw_state &= ~(TDLS_PEER_AT_OFF_STATE); ++ break; ++ case TDLS_INIT_CH_SEN: ++ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_INIT_CH_SEN, 0); ++ pmlmeext->sitesurvey_res.channel_idx = 0; ++ ptdls_sta->option = TDLS_DONE_CH_SEN; ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_DONE_CH_SEN); ++ break; ++ case TDLS_DONE_CH_SEN: ++ survey_channel = pmlmeext->channel_set[pmlmeext->sitesurvey_res.channel_idx].ChannelNum; ++ if(survey_channel){ ++ SelectChannel(padapter, survey_channel); ++ ptdlsinfo->cur_channel = survey_channel; ++ pmlmeext->sitesurvey_res.channel_idx++; ++ _set_timer(&ptdls_sta->option_timer, SURVEY_TO); ++ }else{ ++ SelectChannel(padapter, pmlmeext->cur_channel); + -+ if ((u32)ptdls_sta->ch_switch_time/1000 > setchtime) -+ wait_time = (u32)ptdls_sta->ch_switch_time/1000 - setchtime; -+ else -+ wait_time = 0; ++ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_DONE_CH_SEN, 0); + -+ if (wait_time > 0) -+ rtw_msleep_os(wait_time); ++ if(ptdlsinfo->ch_sensing==1){ ++ ptdlsinfo->ch_sensing=0; ++ ptdlsinfo->cur_channel=1; ++ min=ptdlsinfo->collect_pkt_num[0]; ++ for(i=1; i ptdlsinfo->collect_pkt_num[i]){ ++ ptdlsinfo->cur_channel=i+1; ++ min=ptdlsinfo->collect_pkt_num[i]; ++ } ++ ptdlsinfo->collect_pkt_num[i]=0; ++ } ++ ptdlsinfo->collect_pkt_num[0]=0; ++ ptdlsinfo->candidate_ch=ptdlsinfo->cur_channel; ++ DBG_871X("TDLS channel sensing done, candidate channel: %02x\n", ptdlsinfo->candidate_ch); ++ ptdlsinfo->cur_channel=0; + -+ issue_nulldata_to_TDLS_peer_STA(ptdls_sta->padapter, ptdls_sta->hwaddr, 0, 0, 0); -+ issue_nulldata_to_TDLS_peer_STA(ptdls_sta->padapter, ptdls_sta->hwaddr, 0, 0, 0); ++ } ++ ++ if(ptdls_sta->tdls_sta_state & TDLS_PEER_SLEEP_STATE){ ++ ptdls_sta->tdls_sta_state |= TDLS_APSD_CHSW_STATE; ++ }else{ ++ //send null data with pwrbit==1 before send ch_switching_req to peer STA. ++ issue_nulldata(padapter, NULL, 1, 0, 0); ++ ++ ptdls_sta->tdls_sta_state |= TDLS_CH_SW_INITIATOR_STATE; ++ ++ issue_tdls_ch_switch_req(padapter, ptdls_sta->hwaddr); ++ DBG_871X("issue tdls ch switch req\n"); ++ } ++ } ++ break; ++ case TDLS_OFF_CH: ++ issue_nulldata(padapter, NULL, 1, 0, 0); ++ SelectChannel(padapter, ptdls_sta->off_ch); ++ ++ DBG_871X("change channel to tar ch:%02x\n", ptdls_sta->off_ch); ++ ptdls_sta->tdls_sta_state |= TDLS_AT_OFF_CH_STATE; ++ ptdls_sta->tdls_sta_state &= ~(TDLS_PEER_AT_OFF_STATE); ++ _set_timer(&ptdls_sta->option_timer, (u32)ptdls_sta->ch_switch_time); ++ break; ++ case TDLS_BASE_CH: ++ _cancel_timer_ex(&ptdls_sta->base_ch_timer); ++ _cancel_timer_ex(&ptdls_sta->off_ch_timer); ++ SelectChannel(padapter, pmlmeext->cur_channel); ++ ptdls_sta->tdls_sta_state &= ~(TDLS_CH_SWITCH_ON_STATE | ++ TDLS_PEER_AT_OFF_STATE | ++ TDLS_AT_OFF_CH_STATE); ++ DBG_871X("go back to base channel\n "); ++ issue_nulldata(padapter, NULL, 0, 0, 0); ++ _set_timer(&ptdls_sta->option_timer, (u32)ptdls_sta->ch_switch_time); ++ break; ++ case TDLS_P_OFF_CH: ++ SelectChannel(padapter, pmlmeext->cur_channel); ++ issue_nulldata(padapter, NULL, 0, 0, 0); ++ DBG_871X("change channel to base ch:%02x\n", pmlmeext->cur_channel); ++ ptdls_sta->tdls_sta_state &= ~(TDLS_PEER_AT_OFF_STATE| TDLS_AT_OFF_CH_STATE); ++ _set_timer(&ptdls_sta->off_ch_timer, TDLS_STAY_TIME); ++ break; ++ case TDLS_P_BASE_CH: ++ issue_nulldata(ptdls_sta->padapter, NULL, 1, 0, 0); ++ SelectChannel(padapter, ptdls_sta->off_ch); ++ DBG_871X("change channel to off ch:%02x\n", ptdls_sta->off_ch); ++ ptdls_sta->tdls_sta_state |= TDLS_AT_OFF_CH_STATE; ++ if((ptdls_sta->tdls_sta_state & TDLS_PEER_AT_OFF_STATE) != TDLS_PEER_AT_OFF_STATE){ ++ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta, 0); ++ } ++ _set_timer(&ptdls_sta->base_ch_timer, TDLS_STAY_TIME); ++ break; ++ case TDLS_RS_RCR: ++ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_RS_RCR, 0); ++ DBG_871X("wirte REG_RCR, set bit6 on\n"); ++ break; ++ case TDLS_CKALV_PH1: ++ _set_timer(&ptdls_sta->alive_timer2, TDLS_ALIVE_TIMER_PH2); ++ break; ++ case TDLS_CKALV_PH2: ++ _set_timer(&ptdls_sta->alive_timer1, TDLS_ALIVE_TIMER_PH1); ++ break; ++ case TDLS_FREE_STA: ++ free_tdls_sta(padapter, ptdls_sta); ++ break; + -+ break; -+ case TDLS_CH_SW_BACK: -+ pchsw_info->ch_sw_state &= ~(TDLS_PEER_AT_OFF_STATE | TDLS_WAIT_CH_RSP_STATE); -+ ATOMIC_SET(&pchsw_info->chsw_on, _FALSE); -+ SelectChannel(padapter, padapter->mlmeextpriv.cur_channel); -+ issue_nulldata(padapter, NULL, 0, 0, 0); -+ break; -+#endif -+ case TDLS_RS_RCR: -+ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_RS_RCR, 0); -+ DBG_871X("wirte REG_RCR, set bit6 on\n"); -+ break; -+ case TDLS_TEAR_STA: -+#ifdef CONFIG_TDLS_CH_SW -+ if (_rtw_memcmp(TDLSoption->addr, pchsw_info->addr, ETH_ALEN) == _TRUE) { -+ pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE | -+ TDLS_CH_SWITCH_ON_STATE | -+ TDLS_PEER_AT_OFF_STATE); -+ ATOMIC_SET(&pchsw_info->chsw_on, _FALSE); -+ _rtw_memset(pchsw_info->addr, 0x00, ETH_ALEN); -+ } -+#endif -+ rtw_sta_media_status_rpt(padapter, ptdls_sta, 0); -+ free_tdls_sta(padapter, ptdls_sta); -+ break; + } + + //_exit_critical_bh(&(ptdlsinfo->hdl_lock), &irqL); @@ -47580,68 +32427,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux/3rdparty/rtl88 + return H2C_SUCCESS; +#else + return H2C_REJECTED; -+#endif /* CONFIG_TDLS */ ++#endif //CONFIG_TDLS + +} -+ -+u8 run_in_thread_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ struct RunInThread_param *p; -+ -+ -+ if (NULL == pbuf) -+ return H2C_PARAMETERS_ERROR; -+ p = (struct RunInThread_param*)pbuf; -+ -+ if (p->func) -+ p->func(p->context); -+ -+ return H2C_SUCCESS; -+} -+ -+u8 rtw_getmacreg_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ -+ struct readMAC_parm *preadmacparm = NULL; -+ u8 sz = 0; -+ u32 addr = 0; -+ u32 value = 0; -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ preadmacparm = (struct readMAC_parm *) pbuf; -+ sz = preadmacparm->len; -+ addr = preadmacparm->addr; -+ value = 0; -+ -+ switch (sz) { -+ case 1: -+ value = rtw_read8(padapter, addr); -+ break; -+ case 2: -+ value = rtw_read16(padapter, addr); -+ break; -+ case 4: -+ value = rtw_read32(padapter, addr); -+ break; -+ default: -+ DBG_871X("%s: Unknown size\n", __func__); -+ break; -+ } -+ DBG_871X("%s: addr:0x%02x valeu:0x%02x\n", __func__, addr, value); -+ -+ return H2C_SUCCESS; -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/core/rtw_mp.c ---- linux.old/3rdparty/rtl8812au/core/rtw_mp.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_mp.c 2017-06-07 23:07:21.003686847 +0300 -@@ -0,0 +1,2577 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_mp.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mp.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_mp.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mp.c 2018-02-06 17:42:30.697966972 +0200 +@@ -0,0 +1,1642 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -47651,25 +32447,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_MP_C_ + +#include + -+#ifdef PLATFORM_FREEBSD -+#include /* for RFHIGHPID */ -+#endif -+ -+#include "../hal/phydm/phydm_precomp.h" -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8821A) -+#include -+#endif -+ ++#include "../hal/odm_precomp.h" + +#ifdef CONFIG_MP_INCLUDED + @@ -47694,7 +32477,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + } + + return val; -+ ++ +} + +void write_macreg(_adapter *padapter, u32 addr, u32 val, u32 sz) @@ -47767,7 +32550,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + + pmp_priv->tx_pktcount = 0; + -+ pmp_priv->rx_bssidpktcount=0; + pmp_priv->rx_pktcount = 0; + pmp_priv->rx_crcerrpktcount = 0; + @@ -47778,86 +32560,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + pmp_priv->network_macaddr[4] = 0x66; + pmp_priv->network_macaddr[5] = 0x55; + -+ pmp_priv->bSetRxBssid = _FALSE; -+ pmp_priv->bRTWSmbCfg = _FALSE; -+ + pnetwork = &pmp_priv->mp_network.network; + _rtw_memcpy(pnetwork->MacAddress, pmp_priv->network_macaddr, ETH_ALEN); + + pnetwork->Ssid.SsidLength = 8; + _rtw_memcpy(pnetwork->Ssid.Ssid, "mp_871x", pnetwork->Ssid.SsidLength); -+ -+ pmp_priv->tx.payload = 2; -+#ifdef CONFIG_80211N_HT -+ pmp_priv->tx.attrib.ht_en = 1; -+#endif -+ +} + -+#ifdef PLATFORM_WINDOWS -+/* -+void mp_wi_callback( -+ IN NDIS_WORK_ITEM* pwk_item, -+ IN PVOID cntx -+ ) -+{ -+ _adapter* padapter =(_adapter *)cntx; -+ struct mp_priv *pmppriv=&padapter->mppriv; -+ struct mp_wi_cntx *pmp_wi_cntx=&pmppriv->wi_cntx; -+ -+ // Execute specified action. -+ if(pmp_wi_cntx->curractfunc != NULL) -+ { -+ LARGE_INTEGER cur_time; -+ ULONGLONG start_time, end_time; -+ NdisGetCurrentSystemTime(&cur_time); // driver version -+ start_time = cur_time.QuadPart/10; // The return value is in microsecond -+ -+ pmp_wi_cntx->curractfunc(padapter); -+ -+ NdisGetCurrentSystemTime(&cur_time); // driver version -+ end_time = cur_time.QuadPart/10; // The return value is in microsecond -+ -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("WorkItemActType: %d, time spent: %I64d us\n", -+ pmp_wi_cntx->param.act_type, (end_time-start_time))); -+ } -+ -+ NdisAcquireSpinLock(&(pmp_wi_cntx->mp_wi_lock)); -+ pmp_wi_cntx->bmp_wi_progress= _FALSE; -+ NdisReleaseSpinLock(&(pmp_wi_cntx->mp_wi_lock)); -+ -+ if (pmp_wi_cntx->bmpdrv_unload) -+ { -+ NdisSetEvent(&(pmp_wi_cntx->mp_wi_evt)); -+ } -+ -+} -+*/ -+ -+static int init_mp_priv_by_os(struct mp_priv *pmp_priv) -+{ -+ struct mp_wi_cntx *pmp_wi_cntx; -+ -+ if (pmp_priv == NULL) return _FAIL; -+ -+ pmp_priv->rx_testcnt = 0; -+ pmp_priv->rx_testcnt1 = 0; -+ pmp_priv->rx_testcnt2 = 0; -+ -+ pmp_priv->tx_testcnt = 0; -+ pmp_priv->tx_testcnt1 = 0; -+ -+ pmp_wi_cntx = &pmp_priv->wi_cntx -+ pmp_wi_cntx->bmpdrv_unload = _FALSE; -+ pmp_wi_cntx->bmp_wi_progress = _FALSE; -+ pmp_wi_cntx->curractfunc = NULL; -+ -+ return _SUCCESS; -+} -+#endif -+ -+#ifdef PLATFORM_LINUX +static int init_mp_priv_by_os(struct mp_priv *pmp_priv) +{ + int i, res; @@ -47898,24 +32607,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + + return res; +} -+#endif + +static void mp_init_xmit_attrib(struct mp_tx *pmptx, PADAPTER padapter) +{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ + struct pkt_attrib *pattrib; ++ struct tx_desc *desc; + + // init xmitframe attribute + pattrib = &pmptx->attrib; + _rtw_memset(pattrib, 0, sizeof(struct pkt_attrib)); -+ _rtw_memset(pmptx->desc, 0, TXDESC_SIZE); ++ desc = &pmptx->desc; ++ _rtw_memset(desc, 0, TXDESC_SIZE); + + pattrib->ether_type = 0x8712; -+ #if 0 -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ #endif ++ //_rtw_memcpy(pattrib->src, padapter->eeprompriv.mac_addr, ETH_ALEN); ++// _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); + _rtw_memset(pattrib->dst, 0xFF, ETH_ALEN); + +// pattrib->dhcp_pkt = 0; @@ -47929,38 +32635,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c +// do_queue_select(padapter, pattrib); + pattrib->nr_frags = 1; + pattrib->encrypt = 0; -+ pattrib->bswenc = _FALSE; -+ pattrib->qos_en = _FALSE; -+ -+ pattrib->pktlen = 1500; -+ -+#ifdef CONFIG_80211AC_VHT -+ if (pHalData->rf_type == RF_1T1R) -+ pattrib->raid = RATEID_IDX_VHT_1SS; -+ else if (pHalData->rf_type == RF_2T2R || pHalData->rf_type == RF_2T4R) -+ pattrib->raid = RATEID_IDX_VHT_2SS; -+ else if (pHalData->rf_type == RF_3T3R) -+ pattrib->raid = RATEID_IDX_VHT_3SS; -+ else -+ pattrib->raid = RATEID_IDX_BGN_40M_1SS; -+#endif ++ pattrib->bswenc = false; ++ pattrib->qos_en = false; +} + +s32 init_mp_priv(PADAPTER padapter) +{ + struct mp_priv *pmppriv = &padapter->mppriv; -+ PHAL_DATA_TYPE pHalData; + -+ pHalData = GET_HAL_DATA(padapter); -+ + _init_mp_priv_(pmppriv); + pmppriv->papdater = padapter; -+ pmppriv->mp_dm =0; ++ + pmppriv->tx.stop = 1; -+ pmppriv->bSetTxPower=0; //for manually set tx power -+ pmppriv->bTxBufCkFail=_FALSE; -+ pmppriv->pktInterval=0; -+ + mp_init_xmit_attrib(&pmppriv->tx, padapter); + + switch (padapter->registrypriv.rf_config) { @@ -47979,14 +32665,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + pmppriv->antenna_rx = ANTENNA_AB; + break; + case RF_2T4R: -+ pmppriv->antenna_tx = ANTENNA_BC; ++ pmppriv->antenna_tx = ANTENNA_AB; + pmppriv->antenna_rx = ANTENNA_ABCD; + break; + } -+ -+ pHalData->AntennaRxPath = pmppriv->antenna_rx; -+ pHalData->AntennaTxPath = pmppriv->antenna_tx; -+ ++ + return _SUCCESS; +} + @@ -48000,105 +32683,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c +} + + -+static VOID PHY_IQCalibrate_default( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery -+ ) -+{ -+ DBG_871X("%s\n", __func__); -+} -+ -+static VOID PHY_LCCalibrate_default( -+ IN PADAPTER pAdapter ++static void PHY_IQCalibrate_default( ++ PADAPTER pAdapter, ++ bool bReCovery + ) +{ + DBG_871X("%s\n", __func__); +} + -+static VOID PHY_SetRFPathSwitch_default( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bMain ++static void PHY_LCCalibrate_default( ++ PADAPTER pAdapter + ) +{ + DBG_871X("%s\n", __func__); +} + -+ -+void mpt_InitHWConfig(PADAPTER Adapter) ++static void PHY_SetRFPathSwitch_default( ++ PADAPTER pAdapter, ++ bool bMain ++ ) +{ -+ if (IS_HARDWARE_TYPE_8723B(Adapter)) { -+ // TODO: <20130114, Kordan> The following setting is only for DPDT and Fixed board type. -+ // TODO: A better solution is configure it according EFUSE during the run-time. -+ -+ PHY_SetMacReg(Adapter, 0x64, BIT20, 0x0); //0x66[4]=0 -+ PHY_SetMacReg(Adapter, 0x64, BIT24, 0x0); //0x66[8]=0 -+ PHY_SetMacReg(Adapter, 0x40, BIT4, 0x0); //0x40[4]=0 -+ PHY_SetMacReg(Adapter, 0x40, BIT3, 0x1); //0x40[3]=1 -+ PHY_SetMacReg(Adapter, 0x4C, BIT24, 0x1); //0x4C[24:23]=10 -+ PHY_SetMacReg(Adapter, 0x4C, BIT23, 0x0); //0x4C[24:23]=10 -+ PHY_SetBBReg(Adapter, 0x944, BIT1|BIT0, 0x3); //0x944[1:0]=11 -+ PHY_SetBBReg(Adapter, 0x930, bMaskByte0, 0x77); //0x930[7:0]=77 -+ PHY_SetMacReg(Adapter, 0x38, BIT11, 0x1); //0x38[11]=1 -+ -+ // TODO: <20130206, Kordan> The default setting is wrong, hard-coded here. -+ PHY_SetMacReg(Adapter, 0x778, 0x3, 0x3); // Turn off hardware PTA control (Asked by Scott) -+ PHY_SetMacReg(Adapter, 0x64, bMaskDWord, 0x36000000); //Fix BT S0/S1 -+ PHY_SetMacReg(Adapter, 0x948, bMaskDWord, 0x0); //Fix BT can't Tx -+ -+ /* <20130522, Kordan> Turn off equalizer to improve Rx sensitivity. (Asked by EEChou) */ -+ PHY_SetBBReg(Adapter, 0xA00, BIT8, 0x0); /*0xA01[0] = 0*/ -+ } else if (IS_HARDWARE_TYPE_8821(Adapter)) { -+ /* <20131121, VincentL> Add for 8821AU DPDT setting and fix switching antenna issue (Asked by Rock) -+ <20131122, VincentL> Enable for all 8821A/8811AU (Asked by Alex)*/ -+ PHY_SetMacReg(Adapter, 0x4C, BIT23, 0x0); /*0x4C[23:22]=01*/ -+ PHY_SetMacReg(Adapter, 0x4C, BIT22, 0x1); /*0x4C[23:22]=01*/ -+ } else if (IS_HARDWARE_TYPE_8188ES(Adapter)) -+ PHY_SetMacReg(Adapter, 0x4C , BIT23, 0); /*select DPDT_P and DPDT_N as output pin*/ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(Adapter)) -+ PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8814A, 0x2000); -+#endif -+ /* -+ else if(IS_HARDWARE_TYPE_8822B(Adapter)) -+ { -+ PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8822B, 0x2000); -+ }*/ ++ DBG_871X("%s\n", __func__); +} + -+#ifdef CONFIG_RTL8188E -+#define PHY_IQCalibrate(a,b) PHY_IQCalibrate_8188E(a,b) -+#define PHY_LCCalibrate(a) PHY_LCCalibrate_8188E(&(GET_HAL_DATA(a)->odmpriv)) -+#define PHY_SetRFPathSwitch(a,b) PHY_SetRFPathSwitch_8188E(a,b) -+#endif -+ -+#ifdef CONFIG_RTL8814A -+#define PHY_IQCalibrate(a,b) PHY_IQCalibrate_8814A(&(GET_HAL_DATA(a)->odmpriv), b) -+#define PHY_LCCalibrate(a) PHY_LCCalibrate_8814A(&(GET_HAL_DATA(a)->odmpriv)) -+#define PHY_SetRFPathSwitch(a,b) PHY_SetRFPathSwitch_8814A(a,b) -+#endif /* CONFIG_RTL8814A */ -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+/* -+#define PHY_IQCalibrate(a,b) PHY_IQCalibrate_8812A(a,b) -+#define PHY_LCCalibrate(a) PHY_LCCalibrate_8812A(&(GET_HAL_DATA(a)->odmpriv)) -+#define PHY_SetRFPathSwitch(a,b) PHY_SetRFPathSwitch_8812A(a,b) -+*/ -+ -+#ifndef CONFIG_RTL8812A -+#define PHY_IQCalibrate_8812A -+#define PHY_LCCalibrate_8812A -+#define PHY_SetRFPathSwitch_8812A -+#endif -+ -+#ifndef CONFIG_RTL8821A -+#define PHY_IQCalibrate_8821A -+#define PHY_LCCalibrate_8821A -+#define PHY_SetRFPathSwitch_8812A -+#endif -+ +#define PHY_IQCalibrate(_Adapter, b) \ + IS_HARDWARE_TYPE_8812(_Adapter) ? PHY_IQCalibrate_8812A(_Adapter, b) : \ -+ IS_HARDWARE_TYPE_8821(_Adapter) ? PHY_IQCalibrate_8821A(&(GET_HAL_DATA(_Adapter)->odmpriv), b) : \ ++ IS_HARDWARE_TYPE_8821(_Adapter) ? PHY_IQCalibrate_8821A(_Adapter, b) : \ + PHY_IQCalibrate_default(_Adapter, b) + +#define PHY_LCCalibrate(_Adapter) \ @@ -48110,57 +32720,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + (IS_HARDWARE_TYPE_JAGUAR(_Adapter)) ? PHY_SetRFPathSwitch_8812A(_Adapter, b) : \ + PHY_SetRFPathSwitch_default(_Adapter, b) + -+#endif //#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+#ifdef CONFIG_RTL8192E -+#define PHY_IQCalibrate(a,b) PHY_IQCalibrate_8192E(a,b) -+#define PHY_LCCalibrate(a) PHY_LCCalibrate_8192E(&(GET_HAL_DATA(a)->odmpriv)) -+#define PHY_SetRFPathSwitch(a,b) PHY_SetRFPathSwitch_8192E(a,b) -+#endif //CONFIG_RTL8812A_8821A -+ -+#ifdef CONFIG_RTL8723B -+static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) -+{ -+ PHAL_DATA_TYPE pHalData; -+ u8 b2ant; //false:1ant, true:2-ant -+ u8 RF_Path; //0:S1, 1:S0 -+ -+ pHalData = GET_HAL_DATA(padapter); -+ b2ant = pHalData->EEPROMBluetoothAntNum==Ant_x2?_TRUE:_FALSE; -+ -+ PHY_IQCalibrate_8723B(padapter, bReCovery, _FALSE, b2ant, pHalData->ant_path); -+} -+ -+ -+#define PHY_LCCalibrate(a) PHY_LCCalibrate_8723B(&(GET_HAL_DATA(a)->odmpriv)) -+#define PHY_SetRFPathSwitch(a,b) PHY_SetRFPathSwitch_8723B(a,b) -+#endif -+ -+#ifdef CONFIG_RTL8703B -+static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) -+{ -+ PHY_IQCalibrate_8703B(padapter, bReCovery); -+} -+ -+ -+#define PHY_LCCalibrate(a) PHY_LCCalibrate_8703B(&(GET_HAL_DATA(a)->odmpriv)) -+#define PHY_SetRFPathSwitch(a, b) -+#endif -+ -+#ifdef CONFIG_RTL8188F -+static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) -+{ -+ PHY_IQCalibrate_8188F(padapter, bReCovery, _FALSE); -+} -+ -+ -+#define PHY_LCCalibrate(a) PHY_LCCalibrate_8188F(&(GET_HAL_DATA(a)->odmpriv)) -+#define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8188F(a, b) -+#endif -+ +s32 +MPT_InitializeAdapter( -+ IN PADAPTER pAdapter, -+ IN u8 Channel ++ PADAPTER pAdapter, ++ u8 Channel + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); @@ -48169,69 +32732,62 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + u32 ledsetting; + struct mlme_priv *pmlmepriv = &pAdapter->mlmepriv; + -+ pMptCtx->bMptDrvUnload = _FALSE; -+ pMptCtx->bMassProdTest = _FALSE; -+ pMptCtx->bMptIndexEven = _TRUE; //default gain index is -6.0db -+ pMptCtx->h2cReqNum = 0x0; -+ //init for BT MP -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8821A) -+ pMptCtx->bMPh2c_timeout = _FALSE; -+ pMptCtx->MptH2cRspEvent = _FALSE; -+ pMptCtx->MptBtC2hEvent = _FALSE; -+ _rtw_init_sema(&pMptCtx->MPh2c_Sema, 0); -+ _init_timer( &pMptCtx->MPh2c_timeout_timer, pAdapter->pnetdev, MPh2c_timeout_handle, pAdapter ); -+#endif -+ -+ mpt_InitHWConfig(pAdapter); -+ -+#ifdef CONFIG_RTL8723B -+ rtl8723b_InitAntenna_Selection(pAdapter); -+ if (IS_HARDWARE_TYPE_8723B(pAdapter)) -+ { -+ -+ /* <20130522, Kordan> Turn off equalizer to improve Rx sensitivity. (Asked by EEChou)*/ -+ PHY_SetBBReg(pAdapter, 0xA00, BIT8, 0x0); -+ PHY_SetRFPathSwitch(pAdapter, 1/*pHalData->bDefaultAntenna*/); /*default use Main*/ -+ /*<20130522, Kordan> 0x51 and 0x71 should be set immediately after path switched, or they might be overwritten. */ -+ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)) -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); -+ else -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); -+ } -+ /*set ant to wifi side in mp mode*/ -+ rtw_write16(pAdapter, 0x870, 0x300); -+ rtw_write16(pAdapter, 0x860, 0x110); -+#endif -+ -+ pMptCtx->bMptWorkItemInProgress = _FALSE; -+ pMptCtx->CurrMptAct = NULL; -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; + //------------------------------------------------------------------------- ++ // HW Initialization for 8190 MPT. ++ //------------------------------------------------------------------------- ++ //------------------------------------------------------------------------- ++ // SW Initialization for 8190 MP. ++ //------------------------------------------------------------------------- ++ pMptCtx->bMptDrvUnload = false; ++ pMptCtx->bMassProdTest = false; ++ pMptCtx->bMptIndexEven = true; //default gain index is -6.0db ++ pMptCtx->h2cReqNum = 0x0; ++ /* Init mpt event. */ ++#if 0 // for Windows ++ NdisInitializeEvent( &(pMptCtx->MptWorkItemEvent) ); ++ NdisAllocateSpinLock( &(pMptCtx->MptWorkItemSpinLock) ); ++ ++ PlatformInitializeWorkItem( ++ Adapter, ++ &(pMptCtx->MptWorkItem), ++ (RT_WORKITEM_CALL_BACK)MPT_WorkItemCallback, ++ (void *)Adapter, ++ "MptWorkItem"); ++#endif ++ //init for BT MP ++ ++ pMptCtx->bMptWorkItemInProgress = false; ++ pMptCtx->CurrMptAct = NULL; ++ //------------------------------------------------------------------------- ++ + // Don't accept any packets + rtw_write32(pAdapter, REG_RCR, 0); + -+ //ledsetting = rtw_read32(pAdapter, REG_LEDCFG0); -+ //rtw_write32(pAdapter, REG_LEDCFG0, ledsetting & ~LED0DIS); -+ -+ //rtw_write32(pAdapter, REG_LEDCFG0, 0x08080); -+ ledsetting = rtw_read32(pAdapter, REG_LEDCFG0); -+ -+ ++ if(IS_HARDWARE_TYPE_8192DU(pAdapter)) ++ { ++ rtw_write32(pAdapter, REG_LEDCFG0, 0x8888); ++ } ++ else ++ { ++ //rtw_write32(pAdapter, REG_LEDCFG0, 0x08080); ++ ledsetting = rtw_read32(pAdapter, REG_LEDCFG0); ++ } ++ ++ PHY_IQCalibrate(pAdapter, false); ++ dm_CheckTXPowerTracking(&pHalData->odmpriv); //trigger thermal meter + PHY_LCCalibrate(pAdapter); -+ PHY_IQCalibrate(pAdapter, _FALSE); -+ //dm_CheckTXPowerTracking(&pHalData->odmpriv); //trigger thermal meter -+ -+ PHY_SetRFPathSwitch(pAdapter, 1/*pHalData->bDefaultAntenna*/); //default use Main -+ ++ + pMptCtx->backup0xc50 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_XAAGCCore1, bMaskByte0); + pMptCtx->backup0xc58 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_XBAGCCore1, bMaskByte0); + pMptCtx->backup0xc30 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_RxDetector1, bMaskByte0); -+ pMptCtx->backup0x52_RF_A = (u1Byte)PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0); -+ pMptCtx->backup0x52_RF_B = (u1Byte)PHY_QueryRFReg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0); -+#ifdef CONFIG_RTL8188E -+ rtw_write32(pAdapter, REG_MACID_NO_LINK_0, 0x0); -+ rtw_write32(pAdapter, REG_MACID_NO_LINK_1, 0x0); -+#endif ++ ++ //set ant to wifi side in mp mode ++ rtw_write16(pAdapter, 0x870, 0x300); ++ rtw_write16(pAdapter, 0x860, 0x110); ++ ++ if (pAdapter->registrypriv.mp_mode == 1) ++ pmlmepriv->fw_state = WIFI_MP_STATE; ++ + return rtStatus; +} + @@ -48252,46 +32808,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + * 05/18/2007 MHC Add normal driver MPHalt code. + * + *---------------------------------------------------------------------------*/ -+VOID ++void +MPT_DeInitAdapter( -+ IN PADAPTER pAdapter ++ PADAPTER pAdapter + ) +{ + PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; + -+ pMptCtx->bMptDrvUnload = _TRUE; -+ #if defined(CONFIG_RTL8723B) -+ _rtw_free_sema(&(pMptCtx->MPh2c_Sema)); -+ _cancel_timer_ex( &pMptCtx->MPh2c_timeout_timer); -+ #endif -+ #if defined(CONFIG_RTL8723B) -+ PHY_SetBBReg(pAdapter,0xA01, BIT0, 1); ///suggestion by jerry for MP Rx. -+ #endif -+#if 0 // for Windows -+ PlatformFreeWorkItem( &(pMptCtx->MptWorkItem) ); -+ -+ while(pMptCtx->bMptWorkItemInProgress) -+ { -+ if(NdisWaitEvent(&(pMptCtx->MptWorkItemEvent), 50)) -+ { -+ break; -+ } -+ } -+ NdisFreeSpinLock( &(pMptCtx->MptWorkItemSpinLock) ); -+#endif ++ pMptCtx->bMptDrvUnload = true; +} + +static u8 mpt_ProStartTest(PADAPTER padapter) +{ + PMPT_CONTEXT pMptCtx = &padapter->mppriv.MptCtx; + -+ pMptCtx->bMassProdTest = _TRUE; -+ pMptCtx->bStartContTx = _FALSE; -+ pMptCtx->bCckContTx = _FALSE; -+ pMptCtx->bOfdmContTx = _FALSE; -+ pMptCtx->bSingleCarrier = _FALSE; -+ pMptCtx->bCarrierSuppression = _FALSE; -+ pMptCtx->bSingleTone = _FALSE; ++ pMptCtx->bMassProdTest = true; ++ pMptCtx->bStartContTx = false; ++ pMptCtx->bCckContTx = false; ++ pMptCtx->bOfdmContTx = false; ++ pMptCtx->bSingleCarrier = false; ++ pMptCtx->bCarrierSuppression = false; ++ pMptCtx->bSingleTone = false; + + return _SUCCESS; +} @@ -48302,20 +32839,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c +s32 SetPowerTracking(PADAPTER padapter, u8 enable) +{ + -+ hal_mpt_SetPowerTracking(padapter, enable); ++ Hal_SetPowerTracking( padapter, enable ); + return 0; +} + +void GetPowerTracking(PADAPTER padapter, u8 *enable) +{ -+ hal_mpt_GetPowerTracking(padapter, enable); ++ Hal_GetPowerTracking( padapter, enable ); +} + +static void disable_dm(PADAPTER padapter) +{ + u8 v8; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ + + //3 1. disable firmware dynamic mechanism + // disable Power Training, Rate Adaptive @@ -48324,195 +32862,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + rtw_write8(padapter, REG_BCN_CTRL, v8); + + //3 2. disable driver dynamic mechanism -+ rtw_phydm_func_disable_all(padapter); ++ // disable Dynamic Initial Gain ++ // disable High Power ++ // disable Power Tracking ++ Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); + + // enable APK, LCK and IQK but disable power tracking -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _FALSE; -+ rtw_phydm_func_set(padapter, ODM_RF_CALIBRATION); -+ -+//#ifdef CONFIG_BT_COEXIST -+// rtw_btcoex_Switch(padapter, 0); //remove for BT MP Down. -+//#endif ++ Switch_DM_Func(padapter, DYNAMIC_RF_CALIBRATION, true); +} + -+ -+void MPT_PwrCtlDM(PADAPTER padapter, u32 bstart) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ if (bstart==1){ -+ DBG_871X("in MPT_PwrCtlDM start\n"); -+ rtw_phydm_func_set(padapter, ODM_RF_TX_PWR_TRACK | ODM_RF_CALIBRATION); -+ -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; -+ padapter->mppriv.mp_dm =1; -+ -+ }else{ -+ DBG_871X("in MPT_PwrCtlDM stop \n"); -+ disable_dm(padapter); -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _FALSE; -+ padapter->mppriv.mp_dm = 0; -+ { -+ TXPWRTRACK_CFG c; -+ u1Byte chnl =0 ; -+ _rtw_memset(&c, 0, sizeof(TXPWRTRACK_CFG)); -+ ConfigureTxpowerTrack(pDM_Odm, &c); -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+ if (*c.ODM_TxPwrTrackSetPwr) { -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, ODM_RF_PATH_A, chnl); -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, ODM_RF_PATH_B, chnl); -+ } -+ } -+ } -+ -+} -+ -+ -+u32 mp_join(PADAPTER padapter,u8 mode) ++//This function initializes the DUT to the MP test mode ++s32 mp_start_test(PADAPTER padapter) +{ + WLAN_BSSID_EX bssid; + struct sta_info *psta; + u32 length; + u8 val8; ++ + _irqL irqL; + s32 res = _SUCCESS; + + struct mp_priv *pmppriv = &padapter->mppriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct wlan_network *tgt_network = &pmlmepriv->cur_network; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX*)(&(pmlmeinfo->network)); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ pwdev->iftype = NL80211_IFTYPE_ADHOC; -+#endif //#ifdef CONFIG_IOCTL_CFG80211 -+ // 1. initialize a new WLAN_BSSID_EX -+ _rtw_memset(&bssid, 0, sizeof(WLAN_BSSID_EX)); -+ DBG_8192C("%s ,pmppriv->network_macaddr=%x %x %x %x %x %x \n",__func__, -+ pmppriv->network_macaddr[0],pmppriv->network_macaddr[1],pmppriv->network_macaddr[2],pmppriv->network_macaddr[3],pmppriv->network_macaddr[4],pmppriv->network_macaddr[5]); -+ _rtw_memcpy(bssid.MacAddress, pmppriv->network_macaddr, ETH_ALEN); -+ -+ if( mode==WIFI_FW_ADHOC_STATE ){ -+ bssid.Ssid.SsidLength = strlen("mp_pseudo_adhoc"); -+ _rtw_memcpy(bssid.Ssid.Ssid, (u8*)"mp_pseudo_adhoc", bssid.Ssid.SsidLength); -+ bssid.InfrastructureMode = Ndis802_11IBSS; -+ bssid.NetworkTypeInUse = Ndis802_11DS; -+ bssid.IELength = 0; -+ bssid.Configuration.DSConfig=pmppriv->channel; -+ -+ }else if(mode==WIFI_FW_STATION_STATE){ -+ bssid.Ssid.SsidLength = strlen("mp_pseudo_STATION"); -+ _rtw_memcpy(bssid.Ssid.Ssid, (u8*)"mp_pseudo_STATION", bssid.Ssid.SsidLength); -+ bssid.InfrastructureMode = Ndis802_11Infrastructure; -+ bssid.NetworkTypeInUse = Ndis802_11DS; -+ bssid.IELength = 0; -+ } -+ -+ length = get_WLAN_BSSID_EX_sz(&bssid); -+ if (length % 4) -+ bssid.Length = ((length >> 2) + 1) << 2; //round up to multiple of 4 bytes. -+ else -+ bssid.Length = length; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) -+ goto end_of_mp_start_test; -+ -+ //init mp_start_test status -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ rtw_disassoc_cmd(padapter, 500, _TRUE); -+ rtw_indicate_disconnect(padapter); -+ rtw_free_assoc_resources(padapter, 1); -+ } -+ pmppriv->prev_fw_state = get_fwstate(pmlmepriv); -+ pmlmepriv->fw_state = WIFI_MP_STATE; -+ -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ -+ //3 2. create a new psta for mp driver -+ //clear psta in the cur_network, if any -+ psta = rtw_get_stainfo(&padapter->stapriv, tgt_network->network.MacAddress); -+ if (psta) rtw_free_stainfo(padapter, psta); -+ -+ psta = rtw_alloc_stainfo(&padapter->stapriv, bssid.MacAddress); -+ if (psta == NULL) { -+ RT_TRACE(_module_mp_, _drv_err_, ("mp_start_test: Can't alloc sta_info!\n")); -+ pmlmepriv->fw_state = pmppriv->prev_fw_state; -+ res = _FAIL; -+ goto end_of_mp_start_test; -+ } -+ set_fwstate(pmlmepriv,WIFI_ADHOC_MASTER_STATE); -+ //3 3. join psudo AdHoc -+ tgt_network->join_res = 1; -+ tgt_network->aid = psta->aid = 1; -+ -+ _rtw_memcpy(&padapter->registrypriv.dev_network, &bssid, length); -+ rtw_update_registrypriv_dev_network(padapter); -+ _rtw_memcpy(&tgt_network->network,&padapter->registrypriv.dev_network, padapter->registrypriv.dev_network.Length); -+ _rtw_memcpy(pnetwork,&padapter->registrypriv.dev_network, padapter->registrypriv.dev_network.Length); -+ -+ rtw_indicate_connect(padapter); -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ set_fwstate(pmlmepriv,_FW_LINKED); -+ -+end_of_mp_start_test: -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if(1) //(res == _SUCCESS) -+ { -+ // set MSR to WIFI_FW_ADHOC_STATE -+ if( mode==WIFI_FW_ADHOC_STATE ){ -+ -+ val8 = rtw_read8(padapter, MSR) & 0xFC; // 0x0102 -+ val8 |= WIFI_FW_ADHOC_STATE; -+ rtw_write8(padapter, MSR, val8); // Link in ad hoc network -+ } -+ else { -+ Set_MSR(padapter, WIFI_FW_STATION_STATE); -+ -+ DBG_8192C("%s , pmppriv->network_macaddr =%x %x %x %x %x %x\n",__func__, -+ pmppriv->network_macaddr[0],pmppriv->network_macaddr[1],pmppriv->network_macaddr[2],pmppriv->network_macaddr[3],pmppriv->network_macaddr[4],pmppriv->network_macaddr[5]); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmppriv->network_macaddr); -+ } -+ } -+ -+ return res; -+} -+//This function initializes the DUT to the MP test mode -+s32 mp_start_test(PADAPTER padapter) -+{ -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ s32 res = _SUCCESS; + + padapter->registrypriv.mp_mode = 1; ++ pmppriv->bSetTxPower=0; //for manually set tx power + + //3 disable dynamic mechanism + disable_dm(padapter); -+ #ifdef CONFIG_RTL8814A -+ rtl8814_InitHalDm(padapter); -+ #endif /* CONFIG_RTL8814A */ -+ #ifdef CONFIG_RTL8812A + rtl8812_InitHalDm(padapter); -+ #endif /* CONFIG_RTL8812A */ -+ #ifdef CONFIG_RTL8723B -+ rtl8723b_InitHalDm(padapter); -+ #endif /* CONFIG_RTL8723B */ -+ #ifdef CONFIG_RTL8703B -+ rtl8703b_InitHalDm(padapter); -+ #endif /* CONFIG_RTL8703B */ -+ #ifdef CONFIG_RTL8192E -+ rtl8192e_InitHalDm(padapter); -+ #endif -+ #ifdef CONFIG_RTL8188F -+ rtl8188f_InitHalDm(padapter); -+ #endif -+ + //3 0. update mp_priv + + if (padapter->registrypriv.rf_config == RF_MAX_TYPE) { @@ -48536,12 +32915,81 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + pmppriv->antenna_tx = ANTENNA_AB; + pmppriv->antenna_rx = ANTENNA_ABCD; + break; -+ } ++ } + } + + mpt_ProStartTest(padapter); + -+ mp_join(padapter,WIFI_FW_ADHOC_STATE); ++ //3 1. initialize a new WLAN_BSSID_EX ++// _rtw_memset(&bssid, 0, sizeof(WLAN_BSSID_EX)); ++ _rtw_memcpy(bssid.MacAddress, pmppriv->network_macaddr, ETH_ALEN); ++ bssid.Ssid.SsidLength = strlen("mp_pseudo_adhoc"); ++ _rtw_memcpy(bssid.Ssid.Ssid, (u8*)"mp_pseudo_adhoc", bssid.Ssid.SsidLength); ++ bssid.InfrastructureMode = Ndis802_11IBSS; ++ bssid.NetworkTypeInUse = Ndis802_11DS; ++ bssid.IELength = 0; ++ ++ length = get_WLAN_BSSID_EX_sz(&bssid); ++ if (length % 4) ++ bssid.Length = ((length >> 2) + 1) << 2; //round up to multiple of 4 bytes. ++ else ++ bssid.Length = length; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) ++ goto end_of_mp_start_test; ++ ++ //init mp_start_test status ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { ++ rtw_disassoc_cmd(padapter, 500, true); ++ rtw_indicate_disconnect(padapter); ++ rtw_free_assoc_resources(padapter, 1); ++ } ++ pmppriv->prev_fw_state = get_fwstate(pmlmepriv); ++ if (padapter->registrypriv.mp_mode == 1) ++ pmlmepriv->fw_state = WIFI_MP_STATE; ++#if 0 ++ if (pmppriv->mode == _LOOPBOOK_MODE_) { ++ set_fwstate(pmlmepriv, WIFI_MP_LPBK_STATE); //append txdesc ++ RT_TRACE(_module_mp_, _drv_notice_, ("+start mp in Lookback mode\n")); ++ } else { ++ RT_TRACE(_module_mp_, _drv_notice_, ("+start mp in normal mode\n")); ++ } ++#endif ++ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); ++ ++ //3 2. create a new psta for mp driver ++ //clear psta in the cur_network, if any ++ psta = rtw_get_stainfo(&padapter->stapriv, tgt_network->network.MacAddress); ++ if (psta) rtw_free_stainfo(padapter, psta); ++ ++ psta = rtw_alloc_stainfo(&padapter->stapriv, bssid.MacAddress); ++ if (psta == NULL) { ++ RT_TRACE(_module_mp_, _drv_err_, ("mp_start_test: Can't alloc sta_info!\n")); ++ pmlmepriv->fw_state = pmppriv->prev_fw_state; ++ res = _FAIL; ++ goto end_of_mp_start_test; ++ } ++ ++ //3 3. join psudo AdHoc ++ tgt_network->join_res = 1; ++ tgt_network->aid = psta->aid = 1; ++ _rtw_memcpy(&tgt_network->network, &bssid, length); ++ ++ rtw_indicate_connect(padapter); ++ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); ++ ++end_of_mp_start_test: ++ ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++ ++ if (res == _SUCCESS) { ++ // set MSR to WIFI_FW_ADHOC_STATE ++ val8 = rtw_read8(padapter, MSR) & 0xFC; // 0x0102 ++ val8 |= WIFI_FW_ADHOC_STATE; ++ rtw_write8(padapter, MSR, val8); // Link in ad hoc network ++ } + + return res; +} @@ -48555,12 +33003,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + struct sta_info *psta; + + _irqL irqL; -+ ++ + if(pmppriv->mode==MP_ON) + { + pmppriv->bSetTxPower=0; -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _FALSE) ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == false) + goto end_of_mp_stop_test; + + //3 1. disconnect psudo AdHoc @@ -48576,83 +33024,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + + //flush the cur_network + _rtw_memset(tgt_network, 0, sizeof(struct wlan_network)); -+ ++ + _clr_fwstate_(pmlmepriv, WIFI_MP_STATE); + +end_of_mp_stop_test: + + _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ #ifdef CONFIG_RTL8812A -+ rtl8812_InitHalDm(padapter); -+ #endif -+ #ifdef CONFIG_RTL8723B -+ rtl8723b_InitHalDm(padapter); -+ #endif -+ #ifdef CONFIG_RTL8703B -+ rtl8703b_InitHalDm(padapter); -+ #endif -+ #ifdef CONFIG_RTL8192E -+ rtl8192e_InitHalDm(padapter); -+ #endif -+ #ifdef CONFIG_RTL8188F -+ rtl8188f_InitHalDm(padapter); -+ #endif + } +} -+/*---------------------------hal\rtl8192c\MPT_Phy.c---------------------------*/ -+#if 0 -+//#ifdef CONFIG_USB_HCI -+static VOID mpt_AdjustRFRegByRateByChan92CU(PADAPTER pAdapter, u8 RateIdx, u8 Channel, u8 BandWidthID) -+{ -+ u8 eRFPath; -+ u32 rfReg0x26; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); + -+ -+ if (RateIdx < MPT_RATE_6M) { // CCK rate,for 88cu -+ rfReg0x26 = 0xf400; -+ } -+ else if ((RateIdx >= MPT_RATE_6M) && (RateIdx <= MPT_RATE_54M)) {// OFDM rate,for 88cu -+ if ((4 == Channel) || (8 == Channel) || (12 == Channel)) -+ rfReg0x26 = 0xf000; -+ else if ((5 == Channel) || (7 == Channel) || (13 == Channel) || (14 == Channel)) -+ rfReg0x26 = 0xf400; -+ else -+ rfReg0x26 = 0x4f200; -+ } -+ else if ((RateIdx >= MPT_RATE_MCS0) && (RateIdx <= MPT_RATE_MCS15)) {// MCS 20M ,for 88cu // MCS40M rate,for 88cu -+ -+ if (CHANNEL_WIDTH_20 == BandWidthID) { -+ if ((4 == Channel) || (8 == Channel)) -+ rfReg0x26 = 0xf000; -+ else if ((5 == Channel) || (7 == Channel) || (13 == Channel) || (14 == Channel)) -+ rfReg0x26 = 0xf400; -+ else -+ rfReg0x26 = 0x4f200; -+ } -+ else{ -+ if ((4 == Channel) || (8 == Channel)) -+ rfReg0x26 = 0xf000; -+ else if ((5 == Channel) || (7 == Channel)) -+ rfReg0x26 = 0xf400; -+ else -+ rfReg0x26 = 0x4f200; -+ } -+ } -+ -+// RT_TRACE(COMP_CMD, DBG_LOUD, ("\n mpt_AdjustRFRegByRateByChan92CU():Chan:%d Rate=%d rfReg0x26:0x%08x\n",Channel, RateIdx,rfReg0x26)); -+ for (eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) { -+ write_rfreg(pAdapter, eRFPath, RF_SYN_G2, rfReg0x26); -+ } -+} -+#endif +/*----------------------------------------------------------------------------- + * Function: mpt_SwitchRfSetting + * + * Overview: Change RF Setting when we siwthc channel/rate/BW for MP. + * -+ * Input: IN PADAPTER pAdapter ++ * Input: PADAPTER pAdapter + * + * Output: NONE + * @@ -48666,19 +33052,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + *---------------------------------------------------------------------------*/ +static void mpt_SwitchRfSetting(PADAPTER pAdapter) +{ -+ hal_mpt_SwitchRfSetting(pAdapter); ++ Hal_mpt_SwitchRfSetting(pAdapter); + } + +/*---------------------------hal\rtl8192c\MPT_Phy.c---------------------------*/ +/*---------------------------hal\rtl8192c\MPT_HelperFunc.c---------------------------*/ -+static void MPT_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14) ++static void MPT_CCKTxPowerAdjust(PADAPTER Adapter, bool bInCH14) +{ -+ hal_mpt_CCKTxPowerAdjust(Adapter, bInCH14); ++ Hal_MPT_CCKTxPowerAdjust(Adapter,bInCH14); +} + -+static void MPT_CCKTxPowerAdjustbyIndex(PADAPTER pAdapter, BOOLEAN beven) ++static void MPT_CCKTxPowerAdjustbyIndex(PADAPTER pAdapter, bool beven) +{ -+ hal_mpt_CCKTxPowerAdjustbyIndex(pAdapter, beven); ++ Hal_MPT_CCKTxPowerAdjustbyIndex(pAdapter,beven); + } + +/*---------------------------hal\rtl8192c\MPT_HelperFunc.c---------------------------*/ @@ -48691,7 +33077,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + */ +void SetChannel(PADAPTER pAdapter) +{ -+ hal_mpt_SetChannel(pAdapter); ++ Hal_SetChannel(pAdapter); +} + +/* @@ -48700,23 +33086,65 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + */ +void SetBandwidth(PADAPTER pAdapter) +{ -+ hal_mpt_SetBandwidth(pAdapter); ++ Hal_SetBandwidth(pAdapter); + +} + -+void SetAntenna(PADAPTER pAdapter) ++static void SetCCKTxPower(PADAPTER pAdapter, u8 *TxPower) +{ -+ hal_mpt_SetAntenna(pAdapter); ++ Hal_SetCCKTxPower(pAdapter,TxPower); ++} ++ ++static void SetOFDMTxPower(PADAPTER pAdapter, u8 *TxPower) ++{ ++ Hal_SetOFDMTxPower(pAdapter,TxPower); ++ } ++ ++ ++void SetAntenna(PADAPTER pAdapter) ++ { ++ Hal_SetAntenna(pAdapter); ++} ++ ++void SetAntennaPathPower(PADAPTER pAdapter) ++{ ++ Hal_SetAntennaPathPower(pAdapter); +} + +int SetTxPower(PADAPTER pAdapter) +{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u1Byte CurrChannel; ++ bool bResult = true; ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ u1Byte rf, TxPower[2]; + -+ hal_mpt_SetTxPower(pAdapter); -+ return _TRUE; ++ u8 u1TxPower = pAdapter->mppriv.txpoweridx; ++ CurrChannel = pMptCtx->MptChannelToSw; ++ ++ if(HAL_IsLegalChannel(pAdapter, CurrChannel) == false) ++ { ++ DBG_871X("SetTxPower(): CurrentChannel:%d is not valid\n", CurrChannel); ++ return false; ++ } ++ ++ TxPower[ODM_RF_PATH_A] = (u1Byte)(u1TxPower&0xff); ++ TxPower[ODM_RF_PATH_B] = (u1Byte)((u1TxPower&0xff00)>>8); ++ DBG_871X("TxPower(A, B) = (0x%x, 0x%x)\n", TxPower[ODM_RF_PATH_A], TxPower[ODM_RF_PATH_B]); ++ ++ for(rf=0; rf<2; rf++) ++ { ++ if(TxPower[rf] > MAX_TX_PWR_INDEX_N_MODE) { ++ DBG_871X("===> SetTxPower: The power index is too large.\n"); ++ return false; ++ } ++ pMptCtx->TxPwrLevel[rf] = TxPower[rf]; ++ } ++ Hal_SetTxPower(pAdapter); ++ return true; +} + -+void SetTxAGCOffset(PADAPTER pAdapter, u32 ulTxAGCOffset) ++static void SetTxAGCOffset(PADAPTER pAdapter, u32 ulTxAGCOffset) +{ + u32 TxAGCOffset_B, TxAGCOffset_C, TxAGCOffset_D,tmpAGC; + @@ -48731,98 +33159,80 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + +void SetDataRate(PADAPTER pAdapter) +{ -+ hal_mpt_SetDataRate(pAdapter); ++ Hal_SetDataRate(pAdapter); +} + -+void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter ,BOOLEAN bMain) ++void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter ,bool bMain) +{ + -+ PHY_SetRFPathSwitch(pAdapter, bMain); ++ PHY_SetRFPathSwitch(pAdapter,bMain); + +} + + +s32 SetThermalMeter(PADAPTER pAdapter, u8 target_ther) +{ -+ return hal_mpt_SetThermalMeter(pAdapter, target_ther); ++ return Hal_SetThermalMeter( pAdapter, target_ther); +} + +static void TriggerRFThermalMeter(PADAPTER pAdapter) +{ -+ hal_mpt_TriggerRFThermalMeter(pAdapter); ++ Hal_TriggerRFThermalMeter(pAdapter); +} + +static u8 ReadRFThermalMeter(PADAPTER pAdapter) +{ -+ return hal_mpt_ReadRFThermalMeter(pAdapter); ++ return Hal_ReadRFThermalMeter(pAdapter); +} + +void GetThermalMeter(PADAPTER pAdapter, u8 *value) +{ -+ hal_mpt_GetThermalMeter(pAdapter, value); ++ Hal_GetThermalMeter(pAdapter,value); +} + +void SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) +{ + PhySetTxPowerLevel(pAdapter); -+ hal_mpt_SetSingleCarrierTx(pAdapter, bStart); ++ Hal_SetSingleCarrierTx(pAdapter,bStart); +} + +void SetSingleToneTx(PADAPTER pAdapter, u8 bStart) +{ + PhySetTxPowerLevel(pAdapter); -+ hal_mpt_SetSingleToneTx(pAdapter, bStart); ++ Hal_SetSingleToneTx(pAdapter,bStart); +} + +void SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) +{ + PhySetTxPowerLevel(pAdapter); -+ hal_mpt_SetCarrierSuppressionTx(pAdapter, bStart); ++ Hal_SetCarrierSuppressionTx(pAdapter, bStart); +} + -+void SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart) ++static void SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart) +{ + PhySetTxPowerLevel(pAdapter); -+ hal_mpt_SetCCKContinuousTx(pAdapter, bStart); ++ Hal_SetCCKContinuousTx(pAdapter,bStart); +} + -+void SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart) ++static void SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart) +{ + PhySetTxPowerLevel(pAdapter); -+ hal_mpt_SetOFDMContinuousTx(pAdapter, bStart); ++ Hal_SetOFDMContinuousTx( pAdapter, bStart); +}/* mpt_StartOfdmContTx */ + +void SetContinuousTx(PADAPTER pAdapter, u8 bStart) +{ + PhySetTxPowerLevel(pAdapter); -+ hal_mpt_SetContinuousTx(pAdapter, bStart); ++ Hal_SetContinuousTx(pAdapter,bStart); +} + + +void PhySetTxPowerLevel(PADAPTER pAdapter) +{ + struct mp_priv *pmp_priv = &pAdapter->mppriv; -+ -+ if (pmp_priv->bSetTxPower==0) // for NO manually set power index -+ { -+#ifdef CONFIG_RTL8188E -+ PHY_SetTxPowerLevel8188E(pAdapter,pmp_priv->channel); -+#endif -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ PHY_SetTxPowerLevel8812(pAdapter,pmp_priv->channel); -+#endif -+#if defined(CONFIG_RTL8192E) -+ PHY_SetTxPowerLevel8192E(pAdapter,pmp_priv->channel); -+#endif -+#if defined(CONFIG_RTL8723B) -+ PHY_SetTxPowerLevel8723B(pAdapter,pmp_priv->channel); -+#endif -+#if defined(CONFIG_RTL8188F) -+ PHY_SetTxPowerLevel8188F(pAdapter, pmp_priv->channel); -+#endif -+ mpt_ProQueryCalTxPower(pAdapter,pmp_priv->antenna_tx); + -+ } ++ if (pmp_priv->bSetTxPower==0) // for NO manually set power index ++ PHY_SetTxPowerLevel8812(pAdapter,pmp_priv->channel); +} + +//------------------------------------------------------------------------------ @@ -48871,7 +33281,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + pmptx = &pmp_priv->tx; + padapter = pmp_priv->papdater; + pxmitpriv = &(padapter->xmitpriv); -+ ++ + thread_enter("RTW_MP_THREAD"); + + DBG_871X("%s:pkTx Start\n", __func__); @@ -48879,26 +33289,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + pxmitframe = alloc_mp_xmitframe(pxmitpriv); + if (pxmitframe == NULL) { + if (pmptx->stop || -+ RTW_CANNOT_RUN(padapter)) { ++ padapter->bSurpriseRemoved || ++ padapter->bDriverStopped) { + goto exit; + } + else { -+ rtw_usleep_os(10); ++ rtw_msleep_os(1); + continue; + } + } + _rtw_memcpy((u8 *)(pxmitframe->buf_addr+TXDESC_OFFSET), pmptx->buf, pmptx->write_size); + _rtw_memcpy(&(pxmitframe->attrib), &(pmptx->attrib), sizeof(struct pkt_attrib)); + -+ -+ rtw_usleep_os(padapter->mppriv.pktInterval); + dump_mpframe(padapter, pxmitframe); -+ + pmptx->sended++; + pmp_priv->tx_pktcount++; + + if (pmptx->stop || -+ RTW_CANNOT_RUN(padapter)) ++ padapter->bSurpriseRemoved || ++ padapter->bDriverStopped) + goto exit; + if ((pmptx->count != 0) && + (pmptx->count == pmptx->sended)) @@ -48916,133 +33325,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + thread_exit(); +} + -+void fill_txdesc_for_mp(PADAPTER padapter, u8 *ptxdesc) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ _rtw_memcpy(ptxdesc, pmp_priv->tx.desc, TXDESC_SIZE); -+} -+ -+#if defined(CONFIG_RTL8188E) -+void fill_tx_desc_8188e(PADAPTER padapter) ++void fill_txdesc_for_mp(PADAPTER padapter, struct tx_desc *ptxdesc) +{ + struct mp_priv *pmp_priv = &padapter->mppriv; -+ struct tx_desc *desc = (struct tx_desc *)&(pmp_priv->tx.desc); -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ u32 pkt_size = pattrib->last_txcmdsz; -+ s32 bmcast = IS_MCAST(pattrib->ra); -+// offset 0 -+#if !defined(CONFIG_RTL8188E_SDIO) && !defined(CONFIG_PCI_HCI) -+ desc->txdw0 |= cpu_to_le32(OWN | FSG | LSG); -+ desc->txdw0 |= cpu_to_le32(pkt_size & 0x0000FFFF); // packet size -+ desc->txdw0 |= cpu_to_le32(((TXDESC_SIZE + OFFSET_SZ) << OFFSET_SHT) & 0x00FF0000); //32 bytes for TX Desc -+ if (bmcast) desc->txdw0 |= cpu_to_le32(BMC); // broadcast packet -+ -+ desc->txdw1 |= cpu_to_le32((0x01 << 26) & 0xff000000); -+#endif -+ -+ desc->txdw1 |= cpu_to_le32((pattrib->mac_id) & 0x3F); //CAM_ID(MAC_ID) -+ desc->txdw1 |= cpu_to_le32((pattrib->qsel << QSEL_SHT) & 0x00001F00); // Queue Select, TID -+ desc->txdw1 |= cpu_to_le32((pattrib->raid << RATE_ID_SHT) & 0x000F0000); // Rate Adaptive ID -+ // offset 8 -+ // desc->txdw2 |= cpu_to_le32(AGG_BK);//AGG BK -+ -+ desc->txdw3 |= cpu_to_le32((pattrib->seqnum<<16)&0x0fff0000); -+ desc->txdw4 |= cpu_to_le32(HW_SSN); -+ -+ desc->txdw4 |= cpu_to_le32(USERATE); -+ desc->txdw4 |= cpu_to_le32(DISDATAFB); -+ -+ if( pmp_priv->preamble ){ -+ if (pmp_priv->rateidx <= MPT_RATE_54M) -+ desc->txdw4 |= cpu_to_le32(DATA_SHORT); // CCK Short Preamble -+ } -+ -+ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) -+ desc->txdw4 |= cpu_to_le32(DATA_BW); -+ -+ // offset 20 -+ desc->txdw5 |= cpu_to_le32(pmp_priv->rateidx & 0x0000001F); -+ -+ if( pmp_priv->preamble ){ -+ if (pmp_priv->rateidx > MPT_RATE_54M) -+ desc->txdw5 |= cpu_to_le32(SGI); // MCS Short Guard Interval -+ } -+ -+ desc->txdw5 |= cpu_to_le32(RTY_LMT_EN); // retry limit enable -+ desc->txdw5 |= cpu_to_le32(0x00180000); // DATA/RTS Rate Fallback Limit -+ -+ ++ _rtw_memcpy(ptxdesc, &(pmp_priv->tx.desc), TXDESC_SIZE); +} -+#endif + -+#if defined(CONFIG_RTL8814A) -+void fill_tx_desc_8814a(PADAPTER padapter) ++static void fill_tx_desc_8812a(PADAPTER padapter) +{ + struct mp_priv *pmp_priv = &padapter->mppriv; ++ //struct tx_desc *pDesc = &(pmp_priv->tx.desc); + u8 *pDesc = (u8 *)&(pmp_priv->tx.desc); + struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ -+ u32 pkt_size = pattrib->last_txcmdsz; -+ s32 bmcast = IS_MCAST(pattrib->ra); -+ u8 data_rate,pwr_status,offset; + -+ //SET_TX_DESC_FIRST_SEG_8814A(pDesc, 1); -+ SET_TX_DESC_LAST_SEG_8814A(pDesc, 1); -+ //SET_TX_DESC_OWN_(pDesc, 1); -+ -+ SET_TX_DESC_PKT_SIZE_8814A(pDesc, pkt_size); -+ -+ offset = TXDESC_SIZE + OFFSET_SZ; -+ -+ SET_TX_DESC_OFFSET_8814A(pDesc, offset); -+#if defined(CONFIG_PCI_HCI) -+ SET_TX_DESC_PKT_OFFSET_8814A(pDesc, 0); /* 8814AE pkt_offset is 0 */ -+#else -+ SET_TX_DESC_PKT_OFFSET_8814A(pDesc, 1); -+#endif -+ -+ if (bmcast) { -+ SET_TX_DESC_BMC_8814A(pDesc, 1); -+ } -+ -+ SET_TX_DESC_MACID_8814A(pDesc, pattrib->mac_id); -+ SET_TX_DESC_RATE_ID_8814A(pDesc, pattrib->raid); -+ -+ //SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_G); -+ SET_TX_DESC_QUEUE_SEL_8814A(pDesc, pattrib->qsel); -+ //SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT); -+ -+ if ( pmp_priv->preamble ){ -+ SET_TX_DESC_DATA_SHORT_8814A(pDesc, 1); -+ } -+ -+ if (!pattrib->qos_en) { -+ SET_TX_DESC_HWSEQ_EN_8814A(pDesc, 1); // Hw set sequence number -+ } else { -+ SET_TX_DESC_SEQ_8814A(pDesc, pattrib->seqnum); -+ } -+ -+ if (pmp_priv->bandwidth <= CHANNEL_WIDTH_160) { -+ SET_TX_DESC_DATA_BW_8814A(pDesc, pmp_priv->bandwidth); -+ } else { -+ DBG_871X("%s:Err: unknown bandwidth %d, use 20M\n", __func__,pmp_priv->bandwidth); -+ SET_TX_DESC_DATA_BW_8814A(pDesc, CHANNEL_WIDTH_20); -+ } -+ -+ SET_TX_DESC_DISABLE_FB_8814A(pDesc, 1); -+ SET_TX_DESC_USE_RATE_8814A(pDesc, 1); -+ SET_TX_DESC_TX_RATE_8814A(pDesc, pmp_priv->rateidx); -+ -+} -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+void fill_tx_desc_8812a(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ u8 *pDesc = (u8 *)&(pmp_priv->tx.desc); -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ + u32 pkt_size = pattrib->last_txcmdsz; + s32 bmcast = IS_MCAST(pattrib->ra); + u8 data_rate,pwr_status,offset; @@ -49050,18 +33345,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + SET_TX_DESC_FIRST_SEG_8812(pDesc, 1); + SET_TX_DESC_LAST_SEG_8812(pDesc, 1); + SET_TX_DESC_OWN_8812(pDesc, 1); -+ ++ + SET_TX_DESC_PKT_SIZE_8812(pDesc, pkt_size); -+ -+ offset = TXDESC_SIZE + OFFSET_SZ; ++ ++ offset = TXDESC_SIZE + OFFSET_SZ; + + SET_TX_DESC_OFFSET_8812(pDesc, offset); -+ -+#if defined(CONFIG_PCI_HCI) -+ SET_TX_DESC_PKT_OFFSET_8812(pDesc, 0); -+#else + SET_TX_DESC_PKT_OFFSET_8812(pDesc, 1); -+#endif ++ + if (bmcast) { + SET_TX_DESC_BMC_8812(pDesc, 1); + } @@ -49072,199 +33363,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + //SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_G); + SET_TX_DESC_QUEUE_SEL_8812(pDesc, pattrib->qsel); + //SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT); -+ ++ + if (!pattrib->qos_en) { + SET_TX_DESC_HWSEQ_EN_8812(pDesc, 1); // Hw set sequence number + } else { + SET_TX_DESC_SEQ_8812(pDesc, pattrib->seqnum); + } -+ -+ if (pmp_priv->bandwidth <= CHANNEL_WIDTH_160) { -+ SET_TX_DESC_DATA_BW_8812(pDesc, pmp_priv->bandwidth); -+ } else { -+ DBG_871X("%s:Err: unknown bandwidth %d, use 20M\n", __func__,pmp_priv->bandwidth); -+ SET_TX_DESC_DATA_BW_8812(pDesc, CHANNEL_WIDTH_20); -+ } + + SET_TX_DESC_DISABLE_FB_8812(pDesc, 1); + SET_TX_DESC_USE_RATE_8812(pDesc, 1); + SET_TX_DESC_TX_RATE_8812(pDesc, pmp_priv->rateidx); + +} -+#endif -+#if defined(CONFIG_RTL8192E) -+void fill_tx_desc_8192e(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ u8 *pDesc = (u8 *)&(pmp_priv->tx.desc); -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ -+ u32 pkt_size = pattrib->last_txcmdsz; -+ s32 bmcast = IS_MCAST(pattrib->ra); -+ u8 data_rate,pwr_status,offset; -+ -+ -+ SET_TX_DESC_PKT_SIZE_92E(pDesc, pkt_size); -+ -+ offset = TXDESC_SIZE + OFFSET_SZ; -+ -+ SET_TX_DESC_OFFSET_92E(pDesc, offset); -+ #if defined(CONFIG_PCI_HCI) /* 8192EE */ -+ -+ SET_TX_DESC_PKT_OFFSET_92E(pDesc, 0); /* 8192EE pkt_offset is 0 */ -+ #else /* 8192EU 8192ES */ -+ SET_TX_DESC_PKT_OFFSET_92E(pDesc, 1); -+ #endif -+ -+ if (bmcast) { -+ SET_TX_DESC_BMC_92E(pDesc, 1); -+ } -+ -+ SET_TX_DESC_MACID_92E(pDesc, pattrib->mac_id); -+ SET_TX_DESC_RATE_ID_92E(pDesc, pattrib->raid); -+ -+ -+ SET_TX_DESC_QUEUE_SEL_92E(pDesc, pattrib->qsel); -+ //SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT); -+ -+ if (!pattrib->qos_en) { -+ SET_TX_DESC_EN_HWSEQ_92E(pDesc, 1);// Hw set sequence number -+ SET_TX_DESC_HWSEQ_SEL_92E(pDesc, pattrib->hw_ssn_sel); -+ } else { -+ SET_TX_DESC_SEQ_92E(pDesc, pattrib->seqnum); -+ } -+ -+ if ((pmp_priv->bandwidth == CHANNEL_WIDTH_20) || (pmp_priv->bandwidth == CHANNEL_WIDTH_40)) { -+ SET_TX_DESC_DATA_BW_92E(pDesc, pmp_priv->bandwidth); -+ } else { -+ DBG_871X("%s:Err: unknown bandwidth %d, use 20M\n", __func__,pmp_priv->bandwidth); -+ SET_TX_DESC_DATA_BW_92E(pDesc, CHANNEL_WIDTH_20); -+ } -+ -+ //SET_TX_DESC_DATA_SC_92E(pDesc, SCMapping_92E(padapter,pattrib)); -+ -+ SET_TX_DESC_DISABLE_FB_92E(pDesc, 1); -+ SET_TX_DESC_USE_RATE_92E(pDesc, 1); -+ SET_TX_DESC_TX_RATE_92E(pDesc, pmp_priv->rateidx); -+ -+} -+#endif -+ -+#if defined(CONFIG_RTL8723B) -+void fill_tx_desc_8723b(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ u8 *ptxdesc = pmp_priv->tx.desc; -+ -+ SET_TX_DESC_AGG_BREAK_8723B(ptxdesc, 1); -+ SET_TX_DESC_MACID_8723B(ptxdesc, pattrib->mac_id); -+ SET_TX_DESC_QUEUE_SEL_8723B(ptxdesc, pattrib->qsel); -+ -+ SET_TX_DESC_RATE_ID_8723B(ptxdesc, pattrib->raid); -+ SET_TX_DESC_SEQ_8723B(ptxdesc, pattrib->seqnum); -+ SET_TX_DESC_HWSEQ_EN_8723B(ptxdesc, 1); -+ SET_TX_DESC_USE_RATE_8723B(ptxdesc, 1); -+ SET_TX_DESC_DISABLE_FB_8723B(ptxdesc, 1); -+ -+ if (pmp_priv->preamble) -+ if (pmp_priv->rateidx <= MPT_RATE_54M) { -+ SET_TX_DESC_DATA_SHORT_8723B(ptxdesc, 1); -+ } -+ -+ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) { -+ SET_TX_DESC_DATA_BW_8723B(ptxdesc, 1); -+ } -+ -+ SET_TX_DESC_TX_RATE_8723B(ptxdesc, pmp_priv->rateidx); -+ -+ SET_TX_DESC_DATA_RATE_FB_LIMIT_8723B(ptxdesc, 0x1F); -+ SET_TX_DESC_RTS_RATE_FB_LIMIT_8723B(ptxdesc, 0xF); -+} -+#endif -+ -+#if defined(CONFIG_RTL8703B) -+void fill_tx_desc_8703b(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ u8 *ptxdesc = pmp_priv->tx.desc; -+ -+ SET_TX_DESC_AGG_BREAK_8703B(ptxdesc, 1); -+ SET_TX_DESC_MACID_8703B(ptxdesc, pattrib->mac_id); -+ SET_TX_DESC_QUEUE_SEL_8703B(ptxdesc, pattrib->qsel); -+ -+ SET_TX_DESC_RATE_ID_8703B(ptxdesc, pattrib->raid); -+ SET_TX_DESC_SEQ_8703B(ptxdesc, pattrib->seqnum); -+ SET_TX_DESC_HWSEQ_EN_8703B(ptxdesc, 1); -+ SET_TX_DESC_USE_RATE_8703B(ptxdesc, 1); -+ SET_TX_DESC_DISABLE_FB_8703B(ptxdesc, 1); -+ -+ if (pmp_priv->preamble) { -+ if (pmp_priv->rateidx <= MPT_RATE_54M) -+ SET_TX_DESC_DATA_SHORT_8703B(ptxdesc, 1); -+ } -+ -+ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) -+ SET_TX_DESC_DATA_BW_8703B(ptxdesc, 1); -+ -+ SET_TX_DESC_TX_RATE_8703B(ptxdesc, pmp_priv->rateidx); -+ -+ SET_TX_DESC_DATA_RATE_FB_LIMIT_8703B(ptxdesc, 0x1F); -+ SET_TX_DESC_RTS_RATE_FB_LIMIT_8703B(ptxdesc, 0xF); -+} -+#endif -+ -+#if defined(CONFIG_RTL8188F) -+void fill_tx_desc_8188f(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ u8 *ptxdesc = pmp_priv->tx.desc; -+ -+ SET_TX_DESC_AGG_BREAK_8188F(ptxdesc, 1); -+ SET_TX_DESC_MACID_8188F(ptxdesc, pattrib->mac_id); -+ SET_TX_DESC_QUEUE_SEL_8188F(ptxdesc, pattrib->qsel); -+ -+ SET_TX_DESC_RATE_ID_8188F(ptxdesc, pattrib->raid); -+ SET_TX_DESC_SEQ_8188F(ptxdesc, pattrib->seqnum); -+ SET_TX_DESC_HWSEQ_EN_8188F(ptxdesc, 1); -+ SET_TX_DESC_USE_RATE_8188F(ptxdesc, 1); -+ SET_TX_DESC_DISABLE_FB_8188F(ptxdesc, 1); -+ -+ if (pmp_priv->preamble) -+ if (pmp_priv->rateidx <= MPT_RATE_54M) -+ SET_TX_DESC_DATA_SHORT_8188F(ptxdesc, 1); -+ -+ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) -+ SET_TX_DESC_DATA_BW_8188F(ptxdesc, 1); -+ -+ SET_TX_DESC_TX_RATE_8188F(ptxdesc, pmp_priv->rateidx); -+ -+ SET_TX_DESC_DATA_RATE_FB_LIMIT_8188F(ptxdesc, 0x1F); -+ SET_TX_DESC_RTS_RATE_FB_LIMIT_8188F(ptxdesc, 0xF); -+} -+#endif -+ -+static void Rtw_MPSetMacTxEDCA(PADAPTER padapter) -+{ -+ -+ rtw_write32(padapter, 0x508 , 0x00a422); //Disable EDCA BE Txop for MP pkt tx adjust Packet interval -+ //DBG_871X("%s:write 0x508~~~~~~ 0x%x\n", __func__,rtw_read32(padapter, 0x508)); -+ PHY_SetMacReg(padapter, 0x458 ,bMaskDWord , 0x0); -+ //DBG_8192C("%s()!!!!! 0x460 = 0x%x\n" ,__func__,PHY_QueryBBReg(padapter, 0x460, bMaskDWord)); -+ PHY_SetMacReg(padapter, 0x460 ,bMaskLWord , 0x0);//fast EDCA queue packet interval & time out vaule -+ //PHY_SetMacReg(padapter, ODM_EDCA_VO_PARAM ,bMaskLWord , 0x431C); -+ //PHY_SetMacReg(padapter, ODM_EDCA_BE_PARAM ,bMaskLWord , 0x431C); -+ //PHY_SetMacReg(padapter, ODM_EDCA_BK_PARAM ,bMaskLWord , 0x431C); -+ DBG_8192C("%s()!!!!! 0x460 = 0x%x\n" ,__func__,PHY_QueryBBReg(padapter, 0x460, bMaskDWord)); -+ -+} + +void SetPacketTx(PADAPTER padapter) +{ -+ u8 *ptr, *pkt_start, *pkt_end,*fctrl; -+ u32 pkt_size,offset,startPlace,i; ++ u8 *ptr, *pkt_start, *pkt_end; ++ u32 pkt_size,offset; ++ struct tx_desc *desc; + struct rtw_ieee80211_hdr *hdr; + u8 payload; + s32 bmcast; @@ -49272,7 +33388,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + struct mp_priv *pmp_priv; + + pmp_priv = &padapter->mppriv; -+ ++ + if (pmp_priv->tx.stop) return; + pmp_priv->tx.sended = 0; + pmp_priv->tx.stop = 0; @@ -49280,7 +33396,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + + //3 1. update_attrib() + pattrib = &pmp_priv->tx.attrib; -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->src, padapter->eeprompriv.mac_addr, ETH_ALEN); + _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); + _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); + bmcast = IS_MCAST(pattrib->ra); @@ -49291,8 +33407,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + pattrib->mac_id = 0; + pattrib->psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); + } -+ pattrib->mbssid = 0; -+ ++ + pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->pktlen; + + //3 2. allocate xmit buffer @@ -49310,49 +33425,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + pmp_priv->tx.buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pmp_priv->tx.pallocated_buf), XMITBUF_ALIGN_SZ); + ptr = pmp_priv->tx.buf; + -+ _rtw_memset(pmp_priv->tx.desc, 0, TXDESC_SIZE); ++ desc = &(pmp_priv->tx.desc); ++ _rtw_memset(desc, 0, TXDESC_SIZE); + pkt_start = ptr; + pkt_end = pkt_start + pkt_size; + + //3 3. init TX descriptor -+#if defined(CONFIG_RTL8188E) -+ if(IS_HARDWARE_TYPE_8188E(padapter)) -+ fill_tx_desc_8188e(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8814A) -+ if(IS_HARDWARE_TYPE_8814A(padapter)) -+ fill_tx_desc_8814a(padapter); -+#endif /* defined(CONFIG_RTL8814A) */ -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ if(IS_HARDWARE_TYPE_8812(padapter) || IS_HARDWARE_TYPE_8821(padapter)) ++ if(IS_HARDWARE_TYPE_8812(padapter)) + fill_tx_desc_8812a(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8192E) -+ if(IS_HARDWARE_TYPE_8192E(padapter)) -+ fill_tx_desc_8192e(padapter); -+#endif -+#if defined(CONFIG_RTL8723B) -+ if(IS_HARDWARE_TYPE_8723B(padapter)) -+ fill_tx_desc_8723b(padapter); -+#endif -+#if defined(CONFIG_RTL8703B) -+ if (IS_HARDWARE_TYPE_8703B(padapter)) -+ fill_tx_desc_8703b(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8188F) -+ if (IS_HARDWARE_TYPE_8188F(padapter)) -+ fill_tx_desc_8188f(padapter); -+#endif + + //3 4. make wlan header, make_wlanhdr() + hdr = (struct rtw_ieee80211_hdr *)pkt_start; + SetFrameSubType(&hdr->frame_ctl, pattrib->subtype); -+ // -+ SetFrDs(&hdr->frame_ctl); + _rtw_memcpy(hdr->addr1, pattrib->dst, ETH_ALEN); // DA + _rtw_memcpy(hdr->addr2, pattrib->src, ETH_ALEN); // SA + _rtw_memcpy(hdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN); // RA, BSSID @@ -49377,91 +33461,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + payload = 0x00; + break; + } -+ pmp_priv->TXradomBuffer = rtw_zmalloc(4096); -+ if(pmp_priv->TXradomBuffer == NULL) -+ { -+ DBG_871X("mp create random buffer fail!\n"); -+ goto exit; -+ } -+ -+ -+ for(i=0;i<4096;i++) -+ pmp_priv->TXradomBuffer[i] = rtw_random32() %0xFF; -+ -+ //startPlace = (u32)(rtw_random32() % 3450); -+ _rtw_memcpy(ptr, pmp_priv->TXradomBuffer,pkt_end - ptr); -+ //_rtw_memset(ptr, payload, pkt_end - ptr); -+ rtw_mfree(pmp_priv->TXradomBuffer,4096); -+ ++ ++ _rtw_memset(ptr, payload, pkt_end - ptr); ++ + //3 6. start thread -+#ifdef PLATFORM_LINUX + pmp_priv->tx.PktTxThread = kthread_run(mp_xmit_packet_thread, pmp_priv, "RTW_MP_THREAD"); + if (IS_ERR(pmp_priv->tx.PktTxThread)) + DBG_871X("Create PktTx Thread Fail !!!!!\n"); -+#endif -+#ifdef PLATFORM_FREEBSD -+{ -+ struct proc *p; -+ struct thread *td; -+ pmp_priv->tx.PktTxThread = kproc_kthread_add(mp_xmit_packet_thread, pmp_priv, -+ &p, &td, RFHIGHPID, 0, "MPXmitThread", "MPXmitThread"); -+ -+ if (pmp_priv->tx.PktTxThread < 0) -+ DBG_871X("Create PktTx Thread Fail !!!!!\n"); -+} -+#endif -+ -+ Rtw_MPSetMacTxEDCA(padapter); -+exit: -+ return; +} + -+void SetPacketRx(PADAPTER pAdapter, u8 bStartRx, u8 bAB) ++void SetPacketRx(PADAPTER pAdapter, u8 bStartRx) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct mp_priv *pmppriv = &pAdapter->mppriv; -+ u8 type; -+ type = _HW_STATE_AP_; ++ + if(bStartRx) + { -+#ifdef CONFIG_RTL8723B -+ PHY_SetMacReg(pAdapter, 0xe70, BIT23|BIT22, 0x3);// Power on adc (in RX_WAIT_CCA state) -+ write_bbreg(pAdapter, 0xa01, BIT0, bDisable);// improve Rx performance by jerry -+#endif -+ if( pmppriv->bSetRxBssid == _TRUE ){ -+ //pHalData->ReceiveConfig = RCR_APM | RCR_AM | RCR_AB |RCR_CBSSID_DATA| RCR_CBSSID_BCN| RCR_APP_ICV | RCR_AMF | RCR_HTC_LOC_CTRL | RCR_APP_MIC | RCR_APP_PHYST_RXFF; -+ pHalData->ReceiveConfig = RCR_AAP | RCR_APM | RCR_AM | RCR_AB |RCR_AMF | RCR_APP_ICV | RCR_AMF | RCR_HTC_LOC_CTRL | RCR_APP_MIC | RCR_APP_PHYST_RXFF ; -+ pHalData->ReceiveConfig |= ACRC32; -+ -+ DBG_8192C("%s , pmppriv->network_macaddr =%x %x %x %x %x %x\n",__func__, -+ pmppriv->network_macaddr[0],pmppriv->network_macaddr[1],pmppriv->network_macaddr[2],pmppriv->network_macaddr[3],pmppriv->network_macaddr[4],pmppriv->network_macaddr[5]); -+ //Set_MSR(pAdapter, WIFI_FW_AP_STATE); -+ //rtw_hal_set_hwreg(pAdapter, HW_VAR_BSSID, pmppriv->network_macaddr); -+ //rtw_hal_set_hwreg(pAdapter, HW_VAR_SET_OPMODE, (u8 *)(&type)); -+ } -+ else -+ { ++ // Accept CRC error and destination address + pHalData->ReceiveConfig = AAP | APM | AM | AB | APP_ICV | ADF | AMF | HTC_LOC_CTRL | APP_MIC | APP_PHYSTS; ++ + pHalData->ReceiveConfig |= ACRC32; ++ + rtw_write32(pAdapter, REG_RCR, pHalData->ReceiveConfig); ++ + // Accept all data frames + rtw_write16(pAdapter, REG_RXFLTMAP2, 0xFFFF); -+ // Accept CRC error and destination address -+ } + } + else + { -+#ifdef CONFIG_RTL8723B -+ PHY_SetMacReg(pAdapter, 0xe70, BIT23|BIT22, 0x00);// Power off adc (in RX_WAIT_CCA state) -+ write_bbreg(pAdapter, 0xa01, BIT0, bEnable);// improve Rx performance by jerry -+#endif + rtw_write32(pAdapter, REG_RCR, 0); + } -+ -+ if (bAB) -+ rtw_write32(pAdapter, REG_RCR, rtw_read32(pAdapter, REG_RCR)|RCR_AB); -+ else -+ rtw_write32(pAdapter, REG_RCR, rtw_read32(pAdapter, REG_RCR)&(~RCR_AB)); +} + +void ResetPhyRxPktCount(PADAPTER pAdapter) @@ -49518,14 +33546,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c +static u32 rtw_GetPSDData(PADAPTER pAdapter, u32 point) +{ + u32 psd_val=0; -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) ++ + u16 psd_reg = 0x910; + u16 psd_regL= 0xF44; -+#else -+ u16 psd_reg = 0x808; -+ u16 psd_regL= 0x8B4; -+#endif + + psd_val = rtw_read32(pAdapter, psd_reg); + @@ -49559,14 +33582,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + u32 psd_data=0; + + -+#ifdef PLATFORM_LINUX + if (!netif_running(pAdapter->pnetdev)) { + RT_TRACE(_module_mp_, _drv_warning_, ("mp_query_psd: Fail! interface not opened!\n")); + return 0; + } -+#endif + -+ if (check_fwstate(&pAdapter->mlmepriv, WIFI_MP_STATE) == _FALSE) { ++ if (check_fwstate(&pAdapter->mlmepriv, WIFI_MP_STATE) == false) { + RT_TRACE(_module_mp_, _drv_warning_, ("mp_query_psd: Fail! not in MP mode!\n")); + return 0; + } @@ -49574,12 +33595,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + if (strlen(data) == 0) { //default value + psd_pts = 128; + psd_start = 64; -+ psd_stop = 128; ++ psd_stop = 128; + } else { + sscanf(data, "pts=%d,start=%d,stop=%d", &psd_pts, &psd_start, &psd_stop); + } -+ -+ data[0]='\0'; ++ ++ _rtw_memset(data, '\0', sizeof(data)); + + i = psd_start; + while (i < psd_stop) @@ -49603,14 +33624,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c +} + + -+#if 0 ++ +void _rtw_mp_xmit_priv (struct xmit_priv *pxmitpriv) +{ + int i,res; + _adapter *padapter = pxmitpriv->adapter; + struct xmit_frame *pxmitframe = (struct xmit_frame*) pxmitpriv->pxmit_frame_buf; + struct xmit_buf *pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf; -+ ++ + u32 max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; + u32 num_xmit_extbuf = NR_XMIT_EXTBUFF; + if(padapter->registrypriv.mp_mode ==0) @@ -49620,15 +33641,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + } + else + { -+ max_xmit_extbuf_size = 6000; -+ num_xmit_extbuf = 8; ++ max_xmit_extbuf_size = 20000; ++ num_xmit_extbuf = 1; + } + + pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; + for(i=0; iregistrypriv.mp_mode ==0) + { -+ max_xmit_extbuf_size = 6000; -+ num_xmit_extbuf = 8; ++ max_xmit_extbuf_size = 20000; ++ num_xmit_extbuf = 1; + } + else + { + max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; + num_xmit_extbuf = NR_XMIT_EXTBUFF; + } -+ ++ + // Init xmit extension buff + _rtw_init_queue(&pxmitpriv->free_xmit_extbuf_queue); + + pxmitpriv->pallocated_xmit_extbuf = rtw_zvmalloc(num_xmit_extbuf * sizeof(struct xmit_buf) + 4); -+ ++ + if (pxmitpriv->pallocated_xmit_extbuf == NULL){ + RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("alloc xmit_extbuf fail!\n")); + res= _FAIL; @@ -49670,24 +33691,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + pxmitbuf->padapter = padapter; + pxmitbuf->buf_tag = XMITBUF_MGNT; + -+ if((res=rtw_os_xmit_resource_alloc(padapter, pxmitbuf,max_xmit_extbuf_size + XMITBUF_ALIGN_SZ, _TRUE)) == _FAIL) { ++ if((res=rtw_os_xmit_resource_alloc(padapter, pxmitbuf,max_xmit_extbuf_size + XMITBUF_ALIGN_SZ, false)) == _FAIL) { + res= _FAIL; + goto exit; + } -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->phead = pxmitbuf->pbuf; -+ pxmitbuf->pend = pxmitbuf->pbuf + max_xmit_extbuf_size; -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+#endif + + rtw_list_insert_tail(&pxmitbuf->list, &(pxmitpriv->free_xmit_extbuf_queue.queue)); + #ifdef DBG_XMIT_BUF_EXT + pxmitbuf->no=i; + #endif + pxmitbuf++; -+ ++ + } + + pxmitpriv->free_xmit_extbuf_cnt = num_xmit_extbuf; @@ -49695,20 +33709,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c +exit: + ; +} -+#endif + + -+ULONG getPowerDiffByRate8188E( -+ IN PADAPTER pAdapter, -+ IN u1Byte CurrChannel, -+ IN ULONG RfPath ++ ++static u32 getPowerDiffByRate8188E( ++ PADAPTER pAdapter, ++ u1Byte CurrChannel, ++ u32 RfPath + ) +{ + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ ULONG PwrGroup=0; -+ ULONG TxPower=0, Limit=0; -+ ULONG Pathmapping = (RfPath == ODM_RF_PATH_A?0:8); ++ u32 PwrGroup=0; ++ u32 TxPower=0, Limit=0; ++ u32 Pathmapping = (RfPath == ODM_RF_PATH_A?0:8); + + switch(pHalData->EEPROMRegulatory) + { @@ -49717,7 +33731,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + PwrGroup = 0; + Limit = 0xff; + break; -+ case 1: // Power-limit table-defined maximum power offset range ++ case 1: // Power-limit table-defined maximum power offset range + // choosed by min(power by rate, power limit). + { + if(pHalData->pwrGroupCnt == 1) @@ -49730,7 +33744,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + PwrGroup = 1; + else if(CurrChannel > 9) + PwrGroup = 2; -+ ++ + if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) + PwrGroup++; + else @@ -49763,123 +33777,123 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + break; + case MPT_RATE_6M: //0xe00 [31:0] = 18M,12M,09M,06M + TxPower += ((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0+Pathmapping])&0xff); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, OFDM 6M, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, OFDM 6M, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0], TxPower)); + break; + case MPT_RATE_9M: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0+Pathmapping])&0xff00)>>8); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, OFDM 9M, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, OFDM 9M, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0], TxPower)); + break; + case MPT_RATE_12M: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0+Pathmapping])&0xff0000)>>16); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, OFDM 12M, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, OFDM 12M, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0], TxPower)); + break; + case MPT_RATE_18M: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0+Pathmapping])&0xff000000)>>24); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, OFDM 24M, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, OFDM 24M, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0], TxPower)); + break; + case MPT_RATE_24M: //0xe04[31:0] = 54M,48M,36M,24M + TxPower += ((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1+Pathmapping])&0xff); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, OFDM 24M, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, OFDM 24M, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1], TxPower)); + break; + case MPT_RATE_36M: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1+Pathmapping])&0xff00)>>8); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, OFDM 36M, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, OFDM 36M, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1], TxPower)); + break; + case MPT_RATE_48M: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1+Pathmapping])&0xff0000)>>16); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, OFDM 48M, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, OFDM 48M, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1], TxPower)); + break; + case MPT_RATE_54M: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1+Pathmapping])&0xff000000)>>24); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, OFDM 54M, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, OFDM 54M, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1], TxPower)); + break; + case MPT_RATE_MCS0: //0xe10[31:0]= MCS=03,02,01,00 + TxPower += ((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2+Pathmapping])&0xff); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, MCS0, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, MCS0, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2], TxPower)); + break; + case MPT_RATE_MCS1: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2+Pathmapping])&0xff00)>>8); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, MCS1, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, MCS1, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2], TxPower)); + break; + case MPT_RATE_MCS2: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2+Pathmapping])&0xff0000)>>16); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, MCS2, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, MCS2, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2], TxPower)); + break; + case MPT_RATE_MCS3: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2+Pathmapping])&0xff000000)>>24); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, MCS3, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, MCS3, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2], TxPower)); + break; + case MPT_RATE_MCS4: //0xe14[31:0]= MCS=07,06,05,04 + TxPower += ((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3+Pathmapping])&0xff); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, MCS4, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, MCS4, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3], TxPower)); + break; + case MPT_RATE_MCS5: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3+Pathmapping])&0xff00)>>8); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, MCS5, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, MCS5, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3], TxPower)); + break; + case MPT_RATE_MCS6: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3+Pathmapping])&0xff0000)>>16); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, MCS6, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, MCS6, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3], TxPower)); + break; + case MPT_RATE_MCS7: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3+Pathmapping])&0xff000000)>>24); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, MCS7, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, MCS7, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3], TxPower)); + break; -+ ++ + case MPT_RATE_MCS8: //0xe18[31:0]= MCS=11,10,09,08 + TxPower += ((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4+Pathmapping])&0xff); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, MCS8, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, MCS8, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4], TxPower)); + break; + case MPT_RATE_MCS9: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4+Pathmapping])&0xff00)>>8); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, MCS9, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, MCS9, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4], TxPower)); + break; + case MPT_RATE_MCS10: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4+Pathmapping])&0xff0000)>>16); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, MCS10, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, MCS10, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4], TxPower)); + break; + case MPT_RATE_MCS11: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4+Pathmapping])&0xff000000)>>24); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, MCS11, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, MCS11, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4], TxPower)); + break; + case MPT_RATE_MCS12: //0xe1c[31:0]= MCS=15,14,13,12 + TxPower += ((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5+Pathmapping])&0xff); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, MCS12, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, MCS12, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5], TxPower)); + break; + case MPT_RATE_MCS13: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5+Pathmapping])&0xff00)>>8); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, MCS13, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, MCS13, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5], TxPower)); + break; + case MPT_RATE_MCS14: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5+Pathmapping])&0xff0000)>>16); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, MCS14, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, MCS14, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5], TxPower)); + break; + case MPT_RATE_MCS15: + TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5+Pathmapping])&0xff000000)>>24); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, MCS15, TxPower = %d\n", ++ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, MCS15, TxPower = %d\n", + // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5], TxPower)); + break; + default: @@ -49895,35 +33909,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + + + -+static ULONG ++static u32 +mpt_ProQueryCalTxPower_8188E( -+ IN PADAPTER pAdapter, -+ IN u1Byte RfPath ++ PADAPTER pAdapter, ++ u1Byte RfPath + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); + u1Byte TxCount=TX_1S, i = 0; //default set to 1S -+ //PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); -+ ULONG TxPower = 1, PwrGroup=0, PowerDiffByRate=0; -+ ULONG TxPowerCCK = 1, TxPowerOFDM = 1, TxPowerBW20 = 1, TxPowerBW40 = 1 ; ++ //PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); ++ u32 TxPower = 1, PwrGroup=0, PowerDiffByRate=0; ++ u32 TxPowerCCK = 1, TxPowerOFDM = 1, TxPowerBW20 = 1, TxPowerBW40 = 1 ; + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); + u1Byte CurrChannel = pHalData->CurrentChannel; -+ u1Byte index = (CurrChannel -1); ++ u1Byte index = (CurrChannel -1); + u1Byte rf_path=(RfPath), rfPath; + u1Byte limit = 0, rate = 0; + -+ if(HAL_IsLegalChannel(pAdapter, CurrChannel) == FALSE) ++ if(HAL_IsLegalChannel(pAdapter, CurrChannel) == false) + { + CurrChannel = 1; -+ } -+ -+ if(pMptCtx->MptRateIndex <= MPT_RATE_11M ) ++ } ++ ++ if( pMptCtx->MptRateIndex >= MPT_RATE_1M && ++ pMptCtx->MptRateIndex <= MPT_RATE_11M ) + { -+ TxPower = pHalData->Index24G_CCK_Base[rf_path][index]; ++ TxPower = pHalData->Index24G_CCK_Base[rf_path][index]; + } + else if(pMptCtx->MptRateIndex >= MPT_RATE_6M && + pMptCtx->MptRateIndex <= MPT_RATE_54M ) -+ { ++ { + TxPower = pHalData->Index24G_BW40_Base[rf_path][index]; + } + else if(pMptCtx->MptRateIndex >= MPT_RATE_MCS0 && @@ -49931,7 +33946,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + { + TxPower = pHalData->Index24G_BW40_Base[rf_path][index]; + } -+ ++ + //RT_DISP(FPHY, PHY_TXPWR, ("HT40 rate(%d) Tx power(RF-%c) = 0x%x\n", pMptCtx->MptRateIndex, ((rf_path==0)?'A':'B'), TxPower)); + + @@ -49939,7 +33954,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + pMptCtx->MptRateIndex <= MPT_RATE_54M ) + { + TxPower += pHalData->OFDM_24G_Diff[rf_path][TxCount]; -+ ///RT_DISP(FPHY, PHY_TXPWR, ("+OFDM_PowerDiff(RF-%c) = 0x%x\n", ((rf_path==0)?'A':'B'), ++ ///RT_DISP(FPHY, PHY_TXPWR, ("+OFDM_PowerDiff(RF-%c) = 0x%x\n", ((rf_path==0)?'A':'B'), + // pHalData->OFDM_24G_Diff[rf_path][TxCount])); + } + @@ -49948,7 +33963,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) + { + TxPower += pHalData->BW20_24G_Diff[rf_path][TxCount]; -+ // RT_DISP(FPHY, PHY_TXPWR, ("+HT20_PowerDiff(RF-%c) = 0x%x\n", ((rf_path==0)?'A':'B'), ++ // RT_DISP(FPHY, PHY_TXPWR, ("+HT20_PowerDiff(RF-%c) = 0x%x\n", ((rf_path==0)?'A':'B'), + // pHalData->BW20_24G_Diff[rf_path][TxCount])); + } + } @@ -49956,18 +33971,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + +#ifdef ENABLE_POWER_BY_RATE + PowerDiffByRate = getPowerDiffByRate8188E(pAdapter, CurrChannel, RfPath); -+#else ++#else + PowerDiffByRate = 0; +#endif + ++ ++ //RT_DISP(FPHY, PHY_TXPWR, ("+PowerDiffByRate(RF-%c) = 0x%x\n", ((rf_path==0)?'A':'B'), ++ // PowerDiffByRate)); ++ TxPower += PowerDiffByRate; ++// RT_DISP(FPHY, PHY_TXPWR, ("Final TxPower(RF-%c) = %d(0x%x)\n", ((rf_path==0)?'A':'B'), ++ // TxPower, TxPower)); ++ ++ /* ++ if(TxPower > 0x3f) ++ TxPower = 0x3f; ++ */ ++ + // 2012/11/02 Awk: add power limit mechansim -+ if( pMptCtx->MptRateIndex <= MPT_RATE_11M ) ++ if( pMptCtx->MptRateIndex >= MPT_RATE_1M && ++ pMptCtx->MptRateIndex <= MPT_RATE_11M ) + { + rate = MGN_1M; + } + else if(pMptCtx->MptRateIndex >= MPT_RATE_6M && + pMptCtx->MptRateIndex <= MPT_RATE_54M ) -+ { ++ { + rate = MGN_54M; + } + else if(pMptCtx->MptRateIndex >= MPT_RATE_MCS0 && @@ -49975,254 +34003,87 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp.c linux/3rdparty/rtl8812au/c + { + rate = MGN_MCS7; + } -+ -+ limit = (u8)PHY_GetTxPowerLimit(pAdapter, pMptCtx->RegTxPwrLimit, -+ pHalData->CurrentBandType, -+ pHalData->CurrentChannelBW,RfPath, ++ #ifdef CONFIG_8192E ++ limit = PHY_GetPowerLimitValue(pAdapter, pMptCtx->RegTxPwrLimit, ++ pHalData->CurrentBandType, ++ pHalData->CurrentChannelBW,RfPath, + rate, CurrChannel); ++ #endif ++ TxPower = TxPower > limit ? limit : TxPower; + -+ //RT_DISP(FPHY, PHY_TXPWR, ("+PowerDiffByRate(RF-%c) = 0x%x\n", ((rf_path==0)?'A':'B'), -+ // PowerDiffByRate)); -+ TxPower += PowerDiffByRate; -+ //RT_DISP(FPHY, PHY_TXPWR, ("PowerDiffByRate limit value(RF-%c) = %d\n", ((rf_path==0)?'A':'B'), -+ // limit)); -+ -+ TxPower += limit > (s8) PowerDiffByRate ? PowerDiffByRate : limit; -+ -+ return TxPower; ++ return TxPower; +} + + -+u8 -+MptToMgntRate( -+ IN ULONG MptRateIdx -+ ) -+{ -+// Mapped to MGN_XXX defined in MgntGen.h -+ switch (MptRateIdx) -+ { -+ /* CCK rate. */ -+ case MPT_RATE_1M: return MGN_1M; -+ case MPT_RATE_2M: return MGN_2M; -+ case MPT_RATE_55M: return MGN_5_5M; -+ case MPT_RATE_11M: return MGN_11M; -+ -+ /* OFDM rate. */ -+ case MPT_RATE_6M: return MGN_6M; -+ case MPT_RATE_9M: return MGN_9M; -+ case MPT_RATE_12M: return MGN_12M; -+ case MPT_RATE_18M: return MGN_18M; -+ case MPT_RATE_24M: return MGN_24M; -+ case MPT_RATE_36M: return MGN_36M; -+ case MPT_RATE_48M: return MGN_48M; -+ case MPT_RATE_54M: return MGN_54M; -+ -+ /* HT rate. */ -+ case MPT_RATE_MCS0: return MGN_MCS0; -+ case MPT_RATE_MCS1: return MGN_MCS1; -+ case MPT_RATE_MCS2: return MGN_MCS2; -+ case MPT_RATE_MCS3: return MGN_MCS3; -+ case MPT_RATE_MCS4: return MGN_MCS4; -+ case MPT_RATE_MCS5: return MGN_MCS5; -+ case MPT_RATE_MCS6: return MGN_MCS6; -+ case MPT_RATE_MCS7: return MGN_MCS7; -+ case MPT_RATE_MCS8: return MGN_MCS8; -+ case MPT_RATE_MCS9: return MGN_MCS9; -+ case MPT_RATE_MCS10: return MGN_MCS10; -+ case MPT_RATE_MCS11: return MGN_MCS11; -+ case MPT_RATE_MCS12: return MGN_MCS12; -+ case MPT_RATE_MCS13: return MGN_MCS13; -+ case MPT_RATE_MCS14: return MGN_MCS14; -+ case MPT_RATE_MCS15: return MGN_MCS15; -+ case MPT_RATE_MCS16: return MGN_MCS16; -+ case MPT_RATE_MCS17: return MGN_MCS17; -+ case MPT_RATE_MCS18: return MGN_MCS18; -+ case MPT_RATE_MCS19: return MGN_MCS19; -+ case MPT_RATE_MCS20: return MGN_MCS20; -+ case MPT_RATE_MCS21: return MGN_MCS21; -+ case MPT_RATE_MCS22: return MGN_MCS22; -+ case MPT_RATE_MCS23: return MGN_MCS23; -+ case MPT_RATE_MCS24: return MGN_MCS24; -+ case MPT_RATE_MCS25: return MGN_MCS25; -+ case MPT_RATE_MCS26: return MGN_MCS26; -+ case MPT_RATE_MCS27: return MGN_MCS27; -+ case MPT_RATE_MCS28: return MGN_MCS28; -+ case MPT_RATE_MCS29: return MGN_MCS29; -+ case MPT_RATE_MCS30: return MGN_MCS30; -+ case MPT_RATE_MCS31: return MGN_MCS31; -+ -+ /* VHT rate. */ -+ case MPT_RATE_VHT1SS_MCS0: return MGN_VHT1SS_MCS0; -+ case MPT_RATE_VHT1SS_MCS1: return MGN_VHT1SS_MCS1; -+ case MPT_RATE_VHT1SS_MCS2: return MGN_VHT1SS_MCS2; -+ case MPT_RATE_VHT1SS_MCS3: return MGN_VHT1SS_MCS3; -+ case MPT_RATE_VHT1SS_MCS4: return MGN_VHT1SS_MCS4; -+ case MPT_RATE_VHT1SS_MCS5: return MGN_VHT1SS_MCS5; -+ case MPT_RATE_VHT1SS_MCS6: return MGN_VHT1SS_MCS6; -+ case MPT_RATE_VHT1SS_MCS7: return MGN_VHT1SS_MCS7; -+ case MPT_RATE_VHT1SS_MCS8: return MGN_VHT1SS_MCS8; -+ case MPT_RATE_VHT1SS_MCS9: return MGN_VHT1SS_MCS9; -+ case MPT_RATE_VHT2SS_MCS0: return MGN_VHT2SS_MCS0; -+ case MPT_RATE_VHT2SS_MCS1: return MGN_VHT2SS_MCS1; -+ case MPT_RATE_VHT2SS_MCS2: return MGN_VHT2SS_MCS2; -+ case MPT_RATE_VHT2SS_MCS3: return MGN_VHT2SS_MCS3; -+ case MPT_RATE_VHT2SS_MCS4: return MGN_VHT2SS_MCS4; -+ case MPT_RATE_VHT2SS_MCS5: return MGN_VHT2SS_MCS5; -+ case MPT_RATE_VHT2SS_MCS6: return MGN_VHT2SS_MCS6; -+ case MPT_RATE_VHT2SS_MCS7: return MGN_VHT2SS_MCS7; -+ case MPT_RATE_VHT2SS_MCS8: return MGN_VHT2SS_MCS8; -+ case MPT_RATE_VHT2SS_MCS9: return MGN_VHT2SS_MCS9; -+ case MPT_RATE_VHT3SS_MCS0: return MGN_VHT3SS_MCS0; -+ case MPT_RATE_VHT3SS_MCS1: return MGN_VHT3SS_MCS1; -+ case MPT_RATE_VHT3SS_MCS2: return MGN_VHT3SS_MCS2; -+ case MPT_RATE_VHT3SS_MCS3: return MGN_VHT3SS_MCS3; -+ case MPT_RATE_VHT3SS_MCS4: return MGN_VHT3SS_MCS4; -+ case MPT_RATE_VHT3SS_MCS5: return MGN_VHT3SS_MCS5; -+ case MPT_RATE_VHT3SS_MCS6: return MGN_VHT3SS_MCS6; -+ case MPT_RATE_VHT3SS_MCS7: return MGN_VHT3SS_MCS7; -+ case MPT_RATE_VHT3SS_MCS8: return MGN_VHT3SS_MCS8; -+ case MPT_RATE_VHT3SS_MCS9: return MGN_VHT3SS_MCS9; -+ case MPT_RATE_VHT4SS_MCS0: return MGN_VHT4SS_MCS0; -+ case MPT_RATE_VHT4SS_MCS1: return MGN_VHT4SS_MCS1; -+ case MPT_RATE_VHT4SS_MCS2: return MGN_VHT4SS_MCS2; -+ case MPT_RATE_VHT4SS_MCS3: return MGN_VHT4SS_MCS3; -+ case MPT_RATE_VHT4SS_MCS4: return MGN_VHT4SS_MCS4; -+ case MPT_RATE_VHT4SS_MCS5: return MGN_VHT4SS_MCS5; -+ case MPT_RATE_VHT4SS_MCS6: return MGN_VHT4SS_MCS6; -+ case MPT_RATE_VHT4SS_MCS7: return MGN_VHT4SS_MCS7; -+ case MPT_RATE_VHT4SS_MCS8: return MGN_VHT4SS_MCS8; -+ case MPT_RATE_VHT4SS_MCS9: return MGN_VHT4SS_MCS9; -+ -+ case MPT_RATE_LAST: // fully automatiMGN_VHT2SS_MCS1; -+ default: -+ DBG_871X("<===MptToMgntRate(), Invalid Rate: %d!!\n", MptRateIdx); -+ return 0x0; -+ } -+} -+ -+u8 rtw_mpRateParseFunc(PADAPTER pAdapter, u8 *targetStr) -+{ -+ u16 i=0; -+ u8* rateindex_Array[] = { "1M","2M","5.5M","11M","6M","9M","12M","18M","24M","36M","48M","54M", -+ "HTMCS0","HTMCS1","HTMCS2","HTMCS3","HTMCS4","HTMCS5","HTMCS6","HTMCS7", -+ "HTMCS8","HTMCS9","HTMCS10","HTMCS11","HTMCS12","HTMCS13","HTMCS14","HTMCS15", -+ "HTMCS16","HTMCS17","HTMCS18","HTMCS19","HTMCS20","HTMCS21","HTMCS22","HTMCS23", -+ "HTMCS24","HTMCS25","HTMCS26","HTMCS27","HTMCS28","HTMCS29","HTMCS30","HTMCS31", -+ "VHT1MCS0","VHT1MCS1","VHT1MCS2","VHT1MCS3","VHT1MCS4","VHT1MCS5","VHT1MCS6","VHT1MCS7","VHT1MCS8","VHT1MCS9", -+ "VHT2MCS0","VHT2MCS1","VHT2MCS2","VHT2MCS3","VHT2MCS4","VHT2MCS5","VHT2MCS6","VHT2MCS7","VHT2MCS8","VHT2MCS9", -+ "VHT3MCS0","VHT3MCS1","VHT3MCS2","VHT3MCS3","VHT3MCS4","VHT3MCS5","VHT3MCS6","VHT3MCS7","VHT3MCS8","VHT3MCS9", -+ "VHT4MCS0","VHT4MCS1","VHT4MCS2","VHT4MCS3","VHT4MCS4","VHT4MCS5","VHT4MCS6","VHT4MCS7","VHT4MCS8","VHT4MCS9"}; -+ -+ for(i=0;i<=83;i++){ -+ if(strcmp(targetStr, rateindex_Array[i]) == 0){ -+ DBG_871X("%s , index = %d \n",__func__ ,i); -+ return i; -+ } -+ } -+ -+ printk("%s ,please input a Data RATE String as:",__func__); -+ for(i=0;i<=83;i++){ -+ printk("%s ",rateindex_Array[i]); -+ if(i%10==0) -+ printk("\n"); -+ } -+ return _FAIL; -+} -+ -+ULONG mpt_ProQueryCalTxPower( ++u32 mpt_ProQueryCalTxPower( + PADAPTER pAdapter, + u8 RfPath + ) +{ + + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ -+ ULONG TxPower = 1, PwrGroup=0, PowerDiffByRate=0; ++ u32 TxPower = 1, PwrGroup=0, PowerDiffByRate=0; ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); + u1Byte limit = 0, rate = 0; -+ -+ #if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ { -+ //return mpt_ProQueryCalTxPower_8188E(pAdapter, RfPath); -+ rate = MptToMgntRate(pAdapter->mppriv.rateidx); -+ TxPower = PHY_GetTxPowerIndex_8188E(pAdapter, RfPath, rate, -+ pHalData->CurrentChannelBW, pHalData->CurrentChannel); ++ rate=pMptCtx->MptRateIndex; + -+ } -+ #endif -+ -+ #if defined(CONFIG_RTL8723B) -+ if( IS_HARDWARE_TYPE_8723B(pAdapter) ) -+ { -+ rate = MptToMgntRate(pAdapter->mppriv.rateidx); -+ TxPower = PHY_GetTxPowerIndex_8723B(pAdapter, RfPath, rate, -+ pHalData->CurrentChannelBW, pHalData->CurrentChannel); -+ } -+ #endif -+ -+ #if defined(CONFIG_RTL8192E) -+ if( IS_HARDWARE_TYPE_8192E(pAdapter) ) -+ { -+ rate = MptToMgntRate(pAdapter->mppriv.rateidx); -+ TxPower = PHY_GetTxPowerIndex_8192E(pAdapter, RfPath, rate, -+ pHalData->CurrentChannelBW, pHalData->CurrentChannel); -+ } -+ #endif -+ #if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ if( IS_HARDWARE_TYPE_JAGUAR(pAdapter) ) -+ { -+ rate = MptToMgntRate(pAdapter->mppriv.rateidx); -+ TxPower = PHY_GetTxPowerIndex_8812A(pAdapter, RfPath, rate, -+ pHalData->CurrentChannelBW, pHalData->CurrentChannel); -+ } -+ #endif -+ #if defined(CONFIG_RTL8814A) -+ if ( IS_HARDWARE_TYPE_8814A(pAdapter) ) -+ { -+ rate = MptToMgntRate(pAdapter->mppriv.rateidx); -+ TxPower = PHY_GetTxPowerIndex_8814A(pAdapter, RfPath, rate, -+ pHalData->CurrentChannelBW, pHalData->CurrentChannel); -+ } -+ #endif -+ #if defined(CONFIG_RTL8703B) -+ if (IS_HARDWARE_TYPE_8703B(pAdapter)) { -+ rate = MptToMgntRate(pAdapter->mppriv.rateidx); -+ TxPower = PHY_GetTxPowerIndex_8703B(pAdapter, RfPath, rate, -+ pHalData->CurrentChannelBW, pHalData->CurrentChannel); -+ } -+ #endif -+ -+ #if defined(CONFIG_RTL8188F) -+ if (IS_HARDWARE_TYPE_8188F(pAdapter)) { -+ rate = MptToMgntRate(pAdapter->mppriv.rateidx); -+ TxPower = PHY_GetTxPowerIndex_8188F(pAdapter, RfPath, rate, -+ pHalData->CurrentChannelBW, pHalData->CurrentChannel); -+ } -+ #endif -+ -+ DBG_8192C("txPower=%d ,CurrentChannelBW=%d ,CurrentChannel=%d ,rate =%d\n", -+ TxPower, pHalData->CurrentChannelBW, pHalData->CurrentChannel, rate); -+ -+ pAdapter->mppriv.txpoweridx = (u8)TxPower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_A] = (u8)TxPower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_B] = (u8)TxPower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_C] = (u8)TxPower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_D] = (u8)TxPower; -+ hal_mpt_SetTxPower(pAdapter); -+ -+ return TxPower; ++ if ( IS_HARDWARE_TYPE_8188E(pAdapter) || IS_HARDWARE_TYPE_8192E(pAdapter) )//|| IS_HARDWARE_TYPE_8723B(pAdapter)) ++ { ++ return mpt_ProQueryCalTxPower_8188E(pAdapter, RfPath); ++ } ++ else ++ { ++ #ifdef CONFIG_8812A ++ TxPower = PHY_GetTxPowerIndex_8812A(pAdapter, RfPath, rate,pHalData->CurrentChannelBW, pHalData->CurrentChannel); ++ #endif ++ return TxPower; ++ } +} -+#endif + -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl8812au/core/rtw_mp_ioctl.c ---- linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_mp_ioctl.c 2017-06-07 23:07:21.003686847 +0300 -@@ -0,0 +1,2946 @@ ++ ++void Hal_ProSetCrystalCap (PADAPTER pAdapter , u32 CrystalCapVal) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ CrystalCapVal = pHalData->CrystalCap & 0x3F; ++ ++ if(IS_HARDWARE_TYPE_8192D(pAdapter)) ++ { ++ PHY_SetBBReg(pAdapter, REG_AFE_XTAL_CTRL, 0xF0, CrystalCapVal & 0x0F); ++ PHY_SetBBReg(pAdapter, REG_AFE_PLL_CTRL, 0xF0000000, (CrystalCapVal & 0xF0) >> 4); ++ } ++ else if(IS_HARDWARE_TYPE_8188E(pAdapter)) ++ { ++ // write 0x24[16:11] = 0x24[22:17] = CrystalCap ++ PHY_SetBBReg(pAdapter, REG_AFE_XTAL_CTRL, 0x7FF800, (CrystalCapVal | (CrystalCapVal << 6))); ++ } ++ else if(IS_HARDWARE_TYPE_8812(pAdapter)) ++ { ++ // write 0x2C[30:25] = 0x2C[24:19] = CrystalCap ++ PHY_SetBBReg(pAdapter, REG_MAC_PHY_CTRL, 0x7FF80000, (CrystalCapVal | (CrystalCapVal << 6))); ++ } ++ else if(IS_HARDWARE_TYPE_8821(pAdapter) || IS_HARDWARE_TYPE_8192E(pAdapter)) ++ { ++ // write 0x2C[23:18] = 0x2C[17:12] = CrystalCap ++ PHY_SetBBReg(pAdapter, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCapVal | (CrystalCapVal << 6))); ++ } ++ else ++ { ++ PHY_SetBBReg(pAdapter, 0x2c, 0xFFF000, (CrystalCapVal | (CrystalCapVal << 6))); ++ } ++} ++ ++ ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mp_ioctl.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_mp_ioctl.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mp_ioctl.c 2018-02-06 17:42:30.697966972 +0200 +@@ -0,0 +1,1637 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -50232,28 +34093,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_MP_IOCTL_C_ + +#include +#include -+#include "../hal/phydm/phydm_precomp.h" ++#include "../hal/odm_precomp.h" + +//**************** oid_rtl_seg_81_85 section start **************** -+NDIS_STATUS oid_rt_wireless_mode_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_wireless_mode_hdl(struct oid_par_priv *poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + if (poid_par_priv->information_buf_len < sizeof(u8)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + if (poid_par_priv->type_of_oid == SET_OID) { + Adapter->registrypriv.wireless_mode = *(u8*)poid_par_priv->information_buf; @@ -50262,34 +34118,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + RT_TRACE(_module_mp_, _drv_info_, ("-query Wireless Mode=%d\n", Adapter->registrypriv.wireless_mode)); + } else { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + } + -+_func_exit_; ++ + + return status; +} +//**************** oid_rtl_seg_81_87_80 section start **************** -+NDIS_STATUS oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + struct bb_reg_param *pbbreg; + u16 offset; + u32 value; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_write_bb_reg_hdl\n")); + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf); + @@ -50306,31 +34159,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + write_bbreg(Adapter, offset, 0xFFFFFFFF, value); + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + struct bb_reg_param *pbbreg; + u16 offset; + u32 value; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_read_bb_reg_hdl\n")); + + if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf); + @@ -50347,41 +34197,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + RT_TRACE(_module_mp_, _drv_notice_, + ("-oid_rt_pro_read_bb_reg_hdl: offset=0x%03X value:0x%08X\n", + offset, value)); -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + struct rf_reg_param *pbbreg; + u8 path; + u8 offset; + u32 value; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_write_rf_reg_hdl\n")); + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf); + + if (pbbreg->path >= MAX_RF_PATH_NUMS) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + if (pbbreg->offset > 0xFF) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + if (pbbreg->value > 0xFFFFF) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + path = (u8)pbbreg->path; + offset = (u8)pbbreg->offset; @@ -50392,42 +34239,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + path, offset, value)); + + _irqlevel_changed_(&oldirql, LOWER); -+ write_rfreg(Adapter, path, offset, value); ++ write_rfreg(Adapter, path, offset, value); + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + struct rf_reg_param *pbbreg; + u8 path; + u8 offset; + u32 value; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; ++ + -+_func_enter_; + + RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_read_rf_reg_hdl\n")); + + if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf); + + if (pbbreg->path >= MAX_RF_PATH_NUMS) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + if (pbbreg->offset > 0xFF) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + path = (u8)pbbreg->path; + offset = (u8)pbbreg->offset; @@ -50444,7 +34288,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + ("-oid_rt_pro_read_rf_reg_hdl: path=%d offset=0x%02X value=0x%05X\n", + path, offset, value)); + -+_func_exit_; ++ + + return status; +} @@ -50453,31 +34297,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + +//**************** oid_rtl_seg_81_80_00 section start **************** +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_set_data_rate_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_data_rate_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + u32 ratevalue;//4 -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_notice_, + ("+oid_rt_pro_set_data_rate_hdl\n")); + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + ratevalue = *((u32*)poid_par_priv->information_buf);//4 + RT_TRACE(_module_mp_, _drv_notice_, + ("oid_rt_pro_set_data_rate_hdl: data rate idx=%d\n", ratevalue)); + if (ratevalue >= MPT_RATE_LAST) -+ return NDIS_STATUS_INVALID_DATA; ++ return uint_INVALID_DATA; + + Adapter->mppriv.rateidx = ratevalue; + @@ -50485,29 +34326,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + SetDataRate(Adapter); + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_start_test_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_start_test_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + u32 mode; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_start_test_hdl\n")); + + if (Adapter->registrypriv.mp_mode == 0) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + _irqlevel_changed_(&oldirql, LOWER); + @@ -50517,7 +34355,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + Adapter->mppriv.mode = mode;// 1 for loopback + + if (mp_start_test(Adapter) == _FAIL) { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + goto exit; + } + @@ -50526,25 +34364,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + + RT_TRACE(_module_mp_, _drv_notice_, ("-oid_rt_pro_start_test_hdl: mp_mode=%d\n", Adapter->mppriv.mode)); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_stop_test_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_stop_test_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_notice_, ("+Set OID_RT_PRO_STOP_TEST\n")); + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + _irqlevel_changed_(&oldirql, LOWER); + mp_stop_test(Adapter); @@ -50552,70 +34387,64 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + + RT_TRACE(_module_mp_, _drv_notice_, ("-Set OID_RT_PRO_STOP_TEST\n")); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + u32 Channel; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_set_channel_direct_call_hdl\n")); + + if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + if (poid_par_priv->type_of_oid == QUERY_OID) { + *((u32*)poid_par_priv->information_buf) = Adapter->mppriv.channel; -+ return NDIS_STATUS_SUCCESS; ++ return uint_SUCCESS; + } + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + Channel = *((u32*)poid_par_priv->information_buf); + RT_TRACE(_module_mp_, _drv_notice_, ("oid_rt_pro_set_channel_direct_call_hdl: Channel=%d\n", Channel)); + if (Channel > 14) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + Adapter->mppriv.channel = Channel; + + _irqlevel_changed_(&oldirql, LOWER); + SetChannel(Adapter); + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_set_bandwidth_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_set_bandwidth_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + u16 bandwidth; + u16 channel_offset; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_info_, + ("+oid_rt_set_bandwidth_hdl\n")); + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + bandwidth = *((u32*)poid_par_priv->information_buf);//4 + channel_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; @@ -50633,26 +34462,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + ("-oid_rt_set_bandwidth_hdl: bandwidth=%d channel_offset=%d\n", + bandwidth, channel_offset)); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + u32 antenna; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_set_antenna_bb_hdl\n")); + + if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + if (poid_par_priv->type_of_oid == SET_OID) + { @@ -50672,33 +34498,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + *(u32*)poid_par_priv->information_buf = antenna; + } + -+_func_exit_; ++ + + return status; +} + -+NDIS_STATUS oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + u32 tx_pwr_idx; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_info_, ("+oid_rt_pro_set_tx_power_control_hdl\n")); + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + tx_pwr_idx = *((u32*)poid_par_priv->information_buf); + if (tx_pwr_idx > MAX_TX_PWR_INDEX_N_MODE) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + Adapter->mppriv.txpoweridx = (u8)tx_pwr_idx; + @@ -50710,7 +34533,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + SetTxPower(Adapter); + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} @@ -50718,138 +34541,135 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 +//------------------------------------------------------------------------------ +//**************** oid_rtl_seg_81_80_20 section start **************** +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + if (poid_par_priv->type_of_oid !=QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } + -+ if (poid_par_priv->information_buf_len == sizeof(ULONG)) { -+ *(ULONG*)poid_par_priv->information_buf = Adapter->mppriv.tx_pktcount; ++ if (poid_par_priv->information_buf_len == sizeof(u32)) { ++ *(u32*)poid_par_priv->information_buf = Adapter->mppriv.tx_pktcount; + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + } else { -+ status = NDIS_STATUS_INVALID_LENGTH; ++ status = uint_INVALID_LENGTH; + } + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } + RT_TRACE(_module_mp_, _drv_alert_, ("===> oid_rt_pro_query_rx_packet_received_hdl.\n")); -+ if (poid_par_priv->information_buf_len == sizeof(ULONG)) { -+ *(ULONG*)poid_par_priv->information_buf = Adapter->mppriv.rx_pktcount; ++ if (poid_par_priv->information_buf_len == sizeof(u32)) { ++ *(u32*)poid_par_priv->information_buf = Adapter->mppriv.rx_pktcount; + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + RT_TRACE(_module_mp_, _drv_alert_, ("recv_ok:%d \n",Adapter->mppriv.rx_pktcount)); + } else { -+ status = NDIS_STATUS_INVALID_LENGTH; ++ status = uint_INVALID_LENGTH; + } + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } + RT_TRACE(_module_mp_, _drv_alert_, ("===> oid_rt_pro_query_rx_packet_crc32_error_hdl.\n")); -+ if (poid_par_priv->information_buf_len == sizeof(ULONG)) { -+ *(ULONG*)poid_par_priv->information_buf = Adapter->mppriv.rx_crcerrpktcount; ++ if (poid_par_priv->information_buf_len == sizeof(u32)) { ++ *(u32*)poid_par_priv->information_buf = Adapter->mppriv.rx_crcerrpktcount; + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + RT_TRACE(_module_mp_, _drv_alert_, ("recv_err:%d \n",Adapter->mppriv.rx_crcerrpktcount)); + } else { -+ status = NDIS_STATUS_INVALID_LENGTH; ++ status = uint_INVALID_LENGTH; + } + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ + -+NDIS_STATUS oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } + + RT_TRACE(_module_mp_, _drv_alert_, ("===> oid_rt_pro_reset_tx_packet_sent_hdl.\n")); + Adapter->mppriv.tx_pktcount = 0; + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + if (poid_par_priv->type_of_oid != SET_OID) + { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } + -+ if (poid_par_priv->information_buf_len == sizeof(ULONG)) { ++ if (poid_par_priv->information_buf_len == sizeof(u32)) { + Adapter->mppriv.rx_pktcount = 0; + Adapter->mppriv.rx_crcerrpktcount = 0; + } else { -+ status = NDIS_STATUS_INVALID_LENGTH; ++ status = uint_INVALID_LENGTH; + } + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } + @@ -50857,89 +34677,80 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + ResetPhyRxPktCount(Adapter); + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_info_, ("+oid_rt_get_phy_rx_packet_received_hdl\n")); + + if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + -+ if (poid_par_priv->information_buf_len != sizeof(ULONG)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ if (poid_par_priv->information_buf_len != sizeof(u32)) ++ return uint_INVALID_LENGTH; + + _irqlevel_changed_(&oldirql, LOWER); -+ *(ULONG*)poid_par_priv->information_buf = GetPhyRxPktReceived(Adapter); ++ *(u32*)poid_par_priv->information_buf = GetPhyRxPktReceived(Adapter); + _irqlevel_changed_(&oldirql, RAISE); + + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + -+ RT_TRACE(_module_mp_, _drv_notice_, ("-oid_rt_get_phy_rx_packet_received_hdl: recv_ok=%d\n", *(ULONG*)poid_par_priv->information_buf)); ++ RT_TRACE(_module_mp_, _drv_notice_, ("-oid_rt_get_phy_rx_packet_received_hdl: recv_ok=%d\n", *(u32*)poid_par_priv->information_buf)); ++ + -+_func_exit_; + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_info_, ("+oid_rt_get_phy_rx_packet_crc32_error_hdl\n")); + + if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + -+ if (poid_par_priv->information_buf_len != sizeof(ULONG)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ if (poid_par_priv->information_buf_len != sizeof(u32)) ++ return uint_INVALID_LENGTH; + + _irqlevel_changed_(&oldirql, LOWER); -+ *(ULONG*)poid_par_priv->information_buf = GetPhyRxPktCRC32Error(Adapter); ++ *(u32*)poid_par_priv->information_buf = GetPhyRxPktCRC32Error(Adapter); + _irqlevel_changed_(&oldirql, RAISE); + + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + -+ RT_TRACE(_module_mp_, _drv_info_, ("-oid_rt_get_phy_rx_packet_crc32_error_hdl: recv_err=%d\n", *(ULONG*)poid_par_priv->information_buf)); ++ RT_TRACE(_module_mp_, _drv_info_, ("-oid_rt_get_phy_rx_packet_crc32_error_hdl: recv_err=%d\n", *(u32*)poid_par_priv->information_buf)); ++ + -+_func_exit_; + + return status; +} +//**************** oid_rtl_seg_81_80_20 section end **************** -+NDIS_STATUS oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + u32 bStartTest; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_set_continuous_tx_hdl\n")); + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + bStartTest = *((u32*)poid_par_priv->information_buf); + @@ -50958,26 +34769,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + } + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} + -+NDIS_STATUS oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + u32 bStartTest; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_alert_, ("+oid_rt_pro_set_single_carrier_tx_hdl\n")); + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + bStartTest = *((u32*)poid_par_priv->information_buf); + @@ -50996,26 +34804,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + } + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} + -+NDIS_STATUS oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + u32 bStartTest; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_set_carrier_suppression_tx_hdl\n")); + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + bStartTest = *((u32*)poid_par_priv->information_buf); + @@ -51034,26 +34839,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + } + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} + -+NDIS_STATUS oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u32 bStartTest; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ u32 bStartTest; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_alert_, ("+oid_rt_pro_set_single_tone_tx_hdl\n")); + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + bStartTest = *((u32*)poid_par_priv->information_buf); + @@ -51061,104 +34863,59 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + SetSingleToneTx(Adapter,(u8)bStartTest); + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} + -+NDIS_STATUS oid_rt_pro_set_modulation_hdl(struct oid_par_priv* poid_par_priv) ++uint oid_rt_pro_set_modulation_hdl(struct oid_par_priv* poid_par_priv) +{ + return 0; +} + -+NDIS_STATUS oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv) +{ + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+_func_enter_; ++ uint status = uint_SUCCESS; + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + _irqlevel_changed_(&oldirql, LOWER); -+ rtw_hal_set_hwreg(Adapter, HW_VAR_TRIGGER_GPIO_0, 0); ++ rtw_hal_set_hwreg(Adapter, HW_VAR_TRIGGER_GPIO_0, NULL); + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; -+ + return status; +} +//**************** oid_rtl_seg_81_80_00 section end **************** +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro8711_join_bss_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro8711_join_bss_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ PNDIS_802_11_SSID pssid; -+ -+_func_enter_; -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ *poid_par_priv->bytes_needed = (u32)sizeof(NDIS_802_11_SSID); -+ *poid_par_priv->bytes_rw = 0; -+ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ pssid = (PNDIS_802_11_SSID)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (mp_start_joinbss(Adapter, pssid) == _FAIL) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = sizeof(NDIS_802_11_SSID); -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_read_register_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_read_register_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ pRW_Reg RegRWStruct; ++ pRW_Reg RegRWStruct; + u32 offset, width; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_info_, + ("+oid_rt_pro_read_register_hdl\n")); + + if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + RegRWStruct = (pRW_Reg)poid_par_priv->information_buf; + offset = RegRWStruct->offset; + width = RegRWStruct->width; + + if (offset > 0xFFF) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + _irqlevel_changed_(&oldirql, LOWER); + @@ -51182,28 +34939,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + + *poid_par_priv->bytes_rw = width; + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_write_register_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_write_register_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ pRW_Reg RegRWStruct; ++ pRW_Reg RegRWStruct; + u32 offset, width, value; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_info_, + ("+oid_rt_pro_write_register_hdl\n")); + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + RegRWStruct = (pRW_Reg)poid_par_priv->information_buf; + offset = RegRWStruct->offset; @@ -51211,7 +34965,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + value = RegRWStruct->value; + + if (offset > 0xFFF) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + _irqlevel_changed_(&oldirql, LOWER); + @@ -51219,14 +34973,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + { + case 1: + if (value > 0xFF) { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + break; + } + rtw_write8(padapter, offset, (u8)value); + break; + case 2: + if (value > 0xFFFF) { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + break; + } + rtw_write16(padapter, offset, (u16)value); @@ -51235,7 +34989,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + rtw_write32(padapter, offset, value); + break; + default: -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + break; + } + @@ -51245,497 +34999,113 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + ("-oid_rt_pro_write_register_hdl: offset=0x%08X width=%d value=0x%X\n", + offset, width, value)); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_burst_read_register_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_burst_read_register_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ pBurst_RW_Reg pBstRwReg; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+_func_enter_; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_burst_read_register_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ pBstRwReg = (pBurst_RW_Reg)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ rtw_read_mem(padapter, pBstRwReg->offset, (u32)pBstRwReg->len, pBstRwReg->Data); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ RT_TRACE(_module_mp_, _drv_info_, ("-oid_rt_pro_burst_read_register_hdl\n")); -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_burst_write_register_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_burst_write_register_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ pBurst_RW_Reg pBstRwReg; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+_func_enter_; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_burst_write_register_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ pBstRwReg = (pBurst_RW_Reg)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ rtw_write_mem(padapter, pBstRwReg->offset, (u32)pBstRwReg->len, pBstRwReg->Data); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ RT_TRACE(_module_mp_, _drv_info_, ("-oid_rt_pro_burst_write_register_hdl\n")); -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_write_txcmd_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_write_txcmd_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ PADAPTER Adapter = (PADAPTER)( poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ -+ TX_CMD_Desc *TxCmd_Info; -+ -+_func_enter_; -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ RT_TRACE(_module_mp_, _drv_info_, ("+Set OID_RT_PRO_WRITE_TXCMD\n")); -+ -+ TxCmd_Info=(TX_CMD_Desc*)poid_par_priv->information_buf; -+ -+ RT_TRACE(_module_mp_, _drv_info_, ("WRITE_TXCMD:Addr=%.8X\n", TxCmd_Info->offset)); -+ RT_TRACE(_module_mp_, _drv_info_, ("WRITE_TXCMD:1.)%.8X\n", (ULONG)TxCmd_Info->TxCMD.value[0])); -+ RT_TRACE(_module_mp_, _drv_info_, ("WRITE_TXCMD:2.)%.8X\n", (ULONG)TxCmd_Info->TxCMD.value[1])); -+ RT_TRACE(_module_mp_, _drv_info_, (("WRITE_TXCMD:3.)%.8X\n", (ULONG)TxCmd_Info->TxCMD.value[2])); -+ RT_TRACE(_module_mp_, _drv_info_, ("WRITE_TXCMD:4.)%.8X\n", (ULONG)TxCmd_Info->TxCMD.value[3])); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ rtw_write32(Adapter, TxCmd_Info->offset + 0, (unsigned int)TxCmd_Info->TxCMD.value[0]); -+ rtw_write32(Adapter, TxCmd_Info->offset + 4, (unsigned int)TxCmd_Info->TxCMD.value[1]); -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("-Set OID_RT_PRO_WRITE_TXCMD: status=0x%08X\n", status)); -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} + +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ pEEPROM_RWParam pEEPROM; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+_func_enter_; -+ -+ RT_TRACE(_module_mp_, _drv_info_, ("+Query OID_RT_PRO_READ16_EEPROM\n")); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ pEEPROM = (pEEPROM_RWParam)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ pEEPROM->value = eeprom_read16(padapter, (u16)(pEEPROM->offset >> 1)); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("-Query OID_RT_PRO_READ16_EEPROM: offset=0x%x value=0x%x\n", -+ pEEPROM->offset, pEEPROM->value)); -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} + +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_write16_eeprom_hdl (struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_write16_eeprom_hdl (struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ pEEPROM_RWParam pEEPROM; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+_func_enter_; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+Set OID_RT_PRO_WRITE16_EEPROM\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ pEEPROM = (pEEPROM_RWParam)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ eeprom_write16(padapter, (u16)(pEEPROM->offset >> 1), pEEPROM->value); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)( poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ struct mp_wiparam *pwi_param; -+ -+_func_enter_; -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(struct mp_wiparam)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ if (Adapter->mppriv.workparam.bcompleted == _FALSE) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ pwi_param = (struct mp_wiparam *)poid_par_priv->information_buf; -+ -+ _rtw_memcpy(pwi_param, &Adapter->mppriv.workparam, sizeof(struct mp_wiparam)); -+ Adapter->mppriv.act_in_progress = _FALSE; -+// RT_TRACE(_module_mp_, _drv_info_, ("rf:%x\n", pwiparam->IoValue)); -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)( poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+_func_enter_; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro8711_pkt_loss_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(uint)*2) { -+ RT_TRACE(_module_mp_, _drv_err_, ("-oid_rt_pro8711_pkt_loss_hdl: buf_len=%d\n", (int)poid_par_priv->information_buf_len)); -+ return NDIS_STATUS_INVALID_LENGTH; -+ } -+ -+ if (*(uint*)poid_par_priv->information_buf == 1)//init==1 -+ Adapter->mppriv.rx_pktloss = 0; -+ -+ *((uint*)poid_par_priv->information_buf+1) = Adapter->mppriv.rx_pktloss; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_rd_attrib_mem_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_rd_attrib_mem_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)( poid_par_priv->adapter_context); -+ struct io_queue *pio_queue = (struct io_queue *)Adapter->pio_queue; -+ struct intf_hdl *pintfhdl = &pio_queue->intf; -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+#ifdef CONFIG_SDIO_HCI -+ void (*_attrib_read)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+#endif -+ -+_func_enter_; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+Query OID_RT_RD_ATTRIB_MEM\n")); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+#ifdef CONFIG_SDIO_HCI -+ _irqlevel_changed_(&oldirql, LOWER); -+{ -+ u32 *plmem = (u32*)poid_par_priv->information_buf+2; -+ _attrib_read = pintfhdl->io_ops._attrib_read; -+ _attrib_read(pintfhdl, *((u32*)poid_par_priv->information_buf), -+ *((u32*)poid_par_priv->information_buf+1), (u8*)plmem); -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+} -+ _irqlevel_changed_(&oldirql, RAISE); -+#endif -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_wr_attrib_mem_hdl (struct oid_par_priv *poid_par_priv) ++uint oid_rt_wr_attrib_mem_hdl (struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ struct io_queue *pio_queue = (struct io_queue *)Adapter->pio_queue; -+ struct intf_hdl *pintfhdl = &pio_queue->intf; -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+#ifdef CONFIG_SDIO_HCI -+ void (*_attrib_write)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+#endif -+ -+_func_enter_; -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+#ifdef CONFIG_SDIO_HCI -+ _irqlevel_changed_(&oldirql, LOWER); -+{ -+ u32 *plmem = (u32*)poid_par_priv->information_buf + 2; -+ _attrib_write = pintfhdl->io_ops._attrib_write; -+ _attrib_write(pintfhdl, *(u32*)poid_par_priv->information_buf, -+ *((u32*)poid_par_priv->information_buf+1), (u8*)plmem); -+} -+ _irqlevel_changed_(&oldirql, RAISE); -+#endif -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+_func_enter_; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+OID_RT_PRO_SET_RF_INTFS\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (rtw_setrfintfs_cmd(Adapter, *(unsigned char*)poid_par_priv->information_buf) == _FAIL) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_poll_rx_status_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_poll_rx_status_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+_func_enter_; -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ _rtw_memcpy(poid_par_priv->information_buf, (unsigned char*)&Adapter->mppriv.rxstat, sizeof(struct recv_stat)); -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ PCFG_DBG_MSG_STRUCT pdbg_msg; -+ -+_func_enter_; -+ -+// RT_TRACE(0xffffffffff,_drv_alert_,("===> oid_rt_pro_cfg_debug_message_hdl.\n")); -+ -+#if 0//#ifdef CONFIG_DEBUG_RTL871X -+ -+ pdbg_msg = (PCFG_DBG_MSG_STRUCT)(poid_par_priv->information_buf); -+ -+ if (poid_par_priv->type_of_oid == SET_OID) { -+ RT_TRACE(0xffffffffff, _drv_alert_, -+ ("===>Set level :0x%08x, H32:0x%08x L32:0x%08x\n", -+ pdbg_msg->DebugLevel, pdbg_msg->DebugComponent_H32, pdbg_msg->DebugComponent_L32)); -+ -+ GlobalDebugLevel = pdbg_msg->DebugLevel; -+ GlobalDebugComponents = (pdbg_msg->DebugComponent_H32 << 32) | pdbg_msg->DebugComponent_L32; -+ RT_TRACE(0xffffffffff, _drv_alert_, -+ ("===> Set level :0x%08x, component:0x%016x\n", -+ GlobalDebugLevel, (u32)GlobalDebugComponents)); -+ } else { -+ pdbg_msg->DebugLevel = GlobalDebugLevel; -+ pdbg_msg->DebugComponent_H32 = (u32)(GlobalDebugComponents >> 32); -+ pdbg_msg->DebugComponent_L32 = (u32)GlobalDebugComponents; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ RT_TRACE(0xffffffffff, _drv_alert_, -+ ("===>Query level:0x%08x H32:0x%08x L32:0x%08x\n", -+ (u32)pdbg_msg->DebugLevel, (u32)pdbg_msg->DebugComponent_H32, (u32)pdbg_msg->DebugComponent_L32)); -+ } -+ -+#endif -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv *poid_par_priv) +{ + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; ++ + -+_func_enter_; + + RT_TRACE(_module_mp_, _drv_notice_, ("+OID_RT_PRO_SET_DATA_RATE_EX\n")); + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + _irqlevel_changed_(&oldirql, LOWER); + + if (rtw_setdatarate_cmd(Adapter, poid_par_priv->information_buf) !=_SUCCESS) -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} +//----------------------------------------------------------------------------- -+NDIS_STATUS oid_rt_get_thermal_meter_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_get_thermal_meter_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + u8 thermal = 0; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_get_thermal_meter_hdl\n")); + + if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + _irqlevel_changed_(&oldirql, LOWER); + GetThermalMeter(Adapter, &thermal); @@ -51744,72 +35114,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + *(u32*)poid_par_priv->information_buf = (u32)thermal; + *poid_par_priv->bytes_rw = sizeof(u32); + -+_func_exit_; ++ + + return status; +} +//----------------------------------------------------------------------------- -+NDIS_STATUS oid_rt_pro_read_tssi_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_read_tssi_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+_func_enter_; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_read_tssi_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (Adapter->mppriv.act_in_progress == _TRUE) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u8)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ //init workparam -+ Adapter->mppriv.act_in_progress = _TRUE; -+ Adapter->mppriv.workparam.bcompleted = _FALSE; -+ Adapter->mppriv.workparam.act_type = MPT_READ_TSSI; -+ Adapter->mppriv.workparam.io_offset = 0; -+ Adapter->mppriv.workparam.io_value = 0xFFFFFFFF; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (!rtw_gettssi_cmd(Adapter,0, (u8*)&Adapter->mppriv.workparam.io_value)) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+ -+_func_enter_; -+ -+// if (poid_par_priv->type_of_oid != SET_OID) -+// return NDIS_STATUS_NOT_ACCEPTED; -+ + if (poid_par_priv->information_buf_len < sizeof(u8)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + _irqlevel_changed_(&oldirql, LOWER); + if (poid_par_priv->type_of_oid == SET_OID) { @@ -51825,680 +35146,78 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + } + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} +//----------------------------------------------------------------------------- -+NDIS_STATUS oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u32 ratevalue; -+ u8 datarates[NumRates]; -+ int i; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+_func_enter_; -+ -+ RT_TRACE(_module_mp_, _drv_info_, ("+OID_RT_PRO_SET_BASIC_RATE\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+#if 0 -+ ratevalue = *((u32*)poid_par_priv->information_buf); -+ -+ for (i = 0; i < NumRates; i++) { -+ if (ratevalue == mpdatarate[i]) -+ datarates[i] = mpdatarate[i]; -+ else -+ datarates[i] = 0xff; -+ RT_TRACE(_module_rtl871x_ioctl_c_, _drv_info_, ("basicrate_inx=%d\n", datarates[i])); -+ } -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (rtw_setbasicrate_cmd(padapter, datarates) != _SUCCESS) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+#endif -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("-OID_RT_PRO_SET_BASIC_RATE: status=0x%08X\n", status)); -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+_func_enter_; -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < 8) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ *poid_par_priv->bytes_rw = 8; -+ _rtw_memcpy(poid_par_priv->information_buf, &(adapter_to_pwrctl(Adapter)->pwr_mode), 8); -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("-oid_rt_pro_qry_pwrstate_hdl: pwr_mode=%d smart_ps=%d\n", -+ adapter_to_pwrctl(Adapter)->pwr_mode, adapter_to_pwrctl(Adapter)->smart_ps)); -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ uint pwr_mode, smart_ps; -+ -+_func_enter_; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+Set OID_RT_PRO_SET_PWRSTATE\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ *poid_par_priv->bytes_rw = 0; -+ *poid_par_priv->bytes_needed = 8; -+ -+ if (poid_par_priv->information_buf_len < 8) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ pwr_mode = *(uint *)(poid_par_priv->information_buf); -+ smart_ps = *(uint *)((int)poid_par_priv->information_buf + 4); -+ -+ *poid_par_priv->bytes_rw = 8; -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ struct setratable_parm *prate_table; -+ u8 res; -+ -+_func_enter_; -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ *poid_par_priv->bytes_needed = sizeof(struct setratable_parm); -+ if (poid_par_priv->information_buf_len < sizeof(struct setratable_parm)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ prate_table = (struct setratable_parm*)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ res = rtw_setrttbl_cmd(Adapter, prate_table); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ if (res == _FAIL) -+ status = NDIS_STATUS_FAILURE; -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+_func_enter_; -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ #if 0 -+ struct mp_wi_cntx *pmp_wi_cntx=&(Adapter->mppriv.wi_cntx); -+ u8 res=_SUCCESS; -+ DEBUG_INFO(("===> Set OID_RT_PRO_H2C_GET_RATE_TABLE.\n")); -+ -+ if(pmp_wi_cntx->bmp_wi_progress ==_TRUE){ -+ DEBUG_ERR(("\n mp workitem is progressing, not allow to set another workitem right now!!!\n")); -+ Status = NDIS_STATUS_NOT_ACCEPTED; -+ break; -+ } -+ else{ -+ pmp_wi_cntx->bmp_wi_progress=_TRUE; -+ pmp_wi_cntx->param.bcompleted=_FALSE; -+ pmp_wi_cntx->param.act_type=MPT_GET_RATE_TABLE; -+ pmp_wi_cntx->param.io_offset=0x0; -+ pmp_wi_cntx->param.bytes_cnt=sizeof(struct getratable_rsp); -+ pmp_wi_cntx->param.io_value=0xffffffff; -+ -+ res=rtw_getrttbl_cmd(Adapter,(struct getratable_rsp *)pmp_wi_cntx->param.data); -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ if(res != _SUCCESS) -+ { -+ Status = NDIS_STATUS_NOT_ACCEPTED; -+ } -+ } -+ DEBUG_INFO(("\n <=== Set OID_RT_PRO_H2C_GET_RATE_TABLE.\n")); -+ #endif -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} + +//**************** oid_rtl_seg_87_12_00 section start **************** -+NDIS_STATUS oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ struct security_priv *psecuritypriv = &Adapter->securitypriv; -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ ENCRY_CTRL_STATE encry_mode; -+ -+ -+ *poid_par_priv->bytes_needed = sizeof(u8); -+ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ if (poid_par_priv->type_of_oid == SET_OID) -+ { -+ encry_mode = *((u8*)poid_par_priv->information_buf); -+ switch (encry_mode) -+ { -+ case HW_CONTROL: -+ #if 0 -+ Adapter->registrypriv.software_decrypt=_FALSE; -+ Adapter->registrypriv.software_encrypt=_FALSE; -+ #else -+ psecuritypriv->sw_decrypt = _FALSE; -+ psecuritypriv->sw_encrypt = _FALSE; -+ #endif -+ break; -+ case SW_CONTROL: -+ #if 0 -+ Adapter->registrypriv.software_decrypt=_TRUE; -+ Adapter->registrypriv.software_encrypt=_TRUE; -+ #else -+ psecuritypriv->sw_decrypt = _TRUE; -+ psecuritypriv->sw_encrypt = _TRUE; -+ #endif -+ break; -+ case HW_ENCRY_SW_DECRY: -+ #if 0 -+ Adapter->registrypriv.software_decrypt=_TRUE; -+ Adapter->registrypriv.software_encrypt=_FALSE; -+ #else -+ psecuritypriv->sw_decrypt = _TRUE; -+ psecuritypriv->sw_encrypt = _FALSE; -+ #endif -+ break; -+ case SW_ENCRY_HW_DECRY: -+ #if 0 -+ Adapter->registrypriv.software_decrypt=_FALSE; -+ Adapter->registrypriv.software_encrypt=_TRUE; -+ #else -+ psecuritypriv->sw_decrypt = _FALSE; -+ psecuritypriv->sw_encrypt = _TRUE; -+ #endif -+ break; -+ } -+ -+ RT_TRACE(_module_rtl871x_ioctl_c_, _drv_notice_, -+ ("-oid_rt_pro_encryption_ctrl_hdl: SET encry_mode=0x%x sw_encrypt=0x%x sw_decrypt=0x%x\n", -+ encry_mode, psecuritypriv->sw_encrypt, psecuritypriv->sw_decrypt)); -+ } -+ else { -+ #if 0 -+ if (Adapter->registrypriv.software_encrypt == _FALSE) { -+ if (Adapter->registrypriv.software_decrypt == _FALSE) -+ encry_mode = HW_CONTROL; -+ else -+ encry_mode = HW_ENCRY_SW_DECRY; -+ } -+ else { -+ if (Adapter->registrypriv.software_decrypt == _FALSE) -+ encry_mode = SW_ENCRY_HW_DECRY; -+ else -+ encry_mode = SW_CONTROL; -+ } -+ #else -+ -+ if ((psecuritypriv->sw_encrypt == _FALSE) && (psecuritypriv->sw_decrypt == _FALSE)) -+ encry_mode = HW_CONTROL; -+ else if ((psecuritypriv->sw_encrypt == _FALSE) && (psecuritypriv->sw_decrypt == _TRUE)) -+ encry_mode = HW_ENCRY_SW_DECRY; -+ else if ((psecuritypriv->sw_encrypt == _TRUE) && (psecuritypriv->sw_decrypt == _FALSE)) -+ encry_mode = SW_ENCRY_HW_DECRY; -+ else if ((psecuritypriv->sw_encrypt == _TRUE) && (psecuritypriv->sw_decrypt == _TRUE)) -+ encry_mode = SW_CONTROL; -+ -+ #endif -+ -+ *(u8*)poid_par_priv->information_buf = encry_mode; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("-oid_rt_pro_encryption_ctrl_hdl: QUERY encry_mode=0x%x\n", -+ encry_mode)); -+ } -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_add_sta_info_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_add_sta_info_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ struct sta_info *psta = NULL; -+ UCHAR *macaddr; -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ *poid_par_priv->bytes_needed = ETH_ALEN; -+ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ macaddr = (UCHAR *) poid_par_priv->information_buf ; -+ -+ RT_TRACE(_module_rtl871x_ioctl_c_,_drv_notice_, -+ ("OID_RT_PRO_ADD_STA_INFO: addr="MAC_FMT"\n", MAC_ARG(macaddr) )); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ psta = rtw_get_stainfo(&Adapter->stapriv, macaddr); -+ -+ if (psta == NULL) { // the sta have been in sta_info_queue => do nothing -+ psta = rtw_alloc_stainfo(&Adapter->stapriv, macaddr); -+ -+ if (psta == NULL) { -+ RT_TRACE(_module_rtl871x_ioctl_c_,_drv_err_,("Can't alloc sta_info when OID_RT_PRO_ADD_STA_INFO\n")); -+ status = NDIS_STATUS_FAILURE; -+ } -+ } else { //(between drv has received this event before and fw have not yet to set key to CAM_ENTRY) -+ RT_TRACE(_module_rtl871x_ioctl_c_, _drv_err_, -+ ("Error: OID_RT_PRO_ADD_STA_INFO: sta has been in sta_hash_queue \n")); -+ } -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ struct sta_info *psta = NULL; -+ UCHAR *macaddr; -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ *poid_par_priv->bytes_needed = ETH_ALEN; -+ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ macaddr = (UCHAR *) poid_par_priv->information_buf ; -+ RT_TRACE(_module_rtl871x_ioctl_c_,_drv_notice_, -+ ("+OID_RT_PRO_ADD_STA_INFO: addr="MAC_FMT"\n", MAC_ARG(macaddr) )); -+ -+ psta = rtw_get_stainfo(&Adapter->stapriv, macaddr); -+ if (psta != NULL) { -+ //_enter_critical(&(Adapter->stapriv.sta_hash_lock), &irqL); -+ rtw_free_stainfo(Adapter, psta); -+ //_exit_critical(&(Adapter->stapriv.sta_hash_lock), &irqL); -+ } -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+#if 0 -+static u32 mp_query_drv_var(_adapter *padapter, u8 offset, u32 var) ++ ++uint oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef CONFIG_SDIO_HCI -+ -+ if (offset == 1) { -+ u16 tmp_blk_num; -+ tmp_blk_num = rtw_read16(padapter, SDIO_RX0_RDYBLK_NUM); -+ RT_TRACE(_module_mp_, _drv_err_, ("Query Information, mp_query_drv_var SDIO_RX0_RDYBLK_NUM=0x%x dvobj.rxblknum=0x%x\n", tmp_blk_num, adapter_to_dvobj(padapter)->rxblknum)); -+ if (adapter_to_dvobj(padapter)->rxblknum != tmp_blk_num) { -+ RT_TRACE(_module_mp_,_drv_err_, ("Query Information, mp_query_drv_var call recv rx\n")); -+ // sd_recv_rxfifo(padapter); -+ } -+ } -+ -+#if 0 -+ if(offset <=100){ //For setting data rate and query data rate -+ if(offset==100){ //For query data rate -+ RT_TRACE(_module_mp_, _drv_emerg_, ("\n mp_query_drv_var: offset(%d): query rate=0x%.2x \n",offset,padapter->registrypriv.tx_rate)); -+ var=padapter->registrypriv.tx_rate; -+ -+ } -+ else if(offset<0x1d){ //For setting data rate -+ padapter->registrypriv.tx_rate=offset; -+ var=padapter->registrypriv.tx_rate; -+ padapter->registrypriv.use_rate=_TRUE; -+ RT_TRACE(_module_mp_, _drv_emerg_, ("\n mp_query_drv_var: offset(%d): set rate=0x%.2x \n",offset,padapter->registrypriv.tx_rate)); -+ } -+ else{ //not use the data rate -+ padapter->registrypriv.use_rate=_FALSE; -+ RT_TRACE(_module_mp_, _drv_emerg_, ("\n mp_query_drv_var: offset(%d) out of rate range\n",offset)); -+ } -+ } -+ else if (offset<=110){ //for setting debug level -+ RT_TRACE(_module_mp_, _drv_emerg_, (" mp_query_drv_var: offset(%d) for set debug level\n",offset)); -+ if(offset==110){ //For query data rate -+ RT_TRACE(_module_mp_, _drv_emerg_, (" mp_query_drv_var: offset(%d): query dbg level=0x%.2x \n",offset,padapter->registrypriv.dbg_level)); -+ padapter->registrypriv.dbg_level=GlobalDebugLevel; -+ var=padapter->registrypriv.dbg_level; -+ } -+ else if(offset<110 && offset>100){ -+ RT_TRACE(_module_mp_, _drv_emerg_, (" mp_query_drv_var: offset(%d): set dbg level=0x%.2x \n",offset,offset-100)); -+ padapter->registrypriv.dbg_level=GlobalDebugLevel=offset-100; -+ var=padapter->registrypriv.dbg_level; -+ RT_TRACE(_module_mp_, _drv_emerg_, (" mp_query_drv_var(_drv_emerg_): offset(%d): set dbg level=0x%.2x \n",offset,GlobalDebugLevel)); -+ RT_TRACE(_module_mp_, _drv_alert_, (" mp_query_drv_var(_drv_alert_): offset(%d): set dbg level=0x%.2x \n",offset,GlobalDebugLevel)); -+ RT_TRACE(_module_mp_, _drv_crit_, (" mp_query_drv_var(_drv_crit_): offset(%d): set dbg level=0x%.2x \n",offset,GlobalDebugLevel)); -+ RT_TRACE(_module_mp_, _drv_err_, (" mp_query_drv_var(_drv_err_): offset(%d): set dbg level=0x%.2x \n",offset,GlobalDebugLevel)); -+ RT_TRACE(_module_mp_, _drv_warning_, (" mp_query_drv_var(_drv_warning_): offset(%d): set dbg level=0x%.2x \n",offset,GlobalDebugLevel)); -+ RT_TRACE(_module_mp_, _drv_notice_, (" mp_query_drv_var(_drv_notice_): offset(%d): set dbg level=0x%.2x \n",offset,GlobalDebugLevel)); -+ RT_TRACE(_module_mp_, _drv_info_, (" mp_query_drv_var(_drv_info_): offset(%d): set dbg level=0x%.2x \n",offset,GlobalDebugLevel)); -+ RT_TRACE(_module_mp_, _drv_debug_, (" mp_query_drv_var(_drv_debug_): offset(%d): set dbg level=0x%.2x \n",offset,GlobalDebugLevel)); -+ -+ } -+ } -+ else if(offset >110 &&offset <116){ -+ if(115==offset){ -+ RT_TRACE(_module_mp_, _drv_emerg_, (" mp_query_drv_var(_drv_emerg_): offset(%d): query TRX access type: [tx_block_mode=%x,rx_block_mode=%x]\n",\ -+ offset, adapter_to_dvobj(padapter)->tx_block_mode, adapter_to_dvobj(padapter)->rx_block_mode)); -+ } -+ else { -+ switch(offset){ -+ case 111: -+ adapter_to_dvobj(padapter)->tx_block_mode=1; -+ adapter_to_dvobj(padapter)->rx_block_mode=1; -+ RT_TRACE(_module_mp_, _drv_emerg_, \ -+ (" mp_query_drv_var(_drv_emerg_): offset(%d): SET TRX access type:(TX block/RX block) [tx_block_mode=%x,rx_block_mode=%x]\n",\ -+ offset, adapter_to_dvobj(padapter)->tx_block_mode, adapter_to_dvobj(padapter)->rx_block_mode)); -+ break; -+ case 112: -+ adapter_to_dvobj(padapter)->tx_block_mode=1; -+ adapter_to_dvobj(padapter)->rx_block_mode=0; -+ RT_TRACE(_module_mp_, _drv_emerg_, \ -+ (" mp_query_drv_var(_drv_emerg_): offset(%d): SET TRX access type:(TX block/RX byte) [tx_block_mode=%x,rx_block_mode=%x]\n",\ -+ offset, adapter_to_dvobj(padapter)->tx_block_mode, adapter_to_dvobj(padapter)->rx_block_mode)); -+ break; -+ case 113: -+ adapter_to_dvobj(padapter)->tx_block_mode=0; -+ adapter_to_dvobj(padapter)->rx_block_mode=1; -+ RT_TRACE(_module_mp_, _drv_emerg_, \ -+ (" mp_query_drv_var(_drv_emerg_): offset(%d): SET TRX access type:(TX byte/RX block) [tx_block_mode=%x,rx_block_mode=%x]\n",\ -+ offset, adapter_to_dvobj(padapter)->tx_block_mode, adapter_to_dvobj(padapter)->rx_block_mode)); -+ break; -+ case 114: -+ adapter_to_dvobj(padapter)->tx_block_mode=0; -+ adapter_to_dvobj(padapter)->rx_block_mode=0; -+ RT_TRACE(_module_mp_, _drv_emerg_, \ -+ (" mp_query_drv_var(_drv_emerg_): offset(%d): SET TRX access type:(TX byte/RX byte) [tx_block_mode=%x,rx_block_mode=%x]\n",\ -+ offset, adapter_to_dvobj(padapter)->tx_block_mode, adapter_to_dvobj(padapter)->rx_block_mode)); -+ break; -+ default : -+ break; -+ -+ } -+ -+ } -+ -+ } -+ else if(offset>=127){ -+ u64 prnt_dbg_comp; -+ u8 chg_idx; -+ u64 tmp_dbg_comp; -+ chg_idx=offset-0x80; -+ tmp_dbg_comp=BIT(chg_idx); -+ prnt_dbg_comp=padapter->registrypriv.dbg_component= GlobalDebugComponents; -+ RT_TRACE(_module_mp_, _drv_emerg_, (" 1: mp_query_drv_var: offset(%d;0x%x):for dbg conpoment prnt_dbg_comp=0x%.16x GlobalDebugComponents=0x%.16x padapter->registrypriv.dbg_component=0x%.16x\n",offset,offset,prnt_dbg_comp,GlobalDebugComponents,padapter->registrypriv.dbg_component)); -+ if(offset==127){ -+ // prnt_dbg_comp=padapter->registrypriv.dbg_component= GlobalDebugComponents; -+ var=(u32)(padapter->registrypriv.dbg_component); -+ RT_TRACE(0xffffffff, _drv_emerg_, ("2: mp_query_drv_var: offset(%d;0x%x):for query dbg conpoment=0x%x(l) 0x%x(h) GlobalDebugComponents=0x%x(l) 0x%x(h) \n",offset,offset,padapter->registrypriv.dbg_component,prnt_dbg_comp)); -+ prnt_dbg_comp=GlobalDebugComponents; -+ RT_TRACE(0xffffffff, _drv_emerg_, ("2-1: mp_query_drv_var: offset(%d;0x%x):for query dbg conpoment=0x%x(l) 0x%x(h) GlobalDebugComponents=0x%x(l) 0x%x(h)\n",offset,offset,padapter->registrypriv.dbg_component,prnt_dbg_comp)); -+ prnt_dbg_comp=GlobalDebugComponents=padapter->registrypriv.dbg_component; -+ RT_TRACE(0xffffffff, _drv_emerg_, ("2-2: mp_query_drv_var: offset(%d;0x%x):for query dbg conpoment=0x%x(l) 0x%x(h) GlobalDebugComponents=0x%x(l) 0x%x(h)\n",offset,offset,padapter->registrypriv.dbg_component,prnt_dbg_comp)); -+ -+ } -+ else{ -+ RT_TRACE(0xffffffff, _drv_emerg_, ("3: mp_query_drv_var: offset(%d;0x%x):for query dbg conpoment=0x%x(l) 0x%x(h) GlobalDebugComponents=0x%x(l) 0x%x(h) chg_idx=%d\n",offset,offset,padapter->registrypriv.dbg_component,prnt_dbg_comp,chg_idx)); -+ prnt_dbg_comp=GlobalDebugComponents; -+ RT_TRACE(0xffffffff, _drv_emerg_,("3-1: mp_query_drv_var: offset(%d;0x%x):for query dbg conpoment=0x%x(l) 0x%x(h) GlobalDebugComponents=0x%x(l) 0x%x(h) chg_idx=%d\n",offset,offset,padapter->registrypriv.dbg_component,prnt_dbg_comp,chg_idx));// ("3-1: mp_query_drv_var: offset(%d;0x%x):before set dbg conpoment=0x%x chg_idx=%d or0x%x BIT(chg_idx[%d]=0x%x)\n",offset,offset,prnt_dbg_comp,chg_idx,chg_idx,(chg_idx),tmp_dbg_comp) -+ prnt_dbg_comp=GlobalDebugComponents=padapter->registrypriv.dbg_component; -+ RT_TRACE(0xffffffff, _drv_emerg_, ("3-2: mp_query_drv_var: offset(%d;0x%x):for query dbg conpoment=0x%x(l) 0x%x(h) GlobalDebugComponents=0x%x(l) 0x%x(h)\n",offset,offset,padapter->registrypriv.dbg_component,prnt_dbg_comp)); -+ -+ if(GlobalDebugComponents&tmp_dbg_comp){ -+ //this bit is already set, now clear it -+ GlobalDebugComponents=GlobalDebugComponents&(~tmp_dbg_comp); -+ } -+ else{ -+ //this bit is not set, now set it. -+ GlobalDebugComponents =GlobalDebugComponents|tmp_dbg_comp; -+ } -+ RT_TRACE(0xffffffff, _drv_emerg_, ("4: mp_query_drv_var: offset(%d;0x%x):before set dbg conpoment tmp_dbg_comp=0x%x GlobalDebugComponents=0x%x(l) 0x%x(h)",offset,offset,tmp_dbg_comp,prnt_dbg_comp)); -+ prnt_dbg_comp=GlobalDebugComponents; -+ RT_TRACE(0xffffffff, _drv_emerg_, ("4-1: mp_query_drv_var: offset(%d;0x%x):before set dbg conpoment tmp_dbg_comp=0x%x GlobalDebugComponents=0x%x(l) 0x%x(h)",offset,offset,tmp_dbg_comp,prnt_dbg_comp)); -+ -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_emerg_, ("0: mp_query_drv_var(_module_rtl871x_xmit_c_:0): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,prnt_dbg_comp)); -+ RT_TRACE(_module_xmit_osdep_c_, _drv_emerg_, ("1: mp_query_drv_var(_module_xmit_osdep_c_:1): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_emerg_, ("2: mp_query_drv_var(_module_rtl871x_recv_c_:2): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_recv_osdep_c_, _drv_emerg_, ("3: mp_query_drv_var(_module_recv_osdep_c_:3): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_emerg_, ("4: mp_query_drv_var(_module_rtl871x_mlme_c_:4): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_mlme_osdep_c_, _drv_emerg_, (" 5:mp_query_drv_var(_module_mlme_osdep_c_:5): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_rtl871x_sta_mgt_c_, _drv_emerg_, ("6: mp_query_drv_var(_module_rtl871x_sta_mgt_c_:6): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_emerg_, ("7: mp_query_drv_var(_module_rtl871x_cmd_c_:7): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_cmd_osdep_c_, _drv_emerg_, ("8: mp_query_drv_var(_module_cmd_osdep_c_:8): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_rtl871x_io_c_, _drv_emerg_, ("9: mp_query_drv_var(_module_rtl871x_io_c_:9): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_io_osdep_c_, _drv_emerg_, ("10: mp_query_drv_var(_module_io_osdep_c_:10): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_os_intfs_c_, _drv_emerg_, ("11: mp_query_drv_var(_module_os_intfs_c_:11): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_rtl871x_security_c_, _drv_emerg_, ("12: mp_query_drv_var(_module_rtl871x_security_c_:12): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_rtl871x_eeprom_c_, _drv_emerg_, ("13: mp_query_drv_var(_module_rtl871x_eeprom_c_:13): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_hal_init_c_, _drv_emerg_, ("14: mp_query_drv_var(_module_hal_init_c_:14): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_hci_hal_init_c_, _drv_emerg_, ("15: mp_query_drv_var(_module_hci_hal_init_c_:15): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_rtl871x_ioctl_c_, _drv_emerg_, ("16: mp_query_drv_var(_module_rtl871x_ioctl_c_:16): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_emerg_, ("17: mp_query_drv_var(_module_rtl871x_ioctl_set_c_:17): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_rtl871x_ioctl_query_c_, _drv_emerg_, ("18: mp_query_drv_var(_module_rtl871x_ioctl_query_c_:18): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_emerg_, ("19: mp_query_drv_var(_module_rtl871x_pwrctrl_c_:19): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_hci_intfs_c_, _drv_emerg_, ("20: mp_query_drv_var(_module_hci_intfs_c_:20): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_hci_ops_c_, _drv_emerg_, ("21: mp_query_drv_var(_module_hci_ops_c_:21): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_osdep_service_c_, _drv_emerg_, ("22: mp_query_drv_var(_module_osdep_service_c_:22): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_mp_, _drv_emerg_, ("23: mp_query_drv_var(_module_mp_:23): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ RT_TRACE(_module_hci_ops_os_c_, _drv_emerg_, ("24: mp_query_drv_var(_module_hci_ops_os_c_:24): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ var=(u32)(GlobalDebugComponents); -+ //GlobalDebugComponents=padapter->registrypriv.dbg_component; -+ RT_TRACE(0xffffffff, _drv_emerg_, (" ==mp_query_drv_var(_module_mp_): offset(%d;0x%x):before set dbg conpoment=0x%x(l) 0x%x(h)\n",offset,offset,GlobalDebugComponents)); -+ -+ } -+ } -+ else{ -+ RT_TRACE(_module_mp_, _drv_emerg_, ("\n mp_query_drv_var: offset(%d) >110\n",offset)); -+ } -+#endif -+#endif -+ -+ return var; -+} -+#endif -+ -+NDIS_STATUS oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ DR_VARIABLE_STRUCT *pdrv_var; -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ *poid_par_priv->bytes_needed = sizeof(DR_VARIABLE_STRUCT); -+ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+Query Information, OID_RT_PRO_QUERY_DR_VARIABLE\n")); -+ -+ pdrv_var = (struct _DR_VARIABLE_STRUCT_ *)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ pdrv_var->variable = mp_query_drv_var(Adapter, pdrv_var->offset, pdrv_var->variable); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("-oid_rt_pro_query_dr_variable_hdl: offset=0x%x valule=0x%x\n", -+ pdrv_var->offset, pdrv_var->variable)); -+ -+ return status; -+#else + return 0; -+#endif +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ RT_TRACE(_module_mp_, _drv_err_, ("oid_rt_pro_rx_packet_type_hdl...................\n")); -+ -+ if (poid_par_priv->information_buf_len < sizeof (UCHAR)) { -+ status = NDIS_STATUS_INVALID_LENGTH; -+ *poid_par_priv->bytes_needed = sizeof(UCHAR); -+ return status; -+ } -+ -+ if (poid_par_priv->type_of_oid == SET_OID) { -+ Adapter->mppriv.rx_with_status = *(UCHAR *) poid_par_priv->information_buf; -+ RT_TRACE(_module_rtl871x_ioctl_c_,_drv_err_, ("Query Information, OID_RT_PRO_RX_PACKET_TYPE:%d \n",\ -+ Adapter->mppriv.rx_with_status)); -+ -+ RT_TRACE(_module_rtl871x_ioctl_c_,_drv_err_,("MAC addr=0x%x:0x%x:0x%x:0x%x:0x%x:0x%x \n", -+ Adapter->eeprompriv.mac_addr[0],Adapter->eeprompriv.mac_addr[1],Adapter->eeprompriv.mac_addr[2],\ -+ Adapter->eeprompriv.mac_addr[3],Adapter->eeprompriv.mac_addr[4],Adapter->eeprompriv.mac_addr[5])); -+ -+ } -+ else { -+ *(UCHAR *) poid_par_priv->information_buf = Adapter->mppriv.rx_with_status; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ RT_TRACE(_module_rtl871x_ioctl_c_,_drv_err_, ("Query Information, OID_RT_PRO_RX_PACKET_TYPE:%d \n", \ -+ Adapter->mppriv.rx_with_status)); -+ -+ //*(u32 *)&Adapter->eeprompriv.mac_addr[0]=rtw_read32(Adapter, 0x10250050); -+ //*(u16 *)&Adapter->eeprompriv.mac_addr[4]=rtw_read16(Adapter, 0x10250054); -+ RT_TRACE(_module_rtl871x_ioctl_c_,_drv_err_,("MAC addr=0x%x:0x%x:0x%x:0x%x:0x%x:0x%x \n", -+ Adapter->eeprompriv.mac_addr[0],Adapter->eeprompriv.mac_addr[1],Adapter->eeprompriv.mac_addr[2],\ -+ Adapter->eeprompriv.mac_addr[3],Adapter->eeprompriv.mac_addr[4],Adapter->eeprompriv.mac_addr[5])); -+ } -+#endif -+ -+ return NDIS_STATUS_SUCCESS; ++ return uint_SUCCESS; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + PEFUSE_ACCESS_STRUCT pefuse; + u8 *data; + u16 addr = 0, cnts = 0, max_available_size = 0; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + if (poid_par_priv->information_buf_len < sizeof(EFUSE_ACCESS_STRUCT)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf; + addr = pefuse->start_addr; @@ -52509,42 +35228,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + ("+oid_rt_pro_read_efuse_hd: buf_len=%d addr=%d cnts=%d\n", + poid_par_priv->information_buf_len, addr, cnts)); + -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); ++ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); + + if ((addr + cnts) > max_available_size) { + RT_TRACE(_module_mp_, _drv_err_, ("!oid_rt_pro_read_efuse_hdl: parameter error!\n")); -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + } + + _irqlevel_changed_(&oldirql, LOWER); -+ if (rtw_efuse_access(Adapter, _FALSE, addr, cnts, data) == _FAIL) { ++ if (rtw_efuse_access(Adapter, false, addr, cnts, data) == _FAIL) { + RT_TRACE(_module_mp_, _drv_err_, ("!oid_rt_pro_read_efuse_hdl: rtw_efuse_access FAIL!\n")); -+ status = NDIS_STATUS_FAILURE; ++ status = uint_FAILURE; + } else + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + PEFUSE_ACCESS_STRUCT pefuse; + u8 *data; + u16 addr = 0, cnts = 0, max_available_size = 0; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + + -+_func_enter_; ++ + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf; + addr = pefuse->start_addr; @@ -52555,40 +35271,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + ("+oid_rt_pro_write_efuse_hdl: buf_len=%d addr=0x%04x cnts=%d\n", + poid_par_priv->information_buf_len, addr, cnts)); + -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); ++ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); + + if ((addr + cnts) > max_available_size) { + RT_TRACE(_module_mp_, _drv_err_, ("!oid_rt_pro_write_efuse_hdl: parameter error")); -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + } + + _irqlevel_changed_(&oldirql, LOWER); -+ if (rtw_efuse_access(Adapter, _TRUE, addr, cnts, data) == _FAIL) -+ status = NDIS_STATUS_FAILURE; ++ if (rtw_efuse_access(Adapter, true, addr, cnts, data) == _FAIL) ++ status = uint_FAILURE; + _irqlevel_changed_(&oldirql, RAISE); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + PPGPKT_STRUCT ppgpkt; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; -+ -+// RT_TRACE(_module_mp_, _drv_info_, ("+oid_rt_pro_rw_efuse_pgpkt_hdl\n")); -+ + *poid_par_priv->bytes_rw = 0; + + if (poid_par_priv->information_buf_len < sizeof(PGPKT_STRUCT)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + ppgpkt = (PPGPKT_STRUCT)poid_par_priv->information_buf; + @@ -52600,23 +35309,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + ("oid_rt_pro_rw_efuse_pgpkt_hdl: Read offset=0x%x\n",\ + ppgpkt->offset)); + -+ Efuse_PowerSwitch(Adapter, _FALSE, _TRUE); -+ if (Efuse_PgPacketRead(Adapter, ppgpkt->offset, ppgpkt->data, _FALSE) == _TRUE) ++ Efuse_PowerSwitch(Adapter, false, true); ++ if (Efuse_PgPacketRead(Adapter, ppgpkt->offset, ppgpkt->data, false) == true) + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + else -+ status = NDIS_STATUS_FAILURE; -+ Efuse_PowerSwitch(Adapter, _FALSE, _FALSE); ++ status = uint_FAILURE; ++ Efuse_PowerSwitch(Adapter, false, false); + } else { + RT_TRACE(_module_mp_, _drv_notice_, + ("oid_rt_pro_rw_efuse_pgpkt_hdl: Write offset=0x%x word_en=0x%x\n",\ + ppgpkt->offset, ppgpkt->word_en)); + -+ Efuse_PowerSwitch(Adapter, _TRUE, _TRUE); -+ if (Efuse_PgPacketWrite(Adapter, ppgpkt->offset, ppgpkt->word_en, ppgpkt->data, _FALSE) == _TRUE) ++ Efuse_PowerSwitch(Adapter, true, true); ++ if (Efuse_PgPacketWrite(Adapter, ppgpkt->offset, ppgpkt->word_en, ppgpkt->data, false) == true) + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + else -+ status = NDIS_STATUS_FAILURE; -+ Efuse_PowerSwitch(Adapter, _TRUE, _FALSE); ++ status = uint_FAILURE; ++ Efuse_PowerSwitch(Adapter, true, false); + } + + _irqlevel_changed_(&oldirql, RAISE); @@ -52624,28 +35333,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + RT_TRACE(_module_mp_, _drv_info_, + ("-oid_rt_pro_rw_efuse_pgpkt_hdl: status=0x%08X\n", status)); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + u16 size; + u8 ret; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + if (poid_par_priv->information_buf_len information_buf = size; + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; + } else -+ status = NDIS_STATUS_FAILURE; ++ status = uint_FAILURE; ++ + -+_func_exit_; + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_efuse_max_size_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_get_efuse_max_size_hdl(struct oid_par_priv *poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + *(u32*)poid_par_priv->information_buf = efuse_GetMaxSize(Adapter); + *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; @@ -52681,16 +35387,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + ("-oid_rt_get_efuse_max_size_hdl: size=%d status=0x%08X\n", + *(int*)poid_par_priv->information_buf, status)); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv) +{ -+ NDIS_STATUS status; ++ uint status; ++ + -+_func_enter_; + + RT_TRACE(_module_mp_, _drv_info_, ("+oid_rt_pro_efuse_hdl\n")); + @@ -52701,31 +35407,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + + RT_TRACE(_module_mp_, _drv_info_, ("-oid_rt_pro_efuse_hdl: status=0x%08X\n", status)); + -+_func_exit_; ++ + + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + u8 *data; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; + PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); + u16 mapLen=0; + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_efuse_map_hdl\n")); + -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); ++ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, false); + + *poid_par_priv->bytes_rw = 0; + + if (poid_par_priv->information_buf_len < mapLen) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + data = (u8*)poid_par_priv->information_buf; + @@ -52741,7 +35444,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + else { + RT_TRACE(_module_mp_, _drv_err_, + ("oid_rt_pro_efuse_map_hdl: READ fail\n")); -+ status = NDIS_STATUS_FAILURE; ++ status = uint_FAILURE; + } + } else { + // SET_OID @@ -52753,7 +35456,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + else { + RT_TRACE(_module_mp_, _drv_err_, + ("oid_rt_pro_efuse_map_hdl: WRITE fail\n")); -+ status = NDIS_STATUS_FAILURE; ++ status = uint_FAILURE; + } + } + @@ -52762,66 +35465,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + RT_TRACE(_module_mp_, _drv_info_, + ("-oid_rt_pro_efuse_map_hdl: status=0x%08X\n", status)); + -+_func_exit_; ++ + + return status; +} + -+NDIS_STATUS oid_rt_set_crystal_cap_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_set_crystal_cap_hdl(struct oid_par_priv *poid_par_priv) +{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ -+ u32 crystal_cap = 0; -+ -+_func_enter_; -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len information_buf);//4 -+ if (crystal_cap > 0xf) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ Adapter->mppriv.curr_crystalcap = crystal_cap; -+ -+ _irqlevel_changed_(&oldirql,LOWER); -+ SetCrystalCap(Adapter); -+ _irqlevel_changed_(&oldirql,RAISE); -+ -+_func_exit_; -+ -+#endif ++ uint status = uint_SUCCESS; + return status; +} + -+NDIS_STATUS oid_rt_set_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_set_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + u8 rx_pkt_type; +// u32 rcr_val32; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; ++ uint status = uint_SUCCESS; +// PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + -+_func_enter_; ++ + + RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_set_rx_packet_type_hdl\n")); + + if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; ++ return uint_NOT_ACCEPTED; + + if (poid_par_priv->information_buf_len < sizeof(u8)) -+ return NDIS_STATUS_INVALID_LENGTH; ++ return uint_INVALID_LENGTH; + + rx_pkt_type = *((u8*)poid_par_priv->information_buf);//4 + @@ -52891,85 +35561,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 +#endif + _irqlevel_changed_(&oldirql, RAISE); +#endif -+_func_exit_; ++ + + return status; +} + -+NDIS_STATUS oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ u32 txagc; -+ -+_func_enter_; -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ txagc = *(u32*)poid_par_priv->information_buf; -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("oid_rt_pro_set_tx_agc_offset_hdl: 0x%08x\n", txagc)); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetTxAGCOffset(Adapter, txagc); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} + -+NDIS_STATUS oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ struct mp_priv *pmppriv = &Adapter->mppriv; -+ u32 type; -+ -+_func_enter_; -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len information_buf; -+ -+ if (_LOOPBOOK_MODE_ == type) { -+ pmppriv->mode = type; -+ set_fwstate(pmlmepriv, WIFI_MP_LPBK_STATE); //append txdesc -+ RT_TRACE(_module_mp_, _drv_info_, ("test mode change to loopback mode:0x%08x.\n", get_fwstate(pmlmepriv))); -+ } else if (_2MAC_MODE_ == type){ -+ pmppriv->mode = type; -+ _clr_fwstate_(pmlmepriv, WIFI_MP_LPBK_STATE); -+ RT_TRACE(_module_mp_, _drv_info_, ("test mode change to 2mac mode:0x%08x.\n", get_fwstate(pmlmepriv))); -+ } else -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} + +unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv) @@ -53000,10 +35604,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + _rtw_memcpy(pattrib->dst, pparm->da, ETH_ALEN); + SetPacketTx(padapter); + } else -+ return NDIS_STATUS_FAILURE; ++ return uint_FAILURE; + } + -+ return NDIS_STATUS_SUCCESS; ++ return uint_SUCCESS; +} + +#if 0 @@ -53087,23 +35691,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 +} +#endif +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_set_power_down_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_set_power_down_hdl(struct oid_par_priv *poid_par_priv) +{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif + u8 bpwrup; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+#ifdef PLATFORM_LINUX -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+#endif -+#endif -+ -+_func_enter_; ++ uint status = uint_SUCCESS; + + if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; ++ status = uint_NOT_ACCEPTED; + return status; + } + @@ -53114,517 +35708,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux/3rdparty/rtl88 + + bpwrup = *(u8 *)poid_par_priv->information_buf; + //CALL the power_down function -+#ifdef PLATFORM_LINUX -+#if defined(CONFIG_RTL8712) //Linux MP insmod unknown symbol -+ dev_power_down(padapter,bpwrup); -+#endif -+#endif + _irqlevel_changed_(&oldirql, RAISE); + -+ //DEBUG_ERR(("\n <=== Query OID_RT_PRO_READ_REGISTER. -+ // Add:0x%08x Width:%d Value:0x%08x\n",RegRWStruct->offset,RegRWStruct->width,RegRWStruct->value)); -+ -+_func_exit_; -+ + return status; +} +//------------------------------------------------------------------------------ -+NDIS_STATUS oid_rt_get_power_mode_hdl(struct oid_par_priv *poid_par_priv) ++uint oid_rt_get_power_mode_hdl(struct oid_par_priv *poid_par_priv) +{ -+#if 0 -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+//#ifdef PLATFORM_OS_XP -+// _irqL oldirql; -+//#endif -+ -+_func_enter_; -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ if (poid_par_priv->information_buf_len < sizeof(u32)) { -+ status = NDIS_STATUS_INVALID_LENGTH; -+ return status; -+ } -+ -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("\n ===> oid_rt_get_power_mode_hdl.\n")); -+ -+// _irqlevel_changed_(&oldirql, LOWER); -+ *(int*)poid_par_priv->information_buf = Adapter->registrypriv.low_power ? POWER_LOW : POWER_NORMAL; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+// _irqlevel_changed_(&oldirql, RAISE); -+ -+_func_exit_; -+ -+ return status; -+#else + return 0; -+#endif +} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_odm.c linux/3rdparty/rtl8812au/core/rtw_odm.c ---- linux.old/3rdparty/rtl8812au/core/rtw_odm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_odm.c 2017-06-07 23:07:21.003686847 +0300 -@@ -0,0 +1,448 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+ -+const char *odm_comp_str[] = { -+ /* BIT0 */"ODM_COMP_DIG", -+ /* BIT1 */"ODM_COMP_RA_MASK", -+ /* BIT2 */"ODM_COMP_DYNAMIC_TXPWR", -+ /* BIT3 */"ODM_COMP_FA_CNT", -+ /* BIT4 */"ODM_COMP_RSSI_MONITOR", -+ /* BIT5 */"ODM_COMP_CCK_PD", -+ /* BIT6 */"ODM_COMP_ANT_DIV", -+ /* BIT7 */"ODM_COMP_PWR_SAVE", -+ /* BIT8 */"ODM_COMP_PWR_TRAIN", -+ /* BIT9 */"ODM_COMP_RATE_ADAPTIVE", -+ /* BIT10 */"ODM_COMP_PATH_DIV", -+ /* BIT11 */"ODM_COMP_PSD", -+ /* BIT12 */"ODM_COMP_DYNAMIC_PRICCA", -+ /* BIT13 */"ODM_COMP_RXHP", -+ /* BIT14 */"ODM_COMP_MP", -+ /* BIT15 */"ODM_COMP_CFO_TRACKING", -+ /* BIT16 */"ODM_COMP_ACS", -+ /* BIT17 */"PHYDM_COMP_ADAPTIVITY", -+ /* BIT18 */"PHYDM_COMP_RA_DBG", -+ /* BIT19 */"PHYDM_COMP_TXBF", -+ /* BIT20 */"ODM_COMP_EDCA_TURBO", -+ /* BIT21 */"ODM_COMP_EARLY_MODE", -+ /* BIT22 */"ODM_FW_DEBUG_TRACE", -+ /* BIT23 */NULL, -+ /* BIT24 */"ODM_COMP_TX_PWR_TRACK", -+ /* BIT25 */"ODM_COMP_RX_GAIN_TRACK", -+ /* BIT26 */"ODM_COMP_CALIBRATION", -+ /* BIT27 */NULL, -+ /* BIT28 */NULL, -+ /* BIT29 */"BEAMFORMING_DEBUG", -+ /* BIT30 */"ODM_COMP_COMMON", -+ /* BIT31 */"ODM_COMP_INIT", -+}; -+ -+#define RTW_ODM_COMP_MAX 32 -+ -+const char *odm_ability_str[] = { -+ /* BIT0 */"ODM_BB_DIG", -+ /* BIT1 */"ODM_BB_RA_MASK", -+ /* BIT2 */"ODM_BB_DYNAMIC_TXPWR", -+ /* BIT3 */"ODM_BB_FA_CNT", -+ /* BIT4 */"ODM_BB_RSSI_MONITOR", -+ /* BIT5 */"ODM_BB_CCK_PD", -+ /* BIT6 */"ODM_BB_ANT_DIV", -+ /* BIT7 */"ODM_BB_PWR_SAVE", -+ /* BIT8 */"ODM_BB_PWR_TRAIN", -+ /* BIT9 */"ODM_BB_RATE_ADAPTIVE", -+ /* BIT10 */"ODM_BB_PATH_DIV", -+ /* BIT11 */"ODM_BB_PSD", -+ /* BIT12 */"ODM_BB_RXHP", -+ /* BIT13 */"ODM_BB_ADAPTIVITY", -+ /* BIT14 */"ODM_BB_CFO_TRACKING", -+ /* BIT15 */"ODM_BB_NHM_CNT", -+ /* BIT16 */"ODM_BB_PRIMARY_CCA", -+ /* BIT17 */"ODM_BB_TXBF", -+ /* BIT18 */NULL, -+ /* BIT19 */NULL, -+ /* BIT20 */"ODM_MAC_EDCA_TURBO", -+ /* BIT21 */"ODM_MAC_EARLY_MODE", -+ /* BIT22 */NULL, -+ /* BIT23 */NULL, -+ /* BIT24 */"ODM_RF_TX_PWR_TRACK", -+ /* BIT25 */"ODM_RF_RX_GAIN_TRACK", -+ /* BIT26 */"ODM_RF_CALIBRATION", -+}; -+ -+#define RTW_ODM_ABILITY_MAX 27 -+ -+const char *odm_dbg_level_str[] = { -+ NULL, -+ "ODM_DBG_OFF", -+ "ODM_DBG_SERIOUS", -+ "ODM_DBG_WARNING", -+ "ODM_DBG_LOUD", -+ "ODM_DBG_TRACE", -+}; -+ -+#define RTW_ODM_DBG_LEVEL_NUM 6 -+ -+void rtw_odm_dbg_comp_msg(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &pHalData->odmpriv; -+ int cnt = 0; -+ u64 dbg_comp = 0; -+ int i; -+ -+ rtw_hal_get_odm_var(adapter, HAL_ODM_DBG_FLAG, &dbg_comp, NULL); -+ -+ DBG_871X_SEL_NL(sel, "odm.DebugComponents = 0x%016llx\n", dbg_comp); -+ for (i=0;iodmpriv; -+ int cnt = 0; -+ u32 dbg_level = 0; -+ int i; -+ -+ rtw_hal_get_odm_var(adapter, HAL_ODM_DBG_LEVEL, &dbg_level, NULL); -+ DBG_871X_SEL_NL(sel, "odm.DebugLevel = %u\n", dbg_level); -+ for (i=0;iodmpriv; -+ int cnt = 0; -+ u32 ability = 0; -+ int i; -+ -+ ability = rtw_phydm_ability_get(adapter); -+ DBG_871X_SEL_NL(sel, "odm.SupportAbility = 0x%08x\n", ability); -+ for (i=0;iregistrypriv; -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &hal_data->odmpriv; -+ -+ DBG_871X_SEL_NL(sel, "RTW_ADAPTIVITY_EN_"); -+ -+ if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_DISABLE) { -+ DBG_871X_SEL(sel, "DISABLE\n"); -+ } else if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_ENABLE) { -+ DBG_871X_SEL(sel, "ENABLE\n"); -+ } else { -+ DBG_871X_SEL(sel, "INVALID\n"); -+ } -+} -+ -+#define RTW_ADAPTIVITY_MODE_NORMAL 0 -+#define RTW_ADAPTIVITY_MODE_CARRIER_SENSE 1 -+ -+void rtw_odm_adaptivity_mode_msg(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *regsty = &adapter->registrypriv; -+ -+ DBG_871X_SEL_NL(sel, "RTW_ADAPTIVITY_MODE_"); -+ -+ if (regsty->adaptivity_mode == RTW_ADAPTIVITY_MODE_NORMAL) { -+ DBG_871X_SEL(sel, "NORMAL\n"); -+ } else if (regsty->adaptivity_mode == RTW_ADAPTIVITY_MODE_CARRIER_SENSE) { -+ DBG_871X_SEL(sel, "CARRIER_SENSE\n"); -+ } else { -+ DBG_871X_SEL(sel, "INVALID\n"); -+ } -+} -+ -+#define RTW_ADAPTIVITY_DML_DISABLE 0 -+#define RTW_ADAPTIVITY_DML_ENABLE 1 -+ -+void rtw_odm_adaptivity_dml_msg(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *regsty = &adapter->registrypriv; -+ -+ DBG_871X_SEL_NL(sel, "RTW_ADAPTIVITY_DML_"); -+ -+ if (regsty->adaptivity_dml == RTW_ADAPTIVITY_DML_DISABLE) { -+ DBG_871X_SEL(sel, "DISABLE\n"); -+ } else if (regsty->adaptivity_dml == RTW_ADAPTIVITY_DML_ENABLE) { -+ DBG_871X_SEL(sel, "ENABLE\n"); -+ } else { -+ DBG_871X_SEL(sel, "INVALID\n"); -+ } -+} -+ -+void rtw_odm_adaptivity_dc_backoff_msg(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *regsty = &adapter->registrypriv; -+ -+ DBG_871X_SEL_NL(sel, "RTW_ADAPTIVITY_DC_BACKOFF:%u\n", regsty->adaptivity_dc_backoff); -+} -+ -+void rtw_odm_adaptivity_config_msg(void *sel, _adapter *adapter) -+{ -+ rtw_odm_adaptivity_ver_msg(sel, adapter); -+ rtw_odm_adaptivity_en_msg(sel, adapter); -+ rtw_odm_adaptivity_mode_msg(sel, adapter); -+ rtw_odm_adaptivity_dml_msg(sel, adapter); -+ rtw_odm_adaptivity_dc_backoff_msg(sel, adapter); -+} -+ -+bool rtw_odm_adaptivity_needed(_adapter *adapter) -+{ -+ struct registry_priv *regsty = &adapter->registrypriv; -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ bool ret = _FALSE; -+ -+ if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_ENABLE) -+ ret = _TRUE; -+ -+ return ret; -+} -+ -+void rtw_odm_adaptivity_parm_msg(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &pHalData->odmpriv; -+ -+ rtw_odm_adaptivity_config_msg(sel, adapter); -+ -+ DBG_871X_SEL_NL(sel, "%10s %16s %16s %22s %12s\n" -+ , "TH_L2H_ini", "TH_EDCCA_HL_diff", "TH_L2H_ini_mode2", "TH_EDCCA_HL_diff_mode2", "EDCCA_enable"); -+ DBG_871X_SEL_NL(sel, "0x%-8x %-16d 0x%-14x %-22d %-12d\n" -+ , (u8)odm->TH_L2H_ini -+ , odm->TH_EDCCA_HL_diff -+ , (u8)odm->TH_L2H_ini_mode2 -+ , odm->TH_EDCCA_HL_diff_mode2 -+ , odm->EDCCA_enable -+ ); -+ -+ DBG_871X_SEL_NL(sel, "%15s %9s\n", "AdapEnableState", "Adap_Flag"); -+ DBG_871X_SEL_NL(sel, "%-15x %-9x\n" -+ , odm->Adaptivity_enable -+ , odm->adaptivity_flag -+ ); -+} -+ -+void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 TH_L2H_ini, s8 TH_EDCCA_HL_diff, s8 TH_L2H_ini_mode2, s8 TH_EDCCA_HL_diff_mode2, u8 EDCCA_enable) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &pHalData->odmpriv; -+ -+ odm->TH_L2H_ini = TH_L2H_ini; -+ odm->TH_EDCCA_HL_diff = TH_EDCCA_HL_diff; -+ odm->TH_L2H_ini_mode2 = TH_L2H_ini_mode2; -+ odm->TH_EDCCA_HL_diff_mode2 = TH_EDCCA_HL_diff_mode2; -+ odm->EDCCA_enable = EDCCA_enable; -+} -+ -+void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &(hal_data->odmpriv); -+ -+ DBG_871X_SEL_NL(sel,"RxRate = %s, RSSI_A = %d(%%), RSSI_B = %d(%%)\n", -+ HDATA_RATE(odm->RxRate), odm->RSSI_A, odm->RSSI_B); -+} -+ -+ -+void rtw_odm_acquirespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); -+ _irqL irqL; -+ -+ switch(type) -+ { -+ case RT_IQK_SPINLOCK: -+ _enter_critical_bh(&pHalData->IQKSpinLock, &irqL); -+ default: -+ break; -+ } -+} -+ -+void rtw_odm_releasespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); -+ _irqL irqL; -+ -+ switch(type) -+ { -+ case RT_IQK_SPINLOCK: -+ _exit_critical_bh(&pHalData->IQKSpinLock, &irqL); -+ default: -+ break; -+ } -+} -+ -+#ifdef CONFIG_DFS_MASTER -+VOID rtw_odm_radar_detect_reset(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ PDM_ODM_T pDM_Odm = &(hal_data->odmpriv); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8192D) { -+ ODM_SetBBReg(pDM_Odm, 0xc84 , BIT25, 0); -+ ODM_SetBBReg(pDM_Odm, 0xc84 , BIT25, 1); -+ } else if (pDM_Odm->SupportICType & ODM_RTL8821) { -+ ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 0); -+ ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 1); -+ } else { -+ /* not supported yet */ -+ rtw_warn_on(1); -+ } -+} -+ -+VOID rtw_odm_radar_detect_disable(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ PDM_ODM_T pDM_Odm = &(hal_data->odmpriv); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8192D) -+ ODM_SetBBReg(pDM_Odm, 0xc84 , BIT25, 0); -+ else if (pDM_Odm->SupportICType & ODM_RTL8821) -+ ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 0); -+ else -+ rtw_warn_on(1); -+} -+ -+/* called after ch, bw is set, chance to adjust parameter for different ch conditions */ -+VOID rtw_odm_radar_detect_enable(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ PDM_ODM_T pDM_Odm = &(hal_data->odmpriv); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8192D) { -+ ODM_SetBBReg(pDM_Odm, 0xc38, BIT23 | BIT22, 2); -+ ODM_SetBBReg(pDM_Odm, 0x814, bMaskDWord, 0x04cc4d10); -+ ODM_SetBBReg(pDM_Odm, 0xc8c, BIT23 | BIT22, 3); -+ ODM_SetBBReg(pDM_Odm, 0xc30, 0xf, 0xa); -+ ODM_SetBBReg(pDM_Odm, 0xcdc, 0xf0000, 4); -+ } else if (pDM_Odm->SupportICType & ODM_RTL8821) { -+ ODM_SetBBReg(pDM_Odm, 0x814, 0x3fffffff, 0x04cc4d10); -+ ODM_SetBBReg(pDM_Odm, 0x834, bMaskByte0, 0x06); -+ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16ecdf); -+ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x0152a400); -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0fa21a20); -+ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0f57204); -+ } else { -+ /* not supported yet */ -+ rtw_warn_on(1); -+ } -+ -+ rtw_odm_radar_detect_reset(adapter); -+} -+ -+BOOLEAN rtw_odm_radar_detect(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ PDM_ODM_T pDM_Odm = &(hal_data->odmpriv); -+ BOOLEAN enable_DFS = FALSE; -+ BOOLEAN bypass = FALSE; -+ BOOLEAN radar_detected = FALSE; -+ -+ static u8Byte last_tx_unicast = 0; -+ static u8Byte last_rx_unicast = 0; -+ static u8Byte throughput = 0; -+ int tp_th = ((*pDM_Odm->pBandWidth == ODM_BW40M) ? 45 : 20); /*refer AP team's testing number*/ -+ -+ throughput = (*(pDM_Odm->pNumTxBytesUnicast) - last_tx_unicast) + (*(pDM_Odm->pNumRxBytesUnicast) - last_rx_unicast); -+ last_tx_unicast = *(pDM_Odm->pNumTxBytesUnicast); -+ last_rx_unicast = *(pDM_Odm->pNumRxBytesUnicast); -+ -+ if (throughput>>18 > tp_th) { -+ if (pDM_Odm->SupportICType & ODM_RTL8192D) -+ ODM_SetBBReg(pDM_Odm, 0xcdc, BIT8|BIT9, 0); -+ bypass = TRUE; -+ } else { -+ if (pDM_Odm->SupportICType & ODM_RTL8192D) -+ ODM_SetBBReg(pDM_Odm, 0xcdc, BIT8|BIT9, 1); -+ } -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8192D) { -+ if (ODM_GetBBReg(pDM_Odm , 0xc84, BIT25)) -+ enable_DFS = TRUE; -+ } else if (pDM_Odm->SupportICType & ODM_RTL8821) { -+ if (ODM_GetBBReg(pDM_Odm , 0x924, BIT15)) -+ enable_DFS = TRUE; -+ } -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8192D) { -+ if (ODM_GetBBReg(pDM_Odm , 0xcf8, BIT23)) -+ radar_detected = TRUE; -+ } else if (pDM_Odm->SupportICType & ODM_RTL8821) { -+ if (ODM_GetBBReg(pDM_Odm , 0xf98, BIT17)) -+ radar_detected = TRUE; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD -+ , ("Radar detect: enable_DFS:%d, radar_detected:%d, bypass:%d\n" -+ , enable_DFS, radar_detected, bypass)); -+ if (0) -+ DBG_871X("Radar detect: enable_DFS:%d, radar_detected:%d, bypass:%d(throughput:%llu, tp_th:%d)\n" -+ , enable_DFS, radar_detected, bypass, throughput, tp_th); -+ -+ if (enable_DFS && radar_detected) -+ rtw_odm_radar_detect_reset(adapter); -+ -+exit: -+ return (enable_DFS && radar_detected && !bypass); -+} -+#endif /* CONFIG_DFS_MASTER */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/core/rtw_p2p.c ---- linux.old/3rdparty/rtl8812au/core/rtw_p2p.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_p2p.c 2017-06-07 23:07:21.004686938 +0300 -@@ -0,0 +1,5395 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_p2p.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_p2p.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_p2p.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_p2p.c 2018-02-06 17:42:30.698966987 +0200 +@@ -0,0 +1,5130 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -53634,11 +35734,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_P2P_C_ + @@ -53646,7 +35741,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + +#ifdef CONFIG_P2P + -+int rtw_p2p_is_channel_list_ok( u8 desired_ch, u8* ch_list, u8 ch_cnt ) ++static int rtw_p2p_is_channel_list_ok( u8 desired_ch, u8* ch_list, u8 ch_cnt ) +{ + int found = 0, i = 0; + @@ -53661,9 +35756,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + return( found ); +} + -+int is_any_client_associated(_adapter *padapter) ++static int is_any_client_associated(_adapter *padapter) +{ -+ return padapter->stapriv.asoc_list_cnt ? _TRUE : _FALSE; ++ return padapter->stapriv.asoc_list_cnt ? true : false; +} + +static u32 go_add_group_info_attr(struct wifidirect_info *pwdinfo, u8 *pbuf) @@ -53681,11 +35776,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + pdata_attr = rtw_zmalloc(MAX_P2P_IE_LEN); + -+ if(NULL == pdata_attr){ -+ DBG_871X("%s pdata_attr malloc failed \n", __FUNCTION__); -+ goto _exit; -+ } -+ + pstart = pdata_attr; + pcur = pdata_attr; + @@ -53694,19 +35784,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + plist = get_next(phead); + + //look up sta asoc_queue -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { ++ while ((rtw_end_of_queue_search(phead, plist)) == false) ++ { + psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ ++ + plist = get_next(plist); -+ ++ + + if(psta->is_p2p_device) + { + tmplen = 0; -+ ++ + pcur++; -+ ++ + //P2P device address + _rtw_memcpy(pcur, psta->dev_addr, ETH_ALEN); + pcur += ETH_ALEN; @@ -53730,7 +35820,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + _rtw_memcpy(pcur, psta->secdev_types_list, psta->num_of_secdev_type*8); + pcur += psta->num_of_secdev_type*8; -+ ++ + if(psta->dev_name_len>0) + { + //*(u16*)(pcur) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); @@ -53747,17 +35837,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + + tmplen = (u8)(pcur-pstart); -+ ++ + *pstart = (tmplen-1); + + attr_len += tmplen; + + //pstart += tmplen; + pstart = pcur; -+ ++ + } -+ -+ ++ ++ + } + _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); + @@ -53767,8 +35857,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + } + + rtw_mfree(pdata_attr, MAX_P2P_IE_LEN); -+ -+_exit: ++ + return len; + +} @@ -53779,12 +35868,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + _adapter *padapter = pwdinfo->padapter; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ unsigned char category = RTW_WLAN_CATEGORY_P2P;//P2P action frame -+ u32 p2poui = cpu_to_be32(P2POUI); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ unsigned char category = RTW_WLAN_CATEGORY_P2P;//P2P action frame ++ __be32 p2poui = cpu_to_be32(P2POUI); + u8 oui_subtype = P2P_GO_DISC_REQUEST; + u8 dialogToken=0; + @@ -53819,10 +35908,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); + + //Build P2P action frame header -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); + + //there is no IE in this P2P action frame + @@ -53833,24 +35922,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ +} + +static void issue_p2p_devdisc_resp(struct wifidirect_info *pwdinfo, u8 *da, u8 status, u8 dialogToken) -+{ ++{ + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + _adapter *padapter = pwdinfo->padapter; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; + u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); ++ __be32 p2poui = cpu_to_be32(P2POUI); + u8 oui_subtype = P2P_DEVDISC_RESP; + u8 p2pie[8] = { 0x00 }; -+ u32 p2pielen = 0; ++ u32 p2pielen = 0; + + DBG_871X("[%s]\n", __FUNCTION__); -+ ++ + if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) + { + return; @@ -53883,8 +35972,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); + + + //Build P2P IE @@ -53897,8 +35986,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + // P2P_ATTR_STATUS + p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_STATUS, 1, &status); -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, p2pie, &pattrib->pktlen); ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, p2pie, &pattrib->pktlen); + + pattrib->last_txcmdsz = pattrib->pktlen; + @@ -53912,19 +36001,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; + u8 action = P2P_PUB_ACTION_ACTION; + u8 dialogToken = frame_body[7]; // The Dialog Token of provisioning discovery request frame. -+ u32 p2poui = cpu_to_be32(P2POUI); ++ __be32 p2poui = cpu_to_be32(P2POUI); + u8 oui_subtype = P2P_PROVISION_DISC_RESP; + u8 wpsie[ 100 ] = { 0x00 }; + u8 wpsielen = 0; +#ifdef CONFIG_WFD + u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ ++#endif //CONFIG_WFD ++ + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -53948,8 +36037,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); + pmlmeext->mgnt_seq++; @@ -53961,8 +36050,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); + + wpsielen = 0; + // WPS OUI @@ -54000,7 +36089,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + RTW_PUT_BE16(wpsie + wpsielen, config_method); + wpsielen += 2; + -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); + +#ifdef CONFIG_WFD + wfdielen = build_provdisc_resp_wfd_ie(pwdinfo, pframe); @@ -54022,13 +36111,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + struct pkt_attrib *pattrib; + unsigned char *pframe; + struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; ++ __le16 *fctrl; + _adapter *padapter = pwdinfo->padapter; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ unsigned char category = RTW_WLAN_CATEGORY_P2P;//P2P action frame -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_PRESENCE_RESPONSE; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ unsigned char category = RTW_WLAN_CATEGORY_P2P;//P2P action frame ++ __be32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_PRESENCE_RESPONSE; + u8 p2pie[ MAX_P2P_IE_LEN] = { 0x00 }; + u8 noa_attr_content[32] = { 0x00 }; + u32 p2pielen = 0; @@ -54064,10 +36153,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); + + //Build P2P action frame header -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); + + + //Add P2P IE header @@ -54078,22 +36167,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + p2pie[ p2pielen++ ] = 0x9A; + p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 + -+ //Add Status attribute in P2P IE ++ //Add Status attribute in P2P IE + p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_STATUS, 1, &status); + + //Add NoA attribute in P2P IE + noa_attr_content[0] = 0x1;//index + noa_attr_content[1] = 0x0;//CTWindow and OppPS Parameters -+ ++ + //todo: Notice of Absence Descriptor(s) -+ ++ + p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_NOA, 2, noa_attr_content); + + + + pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, p2pie, &(pattrib->pktlen)); + -+ ++ + pattrib->last_txcmdsz = pattrib->pktlen; + + dump_mgntframe(padapter, pmgntframe); @@ -54105,7 +36194,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + u8 p2pie[ MAX_P2P_IE_LEN] = { 0x00 }; + u16 capability=0; + u32 len=0, p2pielen = 0; -+ ++ __le16 le_tmp; + + // P2P OUI + p2pielen = 0; @@ -54118,7 +36207,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // According to the P2P Specification, the beacon frame should contain 3 P2P attributes + // 1. P2P Capability + // 2. P2P Device ID -+ // 3. Notice of Absence ( NOA ) ++ // 3. Notice of Absence ( NOA ) + + // P2P Capability ATTR + // Type: @@ -54126,42 +36215,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Value: + // Device Capability Bitmap, 1 byte + // Be able to participate in additional P2P Groups and -+ // support the P2P Invitation Procedure -+ // Group Capability Bitmap, 1 byte ++ // support the P2P Invitation Procedure ++ // Group Capability Bitmap, 1 byte + capability = P2P_DEVCAP_INVITATION_PROC|P2P_DEVCAP_CLIENT_DISCOVERABILITY; + capability |= ((P2P_GRPCAP_GO | P2P_GRPCAP_INTRABSS) << 8); + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) + capability |= (P2P_GRPCAP_GROUP_FORMATION<<8); + -+ capability = cpu_to_le16(capability); ++ le_tmp = cpu_to_le16(capability); + -+ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_CAPABILITY, 2, (u8*)&capability); ++ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_CAPABILITY, 2, (u8*)&le_tmp); + -+ + // P2P Device ID ATTR + p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_DEVICE_ID, ETH_ALEN, pwdinfo->device_addr); + -+ + // Notice of Absence ATTR -+ // Type: ++ // Type: + // Length: + // Value: -+ ++ + //go_add_noa_attr(pwdinfo); -+ -+ ++ + pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); -+ -+ ++ + return len; -+ +} + +#ifdef CONFIG_WFD +u32 build_beacon_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) +{ + u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u16 val16=0; + u32 len=0, wfdielen = 0; + _adapter *padapter = pwdinfo->padapter; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -54198,24 +36281,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + if ( is_any_client_associated( pwdinfo->padapter ) ) + { + // WFD primary sink + WiFi Direct mode + WSD (WFD Service Discovery) -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD ); + } + else + { + // WFD primary sink + available for WFD session + WiFi Direct mode + WSD (WFD Service Discovery) -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); + } + + } + else + { + // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); + } -+ ++ + wfdielen += 2; + + // Value2: @@ -54241,7 +36321,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + // Value: + // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE ) ++ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) + { + _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); + } @@ -54273,16 +36353,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + wfdie[ wfdielen++ ] = 0; + wfdie[ wfdielen++ ] = 0; + -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); + + return len; -+ ++ +} + +u32 build_probe_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) +{ + u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u16 val16=0; + u32 len=0, wfdielen = 0; + _adapter *padapter = pwdinfo->padapter; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -54316,20 +36395,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + if ( 1 == pwdinfo->wfd_tdls_enable ) + { -+ // WFD primary sink + available for WFD session + WiFi TDLS mode + WSC ( WFD Service Discovery ) -+ val16 = pwfd_info->wfd_device_type | -+ WFD_DEVINFO_SESSION_AVAIL | ++ // WFD primary sink + available for WFD session + WiFi TDLS mode + WSC ( WFD Service Discovery ) ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | ++ WFD_DEVINFO_SESSION_AVAIL | + WFD_DEVINFO_WSD | -+ WFD_DEVINFO_PC_TDLS; -+ RTW_PUT_BE16(wfdie + wfdielen, val16 ); ++ WFD_DEVINFO_PC_TDLS ); + } + else + { -+ // WFD primary sink + available for WFD session + WiFi Direct mode + WSC ( WFD Service Discovery ) -+ val16 = pwfd_info->wfd_device_type | -+ WFD_DEVINFO_SESSION_AVAIL | -+ WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16 ); ++ // WFD primary sink + available for WFD session + WiFi Direct mode + WSC ( WFD Service Discovery ) ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | ++ WFD_DEVINFO_SESSION_AVAIL | ++ WFD_DEVINFO_WSD ); + } + + wfdielen += 2; @@ -54357,7 +36434,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + // Value: + // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE ) ++ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) + { + _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); + } @@ -54389,10 +36466,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + wfdie[ wfdielen++ ] = 0; + wfdie[ wfdielen++ ] = 0; + -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); + + return len; -+ ++ +} + +u32 build_probe_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 tunneled) @@ -54430,8 +36507,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Value1: + // WFD device information + // WFD primary sink + available for WFD session + WiFi Direct mode -+ -+ if ( _TRUE == pwdinfo->session_available ) ++ ++ if ( true == pwdinfo->session_available ) + { + if ( P2P_ROLE_GO == pwdinfo->role ) + { @@ -54446,7 +36523,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + // WiFi Direct mode + WSD ( WFD Service Discovery ) + RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); -+ } ++ } + } + else + { @@ -54459,7 +36536,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + // available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) + RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); -+ } ++ } + } + } + else @@ -54515,7 +36592,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + // Value: + // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE ) ++ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) + { + _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); + } @@ -54576,7 +36653,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + // Value: + // Alternative MAC Address -+ _rtw_memcpy(wfdie + wfdielen, adapter_mac_addr(padapter->pbuddy_adapter), ETH_ALEN); ++ _rtw_memcpy( wfdie + wfdielen, &padapter->pbuddy_adapter->eeprompriv.mac_addr[ 0 ], ETH_ALEN ); + // This mac address is used to make the WFD session when TDLS is enable. + + wfdielen += ETH_ALEN; @@ -54587,15 +36664,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); + + return len; -+ ++ +} + +u32 build_assoc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) +{ + u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u16 val16=0; + u32 len=0, wfdielen = 0; -+ _adapter *padapter = NULL; ++ _adapter *padapter = NULL; + struct mlme_priv *pmlmepriv = NULL; + struct wifi_display_info *pwfd_info = NULL; + @@ -54608,7 +36684,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + padapter = pwdinfo->padapter; + pmlmepriv = &padapter->mlmepriv; + pwfd_info = padapter->wdinfo.wfd_info; -+ ++ + wfdielen = 0; + wfdie[ wfdielen++ ] = 0x50; + wfdie[ wfdielen++ ] = 0x6F; @@ -54634,8 +36710,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Value1: + // WFD device information + // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); + wfdielen += 2; + + // Value2: @@ -54661,7 +36736,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + // Value: + // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE ) ++ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) + { + _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); + } @@ -54693,17 +36768,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + wfdie[ wfdielen++ ] = 0; + wfdie[ wfdielen++ ] = 0; + -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); + + return len; -+ ++ +} + +u32 build_assoc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) +{ + u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; + u32 len=0, wfdielen = 0; -+ u16 val16=0; + _adapter *padapter = pwdinfo->padapter; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; @@ -54734,8 +36808,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Value1: + // WFD device information + // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); + wfdielen += 2; + + // Value2: @@ -54761,7 +36834,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + // Value: + // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE ) ++ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) + { + _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); + } @@ -54793,17 +36866,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + wfdie[ wfdielen++ ] = 0; + wfdie[ wfdielen++ ] = 0; + -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); + + return len; -+ ++ +} + +u32 build_nego_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) +{ + u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; + u32 len=0, wfdielen = 0; -+ u16 val16=0; + _adapter *padapter = pwdinfo->padapter; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; @@ -54834,8 +36906,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Value1: + // WFD device information + // WFD primary sink + WiFi Direct mode + WSD ( WFD Service Discovery ) + WFD Session Available -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL); + wfdielen += 2; + + // Value2: @@ -54861,7 +36932,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + // Value: + // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE ) ++ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) + { + _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); + } @@ -54893,17 +36964,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + wfdie[ wfdielen++ ] = 0; + wfdie[ wfdielen++ ] = 0; + -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); + + return len; -+ ++ +} + +u32 build_nego_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) +{ + u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; + u32 len=0, wfdielen = 0; -+ u16 val16=0; + _adapter *padapter = pwdinfo->padapter; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; @@ -54934,8 +37004,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Value1: + // WFD device information + // WFD primary sink + WiFi Direct mode + WSD ( WFD Service Discovery ) + WFD Session Available -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL); + wfdielen += 2; + + // Value2: @@ -54961,108 +37030,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + // Value: + // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ wfdielen += ETH_ALEN; -+ -+ // Coupled Sink Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ // Value: -+ // Coupled Sink Status bitmap -+ // Not coupled/available for Coupling -+ wfdie[ wfdielen++ ] = 0; -+ // MAC Addr. -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ -+ -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_nego_confirm_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len=0, wfdielen = 0; -+ u16 val16=0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; -+ -+ // WFD OUI -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110825 -+ // According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID ( Optional ) -+ // 3. Local IP Adress ( Optional ) -+ -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ // WFD primary sink + WiFi Direct mode + WSD ( WFD Service Discovery ) + WFD Session Available -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE ) ++ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) + { + _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); + } @@ -55098,14 +37066,112 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); + + return len; -+ ++ ++} ++ ++u32 build_nego_confirm_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) ++{ ++ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; ++ u32 len=0, wfdielen = 0; ++ _adapter *padapter = pwdinfo->padapter; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; ++ ++ // WFD OUI ++ wfdielen = 0; ++ wfdie[ wfdielen++ ] = 0x50; ++ wfdie[ wfdielen++ ] = 0x6F; ++ wfdie[ wfdielen++ ] = 0x9A; ++ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 ++ ++ // Commented by Albert 20110825 ++ // According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes ++ // 1. WFD Device Information ++ // 2. Associated BSSID ( Optional ) ++ // 3. Local IP Adress ( Optional ) ++ ++ ++ // WFD Device Information ATTR ++ // Type: ++ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; ++ ++ // Length: ++ // Note: In the WFD specification, the size of length field is 2. ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ // Value1: ++ // WFD device information ++ // WFD primary sink + WiFi Direct mode + WSD ( WFD Service Discovery ) + WFD Session Available ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL); ++ wfdielen += 2; ++ ++ // Value2: ++ // Session Management Control Port ++ // Default TCP port for RTSP messages is 554 ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); ++ wfdielen += 2; ++ ++ // Value3: ++ // WFD Device Maximum Throughput ++ // 300Mbps is the maximum throughput ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ // Associated BSSID ATTR ++ // Type: ++ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; ++ ++ // Length: ++ // Note: In the WFD specification, the size of length field is 2. ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ // Value: ++ // Associated BSSID ++ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) ++ { ++ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); ++ } ++ else ++ { ++ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); ++ } ++ ++ wfdielen += ETH_ALEN; ++ ++ // Coupled Sink Information ATTR ++ // Type: ++ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; ++ ++ // Length: ++ // Note: In the WFD specification, the size of length field is 2. ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); ++ wfdielen += 2; ++ ++ // Value: ++ // Coupled Sink Status bitmap ++ // Not coupled/available for Coupling ++ wfdie[ wfdielen++ ] = 0; ++ // MAC Addr. ++ wfdie[ wfdielen++ ] = 0; ++ wfdie[ wfdielen++ ] = 0; ++ wfdie[ wfdielen++ ] = 0; ++ wfdie[ wfdielen++ ] = 0; ++ wfdie[ wfdielen++ ] = 0; ++ wfdie[ wfdielen++ ] = 0; ++ ++ ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ ++ return len; ++ +} + +u32 build_invitation_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) +{ + u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; + u32 len=0, wfdielen = 0; -+ u16 val16=0; + _adapter *padapter = pwdinfo->padapter; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; @@ -55136,8 +37202,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Value1: + // WFD device information + // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); + wfdielen += 2; + + // Value2: @@ -55163,7 +37228,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + // Value: + // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE ) ++ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) + { + _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); + } @@ -55210,16 +37275,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + } + -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); + + return len; -+ ++ +} + +u32 build_invitation_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) +{ + u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u16 val16=0; + u32 len=0, wfdielen = 0; + _adapter *padapter = pwdinfo->padapter; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -55251,8 +37315,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Value1: + // WFD device information + // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); + wfdielen += 2; + + // Value2: @@ -55278,7 +37341,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + // Value: + // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE ) ++ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) + { + _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); + } @@ -55325,17 +37388,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + } + -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); + + return len; -+ ++ +} + +u32 build_provdisc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) +{ + u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; + u32 len=0, wfdielen = 0; -+ u16 val16=0; + _adapter *padapter = pwdinfo->padapter; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; @@ -55366,8 +37428,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Value1: + // WFD device information + // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); + wfdielen += 2; + + // Value2: @@ -55393,7 +37454,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + // Value: + // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE ) ++ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) + { + _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); + } @@ -55426,17 +37487,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + wfdie[ wfdielen++ ] = 0; + + -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); + + return len; -+ ++ +} + +u32 build_provdisc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) +{ + u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; + u32 len=0, wfdielen = 0; -+ u16 val16=0; + _adapter *padapter = pwdinfo->padapter; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; @@ -55467,8 +37527,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Value1: + // WFD device information + // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); + wfdielen += 2; + + // Value2: @@ -55494,7 +37553,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + // Value: + // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE ) ++ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) + { + _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); + } @@ -55526,10 +37585,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + wfdie[ wfdielen++ ] = 0; + wfdie[ wfdielen++ ] = 0; + -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); ++ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); + + return len; -+ ++ +} + + @@ -55538,20 +37597,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ +u32 build_probe_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) +{ + u8 p2pie[ MAX_P2P_IE_LEN] = { 0x00 }; -+ u32 len=0, p2pielen = 0; ++ u32 len=0, p2pielen = 0; +#ifdef CONFIG_INTEL_WIDI -+ struct mlme_priv *pmlmepriv = &(pwdinfo->padapter->mlmepriv); + u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; -+ u8 widi_version = 0, i = 0; -+ -+ if( _rtw_memcmp( pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN ) == _FALSE ) -+ { -+ widi_version = 35; -+ } -+ else if( pmlmepriv->num_p2p_sdt != 0 ) -+ { -+ widi_version = 40; -+ } +#endif //CONFIG_INTEL_WIDI + + // P2P OUI @@ -55581,7 +37629,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Value: + // Device Capability Bitmap, 1 byte + p2pie[ p2pielen++ ] = DMP_P2P_DEVCAP_SUPPORT; -+ ++ + // Group Capability Bitmap, 1 byte + if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) + { @@ -55623,31 +37671,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + + // Notice of Absence ATTR -+ // Type: ++ // Type: + // Length: + // Value: + if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) + { + //go_add_noa_attr(pwdinfo); -+ } ++ } + + // Device Info ATTR + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; + + // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) ++ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) + // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) + //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); +#ifdef CONFIG_INTEL_WIDI -+ if( widi_version == 35 ) ++ if( _rtw_memcmp( pwdinfo->padapter->mlmepriv.sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN ) == false ) + { + RTW_PUT_LE16(p2pie + p2pielen, 21 + 8 + pwdinfo->device_name_len); + } -+ else if( widi_version == 40 ) -+ { -+ RTW_PUT_LE16(p2pie + p2pielen, 21 + 8 * pmlmepriv->num_p2p_sdt + pwdinfo->device_name_len); -+ } + else +#endif //CONFIG_INTEL_WIDI + RTW_PUT_LE16(p2pie + p2pielen, 21 + pwdinfo->device_name_len); @@ -55664,51 +37708,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + RTW_PUT_BE16(p2pie + p2pielen, pwdinfo->supported_wps_cm); + p2pielen += 2; + -+#ifdef CONFIG_INTEL_WIDI -+ if( widi_version == 40 ) -+ { -+ // Primary Device Type -+ // Category ID -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); -+ RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_pdt_cid ); -+ p2pielen += 2; ++ // Primary Device Type ++ // Category ID ++ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); ++ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_CID_MULIT_MEDIA); ++ p2pielen += 2; + -+ // OUI -+ //*(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); -+ RTW_PUT_BE32(p2pie + p2pielen, WPSOUI); -+ p2pielen += 4; ++ // OUI ++ //*(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); ++ RTW_PUT_BE32(p2pie + p2pielen, WPSOUI); ++ p2pielen += 4; + -+ // Sub Category ID -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); -+ RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_pdt_scid); -+ p2pielen += 2; -+ } -+ else -+#endif //CONFIG_INTEL_WIDI -+ { -+ // Primary Device Type -+ // Category ID -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_CID_MULIT_MEDIA); -+ p2pielen += 2; -+ -+ // OUI -+ //*(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); -+ RTW_PUT_BE32(p2pie + p2pielen, WPSOUI); -+ p2pielen += 4; -+ -+ // Sub Category ID -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_SCID_MEDIA_SERVER); -+ p2pielen += 2; -+ } ++ // Sub Category ID ++ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); ++ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_SCID_MEDIA_SERVER); ++ p2pielen += 2; + + // Number of Secondary Device Types +#ifdef CONFIG_INTEL_WIDI -+ if( widi_version == 35 ) ++ if( _rtw_memcmp( pwdinfo->padapter->mlmepriv.sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN ) == false ) + { + p2pie[ p2pielen++ ] = 0x01; -+ ++ + RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_CID_DISPLAYS); + p2pielen += 2; + @@ -55718,21 +37739,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + RTW_PUT_BE16(p2pie + p2pielen, P2P_SCID_WIDI_CONSUMER_SINK); + p2pielen += 2; + } -+ else if( widi_version == 40 ) -+ { -+ p2pie[ p2pielen++ ] = pmlmepriv->num_p2p_sdt; -+ for( ; i < pmlmepriv->num_p2p_sdt; i++ ) -+ { -+ RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_sdt_cid[i]); -+ p2pielen += 2; -+ -+ RTW_PUT_BE32(p2pie + p2pielen, INTEL_DEV_TYPE_OUI); -+ p2pielen += 4; -+ -+ RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_sdt_scid[i]); -+ p2pielen += 2; -+ } -+ } + else +#endif //CONFIG_INTEL_WIDI + p2pie[ p2pielen++ ] = 0x00; // No Secondary Device Type List @@ -55761,18 +37767,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + p2pielen += go_add_group_info_attr(pwdinfo, p2pie + p2pielen); + } + -+ ++ + pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); -+ ++ + + return len; -+ ++ +} + +u32 build_prov_disc_request_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8* pssid, u8 ussidlen, u8* pdev_raddr ) +{ + u8 p2pie[ MAX_P2P_IE_LEN] = { 0x00 }; -+ u32 len=0, p2pielen = 0; ++ u32 len=0, p2pielen = 0; + + // P2P OUI + p2pielen = 0; @@ -55799,7 +37805,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Value: + // Device Capability Bitmap, 1 byte + p2pie[ p2pielen++ ] = DMP_P2P_DEVCAP_SUPPORT; -+ ++ + // Group Capability Bitmap, 1 byte + if ( pwdinfo->persistent_supported ) + p2pie[ p2pielen++ ] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; @@ -55812,7 +37818,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + p2pie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; + + // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) ++ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) + // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) + //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); + RTW_PUT_LE16(p2pie + p2pielen, 21 + pwdinfo->device_name_len); @@ -55876,7 +37882,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + // Added by Albert 2011/05/19 + // In this case, the pdev_raddr is the device address of the group owner. -+ ++ + // P2P Group ID ATTR + // Type: + p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_ID; @@ -55892,21 +37898,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + _rtw_memcpy( p2pie + p2pielen, pssid, ussidlen ); + p2pielen += ussidlen; -+ ++ + } + + pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); -+ ++ + + return len; -+ ++ +} + + +u32 build_assoc_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 status_code) +{ + u8 p2pie[ MAX_P2P_IE_LEN] = { 0x00 }; -+ u32 len=0, p2pielen = 0; ++ u32 len=0, p2pielen = 0; + + // P2P OUI + p2pielen = 0; @@ -55931,22 +37937,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + + pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); -+ ++ + return len; -+ ++ +} + +u32 build_deauth_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) +{ + u32 len=0; -+ ++ + return len; +} + +u32 process_probe_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) -+{ ++{ + u8 *p; -+ u32 ret=_FALSE; ++ u32 ret=false; + u8 *p2pie; + u32 p2pielen = 0; + int ssid_len=0, rate_cnt = 0; @@ -55992,7 +37998,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // 6. Device ID attribute in P2P IE. (Todo) + + p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _SSID_IE_, (int *)&ssid_len, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); ++ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); + + ssid_len &= 0xff; // Just last 1 byte is valid for ssid len of the probe request + if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) @@ -56005,23 +38011,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + //Check Requested Device Type attributes in WSC IE. + //Check Device ID attribute in P2P IE + -+ ret = _TRUE; ++ ret = true; + } + else if ( (p != NULL) && ( ssid_len == 0 ) ) + { -+ ret = _TRUE; ++ ret = true; + } + } + else + { + //non -p2p device + } -+ -+ } + -+ ++ } ++ ++ + return ret; -+ ++ +} + +u32 process_assoc_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len, struct sta_info *psta) @@ -56043,12 +38049,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + if (frame_type == WIFI_ASSOCREQ) + { + ie_offset = _ASOCREQ_IE_OFFSET_; -+ } ++ } + else // WIFI_REASSOCREQ + { + ie_offset = _REASOCREQ_IE_OFFSET_; + } -+ ++ + ies = pframe + WLAN_HDR_A3_LEN + ie_offset; + ies_len = len - WLAN_HDR_A3_LEN - ie_offset; + @@ -56063,39 +38069,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + DBG_8192C( "[%s] P2P IE Found!!\n", __FUNCTION__ ); + } -+ ++ + while ( p2p_ie ) + { + //Check P2P Capability ATTR + if( rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8*)&cap_attr, (uint*) &attr_contentlen) ) + { + DBG_8192C( "[%s] Got P2P Capability Attr!!\n", __FUNCTION__ ); -+ cap_attr = le16_to_cpu(cap_attr); ++ le16_to_cpup((__le16 *)&cap_attr); + psta->dev_cap = cap_attr&0xff; + } + + //Check Extended Listen Timing ATTR -+ ++ + + //Check P2P Device Info ATTR + if(rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO, NULL, (uint*)&attr_contentlen)) + { -+ DBG_8192C( "[%s] Got P2P DEVICE INFO Attr!!\n", __FUNCTION__ ); ++ DBG_8192C( "[%s] Got P2P DEVICE INFO Attr!!\n", __FUNCTION__ ); + pattr_content = pbuf = rtw_zmalloc(attr_contentlen); + if(pattr_content) + { + u8 num_of_secdev_type; + u16 dev_name_len; -+ -+ ++ ++ + rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO , pattr_content, (uint*)&attr_contentlen); + -+ _rtw_memcpy(psta->dev_addr, pattr_content, ETH_ALEN);//P2P Device Address ++ _rtw_memcpy(psta->dev_addr, pattr_content, ETH_ALEN);//P2P Device Address + + pattr_content += ETH_ALEN; + + _rtw_memcpy(&psta->config_methods, pattr_content, 2);//Config Methods -+ psta->config_methods = be16_to_cpu(psta->config_methods); ++ be16_to_cpup((__be16 *)&psta->config_methods); + + pattr_content += 2; + @@ -56119,16 +38125,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + len = (sizeof(psta->secdev_types_list)<(num_of_secdev_type*8)) ? (sizeof(psta->secdev_types_list)) : (num_of_secdev_type*8); + + _rtw_memcpy(psta->secdev_types_list, pattr_content, len); -+ ++ + pattr_content += (num_of_secdev_type*8); + } + + + //dev_name_len = attr_contentlen - ETH_ALEN - 2 - 8 - 1 - (num_of_secdev_type*8); + psta->dev_name_len=0; -+ if(WPS_ATTR_DEVICE_NAME == be16_to_cpu(*(u16*)pattr_content)) -+ { -+ dev_name_len = be16_to_cpu(*(u16*)(pattr_content+2)); ++ if(WPS_ATTR_DEVICE_NAME == be16_to_cpu(*(__be16*)pattr_content)) ++ { ++ dev_name_len = be16_to_cpu(*(__be16*)(pattr_content+2)); + + psta->dev_name_len = (sizeof(psta->dev_name)dev_name):dev_name_len; + @@ -56143,7 +38149,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + //Get the next P2P IE + p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); -+ ++ + } + + return status_code; @@ -56158,39 +38164,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + _adapter *padapter = pwdinfo->padapter; + struct sta_priv *pstapriv = &padapter->stapriv; + u8 *p2p_ie; -+ u32 p2p_ielen = 0; -+ ++ u32 p2p_ielen = 0; ++ + frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); + + dialogToken = frame_body[7]; + status = P2P_STATUS_FAIL_UNKNOWN_P2PGROUP; -+ ++ + if ( (p2p_ie=rtw_get_p2p_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen)) ) + { + u8 groupid[ 38 ] = { 0x00 }; -+ u8 dev_addr[ETH_ALEN] = { 0x00 }; ++ u8 dev_addr[ETH_ALEN] = { 0x00 }; + u32 attr_contentlen = 0; + + if(rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, groupid, &attr_contentlen)) + { -+ if(_rtw_memcmp(pwdinfo->device_addr, groupid, ETH_ALEN) && ++ if(_rtw_memcmp(pwdinfo->device_addr, groupid, ETH_ALEN) && + _rtw_memcmp(pwdinfo->p2p_group_ssid, groupid+ETH_ALEN, pwdinfo->p2p_group_ssid_len)) + { + attr_contentlen=0; + if(rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_ID, dev_addr, &attr_contentlen)) + { + _irqL irqL; -+ _list *phead, *plist; ++ _list *phead, *plist; + + _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); + phead = &pstapriv->asoc_list; + plist = get_next(phead); + + //look up sta asoc_queue -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { ++ while ((rtw_end_of_queue_search(phead, plist)) == false) ++ { + psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ ++ + plist = get_next(plist); + + if(psta->is_p2p_device && (psta->dev_cap&P2P_DEVCAP_CLIENT_DISCOVERABILITY) && @@ -56201,19 +38207,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + //issue GO Discoverability Request + issue_group_disc_req(pwdinfo, psta->hwaddr); + //_enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ ++ + status = P2P_STATUS_SUCCESS; -+ ++ + break; + } + else + { + status = P2P_STATUS_FAIL_INFO_UNAVAILABLE; + } -+ -+ } ++ ++ } + _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ ++ + } + else + { @@ -56225,23 +38231,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + status = P2P_STATUS_FAIL_INVALID_PARAM; + } -+ -+ } -+ ++ ++ } ++ + } + -+ ++ + //issue Device Discoverability Response + issue_p2p_devdisc_resp(pwdinfo, GetAddr2Ptr(pframe), status, dialogToken); -+ -+ -+ return (status==P2P_STATUS_SUCCESS) ? _TRUE:_FALSE; -+ ++ ++ ++ return (status==P2P_STATUS_SUCCESS) ? true:false; ++ +} + +u32 process_p2p_devdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) +{ -+ return _TRUE; ++ return true; +} + +u8 process_p2p_provdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len ) @@ -56250,7 +38256,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + u8 *wpsie; + uint wps_ielen = 0, attr_contentlen = 0; + u16 uconfig_method = 0; -+ ++ + + frame_body = (pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); + @@ -56258,7 +38264,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + if ( rtw_get_wps_attr_content( wpsie, wps_ielen, WPS_ATTR_CONF_METHOD , ( u8* ) &uconfig_method, &attr_contentlen) ) + { -+ uconfig_method = be16_to_cpu( uconfig_method ); ++ be16_to_cpup((__be16 *)&uconfig_method); + switch( uconfig_method ) + { + case WPS_CM_DISPLYA: @@ -56286,17 +38292,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + } + } + DBG_871X( "[%s] config method = %s\n", __FUNCTION__, pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req ); -+ return _TRUE; -+ ++ return true; ++ +} -+ ++ +u8 process_p2p_provdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe) +{ + -+ return _TRUE; ++ return true; +} + -+u8 rtw_p2p_get_peer_ch_list(struct wifidirect_info *pwdinfo, u8 *ch_content, u8 ch_cnt, u8 *peer_ch_list) ++static u8 rtw_p2p_get_peer_ch_list(struct wifidirect_info *pwdinfo, u8 *ch_content, u8 ch_cnt, u8 *peer_ch_list) +{ + u8 i = 0, j = 0; + u8 temp = 0; @@ -56321,7 +38327,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + return ch_no; +} + -+u8 rtw_p2p_check_peer_oper_ch(struct mlme_ext_priv *pmlmeext, u8 ch) ++static u8 rtw_p2p_check_peer_oper_ch(struct mlme_ext_priv *pmlmeext, u8 ch) +{ + u8 i = 0; + @@ -56336,7 +38342,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + return _FAIL; +} + -+u8 rtw_p2p_ch_inclusion(struct mlme_ext_priv *pmlmeext, u8 *peer_ch_list, u8 peer_ch_num, u8 *ch_list_inclusioned) ++static u8 rtw_p2p_ch_inclusion(struct mlme_ext_priv *pmlmeext, u8 *peer_ch_list, u8 peer_ch_num, u8 *ch_list_inclusioned) +{ + int i = 0, j = 0, temp = 0; + u8 ch_no = 0; @@ -56373,7 +38379,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + u32 wfd_ielen = 0; +#ifdef CONFIG_TDLS + struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+#endif // CONFIG_TDLS ++#endif // CONFIG_TDLS +#endif // CONFIG_WFD +#ifdef CONFIG_CONCURRENT_MODE + _adapter *pbuddy_adapter = pwdinfo->padapter->pbuddy_adapter; @@ -56390,7 +38396,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + if(_rtw_memcmp( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "000", 3) ) + { + rtw_get_wps_attr_content( wpsie, wps_ielen, WPS_ATTR_DEVICE_PWID, (u8*) &wps_devicepassword_id, &wps_devicepassword_id_len); -+ wps_devicepassword_id = be16_to_cpu( wps_devicepassword_id ); ++ be16_to_cpup((__be16 *)&wps_devicepassword_id); + + if ( wps_devicepassword_id == WPS_DPID_USER_SPEC ) + { @@ -56398,11 +38404,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + } + else if ( wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC ) + { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pad", 3 ); ++ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pad", 3 ); + } + else + { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pbc", 3 ); ++ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pbc", 3 ); + } + } + } @@ -56414,9 +38420,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + return( result ); + } + ++ if ( pwdinfo->ui_got_wps_info == P2P_NO_WPSINFO ) ++ { ++ result = P2P_STATUS_FAIL_INFO_UNAVAILABLE; ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_INFOR_NOREADY); ++ return( result ); ++ } ++ + ies = pframe + _PUBLIC_ACTION_IE_OFFSET_; + ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ ++ + p2p_ie = rtw_get_p2p_ie( ies, ies_len, NULL, &p2p_ielen ); + + if ( !p2p_ie ) @@ -56425,7 +38438,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + result = P2P_STATUS_FAIL_INCOMPATIBLE_PARAM; + rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); + } -+ ++ + while ( p2p_ie ) + { + u8 attr_content = 0x00; @@ -56437,18 +38450,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + u8 ch_list_inclusioned[100] = { 0x00 }; + u8 ch_num_inclusioned = 0; + u16 cap_attr; -+ u8 listen_ch_attr[5] = { 0x00 }; + + rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_ING); + + //Check P2P Capability ATTR + if(rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8*)&cap_attr, (uint*)&attr_contentlen) ) + { -+ cap_attr = le16_to_cpu(cap_attr); -+ ++ le16_to_cpup((__le16 *)&cap_attr); ++ +#if defined(CONFIG_WFD) && defined(CONFIG_TDLS) + if(!(cap_attr & P2P_GRPCAP_INTRABSS) ) -+ ptdlsinfo->ap_prohibited = _TRUE; ++ ptdlsinfo->ap_prohibited = true; +#endif //defined(CONFIG_WFD) && defined(CONFIG_TDLS) + } + @@ -56475,7 +38487,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); + } -+ } ++ } + } + else if ( pwdinfo->intent > ( pwdinfo->peer_intent >> 1 ) ) + { @@ -56490,14 +38502,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + // Store the group id information. + _rtw_memcpy( pwdinfo->groupid_info.go_device_addr, pwdinfo->device_addr, ETH_ALEN ); -+ _rtw_memcpy( pwdinfo->groupid_info.ssid, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen ); ++ _rtw_memcpy( pwdinfo->groupid_info.ssid, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen ); + } + } + -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_LISTEN_CH, (u8 *)listen_ch_attr, (uint *) &attr_contentlen) && attr_contentlen == 5) -+ pwdinfo->nego_req_info.peer_ch = listen_ch_attr[4]; -+ -+ DBG_871X(FUNC_ADPT_FMT" listen channel :%u\n", FUNC_ADPT_ARG(padapter), pwdinfo->nego_req_info.peer_ch); + + attr_contentlen = 0; + if ( rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_INTENTED_IF_ADDR, pwdinfo->p2p_peer_interface_addr, &attr_contentlen ) ) @@ -56523,7 +38531,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) + { -+ if ( !rtw_p2p_is_channel_list_ok( pwdinfo->operating_channel, ++ if ( !rtw_p2p_is_channel_list_ok( pwdinfo->operating_channel, + ch_list_inclusioned, ch_num_inclusioned) ) + { +#ifdef CONFIG_CONCURRENT_MODE @@ -56541,11 +38549,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + attr_contentlen = 0; + + if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen) ) -+ { ++ { + peer_operating_ch = operatingch_info[4]; + } + -+ if ( rtw_p2p_is_channel_list_ok( peer_operating_ch, ++ if ( rtw_p2p_is_channel_list_ok( peer_operating_ch, + ch_list_inclusioned, ch_num_inclusioned) ) + { + /** @@ -56570,12 +38578,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); + } + -+ if (pwdinfo->ui_got_wps_info == P2P_NO_WPSINFO) { -+ result = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_INFOR_NOREADY); -+ return result; -+ } -+ +#ifdef CONFIG_WFD + // Added by Albert 20110823 + // Try to get the TCP port information when receiving the negotiation request. @@ -56610,14 +38612,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + u32 wfd_ielen = 0; +#ifdef CONFIG_TDLS + struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+#endif // CONFIG_TDLS ++#endif // CONFIG_TDLS +#endif // CONFIG_WFD + + ies = pframe + _PUBLIC_ACTION_IE_OFFSET_; + ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; + + // Be able to know which one is the P2P GO and which one is P2P client. -+ ++ + if ( rtw_get_wps_ie( ies, ies_len, NULL, &wps_ielen) ) + { + @@ -56657,16 +38659,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + //Check P2P Capability ATTR + if(rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8*)&cap_attr, (uint*)&attr_contentlen) ) + { -+ cap_attr = le16_to_cpu(cap_attr); ++ le16_to_cpup((__le16 *)&cap_attr); +#ifdef CONFIG_TDLS + if(!(cap_attr & P2P_GRPCAP_INTRABSS) ) -+ ptdlsinfo->ap_prohibited = _TRUE; ++ ptdlsinfo->ap_prohibited = true; +#endif // CONFIG_TDLS + } + + rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, &attr_content, &attr_contentlen); + if ( attr_contentlen == 1 ) -+ { ++ { + DBG_871X( "[%s] Status = %d\n", __FUNCTION__, attr_content ); + if ( attr_content == P2P_STATUS_SUCCESS ) + { @@ -56694,7 +38696,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + _rtw_memset( pwdinfo->p2p_peer_interface_addr, 0x00, ETH_ALEN ); + } + } -+ ++ + // Try to get the peer's intent and tie breaker value. + attr_content = 0x00; + attr_contentlen = 0; @@ -56724,7 +38726,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); + } -+ } ++ } + } + else if ( pwdinfo->intent > ( pwdinfo->peer_intent >> 1 ) ) + { @@ -56744,19 +38746,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Store the group id information. + _rtw_memcpy( pwdinfo->groupid_info.go_device_addr, pwdinfo->device_addr, ETH_ALEN ); + _rtw_memcpy( pwdinfo->groupid_info.ssid, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen ); -+ ++ + } + } -+ ++ + // Try to get the operation channel information -+ ++ + attr_contentlen = 0; + if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen)) + { + DBG_871X( "[%s] Peer's operating channel = %d\n", __FUNCTION__, operatingch_info[4] ); + pwdinfo->peer_operating_ch = operatingch_info[4]; + } -+ ++ + // Try to get the channel list information + if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, pwdinfo->channel_list_attr, &pwdinfo->channel_list_attr_len ) ) + { @@ -56775,7 +38777,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) + { -+ if ( !rtw_p2p_is_channel_list_ok( pwdinfo->operating_channel, ++ if ( !rtw_p2p_is_channel_list_ok( pwdinfo->operating_channel, + ch_list_inclusioned, ch_num_inclusioned) ) + { +#ifdef CONFIG_CONCURRENT_MODE @@ -56793,11 +38795,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + attr_contentlen = 0; + + if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen) ) -+ { ++ { + peer_operating_ch = operatingch_info[4]; + } + -+ if ( rtw_p2p_is_channel_list_ok( peer_operating_ch, ++ if ( rtw_p2p_is_channel_list_ok( peer_operating_ch, + ch_list_inclusioned, ch_num_inclusioned) ) + { + /** @@ -56831,11 +38833,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + _rtw_memcpy( pwdinfo->groupid_info.go_device_addr, &groupid[0], ETH_ALEN ); + _rtw_memcpy( pwdinfo->groupid_info.ssid, &groupid[6], attr_contentlen - ETH_ALEN ); + } -+ ++ + //Get the next P2P IE + p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); + } -+ ++ + } + +#ifdef CONFIG_WFD @@ -56887,7 +38889,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + if ( attr_content == P2P_STATUS_SUCCESS ) + { + u8 bcancelled = 0; -+ ++ + _cancel_timer( &pwdinfo->restore_p2p_state_timer, &bcancelled ); + + // Commented by Albert 20100911 @@ -56913,15 +38915,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); + } -+ } -+ ++ } ++ +#ifdef CONFIG_CONCURRENT_MODE + if ( check_buddy_fwstate(pwdinfo->padapter , _FW_LINKED ) ) + { + // Switch back to the AP channel soon. + _set_timer( &pwdinfo->ap_p2p_switch_timer, 100 ); + } -+#endif ++#endif + } + else + { @@ -56938,19 +38940,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + DBG_871X( "[%s] Ssid = %s, ssidlen = %zu\n", __FUNCTION__, &groupid[ETH_ALEN], strlen(&groupid[ETH_ALEN]) ); + _rtw_memcpy( pwdinfo->groupid_info.go_device_addr, &groupid[0], ETH_ALEN ); -+ _rtw_memcpy( pwdinfo->groupid_info.ssid, &groupid[6], attr_contentlen - ETH_ALEN ); ++ _rtw_memcpy( pwdinfo->groupid_info.ssid, &groupid[6], attr_contentlen - ETH_ALEN ); + } + + attr_contentlen = 0; + if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen) ) -+ { ++ { + DBG_871X( "[%s] Peer's operating channel = %d\n", __FUNCTION__, operatingch_info[4] ); + pwdinfo->peer_operating_ch = operatingch_info[4]; + } + + //Get the next P2P IE + p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); -+ ++ + } + + return( result ); @@ -56958,10 +38960,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + +u8 process_p2p_presence_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) +{ -+ u8 *frame_body; ++ u8 *frame_body; + u8 dialogToken=0; + u8 status = P2P_STATUS_SUCCESS; -+ ++ + frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); + + dialogToken = frame_body[6]; @@ -56970,41 +38972,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + issue_p2p_presence_resp(pwdinfo, GetAddr2Ptr(pframe), status, dialogToken); + -+ return _TRUE; ++ return true; +} + -+void find_phase_handler( _adapter* padapter ) ++static void find_phase_handler( _adapter* padapter ) +{ + struct wifidirect_info *pwdinfo = &padapter->wdinfo; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ NDIS_802_11_SSID ssid; ++ NDIS_802_11_SSID ssid; + _irqL irqL; + u8 _status = 0; + -+_func_enter_; ++ + + _rtw_memset((unsigned char*)&ssid, 0, sizeof(NDIS_802_11_SSID)); + _rtw_memcpy(ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN ); + ssid.SsidLength = P2P_WILDCARD_SSID_LEN; + + rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ ++ + _enter_critical_bh(&pmlmepriv->lock, &irqL); + _status = rtw_sitesurvey_cmd(padapter, &ssid, 1, NULL, 0); + _exit_critical_bh(&pmlmepriv->lock, &irqL); + + -+_func_exit_; ++ +} + +void p2p_concurrent_handler( _adapter* padapter ); + -+void restore_p2p_state_handler( _adapter* padapter ) ++static void restore_p2p_state_handler( _adapter* padapter ) +{ + struct wifidirect_info *pwdinfo = &padapter->wdinfo; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + -+_func_enter_; ++ + + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL)) + { @@ -57016,19 +39018,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + _adapter *pbuddy_adapter = padapter->pbuddy_adapter; + struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ ++ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; ++ + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_RSP)) + { + set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ ++ + issue_nulldata(pbuddy_adapter, NULL, 0, 3, 500); + } + } +#endif + + rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ ++ + if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE)) + { +#ifdef CONFIG_CONCURRENT_MODE @@ -57039,67 +39041,65 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + set_channel_bwmode( padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); +#endif + } -+_func_exit_; ++ +} + -+void pre_tx_invitereq_handler( _adapter* padapter ) ++static void pre_tx_invitereq_handler( _adapter* padapter ) +{ + struct wifidirect_info *pwdinfo = &padapter->wdinfo; + u8 val8 = 1; -+_func_enter_; ++ + + set_channel_bwmode(padapter, pwdinfo->invitereq_info.peer_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); + issue_probereq_p2p(padapter, NULL); + _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ -+_func_exit_; ++ ++ +} + -+void pre_tx_provdisc_handler( _adapter* padapter ) ++static void pre_tx_provdisc_handler( _adapter* padapter ) +{ + struct wifidirect_info *pwdinfo = &padapter->wdinfo; + u8 val8 = 1; -+_func_enter_; ++ + + set_channel_bwmode(padapter, pwdinfo->tx_prov_disc_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); + rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); + issue_probereq_p2p(padapter, NULL); + _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ -+_func_exit_; ++ ++ +} + -+void pre_tx_negoreq_handler( _adapter* padapter ) ++static void pre_tx_negoreq_handler( _adapter* padapter ) +{ + struct wifidirect_info *pwdinfo = &padapter->wdinfo; + u8 val8 = 1; -+_func_enter_; ++ + + set_channel_bwmode(padapter, pwdinfo->nego_req_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); + issue_probereq_p2p(padapter, NULL); + _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ -+_func_exit_; ++ ++ +} + +#ifdef CONFIG_CONCURRENT_MODE +void p2p_concurrent_handler( _adapter* padapter ) +{ + struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + //_adapter *pbuddy_adapter = padapter->pbuddy_adapter; + //struct wifidirect_info *pbuddy_wdinfo = &pbuddy_adapter->wdinfo; + //struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; + //struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; + u8 val8; -+_func_enter_; ++ + + if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) + { -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; + struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; + + pwdinfo->operating_channel = pbuddy_mlmeext->cur_channel; @@ -57110,8 +39110,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); + -+ if (check_buddy_fwstate(padapter, WIFI_FW_STATION_STATE)) -+ issue_nulldata(pbuddy_adapter, NULL, 0, 3, 500); ++ issue_nulldata(pbuddy_adapter, NULL, 0, 3, 500); + } + else if( pwdinfo->driver_interface == DRIVER_WEXT ) + { @@ -57131,19 +39130,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + } + + rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); -+ if(!check_buddy_mlmeinfo_state(padapter, WIFI_FW_AP_STATE) && -+ ((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE)) -+ { -+ val8 = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ } ++ val8 = 1; ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); ++ + // Todo: To check the value of pwdinfo->ext_listen_period is equal to 0 or not. + _set_timer( &pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_period ); + } + } -+ else if ( rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) || ++ else if ( rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) || + rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL) || -+ ( rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) && pwdinfo->nego_req_info.benable == _FALSE ) || ++ ( rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) && pwdinfo->nego_req_info.benable == false ) || + rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ) ) + { + // Now, the driver is in the listen state of P2P mode. @@ -57156,11 +39152,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + if ( pbuddy_mlmeext->cur_channel != pwdinfo->listen_channel ) + { + set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ if (!check_buddy_mlmeinfo_state(padapter, WIFI_FW_AP_STATE) && ((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE)) -+ { -+ val8 = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ } ++ val8 = 0; ++ padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); + rtw_p2p_set_state(pwdinfo, P2P_STATE_IDLE); + issue_nulldata(pbuddy_adapter, NULL, 0, 3, 500); + } @@ -57184,15 +39177,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + issue_probereq_p2p(padapter, NULL); + _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); + } -+ else if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) && pwdinfo->nego_req_info.benable == _TRUE) ++ else if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) && pwdinfo->nego_req_info.benable == true) + { + val8 = 1; + set_channel_bwmode(padapter, pwdinfo->nego_req_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); + rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); + issue_probereq_p2p(padapter, NULL); + _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ } -+ else if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ ) && pwdinfo->invitereq_info.benable == _TRUE) ++ } ++ else if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ ) && pwdinfo->invitereq_info.benable == true) + { + /* + val8 = 1; @@ -57206,10 +39199,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + } + else + { -+ set_channel_bwmode( padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ set_channel_bwmode( padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); + } + -+_func_exit_; ++ +} +#endif + @@ -57218,61 +39211,59 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ +{ + struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; + struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u8 ch, bw, offset; -+_func_enter_; + -+ if (rtw_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ } -+ else if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->listen_channel) { -+ ch = pwdinfo->listen_channel; -+ bw = CHANNEL_WIDTH_20; -+ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" back to listen ch - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ } -+ else { -+ ch = pcfg80211_wdinfo->restore_channel; -+ bw = CHANNEL_WIDTH_20; -+ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" back to restore ch - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ } + -+ set_channel_bwmode(padapter, ch, offset, bw); ++ { + -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); ++#ifdef CONFIG_CONCURRENT_MODE ++ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) ++ { ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; ++ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; ++ ++ DBG_871X("%s, switch ch back to buddy's cur_channel=%d\n", __func__, pbuddy_mlmeext->cur_channel); ++ ++ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); ++ ++ pmlmeext->cur_channel = pbuddy_mlmeext->cur_channel; ++ ++ }else ++#endif //CONFIG_CONCURRENT_MODE ++ if( pcfg80211_wdinfo->restore_channel != pmlmeext->cur_channel ) ++ { ++ if ( !check_fwstate(&padapter->mlmepriv, _FW_LINKED ) ) ++ pmlmeext->cur_channel = pcfg80211_wdinfo->restore_channel; ++ ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ } ++ ++ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); +#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); ++ DBG_871X("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); +#endif ++ } + -+ pcfg80211_wdinfo->is_ro_ch = _FALSE; -+ pcfg80211_wdinfo->last_ro_ch_time = rtw_get_current_time(); ++ pcfg80211_wdinfo->is_ro_ch = false; + -+ DBG_871X("cfg80211_remain_on_channel_expired cookie:0x%llx, ch=%d, bw=%d, offset=%d\n" -+ , pcfg80211_wdinfo->remain_on_ch_cookie -+ , rtw_get_oper_ch(padapter), rtw_get_oper_bw(padapter), rtw_get_oper_choffset(padapter)); ++ DBG_871X("cfg80211_remain_on_channel_expired\n"); + -+ rtw_cfg80211_remain_on_channel_expired(padapter, -+ pcfg80211_wdinfo->remain_on_ch_cookie, ++ rtw_cfg80211_remain_on_channel_expired(padapter, ++ pcfg80211_wdinfo->remain_on_ch_cookie, + &pcfg80211_wdinfo->remain_on_ch_channel, + pcfg80211_wdinfo->remain_on_ch_type, GFP_KERNEL); + -+_func_exit_; ++ +} + +static void ro_ch_timer_process (void *FunctionContext) +{ + _adapter *adapter = (_adapter *)FunctionContext; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); ++ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(adapter->rtw_wdev); + + //printk("%s \n", __FUNCTION__); -+ ++ +#ifdef CONFIG_CONCURRENT_MODE + ATOMIC_SET(&pwdev_priv->ro_ch_to, 1); +#endif @@ -57332,7 +39323,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + u8 *pattr_temp = pattr + 3 ; + + attr_contentlen -= 3; -+ ++ + while (attr_contentlen>0) { + num_of_ch = *(pattr_temp+1); + @@ -57351,7 +39342,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + +static bool rtw_chk_p2pie_ch_list_with_buddy(_adapter *padapter, const u8 *frame_body, u32 len) +{ -+ bool fit = _FALSE; ++ bool fit = false; +#ifdef CONFIG_CONCURRENT_MODE + u8 *ies, *p2p_ie; + u32 ies_len, p2p_ielen; @@ -57382,7 +39373,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + for(i=0; ipbuddy_adapter; ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; + struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; + + ies = (u8*)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); + ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ ++ + p2p_ie = rtw_get_p2p_ie( ies, ies_len, NULL, &p2p_ielen ); + + while ( p2p_ie ) -+ { ++ { + u32 attr_contentlen = 0; + u8 *pattr = NULL; -+ ++ + //Check P2P_ATTR_CH_LIST + if((pattr=rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, (uint*)&attr_contentlen))!=NULL) + { @@ -57462,17 +39451,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + u8 *pattr_temp = pattr + 3 ; + + attr_contentlen -= 3; -+ ++ + while(attr_contentlen>0) -+ { ++ { + num_of_ch = *(pattr_temp+1); -+ ++ + for(i=0; icur_channel;//forcing to the same channel + + pattr_temp += (2+num_of_ch); + attr_contentlen -= (2+num_of_ch); -+ } ++ } + } + + //Check P2P_ATTR_OPERATING_CH @@ -57480,12 +39469,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + pattr = NULL; + if((pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, (uint*)&attr_contentlen))!=NULL) + { -+ *(pattr+4) = pbuddy_mlmeext->cur_channel;//forcing to the same channel ++ *(pattr+4) = pbuddy_mlmeext->cur_channel;//forcing to the same channel + } + + //Get the next P2P IE + p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); -+ ++ + } + +#endif @@ -57497,16 +39486,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + unsigned char *frame_body; + u8 category, action, OUI_Subtype, dialogToken=0; + u32 wfdielen = 0; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ -+ frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); ++ ++ frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); + category = frame_body[0]; + + if(category == RTW_WLAN_CATEGORY_PUBLIC) + { + action = frame_body[1]; + if (action == ACT_PUBLIC_VENDOR -+ && _rtw_memcmp(frame_body+2, P2P_OUI, 4) == _TRUE ++ && _rtw_memcmp(frame_body+2, P2P_OUI, 4) == true + ) + { + OUI_Subtype = frame_body[6]; @@ -57562,12 +39551,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + } + default: + -+ break; ++ break; + } + + } -+ -+ } ++ ++ } + else if(category == RTW_WLAN_CATEGORY_P2P) + { + OUI_Subtype = frame_body[5]; @@ -57582,26 +39571,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + case P2P_NOTICE_OF_ABSENCE: + -+ break; ++ break; + case P2P_PRESENCE_REQUEST: + -+ break; ++ break; + case P2P_PRESENCE_RESPONSE: + -+ break; ++ break; + case P2P_GO_DISC_REQUEST: + -+ break; ++ break; + default: + -+ break; -+ } ++ break; ++ } + -+ } -+ else ++ } ++ else + { + DBG_871X("%s, action frame category=%d\n", __func__, category); -+ //is_p2p_frame = (-1); ++ //is_p2p_frame = (-1); + } + + return; @@ -57615,7 +39604,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + int w_sz = 0; + u8 ch_cnt = 0; + u8 ch_list[40]; -+ bool continuous = _FALSE; ++ bool continuous = false; + + if ((pattr=rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, &attr_contentlen))!=NULL) { + int i, j; @@ -57643,6 +39632,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + attr_contentlen -= (2+num_of_ch); + } + ++ + for (j=0;j>1 == resp >>1) -+ return req&0x01 ? _TRUE : _FALSE; -+ else if (req>>1 > resp>>1) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ +int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx) +{ + int is_p2p_frame = (-1); @@ -57678,21 +39655,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + u8 category, action, OUI_Subtype, dialogToken=0; + u8 *p2p_ie = NULL; + uint p2p_ielen = 0; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); ++ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); + int status = -1; + u8 ch_list_buf[128] = {'\0'}; + int op_ch = -1; -+ int listen_ch = -1; + u8 intent = 0; -+ -+ frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ ++ frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); + category = frame_body[0]; + //just for check + if(category == RTW_WLAN_CATEGORY_PUBLIC) + { + action = frame_body[1]; + if (action == ACT_PUBLIC_VENDOR -+ && _rtw_memcmp(frame_body+2, P2P_OUI, 4) == _TRUE ++ && _rtw_memcmp(frame_body+2, P2P_OUI, 4) == true + ) + { + OUI_Subtype = frame_body[6]; @@ -57713,18 +39689,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + u8 *cont; + uint cont_len; + case P2P_GO_NEGO_REQ: -+ { -+ struct rtw_wdev_nego_info* nego_info = &pwdev_priv->nego_info; -+ + if (tx) { + #ifdef CONFIG_DRV_ISSUE_PROV_REQ // IOT FOR S2 -+ if(pwdev_priv->provdisc_req_issued == _FALSE) ++ if(pwdev_priv->provdisc_req_issued == false) + rtw_cfg80211_issue_p2p_provision_request(padapter, buf, len); + #endif //CONFIG_DRV_ISSUE_PROV_REQ + -+ //pwdev_priv->provdisc_req_issued = _FALSE; ++ //pwdev_priv->provdisc_req_issued = false; + -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ #ifdef CONFIG_CONCURRENT_MODE + if(check_buddy_fwstate(padapter, _FW_LINKED)) + rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)); + #endif @@ -57732,30 +39705,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len))) + op_ch = *(cont+4); -+ if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_LISTEN_CH, NULL, &cont_len))) -+ listen_ch = *(cont+4); + if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GO_INTENT, NULL, &cont_len))) + intent = *cont; -+ -+ if (nego_info->token != dialogToken) -+ rtw_wdev_nego_info_init(nego_info); -+ -+ _rtw_memcpy(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN); -+ nego_info->active = tx ? 1 : 0; -+ nego_info->token = dialogToken; -+ nego_info->req_op_ch = op_ch; -+ nego_info->req_listen_ch = listen_ch; -+ nego_info->req_intent = intent; -+ nego_info->state = 0; -+ + dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); -+ DBG_871X("RTW_%s:P2P_GO_NEGO_REQ, dialogToken=%d, intent:%u%s, listen_ch:%d, op_ch:%d, ch_list:%s\n", -+ (tx==_TRUE)?"Tx":"Rx", dialogToken, (intent>>1), intent&0x1 ? "+" : "-", listen_ch, op_ch, ch_list_buf); ++ DBG_871X("RTW_%s:P2P_GO_NEGO_REQ, dialogToken=%d, intent:%u%s, op_ch:%d, ch_list:%s\n", ++ (tx==true)?"Tx":"Rx", dialogToken, (intent>>1), intent&0x1 ? "+" : "-", op_ch, ch_list_buf); + + if (!tx) { -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ #ifdef CONFIG_CONCURRENT_MODE + if(check_buddy_fwstate(padapter, _FW_LINKED) -+ && rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE) ++ && rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)) == false) + { + DBG_871X(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); + rtw_change_p2pie_ch_list(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr), 0); @@ -57764,13 +39723,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + } + + break; -+ } + case P2P_GO_NEGO_RESP: -+ { -+ struct rtw_wdev_nego_info* nego_info = &pwdev_priv->nego_info; -+ + if (tx) { -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ #ifdef CONFIG_CONCURRENT_MODE + if(check_buddy_fwstate(padapter, _FW_LINKED)) + rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)); + #endif @@ -57782,27 +39737,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + intent = *cont; + if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len))) + status = *cont; -+ -+ if (nego_info->token == dialogToken && nego_info->state == 0 -+ && _rtw_memcmp(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN) == _TRUE -+ ) { -+ nego_info->status = (status==-1) ? 0xff : status; -+ nego_info->rsp_op_ch= op_ch; -+ nego_info->rsp_intent = intent; -+ nego_info->state = 1; -+ if (status != 0) -+ nego_info->token = 0; /* init */ -+ } -+ + dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); + DBG_871X("RTW_%s:P2P_GO_NEGO_RESP, dialogToken=%d, intent:%u%s, status:%d, op_ch:%d, ch_list:%s\n", -+ (tx==_TRUE)?"Tx":"Rx", dialogToken, (intent>>1), intent&0x1 ? "+" : "-", status, op_ch, ch_list_buf); ++ (tx==true)?"Tx":"Rx", dialogToken, (intent>>1), intent&0x1 ? "+" : "-", status, op_ch, ch_list_buf); + + if (!tx) { -+ pwdev_priv->provdisc_req_issued = _FALSE; -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ pwdev_priv->provdisc_req_issued = false; ++ #ifdef CONFIG_CONCURRENT_MODE + if(check_buddy_fwstate(padapter, _FW_LINKED) -+ && rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE) ++ && rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)) == false) + { + DBG_871X(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); + rtw_change_p2pie_ch_list(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr), 0); @@ -57811,14 +39754,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + } + + break; -+ } + case P2P_GO_NEGO_CONF: -+ { -+ struct rtw_wdev_nego_info* nego_info = &pwdev_priv->nego_info; -+ bool is_go = _FALSE; -+ + if (tx) { -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ #ifdef CONFIG_CONCURRENT_MODE + if(check_buddy_fwstate(padapter, _FW_LINKED)) + rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)); + #endif @@ -57828,38 +39766,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + op_ch = *(cont+4); + if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len))) + status = *cont; -+ -+ if (nego_info->token == dialogToken && nego_info->state == 1 -+ && _rtw_memcmp(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN) == _TRUE -+ ) { -+ nego_info->status = (status==-1) ? 0xff : status; -+ nego_info->conf_op_ch = (op_ch==-1) ? 0 : op_ch; -+ nego_info->state = 2; -+ -+ if (status == 0) { -+ if (rtw_p2p_nego_intent_compare(nego_info->req_intent, nego_info->rsp_intent) ^ !tx) -+ is_go = _TRUE; -+ } -+ -+ nego_info->token = 0; /* init */ -+ } -+ + dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); + DBG_871X("RTW_%s:P2P_GO_NEGO_CONF, dialogToken=%d, status:%d, op_ch:%d, ch_list:%s\n", -+ (tx==_TRUE)?"Tx":"Rx", dialogToken, status, op_ch, ch_list_buf); ++ (tx==true)?"Tx":"Rx", dialogToken, status, op_ch, ch_list_buf); + + if (!tx) { + } + + break; -+ } + case P2P_INVIT_REQ: + { + struct rtw_wdev_invit_info* invit_info = &pwdev_priv->invit_info; + int flags = -1; + + if (tx) { -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ #ifdef CONFIG_CONCURRENT_MODE + if(check_buddy_fwstate(padapter, _FW_LINKED)) + rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)); + #endif @@ -57873,27 +39794,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + if (invit_info->token != dialogToken) + rtw_wdev_invit_info_init(invit_info); + -+ _rtw_memcpy(invit_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN); -+ invit_info->active = tx ? 1 : 0; + invit_info->token = dialogToken; + invit_info->flags = (flags==-1) ? 0x0 : flags; + invit_info->req_op_ch= op_ch; -+ invit_info->state = 0; + + dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); + DBG_871X("RTW_%s:P2P_INVIT_REQ, dialogToken=%d, flags:0x%02x, op_ch:%d, ch_list:%s\n", -+ (tx==_TRUE)?"Tx":"Rx", dialogToken, flags, op_ch, ch_list_buf); ++ (tx==true)?"Tx":"Rx", dialogToken, flags, op_ch, ch_list_buf); + + if (!tx) { -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) -+ if(check_buddy_fwstate(padapter, _FW_LINKED)) { -+ if (op_ch != -1 && rtw_chk_p2pie_op_ch_with_buddy(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE) { -+ DBG_871X(FUNC_ADPT_FMT" op_ch:%u has no intersect with buddy\n", FUNC_ADPT_ARG(padapter), op_ch); -+ rtw_change_p2pie_ch_list(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr), 0); -+ } else if (rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE) { -+ DBG_871X(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); -+ rtw_change_p2pie_ch_list(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr), 0); -+ } ++ #ifdef CONFIG_CONCURRENT_MODE ++ if(check_buddy_fwstate(padapter, _FW_LINKED) ++ && rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)) == false) ++ { ++ DBG_871X(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); ++ rtw_change_p2pie_ch_list(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr), 0); + } + #endif + } @@ -57905,38 +39820,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + struct rtw_wdev_invit_info* invit_info = &pwdev_priv->invit_info; + + if (tx) { -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) ++ #ifdef CONFIG_CONCURRENT_MODE + if(check_buddy_fwstate(padapter, _FW_LINKED)) + rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)); + #endif + } + + if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len))) -+ { -+#ifdef CONFIG_P2P_INVITE_IOT -+ if(tx && *cont==7) -+ { -+ DBG_871X("TX_P2P_INVITE_RESP, status is no common channel, change to unknown group\n"); -+ *cont = 8; //unknow group status -+ } -+#endif //CONFIG_P2P_INVITE_IOT + status = *cont; -+ } + if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len))) + op_ch = *(cont+4); + -+ if (invit_info->token == dialogToken && invit_info->state == 0 -+ && _rtw_memcmp(invit_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN) == _TRUE -+ ) { ++ if (invit_info->token != dialogToken) { ++ rtw_wdev_invit_info_init(invit_info); ++ } else { ++ invit_info->token = 0; + invit_info->status = (status==-1) ? 0xff : status; + invit_info->rsp_op_ch= op_ch; -+ invit_info->state = 1; -+ invit_info->token = 0; /* init */ + } + + dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); + DBG_871X("RTW_%s:P2P_INVIT_RESP, dialogToken=%d, status:%d, op_ch:%d, ch_list:%s\n", -+ (tx==_TRUE)?"Tx":"Rx", dialogToken, status, op_ch, ch_list_buf); ++ (tx==true)?"Tx":"Rx", dialogToken, status, op_ch, ch_list_buf); + + if (!tx) { + } @@ -57944,11 +39849,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + break; + } + case P2P_DEVDISC_REQ: -+ DBG_871X("RTW_%s:P2P_DEVDISC_REQ, dialogToken=%d\n", (tx==_TRUE)?"Tx":"Rx", dialogToken); ++ DBG_871X("RTW_%s:P2P_DEVDISC_REQ, dialogToken=%d\n", (tx==true)?"Tx":"Rx", dialogToken); + break; + case P2P_DEVDISC_RESP: + cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len); -+ DBG_871X("RTW_%s:P2P_DEVDISC_RESP, dialogToken=%d, status:%d\n", (tx==_TRUE)?"Tx":"Rx", dialogToken, cont?*cont:-1); ++ DBG_871X("RTW_%s:P2P_DEVDISC_RESP, dialogToken=%d, status:%d\n", (tx==true)?"Tx":"Rx", dialogToken, cont?*cont:-1); + break; + case P2P_PROVISION_DISC_REQ: + { @@ -57956,43 +39861,43 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + u8 *p2p_ie; + uint p2p_ielen = 0; + uint contentlen = 0; -+ -+ DBG_871X("RTW_%s:P2P_PROVISION_DISC_REQ, dialogToken=%d\n", (tx==_TRUE)?"Tx":"Rx", dialogToken); ++ ++ DBG_871X("RTW_%s:P2P_PROVISION_DISC_REQ, dialogToken=%d\n", (tx==true)?"Tx":"Rx", dialogToken); + + //if(tx) + { -+ pwdev_priv->provdisc_req_issued = _FALSE; -+ ++ pwdev_priv->provdisc_req_issued = false; ++ + if( (p2p_ie=rtw_get_p2p_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen))) -+ { ++ { + + if(rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, NULL, &contentlen)) + { -+ pwdev_priv->provdisc_req_issued = _FALSE;//case: p2p_client join p2p GO ++ pwdev_priv->provdisc_req_issued = false;//case: p2p_client join p2p GO + } + else + { + #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("provdisc_req_issued is _TRUE\n"); ++ DBG_871X("provdisc_req_issued is true\n"); + #endif //CONFIG_DEBUG_CFG80211 -+ pwdev_priv->provdisc_req_issued = _TRUE;//case: p2p_devices connection before Nego req. ++ pwdev_priv->provdisc_req_issued = true;//case: p2p_devices connection before Nego req. + } -+ -+ } -+ } -+ } ++ ++ } ++ } ++ } + break; + case P2P_PROVISION_DISC_RESP: -+ DBG_871X("RTW_%s:P2P_PROVISION_DISC_RESP, dialogToken=%d\n", (tx==_TRUE)?"Tx":"Rx", dialogToken); ++ DBG_871X("RTW_%s:P2P_PROVISION_DISC_RESP, dialogToken=%d\n", (tx==true)?"Tx":"Rx", dialogToken); + break; + default: -+ DBG_871X("RTW_%s:OUI_Subtype=%d, dialogToken=%d\n", (tx==_TRUE)?"Tx":"Rx", OUI_Subtype, dialogToken); -+ break; ++ DBG_871X("RTW_%s:OUI_Subtype=%d, dialogToken=%d\n", (tx==true)?"Tx":"Rx", OUI_Subtype, dialogToken); ++ break; + } + + } -+ -+ } ++ ++ } + else if(category == RTW_WLAN_CATEGORY_P2P) + { + OUI_Subtype = frame_body[5]; @@ -58008,26 +39913,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + switch(OUI_Subtype) + { + case P2P_NOTICE_OF_ABSENCE: -+ DBG_871X("RTW_%s:P2P_NOTICE_OF_ABSENCE, dialogToken=%d\n", (tx==_TRUE)?"TX":"RX", dialogToken); -+ break; ++ DBG_871X("RTW_%s:P2P_NOTICE_OF_ABSENCE, dialogToken=%d\n", (tx==true)?"TX":"RX", dialogToken); ++ break; + case P2P_PRESENCE_REQUEST: -+ DBG_871X("RTW_%s:P2P_PRESENCE_REQUEST, dialogToken=%d\n", (tx==_TRUE)?"TX":"RX", dialogToken); -+ break; ++ DBG_871X("RTW_%s:P2P_PRESENCE_REQUEST, dialogToken=%d\n", (tx==true)?"TX":"RX", dialogToken); ++ break; + case P2P_PRESENCE_RESPONSE: -+ DBG_871X("RTW_%s:P2P_PRESENCE_RESPONSE, dialogToken=%d\n", (tx==_TRUE)?"TX":"RX", dialogToken); -+ break; ++ DBG_871X("RTW_%s:P2P_PRESENCE_RESPONSE, dialogToken=%d\n", (tx==true)?"TX":"RX", dialogToken); ++ break; + case P2P_GO_DISC_REQUEST: -+ DBG_871X("RTW_%s:P2P_GO_DISC_REQUEST, dialogToken=%d\n", (tx==_TRUE)?"TX":"RX", dialogToken); -+ break; ++ DBG_871X("RTW_%s:P2P_GO_DISC_REQUEST, dialogToken=%d\n", (tx==true)?"TX":"RX", dialogToken); ++ break; + default: -+ DBG_871X("RTW_%s:OUI_Subtype=%d, dialogToken=%d\n", (tx==_TRUE)?"TX":"RX", OUI_Subtype, dialogToken); -+ break; -+ } ++ DBG_871X("RTW_%s:OUI_Subtype=%d, dialogToken=%d\n", (tx==true)?"TX":"RX", OUI_Subtype, dialogToken); ++ break; ++ } + -+ } ++ } + else + { -+ DBG_871X("RTW_%s:action frame category=%d\n", (tx==_TRUE)?"TX":"RX", category); ++ DBG_871X("RTW_%s:action frame category=%d\n", (tx==true)?"TX":"RX", category); ++ //is_p2p_frame = (-1); + } + + return is_p2p_frame; @@ -58038,16 +39944,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; + + _rtw_memset(pcfg80211_wdinfo, 0x00, sizeof(struct cfg80211_wifidirect_info) ); -+ ++ + _init_timer( &pcfg80211_wdinfo->remain_on_ch_timer, padapter->pnetdev, ro_ch_timer_process, padapter ); +} -+#endif //CONFIG_IOCTL_CFG80211 ++#endif //CONFIG_IOCTL_CFG80211 + +void p2p_protocol_wk_hdl(_adapter *padapter, int intCmdType) +{ + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ -+_func_enter_; ++ ++ + + switch(intCmdType) + { @@ -58088,7 +39994,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + pre_tx_invitereq_handler( padapter ); + } -+#else ++#else + pre_tx_invitereq_handler( padapter ); +#endif + break; @@ -58104,7 +40010,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + pre_tx_negoreq_handler( padapter ); + } -+#else ++#else + pre_tx_negoreq_handler( padapter ); +#endif + break; @@ -58115,7 +40021,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + p2p_concurrent_handler( padapter ); + break; -+ } ++ } +#endif +#endif +#ifdef CONFIG_IOCTL_CFG80211 @@ -58123,52 +40029,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + ro_ch_handler( padapter ); + break; -+ } -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ } -+ -+_func_exit_; -+} -+ -+int process_p2p_cross_connect_ie(PADAPTER padapter, u8 *IEs, u32 IELength) -+{ -+ int ret = _TRUE; -+ u8 * ies; -+ u32 ies_len; -+ u8 * p2p_ie; -+ u32 p2p_ielen = 0; -+ u8 p2p_attr[MAX_P2P_IE_LEN] = { 0x00 };// NoA length should be n*(13) + 2 -+ u32 attr_contentlen = 0; -+ -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ -+_func_enter_; -+ -+ if(IELength <= _BEACON_IE_OFFSET_) -+ return ret; -+ -+ ies = IEs + _BEACON_IE_OFFSET_; -+ ies_len = IELength - _BEACON_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie( ies, ies_len, NULL, &p2p_ielen); -+ -+ while(p2p_ie) -+ { -+ // Get P2P Manageability IE. -+ if(rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_MANAGEABILITY, p2p_attr, &attr_contentlen)) -+ { -+ if ((p2p_attr[0]&(BIT(0)|BIT(1))) == 0x01) { -+ ret = _FALSE; -+ } -+ break; + } -+ //Get the next P2P IE -+ p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); ++#endif //CONFIG_IOCTL_CFG80211 ++ + } + -+_func_exit_; -+ return ret; ++ +} + +#ifdef CONFIG_P2P_PS @@ -58180,36 +40046,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + u32 p2p_ielen = 0; + u8 noa_attr[MAX_P2P_IE_LEN] = { 0x00 };// NoA length should be n*(13) + 2 + u32 attr_contentlen = 0; -+ ++ + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ u8 find_p2p = _FALSE, find_p2p_ps = _FALSE; ++ u8 find_p2p = false, find_p2p_ps = false; + u8 noa_offset, noa_num, noa_index; + -+_func_enter_; ++ + + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) + { + return; + } +#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->iface_type != IFACE_PORT0) ++ if(padapter->iface_type != IFACE_PORT0) + return; +#endif + if(IELength <= _BEACON_IE_OFFSET_) + return; -+ ++ + ies = IEs + _BEACON_IE_OFFSET_; + ies_len = IELength - _BEACON_IE_OFFSET_; + + p2p_ie = rtw_get_p2p_ie( ies, ies_len, NULL, &p2p_ielen); -+ ++ + while(p2p_ie) + { -+ find_p2p = _TRUE; ++ find_p2p = true; + // Get Notice of Absence IE. + if(rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_NOA, noa_attr, &attr_contentlen)) + { -+ find_p2p_ps = _TRUE; ++ find_p2p_ps = true; + noa_index = noa_attr[0]; + + if( (pwdinfo->p2p_ps_mode == P2P_PS_NONE) || @@ -58248,7 +40114,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + pwdinfo->p2p_ps_mode = P2P_PS_CTWINDOW; + // driver should wait LPS for entering CTWindow -+ if(adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) ++ if(padapter->pwrctrlpriv.bFwCurrentInPSMode == true) + { + p2p_ps_wk_cmd(padapter, P2P_PS_ENABLE, 1); + } @@ -58272,30 +40138,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + } + -+ if(find_p2p == _TRUE) ++ if(find_p2p == true) + { -+ if( (pwdinfo->p2p_ps_mode > P2P_PS_NONE) && (find_p2p_ps == _FALSE) ) ++ if( (pwdinfo->p2p_ps_mode > P2P_PS_NONE) && (find_p2p_ps == false) ) + { + p2p_ps_wk_cmd(padapter, P2P_PS_DISABLE, 1); + } + } + -+_func_exit_; ++ +} + +void p2p_ps_wk_hdl(_adapter *padapter, u8 p2p_ps_state) +{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ -+_func_enter_; ++ ++ + + // Pre action for p2p state + switch(p2p_ps_state) + { + case P2P_PS_DISABLE: + pwdinfo->p2p_ps_state = p2p_ps_state; -+ ++ + rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_P2P_PS_OFFLOAD, (u8 *)(&p2p_ps_state)); + + pwdinfo->noa_index = 0; @@ -58303,26 +40169,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + pwdinfo->opp_ps = 0; + pwdinfo->noa_num = 0; + pwdinfo->p2p_ps_mode = P2P_PS_NONE; -+ if(pwrpriv->bFwCurrentInPSMode == _TRUE) ++ if(padapter->pwrctrlpriv.bFwCurrentInPSMode == true) + { + if(pwrpriv->smart_ps == 0) + { + pwrpriv->smart_ps = 2; -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&(pwrpriv->pwr_mode))); ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&(padapter->pwrctrlpriv.pwr_mode))); + } + } + break; + case P2P_PS_ENABLE: + if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) { + pwdinfo->p2p_ps_state = p2p_ps_state; -+ ++ + if( pwdinfo->ctwindow > 0 ) + { + if(pwrpriv->smart_ps != 0) + { + pwrpriv->smart_ps = 0; + DBG_871X("%s(): Enter CTW, change SmartPS\n", __FUNCTION__); -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&(pwrpriv->pwr_mode))); ++ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&(padapter->pwrctrlpriv.pwr_mode))); + } + } + rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_P2P_PS_OFFLOAD, (u8 *)(&p2p_ps_state)); @@ -58340,7 +40206,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + break; + } + -+_func_exit_; ++ +} + +u8 p2p_ps_wk_cmd(_adapter*padapter, u8 p2p_ps_state, u8 enqueue) @@ -58350,12 +40216,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + u8 res = _SUCCESS; -+ -+_func_enter_; + -+ if ( rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) ++ ++ ++ if ( rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) +#ifdef CONFIG_CONCURRENT_MODE -+ || (padapter->iface_type != IFACE_PORT0) ++ || (padapter->iface_type != IFACE_PORT0) +#endif + ) + { @@ -58364,13 +40230,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + if(enqueue) + { -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); ++ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); + if(ph2c==NULL){ + res= _FAIL; + goto exit; + } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); ++ ++ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if(pdrvextra_cmd_parm==NULL){ + rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); + res= _FAIL; @@ -58378,8 +40244,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + } + + pdrvextra_cmd_parm->ec_id = P2P_PS_WK_CID; -+ pdrvextra_cmd_parm->type = p2p_ps_state; -+ pdrvextra_cmd_parm->size = 0; ++ pdrvextra_cmd_parm->type_size = p2p_ps_state; + pdrvextra_cmd_parm->pbuf = NULL; + + init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); @@ -58390,19 +40255,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + p2p_ps_wk_hdl(padapter, p2p_ps_state); + } -+ ++ +exit: -+ -+_func_exit_; ++ ++ + + return res; + +} +#endif // CONFIG_P2P_PS + ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) +static void reset_ch_sitesurvey_timer_process (void *FunctionContext) ++#else ++static void reset_ch_sitesurvey_timer_process(struct timer_list *t) ++#endif +{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _adapter *adapter = (_adapter *)FunctionContext; ++#else ++ _adapter *adapter = from_timer(adapter, t, wdinfo.reset_ch_sitesurvey); ++#endif + struct wifidirect_info *pwdinfo = &adapter->wdinfo; + + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) @@ -58411,17 +40284,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + DBG_871X( "[%s] In\n", __FUNCTION__ ); + // Reset the operation channel information + pwdinfo->rx_invitereq_info.operation_ch[0] = 0; -+#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->rx_invitereq_info.operation_ch[1] = 0; -+ pwdinfo->rx_invitereq_info.operation_ch[2] = 0; -+ pwdinfo->rx_invitereq_info.operation_ch[3] = 0; -+#endif //CONFIG_P2P_OP_CHK_SOCIAL_CH + pwdinfo->rx_invitereq_info.scan_op_ch_only = 0; +} + -+static void reset_ch_sitesurvey_timer_process2 (void *FunctionContext) ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++static void reset_ch_sitesurvey_timer_process2(void *FunctionContext) ++#else ++static void reset_ch_sitesurvey_timer_process2(struct timer_list *t) ++#endif +{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _adapter *adapter = (_adapter *)FunctionContext; ++#else ++ _adapter *adapter = from_timer(adapter, t, wdinfo.reset_ch_sitesurvey2); ++#endif + struct wifidirect_info *pwdinfo = &adapter->wdinfo; + + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) @@ -58430,58 +40306,69 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + DBG_871X( "[%s] In\n", __FUNCTION__ ); + // Reset the operation channel information + pwdinfo->p2p_info.operation_ch[0] = 0; -+#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->p2p_info.operation_ch[1] = 0; -+ pwdinfo->p2p_info.operation_ch[2] = 0; -+ pwdinfo->p2p_info.operation_ch[3] = 0; -+#endif //CONFIG_P2P_OP_CHK_SOCIAL_CH + pwdinfo->p2p_info.scan_op_ch_only = 0; +} + ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) +static void restore_p2p_state_timer_process (void *FunctionContext) ++#else ++static void restore_p2p_state_timer_process(struct timer_list *t) ++#endif +{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _adapter *adapter = (_adapter *)FunctionContext; ++#else ++ _adapter *adapter = from_timer(adapter, t, wdinfo.restore_p2p_state_timer); ++#endif + struct wifidirect_info *pwdinfo = &adapter->wdinfo; + + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+ ++ return; ++ + p2p_protocol_wk_cmd( adapter, P2P_RESTORE_STATE_WK ); +} + ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) +static void pre_tx_scan_timer_process (void *FunctionContext) ++#else ++static void pre_tx_scan_timer_process(struct timer_list *t) ++#endif +{ -+ _adapter *adapter = (_adapter *) FunctionContext; -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u8 _status = 0; ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++ _adapter *adapter = (_adapter *) FunctionContext; ++#else ++ _adapter *adapter = from_timer(adapter, t, wdinfo.pre_tx_scan_timer); ++#endif ++ struct wifidirect_info *pwdinfo = &adapter->wdinfo; ++ _irqL irqL; ++ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; ++ u8 _status = 0; + + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) + return; -+ ++ + _enter_critical_bh(&pmlmepriv->lock, &irqL); + + + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) + { -+ if ( _TRUE == pwdinfo->tx_prov_disc_info.benable ) // the provision discovery request frame is trigger to send or not ++ if ( true == pwdinfo->tx_prov_disc_info.benable ) // the provision discovery request frame is trigger to send or not + { -+ p2p_protocol_wk_cmd( adapter, P2P_PRE_TX_PROVDISC_PROCESS_WK ); ++ p2p_protocol_wk_cmd( adapter, P2P_PRE_TX_PROVDISC_PROCESS_WK ); + //issue_probereq_p2p(adapter, NULL); + //_set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); + } + } + else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) + { -+ if ( _TRUE == pwdinfo->nego_req_info.benable ) ++ if ( true == pwdinfo->nego_req_info.benable ) + { + p2p_protocol_wk_cmd( adapter, P2P_PRE_TX_NEGOREQ_PROCESS_WK ); + } + } + else if ( rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ ) ) + { -+ if ( _TRUE == pwdinfo->invitereq_info.benable ) ++ if ( true == pwdinfo->invitereq_info.benable ) + { + p2p_protocol_wk_cmd( adapter, P2P_PRE_TX_INVITEREQ_PROCESS_WK ); + } @@ -58490,13 +40377,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + DBG_8192C( "[%s] p2p_state is %d, ignore!!\n", __FUNCTION__, rtw_p2p_state(pwdinfo) ); + } -+ ++ + _exit_critical_bh(&pmlmepriv->lock, &irqL); +} + ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) +static void find_phase_timer_process (void *FunctionContext) ++#else ++static void find_phase_timer_process(struct timer_list *t) ++#endif +{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _adapter *adapter = (_adapter *)FunctionContext; ++#else ++ _adapter *adapter = from_timer(adapter, t, wdinfo.find_phase_timer); ++#endif + struct wifidirect_info *pwdinfo = &adapter->wdinfo; + + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) @@ -58508,12 +40403,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ +} + +#ifdef CONFIG_CONCURRENT_MODE ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) +void ap_p2p_switch_timer_process (void *FunctionContext) ++#else ++void ap_p2p_switch_timer_process(struct timer_list *t) ++#endif +{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _adapter *adapter = (_adapter *)FunctionContext; ++#else ++ _adapter *adapter = from_timer(adapter, t, wdinfo.ap_p2p_switch_timer); ++#endif + struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); ++#ifdef CONFIG_IOCTL_CFG80211 ++ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(adapter->rtw_wdev); +#endif + + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) @@ -58533,9 +40436,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + pwdinfo = &padapter->wdinfo; + pwdinfo->persistent_supported = 0; -+ pwdinfo->session_available = _TRUE; ++ pwdinfo->session_available = true; + pwdinfo->wfd_tdls_enable = 0; -+ pwdinfo->wfd_tdls_weaksec = _TRUE; ++ pwdinfo->wfd_tdls_weaksec = 0; +} + +#ifdef CONFIG_WFD @@ -58547,13 +40450,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + // Used in P2P and TDLS + pwfd_info->rtsp_ctrlport = 554; + pwfd_info->peer_rtsp_ctrlport = 0; // Reset to 0 -+ pwfd_info->wfd_enable = _FALSE; ++ pwfd_info->wfd_enable = false; + pwfd_info->wfd_device_type = WFD_DEVINFO_PSINK; + pwfd_info->scan_result_type = SCAN_RESULT_P2P_ONLY; + + // Used in P2P -+ pwfd_info->peer_session_avail = _TRUE; -+ pwfd_info->wfd_pc = _FALSE; ++ pwfd_info->peer_session_avail = true; ++ pwfd_info->wfd_pc = false; + + // Used in TDLS + _rtw_memset( pwfd_info->ip_address, 0x00, 4 ); @@ -58567,6 +40470,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ +{ + struct wifidirect_info *pwdinfo = &padapter->wdinfo; + ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _init_timer( &pwdinfo->find_phase_timer, padapter->pnetdev, find_phase_timer_process, padapter ); + _init_timer( &pwdinfo->restore_p2p_state_timer, padapter->pnetdev, restore_p2p_state_timer_process, padapter ); + _init_timer( &pwdinfo->pre_tx_scan_timer, padapter->pnetdev, pre_tx_scan_timer_process, padapter ); @@ -58575,6 +40479,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ +#ifdef CONFIG_CONCURRENT_MODE + _init_timer( &pwdinfo->ap_p2p_switch_timer, padapter->pnetdev, ap_p2p_switch_timer_process, padapter ); +#endif ++#else ++ timer_setup(&pwdinfo->find_phase_timer, find_phase_timer_process, 0); ++ timer_setup(&pwdinfo->restore_p2p_state_timer, restore_p2p_state_timer_process, 0); ++ timer_setup(&pwdinfo->pre_tx_scan_timer, pre_tx_scan_timer_process, 0); ++ timer_setup(&pwdinfo->reset_ch_sitesurvey, reset_ch_sitesurvey_timer_process, 0); ++ timer_setup(&pwdinfo->reset_ch_sitesurvey2, reset_ch_sitesurvey_timer_process2, 0); ++#endif ++#ifdef CONFIG_CONCURRENT_MODE ++ timer_setup(&pwdinfo->ap_p2p_switch_timer, ap_p2p_switch_timer_process, 0); ++#endif +} + +void rtw_init_wifidirect_addrs(_adapter* padapter, u8 *dev_addr, u8 *iface_addr) @@ -58600,15 +40514,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ +#endif +#ifdef CONFIG_CONCURRENT_MODE + _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct wifidirect_info *pbuddy_wdinfo = NULL; -+ struct mlme_priv *pbuddy_mlmepriv = NULL; -+ struct mlme_ext_priv *pbuddy_mlmeext = NULL; ++ struct wifidirect_info *pbuddy_wdinfo; ++ struct mlme_priv *pbuddy_mlmepriv; ++ struct mlme_ext_priv *pbuddy_mlmeext; +#endif + + pwdinfo = &padapter->wdinfo; + + pwdinfo->padapter = padapter; -+ ++ + // 1, 6, 11 are the social channel defined in the WiFi Direct specification. + pwdinfo->social_chan[0] = 1; + pwdinfo->social_chan[1] = 6; @@ -58622,7 +40536,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; + } + -+ if ( ( check_buddy_fwstate(padapter, _FW_LINKED ) == _TRUE ) && ++ if ( ( check_buddy_fwstate(padapter, _FW_LINKED ) == true ) && + ( ( pbuddy_mlmeext->cur_channel == 1) || ( pbuddy_mlmeext->cur_channel == 6 ) || ( pbuddy_mlmeext->cur_channel == 11 ) ) + ) + { @@ -58641,7 +40555,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + { + rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); + #ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) == _TRUE ) ++ if ( check_buddy_fwstate(padapter, _FW_LINKED ) == true ) + { + rtw_p2p_set_state(pwdinfo, P2P_STATE_IDLE); + } @@ -58659,7 +40573,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); + pwdinfo->intent = 1; + rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ } ++ } + else if (role == P2P_ROLE_GO) + { + rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); @@ -58668,7 +40582,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); + } + -+// Use the OFDM rate in the P2P probe response frame. ( 6(B), 9(B), 12, 18, 24, 36, 48, 54 ) ++// Use the OFDM rate in the P2P probe response frame. ( 6(B), 9(B), 12, 18, 24, 36, 48, 54 ) + pwdinfo->support_rate[0] = 0x8c; // 6(B) + pwdinfo->support_rate[1] = 0x92; // 9(B) + pwdinfo->support_rate[2] = 0x18; // 12 @@ -58685,7 +40599,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + _rtw_memset( &pwdinfo->invitereq_info, 0x00, sizeof( struct tx_invite_req_info ) ); + pwdinfo->invitereq_info.token = 3; // Token used for P2P invitation request frame. -+ ++ + _rtw_memset( &pwdinfo->inviteresp_info, 0x00, sizeof( struct tx_invite_resp_info ) ); + pwdinfo->inviteresp_info.token = 0; + @@ -58747,103 +40661,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + pwdinfo->rx_invitereq_info.operation_ch[0] = 0; + pwdinfo->rx_invitereq_info.operation_ch[1] = 0; // Used to indicate the scan end in site survey function -+#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->rx_invitereq_info.operation_ch[2] = 0; -+ pwdinfo->rx_invitereq_info.operation_ch[3] = 0; -+ pwdinfo->rx_invitereq_info.operation_ch[4] = 0; -+#endif //CONFIG_P2P_OP_CHK_SOCIAL_CH + pwdinfo->rx_invitereq_info.scan_op_ch_only = 0; + pwdinfo->p2p_info.operation_ch[0] = 0; + pwdinfo->p2p_info.operation_ch[1] = 0; // Used to indicate the scan end in site survey function -+#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->p2p_info.operation_ch[2] = 0; -+ pwdinfo->p2p_info.operation_ch[3] = 0; -+ pwdinfo->p2p_info.operation_ch[4] = 0; -+#endif //CONFIG_P2P_OP_CHK_SOCIAL_CH + pwdinfo->p2p_info.scan_op_ch_only = 0; +} + +#ifdef CONFIG_DBG_P2P ++char * p2p_role_str[] = { ++ "P2P_ROLE_DISABLE", ++ "P2P_ROLE_DEVICE", ++ "P2P_ROLE_CLIENT", ++ "P2P_ROLE_GO" ++}; + -+/** -+ * rtw_p2p_role_txt - Get the p2p role name as a text string -+ * @role: P2P role -+ * Returns: The state name as a printable text string -+ */ -+const char * rtw_p2p_role_txt(enum P2P_ROLE role) -+{ -+ switch (role) { -+ case P2P_ROLE_DISABLE: -+ return "P2P_ROLE_DISABLE"; -+ case P2P_ROLE_DEVICE: -+ return "P2P_ROLE_DEVICE"; -+ case P2P_ROLE_CLIENT: -+ return "P2P_ROLE_CLIENT"; -+ case P2P_ROLE_GO: -+ return "P2P_ROLE_GO"; -+ default: -+ return "UNKNOWN"; -+ } -+} -+ -+/** -+ * rtw_p2p_state_txt - Get the p2p state name as a text string -+ * @state: P2P state -+ * Returns: The state name as a printable text string -+ */ -+const char * rtw_p2p_state_txt(enum P2P_STATE state) -+{ -+ switch (state) { -+ case P2P_STATE_NONE: -+ return "P2P_STATE_NONE"; -+ case P2P_STATE_IDLE: -+ return "P2P_STATE_IDLE"; -+ case P2P_STATE_LISTEN: -+ return "P2P_STATE_LISTEN"; -+ case P2P_STATE_SCAN: -+ return "P2P_STATE_SCAN"; -+ case P2P_STATE_FIND_PHASE_LISTEN: -+ return "P2P_STATE_FIND_PHASE_LISTEN"; -+ case P2P_STATE_FIND_PHASE_SEARCH: -+ return "P2P_STATE_FIND_PHASE_SEARCH"; -+ case P2P_STATE_TX_PROVISION_DIS_REQ: -+ return "P2P_STATE_TX_PROVISION_DIS_REQ"; -+ case P2P_STATE_RX_PROVISION_DIS_RSP: -+ return "P2P_STATE_RX_PROVISION_DIS_RSP"; -+ case P2P_STATE_RX_PROVISION_DIS_REQ: -+ return "P2P_STATE_RX_PROVISION_DIS_REQ"; -+ case P2P_STATE_GONEGO_ING: -+ return "P2P_STATE_GONEGO_ING"; -+ case P2P_STATE_GONEGO_OK: -+ return "P2P_STATE_GONEGO_OK"; -+ case P2P_STATE_GONEGO_FAIL: -+ return "P2P_STATE_GONEGO_FAIL"; -+ case P2P_STATE_RECV_INVITE_REQ_MATCH: -+ return "P2P_STATE_RECV_INVITE_REQ_MATCH"; -+ case P2P_STATE_PROVISIONING_ING: -+ return "P2P_STATE_PROVISIONING_ING"; -+ case P2P_STATE_PROVISIONING_DONE: -+ return "P2P_STATE_PROVISIONING_DONE"; -+ case P2P_STATE_TX_INVITE_REQ: -+ return "P2P_STATE_TX_INVITE_REQ"; -+ case P2P_STATE_RX_INVITE_RESP_OK: -+ return "P2P_STATE_RX_INVITE_RESP_OK"; -+ case P2P_STATE_RECV_INVITE_REQ_DISMATCH: -+ return "P2P_STATE_RECV_INVITE_REQ_DISMATCH"; -+ case P2P_STATE_RECV_INVITE_REQ_GO: -+ return "P2P_STATE_RECV_INVITE_REQ_GO"; -+ case P2P_STATE_RECV_INVITE_REQ_JOIN: -+ return "P2P_STATE_RECV_INVITE_REQ_JOIN"; -+ case P2P_STATE_RX_INVITE_RESP_FAIL: -+ return "P2P_STATE_RX_INVITE_RESP_FAIL"; -+ case P2P_STATE_RX_INFOR_NOREADY: -+ return "P2P_STATE_RX_INFOR_NOREADY"; -+ case P2P_STATE_TX_INFOR_NOREADY: -+ return "P2P_STATE_TX_INFOR_NOREADY"; -+ default: -+ return "UNKNOWN"; -+ } -+} ++char * p2p_state_str[] = { ++ "P2P_STATE_NONE", ++ "P2P_STATE_IDLE", ++ "P2P_STATE_LISTEN", ++ "P2P_STATE_SCAN", ++ "P2P_STATE_FIND_PHASE_LISTEN", ++ "P2P_STATE_FIND_PHASE_SEARCH", ++ "P2P_STATE_TX_PROVISION_DIS_REQ", ++ "P2P_STATE_RX_PROVISION_DIS_RSP", ++ "P2P_STATE_RX_PROVISION_DIS_REQ", ++ "P2P_STATE_GONEGO_ING", ++ "P2P_STATE_GONEGO_OK", ++ "P2P_STATE_GONEGO_FAIL", ++ "P2P_STATE_RECV_INVITE_REQ_MATCH", ++ "P2P_STATE_PROVISIONING_ING", ++ "P2P_STATE_PROVISIONING_DONE", ++ "P2P_STATE_RECV_INVITE_REQ_DISMATCH", ++ "P2P_STATE_RECV_INVITE_REQ_GO" ++}; + +void dbg_rtw_p2p_set_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line) +{ @@ -58851,25 +40701,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + enum P2P_STATE old_state = _rtw_p2p_state(wdinfo); + _rtw_p2p_set_state(wdinfo, state); + DBG_871X("[CONFIG_DBG_P2P]%s:%d set_state from %s to %s\n", caller, line -+ , rtw_p2p_state_txt(old_state), rtw_p2p_state_txt(_rtw_p2p_state(wdinfo)) ++ , p2p_state_str[old_state], p2p_state_str[_rtw_p2p_state(wdinfo)] + ); + } else { + DBG_871X("[CONFIG_DBG_P2P]%s:%d set_state to same state %s\n", caller, line -+ , rtw_p2p_state_txt(_rtw_p2p_state(wdinfo)) ++ , p2p_state_str[_rtw_p2p_state(wdinfo)] + ); + } +} +void dbg_rtw_p2p_set_pre_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line) +{ + if(_rtw_p2p_pre_state(wdinfo) != state) { -+ enum P2P_STATE old_state = _rtw_p2p_pre_state(wdinfo); ++ enum P2P_STATE old_state = _rtw_p2p_pre_state(wdinfo); + _rtw_p2p_set_pre_state(wdinfo, state); + DBG_871X("[CONFIG_DBG_P2P]%s:%d set_pre_state from %s to %s\n", caller, line -+ , rtw_p2p_state_txt(old_state), rtw_p2p_state_txt(_rtw_p2p_pre_state(wdinfo)) ++ , p2p_state_str[old_state], p2p_state_str[_rtw_p2p_pre_state(wdinfo)] + ); + } else { + DBG_871X("[CONFIG_DBG_P2P]%s:%d set_pre_state to same state %s\n", caller, line -+ , rtw_p2p_state_txt(_rtw_p2p_pre_state(wdinfo)) ++ , p2p_state_str[_rtw_p2p_pre_state(wdinfo)] + ); + } +} @@ -58884,7 +40734,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + } else { + DBG_871X("[CONFIG_DBG_P2P]%s:%d restore no pre state, cur state %s\n", caller, line + , p2p_state_str[wdinfo->p2p_state] -+ ); ++ ); + } +} +#endif @@ -58894,11 +40744,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + enum P2P_ROLE old_role = wdinfo->role; + _rtw_p2p_set_role(wdinfo, role); + DBG_871X("[CONFIG_DBG_P2P]%s:%d set_role from %s to %s\n", caller, line -+ , rtw_p2p_role_txt(old_role), rtw_p2p_role_txt(wdinfo->role) ++ , p2p_role_str[old_role], p2p_role_str[wdinfo->role] + ); + } else { + DBG_871X("[CONFIG_DBG_P2P]%s:%d set_role to same role %s\n", caller, line -+ , rtw_p2p_role_txt(wdinfo->role) ++ , p2p_role_str[wdinfo->role] + ); + } +} @@ -58909,6 +40759,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ +{ + int ret = _SUCCESS; + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + + if (role == P2P_ROLE_DEVICE || role == P2P_ROLE_CLIENT|| role == P2P_ROLE_GO) + { @@ -58941,25 +40792,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + + //Enable P2P function + init_wifidirect_info(padapter, role); -+ -+ rtw_hal_set_odm_var(padapter,HAL_ODM_P2P_STATE,NULL,_TRUE); ++ ++ rtw_hal_set_odm_var(padapter,HAL_ODM_P2P_STATE,NULL,true); + #ifdef CONFIG_WFD -+ rtw_hal_set_odm_var(padapter,HAL_ODM_WIFI_DISPLAY_STATE,NULL,_TRUE); ++ rtw_hal_set_odm_var(padapter,HAL_ODM_WIFI_DISPLAY_STATE,NULL,true); + #endif -+ ++ + } + else if (role == P2P_ROLE_DISABLE) + { -+#ifdef CONFIG_INTEL_WIDI -+ if( padapter->mlmepriv.p2p_reject_disable == _TRUE ) -+ return ret; -+#endif //CONFIG_INTEL_WIDI -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 ) -+ adapter_wdev_data(padapter)->p2p_enabled = _FALSE; -+#endif //CONFIG_IOCTL_CFG80211 -+ ++ if (_FAIL == rtw_pwr_wakeup(padapter)) { ++ ret = _FAIL; ++ goto exit; ++ } + + //Disable P2P function + if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) @@ -58969,38 +40814,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ + _cancel_timer_ex( &pwdinfo->pre_tx_scan_timer); + _cancel_timer_ex( &pwdinfo->reset_ch_sitesurvey); + _cancel_timer_ex( &pwdinfo->reset_ch_sitesurvey2); ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + reset_ch_sitesurvey_timer_process( padapter ); + reset_ch_sitesurvey_timer_process2( padapter ); -+ #ifdef CONFIG_CONCURRENT_MODE ++#else ++ reset_ch_sitesurvey_timer_process(&padapter->wdinfo.reset_ch_sitesurvey); ++ reset_ch_sitesurvey_timer_process(&padapter->wdinfo.reset_ch_sitesurvey2); ++#endif ++ #ifdef CONFIG_CONCURRENT_MODE + _cancel_timer_ex( &pwdinfo->ap_p2p_switch_timer); + #endif + rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE); -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_NONE); + rtw_p2p_set_role(pwdinfo, P2P_ROLE_DISABLE); + _rtw_memset(&pwdinfo->rx_prov_disc_info, 0x00, sizeof(struct rx_provdisc_req_info)); -+ -+ /* Remove profiles in wifidirect_info structure. */ -+ _rtw_memset( &pwdinfo->profileinfo[ 0 ], 0x00, sizeof( struct profile_info ) * P2P_MAX_PERSISTENT_GROUP_NUM ); -+ pwdinfo->profileindex = 0; + } + -+ rtw_hal_set_odm_var(padapter,HAL_ODM_P2P_STATE,NULL,_FALSE); ++ rtw_hal_set_odm_var(padapter,HAL_ODM_P2P_STATE,NULL,false); + #ifdef CONFIG_WFD -+ rtw_hal_set_odm_var(padapter,HAL_ODM_WIFI_DISPLAY_STATE,NULL,_FALSE); ++ rtw_hal_set_odm_var(padapter,HAL_ODM_WIFI_DISPLAY_STATE,NULL,false); + #endif + -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ + //Restore to initial setting. + update_tx_basic_rate(padapter, padapter->registrypriv.wireless_mode); + -+#ifdef CONFIG_INTEL_WIDI -+ rtw_reset_widi_info(padapter); -+#endif //CONFIG_INTEL_WIDI -+ + //For WiDi purpose. +#ifdef CONFIG_IOCTL_CFG80211 + pwdinfo->driver_interface = DRIVER_CFG80211; @@ -59009,21 +40845,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_p2p.c linux/3rdparty/rtl8812au/ +#endif //CONFIG_IOCTL_CFG80211 + + } -+ -+exit: ++ ++exit: + return ret; +} + +#endif //CONFIG_P2P -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl8812au/core/rtw_pwrctrl.c ---- linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_pwrctrl.c 2017-06-07 23:07:21.004686938 +0300 -@@ -0,0 +1,2706 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_pwrctrl.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_pwrctrl.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_pwrctrl.c 2018-02-06 17:42:30.698966987 +0200 +@@ -0,0 +1,1815 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -59033,116 +40868,64 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_PWRCTRL_C_ + +#include -+#include -+#include + -+int rtw_fw_ps_state(PADAPTER padapter) -+{ -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ int ret=_FAIL, dont_care=0; -+ u16 fw_ps_state=0; -+ u32 start_time; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ -+ if(registry_par->check_fw_ps != 1) -+ return _SUCCESS; -+ -+ _enter_pwrlock(&pwrpriv->check_32k_lock); -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ DBG_871X("%s: bSurpriseRemoved=%s , hw_init_completed=%d, bDriverStopped=%s\n", __func__ -+ , rtw_is_surprise_removed(padapter)?"True":"False" -+ , rtw_get_hw_init_completed(padapter) -+ , rtw_is_drv_stopped(padapter)?"True":"False"); -+ goto exit_fw_ps_state; -+ } -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_REQ_FW_PS, (u8 *)&dont_care); -+ { -+ //4. if 0x88[7]=1, driver set cmd to leave LPS/IPS. -+ //Else, hw will keep in active mode. -+ //debug info: -+ //0x88[7] = 32kpermission, -+ //0x88[6:0] = current_ps_state -+ //0x89[7:0] = last_rpwm -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_FW_PS_STATE, (u8 *)&fw_ps_state); -+ -+ if((fw_ps_state & 0x80) == 0) -+ ret=_SUCCESS; -+ else -+ { -+ pdbgpriv->dbg_poll_fail_cnt++; -+ DBG_871X("%s: fw_ps_state=%04x \n", __FUNCTION__, fw_ps_state); -+ } -+ } -+ -+ -+exit_fw_ps_state: -+ _exit_pwrlock(&pwrpriv->check_32k_lock); -+ return ret; -+} ++// Should not include hal dependent herader here, it will remove later. Lucas@20130123 ++#ifdef CONFIG_BT_COEXIST ++#include ++#endif + +#ifdef CONFIG_IPS -+void _ips_enter(_adapter * padapter) ++void ips_enter(_adapter * padapter) +{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + -+ pwrpriv->bips_processing = _TRUE; ++ _enter_pwrlock(&pwrpriv->lock); ++ ++ pwrpriv->bips_processing = true; + + // syn ips_mode with request + pwrpriv->ips_mode = pwrpriv->ips_mode_req; -+ -+ pwrpriv->ips_enter_cnts++; -+ DBG_871X("==>ips_enter cnts:%d\n",pwrpriv->ips_enter_cnts); + ++ pwrpriv->ips_enter_cnts++; ++ DBG_871X("==>ips_enter cnts:%d\n",pwrpriv->ips_enter_cnts); ++#ifdef CONFIG_BT_COEXIST ++ BTDM_TurnOffBtCoexistBeforeEnterIPS(padapter); ++#endif + if(rf_off == pwrpriv->change_rfpwrstate ) -+ { -+ pwrpriv->bpower_saving = _TRUE; ++ { ++ pwrpriv->bpower_saving = true; + DBG_871X_LEVEL(_drv_always_, "nolinked power save enter\n"); + + if(pwrpriv->ips_mode == IPS_LEVEL_2) -+ pwrpriv->bkeepfwalive = _TRUE; -+ ++ pwrpriv->bkeepfwalive = true; ++ + rtw_ips_pwr_down(padapter); + pwrpriv->rf_pwrstate = rf_off; -+ } -+ pwrpriv->bips_processing = _FALSE; -+ ++ } ++ pwrpriv->bips_processing = false; ++ ++ _exit_pwrlock(&pwrpriv->lock); ++ +} + -+void ips_enter(_adapter * padapter) ++int ips_leave(_adapter * padapter) +{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; ++ struct security_priv* psecuritypriv=&(padapter->securitypriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ int result = _SUCCESS; ++ sint keyid; + + -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_IpsNotify(padapter, pwrpriv->ips_mode_req); -+#endif // CONFIG_BT_COEXIST -+ + _enter_pwrlock(&pwrpriv->lock); -+ _ips_enter(padapter); -+ _exit_pwrlock(&pwrpriv->lock); -+} -+ -+int _ips_leave(_adapter * padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ int result = _SUCCESS; + + if((pwrpriv->rf_pwrstate == rf_off) &&(!pwrpriv->bips_processing)) + { -+ pwrpriv->bips_processing = _TRUE; ++ pwrpriv->bips_processing = true; + pwrpriv->change_rfpwrstate = rf_on; + pwrpriv->ips_leave_cnts++; + DBG_871X("==>ips_leave cnts:%d\n",pwrpriv->ips_leave_cnts); @@ -59151,52 +40934,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + pwrpriv->rf_pwrstate = rf_on; + } + DBG_871X_LEVEL(_drv_always_, "nolinked power save leave\n"); -+ -+ DBG_871X("==> ips_leave.....LED(0x%08x)...\n",rtw_read32(padapter,0x4c)); -+ pwrpriv->bips_processing = _FALSE; + -+ pwrpriv->bkeepfwalive = _FALSE; -+ pwrpriv->bpower_saving = _FALSE; ++ if((_WEP40_ == psecuritypriv->dot11PrivacyAlgrthm) ||(_WEP104_ == psecuritypriv->dot11PrivacyAlgrthm)) ++ { ++ DBG_871X("==>%s,channel(%d),processing(%x)\n",__FUNCTION__,padapter->mlmeextpriv.cur_channel,pwrpriv->bips_processing); ++ set_channel_bwmode(padapter, padapter->mlmeextpriv.cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ for(keyid=0;keyid<4;keyid++){ ++ if(pmlmepriv->key_mask & BIT(keyid)){ ++ if(keyid == psecuritypriv->dot11PrivacyKeyIndex) ++ result=rtw_set_key(padapter,psecuritypriv, keyid, 1); ++ else ++ result=rtw_set_key(padapter,psecuritypriv, keyid, 0); ++ } ++ } ++ } ++ ++ DBG_871X("==> ips_leave.....LED(0x%08x)...\n",rtw_read32(padapter,0x4c)); ++ pwrpriv->bips_processing = false; ++ ++ pwrpriv->bkeepfwalive = false; ++ pwrpriv->bpower_saving = false; + } + ++ _exit_pwrlock(&pwrpriv->lock); ++ + return result; +} + -+int ips_leave(_adapter * padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ int ret; + -+ if(!is_primary_adapter(padapter)) -+ return _SUCCESS; -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ ret = _ips_leave(padapter); -+#ifdef DBG_CHECK_FW_PS_STATE -+ if(rtw_fw_ps_state(padapter) == _FAIL) -+ { -+ DBG_871X("ips leave doesn't leave 32k\n"); -+ pdbgpriv->dbg_leave_ips_fail_cnt++; -+ } -+#endif //DBG_CHECK_FW_PS_STATE -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ if (_SUCCESS == ret) -+ ODM_DMReset(&GET_HAL_DATA(padapter)->odmpriv); -+ -+#ifdef CONFIG_BT_COEXIST -+ if (_SUCCESS == ret) -+ rtw_btcoex_IpsNotify(padapter, IPS_NONE); -+#endif // CONFIG_BT_COEXIST -+ -+ return ret; -+} -+#endif /* CONFIG_IPS */ ++#endif + +#ifdef CONFIG_AUTOSUSPEND -+extern void autosuspend_enter(_adapter* padapter); ++extern void autosuspend_enter(_adapter* padapter); +extern int autoresume_enter(_adapter* padapter); +#endif + @@ -59217,14 +40986,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +#endif +#endif + -+ bool ret = _FALSE; ++ bool ret = false; + -+ if (adapter_to_pwrctl(adapter)->bpower_saving ==_TRUE ) { -+ //DBG_871X("%s: already in LPS or IPS mode\n", __func__); -+ goto exit; -+ } -+ -+ if (adapter_to_pwrctl(adapter)->ips_deny_time >= rtw_get_current_time()) { ++ if (adapter->pwrctrlpriv.ips_deny_time >= rtw_get_current_time()) { + //DBG_871X("%s ips_deny_time\n", __func__); + goto exit; + } @@ -59238,9 +41002,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + #elif defined(CONFIG_P2P) + || !rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) + #endif -+ #if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) -+ || rtw_get_passing_time_ms(pcfg80211_wdinfo->last_ro_ch_time) < 3000 -+ #endif + ) { + goto exit; + } @@ -59264,9 +41025,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + #elif defined(CONFIG_P2P) + || !rtw_p2p_chk_state(b_pwdinfo, P2P_STATE_NONE) + #endif -+ #if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) -+ || rtw_get_passing_time_ms(b_pcfg80211_wdinfo->last_ro_ch_time) < 3000 -+ #endif + ) { + goto exit; + } @@ -59278,7 +41036,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +#endif + +#ifdef CONFIG_INTEL_PROXIM -+ if(adapter->proximity.proxim_on==_TRUE){ ++ if(adapter->proximity.proxim_on==true){ + return; + } +#endif @@ -59286,68 +41044,44 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + if (pxmit_priv->free_xmitbuf_cnt != NR_XMITBUFF || + pxmit_priv->free_xmit_extbuf_cnt != NR_XMIT_EXTBUFF) { + DBG_871X_LEVEL(_drv_always_, "There are some pkts to transmit\n"); -+ DBG_871X_LEVEL(_drv_always_, "free_xmitbuf_cnt: %d, free_xmit_extbuf_cnt: %d\n", -+ pxmit_priv->free_xmitbuf_cnt, pxmit_priv->free_xmit_extbuf_cnt); ++ DBG_871X_LEVEL(_drv_info_, "free_xmitbuf_cnt: %d, free_xmit_extbuf_cnt: %d\n", ++ pxmit_priv->free_xmitbuf_cnt, pxmit_priv->free_xmit_extbuf_cnt); + goto exit; + } + -+ ret = _TRUE; ++ ret = true; + +exit: + return ret; +} + -+ -+/* -+ * ATTENTION: -+ * rtw_ps_processor() doesn't handle LPS. -+ */ +void rtw_ps_processor(_adapter*padapter) +{ +#ifdef CONFIG_P2P + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); +#endif //CONFIG_P2P -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; +#ifdef SUPPORT_HW_RFOFF_DETECTED + rt_rf_power_state rfpwrstate; +#endif //SUPPORT_HW_RFOFF_DETECTED -+ u32 ps_deny = 0; + -+ _enter_pwrlock(&adapter_to_pwrctl(padapter)->lock); -+ ps_deny = rtw_ps_deny_get(padapter); -+ _exit_pwrlock(&adapter_to_pwrctl(padapter)->lock); -+ if (ps_deny != 0) -+ { -+ DBG_871X(FUNC_ADPT_FMT ": ps_deny=0x%08X, skip power save!\n", -+ FUNC_ADPT_ARG(padapter), ps_deny); -+ goto exit; -+ } -+ -+ if(pwrpriv->bInSuspend == _TRUE){//system suspend or autosuspend -+ pdbgpriv->dbg_ps_insuspend_cnt++; -+ DBG_871X("%s, pwrpriv->bInSuspend == _TRUE ignore this process\n",__FUNCTION__); -+ return; -+ } -+ -+ pwrpriv->ps_processing = _TRUE; ++ pwrpriv->ps_processing = true; + +#ifdef SUPPORT_HW_RFOFF_DETECTED -+ if(pwrpriv->bips_processing == _TRUE) ++ if(pwrpriv->bips_processing == true) + goto exit; -+ -+ //DBG_871X("==> fw report state(0x%x)\n",rtw_read8(padapter,0x1ca)); -+ if(pwrpriv->bHWPwrPindetect) ++ ++ //DBG_871X("==> fw report state(0x%x)\n",rtw_read8(padapter,0x1ca)); ++ if(padapter->pwrctrlpriv.bHWPwrPindetect) + { + #ifdef CONFIG_AUTOSUSPEND + if(padapter->registrypriv.usbss_enable) + { + if(pwrpriv->rf_pwrstate == rf_on) + { -+ if(padapter->net_closed == _TRUE) -+ pwrpriv->ps_flag = _TRUE; ++ if(padapter->net_closed == true) ++ pwrpriv->ps_flag = true; + + rfpwrstate = RfOnOffDetect(padapter); + DBG_871X("@@@@- #1 %s==> rfstate:%s \n",__FUNCTION__,(rfpwrstate==rf_on)?"rf_on":"rf_off"); @@ -59356,14 +41090,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + if(rfpwrstate == rf_off) + { + pwrpriv->change_rfpwrstate = rf_off; -+ -+ pwrpriv->bkeepfwalive = _TRUE; -+ pwrpriv->brfoffbyhw = _TRUE; -+ -+ autosuspend_enter(padapter); ++ ++ pwrpriv->bkeepfwalive = true; ++ pwrpriv->brfoffbyhw = true; ++ ++ autosuspend_enter(padapter); + } + } -+ } ++ } + } + else + #endif //CONFIG_AUTOSUSPEND @@ -59374,27 +41108,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + if(rfpwrstate!= pwrpriv->rf_pwrstate) + { + if(rfpwrstate == rf_off) -+ { -+ pwrpriv->change_rfpwrstate = rf_off; -+ pwrpriv->brfoffbyhw = _TRUE; -+ rtw_hw_suspend(padapter ); ++ { ++ pwrpriv->change_rfpwrstate = rf_off; ++ pwrpriv->brfoffbyhw = true; ++ padapter->bCardDisableWOHSM = true; ++ rtw_hw_suspend(padapter ); + } + else + { + pwrpriv->change_rfpwrstate = rf_on; -+ rtw_hw_resume(padapter ); ++ rtw_hw_resume(padapter ); + } + DBG_871X("current rf_pwrstate(%s)\n",(pwrpriv->rf_pwrstate == rf_off)?"rf_off":"rf_on"); + } + } -+ pwrpriv->pwr_state_check_cnts ++; ++ pwrpriv->pwr_state_check_cnts ++; + } +#endif //SUPPORT_HW_RFOFF_DETECTED + -+ if (pwrpriv->ips_mode_req == IPS_NONE) ++ if (pwrpriv->ips_mode_req == IPS_NONE ++ #ifdef CONFIG_CONCURRENT_MODE ++ || padapter->pbuddy_adapter->pwrctrlpriv.ips_mode_req == IPS_NONE ++ #endif ++ ) + goto exit; + -+ if (rtw_pwr_unassociated_idle(padapter) == _FALSE) ++ if (rtw_pwr_unassociated_idle(padapter) == false) + goto exit; + + if((pwrpriv->rf_pwrstate == rf_on) && ((pwrpriv->pwr_state_check_cnts%4)==0)) @@ -59407,24 +41146,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + #ifdef CONFIG_AUTOSUSPEND + if(padapter->registrypriv.usbss_enable) + { -+ if(pwrpriv->bHWPwrPindetect) -+ pwrpriv->bkeepfwalive = _TRUE; -+ -+ if(padapter->net_closed == _TRUE) -+ pwrpriv->ps_flag = _TRUE; ++ if(pwrpriv->bHWPwrPindetect) ++ pwrpriv->bkeepfwalive = true; ++ ++ if(padapter->net_closed == true) ++ pwrpriv->ps_flag = true; + + #if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) -+ if (_TRUE==pwrpriv->bInternalAutoSuspend) { ++ if (true==pwrpriv->bInternalAutoSuspend) { + DBG_871X("<==%s .pwrpriv->bInternalAutoSuspend)(%x)\n",__FUNCTION__,pwrpriv->bInternalAutoSuspend); + } else { + pwrpriv->change_rfpwrstate = rf_off; ++ padapter->bCardDisableWOHSM = true; + DBG_871X("<==%s .pwrpriv->bInternalAutoSuspend)(%x) call autosuspend_enter\n",__FUNCTION__,pwrpriv->bInternalAutoSuspend); + autosuspend_enter(padapter); -+ } ++ } + #else ++ padapter->bCardDisableWOHSM = true; + autosuspend_enter(padapter); + #endif //if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) -+ } ++ } + else if(pwrpriv->bHWPwrPindetect) + { + } @@ -59436,93 +41177,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + #endif //defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) + + #ifdef CONFIG_IPS -+ ips_enter(padapter); ++ ips_enter(padapter); + #endif + } + } +exit: -+#ifndef CONFIG_IPS_CHECK_IN_WD -+ rtw_set_pwr_state_check_timer(pwrpriv); -+#endif -+ pwrpriv->ps_processing = _FALSE; ++ rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv); ++ pwrpriv->ps_processing = false; + return; +} + -+void pwr_state_check_handler(RTW_TIMER_HDL_ARGS); ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) +void pwr_state_check_handler(RTW_TIMER_HDL_ARGS) ++#else ++void pwr_state_check_handler(struct timer_list *t) ++#endif +{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _adapter *padapter = (_adapter *)FunctionContext; ++#else ++ _adapter *padapter = from_timer(padapter, t, pwrctrlpriv.pwr_state_check_timer); ++#endif + rtw_ps_cmd(padapter); +} + ++ +#ifdef CONFIG_LPS -+void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets) -+{ -+#ifdef CONFIG_CHECK_LEAVE_LPS -+ static u32 start_time = 0; -+ static u32 xmit_cnt = 0; -+ u8 bLeaveLPS = _FALSE; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ -+ if(tx) //from tx -+ { -+ xmit_cnt += tx_packets; -+ -+ if (start_time== 0) -+ start_time= rtw_get_current_time(); -+ -+ if (rtw_get_passing_time_ms(start_time) > 2000) // 2 sec == watch dog timer -+ { -+ if(xmit_cnt > 8) -+ { -+ if ((adapter_to_pwrctl(padapter)->bLeisurePs) -+ && (adapter_to_pwrctl(padapter)->pwr_mode != PS_MODE_ACTIVE) -+#ifdef CONFIG_BT_COEXIST -+ && (rtw_btcoex_IsBtControlLps(padapter) == _FALSE) -+#endif -+ ) -+ { -+ //DBG_871X("leave lps via Tx = %d\n", xmit_cnt); -+ bLeaveLPS = _TRUE; -+ } -+ } -+ -+ start_time= rtw_get_current_time(); -+ xmit_cnt = 0; -+ } -+ -+ } -+ else // from rx path -+ { -+ if(pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 4/*2*/) -+ { -+ if ((adapter_to_pwrctl(padapter)->bLeisurePs) -+ && (adapter_to_pwrctl(padapter)->pwr_mode != PS_MODE_ACTIVE) -+#ifdef CONFIG_BT_COEXIST -+ && (rtw_btcoex_IsBtControlLps(padapter) == _FALSE) -+#endif -+ ) -+ { -+ //DBG_871X("leave lps via Rx = %d\n", pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); -+ bLeaveLPS = _TRUE; -+ } -+ } -+ } -+ -+ if(bLeaveLPS) -+ { -+ //DBG_871X("leave lps via %s, Tx = %d, Rx = %d \n", tx?"Tx":"Rx", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod,pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); -+ //rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); -+ rtw_lps_ctrl_wk_cmd(padapter, tx?LPS_CTRL_TX_TRAFFIC_LEAVE:LPS_CTRL_RX_TRAFFIC_LEAVE, tx?0:1); -+ } -+#endif //CONFIG_CHECK_LEAVE_LPS -+} -+ +/* -+ * Description: -+ * This function MUST be called under power lock protect + * + * Parameters + * padapter @@ -59532,51 +41213,53 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +void rtw_set_rpwm(PADAPTER padapter, u8 pslv) +{ + u8 rpwm; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+#ifdef CONFIG_DETECT_CPWM_BY_POLLING -+ u8 cpwm_orig; -+#endif // CONFIG_DETECT_CPWM_BY_POLLING -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+_func_enter_; ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; ++ ++ + + pslv = PS_STATE(pslv); + ++ ++ if (true == pwrpriv->btcoex_rfon) ++ { ++ if (pslv < PS_STATE_S4) ++ pslv = PS_STATE_S3; ++ } ++ +#ifdef CONFIG_LPS_RPWM_TIMER -+ if (pwrpriv->brpwmtimeout == _TRUE) ++ if (pwrpriv->brpwmtimeout == true) + { + DBG_871X("%s: RPWM timeout, force to set RPWM(0x%02X) again!\n", __FUNCTION__, pslv); + } + else +#endif // CONFIG_LPS_RPWM_TIMER + { -+ if ( (pwrpriv->rpwm == pslv) ++ if ( (pwrpriv->rpwm == pslv) +#ifdef CONFIG_LPS_LCLK -+ || ((pwrpriv->rpwm >= PS_STATE_S2)&&(pslv >= PS_STATE_S2)) ++ || ((pwrpriv->rpwm >= PS_STATE_S2)&&(pslv >= PS_STATE_S2)) +#endif -+ ) -+ { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_,_drv_err_, -+ ("%s: Already set rpwm[0x%02X], new=0x%02X!\n", __FUNCTION__, pwrpriv->rpwm, pslv)); -+ return; -+ } ++ ) ++ { ++ RT_TRACE(_module_rtl871x_pwrctrl_c_,_drv_err_, ++ ("%s: Already set rpwm[0x%02X], new=0x%02X!\n", __FUNCTION__, pwrpriv->rpwm, pslv)); ++ return; ++ } + } + -+ if (rtw_is_surprise_removed(padapter) || -+ (!rtw_is_hw_init_completed(padapter))) ++ if ((padapter->bSurpriseRemoved == true) || ++ (padapter->hw_init_completed == false)) + { + RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_err_, -+ ("%s: SurpriseRemoved(%s) hw_init_completed(%s)\n" -+ , __func__ -+ , rtw_is_surprise_removed(padapter)?"True":"False" -+ , rtw_is_hw_init_completed(padapter)?"True":"False")); ++ ("%s: SurpriseRemoved(%d) hw_init_completed(%d)\n", ++ __FUNCTION__, padapter->bSurpriseRemoved, padapter->hw_init_completed)); + + pwrpriv->cpwm = PS_STATE_S4; + + return; + } + -+ if (rtw_is_drv_stopped(padapter)) { ++ if (padapter->bDriverStopped == true) ++ { + RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_err_, + ("%s: change power state(0x%02X) when DriverStopped\n", __FUNCTION__, pslv)); + @@ -59598,268 +41281,72 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + + pwrpriv->rpwm = pslv; + -+#ifdef CONFIG_DETECT_CPWM_BY_POLLING -+ cpwm_orig = 0; -+ if (rpwm & PS_ACK) -+ { -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig); -+ } -+#endif -+ -+#if defined(CONFIG_LPS_RPWM_TIMER) && !defined(CONFIG_DETECT_CPWM_BY_POLLING) ++#ifdef CONFIG_LPS_RPWM_TIMER + if (rpwm & PS_ACK) + _set_timer(&pwrpriv->pwr_rpwm_timer, LPS_RPWM_WAIT_MS); -+#endif // CONFIG_LPS_RPWM_TIMER & !CONFIG_DETECT_CPWM_BY_POLLING ++#endif // CONFIG_LPS_RPWM_TIMER + rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); + + pwrpriv->tog += 0x80; + +#ifdef CONFIG_LPS_LCLK + // No LPS 32K, No Ack -+ if (rpwm & PS_ACK) -+ { -+#ifdef CONFIG_DETECT_CPWM_BY_POLLING -+ u32 start_time; -+ u8 cpwm_now; -+ u8 poll_cnt=0; -+ -+ start_time = rtw_get_current_time(); -+ -+ // polling cpwm -+ do { -+ rtw_msleep_os(1); -+ poll_cnt++; -+ cpwm_now = 0; -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_now); -+ if ((cpwm_orig ^ cpwm_now) & 0x80) -+ { -+ pwrpriv->cpwm = PS_STATE_S4; -+ pwrpriv->cpwm_tog = cpwm_now & PS_TOGGLE; -+#ifdef DBG_CHECK_FW_PS_STATE -+ DBG_871X("%s: polling cpwm OK! poll_cnt=%d, cpwm_orig=%02x, cpwm_now=%02x , 0x100=0x%x\n" -+ , __FUNCTION__,poll_cnt, cpwm_orig, cpwm_now, rtw_read8(padapter, REG_CR)); -+ if(rtw_fw_ps_state(padapter) == _FAIL) -+ { -+ DBG_871X("leave 32k but fw state in 32k\n"); -+ pdbgpriv->dbg_rpwm_toogle_cnt++; -+ } -+#endif //DBG_CHECK_FW_PS_STATE -+ break; -+ } -+ -+ if (rtw_get_passing_time_ms(start_time) > LPS_RPWM_WAIT_MS) -+ { -+ DBG_871X("%s: polling cpwm timeout! poll_cnt=%d, cpwm_orig=%02x, cpwm_now=%02x \n", __FUNCTION__,poll_cnt, cpwm_orig, cpwm_now); -+#ifdef DBG_CHECK_FW_PS_STATE -+ if(rtw_fw_ps_state(padapter) == _FAIL) -+ { -+ DBG_871X("rpwm timeout and fw ps state in 32k\n"); -+ pdbgpriv->dbg_rpwm_timeout_fail_cnt++; -+ } -+#endif //DBG_CHECK_FW_PS_STATE -+#ifdef CONFIG_LPS_RPWM_TIMER -+ _set_timer(&pwrpriv->pwr_rpwm_timer, 1); -+#endif // CONFIG_LPS_RPWM_TIMER -+ break; -+ } -+ } while (1); -+#endif // CONFIG_DETECT_CPWM_BY_POLLING -+ } -+ else -+#endif // CONFIG_LPS_LCLK ++ if (!(rpwm & PS_ACK)) ++#endif + { + pwrpriv->cpwm = pslv; + } + -+_func_exit_; ++ +} + ++u8 PS_RDY_CHECK(_adapter * padapter); +u8 PS_RDY_CHECK(_adapter * padapter) +{ + u32 curr_time, delta_time; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+#endif /* CONFIG_IOCTL_CFG80211 */ -+#endif /* CONFIG_P2P */ + -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ if(_TRUE == pwrpriv->bInSuspend && pwrpriv->wowlan_mode) -+ return _TRUE; -+ else if(_TRUE == pwrpriv->bInSuspend && pwrpriv->wowlan_ap_mode) -+ return _TRUE; -+ else if (_TRUE == pwrpriv->bInSuspend) -+ return _FALSE; -+#else -+ if(_TRUE == pwrpriv->bInSuspend ) -+ return _FALSE; -+#endif -+ -+ curr_time = rtw_get_current_time(); ++ curr_time = rtw_get_current_time(); + + delta_time = curr_time -pwrpriv->DelayLPSLastTimeStamp; + + if(delta_time < LPS_DELAY_TIME) -+ { -+ return _FALSE; ++ { ++ return false; + } + -+ if (check_fwstate(pmlmepriv, WIFI_SITE_MONITOR) -+ || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING|WIFI_UNDER_WPS) -+ || check_fwstate(pmlmepriv, WIFI_AP_STATE) -+ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE|WIFI_ADHOC_STATE) -+ #if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_P2P_IPS) -+ || pcfg80211_wdinfo->is_ro_ch -+ #elif defined(CONFIG_P2P) -+ || !rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) -+ #endif -+ || rtw_is_scan_deny(padapter) -+#ifdef CONFIG_TDLS -+ // TDLS link is established. -+ || ( padapter->tdlsinfo.link_established == _TRUE ) -+#endif // CONFIG_TDLS -+ ) -+ return _FALSE; -+ -+ if( (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) && (padapter->securitypriv.binstallGrpkey == _FALSE) ) ++ if ((check_fwstate(pmlmepriv, _FW_LINKED) == false) || ++ (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) || ++ (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) ) ++ return false; ++#ifdef CONFIG_WOWLAN ++ if(true == pwrpriv->bInSuspend && pwrpriv->wowlan_mode) ++ return true; ++ else ++ return false; ++#else ++ if(true == pwrpriv->bInSuspend ) ++ return false; ++#endif ++ if( (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) && (padapter->securitypriv.binstallGrpkey == false) ) + { + DBG_871X("Group handshake still in progress !!!\n"); -+ return _FALSE; ++ return false; + } -+ +#ifdef CONFIG_IOCTL_CFG80211 + if (!rtw_cfg80211_pwr_mgmt(padapter)) -+ return _FALSE; -+#endif ++ return false; ++#endif + -+ return _TRUE; ++ return true; +} + -+#if defined(CONFIG_FWLPS_IN_IPS) -+void rtw_set_fw_in_ips_mode(PADAPTER padapter, u8 enable) ++void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode) +{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ int cnt=0; -+ u32 start_time; -+ u8 val8 = 0; -+ u8 cpwm_orig = 0, cpwm_now = 0; -+ u8 parm[H2C_INACTIVE_PS_LEN]={0}; -+ -+ if (padapter->netif_up == _FALSE) { -+ DBG_871X("%s: ERROR, netif is down\n", __func__); -+ return; -+ } -+ -+ //u8 cmd_param; //BIT0:enable, BIT1:NoConnect32k -+ if (enable) { -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_IpsNotify(padapter, pwrpriv->ips_mode_req); -+#endif -+ //Enter IPS -+ DBG_871X("%s: issue H2C to FW when entering IPS\n", __func__); -+ -+#ifdef CONFIG_PNO_SUPPORT -+ parm[0] = 0x03; -+ parm[1] = pwrpriv->pnlo_info->fast_scan_iterations; -+ parm[2] = pwrpriv->pnlo_info->slow_scan_period; -+#else -+ parm[0] = 0x03; -+ parm[1] = 0x0; -+ parm[2] = 0x0; -+#endif//CONFIG_PNO_SUPPORT -+ -+ rtw_hal_fill_h2c_cmd(padapter, //H2C_FWLPS_IN_IPS_, -+ H2C_INACTIVE_PS_, -+ H2C_INACTIVE_PS_LEN, parm); -+ //poll 0x1cc to make sure H2C command already finished by FW; MAC_0x1cc=0 means H2C done by FW. -+ do{ -+ val8 = rtw_read8(padapter, REG_HMETFR); -+ cnt++; -+ DBG_871X("%s polling REG_HMETFR=0x%x, cnt=%d \n", -+ __func__, val8, cnt); -+ rtw_mdelay_os(10); -+ }while(cnt<100 && (val8!=0)); -+ -+ //H2C done, enter 32k -+ if (val8 == 0) { -+ //ser rpwm to enter 32k -+ val8 = rtw_read8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HRPWM1); -+ DBG_871X("%s: read rpwm=%02x\n", __FUNCTION__, val8); -+ val8 += 0x80; -+ val8 |= BIT(0); -+ rtw_write8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HRPWM1, val8); -+ DBG_871X("%s: write rpwm=%02x\n", __FUNCTION__, val8); -+ adapter_to_pwrctl(padapter)->tog = (val8 + 0x80) & 0x80; -+ cnt = val8 = 0; -+ if (parm[1] == 0 || parm[2] == 0) { -+ do { -+ val8 = rtw_read8(padapter, REG_CR); -+ cnt++; -+ DBG_871X("%s polling 0x100=0x%x, cnt=%d \n", -+ __func__, val8, cnt); -+ DBG_871X("%s 0x08:%02x, 0x03:%02x\n", -+ __func__, -+ rtw_read8(padapter, 0x08), -+ rtw_read8(padapter, 0x03)); -+ rtw_mdelay_os(10); -+ } while(cnt<20 && (val8!=0xEA)); -+ } -+ } -+ } else { -+ //Leave IPS -+ DBG_871X("%s: Leaving IPS in FWLPS state\n", __func__); -+ -+ //for polling cpwm -+ cpwm_orig = 0; -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig); -+ -+ //ser rpwm -+ val8 = rtw_read8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HRPWM1); -+ val8 &= 0x80; -+ val8 += 0x80; -+ val8 |= BIT(6); -+ rtw_write8(padapter, SDIO_LOCAL_BASE|SDIO_REG_HRPWM1, val8); -+ DBG_871X("%s: write rpwm=%02x\n", __FUNCTION__, val8); -+ adapter_to_pwrctl(padapter)->tog = (val8 + 0x80) & 0x80; -+ -+ //do polling cpwm -+ start_time = rtw_get_current_time(); -+ do { -+ -+ rtw_mdelay_os(1); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_now); -+ if ((cpwm_orig ^ cpwm_now) & 0x80) { -+ break; -+ } -+ -+ if (rtw_get_passing_time_ms(start_time) > 100) -+ { -+ DBG_871X("%s: polling cpwm timeout when leaving IPS in FWLPS state\n", __FUNCTION__); -+ break; -+ } -+ } while (1); -+ -+ parm[0] = 0x0; -+ parm[1] = 0x0; -+ parm[2] = 0x0; -+ rtw_hal_fill_h2c_cmd(padapter, H2C_INACTIVE_PS_, -+ H2C_INACTIVE_PS_LEN, parm); -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_IpsNotify(padapter, IPS_NONE); -+#endif -+ } -+} -+#endif //CONFIG_PNO_SUPPORT -+ -+void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode, const char *msg) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; +#ifdef CONFIG_P2P + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); +#endif //CONFIG_P2P @@ -59871,7 +41358,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + struct sta_info *ptdls_sta; +#endif //CONFIG_TDLS + -+_func_enter_; ++ + + RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, + ("%s: PowerMode=%d Smart_PS=%d\n", @@ -59886,13 +41373,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + { + if (PS_MODE_ACTIVE == ps_mode) return; + -+#ifndef CONFIG_BT_COEXIST + if ((pwrpriv->smart_ps == smart_ps) && + (pwrpriv->bcn_ant_mode == bcn_ant_mode)) + { + return; + } -+#endif // !CONFIG_BT_COEXIST + } + +#ifdef CONFIG_LPS_LCLK @@ -59902,30 +41387,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + //if(pwrpriv->pwr_mode == PS_MODE_ACTIVE) + if(ps_mode == PS_MODE_ACTIVE) + { -+ if (1 -+#ifdef CONFIG_BT_COEXIST -+ && (((rtw_btcoex_IsBtControlLps(padapter) == _FALSE) +#ifdef CONFIG_P2P_PS -+ && (pwdinfo->opp_ps == 0) -+#endif // CONFIG_P2P_PS -+ ) -+ || ((rtw_btcoex_IsBtControlLps(padapter) == _TRUE) -+ && (rtw_btcoex_IsLpsOn(padapter) == _FALSE)) -+ ) -+#else // !CONFIG_BT_COEXIST -+#ifdef CONFIG_P2P_PS -+ && (pwdinfo->opp_ps == 0) -+#endif // CONFIG_P2P_PS -+#endif // !CONFIG_BT_COEXIST -+ ) ++ if(pwdinfo->opp_ps == 0) ++#endif //CONFIG_P2P_PS + { -+ DBG_871X(FUNC_ADPT_FMT" Leave 802.11 power save - %s\n", -+ FUNC_ADPT_ARG(padapter), msg); ++ DBG_871X("rtw_set_ps_mode: Leave 802.11 power save\n"); + -+ if (pwrpriv->lps_leave_cnts < UINT_MAX) -+ pwrpriv->lps_leave_cnts++; -+ else -+ pwrpriv->lps_leave_cnts = 0; +#ifdef CONFIG_TDLS + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); + @@ -59934,12 +41401,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + phead = &(pstapriv->sta_hash[i]); + plist = get_next(phead); + -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) ++ while ((rtw_end_of_queue_search(phead, plist)) == false) + { + ptdls_sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); + + if( ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE ) -+ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 0, 0, 0); ++ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta, 0); + plist = get_next(plist); + } + } @@ -59949,62 +41416,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + + pwrpriv->pwr_mode = ps_mode; + rtw_set_rpwm(padapter, PS_STATE_S4); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_P2P_WOWLAN) -+ if (pwrpriv->wowlan_mode == _TRUE || -+ pwrpriv->wowlan_ap_mode == _TRUE || -+ pwrpriv->wowlan_p2p_mode == _TRUE) -+ { -+ u32 start_time, delay_ms; -+ u8 val8; -+ delay_ms = 20; -+ start_time = rtw_get_current_time(); -+ do { -+ rtw_hal_get_hwreg(padapter, HW_VAR_SYS_CLKR, &val8); -+ if (!(val8 & BIT(4))){ //0x08 bit4 =1 --> in 32k, bit4 = 0 --> leave 32k -+ pwrpriv->cpwm = PS_STATE_S4; -+ break; -+ } -+ if (rtw_get_passing_time_ms(start_time) > delay_ms) -+ { -+ DBG_871X("%s: Wait for FW 32K leave more than %u ms!!!\n", -+ __FUNCTION__, delay_ms); -+ pdbgpriv->dbg_wow_leave_ps_fail_cnt++; -+ break; -+ } -+ rtw_usleep_os(100); -+ } while (1); -+ } -+#endif + rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); -+ pwrpriv->bFwCurrentInPSMode = _FALSE; -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_LpsNotify(padapter, ps_mode); -+#endif // CONFIG_BT_COEXIST ++ pwrpriv->bFwCurrentInPSMode = false; + } + } + else + { -+ if ((PS_RDY_CHECK(padapter) && check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE)) ++ if (PS_RDY_CHECK(padapter) +#ifdef CONFIG_BT_COEXIST -+ || ((rtw_btcoex_IsBtControlLps(padapter) == _TRUE) -+ && (rtw_btcoex_IsLpsOn(padapter) == _TRUE)) ++ || (BT_1Ant(padapter) == true) +#endif -+#ifdef CONFIG_P2P_WOWLAN -+ ||( _TRUE == pwrpriv->wowlan_p2p_mode) -+#endif //CONFIG_P2P_WOWLAN + ) + { -+ u8 pslv; ++ DBG_871X("%s: Enter 802.11 power save\n", __FUNCTION__); + -+ DBG_871X(FUNC_ADPT_FMT" Enter 802.11 power save - %s\n", -+ FUNC_ADPT_ARG(padapter), msg); -+ -+ if (pwrpriv->lps_enter_cnts < UINT_MAX) -+ pwrpriv->lps_enter_cnts++; -+ else -+ pwrpriv->lps_enter_cnts = 0; +#ifdef CONFIG_TDLS + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); + @@ -60013,12 +41438,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + phead = &(pstapriv->sta_hash[i]); + plist = get_next(phead); + -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) ++ while ((rtw_end_of_queue_search(phead, plist)) == false) + { + ptdls_sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); + + if( ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE ) -+ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 1, 0, 0); ++ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta, 1); + plist = get_next(plist); + } + } @@ -60026,11 +41451,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); +#endif //CONFIG_TDLS + -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_LpsNotify(padapter, ps_mode); -+#endif // CONFIG_BT_COEXIST -+ -+ pwrpriv->bFwCurrentInPSMode = _TRUE; ++ pwrpriv->bFwCurrentInPSMode = true; + pwrpriv->pwr_mode = ps_mode; + pwrpriv->smart_ps = smart_ps; + pwrpriv->bcn_ant_mode = bcn_ant_mode; @@ -60042,26 +41463,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + p2p_ps_wk_cmd(padapter, P2P_PS_ENABLE, 0); +#endif //CONFIG_P2P_PS + -+ pslv = PS_STATE_S2; +#ifdef CONFIG_LPS_LCLK + if (pwrpriv->alives == 0) -+ pslv = PS_STATE_S0; -+#endif // CONFIG_LPS_LCLK -+ -+#ifdef CONFIG_BT_COEXIST -+ if ((rtw_btcoex_IsBtDisabled(padapter) == _FALSE) -+ && (rtw_btcoex_IsBtControlLps(padapter) == _TRUE)) -+ { -+ u8 val8; -+ -+ val8 = rtw_btcoex_LpsVal(padapter); -+ if (val8 & BIT(4)) -+ pslv = PS_STATE_S2; -+ -+ } -+#endif // CONFIG_BT_COEXIST -+ -+ rtw_set_rpwm(padapter, pslv); ++ rtw_set_rpwm(padapter, PS_STATE_S0); ++#else ++ rtw_set_rpwm(padapter, PS_STATE_S2); ++#endif + } + } + @@ -60069,7 +41476,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + _exit_pwrlock(&pwrpriv->lock); +#endif + -+_func_exit_; ++ +} + +/* @@ -60081,7 +41488,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +s32 LPS_RF_ON_check(PADAPTER padapter, u32 delay_ms) +{ + u32 start_time; -+ u8 bAwake = _FALSE; ++ u8 bAwake = false; + s32 err = 0; + + @@ -60089,10 +41496,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + while (1) + { + rtw_hal_get_hwreg(padapter, HW_VAR_FWLPS_RF_ON, &bAwake); -+ if (_TRUE == bAwake) ++ if (true == bAwake) + break; + -+ if (rtw_is_surprise_removed(padapter)) { ++ if (true == padapter->bSurpriseRemoved) ++ { + err = -2; + DBG_871X("%s: device surprise removed!!\n", __FUNCTION__); + break; @@ -60114,59 +41522,58 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +// Description: +// Enter the leisure power save mode. +// -+void LPS_Enter(PADAPTER padapter, const char *msg) ++void LPS_Enter(PADAPTER padapter) +{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + _adapter *buddy = padapter->pbuddy_adapter; -+ int n_assoc_iface = 0; -+ int i; -+ char buf[32] = {0}; + -+_func_enter_; ++ + +// DBG_871X("+LeisurePSEnter\n"); + -+#ifdef CONFIG_BT_COEXIST -+ if (rtw_btcoex_IsBtControlLps(padapter) == _TRUE) -+ return; ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->iface_type != IFACE_PORT0) ++ return; /* Skip power saving for concurrent mode port 1*/ ++ ++ /* consider buddy, if exist */ ++ if (buddy) { ++ struct mlme_priv *b_pmlmepriv = &(buddy->mlmepriv); ++ #ifdef CONFIG_P2P ++ struct wifidirect_info *b_pwdinfo = &(buddy->wdinfo); ++ #ifdef CONFIG_IOCTL_CFG80211 ++ struct cfg80211_wifidirect_info *b_pcfg80211_wdinfo = &buddy->cfg80211_wdinfo; ++ #endif ++ #endif ++ ++ if (check_fwstate(b_pmlmepriv, WIFI_ASOC_STATE|WIFI_SITE_MONITOR) ++ || check_fwstate(b_pmlmepriv, WIFI_UNDER_LINKING|WIFI_UNDER_WPS) ++ || check_fwstate(b_pmlmepriv, WIFI_AP_STATE) ++ || check_fwstate(b_pmlmepriv, WIFI_ADHOC_MASTER_STATE|WIFI_ADHOC_STATE) ++ #if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_P2P_IPS) ++ || b_pcfg80211_wdinfo->is_ro_ch ++ #elif defined(CONFIG_P2P) ++ || !rtw_p2p_chk_state(b_pwdinfo, P2P_STATE_NONE) ++ #endif ++ || rtw_is_scan_deny(buddy) ++ ) { ++ return; ++ } ++ } +#endif + -+ /* Skip lps enter request if number of assocated adapters is not 1 */ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) -+ n_assoc_iface++; -+ } -+ if (n_assoc_iface != 1) ++ if (PS_RDY_CHECK(padapter) == false) + return; + -+ /* Skip lps enter request for adapter not port0 */ -+ if (get_iface_type(padapter) != IFACE_PORT0) -+ return; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (PS_RDY_CHECK(dvobj->padapters[i]) == _FALSE) -+ return; -+ } -+ -+#ifdef CONFIG_P2P_PS -+ if(padapter->wdinfo.p2p_ps_mode == P2P_PS_NOA) -+ { -+ return;//supporting p2p client ps NOA via H2C_8723B_P2P_PS_OFFLOAD -+ } -+#endif //CONFIG_P2P_PS -+ + if (pwrpriv->bLeisurePs) + { + // Idle for a while if we connect to AP a while ago. -+ if (pwrpriv->LpsIdleCount >= 2) // 4 Sec ++ if(pwrpriv->LpsIdleCount >= 2) // 4 Sec + { + if(pwrpriv->pwr_mode == PS_MODE_ACTIVE) + { -+ sprintf(buf, "WIFI-%s", msg); -+ pwrpriv->bpower_saving = _TRUE; -+ rtw_set_ps_mode(padapter, pwrpriv->power_mgnt, padapter->registrypriv.smart_ps, 0, buf); ++ pwrpriv->bpower_saving = true; ++ rtw_set_ps_mode(padapter, pwrpriv->power_mgnt, padapter->registrypriv.smart_ps, 0); + } + } + else @@ -60175,217 +41582,62 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + +// DBG_871X("-LeisurePSEnter\n"); + -+_func_exit_; ++ +} + +// +// Description: +// Leave the leisure power save mode. +// -+void LPS_Leave(PADAPTER padapter, const char *msg) ++void LPS_Leave(PADAPTER padapter) +{ +#define LPS_LEAVE_TIMEOUT_MS 100 + -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + u32 start_time; -+ u8 bAwake = _FALSE; -+ char buf[32] = {0}; -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; ++ u8 bAwake = false; + -+_func_enter_; ++ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->iface_type != IFACE_PORT0) ++ return; /* Skip power saving for concurrent mode port 1*/ ++#endif + +// DBG_871X("+LeisurePSLeave\n"); + -+#ifdef CONFIG_BT_COEXIST -+ if (rtw_btcoex_IsBtControlLps(padapter) == _TRUE) -+ return; -+#endif -+ + if (pwrpriv->bLeisurePs) + { + if(pwrpriv->pwr_mode != PS_MODE_ACTIVE) + { -+ sprintf(buf, "WIFI-%s", msg); -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, buf); ++ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0); + + if(pwrpriv->pwr_mode == PS_MODE_ACTIVE) + LPS_RF_ON_check(padapter, LPS_LEAVE_TIMEOUT_MS); + } + } + -+ pwrpriv->bpower_saving = _FALSE; -+#ifdef DBG_CHECK_FW_PS_STATE -+ if(rtw_fw_ps_state(padapter) == _FAIL) -+ { -+ DBG_871X("leave lps, fw in 32k\n"); -+ pdbgpriv->dbg_leave_lps_fail_cnt++; -+ } -+#endif //DBG_CHECK_FW_PS_STATE ++ pwrpriv->bpower_saving = false; ++ +// DBG_871X("-LeisurePSLeave\n"); + -+_func_exit_; ++ +} +#endif + -+void LeaveAllPowerSaveModeDirect(PADAPTER Adapter) -+{ -+ PADAPTER pri_padapter = GET_PRIMARY_ADAPTER(Adapter); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); -+ struct dvobj_priv *psdpriv = Adapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+#ifndef CONFIG_DETECT_CPWM_BY_POLLING -+ u8 cpwm_orig, cpwm_now; -+ u32 start_time; -+#endif // CONFIG_DETECT_CPWM_BY_POLLING -+ -+_func_enter_; -+ -+ DBG_871X("%s.....\n",__FUNCTION__); -+ -+ if (rtw_is_surprise_removed(Adapter)) { -+ DBG_871X(FUNC_ADPT_FMT ": bSurpriseRemoved=_TRUE Skip!\n", FUNC_ADPT_ARG(Adapter)); -+ return; -+ } -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+#ifdef CONFIG_CONCURRENT_MODE -+ || (check_buddy_fwstate(Adapter,_FW_LINKED) == _TRUE) -+#endif -+ ) -+ { //connect -+ -+ if(pwrpriv->pwr_mode == PS_MODE_ACTIVE) { -+ DBG_871X("%s: Driver Already Leave LPS\n",__FUNCTION__); -+ return; -+ } -+ -+#ifdef CONFIG_LPS_LCLK -+ _enter_pwrlock(&pwrpriv->lock); -+ -+#ifndef CONFIG_DETECT_CPWM_BY_POLLING -+ cpwm_orig = 0; -+ rtw_hal_get_hwreg(Adapter, HW_VAR_CPWM, &cpwm_orig); -+#endif //CONFIG_DETECT_CPWM_BY_POLLING -+ rtw_set_rpwm(Adapter, PS_STATE_S4); -+ -+#ifndef CONFIG_DETECT_CPWM_BY_POLLING -+ -+ start_time = rtw_get_current_time(); -+ -+ // polling cpwm -+ do { -+ rtw_mdelay_os(1); -+ -+ rtw_hal_get_hwreg(Adapter, HW_VAR_CPWM, &cpwm_now); -+ if ((cpwm_orig ^ cpwm_now) & 0x80) -+ { -+ pwrpriv->cpwm = PS_STATE_S4; -+ pwrpriv->cpwm_tog = cpwm_now & PS_TOGGLE; -+#ifdef DBG_CHECK_FW_PS_STATE -+ DBG_871X("%s: polling cpwm OK! cpwm_orig=%02x, cpwm_now=%02x, 0x100=0x%x \n" -+ , __FUNCTION__, cpwm_orig, cpwm_now, rtw_read8(Adapter, REG_CR)); -+ if(rtw_fw_ps_state(Adapter) == _FAIL) -+ { -+ DBG_871X("%s: leave 32k but fw state in 32k\n", __FUNCTION__); -+ pdbgpriv->dbg_rpwm_toogle_cnt++; -+ } -+#endif //DBG_CHECK_FW_PS_STATE -+ break; -+ } -+ -+ if (rtw_get_passing_time_ms(start_time) > LPS_RPWM_WAIT_MS) -+ { -+ DBG_871X("%s: polling cpwm timeout! cpwm_orig=%02x, cpwm_now=%02x \n", __FUNCTION__, cpwm_orig, cpwm_now); -+#ifdef DBG_CHECK_FW_PS_STATE -+ if(rtw_fw_ps_state(Adapter) == _FAIL) -+ { -+ DBG_871X("rpwm timeout and fw ps state in 32k\n"); -+ pdbgpriv->dbg_rpwm_timeout_fail_cnt++; -+ } -+#endif //DBG_CHECK_FW_PS_STATE -+ break; -+ } -+ } while (1); -+#endif // CONFIG_DETECT_CPWM_BY_POLLING -+ -+ _exit_pwrlock(&pwrpriv->lock); -+#endif -+ -+#ifdef CONFIG_P2P_PS -+ p2p_ps_wk_cmd(pri_padapter, P2P_PS_DISABLE, 0); -+#endif //CONFIG_P2P_PS -+ -+#ifdef CONFIG_LPS -+ rtw_lps_ctrl_wk_cmd(pri_padapter, LPS_CTRL_LEAVE, 0); -+#endif -+ } -+ else -+ { -+ if(pwrpriv->rf_pwrstate== rf_off) -+ { -+ #ifdef CONFIG_AUTOSUSPEND -+ if(Adapter->registrypriv.usbss_enable) -+ { -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ usb_disable_autosuspend(adapter_to_dvobj(Adapter)->pusbdev); -+ #elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,22) && LINUX_VERSION_CODE<=KERNEL_VERSION(2,6,34)) -+ adapter_to_dvobj(Adapter)->pusbdev->autosuspend_disabled = Adapter->bDisableAutosuspend;//autosuspend disabled by the user -+ #endif -+ } -+ else -+ #endif -+ { -+#if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_RTL8188E) -+ #ifdef CONFIG_IPS -+ if(_FALSE == ips_leave(pri_padapter)) -+ { -+ DBG_871X("======> ips_leave fail.............\n"); -+ } -+ #endif -+#endif //CONFIG_SWLPS_IN_IPS || (CONFIG_PLATFORM_SPRD && CONFIG_RTL8188E) -+ } -+ } -+ } -+ -+_func_exit_; -+} -+ +// +// Description: Leave all power save mode: LPS, FwLPS, IPS if needed. -+// Move code to function by tynli. 2010.03.26. ++// Move code to function by tynli. 2010.03.26. +// -+void LeaveAllPowerSaveMode(IN PADAPTER Adapter) ++void LeaveAllPowerSaveMode(PADAPTER Adapter) +{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); + struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); + u8 enqueue = 0; -+ int n_assoc_iface = 0; -+ int i; + -+_func_enter_; ++ + + //DBG_871X("%s.....\n",__FUNCTION__); -+ -+ if (_FALSE == Adapter->bup) -+ { -+ DBG_871X(FUNC_ADPT_FMT ": bup=%d Skip!\n", -+ FUNC_ADPT_ARG(Adapter), Adapter->bup); -+ return; -+ } -+ -+ if (rtw_is_surprise_removed(Adapter)) { -+ DBG_871X(FUNC_ADPT_FMT ": bSurpriseRemoved=_TRUE Skip!\n", FUNC_ADPT_ARG(Adapter)); -+ return; -+ } -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) -+ n_assoc_iface++; -+ } -+ -+ if (n_assoc_iface) ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) + { //connect +#ifdef CONFIG_LPS_LCLK + enqueue = 1; @@ -60401,11 +41653,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + +#ifdef CONFIG_LPS_LCLK + LPS_Leave_check(Adapter); -+#endif ++#endif + } + else + { -+ if(adapter_to_pwrctl(Adapter)->rf_pwrstate== rf_off) ++ if(Adapter->pwrctrlpriv.rf_pwrstate== rf_off) + { + #ifdef CONFIG_AUTOSUSPEND + if(Adapter->registrypriv.usbss_enable) @@ -60419,19 +41671,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + else + #endif + { -+#if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) || (defined(CONFIG_PLATFORM_SPRD) && defined(CONFIG_RTL8188E)) -+ #ifdef CONFIG_IPS -+ if(_FALSE == ips_leave(Adapter)) -+ { -+ DBG_871X("======> ips_leave fail.............\n"); -+ } -+ #endif -+#endif //CONFIG_SWLPS_IN_IPS || (CONFIG_PLATFORM_SPRD && CONFIG_RTL8188E) -+ } -+ } ++ } ++ } + } + -+_func_exit_; ++ +} + +#ifdef CONFIG_LPS_LCLK @@ -60442,33 +41686,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + u32 start_time; + u8 bReady; + -+_func_enter_; + -+ pwrpriv = adapter_to_pwrctl(padapter); + -+ bReady = _FALSE; ++ pwrpriv = &padapter->pwrctrlpriv; ++ ++ bReady = false; + start_time = rtw_get_current_time(); + + rtw_yield_os(); -+ ++ + while(1) + { + _enter_pwrlock(&pwrpriv->lock); + -+ if (rtw_is_surprise_removed(padapter) -+ || (!rtw_is_hw_init_completed(padapter)) -+#ifdef CONFIG_USB_HCI -+ || rtw_is_drv_stopped(padapter) -+#endif ++ if ((padapter->bSurpriseRemoved == true) ++ || (padapter->hw_init_completed == false) ++ || (padapter->bDriverStopped== true) + || (pwrpriv->pwr_mode == PS_MODE_ACTIVE) + ) + { -+ bReady = _TRUE; ++ bReady = true; + } + + _exit_pwrlock(&pwrpriv->lock); + -+ if(_TRUE == bReady) ++ if(true == bReady) + break; + + if(rtw_get_passing_time_ms(start_time)>100) @@ -60479,7 +41721,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + rtw_msleep_os(1); + } + -+_func_exit_; ++ +} + +/* @@ -60495,9 +41737,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +{ + struct pwrctrl_priv *pwrpriv; + -+_func_enter_; + -+ pwrpriv = adapter_to_pwrctl(padapter); ++ ++ pwrpriv = &padapter->pwrctrlpriv; +#if 0 + if (pwrpriv->cpwm_tog == (preportpwrstate->state & PS_TOGGLE)) { + RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_err_, @@ -60536,14 +41778,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, + ("cpwm_int_hdl: cpwm=0x%02x\n", pwrpriv->cpwm)); + -+_func_exit_; ++ +} + +static void cpwm_event_callback(struct work_struct *work) +{ + struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, cpwm_event); -+ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); -+ _adapter *adapter = dvobj->padapters[IFACE_ID0]; ++ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); + struct reportpwrstate_parm report; + + //DBG_871X("%s\n",__FUNCTION__); @@ -60556,13 +41797,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +static void rpwmtimeout_workitem_callback(struct work_struct *work) +{ + PADAPTER padapter; -+ struct dvobj_priv *dvobj; + struct pwrctrl_priv *pwrpriv; + + + pwrpriv = container_of(work, struct pwrctrl_priv, rpwmtimeoutwi); -+ dvobj = pwrctl_to_dvobj(pwrpriv); -+ padapter = dvobj->padapters[IFACE_ID0]; ++ padapter = container_of(pwrpriv, _adapter, pwrctrlpriv); +// DBG_871X("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); + + _enter_pwrlock(&pwrpriv->lock); @@ -60595,9 +41834,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + DBG_871X("%s: cpwm=%d, nothing to do!\n", __func__, pwrpriv->cpwm); + goto exit; + } -+ pwrpriv->brpwmtimeout = _TRUE; ++ pwrpriv->brpwmtimeout = true; + rtw_set_rpwm(padapter, pwrpriv->rpwm); -+ pwrpriv->brpwmtimeout = _FALSE; ++ pwrpriv->brpwmtimeout = false; + +exit: + _exit_pwrlock(&pwrpriv->lock); @@ -60613,8 +41852,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + + + padapter = (PADAPTER)FunctionContext; -+ pwrpriv = adapter_to_pwrctl(padapter); -+ DBG_871X("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); ++ pwrpriv = &padapter->pwrctrlpriv; ++// DBG_871X("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); + + if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) + { @@ -60636,133 +41875,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + pwrctrl->alives &= ~tag; +} + -+ -+/* -+ * Description: -+ * Check if the fw_pwrstate is okay for I/O. -+ * If not (cpwm is less than S2), then the sub-routine -+ * will raise the cpwm to be greater than or equal to S2. -+ * -+ * Calling Context: Passive -+ * -+ * Constraint: -+ * 1. this function will request pwrctrl->lock -+ * -+ * Return Value: -+ * _SUCCESS hardware is ready for I/O -+ * _FAIL can't I/O right now -+ */ -+s32 rtw_register_task_alive(PADAPTER padapter, u32 task) -+{ -+ s32 res; -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+_func_enter_; -+ -+ res = _SUCCESS; -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S2; -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ register_task_alive(pwrctrl, task); -+ -+ if (pwrctrl->bFwCurrentInPSMode == _TRUE) -+ { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("%s: task=0x%x cpwm=0x%02x alives=0x%08x\n", -+ __FUNCTION__, task, pwrctrl->cpwm, pwrctrl->alives)); -+ -+ if (pwrctrl->cpwm < pslv) -+ { -+ if (pwrctrl->cpwm < PS_STATE_S2) -+ res = _FAIL; -+ if (pwrctrl->rpwm < pslv) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+#ifdef CONFIG_DETECT_CPWM_BY_POLLING -+ if (_FAIL == res) -+ { -+ if (pwrctrl->cpwm >= PS_STATE_S2) -+ res = _SUCCESS; -+ } -+#endif // CONFIG_DETECT_CPWM_BY_POLLING -+ -+_func_exit_; -+ -+ return res; -+} -+ -+/* -+ * Description: -+ * If task is done, call this func. to power down firmware again. -+ * -+ * Constraint: -+ * 1. this function will request pwrctrl->lock -+ * -+ * Return Value: -+ * none -+ */ -+void rtw_unregister_task_alive(PADAPTER padapter, u32 task) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+_func_enter_; -+ -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S0; -+ -+#ifdef CONFIG_BT_COEXIST -+ if ((rtw_btcoex_IsBtDisabled(padapter) == _FALSE) -+ && (rtw_btcoex_IsBtControlLps(padapter) == _TRUE)) -+ { -+ u8 val8; -+ -+ val8 = rtw_btcoex_LpsVal(padapter); -+ if (val8 & BIT(4)) -+ pslv = PS_STATE_S2; -+ -+ } -+#endif // CONFIG_BT_COEXIST -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ unregister_task_alive(pwrctrl, task); -+ -+ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) -+ && (pwrctrl->bFwCurrentInPSMode == _TRUE)) -+ { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("%s: cpwm=0x%02x alives=0x%08x\n", -+ __FUNCTION__, pwrctrl->cpwm, pwrctrl->alives)); -+ -+ if (pwrctrl->cpwm > pslv) -+ { -+ if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+_func_exit_; -+} -+ +/* + * Caller: rtw_xmit_thread -+ * ++ * + * Check if the fw_pwrstate is okay for xmit. + * If not (cpwm is less than S3), then the sub-routine -+ * will raise the cpwm to be greater than or equal to S3. ++ * will raise the cpwm to be greater than or equal to S3. + * + * Calling Context: Passive -+ * ++ * + * Return Value: + * _SUCCESS rtw_xmit_thread can write fifo/txcmd afterwards. + * _FAIL rtw_xmit_thread can not do anything. @@ -60773,17 +41894,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + struct pwrctrl_priv *pwrctrl; + u8 pslv; + -+_func_enter_; ++ + + res = _SUCCESS; -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S2; ++ pwrctrl = &padapter->pwrctrlpriv; ++#ifdef CONFIG_BT_COEXIST ++ if (true == pwrctrl->btcoex_rfon) ++ pslv = PS_STATE_S3; ++ else ++#endif ++ { ++ pslv = PS_STATE_S2; ++ } + + _enter_pwrlock(&pwrctrl->lock); + + register_task_alive(pwrctrl, XMIT_ALIVE); + -+ if (pwrctrl->bFwCurrentInPSMode == _TRUE) ++ if (pwrctrl->bFwCurrentInPSMode == true) + { + RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, + ("rtw_register_tx_alive: cpwm=0x%02x alives=0x%08x\n", @@ -60800,17 +41928,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + + _exit_pwrlock(&pwrctrl->lock); + -+#ifdef CONFIG_DETECT_CPWM_BY_POLLING -+ if (_FAIL == res) -+ { -+ if (pwrctrl->cpwm >= PS_STATE_S2) -+ res = _SUCCESS; -+ } -+#endif // CONFIG_DETECT_CPWM_BY_POLLING + -+_func_exit_; + -+ return res; ++ return res; +} + +/* @@ -60832,17 +41952,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + struct pwrctrl_priv *pwrctrl; + u8 pslv; + -+_func_enter_; ++ + + res = _SUCCESS; -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S2; ++ pwrctrl = &padapter->pwrctrlpriv; ++#ifdef CONFIG_BT_COEXIST ++ if (true == pwrctrl->btcoex_rfon) ++ pslv = PS_STATE_S3; ++ else ++#endif ++ { ++ pslv = PS_STATE_S2; ++ } + + _enter_pwrlock(&pwrctrl->lock); + + register_task_alive(pwrctrl, CMD_ALIVE); + -+ if (pwrctrl->bFwCurrentInPSMode == _TRUE) ++ if (pwrctrl->bFwCurrentInPSMode == true) + { + RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_info_, + ("rtw_register_cmd_alive: cpwm=0x%02x alives=0x%08x\n", @@ -60859,15 +41986,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + + _exit_pwrlock(&pwrctrl->lock); + -+#ifdef CONFIG_DETECT_CPWM_BY_POLLING -+ if (_FAIL == res) -+ { -+ if (pwrctrl->cpwm >= PS_STATE_S2) -+ res = _SUCCESS; -+ } -+#endif // CONFIG_DETECT_CPWM_BY_POLLING + -+_func_exit_; + + return res; +} @@ -60885,9 +42004,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +{ + struct pwrctrl_priv *pwrctrl; + -+_func_enter_; + -+ pwrctrl = adapter_to_pwrctl(padapter); ++ ++ pwrctrl = &padapter->pwrctrlpriv; + + _enter_pwrlock(&pwrctrl->lock); + @@ -60898,7 +42017,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + + _exit_pwrlock(&pwrctrl->lock); + -+_func_exit_; ++ + + return _SUCCESS; +} @@ -60916,9 +42035,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +{ + struct pwrctrl_priv *pwrctrl; + -+_func_enter_; + -+ pwrctrl = adapter_to_pwrctl(padapter); ++ ++ pwrctrl = &padapter->pwrctrlpriv; + + _enter_pwrlock(&pwrctrl->lock); + @@ -60929,7 +42048,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + + _exit_pwrlock(&pwrctrl->lock); + -+_func_exit_; ++ + + return _SUCCESS; +} @@ -60944,61 +42063,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +void rtw_unregister_tx_alive(PADAPTER padapter) +{ + struct pwrctrl_priv *pwrctrl; -+ u8 pslv; + -+_func_enter_; + -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S0; + -+#ifdef CONFIG_BT_COEXIST -+ if ((rtw_btcoex_IsBtDisabled(padapter) == _FALSE) -+ && (rtw_btcoex_IsBtControlLps(padapter) == _TRUE)) -+ { -+ u8 val8; -+ -+ val8 = rtw_btcoex_LpsVal(padapter); -+ if (val8 & BIT(4)) -+ pslv = PS_STATE_S2; -+ -+ } -+#endif // CONFIG_BT_COEXIST -+ -+#ifdef CONFIG_P2P_PS -+ if(padapter->wdinfo.p2p_ps_mode > P2P_PS_NONE) -+ { -+ pslv = PS_STATE_S2; -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ else if(rtw_buddy_adapter_up(padapter)) -+ { -+ if(padapter->pbuddy_adapter->wdinfo.p2p_ps_mode > P2P_PS_NONE) -+ pslv = PS_STATE_S2; -+ } -+#endif -+#endif ++ pwrctrl = &padapter->pwrctrlpriv; + + _enter_pwrlock(&pwrctrl->lock); + + unregister_task_alive(pwrctrl, XMIT_ALIVE); + -+ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) -+ && (pwrctrl->bFwCurrentInPSMode == _TRUE)) ++ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) && ++ (pwrctrl->bFwCurrentInPSMode == true)) + { + RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, + ("%s: cpwm=0x%02x alives=0x%08x\n", + __FUNCTION__, pwrctrl->cpwm, pwrctrl->alives)); + -+ if (pwrctrl->cpwm > pslv) ++ if ((pwrctrl->alives == 0) && ++ (pwrctrl->cpwm > PS_STATE_S0)) + { -+ if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) -+ rtw_set_rpwm(padapter, pslv); ++ rtw_set_rpwm(padapter, PS_STATE_S0); + } + } + + _exit_pwrlock(&pwrctrl->lock); + -+_func_exit_; ++ +} + +/* @@ -61011,61 +42101,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +void rtw_unregister_cmd_alive(PADAPTER padapter) +{ + struct pwrctrl_priv *pwrctrl; -+ u8 pslv; + -+_func_enter_; + -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S0; + -+#ifdef CONFIG_BT_COEXIST -+ if ((rtw_btcoex_IsBtDisabled(padapter) == _FALSE) -+ && (rtw_btcoex_IsBtControlLps(padapter) == _TRUE)) -+ { -+ u8 val8; -+ -+ val8 = rtw_btcoex_LpsVal(padapter); -+ if (val8 & BIT(4)) -+ pslv = PS_STATE_S2; -+ -+ } -+#endif // CONFIG_BT_COEXIST -+ -+#ifdef CONFIG_P2P_PS -+ if(padapter->wdinfo.p2p_ps_mode > P2P_PS_NONE) -+ { -+ pslv = PS_STATE_S2; -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ else if(rtw_buddy_adapter_up(padapter)) -+ { -+ if(padapter->pbuddy_adapter->wdinfo.p2p_ps_mode > P2P_PS_NONE) -+ pslv = PS_STATE_S2; -+ } -+#endif -+#endif ++ pwrctrl = &padapter->pwrctrlpriv; + + _enter_pwrlock(&pwrctrl->lock); + + unregister_task_alive(pwrctrl, CMD_ALIVE); + -+ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) -+ && (pwrctrl->bFwCurrentInPSMode == _TRUE)) ++ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) && ++ (pwrctrl->bFwCurrentInPSMode == true)) + { + RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_info_, + ("%s: cpwm=0x%02x alives=0x%08x\n", + __FUNCTION__, pwrctrl->cpwm, pwrctrl->alives)); + -+ if (pwrctrl->cpwm > pslv) ++ if ((pwrctrl->alives == 0) && ++ (pwrctrl->cpwm > PS_STATE_S0)) + { -+ if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) -+ rtw_set_rpwm(padapter, pslv); ++ rtw_set_rpwm(padapter, PS_STATE_S0); + } + } + + _exit_pwrlock(&pwrctrl->lock); + -+_func_exit_; ++ +} + +/* @@ -61075,9 +42136,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +{ + struct pwrctrl_priv *pwrctrl; + -+_func_enter_; + -+ pwrctrl = adapter_to_pwrctl(padapter); ++ ++ pwrctrl = &padapter->pwrctrlpriv; + + _enter_pwrlock(&pwrctrl->lock); + @@ -61089,16 +42150,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + + _exit_pwrlock(&pwrctrl->lock); + -+_func_exit_; ++ +} + +void rtw_unregister_evt_alive(PADAPTER padapter) +{ + struct pwrctrl_priv *pwrctrl; + -+_func_enter_; + -+ pwrctrl = adapter_to_pwrctl(padapter); ++ ++ pwrctrl = &padapter->pwrctrlpriv; + + unregister_task_alive(pwrctrl, EVT_ALIVE); + @@ -61108,7 +42169,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + + _exit_pwrlock(&pwrctrl->lock); + -+_func_exit_; ++ +} +#endif /* CONFIG_LPS_LCLK */ + @@ -61118,42 +42179,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + +void rtw_init_pwrctrl_priv(PADAPTER padapter) +{ -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ int i = 0; -+ u8 val8 = 0; -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (padapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif -+ -+_func_enter_; -+ -+#ifdef PLATFORM_WINDOWS -+ pwrctrlpriv->pnp_current_pwr_state=NdisDeviceStateD0; -+#endif ++ struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; + + _init_pwrlock(&pwrctrlpriv->lock); -+ _init_pwrlock(&pwrctrlpriv->check_32k_lock); + pwrctrlpriv->rf_pwrstate = rf_on; + pwrctrlpriv->ips_enter_cnts=0; + pwrctrlpriv->ips_leave_cnts=0; -+ pwrctrlpriv->lps_enter_cnts=0; -+ pwrctrlpriv->lps_leave_cnts=0; -+ pwrctrlpriv->bips_processing = _FALSE; ++ pwrctrlpriv->bips_processing = false; + + pwrctrlpriv->ips_mode = padapter->registrypriv.ips_mode; + pwrctrlpriv->ips_mode_req = padapter->registrypriv.ips_mode; + + pwrctrlpriv->pwr_state_check_interval = RTW_PWR_STATE_CHK_INTERVAL; + pwrctrlpriv->pwr_state_check_cnts = 0; -+ pwrctrlpriv->bInternalAutoSuspend = _FALSE; -+ pwrctrlpriv->bInSuspend = _FALSE; -+ pwrctrlpriv->bkeepfwalive = _FALSE; ++ pwrctrlpriv->bInternalAutoSuspend = false; ++ pwrctrlpriv->bInSuspend = false; ++ pwrctrlpriv->bkeepfwalive = false; + +#ifdef CONFIG_AUTOSUSPEND +#ifdef SUPPORT_HW_RFOFF_DETECTED -+ pwrctrlpriv->pwr_state_check_interval = (pwrctrlpriv->bHWPwrPindetect) ?1000:2000; ++ pwrctrlpriv->pwr_state_check_interval = (pwrctrlpriv->bHWPwrPindetect) ?1000:2000; +#endif +#endif + @@ -61161,11 +42206,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + //pwrctrlpriv->FWCtrlPSMode =padapter->registrypriv.power_mgnt;// PS_MODE_MIN; + if (padapter->registrypriv.mp_mode == 1) + pwrctrlpriv->power_mgnt =PS_MODE_ACTIVE ; -+ else ++ else + pwrctrlpriv->power_mgnt =padapter->registrypriv.power_mgnt;// PS_MODE_MIN; -+ pwrctrlpriv->bLeisurePs = (PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt)?_TRUE:_FALSE; ++ pwrctrlpriv->bLeisurePs = (PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt)?true:false; + -+ pwrctrlpriv->bFwCurrentInPSMode = _FALSE; ++ pwrctrlpriv->bFwCurrentInPSMode = false; + + pwrctrlpriv->rpwm = 0; + pwrctrlpriv->cpwm = PS_STATE_S4; @@ -61173,28 +42218,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + pwrctrlpriv->pwr_mode = PS_MODE_ACTIVE; + pwrctrlpriv->smart_ps = padapter->registrypriv.smart_ps; + pwrctrlpriv->bcn_ant_mode = 0; -+ pwrctrlpriv->dtim = 0; + + pwrctrlpriv->tog = 0x80; + ++ pwrctrlpriv->btcoex_rfon = false; ++ +#ifdef CONFIG_LPS_LCLK + rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&pwrctrlpriv->rpwm)); + + _init_workitem(&pwrctrlpriv->cpwm_event, cpwm_event_callback, NULL); + +#ifdef CONFIG_LPS_RPWM_TIMER -+ pwrctrlpriv->brpwmtimeout = _FALSE; ++ pwrctrlpriv->brpwmtimeout = false; + _init_workitem(&pwrctrlpriv->rpwmtimeoutwi, rpwmtimeout_workitem_callback, NULL); + _init_timer(&pwrctrlpriv->pwr_rpwm_timer, padapter->pnetdev, pwr_rpwm_timeout_handler, padapter); +#endif // CONFIG_LPS_RPWM_TIMER +#endif // CONFIG_LPS_LCLK + ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + rtw_init_timer(&pwrctrlpriv->pwr_state_check_timer, padapter, pwr_state_check_handler); -+ -+ pwrctrlpriv->wowlan_mode = _FALSE; -+ pwrctrlpriv->wowlan_ap_mode = _FALSE; -+ pwrctrlpriv->wowlan_p2p_mode = _FALSE; -+ ++#else ++ timer_setup(&pwrctrlpriv->pwr_state_check_timer, pwr_state_check_handler, 0); ++#endif + #ifdef CONFIG_RESUME_IN_WORKQUEUE + _init_workitem(&pwrctrlpriv->resume_work, resume_workitem_callback, NULL); + pwrctrlpriv->rtw_workqueue = create_singlethread_workqueue("rtw_workqueue"); @@ -61205,108 +42250,57 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + rtw_register_early_suspend(pwrctrlpriv); + #endif //CONFIG_HAS_EARLYSUSPEND || CONFIG_ANDROID_POWER + -+#ifdef CONFIG_GPIO_WAKEUP -+ /*default low active*/ -+ pwrctrlpriv->is_high_active = HIGH_ACTIVE; -+ val8 = (pwrctrlpriv->is_high_active == 0) ? 1 : 0; -+ rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, val8); -+ DBG_871X("%s: set GPIO_%d %d as default.\n", -+ __func__, WAKEUP_GPIO_IDX, val8); -+#endif /* CONFIG_GPIO_WAKEUP */ + -+#ifdef CONFIG_WOWLAN -+ pwrctrlpriv->wowlan_pattern_idx = 0; -+ for (i = 0 ; i < MAX_WKFM_NUM; i++) { -+ _rtw_memset(pwrctrlpriv->patterns[i].content, '\0', -+ sizeof(pwrctrlpriv->patterns[i].content)); -+ _rtw_memset(pwrctrlpriv->patterns[i].mask, '\0', -+ sizeof(pwrctrlpriv->patterns[i].mask)); -+ pwrctrlpriv->patterns[i].len = 0; -+ } + -+#ifdef CONFIG_PNO_SUPPORT -+ pwrctrlpriv->pno_inited = _FALSE; -+ pwrctrlpriv->pnlo_info = NULL; -+ pwrctrlpriv->pscan_info = NULL; -+ pwrctrlpriv->pno_ssid_list = NULL; -+ pwrctrlpriv->pno_in_resume = _TRUE; -+#endif /* CONFIG_PNO_SUPPORT */ -+#endif /* CONFIG_WOWLAN */ -+ -+_func_exit_; + +} + + +void rtw_free_pwrctrl_priv(PADAPTER adapter) +{ -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(adapter); ++ struct pwrctrl_priv *pwrctrlpriv = &adapter->pwrctrlpriv; + -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (adapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif + -+_func_enter_; + + //_rtw_memset((unsigned char *)pwrctrlpriv, 0, sizeof(struct pwrctrl_priv)); + + + #ifdef CONFIG_RESUME_IN_WORKQUEUE -+ if (pwrctrlpriv->rtw_workqueue) { ++ if (pwrctrlpriv->rtw_workqueue) { + flush_workqueue(pwrctrlpriv->rtw_workqueue); + destroy_workqueue(pwrctrlpriv->rtw_workqueue); + } + #endif + -+#ifdef CONFIG_WOWLAN -+#ifdef CONFIG_PNO_SUPPORT -+ if (pwrctrlpriv->pnlo_info != NULL) -+ printk("****** pnlo_info memory leak********\n"); -+ -+ if (pwrctrlpriv->pscan_info != NULL) -+ printk("****** pscan_info memory leak********\n"); -+ -+ if (pwrctrlpriv->pno_ssid_list != NULL) -+ printk("****** pno_ssid_list memory leak********\n"); -+#endif -+#endif /* CONFIG_WOWLAN */ + + #if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) + rtw_unregister_early_suspend(pwrctrlpriv); + #endif //CONFIG_HAS_EARLYSUSPEND || CONFIG_ANDROID_POWER + + _free_pwrlock(&pwrctrlpriv->lock); -+ _free_pwrlock(&pwrctrlpriv->check_32k_lock); + -+_func_exit_; ++ +} + +#ifdef CONFIG_RESUME_IN_WORKQUEUE +extern int rtw_resume_process(_adapter *padapter); -+ +static void resume_workitem_callback(struct work_struct *work) +{ + struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, resume_work); -+ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); -+ _adapter *adapter = dvobj->padapters[IFACE_ID0]; ++ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); + + DBG_871X("%s\n",__FUNCTION__); + + rtw_resume_process(adapter); -+ -+ rtw_resume_unlock_suspend(); +} + +void rtw_resume_in_workqueue(struct pwrctrl_priv *pwrpriv) +{ + // accquire system's suspend lock preventing from falliing asleep while resume in workqueue -+ //rtw_lock_suspend(); ++ rtw_lock_suspend(); + -+ rtw_resume_lock_suspend(); -+ + #if 1 -+ queue_work(pwrpriv->rtw_workqueue, &pwrpriv->resume_work); ++ queue_work(pwrpriv->rtw_workqueue, &pwrpriv->resume_work); + #else + _set_workitem(&pwrpriv->resume_work); + #endif @@ -61316,12 +42310,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) +inline bool rtw_is_earlysuspend_registered(struct pwrctrl_priv *pwrpriv) +{ -+ return (pwrpriv->early_suspend.suspend) ? _TRUE : _FALSE; ++ return (pwrpriv->early_suspend.suspend) ? true : false; +} + +inline bool rtw_is_do_late_resume(struct pwrctrl_priv *pwrpriv) +{ -+ return (pwrpriv->do_late_resume) ? _TRUE : _FALSE; ++ return (pwrpriv->do_late_resume) ? true : false; +} + +inline void rtw_set_do_late_resume(struct pwrctrl_priv *pwrpriv, bool enable) @@ -61337,43 +42331,55 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); + DBG_871X("%s\n",__FUNCTION__); + -+ rtw_set_do_late_resume(pwrpriv, _FALSE); ++ rtw_set_do_late_resume(pwrpriv, false); +} + +static void rtw_late_resume(struct early_suspend *h) +{ + struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); -+ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); -+ _adapter *adapter = dvobj->padapters[IFACE_ID0]; ++ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); + + DBG_871X("%s\n",__FUNCTION__); -+ + if(pwrpriv->do_late_resume) { -+ rtw_set_do_late_resume(pwrpriv, _FALSE); ++ rtw_set_do_late_resume(pwrpriv, false); + rtw_resume_process(adapter); + } +} + +void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv) +{ ++ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); ++ ++#if defined(CONFIG_CONCURRENT_MODE) ++ if (adapter->adapter_type != PRIMARY_ADAPTER) ++ return; ++#endif ++ + DBG_871X("%s\n", __FUNCTION__); + + //jeff: set the early suspend level before blank screen, so we wll do late resume after scree is lit + pwrpriv->early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20; + pwrpriv->early_suspend.suspend = rtw_early_suspend; + pwrpriv->early_suspend.resume = rtw_late_resume; -+ register_early_suspend(&pwrpriv->early_suspend); ++ register_early_suspend(&pwrpriv->early_suspend); ++ + -+ +} + +void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv) +{ ++ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); ++ ++#if defined(CONFIG_CONCURRENT_MODE) ++ if (adapter->adapter_type != PRIMARY_ADAPTER) ++ return; ++#endif ++ + DBG_871X("%s\n", __FUNCTION__); + -+ rtw_set_do_late_resume(pwrpriv, _FALSE); ++ rtw_set_do_late_resume(pwrpriv, false); + -+ if (pwrpriv->early_suspend.suspend) ++ if (pwrpriv->early_suspend.suspend) + unregister_early_suspend(&pwrpriv->early_suspend); + + pwrpriv->early_suspend.suspend = NULL; @@ -61382,50 +42388,59 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +#endif //CONFIG_HAS_EARLYSUSPEND + +#ifdef CONFIG_ANDROID_POWER -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) +extern int rtw_resume_process(PADAPTER padapter); -+#endif +static void rtw_early_suspend(android_early_suspend_t *h) +{ + struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); + DBG_871X("%s\n",__FUNCTION__); + -+ rtw_set_do_late_resume(pwrpriv, _FALSE); ++ rtw_set_do_late_resume(pwrpriv, false); +} + +static void rtw_late_resume(android_early_suspend_t *h) +{ + struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); -+ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); -+ _adapter *adapter = dvobj->padapters[IFACE_ID0]; ++ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); + + DBG_871X("%s\n",__FUNCTION__); + if(pwrpriv->do_late_resume) { -+ #if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ rtw_set_do_late_resume(pwrpriv, _FALSE); ++ rtw_set_do_late_resume(pwrpriv, false); + rtw_resume_process(adapter); -+ #endif + } +} + +void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv) +{ ++ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); ++ ++#if defined(CONFIG_CONCURRENT_MODE) ++ if (adapter->adapter_type != PRIMARY_ADAPTER) ++ return; ++#endif ++ + DBG_871X("%s\n", __FUNCTION__); + + //jeff: set the early suspend level before blank screen, so we wll do late resume after scree is lit + pwrpriv->early_suspend.level = ANDROID_EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20; + pwrpriv->early_suspend.suspend = rtw_early_suspend; + pwrpriv->early_suspend.resume = rtw_late_resume; -+ android_register_early_suspend(&pwrpriv->early_suspend); ++ android_register_early_suspend(&pwrpriv->early_suspend); +} + +void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv) +{ ++ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); ++ ++#if defined(CONFIG_CONCURRENT_MODE) ++ if (adapter->adapter_type != PRIMARY_ADAPTER) ++ return; ++#endif ++ + DBG_871X("%s\n", __FUNCTION__); + -+ rtw_set_do_late_resume(pwrpriv, _FALSE); ++ rtw_set_do_late_resume(pwrpriv, false); + -+ if (pwrpriv->early_suspend.suspend) ++ if (pwrpriv->early_suspend.suspend) + android_unregister_early_suspend(&pwrpriv->early_suspend); + + pwrpriv->early_suspend.suspend = NULL; @@ -61435,16 +42450,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + +u8 rtw_interface_ps_func(_adapter *padapter,HAL_INTF_PS_FUNC efunc_id,u8* val) +{ -+ u8 bResult = _TRUE; ++ u8 bResult = true; + rtw_hal_intf_ps_func(padapter,efunc_id,val); -+ ++ + return bResult; +} + + +inline void rtw_set_ips_deny(_adapter *padapter, u32 ms) +{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ms); +} + @@ -61457,19 +42472,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + +int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller) +{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ struct mlme_priv *pmlmepriv; ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + int ret = _SUCCESS; -+ int i; + u32 start = rtw_get_current_time(); + -+ /* for LPS */ -+ LeaveAllPowerSaveMode(padapter); ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->pbuddy_adapter) ++ LeaveAllPowerSaveMode(padapter->pbuddy_adapter); + -+ /* IPS still bound with primary adapter */ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ pmlmepriv = &padapter->mlmepriv; ++ if ((padapter->isprimary == false) && padapter->pbuddy_adapter){ ++ padapter = padapter->pbuddy_adapter; ++ pwrpriv = &padapter->pwrctrlpriv; ++ pmlmepriv = &padapter->mlmepriv; ++ } ++#endif + + if (pwrpriv->ips_deny_time < rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms)) + pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms); @@ -61497,9 +42514,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + } +#endif + -+ if (pwrpriv->bInternalAutoSuspend == _FALSE && pwrpriv->bInSuspend) { ++ if (pwrpriv->bInternalAutoSuspend == false && pwrpriv->bInSuspend) { + DBG_871X("%s wait bInSuspend...\n", __func__); -+ while (pwrpriv->bInSuspend ++ while (pwrpriv->bInSuspend + && ((rtw_get_passing_time_ms(start) <= 3000 && !rtw_is_do_late_resume(pwrpriv)) + || (rtw_get_passing_time_ms(start) <= 500 && rtw_is_do_late_resume(pwrpriv))) + ) { @@ -61512,29 +42529,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + } + + //System suspend is not allowed to wakeup -+ if((pwrpriv->bInternalAutoSuspend == _FALSE) && (_TRUE == pwrpriv->bInSuspend )){ ++ if((pwrpriv->bInternalAutoSuspend == false) && (true == pwrpriv->bInSuspend )){ + ret = _FAIL; + goto exit; + } + + //block??? -+ if((pwrpriv->bInternalAutoSuspend == _TRUE) && (padapter->net_closed == _TRUE)) { ++ if((pwrpriv->bInternalAutoSuspend == true) && (padapter->net_closed == true)) { + ret = _FAIL; + goto exit; + } + + //I think this should be check in IPS, LPS, autosuspend functions... -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) + { +#if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) -+ if(_TRUE==pwrpriv->bInternalAutoSuspend){ ++ if(true==pwrpriv->bInternalAutoSuspend){ + if(0==pwrpriv->autopm_cnt){ -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,33)) -+ if (usb_autopm_get_interface(adapter_to_dvobj(padapter)->pusbintf) < 0) ++ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,33)) ++ if (usb_autopm_get_interface(adapter_to_dvobj(padapter)->pusbintf) < 0) + { + DBG_871X( "can't get autopm: \n"); -+ } -+ #elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,20)) ++ } ++ #elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,20)) + usb_autopm_disable(adapter_to_dvobj(padapter)->pusbintf); + #else + usb_autoresume_device(adapter_to_dvobj(padapter)->pusbdev, 1); @@ -61547,13 +42564,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 +#if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) + } +#endif //#if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) -+ } ++ } + + if(rf_off == pwrpriv->rf_pwrstate ) -+ { -+#ifdef CONFIG_USB_HCI ++ { +#ifdef CONFIG_AUTOSUSPEND -+ if(pwrpriv->brfoffbyhw==_TRUE) ++ if(pwrpriv->brfoffbyhw==true) + { + DBG_8192C("hw still in rf_off state ...........\n"); + ret = _FAIL; @@ -61567,11 +42583,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + DBG_8192C("======> autoresume fail.............\n"); + ret = _FAIL; + goto exit; -+ } ++ } + } + else +#endif -+#endif + { +#ifdef CONFIG_IPS + DBG_8192C("%s call ips_leave....\n",__FUNCTION__); @@ -61586,16 +42601,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + } + + //TODO: the following checking need to be merged... -+ if (rtw_is_drv_stopped(padapter) ++ if(padapter->bDriverStopped + || !padapter->bup -+ || !rtw_is_hw_init_completed(padapter) -+ ) { -+ DBG_8192C("%s: bDriverStopped=%s, bup=%d, hw_init_completed=%u\n" ++ || !padapter->hw_init_completed ++ ){ ++ DBG_8192C("%s: bDriverStopped=%d, bup=%d, hw_init_completed=%u\n" + , caller -+ , rtw_is_drv_stopped(padapter)?"True":"False" ++ , padapter->bDriverStopped + , padapter->bup -+ , rtw_get_hw_init_completed(padapter)); -+ ret= _FALSE; ++ , padapter->hw_init_completed); ++ ret= false; + goto exit; + } + @@ -61608,9 +42623,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + +int rtw_pm_set_lps(_adapter *padapter, u8 mode) +{ -+ int ret = 0; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ ++ int ret = 0; ++ struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; ++ + if ( mode < PS_MODE_NUM ) + { + if(pwrctrlpriv->power_mgnt !=mode) @@ -61624,7 +42639,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + pwrctrlpriv->LpsIdleCount = 2; + } + pwrctrlpriv->power_mgnt = mode; -+ pwrctrlpriv->bLeisurePs = (PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt)?_TRUE:_FALSE; ++ pwrctrlpriv->bLeisurePs = (PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt)?true:false; + } + } + else @@ -61637,17 +42652,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + +int rtw_pm_set_ips(_adapter *padapter, u8 mode) +{ -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++ struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; + + if( mode == IPS_NORMAL || mode == IPS_LEVEL_2 ) { + rtw_ips_mode_req(pwrctrlpriv, mode); + DBG_871X("%s %s\n", __FUNCTION__, mode == IPS_NORMAL?"IPS_NORMAL":"IPS_LEVEL_2"); + return 0; -+ } ++ } + else if(mode ==IPS_NONE){ + rtw_ips_mode_req(pwrctrlpriv, mode); + DBG_871X("%s %s\n", __FUNCTION__, "IPS_NONE"); -+ if (!rtw_is_surprise_removed(padapter) && (_FAIL == rtw_pwr_wakeup(padapter))) ++ if((padapter->bSurpriseRemoved ==0)&&(_FAIL == rtw_pwr_wakeup(padapter)) ) + return -EFAULT; + } + else { @@ -61655,85 +42670,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux/3rdparty/rtl881 + } + return 0; +} -+ -+/* -+ * ATTENTION: -+ * This function will request pwrctrl LOCK! -+ */ -+void rtw_ps_deny(PADAPTER padapter, PS_DENY_REASON reason) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ s32 ret; -+ -+ -+// DBG_871X("+" FUNC_ADPT_FMT ": Request PS deny for %d (0x%08X)\n", -+// FUNC_ADPT_ARG(padapter), reason, BIT(reason)); -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ if (pwrpriv->ps_deny & BIT(reason)) -+ { -+ DBG_871X(FUNC_ADPT_FMT ": [WARNING] Reason %d had been set before!!\n", -+ FUNC_ADPT_ARG(padapter), reason); -+ } -+ pwrpriv->ps_deny |= BIT(reason); -+ _exit_pwrlock(&pwrpriv->lock); -+ -+// DBG_871X("-" FUNC_ADPT_FMT ": Now PS deny for 0x%08X\n", -+// FUNC_ADPT_ARG(padapter), pwrpriv->ps_deny); -+} -+ -+/* -+ * ATTENTION: -+ * This function will request pwrctrl LOCK! -+ */ -+void rtw_ps_deny_cancel(PADAPTER padapter, PS_DENY_REASON reason) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+// DBG_871X("+" FUNC_ADPT_FMT ": Cancel PS deny for %d(0x%08X)\n", -+// FUNC_ADPT_ARG(padapter), reason, BIT(reason)); -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ if ((pwrpriv->ps_deny & BIT(reason)) == 0) -+ { -+ DBG_871X(FUNC_ADPT_FMT ": [ERROR] Reason %d had been canceled before!!\n", -+ FUNC_ADPT_ARG(padapter), reason); -+ } -+ pwrpriv->ps_deny &= ~BIT(reason); -+ _exit_pwrlock(&pwrpriv->lock); -+ -+// DBG_871X("-" FUNC_ADPT_FMT ": Now PS deny for 0x%08X\n", -+// FUNC_ADPT_ARG(padapter), pwrpriv->ps_deny); -+} -+ -+/* -+ * ATTENTION: -+ * Before calling this function pwrctrl lock should be occupied already, -+ * otherwise it may return incorrect value. -+ */ -+u32 rtw_ps_deny_get(PADAPTER padapter) -+{ -+ u32 deny; -+ -+ -+ deny = adapter_to_pwrctl(padapter)->ps_deny; -+ -+ return deny; -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au/core/rtw_recv.c ---- linux.old/3rdparty/rtl8812au/core/rtw_recv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_recv.c 2017-06-07 23:07:21.004686938 +0300 -@@ -0,0 +1,4947 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_recv.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_recv.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_recv.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_recv.c 2018-02-06 17:42:30.699967001 +0200 +@@ -0,0 +1,3627 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -61743,49 +42687,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_RECV_C_ + +#include -+#include -+ -+#if defined (PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+ -+#error "Shall be Linux or Windows, but not both!\n" -+ -+#endif -+ + +#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) +void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS); -+ -+enum { -+ SIGNAL_STAT_CALC_PROFILE_0 = 0, -+ SIGNAL_STAT_CALC_PROFILE_1, -+ SIGNAL_STAT_CALC_PROFILE_MAX -+}; -+ -+u8 signal_stat_calc_profile[SIGNAL_STAT_CALC_PROFILE_MAX][2] = { -+ {4, 1}, /* Profile 0 => pre_stat : curr_stat = 4 : 1 */ -+ {3, 7} /* Profile 1 => pre_stat : curr_stat = 3 : 7 */ -+}; -+ -+#ifndef RTW_SIGNAL_STATE_CALC_PROFILE -+#define RTW_SIGNAL_STATE_CALC_PROFILE SIGNAL_STAT_CALC_PROFILE_1 ++#else ++void rtw_signal_stat_timer_hdl(struct timer_list *t); +#endif -+ +#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS + ++ +void _rtw_init_sta_recv_priv(struct sta_recv_priv *psta_recvpriv) +{ + + -+_func_enter_; ++ + + _rtw_memset((u8 *)psta_recvpriv, 0, sizeof (struct sta_recv_priv)); + @@ -61796,7 +42716,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + _rtw_init_queue(&psta_recvpriv->defrag_q); + -+_func_exit_; ++ + +} + @@ -61808,7 +42728,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + sint res=_SUCCESS; + -+_func_enter_; ++ + + // We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). + //_rtw_memset((unsigned char *)precvpriv, 0, sizeof (struct recv_priv)); @@ -61823,14 +42743,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + precvpriv->free_recvframe_cnt = NR_RECVFRAME; + -+ precvpriv->sink_udpport = 0; -+ precvpriv->pre_rtp_rxseq = 0; -+ precvpriv->cur_rtp_rxseq = 0; -+ + rtw_os_recv_resource_init(precvpriv, padapter); + + precvpriv->pallocated_frame_buf = rtw_zvmalloc(NR_RECVFRAME * sizeof(union recv_frame) + RXFRAME_ALIGN_SZ); -+ ++ + if(precvpriv->pallocated_frame_buf==NULL){ + res= _FAIL; + goto exit; @@ -61859,20 +42775,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + } + -+#ifdef CONFIG_USB_HCI -+ -+ ATOMIC_SET(&(precvpriv->rx_pending_cnt), 1); ++ precvpriv->rx_pending_cnt=1; + + _rtw_init_sema(&precvpriv->allrxreturnevt, 0); + -+#endif -+ + res = rtw_hal_init_recv_priv(padapter); + +#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + rtw_init_timer(&precvpriv->signal_stat_timer, padapter, RTW_TIMER_HDL_NAME(signal_stat)); ++#else ++ timer_setup(&precvpriv->signal_stat_timer, RTW_TIMER_HDL_NAME(signal_stat), 0); ++#endif + -+ precvpriv->signal_stat_sampling_interval = 2000; //ms ++ precvpriv->signal_stat_sampling_interval = 1000; //ms + //precvpriv->signal_stat_converging_constant = 5000; //ms + + rtw_set_signal_stat_timer(precvpriv); @@ -61880,7 +42796,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + +exit: + -+_func_exit_; ++ + + return res; + @@ -61890,7 +42806,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +void rtw_mfree_recv_priv_lock(struct recv_priv *precvpriv) +{ + _rtw_spinlock_free(&precvpriv->lock); -+#ifdef CONFIG_RECV_THREAD_MODE ++#ifdef CONFIG_RECV_THREAD_MODE + _rtw_free_sema(&precvpriv->recv_sema); + _rtw_free_sema(&precvpriv->terminate_recvthread_sema); +#endif @@ -61909,7 +42825,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +{ + _adapter *padapter = precvpriv->adapter; + -+_func_enter_; ++ + + rtw_free_uc_swdec_pending_queue(padapter); + @@ -61923,7 +42839,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + rtw_hal_free_recv_priv(padapter); + -+_func_exit_; ++ + +} + @@ -61934,9 +42850,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + _list *plist, *phead; + _adapter *padapter; + struct recv_priv *precvpriv; -+_func_enter_; + -+ if(_rtw_queue_empty(pfree_recv_queue) == _TRUE) ++ ++ if(_rtw_queue_empty(pfree_recv_queue) == true) + { + precvframe = NULL; + } @@ -61957,7 +42873,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + } + } + -+_func_exit_; ++ + + return precvframe; + @@ -61967,7 +42883,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +{ + _irqL irqL; + union recv_frame *precvframe; -+ ++ + _enter_critical_bh(&pfree_recv_queue->lock, &irqL); + + precvframe = _rtw_alloc_recvframe(pfree_recv_queue); @@ -61991,7 +42907,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + _adapter *padapter=precvframe->u.hdr.adapter; + struct recv_priv *precvpriv = &padapter->recvpriv; + -+_func_enter_; ++ + +#ifdef CONFIG_CONCURRENT_MODE + if(padapter->adapter_type > PRIMARY_ADAPTER) @@ -61999,8 +42915,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + padapter = padapter->pbuddy_adapter;//get primary_padapter + precvpriv = &padapter->recvpriv; + pfree_recv_queue = &precvpriv->free_recv_queue; -+ precvframe->u.hdr.adapter = padapter; -+ } ++ precvframe->u.hdr.adapter = padapter; ++ } +#endif + + rtw_os_free_recvframe(precvframe); @@ -62021,7 +42937,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + _exit_critical_bh(&pfree_recv_queue->lock, &irqL); + -+_func_exit_; ++ + + return _SUCCESS; + @@ -62036,7 +42952,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + _adapter *padapter=precvframe->u.hdr.adapter; + struct recv_priv *precvpriv = &padapter->recvpriv; + -+_func_enter_; ++ + + //_rtw_init_listhead(&(precvframe->u.hdr.list)); + rtw_list_delete(&(precvframe->u.hdr.list)); @@ -62049,7 +42965,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + precvpriv->free_recvframe_cnt++; + } + -+_func_exit_; ++ + + return _SUCCESS; +} @@ -62058,7 +42974,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +{ + sint ret; + _irqL irqL; -+ ++ + //_spinlock(&pfree_recv_queue->lock); + _enter_critical_bh(&queue->lock, &irqL); + ret = _rtw_enqueue_recvframe(precvframe, queue); @@ -62088,16 +43004,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + +void rtw_free_recvframe_queue(_queue *pframequeue, _queue *pfree_recv_queue) +{ -+ union recv_frame *precvframe; ++ union recv_frame *precvframe; + _list *plist, *phead; + -+_func_enter_; ++ + _rtw_spinlock(&pframequeue->lock); + + phead = get_list_head(pframequeue); + plist = get_next(phead); + -+ while(rtw_end_of_queue_search(phead, plist) == _FALSE) ++ while(rtw_end_of_queue_search(phead, plist) == false) + { + precvframe = LIST_CONTAINOR(plist, union recv_frame, u); + @@ -62110,7 +43026,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + _rtw_spinunlock(&pframequeue->lock); + -+_func_exit_; ++ + +} + @@ -62120,12 +43036,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + union recv_frame *pending_frame; + while((pending_frame=rtw_alloc_recvframe(&adapter->recvpriv.uc_swdec_pending_queue))) { + rtw_free_recvframe(pending_frame, &adapter->recvpriv.free_recv_queue); ++ DBG_871X("%s: dequeue uc_swdec_pending_queue\n", __func__); + cnt++; + } + -+ if (cnt) -+ DBG_871X(FUNC_ADPT_FMT" dequeue %d\n", FUNC_ADPT_ARG(adapter), cnt); -+ + return cnt; +} + @@ -62146,38 +43060,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + +sint rtw_enqueue_recvbuf(struct recv_buf *precvbuf, _queue *queue) +{ -+ _irqL irqL; -+#ifdef CONFIG_SDIO_HCI -+ _enter_critical_bh(&queue->lock, &irqL); -+#else ++ _irqL irqL; + _enter_critical_ex(&queue->lock, &irqL); -+#endif/*#ifdef CONFIG_SDIO_HCI*/ + + rtw_list_delete(&precvbuf->list); + + rtw_list_insert_tail(&precvbuf->list, get_list_head(queue)); -+#ifdef CONFIG_SDIO_HCI -+ _exit_critical_bh(&queue->lock, &irqL); -+#else + _exit_critical_ex(&queue->lock, &irqL); -+#endif/*#ifdef CONFIG_SDIO_HCI*/ + return _SUCCESS; -+ +} + +struct recv_buf *rtw_dequeue_recvbuf (_queue *queue) +{ + _irqL irqL; + struct recv_buf *precvbuf; -+ _list *plist, *phead; ++ _list *plist, *phead; + -+#ifdef CONFIG_SDIO_HCI -+ _enter_critical_bh(&queue->lock, &irqL); -+#else + _enter_critical_ex(&queue->lock, &irqL); -+#endif/*#ifdef CONFIG_SDIO_HCI*/ -+ -+ if(_rtw_queue_empty(queue) == _TRUE) ++ ++ if(_rtw_queue_empty(queue) == true) + { + precvbuf = NULL; + } @@ -62190,17 +43091,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + precvbuf = LIST_CONTAINOR(plist, struct recv_buf, list); + + rtw_list_delete(&precvbuf->list); -+ ++ + } + -+#ifdef CONFIG_SDIO_HCI -+ _exit_critical_bh(&queue->lock, &irqL); -+#else + _exit_critical_ex(&queue->lock, &irqL); -+#endif/*#ifdef CONFIG_SDIO_HCI*/ -+ + return precvbuf; -+ +} + +sint recvframe_chkmic(_adapter *adapter, union recv_frame *precvframe); @@ -62209,17 +43104,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + sint i,res=_SUCCESS; + u32 datalen; + u8 miccode[8]; -+ u8 bmic_err=_FALSE,brpt_micerror = _TRUE; ++ u8 bmic_err=false,brpt_micerror = true; + u8 *pframe, *payload,*pframemic; + u8 *mickey; + //u8 *iv,rxdata_key_idx=0; + struct sta_info *stainfo; + struct rx_pkt_attrib *prxattrib=&precvframe->u.hdr.attrib; -+ struct security_priv *psecuritypriv=&adapter->securitypriv; ++ struct security_priv *psecuritypriv=&adapter->securitypriv; + + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+_func_enter_; ++ + + stainfo=rtw_get_stainfo(&adapter->stapriv ,&prxattrib->ta[0]); + @@ -62238,12 +43133,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + //iv = precvframe->u.hdr.rx_data+prxattrib->hdrlen; + //rxdata_key_idx =( ((iv[3])>>6)&0x3) ; + mickey=&psecuritypriv->dot118021XGrprxmickey[prxattrib->key_index].skey[0]; -+ ++ + RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("\n recvframe_chkmic: bcmc key \n")); + //DBG_871X("\n recvframe_chkmic: bcmc key psecuritypriv->dot118021XGrpKeyid(%d),pmlmeinfo->key_index(%d) ,recv key_id(%d)\n", + // psecuritypriv->dot118021XGrpKeyid,pmlmeinfo->key_index,rxdata_key_idx); -+ -+ if(psecuritypriv->binstallGrpkey==_FALSE) ++ ++ if(psecuritypriv->binstallGrpkey==false) + { + res=_FAIL; + RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("\n recvframe_chkmic:didn't install group key!!!!!!!!!!\n")); @@ -62268,17 +43163,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + pframemic=payload+datalen; + -+ bmic_err=_FALSE; ++ bmic_err=false; + + for(i=0;i<8;i++){ + if(miccode[i] != *(pframemic+i)){ + RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("recvframe_chkmic:miccode[%d](%02x) != *(pframemic+%d)(%02x) ",i,miccode[i],i,*(pframemic+i))); -+ bmic_err=_TRUE; ++ bmic_err=true; + } + } + + -+ if(bmic_err==_TRUE){ ++ if(bmic_err==true){ + + RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("\n *(pframemic-8)-*(pframemic-1)=0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x\n", + *(pframemic-8),*(pframemic-7),*(pframemic-6),*(pframemic-5),*(pframemic-4),*(pframemic-3),*(pframemic-2),*(pframemic-1))); @@ -62305,12 +43200,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + // double check key_index for some timing issue , + // cannot compare with psecuritypriv->dot118021XGrpKeyid also cause timing issue -+ if((IS_MCAST(prxattrib->ra)==_TRUE) && (prxattrib->key_index != pmlmeinfo->key_index )) -+ brpt_micerror = _FALSE; -+ -+ if((prxattrib->bdecrypted ==_TRUE)&& (brpt_micerror == _TRUE)) ++ if((IS_MCAST(prxattrib->ra)==true) && (prxattrib->key_index != pmlmeinfo->key_index )) ++ brpt_micerror = false; ++ ++ if((prxattrib->bdecrypted ==true)&& (brpt_micerror == true)) + { -+ rtw_handle_tkip_mic_err(adapter, stainfo, (u8)IS_MCAST(prxattrib->ra)); ++ rtw_handle_tkip_mic_err(adapter,(u8)IS_MCAST(prxattrib->ra)); + RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,(" mic error :prxattrib->bdecrypted=%d ",prxattrib->bdecrypted)); + DBG_871X(" mic error :prxattrib->bdecrypted=%d\n",prxattrib->bdecrypted); + } @@ -62325,9 +43220,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + } + else{ + //mic checked ok -+ if((psecuritypriv->bcheck_grpkey ==_FALSE)&&(IS_MCAST(prxattrib->ra)==_TRUE)){ -+ psecuritypriv->bcheck_grpkey =_TRUE; -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("psecuritypriv->bcheck_grpkey =_TRUE")); ++ if((psecuritypriv->bcheck_grpkey ==false)&&(IS_MCAST(prxattrib->ra)==true)){ ++ psecuritypriv->bcheck_grpkey =true; ++ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("psecuritypriv->bcheck_grpkey =true")); + } + } + @@ -62343,7 +43238,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + +exit: + -+_func_exit_; ++ + + return res; + @@ -62359,9 +43254,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + union recv_frame *return_packet=precv_frame; + u32 res=_SUCCESS; + -+_func_enter_; -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt); + + RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("prxstat->decrypted=%x prxattrib->encrypt = 0x%03x\n",prxattrib->bdecrypted,prxattrib->encrypt)); + @@ -62379,49 +43271,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + case _WEP104_: + prxattrib->key_index = psecuritypriv->dot11PrivacyKeyIndex; + break; -+ case _TKIP_: -+ case _AES_: ++ case _TKIP_: ++ case _AES_: + default: + prxattrib->key_index = psecuritypriv->dot118021XGrpKeyid; + break; -+ } -+ } ++ } ++ } + } + -+ if((prxattrib->encrypt>0) && ((prxattrib->bdecrypted==0) ||(psecuritypriv->sw_decrypt==_TRUE))) ++ if((prxattrib->encrypt>0) && ((prxattrib->bdecrypted==0) ||(psecuritypriv->sw_decrypt==true))) + { + +#ifdef CONFIG_CONCURRENT_MODE + if(!IS_MCAST(prxattrib->ra))//bc/mc packets use sw decryption for concurrent mode -+#endif -+ psecuritypriv->hw_decrypted=_FALSE; ++#endif ++ psecuritypriv->hw_decrypted=false; + + #ifdef DBG_RX_DECRYPTOR -+ DBG_871X("[%s] %d:prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n", -+ __FUNCTION__, -+ __LINE__, -+ prxattrib->bdecrypted, -+ prxattrib->encrypt, -+ psecuritypriv->hw_decrypted); ++ DBG_871X("prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n" ++ , prxattrib->bdecrypted ,prxattrib->encrypt, psecuritypriv->hw_decrypted); + #endif + + switch(prxattrib->encrypt){ + case _WEP40_: + case _WEP104_: -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_wep); + rtw_wep_decrypt(padapter, (u8 *)precv_frame); + break; + case _TKIP_: -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_tkip); + res = rtw_tkip_decrypt(padapter, (u8 *)precv_frame); + break; + case _AES_: -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_aes); + res = rtw_aes_decrypt(padapter, (u8 * )precv_frame); + break; +#ifdef CONFIG_WAPI_SUPPORT + case _SMS4_: -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_wapi); + rtw_sms4_decrypt(padapter, (u8 * )precv_frame); + break; +#endif @@ -62437,9 +43321,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +#if 0 + if((prxstat->icv==1)&&(prxattrib->encrypt!=_AES_)) + { -+ psecuritypriv->hw_decrypted=_FALSE; ++ psecuritypriv->hw_decrypted=false; + -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("psecuritypriv->hw_decrypted=_FALSE")); ++ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("psecuritypriv->hw_decrypted=false")); + + rtw_free_recvframe(precv_frame, &padapter->recvpriv.free_recv_queue); + @@ -62449,44 +43333,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + else +#endif + { -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_hw); -+ -+ psecuritypriv->hw_decrypted=_TRUE; ++ psecuritypriv->hw_decrypted=true; + #ifdef DBG_RX_DECRYPTOR -+ DBG_871X("[%s] %d:prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n", -+ __FUNCTION__, -+ __LINE__, -+ prxattrib->bdecrypted, -+ prxattrib->encrypt, -+ psecuritypriv->hw_decrypted); -+ ++ DBG_871X("prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n" ++ , prxattrib->bdecrypted ,prxattrib->encrypt, psecuritypriv->hw_decrypted); + #endif ++ + } + } + else { -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_unknown); + #ifdef DBG_RX_DECRYPTOR -+ DBG_871X("[%s] %d:prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n", -+ __FUNCTION__, -+ __LINE__, -+ prxattrib->bdecrypted, -+ prxattrib->encrypt, -+ psecuritypriv->hw_decrypted); ++ DBG_871X("prxstat->bdecrypted:%d, prxattrib->encrypt:%d, psecuritypriv->hw_decrypted:%d\n" ++ , prxattrib->bdecrypted ,prxattrib->encrypt, psecuritypriv->hw_decrypted); + #endif + } -+ ++ + if(res == _FAIL) + { -+ rtw_free_recvframe(return_packet,&padapter->recvpriv.free_recv_queue); ++ rtw_free_recvframe(return_packet,&padapter->recvpriv.free_recv_queue); + return_packet = NULL; -+ } -+ else -+ { -+ prxattrib->bdecrypted = _TRUE; ++ + } + //recvframe_chkmic(adapter, precv_frame); //move to recvframme_defrag function + -+_func_exit_; ++ + + return return_packet; + @@ -62495,20 +43365,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +union recv_frame * portctrl(_adapter *adapter,union recv_frame * precv_frame); +union recv_frame * portctrl(_adapter *adapter,union recv_frame * precv_frame) +{ -+ u8 *psta_addr = NULL; -+ u8 *ptr; ++ u8 *psta_addr, *ptr; + uint auth_alg; + struct recv_frame_hdr *pfhdr; + struct sta_info *psta; + struct sta_priv *pstapriv ; + union recv_frame *prtnframe; + u16 ether_type=0; -+ u16 eapol_type = 0x888e;//for Funia BD's WPA issue ++ u16 eapol_type = 0x888e;//for Funia BD's WPA issue + struct rx_pkt_attrib *pattrib; -+ -+_func_enter_; ++ __be16 be_tmp; + + pstapriv = &adapter->stapriv; ++ psta = rtw_get_stainfo(pstapriv, psta_addr); + + auth_alg = adapter->securitypriv.dot11AuthAlgrthm; + @@ -62519,8 +43388,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + prtnframe = NULL; + -+ psta = rtw_get_stainfo(pstapriv, psta_addr); -+ + RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("########portctrl:adapter->securitypriv.dot11AuthAlgrthm=%d\n",adapter->securitypriv.dot11AuthAlgrthm)); + + if(auth_alg==2) @@ -62535,13 +43402,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + //get ether_type + ptr=ptr+pfhdr->attrib.hdrlen+pfhdr->attrib.iv_len+LLC_HEADER_SIZE; -+ _rtw_memcpy(ðer_type,ptr, 2); -+ ether_type= ntohs((unsigned short )ether_type); ++ _rtw_memcpy(&be_tmp,ptr, 2); ++ ether_type= ntohs(be_tmp); + + if (ether_type == eapol_type) { + prtnframe=precv_frame; -+ } -+ else { ++ } else { + //free this frame + rtw_free_recvframe(precv_frame, &adapter->recvpriv.free_recv_queue); + prtnframe=NULL; @@ -62561,15 +43427,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + prtnframe=precv_frame; + //check is the EAPOL frame or not (Rekey) -+ //if(ether_type == eapol_type){ -+ // RT_TRACE(_module_rtl871x_recv_c_,_drv_notice_,("########portctrl:ether_type == 0x888e\n")); ++ if(ether_type == eapol_type){ ++ ++ RT_TRACE(_module_rtl871x_recv_c_,_drv_notice_,("########portctrl:ether_type == 0x888e\n")); + //check Rekey + -+ // prtnframe=precv_frame; -+ //} -+ //else{ -+ // RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("########portctrl:ether_type=0x%04x\n", ether_type)); -+ //} ++ prtnframe=precv_frame; ++ } ++ else{ ++ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("########portctrl:ether_type=0x%04x\n", ether_type)); ++ } + } + } + else @@ -62577,7 +43444,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + prtnframe=precv_frame; + } + -+_func_exit_; ++ + + return prtnframe; + @@ -62591,7 +43458,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + u16 seq_ctrl = ( (precv_frame->u.hdr.attrib.seq_num&0xffff) << 4) | + (precv_frame->u.hdr.attrib.frag_num & 0xf); + -+_func_enter_; ++ + + if(tid>15) + { @@ -62612,7 +43479,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + prxcache->tid_rxseq[tid] = seq_ctrl; + -+_func_exit_; ++ + + return _SUCCESS; + @@ -62667,13 +43534,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame); +void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame) +{ -+#ifdef CONFIG_AP_MODE ++#ifdef CONFIG_AP_MODE + struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; + struct sta_priv *pstapriv = &padapter->stapriv; + struct sta_info *psta=NULL; + + psta = rtw_get_stainfo(pstapriv, pattrib->src); -+ ++ + if(!psta) return; + +#ifdef CONFIG_TDLS @@ -62686,15 +43553,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + if(!(psta->qos_info&0xf)) + return; -+ ++ +#ifdef CONFIG_TDLS + } -+#endif //CONFIG_TDLS ++#endif //CONFIG_TDLS + + if(psta->state&WIFI_SLEEP_STATE) + { -+ u8 wmmps_ac=0; -+ ++ u8 wmmps_ac=0; ++ + switch(pattrib->priority) + { + case 1: @@ -62713,7 +43580,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + case 3: + default: + wmmps_ac = psta->uapsd_be&BIT(1); -+ break; ++ break; + } + + if(wmmps_ac) @@ -62729,11 +43596,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + issue_qos_nulldata(padapter, psta->hwaddr, (u16)pattrib->priority, 0, 0); + } + } -+ ++ + } + -+ -+#endif ++ ++#endif + +} + @@ -62746,87 +43613,89 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + u8 category_field = 1; +#ifdef CONFIG_WFD + u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a }; -+#endif /* CONFIG_WFD */ ++#endif //CONFIG_WFD + struct tdls_info *ptdlsinfo = &(adapter->tdlsinfo); + -+ /* point to action field */ -+ paction+=pattrib->hdrlen -+ + pattrib->iv_len -+ + SNAP_SIZE -+ + ETH_TYPE_LEN -+ + PAYLOAD_TYPE_LEN ++ //point to action field ++ paction+=pattrib->hdrlen ++ + pattrib->iv_len ++ + SNAP_SIZE ++ + ETH_TYPE_LEN ++ + PAYLOAD_TYPE_LEN + + category_field; + -+ if (ptdlsinfo->tdls_enable == _FALSE) { ++ if(ptdlsinfo->enable == 0) ++ { + DBG_871X("recv tdls frame, " + "but tdls haven't enabled\n"); + ret = _FAIL; + return ret; + } + -+ DBG_871X("[TDLS] Recv %s from "MAC_FMT"\n", rtw_tdls_action_txt(*paction), MAC_ARG(pattrib->src)); -+ + switch(*paction){ -+ case TDLS_SETUP_REQUEST: -+ ret=On_TDLS_Setup_Req(adapter, precv_frame); -+ break; -+ case TDLS_SETUP_RESPONSE: -+ ret=On_TDLS_Setup_Rsp(adapter, precv_frame); -+ break; -+ case TDLS_SETUP_CONFIRM: -+ ret=On_TDLS_Setup_Cfm(adapter, precv_frame); -+ break; -+ case TDLS_TEARDOWN: -+ ret=On_TDLS_Teardown(adapter, precv_frame); -+ break; -+ case TDLS_DISCOVERY_REQUEST: -+ ret=On_TDLS_Dis_Req(adapter, precv_frame); -+ break; -+ case TDLS_PEER_TRAFFIC_INDICATION: -+ ret=On_TDLS_Peer_Traffic_Indication(adapter, precv_frame); -+ break; -+ case TDLS_PEER_TRAFFIC_RESPONSE: -+ ret=On_TDLS_Peer_Traffic_Rsp(adapter, precv_frame); -+ break; -+#ifdef CONFIG_TDLS_CH_SW -+ case TDLS_CHANNEL_SWITCH_REQUEST: -+ ret=On_TDLS_Ch_Switch_Req(adapter, precv_frame); -+ break; -+ case TDLS_CHANNEL_SWITCH_RESPONSE: -+ ret=On_TDLS_Ch_Switch_Rsp(adapter, precv_frame); -+ break; -+#endif -+#ifdef CONFIG_WFD -+ /* First byte of WFA OUI */ -+ case 0x50: -+ if (_rtw_memcmp(WFA_OUI, paction, 3)) { -+ /* Probe request frame */ -+ if (*(paction + 3) == 0x04) { -+ /* WFDTDLS: for sigma test, do not setup direct link automatically */ -+ ptdlsinfo->dev_discovered = _TRUE; -+ DBG_871X("recv tunneled probe request frame\n"); -+ issue_tunneled_probe_rsp(adapter, precv_frame); ++ case TDLS_SETUP_REQUEST: ++ DBG_871X("recv tdls setup request frame\n"); ++ ret=On_TDLS_Setup_Req(adapter, precv_frame); ++ break; ++ case TDLS_SETUP_RESPONSE: ++ DBG_871X("recv tdls setup response frame\n"); ++ ret=On_TDLS_Setup_Rsp(adapter, precv_frame); ++ break; ++ case TDLS_SETUP_CONFIRM: ++ DBG_871X("recv tdls setup confirm frame\n"); ++ ret=On_TDLS_Setup_Cfm(adapter, precv_frame); ++ break; ++ case TDLS_TEARDOWN: ++ DBG_871X("recv tdls teardown, free sta_info\n"); ++ ret=On_TDLS_Teardown(adapter, precv_frame); ++ break; ++ case TDLS_DISCOVERY_REQUEST: ++ DBG_871X("recv tdls discovery request frame\n"); ++ ret=On_TDLS_Dis_Req(adapter, precv_frame); ++ break; ++ case TDLS_PEER_TRAFFIC_RESPONSE: ++ DBG_871X("recv tdls peer traffic response frame\n"); ++ ret=On_TDLS_Peer_Traffic_Rsp(adapter, precv_frame); ++ break; ++ case TDLS_CHANNEL_SWITCH_REQUEST: ++ DBG_871X("recv tdls channel switch request frame\n"); ++ ret=On_TDLS_Ch_Switch_Req(adapter, precv_frame); ++ break; ++ case TDLS_CHANNEL_SWITCH_RESPONSE: ++ DBG_871X("recv tdls channel switch response frame\n"); ++ ret=On_TDLS_Ch_Switch_Rsp(adapter, precv_frame); ++ break; ++#ifdef CONFIG_WFD ++ case 0x50: //First byte of WFA OUI ++ if( _rtw_memcmp(WFA_OUI, (paction), 3) ) ++ { ++ if( *(paction + 3) == 0x04) //Probe request frame ++ { ++ //WFDTDLS: for sigma test, do not setup direct link automatically ++ ptdlsinfo->dev_discovered = 1; ++ DBG_871X("recv tunneled probe request frame\n"); ++ issue_tunneled_probe_rsp(adapter, precv_frame); ++ } ++ if( *(paction + 3) == 0x05) //Probe response frame ++ { ++ //WFDTDLS: for sigma test, do not setup direct link automatically ++ ptdlsinfo->dev_discovered = 1; ++ DBG_871X("recv tunneled probe response frame\n"); ++ } + } -+ /* Probe response frame */ -+ if (*(paction + 3) == 0x05) { -+ /* WFDTDLS: for sigma test, do not setup direct link automatically */ -+ ptdlsinfo->dev_discovered = _TRUE; -+ DBG_871X("recv tunneled probe response frame\n"); -+ } -+ } -+ break; -+#endif /* CONFIG_WFD */ -+ default: -+ DBG_871X("receive TDLS frame %d but not support\n", *paction); -+ ret=_FAIL; -+ break; ++ break; ++#endif //CONFIG_WFD ++ default: ++ DBG_871X("receive TDLS frame but not supported\n"); ++ ret=_FAIL; ++ break; + } + +exit: + return ret; -+ ++ +} -+#endif /* CONFIG_TDLS */ ++#endif + +void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_info*sta); +void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_info*sta) @@ -62836,8 +43705,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + struct stainfo_stats *pstats = NULL; + struct rx_pkt_attrib *pattrib = & prframe->u.hdr.attrib; + struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + + sz = get_recvframe_len(prframe); + precvpriv->rx_bytes += sz; @@ -62859,29 +43726,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + pstats->rx_data_pkts++; + pstats->rx_bytes += sz; -+ -+ /*record rx packets for every tid*/ -+ pstats->rx_data_qos_pkts[pattrib->priority]++; -+ -+#ifdef CONFIG_TDLS -+ if(psta->tdls_sta_state & TDLS_LINKED_STATE) -+ { -+ struct sta_info *pap_sta = NULL; -+ pap_sta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); -+ if(pap_sta) -+ { -+ pstats = &pap_sta->sta_stats; -+ pstats->rx_data_pkts++; -+ pstats->rx_bytes += sz; -+ } -+ } -+#endif //CONFIG_TDLS + } + -+#ifdef CONFIG_CHECK_LEAVE_LPS -+ traffic_check_for_leave_lps(padapter, _FALSE, 0); -+#endif //CONFIG_LPS -+ +} + +sint sta2sta_data_frame( @@ -62898,30 +43744,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + u8 *ptr = precv_frame->u.hdr.rx_data; + sint ret = _SUCCESS; + struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct sta_priv *pstapriv = &adapter->stapriv; + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + u8 *mybssid = get_bssid(pmlmepriv); -+ u8 *myhwaddr = adapter_mac_addr(adapter); ++ u8 *myhwaddr = myid(&adapter->eeprompriv); + u8 * sta_addr = NULL; + sint bmcast = IS_MCAST(pattrib->dst); + -+#ifdef CONFIG_TDLS ++#ifdef CONFIG_TDLS + struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; -+#ifdef CONFIG_TDLS_CH_SW -+ struct tdls_ch_switch *pchsw_info = &ptdlsinfo->chsw_info; -+#endif + struct sta_info *ptdls_sta=NULL; + u8 *psnap_type=ptr+pattrib->hdrlen + pattrib->iv_len+SNAP_SIZE; + //frame body located after [+2]: ether-type, [+1]: payload type + u8 *pframe_body = psnap_type+2+1; +#endif + -+_func_enter_; + -+ //DBG_871X("[%s] %d, seqnum:%d\n", __FUNCTION__, __LINE__, pattrib->seq_num); + -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) + { + + // filter packets that SA is myself or multicast or broadcast @@ -62946,87 +43787,91 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + sta_addr = pattrib->src; + + } -+ else if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) ++ else if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) + { +#ifdef CONFIG_TDLS + -+ /* direct link data transfer */ -+ if (ptdlsinfo->link_established == _TRUE) { ++ //direct link data transfer ++ if(ptdlsinfo->setup_state == TDLS_LINKED_STATE){ + ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->src); -+ if (ptdls_sta == NULL) { ++ if(ptdls_sta==NULL) ++ { + ret=_FAIL; + goto exit; -+ } else if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { -+ /* filter packets that SA is myself or multicast or broadcast */ -+ if (_rtw_memcmp(myhwaddr, pattrib->src, ETH_ALEN)) { -+ ret= _FAIL; -+ goto exit; -+ } -+ /* da should be for me */ -+ if ((!_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN)) && (!bmcast)) { -+ ret= _FAIL; -+ goto exit; -+ } -+ /* check BSSID */ -+ if (_rtw_memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ _rtw_memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN))) { -+ ret= _FAIL; -+ goto exit; -+ } ++ } ++ else if(ptdls_sta->tdls_sta_state&TDLS_LINKED_STATE) ++ { + -+#ifdef CONFIG_TDLS_CH_SW -+ pchsw_info->ch_sw_state |= TDLS_PEER_AT_OFF_STATE; -+ -+ if(ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) { -+ if (!(pchsw_info->ch_sw_state & TDLS_PEER_AT_OFF_STATE)) { -+ DBG_871X("%s %d\n", __FUNCTION__, __LINE__); -+ issue_nulldata_to_TDLS_peer_STA(adapter, ptdls_sta->hwaddr, 0, 0, 0); -+ pchsw_info->ch_sw_state |= TDLS_PEER_AT_OFF_STATE; -+ /* On_TDLS_Peer_Traffic_Rsp(adapter, precv_frame); */ ++ //drop QoS-SubType Data, including QoS NULL, excluding QoS-Data ++ if( (GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE )== WIFI_QOS_DATA_TYPE) ++ { ++ if(GetFrameSubType(ptr)&(BIT(4)|BIT(5)|BIT(6))) ++ { ++ DBG_871X("drop QoS-Sybtype Data\n"); ++ ret= _FAIL; ++ goto exit; + } + } -+#endif ++ // filter packets that SA is myself or multicast or broadcast ++ if (_rtw_memcmp(myhwaddr, pattrib->src, ETH_ALEN)){ ++ ret= _FAIL; ++ goto exit; ++ } ++ // da should be for me ++ if((!_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN))&& (!bmcast)) ++ { ++ ret= _FAIL; ++ goto exit; ++ } ++ // check BSSID ++ if( _rtw_memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || ++ _rtw_memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || ++ (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN)) ) ++ { ++ ret= _FAIL; ++ goto exit; ++ } + -+ /* process UAPSD tdls sta */ ++ //process UAPSD tdls sta + process_pwrbit_data(adapter, precv_frame); + -+ /* if NULL-frame, check pwrbit */ -+ if ((GetFrameSubType(ptr) & WIFI_DATA_NULL) == WIFI_DATA_NULL) { -+ /* NULL-frame with pwrbit=1, buffer_STA should buffer frames for sleep_STA */ -+ if (GetPwrMgt(ptr)) { -+ /* it would be triggered when we are off channel and receiving NULL DATA */ -+ /* we can confirm that peer STA is at off channel */ ++ // if NULL-frame, check pwrbit ++ if ((GetFrameSubType(ptr)) == WIFI_DATA_NULL) ++ { ++ //NULL-frame with pwrbit=1, buffer_STA should buffer frames for sleep_STA ++ if(GetPwrMgt(ptr)) ++ { + DBG_871X("TDLS: recv peer null frame with pwr bit 1\n"); -+ //ptdls_sta->tdls_sta_state|=TDLS_PEER_SLEEP_STATE; ++ ptdls_sta->tdls_sta_state|=TDLS_PEER_SLEEP_STATE; ++ // it would be triggered when we are off channel and receiving NULL DATA ++ // we can confirm that peer STA is at off channel ++ } ++ else if(ptdls_sta->tdls_sta_state&TDLS_CH_SWITCH_ON_STATE) ++ { ++ if((ptdls_sta->tdls_sta_state & TDLS_PEER_AT_OFF_STATE) != TDLS_PEER_AT_OFF_STATE) ++ { ++ issue_nulldata_to_TDLS_peer_STA(adapter, ptdls_sta, 0); ++ ptdls_sta->tdls_sta_state |= TDLS_PEER_AT_OFF_STATE; ++ On_TDLS_Peer_Traffic_Rsp(adapter, precv_frame); ++ } + } + -+ /* TODO: Updated BSSID's seq. */ -+ //DBG_871X("drop Null Data\n"); -+ ptdls_sta->tdls_sta_state &= ~(TDLS_WAIT_PTR_STATE); + ret= _FAIL; + goto exit; + } -+ -+ /* receive some of all TDLS management frames, process it at ON_TDLS */ -+ if (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_TDLS, 2)) { ++ //receive some of all TDLS management frames, process it at ON_TDLS ++ if((_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_TDLS, 2))){ + ret= OnTDLS(adapter, precv_frame); + goto exit; + } + -+ if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) { -+ process_wmmps_data(adapter, precv_frame); -+ } -+ -+ ptdls_sta->tdls_sta_state &= ~(TDLS_WAIT_PTR_STATE); -+ + } + + sta_addr = pattrib->src; -+ -+ } ++ ++ } + else -+#endif /* CONFIG_TDLS */ ++#endif //CONFIG_TDLS + { + // For Station mode, sa and bssid should always be BSSID, and DA is my mac-address + if(!_rtw_memcmp(pattrib->bssid, pattrib->src, ETH_ALEN) ) @@ -63040,7 +43885,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + } + + } -+ else if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ else if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) + { + if (bmcast) + { @@ -63062,7 +43907,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + } + + } -+ else if(check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) ++ else if(check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) + { + _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); @@ -63086,9 +43931,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + +#ifdef CONFIG_TDLS + if(ptdls_sta != NULL) -+ { + *psta = ptdls_sta; -+ } +#endif //CONFIG_TDLS + + if (*psta == NULL) { @@ -63096,8 +43939,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +#ifdef CONFIG_MP_INCLUDED + if (adapter->registrypriv.mp_mode == 1) + { -+ if(check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) -+ adapter->mppriv.rx_pktloss++; ++ if(check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) ++ adapter->mppriv.rx_pktloss++; + } +#endif + ret= _FAIL; @@ -63105,7 +43948,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + } + +exit: -+_func_exit_; ++ + return ret; + +} @@ -63122,17 +43965,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + u8 *ptr = precv_frame->u.hdr.rx_data; + struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; + sint ret = _SUCCESS; -+ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct sta_priv *pstapriv = &adapter->stapriv; + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + u8 *mybssid = get_bssid(pmlmepriv); -+ u8 *myhwaddr = adapter_mac_addr(adapter); ++ u8 *myhwaddr = myid(&adapter->eeprompriv); + sint bmcast = IS_MCAST(pattrib->dst); + -+_func_enter_; + -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE -+ || check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE ) ++ ++ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) ++ && (check_fwstate(pmlmepriv, _FW_LINKED) == true ++ || check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true ) + ) + { + @@ -63142,7 +43985,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + #ifdef DBG_RX_DROP_FRAME + DBG_871X("DBG_RX_DROP_FRAME %s SA="MAC_FMT", myhwaddr="MAC_FMT"\n", + __FUNCTION__, MAC_ARG(pattrib->src), MAC_ARG(myhwaddr)); -+ #endif ++ #endif + ret= _FAIL; + goto exit; + } @@ -63209,8 +44052,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + } + + } -+ else if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) && -+ (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ) ++ else if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) && ++ (check_fwstate(pmlmepriv, _FW_LINKED) == true) ) + { + _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); @@ -63219,8 +44062,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); + + // -+ if(adapter->mppriv.bRTWSmbCfg==_FALSE) -+ _rtw_memcpy(pattrib->bssid, mybssid, ETH_ALEN); ++ _rtw_memcpy(pattrib->bssid, mybssid, ETH_ALEN); + + + *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); // get sta_info @@ -63235,7 +44077,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + + } -+ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) + { + /* Special case */ + ret = RTW_RX_HANDLED; @@ -63248,23 +44090,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); // get sta_info + if (*psta == NULL) + { -+ -+ //for AP multicast issue , modify by yiwei -+ static u32 send_issue_deauth_time=0; -+ -+ //DBG_871X("After send deauth , %u ms has elapsed.\n", rtw_get_passing_time_ms(send_issue_deauth_time)); -+ -+ if(rtw_get_passing_time_ms(send_issue_deauth_time) > 10000 || send_issue_deauth_time == 0 ) -+ { -+ send_issue_deauth_time = rtw_get_current_time(); -+ -+ DBG_871X("issue_deauth to the ap=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->bssid)); -+ -+ issue_deauth(adapter, pattrib->bssid, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ } ++ DBG_871X("issue_deauth to the ap=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->bssid)); ++ ++ issue_deauth(adapter, pattrib->bssid, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); + } -+ } -+ ++ } ++ + ret = _FAIL; + #ifdef DBG_RX_DROP_FRAME + DBG_871X("DBG_RX_DROP_FRAME %s fw_state:0x%x\n", __FUNCTION__, get_fwstate(pmlmepriv)); @@ -63273,7 +44104,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + +exit: + -+_func_exit_; ++ + + return ret; + @@ -63290,14 +44121,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +{ + u8 *ptr = precv_frame->u.hdr.rx_data; + struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct sta_priv *pstapriv = &adapter->stapriv; + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ unsigned char *mybssid = get_bssid(pmlmepriv); ++ unsigned char *mybssid = get_bssid(pmlmepriv); + sint ret=_SUCCESS; + -+_func_enter_; + -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) + { + //For AP mode, RA=BSSID, TX=STA(SRC_ADDR), A3=DST_ADDR + if(!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN)) @@ -63331,32 +44162,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + goto exit; + } + } -+ else if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) && -+ (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ) -+ { -+ //DBG_871X("%s ,in WIFI_MP_STATE \n",__func__); -+ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ // -+ if(adapter->mppriv.bRTWSmbCfg == _FALSE) -+ _rtw_memcpy(pattrib->bssid, mybssid, ETH_ALEN); -+ -+ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); // get sta_info -+ if (*psta == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("can't get psta under MP_MODE ; drop pkt\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s can't get psta under WIFI_MP_STATE ; drop pkt\n", __FUNCTION__); -+ #endif -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ } + else { -+ u8 *myhwaddr = adapter_mac_addr(adapter); ++ u8 *myhwaddr = myid(&adapter->eeprompriv); + if (!_rtw_memcmp(pattrib->ra, myhwaddr, ETH_ALEN)) { + ret = RTW_RX_HANDLED; + goto exit; @@ -63369,7 +44176,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + +exit: + -+_func_exit_; ++ + + return ret; + @@ -63378,45 +44185,43 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame); +sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) +{ ++#ifdef CONFIG_AP_MODE + struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; + struct sta_priv *pstapriv = &padapter->stapriv; + u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct sta_info *psta=NULL; + //uint len = precv_frame->u.hdr.len; -+ ++ + //DBG_871X("+validate_recv_ctrl_frame\n"); + + if (GetFrameType(pframe) != WIFI_CTRL_TYPE) -+ { ++ { + return _FAIL; + } + + //receive the frames that ra(a1) is my address -+ if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_mac_addr(padapter), ETH_ALEN)) -+ return _FAIL; -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta==NULL) ++ if (!_rtw_memcmp(GetAddr1Ptr(pframe), myid(&padapter->eeprompriv), ETH_ALEN)) + { + return _FAIL; + } + -+ //for rx pkt statistics -+ psta->sta_stats.rx_ctrl_pkts++; -+ + //only handle ps-poll + if(GetFrameSubType(pframe) == WIFI_PSPOLL) + { -+#ifdef CONFIG_AP_MODE + u16 aid; -+ u8 wmmps_ac=0; -+ ++ u8 wmmps_ac=0; ++ struct sta_info *psta=NULL; ++ + aid = GetAid(pframe); -+ if(psta->aid!=aid) ++ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); ++ ++ if((psta==NULL) || (psta->aid!=aid)) + { + return _FAIL; + } + ++ //for rx pkt statistics ++ psta->sta_stats.rx_ctrl_pkts++; ++ + switch(pattrib->priority) + { + case 1: @@ -63435,34 +44240,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + case 3: + default: + wmmps_ac = psta->uapsd_be&BIT(0); -+ break; ++ break; + } + + if(wmmps_ac) + return _FAIL; + + if(psta->state & WIFI_STA_ALIVE_CHK_STATE) -+ { ++ { + DBG_871X("%s alive check-rx ps-poll\n", __func__); + psta->expire_to = pstapriv->expire_to; + psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ } ++ } + + if((psta->state&WIFI_SLEEP_STATE) && (pstapriv->sta_dz_bitmap&BIT(psta->aid))) + { -+ _irqL irqL; ++ _irqL irqL; + _list *xmitframe_plist, *xmitframe_phead; + struct xmit_frame *pxmitframe=NULL; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ ++ + //_enter_critical_bh(&psta->sleep_q.lock, &irqL); + _enter_critical_bh(&pxmitpriv->lock, &irqL); + + xmitframe_phead = get_list_head(&psta->sleep_q); + xmitframe_plist = get_next(xmitframe_phead); + -+ if ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) -+ { ++ if ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) ++ { + pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); + + xmitframe_plist = get_next(xmitframe_plist); @@ -63473,20 +44278,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + if(psta->sleepq_len>0) + pxmitframe->attrib.mdata = 1; -+ else ++ else + pxmitframe->attrib.mdata = 0; + + pxmitframe->attrib.triggered = 1; + -+ //DBG_871X("handling ps-poll, q_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); ++ //DBG_871X("handling ps-poll, q_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); + +#if 0 -+ _exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ if(rtw_hal_xmit(padapter, pxmitframe) == _TRUE) ++ _exit_critical_bh(&psta->sleep_q.lock, &irqL); ++ if(rtw_hal_xmit(padapter, pxmitframe) == true) + { + rtw_os_xmit_complete(padapter, pxmitframe); + } -+ _enter_critical_bh(&psta->sleep_q.lock, &irqL); ++ _enter_critical_bh(&psta->sleep_q.lock, &irqL); +#endif + rtw_hal_xmitframe_enqueue(padapter, pxmitframe); + @@ -63497,19 +44302,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + //DBG_871X("after handling ps-poll, tim=%x\n", pstapriv->tim_bitmap); + + //upate BCN for TIM IE -+ //update_BCNTIM(padapter); -+ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); ++ //update_BCNTIM(padapter); ++ update_beacon(padapter, _TIM_IE_, NULL, false); + } -+ ++ + //_exit_critical_bh(&psta->sleep_q.lock, &irqL); + _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ ++ + } + else + { + //_exit_critical_bh(&psta->sleep_q.lock, &irqL); + _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ ++ + //DBG_871X("no buffered packets to xmit\n"); + if(pstapriv->tim_bitmap&BIT(psta->aid)) + { @@ -63518,30 +44323,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + DBG_871X("no buffered packets to xmit\n"); + + //issue nulldata with More data bit = 0 to indicate we have no buffered packets -+ issue_nulldata_in_interrupt(padapter, psta->hwaddr, 0); ++ issue_nulldata(padapter, psta->hwaddr, 0, 0, 0); + } + else + { + DBG_871X("error!psta->sleepq_len=%d\n", psta->sleepq_len); -+ psta->sleepq_len=0; ++ psta->sleepq_len=0; + } -+ -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); ++ ++ pstapriv->tim_bitmap &= ~BIT(psta->aid); + + //upate BCN for TIM IE + //update_BCNTIM(padapter); -+ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); ++ update_beacon(padapter, _TIM_IE_, NULL, false); + } -+ } ++ ++ } ++ + } -+#endif //CONFIG_AP_MODE -+ } -+ else if(GetFrameSubType(pframe) == WIFI_NDPA) { -+#ifdef CONFIG_BEAMFORMING -+ beamforming_get_ndpa_frame(padapter, precv_frame); -+#endif/*CONFIG_BEAMFORMING*/ ++ + } + ++#endif ++ + return _FAIL; + +} @@ -63555,7 +44359,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("+validate_recv_mgnt_frame\n")); + +#if 0 -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) + { +#ifdef CONFIG_NATIVEAP_MLME + mgt_dispatcher(padapter, precv_frame); @@ -63585,24 +44389,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + else if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_PROBEREQ) + psta->sta_stats.rx_probereq_pkts++; + else if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_PROBERSP) { -+ if (_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(precv_frame->u.hdr.rx_data), ETH_ALEN) == _TRUE) ++ if (_rtw_memcmp(padapter->eeprompriv.mac_addr, GetAddr1Ptr(precv_frame->u.hdr.rx_data), ETH_ALEN) == true) + psta->sta_stats.rx_probersp_pkts++; + else if (is_broadcast_mac_addr(GetAddr1Ptr(precv_frame->u.hdr.rx_data)) + || is_multicast_mac_addr(GetAddr1Ptr(precv_frame->u.hdr.rx_data))) + psta->sta_stats.rx_probersp_bm_pkts++; -+ else ++ else + psta->sta_stats.rx_probersp_uo_pkts++; + } + } + } + +#ifdef CONFIG_INTEL_PROXIM -+ if(padapter->proximity.proxim_on==_TRUE) ++ if(padapter->proximity.proxim_on==true) + { + struct rx_pkt_attrib * pattrib=&precv_frame->u.hdr.attrib; + struct recv_stat* prxstat=( struct recv_stat * ) precv_frame->u.hdr.rx_head ; + u8 * pda,*psa,*pbssid,*ptr; -+ ptr=precv_frame->u.hdr.rx_data; ++ ptr=precv_frame->u.hdr.rx_data; + pda = get_da(ptr); + psa = get_sa(ptr); + pbssid = get_hdr_bssid(ptr); @@ -63639,7 +44443,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + default: + break; + -+ } ++ } + pattrib->priority=0; + pattrib->hdrlen = pattrib->to_fr_ds==3 ? 30 : 24; + @@ -63660,11 +44464,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + struct sta_info *psta = NULL; + u8 *ptr = precv_frame->u.hdr.rx_data; + struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct security_priv *psecuritypriv = &adapter->securitypriv; + sint ret = _SUCCESS; ++#ifdef CONFIG_TDLS ++ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; ++#endif //CONFIG_TDLS ++ + -+_func_enter_; + + bretry = GetRetry(ptr); + pda = get_da(ptr); @@ -63735,11 +44542,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + ret= _FAIL; + goto exit; + } -+ ++ + //psta->rssi = prxcmd->rssi; + //psta->signal_quality= prxcmd->sq; + precv_frame->u.hdr.psta = psta; -+ ++ + + pattrib->amsdu=0; + pattrib->ack_policy = 0; @@ -63752,9 +44559,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + pattrib->hdrlen = pattrib->to_fr_ds==3 ? 32 : 26; + + if(pattrib->priority!=0 && pattrib->priority!=3) -+ adapter->recvpriv.bIsAnyNonBEPkts = _TRUE; -+ else -+ adapter->recvpriv.bIsAnyNonBEPkts = _FALSE; ++ { ++ adapter->recvpriv.bIsAnyNonBEPkts = true; ++ } + } + else + { @@ -63781,6 +44588,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + goto exit; + } + ++#if 0 ++ if(psta->tdls_sta_state & TDLS_LINKED_STATE ) ++ { ++ if(psta->dot118021XPrivacy==_AES_) ++ pattrib->encrypt=psta->dot118021XPrivacy; ++ } ++#endif //CONFIG_TDLS ++ + if(pattrib->privacy){ + + RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("validate_recv_data_frame:pattrib->privacy=%x\n", pattrib->privacy)); @@ -63807,149 +44622,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + +exit: + -+_func_exit_; ++ + + return ret; +} + -+#ifdef CONFIG_IEEE80211W -+static sint validate_80211w_mgmt(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ u8 type; -+ u8 subtype; -+ -+ type = GetFrameType(ptr); -+ subtype = GetFrameSubType(ptr); //bit(7)~bit(2) -+ -+ if (adapter->securitypriv.binstallBIPkey == _TRUE) -+ { -+ //unicast management frame decrypt -+ if(pattrib->privacy && !(IS_MCAST(GetAddr1Ptr(ptr))) && -+ (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || subtype == WIFI_ACTION)) -+ { -+ u8 *ppp, *mgmt_DATA; -+ u32 data_len=0; -+ ppp = GetAddr2Ptr(ptr); -+ -+ pattrib->bdecrypted = 0; -+ pattrib->encrypt = _AES_; -+ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ //set iv and icv length -+ SET_ICE_IV_LEN(pattrib->iv_len, pattrib->icv_len, pattrib->encrypt); -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); -+ //actual management data frame body -+ data_len = pattrib->pkt_len - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; -+ mgmt_DATA = rtw_zmalloc(data_len); -+ if(mgmt_DATA == NULL) -+ { -+ DBG_871X("%s mgmt allocate fail !!!!!!!!!\n", __FUNCTION__); -+ goto validate_80211w_fail; -+ } -+ /* //dump the packet content before decrypt -+ { -+ int pp; -+ printk("pattrib->pktlen = %d =>", pattrib->pkt_len); -+ for(pp=0;pp< pattrib->pkt_len; pp++) -+ printk(" %02x ", ptr[pp]); -+ printk("\n"); -+ }*/ -+ -+ precv_frame = decryptor(adapter, precv_frame); -+ //save actual management data frame body -+ _rtw_memcpy(mgmt_DATA, ptr+pattrib->hdrlen+pattrib->iv_len, data_len); -+ //overwrite the iv field -+ _rtw_memcpy(ptr+pattrib->hdrlen, mgmt_DATA, data_len); -+ //remove the iv and icv length -+ pattrib->pkt_len = pattrib->pkt_len - pattrib->iv_len - pattrib->icv_len; -+ rtw_mfree(mgmt_DATA, data_len); -+ /* //print packet content after decryption -+ { -+ int pp; -+ printk("after decryption pattrib->pktlen = %d @@=>", pattrib->pkt_len); -+ for(pp=0;pp< pattrib->pkt_len; pp++) -+ printk(" %02x ", ptr[pp]); -+ printk("\n"); -+ }*/ -+ if(!precv_frame) -+ { -+ DBG_871X("%s mgmt descrypt fail !!!!!!!!!\n", __FUNCTION__); -+ goto validate_80211w_fail; -+ } -+ } -+ else if(IS_MCAST(GetAddr1Ptr(ptr)) && -+ (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC)) -+ { -+ sint BIP_ret = _SUCCESS; -+ //verify BIP MME IE of broadcast/multicast de-auth/disassoc packet -+ BIP_ret = rtw_BIP_verify(adapter, (u8 * )precv_frame); -+ if(BIP_ret == _FAIL) -+ { -+ //DBG_871X("802.11w BIP verify fail\n"); -+ goto validate_80211w_fail; -+ } -+ else if(BIP_ret == RTW_RX_HANDLED) -+ { -+ DBG_871X("802.11w recv none protected packet\n"); -+ //drop pkt, don't issue sa query request -+ /* issue_action_SA_Query(adapter, NULL, 0, 0, 0); */ -+ goto validate_80211w_fail; -+ } -+ }//802.11w protect -+ else -+ { -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(ptr)); -+ -+ if (subtype == WIFI_ACTION && psta && psta->bpairwise_key_installed == _TRUE) { -+ //according 802.11-2012 standard, these five types are not robust types -+ if( ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_PUBLIC && -+ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_HT && -+ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_UNPROTECTED_WNM && -+ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_SELF_PROTECTED && -+ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_P2P) -+ { -+ DBG_871X("action frame category=%d should robust\n", ptr[WLAN_HDR_A3_LEN]); -+ goto validate_80211w_fail; -+ } -+ } -+ else if(subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC) -+ { -+ unsigned short reason; -+ reason = le16_to_cpu(*(unsigned short *)(ptr + WLAN_HDR_A3_LEN)); -+ DBG_871X("802.11w recv none protected packet, reason=%d\n", reason); -+ if(reason == 6 || reason == 7) -+ { -+ //issue sa query request -+ issue_action_SA_Query(adapter, NULL, 0, 0, IEEE80211W_RIGHT_KEY); -+ } -+ goto validate_80211w_fail; -+ } -+ } -+ } -+ return _SUCCESS; -+ -+validate_80211w_fail: -+ return _FAIL; -+ -+} -+#endif //CONFIG_IEEE80211W -+ -+static inline void dump_rx_packet(u8 *ptr) -+{ -+ int i; -+ -+ DBG_871X("############################# \n"); -+ for(i=0; i<64;i=i+8) -+ DBG_871X("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr+i), -+ *(ptr+i+1), *(ptr+i+2) ,*(ptr+i+3) ,*(ptr+i+4),*(ptr+i+5), *(ptr+i+6), *(ptr+i+7)); -+ DBG_871X("############################# \n"); -+} -+ +sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame); +sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame) +{ @@ -63980,7 +44657,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + u8 external_len = 0; +#endif + -+_func_enter_; ++ ++ + +#ifdef CONFIG_FIND_BEST_CHANNEL + if (pmlmeext->sitesurvey_res.state == SCAN_PROCESS) { @@ -63996,26 +44674,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + } +#endif //CONFIG_TDLS + -+#ifdef RTK_DMP_PLATFORM -+ if ( 0 ) -+ { -+ DBG_871X("++\n"); -+ { -+ int i; -+ for(i=0; i<64;i=i+8) -+ DBG_871X("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:", *(ptr+i), -+ *(ptr+i+1), *(ptr+i+2) ,*(ptr+i+3) ,*(ptr+i+4),*(ptr+i+5), *(ptr+i+6), *(ptr+i+7)); -+ -+ } -+ DBG_871X("--\n"); -+ } -+#endif //RTK_DMP_PLATFORM -+ + //add version chk + if(ver!=0){ + RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("validate_recv_data_frame fail! (ver!=0)\n")); + retval= _FAIL; -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_ver_err); + goto exit; + } + @@ -64040,53 +44702,64 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +{ + u8 bDumpRxPkt; + rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); -+ if (bDumpRxPkt == 1) //dump all rx packets -+ dump_rx_packet(ptr); -+ else if ((bDumpRxPkt == 2) && (type == WIFI_MGT_TYPE)) -+ dump_rx_packet(ptr); -+ else if ((bDumpRxPkt == 3) && (type == WIFI_DATA_TYPE)) -+ dump_rx_packet(ptr); ++ if(bDumpRxPkt ==1){//dump all rx packets ++ int i; ++ DBG_871X("############################# \n"); ++ ++ for(i=0; i<64;i=i+8) ++ DBG_871X("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr+i), ++ *(ptr+i+1), *(ptr+i+2) ,*(ptr+i+3) ,*(ptr+i+4),*(ptr+i+5), *(ptr+i+6), *(ptr+i+7)); ++ DBG_871X("############################# \n"); ++ } ++ else if(bDumpRxPkt ==2){ ++ if(type== WIFI_MGT_TYPE){ ++ int i; ++ DBG_871X("############################# \n"); ++ ++ for(i=0; i<64;i=i+8) ++ DBG_871X("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr+i), ++ *(ptr+i+1), *(ptr+i+2) ,*(ptr+i+3) ,*(ptr+i+4),*(ptr+i+5), *(ptr+i+6), *(ptr+i+7)); ++ DBG_871X("############################# \n"); ++ } ++ } ++ else if(bDumpRxPkt ==3){ ++ if(type== WIFI_DATA_TYPE){ ++ int i; ++ DBG_871X("############################# \n"); ++ ++ for(i=0; i<64;i=i+8) ++ DBG_871X("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr+i), ++ *(ptr+i+1), *(ptr+i+2) ,*(ptr+i+3) ,*(ptr+i+4),*(ptr+i+5), *(ptr+i+6), *(ptr+i+7)); ++ DBG_871X("############################# \n"); ++ } ++ } +} +#endif + switch (type) + { + case WIFI_MGT_TYPE: //mgnt -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt); -+#ifdef CONFIG_IEEE80211W -+ if(validate_80211w_mgmt(adapter, precv_frame) == _FAIL) -+ { -+ retval = _FAIL; -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt_err_80211w); -+ break; -+ } -+#endif //CONFIG_IEEE80211W -+ + retval = validate_recv_mgnt_frame(adapter, precv_frame); + if (retval == _FAIL) + { + RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("validate_recv_mgnt_frame fail\n")); -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt_err); + } + retval = _FAIL; // only data frame return _SUCCESS + break; + case WIFI_CTRL_TYPE: //ctrl -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_ctrl); + retval = validate_recv_ctrl_frame(adapter, precv_frame); + if (retval == _FAIL) + { + RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("validate_recv_ctrl_frame fail\n")); -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_ctrl_err); + } + retval = _FAIL; // only data frame return _SUCCESS + break; + case WIFI_DATA_TYPE: //data -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data); +#ifdef CONFIG_WAPI_SUPPORT + if(pattrib->qos) + external_len = 2; + else + external_len= 0; -+ ++ + wai_pkt = rtw_wapi_is_wai_packet(adapter,ptr); + + phdr->bIsWaiPacket = wai_pkt; @@ -64099,7 +44772,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + else + { + retval = _FAIL; -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_wapi_seq_err); + break; + } + } @@ -64108,7 +44780,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + if(rtw_wapi_drop_for_key_absent(adapter,GetAddr2Ptr(ptr))){ + retval=_FAIL; + WAPI_TRACE(WAPI_RX,"drop for key absent for rx \n"); -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_wapi_key_err); + break; + } + } @@ -64122,30 +44793,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + struct recv_priv *precvpriv = &adapter->recvpriv; + //RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("validate_recv_data_frame fail\n")); + precvpriv->rx_drop++; -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_err); -+ } -+ else if (retval == _SUCCESS) -+ { -+#ifdef DBG_RX_DUMP_EAP -+ u8 bDumpRxPkt; -+ u16 eth_type; -+ -+ // dump eapol -+ rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); -+ // get ether_type -+ _rtw_memcpy(ð_type, ptr + pattrib->hdrlen + pattrib->iv_len + LLC_HEADER_SIZE, 2); -+ eth_type = ntohs((unsigned short) eth_type); -+ if ((bDumpRxPkt == 4) && (eth_type == 0x888e)) -+ dump_rx_packet(ptr); -+#endif -+ } -+ else -+ { -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_handled); + } + break; + default: -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_unknown); + RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("validate_recv_data_frame fail! type=0x%x\n", type)); + #ifdef DBG_RX_DROP_FRAME + DBG_871X("DBG_RX_DROP_FRAME validate_recv_data_frame fail! type=0x%x\n", type); @@ -64156,7 +44806,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + +exit: + -+_func_exit_; ++ + + return retval; +} @@ -64169,11 +44819,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +sint wlanhdr_to_ethhdr ( union recv_frame *precvframe) +{ + sint rmv_len; -+ u16 eth_type, len; ++ u16 eth_type; ++ u16 len; + u8 bsnaphdr; + u8 *psnap_type; + struct ieee80211_snap_hdr *psnap; -+ ++ __be16 be_tmp; ++ + sint ret=_SUCCESS; + _adapter *adapter =precvframe->u.hdr.adapter; + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; @@ -64181,10 +44833,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + u8 *ptr = get_recvframe_data(precvframe) ; // point to frame_ctrl field + struct rx_pkt_attrib *pattrib = & precvframe->u.hdr.attrib; + -+_func_enter_; ++ + + if(pattrib->encrypt){ -+ recvframe_pull_tail(precvframe, pattrib->icv_len); ++ recvframe_pull_tail(precvframe, pattrib->icv_len); + } + + psnap=(struct ieee80211_snap_hdr *)(ptr+pattrib->hdrlen + pattrib->iv_len); @@ -64192,16 +44844,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + /* convert hdr + possible LLC headers into Ethernet header */ + //eth_type = (psnap_type[0] << 8) | psnap_type[1]; + if((_rtw_memcmp(psnap, rtw_rfc1042_header, SNAP_SIZE) && -+ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_IPX, 2) == _FALSE) && -+ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_AARP, 2)==_FALSE) )|| ++ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_IPX, 2) == false) && ++ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_AARP, 2)==false) )|| + //eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) || + _rtw_memcmp(psnap, rtw_bridge_tunnel_header, SNAP_SIZE)){ + /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ -+ bsnaphdr = _TRUE; ++ bsnaphdr = true; + } + else { + /* Leave Ethernet header part of hdr and full payload */ -+ bsnaphdr = _FALSE; ++ bsnaphdr = false; + } + + rmv_len = pattrib->hdrlen + pattrib->iv_len +(bsnaphdr?SNAP_SIZE:0); @@ -64209,24 +44861,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("\n===pattrib->hdrlen: %x, pattrib->iv_len:%x ===\n\n", pattrib->hdrlen, pattrib->iv_len)); + -+ _rtw_memcpy(ð_type, ptr+rmv_len, 2); -+ eth_type= ntohs((unsigned short )eth_type); //pattrib->ether_type ++ _rtw_memcpy(&be_tmp, ptr+rmv_len, 2); ++ eth_type= ntohs(be_tmp); //pattrib->ether_type + pattrib->eth_type = eth_type; + +#ifdef CONFIG_AUTO_AP_MODE + if (0x8899 == pattrib->eth_type) + { + struct sta_info *psta = precvframe->u.hdr.psta; -+ -+ DBG_871X("wlan rx: got eth_type=0x%x\n", pattrib->eth_type); -+ ++ ++ DBG_871X("wlan rx: got eth_type=0x%x\n", pattrib->eth_type); ++ + if (psta && psta->isrc && psta->pid>0) + { + u16 rx_pid; + + rx_pid = *(u16*)(ptr+rmv_len+2); -+ -+ DBG_871X("wlan rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", ++ ++ DBG_871X("wlan rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", + rx_pid, MAC_ARG(psta->hwaddr), psta->pid); + + if(rx_pid == psta->pid) @@ -64235,55 +44887,45 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + u16 len = *(u16*)(ptr+rmv_len+4); + //u16 ctrl_type = *(u16*)(ptr+rmv_len+6); + -+ //DBG_871X("RC: len=0x%x, ctrl_type=0x%x\n", len, ctrl_type); -+ DBG_871X("RC: len=0x%x\n", len); ++ //DBG_871X("RC: len=0x%x, ctrl_type=0x%x\n", len, ctrl_type); ++ DBG_871X("RC: len=0x%x\n", len); + + for(i=0;idst, ETH_ALEN); -+ _rtw_memcpy(ptr+ETH_ALEN, pattrib->src, ETH_ALEN); ++ _rtw_memcpy(ptr, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(ptr+ETH_ALEN, pattrib->src, ETH_ALEN); + -+ if(!bsnaphdr) { -+ len = htons(len); -+ _rtw_memcpy(ptr+12, &len, 2); -+ } ++ if(!bsnaphdr) { ++ __be16 be_len = htons(len); ++ ++ _rtw_memcpy(ptr+12, &be_len, 2); + } + -+exiting: -+_func_exit_; ++ + return ret; + +} @@ -64306,19 +44948,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + struct rx_pkt_attrib *pattrib = & precvframe->u.hdr.attrib; + struct _vlan *pvlan = NULL; + -+_func_enter_; ++ + + psnap=(struct ieee80211_snap_hdr *)(ptr+pattrib->hdrlen + pattrib->iv_len); + psnap_type=ptr+pattrib->hdrlen + pattrib->iv_len+SNAP_SIZE; + if (psnap->dsap==0xaa && psnap->ssap==0xaa && psnap->ctrl==0x03) + { + if (_rtw_memcmp(psnap->oui, oui_rfc1042, WLAN_IEEE_OUI_LEN)) -+ bsnaphdr=_TRUE;//wlan_pkt_format = WLAN_PKT_FORMAT_SNAP_RFC1042; ++ bsnaphdr=true;//wlan_pkt_format = WLAN_PKT_FORMAT_SNAP_RFC1042; + else if (_rtw_memcmp(psnap->oui, SNAP_HDR_APPLETALK_DDP, WLAN_IEEE_OUI_LEN) && + _rtw_memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_DDP, 2) ) -+ bsnaphdr=_TRUE; //wlan_pkt_format = WLAN_PKT_FORMAT_APPLETALK; ++ bsnaphdr=true; //wlan_pkt_format = WLAN_PKT_FORMAT_APPLETALK; + else if (_rtw_memcmp( psnap->oui, oui_8021h, WLAN_IEEE_OUI_LEN)) -+ bsnaphdr=_TRUE; //wlan_pkt_format = WLAN_PKT_FORMAT_SNAP_TUNNEL; ++ bsnaphdr=true; //wlan_pkt_format = WLAN_PKT_FORMAT_SNAP_TUNNEL; + else { + RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("drop pkt due to invalid frame format!\n")); + ret= _FAIL; @@ -64326,12 +44968,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + } + + } else -+ bsnaphdr=_FALSE;//wlan_pkt_format = WLAN_PKT_FORMAT_OTHERS; ++ bsnaphdr=false;//wlan_pkt_format = WLAN_PKT_FORMAT_OTHERS; + + rmv_len = pattrib->hdrlen + pattrib->iv_len +(bsnaphdr?SNAP_SIZE:0); + RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("===pattrib->hdrlen: %x, pattrib->iv_len:%x ===\n", pattrib->hdrlen, pattrib->iv_len)); + -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) ++ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) + { + ptr += rmv_len ; + *ptr = 0x87; @@ -64380,21 +45022,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + } + else + { -+#ifdef PLATFORM_OS_XP -+ NDIS_PACKET_8021Q_INFO VlanPriInfo; -+ UINT32 UserPriority = precvframe->u.hdr.attrib.priority; -+ UINT32 VlanID = (pvlan!=NULL ? get_vlan_id(pvlan) : 0 ); -+ -+ VlanPriInfo.Value = // Get current value. -+ NDIS_PER_PACKET_INFO_FROM_PACKET(precvframe->u.hdr.pkt, Ieee8021QInfo); -+ -+ VlanPriInfo.TagHeader.UserPriority = UserPriority; -+ VlanPriInfo.TagHeader.VlanId = VlanID ; -+ -+ VlanPriInfo.TagHeader.CanonicalFormatId = 0; // Should be zero. -+ VlanPriInfo.TagHeader.Reserved = 0; // Should be zero. -+ NDIS_PER_PACKET_INFO_FROM_PACKET(precvframe->u.hdr.pkt, Ieee8021QInfo) = VlanPriInfo.Value; -+#endif + } + + if(eth_type==0x8712)// append rx status for mp test packets @@ -64414,74 +45041,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + +exit: + -+_func_exit_; ++ + + return ret; +} +#endif + -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#ifdef PLATFORM_LINUX -+static void recvframe_expand_pkt( -+ PADAPTER padapter, -+ union recv_frame *prframe) -+{ -+ struct recv_frame_hdr *pfhdr; -+ _pkt *ppkt; -+ u8 shift_sz; -+ u32 alloc_sz; -+ u8 *ptr; -+ -+ -+ pfhdr = &prframe->u.hdr; -+ -+ // 6 is for IP header 8 bytes alignment in QoS packet case. -+ if (pfhdr->attrib.qos) -+ shift_sz = 6; -+ else -+ shift_sz = 0; -+ -+ // for first fragment packet, need to allocate -+ // (1536 + RXDESC_SIZE + drvinfo_sz) to reassemble packet -+ // 8 is for skb->data 8 bytes alignment. -+// alloc_sz = _RND(1536 + RXDESC_SIZE + pfhdr->attrib.drvinfosize + shift_sz + 8, 128); -+ alloc_sz = 1664; // round (1536 + 24 + 32 + shift_sz + 8) to 128 bytes alignment -+ -+ //3 1. alloc new skb -+ // prepare extra space for 4 bytes alignment -+ ppkt = rtw_skb_alloc(alloc_sz); -+ -+ if (!ppkt) return; // no way to expand -+ -+ //3 2. Prepare new skb to replace & release old skb -+ // force ppkt->data at 8-byte alignment address -+ skb_reserve(ppkt, 8 - ((SIZE_PTR)ppkt->data & 7)); -+ // force ip_hdr at 8-byte alignment address according to shift_sz -+ skb_reserve(ppkt, shift_sz); -+ -+ // copy data to new pkt -+ ptr = skb_put(ppkt, pfhdr->len); -+ if (ptr) -+ _rtw_memcpy(ptr, pfhdr->rx_data, pfhdr->len); -+ -+ rtw_skb_free(pfhdr->pkt); -+ -+ // attach new pkt to recvframe -+ pfhdr->pkt = ppkt; -+ pfhdr->rx_head = ppkt->head; -+ pfhdr->rx_data = ppkt->data; -+ pfhdr->rx_tail = skb_tail_pointer(ppkt); -+ pfhdr->rx_end = skb_end_pointer(ppkt); -+} -+#else -+#warning "recvframe_expand_pkt not implement, defrag may crash system" -+#endif -+#endif -+ +//perform defrag -+union recv_frame * recvframe_defrag(_adapter *adapter,_queue *defrag_q); -+union recv_frame * recvframe_defrag(_adapter *adapter,_queue *defrag_q) ++static union recv_frame * recvframe_defrag(_adapter *adapter,_queue *defrag_q) +{ + _list *plist, *phead; + u8 *data,wlanhdr_offset; @@ -64490,7 +45057,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + union recv_frame* prframe, *pnextrframe; + _queue *pfree_recv_queue; + -+_func_enter_; ++ + + curfragnum=0; + pfree_recv_queue=&adapter->recvpriv.free_recv_queue; @@ -64511,12 +45078,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + return NULL; + } + -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#ifndef CONFIG_SDIO_RX_COPY -+ recvframe_expand_pkt(adapter, prframe); -+#endif -+#endif -+ + curfragnum++; + + plist= get_list_head(defrag_q); @@ -64525,7 +45086,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + data=get_recvframe_data(prframe); + -+ while(rtw_end_of_queue_search(phead, plist) == _FALSE) ++ while(rtw_end_of_queue_search(phead, plist) == false) + { + pnextrframe = LIST_CONTAINOR(plist, union recv_frame , u); + pnfhdr=&pnextrframe->u.hdr; @@ -64569,7 +45130,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("Performance defrag!!!!!\n")); + -+_func_exit_; ++ + + return prframe; +} @@ -64587,7 +45148,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + union recv_frame *prtnframe = NULL; + _queue *pfree_recv_queue, *pdefrag_q; + -+_func_enter_; ++ + + pstapriv = &padapter->stapriv; + @@ -64627,7 +45188,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + if(fragnum==0) + { + //the first fragment -+ if(_rtw_queue_empty(pdefrag_q) == _FALSE) ++ if(_rtw_queue_empty(pdefrag_q) == false) + { + //free current defrag_q + rtw_free_recvframe_queue(pdefrag_q, pfree_recv_queue); @@ -64696,16 +45257,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + } + } + -+_func_exit_; ++ + + return prtnframe; + +} + -+int amsdu_to_msdu(_adapter *padapter, union recv_frame *prframe) ++static int amsdu_to_msdu(_adapter *padapter, union recv_frame *prframe) +{ + int a_len, padding_len; -+ u16 nSubframe_Length; ++ u16 nSubframe_Length; + u8 nr_subframes, i; + u8 *pdata; + _pkt *sub_pkt,*subframes[MAX_SUBFRAME_COUNT]; @@ -64716,7 +45277,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + nr_subframes = 0; + + recvframe_pull(prframe, prframe->u.hdr.attrib.hdrlen); -+ ++ + if(prframe->u.hdr.attrib.iv_len >0) + { + recvframe_pull(prframe, prframe->u.hdr.attrib.iv_len); @@ -64781,16 +45342,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + prframe->u.hdr.len = 0; + rtw_free_recvframe(prframe, pfree_recv_queue);//free this recv_frame -+ ++ + return ret; +} + +int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num); +int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num) +{ -+ PADAPTER padapter = preorder_ctrl->padapter; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; + u8 wsize = preorder_ctrl->wsize_b; + u16 wend = (preorder_ctrl->indicate_seq + wsize -1) & 0xFFF;//% 4096; + @@ -64815,12 +45373,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + //DbgPrint("CheckRxTsIndicateSeq(): Packet Drop! IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); + + #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("%s IndicateSeq: %d > NewSeq: %d\n", __FUNCTION__, ++ DBG_871X("%s IndicateSeq: %d > NewSeq: %d\n", __FUNCTION__, + preorder_ctrl->indicate_seq, seq_num); + #endif + + -+ return _FALSE; ++ return false; + } + + // @@ -64831,7 +45389,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + if( SN_EQUAL(seq_num, preorder_ctrl->indicate_seq) ) + { + preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) & 0xFFF; -+ + #ifdef DBG_RX_SEQ + DBG_871X("DBG_RX_SEQ %s:%d SN_EQUAL IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, + preorder_ctrl->indicate_seq, seq_num); @@ -64847,7 +45404,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + preorder_ctrl->indicate_seq = seq_num + 1 -wsize; + else + preorder_ctrl->indicate_seq = 0xFFF - (wsize - (seq_num + 1)) + 1; -+ pdbgpriv->dbg_rx_ampdu_window_shift_cnt++; ++ + #ifdef DBG_RX_SEQ + DBG_871X("DBG_RX_SEQ %s:%d SN_LESS(wend, seq_num) IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, + preorder_ctrl->indicate_seq, seq_num); @@ -64856,7 +45413,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + //DbgPrint("exit->check_indicate_seq(): IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); + -+ return _TRUE; ++ return true; +} + +int enqueue_reorder_recvframe(struct recv_reorder_ctrl *preorder_ctrl, union recv_frame *prframe); @@ -64877,7 +45434,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + phead = get_list_head(ppending_recvframe_queue); + plist = get_next(phead); + -+ while(rtw_end_of_queue_search(phead, plist) == _FALSE) ++ while(rtw_end_of_queue_search(phead, plist) == false) + { + pnextrframe = LIST_CONTAINOR(plist, union recv_frame, u); + pnextattrib = &pnextrframe->u.hdr.attrib; @@ -64893,7 +45450,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + //_exit_critical_ex(&ppending_recvframe_queue->lock, &irql); + -+ return _FALSE; ++ return false; + } + else + { @@ -64917,23 +45474,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + + //RT_TRACE(COMP_RX_REORDER, DBG_TRACE, ("InsertRxReorderList(): Pkt insert into buffer!! IndicateSeq: %d, NewSeq: %d\n", pTS->RxIndicateSeq, SeqNum)); -+ return _TRUE; ++ return true; + +} + -+void recv_indicatepkts_pkt_loss_cnt(struct debug_priv *pdbgpriv, u64 prev_seq, u64 current_seq); -+void recv_indicatepkts_pkt_loss_cnt(struct debug_priv *pdbgpriv, u64 prev_seq, u64 current_seq) -+{ -+ if(current_seq < prev_seq) -+ { -+ pdbgpriv->dbg_rx_ampdu_loss_count+= (4096 + current_seq - prev_seq); -+ -+ } -+ else -+ { -+ pdbgpriv->dbg_rx_ampdu_loss_count+= (current_seq - prev_seq); -+ } -+} +int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced); +int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced) +{ @@ -64943,20 +45487,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + union recv_frame *prframe; + struct rx_pkt_attrib *pattrib; + //u8 index = 0; -+ int bPktInBuf = _FALSE; ++ int bPktInBuf = false; + struct recv_priv *precvpriv = &padapter->recvpriv; + _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_in_oder); + + //DbgPrint("+recv_indicatepkts_in_order\n"); + + //_enter_critical_ex(&ppending_recvframe_queue->lock, &irql); + //_rtw_spinlock_ex(&ppending_recvframe_queue->lock); + -+ phead = get_list_head(ppending_recvframe_queue); ++ phead = get_list_head(ppending_recvframe_queue); + plist = get_next(phead); + +#if 0 @@ -64966,33 +45506,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +#endif + + // Handling some condition for forced indicate case. -+ if(bforced==_TRUE) ++ if(bforced==true) + { -+ pdbgpriv->dbg_rx_ampdu_forced_indicate_count++; + if(rtw_is_list_empty(phead)) + { + // _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); + //_rtw_spinunlock_ex(&ppending_recvframe_queue->lock); -+ return _TRUE; ++ return true; + } -+ -+ prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pattrib = &prframe->u.hdr.attrib; + ++ prframe = LIST_CONTAINOR(plist, union recv_frame, u); ++ pattrib = &prframe->u.hdr.attrib; ++ preorder_ctrl->indicate_seq = pattrib->seq_num; + #ifdef DBG_RX_SEQ + DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, + preorder_ctrl->indicate_seq, pattrib->seq_num); + #endif -+ recv_indicatepkts_pkt_loss_cnt(pdbgpriv,preorder_ctrl->indicate_seq,pattrib->seq_num); -+ preorder_ctrl->indicate_seq = pattrib->seq_num; -+ + } + + // Prepare indication list and indication. + // Check if there is any packet need indicate. + while(!rtw_is_list_empty(phead)) + { -+ ++ + prframe = LIST_CONTAINOR(plist, union recv_frame, u); + pattrib = &prframe->u.hdr.attrib; + @@ -65006,8 +45542,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + // This protect buffer from overflow. + if(index >= REORDER_WIN_SIZE) + { -+ RT_ASSERT(FALSE, ("IndicateRxReorderList(): Buffer overflow!! \n")); -+ bPktInBuf = TRUE; ++ RT_ASSERT(false, ("IndicateRxReorderList(): Buffer overflow!! \n")); ++ bPktInBuf = true; + break; + } +#endif @@ -65030,7 +45566,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + { + //Cancel previous pending timer. + //PlatformCancelTimer(Adapter, &pTS->RxPktPendingTimer); -+ if(bforced!=_TRUE) ++ if(bforced!=true) + { + //DBG_871X("_cancel_timer(&preorder_ctrl->reordering_ctrl_timer, &bcancelled);\n"); + _cancel_timer(&preorder_ctrl->reordering_ctrl_timer, &bcancelled); @@ -65051,9 +45587,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + { + //DBG_871X("recv_indicatepkts_in_order, amsdu!=1, indicate_seq=%d, seq_num=%d\n", preorder_ctrl->indicate_seq, pattrib->seq_num); + -+ if (!RTW_CANNOT_RUN(padapter)) -+ rtw_recv_indicatepkt(padapter, prframe);/*indicate this recv_frame*/ ++ if ((padapter->bDriverStopped == false) && ++ (padapter->bSurpriseRemoved == false)) ++ { + ++ rtw_recv_indicatepkt(padapter, prframe);//indicate this recv_frame ++ ++ } + } + else if(pattrib->amsdu==1) + { @@ -65069,12 +45609,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + + //Update local variables. -+ bPktInBuf = _FALSE; ++ bPktInBuf = false; + + } + else + { -+ bPktInBuf = _TRUE; ++ bPktInBuf = true; + break; + } + @@ -65102,7 +45642,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +*/ + //_exit_critical_ex(&ppending_recvframe_queue->lock, &irql); + -+ //return _TRUE; ++ //return true; + return bPktInBuf; + +} @@ -65115,63 +45655,52 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; + struct recv_reorder_ctrl *preorder_ctrl = prframe->u.hdr.preorder_ctrl; + _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_reoder); + + if(!pattrib->amsdu) + { + //s1. -+ retval = wlanhdr_to_ethhdr(prframe); -+ if (retval != _SUCCESS) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("wlanhdr_to_ethhdr: drop pkt \n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr error!\n", __FUNCTION__); -+ #endif -+ return retval; -+ } ++ wlanhdr_to_ethhdr(prframe); + -+ //if ((pattrib->qos!=1) /*|| pattrib->priority!=0 || IS_MCAST(pattrib->ra)*/ -+ // || (pattrib->eth_type==0x0806) || (pattrib->ack_policy!=0)) -+ if (pattrib->qos!=1) ++ if ((pattrib->qos!=1) /*|| pattrib->priority!=0 || IS_MCAST(pattrib->ra)*/ ++ || (pattrib->eth_type==0x0806) || (pattrib->ack_policy!=0)) + { -+ if (!RTW_CANNOT_RUN(padapter)) { ++ if ((padapter->bDriverStopped == false) && ++ (padapter->bSurpriseRemoved == false)) ++ { + RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("@@@@ recv_indicatepkt_reorder -recv_func recv_indicatepkt\n" )); + + rtw_recv_indicatepkt(padapter, prframe); + return _SUCCESS; + + } -+ ++ + #ifdef DBG_RX_DROP_FRAME + DBG_871X("DBG_RX_DROP_FRAME %s pattrib->qos !=1\n", __FUNCTION__); + #endif -+ ++ + return _FAIL; -+ ++ + } + -+ if (preorder_ctrl->enable == _FALSE) ++ if (preorder_ctrl->enable == false) + { -+ //indicate this recv_frame ++ //indicate this recv_frame + preorder_ctrl->indicate_seq = pattrib->seq_num; + #ifdef DBG_RX_SEQ + DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, + preorder_ctrl->indicate_seq, pattrib->seq_num); + #endif -+ -+ rtw_recv_indicatepkt(padapter, prframe); -+ ++ ++ rtw_recv_indicatepkt(padapter, prframe); ++ + preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1)%4096; + #ifdef DBG_RX_SEQ + DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, + preorder_ctrl->indicate_seq, pattrib->seq_num); + #endif -+ -+ return _SUCCESS; -+ } ++ ++ return _SUCCESS; ++ } + +#ifndef CONFIG_RECV_REORDERING_CTRL + //indicate this recv_frame @@ -65182,7 +45711,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + } + else if(pattrib->amsdu==1) //temp filter -> means didn't support A-MSDUs in a A-MPDU + { -+ if (preorder_ctrl->enable == _FALSE) ++ if (preorder_ctrl->enable == false) + { + preorder_ctrl->indicate_seq = pattrib->seq_num; + #ifdef DBG_RX_SEQ @@ -65221,7 +45750,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + //s2. check if winstart_b(indicate_seq) needs to been updated + if(!check_indicate_seq(preorder_ctrl, pattrib->seq_num)) + { -+ pdbgpriv->dbg_rx_ampdu_drop_count++; + //pHTInfo->RxReorderDropCounter++; + //ReturnRFDList(Adapter, pRfd); + //RT_TRACE(COMP_RX_REORDER, DBG_TRACE, ("RxReorderIndicatePacket() ==> Packet Drop!!\n")); @@ -65231,11 +45759,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + #ifdef DBG_RX_DROP_FRAME + DBG_871X("DBG_RX_DROP_FRAME %s check_indicate_seq fail\n", __FUNCTION__); + #endif -+#if 0 ++#if 0 + rtw_recv_indicatepkt(padapter, prframe); + + _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ ++ + goto _success_exit; +#else + goto _err_exit; @@ -65266,8 +45794,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + // 2. All packets with SeqNum larger than or equal to WinStart => Buffer it. + // + -+ //recv_indicatepkts_in_order(padapter, preorder_ctrl, _TRUE); -+ if(recv_indicatepkts_in_order(padapter, preorder_ctrl, _FALSE)==_TRUE) ++ //recv_indicatepkts_in_order(padapter, preorder_ctrl, true); ++ if(recv_indicatepkts_in_order(padapter, preorder_ctrl, false)==true) + { + _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); + _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); @@ -65299,16 +45827,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; + + -+ if (RTW_CANNOT_RUN(padapter)) ++ if(padapter->bDriverStopped ||padapter->bSurpriseRemoved) ++ { + return; ++ } + + //DBG_871X("+rtw_reordering_ctrl_timeout_handler()=>\n"); + + _enter_critical_bh(&ppending_recvframe_queue->lock, &irql); + -+ if(recv_indicatepkts_in_order(padapter, preorder_ctrl, _TRUE)==_TRUE) ++ if(recv_indicatepkts_in_order(padapter, preorder_ctrl, true)==true) + { -+ _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); ++ _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); + } + + _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); @@ -65329,16 +45859,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au +#ifdef CONFIG_80211N_HT + + struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate); + +#ifdef CONFIG_TDLS -+ if( (phtpriv->ht_option==_TRUE) || -+ ((psta->tdls_sta_state & TDLS_LINKED_STATE) && -+ (psta->htpriv.ht_option==_TRUE) && -+ (psta->htpriv.ampdu_enable==_TRUE))) //B/G/N Mode ++ if( (phtpriv->ht_option==true) || ++ ((psta->tdls_sta_state & TDLS_LINKED_STATE) && ++ (psta->htpriv.ht_option==true) && ++ (psta->htpriv.ampdu_enable==true))) //B/G/N Mode +#else -+ if(phtpriv->ht_option==_TRUE) //B/G/N Mode ++ if(phtpriv->ht_option==true) //B/G/N Mode +#endif //CONFIG_TDLS + { + //prframe->u.hdr.preorder_ctrl = &precvpriv->recvreorder_ctrl[pattrib->priority]; @@ -65348,8 +45876,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + #ifdef DBG_RX_DROP_FRAME + DBG_871X("DBG_RX_DROP_FRAME %s recv_indicatepkt_reorder error!\n", __FUNCTION__); + #endif -+ -+ if (!RTW_CANNOT_RUN(padapter)) { ++ ++ if ((padapter->bDriverStopped == false) && ++ (padapter->bSurpriseRemoved == false)) ++ { + retval = _FAIL; + return retval; + } @@ -65368,18 +45898,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + return retval; + } + -+ if (!RTW_CANNOT_RUN(padapter)) { ++ if ((padapter->bDriverStopped ==false)&&( padapter->bSurpriseRemoved==false)) ++ { + //indicate this recv_frame + RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("@@@@ process_recv_indicatepkts- recv_func recv_indicatepkt\n" )); + rtw_recv_indicatepkt(padapter, prframe); ++ ++ + } + else + { + RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("@@@@ process_recv_indicatepkts- recv_func free_indicatepkt\n" )); + -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("recv_func:bDriverStopped(%s) OR bSurpriseRemoved(%s)" -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False")); ++ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("recv_func:bDriverStopped(%d) OR bSurpriseRemoved(%d)", padapter->bDriverStopped, padapter->bSurpriseRemoved)); + retval = _FAIL; + return retval; + } @@ -65390,650 +45921,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + +} + -+#ifdef CONFIG_MP_INCLUDED -+int validate_mp_recv_frame(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ int ret = _SUCCESS; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ u8 type,subtype; -+ -+ if(!adapter->mppriv.bmac_filter) -+ return ret; -+#if 0 -+ if (1){ -+ u8 bDumpRxPkt; -+ type = GetFrameType(ptr); -+ subtype = GetFrameSubType(ptr); //bit(7)~bit(2) -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); -+ if(bDumpRxPkt ==1){//dump all rx packets -+ int i; -+ DBG_871X("############ type:0x%02x subtype:0x%02x ################# \n",type,subtype); -+ -+ for(i=0; i<64;i=i+8) -+ DBG_871X("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr+i), -+ *(ptr+i+1), *(ptr+i+2) ,*(ptr+i+3) ,*(ptr+i+4),*(ptr+i+5), *(ptr+i+6), *(ptr+i+7)); -+ DBG_871X("############################# \n"); -+ } -+ } -+#endif -+ -+ if(_rtw_memcmp( GetAddr2Ptr(ptr), adapter->mppriv.mac_filter, ETH_ALEN) == _FALSE ) -+ ret = _FAIL; -+ -+ return ret; -+} -+#endif -+ -+static sint MPwlanhdr_to_ethhdr ( union recv_frame *precvframe) -+{ -+ sint rmv_len; -+ u16 eth_type, len; -+ u8 bsnaphdr; -+ u8 *psnap_type; -+ u8 mcastheadermac[]={0x01,0x00,0x5e}; -+ -+ struct ieee80211_snap_hdr *psnap; -+ -+ sint ret=_SUCCESS; -+ _adapter *adapter =precvframe->u.hdr.adapter; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ u8 *ptr = get_recvframe_data(precvframe) ; // point to frame_ctrl field -+ struct rx_pkt_attrib *pattrib = & precvframe->u.hdr.attrib; -+ -+_func_enter_; -+ -+ if(pattrib->encrypt){ -+ recvframe_pull_tail(precvframe, pattrib->icv_len); -+ } -+ -+ psnap=(struct ieee80211_snap_hdr *)(ptr+pattrib->hdrlen + pattrib->iv_len); -+ psnap_type=ptr+pattrib->hdrlen + pattrib->iv_len+SNAP_SIZE; -+ /* convert hdr + possible LLC headers into Ethernet header */ -+ //eth_type = (psnap_type[0] << 8) | psnap_type[1]; -+ if((_rtw_memcmp(psnap, rtw_rfc1042_header, SNAP_SIZE) && -+ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_IPX, 2) == _FALSE) && -+ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_AARP, 2)==_FALSE) )|| -+ //eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) || -+ _rtw_memcmp(psnap, rtw_bridge_tunnel_header, SNAP_SIZE)){ -+ /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ -+ bsnaphdr = _TRUE; -+ } -+ else { -+ /* Leave Ethernet header part of hdr and full payload */ -+ bsnaphdr = _FALSE; -+ } -+ -+ rmv_len = pattrib->hdrlen + pattrib->iv_len +(bsnaphdr?SNAP_SIZE:0); -+ len = precvframe->u.hdr.len - rmv_len; -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("\n===pattrib->hdrlen: %x, pattrib->iv_len:%x ===\n\n", pattrib->hdrlen, pattrib->iv_len)); -+ -+ _rtw_memcpy(ð_type, ptr+rmv_len, 2); -+ eth_type= ntohs((unsigned short )eth_type); //pattrib->ether_type -+ pattrib->eth_type = eth_type; -+ -+ { -+ ptr = recvframe_pull(precvframe, (rmv_len-sizeof(struct ethhdr)+ (bsnaphdr?2:0))); -+ } -+ -+ _rtw_memcpy(ptr, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(ptr+ETH_ALEN, pattrib->src, ETH_ALEN); -+ -+ if(!bsnaphdr) { -+ len = htons(len); -+ _rtw_memcpy(ptr+12, &len, 2); -+ } -+ -+ -+ len = htons(pattrib->seq_num); -+ //DBG_871X("wlan seq = %d ,seq_num =%x\n",len,pattrib->seq_num); -+ _rtw_memcpy(ptr+12,&len, 2); -+ if(adapter->mppriv.bRTWSmbCfg==_TRUE) -+ { -+// if(_rtw_memcmp(mcastheadermac, pattrib->dst, 3) == _TRUE)//SimpleConfig Dest. -+// _rtw_memcpy(ptr+ETH_ALEN, pattrib->bssid, ETH_ALEN); -+ -+ if(_rtw_memcmp(mcastheadermac, pattrib->bssid, 3) == _TRUE) //SimpleConfig Dest. -+ _rtw_memcpy(ptr, pattrib->bssid, ETH_ALEN); -+ -+ } -+ -+ -+_func_exit_; -+ return ret; -+ -+} -+ -+ -+int mp_recv_frame(_adapter *padapter, union recv_frame *rframe) ++static int recv_func_prehandle(_adapter *padapter, union recv_frame *rframe) +{ + int ret = _SUCCESS; + struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; + struct recv_priv *precvpriv = &padapter->recvpriv; + _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; ++ +#ifdef CONFIG_MP_INCLUDED + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mp_priv *pmppriv = &padapter->mppriv; +#endif //CONFIG_MP_INCLUDED -+ u8 type; -+ u8 *ptr = rframe->u.hdr.rx_data; -+ u8 *psa, *pda, *pbssid; -+ struct sta_info *psta = NULL; -+ DBG_COUNTER(padapter->rx_logs.core_rx_pre); -+ -+ if ( (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) )//&&(padapter->mppriv.check_mp_pkt == 0)) -+ { -+ if (pattrib->crc_err == 1){ -+ padapter->mppriv.rx_crcerrpktcount++; -+ } -+ else{ -+ if(_SUCCESS == validate_mp_recv_frame(padapter, rframe)) -+ padapter->mppriv.rx_pktcount++; -+ else -+ padapter->mppriv.rx_pktcount_filter_out++; -+ } + -+ if(pmppriv->rx_bindicatePkt == _FALSE) ++#ifdef CONFIG_MP_INCLUDED ++ if (padapter->registrypriv.mp_mode == 1) ++ { ++ if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == true))//&&(padapter->mppriv.check_mp_pkt == 0)) + { -+ //RT_TRACE(_module_rtl871x_recv_c_, _drv_alert_, ("MP - Not in loopback mode , drop pkt \n")); ++ if (pattrib->crc_err == 1) ++ padapter->mppriv.rx_crcerrpktcount++; ++ else ++ padapter->mppriv.rx_pktcount++; ++ ++ if (check_fwstate(pmlmepriv, WIFI_MP_LPBK_STATE) == false) { ++ RT_TRACE(_module_rtl871x_recv_c_, _drv_alert_, ("MP - Not in loopback mode , drop pkt \n")); + ret = _FAIL; + rtw_free_recvframe(rframe, pfree_recv_queue);//free this recv_frame + goto exit; + } -+ else -+ { -+ type = GetFrameType(ptr); -+ pattrib->to_fr_ds = get_tofr_ds(ptr); -+ pattrib->frag_num = GetFragNum(ptr); -+ pattrib->seq_num = GetSequence(ptr); -+ pattrib->pw_save = GetPwrMgt(ptr); -+ pattrib->mfrag = GetMFrag(ptr); -+ pattrib->mdata = GetMData(ptr); -+ pattrib->privacy = GetPrivacy(ptr); -+ pattrib->order = GetOrder(ptr); -+ -+ if(type ==WIFI_DATA_TYPE) -+ { -+ pda = get_da(ptr); -+ psa = get_sa(ptr); -+ pbssid = get_hdr_bssid(ptr); -+ -+ _rtw_memcpy(pattrib->dst, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, psa, ETH_ALEN); -+ _rtw_memcpy(pattrib->bssid, pbssid, ETH_ALEN); -+ -+ switch(pattrib->to_fr_ds) -+ { -+ case 0: -+ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); -+ ret = sta2sta_data_frame(padapter, rframe, &psta); -+ break; -+ -+ case 1: -+ -+ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pbssid, ETH_ALEN); -+ ret = ap2sta_data_frame(padapter, rframe, &psta); -+ -+ break; -+ -+ case 2: -+ _rtw_memcpy(pattrib->ra, pbssid, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); -+ ret = sta2ap_data_frame(padapter, rframe, &psta); -+ break; -+ -+ case 3: -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); -+ ret =_FAIL; -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,(" case 3\n")); -+ break; -+ -+ default: -+ ret =_FAIL; -+ break; -+ } -+ -+ ret = MPwlanhdr_to_ethhdr (rframe); -+ -+ if (ret != _SUCCESS) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("wlanhdr_to_ethhdr: drop pkt \n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr: drop pkt\n", __FUNCTION__); -+ #endif -+ rtw_free_recvframe(rframe, pfree_recv_queue);//free this recv_frame -+ ret = _FAIL; -+ goto exit; -+ } -+ if (!RTW_CANNOT_RUN(padapter)) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_alert_, ("@@@@ recv_func: recv_func rtw_recv_indicatepkt\n" )); -+ //indicate this recv_frame -+ ret = rtw_recv_indicatepkt(padapter, rframe); -+ if (ret != _SUCCESS) -+ { -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s rtw_recv_indicatepkt fail!\n", __FUNCTION__); -+ #endif -+ rtw_free_recvframe(rframe, pfree_recv_queue);//free this recv_frame -+ ret = _FAIL; -+ -+ goto exit; -+ } -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_alert_, ("@@@@ recv_func: rtw_free_recvframe\n" )); -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_debug_, ("recv_func:bDriverStopped(%s) OR bSurpriseRemoved(%s)" -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s ecv_func:bDriverStopped(%s) OR bSurpriseRemoved(%s)\n", __func__, -+ rtw_is_drv_stopped(padapter)?"True":"False", -+ rtw_is_surprise_removed(padapter)?"True":"False"); -+ #endif -+ ret = _FAIL; -+ rtw_free_recvframe(rframe, pfree_recv_queue);//free this recv_frame -+ goto exit; -+ } -+ -+ } -+ } -+ -+ } -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("recv_func: validate_recv_frame fail! drop pkt\n")); -+ rtw_free_recvframe(rframe, pfree_recv_queue);//free this recv_frame -+ ret = _FAIL; -+ -+exit: -+ return ret; -+ -+} -+ -+static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, u8 *buf) -+{ -+#define CHAN2FREQ(a) ((a < 14)?(2407+5*a):(5000+5*a)) -+ -+#if 0 -+#define RTW_RX_RADIOTAP_PRESENT ( \ -+ (1 << IEEE80211_RADIOTAP_TSFT) | \ -+ (1 << IEEE80211_RADIOTAP_FLAGS) | \ -+ (1 << IEEE80211_RADIOTAP_RATE) | \ -+ (1 << IEEE80211_RADIOTAP_CHANNEL) | \ -+ (0 << IEEE80211_RADIOTAP_FHSS) | \ -+ (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) | \ -+ (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) | \ -+ (0 << IEEE80211_RADIOTAP_LOCK_QUALITY) | \ -+ (0 << IEEE80211_RADIOTAP_TX_ATTENUATION) | \ -+ (0 << IEEE80211_RADIOTAP_DB_TX_ATTENUATION) | \ -+ (0 << IEEE80211_RADIOTAP_DBM_TX_POWER) | \ -+ (1 << IEEE80211_RADIOTAP_ANTENNA) | \ -+ (1 << IEEE80211_RADIOTAP_DB_ANTSIGNAL) | \ -+ (0 << IEEE80211_RADIOTAP_DB_ANTNOISE) | \ -+ (0 << IEEE80211_RADIOTAP_RX_FLAGS) | \ -+ (0 << IEEE80211_RADIOTAP_TX_FLAGS) | \ -+ (0 << IEEE80211_RADIOTAP_RTS_RETRIES) | \ -+ (0 << IEEE80211_RADIOTAP_DATA_RETRIES) | \ -+ (0 << IEEE80211_RADIOTAP_MCS) | \ -+ (0 << IEEE80211_RADIOTAP_RADIOTAP_NAMESPACE)| \ -+ (0 << IEEE80211_RADIOTAP_VENDOR_NAMESPACE) | \ -+ (0 << IEEE80211_RADIOTAP_EXT) | \ -+ 0) -+ -+ /* (0 << IEEE80211_RADIOTAP_AMPDU_STATUS) | \ */ -+ /* (0 << IEEE80211_RADIOTAP_VHT) | \ */ -+#endif -+#ifndef IEEE80211_RADIOTAP_MCS -+#define IEEE80211_RADIOTAP_MCS 19 -+#endif -+#ifndef IEEE80211_RADIOTAP_VHT -+#define IEEE80211_RADIOTAP_VHT 21 -+#endif -+ -+#ifndef IEEE80211_RADIOTAP_F_BADFCS -+#define IEEE80211_RADIOTAP_F_BADFCS 0x40 /* bad FCS */ -+#endif -+ -+ sint ret = _SUCCESS; -+ _adapter *adapter = precvframe->u.hdr.adapter; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ u16 tmp_16bit = 0; -+ -+ u8 data_rate[] = { -+ 2, 4, 11, 22, /* CCK */ -+ 12, 18, 24, 36, 48, 72, 93, 108, /* OFDM */ -+ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, /* HT MCS index */ -+ 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, -+ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, /* VHT Nss 1 */ -+ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, /* VHT Nss 2 */ -+ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, /* VHT Nss 3 */ -+ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, /* VHT Nss 4 */ -+ }; -+ -+ _pkt *pskb = NULL; -+ -+ struct ieee80211_radiotap_header *rtap_hdr = NULL; -+ u8 *ptr = NULL; -+ -+ u8 hdr_buf[64] = {0}; -+ u16 rt_len = 8; -+ -+ /* create header */ -+ rtap_hdr = (struct ieee80211_radiotap_header *)&hdr_buf[0]; -+ rtap_hdr->it_version = PKTHDR_RADIOTAP_VERSION; -+ -+ /* tsft */ -+ if (pattrib->tsfl) { -+ u64 tmp_64bit; -+ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_TSFT); -+ tmp_64bit = cpu_to_le64(pattrib->tsfl); -+ memcpy(&hdr_buf[rt_len], &tmp_64bit, 8); -+ rt_len += 8; -+ } -+ -+ /* flags */ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_FLAGS); -+ if (0) -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_CFP; -+ -+ if (0) -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_SHORTPRE; -+ -+ if ((pattrib->encrypt == 1) || (pattrib->encrypt == 5)) -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_WEP; -+ -+ if (pattrib->mfrag) -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_FRAG; -+ -+#ifndef CONFIG_RX_PACKET_APPEND_FCS -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_FCS; -+#endif -+ -+ if (0) -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_DATAPAD; -+ -+ if (pattrib->crc_err) -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_BADFCS; -+ -+ if (pattrib->sgi) { -+ /* Currently unspecified but used */ -+ hdr_buf[rt_len] |= 0x80; -+ } -+ rt_len += 1; -+ -+ /* rate */ -+ if (pattrib->data_rate < 12) { -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_RATE); -+ if (pattrib->data_rate < 4) { -+ /* CCK */ -+ hdr_buf[rt_len] = data_rate[pattrib->data_rate]; -+ } else { -+ /* OFDM */ -+ hdr_buf[rt_len] = data_rate[pattrib->data_rate]; + } + } -+ rt_len += 1; /* force padding 1 byte for aligned */ -+ -+ /* channel */ -+ tmp_16bit = 0; -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_CHANNEL); -+ tmp_16bit = CHAN2FREQ(rtw_get_oper_ch(padapter)); -+ /*tmp_16bit = CHAN2FREQ(pHalData->CurrentChannel);*/ -+ memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 2; -+ -+ /* channel flags */ -+ tmp_16bit = 0; -+ if (pHalData->CurrentBandType == 0) -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_2GHZ); -+ else -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_5GHZ); -+ -+ if (pattrib->data_rate < 12) { -+ if (pattrib->data_rate < 4) { -+ /* CCK */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_CCK); -+ } else { -+ /* OFDM */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_OFDM); -+ } -+ } else { -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_DYN); -+ } -+ memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 2; -+ -+ /* dBm Antenna Signal */ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL); -+ hdr_buf[rt_len] = pattrib->phy_info.RecvSignalPower; -+ rt_len += 1; -+ -+#if 0 -+ /* dBm Antenna Noise */ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE); -+ hdr_buf[rt_len] = 0; -+ rt_len += 1; -+ -+ /* Signal Quality */ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_LOCK_QUALITY); -+ hdr_buf[rt_len] = pattrib->phy_info.SignalQuality; -+ rt_len += 1; +#endif + -+ /* Antenna */ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_ANTENNA); -+ hdr_buf[rt_len] = 0; /* pHalData->rf_type; */ -+ rt_len += 1; -+ -+ /* RX flags */ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_RX_FLAGS); -+#if 0 -+ tmp_16bit = cpu_to_le16(0); -+ memcpy(ptr, &tmp_16bit, 1); -+#endif -+ rt_len += 2; -+ -+ /* MCS information */ -+ if (pattrib->data_rate >= 12 && pattrib->data_rate < 44) { -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_MCS); -+ /* known, flag */ -+ hdr_buf[rt_len] |= BIT1; /* MCS index known */ -+ -+ /* bandwidth */ -+ hdr_buf[rt_len] |= BIT0; -+ hdr_buf[rt_len+1] |= (pattrib->bw & 0x03); -+ -+ /* guard interval */ -+ hdr_buf[rt_len] |= BIT2; -+ hdr_buf[rt_len+1] |= (pattrib->sgi & 0x01) << 2; -+ -+ /* STBC */ -+ hdr_buf[rt_len] |= BIT5; -+ hdr_buf[rt_len+1] |= (pattrib->stbc & 0x03) << 5; -+ -+ rt_len += 2; -+ -+ /* MCS rate index */ -+ hdr_buf[rt_len] = data_rate[pattrib->data_rate]; -+ rt_len += 1; -+ } -+ -+ /* VHT */ -+ if (pattrib->data_rate >= 44 && pattrib->data_rate < 84) { -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_VHT); -+ -+ /* known 16 bit, flag 8 bit */ -+ tmp_16bit = 0; -+ -+ /* Bandwidth */ -+ tmp_16bit |= BIT6; -+ -+ /* Group ID */ -+ tmp_16bit |= BIT7; -+ -+ /* Partial AID */ -+ tmp_16bit |= BIT8; -+ -+ /* STBC */ -+ tmp_16bit |= BIT0; -+ hdr_buf[rt_len+2] |= (pattrib->stbc & 0x01); -+ -+ /* Guard interval */ -+ tmp_16bit |= BIT2; -+ hdr_buf[rt_len+2] |= (pattrib->sgi & 0x01) << 2; -+ -+ /* LDPC extra OFDM symbol */ -+ tmp_16bit |= BIT4; -+ hdr_buf[rt_len+2] |= (pattrib->ldpc & 0x01) << 4; -+ -+ memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 3; -+ -+ /* bandwidth */ -+ if (pattrib->bw == 0) -+ hdr_buf[rt_len] |= 0; -+ else if (pattrib->bw == 1) -+ hdr_buf[rt_len] |= 1; -+ else if (pattrib->bw == 2) -+ hdr_buf[rt_len] |= 4; -+ else if (pattrib->bw == 3) -+ hdr_buf[rt_len] |= 11; -+ rt_len += 1; -+ -+ /* mcs_nss */ -+ if (pattrib->data_rate >= 44 && pattrib->data_rate < 54) { -+ hdr_buf[rt_len] |= 1; -+ hdr_buf[rt_len] |= data_rate[pattrib->data_rate] << 4; -+ } else if (pattrib->data_rate >= 54 && pattrib->data_rate < 64) { -+ hdr_buf[rt_len + 1] |= 2; -+ hdr_buf[rt_len + 1] |= data_rate[pattrib->data_rate] << 4; -+ } else if (pattrib->data_rate >= 64 && pattrib->data_rate < 74) { -+ hdr_buf[rt_len + 2] |= 3; -+ hdr_buf[rt_len + 2] |= data_rate[pattrib->data_rate] << 4; -+ } else if (pattrib->data_rate >= 74 && pattrib->data_rate < 84) { -+ hdr_buf[rt_len + 3] |= 4; -+ hdr_buf[rt_len + 3] |= data_rate[pattrib->data_rate] << 4; -+ } -+ rt_len += 4; -+ -+ /* coding */ -+ hdr_buf[rt_len] = 0; -+ rt_len += 1; -+ -+ /* group_id */ -+ hdr_buf[rt_len] = 0; -+ rt_len += 1; -+ -+ /* partial_aid */ -+ tmp_16bit = 0; -+ memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 2; -+ } -+ -+ /* push to skb */ -+ pskb = (_pkt *)buf; -+ if (skb_headroom(pskb) < rt_len) { -+ DBG_871X("%s:%d %s headroom is too small.\n", __FILE__, __LINE__, __func__); -+ ret = _FAIL; -+ return ret; -+ } -+ -+ ptr = skb_push(pskb, rt_len); -+ if (ptr) { -+ rtap_hdr->it_len = cpu_to_le16(rt_len); -+ memcpy(ptr, rtap_hdr, rt_len); -+ } else { -+ ret = _FAIL; -+ } -+ -+ return ret; -+ -+} -+ -+int recv_frame_monitor(_adapter *padapter, union recv_frame *rframe) -+{ -+ int ret = _SUCCESS; -+ struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ _pkt *pskb = NULL; -+ -+ /* read skb information from recv frame */ -+ pskb = rframe->u.hdr.pkt; -+ pskb->len = rframe->u.hdr.len; -+ pskb->data = rframe->u.hdr.rx_data; -+ skb_set_tail_pointer(pskb, rframe->u.hdr.len); -+ -+ /* fill radiotap header */ -+ if (fill_radiotap_hdr(padapter, rframe, (u8 *)pskb) == _FAIL) { -+ ret = _FAIL; -+ rtw_free_recvframe(rframe, pfree_recv_queue); /* free this recv_frame */ -+ goto exit; -+ } -+ -+ /* write skb information to recv frame */ -+ skb_reset_mac_header(pskb); -+ rframe->u.hdr.len = pskb->len; -+ rframe->u.hdr.rx_data = pskb->data; -+ rframe->u.hdr.rx_head = pskb->head; -+ rframe->u.hdr.rx_tail = skb_tail_pointer(pskb); -+ rframe->u.hdr.rx_end = skb_end_pointer(pskb); -+ -+ if (!RTW_CANNOT_RUN(padapter)) { -+ /* indicate this recv_frame */ -+ ret = rtw_recv_monitor(padapter, rframe); -+ if (ret != _SUCCESS) { -+ ret = _FAIL; -+ rtw_free_recvframe(rframe, pfree_recv_queue); /* free this recv_frame */ -+ goto exit; -+ } -+ } else { -+ ret = _FAIL; -+ rtw_free_recvframe(rframe, pfree_recv_queue); /* free this recv_frame */ -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+int recv_func_prehandle(_adapter *padapter, union recv_frame *rframe) -+{ -+ int ret = _SUCCESS; -+ struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+#ifdef DBG_RX_COUNTER_DUMP -+ if( padapter->dump_rx_cnt_mode & DUMP_DRV_RX_COUNTER ) -+ { -+ if (pattrib->crc_err == 1) -+ padapter->drv_rx_cnt_crcerror++; -+ else -+ padapter->drv_rx_cnt_ok++; -+ } -+#endif -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1 || padapter->mppriv.bRTWSmbCfg ==_TRUE) -+ { -+ mp_recv_frame(padapter,rframe); -+ ret = _FAIL; -+ goto exit; -+ } -+ else -+#endif -+ { + //check the frame crtl field and decache + ret = validate_recv_frame(padapter, rframe); + if (ret != _SUCCESS) @@ -66042,23 +45960,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + rtw_free_recvframe(rframe, pfree_recv_queue);//free this recv_frame + goto exit; + } -+ } ++ +exit: + return ret; +} + -+int recv_func_posthandle(_adapter *padapter, union recv_frame *prframe) ++static int recv_func_posthandle(_adapter *padapter, union recv_frame *prframe) +{ + int ret = _SUCCESS; + union recv_frame *orig_prframe = prframe; + struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; + struct recv_priv *precvpriv = &padapter->recvpriv; + _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; ++ ++ +#ifdef CONFIG_TDLS + u8 *psnap_type, *pcategory; ++ struct sta_info *ptdls_sta = NULL; +#endif //CONFIG_TDLS + -+ DBG_COUNTER(padapter->rx_logs.core_rx_post); + + // DATA FRAME + rtw_led_control(padapter, LED_CTL_RX); @@ -66070,7 +45990,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + DBG_871X("DBG_RX_DROP_FRAME %s decryptor: drop pkt\n", __FUNCTION__); + #endif + ret = _FAIL; -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_err); + goto _recv_data_drop; + } + @@ -66092,14 +46011,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + +#ifdef CONFIG_TDLS + //check TDLS frame -+ psnap_type = get_recvframe_data(orig_prframe) + pattrib->hdrlen + pattrib->iv_len+SNAP_SIZE; ++ psnap_type = get_recvframe_data(orig_prframe); ++ psnap_type+=pattrib->hdrlen + pattrib->iv_len+SNAP_SIZE; + pcategory = psnap_type + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; + + if((_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_TDLS, ETH_TYPE_LEN)) && + ((*pcategory==RTW_WLAN_CATEGORY_TDLS) || (*pcategory==RTW_WLAN_CATEGORY_P2P))){ -+ ret = OnTDLS(padapter, prframe); -+ if(ret == _FAIL) -+ goto _exit_recv_func; ++ ret = OnTDLS(padapter, prframe); //all of functions will return _FAIL ++ goto _exit_recv_func; + } +#endif //CONFIG_TDLS + @@ -66109,8 +46028,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + #ifdef DBG_RX_DROP_FRAME + DBG_871X("DBG_RX_DROP_FRAME %s recvframe_chk_defrag: drop pkt\n", __FUNCTION__); + #endif -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_defrag_err); -+ goto _recv_data_drop; ++ goto _recv_data_drop; + } + + prframe=portctrl(padapter, prframe); @@ -66120,11 +46038,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + DBG_871X("DBG_RX_DROP_FRAME %s portctrl: drop pkt\n", __FUNCTION__); + #endif + ret = _FAIL; -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_portctrl_err); + goto _recv_data_drop; + } + ++#ifdef CONFIG_TDLS ++ if(padapter->tdlsinfo.setup_state == TDLS_LINKED_STATE) ++ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->src); ++ count_rx_stats(padapter, prframe, ptdls_sta); ++#else + count_rx_stats(padapter, prframe, NULL); ++#endif //CONFIG_TDLS + +#ifdef CONFIG_WAPI_SUPPORT + rtw_wapi_update_info(padapter, prframe); @@ -66139,7 +46062,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + DBG_871X("DBG_RX_DROP_FRAME %s process_recv_indicatepkts fail!\n", __FUNCTION__); + #endif + rtw_free_recvframe(orig_prframe, pfree_recv_queue);//free this recv_frame -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_err); + goto _recv_data_drop; + } +#else // CONFIG_80211N_HT @@ -66156,12 +46078,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + goto _recv_data_drop; + } + -+ if (!RTW_CANNOT_RUN(padapter)) { ++ if ((padapter->bDriverStopped == false) && (padapter->bSurpriseRemoved == false)) ++ { + RT_TRACE(_module_rtl871x_recv_c_, _drv_alert_, ("@@@@ recv_func: recv_func rtw_recv_indicatepkt\n" )); + //indicate this recv_frame + ret = rtw_recv_indicatepkt(padapter, prframe); + if (ret != _SUCCESS) -+ { ++ { + #ifdef DBG_RX_DROP_FRAME + DBG_871X("DBG_RX_DROP_FRAME %s rtw_recv_indicatepkt fail!\n", __FUNCTION__); + #endif @@ -66173,9 +46096,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + RT_TRACE(_module_rtl871x_recv_c_, _drv_alert_, ("@@@@ recv_func: rtw_free_recvframe\n" )); + RT_TRACE(_module_rtl871x_recv_c_, _drv_debug_, ("recv_func:bDriverStopped(%d) OR bSurpriseRemoved(%d)", padapter->bDriverStopped, padapter->bSurpriseRemoved)); + #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s ecv_func:bDriverStopped(%s) OR bSurpriseRemoved(%s)\n", __func__ -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False"); ++ DBG_871X("DBG_RX_DROP_FRAME %s ecv_func:bDriverStopped(%d) OR bSurpriseRemoved(%d)\n", __FUNCTION__, ++ padapter->bDriverStopped, padapter->bSurpriseRemoved); + #endif + ret = _FAIL; + rtw_free_recvframe(orig_prframe, pfree_recv_queue); //free this recv_frame @@ -66222,56 +46144,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + struct security_priv *psecuritypriv=&padapter->securitypriv; + struct mlme_priv *mlmepriv = &padapter->mlmepriv; + -+ if (check_fwstate(mlmepriv, WIFI_MONITOR_STATE)) { -+ /* monitor mode */ -+ recv_frame_monitor(padapter, rframe); -+ ret = _SUCCESS; -+ goto exit; -+ } else -+ + /* check if need to handle uc_swdec_pending_queue*/ + if (check_fwstate(mlmepriv, WIFI_STATION_STATE) && psecuritypriv->busetkipkey) + { + union recv_frame *pending_frame; -+ int cnt = 0; ++ _irqL irqL; + + while((pending_frame=rtw_alloc_recvframe(&padapter->recvpriv.uc_swdec_pending_queue))) { -+ cnt++; -+ DBG_COUNTER(padapter->rx_logs.core_rx_dequeue); -+ recv_func_posthandle(padapter, pending_frame); ++ if (recv_func_posthandle(padapter, pending_frame) == _SUCCESS) ++ DBG_871X("%s: dequeue uc_swdec_pending_queue\n", __func__); + } -+ -+ if (cnt) -+ DBG_871X(FUNC_ADPT_FMT" dequeue %d from uc_swdec_pending_queue\n", -+ FUNC_ADPT_ARG(padapter), cnt); + } + -+ DBG_COUNTER(padapter->rx_logs.core_rx); + ret = recv_func_prehandle(padapter, rframe); + + if(ret == _SUCCESS) { -+ ++ + /* check if need to enqueue into uc_swdec_pending_queue*/ + if (check_fwstate(mlmepriv, WIFI_STATION_STATE) && + !IS_MCAST(prxattrib->ra) && prxattrib->encrypt>0 && -+ (prxattrib->bdecrypted == 0 ||psecuritypriv->sw_decrypt == _TRUE) && -+ psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPAPSK && -+ !psecuritypriv->busetkipkey) -+ { -+ DBG_COUNTER(padapter->rx_logs.core_rx_enqueue); ++ (prxattrib->bdecrypted == 0 ||psecuritypriv->sw_decrypt == true) && ++ !is_wep_enc(psecuritypriv->dot11PrivacyAlgrthm) && ++ !psecuritypriv->busetkipkey) { + rtw_enqueue_recvframe(rframe, &padapter->recvpriv.uc_swdec_pending_queue); -+ //DBG_871X("%s: no key, enqueue uc_swdec_pending_queue\n", __func__); -+ -+ if (recvpriv->free_recvframe_cnt < NR_RECVFRAME/4) { -+ /* to prevent from recvframe starvation, get recvframe from uc_swdec_pending_queue to free_recvframe_cnt */ -+ rframe = rtw_alloc_recvframe(&padapter->recvpriv.uc_swdec_pending_queue); -+ if (rframe) -+ goto do_posthandle; -+ } ++ DBG_871X("%s: no key, enqueue uc_swdec_pending_queue\n", __func__); + goto exit; + } + -+do_posthandle: + ret = recv_func_posthandle(padapter, rframe); + } + @@ -66286,7 +46185,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + struct recv_priv *precvpriv; + s32 ret=_SUCCESS; + -+_func_enter_; ++ + +// RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("+rtw_recv_entry\n")); + @@ -66304,7 +46203,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + precvpriv->rx_pkts++; + -+_func_exit_; ++ + + return ret; + @@ -66317,22 +46216,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + + //RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("_recv_entry_drop\n")); + -+_func_exit_; ++ + + return ret; +} + +#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS){ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS) ++#else ++void rtw_signal_stat_timer_hdl(struct timer_list *t) ++#endif ++{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _adapter *adapter = (_adapter *)FunctionContext; ++#else ++ _adapter *adapter = from_timer(adapter, t, recvpriv.signal_stat_timer); ++#endif + struct recv_priv *recvpriv = &adapter->recvpriv; -+ ++ + u32 tmp_s, tmp_q; + u8 avg_signal_strength = 0; + u8 avg_signal_qual = 0; + u32 num_signal_strength = 0; + u32 num_signal_qual = 0; -+ u8 ratio_pre_stat = 0, ratio_curr_stat = 0, ratio_total = 0, ratio_profile = SIGNAL_STAT_CALC_PROFILE_0; ++ u8 _alpha = 3; // this value is based on converging_constant = 5000 and sampling_interval = 1000 + + if(adapter->recvpriv.is_signal_dbg) { + //update the user specific value, signal_strength_dbg, to signal_strength, rssi @@ -66346,7 +46254,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + // after avg_vals are accquired, we can re-stat the signal values + recvpriv->signal_strength_data.update_req = 1; + } -+ ++ + if(recvpriv->signal_qual_data.update_req == 0) {// update_req is clear, means we got rx + avg_signal_qual = recvpriv->signal_qual_data.avg_val; + num_signal_qual = recvpriv->signal_qual_data.total_num; @@ -66354,337 +46262,53 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_recv.c linux/3rdparty/rtl8812au + recvpriv->signal_qual_data.update_req = 1; + } + -+ if (num_signal_strength == 0) { -+ if (rtw_get_on_cur_ch_time(adapter) == 0 -+ || rtw_get_passing_time_ms(rtw_get_on_cur_ch_time(adapter)) < 2 * adapter->mlmeextpriv.mlmext_info.bcn_interval -+ ) { -+ goto set_timer; -+ } -+ } -+ -+ if(check_fwstate(&adapter->mlmepriv, _FW_UNDER_SURVEY) == _TRUE -+ || check_fwstate(&adapter->mlmepriv, _FW_LINKED) == _FALSE -+ ) { -+ goto set_timer; -+ } -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(adapter, _FW_UNDER_SURVEY) == _TRUE) -+ goto set_timer; -+ #endif -+ -+ if (RTW_SIGNAL_STATE_CALC_PROFILE < SIGNAL_STAT_CALC_PROFILE_MAX) -+ ratio_profile = RTW_SIGNAL_STATE_CALC_PROFILE; -+ -+ ratio_pre_stat = signal_stat_calc_profile[ratio_profile][0]; -+ ratio_curr_stat = signal_stat_calc_profile[ratio_profile][1]; -+ ratio_total = ratio_pre_stat + ratio_curr_stat; -+ + //update value of signal_strength, rssi, signal_qual -+ tmp_s = (ratio_curr_stat * avg_signal_strength + ratio_pre_stat * recvpriv->signal_strength); -+ if (tmp_s % ratio_total) -+ tmp_s = tmp_s / ratio_total + 1; -+ else -+ tmp_s = tmp_s / ratio_total; -+ if (tmp_s > 100) -+ tmp_s = 100; ++ if(check_fwstate(&adapter->mlmepriv, _FW_UNDER_SURVEY) == false) { ++ tmp_s = (avg_signal_strength+(_alpha-1)*recvpriv->signal_strength); ++ if(tmp_s %_alpha) ++ tmp_s = tmp_s/_alpha + 1; ++ else ++ tmp_s = tmp_s/_alpha; ++ if(tmp_s>100) ++ tmp_s = 100; + -+ tmp_q = (ratio_curr_stat * avg_signal_qual + ratio_pre_stat * recvpriv->signal_qual); -+ if (tmp_q % ratio_total) -+ tmp_q = tmp_q / ratio_total + 1; -+ else -+ tmp_q = tmp_q / ratio_total; -+ if (tmp_q > 100) -+ tmp_q = 100; ++ tmp_q = (avg_signal_qual+(_alpha-1)*recvpriv->signal_qual); ++ if(tmp_q %_alpha) ++ tmp_q = tmp_q/_alpha + 1; ++ else ++ tmp_q = tmp_q/_alpha; ++ if(tmp_q>100) ++ tmp_q = 100; + -+ recvpriv->signal_strength = tmp_s; -+ recvpriv->rssi = (s8)translate_percentage_to_dbm(tmp_s); -+ recvpriv->signal_qual = tmp_q; ++ recvpriv->signal_strength = tmp_s; ++ recvpriv->rssi = (s8)translate_percentage_to_dbm(tmp_s); ++ recvpriv->signal_qual = tmp_q; + -+ #if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 -+ DBG_871X(FUNC_ADPT_FMT" signal_strength:%3u, rssi:%3d, signal_qual:%3u" -+ ", num_signal_strength:%u, num_signal_qual:%u" -+ ", on_cur_ch_ms:%d" -+ "\n" -+ , FUNC_ADPT_ARG(adapter) -+ , recvpriv->signal_strength -+ , recvpriv->rssi -+ , recvpriv->signal_qual -+ , num_signal_strength, num_signal_qual -+ , rtw_get_on_cur_ch_time(adapter) ? rtw_get_passing_time_ms(rtw_get_on_cur_ch_time(adapter)) : 0 -+ ); -+ #endif ++ #if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 ++ DBG_871X("%s signal_strength:%3u, rssi:%3d, signal_qual:%3u" ++ ", num_signal_strength:%u, num_signal_qual:%u" ++ "\n" ++ , __FUNCTION__ ++ , recvpriv->signal_strength ++ , recvpriv->rssi ++ , recvpriv->signal_qual ++ , num_signal_strength, num_signal_qual ++ ); ++ #endif ++ } + } -+ -+set_timer: + rtw_set_signal_stat_timer(recvpriv); -+ ++ +} +#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ -+static void rx_process_rssi(_adapter *padapter,union recv_frame *prframe) -+{ -+ u32 last_rssi, tmp_val; -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ struct signal_stat * signal_stat = &padapter->recvpriv.signal_strength_data; -+#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ -+ //DBG_8192C("process_rssi=> pattrib->rssil(%d) signal_strength(%d)\n ",pattrib->RecvSignalPower,pattrib->signal_strength); -+ //if(pRfd->Status.bPacketToSelf || pRfd->Status.bPacketBeacon) -+ { -+ #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ if(signal_stat->update_req) { -+ signal_stat->total_num = 0; -+ signal_stat->total_val = 0; -+ signal_stat->update_req = 0; -+ } -+ -+ signal_stat->total_num++; -+ signal_stat->total_val += pattrib->phy_info.SignalStrength; -+ signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; -+ #else //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ -+ //Adapter->RxStats.RssiCalculateCnt++; //For antenna Test -+ if(padapter->recvpriv.signal_strength_data.total_num++ >= PHY_RSSI_SLID_WIN_MAX) -+ { -+ padapter->recvpriv.signal_strength_data.total_num = PHY_RSSI_SLID_WIN_MAX; -+ last_rssi = padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index]; -+ padapter->recvpriv.signal_strength_data.total_val -= last_rssi; -+ } -+ padapter->recvpriv.signal_strength_data.total_val +=pattrib->phy_info.SignalStrength; -+ -+ padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index++] = pattrib->phy_info.SignalStrength; -+ if(padapter->recvpriv.signal_strength_data.index >= PHY_RSSI_SLID_WIN_MAX) -+ padapter->recvpriv.signal_strength_data.index = 0; -+ -+ -+ tmp_val = padapter->recvpriv.signal_strength_data.total_val/padapter->recvpriv.signal_strength_data.total_num; -+ -+ if(padapter->recvpriv.is_signal_dbg) { -+ padapter->recvpriv.signal_strength= padapter->recvpriv.signal_strength_dbg; -+ padapter->recvpriv.rssi=(s8)translate_percentage_to_dbm(padapter->recvpriv.signal_strength_dbg); -+ } else { -+ padapter->recvpriv.signal_strength= tmp_val; -+ padapter->recvpriv.rssi=(s8)translate_percentage_to_dbm(tmp_val); -+ } -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("UI RSSI = %d, ui_rssi.TotalVal = %d, ui_rssi.TotalNum = %d\n", tmp_val, padapter->recvpriv.signal_strength_data.total_val,padapter->recvpriv.signal_strength_data.total_num)); -+ #endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ } -+} -+ -+static void rx_process_link_qual(_adapter *padapter,union recv_frame *prframe) -+{ -+ u32 last_evm=0, tmpVal; -+ struct rx_pkt_attrib *pattrib; -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ struct signal_stat * signal_stat; -+#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ -+ if(prframe == NULL || padapter==NULL){ -+ return; -+ } -+ -+ pattrib = &prframe->u.hdr.attrib; -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ signal_stat = &padapter->recvpriv.signal_qual_data; -+#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ -+ //DBG_8192C("process_link_qual=> pattrib->signal_qual(%d)\n ",pattrib->signal_qual); -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ if(signal_stat->update_req) { -+ signal_stat->total_num = 0; -+ signal_stat->total_val = 0; -+ signal_stat->update_req = 0; -+ } -+ -+ signal_stat->total_num++; -+ signal_stat->total_val += pattrib->phy_info.SignalQuality; -+ signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; -+ -+#else //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ if(pattrib->phy_info.SignalQuality != 0) -+ { -+ // -+ // 1. Record the general EVM to the sliding window. -+ // -+ if(padapter->recvpriv.signal_qual_data.total_num++ >= PHY_LINKQUALITY_SLID_WIN_MAX) -+ { -+ padapter->recvpriv.signal_qual_data.total_num = PHY_LINKQUALITY_SLID_WIN_MAX; -+ last_evm = padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index]; -+ padapter->recvpriv.signal_qual_data.total_val -= last_evm; -+ } -+ padapter->recvpriv.signal_qual_data.total_val += pattrib->phy_info.SignalQuality; -+ -+ padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = pattrib->phy_info.SignalQuality; -+ if(padapter->recvpriv.signal_qual_data.index >= PHY_LINKQUALITY_SLID_WIN_MAX) -+ padapter->recvpriv.signal_qual_data.index = 0; -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("Total SQ=%d pattrib->signal_qual= %d\n", padapter->recvpriv.signal_qual_data.total_val, pattrib->phy_info.SignalQuality)); -+ -+ // <1> Showed on UI for user, in percentage. -+ tmpVal = padapter->recvpriv.signal_qual_data.total_val/padapter->recvpriv.signal_qual_data.total_num; -+ padapter->recvpriv.signal_qual=(u8)tmpVal; -+ -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,(" pattrib->signal_qual =%d\n", pattrib->phy_info.SignalQuality)); -+ } -+#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+} -+ -+void rx_process_phy_info(_adapter *padapter, union recv_frame *rframe) -+{ -+ /* Check RSSI */ -+ rx_process_rssi(padapter, rframe); -+ -+ /* Check PWDB */ -+ //process_PWDB(padapter, rframe); -+ -+ //UpdateRxSignalStatistics8192C(Adapter, pRfd); -+ -+ /* Check EVM */ -+ rx_process_link_qual(padapter, rframe); -+ #ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ rtw_store_phy_info( padapter, rframe); -+ #endif -+} -+ -+void rx_query_phy_status( -+ union recv_frame *precvframe, -+ u8 *pphy_status) -+{ -+ PADAPTER padapter = precvframe->u.hdr.adapter; -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PODM_PHY_INFO_T pPHYInfo = (PODM_PHY_INFO_T)(&pattrib->phy_info); -+ u8 *wlanhdr; -+ ODM_PACKET_INFO_T pkt_info; -+ u8 *sa; -+ struct sta_priv *pstapriv; -+ struct sta_info *psta = NULL; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ //_irqL irqL; -+ -+ pkt_info.bPacketMatchBSSID =_FALSE; -+ pkt_info.bPacketToSelf = _FALSE; -+ pkt_info.bPacketBeacon = _FALSE; -+ -+ wlanhdr = get_recvframe_data(precvframe); -+ -+ pkt_info.bPacketMatchBSSID = (!IsFrameTypeCtrl(wlanhdr)) -+ && (!pattrib->icv_err) && (!pattrib->crc_err) -+ && _rtw_memcmp(get_hdr_bssid(wlanhdr), get_bssid(&padapter->mlmepriv), ETH_ALEN); -+ -+ pkt_info.bToSelf = (!pattrib->icv_err) && (!pattrib->crc_err) -+ && _rtw_memcmp(get_ra(wlanhdr), adapter_mac_addr(padapter), ETH_ALEN); -+ -+ pkt_info.bPacketToSelf = pkt_info.bPacketMatchBSSID -+ && _rtw_memcmp(get_ra(wlanhdr), adapter_mac_addr(padapter), ETH_ALEN); -+ -+ pkt_info.bPacketBeacon = pkt_info.bPacketMatchBSSID -+ && (GetFrameSubType(wlanhdr) == WIFI_BEACON); -+ -+ sa = get_ta(wlanhdr); -+ -+ pkt_info.StationID = 0xFF; -+ -+ if (_rtw_memcmp(adapter_mac_addr(padapter), sa, ETH_ALEN) == _TRUE) { -+ static u32 start_time = 0; -+ -+#if 0 /*For debug */ -+ if (IsFrameTypeCtrl(wlanhdr)) { -+ DBG_871X("-->Control frame: Y\n"); -+ DBG_871X("-->pkt_len: %d\n", pattrib->pkt_len); -+ DBG_871X("-->Sub Type = 0x%X\n", GetFrameSubType(wlanhdr)); -+ } -+ -+ /* Dump first 40 bytes of header */ -+ int i = 0; -+ -+ for (i = 0; i < 40; i++) -+ DBG_871X("%d: %X\n", i, *((u8 *)wlanhdr + i)); -+ -+ DBG_871X("\n"); -+#endif -+ -+ if ((start_time == 0) || (rtw_get_passing_time_ms(start_time) > 5000)) { -+ DBG_871X_LEVEL(_drv_always_, "Warning!!! %s: Confilc mac addr!!\n", __func__); -+ start_time = rtw_get_current_time(); -+ } -+ pdbgpriv->dbg_rx_conflic_mac_addr_cnt++; -+ } else{ -+ pstapriv = &padapter->stapriv; -+ psta = rtw_get_stainfo(pstapriv, sa); -+ if (psta) -+ pkt_info.StationID = psta->mac_id; -+ } -+ -+ pkt_info.DataRate = pattrib->data_rate; -+ -+ //_enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); -+ ODM_PhyStatusQuery(&pHalData->odmpriv, pPHYInfo, pphy_status, &pkt_info); -+ if (psta) -+ psta->rssi = pattrib->phy_info.RecvSignalPower; -+ //_exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); -+ -+#ifdef CONFIG_SW_ANTENNA_DIVERSITY -+ if (GET_HAL_DATA(padapter)->odmpriv.RSSI_test == _FALSE) -+#endif -+ { -+ precvframe->u.hdr.psta = NULL; -+ if (pkt_info.bPacketMatchBSSID -+ && (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) -+ ) { -+ if (psta) { -+ precvframe->u.hdr.psta = psta; -+ rx_process_phy_info(padapter, precvframe); -+ } -+ } else if (pkt_info.bPacketToSelf || pkt_info.bPacketBeacon) { -+ if (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE) == _TRUE) { -+ if (psta) -+ precvframe->u.hdr.psta = psta; -+ } -+ rx_process_phy_info(padapter, precvframe); -+ } -+ } -+} -+/* -+* Increase and check if the continual_no_rx_packet of this @param pmlmepriv is larger than MAX_CONTINUAL_NORXPACKET_COUNT -+* @return _TRUE: -+* @return _FALSE: -+*/ -+int rtw_inc_and_chk_continual_no_rx_packet(struct sta_info *sta, int tid_index) -+{ -+ -+ int ret = _FALSE; -+ int value = ATOMIC_INC_RETURN(&sta->continual_no_rx_packet[tid_index]); -+ -+ if (value >= MAX_CONTINUAL_NORXPACKET_COUNT) -+ ret = _TRUE; -+ -+ return ret; -+} -+ -+/* -+* Set the continual_no_rx_packet of this @param pmlmepriv to 0 -+*/ -+void rtw_reset_continual_no_rx_packet(struct sta_info *sta, int tid_index) -+{ -+ ATOMIC_SET(&sta->continual_no_rx_packet[tid_index], 0); -+} -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_rf.c linux/3rdparty/rtl8812au/core/rtw_rf.c ---- linux.old/3rdparty/rtl8812au/core/rtw_rf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_rf.c 2017-06-07 23:07:21.004686938 +0300 -@@ -0,0 +1,437 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_rf.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_rf.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_rf.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_rf.c 2018-02-06 17:42:30.699967001 +0200 +@@ -0,0 +1,85 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -66694,438 +46318,86 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_rf.c linux/3rdparty/rtl8812au/c + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_RF_C_ + +#include -+#include + -+u8 center_ch_5g_all[CENTER_CH_5G_ALL_NUM] = { -+ 36, 38, 40, 42, 44, 46, 48, /* Band 1 */ -+ 52, 54, 56, 58, 60, 62, 64, /* Band 2 */ -+ 100, 102, 104, 106, 108, 110, 112, /* Band 3 */ -+ 116, 118, 120, 122, 124, 126, 128, /* Band 3 */ -+ 132, 134, 136, 138, 140, 142, 144, /* Band 3 */ -+ 149, 151, 153, 155, 157, 159, 161, /* Band 4 */ -+ 165, 167, 169, 171, 173, 175, 177}; /* Band 4 */ + -+u8 center_ch_5g_20m[CENTER_CH_5G_20M_NUM] = { -+ 36, 40, 44, 48, -+ 52, 56, 60, 64, -+ 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144, -+ 149, 153, 157, 161, 165, 169, 173, 177 ++struct ch_freq { ++ u32 channel; ++ u32 frequency; +}; + -+u8 center_ch_5g_40m[CENTER_CH_5G_40M_NUM] = {38, 46, 54, 62, 102, 110, 118, 126, 134, 142, 151, 159, 167, 175}; -+ -+u8 center_ch_5g_80m[CENTER_CH_5G_80M_NUM] = {42, 58, 106, 122, 138, 155, 171}; -+ -+int rtw_ch2freq(int chan) -+{ -+ /* see 802.11 17.3.8.3.2 and Annex J -+ * there are overlapping channel numbers in 5GHz and 2GHz bands */ -+ -+ /* -+ * RTK: don't consider the overlapping channel numbers: 5G channel <= 14, -+ * because we don't support it. simply judge from channel number -+ */ -+ -+ if (chan >= 1 && chan <= 14) { -+ if (chan == 14) -+ return 2484; -+ else if (chan < 14) -+ return 2407 + chan * 5; -+ } else if (chan >= 36 && chan <= 177) { -+ return 5000 + chan * 5; -+ } -+ -+ return 0; /* not supported */ -+} -+ -+int rtw_freq2ch(int freq) -+{ -+ /* see 802.11 17.3.8.3.2 and Annex J */ -+ if (freq == 2484) -+ return 14; -+ else if (freq < 2484) -+ return (freq - 2407) / 5; -+ else if (freq >= 4910 && freq <= 4980) -+ return (freq - 4000) / 5; -+ else if (freq <= 45000) /* DMG band lower limit */ -+ return (freq - 5000) / 5; -+ else if (freq >= 58320 && freq <= 64800) -+ return (freq - 56160) / 2160; -+ else -+ return 0; -+} -+ -+bool rtw_chbw_to_freq_range(u8 ch, u8 bw, u8 offset, u32 *hi, u32 *lo) -+{ -+ u8 c_ch; -+ u32 freq; -+ u32 hi_ret = 0, lo_ret = 0; -+ int i; -+ bool valid = _FALSE; -+ -+ if (hi) -+ *hi = 0; -+ if (lo) -+ *lo = 0; -+ -+ c_ch = rtw_get_center_ch(ch, bw, offset); -+ freq = rtw_ch2freq(c_ch); -+ -+ if (!freq) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (bw == CHANNEL_WIDTH_80) { -+ hi_ret = freq + 40; -+ lo_ret = freq - 40; -+ } else if (bw == CHANNEL_WIDTH_40) { -+ hi_ret = freq + 20; -+ lo_ret = freq - 20; -+ } else if (bw == CHANNEL_WIDTH_20) { -+ hi_ret = freq + 10; -+ lo_ret = freq - 10; -+ } else { -+ rtw_warn_on(1); -+ } -+ -+ if (hi) -+ *hi = hi_ret; -+ if (lo) -+ *lo = lo_ret; -+ -+ valid = _TRUE; -+ -+exit: -+ return valid; -+} -+ -+static const char * const _ch_width_str[] = { -+ "20MHz", -+ "40MHz", -+ "80MHz", -+ "160MHz", -+ "80_80MHz", -+ "CHANNEL_WIDTH_MAX", ++struct ch_freq ch_freq_map[] = { ++ {1, 2412},{2, 2417},{3, 2422},{4, 2427},{5, 2432}, ++ {6, 2437},{7, 2442},{8, 2447},{9, 2452},{10, 2457}, ++ {11, 2462},{12, 2467},{13, 2472},{14, 2484}, ++ /* UNII */ ++ {36, 5180},{40, 5200},{44, 5220},{48, 5240},{52, 5260}, ++ {56, 5280},{60, 5300},{64, 5320},{149, 5745},{153, 5765}, ++ {157, 5785},{161, 5805},{165, 5825},{167, 5835},{169, 5845}, ++ {171, 5855},{173, 5865}, ++ /* HiperLAN2 */ ++ {100, 5500},{104, 5520},{108, 5540},{112, 5560},{116, 5580}, ++ {120, 5600},{124, 5620},{128, 5640},{132, 5660},{136, 5680}, ++ {140, 5700}, ++ /* Japan MMAC */ ++ {34, 5170},{38, 5190},{42, 5210},{46, 5230}, ++ /* Japan */ ++ {184, 4920},{188, 4940},{192, 4960},{196, 4980}, ++ {208, 5040},/* Japan, means J08 */ ++ {212, 5060},/* Japan, means J12 */ ++ {216, 5080},/* Japan, means J16 */ +}; + -+const char *ch_width_str(u8 bw) ++int ch_freq_map_num = (sizeof(ch_freq_map) / sizeof(struct ch_freq)); ++ ++u32 rtw_ch2freq(u32 channel) +{ -+ bw = (bw >= CHANNEL_WIDTH_MAX) ? CHANNEL_WIDTH_MAX : bw; -+ return _ch_width_str[bw]; -+} ++ u8 i; ++ u32 freq = 0; + -+const char rf_path_char(u8 path) -+{ -+ if (path >= RF_PATH_MAX) -+ return 'X'; -+ return 'A' + path; -+} -+ -+struct country_chplan { -+ char alpha2[2]; -+ u8 chplan; -+}; -+ -+static const struct country_chplan country_chplan_map[] = { -+ {"AD", 0x26}, /* Andorra */ -+ {"AE", 0x26}, /* United Arab Emirates */ -+ {"AG", 0x30}, /* Antigua & Barbuda */ -+ {"AI", 0x26}, /* Anguilla(UK) */ -+ {"AL", 0x26}, /* Albania */ -+ {"AM", 0x34}, /* Armenia */ -+ {"AO", 0x26}, /* Angola */ -+ {"AQ", 0x26}, /* Antarctica */ -+ {"AR", 0x57}, /* Argentina */ -+ {"AS", 0x34}, /* American Samoa */ -+ {"AT", 0x26}, /* Austria */ -+ {"AU", 0x45}, /* Australia */ -+ {"AW", 0x34}, /* Aruba */ -+ {"AZ", 0x26}, /* Azerbaijan */ -+ {"BA", 0x26}, /* Bosnia & Herzegovina */ -+ {"BD", 0x26}, /* Bangladesh */ -+ {"BE", 0x26}, /* Belgium */ -+ {"BG", 0x26}, /* Bulgaria */ -+ {"BH", 0x47}, /* Bahrain */ -+ {"BO", 0x30}, /* Bolivia */ -+ {"BR", 0x34}, /* Brazil */ -+ {"CA", 0x34}, /* Canada */ -+ {"CH", 0x26}, /* Switzerland */ -+ {"CL", 0x30}, /* Chile */ -+ {"CN", 0x48}, /* China */ -+ {"CO", 0x34}, /* Colombia */ -+ {"CR", 0x34}, /* Costa Rica */ -+ {"CY", 0x26}, /* Cyprus */ -+ {"CZ", 0x26}, /* Czech Republic */ -+ {"DE", 0x26}, /* Germany */ -+ {"DK", 0x26}, /* Denmark */ -+ {"DO", 0x34}, /* Dominican Republic */ -+ {"EC", 0x34}, /* Ecuador */ -+ {"EE", 0x26}, /* Estonia */ -+ {"EG", 0x47}, /* Egypt */ -+ {"ES", 0x26}, /* Spain */ -+ {"FI", 0x26}, /* Finland */ -+ {"FR", 0x26}, /* France */ -+ {"GB", 0x26}, /* Great Britain (United Kingdom; England) */ -+ {"GH", 0x26}, /* Ghana */ -+ {"GR", 0x26}, /* Greece */ -+ {"GT", 0x34}, /* Guatemala */ -+ {"HK", 0x26}, /* Hong Kong */ -+ {"HN", 0x32}, /* Honduras */ -+ {"HR", 0x26}, /* Croatia */ -+ {"HU", 0x26}, /* Hungary */ -+ {"ID", 0x54}, /* Indonesia */ -+ {"IE", 0x26}, /* Ireland */ -+ {"IL", 0x47}, /* Israel */ -+ {"IN", 0x47}, /* India */ -+ {"IQ", 0x26}, /* Iraq */ -+ {"IS", 0x26}, /* Iceland */ -+ {"IT", 0x26}, /* Italy */ -+ {"JM", 0x51}, /* Jamaica */ -+ {"JO", 0x49}, /* Jordan */ -+ {"JP", 0x27}, /* Japan- Telec */ -+ {"KE", 0x47}, /* Kenya */ -+ {"KG", 0x26}, /* Kyrgyzstan */ -+ {"KH", 0x26}, /* Cambodia */ -+ {"KR", 0x28}, /* South Korea */ -+ {"KW", 0x47}, /* Kuwait */ -+ {"KZ", 0x26}, /* Kazakhstan */ -+ {"LB", 0x26}, /* Lebanon */ -+ {"LI", 0x26}, /* Liechtenstein */ -+ {"LK", 0x26}, /* Sri Lanka */ -+ {"LS", 0x26}, /* Lesotho */ -+ {"LT", 0x26}, /* Lithuania */ -+ {"LU", 0x26}, /* Luxembourg */ -+ {"LV", 0x26}, /* Latvia */ -+ {"MA", 0x47}, /* Morocco */ -+ {"MC", 0x26}, /* Monaco */ -+ {"ME", 0x26}, /* Montenegro */ -+ {"MK", 0x26}, /* Republic of Macedonia (FYROM) */ -+ {"MT", 0x26}, /* Malta */ -+ {"MX", 0x34}, /* Mexico */ -+ {"MY", 0x47}, /* Malaysia */ -+ {"MZ", 0x26}, /* Mozambique */ -+ {"NA", 0x26}, /* Namibia */ -+ {"NG", 0x50}, /* Nigeria */ -+ {"NI", 0x34}, /* Nicaragua */ -+ {"NL", 0x26}, /* Netherlands */ -+ {"NO", 0x26}, /* Norway */ -+ {"NZ", 0x45}, /* New Zealand */ -+ {"OM", 0x26}, /* Oman */ -+ {"PA", 0x34}, /* Panama */ -+ {"PE", 0x34}, /* Peru */ -+ {"PG", 0x26}, /* Papua New Guinea */ -+ {"PH", 0x26}, /* Philippines */ -+ {"PK", 0x51}, /* Pakistan */ -+ {"PL", 0x26}, /* Poland */ -+ {"PR", 0x34}, /* Puerto Rico */ -+ {"PT", 0x26}, /* Portugal */ -+ {"PY", 0x34}, /* Paraguay */ -+ {"QA", 0x51}, /* Qatar */ -+ {"RO", 0x26}, /* Romania */ -+ {"RS", 0x26}, /* Serbia */ -+ {"RU", 0x59}, /* Russia, fac/gost */ -+ {"SA", 0x26}, /* Saudi Arabia */ -+ {"SE", 0x26}, /* Sweden */ -+ {"SG", 0x47}, /* Singapore */ -+ {"SI", 0x26}, /* Slovenia */ -+ {"SK", 0x26}, /* Slovakia */ -+ {"SN", 0x26}, /* Senegal */ -+ {"SV", 0x30}, /* El Salvador */ -+ {"TH", 0x26}, /* Thailand */ -+ {"TN", 0x47}, /* Tunisia */ -+ {"TR", 0x26}, /* Turkey */ -+ {"TT", 0x42}, /* Trinidad & Tobago */ -+ {"TW", 0x39}, /* Taiwan */ -+ {"UA", 0x26}, /* Ukraine */ -+ {"US", 0x34}, /* United States of America (USA) */ -+ {"UY", 0x34}, /* Uruguay */ -+ {"VE", 0x30}, /* Venezuela */ -+ {"VN", 0x26}, /* Vietnam */ -+ {"YE", 0x26}, /* Yemen */ -+ {"ZA", 0x26}, /* South Africa */ -+ {"ZW", 0x26}, /* Zimbabwe */ -+}; -+ -+u16 country_chplan_map_sz = sizeof(country_chplan_map)/sizeof(struct country_chplan); -+ -+/* -+* rtw_get_chplan_from_country - -+* @country_code: string of country code -+* -+* Return channel_plan index or -1 when unsupported country_code is given -+*/ -+int rtw_get_chplan_from_country(const char *country_code) -+{ -+ int channel_plan = -1; -+ int i; -+ -+ /* TODO: should consider 3-character country code? */ -+ -+ for (i = 0; i < country_chplan_map_sz; i++) { -+ if (strncmp(country_code, country_chplan_map[i].alpha2, 2) == 0) { -+ channel_plan = country_chplan_map[i].chplan; -+ break; ++ for (i = 0; i < ch_freq_map_num; i++) ++ { ++ if (channel == ch_freq_map[i].channel) ++ { ++ freq = ch_freq_map[i].frequency; ++ break; + } + } ++ if (i == ch_freq_map_num) ++ freq = 2412; + -+ return channel_plan; ++ return freq; +} + -+int rtw_ch_to_bb_gain_sel(int ch) ++u32 rtw_freq2ch(u32 freq) +{ -+ int sel = -1; ++ u8 i; ++ u32 ch = 0; + -+ if (ch >= 1 && ch <= 14) -+ sel = BB_GAIN_2G; -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ else if (ch >= 36 && ch < 48) -+ sel = BB_GAIN_5GLB1; -+ else if (ch >= 52 && ch <= 64) -+ sel = BB_GAIN_5GLB2; -+ else if (ch >= 100 && ch <= 120) -+ sel = BB_GAIN_5GMB1; -+ else if (ch >= 124 && ch <= 144) -+ sel = BB_GAIN_5GMB2; -+ else if (ch >= 149 && ch <= 177) -+ sel = BB_GAIN_5GHB; -+#endif -+ -+ return sel; -+} -+ -+s8 rtw_rf_get_kfree_tx_gain_offset(_adapter *padapter, u8 path, u8 ch) -+{ -+ s8 kfree_offset = 0; -+ -+#ifdef CONFIG_RF_GAIN_OFFSET -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(padapter); -+ s8 bb_gain_sel = rtw_ch_to_bb_gain_sel(ch); -+ -+ if (bb_gain_sel < BB_GAIN_2G || bb_gain_sel >= BB_GAIN_NUM) { -+ rtw_warn_on(1); -+ goto exit; ++ for (i = 0; i < ch_freq_map_num; i++) ++ { ++ if (freq == ch_freq_map[i].frequency) ++ { ++ ch = ch_freq_map[i].channel; ++ break; ++ } + } ++ if (i == ch_freq_map_num) ++ ch = 1; + -+ if (kfree_data->flag & KFREE_FLAG_ON) { -+ kfree_offset = kfree_data->bb_gain[bb_gain_sel][path]; -+ if (1) -+ DBG_871X("%s path:%u, ch:%u, bb_gain_sel:%d, kfree_offset:%d\n" -+ , __func__, path, ch, bb_gain_sel, kfree_offset); -+ } -+exit: -+#endif /* CONFIG_RF_GAIN_OFFSET */ -+ return kfree_offset; ++ return ch; +} -+ -+void rtw_rf_set_tx_gain_offset(_adapter *adapter, u8 path, s8 offset) -+{ -+ u8 write_value; -+ -+ DBG_871X("kfree gain_offset 0x55:0x%x ", rtw_hal_read_rfreg(adapter, path, 0x55, 0xffffffff)); -+ switch (rtw_get_chip_type(adapter)) { -+#ifdef CONFIG_RTL8703B -+ case RTL8703B: -+ write_value = RF_TX_GAIN_OFFSET_8703B(offset); -+ rtw_hal_write_rfreg(adapter, path, 0x55, 0x0fc000, write_value); -+ break; -+#endif /* CONFIG_RTL8703B */ -+#ifdef CONFIG_RTL8188F -+ case RTL8188F: -+ write_value = RF_TX_GAIN_OFFSET_8188F(offset); -+ rtw_hal_write_rfreg(adapter, path, 0x55, 0x0fc000, write_value); -+ break; -+#endif /* CONFIG_RTL8188F */ -+#ifdef CONFIG_RTL8192E -+ case RTL8192E: -+ write_value = RF_TX_GAIN_OFFSET_8192E(offset); -+ rtw_hal_write_rfreg(adapter, path, 0x55, 0x0f8000, write_value); -+ break; -+#endif /* CONFIG_RTL8188F */ -+ -+#ifdef CONFIG_RTL8821A -+ case RTL8821: -+ write_value = RF_TX_GAIN_OFFSET_8821A(offset); -+ rtw_hal_write_rfreg(adapter, path, 0x55, 0x0f8000, write_value); -+ break; -+#endif /* CONFIG_RTL8821A */ -+#ifdef CONFIG_RTL8814A -+ case RTL8814A: -+ DBG_871X("\nkfree by PhyDM on the sw CH. path %d\n", path); -+ break; -+#endif /* CONFIG_RTL8821A */ -+ -+ default: -+ rtw_warn_on(1); -+ break; -+ } -+ -+ DBG_871X(" after :0x%x\n", rtw_hal_read_rfreg(adapter, path, 0x55, 0xffffffff)); -+} -+ -+void rtw_rf_apply_tx_gain_offset(_adapter *adapter, u8 ch) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ s8 kfree_offset = 0; -+ s8 tx_pwr_track_offset = 0; /* TODO: 8814A should consider tx pwr track when setting tx gain offset */ -+ s8 total_offset; -+ int i; -+ -+ for (i = 0; i < hal_data->NumTotalRFPath; i++) { -+ kfree_offset = rtw_rf_get_kfree_tx_gain_offset(adapter, i, ch); -+ total_offset = kfree_offset + tx_pwr_track_offset; -+ rtw_rf_set_tx_gain_offset(adapter, i, total_offset); -+ } -+} -+ -+bool rtw_is_dfs_range(u32 hi, u32 lo) -+{ -+ return rtw_is_range_overlap(hi, lo, 5720 + 10, 5260 - 10)?_TRUE:_FALSE; -+} -+ -+bool rtw_is_dfs_ch(u8 ch, u8 bw, u8 offset) -+{ -+ u32 hi, lo; -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) -+ return _FALSE; -+ -+ return rtw_is_dfs_range(hi, lo)?_TRUE:_FALSE; -+} -+ -+bool rtw_is_long_cac_range(u32 hi, u32 lo) -+{ -+ return rtw_is_range_overlap(hi, lo, 5660 + 10, 5600 - 10)?_TRUE:_FALSE; -+} -+ -+bool rtw_is_long_cac_ch(u8 ch, u8 bw, u8 offset) -+{ -+ u32 hi, lo; -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) -+ return _FALSE; -+ -+ return rtw_is_long_cac_range(hi, lo)?_TRUE:_FALSE; -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl8812au/core/rtw_security.c ---- linux.old/3rdparty/rtl8812au/core/rtw_security.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_security.c 2017-06-07 23:07:21.005687029 +0300 -@@ -0,0 +1,3350 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_security.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_security.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_security.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_security.c 2018-02-06 17:42:30.699967001 +0200 +@@ -0,0 +1,2864 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -67135,97 +46407,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_SECURITY_C_ + +#include + -+static const char *_security_type_str[] = { -+ "N/A", -+ "WEP40", -+ "TKIP", -+ "TKIP_WM", -+ "AES", -+ "WEP104", -+ "SMS4", -+ "WEP_WPA", -+ "BIP", -+}; + -+const char *security_type_str(u8 value) -+{ -+#ifdef CONFIG_IEEE80211W -+ if (value <= _BIP_) -+#else -+ if (value <= _WEP_WPA_MIXED_) -+#endif -+ return _security_type_str[value]; -+ return NULL; -+} -+ -+#ifdef DBG_SW_SEC_CNT -+#define WEP_SW_ENC_CNT_INC(sec, ra) \ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->wep_sw_enc_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->wep_sw_enc_cnt_mc++; \ -+ else \ -+ sec->wep_sw_enc_cnt_uc++; -+ -+#define WEP_SW_DEC_CNT_INC(sec, ra) \ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->wep_sw_dec_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->wep_sw_dec_cnt_mc++; \ -+ else \ -+ sec->wep_sw_dec_cnt_uc++; -+ -+#define TKIP_SW_ENC_CNT_INC(sec, ra) \ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->tkip_sw_enc_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->tkip_sw_enc_cnt_mc++; \ -+ else \ -+ sec->tkip_sw_enc_cnt_uc++; -+ -+#define TKIP_SW_DEC_CNT_INC(sec, ra) \ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->tkip_sw_dec_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->tkip_sw_dec_cnt_mc++; \ -+ else \ -+ sec->tkip_sw_dec_cnt_uc++; -+ -+#define AES_SW_ENC_CNT_INC(sec, ra) \ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->aes_sw_enc_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->aes_sw_enc_cnt_mc++; \ -+ else \ -+ sec->aes_sw_enc_cnt_uc++; -+ -+#define AES_SW_DEC_CNT_INC(sec, ra) \ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->aes_sw_dec_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->aes_sw_dec_cnt_mc++; \ -+ else \ -+ sec->aes_sw_dec_cnt_uc++; -+#else -+#define WEP_SW_ENC_CNT_INC(sec, ra) -+#define WEP_SW_DEC_CNT_INC(sec, ra) -+#define TKIP_SW_ENC_CNT_INC(sec, ra) -+#define TKIP_SW_DEC_CNT_INC(sec, ra) -+#define AES_SW_ENC_CNT_INC(sec, ra) -+#define AES_SW_DEC_CNT_INC(sec, ra) -+#endif /* DBG_SW_SEC_CNT */ -+ -+//=====WEP related===== ++//=====WEP related===== + +#define CRC32_POLY 0x04c11db7 + @@ -67237,14 +46425,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +}; + + -+static void arcfour_init(struct arc4context *parc4ctx, u8 * key,u32 key_len) ++static void arcfour_init(struct arc4context *parc4ctx, u8 * key,u32 key_len) +{ + u32 t, u; + u32 keyindex; + u32 stateindex; + u8 * state; + u32 counter; -+_func_enter_; ++ + state = parc4ctx->state; + parc4ctx->x = 0; + parc4ctx->y = 0; @@ -67262,7 +46450,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + if (++keyindex >= key_len) + keyindex = 0; + } -+_func_exit_; ++ +} +static u32 arcfour_byte( struct arc4context *parc4ctx) +{ @@ -67270,7 +46458,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + u32 y; + u32 sx, sy; + u8 * state; -+_func_enter_; ++ + state = parc4ctx->state; + x = (parc4ctx->x + 1) & 0xff; + sx = state[x]; @@ -67280,21 +46468,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + parc4ctx->y = y; + state[y] = (u8)sx; + state[x] = (u8)sy; -+_func_exit_; ++ + return state[(sx + sy) & 0xff]; +} -+ -+ -+static void arcfour_encrypt( struct arc4context *parc4ctx, ++ ++ ++static void arcfour_encrypt( struct arc4context *parc4ctx, + u8 * dest, -+ u8 * src, ++ u8 * src, + u32 len) +{ + u32 i; -+_func_enter_; ++ + for (i = 0; i < len; i++) + dest[i] = src[i] ^ (unsigned char)arcfour_byte(parc4ctx); -+_func_exit_; ++ +} + +static sint bcrc32initialized = 0; @@ -67308,9 +46496,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + +static void crc32_init(void) +{ -+_func_enter_; -+ if (bcrc32initialized == 1) -+ goto exit; ++ ++ if (bcrc32initialized == 1) ++ return; + else{ + sint i, j; + u32 c; @@ -67319,7 +46507,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + + c = 0x12340000; + -+ for (i = 0; i < 256; ++i) ++ for (i = 0; i < 256; ++i) + { + k = crc32_reverseBit((u8)i); + for (c = ((u32)k) << 24, j = 8; j > 0; --j){ @@ -67334,34 +46522,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + } + bcrc32initialized= 1; + } -+exit: -+_func_exit_; +} + -+static u32 getcrc32(u8 *buf, sint len) ++static __le32 getcrc32(u8 *buf, sint len) +{ + u8 *p; + u32 crc; -+_func_enter_; -+ if (bcrc32initialized == 0) crc32_init(); ++ ++ if (bcrc32initialized == 0) ++ crc32_init(); + + crc = 0xffffffff; /* preload shift register, per CRC-32 spec */ + -+ for (p = buf; len > 0; ++p, --len) -+ { -+ crc = crc32_table[ (crc ^ *p) & 0xff] ^ (crc >> 8); -+ } -+_func_exit_; -+ return ~crc; /* transmit complement, per CRC-32 spec */ -+} ++ for (p = buf; len > 0; ++p, --len) ++ crc = crc32_table[(crc ^ *p) & 0xff] ^ (crc >> 8); + ++ return cpu_to_le32(~crc); /* transmit complement, per CRC-32 spec */ ++} + +/* + Need to consider the fragment situation +*/ +void rtw_wep_encrypt(_adapter *padapter, u8 *pxmitframe) +{ // exclude ICV -+ ++ + unsigned char crc[4]; + struct arc4context mycontext; + @@ -67372,18 +46556,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + u8 wepkey[16]; + u8 hw_hdr_offset=0; + struct pkt_attrib *pattrib = &((struct xmit_frame*)pxmitframe)->attrib; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; ++ struct security_priv *psecuritypriv=&padapter->securitypriv; + struct xmit_priv *pxmitpriv=&padapter->xmitpriv; -+ -+_func_enter_; + -+ ++ ++ ++ + if(((struct xmit_frame*)pxmitframe)->buf_addr==NULL) + return; + +#ifdef CONFIG_USB_TX_AGGREGATION + hw_hdr_offset = TXDESC_SIZE + -+ (((struct xmit_frame*)pxmitframe)->pkt_offset * PACKET_OFFSET_SZ); ++ (((struct xmit_frame*)pxmitframe)->pkt_offset * PACKET_OFFSET_SZ); +#else + #ifdef CONFIG_TX_EARLY_MODE + hw_hdr_offset = TXDESC_OFFSET+EARLY_MODE_INFO_SIZE; @@ -67393,7 +46577,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +#endif + + pframe = ((struct xmit_frame*)pxmitframe)->buf_addr + hw_hdr_offset; -+ ++ + //start to encrypt each fragment + if((pattrib->encrypt==_WEP40_)||(pattrib->encrypt==_WEP104_)) + { @@ -67408,10 +46592,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + + if((curfragnum+1)==pattrib->nr_frags) + { //the last fragment -+ ++ + length=pattrib->last_txcmdsz-pattrib->hdrlen-pattrib->iv_len- pattrib->icv_len; -+ -+ *((u32 *)crc)=cpu_to_le32(getcrc32(payload,length)); ++ ++ *((u32 *)crc)=le32_to_cpu(getcrc32(payload,length)); + + arcfour_init(&mycontext, wepkey,3+keylength); + arcfour_encrypt(&mycontext, payload, payload, length); @@ -67421,41 +46605,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + else + { + length=pxmitpriv->frag_len-pattrib->hdrlen-pattrib->iv_len-pattrib->icv_len ; -+ *((u32 *)crc)=cpu_to_le32(getcrc32(payload,length)); ++ *((u32 *)crc)=le32_to_cpu(getcrc32(payload,length)); + arcfour_init(&mycontext, wepkey,3+keylength); + arcfour_encrypt(&mycontext, payload, payload, length); + arcfour_encrypt(&mycontext, payload+length, crc, 4); -+ ++ + pframe+=pxmitpriv->frag_len; + pframe=(u8 *)RND4((SIZE_PTR)(pframe)); + + } -+ -+ } + -+ WEP_SW_ENC_CNT_INC(psecuritypriv, pattrib->ra); ++ } ++ + } -+ -+_func_exit_; ++ ++ + +} + +void rtw_wep_decrypt(_adapter *padapter, u8 *precvframe) -+{ ++{ + // exclude ICV + u8 crc[4]; + struct arc4context mycontext; -+ sint length; ++ sint length; + u32 keylength; + u8 *pframe, *payload,*iv,wepkey[16]; + u8 keyindex; + struct rx_pkt_attrib *prxattrib = &(((union recv_frame*)precvframe)->u.hdr.attrib); -+ struct security_priv *psecuritypriv=&padapter->securitypriv; ++ struct security_priv *psecuritypriv=&padapter->securitypriv; ++ + -+_func_enter_; + + pframe=(unsigned char *)((union recv_frame*)precvframe)->u.hdr.rx_data; -+ ++ + //start to decrypt recvframe + if((prxattrib->encrypt==_WEP40_)||(prxattrib->encrypt==_WEP104_)) + { @@ -67469,42 +46652,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + length= ((union recv_frame *)precvframe)->u.hdr.len-prxattrib->hdrlen-prxattrib->iv_len; + + payload=pframe+prxattrib->iv_len+prxattrib->hdrlen; -+ ++ + //decrypt payload include icv + arcfour_init(&mycontext, wepkey,3+keylength); + arcfour_encrypt(&mycontext, payload, payload, length); -+ ++ + //calculate icv and compare the icv + *((u32 *)crc)=le32_to_cpu(getcrc32(payload,length-4)); -+ ++ + if(crc[3]!=payload[length-1] || crc[2]!=payload[length-2] || crc[1]!=payload[length-3] || crc[0]!=payload[length-4]) + { + RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_wep_decrypt:icv error crc[3](%x)!=payload[length-1](%x) || crc[2](%x)!=payload[length-2](%x) || crc[1](%x)!=payload[length-3](%x) || crc[0](%x)!=payload[length-4](%x)\n", + crc[3],payload[length-1],crc[2],payload[length-2],crc[1],payload[length-3],crc[0],payload[length-4])); + } + -+ WEP_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); + } -+ -+_func_exit_; ++ ++ + + return; -+ ++ +} + -+//3 =====TKIP related===== ++//3 =====TKIP related===== + +static u32 secmicgetuint32( u8 * p ) +// Convert from Byte[] to Us4Byte32 in a portable way +{ + s32 i; + u32 res = 0; -+_func_enter_; ++ + for( i=0; i<4; i++ ) + { + res |= ((u32)(*p++)) << (8*i); + } -+_func_exit_; ++ + return res; +} + @@ -67512,40 +46694,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +// Convert from Us4Byte32 to Byte[] in a portable way +{ + long i; -+_func_enter_; ++ + for( i=0; i<4; i++ ) + { + *p++ = (u8) (val & 0xff); + val >>= 8; + } -+_func_exit_; ++ +} + +static void secmicclear(struct mic_data *pmicdata) +{ +// Reset the state to the empty message. -+_func_enter_; ++ + pmicdata->L = pmicdata->K0; + pmicdata->R = pmicdata->K1; + pmicdata->nBytesInM = 0; + pmicdata->M = 0; -+_func_exit_; ++ +} + +void rtw_secmicsetkey(struct mic_data *pmicdata, u8 * key ) +{ + // Set the key -+_func_enter_; ++ + pmicdata->K0 = secmicgetuint32( key ); + pmicdata->K1 = secmicgetuint32( key + 4 ); + // and reset the message + secmicclear(pmicdata); -+_func_exit_; ++ +} + +void rtw_secmicappendbyte(struct mic_data *pmicdata, u8 b ) +{ -+_func_enter_; ++ + // Append the byte to our word-sized buffer + pmicdata->M |= ((unsigned long)b) << (8*pmicdata->nBytesInM); + pmicdata->nBytesInM++; @@ -67565,24 +46747,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + pmicdata->M = 0; + pmicdata->nBytesInM = 0; + } -+_func_exit_; ++ +} + +void rtw_secmicappend(struct mic_data *pmicdata, u8 * src, u32 nbytes ) +{ -+_func_enter_; ++ + // This is simple + while( nbytes > 0 ) + { + rtw_secmicappendbyte(pmicdata, *src++ ); + nbytes--; + } -+_func_exit_; ++ +} + +void rtw_secgetmic(struct mic_data *pmicdata, u8 * dst ) +{ -+_func_enter_; ++ + // Append the minimum padding + rtw_secmicappendbyte(pmicdata, 0x5a ); + rtw_secmicappendbyte(pmicdata, 0 ); @@ -67599,7 +46781,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + secmicputuint32( dst+4, pmicdata->R ); + // Reset to the empty message. + secmicclear(pmicdata); -+_func_exit_; ++ +} + + @@ -67608,18 +46790,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + + struct mic_data micdata; + u8 priority[4]={0x0,0x0,0x0,0x0}; -+_func_enter_; ++ + rtw_secmicsetkey(&micdata, key); + priority[0]=pri; -+ ++ + /* Michael MIC pseudo header: DA, SA, 3 x 0, Priority */ + if(header[1]&1){ //ToDS==1 + rtw_secmicappend(&micdata, &header[16], 6); //DA + if(header[1]&2) //From Ds==1 + rtw_secmicappend(&micdata, &header[24], 6); + else -+ rtw_secmicappend(&micdata, &header[10], 6); -+ } ++ rtw_secmicappend(&micdata, &header[10], 6); ++ } + else{ //ToDS==0 + rtw_secmicappend(&micdata, &header[4], 6); //DA + if(header[1]&2) //From Ds==1 @@ -67630,11 +46812,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + } + rtw_secmicappend(&micdata, &priority[0], 4); + -+ ++ + rtw_secmicappend(&micdata, data, data_len); + + rtw_secgetmic(&micdata,mic_code); -+_func_exit_; ++ +} + + @@ -67698,7 +46880,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + 0x038F,0x59F8,0x0980,0x1A17,0x65DA,0xD731,0x84C6,0xD0B8, + 0x82C3,0x29B0,0x5A77,0x1E11,0x7BCB,0xA8FC,0x6DD6,0x2C3A, + }, -+ ++ + + { /* second half of table is unsigned char-reversed version of first! */ + 0xA5C6,0x84F8,0x99EE,0x8DF6,0x0DFF,0xBDD6,0xB1DE,0x5491, @@ -67735,7 +46917,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + 0xC382,0xB029,0x775A,0x111E,0xCB7B,0xFCA8,0xD66D,0x3A2C, + } +}; -+ ++ + /* +********************************************************************** +* Routine: Phase 1 -- generate P1K, given TA, TK, IV32 @@ -67756,7 +46938,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +static void phase1(u16 *p1k,const u8 *tk,const u8 *ta,u32 iv32) +{ + sint i; -+_func_enter_; ++ + /* Initialize the 80 bits of P1K[] from IV32 and TA[0..5] */ + p1k[0] = Lo16(iv32); + p1k[1] = Hi16(iv32); @@ -67768,16 +46950,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + /* size on the 80-bit block P1K[], using the 128-bit key TK[] */ + for (i=0; i < PHASE1_LOOP_CNT ;i++) + { /* Each add operation here is mod 2**16 */ -+ p1k[0] += _S_(p1k[4] ^ TK16((i&1)+0)); ++ p1k[0] += _S_(p1k[4] ^ TK16((i&1)+0)); + p1k[1] += _S_(p1k[0] ^ TK16((i&1)+2)); + p1k[2] += _S_(p1k[1] ^ TK16((i&1)+4)); + p1k[3] += _S_(p1k[2] ^ TK16((i&1)+6)); + p1k[4] += _S_(p1k[3] ^ TK16((i&1)+0)); + p1k[4] += (unsigned short)i; /* avoid "slide attacks" */ + } -+_func_exit_; ++ +} -+ ++ + +/* +********************************************************************** @@ -67806,7 +46988,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +{ + sint i; + u16 PPK[6]; /* temporary key for mixing */ -+_func_enter_; ++ + /* Note: all adds in the PPK[] equations below are mod 2**16 */ + for (i=0;i<5;i++) PPK[i]=p1k[i]; /* first, copy P1K to PPK */ + PPK[5] = p1k[4] +iv16; /* next, add in IV16 */ @@ -67836,7 +47018,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + rc4key[1] =(Hi8(iv16) | 0x20) & 0x7F; /* Help avoid weak (FMS) keys */ + rc4key[2] = Lo8(iv16); + rc4key[3] = Lo8((PPK[5] ^ TK16(0)) >> 1); -+ ++ + + /* Copy 96 bits of PPK[0..5] to RC4KEY[4..15] (little-endian) */ + for (i=0;i<6;i++) @@ -67844,7 +47026,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + rc4key[4+2*i] = Lo8(PPK[i]); + rc4key[5+2*i] = Hi8(PPK[i]); + } -+_func_exit_; ++ +} + + @@ -67858,24 +47040,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + u8 crc[4]; + u8 hw_hdr_offset = 0; + struct arc4context mycontext; -+ sint curfragnum,length; ++ sint curfragnum,length; + u32 prwskeylen; + + u8 *pframe, *payload,*iv,*prwskey; + union pn48 dot11txpn; + //struct sta_info *stainfo; + struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; ++ struct security_priv *psecuritypriv=&padapter->securitypriv; + struct xmit_priv *pxmitpriv=&padapter->xmitpriv; + u32 res=_SUCCESS; -+_func_enter_; ++ + + if(((struct xmit_frame*)pxmitframe)->buf_addr==NULL) + return _FAIL; + +#ifdef CONFIG_USB_TX_AGGREGATION + hw_hdr_offset = TXDESC_SIZE + -+ (((struct xmit_frame*)pxmitframe)->pkt_offset * PACKET_OFFSET_SZ); ++ (((struct xmit_frame*)pxmitframe)->pkt_offset * PACKET_OFFSET_SZ); +#else + #ifdef CONFIG_TX_EARLY_MODE + hw_hdr_offset = TXDESC_OFFSET+EARLY_MODE_INFO_SIZE; @@ -67897,8 +47079,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + { + DBG_871X("%s, call rtw_get_stainfo()\n", __func__); + stainfo=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0] ); -+ } -+*/ ++ } ++*/ + //if (stainfo!=NULL) + { +/* @@ -67907,7 +47089,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, stainfo->state); + return _FAIL; + } -+*/ ++*/ + RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_tkip_encrypt: stainfo!=NULL!!!\n")); + + if(IS_MCAST(pattrib->ra)) @@ -67925,7 +47107,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + for(curfragnum=0;curfragnumnr_frags;curfragnum++){ + iv=pframe+pattrib->hdrlen; + payload=pframe+pattrib->iv_len+pattrib->hdrlen; -+ ++ + GET_TKIP_PN(iv, dot11txpn); + + pnl=(u16)(dot11txpn.val); @@ -67933,12 +47115,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + + phase1((u16 *)&ttkey[0],prwskey,&pattrib->ta[0],pnh); + -+ phase2(&rc4key[0],prwskey,(u16 *)&ttkey[0],pnl); ++ phase2(&rc4key[0],prwskey,(u16 *)&ttkey[0],pnl); + + if((curfragnum+1)==pattrib->nr_frags){ //4 the last fragment + length=pattrib->last_txcmdsz-pattrib->hdrlen-pattrib->iv_len- pattrib->icv_len; + RT_TRACE(_module_rtl871x_security_c_,_drv_info_,("pattrib->iv_len =%x, pattrib->icv_len =%x\n", pattrib->iv_len,pattrib->icv_len)); -+ *((u32 *)crc)=cpu_to_le32(getcrc32(payload,length));/* modified by Amy*/ ++ *((u32 *)crc)=le32_to_cpu(getcrc32(payload,length));/* modified by Amy*/ + + arcfour_init(&mycontext, rc4key,16); + arcfour_encrypt(&mycontext, payload, payload, length); @@ -67947,18 +47129,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + } + else{ + length=pxmitpriv->frag_len-pattrib->hdrlen-pattrib->iv_len-pattrib->icv_len ; -+ *((u32 *)crc)=cpu_to_le32(getcrc32(payload,length));/* modified by Amy*/ ++ *((u32 *)crc)=le32_to_cpu(getcrc32(payload,length));/* modified by Amy*/ + arcfour_init(&mycontext,rc4key,16); + arcfour_encrypt(&mycontext, payload, payload, length); + arcfour_encrypt(&mycontext, payload+length, crc, 4); -+ ++ + pframe+=pxmitpriv->frag_len; + pframe=(u8 *)RND4((SIZE_PTR)(pframe)); + + } + } + -+ TKIP_SW_ENC_CNT_INC(psecuritypriv,pattrib->ra); ++ + } +/* + else{ @@ -67966,12 +47148,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + DBG_871X("%s, psta==NUL\n", __func__); + res=_FAIL; + } -+*/ -+ ++*/ ++ + } -+_func_exit_; ++ + return res; -+ ++ +} + + @@ -67984,21 +47166,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + u8 ttkey[16]; + u8 crc[4]; + struct arc4context mycontext; -+ sint length; ++ sint length; + u32 prwskeylen; + + u8 *pframe, *payload,*iv,*prwskey; + union pn48 dot11txpn; + struct sta_info *stainfo; + struct rx_pkt_attrib *prxattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; ++ struct security_priv *psecuritypriv=&padapter->securitypriv; +// struct recv_priv *precvpriv=&padapter->recvpriv; + u32 res=_SUCCESS; + -+_func_enter_; ++ + + pframe=(unsigned char *)((union recv_frame*)precvframe)->u.hdr.rx_data; -+ ++ + //4 start to decrypt recvframe + if(prxattrib->encrypt==_TKIP_){ + @@ -68007,42 +47189,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + + if(IS_MCAST(prxattrib->ra)) + { -+ static u32 start = 0; -+ static u32 no_gkey_bc_cnt = 0; -+ static u32 no_gkey_mc_cnt = 0; -+ -+ if(psecuritypriv->binstallGrpkey==_FALSE) ++ if(psecuritypriv->binstallGrpkey==false) + { + res=_FAIL; -+ -+ if (start == 0) -+ start = rtw_get_current_time(); -+ -+ if (is_broadcast_mac_addr(prxattrib->ra)) -+ no_gkey_bc_cnt++; -+ else -+ no_gkey_mc_cnt++; -+ -+ if (rtw_get_passing_time_ms(start) > 1000) { -+ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", -+ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); -+ } -+ start = rtw_get_current_time(); -+ no_gkey_bc_cnt = 0; -+ no_gkey_mc_cnt = 0; -+ } ++ DBG_8192C("%s:rx bc/mc packets,but didn't install group key!!!!!!!!!!\n",__FUNCTION__); + goto exit; + } -+ -+ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" gkey installed. no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", -+ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); -+ } -+ start = 0; -+ no_gkey_bc_cnt = 0; -+ no_gkey_mc_cnt = 0; -+ + //DBG_871X("rx bc/mc packets, to perform sw rtw_tkip_decrypt\n"); + //prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; + prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; @@ -68050,24 +47202,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + } + else + { ++ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_tkip_decrypt: stainfo!=NULL!!!\n")); + prwskey=&stainfo->dot118021x_UncstKey.skey[0]; + prwskeylen=16; + } -+ ++ + iv=pframe+prxattrib->hdrlen; + payload=pframe+prxattrib->iv_len+prxattrib->hdrlen; + length= ((union recv_frame *)precvframe)->u.hdr.len-prxattrib->hdrlen-prxattrib->iv_len; -+ ++ + GET_TKIP_PN(iv, dot11txpn); + + pnl=(u16)(dot11txpn.val); + pnh=(u32)(dot11txpn.val>>16); + + phase1((u16 *)&ttkey[0],prwskey,&prxattrib->ta[0],pnh); -+ phase2(&rc4key[0],prwskey,(unsigned short *)&ttkey[0],pnl); ++ phase2(&rc4key[0],prwskey,(unsigned short *)&ttkey[0],pnl); + + //4 decrypt payload include icv -+ ++ + arcfour_init(&mycontext, rc4key,16); + arcfour_encrypt(&mycontext, payload, payload, length); + @@ -68080,18 +47233,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + res=_FAIL; + } + -+ TKIP_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); ++ + } + else{ + RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_tkip_decrypt: stainfo==NULL!!!\n")); + res=_FAIL; + } -+ ++ + } -+_func_exit_; ++ +exit: + return res; -+ ++ +} + + @@ -68151,13 +47304,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + sint a4_exists, + u8 *mpdu, + uint payload_length, -+ u8 * pn_vector, -+ uint frtype);// add for CONFIG_IEEE80211W, none 11w also can use ++ u8 * pn_vector); +static void construct_mic_header1( + u8 *mic_header1, + sint header_length, -+ u8 *mpdu, -+ uint frtype);// add for CONFIG_IEEE80211W, none 11w also can use ++ u8 *mpdu); +static void construct_mic_header2( + u8 *mic_header2, + u8 *mpdu, @@ -68169,8 +47320,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + sint qc_exists, + u8 *mpdu, + u8 *pn_vector, -+ sint c, -+ uint frtype);// add for CONFIG_IEEE80211W, none 11w also can use ++ sint c); +static void xor_128(u8 *a, u8 *b, u8 *out); +static void xor_32(u8 *a, u8 *b, u8 *out); +static u8 sbox(u8 a); @@ -68178,13 +47328,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +static void byte_sub(u8 *in, u8 *out); +static void shift_row(u8 *in, u8 *out); +static void mix_column(u8 *in, u8 *out); -+#ifndef PLATFORM_FREEBSD +static void add_round_key( u8 *shiftrow_in, + u8 *mcol_in, + u8 *block_in, + sint round, + u8 *out); -+#endif //PLATFORM_FREEBSD +static void aes128k128d(u8 *key, u8 *data, u8 *ciphertext); + + @@ -68196,24 +47344,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +static void xor_128(u8 *a, u8 *b, u8 *out) +{ + sint i; -+_func_enter_; ++ + for (i=0;i<16; i++) + { + out[i] = a[i] ^ b[i]; + } -+_func_exit_; ++ +} + + +static void xor_32(u8 *a, u8 *b, u8 *out) +{ + sint i; -+_func_enter_; ++ + for (i=0;i<4; i++) + { + out[i] = a[i] ^ b[i]; + } -+_func_exit_; ++ +} + + @@ -68232,7 +47380,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, + 0x1b, 0x36, 0x36, 0x36 + }; -+_func_enter_; ++ + sbox_key[0] = sbox(key[13]); + sbox_key[1] = sbox(key[14]); + sbox_key[2] = sbox(key[15]); @@ -68246,25 +47394,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + xor_32(&key[4], &key[0], &key[4]); + xor_32(&key[8], &key[4], &key[8]); + xor_32(&key[12], &key[8], &key[12]); -+_func_exit_; ++ +} + + +static void byte_sub(u8 *in, u8 *out) +{ + sint i; -+_func_enter_; ++ + for (i=0; i< 16; i++) + { + out[i] = sbox(in[i]); + } -+_func_exit_; ++ +} + + +static void shift_row(u8 *in, u8 *out) +{ -+_func_enter_; ++ + out[0] = in[0]; + out[1] = in[5]; + out[2] = in[10]; @@ -68281,7 +47429,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + out[13] = in[1]; + out[14] = in[6]; + out[15] = in[11]; -+_func_exit_; ++ +} + + @@ -68296,7 +47444,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + u8 rotr[4]; + u8 temp[4]; + u8 tempb[4]; -+_func_enter_; ++ + for (i=0 ; i<4; i++) + { + if ((in[i] & 0x80)== 0x80) @@ -68344,7 +47492,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + xor_32(add1bf7, rotr, temp); + xor_32(swap_halfs, rotl,tempb); + xor_32(temp, tempb, out); -+_func_exit_; ++ +} + + @@ -68355,7 +47503,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + u8 intermediatea[16]; + u8 intermediateb[16]; + u8 round_key[16]; -+_func_enter_; ++ + for(i=0; i<16; i++) round_key[i] = key[i]; + + for (round = 0; round < 11; round++) @@ -68383,15 +47531,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + next_key(round_key, round); + } + } -+_func_exit_; ++ +} + + +/************************************************/ +/* construct_mic_iv() */ +/* Builds the MIC IV from header fields and PN */ -+/* Baron think the function is construct CCM */ -+/* nonce */ +/************************************************/ +static void construct_mic_iv( + u8 *mic_iv, @@ -68399,21 +47545,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + sint a4_exists, + u8 *mpdu, + uint payload_length, -+ u8 *pn_vector, -+ uint frtype// add for CONFIG_IEEE80211W, none 11w also can use ++ u8 *pn_vector + ) +{ + sint i; -+_func_enter_; ++ + mic_iv[0] = 0x59; + if (qc_exists && a4_exists) mic_iv[1] = mpdu[30] & 0x0f; /* QoS_TC */ + if (qc_exists && !a4_exists) mic_iv[1] = mpdu[24] & 0x0f; /* mute bits 7-4 */ + if (!qc_exists) mic_iv[1] = 0x00; -+#ifdef CONFIG_IEEE80211W -+ //802.11w management frame should set management bit(4) -+ if(frtype == WIFI_MGT_TYPE) -+ mic_iv[1] |= BIT(4); -+#endif //CONFIG_IEEE80211W + for (i = 2; i < 8; i++) + mic_iv[i] = mpdu[i + 8]; /* mic_iv[2:7] = A2[0:5] = mpdu[10:15] */ + #ifdef CONSISTENT_PN_ORDER @@ -68425,7 +47565,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + #endif + mic_iv[14] = (unsigned char) (payload_length / 256); + mic_iv[15] = (unsigned char) (payload_length % 256); -+_func_exit_; ++ +} + + @@ -68433,26 +47573,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +/* construct_mic_header1() */ +/* Builds the first MIC header block from */ +/* header fields. */ -+/* Build AAD SC,A1,A2 */ +/************************************************/ +static void construct_mic_header1( + u8 *mic_header1, + sint header_length, -+ u8 *mpdu, -+ uint frtype// add for CONFIG_IEEE80211W, none 11w also can use ++ u8 *mpdu + ) +{ -+_func_enter_; ++ + mic_header1[0] = (u8)((header_length - 2) / 256); + mic_header1[1] = (u8)((header_length - 2) % 256); -+#ifdef CONFIG_IEEE80211W -+ //802.11w management frame don't AND subtype bits 4,5,6 of frame control field -+ if(frtype == WIFI_MGT_TYPE) -+ mic_header1[2] = mpdu[0]; -+ else -+#endif //CONFIG_IEEE80211W -+ mic_header1[2] = mpdu[0] & 0xcf; /* Mute CF poll & CF ack bits */ -+ ++ mic_header1[2] = mpdu[0] & 0xcf; /* Mute CF poll & CF ack bits */ + mic_header1[3] = mpdu[1] & 0xc7; /* Mute retry, more data and pwr mgt bits */ + mic_header1[4] = mpdu[4]; /* A1 */ + mic_header1[5] = mpdu[5]; @@ -68466,7 +47597,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + mic_header1[13] = mpdu[13]; + mic_header1[14] = mpdu[14]; + mic_header1[15] = mpdu[15]; -+_func_exit_; ++ +} + + @@ -68483,7 +47614,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + ) +{ + sint i; -+_func_enter_; ++ + for (i = 0; i<16; i++) mic_header2[i]=0x00; + + mic_header2[0] = mpdu[16]; /* A3 */ @@ -68518,7 +47649,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + mic_header2[15] = mpdu[31] & 0x00; + } + -+_func_exit_; ++ +} + + @@ -68526,8 +47657,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +/* construct_mic_header2() */ +/* Builds the last MIC header block from */ +/* header fields. */ -+/* Baron think the function is construct CCM */ -+/* nonce */ +/************************************************/ +static void construct_ctr_preload( + u8 *ctr_preload, @@ -68535,25 +47664,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + sint qc_exists, + u8 *mpdu, + u8 *pn_vector, -+ sint c, -+ uint frtype // add for CONFIG_IEEE80211W, none 11w also can use ++ sint c + ) +{ + sint i = 0; -+_func_enter_; ++ + for (i=0; i<16; i++) ctr_preload[i] = 0x00; + i = 0; -+ ++ + ctr_preload[0] = 0x01; /* flag */ -+ if (qc_exists && a4_exists) ++ if (qc_exists && a4_exists) + ctr_preload[1] = mpdu[30] & 0x0f; /* QoC_Control */ -+ if (qc_exists && !a4_exists) ++ if (qc_exists && !a4_exists) + ctr_preload[1] = mpdu[24] & 0x0f; -+#ifdef CONFIG_IEEE80211W -+ //802.11w management frame should set management bit(4) -+ if(frtype == WIFI_MGT_TYPE) -+ ctr_preload[1] |= BIT(4); -+#endif //CONFIG_IEEE80211W ++ + for (i = 2; i < 8; i++) + ctr_preload[i] = mpdu[i + 8]; /* ctr_preload[2:7] = A2[0:5] = mpdu[10:15] */ + #ifdef CONSISTENT_PN_ORDER @@ -68565,7 +47689,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + #endif + ctr_preload[14] = (unsigned char) (c / 256); /* Ctr */ + ctr_preload[15] = (unsigned char) (c % 256); -+_func_exit_; ++ +} + + @@ -68576,12 +47700,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +static void bitwise_xor(u8 *ina, u8 *inb, u8 *out) +{ + sint i; -+_func_enter_; ++ + for (i=0; i<16; i++) + { + out[i] = ina[i] ^ inb[i]; + } -+_func_exit_; ++ +} + + @@ -68606,8 +47730,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +// uint offset = 0; + uint frtype = GetFrameType(pframe); + uint frsubtype = GetFrameSubType(pframe); -+ -+_func_enter_; ++ ++ + frsubtype=frsubtype>>4; + + @@ -68625,25 +47749,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + a4_exists = 1; + + if ( -+ ((frtype|frsubtype) == WIFI_DATA_CFACK) || -+ ((frtype|frsubtype) == WIFI_DATA_CFPOLL)|| -+ ((frtype|frsubtype) == WIFI_DATA_CFACKPOLL)) ++ (frtype == WIFI_DATA_CFACK) || ++ (frtype == WIFI_DATA_CFPOLL)|| ++ (frtype == WIFI_DATA_CFACKPOLL)) + { + qc_exists = 1; + if(hdrlen != WLAN_HDR_A3_QOS_LEN){ -+ ++ + hdrlen += 2; + } + } -+ // add for CONFIG_IEEE80211W, none 11w also can use -+ else if ((frtype == WIFI_DATA) && -+ ((frsubtype == 0x08) || ++ else if ( ++ (frsubtype == 0x08) || + (frsubtype == 0x09)|| + (frsubtype == 0x0a)|| -+ (frsubtype == 0x0b))) ++ (frsubtype == 0x0b)) + { + if(hdrlen != WLAN_HDR_A3_QOS_LEN){ -+ ++ + hdrlen += 2; + } + qc_exists = 1; @@ -68657,22 +47780,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + pn_vector[3]=pframe[hdrlen+5]; + pn_vector[4]=pframe[hdrlen+6]; + pn_vector[5]=pframe[hdrlen+7]; -+ ++ + construct_mic_iv( + mic_iv, + qc_exists, + a4_exists, + pframe, //message, + plen, -+ pn_vector, -+ frtype // add for CONFIG_IEEE80211W, none 11w also can use ++ pn_vector + ); + + construct_mic_header1( + mic_header1, + hdrlen, -+ pframe, //message -+ frtype // add for CONFIG_IEEE80211W, none 11w also can use ++ pframe //message + ); + construct_mic_header2( + mic_header2, @@ -68720,21 +47841,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + + /* Insert MIC into payload */ + for (j = 0; j < 8; j++) -+ { -+ pframe[payload_index+j] = mic[j]; //message[payload_index+j] = mic[j]; -+ } ++ pframe[payload_index+j] = mic[j]; //message[payload_index+j] = mic[j]; + -+ payload_index = hdrlen + 8; -+ for (i=0; i< num_blocks; i++) -+ { ++ payload_index = hdrlen + 8; ++ for (i=0; i< num_blocks; i++) { + construct_ctr_preload( + ctr_preload, + a4_exists, + qc_exists, + pframe, //message, + pn_vector, -+ i+1, -+ frtype); // add for CONFIG_IEEE80211W, none 11w also can use ++ i+1); + aes128k128d(key, ctr_preload, aes_out); + bitwise_xor(aes_out, &pframe[payload_index], chain_buffer);//bitwise_xor(aes_out, &message[payload_index], chain_buffer); + for (j=0; j<16;j++) pframe[payload_index++] = chain_buffer[j];//for (j=0; j<16;j++) message[payload_index++] = chain_buffer[j]; @@ -68748,8 +47865,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + qc_exists, + pframe, //message, + pn_vector, -+ num_blocks+1, -+ frtype); // add for CONFIG_IEEE80211W, none 11w also can use ++ num_blocks+1); + + for (j = 0; j < 16; j++) padded_buffer[j] = 0x00; + for (j = 0; j < payload_remainder; j++) @@ -68768,8 +47884,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + qc_exists, + pframe, //message, + pn_vector, -+ 0, -+ frtype); // add for CONFIG_IEEE80211W, none 11w also can use ++ 0); + + for (j = 0; j < 16; j++) padded_buffer[j] = 0x00; + for (j = 0; j < 8; j++) @@ -68780,7 +47895,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + aes128k128d(key, ctr_preload, aes_out); + bitwise_xor(aes_out, padded_buffer, chain_buffer); + for (j=0; j<8;j++) pframe[payload_index++] = chain_buffer[j];//for (j=0; j<8;j++) message[payload_index++] = chain_buffer[j]; -+_func_exit_; ++ + return _SUCCESS; +} + @@ -68792,22 +47907,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +{ // exclude ICV + + -+ /*static*/ ++ /*static*/ +// unsigned char message[MAX_MSG_SIZE]; + -+ /* Intermediate Buffers */ -+ sint curfragnum,length; ++ /* Intermediate Buffers */ ++ sint curfragnum,length; + u32 prwskeylen; + u8 *pframe,*prwskey; //, *payload,*iv + u8 hw_hdr_offset = 0; -+ //struct sta_info *stainfo=NULL; ++ //struct sta_info *stainfo; + struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; ++ struct security_priv *psecuritypriv=&padapter->securitypriv; + struct xmit_priv *pxmitpriv=&padapter->xmitpriv; + +// uint offset = 0; + u32 res=_SUCCESS; -+_func_enter_; ++ + + if(((struct xmit_frame*)pxmitframe)->buf_addr==NULL) + return _FAIL; @@ -68820,7 +47935,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + hw_hdr_offset = TXDESC_OFFSET+EARLY_MODE_INFO_SIZE; + #else + hw_hdr_offset = TXDESC_OFFSET; -+ #endif ++ #endif +#endif + + pframe = ((struct xmit_frame*)pxmitframe)->buf_addr + hw_hdr_offset; @@ -68837,7 +47952,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + DBG_871X("%s, call rtw_get_stainfo()\n", __func__); + stainfo=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0] ); + } -+*/ ++*/ + //if (stainfo!=NULL) + { +/* @@ -68859,9 +47974,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + prwskey=pattrib->dot118021x_UncstKey.skey; + } + -+#ifdef CONFIG_TDLS ++#ifdef CONFIG_TDLS //swencryption + { -+ /* Swencryption */ + struct sta_info *ptdls_sta; + ptdls_sta=rtw_get_stainfo(&padapter->stapriv ,&pattrib->dst[0] ); + if((ptdls_sta != NULL) && (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) ) @@ -68873,17 +47987,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +#endif //CONFIG_TDLS + + prwskeylen=16; -+ ++ + for(curfragnum=0;curfragnumnr_frags;curfragnum++){ -+ ++ + if((curfragnum+1)==pattrib->nr_frags){ //4 the last fragment + length=pattrib->last_txcmdsz-pattrib->hdrlen-pattrib->iv_len- pattrib->icv_len; -+ ++ + aes_cipher(prwskey,pattrib->hdrlen,pframe, length); + } + else{ + length=pxmitpriv->frag_len-pattrib->hdrlen-pattrib->iv_len-pattrib->icv_len ; -+ ++ + aes_cipher(prwskey,pattrib->hdrlen,pframe, length); + pframe+=pxmitpriv->frag_len; + pframe=(u8*)RND4((SIZE_PTR)(pframe)); @@ -68891,20 +48005,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + } + } + -+ AES_SW_ENC_CNT_INC(psecuritypriv, pattrib->ra); ++ + } +/* + else{ + RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_aes_encrypt: stainfo==NULL!!!\n")); -+ DBG_871X("%s, psta==NUL\n", __func__); ++ DBG_871X("%s, psta==NUL\n", __func__); + res=_FAIL; + } +*/ ++ + } + + + -+_func_exit_; ++ + return res; +} + @@ -68931,7 +48046,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +// uint offset = 0; + uint frtype = GetFrameType(pframe); + uint frsubtype = GetFrameSubType(pframe); -+_func_enter_; ++ + frsubtype=frsubtype>>4; + + @@ -68945,7 +48060,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + + //start to decrypt the payload + -+ num_blocks = (plen-8) / 16; //(plen including LLC, payload_length and mic ) ++ num_blocks = (plen-8) / 16; //(plen including llc, payload_length and mic ) + + payload_remainder = (plen-8) % 16; + @@ -68962,24 +48077,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + a4_exists = 1; + + if ( -+ ((frtype|frsubtype) == WIFI_DATA_CFACK) || -+ ((frtype|frsubtype) == WIFI_DATA_CFPOLL)|| -+ ((frtype|frsubtype) == WIFI_DATA_CFACKPOLL)) ++ (frtype == WIFI_DATA_CFACK) || ++ (frtype == WIFI_DATA_CFPOLL)|| ++ (frtype == WIFI_DATA_CFACKPOLL)) + { + qc_exists = 1; + if(hdrlen != WLAN_HDR_A3_QOS_LEN){ -+ ++ + hdrlen += 2; + } -+ }//only for data packet . add for CONFIG_IEEE80211W, none 11w also can use -+ else if ((frtype == WIFI_DATA) && -+ ((frsubtype == 0x08) || ++ } ++ else if ( ++ (frsubtype == 0x08) || + (frsubtype == 0x09)|| + (frsubtype == 0x0a)|| -+ (frsubtype == 0x0b))) ++ (frsubtype == 0x0b)) + { + if(hdrlen != WLAN_HDR_A3_QOS_LEN){ -+ ++ + hdrlen += 2; + } + qc_exists = 1; @@ -68991,7 +48106,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + // now, decrypt pframe with hdrlen offset and plen long + + payload_index = hdrlen + 8; // 8 is for extiv -+ ++ + for (i=0; i< num_blocks; i++) + { + construct_ctr_preload( @@ -69000,8 +48115,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + qc_exists, + pframe, + pn_vector, -+ i+1, -+ frtype // add for CONFIG_IEEE80211W, none 11w also can use ++ i+1 + ); + + aes128k128d(key, ctr_preload, aes_out); @@ -69018,8 +48132,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + qc_exists, + pframe, + pn_vector, -+ num_blocks+1, -+ frtype // add for CONFIG_IEEE80211W, none 11w also can use ++ num_blocks+1 + ); + + for (j = 0; j < 16; j++) padded_buffer[j] = 0x00; @@ -69032,7 +48145,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + for (j=0; ju.hdr.attrib; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; ++ struct security_priv *psecuritypriv=&padapter->securitypriv; +// struct recv_priv *precvpriv=&padapter->recvpriv; + u32 res=_SUCCESS; -+_func_enter_; ++ + pframe=(unsigned char *)((union recv_frame*)precvframe)->u.hdr.rx_data; + //4 start to encrypt each fragment + if((prxattrib->encrypt==_AES_)){ @@ -69214,45 +48319,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + + if(IS_MCAST(prxattrib->ra)) + { -+ static u32 start = 0; -+ static u32 no_gkey_bc_cnt = 0; -+ static u32 no_gkey_mc_cnt = 0; -+ ++ //in concurrent we should use sw descrypt in group key, so we remove this message + //DBG_871X("rx bc/mc packets, to perform sw rtw_aes_decrypt\n"); + //prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; -+ if(psecuritypriv->binstallGrpkey==_FALSE) ++ if(psecuritypriv->binstallGrpkey==false) + { + res=_FAIL; -+ -+ if (start == 0) -+ start = rtw_get_current_time(); -+ -+ if (is_broadcast_mac_addr(prxattrib->ra)) -+ no_gkey_bc_cnt++; -+ else -+ no_gkey_mc_cnt++; -+ -+ if (rtw_get_passing_time_ms(start) > 1000) { -+ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", -+ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); -+ } -+ start = rtw_get_current_time(); -+ no_gkey_bc_cnt = 0; -+ no_gkey_mc_cnt = 0; -+ } -+ ++ DBG_8192C("%s:rx bc/mc packets,but didn't install group key!!!!!!!!!!\n",__FUNCTION__); + goto exit; + } -+ -+ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" gkey installed. no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", -+ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); -+ } -+ start = 0; -+ no_gkey_bc_cnt = 0; -+ no_gkey_mc_cnt = 0; -+ + prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; + if(psecuritypriv->dot118021XGrpKeyid != prxattrib->key_index) + { @@ -69266,148 +48341,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + { + prwskey=&stainfo->dot118021x_UncstKey.skey[0]; + } -+ ++ + length= ((union recv_frame *)precvframe)->u.hdr.len-prxattrib->hdrlen-prxattrib->iv_len; -+ /*// add for CONFIG_IEEE80211W, debug -+ if(0) -+ printk("@@@@@@@@@@@@@@@@@@ length=%d, prxattrib->hdrlen=%d, prxattrib->pkt_len=%d \n" -+ , length, prxattrib->hdrlen, prxattrib->pkt_len); -+ if(0) -+ { -+ int no; -+ //test print PSK -+ printk("PSK key below:\n"); -+ for(no=0;no<16;no++) -+ printk(" %02x ", prwskey[no]); -+ printk("\n"); -+ } -+ if(0) -+ { -+ int no; -+ //test print PSK -+ printk("frame:\n"); -+ for(no=0;nopkt_len;no++) -+ printk(" %02x ", pframe[no]); -+ printk("\n"); -+ }*/ + + res= aes_decipher(prwskey,prxattrib->hdrlen,pframe, length); + -+ AES_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); ++ + } + else{ -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_aes_decrypt: stainfo==NULL!!!\n")); ++ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_aes_encrypt: stainfo==NULL!!!\n")); + res=_FAIL; + } -+ ++ + } -+_func_exit_; ++ +exit: + return res; +} -+ -+#ifdef CONFIG_IEEE80211W -+u32 rtw_BIP_verify(_adapter *padapter, u8 *precvframe) -+{ -+ struct rx_pkt_attrib *pattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; -+ u8 *pframe; -+ u8 *BIP_AAD, *p; -+ u32 res=_FAIL; -+ uint len, ori_len; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u8 mic[16]; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ ori_len = pattrib->pkt_len-WLAN_HDR_A3_LEN+BIP_AAD_SIZE; -+ BIP_AAD = rtw_zmalloc(ori_len); -+ -+ if(BIP_AAD == NULL) -+ { -+ DBG_871X("BIP AAD allocate fail\n"); -+ return _FAIL; -+ } -+ //PKT start -+ pframe=(unsigned char *)((union recv_frame*)precvframe)->u.hdr.rx_data; -+ //mapping to wlan header -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ //save the frame body + MME -+ _rtw_memcpy(BIP_AAD+BIP_AAD_SIZE, pframe+WLAN_HDR_A3_LEN, pattrib->pkt_len-WLAN_HDR_A3_LEN); -+ //find MME IE pointer -+ p = rtw_get_ie(BIP_AAD+BIP_AAD_SIZE, _MME_IE_, &len, pattrib->pkt_len-WLAN_HDR_A3_LEN); -+ //Baron -+ if(p) -+ { -+ u16 keyid=0; -+ u64 temp_ipn=0; -+ //save packet number -+ _rtw_memcpy(&temp_ipn, p+4, 6); -+ temp_ipn = le64_to_cpu(temp_ipn); -+ //BIP packet number should bigger than previous BIP packet -+ if (temp_ipn < pmlmeext->mgnt_80211w_IPN_rx) { -+ DBG_871X("replay BIP packet\n"); -+ goto BIP_exit; -+ } -+ //copy key index -+ _rtw_memcpy(&keyid, p+2, 2); -+ keyid = le16_to_cpu(keyid); -+ if(keyid != padapter->securitypriv.dot11wBIPKeyid) -+ { -+ DBG_871X("BIP key index error!\n"); -+ goto BIP_exit; -+ } -+ //clear the MIC field of MME to zero -+ _rtw_memset(p+2+len-8, 0, 8); -+ -+ //conscruct AAD, copy frame control field -+ _rtw_memcpy(BIP_AAD, &pwlanhdr->frame_ctl, 2); -+ ClearRetry(BIP_AAD); -+ ClearPwrMgt(BIP_AAD); -+ ClearMData(BIP_AAD); -+ //conscruct AAD, copy address 1 to address 3 -+ _rtw_memcpy(BIP_AAD+2, pwlanhdr->addr1, 18); -+ -+ if(omac1_aes_128(padapter->securitypriv.dot11wBIPKey[padapter->securitypriv.dot11wBIPKeyid].skey -+ , BIP_AAD, ori_len, mic)) -+ goto BIP_exit; -+ -+ /*//management packet content -+ { -+ int pp; -+ DBG_871X("pkt: "); -+ for(pp=0;pp< pattrib->pkt_len; pp++) -+ printk(" %02x ", pframe[pp]); -+ DBG_871X("\n"); -+ //BIP AAD + management frame body + MME(MIC is zero) -+ DBG_871X("AAD+PKT: "); -+ for(pp=0;pp< ori_len; pp++) -+ DBG_871X(" %02x ", BIP_AAD[pp]); -+ DBG_871X("\n"); -+ //show the MIC result -+ DBG_871X("mic: "); -+ for(pp=0;pp<16; pp++) -+ DBG_871X(" %02x ", mic[pp]); -+ DBG_871X("\n"); -+ } -+ */ -+ //MIC field should be last 8 bytes of packet (packet without FCS) -+ if(_rtw_memcmp(mic, pframe+pattrib->pkt_len-8, 8)) -+ { -+ pmlmeext->mgnt_80211w_IPN_rx = temp_ipn; -+ res=_SUCCESS; -+ } -+ else -+ DBG_871X("BIP MIC error!\n"); -+ -+ } -+ else -+ res = RTW_RX_HANDLED; -+BIP_exit: -+ -+ rtw_mfree(BIP_AAD, ori_len); -+ return res; -+} -+#endif //CONFIG_IEEE80211W -+ -+#ifndef PLATFORM_FREEBSD +/* compress 512-bits */ +static int sha256_compress(struct sha256_state *md, unsigned char *buf) +{ @@ -69428,7 +48378,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + for (i = 16; i < 64; i++) { + W[i] = Gamma1(W[i - 2]) + W[i - 7] + Gamma0(W[i - 15]) + + W[i - 16]; -+ } ++ } + + /* Compress */ +#define RND(a,b,c,d,e,f,g,h,i) \ @@ -69439,7 +48389,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + + for (i = 0; i < 64; ++i) { + RND(S[0], S[1], S[2], S[3], S[4], S[5], S[6], S[7], i); -+ t = S[7]; S[7] = S[6]; S[6] = S[5]; S[5] = S[4]; ++ t = S[7]; S[7] = S[6]; S[6] = S[5]; S[5] = S[4]; + S[4] = S[3]; S[3] = S[2]; S[2] = S[1]; S[1] = S[0]; S[0] = t; + } + @@ -69673,7 +48623,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + _len[1] = 32; + sha256_vector(2, _addr, _len, mac); +} -+#endif //PLATFORM_FREEBSD ++ +/** + * sha256_prf - SHA256-based Pseudo-Random Function (IEEE 802.11r, 8.5.1.5.2) + * @key: Key for PRF @@ -69687,7 +48637,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + * This function is used to derive new, cryptographically separate keys from a + * given key. + */ -+#ifndef PLATFORM_FREEBSD //Baron +static void sha256_prf(u8 *key, size_t key_len, char *label, + u8 *data, size_t data_len, u8 *buf, size_t buf_len) +{ @@ -69724,7 +48673,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + counter++; + } +} -+#endif //PLATFORM_FREEBSD Baron + +/* AES tables*/ +const u32 Te0[256] = { @@ -69903,7 +48851,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + * + * @return the number of rounds for the given cipher key size. + */ -+#ifndef PLATFORM_FREEBSD //Baron +static void rijndaelKeySetupEnc(u32 rk[/*44*/], const u8 cipherKey[]) +{ + int i; @@ -70028,7 +48975,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + rtw_mfree(ctx, AES_PRIV_SIZE); +} + -+ +/** + * omac1_aes_128_vector - One-Key CBC MAC (OMAC1) hash with AES-128 + * @key: 128-bit key for the hash operation @@ -70102,7 +49048,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + return 0; +} + -+ +/** + * omac1_aes_128 - One-Key CBC MAC (OMAC1) hash with AES-128 (aka AES-CMAC) + * @key: 128-bit key for the hash operation @@ -70114,17 +49059,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + * This is a mode for using block cipher (AES in this case) for authentication. + * OMAC1 was standardized with the name CMAC by NIST in a Special Publication + * (SP) 800-38B. -+ */ //modify for CONFIG_IEEE80211W -+int omac1_aes_128(u8 *key, u8 *data, size_t data_len, u8 *mac) ++ */ ++static int omac1_aes_128(u8 *key, u8 *data, size_t data_len, u8 *mac) +{ + return omac1_aes_128_vector(key, 1, &data, &data_len, mac); +} -+#endif //PLATFORM_FREEBSD Baron + +#ifdef CONFIG_TDLS -+void wpa_tdls_generate_tpk(_adapter *padapter, PVOID sta) ++void wpa_tdls_generate_tpk(_adapter *padapter, struct sta_info *psta) +{ -+ struct sta_info *psta = (struct sta_info *)sta; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + u8 *SNonce = psta->SNonce; + u8 *ANonce = psta->ANonce; @@ -70157,16 +49100,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + * added by the KDF anyway.. + */ + -+ if (os_memcmp(adapter_mac_addr(padapter), psta->hwaddr, ETH_ALEN) < 0) { -+ _rtw_memcpy(data, adapter_mac_addr(padapter), ETH_ALEN); ++ if (os_memcmp(myid(&(padapter->eeprompriv)), psta->hwaddr, ETH_ALEN) < 0) { ++ _rtw_memcpy(data, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(data + ETH_ALEN, psta->hwaddr, ETH_ALEN); + } else { + _rtw_memcpy(data, psta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(data + ETH_ALEN, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(data + ETH_ALEN, myid(&(padapter->eeprompriv)), ETH_ALEN); + } + _rtw_memcpy(data + 2 * ETH_ALEN, get_bssid(pmlmepriv), ETH_ALEN); + -+ sha256_prf(key_input, SHA256_MAC_LEN, "TDLS PMK", data, sizeof(data), (u8 *) &psta->tpk, sizeof(psta->tpk)); ++ sha256_prf(key_input, SHA256_MAC_LEN, "TDLS PMK", data, sizeof(data), (u8 *) &psta->tpk, sizeof(psta->tpk)); + + +} @@ -70182,7 +49125,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + * + * Calculate MIC for TDLS frame. + */ -+int wpa_tdls_ftie_mic(u8 *kck, u8 trans_seq, ++int wpa_tdls_ftie_mic(u8 *kck, u8 trans_seq, + u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie, + u8 *mic) +{ @@ -70222,55 +49165,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + _ftie = (struct wpa_tdls_ftie *) pos; + _rtw_memset(_ftie->mic, 0, TDLS_MIC_LEN); + pos += 2 + ftie[1]; -+ -+ ret = omac1_aes_128(kck, buf, pos - buf, mic); -+ rtw_mfree(buf, len); -+ return ret; -+ -+} -+ -+/** -+ * wpa_tdls_teardown_ftie_mic - Calculate TDLS TEARDOWN FTIE MIC -+ * @kck: TPK-KCK -+ * @lnkid: Pointer to the beginning of Link Identifier IE -+ * @reason: Reason code of TDLS Teardown -+ * @dialog_token: Dialog token that was used in the MIC calculation for TPK Handshake Message 3 -+ * @trans_seq: Transaction Sequence number (1 octet) which shall be set to the value 4 -+ * @ftie: Pointer to the beginning of FT IE -+ * @mic: Pointer for writing MIC -+ * -+ * Calculate MIC for TDLS TEARDOWN frame according to Section 10.22.5 in IEEE 802.11 - 2012. -+ */ -+int wpa_tdls_teardown_ftie_mic(u8 *kck, u8 *lnkid, u16 reason, -+ u8 dialog_token, u8 trans_seq, u8 *ftie, u8 *mic) -+{ -+ u8 *buf, *pos; -+ struct wpa_tdls_ftie *_ftie; -+ int ret; -+ int len = 2 + lnkid[1] + 2 + 1 + 1 + 2 + ftie[1]; -+ -+ buf = rtw_zmalloc(len); -+ if (!buf) { -+ DBG_871X("TDLS: No memory for MIC calculation\n"); -+ return -1; -+ } -+ -+ pos = buf; -+ /* 1) Link Identifier IE */ -+ _rtw_memcpy(pos, lnkid, 2 + lnkid[1]); -+ pos += 2 + lnkid[1]; -+ /* 2) Reason Code */ -+ _rtw_memcpy(pos, (u8 *)&reason, 2); -+ pos += 2; -+ /* 3) Dialog Token */ -+ *pos++ = dialog_token; -+ /* 4) Transaction Sequence number */ -+ *pos++ = trans_seq; -+ /* 5) FTIE, with the MIC field of the FTIE set to 0 */ -+ _rtw_memcpy(pos, ftie, 2 + ftie[1]); -+ _ftie = (struct wpa_tdls_ftie *) pos; -+ _rtw_memset(_ftie->mic, 0, TDLS_MIC_LEN); -+ pos += 2 + ftie[1]; + + ret = omac1_aes_128(kck, buf, pos - buf, mic); + rtw_mfree(buf, len); @@ -70289,14 +49183,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + + if (lnkid == NULL || rsnie == NULL || + timeoutie == NULL || ftie == NULL){ -+ return _FAIL; ++ return 0; + } -+ ++ + len = 2 * ETH_ALEN + 1 + 2 + 18 + 2 + *(rsnie+1) + 2 + *(timeoutie+1) + 2 + *(ftie+1); + + buf = rtw_zmalloc(len); + if (buf == NULL) -+ return _FAIL; ++ return 0; + + pos = buf; + /* 1) TDLS initiator STA MAC address */ @@ -70326,17 +49220,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 + ret = omac1_aes_128(kck, buf, pos - buf, mic); + rtw_mfree(buf, len); + if (ret) -+ return _FAIL; ++ return 0; + rx_ftie = ftie+4; + + if (os_memcmp(mic, rx_ftie, 16) == 0) { + //Valid MIC -+ return _SUCCESS; ++ return 1; + } + + //Invalid MIC + DBG_871X( "[%s] Invalid MIC\n", __FUNCTION__); -+ return _FAIL; ++ return 0; + +} +#endif //CONFIG_TDLS @@ -70345,510 +49239,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_security.c linux/3rdparty/rtl88 +{ + _adapter *padapter = (_adapter *)FunctionContext; + -+_func_enter_; ++ + + RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("^^^rtw_use_tkipkey_handler ^^^\n")); -+ ++ +/* -+ if (RTW_CANNOT_RUN(padapter)) { -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("^^^rtw_use_tkipkey_handler (padapter->bDriverStopped %s)(padapter->bSurpriseRemoved %s)^^^\n" -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False")); ++ if(padapter->bDriverStopped ||padapter->bSurpriseRemoved){ ++ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("^^^rtw_use_tkipkey_handler (padapter->bDriverStopped %d)(padapter->bSurpriseRemoved %d)^^^\n",padapter->bDriverStopped,padapter->bSurpriseRemoved)); + + return; + } + */ -+ -+ padapter->securitypriv.busetkipkey=_TRUE; ++ ++ padapter->securitypriv.busetkipkey=true; + + RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("^^^rtw_use_tkipkey_handler padapter->securitypriv.busetkipkey=%d^^^\n",padapter->securitypriv.busetkipkey)); + -+_func_exit_; ++ + +} -+ -+/* Restore HW wep key setting according to key_mask */ -+void rtw_sec_restore_wep_key(_adapter *adapter) -+{ -+ struct security_priv* securitypriv=&(adapter->securitypriv); -+ sint keyid; -+ -+ if((_WEP40_ == securitypriv->dot11PrivacyAlgrthm) ||(_WEP104_ == securitypriv->dot11PrivacyAlgrthm)) { -+ for(keyid=0;keyid<4;keyid++){ -+ if(securitypriv->key_mask & BIT(keyid)){ -+ if(keyid == securitypriv->dot11PrivacyKeyIndex) -+ rtw_set_key(adapter,securitypriv, keyid, 1, _FALSE); -+ else -+ rtw_set_key(adapter,securitypriv, keyid, 0, _FALSE); -+ } -+ } -+ } -+} -+ -+u8 rtw_handle_tkip_countermeasure(_adapter* adapter, const char *caller) -+{ -+ struct security_priv* securitypriv=&(adapter->securitypriv); -+ u8 status = _SUCCESS; -+ -+ if (securitypriv->btkip_countermeasure == _TRUE) { -+ u32 passing_ms = rtw_get_passing_time_ms(securitypriv->btkip_countermeasure_time); -+ if (passing_ms > 60*1000) { -+ DBG_871X_LEVEL(_drv_always_, "%s("ADPT_FMT") countermeasure time:%ds > 60s \n", -+ caller, ADPT_ARG(adapter), passing_ms/1000); -+ securitypriv->btkip_countermeasure = _FALSE; -+ securitypriv->btkip_countermeasure_time = 0; -+ } else { -+ DBG_871X_LEVEL(_drv_always_, "%s("ADPT_FMT") countermeasure time:%ds < 60s \n", -+ caller, ADPT_ARG(adapter), passing_ms/1000); -+ status = _FAIL; -+ } -+ } -+ -+ return status; -+} -+ -+#ifdef CONFIG_WOWLAN -+u16 rtw_cal_crc16(u8 data, u16 crc) -+{ -+ u8 shift_in, data_bit; -+ u8 crc_bit4, crc_bit11, crc_bit15; -+ u16 crc_result; -+ int index; -+ -+ for (index = 0; index < 8; index++) { -+ crc_bit15 = ((crc & BIT15) ? 1 : 0); -+ data_bit = (data & (BIT0 << index) ? 1 : 0); -+ shift_in = crc_bit15 ^ data_bit; -+ /*printf("crc_bit15=%d, DataBit=%d, shift_in=%d\n", -+ * crc_bit15, data_bit, shift_in);*/ -+ -+ crc_result = crc << 1; -+ -+ if (shift_in == 0) -+ crc_result &= (~BIT0); -+ else -+ crc_result |= BIT0; -+ /*printf("CRC =%x\n",CRC_Result);*/ -+ -+ crc_bit11 = ((crc & BIT11) ? 1 : 0) ^ shift_in; -+ -+ if (crc_bit11 == 0) -+ crc_result &= (~BIT12); -+ else -+ crc_result |= BIT12; -+ -+ /*printf("bit12 CRC =%x\n",CRC_Result);*/ -+ -+ crc_bit4 = ((crc & BIT4) ? 1 : 0) ^ shift_in; -+ -+ if (crc_bit4 == 0) -+ crc_result &= (~BIT5); -+ else -+ crc_result |= BIT5; -+ -+ /* printf("bit5 CRC =%x\n",CRC_Result); */ -+ /* repeat using the last result*/ -+ crc = crc_result; -+ } -+ return crc; -+} -+ -+/* -+ * function name :rtw_calc_crc -+ * -+ * input: char* pattern , pattern size -+ * -+ */ -+u16 rtw_calc_crc(u8 *pdata, int length) -+{ -+ u16 crc = 0xffff; -+ int i; -+ -+ for (i = 0; i < length; i++) -+ crc = rtw_cal_crc16(pdata[i], crc); -+ /* get 1' complement */ -+ crc = ~crc; -+ -+ return crc; -+} -+#endif /*CONFIG_WOWLAN*/ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sreset.c linux/3rdparty/rtl8812au/core/rtw_sreset.c ---- linux.old/3rdparty/rtl8812au/core/rtw_sreset.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_sreset.c 2017-06-07 23:07:21.005687029 +0300 -@@ -0,0 +1,365 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+#include -+ -+void sreset_init_value(_adapter *padapter) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ _rtw_mutex_init(&psrtpriv->silentreset_mutex); -+ psrtpriv->silent_reset_inprogress = _FALSE; -+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; -+ psrtpriv->last_tx_time =0; -+ psrtpriv->last_tx_complete_time =0; -+#endif -+} -+void sreset_reset_value(_adapter *padapter) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; -+ psrtpriv->last_tx_time =0; -+ psrtpriv->last_tx_complete_time =0; -+#endif -+} -+ -+u8 sreset_get_wifi_status(_adapter *padapter) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ u8 status = WIFI_STATUS_SUCCESS; -+ u32 val32 = 0; -+ _irqL irqL; -+ if(psrtpriv->silent_reset_inprogress == _TRUE) -+ { -+ return status; -+ } -+ val32 =rtw_read32(padapter,REG_TXDMA_STATUS); -+ if(val32==0xeaeaeaea){ -+ psrtpriv->Wifi_Error_Status = WIFI_IF_NOT_EXIST; -+ } -+ else if(val32!=0){ -+ DBG_8192C("txdmastatu(%x)\n",val32); -+ psrtpriv->Wifi_Error_Status = WIFI_MAC_TXDMA_ERROR; -+ } -+ -+ if(WIFI_STATUS_SUCCESS !=psrtpriv->Wifi_Error_Status) -+ { -+ DBG_8192C("==>%s error_status(0x%x) \n",__FUNCTION__,psrtpriv->Wifi_Error_Status); -+ status = (psrtpriv->Wifi_Error_Status &( ~(USB_READ_PORT_FAIL|USB_WRITE_PORT_FAIL))); -+ } -+ DBG_8192C("==> %s wifi_status(0x%x)\n",__FUNCTION__,status); -+ -+ //status restore -+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; -+ -+ return status; -+#else -+ return WIFI_STATUS_SUCCESS; -+#endif -+} -+ -+void sreset_set_wifi_error_status(_adapter *padapter, u32 status) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.Wifi_Error_Status = status; -+#endif -+} -+ -+void sreset_set_trigger_point(_adapter *padapter, s32 tgp) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.dbg_trigger_point = tgp; -+#endif -+} -+ -+bool sreset_inprogress(_adapter *padapter) -+{ -+#if defined(DBG_CONFIG_ERROR_RESET) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ return pHalData->srestpriv.silent_reset_inprogress; -+#else -+ return _FALSE; -+#endif -+} -+ -+void sreset_restore_security_station(_adapter *padapter) -+{ -+ u8 EntryId = 0; -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct sta_priv * pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ struct mlme_ext_info *pmlmeinfo = &padapter->mlmeextpriv.mlmext_info; -+ -+ { -+ u8 val8; -+ -+ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_8021X) { -+ val8 = 0xcc; -+ #ifdef CONFIG_WAPI_SUPPORT -+ } else if (padapter->wapiInfo.bWapiEnable && pmlmeinfo->auth_algo == dot11AuthAlgrthm_WAPI) { -+ //Disable TxUseDefaultKey, RxUseDefaultKey, RxBroadcastUseDefaultKey. -+ val8 = 0x4c; -+ #endif -+ } else { -+ val8 = 0xcf; -+ } -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ } -+ -+ #if 0 -+ if ( ( padapter->securitypriv.dot11PrivacyAlgrthm == _WEP40_ ) || -+ ( padapter->securitypriv.dot11PrivacyAlgrthm == _WEP104_ )) -+ { -+ -+ for(EntryId=0; EntryId<4; EntryId++) -+ { -+ if(EntryId == psecuritypriv->dot11PrivacyKeyIndex) -+ rtw_set_key(padapter,&padapter->securitypriv, EntryId, 1,_FALSE); -+ else -+ rtw_set_key(padapter,&padapter->securitypriv, EntryId, 0,_FALSE); -+ } -+ -+ } -+ else -+ #endif -+ if((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) -+ { -+ psta = rtw_get_stainfo(pstapriv, get_bssid(mlmepriv)); -+ if (psta == NULL) { -+ //DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail \n")); -+ } -+ else -+ { -+ //pairwise key -+ rtw_setstakey_cmd(padapter, psta, UNICAST_KEY,_FALSE); -+ //group key -+ rtw_set_key(padapter,&padapter->securitypriv,padapter->securitypriv.dot118021XGrpKeyid, 0,_FALSE); -+ } -+ } -+} -+ -+void sreset_restore_network_station(_adapter *padapter) -+{ -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ #if 0 -+ { -+ //======================================================= -+ // reset related register of Beacon control -+ -+ //set MSR to nolink -+ Set_MSR(padapter, _HW_STATE_NOLINK_); -+ // reject all data frame -+ rtw_write16(padapter, REG_RXFLTMAP2,0x00); -+ //reset TSF -+ rtw_write8(padapter, REG_DUAL_TSF_RST, (BIT(0)|BIT(1))); -+ -+ // disable update TSF -+ SetBcnCtrlReg(padapter, BIT(4), 0); -+ -+ //======================================================= -+ } -+ #endif -+ -+ rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure,_FALSE); -+ -+ { -+ u8 threshold; -+ #ifdef CONFIG_USB_HCI -+ // TH=1 => means that invalidate usb rx aggregation -+ // TH=0 => means that validate usb rx aggregation, use init value. -+ if(mlmepriv->htpriv.ht_option) { -+ if(padapter->registrypriv.wifi_spec==1) -+ threshold = 1; -+ else -+ threshold = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); -+ } else { -+ threshold = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); -+ } -+ #endif -+ } -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, NULL); -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ //disable dynamic functions, such as high power, DIG -+ /*rtw_phydm_func_disable_all(padapter);*/ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress); -+ -+ { -+ u8 join_type = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ } -+ -+ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); -+ -+ mlmeext_joinbss_event_callback(padapter, 1); -+ //restore Sequence No. -+ rtw_hal_set_hwreg(padapter, HW_VAR_RESTORE_HW_SEQ, 0); -+ -+ sreset_restore_security_station(padapter); -+} -+ -+ -+void sreset_restore_network_status(_adapter *padapter) -+{ -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (check_fwstate(mlmepriv, WIFI_STATION_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); -+ sreset_restore_network_station(padapter); -+ } else if (check_fwstate(mlmepriv, WIFI_AP_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); -+ rtw_ap_restore_network(padapter); -+ } else if (check_fwstate(mlmepriv, WIFI_ADHOC_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); -+ } else { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); -+ } -+} -+ -+void sreset_stop_adapter(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ if (padapter == NULL) -+ return; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ rtw_netif_stop_queue(padapter->pnetdev); -+ -+ rtw_cancel_all_timer(padapter); -+ -+ /* TODO: OS and HCI independent */ -+ #if defined(PLATFORM_LINUX) && defined(CONFIG_USB_HCI) -+ tasklet_kill(&pxmitpriv->xmit_tasklet); -+ #endif -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) -+ rtw_scan_abort(padapter); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) -+ { -+ rtw_set_to_roam(padapter, 0); -+ _rtw_join_timeout_handler(padapter); -+ } -+ -+} -+ -+void sreset_start_adapter(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ if (padapter == NULL) -+ return; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) { -+ sreset_restore_network_status(padapter); -+ } -+ -+ /* TODO: OS and HCI independent */ -+ #if defined(PLATFORM_LINUX) && defined(CONFIG_USB_HCI) -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+ #endif -+ -+ if (is_primary_adapter(padapter)) -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); -+ -+ rtw_netif_wake_queue(padapter->pnetdev); -+} -+ -+void sreset_reset(_adapter *padapter) -+{ -+#ifdef DBG_CONFIG_ERROR_RESET -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ _irqL irqL; -+ u32 start = rtw_get_current_time(); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; -+ -+ -+#ifdef CONFIG_LPS -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "SRESET"); -+#endif//#ifdef CONFIG_LPS -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ -+ psrtpriv->silent_reset_inprogress = _TRUE; -+ pwrpriv->change_rfpwrstate = rf_off; -+ -+ sreset_stop_adapter(padapter); -+ #ifdef CONFIG_CONCURRENT_MODE -+ sreset_stop_adapter(padapter->pbuddy_adapter); -+ #endif -+ -+ #ifdef CONFIG_IPS -+ _ips_enter(padapter); -+ _ips_leave(padapter); -+ #endif -+ -+ sreset_start_adapter(padapter); -+ #ifdef CONFIG_CONCURRENT_MODE -+ sreset_start_adapter(padapter->pbuddy_adapter); -+ #endif -+ -+ psrtpriv->silent_reset_inprogress = _FALSE; -+ -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ DBG_871X("%s done in %d ms\n", __FUNCTION__, rtw_get_passing_time_ms(start)); -+ pdbgpriv->dbg_sreset_cnt++; -+#endif -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl8812au/core/rtw_sta_mgt.c ---- linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_sta_mgt.c 2017-06-07 23:07:21.005687029 +0300 -@@ -0,0 +1,882 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_sreset.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_sreset.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_sreset.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_sreset.c 2018-02-06 17:42:30.699967001 +0200 +@@ -0,0 +1,340 @@ +/****************************************************************************** + * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -70858,57 +49275,382 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++ ++#include ++#include ++#include ++ ++void sreset_init_value(_adapter *padapter) ++{ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++ ++ _rtw_mutex_init(&psrtpriv->silentreset_mutex); ++ psrtpriv->silent_reset_inprogress = false; ++ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; ++ psrtpriv->last_tx_time =0; ++ psrtpriv->last_tx_complete_time =0; ++#endif ++} ++void sreset_reset_value(_adapter *padapter) ++{ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++ ++ psrtpriv->silent_reset_inprogress = false; ++ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; ++ psrtpriv->last_tx_time =0; ++ psrtpriv->last_tx_complete_time =0; ++#endif ++} ++ ++u8 sreset_get_wifi_status(_adapter *padapter) ++{ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++ ++ u8 status = WIFI_STATUS_SUCCESS; ++ u32 val32 = 0; ++ _irqL irqL; ++ if(psrtpriv->silent_reset_inprogress == true) ++ { ++ return status; ++ } ++ val32 =rtw_read32(padapter,REG_TXDMA_STATUS); ++ if(val32==0xeaeaeaea){ ++ psrtpriv->Wifi_Error_Status = WIFI_IF_NOT_EXIST; ++ } ++ else if(val32!=0){ ++ DBG_8192C("txdmastatu(%x)\n",val32); ++ psrtpriv->Wifi_Error_Status = WIFI_MAC_TXDMA_ERROR; ++ } ++ ++ if(WIFI_STATUS_SUCCESS !=psrtpriv->Wifi_Error_Status) ++ { ++ DBG_8192C("==>%s error_status(0x%x) \n",__FUNCTION__,psrtpriv->Wifi_Error_Status); ++ status = (psrtpriv->Wifi_Error_Status &( ~(USB_READ_PORT_FAIL|USB_WRITE_PORT_FAIL))); ++ } ++ DBG_8192C("==> %s wifi_status(0x%x)\n",__FUNCTION__,status); ++ ++ //status restore ++ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; ++ ++ return status; ++#else ++ return WIFI_STATUS_SUCCESS; ++#endif ++} ++ ++void sreset_set_wifi_error_status(_adapter *padapter, u32 status) ++{ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ pHalData->srestpriv.Wifi_Error_Status = status; ++#endif ++} ++ ++void sreset_set_trigger_point(_adapter *padapter, s32 tgp) ++{ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ pHalData->srestpriv.dbg_trigger_point = tgp; ++#endif ++} ++ ++bool sreset_inprogress(_adapter *padapter) ++{ ++#if defined(DBG_CONFIG_ERROR_RESET) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ return pHalData->srestpriv.silent_reset_inprogress; ++#else ++ return false; ++#endif ++} ++ ++void sreset_restore_security_station(_adapter *padapter) ++{ ++ u8 EntryId = 0; ++ struct mlme_priv *mlmepriv = &padapter->mlmepriv; ++ struct sta_priv * pstapriv = &padapter->stapriv; ++ struct sta_info *psta; ++ struct security_priv* psecuritypriv=&(padapter->securitypriv); ++ struct mlme_ext_info *pmlmeinfo = &padapter->mlmeextpriv.mlmext_info; ++ ++ { ++ u8 val8; ++ ++ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_8021X) { ++ val8 = 0xcc; ++ #ifdef CONFIG_WAPI_SUPPORT ++ } else if (padapter->wapiInfo.bWapiEnable && pmlmeinfo->auth_algo == dot11AuthAlgrthm_WAPI) { ++ //Disable TxUseDefaultKey, RxUseDefaultKey, RxBroadcastUseDefaultKey. ++ val8 = 0x4c; ++ #endif ++ } else { ++ val8 = 0xcf; ++ } ++ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); ++ } ++ ++ #if 0 ++ if ( ( padapter->securitypriv.dot11PrivacyAlgrthm == _WEP40_ ) || ++ ( padapter->securitypriv.dot11PrivacyAlgrthm == _WEP104_ )) ++ { ++ ++ for(EntryId=0; EntryId<4; EntryId++) ++ { ++ if(EntryId == psecuritypriv->dot11PrivacyKeyIndex) ++ rtw_set_key(padapter,&padapter->securitypriv, EntryId, 1); ++ else ++ rtw_set_key(padapter,&padapter->securitypriv, EntryId, 0); ++ } ++ ++ } ++ else ++ #endif ++ if((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || ++ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) ++ { ++ psta = rtw_get_stainfo(pstapriv, get_bssid(mlmepriv)); ++ if (psta == NULL) { ++ //DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail \n")); ++ } ++ else ++ { ++ //pairwise key ++ rtw_setstakey_cmd(padapter, (unsigned char *)psta, true); ++ //group key ++ rtw_set_key(padapter,&padapter->securitypriv,padapter->securitypriv.dot118021XGrpKeyid, 0); ++ } ++ } ++} ++ ++void sreset_restore_network_station(_adapter *padapter) ++{ ++ struct mlme_priv *mlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ #if 0 ++ { ++ //======================================================= ++ // reset related register of Beacon control ++ ++ //set MSR to nolink ++ Set_MSR(padapter, _HW_STATE_NOLINK_); ++ // reject all data frame ++ rtw_write16(padapter, REG_RXFLTMAP2,0x00); ++ //reset TSF ++ rtw_write8(padapter, REG_DUAL_TSF_RST, (BIT(0)|BIT(1))); ++ ++ // disable update TSF ++ SetBcnCtrlReg(padapter, BIT(4), 0); ++ ++ //======================================================= ++ } ++ #endif ++ ++ rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure); ++ ++ { ++ u8 threshold; ++ // TH=1 => means that invalidate usb rx aggregation ++ // TH=0 => means that validate usb rx aggregation, use init value. ++ if(mlmepriv->htpriv.ht_option) { ++ if(padapter->registrypriv.wifi_spec==1) ++ threshold = 1; ++ else ++ threshold = 0; ++ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); ++ } else { ++ threshold = 1; ++ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); ++ } ++ } ++ ++ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); ++ ++ //disable dynamic functions, such as high power, DIG ++ //Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress); ++ ++ { ++ u8 join_type = 0; ++ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); ++ } ++ ++ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); ++ ++ mlmeext_joinbss_event_callback(padapter, 1); ++ //restore Sequence No. ++ rtw_write8(padapter,0x4dc,padapter->xmitpriv.nqos_ssn); ++ ++ sreset_restore_security_station(padapter); ++} ++ ++void sreset_restore_network_status(_adapter *padapter) ++{ ++ struct mlme_priv *mlmepriv = &padapter->mlmepriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if (check_fwstate(mlmepriv, WIFI_STATION_STATE)) { ++ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); ++ sreset_restore_network_station(padapter); ++ } else if (check_fwstate(mlmepriv, WIFI_AP_STATE)) { ++ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); ++ rtw_ap_restore_network(padapter); ++ } else if (check_fwstate(mlmepriv, WIFI_ADHOC_STATE)) { ++ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); ++ } else { ++ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); ++ } ++} ++ ++void sreset_stop_adapter(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ if (padapter == NULL) ++ return; ++ ++ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ ++ if (!rtw_netif_queue_stopped(padapter->pnetdev)) ++ rtw_netif_stop_queue(padapter->pnetdev); ++ ++ rtw_cancel_all_timer(padapter); ++ ++ /* TODO: OS and HCI independent */ ++ tasklet_kill(&pxmitpriv->xmit_tasklet); ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) ++ rtw_scan_abort(padapter); ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) ++ _rtw_join_timeout_handler(padapter); ++ ++} ++ ++void sreset_start_adapter(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ ++ if (padapter == NULL) ++ return; ++ ++ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED)) { ++ sreset_restore_network_status(padapter); ++ } ++ ++ /* TODO: OS and HCI independent */ ++ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); ++ ++ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); ++ ++ if (rtw_netif_queue_stopped(padapter->pnetdev)) ++ rtw_netif_wake_queue(padapter->pnetdev); ++ ++} ++ ++void sreset_reset(_adapter *padapter) ++{ ++#ifdef DBG_CONFIG_ERROR_RESET ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ _irqL irqL; ++ u32 start = rtw_get_current_time(); ++ ++ DBG_871X("%s\n", __FUNCTION__); ++ ++ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; ++ ++ _enter_critical_mutex(&psrtpriv->silentreset_mutex, &irqL); ++ psrtpriv->silent_reset_inprogress = true; ++ pwrpriv->change_rfpwrstate = rf_off; ++ ++ sreset_stop_adapter(padapter); ++ #ifdef CONFIG_CONCURRENT_MODE ++ sreset_stop_adapter(padapter->pbuddy_adapter); ++ #endif ++ ++ #ifdef CONFIG_IPS ++ ips_enter(padapter); ++ ips_leave(padapter); ++ #endif ++ ++ sreset_start_adapter(padapter); ++ #ifdef CONFIG_CONCURRENT_MODE ++ sreset_start_adapter(padapter->pbuddy_adapter); ++ #endif ++ ++ psrtpriv->silent_reset_inprogress = false; ++ _exit_critical_mutex(&psrtpriv->silentreset_mutex, &irqL); ++ ++ DBG_871X("%s done in %d ms\n", __FUNCTION__, rtw_get_passing_time_ms(start)); ++#endif ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_sta_mgt.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_sta_mgt.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_sta_mgt.c 2018-02-06 17:42:30.699967001 +0200 +@@ -0,0 +1,824 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#define _RTW_STA_MGT_C_ + +#include + -+#if defined (PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+ -+#error "Shall be Linux or Windows, but not both!\n" -+ -+#endif -+ -+ -+void _rtw_init_stainfo(struct sta_info *psta); +void _rtw_init_stainfo(struct sta_info *psta) +{ -+ -+_func_enter_; -+ + _rtw_memset((u8 *)psta, 0, sizeof (struct sta_info)); + + _rtw_spinlock_init(&psta->lock); + _rtw_init_listhead(&psta->list); + _rtw_init_listhead(&psta->hash_list); -+ //_rtw_init_listhead(&psta->asoc_list); -+ //_rtw_init_listhead(&psta->sleep_list); -+ //_rtw_init_listhead(&psta->wakeup_list); + + _rtw_init_queue(&psta->sleep_q); + psta->sleepq_len = 0; + + _rtw_init_sta_xmit_priv(&psta->sta_xmitpriv); + _rtw_init_sta_recv_priv(&psta->sta_recvpriv); -+ ++ +#ifdef CONFIG_AP_MODE + + _rtw_init_listhead(&psta->asoc_list); + + _rtw_init_listhead(&psta->auth_list); -+ ++ + psta->expire_to = 0; -+ ++ + psta->flags = 0; -+ ++ + psta->capability = 0; + -+ psta->bpairwise_key_installed = _FALSE; ++ psta->bpairwise_key_installed = false; + + +#ifdef CONFIG_NATIVEAP_MLME @@ -70918,18 +49660,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + psta->no_ht_gf_set = 0; + psta->no_ht_set = 0; + psta->ht_20mhz_set = 0; -+ psta->ht_40mhz_intolerant = 0; -+#endif ++#endif + +#ifdef CONFIG_TX_MCAST2UNI + psta->under_exist_checking = 0; +#endif // CONFIG_TX_MCAST2UNI -+ ++ + psta->keep_alive_trycnt = 0; + -+#endif // CONFIG_AP_MODE -+ -+_func_exit_; ++#endif // CONFIG_AP_MODE ++ ++ + +} + @@ -70938,20 +49679,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + struct sta_info *psta; + s32 i; + -+_func_enter_; ++ + + pstapriv->pallocated_stainfo_buf = rtw_zvmalloc (sizeof(struct sta_info) * NUM_STA+ 4); -+ ++ + if(!pstapriv->pallocated_stainfo_buf) + return _FAIL; + -+ pstapriv->pstainfo_buf = pstapriv->pallocated_stainfo_buf + 4 - ++ pstapriv->pstainfo_buf = pstapriv->pallocated_stainfo_buf + 4 - + ((SIZE_PTR)(pstapriv->pallocated_stainfo_buf ) & 3); + + _rtw_init_queue(&pstapriv->free_sta_queue); + + _rtw_spinlock_init(&pstapriv->sta_hash_lock); -+ ++ + //_rtw_init_queue(&pstapriv->asoc_q); + pstapriv->asoc_sta_count = 0; + _rtw_init_queue(&pstapriv->sleep_q); @@ -70959,7 +49700,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + + psta = (struct sta_info *)(pstapriv->pstainfo_buf); + -+ ++ + for(i = 0; i < NUM_STA; i++) + { + _rtw_init_stainfo(psta); @@ -70971,7 +49712,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + psta++; + } + -+ ++ + +#ifdef CONFIG_AP_MODE + @@ -70985,7 +49726,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + pstapriv->asoc_list_cnt = 0; + pstapriv->auth_list_cnt = 0; + -+ pstapriv->auth_to = 3; // 3*2 = 6 sec ++ pstapriv->auth_to = 3; // 3*2 = 6 sec + pstapriv->assoc_to = 3; + //pstapriv->expire_to = 900;// 900*2 = 1800 sec = 30 min, expire after no any traffic. + //pstapriv->expire_to = 30;// 30*2 = 60 sec = 1 min, expire after no any traffic. @@ -70993,18 +49734,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + pstapriv->expire_to = 3; // 3*2 = 6 sec +#else + pstapriv->expire_to = 60;// 60*2 = 120 sec = 2 min, expire after no any traffic. -+#endif -+#ifdef CONFIG_ATMEL_RC_PATCH -+ _rtw_memset( pstapriv->atmel_rc_pattern, 0, ETH_ALEN); -+#endif -+ pstapriv->max_num_sta = NUM_STA; -+ +#endif -+ -+_func_exit_; ++ pstapriv->max_num_sta = NUM_STA; ++ ++#endif ++ ++ + + return _SUCCESS; -+ ++ +} + +inline int rtw_stainfo_offset(struct sta_priv *stapriv, struct sta_info *sta) @@ -71028,7 +49766,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 +void _rtw_free_sta_xmit_priv_lock(struct sta_xmit_priv *psta_xmitpriv); +void _rtw_free_sta_xmit_priv_lock(struct sta_xmit_priv *psta_xmitpriv) +{ -+_func_enter_; ++ + + _rtw_spinlock_free(&psta_xmitpriv->lock); + @@ -71036,33 +49774,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + _rtw_spinlock_free(&(psta_xmitpriv->bk_q.sta_pending.lock)); + _rtw_spinlock_free(&(psta_xmitpriv->vi_q.sta_pending.lock)); + _rtw_spinlock_free(&(psta_xmitpriv->vo_q.sta_pending.lock)); -+_func_exit_; ++ +} + +static void _rtw_free_sta_recv_priv_lock(struct sta_recv_priv *psta_recvpriv) +{ -+_func_enter_; ++ + + _rtw_spinlock_free(&psta_recvpriv->lock); + + _rtw_spinlock_free(&(psta_recvpriv->defrag_q.lock)); + -+_func_exit_; ++ + +} + +void rtw_mfree_stainfo(struct sta_info *psta); +void rtw_mfree_stainfo(struct sta_info *psta) +{ -+_func_enter_; ++ + + if(&psta->lock != NULL) + _rtw_spinlock_free(&psta->lock); + + _rtw_free_sta_xmit_priv_lock(&psta->sta_xmitpriv); + _rtw_free_sta_recv_priv_lock(&psta->sta_recvpriv); -+ -+_func_exit_; ++ ++ +} + + @@ -71073,25 +49811,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + _irqL irqL; + _list *plist, *phead; + struct sta_info *psta = NULL; -+ -+_func_enter_; ++ ++ + + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); + + phead = get_list_head(&pstapriv->free_sta_queue); + plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == false) + { + psta = LIST_CONTAINOR(plist, struct sta_info ,list); + plist = get_next(plist); + + rtw_mfree_stainfo(psta); + } -+ ++ + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); + -+_func_exit_; ++ + +} + @@ -71120,53 +49858,53 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + +u32 _rtw_free_sta_priv(struct sta_priv *pstapriv) +{ -+ _irqL irqL; ++ _irqL irqL; + _list *phead, *plist; + struct sta_info *psta = NULL; + struct recv_reorder_ctrl *preorder_ctrl; -+ int index; ++ int index; ++ + -+_func_enter_; + if(pstapriv){ + -+ /* delete all reordering_ctrl_timer */ ++ /* delete all reordering_ctrl_timer */ + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); + for(index = 0; index < NUM_STA; index++) + { + phead = &(pstapriv->sta_hash[index]); + plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == false) + { -+ int i; ++ int i; + psta = LIST_CONTAINOR(plist, struct sta_info ,hash_list); + plist = get_next(plist); + + for(i=0; i < 16 ; i++) + { + preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); ++ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); + } + } + } + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); + /*===============================*/ -+ ++ + rtw_mfree_sta_priv_lock(pstapriv); + + if(pstapriv->pallocated_stainfo_buf) { + rtw_vmfree(pstapriv->pallocated_stainfo_buf, sizeof(struct sta_info)*NUM_STA+4); + } + } -+ -+_func_exit_; ++ ++ + return _SUCCESS; +} + + +//struct sta_info *rtw_alloc_stainfo(_queue *pfree_sta_queue, unsigned char *hwaddr) -+struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) -+{ ++struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) ++{ + _irqL irqL, irqL2; + uint tmp_aid; + s32 index; @@ -71176,14 +49914,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + struct recv_reorder_ctrl *preorder_ctrl; + int i = 0; + u16 wRxSeqInitialValue = 0xffff; -+ -+_func_enter_; ++ ++ + + pfree_sta_queue = &pstapriv->free_sta_queue; + + //_enter_critical_bh(&(pfree_sta_queue->lock), &irqL); + _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); -+ if (_rtw_queue_empty(pfree_sta_queue) == _TRUE) ++ ++ if (_rtw_queue_empty(pfree_sta_queue) == true) + { + //_exit_critical_bh(&(pfree_sta_queue->lock), &irqL); + _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); @@ -71192,13 +49931,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + else + { + psta = LIST_CONTAINOR(get_next(&pfree_sta_queue->queue), struct sta_info, list); -+ ++ + rtw_list_delete(&(psta->list)); + + //_exit_critical_bh(&(pfree_sta_queue->lock), &irqL); -+ -+ tmp_aid = psta->aid; -+ ++ ++ tmp_aid = psta->aid; ++ + _rtw_init_stainfo(psta); + + psta->padapter = pstapriv->padapter; @@ -71211,7 +49950,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + + if(index >= NUM_STA){ + RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_err_,("ERROR=> rtw_alloc_stainfo: index >= NUM_STA")); -+ psta= NULL; ++ psta= NULL; + goto exit; + } + phash_list = &(pstapriv->sta_hash[index]); @@ -71234,15 +49973,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + _rtw_memcpy( &psta->sta_recvpriv.rxcache.tid_rxseq[ i ], &wRxSeqInitialValue, 2 ); + } + -+ RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_info_,("alloc number_%d stainfo with hwaddr = %x %x %x %x %x %x \n", ++ RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_info_,("alloc number_%d stainfo with hwaddr = %x %x %x %x %x %x \n", + pstapriv->asoc_sta_count , hwaddr[0], hwaddr[1], hwaddr[2],hwaddr[3],hwaddr[4],hwaddr[5])); + + init_addba_retry_timer(pstapriv->padapter, psta); -+#ifdef CONFIG_IEEE80211W -+ init_dot11w_expire_timer(pstapriv->padapter, psta); -+#endif /* CONFIG_IEEE80211W */ ++ +#ifdef CONFIG_TDLS -+ rtw_init_tdls_timer(pstapriv->padapter, psta); ++ psta->padapter = pstapriv->padapter; ++ init_TPK_timer(pstapriv->padapter, psta); ++ init_ch_switch_timer(pstapriv->padapter, psta); ++ init_base_ch_timer(pstapriv->padapter, psta); ++ init_off_ch_timer(pstapriv->padapter, psta); ++ init_handshake_timer(pstapriv->padapter, psta); ++ init_tdls_alive_timer(pstapriv->padapter, psta); +#endif //CONFIG_TDLS + + //for A-MPDU Rx reordering buffer control @@ -71251,18 +49994,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + preorder_ctrl = &psta->recvreorder_ctrl[i]; + + preorder_ctrl->padapter = pstapriv->padapter; -+ -+ preorder_ctrl->enable = _FALSE; -+ ++ ++ preorder_ctrl->enable = false; ++ + preorder_ctrl->indicate_seq = 0xffff; + #ifdef DBG_RX_SEQ + DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d\n", __FUNCTION__, __LINE__, + preorder_ctrl->indicate_seq); + #endif -+ preorder_ctrl->wend_b= 0xffff; ++ preorder_ctrl->wend_b= 0xffff; + //preorder_ctrl->wsize_b = (NR_RECVBUFF-2); + preorder_ctrl->wsize_b = 64;//64; -+ preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; + + _rtw_init_queue(&preorder_ctrl->pending_recvframe_queue); + @@ -71273,9 +50015,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + //init for DM + psta->rssi_stat.UndecoratedSmoothedPWDB = (-1); + psta->rssi_stat.UndecoratedSmoothedCCK = (-1); -+#ifdef CONFIG_ATMEL_RC_PATCH -+ psta->flag_atmel_rc = 0; -+#endif ++ + /* init for the sequence number of received management frame */ + psta->RxMgmtFrameSeqNum = 0xffff; + @@ -71283,12 +50023,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + rtw_alloc_macid(pstapriv->padapter, psta); + + } -+ ++ +exit: + + _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); + -+_func_exit_; ++ + + return psta; + @@ -71298,7 +50038,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + +// using pstapriv->sta_hash_lock to protect +u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta) -+{ ++{ + int i; + _irqL irqL0; + _queue *pfree_sta_queue; @@ -71307,19 +50047,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + struct xmit_priv *pxmitpriv= &padapter->xmitpriv; + struct sta_priv *pstapriv = &padapter->stapriv; + struct hw_xmit *phwxmit; -+ int pending_qcnt[4]; + -+_func_enter_; -+ ++ ++ ++ + if (psta == NULL) + goto exit; + -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); -+ rtw_list_delete(&psta->hash_list); -+ RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_err_,("\n free number_%d stainfo with hwaddr = 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x \n",pstapriv->asoc_sta_count , psta->hwaddr[0], psta->hwaddr[1], psta->hwaddr[2],psta->hwaddr[3],psta->hwaddr[4],psta->hwaddr[5])); -+ pstapriv->asoc_sta_count --; -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); -+ + + _enter_critical_bh(&psta->lock, &irqL0); + psta->state &= ~_FW_LINKED; @@ -71329,23 +50063,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + + + pstaxmitpriv = &psta->sta_xmitpriv; -+ ++ + //rtw_list_delete(&psta->sleep_list); -+ ++ + //rtw_list_delete(&psta->wakeup_list); -+ ++ + _enter_critical_bh(&pxmitpriv->lock, &irqL0); -+ ++ + rtw_free_xmitframe_queue(pxmitpriv, &psta->sleep_q); + psta->sleepq_len = 0; -+ ++ + //vo + //_enter_critical_bh(&(pxmitpriv->vo_pending.lock), &irqL0); + rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->vo_q.sta_pending); + rtw_list_delete(&(pstaxmitpriv->vo_q.tx_pending)); + phwxmit = pxmitpriv->hwxmits; + phwxmit->accnt -= pstaxmitpriv->vo_q.qcnt; -+ pending_qcnt[0] = pstaxmitpriv->vo_q.qcnt; + pstaxmitpriv->vo_q.qcnt = 0; + //_exit_critical_bh(&(pxmitpriv->vo_pending.lock), &irqL0); + @@ -71355,7 +50088,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + rtw_list_delete(&(pstaxmitpriv->vi_q.tx_pending)); + phwxmit = pxmitpriv->hwxmits+1; + phwxmit->accnt -= pstaxmitpriv->vi_q.qcnt; -+ pending_qcnt[1] = pstaxmitpriv->vi_q.qcnt; + pstaxmitpriv->vi_q.qcnt = 0; + //_exit_critical_bh(&(pxmitpriv->vi_pending.lock), &irqL0); + @@ -71365,36 +50097,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); + phwxmit = pxmitpriv->hwxmits+2; + phwxmit->accnt -= pstaxmitpriv->be_q.qcnt; -+ pending_qcnt[2] = pstaxmitpriv->be_q.qcnt; + pstaxmitpriv->be_q.qcnt = 0; + //_exit_critical_bh(&(pxmitpriv->be_pending.lock), &irqL0); -+ ++ + //bk + //_enter_critical_bh(&(pxmitpriv->bk_pending.lock), &irqL0); + rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->bk_q.sta_pending); + rtw_list_delete(&(pstaxmitpriv->bk_q.tx_pending)); + phwxmit = pxmitpriv->hwxmits+3; + phwxmit->accnt -= pstaxmitpriv->bk_q.qcnt; -+ pending_qcnt[3] = pstaxmitpriv->bk_q.qcnt; + pstaxmitpriv->bk_q.qcnt = 0; + //_exit_critical_bh(&(pxmitpriv->bk_pending.lock), &irqL0); + -+ rtw_os_wake_queue_at_free_stainfo(padapter, pending_qcnt); -+ + _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ ++ ++ rtw_list_delete(&psta->hash_list); ++ RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_err_,("\n free number_%d stainfo with hwaddr = 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x \n",pstapriv->asoc_sta_count , psta->hwaddr[0], psta->hwaddr[1], psta->hwaddr[2],psta->hwaddr[3],psta->hwaddr[4],psta->hwaddr[5])); ++ pstapriv->asoc_sta_count --; ++ ++ + // re-init sta_info; 20061114 // will be init in alloc_stainfo + //_rtw_init_sta_xmit_priv(&psta->sta_xmitpriv); + //_rtw_init_sta_recv_priv(&psta->sta_recvpriv); -+#ifdef CONFIG_IEEE80211W -+ _cancel_timer_ex(&psta->dot11w_expire_timer); -+#endif /* CONFIG_IEEE80211W */ ++ + _cancel_timer_ex(&psta->addba_retry_timer); + +#ifdef CONFIG_TDLS -+ psta->tdls_sta_state = TDLS_STATE_NONE; -+ rtw_free_tdls_timer(psta); ++ _cancel_timer_ex(&psta->TPK_timer); ++ _cancel_timer_ex(&psta->option_timer); ++ _cancel_timer_ex(&psta->base_ch_timer); ++ _cancel_timer_ex(&psta->off_ch_timer); ++ _cancel_timer_ex(&psta->alive_timer1); ++ _cancel_timer_ex(&psta->alive_timer2); +#endif //CONFIG_TDLS + + //for A-MPDU Rx reordering buffer control, cancel reordering_ctrl_timer @@ -71405,37 +50139,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + union recv_frame *prframe; + _queue *ppending_recvframe_queue; + _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ -+ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); + -+ ++ preorder_ctrl = &psta->recvreorder_ctrl[i]; ++ ++ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); ++ ++ + ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; + + _enter_critical_bh(&ppending_recvframe_queue->lock, &irqL); + -+ phead = get_list_head(ppending_recvframe_queue); ++ phead = get_list_head(ppending_recvframe_queue); + plist = get_next(phead); -+ ++ + while(!rtw_is_list_empty(phead)) -+ { ++ { + prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ ++ + plist = get_next(plist); -+ ++ + rtw_list_delete(&(prframe->u.hdr.list)); + + rtw_free_recvframe(prframe, pfree_recv_queue); + } + + _exit_critical_bh(&ppending_recvframe_queue->lock, &irqL); -+ ++ + } + + if (!(psta->state & WIFI_AP_STATE)) -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _FALSE); -+ ++ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, false); ++ + + //release mac id for non-bc/mc station, + rtw_release_macid(pstapriv->padapter, psta); @@ -71444,7 +50178,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + +/* + _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL0); -+ rtw_list_delete(&psta->asoc_list); ++ rtw_list_delete(&psta->asoc_list); + _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL0); +*/ + _enter_critical_bh(&pstapriv->auth_list_lock, &irqL0); @@ -71453,11 +50187,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + pstapriv->auth_list_cnt--; + } + _exit_critical_bh(&pstapriv->auth_list_lock, &irqL0); -+ ++ + psta->expire_to = 0; -+#ifdef CONFIG_ATMEL_RC_PATCH -+ psta->flag_atmel_rc = 0; -+#endif ++ + psta->sleepq_ac_len = 0; + psta->qos_info = 0; + @@ -71470,9 +50202,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + psta->has_legacy_ac = 0; + +#ifdef CONFIG_NATIVEAP_MLME -+ ++ + pstapriv->sta_dz_bitmap &=~BIT(psta->aid); -+ pstapriv->tim_bitmap &=~BIT(psta->aid); ++ pstapriv->tim_bitmap &=~BIT(psta->aid); + + //rtw_indicate_sta_disassoc_event(padapter, psta); + @@ -71480,30 +50212,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + { + pstapriv->sta_aid[psta->aid - 1] = NULL; + psta->aid = 0; -+ } -+ -+#endif // CONFIG_NATIVEAP_MLME ++ } ++ ++#endif // CONFIG_NATIVEAP_MLME + +#ifdef CONFIG_TX_MCAST2UNI + psta->under_exist_checking = 0; +#endif // CONFIG_TX_MCAST2UNI + -+#endif // CONFIG_AP_MODE ++#endif // CONFIG_AP_MODE + + _rtw_spinlock_free(&psta->lock); + + //_enter_critical_bh(&(pfree_sta_queue->lock), &irqL0); -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); + rtw_list_insert_tail(&psta->list, get_list_head(pfree_sta_queue)); -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); + //_exit_critical_bh(&(pfree_sta_queue->lock), &irqL0); + +exit: -+ -+_func_exit_; ++ ++ + + return _SUCCESS; -+ ++ +} + +// free all stainfo which in sta_hash[all] @@ -71515,54 +50245,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + struct sta_info *psta = NULL; + struct sta_priv *pstapriv = &padapter->stapriv; + struct sta_info* pbcmc_stainfo =rtw_get_bcmc_stainfo( padapter); -+ u8 free_sta_num = 0; -+ char free_sta_list[NUM_STA]; -+ int stainfo_offset; -+ -+_func_enter_; + + if(pstapriv->asoc_sta_count==1) -+ goto exit; ++ return; + + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); + -+ for(index=0; index< NUM_STA; index++) -+ { ++ for(index=0; index< NUM_STA; index++) { + phead = &(pstapriv->sta_hash[index]); + plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == false) { + psta = LIST_CONTAINOR(plist, struct sta_info ,hash_list); + + plist = get_next(plist); + + if(pbcmc_stainfo!=psta) -+ { -+ rtw_list_delete(&psta->hash_list); -+ //rtw_free_stainfo(padapter , psta); -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) { -+ free_sta_list[free_sta_num++] = stainfo_offset; -+ } -+ } -+ ++ rtw_free_stainfo(padapter , psta); ++ + } + } -+ ++ + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ -+ for (index = 0; index < free_sta_num; index++) -+ { -+ psta = rtw_get_stainfo_by_offset(pstapriv, free_sta_list[index]); -+ rtw_free_stainfo(padapter , psta); -+ } -+ -+exit: -+ -+_func_exit_; -+ +} + +/* any station allocated can be searched by hash list */ @@ -71574,18 +50278,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + _list *plist, *phead; + + struct sta_info *psta = NULL; -+ ++ + u32 index; + + u8 *addr; + + u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; + -+_func_enter_; ++ + + if(hwaddr==NULL) + return NULL; -+ ++ + if(IS_MCAST(hwaddr)) + { + addr = bc_addr; @@ -71598,17 +50302,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + index = wifi_mac_hash(addr); + + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ ++ + phead = &(pstapriv->sta_hash[index]); + plist = get_next(phead); + + -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) ++ while ((rtw_end_of_queue_search(phead, plist)) == false) + { -+ ++ + psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ if ((_rtw_memcmp(psta->hwaddr, addr, ETH_ALEN))== _TRUE) ++ ++ if ((_rtw_memcmp(psta->hwaddr, addr, ETH_ALEN))== true) + { // if found the matched address + break; + } @@ -71617,35 +50321,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + } + + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+_func_exit_; ++ + return psta; -+ ++ +} + +u32 rtw_init_bcmc_stainfo(_adapter* padapter) +{ + -+ struct sta_info *psta; ++ struct sta_info *psta; + struct tx_servq *ptxservq; + u32 res=_SUCCESS; + NDIS_802_11_MAC_ADDRESS bcast_addr= {0xff,0xff,0xff,0xff,0xff,0xff}; -+ ++ + struct sta_priv *pstapriv = &padapter->stapriv; -+ //_queue *pstapending = &padapter->xmitpriv.bm_pending; -+ -+_func_enter_; ++ //_queue *pstapending = &padapter->xmitpriv.bm_pending; ++ ++ + + psta = rtw_alloc_stainfo(pstapriv, bcast_addr); -+ ++ + if(psta==NULL){ + res=_FAIL; + RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_err_,("rtw_alloc_stainfo fail")); + goto exit; + } -+#ifdef CONFIG_BEAMFORMING -+ psta->txbf_gid = 63; -+ psta->txbf_paid = 0; -+#endif ++ ++ // default broadcast & multicast use macid 1 ++ psta->mac_id = 1; ++ + ptxservq= &(psta->sta_xmitpriv.be_q); + +/* @@ -71656,9 +50360,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + + _exit_critical(&pstapending->lock, &irqL0); +*/ -+ ++ +exit: -+_func_exit_; ++ + return _SUCCESS; + +} @@ -71666,3221 +50370,74 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux/3rdparty/rtl881 + +struct sta_info* rtw_get_bcmc_stainfo(_adapter* padapter) +{ -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *psta; ++ struct sta_priv *pstapriv = &padapter->stapriv; + u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+_func_enter_; ++ + psta = rtw_get_stainfo(pstapriv, bc_addr); -+_func_exit_; ++ + return psta; + +} + +u8 rtw_access_ctrl(_adapter *padapter, u8 *mac_addr) +{ -+ u8 res = _TRUE; ++ u8 res = true; +#ifdef CONFIG_AP_MODE + _irqL irqL; + _list *plist, *phead; + struct rtw_wlan_acl_node *paclnode; -+ u8 match = _FALSE; ++ u8 match = false; + struct sta_priv *pstapriv = &padapter->stapriv; + struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; + _queue *pacl_node_q =&pacl_list->acl_node_q; -+ ++ + _enter_critical_bh(&(pacl_node_q->lock), &irqL); + phead = get_list_head(pacl_node_q); -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) ++ plist = get_next(phead); ++ while ((rtw_end_of_queue_search(phead, plist)) == false) + { + paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); + plist = get_next(plist); + + if(_rtw_memcmp(paclnode->addr, mac_addr, ETH_ALEN)) + { -+ if(paclnode->valid == _TRUE) ++ if(paclnode->valid == true) + { -+ match = _TRUE; ++ match = true; + break; + } -+ } -+ } ++ } ++ } + _exit_critical_bh(&(pacl_node_q->lock), &irqL); -+ ++ + + if(pacl_list->mode == 1)//accept unless in deny list + { -+ res = (match == _TRUE) ? _FALSE:_TRUE; -+ } ++ res = (match == true) ? false:true; ++ } + else if(pacl_list->mode == 2)//deny unless in accept list + { -+ res = (match == _TRUE) ? _TRUE:_FALSE; ++ res = (match == true) ? true:false; + } + else + { -+ res = _TRUE; -+ } -+ ++ res = true; ++ } ++ +#endif + + return res; + +} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_tdls.c linux/3rdparty/rtl8812au/core/rtw_tdls.c ---- linux.old/3rdparty/rtl8812au/core/rtw_tdls.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_tdls.c 2017-06-07 23:07:21.005687029 +0300 -@@ -0,0 +1,3142 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_TDLS_C_ -+ -+#include -+ -+#ifdef CONFIG_TDLS -+#define ONE_SEC 1000 /* 1000 ms */ -+ -+extern unsigned char MCS_rate_2R[16]; -+extern unsigned char MCS_rate_1R[16]; -+extern void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame); -+ -+void rtw_reset_tdls_info(_adapter* padapter) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ ptdlsinfo->ap_prohibited = _FALSE; -+ -+ /* For TDLS channel switch, currently we only allow it to work in wifi logo test mode */ -+ if (padapter->registrypriv.wifi_spec == 1) -+ { -+ ptdlsinfo->ch_switch_prohibited = _FALSE; -+ } -+ else -+ { -+ ptdlsinfo->ch_switch_prohibited = _TRUE; -+ } -+ -+ ptdlsinfo->link_established = _FALSE; -+ ptdlsinfo->sta_cnt = 0; -+ ptdlsinfo->sta_maximum = _FALSE; -+ -+#ifdef CONFIG_TDLS_CH_SW -+ ptdlsinfo->chsw_info.ch_sw_state = TDLS_STATE_NONE; -+ ATOMIC_SET(&ptdlsinfo->chsw_info.chsw_on, _FALSE); -+ ptdlsinfo->chsw_info.off_ch_num = 0; -+ ptdlsinfo->chsw_info.ch_offset = 0; -+ ptdlsinfo->chsw_info.cur_time = 0; -+ ptdlsinfo->chsw_info.delay_switch_back = _FALSE; -+ ptdlsinfo->chsw_info.dump_stack = _FALSE; -+#endif -+ -+ ptdlsinfo->ch_sensing = 0; -+ ptdlsinfo->watchdog_count = 0; -+ ptdlsinfo->dev_discovered = _FALSE; -+ -+#ifdef CONFIG_WFD -+ ptdlsinfo->wfd_info = &padapter->wfd_info; -+#endif /* ONFIG_WFD */ -+} -+ -+int rtw_init_tdls_info(_adapter* padapter) -+{ -+ int res = _SUCCESS; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ rtw_reset_tdls_info(padapter); -+ -+ ptdlsinfo->tdls_enable = _TRUE; -+#ifdef CONFIG_TDLS_DRIVER_SETUP -+ ptdlsinfo->driver_setup = _TRUE; -+#else -+ ptdlsinfo->driver_setup = _FALSE; -+#endif /* CONFIG_TDLS_DRIVER_SETUP */ -+ -+ _rtw_spinlock_init(&ptdlsinfo->cmd_lock); -+ _rtw_spinlock_init(&ptdlsinfo->hdl_lock); -+ -+ return res; -+ -+} -+ -+void rtw_free_tdls_info(struct tdls_info *ptdlsinfo) -+{ -+ _rtw_spinlock_free(&ptdlsinfo->cmd_lock); -+ _rtw_spinlock_free(&ptdlsinfo->hdl_lock); -+ -+ _rtw_memset(ptdlsinfo, 0, sizeof(struct tdls_info) ); -+ -+} -+ -+int check_ap_tdls_prohibited(u8 *pframe, u8 pkt_len) -+{ -+ u8 tdls_prohibited_bit = 0x40; /* bit(38); TDLS_prohibited */ -+ -+ if (pkt_len < 5) { -+ return _FALSE; -+ } -+ -+ pframe += 4; -+ if ((*pframe) & tdls_prohibited_bit) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+int check_ap_tdls_ch_switching_prohibited(u8 *pframe, u8 pkt_len) -+{ -+ u8 tdls_ch_swithcing_prohibited_bit = 0x80; /* bit(39); TDLS_channel_switching prohibited */ -+ -+ if (pkt_len < 5) { -+ return _FALSE; -+ } -+ -+ pframe += 4; -+ if ((*pframe) & tdls_ch_swithcing_prohibited_bit) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+int _issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int wait_ack) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl, *qc; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ pattrib->hdrlen +=2; -+ pattrib->qos_en = _TRUE; -+ pattrib->eosp = 1; -+ pattrib->ack_policy = 0; -+ pattrib->mdata = 0; -+ pattrib->retry_ctrl = _FALSE; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ if (power_mode) -+ SetPwrMgt(fctrl); -+ -+ qc = (unsigned short *)(pframe + pattrib->hdrlen - 2); -+ -+ SetPriority(qc, 7); /* Set priority to VO */ -+ -+ SetEOSP(qc, pattrib->eosp); -+ -+ SetAckpolicy(qc, pattrib->ack_policy); -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if (wait_ack) -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+ -+} -+ -+/* -+ *wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ *wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ *try_cnt means the maximal TX count to try -+ */ -+int issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) -+{ -+ int ret; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ #if 0 -+ psta = rtw_get_stainfo(&padapter->stapriv, da); -+ if (psta) { -+ if (power_mode) -+ rtw_hal_macid_sleep(padapter, psta->mac_id); -+ else -+ rtw_hal_macid_wakeup(padapter, psta->mac_id); -+ } else { -+ DBG_871X(FUNC_ADPT_FMT ": Can't find sta info for " MAC_FMT ", skip macid %s!!\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), power_mode?"sleep":"wakeup"); -+ rtw_warn_on(1); -+ } -+ #endif -+ -+ do { -+ ret = _issue_nulldata_to_TDLS_peer_STA(padapter, da, power_mode, wait_ms>0 ? _TRUE : _FALSE); -+ -+ i++; -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ } while ((i < try_cnt) && (ret==_FAIL || wait_ms==0)); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+ #ifndef DBG_XMIT_ACK -+ goto exit; -+ #endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ if (da) -+ DBG_871X(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), -+ ret==_SUCCESS?", acked":"", i, try_cnt, rtw_get_passing_time_ms(start)); -+ else -+ DBG_871X(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), -+ ret==_SUCCESS?", acked":"", i, try_cnt, rtw_get_passing_time_ms(start)); -+ } -+exit: -+ return ret; -+} -+ -+void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ _irqL irqL; -+ -+ /* free peer sta_info */ -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ if (ptdlsinfo->sta_cnt != 0) -+ ptdlsinfo->sta_cnt--; -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ /* -2: AP + BC/MC sta, -4: default key */ -+ if (ptdlsinfo->sta_cnt < MAX_ALLOWED_TDLS_STA_NUM) { -+ ptdlsinfo->sta_maximum = _FALSE; -+ _rtw_memset( &ptdlsinfo->ss_record, 0x00, sizeof(struct tdls_ss_record) ); -+ } -+ -+ /* clear cam */ -+ rtw_clearstakey_cmd(padapter, ptdls_sta, _TRUE); -+ -+ if (ptdlsinfo->sta_cnt == 0) { -+ rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR); -+ ptdlsinfo->link_established = _FALSE; -+ } -+ else -+ DBG_871X("Remain tdls sta:%02x\n", ptdlsinfo->sta_cnt); -+ -+ rtw_free_stainfo(padapter, ptdls_sta); -+ -+} -+ -+ -+/* TDLS encryption(if needed) will always be CCMP */ -+void rtw_tdls_set_key(_adapter *padapter, struct sta_info *ptdls_sta) -+{ -+ ptdls_sta->dot118021XPrivacy=_AES_; -+ rtw_setstakey_cmd(padapter, ptdls_sta, TDLS_KEY, _TRUE); -+} -+ -+#ifdef CONFIG_80211N_HT -+void rtw_tdls_process_ht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 *data, u8 Length) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ u8 max_AMPDU_len, min_MPDU_spacing; -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0; -+ -+ /* Save HT capabilities in the sta object */ -+ _rtw_memset(&ptdls_sta->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap)); -+ if (data && Length >= sizeof(struct rtw_ieee80211_ht_cap)) { -+ ptdls_sta->flags |= WLAN_STA_HT; -+ ptdls_sta->flags |= WLAN_STA_WME; -+ -+ _rtw_memcpy(&ptdls_sta->htpriv.ht_cap, data, sizeof(struct rtw_ieee80211_ht_cap)); -+ } else -+ ptdls_sta->flags &= ~WLAN_STA_HT; -+ -+ if (ptdls_sta->flags & WLAN_STA_HT) { -+ if (padapter->registrypriv.ht_enable == _TRUE) { -+ ptdls_sta->htpriv.ht_option = _TRUE; -+ ptdls_sta->qos_option = _TRUE; -+ } else { -+ ptdls_sta->htpriv.ht_option = _FALSE; -+ ptdls_sta->qos_option = _FALSE; -+ } -+ } -+ -+ /* HT related cap */ -+ if (ptdls_sta->htpriv.ht_option) { -+ /* Check if sta supports rx ampdu */ -+ if (padapter->registrypriv.ampdu_enable == 1) -+ ptdls_sta->htpriv.ampdu_enable = _TRUE; -+ -+ /* AMPDU Parameters field */ -+ /* Get MIN of MAX AMPDU Length Exp */ -+ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3) > (data[2] & 0x3)) -+ max_AMPDU_len = (data[2] & 0x3); -+ else -+ max_AMPDU_len = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3); -+ /* Get MAX of MIN MPDU Start Spacing */ -+ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) > (data[2] & 0x1c)) -+ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c); -+ else -+ min_MPDU_spacing = (data[2] & 0x1c); -+ ptdls_sta->htpriv.rx_ampdu_min_spacing = max_AMPDU_len | min_MPDU_spacing; -+ -+ /* Check if sta support s Short GI 20M */ -+ if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_20)) -+ ptdls_sta->htpriv.sgi_20m = _TRUE; -+ -+ /* Check if sta support s Short GI 40M */ -+ if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_40)) -+ ptdls_sta->htpriv.sgi_40m = _TRUE; -+ -+ /* Bwmode would still followed AP's setting */ -+ if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) { -+ if (padapter->mlmeextpriv.cur_bwmode >= CHANNEL_WIDTH_40) -+ ptdls_sta->bw_mode = CHANNEL_WIDTH_40; -+ ptdls_sta->htpriv.ch_offset = padapter->mlmeextpriv.cur_ch_offset; -+ } -+ -+ /* Config LDPC Coding Capability */ -+ if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX) && GET_HT_CAP_ELE_LDPC_CAP(data)) { -+ SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX)); -+ DBG_871X("Enable HT Tx LDPC!\n"); -+ } -+ ptdls_sta->htpriv.ldpc_cap = cur_ldpc_cap; -+ -+ /* Config STBC setting */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAP_ELE_RX_STBC(data)) { -+ SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX)); -+ DBG_871X("Enable HT Tx STBC!\n"); -+ } -+ ptdls_sta->htpriv.stbc_cap = cur_stbc_cap; -+ -+#ifdef CONFIG_BEAMFORMING -+ /* Config Tx beamforming setting */ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(data)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); -+ } -+ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(data)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); -+ } -+ ptdls_sta->htpriv.beamform_cap = cur_beamform_cap; -+ if (cur_beamform_cap) -+ DBG_871X("Client HT Beamforming Cap = 0x%02X\n", cur_beamform_cap); -+#endif /* CONFIG_BEAMFORMING */ -+ } -+ -+} -+ -+u8 *rtw_tdls_set_ht_cap(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ rtw_ht_use_default_setting(padapter); -+ -+ rtw_restructure_ht_ie(padapter, NULL, pframe, 0, &(pattrib->pktlen), padapter->mlmeextpriv.cur_channel); -+ -+ return pframe + pattrib->pktlen; -+} -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+void rtw_tdls_process_vht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 *data, u8 Length) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0, rf_type = RF_1T1R; -+ u8 *pcap_mcs; -+ u8 vht_mcs[2]; -+ -+ _rtw_memset(&ptdls_sta->vhtpriv, 0, sizeof(struct vht_priv)); -+ if (data && Length == 12) { -+ ptdls_sta->flags |= WLAN_STA_VHT; -+ -+ _rtw_memcpy(ptdls_sta->vhtpriv.vht_cap, data, 12); -+ -+#if 0 -+ if (elems.vht_op_mode_notify && elems.vht_op_mode_notify_len == 1) { -+ _rtw_memcpy(&pstat->vhtpriv.vht_op_mode_notify, elems.vht_op_mode_notify, 1); -+ } else /* for Frame without Operating Mode notify ie; default: 80M */ { -+ pstat->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80; -+ } -+#else -+ ptdls_sta->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80; -+#endif -+ } else -+ ptdls_sta->flags &= ~WLAN_STA_VHT; -+ -+ if (ptdls_sta->flags & WLAN_STA_VHT) { -+ if (padapter->registrypriv.vht_enable == _TRUE) -+ ptdls_sta->vhtpriv.vht_option = _TRUE; -+ else -+ ptdls_sta->vhtpriv.vht_option = _FALSE; -+ } -+ -+ /* B4 Rx LDPC */ -+ if (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX) && -+ GET_VHT_CAPABILITY_ELE_RX_LDPC(data)) { -+ SET_FLAG(cur_ldpc_cap, (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX)); -+ DBG_871X("Current VHT LDPC Setting = %02X\n", cur_ldpc_cap); -+ } -+ ptdls_sta->vhtpriv.ldpc_cap = cur_ldpc_cap; -+ -+ /* B5 Short GI for 80 MHz */ -+ ptdls_sta->vhtpriv.sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(data) & pvhtpriv->sgi_80m) ? _TRUE : _FALSE; -+ -+ /* B8 B9 B10 Rx STBC */ -+ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX) && -+ GET_VHT_CAPABILITY_ELE_RX_STBC(data)) { -+ SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); -+ DBG_871X("Current VHT STBC Setting = %02X\n", cur_stbc_cap); -+ } -+ ptdls_sta->vhtpriv.stbc_cap = cur_stbc_cap; -+ -+ /* B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && -+ GET_VHT_CAPABILITY_ELE_SU_BFEE(data)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); -+ } -+ -+ /* B12 SU Beamformee Capable, the target supports Beamformee and we are Beamformer */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) && -+ GET_VHT_CAPABILITY_ELE_SU_BFER(data)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ } -+ ptdls_sta->vhtpriv.beamform_cap = cur_beamform_cap; -+ if (cur_beamform_cap) -+ DBG_871X("Current VHT Beamforming Setting = %02X\n", cur_beamform_cap); -+ -+ /* B23 B24 B25 Maximum A-MPDU Length Exponent */ -+ ptdls_sta->vhtpriv.ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(data); -+ -+ pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(data); -+ _rtw_memcpy(vht_mcs, pcap_mcs, 2); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if ((rf_type == RF_1T1R) || (rf_type == RF_1T2R)) -+ vht_mcs[0] |= 0xfc; -+ else if (rf_type == RF_2T2R) -+ vht_mcs[0] |= 0xf0; -+ else if (rf_type == RF_3T3R) -+ vht_mcs[0] |= 0xc0; -+ -+ _rtw_memcpy(ptdls_sta->vhtpriv.vht_mcs_map, vht_mcs, 2); -+ -+ ptdls_sta->vhtpriv.vht_highest_rate = rtw_get_vht_highest_rate(ptdls_sta->vhtpriv.vht_mcs_map); -+} -+ -+u8 *rtw_tdls_set_aid(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ return rtw_set_ie(pframe, EID_AID, 2, (u8 *)&(padapter->mlmepriv.cur_network.aid), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_vht_cap(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ u32 ie_len = 0; -+ -+ rtw_vht_use_default_setting(padapter); -+ -+ ie_len = rtw_build_vht_cap_ie(padapter, pframe); -+ pattrib->pktlen += ie_len; -+ -+ return pframe + ie_len; -+} -+ -+u8 *rtw_tdls_set_vht_operation(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib, u8 channel) -+{ -+ u32 ie_len = 0; -+ -+ ie_len = rtw_build_vht_operation_ie(padapter, pframe, channel); -+ pattrib->pktlen += ie_len; -+ -+ return pframe + ie_len; -+} -+ -+u8 *rtw_tdls_set_vht_op_mode_notify(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib, u8 bw) -+{ -+ u32 ie_len = 0; -+ -+ ie_len = rtw_build_vht_op_mode_notify_ie(padapter, pframe, bw); -+ pattrib->pktlen += ie_len; -+ -+ return pframe + ie_len; -+} -+#endif -+ -+ -+u8 *rtw_tdls_set_sup_ch(struct mlme_ext_priv *pmlmeext, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ u8 sup_ch[30 * 2] = {0x00}, ch_set_idx = 0, sup_ch_idx = 2; -+ -+ do { -+ if (pmlmeext->channel_set[ch_set_idx].ChannelNum <= 14) { -+ sup_ch[0] = 1; /* First channel number */ -+ sup_ch[1] = pmlmeext->channel_set[ch_set_idx].ChannelNum; /* Number of channel */ -+ } else { -+ sup_ch[sup_ch_idx++] = pmlmeext->channel_set[ch_set_idx].ChannelNum; -+ sup_ch[sup_ch_idx++] = 1; -+ } -+ ch_set_idx++; -+ } while (pmlmeext->channel_set[ch_set_idx].ChannelNum != 0 && ch_set_idx < MAX_CHANNEL_NUM); -+ -+ return rtw_set_ie(pframe, _SUPPORTED_CH_IE_, sup_ch_idx, sup_ch, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_rsnie(struct tdls_txmgmt *ptxmgmt, u8 *pframe, struct pkt_attrib *pattrib, int init, struct sta_info *ptdls_sta) -+{ -+ u8 *p = NULL; -+ int len = 0; -+ -+ if (ptxmgmt->len > 0) -+ p = rtw_get_ie(ptxmgmt->buf, _RSN_IE_2_, &len, ptxmgmt->len); -+ -+ if (p != NULL) -+ return rtw_set_ie(pframe, _RSN_IE_2_, len, p+2, &(pattrib->pktlen)); -+ else -+ if (init == _TRUE) -+ return rtw_set_ie(pframe, _RSN_IE_2_, sizeof(TDLS_RSNIE), TDLS_RSNIE, &(pattrib->pktlen)); -+ else -+ return rtw_set_ie(pframe, _RSN_IE_2_, sizeof(ptdls_sta->TDLS_RSNIE), ptdls_sta->TDLS_RSNIE, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_ext_cap(u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ return rtw_set_ie(pframe, _EXT_CAP_IE_ , sizeof(TDLS_EXT_CAPIE), TDLS_EXT_CAPIE, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_qos_cap(u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ return rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, sizeof(TDLS_WMMIE), TDLS_WMMIE, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_ftie(struct tdls_txmgmt *ptxmgmt, u8 *pframe, struct pkt_attrib *pattrib, u8 *ANonce, u8 *SNonce) -+{ -+ struct wpa_tdls_ftie FTIE = {0}; -+ u8 *p = NULL; -+ int len = 0; -+ -+ if (ptxmgmt->len > 0) -+ p = rtw_get_ie(ptxmgmt->buf, _FTIE_, &len, ptxmgmt->len); -+ -+ if (p != NULL) -+ return rtw_set_ie(pframe, _FTIE_, len, p+2, &(pattrib->pktlen)); -+ else { -+ if (ANonce != NULL) -+ _rtw_memcpy(FTIE.Anonce, ANonce, WPA_NONCE_LEN); -+ if (SNonce != NULL) -+ _rtw_memcpy(FTIE.Snonce, SNonce, WPA_NONCE_LEN); -+ return rtw_set_ie(pframe, _FTIE_ , 82, (u8 *)FTIE.mic_ctrl, &(pattrib->pktlen)); -+ } -+} -+ -+u8 *rtw_tdls_set_timeout_interval(struct tdls_txmgmt *ptxmgmt, u8 *pframe, struct pkt_attrib *pattrib, int init, struct sta_info *ptdls_sta) -+{ -+ u8 timeout_itvl[5]; /* set timeout interval to maximum value */ -+ u32 timeout_interval= TPK_RESEND_COUNT; -+ u8 *p = NULL; -+ int len = 0; -+ -+ if (ptxmgmt->len > 0) -+ p = rtw_get_ie(ptxmgmt->buf, _TIMEOUT_ITVL_IE_, &len, ptxmgmt->len); -+ -+ if (p != NULL) -+ return rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, len, p+2, &(pattrib->pktlen)); -+ else { -+ /* Timeout interval */ -+ timeout_itvl[0]=0x02; -+ if (init == _TRUE) -+ _rtw_memcpy(timeout_itvl+1, &timeout_interval, 4); -+ else -+ _rtw_memcpy(timeout_itvl+1, (u8 *)(&ptdls_sta->TDLS_PeerKey_Lifetime), 4); -+ -+ return rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); -+ } -+} -+ -+u8 *rtw_tdls_set_bss_coexist(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ u8 iedata=0; -+ -+ if (padapter->mlmepriv.num_FortyMHzIntolerant > 0) -+ iedata |= BIT(2); /* 20 MHz BSS Width Request */ -+ -+ /* Information Bit should be set by TDLS test plan 5.9 */ -+ iedata |= BIT(0); -+ return rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_payload_type(u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ u8 payload_type = 0x02; -+ return rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_category(u8 *pframe, struct pkt_attrib *pattrib, u8 category) -+{ -+ return rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_action(u8 *pframe, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt) -+{ -+ return rtw_set_fixed_ie(pframe, 1, &(ptxmgmt->action_code), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_status_code(u8 *pframe, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt) -+{ -+ return rtw_set_fixed_ie(pframe, 2, (u8 *)&(ptxmgmt->status_code), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_dialog(u8 *pframe, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt) -+{ -+ u8 dialogtoken = 1; -+ if (ptxmgmt->dialog_token) -+ return rtw_set_fixed_ie(pframe, 1, &(ptxmgmt->dialog_token), &(pattrib->pktlen)); -+ else -+ return rtw_set_fixed_ie(pframe, 1, &(dialogtoken), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_reg_class(u8 *pframe, struct pkt_attrib *pattrib, struct sta_info *ptdls_sta) -+{ -+ u8 reg_class = 1; -+ return rtw_set_fixed_ie(pframe, 1, &(reg_class), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_capability(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ u8 cap_from_ie[2] = {0}; -+ -+ _rtw_memcpy(cap_from_ie, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); -+ -+ return rtw_set_fixed_ie(pframe, 2, cap_from_ie, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_supported_rate(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ u8 bssrate[NDIS_802_11_LENGTH_RATES_EX]; -+ int bssrate_len = 0; -+ u8 more_supportedrates = 0; -+ -+ rtw_set_supported_rate(bssrate, (padapter->registrypriv.wireless_mode == WIRELESS_MODE_MAX) ? padapter->mlmeextpriv.cur_wireless_mode : padapter->registrypriv.wireless_mode); -+ bssrate_len = rtw_get_rateset_len(bssrate); -+ -+ if (bssrate_len > 8) { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); -+ more_supportedrates = 1; -+ } else { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); -+ } -+ -+ /* extended supported rates */ -+ if (more_supportedrates == 1) { -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); -+ } -+ -+ return pframe; -+} -+ -+u8 *rtw_tdls_set_sup_reg_class(u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ return rtw_set_ie(pframe, _SRC_IE_ , sizeof(TDLS_SRC), TDLS_SRC, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_linkid(u8 *pframe, struct pkt_attrib *pattrib, u8 init) -+{ -+ u8 link_id_addr[18] = {0}; -+ if (init == _TRUE) { -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); -+ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); -+ } else { -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr+6), pattrib->dst, 6); -+ _rtw_memcpy((link_id_addr+12), pattrib->src, 6); -+ } -+ return rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); -+} -+ -+#ifdef CONFIG_TDLS_CH_SW -+u8 *rtw_tdls_set_target_ch(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ u8 target_ch = 1; -+ if (padapter->tdlsinfo.chsw_info.off_ch_num) -+ return rtw_set_fixed_ie(pframe, 1, &(padapter->tdlsinfo.chsw_info.off_ch_num), &(pattrib->pktlen)); -+ else -+ return rtw_set_fixed_ie(pframe, 1, &(target_ch), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_ch_sw(u8 *pframe, struct pkt_attrib *pattrib, struct sta_info *ptdls_sta) -+{ -+ u8 ch_switch_timing[4] = {0}; -+ u16 switch_time = (ptdls_sta->ch_switch_time >= CH_SWITCH_TIME * 1000) ? -+ ptdls_sta->ch_switch_time : CH_SWITCH_TIME; -+ u16 switch_timeout = (ptdls_sta->ch_switch_timeout >= CH_SWITCH_TIMEOUT * 1000) ? -+ ptdls_sta->ch_switch_timeout : CH_SWITCH_TIMEOUT; -+ -+ _rtw_memcpy(ch_switch_timing, &switch_time, 2); -+ _rtw_memcpy(ch_switch_timing + 2, &switch_timeout, 2); -+ -+ return rtw_set_ie(pframe, _CH_SWITCH_TIMING_, 4, ch_switch_timing, &(pattrib->pktlen)); -+} -+#endif -+ -+u8 *rtw_tdls_set_wmm_params(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 wmm_param_ele[24] = {0}; -+ -+ if (&pmlmeinfo->WMM_param) { -+ _rtw_memcpy(wmm_param_ele, WMM_PARA_OUI, 6); -+ if (_rtw_memcmp(&pmlmeinfo->WMM_param, &wmm_param_ele[6], 18) == _TRUE) -+ /* Use default WMM Param */ -+ _rtw_memcpy(wmm_param_ele + 6, (u8 *)&TDLS_WMM_PARAM_IE, sizeof(TDLS_WMM_PARAM_IE)); -+ else -+ _rtw_memcpy(wmm_param_ele + 6, (u8 *)&pmlmeinfo->WMM_param, sizeof(pmlmeinfo->WMM_param)); -+ return rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 24, wmm_param_ele, &(pattrib->pktlen)); -+ } -+ else -+ return pframe; -+} -+ -+#ifdef CONFIG_WFD -+void rtw_tdls_process_wfd_ie(struct tdls_info *ptdlsinfo, u8 *ptr, u8 length) -+{ -+ u8 wfd_ie[ 128 ] = { 0x00 }; -+ u32 wfd_ielen = 0; -+ u32 wfd_offset = 0; -+ /* Try to get the TCP port information when receiving the negotiation response. */ -+ -+ wfd_offset = 0; -+ wfd_offset = rtw_get_wfd_ie( ptr + wfd_offset, length - wfd_offset, wfd_ie, &wfd_ielen ); -+ while (wfd_offset) { -+ u8 attr_content[ 10 ] = { 0x00 }; -+ u32 attr_contentlen = 0; -+ int i; -+ -+ DBG_871X( "[%s] WFD IE Found!!\n", __FUNCTION__ ); -+ rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, attr_content, &attr_contentlen); -+ if (attr_contentlen) { -+ ptdlsinfo->wfd_info->peer_rtsp_ctrlport = RTW_GET_BE16( attr_content + 2 ); -+ DBG_871X( "[%s] Peer PORT NUM = %d\n", __FUNCTION__, ptdlsinfo->wfd_info->peer_rtsp_ctrlport ); -+ } -+ -+ _rtw_memset( attr_content, 0x00, 10); -+ attr_contentlen = 0; -+ rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_LOCAL_IP_ADDR, attr_content, &attr_contentlen); -+ if (attr_contentlen) { -+ _rtw_memcpy(ptdlsinfo->wfd_info->peer_ip_address, ( attr_content + 1 ), 4); -+ DBG_871X( "[%s] Peer IP = %02u.%02u.%02u.%02u \n", __FUNCTION__, -+ ptdlsinfo->wfd_info->peer_ip_address[0], ptdlsinfo->wfd_info->peer_ip_address[1], -+ ptdlsinfo->wfd_info->peer_ip_address[2], ptdlsinfo->wfd_info->peer_ip_address[3]); -+ } -+ wfd_offset = rtw_get_wfd_ie( ptr + wfd_offset, length - wfd_offset, wfd_ie, &wfd_ielen ); -+ } -+} -+ -+int issue_tunneled_probe_req(_adapter *padapter) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ u8 baddr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ struct tdls_txmgmt txmgmt; -+ int ret = _FAIL; -+ -+ DBG_871X("[%s]\n", __FUNCTION__); -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ txmgmt.action_code = TUNNELED_PROBE_REQ; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, baddr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+exit: -+ -+ return ret; -+} -+ -+int issue_tunneled_probe_rsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct tdls_txmgmt txmgmt; -+ int ret = _FAIL; -+ -+ DBG_871X("[%s]\n", __FUNCTION__); -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ txmgmt.action_code = TUNNELED_PROBE_RSP; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, precv_frame->u.hdr.attrib.src, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+exit: -+ -+ return ret; -+} -+#endif /* CONFIG_WFD */ -+ -+int issue_tdls_setup_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta= NULL; -+ _irqL irqL; -+ int ret = _FAIL; -+ /* Retry timer should be set at least 301 sec, using TPK_count counting 301 times. */ -+ u32 timeout_interval= TPK_RESEND_COUNT; -+ -+ DBG_871X("[TDLS] %s\n", __FUNCTION__); -+ -+ ptxmgmt->action_code = TDLS_SETUP_REQUEST; -+ if (ptdlsinfo->ap_prohibited == _TRUE) -+ goto exit; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ -+ /* init peer sta_info */ -+ ptdls_sta = rtw_get_stainfo(pstapriv, ptxmgmt->peer); -+ if (ptdls_sta == NULL) { -+ ptdls_sta = rtw_alloc_stainfo(pstapriv, ptxmgmt->peer); -+ if (ptdls_sta == NULL) { -+ DBG_871X("[%s] rtw_alloc_stainfo fail\n", __FUNCTION__); -+ rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ } -+ -+ if(!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) -+ ptdlsinfo->sta_cnt++; -+ -+ if (ptdlsinfo->sta_cnt == MAX_ALLOWED_TDLS_STA_NUM) -+ ptdlsinfo->sta_maximum = _TRUE; -+ -+ ptdls_sta->tdls_sta_state |= TDLS_RESPONDER_STATE; -+ -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { -+ ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval; -+ _set_timer(&ptdls_sta->handshake_timer, TDLS_HANDSHAKE_TIME); -+ } -+ -+ pattrib->qsel = pattrib->priority; -+ -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) !=_SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ if (wait_ack) { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ -+ return ret; -+} -+ -+int _issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta=NULL; -+ _irqL irqL; -+ int ret = _FAIL; -+ -+ DBG_871X("[TDLS] %s\n", __FUNCTION__); -+ -+ ptxmgmt->action_code = TDLS_TEARDOWN; -+ ptdls_sta = rtw_get_stainfo(pstapriv, ptxmgmt->peer); -+ if (ptdls_sta == NULL) { -+ DBG_871X("Np tdls_sta for tearing down\n"); -+ goto exit; -+ } -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ rtw_set_scan_deny(padapter, 550); -+ -+ rtw_scan_abort(padapter); -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) -+ rtw_scan_abort(padapter->pbuddy_adapter); -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) -+ if(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) -+ if (pattrib->encrypt) -+ _cancel_timer_ex(&ptdls_sta->TPK_timer); -+ -+ if (wait_ack) { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+ if (ret == _SUCCESS && rtw_tdls_is_driver_setup(padapter)) -+ rtw_tdls_cmd(padapter, ptxmgmt->peer, TDLS_TEAR_STA); -+ -+exit: -+ -+ return ret; -+} -+ -+int issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack) -+{ -+ int ret = _FAIL; -+ -+ ret = _issue_tdls_teardown(padapter, ptxmgmt, wait_ack); -+ if ((ptxmgmt->status_code == _RSON_TDLS_TEAR_UN_RSN_) && (ret == _FAIL)) { -+ /* Change status code and send teardown again via AP */ -+ ptxmgmt->status_code = _RSON_TDLS_TEAR_TOOFAR_; -+ ret = _issue_tdls_teardown(padapter, ptxmgmt, wait_ack); -+ } -+ -+ return ret; -+} -+ -+int issue_tdls_dis_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ int ret = _FAIL; -+ -+ DBG_871X("[TDLS] %s\n", __FUNCTION__); -+ -+ ptxmgmt->action_code = TDLS_DISCOVERY_REQUEST; -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ dump_mgntframe(padapter, pmgntframe); -+ DBG_871X("issue tdls dis req\n"); -+ -+ ret = _SUCCESS; -+exit: -+ -+ return ret; -+} -+ -+int issue_tdls_setup_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ int ret = _FAIL; -+ -+ DBG_871X("[TDLS] %s\n", __FUNCTION__); -+ -+ ptxmgmt->action_code = TDLS_SETUP_RESPONSE; -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(&(padapter->mlmepriv)), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ ret = _SUCCESS; -+exit: -+ -+ return ret; -+ -+} -+ -+int issue_tdls_setup_cfm(_adapter *padapter, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ int ret = _FAIL; -+ -+ DBG_871X("[TDLS] %s\n", __FUNCTION__); -+ -+ ptxmgmt->action_code = TDLS_SETUP_CONFIRM; -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(&padapter->mlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ ret = _SUCCESS; -+exit: -+ -+ return ret; -+ -+} -+ -+/* TDLS Discovery Response frame is a management action frame */ -+int issue_tdls_dis_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 privacy) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ int ret = _FAIL; -+ -+ DBG_871X("[TDLS] %s\n", __FUNCTION__); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ /* unicast probe request frame */ -+ _rtw_memcpy(pwlanhdr->addr1, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->dst, pwlanhdr->addr1, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, pwlanhdr->addr2, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, pwlanhdr->addr3, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof (struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof (struct rtw_ieee80211_hdr_3addr); -+ -+ rtw_build_tdls_dis_rsp_ies(padapter, pmgntframe, pframe, ptxmgmt, privacy); -+ -+ pattrib->nr_frags = 1; -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+int issue_tdls_peer_traffic_rsp(_adapter *padapter, struct sta_info *ptdls_sta, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ int ret = _FAIL; -+ -+ DBG_871X("[TDLS] %s\n", __FUNCTION__); -+ -+ ptxmgmt->action_code = TDLS_PEER_TRAFFIC_RESPONSE; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) !=_SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ -+exit: -+ -+ return ret; -+} -+ -+int issue_tdls_peer_traffic_indication(_adapter *padapter, struct sta_info *ptdls_sta) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct tdls_txmgmt txmgmt; -+ int ret = _FAIL; -+ -+ DBG_871X("[TDLS] %s\n", __FUNCTION__); -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ txmgmt.action_code = TDLS_PEER_TRAFFIC_INDICATION; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ /* PTI frame's priority should be AC_VO */ -+ pattrib->priority = 7; -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ -+exit: -+ -+ return ret; -+} -+ -+int issue_tdls_ch_switch_req(_adapter *padapter, struct sta_info *ptdls_sta) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct tdls_txmgmt txmgmt; -+ int ret = _FAIL; -+ -+ DBG_871X("[TDLS] %s\n", __FUNCTION__); -+ -+ if (padapter->tdlsinfo.ch_switch_prohibited == _TRUE) -+ { DBG_871X("[TDLS] Ignore %s since ch_switch_prohibited = _TRUE\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ txmgmt.action_code = TDLS_CHANNEL_SWITCH_REQUEST; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) !=_SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+exit: -+ -+ return ret; -+} -+ -+int issue_tdls_ch_switch_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ int ret = _FAIL; -+ -+ DBG_871X("[TDLS] %s\n", __FUNCTION__); -+ -+ if (padapter->tdlsinfo.ch_switch_prohibited == _TRUE) -+ { DBG_871X("[TDLS] Ignore %s since ch_switch_prohibited = _TRUE\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ ptxmgmt->action_code = TDLS_CHANNEL_SWITCH_RESPONSE; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+/* -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ if(xmitframe_enqueue_for_tdls_sleeping_sta(padapter, pmgntframe)==_TRUE){ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ return _FALSE; -+ } -+*/ -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) !=_SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ if (wait_ack) { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ ret = _SUCCESS; -+exit: -+ -+ return ret; -+} -+ -+int On_TDLS_Dis_Rsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct sta_info *ptdls_sta = NULL, *psta = rtw_get_stainfo(&(padapter->stapriv), get_bssid(&(padapter->mlmepriv))); -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ u8 *ptr = precv_frame->u.hdr.rx_data, *psa; -+ struct rx_pkt_attrib *pattrib = &(precv_frame->u.hdr.attrib); -+ struct tdls_info *ptdlsinfo = &(padapter->tdlsinfo); -+ u8 empty_addr[ETH_ALEN] = { 0x00 }; -+ int UndecoratedSmoothedPWDB; -+ struct tdls_txmgmt txmgmt; -+ int ret = _SUCCESS; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ /* WFDTDLS: for sigma test, not to setup direct link automatically */ -+ ptdlsinfo->dev_discovered = _TRUE; -+ -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), psa); -+ if (ptdls_sta != NULL) -+ ptdls_sta->sta_stats.rx_tdls_disc_rsp_pkts++; -+ -+#ifdef CONFIG_TDLS_AUTOSETUP -+ if (ptdls_sta != NULL) { -+ /* Record the tdls sta with lowest signal strength */ -+ if (ptdlsinfo->sta_maximum == _TRUE && ptdls_sta->alive_count >= 1 ) { -+ if (_rtw_memcmp(ptdlsinfo->ss_record.macaddr, empty_addr, ETH_ALEN)) { -+ _rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN); -+ ptdlsinfo->ss_record.RxPWDBAll = pattrib->phy_info.RxPWDBAll; -+ } else { -+ if (ptdlsinfo->ss_record.RxPWDBAll < pattrib->phy_info.RxPWDBAll) { -+ _rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN); -+ ptdlsinfo->ss_record.RxPWDBAll = pattrib->phy_info.RxPWDBAll; -+ } -+ } -+ } -+ } else { -+ if (ptdlsinfo->sta_maximum == _TRUE) { -+ if (_rtw_memcmp( ptdlsinfo->ss_record.macaddr, empty_addr, ETH_ALEN)) { -+ /* All traffics are busy, do not set up another direct link. */ -+ ret = _FAIL; -+ goto exit; -+ } else { -+ if (pattrib->phy_info.RxPWDBAll > ptdlsinfo->ss_record.RxPWDBAll) { -+ _rtw_memcpy(txmgmt.peer, ptdlsinfo->ss_record.macaddr, ETH_ALEN); -+ /* issue_tdls_teardown(padapter, ptdlsinfo->ss_record.macaddr, _FALSE); */ -+ } else { -+ ret = _FAIL; -+ goto exit; -+ } -+ } -+ } -+ -+ rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); -+ -+ if (pattrib->phy_info.RxPWDBAll + TDLS_SIGNAL_THRESH >= UndecoratedSmoothedPWDB) { -+ DBG_871X("pattrib->RxPWDBAll=%d, pdmpriv->UndecoratedSmoothedPWDB=%d\n", pattrib->phy_info.RxPWDBAll, UndecoratedSmoothedPWDB); -+ _rtw_memcpy(txmgmt.peer, psa, ETH_ALEN); -+ issue_tdls_setup_req(padapter, &txmgmt, _FALSE); -+ } -+ } -+#endif /* CONFIG_TDLS_AUTOSETUP */ -+ -+exit: -+ return ret; -+ -+} -+ -+sint On_TDLS_Setup_Req(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ u8 *psa, *pmyid; -+ struct sta_info *ptdls_sta= NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ _irqL irqL; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *prsnie, *ppairwise_cipher; -+ u8 i, k; -+ u8 ccmp_included=0, rsnie_included=0; -+ u16 j, pairwise_count; -+ u8 SNonce[32]; -+ u32 timeout_interval = TPK_RESEND_COUNT; -+ sint parsing_length; /* Frame body length, without icv_len */ -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE = 5; -+ unsigned char supportRate[16]; -+ int supportRateNum = 0; -+ struct tdls_txmgmt txmgmt; -+ -+ if (ptdlsinfo->ap_prohibited == _TRUE) -+ goto exit; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ pmyid = adapter_mac_addr(padapter); -+ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN; -+ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len -+ -prx_pkt_attrib->hdrlen -+ -prx_pkt_attrib->iv_len -+ -prx_pkt_attrib->icv_len -+ -LLC_HEADER_SIZE -+ -ETH_TYPE_LEN -+ -PAYLOAD_TYPE_LEN -+ -FIXED_IE; -+ -+ if (ptdls_sta == NULL) { -+ ptdls_sta = rtw_alloc_stainfo(pstapriv, psa); -+ } else { -+ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { -+ /* If the direct link is already set up */ -+ /* Process as re-setup after tear down */ -+ DBG_871X("re-setup a direct link\n"); -+ } -+ /* Already receiving TDLS setup request */ -+ else if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) { -+ DBG_871X("receive duplicated TDLS setup request frame in handshaking\n"); -+ goto exit; -+ } -+ /* When receiving and sending setup_req to the same link at the same time */ -+ /* STA with higher MAC_addr would be initiator */ -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) { -+ DBG_871X("receive setup_req after sending setup_req\n"); -+ for (i=0;i<6;i++){ -+ if(*(pmyid+i)==*(psa+i)){ -+ } -+ else if(*(pmyid+i)>*(psa+i)){ -+ ptdls_sta->tdls_sta_state = TDLS_INITIATOR_STATE; -+ break; -+ }else if(*(pmyid+i)<*(psa+i)){ -+ goto exit; -+ } -+ } -+ } -+ } -+ -+ if (ptdls_sta) { -+ txmgmt.dialog_token = *(ptr+2); /* Copy dialog token */ -+ txmgmt.status_code = _STATS_SUCCESSFUL_; -+ -+ /* Parsing information element */ -+ for (j=FIXED_IE; jElementID) { -+ case _SUPPORTEDRATES_IE_: -+ _rtw_memcpy(supportRate, pIE->data, pIE->Length); -+ supportRateNum = pIE->Length; -+ break; -+ case _COUNTRY_IE_: -+ break; -+ case _EXT_SUPPORTEDRATES_IE_: -+ if (supportRateNum<=sizeof(supportRate)) { -+ _rtw_memcpy(supportRate+supportRateNum, pIE->data, pIE->Length); -+ supportRateNum += pIE->Length; -+ } -+ break; -+ case _SUPPORTED_CH_IE_: -+ break; -+ case _RSN_IE_2_: -+ rsnie_included=1; -+ if (prx_pkt_attrib->encrypt) { -+ prsnie=(u8*)pIE; -+ /* Check CCMP pairwise_cipher presence. */ -+ ppairwise_cipher=prsnie+10; -+ _rtw_memcpy(ptdls_sta->TDLS_RSNIE, pIE->data, pIE->Length); -+ pairwise_count = *(u16*)(ppairwise_cipher-2); -+ for (k=0; kencrypt) -+ _rtw_memcpy(SNonce, (ptr+j+52), 32); -+ break; -+ case _TIMEOUT_ITVL_IE_: -+ if (prx_pkt_attrib->encrypt) -+ timeout_interval = cpu_to_le32(*(u32*)(ptr+j+3)); -+ break; -+ case _RIC_Descriptor_IE_: -+ break; -+#ifdef CONFIG_80211N_HT -+ case _HT_CAPABILITY_IE_: -+ rtw_tdls_process_ht_cap(padapter, ptdls_sta, pIE->data, pIE->Length); -+ break; -+#endif -+#ifdef CONFIG_80211AC_VHT -+ case EID_AID: -+ break; -+ case EID_VHTCapability: -+ rtw_tdls_process_vht_cap(padapter, ptdls_sta, pIE->data, pIE->Length); -+ break; -+#endif -+ case EID_BSSCoexistence: -+ break; -+ case _LINK_ID_IE_: -+ if (_rtw_memcmp(get_bssid(pmlmepriv), pIE->data, 6) == _FALSE) -+ txmgmt.status_code=_STATS_NOT_IN_SAME_BSS_; -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ /* Check status code */ -+ /* If responder STA has/hasn't security on AP, but request hasn't/has RSNIE, it should reject */ -+ if (txmgmt.status_code == _STATS_SUCCESSFUL_) { -+ if (rsnie_included && prx_pkt_attrib->encrypt == 0) -+ txmgmt.status_code = _STATS_SEC_DISABLED_; -+ else if (rsnie_included==0 && prx_pkt_attrib->encrypt) -+ txmgmt.status_code = _STATS_INVALID_PARAMETERS_; -+ -+#ifdef CONFIG_WFD -+ /* WFD test plan version 0.18.2 test item 5.1.5 */ -+ /* SoUT does not use TDLS if AP uses weak security */ -+ if (padapter->wdinfo.wfd_tdls_enable && (rsnie_included && prx_pkt_attrib->encrypt != _AES_)) -+ txmgmt.status_code = _STATS_SEC_DISABLED_; -+#endif /* CONFIG_WFD */ -+ } -+ -+ ptdls_sta->tdls_sta_state|= TDLS_INITIATOR_STATE; -+ if (prx_pkt_attrib->encrypt) { -+ _rtw_memcpy(ptdls_sta->SNonce, SNonce, 32); -+ -+ if (timeout_interval <= 300) -+ ptdls_sta->TDLS_PeerKey_Lifetime = TPK_RESEND_COUNT; -+ else -+ ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval; -+ } -+ -+ /* Update station supportRate */ -+ ptdls_sta->bssratelen = supportRateNum; -+ _rtw_memcpy(ptdls_sta->bssrateset, supportRate, supportRateNum); -+ -+ if (!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) -+ ptdlsinfo->sta_cnt++; -+ /* -2: AP + BC/MC sta, -4: default key */ -+ if (ptdlsinfo->sta_cnt == MAX_ALLOWED_TDLS_STA_NUM) -+ ptdlsinfo->sta_maximum = _TRUE; -+ -+#ifdef CONFIG_WFD -+ rtw_tdls_process_wfd_ie(ptdlsinfo, ptr + FIXED_IE, parsing_length - FIXED_IE); -+#endif /* CONFIG_WFD */ -+ -+ }else { -+ goto exit; -+ } -+ -+ _rtw_memcpy(txmgmt.peer, prx_pkt_attrib->src, ETH_ALEN); -+ -+ if (rtw_tdls_is_driver_setup(padapter)) { -+ issue_tdls_setup_rsp(padapter, &txmgmt); -+ -+ if (txmgmt.status_code==_STATS_SUCCESSFUL_) { -+ _set_timer( &ptdls_sta->handshake_timer, TDLS_HANDSHAKE_TIME); -+ }else { -+ free_tdls_sta(padapter, ptdls_sta); -+ } -+ } -+ -+exit: -+ -+ return _SUCCESS; -+} -+ -+int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct sta_info *ptdls_sta= NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ _irqL irqL; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *psa; -+ u16 status_code=0; -+ sint parsing_length; /* Frame body length, without icv_len */ -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE =7; -+ u8 ANonce[32]; -+ u8 *pftie=NULL, *ptimeout_ie=NULL, *plinkid_ie=NULL, *prsnie=NULL, *pftie_mic=NULL, *ppairwise_cipher=NULL; -+ u16 pairwise_count, j, k; -+ u8 verify_ccmp=0; -+ unsigned char supportRate[16]; -+ int supportRateNum = 0; -+ struct tdls_txmgmt txmgmt; -+ int ret = _SUCCESS; -+ u32 timeout_interval = TPK_RESEND_COUNT; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ if (NULL == ptdls_sta) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN; -+ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len -+ -prx_pkt_attrib->hdrlen -+ -prx_pkt_attrib->iv_len -+ -prx_pkt_attrib->icv_len -+ -LLC_HEADER_SIZE -+ -ETH_TYPE_LEN -+ -PAYLOAD_TYPE_LEN -+ -FIXED_IE; -+ -+ _rtw_memcpy(&status_code, ptr+2, 2); -+ -+ if (status_code != 0) { -+ DBG_871X( "[TDLS] %s status_code = %d, free_tdls_sta\n", __FUNCTION__, status_code ); -+ free_tdls_sta(padapter, ptdls_sta); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ status_code = 0; -+ -+ /* parsing information element */ -+ for (j = FIXED_IE; jElementID) { -+ case _SUPPORTEDRATES_IE_: -+ _rtw_memcpy(supportRate, pIE->data, pIE->Length); -+ supportRateNum = pIE->Length; -+ break; -+ case _COUNTRY_IE_: -+ break; -+ case _EXT_SUPPORTEDRATES_IE_: -+ if (supportRateNum<=sizeof(supportRate)) { -+ _rtw_memcpy(supportRate+supportRateNum, pIE->data, pIE->Length); -+ supportRateNum += pIE->Length; -+ } -+ break; -+ case _SUPPORTED_CH_IE_: -+ break; -+ case _RSN_IE_2_: -+ prsnie=(u8*)pIE; -+ /* Check CCMP pairwise_cipher presence. */ -+ ppairwise_cipher=prsnie+10; -+ _rtw_memcpy(&pairwise_count, (u16*)(ppairwise_cipher-2), 2); -+ for (k=0;kwmm_enable == _TRUE) || (padapter->mlmepriv.htpriv.ht_option == _TRUE)) -+ ptdls_sta->qos_option = _TRUE; -+ } -+ break; -+ case _FTIE_: -+ pftie=(u8*)pIE; -+ _rtw_memcpy(ANonce, (ptr+j+20), 32); -+ break; -+ case _TIMEOUT_ITVL_IE_: -+ ptimeout_ie=(u8*)pIE; -+ timeout_interval = cpu_to_le32(*(u32*)(ptimeout_ie+3)); -+ break; -+ case _RIC_Descriptor_IE_: -+ break; -+#ifdef CONFIG_80211N_HT -+ case _HT_CAPABILITY_IE_: -+ rtw_tdls_process_ht_cap(padapter, ptdls_sta, pIE->data, pIE->Length); -+ break; -+#endif -+#ifdef CONFIG_80211AC_VHT -+ case EID_AID: -+ /* todo in the future if necessary */ -+ break; -+ case EID_VHTCapability: -+ rtw_tdls_process_vht_cap(padapter, ptdls_sta, pIE->data, pIE->Length); -+ break; -+ case EID_OpModeNotification: -+ rtw_process_vht_op_mode_notify(padapter, pIE->data, ptdls_sta); -+ break; -+#endif -+ case EID_BSSCoexistence: -+ break; -+ case _LINK_ID_IE_: -+ plinkid_ie=(u8*)pIE; -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ ptdls_sta->bssratelen = supportRateNum; -+ _rtw_memcpy(ptdls_sta->bssrateset, supportRate, supportRateNum); -+ _rtw_memcpy(ptdls_sta->ANonce, ANonce, 32); -+ -+#ifdef CONFIG_WFD -+ rtw_tdls_process_wfd_ie(ptdlsinfo, ptr + FIXED_IE, parsing_length - FIXED_IE); -+#endif /* CONFIG_WFD */ -+ -+ if (status_code != _STATS_SUCCESSFUL_) { -+ txmgmt.status_code = status_code; -+ } else { -+ if (prx_pkt_attrib->encrypt) { -+ if (verify_ccmp == 1) { -+ txmgmt.status_code = _STATS_SUCCESSFUL_; -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { -+ wpa_tdls_generate_tpk(padapter, ptdls_sta); -+ if (tdls_verify_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie) == _FAIL) { -+ DBG_871X( "[TDLS] %s tdls_verify_mic fail, free_tdls_sta\n", __FUNCTION__); -+ free_tdls_sta(padapter, ptdls_sta); -+ ret = _FAIL; -+ goto exit; -+ } -+ ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval; -+ } -+ } -+ else -+ { -+ txmgmt.status_code = _STATS_INVALID_RSNIE_; -+ } -+ -+ }else{ -+ txmgmt.status_code = _STATS_SUCCESSFUL_; -+ } -+ } -+ -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { -+ _rtw_memcpy(txmgmt.peer, prx_pkt_attrib->src, ETH_ALEN); -+ issue_tdls_setup_cfm(padapter, &txmgmt); -+ -+ if (txmgmt.status_code == _STATS_SUCCESSFUL_) { -+ ptdlsinfo->link_established = _TRUE; -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) { -+ ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; -+ ptdls_sta->state |= _FW_LINKED; -+ _cancel_timer_ex( &ptdls_sta->handshake_timer); -+ } -+ -+ if (prx_pkt_attrib->encrypt) -+ rtw_tdls_set_key(padapter, ptdls_sta); -+ -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ESTABLISHED); -+ -+ } -+ } -+ -+exit: -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) -+ return ret; -+ else -+ return _SUCCESS; -+ -+} -+ -+int On_TDLS_Setup_Cfm(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct sta_info *ptdls_sta= NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ _irqL irqL; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *psa; -+ u16 status_code=0; -+ sint parsing_length; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE =5; -+ u8 *pftie=NULL, *ptimeout_ie=NULL, *plinkid_ie=NULL, *prsnie=NULL, *pftie_mic=NULL, *ppairwise_cipher=NULL; -+ u16 j, pairwise_count; -+ int ret = _SUCCESS; -+ -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ if (ptdls_sta == NULL) { -+ DBG_871X("[%s] Direct Link Peer = "MAC_FMT" not found\n", __FUNCTION__, MAC_ARG(psa)); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN; -+ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len -+ -prx_pkt_attrib->hdrlen -+ -prx_pkt_attrib->iv_len -+ -prx_pkt_attrib->icv_len -+ -LLC_HEADER_SIZE -+ -ETH_TYPE_LEN -+ -PAYLOAD_TYPE_LEN -+ -FIXED_IE; -+ -+ _rtw_memcpy(&status_code, ptr+2, 2); -+ -+ if (status_code!= 0) { -+ DBG_871X("[%s] status_code = %d\n, free_tdls_sta", __FUNCTION__, status_code); -+ free_tdls_sta(padapter, ptdls_sta); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* Parsing information element */ -+ for (j = FIXED_IE; j < parsing_length;) { -+ -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j); -+ -+ switch (pIE->ElementID) { -+ case _RSN_IE_2_: -+ prsnie = (u8 *)pIE; -+ break; -+ case _VENDOR_SPECIFIC_IE_: -+ if (_rtw_memcmp((u8 *)pIE + 2, WMM_PARA_OUI, 6) == _TRUE) { -+ /* WMM Parameter ID and OUI */ -+ ptdls_sta->qos_option = _TRUE; -+ } -+ break; -+ case _FTIE_: -+ pftie = (u8 *)pIE; -+ break; -+ case _TIMEOUT_ITVL_IE_: -+ ptimeout_ie = (u8 *)pIE; -+ break; -+#ifdef CONFIG_80211N_HT -+ case _HT_EXTRA_INFO_IE_: -+ break; -+#endif -+#ifdef CONFIG_80211AC_VHT -+ case EID_VHTOperation: -+ break; -+ case EID_OpModeNotification: -+ rtw_process_vht_op_mode_notify(padapter, pIE->data, ptdls_sta); -+ break; -+#endif -+ case _LINK_ID_IE_: -+ plinkid_ie = (u8 *)pIE; -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ if (prx_pkt_attrib->encrypt) { -+ /* Verify mic in FTIE MIC field */ -+ if (rtw_tdls_is_driver_setup(padapter) && -+ (tdls_verify_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie) == _FAIL)) { -+ free_tdls_sta(padapter, ptdls_sta); -+ ret = _FAIL; -+ goto exit; -+ } -+ } -+ -+ if (rtw_tdls_is_driver_setup(padapter)) { -+ ptdlsinfo->link_established = _TRUE; -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) { -+ ptdls_sta->tdls_sta_state|=TDLS_LINKED_STATE; -+ ptdls_sta->state |= _FW_LINKED; -+ _cancel_timer_ex(&ptdls_sta->handshake_timer); -+ } -+ -+ if (prx_pkt_attrib->encrypt) { -+ rtw_tdls_set_key(padapter, ptdls_sta); -+ -+ /* Start TPK timer */ -+ ptdls_sta->TPK_count = 0; -+ _set_timer(&ptdls_sta->TPK_timer, ONE_SEC); -+ } -+ -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ESTABLISHED); -+ } -+ -+exit: -+ return ret; -+ -+} -+ -+int On_TDLS_Dis_Req(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta_ap; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ sint parsing_length; /* Frame body length, without icv_len */ -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE = 3, *dst; -+ u16 j; -+ struct tdls_txmgmt txmgmt; -+ int ret = _SUCCESS; -+ -+ if (rtw_tdls_is_driver_setup(padapter) == _FALSE) -+ goto exit; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN; -+ txmgmt.dialog_token = *(ptr+2); -+ _rtw_memcpy(&txmgmt.peer, precv_frame->u.hdr.attrib.src, ETH_ALEN); -+ txmgmt.action_code = TDLS_DISCOVERY_RESPONSE; -+ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len -+ -prx_pkt_attrib->hdrlen -+ -prx_pkt_attrib->iv_len -+ -prx_pkt_attrib->icv_len -+ -LLC_HEADER_SIZE -+ -ETH_TYPE_LEN -+ -PAYLOAD_TYPE_LEN -+ -FIXED_IE; -+ -+ /* Parsing information element */ -+ for (j=FIXED_IE; jElementID) { -+ case _LINK_ID_IE_: -+ psta_ap = rtw_get_stainfo(pstapriv, pIE->data); -+ if (psta_ap == NULL) -+ goto exit; -+ dst = pIE->data + 12; -+ if (MacAddr_isBcst(dst) == _FALSE && (_rtw_memcmp(adapter_mac_addr(padapter), dst, 6) == _FALSE)) -+ goto exit; -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ issue_tdls_dis_rsp(padapter, &txmgmt, prx_pkt_attrib->privacy); -+ -+exit: -+ return ret; -+ -+} -+ -+int On_TDLS_Teardown(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ u8 *psa; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta= NULL; -+ _irqL irqL; -+ u8 reason; -+ -+ reason = *(ptr + prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN + 2); -+ DBG_871X("[TDLS] %s Reason code(%d)\n", __FUNCTION__,reason); -+ -+ psa = get_sa(ptr); -+ -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ if (ptdls_sta != NULL) { -+ if (rtw_tdls_is_driver_setup(padapter)) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_TEAR_STA); -+ } -+ -+ return _SUCCESS; -+ -+} -+ -+#if 0 -+u8 TDLS_check_ch_state(uint state){ -+ if (state & TDLS_CH_SWITCH_ON_STATE && -+ state & TDLS_PEER_AT_OFF_STATE) { -+ if (state & TDLS_PEER_SLEEP_STATE) -+ return 2; /* U-APSD + ch. switch */ -+ else -+ return 1; /* ch. switch */ -+ }else -+ return 0; -+} -+#endif -+ -+int On_TDLS_Peer_Traffic_Indication(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->src); -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct tdls_txmgmt txmgmt; -+ -+ ptr +=pattrib->hdrlen + pattrib->iv_len+LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN; -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ -+ if (ptdls_sta != NULL) { -+ txmgmt.dialog_token = *(ptr+2); -+ issue_tdls_peer_traffic_rsp(padapter, ptdls_sta, &txmgmt); -+ //issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 0, 0, 0); -+ } else { -+ DBG_871X("from unknown sta:"MAC_FMT"\n", MAC_ARG(pattrib->src)); -+ return _FAIL; -+ } -+ -+ return _SUCCESS; -+} -+ -+/* We process buffered data for 1. U-APSD, 2. ch. switch, 3. U-APSD + ch. switch here */ -+int On_TDLS_Peer_Traffic_Rsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->src); -+ u8 wmmps_ac=0; -+ /* u8 state=TDLS_check_ch_state(ptdls_sta->tdls_sta_state); */ -+ int i; -+ -+ ptdls_sta->sta_stats.rx_data_pkts++; -+ -+ ptdls_sta->tdls_sta_state &= ~(TDLS_WAIT_PTR_STATE); -+ -+ /* Check 4-AC queue bit */ -+ if (ptdls_sta->uapsd_vo || ptdls_sta->uapsd_vi || ptdls_sta->uapsd_be || ptdls_sta->uapsd_bk) -+ wmmps_ac=1; -+ -+ /* If it's a direct link and have buffered frame */ -+ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { -+ if (wmmps_ac) { -+ _irqL irqL; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe=NULL; -+ -+ _enter_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); -+ -+ xmitframe_phead = get_list_head(&ptdls_sta->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ /* transmit buffered frames */ -+ while (rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist) == _FALSE) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ xmitframe_plist = get_next(xmitframe_plist); -+ rtw_list_delete(&pxmitframe->list); -+ -+ ptdls_sta->sleepq_len--; -+ ptdls_sta->sleepq_ac_len--; -+ if (ptdls_sta->sleepq_len>0) { -+ pxmitframe->attrib.mdata = 1; -+ pxmitframe->attrib.eosp = 0; -+ } else { -+ pxmitframe->attrib.mdata = 0; -+ pxmitframe->attrib.eosp = 1; -+ } -+ pxmitframe->attrib.triggered = 1; -+ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ } -+ -+ if (ptdls_sta->sleepq_len==0) -+ DBG_871X("no buffered packets for tdls to xmit\n"); -+ else { -+ DBG_871X("error!psta->sleepq_len=%d\n", ptdls_sta->sleepq_len); -+ ptdls_sta->sleepq_len=0; -+ } -+ -+ _exit_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); -+ -+ } -+ -+ } -+ -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_TDLS_CH_SW -+sint On_TDLS_Ch_Switch_Req(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ struct sta_info *ptdls_sta= NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *psa; -+ sint parsing_length; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE = 4; -+ u16 j; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct tdls_txmgmt txmgmt; -+ u16 switch_time= CH_SWITCH_TIME * 1000, switch_timeout=CH_SWITCH_TIMEOUT * 1000; -+ -+ if (padapter->tdlsinfo.ch_switch_prohibited == _TRUE) -+ { DBG_871X("[TDLS] Ignore %s since ch_switch_prohibited = _TRUE\n", __FUNCTION__); -+ return _SUCCESS; -+ } -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ ptdls_sta->ch_switch_time=switch_time; -+ ptdls_sta->ch_switch_timeout=switch_timeout; -+ -+ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN; -+ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len -+ -prx_pkt_attrib->hdrlen -+ -prx_pkt_attrib->iv_len -+ -prx_pkt_attrib->icv_len -+ -LLC_HEADER_SIZE -+ -ETH_TYPE_LEN -+ -PAYLOAD_TYPE_LEN -+ -FIXED_IE; -+ -+ pchsw_info->off_ch_num = *(ptr + 2); -+ -+ if (*(ptr + 2) == 2) { -+ pchsw_info->off_ch_num = 11; -+ } -+ -+ if (pchsw_info->off_ch_num != pmlmeext->cur_channel) { -+ pchsw_info->delay_switch_back = _FALSE; -+ } -+ -+ /* Parsing information element */ -+ for (j=FIXED_IE; jElementID) { -+ case EID_SecondaryChnlOffset: -+ padapter->tdlsinfo.chsw_info.ch_offset = *(pIE->data); -+ break; -+ case _LINK_ID_IE_: -+ break; -+ case _CH_SWITCH_TIMING_: -+ ptdls_sta->ch_switch_time = (RTW_GET_LE16(pIE->data) >= CH_SWITCH_TIME * 1000) ? -+ RTW_GET_LE16(pIE->data) : CH_SWITCH_TIME * 1000; -+ ptdls_sta->ch_switch_timeout = (RTW_GET_LE16(pIE->data + 2) >= CH_SWITCH_TIMEOUT * 1000) ? -+ RTW_GET_LE16(pIE->data + 2) : CH_SWITCH_TIMEOUT * 1000; -+ DBG_871X("%s ch_switch_time:%d, ch_switch_timeout:%d\n" -+ , __FUNCTION__, RTW_GET_LE16(pIE->data), RTW_GET_LE16(pIE->data + 2)); -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ } -+ -+ /* Todo: check status */ -+ txmgmt.status_code = 0; -+ _rtw_memcpy(txmgmt.peer, psa, ETH_ALEN); -+ -+ ATOMIC_SET(&pchsw_info->chsw_on, _TRUE); -+ -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_RESP); -+ -+ return _SUCCESS; -+} -+ -+sint On_TDLS_Ch_Switch_Rsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ struct sta_info *ptdls_sta= NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *psa; -+ sint parsing_length; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE = 4; -+ u16 status_code, j, switch_time, switch_timeout; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ int ret = _SUCCESS; -+ -+ if (padapter->tdlsinfo.ch_switch_prohibited == _TRUE) -+ { DBG_871X("[TDLS] Ignore %s since ch_switch_prohibited = _TRUE\n", __FUNCTION__); -+ return _SUCCESS; -+ } -+ -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ /* If we receive Unsolicited TDLS Channel Switch Response when channel switch is running, */ -+ /* we will go back to base channel and terminate this channel switch procedure */ -+ if (ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) { -+ if (pmlmeext->cur_channel != rtw_get_oper_ch(padapter)) { -+ DBG_871X("receive unsolicited channel switch response \n"); -+ rtw_tdls_cmd(padapter, NULL, TDLS_CH_SW_BACK); -+ goto exit; -+ } -+ } -+ -+ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN; -+ parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len -+ -prx_pkt_attrib->hdrlen -+ -prx_pkt_attrib->iv_len -+ -prx_pkt_attrib->icv_len -+ -LLC_HEADER_SIZE -+ -ETH_TYPE_LEN -+ -PAYLOAD_TYPE_LEN -+ -FIXED_IE; -+ -+ _rtw_memcpy(&status_code, ptr+2, 2); -+ -+ if (status_code != 0) { -+ DBG_871X("[%s] status_code:%d\n", __FUNCTION__, status_code); -+ pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE); -+ ATOMIC_SET(&pchsw_info->chsw_on, _FALSE); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* Parsing information element */ -+ for (j = FIXED_IE; j < parsing_length;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr+ j); -+ -+ switch (pIE->ElementID) { -+ case _LINK_ID_IE_: -+ break; -+ case _CH_SWITCH_TIMING_: -+ _rtw_memcpy(&switch_time, pIE->data, 2); -+ if (switch_time > ptdls_sta->ch_switch_time) -+ _rtw_memcpy(&ptdls_sta->ch_switch_time, &switch_time, 2); -+ -+ _rtw_memcpy(&switch_timeout, pIE->data + 2, 2); -+ if (switch_timeout > ptdls_sta->ch_switch_timeout) -+ _rtw_memcpy(&ptdls_sta->ch_switch_timeout, &switch_timeout, 2); -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ } -+ -+ if ((pmlmeext->cur_channel == rtw_get_oper_ch(padapter)) && -+ (pchsw_info->ch_sw_state & TDLS_WAIT_CH_RSP_STATE)) { -+ ATOMIC_SET(&pchsw_info->chsw_on, _TRUE); -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW); -+ } -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_TDLS_CH_SW */ -+ -+#ifdef CONFIG_WFD -+void wfd_ie_tdls(_adapter * padapter, u8 *pframe, u32 *pktlen ) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->tdlsinfo.wfd_info; -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 wfdielen = 0; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* -+ * Commented by Albert 20110825 -+ * According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes -+ * 1. WFD Device Information -+ * 2. Associated BSSID ( Optional ) -+ * 3. Local IP Adress ( Optional ) -+ */ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ /* available for WFD session + Preferred TDLS + WSD ( WFD Service Discovery ) */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL -+ | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_WSD); -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate( pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ /* Local IP Address ATTR */ -+ wfdie[ wfdielen++ ] = WFD_ATTR_LOCAL_IP_ADDR; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0005); -+ wfdielen += 2; -+ -+ /* Version: */ -+ /* 0x01: Version1;IPv4 */ -+ wfdie[ wfdielen++ ] = 0x01; -+ -+ /* IPv4 Address */ -+ _rtw_memcpy( wfdie + wfdielen, pwfd_info->ip_address, 4 ); -+ wfdielen += 4; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, pktlen); -+ -+} -+#endif /* CONFIG_WFD */ -+ -+void rtw_build_tdls_setup_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta=rtw_get_stainfo( (&padapter->stapriv) , pattrib->dst); -+ -+ int i = 0 ; -+ u32 time; -+ u8 *pframe_head; -+ -+ /* SNonce */ -+ if (pattrib->encrypt) { -+ for (i=0;i<8;i++) { -+ time=rtw_get_current_time(); -+ _rtw_memcpy(&ptdls_sta->SNonce[4*i], (u8 *)&time, 4); -+ } -+ } -+ -+ pframe_head = pframe; /* For rtw_tdls_set_ht_cap() */ -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ -+ pframe = rtw_tdls_set_capability(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_sup_ch(&(padapter->mlmeextpriv), pframe, pattrib); -+ pframe = rtw_tdls_set_sup_reg_class(pframe, pattrib); -+ -+ if (pattrib->encrypt) -+ pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta); -+ -+ pframe = rtw_tdls_set_ext_cap(pframe, pattrib); -+ -+ if (pattrib->encrypt) { -+ pframe = rtw_tdls_set_ftie(ptxmgmt -+ , pframe -+ , pattrib -+ , NULL -+ , ptdls_sta->SNonce); -+ -+ pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta); -+ } -+ -+#ifdef CONFIG_80211N_HT -+ /* Sup_reg_classes(optional) */ -+ if (pregistrypriv->ht_enable == _TRUE) -+ pframe = rtw_tdls_set_ht_cap(padapter, pframe_head, pattrib); -+#endif -+ -+ pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib); -+ -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+ if ((pregistrypriv->wmm_enable == _TRUE) || (padapter->mlmepriv.htpriv.ht_option == _TRUE)) -+ pframe = rtw_tdls_set_qos_cap(pframe, pattrib); -+ -+#ifdef CONFIG_80211AC_VHT -+ if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) && (pregistrypriv->vht_enable == _TRUE) && (pmlmeext->cur_channel > 14)) { -+ pframe = rtw_tdls_set_aid(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_vht_cap(padapter, pframe, pattrib); -+ } -+#endif -+ -+#ifdef CONFIG_WFD -+ wfd_ie_tdls( padapter, pframe, &(pattrib->pktlen) ); -+#endif /* CONFIG_WFD */ -+ -+} -+ -+void rtw_build_tdls_setup_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta; -+ u8 k; /* for random ANonce */ -+ u8 *pftie=NULL, *ptimeout_ie = NULL, *plinkid_ie = NULL, *prsnie = NULL, *pftie_mic = NULL; -+ u32 time; -+ u8 *pframe_head; -+ -+ ptdls_sta = rtw_get_stainfo( &(padapter->stapriv) , pattrib->dst); -+ -+ if (ptdls_sta == NULL) -+ DBG_871X("[%s] %d ptdls_sta is NULL\n", __FUNCTION__, __LINE__); -+ -+ if (pattrib->encrypt && ptdls_sta != NULL) { -+ for (k=0;k<8;k++) { -+ time = rtw_get_current_time(); -+ _rtw_memcpy(&ptdls_sta->ANonce[4*k], (u8*)&time, 4); -+ } -+ } -+ -+ pframe_head = pframe; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt); -+ -+ if (ptxmgmt->status_code != 0) { -+ DBG_871X("[%s] status_code:%04x \n", __FUNCTION__, ptxmgmt->status_code); -+ return; -+ } -+ -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_capability(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_sup_ch(&(padapter->mlmeextpriv), pframe, pattrib); -+ pframe = rtw_tdls_set_sup_reg_class(pframe, pattrib); -+ -+ if (pattrib->encrypt) { -+ prsnie = pframe; -+ pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _FALSE, ptdls_sta); -+ } -+ -+ pframe = rtw_tdls_set_ext_cap(pframe, pattrib); -+ -+ if (pattrib->encrypt) { -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) -+ wpa_tdls_generate_tpk(padapter, ptdls_sta); -+ -+ pftie = pframe; -+ pftie_mic = pframe+4; -+ pframe = rtw_tdls_set_ftie(ptxmgmt -+ , pframe -+ , pattrib -+ , ptdls_sta->ANonce -+ , ptdls_sta->SNonce); -+ -+ ptimeout_ie = pframe; -+ pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _FALSE, ptdls_sta); -+ } -+ -+#ifdef CONFIG_80211N_HT -+ /* Sup_reg_classes(optional) */ -+ if (pregistrypriv->ht_enable == _TRUE) -+ pframe = rtw_tdls_set_ht_cap(padapter, pframe_head, pattrib); -+#endif -+ -+ pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib); -+ -+ plinkid_ie = pframe; -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ -+ /* Fill FTIE mic */ -+ if (pattrib->encrypt && rtw_tdls_is_driver_setup(padapter) == _TRUE) -+ wpa_tdls_ftie_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie, pftie_mic); -+ -+ if ((pregistrypriv->wmm_enable == _TRUE) || (padapter->mlmepriv.htpriv.ht_option == _TRUE)) -+ pframe = rtw_tdls_set_qos_cap(pframe, pattrib); -+ -+#ifdef CONFIG_80211AC_VHT -+ if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) && (pregistrypriv->vht_enable == _TRUE) && (pmlmeext->cur_channel > 14)) { -+ pframe = rtw_tdls_set_aid(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_vht_cap(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_vht_op_mode_notify(padapter, pframe, pattrib, pmlmeext->cur_bwmode); -+ } -+#endif -+ -+#ifdef CONFIG_WFD -+ wfd_ie_tdls( padapter, pframe, &(pattrib->pktlen) ); -+#endif /* CONFIG_WFD */ -+ -+} -+ -+void rtw_build_tdls_setup_cfm_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta=rtw_get_stainfo( (&padapter->stapriv) , pattrib->dst); -+ -+ unsigned int ie_len; -+ unsigned char *p; -+ u8 wmm_param_ele[24] = {0}; -+ u8 *pftie=NULL, *ptimeout_ie=NULL, *plinkid_ie=NULL, *prsnie=NULL, *pftie_mic=NULL; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ -+ if (ptxmgmt->status_code!=0) -+ return; -+ -+ if (pattrib->encrypt) { -+ prsnie = pframe; -+ pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta); -+ } -+ -+ if (pattrib->encrypt) { -+ pftie = pframe; -+ pftie_mic = pframe+4; -+ pframe = rtw_tdls_set_ftie(ptxmgmt -+ , pframe -+ , pattrib -+ , ptdls_sta->ANonce -+ , ptdls_sta->SNonce); -+ -+ ptimeout_ie = pframe; -+ pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta); -+ -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { -+ /* Start TPK timer */ -+ ptdls_sta->TPK_count=0; -+ _set_timer(&ptdls_sta->TPK_timer, ONE_SEC); -+ } -+ } -+ -+ /* HT operation; todo */ -+ -+ plinkid_ie = pframe; -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+ if (pattrib->encrypt && (rtw_tdls_is_driver_setup(padapter) == _TRUE)) -+ wpa_tdls_ftie_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie, pftie_mic); -+ -+ if (ptdls_sta->qos_option == _TRUE) -+ pframe = rtw_tdls_set_wmm_params(padapter, pframe, pattrib); -+ -+#ifdef CONFIG_80211AC_VHT -+ if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) && (pregistrypriv->vht_enable == _TRUE) -+ && (ptdls_sta->vhtpriv.vht_option == _TRUE) && (pmlmeext->cur_channel > 14)) { -+ pframe = rtw_tdls_set_vht_operation(padapter, pframe, pattrib, pmlmeext->cur_channel); -+ pframe = rtw_tdls_set_vht_op_mode_notify(padapter, pframe, pattrib, pmlmeext->cur_bwmode); -+ } -+#endif -+} -+ -+void rtw_build_tdls_teardown_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta = rtw_get_stainfo( &(padapter->stapriv) , pattrib->dst); -+ u8 *pftie = NULL, *pftie_mic = NULL, *plinkid_ie = NULL; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt); -+ -+ if (pattrib->encrypt) { -+ pftie = pframe; -+ pftie_mic = pframe + 4; -+ pframe = rtw_tdls_set_ftie(ptxmgmt -+ , pframe -+ , pattrib -+ , ptdls_sta->ANonce -+ , ptdls_sta->SNonce); -+ } -+ -+ plinkid_ie = pframe; -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+ if (pattrib->encrypt && (rtw_tdls_is_driver_setup(padapter) == _TRUE)) -+ wpa_tdls_teardown_ftie_mic(ptdls_sta->tpk.kck, plinkid_ie, ptxmgmt->status_code, 1, 4, pftie, pftie_mic); -+} -+ -+void rtw_build_tdls_dis_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+} -+ -+void rtw_build_tdls_dis_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, u8 privacy) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 *pframe_head, pktlen_index; -+ -+ pktlen_index = pattrib->pktlen; -+ pframe_head = pframe; -+ -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_PUBLIC); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_capability(padapter, pframe, pattrib); -+ -+ pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib); -+ -+ pframe = rtw_tdls_set_sup_ch(pmlmeext, pframe, pattrib); -+ -+ if (privacy) -+ pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _TRUE, NULL); -+ -+ pframe = rtw_tdls_set_ext_cap(pframe, pattrib); -+ -+ if (privacy) { -+ pframe = rtw_tdls_set_ftie(ptxmgmt, pframe, pattrib, NULL, NULL); -+ pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _TRUE, NULL); -+ } -+ -+#ifdef CONFIG_80211N_HT -+ if (pregistrypriv->ht_enable == _TRUE) -+ pframe = rtw_tdls_set_ht_cap(padapter, pframe_head - pktlen_index, pattrib); -+#endif -+ -+ pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ -+} -+ -+ -+void rtw_build_tdls_peer_traffic_indication_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 AC_queue=0; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+ /* PTI control */ -+ /* PU buffer status */ -+ if (ptdls_sta->uapsd_bk & BIT(1)) -+ AC_queue=BIT(0); -+ if (ptdls_sta->uapsd_be & BIT(1)) -+ AC_queue=BIT(1); -+ if (ptdls_sta->uapsd_vi & BIT(1)) -+ AC_queue=BIT(2); -+ if (ptdls_sta->uapsd_vo & BIT(1)) -+ AC_queue=BIT(3); -+ pframe = rtw_set_ie(pframe, _PTI_BUFFER_STATUS_, 1, &AC_queue, &(pattrib->pktlen)); -+ -+} -+ -+void rtw_build_tdls_peer_traffic_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+} -+ -+#ifdef CONFIG_TDLS_CH_SW -+void rtw_build_tdls_ch_switch_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); -+ u16 switch_time= CH_SWITCH_TIME * 1000, switch_timeout=CH_SWITCH_TIMEOUT * 1000; -+ -+ ptdls_sta->ch_switch_time=switch_time; -+ ptdls_sta->ch_switch_timeout=switch_timeout; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_target_ch(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_reg_class(pframe, pattrib, ptdls_sta); -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+ pframe = rtw_tdls_set_ch_sw(pframe, pattrib, ptdls_sta); -+ -+} -+ -+void rtw_build_tdls_ch_switch_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt); -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+ pframe = rtw_tdls_set_ch_sw(pframe, pattrib, ptdls_sta); -+} -+#endif -+ -+#ifdef CONFIG_WFD -+void rtw_build_tunneled_probe_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct wifidirect_info *pbuddy_wdinfo = &padapter->pbuddy_adapter->wdinfo; -+ u8 category = RTW_WLAN_CATEGORY_P2P; -+ u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a}; -+ u8 probe_req = 4; -+ u8 wfdielen = 0; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 3, WFA_OUI, &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(probe_req), &(pattrib->pktlen)); -+ -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ wfdielen = build_probe_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } else if (!rtw_p2p_chk_state(pbuddy_wdinfo, P2P_STATE_NONE)) { -+ wfdielen = build_probe_req_wfd_ie(pbuddy_wdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } -+ -+} -+ -+void rtw_build_tunneled_probe_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct wifidirect_info *pbuddy_wdinfo = &padapter->pbuddy_adapter->wdinfo; -+ u8 category = RTW_WLAN_CATEGORY_P2P; -+ u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a}; -+ u8 probe_rsp = 5; -+ u8 wfdielen = 0; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 3, WFA_OUI, &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(probe_rsp), &(pattrib->pktlen)); -+ -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ wfdielen = build_probe_resp_wfd_ie(pwdinfo, pframe, 1); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } else if (!rtw_p2p_chk_state(pbuddy_wdinfo, P2P_STATE_NONE)) { -+ wfdielen = build_probe_resp_wfd_ie(pbuddy_wdinfo, pframe, 1); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } -+ -+} -+#endif /* CONFIG_WFD */ -+ -+void _tdls_tpk_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ struct tdls_txmgmt txmgmt; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ ptdls_sta->TPK_count++; -+ /* TPK_timer expired in a second */ -+ /* Retry timer should set at least 301 sec. */ -+ if (ptdls_sta->TPK_count >= ptdls_sta->TDLS_PeerKey_Lifetime) { -+ DBG_871X("[TDLS] %s, Re-Setup TDLS link with "MAC_FMT" since TPK lifetime expires!\n", __FUNCTION__, MAC_ARG(ptdls_sta->hwaddr)); -+ ptdls_sta->TPK_count=0; -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); -+ issue_tdls_setup_req(ptdls_sta->padapter, &txmgmt, _FALSE); -+ } -+ -+ _set_timer(&ptdls_sta->TPK_timer, ONE_SEC); -+} -+ -+#ifdef CONFIG_TDLS_CH_SW -+void _tdls_ch_switch_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = ptdls_sta->padapter; -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ -+ //DBG_871X("%s %d, tdls_sta_state:0x%08x\n", __FUNCTION__, __LINE__, ptdls_sta->tdls_sta_state); -+ -+ if (padapter->mlmeextpriv.cur_channel != rtw_get_oper_ch(padapter)) { -+ if (!(pchsw_info->ch_sw_state & TDLS_PEER_AT_OFF_STATE)) { -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_BACK); -+ ATOMIC_SET(&pchsw_info->chsw_on, _FALSE); -+ DBG_871X("[TDLS] %s, can't get traffic from op_ch:%d\n", __FUNCTION__, rtw_get_oper_ch(padapter)); -+ } else { -+ //DBG_871X("%s %d\n", __FUNCTION__, __LINE__); -+ //_set_timer(&ptdls_sta->delay_timer, padapter->mlmeextpriv.mlmext_info.bcn_interval - 5 - ptdls_sta->ch_switch_timeout/1000); -+ } -+ } else { -+ //DBG_871X("%s %d, op_ch:%d, tdls_state:0x%08x\n", __FUNCTION__, __LINE__, rtw_get_oper_ch(padapter), ptdls_sta->tdls_sta_state); -+ } -+ -+#if 0 -+ if (!(pchsw_info->ch_sw_state & TDLS_PEER_AT_OFF_STATE)) { -+ //SelectChannel(padapter, padapter->mlmeextpriv.cur_channel); -+ ATOMIC_SET(&pchsw_info->chsw_on, _FALSE); -+ DBG_871X("%s %d, op_ch:%d, tdls_state:0x%08x\n", __FUNCTION__, __LINE__, rtw_get_oper_ch(padapter), ptdls_sta->tdls_sta_state); -+ } -+ -+ if (pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE) { -+ if (padapter->mlmeextpriv.cur_channel != rtw_get_oper_ch(padapter)) { -+ DBG_871X("%s %d\n", __FUNCTION__, __LINE__); -+ _set_timer(&ptdls_sta->delay_timer, padapter->mlmeextpriv.mlmext_info.bcn_interval - 5 - ptdls_sta->ch_switch_timeout/1000); -+ //_set_timer(&ptdls_sta->delay_timer, 1000); -+ } else { -+ DBG_871X("%s %d\n", __FUNCTION__, __LINE__); -+ issue_tdls_ch_switch_req(padapter, ptdls_sta); -+ //_set_timer(&ptdls_sta->delay_timer, 500); -+ } -+ } -+#endif -+} -+ -+void _tdls_delay_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = ptdls_sta->padapter; -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ -+ DBG_871X("[TDLS] %s, op_ch:%d, tdls_state:0x%08x\n", __FUNCTION__, rtw_get_oper_ch(padapter), ptdls_sta->tdls_sta_state); -+ pchsw_info->delay_switch_back = _TRUE; -+} -+#endif -+ -+void _tdls_handshake_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = ptdls_sta->padapter; -+ struct tdls_txmgmt txmgmt; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); -+ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; -+ -+ if (ptdls_sta != NULL) { -+ DBG_871X("[TDLS] Handshake time out\n"); -+ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) -+ { -+ issue_tdls_teardown(padapter, &txmgmt, _TRUE); -+ } -+ else -+ { -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_TEAR_STA); -+ } -+ } -+} -+ -+void _tdls_pti_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = ptdls_sta->padapter; -+ struct tdls_txmgmt txmgmt; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); -+ txmgmt.status_code = _RSON_TDLS_TEAR_TOOFAR_; -+ -+ if (ptdls_sta != NULL) { -+ if (ptdls_sta->tdls_sta_state & TDLS_WAIT_PTR_STATE) { -+ DBG_871X("[TDLS] Doesn't receive PTR from peer dev:"MAC_FMT"; " -+ "Send TDLS Tear Down\n", MAC_ARG(ptdls_sta->hwaddr)); -+ issue_tdls_teardown(padapter, &txmgmt, _FALSE); -+ } -+ } -+} -+ -+void rtw_init_tdls_timer(_adapter *padapter, struct sta_info *psta) -+{ -+ psta->padapter=padapter; -+ _init_timer(&psta->TPK_timer, padapter->pnetdev, _tdls_tpk_timer_hdl, psta); -+#ifdef CONFIG_TDLS_CH_SW -+ _init_timer(&psta->ch_sw_timer, padapter->pnetdev, _tdls_ch_switch_timer_hdl, psta); -+ _init_timer(&psta->delay_timer, padapter->pnetdev, _tdls_delay_timer_hdl, psta); -+#endif -+ _init_timer(&psta->handshake_timer, padapter->pnetdev, _tdls_handshake_timer_hdl, psta); -+ _init_timer(&psta->pti_timer, padapter->pnetdev, _tdls_pti_timer_hdl, psta); -+} -+ -+void rtw_free_tdls_timer(struct sta_info *psta) -+{ -+ _cancel_timer_ex(&psta->TPK_timer); -+#ifdef CONFIG_TDLS_CH_SW -+ _cancel_timer_ex(&psta->ch_sw_timer); -+ _cancel_timer_ex(&psta->delay_timer); -+#endif -+ _cancel_timer_ex(&psta->handshake_timer); -+ _cancel_timer_ex(&psta->pti_timer); -+} -+ -+u8 update_sgi_tdls(_adapter *padapter, struct sta_info *psta) -+{ -+ return query_ra_short_GI(psta); -+} -+ -+u32 update_mask_tdls(_adapter *padapter, struct sta_info *psta) -+{ -+ unsigned char sta_band = 0; -+ unsigned int tx_ra_bitmap=0; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ tx_ra_bitmap = psta->ra_mask; -+ -+ if (pcur_network->Configuration.DSConfig > 14) { -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_5N | WIRELESS_11A; -+ else -+ sta_band |= WIRELESS_11A; -+ } else { -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_24N | WIRELESS_11G | WIRELESS_11B; -+ else if (tx_ra_bitmap & 0xff0) -+ sta_band |= WIRELESS_11G |WIRELESS_11B; -+ else -+ sta_band |= WIRELESS_11B; -+ } -+ -+ psta->wireless_mode = sta_band; -+ -+ psta->raid = rtw_hal_networktype_to_raid(padapter,psta); -+ tx_ra_bitmap |= ((psta->raid<<28)&0xf0000000); -+ return tx_ra_bitmap; -+} -+ -+int rtw_tdls_is_driver_setup(_adapter *padapter) -+{ -+ return padapter->tdlsinfo.driver_setup; -+} -+ -+const char * rtw_tdls_action_txt(enum TDLS_ACTION_FIELD action) -+{ -+ switch (action) { -+ case TDLS_SETUP_REQUEST: -+ return "TDLS_SETUP_REQUEST"; -+ case TDLS_SETUP_RESPONSE: -+ return "TDLS_SETUP_RESPONSE"; -+ case TDLS_SETUP_CONFIRM: -+ return "TDLS_SETUP_CONFIRM"; -+ case TDLS_TEARDOWN: -+ return "TDLS_TEARDOWN"; -+ case TDLS_PEER_TRAFFIC_INDICATION: -+ return "TDLS_PEER_TRAFFIC_INDICATION"; -+ case TDLS_CHANNEL_SWITCH_REQUEST: -+ return "TDLS_CHANNEL_SWITCH_REQUEST"; -+ case TDLS_CHANNEL_SWITCH_RESPONSE: -+ return "TDLS_CHANNEL_SWITCH_RESPONSE"; -+ case TDLS_PEER_PSM_REQUEST: -+ return "TDLS_PEER_PSM_REQUEST"; -+ case TDLS_PEER_PSM_RESPONSE: -+ return "TDLS_PEER_PSM_RESPONSE"; -+ case TDLS_PEER_TRAFFIC_RESPONSE: -+ return "TDLS_PEER_TRAFFIC_RESPONSE"; -+ case TDLS_DISCOVERY_REQUEST: -+ return "TDLS_DISCOVERY_REQUEST"; -+ case TDLS_DISCOVERY_RESPONSE: -+ return "TDLS_DISCOVERY_RESPONSE"; -+ default: -+ return "UNKNOWN"; -+ } -+} -+ -+#endif /* CONFIG_TDLS */ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/core/rtw_vht.c ---- linux.old/3rdparty/rtl8812au/core/rtw_vht.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_vht.c 2017-06-07 23:07:21.005687029 +0300 -@@ -0,0 +1,793 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_tdls.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_tdls.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_tdls.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_tdls.c 2018-02-06 17:42:30.700967016 +0200 +@@ -0,0 +1,2922 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -74890,10 +50447,2931 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++#define _RTW_TDLS_C_ ++ ++#include ++#include "rtw_mlme.h" ++ ++#ifdef CONFIG_TDLS ++extern void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame); ++extern s32 rtw_dump_xframe(_adapter *padapter, struct xmit_frame *pxmitframe); ++ ++void rtw_reset_tdls_info(_adapter* padapter) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ ++ ptdlsinfo->ap_prohibited = false; ++ ptdlsinfo->setup_state = TDLS_STATE_NONE; ++ ptdlsinfo->sta_cnt = 0; ++ ptdlsinfo->sta_maximum = false; ++ ptdlsinfo->macid_index= 6; ++ ptdlsinfo->clear_cam= 0; ++ ptdlsinfo->ch_sensing = 0; ++ ptdlsinfo->cur_channel = 0; ++ ptdlsinfo->candidate_ch = 1; //when inplement channel switching, default candidate channel is 1 ++ ptdlsinfo->watchdog_count = 0; ++ ptdlsinfo->dev_discovered = 0; ++ ++#ifdef CONFIG_WFD ++ ptdlsinfo->wfd_info = &padapter->wfd_info; ++#endif //CONFIG_WFD ++} ++ ++int rtw_init_tdls_info(_adapter* padapter) ++{ ++ int res = _SUCCESS; ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ ++ ptdlsinfo->enable = 1; ++ rtw_reset_tdls_info(padapter); ++ ++ _rtw_spinlock_init(&ptdlsinfo->cmd_lock); ++ _rtw_spinlock_init(&ptdlsinfo->hdl_lock); ++ ++ return res; ++ ++} ++ ++void rtw_free_tdls_info(struct tdls_info *ptdlsinfo) ++{ ++ _rtw_spinlock_free(&ptdlsinfo->cmd_lock); ++ _rtw_spinlock_free(&ptdlsinfo->hdl_lock); ++ ++ _rtw_memset(ptdlsinfo, 0, sizeof(struct tdls_info) ); ++ ++} ++ ++void issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, struct sta_info *ptdls_sta, unsigned int power_mode) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ return; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++// SetToDs(fctrl); ++ if (power_mode) ++ { ++ SetPwrMgt(fctrl); ++ } ++ ++ _rtw_memcpy(pwlanhdr->addr1, ptdls_sta->hwaddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority]++; ++ ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority] &= 0xFFF; ++ pattrib->seqnum = ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority]; ++ SetSeqNum(pwlanhdr, pattrib->seqnum); ++ ++ SetFrameSubType(pframe, WIFI_DATA_NULL); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ dump_mgntframe(padapter, pmgntframe); ++ ++ return; ++} ++ ++s32 update_tdls_attrib(_adapter *padapter, struct pkt_attrib *pattrib) ++{ ++ ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct qos_priv *pqospriv= &pmlmepriv->qospriv; ++ ++ s32 res=_SUCCESS; ++ sint bmcast; ++ ++ bmcast = IS_MCAST(pattrib->ra); ++ ++ psta = rtw_get_stainfo(pstapriv, pattrib->ra); ++ if (psta == NULL) { ++ res =_FAIL; ++ goto exit; ++ } ++ ++ pattrib->mac_id = psta->mac_id; ++ ++ pattrib->psta = psta; ++ ++ pattrib->ack_policy = 0; ++ // get ether_hdr_len ++ pattrib->pkt_hdrlen = ETH_HLEN;//(pattrib->ether_type == 0x8100) ? (14 + 4 ): 14; //vlan tag ++ ++ if (pqospriv->qos_option && psta->qos_option) { ++ pattrib->priority = 1; //tdls management frame should be AC_BK ++ pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN; ++ pattrib->subtype = WIFI_QOS_DATA_TYPE; ++ } else { ++ pattrib->hdrlen = WLAN_HDR_A3_LEN; ++ pattrib->subtype = WIFI_DATA_TYPE; ++ pattrib->priority = 0; ++ } ++ ++ if (psta->ieee8021x_blocked == true) ++ { ++ pattrib->encrypt = 0; ++ } ++ else ++ { ++ GET_ENCRY_ALGO(psecuritypriv, psta, pattrib->encrypt, bmcast); ++ ++ switch(psecuritypriv->dot11AuthAlgrthm) ++ { ++ case dot11AuthAlgrthm_Open: ++ case dot11AuthAlgrthm_Shared: ++ case dot11AuthAlgrthm_Auto: ++ pattrib->key_idx = (u8)psecuritypriv->dot11PrivacyKeyIndex; ++ break; ++ case dot11AuthAlgrthm_8021X: ++ pattrib->key_idx = 0; ++ break; ++ default: ++ pattrib->key_idx = 0; ++ break; ++ } ++ } ++ ++ switch (pattrib->encrypt) ++ { ++ case _WEP40_: ++ case _WEP104_: ++ pattrib->iv_len = 4; ++ pattrib->icv_len = 4; ++ break; ++ case _TKIP_: ++ pattrib->iv_len = 8; ++ pattrib->icv_len = 4; ++ if(padapter->securitypriv.busetkipkey==_FAIL) ++ { ++ res =_FAIL; ++ goto exit; ++ } ++ break; ++ case _AES_: ++ pattrib->iv_len = 8; ++ pattrib->icv_len = 8; ++ break; ++ default: ++ pattrib->iv_len = 0; ++ pattrib->icv_len = 0; ++ break; ++ } ++ ++ if (pattrib->encrypt && ++ ((padapter->securitypriv.sw_encrypt == true) || (psecuritypriv->hw_decrypted == false))) ++ { ++ pattrib->bswenc = true; ++ } else { ++ pattrib->bswenc = false; ++ } ++ ++ //qos_en, ht_en, init rate, ,bw, ch_offset, sgi ++ pattrib->qos_en = psta->qos_option; ++ pattrib->ht_en = psta->htpriv.ht_option; ++ pattrib->raid = psta->raid; ++ pattrib->bwmode = psta->htpriv.bwmode; ++ pattrib->ch_offset = psta->htpriv.ch_offset; ++ pattrib->sgi= psta->htpriv.sgi; ++ pattrib->ampdu_en = false; ++ ++ //if(pattrib->ht_en && psta->htpriv.ampdu_enable) ++ //{ ++ // if(psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) ++ // pattrib->ampdu_en = true; ++ //} ++ ++exit: ++ ++ return res; ++} ++ ++void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ _irqL irqL; ++ ++ //free peer sta_info ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ if(ptdlsinfo->sta_cnt != 0) ++ ptdlsinfo->sta_cnt--; ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ if( ptdlsinfo->sta_cnt < (NUM_STA - 2) ) // -2: AP + BC/MC sta ++ { ++ ptdlsinfo->sta_maximum = false; ++ _rtw_memset( &ptdlsinfo->ss_record, 0x00, sizeof(struct tdls_ss_record) ); ++ } ++ //ready to clear cam ++ if(ptdls_sta->mac_id!=0){ ++ ptdlsinfo->clear_cam=ptdls_sta->mac_id; ++ rtw_setstakey_cmd(padapter, (u8 *)ptdls_sta, true); ++ } ++ ++ if(ptdlsinfo->sta_cnt==0){ ++ rtw_tdls_cmd(padapter, myid(&(padapter->eeprompriv)), TDLS_RS_RCR); ++ ptdlsinfo->setup_state=TDLS_STATE_NONE; ++ } ++ else ++ DBG_871X("Remain tdls sta:%02x\n", ptdlsinfo->sta_cnt); ++ ++ rtw_free_stainfo(padapter, ptdls_sta); ++ ++} ++ ++// cam entry will be the same as mac_id ++void rtw_tdls_set_mac_id(struct tdls_info *ptdlsinfo, struct sta_info *ptdls_sta) ++{ ++ if(ptdls_sta->mac_id==0) ++ { ++ ptdls_sta->mac_id = ptdlsinfo->macid_index; ++ if( (++ptdlsinfo->macid_index) > (NUM_STA -2) ) ++ ptdlsinfo->macid_index= TDLS_INI_MACID_ENTRY; ++ } ++} ++ ++//TDLS encryption(if needed) will always be CCMP ++void rtw_tdls_set_key(_adapter *adapter, struct rx_pkt_attrib *prx_pkt_attrib, struct sta_info *ptdls_sta) ++{ ++ if(prx_pkt_attrib->encrypt) ++ { ++ ptdls_sta->dot118021XPrivacy=_AES_; ++ rtw_setstakey_cmd(adapter, (u8*)ptdls_sta, true); ++ } ++} ++ ++void rtw_tdls_process_ht_cap(_adapter *adapter, struct sta_info *ptdls_sta, u8 *data, u8 Length) ++{ ++ /* save HT capabilities in the sta object */ ++ _rtw_memset(&ptdls_sta->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap)); ++ if (data && Length >= sizeof(struct rtw_ieee80211_ht_cap) ) ++ { ++ ptdls_sta->flags |= WLAN_STA_HT; ++ ++ ptdls_sta->flags |= WLAN_STA_WME; ++ ++ _rtw_memcpy(&ptdls_sta->htpriv.ht_cap, data, sizeof(struct rtw_ieee80211_ht_cap)); ++ ++ } else ++ ptdls_sta->flags &= ~WLAN_STA_HT; ++ ++ if(ptdls_sta->flags & WLAN_STA_HT) ++ { ++ if(adapter->registrypriv.ht_enable == true) ++ { ++ ptdls_sta->htpriv.ht_option = true; ++ } ++ else ++ { ++ ptdls_sta->htpriv.ht_option = false; ++ ptdls_sta->stat_code = _STATS_FAILURE_; ++ } ++ } ++ ++ //HT related cap ++ if(ptdls_sta->htpriv.ht_option) ++ { ++ //check if sta supports rx ampdu ++ if(adapter->registrypriv.ampdu_enable==1) ++ ptdls_sta->htpriv.ampdu_enable = true; ++ ++ //check if sta support s Short GI ++ if(ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_20|IEEE80211_HT_CAP_SGI_40)) ++ { ++ ptdls_sta->htpriv.sgi = true; ++ } ++ ++ // bwmode would still followed AP's setting ++ if(ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) ++ { ++ ptdls_sta->htpriv.bwmode = adapter->mlmeextpriv.cur_bwmode; ++ ptdls_sta->htpriv.ch_offset = adapter->mlmeextpriv.cur_ch_offset; ++ } ++ } ++} ++ ++u8 *rtw_tdls_set_ht_cap(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ struct rtw_ieee80211_ht_cap ht_capie; ++ u8 rf_type; ++ ++ //HT capabilities ++ _rtw_memset(&ht_capie, 0, sizeof(struct rtw_ieee80211_ht_cap)); ++ ++ ht_capie.cap_info = IEEE80211_HT_CAP_SUP_WIDTH |IEEE80211_HT_CAP_SGI_20 |IEEE80211_HT_CAP_SM_PS | ++ IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_TX_STBC |IEEE80211_HT_CAP_DSSSCCK40; ++ ++ { ++ u32 rx_packet_offset, max_recvbuf_sz; ++ padapter->HalFunc.GetHalDefVarHandler(padapter, HAL_DEF_RX_PACKET_OFFSET, &rx_packet_offset); ++ padapter->HalFunc.GetHalDefVarHandler(padapter, HAL_DEF_MAX_RECVBUF_SZ, &max_recvbuf_sz); ++ if(max_recvbuf_sz-rx_packet_offset>(8191-256)) ++ ht_capie.cap_info = ht_capie.cap_info |IEEE80211_HT_CAP_MAX_AMSDU; ++ } ++ ++ ht_capie.ampdu_params_info = (IEEE80211_HT_CAP_AMPDU_FACTOR&0x03); ++ ++ padapter->HalFunc.GetHwRegHandler(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ switch(rf_type) ++ { ++ case RF_1T1R: ++ ht_capie.cap_info |= 0x0100;//RX STBC One spatial stream ++ _rtw_memcpy(ht_capie.supp_mcs_set, MCS_rate_1R, 16); ++ break; ++ ++ case RF_2T2R: ++ case RF_1T2R: ++ default: ++ ht_capie.cap_info|= 0x0200;//RX STBC two spatial stream ++ _rtw_memcpy(ht_capie.supp_mcs_set, MCS_rate_2R, 16); ++ break; ++ } ++ ++ return(rtw_set_ie(pframe, _HT_CAPABILITY_IE_, ++ sizeof(struct rtw_ieee80211_ht_cap), (unsigned char*)&ht_capie, &(pattrib->pktlen))); ++} ++ ++u8 *rtw_tdls_set_sup_ch(struct mlme_ext_priv *pmlmeext, u8 *pframe, struct pkt_attrib *pattrib) ++{ ++ u8 sup_ch[ 30 * 2 ] = { 0x00 }, sup_ch_idx = 0, idx_5g = 2; //For supported channel ++ do{ ++ if( pmlmeext->channel_set[sup_ch_idx].ChannelNum <= 14 ) ++ { ++ sup_ch[0] = 1; //First channel number ++ sup_ch[1] = pmlmeext->channel_set[sup_ch_idx].ChannelNum; //Number of channel ++ } ++ else ++ { ++ sup_ch[idx_5g++] = pmlmeext->channel_set[sup_ch_idx].ChannelNum; ++ sup_ch[idx_5g++] = 1; ++ } ++ ++ sup_ch_idx++; ++ } ++ while( pmlmeext->channel_set[sup_ch_idx].ChannelNum != 0 ); ++ return(rtw_set_ie(pframe, _SUPPORTED_CH_IE_, idx_5g, sup_ch, &(pattrib->pktlen))); ++} ++ ++#ifdef CONFIG_WFD ++void rtw_tdls_process_wfd_ie(struct tdls_info *ptdlsinfo, u8 *ptr, u8 length) ++{ ++ u8 wfd_ie[ 128 ] = { 0x00 }; ++ u32 wfd_ielen = 0; ++ u32 wfd_offset = 0; ++ // Try to get the TCP port information when receiving the negotiation response. ++ // ++ ++ wfd_offset = 0; ++ wfd_offset = rtw_get_wfd_ie( ptr + wfd_offset, length - wfd_offset, wfd_ie, &wfd_ielen ); ++ while( wfd_offset ) ++ { ++ u8 attr_content[ 10 ] = { 0x00 }; ++ u32 attr_contentlen = 0; ++ int i; ++ ++ DBG_871X( "[%s] WFD IE Found!!\n", __FUNCTION__ ); ++ rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, attr_content, &attr_contentlen); ++ if ( attr_contentlen ) ++ { ++ ptdlsinfo->wfd_info->peer_rtsp_ctrlport = RTW_GET_BE16( attr_content + 2 ); ++ DBG_871X( "[%s] Peer PORT NUM = %d\n", __FUNCTION__, ptdlsinfo->wfd_info->peer_rtsp_ctrlport ); ++ } ++ ++ _rtw_memset( attr_content, 0x00, 10); ++ attr_contentlen = 0; ++ rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_LOCAL_IP_ADDR, attr_content, &attr_contentlen); ++ if ( attr_contentlen ) ++ { ++ _rtw_memcpy(ptdlsinfo->wfd_info->peer_ip_address, ( attr_content + 1 ), 4); ++ DBG_871X( "[%s] Peer IP = %02u.%02u.%02u.%02u \n", __FUNCTION__, ++ ptdlsinfo->wfd_info->peer_ip_address[0], ptdlsinfo->wfd_info->peer_ip_address[1], ++ ptdlsinfo->wfd_info->peer_ip_address[2], ptdlsinfo->wfd_info->peer_ip_address[3] ++ ); ++ } ++ wfd_offset = rtw_get_wfd_ie( ptr + wfd_offset, length - wfd_offset, wfd_ie, &wfd_ielen ); ++ } ++} ++ ++void issue_tunneled_probe_req(_adapter *padapter) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ u8 baddr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ DBG_871X("[%s]\n", __FUNCTION__); ++ ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ return; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, baddr, ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel=pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TUNNELED_PROBE_REQ) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ rtw_dump_xframe(padapter, pmgntframe); ++ ++exit: ++ ++ return; ++} ++ ++void issue_tunneled_probe_rsp(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct rx_pkt_attrib *rx_pkt_pattrib = &precv_frame->u.hdr.attrib; ++ ++ DBG_871X("[%s]\n", __FUNCTION__); ++ ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ return; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, rx_pkt_pattrib->src, ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel=pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TUNNELED_PROBE_RSP) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ rtw_dump_xframe(padapter, pmgntframe); ++ ++exit: ++ ++ return; ++} ++#endif //CONFIG_WFD ++ ++void issue_tdls_setup_req(_adapter *padapter, u8 *mac_addr) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *ptdls_sta= NULL; ++ _irqL irqL; ++ static u8 dialogtoken = 0; ++ u32 timeout_interval= TPK_RESEND_COUNT * 1000; //retry timer should set at least 301 sec, using TPK_count counting 301 times. ++ ++ if(ptdlsinfo->ap_prohibited == true) ++ goto exit; ++ ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ return; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, mac_addr, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ ++ //init peer sta_info ++ ptdls_sta = rtw_get_stainfo(pstapriv, mac_addr); ++ if(ptdls_sta==NULL) ++ { ++ ptdls_sta = rtw_alloc_stainfo(pstapriv, mac_addr); ++ if(ptdls_sta) ++ { ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ if(!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) ++ ptdlsinfo->sta_cnt++; ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ if( ptdlsinfo->sta_cnt == (NUM_STA - 2) ) // -2: AP + BC/MC sta ++ { ++ ptdlsinfo->sta_maximum = true; ++ } ++ } ++ else ++ { ++ rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ } ++ ++ if(ptdls_sta){ ++ ptdls_sta->tdls_sta_state |= TDLS_RESPONDER_STATE; ++ //for tdls; ptdls_sta->aid is used to fill dialogtoken ++ ptdls_sta->dialog = dialogtoken; ++ dialogtoken = (dialogtoken+1)%256; ++ ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval; ++ _set_timer( &ptdls_sta->handshake_timer, TDLS_HANDSHAKE_TIME ); ++ } ++ ++ pattrib->qsel=pattrib->priority; ++ if(rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_SETUP_REQUEST) !=_SUCCESS ){ ++ rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ rtw_dump_xframe(padapter, pmgntframe); ++ ++exit: ++ ++ return; ++} ++ ++void issue_tdls_teardown(_adapter *padapter, u8 *mac_addr) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *ptdls_sta=NULL; ++ _irqL irqL; ++ ++ ptdls_sta = rtw_get_stainfo(pstapriv, mac_addr); ++ if(ptdls_sta==NULL){ ++ DBG_871X("issue tdls teardown unsuccessful\n"); ++ return; ++ }else{ ++ ptdls_sta->tdls_sta_state=TDLS_STATE_NONE; ++ } ++ ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ return; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, mac_addr, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel=pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_TEARDOWN) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ rtw_dump_xframe(padapter, pmgntframe); ++ ++ if(ptdls_sta->tdls_sta_state & TDLS_CH_SWITCH_ON_STATE){ ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CS_OFF); ++ } ++ ++ if( ptdls_sta->timer_flag == 1 ) ++ { ++ _enter_critical_bh(&(padapter->tdlsinfo.hdl_lock), &irqL); ++ ptdls_sta->timer_flag = 2; ++ _exit_critical_bh(&(padapter->tdlsinfo.hdl_lock), &irqL); ++ } ++ else ++ rtw_tdls_cmd(padapter, mac_addr, TDLS_FREE_STA ); ++ ++ ++exit: ++ ++ return; ++} ++ ++void issue_tdls_dis_req(_adapter *padapter, u8 *mac_addr) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ u8 baddr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ return; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ if(mac_addr == NULL) ++ _rtw_memcpy(pattrib->dst, baddr, ETH_ALEN); ++ else ++ _rtw_memcpy(pattrib->dst, mac_addr, ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel=pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_DISCOVERY_REQUEST) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ rtw_dump_xframe(padapter, pmgntframe); ++ DBG_871X("issue tdls dis req\n"); ++ ++exit: ++ ++ return; ++} ++ ++void issue_tdls_setup_rsp(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct rx_pkt_attrib *rx_pkt_pattrib = &precv_frame->u.hdr.attrib; ++ _irqL irqL; ++ ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ return; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, rx_pkt_pattrib->src, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->ra, rx_pkt_pattrib->bssid, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel=pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_SETUP_RESPONSE) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ rtw_dump_xframe(padapter, pmgntframe); ++ ++exit: ++ ++ return; ++ ++} ++ ++void issue_tdls_setup_cfm(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct sta_info *ptdls_sta=NULL; ++ _irqL irqL; ++ ++ struct rx_pkt_attrib *rx_pkt_pattrib = & precv_frame->u.hdr.attrib; ++ ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ return; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, rx_pkt_pattrib->src, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->ra, rx_pkt_pattrib->bssid, ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel=pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_SETUP_CONFIRM) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ ++ rtw_dump_xframe(padapter, pmgntframe); ++ ++exit: ++ ++ return; ++ ++} ++ ++//TDLS Discovery Response frame is a management action frame ++void issue_tdls_dis_rsp(_adapter *padapter, union recv_frame *precv_frame, u8 dialog) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ ++ struct rx_pkt_attrib *rx_pkt_pattrib = &precv_frame->u.hdr.attrib; ++ ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ return; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ // unicast probe request frame ++ _rtw_memcpy(pwlanhdr->addr1, rx_pkt_pattrib->src, ETH_ALEN); ++ _rtw_memcpy(pattrib->dst, pwlanhdr->addr1, ETH_ALEN); ++ ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ _rtw_memcpy(pattrib->src, pwlanhdr->addr2, ETH_ALEN); ++ ++ _rtw_memcpy(pwlanhdr->addr3, rx_pkt_pattrib->bssid, ETH_ALEN); ++ _rtw_memcpy(pattrib->ra, pwlanhdr->addr3, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof (struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof (struct rtw_ieee80211_hdr_3addr); ++ ++ rtw_build_tdls_dis_rsp_ies(padapter, pmgntframe, pframe, dialog); ++ ++ pattrib->nr_frags = 1; ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ return; ++} ++ ++void issue_tdls_peer_traffic_indication(_adapter *padapter, struct sta_info *ptdls_sta) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ ++ static u8 dialogtoken=0; ++ ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ return; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ //for tdls; pattrib->nr_frags is used to fill dialogtoken ++ ptdls_sta->dialog = dialogtoken; ++ dialogtoken = (dialogtoken+1)%256; ++ //PTI frame's priority should be AC_VO ++ pattrib->priority = 7; ++ ++ update_tdls_attrib(padapter, pattrib); ++ pattrib->qsel=pattrib->priority; ++ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_PEER_TRAFFIC_INDICATION) != _SUCCESS) { ++ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ rtw_dump_xframe(padapter, pmgntframe); ++ ++exit: ++ ++ return; ++} ++ ++void issue_tdls_ch_switch_req(_adapter *padapter, u8 *mac_addr) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ return; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, mac_addr, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ ++ pattrib->qsel=pattrib->priority; ++ if(rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_CHANNEL_SWITCH_REQUEST) !=_SUCCESS ){ ++ rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ rtw_dump_xframe(padapter, pmgntframe); ++ ++exit: ++ ++ return; ++} ++ ++void issue_tdls_ch_switch_rsp(_adapter *padapter, u8 *mac_addr) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ ++ _irqL irqL; ++ ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ return; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ ++ pmgntframe->frame_tag = DATA_FRAMETAG; ++ pattrib->ether_type = 0x890d; ++ ++ _rtw_memcpy(pattrib->dst, mac_addr, ETH_ALEN); ++ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ ++ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); ++ ++ update_tdls_attrib(padapter, pattrib); ++ ++ pattrib->qsel=pattrib->priority; ++/* ++ _enter_critical_bh(&pxmitpriv->lock, &irqL); ++ if(xmitframe_enqueue_for_tdls_sleeping_sta(padapter, pmgntframe)==true){ ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ return false; ++ } ++*/ ++ if(rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_CHANNEL_SWITCH_RESPONSE) !=_SUCCESS ){ ++ rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf); ++ rtw_free_xmitframe(pxmitpriv, pmgntframe); ++ goto exit; ++ } ++ rtw_dump_xframe(padapter, pmgntframe); ++ ++exit: ++ ++ return; ++} ++ ++sint On_TDLS_Dis_Rsp(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ struct sta_info *ptdls_sta = NULL, *psta = rtw_get_stainfo(&(adapter->stapriv), get_bssid(&(adapter->mlmepriv))); ++ struct recv_priv *precvpriv = &(adapter->recvpriv); ++ u8 *ptr = precv_frame->u.hdr.rx_data, *psa; ++ struct rx_pkt_attrib *pattrib = &(precv_frame->u.hdr.attrib); ++ struct tdls_info *ptdlsinfo = &(adapter->tdlsinfo); ++ u8 empty_addr[ETH_ALEN] = { 0x00 }; ++ int UndecoratedSmoothedPWDB; ++ ++ ++ //WFDTDLS: for sigma test, not to setup direct link automatically ++ ptdlsinfo->dev_discovered = 1; ++ ++#ifdef CONFIG_TDLS_AUTOSETUP ++ psa = get_sa(ptr); ++ ptdls_sta = rtw_get_stainfo(&(adapter->stapriv), psa); ++ ++ if(ptdls_sta != NULL) ++ { ++ ptdls_sta->tdls_sta_state |= TDLS_ALIVE_STATE; ++ ++ //Record the tdls sta with lowest signal strength ++ if( (ptdlsinfo->sta_maximum == true) && (ptdls_sta->alive_count >= 1) ) ++ { ++ if( _rtw_memcmp(ptdlsinfo->ss_record.macaddr, empty_addr, ETH_ALEN) ) ++ { ++ _rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN); ++ ptdlsinfo->ss_record.RxPWDBAll = pattrib->RxPWDBAll; ++ } ++ else ++ { ++ if( ptdlsinfo->ss_record.RxPWDBAll < pattrib->RxPWDBAll ) ++ { ++ _rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN); ++ ptdlsinfo->ss_record.RxPWDBAll = pattrib->RxPWDBAll; ++ } ++ } ++ } ++ ++ } ++ else ++ { ++ if( ptdlsinfo->sta_maximum == true) ++ { ++ if( _rtw_memcmp( ptdlsinfo->ss_record.macaddr, empty_addr, ETH_ALEN ) ) ++ { ++ //All traffics are busy, do not set up another direct link. ++ return _FAIL; ++ } ++ else ++ { ++ if( pattrib->RxPWDBAll > ptdlsinfo->ss_record.RxPWDBAll ) ++ { ++ issue_tdls_teardown(adapter, ptdlsinfo->ss_record.macaddr); ++ } ++ else ++ { ++ return _FAIL; ++ } ++ } ++ } ++ ++ adapter->HalFunc.GetHalDefVarHandler(adapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); ++ ++ if( pattrib->RxPWDBAll + TDLS_SIGNAL_THRESH >= UndecoratedSmoothedPWDB); ++ { ++ DBG_871X("pattrib->RxPWDBAll=%d, pdmpriv->UndecoratedSmoothedPWDB=%d\n", pattrib->RxPWDBAll, UndecoratedSmoothedPWDB); ++ issue_tdls_setup_req(adapter, psa); ++ } ++ } ++#endif //CONFIG_TDLS_AUTOSETUP ++ ++ return _SUCCESS; ++} ++ ++sint On_TDLS_Setup_Req(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; ++ u8 *psa, *pmyid; ++ struct sta_info *ptdls_sta= NULL; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ struct security_priv *psecuritypriv = &adapter->securitypriv; ++ _irqL irqL; ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ u8 *prsnie, *ppairwise_cipher; ++ u8 i, k, pairwise_count; ++ u8 ccmp_have=0, rsnie_have=0; ++ u16 j; ++ u8 SNonce[32]; ++ u32 *timeout_interval; ++ sint parsing_length; //frame body length, without icv_len ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 FIXED_IE = 5; ++ unsigned char supportRate[16]; ++ int supportRateNum = 0; ++ ++ psa = get_sa(ptr); ++ ptdls_sta = rtw_get_stainfo(pstapriv, psa); ++ ++ pmyid=myid(&(adapter->eeprompriv)); ++ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+TYPE_LENGTH_FIELD_SIZE+1; ++ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len ++ -prx_pkt_attrib->hdrlen ++ -prx_pkt_attrib->iv_len ++ -prx_pkt_attrib->icv_len ++ -LLC_HEADER_SIZE ++ -ETH_TYPE_LEN ++ -PAYLOAD_TYPE_LEN ++ -FIXED_IE; ++ ++ if(ptdlsinfo->ap_prohibited == true) ++ { ++ goto exit; ++ } ++ ++ if(ptdls_sta==NULL){ ++ ptdls_sta = rtw_alloc_stainfo(pstapriv, psa); ++ }else{ ++ if(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE){ ++ //If the direct link is already set up ++ //Process as re-setup after tear down ++ DBG_871X("re-setup a direct link\n"); ++ } ++ //already receiving TDLS setup request ++ else if(ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE){ ++ DBG_871X("receive duplicated TDLS setup request frame in handshaking\n"); ++ goto exit; ++ } ++ //When receiving and sending setup_req to the same link at the same time, STA with higher MAC_addr would be initiator ++ //following is to check out MAC_addr ++ else if(ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE){ ++ DBG_871X("receive setup_req after sending setup_req\n"); ++ for (i=0;i<6;i++){ ++ if(*(pmyid+i)==*(psa+i)){ ++ } ++ else if(*(pmyid+i)>*(psa+i)){ ++ goto exit; ++ }else if(*(pmyid+i)<*(psa+i)){ ++ ptdls_sta->tdls_sta_state=TDLS_INITIATOR_STATE; ++ break; ++ } ++ } ++ } ++ } ++ ++ if(ptdls_sta) ++ { ++ ptdls_sta->dialog = *(ptr+2); //copy dialog token ++ ptdls_sta->stat_code = 0; ++ ++ //parsing information element ++ for(j=FIXED_IE; jElementID) ++ { ++ case _SUPPORTEDRATES_IE_: ++ _rtw_memcpy(supportRate, pIE->data, pIE->Length); ++ supportRateNum = pIE->Length; ++ break; ++ case _COUNTRY_IE_: ++ break; ++ case _EXT_SUPPORTEDRATES_IE_: ++ if(supportRateNum<=sizeof(supportRate)) ++ { ++ _rtw_memcpy(supportRate+supportRateNum, pIE->data, pIE->Length); ++ supportRateNum += pIE->Length; ++ } ++ break; ++ case _SUPPORTED_CH_IE_: ++ break; ++ case _RSN_IE_2_: ++ rsnie_have=1; ++ if(prx_pkt_attrib->encrypt){ ++ prsnie=(u8*)pIE; ++ //check whether initiator STA has CCMP pairwise_cipher. ++ ppairwise_cipher=prsnie+10; ++ _rtw_memcpy(&pairwise_count, (u16*)(ppairwise_cipher-2), 1); ++ for(k=0;kstat_code=72; ++ } ++ } ++ break; ++ case _EXT_CAP_IE_: ++ break; ++ case _VENDOR_SPECIFIC_IE_: ++ break; ++ case _FTIE_: ++ if(prx_pkt_attrib->encrypt) ++ _rtw_memcpy(SNonce, (ptr+j+52), 32); ++ break; ++ case _TIMEOUT_ITVL_IE_: ++ if(prx_pkt_attrib->encrypt) ++ timeout_interval = (u32 *)(ptr+j+3); ++ break; ++ case _RIC_Descriptor_IE_: ++ break; ++ case _HT_CAPABILITY_IE_: ++ rtw_tdls_process_ht_cap(adapter, ptdls_sta, pIE->data, pIE->Length); ++ break; ++ case EID_BSSCoexistence: ++ break; ++ case _LINK_ID_IE_: ++ if(_rtw_memcmp(get_bssid(pmlmepriv), pIE->data, 6) == false) ++ { ++ //not in the same BSS ++ ptdls_sta->stat_code=7; ++ } ++ break; ++ default: ++ break; ++ } ++ ++ j += (pIE->Length + 2); ++ ++ } ++ ++ //update station supportRate ++ ptdls_sta->bssratelen = supportRateNum; ++ _rtw_memcpy(ptdls_sta->bssrateset, supportRate, supportRateNum); ++ ++ //check status code ++ //if responder STA has/hasn't security on AP, but request hasn't/has RSNIE, it should reject ++ if(ptdls_sta->stat_code == 0 ) ++ { ++ if(rsnie_have && (prx_pkt_attrib->encrypt==0)){ ++ //security disabled ++ ptdls_sta->stat_code = 5; ++ }else if(rsnie_have==0 && (prx_pkt_attrib->encrypt)){ ++ //request haven't RSNIE ++ ptdls_sta->stat_code = 38; ++ } ++ ++#ifdef CONFIG_WFD ++ //WFD test plan version 0.18.2 test item 5.1.5 ++ //SoUT does not use TDLS if AP uses weak security ++ if ( adapter->wdinfo.wfd_tdls_enable ) ++ { ++ if(rsnie_have && (prx_pkt_attrib->encrypt != _AES_)) ++ { ++ ptdls_sta->stat_code = 5; ++ } ++ } ++#endif //CONFIG_WFD ++ } ++ ++ ptdls_sta->tdls_sta_state|= TDLS_INITIATOR_STATE; ++ if(prx_pkt_attrib->encrypt){ ++ _rtw_memcpy(ptdls_sta->SNonce, SNonce, 32); ++ _rtw_memcpy(&(ptdls_sta->TDLS_PeerKey_Lifetime), timeout_interval, 4); ++ } ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ if(!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) ++ ptdlsinfo->sta_cnt++; ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ if( ptdlsinfo->sta_cnt == (NUM_STA - 2) ) // -2: AP + BC/MC sta ++ { ++ ptdlsinfo->sta_maximum = true; ++ } ++ ++#ifdef CONFIG_WFD ++ rtw_tdls_process_wfd_ie(ptdlsinfo, ptr + FIXED_IE, parsing_length - FIXED_IE); ++#endif // CONFIG_WFD ++ ++ } ++ else ++ { ++ goto exit; ++ } ++ ++ issue_tdls_setup_rsp(adapter, precv_frame); ++ ++ if(ptdls_sta->stat_code==0) ++ { ++ _set_timer( &ptdls_sta->handshake_timer, TDLS_HANDSHAKE_TIME); ++ } ++ else //status code!=0 ; setup unsuccess ++ { ++ free_tdls_sta(adapter, ptdls_sta); ++ } ++ ++exit: ++ ++ return _FAIL; ++} ++ ++sint On_TDLS_Setup_Rsp(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; ++ struct sta_info *ptdls_sta= NULL; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ _irqL irqL; ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ u8 *psa; ++ u16 stat_code; ++ sint parsing_length; //frame body length, without icv_len ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 FIXED_IE =7; ++ u8 *pftie, *ptimeout_ie, *plinkid_ie, *prsnie, *pftie_mic, *ppairwise_cipher; ++ u16 pairwise_count, j, k; ++ u8 verify_ccmp=0; ++ unsigned char supportRate[16]; ++ int supportRateNum = 0; ++ ++ psa = get_sa(ptr); ++ ptdls_sta = rtw_get_stainfo(pstapriv, psa); ++ ++ if ( NULL == ptdls_sta ) ++ { ++ return _FAIL; ++ } ++ ++ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+TYPE_LENGTH_FIELD_SIZE+1; ++ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len ++ -prx_pkt_attrib->hdrlen ++ -prx_pkt_attrib->iv_len ++ -prx_pkt_attrib->icv_len ++ -LLC_HEADER_SIZE ++ -TYPE_LENGTH_FIELD_SIZE ++ -1 ++ -FIXED_IE; ++ ++ _rtw_memcpy(&stat_code, ptr+2, 2); ++ ++ if(stat_code!=0) ++ { ++ DBG_871X( "[%s] status_code = %d, free_tdls_sta\n", __FUNCTION__, stat_code ); ++ free_tdls_sta(adapter, ptdls_sta); ++ return _FAIL; ++ } ++ ++ stat_code = 0; ++ ++ //parsing information element ++ for(j=FIXED_IE; jElementID) ++ { ++ case _SUPPORTEDRATES_IE_: ++ _rtw_memcpy(supportRate, pIE->data, pIE->Length); ++ supportRateNum = pIE->Length; ++ break; ++ case _COUNTRY_IE_: ++ break; ++ case _EXT_SUPPORTEDRATES_IE_: ++ if(supportRateNum<=sizeof(supportRate)) ++ { ++ _rtw_memcpy(supportRate+supportRateNum, pIE->data, pIE->Length); ++ supportRateNum += pIE->Length; ++ } ++ break; ++ case _SUPPORTED_CH_IE_: ++ break; ++ case _RSN_IE_2_: ++ prsnie=(u8*)pIE; ++ //check whether responder STA has CCMP pairwise_cipher. ++ ppairwise_cipher=prsnie+10; ++ _rtw_memcpy(&pairwise_count, (u16*)(ppairwise_cipher-2), 2); ++ for(k=0;kANonce, (ptr+j+20), 32); ++ break; ++ case _TIMEOUT_ITVL_IE_: ++ ptimeout_ie=(u8*)pIE; ++ break; ++ case _RIC_Descriptor_IE_: ++ break; ++ case _HT_CAPABILITY_IE_: ++ rtw_tdls_process_ht_cap(adapter, ptdls_sta, pIE->data, pIE->Length); ++ break; ++ case EID_BSSCoexistence: ++ break; ++ case _LINK_ID_IE_: ++ plinkid_ie=(u8*)pIE; ++ break; ++ default: ++ break; ++ } ++ ++ j += (pIE->Length + 2); ++ ++ } ++ ++ //update station supportRate ++ ptdls_sta->bssratelen = supportRateNum; ++ _rtw_memcpy(ptdls_sta->bssrateset, supportRate, supportRateNum); ++ ++#ifdef CONFIG_WFD ++ rtw_tdls_process_wfd_ie(ptdlsinfo, ptr + FIXED_IE, parsing_length - FIXED_IE); ++#endif // CONFIG_WFD ++ ++ if(stat_code != 0) ++ { ++ ptdls_sta->stat_code = stat_code; ++ } ++ else ++ { ++ if(prx_pkt_attrib->encrypt) ++ { ++ if(verify_ccmp==1) ++ { ++ wpa_tdls_generate_tpk(adapter, ptdls_sta); ++ ptdls_sta->stat_code=0; ++ if(tdls_verify_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie)==0) //0: Invalid, 1: valid ++ { ++ free_tdls_sta(adapter, ptdls_sta); ++ return _FAIL; ++ } ++ } ++ else ++ { ++ ptdls_sta->stat_code=72; //invalide contents of RSNIE ++ } ++ ++ }else{ ++ ptdls_sta->stat_code=0; ++ } ++ } ++ ++ DBG_871X("issue_tdls_setup_cfm\n"); ++ issue_tdls_setup_cfm(adapter, precv_frame); ++ ++ if(ptdls_sta->stat_code==0) ++ { ++ ptdlsinfo->setup_state = TDLS_LINKED_STATE; ++ ++ if( ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE ) ++ { ++ ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; ++ _cancel_timer_ex( &ptdls_sta->handshake_timer); ++#ifdef CONFIG_TDLS_AUTOCHECKALIVE ++ _set_timer( &ptdls_sta->alive_timer1, TDLS_ALIVE_TIMER_PH1); ++#endif //CONFIG_TDLS_AUTOSETUP ++ } ++ ++ rtw_tdls_set_mac_id(ptdlsinfo, ptdls_sta); ++ rtw_tdls_set_key(adapter, prx_pkt_attrib, ptdls_sta); ++ ++ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_WRCR); ++ ++ } ++ else //status code!=0 ; setup unsuccessful ++ { ++ free_tdls_sta(adapter, ptdls_sta); ++ } ++ ++ return _FAIL; ++ ++} ++ ++sint On_TDLS_Setup_Cfm(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; ++ struct sta_info *ptdls_sta= NULL; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ _irqL irqL; ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ u8 *psa; ++ u16 stat_code; ++ sint parsing_length; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 FIXED_IE =5; ++ u8 *pftie, *ptimeout_ie, *plinkid_ie, *prsnie, *pftie_mic, *ppairwise_cipher; ++ u16 j, pairwise_count; ++ ++ psa = get_sa(ptr); ++ ptdls_sta = rtw_get_stainfo(pstapriv, psa); ++ ++ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+TYPE_LENGTH_FIELD_SIZE+1; ++ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len ++ -prx_pkt_attrib->hdrlen ++ -prx_pkt_attrib->iv_len ++ -prx_pkt_attrib->icv_len ++ -LLC_HEADER_SIZE ++ -ETH_TYPE_LEN ++ -PAYLOAD_TYPE_LEN ++ -FIXED_IE; ++ _rtw_memcpy(&stat_code, ptr+2, 2); ++ ++ if(stat_code!=0){ ++ DBG_871X( "[%s] stat_code = %d\n, free_tdls_sta", __FUNCTION__, stat_code ); ++ free_tdls_sta(adapter, ptdls_sta); ++ return _FAIL; ++ } ++ ++ if(prx_pkt_attrib->encrypt){ ++ //parsing information element ++ for(j=FIXED_IE; jElementID) ++ { ++ case _RSN_IE_2_: ++ prsnie=(u8*)pIE; ++ break; ++ case _VENDOR_SPECIFIC_IE_: ++ break; ++ case _FTIE_: ++ pftie=(u8*)pIE; ++ break; ++ case _TIMEOUT_ITVL_IE_: ++ ptimeout_ie=(u8*)pIE; ++ break; ++ case _HT_EXTRA_INFO_IE_: ++ break; ++ case _LINK_ID_IE_: ++ plinkid_ie=(u8*)pIE; ++ break; ++ default: ++ break; ++ } ++ ++ j += (pIE->Length + 2); ++ ++ } ++ ++ //verify mic in FTIE MIC field ++ if(tdls_verify_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie)==0){ //0: Invalid, 1: Valid ++ free_tdls_sta(adapter, ptdls_sta); ++ return _FAIL; ++ } ++ ++ } ++ ++ ptdlsinfo->setup_state = TDLS_LINKED_STATE; ++ if( ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE ) ++ { ++ ptdls_sta->tdls_sta_state|=TDLS_LINKED_STATE; ++ _cancel_timer_ex( &ptdls_sta->handshake_timer); ++#ifdef CONFIG_TDLS_AUTOCHECKALIVE ++ _set_timer( &ptdls_sta->alive_timer1, TDLS_ALIVE_TIMER_PH1); ++#endif //CONFIG_TDLS_AUTOCHECKALIVE ++ } ++ ++ rtw_tdls_set_mac_id(ptdlsinfo, ptdls_sta); ++ rtw_tdls_set_key(adapter, prx_pkt_attrib, ptdls_sta); ++ ++ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_WRCR); ++ ++ return _FAIL; ++ ++} ++ ++sint On_TDLS_Dis_Req(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct sta_info *psta_ap; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ sint parsing_length; //frame body length, without icv_len ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 FIXED_IE = 3, *dst, *pdialog = NULL; ++ u16 j; ++ ++ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE+TYPE_LENGTH_FIELD_SIZE + 1; ++ pdialog=ptr+2; ++ ++ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len ++ -prx_pkt_attrib->hdrlen ++ -prx_pkt_attrib->iv_len ++ -prx_pkt_attrib->icv_len ++ -LLC_HEADER_SIZE ++ -TYPE_LENGTH_FIELD_SIZE ++ -1 ++ -FIXED_IE; ++ ++ //parsing information element ++ for(j=FIXED_IE; jElementID) ++ { ++ case _LINK_ID_IE_: ++ psta_ap = rtw_get_stainfo(pstapriv, pIE->data); ++ if(psta_ap == NULL) ++ { ++ goto exit; ++ } ++ dst = pIE->data + 12; ++ if( (MacAddr_isBcst(dst) == false) && (_rtw_memcmp(myid(&(adapter->eeprompriv)), dst, 6) == false) ) ++ { ++ goto exit; ++ } ++ break; ++ default: ++ break; ++ } ++ ++ j += (pIE->Length + 2); ++ ++ } ++ ++ //check frame contents ++ ++ issue_tdls_dis_rsp(adapter, precv_frame, *(pdialog) ); ++ ++exit: ++ ++ return _FAIL; ++ ++} ++ ++sint On_TDLS_Teardown(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ u8 *psa; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ struct sta_info *ptdls_sta= NULL; ++ _irqL irqL; ++ ++ psa = get_sa(ptr); ++ ++ ptdls_sta = rtw_get_stainfo(pstapriv, psa); ++ if(ptdls_sta!=NULL){ ++ if(ptdls_sta->tdls_sta_state & TDLS_CH_SWITCH_ON_STATE){ ++ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_CS_OFF); ++ } ++ free_tdls_sta(adapter, ptdls_sta); ++ } ++ ++ return _FAIL; ++ ++} ++ ++u8 TDLS_check_ch_state(uint state){ ++ if( (state & TDLS_CH_SWITCH_ON_STATE) && ++ (state & TDLS_AT_OFF_CH_STATE) && ++ (state & TDLS_PEER_AT_OFF_STATE) ){ ++ ++ if(state & TDLS_PEER_SLEEP_STATE) ++ return 2; //U-APSD + ch. switch ++ else ++ return 1; //ch. switch ++ }else ++ return 0; ++} ++ ++//we process buffered data for 1. U-APSD, 2. ch. switch, 3. U-APSD + ch. switch here ++sint On_TDLS_Peer_Traffic_Rsp(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ //get peer sta infomation ++ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->src); ++ u8 wmmps_ac=0, state=TDLS_check_ch_state(ptdls_sta->tdls_sta_state); ++ int i; ++ ++ ptdls_sta->sta_stats.rx_data_pkts++; ++ ++ //receive peer traffic response frame, sleeping STA wakes up ++ //ptdls_sta->tdls_sta_state &= ~(TDLS_PEER_SLEEP_STATE); ++ process_wmmps_data( adapter, precv_frame); ++ ++ // if noticed peer STA wakes up by receiving peer traffic response ++ // and we want to do channel swtiching, then we will transmit channel switch request first ++ if(ptdls_sta->tdls_sta_state & TDLS_APSD_CHSW_STATE){ ++ issue_tdls_ch_switch_req(adapter, pattrib->src); ++ ptdls_sta->tdls_sta_state &= ~(TDLS_APSD_CHSW_STATE); ++ return _FAIL; ++ } ++ ++ //check 4-AC queue bit ++ if(ptdls_sta->uapsd_vo || ptdls_sta->uapsd_vi || ptdls_sta->uapsd_be || ptdls_sta->uapsd_bk) ++ wmmps_ac=1; ++ ++ //if it's a direct link and have buffered frame ++ if(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE){ ++ if(wmmps_ac && state) ++ { ++ _irqL irqL; ++ _list *xmitframe_plist, *xmitframe_phead; ++ struct xmit_frame *pxmitframe=NULL; ++ ++ _enter_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); ++ ++ xmitframe_phead = get_list_head(&ptdls_sta->sleep_q); ++ xmitframe_plist = get_next(xmitframe_phead); ++ ++ //transmit buffered frames ++ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) ++ { ++ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); ++ xmitframe_plist = get_next(xmitframe_plist); ++ rtw_list_delete(&pxmitframe->list); ++ ++ ptdls_sta->sleepq_len--; ++ if(ptdls_sta->sleepq_len>0){ ++ pxmitframe->attrib.mdata = 1; ++ pxmitframe->attrib.eosp = 0; ++ }else{ ++ pxmitframe->attrib.mdata = 0; ++ pxmitframe->attrib.eosp = 1; ++ } ++ //pxmitframe->attrib.triggered = 1; //maybe doesn't need in TDLS ++ if(adapter->HalFunc.hal_xmit(adapter, pxmitframe) == true) ++ { ++ rtw_os_xmit_complete(adapter, pxmitframe); ++ } ++ ++ } ++ ++ if(ptdls_sta->sleepq_len==0) ++ { ++ DBG_871X("no buffered packets for tdls to xmit\n"); ++ //on U-APSD + CH. switch state, when there is no buffered date to xmit, ++ // we should go back to base channel ++ if(state==2){ ++ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_CS_OFF); ++ }else if(ptdls_sta->tdls_sta_state&TDLS_SW_OFF_STATE){ ++ ptdls_sta->tdls_sta_state &= ~(TDLS_SW_OFF_STATE); ++ ptdlsinfo->candidate_ch= pmlmeext->cur_channel; ++ issue_tdls_ch_switch_req(adapter, pattrib->src); ++ DBG_871X("issue tdls ch switch req back to base channel\n"); ++ } ++ ++ } ++ else ++ { ++ DBG_871X("error!psta->sleepq_len=%d\n", ptdls_sta->sleepq_len); ++ ptdls_sta->sleepq_len=0; ++ } ++ ++ _exit_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); ++ ++ } ++ ++ } ++ ++ return _FAIL; ++} ++ ++sint On_TDLS_Ch_Switch_Req(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ struct sta_info *ptdls_sta= NULL; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ u8 *psa; ++ sint parsing_length; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 FIXED_IE =3; ++ u16 j; ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ ++ psa = get_sa(ptr); ++ ptdls_sta = rtw_get_stainfo(pstapriv, psa); ++ ++ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+TYPE_LENGTH_FIELD_SIZE+1; ++ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len ++ -prx_pkt_attrib->hdrlen ++ -prx_pkt_attrib->iv_len ++ -prx_pkt_attrib->icv_len ++ -LLC_HEADER_SIZE ++ -ETH_TYPE_LEN ++ -PAYLOAD_TYPE_LEN ++ -FIXED_IE; ++ ++ ptdls_sta->off_ch = *(ptr+2); ++ ++ //parsing information element ++ for(j=FIXED_IE; jElementID) ++ { ++ case _COUNTRY_IE_: ++ break; ++ case _CH_SWTICH_ANNOUNCE_: ++ break; ++ case _LINK_ID_IE_: ++ break; ++ case _CH_SWITCH_TIMING_: ++ _rtw_memcpy(&ptdls_sta->ch_switch_time, pIE->data, 2); ++ _rtw_memcpy(&ptdls_sta->ch_switch_timeout, pIE->data+2, 2); ++ default: ++ break; ++ } ++ ++ j += (pIE->Length + 2); ++ ++ } ++ ++ //todo: check status ++ ptdls_sta->stat_code=0; ++ ptdls_sta->tdls_sta_state |= TDLS_CH_SWITCH_ON_STATE; ++ ++ issue_nulldata(adapter, NULL, 1, 0, 0); ++ ++ issue_tdls_ch_switch_rsp(adapter, psa); ++ ++ DBG_871X("issue tdls channel switch response\n"); ++ ++ if((ptdls_sta->tdls_sta_state & TDLS_CH_SWITCH_ON_STATE) && ptdls_sta->off_ch==pmlmeext->cur_channel){ ++ DBG_871X("back to base channel %x\n", pmlmeext->cur_channel); ++ ptdls_sta->option=7; ++ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_BASE_CH); ++ }else{ ++ ptdls_sta->option=6; ++ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_OFF_CH); ++ } ++ return _FAIL; ++} ++ ++sint On_TDLS_Ch_Switch_Rsp(_adapter *adapter, union recv_frame *precv_frame) ++{ ++ struct sta_info *ptdls_sta= NULL; ++ struct sta_priv *pstapriv = &adapter->stapriv; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; ++ u8 *psa; ++ sint parsing_length; ++ PNDIS_802_11_VARIABLE_IEs pIE; ++ u8 FIXED_IE =4; ++ u16 stat_code, j, switch_time, switch_timeout; ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ ++ psa = get_sa(ptr); ++ ptdls_sta = rtw_get_stainfo(pstapriv, psa); ++ ++ //if channel switch is running and receiving Unsolicited TDLS Channel Switch Response, ++ //it will go back to base channel and terminate this channel switch procedure ++ if(ptdls_sta->tdls_sta_state & TDLS_CH_SWITCH_ON_STATE ){ ++ if(pmlmeext->cur_channel==ptdls_sta->off_ch){ ++ DBG_871X("back to base channel %x\n", pmlmeext->cur_channel); ++ ptdls_sta->option=7; ++ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_OFF_CH); ++ }else{ ++ DBG_871X("receive unsolicited channel switch response \n"); ++ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_CS_OFF); ++ } ++ return _FAIL; ++ } ++ ++ //avoiding duplicated or unconditional ch. switch. rsp ++ if((ptdls_sta->tdls_sta_state & TDLS_CH_SW_INITIATOR_STATE) != TDLS_CH_SW_INITIATOR_STATE) ++ return _FAIL; ++ ++ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+TYPE_LENGTH_FIELD_SIZE+1; ++ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len ++ -prx_pkt_attrib->hdrlen ++ -prx_pkt_attrib->iv_len ++ -prx_pkt_attrib->icv_len ++ -LLC_HEADER_SIZE ++ -ETH_TYPE_LEN ++ -PAYLOAD_TYPE_LEN ++ -FIXED_IE; ++ ++ _rtw_memcpy(&stat_code, ptr+2, 2); ++ ++ if(stat_code!=0){ ++ return _FAIL; ++ } ++ ++ //parsing information element ++ for(j=FIXED_IE; jElementID) ++ { ++ case _LINK_ID_IE_: ++ break; ++ case _CH_SWITCH_TIMING_: ++ _rtw_memcpy(&switch_time, pIE->data, 2); ++ if(switch_time > ptdls_sta->ch_switch_time) ++ _rtw_memcpy(&ptdls_sta->ch_switch_time, &switch_time, 2); ++ ++ _rtw_memcpy(&switch_timeout, pIE->data+2, 2); ++ if(switch_timeout > ptdls_sta->ch_switch_timeout) ++ _rtw_memcpy(&ptdls_sta->ch_switch_timeout, &switch_timeout, 2); ++ ++ default: ++ break; ++ } ++ ++ j += (pIE->Length + 2); ++ ++ } ++ ++ ptdls_sta->tdls_sta_state &= ~(TDLS_CH_SW_INITIATOR_STATE); ++ ptdls_sta->tdls_sta_state |=TDLS_CH_SWITCH_ON_STATE; ++ ++ //goto set_channel_workitem_callback() ++ ptdls_sta->option=6; ++ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_OFF_CH); ++ ++ return _FAIL; ++} ++ ++#ifdef CONFIG_WFD ++void wfd_ie_tdls(_adapter * padapter, u8 *pframe, u32 *pktlen ) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wifi_display_info *pwfd_info = padapter->tdlsinfo.wfd_info; ++ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; ++ u32 wfdielen = 0; ++ ++ // WFD OUI ++ wfdielen = 0; ++ wfdie[ wfdielen++ ] = 0x50; ++ wfdie[ wfdielen++ ] = 0x6F; ++ wfdie[ wfdielen++ ] = 0x9A; ++ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 ++ ++ // Commented by Albert 20110825 ++ // According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes ++ // 1. WFD Device Information ++ // 2. Associated BSSID ( Optional ) ++ // 3. Local IP Adress ( Optional ) ++ ++ // WFD Device Information ATTR ++ // Type: ++ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; ++ ++ // Length: ++ // Note: In the WFD specification, the size of length field is 2. ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ // Value1: ++ // WFD device information ++ // available for WFD session + Preferred TDLS + WSD ( WFD Service Discovery ) ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL ++ | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_WSD); ++ wfdielen += 2; ++ ++ // Value2: ++ // Session Management Control Port ++ // Default TCP port for RTSP messages is 554 ++ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); ++ wfdielen += 2; ++ ++ // Value3: ++ // WFD Device Maximum Throughput ++ // 300Mbps is the maximum throughput ++ RTW_PUT_BE16(wfdie + wfdielen, 300); ++ wfdielen += 2; ++ ++ // Associated BSSID ATTR ++ // Type: ++ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; ++ ++ // Length: ++ // Note: In the WFD specification, the size of length field is 2. ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); ++ wfdielen += 2; ++ ++ // Value: ++ // Associated BSSID ++ if ( check_fwstate( pmlmepriv, _FW_LINKED) == true ) ++ { ++ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); ++ } ++ else ++ { ++ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); ++ } ++ ++ // Local IP Address ATTR ++ wfdie[ wfdielen++ ] = WFD_ATTR_LOCAL_IP_ADDR; ++ ++ // Length: ++ // Note: In the WFD specification, the size of length field is 2. ++ RTW_PUT_BE16(wfdie + wfdielen, 0x0005); ++ wfdielen += 2; ++ ++ // Version: ++ // 0x01: Version1;IPv4 ++ wfdie[ wfdielen++ ] = 0x01; ++ ++ // IPv4 Address ++ _rtw_memcpy( wfdie + wfdielen, pwfd_info->ip_address, 4 ); ++ wfdielen += 4; ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, pktlen); ++ ++} ++#endif //CONFIG_WFD ++ ++void rtw_build_tdls_setup_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct sta_info *ptdls_sta=rtw_get_stainfo( (&padapter->stapriv) , pattrib->dst); ++ ++ u8 payload_type = 0x02; ++ u8 category = RTW_WLAN_CATEGORY_TDLS; ++ u8 action = TDLS_SETUP_REQUEST; ++ u8 bssrate[NDIS_802_11_LENGTH_RATES_EX]; //Use NDIS_802_11_LENGTH_RATES_EX in order to call func.rtw_set_supported_rate ++ int bssrate_len = 0, i = 0 ; ++ u8 more_supportedrates = 0; ++ unsigned int ie_len; ++ u8 *p; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ u8 link_id_addr[18] = {0}; ++ u8 iedata=0; ++ u8 sup_ch[ 30 * 2 ] = {0x00 }, sup_ch_idx = 0, idx_5g = 2; //For supported channel ++ u8 timeout_itvl[5]; //set timeout interval to maximum value ++ u32 time; ++ ++ //SNonce ++ if(pattrib->encrypt){ ++ for(i=0;i<8;i++){ ++ time=rtw_get_current_time(); ++ _rtw_memcpy(&ptdls_sta->SNonce[4*i], (u8 *)&time, 4); ++ } ++ } ++ ++ //payload type ++ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); ++ //category, action, dialog token ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(ptdls_sta->dialog), &(pattrib->pktlen)); ++ ++ //capability ++ _rtw_memcpy(pframe, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); ++ ++ if(pattrib->encrypt) ++ *pframe =*pframe | BIT(4); ++ pframe += 2; ++ pattrib->pktlen += 2; ++ ++ //supported rates ++ rtw_set_supported_rate(bssrate, WIRELESS_11BG_24N); ++ bssrate_len = IEEE80211_CCK_RATE_LEN + IEEE80211_NUM_OFDM_RATESLEN; ++ ++ if (bssrate_len > 8) ++ { ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); ++ more_supportedrates = 1; ++ } ++ else ++ { ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); ++ } ++ ++ //country(optional) ++ //extended supported rates ++ if(more_supportedrates==1){ ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); ++ } ++ ++ //supported channels ++ pframe = rtw_tdls_set_sup_ch(pmlmeext, pframe, pattrib); ++ ++ // SRC IE ++ pframe = rtw_set_ie( pframe, _SRC_IE_, 16, TDLS_SRC, &(pattrib->pktlen)); ++ ++ //RSNIE ++ if(pattrib->encrypt) ++ pframe = rtw_set_ie(pframe, _RSN_IE_2_, 20, TDLS_RSNIE, &(pattrib->pktlen)); ++ ++ //extended capabilities ++ pframe = rtw_set_ie(pframe, _EXT_CAP_IE_ , 5, TDLS_EXT_CAPIE, &(pattrib->pktlen)); ++ ++ //QoS capability(WMM_IE) ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 7, TDLS_WMMIE, &(pattrib->pktlen)); ++ ++ ++ if(pattrib->encrypt){ ++ //FTIE ++ _rtw_memset(pframe, 0, 84); //All fields except SNonce shall be set to 0 ++ _rtw_memset(pframe, _FTIE_, 1); //version ++ _rtw_memset((pframe+1), 82, 1); //length ++ _rtw_memcpy((pframe+52), ptdls_sta->SNonce, 32); ++ pframe += 84; ++ pattrib->pktlen += 84; ++ ++ //Timeout interval ++ timeout_itvl[0]=0x02; ++ _rtw_memcpy(timeout_itvl+1, (u8 *)(&ptdls_sta->TDLS_PeerKey_Lifetime), 4); ++ pframe = rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); ++ } ++ ++ //Sup_reg_classes(optional) ++ //HT capabilities ++ pframe = rtw_tdls_set_ht_cap(padapter, pframe, pattrib); ++ ++ //20/40 BSS coexistence ++ if(pmlmepriv->num_FortyMHzIntolerant>0) ++ iedata |= BIT(2);//20 MHz BSS Width Request ++ pframe = rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); ++ ++ //Link identifier ++ _rtw_memcpy(link_id_addr, pattrib->ra, 6); ++ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); ++ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); ++ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); ++ ++#ifdef CONFIG_WFD ++ wfd_ie_tdls( padapter, pframe, &(pattrib->pktlen) ); ++#endif //CONFIG_WFD ++ ++} ++ ++void rtw_build_tdls_setup_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) ++{ ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct sta_info *ptdls_sta; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ ++ u8 payload_type = 0x02; ++ unsigned char category = RTW_WLAN_CATEGORY_TDLS; ++ unsigned char action = TDLS_SETUP_RESPONSE; ++ unsigned char bssrate[NDIS_802_11_LENGTH_RATES_EX]; ++ int bssrate_len = 0; ++ u8 more_supportedrates = 0; ++ unsigned int ie_len; ++ unsigned char *p; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ u8 link_id_addr[18] = {0}; ++ u8 iedata=0; ++ u8 timeout_itvl[5]; //setup response timeout interval will copy from request ++ u8 ANonce[32]; //maybe it can put in ontdls_req ++ u8 k; //for random ANonce ++ u8 *pftie, *ptimeout_ie, *plinkid_ie, *prsnie, *pftie_mic; ++ u32 time; ++ ++ ptdls_sta = rtw_get_stainfo( &(padapter->stapriv) , pattrib->dst); ++ ++ if(ptdls_sta == NULL ) ++ { ++ DBG_871X("[%s] %d\n", __FUNCTION__, __LINE__); ++ return; ++ } ++ ++ if(pattrib->encrypt){ ++ for(k=0;k<8;k++){ ++ time=rtw_get_current_time(); ++ _rtw_memcpy(&ptdls_sta->ANonce[4*k], (u8*)&time, 4); ++ } ++ } ++ ++ //payload type ++ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); ++ //category, action, status code ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&ptdls_sta->stat_code, &(pattrib->pktlen)); ++ ++ if(ptdls_sta->stat_code!=0) //invalid setup request ++ { ++ DBG_871X("ptdls_sta->stat_code:%04x \n", ptdls_sta->stat_code); ++ return; ++ } ++ ++ //dialog token ++ pframe = rtw_set_fixed_ie(pframe, 1, &(ptdls_sta->dialog), &(pattrib->pktlen)); ++ ++ //capability ++ _rtw_memcpy(pframe, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); ++ ++ if(pattrib->encrypt ) ++ *pframe =*pframe | BIT(4); ++ pframe += 2; ++ pattrib->pktlen += 2; ++ ++ //supported rates ++ rtw_set_supported_rate(bssrate, WIRELESS_11BG_24N); ++ bssrate_len = IEEE80211_CCK_RATE_LEN + IEEE80211_NUM_OFDM_RATESLEN; ++ ++ if (bssrate_len > 8) ++ { ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); ++ more_supportedrates = 1; ++ } ++ else ++ { ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); ++ } ++ ++ //country(optional) ++ //extended supported rates ++ if(more_supportedrates==1){ ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); ++ } ++ ++ //supported channels ++ pframe = rtw_tdls_set_sup_ch(pmlmeext, pframe, pattrib); ++ ++ // SRC IE ++ pframe = rtw_set_ie(pframe, _SRC_IE_ , 16, TDLS_SRC, &(pattrib->pktlen)); ++ ++ //RSNIE ++ if(pattrib->encrypt){ ++ prsnie = pframe; ++ pframe = rtw_set_ie(pframe, _RSN_IE_2_, 20, TDLS_RSNIE, &(pattrib->pktlen)); ++ } ++ ++ //extended capabilities ++ pframe = rtw_set_ie(pframe, _EXT_CAP_IE_ , 5, TDLS_EXT_CAPIE, &(pattrib->pktlen)); ++ ++ //QoS capability(WMM_IE) ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 7, TDLS_WMMIE, &(pattrib->pktlen)); ++ ++ if(pattrib->encrypt){ ++ wpa_tdls_generate_tpk(padapter, ptdls_sta); ++ ++ //FTIE ++ pftie = pframe; ++ pftie_mic = pframe+4; ++ _rtw_memset(pframe, 0, 84); //All fields except SNonce shall be set to 0 ++ _rtw_memset(pframe, _FTIE_, 1); //version ++ _rtw_memset((pframe+1), 82, 1); //length ++ _rtw_memcpy((pframe+20), ptdls_sta->ANonce, 32); ++ _rtw_memcpy((pframe+52), ptdls_sta->SNonce, 32); ++ pframe += 84; ++ pattrib->pktlen += 84; ++ ++ //Timeout interval ++ ptimeout_ie = pframe; ++ timeout_itvl[0]=0x02; ++ _rtw_memcpy(timeout_itvl+1, (u8 *)(&ptdls_sta->TDLS_PeerKey_Lifetime), 4); ++ pframe = rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); ++ } ++ ++ //Sup_reg_classes(optional) ++ //HT capabilities ++ pframe = rtw_tdls_set_ht_cap(padapter, pframe, pattrib); ++ ++ //20/40 BSS coexistence ++ if(pmlmepriv->num_FortyMHzIntolerant>0) ++ iedata |= BIT(2);//20 MHz BSS Width Request ++ pframe = rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); ++ ++ //Link identifier ++ plinkid_ie = pframe; ++ _rtw_memcpy(link_id_addr, pattrib->ra, 6); ++ _rtw_memcpy((link_id_addr+6), pattrib->dst, 6); ++ _rtw_memcpy((link_id_addr+12), pattrib->src, 6); ++ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); ++ ++ //fill FTIE mic ++ if(pattrib->encrypt) ++ wpa_tdls_ftie_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie, pftie_mic); ++ ++#ifdef CONFIG_WFD ++ wfd_ie_tdls( padapter, pframe, &(pattrib->pktlen) ); ++#endif //CONFIG_WFD ++ ++} ++ ++void rtw_build_tdls_setup_cfm_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) ++{ ++ ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct sta_info *ptdls_sta=rtw_get_stainfo( (&padapter->stapriv) , pattrib->dst); ++ ++ u8 payload_type = 0x02; ++ unsigned char category = RTW_WLAN_CATEGORY_TDLS; ++ unsigned char action = TDLS_SETUP_CONFIRM; ++ u8 more_supportedrates = 0; ++ unsigned int ie_len; ++ unsigned char *p; ++ u8 timeout_itvl[5]; //set timeout interval to maximum value ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ u8 link_id_addr[18] = {0}; ++ u8 *pftie, *ptimeout_ie, *plinkid_ie, *prsnie, *pftie_mic; ++ ++ //payload type ++ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); ++ //category, action, status code, dialog token ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&ptdls_sta->stat_code, &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(ptdls_sta->dialog), &(pattrib->pktlen)); ++ ++ if(ptdls_sta->stat_code!=0) //invalid setup request ++ return; ++ ++ //RSNIE ++ if(pattrib->encrypt){ ++ prsnie = pframe; ++ pframe = rtw_set_ie(pframe, _RSN_IE_2_, 20, TDLS_RSNIE, &(pattrib->pktlen)); ++ } ++ ++ //EDCA param set; WMM param ele. ++ if(pattrib->encrypt){ ++ //FTIE ++ pftie = pframe; ++ pftie_mic = pframe+4; ++ _rtw_memset(pframe, 0, 84); //All fields except SNonce shall be set to 0 ++ _rtw_memset(pframe, _FTIE_, 1); //version ++ _rtw_memset((pframe+1), 82, 1); //length ++ _rtw_memcpy((pframe+20), ptdls_sta->ANonce, 32); ++ _rtw_memcpy((pframe+52), ptdls_sta->SNonce, 32); ++ pframe += 84; ++ pattrib->pktlen += 84; ++ ++ //Timeout interval ++ ptimeout_ie = pframe; ++ timeout_itvl[0]=0x02; ++ _rtw_memcpy(timeout_itvl+1, (u8 *)(&ptdls_sta->TDLS_PeerKey_Lifetime), 4); ++ ptdls_sta->TPK_count=0; ++ _set_timer(&ptdls_sta->TPK_timer, ptdls_sta->TDLS_PeerKey_Lifetime/TPK_RESEND_COUNT); ++ pframe = rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); ++ } ++ ++ //HT operation; todo ++ //Link identifier ++ plinkid_ie = pframe; ++ _rtw_memcpy(link_id_addr, pattrib->ra, 6); ++ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); ++ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); ++ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); ++ ++ //fill FTIE mic ++ if(pattrib->encrypt) ++ wpa_tdls_ftie_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie, pftie_mic); ++ ++} ++ ++void rtw_build_tdls_teardown_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) ++{ ++ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ u8 payload_type = 0x02; ++ unsigned char category = RTW_WLAN_CATEGORY_TDLS; ++ unsigned char action = TDLS_TEARDOWN; ++ u8 link_id_addr[18] = {0}; ++ ++ struct sta_info *ptdls_sta = rtw_get_stainfo( &(padapter->stapriv) , pattrib->dst); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ //payload type ++ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); ++ //category, action, reason code ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, (u8 *)&ptdls_sta->stat_code, &(pattrib->pktlen)); ++ ++ //Link identifier ++ if(ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE){ ++ _rtw_memcpy(link_id_addr, pattrib->ra, 6); ++ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); ++ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); ++ }else if(ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE){ ++ _rtw_memcpy(link_id_addr, pattrib->ra, 6); ++ _rtw_memcpy((link_id_addr+6), pattrib->dst, 6); ++ _rtw_memcpy((link_id_addr+12), pattrib->src, 6); ++ } ++ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); ++ ++} ++ ++void rtw_build_tdls_dis_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) ++{ ++ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ u8 payload_type = 0x02; ++ u8 category = RTW_WLAN_CATEGORY_TDLS; ++ u8 action = TDLS_DISCOVERY_REQUEST; ++ u8 link_id_addr[18] = {0}; ++ static u8 dialogtoken=0; ++ ++ //payload type ++ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); ++ //category, action, reason code ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogtoken), &(pattrib->pktlen)); ++ dialogtoken = (dialogtoken+1)%256; ++ ++ //Link identifier ++ _rtw_memcpy(link_id_addr, pattrib->ra, 6); ++ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); ++ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); ++ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); ++ ++} ++ ++void rtw_build_tdls_dis_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, u8 dialog) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ ++ u8 category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = TDLS_DISCOVERY_RESPONSE; ++ u8 bssrate[NDIS_802_11_LENGTH_RATES_EX]; ++ int bssrate_len = 0; ++ u8 more_supportedrates = 0; ++ u8 *p; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ u8 link_id_addr[18] = {0}; ++ u8 iedata=0; ++ u8 timeout_itvl[5]; //set timeout interval to maximum value ++ u32 timeout_interval= TPK_RESEND_COUNT * 1000; ++ ++ //category, action, dialog token ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialog), &(pattrib->pktlen)); ++ ++ //capability ++ _rtw_memcpy(pframe, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); ++ ++ if(pattrib->encrypt) ++ *pframe =*pframe | BIT(4); ++ pframe += 2; ++ pattrib->pktlen += 2; ++ ++ //supported rates ++ rtw_set_supported_rate(bssrate, WIRELESS_11BG_24N); ++ bssrate_len = IEEE80211_CCK_RATE_LEN + IEEE80211_NUM_OFDM_RATESLEN; ++ ++ if (bssrate_len > 8) ++ { ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); ++ more_supportedrates = 1; ++ } ++ else ++ { ++ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); ++ } ++ ++ //extended supported rates ++ if(more_supportedrates==1){ ++ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); ++ } ++ ++ //supported channels ++ pframe = rtw_tdls_set_sup_ch(pmlmeext, pframe, pattrib); ++ ++ //RSNIE ++ if(pattrib->encrypt) ++ pframe = rtw_set_ie(pframe, _RSN_IE_2_, 20, TDLS_RSNIE, &(pattrib->pktlen)); ++ ++ //extended capability ++ pframe = rtw_set_ie(pframe, _EXT_CAP_IE_ , 5, TDLS_EXT_CAPIE, &(pattrib->pktlen)); ++ ++ if(pattrib->encrypt){ ++ //FTIE ++ _rtw_memset(pframe, 0, 84); //All fields shall be set to 0 ++ _rtw_memset(pframe, _FTIE_, 1); //version ++ _rtw_memset((pframe+1), 82, 1); //length ++ pframe += 84; ++ pattrib->pktlen += 84; ++ ++ //Timeout interval ++ timeout_itvl[0]=0x02; ++ _rtw_memcpy(timeout_itvl+1, &timeout_interval, 4); ++ pframe = rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); ++ } ++ ++ //Sup_reg_classes(optional) ++ //HT capabilities ++ pframe = rtw_tdls_set_ht_cap(padapter, pframe, pattrib); ++ ++ //20/40 BSS coexistence ++ if(pmlmepriv->num_FortyMHzIntolerant>0) ++ iedata |= BIT(2);//20 MHz BSS Width Request ++ pframe = rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); ++ ++ //Link identifier ++ _rtw_memcpy(link_id_addr, pattrib->ra, 6); ++ _rtw_memcpy((link_id_addr+6), pattrib->dst, 6); ++ _rtw_memcpy((link_id_addr+12), pattrib->src, 6); ++ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); ++ ++} ++ ++void rtw_build_tdls_peer_traffic_indication_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) ++{ ++ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ u8 payload_type = 0x02; ++ unsigned char category = RTW_WLAN_CATEGORY_TDLS; ++ unsigned char action = TDLS_PEER_TRAFFIC_INDICATION; ++ ++ u8 link_id_addr[18] = {0}; ++ u8 AC_queue=0; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); ++ ++ //payload type ++ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); ++ //category, action, reason code ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(ptdls_sta->dialog), &(pattrib->pktlen)); ++ ++ //Link identifier ++ _rtw_memcpy(link_id_addr, pattrib->ra, 6); ++ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); ++ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); ++ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); ++ ++ //PTI control ++ //PU buffer status ++ if(ptdls_sta->uapsd_bk&BIT(1)) ++ AC_queue=BIT(0); ++ if(ptdls_sta->uapsd_be&BIT(1)) ++ AC_queue=BIT(1); ++ if(ptdls_sta->uapsd_vi&BIT(1)) ++ AC_queue=BIT(2); ++ if(ptdls_sta->uapsd_vo&BIT(1)) ++ AC_queue=BIT(3); ++ pframe = rtw_set_ie(pframe, _PTI_BUFFER_STATUS_, 1, &AC_queue, &(pattrib->pktlen)); ++ ++} ++ ++void rtw_build_tdls_ch_switch_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) ++{ ++ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ u8 payload_type = 0x02; ++ unsigned char category = RTW_WLAN_CATEGORY_TDLS; ++ unsigned char action = TDLS_CHANNEL_SWITCH_REQUEST; ++ u8 link_id_addr[18] = {0}; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); ++ u8 ch_switch_timing[4] = {0}; ++ u16 switch_time= CH_SWITCH_TIME, switch_timeout=CH_SWITCH_TIMEOUT; ++ ++ //payload type ++ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); ++ //category, action, target_ch ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(ptdlsinfo->candidate_ch), &(pattrib->pktlen)); ++ ++ //Link identifier ++ _rtw_memcpy(link_id_addr, pattrib->ra, 6); ++ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); ++ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); ++ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); ++ ++ //ch switch timing ++ _rtw_memcpy(ch_switch_timing, &switch_time, 2); ++ _rtw_memcpy(ch_switch_timing+2, &switch_timeout, 2); ++ pframe = rtw_set_ie(pframe, _CH_SWITCH_TIMING_, 4, ch_switch_timing, &(pattrib->pktlen)); ++ ++ //update ch switch attrib to sta_info ++ ptdls_sta->off_ch=ptdlsinfo->candidate_ch; ++ ptdls_sta->ch_switch_time=switch_time; ++ ptdls_sta->ch_switch_timeout=switch_timeout; ++ ++} ++ ++void rtw_build_tdls_ch_switch_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) ++{ ++ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ u8 payload_type = 0x02; ++ unsigned char category = RTW_WLAN_CATEGORY_TDLS; ++ unsigned char action = TDLS_CHANNEL_SWITCH_RESPONSE; ++ u8 link_id_addr[18] = {0}; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; ++ u8 ch_switch_timing[4] = {0}; ++ ++ //payload type ++ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); ++ //category, action, status_code ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&ptdls_sta->stat_code, &(pattrib->pktlen)); ++ ++ //Link identifier ++ _rtw_memcpy(link_id_addr, pattrib->ra, 6); ++ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); ++ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); ++ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); ++ ++ //ch switch timing ++ _rtw_memcpy(ch_switch_timing, &ptdls_sta->ch_switch_time, 2); ++ _rtw_memcpy(ch_switch_timing+2, &ptdls_sta->ch_switch_timeout, 2); ++ pframe = rtw_set_ie(pframe, _CH_SWITCH_TIMING_, 4, ch_switch_timing, &(pattrib->pktlen)); ++ ++} ++ ++#ifdef CONFIG_WFD ++void rtw_build_tunneled_probe_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) ++{ ++ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ struct wifidirect_info *pbuddy_wdinfo = &padapter->pbuddy_adapter->wdinfo; ++ u8 payload_type = 0x02; ++ u8 category = RTW_WLAN_CATEGORY_P2P; ++ u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a}; ++ u8 probe_req = 4; ++ u8 wfdielen = 0; ++ ++ //payload type ++ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); ++ //category, OUI, frame_body_type ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 3, WFA_OUI, &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(probe_req), &(pattrib->pktlen)); ++ ++ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ { ++ wfdielen = build_probe_req_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++ } ++ else if(!rtw_p2p_chk_state(pbuddy_wdinfo, P2P_STATE_NONE)) ++ { ++ wfdielen = build_probe_req_wfd_ie(pbuddy_wdinfo, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++ } ++ ++} ++ ++void rtw_build_tunneled_probe_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) ++{ ++ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ struct wifidirect_info *pbuddy_wdinfo = &padapter->pbuddy_adapter->wdinfo; ++ u8 payload_type = 0x02; ++ u8 category = RTW_WLAN_CATEGORY_P2P; ++ u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a}; ++ u8 probe_rsp = 5; ++ u8 wfdielen = 0; ++ ++ //payload type ++ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); ++ //category, OUI, frame_body_type ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 3, WFA_OUI, &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(probe_rsp), &(pattrib->pktlen)); ++ ++ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ { ++ wfdielen = build_probe_resp_wfd_ie(pwdinfo, pframe, 1); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++ } ++ else if(!rtw_p2p_chk_state(pbuddy_wdinfo, P2P_STATE_NONE)) ++ { ++ wfdielen = build_probe_resp_wfd_ie(pbuddy_wdinfo, pframe, 1); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++ } ++ ++} ++#endif //CONFIG_WFD ++ ++void _TPK_timer_hdl(void *FunctionContext) ++{ ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ ++ ptdls_sta->TPK_count++; ++ //TPK_timer set 1000 as default ++ //retry timer should set at least 301 sec. ++ if(ptdls_sta->TPK_count==TPK_RESEND_COUNT){ ++ ptdls_sta->TPK_count=0; ++ issue_tdls_setup_req(ptdls_sta->padapter, ptdls_sta->hwaddr); ++ } ++ ++ _set_timer(&ptdls_sta->TPK_timer, ptdls_sta->TDLS_PeerKey_Lifetime/TPK_RESEND_COUNT); ++} ++ ++void init_TPK_timer(_adapter *padapter, struct sta_info *psta) ++{ ++ psta->padapter=padapter; ++ ++ _init_timer(&psta->TPK_timer, padapter->pnetdev, _TPK_timer_hdl, psta); ++} ++ ++// TDLS_DONE_CH_SEN: channel sensing and report candidate channel ++// TDLS_OFF_CH: first time set channel to off channel ++// TDLS_BASE_CH: when go back to the channel linked with AP, send null data to peer STA as an indication ++void _ch_switch_timer_hdl(void *FunctionContext) ++{ ++ ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ _adapter *padapter = ptdls_sta->padapter; ++ ++ if( ptdls_sta->option == TDLS_DONE_CH_SEN ){ ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_DONE_CH_SEN); ++ }else if( ptdls_sta->option == TDLS_OFF_CH ){ ++ issue_nulldata_to_TDLS_peer_STA(ptdls_sta->padapter, ptdls_sta, 0); ++ _set_timer(&ptdls_sta->base_ch_timer, 500); ++ }else if( ptdls_sta->option == TDLS_BASE_CH){ ++ issue_nulldata_to_TDLS_peer_STA(ptdls_sta->padapter, ptdls_sta, 0); ++ } ++} ++ ++void init_ch_switch_timer(_adapter *padapter, struct sta_info *psta) ++{ ++ psta->padapter=padapter; ++ _init_timer(&psta->option_timer, padapter->pnetdev, _ch_switch_timer_hdl, psta); ++} ++ ++void _base_ch_timer_hdl(void *FunctionContext) ++{ ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ rtw_tdls_cmd(ptdls_sta->padapter, ptdls_sta->hwaddr, TDLS_P_OFF_CH); ++} ++ ++void init_base_ch_timer(_adapter *padapter, struct sta_info *psta) ++{ ++ psta->padapter=padapter; ++ _init_timer(&psta->base_ch_timer, padapter->pnetdev, _base_ch_timer_hdl, psta); ++} ++ ++void _off_ch_timer_hdl(void *FunctionContext) ++{ ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ rtw_tdls_cmd(ptdls_sta->padapter, ptdls_sta->hwaddr, TDLS_P_BASE_CH ); ++} ++ ++void init_off_ch_timer(_adapter *padapter, struct sta_info *psta) ++{ ++ psta->padapter=padapter; ++ _init_timer(&psta->off_ch_timer, padapter->pnetdev, _off_ch_timer_hdl, psta); ++} ++ ++void _tdls_handshake_timer_hdl(void *FunctionContext) ++{ ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ ++ if(ptdls_sta != NULL) ++ { ++ if( !(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) ) ++ { ++ DBG_871X("tdls handshake time out\n"); ++ free_tdls_sta(ptdls_sta->padapter, ptdls_sta); ++ } ++ } ++} ++ ++void init_handshake_timer(_adapter *padapter, struct sta_info *psta) ++{ ++ psta->padapter=padapter; ++ _init_timer(&psta->handshake_timer, padapter->pnetdev, _tdls_handshake_timer_hdl, psta); ++} ++ ++//Check tdls peer sta alive. ++void _tdls_alive_timer_phase1_hdl(void *FunctionContext) ++{ ++ _irqL irqL; ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ _adapter *padapter = ptdls_sta->padapter; ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ ++ _enter_critical_bh(&ptdlsinfo->hdl_lock, &irqL); ++ ptdls_sta->timer_flag = 1; ++ _exit_critical_bh(&ptdlsinfo->hdl_lock, &irqL); ++ ++ ptdls_sta->tdls_sta_state &= (~TDLS_ALIVE_STATE); ++ ++ DBG_871X("issue_tdls_dis_req to check alive\n"); ++ issue_tdls_dis_req( padapter, ptdls_sta->hwaddr); ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CKALV_PH1); ++ sta_update_last_rx_pkts(ptdls_sta); ++ ++ if ( ptdls_sta->timer_flag == 2 ) ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_FREE_STA); ++ else ++ { ++ _enter_critical_bh(&ptdlsinfo->hdl_lock, &irqL); ++ ptdls_sta->timer_flag = 0; ++ _exit_critical_bh(&ptdlsinfo->hdl_lock, &irqL); ++ } ++ ++} ++ ++void _tdls_alive_timer_phase2_hdl(void *FunctionContext) ++{ ++ _irqL irqL; ++ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; ++ _adapter *padapter = ptdls_sta->padapter; ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ ++ _enter_critical_bh(&(ptdlsinfo->hdl_lock), &irqL); ++ ptdls_sta->timer_flag = 1; ++ _exit_critical_bh(&ptdlsinfo->hdl_lock, &irqL); ++ ++ if( (ptdls_sta->tdls_sta_state & TDLS_ALIVE_STATE) && ++ (sta_last_rx_pkts(ptdls_sta) + 3 <= sta_rx_pkts(ptdls_sta)) ) ++ { ++ DBG_871X("TDLS STA ALIVE, ptdls_sta->sta_stats.last_rx_pkts:%llu, ptdls_sta->sta_stats.rx_pkts:%llu\n", ++ sta_last_rx_pkts(ptdls_sta), sta_rx_pkts(ptdls_sta)); ++ ++ ptdls_sta->alive_count = 0; ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CKALV_PH2); ++ } ++ else ++ { ++ if( !(ptdls_sta->tdls_sta_state & TDLS_ALIVE_STATE) ) ++ DBG_871X("TDLS STA TOO FAR\n"); ++ if( !(sta_last_rx_pkts(ptdls_sta) + 3 <= sta_rx_pkts(ptdls_sta))) ++ DBG_871X("TDLS LINK WITH LOW TRAFFIC, ptdls_sta->sta_stats.last_rx_pkts:%llu, ptdls_sta->sta_stats.rx_pkts:%llu\n", ++ sta_last_rx_pkts(ptdls_sta), sta_rx_pkts(ptdls_sta)); ++ ++ ptdls_sta->alive_count++; ++ if( ptdls_sta->alive_count == TDLS_ALIVE_COUNT ) ++ { ++ ptdls_sta->stat_code = _RSON_TDLS_TEAR_TOOFAR_; ++ issue_tdls_teardown(padapter, ptdls_sta->hwaddr); ++ } ++ else ++ { ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CKALV_PH2); ++ } ++ } ++ ++ if ( ptdls_sta->timer_flag == 2 ) ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_FREE_STA); ++ else ++ { ++ _enter_critical_bh(&(ptdlsinfo->hdl_lock), &irqL); ++ ptdls_sta->timer_flag = 0; ++ _exit_critical_bh(&ptdlsinfo->hdl_lock, &irqL); ++} ++ ++} ++ ++void init_tdls_alive_timer(_adapter *padapter, struct sta_info *psta) ++{ ++ psta->padapter=padapter; ++ _init_timer(&psta->alive_timer1, padapter->pnetdev, _tdls_alive_timer_phase1_hdl, psta); ++ _init_timer(&psta->alive_timer2, padapter->pnetdev, _tdls_alive_timer_phase2_hdl, psta); ++} ++ ++int update_sgi_tdls(_adapter *padapter, struct sta_info *psta) ++{ ++ struct ht_priv *psta_ht = NULL; ++ psta_ht = &psta->htpriv; ++ ++ if(psta_ht->ht_option) ++ { ++ return psta_ht->sgi; ++ } ++ else ++ return false; ++} ++ ++u32 update_mask_tdls(_adapter *padapter, struct sta_info *psta) ++{ ++ int i; ++ u8 rf_type, id; ++ unsigned char sta_band = 0; ++ unsigned char limit; ++ unsigned int tx_ra_bitmap=0; ++ struct ht_priv *psta_ht = NULL; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; ++ ++ psta_ht = &psta->htpriv; ++ //b/g mode ra_bitmap ++ for (i=0; ibssrateset); i++) ++ { ++ if (psta->bssrateset[i]) ++ tx_ra_bitmap |= rtw_get_bit_value_from_ieee_value(psta->bssrateset[i]&0x7f); ++ } ++ ++ //n mode ra_bitmap ++ if(psta_ht->ht_option) ++ { ++ padapter->HalFunc.GetHwRegHandler(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ if(rf_type == RF_2T2R) ++ limit=16;// 2R ++ else ++ limit=8;// 1R ++ ++ for (i=0; iht_cap.supp_mcs_set[i/8] & BIT(i%8)) ++ tx_ra_bitmap |= BIT(i+12); ++ } ++ } ++ ++ if ( pcur_network->Configuration.DSConfig > 14 ) { ++ // 5G band ++ if (tx_ra_bitmap & 0xffff000) ++ sta_band |= WIRELESS_11_5N | WIRELESS_11A; ++ else ++ sta_band |= WIRELESS_11A; ++ } else { ++ if (tx_ra_bitmap & 0xffff000) ++ sta_band |= WIRELESS_11_24N | WIRELESS_11G | WIRELESS_11B; ++ else if (tx_ra_bitmap & 0xff0) ++ sta_band |= WIRELESS_11G |WIRELESS_11B; ++ else ++ sta_band |= WIRELESS_11B; ++ } ++ ++ //id = networktype_to_raid(sta_band); ++ id = rtw_hal_networktype_to_raid(padapter,sta_band); ++ tx_ra_bitmap |= ((id<<28)&0xf0000000); ++ return tx_ra_bitmap; ++} ++ ++#endif //CONFIG_TDLS +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_vht.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_vht.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_vht.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_vht.c 2018-02-06 17:42:30.700967016 +0200 +@@ -0,0 +1,607 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#define _RTW_VHT_C @@ -74901,34 +53379,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ +#include + +#ifdef CONFIG_80211AC_VHT -+// 20/40/80, ShortGI, MCS Rate -+const u16 VHT_MCS_DATA_RATE[3][2][30] = ++// 20/40/80, ShortGI, MCS Rate ++const u16 VHT_MCS_DATA_RATE[3][2][20] = + { { {13, 26, 39, 52, 78, 104, 117, 130, 156, 156, -+ 26, 52, 78, 104, 156, 208, 234, 260, 312, 312, -+ 39, 78, 117, 156, 234, 312, 351, 390, 468, 520}, // Long GI, 20MHz ++ 26, 52, 78, 104, 156, 208, 234, 260, 312, 312}, // Long GI, 20MHz + {14, 29, 43, 58, 87, 116, 130, 144, 173, 173, -+ 29, 58, 87, 116, 173, 231, 260, 289, 347, 347, -+ 43, 87, 130, 173, 260, 347,390, 433, 520, 578} }, // Short GI, 20MHz -+ { {27, 54, 81, 108, 162, 216, 243, 270, 324, 360, -+ 54, 108, 162, 216, 324, 432, 486, 540, 648, 720, -+ 81, 162, 243, 324, 486, 648, 729, 810, 972, 1080}, // Long GI, 40MHz -+ {30, 60, 90, 120, 180, 240, 270, 300,360, 400, -+ 60, 120, 180, 240, 360, 480, 540, 600, 720, 800, -+ 90, 180, 270, 360, 540, 720, 810, 900, 1080, 1200}}, // Short GI, 40MHz ++ 29, 58, 87, 116, 173, 231, 260, 289, 347, 347} }, // Short GI, 20MHz ++ { {27, 54, 81, 108, 162, 216, 243, 270, 324, 360, ++ 54, 108, 162, 216, 324, 432, 486, 540, 648, 720}, // Long GI, 40MHz ++ {30, 60, 90, 120, 180, 240, 270, 300,360, 400, ++ 60, 120, 180, 240, 360, 480, 540, 600, 720, 800}}, // Short GI, 40MHz + { {59, 117, 176, 234, 351, 468, 527, 585, 702, 780, -+ 117, 234, 351, 468, 702, 936, 1053, 1170, 1404, 1560, -+ 176, 351, 527, 702, 1053, 1404, 1580, 1755, 2106, 2340}, /* Long GI, 80MHz */ -+ {65, 130, 195, 260, 390, 520, 585, 650, 780, 867, -+ 130, 260, 390, 520, 780, 1040, 1170, 1300, 1560,1734, -+ 195, 390, 585, 780, 1170, 1560, 1755, 1950, 2340, 2600} } /* Short GI, 80MHz */ ++ 117, 234, 351, 468, 702, 936, 1053, 1170, 1404, 1560}, // Long GI, 80MHz ++ {65, 130, 195, 260, 390, 520, 585, 650, 780, 867, ++ 130, 260, 390, 520, 780, 1040, 1170, 1300, 1560,1734} } // Short GI, 80MHz + }; + -+u8 rtw_get_vht_highest_rate(u8 *pvht_mcs_map) ++u8 rtw_get_vht_highest_rate(_adapter *padapter, u8 *pvht_mcs_map) +{ + u8 i, j; + u8 bit_map; + u8 vht_mcs_rate = 0; -+ ++ + for(i = 0; i < 2; i++) + { + if(pvht_mcs_map[i] != 0xff) @@ -74936,102 +53408,52 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + for(j = 0; j < 8; j += 2) + { + bit_map = (pvht_mcs_map[i] >> j) & 3; -+ ++ + if(bit_map != 3) + vht_mcs_rate = MGN_VHT1SS_MCS7 + 10*j/2 + i*40 + bit_map; //VHT rate indications begin from 0x90 + } + } + } -+ -+ /* DBG_871X("HighestVHTMCSRate is %x\n", vht_mcs_rate); */ ++ ++ //DBG_871X("HighestVHTMCSRate is %x\n", vht_mcs_rate); + return vht_mcs_rate; +} + -+u8 rtw_vht_mcsmap_to_nss(u8 *pvht_mcs_map) ++u16 rtw_vht_data_rate(u8 bw, u8 short_GI, u8 vht_mcs_rate) +{ -+ u8 i, j; -+ u8 bit_map; -+ u8 nss = 0; -+ -+ for(i = 0; i < 2; i++) -+ { -+ if(pvht_mcs_map[i] != 0xff) -+ { -+ for(j = 0; j < 8; j += 2) -+ { -+ bit_map = (pvht_mcs_map[i] >> j) & 3; -+ -+ if(bit_map != 3) -+ nss++; -+ } -+ } -+ } -+ -+ /* DBG_871X("%s : %dSS\n", __FUNCTION__, nss); */ -+ return nss; -+} ++ if(vht_mcs_rate > MGN_VHT2SS_MCS9) ++ vht_mcs_rate = MGN_VHT2SS_MCS9; + -+void rtw_vht_nss_to_mcsmap(u8 nss, u8 *target_mcs_map, u8 *cur_mcs_map) -+{ -+ u8 i, j; -+ u8 cur_rate, target_rate; -+ -+ for(i = 0; i < 2; i++) -+ { -+ target_mcs_map[i] = 0; -+ for(j = 0; j < 8; j+=2) -+ { -+ cur_rate = (cur_mcs_map[i] >> j) & 3; -+ if(cur_rate == 3) //0x3 indicates not supported that num of SS -+ target_rate = 3; -+ else if(nss <= ((j/2)+i*4)) -+ target_rate = 3; -+ else -+ target_rate = cur_rate; -+ -+ target_mcs_map[i] |= (target_rate << j); -+ } -+ } -+ -+ //DBG_871X("%s : %dSS\n", __FUNCTION__, nss); -+} -+ -+u16 rtw_vht_mcs_to_data_rate(u8 bw, u8 short_GI, u8 vht_mcs_rate) -+{ -+ if(vht_mcs_rate > MGN_VHT3SS_MCS9) -+ vht_mcs_rate = MGN_VHT3SS_MCS9; -+ /* DBG_871X("bw=%d, short_GI=%d, ((vht_mcs_rate - MGN_VHT1SS_MCS0)&0x3f)=%d\n", bw, short_GI, ((vht_mcs_rate - MGN_VHT1SS_MCS0)&0x3f)); */ + return VHT_MCS_DATA_RATE[bw][short_GI][((vht_mcs_rate - MGN_VHT1SS_MCS0)&0x3f)]; +} + +void rtw_vht_use_default_setting(_adapter *padapter) +{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; + struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ BOOLEAN bHwLDPCSupport = _FALSE, bHwSTBCSupport = _FALSE; -+ BOOLEAN bHwSupportBeamformer = _FALSE, bHwSupportBeamformee = _FALSE; ++ bool bHwLDPCSupport = false, bHwSTBCSupport = false; + u8 rf_type = 0; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ pvhtpriv->sgi_80m = TEST_FLAG(pregistrypriv->short_gi, BIT2) ? _TRUE : _FALSE; ++ ++ pvhtpriv->bwmode = (pregistrypriv->bw_mode & 0xF0) >> 4; ++ if (pvhtpriv->bwmode > CHANNEL_WIDTH_80) { ++ pvhtpriv->sgi = TEST_FLAG(pregistrypriv->short_gi, BIT3) ? true : false; ++ } else { ++ pvhtpriv->sgi = TEST_FLAG(pregistrypriv->short_gi, BIT2) ? true : false; ++ } + + // LDPC support -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_LDPC, (u8 *)&bHwLDPCSupport); ++ rtw_hal_get_def_var(padapter, HAL_DEF_LDPC, (u8 *)&bHwLDPCSupport); + CLEAR_FLAGS(pvhtpriv->ldpc_cap); + if(bHwLDPCSupport) + { + if(TEST_FLAG(pregistrypriv->ldpc_cap, BIT0)) + SET_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_RX); -+ } -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_LDPC, (u8 *)&bHwLDPCSupport); -+ if(bHwLDPCSupport) -+ { + if(TEST_FLAG(pregistrypriv->ldpc_cap, BIT1)) + SET_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX); -+ } -+ if (pvhtpriv->ldpc_cap) ++ + DBG_871X("[VHT] Support LDPC = 0x%02X\n", pvhtpriv->ldpc_cap); ++ } + + // STBC + rtw_hal_get_def_var(padapter, HAL_DEF_TX_STBC, (u8 *)&bHwSTBCSupport); @@ -75047,45 +53469,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + if(TEST_FLAG(pregistrypriv->stbc_cap, BIT0)) + SET_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_RX); + } -+ if (pvhtpriv->stbc_cap) -+ DBG_871X("[VHT] Support STBC = 0x%02X\n", pvhtpriv->stbc_cap); -+ -+ // Beamforming setting -+ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMER, (u8 *)&bHwSupportBeamformer); -+ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMEE, (u8 *)&bHwSupportBeamformee); -+ CLEAR_FLAGS(pvhtpriv->beamform_cap); -+ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT0) && bHwSupportBeamformer) { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) { -+ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ DBG_871X("[VHT] CONCURRENT AP Support Beamformer\n"); -+ } else -+ DBG_871X("[VHT] CONCURRENT not AP ;not allow Support Beamformer\n"); -+ #else -+ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ DBG_871X("[VHT] Support Beamformer\n"); -+ #endif -+ } -+ if(TEST_FLAG(pregistrypriv->beamform_cap, BIT1) && bHwSupportBeamformee) -+ { -+ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); -+ DBG_871X("[VHT] Support Beamformee\n"); -+ } ++ DBG_871X("[VHT] Support STBC = 0x%02X\n", pvhtpriv->stbc_cap); + + pvhtpriv->ampdu_len = pregistrypriv->ampdu_factor; + + rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); + -+ if (rf_type == RF_3T3R) -+ pvhtpriv->vht_mcs_map[0] = 0xea; /* support 1SS MCS 0~9 2SS MCS 0~9 3SS MCS 0~9 */ -+ else if(rf_type == RF_2T2R) -+ pvhtpriv->vht_mcs_map[0] = 0xfa; /* support 1SS MCS 0~9 2SS MCS 0~9 */ ++ if (rf_type == RF_1T1R) ++ pvhtpriv->vht_mcs_map[0] = 0xfe; // Only support 1SS MCS 0~9; + else -+ pvhtpriv->vht_mcs_map[0] = 0xfe; /* Only support 1SS MCS 0~9; */ ++ pvhtpriv->vht_mcs_map[0] = 0xfa; //support 1SS MCS 0~9 2SS MCS 0~9 + pvhtpriv->vht_mcs_map[1] = 0xff; + + if(pregistrypriv->vht_rate_sel == 1) -+ { ++ { + pvhtpriv->vht_mcs_map[0] = 0xfc; // support 1SS MCS 0~7 + } + else if(pregistrypriv->vht_rate_sel == 2) @@ -75121,19 +53518,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + pvhtpriv->vht_mcs_map[0] = 0xf4; // support 1SS MCS 0-7 2SS MCS 0~8 + } + -+ pvhtpriv->vht_highest_rate = rtw_get_vht_highest_rate(pvhtpriv->vht_mcs_map); ++ pvhtpriv->vht_highest_rate = rtw_get_vht_highest_rate(padapter, pvhtpriv->vht_mcs_map); +} + -+u64 rtw_vht_rate_to_bitmap(u8 *pVHTRate) ++u32 rtw_vht_rate_to_bitmap(u8 *pVHTRate) +{ + + u8 i,j , tmpRate; -+ u64 RateBitmap = 0; -+ u8 Bits_3ss = 6; -+ -+ for(i = j= 0; i < Bits_3ss; i+=2, j+=10) ++ u32 RateBitmap = 0; ++ ++ for(i = j= 0; i < 4; i+=2, j+=10) + { -+ /* every two bits means single sptial stream */ + tmpRate = (pVHTRate[0] >> i) & 3; + + switch(tmpRate){ @@ -75152,69 +53547,59 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + break; + } + } -+ DBG_871X("RateBitmap=%016llx , pVHTRate[0]=%02x, pVHTRate[1]=%02x\n", RateBitmap, pVHTRate[0], pVHTRate[1]); ++ + return RateBitmap; +} + -+void update_sta_vht_info_apmode(_adapter *padapter, PVOID sta) ++void update_sta_vht_info_apmode(_adapter *padapter, void * psta) +{ -+ struct sta_info *psta = (struct sta_info *)sta; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct vht_priv *pvhtpriv_ap = &pmlmepriv->vhtpriv; -+ struct vht_priv *pvhtpriv_sta = &psta->vhtpriv; -+ struct ht_priv *phtpriv_sta = &psta->htpriv; -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, bw_mode = 0; -+ u16 cur_beamform_cap = 0; ++ struct vht_priv *pvhtpriv_sta = &((struct sta_info *)psta)->vhtpriv; ++ struct ht_priv *phtpriv_sta = &((struct sta_info *)psta)->htpriv; ++ u8 cur_ldpc_cap=0, cur_stbc_cap=0, cur_beamform_cap=0; + u8 *pcap_mcs; + -+ if (pvhtpriv_sta->vht_option == _FALSE) { ++ if (pvhtpriv_sta->vht_option == false) { + return; + } + -+ bw_mode = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(&pvhtpriv_sta->vht_op_mode_notify); -+ -+ //if (bw_mode > psta->bw_mode) -+ psta->bw_mode = bw_mode; -+ + // B4 Rx LDPC -+ if (TEST_FLAG(pvhtpriv_ap->ldpc_cap, LDPC_VHT_ENABLE_TX) && -+ GET_VHT_CAPABILITY_ELE_RX_LDPC(pvhtpriv_sta->vht_cap)) -+ { -+ SET_FLAG(cur_ldpc_cap, (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX)); -+ DBG_871X("Current STA(%d) VHT LDPC = %02X\n", psta->aid, cur_ldpc_cap); ++ if (TEST_FLAG(pvhtpriv_ap->ldpc_cap, LDPC_VHT_ENABLE_TX)) { ++ SET_FLAG(cur_ldpc_cap, GET_VHT_CAPABILITY_ELE_RX_LDPC(pvhtpriv_sta->vht_cap) ? (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX) : 0); + } + pvhtpriv_sta->ldpc_cap = cur_ldpc_cap; ++ DBG_871X("Current STA VHT LDPC = %02X\n", cur_ldpc_cap); + -+ if (psta->bw_mode > pmlmeext->cur_bwmode) -+ psta->bw_mode = pmlmeext->cur_bwmode; ++ if (pvhtpriv_sta->bwmode > pvhtpriv_ap->bwmode) ++ pvhtpriv_sta->bwmode = pvhtpriv_ap->bwmode; + -+ if (psta->bw_mode == CHANNEL_WIDTH_80) { ++ if (pvhtpriv_sta->bwmode == CHANNEL_WIDTH_80) { + // B5 Short GI for 80 MHz -+ pvhtpriv_sta->sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi_80m) ? _TRUE : _FALSE; -+ //DBG_871X("Current STA ShortGI80MHz = %d\n", pvhtpriv_sta->sgi_80m); -+ } else if (psta->bw_mode >= CHANNEL_WIDTH_160) { ++ pvhtpriv_sta->sgi = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi) ? true : false; ++ DBG_871X("Current STA ShortGI80MHz = %d\n", pvhtpriv_sta->sgi); ++ } else if (pvhtpriv_sta->bwmode >= CHANNEL_WIDTH_160) { + // B5 Short GI for 80 MHz -+ pvhtpriv_sta->sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI160M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi_80m) ? _TRUE : _FALSE; -+ //DBG_871X("Current STA ShortGI160MHz = %d\n", pvhtpriv_sta->sgi_80m); ++ pvhtpriv_sta->sgi = (GET_VHT_CAPABILITY_ELE_SHORT_GI160M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi) ? true : false; ++ DBG_871X("Current STA ShortGI160MHz = %d\n", pvhtpriv_sta->sgi); ++ } else { ++ pvhtpriv_sta->sgi = phtpriv_sta->sgi; + } + + // B8 B9 B10 Rx STBC -+ if (TEST_FLAG(pvhtpriv_ap->stbc_cap, STBC_VHT_ENABLE_TX) && ++ if (TEST_FLAG(pvhtpriv_ap->stbc_cap, STBC_VHT_ENABLE_TX) && + GET_VHT_CAPABILITY_ELE_RX_STBC(pvhtpriv_sta->vht_cap)) + { -+ SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); -+ DBG_871X("Current STA(%d) VHT STBC = %02X\n", psta->aid, cur_stbc_cap); ++ SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); + } + pvhtpriv_sta->stbc_cap = cur_stbc_cap; ++ DBG_871X("Current STA VHT STBC = %02X\n", cur_stbc_cap); + + // B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee -+ if (TEST_FLAG(pvhtpriv_ap->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && ++ if (TEST_FLAG(pvhtpriv_ap->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && + GET_VHT_CAPABILITY_ELE_SU_BFEE(pvhtpriv_sta->vht_cap)) + { + SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); -+ /*Shift to BEAMFORMING_VHT_BEAMFORMER_STS_CAP*/ -+ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFEE_STS_CAP(pvhtpriv_sta->vht_cap)<<8); + } + + // B12 SU Beamformee Capable, the target supports Beamformee and we are Beamformer @@ -75222,13 +53607,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + GET_VHT_CAPABILITY_ELE_SU_BFER(pvhtpriv_sta->vht_cap)) + { + SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ /*Shit to BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM*/ -+ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFER_SOUND_DIM_NUM(pvhtpriv_sta->vht_cap)<<12); + } + pvhtpriv_sta->beamform_cap = cur_beamform_cap; -+ if (cur_beamform_cap) { -+ DBG_871X("Current STA(%d) VHT Beamforming Setting = %02X\n", psta->aid, cur_beamform_cap); -+ } ++ DBG_871X("Current VHT Beamforming Setting = %02X\n", cur_beamform_cap); + + // B23 B24 B25 Maximum A-MPDU Length Exponent + pvhtpriv_sta->ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pvhtpriv_sta->vht_cap); @@ -75236,7 +53617,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pvhtpriv_sta->vht_cap); + _rtw_memcpy(pvhtpriv_sta->vht_mcs_map, pcap_mcs, 2); + -+ pvhtpriv_sta->vht_highest_rate = rtw_get_vht_highest_rate(pvhtpriv_sta->vht_mcs_map); ++ pvhtpriv_sta->vht_highest_rate = rtw_get_vht_highest_rate(padapter, pvhtpriv_sta->vht_mcs_map); + +} + @@ -75256,50 +53637,45 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + +void VHT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) +{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, rf_type = RF_1T1R; -+ u16 cur_beamform_cap = 0; ++ u8 cur_ldpc_cap=0, cur_stbc_cap=0, cur_beamform_cap=0, rf_type = RF_1T1R; + u8 *pcap_mcs; + u8 vht_mcs[2]; + + if(pIE==NULL) return; + -+ if(pvhtpriv->vht_option == _FALSE) return; ++ if(pvhtpriv->vht_option == false) return; + + pmlmeinfo->VHT_enable = 1; + + // B4 Rx LDPC -+ if (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX) && -+ GET_VHT_CAPABILITY_ELE_RX_LDPC(pIE->data)) -+ { -+ SET_FLAG(cur_ldpc_cap, (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX)); -+ DBG_871X("Current VHT LDPC Setting = %02X\n", cur_ldpc_cap); ++ if (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX)) { ++ SET_FLAG(cur_ldpc_cap, GET_VHT_CAPABILITY_ELE_RX_LDPC(pIE->data) ? (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX) : 0); + } + pvhtpriv->ldpc_cap = cur_ldpc_cap; ++ DBG_871X("Current VHT LDPC Setting = %02X\n", cur_ldpc_cap); + + // B5 Short GI for 80 MHz -+ pvhtpriv->sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(pIE->data) & pvhtpriv->sgi_80m) ? _TRUE : _FALSE; -+ //DBG_871X("Current ShortGI80MHz = %d\n", pvhtpriv->sgi_80m); ++ pvhtpriv->sgi = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(pIE->data) & pvhtpriv->sgi) ? true : false; ++ DBG_871X("Current ShortGI80MHz = %d\n", pvhtpriv->sgi); + + // B8 B9 B10 Rx STBC -+ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX) && ++ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX) && + GET_VHT_CAPABILITY_ELE_RX_STBC(pIE->data)) + { -+ SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); -+ DBG_871X("Current VHT STBC Setting = %02X\n", cur_stbc_cap); ++ SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); + } + pvhtpriv->stbc_cap = cur_stbc_cap; ++ DBG_871X("Current VHT STBC Setting = %02X\n", cur_stbc_cap); + + // B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && ++ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && + GET_VHT_CAPABILITY_ELE_SU_BFEE(pIE->data)) + { + SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); -+ /*Shift to BEAMFORMING_VHT_BEAMFORMER_STS_CAP*/ -+ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFEE_STS_CAP(pIE->data)<<8); + } + + // B12 SU Beamformee Capable, the target supports Beamformee and we are Beamformer @@ -75307,14 +53683,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + GET_VHT_CAPABILITY_ELE_SU_BFER(pIE->data)) + { + SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ /*Shit to BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM*/ -+ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFER_SOUND_DIM_NUM(pIE->data)<<12); -+ + } + pvhtpriv->beamform_cap = cur_beamform_cap; -+ if (cur_beamform_cap) { -+ DBG_871X("Current VHT Beamforming Setting = %02X\n", cur_beamform_cap); -+ } ++ DBG_871X("Current VHT Beamforming Setting = %02X\n", cur_beamform_cap); + + // B23 B24 B25 Maximum A-MPDU Length Exponent + pvhtpriv->ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pIE->data); @@ -75327,131 +53698,61 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + vht_mcs[0] |= 0xfc; + else if (rf_type == RF_2T2R) + vht_mcs[0] |= 0xf0; -+ else if (rf_type == RF_3T3R) -+ vht_mcs[0] |= 0xc0; + + _rtw_memcpy(pvhtpriv->vht_mcs_map, vht_mcs, 2); + -+ pvhtpriv->vht_highest_rate = rtw_get_vht_highest_rate(pvhtpriv->vht_mcs_map); ++ pvhtpriv->vht_highest_rate = rtw_get_vht_highest_rate(padapter, pvhtpriv->vht_mcs_map); +} + +void VHT_operation_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) +{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct ht_priv *phtpriv = &pmlmepriv->htpriv; + struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + + if(pIE==NULL) return; + -+ if(pvhtpriv->vht_option == _FALSE) return; -+} ++ if(pvhtpriv->vht_option == false) return; + -+void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, PVOID sta) -+{ -+ struct sta_info *psta = (struct sta_info *)sta; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u8 target_bw; -+ u8 target_rxss, current_rxss; -+ u8 update_ra = _FALSE; -+ u8 vht_mcs_map[2] = {}; -+ -+ if(pvhtpriv->vht_option == _FALSE) -+ return; -+ -+ target_bw = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(pframe); -+ target_rxss = (GET_VHT_OPERATING_MODE_FIELD_RX_NSS(pframe)+1); -+ -+ if (target_bw != psta->bw_mode) { -+ if (target_bw <= (padapter->registrypriv.bw_mode >> 4)) { -+ update_ra = _TRUE; -+ psta->bw_mode = target_bw; -+ } -+ } -+ -+ current_rxss = rtw_vht_mcsmap_to_nss(psta->vhtpriv.vht_mcs_map); -+ if (target_rxss != current_rxss) { -+ update_ra = _TRUE; -+ -+ rtw_vht_nss_to_mcsmap(target_rxss, vht_mcs_map, psta->vhtpriv.vht_mcs_map); -+ _rtw_memcpy(psta->vhtpriv.vht_mcs_map, vht_mcs_map, 2); -+ -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ } -+ -+ if (update_ra) { -+ rtw_dm_ra_mask_wk_cmd(padapter, (u8 *)psta); ++ if ((GET_VHT_OPERATION_ELE_CHL_WIDTH(pIE->data) >= 1) ++ && ((pregistrypriv->bw_mode & 0xf0) >= CHANNEL_WIDTH_80)) { ++ pvhtpriv->bwmode = CHANNEL_WIDTH_80; ++ } else { ++ pvhtpriv->bwmode = phtpriv->bwmode; + } +} + +u32 rtw_build_vht_operation_ie(_adapter *padapter, u8 *pbuf, u8 channel) +{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ //struct registry_priv *pregistrypriv = &padapter->registrypriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ //struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u8 ChnlWidth, center_freq, bw_mode, rf_type = 0; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ u8 ChnlWidth, center_freq; + u32 len = 0; + u8 operation[5]; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ _rtw_memset(operation, 0, 5); + -+ bw_mode = pregistrypriv->bw_mode >> 4; -+ -+ if (bw_mode >= CHANNEL_WIDTH_80) -+ { -+ center_freq = rtw_get_center_ch(channel, bw_mode, HAL_PRIME_CHNL_OFFSET_LOWER); ++ if (pvhtpriv->bwmode >= CHANNEL_WIDTH_80) + ChnlWidth = 1; -+ } + else -+ { -+ center_freq = 0; + ChnlWidth = 0; -+ } + -+ ++ center_freq = rtw_get_center_ch(channel, pvhtpriv->bwmode, HAL_PRIME_CHNL_OFFSET_LOWER); ++ + SET_VHT_OPERATION_ELE_CHL_WIDTH(operation, ChnlWidth); + //center frequency + SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(operation, center_freq);//Todo: need to set correct center channel + SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(operation,0); -+ -+ if (padapter->registrypriv.rf_config != RF_MAX_TYPE) -+ rf_type = padapter->registrypriv.rf_config; -+ -+ switch (rf_type) { -+ case RF_1T1R: -+ operation[3] = 0xfe; -+ operation[4] = 0xff; -+ break; -+ case RF_1T2R: -+ case RF_2T2R: -+ case RF_2T2R_GREEN: -+ operation[3] = 0xfa; -+ operation[4] = 0xff; -+ break; -+ case RF_2T3R: -+ case RF_2T4R: -+ case RF_3T3R: -+ case RF_3T4R: -+ operation[3] = 0xea; -+ operation[4] = 0xff; -+ break; -+ case RF_4T4R: -+ operation[3] = 0xaa; -+ operation[4] = 0xff; -+ break; -+ default: -+ DBG_871X("%s, %d, unknown rf type\n", __func__, __LINE__); -+ } ++ SET_VHT_OPERATION_ELE_BASIC_MCS_SET(operation, 0xFFFF); + -+ rtw_set_ie(pbuf, EID_VHTOperation, 5, operation, &len); ++ pbuf = rtw_set_ie(pbuf, EID_VHTOperation, 12, operation, &len); + + return len; +} + -+u32 rtw_build_vht_op_mode_notify_ie(_adapter *padapter, u8 *pbuf, u8 bw) ++u32 rtw_build_vht_op_mode_notify_ie(_adapter *padapter, u8 *pbuf) +{ + //struct registry_priv *pregistrypriv = &padapter->registrypriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -75460,22 +53761,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + u8 opmode = 0, rf_type = 0; + u8 chnl_width, rx_nss; + -+ chnl_width = bw; ++ chnl_width = pvhtpriv->bwmode; + + rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if(rf_type == RF_3T3R) -+ rx_nss = 3; -+ else if(rf_type == RF_2T2R) -+ rx_nss = 2; -+ else ++ if(rf_type == RF_1T1R) + rx_nss = 1; ++ else ++ rx_nss = 2; + + SET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(&opmode, chnl_width); + SET_VHT_OPERATING_MODE_FIELD_RX_NSS(&opmode, (rx_nss-1)); + SET_VHT_OPERATING_MODE_FIELD_RX_NSS_TYPE(&opmode, 0); //Todo + -+ pvhtpriv->vht_op_mode_notify = opmode; -+ + pbuf = rtw_set_ie(pbuf, EID_OpModeNotification, 1, &opmode, &len); + + return len; @@ -75483,7 +53780,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + +u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf) +{ -+ u8 bw, rf_type, rf_num; ++ u8 bw, rf_type; + u16 HighestRate; + u8 *pcap, *pcap_mcs; + u32 len = 0; @@ -75493,10 +53790,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + + pcap = pvhtpriv->vht_cap; + _rtw_memset(pcap, 0, 32); -+ -+ /* B0 B1 Maximum MPDU Length */ -+ SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(pcap, 2); -+ ++ + // B2 B3 Supported Channel Width Set + SET_VHT_CAPABILITY_ELE_CHL_WIDTH(pcap, 0); //indicate we don't support neither 160M nor 80+80M bandwidth. + @@ -75507,10 +53801,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + } + + // B5 ShortGI for 80MHz -+ SET_VHT_CAPABILITY_ELE_SHORT_GI80M(pcap, pvhtpriv->sgi_80m? 1 : 0); // We can receive Short GI of 80M ++ SET_VHT_CAPABILITY_ELE_SHORT_GI80M(pcap, pvhtpriv->sgi? 1 : 0); // We can receive Short GI of 80M + + // B6 ShortGI for 160MHz -+ //SET_VHT_CAPABILITY_ELE_SHORT_GI160M(pcap, pvhtpriv->sgi_80m? 1 : 0); ++ if (pvhtpriv->bwmode > CHANNEL_WIDTH_80) { ++ SET_VHT_CAPABILITY_ELE_SHORT_GI160M(pcap, pvhtpriv->sgi? 1 : 0); ++ } + + // B7 Tx STBC + if(TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX)) @@ -75522,30 +53818,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + if(TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_RX)) + { + rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if ((rf_type == RF_2T2R) || (rf_type == RF_1T2R)) -+ rf_num = 1; -+ else if (rf_type == RF_1T1R) -+ rf_num = 1; -+ -+ SET_VHT_CAPABILITY_ELE_RX_STBC(pcap, rf_num); ++ if ((rf_type == RF_2T2R) || (rf_type == RF_1T2R)) { ++ SET_VHT_CAPABILITY_ELE_RX_STBC(pcap, 2); ++ } ++ else if (rf_type == RF_1T1R) { ++ SET_VHT_CAPABILITY_ELE_RX_STBC(pcap, 1); ++ } + } + + // B11 SU Beamformer Capable -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { ++ if(TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) ++ { + SET_VHT_CAPABILITY_ELE_SU_BFER(pcap, 1); -+ // B16 17 18 Number of Sounding Dimensions -+ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMER_CAP, (u8 *)&rf_num); -+ SET_VHT_CAPABILITY_ELE_SOUNDING_DIMENSIONS(pcap, rf_num); + } + + // B12 SU Beamformee Capable -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) { ++ if(TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) ++ { + SET_VHT_CAPABILITY_ELE_SU_BFEE(pcap, 1); -+ // B13 14 15 Compressed Steering Number of Beamformer Antennas Supported -+ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); -+ SET_VHT_CAPABILITY_ELE_BFER_ANT_SUPP(pcap, rf_num); + } + ++ // B13 14 15 Compressed Steering Number of Beamformer Antennas Supported ++ SET_VHT_CAPABILITY_ELE_BFER_ANT_SUPP(pcap, 1);// TODO ++ // B16 17 18 Number of Sounding Dimensions ++ SET_VHT_CAPABILITY_ELE_SOUNDING_DIMENSIONS(pcap, 1); ++ + // B19 MU Beamformer Capable + SET_VHT_CAPABILITY_ELE_MU_BFER(pcap, 0); //HW don't support mu bfee/bfer + // B20 MU Beamformee Capable @@ -75572,9 +53869,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + pcap_mcs = GET_VHT_CAPABILITY_ELE_TX_MCS(pcap); + _rtw_memcpy(pcap_mcs, pvhtpriv->vht_mcs_map, 2); + -+ bw = (pregistrypriv->bw_mode >> 4); -+ HighestRate = VHT_MCS_DATA_RATE[bw][pvhtpriv->sgi_80m][((pvhtpriv->vht_highest_rate - MGN_VHT1SS_MCS0)&0x3f)]; -+ HighestRate = (HighestRate+1) >> 1; ++ bw = (pregistrypriv->bw_mode >> 4) & 0xf; ++ HighestRate = VHT_MCS_DATA_RATE[bw][pvhtpriv->sgi][((pvhtpriv->vht_highest_rate - MGN_VHT1SS_MCS0)&0x3f)]; ++ HighestRate = (HighestRate+1) >> 1; + + SET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(pcap, HighestRate); //indicate we support highest rx rate is 600Mbps. + SET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(pcap, HighestRate); //indicate we support highest tx rate is 600Mbps. @@ -75586,8 +53883,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + +u32 rtw_restructure_vht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len) +{ -+ u32 ielen=0, out_len=0; -+ u8 cap_len=0, notify_len=0, notify_bw=0, operation_bw=0, supported_chnl_width=0; ++ u32 ielen, out_len; ++ u8 cap_len, notify_len, operation_bw, supported_chnl_width; + u8 *p, *pframe; + struct registry_priv *pregistrypriv = &padapter->registrypriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -75598,7 +53895,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + p = rtw_get_ie(in_ie+12, EID_VHTCapability, &ielen, in_len-12); + if (p && ielen>0) { + supported_chnl_width = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p+2); -+ ++ + // VHT Capabilities element + cap_len = rtw_build_vht_cap_ie(padapter, out_ie+*pout_len); + *pout_len += cap_len; @@ -75628,20 +53925,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + pframe = rtw_set_ie(out_ie+out_len, EID_VHTOperation, ielen, p+2 , pout_len); + } + -+ notify_bw = pregistrypriv->bw_mode >> 4; -+ -+ if (notify_bw > operation_bw) -+ notify_bw = operation_bw; ++ if (pvhtpriv->bwmode > operation_bw) ++ pvhtpriv->bwmode = operation_bw; + + // Operating Mode Notification element -+ notify_len = rtw_build_vht_op_mode_notify_ie(padapter, out_ie+*pout_len, notify_bw); ++ notify_len = rtw_build_vht_op_mode_notify_ie(padapter, out_ie+*pout_len); + *pout_len += notify_len; + -+ pvhtpriv->vht_option = _TRUE; ++ pvhtpriv->vht_option = true; + } -+ ++ + return (pvhtpriv->vht_option); -+ ++ +} + +void VHTOnAssocRsp(_adapter *padapter) @@ -75651,7 +53946,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u8 ht_AMPDU_len; -+ ++ + DBG_871X("%s\n", __FUNCTION__); + + if (!pmlmeinfo->HT_enable) @@ -75660,6 +53955,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ + if (!pmlmeinfo->VHT_enable) + return; + ++ if(pvhtpriv->bwmode >= CHANNEL_WIDTH_80) ++ pmlmeext->cur_bwmode = pvhtpriv->bwmode; ++ + ht_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; + + if(pvhtpriv->ampdu_len > ht_AMPDU_len) @@ -75669,2272 +53967,2268 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_vht.c linux/3rdparty/rtl8812au/ +} + +#endif //CONFIG_80211AC_VHT -+ -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wapi.c linux/3rdparty/rtl8812au/core/rtw_wapi.c ---- linux.old/3rdparty/rtl8812au/core/rtw_wapi.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_wapi.c 2017-06-07 23:07:21.006687120 +0300 +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_wapi.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_wapi.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_wapi.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_wapi.c 2018-02-06 17:42:30.700967016 +0200 @@ -0,0 +1,1326 @@ -+#ifdef CONFIG_WAPI_SUPPORT -+ -+#include -+#include -+#include -+#include -+ -+ -+u32 wapi_debug_component = -+// WAPI_INIT | -+// WAPI_API | -+// WAPI_TX | -+// WAPI_RX | -+ WAPI_ERR ; //always open err flags on -+ -+void WapiFreeAllStaInfo(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo; -+ PRT_WAPI_STA_INFO pWapiStaInfo; -+ PRT_WAPI_BKID pWapiBkid; -+ -+ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); -+ pWapiInfo = &padapter->wapiInfo; -+ -+ //Pust to Idle List -+ rtw_wapi_return_all_sta_info(padapter); -+ -+ //Sta Info List -+ while(!list_empty(&(pWapiInfo->wapiSTAIdleList))) -+ { -+ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAIdleList.next, RT_WAPI_STA_INFO, list); -+ list_del_init(&pWapiStaInfo->list); -+ } -+ -+ //BKID List -+ while(!list_empty(&(pWapiInfo->wapiBKIDIdleList))) -+ { -+ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDIdleList.next, RT_WAPI_BKID, list); -+ list_del_init(&pWapiBkid->list); -+ } -+ WAPI_TRACE(WAPI_INIT, "<=========== %s\n", __FUNCTION__); -+ return; -+} -+ -+void WapiSetIE(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ //PRT_WAPI_BKID pWapiBkid; -+ u16 protocolVer = 1; -+ u16 akmCnt = 1; -+ u16 suiteCnt = 1; -+ u16 capability = 0; -+ u8 OUI[3]; -+ -+ OUI[0] = 0x00; -+ OUI[1] = 0x14; -+ OUI[2] = 0x72; -+ -+ pWapiInfo->wapiIELength = 0; -+//protocol version -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength, &protocolVer, 2); -+ pWapiInfo->wapiIELength +=2; -+//akm -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength, &akmCnt, 2); -+ pWapiInfo->wapiIELength +=2; -+ -+ if(pWapiInfo->bWapiPSK){ -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength,OUI, 3); -+ pWapiInfo->wapiIELength +=3; -+ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x2; -+ pWapiInfo->wapiIELength +=1; -+ }else{ -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength,OUI, 3); -+ pWapiInfo->wapiIELength +=3; -+ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; -+ pWapiInfo->wapiIELength +=1; -+ } -+ -+//usk -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength, &suiteCnt, 2); -+ pWapiInfo->wapiIELength +=2; -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength,OUI, 3); -+ pWapiInfo->wapiIELength +=3; -+ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; -+ pWapiInfo->wapiIELength +=1; -+ -+//msk -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength,OUI, 3); -+ pWapiInfo->wapiIELength +=3; -+ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; -+ pWapiInfo->wapiIELength +=1; -+ -+//Capbility -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength, &capability, 2); -+ pWapiInfo->wapiIELength +=2; -+} -+ -+ -+/* PN1 > PN2, return 1, -+ * else return 0. -+ */ -+u32 WapiComparePN(u8 *PN1, u8 *PN2) -+{ -+ char i; -+ -+ if ((NULL == PN1) || (NULL == PN2)) -+ return 1; -+ -+ // overflow case -+ if ((PN2[15] - PN1[15]) & 0x80) -+ return 1; -+ -+ for (i=16; i>0; i--) -+ { -+ if(PN1[i-1] == PN2[i-1]) -+ continue; -+ else if(PN1[i-1] > PN2[i-1]) -+ return 1; -+ else -+ return 0; -+ } -+ -+ return 0; -+} -+ -+u8 -+WapiGetEntryForCamWrite(_adapter *padapter,u8 *pMacAddr,u8 KID,BOOLEAN IsMsk) -+{ -+ PRT_WAPI_T pWapiInfo=NULL; -+ //PRT_WAPI_CAM_ENTRY pEntry=NULL; -+ u8 i=0; -+ u8 ret = 0xff; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ //exist? -+ for(i=0;iwapiCamEntry[i].IsUsed -+ && (_rtw_memcmp(pMacAddr, pWapiInfo->wapiCamEntry[i].PeerMacAddr, ETH_ALEN) == _TRUE) -+ && pWapiInfo->wapiCamEntry[i].keyidx == KID -+ && pWapiInfo->wapiCamEntry[i].type == IsMsk) -+ { -+ ret = pWapiInfo->wapiCamEntry[i].entry_idx; //cover it -+ break; -+ } -+ } -+ -+ if(i == WAPI_CAM_ENTRY_NUM) //not found -+ { -+ for(i=0;iwapiCamEntry[i].IsUsed == 0) -+ { -+ pWapiInfo->wapiCamEntry[i].IsUsed = 1; -+ pWapiInfo->wapiCamEntry[i].type = IsMsk; -+ pWapiInfo->wapiCamEntry[i].keyidx = KID; -+ _rtw_memcpy(pWapiInfo->wapiCamEntry[i].PeerMacAddr, pMacAddr,ETH_ALEN); -+ ret = pWapiInfo->wapiCamEntry[i].entry_idx; -+ break; -+ } -+ } -+ } -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+ return ret; -+ -+/* -+ if(RTIsListEmpty(&pWapiInfo->wapiCamIdleList)){ -+ RT_TRACE(COMP_SEC,DBG_LOUD,("No Entry for wapi!!!\n")); -+ return 0; -+ } -+ -+ pEntry = (PRT_WAPI_CAM_ENTRY)RTRemoveHeadList(&pWapiInfo->wapiCamIdleList); -+ RTInsertTailList(&pWapiInfo->wapiCamUsedList, &pEntry->list); -+ -+ RT_TRACE(COMP_SEC,DBG_LOUD,("<====WapiGetCamEntry(),Get Entry Idx:%d.but we just return 4 for test\n",pEntry->entry_idx)); -+ -+ return pEntry->entry_idx;*/ -+} -+ -+u8 WapiGetEntryForCamClear(_adapter *padapter,u8 *pPeerMac,u8 keyid,u8 IsMsk) -+{ -+ PRT_WAPI_T pWapiInfo=NULL; -+ u8 i=0; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ for(i=0;iwapiCamEntry[i].IsUsed -+ && (_rtw_memcmp(pPeerMac, pWapiInfo->wapiCamEntry[i].PeerMacAddr, ETH_ALEN) == _TRUE) -+ && pWapiInfo->wapiCamEntry[i].keyidx == keyid -+ && pWapiInfo->wapiCamEntry[i].type == IsMsk) -+ { -+ pWapiInfo->wapiCamEntry[i].IsUsed = 0; -+ pWapiInfo->wapiCamEntry[i].keyidx = 2; -+ _rtw_memset(pWapiInfo->wapiCamEntry[i].PeerMacAddr,0,ETH_ALEN); -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+ return pWapiInfo->wapiCamEntry[i].entry_idx; -+ } -+ } -+ -+ WAPI_TRACE(WAPI_API,"<====WapiGetReturnCamEntry(), No this cam entry.\n"); -+ return 0xff; -+/* -+ if(RTIsListEmpty(&pWapiInfo->wapiCamUsedList)){ -+ RT_TRACE(COMP_SEC,DBG_LOUD,("No Entry for wapi!!!\n")); -+ return FALSE; -+ } -+ -+ pList = &pWapiInfo->wapiCamUsedList; -+ while(pList->Flink != &pWapiInfo->wapiCamUsedList) -+ { -+ pEntry = (PRT_WAPI_CAM_ENTRY)pList->Flink; -+ if(PlatformCompareMemory(pPeerMac,pEntry->PeerMacAddr, ETHER_ADDRLEN)== 0 -+ && keyid == pEntry->keyidx) -+ { -+ RTRemoveEntryList(pList); -+ RTInsertHeadList(&pWapiInfo->wapiCamIdleList, pList); -+ return pEntry->entry_idx; -+ } -+ pList = pList->Flink; -+ } -+ -+ return 0; -+*/ -+} -+ -+void -+WapiResetAllCamEntry(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo; -+ int i; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ for (i=0;iwapiCamEntry[i].PeerMacAddr, 0, ETH_ALEN); -+ pWapiInfo->wapiCamEntry[i].IsUsed = 0; -+ pWapiInfo->wapiCamEntry[i].keyidx = 2; //invalid -+ pWapiInfo->wapiCamEntry[i].entry_idx = 4+i*2; -+ } -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+ -+ return; -+} -+ -+u8 WapiWriteOneCamEntry( -+ _adapter *padapter, -+ u8 *pMacAddr, -+ u8 KeyId, -+ u8 EntryId, -+ u8 EncAlg, -+ u8 bGroupKey, -+ u8 *pKey -+) -+{ -+ u8 retVal = 0; -+ u16 usConfig = 0; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ if(EntryId >= 32) -+ { -+ WAPI_TRACE(WAPI_ERR, "<=== CamAddOneEntry(): ulKeyId exceed!\n"); -+ return retVal; -+ } -+ -+ usConfig=usConfig|(0x01<<15)|((u16)(EncAlg)<<2)|(KeyId); -+ -+ if(EncAlg == _SMS4_ ) -+ { -+ if(bGroupKey == 1) -+ usConfig |= (0x01<<6); -+ if((EntryId % 2)==1) // ==0 sec key; == 1mic key -+ usConfig |= (0x01<<5); -+ } -+ -+ write_cam(padapter, EntryId, usConfig, pMacAddr, pKey); -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ return 1; -+} -+ -+void rtw_wapi_init(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo; -+ int i; -+ -+ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); -+ RT_ASSERT_RET(padapter); -+ -+ if (!padapter->WapiSupport) -+ { -+ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ pWapiInfo = &padapter->wapiInfo; -+ pWapiInfo->bWapiEnable = false; -+ -+ //Init BKID List -+ INIT_LIST_HEAD(&pWapiInfo->wapiBKIDIdleList); -+ INIT_LIST_HEAD(&pWapiInfo->wapiBKIDStoreList); -+ for(i=0;iwapiBKID[i].list, &pWapiInfo->wapiBKIDIdleList); -+ } -+ -+ //Init STA List -+ INIT_LIST_HEAD(&pWapiInfo->wapiSTAIdleList); -+ INIT_LIST_HEAD(&pWapiInfo->wapiSTAUsedList); -+ for(i=0;iwapiSta[i].list, &pWapiInfo->wapiSTAIdleList); -+ } -+ -+ for (i=0;iwapiCamEntry[i].IsUsed = 0; -+ pWapiInfo->wapiCamEntry[i].keyidx = 2; //invalid -+ pWapiInfo->wapiCamEntry[i].entry_idx = 4+i*2; -+ } -+ -+ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_free(_adapter *padapter) -+{ -+ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); -+ RT_ASSERT_RET(padapter); -+ -+ if (!padapter->WapiSupport) -+ { -+ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ WapiFreeAllStaInfo(padapter); -+ -+ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_disable_tx(_adapter *padapter) -+{ -+ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); -+ RT_ASSERT_RET(padapter); -+ -+ if (!padapter->WapiSupport) -+ { -+ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ padapter->wapiInfo.wapiTxMsk.bTxEnable = false; -+ padapter->wapiInfo.wapiTxMsk.bSet = false; -+ -+ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); -+} -+ -+u8 rtw_wapi_is_wai_packet(_adapter* padapter,u8 *pkt_data) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ u8 WaiPkt = 0, *pTaddr, bFind = false; -+ u8 Offset_TypeWAI = 0 ; // (mac header len + llc length) -+ -+ WAPI_TRACE(WAPI_TX|WAPI_RX, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return 0; -+ } -+ -+ Offset_TypeWAI = 24 + 6 ; -+ -+ //YJ,add,091103. Data frame may also have skb->data[30]=0x88 and skb->data[31]=0xb4. -+ if ((pkt_data[1]&0x40) !=0) -+ { -+ //DBG_871X("data is privacy \n"); -+ return 0; -+ } -+ -+ pTaddr = GetAddr2Ptr(pkt_data); -+ if(list_empty(&pWapiInfo->wapiSTAUsedList)){ -+ bFind = false; -+ }else{ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list){ -+ if (_rtw_memcmp(pTaddr, pWapiSta->PeerMacAddr, 6) == _TRUE) { -+ bFind = true; -+ break; -+ } -+ } -+ } -+ -+ WAPI_TRACE(WAPI_TX|WAPI_RX, "%s: bFind=%d pTaddr="MAC_FMT"\n", __FUNCTION__, bFind, MAC_ARG(pTaddr)); -+ -+ if (pkt_data[0] == WIFI_QOS_DATA_TYPE) -+ { -+ Offset_TypeWAI += 2; -+ } -+ -+ // 88b4? -+ if( (pkt_data[Offset_TypeWAI]==0x88) && (pkt_data[Offset_TypeWAI+1]==0xb4) ){ -+ WaiPkt = pkt_data[Offset_TypeWAI+5]; -+ -+ psecuritypriv->hw_decrypted = _TRUE; -+ }else{ -+ WAPI_TRACE(WAPI_TX|WAPI_RX, "%s(): non wai packet\n",__FUNCTION__); -+ } -+ -+ WAPI_TRACE(WAPI_TX|WAPI_RX, "%s(): Recvd WAI frame. IsWAIPkt(%d)\n",__FUNCTION__, WaiPkt); -+ -+ return WaiPkt; -+} -+ -+ -+void rtw_wapi_update_info(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ struct recv_frame_hdr *precv_hdr; -+ u8 *ptr; -+ u8 *pTA; -+ u8 *pRecvPN; -+ -+ -+ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ precv_hdr = &precv_frame->u.hdr; -+ ptr = precv_hdr->rx_data; -+ -+ if (precv_hdr->attrib.qos == 1) -+ { -+ precv_hdr->UserPriority = GetTid(ptr); -+ } -+ else -+ { -+ precv_hdr->UserPriority = 0; -+ } -+ -+ pTA = GetAddr2Ptr(ptr); -+ _rtw_memcpy((u8 *)precv_hdr->WapiSrcAddr, pTA, 6); -+ pRecvPN = ptr + precv_hdr->attrib.hdrlen + 2; -+ _rtw_memcpy((u8 *)precv_hdr->WapiTempPN, pRecvPN, 16); -+ -+ WAPI_TRACE(WAPI_RX, "<========== %s\n", __FUNCTION__); -+} -+ -+/**************************************************************************** -+TRUE-----------------Drop -+FALSE---------------- handle -+add to support WAPI to N-mode -+*****************************************************************************/ -+u8 rtw_wapi_check_for_drop( -+ _adapter *padapter, -+ union recv_frame *precv_frame -+) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ u8 *pLastRecvPN = NULL; -+ u8 bFind = false; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ u8 bDrop = false; -+ struct recv_frame_hdr *precv_hdr = &precv_frame->u.hdr; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ int i; -+ -+ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return false; -+ } -+ -+ if(precv_hdr->bIsWaiPacket !=0) -+ { -+ if(precv_hdr->bIsWaiPacket== 0x8) -+ { -+ -+ DBG_871X("rtw_wapi_check_for_drop: dump packet \n"); -+ for(i=0;i<50;i++) -+ { -+ DBG_871X("%02X ",ptr[i]); -+ if((i+1) %8 ==0) -+ DBG_871X("\n"); -+ } -+ DBG_871X("\n rtw_wapi_check_for_drop: dump packet \n"); -+ -+ for(i=0;i<16;i++) -+ { -+ if(ptr[i+27] !=0) -+ break; -+ } -+ -+ if(i== 16) -+ { -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_check_for_drop: drop with zero BKID \n"); -+ return true; -+ } -+ else -+ { -+ return false; -+ } -+ } -+ else -+ return false; -+ } -+ -+ if(list_empty(&pWapiInfo->wapiSTAUsedList)){ -+ bFind = false; -+ }else{ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (_rtw_memcmp(precv_hdr->WapiSrcAddr, pWapiSta->PeerMacAddr, ETH_ALEN) == _TRUE) { -+ bFind = true; -+ break; -+ } -+ } -+ } -+ WAPI_TRACE(WAPI_RX, "%s: bFind=%d prxb->WapiSrcAddr="MAC_FMT"\n", __FUNCTION__, bFind, MAC_ARG(precv_hdr->WapiSrcAddr)); -+ -+ if(bFind) -+ { -+ if(IS_MCAST(precv_hdr->attrib.ra)) -+ { -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_check_for_drop: multicast case \n"); -+ pLastRecvPN = pWapiSta->lastRxMulticastPN; -+ } -+ else -+ { -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_check_for_drop: unicast case \n"); -+ switch(precv_hdr->UserPriority) -+ { -+ case 0: -+ case 3: -+ pLastRecvPN = pWapiSta->lastRxUnicastPNBEQueue; -+ break; -+ case 1: -+ case 2: -+ pLastRecvPN = pWapiSta->lastRxUnicastPNBKQueue; -+ break; -+ case 4: -+ case 5: -+ pLastRecvPN = pWapiSta->lastRxUnicastPNVIQueue; -+ break; -+ case 6: -+ case 7: -+ pLastRecvPN = pWapiSta->lastRxUnicastPNVOQueue; -+ break; -+ default: -+ WAPI_TRACE(WAPI_ERR,"%s: Unknown TID \n",__FUNCTION__); -+ break; -+ } -+ } -+ -+ if(!WapiComparePN(precv_hdr->WapiTempPN,pLastRecvPN)) -+ { -+ WAPI_TRACE(WAPI_RX,"%s: Equal PN!!\n",__FUNCTION__); -+ if(IS_MCAST(precv_hdr->attrib.ra)) -+ _rtw_memcpy(pLastRecvPN,WapiAEMultiCastPNInitialValueSrc,16); -+ else -+ _rtw_memcpy(pLastRecvPN,WapiAEPNInitialValueSrc,16); -+ bDrop = true; -+ } -+ else -+ { -+ _rtw_memcpy(pLastRecvPN,precv_hdr->WapiTempPN,16); -+ } -+ } -+ -+ WAPI_TRACE(WAPI_RX, "<========== %s\n", __FUNCTION__); -+ return bDrop; -+} -+ -+void rtw_build_probe_resp_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ u8 WapiIELength = 0; -+ -+ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ WapiSetIE(padapter); -+ WapiIELength = pWapiInfo->wapiIELength; -+ pframe[0] = _WAPI_IE_; -+ pframe[1] = WapiIELength; -+ _rtw_memcpy(pframe+2, pWapiInfo->wapiIE, WapiIELength); -+ pframe += WapiIELength+2; -+ pattrib->pktlen += WapiIELength+2; -+ -+ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_build_beacon_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ u8 WapiIELength = 0; -+ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ WapiSetIE(padapter); -+ WapiIELength = pWapiInfo->wapiIELength; -+ pframe[0] = _WAPI_IE_; -+ pframe[1] = WapiIELength; -+ _rtw_memcpy(pframe+2, pWapiInfo->wapiIE, WapiIELength); -+ pframe += WapiIELength+2; -+ pattrib->pktlen += WapiIELength+2; -+ -+ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_build_assoc_req_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) -+{ -+ PRT_WAPI_BKID pWapiBKID; -+ u16 bkidNum; -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ u8 WapiIELength = 0; -+ -+ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ WapiSetIE(padapter); -+ WapiIELength = pWapiInfo->wapiIELength; -+ bkidNum = 0; -+ if(!list_empty(&(pWapiInfo->wapiBKIDStoreList))){ -+ list_for_each_entry(pWapiBKID, &pWapiInfo->wapiBKIDStoreList, list) { -+ bkidNum ++; -+ _rtw_memcpy(pWapiInfo->wapiIE+WapiIELength+2, pWapiBKID->bkid,16); -+ WapiIELength += 16; -+ } -+ } -+ _rtw_memcpy(pWapiInfo->wapiIE+WapiIELength, &bkidNum, 2); -+ WapiIELength += 2; -+ -+ pframe[0] = _WAPI_IE_; -+ pframe[1] = WapiIELength; -+ _rtw_memcpy(pframe+2, pWapiInfo->wapiIE, WapiIELength); -+ pframe += WapiIELength+2; -+ pattrib->pktlen += WapiIELength+2; -+ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_on_assoc_ok(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ PRT_WAPI_STA_INFO pWapiSta; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ //u8 WapiASUEPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ -+ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ pWapiSta =(PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAIdleList.next, RT_WAPI_STA_INFO, list); -+ list_del_init(&pWapiSta->list); -+ list_add_tail(&pWapiSta->list, &pWapiInfo->wapiSTAUsedList); -+ _rtw_memcpy(pWapiSta->PeerMacAddr,padapter->mlmeextpriv.mlmext_info.network.MacAddress,6); -+ _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPN, WapiAEPNInitialValueSrc, 16); -+ -+ //For chenk PN error with Qos Data after s3: add by ylb 20111114 -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue,WapiAEPNInitialValueSrc,16); -+ -+ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); -+} -+ -+ -+void rtw_wapi_return_one_sta_info(_adapter *padapter, u8 *MacAddr) -+{ -+ PRT_WAPI_T pWapiInfo; -+ PRT_WAPI_STA_INFO pWapiStaInfo = NULL; -+ PRT_WAPI_BKID pWapiBkid = NULL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ WAPI_TRACE(WAPI_API, "==========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ { -+ while(!list_empty(&(pWapiInfo->wapiBKIDStoreList))) -+ { -+ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDStoreList.next, RT_WAPI_BKID, list); -+ list_del_init(&pWapiBkid->list); -+ _rtw_memset(pWapiBkid->bkid,0,16); -+ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDIdleList); -+ } -+ } -+ -+ -+ WAPI_TRACE(WAPI_API, " %s: after clear bkid \n", __FUNCTION__); -+ -+ -+ //Remove STA info -+ if(list_empty(&(pWapiInfo->wapiSTAUsedList))){ -+ WAPI_TRACE(WAPI_API, " %s: wapiSTAUsedList is null \n", __FUNCTION__); -+ return; -+ }else{ -+ -+ WAPI_TRACE(WAPI_API, " %s: wapiSTAUsedList is not null \n", __FUNCTION__); -+#if 0 -+ pWapiStaInfo=(PRT_WAPI_STA_INFO)list_entry((pWapiInfo->wapiSTAUsedList.next),RT_WAPI_STA_INFO,list); -+ -+ list_for_each_entry(pWapiStaInfo, &(pWapiInfo->wapiSTAUsedList), list) { -+ -+ DBG_871X("MAC Addr %02x-%02x-%02x-%02x-%02x-%02x \n",MacAddr[0],MacAddr[1],MacAddr[2],MacAddr[3],MacAddr[4],MacAddr[5]); -+ -+ -+ DBG_871X("peer Addr %02x-%02x-%02x-%02x-%02x-%02x \n",pWapiStaInfo->PeerMacAddr[0],pWapiStaInfo->PeerMacAddr[1],pWapiStaInfo->PeerMacAddr[2],pWapiStaInfo->PeerMacAddr[3],pWapiStaInfo->PeerMacAddr[4],pWapiStaInfo->PeerMacAddr[5]); -+ -+ if(pWapiStaInfo == NULL) -+ { -+ WAPI_TRACE(WAPI_API, " %s: pWapiStaInfo == NULL Case \n", __FUNCTION__); -+ return; -+ } -+ -+ if(pWapiStaInfo->PeerMacAddr == NULL) -+ { -+ WAPI_TRACE(WAPI_API, " %s: pWapiStaInfo->PeerMacAddr == NULL Case \n", __FUNCTION__); -+ return; -+ } -+ -+ if(MacAddr == NULL) -+ { -+ WAPI_TRACE(WAPI_API, " %s: MacAddr == NULL Case \n", __FUNCTION__); -+ return; -+ } -+ -+ if (_rtw_memcmp(pWapiStaInfo->PeerMacAddr, MacAddr, ETH_ALEN) == _TRUE) { -+ pWapiStaInfo->bAuthenticateInProgress = false; -+ pWapiStaInfo->bSetkeyOk = false; -+ _rtw_memset(pWapiStaInfo->PeerMacAddr,0,ETH_ALEN); -+ list_del_init(&pWapiStaInfo->list); -+ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); -+ break; -+ } -+ -+ } -+#endif -+ -+ while(!list_empty(&(pWapiInfo->wapiSTAUsedList))) -+ { -+ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAUsedList.next, RT_WAPI_STA_INFO, list); -+ -+ DBG_871X("peer Addr %02x-%02x-%02x-%02x-%02x-%02x \n",pWapiStaInfo->PeerMacAddr[0],pWapiStaInfo->PeerMacAddr[1],pWapiStaInfo->PeerMacAddr[2],pWapiStaInfo->PeerMacAddr[3],pWapiStaInfo->PeerMacAddr[4],pWapiStaInfo->PeerMacAddr[5]); -+ -+ list_del_init(&pWapiStaInfo->list); -+ memset(pWapiStaInfo->PeerMacAddr,0,ETH_ALEN); -+ pWapiStaInfo->bSetkeyOk = 0; -+ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); -+ } -+ -+ } -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+ return; -+} -+ -+void rtw_wapi_return_all_sta_info(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo; -+ PRT_WAPI_STA_INFO pWapiStaInfo; -+ PRT_WAPI_BKID pWapiBkid; -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ //Sta Info List -+ while(!list_empty(&(pWapiInfo->wapiSTAUsedList))) -+ { -+ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAUsedList.next, RT_WAPI_STA_INFO, list); -+ list_del_init(&pWapiStaInfo->list); -+ memset(pWapiStaInfo->PeerMacAddr,0,ETH_ALEN); -+ pWapiStaInfo->bSetkeyOk = 0; -+ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); -+ } -+ -+ //BKID List -+ while(!list_empty(&(pWapiInfo->wapiBKIDStoreList))) -+ { -+ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDStoreList.next, RT_WAPI_BKID, list); -+ list_del_init(&pWapiBkid->list); -+ memset(pWapiBkid->bkid,0,16); -+ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDIdleList); -+ } -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_clear_cam_entry(_adapter *padapter, u8 *pMacAddr) -+{ -+ u8 UcIndex = 0; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 0, 0); -+ if(UcIndex != 0xff){ -+ //CAM_mark_invalid(Adapter, UcIndex); -+ CAM_empty_entry(padapter, UcIndex); -+ } -+ -+ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 1, 0); -+ if(UcIndex != 0xff){ -+ //CAM_mark_invalid(Adapter, UcIndex); -+ CAM_empty_entry(padapter, UcIndex); -+ } -+ -+ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 0, 1); -+ if(UcIndex != 0xff){ -+ //CAM_mark_invalid(Adapter, UcIndex); -+ CAM_empty_entry(padapter, UcIndex); -+ } -+ -+ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 1, 1); -+ if(UcIndex != 0xff){ -+ //CAM_mark_invalid(padapter, UcIndex); -+ CAM_empty_entry(padapter, UcIndex); -+ } -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_clear_all_cam_entry(_adapter *padapter) -+{ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ invalidate_cam_all(padapter); // is this ok? -+ WapiResetAllCamEntry(padapter); -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_set_key(_adapter *padapter, RT_WAPI_KEY *pWapiKey, RT_WAPI_STA_INFO *pWapiSta, u8 bGroupKey, u8 bUseDefaultKey) -+{ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ u8 *pMacAddr = pWapiSta->PeerMacAddr; -+ u32 EntryId = 0; -+ BOOLEAN IsPairWise = false ; -+ u8 EncAlgo; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_API, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ EncAlgo = _SMS4_; -+ -+ //For Tx bc/mc pkt,use defualt key entry -+ if(bUseDefaultKey) -+ { -+ // when WAPI update key, keyid will be 0 or 1 by turns. -+ if (pWapiKey->keyId == 0) -+ EntryId = 0; -+ else -+ EntryId = 2; -+ } -+ else -+ { -+ // tx/rx unicast pkt, or rx broadcast, find the key entry by peer's MacAddr -+ EntryId = WapiGetEntryForCamWrite(padapter,pMacAddr,pWapiKey->keyId,bGroupKey); -+ } -+ -+ if(EntryId == 0xff){ -+ WAPI_TRACE(WAPI_API, "===>No entry for WAPI setkey! !!\n"); -+ return; -+ } -+ -+ //EntryId is also used to diff Sec key and Mic key -+ //Sec Key -+ WapiWriteOneCamEntry(padapter, -+ pMacAddr, -+ pWapiKey->keyId, //keyid -+ EntryId, //entry -+ EncAlgo, //type -+ bGroupKey, //pairwise or group key -+ pWapiKey->dataKey); -+ //MIC key -+ WapiWriteOneCamEntry(padapter, -+ pMacAddr, -+ pWapiKey->keyId, //keyid -+ EntryId+1, //entry -+ EncAlgo, //type -+ bGroupKey, //pairwise or group key -+ pWapiKey->micKey); -+ -+ WAPI_TRACE(WAPI_API, "Set Wapi Key :KeyId:%d,EntryId:%d,PairwiseKey:%d.\n",pWapiKey->keyId,EntryId,!bGroupKey); -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+} -+ -+#if 0 -+//YJ,test,091013 -+void wapi_test_set_key(struct _adapter *padapter, u8* buf) -+{ /*Data: keyType(1) + bTxEnable(1) + bAuthenticator(1) + bUpdate(1) + PeerAddr(6) + DataKey(16) + MicKey(16) + KeyId(1)*/ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_BKID pWapiBkid; -+ PRT_WAPI_STA_INFO pWapiSta; -+ u8 data[43]; -+ bool bTxEnable; -+ bool bUpdate; -+ bool bAuthenticator; -+ u8 PeerAddr[6]; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiASUEPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ -+ WAPI_TRACE(WAPI_INIT, "===========>%s\n", __FUNCTION__); -+ -+ if (!padapter->WapiSupport){ -+ return; -+ } -+ -+ copy_from_user(data, buf, 43); -+ bTxEnable = data[1]; -+ bAuthenticator = data[2]; -+ bUpdate = data[3]; -+ memcpy(PeerAddr,data+4,6); -+ -+ if(data[0] == 0x3){ -+ if(!list_empty(&(pWapiInfo->wapiBKIDIdleList))){ -+ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDIdleList.next, RT_WAPI_BKID, list); -+ list_del_init(&pWapiBkid->list); -+ memcpy(pWapiBkid->bkid, data+10, 16); -+ WAPI_DATA(WAPI_INIT, "SetKey - BKID", pWapiBkid->bkid, 16); -+ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDStoreList); -+ } -+ }else{ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if(!memcmp(pWapiSta->PeerMacAddr,PeerAddr,6)){ -+ pWapiSta->bAuthenticatorInUpdata = false; -+ switch(data[0]){ -+ case 1: //usk -+ if(bAuthenticator){ //authenticator -+ memcpy(pWapiSta->lastTxUnicastPN,WapiAEPNInitialValueSrc,16); -+ if(!bUpdate) { //first -+ WAPI_TRACE(WAPI_INIT,"AE fisrt set usk \n"); -+ pWapiSta->wapiUsk.bSet = true; -+ memcpy(pWapiSta->wapiUsk.dataKey,data+10,16); -+ memcpy(pWapiSta->wapiUsk.micKey,data+26,16); -+ pWapiSta->wapiUsk.keyId = *(data+42); -+ pWapiSta->wapiUsk.bTxEnable = true; -+ WAPI_DATA(WAPI_INIT, "SetKey - AE USK Data Key", pWapiSta->wapiUsk.dataKey, 16); -+ WAPI_DATA(WAPI_INIT, "SetKey - AE USK Mic Key", pWapiSta->wapiUsk.micKey, 16); -+ } -+ else //update -+ { -+ WAPI_TRACE(WAPI_INIT, "AE update usk \n"); -+ pWapiSta->wapiUskUpdate.bSet = true; -+ pWapiSta->bAuthenticatorInUpdata = true; -+ memcpy(pWapiSta->wapiUskUpdate.dataKey,data+10,16); -+ memcpy(pWapiSta->wapiUskUpdate.micKey,data+26,16); -+ memcpy(pWapiSta->lastRxUnicastPNBEQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPNBKQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPNVIQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPNVOQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPN,WapiASUEPNInitialValueSrc,16); -+ pWapiSta->wapiUskUpdate.keyId = *(data+42); -+ pWapiSta->wapiUskUpdate.bTxEnable = true; -+ } -+ } -+ else{ -+ if(!bUpdate){ -+ WAPI_TRACE(WAPI_INIT,"ASUE fisrt set usk \n"); -+ if(bTxEnable){ -+ pWapiSta->wapiUsk.bTxEnable = true; -+ memcpy(pWapiSta->lastTxUnicastPN,WapiASUEPNInitialValueSrc,16); -+ }else{ -+ pWapiSta->wapiUsk.bSet = true; -+ memcpy(pWapiSta->wapiUsk.dataKey,data+10,16); -+ memcpy(pWapiSta->wapiUsk.micKey,data+26,16); -+ pWapiSta->wapiUsk.keyId = *(data+42); -+ pWapiSta->wapiUsk.bTxEnable = false; -+ } -+ }else{ -+ WAPI_TRACE(WAPI_INIT,"ASUE update usk \n"); -+ if(bTxEnable){ -+ pWapiSta->wapiUskUpdate.bTxEnable = true; -+ if(pWapiSta->wapiUskUpdate.bSet){ -+ memcpy(pWapiSta->wapiUsk.dataKey,pWapiSta->wapiUskUpdate.dataKey,16); -+ memcpy(pWapiSta->wapiUsk.micKey,pWapiSta->wapiUskUpdate.micKey,16); -+ pWapiSta->wapiUsk.keyId=pWapiSta->wapiUskUpdate.keyId; -+ memcpy(pWapiSta->lastRxUnicastPNBEQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPNBKQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPNVIQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPNVOQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPN,WapiASUEPNInitialValueSrc,16); -+ pWapiSta->wapiUskUpdate.bTxEnable = false; -+ pWapiSta->wapiUskUpdate.bSet = false; -+ } -+ memcpy(pWapiSta->lastTxUnicastPN,WapiASUEPNInitialValueSrc,16); -+ }else{ -+ pWapiSta->wapiUskUpdate.bSet = true; -+ memcpy(pWapiSta->wapiUskUpdate.dataKey,data+10,16); -+ memcpy(pWapiSta->wapiUskUpdate.micKey,data+26,16); -+ pWapiSta->wapiUskUpdate.keyId = *(data+42); -+ pWapiSta->wapiUskUpdate.bTxEnable = false; -+ } -+ } -+ } -+ break; -+ case 2: //msk -+ if(bAuthenticator){ //authenticator -+ pWapiInfo->wapiTxMsk.bSet = true; -+ memcpy(pWapiInfo->wapiTxMsk.dataKey,data+10,16); -+ memcpy(pWapiInfo->wapiTxMsk.micKey,data+26,16); -+ pWapiInfo->wapiTxMsk.keyId = *(data+42); -+ pWapiInfo->wapiTxMsk.bTxEnable = true; -+ memcpy(pWapiInfo->lastTxMulticastPN,WapiAEMultiCastPNInitialValueSrc,16); -+ -+ if(!bUpdate){ //first -+ WAPI_TRACE(WAPI_INIT, "AE fisrt set msk \n"); -+ if(!pWapiSta->bSetkeyOk) -+ pWapiSta->bSetkeyOk = true; -+ pWapiInfo->bFirstAuthentiateInProgress= false; -+ }else{ //update -+ WAPI_TRACE(WAPI_INIT,"AE update msk \n"); -+ } -+ -+ WAPI_DATA(WAPI_INIT, "SetKey - AE MSK Data Key", pWapiInfo->wapiTxMsk.dataKey, 16); -+ WAPI_DATA(WAPI_INIT, "SetKey - AE MSK Mic Key", pWapiInfo->wapiTxMsk.micKey, 16); -+ } -+ else{ -+ if(!bUpdate){ -+ WAPI_TRACE(WAPI_INIT,"ASUE fisrt set msk \n"); -+ pWapiSta->wapiMsk.bSet = true; -+ memcpy(pWapiSta->wapiMsk.dataKey,data+10,16); -+ memcpy(pWapiSta->wapiMsk.micKey,data+26,16); -+ pWapiSta->wapiMsk.keyId = *(data+42); -+ pWapiSta->wapiMsk.bTxEnable = false; -+ if(!pWapiSta->bSetkeyOk) -+ pWapiSta->bSetkeyOk = true; -+ pWapiInfo->bFirstAuthentiateInProgress= false; -+ WAPI_DATA(WAPI_INIT, "SetKey - ASUE MSK Data Key", pWapiSta->wapiMsk.dataKey, 16); -+ WAPI_DATA(WAPI_INIT, "SetKey - ASUE MSK Mic Key", pWapiSta->wapiMsk.micKey, 16); -+ }else{ -+ WAPI_TRACE(WAPI_INIT,"ASUE update msk \n"); -+ pWapiSta->wapiMskUpdate.bSet = true; -+ memcpy(pWapiSta->wapiMskUpdate.dataKey,data+10,16); -+ memcpy(pWapiSta->wapiMskUpdate.micKey,data+26,16); -+ pWapiSta->wapiMskUpdate.keyId = *(data+42); -+ pWapiSta->wapiMskUpdate.bTxEnable = false; -+ } -+ } -+ break; -+ default: -+ WAPI_TRACE(WAPI_ERR,"Unknown Flag \n"); -+ break; -+ } -+ } -+ } -+ } -+ WAPI_TRACE(WAPI_INIT, "<===========%s\n", __FUNCTION__); -+} -+ -+ -+void wapi_test_init(struct _adapter *padapter) -+{ -+ u8 keybuf[100]; -+ u8 mac_addr[6]={0x00,0xe0,0x4c,0x72,0x04,0x70}; -+ u8 UskDataKey[16]={0x00,0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,0x09,0x0a,0x0b,0x0c,0x0d,0x0e,0x0f}; -+ u8 UskMicKey[16]={0x10,0x11,0x12,0x13,0x14,0x15,0x16,0x17,0x18,0x19,0x1a,0x1b,0x1c,0x1d,0x1e,0x1f}; -+ u8 UskId = 0; -+ u8 MskDataKey[16]={0x20,0x21,0x22,0x23,0x24,0x25,0x26,0x27,0x28,0x29,0x2a,0x2b,0x2c,0x2d,0x2e,0x2f}; -+ u8 MskMicKey[16]={0x30,0x31,0x32,0x33,0x34,0x35,0x36,0x37,0x38,0x39,0x3a,0x3b,0x3c,0x3d,0x3e,0x3f}; -+ u8 MskId = 0; -+ -+ WAPI_TRACE(WAPI_INIT, "===========>%s\n", __FUNCTION__); -+ -+ //Enable Wapi -+ WAPI_TRACE(WAPI_INIT, "%s: Enable wapi!!!!\n", __FUNCTION__); -+ padapter->wapiInfo.bWapiEnable = true; -+ padapter->pairwise_key_type = KEY_TYPE_SMS4; -+ ieee->group_key_type = KEY_TYPE_SMS4; -+ padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN; -+ padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN; -+ -+ //set usk -+ WAPI_TRACE(WAPI_INIT, "%s: Set USK!!!!\n", __FUNCTION__); -+ memset(keybuf,0,100); -+ keybuf[0] = 1; //set usk -+ keybuf[1] = 1; //enable tx -+ keybuf[2] = 1; //AE -+ keybuf[3] = 0; //not update -+ -+ memcpy(keybuf+4,mac_addr,6); -+ memcpy(keybuf+10,UskDataKey,16); -+ memcpy(keybuf+26,UskMicKey,16); -+ keybuf[42]=UskId; -+ wapi_test_set_key(padapter, keybuf); -+ -+ memset(keybuf,0,100); -+ keybuf[0] = 1; //set usk -+ keybuf[1] = 1; //enable tx -+ keybuf[2] = 0; //AE -+ keybuf[3] = 0; //not update -+ -+ memcpy(keybuf+4,mac_addr,6); -+ memcpy(keybuf+10,UskDataKey,16); -+ memcpy(keybuf+26,UskMicKey,16); -+ keybuf[42]=UskId; -+ wapi_test_set_key(padapter, keybuf); -+ -+ //set msk -+ WAPI_TRACE(WAPI_INIT, "%s: Set MSK!!!!\n", __FUNCTION__); -+ memset(keybuf,0,100); -+ keybuf[0] = 2; //set msk -+ keybuf[1] = 1; //Enable TX -+ keybuf[2] = 1; //AE -+ keybuf[3] = 0; //not update -+ memcpy(keybuf+4,mac_addr,6); -+ memcpy(keybuf+10,MskDataKey,16); -+ memcpy(keybuf+26,MskMicKey,16); -+ keybuf[42] = MskId; -+ wapi_test_set_key(padapter, keybuf); -+ -+ memset(keybuf,0,100); -+ keybuf[0] = 2; //set msk -+ keybuf[1] = 1; //Enable TX -+ keybuf[2] = 0; //AE -+ keybuf[3] = 0; //not update -+ memcpy(keybuf+4,mac_addr,6); -+ memcpy(keybuf+10,MskDataKey,16); -+ memcpy(keybuf+26,MskMicKey,16); -+ keybuf[42] = MskId; -+ wapi_test_set_key(padapter, keybuf); -+ WAPI_TRACE(WAPI_INIT, "<===========%s\n", __FUNCTION__); -+} -+#endif -+ -+void rtw_wapi_get_iv(_adapter *padapter,u8 *pRA, u8*IV) -+{ -+ PWLAN_HEADER_WAPI_EXTENSION pWapiExt = NULL; -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ bool bPNOverflow = false; -+ bool bFindMatchPeer = false; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ -+ pWapiExt = (PWLAN_HEADER_WAPI_EXTENSION)IV; -+ -+ WAPI_DATA(WAPI_RX,"wapi_get_iv: pra",pRA,6); -+ -+ if(IS_MCAST(pRA)){ -+ if(!pWapiInfo->wapiTxMsk.bTxEnable){ -+ WAPI_TRACE(WAPI_ERR,"%s: bTxEnable = 0!!\n",__FUNCTION__); -+ return; -+ } -+ -+ if(pWapiInfo->wapiTxMsk.keyId <= 1){ -+ pWapiExt->KeyIdx = pWapiInfo->wapiTxMsk.keyId; -+ pWapiExt->Reserved = 0; -+ bPNOverflow = WapiIncreasePN(pWapiInfo->lastTxMulticastPN, 1); -+ memcpy(pWapiExt->PN, pWapiInfo->lastTxMulticastPN, 16); -+ } -+ } -+ else -+ { -+ if(list_empty(&pWapiInfo->wapiSTAUsedList)){ -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_get_iv: list is empty \n"); -+ _rtw_memset(IV,10,18); -+ return; -+ } -+ else{ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list){ -+ WAPI_DATA(WAPI_RX,"rtw_wapi_get_iv: peermacaddr ",pWapiSta->PeerMacAddr,6); -+ if (_rtw_memcmp((u8*)pWapiSta->PeerMacAddr, pRA, 6) == _TRUE) { -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ -+ WAPI_TRACE(WAPI_RX,"bFindMatchPeer: %d \n",bFindMatchPeer); -+ WAPI_DATA(WAPI_RX,"Addr",pRA,6); -+ -+ if (bFindMatchPeer){ -+ if((!pWapiSta->wapiUskUpdate.bTxEnable) && (!pWapiSta->wapiUsk.bTxEnable)) -+ return; -+ -+ if (pWapiSta->wapiUsk.keyId <= 1){ -+ if(pWapiSta->wapiUskUpdate.bTxEnable) -+ pWapiExt->KeyIdx = pWapiSta->wapiUskUpdate.keyId; -+ else -+ pWapiExt->KeyIdx = pWapiSta->wapiUsk.keyId; -+ -+ pWapiExt->Reserved = 0; -+ bPNOverflow = WapiIncreasePN(pWapiSta->lastTxUnicastPN, 2); -+ _rtw_memcpy(pWapiExt->PN, pWapiSta->lastTxUnicastPN, 16); -+ -+ } -+ } -+ } -+ -+ } -+ -+} -+ -+bool rtw_wapi_drop_for_key_absent(_adapter *padapter,u8 *pRA) -+{ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ bool bFindMatchPeer = false; -+ bool bDrop = false; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ WAPI_DATA(WAPI_RX,"rtw_wapi_drop_for_key_absent: ra ",pRA,6); -+ -+ if(psecuritypriv->dot11PrivacyAlgrthm == _SMS4_) -+ { -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ return true; -+ -+ if(IS_MCAST(pRA)){ -+ if(!pWapiInfo->wapiTxMsk.bTxEnable){ -+ bDrop = true; -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_drop_for_key_absent: multicast key is absent \n"); -+ return bDrop; -+ } -+ } -+ else{ -+ if(!list_empty(&pWapiInfo->wapiSTAUsedList)){ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list){ -+ WAPI_DATA(WAPI_RX,"rtw_wapi_drop_for_key_absent: pWapiSta->PeerMacAddr ",pWapiSta->PeerMacAddr,6); -+ if (_rtw_memcmp(pRA, pWapiSta->PeerMacAddr, 6) == _TRUE){ -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ if (bFindMatchPeer) { -+ if (!pWapiSta->wapiUsk.bTxEnable){ -+ bDrop = true; -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_drop_for_key_absent: unicast key is absent \n"); -+ return bDrop; -+ } -+ } -+ else{ -+ bDrop = true; -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_drop_for_key_absent: no peer find \n"); -+ return bDrop; -+ } -+ -+ } -+ else{ -+ bDrop = true; -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_drop_for_key_absent: no sta exist \n"); -+ return bDrop; -+ } -+ } -+ } -+ else -+ { -+ return bDrop; -+ } -+ -+ return bDrop; -+} -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wapi_sms4.c linux/3rdparty/rtl8812au/core/rtw_wapi_sms4.c ---- linux.old/3rdparty/rtl8812au/core/rtw_wapi_sms4.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_wapi_sms4.c 2017-06-07 23:07:21.006687120 +0300 -@@ -0,0 +1,923 @@ -+#ifdef CONFIG_WAPI_SUPPORT -+ -+#include -+#include -+#include -+#include -+ -+ -+#ifdef CONFIG_WAPI_SW_SMS4 -+ -+#define WAPI_LITTLE_ENDIAN -+//#define BIG_ENDIAN -+#define ENCRYPT 0 -+#define DECRYPT 1 -+ -+ -+/********************************************************** -+ **********************************************************/ -+const u8 Sbox[256] = { -+0xd6,0x90,0xe9,0xfe,0xcc,0xe1,0x3d,0xb7,0x16,0xb6,0x14,0xc2,0x28,0xfb,0x2c,0x05, -+0x2b,0x67,0x9a,0x76,0x2a,0xbe,0x04,0xc3,0xaa,0x44,0x13,0x26,0x49,0x86,0x06,0x99, -+0x9c,0x42,0x50,0xf4,0x91,0xef,0x98,0x7a,0x33,0x54,0x0b,0x43,0xed,0xcf,0xac,0x62, -+0xe4,0xb3,0x1c,0xa9,0xc9,0x08,0xe8,0x95,0x80,0xdf,0x94,0xfa,0x75,0x8f,0x3f,0xa6, -+0x47,0x07,0xa7,0xfc,0xf3,0x73,0x17,0xba,0x83,0x59,0x3c,0x19,0xe6,0x85,0x4f,0xa8, -+0x68,0x6b,0x81,0xb2,0x71,0x64,0xda,0x8b,0xf8,0xeb,0x0f,0x4b,0x70,0x56,0x9d,0x35, -+0x1e,0x24,0x0e,0x5e,0x63,0x58,0xd1,0xa2,0x25,0x22,0x7c,0x3b,0x01,0x21,0x78,0x87, -+0xd4,0x00,0x46,0x57,0x9f,0xd3,0x27,0x52,0x4c,0x36,0x02,0xe7,0xa0,0xc4,0xc8,0x9e, -+0xea,0xbf,0x8a,0xd2,0x40,0xc7,0x38,0xb5,0xa3,0xf7,0xf2,0xce,0xf9,0x61,0x15,0xa1, -+0xe0,0xae,0x5d,0xa4,0x9b,0x34,0x1a,0x55,0xad,0x93,0x32,0x30,0xf5,0x8c,0xb1,0xe3, -+0x1d,0xf6,0xe2,0x2e,0x82,0x66,0xca,0x60,0xc0,0x29,0x23,0xab,0x0d,0x53,0x4e,0x6f, -+0xd5,0xdb,0x37,0x45,0xde,0xfd,0x8e,0x2f,0x03,0xff,0x6a,0x72,0x6d,0x6c,0x5b,0x51, -+0x8d,0x1b,0xaf,0x92,0xbb,0xdd,0xbc,0x7f,0x11,0xd9,0x5c,0x41,0x1f,0x10,0x5a,0xd8, -+0x0a,0xc1,0x31,0x88,0xa5,0xcd,0x7b,0xbd,0x2d,0x74,0xd0,0x12,0xb8,0xe5,0xb4,0xb0, -+0x89,0x69,0x97,0x4a,0x0c,0x96,0x77,0x7e,0x65,0xb9,0xf1,0x09,0xc5,0x6e,0xc6,0x84, -+0x18,0xf0,0x7d,0xec,0x3a,0xdc,0x4d,0x20,0x79,0xee,0x5f,0x3e,0xd7,0xcb,0x39,0x48 -+}; -+ -+const u32 CK[32] = { -+ 0x00070e15, 0x1c232a31, 0x383f464d, 0x545b6269, -+ 0x70777e85, 0x8c939aa1, 0xa8afb6bd, 0xc4cbd2d9, -+ 0xe0e7eef5, 0xfc030a11, 0x181f262d, 0x343b4249, -+ 0x50575e65, 0x6c737a81, 0x888f969d, 0xa4abb2b9, -+ 0xc0c7ced5, 0xdce3eaf1, 0xf8ff060d, 0x141b2229, -+ 0x30373e45, 0x4c535a61, 0x686f767d, 0x848b9299, -+ 0xa0a7aeb5, 0xbcc3cad1, 0xd8dfe6ed, 0xf4fb0209, -+ 0x10171e25, 0x2c333a41, 0x484f565d, 0x646b7279 }; -+ -+#define Rotl(_x, _y) (((_x) << (_y)) | ((_x) >> (32 - (_y)))) -+ -+#define ByteSub(_A) (Sbox[(_A) >> 24 & 0xFF] << 24 | \ -+ Sbox[(_A) >> 16 & 0xFF] << 16 | \ -+ Sbox[(_A) >> 8 & 0xFF] << 8 | \ -+ Sbox[(_A) & 0xFF]) -+ -+#define L1(_B) ((_B) ^ Rotl(_B, 2) ^ Rotl(_B, 10) ^ Rotl(_B, 18) ^ Rotl(_B, 24)) -+#define L2(_B) ((_B) ^ Rotl(_B, 13) ^ Rotl(_B, 23)) -+ -+static void -+xor_block(void *dst, void *src1, void *src2) -+/* 128-bit xor: *dst = *src1 xor *src2. Pointers must be 32-bit aligned */ -+{ -+ ((u32 *)dst)[0] = ((u32 *)src1)[0] ^ ((u32 *)src2)[0]; -+ ((u32 *)dst)[1] = ((u32 *)src1)[1] ^ ((u32 *)src2)[1]; -+ ((u32 *)dst)[2] = ((u32 *)src1)[2] ^ ((u32 *)src2)[2]; -+ ((u32 *)dst)[3] = ((u32 *)src1)[3] ^ ((u32 *)src2)[3]; -+} -+ -+ -+void SMS4Crypt(u8 *Input, u8 *Output, u32 *rk) -+{ -+ u32 r, mid, x0, x1, x2, x3, *p; -+ p = (u32 *)Input; -+ x0 = p[0]; -+ x1 = p[1]; -+ x2 = p[2]; -+ x3 = p[3]; -+#ifdef WAPI_LITTLE_ENDIAN -+ x0 = Rotl(x0, 16); x0 = ((x0 & 0x00FF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); -+ x1 = Rotl(x1, 16); x1 = ((x1 & 0x00FF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); -+ x2 = Rotl(x2, 16); x2 = ((x2 & 0x00FF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); -+ x3 = Rotl(x3, 16); x3 = ((x3 & 0x00FF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); -+#endif -+ for (r = 0; r < 32; r += 4) -+ { -+ mid = x1 ^ x2 ^ x3 ^ rk[r + 0]; -+ mid = ByteSub(mid); -+ x0 ^= L1(mid); -+ mid = x2 ^ x3 ^ x0 ^ rk[r + 1]; -+ mid = ByteSub(mid); -+ x1 ^= L1(mid); -+ mid = x3 ^ x0 ^ x1 ^ rk[r + 2]; -+ mid = ByteSub(mid); -+ x2 ^= L1(mid); -+ mid = x0 ^ x1 ^ x2 ^ rk[r + 3]; -+ mid = ByteSub(mid); -+ x3 ^= L1(mid); -+ } -+#ifdef WAPI_LITTLE_ENDIAN -+ x0 = Rotl(x0, 16); x0 = ((x0 & 0x00FF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); -+ x1 = Rotl(x1, 16); x1 = ((x1 & 0x00FF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); -+ x2 = Rotl(x2, 16); x2 = ((x2 & 0x00FF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); -+ x3 = Rotl(x3, 16); x3 = ((x3 & 0x00FF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); -+#endif -+ p = (u32 *)Output; -+ p[0] = x3; -+ p[1] = x2; -+ p[2] = x1; -+ p[3] = x0; -+} -+ -+ -+ -+void SMS4KeyExt(u8 *Key, u32 *rk, u32 CryptFlag) -+{ -+ u32 r, mid, x0, x1, x2, x3, *p; -+ -+ p = (u32 *)Key; -+ x0 = p[0]; -+ x1 = p[1]; -+ x2 = p[2]; -+ x3 = p[3]; -+#ifdef WAPI_LITTLE_ENDIAN -+ x0 = Rotl(x0, 16); x0 = ((x0 & 0xFF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); -+ x1 = Rotl(x1, 16); x1 = ((x1 & 0xFF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); -+ x2 = Rotl(x2, 16); x2 = ((x2 & 0xFF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); -+ x3 = Rotl(x3, 16); x3 = ((x3 & 0xFF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); -+#endif -+ -+ x0 ^= 0xa3b1bac6; -+ x1 ^= 0x56aa3350; -+ x2 ^= 0x677d9197; -+ x3 ^= 0xb27022dc; -+ for (r = 0; r < 32; r += 4) -+ { -+ mid = x1 ^ x2 ^ x3 ^ CK[r + 0]; -+ mid = ByteSub(mid); -+ rk[r + 0] = x0 ^= L2(mid); -+ mid = x2 ^ x3 ^ x0 ^ CK[r + 1]; -+ mid = ByteSub(mid); -+ rk[r + 1] = x1 ^= L2(mid); -+ mid = x3 ^ x0 ^ x1 ^ CK[r + 2]; -+ mid = ByteSub(mid); -+ rk[r + 2] = x2 ^= L2(mid); -+ mid = x0 ^ x1 ^ x2 ^ CK[r + 3]; -+ mid = ByteSub(mid); -+ rk[r + 3] = x3 ^= L2(mid); -+ } -+ if (CryptFlag == DECRYPT) -+ { -+ for (r = 0; r < 16; r++) -+ mid = rk[r], rk[r] = rk[31 - r], rk[31 - r] = mid; -+ } -+} -+ -+ -+void WapiSMS4Cryption(u8 *Key, u8 *IV, u8 *Input, u16 InputLength, -+ u8 *Output, u16 *OutputLength, u32 CryptFlag) -+{ -+ u32 blockNum,i,j, rk[32]; -+ u16 remainder; -+ u8 blockIn[16],blockOut[16], tempIV[16], k; -+ -+ *OutputLength = 0; -+ remainder = InputLength & 0x0F; -+ blockNum = InputLength >> 4; -+ if(remainder !=0) -+ blockNum++; -+ else -+ remainder = 16; -+ -+ for(k=0;k<16;k++) -+ tempIV[k] = IV[15-k]; -+ -+ memcpy(blockIn, tempIV, 16); -+ -+ SMS4KeyExt((u8 *)Key, rk,CryptFlag); -+ -+ for(i=0; i> 4; -+ -+ for(k=0;k<16;k++) -+ tempIV[k] = IV[15-k]; -+ -+ memcpy(BlockIn, tempIV, 16); -+ -+ SMS4KeyExt((u8 *)Key, rk, ENCRYPT); -+ -+ SMS4Crypt((u8 *)BlockIn, BlockOut, rk); -+ -+ for(i=0; i> 4; -+ -+ for(i=0; i%s\n", __FUNCTION__); -+ -+ header = (struct ieee80211_hdr_3addr_qos *)pHeader; -+ memset(TempBuf, 0, 34); -+ memcpy(TempBuf, pHeader, 2); //FrameCtrl -+ pTemp = (u16*)TempBuf; -+ *pTemp &= 0xc78f; //bit4,5,6,11,12,13 -+ -+ memcpy((TempBuf+2), (pHeader+4), 12); //Addr1, Addr2 -+ memcpy((TempBuf+14), (pHeader+22), 2); // SeqCtrl -+ pTemp = (u16*)(TempBuf + 14); -+ *pTemp &= 0x000f; -+ -+ memcpy((TempBuf+16), (pHeader+16), 6); //Addr3 -+ -+ fc = le16_to_cpu(header->frame_ctl); -+ -+ -+ -+ if (GetFrDs((u16*)&fc) && GetToDs((u16 *)&fc)) -+ { -+ memcpy((TempBuf+22), (pHeader+24), 6); -+ QosOffset = 30; -+ }else{ -+ memset((TempBuf+22), 0, 6); -+ QosOffset = 24; -+ } -+ -+ if((fc & 0x0088) == 0x0088){ -+ memcpy((TempBuf+28), (pHeader+QosOffset), 2); -+ TempLen += 2; -+ //IV = pHeader + QosOffset + 2 + SNAP_SIZE + sizeof(u16) + 2; -+ IV = pHeader + QosOffset + 2 + 2; -+ }else{ -+ IV = pHeader + QosOffset + 2; -+ //IV = pHeader + QosOffset + SNAP_SIZE + sizeof(u16) + 2; -+ } -+ -+ TempBuf[TempLen-1] = (u8)(DataLen & 0xff); -+ TempBuf[TempLen-2] = (u8)((DataLen & 0xff00)>>8); -+ TempBuf[TempLen-4] = KeyIdx; -+ -+ WAPI_DATA(WAPI_TX, "CalculateMic - KEY", MicKey, 16); -+ WAPI_DATA(WAPI_TX, "CalculateMic - IV", IV, 16); -+ WAPI_DATA(WAPI_TX, "CalculateMic - TempBuf", TempBuf, TempLen); -+ WAPI_DATA(WAPI_TX, "CalculateMic - pData", pData, DataLen); -+ -+ WapiSMS4CalculateMic(MicKey, IV, TempBuf, TempLen, -+ pData, DataLen, MicBuffer, &MicLen); -+ -+ if (MicLen != 16) -+ WAPI_TRACE(WAPI_ERR,"%s: MIC Length Error!!\n",__FUNCTION__); -+ -+ WAPI_TRACE(WAPI_TX|WAPI_RX, "<=========%s\n", __FUNCTION__); -+#endif -+} -+ -+/* AddCount: 1 or 2. -+ * If overflow, return 1, -+ * else return 0. -+ */ -+u8 WapiIncreasePN(u8 *PN, u8 AddCount) -+{ -+ u8 i; -+ -+ if (NULL == PN) -+ return 1; -+ //YJ,test,091102 -+ /* -+ if(AddCount == 2){ -+ DBG_8192C("############################%s(): PN[0]=0x%x\n", __FUNCTION__, PN[0]); -+ if(PN[0] == 0x48){ -+ PN[0] += AddCount; -+ return 1; -+ }else{ -+ PN[0] += AddCount; -+ return 0; -+ } -+ } -+ */ -+ //YJ,test,091102,end -+ -+ for (i=0; i<16; i++) -+ { -+ if (PN[i] + AddCount <= 0xff) -+ { -+ PN[i] += AddCount; -+ return 0; -+ } -+ else -+ { -+ PN[i] += AddCount; -+ AddCount = 1; -+ } -+ } -+ return 1; -+} -+ -+ -+void WapiGetLastRxUnicastPNForQoSData( -+ u8 UserPriority, -+ PRT_WAPI_STA_INFO pWapiStaInfo, -+ u8 *PNOut -+) -+{ -+ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); -+ switch(UserPriority) -+ { -+ case 0: -+ case 3: -+ memcpy(PNOut,pWapiStaInfo->lastRxUnicastPNBEQueue,16); -+ break; -+ case 1: -+ case 2: -+ memcpy(PNOut,pWapiStaInfo->lastRxUnicastPNBKQueue,16); -+ break; -+ case 4: -+ case 5: -+ memcpy(PNOut,pWapiStaInfo->lastRxUnicastPNVIQueue,16); -+ break; -+ case 6: -+ case 7: -+ memcpy(PNOut,pWapiStaInfo->lastRxUnicastPNVOQueue,16); -+ break; -+ default: -+ WAPI_TRACE(WAPI_ERR, "%s: Unknown TID \n", __FUNCTION__); -+ break; -+ } -+ WAPI_TRACE(WAPI_RX, "<=========== %s\n", __FUNCTION__); -+} -+ -+ -+void WapiSetLastRxUnicastPNForQoSData( -+ u8 UserPriority, -+ u8 *PNIn, -+ PRT_WAPI_STA_INFO pWapiStaInfo -+) -+{ -+ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); -+ switch(UserPriority) -+ { -+ case 0: -+ case 3: -+ memcpy(pWapiStaInfo->lastRxUnicastPNBEQueue,PNIn,16); -+ break; -+ case 1: -+ case 2: -+ memcpy(pWapiStaInfo->lastRxUnicastPNBKQueue,PNIn,16); -+ break; -+ case 4: -+ case 5: -+ memcpy(pWapiStaInfo->lastRxUnicastPNVIQueue,PNIn,16); -+ break; -+ case 6: -+ case 7: -+ memcpy(pWapiStaInfo->lastRxUnicastPNVOQueue,PNIn,16); -+ break; -+ default: -+ WAPI_TRACE(WAPI_ERR, "%s: Unknown TID \n", __FUNCTION__); -+ break; -+ } -+ WAPI_TRACE(WAPI_RX, "<=========== %s\n", __FUNCTION__); -+} -+ -+ -+/**************************************************************************** -+ FALSE not RX-Reorder -+ TRUE do RX Reorder -+add to support WAPI to N-mode -+*****************************************************************************/ -+u8 WapiCheckPnInSwDecrypt( -+ _adapter *padapter, -+ struct sk_buff *pskb -+) -+{ -+ u8 ret = false; -+ -+#if 0 -+ struct ieee80211_hdr_3addr_qos *header; -+ u16 fc; -+ u8 *pDaddr, *pTaddr, *pRaddr; -+ -+ header = (struct ieee80211_hdr_3addr_qos *)pskb->data; -+ pTaddr = header->addr2; -+ pRaddr = header->addr1; -+ fc = le16_to_cpu(header->frame_ctl); -+ -+ if(GetToDs(&fc)) -+ pDaddr = header->addr3; -+ else -+ pDaddr = header->addr1; -+ -+ if ((_rtw_memcmp(pRaddr, padapter->pnetdev->dev_addr, ETH_ALEN) == 0) -+ && ! (pDaddr) -+ && (GetFrameType(&fc) == WIFI_QOS_DATA_TYPE)) -+ //&& ieee->pHTInfo->bCurrentHTSupport && -+ //ieee->pHTInfo->bCurRxReorderEnable) -+ ret = false; -+ else -+ ret = true; -+#endif -+ WAPI_TRACE(WAPI_RX, "%s: return %d\n", __FUNCTION__, ret); -+ return ret; -+} -+ -+int SecSMS4HeaderFillIV(_adapter *padapter, u8 *pxmitframe) -+{ -+ struct pkt_attrib *pattrib = &((struct xmit_frame*)pxmitframe)->attrib; -+ u8 * frame = ((struct xmit_frame *)pxmitframe)->buf_addr + TXDESC_OFFSET; -+ u8 *pSecHeader = NULL, *pos = NULL, *pRA = NULL; -+ u8 bPNOverflow = false, bFindMatchPeer = false, hdr_len = 0; -+ PWLAN_HEADER_WAPI_EXTENSION pWapiExt = NULL; -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ int ret = 0; -+ -+ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); -+ -+ return ret; -+#if 0 -+ hdr_len = sMacHdrLng; -+ if (GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE) -+ { -+ hdr_len += 2; -+ } -+ //hdr_len += SNAP_SIZE + sizeof(u16); -+ -+ pos = skb_push(pskb, padapter->wapiInfo.extra_prefix_len); -+ memmove(pos, pos+padapter->wapiInfo.extra_prefix_len, hdr_len); -+ -+ pSecHeader = pskb->data + hdr_len; -+ pWapiExt = (PWLAN_HEADER_WAPI_EXTENSION)pSecHeader; -+ pRA = pskb->data + 4; -+ -+ WAPI_DATA(WAPI_TX, "FillIV - Before Fill IV", pskb->data, pskb->len); -+ -+ //Address 1 is always receiver's address -+ if( IS_MCAST(pRA) ){ -+ if(!pWapiInfo->wapiTxMsk.bTxEnable){ -+ WAPI_TRACE(WAPI_ERR,"%s: bTxEnable = 0!!\n",__FUNCTION__); -+ return -2; -+ } -+ if(pWapiInfo->wapiTxMsk.keyId <= 1){ -+ pWapiExt->KeyIdx = pWapiInfo->wapiTxMsk.keyId; -+ pWapiExt->Reserved = 0; -+ bPNOverflow = WapiIncreasePN(pWapiInfo->lastTxMulticastPN, 1); -+ memcpy(pWapiExt->PN, pWapiInfo->lastTxMulticastPN, 16); -+ if (bPNOverflow){ -+ // Update MSK Notification. -+ WAPI_TRACE(WAPI_ERR,"===============>%s():multicast PN overflow\n",__FUNCTION__); -+ rtw_wapi_app_event_handler(padapter,NULL,0,pRA, false, false, true, 0, false); -+ } -+ }else{ -+ WAPI_TRACE(WAPI_ERR,"%s: Invalid Wapi Multicast KeyIdx!!\n",__FUNCTION__); -+ ret = -3; -+ } -+ } -+ else{ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if(!memcmp(pWapiSta->PeerMacAddr,pRA,6)){ -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ if (bFindMatchPeer){ -+ if((!pWapiSta->wapiUskUpdate.bTxEnable) && (!pWapiSta->wapiUsk.bTxEnable)){ -+ WAPI_TRACE(WAPI_ERR,"%s: bTxEnable = 0!!\n",__FUNCTION__); -+ return -4; -+ } -+ if (pWapiSta->wapiUsk.keyId <= 1){ -+ if(pWapiSta->wapiUskUpdate.bTxEnable) -+ pWapiExt->KeyIdx = pWapiSta->wapiUskUpdate.keyId; -+ else -+ pWapiExt->KeyIdx = pWapiSta->wapiUsk.keyId; -+ -+ pWapiExt->Reserved = 0; -+ bPNOverflow = WapiIncreasePN(pWapiSta->lastTxUnicastPN, 2); -+ memcpy(pWapiExt->PN, pWapiSta->lastTxUnicastPN, 16); -+ if (bPNOverflow){ -+ // Update USK Notification. -+ WAPI_TRACE(WAPI_ERR,"===============>%s():unicast PN overflow\n",__FUNCTION__); -+ rtw_wapi_app_event_handler(padapter,NULL,0,pWapiSta->PeerMacAddr, false, true, false, 0, false); -+ } -+ }else{ -+ WAPI_TRACE(WAPI_ERR,"%s: Invalid Wapi Unicast KeyIdx!!\n",__FUNCTION__); -+ ret = -5; -+ } -+ } -+ else{ -+ WAPI_TRACE(WAPI_ERR,"%s: Can not find Peer Sta "MAC_FMT"!!\n",__FUNCTION__, MAC_ARG(pRA)); -+ ret = -6; -+ } -+ } -+ -+ WAPI_DATA(WAPI_TX, "FillIV - After Fill IV", pskb->data, pskb->len); -+ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); -+ return ret; -+#endif -+} -+ -+// WAPI SW Enc: must have done Coalesce! -+void SecSWSMS4Encryption( -+ _adapter *padapter, -+ u8 * pxmitframe -+ ) -+{ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ u8 *pframe = ((struct xmit_frame*)pxmitframe)->buf_addr + TXDESC_SIZE; -+ struct pkt_attrib *pattrib = &((struct xmit_frame*)pxmitframe)->attrib; -+ -+ u8 *SecPtr = NULL, *pRA, *pMicKey = NULL, *pDataKey = NULL, *pIV = NULL; -+ u8 IVOffset, DataOffset, bFindMatchPeer = false, KeyIdx = 0, MicBuffer[16]; -+ u16 OutputLength; -+ -+ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); -+ -+ WAPI_TRACE(WAPI_TX,"hdrlen: %d \n",pattrib->hdrlen); -+ -+ return; -+ -+ DataOffset = pattrib->hdrlen + pattrib->iv_len; -+ -+ pRA = pframe + 4; -+ -+ -+ if( IS_MCAST(pRA) ){ -+ KeyIdx = pWapiInfo->wapiTxMsk.keyId; -+ pIV = pWapiInfo->lastTxMulticastPN; -+ pMicKey = pWapiInfo->wapiTxMsk.micKey; -+ pDataKey = pWapiInfo->wapiTxMsk.dataKey; -+ }else{ -+ if (!list_empty(&(pWapiInfo->wapiSTAUsedList))){ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (0 == memcmp(pWapiSta->PeerMacAddr, pRA, 6)){ -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ -+ if (bFindMatchPeer){ -+ if (pWapiSta->wapiUskUpdate.bTxEnable){ -+ KeyIdx = pWapiSta->wapiUskUpdate.keyId; -+ WAPI_TRACE(WAPI_TX, "%s(): Use update USK!! KeyIdx=%d\n", __FUNCTION__, KeyIdx); -+ pIV = pWapiSta->lastTxUnicastPN; -+ pMicKey = pWapiSta->wapiUskUpdate.micKey; -+ pDataKey = pWapiSta->wapiUskUpdate.dataKey; -+ }else{ -+ KeyIdx = pWapiSta->wapiUsk.keyId; -+ WAPI_TRACE(WAPI_TX, "%s(): Use USK!! KeyIdx=%d\n", __FUNCTION__, KeyIdx); -+ pIV = pWapiSta->lastTxUnicastPN; -+ pMicKey = pWapiSta->wapiUsk.micKey; -+ pDataKey = pWapiSta->wapiUsk.dataKey; -+ } -+ }else{ -+ WAPI_TRACE(WAPI_ERR,"%s: Can not find Peer Sta!!\n",__FUNCTION__); -+ return; -+ } -+ }else{ -+ WAPI_TRACE(WAPI_ERR,"%s: wapiSTAUsedList is empty!!\n",__FUNCTION__); -+ return; -+ } -+ } -+ -+ SecPtr = pframe; -+ SecCalculateMicSMS4(KeyIdx, pMicKey, SecPtr, (SecPtr+DataOffset), pattrib->pktlen, MicBuffer); -+ -+ WAPI_DATA(WAPI_TX, "Encryption - MIC", MicBuffer, padapter->wapiInfo.extra_postfix_len); -+ -+ memcpy(pframe+pattrib->hdrlen+pattrib->iv_len+pattrib->pktlen-pattrib->icv_len, -+ (u8 *)MicBuffer, -+ padapter->wapiInfo.extra_postfix_len -+ ); -+ -+ -+ WapiSMS4Encryption(pDataKey, pIV, (SecPtr+DataOffset),pattrib->pktlen+pattrib->icv_len, (SecPtr+DataOffset), &OutputLength); -+ -+ WAPI_DATA(WAPI_TX, "Encryption - After SMS4 encryption",pframe,pattrib->hdrlen+pattrib->iv_len+pattrib->pktlen); -+ -+ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); -+} -+ -+u8 SecSWSMS4Decryption( -+ _adapter *padapter, -+ u8 *precv_frame, -+ struct recv_priv *precv_priv -+ ) -+{ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ struct recv_frame_hdr *precv_hdr; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ u8 IVOffset, DataOffset, bFindMatchPeer = false, bUseUpdatedKey = false; -+ u8 KeyIdx, MicBuffer[16], lastRxPNforQoS[16]; -+ u8 *pRA, *pTA, *pMicKey, *pDataKey, *pLastRxPN, *pRecvPN, *pSecData, *pRecvMic, *pos; -+ u8 TID = 0; -+ u16 OutputLength, DataLen; -+ u8 bQosData; -+ struct sk_buff * pskb; -+ -+ WAPI_TRACE(WAPI_RX, "=========>%s\n", __FUNCTION__); -+ -+ return 0; -+ -+ precv_hdr = &((union recv_frame*)precv_frame)->u.hdr; -+ pskb = (struct sk_buff *)(precv_hdr->rx_data); -+ precv_hdr->bWapiCheckPNInDecrypt = WapiCheckPnInSwDecrypt(padapter, pskb); -+ WAPI_TRACE(WAPI_RX, "=========>%s: check PN %d\n", __FUNCTION__,precv_hdr->bWapiCheckPNInDecrypt); -+ WAPI_DATA(WAPI_RX, "Decryption - Before decryption", pskb->data, pskb->len); -+ -+ IVOffset = sMacHdrLng; -+ bQosData = GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE; -+ if (bQosData){ -+ IVOffset += 2; -+ } -+ -+ //if(GetHTC()) -+ // IVOffset += 4; -+ -+ //IVOffset += SNAP_SIZE + sizeof(u16); -+ -+ DataOffset = IVOffset + padapter->wapiInfo.extra_prefix_len; -+ -+ pRA = pskb->data + 4; -+ pTA = pskb->data + 10; -+ KeyIdx = *(pskb->data + IVOffset); -+ pRecvPN = pskb->data + IVOffset + 2; -+ pSecData = pskb->data + DataOffset; -+ DataLen = pskb->len - DataOffset; -+ pRecvMic = pskb->data + pskb->len - padapter->wapiInfo.extra_postfix_len; -+ TID = GetTid(pskb->data); -+ -+ if (!list_empty(&(pWapiInfo->wapiSTAUsedList))){ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (0 == memcmp(pWapiSta->PeerMacAddr, pTA, 6)){ -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ } -+ -+ if (!bFindMatchPeer){ -+ WAPI_TRACE(WAPI_ERR, "%s: Can not find Peer Sta "MAC_FMT" for Key Info!!!\n", __FUNCTION__, MAC_ARG(pTA)); -+ return false; -+ } -+ -+ if( IS_MCAST(pRA) ){ -+ WAPI_TRACE(WAPI_RX, "%s: Multicast decryption !!!\n", __FUNCTION__); -+ if (pWapiSta->wapiMsk.keyId == KeyIdx && pWapiSta->wapiMsk.bSet){ -+ pLastRxPN = pWapiSta->lastRxMulticastPN; -+ if (!WapiComparePN(pRecvPN, pLastRxPN)){ -+ WAPI_TRACE(WAPI_ERR, "%s: MSK PN is not larger than last, Dropped!!!\n", __FUNCTION__); -+ WAPI_DATA(WAPI_ERR, "pRecvPN:", pRecvPN, 16); -+ WAPI_DATA(WAPI_ERR, "pLastRxPN:", pLastRxPN, 16); -+ return false; -+ } -+ -+ memcpy(pLastRxPN, pRecvPN, 16); -+ pMicKey = pWapiSta->wapiMsk.micKey; -+ pDataKey = pWapiSta->wapiMsk.dataKey; -+ }else if (pWapiSta->wapiMskUpdate.keyId == KeyIdx && pWapiSta->wapiMskUpdate.bSet){ -+ WAPI_TRACE(WAPI_RX, "%s: Use Updated MSK for Decryption !!!\n", __FUNCTION__); -+ bUseUpdatedKey = true; -+ memcpy(pWapiSta->lastRxMulticastPN, pRecvPN, 16); -+ pMicKey = pWapiSta->wapiMskUpdate.micKey; -+ pDataKey = pWapiSta->wapiMskUpdate.dataKey; -+ }else{ -+ WAPI_TRACE(WAPI_ERR, "%s: Can not find MSK with matched KeyIdx(%d), Dropped !!!\n", __FUNCTION__,KeyIdx); -+ return false; -+ } -+ } -+ else{ -+ WAPI_TRACE(WAPI_RX, "%s: Unicast decryption !!!\n", __FUNCTION__); -+ if (pWapiSta->wapiUsk.keyId == KeyIdx && pWapiSta->wapiUsk.bSet){ -+ WAPI_TRACE(WAPI_RX, "%s: Use USK for Decryption!!!\n", __FUNCTION__); -+ if(precv_hdr->bWapiCheckPNInDecrypt){ -+ if(GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE){ -+ WapiGetLastRxUnicastPNForQoSData(TID, pWapiSta, lastRxPNforQoS); -+ pLastRxPN = lastRxPNforQoS; -+ }else{ -+ pLastRxPN = pWapiSta->lastRxUnicastPN; -+ } -+ if (!WapiComparePN(pRecvPN, pLastRxPN)){ -+ return false; -+ } -+ if(bQosData){ -+ WapiSetLastRxUnicastPNForQoSData(TID, pRecvPN, pWapiSta); -+ }else{ -+ memcpy(pWapiSta->lastRxUnicastPN, pRecvPN, 16); -+ } -+ }else{ -+ memcpy(precv_hdr->WapiTempPN,pRecvPN,16); -+ } -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE)) -+ { -+ if ((pRecvPN[0] & 0x1) == 0){ -+ WAPI_TRACE(WAPI_ERR, "%s: Rx USK PN is not odd when Infra STA mode, Dropped !!!\n", __FUNCTION__); -+ return false; -+ } -+ } -+ -+ pMicKey = pWapiSta->wapiUsk.micKey; -+ pDataKey = pWapiSta->wapiUsk.dataKey; -+ } -+ else if (pWapiSta->wapiUskUpdate.keyId == KeyIdx && pWapiSta->wapiUskUpdate.bSet ){ -+ WAPI_TRACE(WAPI_RX, "%s: Use Updated USK for Decryption!!!\n", __FUNCTION__); -+ if(pWapiSta->bAuthenticatorInUpdata) -+ bUseUpdatedKey = true; -+ else -+ bUseUpdatedKey = false; -+ -+ if(bQosData){ -+ WapiSetLastRxUnicastPNForQoSData(TID, pRecvPN, pWapiSta); -+ }else{ -+ memcpy(pWapiSta->lastRxUnicastPN, pRecvPN, 16); -+ } -+ pMicKey = pWapiSta->wapiUskUpdate.micKey; -+ pDataKey = pWapiSta->wapiUskUpdate.dataKey; -+ }else{ -+ WAPI_TRACE(WAPI_ERR, "%s: No valid USK!!!KeyIdx=%d pWapiSta->wapiUsk.keyId=%d pWapiSta->wapiUskUpdate.keyId=%d\n", __FUNCTION__, KeyIdx, pWapiSta->wapiUsk.keyId, pWapiSta->wapiUskUpdate.keyId); -+ //dump_buf(pskb->data,pskb->len); -+ return false; -+ } -+ } -+ -+ WAPI_DATA(WAPI_RX, "Decryption - DataKey", pDataKey, 16); -+ WAPI_DATA(WAPI_RX, "Decryption - IV", pRecvPN, 16); -+ WapiSMS4Decryption(pDataKey, pRecvPN, pSecData, DataLen, pSecData, &OutputLength); -+ -+ if (OutputLength != DataLen) -+ WAPI_TRACE(WAPI_ERR, "%s: Output Length Error!!!!\n", __FUNCTION__); -+ -+ WAPI_DATA(WAPI_RX, "Decryption - After decryption", pskb->data, pskb->len); -+ -+ DataLen -= padapter->wapiInfo.extra_postfix_len; -+ -+ SecCalculateMicSMS4(KeyIdx, pMicKey, pskb->data, pSecData, DataLen, MicBuffer); -+ -+ WAPI_DATA(WAPI_RX, "Decryption - MIC received", pRecvMic, SMS4_MIC_LEN); -+ WAPI_DATA(WAPI_RX, "Decryption - MIC calculated", MicBuffer, SMS4_MIC_LEN); -+ -+ if (0 == memcmp(MicBuffer, pRecvMic, padapter->wapiInfo.extra_postfix_len)){ -+ WAPI_TRACE(WAPI_RX, "%s: Check MIC OK!!\n", __FUNCTION__); -+ if (bUseUpdatedKey){ -+ // delete the old key -+ if ( IS_MCAST(pRA) ){ -+ WAPI_TRACE(WAPI_API, "%s(): AE use new update MSK!!\n", __FUNCTION__); -+ pWapiSta->wapiMsk.keyId = pWapiSta->wapiMskUpdate.keyId; -+ memcpy(pWapiSta->wapiMsk.dataKey, pWapiSta->wapiMskUpdate.dataKey, 16); -+ memcpy(pWapiSta->wapiMsk.micKey, pWapiSta->wapiMskUpdate.micKey, 16); -+ pWapiSta->wapiMskUpdate.bTxEnable = pWapiSta->wapiMskUpdate.bSet = false; -+ }else{ -+ WAPI_TRACE(WAPI_API, "%s(): AE use new update USK!!\n", __FUNCTION__); -+ pWapiSta->wapiUsk.keyId = pWapiSta->wapiUskUpdate.keyId; -+ memcpy(pWapiSta->wapiUsk.dataKey, pWapiSta->wapiUskUpdate.dataKey, 16); -+ memcpy(pWapiSta->wapiUsk.micKey, pWapiSta->wapiUskUpdate.micKey, 16); -+ pWapiSta->wapiUskUpdate.bTxEnable = pWapiSta->wapiUskUpdate.bSet = false; -+ } -+ } -+ }else{ -+ WAPI_TRACE(WAPI_ERR, "%s: Check MIC Error, Dropped !!!!\n", __FUNCTION__); -+ return false; -+ } -+ -+ pos = pskb->data; -+ memmove(pos+padapter->wapiInfo.extra_prefix_len, pos, IVOffset); -+ skb_pull(pskb, padapter->wapiInfo.extra_prefix_len); -+ -+ WAPI_TRACE(WAPI_RX, "<=========%s\n", __FUNCTION__); -+ -+ return true; -+} -+ -+u32 rtw_sms4_encrypt(_adapter *padapter, u8 *pxmitframe) -+{ -+ -+ u8 *pframe; -+ u32 res = _SUCCESS; -+ -+ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_TX, "<========== %s, WAPI not supported or enabled!\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+ if(((struct xmit_frame*)pxmitframe)->buf_addr==NULL) -+ return _FAIL; -+ -+ pframe = ((struct xmit_frame*)pxmitframe)->buf_addr + TXDESC_OFFSET; -+ -+ SecSWSMS4Encryption(padapter, pxmitframe); -+ -+ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); -+ return res; -+} -+ -+u32 rtw_sms4_decrypt(_adapter *padapter, u8 *precvframe) -+{ -+ u8 *pframe; -+ u32 res = _SUCCESS; -+ -+ WAPI_TRACE(WAPI_RX, "=========>%s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or enabled!\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+ -+ //drop packet when hw decrypt fail -+ //return tempraily -+ return _FAIL; -+ -+ //pframe=(unsigned char *)((union recv_frame*)precvframe)->u.hdr.rx_data; -+ -+ if (false == SecSWSMS4Decryption(padapter, precvframe, &padapter->recvpriv)) -+ { -+ WAPI_TRACE(WAPI_ERR, "%s():SMS4 decrypt frame error\n",__FUNCTION__); -+ return _FAIL; -+ } -+ -+ WAPI_TRACE(WAPI_RX, "<=========%s\n", __FUNCTION__); -+ return res; -+} -+ -+#else -+ -+u32 rtw_sms4_encrypt(_adapter *padapter, u8 *pxmitframe) -+{ -+ WAPI_TRACE(WAPI_TX, "=========>Dummy %s\n", __FUNCTION__); -+ WAPI_TRACE(WAPI_TX, "<=========Dummy %s\n", __FUNCTION__); -+ return _SUCCESS; -+} -+ -+u32 rtw_sms4_decrypt(_adapter *padapter, u8 *precvframe) -+{ -+ WAPI_TRACE(WAPI_RX, "=========>Dummy %s\n", __FUNCTION__); -+ WAPI_TRACE(WAPI_RX, "<=========Dummy %s\n", __FUNCTION__); -+ return _SUCCESS; -+} -+ -+#endif -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8812au/core/rtw_wlan_util.c ---- linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_wlan_util.c 2017-06-07 23:07:21.006687120 +0300 -@@ -0,0 +1,4704 @@ ++#ifdef CONFIG_WAPI_SUPPORT ++ ++#include ++#include ++#include ++#include ++ ++ ++u32 wapi_debug_component = ++// WAPI_INIT | ++// WAPI_API | ++// WAPI_TX | ++// WAPI_RX | ++ WAPI_ERR ; //always open err flags on ++ ++void WapiFreeAllStaInfo(_adapter *padapter) ++{ ++ PRT_WAPI_T pWapiInfo; ++ PRT_WAPI_STA_INFO pWapiStaInfo; ++ PRT_WAPI_BKID pWapiBkid; ++ ++ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); ++ pWapiInfo = &padapter->wapiInfo; ++ ++ //Pust to Idle List ++ rtw_wapi_return_all_sta_info(padapter); ++ ++ //Sta Info List ++ while(!list_empty(&(pWapiInfo->wapiSTAIdleList))) ++ { ++ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAIdleList.next, RT_WAPI_STA_INFO, list); ++ list_del_init(&pWapiStaInfo->list); ++ } ++ ++ //BKID List ++ while(!list_empty(&(pWapiInfo->wapiBKIDIdleList))) ++ { ++ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDIdleList.next, RT_WAPI_BKID, list); ++ list_del_init(&pWapiBkid->list); ++ } ++ WAPI_TRACE(WAPI_INIT, "<=========== %s\n", __FUNCTION__); ++ return; ++} ++ ++void WapiSetIE(_adapter *padapter) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ //PRT_WAPI_BKID pWapiBkid; ++ u16 protocolVer = 1; ++ u16 akmCnt = 1; ++ u16 suiteCnt = 1; ++ u16 capability = 0; ++ u8 OUI[3]; ++ ++ OUI[0] = 0x00; ++ OUI[1] = 0x14; ++ OUI[2] = 0x72; ++ ++ pWapiInfo->wapiIELength = 0; ++//protocol version ++ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength, &protocolVer, 2); ++ pWapiInfo->wapiIELength +=2; ++//akm ++ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength, &akmCnt, 2); ++ pWapiInfo->wapiIELength +=2; ++ ++ if(pWapiInfo->bWapiPSK){ ++ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength,OUI, 3); ++ pWapiInfo->wapiIELength +=3; ++ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x2; ++ pWapiInfo->wapiIELength +=1; ++ }else{ ++ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength,OUI, 3); ++ pWapiInfo->wapiIELength +=3; ++ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; ++ pWapiInfo->wapiIELength +=1; ++ } ++ ++//usk ++ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength, &suiteCnt, 2); ++ pWapiInfo->wapiIELength +=2; ++ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength,OUI, 3); ++ pWapiInfo->wapiIELength +=3; ++ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; ++ pWapiInfo->wapiIELength +=1; ++ ++//msk ++ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength,OUI, 3); ++ pWapiInfo->wapiIELength +=3; ++ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; ++ pWapiInfo->wapiIELength +=1; ++ ++//Capbility ++ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength, &capability, 2); ++ pWapiInfo->wapiIELength +=2; ++} ++ ++ ++/* PN1 > PN2, return 1, ++ * else return 0. ++ */ ++u32 WapiComparePN(u8 *PN1, u8 *PN2) ++{ ++ char i; ++ ++ if ((NULL == PN1) || (NULL == PN2)) ++ return 1; ++ ++ // overflow case ++ if ((PN2[15] - PN1[15]) & 0x80) ++ return 1; ++ ++ for (i=16; i>0; i--) ++ { ++ if(PN1[i-1] == PN2[i-1]) ++ continue; ++ else if(PN1[i-1] > PN2[i-1]) ++ return 1; ++ else ++ return 0; ++ } ++ ++ return 0; ++} ++ ++u8 ++WapiGetEntryForCamWrite(_adapter *padapter,u8 *pMacAddr,u8 KID,bool IsMsk) ++{ ++ PRT_WAPI_T pWapiInfo=NULL; ++ //PRT_WAPI_CAM_ENTRY pEntry=NULL; ++ u8 i=0; ++ u8 ret = 0xff; ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ pWapiInfo = &padapter->wapiInfo; ++ ++ //exist? ++ for(i=0;iwapiCamEntry[i].IsUsed ++ && (_rtw_memcmp(pMacAddr, pWapiInfo->wapiCamEntry[i].PeerMacAddr, ETH_ALEN) == true) ++ && pWapiInfo->wapiCamEntry[i].keyidx == KID ++ && pWapiInfo->wapiCamEntry[i].type == IsMsk) ++ { ++ ret = pWapiInfo->wapiCamEntry[i].entry_idx; //cover it ++ break; ++ } ++ } ++ ++ if(i == WAPI_CAM_ENTRY_NUM) //not found ++ { ++ for(i=0;iwapiCamEntry[i].IsUsed == 0) ++ { ++ pWapiInfo->wapiCamEntry[i].IsUsed = 1; ++ pWapiInfo->wapiCamEntry[i].type = IsMsk; ++ pWapiInfo->wapiCamEntry[i].keyidx = KID; ++ _rtw_memcpy(pWapiInfo->wapiCamEntry[i].PeerMacAddr, pMacAddr,ETH_ALEN); ++ ret = pWapiInfo->wapiCamEntry[i].entry_idx; ++ break; ++ } ++ } ++ } ++ ++ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); ++ return ret; ++ ++/* ++ if(RTIsListEmpty(&pWapiInfo->wapiCamIdleList)){ ++ RT_TRACE(COMP_SEC,DBG_LOUD,("No Entry for wapi!!!\n")); ++ return 0; ++ } ++ ++ pEntry = (PRT_WAPI_CAM_ENTRY)RTRemoveHeadList(&pWapiInfo->wapiCamIdleList); ++ RTInsertTailList(&pWapiInfo->wapiCamUsedList, &pEntry->list); ++ ++ RT_TRACE(COMP_SEC,DBG_LOUD,("<====WapiGetCamEntry(),Get Entry Idx:%d.but we just return 4 for test\n",pEntry->entry_idx)); ++ ++ return pEntry->entry_idx;*/ ++} ++ ++u8 WapiGetEntryForCamClear(_adapter *padapter,u8 *pPeerMac,u8 keyid,u8 IsMsk) ++{ ++ PRT_WAPI_T pWapiInfo=NULL; ++ u8 i=0; ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ pWapiInfo = &padapter->wapiInfo; ++ ++ for(i=0;iwapiCamEntry[i].IsUsed ++ && (_rtw_memcmp(pPeerMac, pWapiInfo->wapiCamEntry[i].PeerMacAddr, ETH_ALEN) == true) ++ && pWapiInfo->wapiCamEntry[i].keyidx == keyid ++ && pWapiInfo->wapiCamEntry[i].type == IsMsk) ++ { ++ pWapiInfo->wapiCamEntry[i].IsUsed = 0; ++ pWapiInfo->wapiCamEntry[i].keyidx = 2; ++ _rtw_memset(pWapiInfo->wapiCamEntry[i].PeerMacAddr,0,ETH_ALEN); ++ ++ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); ++ return pWapiInfo->wapiCamEntry[i].entry_idx; ++ } ++ } ++ ++ WAPI_TRACE(WAPI_API,"<====WapiGetReturnCamEntry(), No this cam entry.\n"); ++ return 0xff; ++/* ++ if(RTIsListEmpty(&pWapiInfo->wapiCamUsedList)){ ++ RT_TRACE(COMP_SEC,DBG_LOUD,("No Entry for wapi!!!\n")); ++ return false; ++ } ++ ++ pList = &pWapiInfo->wapiCamUsedList; ++ while(pList->Flink != &pWapiInfo->wapiCamUsedList) ++ { ++ pEntry = (PRT_WAPI_CAM_ENTRY)pList->Flink; ++ if(PlatformCompareMemory(pPeerMac,pEntry->PeerMacAddr, ETHER_ADDRLEN)== 0 ++ && keyid == pEntry->keyidx) ++ { ++ RTRemoveEntryList(pList); ++ RTInsertHeadList(&pWapiInfo->wapiCamIdleList, pList); ++ return pEntry->entry_idx; ++ } ++ pList = pList->Flink; ++ } ++ ++ return 0; ++*/ ++} ++ ++void ++WapiResetAllCamEntry(_adapter *padapter) ++{ ++ PRT_WAPI_T pWapiInfo; ++ int i; ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ pWapiInfo = &padapter->wapiInfo; ++ ++ for (i=0;iwapiCamEntry[i].PeerMacAddr, 0, ETH_ALEN); ++ pWapiInfo->wapiCamEntry[i].IsUsed = 0; ++ pWapiInfo->wapiCamEntry[i].keyidx = 2; //invalid ++ pWapiInfo->wapiCamEntry[i].entry_idx = 4+i*2; ++ } ++ ++ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); ++ ++ return; ++} ++ ++u8 WapiWriteOneCamEntry( ++ _adapter *padapter, ++ u8 *pMacAddr, ++ u8 KeyId, ++ u8 EntryId, ++ u8 EncAlg, ++ u8 bGroupKey, ++ u8 *pKey ++) ++{ ++ u8 retVal = 0; ++ u16 usConfig = 0; ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ if(EntryId >= 32) ++ { ++ WAPI_TRACE(WAPI_ERR, "<=== CamAddOneEntry(): ulKeyId exceed!\n"); ++ return retVal; ++ } ++ ++ usConfig=usConfig|(0x01<<15)|((u16)(EncAlg)<<2)|(KeyId); ++ ++ if(EncAlg == _SMS4_ ) ++ { ++ if(bGroupKey == 1) ++ usConfig |= (0x01<<6); ++ if((EntryId % 2)==1) // ==0 sec key; == 1mic key ++ usConfig |= (0x01<<5); ++ } ++ ++ write_cam(padapter, EntryId, usConfig, pMacAddr, pKey); ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ return 1; ++} ++ ++void rtw_wapi_init(_adapter *padapter) ++{ ++ PRT_WAPI_T pWapiInfo; ++ int i; ++ ++ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); ++ RT_ASSERT_RET(padapter); ++ ++ if (!padapter->WapiSupport) ++ { ++ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); ++ return; ++ } ++ ++ pWapiInfo = &padapter->wapiInfo; ++ pWapiInfo->bWapiEnable = false; ++ ++ //Init BKID List ++ INIT_LIST_HEAD(&pWapiInfo->wapiBKIDIdleList); ++ INIT_LIST_HEAD(&pWapiInfo->wapiBKIDStoreList); ++ for(i=0;iwapiBKID[i].list, &pWapiInfo->wapiBKIDIdleList); ++ } ++ ++ //Init STA List ++ INIT_LIST_HEAD(&pWapiInfo->wapiSTAIdleList); ++ INIT_LIST_HEAD(&pWapiInfo->wapiSTAUsedList); ++ for(i=0;iwapiSta[i].list, &pWapiInfo->wapiSTAIdleList); ++ } ++ ++ for (i=0;iwapiCamEntry[i].IsUsed = 0; ++ pWapiInfo->wapiCamEntry[i].keyidx = 2; //invalid ++ pWapiInfo->wapiCamEntry[i].entry_idx = 4+i*2; ++ } ++ ++ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_wapi_free(_adapter *padapter) ++{ ++ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); ++ RT_ASSERT_RET(padapter); ++ ++ if (!padapter->WapiSupport) ++ { ++ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); ++ return; ++ } ++ ++ WapiFreeAllStaInfo(padapter); ++ ++ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_wapi_disable_tx(_adapter *padapter) ++{ ++ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); ++ RT_ASSERT_RET(padapter); ++ ++ if (!padapter->WapiSupport) ++ { ++ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); ++ return; ++ } ++ ++ padapter->wapiInfo.wapiTxMsk.bTxEnable = false; ++ padapter->wapiInfo.wapiTxMsk.bSet = false; ++ ++ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); ++} ++ ++u8 rtw_wapi_is_wai_packet(_adapter* padapter,u8 *pkt_data) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ u8 WaiPkt = 0, *pTaddr, bFind = false; ++ u8 Offset_TypeWAI = 0 ; // (mac header len + llc length) ++ ++ WAPI_TRACE(WAPI_TX|WAPI_RX, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return 0; ++ } ++ ++ Offset_TypeWAI = 24 + 6 ; ++ ++ //YJ,add,091103. Data frame may also have skb->data[30]=0x88 and skb->data[31]=0xb4. ++ if ((pkt_data[1]&0x40) !=0) ++ { ++ DBG_871X("data is privacy \n"); ++ return 0; ++ } ++ ++ pTaddr = GetAddr2Ptr(pkt_data); ++ if(list_empty(&pWapiInfo->wapiSTAUsedList)){ ++ bFind = false; ++ }else{ ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list){ ++ if (_rtw_memcmp(pTaddr, pWapiSta->PeerMacAddr, 6) == true) { ++ bFind = true; ++ break; ++ } ++ } ++ } ++ ++ WAPI_TRACE(WAPI_TX|WAPI_RX, "%s: bFind=%d pTaddr="MAC_FMT"\n", __FUNCTION__, bFind, MAC_ARG(pTaddr)); ++ ++ if (pkt_data[0] == WIFI_QOS_DATA_TYPE) ++ { ++ Offset_TypeWAI += 2; ++ } ++ ++ // 88b4? ++ if( (pkt_data[Offset_TypeWAI]==0x88) && (pkt_data[Offset_TypeWAI+1]==0xb4) ){ ++ WaiPkt = pkt_data[Offset_TypeWAI+5]; ++ ++ psecuritypriv->hw_decrypted = true; ++ }else{ ++ WAPI_TRACE(WAPI_TX|WAPI_RX, "%s(): non wai packet\n",__FUNCTION__); ++ } ++ ++ WAPI_TRACE(WAPI_TX|WAPI_RX, "%s(): Recvd WAI frame. IsWAIPkt(%d)\n",__FUNCTION__, WaiPkt); ++ ++ return WaiPkt; ++} ++ ++ ++void rtw_wapi_update_info(_adapter *padapter, union recv_frame *precv_frame) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ struct recv_frame_hdr *precv_hdr; ++ u8 *ptr; ++ u8 *pTA; ++ u8 *pRecvPN; ++ ++ ++ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ precv_hdr = &precv_frame->u.hdr; ++ ptr = precv_hdr->rx_data; ++ ++ if (precv_hdr->attrib.qos == 1) ++ { ++ precv_hdr->UserPriority = GetTid(ptr); ++ } ++ else ++ { ++ precv_hdr->UserPriority = 0; ++ } ++ ++ pTA = GetAddr2Ptr(ptr); ++ _rtw_memcpy((u8 *)precv_hdr->WapiSrcAddr, pTA, 6); ++ pRecvPN = ptr + precv_hdr->attrib.hdrlen + 2; ++ _rtw_memcpy((u8 *)precv_hdr->WapiTempPN, pRecvPN, 16); ++ ++ WAPI_TRACE(WAPI_RX, "<========== %s\n", __FUNCTION__); ++} ++ ++/**************************************************************************** ++true-----------------Drop ++false---------------- handle ++add to support WAPI to N-mode ++*****************************************************************************/ ++u8 rtw_wapi_check_for_drop( ++ _adapter *padapter, ++ union recv_frame *precv_frame ++) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ u8 *pLastRecvPN = NULL; ++ u8 bFind = false; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ u8 bDrop = false; ++ struct recv_frame_hdr *precv_hdr = &precv_frame->u.hdr; ++ u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; ++ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; ++ u8 *ptr = precv_frame->u.hdr.rx_data; ++ int i; ++ ++ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return false; ++ } ++ ++ if(precv_hdr->bIsWaiPacket !=0) ++ { ++ if(precv_hdr->bIsWaiPacket== 0x8) ++ { ++ ++ DBG_871X("rtw_wapi_check_for_drop: dump packet \n"); ++ for(i=0;i<50;i++) ++ { ++ DBG_871X("%02X ",ptr[i]); ++ if((i+1) %8 ==0) ++ DBG_871X("\n"); ++ } ++ DBG_871X("\n rtw_wapi_check_for_drop: dump packet \n"); ++ ++ for(i=0;i<16;i++) ++ { ++ if(ptr[i+27] !=0) ++ break; ++ } ++ ++ if(i== 16) ++ { ++ WAPI_TRACE(WAPI_RX,"rtw_wapi_check_for_drop: drop with zero BKID \n"); ++ return true; ++ } ++ else ++ { ++ return false; ++ } ++ } ++ else ++ return false; ++ } ++ ++ if(list_empty(&pWapiInfo->wapiSTAUsedList)){ ++ bFind = false; ++ }else{ ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if (_rtw_memcmp(precv_hdr->WapiSrcAddr, pWapiSta->PeerMacAddr, ETH_ALEN) == true) { ++ bFind = true; ++ break; ++ } ++ } ++ } ++ WAPI_TRACE(WAPI_RX, "%s: bFind=%d prxb->WapiSrcAddr="MAC_FMT"\n", __FUNCTION__, bFind, MAC_ARG(precv_hdr->WapiSrcAddr)); ++ ++ if(bFind) ++ { ++ if(IS_MCAST(precv_hdr->attrib.ra)) ++ { ++ WAPI_TRACE(WAPI_RX,"rtw_wapi_check_for_drop: multicast case \n"); ++ pLastRecvPN = pWapiSta->lastRxMulticastPN; ++ } ++ else ++ { ++ WAPI_TRACE(WAPI_RX,"rtw_wapi_check_for_drop: unicast case \n"); ++ switch(precv_hdr->UserPriority) ++ { ++ case 0: ++ case 3: ++ pLastRecvPN = pWapiSta->lastRxUnicastPNBEQueue; ++ break; ++ case 1: ++ case 2: ++ pLastRecvPN = pWapiSta->lastRxUnicastPNBKQueue; ++ break; ++ case 4: ++ case 5: ++ pLastRecvPN = pWapiSta->lastRxUnicastPNVIQueue; ++ break; ++ case 6: ++ case 7: ++ pLastRecvPN = pWapiSta->lastRxUnicastPNVOQueue; ++ break; ++ default: ++ WAPI_TRACE(WAPI_ERR,"%s: Unknown TID \n",__FUNCTION__); ++ break; ++ } ++ } ++ ++ if(!WapiComparePN(precv_hdr->WapiTempPN,pLastRecvPN)) ++ { ++ WAPI_TRACE(WAPI_RX,"%s: Equal PN!!\n",__FUNCTION__); ++ if(IS_MCAST(precv_hdr->attrib.ra)) ++ _rtw_memcpy(pLastRecvPN,WapiAEMultiCastPNInitialValueSrc,16); ++ else ++ _rtw_memcpy(pLastRecvPN,WapiAEPNInitialValueSrc,16); ++ bDrop = true; ++ } ++ else ++ { ++ _rtw_memcpy(pLastRecvPN,precv_hdr->WapiTempPN,16); ++ } ++ } ++ ++ WAPI_TRACE(WAPI_RX, "<========== %s\n", __FUNCTION__); ++ return bDrop; ++} ++ ++void rtw_build_probe_resp_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ u8 WapiIELength = 0; ++ ++ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); ++ return; ++ } ++ ++ WapiSetIE(padapter); ++ WapiIELength = pWapiInfo->wapiIELength; ++ pframe[0] = _WAPI_IE_; ++ pframe[1] = WapiIELength; ++ _rtw_memcpy(pframe+2, pWapiInfo->wapiIE, WapiIELength); ++ pframe += WapiIELength+2; ++ pattrib->pktlen += WapiIELength+2; ++ ++ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_build_beacon_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ u8 WapiIELength = 0; ++ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); ++ return; ++ } ++ ++ WapiSetIE(padapter); ++ WapiIELength = pWapiInfo->wapiIELength; ++ pframe[0] = _WAPI_IE_; ++ pframe[1] = WapiIELength; ++ _rtw_memcpy(pframe+2, pWapiInfo->wapiIE, WapiIELength); ++ pframe += WapiIELength+2; ++ pattrib->pktlen += WapiIELength+2; ++ ++ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_build_assoc_req_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) ++{ ++ PRT_WAPI_BKID pWapiBKID; ++ u16 bkidNum; ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ u8 WapiIELength = 0; ++ ++ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); ++ return; ++ } ++ ++ WapiSetIE(padapter); ++ WapiIELength = pWapiInfo->wapiIELength; ++ bkidNum = 0; ++ if(!list_empty(&(pWapiInfo->wapiBKIDStoreList))){ ++ list_for_each_entry(pWapiBKID, &pWapiInfo->wapiBKIDStoreList, list) { ++ bkidNum ++; ++ _rtw_memcpy(pWapiInfo->wapiIE+WapiIELength+2, pWapiBKID->bkid,16); ++ WapiIELength += 16; ++ } ++ } ++ _rtw_memcpy(pWapiInfo->wapiIE+WapiIELength, &bkidNum, 2); ++ WapiIELength += 2; ++ ++ pframe[0] = _WAPI_IE_; ++ pframe[1] = WapiIELength; ++ _rtw_memcpy(pframe+2, pWapiInfo->wapiIE, WapiIELength); ++ pframe += WapiIELength+2; ++ pattrib->pktlen += WapiIELength+2; ++ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_wapi_on_assoc_ok(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) ++{ ++ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); ++ PRT_WAPI_STA_INFO pWapiSta; ++ u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; ++ //u8 WapiASUEPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; ++ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; ++ ++ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ pWapiSta =(PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAIdleList.next, RT_WAPI_STA_INFO, list); ++ list_del_init(&pWapiSta->list); ++ list_add_tail(&pWapiSta->list, &pWapiInfo->wapiSTAUsedList); ++ _rtw_memcpy(pWapiSta->PeerMacAddr,padapter->mlmeextpriv.mlmext_info.network.MacAddress,6); ++ _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPN, WapiAEPNInitialValueSrc, 16); ++ ++ //For chenk PN error with Qos Data after s3: add by ylb 20111114 ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue,WapiAEPNInitialValueSrc,16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue,WapiAEPNInitialValueSrc,16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue,WapiAEPNInitialValueSrc,16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue,WapiAEPNInitialValueSrc,16); ++ ++ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); ++} ++ ++ ++void rtw_wapi_return_one_sta_info(_adapter *padapter, u8 *MacAddr) ++{ ++ PRT_WAPI_T pWapiInfo; ++ PRT_WAPI_STA_INFO pWapiStaInfo = NULL; ++ PRT_WAPI_BKID pWapiBkid = NULL; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ pWapiInfo = &padapter->wapiInfo; ++ ++ WAPI_TRACE(WAPI_API, "==========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE)) ++ { ++ while(!list_empty(&(pWapiInfo->wapiBKIDStoreList))) ++ { ++ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDStoreList.next, RT_WAPI_BKID, list); ++ list_del_init(&pWapiBkid->list); ++ _rtw_memset(pWapiBkid->bkid,0,16); ++ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDIdleList); ++ } ++ } ++ ++ ++ WAPI_TRACE(WAPI_API, " %s: after clear bkid \n", __FUNCTION__); ++ ++ ++ //Remove STA info ++ if(list_empty(&(pWapiInfo->wapiSTAUsedList))){ ++ WAPI_TRACE(WAPI_API, " %s: wapiSTAUsedList is null \n", __FUNCTION__); ++ return; ++ }else{ ++ ++ WAPI_TRACE(WAPI_API, " %s: wapiSTAUsedList is not null \n", __FUNCTION__); ++#if 0 ++ pWapiStaInfo=(PRT_WAPI_STA_INFO)list_entry((pWapiInfo->wapiSTAUsedList.next),RT_WAPI_STA_INFO,list); ++ ++ list_for_each_entry(pWapiStaInfo, &(pWapiInfo->wapiSTAUsedList), list) { ++ ++ DBG_871X("MAC Addr %02x-%02x-%02x-%02x-%02x-%02x \n",MacAddr[0],MacAddr[1],MacAddr[2],MacAddr[3],MacAddr[4],MacAddr[5]); ++ ++ ++ DBG_871X("peer Addr %02x-%02x-%02x-%02x-%02x-%02x \n",pWapiStaInfo->PeerMacAddr[0],pWapiStaInfo->PeerMacAddr[1],pWapiStaInfo->PeerMacAddr[2],pWapiStaInfo->PeerMacAddr[3],pWapiStaInfo->PeerMacAddr[4],pWapiStaInfo->PeerMacAddr[5]); ++ ++ if(pWapiStaInfo == NULL) ++ { ++ WAPI_TRACE(WAPI_API, " %s: pWapiStaInfo == NULL Case \n", __FUNCTION__); ++ return; ++ } ++ ++ if(pWapiStaInfo->PeerMacAddr == NULL) ++ { ++ WAPI_TRACE(WAPI_API, " %s: pWapiStaInfo->PeerMacAddr == NULL Case \n", __FUNCTION__); ++ return; ++ } ++ ++ if(MacAddr == NULL) ++ { ++ WAPI_TRACE(WAPI_API, " %s: MacAddr == NULL Case \n", __FUNCTION__); ++ return; ++ } ++ ++ if (_rtw_memcmp(pWapiStaInfo->PeerMacAddr, MacAddr, ETH_ALEN) == true) { ++ pWapiStaInfo->bAuthenticateInProgress = false; ++ pWapiStaInfo->bSetkeyOk = false; ++ _rtw_memset(pWapiStaInfo->PeerMacAddr,0,ETH_ALEN); ++ list_del_init(&pWapiStaInfo->list); ++ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); ++ break; ++ } ++ ++ } ++#endif ++ ++ while(!list_empty(&(pWapiInfo->wapiSTAUsedList))) ++ { ++ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAUsedList.next, RT_WAPI_STA_INFO, list); ++ ++ DBG_871X("peer Addr %02x-%02x-%02x-%02x-%02x-%02x \n",pWapiStaInfo->PeerMacAddr[0],pWapiStaInfo->PeerMacAddr[1],pWapiStaInfo->PeerMacAddr[2],pWapiStaInfo->PeerMacAddr[3],pWapiStaInfo->PeerMacAddr[4],pWapiStaInfo->PeerMacAddr[5]); ++ ++ list_del_init(&pWapiStaInfo->list); ++ memset(pWapiStaInfo->PeerMacAddr,0,ETH_ALEN); ++ pWapiStaInfo->bSetkeyOk = 0; ++ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); ++ } ++ ++ } ++ ++ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); ++ return; ++} ++ ++void rtw_wapi_return_all_sta_info(_adapter *padapter) ++{ ++ PRT_WAPI_T pWapiInfo; ++ PRT_WAPI_STA_INFO pWapiStaInfo; ++ PRT_WAPI_BKID pWapiBkid; ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ pWapiInfo = &padapter->wapiInfo; ++ ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ //Sta Info List ++ while(!list_empty(&(pWapiInfo->wapiSTAUsedList))) ++ { ++ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAUsedList.next, RT_WAPI_STA_INFO, list); ++ list_del_init(&pWapiStaInfo->list); ++ memset(pWapiStaInfo->PeerMacAddr,0,ETH_ALEN); ++ pWapiStaInfo->bSetkeyOk = 0; ++ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); ++ } ++ ++ //BKID List ++ while(!list_empty(&(pWapiInfo->wapiBKIDStoreList))) ++ { ++ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDStoreList.next, RT_WAPI_BKID, list); ++ list_del_init(&pWapiBkid->list); ++ memset(pWapiBkid->bkid,0,16); ++ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDIdleList); ++ } ++ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_wapi_clear_cam_entry(_adapter *padapter, u8 *pMacAddr) ++{ ++ u8 UcIndex = 0; ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 0, 0); ++ if(UcIndex != 0xff){ ++ //CAM_mark_invalid(Adapter, UcIndex); ++ CAM_empty_entry(padapter, UcIndex); ++ } ++ ++ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 1, 0); ++ if(UcIndex != 0xff){ ++ //CAM_mark_invalid(Adapter, UcIndex); ++ CAM_empty_entry(padapter, UcIndex); ++ } ++ ++ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 0, 1); ++ if(UcIndex != 0xff){ ++ //CAM_mark_invalid(Adapter, UcIndex); ++ CAM_empty_entry(padapter, UcIndex); ++ } ++ ++ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 1, 1); ++ if(UcIndex != 0xff){ ++ //CAM_mark_invalid(padapter, UcIndex); ++ CAM_empty_entry(padapter, UcIndex); ++ } ++ ++ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); ++} ++ ++void rtw_wapi_clear_all_cam_entry(_adapter *padapter) ++{ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ invalidate_cam_all(padapter); // is this ok? ++ WapiResetAllCamEntry(padapter); ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++} ++ ++void rtw_wapi_set_key(_adapter *padapter, RT_WAPI_KEY *pWapiKey, RT_WAPI_STA_INFO *pWapiSta, u8 bGroupKey, u8 bUseDefaultKey) ++{ ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ u8 *pMacAddr = pWapiSta->PeerMacAddr; ++ u32 EntryId = 0; ++ bool IsPairWise = false ; ++ u8 EncAlgo; ++ ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_API, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); ++ return; ++ } ++ ++ EncAlgo = _SMS4_; ++ ++ //For Tx bc/mc pkt,use defualt key entry ++ if(bUseDefaultKey) ++ { ++ // when WAPI update key, keyid will be 0 or 1 by turns. ++ if (pWapiKey->keyId == 0) ++ EntryId = 0; ++ else ++ EntryId = 2; ++ } ++ else ++ { ++ // tx/rx unicast pkt, or rx broadcast, find the key entry by peer's MacAddr ++ EntryId = WapiGetEntryForCamWrite(padapter,pMacAddr,pWapiKey->keyId,bGroupKey); ++ } ++ ++ if(EntryId == 0xff){ ++ WAPI_TRACE(WAPI_API, "===>No entry for WAPI setkey! !!\n"); ++ return; ++ } ++ ++ //EntryId is also used to diff Sec key and Mic key ++ //Sec Key ++ WapiWriteOneCamEntry(padapter, ++ pMacAddr, ++ pWapiKey->keyId, //keyid ++ EntryId, //entry ++ EncAlgo, //type ++ bGroupKey, //pairwise or group key ++ pWapiKey->dataKey); ++ //MIC key ++ WapiWriteOneCamEntry(padapter, ++ pMacAddr, ++ pWapiKey->keyId, //keyid ++ EntryId+1, //entry ++ EncAlgo, //type ++ bGroupKey, //pairwise or group key ++ pWapiKey->micKey); ++ ++ WAPI_TRACE(WAPI_API, "Set Wapi Key :KeyId:%d,EntryId:%d,PairwiseKey:%d.\n",pWapiKey->keyId,EntryId,!bGroupKey); ++ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); ++ ++} ++ ++#if 0 ++//YJ,test,091013 ++void wapi_test_set_key(struct _adapter *padapter, u8* buf) ++{ /*Data: keyType(1) + bTxEnable(1) + bAuthenticator(1) + bUpdate(1) + PeerAddr(6) + DataKey(16) + MicKey(16) + KeyId(1)*/ ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ PRT_WAPI_BKID pWapiBkid; ++ PRT_WAPI_STA_INFO pWapiSta; ++ u8 data[43]; ++ bool bTxEnable; ++ bool bUpdate; ++ bool bAuthenticator; ++ u8 PeerAddr[6]; ++ u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; ++ u8 WapiASUEPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; ++ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; ++ ++ WAPI_TRACE(WAPI_INIT, "===========>%s\n", __FUNCTION__); ++ ++ if (!padapter->WapiSupport){ ++ return; ++ } ++ ++ copy_from_user(data, buf, 43); ++ bTxEnable = data[1]; ++ bAuthenticator = data[2]; ++ bUpdate = data[3]; ++ memcpy(PeerAddr,data+4,6); ++ ++ if(data[0] == 0x3){ ++ if(!list_empty(&(pWapiInfo->wapiBKIDIdleList))){ ++ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDIdleList.next, RT_WAPI_BKID, list); ++ list_del_init(&pWapiBkid->list); ++ memcpy(pWapiBkid->bkid, data+10, 16); ++ WAPI_DATA(WAPI_INIT, "SetKey - BKID", pWapiBkid->bkid, 16); ++ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDStoreList); ++ } ++ }else{ ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if(!memcmp(pWapiSta->PeerMacAddr,PeerAddr,6)){ ++ pWapiSta->bAuthenticatorInUpdata = false; ++ switch(data[0]){ ++ case 1: //usk ++ if(bAuthenticator){ //authenticator ++ memcpy(pWapiSta->lastTxUnicastPN,WapiAEPNInitialValueSrc,16); ++ if(!bUpdate) { //first ++ WAPI_TRACE(WAPI_INIT,"AE fisrt set usk \n"); ++ pWapiSta->wapiUsk.bSet = true; ++ memcpy(pWapiSta->wapiUsk.dataKey,data+10,16); ++ memcpy(pWapiSta->wapiUsk.micKey,data+26,16); ++ pWapiSta->wapiUsk.keyId = *(data+42); ++ pWapiSta->wapiUsk.bTxEnable = true; ++ WAPI_DATA(WAPI_INIT, "SetKey - AE USK Data Key", pWapiSta->wapiUsk.dataKey, 16); ++ WAPI_DATA(WAPI_INIT, "SetKey - AE USK Mic Key", pWapiSta->wapiUsk.micKey, 16); ++ } ++ else //update ++ { ++ WAPI_TRACE(WAPI_INIT, "AE update usk \n"); ++ pWapiSta->wapiUskUpdate.bSet = true; ++ pWapiSta->bAuthenticatorInUpdata = true; ++ memcpy(pWapiSta->wapiUskUpdate.dataKey,data+10,16); ++ memcpy(pWapiSta->wapiUskUpdate.micKey,data+26,16); ++ memcpy(pWapiSta->lastRxUnicastPNBEQueue,WapiASUEPNInitialValueSrc,16); ++ memcpy(pWapiSta->lastRxUnicastPNBKQueue,WapiASUEPNInitialValueSrc,16); ++ memcpy(pWapiSta->lastRxUnicastPNVIQueue,WapiASUEPNInitialValueSrc,16); ++ memcpy(pWapiSta->lastRxUnicastPNVOQueue,WapiASUEPNInitialValueSrc,16); ++ memcpy(pWapiSta->lastRxUnicastPN,WapiASUEPNInitialValueSrc,16); ++ pWapiSta->wapiUskUpdate.keyId = *(data+42); ++ pWapiSta->wapiUskUpdate.bTxEnable = true; ++ } ++ } ++ else{ ++ if(!bUpdate){ ++ WAPI_TRACE(WAPI_INIT,"ASUE fisrt set usk \n"); ++ if(bTxEnable){ ++ pWapiSta->wapiUsk.bTxEnable = true; ++ memcpy(pWapiSta->lastTxUnicastPN,WapiASUEPNInitialValueSrc,16); ++ }else{ ++ pWapiSta->wapiUsk.bSet = true; ++ memcpy(pWapiSta->wapiUsk.dataKey,data+10,16); ++ memcpy(pWapiSta->wapiUsk.micKey,data+26,16); ++ pWapiSta->wapiUsk.keyId = *(data+42); ++ pWapiSta->wapiUsk.bTxEnable = false; ++ } ++ }else{ ++ WAPI_TRACE(WAPI_INIT,"ASUE update usk \n"); ++ if(bTxEnable){ ++ pWapiSta->wapiUskUpdate.bTxEnable = true; ++ if(pWapiSta->wapiUskUpdate.bSet){ ++ memcpy(pWapiSta->wapiUsk.dataKey,pWapiSta->wapiUskUpdate.dataKey,16); ++ memcpy(pWapiSta->wapiUsk.micKey,pWapiSta->wapiUskUpdate.micKey,16); ++ pWapiSta->wapiUsk.keyId=pWapiSta->wapiUskUpdate.keyId; ++ memcpy(pWapiSta->lastRxUnicastPNBEQueue,WapiASUEPNInitialValueSrc,16); ++ memcpy(pWapiSta->lastRxUnicastPNBKQueue,WapiASUEPNInitialValueSrc,16); ++ memcpy(pWapiSta->lastRxUnicastPNVIQueue,WapiASUEPNInitialValueSrc,16); ++ memcpy(pWapiSta->lastRxUnicastPNVOQueue,WapiASUEPNInitialValueSrc,16); ++ memcpy(pWapiSta->lastRxUnicastPN,WapiASUEPNInitialValueSrc,16); ++ pWapiSta->wapiUskUpdate.bTxEnable = false; ++ pWapiSta->wapiUskUpdate.bSet = false; ++ } ++ memcpy(pWapiSta->lastTxUnicastPN,WapiASUEPNInitialValueSrc,16); ++ }else{ ++ pWapiSta->wapiUskUpdate.bSet = true; ++ memcpy(pWapiSta->wapiUskUpdate.dataKey,data+10,16); ++ memcpy(pWapiSta->wapiUskUpdate.micKey,data+26,16); ++ pWapiSta->wapiUskUpdate.keyId = *(data+42); ++ pWapiSta->wapiUskUpdate.bTxEnable = false; ++ } ++ } ++ } ++ break; ++ case 2: //msk ++ if(bAuthenticator){ //authenticator ++ pWapiInfo->wapiTxMsk.bSet = true; ++ memcpy(pWapiInfo->wapiTxMsk.dataKey,data+10,16); ++ memcpy(pWapiInfo->wapiTxMsk.micKey,data+26,16); ++ pWapiInfo->wapiTxMsk.keyId = *(data+42); ++ pWapiInfo->wapiTxMsk.bTxEnable = true; ++ memcpy(pWapiInfo->lastTxMulticastPN,WapiAEMultiCastPNInitialValueSrc,16); ++ ++ if(!bUpdate){ //first ++ WAPI_TRACE(WAPI_INIT, "AE fisrt set msk \n"); ++ if(!pWapiSta->bSetkeyOk) ++ pWapiSta->bSetkeyOk = true; ++ pWapiInfo->bFirstAuthentiateInProgress= false; ++ }else{ //update ++ WAPI_TRACE(WAPI_INIT,"AE update msk \n"); ++ } ++ ++ WAPI_DATA(WAPI_INIT, "SetKey - AE MSK Data Key", pWapiInfo->wapiTxMsk.dataKey, 16); ++ WAPI_DATA(WAPI_INIT, "SetKey - AE MSK Mic Key", pWapiInfo->wapiTxMsk.micKey, 16); ++ } ++ else{ ++ if(!bUpdate){ ++ WAPI_TRACE(WAPI_INIT,"ASUE fisrt set msk \n"); ++ pWapiSta->wapiMsk.bSet = true; ++ memcpy(pWapiSta->wapiMsk.dataKey,data+10,16); ++ memcpy(pWapiSta->wapiMsk.micKey,data+26,16); ++ pWapiSta->wapiMsk.keyId = *(data+42); ++ pWapiSta->wapiMsk.bTxEnable = false; ++ if(!pWapiSta->bSetkeyOk) ++ pWapiSta->bSetkeyOk = true; ++ pWapiInfo->bFirstAuthentiateInProgress= false; ++ WAPI_DATA(WAPI_INIT, "SetKey - ASUE MSK Data Key", pWapiSta->wapiMsk.dataKey, 16); ++ WAPI_DATA(WAPI_INIT, "SetKey - ASUE MSK Mic Key", pWapiSta->wapiMsk.micKey, 16); ++ }else{ ++ WAPI_TRACE(WAPI_INIT,"ASUE update msk \n"); ++ pWapiSta->wapiMskUpdate.bSet = true; ++ memcpy(pWapiSta->wapiMskUpdate.dataKey,data+10,16); ++ memcpy(pWapiSta->wapiMskUpdate.micKey,data+26,16); ++ pWapiSta->wapiMskUpdate.keyId = *(data+42); ++ pWapiSta->wapiMskUpdate.bTxEnable = false; ++ } ++ } ++ break; ++ default: ++ WAPI_TRACE(WAPI_ERR,"Unknown Flag \n"); ++ break; ++ } ++ } ++ } ++ } ++ WAPI_TRACE(WAPI_INIT, "<===========%s\n", __FUNCTION__); ++} ++ ++ ++void wapi_test_init(struct _adapter *padapter) ++{ ++ u8 keybuf[100]; ++ u8 mac_addr[6]={0x00,0xe0,0x4c,0x72,0x04,0x70}; ++ u8 UskDataKey[16]={0x00,0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,0x09,0x0a,0x0b,0x0c,0x0d,0x0e,0x0f}; ++ u8 UskMicKey[16]={0x10,0x11,0x12,0x13,0x14,0x15,0x16,0x17,0x18,0x19,0x1a,0x1b,0x1c,0x1d,0x1e,0x1f}; ++ u8 UskId = 0; ++ u8 MskDataKey[16]={0x20,0x21,0x22,0x23,0x24,0x25,0x26,0x27,0x28,0x29,0x2a,0x2b,0x2c,0x2d,0x2e,0x2f}; ++ u8 MskMicKey[16]={0x30,0x31,0x32,0x33,0x34,0x35,0x36,0x37,0x38,0x39,0x3a,0x3b,0x3c,0x3d,0x3e,0x3f}; ++ u8 MskId = 0; ++ ++ WAPI_TRACE(WAPI_INIT, "===========>%s\n", __FUNCTION__); ++ ++ //Enable Wapi ++ WAPI_TRACE(WAPI_INIT, "%s: Enable wapi!!!!\n", __FUNCTION__); ++ padapter->wapiInfo.bWapiEnable = true; ++ padapter->pairwise_key_type = KEY_TYPE_SMS4; ++ ieee->group_key_type = KEY_TYPE_SMS4; ++ padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN; ++ padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN; ++ ++ //set usk ++ WAPI_TRACE(WAPI_INIT, "%s: Set USK!!!!\n", __FUNCTION__); ++ memset(keybuf,0,100); ++ keybuf[0] = 1; //set usk ++ keybuf[1] = 1; //enable tx ++ keybuf[2] = 1; //AE ++ keybuf[3] = 0; //not update ++ ++ memcpy(keybuf+4,mac_addr,6); ++ memcpy(keybuf+10,UskDataKey,16); ++ memcpy(keybuf+26,UskMicKey,16); ++ keybuf[42]=UskId; ++ wapi_test_set_key(padapter, keybuf); ++ ++ memset(keybuf,0,100); ++ keybuf[0] = 1; //set usk ++ keybuf[1] = 1; //enable tx ++ keybuf[2] = 0; //AE ++ keybuf[3] = 0; //not update ++ ++ memcpy(keybuf+4,mac_addr,6); ++ memcpy(keybuf+10,UskDataKey,16); ++ memcpy(keybuf+26,UskMicKey,16); ++ keybuf[42]=UskId; ++ wapi_test_set_key(padapter, keybuf); ++ ++ //set msk ++ WAPI_TRACE(WAPI_INIT, "%s: Set MSK!!!!\n", __FUNCTION__); ++ memset(keybuf,0,100); ++ keybuf[0] = 2; //set msk ++ keybuf[1] = 1; //Enable TX ++ keybuf[2] = 1; //AE ++ keybuf[3] = 0; //not update ++ memcpy(keybuf+4,mac_addr,6); ++ memcpy(keybuf+10,MskDataKey,16); ++ memcpy(keybuf+26,MskMicKey,16); ++ keybuf[42] = MskId; ++ wapi_test_set_key(padapter, keybuf); ++ ++ memset(keybuf,0,100); ++ keybuf[0] = 2; //set msk ++ keybuf[1] = 1; //Enable TX ++ keybuf[2] = 0; //AE ++ keybuf[3] = 0; //not update ++ memcpy(keybuf+4,mac_addr,6); ++ memcpy(keybuf+10,MskDataKey,16); ++ memcpy(keybuf+26,MskMicKey,16); ++ keybuf[42] = MskId; ++ wapi_test_set_key(padapter, keybuf); ++ WAPI_TRACE(WAPI_INIT, "<===========%s\n", __FUNCTION__); ++} ++#endif ++ ++void rtw_wapi_get_iv(_adapter *padapter,u8 *pRA, u8*IV) ++{ ++ PWLAN_HEADER_WAPI_EXTENSION pWapiExt = NULL; ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ bool bPNOverflow = false; ++ bool bFindMatchPeer = false; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ ++ pWapiExt = (PWLAN_HEADER_WAPI_EXTENSION)IV; ++ ++ WAPI_DATA(WAPI_RX,"wapi_get_iv: pra",pRA,6); ++ ++ if(IS_MCAST(pRA)){ ++ if(!pWapiInfo->wapiTxMsk.bTxEnable){ ++ WAPI_TRACE(WAPI_ERR,"%s: bTxEnable = 0!!\n",__FUNCTION__); ++ return; ++ } ++ ++ if(pWapiInfo->wapiTxMsk.keyId <= 1){ ++ pWapiExt->KeyIdx = pWapiInfo->wapiTxMsk.keyId; ++ pWapiExt->Reserved = 0; ++ bPNOverflow = WapiIncreasePN(pWapiInfo->lastTxMulticastPN, 1); ++ memcpy(pWapiExt->PN, pWapiInfo->lastTxMulticastPN, 16); ++ } ++ } ++ else ++ { ++ if(list_empty(&pWapiInfo->wapiSTAUsedList)){ ++ WAPI_TRACE(WAPI_RX,"rtw_wapi_get_iv: list is empty \n"); ++ _rtw_memset(IV,10,18); ++ return; ++ } ++ else{ ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list){ ++ WAPI_DATA(WAPI_RX,"rtw_wapi_get_iv: peermacaddr ",pWapiSta->PeerMacAddr,6); ++ if (_rtw_memcmp((u8*)pWapiSta->PeerMacAddr, pRA, 6) == true) { ++ bFindMatchPeer = true; ++ break; ++ } ++ } ++ ++ WAPI_TRACE(WAPI_RX,"bFindMatchPeer: %d \n",bFindMatchPeer); ++ WAPI_DATA(WAPI_RX,"Addr",pRA,6); ++ ++ if (bFindMatchPeer){ ++ if((!pWapiSta->wapiUskUpdate.bTxEnable) && (!pWapiSta->wapiUsk.bTxEnable)) ++ return; ++ ++ if (pWapiSta->wapiUsk.keyId <= 1){ ++ if(pWapiSta->wapiUskUpdate.bTxEnable) ++ pWapiExt->KeyIdx = pWapiSta->wapiUskUpdate.keyId; ++ else ++ pWapiExt->KeyIdx = pWapiSta->wapiUsk.keyId; ++ ++ pWapiExt->Reserved = 0; ++ bPNOverflow = WapiIncreasePN(pWapiSta->lastTxUnicastPN, 2); ++ _rtw_memcpy(pWapiExt->PN, pWapiSta->lastTxUnicastPN, 16); ++ ++ } ++ } ++ } ++ ++ } ++ ++} ++ ++bool rtw_wapi_drop_for_key_absent(_adapter *padapter,u8 *pRA) ++{ ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ bool bFindMatchPeer = false; ++ bool bDrop = false; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++ WAPI_DATA(WAPI_RX,"rtw_wapi_drop_for_key_absent: ra ",pRA,6); ++ ++ if(psecuritypriv->dot11PrivacyAlgrthm == _SMS4_) ++ { ++ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) ++ return true; ++ ++ if(IS_MCAST(pRA)){ ++ if(!pWapiInfo->wapiTxMsk.bTxEnable){ ++ bDrop = true; ++ WAPI_TRACE(WAPI_RX,"rtw_wapi_drop_for_key_absent: multicast key is absent \n"); ++ return bDrop; ++ } ++ } ++ else{ ++ if(!list_empty(&pWapiInfo->wapiSTAUsedList)){ ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list){ ++ WAPI_DATA(WAPI_RX,"rtw_wapi_drop_for_key_absent: pWapiSta->PeerMacAddr ",pWapiSta->PeerMacAddr,6); ++ if (_rtw_memcmp(pRA, pWapiSta->PeerMacAddr, 6) == true){ ++ bFindMatchPeer = true; ++ break; ++ } ++ } ++ if (bFindMatchPeer) { ++ if (!pWapiSta->wapiUsk.bTxEnable){ ++ bDrop = true; ++ WAPI_TRACE(WAPI_RX,"rtw_wapi_drop_for_key_absent: unicast key is absent \n"); ++ return bDrop; ++ } ++ } ++ else{ ++ bDrop = true; ++ WAPI_TRACE(WAPI_RX,"rtw_wapi_drop_for_key_absent: no peer find \n"); ++ return bDrop; ++ } ++ ++ } ++ else{ ++ bDrop = true; ++ WAPI_TRACE(WAPI_RX,"rtw_wapi_drop_for_key_absent: no sta exist \n"); ++ return bDrop; ++ } ++ } ++ } ++ else ++ { ++ return bDrop; ++ } ++ ++ return bDrop; ++} ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_wapi_sms4.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_wapi_sms4.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_wapi_sms4.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_wapi_sms4.c 2018-02-06 17:42:30.700967016 +0200 +@@ -0,0 +1,920 @@ ++#ifdef CONFIG_WAPI_SUPPORT ++ ++#include ++#include ++#include ++#include ++ ++ ++#ifdef CONFIG_WAPI_SW_SMS4 ++ ++#define ENCRYPT 0 ++#define DECRYPT 1 ++ ++/********************************************************** ++ **********************************************************/ ++const u8 Sbox[256] = { ++0xd6,0x90,0xe9,0xfe,0xcc,0xe1,0x3d,0xb7,0x16,0xb6,0x14,0xc2,0x28,0xfb,0x2c,0x05, ++0x2b,0x67,0x9a,0x76,0x2a,0xbe,0x04,0xc3,0xaa,0x44,0x13,0x26,0x49,0x86,0x06,0x99, ++0x9c,0x42,0x50,0xf4,0x91,0xef,0x98,0x7a,0x33,0x54,0x0b,0x43,0xed,0xcf,0xac,0x62, ++0xe4,0xb3,0x1c,0xa9,0xc9,0x08,0xe8,0x95,0x80,0xdf,0x94,0xfa,0x75,0x8f,0x3f,0xa6, ++0x47,0x07,0xa7,0xfc,0xf3,0x73,0x17,0xba,0x83,0x59,0x3c,0x19,0xe6,0x85,0x4f,0xa8, ++0x68,0x6b,0x81,0xb2,0x71,0x64,0xda,0x8b,0xf8,0xeb,0x0f,0x4b,0x70,0x56,0x9d,0x35, ++0x1e,0x24,0x0e,0x5e,0x63,0x58,0xd1,0xa2,0x25,0x22,0x7c,0x3b,0x01,0x21,0x78,0x87, ++0xd4,0x00,0x46,0x57,0x9f,0xd3,0x27,0x52,0x4c,0x36,0x02,0xe7,0xa0,0xc4,0xc8,0x9e, ++0xea,0xbf,0x8a,0xd2,0x40,0xc7,0x38,0xb5,0xa3,0xf7,0xf2,0xce,0xf9,0x61,0x15,0xa1, ++0xe0,0xae,0x5d,0xa4,0x9b,0x34,0x1a,0x55,0xad,0x93,0x32,0x30,0xf5,0x8c,0xb1,0xe3, ++0x1d,0xf6,0xe2,0x2e,0x82,0x66,0xca,0x60,0xc0,0x29,0x23,0xab,0x0d,0x53,0x4e,0x6f, ++0xd5,0xdb,0x37,0x45,0xde,0xfd,0x8e,0x2f,0x03,0xff,0x6a,0x72,0x6d,0x6c,0x5b,0x51, ++0x8d,0x1b,0xaf,0x92,0xbb,0xdd,0xbc,0x7f,0x11,0xd9,0x5c,0x41,0x1f,0x10,0x5a,0xd8, ++0x0a,0xc1,0x31,0x88,0xa5,0xcd,0x7b,0xbd,0x2d,0x74,0xd0,0x12,0xb8,0xe5,0xb4,0xb0, ++0x89,0x69,0x97,0x4a,0x0c,0x96,0x77,0x7e,0x65,0xb9,0xf1,0x09,0xc5,0x6e,0xc6,0x84, ++0x18,0xf0,0x7d,0xec,0x3a,0xdc,0x4d,0x20,0x79,0xee,0x5f,0x3e,0xd7,0xcb,0x39,0x48 ++}; ++ ++const u32 CK[32] = { ++ 0x00070e15, 0x1c232a31, 0x383f464d, 0x545b6269, ++ 0x70777e85, 0x8c939aa1, 0xa8afb6bd, 0xc4cbd2d9, ++ 0xe0e7eef5, 0xfc030a11, 0x181f262d, 0x343b4249, ++ 0x50575e65, 0x6c737a81, 0x888f969d, 0xa4abb2b9, ++ 0xc0c7ced5, 0xdce3eaf1, 0xf8ff060d, 0x141b2229, ++ 0x30373e45, 0x4c535a61, 0x686f767d, 0x848b9299, ++ 0xa0a7aeb5, 0xbcc3cad1, 0xd8dfe6ed, 0xf4fb0209, ++ 0x10171e25, 0x2c333a41, 0x484f565d, 0x646b7279 }; ++ ++#define Rotl(_x, _y) (((_x) << (_y)) | ((_x) >> (32 - (_y)))) ++ ++#define ByteSub(_A) (Sbox[(_A) >> 24 & 0xFF] << 24 | \ ++ Sbox[(_A) >> 16 & 0xFF] << 16 | \ ++ Sbox[(_A) >> 8 & 0xFF] << 8 | \ ++ Sbox[(_A) & 0xFF]) ++ ++#define L1(_B) ((_B) ^ Rotl(_B, 2) ^ Rotl(_B, 10) ^ Rotl(_B, 18) ^ Rotl(_B, 24)) ++#define L2(_B) ((_B) ^ Rotl(_B, 13) ^ Rotl(_B, 23)) ++ ++static void ++xor_block(void *dst, void *src1, void *src2) ++/* 128-bit xor: *dst = *src1 xor *src2. Pointers must be 32-bit aligned */ ++{ ++ ((u32 *)dst)[0] = ((u32 *)src1)[0] ^ ((u32 *)src2)[0]; ++ ((u32 *)dst)[1] = ((u32 *)src1)[1] ^ ((u32 *)src2)[1]; ++ ((u32 *)dst)[2] = ((u32 *)src1)[2] ^ ((u32 *)src2)[2]; ++ ((u32 *)dst)[3] = ((u32 *)src1)[3] ^ ((u32 *)src2)[3]; ++} ++ ++ ++void SMS4Crypt(u8 *Input, u8 *Output, u32 *rk) ++{ ++ u32 r, mid, x0, x1, x2, x3, *p; ++ p = (u32 *)Input; ++ x0 = p[0]; ++ x1 = p[1]; ++ x2 = p[2]; ++ x3 = p[3]; ++#ifdef __LITTLE_ENDIAN ++ x0 = Rotl(x0, 16); x0 = ((x0 & 0x00FF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); ++ x1 = Rotl(x1, 16); x1 = ((x1 & 0x00FF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); ++ x2 = Rotl(x2, 16); x2 = ((x2 & 0x00FF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); ++ x3 = Rotl(x3, 16); x3 = ((x3 & 0x00FF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); ++#endif ++ for (r = 0; r < 32; r += 4) ++ { ++ mid = x1 ^ x2 ^ x3 ^ rk[r + 0]; ++ mid = ByteSub(mid); ++ x0 ^= L1(mid); ++ mid = x2 ^ x3 ^ x0 ^ rk[r + 1]; ++ mid = ByteSub(mid); ++ x1 ^= L1(mid); ++ mid = x3 ^ x0 ^ x1 ^ rk[r + 2]; ++ mid = ByteSub(mid); ++ x2 ^= L1(mid); ++ mid = x0 ^ x1 ^ x2 ^ rk[r + 3]; ++ mid = ByteSub(mid); ++ x3 ^= L1(mid); ++ } ++#ifdef __LITTLE_ENDIAN ++ x0 = Rotl(x0, 16); x0 = ((x0 & 0x00FF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); ++ x1 = Rotl(x1, 16); x1 = ((x1 & 0x00FF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); ++ x2 = Rotl(x2, 16); x2 = ((x2 & 0x00FF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); ++ x3 = Rotl(x3, 16); x3 = ((x3 & 0x00FF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); ++#endif ++ p = (u32 *)Output; ++ p[0] = x3; ++ p[1] = x2; ++ p[2] = x1; ++ p[3] = x0; ++} ++ ++ ++ ++void SMS4KeyExt(u8 *Key, u32 *rk, u32 CryptFlag) ++{ ++ u32 r, mid, x0, x1, x2, x3, *p; ++ ++ p = (u32 *)Key; ++ x0 = p[0]; ++ x1 = p[1]; ++ x2 = p[2]; ++ x3 = p[3]; ++#ifdef __LITTLE_ENDIAN ++ x0 = Rotl(x0, 16); x0 = ((x0 & 0xFF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); ++ x1 = Rotl(x1, 16); x1 = ((x1 & 0xFF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); ++ x2 = Rotl(x2, 16); x2 = ((x2 & 0xFF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); ++ x3 = Rotl(x3, 16); x3 = ((x3 & 0xFF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); ++#endif ++ ++ x0 ^= 0xa3b1bac6; ++ x1 ^= 0x56aa3350; ++ x2 ^= 0x677d9197; ++ x3 ^= 0xb27022dc; ++ for (r = 0; r < 32; r += 4) ++ { ++ mid = x1 ^ x2 ^ x3 ^ CK[r + 0]; ++ mid = ByteSub(mid); ++ rk[r + 0] = x0 ^= L2(mid); ++ mid = x2 ^ x3 ^ x0 ^ CK[r + 1]; ++ mid = ByteSub(mid); ++ rk[r + 1] = x1 ^= L2(mid); ++ mid = x3 ^ x0 ^ x1 ^ CK[r + 2]; ++ mid = ByteSub(mid); ++ rk[r + 2] = x2 ^= L2(mid); ++ mid = x0 ^ x1 ^ x2 ^ CK[r + 3]; ++ mid = ByteSub(mid); ++ rk[r + 3] = x3 ^= L2(mid); ++ } ++ if (CryptFlag == DECRYPT) ++ { ++ for (r = 0; r < 16; r++) ++ mid = rk[r], rk[r] = rk[31 - r], rk[31 - r] = mid; ++ } ++} ++ ++ ++void WapiSMS4Cryption(u8 *Key, u8 *IV, u8 *Input, u16 InputLength, ++ u8 *Output, u16 *OutputLength, u32 CryptFlag) ++{ ++ u32 blockNum,i,j, rk[32]; ++ u16 remainder; ++ u8 blockIn[16],blockOut[16], tempIV[16], k; ++ ++ *OutputLength = 0; ++ remainder = InputLength & 0x0F; ++ blockNum = InputLength >> 4; ++ if(remainder !=0) ++ blockNum++; ++ else ++ remainder = 16; ++ ++ for(k=0;k<16;k++) ++ tempIV[k] = IV[15-k]; ++ ++ memcpy(blockIn, tempIV, 16); ++ ++ SMS4KeyExt((u8 *)Key, rk,CryptFlag); ++ ++ for(i=0; i> 4; ++ ++ for(k=0;k<16;k++) ++ tempIV[k] = IV[15-k]; ++ ++ memcpy(BlockIn, tempIV, 16); ++ ++ SMS4KeyExt((u8 *)Key, rk, ENCRYPT); ++ ++ SMS4Crypt((u8 *)BlockIn, BlockOut, rk); ++ ++ for(i=0; i> 4; ++ ++ for(i=0; i%s\n", __FUNCTION__); ++ ++ header = (struct ieee80211_hdr_3addr_qos *)pHeader; ++ memset(TempBuf, 0, 34); ++ memcpy(TempBuf, pHeader, 2); //FrameCtrl ++ pTemp = (u16*)TempBuf; ++ *pTemp &= 0xc78f; //bit4,5,6,11,12,13 ++ ++ memcpy((TempBuf+2), (pHeader+4), 12); //Addr1, Addr2 ++ memcpy((TempBuf+14), (pHeader+22), 2); // SeqCtrl ++ pTemp = (u16*)(TempBuf + 14); ++ *pTemp &= 0x000f; ++ ++ memcpy((TempBuf+16), (pHeader+16), 6); //Addr3 ++ ++ fc = le16_to_cpu(header->frame_ctl); ++ ++ ++ ++ if (GetFrDs((u16*)&fc) && GetToDs((u16 *)&fc)) ++ { ++ memcpy((TempBuf+22), (pHeader+24), 6); ++ QosOffset = 30; ++ }else{ ++ memset((TempBuf+22), 0, 6); ++ QosOffset = 24; ++ } ++ ++ if((fc & 0x0088) == 0x0088){ ++ memcpy((TempBuf+28), (pHeader+QosOffset), 2); ++ TempLen += 2; ++ //IV = pHeader + QosOffset + 2 + SNAP_SIZE + sizeof(u16) + 2; ++ IV = pHeader + QosOffset + 2 + 2; ++ }else{ ++ IV = pHeader + QosOffset + 2; ++ //IV = pHeader + QosOffset + SNAP_SIZE + sizeof(u16) + 2; ++ } ++ ++ TempBuf[TempLen-1] = (u8)(DataLen & 0xff); ++ TempBuf[TempLen-2] = (u8)((DataLen & 0xff00)>>8); ++ TempBuf[TempLen-4] = KeyIdx; ++ ++ WAPI_DATA(WAPI_TX, "CalculateMic - KEY", MicKey, 16); ++ WAPI_DATA(WAPI_TX, "CalculateMic - IV", IV, 16); ++ WAPI_DATA(WAPI_TX, "CalculateMic - TempBuf", TempBuf, TempLen); ++ WAPI_DATA(WAPI_TX, "CalculateMic - pData", pData, DataLen); ++ ++ WapiSMS4CalculateMic(MicKey, IV, TempBuf, TempLen, ++ pData, DataLen, MicBuffer, &MicLen); ++ ++ if (MicLen != 16) ++ WAPI_TRACE(WAPI_ERR,"%s: MIC Length Error!!\n",__FUNCTION__); ++ ++ WAPI_TRACE(WAPI_TX|WAPI_RX, "<=========%s\n", __FUNCTION__); ++#endif ++} ++ ++/* AddCount: 1 or 2. ++ * If overflow, return 1, ++ * else return 0. ++ */ ++u8 WapiIncreasePN(u8 *PN, u8 AddCount) ++{ ++ u8 i; ++ ++ if (NULL == PN) ++ return 1; ++ //YJ,test,091102 ++ /* ++ if(AddCount == 2){ ++ DBG_8192C("############################%s(): PN[0]=0x%x\n", __FUNCTION__, PN[0]); ++ if(PN[0] == 0x48){ ++ PN[0] += AddCount; ++ return 1; ++ }else{ ++ PN[0] += AddCount; ++ return 0; ++ } ++ } ++ */ ++ //YJ,test,091102,end ++ ++ for (i=0; i<16; i++) ++ { ++ if (PN[i] + AddCount <= 0xff) ++ { ++ PN[i] += AddCount; ++ return 0; ++ } ++ else ++ { ++ PN[i] += AddCount; ++ AddCount = 1; ++ } ++ } ++ return 1; ++} ++ ++ ++void WapiGetLastRxUnicastPNForQoSData( ++ u8 UserPriority, ++ PRT_WAPI_STA_INFO pWapiStaInfo, ++ u8 *PNOut ++) ++{ ++ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); ++ switch(UserPriority) ++ { ++ case 0: ++ case 3: ++ memcpy(PNOut,pWapiStaInfo->lastRxUnicastPNBEQueue,16); ++ break; ++ case 1: ++ case 2: ++ memcpy(PNOut,pWapiStaInfo->lastRxUnicastPNBKQueue,16); ++ break; ++ case 4: ++ case 5: ++ memcpy(PNOut,pWapiStaInfo->lastRxUnicastPNVIQueue,16); ++ break; ++ case 6: ++ case 7: ++ memcpy(PNOut,pWapiStaInfo->lastRxUnicastPNVOQueue,16); ++ break; ++ default: ++ WAPI_TRACE(WAPI_ERR, "%s: Unknown TID \n", __FUNCTION__); ++ break; ++ } ++ WAPI_TRACE(WAPI_RX, "<=========== %s\n", __FUNCTION__); ++} ++ ++ ++void WapiSetLastRxUnicastPNForQoSData( ++ u8 UserPriority, ++ u8 *PNIn, ++ PRT_WAPI_STA_INFO pWapiStaInfo ++) ++{ ++ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); ++ switch(UserPriority) ++ { ++ case 0: ++ case 3: ++ memcpy(pWapiStaInfo->lastRxUnicastPNBEQueue,PNIn,16); ++ break; ++ case 1: ++ case 2: ++ memcpy(pWapiStaInfo->lastRxUnicastPNBKQueue,PNIn,16); ++ break; ++ case 4: ++ case 5: ++ memcpy(pWapiStaInfo->lastRxUnicastPNVIQueue,PNIn,16); ++ break; ++ case 6: ++ case 7: ++ memcpy(pWapiStaInfo->lastRxUnicastPNVOQueue,PNIn,16); ++ break; ++ default: ++ WAPI_TRACE(WAPI_ERR, "%s: Unknown TID \n", __FUNCTION__); ++ break; ++ } ++ WAPI_TRACE(WAPI_RX, "<=========== %s\n", __FUNCTION__); ++} ++ ++ ++/**************************************************************************** ++ false not RX-Reorder ++ true do RX Reorder ++add to support WAPI to N-mode ++*****************************************************************************/ ++u8 WapiCheckPnInSwDecrypt( ++ _adapter *padapter, ++ struct sk_buff *pskb ++) ++{ ++ u8 ret = false; ++ ++#if 0 ++ struct ieee80211_hdr_3addr_qos *header; ++ u16 fc; ++ u8 *pDaddr, *pTaddr, *pRaddr; ++ ++ header = (struct ieee80211_hdr_3addr_qos *)pskb->data; ++ pTaddr = header->addr2; ++ pRaddr = header->addr1; ++ fc = le16_to_cpu(header->frame_ctl); ++ ++ if(GetToDs(&fc)) ++ pDaddr = header->addr3; ++ else ++ pDaddr = header->addr1; ++ ++ if ((_rtw_memcmp(pRaddr, padapter->pnetdev->dev_addr, ETH_ALEN) == 0) ++ && ! (pDaddr) ++ && (GetFrameType(&fc) == WIFI_QOS_DATA_TYPE)) ++ //&& ieee->pHTInfo->bCurrentHTSupport && ++ //ieee->pHTInfo->bCurRxReorderEnable) ++ ret = false; ++ else ++ ret = true; ++#endif ++ WAPI_TRACE(WAPI_RX, "%s: return %d\n", __FUNCTION__, ret); ++ return ret; ++} ++ ++int SecSMS4HeaderFillIV(_adapter *padapter, u8 *pxmitframe) ++{ ++ struct pkt_attrib *pattrib = &((struct xmit_frame*)pxmitframe)->attrib; ++ u8 * frame = ((struct xmit_frame *)pxmitframe)->buf_addr + TXDESC_OFFSET; ++ u8 *pSecHeader = NULL, *pos = NULL, *pRA = NULL; ++ u8 bPNOverflow = false, bFindMatchPeer = false, hdr_len = 0; ++ PWLAN_HEADER_WAPI_EXTENSION pWapiExt = NULL; ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ int ret = 0; ++ ++ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); ++ ++ return ret; ++#if 0 ++ hdr_len = sMacHdrLng; ++ if (GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE) ++ { ++ hdr_len += 2; ++ } ++ //hdr_len += SNAP_SIZE + sizeof(u16); ++ ++ pos = skb_push(pskb, padapter->wapiInfo.extra_prefix_len); ++ memmove(pos, pos+padapter->wapiInfo.extra_prefix_len, hdr_len); ++ ++ pSecHeader = pskb->data + hdr_len; ++ pWapiExt = (PWLAN_HEADER_WAPI_EXTENSION)pSecHeader; ++ pRA = pskb->data + 4; ++ ++ WAPI_DATA(WAPI_TX, "FillIV - Before Fill IV", pskb->data, pskb->len); ++ ++ //Address 1 is always receiver's address ++ if( IS_MCAST(pRA) ){ ++ if(!pWapiInfo->wapiTxMsk.bTxEnable){ ++ WAPI_TRACE(WAPI_ERR,"%s: bTxEnable = 0!!\n",__FUNCTION__); ++ return -2; ++ } ++ if(pWapiInfo->wapiTxMsk.keyId <= 1){ ++ pWapiExt->KeyIdx = pWapiInfo->wapiTxMsk.keyId; ++ pWapiExt->Reserved = 0; ++ bPNOverflow = WapiIncreasePN(pWapiInfo->lastTxMulticastPN, 1); ++ memcpy(pWapiExt->PN, pWapiInfo->lastTxMulticastPN, 16); ++ if (bPNOverflow){ ++ // Update MSK Notification. ++ WAPI_TRACE(WAPI_ERR,"===============>%s():multicast PN overflow\n",__FUNCTION__); ++ rtw_wapi_app_event_handler(padapter,NULL,0,pRA, false, false, true, 0, false); ++ } ++ }else{ ++ WAPI_TRACE(WAPI_ERR,"%s: Invalid Wapi Multicast KeyIdx!!\n",__FUNCTION__); ++ ret = -3; ++ } ++ } ++ else{ ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if(!memcmp(pWapiSta->PeerMacAddr,pRA,6)){ ++ bFindMatchPeer = true; ++ break; ++ } ++ } ++ if (bFindMatchPeer){ ++ if((!pWapiSta->wapiUskUpdate.bTxEnable) && (!pWapiSta->wapiUsk.bTxEnable)){ ++ WAPI_TRACE(WAPI_ERR,"%s: bTxEnable = 0!!\n",__FUNCTION__); ++ return -4; ++ } ++ if (pWapiSta->wapiUsk.keyId <= 1){ ++ if(pWapiSta->wapiUskUpdate.bTxEnable) ++ pWapiExt->KeyIdx = pWapiSta->wapiUskUpdate.keyId; ++ else ++ pWapiExt->KeyIdx = pWapiSta->wapiUsk.keyId; ++ ++ pWapiExt->Reserved = 0; ++ bPNOverflow = WapiIncreasePN(pWapiSta->lastTxUnicastPN, 2); ++ memcpy(pWapiExt->PN, pWapiSta->lastTxUnicastPN, 16); ++ if (bPNOverflow){ ++ // Update USK Notification. ++ WAPI_TRACE(WAPI_ERR,"===============>%s():unicast PN overflow\n",__FUNCTION__); ++ rtw_wapi_app_event_handler(padapter,NULL,0,pWapiSta->PeerMacAddr, false, true, false, 0, false); ++ } ++ }else{ ++ WAPI_TRACE(WAPI_ERR,"%s: Invalid Wapi Unicast KeyIdx!!\n",__FUNCTION__); ++ ret = -5; ++ } ++ } ++ else{ ++ WAPI_TRACE(WAPI_ERR,"%s: Can not find Peer Sta "MAC_FMT"!!\n",__FUNCTION__, MAC_ARG(pRA)); ++ ret = -6; ++ } ++ } ++ ++ WAPI_DATA(WAPI_TX, "FillIV - After Fill IV", pskb->data, pskb->len); ++ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); ++ return ret; ++#endif ++} ++ ++// WAPI SW Enc: must have done Coalesce! ++void SecSWSMS4Encryption( ++ _adapter *padapter, ++ u8 * pxmitframe ++ ) ++{ ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ u8 *pframe = ((struct xmit_frame*)pxmitframe)->buf_addr + TXDESC_SIZE; ++ struct pkt_attrib *pattrib = &((struct xmit_frame*)pxmitframe)->attrib; ++ ++ u8 *SecPtr = NULL, *pRA, *pMicKey = NULL, *pDataKey = NULL, *pIV = NULL; ++ u8 IVOffset, DataOffset, bFindMatchPeer = false, KeyIdx = 0, MicBuffer[16]; ++ u16 OutputLength; ++ ++ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); ++ ++ WAPI_TRACE(WAPI_TX,"hdrlen: %d \n",pattrib->hdrlen); ++ ++ return; ++ ++ DataOffset = pattrib->hdrlen + pattrib->iv_len; ++ ++ pRA = pframe + 4; ++ ++ ++ if( IS_MCAST(pRA) ){ ++ KeyIdx = pWapiInfo->wapiTxMsk.keyId; ++ pIV = pWapiInfo->lastTxMulticastPN; ++ pMicKey = pWapiInfo->wapiTxMsk.micKey; ++ pDataKey = pWapiInfo->wapiTxMsk.dataKey; ++ }else{ ++ if (!list_empty(&(pWapiInfo->wapiSTAUsedList))){ ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if (0 == memcmp(pWapiSta->PeerMacAddr, pRA, 6)){ ++ bFindMatchPeer = true; ++ break; ++ } ++ } ++ ++ if (bFindMatchPeer){ ++ if (pWapiSta->wapiUskUpdate.bTxEnable){ ++ KeyIdx = pWapiSta->wapiUskUpdate.keyId; ++ WAPI_TRACE(WAPI_TX, "%s(): Use update USK!! KeyIdx=%d\n", __FUNCTION__, KeyIdx); ++ pIV = pWapiSta->lastTxUnicastPN; ++ pMicKey = pWapiSta->wapiUskUpdate.micKey; ++ pDataKey = pWapiSta->wapiUskUpdate.dataKey; ++ }else{ ++ KeyIdx = pWapiSta->wapiUsk.keyId; ++ WAPI_TRACE(WAPI_TX, "%s(): Use USK!! KeyIdx=%d\n", __FUNCTION__, KeyIdx); ++ pIV = pWapiSta->lastTxUnicastPN; ++ pMicKey = pWapiSta->wapiUsk.micKey; ++ pDataKey = pWapiSta->wapiUsk.dataKey; ++ } ++ }else{ ++ WAPI_TRACE(WAPI_ERR,"%s: Can not find Peer Sta!!\n",__FUNCTION__); ++ return; ++ } ++ }else{ ++ WAPI_TRACE(WAPI_ERR,"%s: wapiSTAUsedList is empty!!\n",__FUNCTION__); ++ return; ++ } ++ } ++ ++ SecPtr = pframe; ++ SecCalculateMicSMS4(KeyIdx, pMicKey, SecPtr, (SecPtr+DataOffset), pattrib->pktlen, MicBuffer); ++ ++ WAPI_DATA(WAPI_TX, "Encryption - MIC", MicBuffer, padapter->wapiInfo.extra_postfix_len); ++ ++ memcpy(pframe+pattrib->hdrlen+pattrib->iv_len+pattrib->pktlen-pattrib->icv_len, ++ (u8 *)MicBuffer, ++ padapter->wapiInfo.extra_postfix_len ++ ); ++ ++ ++ WapiSMS4Encryption(pDataKey, pIV, (SecPtr+DataOffset),pattrib->pktlen+pattrib->icv_len, (SecPtr+DataOffset), &OutputLength); ++ ++ WAPI_DATA(WAPI_TX, "Encryption - After SMS4 encryption",pframe,pattrib->hdrlen+pattrib->iv_len+pattrib->pktlen); ++ ++ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); ++} ++ ++u8 SecSWSMS4Decryption( ++ _adapter *padapter, ++ u8 *precv_frame, ++ struct recv_priv *precv_priv ++ ) ++{ ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ struct recv_frame_hdr *precv_hdr; ++ PRT_WAPI_STA_INFO pWapiSta = NULL; ++ u8 IVOffset, DataOffset, bFindMatchPeer = false, bUseUpdatedKey = false; ++ u8 KeyIdx, MicBuffer[16], lastRxPNforQoS[16]; ++ u8 *pRA, *pTA, *pMicKey, *pDataKey, *pLastRxPN, *pRecvPN, *pSecData, *pRecvMic, *pos; ++ u8 TID = 0; ++ u16 OutputLength, DataLen; ++ u8 bQosData; ++ struct sk_buff * pskb; ++ ++ WAPI_TRACE(WAPI_RX, "=========>%s\n", __FUNCTION__); ++ ++ return 0; ++ ++ precv_hdr = &((union recv_frame*)precv_frame)->u.hdr; ++ pskb = (struct sk_buff *)(precv_hdr->rx_data); ++ precv_hdr->bWapiCheckPNInDecrypt = WapiCheckPnInSwDecrypt(padapter, pskb); ++ WAPI_TRACE(WAPI_RX, "=========>%s: check PN %d\n", __FUNCTION__,precv_hdr->bWapiCheckPNInDecrypt); ++ WAPI_DATA(WAPI_RX, "Decryption - Before decryption", pskb->data, pskb->len); ++ ++ IVOffset = sMacHdrLng; ++ bQosData = GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE; ++ if (bQosData){ ++ IVOffset += 2; ++ } ++ ++ //if(GetHTC()) ++ // IVOffset += 4; ++ ++ //IVOffset += SNAP_SIZE + sizeof(u16); ++ ++ DataOffset = IVOffset + padapter->wapiInfo.extra_prefix_len; ++ ++ pRA = pskb->data + 4; ++ pTA = pskb->data + 10; ++ KeyIdx = *(pskb->data + IVOffset); ++ pRecvPN = pskb->data + IVOffset + 2; ++ pSecData = pskb->data + DataOffset; ++ DataLen = pskb->len - DataOffset; ++ pRecvMic = pskb->data + pskb->len - padapter->wapiInfo.extra_postfix_len; ++ TID = GetTid(pskb->data); ++ ++ if (!list_empty(&(pWapiInfo->wapiSTAUsedList))){ ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if (0 == memcmp(pWapiSta->PeerMacAddr, pTA, 6)){ ++ bFindMatchPeer = true; ++ break; ++ } ++ } ++ } ++ ++ if (!bFindMatchPeer){ ++ WAPI_TRACE(WAPI_ERR, "%s: Can not find Peer Sta "MAC_FMT" for Key Info!!!\n", __FUNCTION__, MAC_ARG(pTA)); ++ return false; ++ } ++ ++ if( IS_MCAST(pRA) ){ ++ WAPI_TRACE(WAPI_RX, "%s: Multicast decryption !!!\n", __FUNCTION__); ++ if (pWapiSta->wapiMsk.keyId == KeyIdx && pWapiSta->wapiMsk.bSet){ ++ pLastRxPN = pWapiSta->lastRxMulticastPN; ++ if (!WapiComparePN(pRecvPN, pLastRxPN)){ ++ WAPI_TRACE(WAPI_ERR, "%s: MSK PN is not larger than last, Dropped!!!\n", __FUNCTION__); ++ WAPI_DATA(WAPI_ERR, "pRecvPN:", pRecvPN, 16); ++ WAPI_DATA(WAPI_ERR, "pLastRxPN:", pLastRxPN, 16); ++ return false; ++ } ++ ++ memcpy(pLastRxPN, pRecvPN, 16); ++ pMicKey = pWapiSta->wapiMsk.micKey; ++ pDataKey = pWapiSta->wapiMsk.dataKey; ++ }else if (pWapiSta->wapiMskUpdate.keyId == KeyIdx && pWapiSta->wapiMskUpdate.bSet){ ++ WAPI_TRACE(WAPI_RX, "%s: Use Updated MSK for Decryption !!!\n", __FUNCTION__); ++ bUseUpdatedKey = true; ++ memcpy(pWapiSta->lastRxMulticastPN, pRecvPN, 16); ++ pMicKey = pWapiSta->wapiMskUpdate.micKey; ++ pDataKey = pWapiSta->wapiMskUpdate.dataKey; ++ }else{ ++ WAPI_TRACE(WAPI_ERR, "%s: Can not find MSK with matched KeyIdx(%d), Dropped !!!\n", __FUNCTION__,KeyIdx); ++ return false; ++ } ++ } ++ else{ ++ WAPI_TRACE(WAPI_RX, "%s: Unicast decryption !!!\n", __FUNCTION__); ++ if (pWapiSta->wapiUsk.keyId == KeyIdx && pWapiSta->wapiUsk.bSet){ ++ WAPI_TRACE(WAPI_RX, "%s: Use USK for Decryption!!!\n", __FUNCTION__); ++ if(precv_hdr->bWapiCheckPNInDecrypt){ ++ if(GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE){ ++ WapiGetLastRxUnicastPNForQoSData(TID, pWapiSta, lastRxPNforQoS); ++ pLastRxPN = lastRxPNforQoS; ++ }else{ ++ pLastRxPN = pWapiSta->lastRxUnicastPN; ++ } ++ if (!WapiComparePN(pRecvPN, pLastRxPN)){ ++ return false; ++ } ++ if(bQosData){ ++ WapiSetLastRxUnicastPNForQoSData(TID, pRecvPN, pWapiSta); ++ }else{ ++ memcpy(pWapiSta->lastRxUnicastPN, pRecvPN, 16); ++ } ++ }else{ ++ memcpy(precv_hdr->WapiTempPN,pRecvPN,16); ++ } ++ ++ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE)) ++ { ++ if ((pRecvPN[0] & 0x1) == 0){ ++ WAPI_TRACE(WAPI_ERR, "%s: Rx USK PN is not odd when Infra STA mode, Dropped !!!\n", __FUNCTION__); ++ return false; ++ } ++ } ++ ++ pMicKey = pWapiSta->wapiUsk.micKey; ++ pDataKey = pWapiSta->wapiUsk.dataKey; ++ } ++ else if (pWapiSta->wapiUskUpdate.keyId == KeyIdx && pWapiSta->wapiUskUpdate.bSet ){ ++ WAPI_TRACE(WAPI_RX, "%s: Use Updated USK for Decryption!!!\n", __FUNCTION__); ++ if(pWapiSta->bAuthenticatorInUpdata) ++ bUseUpdatedKey = true; ++ else ++ bUseUpdatedKey = false; ++ ++ if(bQosData){ ++ WapiSetLastRxUnicastPNForQoSData(TID, pRecvPN, pWapiSta); ++ }else{ ++ memcpy(pWapiSta->lastRxUnicastPN, pRecvPN, 16); ++ } ++ pMicKey = pWapiSta->wapiUskUpdate.micKey; ++ pDataKey = pWapiSta->wapiUskUpdate.dataKey; ++ }else{ ++ WAPI_TRACE(WAPI_ERR, "%s: No valid USK!!!KeyIdx=%d pWapiSta->wapiUsk.keyId=%d pWapiSta->wapiUskUpdate.keyId=%d\n", __FUNCTION__, KeyIdx, pWapiSta->wapiUsk.keyId, pWapiSta->wapiUskUpdate.keyId); ++ //dump_buf(pskb->data,pskb->len); ++ return false; ++ } ++ } ++ ++ WAPI_DATA(WAPI_RX, "Decryption - DataKey", pDataKey, 16); ++ WAPI_DATA(WAPI_RX, "Decryption - IV", pRecvPN, 16); ++ WapiSMS4Decryption(pDataKey, pRecvPN, pSecData, DataLen, pSecData, &OutputLength); ++ ++ if (OutputLength != DataLen) ++ WAPI_TRACE(WAPI_ERR, "%s: Output Length Error!!!!\n", __FUNCTION__); ++ ++ WAPI_DATA(WAPI_RX, "Decryption - After decryption", pskb->data, pskb->len); ++ ++ DataLen -= padapter->wapiInfo.extra_postfix_len; ++ ++ SecCalculateMicSMS4(KeyIdx, pMicKey, pskb->data, pSecData, DataLen, MicBuffer); ++ ++ WAPI_DATA(WAPI_RX, "Decryption - MIC received", pRecvMic, SMS4_MIC_LEN); ++ WAPI_DATA(WAPI_RX, "Decryption - MIC calculated", MicBuffer, SMS4_MIC_LEN); ++ ++ if (0 == memcmp(MicBuffer, pRecvMic, padapter->wapiInfo.extra_postfix_len)){ ++ WAPI_TRACE(WAPI_RX, "%s: Check MIC OK!!\n", __FUNCTION__); ++ if (bUseUpdatedKey){ ++ // delete the old key ++ if ( IS_MCAST(pRA) ){ ++ WAPI_TRACE(WAPI_API, "%s(): AE use new update MSK!!\n", __FUNCTION__); ++ pWapiSta->wapiMsk.keyId = pWapiSta->wapiMskUpdate.keyId; ++ memcpy(pWapiSta->wapiMsk.dataKey, pWapiSta->wapiMskUpdate.dataKey, 16); ++ memcpy(pWapiSta->wapiMsk.micKey, pWapiSta->wapiMskUpdate.micKey, 16); ++ pWapiSta->wapiMskUpdate.bTxEnable = pWapiSta->wapiMskUpdate.bSet = false; ++ }else{ ++ WAPI_TRACE(WAPI_API, "%s(): AE use new update USK!!\n", __FUNCTION__); ++ pWapiSta->wapiUsk.keyId = pWapiSta->wapiUskUpdate.keyId; ++ memcpy(pWapiSta->wapiUsk.dataKey, pWapiSta->wapiUskUpdate.dataKey, 16); ++ memcpy(pWapiSta->wapiUsk.micKey, pWapiSta->wapiUskUpdate.micKey, 16); ++ pWapiSta->wapiUskUpdate.bTxEnable = pWapiSta->wapiUskUpdate.bSet = false; ++ } ++ } ++ }else{ ++ WAPI_TRACE(WAPI_ERR, "%s: Check MIC Error, Dropped !!!!\n", __FUNCTION__); ++ return false; ++ } ++ ++ pos = pskb->data; ++ memmove(pos+padapter->wapiInfo.extra_prefix_len, pos, IVOffset); ++ skb_pull(pskb, padapter->wapiInfo.extra_prefix_len); ++ ++ WAPI_TRACE(WAPI_RX, "<=========%s\n", __FUNCTION__); ++ ++ return true; ++} ++ ++u32 rtw_sms4_encrypt(_adapter *padapter, u8 *pxmitframe) ++{ ++ ++ u8 *pframe; ++ u32 res = _SUCCESS; ++ ++ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_TX, "<========== %s, WAPI not supported or enabled!\n", __FUNCTION__); ++ return _FAIL; ++ } ++ ++ if(((struct xmit_frame*)pxmitframe)->buf_addr==NULL) ++ return _FAIL; ++ ++ pframe = ((struct xmit_frame*)pxmitframe)->buf_addr + TXDESC_OFFSET; ++ ++ SecSWSMS4Encryption(padapter, pxmitframe); ++ ++ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); ++ return res; ++} ++ ++u32 rtw_sms4_decrypt(_adapter *padapter, u8 *precvframe) ++{ ++ u8 *pframe; ++ u32 res = _SUCCESS; ++ ++ WAPI_TRACE(WAPI_RX, "=========>%s\n", __FUNCTION__); ++ ++ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) ++ { ++ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or enabled!\n", __FUNCTION__); ++ return _FAIL; ++ } ++ ++ ++ //drop packet when hw decrypt fail ++ //return tempraily ++ return _FAIL; ++ ++ //pframe=(unsigned char *)((union recv_frame*)precvframe)->u.hdr.rx_data; ++ ++ if (false == SecSWSMS4Decryption(padapter, precvframe, &padapter->recvpriv)) ++ { ++ WAPI_TRACE(WAPI_ERR, "%s():SMS4 decrypt frame error\n",__FUNCTION__); ++ return _FAIL; ++ } ++ ++ WAPI_TRACE(WAPI_RX, "<=========%s\n", __FUNCTION__); ++ return res; ++} ++ ++#else ++ ++u32 rtw_sms4_encrypt(_adapter *padapter, u8 *pxmitframe) ++{ ++ WAPI_TRACE(WAPI_TX, "=========>Dummy %s\n", __FUNCTION__); ++ WAPI_TRACE(WAPI_TX, "<=========Dummy %s\n", __FUNCTION__); ++ return _SUCCESS; ++} ++ ++u32 rtw_sms4_decrypt(_adapter *padapter, u8 *precvframe) ++{ ++ WAPI_TRACE(WAPI_RX, "=========>Dummy %s\n", __FUNCTION__); ++ WAPI_TRACE(WAPI_RX, "<=========Dummy %s\n", __FUNCTION__); ++ return _SUCCESS; ++} ++ ++#endif ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_wlan_util.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_wlan_util.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_wlan_util.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_wlan_util.c 2018-02-06 17:42:30.701967031 +0200 +@@ -0,0 +1,2797 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -77944,39 +56238,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_WLAN_UTIL_C_ + +#include ++#include "rtw_mlme.h" + -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+#include -+#endif ++static unsigned char ARTHEROS_OUI1[] = {0x00, 0x03, 0x7f}; ++static unsigned char ARTHEROS_OUI2[] = {0x00, 0x13, 0x74}; + -+unsigned char ARTHEROS_OUI1[] = {0x00, 0x03, 0x7f}; -+unsigned char ARTHEROS_OUI2[] = {0x00, 0x13, 0x74}; ++static unsigned char BROADCOM_OUI1[] = {0x00, 0x10, 0x18}; ++static unsigned char BROADCOM_OUI2[] = {0x00, 0x0a, 0xf7}; ++static unsigned char BROADCOM_OUI3[] = {0x00, 0x05, 0xb5}; + -+unsigned char BROADCOM_OUI1[] = {0x00, 0x10, 0x18}; -+unsigned char BROADCOM_OUI2[] = {0x00, 0x0a, 0xf7}; -+unsigned char BROADCOM_OUI3[] = {0x00, 0x05, 0xb5}; -+ -+ -+unsigned char CISCO_OUI[] = {0x00, 0x40, 0x96}; -+unsigned char MARVELL_OUI[] = {0x00, 0x50, 0x43}; -+unsigned char RALINK_OUI[] = {0x00, 0x0c, 0x43}; -+unsigned char REALTEK_OUI[] = {0x00, 0xe0, 0x4c}; -+unsigned char AIRGOCAP_OUI[] = {0x00, 0x0a, 0xf5}; -+ -+unsigned char REALTEK_96B_IE[] = {0x00, 0xe0, 0x4c, 0x02, 0x01, 0x20}; ++static unsigned char CISCO_OUI[] = {0x00, 0x40, 0x96}; ++static unsigned char MARVELL_OUI[] = {0x00, 0x50, 0x43}; ++static unsigned char RALINK_OUI[] = {0x00, 0x0c, 0x43}; ++static unsigned char REALTEK_OUI[] = {0x00, 0xe0, 0x4c}; ++static unsigned char AIRGOCAP_OUI[] = {0x00, 0x0a, 0xf5}; + +extern unsigned char RTW_WPA_OUI[]; -+extern unsigned char WPA_TKIP_CIPHER[4]; -+extern unsigned char RSN_TKIP_CIPHER[4]; + +#define R2T_PHY_DELAY (0) + @@ -77984,9 +56265,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 +#define WAIT_FOR_BCN_TO_MIN (6000) +#define WAIT_FOR_BCN_TO_MAX (20000) + -+#define DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS 1000 -+#define DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD 3 -+ +static u8 rtw_basic_rate_cck[4] = { + IEEE80211_CCK_RATE_1MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_2MB|IEEE80211_BASIC_RATE_MASK, + IEEE80211_CCK_RATE_5MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_11MB|IEEE80211_BASIC_RATE_MASK @@ -78004,118 +56282,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + IEEE80211_OFDM_RATE_24MB|IEEE80211_BASIC_RATE_MASK +}; + -+int new_bcn_max = 3; + +int cckrates_included(unsigned char *rate, int ratelen) +{ + int i; -+ ++ + for(i = 0; i < ratelen; i++) + { + if ( (((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || + (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22) ) -+ return _TRUE; ++ return true; + } + -+ return _FALSE; ++ return false; + +} + +int cckratesonly_included(unsigned char *rate, int ratelen) +{ + int i; -+ ++ + for(i = 0; i < ratelen; i++) + { + if ( (((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && + (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22) ) -+ return _FALSE; ++ return false; + } -+ -+ return _TRUE; ++ ++ return true; +} + -+s8 rtw_get_tx_nss(_adapter *adapter, struct sta_info *psta) -+{ -+ u8 rf_type = RF_1T1R, custom_rf_type, vht_mcs[2]; -+ s8 nss = 1; -+ -+ custom_rf_type = adapter->registrypriv.rf_config; -+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ if (!psta) -+ return nss; -+ -+ /* rf_config is dependent on efuse or sw config */ -+ if (custom_rf_type != RF_MAX_TYPE) -+ rf_type = custom_rf_type; -+ -+#ifdef CONFIG_80211AC_VHT -+ if (psta->vhtpriv.vht_option) { -+ u8 vht_mcs[2]; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct vht_priv *pvhtpriv_ap = &pmlmepriv->vhtpriv; -+ -+ _rtw_memcpy(vht_mcs, psta->vhtpriv.vht_mcs_map, 2); -+ /* doesn't support 5~8 SS so far */ -+ vht_mcs[1] = 0xff; -+ switch (rf_type) { -+ case RF_1T1R: -+ case RF_1T2R: -+ vht_mcs[0] |= 0xfc; -+ break; -+ case RF_2T2R: -+ case RF_2T4R: -+ case RF_2T2R_GREEN: -+ case RF_2T3R: -+ vht_mcs[0] |= 0xf0; -+ break; -+ case RF_3T3R: -+ case RF_3T4R: -+ vht_mcs[0] |= 0xc0; -+ break; -+ default: -+ DBG_871X("%s,%d, unknown rf type\n", __func__, __LINE__); -+ break; -+ } -+ nss = rtw_vht_mcsmap_to_nss(vht_mcs); -+ } else -+#endif /* CONFIG_80211AC_VHT */ -+ if (psta->htpriv.ht_option) { -+ u8 supp_mcs_set[4]; -+ -+ _rtw_memcpy(supp_mcs_set, psta->htpriv.ht_cap.supp_mcs_set, 4); -+ -+ switch (rf_type) { -+ case RF_1T1R: -+ case RF_1T2R: -+ supp_mcs_set[1] = supp_mcs_set[2] = supp_mcs_set[3] = 0; -+ break; -+ case RF_2T2R: -+ case RF_2T4R: -+ case RF_2T2R_GREEN: -+ case RF_2T3R: -+ supp_mcs_set[2] = supp_mcs_set[3] = 0; -+ break; -+ case RF_3T3R: -+ case RF_3T4R: -+ supp_mcs_set[3] = 0; -+ break; -+ default: -+ DBG_871X("%s,%d, unknown rf type\n", __func__, __LINE__); -+ break; -+ } -+ nss = rtw_ht_mcsset_to_nss(supp_mcs_set); -+ } -+ -+ DBG_871X("%s: %d SS, rf_type=%d\n", __func__, nss, rf_type); -+ return nss; -+} -+ -+u8 networktype_to_raid(_adapter *adapter,struct sta_info *psta) ++u8 networktype_to_raid(_adapter *adapter,unsigned char network_type) +{ + unsigned char raid; -+ switch(psta->wireless_mode) ++ switch(network_type) + { + case WIRELESS_11B: + raid = RATR_INX_WIRELESS_B; @@ -78140,22 +56340,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + break; + default: + raid = RATR_INX_WIRELESS_GB; -+ break; ++ break; + + } + return raid; -+ ++ +} + -+u8 networktype_to_raid_ex(_adapter *adapter, struct sta_info *psta) ++u8 networktype_to_raid_ex(_adapter *adapter,unsigned char network_type) +{ + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ u8 raid = RATEID_IDX_BGN_40M_1SS, cur_rf_type, rf_type, custom_rf_type; -+ s8 tx_nss; ++ u8 raid, rf_type; + -+ tx_nss = rtw_get_tx_nss(adapter, psta); ++ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); + -+ switch(psta->wireless_mode) ++ switch(network_type) + { + case WIRELESS_11B: + raid = RATEID_IDX_B; @@ -78171,83 +56370,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + case WIRELESS_11_5N: + case WIRELESS_11A_5N: + case WIRELESS_11G_24N: -+ if (tx_nss == 1) -+ raid = RATEID_IDX_GN_N1SS; -+ else if (tx_nss == 2) ++ if (rf_type == 2) + raid = RATEID_IDX_GN_N2SS; -+ else if (tx_nss == 3) -+ raid = RATEID_IDX_BGN_3SS; + else -+ DBG_871X("tx_nss error!(tx_nss=%d)\n", tx_nss); ++ raid = RATEID_IDX_GN_N1SS; + break; + case WIRELESS_11B_24N: + case WIRELESS_11BG_24N: -+ if (psta->bw_mode == CHANNEL_WIDTH_20) { -+ if (tx_nss == 1) -+ raid = RATEID_IDX_BGN_20M_1SS_BN; -+ else if (tx_nss == 2) ++ if (pmlmeext->cur_bwmode == CHANNEL_WIDTH_20) { ++ if (rf_type == RF_2T2R) + raid = RATEID_IDX_BGN_20M_2SS_BN; -+ else if (tx_nss == 3) -+ raid = RATEID_IDX_BGN_3SS; + else -+ DBG_871X("tx_nss error!(tx_nss=%d)\n", tx_nss); ++ raid = RATEID_IDX_BGN_20M_1SS_BN; + } else { -+ if (tx_nss == 1) -+ raid = RATEID_IDX_BGN_40M_1SS; -+ else if (tx_nss == 2) ++ if (rf_type == RF_2T2R) + raid = RATEID_IDX_BGN_40M_2SS; -+ else if (tx_nss == 3) -+ raid = RATEID_IDX_BGN_3SS; + else -+ DBG_871X("tx_nss error!(tx_nss=%d)\n", tx_nss); ++ raid = RATEID_IDX_BGN_40M_1SS; + } + break; +#ifdef CONFIG_80211AC_VHT + case WIRELESS_11_5AC: -+ if (tx_nss == 1) -+ raid = RATEID_IDX_VHT_1SS; -+ else if (tx_nss == 2) -+ raid = RATEID_IDX_VHT_2SS; -+ else if (tx_nss == 3) -+ raid = RATEID_IDX_VHT_3SS; -+ else -+ DBG_871X("tx_nss error!(tx_nss=%d)\n", tx_nss); -+ break; + case WIRELESS_11_24AC: -+ if (psta->bw_mode >= CHANNEL_WIDTH_80) -+ { -+ if (tx_nss == 1) -+ raid = RATEID_IDX_VHT_1SS; -+ else if (tx_nss == 2) -+ raid = RATEID_IDX_VHT_2SS; -+ else if (tx_nss == 3) -+ raid = RATEID_IDX_VHT_3SS; -+ else -+ DBG_871X("tx_nss error!(tx_nss=%d)\n", tx_nss); -+ } ++ if ((rf_type == RF_1T1R) || (adapter->mlmepriv.vhtpriv.vht_highest_rate <= MGN_VHT1SS_MCS9)) ++ raid = RATEID_IDX_VHT_1SS; + else -+ { -+ if (tx_nss == 1) -+ raid = RATEID_IDX_MIX1; -+ else if (tx_nss == 2) -+ raid = RATEID_IDX_MIX2; -+ else if (tx_nss == 3) -+ raid = RATEID_IDX_VHT_3SS; -+ else -+ DBG_871X("tx_nss error!(tx_nss=%d)\n", tx_nss); -+ } ++ raid = RATEID_IDX_VHT_2SS; + break; +#endif + default: -+ DBG_871X("unexpected wireless mode!(psta->wireless_mode=%x)\n", psta->wireless_mode); -+ break; ++ raid = RATEID_IDX_BGN_40M_2SS; ++ break; + + } -+ -+ /* DBG_871X("psta->wireless_mode=%x, tx_nss=%d\n", psta->wireless_mode, tx_nss); */ -+ + return raid; -+ ++ +} + +u8 judge_network_type(_adapter *padapter, unsigned char *rate, int ratelen) @@ -78255,7 +56412,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + u8 network_type = 0; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ ++ + + if(pmlmeext->cur_channel > 14) + { @@ -78273,11 +56430,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + network_type = WIRELESS_11_24N; + } + -+ if ((cckratesonly_included(rate, ratelen)) == _TRUE) ++ if ((cckratesonly_included(rate, ratelen)) == true) + { + network_type |= WIRELESS_11B; + } -+ else if((cckrates_included(rate, ratelen)) == _TRUE) ++ else if((cckrates_included(rate, ratelen)) == true) + { + network_type |= WIRELESS_11BG; + } @@ -78286,8 +56443,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + network_type |= WIRELESS_11G; + } + } -+ -+ return network_type; ++ ++ return network_type; +} + +unsigned char ratetbl_val_2wifirate(unsigned char rate); @@ -78295,7 +56452,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 +{ + unsigned char val = 0; + -+ switch (rate & 0x7f) ++ switch (rate & 0x7f) + { + case 0: + val = IEEE80211_CCK_RATE_1MB; @@ -78312,7 +56469,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + case 3: + val = IEEE80211_CCK_RATE_11MB; + break; -+ ++ + case 4: + val = IEEE80211_OFDM_RATE_6MB; + break; @@ -78324,7 +56481,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + case 6: + val = IEEE80211_OFDM_RATE_12MB; + break; -+ ++ + case 7: + val = IEEE80211_OFDM_RATE_18MB; + break; @@ -78332,7 +56489,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + case 8: + val = IEEE80211_OFDM_RATE_24MB; + break; -+ ++ + case 9: + val = IEEE80211_OFDM_RATE_36MB; + break; @@ -78340,7 +56497,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + case 10: + val = IEEE80211_OFDM_RATE_48MB; + break; -+ ++ + case 11: + val = IEEE80211_OFDM_RATE_54MB; + break; @@ -78357,7 +56514,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + int i; + unsigned char val; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ ++ + for(i = 0; i < NumRates; i++) + { + val = pmlmeext->basicrate[i]; @@ -78366,12 +56523,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + { + if (rate == ratetbl_val_2wifirate(val)) + { -+ return _TRUE; ++ return true; + } + } + } -+ -+ return _FALSE; ++ ++ return false; +} + +unsigned int ratetbl2rateset(_adapter *padapter, unsigned char *rateset); @@ -78390,18 +56547,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + { + case 0xff: + return len; -+ ++ + case 0xfe: + continue; -+ ++ + default: + rate = ratetbl_val_2wifirate(rate); + -+ if (is_basicrate(padapter, rate) == _TRUE) ++ if (is_basicrate(padapter, rate) == true) + { + rate |= IEEE80211_BASIC_RATE_MASK; + } -+ ++ + rateset[len] = rate; + len++; + break; @@ -78419,22 +56576,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + _rtw_memcpy(pbssrate, supportedrates, *bssrate_len); +} + -+void set_mcs_rate_by_mask(u8 *mcs_set, u32 mask) -+{ -+ u8 mcs_rate_1r = (u8)(mask&0xff); -+ u8 mcs_rate_2r = (u8)((mask>>8)&0xff); -+ u8 mcs_rate_3r = (u8)((mask>>16)&0xff); -+ u8 mcs_rate_4r = (u8)((mask>>24)&0xff); -+ -+ mcs_set[0] &= mcs_rate_1r; -+ mcs_set[1] &= mcs_rate_2r; -+ mcs_set[2] &= mcs_rate_3r; -+ mcs_set[3] &= mcs_rate_4r; -+} -+ +void UpdateBrateTbl( -+ IN PADAPTER Adapter, -+ IN u8 *mBratesOS ++ PADAPTER Adapter, ++ u8 *mBratesOS +) +{ + u8 i; @@ -78480,6 +56624,72 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + } + +} ++ ++void Save_DM_Func_Flag(_adapter *padapter) ++{ ++ u8 bSaveFlag = true; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; ++ if(pbuddy_adapter) ++ rtw_hal_set_hwreg(pbuddy_adapter, HW_VAR_DM_FUNC_OP, (u8 *)(&bSaveFlag)); ++#endif ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_OP, (u8 *)(&bSaveFlag)); ++ ++} ++ ++void Restore_DM_Func_Flag(_adapter *padapter) ++{ ++ u8 bSaveFlag = false; ++#ifdef CONFIG_CONCURRENT_MODE ++ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; ++ if(pbuddy_adapter) ++ rtw_hal_set_hwreg(pbuddy_adapter, HW_VAR_DM_FUNC_OP, (u8 *)(&bSaveFlag)); ++#endif ++ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_OP, (u8 *)(&bSaveFlag)); ++} ++ ++void Switch_DM_Func(_adapter *padapter, u32 mode, u8 enable) ++{ ++#ifdef CONFIG_CONCURRENT_MODE ++ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; ++#endif ++ ++ if(enable == true) ++ { ++#ifdef CONFIG_CONCURRENT_MODE ++ if(pbuddy_adapter) ++ rtw_hal_set_hwreg(pbuddy_adapter, HW_VAR_DM_FUNC_SET, (u8 *)(&mode)); ++#endif ++ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_SET, (u8 *)(&mode)); ++ } ++ else ++ { ++#ifdef CONFIG_CONCURRENT_MODE ++ if(pbuddy_adapter) ++ rtw_hal_set_hwreg(pbuddy_adapter, HW_VAR_DM_FUNC_CLR, (u8 *)(&mode)); ++#endif ++ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_CLR, (u8 *)(&mode)); ++ } ++ ++#if 0 ++ u8 val8; ++ ++ val8 = rtw_read8(padapter, FW_DYNAMIC_FUN_SWITCH); ++ ++ if(enable == true) ++ { ++ rtw_write8(padapter, FW_DYNAMIC_FUN_SWITCH, (val8 | mode)); ++ } ++ else ++ { ++ rtw_write8(padapter, FW_DYNAMIC_FUN_SWITCH, (val8 & mode)); ++ } ++#endif ++ ++} ++ +static void Set_NETYPE1_MSR(_adapter *padapter, u8 type) +{ + rtw_hal_set_hwreg(padapter, HW_VAR_MEDIA_STATUS1, (u8 *)(&type)); @@ -78511,39 +56721,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + +inline void rtw_set_oper_ch(_adapter *adapter, u8 ch) +{ -+#ifdef DBG_CH_SWITCH -+ const int len = 128; -+ char msg[128] = {0}; -+ int cnt = 0; -+ int i = 0; -+#endif /* DBG_CH_SWITCH */ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ if (dvobj->oper_channel != ch) { -+ dvobj->on_oper_ch_time = rtw_get_current_time(); -+ -+#ifdef DBG_CH_SWITCH -+ cnt += snprintf(msg+cnt, len-cnt, "switch to ch %3u", ch); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ _adapter *iface = dvobj->padapters[i]; -+ cnt += snprintf(msg+cnt, len-cnt, " ["ADPT_FMT":", ADPT_ARG(iface)); -+ if (iface->mlmeextpriv.cur_channel == ch) -+ cnt += snprintf(msg+cnt, len-cnt, "C"); -+ else -+ cnt += snprintf(msg+cnt, len-cnt, "_"); -+ if (iface->wdinfo.listen_channel == ch && !rtw_p2p_chk_state(&iface->wdinfo, P2P_STATE_NONE)) -+ cnt += snprintf(msg+cnt, len-cnt, "L"); -+ else -+ cnt += snprintf(msg+cnt, len-cnt, "_"); -+ cnt += snprintf(msg+cnt, len-cnt, "]"); -+ } -+ -+ DBG_871X(FUNC_ADPT_FMT" %s\n", FUNC_ADPT_ARG(adapter), msg); -+#endif /* DBG_CH_SWITCH */ -+ } -+ -+ dvobj->oper_channel = ch; ++ adapter_to_dvobj(adapter)->oper_channel = ch; +} + +inline u8 rtw_get_oper_bw(_adapter *adapter) @@ -78566,59 +56744,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + adapter_to_dvobj(adapter)->oper_ch_offset = offset; +} + -+u8 rtw_get_offset_by_ch(u8 channel) -+{ -+ u8 offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if(channel>=1 && channel<=4) -+ { -+ offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ } -+ else if(channel>=5 && channel<=14) -+ { -+ offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ } -+ else -+ { -+ switch(channel) -+ { -+ case 36: -+ case 44: -+ case 52: -+ case 60: -+ case 100: -+ case 108: -+ case 116: -+ case 124: -+ case 132: -+ case 149: -+ case 157: -+ offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ case 40: -+ case 48: -+ case 56: -+ case 64: -+ case 104: -+ case 112: -+ case 120: -+ case 128: -+ case 136: -+ case 153: -+ case 161: -+ offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ default: -+ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ -+ } -+ -+ return offset; -+ -+} -+ +u8 rtw_get_center_ch(u8 channel, u8 chnl_bw, u8 chnl_offset) +{ + u8 center_ch = channel; @@ -78651,101 +56776,50 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + return center_ch; +} + -+inline u32 rtw_get_on_oper_ch_time(_adapter *adapter) -+{ -+ return adapter_to_dvobj(adapter)->on_oper_ch_time; -+} -+ -+inline u32 rtw_get_on_cur_ch_time(_adapter *adapter) -+{ -+ if (adapter->mlmeextpriv.cur_channel == adapter_to_dvobj(adapter)->oper_channel) -+ return adapter_to_dvobj(adapter)->on_oper_ch_time; -+ else -+ return 0; -+} -+ +void SelectChannel(_adapter *padapter, unsigned char channel) +{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ //saved channel info ++ rtw_set_oper_ch(padapter, channel); ++ dc_SelectChannel(padapter, channel); ++#else //CONFIG_DUALMAC_CONCURRENT + + _enter_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); + -+#ifdef CONFIG_DFS_MASTER -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ bool ori_overlap_radar_detect_ch = rtw_rfctl_overlap_radar_detect_ch(rfctl); -+ bool new_overlap_radar_detect_ch = _rtw_rfctl_overlap_radar_detect_ch(rfctl, channel -+ , adapter_to_dvobj(padapter)->oper_bwmode, adapter_to_dvobj(padapter)->oper_ch_offset); -+ -+ if (!ori_overlap_radar_detect_ch && new_overlap_radar_detect_ch) -+ rtw_odm_radar_detect_enable(padapter); -+ -+ if (new_overlap_radar_detect_ch && IS_UNDER_CAC(rfctl)) { -+ u8 pause = 0xFF; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &pause); -+ } -+#endif /* CONFIG_DFS_MASTER */ -+ + //saved channel info + rtw_set_oper_ch(padapter, channel); + + rtw_hal_set_chan(padapter, channel); + -+#ifdef CONFIG_DFS_MASTER -+ if (ori_overlap_radar_detect_ch && !new_overlap_radar_detect_ch) { -+ u8 pause = 0x00; -+ -+ rtw_odm_radar_detect_disable(padapter); -+ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &pause); -+ } -+} -+#endif /* CONFIG_DFS_MASTER */ -+ + _exit_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); -+ ++ ++#endif // CONFIG_DUALMAC_CONCURRENT +} + +void SetBWMode(_adapter *padapter, unsigned short bwmode, unsigned char channel_offset) +{ + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ //saved bw info ++ rtw_set_oper_bw(padapter, bwmode); ++ rtw_set_oper_choffset(padapter, channel_offset); ++ dc_SetBWMode(padapter, bwmode, channel_offset); ++#else //CONFIG_DUALMAC_CONCURRENT ++ + _enter_critical_mutex(&(adapter_to_dvobj(padapter)->setbw_mutex), NULL); + -+#ifdef CONFIG_DFS_MASTER -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ bool ori_overlap_radar_detect_ch = rtw_rfctl_overlap_radar_detect_ch(rfctl); -+ bool new_overlap_radar_detect_ch = _rtw_rfctl_overlap_radar_detect_ch(rfctl -+ , adapter_to_dvobj(padapter)->oper_channel, bwmode, channel_offset); -+ -+ if (!ori_overlap_radar_detect_ch && new_overlap_radar_detect_ch) -+ rtw_odm_radar_detect_enable(padapter); -+ -+ if (new_overlap_radar_detect_ch && IS_UNDER_CAC(rfctl)) { -+ u8 pause = 0xFF; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &pause); -+ } -+#endif /* CONFIG_DFS_MASTER */ -+ + //saved bw info + rtw_set_oper_bw(padapter, bwmode); + rtw_set_oper_choffset(padapter, channel_offset); + + rtw_hal_set_bwmode(padapter, (CHANNEL_WIDTH)bwmode, channel_offset); + -+#ifdef CONFIG_DFS_MASTER -+ if (ori_overlap_radar_detect_ch && !new_overlap_radar_detect_ch) { -+ u8 pause = 0x00; -+ -+ rtw_odm_radar_detect_disable(padapter); -+ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &pause); -+ } -+} -+#endif /* CONFIG_DFS_MASTER */ -+ + _exit_critical_mutex(&(adapter_to_dvobj(padapter)->setbw_mutex), NULL); ++ ++#endif // CONFIG_DUALMAC_CONCURRENT +} + +void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char channel_offset, unsigned short bwmode) @@ -78769,25 +56843,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + else + chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + } -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); -+ -+#ifdef CONFIG_DFS_MASTER -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ bool ori_overlap_radar_detect_ch = rtw_rfctl_overlap_radar_detect_ch(rfctl); -+ bool new_overlap_radar_detect_ch = _rtw_rfctl_overlap_radar_detect_ch(rfctl, channel, bwmode, channel_offset); -+ -+ if (!ori_overlap_radar_detect_ch && new_overlap_radar_detect_ch) -+ rtw_odm_radar_detect_enable(padapter); -+ -+ if (new_overlap_radar_detect_ch && IS_UNDER_CAC(rfctl)) { -+ u8 pause = 0xFF; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &pause); -+ } -+#endif /* CONFIG_DFS_MASTER */ + + //set Channel ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ //saved channel/bw info ++ rtw_set_oper_ch(padapter, channel); ++ rtw_set_oper_bw(padapter, bwmode); ++ rtw_set_oper_choffset(padapter, channel_offset); ++ SelectChannel(padapter, channel); ++ SetBWMode(padapter, bwmode, channel_offset); ++#else //CONFIG_DUALMAC_CONCURRENT ++ ++ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); ++ + //saved channel/bw info + rtw_set_oper_ch(padapter, channel); + rtw_set_oper_bw(padapter, bwmode); @@ -78795,17 +56863,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + + rtw_hal_set_chnl_bw(padapter, center_ch, bwmode, channel_offset, chnl_offset80); // set center channel + -+#ifdef CONFIG_DFS_MASTER -+ if (ori_overlap_radar_detect_ch && !new_overlap_radar_detect_ch) { -+ u8 pause = 0x00; -+ -+ rtw_odm_radar_detect_disable(padapter); -+ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &pause); -+ } -+} -+#endif /* CONFIG_DFS_MASTER */ -+ + _exit_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); ++ ++#endif // CONFIG_DUALMAC_CONCURRENT +} + +int get_bsstype(unsigned short capability) @@ -78820,21 +56880,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + } + else + { -+ return 0; ++ return 0; + } +} + +__inline u8 *get_my_bssid(WLAN_BSSID_EX *pnetwork) -+{ -+ return (pnetwork->MacAddress); ++{ ++ return (pnetwork->MacAddress); +} + +u16 get_beacon_interval(WLAN_BSSID_EX *bss) +{ -+ unsigned short val; ++ __le16 val; + _rtw_memcpy((unsigned char *)&val, rtw_get_beacon_interval_from_ie(bss->IEs), 2); + -+ return le16_to_cpu(val); ++ return le16_to_cpu(val); + +} + @@ -78848,10 +56908,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + + pmlmeext = &padapter->mlmeextpriv; + pmlmeinfo = &(pmlmeext->mlmext_info); -+ ++ + if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && ((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE)) + { -+ return _TRUE; ++ return true; + } + else + { @@ -78863,10 +56923,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 +{ + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ ++ + if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE)) + { -+ return _TRUE; ++ return true; + } + else + { @@ -78879,7 +56939,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + unsigned int i; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ ++ + for (i = IBSS_START_MAC_ID; i < NUM_STA; i++) + { + if (pmlmeinfo->FW_sta_info[i].status == 1) @@ -78887,9 +56947,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + return _FAIL; + } + } -+ -+ return _TRUE; -+ ++ ++ return true; ++ +} + +unsigned int decide_wait_for_beacon_timeout(unsigned int bcn_interval) @@ -78897,11 +56957,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + if ((bcn_interval << 2) < WAIT_FOR_BCN_TO_MIN) + { + return WAIT_FOR_BCN_TO_MIN; -+ } ++ } + else if ((bcn_interval << 2) > WAIT_FOR_BCN_TO_MAX) + { + return WAIT_FOR_BCN_TO_MAX; -+ } ++ } + else + { + return ((bcn_interval << 2)); @@ -78909,8 +56969,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 +} + +void CAM_empty_entry( -+ PADAPTER Adapter, -+ u8 ucIndex ++ PADAPTER Adapter, ++ u8 ucIndex +) +{ + rtw_hal_set_hwreg(Adapter, HW_VAR_CAM_EMPTY_ENTRY, (u8 *)(&ucIndex)); @@ -78918,546 +56978,111 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + +void invalidate_cam_all(_adapter *padapter) +{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ u8 val8 = 0; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_INVALID_ALL, &val8); -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ rtw_sec_cam_map_clr_all(&cam_ctl->used); -+ _rtw_memset(dvobj->cam_cache, 0, sizeof(struct sec_cam_ent) * SEC_CAM_ENT_NUM_SW_LIMIT); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); ++ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_INVALID_ALL, NULL); +} -+ -+void _clear_cam_entry(_adapter *padapter, u8 entry) ++#if 0 ++static u32 _ReadCAM(_adapter *padapter ,u32 addr) +{ -+ unsigned char null_sta[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ unsigned char null_key[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,0x00, 0x00, 0x00, 0x00,0x00, 0x00, 0x00, 0x00}; ++ u32 count = 0, cmd; ++ cmd = CAM_POLLINIG |addr ; ++ rtw_write32(padapter, RWCAM, cmd); + -+ rtw_sec_write_cam_ent(padapter, entry, 0, null_sta, null_key); -+} -+ -+inline void write_cam(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) -+{ -+#ifdef CONFIG_WRITE_CACHE_ONLY -+ write_cam_cache(adapter, id ,ctrl, mac, key); -+#else -+ rtw_sec_write_cam_ent(adapter, id, ctrl, mac, key); -+ write_cam_cache(adapter, id ,ctrl, mac, key); -+#endif -+} -+ -+inline void clear_cam_entry(_adapter *adapter, u8 id) -+{ -+ _clear_cam_entry(adapter, id); -+ clear_cam_cache(adapter, id); -+} -+ -+inline void write_cam_from_cache(_adapter *adapter, u8 id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ struct sec_cam_ent cache; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ _rtw_memcpy(&cache, &dvobj->cam_cache[id], sizeof(struct sec_cam_ent)); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+ rtw_sec_write_cam_ent(adapter, id, cache.ctrl, cache.mac, cache.key); -+} -+ -+void write_cam_cache(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ -+ dvobj->cam_cache[id].ctrl = ctrl; -+ _rtw_memcpy(dvobj->cam_cache[id].mac, mac, ETH_ALEN); -+ _rtw_memcpy(dvobj->cam_cache[id].key, key, 16); -+ -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+} -+ -+void clear_cam_cache(_adapter *adapter, u8 id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ -+ _rtw_memset(&(dvobj->cam_cache[id]), 0, sizeof(struct sec_cam_ent)); -+ -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+} -+ -+s16 rtw_get_camid(_adapter *adapter, struct sta_info *sta, s16 kid) -+{ -+ u8 macid; -+ s16 camid; -+ -+ //cam_entry: -+ //0~3 for default key -+ -+ //for concurrent mode (ap+sta, sta+sta): -+ //default key is disable, using sw encrypt/decrypt -+ //camid 0, 1, 2, 3 is default entry for default key/group key -+ //macid = 1 is for bc/mc stainfo, no mapping to camid -+ //macid = 0 mapping to camid 4 -+ //for macid >=2, camid = macid+3; -+ -+ if (sta) { -+ struct mlme_ext_info *mlmeinfo = &adapter->mlmeextpriv.mlmext_info; -+ macid = sta->mac_id; -+ -+ if((mlmeinfo->state&0x03) == WIFI_FW_AP_STATE) { -+ if((macid == 1) || (macid>(NUM_STA-4))){ -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" failed, mac_id=%d\n", FUNC_ADPT_ARG(adapter), macid); -+ camid = -1; -+ goto exit; -+ } -+ } -+ -+ if(macid==0) -+ camid = 4; -+ else if(macid >=2) -+ camid = macid + 3; -+ else -+ camid = 4; -+ } -+ else { -+ /* default key is disabled */ -+ camid = -1; -+ } -+ -+exit: -+ return (s16)camid; -+} -+ -+inline bool _rtw_camctl_chk_cap(_adapter *adapter, u8 cap) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ if (cam_ctl->sec_cap & cap) -+ return _TRUE; -+ return _FALSE; -+} -+ -+inline void _rtw_camctl_set_flags(_adapter *adapter, u32 flags) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ cam_ctl->flags |= flags; -+} -+ -+inline void rtw_camctl_set_flags(_adapter *adapter, u32 flags) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ _rtw_camctl_set_flags(adapter, flags); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+} -+ -+inline void _rtw_camctl_clr_flags(_adapter *adapter, u32 flags) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ cam_ctl->flags &= ~flags; -+} -+ -+inline void rtw_camctl_clr_flags(_adapter *adapter, u32 flags) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ _rtw_camctl_clr_flags(adapter, flags); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+} -+ -+inline bool _rtw_camctl_chk_flags(_adapter *adapter, u32 flags) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ if (cam_ctl->flags & flags) -+ return _TRUE; -+ return _FALSE; -+} -+ -+void dump_sec_cam_map(void *sel, struct sec_cam_bmp *map, u8 max_num) -+{ -+ DBG_871X_SEL_NL(sel, "0x%08x\n", map->m0); -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ if (max_num && max_num > 32) -+ DBG_871X_SEL_NL(sel, "0x%08x\n", map->m1); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ if (max_num && max_num > 64) -+ DBG_871X_SEL_NL(sel, "0x%08x\n", map->m2); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ if (max_num && max_num > 96) -+ DBG_871X_SEL_NL(sel, "0x%08x\n", map->m3); -+#endif -+} -+ -+inline bool rtw_sec_camid_is_set(struct sec_cam_bmp *map, u8 id) -+{ -+ if (id < 32) -+ return (map->m0 & BIT(id)); -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ return (map->m1 & BIT(id - 32)); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ return (map->m2 & BIT(id - 64)); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ return (map->m3 & BIT(id - 96)); -+#endif -+ else -+ rtw_warn_on(1); -+ -+ return 0; -+} -+ -+inline void rtw_sec_cam_map_set(struct sec_cam_bmp *map, u8 id) -+{ -+ if (id < 32) -+ map->m0 |= BIT(id); -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ map->m1 |= BIT(id - 32); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ map->m2 |= BIT(id - 64); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ map->m3 |= BIT(id - 96); -+#endif -+ else -+ rtw_warn_on(1); -+} -+ -+inline void rtw_sec_cam_map_clr(struct sec_cam_bmp *map, u8 id) -+{ -+ if (id < 32) -+ map->m0 &= ~BIT(id); -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ map->m1 &= ~BIT(id-32); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ map->m2 &= ~BIT(id-64); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ map->m3 &= ~BIT(id-96); -+#endif -+ else -+ rtw_warn_on(1); -+} -+ -+inline void rtw_sec_cam_map_clr_all(struct sec_cam_bmp *map) -+{ -+ map->m0 = 0; -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ map->m1 = 0; -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ map->m2 = 0; -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ map->m3 = 0; -+#endif -+} -+ -+inline bool rtw_sec_camid_is_drv_forbid(struct cam_ctl_t *cam_ctl, u8 id) -+{ -+ struct sec_cam_bmp forbid_map; -+ -+ forbid_map.m0 = 0x00000ff0; -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ forbid_map.m1 = 0x00000000; -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ forbid_map.m2 = 0x00000000; -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ forbid_map.m3 = 0x00000000; -+#endif -+ -+ if (id < 32) -+ return (forbid_map.m0 & BIT(id)); -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ return (forbid_map.m1 & BIT(id - 32)); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ return (forbid_map.m2 & BIT(id - 64)); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ return (forbid_map.m3 & BIT(id - 96)); -+#endif -+ else -+ rtw_warn_on(1); -+ -+ return 1; -+} -+ -+bool _rtw_sec_camid_is_used(struct cam_ctl_t *cam_ctl, u8 id) -+{ -+ bool ret = _FALSE; -+ -+ if (id >= cam_ctl->num) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ #if 0 /* for testing */ -+ if (rtw_sec_camid_is_drv_forbid(cam_ctl, id)) { -+ ret = _TRUE; -+ goto exit; -+ } -+ #endif -+ -+ ret = rtw_sec_camid_is_set(&cam_ctl->used, id); -+ -+exit: -+ return ret; -+} -+ -+inline bool rtw_sec_camid_is_used(struct cam_ctl_t *cam_ctl, u8 id) -+{ -+ _irqL irqL; -+ bool ret; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ ret = _rtw_sec_camid_is_used(cam_ctl, id); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+ return ret; -+} -+ -+inline bool _rtw_camid_is_gk(_adapter *adapter, u8 cam_id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ bool ret = _FALSE; -+ -+ if (cam_id >= cam_ctl->num) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (_rtw_sec_camid_is_used(cam_ctl, cam_id) == _FALSE) -+ goto exit; -+ -+ ret = (dvobj->cam_cache[cam_id].ctrl&BIT6)?_TRUE:_FALSE; -+ -+exit: -+ return ret; -+} -+ -+inline bool rtw_camid_is_gk(_adapter *adapter, u8 cam_id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ bool ret; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ ret = _rtw_camid_is_gk(adapter, cam_id); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+ return ret; -+} -+ -+bool cam_cache_chk(_adapter *adapter, u8 id, u8 *addr, s16 kid, s8 gk) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ bool ret = _FALSE; -+ -+ if (addr && _rtw_memcmp(dvobj->cam_cache[id].mac, addr, ETH_ALEN) == _FALSE) -+ goto exit; -+ if (kid >= 0 && kid != (dvobj->cam_cache[id].ctrl&0x03)) -+ goto exit; -+ if (gk != -1 && (gk?_TRUE:_FALSE) != _rtw_camid_is_gk(adapter, id)) -+ goto exit; -+ -+ ret = _TRUE; -+ -+exit: -+ return ret; -+} -+ -+s16 _rtw_camid_search(_adapter *adapter, u8 *addr, s16 kid, s8 gk) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ int i; -+ s16 cam_id = -1; -+ -+ for (i = 0; i < cam_ctl->num; i++) { -+ if (cam_cache_chk(adapter, i, addr, kid, gk)) { -+ cam_id = i; ++ do{ ++ if(0 == (rtw_read32(padapter,REG_CAMCMD) & CAM_POLLINIG)){ + break; + } -+ } ++ }while(count++ < 100); + -+ if (0) { -+ if (addr) -+ DBG_871X(FUNC_ADPT_FMT" addr:"MAC_FMT" kid:%d, gk:%d, return cam_id:%d\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), kid, gk, cam_id); -+ else -+ DBG_871X(FUNC_ADPT_FMT" addr:%p kid:%d, gk:%d, return cam_id:%d\n" -+ , FUNC_ADPT_ARG(adapter), addr, kid, gk, cam_id); -+ } -+ -+ return cam_id; ++ return rtw_read32(padapter,REG_CAMREAD); +} -+ -+s16 rtw_camid_search(_adapter *adapter, u8 *addr, s16 kid, s8 gk) ++void read_cam(_adapter *padapter ,u8 entry) +{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ s16 cam_id = -1; ++ u32 j,count = 0, addr, cmd; ++ addr = entry << 3; + -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ cam_id = _rtw_camid_search(adapter, addr, kid, gk); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+ return cam_id; -+} -+ -+s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, bool *used) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ s16 cam_id = -1; -+ -+ *used = _FALSE; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ -+#ifdef DYNAMIC_CAMID_ALLOC ++ DBG_8192C("********* DUMP CAM Entry_#%02d***************\n",entry); ++ for (j = 0; j < 6; j++) + { -+ struct mlme_ext_info *mlmeinfo = &adapter->mlmeextpriv.mlmext_info; -+ -+ if((((mlmeinfo->state&0x03) == WIFI_FW_AP_STATE) || ((mlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE)) -+ && !sta) { -+ /* AP/Ad-hoc mode group key: static alloction to default key by key ID */ -+ if (kid > 3) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" group key with invalid key id:%u\n" -+ , FUNC_ADPT_ARG(adapter), kid); -+ rtw_warn_on(1); -+ goto bitmap_handle; -+ } -+ cam_id = kid; -+ } -+ else { -+ int i; -+ u8 *addr = sta?sta->hwaddr:NULL; -+ #if 0 /* for testing */ -+ static u8 start_id = 0; -+ #else -+ u8 start_id = 0; -+ #endif -+ -+ if(!sta) { -+ if (!(mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { -+ /* bypass STA mode group key setting before connected(ex:WEP) because bssid is not ready */ -+ goto bitmap_handle; -+ } -+ -+ addr = get_bssid(&adapter->mlmepriv); -+ } -+ -+ /* find cam entry which has the same addr, kid (, gk bit) */ -+ if (_rtw_camctl_chk_cap(adapter, SEC_CAP_CHK_BMC) == _TRUE) -+ i = _rtw_camid_search(adapter, addr, kid, sta?_FALSE:_TRUE); -+ else -+ i = _rtw_camid_search(adapter, addr, kid, -1); -+ -+ if (i >= 0) { -+ cam_id = i; -+ goto bitmap_handle; -+ } -+ -+ for (i = 0; i < cam_ctl->num; i++) { -+ /* bypass default key which is allocated statically */ -+ if (((i + start_id) % cam_ctl->num) < 4) -+ continue; -+ -+ if (_rtw_sec_camid_is_used(cam_ctl, ((i + start_id) % cam_ctl->num)) == _FALSE) -+ break; -+ } -+ -+ if (i == cam_ctl->num) { -+ if (sta) -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" pairwise key with "MAC_FMT" id:%u no room\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), kid); -+ else -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" group key with "MAC_FMT" id:%u no room\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), kid); -+ rtw_warn_on(1); -+ goto bitmap_handle; -+ } -+ -+ cam_id = ((i + start_id) % cam_ctl->num); -+ start_id = ((i + start_id + 1) % cam_ctl->num); -+ } ++ cmd = _ReadCAM(padapter ,addr+j); ++ DBG_8192C("offset:0x%02x => 0x%08x \n",addr+j,cmd); + } -+#else -+ cam_id = rtw_get_camid(adapter, sta, kid); -+#endif /* DYNAMIC_CAMID_ALLOC */ ++ DBG_8192C("*********************************\n"); ++} ++#endif ++ ++void write_cam(_adapter *padapter, u8 entry, u16 ctrl, u8 *mac, u8 *key) ++{ ++ unsigned int i, val, addr; ++ //unsigned int cmd; ++ int j; ++ u32 cam_val[2]; ++ ++ addr = entry << 3; ++ ++ for (j = 5; j >= 0; j--) ++ { ++ switch (j) ++ { ++ case 0: ++ val = (ctrl | (mac[0] << 16) | (mac[1] << 24) ); ++ break; ++ ++ case 1: ++ val = (mac[2] | ( mac[3] << 8) | (mac[4] << 16) | (mac[5] << 24)); ++ break; ++ ++ default: ++ i = (j - 2) << 2; ++ val = (key[i] | (key[i+1] << 8) | (key[i+2] << 16) | (key[i+3] << 24)); ++ break; ++ ++ } ++ ++ cam_val[0] = val; ++ cam_val[1] = addr + (unsigned int)j; ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_WRITE, (u8 *)cam_val); ++ ++ //rtw_write32(padapter, WCAMI, val); ++ ++ //cmd = CAM_POLLINIG | CAM_WRITE | (addr + j); ++ //rtw_write32(padapter, RWCAM, cmd); ++ ++ //DBG_871X("%s=> cam write: %x, %x\n",__FUNCTION__, cmd, val); + -+bitmap_handle: -+ if (cam_id >= 0) { -+ *used = _rtw_sec_camid_is_used(cam_ctl, cam_id); -+ rtw_sec_cam_map_set(&cam_ctl->used, cam_id); + } + -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+ return cam_id; +} + -+void rtw_camid_free(_adapter *adapter, u8 cam_id) ++void clear_cam_entry(_adapter *padapter, u8 entry) +{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; ++#if 0 ++ u32 addr, val=0; ++ u32 cam_val[2]; + -+ _enter_critical_bh(&cam_ctl->lock, &irqL); ++ addr = entry << 3; + -+ if (cam_id < cam_ctl->num) -+ rtw_sec_cam_map_clr(&cam_ctl->used, cam_id); + -+ _exit_critical_bh(&cam_ctl->lock, &irqL); ++ cam_val[0] = val; ++ cam_val[1] = addr + (unsigned int)0; ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_WRITE, (u8 *)cam_val); ++ ++ ++ ++ cam_val[0] = val; ++ cam_val[1] = addr + (unsigned int)1; ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_WRITE, (u8 *)cam_val); ++#else ++ ++ unsigned char null_sta[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; ++ ++ unsigned char null_key[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,0x00, 0x00, 0x00, 0x00,0x00, 0x00, 0x00, 0x00}; ++ ++ write_cam(padapter, entry, 0, null_sta, null_key); ++ ++#endif +} + +int allocate_fw_sta_entry(_adapter *padapter) @@ -79465,7 +57090,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + unsigned int mac_id; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ ++ + for (mac_id = IBSS_START_MAC_ID; mac_id < NUM_STA; mac_id++) + { + if (pmlmeinfo->FW_sta_info[mac_id].status == 0) @@ -79475,67 +57100,58 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + break; + } + } -+ ++ + return mac_id; +} + +void flush_all_cam_entry(_adapter *padapter) +{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + +#ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_fwstate(padapter, _FW_LINKED) == _TRUE) ++ ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ //if(check_buddy_mlmeinfo_state(padapter, _HW_STATE_NOLINK_)) ++ if(check_buddy_fwstate(padapter, _FW_LINKED) == false) ++ { ++ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_INVALID_ALL, 0); ++ } ++ else + { + if(check_fwstate(pmlmepriv, WIFI_STATION_STATE)) + { + struct sta_priv *pstapriv = &padapter->stapriv; + struct sta_info *psta; ++ u8 cam_id;//cam_entry + + psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); + if(psta) { + if(psta->state & WIFI_AP_STATE) -+ {} //clear cam when ap free per sta_info ++ {} //clear cam when ap free per sta_info + else { -+ rtw_clearstakey_cmd(padapter, psta, _FALSE); ++ ++ cam_id = (u8)rtw_get_camid(psta->mac_id); ++ ++ //clear_cam_entry(padapter, cam_id); ++ rtw_clearstakey_cmd(padapter, (u8*)psta, cam_id, false); + } + } + } -+ else if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ else if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) + { -+ /* clear default key */ -+ int i, cam_id; -+ u8 null_addr[ETH_ALEN]= {0,0,0,0,0,0}; -+ -+ for (i=0;i<4;i++) { -+ cam_id = rtw_camid_search(padapter, null_addr, i, -1); -+ if (cam_id >= 0) { -+ clear_cam_entry(padapter, cam_id); -+ rtw_camid_free(padapter, cam_id); -+ } -+ } -+ -+ /* clear default key related key search setting */ -+ #ifdef DYNAMIC_CAMID_ALLOC -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_DK_CFG, (u8*)_FALSE); -+ #endif -+ -+ /* leave pairwise key when ap free per sta_info */ ++ //clear cam when ap free per sta_info + } + } -+ else ++#else //CONFIG_CONCURRENT_MODE ++ ++ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_INVALID_ALL, NULL); ++ +#endif //CONFIG_CONCURRENT_MODE -+ { -+ invalidate_cam_all(padapter); -+ /* clear default key related key search setting */ -+ #ifdef DYNAMIC_CAMID_ALLOC -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_DK_CFG, (u8*)_FALSE); -+ #endif -+ } + + _rtw_memset((u8 *)(pmlmeinfo->FW_sta_info), 0, sizeof(pmlmeinfo->FW_sta_info)); -+ ++ +} + +#if defined(CONFIG_P2P) && defined(CONFIG_WFD) @@ -79545,7 +57161,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo; ++ struct wifidirect_info *pwdinfo; + u8 wfd_ie[ 128 ] = { 0x00 }; + u32 wfd_ielen = 0; + @@ -79555,15 +57171,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + { + u8 attr_content[ 10 ] = { 0x00 }; + u32 attr_contentlen = 0; -+ ++ + DBG_871X( "[%s] Found WFD IE\n", __FUNCTION__ ); + rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, attr_content, &attr_contentlen); + if ( attr_contentlen ) + { + pwdinfo->wfd_info->peer_rtsp_ctrlport = RTW_GET_BE16( attr_content + 2 ); + DBG_8192C( "[%s] Peer PORT NUM = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_rtsp_ctrlport ); -+ return( _TRUE ); -+ } ++ return( true ); ++ } + } + else + { @@ -79579,24 +57195,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + //struct registry_priv *pregpriv = &padapter->registrypriv; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ + if(pmlmepriv->qospriv.qos_option==0) + { + pmlmeinfo->WMM_enable = 0; -+ return _FALSE; -+ } -+ -+ if(_rtw_memcmp(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element))) -+ { -+ return _FALSE; -+ } -+ else -+ { -+ _rtw_memcpy(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element)); ++ return _FAIL; + } ++ + pmlmeinfo->WMM_enable = 1; -+ return _TRUE; ++ _rtw_memcpy(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element)); ++ return true; + + /*if (pregpriv->wifi_spec == 1) + { @@ -79609,7 +57218,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + { + pmlmeinfo->WMM_enable = 1; + _rtw_rtw_memcpy(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element)); -+ return _TRUE; ++ return true; + } + } + else @@ -79617,7 +57226,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + pmlmeinfo->WMM_enable = 0; + return _FAIL; + }*/ -+ ++ +} + +void WMMOnAssocRsp(_adapter *padapter) @@ -79634,7 +57243,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + + acm_mask = 0; + -+ if (IsSupported5G(pmlmeext->cur_wireless_mode) || ++ if (IsSupported5G(pmlmeext->cur_wireless_mode) || + (pmlmeext->cur_wireless_mode & WIRELESS_11_24N) ) + aSifsTime = 16; + else @@ -79652,9 +57261,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + } else if (pmlmeext->cur_wireless_mode & WIRELESS_11B) { + ECWMin = 5; + ECWMax = 10; -+ } else { -+ ECWMin = 4; -+ ECWMax = 10; + } + + TXOP = 0; @@ -79671,9 +57277,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + } + else + { -+ edca[0] = edca[1] = edca[2] = edca[3] = 0; -+ -+ for (i = 0; i < 4; i++) ++ for (i = 0; i < 4; i++) + { + ACI = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 5) & 0x03; + ACM = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 4) & 0x01; @@ -79711,7 +57315,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); + acm_mask |= (ACM? BIT(3):0); + edca[XMIT_VO_QUEUE] = acParm; -+ break; ++ break; + } + + DBG_871X("WMM(%x): %x, %x\n", ACI, ACM, acParm); @@ -79726,7 +57330,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + + if(pregpriv->wifi_spec==1) + { -+ u32 j, tmp, change_inx=_FALSE; ++ u32 j, tmp, change_inx; + + //entry indx: 0->vo, 1->vi, 2->be, 3->bk. + for(i=0; i<4; i++) @@ -79736,15 +57340,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + //compare CW and AIFS + if((edca[j] & 0xFFFF) < (edca[i] & 0xFFFF)) + { -+ change_inx = _TRUE; ++ change_inx = true; + } + else if((edca[j] & 0xFFFF) == (edca[i] & 0xFFFF)) + { + //compare TXOP + if((edca[j] >> 16) > (edca[i] >> 16)) -+ change_inx = _TRUE; ++ change_inx = true; + } -+ ++ + if(change_inx) + { + tmp = edca[i]; @@ -79755,7 +57359,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + inx[i] = inx[j]; + inx[j] = tmp; + -+ change_inx = _FALSE; ++ change_inx = false; + } + } + } @@ -79784,13 +57388,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + if(!pIE) + return; + -+ if(phtpriv->ht_option == _FALSE) return; ++ if(phtpriv->ht_option == false) return; + + if(pmlmeext->cur_bwmode >= CHANNEL_WIDTH_80) return; + + if(pIE->Length > sizeof(struct HT_info_element)) + return; -+ ++ + pHT_info = (struct HT_info_element *)pIE->data; + + if (pmlmeext->cur_channel > 14) { @@ -79810,13 +57414,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + case 1: + new_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; + break; -+ ++ + case 3: + new_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; + break; -+ ++ + default: -+ new_bwmode = CHANNEL_WIDTH_20; + new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + break; + } @@ -79825,13 +57428,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + { + new_bwmode = CHANNEL_WIDTH_20; + new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } ++ } ++ + -+ + if((new_bwmode!= pmlmeext->cur_bwmode) || (new_ch_offset!=pmlmeext->cur_ch_offset)) + { -+ pmlmeinfo->bwmode_updated = _TRUE; -+ ++ pmlmeinfo->bwmode_updated = true; ++ + pmlmeext->cur_bwmode = new_bwmode; + pmlmeext->cur_ch_offset = new_ch_offset; + @@ -79840,42 +57443,42 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + } + else + { -+ pmlmeinfo->bwmode_updated = _FALSE; ++ pmlmeinfo->bwmode_updated = false; + } -+ + -+ if(_TRUE == pmlmeinfo->bwmode_updated) ++ ++ if(true == pmlmeinfo->bwmode_updated) + { + struct sta_info *psta; -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + struct sta_priv *pstapriv = &padapter->stapriv; -+ ++ + //set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); + -+ ++ + //update ap's stainfo + psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); + if(psta) + { + struct ht_priv *phtpriv_sta = &psta->htpriv; -+ ++ + if(phtpriv_sta->ht_option) -+ { -+ // bwmode -+ psta->bw_mode = pmlmeext->cur_bwmode; -+ phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; ++ { ++ // bwmode ++ phtpriv_sta->bwmode = pmlmeext->cur_bwmode; ++ phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; + } + else + { -+ psta->bw_mode = CHANNEL_WIDTH_20; ++ phtpriv_sta->bwmode = CHANNEL_WIDTH_20; + phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + } + -+ rtw_dm_ra_mask_wk_cmd(padapter, (u8 *)psta); + } + -+ //pmlmeinfo->bwmode_updated = _FALSE;//bwmode_updated done, reset it! -+ } ++ //pmlmeinfo->bwmode_updated = false;//bwmode_updated done, reset it! ++ ++ } +#endif //CONFIG_80211N_HT +} + @@ -79883,21 +57486,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 +{ +#ifdef CONFIG_80211N_HT + unsigned int i; -+ u8 rf_type = RF_1T1R; ++ u8 rf_type; + u8 max_AMPDU_len, min_MPDU_spacing; -+ u8 cur_ldpc_cap=0, cur_stbc_cap=0, cur_beamform_cap=0; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; ++ + if(pIE==NULL) return; -+ -+ if(phtpriv->ht_option == _FALSE) return; ++ ++ if(phtpriv->ht_option == false) return; + + pmlmeinfo->HT_caps_enable = 1; -+ ++ + for (i = 0; i < (pIE->Length); i++) + { + if (i != 2) @@ -79908,9 +57510,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + } + else + { -+ /* AMPDU Parameters field */ -+ -+ /* Get MIN of MAX AMPDU Length Exp */ ++ //modify from fw by Thomas 2010/11/17 + if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3) > (pIE->data[i] & 0x3)) + { + max_AMPDU_len = (pIE->data[i] & 0x3); @@ -79920,7 +57520,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + max_AMPDU_len = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3); + } + -+ /* Get MAX of MIN MPDU Start Spacing */ + if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) > (pIE->data[i] & 0x1c)) + { + min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c); @@ -79934,117 +57533,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + } + } + -+ // Commented by Albert 2010/07/12 -+ // Have to handle the endian issue after copying. -+ // HT_ext_caps didn't be used yet. -+ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info = le16_to_cpu( pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info ); -+ pmlmeinfo->HT_caps.u.HT_cap_element.HT_ext_caps = le16_to_cpu( pmlmeinfo->HT_caps.u.HT_cap_element.HT_ext_caps ); -+ + rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); + -+ -+ //update the MCS set -+ for (i = 0; i < 16; i++) -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= pmlmeext->default_supported_mcs_set[i]; -+ + //update the MCS rates -+ switch(rf_type) ++ for (i = 0; i < 16; i++) + { -+ case RF_1T1R: -+ case RF_1T2R: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_1R); -+ break; -+ case RF_2T2R: ++ if((rf_type == RF_1T1R) || (rf_type == RF_1T2R)) ++ { ++ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; ++ } ++ else ++ { + #ifdef CONFIG_DISABLE_MCS13TO15 -+ if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && pregistrypriv->wifi_spec != 1 ) -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R_13TO15_OFF); ++ if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && (pregistrypriv->wifi_spec!=1)) ++ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_2R_MCS13TO15_OFF[i]; + else -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+#else //CONFIG_DISABLE_MCS13TO15 -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+#endif //CONFIG_DISABLE_MCS13TO15 -+ break; -+ case RF_3T3R: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_3R); -+ break; -+ default: -+ DBG_871X("[warning] rf_type %d is not expected\n", rf_type); ++ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_2R[i]; ++ #else ++ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_2R[i]; ++ #endif //CONFIG_DISABLE_MCS13TO15 ++ } ++ #ifdef RTL8192C_RECONFIG_TO_1T1R ++ { ++ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; ++ } ++ #endif + } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ // Config STBC setting -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAP_ELE_TX_STBC(pIE->data)) -+ { -+ SET_FLAG(cur_stbc_cap, STBC_HT_ENABLE_TX); -+ DBG_871X("Enable HT Tx STBC !\n"); -+ } -+ phtpriv->stbc_cap = cur_stbc_cap; -+ -+#ifdef CONFIG_BEAMFORMING -+ // Config Tx beamforming setting -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pIE->data)) -+ { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); -+ /* Shift to BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP*/ -+ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(pIE->data) << 6); -+ } -+ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(pIE->data)) -+ { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); -+ /* Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ -+ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pIE->data) << 4); -+ } -+ phtpriv->beamform_cap = cur_beamform_cap; -+ if (cur_beamform_cap) { -+ DBG_871X("AP HT Beamforming Cap = 0x%02X\n", cur_beamform_cap); -+ } -+#endif /*CONFIG_BEAMFORMING*/ -+ } else { -+ /*WIFI_STATION_STATEorI_ADHOC_STATE or WIFI_ADHOC_MASTER_STATE*/ -+ // Config LDPC Coding Capability -+ if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX) && GET_HT_CAP_ELE_LDPC_CAP(pIE->data)) -+ { -+ SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX)); -+ DBG_871X("Enable HT Tx LDPC!\n"); -+ } -+ phtpriv->ldpc_cap = cur_ldpc_cap; -+ -+ // Config STBC setting -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAP_ELE_RX_STBC(pIE->data)) -+ { -+ SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX) ); -+ DBG_871X("Enable HT Tx STBC!\n"); -+ } -+ phtpriv->stbc_cap = cur_stbc_cap; -+ -+#ifdef CONFIG_BEAMFORMING -+ // Config Tx beamforming setting -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pIE->data)) -+ { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); -+ /* Shift to BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP*/ -+ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(pIE->data) << 6); -+ } -+ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(pIE->data)) -+ { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); -+ /* Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ -+ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pIE->data) << 4); -+ } -+ phtpriv->beamform_cap = cur_beamform_cap; -+ if (cur_beamform_cap) { -+ DBG_871X("Client HT Beamforming Cap = 0x%02X\n", cur_beamform_cap); -+ } -+#endif /*CONFIG_BEAMFORMING*/ -+ } -+ +#endif //CONFIG_80211N_HT ++ return; +} + +void HT_info_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) @@ -80052,17 +57568,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 +#ifdef CONFIG_80211N_HT + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct ht_priv *phtpriv = &pmlmepriv->htpriv; + + if(pIE==NULL) return; + -+ if(phtpriv->ht_option == _FALSE) return; ++ if(phtpriv->ht_option == false) return; + + + if(pIE->Length > sizeof(struct HT_info_element)) + return; -+ ++ + pmlmeinfo->HT_info_enable = 1; + _rtw_memcpy(&(pmlmeinfo->HT_info), pIE->data, pIE->Length); +#endif //CONFIG_80211N_HT @@ -80076,7 +57592,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + //struct registry_priv *pregpriv = &padapter->registrypriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ ++ + DBG_871X("%s\n", __FUNCTION__); + + if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable)) @@ -80089,15 +57605,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + //set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); + return; + } -+ ++ + //handle A-MPDU parameter field -+ /* ++ /* + AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k -+ AMPDU_para [4:2]:Min MPDU Start Spacing ++ AMPDU_para [4:2]:Min MPDU Start Spacing + */ -+ max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; -+ -+ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2; ++ max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; ++ ++ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2; + + rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MIN_SPACE, (u8 *)(&min_MPDU_spacing)); + @@ -80105,7 +57621,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + +#if 0 //move to rtw_update_ht_cap() + if ((pregpriv->bw_mode > 0) && -+ (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & BIT(1)) && ++ (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & BIT(1)) && + (pmlmeinfo->HT_info.infos[0] & BIT(2))) + { + //switch to the 40M Hz mode accoring to the AP @@ -80115,16 +57631,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + case EXTCHNL_OFFSET_UPPER: + pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; + break; -+ ++ + case EXTCHNL_OFFSET_LOWER: + pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; + break; -+ ++ + default: + pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + break; + } -+ ++ + //SelectChannel(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset); + } +#endif @@ -80152,7 +57668,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + // + pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; +#endif -+ ++ +} + +void ERP_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) @@ -80162,7 +57678,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + + if(pIE->Length>1) + return; -+ ++ + pmlmeinfo->ERP_enable = 1; + _rtw_memcpy(&(pmlmeinfo->ERP_IE), pIE->data, pIE->Length); +} @@ -80170,7 +57686,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 +void VCS_update(_adapter *padapter, struct sta_info *psta) +{ + struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + @@ -80180,7 +57695,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + psta->rtsen = 0; + psta->cts2self = 0; + break; -+ ++ + case 1: //on + if (pregpriv->vcs_type == 1) /* 1:RTS/CTS 2:CTS to self */ + { @@ -80193,167 +57708,51 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + psta->cts2self = 1; + } + break; -+ ++ + case 2: //auto + default: -+ if (((pmlmeinfo->ERP_enable) && (pmlmeinfo->ERP_IE & BIT(1))) -+ /*||(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT)*/ -+ ) { -+ if (pregpriv->vcs_type == 1) { ++ if ((pmlmeinfo->ERP_enable) && (pmlmeinfo->ERP_IE & BIT(1))) ++ { ++ if (pregpriv->vcs_type == 1) ++ { + psta->rtsen = 1; + psta->cts2self = 0; -+ } else { ++ } ++ else ++ { + psta->rtsen = 0; + psta->cts2self = 1; + } -+ } else { ++ } ++ else ++ { + psta->rtsen = 0; + psta->cts2self = 0; -+ } ++ } + break; + } +} + -+void update_ldpc_stbc_cap(struct sta_info *psta) ++#ifdef CONFIG_TDLS ++int check_ap_tdls_prohibited(u8 *pframe, u8 pkt_len) +{ -+#ifdef CONFIG_80211N_HT ++ u8 tdls_prohibited_bit = 0x40; //bit(38); TDLS_prohibited + -+#ifdef CONFIG_80211AC_VHT -+ if (psta->vhtpriv.vht_option) { -+ if(TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX)) -+ psta->ldpc = 1; -+ -+ if(TEST_FLAG(psta->vhtpriv.stbc_cap, STBC_VHT_ENABLE_TX)) -+ psta->stbc = 1; -+ } -+ else -+#endif //CONFIG_80211AC_VHT -+ if (psta->htpriv.ht_option) { -+ if(TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_ENABLE_TX)) -+ psta->ldpc = 1; -+ -+ if(TEST_FLAG(psta->htpriv.stbc_cap, STBC_HT_ENABLE_TX)) -+ psta->stbc = 1; -+ } else { -+ psta->ldpc = 0; -+ psta->stbc = 0; ++ if(pkt_len < 5) ++ { ++ return false; + } + -+#endif //CONFIG_80211N_HT -+} -+ -+ -+/* -+ * rtw_get_bcn_keys: get beacon keys from recv frame -+ * -+ * TODO: -+ * WLAN_EID_COUNTRY -+ * WLAN_EID_ERP_INFO -+ * WLAN_EID_CHANNEL_SWITCH -+ * WLAN_EID_PWR_CONSTRAINT -+ */ -+int rtw_get_bcn_keys(ADAPTER *Adapter, u8 *pframe, u32 packet_len, -+ struct beacon_keys *recv_beacon) -+{ -+ int left; -+ u16 capability; -+ unsigned char *pos; -+ struct rtw_ieee802_11_elems elems; -+ struct rtw_ieee80211_ht_cap *pht_cap = NULL; -+ struct HT_info_element *pht_info = NULL; -+ -+ _rtw_memset(recv_beacon, 0, sizeof(*recv_beacon)); -+ -+ /* checking capabilities */ -+ capability = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN + 10)); -+ -+ /* checking IEs */ -+ left = packet_len - sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_; -+ pos = pframe + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_; -+ if (rtw_ieee802_11_parse_elems(pos, left, &elems, 1) == ParseFailed) -+ return _FALSE; -+ -+ /* check bw and channel offset */ -+ if (elems.ht_capabilities) { -+ if (elems.ht_capabilities_len != sizeof(*pht_cap)) -+ return _FALSE; -+ -+ pht_cap = (struct rtw_ieee80211_ht_cap *) elems.ht_capabilities; -+ recv_beacon->ht_cap_info = pht_cap->cap_info; -+ } -+ -+ if (elems.ht_operation) { -+ if (elems.ht_operation_len != sizeof(*pht_info)) -+ return _FALSE; -+ -+ pht_info = (struct HT_info_element *) elems.ht_operation; -+ recv_beacon->ht_info_infos_0_sco = pht_info->infos[0] & 0x03; -+ } -+ -+ /* Checking for channel */ -+ if (elems.ds_params && elems.ds_params_len == sizeof(recv_beacon->bcn_channel)) -+ _rtw_memcpy(&recv_beacon->bcn_channel, elems.ds_params, -+ sizeof(recv_beacon->bcn_channel)); -+ else if (pht_info) -+ /* In 5G, some ap do not have DSSET IE checking HT info for channel */ -+ recv_beacon->bcn_channel = pht_info->primary_channel; -+ else { -+ /* we don't find channel IE, so don't check it */ -+ //DBG_871X("Oops: %s we don't find channel IE, so don't check it \n", __func__); -+ recv_beacon->bcn_channel = Adapter->mlmeextpriv.cur_channel; -+ } -+ -+ /* checking SSID */ -+ if (elems.ssid) { -+ if (elems.ssid_len > sizeof(recv_beacon->ssid)) -+ return _FALSE; -+ -+ _rtw_memcpy(recv_beacon->ssid, elems.ssid, elems.ssid_len); -+ recv_beacon->ssid_len = elems.ssid_len; -+ } else; // means hidden ssid -+ -+ /* checking RSN first */ -+ if (elems.rsn_ie && elems.rsn_ie_len) { -+ recv_beacon->encryp_protocol = ENCRYP_PROTOCOL_WPA2; -+ rtw_parse_wpa2_ie(elems.rsn_ie - 2, elems.rsn_ie_len + 2, -+ &recv_beacon->group_cipher, &recv_beacon->pairwise_cipher, -+ &recv_beacon->is_8021x); -+ } -+ /* checking WPA secon */ -+ else if (elems.wpa_ie && elems.wpa_ie_len) { -+ recv_beacon->encryp_protocol = ENCRYP_PROTOCOL_WPA; -+ rtw_parse_wpa_ie(elems.wpa_ie - 2, elems.wpa_ie_len + 2, -+ &recv_beacon->group_cipher, &recv_beacon->pairwise_cipher, -+ &recv_beacon->is_8021x); -+ } -+ else if (capability & BIT(4)) { -+ recv_beacon->encryp_protocol = ENCRYP_PROTOCOL_WEP; -+ } -+ -+ return _TRUE; -+} -+ -+void rtw_dump_bcn_keys(struct beacon_keys *recv_beacon) -+{ -+ int i; -+ char *p; -+ u8 ssid[IW_ESSID_MAX_SIZE + 1]; -+ -+ _rtw_memcpy(ssid, recv_beacon->ssid, recv_beacon->ssid_len); -+ ssid[recv_beacon->ssid_len] = '\0'; -+ -+ DBG_871X("%s: ssid = %s\n", __func__, ssid); -+ DBG_871X("%s: channel = %x\n", __func__, recv_beacon->bcn_channel); -+ DBG_871X("%s: ht_cap = %x\n", __func__, recv_beacon->ht_cap_info); -+ DBG_871X("%s: ht_info_infos_0_sco = %x\n", __func__, recv_beacon->ht_info_infos_0_sco); -+ DBG_871X("%s: sec=%d, group = %x, pair = %x, 8021X = %x\n", __func__, -+ recv_beacon->encryp_protocol, recv_beacon->group_cipher, -+ recv_beacon->pairwise_cipher, recv_beacon->is_8021x); ++ pframe += 4; ++ if( (*pframe) & tdls_prohibited_bit ) ++ return true; ++ ++ return false; +} ++#endif //CONFIG_TDLS + +int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len) +{ -+#if 0 + unsigned int len; + unsigned char *p; + unsigned short val16, subtype; @@ -80371,17 +57770,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + struct HT_info_element *pht_info = NULL; + struct rtw_ieee80211_ht_cap *pht_cap = NULL; + u32 bcn_channel; -+ unsigned short ht_cap_info; ++ unsigned short ht_cap_info; + unsigned char ht_info_infos_0; -+#endif -+ unsigned int len; -+ u8 *pbssid = GetAddr3Ptr(pframe); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ struct wlan_network *cur_network = &(Adapter->mlmepriv.cur_network); -+ struct beacon_keys recv_beacon; + -+ if (is_client_associated_to_ap(Adapter) == _FALSE) -+ return _TRUE; ++ if (is_client_associated_to_ap(Adapter) == false) ++ return true; + + len = packet_len - sizeof(struct rtw_ieee80211_hdr_3addr); + @@ -80390,95 +57783,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + return _FAIL; + } + -+ if (_rtw_memcmp(cur_network->network.MacAddress, pbssid, 6) == _FALSE) { ++ if (_rtw_memcmp(cur_network->network.MacAddress, pbssid, 6) == false) { + DBG_871X("Oops: rtw_check_network_encrypt linked but recv other bssid bcn\n" MAC_FMT MAC_FMT, + MAC_ARG(pbssid), MAC_ARG(cur_network->network.MacAddress)); -+ return _TRUE; ++ return true; + } + -+ if (rtw_get_bcn_keys(Adapter, pframe, packet_len, &recv_beacon) == _FALSE) -+ return _TRUE; // parsing failed => broken IE -+ -+ // don't care hidden ssid, use current beacon ssid directly -+ if (recv_beacon.ssid_len == 0) { -+ _rtw_memcpy(recv_beacon.ssid, pmlmepriv->cur_beacon_keys.ssid, -+ pmlmepriv->cur_beacon_keys.ssid_len); -+ recv_beacon.ssid_len = pmlmepriv->cur_beacon_keys.ssid_len; -+ } -+ -+ if (_rtw_memcmp(&recv_beacon, &pmlmepriv->cur_beacon_keys, sizeof(recv_beacon)) == _TRUE) -+ { -+ pmlmepriv->new_beacon_cnts = 0; -+ } -+ else if ((pmlmepriv->new_beacon_cnts == 0) || -+ _rtw_memcmp(&recv_beacon, &pmlmepriv->new_beacon_keys, sizeof(recv_beacon)) == _FALSE) -+ { -+ DBG_871X_LEVEL(_drv_err_, "%s: start new beacon (seq=%d)\n", __func__, GetSequence(pframe)); -+ -+ if (pmlmepriv->new_beacon_cnts == 0) { -+ DBG_871X_LEVEL(_drv_err_, "%s: cur beacon key\n", __func__); -+ DBG_871X_EXP(_drv_err_, rtw_dump_bcn_keys(&pmlmepriv->cur_beacon_keys)); -+ } -+ -+ DBG_871X_LEVEL(_drv_err_, "%s: new beacon key\n", __func__); -+ DBG_871X_EXP(_drv_err_, rtw_dump_bcn_keys(&recv_beacon)); -+ -+ memcpy(&pmlmepriv->new_beacon_keys, &recv_beacon, sizeof(recv_beacon)); -+ pmlmepriv->new_beacon_cnts = 1; -+ } -+ else -+ { -+ DBG_871X_LEVEL(_drv_err_, "%s: new beacon again (seq=%d)\n", __func__, GetSequence(pframe)); -+ pmlmepriv->new_beacon_cnts++; -+ } -+ -+ // if counter >= max, it means beacon is changed really -+ if (pmlmepriv->new_beacon_cnts >= new_bcn_max) -+ { -+ DBG_871X_LEVEL(_drv_err_, "%s: new beacon occur!!\n", __func__); -+ -+ // check bw mode change only? -+ pmlmepriv->cur_beacon_keys.ht_cap_info = recv_beacon.ht_cap_info; -+ pmlmepriv->cur_beacon_keys.ht_info_infos_0_sco = recv_beacon.ht_info_infos_0_sco; -+ -+ if (_rtw_memcmp(&recv_beacon, &pmlmepriv->cur_beacon_keys, -+ sizeof(recv_beacon)) == _FALSE) { -+ // beacon is changed, have to do disconnect/connect -+ return _FAIL; -+ } -+ -+ DBG_871X("%s bw mode change\n", __func__); -+ DBG_871X("%s bcn now: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, -+ cur_network->BcnInfo.ht_cap_info, -+ cur_network->BcnInfo.ht_info_infos_0); -+ -+ cur_network->BcnInfo.ht_cap_info = recv_beacon.ht_cap_info; -+ cur_network->BcnInfo.ht_info_infos_0 = -+ (cur_network->BcnInfo.ht_info_infos_0 & (~0x03)) | -+ recv_beacon.ht_info_infos_0_sco; -+ -+ DBG_871X("%s bcn link: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, -+ cur_network->BcnInfo.ht_cap_info, -+ cur_network->BcnInfo.ht_info_infos_0); -+ -+ memcpy(&pmlmepriv->cur_beacon_keys, &recv_beacon, sizeof(recv_beacon)); -+ pmlmepriv->new_beacon_cnts = 0; -+ } -+ -+ return _SUCCESS; -+ -+#if 0 + bssid = (WLAN_BSSID_EX *)rtw_zmalloc(sizeof(WLAN_BSSID_EX)); -+ if (bssid == NULL) { -+ DBG_871X("%s rtw_zmalloc fail !!!\n", __func__); -+ return _TRUE; -+ } -+ -+ if ((pmlmepriv->timeBcnInfoChkStart != 0) && (rtw_get_passing_time_ms(pmlmepriv->timeBcnInfoChkStart) > DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS)) -+ { -+ pmlmepriv->timeBcnInfoChkStart = 0; -+ pmlmepriv->NumOfBcnInfoChkFail = 0; -+ } + + subtype = GetFrameSubType(pframe) >> 4; + @@ -80496,7 +57807,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); + if(p && len>0) { + pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); -+ ht_cap_info = pht_cap->cap_info; ++ ht_cap_info = le16_to_cpu(pht_cap->cap_info); + } else { + ht_cap_info = 0; + } @@ -80511,15 +57822,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + if (ht_cap_info != cur_network->BcnInfo.ht_cap_info || + ((ht_info_infos_0&0x03) != (cur_network->BcnInfo.ht_info_infos_0&0x03))) { + DBG_871X("%s bcn now: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, -+ ht_cap_info, ht_info_infos_0); ++ ht_cap_info, ht_info_infos_0); + DBG_871X("%s bcn link: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, -+ cur_network->BcnInfo.ht_cap_info, cur_network->BcnInfo.ht_info_infos_0); -+ DBG_871X("%s bw mode change\n", __func__); -+ { ++ cur_network->BcnInfo.ht_cap_info, cur_network->BcnInfo.ht_info_infos_0); ++ DBG_871X("%s bw mode change, disconnect\n", __func__); ++ { + //bcn_info_update + cur_network->BcnInfo.ht_cap_info = ht_cap_info; + cur_network->BcnInfo.ht_info_infos_0 = ht_info_infos_0; -+ //to do : need to check that whether modify related register of BB or not ++ //to do : need to check that whether modify related register of BB or not + } + //goto _mismatch; + } @@ -80529,7 +57840,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + if (p) { + bcn_channel = *(p + 2); + } else {/* In 5G, some ap do not have DSSET IE checking HT info for channel */ -+ rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); ++ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); + if(pht_info) { + bcn_channel = pht_info->primary_channel; + } else { /* we don't find channel IE, so don't check it */ @@ -80546,12 +57857,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + /* checking SSID */ + if ((p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _SSID_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_)) == NULL) { + DBG_871X("%s marc: cannot find SSID for survey event\n", __func__); -+ hidden_ssid = _TRUE; ++ hidden_ssid = true; + } else { -+ hidden_ssid = _FALSE; ++ hidden_ssid = false; + } + -+ if((NULL != p) && (_FALSE == hidden_ssid && (*(p + 1)))) { ++ if((NULL != p) && (false == hidden_ssid && (*(p + 1)))) { + _rtw_memcpy(bssid->Ssid.Ssid, (p + 2), *(p + 1)); + bssid->Ssid.SsidLength = *(p + 1); + } else { @@ -80564,10 +57875,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + bssid->Ssid.SsidLength, cur_network->network.Ssid.Ssid, + cur_network->network.Ssid.SsidLength)); + -+ if (_rtw_memcmp(bssid->Ssid.Ssid, cur_network->network.Ssid.Ssid, 32) == _FALSE || ++ if (_rtw_memcmp(bssid->Ssid.Ssid, cur_network->network.Ssid.Ssid, 32) == false || + bssid->Ssid.SsidLength != cur_network->network.Ssid.SsidLength) { + if (bssid->Ssid.Ssid[0] != '\0' && bssid->Ssid.SsidLength != 0) { /* not hidden ssid */ -+ DBG_871X("%s(), SSID is not match\n", __func__); ++ DBG_871X("%s(), SSID is not match return FAIL\n", __func__); + goto _mismatch; + } + } @@ -80584,7 +57895,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + ("%s(): cur_network->network.Privacy is %d, bssid.Privacy is %d\n", + __func__, cur_network->network.Privacy,bssid->Privacy)); + if (cur_network->network.Privacy != bssid->Privacy) { -+ DBG_871X("%s(), privacy is not match\n",__func__); ++ DBG_871X("%s(), privacy is not match return FAIL\n",__func__); + goto _mismatch; + } + @@ -80600,7 +57911,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + } + + if (cur_network->BcnInfo.encryp_protocol != encryp_protocol) { -+ DBG_871X("%s(): enctyp is not match\n",__func__); ++ DBG_871X("%s(): enctyp is not match ,return FAIL\n",__func__); + goto _mismatch; + } + @@ -80627,14 +57938,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_, + ("%s cur_network->group_cipher is %d: %d\n",__func__, cur_network->BcnInfo.group_cipher, group_cipher)); + if (pairwise_cipher != cur_network->BcnInfo.pairwise_cipher || group_cipher != cur_network->BcnInfo.group_cipher) { -+ DBG_871X("%s pairwise_cipher(%x:%x) or group_cipher(%x:%x) is not match\n",__func__, ++ DBG_871X("%s pairwise_cipher(%x:%x) or group_cipher(%x:%x) is not match ,return FAIL\n",__func__, + pairwise_cipher, cur_network->BcnInfo.pairwise_cipher, + group_cipher, cur_network->BcnInfo.group_cipher); + goto _mismatch; + } + + if (is_8021x != cur_network->BcnInfo.is_8021x) { -+ DBG_871X("%s authentication is not match\n", __func__); ++ DBG_871X("%s authentication is not match ,return FAIL\n", __func__); + goto _mismatch; + } + } @@ -80644,27 +57955,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + +_mismatch: + rtw_mfree((u8 *)bssid, sizeof(WLAN_BSSID_EX)); ++ return _FAIL; + -+ if (pmlmepriv->NumOfBcnInfoChkFail == 0) -+ { -+ pmlmepriv->timeBcnInfoChkStart = rtw_get_current_time(); -+ } + -+ pmlmepriv->NumOfBcnInfoChkFail++; -+ DBG_871X("%s by "ADPT_FMT" - NumOfChkFail = %d (SeqNum of this Beacon frame = %d).\n", __func__, ADPT_ARG(Adapter), pmlmepriv->NumOfBcnInfoChkFail, GetSequence(pframe)); -+ -+ if ((pmlmepriv->timeBcnInfoChkStart != 0) && (rtw_get_passing_time_ms(pmlmepriv->timeBcnInfoChkStart) <= DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS) -+ && (pmlmepriv->NumOfBcnInfoChkFail >= DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD)) -+ { -+ DBG_871X("%s by "ADPT_FMT" - NumOfChkFail = %d >= threshold : %d (in %d ms), return FAIL.\n", __func__, ADPT_ARG(Adapter), pmlmepriv->NumOfBcnInfoChkFail, -+ DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD, rtw_get_passing_time_ms(pmlmepriv->timeBcnInfoChkStart)); -+ pmlmepriv->timeBcnInfoChkStart = 0; -+ pmlmepriv->NumOfBcnInfoChkFail = 0; -+ return _FAIL; -+ } -+ -+ return _SUCCESS; -+#endif +} + +void update_beacon_info(_adapter *padapter, u8 *pframe, uint pkt_len, struct sta_info *psta) @@ -80672,38 +57965,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + unsigned int i; + unsigned int len; + PNDIS_802_11_VARIABLE_IEs pIE; -+ ++ +#ifdef CONFIG_TDLS + struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; + u8 tdls_prohibited[] = { 0x00, 0x00, 0x00, 0x00, 0x10 }; //bit(38): TDLS_prohibited +#endif //CONFIG_TDLS -+ ++ + len = pkt_len - (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN); + + for (i = 0; i < len;) + { + pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN) + i); -+ ++ + switch (pIE->ElementID) + { -+ case _VENDOR_SPECIFIC_IE_: -+ //to update WMM paramter set while receiving beacon -+ if (_rtw_memcmp(pIE->data, WMM_PARA_OUI, 6) && pIE->Length == WLAN_WMM_LEN) //WMM ++#if 0 ++ case _VENDOR_SPECIFIC_IE_: ++ //todo: to update WMM paramter set while receiving beacon ++ if (_rtw_memcmp(pIE->data, WMM_PARA_OUI, 6)) //WMM + { -+ (WMM_param_handler(padapter, pIE))? report_wmm_edca_update(padapter): 0; ++ (WMM_param_handler(padapter, pIE))? WMMOnAssocRsp(padapter): 0; + } -+ + break; ++#endif + -+ case _HT_EXTRA_INFO_IE_: //HT info ++ case _HT_EXTRA_INFO_IE_: //HT info + //HT_info_handler(padapter, pIE); + bwmode_update_check(padapter, pIE); + break; -+#ifdef CONFIG_80211AC_VHT -+ case EID_OpModeNotification: -+ rtw_process_vht_op_mode_notify(padapter, pIE->data, psta); -+ break; -+#endif //CONFIG_80211AC_VHT ++ + case _ERPINFO_IE_: + ERP_IE_handler(padapter, pIE); + VCS_update(padapter, psta); @@ -80711,16 +58001,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + +#ifdef CONFIG_TDLS + case _EXT_CAP_IE_: -+ if( check_ap_tdls_prohibited(pIE->data, pIE->Length) == _TRUE ) -+ ptdlsinfo->ap_prohibited = _TRUE; -+ if (check_ap_tdls_ch_switching_prohibited(pIE->data, pIE->Length) == _TRUE) -+ ptdlsinfo->ch_switch_prohibited = _TRUE; ++ if( check_ap_tdls_prohibited(pIE->data, pIE->Length) == true ) ++ ptdlsinfo->ap_prohibited = true; + break; +#endif //CONFIG_TDLS + default: + break; + } -+ ++ + i += (pIE->Length + 2); + } +} @@ -80731,28 +58019,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + unsigned int i; + unsigned int len; + PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 new_ch_no = 0; ++ u8 new_ch_no = 0; + -+ if(padapter->mlmepriv.handle_dfs == _TRUE ) -+ return; -+ + len = pkt_len - (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN); + + for (i = 0; i < len;) + { + pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN) + i); -+ ++ + switch (pIE->ElementID) + { + case _CH_SWTICH_ANNOUNCE_: -+ padapter->mlmepriv.handle_dfs = _TRUE; + _rtw_memcpy(&new_ch_no, pIE->data+1, 1); + rtw_set_csa_cmd(padapter, new_ch_no); + break; ++ + default: + break; + } -+ ++ + i += (pIE->Length + 2); + } +} @@ -80764,43 +58049,43 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + PNDIS_802_11_VARIABLE_IEs pIE; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + + if (rtw_get_capability((WLAN_BSSID_EX *)cur_network) & WLAN_CAPABILITY_PRIVACY) + { + for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pmlmeinfo->network.IELength;) + { + pIE = (PNDIS_802_11_VARIABLE_IEs)(pmlmeinfo->network.IEs + i); -+ ++ + switch (pIE->ElementID) + { + case _VENDOR_SPECIFIC_IE_: -+ if ((_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4)) && (_rtw_memcmp((pIE->data + 12), WPA_TKIP_CIPHER, 4))) ++ if ((_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4)) && (_rtw_memcmp((pIE->data + 12), WPA_TKIP_CIPHER, 4))) + { -+ return _TRUE; ++ return true; + } + break; -+ ++ + case _RSN_IE_2_: -+ if (_rtw_memcmp((pIE->data + 8), RSN_TKIP_CIPHER, 4)) ++ if (_rtw_memcmp((pIE->data + 8), RSN_TKIP_CIPHER, 4)) + { -+ return _TRUE; ++ return true; + } -+ ++ + default: + break; + } -+ ++ + i += (pIE->Length + 2); + } -+ -+ return _FALSE; ++ ++ return false; + } + else + { -+ return _FALSE; ++ return false; + } -+ ++ +} + +unsigned int should_forbid_n_rate(_adapter * padapter) @@ -80822,13 +58107,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + if (_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4) && + ((_rtw_memcmp((pIE->data + 12), WPA_CIPHER_SUITE_CCMP, 4)) || + (_rtw_memcmp((pIE->data + 16), WPA_CIPHER_SUITE_CCMP, 4)))) -+ return _FALSE; ++ return false; + break; + + case _RSN_IE_2_: + if ((_rtw_memcmp((pIE->data + 8), RSN_CIPHER_SUITE_CCMP, 4)) || + (_rtw_memcmp((pIE->data + 12), RSN_CIPHER_SUITE_CCMP, 4))) -+ return _FALSE; ++ return false; + + default: + break; @@ -80837,11 +58122,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + i += (pIE->Length + 2); + } + -+ return _TRUE; ++ return true; + } + else + { -+ return _FALSE; ++ return false; + } + +} @@ -80853,7 +58138,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + PNDIS_802_11_VARIABLE_IEs pIE; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + + if (rtw_get_capability((WLAN_BSSID_EX *)cur_network) & WLAN_CAPABILITY_PRIVACY) + { @@ -80865,11 +58150,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + { + case _VENDOR_SPECIFIC_IE_: + if (_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4)) -+ return _FALSE; ++ return false; + break; + + case _RSN_IE_2_: -+ return _FALSE; ++ return false; + + default: + break; @@ -80878,11 +58163,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + i += (pIE->Length + 2); + } + -+ return _TRUE; ++ return true; + } + else + { -+ return _FALSE; ++ return false; + } + +} @@ -80893,7 +58178,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + int inx = 0; + rate = rate & 0x7f; + -+ switch (rate) ++ switch (rate) + { + case 54*2: + inx = 11; @@ -80910,7 +58195,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + case 24*2: + inx = 8; + break; -+ ++ + case 18*2: + inx = 7; + break; @@ -80922,7 +58207,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + case 9*2: + inx = 5; + break; -+ ++ + case 6*2: + inx = 4; + break; @@ -80937,22 +58222,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + case 2*2: + inx = 1; + break; -+ ++ + case 1*2: + inx = 0; + break; + + } -+ return inx; ++ return inx; +} + +unsigned int update_basic_rate(unsigned char *ptn, unsigned int ptn_sz) +{ + unsigned int i, num_of_rate; + unsigned int mask = 0; -+ ++ + num_of_rate = (ptn_sz > NumRates)? NumRates: ptn_sz; -+ ++ + for (i = 0; i < num_of_rate; i++) + { + if ((*(ptn + i)) & 0x80) @@ -80967,9 +58252,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 +{ + unsigned int i, num_of_rate; + unsigned int mask = 0; -+ ++ + num_of_rate = (ptn_sz > NumRates)? NumRates: ptn_sz; -+ ++ + for (i = 0; i < num_of_rate; i++) + { + mask |= 0x1 << wifirate2_ratetbl_inx(*(ptn + i)); @@ -80981,31 +58266,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 +unsigned int update_MCS_rate(struct HT_caps_element *pHT_caps) +{ + unsigned int mask = 0; -+ ++ + mask = ((pHT_caps->u.HT_cap_element.MCS_rate[0] << 12) | (pHT_caps->u.HT_cap_element.MCS_rate[1] << 20)); -+ ++ + return mask; +} + -+int support_short_GI(_adapter *padapter, struct HT_caps_element *pHT_caps, u8 bwmode) ++int support_short_GI(_adapter *padapter, struct HT_caps_element *pHT_caps) +{ + unsigned char bit_offset; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (!(pmlmeinfo->HT_enable)) -+ return _FAIL; + -+ bit_offset = (bwmode & CHANNEL_WIDTH_40)? 6: 5; -+ -+ if (pHT_caps->u.HT_cap_element.HT_caps_info & (0x1 << bit_offset)) -+ { -+ return _SUCCESS; -+ } -+ else -+ { ++ if (!(pmlmeinfo->HT_enable)) ++ return _FAIL; ++ ++ if ((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_RALINK)) ++ return _FAIL; ++ ++ bit_offset = (pmlmeext->cur_bwmode & CHANNEL_WIDTH_40)? 6: 5; ++ ++ if (le16_to_cpu(pHT_caps->u.HT_cap_element.HT_caps_info) & (0x1 << bit_offset)) ++ return _SUCCESS; ++ else + return _FAIL; -+ } +} + +unsigned char get_highest_rate_idx(u32 mask) @@ -81029,9 +58313,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 +unsigned char get_highest_mcs_rate(struct HT_caps_element *pHT_caps) +{ + int i, mcs_rate; -+ ++ + mcs_rate = (pHT_caps->u.HT_cap_element.MCS_rate[0] | (pHT_caps->u.HT_cap_element.MCS_rate[1] << 8)); -+ ++ + for (i = 15; i >= 0; i--) + { + if (mcs_rate & (0x1 << i)) @@ -81039,7 +58323,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + break; + } + } -+ ++ + return i; +} + @@ -81056,7 +58340,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + +void set_sta_rate(_adapter *padapter, struct sta_info *psta) +{ -+ //rate adaptive ++ //rate adaptive + enable_rate_adaptive(padapter, psta); +} + @@ -81109,7 +58393,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + for (i = sizeof(NDIS_802_11_FIXED_IEs); i < len;) + { + pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + i); -+ ++ + switch (pIE->ElementID) + { + case _VENDOR_SPECIFIC_IE_: @@ -81118,9 +58402,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + DBG_871X("link to Artheros AP\n"); + return HT_IOT_PEER_ATHEROS; + } -+ else if ( (_rtw_memcmp(pIE->data, BROADCOM_OUI1, 3)) -+ || (_rtw_memcmp(pIE->data, BROADCOM_OUI2, 3)) -+ || (_rtw_memcmp(pIE->data, BROADCOM_OUI3, 3))) ++ else if ((_rtw_memcmp(pIE->data, BROADCOM_OUI1, 3)) ++ || (_rtw_memcmp(pIE->data, BROADCOM_OUI2, 3)) ++ || (_rtw_memcmp(pIE->data, BROADCOM_OUI2, 3))) + { + DBG_871X("link to Broadcom AP\n"); + return HT_IOT_PEER_BROADCOM; @@ -81172,7 +58456,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + } + } + } -+ ++ + DBG_871X("link to Realtek AP\n"); + return Vender; + } @@ -81185,34 +58469,66 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + { + break; + } -+ ++ + default: + break; + } -+ ++ + i += (pIE->Length + 2); + } -+ ++ + DBG_871X("link to new AP\n"); + return HT_IOT_PEER_UNKNOWN; +} + ++void update_IOT_info(_adapter *padapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ switch (pmlmeinfo->assoc_AP_vendor) ++ { ++ case HT_IOT_PEER_MARVELL: ++ pmlmeinfo->turboMode_cts2self = 1; ++ pmlmeinfo->turboMode_rtsen = 0; ++ break; ++ ++ case HT_IOT_PEER_RALINK: ++ pmlmeinfo->turboMode_cts2self = 0; ++ pmlmeinfo->turboMode_rtsen = 1; ++ //disable high power ++ Switch_DM_Func(padapter, (~DYNAMIC_BB_DYNAMIC_TXPWR), false); ++ break; ++ case HT_IOT_PEER_REALTEK: ++ //rtw_write16(padapter, 0x4cc, 0xffff); ++ //rtw_write16(padapter, 0x546, 0x01c0); ++ //disable high power ++ Switch_DM_Func(padapter, (~DYNAMIC_BB_DYNAMIC_TXPWR), false); ++ break; ++ default: ++ pmlmeinfo->turboMode_cts2self = 0; ++ pmlmeinfo->turboMode_rtsen = 1; ++ break; ++ } ++ ++} ++ +void update_capinfo(PADAPTER Adapter, u16 updateCap) +{ + struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ BOOLEAN ShortPreamble; ++ bool ShortPreamble; + + // Check preamble mode, 2005.01.06, by rcnjko. + // Mark to update preamble value forever, 2008.03.18 by lanhsin + //if( pMgntInfo->RegPreambleMode == PREAMBLE_AUTO ) + { -+ ++ + if(updateCap & cShortPreamble) + { // Short Preamble + if(pmlmeinfo->preamble_mode != PREAMBLE_SHORT) // PREAMBLE_LONG or PREAMBLE_AUTO + { -+ ShortPreamble = _TRUE; ++ ShortPreamble = true; + pmlmeinfo->preamble_mode = PREAMBLE_SHORT; + rtw_hal_set_hwreg( Adapter, HW_VAR_ACK_PREAMBLE, (u8 *)&ShortPreamble ); + } @@ -81221,7 +58537,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + { // Long Preamble + if(pmlmeinfo->preamble_mode != PREAMBLE_LONG) // PREAMBLE_SHORT or PREAMBLE_AUTO + { -+ ShortPreamble = _FALSE; ++ ShortPreamble = false; + pmlmeinfo->preamble_mode = PREAMBLE_LONG; + rtw_hal_set_hwreg( Adapter, HW_VAR_ACK_PREAMBLE, (u8 *)&ShortPreamble ); + } @@ -81235,11 +58551,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + else + { + //Filen: See 802.11-2007 p.90 -+ if( pmlmeext->cur_wireless_mode & (WIRELESS_11_24N | WIRELESS_11A | WIRELESS_11_5N | WIRELESS_11AC)) -+ { -+ pmlmeinfo->slotTime = SHORT_SLOT_TIME; -+ } -+ else if( pmlmeext->cur_wireless_mode & (WIRELESS_11G)) ++ if( pmlmeext->cur_wireless_mode & (WIRELESS_11G)) + { + if( (updateCap & cShortSlotTime) /* && (!(pMgntInfo->pHTInfo->RT2RT_HT_Mode & RT_HT_CAP_USE_LONG_PREAMBLE)) */) + { // Short Slot Time @@ -81250,34 +58562,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; + } + } ++ else if( pmlmeext->cur_wireless_mode & (WIRELESS_11_24N | WIRELESS_11A | WIRELESS_11_5N | WIRELESS_11AC)) ++ { ++ pmlmeinfo->slotTime = SHORT_SLOT_TIME; ++ } + else + { + //B Mode + pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; + } -+ } -+ ++ } ++ + rtw_hal_set_hwreg( Adapter, HW_VAR_SLOT_TIME, &pmlmeinfo->slotTime ); + +} + -+/* -+* set adapter.mlmeextpriv.mlmext_info.HT_enable -+* set adapter.mlmeextpriv.cur_wireless_mode -+* set SIFS register -+* set mgmt tx rate -+*/ +void update_wireless_mode(_adapter *padapter) +{ + int ratelen, network_type = 0; + u32 SIFS_Timer; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + unsigned char *rate = cur_network->SupportedRates; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif //CONFIG_P2P + + ratelen = rtw_get_rateset_len(cur_network->SupportedRates); + @@ -81301,12 +58608,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + network_type = WIRELESS_11AC; + else if (pmlmeinfo->HT_enable) + network_type = WIRELESS_11_24N; -+ -+ if ((cckratesonly_included(rate, ratelen)) == _TRUE) ++ ++ if ((cckratesonly_included(rate, ratelen)) == true) + { + network_type |= WIRELESS_11B; + } -+ else if((cckrates_included(rate, ratelen)) == _TRUE) ++ else if((cckrates_included(rate, ratelen)) == true) + { + network_type |= WIRELESS_11BG; + } @@ -81317,7 +58624,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + } + + pmlmeext->cur_wireless_mode = network_type & padapter->registrypriv.wireless_mode; -+ /* DBG_871X("network_type=%02x, padapter->registrypriv.wireless_mode=%02x\n", network_type, padapter->registrypriv.wireless_mode); */ +/* + if((pmlmeext->cur_wireless_mode==WIRELESS_11G) || + (pmlmeext->cur_wireless_mode==WIRELESS_11BG))//WIRELESS_MODE_G) @@ -81325,18 +58631,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + else + SIFS_Timer = 0x0e0e;//pHalData->SifsTime; //OFDM +*/ -+ ++ + SIFS_Timer = 0x0a0a0808; //0x0808 -> for CCK, 0x0a0a -> for OFDM + //change this value if having IOT issues. -+ -+ rtw_hal_set_hwreg( padapter, HW_VAR_RESP_SIFS, (u8 *)&SIFS_Timer); + -+ rtw_hal_set_hwreg( padapter, HW_VAR_WIRELESS_MODE, (u8 *)&(pmlmeext->cur_wireless_mode)); ++ padapter->HalFunc.SetHwRegHandler( padapter, HW_VAR_RESP_SIFS, (u8 *)&SIFS_Timer); + -+ if ((pmlmeext->cur_wireless_mode & WIRELESS_11B) -+ && rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ padapter->HalFunc.SetHwRegHandler( padapter, HW_VAR_WIRELESS_MODE, (u8 *)&(pmlmeext->cur_wireless_mode)); ++ ++ if (pmlmeext->cur_wireless_mode & WIRELESS_11B) + update_mgnt_tx_rate(padapter, IEEE80211_CCK_RATE_1MB); -+ else ++ else + update_mgnt_tx_rate(padapter, IEEE80211_OFDM_RATE_6MB); +} + @@ -81351,35 +58656,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + if ((ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) + { + return; -+ } ++ } + -+ if ((pwriteMacPara = (struct reg_rw_parm*)rtw_malloc(sizeof(struct reg_rw_parm))) == NULL) -+ { ++ if ((pwriteMacPara = (struct reg_rw_parm*)rtw_malloc(sizeof(struct reg_rw_parm))) == NULL) ++ { + rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); + return; + } -+ ++ + pwriteMacPara->rw = 1; + pwriteMacPara->addr = addr; + pwriteMacPara->value = value; -+ ++ + init_h2fwcmd_w_parm_no_rsp(ph2c, pwriteMacPara, GEN_CMD_CODE(_Write_MACREG)); + rtw_enqueue_cmd(pcmdpriv, ph2c); -+#endif ++#endif +} + -+void update_sta_basic_rate(struct sta_info *psta, u8 wireless_mode) ++void update_bmc_sta_support_rate(_adapter *padapter, u32 mac_id) +{ -+ if(IsSupportedTxCCK(wireless_mode)) ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ if(pmlmeext->cur_wireless_mode & WIRELESS_11B) + { + // Only B, B/G, and B/G/N AP could use CCK rate -+ _rtw_memcpy(psta->bssrateset, rtw_basic_rate_cck, 4); -+ psta->bssratelen = 4; ++ _rtw_memcpy((pmlmeinfo->FW_sta_info[mac_id].SupportedRates), rtw_basic_rate_cck, 4); + } + else + { -+ _rtw_memcpy(psta->bssrateset, rtw_basic_rate_ofdm, 3); -+ psta->bssratelen = 3; ++ _rtw_memcpy((pmlmeinfo->FW_sta_info[mac_id].SupportedRates), rtw_basic_rate_ofdm, 4); + } +} + @@ -81390,16 +58696,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + int supportRateNum = 0; + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ ++ + pIE = (PNDIS_802_11_VARIABLE_IEs)rtw_get_ie(pvar_ie, _SUPPORTEDRATES_IE_, &ie_len, var_ie_len); + if (pIE == NULL) + { + return _FAIL; + } -+ ++ + _rtw_memcpy(pmlmeinfo->FW_sta_info[cam_idx].SupportedRates, pIE->data, ie_len); + supportRateNum = ie_len; -+ ++ + pIE = (PNDIS_802_11_VARIABLE_IEs)rtw_get_ie(pvar_ie, _EXT_SUPPORTEDRATES_IE_, &ie_len, var_ie_len); + if (pIE) + { @@ -81407,51 +58713,55 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + } + + return _SUCCESS; -+ ++ +} + +void process_addba_req(_adapter *padapter, u8 *paddba_req, u8 *addr) +{ + struct sta_info *psta; -+ u16 tid, start_seq, param; -+ struct sta_priv *pstapriv = &padapter->stapriv; ++ u16 tid, start_seq, param; ++ struct recv_reorder_ctrl *preorder_ctrl; ++ struct sta_priv *pstapriv = &padapter->stapriv; + struct ADDBA_request *preq = (struct ADDBA_request*)paddba_req; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 size, accept = _FALSE; + + psta = rtw_get_stainfo(pstapriv, addr); -+ if (!psta) -+ goto exit; + -+ start_seq = le16_to_cpu(preq->BA_starting_seqctrl) >> 4; ++ if(psta) ++ { ++ start_seq = le16_to_cpu(preq->BA_starting_seqctrl) >> 4; + -+ param = le16_to_cpu(preq->BA_para_set); -+ tid = (param>>2)&0x0f; ++ param = le16_to_cpu(preq->BA_para_set); ++ tid = (param>>2)&0x0f; + ++ preorder_ctrl = &psta->recvreorder_ctrl[tid]; + -+ accept = rtw_rx_ampdu_is_accept(padapter); -+ size = rtw_rx_ampdu_size(padapter); ++ #ifdef CONFIG_UPDATE_INDICATE_SEQ_WHILE_PROCESS_ADDBA_REQ ++ preorder_ctrl->indicate_seq = start_seq; ++ #ifdef DBG_RX_SEQ ++ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, start_seq: %d\n", __FUNCTION__, __LINE__, ++ preorder_ctrl->indicate_seq, start_seq); ++ #endif ++ #else ++ preorder_ctrl->indicate_seq = 0xffff; ++ #endif + -+ if (accept == _TRUE) -+ rtw_addbarsp_cmd(padapter, addr, tid, 0, size, start_seq); -+ else -+ rtw_addbarsp_cmd(padapter, addr, tid, 37, size, start_seq); /* reject ADDBA Req */ ++ preorder_ctrl->enable =(pmlmeinfo->bAcceptAddbaReq == true)? true :false; ++ } + -+exit: -+ return; +} + +void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len) -+{ ++{ + u8* pIE; -+ u32 *pbuf; -+ ++ __le32 *pbuf; ++ + pIE = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ pbuf = (u32*)pIE; ++ pbuf = ((__le32*)pIE); + + pmlmeext->TSFValue = le32_to_cpu(*(pbuf+1)); -+ ++ + pmlmeext->TSFValue = pmlmeext->TSFValue << 32; + + pmlmeext->TSFValue |= le32_to_cpu(*pbuf); @@ -81459,382 +58769,103 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + +void correct_TSF(_adapter *padapter, struct mlme_ext_priv *pmlmeext) +{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CORRECT_TSF, 0); ++ rtw_hal_set_hwreg(padapter, HW_VAR_CORRECT_TSF, NULL); +} + -+void adaptive_early_32k(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len) -+{ -+ int i; -+ u8* pIE; -+ u32 *pbuf; -+ u64 tsf=0; -+ u32 delay_ms; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ pmlmeext->bcn_cnt++; -+ -+ pIE = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ pbuf = (u32*)pIE; -+ -+ tsf = le32_to_cpu(*(pbuf+1)); -+ tsf = tsf << 32; -+ tsf |= le32_to_cpu(*pbuf); -+ -+ //DBG_871X("%s(): tsf_upper= 0x%08x, tsf_lower=0x%08x\n", __func__, (u32)(tsf>>32), (u32)tsf); -+ -+ //delay = (timestamp mod 1024*100)/1000 (unit: ms) -+ //delay_ms = do_div(tsf, (pmlmeinfo->bcn_interval*1024))/1000; -+ delay_ms = rtw_modular64(tsf, (pmlmeinfo->bcn_interval*1024)); -+ delay_ms = delay_ms/1000; -+ -+ if(delay_ms >= 8) -+ { -+ pmlmeext->bcn_delay_cnt[8]++; -+ //pmlmeext->bcn_delay_ratio[8] = (pmlmeext->bcn_delay_cnt[8] * 100) /pmlmeext->bcn_cnt; -+ } -+ else -+ { -+ pmlmeext->bcn_delay_cnt[delay_ms]++; -+ //pmlmeext->bcn_delay_ratio[delay_ms] = (pmlmeext->bcn_delay_cnt[delay_ms] * 100) /pmlmeext->bcn_cnt; -+ } -+ -+/* -+ DBG_871X("%s(): (a)bcn_cnt = %d\n", __func__, pmlmeext->bcn_cnt); -+ -+ -+ for(i=0; i<9; i++) -+ { -+ DBG_871X("%s():bcn_delay_cnt[%d]=%d, bcn_delay_ratio[%d]=%d\n", __func__, i, -+ pmlmeext->bcn_delay_cnt[i] , i, pmlmeext->bcn_delay_ratio[i]); -+ } -+*/ -+ -+ //dump for adaptive_early_32k -+ if(pmlmeext->bcn_cnt > 100 && (pmlmeext->adaptive_tsf_done==_TRUE)) -+ { -+ u8 ratio_20_delay, ratio_80_delay; -+ u8 DrvBcnEarly, DrvBcnTimeOut; -+ -+ ratio_20_delay = 0; -+ ratio_80_delay = 0; -+ DrvBcnEarly = 0xff; -+ DrvBcnTimeOut = 0xff; -+ -+ DBG_871X("%s(): bcn_cnt = %d\n", __func__, pmlmeext->bcn_cnt); -+ -+ for(i=0; i<9; i++) -+ { -+ pmlmeext->bcn_delay_ratio[i] = (pmlmeext->bcn_delay_cnt[i] * 100) /pmlmeext->bcn_cnt; -+ -+ -+ //DBG_871X("%s():bcn_delay_cnt[%d]=%d, bcn_delay_ratio[%d]=%d\n", __func__, i, -+ // pmlmeext->bcn_delay_cnt[i] , i, pmlmeext->bcn_delay_ratio[i]); -+ -+ ratio_20_delay += pmlmeext->bcn_delay_ratio[i]; -+ ratio_80_delay += pmlmeext->bcn_delay_ratio[i]; -+ -+ if(ratio_20_delay > 20 && DrvBcnEarly == 0xff) -+ { -+ DrvBcnEarly = i; -+ //DBG_871X("%s(): DrvBcnEarly = %d\n", __func__, DrvBcnEarly); -+ } -+ -+ if(ratio_80_delay > 80 && DrvBcnTimeOut == 0xff) -+ { -+ DrvBcnTimeOut = i; -+ //DBG_871X("%s(): DrvBcnTimeOut = %d\n", __func__, DrvBcnTimeOut); -+ } -+ -+ //reset adaptive_early_32k cnt -+ pmlmeext->bcn_delay_cnt[i] = 0; -+ pmlmeext->bcn_delay_ratio[i] = 0; -+ } -+ -+ pmlmeext->DrvBcnEarly = DrvBcnEarly; -+ pmlmeext->DrvBcnTimeOut = DrvBcnTimeOut; -+ -+ pmlmeext->bcn_cnt = 0; -+ } -+ -+} -+ -+ +void beacon_timing_control(_adapter *padapter) +{ + rtw_hal_bcn_related_reg_setting(padapter); +} + -+#define CONFIG_SHARED_BMC_MACID -+ -+void dump_macid_map(void *sel, struct macid_bmp *map, u8 max_num) ++uint rtw_get_camid(uint macid) +{ -+ DBG_871X_SEL_NL(sel, "0x%08x\n", map->m0); -+#if (MACID_NUM_SW_LIMIT > 32) -+ if (max_num && max_num > 32) -+ DBG_871X_SEL_NL(sel, "0x%08x\n", map->m1); -+#endif -+#if (MACID_NUM_SW_LIMIT > 64) -+ if (max_num && max_num > 64) -+ DBG_871X_SEL_NL(sel, "0x%08x\n", map->m2); -+#endif -+#if (MACID_NUM_SW_LIMIT > 96) -+ if (max_num && max_num > 96) -+ DBG_871X_SEL_NL(sel, "0x%08x\n", map->m3); -+#endif -+} ++ uint camid; + -+inline bool rtw_macid_is_set(struct macid_bmp *map, u8 id) -+{ -+ if (id < 32) -+ return (map->m0 & BIT(id)); -+#if (MACID_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ return (map->m1 & BIT(id-32)); -+#endif -+#if (MACID_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ return (map->m2 & BIT(id-64)); -+#endif -+#if (MACID_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ return (map->m3 & BIT(id-96)); -+#endif ++ //camid 0, 1, 2, 3 is default entry for default key/group key ++ //macid = 1 is for bc/mc stainfo, no mapping to camid ++ //macid = 0 mapping to camid 4 ++ //for macid >=2, camid = macid+3; ++ ++ if(macid==0) ++ camid = 4; ++ else if(macid >=2) ++ camid = macid + 3; + else -+ rtw_warn_on(1); ++ camid = 4; + -+ return 0; -+} -+ -+inline void rtw_macid_map_set(struct macid_bmp *map, u8 id) -+{ -+ if (id < 32) -+ map->m0 |= BIT(id); -+#if (MACID_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ map->m1 |= BIT(id-32); -+#endif -+#if (MACID_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ map->m2 |= BIT(id-64); -+#endif -+#if (MACID_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ map->m3 |= BIT(id-96); -+#endif -+ else -+ rtw_warn_on(1); -+} -+ -+inline void rtw_macid_map_clr(struct macid_bmp *map, u8 id) -+{ -+ if (id < 32) -+ map->m0 &= ~BIT(id); -+#if (MACID_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ map->m1 &= ~BIT(id-32); -+#endif -+#if (MACID_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ map->m2 &= ~BIT(id-64); -+#endif -+#if (MACID_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ map->m3 &= ~BIT(id-96); -+#endif -+ else -+ rtw_warn_on(1); -+} -+ -+inline bool rtw_macid_is_used(struct macid_ctl_t *macid_ctl, u8 id) -+{ -+ return rtw_macid_is_set(&macid_ctl->used, id); -+} -+ -+inline bool rtw_macid_is_bmc(struct macid_ctl_t *macid_ctl, u8 id) -+{ -+ return rtw_macid_is_set(&macid_ctl->bmc, id); -+} -+ -+inline s8 rtw_macid_get_if_g(struct macid_ctl_t *macid_ctl, u8 id) -+{ -+ int i; -+ -+#ifdef CONFIG_SHARED_BMC_MACID -+ if (rtw_macid_is_bmc(macid_ctl,id)) -+ return -1; -+#endif -+ -+ for (i=0;iif_g[i], id)) -+ return i; -+ } -+ return -1; -+} -+ -+inline s8 rtw_macid_get_ch_g(struct macid_ctl_t *macid_ctl, u8 id) -+{ -+ int i; -+ -+ for (i=0;i<2;i++) { -+ if (rtw_macid_is_set(&macid_ctl->ch_g[i], id)) -+ return i; -+ } -+ return -1; ++ return camid; +} + +void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta) +{ + int i; -+ _irqL irqL; ++ _irqL irqL; + u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ struct macid_bmp *used_map = &macid_ctl->used; -+ //static u8 last_id = 0; /* for testing */ -+ u8 last_id = 0; ++ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); + -+ if (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), ETH_ALEN)) { -+ psta->mac_id = macid_ctl->num; ++ ++ if(_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) ++ return; ++ ++ if(_rtw_memcmp(psta->hwaddr, myid(&padapter->eeprompriv), ETH_ALEN)) ++ { ++ psta->mac_id = NUM_STA; + return; + } + -+#ifdef CONFIG_SHARED_BMC_MACID -+ if(_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) { -+ /* use shared broadcast & multicast macid 1 */ -+ _enter_critical_bh(&macid_ctl->lock, &irqL); -+ rtw_macid_map_set(used_map, 1); -+ rtw_macid_map_set(&macid_ctl->bmc, 1); -+ for (i=0;iif_g[padapter->iface_id], 1); -+ /* TODO ch_g? */ -+ _exit_critical_bh(&macid_ctl->lock, &irqL); -+ i = 1; -+ goto assigned; -+ } -+#endif -+ -+ _enter_critical_bh(&macid_ctl->lock, &irqL); -+ -+ for (i=last_id;inum;i++) { -+ #ifdef CONFIG_SHARED_BMC_MACID -+ if (i == 1) -+ continue; -+ #endif -+ if (!rtw_macid_is_used(macid_ctl, i)) ++ _enter_critical_bh(&pdvobj->lock, &irqL); ++ for(i=0; imacid[i] == false) ++ { ++ pdvobj->macid[i] = true; + break; ++ } ++ } ++ _exit_critical_bh(&pdvobj->lock, &irqL); ++ ++ if( i > (NUM_STA-1)) ++ { ++ psta->mac_id = NUM_STA; ++ DBG_871X(" no room for more MACIDs\n"); ++ } ++ else ++ { ++ psta->mac_id = i; ++ DBG_871X("%s = %d\n", __FUNCTION__, psta->mac_id); + } + -+ if (i < macid_ctl->num) { -+ -+ rtw_macid_map_set(used_map, i); -+ -+ if(_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) -+ rtw_macid_map_set(&macid_ctl->bmc, i); -+ -+ rtw_macid_map_set(&macid_ctl->if_g[padapter->iface_id], i); -+ -+ /* TODO ch_g? */ -+ -+ last_id++; -+ last_id %= macid_ctl->num; -+ } -+ -+ _exit_critical_bh(&macid_ctl->lock, &irqL); -+ -+ if (i >= macid_ctl->num) { -+ psta->mac_id = macid_ctl->num; -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" no available macid\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id+1, MAC_ARG(psta->hwaddr)); -+ rtw_warn_on(1); -+ goto exit; -+ } else { -+ goto assigned; -+ } -+ -+assigned: -+ psta->mac_id = i; -+ DBG_871X(FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" macid:%u\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id+1, MAC_ARG(psta->hwaddr), psta->mac_id); -+ -+exit: -+ return; +} + +void rtw_release_macid(_adapter *padapter, struct sta_info *psta) +{ -+ _irqL irqL; ++ int i; ++ _irqL irqL; + u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); ++ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); + -+ if (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), ETH_ALEN)) -+ return; + -+#ifdef CONFIG_SHARED_BMC_MACID + if(_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) + return; + -+ if (psta->mac_id == 1) { -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" with macid:%u\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id+1, MAC_ARG(psta->hwaddr), psta->mac_id); -+ rtw_warn_on(1); ++ if(_rtw_memcmp(psta->hwaddr, myid(&padapter->eeprompriv), ETH_ALEN)) ++ { + return; + } -+#endif + -+ _enter_critical_bh(&macid_ctl->lock, &irqL); -+ -+ if (psta->mac_id < macid_ctl->num) { -+ int i; -+ -+ if (!rtw_macid_is_used(macid_ctl, psta->mac_id)) { -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" macid:%u not used\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id+1, MAC_ARG(psta->hwaddr), psta->mac_id); -+ rtw_warn_on(1); ++ _enter_critical_bh(&pdvobj->lock, &irqL); ++ if(psta->mac_idmac_id !=1 ) ++ { ++ if(pdvobj->macid[psta->mac_id] == true) ++ { ++ DBG_871X("%s = %d\n", __FUNCTION__, psta->mac_id); ++ pdvobj->macid[psta->mac_id] = false; ++ psta->mac_id = NUM_STA; + } + -+ rtw_macid_map_clr(&macid_ctl->used, psta->mac_id); -+ rtw_macid_map_clr(&macid_ctl->bmc, psta->mac_id); -+ for (i=0;iif_g[i], psta->mac_id); -+ for (i=0;i<2;i++) -+ rtw_macid_map_clr(&macid_ctl->ch_g[i], psta->mac_id); + } ++ _exit_critical_bh(&pdvobj->lock, &irqL); + -+ _exit_critical_bh(&macid_ctl->lock, &irqL); -+ -+ psta->mac_id = macid_ctl->num; -+} -+ -+//For 8188E RA -+u8 rtw_search_max_mac_id(_adapter *padapter) -+{ -+ u8 max_mac_id=0; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ int i; -+ _irqL irqL; -+ -+ _enter_critical_bh(&macid_ctl->lock, &irqL); -+ for(i=(macid_ctl->num-1); i>0 ; i--) { -+ if (!rtw_macid_is_used(macid_ctl, i)) -+ break; -+ } -+ _exit_critical_bh(&macid_ctl->lock, &irqL); -+ max_mac_id = i; -+ -+ return max_mac_id; -+} -+ -+inline void rtw_macid_ctl_init(struct macid_ctl_t *macid_ctl) -+{ -+ _rtw_spinlock_init(&macid_ctl->lock); -+} -+ -+inline void rtw_macid_ctl_deinit(struct macid_ctl_t *macid_ctl) -+{ -+ _rtw_spinlock_free(&macid_ctl->lock); +} + +#if 0 @@ -81842,32 +58873,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 +{ + unsigned short ATIMWindow; + unsigned char *pframe; -+ struct tx_desc *ptxdesc; -+ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct tx_desc *ptxdesc; ++ struct rtw_ieee80211_hdr *pwlanhdr; + unsigned short *fctrl; + unsigned int rate_len, len = 0; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ ++ + _rtw_memset(beacon_frame, 0, 256); -+ ++ + pframe = beacon_frame + TXDESC_SIZE; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ + fctrl = &(pwlanhdr->frame_ctl); + *(fctrl) = 0; -+ ++ + _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); -+ ++ + SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); + len = sizeof(struct rtw_ieee80211_hdr_3addr); + + //timestamp will be inserted by hardware @@ -81875,7 +58906,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + len += 8; + + // beacon interval: 2 bytes -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); ++ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); + + pframe += 2; + len += 2; @@ -81902,7 +58933,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &len); + + //todo: ERP IE -+ ++ + // EXTERNDED SUPPORTED RATE + if (rate_len > 8) + { @@ -81917,732 +58948,88 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_wlan_util.c linux/3rdparty/rtl8 + + //fill the tx descriptor + ptxdesc = (struct tx_desc *)beacon_frame; -+ -+ //offset 0 -+ ptxdesc->txdw0 |= cpu_to_le32(len & 0x0000ffff); ++ ++ //offset 0 ++ ptxdesc->txdw0 |= cpu_to_le32(len & 0x0000ffff); + ptxdesc->txdw0 |= cpu_to_le32(((TXDESC_SIZE + OFFSET_SZ) << OFFSET_SHT) & 0x00ff0000); //default = 32 bytes for TX Desc -+ -+ //offset 4 ++ ++ //offset 4 + ptxdesc->txdw1 |= cpu_to_le32((0x10 << QSEL_SHT) & 0x00001f00); -+ -+ //offset 8 ++ ++ //offset 8 + ptxdesc->txdw2 |= cpu_to_le32(BMC); + ptxdesc->txdw2 |= cpu_to_le32(BK); + -+ //offset 16 ++ //offset 16 + ptxdesc->txdw4 = 0x80000000; -+ ++ + //offset 20 -+ ptxdesc->txdw5 = 0x00000000; //1M -+ ++ ptxdesc->txdw5 = 0x00000000; //1M ++ + return (len + TXDESC_SIZE); +} +#endif + -+_adapter *dvobj_get_port0_adapter(struct dvobj_priv *dvobj) ++static _adapter *pbuddy_padapter = NULL; ++ ++int rtw_handle_dualmac(_adapter *adapter, bool init) +{ -+ _adapter *port0_iface = NULL; -+ int i; -+ for (i=0;iiface_nums;i++) { -+ if (get_iface_type(dvobj->padapters[i]) == IFACE_PORT0) -+ break; -+ } ++ int status = _SUCCESS; ++ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + -+ if (i<0 || i>=dvobj->iface_nums) -+ rtw_warn_on(1); -+ else -+ port0_iface = dvobj->padapters[i]; ++ if(adapter->chip_type != RTL8192D) ++ goto exit; + -+ return port0_iface; -+} -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void rtw_get_current_ip_address(PADAPTER padapter, u8 *pcurrentip) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct in_device *my_ip_ptr = padapter->pnetdev->ip_ptr; -+ u8 ipaddress[4]; -+ -+ if ( (pmlmeinfo->state & WIFI_FW_LINKING_STATE) || -+ pmlmeinfo->state & WIFI_FW_AP_STATE) { -+ if ( my_ip_ptr != NULL ) { -+ struct in_ifaddr *my_ifa_list = my_ip_ptr->ifa_list ; -+ if ( my_ifa_list != NULL ) { -+ ipaddress[0] = my_ifa_list->ifa_address & 0xFF; -+ ipaddress[1] = (my_ifa_list->ifa_address >> 8) & 0xFF; -+ ipaddress[2] = (my_ifa_list->ifa_address >> 16) & 0xFF; -+ ipaddress[3] = my_ifa_list->ifa_address >> 24; -+ DBG_871X("%s: %d.%d.%d.%d ==========\n", __func__, -+ ipaddress[0], ipaddress[1], ipaddress[2], ipaddress[3]); -+ _rtw_memcpy(pcurrentip, ipaddress, 4); -+ } ++ if (init) { ++ #if 0 ++ /* For SMSP on 92DU-VC, driver do not probe another Interface. */ ++ if(dvobj->NumInterfaces == 2 && dvobj->InterfaceNumber != 0 && ++ adapter->registrypriv.mac_phy_mode == 1) { ++ DBG_871X("%s(): Do not init another USB Interface because SMSP\n",__FUNCTION__); ++ status = _FAIL; ++ goto exit; ++ } ++ #endif ++ ++ if (pbuddy_padapter == NULL) { ++ pbuddy_padapter = adapter; ++ DBG_871X("%s(): pbuddy_padapter == NULL, Set pbuddy_padapter\n",__FUNCTION__); ++ } else { ++ adapter->pbuddy_adapter = pbuddy_padapter; ++ pbuddy_padapter->pbuddy_adapter = adapter; ++ // clear global value ++ pbuddy_padapter = NULL; ++ DBG_871X("%s(): pbuddy_padapter exist, Exchange Information\n",__FUNCTION__); ++ } ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ if (dvobj->InterfaceNumber == 0) { ++ //set adapter_type/iface type ++ adapter->isprimary = true; ++ adapter->adapter_type = PRIMARY_ADAPTER; ++ adapter->iface_type = IFACE_PORT0; ++ DBG_871X("%s(): PRIMARY_ADAPTER\n",__FUNCTION__); ++ } else { ++ //set adapter_type/iface type ++ adapter->isprimary = false; ++ adapter->adapter_type = SECONDARY_ADAPTER; ++ adapter->iface_type = IFACE_PORT1; ++ DBG_871X("%s(): SECONDARY_ADAPTER\n",__FUNCTION__); + } -+ } -+} +#endif -+#ifdef CONFIG_WOWLAN -+bool rtw_check_pattern_valid(u8 *input, u8 len) -+{ -+ int i = 0; -+ bool res = _FALSE; -+ -+ for (i = 0 ; i < len ; i++) { -+ if ((input[i] <= '9' && input[i] >= '0') || -+ (input[i] <= 'F' && input[i] >= 'A') || -+ (input[i] <= 'f' && input[i] >= 'a')) -+ res = _TRUE; -+ else -+ res = _FALSE; ++ }else { ++ pbuddy_padapter = NULL; + } -+ return res; ++exit: ++ return status; +} -+ -+bool rtw_read_from_frame_mask(_adapter *adapter, u8 idx) -+{ -+ u32 data_l = 0, data_h = 0, rx_dma_buff_sz = 0, page_sz = 0; -+ u16 offset, rx_buf_ptr = 0; -+ u16 cam_start_offset = 0; -+ u16 ctrl_l = 0, ctrl_h = 0; -+ u8 count = 0, tmp = 0; -+ int i = 0; -+ bool res = _TRUE; -+ -+ if (idx > MAX_WKFM_NUM) { -+ DBG_871X("[Error]: %s, pattern index is out of range\n", -+ __func__); -+ return _FALSE; -+ } -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ_WOW, -+ (u8 *)&rx_dma_buff_sz); -+ -+ if (rx_dma_buff_sz == 0) { -+ DBG_871X("[Error]: %s, rx_dma_buff_sz is 0!!\n", __func__); -+ return _FALSE; -+ } -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_PAGE_SIZE, (u8 *)&page_sz); -+ -+ if (page_sz == 0) { -+ DBG_871X("[Error]: %s, page_sz is 0!!\n", __func__); -+ return _FALSE; -+ } -+ -+ offset = (u16)PageNum(rx_dma_buff_sz, page_sz); -+ cam_start_offset = offset * page_sz; -+ -+ ctrl_l = 0x0; -+ ctrl_h = 0x0; -+ -+ /* Enable RX packet buffer access */ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, RXPKT_BUF_SELECT); -+ -+ /* Read the WKFM CAM */ -+ for (i = 0; i < (WKFMCAM_ADDR_NUM / 2); i++) { -+ /* -+ * Set Rx packet buffer offset. -+ * RxBufer pointer increases 1, we can access 8 bytes in Rx packet buffer. -+ * CAM start offset (unit: 1 byte) = Index*WKFMCAM_SIZE -+ * RxBufer pointer addr = (CAM start offset + per entry offset of a WKFMCAM)/8 -+ * * Index: The index of the wake up frame mask -+ * * WKFMCAM_SIZE: the total size of one WKFM CAM -+ * * per entry offset of a WKFM CAM: Addr i * 4 bytes -+ */ -+ rx_buf_ptr = -+ (cam_start_offset + idx*WKFMCAM_SIZE + i*8) >> 3; -+ rtw_write16(adapter, REG_PKTBUF_DBG_CTRL, rx_buf_ptr); -+ -+ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); -+ data_l = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L); -+ data_h = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H); -+ -+ DBG_871X("[%d]: %08x %08x\n", i, data_h, data_l); -+ -+ count = 0; -+ -+ do { -+ tmp = rtw_read8(adapter, REG_RXPKTBUF_CTRL); -+ rtw_udelay_os(2); -+ count++; -+ } while (!tmp && count < 100); -+ -+ if (count >= 100) { -+ DBG_871X("%s count:%d\n", __func__, count); -+ res = _FALSE; -+ } -+ } -+ -+ /* Disable RX packet buffer access */ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, -+ DISABLE_TRXPKT_BUF_ACCESS); -+ return res; -+} -+ -+bool rtw_write_to_frame_mask(_adapter *adapter, u8 idx, -+ struct rtl_wow_pattern *context) -+{ -+ u32 data = 0, rx_dma_buff_sz = 0, page_sz = 0; -+ u16 offset, rx_buf_ptr = 0; -+ u16 cam_start_offset = 0; -+ u16 ctrl_l = 0, ctrl_h = 0; -+ u8 count = 0, tmp = 0; -+ int res = 0, i = 0; -+ -+ if (idx > MAX_WKFM_NUM) { -+ DBG_871X("[Error]: %s, pattern index is out of range\n", -+ __func__); -+ return _FALSE; -+ } -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ_WOW, -+ (u8 *)&rx_dma_buff_sz); -+ -+ if (rx_dma_buff_sz == 0) { -+ DBG_871X("[Error]: %s, rx_dma_buff_sz is 0!!\n", __func__); -+ return _FALSE; -+ } -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_PAGE_SIZE, (u8 *)&page_sz); -+ -+ if (page_sz == 0) { -+ DBG_871X("[Error]: %s, page_sz is 0!!\n", __func__); -+ return _FALSE; -+ } -+ -+ offset = (u16)PageNum(rx_dma_buff_sz, page_sz); -+ -+ cam_start_offset = offset * page_sz; -+ -+ if (IS_HARDWARE_TYPE_8188E(adapter)) { -+ ctrl_l = 0x0001; -+ ctrl_h = 0x0001; -+ } else { -+ ctrl_l = 0x0f01; -+ ctrl_h = 0xf001; -+ } -+ -+ /* Enable RX packet buffer access */ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, RXPKT_BUF_SELECT); -+ -+ /* Write the WKFM CAM */ -+ for (i = 0; i < WKFMCAM_ADDR_NUM; i++) { -+ /* -+ * Set Rx packet buffer offset. -+ * RxBufer pointer increases 1, we can access 8 bytes in Rx packet buffer. -+ * CAM start offset (unit: 1 byte) = Index*WKFMCAM_SIZE -+ * RxBufer pointer addr = (CAM start offset + per entry offset of a WKFMCAM)/8 -+ * * Index: The index of the wake up frame mask -+ * * WKFMCAM_SIZE: the total size of one WKFM CAM -+ * * per entry offset of a WKFM CAM: Addr i * 4 bytes -+ */ -+ rx_buf_ptr = -+ (cam_start_offset + idx*WKFMCAM_SIZE + i*4) >> 3; -+ rtw_write16(adapter, REG_PKTBUF_DBG_CTRL, rx_buf_ptr); -+ -+ if (i == 0) { -+ if (context->type == PATTERN_VALID) -+ data = BIT(31) | context->crc; -+ else if (context->type == PATTERN_BROADCAST) -+ data |= BIT(26); -+ else if (context->type == PATTERN_MULTICAST) -+ data |= BIT(25); -+ else if (context->type == PATTERN_UNICAST) -+ data |= BIT(24); -+ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_L, data); -+ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); -+ } else if (i == 1) { -+ data = 0; -+ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, data); -+ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_h); -+ } else if (i == 2 || i == 4) { -+ data = context->mask[i - 2]; -+ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_L, data); -+ /* write to RX packet buffer*/ -+ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); -+ } else if (i == 3 || i == 5) { -+ data = context->mask[i - 2]; -+ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, data); -+ /* write to RX packet buffer*/ -+ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_h); -+ } -+ -+ count = 0; -+ do { -+ tmp = rtw_read8(adapter, REG_RXPKTBUF_CTRL); -+ rtw_udelay_os(2); -+ count++; -+ } while (tmp && count < 100); -+ -+ if (count >= 100) -+ res = _FALSE; -+ else -+ res = _TRUE; -+ } -+ -+ /* Disable RX packet buffer access */ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, -+ DISABLE_TRXPKT_BUF_ACCESS); -+ -+ return res; -+} -+ -+ -+void rtw_dump_priv_pattern(_adapter *adapter, u8 idx) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ char str_1[128]; -+ char *p_str; -+ u8 val8 = 0; -+ int i = 0, j = 0, len = 0, max_len = 0; -+ -+ DBG_871X("=========[%d]========\n", idx); -+ -+ DBG_871X(">>>priv_pattern_content:\n"); -+ p_str = str_1; -+ max_len = sizeof(str_1); -+ for (i = 0 ; i < MAX_WKFM_PATTERN_SIZE/8 ; i++) { -+ _rtw_memset(p_str, 0, max_len); -+ len = 0; -+ for (j = 0 ; j < 8 ; j++) { -+ val8 = pwrctl->patterns[idx].content[i*8 + j]; -+ len += snprintf(p_str + len, max_len - len, -+ "%02x ", val8); -+ } -+ DBG_871X("%s\n", p_str); -+ } -+ -+ DBG_871X(">>>priv_pattern_mask:\n"); -+ for (i = 0 ; i < MAX_WKFM_SIZE/8 ; i++) { -+ _rtw_memset(p_str, 0, max_len); -+ len = 0; -+ for (j = 0 ; j < 8 ; j++) { -+ val8 = pwrctl->patterns[idx].mask[i*8 + j]; -+ len += snprintf(p_str + len, max_len - len, -+ "%02x ", val8); -+ } -+ DBG_871X("%s\n", p_str); -+ } -+} -+ -+void rtw_clean_pattern(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct rtl_wow_pattern zero_pattern; -+ int i = 0; -+ -+ _rtw_memset(&zero_pattern, 0, sizeof(struct rtl_wow_pattern)); -+ -+ zero_pattern.type = PATTERN_INVALID; -+ -+ for (i = 0; i < MAX_WKFM_NUM; i++) -+ rtw_write_to_frame_mask(adapter, i, &zero_pattern); -+ -+ pwrctl->wowlan_pattern_idx = 0; -+ rtw_write8(adapter, REG_WKFMCAM_NUM, pwrctl->wowlan_pattern_idx); -+} -+ -+void rtw_get_sec_iv(PADAPTER padapter, u8*pcur_dot11txpn, u8 *StaAddr) -+{ -+ struct sta_info *psta; -+ struct security_priv *psecpriv = &padapter->securitypriv; -+ -+ _rtw_memset(pcur_dot11txpn, 0, 8); -+ if(NULL == StaAddr) -+ return; -+ psta = rtw_get_stainfo(&padapter->stapriv, StaAddr); -+ DBG_871X("%s(): StaAddr: %02x %02x %02x %02x %02x %02x\n", -+ __func__, StaAddr[0], StaAddr[1], StaAddr[2], -+ StaAddr[3], StaAddr[4], StaAddr[5]); -+ -+ if(psta) -+ { -+ if (psecpriv->dot11PrivacyAlgrthm != _NO_PRIVACY_ && psta->dot11txpn.val > 0) -+ psta->dot11txpn.val--; -+ AES_IV(pcur_dot11txpn, psta->dot11txpn, 0); -+ -+ DBG_871X("%s(): CurrentIV: %02x %02x %02x %02x %02x %02x %02x %02x \n" -+ , __func__, pcur_dot11txpn[0],pcur_dot11txpn[1], -+ pcur_dot11txpn[2],pcur_dot11txpn[3], pcur_dot11txpn[4], -+ pcur_dot11txpn[5],pcur_dot11txpn[6],pcur_dot11txpn[7]); -+ } -+} -+void rtw_set_sec_pn(PADAPTER padapter) -+{ -+ struct sta_info *psta; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct security_priv *psecpriv = &padapter->securitypriv; -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, -+ get_my_bssid(&pmlmeinfo->network)); -+ -+ if(psta) -+ { -+ if (pwrpriv->wowlan_fw_iv > psta->dot11txpn.val) -+ { -+ if (psecpriv->dot11PrivacyAlgrthm != _NO_PRIVACY_) -+ psta->dot11txpn.val = pwrpriv->wowlan_fw_iv + 2; -+ } else { -+ DBG_871X("%s(): FW IV is smaller than driver\n", __func__); -+ psta->dot11txpn.val += 2; -+ } -+ DBG_871X("%s: dot11txpn: 0x%016llx\n", __func__ ,psta->dot11txpn.val); -+ } -+} -+#endif //CONFIG_WOWLAN -+ -+#ifdef CONFIG_PNO_SUPPORT -+#define CSCAN_TLV_TYPE_SSID_IE 'S' -+#define CIPHER_IE "key_mgmt=" -+#define CIPHER_NONE "NONE" -+#define CIPHER_WPA_PSK "WPA-PSK" -+#define CIPHER_WPA_EAP "WPA-EAP IEEE8021X" -+/* -+ * SSIDs list parsing from cscan tlv list -+ */ -+int rtw_parse_ssid_list_tlv(char** list_str, pno_ssid_t* ssid, -+ int max, int *bytes_left) { -+ char* str; -+ -+ int idx = 0; -+ -+ if ((list_str == NULL) || (*list_str == NULL) || (*bytes_left < 0)) { -+ DBG_871X("%s error paramters\n", __func__); -+ return -1; -+ } -+ -+ str = *list_str; -+ while (*bytes_left > 0) { -+ -+ if (str[0] != CSCAN_TLV_TYPE_SSID_IE) { -+ *list_str = str; -+ DBG_871X("nssid=%d left_parse=%d %d\n", idx, *bytes_left, str[0]); -+ return idx; -+ } -+ -+ /* Get proper CSCAN_TLV_TYPE_SSID_IE */ -+ *bytes_left -= 1; -+ str += 1; -+ -+ if (str[0] == 0) { -+ /* Broadcast SSID */ -+ ssid[idx].SSID_len = 0; -+ memset((char*)ssid[idx].SSID, 0x0, WLAN_SSID_MAXLEN); -+ *bytes_left -= 1; -+ str += 1; -+ -+ DBG_871X("BROADCAST SCAN left=%d\n", *bytes_left); -+ } -+ else if (str[0] <= WLAN_SSID_MAXLEN) { -+ /* Get proper SSID size */ -+ ssid[idx].SSID_len = str[0]; -+ *bytes_left -= 1; -+ str += 1; -+ -+ /* Get SSID */ -+ if (ssid[idx].SSID_len > *bytes_left) { -+ DBG_871X("%s out of memory range len=%d but left=%d\n", -+ __func__, ssid[idx].SSID_len, *bytes_left); -+ return -1; -+ } -+ -+ memcpy((char*)ssid[idx].SSID, str, ssid[idx].SSID_len); -+ -+ *bytes_left -= ssid[idx].SSID_len; -+ str += ssid[idx].SSID_len; -+ -+ DBG_871X("%s :size=%d left=%d\n", -+ (char*)ssid[idx].SSID, ssid[idx].SSID_len, *bytes_left); -+ } -+ else { -+ DBG_871X("### SSID size more that %d\n", str[0]); -+ return -1; -+ } -+ -+ if (idx++ > max) { -+ DBG_871X("%s number of SSIDs more that %d\n", __func__, idx); -+ return -1; -+ } -+ } -+ -+ *list_str = str; -+ return idx; -+} -+ -+int rtw_parse_cipher_list(struct pno_nlo_info *nlo_info, char* list_str) { -+ -+ char *pch, *pnext, *pend; -+ u8 key_len = 0, index = 0; -+ -+ pch = list_str; -+ -+ if (nlo_info == NULL || list_str == NULL) { -+ DBG_871X("%s error paramters\n", __func__); -+ return -1; -+ } -+ -+ while (strlen(pch) != 0) { -+ pnext = strstr(pch, "key_mgmt="); -+ if (pnext != NULL) { -+ pch = pnext + strlen(CIPHER_IE); -+ pend = strstr(pch, "}"); -+ if (strncmp(pch, CIPHER_NONE, -+ strlen(CIPHER_NONE)) == 0) { -+ nlo_info->ssid_cipher_info[index] = 0x00; -+ } else if (strncmp(pch, CIPHER_WPA_PSK, -+ strlen(CIPHER_WPA_PSK)) == 0) { -+ nlo_info->ssid_cipher_info[index] = 0x66; -+ } else if (strncmp(pch, CIPHER_WPA_EAP, -+ strlen(CIPHER_WPA_EAP)) == 0) { -+ nlo_info->ssid_cipher_info[index] = 0x01; -+ } -+ index ++; -+ pch = pend + 1; -+ } else { -+ break; -+ } -+ } -+ return 0; -+} -+ -+int rtw_dev_nlo_info_set(struct pno_nlo_info *nlo_info, pno_ssid_t* ssid, -+ int num, int pno_time, int pno_repeat, int pno_freq_expo_max) { -+ -+ int i = 0; -+ struct file *fp; -+ mm_segment_t fs; -+ loff_t pos = 0; -+ u8 *source = NULL; -+ long len = 0; -+ -+ DBG_871X("+%s+\n", __func__); -+ -+ nlo_info->fast_scan_period = pno_time; -+ nlo_info->ssid_num = num & BIT_LEN_MASK_32(8); -+ nlo_info->hidden_ssid_num = num & BIT_LEN_MASK_32(8); -+ nlo_info->slow_scan_period = (pno_time * 2); -+ nlo_info->fast_scan_iterations = 5; -+ -+ if (nlo_info->hidden_ssid_num > 8) -+ nlo_info->hidden_ssid_num = 8; -+ -+ //TODO: channel list and probe index is all empty. -+ for (i = 0 ; i < num ; i++) { -+ nlo_info->ssid_length[i] -+ = ssid[i].SSID_len; -+ } -+ -+ /* cipher array */ -+ fp = filp_open("/data/misc/wifi/wpa_supplicant.conf", O_RDONLY, 0644); -+ if (IS_ERR(fp)) { -+ DBG_871X("Error, wpa_supplicant.conf doesn't exist.\n"); -+ DBG_871X("Error, cipher array using default value.\n"); -+ return 0; -+ } -+ -+ len = i_size_read(fp->f_path.dentry->d_inode); -+ if (len < 0 || len > 2048) { -+ DBG_871X("Error, file size is bigger than 2048.\n"); -+ DBG_871X("Error, cipher array using default value.\n"); -+ return 0; -+ } -+ -+ fs = get_fs(); -+ set_fs(KERNEL_DS); -+ -+ source = rtw_zmalloc(2048); -+ -+ if (source != NULL) { -+ len = vfs_read(fp, source, len, &pos); -+ rtw_parse_cipher_list(nlo_info, source); -+ rtw_mfree(source, 2048); -+ } -+ -+ set_fs(fs); -+ filp_close(fp, NULL); -+ -+ DBG_871X("-%s-\n", __func__); -+ return 0; -+} -+ -+int rtw_dev_ssid_list_set(struct pno_ssid_list *pno_ssid_list, -+ pno_ssid_t* ssid, u8 num) { -+ -+ int i = 0; -+ if(num > MAX_PNO_LIST_COUNT) -+ num = MAX_PNO_LIST_COUNT; -+ -+ for (i = 0 ; i < num ; i++) { -+ _rtw_memcpy(&pno_ssid_list->node[i].SSID, -+ ssid[i].SSID, ssid[i].SSID_len); -+ pno_ssid_list->node[i].SSID_len = ssid[i].SSID_len; -+ } -+ return 0; -+} -+ -+int rtw_dev_scan_info_set(_adapter *padapter, pno_ssid_t* ssid, -+ unsigned char ch, unsigned char ch_offset, unsigned short bw_mode) { -+ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ struct pno_scan_info *scan_info = pwrctl->pscan_info; -+ int i; -+ -+ scan_info->channel_num = MAX_SCAN_LIST_COUNT; -+ scan_info->orig_ch = ch; -+ scan_info->orig_bw = bw_mode; -+ scan_info->orig_40_offset = ch_offset; -+ -+ for(i = 0 ; i < scan_info->channel_num ; i++) { -+ if (i < 11) -+ scan_info->ssid_channel_info[i].active = 1; -+ else -+ scan_info->ssid_channel_info[i].active = 0; -+ -+ scan_info->ssid_channel_info[i].timeout = 100; -+ -+ scan_info->ssid_channel_info[i].tx_power = -+ PHY_GetTxPowerIndex(padapter, 0, 0x02, bw_mode, i+1); -+ -+ scan_info->ssid_channel_info[i].channel = i+1; -+ } -+ -+ DBG_871X("%s, channel_num: %d, orig_ch: %d, orig_bw: %d orig_40_offset: %d\n", -+ __func__, scan_info->channel_num, scan_info->orig_ch, -+ scan_info->orig_bw, scan_info->orig_40_offset); -+ return 0; -+} -+ -+int rtw_dev_pno_set(struct net_device *net, pno_ssid_t* ssid, int num, -+ int pno_time, int pno_repeat, int pno_freq_expo_max) { -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ int ret = -1; -+ -+ if (num == 0) { -+ DBG_871X("%s, nssid is zero, no need to setup pno ssid list\n", __func__); -+ return 0; -+ } -+ -+ if (pwrctl == NULL) { -+ DBG_871X("%s, ERROR: pwrctl is NULL\n", __func__); -+ return -1; -+ } else { -+ pwrctl->pnlo_info = -+ (pno_nlo_info_t*)rtw_zmalloc(sizeof(pno_nlo_info_t)); -+ pwrctl->pno_ssid_list = -+ (pno_ssid_list_t*)rtw_zmalloc(sizeof(pno_ssid_list_t)); -+ pwrctl->pscan_info = -+ (pno_scan_info_t*)rtw_zmalloc(sizeof(pno_scan_info_t)); -+ } -+ -+ if (pwrctl->pnlo_info == NULL || -+ pwrctl->pscan_info == NULL || -+ pwrctl->pno_ssid_list == NULL){ -+ DBG_871X("%s, ERROR: alloc nlo_info, ssid_list, scan_info fail\n", __func__); -+ goto failing; -+ } -+ -+ pwrctl->pno_in_resume = _FALSE; -+ -+ pwrctl->pno_inited = _TRUE; -+ /* NLO Info */ -+ ret = rtw_dev_nlo_info_set(pwrctl->pnlo_info, ssid, num, -+ pno_time, pno_repeat, pno_freq_expo_max); -+ -+ /* SSID Info */ -+ ret = rtw_dev_ssid_list_set(pwrctl->pno_ssid_list, ssid, num); -+ -+ /* SCAN Info */ -+ ret = rtw_dev_scan_info_set(padapter, ssid, pmlmeext->cur_channel, -+ pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ DBG_871X("+%s num: %d, pno_time: %d, pno_repeat:%d, pno_freq_expo_max:%d+\n", -+ __func__, num, pno_time, pno_repeat, pno_freq_expo_max); -+ -+ return 0; -+ -+failing: -+ if (pwrctl->pnlo_info) { -+ rtw_mfree((u8 *)pwrctl->pnlo_info, sizeof(pno_nlo_info_t)); -+ pwrctl->pnlo_info = NULL; -+ } -+ if (pwrctl->pno_ssid_list) { -+ rtw_mfree((u8 *)pwrctl->pno_ssid_list, sizeof(pno_ssid_list_t)); -+ pwrctl->pno_ssid_list = NULL; -+ } -+ if (pwrctl->pscan_info) { -+ rtw_mfree((u8 *)pwrctl->pscan_info, sizeof(pno_scan_info_t)); -+ pwrctl->pscan_info = NULL; -+ } -+ -+ return -1; -+} -+ -+#ifdef CONFIG_PNO_SET_DEBUG -+void rtw_dev_pno_debug(struct net_device *net) { -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ int i = 0, j = 0; -+ -+ DBG_871X("*******NLO_INFO********\n"); -+ DBG_871X("ssid_num: %d\n", pwrctl->pnlo_info->ssid_num); -+ DBG_871X("fast_scan_iterations: %d\n", -+ pwrctl->pnlo_info->fast_scan_iterations); -+ DBG_871X("fast_scan_period: %d\n", pwrctl->pnlo_info->fast_scan_period); -+ DBG_871X("slow_scan_period: %d\n", pwrctl->pnlo_info->slow_scan_period); -+ DBG_871X("ssid_length: "); -+ for (i = 0 ; i < MAX_PNO_LIST_COUNT ; i++) { -+ printk("%d, ", pwrctl->pnlo_info->ssid_length[i]); -+ } -+ DBG_871X("\n"); -+ -+ DBG_871X("cipher_info: "); -+ for (i = 0 ; i < MAX_PNO_LIST_COUNT ; i++) { -+ DBG_871X("%d, ", pwrctl->pnlo_info->ssid_cipher_info[i]); -+ } -+ DBG_871X("\n"); -+ -+ DBG_871X("channel_info: "); -+ for (i = 0 ; i < MAX_PNO_LIST_COUNT ; i++) { -+ DBG_871X("%d, ", pwrctl->pnlo_info->ssid_channel_info[i]); -+ } -+ DBG_871X("\n"); -+ -+ DBG_871X("******SSID_LISD******\n"); -+ for (i = 0 ; i < MAX_PNO_LIST_COUNT ; i++) { -+ DBG_871X("[%d]SSID: %s \n", i, -+ pwrctl->pno_ssid_list->node[i].SSID); -+ } -+ -+ DBG_871X("******SCAN_INFO******\n"); -+ DBG_871X("ch_num: %d\n", pwrctl->pscan_info->channel_num); -+ DBG_871X("orig_ch: %d\n", pwrctl->pscan_info->orig_ch); -+ DBG_871X("orig bw: %d\n", pwrctl->pscan_info->orig_bw); -+ DBG_871X("orig 40 offset: %d\n", pwrctl->pscan_info->orig_40_offset); -+ for(i = 0 ; i < MAX_SCAN_LIST_COUNT ; i++) { -+ DBG_871X("[%02d] avtive:%d, timeout:%d, tx_power:%d, ch:%02d\n", -+ i, pwrctl->pscan_info->ssid_channel_info[i].active, -+ pwrctl->pscan_info->ssid_channel_info[i].timeout, -+ pwrctl->pscan_info->ssid_channel_info[i].tx_power, -+ pwrctl->pscan_info->ssid_channel_info[i].channel); -+ } -+ DBG_871X("*****************\n"); -+} -+#endif //CONFIG_PNO_SET_DEBUG -+#endif //CONFIG_PNO_SUPPORT -diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au/core/rtw_xmit.c ---- linux.old/3rdparty/rtl8812au/core/rtw_xmit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/core/rtw_xmit.c 2017-06-07 23:07:21.007687211 +0300 -@@ -0,0 +1,4919 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_xmit.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_xmit.c +--- linux-4.14.17/3rdparty/rtl8812au/core/rtw_xmit.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_xmit.c 2018-02-06 17:42:30.701967031 +0200 +@@ -0,0 +1,4131 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -82652,45 +59039,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTW_XMIT_C_ + +#include + -+#if defined (PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+#error "Shall be Linux or Windows, but not both!\n" -+#endif -+ -+ +static u8 P802_1H_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0xf8 }; +static u8 RFC1042_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0x00 }; + +static void _init_txservq(struct tx_servq *ptxservq) +{ -+_func_enter_; ++ + _rtw_init_listhead(&ptxservq->tx_pending); + _rtw_init_queue(&ptxservq->sta_pending); + ptxservq->qcnt = 0; -+_func_exit_; +} + -+ +void _rtw_init_sta_xmit_priv(struct sta_xmit_priv *psta_xmitpriv) -+{ -+ -+_func_enter_; -+ ++{ + _rtw_memset((unsigned char *)psta_xmitpriv, 0, sizeof (struct sta_xmit_priv)); + + _rtw_spinlock_init(&psta_xmitpriv->lock); -+ -+ //for(i = 0 ; i < MAX_NUMBLKS; i++) -+ // _init_txservq(&(psta_xmitpriv->blk_q[i])); + + _init_txservq(&psta_xmitpriv->be_q); + _init_txservq(&psta_xmitpriv->bk_q); @@ -82698,8 +59067,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _init_txservq(&psta_xmitpriv->vo_q); + _rtw_init_listhead(&psta_xmitpriv->legacy_dz); + _rtw_init_listhead(&psta_xmitpriv->apsd); -+ -+_func_exit_; ++ ++ + +} + @@ -82708,27 +59077,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + int i; + struct xmit_buf *pxmitbuf; + struct xmit_frame *pxframe; -+ sint res=_SUCCESS; -+ -+_func_enter_; ++ sint res=_SUCCESS; ++ u32 max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; ++ u32 num_xmit_extbuf = NR_XMIT_EXTBUFF; ++ ++ + + // We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). + //_rtw_memset((unsigned char *)pxmitpriv, 0, sizeof(struct xmit_priv)); -+ ++ + _rtw_spinlock_init(&pxmitpriv->lock); + _rtw_spinlock_init(&pxmitpriv->lock_sctx); + _rtw_init_sema(&pxmitpriv->xmit_sema, 0); + _rtw_init_sema(&pxmitpriv->terminate_xmitthread_sema, 0); + -+ /* ++ /* + Please insert all the queue initializaiton using _rtw_init_queue below + */ + + pxmitpriv->adapter = padapter; -+ ++ + //for(i = 0 ; i < MAX_NUMBLKS; i++) + // _rtw_init_queue(&pxmitpriv->blk_strms[i]); -+ ++ + _rtw_init_queue(&pxmitpriv->be_pending); + _rtw_init_queue(&pxmitpriv->bk_pending); + _rtw_init_queue(&pxmitpriv->vi_pending); @@ -82740,17 +59111,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + _rtw_init_queue(&pxmitpriv->free_xmit_queue); + -+ /* -+ Please allocate memory with the sz = (struct xmit_frame) * NR_XMITFRAME, ++ /* ++ Please allocate memory with the sz = (struct xmit_frame) * NR_XMITFRAME, + and initialize free_xmit_frame below. + Please also apply free_txobj to link_up all the xmit_frames... + */ + + pxmitpriv->pallocated_frame_buf = rtw_zvmalloc(NR_XMITFRAME * sizeof(struct xmit_frame) + 4); -+ ++ + if (pxmitpriv->pallocated_frame_buf == NULL){ + pxmitpriv->pxmit_frame_buf =NULL; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("alloc xmit_frame fail!\n")); ++ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("alloc xmit_frame fail!\n")); + res= _FAIL; + goto exit; + } @@ -82767,11 +59138,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + pxframe->padapter = padapter; + pxframe->frame_tag = NULL_FRAMETAG; + -+ pxframe->pkt = NULL; ++ pxframe->pkt = NULL; + + pxframe->buf_addr = NULL; + pxframe->pxmitbuf = NULL; -+ ++ + rtw_list_insert_tail(&(pxframe->list), &(pxmitpriv->free_xmit_queue.queue)); + + pxframe++; @@ -82787,7 +59158,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _rtw_init_queue(&pxmitpriv->pending_xmitbuf_queue); + + pxmitpriv->pallocated_xmitbuf = rtw_zvmalloc(NR_XMITBUFF * sizeof(struct xmit_buf) + 4); -+ ++ + if (pxmitpriv->pallocated_xmitbuf == NULL){ + RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("alloc xmit_buf fail!\n")); + res= _FAIL; @@ -82809,21 +59180,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + pxmitbuf->buf_tag = XMITBUF_DATA; + + /* Tx buf allocation may fail sometimes, so sleep and retry. */ -+ if((res=rtw_os_xmit_resource_alloc(padapter, pxmitbuf,(MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), _TRUE)) == _FAIL) { ++ if((res=rtw_os_xmit_resource_alloc(padapter, pxmitbuf,(MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), true)) == _FAIL) { + rtw_msleep_os(10); -+ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf,(MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), _TRUE); ++ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf,(MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), true); + if (res == _FAIL) { + goto exit; + } + } + -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->phead = pxmitbuf->pbuf; -+ pxmitbuf->pend = pxmitbuf->pbuf + MAX_XMITBUF_SZ; -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+#endif -+ + pxmitbuf->flags = XMIT_VO_QUEUE; + + rtw_list_insert_tail(&pxmitbuf->list, &(pxmitpriv->free_xmitbuf_queue.queue)); @@ -82832,49 +59196,49 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + #endif + + pxmitbuf++; -+ ++ + } + + pxmitpriv->free_xmitbuf_cnt = NR_XMITBUFF; + + /* init xframe_ext queue, the same count as extbuf */ + _rtw_init_queue(&pxmitpriv->free_xframe_ext_queue); -+ -+ pxmitpriv->xframe_ext_alloc_addr = rtw_zvmalloc(NR_XMIT_EXTBUFF * sizeof(struct xmit_frame) + 4); -+ ++ ++ pxmitpriv->xframe_ext_alloc_addr = rtw_zvmalloc(num_xmit_extbuf * sizeof(struct xmit_frame) + 4); ++ + if (pxmitpriv->xframe_ext_alloc_addr == NULL){ + pxmitpriv->xframe_ext = NULL; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("alloc xframe_ext fail!\n")); ++ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("alloc xframe_ext fail!\n")); + res= _FAIL; + goto exit; + } + pxmitpriv->xframe_ext = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->xframe_ext_alloc_addr), 4); + pxframe = (struct xmit_frame*)pxmitpriv->xframe_ext; + -+ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { ++ for (i = 0; i < num_xmit_extbuf; i++) { + _rtw_init_listhead(&(pxframe->list)); + + pxframe->padapter = padapter; + pxframe->frame_tag = NULL_FRAMETAG; + -+ pxframe->pkt = NULL; ++ pxframe->pkt = NULL; + + pxframe->buf_addr = NULL; + pxframe->pxmitbuf = NULL; -+ ++ + pxframe->ext_tag = 1; -+ ++ + rtw_list_insert_tail(&(pxframe->list), &(pxmitpriv->free_xframe_ext_queue.queue)); + + pxframe++; + } -+ pxmitpriv->free_xframe_ext_cnt = NR_XMIT_EXTBUFF; ++ pxmitpriv->free_xframe_ext_cnt = num_xmit_extbuf; + + // Init xmit extension buff + _rtw_init_queue(&pxmitpriv->free_xmit_extbuf_queue); + -+ pxmitpriv->pallocated_xmit_extbuf = rtw_zvmalloc(NR_XMIT_EXTBUFF * sizeof(struct xmit_buf) + 4); -+ ++ pxmitpriv->pallocated_xmit_extbuf = rtw_zvmalloc(num_xmit_extbuf * sizeof(struct xmit_buf) + 4); ++ + if (pxmitpriv->pallocated_xmit_extbuf == NULL){ + RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("alloc xmit_extbuf fail!\n")); + res= _FAIL; @@ -82885,7 +59249,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + pxmitbuf = (struct xmit_buf*)pxmitpriv->pxmit_extbuf; + -+ for (i = 0; i < NR_XMIT_EXTBUFF; i++) ++ for (i = 0; i < num_xmit_extbuf; i++) + { + _rtw_init_listhead(&pxmitbuf->list); + @@ -82893,49 +59257,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + pxmitbuf->padapter = padapter; + pxmitbuf->buf_tag = XMITBUF_MGNT; + -+ if((res=rtw_os_xmit_resource_alloc(padapter, pxmitbuf,MAX_XMIT_EXTBUF_SZ + XMITBUF_ALIGN_SZ, _TRUE)) == _FAIL) { ++ if((res=rtw_os_xmit_resource_alloc(padapter, pxmitbuf,max_xmit_extbuf_size + XMITBUF_ALIGN_SZ, true)) == _FAIL) { + res= _FAIL; + goto exit; + } -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->phead = pxmitbuf->pbuf; -+ pxmitbuf->pend = pxmitbuf->pbuf + MAX_XMIT_EXTBUF_SZ; -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+#endif + + rtw_list_insert_tail(&pxmitbuf->list, &(pxmitpriv->free_xmit_extbuf_queue.queue)); + #ifdef DBG_XMIT_BUF_EXT + pxmitbuf->no=i; + #endif + pxmitbuf++; -+ ++ + } + -+ pxmitpriv->free_xmit_extbuf_cnt = NR_XMIT_EXTBUFF; ++ pxmitpriv->free_xmit_extbuf_cnt = num_xmit_extbuf; + -+ for (i = 0; ipcmd_xmitbuf[i]; -+ if (pxmitbuf) { -+ _rtw_init_listhead(&pxmitbuf->list); + -+ pxmitbuf->priv_data = NULL; -+ pxmitbuf->padapter = padapter; -+ pxmitbuf->buf_tag = XMITBUF_CMD; ++ pxmitbuf = &pxmitpriv->pcmd_xmitbuf; ++ if (pxmitbuf) { ++ _rtw_init_listhead(&pxmitbuf->list); + -+ if((res=rtw_os_xmit_resource_alloc(padapter, pxmitbuf, MAX_CMDBUF_SZ+XMITBUF_ALIGN_SZ, _TRUE)) == _FAIL) { -+ res= _FAIL; -+ goto exit; -+ } ++ pxmitbuf->priv_data = NULL; ++ pxmitbuf->padapter = padapter; ++ pxmitbuf->buf_tag = XMITBUF_CMD; + -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->phead = pxmitbuf->pbuf; -+ pxmitbuf->pend = pxmitbuf->pbuf + MAX_CMDBUF_SZ; -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+#endif -+ pxmitbuf->alloc_sz = MAX_CMDBUF_SZ+XMITBUF_ALIGN_SZ; ++ if((res=rtw_os_xmit_resource_alloc(padapter, pxmitbuf, 0, true)) == _FAIL) { ++ res= _FAIL; ++ goto exit; + } + } + @@ -82947,7 +59295,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + pxmitpriv->wmm_para_seq[i] = i; + } + -+#ifdef CONFIG_USB_HCI + pxmitpriv->txirp_cnt=1; + + _rtw_init_sema(&(pxmitpriv->tx_retevt), 0); @@ -82957,20 +59304,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + pxmitpriv->bkq_cnt = 0; + pxmitpriv->viq_cnt = 0; + pxmitpriv->voq_cnt = 0; -+#endif + + +#ifdef CONFIG_XMIT_ACK -+ pxmitpriv->ack_tx = _FALSE; ++ pxmitpriv->ack_tx = false; + _rtw_mutex_init(&pxmitpriv->ack_tx_mutex); -+ rtw_sctx_init(&pxmitpriv->ack_tx_ops, 0); ++ rtw_sctx_init(&pxmitpriv->ack_tx_ops, 0); +#endif + + rtw_hal_init_xmit_priv(padapter); + +exit: + -+_func_exit_; ++ + + return res; +} @@ -83003,34 +59349,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _adapter *padapter = pxmitpriv->adapter; + struct xmit_frame *pxmitframe = (struct xmit_frame*) pxmitpriv->pxmit_frame_buf; + struct xmit_buf *pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf; -+ -+ _func_enter_; ++ u32 max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; ++ u32 num_xmit_extbuf = NR_XMIT_EXTBUFF; + + rtw_hal_free_xmit_priv(padapter); -+ ++ + rtw_mfree_xmit_priv_lock(pxmitpriv); -+ -+ if(pxmitpriv->pxmit_frame_buf==NULL) -+ goto out; -+ ++ ++ if(pxmitpriv->pxmit_frame_buf==NULL) ++ return; ++ + for(i=0; ipallocated_frame_buf) { + rtw_vmfree(pxmitpriv->pallocated_frame_buf, NR_XMITFRAME * sizeof(struct xmit_frame) + 4); + } -+ ++ + + if(pxmitpriv->pallocated_xmitbuf) { + rtw_vmfree(pxmitpriv->pallocated_xmitbuf, NR_XMITBUFF * sizeof(struct xmit_buf) + 4); @@ -83038,78 +59384,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + /* free xframe_ext queue, the same count as extbuf */ + if ((pxmitframe = (struct xmit_frame*)pxmitpriv->xframe_ext)) { -+ for (i=0; ixframe_ext_alloc_addr) -+ rtw_vmfree(pxmitpriv->xframe_ext_alloc_addr, NR_XMIT_EXTBUFF * sizeof(struct xmit_frame) + 4); ++ rtw_vmfree(pxmitpriv->xframe_ext_alloc_addr, num_xmit_extbuf * sizeof(struct xmit_frame) + 4); + _rtw_spinlock_free(&pxmitpriv->free_xframe_ext_queue.lock); + + // free xmit extension buff + _rtw_spinlock_free(&pxmitpriv->free_xmit_extbuf_queue.lock); + + pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; -+ for(i=0; ipallocated_xmit_extbuf) { -+ rtw_vmfree(pxmitpriv->pallocated_xmit_extbuf, NR_XMIT_EXTBUFF * sizeof(struct xmit_buf) + 4); ++ rtw_vmfree(pxmitpriv->pallocated_xmit_extbuf, num_xmit_extbuf * sizeof(struct xmit_buf) + 4); + } + -+ for (i=0; ipcmd_xmitbuf[i]; -+ if(pxmitbuf!=NULL) -+ rtw_os_xmit_resource_free(padapter, pxmitbuf, MAX_CMDBUF_SZ+XMITBUF_ALIGN_SZ , _TRUE); -+ } ++ pxmitbuf = &pxmitpriv->pcmd_xmitbuf; ++ rtw_os_xmit_resource_free(padapter, pxmitbuf, 0, true); + + rtw_free_hwxmits(padapter); + -+#ifdef CONFIG_XMIT_ACK -+ _rtw_mutex_free(&pxmitpriv->ack_tx_mutex); -+#endif -+ -+out: -+ -+_func_exit_; -+ -+} -+ -+u8 query_ra_short_GI(struct sta_info *psta) -+{ -+ u8 sgi = _FALSE, sgi_20m = _FALSE, sgi_40m = _FALSE, sgi_80m = _FALSE; -+ -+#ifdef CONFIG_80211N_HT -+#ifdef CONFIG_80211AC_VHT -+ if (psta->vhtpriv.vht_option) { -+ sgi_80m= psta->vhtpriv.sgi_80m; -+ } -+#endif //CONFIG_80211AC_VHT -+ { -+ sgi_20m = psta->htpriv.sgi_20m; -+ sgi_40m = psta->htpriv.sgi_40m; -+ } ++#ifdef CONFIG_XMIT_ACK ++ _rtw_mutex_free(&pxmitpriv->ack_tx_mutex); +#endif -+ -+ switch(psta->bw_mode){ -+ case CHANNEL_WIDTH_80: -+ sgi = sgi_80m; -+ break; -+ case CHANNEL_WIDTH_40: -+ sgi = sgi_40m; -+ break; -+ case CHANNEL_WIDTH_20: -+ default: -+ sgi = sgi_20m; -+ break; -+ } -+ -+ return sgi; +} + +static void update_attrib_vcs_info(_adapter *padapter, struct xmit_frame *pxmitframe) @@ -83175,7 +59481,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + } + else + { -+ while (_TRUE) ++ while (true) + { +#if 0 //Todo + //check IOT action @@ -83194,13 +59500,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +#endif + + //IOT action -+ if((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_ATHEROS) && (pattrib->ampdu_en==_TRUE) && ++ if((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_ATHEROS) && (pattrib->ampdu_en==true) && + (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_ )) + { + pattrib->vcs_mode = CTS_TO_SELF; + break; -+ } -+ ++ } ++ + + //check ERP protection + if(pattrib->rtsen || pattrib->cts2self) @@ -83235,7 +59541,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + //to do list: check MIMO power save condition. + + //check AMPDU aggregation for TXOP -+ if((pattrib->ampdu_en==_TRUE) && (!IS_HARDWARE_TYPE_8812(padapter))) ++ if((pattrib->ampdu_en==true) && (!IS_HARDWARE_TYPE_JAGUAR(padapter))) + { + pattrib->vcs_mode = RTS_CTS; + break; @@ -83245,79 +59551,56 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + break; + } + } -+ -+ //for debug : force driver control vrtl_carrier_sense. -+ if(padapter->driver_vcs_en==1) -+ { -+ //u8 driver_vcs_en; //Enable=1, Disable=0 driver control vrtl_carrier_sense. -+ //u8 driver_vcs_type;//force 0:disable VCS, 1:RTS-CTS, 2:CTS-to-self when vcs_en=1. -+ pattrib->vcs_mode = padapter->driver_vcs_type; -+ } -+ +} + -+static void update_attrib_phy_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) ++static void update_attrib_phy_info(struct pkt_attrib *pattrib, struct sta_info *psta) +{ -+ struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; -+ + pattrib->rtsen = psta->rtsen; + pattrib->cts2self = psta->cts2self; -+ ++ + pattrib->mdata = 0; + pattrib->eosp = 0; + pattrib->triggered=0; -+ pattrib->ampdu_spacing = 0; -+ ++ + //qos_en, ht_en, init rate, ,bw, ch_offset, sgi + pattrib->qos_en = psta->qos_option; -+ ++ + pattrib->raid = psta->raid; -+ -+ if (mlmeext->cur_bwmode < psta->bw_mode) -+ pattrib->bwmode = mlmeext->cur_bwmode; -+ else -+ pattrib->bwmode = psta->bw_mode; -+ -+ pattrib->sgi = query_ra_short_GI(psta); -+ -+ pattrib->ldpc = psta->ldpc; -+ pattrib->stbc = psta->stbc; -+ +#ifdef CONFIG_80211N_HT ++#ifdef CONFIG_80211AC_VHT ++ if (psta->vhtpriv.vht_option) { ++ pattrib->bwmode = psta->vhtpriv.bwmode; ++ pattrib->sgi= psta->vhtpriv.sgi; ++ ++ if(TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX)) ++ pattrib->ldpc = 1; ++ ++ if(TEST_FLAG(psta->vhtpriv.stbc_cap, STBC_VHT_ENABLE_TX)) ++ pattrib->stbc = 1; ++ } ++ else ++#endif //CONFIG_80211AC_VHT ++ { ++ pattrib->bwmode = psta->htpriv.bwmode; ++ pattrib->sgi= psta->htpriv.sgi; ++ } ++ + pattrib->ht_en = psta->htpriv.ht_option; + pattrib->ch_offset = psta->htpriv.ch_offset; -+ pattrib->ampdu_en = _FALSE; -+ -+ if(padapter->driver_ampdu_spacing != 0xFF) //driver control AMPDU Density for peer sta's rx -+ pattrib->ampdu_spacing = padapter->driver_ampdu_spacing; -+ else -+ pattrib->ampdu_spacing = psta->htpriv.rx_ampdu_min_spacing; ++ pattrib->ampdu_en = false; +#endif //CONFIG_80211N_HT + //if(pattrib->ht_en && psta->htpriv.ampdu_enable) + //{ + // if(psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) -+ // pattrib->ampdu_en = _TRUE; -+ //} ++ // pattrib->ampdu_en = true; ++ //} + -+#ifdef CONFIG_TDLS -+ if (pattrib->direct_link==_TRUE) { -+ psta = pattrib->ptdls_sta; + -+ pattrib->raid = psta->raid; -+#ifdef CONFIG_80211N_HT -+ pattrib->bwmode = psta->bw_mode; -+ pattrib->ht_en = psta->htpriv.ht_option; -+ pattrib->ch_offset = psta->htpriv.ch_offset; -+ pattrib->sgi= query_ra_short_GI(psta); -+#endif /* CONFIG_80211N_HT */ -+ } -+#endif /* CONFIG_TDLS */ -+ -+ pattrib->retry_ctrl = _FALSE; ++ pattrib->retry_ctrl = false; + +#ifdef CONFIG_AUTO_AP_MODE + if(psta->isrc && psta->pid>0) -+ pattrib->pctrl = _TRUE; ++ pattrib->pctrl = true; +#endif + +} @@ -83329,21 +59612,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + struct security_priv *psecuritypriv = &padapter->securitypriv; + sint bmcast = IS_MCAST(pattrib->ra); + -+ _rtw_memset(pattrib->dot118021x_UncstKey.skey, 0, 16); ++ _rtw_memset(pattrib->dot118021x_UncstKey.skey, 0, 16); + _rtw_memset(pattrib->dot11tkiptxmickey.skey, 0, 16); -+ pattrib->mac_id = psta->mac_id; + -+ if (psta->ieee8021x_blocked == _TRUE) ++ if (psta->ieee8021x_blocked == true) + { -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("\n psta->ieee8021x_blocked == _TRUE \n")); ++ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("\n psta->ieee8021x_blocked == true \n")); + + pattrib->encrypt = 0; + -+ if((pattrib->ether_type != 0x888e) && (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _FALSE)) ++ if((pattrib->ether_type != 0x888e) && (check_fwstate(pmlmepriv, WIFI_MP_STATE) == false)) + { -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("\npsta->ieee8021x_blocked == _TRUE, pattrib->ether_type(%.4x) != 0x888e\n",pattrib->ether_type)); ++ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("\npsta->ieee8021x_blocked == true, pattrib->ether_type(%.4x) != 0x888e\n",pattrib->ether_type)); + #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s psta->ieee8021x_blocked == _TRUE, pattrib->ether_type(%04x) != 0x888e\n", __FUNCTION__,pattrib->ether_type); ++ DBG_871X("DBG_TX_DROP_FRAME %s psta->ieee8021x_blocked == true, pattrib->ether_type(%04x) != 0x888e\n", __FUNCTION__,pattrib->ether_type); + #endif + res = _FAIL; + goto exit; @@ -83352,7 +59634,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + else + { + GET_ENCRY_ALGO(psecuritypriv, psta, pattrib->encrypt, bmcast); -+ ++ +#ifdef CONFIG_WAPI_SUPPORT + if(pattrib->ether_type == 0x88B4) + pattrib->encrypt=_NO_PRIVACY_; @@ -83379,16 +59661,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + //For WPS 1.0 WEP, driver should not encrypt EAPOL Packet for WPS handshake. + if (((pattrib->encrypt ==_WEP40_)||(pattrib->encrypt ==_WEP104_)) && (pattrib->ether_type == 0x888e)) + pattrib->encrypt=_NO_PRIVACY_; -+ ++ + } + -+#ifdef CONFIG_TDLS -+ if (pattrib->direct_link == _TRUE) { -+ if (pattrib->encrypt > 0) -+ pattrib->encrypt = _AES_; -+ } -+#endif -+ + switch (pattrib->encrypt) + { + case _WEP40_: @@ -83403,7 +59678,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + pattrib->icv_len = 4; + + if(psecuritypriv->busetkipkey==_FAIL) -+ { ++ { + #ifdef DBG_TX_DROP_FRAME + DBG_871X("DBG_TX_DROP_FRAME %s psecuritypriv->busetkipkey(%d)==_FAIL drop packet\n", __FUNCTION__, psecuritypriv->busetkipkey); + #endif @@ -83418,26 +59693,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + + _rtw_memcpy(pattrib->dot11tkiptxmickey.skey, psta->dot11tkiptxmickey.skey, 16); -+ ++ + break; -+ ++ + case _AES_: -+ ++ + pattrib->iv_len = 8; + pattrib->icv_len = 8; -+ ++ + if(bmcast) + AES_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); + else + AES_IV(pattrib->iv, psta->dot11txpn, 0); -+ ++ + break; + +#ifdef CONFIG_WAPI_SUPPORT + case _SMS4_: + pattrib->iv_len = 18; + pattrib->icv_len = 16; -+ rtw_wapi_get_iv(padapter,pattrib->ra,pattrib->iv); ++ rtw_wapi_get_iv(padapter,pattrib->ra,pattrib->iv); + break; +#endif + default: @@ -83447,44 +59722,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + } + + if(pattrib->encrypt>0) -+ _rtw_memcpy(pattrib->dot118021x_UncstKey.skey, psta->dot118021x_UncstKey.skey, 16); -+ -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, -+ ("update_attrib: encrypt=%d securitypriv.sw_encrypt=%d\n", -+ pattrib->encrypt, padapter->securitypriv.sw_encrypt)); -+ -+ if (pattrib->encrypt && -+ ((padapter->securitypriv.sw_encrypt == _TRUE) || (psecuritypriv->hw_decrypted == _FALSE))) -+ { -+ pattrib->bswenc = _TRUE; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_, -+ ("update_attrib: encrypt=%d securitypriv.hw_decrypted=%d bswenc=_TRUE\n", -+ pattrib->encrypt, padapter->securitypriv.sw_encrypt)); -+ } else { -+ pattrib->bswenc = _FALSE; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("update_attrib: bswenc=_FALSE\n")); -+ } -+ -+#if defined(CONFIG_CONCURRENT_MODE) && !defined(DYNAMIC_CAMID_ALLOC) -+ if((pattrib->encrypt && bmcast) || (pattrib->encrypt ==_WEP40_) || (pattrib->encrypt ==_WEP104_)) -+ { -+ pattrib->bswenc = _TRUE;//force using sw enc. -+ } -+#endif -+#ifdef DYNAMIC_CAMID_ALLOC -+ if (pattrib->encrypt && bmcast && _rtw_camctl_chk_flags(padapter, SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH)) -+ pattrib->bswenc = _TRUE; -+#endif -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if(pattrib->encrypt == _SMS4_) -+ pattrib->bswenc = _FALSE; -+#endif ++ _rtw_memcpy(pattrib->dot118021x_UncstKey.skey, psta->dot118021x_UncstKey.skey, 16); + +exit: + + return res; -+ ++ +} + +u8 qos_acm(u8 acm_mask, u8 priority) @@ -83534,116 +59777,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _rtw_pktfile_read(ppktfile, (u8*)&ip_hdr, sizeof(ip_hdr)); +// UserPriority = (ntohs(ip_hdr.tos) >> 5) & 0x3; + UserPriority = ip_hdr.tos >> 5; -+ } -+/* -+ else if (pattrib->ether_type == 0x888e) { ++ } else if (pattrib->ether_type == 0x888e) { + // "When priority processing of data frames is supported, + // a STA's SME should send EAPOL-Key frames at the highest priority." + UserPriority = 7; + } -+*/ ++ + pattrib->priority = UserPriority; + pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN; + pattrib->subtype = WIFI_QOS_DATA_TYPE; +} + -+#ifdef CONFIG_TDLS -+u8 rtw_check_tdls_established(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ pattrib->ptdls_sta = NULL; -+ -+ pattrib->direct_link = _FALSE; -+ if (padapter->tdlsinfo.link_established == _TRUE) { -+ pattrib->ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); -+#if 1 -+ if((pattrib->ptdls_sta!=NULL)&& -+ (pattrib->ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)&& -+ (pattrib->ether_type!=0x0806)){ -+ pattrib->direct_link = _TRUE; -+ //DBG_871X("send ptk to "MAC_FMT" using direct link\n", MAC_ARG(pattrib->dst)); -+ } -+#else -+ if (pattrib->ptdls_sta != NULL && -+ pattrib->ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { -+ pattrib->direct_link = _TRUE; -+ #if 0 -+ DBG_871X("send ptk to "MAC_FMT" using direct link\n", MAC_ARG(pattrib->dst)); -+ #endif -+ } -+ -+ /* ARP frame may be helped by AP*/ -+ if (pattrib->ether_type != 0x0806) { -+ pattrib->direct_link = _FALSE; -+ } -+#endif -+ } -+ -+ return pattrib->direct_link; -+} -+ -+s32 update_tdls_attrib(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv= &pmlmepriv->qospriv; -+ -+ s32 res=_SUCCESS; -+ -+ psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ if (psta == NULL) { -+ res =_FAIL; -+ goto exit; -+ } -+ -+ pattrib->mac_id = psta->mac_id; -+ pattrib->psta = psta; -+ pattrib->ack_policy = 0; -+ // get ether_hdr_len -+ pattrib->pkt_hdrlen = ETH_HLEN; -+ -+ // [TDLS] TODO: setup req/rsp should be AC_BK -+ if (pqospriv->qos_option && psta->qos_option) { -+ pattrib->priority = 4; //tdls management frame should be AC_VI -+ pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN; -+ pattrib->subtype = WIFI_QOS_DATA_TYPE; -+ } else { -+ pattrib->priority = 0; -+ pattrib->hdrlen = WLAN_HDR_A3_LEN; -+ pattrib->subtype = WIFI_DATA_TYPE; -+ } -+ -+ //TODO:_lock -+ if(update_attrib_sec_info(padapter, pattrib, psta) == _FAIL) -+ { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ update_attrib_phy_info(padapter, pattrib, psta); -+ -+ -+exit: -+ -+ return res; -+} -+ -+#endif //CONFIG_TDLS -+ -+//get non-qos hw_ssn control register,mapping to REG_HW_SEQ0,1,2,3 -+inline u8 rtw_get_hwseq_no(_adapter *padapter) -+{ -+ u8 hwseq_num = 0; -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->adapter_type == SECONDARY_ADAPTER) -+ hwseq_num = 1; -+ //else -+ // hwseq_num = 2; -+#endif //CONFIG_CONCURRENT_MODE -+ return hwseq_num; -+} +static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattrib) +{ + uint i; @@ -83654,14 +59798,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + sint bmcast; + struct sta_priv *pstapriv = &padapter->stapriv; + struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct qos_priv *pqospriv= &pmlmepriv->qospriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + sint res = _SUCCESS; + -+ _func_enter_; + -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib); + + _rtw_open_pktfile(pkt, &pktfile); + i = _rtw_pktfile_read(&pktfile, (u8*)ðerhdr, ETH_HLEN); @@ -83673,41 +59814,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _rtw_memcpy(pattrib->src, ðerhdr.h_source, ETH_ALEN); + + -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) { + _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, adapter_mac_addr(padapter), ETH_ALEN); -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_adhoc); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); + } + else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+#ifdef CONFIG_TDLS -+ if (rtw_check_tdls_established(padapter, pattrib) == _TRUE) -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); /* For TDLS direct link Tx, set ra to be same to dst */ -+ else -+#endif + _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, adapter_mac_addr(padapter), ETH_ALEN); -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_sta); ++ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); + } + else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { + _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); + _rtw_memcpy(pattrib->ta, get_bssid(pmlmepriv), ETH_ALEN); -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_ap); -+ } -+ else -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_unknown); ++ } + + pattrib->pktlen = pktfile.pkt_len; + + if (ETH_P_IP == pattrib->ether_type) + { -+ // The following is for DHCP and ARP packet, we use cck1M to tx these packets and let LPS awake some time ++ // The following is for DHCP and ARP packet, we use cck1M to tx these packets and let LPS awake some time + // to prevent DHCP protocol fail -+ + u8 tmp[24]; -+ + _rtw_pktfile_read(&pktfile, &tmp[0], 24); -+ + pattrib->dhcp_pkt = 0; + if (pktfile.pkt_len > 282) {//MINIMUM_DHCP_PACKET_SIZE) { + if (ETH_P_IP == pattrib->ether_type) {// IP header @@ -83717,33 +59845,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + // 67 : UDP BOOTP server + RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("======================update_attrib: get DHCP Packet \n")); + // Use low rate to send DHCP packet. -+ //if(pMgntInfo->IOTAction & HT_IOT_ACT_WA_IOT_Broadcom) ++ //if(pMgntInfo->IOTAction & HT_IOT_ACT_WA_IOT_Broadcom) + //{ + // tcb_desc->DataRate = MgntQuery_TxRateExcludeCCKRates(ieee);//0xc;//ofdm 6m + // tcb_desc->bTxDisableRateFallBack = false; + //} + //else -+ // pTcb->DataRate = Adapter->MgntInfo.LowestBasicRate; -+ //RTPRINT(FDM, WA_IOT, ("DHCP TranslateHeader(), pTcb->DataRate = 0x%x\n", pTcb->DataRate)); ++ // pTcb->DataRate = Adapter->MgntInfo.LowestBasicRate; ++ //RTPRINT(FDM, WA_IOT, ("DHCP TranslateHeader(), pTcb->DataRate = 0x%x\n", pTcb->DataRate)); + pattrib->dhcp_pkt = 1; -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_dhcp); + } + } + } -+ -+ //for parsing ICMP pakcets -+ { -+ struct iphdr *piphdr = (struct iphdr *)tmp; -+ -+ pattrib->icmp_pkt = 0; -+ if(piphdr->protocol == 0x1) // protocol type in ip header 0x1 is ICMP -+ { -+ pattrib->icmp_pkt = 1; -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_icmp); -+ } -+ } -+ -+ + } else if (0x888e == pattrib->ether_type) { + DBG_871X_LEVEL(_drv_always_, "send eapol packet\n"); + } @@ -83757,33 +59870,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + // If EAPOL , ARP , OR DHCP packet, driver must be in active mode. +#ifdef CONFIG_WAPI_SUPPORT + if ( (pattrib->ether_type == 0x88B4) || (pattrib->ether_type == 0x0806) || (pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1) ) -+#else //!CONFIG_WAPI_SUPPORT -+#if 0 ++#else + if ( (pattrib->ether_type == 0x0806) || (pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1) ) -+#else // only ICMP/DHCP packets is as SPECIAL_PACKET, and leave LPS when tx IMCP/DHCP packets. -+ //if ((pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1) ) -+ if (pattrib->icmp_pkt==1) -+ { -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); -+ } -+ else if(pattrib->dhcp_pkt==1) -+#endif +#endif + { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_active); + rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SPECIAL_PACKET, 1); + } -+#endif //CONFIG_LPS ++#endif + + bmcast = IS_MCAST(pattrib->ra); -+ ++ + // get sta_info + if (bmcast) { + psta = rtw_get_bcmc_stainfo(padapter); + } else { + psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ if (psta == NULL) { // if we cannot get psta => drop the pkt -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_ucast_sta); ++ if (psta == NULL) { // if we cannot get psta => drrp the pkt + RT_TRACE(_module_rtl871x_xmit_c_, _drv_alert_, ("\nupdate_attrib => get sta_info fail, ra:" MAC_FMT"\n", MAC_ARG(pattrib->ra))); + #ifdef DBG_TX_DROP_FRAME + DBG_871X("DBG_TX_DROP_FRAME %s get sta_info fail, ra:" MAC_FMT"\n", __FUNCTION__, MAC_ARG(pattrib->ra)); @@ -83791,9 +59893,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + res =_FAIL; + goto exit; + } -+ else if((check_fwstate(pmlmepriv, WIFI_AP_STATE)==_TRUE)&&(!(psta->state & _FW_LINKED))) ++ else if((check_fwstate(pmlmepriv, WIFI_AP_STATE)==true)&&(!(psta->state & _FW_LINKED))) + { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_ucast_ap_link); + res =_FAIL; + goto exit; + } @@ -83801,7 +59902,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + if(psta == NULL) + { // if we cannot get psta => drop the pkt -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_sta); + RT_TRACE(_module_rtl871x_xmit_c_, _drv_alert_, ("\nupdate_attrib => get sta_info fail, ra:" MAC_FMT "\n", MAC_ARG(pattrib->ra))); + #ifdef DBG_TX_DROP_FRAME + DBG_871X("DBG_TX_DROP_FRAME %s get sta_info fail, ra:" MAC_FMT"\n", __FUNCTION__, MAC_ARG(pattrib->ra)); @@ -83812,39 +59912,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + if(!(psta->state &_FW_LINKED)) + { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_link); + DBG_871X("%s, psta("MAC_FMT")->state(0x%x) != _FW_LINKED\n", __func__, MAC_ARG(psta->hwaddr), psta->state); + return _FAIL; + } -+#ifdef CONFIG_BEAMFORMING -+ update_attrib_txbf_info(padapter, pattrib, psta); -+#endif ++ ++ + + //TODO:_lock + if(update_attrib_sec_info(padapter, pattrib, psta) == _FAIL) + { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_sec); + res = _FAIL; + goto exit; + } + -+ update_attrib_phy_info(padapter, pattrib, psta); ++ update_attrib_phy_info(pattrib, psta); + ++ pattrib->mac_id = psta->mac_id; + //DBG_8192C("%s ==> mac_id(%d)\n",__FUNCTION__,pattrib->mac_id ); -+ ++ + pattrib->psta = psta; + //TODO:_unlock -+ -+ pattrib->pctrl = 0; -+ ++ ++ pattrib->pctrl = 0; ++ + pattrib->ack_policy = 0; + // get ether_hdr_len + pattrib->pkt_hdrlen = ETH_HLEN;//(pattrib->ether_type == 0x8100) ? (14 + 4 ): 14; //vlan tag + + pattrib->hdrlen = WLAN_HDR_A3_LEN; -+ pattrib->subtype = WIFI_DATA_TYPE; ++ pattrib->subtype = WIFI_DATA_TYPE; + pattrib->priority = 0; -+ ++ + if (check_fwstate(pmlmepriv, WIFI_AP_STATE|WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE)) + { + if(pattrib->qos_en) @@ -83852,41 +59950,64 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + } + else + { -+#ifdef CONFIG_TDLS -+ if (pattrib->direct_link == _TRUE) { -+ if (pattrib->qos_en) -+ set_qos(&pktfile, pattrib); -+ } else -+#endif ++ if(pqospriv->qos_option) + { -+ if (pqospriv->qos_option) { -+ set_qos(&pktfile, pattrib); ++ set_qos(&pktfile, pattrib); + -+ if (pmlmepriv->acm_mask != 0) -+ pattrib->priority = qos_acm(pmlmepriv->acm_mask, pattrib->priority); ++ if(pmlmepriv->acm_mask != 0) ++ { ++ pattrib->priority = qos_acm(pmlmepriv->acm_mask, pattrib->priority); + } + } + } + + //pattrib->priority = 5; //force to used VI queue, for testing -+ pattrib->hw_ssn_sel = pxmitpriv->hw_ssn_seq_no; ++ ++ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ++ ("update_attrib: encrypt=%d securitypriv.sw_encrypt=%d\n", ++ pattrib->encrypt, padapter->securitypriv.sw_encrypt)); ++ ++ if (pattrib->encrypt && ++ ((padapter->securitypriv.sw_encrypt == true) || (psecuritypriv->hw_decrypted == false))) ++ { ++ pattrib->bswenc = true; ++ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_, ++ ("update_attrib: encrypt=%d securitypriv.hw_decrypted=%d bswenc=true\n", ++ pattrib->encrypt, padapter->securitypriv.sw_encrypt)); ++ } else { ++ pattrib->bswenc = false; ++ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("update_attrib: bswenc=false\n")); ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if((pattrib->encrypt && bmcast) || (pattrib->encrypt ==_WEP40_) || (pattrib->encrypt ==_WEP104_)) ++ { ++ pattrib->bswenc = true;//force using sw enc. ++ } ++#endif ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if(pattrib->encrypt == _SMS4_) ++ pattrib->bswenc = false; ++#endif ++ + rtw_set_tx_chksum_offload(pkt, pattrib); + +exit: + -+_func_exit_; ++ + + return res; +} + +static s32 xmitframe_addmic(_adapter *padapter, struct xmit_frame *pxmitframe){ -+ sint curfragnum,length; ++ sint curfragnum,length; + u8 *pframe, *payload,mic[8]; + struct mic_data micdata; + //struct sta_info *stainfo; -+ struct qos_priv *pqospriv= &(padapter->mlmepriv.qospriv); ++ struct qos_priv *pqospriv= &(padapter->mlmepriv.qospriv); + struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; ++ struct security_priv *psecuritypriv=&padapter->securitypriv; + struct xmit_priv *pxmitpriv=&padapter->xmitpriv; + u8 priority[4]={0x0,0x0,0x0,0x0}; + u8 hw_hdr_offset = 0; @@ -83901,8 +60022,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + { + DBG_871X("%s, call rtw_get_stainfo()\n", __func__); + stainfo=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0]); -+ } -+ ++ } ++ + if(stainfo==NULL) + { + DBG_871X("%s, psta==NUL\n", __func__); @@ -83916,19 +60037,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + } +*/ + -+_func_enter_; ++ + +#ifdef CONFIG_USB_TX_AGGREGATION -+ hw_hdr_offset = TXDESC_SIZE + (pxmitframe->pkt_offset * PACKET_OFFSET_SZ);; ++ hw_hdr_offset = TXDESC_SIZE + (pxmitframe->pkt_offset * PACKET_OFFSET_SZ);; +#else + #ifdef CONFIG_TX_EARLY_MODE + hw_hdr_offset = TXDESC_OFFSET+ EARLY_MODE_INFO_SIZE; + #else + hw_hdr_offset = TXDESC_OFFSET; + #endif -+#endif -+ -+ if(pattrib->encrypt ==_TKIP_)//if(psecuritypriv->dot11PrivacyAlgrthm==_TKIP_PRIVACY_) ++#endif ++ ++ if(pattrib->encrypt ==_TKIP_)//if(psecuritypriv->dot11PrivacyAlgrthm==_TKIP_PRIVACY_) + { + //encode mic code + //if(stainfo!= NULL) @@ -83936,20 +60057,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + u8 null_key[16]={0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0}; + + pframe = pxmitframe->buf_addr + hw_hdr_offset; -+ ++ + if(bmcst) + { -+ if(_rtw_memcmp(psecuritypriv->dot118021XGrptxmickey[psecuritypriv->dot118021XGrpKeyid].skey, null_key, 16)==_TRUE){ ++ if(_rtw_memcmp(psecuritypriv->dot118021XGrptxmickey[psecuritypriv->dot118021XGrpKeyid].skey, null_key, 16)==true){ + //DbgPrint("\nxmitframe_addmic:stainfo->dot11tkiptxmickey==0\n"); + //rtw_msleep_os(10); + return _FAIL; -+ } ++ } + //start to calculate the mic code + rtw_secmicsetkey(&micdata, psecuritypriv->dot118021XGrptxmickey[psecuritypriv->dot118021XGrpKeyid].skey); + } + else + { -+ if(_rtw_memcmp(&pattrib->dot11tkiptxmickey.skey[0],null_key, 16)==_TRUE){ ++ if(_rtw_memcmp(&pattrib->dot11tkiptxmickey.skey[0],null_key, 16)==true){ + //DbgPrint("\nxmitframe_addmic:stainfo->dot11tkiptxmickey==0\n"); + //rtw_msleep_os(10); + return _FAIL; @@ -83957,14 +60078,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + //start to calculate the mic code + rtw_secmicsetkey(&micdata, &pattrib->dot11tkiptxmickey.skey[0]); + } -+ ++ + if(pframe[1]&1){ //ToDS==1 + rtw_secmicappend(&micdata, &pframe[16], 6); //DA + if(pframe[1]&2) //From Ds==1 + rtw_secmicappend(&micdata, &pframe[24], 6); + else -+ rtw_secmicappend(&micdata, &pframe[10], 6); -+ } ++ rtw_secmicappend(&micdata, &pframe[10], 6); ++ } + else{ //ToDS==0 + rtw_secmicappend(&micdata, &pframe[4], 6); //DA + if(pframe[1]&2) //From Ds==1 @@ -83978,9 +60099,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + if(pattrib->qos_en) + priority[0]=(u8)pxmitframe->attrib.priority; + -+ ++ + rtw_secmicappend(&micdata, &priority[0], 4); -+ ++ + payload=pframe; + + for(curfragnum=0;curfragnumnr_frags;curfragnum++){ @@ -84012,7 +60133,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + _rtw_memcpy(payload, &(mic[0]),8); + pattrib->last_txcmdsz+=8; -+ ++ + RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("\n ========last pkt========\n")); + payload=payload-pattrib->last_txcmdsz+8; + for(curfragnum=0;curfragnumlast_txcmdsz;curfragnum=curfragnum+8) @@ -84024,10 +60145,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + else{ + RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("xmitframe_addmic: rtw_get_stainfo==NULL!!!\n")); + } -+*/ ++*/ + } -+ -+_func_exit_; ++ ++ + + return _SUCCESS; +} @@ -84035,11 +60156,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +static s32 xmitframe_swencrypt(_adapter *padapter, struct xmit_frame *pxmitframe){ + + struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ //struct security_priv *psecuritypriv=&padapter->securitypriv; -+ -+_func_enter_; ++ //struct security_priv *psecuritypriv=&padapter->securitypriv; + -+ //if((psecuritypriv->sw_encrypt)||(pattrib->bswenc)) ++ ++ ++ //if((psecuritypriv->sw_encrypt)||(pattrib->bswenc)) + if(pattrib->bswenc) + { + //DBG_871X("start xmitframe_swencrypt\n"); @@ -84067,7 +60188,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + RT_TRACE(_module_rtl871x_xmit_c_,_drv_notice_,("### xmitframe_hwencrypt\n")); + } + -+_func_exit_; ++ + + return _SUCCESS; +} @@ -84079,70 +60200,55 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + struct rtw_ieee80211_hdr *pwlanhdr = (struct rtw_ieee80211_hdr *)hdr; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ u8 qos_option = _FALSE; ++ u8 qos_option = false; ++#ifdef CONFIG_TDLS ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_info *ptdls_sta=NULL, *psta_backup=NULL; ++ u8 direct_link=0; ++#endif //CONFIG_TDLS + sint res = _SUCCESS; -+ u16 *fctrl = &pwlanhdr->frame_ctl; -+ -+ //struct sta_info *psta; -+ -+ //sint bmcst = IS_MCAST(pattrib->ra); -+ -+_func_enter_; -+ -+/* -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if(pattrib->psta != psta) -+ { -+ DBG_871X("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return; -+ } -+ -+ if(psta==NULL) -+ { -+ DBG_871X("%s, psta==NUL\n", __func__); -+ return _FAIL; -+ } -+ -+ if(!(psta->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return _FAIL; -+ } -+*/ ++ __le16 *fctrl = &pwlanhdr->frame_ctl; + + _rtw_memset(hdr, 0, WLANHDR_OFFSET); + + SetFrameSubType(fctrl, pattrib->subtype); + -+ if (pattrib->subtype & WIFI_DATA_TYPE) -+ { -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)) { ++ if (pattrib->subtype & WIFI_DATA_TYPE) { ++ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true)) { ++ //to_ds = 1, fr_ds = 0; +#ifdef CONFIG_TDLS -+ if(pattrib->direct_link == _TRUE){ -+ //TDLS data transfer, ToDS=0, FrDs=0 -+ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); -+ -+ if (pattrib->qos_en) -+ qos_option = _TRUE; -+ } -+ else ++ if((ptdlsinfo->setup_state == TDLS_LINKED_STATE)){ ++ ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); ++ if((ptdls_sta!=NULL)&&(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)&&(pattrib->ether_type!=0x0806)){ ++ //TDLS data transfer, ToDS=0, FrDs=0 ++ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); ++ direct_link=1; ++ }else{ ++ // 1.Data transfer to AP ++ // 2.Arp pkt will relayed by AP ++ SetToDs(fctrl); ++ _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); ++ } ++ }else +#endif //CONFIG_TDLS + { -+ //to_ds = 1, fr_ds = 0; -+ // 1.Data transfer to AP -+ // 2.Arp pkt will relayed by AP -+ SetToDs(fctrl); ++ //Data transfer to AP ++ SetToDs(fctrl); + _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->ta, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); ++ } ++ ++ if (pqospriv->qos_option) ++ qos_option = true; + -+ if (pqospriv->qos_option) -+ qos_option = _TRUE; -+ } + } -+ else if ((check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ) { ++ else if ((check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) ) { + //to_ds = 0, fr_ds = 1; + SetFrDs(fctrl); + _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); @@ -84150,16 +60256,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _rtw_memcpy(pwlanhdr->addr3, pattrib->src, ETH_ALEN); + + if(pattrib->qos_en) -+ qos_option = _TRUE; ++ qos_option = true; + } -+ else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { ++ else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) { + _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->ta, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); + + if(pattrib->qos_en) -+ qos_option = _TRUE; ++ qos_option = true; + } + else { + RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("fw_state:%x is not allowed to xmit frame\n", get_fwstate(pmlmepriv))); @@ -84209,11 +60315,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + return _FAIL; + } + -+ -+ if(psta) ++ //if(psta) + { ++#ifdef CONFIG_TDLS ++ if(direct_link==1) ++ { ++ psta_backup = psta; ++ psta = ptdls_sta; ++ } ++#endif //CONFIG_TDLS ++ + psta->sta_xmitpriv.txseq_tid[pattrib->priority]++; + psta->sta_xmitpriv.txseq_tid[pattrib->priority] &= 0xFFF; ++ + pattrib->seqnum = psta->sta_xmitpriv.txseq_tid[pattrib->priority]; + + SetSeqNum(hdr, pattrib->seqnum); @@ -84223,40 +60337,65 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + if(pattrib->ht_en && psta->htpriv.ampdu_enable) + { + if(psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) -+ pattrib->ampdu_en = _TRUE; ++ pattrib->ampdu_en = true; + } + + //re-check if enable ampdu by BA_starting_seqctrl -+ if(pattrib->ampdu_en == _TRUE) -+ { ++ if(pattrib->ampdu_en == true) ++ { + u16 tx_seq; + + tx_seq = psta->BA_starting_seqctrl[pattrib->priority & 0x0f]; -+ ++ + //check BA_starting_seqctrl + if(SN_LESS(pattrib->seqnum, tx_seq)) + { + //DBG_871X("tx ampdu seqnum(%d) < tx_seq(%d)\n", pattrib->seqnum, tx_seq); -+ pattrib->ampdu_en = _FALSE;//AGG BK ++ pattrib->ampdu_en = false;//AGG BK + } + else if(SN_EQUAL(pattrib->seqnum, tx_seq)) -+ { ++ { + psta->BA_starting_seqctrl[pattrib->priority & 0x0f] = (tx_seq+1)&0xfff; -+ -+ pattrib->ampdu_en = _TRUE;//AGG EN ++ ++ pattrib->ampdu_en = true;//AGG EN + } + else + { + //DBG_871X("tx ampdu over run\n"); + psta->BA_starting_seqctrl[pattrib->priority & 0x0f] = (pattrib->seqnum+1)&0xfff; -+ pattrib->ampdu_en = _TRUE;//AGG EN ++ pattrib->ampdu_en = true;//AGG EN + } + + } +#endif //CONFIG_80211N_HT ++#ifdef CONFIG_TDLS ++ if(direct_link==1) ++ { ++ if (pattrib->encrypt){ ++ pattrib->encrypt= _AES_; ++ pattrib->iv_len=8; ++ pattrib->icv_len=8; ++ } ++ ++ //qos_en, ht_en, init rate, ,bw, ch_offset, sgi ++ //pattrib->qos_en = ptdls_sta->qos_option; ++ ++ pattrib->raid = ptdls_sta->raid; ++#ifdef CONFIG_80211N_HT ++ pattrib->bwmode = ptdls_sta->htpriv.bwmode; ++ pattrib->ht_en = ptdls_sta->htpriv.ht_option; ++ pattrib->ch_offset = ptdls_sta->htpriv.ch_offset; ++ pattrib->sgi= ptdls_sta->htpriv.sgi; ++#endif //CONFIG_80211N_HT ++ pattrib->mac_id = ptdls_sta->mac_id; ++ ++ psta = psta_backup; ++ } ++#endif //CONFIG_TDLS ++ + } + } -+ ++ + } + else + { @@ -84265,7 +60404,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + +exit: + -+_func_exit_; ++ + + return res; +} @@ -84274,14 +60413,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +{ + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + -+ return ((_rtw_queue_empty(&pxmitpriv->be_pending) == _FALSE) || -+ (_rtw_queue_empty(&pxmitpriv->bk_pending) == _FALSE) || -+ (_rtw_queue_empty(&pxmitpriv->vi_pending) == _FALSE) || -+ (_rtw_queue_empty(&pxmitpriv->vo_pending) == _FALSE)); ++ return ((_rtw_queue_empty(&pxmitpriv->be_pending) == false) || ++ (_rtw_queue_empty(&pxmitpriv->bk_pending) == false) || ++ (_rtw_queue_empty(&pxmitpriv->vi_pending) == false) || ++ (_rtw_queue_empty(&pxmitpriv->vo_pending) == false)); +} + +s32 rtw_txframes_sta_ac_pending(_adapter *padapter, struct pkt_attrib *pattrib) -+{ ++{ + struct sta_info *psta; + struct tx_servq *ptxservq; + int priority = pattrib->priority; @@ -84294,7 +60433,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + { + DBG_871X("%s, call rtw_get_stainfo()\n", __func__); + psta=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0]); -+ } ++ } +*/ + psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); + if(pattrib->psta != psta) @@ -84314,69 +60453,64 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); + return 0; + } -+ -+ switch(priority) ++ ++ switch(priority) + { + case 1: + case 2: -+ ptxservq = &(psta->sta_xmitpriv.bk_q); ++ ptxservq = &(psta->sta_xmitpriv.bk_q); + break; + case 4: + case 5: -+ ptxservq = &(psta->sta_xmitpriv.vi_q); ++ ptxservq = &(psta->sta_xmitpriv.vi_q); + break; + case 6: + case 7: -+ ptxservq = &(psta->sta_xmitpriv.vo_q); ++ ptxservq = &(psta->sta_xmitpriv.vo_q); + break; + case 0: + case 3: + default: -+ ptxservq = &(psta->sta_xmitpriv.be_q); ++ ptxservq = &(psta->sta_xmitpriv.be_q); + break; -+ -+ } + -+ return ptxservq->qcnt; ++ } ++ ++ return ptxservq->qcnt; +} + +#ifdef CONFIG_TDLS + -+int rtw_build_tdls_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) ++int rtw_build_tdls_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, u8 action) +{ + int res=_SUCCESS; + -+ switch(ptxmgmt->action_code){ ++ switch(action){ + case TDLS_SETUP_REQUEST: -+ rtw_build_tdls_setup_req_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ rtw_build_tdls_setup_req_ies(padapter, pxmitframe, pframe); + break; + case TDLS_SETUP_RESPONSE: -+ rtw_build_tdls_setup_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ rtw_build_tdls_setup_rsp_ies(padapter, pxmitframe, pframe); + break; + case TDLS_SETUP_CONFIRM: -+ rtw_build_tdls_setup_cfm_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ rtw_build_tdls_setup_cfm_ies(padapter, pxmitframe, pframe); + break; + case TDLS_TEARDOWN: -+ rtw_build_tdls_teardown_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ rtw_build_tdls_teardown_ies(padapter, pxmitframe, pframe); + break; + case TDLS_DISCOVERY_REQUEST: -+ rtw_build_tdls_dis_req_ies(padapter, pxmitframe, pframe, ptxmgmt); -+ break; -+ case TDLS_PEER_TRAFFIC_INDICATION: -+ rtw_build_tdls_peer_traffic_indication_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ rtw_build_tdls_dis_req_ies(padapter, pxmitframe, pframe); ++ break; ++ case TDLS_PEER_TRAFFIC_INDICATION: ++ rtw_build_tdls_peer_traffic_indication_ies(padapter, pxmitframe, pframe); + break; -+#ifdef CONFIG_TDLS_CH_SW + case TDLS_CHANNEL_SWITCH_REQUEST: -+ rtw_build_tdls_ch_switch_req_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ rtw_build_tdls_ch_switch_req_ies(padapter, pxmitframe, pframe); + break; + case TDLS_CHANNEL_SWITCH_RESPONSE: -+ rtw_build_tdls_ch_switch_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ rtw_build_tdls_ch_switch_rsp_ies(padapter, pxmitframe, pframe); + break; -+#endif -+ case TDLS_PEER_TRAFFIC_RESPONSE: -+ rtw_build_tdls_peer_traffic_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt); -+ break; -+#ifdef CONFIG_WFD ++#ifdef CONFIG_WFD + case TUNNELED_PROBE_REQ: + rtw_build_tunneled_probe_req_ies(padapter, pxmitframe, pframe); + break; @@ -84392,34 +60526,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + return res; +} + -+s32 rtw_make_tdls_wlanhdr (_adapter *padapter , u8 *hdr, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt) ++s32 rtw_make_tdls_wlanhdr (_adapter *padapter , u8 *hdr, struct pkt_attrib *pattrib, u8 action) +{ + u16 *qc; + struct rtw_ieee80211_hdr *pwlanhdr = (struct rtw_ieee80211_hdr *)hdr; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct sta_priv *pstapriv = &padapter->stapriv; + struct sta_info *psta=NULL, *ptdls_sta=NULL; + u8 tdls_seq=0, baddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; + + sint res = _SUCCESS; + u16 *fctrl = &pwlanhdr->frame_ctl; + -+_func_enter_; ++ + + _rtw_memset(hdr, 0, WLANHDR_OFFSET); + + SetFrameSubType(fctrl, pattrib->subtype); + -+ switch(ptxmgmt->action_code){ ++ switch(action){ + case TDLS_SETUP_REQUEST: + case TDLS_SETUP_RESPONSE: + case TDLS_SETUP_CONFIRM: ++ case TDLS_TEARDOWN: //directly to peer STA or via AP + case TDLS_PEER_TRAFFIC_INDICATION: -+ case TDLS_PEER_PSM_REQUEST: ++ case TDLS_PEER_PSM_REQUEST: //directly to peer STA or via AP + case TUNNELED_PROBE_REQ: + case TUNNELED_PROBE_RSP: -+ case TDLS_DISCOVERY_REQUEST: + SetToDs(fctrl); + _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); @@ -84434,32 +60568,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); + tdls_seq=1; + break; -+ case TDLS_TEARDOWN: -+ if(ptxmgmt->status_code == _RSON_TDLS_TEAR_UN_RSN_) ++ case TDLS_DISCOVERY_REQUEST: //unicast: directly to peer sta, Bcast: via AP ++ if(_rtw_memcmp(pattrib->dst, baddr, ETH_ALEN) ) ++ { ++ SetToDs(fctrl); ++ _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); ++ } ++ else + { + _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); + tdls_seq=1; + } -+ else -+ { -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); -+ } + break; + } + + if (pattrib->encrypt) + SetPrivacy(fctrl); + -+ if(ptxmgmt->action_code == TDLS_PEER_TRAFFIC_RESPONSE) -+ { -+ SetPwrMgt(fctrl); -+ } -+ + if (pqospriv->qos_option) + { + qc = (unsigned short *)(hdr + pattrib->hdrlen - 2); @@ -84469,7 +60598,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + } + + psta = pattrib->psta; -+ ++ + // 1. update seq_num per link by sta_info + // 2. rewrite encrypt to _AES_, also rewrite iv_len, icv_len + if(tdls_seq==1){ @@ -84484,9 +60613,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + pattrib->encrypt= _AES_; + pattrib->iv_len=8; + pattrib->icv_len=8; -+ pattrib->bswenc = _FALSE; + } -+ pattrib->mac_id = ptdls_sta->mac_id; + }else{ + res=_FAIL; + goto exit; @@ -84501,12 +60628,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + +exit: + -+_func_exit_; ++ + + return res; +} + -+s32 rtw_xmit_tdls_coalesce(_adapter * padapter, struct xmit_frame * pxmitframe, struct tdls_txmgmt *ptxmgmt) ++s32 rtw_xmit_tdls_coalesce(_adapter * padapter, struct xmit_frame * pxmitframe, u8 action) +{ + s32 llc_sz; + @@ -84519,12 +60646,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + u8 *pbuf_start; + s32 bmcst = IS_MCAST(pattrib->ra); + s32 res = _SUCCESS; -+ -+_func_enter_; ++ ++ + + if (pattrib->psta) { + psta = pattrib->psta; -+ } else { ++ } else { + if(bmcst) { + psta = rtw_get_bcmc_stainfo(padapter); + } else { @@ -84532,20 +60659,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + } + } + -+ if (psta==NULL) { -+ res = _FAIL; -+ goto exit; -+ } ++ if(psta==NULL) ++ return _FAIL; + -+ if (pxmitframe->buf_addr == NULL) { -+ res = _FAIL; -+ goto exit; -+ } ++ if (pxmitframe->buf_addr == NULL) ++ return _FAIL; + + pbuf_start = pxmitframe->buf_addr; + mem_start = pbuf_start + TXDESC_OFFSET; + -+ if (rtw_make_tdls_wlanhdr(padapter, mem_start, pattrib, ptxmgmt) == _FAIL) { ++ if (rtw_make_tdls_wlanhdr(padapter, mem_start, pattrib, action) == _FAIL) { + res = _FAIL; + goto exit; + } @@ -84562,14 +60685,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + { + case _WEP40_: + case _WEP104_: -+ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); ++ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); + break; -+ case _TKIP_: ++ case _TKIP_: + if(bmcst) + TKIP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); + else + TKIP_IV(pattrib->iv, psta->dot11txpn, 0); -+ break; ++ break; + case _AES_: + if(bmcst) + AES_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); @@ -84590,31 +60713,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + //pattrib->pktlen will be counted in rtw_build_tdls_ies + pattrib->pktlen = 0; + -+ rtw_build_tdls_ies(padapter, pxmitframe, pframe, ptxmgmt); ++ rtw_build_tdls_ies(padapter, pxmitframe, pframe, action); + + if ((pattrib->icv_len >0 )&& (pattrib->bswenc)) { + pframe += pattrib->pktlen; -+ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); ++ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); + pframe += pattrib->icv_len; + } + + pattrib->nr_frags = 1; -+ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len + llc_sz + ++ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len + llc_sz + + ((pattrib->bswenc) ? pattrib->icv_len : 0) + pattrib->pktlen; -+ ++ + if (xmitframe_addmic(padapter, pxmitframe) == _FAIL) + { -+ res = _FAIL; + goto exit; + } + + xmitframe_swencrypt(padapter, pxmitframe); -+ ++ + update_attrib_vcs_info(padapter, pxmitframe); -+ -+exit: -+ -+_func_exit_; ++ ++exit: ++ ++ + + return res; +} @@ -84646,7 +60768,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +3. append sta's iv/ext-iv +4. append LLC +5. move frag chunk from pframe to pxmitframe->mem -+6. apply sw-encrypt, if necessary. ++6. apply sw-encrypt, if necessary. + +*/ +s32 rtw_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe) @@ -84672,21 +60794,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + s32 bmcst = IS_MCAST(pattrib->ra); + s32 res = _SUCCESS; + -+_func_enter_; ++ + +/* + if (pattrib->psta) + { + psta = pattrib->psta; + } else -+ { ++ { + DBG_871X("%s, call rtw_get_stainfo()\n", __func__); + psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); + } + + if(psta==NULL) + { -+ ++ + DBG_871X("%s, psta==NUL\n", __func__); + return _FAIL; + } @@ -84704,7 +60826,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + } + + pbuf_start = pxmitframe->buf_addr; -+ ++ +#ifdef CONFIG_USB_TX_AGGREGATION + hw_hdr_offset = TXDESC_SIZE + (pxmitframe->pkt_offset * PACKET_OFFSET_SZ); +#else @@ -84746,7 +60868,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + //adding icv, if necessary... + if (pattrib->iv_len) + { -+/* ++/* + //if (check_fwstate(pmlmepriv, WIFI_MP_STATE)) + // psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); + //else @@ -84758,14 +60880,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + { + case _WEP40_: + case _WEP104_: -+ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); ++ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); + break; -+ case _TKIP_: ++ case _TKIP_: + if(bmcst) + TKIP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); + else + TKIP_IV(pattrib->iv, psta->dot11txpn, 0); -+ break; ++ break; + case _AES_: + if(bmcst) + AES_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); @@ -84812,19 +60934,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + pframe += mem_sz; + + if ((pattrib->icv_len >0 )&& (pattrib->bswenc)) { -+ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); ++ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); + pframe += pattrib->icv_len; + } + + frg_inx++; + -+ if (bmcst || (rtw_endofpktfile(&pktfile) == _TRUE)) ++ if (bmcst || (rtw_endofpktfile(&pktfile) == true)) + { + pattrib->nr_frags = frg_inx; + -+ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len + ((pattrib->nr_frags==1)? llc_sz:0) + ++ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len + ((pattrib->nr_frags==1)? llc_sz:0) + + ((pattrib->bswenc) ? pattrib->icv_len : 0) + mem_sz; -+ ++ + ClearMFrag(mem_start); + + break; @@ -84835,8 +60957,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + addr = (SIZE_PTR)(pframe); + + mem_start = (unsigned char *)RND4(addr) + hw_hdr_offset; -+ _rtw_memcpy(mem_start, pbuf_start + hw_hdr_offset, pattrib->hdrlen); -+ ++ _rtw_memcpy(mem_start, pbuf_start + hw_hdr_offset, pattrib->hdrlen); ++ + } + + if (xmitframe_addmic(padapter, pxmitframe) == _FAIL) @@ -84849,259 +60971,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + xmitframe_swencrypt(padapter, pxmitframe); + -+ if(bmcst == _FALSE) ++ if(bmcst == false) + update_attrib_vcs_info(padapter, pxmitframe); + else + pattrib->vcs_mode = NONE_VCS; + -+exit: -+ -+_func_exit_; ++exit: ++ ++ + + return res; +} + -+#ifdef CONFIG_IEEE80211W -+//broadcast or multicast management pkt use BIP, unicast management pkt use CCMP encryption -+s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe) -+{ -+ struct pkt_file pktfile; -+ s32 frg_inx, frg_len, mpdu_len, llc_sz, mem_sz; -+ SIZE_PTR addr; -+ u8 *pframe, *mem_start = NULL, *tmp_buf=NULL; -+ u8 hw_hdr_offset, subtype ; -+ struct sta_info *psta = NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 *pbuf_start; -+ s32 bmcst = IS_MCAST(pattrib->ra); -+ s32 res = _FAIL; -+ u8 *BIP_AAD=NULL; -+ u8 *MGMT_body=NULL; -+ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u8 MME[_MME_IE_LENGTH_]; -+ -+ _irqL irqL; -+ u32 ori_len; -+ mem_start = pframe = (u8 *)(pxmitframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+_func_enter_; -+ ori_len = BIP_AAD_SIZE+pattrib->pktlen; -+ tmp_buf = BIP_AAD = rtw_zmalloc(ori_len); -+ subtype = GetFrameSubType(pframe); //bit(7)~bit(2) -+ -+ if(BIP_AAD == NULL) -+ return _FAIL; -+ -+ _enter_critical_bh(&padapter->security_key_mutex, &irqL); -+ -+ -+ //IGTK key is not install, it may not support 802.11w -+ if(padapter->securitypriv.binstallBIPkey != _TRUE) -+ { -+ DBG_871X("no instll BIP key\n"); -+ goto xmitframe_coalesce_success; -+ } -+ //station mode doesn't need TX BIP, just ready the code -+ if(bmcst) -+ { -+ int frame_body_len; -+ u8 mic[16]; -+ -+ _rtw_memset(MME, 0, _MME_IE_LENGTH_); -+ -+ //other types doesn't need the BIP -+ if(GetFrameSubType(pframe) != WIFI_DEAUTH && GetFrameSubType(pframe) != WIFI_DISASSOC) -+ goto xmitframe_coalesce_fail; -+ -+ MGMT_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ pframe += pattrib->pktlen; -+ -+ //octent 0 and 1 is key index ,BIP keyid is 4 or 5, LSB only need octent 0 -+ MME[0]=padapter->securitypriv.dot11wBIPKeyid; -+ //copy packet number -+ _rtw_memcpy(&MME[2], &pmlmeext->mgnt_80211w_IPN, 6); -+ //increase the packet number -+ pmlmeext->mgnt_80211w_IPN++; -+ -+ //add MME IE with MIC all zero, MME string doesn't include element id and length -+ pframe = rtw_set_ie(pframe, _MME_IE_ , 16 , MME, &(pattrib->pktlen)); -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ // total frame length - header length -+ frame_body_len = pattrib->pktlen - sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ //conscruct AAD, copy frame control field -+ _rtw_memcpy(BIP_AAD, &pwlanhdr->frame_ctl, 2); -+ ClearRetry(BIP_AAD); -+ ClearPwrMgt(BIP_AAD); -+ ClearMData(BIP_AAD); -+ //conscruct AAD, copy address 1 to address 3 -+ _rtw_memcpy(BIP_AAD+2, pwlanhdr->addr1, 18); -+ //copy management fram body -+ _rtw_memcpy(BIP_AAD+BIP_AAD_SIZE, MGMT_body, frame_body_len); -+ /*//dump total packet include MME with zero MIC -+ { -+ int i; -+ printk("Total packet: "); -+ for(i=0; i < BIP_AAD_SIZE+frame_body_len; i++) -+ printk(" %02x ", BIP_AAD[i]); -+ printk("\n"); -+ }*/ -+ //calculate mic -+ if(omac1_aes_128(padapter->securitypriv.dot11wBIPKey[padapter->securitypriv.dot11wBIPKeyid].skey -+ , BIP_AAD, BIP_AAD_SIZE+frame_body_len, mic)) -+ goto xmitframe_coalesce_fail; -+ -+ /*//dump calculated mic result -+ { -+ int i; -+ printk("Calculated mic result: "); -+ for(i=0; i<16; i++) -+ printk(" %02x ", mic[i]); -+ printk("\n"); -+ }*/ -+ //copy right BIP mic value, total is 128bits, we use the 0~63 bits -+ _rtw_memcpy(pframe-8, mic, 8); -+ /*/dump all packet after mic ok -+ { -+ int pp; -+ printk("pattrib->pktlen = %d \n", pattrib->pktlen); -+ for(pp=0;pp< pattrib->pktlen; pp++) -+ printk(" %02x ", mem_start[pp]); -+ printk("\n"); -+ }*/ -+ } -+ else //unicast mgmt frame TX -+ { -+ //start to encrypt mgmt frame -+ if(subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || -+ subtype == WIFI_REASSOCREQ || subtype == WIFI_ACTION) -+ { -+ if (pattrib->psta) -+ psta = pattrib->psta; -+ else -+ { -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ } -+ -+ if(psta==NULL) -+ { -+ -+ DBG_871X("%s, psta==NUL\n", __func__); -+ goto xmitframe_coalesce_fail; -+ } -+ -+ if (pxmitframe->buf_addr == NULL) { -+ DBG_871X("%s, pxmitframe->buf_addr\n", __func__); -+ goto xmitframe_coalesce_fail; -+ } -+ -+ //DBG_871X("%s, action frame category=%d \n", __func__, pframe[WLAN_HDR_A3_LEN]); -+ //according 802.11-2012 standard, these five types are not robust types -+ if(subtype == WIFI_ACTION && -+ (pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_PUBLIC || -+ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_HT || -+ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_UNPROTECTED_WNM || -+ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_SELF_PROTECTED || -+ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_P2P)) -+ goto xmitframe_coalesce_fail; -+ //before encrypt dump the management packet content -+ /*{ -+ int i; -+ printk("Management pkt: "); -+ for(i=0; ipktlen; i++) -+ printk(" %02x ", pframe[i]); -+ printk("=======\n"); -+ }*/ -+ if(pattrib->encrypt>0) -+ _rtw_memcpy(pattrib->dot118021x_UncstKey.skey, psta->dot118021x_UncstKey.skey, 16); -+ -+ /* To use wrong key */ -+ if (pattrib->key_type == IEEE80211W_WRONG_KEY) { -+ DBG_871X("use wrong key\n"); -+ pattrib->dot118021x_UncstKey.skey[0] = 0xff; -+ } -+ -+ //bakeup original management packet -+ _rtw_memcpy(tmp_buf, pframe, pattrib->pktlen); -+ //move to data portion -+ pframe += pattrib->hdrlen; -+ -+ //802.11w unicast management packet must be _AES_ -+ pattrib->iv_len = 8; -+ //it's MIC of AES -+ pattrib->icv_len = 8; -+ -+ switch(pattrib->encrypt) -+ { -+ case _AES_: -+ //set AES IV header -+ AES_IV(pattrib->iv, psta->dot11wtxpn, 0); -+ break; -+ default: -+ goto xmitframe_coalesce_fail; -+ } -+ //insert iv header into management frame -+ _rtw_memcpy(pframe, pattrib->iv, pattrib->iv_len); -+ pframe += pattrib->iv_len; -+ //copy mgmt data portion after CCMP header -+ _rtw_memcpy(pframe, tmp_buf+pattrib->hdrlen, pattrib->pktlen-pattrib->hdrlen); -+ //move pframe to end of mgmt pkt -+ pframe += pattrib->pktlen-pattrib->hdrlen; -+ //add 8 bytes CCMP IV header to length -+ pattrib->pktlen += pattrib->iv_len; -+ /*//dump management packet include AES IV header -+ { -+ int i; -+ printk("Management pkt + IV: "); -+ //for(i=0; ipktlen; i++) -+ //printk(" %02x ", mem_start[i]); -+ printk("@@@@@@@@@@@@@\n"); -+ }*/ -+ -+ if ((pattrib->icv_len >0 )&& (pattrib->bswenc)) { -+ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); -+ pframe += pattrib->icv_len; -+ } -+ //add 8 bytes MIC -+ pattrib->pktlen += pattrib->icv_len; -+ //set final tx command size -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ //set protected bit must be beofre SW encrypt -+ SetPrivacy(mem_start); -+ /*//dump management packet include AES header -+ { -+ int i; -+ printk("prepare to enc Management pkt + IV: "); -+ for(i=0; ipktlen; i++) -+ printk(" %02x ", mem_start[i]); -+ printk("@@@@@@@@@@@@@\n"); -+ }*/ -+ //software encrypt -+ xmitframe_swencrypt(padapter, pxmitframe); -+ } -+ } -+ -+xmitframe_coalesce_success: -+ _exit_critical_bh(&padapter->security_key_mutex, &irqL); -+ rtw_mfree(BIP_AAD, ori_len); -+_func_exit_; -+ return _SUCCESS; -+ -+xmitframe_coalesce_fail: -+ _exit_critical_bh(&padapter->security_key_mutex, &irqL); -+ rtw_mfree(BIP_AAD, ori_len); -+_func_exit_; -+ -+ return _FAIL; -+} -+#endif //CONFIG_IEEE80211W -+ +/* Logical Link Control(LLC) SubNetwork Attachment Point(SNAP) header + * IEEE LLC/SNAP header contains 8 octets + * First 3 octets comprise the LLC portion @@ -85114,7 +60995,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + struct ieee80211_snap_hdr *snap; + u8 *oui; + -+_func_enter_; ++ + + snap = (struct ieee80211_snap_hdr *)data; + snap->dsap = 0xaa; @@ -85125,14 +61006,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + oui = P802_1H_OUI; + else + oui = RFC1042_OUI; -+ ++ + snap->oui[0] = oui[0]; + snap->oui[1] = oui[1]; + snap->oui[2] = oui[2]; + -+ *(u16 *)(data + SNAP_SIZE) = htons(h_proto); ++ *(__be16 *)(data + SNAP_SIZE) = htons(h_proto); ++ + -+_func_exit_; + + return SNAP_SIZE + sizeof(u16); +} @@ -85145,18 +61026,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + sint erp_len; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+_func_enter_; -+ ++ ++ ++ + switch(pxmitpriv->vcs_setting) + { + case DISABLE_VCS: + pxmitpriv->vcs = NONE_VCS; + break; -+ ++ + case ENABLE_VCS: + break; -+ ++ + case AUTO_VCS: + default: + perp = rtw_get_ie(ie, _ERPINFO_IE_, &erp_len, ie_len); @@ -85178,11 +61059,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + pxmitpriv->vcs = NONE_VCS; + } + -+ break; -+ ++ break; ++ + } + -+_func_exit_; ++ + +} + @@ -85192,65 +61073,45 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + struct stainfo_stats *pstats = NULL; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 pkt_num = 1; + + if ((pxmitframe->frame_tag&0x0f) == DATA_FRAMETAG) + { -+#if defined(CONFIG_USB_TX_AGGREGATION) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pkt_num = pxmitframe->agg_num; -+#endif -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod += pkt_num; -+ -+ pxmitpriv->tx_pkts += pkt_num; -+ + pxmitpriv->tx_bytes += sz; ++#if defined(CONFIG_USB_TX_AGGREGATION) ++ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod += pxmitframe->agg_num; ++#else ++ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod++; ++#endif + + psta = pxmitframe->attrib.psta; + if (psta) + { + pstats = &psta->sta_stats; -+ -+ pstats->tx_pkts += pkt_num; -+ ++#if defined(CONFIG_USB_TX_AGGREGATION) ++ pstats->tx_pkts += pxmitframe->agg_num; ++#else ++ pstats->tx_pkts++; ++#endif + pstats->tx_bytes += sz; -+#ifdef CONFIG_TDLS -+ if(pxmitframe->attrib.ptdls_sta != NULL) -+ { -+ pstats = &(pxmitframe->attrib.ptdls_sta->sta_stats); -+ pstats->tx_pkts += pkt_num; -+ pstats->tx_bytes += sz; -+ } -+#endif //CONFIG_TDLS + } -+ -+#ifdef CONFIG_CHECK_LEAVE_LPS -+ //traffic_check_for_leave_lps(padapter, _TRUE); -+#endif //CONFIG_LPS -+ + } +} + -+static struct xmit_buf *__rtw_alloc_cmd_xmitbuf(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type) ++struct xmit_buf *rtw_alloc_cmd_xmitbuf(struct xmit_priv *pxmitpriv, u32 buffsize) +{ + struct xmit_buf *pxmitbuf = NULL; + -+_func_enter_; + -+ pxmitbuf = &pxmitpriv->pcmd_xmitbuf[buf_type]; ++ ++ pxmitbuf = &pxmitpriv->pcmd_xmitbuf; + if (pxmitbuf != NULL) { -+ pxmitbuf->priv_data = NULL; ++ if(rtw_os_xmit_resource_alloc(pxmitpriv->adapter, pxmitbuf,(buffsize + XMITBUF_ALIGN_SZ), false) == _FAIL) { ++ return NULL; ++ } + -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+ pxmitbuf->agg_num = 0; -+ pxmitbuf->pg_num = 0; -+#endif -+#ifdef CONFIG_PCI_HCI -+ pxmitbuf->len = 0; -+ pxmitbuf->desc = NULL; -+#endif ++ pxmitbuf->alloc_sz = buffsize + XMITBUF_ALIGN_SZ; ++ ++ pxmitbuf->priv_data = NULL; + + if (pxmitbuf->sctx) { + DBG_871X("%s pxmitbuf->sctx is not NULL\n", __func__); @@ -85260,15 +61121,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + DBG_871X("%s fail, no xmitbuf available !!!\n", __func__); + } + -+exit: + -+_func_exit_; + + return pxmitbuf; +} + -+struct xmit_frame *__rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type) ++s32 rtw_free_cmd_xmitbuf(struct xmit_priv *pxmitpriv) ++{ ++ struct xmit_buf *pxmitbuf = NULL; ++ ++ ++ ++ pxmitbuf = &pxmitpriv->pcmd_xmitbuf; ++ if (pxmitbuf==NULL) { ++ DBG_871X("%s fail, no xmitbuf available !!!\n", __func__); ++ return _FAIL; ++ } else { ++ rtw_os_xmit_resource_free(pxmitbuf->padapter, pxmitbuf, pxmitbuf->alloc_sz, false); ++ } ++ ++ ++ ++ return _SUCCESS; ++} ++ ++struct xmit_frame *rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, u32 buffsize) +{ + struct xmit_frame *pcmdframe; + struct xmit_buf *pxmitbuf; @@ -85279,7 +61156,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + return NULL; + } + -+ if ((pxmitbuf = __rtw_alloc_cmd_xmitbuf(pxmitpriv, buf_type)) == NULL) { ++ if ((pxmitbuf = rtw_alloc_cmd_xmitbuf(pxmitpriv, buffsize)) == NULL) { + DBG_871X("%s, alloc xmitbuf fail\n", __FUNCTION__); + rtw_free_xmitframe(pxmitpriv, pcmdframe); + return NULL; @@ -85297,6 +61174,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + +} + ++void rtw_free_cmdxmitframe(struct xmit_priv *pxmitpriv, struct xmit_frame *pxmitframe) ++{ ++ rtw_free_xmitframe(pxmitpriv, pxmitframe); ++ rtw_free_cmd_xmitbuf(pxmitpriv); ++} ++ +struct xmit_buf *rtw_alloc_xmitbuf_ext(struct xmit_priv *pxmitpriv) +{ + _irqL irqL; @@ -85304,11 +61187,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _list *plist, *phead; + _queue *pfree_queue = &pxmitpriv->free_xmit_extbuf_queue; + -+_func_enter_; ++ + + _enter_critical(&pfree_queue->lock, &irqL); + -+ if(_rtw_queue_empty(pfree_queue) == _TRUE) { ++ if(_rtw_queue_empty(pfree_queue) == true) { + pxmitbuf = NULL; + } else { + @@ -85327,19 +61210,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + #ifdef DBG_XMIT_BUF_EXT + DBG_871X("DBG_XMIT_BUF_EXT ALLOC no=%d, free_xmit_extbuf_cnt=%d\n",pxmitbuf->no, pxmitpriv->free_xmit_extbuf_cnt); + #endif -+ -+ -+ pxmitbuf->priv_data = NULL; + -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+ pxmitbuf->agg_num = 1; -+#endif -+#ifdef CONFIG_PCI_HCI -+ pxmitbuf->len = 0; -+ pxmitbuf->desc = NULL; -+#endif ++ ++ pxmitbuf->priv_data = NULL; + + if (pxmitbuf->sctx) { + DBG_871X("%s pxmitbuf->sctx is not NULL\n", __func__); @@ -85350,7 +61223,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + _exit_critical(&pfree_queue->lock, &irqL); + -+_func_exit_; ++ + + return pxmitbuf; +} @@ -85360,7 +61233,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _irqL irqL; + _queue *pfree_queue = &pxmitpriv->free_xmit_extbuf_queue; + -+_func_enter_; ++ + + if(pxmitbuf==NULL) + { @@ -85379,10 +61252,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + _exit_critical(&pfree_queue->lock, &irqL); + -+_func_exit_; ++ + + return _SUCCESS; -+} ++} + +struct xmit_buf *rtw_alloc_xmitbuf(struct xmit_priv *pxmitpriv) +{ @@ -85391,13 +61264,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _list *plist, *phead; + _queue *pfree_xmitbuf_queue = &pxmitpriv->free_xmitbuf_queue; + -+_func_enter_; ++ + + //DBG_871X("+rtw_alloc_xmitbuf\n"); + + _enter_critical(&pfree_xmitbuf_queue->lock, &irqL); + -+ if(_rtw_queue_empty(pfree_xmitbuf_queue) == _TRUE) { ++ if(_rtw_queue_empty(pfree_xmitbuf_queue) == true) { + pxmitbuf = NULL; + } else { + @@ -85420,17 +61293,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + pxmitbuf->priv_data = NULL; + -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+ pxmitbuf->agg_num = 0; -+ pxmitbuf->pg_num = 0; -+#endif -+#ifdef CONFIG_PCI_HCI -+ pxmitbuf->len = 0; -+ pxmitbuf->desc = NULL; -+#endif -+ + if (pxmitbuf->sctx) { + DBG_871X("%s pxmitbuf->sctx is not NULL\n", __func__); + rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_ALLOC); @@ -85445,7 +61307,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + _exit_critical(&pfree_xmitbuf_queue->lock, &irqL); + -+_func_exit_; ++ + + return pxmitbuf; +} @@ -85455,7 +61317,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _irqL irqL; + _queue *pfree_xmitbuf_queue = &pxmitpriv->free_xmitbuf_queue; + -+_func_enter_; ++ + + //DBG_871X("+rtw_free_xmitbuf\n"); + @@ -85478,7 +61340,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + { + _enter_critical(&pfree_xmitbuf_queue->lock, &irqL); + -+ rtw_list_delete(&pxmitbuf->list); ++ rtw_list_delete(&pxmitbuf->list); + + rtw_list_insert_tail(&(pxmitbuf->list), get_list_head(pfree_xmitbuf_queue)); + @@ -85490,12 +61352,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _exit_critical(&pfree_xmitbuf_queue->lock, &irqL); + } + -+_func_exit_; + -+ return _SUCCESS; -+} + -+void rtw_init_xmitframe(struct xmit_frame *pxframe) ++ return _SUCCESS; ++} ++ ++static void rtw_init_xmitframe(struct xmit_frame *pxframe) +{ + if (pxframe != NULL)//default value setting + { @@ -85507,25 +61369,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + pxframe->frame_tag = DATA_FRAMETAG; + -+#ifdef CONFIG_USB_HCI + pxframe->pkt = NULL; -+#ifdef USB_PACKET_OFFSET_SZ -+ pxframe->pkt_offset = (PACKET_OFFSET_SZ/8); -+#else + pxframe->pkt_offset = 1;//default use pkt_offset to fill tx desc -+#endif + +#ifdef CONFIG_USB_TX_AGGREGATION + pxframe->agg_num = 1; +#endif + -+#endif //#ifdef CONFIG_USB_HCI -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxframe->pg_num = 1; -+ pxframe->agg_num = 1; -+#endif -+ +#ifdef CONFIG_XMIT_ACK + pxframe->ack_report = 0; +#endif @@ -85548,7 +61398,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +{ + /* + Please remember to use all the osdep_service api, -+ and lock/unlock or _enter/_exit critical to protect ++ and lock/unlock or _enter/_exit critical to protect + pfree_xmit_queue + */ + @@ -85557,11 +61407,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _list *plist, *phead; + _queue *pfree_xmit_queue = &pxmitpriv->free_xmit_queue; + -+_func_enter_; ++ + + _enter_critical_bh(&pfree_xmit_queue->lock, &irqL); + -+ if (_rtw_queue_empty(pfree_xmit_queue) == _TRUE) { ++ if (_rtw_queue_empty(pfree_xmit_queue) == true) { + RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_alloc_xmitframe:%d\n", pxmitpriv->free_xmitframe_cnt)); + pxframe = NULL; + } else { @@ -85580,7 +61430,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + rtw_init_xmitframe(pxframe); + -+_func_exit_; ++ + + return pxframe; +} @@ -85592,11 +61442,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _list *plist, *phead; + _queue *queue = &pxmitpriv->free_xframe_ext_queue; + -+_func_enter_; ++ + + _enter_critical_bh(&queue->lock, &irqL); + -+ if (_rtw_queue_empty(queue) == _TRUE) { ++ if (_rtw_queue_empty(queue) == true) { + RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_alloc_xmitframe_ext:%d\n", pxmitpriv->free_xframe_ext_cnt)); + pxframe = NULL; + } else { @@ -85613,7 +61463,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + rtw_init_xmitframe(pxframe); + -+_func_exit_; ++ + + return pxframe; +} @@ -85624,10 +61474,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + u8 *alloc_addr; + + alloc_addr = rtw_zmalloc(sizeof(struct xmit_frame) + 4); -+ ++ + if (alloc_addr == NULL) + goto exit; -+ ++ + pxframe = (struct xmit_frame *)N_BYTE_ALIGMENT((SIZE_PTR)(alloc_addr), 4); + pxframe->alloc_addr = alloc_addr; + @@ -85648,13 +61498,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +} + +s32 rtw_free_xmitframe(struct xmit_priv *pxmitpriv, struct xmit_frame *pxmitframe) -+{ ++{ + _irqL irqL; -+ _queue *queue = NULL; ++ _queue *queue; + _adapter *padapter = pxmitpriv->adapter; + _pkt *pndis_pkt = NULL; + -+_func_enter_; ++ + + if (pxmitframe == NULL) { + RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("======rtw_free_xmitframe():pxmitframe==NULL!!!!!!!!!!\n")); @@ -85677,11 +61527,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + else if(pxmitframe->ext_tag == 1) + queue = &pxmitpriv->free_xframe_ext_queue; + else -+ rtw_warn_on(1); ++ {} + + _enter_critical_bh(&queue->lock, &irqL); + -+ rtw_list_delete(&pxmitframe->list); ++ rtw_list_delete(&pxmitframe->list); + rtw_list_insert_tail(&pxmitframe->list, get_list_head(queue)); + if (pxmitframe->ext_tag == 0) { + pxmitpriv->free_xmitframe_cnt++; @@ -85701,7 +61551,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + +exit: + -+_func_exit_; ++ + + return _SUCCESS; +} @@ -85710,33 +61560,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +{ + _irqL irqL; + _list *plist, *phead; -+ struct xmit_frame *pxmitframe; ++ struct xmit_frame *pxmitframe; ++ + -+_func_enter_; + + _enter_critical_bh(&(pframequeue->lock), &irqL); + + phead = get_list_head(pframequeue); + plist = get_next(phead); -+ -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) ++ ++ while (rtw_end_of_queue_search(phead, plist) == false) + { -+ ++ + pxmitframe = LIST_CONTAINOR(plist, struct xmit_frame, list); + -+ plist = get_next(plist); -+ ++ plist = get_next(plist); ++ + rtw_free_xmitframe(pxmitpriv,pxmitframe); -+ ++ + } + _exit_critical_bh(&(pframequeue->lock), &irqL); + -+_func_exit_; ++ +} + +s32 rtw_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) +{ -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue); + if (rtw_xmit_classifier(padapter, pxmitframe) == _FAIL) + { + RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, @@ -85756,36 +61605,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + xmitframe_phead = get_list_head(pframe_queue); + xmitframe_plist = get_next(xmitframe_phead); + -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) ++ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) + { + pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); + -+ /* xmitframe_plist = get_next(xmitframe_plist); */ ++ xmitframe_plist = get_next(xmitframe_plist); + -+/*#ifdef RTK_DMP_PLATFORM -+#ifdef CONFIG_USB_TX_AGGREGATION -+ if((ptxservq->qcnt>0) && (ptxservq->qcnt<=2)) -+ { -+ pxmitframe = NULL; -+ -+ tasklet_schedule(&pxmitpriv->xmit_tasklet); -+ -+ break; -+ } -+#endif -+#endif*/ + rtw_list_delete(&pxmitframe->list); + + ptxservq->qcnt--; + -+ //rtw_list_insert_tail(&pxmitframe->list, &phwxmit->pending); -+ -+ //ptxservq->qcnt--; -+ -+ break; -+ -+ //pxmitframe = NULL; ++ break; + ++ pxmitframe = NULL; + } + + return pxmitframe; @@ -85802,11 +61634,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + _adapter *padapter = pxmitpriv->adapter; + struct registry_priv *pregpriv = &padapter->registrypriv; + int i, inx[4]; -+#ifdef CONFIG_USB_HCI -+// int j, tmp, acirp_cnt[4]; -+#endif + -+_func_enter_; ++ + + inx[0] = 0; inx[1] = 1; inx[2] = 2; inx[3] = 3; + @@ -85820,17 +61649,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + inx[flags] = 0; + inx[0] = flags; + } -+#endif -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_PCI_HCI) ++#endif ++ + for(j=0; j<4; j++) + inx[j] = pxmitpriv->wmm_para_seq[j]; -+#endif + } + + _enter_critical_bh(&pxmitpriv->lock, &irqL0); + -+ for(i = 0; i < entry; i++) ++ for(i = 0; i < entry; i++) + { + phwxmit = phwxmit_i + inx[i]; + @@ -85839,7 +61666,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + sta_phead = get_list_head(phwxmit->sta_queue); + sta_plist = get_next(sta_phead); + -+ while ((rtw_end_of_queue_search(sta_phead, sta_plist)) == _FALSE) ++ while ((rtw_end_of_queue_search(sta_phead, sta_plist)) == false) + { + + ptxservq= LIST_CONTAINOR(sta_plist, struct tx_servq, tx_pending); @@ -85873,19 +61700,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + _exit_critical_bh(&pxmitpriv->lock, &irqL0); + -+_func_exit_; ++ + + return pxmitframe; +} + -+#if 1 +struct tx_servq *rtw_get_sta_pending(_adapter *padapter, struct sta_info *psta, sint up, u8 *ac) +{ + struct tx_servq *ptxservq=NULL; -+ -+_func_enter_; + -+ switch (up) ++ ++ ++ switch (up) + { + case 1: + case 2: @@ -85905,7 +61731,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + case 7: + ptxservq = &(psta->sta_xmitpriv.vo_q); + *(ac) = 0; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_get_sta_pending : VO \n")); ++ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_get_sta_pending : VO \n")); + break; + + case 0: @@ -85913,78 +61739,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + default: + ptxservq = &(psta->sta_xmitpriv.be_q); + *(ac) = 2; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_get_sta_pending : BE \n")); ++ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_get_sta_pending : BE \n")); + break; -+ ++ + } + -+_func_exit_; + -+ return ptxservq; ++ ++ return ptxservq; +} -+#else -+__inline static struct tx_servq *rtw_get_sta_pending -+ (_adapter *padapter, _queue **ppstapending, struct sta_info *psta, sint up) -+{ -+ struct tx_servq *ptxservq; -+ struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; -+ -+_func_enter_; -+ -+#ifdef CONFIG_RTL8711 -+ -+ if(IS_MCAST(psta->hwaddr)) -+ { -+ ptxservq = &(psta->sta_xmitpriv.be_q); // we will use be_q to queue bc/mc frames in BCMC_stainfo -+ *ppstapending = &padapter->xmitpriv.bm_pending; -+ } -+ else -+#endif -+ { -+ switch (up) -+ { -+ case 1: -+ case 2: -+ ptxservq = &(psta->sta_xmitpriv.bk_q); -+ *ppstapending = &padapter->xmitpriv.bk_pending; -+ (phwxmits+3)->accnt++; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_get_sta_pending : BK \n")); -+ break; -+ -+ case 4: -+ case 5: -+ ptxservq = &(psta->sta_xmitpriv.vi_q); -+ *ppstapending = &padapter->xmitpriv.vi_pending; -+ (phwxmits+1)->accnt++; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_get_sta_pending : VI\n")); -+ break; -+ -+ case 6: -+ case 7: -+ ptxservq = &(psta->sta_xmitpriv.vo_q); -+ *ppstapending = &padapter->xmitpriv.vo_pending; -+ (phwxmits+0)->accnt++; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_get_sta_pending : VO \n")); -+ break; -+ -+ case 0: -+ case 3: -+ default: -+ ptxservq = &(psta->sta_xmitpriv.be_q); -+ *ppstapending = &padapter->xmitpriv.be_pending; -+ (phwxmits+2)->accnt++; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_get_sta_pending : BE \n")); -+ break; -+ -+ } -+ -+ } -+ -+_func_exit_; -+ -+ return ptxservq; -+} -+#endif + +/* + * Will enqueue pxmitframe to the proper queue, @@ -86001,29 +61764,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; + sint res = _SUCCESS; + -+_func_enter_; + -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class); + +/* + if (pattrib->psta) { -+ psta = pattrib->psta; ++ psta = pattrib->psta; + } else { + DBG_871X("%s, call rtw_get_stainfo()\n", __func__); + psta = rtw_get_stainfo(pstapriv, pattrib->ra); + } -+*/ ++*/ + + psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); + if(pattrib->psta != psta) + { -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_sta); + DBG_871X("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); + return _FAIL; + } + + if (psta == NULL) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_nosta); + res = _FAIL; + DBG_8192C("rtw_xmit_classifier: psta == NULL\n"); + RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("rtw_xmit_classifier: psta == NULL\n")); @@ -86032,7 +61791,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + if(!(psta->state &_FW_LINKED)) + { -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_fwlink); + DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); + return _FAIL; + } @@ -86057,7 +61815,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + +exit: + -+_func_exit_; ++ + + return res; +} @@ -86069,16 +61827,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + pxmitpriv->hwxmit_entry = HWXMIT_ENTRY; + -+ pxmitpriv->hwxmits = NULL; ++ pxmitpriv->hwxmits = (struct hw_xmit *)rtw_zmalloc(sizeof (struct hw_xmit) * pxmitpriv->hwxmit_entry); + -+ pxmitpriv->hwxmits = (struct hw_xmit *)rtw_zmalloc(sizeof (struct hw_xmit) * pxmitpriv->hwxmit_entry); -+ -+ if(pxmitpriv->hwxmits == NULL) -+ { -+ DBG_871X("alloc hwxmits fail!...\n"); -+ return; -+ } -+ + hwxmits = pxmitpriv->hwxmits; + + if(pxmitpriv->hwxmit_entry == 5) @@ -86086,7 +61836,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + //pxmitpriv->bmc_txqueue.head = 0; + //hwxmits[0] .phwtxqueue = &pxmitpriv->bmc_txqueue; + hwxmits[0] .sta_queue = &pxmitpriv->bm_pending; -+ ++ + //pxmitpriv->vo_txqueue.head = 0; + //hwxmits[1] .phwtxqueue = &pxmitpriv->vo_txqueue; + hwxmits[1] .sta_queue = &pxmitpriv->vo_pending; @@ -86094,16 +61844,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + //pxmitpriv->vi_txqueue.head = 0; + //hwxmits[2] .phwtxqueue = &pxmitpriv->vi_txqueue; + hwxmits[2] .sta_queue = &pxmitpriv->vi_pending; -+ ++ + //pxmitpriv->bk_txqueue.head = 0; + //hwxmits[3] .phwtxqueue = &pxmitpriv->bk_txqueue; + hwxmits[3] .sta_queue = &pxmitpriv->bk_pending; + -+ //pxmitpriv->be_txqueue.head = 0; ++ //pxmitpriv->be_txqueue.head = 0; + //hwxmits[4] .phwtxqueue = &pxmitpriv->be_txqueue; + hwxmits[4] .sta_queue = &pxmitpriv->be_pending; -+ -+ } ++ ++ } + else if(pxmitpriv->hwxmit_entry == 4) + { + @@ -86118,17 +61868,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + //pxmitpriv->be_txqueue.head = 0; + //hwxmits[2] .phwtxqueue = &pxmitpriv->be_txqueue; + hwxmits[2] .sta_queue = &pxmitpriv->be_pending; -+ ++ + //pxmitpriv->bk_txqueue.head = 0; + //hwxmits[3] .phwtxqueue = &pxmitpriv->bk_txqueue; + hwxmits[3] .sta_queue = &pxmitpriv->bk_pending; + } + else + { -+ ++ + + } -+ ++ + +} + @@ -86145,26 +61895,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +void rtw_init_hwxmits(struct hw_xmit *phwxmit, sint entry) +{ + sint i; -+_func_enter_; ++ + for(i = 0; i < entry; i++, phwxmit++) + { + //_rtw_spinlock_init(&phwxmit->xmit_lock); -+ //_rtw_init_listhead(&phwxmit->pending); ++ //_rtw_init_listhead(&phwxmit->pending); + //phwxmit->txcmdcnt = 0; + phwxmit->accnt = 0; + } -+_func_exit_; ++ +} + +#ifdef CONFIG_BR_EXT -+int rtw_br_client_tx(_adapter *padapter, struct sk_buff **pskb) ++static int rtw_br_client_tx(_adapter *padapter, struct sk_buff **pskb) +{ + struct sk_buff *skb = *pskb; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + _irqL irqL; -+ //if(check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == _TRUE) ++ //if(check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == true) + { -+ void dhcp_flag_bcast(_adapter *priv, struct sk_buff *skb); + int res, is_vlan_tag=0, i, do_nat25=1; + unsigned short vlan_hdr=0; + void *br_port = NULL; @@ -86182,20 +61931,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + if ( !(skb->data[0] & 1) && + br_port && + memcmp(skb->data+MACADDRLEN, padapter->br_mac, MACADDRLEN) && -+ *((unsigned short *)(skb->data+MACADDRLEN*2)) != __constant_htons(ETH_P_8021Q) && -+ *((unsigned short *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_IP) && ++ *((__be16 *)(skb->data+MACADDRLEN*2)) != __constant_htons(ETH_P_8021Q) && ++ *((__be16 *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_IP) && + !memcmp(padapter->scdb_mac, skb->data+MACADDRLEN, MACADDRLEN) && padapter->scdb_entry) { + memcpy(skb->data+MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); + padapter->scdb_entry->ageing_timer = jiffies; + _exit_critical_bh(&padapter->br_ext_lock, &irqL); + } + else -+ //if (!priv->pmib->ethBrExtInfo.nat25_disable) ++ //if (!priv->pmib->ethBrExtInfo.nat25_disable) + { +// if (priv->dev->br_port && +// !memcmp(skb->data+MACADDRLEN, priv->br_mac, MACADDRLEN)) { +#if 1 -+ if (*((unsigned short *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_8021Q)) { ++ if (*((__be16 *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_8021Q)) { + is_vlan_tag = 1; + vlan_hdr = *((unsigned short *)(skb->data+MACADDRLEN*2+2)); + for (i=0; i<6; i++) @@ -86204,13 +61953,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + } + //if SA == br_mac && skb== IP => copy SIP to br_ip ?? why + if (!memcmp(skb->data+MACADDRLEN, padapter->br_mac, MACADDRLEN) && -+ (*((unsigned short *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_IP))) ++ (*((__be16 *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_IP))) + memcpy(padapter->br_ip, skb->data+WLAN_ETHHDR_LEN+12, 4); + -+ if (*((unsigned short *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_IP)) { ++ if (*((__be16 *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_IP)) { + if (memcmp(padapter->scdb_mac, skb->data+MACADDRLEN, MACADDRLEN)) { -+ void *scdb_findEntry(_adapter *priv, unsigned char *macAddr, unsigned char *ipAddr); -+ + if ((padapter->scdb_entry = (struct nat25_network_db_entry *)scdb_findEntry(padapter, + skb->data+MACADDRLEN, skb->data+WLAN_ETHHDR_LEN+12)) != NULL) { + memcpy(padapter->scdb_mac, skb->data+MACADDRLEN, MACADDRLEN); @@ -86234,7 +61981,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +#endif // 1 + if (do_nat25) + { -+ int nat25_db_handle(_adapter *priv, struct sk_buff *skb, int method); + if (nat25_db_handle(padapter, skb, NAT25_CHECK) == 0) { + struct sk_buff *newskb; + @@ -86242,18 +61988,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + skb_push(skb, 4); + for (i=0; i<6; i++) + *((unsigned short *)(skb->data+i*2)) = *((unsigned short *)(skb->data+4+i*2)); -+ *((unsigned short *)(skb->data+MACADDRLEN*2)) = __constant_htons(ETH_P_8021Q); ++ *((__be16 *)(skb->data+MACADDRLEN*2)) = __constant_htons(ETH_P_8021Q); + *((unsigned short *)(skb->data+MACADDRLEN*2+2)) = vlan_hdr; + } + -+ newskb = rtw_skb_copy(skb); ++ newskb = skb_copy(skb, GFP_ATOMIC); + if (newskb == NULL) { + //priv->ext_stats.tx_drops++; -+ DEBUG_ERR("TX DROP: rtw_skb_copy fail!\n"); ++ DEBUG_ERR("TX DROP: skb_copy fail!\n"); + //goto stop_proc; + return -1; + } -+ rtw_skb_free(skb); ++ dev_kfree_skb_any(skb); + + *pskb = skb = newskb; + if (is_vlan_tag) { @@ -86266,19 +62012,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + if (skb_is_nonlinear(skb)) + DEBUG_ERR("%s(): skb_is_nonlinear!!\n", __FUNCTION__); -+ ++ + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 18)) + res = skb_linearize(skb, GFP_ATOMIC); +#else // (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 18)) + res = skb_linearize(skb); +#endif // (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 18)) -+ if (res < 0) { ++ if (res < 0) { + DEBUG_ERR("TX DROP: skb_linearize fail!\n"); + //goto free_and_stop; + return -1; + } -+ ++ + res = nat25_db_handle(padapter, skb, NAT25_INSERT); + if (res < 0) { + if (res == -2) { @@ -86303,16 +62049,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + skb_push(skb, 4); + for (i=0; i<6; i++) + *((unsigned short *)(skb->data+i*2)) = *((unsigned short *)(skb->data+4+i*2)); -+ *((unsigned short *)(skb->data+MACADDRLEN*2)) = __constant_htons(ETH_P_8021Q); ++ *((__be16 *)(skb->data+MACADDRLEN*2)) = __constant_htons(ETH_P_8021Q); + *((unsigned short *)(skb->data+MACADDRLEN*2+2)) = vlan_hdr; + } + } -+#if 0 ++#if 0 + else{ + if (*((unsigned short *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_8021Q)) { + is_vlan_tag = 1; + } -+ ++ + if(is_vlan_tag){ + if(ICMPV6_MCAST_MAC(skb->data) && ICMPV6_PROTO1A_VALN(skb->data)){ + memcpy(skb->data+MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); @@ -86322,7 +62068,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + if(ICMPV6_MCAST_MAC(skb->data) && ICMPV6_PROTO1A(skb->data)){ + memcpy(skb->data+MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); + } -+ } ++ } + } +#endif // 0 + @@ -86342,22 +62088,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +u32 rtw_get_ff_hwaddr(struct xmit_frame *pxmitframe) +{ + u32 addr; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ + switch(pattrib->qsel) + { + case 0: + case 3: + addr = BE_QUEUE_INX; -+ break; ++ break; + case 1: + case 2: + addr = BK_QUEUE_INX; -+ break; ++ break; + case 4: + case 5: + addr = VI_QUEUE_INX; -+ break; ++ break; + case 6: + case 7: + addr = VO_QUEUE_INX; @@ -86371,8 +62117,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + case 0x12: + default: + addr = MGT_QUEUE_INX; -+ break; -+ ++ break; ++ + } + + return addr; @@ -86382,15 +62128,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +static void do_queue_select(_adapter *padapter, struct pkt_attrib *pattrib) +{ + u8 qsel; -+ ++ + qsel = pattrib->priority; + RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("### do_queue_select priority=%d ,qsel = %d\n",pattrib->priority ,qsel)); + -+#ifdef CONFIG_CONCURRENT_MODE -+// if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) ++#ifdef CONFIG_CONCURRENT_MODE ++// if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == true) +// qsel = 7;// +#endif -+ ++ + pattrib->qsel = qsel; +} + @@ -86418,8 +62164,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + s32 res; + -+ DBG_COUNTER(padapter->tx_logs.core_tx); -+ + if (start == 0) + start = rtw_get_current_time(); + @@ -86435,7 +62179,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + if (pxmitframe == NULL) { + drop_cnt ++; + RT_TRACE(_module_xmit_osdep_c_, _drv_err_, ("rtw_xmit: no more pxmitframe\n")); -+ DBG_COUNTER(padapter->tx_logs.core_tx_err_pxmitframe); + return -1; + } + @@ -86449,16 +62192,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + rcu_read_unlock(); +#endif // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) + -+ if( br_port && check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == _TRUE) ++ if( br_port && check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == true) + { + res = rtw_br_client_tx(padapter, ppkt); + if (res == -1) + { + rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ DBG_COUNTER(padapter->tx_logs.core_tx_err_brtx); + return -1; + } -+ } ++ } + +#endif // CONFIG_BR_EXT + @@ -86490,17 +62232,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + +#ifdef CONFIG_AP_MODE + _enter_critical_bh(&pxmitpriv->lock, &irqL0); -+ if(xmitframe_enqueue_for_sleeping_sta(padapter, pxmitframe) == _TRUE) ++ if(xmitframe_enqueue_for_sleeping_sta(padapter, pxmitframe) == true) + { + _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue); -+ return 1; ++ return 1; + } + _exit_critical_bh(&pxmitpriv->lock, &irqL0); +#endif + -+ //pre_xmitframe -+ if (rtw_hal_xmit(padapter, pxmitframe) == _FALSE) ++ if (rtw_hal_xmit(padapter, pxmitframe) == false) + return 1; + + return 0; @@ -86509,7 +62249,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +#ifdef CONFIG_TDLS +sint xmitframe_enqueue_for_tdls_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe) +{ -+ sint ret=_FALSE; ++ sint ret=false; + + _irqL irqL; + struct sta_info *ptdls_sta=NULL; @@ -86517,7 +62257,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + struct pkt_attrib *pattrib = &pxmitframe->attrib; + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + int i; -+ ++ + ptdls_sta=rtw_get_stainfo(pstapriv, pattrib->dst); + if(ptdls_sta==NULL){ + return ret; @@ -86525,20 +62265,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + if(pattrib->triggered==1) + { -+ ret = _TRUE; ++ ret = true; + return ret; -+ } ++ } ++ ++ _enter_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); + -+ _enter_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); -+ + if(ptdls_sta->state&WIFI_SLEEP_STATE) + { + rtw_list_delete(&pxmitframe->list); -+ -+ //_enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ ++ ++ //_enter_critical_bh(&psta->sleep_q.lock, &irqL); ++ + rtw_list_insert_tail(&pxmitframe->list, get_list_head(&ptdls_sta->sleep_q)); -+ ++ + ptdls_sta->sleepq_len++; + ptdls_sta->sleepq_ac_len++; + @@ -86547,106 +62287,63 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + { + case 1: + case 2: -+ ptdls_sta->uapsd_bk |= BIT(1); ++ ptdls_sta->uapsd_bk = ptdls_sta->uapsd_bk | BIT(1); + break; + case 4: + case 5: -+ ptdls_sta->uapsd_vi |= BIT(1); ++ ptdls_sta->uapsd_vi = ptdls_sta->uapsd_vi | BIT(1); + break; + case 6: + case 7: -+ ptdls_sta->uapsd_vo |= BIT(1); ++ ptdls_sta->uapsd_vo = ptdls_sta->uapsd_vo | BIT(1); + break; + case 0: + case 3: + default: -+ ptdls_sta->uapsd_be |= BIT(1); ++ ptdls_sta->uapsd_be = ptdls_sta->uapsd_be | BIT(1); + break; + } + -+ /* Transmit TDLS PTI via AP */ + if(ptdls_sta->sleepq_len==1) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ISSUE_PTI); ++ { ++ //transmit TDLS PTI via AP ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_SD_PTI); ++ } ++ ret = true; + -+ ret = _TRUE; + } + -+ _exit_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); ++ _exit_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); + } + + return ret; -+ ++ +} +#endif //CONFIG_TDLS + -+#define RTW_HIQ_FILTER_ALLOW_ALL 0 -+#define RTW_HIQ_FILTER_ALLOW_SPECIAL 1 -+#define RTW_HIQ_FILTER_DENY_ALL 2 -+ -+inline bool xmitframe_hiq_filter(struct xmit_frame *xmitframe) -+{ -+ bool allow = _FALSE; -+ _adapter *adapter = xmitframe->padapter; -+ struct registry_priv *registry = &adapter->registrypriv; -+ -+if (rtw_get_intf_type(adapter) != RTW_PCIE) { -+ -+ if (adapter->registrypriv.wifi_spec == 1) { -+ allow = _TRUE; -+ } else if (registry->hiq_filter == RTW_HIQ_FILTER_ALLOW_SPECIAL) { -+ -+ struct pkt_attrib *attrib = &xmitframe->attrib; -+ -+ if (attrib->ether_type == 0x0806 -+ || attrib->ether_type == 0x888e -+ #ifdef CONFIG_WAPI_SUPPORT -+ || attrib->ether_type == 0x88B4 -+ #endif -+ || attrib->dhcp_pkt -+ ) { -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" ether_type:0x%04x%s\n", FUNC_ADPT_ARG(xmitframe->padapter) -+ , attrib->ether_type, attrib->dhcp_pkt?" DHCP":""); -+ allow = _TRUE; -+ } -+ } -+ else if (registry->hiq_filter == RTW_HIQ_FILTER_ALLOW_ALL) { -+ allow = _TRUE; -+ } -+ else if (registry->hiq_filter == RTW_HIQ_FILTER_DENY_ALL) { -+ } -+ else { -+ rtw_warn_on(1); -+ } -+} -+ return allow; -+} -+ +#if defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) + +sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe) +{ + _irqL irqL; -+ sint ret=_FALSE; ++ sint ret=false; + struct sta_info *psta=NULL; + struct sta_priv *pstapriv = &padapter->stapriv; + struct pkt_attrib *pattrib = &pxmitframe->attrib; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + sint bmcst = IS_MCAST(pattrib->ra); -+ bool update_tim = _FALSE; +#ifdef CONFIG_TDLS ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; + -+ if( padapter->tdlsinfo.link_established == _TRUE ) ++ if( ptdlsinfo->setup_state == TDLS_LINKED_STATE ) + { + ret = xmitframe_enqueue_for_tdls_sleeping_sta(padapter, pxmitframe); ++ return ret; + } +#endif //CONFIG_TDLS + -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _FALSE) -+ { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_fwstate); ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == false) + return ret; -+ } +/* + if(pattrib->psta) + { @@ -86661,33 +62358,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); + if(pattrib->psta != psta) + { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_sta); + DBG_871X("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return _FALSE; ++ return false; + } + + if(psta==NULL) + { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_nosta); + DBG_871X("%s, psta==NUL\n", __func__); -+ return _FALSE; ++ return false; + } + + if(!(psta->state &_FW_LINKED)) + { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_link); + DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return _FALSE; ++ return false; + } + + if(pattrib->triggered==1) + { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_trigger); + //DBG_871X("directly xmit pspoll_triggered packet\n"); + + //pattrib->triggered=0; -+ if (bmcst && xmitframe_hiq_filter(pxmitframe) == _TRUE) -+ pattrib->qsel = QSLT_HIGH;//HIQ ++ ++ if(bmcst) ++ pattrib->qsel = 0x11;//HIQ ++ + + return ret; + } @@ -86695,73 +62390,54 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + if(bmcst) + { -+ _enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ ++ _enter_critical_bh(&psta->sleep_q.lock, &irqL); ++ + if(pstapriv->sta_dz_bitmap)//if anyone sta is in ps mode + { -+ //pattrib->qsel = QSLT_HIGH;//HIQ -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ //_enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&psta->sleep_q)); -+ -+ psta->sleepq_len++; ++ //pattrib->qsel = 0x11;//HIQ + -+ if (!(pstapriv->tim_bitmap & BIT(0))) -+ update_tim = _TRUE; ++ rtw_list_delete(&pxmitframe->list); ++ ++ //_enter_critical_bh(&psta->sleep_q.lock, &irqL); ++ ++ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&psta->sleep_q)); ++ ++ psta->sleepq_len++; + + pstapriv->tim_bitmap |= BIT(0);// + pstapriv->sta_dz_bitmap |= BIT(0); + + //DBG_871X("enqueue, sq_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); -+ if (padapter->registrypriv.wifi_spec == 1) { -+ /* -+ *if (update_tim == _TRUE) -+ * rtw_chk_hi_queue_cmd(padapter); -+ */ -+ } else { + -+ if (update_tim == _TRUE) { -+ if (is_broadcast_mac_addr(pattrib->ra)) -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "buffer BC"); -+ else -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "buffer MC"); -+ } else { -+ chk_bmc_sleepq_cmd(padapter); -+ } -+ } ++ update_beacon(padapter, _TIM_IE_, NULL, false);//tx bc/mc packets after upate bcn + -+ //_exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ ret = _TRUE; ++ //_exit_critical_bh(&psta->sleep_q.lock, &irqL); ++ ++ ret = true; + -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_mcast); -+ + } -+ -+ _exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ return ret; -+ -+ } -+ + -+ _enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ ++ _exit_critical_bh(&psta->sleep_q.lock, &irqL); ++ ++ return ret; ++ ++ } ++ ++ ++ _enter_critical_bh(&psta->sleep_q.lock, &irqL); ++ + if(psta->state&WIFI_SLEEP_STATE) + { + u8 wmmps_ac=0; -+ -+ if(pstapriv->sta_dz_bitmap&BIT(psta->aid)) -+ { ++ ++ if(pstapriv->sta_dz_bitmap&BIT(psta->aid)) ++ { + rtw_list_delete(&pxmitframe->list); -+ -+ //_enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ ++ ++ //_enter_critical_bh(&psta->sleep_q.lock, &irqL); ++ + rtw_list_insert_tail(&pxmitframe->list, get_list_head(&psta->sleep_q)); -+ ++ + psta->sleepq_len++; + + switch(pattrib->priority) @@ -86790,39 +62466,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + if(((psta->has_legacy_ac) && (!wmmps_ac)) ||((!psta->has_legacy_ac)&&(wmmps_ac))) + { -+ if (!(pstapriv->tim_bitmap & BIT(psta->aid))) -+ update_tim = _TRUE; -+ + pstapriv->tim_bitmap |= BIT(psta->aid); + + //DBG_871X("enqueue, sq_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); + -+ if(update_tim == _TRUE) ++ if(psta->sleepq_len==1) + { + //DBG_871X("sleepq_len==1, update BCNTIM\n"); + //upate BCN for TIM IE -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "buffer UC"); ++ update_beacon(padapter, _TIM_IE_, NULL, false); + } + } + -+ //_exit_critical_bh(&psta->sleep_q.lock, &irqL); ++ //_exit_critical_bh(&psta->sleep_q.lock, &irqL); + + //if(psta->sleepq_len > (NR_XMITFRAME>>3)) + //{ + // wakeup_sta_to_xmit(padapter, psta); -+ //} ++ //} + -+ ret = _TRUE; ++ ret = true; + -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_ucast); + } + + } + -+ _exit_critical_bh(&psta->sleep_q.lock, &irqL); ++ _exit_critical_bh(&psta->sleep_q.lock, &irqL); + + return ret; -+ ++ +} + +static void dequeue_xmitframes_to_sleeping_queue(_adapter *padapter, struct sta_info *psta, _queue *pframequeue) @@ -86832,26 +62504,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + u8 ac_index; + struct tx_servq *ptxservq; + struct pkt_attrib *pattrib; -+ struct xmit_frame *pxmitframe; ++ struct xmit_frame *pxmitframe; + struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; -+ ++ + phead = get_list_head(pframequeue); + plist = get_next(phead); -+ -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) -+ { ++ ++ while (rtw_end_of_queue_search(phead, plist) == false) ++ { + pxmitframe = LIST_CONTAINOR(plist, struct xmit_frame, list); + + plist = get_next(plist); -+ -+ pattrib = &pxmitframe->attrib; + -+ pattrib->triggered = 0; -+ -+ ret = xmitframe_enqueue_for_sleeping_sta(padapter, pxmitframe); ++ ret = xmitframe_enqueue_for_sleeping_sta(padapter, pxmitframe); + -+ if(_TRUE == ret) ++ if(true == ret) + { ++ pattrib = &pxmitframe->attrib; ++ + ptxservq = rtw_get_sta_pending(padapter, psta, pattrib->priority, (u8 *)(&ac_index)); + + ptxservq->qcnt--; @@ -86859,37 +62529,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + } + else + { -+ //DBG_871X("xmitframe_enqueue_for_sleeping_sta return _FALSE\n"); ++ //DBG_871X("xmitframe_enqueue_for_sleeping_sta return false\n"); + } -+ ++ + } -+ ++ +} + +void stop_sta_xmit(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL0; ++{ ++ _irqL irqL0; + struct sta_info *psta_bmc; + struct sta_xmit_priv *pstaxmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ + pstaxmitpriv = &psta->sta_xmitpriv; + + //for BC/MC Frames + psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ -+ ++ ++ + _enter_critical_bh(&pxmitpriv->lock, &irqL0); + + psta->state |= WIFI_SLEEP_STATE; -+ ++ +#ifdef CONFIG_TDLS + if( !(psta->tdls_sta_state & TDLS_LINKED_STATE) ) +#endif //CONFIG_TDLS + pstapriv->sta_dz_bitmap |= BIT(psta->aid); -+ -+ ++ ++ + + dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->vo_q.sta_pending); + rtw_list_delete(&(pstaxmitpriv->vo_q.tx_pending)); @@ -86901,13 +62571,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->be_q.sta_pending); + rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); -+ ++ + + dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->bk_q.sta_pending); + rtw_list_delete(&(pstaxmitpriv->bk_q.tx_pending)); + +#ifdef CONFIG_TDLS -+ if (!(psta->tdls_sta_state & TDLS_LINKED_STATE) && (psta_bmc != NULL)) { ++ if( !(psta->tdls_sta_state & TDLS_LINKED_STATE) ) ++ { ++ if( psta_bmc != NULL ) ++ { +#endif //CONFIG_TDLS + + @@ -86915,19 +62588,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + pstaxmitpriv = &psta_bmc->sta_xmitpriv; + dequeue_xmitframes_to_sleeping_queue(padapter, psta_bmc, &pstaxmitpriv->be_q.sta_pending); + rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); -+ + -+#ifdef CONFIG_TDLS ++ ++#ifdef CONFIG_TDLS + } -+#endif //CONFIG_TDLS ++ } ++#endif //CONFIG_TDLS + _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ + -+} ++ ++} + +void wakeup_sta_to_xmit(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL; ++{ ++ _irqL irqL; + u8 update_mask=0, wmmps_ac=0; + struct sta_info *psta_bmc; + _list *xmitframe_plist, *xmitframe_phead; @@ -86936,7 +62610,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + + psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ ++ + + //_enter_critical_bh(&psta->sleep_q.lock, &irqL); + _enter_critical_bh(&pxmitpriv->lock, &irqL); @@ -86944,7 +62618,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + xmitframe_phead = get_list_head(&psta->sleep_q); + xmitframe_plist = get_next(xmitframe_phead); + -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) ++ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) + { + pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); + @@ -86998,7 +62672,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + +/* + _exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ if(rtw_hal_xmit(padapter, pxmitframe) == _TRUE) ++ if(rtw_hal_xmit(padapter, pxmitframe) == true) + { + rtw_os_xmit_complete(padapter, pxmitframe); + } @@ -87009,41 +62683,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + } + -+ if(psta->sleepq_len==0) -+ { -+#ifdef CONFIG_TDLS -+ if( psta->tdls_sta_state & TDLS_LINKED_STATE ) -+ { -+ if(psta->state&WIFI_SLEEP_STATE) -+ psta->state ^= WIFI_SLEEP_STATE; -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ return; -+ } -+#endif //CONFIG_TDLS -+ -+ if (pstapriv->tim_bitmap & BIT(psta->aid)) { -+ //DBG_871X("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); -+ //upate BCN for TIM IE -+ //update_BCNTIM(padapter); -+ update_mask = BIT(0); -+ } -+ -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ if(psta->state&WIFI_SLEEP_STATE) -+ psta->state ^= WIFI_SLEEP_STATE; -+ -+ if(psta->state & WIFI_STA_ALIVE_CHK_STATE) -+ { -+ DBG_871X("%s alive check\n", __func__); -+ psta->expire_to = pstapriv->expire_to; -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ } -+ -+ pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); -+ } -+ + //for BC/MC Frames + if(!psta_bmc) + goto _exit; @@ -87053,7 +62692,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + xmitframe_phead = get_list_head(&psta_bmc->sleep_q); + xmitframe_plist = get_next(xmitframe_phead); + -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) ++ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) + { + pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); + @@ -87071,7 +62710,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + pxmitframe->attrib.triggered = 1; +/* + _exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); -+ if(rtw_hal_xmit(padapter, pxmitframe) == _TRUE) ++ if(rtw_hal_xmit(padapter, pxmitframe) == true) + { + rtw_os_xmit_complete(padapter, pxmitframe); + } @@ -87084,34 +62723,59 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + if(psta_bmc->sleepq_len==0) + { -+ if (pstapriv->tim_bitmap & BIT(0)) { -+ //DBG_871X("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); -+ //upate BCN for TIM IE -+ //update_BCNTIM(padapter); -+ update_mask |= BIT(1); -+ } + pstapriv->tim_bitmap &= ~BIT(0); + pstapriv->sta_dz_bitmap &= ~BIT(0); ++ ++ //DBG_871X("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); ++ //upate BCN for TIM IE ++ //update_BCNTIM(padapter); ++ update_mask |= BIT(1); + } + -+ } ++ } ++ ++ if(psta->sleepq_len==0) ++ { ++#ifdef CONFIG_TDLS ++ if( psta->tdls_sta_state & TDLS_LINKED_STATE ) ++ { ++ if(psta->state&WIFI_SLEEP_STATE) ++ psta->state ^= WIFI_SLEEP_STATE; ++ ++ goto _exit; ++ } ++#endif //CONFIG_TDLS ++ pstapriv->tim_bitmap &= ~BIT(psta->aid); ++ ++ //DBG_871X("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); ++ //upate BCN for TIM IE ++ //update_BCNTIM(padapter); ++ update_mask = BIT(0); ++ ++ if(psta->state&WIFI_SLEEP_STATE) ++ psta->state ^= WIFI_SLEEP_STATE; ++ ++ if(psta->state & WIFI_STA_ALIVE_CHK_STATE) ++ { ++ psta->expire_to = pstapriv->expire_to; ++ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; ++ } ++ ++ pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); ++ } + +_exit: + -+ //_exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); ++ //_exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); + _exit_critical_bh(&pxmitpriv->lock, &irqL); + + if(update_mask) + { + //update_BCNTIM(padapter); -+ if ((update_mask & (BIT(0)|BIT(1))) == (BIT(0)|BIT(1))) -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "clear UC&BMC"); -+ else if ((update_mask & BIT(1)) == BIT(1)) -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "clear BMC"); -+ else -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "clear UC"); ++ //printk("%s => call update_beacon\n",__FUNCTION__); ++ update_beacon(padapter, _TIM_IE_, NULL, false); + } -+ ++ +} + +void xmit_delivery_enabled_frames(_adapter *padapter, struct sta_info *psta) @@ -87130,8 +62794,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + xmitframe_phead = get_list_head(&psta->sleep_q); + xmitframe_plist = get_next(xmitframe_phead); + -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) -+ { ++ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) ++ { + pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); + + xmitframe_plist = get_next(xmitframe_plist); @@ -87154,9 +62818,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + case 3: + default: + wmmps_ac = psta->uapsd_be&BIT(1); -+ break; ++ break; + } -+ ++ + if(!wmmps_ac) + continue; + @@ -87177,6 +62841,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + } + + pxmitframe->attrib.triggered = 1; ++ ++/* ++ if(rtw_hal_xmit(padapter, pxmitframe) == true) ++ { ++ rtw_os_xmit_complete(padapter, pxmitframe); ++ } ++*/ + rtw_hal_xmitframe_enqueue(padapter, pxmitframe); + + if((psta->sleepq_ac_len==0) && (!psta->has_legacy_ac) && (wmmps_ac)) @@ -87185,7 +62856,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + if(psta->tdls_sta_state & TDLS_LINKED_STATE ) + { + //_exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ goto exit; ++ _exit_critical_bh(&pxmitpriv->lock, &irqL); ++ return; + } +#endif //CONFIG_TDLS + pstapriv->tim_bitmap &= ~BIT(psta->aid); @@ -87193,20 +62865,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + //DBG_871X("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); + //upate BCN for TIM IE + //update_BCNTIM(padapter); -+ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); ++ update_beacon(padapter, _TIM_IE_, NULL, false); + //update_mask = BIT(0); + } -+ -+ } + -+exit: -+ //_exit_critical_bh(&psta->sleep_q.lock, &irqL); ++ } ++ ++ //_exit_critical_bh(&psta->sleep_q.lock, &irqL); + _exit_critical_bh(&pxmitpriv->lock, &irqL); + -+ return; +} + -+#endif /* defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) */ ++#endif + +#ifdef CONFIG_XMIT_THREAD_MODE +void enqueue_pending_xmitbuf( @@ -87226,30 +62896,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + + -+#if defined(CONFIG_SDIO_HCI) && defined(CONFIG_CONCURRENT_MODE) + if (pri_adapter->adapter_type > PRIMARY_ADAPTER) + pri_adapter = pri_adapter->pbuddy_adapter; -+#endif //SDIO_HCI + CONCURRENT + _rtw_up_sema(&(pri_adapter->xmitpriv.xmit_sema)); + +} + -+void enqueue_pending_xmitbuf_to_head( -+ struct xmit_priv *pxmitpriv, -+ struct xmit_buf *pxmitbuf) -+{ -+ _irqL irql; -+ _queue *pqueue; -+ _adapter *pri_adapter = pxmitpriv->adapter; -+ -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ _enter_critical_bh(&pqueue->lock, &irql); -+ rtw_list_delete(&pxmitbuf->list); -+ rtw_list_insert_head(&pxmitbuf->list, get_list_head(pqueue)); -+ _exit_critical_bh(&pqueue->lock, &irql); -+} -+ +struct xmit_buf* dequeue_pending_xmitbuf( + struct xmit_priv *pxmitpriv) +{ @@ -87263,7 +62915,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + _enter_critical_bh(&pqueue->lock, &irql); + -+ if (_rtw_queue_empty(pqueue) == _FALSE) ++ if (_rtw_queue_empty(pqueue) == false) + { + _list *plist, *phead; + @@ -87283,9 +62935,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +{ + _irqL irql; + struct xmit_buf *pxmitbuf; -+#ifdef CONFIG_USB_HCI + struct xmit_frame *pxmitframe; -+#endif + _queue *pqueue; + + @@ -87294,7 +62944,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + _enter_critical_bh(&pqueue->lock, &irql); + -+ if (_rtw_queue_empty(pqueue) == _FALSE) ++ if (_rtw_queue_empty(pqueue) == false) + { + _list *plist, *phead; + u8 type; @@ -87304,10 +62954,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + do { + plist = get_next(plist); + if (plist == phead) break; -+ ++ + pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); + -+#ifdef CONFIG_USB_HCI + pxmitframe = (struct xmit_frame*)pxmitbuf->priv_data; + if(pxmitframe) + { @@ -87317,9 +62966,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + { + DBG_871X("%s, !!!ERROR!!! For USB, TODO ITEM \n", __FUNCTION__); + } -+#else -+ type = GetFrameSubType(pxmitbuf->pbuf + TXDESC_OFFSET); -+#endif + + if ((type == WIFI_PROBEREQ) || + (type == WIFI_DATA_NULL) || @@ -87340,20 +62986,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +sint check_pending_xmitbuf( + struct xmit_priv *pxmitpriv) +{ -+ _irqL irql; + _queue *pqueue; -+ sint ret = _FALSE; + + pqueue = &pxmitpriv->pending_xmitbuf_queue; + -+ _enter_critical_bh(&pqueue->lock, &irql); -+ -+ if(_rtw_queue_empty(pqueue) == _FALSE) -+ ret = _TRUE; -+ -+ _exit_critical_bh(&pqueue->lock, &irql); -+ -+ return ret; ++ if(_rtw_queue_empty(pqueue) == false) ++ return true; ++ else ++ return false; +} + +thread_return rtw_xmit_thread(thread_context context) @@ -87378,66 +63018,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +} +#endif + -+bool rtw_xmit_ac_blocked(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+ struct mlme_ext_priv *mlmeext; -+ struct mlme_ext_info *mlmeextinfo; -+ bool blocked = _FALSE; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ mlmeext = &iface->mlmeextpriv; -+ -+ /* check scan state */ -+ if (mlmeext_scan_state(mlmeext) != SCAN_DISABLE -+ && mlmeext_scan_state(mlmeext) != SCAN_BACK_OP -+ ) { -+ blocked = _TRUE; -+ goto exit; -+ } -+ -+ if (mlmeext_scan_state(mlmeext) == SCAN_BACK_OP -+ && !mlmeext_chk_scan_backop_flags(mlmeext, SS_BACKOP_TX_RESUME) -+ ) { -+ blocked = _TRUE; -+ goto exit; -+ } -+ } -+ -+exit: -+ return blocked; -+} -+ +void rtw_sctx_init(struct submit_ctx *sctx, int timeout_ms) +{ + sctx->timeout_ms = timeout_ms; + sctx->submit_time= rtw_get_current_time(); -+#ifdef PLATFORM_LINUX /* TODO: add condition wating interface for other os */ + init_completion(&sctx->done); -+#endif + sctx->status = RTW_SCTX_SUBMITTED; +} + -+int rtw_sctx_wait(struct submit_ctx *sctx, const char *msg) ++int rtw_sctx_wait(struct submit_ctx *sctx) +{ + int ret = _FAIL; -+ unsigned long expire; ++ unsigned long expire; + int status = 0; + -+#ifdef PLATFORM_LINUX + expire= sctx->timeout_ms ? msecs_to_jiffies(sctx->timeout_ms) : MAX_SCHEDULE_TIMEOUT; + if (!wait_for_completion_timeout(&sctx->done, expire)) { + /* timeout, do something?? */ + status = RTW_SCTX_DONE_TIMEOUT; -+ DBG_871X("%s timeout: %s\n", __func__, msg); ++ DBG_871X("%s timeout\n", __func__); + } else { + status = sctx->status; + } -+#endif -+ + if (status == RTW_SCTX_DONE_SUCCESS) { + ret = _SUCCESS; + } @@ -87445,7 +63047,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + return ret; +} + -+bool rtw_sctx_chk_waring_status(int status) ++static bool rtw_sctx_chk_waring_status(int status) +{ + switch(status) { + case RTW_SCTX_DONE_UNKNOWN: @@ -87454,9 +63056,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + + case RTW_SCTX_DONE_DRV_STOP: + case RTW_SCTX_DONE_DEV_REMOVE: -+ return _TRUE; ++ return true; + default: -+ return _FALSE; ++ return false; + } +} + @@ -87466,9 +63068,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + if (rtw_sctx_chk_waring_status(status)) + DBG_871X("%s status:%d\n", __func__, status); + (*sctx)->status = status; -+ #ifdef PLATFORM_LINUX + complete(&((*sctx)->done)); -+ #endif + *sctx = NULL; + } +} @@ -87481,7 +63081,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au +#ifdef CONFIG_XMIT_ACK + +#ifdef CONFIG_XMIT_ACK_POLLING -+s32 c2h_evt_hdl(_adapter *adapter, u8 *c2h_evt, c2h_id_filter filter); ++s32 c2h_evt_hdl(_adapter *adapter, struct c2h_evt_hdr *c2h_evt, c2h_id_filter filter); + +/** + * rtw_ack_tx_polling - @@ -87507,15 +63107,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + if (pack_tx_ops->status != RTW_SCTX_SUBMITTED) + break; + -+ if (rtw_is_drv_stopped(adapter)) { ++ if (adapter->bDriverStopped) { + pack_tx_ops->status = RTW_SCTX_DONE_DRV_STOP; + break; + } -+ if (rtw_is_surprise_removed(adapter)) { ++ if (adapter->bSurpriseRemoved) { + pack_tx_ops->status = RTW_SCTX_DONE_DEV_REMOVE; + break; + } -+ ++ + rtw_msleep_os(10); + } while (rtw_get_passing_time_ms(pack_tx_ops->submit_time) < timeout_ms); + @@ -87542,14 +63142,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + pack_tx_ops->timeout_ms = timeout_ms; + pack_tx_ops->status = RTW_SCTX_SUBMITTED; + -+ return rtw_sctx_wait(pack_tx_ops, __func__); ++ return rtw_sctx_wait(pack_tx_ops); +#endif +} + +void rtw_ack_tx_done(struct xmit_priv *pxmitpriv, int status) +{ + struct submit_ctx *pack_tx_ops = &pxmitpriv->ack_tx_ops; -+ ++ + if (pxmitpriv->ack_tx) { + rtw_sctx_done_err(&pack_tx_ops, status); + } else { @@ -87557,68791 +63157,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/core/rtw_xmit.c linux/3rdparty/rtl8812au + } +} +#endif //CONFIG_XMIT_ACK -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8188c2Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8188c2Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8188c2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8188c2Ant.c 2017-06-07 23:07:21.007687211 +0300 -@@ -0,0 +1,1987 @@ -+//============================================================ -+// Description: -+// -+// This file is for 92CE/92CU BT 1 Antenna Co-exist mechanism -+// -+// By cosa 02/11/2011 -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8188c2Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8188C_2ANT GLCoexDm8188c2Ant; -+static PCOEX_DM_8188C_2ANT pCoexDm=&GLCoexDm8188c2Ant; -+static COEX_STA_8188C_2ANT GLCoexSta8188c2Ant; -+static PCOEX_STA_8188C_2ANT pCoexSta=&GLCoexSta8188c2Ant; -+ -+//============================================================ -+// local function start with btdm_ -+//============================================================ -+u1Byte -+halbtc8188c2ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+u1Byte -+halbtc8188c2ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ u1Byte algorithm=BT_8188C_2ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ if(!pStackInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No profile exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pStackInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(pStackInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO algorithm\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(numOfDiffProfile == 1) -+ { -+ if(pStackInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_HID; -+ } -+ else if(pStackInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_A2DP; -+ } -+ else if(pStackInfo->bPanExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN only\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_PAN; -+ } -+ } -+ else -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_HID_PAN; -+ } -+ else if( pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN + A2DP\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_PAN_A2DP; -+ } -+ } -+ } -+ return algorithm; -+} -+ -+VOID -+halbtc8188c2ant_SetFwBalance( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bBalanceOn, -+ IN u1Byte ms0, -+ IN u1Byte ms1 -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ -+ if(bBalanceOn) -+ { -+ H2C_Parameter[2] = 1; -+ H2C_Parameter[1] = ms1; -+ H2C_Parameter[0] = ms0; -+ } -+ else -+ { -+ H2C_Parameter[2] = 0; -+ H2C_Parameter[1] = 0; -+ H2C_Parameter[0] = 0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Balance=[%s:%dms:%dms], write 0xc=0x%x\n", -+ bBalanceOn?"ON":"OFF", ms0, ms1, -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0xc, 3, H2C_Parameter); -+} -+ -+VOID -+halbtc8188c2ant_Balance( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bBalanceOn, -+ IN u1Byte ms0, -+ IN u1Byte ms1 -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Balance %s\n", -+ (bForceExec? "force to":""), (bBalanceOn? "ON":"OFF"))); -+ pCoexDm->bCurBalanceOn = bBalanceOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreBalanceOn == pCoexDm->bCurBalanceOn) -+ return; -+ } -+ halbtc8188c2ant_SetFwBalance(pBtCoexist, bBalanceOn, ms0, ms1); -+ -+ pCoexDm->bPreBalanceOn = pCoexDm->bCurBalanceOn; -+} -+ -+VOID -+halbtc8188c2ant_SetFwDiminishWifi( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bDacOn, -+ IN BOOLEAN bInterruptOn, -+ IN u1Byte fwDacSwingLvl, -+ IN BOOLEAN bNavOn -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ -+ if((pBtCoexist->stackInfo.minBtRssi <= -5) && (fwDacSwingLvl == 0x20)) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], DiminishWiFi 0x20 original, but set 0x18 for Low RSSI!\n")); -+ fwDacSwingLvl = 0x18; -+ } -+ -+ H2C_Parameter[2] = 0; -+ H2C_Parameter[1] = fwDacSwingLvl; -+ H2C_Parameter[0] = 0; -+ if(bDacOn) -+ { -+ H2C_Parameter[2] |= 0x01; //BIT0 -+ if(bInterruptOn) -+ { -+ H2C_Parameter[2] |= 0x02; //BIT1 -+ } -+ } -+ if(bNavOn) -+ { -+ H2C_Parameter[2] |= 0x08; //BIT3 -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bDacOn=%s, bInterruptOn=%s, bNavOn=%s, write 0xe=0x%x\n", -+ (bDacOn?"ON":"OFF"), (bInterruptOn?"ON":"OFF"), (bNavOn?"ON":"OFF"), -+ (H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2]))); -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0xe, 3, H2C_Parameter); -+} -+ -+VOID -+halbtc8188c2ant_DiminishWifi( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacOn, -+ IN BOOLEAN bInterruptOn, -+ IN u1Byte fwDacSwingLvl, -+ IN BOOLEAN bNavOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set Diminish Wifi, bDacOn=%s, bInterruptOn=%s, fwDacSwingLvl=%d, bNavOn=%s\n", -+ (bForceExec? "force to":""), (bDacOn? "ON":"OFF"), (bInterruptOn? "ON":"OFF"), fwDacSwingLvl, (bNavOn? "ON":"OFF"))); -+ -+ pCoexDm->bCurDacOn = bDacOn; -+ pCoexDm->bCurInterruptOn = bInterruptOn; -+ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; -+ pCoexDm->bCurNavOn = bNavOn; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacOn==pCoexDm->bCurDacOn) && -+ (pCoexDm->bPreInterruptOn==pCoexDm->bCurInterruptOn) && -+ (pCoexDm->preFwDacSwingLvl==pCoexDm->curFwDacSwingLvl) && -+ (pCoexDm->bPreNavOn==pCoexDm->bCurNavOn) ) -+ return; -+ } -+ halbtc8188c2ant_SetFwDiminishWifi(pBtCoexist, bDacOn, bInterruptOn, fwDacSwingLvl, bNavOn); -+ -+ pCoexDm->bPreDacOn = pCoexDm->bCurDacOn; -+ pCoexDm->bPreInterruptOn = pCoexDm->bCurInterruptOn; -+ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -+ pCoexDm->bPreNavOn = pCoexDm->bCurNavOn; -+} -+ -+VOID -+halbtc8188c2ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xf0, 0xf); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xf0, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+VOID -+halbtc8188c2ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8188c2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8188c2ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte tmpU1; -+ -+ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); -+ if(bLowPenaltyRa) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); -+ tmpU1 &= ~BIT2; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); -+ tmpU1 |= BIT2; -+ } -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -+} -+ -+VOID -+halbtc8188c2ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8188c2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8188c2ant_SetSwFullTimeDacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSwDacSwingOn, -+ IN u4Byte swDacSwingLvl -+ ) -+{ -+ u4Byte dacSwingLvl; -+ -+ if(bSwDacSwingOn) -+ { -+ if((pBtCoexist->stackInfo.minBtRssi <= -5) && (swDacSwingLvl == 0x20)) -+ { -+ dacSwingLvl = 0x18; -+ } -+ else -+ { -+ dacSwingLvl = swDacSwingLvl; -+ } -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, dacSwingLvl); -+ } -+ else -+ { -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, 0x30); -+ } -+} -+ -+VOID -+halbtc8188c2ant_DacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacSwingOn, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", -+ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); -+ pCoexDm->bCurDacSwingOn = bDacSwingOn; -+ pCoexDm->curDacSwingLvl = dacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && -+ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) -+ return; -+ } -+ delay_ms(30); -+ halbtc8188c2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); -+ -+ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; -+ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -+} -+ -+VOID -+halbtc8188c2ant_SetAdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ if(bAdcBackOff) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a07611); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a05611); -+ } -+} -+ -+VOID -+halbtc8188c2ant_AdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", -+ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); -+ pCoexDm->bCurAdcBackOff = bAdcBackOff; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) -+ return; -+ } -+ halbtc8188c2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); -+ -+ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -+} -+ -+VOID -+halbtc8188c2ant_SetAgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ u1Byte rssiAdjustVal=0; -+ -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4e1c0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4d1d0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4c1e0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4b1f0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4a200001); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xdc000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x90000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x51000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x12000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x00255); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x641c0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x631d0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x621e0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x611f0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x60200001); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x32000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x71000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xb0000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xfc000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x10255); -+ } -+ -+ // set rssiAdjustVal for wifi module. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -+} -+ -+ -+VOID -+halbtc8188c2ant_AgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", -+ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); -+ pCoexDm->bCurAgcTableEn = bAgcTableEn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) -+ return; -+ } -+ halbtc8188c2ant_SetAgcTable(pBtCoexist, bAgcTableEn); -+ -+ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -+} -+ -+VOID -+halbtc8188c2ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u4Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8188c2ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u4Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c4, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8188c2ant_SetCoexTable(pBtCoexist, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8188c2ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw mechanism -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+} -+VOID -+halbtc8188c2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+ -+VOID -+halbtc8188c2ant_MonitorBtState( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN stateChange=FALSE; -+ u4Byte BT_Polling, Ratio_Act, Ratio_STA; -+ u4Byte BT_Active, BT_State; -+ u4Byte regBTActive=0, regBTState=0, regBTPolling=0; -+ u4Byte btBusyThresh=0; -+ u4Byte fwVer=0; -+ static BOOLEAN bBtBusyTraffic=FALSE; -+ BOOLEAN bRejApAggPkt=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FirmwareVersion = 0x%x(%d)\n", fwVer, fwVer)); -+ if(fwVer < 62) -+ { -+ regBTActive = 0x488; -+ regBTState = 0x48c; -+ regBTPolling = 0x490; -+ } -+ else -+ { -+ regBTActive = 0x444; -+ regBTState = 0x448; -+ if(fwVer >= 74) -+ regBTPolling = 0x44c; -+ else -+ regBTPolling = 0x700; -+ } -+ btBusyThresh = 60; -+ -+ BT_Active = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTActive); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Active(0x%x)=0x%x\n", regBTActive, BT_Active)); -+ BT_Active = BT_Active & 0x00ffffff; -+ -+ BT_State = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTState); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_State(0x%x)=0x%x\n", regBTState, BT_State)); -+ BT_State = BT_State & 0x00ffffff; -+ -+ BT_Polling = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTPolling); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Polling(0x%x)=0x%x\n", regBTPolling, BT_Polling)); -+ -+ if(BT_Active==0xffffffff && BT_State==0xffffffff && BT_Polling==0xffffffff ) -+ return; -+ -+ // 2011/05/04 MH For Slim combo test meet a problem. Surprise remove and WLAN is running -+ // DHCP process. At the same time, the register read value might be zero. And cause BSOD 0x7f -+ // EXCEPTION_DIVIDED_BY_ZERO. In This case, the stack content may always be wrong due to -+ // HW divide trap. -+ if (BT_Polling==0) -+ return; -+ -+ Ratio_Act = BT_Active*1000/BT_Polling; -+ Ratio_STA = BT_State*1000/BT_Polling; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_Act=%d\n", Ratio_Act)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_STA=%d\n", Ratio_STA)); -+ -+ if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ if(Ratio_STA < 60) // BT PAN idle -+ { -+ } -+ else -+ { -+ // Check if BT PAN (under BT 2.1) is uplink or downlink -+ if((Ratio_Act/Ratio_STA) < 2) -+ { // BT PAN Uplink -+ pCoexSta->bBtUplink = TRUE; -+ } -+ else -+ { // BT PAN downlink -+ pCoexSta->bBtUplink = FALSE; -+ } -+ } -+ } -+ -+ // Check BT is idle or not -+ if(!pBtCoexist->stackInfo.bBtLinkExist) -+ { -+ pCoexSta->bBtBusy = FALSE; -+ } -+ else -+ { -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ if(Ratio_Act<20) -+ { -+ pCoexSta->bBtBusy = FALSE; -+ } -+ else -+ { -+ pCoexSta->bBtBusy = TRUE; -+ } -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ if(Ratio_STA < btBusyThresh) -+ { -+ pCoexSta->bBtBusy = FALSE; -+ } -+ else -+ { -+ pCoexSta->bBtBusy = TRUE; -+ } -+ -+ if( (Ratio_STA < btBusyThresh) || -+ (Ratio_Act<180 && Ratio_STA<130) ) -+ { -+ pCoexSta->bA2dpBusy = FALSE; -+ } -+ else -+ { -+ pCoexSta->bA2dpBusy = TRUE; -+ } -+ } -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &pCoexSta->bBtBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &pCoexSta->bBtBusy); -+ -+ if(bBtBusyTraffic != pCoexSta->bBtBusy) -+ { // BT idle or BT non-idle -+ bBtBusyTraffic = pCoexSta->bBtBusy; -+ stateChange = TRUE; -+ } -+ -+ if(stateChange) -+ { -+ if(!pCoexSta->bBtBusy) -+ { -+ halbtc8188c2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ } -+ else -+ { -+ halbtc8188c2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ } -+ -+ if(stateChange) -+ { -+ bRejApAggPkt = pCoexSta->bBtBusy; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejApAggPkt); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionA2dpBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw, wifiTrafficDir; -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ -+ if(pCoexSta->bBtBusy) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism first -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ } -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionA2dpBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw, wifiTrafficDir; -+ BOOLEAN bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ if(pCoexSta->bA2dpBusy && bWifiBusy) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ -+ // fw mechanism first -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x18); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ } -+ else if(pCoexSta->bA2dpBusy) -+ { -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, TRUE, 0x18, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionA2dpBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionA2dpBc8(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionPanBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ if(bBtHsOn) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ else -+ { -+ if(pCoexSta->bBtBusy && bWifiBusy) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ } -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+} -+ -+VOID -+halbtc8188c2ant_ActionPanBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ u4Byte wifiBw, wifiTrafficDir; -+ s4Byte wifiRssi; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(bBtHsOn) -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ else -+ { -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 3, 25, 50); -+ -+ if(pCoexSta->bBtBusy && bWifiBusy) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ // fw mechanism first -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ } -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ } -+ else if( (wifiRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_MEDIUM) ) -+ { -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); -+ -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); -+ else -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); -+ -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ if(pCoexSta->bBtUplink) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); -+ } -+ else -+ { -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ } -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else if(pCoexSta->bBtBusy && !bWifiBusy && (wifiRssi < 30)) -+ { -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x0a, 0x20); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionPan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionPanBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionPanBc8(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte wifiBw, wifiTrafficDir; -+ BOOLEAN bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ if(BTC_WIFI_BW_LEGACY == wifiBw) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else if(!bWifiBusy) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+} -+ -+ -+VOID -+halbtc8188c2ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw; -+ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ -+ // fw mechanism -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionHidA2dpBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw, wifiTrafficDir; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ -+ if(pCoexSta->bBtBusy) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism first -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x7, 0x20); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ } -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else -+ { -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ // fw mechanism first -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x7, 0x20); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+} -+VOID -+halbtc8188c2ant_ActionHidA2dpBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw; -+ -+ if(pCoexSta->bBtBusy) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else -+ { -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ // fw mechanism -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionHidA2dpBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionHidA2dpBc8(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionHidPanBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u4Byte wifiBw, wifiTrafficDir; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(bBtHsOn) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ if(BTC_WIFI_BW_LEGACY == wifiBw) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(!bWifiBusy) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ } -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+} -+VOID -+halbtc8188c2ant_ActionHidPanBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ u4Byte wifiBw, wifiTrafficDir; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!bBtHsOn) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); -+ if((pCoexSta->bBtBusy && bWifiBusy)) -+ { -+ // fw mechanism first -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); -+ } -+ else -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); -+ } -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+ else -+ { -+ if(BTC_INTF_USB == pBtCoexist->chipInterface) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ } -+ else -+ { -+ if(pCoexSta->bBtBusy) -+ { -+ // fw mechanism -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionHidPan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionHidPanBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionHidPanBc8(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionPanA2dpBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ if(bBtHsOn) -+ { -+ if(pCoexSta->bBtBusy) -+ { -+ // fw mechanism -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+ else -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ if(pCoexSta->bBtBusy && bWifiBusy) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+} -+VOID -+halbtc8188c2ant_ActionPanA2dpBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!bBtHsOn) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); -+ if((pCoexSta->bBtBusy && bWifiBusy)) -+ { -+ // fw mechanism first -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); -+ } -+ else -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); -+ } -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+ else -+ { -+ if(pCoexSta->bBtBusy) -+ { -+ // fw mechanism -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionPanA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionPanA2dpBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionPanA2dpBc8(pBtCoexist); -+ } -+} -+ -+//============================================================ -+// extern function start with EXhalbtc8188c2ant_ -+//============================================================ -+VOID -+EXhalbtc8188c2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8188c2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ u1Byte u1Tmp=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); -+ -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xf0); -+ -+ if( (BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) || -+ (BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ) -+ { -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd) & BIT0; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, u1Tmp); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0xaaaa9aaa, 0xffbd0040, 0x40000010); -+ } -+} -+ -+VOID -+EXhalbtc8188c2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8188c2ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8188c2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pStackInfo->bProfileNotified) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ -+ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ -+ u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8188c2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ //halbtc8188c2ant_InitCoexDm(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8188c2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ halbtc8188c2ant_InitCoexDm(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8188c2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8188c2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8188c2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+ -+} -+ -+VOID -+EXhalbtc8188c2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8188c2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8188c2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ EXhalbtc8188c2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+VOID -+EXhalbtc8188c2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte algorithm; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Periodical!!\n")); -+ -+ // NOTE: -+ // sw mechanism must be done after fw mechanism -+ // -+ -+ if((BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) || -+ (BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ) -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_GET_BT_RSSI, NULL); -+ -+ halbtc8188c2ant_MonitorBtState(pBtCoexist); -+ algorithm = halbtc8188c2ant_ActionAlgorithm(pBtCoexist); -+ pCoexDm->curAlgorithm = algorithm; -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8188C_2ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO\n")); -+ halbtc8188c2ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8188C_2ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID\n")); -+ halbtc8188c2ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8188C_2ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP\n")); -+ halbtc8188c2ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8188C_2ANT_COEX_ALGO_PAN: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN\n")); -+ halbtc8188c2ant_ActionPan(pBtCoexist); -+ break; -+ case BT_8188C_2ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP\n")); -+ halbtc8188c2ant_ActionHidA2dp(pBtCoexist); -+ break; -+ case BT_8188C_2ANT_COEX_ALGO_HID_PAN: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+HID\n")); -+ halbtc8188c2ant_ActionHidPan(pBtCoexist); -+ break; -+ case BT_8188C_2ANT_COEX_ALGO_PAN_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP\n")); -+ halbtc8188c2ant_ActionPanA2dp(pBtCoexist); -+ break; -+ default: -+ break; -+ } -+ } -+} -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8188c2Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8188c2Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8188c2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8188c2Ant.h 2017-06-07 23:07:21.007687211 +0300 -@@ -0,0 +1,149 @@ -+//=========================================== -+// The following is for 8188C 2Ant BT Co-exist definition -+//=========================================== -+#define BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT 6 -+ -+typedef enum _BT_INFO_SRC_8188C_2ANT{ -+ BT_INFO_SRC_8188C_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8188C_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8188C_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8188C_2ANT_MAX -+}BT_INFO_SRC_8188C_2ANT,*PBT_INFO_SRC_8188C_2ANT; -+ -+typedef enum _BT_8188C_2ANT_BT_STATUS{ -+ BT_8188C_2ANT_BT_STATUS_IDLE = 0x0, -+ BT_8188C_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8188C_2ANT_BT_STATUS_NON_IDLE = 0x2, -+ BT_8188C_2ANT_BT_STATUS_MAX -+}BT_8188C_2ANT_BT_STATUS,*PBT_8188C_2ANT_BT_STATUS; -+ -+typedef enum _BT_8188C_2ANT_COEX_ALGO{ -+ BT_8188C_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8188C_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8188C_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8188C_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8188C_2ANT_COEX_ALGO_PAN = 0x4, -+ BT_8188C_2ANT_COEX_ALGO_HID_A2DP = 0x5, -+ BT_8188C_2ANT_COEX_ALGO_HID_PAN = 0x6, -+ BT_8188C_2ANT_COEX_ALGO_PAN_A2DP = 0x7, -+ BT_8188C_2ANT_COEX_ALGO_MAX -+}BT_8188C_2ANT_COEX_ALGO,*PBT_8188C_2ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8188C_2ANT{ -+ // fw mechanism -+ BOOLEAN bPreBalanceOn; -+ BOOLEAN bCurBalanceOn; -+ -+ // diminishWifi -+ BOOLEAN bPreDacOn; -+ BOOLEAN bCurDacOn; -+ BOOLEAN bPreInterruptOn; -+ BOOLEAN bCurInterruptOn; -+ u1Byte preFwDacSwingLvl; -+ u1Byte curFwDacSwingLvl; -+ BOOLEAN bPreNavOn; -+ BOOLEAN bCurNavOn; -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ BOOLEAN bPreDacSwingOn; -+ u4Byte preDacSwingLvl; -+ BOOLEAN bCurDacSwingOn; -+ u4Byte curDacSwingLvl; -+ BOOLEAN bPreAdcBackOff; -+ BOOLEAN bCurAdcBackOff; -+ BOOLEAN bPreAgcTableEn; -+ BOOLEAN bCurAgcTableEn; -+ //u4Byte preVal0x6c0; -+ //u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u4Byte preVal0x6cc; -+ u4Byte curVal0x6cc; -+ //BOOLEAN bLimitedDig; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ //u1Byte btStatus; -+ //u1Byte wifiChnlInfo[3]; -+} COEX_DM_8188C_2ANT, *PCOEX_DM_8188C_2ANT; -+ -+typedef struct _COEX_STA_8188C_2ANT{ -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bBtBusy; -+ BOOLEAN bBtUplink; -+ BOOLEAN bBtDownLink; -+ BOOLEAN bA2dpBusy; -+}COEX_STA_8188C_2ANT, *PCOEX_STA_8188C_2ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8188c2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8188c2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8188c2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8188c2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8188c2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8188c2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8188c2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8188c2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8188c2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8188c2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8188c2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8188c2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8188c2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8192d2Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8192d2Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8192d2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8192d2Ant.c 2017-06-07 23:07:21.008687302 +0300 -@@ -0,0 +1,1992 @@ -+//============================================================ -+// Description: -+// -+// This file is for 92D BT 2 Antenna Co-exist mechanism -+// -+// By cosa 02/11/2011 -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8192d2Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8192D_2ANT GLCoexDm8192d2Ant; -+static PCOEX_DM_8192D_2ANT pCoexDm=&GLCoexDm8192d2Ant; -+static COEX_STA_8192D_2ANT GLCoexSta8192d2Ant; -+static PCOEX_STA_8192D_2ANT pCoexSta=&GLCoexSta8192d2Ant; -+ -+//============================================================ -+// local function start with btdm_ -+//============================================================ -+u1Byte -+halbtc8192d2ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+u1Byte -+halbtc8192d2ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ u1Byte algorithm=BT_8192D_2ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!pStackInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No profile exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pStackInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(pStackInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO algorithm\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(numOfDiffProfile == 1) -+ { -+ if(pStackInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_HID; -+ } -+ else if(pStackInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_A2DP; -+ } -+ else if(pStackInfo->bPanExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN only\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_PAN; -+ } -+ } -+ else -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_HID_PAN; -+ } -+ else if( pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN + A2DP\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_PAN_A2DP; -+ } -+ } -+ } -+ return algorithm; -+} -+ -+VOID -+halbtc8192d2ant_SetFwBalance( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bBalanceOn, -+ IN u1Byte ms0, -+ IN u1Byte ms1 -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ -+ if(bBalanceOn) -+ { -+ H2C_Parameter[2] = 1; -+ H2C_Parameter[1] = ms1; -+ H2C_Parameter[0] = ms0; -+ } -+ else -+ { -+ H2C_Parameter[2] = 0; -+ H2C_Parameter[1] = 0; -+ H2C_Parameter[0] = 0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Balance=[%s:%dms:%dms], write 0xc=0x%x\n", -+ bBalanceOn?"ON":"OFF", ms0, ms1, -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0xc, 3, H2C_Parameter); -+} -+ -+VOID -+halbtc8192d2ant_Balance( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bBalanceOn, -+ IN u1Byte ms0, -+ IN u1Byte ms1 -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Balance %s\n", -+ (bForceExec? "force to":""), (bBalanceOn? "ON":"OFF"))); -+ pCoexDm->bCurBalanceOn = bBalanceOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreBalanceOn == pCoexDm->bCurBalanceOn) -+ return; -+ } -+ halbtc8192d2ant_SetFwBalance(pBtCoexist, bBalanceOn, ms0, ms1); -+ -+ pCoexDm->bPreBalanceOn = pCoexDm->bCurBalanceOn; -+} -+ -+VOID -+halbtc8192d2ant_SetFwDiminishWifi( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bDacOn, -+ IN BOOLEAN bInterruptOn, -+ IN u1Byte fwDacSwingLvl, -+ IN BOOLEAN bNavOn -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ -+ if((pBtCoexist->stackInfo.minBtRssi <= -5) && (fwDacSwingLvl == 0x20)) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], DiminishWiFi 0x20 original, but set 0x18 for Low RSSI!\n")); -+ fwDacSwingLvl = 0x18; -+ } -+ -+ H2C_Parameter[2] = 0; -+ H2C_Parameter[1] = fwDacSwingLvl; -+ H2C_Parameter[0] = 0; -+ if(bDacOn) -+ { -+ H2C_Parameter[2] |= 0x01; //BIT0 -+ if(bInterruptOn) -+ { -+ H2C_Parameter[2] |= 0x02; //BIT1 -+ } -+ } -+ if(bNavOn) -+ { -+ H2C_Parameter[2] |= 0x08; //BIT3 -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bDacOn=%s, bInterruptOn=%s, bNavOn=%s, write 0x12=0x%x\n", -+ (bDacOn?"ON":"OFF"), (bInterruptOn?"ON":"OFF"), (bNavOn?"ON":"OFF"), -+ (H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2]))); -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x12, 3, H2C_Parameter); -+} -+ -+ -+VOID -+halbtc8192d2ant_DiminishWifi( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacOn, -+ IN BOOLEAN bInterruptOn, -+ IN u1Byte fwDacSwingLvl, -+ IN BOOLEAN bNavOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set Diminish Wifi, bDacOn=%s, bInterruptOn=%s, fwDacSwingLvl=%d, bNavOn=%s\n", -+ (bForceExec? "force to":""), (bDacOn? "ON":"OFF"), (bInterruptOn? "ON":"OFF"), fwDacSwingLvl, (bNavOn? "ON":"OFF"))); -+ -+ pCoexDm->bCurDacOn = bDacOn; -+ pCoexDm->bCurInterruptOn = bInterruptOn; -+ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; -+ pCoexDm->bCurNavOn = bNavOn; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacOn==pCoexDm->bCurDacOn) && -+ (pCoexDm->bPreInterruptOn==pCoexDm->bCurInterruptOn) && -+ (pCoexDm->preFwDacSwingLvl==pCoexDm->curFwDacSwingLvl) && -+ (pCoexDm->bPreNavOn==pCoexDm->bCurNavOn) ) -+ return; -+ } -+ halbtc8192d2ant_SetFwDiminishWifi(pBtCoexist, bDacOn, bInterruptOn, fwDacSwingLvl, bNavOn); -+ -+ pCoexDm->bPreDacOn = pCoexDm->bCurDacOn; -+ pCoexDm->bPreInterruptOn = pCoexDm->bCurInterruptOn; -+ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -+ pCoexDm->bPreNavOn = pCoexDm->bCurNavOn; -+} -+ -+VOID -+halbtc8192d2ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xf2ff7); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+ -+VOID -+halbtc8192d2ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8192d2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8192d2ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte tmpU1; -+ -+ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); -+ if(bLowPenaltyRa) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); -+ tmpU1 &= ~BIT2; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); -+ tmpU1 |= BIT2; -+ } -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -+} -+ -+VOID -+halbtc8192d2ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8192d2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8192d2ant_SetSwFullTimeDacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSwDacSwingOn, -+ IN u4Byte swDacSwingLvl -+ ) -+{ -+ u4Byte dacSwingLvl; -+ -+ if(bSwDacSwingOn) -+ { -+ if((pBtCoexist->stackInfo.minBtRssi <= -5) && (swDacSwingLvl == 0x20)) -+ { -+ dacSwingLvl = 0x18; -+ } -+ else -+ { -+ dacSwingLvl = swDacSwingLvl; -+ } -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, dacSwingLvl); -+ } -+ else -+ { -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, 0x30); -+ } -+} -+ -+VOID -+halbtc8192d2ant_DacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacSwingOn, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", -+ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); -+ pCoexDm->bCurDacSwingOn = bDacSwingOn; -+ pCoexDm->curDacSwingLvl = dacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && -+ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) -+ return; -+ } -+ delay_ms(30); -+ halbtc8192d2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); -+ -+ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; -+ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -+} -+ -+VOID -+halbtc8192d2ant_SetAdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ if(bAdcBackOff) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a07611); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a05611); -+ } -+} -+ -+VOID -+halbtc8192d2ant_AdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", -+ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); -+ pCoexDm->bCurAdcBackOff = bAdcBackOff; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) -+ return; -+ } -+ halbtc8192d2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); -+ -+ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -+} -+ -+VOID -+halbtc8192d2ant_SetAgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ u1Byte rssiAdjustVal=0; -+ -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0xa99); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xd4000); -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b000001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b010001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b020001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b030001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b040001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b050001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b060001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b070001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b080001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b090001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b0A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b0B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7a0C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x790D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x780E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x770F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x76100001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x75110001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x74120001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x73130001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x72140001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x71150001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x70160001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6f170001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6e180001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6d190001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6c1A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6b1B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6a1C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x691D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4f1E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4e1F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4d200001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4c210001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4b220001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4a230001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x49240001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x48250001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x47260001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x46270001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x45280001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x44290001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x432A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x422B0001); -+ -+ rssiAdjustVal = 12; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x30a99); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xdc000); -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B000001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B010001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B020001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B030001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B040001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B050001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B060001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7A070001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x79080001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x78090001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x770A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x760B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x750C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x740D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x730E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x720F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x71100001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x70110001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6F120001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6E130001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6D140001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6C150001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6B160001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6A170001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x69180001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x68190001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x671A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x661B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x651C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x641D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x631E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x621F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x61200001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x60210001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x49220001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x48230001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x47240001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x46250001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x45260001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x44270001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x43280001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x42290001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x412A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x402B0001); -+ } -+ -+ // set rssiAdjustVal for wifi module. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -+} -+ -+ -+ -+VOID -+halbtc8192d2ant_AgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", -+ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); -+ pCoexDm->bCurAgcTableEn = bAgcTableEn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) -+ return; -+ } -+ halbtc8192d2ant_SetAgcTable(pBtCoexist, bAgcTableEn); -+ -+ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -+} -+ -+VOID -+halbtc8192d2ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u4Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8192d2ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u4Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c4, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8192d2ant_SetCoexTable(pBtCoexist, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8192d2ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw mechanism -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+} -+VOID -+halbtc8192d2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+halbtc8192d2ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte btActive -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtDisabled=FALSE, bForceToRoam=FALSE; -+ u4Byte u4Tmp=0; -+ -+ // This function check if bt is disabled -+ if(btActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ -+ bForceToRoam = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_FORCE_TO_ROAM, &bForceToRoam); -+ -+ bPreBtDisabled = bBtDisabled; -+ } -+} -+ -+VOID -+halbtc8192d2ant_MonitorBtState( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN stateChange=FALSE; -+ u4Byte BT_Polling, Ratio_Act, Ratio_STA; -+ u4Byte BT_Active, BT_State; -+ u4Byte regBTActive=0, regBTState=0, regBTPolling=0; -+ u4Byte btBusyThresh=0; -+ u4Byte fwVer=0; -+ static BOOLEAN bBtBusyTraffic=FALSE; -+ BOOLEAN bRejApAggPkt=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FirmwareVersion = 0x%x(%d)\n", fwVer, fwVer)); -+ -+ regBTActive = 0x444; -+ regBTState = 0x448; -+ regBTPolling = 0x44c; -+ -+ btBusyThresh = 40; -+ -+ BT_Active = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTActive); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Active(0x%x)=0x%x\n", regBTActive, BT_Active)); -+ BT_Active = BT_Active & 0x00ffffff; -+ -+ BT_State = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTState); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_State(0x%x)=0x%x\n", regBTState, BT_State)); -+ BT_State = BT_State & 0x00ffffff; -+ -+ BT_Polling = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTPolling); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Polling(0x%x)=0x%x\n", regBTPolling, BT_Polling)); -+ -+ if(BT_Active==0xffffffff && BT_State==0xffffffff && BT_Polling==0xffffffff ) -+ return; -+ -+ // 2011/05/04 MH For Slim combo test meet a problem. Surprise remove and WLAN is running -+ // DHCP process. At the same time, the register read value might be zero. And cause BSOD 0x7f -+ // EXCEPTION_DIVIDED_BY_ZERO. In This case, the stack content may always be wrong due to -+ // HW divide trap. -+ if (BT_Polling==0) -+ return; -+ -+ halbtc8192d2ant_MonitorBtEnableDisable(pBtCoexist, BT_Active); -+ -+ Ratio_Act = BT_Active*1000/BT_Polling; -+ Ratio_STA = BT_State*1000/BT_Polling; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_Act=%d\n", Ratio_Act)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_STA=%d\n", Ratio_STA)); -+ -+ if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ if(Ratio_STA < 60) // BT PAN idle -+ { -+ } -+ else -+ { -+ // Check if BT PAN (under BT 2.1) is uplink or downlink -+ if((Ratio_Act/Ratio_STA) < 2) -+ { // BT PAN Uplink -+ pCoexSta->bBtUplink = TRUE; -+ } -+ else -+ { // BT PAN downlink -+ pCoexSta->bBtUplink = FALSE; -+ } -+ } -+ } -+ -+ // Check BT is idle or not -+ if(!pBtCoexist->stackInfo.bBtLinkExist) -+ { -+ pCoexSta->bBtBusy = FALSE; -+ } -+ else -+ { -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ if(Ratio_Act<20) -+ { -+ pCoexSta->bBtBusy = FALSE; -+ } -+ else -+ { -+ pCoexSta->bBtBusy = TRUE; -+ } -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ if(Ratio_STA < btBusyThresh) -+ { -+ pCoexSta->bBtBusy = FALSE; -+ } -+ else -+ { -+ pCoexSta->bBtBusy = TRUE; -+ } -+ -+ if( (Ratio_STA < btBusyThresh) || -+ (Ratio_Act<180 && Ratio_STA<130) ) -+ { -+ pCoexSta->bA2dpBusy = FALSE; -+ } -+ else -+ { -+ pCoexSta->bA2dpBusy = TRUE; -+ } -+ } -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &pCoexSta->bBtBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &pCoexSta->bBtBusy); -+ -+ if(bBtBusyTraffic != pCoexSta->bBtBusy) -+ { // BT idle or BT non-idle -+ bBtBusyTraffic = pCoexSta->bBtBusy; -+ stateChange = TRUE; -+ } -+ -+ if(stateChange) -+ { -+ if(!pCoexSta->bBtBusy) -+ { -+ halbtc8192d2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ } -+ else -+ { -+ halbtc8192d2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ } -+ -+ if(stateChange) -+ { -+ bRejApAggPkt = pCoexSta->bBtBusy; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejApAggPkt); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ } -+} -+ -+VOID -+halbtc8192d2ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw, wifiTrafficDir; -+ BOOLEAN bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ if(pCoexSta->bA2dpBusy && bWifiBusy) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ } -+ else -+ { -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 25, 0); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 40, 0); -+ } -+ } -+ -+ // fw mechanism first -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x18); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ } -+ else if(pCoexSta->bA2dpBusy) -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, TRUE, 0x18, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8192d2ant_ActionPan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState, wifiRssiState1; -+ u4Byte wifiBw, wifiTrafficDir; -+ s4Byte wifiRssi; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(bBtHsOn) -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ else -+ { -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 3, 25, 50); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ } -+ else -+ { -+ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 25, 0); -+ } -+ -+ if(pCoexSta->bBtBusy && bWifiBusy) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ // fw mechanism first -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ } -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ } -+ else if( (wifiRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_MEDIUM) ) -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); -+ -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); -+ else -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); -+ -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ if(pCoexSta->bBtUplink) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); -+ } -+ else -+ { -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ } -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else if(pCoexSta->bBtBusy && -+ !bWifiBusy && -+ (wifiRssi < 30)) -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x0a, 0x20); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+} -+ -+ -+VOID -+halbtc8192d2ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiTrafficDir; -+ BOOLEAN bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 45, 0); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 20, 0); -+ } -+ -+ if(pCoexSta->bBtBusy && bWifiBusy) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ // fw mechanism first -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, TRUE, 0x18, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x15); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x30, FALSE); -+ } -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+} -+ -+ -+ -+VOID -+halbtc8192d2ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+} -+ -+VOID -+halbtc8192d2ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1; -+ u4Byte wifiBw; -+ -+ if(pCoexSta->bBtBusy) -+ { -+ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 35, 0); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else -+ { -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ // fw mechanism -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else -+ { -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+} -+ -+ -+VOID -+halbtc8192d2ant_ActionHidPanBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u4Byte wifiBw, wifiTrafficDir; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(bBtHsOn) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ if(BTC_WIFI_BW_LEGACY == wifiBw) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(!bWifiBusy) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ } -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+} -+VOID -+halbtc8192d2ant_ActionHidPanBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ u4Byte wifiBw, wifiTrafficDir; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!bBtHsOn) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); -+ if((pCoexSta->bBtBusy && bWifiBusy)) -+ { -+ // fw mechanism first -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); -+ } -+ else -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); -+ } -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+ else -+ { -+ if(BTC_INTF_USB == pBtCoexist->chipInterface) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ } -+ else -+ { -+ if(pCoexSta->bBtBusy) -+ { -+ // fw mechanism -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ } -+} -+ -+VOID -+halbtc8192d2ant_ActionHidPan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8192d2ant_ActionHidPanBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8192d2ant_ActionHidPanBc8(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8192d2ant_ActionPanA2dpBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ if(bBtHsOn) -+ { -+ if(pCoexSta->bBtBusy) -+ { -+ // fw mechanism -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+ else -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ if(pCoexSta->bBtBusy && bWifiBusy) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+} -+VOID -+halbtc8192d2ant_ActionPanA2dpBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!bBtHsOn) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); -+ if((pCoexSta->bBtBusy && bWifiBusy)) -+ { -+ // fw mechanism first -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); -+ } -+ else -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); -+ } -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+ else -+ { -+ if(pCoexSta->bBtBusy) -+ { -+ // fw mechanism -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+} -+ -+VOID -+halbtc8192d2ant_ActionPanA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8192d2ant_ActionPanA2dpBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8192d2ant_ActionPanA2dpBc8(pBtCoexist); -+ } -+} -+ -+BOOLEAN -+halbtc8192d2ant_IsBtCoexistEnter( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte macPhyMode; -+ BOOLEAN bRet=TRUE; -+ BOOLEAN bWifiUnder5G=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_MAC_PHY_MODE, &macPhyMode); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ -+ if(BTC_SMSP != macPhyMode) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Only support single mac single phy!!\n")); -+ bRet = FALSE; -+ } -+ -+ if(bWifiUnder5G) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under 5G or A band\n")); -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ bRet = FALSE; -+ } -+ -+ return bRet; -+} -+ -+//============================================================ -+// extern function start with EXhalbtc8192d2ant_ -+//============================================================ -+VOID -+EXhalbtc8192d2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8192d2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ u1Byte u1Tmp=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); -+ -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ if( (BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) || -+ (BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ) -+ { -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd) & BIT0; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, u1Tmp); -+ -+ halbtc8192d2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0xaaaa9aaa, 0xffbd0040, 0x40000010); -+ -+ // switch control, here we set pathA to control -+ // 0x878[13] = 1, 0:pathB, 1:pathA(default) -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x878, BIT13, 0x1); -+ -+ // antsel control, here we use phy0 and enable antsel. -+ // 0x87c[16:15] = b'11, enable antsel, antsel output pin -+ // 0x87c[30] = 0, 0: phy0, 1:phy 1 -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x87c, bMaskDWord, 0x1fff8); -+ -+ // antsel to Bt or Wifi, it depends Bt on/off. -+ // 0x860[9:8] = 'b10, b10:Bt On, WL2G off(default), b01:Bt off, WL2G on. -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x860, BIT9|BIT8, 0x2); -+ -+ // sw/hw control switch, here we set sw control -+ // 0x870[9:8] = 'b11 sw control, 'b00 hw control -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x870, BIT9|BIT8, 0x3); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8192d2ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8192d2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pStackInfo->bProfileNotified) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ -+ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ -+ u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8192d2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ //halbtc8192d2ant_InitCoexDm(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ halbtc8192d2ant_InitCoexDm(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8192d2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ EXhalbtc8192d2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+VOID -+EXhalbtc8192d2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte algorithm; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Periodical!!\n")); -+ -+ // NOTE: -+ // sw mechanism must be done after fw mechanism -+ // -+ if(!halbtc8192d2ant_IsBtCoexistEnter(pBtCoexist)) -+ return; -+ -+ if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_GET_BT_RSSI, NULL); -+ -+ halbtc8192d2ant_MonitorBtState(pBtCoexist); -+ algorithm = halbtc8192d2ant_ActionAlgorithm(pBtCoexist); -+ pCoexDm->curAlgorithm = algorithm; -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8192D_2ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO\n")); -+ halbtc8192d2ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8192D_2ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID\n")); -+ halbtc8192d2ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8192D_2ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP\n")); -+ halbtc8192d2ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8192D_2ANT_COEX_ALGO_PAN: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN\n")); -+ halbtc8192d2ant_ActionPan(pBtCoexist); -+ break; -+ case BT_8192D_2ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP\n")); -+ halbtc8192d2ant_ActionHidA2dp(pBtCoexist); -+ break; -+ case BT_8192D_2ANT_COEX_ALGO_HID_PAN: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+HID\n")); -+ halbtc8192d2ant_ActionHidPan(pBtCoexist); -+ break; -+ case BT_8192D_2ANT_COEX_ALGO_PAN_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP\n")); -+ halbtc8192d2ant_ActionPanA2dp(pBtCoexist); -+ break; -+ default: -+ break; -+ } -+ } -+} -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8192d2Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8192d2Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8192d2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8192d2Ant.h 2017-06-07 23:07:21.008687302 +0300 -@@ -0,0 +1,170 @@ -+//=========================================== -+// The following is for 8192D 2Ant BT Co-exist definition -+//=========================================== -+#define BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT 6 -+ -+typedef enum _BT_INFO_SRC_8192D_2ANT{ -+ BT_INFO_SRC_8192D_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8192D_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8192D_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8192D_2ANT_MAX -+}BT_INFO_SRC_8192D_2ANT,*PBT_INFO_SRC_8192D_2ANT; -+ -+typedef enum _BT_8192D_2ANT_BT_STATUS{ -+ BT_8192D_2ANT_BT_STATUS_IDLE = 0x0, -+ BT_8192D_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8192D_2ANT_BT_STATUS_NON_IDLE = 0x2, -+ BT_8192D_2ANT_BT_STATUS_MAX -+}BT_8192D_2ANT_BT_STATUS,*PBT_8192D_2ANT_BT_STATUS; -+ -+typedef enum _BT_8192D_2ANT_COEX_ALGO{ -+ BT_8192D_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8192D_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8192D_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8192D_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8192D_2ANT_COEX_ALGO_PAN = 0x4, -+ BT_8192D_2ANT_COEX_ALGO_HID_A2DP = 0x5, -+ BT_8192D_2ANT_COEX_ALGO_HID_PAN = 0x6, -+ BT_8192D_2ANT_COEX_ALGO_PAN_A2DP = 0x7, -+ BT_8192D_2ANT_COEX_ALGO_MAX -+}BT_8192D_2ANT_COEX_ALGO,*PBT_8192D_2ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8192D_2ANT{ -+ // fw mechanism -+ BOOLEAN bPreBalanceOn; -+ BOOLEAN bCurBalanceOn; -+ -+ // diminishWifi -+ BOOLEAN bPreDacOn; -+ BOOLEAN bCurDacOn; -+ BOOLEAN bPreInterruptOn; -+ BOOLEAN bCurInterruptOn; -+ u1Byte preFwDacSwingLvl; -+ u1Byte curFwDacSwingLvl; -+ BOOLEAN bPreNavOn; -+ BOOLEAN bCurNavOn; -+ -+ -+ -+ -+ -+ //BOOLEAN bPreDecBtPwr; -+ //BOOLEAN bCurDecBtPwr; -+ -+ //u1Byte preFwDacSwingLvl; -+ //u1Byte curFwDacSwingLvl; -+ //BOOLEAN bCurIgnoreWlanAct; -+ //BOOLEAN bPreIgnoreWlanAct; -+ //u1Byte prePsTdma; -+ //u1Byte curPsTdma; -+ //u1Byte psTdmaPara[5]; -+ //u1Byte psTdmaDuAdjType; -+ //BOOLEAN bResetTdmaAdjust; -+ //BOOLEAN bPrePsTdmaOn; -+ //BOOLEAN bCurPsTdmaOn; -+ //BOOLEAN bPreBtAutoReport; -+ //BOOLEAN bCurBtAutoReport; -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ BOOLEAN bPreDacSwingOn; -+ u4Byte preDacSwingLvl; -+ BOOLEAN bCurDacSwingOn; -+ u4Byte curDacSwingLvl; -+ BOOLEAN bPreAdcBackOff; -+ BOOLEAN bCurAdcBackOff; -+ BOOLEAN bPreAgcTableEn; -+ BOOLEAN bCurAgcTableEn; -+ //u4Byte preVal0x6c0; -+ //u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u4Byte preVal0x6cc; -+ u4Byte curVal0x6cc; -+ //BOOLEAN bLimitedDig; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ //u1Byte btStatus; -+ //u1Byte wifiChnlInfo[3]; -+} COEX_DM_8192D_2ANT, *PCOEX_DM_8192D_2ANT; -+ -+typedef struct _COEX_STA_8192D_2ANT{ -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bBtBusy; -+ BOOLEAN bBtUplink; -+ BOOLEAN bBtDownLink; -+ BOOLEAN bA2dpBusy; -+}COEX_STA_8192D_2ANT, *PCOEX_STA_8192D_2ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8192d2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192d2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8192d2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192d2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192d2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192d2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192d2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192d2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192d2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192d2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192d2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192d2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8192d2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8192e1Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8192e1Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8192e1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8192e1Ant.c 2017-06-07 23:07:21.008687302 +0300 -@@ -0,0 +1,3738 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8192E Co-exist mechanism -+// -+// History -+// 2012/11/15 Cosa first check in. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8192e1Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8192E_1ANT GLCoexDm8192e1Ant; -+static PCOEX_DM_8192E_1ANT pCoexDm=&GLCoexDm8192e1Ant; -+static COEX_STA_8192E_1ANT GLCoexSta8192e1Ant; -+static PCOEX_STA_8192E_1ANT pCoexSta=&GLCoexSta8192e1Ant; -+ -+const char *const GLBtInfoSrc8192e1Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u4Byte GLCoexVerDate8192e1Ant=20140527; -+u4Byte GLCoexVer8192e1Ant=0x4f; -+ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8192e1ant_ -+//============================================================ -+u1Byte -+halbtc8192e1ant_BtRssiState( -+ u1Byte levelNum, -+ u1Byte rssiThresh, -+ u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte btRssi=0; -+ u1Byte btRssiState=pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh1) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+u1Byte -+halbtc8192e1ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+VOID -+halbtc8192e1ant_UpdateRaMask( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte disRateMask -+ ) -+{ -+ pCoexDm->curRaMask = disRateMask; -+ -+ if( bForceExec || (pCoexDm->preRaMask != pCoexDm->curRaMask)) -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_UPDATE_RAMASK, &pCoexDm->curRaMask); -+ } -+ pCoexDm->preRaMask = pCoexDm->curRaMask; -+} -+ -+VOID -+halbtc8192e1ant_AutoRateFallbackRetry( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiUnderBMode=FALSE; -+ -+ pCoexDm->curArfrType = type; -+ -+ if( bForceExec || (pCoexDm->preArfrType != pCoexDm->curArfrType)) -+ { -+ switch(pCoexDm->curArfrType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, pCoexDm->backupArfrCnt1); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, pCoexDm->backupArfrCnt2); -+ break; -+ case 1: -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ if(bWifiUnderBMode) -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x01010101); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preArfrType = pCoexDm->curArfrType; -+} -+ -+VOID -+halbtc8192e1ant_RetryLimit( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curRetryLimitType = type; -+ -+ if( bForceExec || (pCoexDm->preRetryLimitType != pCoexDm->curRetryLimitType)) -+ { -+ switch(pCoexDm->curRetryLimitType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, pCoexDm->backupRetryLimit); -+ break; -+ case 1: // retry limit=8 -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preRetryLimitType = pCoexDm->curRetryLimitType; -+} -+ -+VOID -+halbtc8192e1ant_AmpduMaxTime( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curAmpduTimeType = type; -+ -+ if( bForceExec || (pCoexDm->preAmpduTimeType != pCoexDm->curAmpduTimeType)) -+ { -+ switch(pCoexDm->curAmpduTimeType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, pCoexDm->backupAmpduMaxTime); -+ break; -+ case 1: // AMPDU timw = 0x38 * 32us -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preAmpduTimeType = pCoexDm->curAmpduTimeType; -+} -+ -+VOID -+halbtc8192e1ant_LimitedTx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte raMaskType, -+ IN u1Byte arfrType, -+ IN u1Byte retryLimitType, -+ IN u1Byte ampduTimeType -+ ) -+{ -+ switch(raMaskType) -+ { -+ case 0: // normal mode -+ halbtc8192e1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0); -+ break; -+ case 1: // disable cck 1/2 -+ halbtc8192e1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x00000003); -+ break; -+ case 2: // disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 -+ halbtc8192e1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8192e1ant_AutoRateFallbackRetry(pBtCoexist, bForceExec, arfrType); -+ halbtc8192e1ant_RetryLimit(pBtCoexist, bForceExec, retryLimitType); -+ halbtc8192e1ant_AmpduMaxTime(pBtCoexist, bForceExec, ampduTimeType); -+} -+ -+VOID -+halbtc8192e1ant_LimitedRx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRejApAggPkt, -+ IN BOOLEAN bBtCtrlAggBufSize, -+ IN u1Byte aggBufSize -+ ) -+{ -+ BOOLEAN bRejectRxAgg=bRejApAggPkt; -+ BOOLEAN bBtCtrlRxAggSize=bBtCtrlAggBufSize; -+ u1Byte rxAggSize=aggBufSize; -+ -+ //============================================ -+ // Rx Aggregation related setting -+ //============================================ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg); -+ // decide BT control aggregation buf size or not -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize); -+ // aggregation buf size, only work when BT control Rx aggregation size. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize); -+ // real update aggregation setting -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+VOID -+halbtc8192e1ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = TRUE; -+ -+ H2C_Parameter[0] |= BIT0; // trigger -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x61=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8192e1ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp, u4Tmp1; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp, u1Tmp1; -+ s4Byte wifiRssi; -+ static u1Byte NumOfBtCounterChk = 0; -+ -+ //to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS -+ //if (! (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e) & 0x8) ) -+ -+ if (pCoexSta->bUnderIps) -+ { -+ pCoexSta->highPriorityTx = 65535; -+ pCoexSta->highPriorityRx = 65535; -+ pCoexSta->lowPriorityTx = 65535; -+ pCoexSta->lowPriorityRx = 65535; -+ return; -+ } -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ if( (pCoexSta->lowPriorityTx >= 1050) && (!pCoexSta->bC2hBtInquiryPage)) -+ pCoexSta->popEventCnt++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", -+ regHPRx, regHPTx, regLPRx, regLPTx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+ -+ if ((regHPTx == 0) && (regHPRx ==0) && (regLPTx == 0) && (regLPRx == 0)) -+ { -+ NumOfBtCounterChk++; -+ if (NumOfBtCounterChk >= 3) -+ { -+ halbtc8192e1ant_QueryBtInfo(pBtCoexist); -+ NumOfBtCounterChk = 0; -+ } -+ } -+} -+ -+ -+VOID -+halbtc8192e1ant_MonitorWiFiCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ u2Byte u2Tmp[3]; -+ s4Byte wifiRssi=0; -+ BOOLEAN bWifiBusy = FALSE, bWifiUnderBMode = FALSE; -+ static u1Byte nCCKLockCounter = 0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ -+ if (pCoexSta->bUnderIps) -+ { -+ pCoexSta->nCRCOK_CCK = 0; -+ pCoexSta->nCRCOK_11g = 0; -+ pCoexSta->nCRCOK_11n = 0; -+ pCoexSta->nCRCOK_11nAgg = 0; -+ -+ pCoexSta->nCRCErr_CCK = 0; -+ pCoexSta->nCRCErr_11g = 0; -+ pCoexSta->nCRCErr_11n = 0; -+ pCoexSta->nCRCErr_11nAgg = 0; -+ } -+ else -+ { -+ pCoexSta->nCRCOK_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf88); -+ pCoexSta->nCRCOK_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf94); -+ pCoexSta->nCRCOK_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf90); -+ pCoexSta->nCRCOK_11nAgg= pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfb8); -+ -+ pCoexSta->nCRCErr_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf84); -+ pCoexSta->nCRCErr_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf96); -+ pCoexSta->nCRCErr_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf92); -+ pCoexSta->nCRCErr_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfba); -+ } -+ -+ -+ //reset counter -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x1); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x0); -+ -+ if ( (bWifiBusy) && (wifiRssi >= 30) && (!bWifiUnderBMode)) -+ { -+ if ( (pCoexDm->btStatus == BT_8192E_1ANT_BT_STATUS_ACL_BUSY) || -+ (pCoexDm->btStatus == BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY) || -+ (pCoexDm->btStatus == BT_8192E_1ANT_BT_STATUS_SCO_BUSY) ) -+ { -+ if (pCoexSta->nCRCOK_CCK >(pCoexSta->nCRCOK_11g + pCoexSta->nCRCOK_11n + -+ pCoexSta->nCRCOK_11nAgg) ) -+ { -+ if (nCCKLockCounter < 5) -+ nCCKLockCounter++; -+ } -+ else -+ { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ -+ } -+ else -+ { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ } -+ else -+ { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ -+ if (!pCoexSta->bPreCCKLock) -+ { -+ -+ if (nCCKLockCounter >= 5) -+ pCoexSta->bCCKLock = TRUE; -+ else -+ pCoexSta->bCCKLock = FALSE; -+ } -+ else -+ { -+ if (nCCKLockCounter == 0) -+ pCoexSta->bCCKLock = FALSE; -+ else -+ pCoexSta->bCCKLock = TRUE; -+ } -+ -+ pCoexSta->bPreCCKLock = pCoexSta->bCCKLock; -+ -+ -+} -+ -+BOOLEAN -+halbtc8192e1ant_IsWifiStatusChanged( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreWifiBusy=FALSE, bPreUnder4way=FALSE, bPreBtHsOn=FALSE; -+ BOOLEAN bWifiBusy=FALSE, bUnder4way=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bWifiConnected=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ -+ if(bWifiConnected) -+ { -+ if(bWifiBusy != bPreWifiBusy) -+ { -+ bPreWifiBusy = bWifiBusy; -+ return TRUE; -+ } -+ if(bUnder4way != bPreUnder4way) -+ { -+ bPreUnder4way = bUnder4way; -+ return TRUE; -+ } -+ if(bBtHsOn != bPreBtHsOn) -+ { -+ bPreBtHsOn = bBtHsOn; -+ return TRUE; -+ } -+ } -+ -+ return FALSE; -+} -+ -+VOID -+halbtc8192e1ant_UpdateBtLinkInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pCoexSta->bScoExist; -+ pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist; -+ pBtLinkInfo->bPanExist = pCoexSta->bPanExist; -+ pBtLinkInfo->bHidExist = pCoexSta->bHidExist; -+ -+ // work around for HS mode. -+ if(bBtHsOn) -+ { -+ pBtLinkInfo->bPanExist = TRUE; -+ pBtLinkInfo->bBtLinkExist = TRUE; -+ } -+ -+ // check if Sco only -+ if( pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bScoOnly = TRUE; -+ else -+ pBtLinkInfo->bScoOnly = FALSE; -+ -+ // check if A2dp only -+ if( !pBtLinkInfo->bScoExist && -+ pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bA2dpOnly = TRUE; -+ else -+ pBtLinkInfo->bA2dpOnly = FALSE; -+ -+ // check if Pan only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bPanOnly = TRUE; -+ else -+ pBtLinkInfo->bPanOnly = FALSE; -+ -+ // check if Hid only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bHidOnly = TRUE; -+ else -+ pBtLinkInfo->bHidOnly = FALSE; -+} -+ -+u1Byte -+halbtc8192e1ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ u1Byte algorithm=BT_8192E_1ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!pBtLinkInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No BT link exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pBtLinkInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(numOfDiffProfile == 1) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO only\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID only\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP only\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_A2DP; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = PAN(HS) only\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = PAN(EDR) only\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 2) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_SCO; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + PAN(HS)\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + PAN(EDR)\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + PAN(HS)\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + PAN(EDR)\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP + PAN(HS)\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_A2DP_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP + PAN(EDR)\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_HID; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + PAN(HS)\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile >= 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+VOID -+halbtc8192e1ant_SetBtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = 0; -+ -+ if(bEnableAutoReport) -+ { -+ H2C_Parameter[0] |= BIT0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], BT FW auto report : %s, FW write 0x68=0x%x\n", -+ (bEnableAutoReport? "Enabled!!":"Disabled!!"), H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x68, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8192e1ant_BtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s BT Auto report = %s\n", -+ (bForceExec? "force to":""), ((bEnableAutoReport)? "Enabled":"Disabled"))); -+ pCoexDm->bCurBtAutoReport = bEnableAutoReport; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreBtAutoReport == pCoexDm->bCurBtAutoReport) -+ return; -+ } -+ halbtc8192e1ant_SetBtAutoReport(pBtCoexist, pCoexDm->bCurBtAutoReport); -+ -+ pCoexDm->bPreBtAutoReport = pCoexDm->bCurBtAutoReport; -+} -+ -+VOID -+halbtc8192e1ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte H2C_Parameter[6] ={0}; -+ -+ H2C_Parameter[0] = 0x6; // opCode, 0x6= Retry_Penalty -+ -+ if(bLowPenaltyRa) -+ { -+ H2C_Parameter[1] |= BIT0; -+ H2C_Parameter[2] = 0x00; //normal rate except MCS7/6/5, OFDM54/48/36 -+ H2C_Parameter[3] = 0xf7; //MCS7 or OFDM54 -+ H2C_Parameter[4] = 0xf8; //MCS6 or OFDM48 -+ H2C_Parameter[5] = 0xf9; //MCS5 or OFDM36 -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set WiFi Low-Penalty Retry: %s", -+ (bLowPenaltyRa? "ON!!":"OFF!!") )); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter); -+} -+ -+VOID -+halbtc8192e1ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8192e1ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8192e1ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8192e1ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c4=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c4, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8192e1ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8192e1ant_CoexTableWithType( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** CoexTable(%d) **********\n", type)); -+ -+ pCoexSta->nCoexTableType = type; -+ -+ switch(type) -+ { -+ case 0: -+ halbtc8192e1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x55555555, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8192e1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8192e1ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8192e1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8192e1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8192e1ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0xaa5a5a5a, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8192e1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 7: -+ halbtc8192e1ant_CoexTable(pBtCoexist, bForceExec, 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8192e1ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(bEnable) -+ { -+ H2C_Parameter[0] |= BIT0; // function enable -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8192e1ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8192e1ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8192e1ant_SetLpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ u1Byte lps=lpsVal; -+ u1Byte rpwm=rpwmVal; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+VOID -+halbtc8192e1ant_LpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bForceExecPwrCmd=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set lps/rpwm=0x%x/0x%x \n", -+ (bForceExec? "force to":""), lpsVal, rpwmVal)); -+ pCoexDm->curLps = lpsVal; -+ pCoexDm->curRpwm = rpwmVal; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preLps == pCoexDm->curLps) && -+ (pCoexDm->preRpwm == pCoexDm->curRpwm) ) -+ { -+ return; -+ } -+ } -+ halbtc8192e1ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal); -+ -+ pCoexDm->preLps = pCoexDm->curLps; -+ pCoexDm->preRpwm = pCoexDm->curRpwm; -+} -+ -+VOID -+halbtc8192e1ant_SwMechanism( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRA -+ ) -+{ -+ halbtc8192e1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA); -+} -+ -+VOID -+halbtc8192e1ant_SetAntPath( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte antPosType, -+ IN BOOLEAN bInitHwCfg, -+ IN BOOLEAN bWifiOff -+ ) -+{ -+ u4Byte u4Tmp=0; -+ -+ if(bInitHwCfg) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x944, 0x24); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x930, 0x700700); -+ if(pBtCoexist->chipInterface == BTC_INTF_USB) -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x64, 0x30430004); -+ else -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x64, 0x30030004); -+ -+ // 0x4c[27][24]='00', Set Antenna to BB -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp &= ~BIT24; -+ u4Tmp &= ~BIT27; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ } -+ else if(bWifiOff) -+ { -+ if(pBtCoexist->chipInterface == BTC_INTF_USB) -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x64, 0x30430004); -+ else -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x64, 0x30030004); -+ -+ // 0x4c[27][24]='11', Set Antenna to BT, 0x64[8:7]=0, 0x64[2]=1 -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp |= BIT24; -+ u4Tmp |= BIT27; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ } -+ -+ // ext switch setting -+ switch(antPosType) -+ { -+ case BTC_ANT_PATH_WIFI: -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x92c, 0x4); -+ break; -+ case BTC_ANT_PATH_BT: -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x92c, 0x20); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x92c, 0x4); -+ break; -+ } -+} -+ -+VOID -+halbtc8192e1ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ u1Byte realByte1=byte1, realByte5=byte5; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ if(bApEnable) -+ { -+ if(byte1&BIT4 && !(byte1&BIT5)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FW for 1Ant AP mode\n")); -+ realByte1 &= ~BIT4; -+ realByte1 |= BIT5; -+ -+ realByte5 |= BIT5; -+ realByte5 &= ~BIT6; -+ } -+ } -+ -+ H2C_Parameter[0] = realByte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = realByte5; -+ -+ pCoexDm->psTdmaPara[0] = realByte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = realByte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], PS-TDMA H2C cmd =0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter); -+} -+ -+ -+VOID -+halbtc8192e1ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bTurnOnByCnt=FALSE, bWifiBusy=FALSE, bWiFiNoisy=FALSE; -+ u1Byte psTdmaTypeByCnt=0, rssiAdjustVal=0; -+ u1Byte psTdmaByte4Val = 0x50, psTdmaByte0Val = 0x51, psTdmaByte3Val = 0x10; -+ s1Byte nWiFiDurationAdjust = 0x0; -+ -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if (pCoexDm->bCurPsTdmaOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(on, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(off, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ -+ if (pCoexSta->nScanAPNum <= 5) -+ nWiFiDurationAdjust = 5; -+ else if (pCoexSta->nScanAPNum >= 40) -+ nWiFiDurationAdjust = -15; -+ else if (pCoexSta->nScanAPNum >= 20) -+ nWiFiDurationAdjust = -10; -+ -+ if (!pCoexSta->bForceLpsOn) //only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 -+ { -+ psTdmaByte0Val = 0x61; //no null-pkt -+ psTdmaByte3Val = 0x11; // no tx-pause at BT-slot -+ psTdmaByte4Val = 0x10; // 0x778 = d/1 toggle -+ } -+ -+ if ( (type == 3) || (type == 13) || (type == 14) ) -+ psTdmaByte4Val = psTdmaByte4Val & 0xbf; //no dynamic slot for multi-profile -+ -+ if (pBtLinkInfo->bSlaveRole == TRUE) -+ psTdmaByte4Val = psTdmaByte4Val | 0x1; //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) -+ -+ if(bTurnOn) -+ { -+ switch(type) -+ { -+ default: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x51, 0x1a, 0x1a, 0x0, psTdmaByte4Val); -+ break; -+ case 1: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 2: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x2d+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 3: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x51, 0x1d, 0x1d, 0x0, psTdmaByte4Val); -+ break; -+ case 4: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x93, 0x15, 0x3, 0x14, 0x0); -+ break; -+ case 5: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x61, 0x15, 0x3, 0x11, 0x11); -+ break; -+ case 6: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x61, 0x20, 0x3, 0x11, 0x11); -+ break; -+ case 7: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x13, 0xc, 0x5, 0x0, 0x0); -+ break; -+ case 8: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 9: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 10: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 11: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 12: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x51, 0x0a, 0x0a, 0x0, 0x50); -+ break; -+ case 13: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x51, 0x12, 0x12, 0x0, psTdmaByte4Val); -+ break; -+ case 14: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x51, 0x21, 0x3, 0x10, psTdmaByte4Val); -+ break; -+ case 15: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0x3, 0x8, 0x0); -+ break; -+ case 16: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x93, 0x15, 0x3, 0x10, 0x0); -+ break; -+ case 18: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 20: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x61, 0x3f, 0x03, 0x11, 0x10); -+ break; -+ case 21: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x11); -+ break; -+ case 22: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x10); -+ break; -+ case 23: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x18); -+ break; -+ case 24: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x3, 0x31, 0x18); -+ break; -+ case 25: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 26: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 27: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x98); -+ break; -+ case 28: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x69, 0x25, 0x3, 0x31, 0x0); -+ break; -+ case 29: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0xab, 0x1a, 0x1a, 0x1, 0x10); -+ break; -+ case 30: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x51, 0x30, 0x3, 0x10, 0x10); -+ break; -+ case 31: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0xd3, 0x1a, 0x1a, 0, 0x58); -+ break; -+ case 32: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x61, 0x35, 0x3, 0x11, 0x11); -+ break; -+ case 33: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0xa3, 0x25, 0x3, 0x30, 0x90); -+ break; -+ case 34: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x53, 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 35: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x63, 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 36: -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0xd3, 0x12, 0x3, 0x14, 0x50); -+ break; -+ case 40: // SoftAP only with no sta associated,BT disable ,TDMA mode for power saving -+ /* here softap mode screen off will cost 70-80mA for phone */ -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x23, 0x18, 0x00, 0x10, 0x24); -+ break; -+ } -+ } -+ else -+ { -+ -+ // disable PS tdma -+ switch(type) -+ { -+ case 8: //PTA Control -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x8, 0x0, 0x0, 0x0, 0x0); -+ halbtc8192e1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FALSE, FALSE); -+ break; -+ case 0: -+ default: //Software control, Antenna at BT side -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ halbtc8192e1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FALSE, FALSE); -+ break; -+ case 9: //Software control, Antenna at WiFi side -+ halbtc8192e1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ halbtc8192e1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_WIFI, FALSE, FALSE); -+ break; -+ } -+ } -+ rssiAdjustVal =0; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssiAdjustVal); -+ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", -+ pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948), pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765), pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67))); -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+VOID -+halbtc8192e1ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // sw all off -+ halbtc8192e1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ // hw all off -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+BOOLEAN -+halbtc8192e1ant_IsCommonAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE, bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if(!bWifiConnected && -+ BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n")); -+ -+ //halbtc8192e1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(bWifiConnected && -+ (BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT non connected-idle!!\n")); -+ -+ //halbtc8192e1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(!bWifiConnected && -+ (BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT connected-idle!!\n")); -+ -+ //halbtc8192e1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(bWifiConnected && -+ (BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT connected-idle!!\n")); -+ -+ //halbtc8192e1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(!bWifiConnected && -+ (BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT Busy!!\n")); -+ -+ //halbtc8192e1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ if (bWifiBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n")); -+ } -+ -+ bCommon = FALSE; -+ } -+ -+ return bCommon; -+} -+ -+ -+VOID -+halbtc8192e1ant_TdmaDurationAdjustForAcl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0, btInfoExt; -+ static BOOLEAN bPreWifiBusy=FALSE; -+ BOOLEAN bWifiBusy = FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjustForAcl()\n")); -+ -+ if(BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifiStatus) -+ bWifiBusy = TRUE; -+ else -+ bWifiBusy = FALSE; -+ -+ if( (BT_8192E_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == wifiStatus) || -+ (BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifiStatus) || -+ (BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT == wifiStatus) ) -+ { -+ if( pCoexDm->curPsTdma != 1 && -+ pCoexDm->curPsTdma != 2 && -+ pCoexDm->curPsTdma != 3 && -+ pCoexDm->curPsTdma != 9 ) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ return; -+ } -+ -+ if(!pCoexDm->bAutoTdmaAdjust) -+ { -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if ( (pCoexSta->lowPriorityTx) > 1050 || (pCoexSta->lowPriorityRx) > 1250 ) -+ retryCount++; -+ -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ if(result == -1) -+ { -+ if( (BT_INFO_8192E_1ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 1) ||(pCoexDm->curPsTdma == 2)) ) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ else if(result == 1) -+ { -+ if( (BT_INFO_8192E_1ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 1) ||(pCoexDm->curPsTdma == 2)) ) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ } -+ else //no change -+ { -+ /* Bryant Modify -+ if(bWifiBusy != bPreWifiBusy) //if busy / idle change -+ { -+ bPreWifiBusy = bWifiBusy; -+ halbtc8192e1ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, pCoexDm->curPsTdma); -+ } -+ */ -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], ********** TDMA(on, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ -+ if( pCoexDm->curPsTdma != 1 && -+ pCoexDm->curPsTdma != 2 && -+ pCoexDm->curPsTdma != 9 && -+ pCoexDm->curPsTdma != 11 ) -+ { -+ // recover to previous adjust type -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ } -+} -+ -+VOID -+halbtc8192e1ant_PsTdmaCheckForPowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bNewPsState -+ ) -+{ -+ u1Byte lpsMode=0x0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode); -+ -+ if(lpsMode) // already under LPS state -+ { -+ if(bNewPsState) -+ { -+ // keep state under LPS, do nothing. -+ } -+ else -+ { -+ // will leave LPS state, turn off psTdma first -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ } -+ else // NO PS state -+ { -+ if(bNewPsState) -+ { -+ // will enter LPS state, turn off psTdma first -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ else -+ { -+ // keep state under NO PS state, do nothing. -+ } -+ } -+} -+ -+VOID -+halbtc8192e1ant_PowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte psType, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bLowPwrDisable=FALSE; -+ -+ switch(psType) -+ { -+ case BTC_PS_WIFI_NATIVE: -+ // recover to original 32k low power setting -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8192e1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, TRUE); -+ halbtc8192e1ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal); -+ // when coex force to enter LPS, do not enter 32k low power. -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ // power save must executed before psTdma. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); -+ pCoexSta->bForceLpsOn = TRUE; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8192e1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, FALSE); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8192e1ant_ActionWifiOnly( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+} -+ -+VOID -+halbtc8192e1ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ halbtc8192e1ant_ActionWifiOnly(pBtCoexist); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ bPreBtDisabled = bBtDisabled; -+ if(!bBtDisabled) -+ { -+ } -+ else -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ } -+ } -+} -+ -+//============================================= -+// -+// Software Coex Mechanism start -+// -+//============================================= -+ -+// SCO only or SCO+PAN(HS) -+ -+/* -+VOID -+halbtc8192e1ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8192e1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+ -+VOID -+halbtc8192e1ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8192e1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -+VOID -+halbtc8192e1ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8192e1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8192e1ant_ActionA2dpPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8192e1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8192e1ant_ActionPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8192e1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+//PAN(HS) only -+VOID -+halbtc8192e1ant_ActionPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8192e1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+//PAN(EDR)+A2DP -+VOID -+halbtc8192e1ant_ActionPanEdrA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8192e1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8192e1ant_ActionPanEdrHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8192e1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+// HID+A2DP+PAN(EDR) -+VOID -+halbtc8192e1ant_ActionHidA2dpPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8192e1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+VOID -+halbtc8192e1ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8192e1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+*/ -+ -+//============================================= -+// -+// Non-Software Coex Mechanism start -+// -+//============================================= -+VOID -+halbtc8192e1ant_ActionWifiMultiPort( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+} -+ -+VOID -+halbtc8192e1ant_ActionHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+} -+ -+VOID -+halbtc8192e1ant_ActionBtInquiry( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE, bApEnable=FALSE, bWifiBusy=FALSE, bBtBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ if((!bWifiConnected) && (!pCoexSta->bWiFiIsHighPriTask)) -+ { -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if((pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist) || (pBtLinkInfo->bA2dpExist)) -+ { -+ // SCO/HID/A2DP busy -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if ((pBtLinkInfo->bPanExist) || (bWifiBusy)) -+ { -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+} -+ -+VOID -+halbtc8192e1ant_ActionBtScoHidOnlyBusy( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ // tdma and coex table -+ -+ if(pBtLinkInfo->bScoExist) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+ else //HID -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+} -+ -+VOID -+halbtc8192e1ant_ActionWifiConnectedBtAclBusy( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ u1Byte btRssiState; -+ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ btRssiState = halbtc8192e1ant_BtRssiState(2, 28, 0); -+ -+ if ( (pCoexSta->lowPriorityRx >= 1000) && (pCoexSta->lowPriorityRx != 65535) ) -+ { -+ pBtLinkInfo->bSlaveRole = TRUE; -+ } -+ else -+ { -+ pBtLinkInfo->bSlaveRole = FALSE; -+ } -+ -+ if(pBtLinkInfo->bHidOnly) //HID -+ { -+ halbtc8192e1ant_ActionBtScoHidOnlyBusy(pBtCoexist, wifiStatus); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ return; -+ } -+ else if(pBtLinkInfo->bA2dpOnly) //A2DP -+ { -+ if(BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifiStatus) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else -+ { -+ halbtc8192e1ant_TdmaDurationAdjustForAcl(pBtCoexist, wifiStatus); -+#if 0 -+ if (pCoexSta->bCCKLock) -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ else -+#endif -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ } -+ } -+ else if ( ((pBtLinkInfo->bA2dpExist) && (pBtLinkInfo->bPanExist)) || -+ (pBtLinkInfo->bHidExist&&pBtLinkInfo->bA2dpExist&&pBtLinkInfo->bPanExist) ) //A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else if(pBtLinkInfo->bHidExist&&pBtLinkInfo->bA2dpExist) //HID+A2DP -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ } -+ else if( (pBtLinkInfo->bPanOnly) || (pBtLinkInfo->bHidExist&&pBtLinkInfo->bPanExist) ) //PAN(OPP,FTP), HID+PAN(OPP,FTP) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else -+ { -+ //BT no-profile busy (0x9) -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+} -+ -+VOID -+halbtc8192e1ant_ActionWifiNotConnected( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // power save state -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ halbtc8192e1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8192e1ant_ActionWifiNotConnectedScan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(BT_8192E_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ if (pBtLinkInfo->bA2dpExist) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ } -+ else if( (BT_8192E_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8192e1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } -+ else -+ { -+ //Bryant Add -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8192e1ant_ActionWifiNotConnectedAssoAuth( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if( (pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist) || (pBtLinkInfo->bA2dpExist) ) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bPanExist) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8192e1ant_ActionWifiConnectedScan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(BT_8192E_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ if (pBtLinkInfo->bA2dpExist) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ } -+ else if( (BT_8192E_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8192e1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } -+ else -+ { -+ //Bryant Add -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8192e1ant_ActionWifiConnectedSpecialPacket( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if((pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist) || (pBtLinkInfo->bA2dpExist)) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8192e1ant_ActionWifiConnected( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiBusy=FALSE; -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ BOOLEAN bUnder4way=FALSE, bApEnable=FALSE; -+ u4Byte wifiBw; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect()===>\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ if(bUnder4way) -+ { -+ halbtc8192e1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ if(bScan || bLink || bRoam) -+ { -+ if(bScan) -+ halbtc8192e1ant_ActionWifiConnectedScan(pBtCoexist); -+ else -+ halbtc8192e1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ // power save state -+ if(!bApEnable && BT_8192E_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus && !pBtCoexist->btLinkInfo.bHidOnly) -+ { -+ if(pBtCoexist->btLinkInfo.bA2dpOnly) //A2DP -+ { -+ if(!bWifiBusy) -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else //busy -+ { -+ if (pCoexSta->nScanAPNum >= BT_8192E_1ANT_WIFI_NOISY_THRESH) //no force LPS, no PS-TDMA, use pure TDMA -+ { -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ } -+ } -+ else if ((pCoexSta->bPanExist == FALSE) && (pCoexSta->bA2dpExist == FALSE) && (pCoexSta->bHidExist == FALSE)) -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ else -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(!bWifiBusy) -+ { -+ if(BT_8192E_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ halbtc8192e1ant_ActionWifiConnectedBtAclBusy(pBtCoexist, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } -+ else if( (BT_8192E_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8192e1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } -+ else -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ -+ if ( (pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60 ) -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ else -+ { -+ if(BT_8192E_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ halbtc8192e1ant_ActionWifiConnectedBtAclBusy(pBtCoexist, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } -+ else if( (BT_8192E_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8192e1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } -+ else -+ { -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ -+ if ( (pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60 ) -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+} -+ -+VOID -+halbtc8192e1ant_RunSwCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte algorithm=0; -+ -+ algorithm = halbtc8192e1ant_ActionAlgorithm(pBtCoexist); -+ pCoexDm->curAlgorithm = algorithm; -+ -+ if(halbtc8192e1ant_IsCommonAction(pBtCoexist)) -+ { -+ -+ } -+ else -+ { -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8192E_1ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = SCO.\n")); -+ //halbtc8192e1ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID.\n")); -+ //halbtc8192e1ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = A2DP.\n")); -+ //halbtc8192e1ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_A2DP_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = A2DP+PAN(HS).\n")); -+ //halbtc8192e1ant_ActionA2dpPanHs(pBtCoexist); -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN(EDR).\n")); -+ //halbtc8192e1ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HS mode.\n")); -+ //halbtc8192e1ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_PANEDR_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN+A2DP.\n")); -+ //halbtc8192e1ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_PANEDR_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN(EDR)+HID.\n")); -+ //halbtc8192e1ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID+A2DP+PAN.\n")); -+ //halbtc8192e1ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID+A2DP.\n")); -+ //halbtc8192e1ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = coexist All Off!!\n")); -+ //halbtc8192e1ant_CoexAllOff(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+} -+ -+VOID -+halbtc8192e1ant_RunCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bIncreaseScanDevNum=FALSE; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ BOOLEAN bMiracastPlusBt=FALSE; -+ u1Byte aggBufSize=5; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism()===>\n")); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n")); -+ return; -+ } -+ -+ if(pBtCoexist->bStopCoexDm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n")); -+ return; -+ } -+ -+ if(pCoexSta->bUnderIps) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under IPS !!!\n")); -+ return; -+ } -+ -+ if( (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8192E_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ bIncreaseScanDevNum = TRUE; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, &bIncreaseScanDevNum); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ -+ if((numOfWifiLink>=2) || (wifiLinkStatus&WIFI_P2P_GO_CONNECTED)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], Multi-Port numOfWifiLink = %d, wifiLinkStatus = 0x%x\n", numOfWifiLink,wifiLinkStatus) ); -+ -+ if(pBtLinkInfo->bBtLinkExist) -+ { -+ halbtc8192e1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ bMiracastPlusBt = TRUE; -+ } -+ else -+ { -+ halbtc8192e1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ bMiracastPlusBt = FALSE; -+ } -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ halbtc8192e1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ -+ if ( (pBtLinkInfo->bA2dpExist) && (pCoexSta->bC2hBtInquiryPage) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], BT Is Inquirying \n") ); -+ halbtc8192e1ant_ActionBtInquiry(pBtCoexist); -+ } -+ else -+ halbtc8192e1ant_ActionWifiMultiPort(pBtCoexist); -+ -+ return; -+ } -+ else -+ { -+ bMiracastPlusBt = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ } -+ -+ if ( (pBtLinkInfo->bBtLinkExist) && (bWifiConnected) ) -+ { -+ halbtc8192e1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ -+ if(pBtLinkInfo->bScoExist) -+ halbtc8192e1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x5); -+ else -+ halbtc8192e1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x8); -+ -+ halbtc8192e1ant_SwMechanism(pBtCoexist, TRUE); -+ halbtc8192e1ant_RunSwCoexistMechanism(pBtCoexist); //just print debug message -+ } -+ else -+ { -+ halbtc8192e1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8192e1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x5); -+ -+ halbtc8192e1ant_SwMechanism(pBtCoexist, FALSE); -+ halbtc8192e1ant_RunSwCoexistMechanism(pBtCoexist); ////just print debug message -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], BT Is Inquirying \n") ); -+ halbtc8192e1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8192e1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ -+ if(!bWifiConnected) -+ { -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is non connected-idle !!!\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if(bScan || bLink || bRoam) -+ { -+ if (bScan) -+ halbtc8192e1ant_ActionWifiNotConnectedScan(pBtCoexist); -+ else -+ halbtc8192e1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist); -+ } -+ else -+ halbtc8192e1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else // wifi LPS/Busy -+ { -+ halbtc8192e1ant_ActionWifiConnected(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8192e1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ -+ // sw all off -+ halbtc8192e1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ //halbtc8192e1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ pCoexSta->popEventCnt = 0; -+} -+ -+VOID -+halbtc8192e1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ u4Byte u4Tmp=0; -+ u2Byte u2Tmp=0; -+ u1Byte u1Tmp=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Init HW Config!!\n")); -+ -+ // antenna sw ctrl to bt -+ halbtc8192e1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, TRUE, FALSE); -+ -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ // antenna switch control parameter -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x858, 0x55555555); -+ -+ // coex parameters -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x1); -+ // 0x790[5:0]=0x5 -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x790); -+ u1Tmp &= 0xc0; -+ u1Tmp |= 0x5; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, u1Tmp); -+ -+ // enable counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ // enable PTA -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x20); -+ // enable mailbox interface -+ u2Tmp = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x40); -+ u2Tmp |= BIT9; -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x40, u2Tmp); -+ -+ // enable PTA I2C mailbox -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x101); -+ u1Tmp |= BIT4; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x101, u1Tmp); -+ -+ // enable bt clock when wifi is disabled. -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x93); -+ u1Tmp |= BIT0; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x93, u1Tmp); -+ // enable bt clock when suspend. -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x7); -+ u1Tmp |= BIT0; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x7, u1Tmp); -+} -+ -+ -+/* -+VOID -+halbtc8192e1ant_WifiOffHwCfg( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // set wlan_act to low -+ //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+} -+*/ -+ -+//============================================================ -+// work around function start with wa_halbtc8192e1ant_ -+//============================================================ -+//============================================================ -+// extern function start with EXhalbtc8192e1ant_ -+//============================================================ -+VOID -+EXhalbtc8192e1ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+#if 0 -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u1Byte u1Tmp=0x0; -+ u2Byte u2Tmp=0x0; -+ -+ pBtCoexist->bStopCoexDm = TRUE; -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x67, 0x20); -+ -+ // enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. -+ u2Tmp = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x2); -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x2, u2Tmp|BIT0|BIT1); -+ -+ // set GRAN_BT = 1 -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ // set WLAN_ACT = 0 -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ // -+ // S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) -+ // Local setting bit define -+ // BIT0: "0" for no antenna inverse; "1" for antenna inverse -+ // BIT1: "0" for internal switch; "1" for external switch -+ // BIT2: "0" for one antenna; "1" for two antenna -+ // NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 -+ if(pBtCoexist->chipInterface == BTC_INTF_USB) -+ { -+ // fixed at S0 for USB interface -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ -+ u1Tmp |= 0x1; // antenna inverse -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0xfe08, u1Tmp); -+ -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ else -+ { -+ // for PCIE and SDIO interface, we check efuse 0xc3[6] -+ if(pBoardInfo->singleAntPath == 0) -+ { -+ // set to S1 -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280); -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+ } -+ else if(pBoardInfo->singleAntPath == 1) -+ { -+ // set to S0 -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ u1Tmp |= 0x1; // antenna inverse -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ -+ if(pBtCoexist->chipInterface == BTC_INTF_PCI) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x384, u1Tmp); -+ } -+ else if(pBtCoexist->chipInterface == BTC_INTF_SDIO) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x60, u1Tmp); -+ } -+ } -+#endif -+} -+ -+VOID -+EXhalbtc8192e1ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8192e1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ halbtc8192e1ant_InitHwConfig(pBtCoexist, bWifiOnly); -+ pBtCoexist->bStopCoexDm = FALSE; -+} -+ -+VOID -+EXhalbtc8192e1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ pBtCoexist->bStopCoexDm = FALSE; -+ -+ halbtc8192e1ant_InitCoexDm(pBtCoexist); -+ -+ halbtc8192e1ant_QueryBtInfo(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8192e1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ u4Byte fwVer=0, btPatchVer=0; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ if(pBtCoexist->bStopCoexDm) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", "CoexVer/ FwVer/ PatchVer", \ -+ GLCoexVerDate8192e1Ant, GLCoexVer8192e1Ant, fwVer, btPatchVer, btPatchVer); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ -+ ((pBtCoexist->btInfo.bBtDisabled)? ("disabled"): ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)? "non-connected idle": -+ ( (BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy")))), -+ pCoexSta->btRssi, pCoexSta->btRetryCnt); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pBtLinkInfo->bScoExist, pBtLinkInfo->bHidExist, pBtLinkInfo->bPanExist, pBtLinkInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8192e1Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ if(!pBtCoexist->bManualControl) -+ { -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %d ", "DelBA/ BtCtrlAgg/ AggSize", \ -+ (pBtCoexist->btInfo.bRejectAggPkt? "Yes":"No"), (pBtCoexist->btInfo.bBtCtrlAggBufSize? "Yes":"No"), -+ pBtCoexist->btInfo.aggBufSize); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Rate Mask", \ -+ pBtCoexist->btInfo.raMask); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase, pCoexDm->bAutoTdmaAdjust); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Latest error condition(should be 0)", \ -+ pCoexDm->errorCondition); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", "IgnWlanAct", \ -+ pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ } -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc04); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xd04); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x90c); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0xc04/ 0xd04/ 0x90c", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x778", \ -+ u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x92c); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x930); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x92c/ 0x930", \ -+ (u1Tmp[0]), u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4f); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x40/ 0x4f", \ -+ u1Tmp[0], u1Tmp[1]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770(hp rx[31:16]/tx[15:0])", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(lp rx[31:16]/tx[15:0])", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+#if(BT_AUTO_REPORT_ONLY_8192E_1ANT == 1) -+ halbtc8192e1ant_MonitorBtCtr(pBtCoexist); -+#endif -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+VOID -+EXhalbtc8192e1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u4Byte u4Tmp=0; -+ -+ if(pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm) -+ return; -+ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ pCoexSta->bUnderIps = TRUE; -+ -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8192e1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FALSE, TRUE); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ pCoexSta->bUnderIps = FALSE; -+ -+ halbtc8192e1ant_InitHwConfig(pBtCoexist, FALSE); -+ halbtc8192e1ant_InitCoexDm(pBtCoexist); -+ halbtc8192e1ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8192e1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm) -+ return; -+ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ pCoexSta->bUnderLps = TRUE; -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ pCoexSta->bUnderLps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8192e1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ -+ u1Byte u1Tmpa, u1Tmpb; -+ u4Byte u4Tmp; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm ) -+ return; -+ -+ if(BTC_SCAN_START == type) -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ -+ halbtc8192e1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); //Force antenna setup for no scan result issue -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67); -+ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", -+ u4Tmp, u1Tmpa, u1Tmpb)); -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &pCoexSta->nScanAPNum); -+ } -+ -+ if(pBtCoexist->btInfo.bBtDisabled) -+ return; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ halbtc8192e1ant_QueryBtInfo(pBtCoexist); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8192e1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8192e1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8192e1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8192e1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8192e1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if(BTC_SCAN_START == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8192e1ant_ActionWifiNotConnectedScan(pBtCoexist); -+ } -+ else // wifi is connected -+ { -+ halbtc8192e1ant_ActionWifiConnectedScan(pBtCoexist); -+ } -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8192e1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else -+ { -+ halbtc8192e1ant_ActionWifiConnected(pBtCoexist); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8192e1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ pCoexDm->nArpCnt = 0; -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ //pCoexDm->nArpCnt = 0; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8192e1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8192e1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8192e1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8192e1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8192e1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ halbtc8192e1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8192e1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else -+ { -+ halbtc8192e1ant_ActionWifiConnected(pBtCoexist); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8192e1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ BOOLEAN bWifiUnderBMode = FALSE; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ -+ //Set CCK Tx/Rx high Pri except 11b mode -+ if (bWifiUnderBMode) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x00); //CCK Tx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x00); //CCK Rx -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x10); //CCK Tx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x10); //CCK Rx -+ } -+ -+ pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ pCoexDm->nArpCnt = 0; -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x0); //CCK Tx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x0); //CCK Rx -+ } -+ -+ // only 2.4G we need to inform bt the chnl mask -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if( (BTC_MEDIA_CONNECT == type) && -+ (wifiCentralChnl <= 14) ) -+ { -+ //H2C_Parameter[0] = 0x1; -+ H2C_Parameter[0] = 0x0; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x66=0x%x\n", -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter); -+} -+ -+VOID -+EXhalbtc8192e1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if( BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ BTC_PACKET_ARP == type ) -+ { -+ if(BTC_PACKET_ARP == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet ARP notify\n")); -+ -+ pCoexDm->nArpCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ARP Packet Count = %d\n", pCoexDm->nArpCnt)); -+ -+ if(pCoexDm->nArpCnt >= 10) // if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecialPacket(pBtCoexist) -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ } -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet DHCP or EAPOL notify\n")); -+ } -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet [Type = %d] notify\n", type)); -+ } -+ -+ pCoexSta->specialPktPeriodCnt = 0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8192e1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8192e1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8192e1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8192e1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8192e1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if( BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ ( (BTC_PACKET_ARP == type ) && (pCoexSta->bWiFiIsHighPriTask) ) ) -+ { -+ halbtc8192e1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8192e1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bWifiConnected=FALSE; -+ BOOLEAN bBtBusy=FALSE; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ -+ rspSource = tmpBuf[0]&0xf; -+ if(rspSource >= BT_INFO_SRC_8192E_1ANT_MAX) -+ rspSource = BT_INFO_SRC_8192E_1ANT_WIFI_FW; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 1) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ if(BT_INFO_SRC_8192E_1ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = // [3:0] -+ pCoexSta->btInfoC2h[rspSource][2]&0xf; -+ -+ if (pCoexSta->btRetryCnt >= 1) -+ pCoexSta->popEventCnt++; -+ -+ if (pCoexSta->btInfoC2h[rspSource][2]&0x20) -+ pCoexSta->bC2hBtPage = TRUE; -+ else -+ pCoexSta->bC2hBtPage = FALSE; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][3]*2-90; -+ //pCoexSta->btInfoC2h[rspSource][3]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][4]; -+ -+ pCoexSta->bBtTxRxMask = (pCoexSta->btInfoC2h[rspSource][2]&0x40); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TX_RX_MASK, &pCoexSta->bBtTxRxMask); -+ if(!pCoexSta->bBtTxRxMask) -+ { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n")); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); -+ } -+ -+ // Here we need to resend some wifi info to BT -+ // because bt is reset and loss of the info. -+ if(pCoexSta->btInfoExt & BIT1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(bWifiConnected) -+ { -+ EXhalbtc8192e1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT); -+ } -+ else -+ { -+ EXhalbtc8192e1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ } -+ -+ if(pCoexSta->btInfoExt & BIT3) -+ { -+ if(!pBtCoexist->bManualControl && !pBtCoexist->bStopCoexDm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")); -+ halbtc8192e1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ } -+ } -+ else -+ { -+ // BT already NOT ignore Wlan active, do nothing here. -+ } -+#if(BT_AUTO_REPORT_ONLY_8192E_1ANT == 0) -+ if( (pCoexSta->btInfoExt & BIT4) ) -+ { -+ // BT auto report already enabled, do nothing -+ } -+ else -+ { -+ halbtc8192e1ant_BtAutoReport(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+#endif -+ } -+ -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8192E_1ANT_B_INQ_PAGE) -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ else -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ -+ // set link exist status -+ if(!(btInfo&BT_INFO_8192E_1ANT_B_CONNECTION)) -+ { -+ pCoexSta->bBtLinkExist = FALSE; -+ pCoexSta->bPanExist = FALSE; -+ pCoexSta->bA2dpExist = FALSE; -+ pCoexSta->bHidExist = FALSE; -+ pCoexSta->bScoExist = FALSE; -+ } -+ else // connection exists -+ { -+ pCoexSta->bBtLinkExist = TRUE; -+ if(btInfo & BT_INFO_8192E_1ANT_B_FTP) -+ pCoexSta->bPanExist = TRUE; -+ else -+ pCoexSta->bPanExist = FALSE; -+ if(btInfo & BT_INFO_8192E_1ANT_B_A2DP) -+ pCoexSta->bA2dpExist = TRUE; -+ else -+ pCoexSta->bA2dpExist = FALSE; -+ if(btInfo & BT_INFO_8192E_1ANT_B_HID) -+ pCoexSta->bHidExist = TRUE; -+ else -+ pCoexSta->bHidExist = FALSE; -+ if(btInfo & BT_INFO_8192E_1ANT_B_SCO_ESCO) -+ pCoexSta->bScoExist = TRUE; -+ else -+ pCoexSta->bScoExist = FALSE; -+ } -+ -+ halbtc8192e1ant_UpdateBtLinkInfo(pBtCoexist); -+ -+ btInfo = btInfo & 0x1f; //mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) -+ -+ if(!(btInfo&BT_INFO_8192E_1ANT_B_CONNECTION)) -+ { -+ pCoexDm->btStatus = BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n")); -+ } -+ else if(btInfo == BT_INFO_8192E_1ANT_B_CONNECTION) // connection exists but no busy -+ { -+ pCoexDm->btStatus = BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n")); -+ } -+ else if((btInfo&BT_INFO_8192E_1ANT_B_SCO_ESCO) || -+ (btInfo&BT_INFO_8192E_1ANT_B_SCO_BUSY)) -+ { -+ pCoexDm->btStatus = BT_8192E_1ANT_BT_STATUS_SCO_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n")); -+ } -+ else if(btInfo&BT_INFO_8192E_1ANT_B_ACL_BUSY) -+ { -+ if(BT_8192E_1ANT_BT_STATUS_ACL_BUSY != pCoexDm->btStatus) -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->btStatus = BT_8192E_1ANT_BT_STATUS_ACL_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n")); -+ } -+ else -+ { -+ pCoexDm->btStatus = BT_8192E_1ANT_BT_STATUS_MAX; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n")); -+ } -+ -+ if( (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8192E_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ bBtBusy = TRUE; -+ else -+ bBtBusy = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ halbtc8192e1ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8192e1ant_RfStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u4Byte u4Tmp; -+ u1Byte u1Tmpa,u1Tmpb, u1Tmpc; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF Status notify\n")); -+ -+ if(BTC_RF_ON == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF is turned ON!!\n")); -+ pBtCoexist->bStopCoexDm = FALSE; -+ } -+ else if(BTC_RF_OFF == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF is turned OFF!!\n")); -+ -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8192e1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FALSE, TRUE); -+ -+ halbtc8192e1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ pBtCoexist->bStopCoexDm = TRUE; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67); -+ u1Tmpc = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e); -+ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x, 0x76e=0x%x\n", -+ u4Tmp, u1Tmpa, u1Tmpb, u1Tmpc)); -+ -+ } -+} -+ -+VOID -+EXhalbtc8192e1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8192e1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FALSE, TRUE); -+ -+ halbtc8192e1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ -+ EXhalbtc8192e1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ -+ pBtCoexist->bStopCoexDm = TRUE; -+} -+ -+VOID -+EXhalbtc8192e1ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify\n")); -+ -+ if(BTC_WIFI_PNP_SLEEP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to SLEEP\n")); -+ -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8192e1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ halbtc8192e1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FALSE, TRUE); -+ -+ pBtCoexist->bStopCoexDm = TRUE; -+ } -+ else if(BTC_WIFI_PNP_WAKE_UP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to WAKE UP\n")); -+ pBtCoexist->bStopCoexDm = FALSE; -+ halbtc8192e1ant_InitHwConfig(pBtCoexist, FALSE); -+ halbtc8192e1ant_InitCoexDm(pBtCoexist); -+ halbtc8192e1ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8192e1ant_CoexDmReset( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], *****************Coex DM Reset*****************\n")); -+ -+ halbtc8192e1ant_InitHwConfig(pBtCoexist, FALSE); -+ //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x2, 0xfffff, 0x0); -+ halbtc8192e1ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8192e1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static u1Byte disVerInfoCnt=0; -+ u4Byte fwVer=0, btPatchVer=0; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ==========================Periodical===========================\n")); -+ -+ if(disVerInfoCnt <= 5) -+ { -+ disVerInfoCnt += 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ant PG Num/ Ant Mech/ Ant Pos = %d/ %d/ %d\n", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT stack/ hci ext ver = %s / %d\n", -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion)); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", -+ GLCoexVerDate8192e1Ant, GLCoexVer8192e1Ant, fwVer, btPatchVer, btPatchVer)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ } -+ -+#if(BT_AUTO_REPORT_ONLY_8192E_1ANT == 0) -+ halbtc8192e1ant_QueryBtInfo(pBtCoexist); -+ halbtc8192e1ant_MonitorBtEnableDisable(pBtCoexist); -+#else -+ halbtc8192e1ant_MonitorBtCtr(pBtCoexist); -+ halbtc8192e1ant_MonitorWiFiCtr(pBtCoexist); -+ -+ if( halbtc8192e1ant_IsWifiStatusChanged(pBtCoexist) || -+ pCoexDm->bAutoTdmaAdjust ) -+ { -+ -+ halbtc8192e1ant_RunCoexistMechanism(pBtCoexist); -+ } -+ -+ pCoexSta->specialPktPeriodCnt++; -+#endif -+} -+ -+ -+VOID -+EXhalbtc8192e1ant_DbgControl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte opCode, -+ IN u1Byte opLen, -+ IN pu1Byte pData -+ ) -+{ -+ switch(opCode) -+ { -+ case BTC_DBG_SET_COEX_NORMAL: -+ pBtCoexist->bManualControl = FALSE; -+ halbtc8192e1ant_InitCoexDm(pBtCoexist); -+ break; -+ case BTC_DBG_SET_COEX_WIFI_ONLY: -+ pBtCoexist->bManualControl = TRUE; -+ halbtc8192e1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+ break; -+ case BTC_DBG_SET_COEX_BT_ONLY: -+ // todo -+ break; -+ default: -+ break; -+ } -+} -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8192e1Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8192e1Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8192e1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8192e1Ant.h 2017-06-07 23:07:21.008687302 +0300 -@@ -0,0 +1,254 @@ -+//=========================================== -+// The following is for 8192E 1ANT BT Co-exist definition -+//=========================================== -+#define BT_AUTO_REPORT_ONLY_8192E_1ANT 1 -+ -+#define BT_INFO_8192E_1ANT_B_FTP BIT7 -+#define BT_INFO_8192E_1ANT_B_A2DP BIT6 -+#define BT_INFO_8192E_1ANT_B_HID BIT5 -+#define BT_INFO_8192E_1ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8192E_1ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8192E_1ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8192E_1ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8192E_1ANT_B_CONNECTION BIT0 -+ -+#define BT_INFO_8192E_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT0))? TRUE:FALSE) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT 2 -+ -+#define BT_8192E_1ANT_WIFI_NOISY_THRESH 30 //max: 255 -+ -+typedef enum _BT_INFO_SRC_8192E_1ANT{ -+ BT_INFO_SRC_8192E_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8192E_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8192E_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8192E_1ANT_MAX -+}BT_INFO_SRC_8192E_1ANT,*PBT_INFO_SRC_8192E_1ANT; -+ -+typedef enum _BT_8192E_1ANT_BT_STATUS{ -+ BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8192E_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8192E_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8192E_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8192E_1ANT_BT_STATUS_MAX -+}BT_8192E_1ANT_BT_STATUS,*PBT_8192E_1ANT_BT_STATUS; -+ -+typedef enum _BT_8192E_1ANT_WIFI_STATUS{ -+ BT_8192E_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8192E_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT = 0x3, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8192E_1ANT_WIFI_STATUS_MAX -+}BT_8192E_1ANT_WIFI_STATUS,*PBT_8192E_1ANT_WIFI_STATUS; -+ -+typedef enum _BT_8192E_1ANT_COEX_ALGO{ -+ BT_8192E_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8192E_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8192E_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8192E_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8192E_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8192E_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8192E_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8192E_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8192E_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8192E_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8192E_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8192E_1ANT_COEX_ALGO_MAX = 0xb, -+}BT_8192E_1ANT_COEX_ALGO,*PBT_8192E_1ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8192E_1ANT{ -+ // fw mechanism -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ BOOLEAN bAutoTdmaAdjust; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ BOOLEAN bPreBtAutoReport; -+ BOOLEAN bCurBtAutoReport; -+ u1Byte preLps; -+ u1Byte curLps; -+ u1Byte preRpwm; -+ u1Byte curRpwm; -+ -+ // sw mechanism -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ -+ u4Byte backupArfrCnt1; // Auto Rate Fallback Retry cnt -+ u4Byte backupArfrCnt2; // Auto Rate Fallback Retry cnt -+ u2Byte backupRetryLimit; -+ u1Byte backupAmpduMaxTime; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+ -+ u4Byte preRaMask; -+ u4Byte curRaMask; -+ u1Byte preArfrType; -+ u1Byte curArfrType; -+ u1Byte preRetryLimitType; -+ u1Byte curRetryLimitType; -+ u1Byte preAmpduTimeType; -+ u1Byte curAmpduTimeType; -+ u4Byte nArpCnt; -+ -+ u1Byte errorCondition; -+} COEX_DM_8192E_1ANT, *PCOEX_DM_8192E_1ANT; -+ -+typedef struct _COEX_STA_8192E_1ANT{ -+ BOOLEAN bBtLinkExist; -+ BOOLEAN bScoExist; -+ BOOLEAN bA2dpExist; -+ BOOLEAN bHidExist; -+ BOOLEAN bPanExist; -+ -+ BOOLEAN bUnderLps; -+ BOOLEAN bUnderIps; -+ u4Byte specialPktPeriodCnt; -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ s1Byte btRssi; -+ BOOLEAN bBtTxRxMask; -+ u1Byte preBtRssiState; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8192E_1ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8192E_1ANT_MAX]; -+ BOOLEAN bC2hBtInquiryPage; -+ BOOLEAN bC2hBtPage; //Add for win8.1 page out issue -+ BOOLEAN bWiFiIsHighPriTask; //Add for win8.1 page out issue -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+ u4Byte popEventCnt; -+ u1Byte nScanAPNum; -+ -+ u4Byte nCRCOK_CCK; -+ u4Byte nCRCOK_11g; -+ u4Byte nCRCOK_11n; -+ u4Byte nCRCOK_11nAgg; -+ -+ u4Byte nCRCErr_CCK; -+ u4Byte nCRCErr_11g; -+ u4Byte nCRCErr_11n; -+ u4Byte nCRCErr_11nAgg; -+ -+ BOOLEAN bCCKLock; -+ BOOLEAN bPreCCKLock; -+ u1Byte nCoexTableType; -+ -+ BOOLEAN bForceLpsOn; -+}COEX_STA_8192E_1ANT, *PCOEX_STA_8192E_1ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8192e1ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192e1ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192e1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8192e1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192e1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192e1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192e1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192e1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192e1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192e1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192e1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8192e1ant_RfStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192e1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192e1ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ); -+VOID -+EXhalbtc8192e1ant_CoexDmReset( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192e1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192e1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192e1ant_DbgControl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte opCode, -+ IN u1Byte opLen, -+ IN pu1Byte pData -+ ); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8192e2Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8192e2Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8192e2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8192e2Ant.c 2017-06-07 23:07:21.008687302 +0300 -@@ -0,0 +1,5027 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8192E Co-exist mechanism -+// -+// History -+// 2012/11/15 Cosa first check in. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8192E_2ANT GLCoexDm8192e2Ant; -+static PCOEX_DM_8192E_2ANT pCoexDm=&GLCoexDm8192e2Ant; -+static COEX_STA_8192E_2ANT GLCoexSta8192e2Ant; -+static PCOEX_STA_8192E_2ANT pCoexSta=&GLCoexSta8192e2Ant; -+ -+const char *const GLBtInfoSrc8192e2Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u4Byte GLCoexVerDate8192e2Ant=20150615; -+u4Byte GLCoexVer8192e2Ant=0x41; -+ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8192e2ant_ -+//============================================================ -+u1Byte -+halbtc8192e2ant_BtRssiState( -+ u1Byte levelNum, -+ u1Byte rssiThresh, -+ u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte btRssi=0; -+ u1Byte btRssiState=pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh1) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+u1Byte -+halbtc8192e2ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+VOID -+halbtc8192e2ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ bPreBtDisabled = bBtDisabled; -+ if(!bBtDisabled) -+ { -+ } -+ else -+ { -+ } -+ } -+} -+ -+u4Byte -+halbtc8192e2ant_DecideRaMask( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte ssType, -+ IN u4Byte raMaskType -+ ) -+{ -+ u4Byte disRaMask=0x0; -+ -+ switch(raMaskType) -+ { -+ case 0: // normal mode -+ if(ssType == 2) -+ disRaMask = 0x0; // enable 2ss -+ else -+ disRaMask = 0xfff00000; // disable 2ss -+ break; -+ case 1: // disable cck 1/2 -+ if(ssType == 2) -+ disRaMask = 0x00000003; // enable 2ss -+ else -+ disRaMask = 0xfff00003; // disable 2ss -+ break; -+ case 2: // disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 -+ if(ssType == 2) -+ disRaMask = 0x0001f1f7; // enable 2ss -+ else -+ disRaMask = 0xfff1f1f7; // disable 2ss -+ break; -+ default: -+ break; -+ } -+ -+ return disRaMask; -+} -+ -+VOID -+halbtc8192e2ant_UpdateRaMask( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte disRateMask -+ ) -+{ -+ pCoexDm->curRaMask = disRateMask; -+ -+ if( bForceExec || (pCoexDm->preRaMask != pCoexDm->curRaMask)) -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_UPDATE_RAMASK, &pCoexDm->curRaMask); -+ } -+ pCoexDm->preRaMask = pCoexDm->curRaMask; -+} -+ -+VOID -+halbtc8192e2ant_AutoRateFallbackRetry( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiUnderBMode=FALSE; -+ -+ pCoexDm->curArfrType = type; -+ -+ if( bForceExec || (pCoexDm->preArfrType != pCoexDm->curArfrType)) -+ { -+ switch(pCoexDm->curArfrType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, pCoexDm->backupArfrCnt1); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, pCoexDm->backupArfrCnt2); -+ break; -+ case 1: -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ if(bWifiUnderBMode) -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x01010101); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preArfrType = pCoexDm->curArfrType; -+} -+ -+VOID -+halbtc8192e2ant_RetryLimit( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curRetryLimitType = type; -+ -+ if( bForceExec || (pCoexDm->preRetryLimitType != pCoexDm->curRetryLimitType)) -+ { -+ switch(pCoexDm->curRetryLimitType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, pCoexDm->backupRetryLimit); -+ break; -+ case 1: // retry limit=8 -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preRetryLimitType = pCoexDm->curRetryLimitType; -+} -+ -+VOID -+halbtc8192e2ant_AmpduMaxTime( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curAmpduTimeType = type; -+ -+ if( bForceExec || (pCoexDm->preAmpduTimeType != pCoexDm->curAmpduTimeType)) -+ { -+ switch(pCoexDm->curAmpduTimeType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, pCoexDm->backupAmpduMaxTime); -+ break; -+ case 1: // AMPDU timw = 0x38 * 32us -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preAmpduTimeType = pCoexDm->curAmpduTimeType; -+} -+ -+VOID -+halbtc8192e2ant_LimitedTx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte raMaskType, -+ IN u1Byte arfrType, -+ IN u1Byte retryLimitType, -+ IN u1Byte ampduTimeType -+ ) -+{ -+ u4Byte disRaMask=0x0; -+ -+ pCoexDm->curRaMaskType = raMaskType; -+ disRaMask = halbtc8192e2ant_DecideRaMask(pBtCoexist, pCoexDm->curSsType, raMaskType); -+ halbtc8192e2ant_UpdateRaMask(pBtCoexist, bForceExec, disRaMask); -+ -+ halbtc8192e2ant_AutoRateFallbackRetry(pBtCoexist, bForceExec, arfrType); -+ halbtc8192e2ant_RetryLimit(pBtCoexist, bForceExec, retryLimitType); -+ halbtc8192e2ant_AmpduMaxTime(pBtCoexist, bForceExec, ampduTimeType); -+} -+ -+VOID -+halbtc8192e2ant_LimitedRx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRejApAggPkt, -+ IN BOOLEAN bBtCtrlAggBufSize, -+ IN u1Byte aggBufSize -+ ) -+{ -+ BOOLEAN bRejectRxAgg=bRejApAggPkt; -+ BOOLEAN bBtCtrlRxAggSize=bBtCtrlAggBufSize; -+ u1Byte rxAggSize=aggBufSize; -+ -+ //============================================ -+ // Rx Aggregation related setting -+ //============================================ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg); -+ // decide BT control aggregation buf size or not -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize); -+ // aggregation buf size, only work when BT control Rx aggregation size. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize); -+ // real update aggregation setting -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+VOID -+halbtc8192e2ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp; -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+} -+ -+VOID -+halbtc8192e2ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = TRUE; -+ -+ H2C_Parameter[0] |= BIT0; // trigger -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x61=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter); -+} -+ -+BOOLEAN -+halbtc8192e2ant_IsWifiStatusChanged( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreWifiBusy=FALSE, bPreUnder4way=FALSE, bPreBtHsOn=FALSE; -+ BOOLEAN bWifiBusy=FALSE, bUnder4way=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bWifiConnected=FALSE; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ -+ if(bWifiConnected) -+ { -+ if(bWifiBusy != bPreWifiBusy) -+ { -+ bPreWifiBusy = bWifiBusy; -+ return TRUE; -+ } -+ if(bUnder4way != bPreUnder4way) -+ { -+ bPreUnder4way = bUnder4way; -+ return TRUE; -+ } -+ if(bBtHsOn != bPreBtHsOn) -+ { -+ bPreBtHsOn = bBtHsOn; -+ return TRUE; -+ } -+ -+ -+ wifiRssiState = halbtc8192e2ant_WifiRssiState(pBtCoexist,3, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ -+ if ( (BTC_RSSI_STATE_HIGH ==wifiRssiState ) || (BTC_RSSI_STATE_LOW ==wifiRssiState )) -+ { -+ return TRUE; -+ } -+ -+ } -+ -+ return FALSE; -+} -+ -+VOID -+halbtc8192e2ant_UpdateBtLinkInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pCoexSta->bScoExist; -+ pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist; -+ pBtLinkInfo->bPanExist = pCoexSta->bPanExist; -+ pBtLinkInfo->bHidExist = pCoexSta->bHidExist; -+ -+ // work around for HS mode. -+ if(bBtHsOn) -+ { -+ pBtLinkInfo->bPanExist = TRUE; -+ pBtLinkInfo->bBtLinkExist = TRUE; -+ } -+ -+ // check if Sco only -+ if( pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bScoOnly = TRUE; -+ else -+ pBtLinkInfo->bScoOnly = FALSE; -+ -+ // check if A2dp only -+ if( !pBtLinkInfo->bScoExist && -+ pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bA2dpOnly = TRUE; -+ else -+ pBtLinkInfo->bA2dpOnly = FALSE; -+ -+ // check if Pan only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bPanOnly = TRUE; -+ else -+ pBtLinkInfo->bPanOnly = FALSE; -+ -+ // check if Hid only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bHidOnly = TRUE; -+ else -+ pBtLinkInfo->bHidOnly = FALSE; -+} -+ -+u1Byte -+halbtc8192e2ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ u1Byte algorithm=BT_8192E_2ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!pBtLinkInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No BT link exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pBtLinkInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ -+ if(numOfDiffProfile == 1) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO only\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_A2DP; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(HS) only\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(EDR) only\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 2) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(HS)\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(EDR)\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO_PAN; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(pStackInfo->numOfHid >= 2) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID*2 + A2DP\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(HS)\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_HID; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(EDR)\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(HS)\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_A2DP_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(EDR)\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP ==> HID\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(HS)\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(EDR)\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO_PAN; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile >= 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+VOID -+halbtc8192e2ant_SetFwDacSwingLevel( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte dacSwingLvl -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ // There are several type of dacswing -+ // 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 -+ H2C_Parameter[0] = dacSwingLvl; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Set Dac Swing Level=0x%x\n", dacSwingLvl)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x64=0x%x\n", H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x64, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8192e2ant_SetFwDecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte decBtPwrLvl -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = decBtPwrLvl; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], decrease Bt Power level = %d, FW write 0x62=0x%x\n", -+ decBtPwrLvl, H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x62, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8192e2ant_DecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte decBtPwrLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s Dec BT power level = %d\n", -+ (bForceExec? "force to":""), decBtPwrLvl)); -+ pCoexDm->curBtDecPwrLvl = decBtPwrLvl; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], preBtDecPwrLvl=%d, curBtDecPwrLvl=%d\n", -+ pCoexDm->preBtDecPwrLvl, pCoexDm->curBtDecPwrLvl)); -+#if 0 // work around, avoid h2c command fail. -+ if(pCoexDm->preBtDecPwrLvl == pCoexDm->curBtDecPwrLvl) -+ return; -+#endif -+ } -+ halbtc8192e2ant_SetFwDecBtPwr(pBtCoexist, pCoexDm->curBtDecPwrLvl); -+ -+ pCoexDm->preBtDecPwrLvl = pCoexDm->curBtDecPwrLvl; -+} -+ -+VOID -+halbtc8192e2ant_SetBtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = 0; -+ -+ if(bEnableAutoReport) -+ { -+ H2C_Parameter[0] |= BIT0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], BT FW auto report : %s, FW write 0x68=0x%x\n", -+ (bEnableAutoReport? "Enabled!!":"Disabled!!"), H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x68, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8192e2ant_BtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s BT Auto report = %s\n", -+ (bForceExec? "force to":""), ((bEnableAutoReport)? "Enabled":"Disabled"))); -+ pCoexDm->bCurBtAutoReport = bEnableAutoReport; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bPreBtAutoReport=%d, bCurBtAutoReport=%d\n", -+ pCoexDm->bPreBtAutoReport, pCoexDm->bCurBtAutoReport)); -+ -+ if(pCoexDm->bPreBtAutoReport == pCoexDm->bCurBtAutoReport) -+ return; -+ } -+ halbtc8192e2ant_SetBtAutoReport(pBtCoexist, pCoexDm->bCurBtAutoReport); -+ -+ pCoexDm->bPreBtAutoReport = pCoexDm->bCurBtAutoReport; -+} -+ -+VOID -+halbtc8192e2ant_FwDacSwingLvl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte fwDacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set FW Dac Swing level = %d\n", -+ (bForceExec? "force to":""), fwDacSwingLvl)); -+ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], preFwDacSwingLvl=%d, curFwDacSwingLvl=%d\n", -+ pCoexDm->preFwDacSwingLvl, pCoexDm->curFwDacSwingLvl)); -+ -+ if(pCoexDm->preFwDacSwingLvl == pCoexDm->curFwDacSwingLvl) -+ return; -+ } -+ -+ halbtc8192e2ant_SetFwDacSwingLevel(pBtCoexist, pCoexDm->curFwDacSwingLvl); -+ -+ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -+} -+ -+VOID -+halbtc8192e2ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xffffc); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+VOID -+halbtc8192e2ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bPreRfRxLpfShrink=%d, bCurRfRxLpfShrink=%d\n", -+ pCoexDm->bPreRfRxLpfShrink, pCoexDm->bCurRfRxLpfShrink)); -+ -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8192e2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8192e2ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte H2C_Parameter[6] ={0}; -+ -+ H2C_Parameter[0] = 0x6; // opCode, 0x6= Retry_Penalty -+ -+ if(bLowPenaltyRa) -+ { -+ H2C_Parameter[1] |= BIT0; -+ H2C_Parameter[2] = 0x00; //normal rate except MCS7/6/5, OFDM54/48/36 -+ H2C_Parameter[3] = 0xf7; //MCS7 or OFDM54 -+ H2C_Parameter[4] = 0xf8; //MCS6 or OFDM48 -+ H2C_Parameter[5] = 0xf9; //MCS5 or OFDM36 -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set WiFi Low-Penalty Retry: %s", -+ (bLowPenaltyRa? "ON!!":"OFF!!")) ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter); -+} -+ -+VOID -+halbtc8192e2ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ //return; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bPreLowPenaltyRa=%d, bCurLowPenaltyRa=%d\n", -+ pCoexDm->bPreLowPenaltyRa, pCoexDm->bCurLowPenaltyRa)); -+ -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8192e2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8192e2ant_SetDacSwingReg( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte level -+ ) -+{ -+ u1Byte val=(u1Byte)level; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Write SwDacSwing = 0x%x\n", level)); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x883, 0x3e, val); -+} -+ -+VOID -+halbtc8192e2ant_SetSwFullTimeDacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSwDacSwingOn, -+ IN u4Byte swDacSwingLvl -+ ) -+{ -+ if(bSwDacSwingOn) -+ { -+ halbtc8192e2ant_SetDacSwingReg(pBtCoexist, swDacSwingLvl); -+ } -+ else -+ { -+ halbtc8192e2ant_SetDacSwingReg(pBtCoexist, 0x18); -+ } -+} -+ -+ -+VOID -+halbtc8192e2ant_DacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacSwingOn, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", -+ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); -+ pCoexDm->bCurDacSwingOn = bDacSwingOn; -+ pCoexDm->curDacSwingLvl = dacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bPreDacSwingOn=%d, preDacSwingLvl=0x%x, bCurDacSwingOn=%d, curDacSwingLvl=0x%x\n", -+ pCoexDm->bPreDacSwingOn, pCoexDm->preDacSwingLvl, -+ pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl)); -+ -+ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && -+ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) -+ return; -+ } -+ delay_ms(30); -+ halbtc8192e2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); -+ -+ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; -+ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -+} -+ -+VOID -+halbtc8192e2ant_SetAdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ if(bAdcBackOff) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xc05, 0x30, 0x3); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xc05, 0x30, 0x1); -+ } -+} -+ -+VOID -+halbtc8192e2ant_AdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", -+ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); -+ pCoexDm->bCurAdcBackOff = bAdcBackOff; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bPreAdcBackOff=%d, bCurAdcBackOff=%d\n", -+ pCoexDm->bPreAdcBackOff, pCoexDm->bCurAdcBackOff)); -+ -+ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) -+ return; -+ } -+ halbtc8192e2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); -+ -+ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -+} -+ -+VOID -+halbtc8192e2ant_SetAgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ u1Byte rssiAdjustVal=0; -+ -+ //=================BB AGC Gain Table -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB Agc Table On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x0a1A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x091B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x081C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x071D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x061E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x051F0001); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB Agc Table Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xaa1A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa91B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa81C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa71D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa61E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa51F0001); -+ } -+ -+#if 0 -+ //=================RF Gain -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x38fff); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x38ffe); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x380c3); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x28ce6); -+ } -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xed, 0xfffff, 0x1); -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x38fff); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x38ffe); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x380c3); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x28ce6); -+ } -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xed, 0xfffff, 0x0); -+ -+ // set rssiAdjustVal for wifi module. -+ if(bAgcTableEn) -+ { -+ rssiAdjustVal = 8; -+ } -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -+#endif -+ -+} -+ -+VOID -+halbtc8192e2ant_AgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", -+ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); -+ pCoexDm->bCurAgcTableEn = bAgcTableEn; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bPreAgcTableEn=%d, bCurAgcTableEn=%d\n", -+ pCoexDm->bPreAgcTableEn, pCoexDm->bCurAgcTableEn)); -+ -+ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) -+ return; -+ } -+ halbtc8192e2ant_SetAgcTable(pBtCoexist, bAgcTableEn); -+ -+ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -+} -+ -+VOID -+halbtc8192e2ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8192e2ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c4, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], preVal0x6c0=0x%x, preVal0x6c4=0x%x, preVal0x6c8=0x%x, preVal0x6cc=0x%x !!\n", -+ pCoexDm->preVal0x6c0, pCoexDm->preVal0x6c4, pCoexDm->preVal0x6c8, pCoexDm->preVal0x6cc)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], curVal0x6c0=0x%x, curVal0x6c4=0x%x, curVal0x6c8=0x%x, curVal0x6cc=0x%x !!\n", -+ pCoexDm->curVal0x6c0, pCoexDm->curVal0x6c4, pCoexDm->curVal0x6c8, pCoexDm->curVal0x6cc)); -+ -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8192e2ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8192e2ant_CoexTableWithType( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexSta->nCoexTableType = type; -+ -+ switch(type) -+ { -+ case 0: -+ halbtc8192e2ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8192e2ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8192e2ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5ffb5ffb, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8192e2ant_CoexTable(pBtCoexist, bForceExec, 0x5fdf5fdf, 0x5fdb5fdb, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8192e2ant_CoexTable(pBtCoexist, bForceExec, 0xdfffdfff, 0x5ffb5ffb, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8192e2ant_CoexTable(pBtCoexist, bForceExec, 0x5ddd5ddd, 0x5fdb5fdb, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8192e2ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 7: -+ if(pCoexSta->nScanAPNum <= NOISY_AP_NUM_THRESH) -+ halbtc8192e2ant_CoexTable(pBtCoexist, bForceExec, 0xffffffff, 0xfafafafa, 0xffffff, 0x3); -+ else -+ halbtc8192e2ant_CoexTable(pBtCoexist, bForceExec, 0xffffffff, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 8: -+ halbtc8192e2ant_CoexTable(pBtCoexist, bForceExec, 0x5f5f5f5f, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8192e2ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(bEnable) -+ { -+ H2C_Parameter[0] |= BIT0; // function enable -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter); -+} -+ -+ -+VOID -+halbtc8192e2ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bPreIgnoreWlanAct = %d, bCurIgnoreWlanAct = %d!!\n", -+ pCoexDm->bPreIgnoreWlanAct, pCoexDm->bCurIgnoreWlanAct)); -+ -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8192e2ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+ -+VOID -+halbtc8192e2ant_SetLpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ u1Byte lps=lpsVal; -+ u1Byte rpwm=rpwmVal; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+ -+VOID -+halbtc8192e2ant_LpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bForceExecPwrCmd=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set lps/rpwm=0x%x/0x%x \n", -+ (bForceExec? "force to":""), lpsVal, rpwmVal)); -+ pCoexDm->curLps = lpsVal; -+ pCoexDm->curRpwm = rpwmVal; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], preLps/curLps=0x%x/0x%x, preRpwm/curRpwm=0x%x/0x%x!!\n", -+ pCoexDm->preLps, pCoexDm->curLps, pCoexDm->preRpwm, pCoexDm->curRpwm)); -+ -+ if( (pCoexDm->preLps == pCoexDm->curLps) && -+ (pCoexDm->preRpwm == pCoexDm->curRpwm) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], LPS-RPWM_Last=0x%x , LPS-RPWM_Now=0x%x!!\n", -+ pCoexDm->preRpwm, pCoexDm->curRpwm)); -+ -+ return; -+ } -+ } -+ halbtc8192e2ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal); -+ -+ pCoexDm->preLps = pCoexDm->curLps; -+ pCoexDm->preRpwm = pCoexDm->curRpwm; -+} -+ -+ -+ -+VOID -+halbtc8192e2ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ u1Byte realByte1=byte1, realByte5=byte5; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ if(bApEnable) -+ { -+ if(byte1&BIT4 && !(byte1&BIT5)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FW for 1Ant AP mode\n")); -+ realByte1 &= ~BIT4; -+ realByte1 |= BIT5; -+ -+ realByte5 |= BIT5; -+ realByte5 &= ~BIT6; -+ } -+ } -+ -+ H2C_Parameter[0] = realByte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = realByte5; -+ -+ pCoexDm->psTdmaPara[0] = realByte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = realByte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], PS-TDMA H2C cmd =0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter); -+} -+ -+ -+VOID -+halbtc8192e2ant_SwMechanism1( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bShrinkRxLPF, -+ IN BOOLEAN bLowPenaltyRA, -+ IN BOOLEAN bLimitedDIG, -+ IN BOOLEAN bBTLNAConstrain -+ ) -+{ -+ /* -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if(BTC_WIFI_BW_HT40 != wifiBw) //only shrink RF Rx LPF for HT40 -+ { -+ if (bShrinkRxLPF) -+ bShrinkRxLPF = FALSE; -+ } -+ */ -+ -+ halbtc8192e2ant_RfShrink(pBtCoexist, NORMAL_EXEC, bShrinkRxLPF); -+ //halbtc8192e2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA); -+} -+ -+VOID -+halbtc8192e2ant_SwMechanism2( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAGCTableShift, -+ IN BOOLEAN bADCBackOff, -+ IN BOOLEAN bSWDACSwing, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ halbtc8192e2ant_AgcTable(pBtCoexist, NORMAL_EXEC, bAGCTableShift); -+ //halbtc8192e2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, bADCBackOff); -+ halbtc8192e2ant_DacSwing(pBtCoexist, NORMAL_EXEC, bSWDACSwing, dacSwingLvl); -+} -+ -+VOID -+halbtc8192e2ant_SetAntPath( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte antPosType, -+ IN BOOLEAN bInitHwCfg, -+ IN BOOLEAN bWifiOff -+ ) -+{ -+ u4Byte u4Tmp=0; -+ -+ if(bInitHwCfg) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x944, 0x24); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x930, 0x700700); -+ if(pBtCoexist->chipInterface == BTC_INTF_USB) -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x64, 0x30430004); -+ else -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x64, 0x30030004); -+ -+ // 0x4c[27][24]='00', Set Antenna to BB -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp &= ~BIT24; -+ u4Tmp &= ~BIT27; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ } -+ else if(bWifiOff) -+ { -+ if(pBtCoexist->chipInterface == BTC_INTF_USB) -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x64, 0x30430004); -+ else -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x64, 0x30030004); -+ -+ // 0x4c[27][24]='11', Set Antenna to BT, 0x64[8:7]=0, 0x64[2]=1 -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp |= BIT24; -+ u4Tmp |= BIT27; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ } -+ -+ // ext switch setting -+ switch(antPosType) -+ { -+ case BTC_ANT_PATH_WIFI: -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x92c, 0x4); -+ break; -+ case BTC_ANT_PATH_BT: -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x92c, 0x20); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x92c, 0x4); -+ break; -+ } -+} -+ -+VOID -+halbtc8192e2ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bTurnOnByCnt=FALSE; -+ u1Byte psTdmaTypeByCnt=0; -+ s1Byte nWiFiDurationAdjust = 0x0; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", -+ (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bPrePsTdmaOn = %d, bCurPsTdmaOn = %d!!\n", -+ pCoexDm->bPrePsTdmaOn, pCoexDm->bCurPsTdmaOn)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], prePsTdma = %d, curPsTdma = %d!!\n", -+ pCoexDm->prePsTdma, pCoexDm->curPsTdma)); -+ -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ -+ if (pCoexSta->nScanAPNum >= 40) -+ nWiFiDurationAdjust = -15; -+ else if (pCoexSta->nScanAPNum >= 20) -+ nWiFiDurationAdjust = -10; -+ -+/* -+ if (!pCoexSta->bForceLpsOn) //only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 -+ { -+ psTdmaByte0Val = 0x61; //no null-pkt -+ psTdmaByte3Val = 0x11; // no tx-pause at BT-slot -+ psTdmaByte4Val = 0x10; // 0x778 = d/1 toggle -+ } -+ -+ -+ if ( (type == 3) || (type == 13) || (type == 14) ) -+ { -+ psTdmaByte4Val = psTdmaByte4Val & 0xbf; //no dynamic slot for multi-profile -+ -+ if (!bWifiBusy) -+ psTdmaByte4Val = psTdmaByte4Val | 0x1; //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) -+ } -+ -+ if (pBtLinkInfo->bSlaveRole == TRUE) -+ psTdmaByte4Val = psTdmaByte4Val | 0x1; //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) -+ -+*/ -+ if(bTurnOn) -+ { -+ switch(type) -+ { -+ case 1: -+ default: //d1,wb -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0x11, 0x10); -+ break; -+ case 2: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x32, 0x03, 0x11, 0x10); -+ break; -+ case 3: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x28, 0x03, 0x11, 0x10); -+ break; -+ case 4: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1e, 0x03, 0x11, 0x10); -+ break; -+ case 5: //d1,pb,TXpause -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x63, 0x3c, 0x03, 0x90, 0x10); -+ break; -+ case 6: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x63, 0x32, 0x03, 0x90, 0x10); -+ break; -+ case 7: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x63, 0x28, 0x03, 0x90, 0x10); -+ break; -+ case 8: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x63, 0x1e, 0x03, 0x90, 0x10); -+ break; -+ case 9: //d1,bb -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0x31, 0x10); -+ break; -+ case 10: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x32, 0x03, 0x31, 0x10); -+ break; -+ case 11: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x28, 0x03, 0x31, 0x10); -+ break; -+ case 12: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1e, 0x03, 0x31, 0x10); -+ break; -+ case 13: //d1,bb,TXpause -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0x30, 0x10); -+ break; -+ case 14: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x32, 0x03, 0x30, 0x10); -+ break; -+ case 15: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x28, 0x03, 0x30, 0x10); -+ break; -+ case 16: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1e, 0x03, 0x30, 0x10); -+ break; -+ case 17: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x61, 0x20, 0x03, 0x10, 0x10); -+ break; -+ case 18: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 19: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0xe1, 0x90); -+ break; -+ case 20: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0x60, 0x90); -+ break; -+ case 21: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x61, 0x35, 0x03, 0x11, 0x11); -+ break; -+ case 71: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ break; -+ -+ // following cases is for wifi rssi low // bad antenna isolation, started from 81 -+ case 80: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x53, 0x3c, 0x3, 0x90, 0x50); -+ break; -+ case 81: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x53, 0x3a+nWiFiDurationAdjust, 0x3, 0x90, 0x50); -+ break; -+ case 82: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x53, 0x30+nWiFiDurationAdjust, 0x03, 0x90, 0x50); -+ break; -+ case 83: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x53, 0x21, 0x03, 0x90, 0x50); -+ break; -+ case 84: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x53, 0x15, 0x3, 0x90, 0x50); -+ break; -+ case 85: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x53, 0x3a, 0x03, 0x90, 0x50); -+ break; -+ case 86: -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x53, 0x21, 0x03, 0x90, 0x50); -+ break; -+ -+ } -+ } -+ else -+ { -+ // disable PS tdma -+ switch(type) -+ { -+ default: -+ case 0: //ANT2PTA, 0x778=1 -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x8, 0x0, 0x0, 0x0, 0x0); -+ halbtc8192e2ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FALSE, FALSE); -+ break; -+ case 1: //ANT2BT, 0x778=3 -+ halbtc8192e2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x8, 0x0); -+ delay_ms(5); -+ halbtc8192e2ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FALSE, FALSE); -+ break; -+ -+ } -+ } -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+VOID -+halbtc8192e2ant_SetSwitchSsType( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte ssType -+ ) -+{ -+ u1Byte mimoPs=BTC_MIMO_PS_DYNAMIC; -+ u4Byte disRaMask=0x0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], REAL set SS Type = %d\n", ssType)); -+ -+ disRaMask = halbtc8192e2ant_DecideRaMask(pBtCoexist, ssType, pCoexDm->curRaMaskType); -+ halbtc8192e2ant_UpdateRaMask(pBtCoexist, FORCE_EXEC, disRaMask); -+ -+ if(ssType == 1) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ // switch ofdm path -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xc04, 0x11); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xd04, 0x1); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x90c, 0x81111111); -+ // switch cck patch -+ //pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xe77, 0x4, 0x1); -+ //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xa07, 0x81); -+ mimoPs=BTC_MIMO_PS_STATIC; -+ } -+ else if(ssType == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xc04, 0x33); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xd04, 0x3); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x90c, 0x81121313); -+ // remove, if 0xe77[2]=0x0 then CCK will fail, advised by Jenyu -+ //pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xe77, 0x4, 0x0); -+ //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xa07, 0x41); -+ mimoPs=BTC_MIMO_PS_DYNAMIC; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_SEND_MIMO_PS, &mimoPs); // set rx 1ss or 2ss -+} -+ -+VOID -+halbtc8192e2ant_SwitchSsType( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte newSsType -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], %s Switch SS Type = %d\n", -+ (bForceExec? "force to":""), newSsType)); -+ pCoexDm->curSsType = newSsType; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->preSsType == pCoexDm->curSsType) -+ return; -+ } -+ halbtc8192e2ant_SetSwitchSsType(pBtCoexist, pCoexDm->curSsType); -+ -+ pCoexDm->preSsType = pCoexDm->curSsType; -+} -+ -+VOID -+halbtc8192e2ant_PsTdmaCheckForPowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bNewPsState -+ ) -+{ -+ u1Byte lpsMode=0x0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode); -+ -+ if(lpsMode) // already under LPS state -+ { -+ if(bNewPsState) -+ { -+ // keep state under LPS, do nothing. -+ } -+ else -+ { -+ // will leave LPS state, turn off psTdma first -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ } -+ else // NO PS state -+ { -+ if(bNewPsState) -+ { -+ // will enter LPS state, turn off psTdma first -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ else -+ { -+ // keep state under NO PS state, do nothing. -+ } -+ } -+} -+ -+VOID -+halbtc8192e2ant_PowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte psType, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bLowPwrDisable=FALSE; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ if(bApEnable) -+ { -+ psType = BTC_PS_WIFI_NATIVE; -+ lpsVal = 0x0; -+ rpwmVal = 0x0; -+ } -+ -+ switch(psType) -+ { -+ case BTC_PS_WIFI_NATIVE: -+ // recover to original 32k low power setting -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8192e2ant_PsTdmaCheckForPowerSaveState(pBtCoexist, TRUE); -+ halbtc8192e2ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal); -+ // when coex force to enter LPS, do not enter 32k low power. -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ // power save must executed before psTdma. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); -+ pCoexSta->bForceLpsOn = TRUE; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8192e2ant_PsTdmaCheckForPowerSaveState(pBtCoexist, FALSE); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+VOID -+halbtc8192e2ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw all off -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ // hw all off -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8192e2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 6); -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, FORCE_EXEC, 0); -+ -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ halbtc8192e2ant_SwitchSsType(pBtCoexist, FORCE_EXEC, 2); -+ -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+VOID -+halbtc8192e2ant_ActionBtInquiry( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+// BOOLEAN bLowPwrDisable=TRUE; -+ -+// pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+// halbtc8192e2ant_SwitchSsType(pBtCoexist, NORMAL_EXEC, 1); -+ -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 21); -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+VOID -+halbtc8192e2ant_ActionWiFiLinkProcess( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ -+} -+ -+BOOLEAN -+halbtc8192e2ant_IsCommonAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE, bWifiBusy=FALSE; -+ BOOLEAN bBtHsOn=FALSE, bLowPwrDisable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if(pBtLinkInfo->bScoExist || pBtLinkInfo->bHidExist) -+ { -+ halbtc8192e2ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 0, 0, 0); -+ } -+ else -+ { -+ halbtc8192e2ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ } -+ -+ if(!bWifiConnected) -+ { -+// bLowPwrDisable = FALSE; -+// pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-connected idle!!\n")); -+ -+ if( (BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) || -+ (BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+// halbtc8192e2ant_SwitchSsType(pBtCoexist, NORMAL_EXEC, 2); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 1); -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ else -+ { -+// halbtc8192e2ant_SwitchSsType(pBtCoexist, NORMAL_EXEC, 1); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ if(BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+// bLowPwrDisable = FALSE; -+// pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT non connected-idle!!\n")); -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+// halbtc8192e2ant_SwitchSsType(pBtCoexist, NORMAL_EXEC, 2); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else if(BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+// bLowPwrDisable = TRUE; -+// pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ if(bBtHsOn) -+ return FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT connected-idle!!\n")); -+ -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+// halbtc8192e2ant_SwitchSsType(pBtCoexist, NORMAL_EXEC, 2); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+// bLowPwrDisable = TRUE; -+// pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ if(bWifiBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n")); -+ bCommon = FALSE; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n")); -+ -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+// halbtc8192e2ant_SwitchSsType(pBtCoexist, NORMAL_EXEC, 1); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 21); -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ bCommon = TRUE; -+ } -+ } -+ } -+ -+ return bCommon; -+} -+ -+ -+VOID -+halbtc8192e2ant_TdmaDurationAdjust( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bScoHid, -+ IN BOOLEAN bTxPause, -+ IN u1Byte maxInterval -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjust()\n")); -+ -+ if(!pCoexDm->bAutoTdmaAdjust) -+ { -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ { -+ if(bScoHid) -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ else -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ } -+ } -+ } -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], retryCount = %d\n", retryCount)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], up=%d, dn=%d, m=%d, n=%d, WaitCount=%d\n", -+ up, dn, m, n, WaitCount)); -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], max Interval = %d\n", maxInterval)); -+ if(maxInterval == 1) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 2) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 3) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ } -+ } -+ -+ // if current PsTdma not match with the recorded one (when scan, dhcp...), -+ // then we have to adjust it back to the previous record one. -+ if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) -+ { -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", -+ pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if( !bScan && !bLink && !bRoam) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); -+ } -+ } -+} -+ -+VOID -+halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow( -+ IN PBTC_COEXIST pBtCoexist//, -+ //IN u1Byte wifiStatus -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0, btInfoExt; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow()\n")); -+#if 0 -+ if( (BT_8192E_2ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == wifiStatus) || -+ (BT_8192E_2ANT_WIFI_STATUS_CONNECTED_SCAN == wifiStatus) || -+ (BT_8192E_2ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT == wifiStatus) ) -+ { -+ if( pCoexDm->curPsTdma != 81 && -+ pCoexDm->curPsTdma != 82 && -+ pCoexDm->curPsTdma != 83 && -+ pCoexDm->curPsTdma != 84 ) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 82); -+ pCoexDm->psTdmaDuAdjType = 82; -+ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ return; -+ } -+#endif -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ -+ retryCount = pCoexSta->btRetryCnt; -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if(!pCoexDm->bAutoTdmaAdjustLowRssi) -+ { -+ pCoexDm->bAutoTdmaAdjustLowRssi = TRUE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjustForWifiRssiLow()!!\n")); -+ -+/* -+ if(BT_INFO_8192E_2ANT_A2DP_BASIC_RATE(btInfoExt)) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 83); -+ pCoexDm->psTdmaDuAdjType = 83; -+ } -+ else -+*/ -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 81); -+ pCoexDm->psTdmaDuAdjType = 81; -+ } -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+// retryCount = pCoexSta->btRetryCnt; -+// btInfoExt = pCoexSta->btInfoExt; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], retryCount = %d\n", retryCount)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], up=%d, dn=%d, m=%d, n=%d, WaitCount=%d\n", -+ up, dn, m, n, WaitCount)); -+ result = 0; -+ WaitCount++; -+ -+ if ( (pCoexSta->lowPriorityTx) > 1050 || (pCoexSta->lowPriorityRx) > 1250 ) -+ retryCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ if(result == -1) -+ { -+/* -+ if( (BT_INFO_8192E_2ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 81) ||(pCoexDm->curPsTdma == 82)) ) -+ if( (BT_INFO_8192E_2ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 81) ||(pCoexDm->curPsTdma == 82)) ) -+ -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 84); -+ pCoexDm->psTdmaDuAdjType = 84; -+ } -+*/ -+ if(pCoexDm->curPsTdma == 80) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 81); -+ pCoexDm->psTdmaDuAdjType = 81; -+ } -+ else if(pCoexDm->curPsTdma == 81) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 82); -+ pCoexDm->psTdmaDuAdjType = 82; -+ } -+ else if(pCoexDm->curPsTdma == 82) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 83); -+ pCoexDm->psTdmaDuAdjType = 83; -+ } -+ else if(pCoexDm->curPsTdma == 83) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 84); -+ pCoexDm->psTdmaDuAdjType = 84; -+ } -+ } -+ else if(result == 1) -+ { -+/* -+ if( (BT_INFO_8192E_2ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 81) ||(pCoexDm->curPsTdma == 82)) ) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 83); -+ pCoexDm->psTdmaDuAdjType = 83; -+ } -+*/ -+ if(pCoexDm->curPsTdma == 84) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 83); -+ pCoexDm->psTdmaDuAdjType = 83; -+ } -+ else if(pCoexDm->curPsTdma == 83) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 82); -+ pCoexDm->psTdmaDuAdjType = 82; -+ } -+ else if(pCoexDm->curPsTdma == 82) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 81); -+ pCoexDm->psTdmaDuAdjType = 81; -+ } -+ else if((pCoexDm->curPsTdma == 81)&&((pCoexSta->nScanAPNum <= NOISY_AP_NUM_THRESH))) -+ { -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 80); -+ pCoexDm->psTdmaDuAdjType = 80; -+ } -+ -+ } -+ -+ if( pCoexDm->curPsTdma != 80 && -+ pCoexDm->curPsTdma != 81 && -+ pCoexDm->curPsTdma != 82 && -+ pCoexDm->curPsTdma != 83 && -+ pCoexDm->curPsTdma != 84 ) -+ { -+ // recover to previous adjust type -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ } -+} -+ -+VOID -+halbtc8192e2ant_GetBtRssiThreshold( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte pThres0, -+ IN pu1Byte pThres1 -+ ) -+{ -+ u1Byte antType, btThreshold=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_ANT_TYPE, &antType); -+ -+ switch(antType) -+ { -+ case BTC_ANT_TYPE_0: // 92E with SPDT -+ *pThres0 = 100; -+ *pThres1 = 100; -+ break; -+ case BTC_ANT_TYPE_1: //92E without SPDT, poor antenna isolation -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ case BTC_ANT_TYPE_2: //92E without SPDT, normal antenna isolation -+ *pThres0 = 34; //92E with coupler, goodl antenna isolation -+ *pThres1 = 42; -+ break; -+ case BTC_ANT_TYPE_3: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ case BTC_ANT_TYPE_4: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+//undefined -+VOID -+halbtc8192e2ant_ActionUndefined( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // power save state -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // coex table -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // pstdma -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ -+ // decrease BT power -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // limited Rx -+ halbtc8192e2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ // sw mechanism -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+ -+// SCO only or SCO+PAN(HS) -+VOID -+halbtc8192e2ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ halbtc8192e2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8192e2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8192e2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ // btRssiState = halbtc8192e2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ if((bApEnable == TRUE) || (BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)))) -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ // halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, TRUE, 0x50, 0x4); -+ -+ // coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ else -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // pstdma -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ else -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ -+ // decrease BT power -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // limited Rx -+ halbtc8192e2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ // sw mechanism -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+VOID -+halbtc8192e2ant_ActionScoPan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ halbtc8192e2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8192e2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8192e2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ // btRssiState = halbtc8192e2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ if((bApEnable == TRUE) || (BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)))) -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ // coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ else -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ -+ // pstdm -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); //shielding room -+ else if (BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 10); //open space //antenna at BT -+ else //low RSSI -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 86); -+ -+ -+/* -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else if (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH) // BT HIGH RSSI & shielding room -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ -+ // limited Rx -+ halbtc8192e2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ // sw mechanism -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); //shielding room -+ else if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); //open space -+ else //low RSSI -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+VOID -+halbtc8192e2ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte anttype=0; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_ANT_TYPE, &anttype); -+ -+// halbtc8192e2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+// btRssiState = halbtc8192e2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8192e2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ btRssiState = halbtc8192e2ant_BtRssiState(3, 34, 42); -+ -+ if(anttype == 0)//ANTTYPE = 0 92E 2ant with SPDT -+ { -+ // power save state & pstdma & coex table -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if(anttype == 1) //92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation -+ { -+ // power save state & pstdma & coex table -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if(anttype == 2)//ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 9); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 9); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 9); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ } -+ } -+ else if(anttype == 3) //ANTTYPE = 3, 92E 3ant with good ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ } -+ else //ANTTYPE = 4 for test -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ -+ // power save state -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // coex table -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // pstdma -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ -+ // decrease BT power -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // limited Rx -+ halbtc8192e2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ // sw mechanism -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -+VOID -+halbtc8192e2ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte anttype=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_ANT_TYPE, &anttype); -+ -+// halbtc8192e2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+// btRssiState = halbtc8192e2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8192e2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ btRssiState = halbtc8192e2ant_BtRssiState(3, 34, 42); -+ -+// anttype = 4; -+ -+ if(anttype == 0)//ANTTYPE = 0 92E 2ant with SPDT -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ else if(anttype == 1) //92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); //shielding room -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ -+ } -+ else if(anttype == 2)//ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ else if(anttype == 3) //ANTTYPE = 3, 92E 3ant with good ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ } -+ else //ANTTYPE = 4 for test -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ -+/* -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else if (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH) // BT HIGH RSSI & shielding room -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ // limited Rx -+ halbtc8192e2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ // sw mechanism -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); //shielding room -+ else if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x06); //open space -+ else //low RSSI -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+VOID -+halbtc8192e2ant_ActionA2dpPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8192e2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8192e2ant_BtRssiState(3, 34, 42); -+ -+// halbtc8192e2ant_SwitchSsType(pBtCoexist, NORMAL_EXEC, 1); -+ halbtc8192e2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ -+ if( (btRssiState == BTC_RSSI_STATE_LOW) || -+ (btRssiState == BTC_RSSI_STATE_STAY_LOW) ) -+ { -+ halbtc8192e2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 2); -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if( (btRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (btRssiState == BTC_RSSI_STATE_STAY_MEDIUM) ) -+ { -+ halbtc8192e2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 2); -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ } -+ else if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192e2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 2); -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+VOID -+halbtc8192e2ant_ActionPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0; -+ -+ halbtc8192e2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8192e2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8192e2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ // btRssiState = halbtc8192e2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ // coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // pstdma -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); //shielding room -+ else if (BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); //open space //antenna at BT -+ else //low RSSI -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 85); -+ -+/* -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else if (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH) // BT HIGH RSSI & shielding room -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ -+ // limited Rx -+ halbtc8192e2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ // sw mechanism -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); //shielding room -+ else if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); //open space -+ else //low RSSI -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+//PAN(HS) only -+VOID -+halbtc8192e2ant_ActionPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8192e2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8192e2ant_BtRssiState(3, 34, 42); -+ -+// halbtc8192e2ant_SwitchSsType(pBtCoexist, NORMAL_EXEC, 1); -+ halbtc8192e2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ -+ if( (btRssiState == BTC_RSSI_STATE_LOW) || -+ (btRssiState == BTC_RSSI_STATE_STAY_LOW) ) -+ { -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if( (btRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (btRssiState == BTC_RSSI_STATE_STAY_MEDIUM) ) -+ { -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ } -+ else if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+//PAN(EDR)+A2DP -+VOID -+halbtc8192e2ant_ActionPanEdrA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0; -+ -+ halbtc8192e2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8192e2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8192e2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ // btRssiState = halbtc8192e2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ if((BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)))) -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ // coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // pstdma -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); //shielding room -+ else if (BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); //open space //antenna at BT -+ else //low RSSI -+{ -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 86); -+} -+ -+/* -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else if (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH) // BT HIGH RSSI & shielding room -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ -+ // limited Rx -+ halbtc8192e2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ // sw mechanism -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); //shielding room -+ else if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); //open space -+ else //low RSSI -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+VOID -+halbtc8192e2ant_ActionPanEdrHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0; -+ -+ halbtc8192e2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8192e2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8192e2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ // btRssiState = halbtc8192e2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ if((BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)))) -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ // coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ else -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // pstdm -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); //shielding room -+ else if (BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); //open space //antenna at BT -+ else //low RSSI -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 86); -+ -+/* -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else if (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH) // BT HIGH RSSI & shielding room -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ -+ // limited Rx -+ halbtc8192e2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ // sw mechanism -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); //shielding room -+ else if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); //open space -+ else //low RSSI -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+// HID+A2DP+PAN(EDR) -+VOID -+halbtc8192e2ant_ActionHidA2dpPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0; -+ -+ halbtc8192e2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8192e2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8192e2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ // btRssiState = halbtc8192e2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ if((BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)))) -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ // coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ else -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); //6 -+ -+ // pstdma -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); //shielding room -+ else if (BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); //open space //antenna at BT -+ else //low RSSI -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 86); -+ } -+ -+/* -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else if (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH) // BT HIGH RSSI & shielding room -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ // limited Rx -+ halbtc8192e2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ // sw mechanism -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); //shielding room -+ else if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); //open space -+ else //low RSSI -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+VOID -+halbtc8192e2ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0, anttype=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_ANT_TYPE, &anttype); -+ -+ // halbtc8192e2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ // btRssiState = halbtc8192e2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8192e2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ btRssiState = halbtc8192e2ant_BtRssiState(3, 34, 42); -+ -+ if(anttype == 0)//ANTTYPE = 0 92E 2ant with SPDT -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ { -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 83); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else -+ { -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 83); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ } -+ else if(anttype == 1) //92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ { -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else -+ { -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 83); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ } -+ else if(anttype == 2)//ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 83); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ } -+ else if(anttype == 3) //ANTTYPE = 3, 92E 3ant with good ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ } -+ else //ANTTYPE = 4 for test -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8192e2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ -+/* -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else if (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH) // BT HIGH RSSI & shielding room -+ halbtc8192e2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ -+ // limited Rx -+ halbtc8192e2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8192e2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ // sw mechanism -+ halbtc8192e2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); //shielding room -+ else if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH)) -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x06); //open space -+ else //low RSSI -+ halbtc8192e2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+VOID -+halbtc8192e2ant_ActionBtWhckTest( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ -+} -+ -+VOID -+halbtc8192e2ant_ActionWifiMultiPort( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ -+} -+ -+VOID -+halbtc8192e2ant_RunCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiUnder5G=FALSE; -+ u1Byte btInfoOriginal=0, btRetryCnt=0; -+ u1Byte algorithm=0; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], RunCoexistMechanism()===>\n")); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n")); -+ return; -+ } -+ -+ if(pCoexSta->bUnderIps) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under IPS !!!\n")); -+ return; -+ } -+ -+ algorithm = halbtc8192e2ant_ActionAlgorithm(pBtCoexist); -+ if(pCoexSta->bC2hBtInquiryPage && (BT_8192E_2ANT_COEX_ALGO_PANHS!=algorithm)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is under inquiry/page scan !!\n")); -+ halbtc8192e2ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ -+ pCoexDm->curAlgorithm = algorithm; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Algorithm = %d \n", pCoexDm->curAlgorithm)); -+ -+ if(halbtc8192e2ant_IsCommonAction(pBtCoexist)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant common.\n")); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ } -+ else -+ { -+ if(pCoexDm->curAlgorithm != pCoexDm->preAlgorithm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], preAlgorithm=%d, curAlgorithm=%d\n", -+ pCoexDm->preAlgorithm, pCoexDm->curAlgorithm)); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ } -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8192E_2ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO.\n")); -+ halbtc8192e2ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_SCO_PAN: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO+PAN(EDR).\n")); -+ halbtc8192e2ant_ActionScoPan(pBtCoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID.\n")); -+ halbtc8192e2ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP.\n")); -+ halbtc8192e2ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_A2DP_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n")); -+ halbtc8192e2ant_ActionA2dpPanHs(pBtCoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n")); -+ halbtc8192e2ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HS mode.\n")); -+ halbtc8192e2ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_PANEDR_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n")); -+ halbtc8192e2ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_PANEDR_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n")); -+ halbtc8192e2ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n")); -+ halbtc8192e2ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n")); -+ halbtc8192e2ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = undefined!!\n")); -+ halbtc8192e2ant_ActionUndefined(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+} -+ -+VOID -+halbtc8192e2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bBackUp -+ ) -+{ -+ u4Byte u4Tmp=0; -+ u2Byte u2Tmp=0; -+ u1Byte u1Tmp=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); -+ -+ if(bBackUp) -+ { -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ } -+ -+ // antenna sw ctrl to bt -+ halbtc8192e2ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, TRUE, FALSE); -+ -+ halbtc8192e2ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ // antenna switch control parameter -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x858, 0x55555555); -+ -+ // coex parameters -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x3); -+ // 0x790[5:0]=0x5 -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x790); -+ u1Tmp &= 0xc0; -+ u1Tmp |= 0x5; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, u1Tmp); -+ -+ // enable counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ // enable PTA -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x20); -+ // enable mailbox interface -+ u2Tmp = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x40); -+ u2Tmp |= BIT9; -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x40, u2Tmp); -+ -+ // enable PTA I2C mailbox -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x101); -+ u1Tmp |= BIT4; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x101, u1Tmp); -+ -+ // enable bt clock when wifi is disabled. -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x93); -+ u1Tmp |= BIT0; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x93, u1Tmp); -+ // enable bt clock when suspend. -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x7); -+ u1Tmp |= BIT0; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x7, u1Tmp); -+} -+ -+//============================================================ -+// work around function start with wa_halbtc8192e2ant_ -+//============================================================ -+//============================================================ -+// extern function start with EXhalbtc8192e2ant_ -+//============================================================ -+VOID -+EXhalbtc8192e2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8192e2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ halbtc8192e2ant_InitHwConfig(pBtCoexist, TRUE); -+} -+ -+VOID -+EXhalbtc8192e2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8192e2ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8192e2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u2Byte u2Tmp[4]; -+ u4Byte u4Tmp[4]; -+ u4Byte faOfdm, faCck; -+ u4Byte fwVer=0, btPatchVer=0; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Antenna type:", \ -+ pBoardInfo->antType); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", "CoexVer/ FwVer/ PatchVer", \ -+ GLCoexVerDate8192e2Ant, GLCoexVer8192e2Ant, fwVer, btPatchVer, btPatchVer); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ -+ ((pBtCoexist->btInfo.bBtDisabled)? ("disabled"): ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)? "non-connected idle": -+ ( (BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy")))), -+ pCoexSta->btRssi, pCoexSta->btRetryCnt); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8192e2Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+/* -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "SS Type", \ -+ pCoexDm->curSsType); -+ CL_PRINTF(cliBuf); -+*/ -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", "SM1[ShRf/ LpRA/ LimDig]", \ -+ pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ -+ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Rate Mask", \ -+ pBtCoexist->btInfo.raMask); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase, pCoexDm->bAutoTdmaAdjust); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "DecBtPwr/ IgnWlanAct", \ -+ pCoexDm->curBtDecPwrLvl, pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "backup ARFR1/ARFR2/RL/AMaxTime", \ -+ pCoexDm->backupArfrCnt1, pCoexDm->backupArfrCnt2, pCoexDm->backupRetryLimit, pCoexDm->backupAmpduMaxTime); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ u2Tmp[0] = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "0x430/0x434/0x42a/0x456", \ -+ u4Tmp[0], u4Tmp[1], u2Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc04); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xd04); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x90c); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0xc04/ 0xd04/ 0x90c", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x778", \ -+ u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x92c); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x930); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x92c/ 0x930", \ -+ (u1Tmp[0]), u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4f); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x40/ 0x4f", \ -+ u1Tmp[0], u1Tmp[1]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770(hp rx[31:16]/tx[15:0])", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(lp rx[31:16]/tx[15:0])", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+#if(BT_AUTO_REPORT_ONLY_8192E_2ANT == 1) -+ halbtc8192e2ant_MonitorBtCtr(pBtCoexist); -+#endif -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8192e2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ pCoexSta->bUnderIps = TRUE; -+ halbtc8192e2ant_CoexAllOff(pBtCoexist); -+ halbtc8192e2ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FALSE, TRUE); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ pCoexSta->bUnderIps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8192e2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ pCoexSta->bUnderLps = TRUE; -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ pCoexSta->bUnderLps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8192e2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &pCoexSta->nScanAPNum); -+ -+ } -+} -+ -+VOID -+EXhalbtc8192e2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8192e2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+ -+ -+ // only 2.4G we need to inform bt the chnl mask -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if( (BTC_MEDIA_CONNECT == type) && -+ (wifiCentralChnl <= 14) ) -+ { -+ H2C_Parameter[0] = 0x1; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x66=0x%x\n", -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter); -+} -+ -+VOID -+EXhalbtc8192e2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8192e2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bBtBusy=FALSE, bLimitedDig=FALSE; -+ BOOLEAN bWifiConnected=FALSE; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ -+ rspSource = tmpBuf[0]&0xf; -+ if(rspSource >= BT_INFO_SRC_8192E_2ANT_MAX) -+ rspSource = BT_INFO_SRC_8192E_2ANT_WIFI_FW; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 1) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ if(BT_INFO_SRC_8192E_2ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = // [3:0] -+ pCoexSta->btInfoC2h[rspSource][2]&0xf; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][3]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][4]; -+ -+ // Here we need to resend some wifi info to BT -+ // because bt is reset and loss of the info. -+ if( (pCoexSta->btInfoExt & BIT1) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ if(bWifiConnected) -+ { -+ EXhalbtc8192e2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT); -+ } -+ else -+ { -+ EXhalbtc8192e2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ } -+ -+ if( (pCoexSta->btInfoExt & BIT3) ) -+ { -+ if(!pBtCoexist->bManualControl && !pBtCoexist->bStopCoexDm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")); -+ halbtc8192e2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ } -+ } -+ else -+ { -+ // BT already NOT ignore Wlan active, do nothing here. -+ } -+ -+#if(BT_AUTO_REPORT_ONLY_8192E_2ANT == 0) -+ if( (pCoexSta->btInfoExt & BIT4) ) -+ { -+ // BT auto report already enabled, do nothing -+ } -+ else -+ { -+ halbtc8192e2ant_BtAutoReport(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+#endif -+ } -+ -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8192E_2ANT_B_INQ_PAGE) -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ else -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ -+ // set link exist status -+ if(!(btInfo&BT_INFO_8192E_2ANT_B_CONNECTION)) -+ { -+ pCoexSta->bBtLinkExist = FALSE; -+ pCoexSta->bPanExist = FALSE; -+ pCoexSta->bA2dpExist = FALSE; -+ pCoexSta->bHidExist = FALSE; -+ pCoexSta->bScoExist = FALSE; -+ } -+ else // connection exists -+ { -+ pCoexSta->bBtLinkExist = TRUE; -+ if(btInfo & BT_INFO_8192E_2ANT_B_FTP) -+ pCoexSta->bPanExist = TRUE; -+ else -+ pCoexSta->bPanExist = FALSE; -+ if(btInfo & BT_INFO_8192E_2ANT_B_A2DP) -+ pCoexSta->bA2dpExist = TRUE; -+ else -+ pCoexSta->bA2dpExist = FALSE; -+ if(btInfo & BT_INFO_8192E_2ANT_B_HID) -+ pCoexSta->bHidExist = TRUE; -+ else -+ pCoexSta->bHidExist = FALSE; -+ if(btInfo & BT_INFO_8192E_2ANT_B_SCO_ESCO) -+ pCoexSta->bScoExist = TRUE; -+ else -+ pCoexSta->bScoExist = FALSE; -+ } -+ -+ halbtc8192e2ant_UpdateBtLinkInfo(pBtCoexist); -+ -+ if(!(btInfo&BT_INFO_8192E_2ANT_B_CONNECTION)) -+ { -+ pCoexDm->btStatus = BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n")); -+ } -+ else if(btInfo == BT_INFO_8192E_2ANT_B_CONNECTION) // connection exists but no busy -+ { -+ pCoexDm->btStatus = BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n")); -+ } -+ else if((btInfo&BT_INFO_8192E_2ANT_B_SCO_ESCO) || -+ (btInfo&BT_INFO_8192E_2ANT_B_SCO_BUSY)) -+ { -+ pCoexDm->btStatus = BT_8192E_2ANT_BT_STATUS_SCO_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n")); -+ } -+ else if(btInfo&BT_INFO_8192E_2ANT_B_ACL_BUSY) -+ { -+ pCoexDm->btStatus = BT_8192E_2ANT_BT_STATUS_ACL_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n")); -+ } -+ else -+ { -+ pCoexDm->btStatus = BT_8192E_2ANT_BT_STATUS_MAX; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n")); -+ } -+ -+ if( (BT_8192E_2ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8192E_2ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8192E_2ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ bBtBusy = TRUE; -+ bLimitedDig = TRUE; -+ } -+ else -+ { -+ bBtBusy = FALSE; -+ bLimitedDig = FALSE; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ pCoexDm->bLimitedDig = bLimitedDig; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bLimitedDig); -+ -+ halbtc8192e2ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8192e2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8192e2ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FALSE, TRUE); -+ halbtc8192e2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ EXhalbtc8192e2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+VOID -+EXhalbtc8192e2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static u1Byte disVerInfoCnt=0; -+ u4Byte fwVer=0, btPatchVer=0; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ==========================Periodical===========================\n")); -+ -+ if(disVerInfoCnt <= 5) -+ { -+ disVerInfoCnt += 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ant PG Num/ Ant Mech/ Ant Pos = %d/ %d/ %d\n", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT stack/ hci ext ver = %s / %d\n", -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion)); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", -+ GLCoexVerDate8192e2Ant, GLCoexVer8192e2Ant, fwVer, btPatchVer, btPatchVer)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ } -+ -+#if(BT_AUTO_REPORT_ONLY_8192E_2ANT == 0) -+ halbtc8192e2ant_QueryBtInfo(pBtCoexist); -+ halbtc8192e2ant_MonitorBtCtr(pBtCoexist); -+ halbtc8192e2ant_MonitorBtEnableDisable(pBtCoexist); -+#else -+ if( halbtc8192e2ant_IsWifiStatusChanged(pBtCoexist) || -+ pCoexDm->bAutoTdmaAdjust) -+ { -+ halbtc8192e2ant_RunCoexistMechanism(pBtCoexist); -+ } -+#endif -+} -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8192e2Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8192e2Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8192e2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8192e2Ant.h 2017-06-07 23:07:21.008687302 +0300 -@@ -0,0 +1,231 @@ -+//=========================================== -+// The following is for 8192E 2Ant BT Co-exist definition -+//=========================================== -+#define BT_AUTO_REPORT_ONLY_8192E_2ANT 0 -+ -+#define BT_INFO_8192E_2ANT_B_FTP BIT7 -+#define BT_INFO_8192E_2ANT_B_A2DP BIT6 -+#define BT_INFO_8192E_2ANT_B_HID BIT5 -+#define BT_INFO_8192E_2ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8192E_2ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8192E_2ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8192E_2ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8192E_2ANT_B_CONNECTION BIT0 -+ -+#define BT_INFO_8192E_2ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT0))? TRUE:FALSE) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT 2 -+#define NOISY_AP_NUM_THRESH 5 -+ -+typedef enum _BT_INFO_SRC_8192E_2ANT{ -+ BT_INFO_SRC_8192E_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8192E_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8192E_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8192E_2ANT_MAX -+}BT_INFO_SRC_8192E_2ANT,*PBT_INFO_SRC_8192E_2ANT; -+ -+typedef enum _BT_8192E_2ANT_BT_STATUS{ -+ BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8192E_2ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8192E_2ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8192E_2ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8192E_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8192E_2ANT_BT_STATUS_MAX -+}BT_8192E_2ANT_BT_STATUS,*PBT_8192E_2ANT_BT_STATUS; -+ -+typedef enum _BT_8192E_2ANT_COEX_ALGO{ -+ BT_8192E_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8192E_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8192E_2ANT_COEX_ALGO_SCO_PAN = 0x2, -+ BT_8192E_2ANT_COEX_ALGO_HID = 0x3, -+ BT_8192E_2ANT_COEX_ALGO_A2DP = 0x4, -+ BT_8192E_2ANT_COEX_ALGO_A2DP_PANHS = 0x5, -+ BT_8192E_2ANT_COEX_ALGO_PANEDR = 0x6, -+ BT_8192E_2ANT_COEX_ALGO_PANHS = 0x7, -+ BT_8192E_2ANT_COEX_ALGO_PANEDR_A2DP = 0x8, -+ BT_8192E_2ANT_COEX_ALGO_PANEDR_HID = 0x9, -+ BT_8192E_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0xa, -+ BT_8192E_2ANT_COEX_ALGO_HID_A2DP = 0xb, -+ BT_8192E_2ANT_COEX_ALGO_MAX = 0xc -+}BT_8192E_2ANT_COEX_ALGO,*PBT_8192E_2ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8192E_2ANT{ -+ // fw mechanism -+ u1Byte preBtDecPwrLvl; -+ u1Byte curBtDecPwrLvl; -+ u1Byte preFwDacSwingLvl; -+ u1Byte curFwDacSwingLvl; -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ BOOLEAN bResetTdmaAdjust; -+ BOOLEAN bAutoTdmaAdjust; -+ BOOLEAN bAutoTdmaAdjustLowRssi; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ BOOLEAN bPreBtAutoReport; -+ BOOLEAN bCurBtAutoReport; -+ u1Byte preLps; -+ u1Byte curLps; -+ u1Byte preRpwm; -+ u1Byte curRpwm; -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ BOOLEAN bPreDacSwingOn; -+ u4Byte preDacSwingLvl; -+ BOOLEAN bCurDacSwingOn; -+ u4Byte curDacSwingLvl; -+ BOOLEAN bPreAdcBackOff; -+ BOOLEAN bCurAdcBackOff; -+ BOOLEAN bPreAgcTableEn; -+ BOOLEAN bCurAgcTableEn; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ -+ u4Byte backupArfrCnt1; // Auto Rate Fallback Retry cnt -+ u4Byte backupArfrCnt2; // Auto Rate Fallback Retry cnt -+ u2Byte backupRetryLimit; -+ u1Byte backupAmpduMaxTime; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+ -+ u1Byte preSsType; -+ u1Byte curSsType; -+ -+ u4Byte preRaMask; -+ u4Byte curRaMask; -+ u1Byte curRaMaskType; -+ u1Byte preArfrType; -+ u1Byte curArfrType; -+ u1Byte preRetryLimitType; -+ u1Byte curRetryLimitType; -+ u1Byte preAmpduTimeType; -+ u1Byte curAmpduTimeType; -+} COEX_DM_8192E_2ANT, *PCOEX_DM_8192E_2ANT; -+ -+typedef struct _COEX_STA_8192E_2ANT{ -+ BOOLEAN bBtLinkExist; -+ BOOLEAN bScoExist; -+ BOOLEAN bA2dpExist; -+ BOOLEAN bHidExist; -+ BOOLEAN bPanExist; -+ -+ BOOLEAN bUnderLps; -+ BOOLEAN bUnderIps; -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ u1Byte btRssi; -+ u1Byte preBtRssiState; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8192E_2ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8192E_2ANT_MAX]; -+ BOOLEAN bC2hBtInquiryPage; -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+ u1Byte nScanAPNum; -+ -+ u4Byte nCRCOK_CCK; -+ u4Byte nCRCOK_11g; -+ u4Byte nCRCOK_11n; -+ u4Byte nCRCOK_11nAgg; -+ -+ u4Byte nCRCErr_CCK; -+ u4Byte nCRCErr_11g; -+ u4Byte nCRCErr_11n; -+ u4Byte nCRCErr_11nAgg; -+ -+ u1Byte nCoexTableType; -+ BOOLEAN bForceLpsOn; -+ -+ u1Byte disVerInfoCnt; -+}COEX_STA_8192E_2ANT, *PCOEX_STA_8192E_2ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8192e2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192e2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8192e2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192e2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192e2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192e2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192e2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192e2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192e2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192e2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8192e2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192e2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192e2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8703b1Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8703b1Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8703b1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8703b1Ant.c 2017-06-07 23:07:21.009687394 +0300 -@@ -0,0 +1,4999 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8703B Co-exist mechanism -+// -+// History -+// 2012/11/15 Cosa first check in. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8703b1Ant.tmh" -+#endif -+ -+//#include -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8703B_1ANT GLCoexDm8703b1Ant; -+static PCOEX_DM_8703B_1ANT pCoexDm=&GLCoexDm8703b1Ant; -+static COEX_STA_8703B_1ANT GLCoexSta8703b1Ant; -+static PCOEX_STA_8703B_1ANT pCoexSta=&GLCoexSta8703b1Ant; -+static PSDSCAN_STA_8703B_1ANT GLPsdScan8703b1Ant; -+static PPSDSCAN_STA_8703B_1ANT pPsdScan = &GLPsdScan8703b1Ant; -+ -+ -+const char *const GLBtInfoSrc8703b1Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u4Byte GLCoexVerDate8703b1Ant=20150413; -+u4Byte GLCoexVer8703b1Ant=0x01; -+ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8703b1ant_ -+//============================================================ -+u1Byte -+halbtc8703b1ant_BtRssiState( -+ u1Byte levelNum, -+ u1Byte rssiThresh, -+ u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte btRssi=0; -+ u1Byte btRssiState=pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh1) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+u1Byte -+halbtc8703b1ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+VOID -+halbtc8703b1ant_UpdateRaMask( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte disRateMask -+ ) -+{ -+ pCoexDm->curRaMask = disRateMask; -+ -+ if( bForceExec || (pCoexDm->preRaMask != pCoexDm->curRaMask)) -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_UPDATE_RAMASK, &pCoexDm->curRaMask); -+ } -+ pCoexDm->preRaMask = pCoexDm->curRaMask; -+} -+ -+VOID -+halbtc8703b1ant_AutoRateFallbackRetry( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiUnderBMode=FALSE; -+ -+ pCoexDm->curArfrType = type; -+ -+ if( bForceExec || (pCoexDm->preArfrType != pCoexDm->curArfrType)) -+ { -+ switch(pCoexDm->curArfrType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, pCoexDm->backupArfrCnt1); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, pCoexDm->backupArfrCnt2); -+ break; -+ case 1: -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ if(bWifiUnderBMode) -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x01010101); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preArfrType = pCoexDm->curArfrType; -+} -+ -+VOID -+halbtc8703b1ant_RetryLimit( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curRetryLimitType = type; -+ -+ if( bForceExec || (pCoexDm->preRetryLimitType != pCoexDm->curRetryLimitType)) -+ { -+ switch(pCoexDm->curRetryLimitType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, pCoexDm->backupRetryLimit); -+ break; -+ case 1: // retry limit=8 -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preRetryLimitType = pCoexDm->curRetryLimitType; -+} -+ -+VOID -+halbtc8703b1ant_AmpduMaxTime( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curAmpduTimeType = type; -+ -+ if( bForceExec || (pCoexDm->preAmpduTimeType != pCoexDm->curAmpduTimeType)) -+ { -+ switch(pCoexDm->curAmpduTimeType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, pCoexDm->backupAmpduMaxTime); -+ break; -+ case 1: // AMPDU timw = 0x38 * 32us -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preAmpduTimeType = pCoexDm->curAmpduTimeType; -+} -+ -+VOID -+halbtc8703b1ant_LimitedTx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte raMaskType, -+ IN u1Byte arfrType, -+ IN u1Byte retryLimitType, -+ IN u1Byte ampduTimeType -+ ) -+{ -+ switch(raMaskType) -+ { -+ case 0: // normal mode -+ halbtc8703b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0); -+ break; -+ case 1: // disable cck 1/2 -+ halbtc8703b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x00000003); -+ break; -+ case 2: // disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 -+ halbtc8703b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8703b1ant_AutoRateFallbackRetry(pBtCoexist, bForceExec, arfrType); -+ halbtc8703b1ant_RetryLimit(pBtCoexist, bForceExec, retryLimitType); -+ halbtc8703b1ant_AmpduMaxTime(pBtCoexist, bForceExec, ampduTimeType); -+} -+ -+VOID -+halbtc8703b1ant_LimitedRx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRejApAggPkt, -+ IN BOOLEAN bBtCtrlAggBufSize, -+ IN u1Byte aggBufSize -+ ) -+{ -+ BOOLEAN bRejectRxAgg=bRejApAggPkt; -+ BOOLEAN bBtCtrlRxAggSize=bBtCtrlAggBufSize; -+ u1Byte rxAggSize=aggBufSize; -+ -+ //============================================ -+ // Rx Aggregation related setting -+ //============================================ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg); -+ // decide BT control aggregation buf size or not -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize); -+ // aggregation buf size, only work when BT control Rx aggregation size. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize); -+ // real update aggregation setting -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+VOID -+halbtc8703b1ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = TRUE; -+ -+ H2C_Parameter[0] |= BIT0; // trigger -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x61=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8703b1ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp, u4Tmp1; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp, u1Tmp1; -+ s4Byte wifiRssi; -+ static u1Byte NumOfBtCounterChk = 0; -+ -+ //to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS -+ //if (! (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e) & 0x8) ) -+ -+ if (pCoexSta->bUnderIps) -+ { -+ //pCoexSta->highPriorityTx = 65535; -+ //pCoexSta->highPriorityRx = 65535; -+ //pCoexSta->lowPriorityTx = 65535; -+ //pCoexSta->lowPriorityRx = 65535; -+ //return; -+ } -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ if( (pCoexSta->lowPriorityTx > 1150) && (!pCoexSta->bC2hBtInquiryPage)) -+ pCoexSta->popEventCnt++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", -+ regHPRx, regHPTx, regLPRx, regLPTx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+ -+ if ((regHPTx == 0) && (regHPRx ==0) && (regLPTx == 0) && (regLPRx == 0)) -+ { -+ NumOfBtCounterChk++; -+ if (NumOfBtCounterChk >= 3) -+ { -+ halbtc8703b1ant_QueryBtInfo(pBtCoexist); -+ NumOfBtCounterChk = 0; -+ } -+ } -+} -+ -+ -+VOID -+halbtc8703b1ant_MonitorWiFiCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ u2Byte u2Tmp[3]; -+ s4Byte wifiRssi=0; -+ BOOLEAN bWifiBusy = FALSE, bWifiUnderBMode = FALSE; -+ static u1Byte nCCKLockCounter = 0; -+ u4Byte TotalCnt; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ -+ if (pCoexSta->bUnderIps) -+ { -+ pCoexSta->nCRCOK_CCK = 0; -+ pCoexSta->nCRCOK_11g = 0; -+ pCoexSta->nCRCOK_11n = 0; -+ pCoexSta->nCRCOK_11nAgg = 0; -+ -+ pCoexSta->nCRCErr_CCK = 0; -+ pCoexSta->nCRCErr_11g = 0; -+ pCoexSta->nCRCErr_11n = 0; -+ pCoexSta->nCRCErr_11nAgg = 0; -+ } -+ else -+ { -+ pCoexSta->nCRCOK_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf88); -+ pCoexSta->nCRCOK_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf94); -+ pCoexSta->nCRCOK_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf90); -+ pCoexSta->nCRCOK_11nAgg= pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfb8); -+ -+ pCoexSta->nCRCErr_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf84); -+ pCoexSta->nCRCErr_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf96); -+ pCoexSta->nCRCErr_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf92); -+ pCoexSta->nCRCErr_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfba); -+ } -+ -+ -+ //reset counter -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x1); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x0); -+ -+ if ( (bWifiBusy) && (wifiRssi >= 30) && (!bWifiUnderBMode)) -+ { -+ TotalCnt = pCoexSta->nCRCOK_CCK + pCoexSta->nCRCOK_11g + pCoexSta->nCRCOK_11n + -+ pCoexSta->nCRCOK_11nAgg; -+ -+ if ( (pCoexDm->btStatus == BT_8703B_1ANT_BT_STATUS_ACL_BUSY) || -+ (pCoexDm->btStatus == BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY) || -+ (pCoexDm->btStatus == BT_8703B_1ANT_BT_STATUS_SCO_BUSY) ) -+ { -+ if (pCoexSta->nCRCOK_CCK >(TotalCnt -pCoexSta->nCRCOK_CCK)) -+ { -+ if (nCCKLockCounter < 3) -+ nCCKLockCounter++; -+ } -+ else -+ { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ -+ } -+ else -+ { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ } -+ else -+ { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ -+ if (!pCoexSta->bPreCCKLock) -+ { -+ -+ if (nCCKLockCounter >= 3) -+ pCoexSta->bCCKLock = TRUE; -+ else -+ pCoexSta->bCCKLock = FALSE; -+ } -+ else -+ { -+ if (nCCKLockCounter == 0) -+ pCoexSta->bCCKLock = FALSE; -+ else -+ pCoexSta->bCCKLock = TRUE; -+ } -+ -+ if (pCoexSta->bCCKLock) -+ pCoexSta->bCCKEverLock = TRUE; -+ -+ pCoexSta->bPreCCKLock = pCoexSta->bCCKLock; -+ -+ -+} -+ -+BOOLEAN -+halbtc8703b1ant_IsWifiStatusChanged( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreWifiBusy=FALSE, bPreUnder4way=FALSE, bPreBtHsOn=FALSE; -+ BOOLEAN bWifiBusy=FALSE, bUnder4way=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bWifiConnected=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ -+ if(bWifiConnected) -+ { -+ if(bWifiBusy != bPreWifiBusy) -+ { -+ bPreWifiBusy = bWifiBusy; -+ return TRUE; -+ } -+ if(bUnder4way != bPreUnder4way) -+ { -+ bPreUnder4way = bUnder4way; -+ return TRUE; -+ } -+ if(bBtHsOn != bPreBtHsOn) -+ { -+ bPreBtHsOn = bBtHsOn; -+ return TRUE; -+ } -+ } -+ -+ return FALSE; -+} -+ -+VOID -+halbtc8703b1ant_UpdateBtLinkInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pCoexSta->bScoExist; -+ pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist; -+ pBtLinkInfo->bPanExist = pCoexSta->bPanExist; -+ pBtLinkInfo->bHidExist = pCoexSta->bHidExist; -+ pBtLinkInfo->bBtHiPriLinkExist = pCoexSta->bBtHiPriLinkExist; -+ -+ // work around for HS mode. -+ if(bBtHsOn) -+ { -+ pBtLinkInfo->bPanExist = TRUE; -+ pBtLinkInfo->bBtLinkExist = TRUE; -+ } -+ -+ // check if Sco only -+ if( pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bScoOnly = TRUE; -+ else -+ pBtLinkInfo->bScoOnly = FALSE; -+ -+ // check if A2dp only -+ if( !pBtLinkInfo->bScoExist && -+ pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bA2dpOnly = TRUE; -+ else -+ pBtLinkInfo->bA2dpOnly = FALSE; -+ -+ // check if Pan only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bPanOnly = TRUE; -+ else -+ pBtLinkInfo->bPanOnly = FALSE; -+ -+ // check if Hid only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bHidOnly = TRUE; -+ else -+ pBtLinkInfo->bHidOnly = FALSE; -+} -+ -+VOID -+halbtc8703b1ant_UpdateWifiChannelInfo( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ BOOLEAN bWifiUnderBMode = FALSE; -+ -+ // only 2.4G we need to inform bt the chnl mask -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if( (BTC_MEDIA_CONNECT == type) && -+ (wifiCentralChnl <= 14) ) -+ { -+ H2C_Parameter[0] = 0x1; //enable BT AFH skip WL channel for 8703b because BT Rx LO interference -+ //H2C_Parameter[0] = 0x0; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x66=0x%x\n", -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter); -+ -+} -+ -+u1Byte -+halbtc8703b1ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ u1Byte algorithm=BT_8703B_1ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!pBtLinkInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No BT link exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pBtLinkInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(numOfDiffProfile == 1) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO only\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID only\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP only\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_A2DP; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = PAN(HS) only\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = PAN(EDR) only\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 2) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_SCO; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + PAN(HS)\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + PAN(EDR)\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + PAN(HS)\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + PAN(EDR)\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP + PAN(HS)\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_A2DP_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP + PAN(EDR)\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_HID; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + PAN(HS)\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile >= 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+VOID -+halbtc8703b1ant_SetBtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = 0; -+ -+ if(bEnableAutoReport) -+ { -+ H2C_Parameter[0] |= BIT0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], BT FW auto report : %s, FW write 0x68=0x%x\n", -+ (bEnableAutoReport? "Enabled!!":"Disabled!!"), H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x68, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8703b1ant_BtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s BT Auto report = %s\n", -+ (bForceExec? "force to":""), ((bEnableAutoReport)? "Enabled":"Disabled"))); -+ pCoexDm->bCurBtAutoReport = bEnableAutoReport; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreBtAutoReport == pCoexDm->bCurBtAutoReport) -+ return; -+ } -+ halbtc8703b1ant_SetBtAutoReport(pBtCoexist, pCoexDm->bCurBtAutoReport); -+ -+ pCoexDm->bPreBtAutoReport = pCoexDm->bCurBtAutoReport; -+} -+ -+VOID -+halbtc8703b1ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte H2C_Parameter[6] ={0}; -+ -+ H2C_Parameter[0] = 0x6; // opCode, 0x6= Retry_Penalty -+ -+ if(bLowPenaltyRa) -+ { -+ H2C_Parameter[1] |= BIT0; -+ H2C_Parameter[2] = 0x00; //normal rate except MCS7/6/5, OFDM54/48/36 -+ H2C_Parameter[3] = 0xf7; //MCS7 or OFDM54 -+ H2C_Parameter[4] = 0xf8; //MCS6 or OFDM48 -+ H2C_Parameter[5] = 0xf9; //MCS5 or OFDM36 -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set WiFi Low-Penalty Retry: %s", -+ (bLowPenaltyRa? "ON!!":"OFF!!") )); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter); -+} -+ -+VOID -+halbtc8703b1ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8703b1ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+u4Byte -+halbtc8703b1ant_LTECoex_InDirectReadReg( -+IN PBTC_COEXIST pBtCoexist, -+IN u2Byte RegAddr -+) -+{ -+ u4Byte j =0; -+ -+ -+ //wait for ready bit before access 0x7c0 -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x7c0, 0x800F0000|RegAddr); -+ -+ do -+ { -+ j++; -+ }while( ((pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x7c3) & BIT5) ==0) && (j fBtcRead4Byte(pBtCoexist, 0x7c8)); //get read data -+ -+} -+ -+VOID -+halbtc8703b1ant_LTECoex_InDirectWriteReg( -+IN PBTC_COEXIST pBtCoexist, -+IN u2Byte RegAddr, -+IN u4Byte BitMask, -+IN u4Byte RegValue -+) -+{ -+ u4Byte val, i=0, j=0, bitpos = 0; -+ -+ -+ if (BitMask == 0x0) -+ return; -+ if (BitMask == 0xffffffff) -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x7c4, RegValue); //put write data -+ -+ //wait for ready bit before access 0x7c0 -+ do -+ { -+ j++; -+ }while( ((pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x7c3) & BIT5) ==0) && (j fBtcWrite4Byte(pBtCoexist, 0x7c0, 0xc00F0000|RegAddr); -+ } -+ else -+ { -+ for(i=0; i<=31; i++) -+ { -+ if ( ((BitMask >> i) & 0x1) == 0x1) -+ { -+ bitpos = i; -+ break; -+ } -+ } -+ -+ //read back register value before write -+ val = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, RegAddr); -+ val = (val & (~BitMask)) | (RegValue << bitpos); -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x7c4, val); //put write data -+ -+ //wait for ready bit before access 0x7c0 -+ do -+ { -+ j++; -+ }while( ((pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x7c3) & BIT5) ==0) && (j fBtcWrite4Byte(pBtCoexist, 0x7c0, 0xc00F0000|RegAddr); -+ -+ } -+ -+} -+ -+void -+halbtc8703b1ant_LTECoex_Enable( -+IN PBTC_COEXIST pBtCoexist, -+IN BOOLEAN bEnable -+) -+{ -+ u1Byte val; -+ -+ val = (bEnable)? 1 : 0; -+ halbtc8703b1ant_LTECoex_InDirectWriteReg(pBtCoexist, 0x38, 0x80, val); //0x38[7] -+ -+} -+ -+void -+halbtc8703b1ant_LTECoex_PathControlOwner( -+IN PBTC_COEXIST pBtCoexist, -+IN BOOLEAN bWiFiControl -+) -+{ -+ u1Byte val; -+ -+ val = (bWiFiControl)? 1 : 0; -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x73, 0x4, val); //0x70[26] -+ -+} -+ -+void -+halbtc8703b1ant_LTECoex_Set_GNT_BT( -+IN PBTC_COEXIST pBtCoexist, -+IN u1Byte nControlBlock, -+IN BOOLEAN bSWControl, -+IN u1Byte nState -+) -+{ -+ u4Byte val=0, BitMask; -+ -+ nState = nState & 0x1; -+ val = (bSWControl)? ((nState<<1) | 0x1) : 0; -+ -+ switch(nControlBlock) -+ { -+ case RFC_AND_BB: -+ default: -+ BitMask = 0xc000; -+ halbtc8703b1ant_LTECoex_InDirectWriteReg(pBtCoexist, 0x38, BitMask, val); // 0x38[15:14] -+ BitMask = 0x0c00; -+ halbtc8703b1ant_LTECoex_InDirectWriteReg(pBtCoexist, 0x38, BitMask, val); // 0x38[11:10] -+ break; -+ case RFC_ONLY: -+ BitMask = 0xc000; -+ halbtc8703b1ant_LTECoex_InDirectWriteReg(pBtCoexist, 0x38, BitMask, val); // 0x38[15:14] -+ break; -+ case BB_ONLY: -+ BitMask = 0x0c00; -+ halbtc8703b1ant_LTECoex_InDirectWriteReg(pBtCoexist, 0x38, BitMask, val); // 0x38[11:10] -+ break; -+ -+ } -+ -+} -+ -+void -+halbtc8703b1ant_LTECoex_Set_GNT_WL( -+IN PBTC_COEXIST pBtCoexist, -+IN u1Byte nControlBlock, -+IN BOOLEAN bSWControl, -+IN u1Byte nState -+) -+{ -+ u4Byte val=0, BitMask; -+ -+ nState = nState & 0x1; -+ val = (bSWControl)? ((nState<<1) | 0x1) : 0; -+ -+ switch(nControlBlock) -+ { -+ case RFC_AND_BB: -+ default: -+ BitMask = 0x3000; -+ halbtc8703b1ant_LTECoex_InDirectWriteReg(pBtCoexist, 0x38, BitMask, val); // 0x38[13:12] -+ BitMask = 0x0300; -+ halbtc8703b1ant_LTECoex_InDirectWriteReg(pBtCoexist, 0x38, BitMask, val); // 0x38[9:8] -+ break; -+ case RFC_ONLY: -+ BitMask = 0x3000; -+ halbtc8703b1ant_LTECoex_InDirectWriteReg(pBtCoexist, 0x38, BitMask, val); // 0x38[13:12] -+ break; -+ case BB_ONLY: -+ BitMask = 0x0300; -+ halbtc8703b1ant_LTECoex_InDirectWriteReg(pBtCoexist, 0x38, BitMask, val); // 0x38[9:8] -+ break; -+ -+ } -+ -+} -+ -+void -+halbtc8703b1ant_LTECoex_Set_CoexTable( -+IN PBTC_COEXIST pBtCoexist, -+IN u1Byte nTableType, -+IN u2Byte nTableContent -+) -+{ -+ u2Byte RegAddr = 0x0000; -+ -+ switch(nTableType) -+ { -+ case WL_VS_LTE: -+ RegAddr = 0xa0; -+ break; -+ case BT_VS_LTE: -+ RegAddr = 0xa4; -+ break; -+ } -+ -+ if (RegAddr != 0x0000) -+ halbtc8703b1ant_LTECoex_InDirectWriteReg(pBtCoexist, RegAddr, 0xffff, nTableContent); // 0xa0[15:0] or 0xa4[15:0] -+ -+ -+} -+ -+ -+void -+halbtc8703b1ant_LTECoex_Set_BreakTable( -+IN PBTC_COEXIST pBtCoexist, -+IN u1Byte nTableType, -+IN u1Byte nTableContent -+) -+{ -+ u2Byte RegAddr = 0x0000; -+ -+ switch(nTableType) -+ { -+ case WL_BREAK_LTE: -+ RegAddr = 0xa8; -+ break; -+ case BT_BREAK_LTE: -+ RegAddr = 0xac; -+ break; -+ case LTE_BREAK_WL: -+ RegAddr = 0xb0; -+ break; -+ case LTE_BREAK_BT: -+ RegAddr = 0xb4; -+ break; -+ } -+ -+ if (RegAddr != 0x0000) -+ halbtc8703b1ant_LTECoex_InDirectWriteReg(pBtCoexist, RegAddr, 0xff, nTableContent); // 0xa8[15:0] or 0xb4[15:0] -+ -+ -+} -+ -+VOID -+halbtc8703b1ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8703b1ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c4=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c4, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8703b1ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8703b1ant_CoexTableWithType( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ -+ u4Byte nBreakTable; -+ u1Byte nSelectTable; -+ -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], ********** CoexTable(%d) **********\n", type)); -+ -+ pCoexSta->nCoexTableType = type; -+ -+ if (pCoexSta->bConCurrentRxModeOn == true) -+ { -+ nBreakTable = 0xf0ffffff; //set WL hi-pri can break BT -+ nSelectTable = 0xb; //set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) -+ } -+ else -+ { -+ nBreakTable = 0xffffff; -+ nSelectTable = 0x3; -+ } -+ -+ switch(type) -+ { -+ case 0: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x55555555, nBreakTable, nSelectTable); -+ break; -+ case 1: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, nBreakTable, nSelectTable); -+ break; -+ case 2: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0xaa5a5a5a, 0xaa5a5a5a, nBreakTable, nSelectTable); -+ break; -+ case 3: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0xaa555555, 0xaa5a5a5a, nBreakTable, nSelectTable); -+ break; -+ case 4: -+ if ( (pCoexSta->bCCKEverLock) && (pCoexSta->nScanAPNum <= 5) ) -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0xaa555555, 0xaaaa5a5a, nBreakTable, nSelectTable); -+ else -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0xaa555555, 0xaa5a5a5a, nBreakTable, nSelectTable); -+ break; -+ case 5: -+ if ( (pCoexSta->bCCKEverLock) && (pCoexSta->nScanAPNum <= 5) ) -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0xaa555555, 0xaaaa5a5a, nBreakTable, nSelectTable); -+ else -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0xaa5a5a5a, 0xaa5a5a5a, nBreakTable, nSelectTable); -+ break; -+ case 6: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0xaaaaaaaa, nBreakTable, nSelectTable); -+ break; -+ case 7: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0xaaaaaaaa, 0xaaaaaaaa, nBreakTable, nSelectTable); -+ break; -+ case 8: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, nBreakTable, nSelectTable); -+ break; -+ case 9: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, nBreakTable, nSelectTable); -+ break; -+ case 10: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, nBreakTable, nSelectTable); -+ break; -+ case 11: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, nBreakTable, nSelectTable); -+ break; -+ case 12: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, nBreakTable, nSelectTable); -+ break; -+ case 13: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0xaaaaaaaa, nBreakTable, nSelectTable); -+ break; -+ case 14: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0x5ada5ada, nBreakTable, nSelectTable); -+ break; -+ case 15: -+ halbtc8703b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0xaaaaaaaa, nBreakTable, nSelectTable); -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8703b1ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(bEnable) -+ { -+ H2C_Parameter[0] |= BIT0; // function enable -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8703b1ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8703b1ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8703b1ant_SetLpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ u1Byte lps=lpsVal; -+ u1Byte rpwm=rpwmVal; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+VOID -+halbtc8703b1ant_LpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bForceExecPwrCmd=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set lps/rpwm=0x%x/0x%x \n", -+ (bForceExec? "force to":""), lpsVal, rpwmVal)); -+ pCoexDm->curLps = lpsVal; -+ pCoexDm->curRpwm = rpwmVal; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preLps == pCoexDm->curLps) && -+ (pCoexDm->preRpwm == pCoexDm->curRpwm) ) -+ { -+ return; -+ } -+ } -+ halbtc8703b1ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal); -+ -+ pCoexDm->preLps = pCoexDm->curLps; -+ pCoexDm->preRpwm = pCoexDm->curRpwm; -+} -+ -+VOID -+halbtc8703b1ant_SwMechanism( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRA -+ ) -+{ -+ halbtc8703b1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA); -+} -+ -+VOID -+halbtc8703b1ant_SetAntPath( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte antPosType, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bInitHwCfg, -+ IN BOOLEAN bWifiOff -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte fwVer=0, u4Tmp=0, cntBtCalChk=0; -+ BOOLEAN bPgExtSwitch=FALSE; -+ BOOLEAN bUseExtSwitch=FALSE; -+ BOOLEAN bIsInMpMode = FALSE; -+ u1Byte H2C_Parameter[2] ={0}, u1Tmp = 0; -+ u4Byte u4Tmp1=0, u4Tmp2=0; -+ -+ pCoexDm->curAntPosType = antPosType; -+ -+#if 1 -+ u4Tmp1 = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0x38); -+ u4Tmp2 = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0x54); -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x73); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** (Before Setup) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", u1Tmp, u4Tmp1, u4Tmp2)); -+#endif -+ -+ if(bInitHwCfg) -+ { -+ //Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) -+ halbtc8703b1ant_LTECoex_Enable(pBtCoexist, 0x0); -+ -+ //GNT_WL_LTE always = 1 (this should be config if LTE coex is required) -+ halbtc8703b1ant_LTECoex_Set_CoexTable(pBtCoexist, WL_VS_LTE, 0xffff); -+ -+ //GNT_BT_LTE always = 1 (this should be config if LTE coex is required) -+ halbtc8703b1ant_LTECoex_Set_CoexTable(pBtCoexist, BT_VS_LTE, 0xffff); -+ -+ // Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) -+ while(cntBtCalChk <= 20) -+ { -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49d); -+ cntBtCalChk++; -+ if(u1Tmp & BIT0) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", cntBtCalChk)); -+ delay_ms(50); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", cntBtCalChk)); -+ break; -+ } -+ } -+ -+ //set Path control owner to WL at initial step -+ halbtc8703b1ant_LTECoex_PathControlOwner(pBtCoexist, WLSIDE_CONTROL); -+ } -+ else if(bWifiOff) -+ { -+ //Disable LTE Coex Function in WiFi side -+ halbtc8703b1ant_LTECoex_Enable(pBtCoexist, 0x0); -+ -+ //if MP mode -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, &bIsInMpMode); -+ if(bIsInMpMode) -+ halbtc8703b1ant_LTECoex_PathControlOwner(pBtCoexist, WLSIDE_CONTROL); //set Path control owner to BT -+ else -+ halbtc8703b1ant_LTECoex_PathControlOwner(pBtCoexist, BTSIDE_CONTROL);//set Path control owner to WiFi -+ } -+ else -+ { -+ // -+ } -+ -+ -+ if(bForceExec || (pCoexDm->curAntPosType != pCoexDm->preAntPosType) || bInitHwCfg || bWifiOff) -+ { -+ // internal switch setting -+ switch(antPosType) -+ { -+ case BTC_ANT_PATH_WIFI: -+ // set GNT_BT to low -+ halbtc8703b1ant_LTECoex_Set_GNT_BT(pBtCoexist, RFC_AND_BB, CONTROL_BY_SW, SET_TO_LOW); -+ //Set GNT_WL to high -+ halbtc8703b1ant_LTECoex_Set_GNT_WL(pBtCoexist, RFC_AND_BB, CONTROL_BY_SW, SET_TO_HIGH); -+ break; -+ case BTC_ANT_PATH_BT: -+ // set GNT_BT to high -+ halbtc8703b1ant_LTECoex_Set_GNT_BT(pBtCoexist, RFC_AND_BB, CONTROL_BY_SW, SET_TO_HIGH); -+ //Set GNT_WL to low -+ halbtc8703b1ant_LTECoex_Set_GNT_WL(pBtCoexist, RFC_AND_BB, CONTROL_BY_SW, SET_TO_LOW); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ // set GNT_BT to PTA -+ halbtc8703b1ant_LTECoex_Set_GNT_BT(pBtCoexist, RFC_AND_BB, CONTROL_BY_PTA, SET_BY_HW); -+ //Set GNT_WL to PTA -+ halbtc8703b1ant_LTECoex_Set_GNT_WL(pBtCoexist, RFC_AND_BB, CONTROL_BY_PTA, SET_BY_HW); -+ break; -+ } -+ } -+ -+#if 1 -+ u4Tmp1 = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0x38); -+ u4Tmp2 = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0x54); -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x73); -+ -+ if(bInitHwCfg) -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** (After Init) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", u1Tmp, u4Tmp1, u4Tmp2)); -+ else if (bWifiOff) -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** (After WiFi off) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", u1Tmp, u4Tmp1, u4Tmp2)); -+ else -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** (After Run time) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", u1Tmp, u4Tmp1, u4Tmp2)); -+#endif -+ -+ pCoexDm->preAntPosType = pCoexDm->curAntPosType; -+} -+ -+ -+VOID -+halbtc8703b1ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ u1Byte realByte1=byte1, realByte5=byte5; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ if(bApEnable) -+ { -+ if(byte1&BIT4 && !(byte1&BIT5)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FW for 1Ant AP mode\n")); -+ realByte1 &= ~BIT4; -+ realByte1 |= BIT5; -+ -+ realByte5 |= BIT5; -+ realByte5 &= ~BIT6; -+ } -+ } -+ -+ H2C_Parameter[0] = realByte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = realByte5; -+ -+ pCoexDm->psTdmaPara[0] = realByte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = realByte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], PS-TDMA H2C cmd =0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter); -+} -+ -+ -+VOID -+halbtc8703b1ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bTurnOnByCnt=FALSE, bWifiBusy=FALSE, bWiFiNoisy=FALSE; -+ u1Byte psTdmaTypeByCnt=0, rssiAdjustVal=0; -+ u1Byte psTdmaByte4Val = 0x50, psTdmaByte0Val = 0x51, psTdmaByte3Val = 0x10; -+ s1Byte nWiFiDurationAdjust = 0x0; -+ static BOOLEAN bPreWifiBusy=FALSE; -+ -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if (bWifiBusy != bPreWifiBusy) -+ { -+ bForceExec = TRUE; -+ bPreWifiBusy = bWifiBusy; -+ } -+ -+ if (pCoexDm->bCurPsTdmaOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(on, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(off, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ -+ if (pCoexSta->nScanAPNum <= 5) -+ nWiFiDurationAdjust = 5; -+ //nWiFiDurationAdjust = 2; -+ else if (pCoexSta->nScanAPNum >= 40) -+ nWiFiDurationAdjust = -15; -+ else if (pCoexSta->nScanAPNum >= 20) -+ nWiFiDurationAdjust = -10; -+ -+ if ((type == 1) || (type == 2) || (type == 9) || (type == 11) || (type == 101) -+ || (type == 102) || (type == 109) || (type == 101)) -+ { -+ if (!pCoexSta->bForceLpsOn) //Native power save TDMA, only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 -+ { -+ psTdmaByte0Val = 0x61; //no null-pkt -+ psTdmaByte3Val = 0x11; // no tx-pause at BT-slot -+ psTdmaByte4Val = 0x10; // 0x778 = d/1 toggle, no dynamic slot -+ } -+ else -+ { -+ psTdmaByte0Val = 0x51; //null-pkt -+ psTdmaByte3Val = 0x10; //tx-pause at BT-slot -+ psTdmaByte4Val = 0x50; // 0x778 = d/1 toggle, dynamic slot -+ } -+ } -+ else if ((type == 3) || (type == 13) || (type == 14) || (type == 103) || (type == 113) || (type == 114)) -+ { -+ psTdmaByte0Val = 0x51; //null-pkt -+ psTdmaByte3Val = 0x10; //tx-pause at BT-slot -+ psTdmaByte4Val = 0x10; // 0x778 = d/1 toggle, no dynamic slot -+#if 0 -+ if (!bWifiBusy) -+ psTdmaByte4Val = psTdmaByte4Val | 0x1; //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) -+#endif -+ } -+ else //native power save case -+ { -+ psTdmaByte0Val = 0x61; //no null-pkt -+ psTdmaByte3Val = 0x11; // no tx-pause at BT-slot -+ psTdmaByte4Val = 0x11; // 0x778 = d/1 toggle, no dynamic slot -+ //psTdmaByte4Va is not defne for 0x778 = d/1, 1/1 case -+ } -+ -+ //if (pBtLinkInfo->bSlaveRole == TRUE) -+ if ((pBtLinkInfo->bSlaveRole == TRUE) && (pBtLinkInfo->bA2dpExist)) -+ psTdmaByte4Val = psTdmaByte4Val | 0x1; //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) -+ -+ if (type > 100) -+ { -+ psTdmaByte0Val = psTdmaByte0Val | 0x82; //set antenna control by SW -+ psTdmaByte3Val = psTdmaByte3Val | 0x60; //set antenna no toggle, control by antenna diversity -+ } -+ -+ -+ if(bTurnOn) -+ { -+ switch(type) -+ { -+ default: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x1a, 0x1a, 0x0, psTdmaByte4Val); -+ break; -+ case 1: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 2: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x2d+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 3: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 4: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x93, 0x15, 0x3, 0x14, 0x0); -+ break; -+ case 5: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x15, 0x3, psTdmaByte3Val, 0x11); -+ break; -+ case 6: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x20, 0x3, psTdmaByte3Val, 0x11); -+ break; -+ case 7: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xc, 0x5, 0x0, 0x0); -+ break; -+ case 8: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 9: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 10: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 11: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 12: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x0a, 0x0a, 0x0, 0x50); -+ break; -+ case 13: -+ if (pCoexSta->nScanAPNum <= 3) // for Lenovo CPT test A2DP + OPP -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ else -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 14: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 15: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0x3, 0x8, 0x0); -+ break; -+ case 16: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x93, 0x15, 0x3, 0x10, 0x0); -+ break; -+ case 18: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 20: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3f, 0x03, psTdmaByte3Val, 0x10); -+ break; -+ case 21: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x11); -+ break; -+ case 22: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x25, 0x03, psTdmaByte3Val, 0x10); -+ break; -+ case 23: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x18); -+ break; -+ case 24: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x3, 0x31, 0x18); -+ break; -+ case 25: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 26: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 27: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x98); -+ break; -+ case 28: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x69, 0x25, 0x3, 0x31, 0x0); -+ break; -+ case 29: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0xab, 0x1a, 0x1a, 0x1, 0x10); -+ break; -+ case 30: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x30, 0x3, 0x10, 0x10); -+ break; -+ case 31: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0xd3, 0x1a, 0x1a, 0, 0x58); -+ break; -+ case 32: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x35, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 33: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x35, 0x3, psTdmaByte3Val, 0x10); -+ break; -+ case 34: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x53, 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 35: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x63, 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 36: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0xd3, 0x12, 0x3, 0x14, 0x50); -+ break; -+ case 40: // SoftAP only with no sta associated,BT disable ,TDMA mode for power saving -+ /* here softap mode screen off will cost 70-80mA for phone */ -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x23, 0x18, 0x00, 0x10, 0x24); -+ break; -+ -+ //for 1-Ant translate to 2-Ant -+ case 101: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 102: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x2d+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 103: -+ //halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x1d, 0x1d, 0x0, psTdmaByte4Val); -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 105: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x15, 0x3, psTdmaByte3Val, 0x11); -+ break; -+ case 106: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x20, 0x3, psTdmaByte3Val, 0x11); -+ break; -+ case 109: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 111: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 113: -+ //halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x12, 0x12, 0x0, psTdmaByte4Val); -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 114: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 120: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3f, 0x03, psTdmaByte3Val, 0x10); -+ break; -+ case 122: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x25, 0x03, psTdmaByte3Val, 0x10); -+ break; -+ case 132: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x25, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 133: -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x25, 0x03, psTdmaByte3Val, 0x11); -+ break; -+ -+ } -+ } -+ else -+ { -+ -+ // disable PS tdma -+ switch(type) -+ { -+ case 8: //PTA Control -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x8, 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 0: -+ default: //Software control, Antenna at BT side -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 1: // 2-Ant, 0x778=3, antenna control by antenna diversity -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x48, 0x0); -+ break; -+#if 0 -+ case 9: //Software control, Antenna at WiFi side -+ halbtc8703b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_WIFI, FALSE, FALSE); -+ break; -+#endif -+ } -+ } -+ rssiAdjustVal =0; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssiAdjustVal); -+ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", -+ pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948), pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765), pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67))); -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+BOOLEAN -+halbtc8703b1ant_IsCommonAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE, bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if(!bWifiConnected && -+ BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n")); -+ -+ //halbtc8703b1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(bWifiConnected && -+ (BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT non connected-idle!!\n")); -+ -+ //halbtc8703b1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(!bWifiConnected && -+ (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT connected-idle!!\n")); -+ -+ //halbtc8703b1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(bWifiConnected && -+ (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT connected-idle!!\n")); -+ -+ //halbtc8703b1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(!bWifiConnected && -+ (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT Busy!!\n")); -+ -+ //halbtc8703b1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ if (bWifiBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n")); -+ } -+ -+ bCommon = FALSE; -+ } -+ -+ return bCommon; -+} -+ -+ -+VOID -+halbtc8703b1ant_TdmaDurationAdjustForAcl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0, btInfoExt; -+ static BOOLEAN bPreWifiBusy=FALSE; -+ BOOLEAN bWifiBusy = FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjustForAcl()\n")); -+ -+ if(BT_8703B_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifiStatus) -+ bWifiBusy = TRUE; -+ else -+ bWifiBusy = FALSE; -+ -+ if( (BT_8703B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == wifiStatus) || -+ (BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifiStatus) || -+ (BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT == wifiStatus) ) -+ { -+ if( pCoexDm->curPsTdma != 1 && -+ pCoexDm->curPsTdma != 2 && -+ pCoexDm->curPsTdma != 3 && -+ pCoexDm->curPsTdma != 9 ) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ return; -+ } -+ -+ if(!pCoexDm->bAutoTdmaAdjust) -+ { -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if ( (pCoexSta->lowPriorityTx) > 1050 || (pCoexSta->lowPriorityRx) > 1250 ) -+ retryCount++; -+ -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ if(result == -1) -+ { -+/* if( (BT_INFO_8703B_1ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 1) ||(pCoexDm->curPsTdma == 2)) ) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else */ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ else if(result == 1) -+ { -+/* if( (BT_INFO_8703B_1ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 1) ||(pCoexDm->curPsTdma == 2)) ) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else */ if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ } -+ else //no change -+ { -+ /* Bryant Modify -+ if(bWifiBusy != bPreWifiBusy) //if busy / idle change -+ { -+ bPreWifiBusy = bWifiBusy; -+ halbtc8703b1ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, pCoexDm->curPsTdma); -+ } -+ */ -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], ********** TDMA(on, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ -+ if( pCoexDm->curPsTdma != 1 && -+ pCoexDm->curPsTdma != 2 && -+ pCoexDm->curPsTdma != 9 && -+ pCoexDm->curPsTdma != 11 ) -+ { -+ // recover to previous adjust type -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ } -+} -+ -+VOID -+halbtc8703b1ant_PsTdmaCheckForPowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bNewPsState -+ ) -+{ -+ u1Byte lpsMode=0x0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode); -+ -+ if(lpsMode) // already under LPS state -+ { -+ if(bNewPsState) -+ { -+ // keep state under LPS, do nothing. -+ } -+ else -+ { -+ // will leave LPS state, turn off psTdma first -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ } -+ } -+ else // NO PS state -+ { -+ if(bNewPsState) -+ { -+ // will enter LPS state, turn off psTdma first -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ } -+ else -+ { -+ // keep state under NO PS state, do nothing. -+ } -+ } -+} -+ -+VOID -+halbtc8703b1ant_PowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte psType, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bLowPwrDisable=FALSE; -+ -+ switch(psType) -+ { -+ case BTC_PS_WIFI_NATIVE: -+ // recover to original 32k low power setting -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8703b1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, TRUE); -+ halbtc8703b1ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal); -+ // when coex force to enter LPS, do not enter 32k low power. -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ // power save must executed before psTdma. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); -+ pCoexSta->bForceLpsOn = TRUE; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8703b1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, FALSE); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8703b1ant_ActionWifiOnly( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ halbtc8703b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+} -+ -+VOID -+halbtc8703b1ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ halbtc8703b1ant_ActionWifiOnly(pBtCoexist); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ bPreBtDisabled = bBtDisabled; -+ if(!bBtDisabled) -+ { -+ } -+ else -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ } -+ } -+} -+ -+//============================================= -+// -+// Software Coex Mechanism start -+// -+//============================================= -+ -+// SCO only or SCO+PAN(HS) -+ -+/* -+VOID -+halbtc8703b1ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+ -+VOID -+halbtc8703b1ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -+VOID -+halbtc8703b1ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8703b1ant_ActionA2dpPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8703b1ant_ActionPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+//PAN(HS) only -+VOID -+halbtc8703b1ant_ActionPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+//PAN(EDR)+A2DP -+VOID -+halbtc8703b1ant_ActionPanEdrA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8703b1ant_ActionPanEdrHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+// HID+A2DP+PAN(EDR) -+VOID -+halbtc8703b1ant_ActionHidA2dpPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+VOID -+halbtc8703b1ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+*/ -+ -+//============================================= -+// -+// Non-Software Coex Mechanism start -+// -+//============================================= -+VOID -+halbtc8703b1ant_ActionBtWhckTest( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8703b1ant_ActionWifiMultiPort( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+} -+ -+VOID -+halbtc8703b1ant_ActionHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+} -+ -+VOID -+halbtc8703b1ant_ActionBtInquiry( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE, bApEnable=FALSE, bWifiBusy=FALSE, bBtBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ if ( (!bWifiConnected) && (!pCoexSta->bWiFiIsHighPriTask) ) -+ { -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if( (pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist) || (pBtLinkInfo->bA2dpExist) ) -+ { -+ // SCO/HID/A2DP busy -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if ( (pBtLinkInfo->bPanExist) || (bWifiBusy) ) -+ { -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ //for BT inquiry/page fail after S4 resume -+ //halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ -+ -+ //halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ //halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+} -+ -+VOID -+halbtc8703b1ant_ActionBtScoHidOnlyBusy( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ // tdma and coex table -+ -+ if(pBtLinkInfo->bScoExist) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+ else //HID -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+} -+ -+VOID -+halbtc8703b1ant_ActionWifiConnectedBtAclBusy( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ u1Byte btRssiState; -+ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ btRssiState = halbtc8703b1ant_BtRssiState(2, 28, 0); -+ -+ if ( (pCoexSta->lowPriorityRx >= 950) && (!pCoexSta->bUnderIps) ) -+ { -+ pBtLinkInfo->bSlaveRole = TRUE; -+ } -+ else -+ { -+ pBtLinkInfo->bSlaveRole = FALSE; -+ } -+ -+ if(pBtLinkInfo->bHidOnly) //HID -+ { -+ halbtc8703b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, wifiStatus); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ return; -+ } -+ else if(pBtLinkInfo->bA2dpOnly) //A2DP -+ { -+ if(BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifiStatus) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else -+ { -+ halbtc8703b1ant_TdmaDurationAdjustForAcl(pBtCoexist, wifiStatus); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ } -+ } -+ else if ( ((pBtLinkInfo->bA2dpExist) && (pBtLinkInfo->bPanExist)) || -+ (pBtLinkInfo->bHidExist&&pBtLinkInfo->bA2dpExist&&pBtLinkInfo->bPanExist) ) //A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else if(pBtLinkInfo->bHidExist&&pBtLinkInfo->bA2dpExist) //HID+A2DP -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if( (pBtLinkInfo->bPanOnly) || (pBtLinkInfo->bHidExist&&pBtLinkInfo->bPanExist) ) //PAN(OPP,FTP), HID+PAN(OPP,FTP) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else -+ { -+ //BT no-profile busy (0x9) -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 33); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+} -+ -+VOID -+halbtc8703b1ant_ActionWifiNotConnected( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // power save state -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ halbtc8703b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8703b1ant_ActionWifiNotConnectedScan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(BT_8703B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ if (pBtLinkInfo->bA2dpExist) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ } -+ else if( (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8703b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } -+ else -+ { -+ //Bryant Add -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8703b1ant_ActionWifiNotConnectedAssoAuth( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if( (pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist) || (pBtLinkInfo->bA2dpExist) ) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bPanExist) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 4); -+ } -+ else -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8703b1ant_ActionWifiConnectedScan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(BT_8703B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ if (pBtLinkInfo->bA2dpExist) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ } -+ else if( (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8703b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } -+ else -+ { -+ //Bryant Add -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8703b1ant_ActionWifiConnectedSpecialPacket( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiBusy = FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ //no special packet process for both WiFi and BT very busy -+ if ((bWifiBusy) && ((pBtLinkInfo->bPanExist) || (pCoexSta->nNumOfProfile >= 2))) -+ return; -+ -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if((pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist)) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+ else if (pBtLinkInfo->bA2dpExist) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8703b1ant_ActionWifiConnected( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiBusy=FALSE; -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ BOOLEAN bUnder4way=FALSE, bApEnable=FALSE; -+ u4Byte wifiBw; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect()===>\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ if(bUnder4way) -+ { -+ halbtc8703b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ if(bScan || bLink || bRoam) -+ { -+ if(bScan) -+ halbtc8703b1ant_ActionWifiConnectedScan(pBtCoexist); -+ else -+ halbtc8703b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ // power save state -+ if(!bApEnable && BT_8703B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus && !pBtCoexist->btLinkInfo.bHidOnly) -+ { -+ if(pBtCoexist->btLinkInfo.bA2dpOnly) //A2DP -+ { -+ if(!bWifiBusy) -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else //busy -+ { -+ if (pCoexSta->nScanAPNum >= BT_8703B_1ANT_WIFI_NOISY_THRESH) //no force LPS, no PS-TDMA, use pure TDMA -+ { -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ } -+ } -+ else if ((pCoexSta->bPanExist == FALSE) && (pCoexSta->bA2dpExist == FALSE) && (pCoexSta->bHidExist == FALSE)) -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ else -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(!bWifiBusy) -+ { -+ if(BT_8703B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ halbtc8703b1ant_ActionWifiConnectedBtAclBusy(pBtCoexist, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } -+ else if( (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8703b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } -+ else -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ if ( (pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60 ) -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ else -+ { -+ if(BT_8703B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ halbtc8703b1ant_ActionWifiConnectedBtAclBusy(pBtCoexist, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } -+ else if( (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8703b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } -+ else -+ { -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ if ( (pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60 ) -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+} -+ -+VOID -+halbtc8703b1ant_RunSwCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte algorithm=0; -+ -+ algorithm = halbtc8703b1ant_ActionAlgorithm(pBtCoexist); -+ pCoexDm->curAlgorithm = algorithm; -+ -+ if(halbtc8703b1ant_IsCommonAction(pBtCoexist)) -+ { -+ -+ } -+ else -+ { -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8703B_1ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = SCO.\n")); -+ //halbtc8703b1ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID.\n")); -+ //halbtc8703b1ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = A2DP.\n")); -+ //halbtc8703b1ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_A2DP_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = A2DP+PAN(HS).\n")); -+ //halbtc8703b1ant_ActionA2dpPanHs(pBtCoexist); -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN(EDR).\n")); -+ //halbtc8703b1ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HS mode.\n")); -+ //halbtc8703b1ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_PANEDR_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN+A2DP.\n")); -+ //halbtc8703b1ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_PANEDR_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN(EDR)+HID.\n")); -+ //halbtc8703b1ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID+A2DP+PAN.\n")); -+ //halbtc8703b1ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID+A2DP.\n")); -+ //halbtc8703b1ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = coexist All Off!!\n")); -+ //halbtc8703b1ant_CoexAllOff(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+} -+ -+VOID -+halbtc8703b1ant_RunCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bIncreaseScanDevNum=FALSE; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ BOOLEAN bMiracastPlusBt=FALSE; -+ u1Byte aggBufSize=5; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0, wifiBw; -+ u1Byte iotPeer=BTC_IOT_PEER_UNKNOWN; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism()===>\n")); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n")); -+ return; -+ } -+ -+ if(pBtCoexist->bStopCoexDm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n")); -+ return; -+ } -+ -+ if(pCoexSta->bUnderIps) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under IPS !!!\n")); -+ return; -+ } -+ -+ if(pCoexSta->bBtWhckTest) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is under WHCK TEST!!!\n")); -+ halbtc8703b1ant_ActionBtWhckTest(pBtCoexist); -+ return; -+ } -+ -+ if( (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ bIncreaseScanDevNum = TRUE; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, &bIncreaseScanDevNum); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ -+ if((numOfWifiLink>=2) || (wifiLinkStatus&WIFI_P2P_GO_CONNECTED)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], Multi-Port numOfWifiLink = %d, wifiLinkStatus = 0x%x\n", numOfWifiLink,wifiLinkStatus) ); -+ -+ if(pBtLinkInfo->bBtLinkExist) -+ { -+ halbtc8703b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ bMiracastPlusBt = TRUE; -+ } -+ else -+ { -+ halbtc8703b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ bMiracastPlusBt = FALSE; -+ } -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ halbtc8703b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ -+ if ( (pBtLinkInfo->bA2dpExist) && (pCoexSta->bC2hBtInquiryPage) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], BT Is Inquirying \n") ); -+ halbtc8703b1ant_ActionBtInquiry(pBtCoexist); -+ } -+ else -+ halbtc8703b1ant_ActionWifiMultiPort(pBtCoexist); -+ -+ return; -+ } -+ else -+ { -+ bMiracastPlusBt = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if ( (pBtLinkInfo->bBtLinkExist) && (bWifiConnected) ) -+ { -+ halbtc8703b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_IOT_PEER, &iotPeer); -+ -+ if(BTC_IOT_PEER_CISCO != iotPeer) -+ { -+ if(pBtLinkInfo->bScoExist)//if (pBtLinkInfo->bBtHiPriLinkExist) -+ halbtc8703b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x5); -+ else -+ halbtc8703b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x5); -+ } -+ else -+ { -+ if(pBtLinkInfo->bScoExist) -+ halbtc8703b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x5); -+ else -+ { -+ if (BTC_WIFI_BW_HT40==wifiBw) -+ halbtc8703b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x10); -+ else -+ halbtc8703b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x8); -+ } -+ } -+ -+ halbtc8703b1ant_SwMechanism(pBtCoexist, TRUE); -+ halbtc8703b1ant_RunSwCoexistMechanism(pBtCoexist); //just print debug message -+ } -+ else -+ { -+ halbtc8703b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8703b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x5); -+ -+ halbtc8703b1ant_SwMechanism(pBtCoexist, FALSE); -+ halbtc8703b1ant_RunSwCoexistMechanism(pBtCoexist); ////just print debug message -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], BT Is Inquirying \n") ); -+ halbtc8703b1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8703b1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ -+ if(!bWifiConnected) -+ { -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is non connected-idle !!!\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if(bScan || bLink || bRoam) -+ { -+ if (bScan) -+ halbtc8703b1ant_ActionWifiNotConnectedScan(pBtCoexist); -+ else -+ halbtc8703b1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist); -+ } -+ else -+ halbtc8703b1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else // wifi LPS/Busy -+ { -+ halbtc8703b1ant_ActionWifiConnected(pBtCoexist); -+ } -+} -+ -+u4Byte -+halbtc8703b1ant_PSD_Log2Base( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val -+ -+ ) -+{ -+ u1Byte i,j; -+ u4Byte tmp, tmp2, val_integerdB=0, tindex, shiftcount=0; -+ u4Byte result,val_fractiondB=0,Table_fraction[21]= {0,432, 332, 274, 232, 200, -+ 174, 151,132,115,100,86,74,62,51,42, -+ 32,23,15,7,0}; -+ -+ if (val == 0) -+ return 0; -+ -+ tmp = val; -+ -+ while(1) -+ { -+ if (tmp == 1) -+ break; -+ else -+ { -+ tmp = (tmp >> 1); -+ shiftcount++; -+ } -+ } -+ -+ -+ val_integerdB = shiftcount+1; -+ -+ tmp2=1; -+ for (j=1; j<= val_integerdB;j++) -+ tmp2 = tmp2*2; -+ -+ tmp = (val*100) /tmp2; -+ tindex = tmp/5; -+ -+ if (tindex > 20) -+ tindex = 20; -+ -+ val_fractiondB = Table_fraction[tindex]; -+ -+ result = val_integerdB*100 - val_fractiondB; -+ -+ return (result); -+ -+ -+} -+ -+VOID -+halbtc8703b1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ -+ // sw all off -+ halbtc8703b1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ //halbtc8703b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ //halbtc8703b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ pCoexSta->popEventCnt = 0; -+} -+ -+VOID -+halbtc8703b1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bBackUp, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte u4Tmp=0;//, fwVer; -+ u2Byte u2Tmp=0; -+ u1Byte u1Tmp=0, u1Tmpa=0, u1Tmpb=0; -+ u1Byte H2C_Parameter[2] ={0}; -+ -+ u4Byte u4Tmp1=0, u4Tmp2=0; -+ -+ -+ u4Tmp1 = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0x38); -+ u4Tmp2 = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0x54); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** (Before Init HW config) 0x38= 0x%x, 0x54= 0x%x**********\n", u4Tmp1, u4Tmp2)); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Init HW Config!!\n")); -+ -+ -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x550, 0x8, 0x1); //enable TBTT nterrupt -+ -+ //BT report packet sample rate -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, 0x5); -+ -+ // Enable BT counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x1); -+ -+ //Enable PTA (3-wire function form BT side) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0x20, 0x1); -+ -+ //Enable PTA (tx/rx signal form WiFi side) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x4c6, 0x10, 0x1); -+ -+ //enable GNT_WL/GNT_BT debug signal to GPIO14/15 -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x73, 0x8, 0x1); -+ -+ //enable GNT_WL -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x4e, 0x40, 0x0); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x1, 0x0); -+ -+ halbtc8703b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ -+ //Antenna config -+ if(bWifiOnly) -+ { -+ pCoexSta->bConCurrentRxModeOn = false; -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_WIFI, FORCE_EXEC, TRUE, FALSE); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_WIFI, FORCE_EXEC, FALSE, FALSE); -+ } -+ else -+ { -+ pCoexSta->bConCurrentRxModeOn = true; -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x953, 0x2, 0x1); -+ //RF 0x1[0] = 0 -> Set GNT_WL_RF_Rx always = 1 for con-current Rx -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0x1, 0x0); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, TRUE, FALSE); -+ } -+ -+ // PTA parameter -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+} -+ -+ -+ -+VOID -+halbtc8703b1ant_PSD_ShowData( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u4Byte nDeltaFreqPerPoint; -+ u4Byte freq,freq1,freq2,n=0,i=0, j=0, m=0, PsdRep1, PsdRep2; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n\n============[PSD info] (%d)============\n", -+ pPsdScan->nPSDGenCount); -+ CL_PRINTF(cliBuf); -+ -+ if (pPsdScan->nPSDGenCount == 0) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n No Data !!\n"); -+ CL_PRINTF(cliBuf); -+ return; -+ } -+ -+ if (pPsdScan->nPSDPoint == 0) -+ nDeltaFreqPerPoint = 0; -+ else -+ nDeltaFreqPerPoint = pPsdScan->nPSDBandWidth/pPsdScan->nPSDPoint; -+ -+ //if (pPsdScan->bIsPSDShowMaxOnly) -+ if (0) -+ { -+ PsdRep1 = pPsdScan->nPSDMaxValue/100; -+ PsdRep2 = pPsdScan->nPSDMaxValue - PsdRep1 * 100; -+ -+ freq = ((pPsdScan->nRealCentFreq-20) * 1000000 + pPsdScan->nPSDMaxValuePoint * nDeltaFreqPerPoint); -+ freq1 = freq/1000000; -+ freq2 = freq/1000 - freq1 * 1000; -+ -+ if (freq2 < 100) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq = %d.0%d MHz", -+ freq1, freq2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq = %d.%d MHz", -+ freq1, freq2); -+ -+ if (PsdRep2 < 10) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, ", Value = %d.0%d dB, (%d) \n", -+ PsdRep1, PsdRep2, pPsdScan->nPSDMaxValue); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, ", Value = %d.%d dB, (%d)\n", -+ PsdRep1, PsdRep2, pPsdScan->nPSDMaxValue); -+ -+ CL_PRINTF(cliBuf); -+ } -+ else -+ { -+ m = pPsdScan->nPSDStartPoint; -+ n = pPsdScan->nPSDStartPoint; -+ i = 1; -+ j = 1; -+ -+ while(1) -+ { -+ do -+ { -+ freq = ((pPsdScan->nRealCentFreq-20) * 1000000 + m * nDeltaFreqPerPoint); -+ freq1 = freq/1000000; -+ freq2 = freq/1000 - freq1 * 1000; -+ -+ if (i ==1) -+ { -+ if (freq2 == 0) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq%6d.0%2d", freq1,freq2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq%6d.%3d", freq1,freq2); -+ } -+ else if ( (i%8 == 0) || (m == pPsdScan->nPSDStopPoint) ) -+ { -+ if (freq2 == 0) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.000\n", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.0%2d\n", freq1,freq2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.%3d\n", freq1,freq2); -+ } -+ else -+ { -+ if (freq2 == 0) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.0%2d", freq1,freq2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.%3d", freq1,freq2); -+ } -+ -+ i++; -+ m++; -+ CL_PRINTF(cliBuf); -+ -+ }while( (i <= 8) && (m <= pPsdScan->nPSDStopPoint)); -+ -+ -+ do -+ { -+ PsdRep1 = pPsdScan->nPSDReport_MaxHold[n]/100; -+ PsdRep2 = pPsdScan->nPSDReport_MaxHold[n] - PsdRep1 * 100; -+ -+ if (j ==1) -+ { -+ if (PsdRep2 <10) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Val %7d.0%d", PsdRep1,PsdRep2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Val %7d.%d", PsdRep1,PsdRep2); -+ } -+ else if ( (j%8 == 0) || (n == pPsdScan->nPSDStopPoint) ) -+ { -+ if (PsdRep2 <10) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%7d.0%d\n", PsdRep1,PsdRep2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%7d.%d\n", PsdRep1,PsdRep2); -+ } -+ else -+ { -+ if (PsdRep2 <10) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%7d.0%d", PsdRep1,PsdRep2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%7d.%d", PsdRep1,PsdRep2); -+ } -+ -+ j++; -+ n++; -+ CL_PRINTF(cliBuf); -+ -+ } while( (j <= 8) && (n <= pPsdScan->nPSDStopPoint)); -+ -+ if ( (m > pPsdScan->nPSDStopPoint) || (n > pPsdScan->nPSDStopPoint) ) -+ break; -+ else -+ { -+ i = 1; -+ j = 1; -+ } -+ -+ } -+ } -+ -+ -+} -+ -+VOID -+halbtc8703b1ant_PSD_MaxHoldData( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte GenCount -+ ) -+{ -+ u4Byte i=0, i_max=0, val_max=0, j; -+ -+ if (GenCount== 1) -+ { -+ memcpy(pPsdScan->nPSDReport_MaxHold, pPsdScan->nPSDReport, BT_8703B_1ANT_ANTDET_PSD_POINTS*sizeof(u4Byte)); -+ -+ for (i= pPsdScan->nPSDStartPoint; i<=pPsdScan->nPSDStopPoint; i++) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Max_Hold i = %d, PSDReport = %d dB\n", i, pPsdScan->nPSDReport_MaxHold[i])); -+ } -+ -+ pPsdScan->nPSDMaxValuePoint = 0; -+ pPsdScan->nPSDMaxValue = 0; -+ -+ } -+ else -+ { -+ for (i= pPsdScan->nPSDStartPoint; i<=pPsdScan->nPSDStopPoint; i++) -+ { -+ if (pPsdScan->nPSDReport[i] > pPsdScan->nPSDReport_MaxHold[i]) -+ pPsdScan->nPSDReport_MaxHold[i] = pPsdScan->nPSDReport[i]; -+ -+ //search Max Value -+ if (i ==pPsdScan->nPSDStartPoint ) -+ { -+ i_max = i; -+ val_max = pPsdScan->nPSDReport_MaxHold[i]; -+ } -+ else -+ { -+ if (pPsdScan->nPSDReport_MaxHold[i] > val_max) -+ { -+ i_max = i; -+ val_max = pPsdScan->nPSDReport_MaxHold[i]; -+ } -+ } -+ -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Max_Hold i = %d, PSDReport = %d dB\n", i, pPsdScan->nPSDReport_MaxHold[i])); -+ -+ } -+ -+ pPsdScan->nPSDMaxValuePoint = i_max; -+ pPsdScan->nPSDMaxValue = val_max; -+ -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Max_Hold i_Max = %d, PSDReport_Max = %d dB\n", pPsdScan->nPSDMaxValuePoint -+ // ,pPsdScan->nPSDMaxValue)); -+ } -+ -+ -+} -+ -+u4Byte -+halbtc8703b1ant_PSD_GetData( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte nPoint -+ ) -+{ -+ //reg 0x808[9:0]: FFT data x -+ //reg 0x808[22]: 0-->1 to get 1 FFT data y -+ //reg 0x8b4[15:0]: FFT data y report -+ -+ u4Byte val = 0, psd_report =0; -+ -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x808); -+ -+ val &= 0xffbffc00; -+ val |= nPoint; -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x808, val); -+ -+ val |= 0x00400000; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x808, val); -+ -+ -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x8b4); -+ -+ psd_report = val & 0x0000ffff; -+ -+ return psd_report; -+} -+ -+ -+VOID -+halbtc8703b1ant_PSD_SweepPoint( -+IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN s4Byte offset, -+ IN u4Byte span, -+ IN u4Byte points, -+ IN u4Byte avgnum -+ ) -+{ -+ u4Byte i,val,n,k=0; -+ u4Byte nPoints=0, psd_report=0; -+ u4Byte nStartP=0, nStopP=0, nDeltaFreqPerPoint=156250; -+ u4Byte nPSDCenterFreq=20*10^6, freq,freq1,freq2; -+ BOOLEAN outloop = FALSE; -+ u1Byte flag = 0; -+ u4Byte tmp, PsdRep1, PsdRep2; -+ u4Byte WiFi_OriginalChannel = 1; -+ -+ pPsdScan->bIsPSDRunning = TRUE; -+ -+ do -+ { -+ switch(flag) -+ { -+ case 0: //Get PSD parameters -+ default: -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), centFreq=0x%x, offset=0x%x, span=0x%x\n", -+ // centFreq, offset, span)); -+ -+ pPsdScan->nPSDBandWidth = 40*1000000; -+ pPsdScan->nPSDPoint = points; -+ pPsdScan->nPSDStartBase = points/2; -+ pPsdScan->nPSDAvgNum = avgnum; -+ pPsdScan->nRealCentFreq = centFreq; -+ pPsdScan->nRealOffset = offset; -+ pPsdScan->nRealSpan = span; -+ -+ -+ nPoints = pPsdScan->nPSDPoint; -+ nDeltaFreqPerPoint = pPsdScan->nPSDBandWidth/pPsdScan->nPSDPoint; -+ -+ //PSD point setup -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x808); -+ val &= 0xffff0fff; -+ -+ switch(pPsdScan->nPSDPoint) -+ { -+ case 128: -+ val |= 0x0; -+ break; -+ case 256: -+ default: -+ val |=0x00004000; -+ break; -+ case 512: -+ val |= 0x00008000; -+ break; -+ case 1024: -+ val |= 0x0000c000; -+ break; -+ } -+ -+ switch(pPsdScan->nPSDAvgNum) -+ { -+ case 1: -+ val |= 0x0; -+ break; -+ case 8: -+ val |=0x00001000; -+ break; -+ case 16: -+ val |= 0x00002000; -+ break; -+ case 32: -+ default: -+ val |= 0x00003000; -+ break; -+ } -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x808, val); -+ -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), PSD BW= %d, DeltaFreq=%d\n" -+ // , pPsdScan->nPSDBandWidth, nDeltaFreqPerPoint)); -+ flag = 1; -+ break; -+ case 1: //calculate the PSD point index from freq/offset/span -+ nPSDCenterFreq = pPsdScan->nPSDBandWidth /2 +offset*(1000000); -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), PSD Center Freq = %d\n", (centFreq + offset))); -+ -+ nStartP = pPsdScan->nPSDStartBase + (nPSDCenterFreq - span *(1000000)/2) /nDeltaFreqPerPoint; -+ pPsdScan->nPSDStartPoint = nStartP - pPsdScan->nPSDStartBase; -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Start PSD Poin Matrix Index = %d\n", pPsdScan->nPSDStartPoint)); -+ -+ nStopP = pPsdScan->nPSDStartBase + (nPSDCenterFreq + span *(1000000)/2) /nDeltaFreqPerPoint; -+ pPsdScan->nPSDStopPoint = nStopP - pPsdScan->nPSDStartBase-1; -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Stop PSD Poin Matrix Index = %d\n",pPsdScan->nPSDStopPoint)); -+ -+ flag = 2; -+ break; -+ case 2: //set RF channel/BW/Mode -+ -+ //set 3-wire off -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x88c); -+ val |= 0x00300000; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x88c,val); -+ -+ //CCK off -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x800); -+ val &= 0xfeffffff; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x800,val); -+ -+ //store WiFi original channel -+ WiFi_OriginalChannel = pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x18, 0x3ff); -+ -+ //Set RF channel -+ if (centFreq == 2484) -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x18, 0x3ff, 0xe); -+ else -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x18, 0x3ff, (centFreq-2412)/5 + 1); //WiFi TRx Mask on -+ -+ //Set RF mode = Rx, RF Gain = 0x8a0 -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x0, 0xfffff, 0x308a0); -+ -+ //Set RF Rx filter corner -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0x3e4); -+ -+ //Set TRx mask off -+ //un-lock TRx Mask setup -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdd, 0x80, 0x1); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdf, 0x1, 0x1); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ flag = 3; -+ break; -+ case 3: -+ memset(pPsdScan->nPSDReport,0, pPsdScan->nPSDPoint*sizeof(u4Byte)); -+ nStartP = pPsdScan->nPSDStartPoint + pPsdScan->nPSDStartBase; -+ nStopP = pPsdScan->nPSDStopPoint + pPsdScan->nPSDStartBase + 1; -+ -+ i = nStartP; -+ -+ while (i < nStopP) -+ { -+ if (i >= nPoints) -+ { -+ psd_report = halbtc8703b1ant_PSD_GetData(pBtCoexist,i-nPoints); -+ } -+ else -+ { -+ psd_report = halbtc8703b1ant_PSD_GetData(pBtCoexist,i); -+ } -+ -+ if (psd_report == 0) -+ tmp = 0; -+ else -+ //tmp = 20*log10((double)psd_report); -+ //20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 -+ tmp = 6 * halbtc8703b1ant_PSD_Log2Base(pBtCoexist, psd_report); -+ -+ n = i-pPsdScan->nPSDStartBase; -+ pPsdScan->nPSDReport[n] = tmp; -+ PsdRep1 = pPsdScan->nPSDReport[n] /100; -+ PsdRep2 = pPsdScan->nPSDReport[n] - PsdRep1 * 100; -+ -+ freq = ((centFreq-20) * 1000000 + n * nDeltaFreqPerPoint); -+ freq1 = freq/1000000; -+ freq2 = freq/1000 - freq1 * 1000; -+/* -+ if (freq2 < 100) -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), i = %d (%d.0%d MHz)", n, freq1, freq2)); -+ else -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), i = %d (%d.%d MHz)", n, freq1, freq2)); -+ -+ if (PsdRep2 < 10) -+ RT_TRACE(COMP_COEX, DBG_LOUD, (", PSDReport = %d (%d.0%d dB)\n",psd_report, PsdRep1, PsdRep2)); -+ else -+ RT_TRACE(COMP_COEX, DBG_LOUD, (", PSDReport = %d (%d.%d dB)\n",psd_report, PsdRep1,PsdRep2)); -+*/ -+ i++; -+ -+ k=0; -+ -+ //Add Delay between PSD point -+ while(1) -+ { -+ if (k++ > 20000) -+ break; -+ } -+ -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint()==============\n")); -+ } -+ -+ flag = 100; -+ break; -+ case 99: //error -+ -+ outloop = TRUE; -+ break; -+ case 100: //recovery -+ -+ //set 3-wire on -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x88c); -+ val &=0xffcfffff; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x88c,val); -+ -+ //CCK on -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x800); -+ val |= 0x01000000; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x800,val); -+ -+ //PSD off -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x808); -+ val &=0xffbfffff; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x808,val); -+ -+ //TRx Mask on -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); -+ -+ //lock TRx Mask setup -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdd, 0x80, 0x0); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdf, 0x1, 0x0); -+ -+ //Set RF Rx filter corner -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0x0); -+ -+ //restore WiFi original channel -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x18, 0x3ff, WiFi_OriginalChannel); -+ -+ outloop = TRUE; -+ break; -+ -+ } -+ -+ }while (!outloop); -+ -+ -+ -+ pPsdScan->bIsPSDRunning = FALSE; -+ -+ -+} -+ -+//============================================================ -+// work around function start with wa_halbtc8703b1ant_ -+//============================================================ -+//============================================================ -+// extern function start with EXhalbtc8703b1ant_ -+//============================================================ -+VOID -+EXhalbtc8703b1ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u1Byte u1Tmp=0x0; -+ u2Byte u2Tmp=0x0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx Execute 8703b 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n")); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("Ant Det Finish = %s, Ant Det Number = %d\n", -+ (pBoardInfo->btdmAntDetFinish? "Yes":"No"), pBoardInfo->btdmAntNumByAntDet)); -+ -+ pBtCoexist->bStopCoexDm = TRUE; -+ -+ // enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. -+ u2Tmp = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x2); -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x2, u2Tmp|BIT0|BIT1); -+ -+ //set Path control owner to WiFi -+ halbtc8703b1ant_LTECoex_PathControlOwner(pBtCoexist, WLSIDE_CONTROL); -+ -+ // set GNT_BT to high -+ halbtc8703b1ant_LTECoex_Set_GNT_BT(pBtCoexist, RFC_AND_BB, CONTROL_BY_SW, SET_TO_HIGH); -+ //Set GNT_WL to low -+ halbtc8703b1ant_LTECoex_Set_GNT_WL(pBtCoexist, RFC_AND_BB, CONTROL_BY_SW, SET_TO_LOW); -+ -+ // set WLAN_ACT = 0 -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ // -+ // S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) -+ // Local setting bit define -+ // BIT0: "0" for no antenna inverse; "1" for antenna inverse -+ // BIT1: "0" for internal switch; "1" for external switch -+ // BIT2: "0" for one antenna; "1" for two antenna -+ // NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 -+ -+ u1Tmp = 0; -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+ -+ if(pBtCoexist->chipInterface == BTC_INTF_USB) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0xfe08, u1Tmp); -+ } -+ else if(pBtCoexist->chipInterface == BTC_INTF_SDIO) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x60, u1Tmp); -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0x38))); -+ -+ -+#if 0 -+ if(pBtCoexist->chipInterface == BTC_INTF_USB) -+ { -+ // fixed at S0 for USB interface -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ -+ u1Tmp |= 0x1; // antenna inverse -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0xfe08, u1Tmp); -+ -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ else -+ { -+ -+ // for PCIE and SDIO interface, we check efuse 0xc3[6] -+ if(pBoardInfo->singleAntPath == 0) -+ { -+ // set to S1 -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280); -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+ } -+ else if(pBoardInfo->singleAntPath == 1) -+ { -+ // set to S0 -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ u1Tmp |= 0x1; // antenna inverse -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ -+ -+ -+ if(pBtCoexist->chipInterface == BTC_INTF_PCI) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x384, u1Tmp); -+ } -+ else if(pBtCoexist->chipInterface == BTC_INTF_SDIO) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x60, u1Tmp); -+ } -+ } -+ -+#endif -+} -+ -+VOID -+EXhalbtc8703b1ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8703b1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ halbtc8703b1ant_InitHwConfig(pBtCoexist, TRUE, bWifiOnly); -+ pBtCoexist->bStopCoexDm = FALSE; -+} -+ -+VOID -+EXhalbtc8703b1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ pBtCoexist->bStopCoexDm = FALSE; -+ -+ halbtc8703b1ant_InitCoexDm(pBtCoexist); -+ -+ halbtc8703b1ant_QueryBtInfo(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8703b1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u2Byte u2Tmp[4]; -+ u4Byte u4Tmp[4]; -+ u4Byte faOfdm, faCck; -+ u4Byte fwVer=0, btPatchVer=0; -+ static u1Byte PopReportIn10s = 0; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ if(pBtCoexist->bStopCoexDm) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ -+ if (pPsdScan->bAntDet_TryCount == 0) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "Ant PG Num/ Mech/ Pos", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos); -+ CL_PRINTF(cliBuf); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d (%d/%d/%d)", "Ant PG Num/ Mech(Ant_Det)/ Pos", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNumByAntDet, pBoardInfo->btdmAntPos, -+ pPsdScan->bAntDet_TryCount, pPsdScan->bAntDet_FailCount, pPsdScan->nAntDet_Result); -+ CL_PRINTF(cliBuf); -+ -+ if (pBoardInfo->btdmAntDetFinish) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "Ant Det PSD Value", pPsdScan->nAntDet_PeakVal); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", "CoexVer/ FwVer/ PatchVer", \ -+ GLCoexVerDate8703b1Ant, GLCoexVer8703b1Ant, fwVer, btPatchVer, btPatchVer); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", "WifibHiPri/ Ccklock/ CckEverLock", \ -+ (pCoexSta->bWiFiIsHighPriTask? "Yes":"No"), -+ (pCoexSta->bCCKLock? "Yes":"No"), -+ (pCoexSta->bCCKEverLock? "Yes":"No")); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ PopReportIn10s++; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", "BT [status/ rssi/ retryCnt/ popCnt]", \ -+ ((pBtCoexist->btInfo.bBtDisabled)? ("disabled"): ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)? "non-connected idle": -+ ( (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy")))), -+ pCoexSta->btRssi, pCoexSta->btRetryCnt, pCoexSta->popEventCnt); -+ CL_PRINTF(cliBuf); -+ -+ if (PopReportIn10s >= 5) -+ { -+ pCoexSta->popEventCnt = 0; -+ PopReportIn10s = 0; -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d / %d", "SCO/HID/PAN/A2DP/Hi-Pri", \ -+ pBtLinkInfo->bScoExist, pBtLinkInfo->bHidExist, pBtLinkInfo->bPanExist, pBtLinkInfo->bA2dpExist, pBtLinkInfo->bBtHiPriLinkExist); -+ CL_PRINTF(cliBuf); -+ -+ if (pStackInfo->bProfileNotified) -+ { -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ else -+ { -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", "BT Role/A2DP rate", \ -+ (pBtLinkInfo->bSlaveRole )? "Slave":"Master", (btInfoExt&BIT0)? "BR":"EDR"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8703b1Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism] (before Manual)============"); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ } -+ -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ 0x%x", "SM[LowPenaltyRA]/RA Mask", \ -+ pCoexDm->bCurLowPenaltyRa, pBtCoexist->btInfo.raMask); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %d ", "NoAggr/ CtrlAggr/ AggrSize", \ -+ (pBtCoexist->btInfo.bRejectAggPkt? "Yes":"No"), (pBtCoexist->btInfo.bBtCtrlAggBufSize? "Yes":"No"), -+ pBtCoexist->btInfo.aggBufSize); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism] (before Manual) ============"); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ } -+ -+ CL_PRINTF(cliBuf); -+ -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase, -+ (pCoexDm->bCurPsTdmaOn? "On":"Off"), -+ (pCoexDm->bAutoTdmaAdjust? "Adj":"Fix") ); -+ -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "WL/BT Coex Table Type", \ -+ pCoexSta->nCoexTableType); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/0x6cc/IgnWlanAct", \ -+ u1Tmp[0], u4Tmp[0], pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0xa0); -+ u4Tmp[1] = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0xa4); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "LTE Coex Table W_L/B_L", \ -+ u4Tmp[0]&0xffff, u4Tmp[1]&0xffff); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0xa8); -+ u4Tmp[1] = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0xac); -+ u4Tmp[2] = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0xb0); -+ u4Tmp[3] = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0xb4); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "LTE Break Table W_L/B_L/L_W/L_B", \ -+ u4Tmp[0]&0xffff, u4Tmp[1]&0xffff, u4Tmp[2]&0xffff, u4Tmp[3]&0xffff); -+ CL_PRINTF(cliBuf); -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ u2Tmp[0] = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "0x430/0x434/0x42a/0x456", \ -+ u4Tmp[0], u4Tmp[1], u2Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ -+ u4Tmp[0] = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0x38); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x73); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", "LTE CoexOn/Path Ctrl Owner", \ -+ ((u4Tmp[0]&BIT7)>> 7), ((u1Tmp[0]&BIT2)? "WL":"BT")); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "LTE 3Wire/OPMode/UART/UARTMode", \ -+ ((u4Tmp[0]&BIT6)>> 6), ((u4Tmp[0]&(BIT5|BIT4))>> 4),((u4Tmp[0]&BIT3)>> 3), (u4Tmp[0]&(BIT2|BIT1|BIT0))); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", \ -+ ((u4Tmp[0]&BIT12)>> 12), ((u4Tmp[0]&BIT14)>> 14), ((u1Tmp[0]&BIT3)? "On":"Off")); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = halbtc8703b1ant_LTECoex_InDirectReadReg(pBtCoexist, 0x54); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", \ -+ ((u4Tmp[0]&BIT2)>> 2), ((u4Tmp[0]&BIT3)>> 3), ((u4Tmp[0]&BIT1)>> 1), (u4Tmp[0]&BIT0)); -+ CL_PRINTF(cliBuf); -+ -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4c6); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x4c6[4]/0x40[5] (WL/BT PTA)", \ -+ ((u1Tmp[0] & BIT4)>>4), ((u1Tmp[1] & BIT5)>>5)); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x953); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s", "0x550(bcn ctrl)/0x522/4-RxAGC", \ -+ u4Tmp[0], u1Tmp[0], (u1Tmp[1]&0x2)? "On": "Off"); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); -+ u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xcf0); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5b); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5c); -+ -+ faOfdm = ((u4Tmp[0]&0xffff0000) >> 16) + ((u4Tmp[1]&0xffff0000) >> 16) + (u4Tmp[1] & 0xffff) + (u4Tmp[2] & 0xffff) + \ -+ ((u4Tmp[3]&0xffff0000) >> 16) + (u4Tmp[3] & 0xffff) ; -+ faCck = (u1Tmp[0] << 8) + u1Tmp[1]; -+ -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0xc50/OFDM-CCA/OFDM-FA/CCK-FA", \ -+ u4Tmp[1]&0xff, u4Tmp[0]&0xffff, faOfdm, faCck); -+ CL_PRINTF(cliBuf); -+ -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_OK CCK/11g/11n/11n-Agg", \ -+ pCoexSta->nCRCOK_CCK, pCoexSta->nCRCOK_11g, pCoexSta->nCRCOK_11n, pCoexSta->nCRCOK_11nAgg); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_Err CCK/11g/11n/11n-Agg", \ -+ pCoexSta->nCRCErr_CCK, pCoexSta->nCRCErr_11g, pCoexSta->nCRCErr_11n, pCoexSta->nCRCErr_11nAgg); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770(high-pri rx/tx)", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(low-pri rx/tx)", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+#if(BT_AUTO_REPORT_ONLY_8703B_1ANT == 1) -+ //halbtc8703b1ant_MonitorBtCtr(pBtCoexist); -+#endif -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8703b1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u4Byte u4Tmp=0; -+ -+ if(pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm) -+ return; -+ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ pCoexSta->bUnderIps = TRUE; -+ -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ -+ halbtc8703b1ant_InitHwConfig(pBtCoexist, FALSE, FALSE); -+ halbtc8703b1ant_InitCoexDm(pBtCoexist); -+ halbtc8703b1ant_QueryBtInfo(pBtCoexist); -+ -+ pCoexSta->bUnderIps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8703b1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm) -+ return; -+ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ pCoexSta->bUnderLps = TRUE; -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ pCoexSta->bUnderLps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8703b1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ -+ u1Byte u1Tmpa, u1Tmpb; -+ u4Byte u4Tmp; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm ) -+ return; -+ -+ if(BTC_SCAN_START == type) -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ halbtc8703b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); //Force antenna setup for no scan result issue -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &pCoexSta->nScanAPNum); -+ } -+ -+ if(pBtCoexist->btInfo.bBtDisabled) -+ return; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ halbtc8703b1ant_QueryBtInfo(pBtCoexist); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8703b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8703b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8703b1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8703b1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8703b1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if(BTC_SCAN_START == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8703b1ant_ActionWifiNotConnectedScan(pBtCoexist); -+ } -+ else // wifi is connected -+ { -+ halbtc8703b1ant_ActionWifiConnectedScan(pBtCoexist); -+ } -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8703b1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else -+ { -+ halbtc8703b1ant_ActionWifiConnected(pBtCoexist); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8703b1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ halbtc8703b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); //Force antenna setup for no scan result issue -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ pCoexDm->nArpCnt = 0; -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ //pCoexDm->nArpCnt = 0; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8703b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8703b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8703b1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8703b1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8703b1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ halbtc8703b1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8703b1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else -+ { -+ halbtc8703b1ant_ActionWifiConnected(pBtCoexist); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8703b1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ BOOLEAN bWifiUnderBMode = FALSE; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ halbtc8703b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); //Force antenna setup for no scan result issue -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ -+ //Set CCK Tx/Rx high Pri except 11b mode -+ if (bWifiUnderBMode) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x00); //CCK Tx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x00); //CCK Rx -+ } -+ else -+ { -+ //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x10); //CCK Tx -+ //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x10); //CCK Rx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x00); //CCK Tx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x10); //CCK Rx -+ } -+ -+ pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ pCoexDm->nArpCnt = 0; -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x0); //CCK Tx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x0); //CCK Rx -+ -+ pCoexSta->bCCKEverLock = FALSE; -+ } -+ -+ halbtc8703b1ant_UpdateWifiChannelInfo(pBtCoexist, type); -+ -+} -+ -+VOID -+EXhalbtc8703b1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE, bUnder4way=FALSE; -+ u1Byte aggBufSize=5; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if( BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ BTC_PACKET_ARP == type ) -+ { -+ if (BTC_PACKET_ARP == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet ARP notify\n")); -+ -+ pCoexDm->nArpCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ARP Packet Count = %d\n", pCoexDm->nArpCnt)); -+ -+ if((pCoexDm->nArpCnt >= 10) && (!bUnder4way)) // if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecialPacket(pBtCoexist) -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ } -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet DHCP or EAPOL notify\n")); -+ } -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet [Type = %d] notify\n", type)); -+ } -+ -+ pCoexSta->specialPktPeriodCnt = 0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8703b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8703b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8703b1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8703b1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8703b1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if( BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ ( (BTC_PACKET_ARP == type ) && (pCoexSta->bWiFiIsHighPriTask) ) ) -+ { -+ halbtc8703b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8703b1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bWifiConnected=FALSE; -+ BOOLEAN bBtBusy=FALSE; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ -+ rspSource = tmpBuf[0]&0xf; -+ if(rspSource >= BT_INFO_SRC_8703B_1ANT_MAX) -+ rspSource = BT_INFO_SRC_8703B_1ANT_WIFI_FW; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 1) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ // if 0xff, it means BT is under WHCK test -+ if (btInfo == 0xff) -+ pCoexSta->bBtWhckTest = TRUE; -+ else -+ pCoexSta->bBtWhckTest = FALSE; -+ -+ if(BT_INFO_SRC_8703B_1ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = // [3:0] -+ pCoexSta->btInfoC2h[rspSource][2]&0xf; -+ -+ if (pCoexSta->btRetryCnt >= 1) -+ pCoexSta->popEventCnt++; -+ -+ if (pCoexSta->btInfoC2h[rspSource][2]&0x20) -+ pCoexSta->bC2hBtPage = TRUE; -+ else -+ pCoexSta->bC2hBtPage = FALSE; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][3]*2-90; -+ //pCoexSta->btInfoC2h[rspSource][3]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][4]; -+ -+ pCoexSta->bBtTxRxMask = (pCoexSta->btInfoC2h[rspSource][2]&0x40); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TX_RX_MASK, &pCoexSta->bBtTxRxMask); -+ -+ -+ // Here we need to resend some wifi info to BT -+ // because bt is reset and loss of the info. -+ if(pCoexSta->btInfoExt & BIT1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(bWifiConnected) -+ { -+ halbtc8703b1ant_UpdateWifiChannelInfo(pBtCoexist, BTC_MEDIA_CONNECT); -+ } -+ else -+ { -+ halbtc8703b1ant_UpdateWifiChannelInfo(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ } -+ -+ if(pCoexSta->btInfoExt & BIT3) -+ { -+ if(!pBtCoexist->bManualControl && !pBtCoexist->bStopCoexDm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")); -+ halbtc8703b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ } -+ } -+ else -+ { -+ // BT already NOT ignore Wlan active, do nothing here. -+ } -+#if(BT_AUTO_REPORT_ONLY_8703B_1ANT == 0) -+ if( (pCoexSta->btInfoExt & BIT4) ) -+ { -+ // BT auto report already enabled, do nothing -+ } -+ else -+ { -+ halbtc8703b1ant_BtAutoReport(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+#endif -+ } -+ -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8703B_1ANT_B_INQ_PAGE) -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ else -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ -+ pCoexSta->nNumOfProfile = 0; -+ -+ // set link exist status -+ if(!(btInfo&BT_INFO_8703B_1ANT_B_CONNECTION)) -+ { -+ pCoexSta->bBtLinkExist = FALSE; -+ pCoexSta->bPanExist = FALSE; -+ pCoexSta->bA2dpExist = FALSE; -+ pCoexSta->bHidExist = FALSE; -+ pCoexSta->bScoExist = FALSE; -+ -+ pCoexSta->bBtHiPriLinkExist = FALSE; -+ } -+ else // connection exists -+ { -+ pCoexSta->bBtLinkExist = TRUE; -+ if(btInfo & BT_INFO_8703B_1ANT_B_FTP) -+ { -+ pCoexSta->bPanExist = TRUE; -+ pCoexSta->nNumOfProfile++; -+ } -+ else -+ pCoexSta->bPanExist = FALSE; -+ if(btInfo & BT_INFO_8703B_1ANT_B_A2DP) -+ { -+ pCoexSta->bA2dpExist = TRUE; -+ pCoexSta->nNumOfProfile++; -+ } -+ else -+ pCoexSta->bA2dpExist = FALSE; -+ if(btInfo & BT_INFO_8703B_1ANT_B_HID) -+ { -+ pCoexSta->bHidExist = TRUE; -+ pCoexSta->nNumOfProfile++; -+ } -+ else -+ pCoexSta->bHidExist = FALSE; -+ if(btInfo & BT_INFO_8703B_1ANT_B_SCO_ESCO) -+ { -+ pCoexSta->bScoExist = TRUE; -+ pCoexSta->nNumOfProfile++; -+ } -+ else -+ pCoexSta->bScoExist = FALSE; -+ -+ if ((pCoexSta->bHidExist == FALSE) && (pCoexSta->bC2hBtInquiryPage == FALSE) &&( pCoexSta->bScoExist == FALSE)) -+ { -+ if (pCoexSta->highPriorityTx + pCoexSta->highPriorityRx >= 160) -+ { -+ pCoexSta->bHidExist = TRUE; -+ pCoexSta->wrongProfileNotification++; -+ pCoexSta->nNumOfProfile++; -+ btInfo = btInfo | 0x28; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT HID = true (Hi-Pri > 160)!\n")); -+ } -+ } -+ -+ //Add Hi-Pri Tx/Rx counter to avoid false detection -+ if (((pCoexSta->bHidExist) || (pCoexSta->bScoExist)) && (pCoexSta->highPriorityTx + pCoexSta->highPriorityRx >= 160) -+ && (!pCoexSta->bC2hBtInquiryPage)) -+ pCoexSta->bBtHiPriLinkExist = TRUE; -+ else -+ pCoexSta->bBtHiPriLinkExist = FALSE; -+ -+ if((btInfo&BT_INFO_8703B_1ANT_B_ACL_BUSY) && (pCoexSta->nNumOfProfile == 0)) -+ { -+ if (pCoexSta->lowPriorityTx + pCoexSta->lowPriorityRx >= 160) -+ { -+ pCoexSta->bPanExist = TRUE; -+ pCoexSta->nNumOfProfile++; -+ pCoexSta->wrongProfileNotification++; -+ btInfo = btInfo | 0x88; -+ } -+ } -+ } -+ -+ halbtc8703b1ant_UpdateBtLinkInfo(pBtCoexist); -+ -+ btInfo = btInfo & 0x1f; //mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) -+ -+ if(!(btInfo&BT_INFO_8703B_1ANT_B_CONNECTION)) -+ { -+ pCoexDm->btStatus = BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n")); -+ } -+ else if(btInfo == BT_INFO_8703B_1ANT_B_CONNECTION) // connection exists but no busy -+ { -+ pCoexDm->btStatus = BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n")); -+ } -+ else if((btInfo&BT_INFO_8703B_1ANT_B_SCO_ESCO) || -+ (btInfo&BT_INFO_8703B_1ANT_B_SCO_BUSY)) -+ { -+ pCoexDm->btStatus = BT_8703B_1ANT_BT_STATUS_SCO_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n")); -+ } -+ else if(btInfo&BT_INFO_8703B_1ANT_B_ACL_BUSY) -+ { -+ if(BT_8703B_1ANT_BT_STATUS_ACL_BUSY != pCoexDm->btStatus) -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->btStatus = BT_8703B_1ANT_BT_STATUS_ACL_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n")); -+ } -+ else -+ { -+ pCoexDm->btStatus = BT_8703B_1ANT_BT_STATUS_MAX; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n")); -+ } -+ -+ if( (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ bBtBusy = TRUE; -+ else -+ bBtBusy = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ halbtc8703b1ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8703b1ant_RfStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u4Byte u4Tmp; -+ u1Byte u1Tmpa,u1Tmpb, u1Tmpc; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF Status notify\n")); -+ -+ if(BTC_RF_ON == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF is turned ON!!\n")); -+ pBtCoexist->bStopCoexDm = FALSE; -+ } -+ else if(BTC_RF_OFF == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF is turned OFF!!\n")); -+ -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE); -+ halbtc8703b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ pBtCoexist->bStopCoexDm = TRUE; -+ -+ } -+} -+ -+VOID -+EXhalbtc8703b1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE); -+ -+ halbtc8703b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ -+ EXhalbtc8703b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ -+ pBtCoexist->bStopCoexDm = TRUE; -+} -+ -+VOID -+EXhalbtc8703b1ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify\n")); -+ -+ if(BTC_WIFI_PNP_SLEEP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to SLEEP\n")); -+ -+ halbtc8703b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8703b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE); -+ halbtc8703b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ -+ pBtCoexist->bStopCoexDm = TRUE; -+ } -+ else if(BTC_WIFI_PNP_WAKE_UP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to WAKE UP\n")); -+ pBtCoexist->bStopCoexDm = FALSE; -+ halbtc8703b1ant_InitHwConfig(pBtCoexist, FALSE, FALSE); -+ halbtc8703b1ant_InitCoexDm(pBtCoexist); -+ halbtc8703b1ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8703b1ant_CoexDmReset( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], *****************Coex DM Reset*****************\n")); -+ -+ halbtc8703b1ant_InitHwConfig(pBtCoexist, FALSE, FALSE); -+ //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x2, 0xfffff, 0x0); -+ halbtc8703b1ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8703b1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static u1Byte disVerInfoCnt=0; -+ u4Byte fwVer=0, btPatchVer=0; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ==========================Periodical===========================\n")); -+ -+ if(disVerInfoCnt <= 5) -+ { -+ disVerInfoCnt += 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ant PG Num/ Ant Mech/ Ant Pos = %d/ %d/ %d\n", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT stack/ hci ext ver = %s / %d\n", -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion)); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", -+ GLCoexVerDate8703b1Ant, GLCoexVer8703b1Ant, fwVer, btPatchVer, btPatchVer)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ } -+ -+#if(BT_AUTO_REPORT_ONLY_8703B_1ANT == 0) -+ halbtc8703b1ant_QueryBtInfo(pBtCoexist); -+ halbtc8703b1ant_MonitorBtEnableDisable(pBtCoexist); -+#else -+ halbtc8703b1ant_MonitorBtCtr(pBtCoexist); -+ halbtc8703b1ant_MonitorWiFiCtr(pBtCoexist); -+#if BT_8703B_1ANT_ANTDET_ENABLE -+ halbtc8703b1ant_MonitorBtEnableDisable(pBtCoexist); -+#endif -+ -+ if( halbtc8703b1ant_IsWifiStatusChanged(pBtCoexist) || -+ pCoexDm->bAutoTdmaAdjust ) -+ { -+ -+ halbtc8703b1ant_RunCoexistMechanism(pBtCoexist); -+ } -+ -+ pCoexSta->specialPktPeriodCnt++; -+ -+ // sample to set bt to execute Ant detection -+ //pBtCoexist->fBtcSetBtAntDetection(pBtCoexist, 20, 14); -+/* -+ if (pPsdScan->bIsAntDetEnable) -+ { -+ if (pPsdScan->nPSDGenCount > pPsdScan->realseconds) -+ pPsdScan->nPSDGenCount = 0; -+ -+ halbtc8703b1ant_AntennaDetection(pBtCoexist, pPsdScan->realcentFreq, pPsdScan->realoffset, pPsdScan->realspan, pPsdScan->realseconds); -+ pPsdScan->nPSDGenTotalCount +=2; -+ pPsdScan->nPSDGenCount += 2; -+ } -+*/ -+#endif -+} -+ -+VOID -+EXhalbtc8703b1ant_AntennaDetection( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ) -+{ -+ //No Antenna Detection required because 8730b is only 1-Ant -+} -+ -+VOID -+EXhalbtc8703b1ant_AntennaIsolation( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ) -+{ -+ -+ -+} -+ -+VOID -+EXhalbtc8703b1ant_PSDScan( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ) -+{ -+ -+ -+} -+ -+VOID -+EXhalbtc8703b1ant_DisplayAntDetection( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ -+} -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8703b1Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8703b1Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8703b1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8703b1Ant.h 2017-06-07 23:07:21.009687394 +0300 -@@ -0,0 +1,373 @@ -+//=========================================== -+// The following is for 8703B 1ANT BT Co-exist definition -+//=========================================== -+#define BT_AUTO_REPORT_ONLY_8703B_1ANT 1 -+ -+#define BT_INFO_8703B_1ANT_B_FTP BIT7 -+#define BT_INFO_8703B_1ANT_B_A2DP BIT6 -+#define BT_INFO_8703B_1ANT_B_HID BIT5 -+#define BT_INFO_8703B_1ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8703B_1ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8703B_1ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8703B_1ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8703B_1ANT_B_CONNECTION BIT0 -+ -+#define BT_INFO_8703B_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT0))? TRUE:FALSE) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT 2 -+ -+#define BT_8703B_1ANT_WIFI_NOISY_THRESH 30 //max: 255 -+ -+//for Antenna detection -+#define BT_8703B_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 -+#define BT_8703B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -+#define BT_8703B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 -+#define BT_8703B_1ANT_ANTDET_PSDTHRES_1ANT 35 -+#define BT_8703B_1ANT_ANTDET_RETRY_INTERVAL 10 //retry timer if ant det is fail, unit: second -+#define BT_8703B_1ANT_ANTDET_ENABLE 0 -+#define BT_8703B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 -+ -+#define BT_8703B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 -+ -+enum _SIGNAL_STATE{ -+ SET_TO_LOW=0, -+ SET_TO_HIGH=1, -+ SET_BY_HW=0 -+}; -+ -+enum _PATH_CONTRL_OWNER{ -+ BTSIDE_CONTROL=0, -+ WLSIDE_CONTROL=1 -+}; -+ -+enum _GNT_CONTROL_TYPE{ -+ CONTROL_BY_PTA=0, -+ CONTROL_BY_SW=1 -+}; -+ -+enum _GNT_CONTROL_BLOCK{ -+ RFC_AND_BB=0, -+ RFC_ONLY=1, -+ BB_ONLY=2 -+}; -+ -+enum _LTE_COEXTABLE_TYPE{ -+ WL_VS_LTE=0, -+ BT_VS_LTE=1 -+}; -+ -+enum _LTE_BREAKTABLE_TYPE{ -+ WL_BREAK_LTE=0, -+ BT_BREAK_LTE=1, -+ LTE_BREAK_WL=2, -+ LTE_BREAK_BT=3 -+}; -+ -+ -+typedef enum _BT_INFO_SRC_8703B_1ANT{ -+ BT_INFO_SRC_8703B_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8703B_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8703B_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8703B_1ANT_MAX -+}BT_INFO_SRC_8703B_1ANT,*PBT_INFO_SRC_8703B_1ANT; -+ -+typedef enum _BT_8703B_1ANT_BT_STATUS{ -+ BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8703B_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8703B_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8703B_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8703B_1ANT_BT_STATUS_MAX -+}BT_8703B_1ANT_BT_STATUS,*PBT_8703B_1ANT_BT_STATUS; -+ -+typedef enum _BT_8703B_1ANT_WIFI_STATUS{ -+ BT_8703B_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8703B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT = 0x3, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8703B_1ANT_WIFI_STATUS_MAX -+}BT_8703B_1ANT_WIFI_STATUS,*PBT_8703B_1ANT_WIFI_STATUS; -+ -+typedef enum _BT_8703B_1ANT_COEX_ALGO{ -+ BT_8703B_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8703B_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8703B_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8703B_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8703B_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8703B_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8703B_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8703B_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8703B_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8703B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8703B_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8703B_1ANT_COEX_ALGO_MAX = 0xb, -+}BT_8703B_1ANT_COEX_ALGO,*PBT_8703B_1ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8703B_1ANT{ -+ // hw setting -+ u1Byte preAntPosType; -+ u1Byte curAntPosType; -+ // fw mechanism -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ BOOLEAN bAutoTdmaAdjust; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ BOOLEAN bPreBtAutoReport; -+ BOOLEAN bCurBtAutoReport; -+ u1Byte preLps; -+ u1Byte curLps; -+ u1Byte preRpwm; -+ u1Byte curRpwm; -+ -+ // sw mechanism -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ -+ u4Byte backupArfrCnt1; // Auto Rate Fallback Retry cnt -+ u4Byte backupArfrCnt2; // Auto Rate Fallback Retry cnt -+ u2Byte backupRetryLimit; -+ u1Byte backupAmpduMaxTime; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+ -+ u4Byte preRaMask; -+ u4Byte curRaMask; -+ u1Byte preArfrType; -+ u1Byte curArfrType; -+ u1Byte preRetryLimitType; -+ u1Byte curRetryLimitType; -+ u1Byte preAmpduTimeType; -+ u1Byte curAmpduTimeType; -+ u4Byte nArpCnt; -+ -+ u1Byte errorCondition; -+} COEX_DM_8703B_1ANT, *PCOEX_DM_8703B_1ANT; -+ -+typedef struct _COEX_STA_8703B_1ANT{ -+ BOOLEAN bBtLinkExist; -+ BOOLEAN bScoExist; -+ BOOLEAN bA2dpExist; -+ BOOLEAN bHidExist; -+ BOOLEAN bPanExist; -+ BOOLEAN bBtHiPriLinkExist; -+ u1Byte nNumOfProfile; -+ -+ BOOLEAN bUnderLps; -+ BOOLEAN bUnderIps; -+ u4Byte specialPktPeriodCnt; -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ s1Byte btRssi; -+ BOOLEAN bBtTxRxMask; -+ u1Byte preBtRssiState; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8703B_1ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8703B_1ANT_MAX]; -+ BOOLEAN bBtWhckTest; -+ BOOLEAN bC2hBtInquiryPage; -+ BOOLEAN bC2hBtPage; //Add for win8.1 page out issue -+ BOOLEAN bWiFiIsHighPriTask; //Add for win8.1 page out issue -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+ u4Byte popEventCnt; -+ u1Byte nScanAPNum; -+ -+ u4Byte nCRCOK_CCK; -+ u4Byte nCRCOK_11g; -+ u4Byte nCRCOK_11n; -+ u4Byte nCRCOK_11nAgg; -+ -+ u4Byte nCRCErr_CCK; -+ u4Byte nCRCErr_11g; -+ u4Byte nCRCErr_11n; -+ u4Byte nCRCErr_11nAgg; -+ -+ BOOLEAN bCCKLock; -+ BOOLEAN bPreCCKLock; -+ BOOLEAN bCCKEverLock; -+ u1Byte nCoexTableType; -+ -+ BOOLEAN bForceLpsOn; -+ u4Byte wrongProfileNotification; -+ -+ BOOLEAN bConCurrentRxModeOn; -+}COEX_STA_8703B_1ANT, *PCOEX_STA_8703B_1ANT; -+ -+#define BT_8703B_1ANT_ANTDET_PSD_POINTS 256 //MAX:1024 -+#define BT_8703B_1ANT_ANTDET_PSD_AVGNUM 1 //MAX:3 -+#define BT_8703B_1ANT_ANTDET_BUF_LEN 16 -+ -+typedef struct _PSDSCAN_STA_8703B_1ANT{ -+ -+u4Byte nAntDet_BTLEChannel; //BT LE Channel ex:2412 -+u4Byte nAntDet_BTTxTime; -+u4Byte nAntDet_PrePSDScanPeakVal; -+BOOLEAN nAntDet_IsAntDetAvailable; -+u4Byte nAntDet_PSDScanPeakVal; -+BOOLEAN nAntDet_IsBTReplyAvailable; -+u4Byte nAntDet_PSDScanPeakFreq; -+ -+u1Byte nAntDet_Result; -+u1Byte nAntDet_PeakVal[BT_8703B_1ANT_ANTDET_BUF_LEN]; -+u1Byte nAntDet_PeakFreq[BT_8703B_1ANT_ANTDET_BUF_LEN]; -+u4Byte bAntDet_TryCount; -+u4Byte bAntDet_FailCount; -+u4Byte nAntDet_IntevalCount; -+u4Byte nAntDet_ThresOffset; -+ -+u4Byte nRealCentFreq; -+s4Byte nRealOffset; -+u4Byte nRealSpan; -+ -+u4Byte nPSDBandWidth; //unit: Hz -+u4Byte nPSDPoint; //128/256/512/1024 -+u4Byte nPSDReport[1024]; //unit:dB (20logx), 0~255 -+u4Byte nPSDReport_MaxHold[1024]; //unit:dB (20logx), 0~255 -+u4Byte nPSDStartPoint; -+u4Byte nPSDStopPoint; -+u4Byte nPSDMaxValuePoint; -+u4Byte nPSDMaxValue; -+u4Byte nPSDStartBase; -+u4Byte nPSDAvgNum; // 1/8/16/32 -+u4Byte nPSDGenCount; -+BOOLEAN bIsPSDRunning; -+BOOLEAN bIsPSDShowMaxOnly; -+} PSDSCAN_STA_8703B_1ANT, *PPSDSCAN_STA_8703B_1ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8703b1ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8703b1ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8703b1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8703b1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8703b1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8703b1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8703b1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8703b1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8703b1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8703b1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8703b1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8703b1ant_RfStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8703b1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8703b1ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ); -+VOID -+EXhalbtc8703b1ant_CoexDmReset( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8703b1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8703b1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8703b1ant_AntennaDetection( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ); -+VOID -+EXhalbtc8703b1ant_AntennaIsolation( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ); -+ -+VOID -+EXhalbtc8703b1ant_PSDScan( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ); -+VOID -+EXhalbtc8703b1ant_DisplayAntDetection( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8703b2Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8703b2Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8703b2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8703b2Ant.c 2017-06-07 23:07:21.010687485 +0300 -@@ -0,0 +1,4864 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8703B Co-exist mechanism -+// -+// History -+// 2012/11/15 Cosa first check in. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8703b2Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8703B_2ANT GLCoexDm8703b2Ant; -+static PCOEX_DM_8703B_2ANT pCoexDm=&GLCoexDm8703b2Ant; -+static COEX_STA_8703B_2ANT GLCoexSta8703b2Ant; -+static PCOEX_STA_8703B_2ANT pCoexSta=&GLCoexSta8703b2Ant; -+ -+const char *const GLBtInfoSrc8703b2Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u4Byte GLCoexVerDate8703b2Ant=20140903; -+u4Byte GLCoexVer8703b2Ant=0x43; -+ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8703b2ant_ -+//============================================================ -+u1Byte -+halbtc8703b2ant_BtRssiState( -+ u1Byte levelNum, -+ u1Byte rssiThresh, -+ u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte btRssi=0; -+ u1Byte btRssiState=pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8703B_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8703B_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8703B_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh1) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+u1Byte -+halbtc8703b2ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8703B_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8703B_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8703B_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+VOID -+halbtc8703b2ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ bPreBtDisabled = bBtDisabled; -+ if(!bBtDisabled) -+ { -+ } -+ else -+ { -+ } -+ } -+} -+ -+VOID -+halbtc8703b2ant_LimitedRx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRejApAggPkt, -+ IN BOOLEAN bBtCtrlAggBufSize, -+ IN u1Byte aggBufSize -+ ) -+{ -+ BOOLEAN bRejectRxAgg=bRejApAggPkt; -+ BOOLEAN bBtCtrlRxAggSize=bBtCtrlAggBufSize; -+ u1Byte rxAggSize=aggBufSize; -+ -+ //============================================ -+ // Rx Aggregation related setting -+ //============================================ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg); -+ // decide BT control aggregation buf size or not -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize); -+ // aggregation buf size, only work when BT control Rx aggregation size. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize); -+ // real update aggregation setting -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+} -+ -+VOID -+halbtc8703b2ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp; -+ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ if ( (pCoexSta->lowPriorityRx >= 950) && (pCoexSta->lowPriorityRx >= pCoexSta->lowPriorityTx) && (!pCoexSta->bUnderIps) ) -+ { -+ pBtLinkInfo->bSlaveRole = TRUE; -+ } -+ else -+ { -+ pBtLinkInfo->bSlaveRole = FALSE; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+} -+ -+VOID -+halbtc8703b2ant_MonitorWiFiCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ u2Byte u2Tmp[3]; -+ s4Byte wifiRssi=0; -+ BOOLEAN bWifiBusy = FALSE, bWifiUnderBMode = FALSE; -+ static u1Byte nCCKLockCounter = 0; -+ -+ -+ if (pCoexSta->bUnderIps) -+ { -+ pCoexSta->nCRCOK_CCK = 0; -+ pCoexSta->nCRCOK_11g = 0; -+ pCoexSta->nCRCOK_11n = 0; -+ pCoexSta->nCRCOK_11nAgg = 0; -+ -+ pCoexSta->nCRCErr_CCK = 0; -+ pCoexSta->nCRCErr_11g = 0; -+ pCoexSta->nCRCErr_11n = 0; -+ pCoexSta->nCRCErr_11nAgg = 0; -+ } -+ else -+ { -+ pCoexSta->nCRCOK_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf88); -+ pCoexSta->nCRCOK_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf94); -+ pCoexSta->nCRCOK_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf90); -+ pCoexSta->nCRCOK_11nAgg= pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfb8); -+ -+ pCoexSta->nCRCErr_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf84); -+ pCoexSta->nCRCErr_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf96); -+ pCoexSta->nCRCErr_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf92); -+ pCoexSta->nCRCErr_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfba); -+ } -+ -+ //reset counter -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x1); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x0); -+} -+ -+VOID -+halbtc8703b2ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = TRUE; -+ -+ H2C_Parameter[0] |= BIT0; // trigger -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x61=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter); -+} -+ -+BOOLEAN -+halbtc8703b2ant_IsWifiStatusChanged( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreWifiBusy=FALSE, bPreUnder4way=FALSE, bPreBtHsOn=FALSE; -+ BOOLEAN bWifiBusy=FALSE, bUnder4way=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bWifiConnected=FALSE; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ -+ if(bWifiConnected) -+ { -+ if(bWifiBusy != bPreWifiBusy) -+ { -+ bPreWifiBusy = bWifiBusy; -+ return TRUE; -+ } -+ if(bUnder4way != bPreUnder4way) -+ { -+ bPreUnder4way = bUnder4way; -+ return TRUE; -+ } -+ if(bBtHsOn != bPreBtHsOn) -+ { -+ bPreBtHsOn = bBtHsOn; -+ return TRUE; -+ } -+ -+ -+ wifiRssiState = halbtc8703b2ant_WifiRssiState(pBtCoexist,3, 2, BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ -+ if ( (BTC_RSSI_STATE_HIGH ==wifiRssiState ) || (BTC_RSSI_STATE_LOW ==wifiRssiState )) -+ { -+ return TRUE; -+ } -+ -+ } -+ -+ return FALSE; -+} -+ -+VOID -+halbtc8703b2ant_UpdateBtLinkInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ -+#if(BT_AUTO_REPORT_ONLY_8703B_2ANT == 1) // profile from bt patch -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pCoexSta->bScoExist; -+ pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist; -+ pBtLinkInfo->bPanExist = pCoexSta->bPanExist; -+ pBtLinkInfo->bHidExist = pCoexSta->bHidExist; -+ -+ // work around for HS mode. -+ if(bBtHsOn) -+ { -+ pBtLinkInfo->bPanExist = TRUE; -+ pBtLinkInfo->bBtLinkExist = TRUE; -+ } -+#else // profile from bt stack -+ pBtLinkInfo->bBtLinkExist = pStackInfo->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pStackInfo->bScoExist; -+ pBtLinkInfo->bA2dpExist = pStackInfo->bA2dpExist; -+ pBtLinkInfo->bPanExist = pStackInfo->bPanExist; -+ pBtLinkInfo->bHidExist = pStackInfo->bHidExist; -+ -+ //for win-8 stack HID report error -+ if(!pStackInfo->bHidExist) -+ pStackInfo->bHidExist = pCoexSta->bHidExist; //sync BTInfo with BT firmware and stack -+ // when stack HID report error, here we use the info from bt fw. -+ if(!pStackInfo->bBtLinkExist) -+ pStackInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+#endif -+ // check if Sco only -+ if( pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bScoOnly = TRUE; -+ else -+ pBtLinkInfo->bScoOnly = FALSE; -+ -+ // check if A2dp only -+ if( !pBtLinkInfo->bScoExist && -+ pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bA2dpOnly = TRUE; -+ else -+ pBtLinkInfo->bA2dpOnly = FALSE; -+ -+ // check if Pan only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bPanOnly = TRUE; -+ else -+ pBtLinkInfo->bPanOnly = FALSE; -+ -+ // check if Hid only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bHidOnly = TRUE; -+ else -+ pBtLinkInfo->bHidOnly = FALSE; -+} -+ -+u1Byte -+halbtc8703b2ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ u1Byte algorithm=BT_8703B_2ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!pBtLinkInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No BT link exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pBtLinkInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(numOfDiffProfile == 1) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO only\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_A2DP; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(HS) only\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(EDR) only\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 2) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(HS)\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(EDR)\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+#if 0 -+ if(pStackInfo->numOfHid >= 2) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID*2 + A2DP\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ else -+#endif -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(HS)\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_HID; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(EDR)\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(HS)\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_A2DP_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(EDR)\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP ==> HID\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(HS)\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(EDR)\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile >= 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); -+ algorithm = BT_8703B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+VOID -+halbtc8703b2ant_SetFwDacSwingLevel( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte dacSwingLvl -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ // There are several type of dacswing -+ // 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 -+ H2C_Parameter[0] = dacSwingLvl; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Set Dac Swing Level=0x%x\n", dacSwingLvl)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x64=0x%x\n", H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x64, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8703b2ant_SetFwDecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte decBtPwrLvl -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = decBtPwrLvl; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], decrease Bt Power level = %d, FW write 0x62=0x%x\n", -+ decBtPwrLvl, H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x62, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8703b2ant_DecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte decBtPwrLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s Dec BT power level = %d\n", -+ (bForceExec? "force to":""), decBtPwrLvl)); -+ pCoexDm->curBtDecPwrLvl = decBtPwrLvl; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->preBtDecPwrLvl == pCoexDm->curBtDecPwrLvl) -+ return; -+ } -+ halbtc8703b2ant_SetFwDecBtPwr(pBtCoexist, pCoexDm->curBtDecPwrLvl); -+ -+ pCoexDm->preBtDecPwrLvl = pCoexDm->curBtDecPwrLvl; -+} -+ -+VOID -+halbtc8703b2ant_SetBtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = 0; -+ -+ if(bEnableAutoReport) -+ { -+ H2C_Parameter[0] |= BIT0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], BT FW auto report : %s, FW write 0x68=0x%x\n", -+ (bEnableAutoReport? "Enabled!!":"Disabled!!"), H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x68, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8703b2ant_BtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s BT Auto report = %s\n", -+ (bForceExec? "force to":""), ((bEnableAutoReport)? "Enabled":"Disabled"))); -+ pCoexDm->bCurBtAutoReport = bEnableAutoReport; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreBtAutoReport == pCoexDm->bCurBtAutoReport) -+ return; -+ } -+ halbtc8703b2ant_SetBtAutoReport(pBtCoexist, pCoexDm->bCurBtAutoReport); -+ -+ pCoexDm->bPreBtAutoReport = pCoexDm->bCurBtAutoReport; -+} -+ -+VOID -+halbtc8703b2ant_FwDacSwingLvl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte fwDacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set FW Dac Swing level = %d\n", -+ (bForceExec? "force to":""), fwDacSwingLvl)); -+ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->preFwDacSwingLvl == pCoexDm->curFwDacSwingLvl) -+ return; -+ } -+ -+ halbtc8703b2ant_SetFwDacSwingLevel(pBtCoexist, pCoexDm->curFwDacSwingLvl); -+ -+ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -+} -+ -+VOID -+halbtc8703b2ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xffffc); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+VOID -+halbtc8703b2ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8703b2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8703b2ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte H2C_Parameter[6] ={0}; -+ -+ H2C_Parameter[0] = 0x6; // opCode, 0x6= Retry_Penalty -+ -+ if(bLowPenaltyRa) -+ { -+ H2C_Parameter[1] |= BIT0; -+ H2C_Parameter[2] = 0x00; //normal rate except MCS7/6/5, OFDM54/48/36 -+ H2C_Parameter[3] = 0xf7; //MCS7 or OFDM54 -+ H2C_Parameter[4] = 0xf8; //MCS6 or OFDM48 -+ H2C_Parameter[5] = 0xf9; //MCS5 or OFDM36 -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set WiFi Low-Penalty Retry: %s", -+ (bLowPenaltyRa? "ON!!":"OFF!!")) ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter); -+} -+ -+VOID -+halbtc8703b2ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ //return; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8703b2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8703b2ant_SetDacSwingReg( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte level -+ ) -+{ -+ u1Byte val=(u1Byte)level; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Write SwDacSwing = 0x%x\n", level)); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x883, 0x3e, val); -+} -+ -+VOID -+halbtc8703b2ant_SetSwFullTimeDacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSwDacSwingOn, -+ IN u4Byte swDacSwingLvl -+ ) -+{ -+ if(bSwDacSwingOn) -+ { -+ halbtc8703b2ant_SetDacSwingReg(pBtCoexist, swDacSwingLvl); -+ } -+ else -+ { -+ halbtc8703b2ant_SetDacSwingReg(pBtCoexist, 0x18); -+ } -+} -+ -+ -+VOID -+halbtc8703b2ant_DacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacSwingOn, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", -+ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); -+ pCoexDm->bCurDacSwingOn = bDacSwingOn; -+ pCoexDm->curDacSwingLvl = dacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && -+ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) -+ return; -+ } -+ delay_ms(30); -+ halbtc8703b2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); -+ -+ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; -+ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -+} -+ -+VOID -+halbtc8703b2ant_SetAdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ if(bAdcBackOff) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xc05, 0x30, 0x3); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xc05, 0x30, 0x1); -+ } -+} -+ -+VOID -+halbtc8703b2ant_AdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", -+ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); -+ pCoexDm->bCurAdcBackOff = bAdcBackOff; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) -+ return; -+ } -+ halbtc8703b2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); -+ -+ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -+} -+ -+VOID -+halbtc8703b2ant_SetAgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ u1Byte rssiAdjustVal=0; -+ -+ //=================BB AGC Gain Table -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB Agc Table On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6e1A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6d1B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6c1C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6b1D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6a1E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x691F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x68200001); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB Agc Table Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xaa1A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa91B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa81C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa71D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa61E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa51F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa4200001); -+ } -+ -+ -+ //=================RF Gain -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x38fff); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x38ffe); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x380c3); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x28ce6); -+ } -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xed, 0xfffff, 0x1); -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x38fff); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x38ffe); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x380c3); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x28ce6); -+ } -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xed, 0xfffff, 0x0); -+ -+ // set rssiAdjustVal for wifi module. -+ if(bAgcTableEn) -+ { -+ rssiAdjustVal = 8; -+ } -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -+} -+ -+VOID -+halbtc8703b2ant_AgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", -+ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); -+ pCoexDm->bCurAgcTableEn = bAgcTableEn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) -+ return; -+ } -+ halbtc8703b2ant_SetAgcTable(pBtCoexist, bAgcTableEn); -+ -+ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -+} -+ -+VOID -+halbtc8703b2ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8703b2ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c4, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8703b2ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8703b2ant_CoexTableWithType( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexSta->nCoexTableType = type; -+ -+ switch(type) -+ { -+ case 0: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x55555555, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5afa5afa, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x5ada5ada, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0xffffffff, 0xffffffff, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0x5fff5fff, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x55ff55ff, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 7: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 8: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 9: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 10: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 11: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 12: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 13: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 14: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 15: -+ halbtc8703b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8703b2ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(bEnable) -+ { -+ H2C_Parameter[0] |= BIT0; // function enable -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8703b2ant_SetLpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ u1Byte lps=lpsVal; -+ u1Byte rpwm=rpwmVal; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+VOID -+halbtc8703b2ant_LpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bForceExecPwrCmd=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set lps/rpwm=0x%x/0x%x \n", -+ (bForceExec? "force to":""), lpsVal, rpwmVal)); -+ pCoexDm->curLps = lpsVal; -+ pCoexDm->curRpwm = rpwmVal; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preLps == pCoexDm->curLps) && -+ (pCoexDm->preRpwm == pCoexDm->curRpwm) ) -+ { -+ return; -+ } -+ } -+ halbtc8703b2ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal); -+ -+ pCoexDm->preLps = pCoexDm->curLps; -+ pCoexDm->preRpwm = pCoexDm->curRpwm; -+} -+ -+VOID -+halbtc8703b2ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8703b2ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8703b2ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ -+ -+ if ( (pCoexSta->bA2dpExist) && (pCoexSta->bHidExist) ) -+ { -+ byte5 = byte5 | 0x1; -+ } -+ -+ H2C_Parameter[0] = byte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = byte5; -+ -+ pCoexDm->psTdmaPara[0] = byte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = byte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x60(5bytes)=0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter); -+} -+ -+VOID -+halbtc8703b2ant_SwMechanism1( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bShrinkRxLPF, -+ IN BOOLEAN bLowPenaltyRA, -+ IN BOOLEAN bLimitedDIG, -+ IN BOOLEAN bBTLNAConstrain -+ ) -+{ -+ /* -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if(BTC_WIFI_BW_HT40 != wifiBw) //only shrink RF Rx LPF for HT40 -+ { -+ if (bShrinkRxLPF) -+ bShrinkRxLPF = FALSE; -+ } -+ */ -+ -+ //halbtc8703b2ant_RfShrink(pBtCoexist, NORMAL_EXEC, bShrinkRxLPF); -+ halbtc8703b2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA); -+} -+ -+VOID -+halbtc8703b2ant_SwMechanism2( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAGCTableShift, -+ IN BOOLEAN bADCBackOff, -+ IN BOOLEAN bSWDACSwing, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ //halbtc8703b2ant_AgcTable(pBtCoexist, NORMAL_EXEC, bAGCTableShift); -+ //halbtc8703b2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, bADCBackOff); -+ //halbtc8703b2ant_DacSwing(pBtCoexist, NORMAL_EXEC, bSWDACSwing, dacSwingLvl); -+} -+ -+VOID -+halbtc8703b2ant_SetAntPath( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte antPosType, -+ IN BOOLEAN bInitHwCfg, -+ IN BOOLEAN bWifiOff -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte fwVer=0, u4Tmp=0; -+ BOOLEAN bPgExtSwitch=FALSE; -+ BOOLEAN bUseExtSwitch=FALSE; -+ u1Byte H2C_Parameter[2] ={0}; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_EXT_SWITCH, &bPgExtSwitch); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); // [31:16]=fw ver, [15:0]=fw sub ver -+ -+ if((fwVer>0 && fwVer<0xc0000) || bPgExtSwitch) -+ bUseExtSwitch = TRUE; -+ -+ if(bInitHwCfg) -+ { -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x39, 0x8, 0x1); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x974, 0xff); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x944, 0x3, 0x3); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x930, 0x77); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); -+ -+ if(fwVer >= 0x180000) -+ { -+ /* Use H2C to set GNT_BT to High to avoid A2DP click */ -+ H2C_Parameter[0] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ } -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); //WiFi TRx Mask off -+ //remove due to interrupt is disabled that polling c2h will fail and delay 100ms. -+ //pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x01); //BT TRx Mask off -+ -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ { -+ //tell firmware "no antenna inverse" -+ H2C_Parameter[0] = 0; -+ } -+ else -+ { -+ //tell firmware "antenna inverse" -+ H2C_Parameter[0] = 1; -+ } -+ -+ if (bUseExtSwitch) -+ { -+ //ext switch type -+ H2C_Parameter[1] = 1; -+ } -+ else -+ { -+ //int switch type -+ H2C_Parameter[1] = 0; -+ } -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } -+ else -+ { -+ if(fwVer >= 0x180000) -+ { -+ /* Use H2C to set GNT_BT to "Control by PTA"*/ -+ H2C_Parameter[0] = 0; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x0); -+ } -+ } -+ -+ // ext switch setting -+ if(bUseExtSwitch) -+ { -+ if (bInitHwCfg) -+ { -+ // 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp &=~BIT23; -+ u4Tmp |= BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ } -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); // fixed internal switch S1->WiFi, S0->BT -+ switch(antPosType) -+ { -+ case BTC_ANT_WIFI_AT_MAIN: -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1); // ext switch main at wifi -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2); // ext switch aux at wifi -+ break; -+ } -+ } -+ else // internal switch -+ { -+ if (bInitHwCfg) -+ { -+ // 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp |= BIT23; -+ u4Tmp &=~BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ } -+ -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x64, 0x1, 0x0); //fixed external switch S1->Main, S0->Aux -+ switch(antPosType) -+ { -+ case BTC_ANT_WIFI_AT_MAIN: -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); // fixed internal switch S1->WiFi, S0->BT -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280); // fixed internal switch S0->WiFi, S1->BT -+ break; -+ } -+ } -+} -+ -+VOID -+halbtc8703b2ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bTurnOnByCnt=FALSE; -+ u1Byte psTdmaTypeByCnt=0; -+ u1Byte wifiRssiState1, btRssiState; -+ -+ -+ wifiRssiState1 = halbtc8703b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8703b2ant_BtRssiState(2, BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", -+ (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ if (!(BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) && bTurnOn) -+ { -+ type = type +100; //for WiFi RSSI low or BT RSSI low -+ pCoexDm->bIsSwitchTo1dot5Ant = TRUE; -+ } -+ else -+ { -+ pCoexDm->bIsSwitchTo1dot5Ant = FALSE; -+ } -+ -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ if(bTurnOn) -+ { -+ switch(type) -+ { -+ case 1: -+ default: -+ //halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0xf1, 0x90); -+ break; -+ case 2: -+ //halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x2d, 0x03, 0xf1, 0x90); -+ break; -+ case 3: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0xf1, 0x90); -+ break; -+ case 4: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x10, 0x03, 0xf1, 0x90); -+ break; -+ case 5: -+ //halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x3, 0x70, 0x90); -+ break; -+ case 6: -+ //halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x2d, 0x3, 0x70, 0x90); -+ break; -+ case 7: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0x70, 0x90); -+ break; -+ case 8: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x10, 0x3, 0x70, 0x90); -+ break; -+ case 9: -+ //halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0xf1, 0x90); -+ break; -+ case 10: -+ //halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x2d, 0x03, 0xf1, 0x90); -+ break; -+ case 11: -+ //halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0xe1, 0x90); -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0xf1, 0x90); -+ break; -+ case 12: -+ //halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x10, 0x3, 0xf1, 0x90); -+ break; -+ case 13: -+ //halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x3, 0x70, 0x90); -+ break; -+ case 14: -+ //halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x2d, 0x3, 0x70, 0x90); -+ break; -+ case 15: -+ //halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0x60, 0x90); -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0x70, 0x90); -+ break; -+ case 16: -+ //halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0x60, 0x90); -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x10, 0x3, 0x70, 0x90); -+ break; -+ case 17: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x2f, 0x2f, 0x60, 0x90); -+ break; -+ case 18: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 19: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0xe1, 0x90); -+ break; -+ case 20: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0x60, 0x90); -+ break; -+ case 21: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x03, 0x70, 0x90); -+ break; -+ case 71: -+ //halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0xf1, 0x90); -+ break; -+ case 101: -+ case 105: -+ case 171: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x3a, 0x03, 0x70, 0x50); -+ break; -+ case 102: -+ case 106: -+ case 110: -+ case 114: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x2d, 0x03, 0x70, 0x50); -+ break; -+ case 103: -+ case 107: -+ case 111: -+ case 115: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x1c, 0x03, 0x70, 0x50); -+ break; -+ case 104: -+ case 108: -+ case 112: -+ case 116: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x10, 0x03, 0x70, 0x50); -+ break; -+ case 109: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0xf1, 0x90); -+ break; -+ case 113: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0x70, 0x90); -+ break; -+ case 121: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x03, 0x70, 0x90); -+ break; -+ case 22: -+ case 122: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x35, 0x03, 0x71, 0x11); -+ break; -+ } -+ } -+ else -+ { -+ // disable PS tdma -+ switch(type) -+ { -+ case 0: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x40, 0x0); -+ break; -+ case 1: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x48, 0x0); -+ break; -+ default: -+ halbtc8703b2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x40, 0x0); -+ break; -+ } -+ } -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+VOID -+halbtc8703b2ant_PsTdmaCheckForPowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bNewPsState -+ ) -+{ -+ u1Byte lpsMode=0x0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode); -+ -+ if(lpsMode) // already under LPS state -+ { -+ if(bNewPsState) -+ { -+ // keep state under LPS, do nothing. -+ } -+ else -+ { -+ // will leave LPS state, turn off psTdma first -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ } -+ else // NO PS state -+ { -+ if(bNewPsState) -+ { -+ // will enter LPS state, turn off psTdma first -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ else -+ { -+ // keep state under NO PS state, do nothing. -+ } -+ } -+} -+ -+VOID -+halbtc8703b2ant_PowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte psType, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bLowPwrDisable=FALSE; -+ -+ switch(psType) -+ { -+ case BTC_PS_WIFI_NATIVE: -+ // recover to original 32k low power setting -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8703b2ant_PsTdmaCheckForPowerSaveState(pBtCoexist, TRUE); -+ halbtc8703b2ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal); -+ // when coex force to enter LPS, do not enter 32k low power. -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ // power save must executed before psTdma. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); -+ pCoexSta->bForceLpsOn = TRUE; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8703b2ant_PsTdmaCheckForPowerSaveState(pBtCoexist, FALSE); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+VOID -+halbtc8703b2ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw all off -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ // hw all off -+ //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8703b2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 6); -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, FORCE_EXEC, 0); -+ -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+VOID -+halbtc8703b2ant_ActionBtInquiry( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ BOOLEAN bWifiConnected=FALSE; -+ BOOLEAN bLowPwrDisable=TRUE; -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ -+ -+ wifiRssiState = halbtc8703b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8703b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8703b2ant_BtRssiState(2, BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ if(bScan || bLink || bRoam) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi link process + BT Inq/Page!!\n")); -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 15); -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ } -+ else if(bWifiConnected) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT Inq/Page!!\n")); -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 15); -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi no-link + BT Inq/Page!!\n")); -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 6); -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+/* -+ pCoexDm->bNeedRecover0x948 = TRUE; -+ pCoexDm->backup0x948 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ -+ halbtc8703b2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_AUX, FALSE, FALSE); -+*/ -+} -+ -+ -+VOID -+halbtc8703b2ant_ActionWiFiLinkProcess( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ u1Byte u1Tmpa, u1Tmpb; -+ -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 15); -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x76e=0x%x\n", -+ u4Tmp, u1Tmpa, u1Tmpb)); -+} -+ -+BOOLEAN -+halbtc8703b2ant_ActionWifiIdleProcess( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ u1Byte apNum=0; -+ -+ wifiRssiState = halbtc8703b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ //wifiRssiState1 = halbtc8703b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ wifiRssiState1 = halbtc8703b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES-20, 0); -+ btRssiState = halbtc8703b2ant_BtRssiState(2, BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ -+ // define the office environment -+ if(BTC_RSSI_HIGH(wifiRssiState1) && -+ (pCoexSta->bHidExist == TRUE) && (pCoexSta->bA2dpExist == TRUE)) -+ { -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle process for BT HID+A2DP exist!!\n")); -+ -+ halbtc8703b2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x6); -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ -+ return TRUE; -+ } -+ else -+ { -+ halbtc8703b2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ return FALSE; -+ } -+ -+ -+} -+ -+ -+ -+BOOLEAN -+halbtc8703b2ant_IsCommonAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte btRssiState=BTC_RSSI_STATE_HIGH; -+ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE, bWifiBusy=FALSE; -+ BOOLEAN bBtHsOn=FALSE, bLowPwrDisable=FALSE; -+ BOOLEAN bAsus8703b=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if(!bWifiConnected) -+ { -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-connected idle!!\n")); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ if(BT_8703B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT non connected-idle!!\n")); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0xb); -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else if(BT_8703B_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ if(bBtHsOn) -+ return FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT connected-idle!!\n")); -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0xb); -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ if(bWifiBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n")); -+#if 0 -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_IS_ASUS_8703B, &bAsus8703b); -+ if(!bAsus8703b) -+ bCommon = FALSE; -+ else -+ bCommon = halbtc8703b2ant_ActionWifiIdleProcess(pBtCoexist); -+#else -+ bCommon = FALSE; -+#endif -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n")); -+ //bCommon = FALSE; -+ bCommon = halbtc8703b2ant_ActionWifiIdleProcess(pBtCoexist); -+ } -+ } -+ } -+ -+ return bCommon; -+} -+VOID -+halbtc8703b2ant_TdmaDurationAdjust( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bScoHid, -+ IN BOOLEAN bTxPause, -+ IN u1Byte maxInterval -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjust()\n")); -+ -+ if(!pCoexDm->bAutoTdmaAdjust) -+ { -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ { -+ if(bScoHid) -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ else -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ } -+ } -+ } -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], retryCount = %d\n", retryCount)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], up=%d, dn=%d, m=%d, n=%d, WaitCount=%d\n", -+ up, dn, m, n, WaitCount)); -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], max Interval = %d\n", maxInterval)); -+ if(maxInterval == 1) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ -+ if(pCoexDm->curPsTdma == 71) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 71); -+ pCoexDm->psTdmaDuAdjType = 71; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 71) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 71); -+ pCoexDm->psTdmaDuAdjType = 71; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 2) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 3) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ } -+ } -+ -+ // if current PsTdma not match with the recorded one (when scan, dhcp...), -+ // then we have to adjust it back to the previous record one. -+ if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) -+ { -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", -+ pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if( !bScan && !bLink && !bRoam) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); -+ } -+ } -+} -+ -+// SCO only or SCO+PAN(HS) -+VOID -+halbtc8703b2ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8703b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8703b2ant_BtRssiState(2, BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 4); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) //for SCO quality at 11b/g mode -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+ else //for SCO quality & wifi performance balance at 11n mode -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); //for voice quality -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x4); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x4); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x4); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x4); -+ } -+ } -+} -+ -+ -+VOID -+halbtc8703b2ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8703b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8703b2ant_BtRssiState(2, BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) //for HID at 11b/g mode -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else //for HID quality & wifi performance balance at 11n mode -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 9); -+ } -+ -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ } -+ else -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -+VOID -+halbtc8703b2ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ u1Byte apNum=0; -+ -+ wifiRssiState = halbtc8703b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8703b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8703b2ant_BtRssiState(2, BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ -+ // define the office environment -+ if( (apNum >= 10) && BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ //DbgPrint(" AP#>10(%d)\n", apNum); -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x18); -+ } -+ return; -+ -+ } -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 13); -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); -+ } -+ else -+ { -+ halbtc8703b2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); -+ } -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8703b2ant_ActionA2dpPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8703b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8703b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8703b2ant_BtRssiState(2, BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 13); -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ halbtc8703b2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 2); -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8703b2ant_ActionPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState,wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8703b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8703b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8703b2ant_BtRssiState(2, BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 10); -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 13); -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ } -+ else -+ { -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ } -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+ -+//PAN(HS) only -+VOID -+halbtc8703b2ant_ActionPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8703b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8703b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8703b2ant_BtRssiState(2, BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+//PAN(EDR)+A2DP -+VOID -+halbtc8703b2ant_ActionPanEdrA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8703b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8703b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8703b2ant_BtRssiState(2, BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 12); -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ halbtc8703b2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ else -+ halbtc8703b2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); -+ } -+ else -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 13); -+ halbtc8703b2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8703b2ant_ActionPanEdrHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8703b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8703b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8703b2ant_BtRssiState(2, BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 14); -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 3); -+ //halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 11); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); -+ } -+ else -+ { -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ //halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ } -+ halbtc8703b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 2); -+ } -+ else -+ { -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ //halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 14); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8703b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+// HID+A2DP+PAN(EDR) -+VOID -+halbtc8703b2ant_ActionHidA2dpPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState,wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8703b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8703b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8703b2ant_BtRssiState(2, BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 14); -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ halbtc8703b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ else -+ halbtc8703b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); -+ } -+ else -+ { -+ halbtc8703b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8703b2ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ u1Byte apNum=0; -+ -+ wifiRssiState = halbtc8703b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ //btRssiState = halbtc8703b2ant_BtRssiState(2, 29, 0); -+ wifiRssiState1 = halbtc8703b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8703b2ant_BtRssiState(3, BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES, 37); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8703b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x5); -+ -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_LEGACY == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else -+ { // only 802.11N mode we have to dec bt power to 4 degree -+ if(BTC_RSSI_HIGH(btRssiState)) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ // need to check ap Number of Not -+ if(apNum < 10) -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+ else -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ } -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 14); -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); -+ } -+ else -+ { -+ halbtc8703b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8703b2ant_ActionBtWhckTest( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8703b2ant_ActionWifiMultiPort( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8703b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8703b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8703b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8703b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ // hw all off -+ //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8703b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8703b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+} -+ -+VOID -+halbtc8703b2ant_RunCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiUnder5G=FALSE, bBtHsOn=FALSE; -+ u1Byte btInfoOriginal=0, btRetryCnt=0; -+ u1Byte algorithm=0; -+ u4Byte numOfWifiLink=0; -+ u4Byte wifiLinkStatus=0; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bMiracastPlusBt=FALSE; -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism()===>\n")); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n")); -+ return; -+ } -+ -+ if(pCoexSta->bUnderIps) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under IPS !!!\n")); -+ return; -+ } -+ -+ if(pCoexSta->bBtWhckTest) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is under WHCK TEST!!!\n")); -+ halbtc8703b2ant_ActionBtWhckTest(pBtCoexist); -+ return; -+ } -+ -+ algorithm = halbtc8703b2ant_ActionAlgorithm(pBtCoexist); -+ if(pCoexSta->bC2hBtInquiryPage && (BT_8703B_2ANT_COEX_ALGO_PANHS!=algorithm)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is under inquiry/page scan !!\n")); -+ halbtc8703b2ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else -+ { -+ /* -+ if(pCoexDm->bNeedRecover0x948) -+ { -+ pCoexDm->bNeedRecover0x948 = FALSE; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, pCoexDm->backup0x948); -+ } -+ */ -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if(bScan || bLink || bRoam) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], WiFi is under Link Process !!\n")); -+ halbtc8703b2ant_ActionWiFiLinkProcess(pBtCoexist); -+ return; -+ } -+ -+ //for P2P -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ -+ if((numOfWifiLink>=2) || (wifiLinkStatus&WIFI_P2P_GO_CONNECTED)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], Multi-Port numOfWifiLink = %d, wifiLinkStatus = 0x%x\n", numOfWifiLink,wifiLinkStatus) ); -+ -+ if(pBtLinkInfo->bBtLinkExist) -+ { -+ bMiracastPlusBt = TRUE; -+ } -+ else -+ { -+ bMiracastPlusBt = FALSE; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ halbtc8703b2ant_ActionWifiMultiPort(pBtCoexist); -+ -+ return; -+ } -+ else -+ { -+ bMiracastPlusBt = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ } -+ -+ pCoexDm->curAlgorithm = algorithm; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Algorithm = %d \n", pCoexDm->curAlgorithm)); -+ -+ if(halbtc8703b2ant_IsCommonAction(pBtCoexist)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant common.\n")); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else -+ { -+ if(pCoexDm->curAlgorithm != pCoexDm->preAlgorithm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], preAlgorithm=%d, curAlgorithm=%d\n", -+ pCoexDm->preAlgorithm, pCoexDm->curAlgorithm)); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8703B_2ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO.\n")); -+ halbtc8703b2ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8703B_2ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID.\n")); -+ halbtc8703b2ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8703B_2ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP.\n")); -+ halbtc8703b2ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8703B_2ANT_COEX_ALGO_A2DP_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n")); -+ halbtc8703b2ant_ActionA2dpPanHs(pBtCoexist); -+ break; -+ case BT_8703B_2ANT_COEX_ALGO_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n")); -+ halbtc8703b2ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8703B_2ANT_COEX_ALGO_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HS mode.\n")); -+ halbtc8703b2ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8703B_2ANT_COEX_ALGO_PANEDR_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n")); -+ halbtc8703b2ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8703B_2ANT_COEX_ALGO_PANEDR_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n")); -+ halbtc8703b2ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8703B_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n")); -+ halbtc8703b2ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8703B_2ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n")); -+ halbtc8703b2ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n")); -+ halbtc8703b2ant_CoexAllOff(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+} -+ -+VOID -+halbtc8703b2ant_WifiOffHwCfg( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bIsInMpMode = FALSE; -+ u1Byte H2C_Parameter[2] ={0}; -+ u4Byte fwVer=0; -+ -+ // set wlan_act to low -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); //WiFi goto standby while GNT_BT 0-->1 -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ if(fwVer >= 0x180000) -+ { -+ /* Use H2C to set GNT_BT to HIGH */ -+ H2C_Parameter[0] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, &bIsInMpMode); -+ if(!bIsInMpMode) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x0); //BT select s0/s1 is controlled by BT -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); //BT select s0/s1 is controlled by WiFi -+} -+ -+VOID -+halbtc8703b2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bBackUp -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte u4Tmp=0, fwVer; -+ u2Byte u2Tmp=0; -+ u1Byte u1Tmp=0; -+ u1Byte H2C_Parameter[2] ={0}; -+ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); -+ -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ // 0x790[5:0]=0x5 -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x790); -+ u1Tmp &= 0xc0; -+ u1Tmp |= 0x5; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, u1Tmp); -+ -+ //Antenna config -+ halbtc8703b2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_MAIN, TRUE, FALSE); -+ pCoexSta->disVerInfoCnt = 0; -+ -+ // PTA parameter -+ halbtc8703b2ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ // Enable counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); //0x76e[3] =1, WLAN_Act control by PTA -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x3); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0x20, 0x1); -+} -+ -+//============================================================ -+// work around function start with wa_halbtc8703b2ant_ -+//============================================================ -+//============================================================ -+// extern function start with EXhalbtc8703b2ant_ -+//============================================================ -+VOID -+EXhalbtc8703b2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u2Byte u2Tmp=0x0; -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x67, 0x20); -+ -+ // enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. -+ u2Tmp = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x2); -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x2, u2Tmp|BIT0|BIT1); -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ -+ if(pBtCoexist->chipInterface == BTC_INTF_USB) -+ { -+ // fixed at S0 for USB interface -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ else -+ { -+ // for PCIE and SDIO interface, we check efuse 0xc3[6] -+ if(pBoardInfo->singleAntPath == 0) -+ { -+ // set to S1 -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+ } -+ else if(pBoardInfo->singleAntPath == 1) -+ { -+ // set to S0 -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ } -+} -+ -+VOID -+EXhalbtc8703b2ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u1Byte u1Tmp=0x4; /* Set BIT2 by default since it's 2ant case */ -+ -+ // -+ // S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) -+ // Local setting bit define -+ // BIT0: "0" for no antenna inverse; "1" for antenna inverse -+ // BIT1: "0" for internal switch; "1" for external switch -+ // BIT2: "0" for one antenna; "1" for two antenna -+ // NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 -+ if(pBtCoexist->chipInterface == BTC_INTF_USB) -+ { -+ // fixed at S0 for USB interface -+ u1Tmp |= 0x1; // antenna inverse -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0xfe08, u1Tmp); -+ } -+ else -+ { -+ // for PCIE and SDIO interface, we check efuse 0xc3[6] -+ if(pBoardInfo->singleAntPath == 0) -+ { -+ } -+ else if(pBoardInfo->singleAntPath == 1) -+ { -+ // set to S0 -+ u1Tmp |= 0x1; // antenna inverse -+ } -+ -+ if(pBtCoexist->chipInterface == BTC_INTF_PCI) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x384, u1Tmp); -+ } -+ else if(pBtCoexist->chipInterface == BTC_INTF_SDIO) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x60, u1Tmp); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8703b2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ halbtc8703b2ant_InitHwConfig(pBtCoexist, TRUE); -+} -+ -+VOID -+EXhalbtc8703b2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8703b2ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8703b2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ u4Byte faOfdm, faCck; -+ u4Byte fwVer=0, btPatchVer=0; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", "CoexVer/ FwVer/ PatchVer", \ -+ GLCoexVerDate8703b2Ant, GLCoexVer8703b2Ant, fwVer, btPatchVer, btPatchVer); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %ddBm/ %d] ", "BT [status/ rssi/ retryCnt]", \ -+ ((pBtCoexist->btInfo.bBtDisabled)? ("disabled"): ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8703B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)? "non-connected idle": -+ ( (BT_8703B_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy")))), -+ pCoexSta->btRssi-100, pCoexSta->btRetryCnt); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pBtLinkInfo->bScoExist, pBtLinkInfo->bHidExist, pBtLinkInfo->bPanExist, pBtLinkInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ -+ if (pStackInfo->bProfileNotified) -+ { -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Role", \ -+ (pBtLinkInfo->bSlaveRole )? "Slave":"Master"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8703b2Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ // Sw mechanism -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism] (before Manual)============"); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", "SM1[ShRf/ LpRA/ LimDig]", \ -+ pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ -+ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism] (before Manual) ============"); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ } -+ -+ psTdmaCase = pCoexDm->curPsTdma; -+ -+ if (pCoexDm->bIsSwitchTo1dot5Ant) -+ psTdmaCase = psTdmaCase + 100; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase, -+ (pCoexDm->bCurPsTdmaOn? "On":"Off"), -+ (pCoexDm->bAutoTdmaAdjust? "Adj":"Fix") ); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Coex Table Type", \ -+ pCoexSta->nCoexTableType); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "DecBtPwr/ IgnWlanAct", \ -+ pCoexDm->curBtDecPwrLvl, pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x778/0x880[29:25]", \ -+ u1Tmp[0], (u4Tmp[0]&0x3e000000) >> 25); -+ CL_PRINTF(cliBuf); -+ -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x948/ 0x67[5] / 0x765", \ -+ u4Tmp[0], ((u1Tmp[0]&0x20)>> 5), u1Tmp[1]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x92c); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x930); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x944); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", \ -+ u4Tmp[0]&0x3, u4Tmp[1]&0xff, u4Tmp[2]&0x3); -+ CL_PRINTF(cliBuf); -+ -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x39); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x64); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x38[11]/0x40/0x4c[24:23]/0x64[0]", \ -+ ((u1Tmp[0] & 0x8)>>3), u1Tmp[1], ((u4Tmp[0]&0x01800000)>>23), u1Tmp[2]&0x1); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49c); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0xc50(dig)/0x49c(null-drop)", \ -+ u4Tmp[0]&0xff, u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); -+ u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xcf0); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5b); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5c); -+ -+ faOfdm = ((u4Tmp[0]&0xffff0000) >> 16) + ((u4Tmp[1]&0xffff0000) >> 16) + (u4Tmp[1] & 0xffff) + (u4Tmp[2] & 0xffff) + \ -+ ((u4Tmp[3]&0xffff0000) >> 16) + (u4Tmp[3] & 0xffff) ; -+ faCck = (u1Tmp[0] << 8) + u1Tmp[1]; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "OFDM-CCA/OFDM-FA/CCK-FA", \ -+ u4Tmp[0]&0xffff, faOfdm, faCck); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_OK CCK/11g/11n/11n-Agg", \ -+ pCoexSta->nCRCOK_CCK, pCoexSta->nCRCOK_11g, pCoexSta->nCRCOK_11n, pCoexSta->nCRCOK_11nAgg); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_Err CCK/11g/11n/11n-Agg", \ -+ pCoexSta->nCRCErr_CCK, pCoexSta->nCRCErr_11g, pCoexSta->nCRCErr_11n, pCoexSta->nCRCErr_11nAgg); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770(high-pri rx/tx)", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(low-pri rx/tx)", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+#if(BT_AUTO_REPORT_ONLY_8703B_2ANT == 1) -+ //halbtc8703b2ant_MonitorBtCtr(pBtCoexist); -+#endif -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8703b2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ pCoexSta->bUnderIps = TRUE; -+ halbtc8703b2ant_WifiOffHwCfg(pBtCoexist); -+ halbtc8703b2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ halbtc8703b2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ pCoexSta->bUnderIps = FALSE; -+ halbtc8703b2ant_InitHwConfig(pBtCoexist, FALSE); -+ halbtc8703b2ant_InitCoexDm(pBtCoexist); -+ halbtc8703b2ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8703b2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ pCoexSta->bUnderLps = TRUE; -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ pCoexSta->bUnderLps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8703b2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u4Byte u4Tmp; -+ u1Byte u1Tmpa, u1Tmpb; -+ -+ -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e); -+ -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x76e=0x%x\n", -+ u4Tmp, u1Tmpa, u1Tmpb)); -+} -+ -+VOID -+EXhalbtc8703b2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8703b2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ u1Byte apNum=0; -+ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+ -+ // only 2.4G we need to inform bt the chnl mask -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if( (BTC_MEDIA_CONNECT == type) && -+ (wifiCentralChnl <= 14) ) -+ { -+ H2C_Parameter[0] = 0x1; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ if(apNum < 10) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x66=0x%x\n", -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter); -+} -+ -+VOID -+EXhalbtc8703b2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8703b2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bBtBusy=FALSE, bLimitedDig=FALSE; -+ BOOLEAN bWifiConnected=FALSE; -+ static BOOLEAN bPreScoExist=FALSE; -+ u4Byte raMask=0x0; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ -+ rspSource = tmpBuf[0]&0xf; -+ if(rspSource >= BT_INFO_SRC_8703B_2ANT_MAX) -+ rspSource = BT_INFO_SRC_8703B_2ANT_WIFI_FW; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 1) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), return for Manual CTRL<===\n")); -+ return; -+ } -+ -+ // if 0xff, it means BT is under WHCK test -+ if (btInfo == 0xff) -+ pCoexSta->bBtWhckTest = TRUE; -+ else -+ pCoexSta->bBtWhckTest = FALSE; -+ -+ if(BT_INFO_SRC_8703B_2ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = // [3:0] -+ pCoexSta->btInfoC2h[rspSource][2]&0xf; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][3]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][4]; -+ -+ pCoexSta->bBtTxRxMask = (pCoexSta->btInfoC2h[rspSource][2]&0x40); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TX_RX_MASK, &pCoexSta->bBtTxRxMask); -+ if (pCoexSta->bBtTxRxMask) -+ { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x01 => Need to switch BT TRx Mask */ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x01\n")); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x01); -+ } -+ -+ // Here we need to resend some wifi info to BT -+ // because bt is reset and loss of the info. -+ if( (pCoexSta->btInfoExt & BIT1) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(bWifiConnected) -+ { -+ EXhalbtc8703b2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT); -+ } -+ else -+ { -+ EXhalbtc8703b2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ } -+ -+ if( (pCoexSta->btInfoExt & BIT3) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")); -+ halbtc8703b2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ } -+ else -+ { -+ // BT already NOT ignore Wlan active, do nothing here. -+ } -+#if(BT_AUTO_REPORT_ONLY_8703B_2ANT == 0) -+ if( (pCoexSta->btInfoExt & BIT4) ) -+ { -+ // BT auto report already enabled, do nothing -+ } -+ else -+ { -+ halbtc8703b2ant_BtAutoReport(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+#endif -+ } -+ -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8703B_2ANT_B_INQ_PAGE) -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ else -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ -+ // set link exist status -+ if(!(btInfo&BT_INFO_8703B_2ANT_B_CONNECTION)) -+ { -+ pCoexSta->bBtLinkExist = FALSE; -+ pCoexSta->bPanExist = FALSE; -+ pCoexSta->bA2dpExist = FALSE; -+ pCoexSta->bHidExist = FALSE; -+ pCoexSta->bScoExist = FALSE; -+ } -+ else // connection exists -+ { -+ pCoexSta->bBtLinkExist = TRUE; -+ if(btInfo & BT_INFO_8703B_2ANT_B_FTP) -+ pCoexSta->bPanExist = TRUE; -+ else -+ pCoexSta->bPanExist = FALSE; -+ if(btInfo & BT_INFO_8703B_2ANT_B_A2DP) -+ pCoexSta->bA2dpExist = TRUE; -+ else -+ pCoexSta->bA2dpExist = FALSE; -+ if(btInfo & BT_INFO_8703B_2ANT_B_HID) -+ pCoexSta->bHidExist = TRUE; -+ else -+ pCoexSta->bHidExist = FALSE; -+ if(btInfo & BT_INFO_8703B_2ANT_B_SCO_ESCO) -+ pCoexSta->bScoExist = TRUE; -+ else -+ pCoexSta->bScoExist = FALSE; -+ -+ if ( (pCoexSta->bHidExist == FALSE) && (pCoexSta->bC2hBtInquiryPage == FALSE) && (pCoexSta->bScoExist == FALSE)) -+ { -+ if (pCoexSta->highPriorityTx + pCoexSta->highPriorityRx >= 160) -+ { -+ pCoexSta->bHidExist = TRUE; -+ btInfo = btInfo | 0x20; -+ } -+ } -+ } -+ -+ halbtc8703b2ant_UpdateBtLinkInfo(pBtCoexist); -+ -+ if(!(btInfo&BT_INFO_8703B_2ANT_B_CONNECTION)) -+ { -+ pCoexDm->btStatus = BT_8703B_2ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n")); -+ } -+ else if(btInfo == BT_INFO_8703B_2ANT_B_CONNECTION) // connection exists but no busy -+ { -+ pCoexDm->btStatus = BT_8703B_2ANT_BT_STATUS_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n")); -+ } -+ else if((btInfo&BT_INFO_8703B_2ANT_B_SCO_ESCO) || -+ (btInfo&BT_INFO_8703B_2ANT_B_SCO_BUSY)) -+ { -+ pCoexDm->btStatus = BT_8703B_2ANT_BT_STATUS_SCO_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n")); -+ } -+ else if(btInfo&BT_INFO_8703B_2ANT_B_ACL_BUSY) -+ { -+ pCoexDm->btStatus = BT_8703B_2ANT_BT_STATUS_ACL_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n")); -+ } -+ else -+ { -+ pCoexDm->btStatus = BT_8703B_2ANT_BT_STATUS_MAX; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n")); -+ } -+ -+ if( (BT_8703B_2ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8703B_2ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8703B_2ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ bBtBusy = TRUE; -+ bLimitedDig = TRUE; -+ } -+ else -+ { -+ bBtBusy = FALSE; -+ bLimitedDig = FALSE; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ pCoexDm->bLimitedDig = bLimitedDig; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bLimitedDig); -+ -+ halbtc8703b2ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8703b2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8703b2ant_WifiOffHwCfg(pBtCoexist); -+ //remove due to interrupt is disabled that polling c2h will fail and delay 100ms. -+ //pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT goto standby while GNT_BT 1-->0 -+ halbtc8703b2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ -+ EXhalbtc8703b2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+VOID -+EXhalbtc8703b2ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify\n")); -+ -+ if(BTC_WIFI_PNP_SLEEP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to SLEEP\n")); -+ } -+ else if(BTC_WIFI_PNP_WAKE_UP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to WAKE UP\n")); -+ halbtc8703b2ant_InitHwConfig(pBtCoexist, FALSE); -+ halbtc8703b2ant_InitCoexDm(pBtCoexist); -+ halbtc8703b2ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8703b2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ //static u1Byte disVerInfoCnt=0; -+ u4Byte fwVer=0, btPatchVer=0; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ==========================Periodical===========================\n")); -+ -+ if(pCoexSta->disVerInfoCnt <= 5) -+ { -+ pCoexSta->disVerInfoCnt += 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ant PG Num/ Ant Mech/ Ant Pos = %d/ %d/ %d\n", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT stack/ hci ext ver = %s / %d\n", -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion)); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", -+ GLCoexVerDate8703b2Ant, GLCoexVer8703b2Ant, fwVer, btPatchVer, btPatchVer)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ -+ if (pCoexSta->disVerInfoCnt == 3) -+ { -+ //Antenna config to set 0x765 = 0x0 (GNT_BT control by PTA) after initial -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set GNT_BT control by PTA\n")); -+ halbtc8703b2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_MAIN, FALSE, FALSE); -+ } -+ } -+ -+#if(BT_AUTO_REPORT_ONLY_8703B_2ANT == 0) -+ halbtc8703b2ant_QueryBtInfo(pBtCoexist); -+ halbtc8703b2ant_MonitorBtEnableDisable(pBtCoexist); -+#else -+ halbtc8703b2ant_MonitorBtCtr(pBtCoexist); -+ halbtc8703b2ant_MonitorWiFiCtr(pBtCoexist); -+ -+ if( halbtc8703b2ant_IsWifiStatusChanged(pBtCoexist) || -+ pCoexDm->bAutoTdmaAdjust) -+ { -+ halbtc8703b2ant_RunCoexistMechanism(pBtCoexist); -+ } -+#endif -+} -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8703b2Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8703b2Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8703b2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8703b2Ant.h 2017-06-07 23:07:21.010687485 +0300 -@@ -0,0 +1,228 @@ -+//=========================================== -+// The following is for 8703B 2Ant BT Co-exist definition -+//=========================================== -+#define BT_AUTO_REPORT_ONLY_8703B_2ANT 1 -+ -+ -+#define BT_INFO_8703B_2ANT_B_FTP BIT7 -+#define BT_INFO_8703B_2ANT_B_A2DP BIT6 -+#define BT_INFO_8703B_2ANT_B_HID BIT5 -+#define BT_INFO_8703B_2ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8703B_2ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8703B_2ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8703B_2ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8703B_2ANT_B_CONNECTION BIT0 -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8703B_2ANT 2 -+ -+ -+#define BT_8703B_2ANT_WIFI_RSSI_COEXSWITCH_THRES 42 //WiFi RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation -+#define BT_8703B_2ANT_BT_RSSI_COEXSWITCH_THRES 46 //BT RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation -+ -+typedef enum _BT_INFO_SRC_8703B_2ANT{ -+ BT_INFO_SRC_8703B_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8703B_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8703B_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8703B_2ANT_MAX -+}BT_INFO_SRC_8703B_2ANT,*PBT_INFO_SRC_8703B_2ANT; -+ -+typedef enum _BT_8703B_2ANT_BT_STATUS{ -+ BT_8703B_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8703B_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8703B_2ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8703B_2ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8703B_2ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8703B_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8703B_2ANT_BT_STATUS_MAX -+}BT_8703B_2ANT_BT_STATUS,*PBT_8703B_2ANT_BT_STATUS; -+ -+typedef enum _BT_8703B_2ANT_COEX_ALGO{ -+ BT_8703B_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8703B_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8703B_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8703B_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8703B_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8703B_2ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8703B_2ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8703B_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8703B_2ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8703B_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8703B_2ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8703B_2ANT_COEX_ALGO_MAX = 0xb, -+}BT_8703B_2ANT_COEX_ALGO,*PBT_8703B_2ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8703B_2ANT{ -+ // fw mechanism -+ u1Byte preBtDecPwrLvl; -+ u1Byte curBtDecPwrLvl; -+ u1Byte preFwDacSwingLvl; -+ u1Byte curFwDacSwingLvl; -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ BOOLEAN bResetTdmaAdjust; -+ BOOLEAN bAutoTdmaAdjust; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ BOOLEAN bPreBtAutoReport; -+ BOOLEAN bCurBtAutoReport; -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ BOOLEAN bPreDacSwingOn; -+ u4Byte preDacSwingLvl; -+ BOOLEAN bCurDacSwingOn; -+ u4Byte curDacSwingLvl; -+ BOOLEAN bPreAdcBackOff; -+ BOOLEAN bCurAdcBackOff; -+ BOOLEAN bPreAgcTableEn; -+ BOOLEAN bCurAgcTableEn; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+ -+ BOOLEAN bNeedRecover0x948; -+ u4Byte backup0x948; -+ -+ u1Byte preLps; -+ u1Byte curLps; -+ u1Byte preRpwm; -+ u1Byte curRpwm; -+ -+ BOOLEAN bIsSwitchTo1dot5Ant; -+} COEX_DM_8703B_2ANT, *PCOEX_DM_8703B_2ANT; -+ -+typedef struct _COEX_STA_8703B_2ANT{ -+ BOOLEAN bBtLinkExist; -+ BOOLEAN bScoExist; -+ BOOLEAN bA2dpExist; -+ BOOLEAN bHidExist; -+ BOOLEAN bPanExist; -+ -+ BOOLEAN bUnderLps; -+ BOOLEAN bUnderIps; -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ u1Byte btRssi; -+ BOOLEAN bBtTxRxMask; -+ u1Byte preBtRssiState; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8703B_2ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8703B_2ANT_MAX]; -+ BOOLEAN bBtWhckTest; -+ BOOLEAN bC2hBtInquiryPage; -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+ -+ u4Byte nCRCOK_CCK; -+ u4Byte nCRCOK_11g; -+ u4Byte nCRCOK_11n; -+ u4Byte nCRCOK_11nAgg; -+ -+ u4Byte nCRCErr_CCK; -+ u4Byte nCRCErr_11g; -+ u4Byte nCRCErr_11n; -+ u4Byte nCRCErr_11nAgg; -+ -+ u1Byte nCoexTableType; -+ BOOLEAN bForceLpsOn; -+ -+ u1Byte disVerInfoCnt; -+}COEX_STA_8703B_2ANT, *PCOEX_STA_8703B_2ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8703b2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8703b2ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8703b2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8703b2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8703b2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8703b2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8703b2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8703b2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8703b2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8703b2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8703b2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8703b2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8703b2ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ); -+VOID -+EXhalbtc8703b2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8703b2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723a1Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8723a1Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723a1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8723a1Ant.c 2017-06-07 23:07:21.010687485 +0300 -@@ -0,0 +1,1544 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8723A Co-exist mechanism -+// -+// History -+// 2012/08/22 Cosa first check in. -+// 2012/11/14 Cosa Revise for 8723A 1Ant out sourcing. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8723a1Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8723A_1ANT GLCoexDm8723a1Ant; -+static PCOEX_DM_8723A_1ANT pCoexDm=&GLCoexDm8723a1Ant; -+static COEX_STA_8723A_1ANT GLCoexSta8723a1Ant; -+static PCOEX_STA_8723A_1ANT pCoexSta=&GLCoexSta8723a1Ant; -+ -+const char *const GLBtInfoSrc8723a1Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8723a1ant_ -+//============================================================ -+VOID -+halbtc8723a1ant_Reg0x550Bit3( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSet -+ ) -+{ -+ u1Byte u1tmp=0; -+ -+ u1tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x550); -+ if(bSet) -+ { -+ u1tmp |= BIT3; -+ } -+ else -+ { -+ u1tmp &= ~BIT3; -+ } -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x550, u1tmp); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set 0x550[3]=%d\n", (bSet? 1:0))); -+} -+ -+VOID -+halbtc8723a1ant_NotifyFwScan( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte scanType -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(BTC_SCAN_START == scanType) -+ H2C_Parameter[0] = 0x1; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Notify FW for wifi scan, write 0x3b=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x3b, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a1ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = TRUE; -+ -+ H2C_Parameter[0] |= BIT0; // trigger -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x38=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x38, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a1ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xf0ff7); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+VOID -+halbtc8723a1ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8723a1ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8723a1ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte tmpU1; -+ -+ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); -+ tmpU1 |= BIT0; -+ if(bLowPenaltyRa) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); -+ tmpU1 &= ~BIT2; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); -+ tmpU1 |= BIT2; -+ } -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -+} -+ -+VOID -+halbtc8723a1ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ return; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8723a1ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8723a1ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8723a1ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8723a1ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8723a1ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(bEnable) -+ { -+ H2C_Parameter[0] |= BIT0; // function enable -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x25=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x25, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a1ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8723a1ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8723a1ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ u1Byte realByte1=byte1, realByte5=byte5; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ // byte1[1:0] != 0 means enable pstdma -+ // for 2Ant bt coexist, if byte1 != 0 means enable pstdma -+ if(byte1) -+ { -+ if(bApEnable) -+ { -+ if(type != 5 && type != 12) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FW for 1Ant AP mode\n")); -+ realByte1 &= ~BIT4; -+ realByte1 |= BIT5; -+ -+ realByte5 |= BIT5; -+ realByte5 &= ~BIT6; -+ } -+ } -+ } -+ H2C_Parameter[0] = realByte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = realByte5; -+ -+ pCoexDm->psTdmaPara[0] = realByte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = realByte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x3a(5bytes)=0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x3a, 5, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a1ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", -+ (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ if(pCoexDm->bCurPsTdmaOn) -+ { -+ switch(pCoexDm->curPsTdma) -+ { -+ case 1: -+ default: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x1a, 0x1a, 0x0, 0x40); -+ break; -+ case 2: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x12, 0x12, 0x0, 0x40); -+ break; -+ case 3: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x3f, 0x3, 0x10, 0x40); -+ break; -+ case 4: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x15, 0x3, 0x10, 0x0); -+ break; -+ case 5: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0xa9, 0x15, 0x3, 0x35, 0xc0); -+ break; -+ -+ case 8: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 9: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 10: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 11: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x5, 0x5, 0x0, 0x40); -+ break; -+ case 12: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0xa9, 0xa, 0x3, 0x15, 0xc0); -+ break; -+ -+ case 18: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ -+ case 20: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x2a, 0x2a, 0x0, 0x0); -+ break; -+ case 21: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x20, 0x3, 0x10, 0x40); -+ break; -+ case 22: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x1a, 0x1a, 0x2, 0x40); -+ break; -+ case 23: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x12, 0x12, 0x2, 0x40); -+ break; -+ case 24: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0xa, 0xa, 0x2, 0x40); -+ break; -+ case 25: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x5, 0x5, 0x2, 0x40); -+ break; -+ case 26: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 27: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x5, 0x5, 0x2, 0x40); -+ break; -+ case 28: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x3, 0x2f, 0x2f, 0x0, 0x0); -+ break; -+ -+ } -+ } -+ else -+ { -+ // disable PS tdma -+ switch(pCoexDm->curPsTdma) -+ { -+ case 8: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x8, 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 0: -+ default: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x0, 0x0, 0x0, 0x0, 0x0); -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x860, 0x210); -+ break; -+ case 9: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x0, 0x0, 0x0, 0x0, 0x0); -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x860, 0x110); -+ break; -+ -+ } -+ } -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+ -+VOID -+halbtc8723a1ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw all off -+ halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ -+ // sw all off -+ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ // hw all off -+ halbtc8723a1ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+} -+ -+VOID -+halbtc8723a1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+} -+ -+VOID -+halbtc8723a1ant_BtEnableAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+} -+ -+VOID -+halbtc8723a1ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp; -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+} -+ -+VOID -+halbtc8723a1ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ bPreBtDisabled = bBtDisabled; -+ if(!bBtDisabled) -+ { -+ halbtc8723a1ant_BtEnableAction(pBtCoexist); -+ } -+ else -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ } -+ } -+} -+ -+VOID -+halbtc8723a1ant_TdmaDurationAdjust( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0; -+ u1Byte btState; -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ btState = pCoexDm->btStatus; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], TdmaDurationAdjust()\n")); -+ if(pCoexDm->psTdmaGlobalCnt != pCoexDm->psTdmaMonitorCnt) -+ { -+ pCoexDm->psTdmaMonitorCnt = 0; -+ pCoexDm->psTdmaGlobalCnt = 0; -+ } -+ if(pCoexDm->psTdmaMonitorCnt == 0) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], first run BT A2DP + WiFi busy state!!\n")); -+ if(btState == BT_STATE_8723A_1ANT_ACL_ONLY_BUSY) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ pCoexDm->psTdmaDuAdjType = 22; -+ } -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], retryCount = %d\n", retryCount)); -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT TxRx counter H+L <= 1200\n")); -+ if(btState != BT_STATE_8723A_1ANT_ACL_ONLY_BUSY) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], NOT ACL only busy!\n")); -+ if(BTC_WIFI_BW_HT40 != wifiBw) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 20MHz\n")); -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 22) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ pCoexDm->psTdmaDuAdjType = 23; -+ } -+ else if(pCoexDm->curPsTdma == 23) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); -+ pCoexDm->psTdmaDuAdjType = 24; -+ } -+ else if(pCoexDm->curPsTdma == 24) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); -+ pCoexDm->psTdmaDuAdjType = 25; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 25) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); -+ pCoexDm->psTdmaDuAdjType = 24; -+ } -+ else if(pCoexDm->curPsTdma == 24) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ pCoexDm->psTdmaDuAdjType = 23; -+ } -+ else if(pCoexDm->curPsTdma == 23) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ pCoexDm->psTdmaDuAdjType = 22; -+ } -+ } -+ // error handle, if not in the following state, -+ // set psTdma again. -+ if( (pCoexDm->psTdmaDuAdjType != 22) && -+ (pCoexDm->psTdmaDuAdjType != 23) && -+ (pCoexDm->psTdmaDuAdjType != 24) && -+ (pCoexDm->psTdmaDuAdjType != 25) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], duration case out of handle!!\n")); -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ pCoexDm->psTdmaDuAdjType = 23; -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 40MHz\n")); -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 23) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); -+ pCoexDm->psTdmaDuAdjType = 24; -+ } -+ else if(pCoexDm->curPsTdma == 24) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); -+ pCoexDm->psTdmaDuAdjType = 25; -+ } -+ else if(pCoexDm->curPsTdma == 25) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 27); -+ pCoexDm->psTdmaDuAdjType = 27; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 27) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); -+ pCoexDm->psTdmaDuAdjType = 25; -+ } -+ else if(pCoexDm->curPsTdma == 25) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); -+ pCoexDm->psTdmaDuAdjType = 24; -+ } -+ else if(pCoexDm->curPsTdma == 24) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ pCoexDm->psTdmaDuAdjType = 23; -+ } -+ } -+ // error handle, if not in the following state, -+ // set psTdma again. -+ if( (pCoexDm->psTdmaDuAdjType != 23) && -+ (pCoexDm->psTdmaDuAdjType != 24) && -+ (pCoexDm->psTdmaDuAdjType != 25) && -+ (pCoexDm->psTdmaDuAdjType != 27) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], duration case out of handle!!\n")); -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); -+ pCoexDm->psTdmaDuAdjType = 24; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ACL only busy\n")); -+ if (result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ } -+ -+ // error handle, if not in the following state, -+ // set psTdma again. -+ if( (pCoexDm->psTdmaDuAdjType != 1) && -+ (pCoexDm->psTdmaDuAdjType != 2) && -+ (pCoexDm->psTdmaDuAdjType != 9) && -+ (pCoexDm->psTdmaDuAdjType != 11) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], duration case out of handle!!\n")); -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ } -+ } -+ } -+ -+ // if current PsTdma not match with the recorded one (when scan, dhcp...), -+ // then we have to adjust it back to the previous record one. -+ if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", -+ pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if( !bScan && !bLink && !bRoam) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); -+ } -+ } -+ pCoexDm->psTdmaMonitorCnt++; -+} -+ -+ -+VOID -+halbtc8723a1ant_CoexForWifiConnect( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bWifiBusy=FALSE; -+ u1Byte btState, btInfoOriginal=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ btState = pCoexDm->btStatus; -+ btInfoOriginal = pCoexSta->btInfoC2h[BT_INFO_SRC_8723A_1ANT_BT_RSP][0]; -+ -+ if(bWifiConnected) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi connected!!\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if( !bWifiBusy && -+ ((BT_STATE_8723A_1ANT_NO_CONNECTION == btState) || -+ (BT_STATE_8723A_1ANT_CONNECT_IDLE == btState)) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], [Wifi is idle] or [Bt is non connected idle or Bt is connected idle]!!\n")); -+ -+ if(BT_STATE_8723A_1ANT_NO_CONNECTION == btState) -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+ else if(BT_STATE_8723A_1ANT_CONNECT_IDLE == btState) -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0xc0); -+ } -+ else -+ { -+ if( (BT_STATE_8723A_1ANT_SCO_ONLY_BUSY == btState) || -+ (BT_STATE_8723A_1ANT_ACL_SCO_BUSY == btState) || -+ (BT_STATE_8723A_1ANT_HID_BUSY == btState) || -+ (BT_STATE_8723A_1ANT_HID_SCO_BUSY == btState) ) -+ { -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0x60); -+ } -+ else -+ { -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0xc0); -+ } -+ switch(btState) -+ { -+ case BT_STATE_8723A_1ANT_NO_CONNECTION: -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ break; -+ case BT_STATE_8723A_1ANT_CONNECT_IDLE: -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ break; -+ case BT_STATE_8723A_1ANT_INQ_OR_PAG: -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ break; -+ case BT_STATE_8723A_1ANT_SCO_ONLY_BUSY: -+ case BT_STATE_8723A_1ANT_ACL_SCO_BUSY: -+ case BT_STATE_8723A_1ANT_HID_BUSY: -+ case BT_STATE_8723A_1ANT_HID_SCO_BUSY: -+ halbtc8723a1ant_TdmaDurationAdjust(pBtCoexist); -+ break; -+ case BT_STATE_8723A_1ANT_ACL_ONLY_BUSY: -+ if (btInfoOriginal&BT_INFO_8723A_1ANT_B_A2DP) -+ { -+ halbtc8723a1ant_TdmaDurationAdjust(pBtCoexist); -+ } -+ else if(btInfoOriginal&BT_INFO_8723A_1ANT_B_FTP) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ } -+ else if( (btInfoOriginal&BT_INFO_8723A_1ANT_B_A2DP) && -+ (btInfoOriginal&BT_INFO_8723A_1ANT_B_FTP) ) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ } -+ else -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ } -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], error!!!, undefined case in halbtc8723a1ant_CoexForWifiConnect()!!\n")); -+ break; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is disconnected!!\n")); -+ } -+ -+ pCoexDm->psTdmaGlobalCnt++; -+} -+ -+//============================================================ -+// work around function start with wa_halbtc8723a1ant_ -+//============================================================ -+VOID -+wa_halbtc8723a1ant_MonitorC2h( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte tmp1b=0x0; -+ u4Byte curC2hTotalCnt=0x0; -+ static u4Byte preC2hTotalCnt=0x0, sameCntPollingTime=0x0; -+ -+ curC2hTotalCnt+=pCoexSta->btInfoC2hCnt[BT_INFO_SRC_8723A_1ANT_BT_RSP]; -+ -+ if(curC2hTotalCnt == preC2hTotalCnt) -+ { -+ sameCntPollingTime++; -+ } -+ else -+ { -+ preC2hTotalCnt = curC2hTotalCnt; -+ sameCntPollingTime = 0; -+ } -+ -+ if(sameCntPollingTime >= 2) -+ { -+ tmp1b = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x1af); -+ if(tmp1b != 0x0) -+ { -+ pCoexSta->c2hHangDetectCnt++; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x1af, 0x0); -+ } -+ } -+} -+ -+//============================================================ -+// extern function start with EXhalbtc8723a1ant_ -+//============================================================ -+VOID -+EXhalbtc8723a1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Init HW Config!!\n")); -+ -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x20); -+ -+ // enable counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ // coex table -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, 0x0); // 1-Ant coex -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, 0xffff); // wifi break table -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, 0x55555555); //coex table -+ -+ // antenna switch control parameter -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x858, 0xaaaaaaaa); -+ -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x860, 0x210); //set antenna at wifi side if ANTSW is software control -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x870, 0x300); //SPDT(connected with TRSW) control by hardware PTA -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x874, 0x22804000); //ANTSW keep by GNT_BT -+ -+ // coexistence parameters -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x1); // enable RTK mode PTA -+} -+ -+VOID -+EXhalbtc8723a1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8723a1ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8723a1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ -+ ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8723A_1ANT_BT_STATUS_IDLE == pCoexDm->btStatus)? "idle":( (BT_8723A_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy"))), -+ pCoexSta->btRssi, pCoexSta->btRetryCnt); -+ CL_PRINTF(cliBuf); -+ -+ if(pStackInfo->bProfileNotified) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723a1Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "write 0x1af=0x0 num", \ -+ pCoexSta->c2hHangDetectCnt); -+ CL_PRINTF(cliBuf); -+ -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "SM1[ShRf/ LpRA/ LimDig]", \ -+ pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(!pBtCoexist->bManualControl) -+ { -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", "IgnWlanAct", \ -+ pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ } -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x783); -+ u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x796); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/ 0x783/ 0x796", \ -+ u1Tmp[0], u1Tmp[1], u1Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x880", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ -+ u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x484); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x484(rate adaptive)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); -+ u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xdac); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0xda0/0xda4/0xda8/0xdac(FA cnt)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u4Tmp[3]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770 (hp rx[31:16]/tx[15:0])", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(lp rx[31:16]/tx[15:0])", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8723a1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ halbtc8723a1ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ //halbtc8723a1ant_InitCoexDm(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE; -+ -+ halbtc8723a1ant_NotifyFwScan(pBtCoexist, type); -+ -+ if(pBtCoexist->btInfo.bBtDisabled) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+ } -+ else -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ //set 0x550[3]=1 before PsTdma -+ halbtc8723a1ant_Reg0x550Bit3(pBtCoexist, TRUE); -+ } -+ -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ else -+ { -+ halbtc8723a1ant_CoexForWifiConnect(pBtCoexist); -+ } -+ } -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE; -+ -+ if(pBtCoexist->btInfo.bBtDisabled) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+ } -+ else -+ { -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ //set 0x550[3]=1 before PsTdma -+ halbtc8723a1ant_Reg0x550Bit3(pBtCoexist, TRUE); -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); // extend wifi slot -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ else -+ { -+ halbtc8723a1ant_CoexForWifiConnect(pBtCoexist); -+ } -+ } -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ if(pBtCoexist->btInfo.bBtDisabled) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+ } -+ else -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 18); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bBtHsOn=FALSE, bBtBusy=FALSE, bForceLps=FALSE; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ -+ rspSource = BT_INFO_SRC_8723A_1ANT_BT_RSP; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 0) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ if(BT_INFO_SRC_8723A_1ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = -+ pCoexSta->btInfoC2h[rspSource][1]; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][2]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][3]; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8723A_1ANT_B_INQ_PAGE) -+ { -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ } -+ else -+ { -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ } -+ btInfo &= ~BIT2; -+ if(!(btInfo & BIT0)) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_NO_CONNECTION; -+ bForceLps = FALSE; -+ } -+ else -+ { -+ bForceLps = TRUE; -+ if(btInfo == 0x1) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_CONNECT_IDLE; -+ } -+ else if(btInfo == 0x9) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_ACL_ONLY_BUSY; -+ bBtBusy = TRUE; -+ } -+ else if(btInfo == 0x13) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_SCO_ONLY_BUSY; -+ bBtBusy = TRUE; -+ } -+ else if(btInfo == 0x1b) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_ACL_SCO_BUSY; -+ bBtBusy = TRUE; -+ } -+ else if(btInfo == 0x29) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_HID_BUSY; -+ bBtBusy = TRUE; -+ } -+ else if(btInfo == 0x3b) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_HID_SCO_BUSY; -+ bBtBusy = TRUE; -+ } -+ } -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bBtBusy); -+ if(bForceLps) -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); -+ else -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ -+ if( (BT_STATE_8723A_1ANT_NO_CONNECTION == pCoexDm->btStatus) || -+ (BT_STATE_8723A_1ANT_CONNECT_IDLE == pCoexDm->btStatus) ) -+ { -+ if(pCoexSta->bC2hBtInquiryPage) -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_INQ_OR_PAG; -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ -+ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, FORCE_EXEC, FALSE); -+ halbtc8723a1ant_RfShrink(pBtCoexist, FORCE_EXEC, FALSE); -+ -+ halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ EXhalbtc8723a1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+VOID -+EXhalbtc8723a1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE, bWifiConnected=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Periodical!!\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ // work around for c2h hang -+ wa_halbtc8723a1ant_MonitorC2h(pBtCoexist); -+ -+ halbtc8723a1ant_QueryBtInfo(pBtCoexist); -+ halbtc8723a1ant_MonitorBtCtr(pBtCoexist); -+ halbtc8723a1ant_MonitorBtEnableDisable(pBtCoexist); -+ -+ -+ if(bScan) -+ return; -+ if(bLink) -+ return; -+ -+ if(bWifiConnected) -+ { -+ if(pBtCoexist->btInfo.bBtDisabled) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+ -+ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ else -+ { -+ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a1ant_CoexForWifiConnect(pBtCoexist); -+ } -+ } -+ else -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ -+ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+} -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723a1Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8723a1Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723a1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8723a1Ant.h 2017-06-07 23:07:21.010687485 +0300 -@@ -0,0 +1,171 @@ -+//=========================================== -+// The following is for 8723A 1Ant BT Co-exist definition -+//=========================================== -+#define BT_INFO_8723A_1ANT_B_FTP BIT7 -+#define BT_INFO_8723A_1ANT_B_A2DP BIT6 -+#define BT_INFO_8723A_1ANT_B_HID BIT5 -+#define BT_INFO_8723A_1ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8723A_1ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8723A_1ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8723A_1ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8723A_1ANT_B_CONNECTION BIT0 -+ -+typedef enum _BT_STATE_8723A_1ANT{ -+ BT_STATE_8723A_1ANT_DISABLED = 0, -+ BT_STATE_8723A_1ANT_NO_CONNECTION = 1, -+ BT_STATE_8723A_1ANT_CONNECT_IDLE = 2, -+ BT_STATE_8723A_1ANT_INQ_OR_PAG = 3, -+ BT_STATE_8723A_1ANT_ACL_ONLY_BUSY = 4, -+ BT_STATE_8723A_1ANT_SCO_ONLY_BUSY = 5, -+ BT_STATE_8723A_1ANT_ACL_SCO_BUSY = 6, -+ BT_STATE_8723A_1ANT_HID_BUSY = 7, -+ BT_STATE_8723A_1ANT_HID_SCO_BUSY = 8, -+ BT_STATE_8723A_1ANT_MAX -+}BT_STATE_8723A_1ANT, *PBT_STATE_8723A_1ANT; -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8723A_1ANT 2 -+ -+typedef enum _BT_INFO_SRC_8723A_1ANT{ -+ BT_INFO_SRC_8723A_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8723A_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8723A_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8723A_1ANT_MAX -+}BT_INFO_SRC_8723A_1ANT,*PBT_INFO_SRC_8723A_1ANT; -+ -+typedef enum _BT_8723A_1ANT_BT_STATUS{ -+ BT_8723A_1ANT_BT_STATUS_IDLE = 0x0, -+ BT_8723A_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8723A_1ANT_BT_STATUS_NON_IDLE = 0x2, -+ BT_8723A_1ANT_BT_STATUS_MAX -+}BT_8723A_1ANT_BT_STATUS,*PBT_8723A_1ANT_BT_STATUS; -+ -+typedef enum _BT_8723A_1ANT_COEX_ALGO{ -+ BT_8723A_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8723A_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8723A_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8723A_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8723A_1ANT_COEX_ALGO_PANEDR = 0x4, -+ BT_8723A_1ANT_COEX_ALGO_PANHS = 0x5, -+ BT_8723A_1ANT_COEX_ALGO_PANEDR_A2DP = 0x6, -+ BT_8723A_1ANT_COEX_ALGO_PANEDR_HID = 0x7, -+ BT_8723A_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x8, -+ BT_8723A_1ANT_COEX_ALGO_HID_A2DP = 0x9, -+ BT_8723A_1ANT_COEX_ALGO_MAX -+}BT_8723A_1ANT_COEX_ALGO,*PBT_8723A_1ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8723A_1ANT{ -+ // fw mechanism -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ u4Byte psTdmaMonitorCnt; -+ u4Byte psTdmaGlobalCnt; -+ BOOLEAN bResetTdmaAdjust; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+} COEX_DM_8723A_1ANT, *PCOEX_DM_8723A_1ANT; -+ -+typedef struct _COEX_STA_8723A_1ANT{ -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ u1Byte btRssi; -+ u1Byte preBtRssiState; -+ u1Byte preBtRssiState1; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8723A_1ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8723A_1ANT_MAX]; -+ BOOLEAN bC2hBtInquiryPage; -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+ //BOOLEAN bHoldForStackOperation; -+ //u1Byte bHoldPeriodCnt; -+ // this is for c2h hang work-around -+ u4Byte c2hHangDetectCnt; -+}COEX_STA_8723A_1ANT, *PCOEX_STA_8723A_1ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8723a1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8723a1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723a2Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8723a2Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723a2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8723a2Ant.c 2017-06-07 23:07:21.010687485 +0300 -@@ -0,0 +1,3746 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8723A Co-exist mechanism -+// -+// History -+// 2012/08/22 Cosa first check in. -+// 2012/11/14 Cosa Revise for 8723A 2Ant out sourcing. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8723a2Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8723A_2ANT GLCoexDm8723a2Ant; -+static PCOEX_DM_8723A_2ANT pCoexDm=&GLCoexDm8723a2Ant; -+static COEX_STA_8723A_2ANT GLCoexSta8723a2Ant; -+static PCOEX_STA_8723A_2ANT pCoexSta=&GLCoexSta8723a2Ant; -+ -+const char *const GLBtInfoSrc8723a2Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8723a2ant_ -+//============================================================ -+BOOLEAN -+halbtc8723a2ant_IsWifiIdle( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if(bWifiConnected) -+ return FALSE; -+ if(bScan) -+ return FALSE; -+ if(bLink) -+ return FALSE; -+ if(bRoam) -+ return FALSE; -+ -+ return TRUE; -+} -+ -+BOOLEAN -+halbtc8723a2ant_IsWifiConnectedIdle( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bScan=FALSE, bLink=FALSE, bRoam=FALSE, bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if(bScan) -+ return FALSE; -+ if(bLink) -+ return FALSE; -+ if(bRoam) -+ return FALSE; -+ if(bWifiConnected && !bWifiBusy) -+ return TRUE; -+ else -+ return FALSE; -+} -+ -+u1Byte -+halbtc8723a2ant_BtRssiState( -+ u1Byte levelNum, -+ u1Byte rssiThresh, -+ u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte btRssi=0; -+ u1Byte btRssiState=pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh1) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+u1Byte -+halbtc8723a2ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+VOID -+halbtc8723a2ant_IndicateWifiChnlBwInfo( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ -+ // only 2.4G we need to inform bt the chnl mask -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if( (BTC_MEDIA_CONNECT == type) && -+ (wifiCentralChnl <= 14) ) -+ { -+ H2C_Parameter[0] = 0x1; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x19=0x%x\n", -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x19, 3, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a2ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = TRUE; -+ -+ H2C_Parameter[0] |= BIT0; // trigger -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x38=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x38, 1, H2C_Parameter); -+} -+u1Byte -+halbtc8723a2ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ BOOLEAN bBtHsOn=FALSE, bBtBusy=FALSE, bLimitedDig=FALSE; -+ u1Byte algorithm=BT_8723A_2ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ //====================== -+ // here we get BT status first -+ //====================== -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_IDLE; -+ -+ if((pStackInfo->bScoExist) ||(bBtHsOn) ||(pStackInfo->bHidExist)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO or HID or HS exists, set BT non-idle !!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; -+ } -+ else -+ { -+ // A2dp profile -+ if( (pBtCoexist->stackInfo.numOfLink == 1) && -+ (pStackInfo->bA2dpExist) ) -+ { -+ if( (pCoexSta->lowPriorityTx+ pCoexSta->lowPriorityRx) < 100) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP, low priority tx+rx < 100, set BT connected-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP, low priority tx+rx >= 100, set BT non-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; -+ } -+ } -+ // Pan profile -+ if( (pBtCoexist->stackInfo.numOfLink == 1) && -+ (pStackInfo->bPanExist) ) -+ { -+ if((pCoexSta->lowPriorityTx+ pCoexSta->lowPriorityRx) < 600) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN, low priority tx+rx < 600, set BT connected-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ } -+ else -+ { -+ if(pCoexSta->lowPriorityTx) -+ { -+ if((pCoexSta->lowPriorityRx /pCoexSta->lowPriorityTx)>9 ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN, low priority rx/tx > 9, set BT connected-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ } -+ } -+ } -+ if(BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN, set BT non-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; -+ } -+ } -+ // Pan+A2dp profile -+ if( (pBtCoexist->stackInfo.numOfLink == 2) && -+ (pStackInfo->bA2dpExist) && -+ (pStackInfo->bPanExist) ) -+ { -+ if((pCoexSta->lowPriorityTx+ pCoexSta->lowPriorityRx) < 600) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN+A2DP, low priority tx+rx < 600, set BT connected-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ } -+ else -+ { -+ if(pCoexSta->lowPriorityTx) -+ { -+ if((pCoexSta->lowPriorityRx /pCoexSta->lowPriorityTx)>9 ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN+A2DP, low priority rx/tx > 9, set BT connected-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ } -+ } -+ } -+ if(BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN+A2DP, set BT non-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; -+ } -+ } -+ } -+ if(BT_8723A_2ANT_BT_STATUS_IDLE != pCoexDm->btStatus) -+ { -+ bBtBusy = TRUE; -+ bLimitedDig = TRUE; -+ } -+ else -+ { -+ bBtBusy = FALSE; -+ bLimitedDig = FALSE; -+ } -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bLimitedDig); -+ //====================== -+ -+ if(!pStackInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No profile exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pStackInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(numOfDiffProfile == 1) -+ { -+ if(pStackInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO only\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(pStackInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID; -+ } -+ else if(pStackInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_A2DP; -+ } -+ else if(pStackInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(HS) only\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(EDR) only\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 2) -+ { -+ if(pStackInfo->bScoExist) -+ { -+ if(pStackInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID; -+ } -+ else if(pStackInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; -+ } -+ else if(pStackInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(HS)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(EDR)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(HS)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(EDR)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(HS)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(EDR)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 3) -+ { -+ if(pStackInfo->bScoExist) -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP ==> HID\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID; -+ } -+ else if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(HS)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(EDR)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile >= 3) -+ { -+ if(pStackInfo->bScoExist) -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+BOOLEAN -+halbtc8723a2ant_NeedToDecBtPwr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bRet=FALSE; -+ BOOLEAN bBtHsOn=FALSE, bWifiConnected=FALSE; -+ s4Byte btHsRssi=0; -+ u1Byte btRssiState=BTC_RSSI_STATE_HIGH; -+ -+ btRssiState = halbtc8723a2ant_BtRssiState(2, 42, 0); -+ -+ if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn)) -+ return FALSE; -+ if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected)) -+ return FALSE; -+ if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_HS_RSSI, &btHsRssi)) -+ return FALSE; -+ if(BTC_RSSI_LOW(btRssiState)) -+ return FALSE; -+ -+ if(bWifiConnected) -+ { -+ if(bBtHsOn) -+ { -+ if(btHsRssi > 37) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Need to decrease bt power for HS mode!!\n")); -+ bRet = TRUE; -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Need to decrease bt power for Wifi is connected!!\n")); -+ bRet = TRUE; -+ } -+ } -+ -+ return bRet; -+} -+ -+VOID -+halbtc8723a2ant_SetFwDacSwingLevel( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte dacSwingLvl -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ // There are several type of dacswing -+ // 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 -+ H2C_Parameter[0] = dacSwingLvl; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Set Dac Swing Level=0x%x\n", dacSwingLvl)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x29=0x%x\n", H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x29, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a2ant_SetFwDecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bDecBtPwr -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = 0; -+ -+ if(bDecBtPwr) -+ { -+ H2C_Parameter[0] |= BIT1; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], decrease Bt Power : %s, FW write 0x21=0x%x\n", -+ (bDecBtPwr? "Yes!!":"No!!"), H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x21, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a2ant_DecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDecBtPwr -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s Dec BT power = %s\n", -+ (bForceExec? "force to":""), ((bDecBtPwr)? "ON":"OFF"))); -+ pCoexDm->bCurDecBtPwr = bDecBtPwr; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreDecBtPwr == pCoexDm->bCurDecBtPwr) -+ return; -+ } -+ halbtc8723a2ant_SetFwDecBtPwr(pBtCoexist, pCoexDm->bCurDecBtPwr); -+ -+ pCoexDm->bPreDecBtPwr = pCoexDm->bCurDecBtPwr; -+} -+ -+VOID -+halbtc8723a2ant_FwDacSwingLvl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte fwDacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set FW Dac Swing level = %d\n", -+ (bForceExec? "force to":""), fwDacSwingLvl)); -+ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->preFwDacSwingLvl == pCoexDm->curFwDacSwingLvl) -+ return; -+ } -+ -+ halbtc8723a2ant_SetFwDacSwingLevel(pBtCoexist, pCoexDm->curFwDacSwingLvl); -+ -+ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -+} -+ -+VOID -+halbtc8723a2ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xf0ff7); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+VOID -+halbtc8723a2ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8723a2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8723a2ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte tmpU1; -+ -+ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); -+ tmpU1 |= BIT0; -+ if(bLowPenaltyRa) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); -+ tmpU1 &= ~BIT2; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); -+ tmpU1 |= BIT2; -+ } -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -+} -+ -+VOID -+halbtc8723a2ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ return; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8723a2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8723a2ant_SetSwFullTimeDacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSwDacSwingOn, -+ IN u4Byte swDacSwingLvl -+ ) -+{ -+ if(bSwDacSwingOn) -+ { -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, swDacSwingLvl); -+ } -+ else -+ { -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0xc0); -+ } -+} -+ -+ -+VOID -+halbtc8723a2ant_DacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacSwingOn, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", -+ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); -+ pCoexDm->bCurDacSwingOn = bDacSwingOn; -+ pCoexDm->curDacSwingLvl = dacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && -+ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) -+ return; -+ } -+ delay_ms(30); -+ halbtc8723a2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); -+ -+ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; -+ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -+} -+ -+VOID -+halbtc8723a2ant_SetAdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ if(bAdcBackOff) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a07611); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a05611); -+ } -+} -+ -+VOID -+halbtc8723a2ant_AdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", -+ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); -+ pCoexDm->bCurAdcBackOff = bAdcBackOff; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) -+ return; -+ } -+ halbtc8723a2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); -+ -+ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -+} -+ -+VOID -+halbtc8723a2ant_SetAgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ u1Byte rssiAdjustVal=0; -+ -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4e1c0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4d1d0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4c1e0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4b1f0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4a200001); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xdc000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x90000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x51000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x12000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x00355); -+ -+ rssiAdjustVal = 6; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x641c0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x631d0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x621e0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x611f0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x60200001); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x32000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x71000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xb0000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xfc000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x30355); -+ } -+ -+ // set rssiAdjustVal for wifi module. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -+} -+ -+ -+VOID -+halbtc8723a2ant_AgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", -+ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); -+ pCoexDm->bCurAgcTableEn = bAgcTableEn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) -+ return; -+ } -+ halbtc8723a2ant_SetAgcTable(pBtCoexist, bAgcTableEn); -+ -+ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -+} -+ -+VOID -+halbtc8723a2ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8723a2ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8723a2ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8723a2ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(bEnable) -+ { -+ H2C_Parameter[0] |= BIT0; // function enable -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x25=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x25, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a2ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8723a2ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8723a2ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ -+ H2C_Parameter[0] = byte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = byte5; -+ -+ pCoexDm->psTdmaPara[0] = byte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = byte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x3a(5bytes)=0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x3a, 5, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a2ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ u4Byte btTxRxCnt=0; -+ -+ btTxRxCnt = pCoexSta->highPriorityTx+pCoexSta->highPriorityRx+ -+ pCoexSta->lowPriorityTx+pCoexSta->lowPriorityRx; -+ -+ if(btTxRxCnt > 3000) -+ { -+ pCoexDm->bCurPsTdmaOn = TRUE; -+ pCoexDm->curPsTdma = 8; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], turn ON PS TDMA, type=%d for BT tx/rx counters=%d(>3000)\n", -+ pCoexDm->curPsTdma, btTxRxCnt)); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", -+ (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ } -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ if(pCoexDm->bCurPsTdmaOn) -+ { -+ switch(pCoexDm->curPsTdma) -+ { -+ case 1: -+ default: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x98); -+ break; -+ case 2: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x98); -+ break; -+ case 3: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0xe1, 0x98); -+ break; -+ case 4: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x5, 0x5, 0xe1, 0x80); -+ break; -+ case 5: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x98); -+ break; -+ case 6: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x98); -+ break; -+ case 7: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0x60, 0x98); -+ break; -+ case 8: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x5, 0x5, 0x60, 0x80); -+ break; -+ case 9: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x98); -+ break; -+ case 10: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x98); -+ break; -+ case 11: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0xe1, 0x98); -+ break; -+ case 12: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x98); -+ break; -+ case 13: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x98); -+ break; -+ case 14: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x98); -+ break; -+ case 15: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0x60, 0x98); -+ break; -+ case 16: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0x60, 0x98); -+ break; -+ case 17: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x2f, 0x2f, 0x60, 0x80); -+ break; -+ case 18: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x98); -+ break; -+ case 19: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0xe1, 0x98); -+ break; -+ case 20: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0x60, 0x98); -+ break; -+ } -+ } -+ else -+ { -+ // disable PS tdma -+ switch(pCoexDm->curPsTdma) -+ { -+ case 0: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x8, 0x0); -+ break; -+ case 1: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ break; -+ default: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x8, 0x0); -+ break; -+ } -+ } -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+ -+VOID -+halbtc8723a2ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw all off -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ // sw all off -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ // hw all off -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+} -+ -+VOID -+halbtc8723a2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ halbtc8723a2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0x55555555, 0xffff, 0x3); -+ halbtc8723a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, FORCE_EXEC, FALSE); -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, FORCE_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, FORCE_EXEC, FALSE); -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, FORCE_EXEC, FALSE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, FORCE_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, FORCE_EXEC, FALSE, 0xc0); -+} -+ -+VOID -+halbtc8723a2ant_BtInquiryPage( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bLowPwrDisable=TRUE; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+} -+ -+VOID -+halbtc8723a2ant_BtEnableAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE; -+ -+ // Here we need to resend some wifi info to BT -+ // because bt is reset and loss of the info. -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(bWifiConnected) -+ { -+ halbtc8723a2ant_IndicateWifiChnlBwInfo(pBtCoexist, BTC_MEDIA_CONNECT); -+ } -+ else -+ { -+ halbtc8723a2ant_IndicateWifiChnlBwInfo(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+} -+ -+VOID -+halbtc8723a2ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp; -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+} -+ -+VOID -+halbtc8723a2ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ bPreBtDisabled = bBtDisabled; -+ if(!bBtDisabled) -+ { -+ halbtc8723a2ant_BtEnableAction(pBtCoexist); -+ } -+ } -+} -+ -+BOOLEAN -+halbtc8723a2ant_IsCommonAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE; -+ BOOLEAN bLowPwrDisable=FALSE; -+ -+ if(!pStackInfo->bBtLinkExist) -+ { -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ } -+ else -+ { -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ if(halbtc8723a2ant_IsWifiIdle(pBtCoexist) && -+ BT_8723A_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle + Bt idle!!\n")); -+ -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ bCommon = TRUE; -+ } -+ else if(!halbtc8723a2ant_IsWifiIdle(pBtCoexist) && -+ (BT_8723A_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-idle + BT idle!!\n")); -+ -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ bCommon = TRUE; -+ } -+ else if(halbtc8723a2ant_IsWifiIdle(pBtCoexist) && -+ (BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle + Bt connected idle!!\n")); -+ -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ bCommon = TRUE; -+ } -+ else if(!halbtc8723a2ant_IsWifiIdle(pBtCoexist) && -+ (BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-idle + Bt connected idle!!\n")); -+ -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ bCommon = TRUE; -+ } -+ else if(halbtc8723a2ant_IsWifiIdle(pBtCoexist) && -+ (BT_8723A_2ANT_BT_STATUS_NON_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle + BT non-idle!!\n")); -+ -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ bCommon = TRUE; -+ } -+ else if(halbtc8723a2ant_IsWifiConnectedIdle(pBtCoexist) && -+ (BT_8723A_2ANT_BT_STATUS_NON_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected-idle + BT non-idle!!\n")); -+ -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-idle + BT non-idle!!\n")); -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ -+ bCommon = FALSE; -+ } -+ -+ return bCommon; -+} -+VOID -+halbtc8723a2ant_TdmaDurationAdjust( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bScoHid, -+ IN BOOLEAN bTxPause, -+ IN u1Byte maxInterval -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjust()\n")); -+ -+ if(pCoexDm->bResetTdmaAdjust) -+ { -+ pCoexDm->bResetTdmaAdjust = FALSE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ { -+ if(bScoHid) -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ else -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ } -+ } -+ } -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], retryCount = %d\n", retryCount)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], up=%d, dn=%d, m=%d, n=%d, WaitCount=%d\n", -+ up, dn, m, n, WaitCount)); -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], max Interval = %d\n", maxInterval)); -+ if(maxInterval == 1) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 2) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 3) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ } -+ } -+ -+ // if current PsTdma not match with the recorded one (when scan, dhcp...), -+ // then we have to adjust it back to the previous record one. -+ if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) -+ { -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", -+ pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if( !bScan && !bLink && !bRoam) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); -+ } -+ } -+} -+ -+// SCO only or SCO+PAN(HS) -+VOID -+halbtc8723a2ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1; -+ u4Byte wifiBw; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+ -+VOID -+halbtc8723a2ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1; -+ u4Byte wifiBw; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -+VOID -+halbtc8723a2ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); -+ } -+ else -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ } -+ else -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); -+ } -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); -+ } -+ else -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ } -+ else -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+VOID -+halbtc8723a2ant_ActionPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+ -+//PAN(HS) only -+VOID -+halbtc8723a2ant_ActionPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw; -+ -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ else -+ { -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+//PAN(EDR)+A2DP -+VOID -+halbtc8723a2ant_ActionPanEdrA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ } -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+VOID -+halbtc8723a2ant_ActionPanEdrHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1; -+ u4Byte wifiBw; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+// HID+A2DP+PAN(EDR) -+VOID -+halbtc8723a2ant_ActionHidA2dpPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ } -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+VOID -+halbtc8723a2ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 1); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 1); -+ } -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 1); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 1); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+VOID -+halbtc8723a2ant_RunCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ u1Byte btInfoOriginal=0, btRetryCnt=0; -+ u1Byte algorithm=0; -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Manual control!!!\n")); -+ return; -+ } -+ -+ if(pStackInfo->bProfileNotified) -+ { -+ if(pCoexSta->bHoldForStackOperation) -+ { -+ // if bt inquiry/page/pair, do not execute. -+ return; -+ } -+ -+ algorithm = halbtc8723a2ant_ActionAlgorithm(pBtCoexist); -+ if(pCoexSta->bHoldPeriodCnt && (BT_8723A_2ANT_COEX_ALGO_PANHS!=algorithm)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex],Hold BT inquiry/page scan setting (cnt = %d)!!\n", -+ pCoexSta->bHoldPeriodCnt)); -+ if(pCoexSta->bHoldPeriodCnt >= 6) -+ { -+ pCoexSta->bHoldPeriodCnt = 0; -+ // next time the coexist parameters should be reset again. -+ } -+ else -+ pCoexSta->bHoldPeriodCnt++; -+ return; -+ } -+ -+ pCoexDm->curAlgorithm = algorithm; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Algorithm = %d \n", pCoexDm->curAlgorithm)); -+ if(halbtc8723a2ant_IsCommonAction(pBtCoexist)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant common.\n")); -+ pCoexDm->bResetTdmaAdjust = TRUE; -+ } -+ else -+ { -+ if(pCoexDm->curAlgorithm != pCoexDm->preAlgorithm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], preAlgorithm=%d, curAlgorithm=%d\n", -+ pCoexDm->preAlgorithm, pCoexDm->curAlgorithm)); -+ pCoexDm->bResetTdmaAdjust = TRUE; -+ } -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8723A_2ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO.\n")); -+ halbtc8723a2ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID.\n")); -+ halbtc8723a2ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP.\n")); -+ halbtc8723a2ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n")); -+ halbtc8723a2ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HS mode.\n")); -+ halbtc8723a2ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_PANEDR_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n")); -+ halbtc8723a2ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_PANEDR_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n")); -+ halbtc8723a2ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n")); -+ halbtc8723a2ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n")); -+ halbtc8723a2ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n")); -+ halbtc8723a2ant_CoexAllOff(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+ } -+} -+ -+//============================================================ -+// work around function start with wa_halbtc8723a2ant_ -+//============================================================ -+VOID -+wa_halbtc8723a2ant_MonitorC2h( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte tmp1b=0x0; -+ u4Byte curC2hTotalCnt=0x0; -+ static u4Byte preC2hTotalCnt=0x0, sameCntPollingTime=0x0; -+ -+ curC2hTotalCnt+=pCoexSta->btInfoC2hCnt[BT_INFO_SRC_8723A_2ANT_BT_RSP]; -+ -+ if(curC2hTotalCnt == preC2hTotalCnt) -+ { -+ sameCntPollingTime++; -+ } -+ else -+ { -+ preC2hTotalCnt = curC2hTotalCnt; -+ sameCntPollingTime = 0; -+ } -+ -+ if(sameCntPollingTime >= 2) -+ { -+ tmp1b = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x1af); -+ if(tmp1b != 0x0) -+ { -+ pCoexSta->c2hHangDetectCnt++; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x1af, 0x0); -+ } -+ } -+} -+ -+//============================================================ -+// extern function start with EXhalbtc8723a2ant_ -+//============================================================ -+VOID -+EXhalbtc8723a2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8723a2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ u4Byte u4Tmp=0; -+ u1Byte u1Tmp=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); -+ -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ // Enable counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x3); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x20); -+} -+ -+VOID -+EXhalbtc8723a2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8723a2ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8723a2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ -+ ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8723A_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus)? "idle":( (BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy"))), -+ pCoexSta->btRssi, pCoexSta->btRetryCnt); -+ CL_PRINTF(cliBuf); -+ -+ if(pStackInfo->bProfileNotified) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723a2Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "write 0x1af=0x0 num", \ -+ pCoexSta->c2hHangDetectCnt); -+ CL_PRINTF(cliBuf); -+ -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "SM1[ShRf/ LpRA/ LimDig]", \ -+ pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ -+ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(!pBtCoexist->bManualControl) -+ { -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "DecBtPwr/ IgnWlanAct", \ -+ pCoexDm->bCurDecBtPwr, pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ } -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x783); -+ u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x796); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/ 0x783/ 0x796", \ -+ u1Tmp[0], u1Tmp[1], u1Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x880", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ -+ u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x484); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x484(rate adaptive)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); -+ u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xdac); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0xda0/0xda4/0xda8/0xdac(FA cnt)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u4Tmp[3]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770 (hp rx[31:16]/tx[15:0])", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(lp rx[31:16]/tx[15:0])", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8723a2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ halbtc8723a2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ //halbtc8723a2ant_InitCoexDm(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+ -+ halbtc8723a2ant_IndicateWifiChnlBwInfo(pBtCoexist, type); -+} -+ -+VOID -+EXhalbtc8723a2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bBtBusy=FALSE, bLimitedDig=FALSE; -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ -+ rspSource = BT_INFO_SRC_8723A_2ANT_BT_RSP; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 0) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ if(BT_INFO_SRC_8723A_2ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = -+ pCoexSta->btInfoC2h[rspSource][1]; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][2]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][3]; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8723A_2ANT_B_INQ_PAGE) -+ { -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ } -+ else -+ { -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_StackOperationNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_STACK_OP_INQ_PAGE_PAIR_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], StackOP Inquiry/page/pair start notify\n")); -+ pCoexSta->bHoldForStackOperation = TRUE; -+ pCoexSta->bHoldPeriodCnt = 1; -+ halbtc8723a2ant_BtInquiryPage(pBtCoexist); -+ } -+ else if(BTC_STACK_OP_INQ_PAGE_PAIR_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], StackOP Inquiry/page/pair finish notify\n")); -+ pCoexSta->bHoldForStackOperation = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ EXhalbtc8723a2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+VOID -+EXhalbtc8723a2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Periodical!!\n")); -+ -+ // work around for c2h hang -+ wa_halbtc8723a2ant_MonitorC2h(pBtCoexist); -+ -+ halbtc8723a2ant_QueryBtInfo(pBtCoexist); -+ halbtc8723a2ant_MonitorBtCtr(pBtCoexist); -+ halbtc8723a2ant_MonitorBtEnableDisable(pBtCoexist); -+ -+ halbtc8723a2ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723a2Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8723a2Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723a2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8723a2Ant.h 2017-06-07 23:07:21.010687485 +0300 -@@ -0,0 +1,184 @@ -+//=========================================== -+// The following is for 8723A 2Ant BT Co-exist definition -+//=========================================== -+#define BT_INFO_8723A_2ANT_B_FTP BIT7 -+#define BT_INFO_8723A_2ANT_B_A2DP BIT6 -+#define BT_INFO_8723A_2ANT_B_HID BIT5 -+#define BT_INFO_8723A_2ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8723A_2ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8723A_2ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8723A_2ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8723A_2ANT_B_CONNECTION BIT0 -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT 2 -+ -+typedef enum _BT_INFO_SRC_8723A_2ANT{ -+ BT_INFO_SRC_8723A_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8723A_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8723A_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8723A_2ANT_MAX -+}BT_INFO_SRC_8723A_2ANT,*PBT_INFO_SRC_8723A_2ANT; -+ -+typedef enum _BT_8723A_2ANT_BT_STATUS{ -+ BT_8723A_2ANT_BT_STATUS_IDLE = 0x0, -+ BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8723A_2ANT_BT_STATUS_NON_IDLE = 0x2, -+ BT_8723A_2ANT_BT_STATUS_MAX -+}BT_8723A_2ANT_BT_STATUS,*PBT_8723A_2ANT_BT_STATUS; -+ -+typedef enum _BT_8723A_2ANT_COEX_ALGO{ -+ BT_8723A_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8723A_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8723A_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8723A_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8723A_2ANT_COEX_ALGO_PANEDR = 0x4, -+ BT_8723A_2ANT_COEX_ALGO_PANHS = 0x5, -+ BT_8723A_2ANT_COEX_ALGO_PANEDR_A2DP = 0x6, -+ BT_8723A_2ANT_COEX_ALGO_PANEDR_HID = 0x7, -+ BT_8723A_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x8, -+ BT_8723A_2ANT_COEX_ALGO_HID_A2DP = 0x9, -+ BT_8723A_2ANT_COEX_ALGO_MAX -+}BT_8723A_2ANT_COEX_ALGO,*PBT_8723A_2ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8723A_2ANT{ -+ // fw mechanism -+ BOOLEAN bPreDecBtPwr; -+ BOOLEAN bCurDecBtPwr; -+ //BOOLEAN bPreBtLnaConstrain; -+ //BOOLEAN bCurBtLnaConstrain; -+ //u1Byte bPreBtPsdMode; -+ //u1Byte bCurBtPsdMode; -+ u1Byte preFwDacSwingLvl; -+ u1Byte curFwDacSwingLvl; -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ BOOLEAN bResetTdmaAdjust; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ //BOOLEAN bPreBtAutoReport; -+ //BOOLEAN bCurBtAutoReport; -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ BOOLEAN bPreDacSwingOn; -+ u4Byte preDacSwingLvl; -+ BOOLEAN bCurDacSwingOn; -+ u4Byte curDacSwingLvl; -+ BOOLEAN bPreAdcBackOff; -+ BOOLEAN bCurAdcBackOff; -+ BOOLEAN bPreAgcTableEn; -+ BOOLEAN bCurAgcTableEn; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+} COEX_DM_8723A_2ANT, *PCOEX_DM_8723A_2ANT; -+ -+typedef struct _COEX_STA_8723A_2ANT{ -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ u1Byte btRssi; -+ u1Byte preBtRssiState; -+ u1Byte preBtRssiState1; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8723A_2ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8723A_2ANT_MAX]; -+ BOOLEAN bC2hBtInquiryPage; -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+ BOOLEAN bHoldForStackOperation; -+ u1Byte bHoldPeriodCnt; -+ // this is for c2h hang work-around -+ u4Byte c2hHangDetectCnt; -+}COEX_STA_8723A_2ANT, *PCOEX_STA_8723A_2ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8723a2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8723a2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8723a2ant_StackOperationNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723b1Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8723b1Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723b1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8723b1Ant.c 2017-06-07 23:07:21.010687485 +0300 -@@ -0,0 +1,5638 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8723B Co-exist mechanism -+// -+// History -+// 2012/11/15 Cosa first check in. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8723b1Ant.tmh" -+#endif -+ -+//#include -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8723B_1ANT GLCoexDm8723b1Ant; -+static PCOEX_DM_8723B_1ANT pCoexDm=&GLCoexDm8723b1Ant; -+static COEX_STA_8723B_1ANT GLCoexSta8723b1Ant; -+static PCOEX_STA_8723B_1ANT pCoexSta=&GLCoexSta8723b1Ant; -+static PSDSCAN_STA_8723B_1ANT GLPsdScan8723b1Ant; -+static PPSDSCAN_STA_8723B_1ANT pPsdScan = &GLPsdScan8723b1Ant; -+ -+ -+const char *const GLBtInfoSrc8723b1Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u4Byte GLCoexVerDate8723b1Ant=20150119; -+u4Byte GLCoexVer8723b1Ant=0x58; -+ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8723b1ant_ -+//============================================================ -+u1Byte -+halbtc8723b1ant_BtRssiState( -+ u1Byte levelNum, -+ u1Byte rssiThresh, -+ u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte btRssi=0; -+ u1Byte btRssiState=pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh1) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+u1Byte -+halbtc8723b1ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+VOID -+halbtc8723b1ant_UpdateRaMask( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte disRateMask -+ ) -+{ -+ pCoexDm->curRaMask = disRateMask; -+ -+ if( bForceExec || (pCoexDm->preRaMask != pCoexDm->curRaMask)) -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_UPDATE_RAMASK, &pCoexDm->curRaMask); -+ } -+ pCoexDm->preRaMask = pCoexDm->curRaMask; -+} -+ -+VOID -+halbtc8723b1ant_AutoRateFallbackRetry( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiUnderBMode=FALSE; -+ -+ pCoexDm->curArfrType = type; -+ -+ if( bForceExec || (pCoexDm->preArfrType != pCoexDm->curArfrType)) -+ { -+ switch(pCoexDm->curArfrType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, pCoexDm->backupArfrCnt1); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, pCoexDm->backupArfrCnt2); -+ break; -+ case 1: -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ if(bWifiUnderBMode) -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x01010101); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preArfrType = pCoexDm->curArfrType; -+} -+ -+VOID -+halbtc8723b1ant_RetryLimit( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curRetryLimitType = type; -+ -+ if( bForceExec || (pCoexDm->preRetryLimitType != pCoexDm->curRetryLimitType)) -+ { -+ switch(pCoexDm->curRetryLimitType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, pCoexDm->backupRetryLimit); -+ break; -+ case 1: // retry limit=8 -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preRetryLimitType = pCoexDm->curRetryLimitType; -+} -+ -+VOID -+halbtc8723b1ant_AmpduMaxTime( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curAmpduTimeType = type; -+ -+ if( bForceExec || (pCoexDm->preAmpduTimeType != pCoexDm->curAmpduTimeType)) -+ { -+ switch(pCoexDm->curAmpduTimeType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, pCoexDm->backupAmpduMaxTime); -+ break; -+ case 1: // AMPDU timw = 0x38 * 32us -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preAmpduTimeType = pCoexDm->curAmpduTimeType; -+} -+ -+VOID -+halbtc8723b1ant_LimitedTx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte raMaskType, -+ IN u1Byte arfrType, -+ IN u1Byte retryLimitType, -+ IN u1Byte ampduTimeType -+ ) -+{ -+ switch(raMaskType) -+ { -+ case 0: // normal mode -+ halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0); -+ break; -+ case 1: // disable cck 1/2 -+ halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x00000003); -+ break; -+ case 2: // disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 -+ halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8723b1ant_AutoRateFallbackRetry(pBtCoexist, bForceExec, arfrType); -+ halbtc8723b1ant_RetryLimit(pBtCoexist, bForceExec, retryLimitType); -+ halbtc8723b1ant_AmpduMaxTime(pBtCoexist, bForceExec, ampduTimeType); -+} -+ -+VOID -+halbtc8723b1ant_LimitedRx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRejApAggPkt, -+ IN BOOLEAN bBtCtrlAggBufSize, -+ IN u1Byte aggBufSize -+ ) -+{ -+ BOOLEAN bRejectRxAgg=bRejApAggPkt; -+ BOOLEAN bBtCtrlRxAggSize=bBtCtrlAggBufSize; -+ u1Byte rxAggSize=aggBufSize; -+ -+ //============================================ -+ // Rx Aggregation related setting -+ //============================================ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg); -+ // decide BT control aggregation buf size or not -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize); -+ // aggregation buf size, only work when BT control Rx aggregation size. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize); -+ // real update aggregation setting -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+VOID -+halbtc8723b1ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = TRUE; -+ -+ H2C_Parameter[0] |= BIT0; // trigger -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x61=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723b1ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp, u4Tmp1; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp, u1Tmp1; -+ s4Byte wifiRssi; -+ static u4Byte NumOfBtCounterChk = 0; -+ -+ //to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS -+ //if (! (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e) & 0x8) ) -+ -+ if (pCoexSta->bUnderIps) -+ { -+ //pCoexSta->highPriorityTx = 65535; -+ //pCoexSta->highPriorityRx = 65535; -+ //pCoexSta->lowPriorityTx = 65535; -+ //pCoexSta->lowPriorityRx = 65535; -+ //return; -+ } -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ if( (pCoexSta->lowPriorityTx > 1050) && (!pCoexSta->bC2hBtInquiryPage)) -+ pCoexSta->popEventCnt++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", -+ regHPRx, regHPTx, regLPRx, regLPTx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+ -+ // This part is for wifi FW and driver to update BT's status as disabled. -+ // The flow is as the following -+ // 1. disable BT -+ // 2. if all BT Tx/Rx counter=0, after 6 sec we query bt info -+ // 3. Because BT will not rsp from mailbox, so wifi fw will know BT is disabled -+ // 4. FW will rsp c2h for BT that driver will know BT is disabled. -+ if ((regHPTx == 0) && (regHPRx ==0) && (regLPTx == 0) && (regLPRx == 0)) -+ { -+ NumOfBtCounterChk++; -+ if (NumOfBtCounterChk == 3) -+{ -+ halbtc8723b1ant_QueryBtInfo(pBtCoexist); -+ } -+ } -+ else -+ { -+ NumOfBtCounterChk = 0; -+ } -+ } -+ -+ -+VOID -+halbtc8723b1ant_MonitorWiFiCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ u2Byte u2Tmp[3]; -+ s4Byte wifiRssi=0; -+ BOOLEAN bWifiBusy = FALSE, bWifiUnderBMode = FALSE; -+ static u1Byte nCCKLockCounter = 0; -+ u4Byte TotalCnt; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ -+ if (pCoexSta->bUnderIps) -+ { -+ pCoexSta->nCRCOK_CCK = 0; -+ pCoexSta->nCRCOK_11g = 0; -+ pCoexSta->nCRCOK_11n = 0; -+ pCoexSta->nCRCOK_11nAgg = 0; -+ -+ pCoexSta->nCRCErr_CCK = 0; -+ pCoexSta->nCRCErr_11g = 0; -+ pCoexSta->nCRCErr_11n = 0; -+ pCoexSta->nCRCErr_11nAgg = 0; -+ } -+ else -+ { -+ pCoexSta->nCRCOK_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf88); -+ pCoexSta->nCRCOK_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf94); -+ pCoexSta->nCRCOK_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf90); -+ pCoexSta->nCRCOK_11nAgg= pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfb8); -+ -+ pCoexSta->nCRCErr_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf84); -+ pCoexSta->nCRCErr_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf96); -+ pCoexSta->nCRCErr_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf92); -+ pCoexSta->nCRCErr_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfba); -+ } -+ -+ -+ //reset counter -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x1); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x0); -+ -+ if ( (bWifiBusy) && (wifiRssi >= 30) && (!bWifiUnderBMode)) -+ { -+ TotalCnt = pCoexSta->nCRCOK_CCK + pCoexSta->nCRCOK_11g + pCoexSta->nCRCOK_11n + -+ pCoexSta->nCRCOK_11nAgg; -+ -+ if ( (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_ACL_BUSY) || -+ (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY) || -+ (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_SCO_BUSY) ) -+ { -+ if (pCoexSta->nCRCOK_CCK >(TotalCnt -pCoexSta->nCRCOK_CCK)) -+ { -+ if (nCCKLockCounter < 3) -+ nCCKLockCounter++; -+ } -+ else -+ { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ -+ } -+ else -+ { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ } -+ else -+ { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ -+ if (!pCoexSta->bPreCCKLock) -+ { -+ -+ if (nCCKLockCounter >= 3) -+ pCoexSta->bCCKLock = TRUE; -+ else -+ pCoexSta->bCCKLock = FALSE; -+ } -+ else -+ { -+ if (nCCKLockCounter == 0) -+ pCoexSta->bCCKLock = FALSE; -+ else -+ pCoexSta->bCCKLock = TRUE; -+ } -+ -+ if (pCoexSta->bCCKLock) -+ pCoexSta->bCCKEverLock = TRUE; -+ -+ pCoexSta->bPreCCKLock = pCoexSta->bCCKLock; -+ -+ -+} -+ -+BOOLEAN -+halbtc8723b1ant_IsWifiStatusChanged( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreWifiBusy=FALSE, bPreUnder4way=FALSE, bPreBtHsOn=FALSE; -+ BOOLEAN bWifiBusy=FALSE, bUnder4way=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bWifiConnected=FALSE; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ -+ if(bWifiConnected) -+ { -+ if(bWifiBusy != bPreWifiBusy) -+ { -+ bPreWifiBusy = bWifiBusy; -+ return TRUE; -+ } -+ if(bUnder4way != bPreUnder4way) -+ { -+ bPreUnder4way = bUnder4way; -+ return TRUE; -+ } -+ if(bBtHsOn != bPreBtHsOn) -+ { -+ bPreBtHsOn = bBtHsOn; -+ return TRUE; -+ } -+ -+ -+ } -+ -+ return FALSE; -+} -+ -+VOID -+halbtc8723b1ant_UpdateBtLinkInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pCoexSta->bScoExist; -+ pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist; -+ pBtLinkInfo->bPanExist = pCoexSta->bPanExist; -+ pBtLinkInfo->bHidExist = pCoexSta->bHidExist; -+ pBtLinkInfo->bBtHiPriLinkExist = pCoexSta->bBtHiPriLinkExist; -+ -+ // work around for HS mode. -+ if(bBtHsOn) -+ { -+ pBtLinkInfo->bPanExist = TRUE; -+ pBtLinkInfo->bBtLinkExist = TRUE; -+ } -+ -+ // check if Sco only -+ if( pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bScoOnly = TRUE; -+ else -+ pBtLinkInfo->bScoOnly = FALSE; -+ -+ // check if A2dp only -+ if( !pBtLinkInfo->bScoExist && -+ pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bA2dpOnly = TRUE; -+ else -+ pBtLinkInfo->bA2dpOnly = FALSE; -+ -+ // check if Pan only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bPanOnly = TRUE; -+ else -+ pBtLinkInfo->bPanOnly = FALSE; -+ -+ // check if Hid only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bHidOnly = TRUE; -+ else -+ pBtLinkInfo->bHidOnly = FALSE; -+} -+ -+u1Byte -+halbtc8723b1ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ u1Byte algorithm=BT_8723B_1ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!pBtLinkInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No BT link exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pBtLinkInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(numOfDiffProfile == 1) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO only\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID only\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP only\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_A2DP; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = PAN(HS) only\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = PAN(EDR) only\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 2) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_SCO; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + PAN(HS)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + PAN(EDR)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + PAN(HS)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + PAN(EDR)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP + PAN(HS)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP + PAN(EDR)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + PAN(HS)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile >= 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); -+ algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+VOID -+halbtc8723b1ant_SetBtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = 0; -+ -+ if(bEnableAutoReport) -+ { -+ H2C_Parameter[0] |= BIT0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], BT FW auto report : %s, FW write 0x68=0x%x\n", -+ (bEnableAutoReport? "Enabled!!":"Disabled!!"), H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x68, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723b1ant_BtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s BT Auto report = %s\n", -+ (bForceExec? "force to":""), ((bEnableAutoReport)? "Enabled":"Disabled"))); -+ pCoexDm->bCurBtAutoReport = bEnableAutoReport; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreBtAutoReport == pCoexDm->bCurBtAutoReport) -+ return; -+ } -+ halbtc8723b1ant_SetBtAutoReport(pBtCoexist, pCoexDm->bCurBtAutoReport); -+ -+ pCoexDm->bPreBtAutoReport = pCoexDm->bCurBtAutoReport; -+} -+ -+VOID -+halbtc8723b1ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte H2C_Parameter[6] ={0}; -+ -+ H2C_Parameter[0] = 0x6; // opCode, 0x6= Retry_Penalty -+ -+ if(bLowPenaltyRa) -+ { -+ H2C_Parameter[1] |= BIT0; -+ H2C_Parameter[2] = 0x00; //normal rate except MCS7/6/5, OFDM54/48/36 -+ H2C_Parameter[3] = 0xf7; //MCS7 or OFDM54 -+ H2C_Parameter[4] = 0xf8; //MCS6 or OFDM48 -+ H2C_Parameter[5] = 0xf9; //MCS5 or OFDM36 -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set WiFi Low-Penalty Retry: %s", -+ (bLowPenaltyRa? "ON!!":"OFF!!") )); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter); -+} -+ -+VOID -+halbtc8723b1ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8723b1ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8723b1ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8723b1ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c4=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c4, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8723b1ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8723b1ant_CoexTableWithType( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ -+#if BT_8723B_1ANT_ANTDET_ENABLE -+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE -+ if (pBoardInfo->btdmAntNumByAntDet == 2) -+ { -+ if (type == 3) -+ type = 14; -+ else if (type == 4) -+ type = 13; -+ else if (type == 5) -+ type = 8; -+ } -+#endif -+#endif -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], ********** CoexTable(%d) **********\n", type)); -+ -+ pCoexSta->nCoexTableType = type; -+ -+ switch(type) -+ { -+ case 0: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x55555555, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 4: -+ if ( pCoexSta->bCCKEverLock) -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); -+ else -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3); -+ break; -+ case 5: -+ if ( pCoexSta->bCCKEverLock) -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0xaaaa5a5a, 0xaaaa5a5a, 0xffffff, 0x3); -+ else -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 7: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 8: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 9: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 10: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 11: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 12: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 13: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 14: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 15: -+ halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8723b1ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(bEnable) -+ { -+ H2C_Parameter[0] |= BIT0; // function enable -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723b1ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8723b1ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8723b1ant_SetLpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ u1Byte lps=lpsVal; -+ u1Byte rpwm=rpwmVal; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+VOID -+halbtc8723b1ant_LpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bForceExecPwrCmd=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set lps/rpwm=0x%x/0x%x \n", -+ (bForceExec? "force to":""), lpsVal, rpwmVal)); -+ pCoexDm->curLps = lpsVal; -+ pCoexDm->curRpwm = rpwmVal; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preLps == pCoexDm->curLps) && -+ (pCoexDm->preRpwm == pCoexDm->curRpwm) ) -+ { -+ return; -+ } -+ } -+ halbtc8723b1ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal); -+ -+ pCoexDm->preLps = pCoexDm->curLps; -+ pCoexDm->preRpwm = pCoexDm->curRpwm; -+} -+ -+VOID -+halbtc8723b1ant_SwMechanism( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRA -+ ) -+{ -+ halbtc8723b1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA); -+} -+ -+VOID -+halbtc8723b1ant_SetAntPath( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte antPosType, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bInitHwCfg, -+ IN BOOLEAN bWifiOff -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte fwVer=0, u4Tmp=0, cntBtCalChk=0; -+ BOOLEAN bPgExtSwitch=FALSE; -+ BOOLEAN bUseExtSwitch=FALSE; -+ BOOLEAN bIsInMpMode = FALSE; -+ u1Byte H2C_Parameter[2] ={0}, u1Tmp = 0; -+ -+ pCoexDm->curAntPosType = antPosType; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_EXT_SWITCH, &bPgExtSwitch); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); // [31:16]=fw ver, [15:0]=fw sub ver -+ -+ if((fwVer>0 && fwVer<0xc0000) || bPgExtSwitch) -+ bUseExtSwitch = TRUE; -+ -+#if BT_8723B_1ANT_ANTDET_ENABLE -+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE -+ if (antPosType == BTC_ANT_PATH_PTA) -+ { -+ if ((pBoardInfo->btdmAntDetFinish) && (pBoardInfo->btdmAntNumByAntDet == 2)) -+ { -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ antPosType = BTC_ANT_PATH_WIFI; -+ else -+ antPosType = BTC_ANT_PATH_BT; -+ } -+ } -+#endif -+#endif -+ -+ if(bInitHwCfg) -+ { -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); //WiFi TRx Mask on -+ //remove due to interrupt is disabled that polling c2h will fail and delay 100ms. -+ //pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT TRx Mask on -+ -+ if(fwVer >= 0x180000) -+ { -+ /* Use H2C to set GNT_BT to HIGH */ -+ H2C_Parameter[0] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } -+ else -+ { -+ // set grant_bt to high -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ } -+ //set wlan_act control by PTA -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x0); //BT select s0/s1 is controlled by BT -+ -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x39, 0x8, 0x1); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x974, 0xff); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x944, 0x3, 0x3); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x930, 0x77); -+ } -+ else if(bWifiOff) -+ { -+ if(fwVer >= 0x180000) -+ { -+ /* Use H2C to set GNT_BT to HIGH */ -+ H2C_Parameter[0] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } -+ else -+ { -+ // set grant_bt to high -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ } -+ //set wlan_act to always low -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, &bIsInMpMode); -+ if(!bIsInMpMode) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x0); //BT select s0/s1 is controlled by BT -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); //BT select s0/s1 is controlled by WiFi -+ -+ // 0x4c[24:23]=00, Set Antenna control by BT_RFE_CTRL BT Vendor 0xac=0xf002 -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp &= ~BIT23; -+ u4Tmp &= ~BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ } -+ else -+ { -+ /* Use H2C to set GNT_BT to LOW */ -+ if(fwVer >= 0x180000) -+ { -+ if (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765) != 0) -+ { -+ H2C_Parameter[0] = 0; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } -+ } -+ else -+ { -+ // BT calibration check -+ while(cntBtCalChk <= 20) -+ { -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49d); -+ cntBtCalChk++; -+ if(u1Tmp & BIT0) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", cntBtCalChk)); -+ delay_ms(50); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", cntBtCalChk)); -+ break; -+ } -+ } -+ -+ // set grant_bt to PTA -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x0); -+ } -+ -+ if (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e) != 0xc) -+ { -+ //set wlan_act control by PTA -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+ } -+ -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); //BT select s0/s1 is controlled by WiFi -+ } -+ -+ if(bUseExtSwitch) -+ { -+ if(bInitHwCfg) -+ { -+ // 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp &=~BIT23; -+ u4Tmp |= BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); // fixed internal switch S1->WiFi, S0->BT -+ -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ { -+ //tell firmware "no antenna inverse" -+ H2C_Parameter[0] = 0; -+ H2C_Parameter[1] = 1; //ext switch type -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } -+ else -+ { -+ //tell firmware "antenna inverse" -+ H2C_Parameter[0] = 1; -+ H2C_Parameter[1] = 1; //ext switch type -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } -+ } -+ -+ if(bForceExec || (pCoexDm->curAntPosType != pCoexDm->preAntPosType)) -+ { -+ // ext switch setting -+ switch(antPosType) -+ { -+ case BTC_ANT_PATH_WIFI: -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1); -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2); -+ break; -+ case BTC_ANT_PATH_BT: -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2); -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1); -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2); -+ break; -+ } -+ } -+ } -+ else -+ { -+ if(bInitHwCfg) -+ { -+ // 0x4c[23]=1, 0x4c[24]=0 Antenna control by 0x64 -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp |= BIT23; -+ u4Tmp &=~BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ -+ //Fix Ext switch Main->S1, Aux->S0 -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x64, 0x1, 0x0); -+ -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ { -+ -+ //tell firmware "no antenna inverse" -+ H2C_Parameter[0] = 0; -+ H2C_Parameter[1] = 0; //internal switch type -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } -+ else -+ { -+ -+ //tell firmware "antenna inverse" -+ H2C_Parameter[0] = 1; -+ H2C_Parameter[1] = 0; //internal switch type -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } -+ } -+ -+ if(bForceExec || (pCoexDm->curAntPosType != pCoexDm->preAntPosType)) -+ { -+ // internal switch setting -+ switch(antPosType) -+ { -+ case BTC_ANT_PATH_WIFI: -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ else -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280); -+ break; -+ case BTC_ANT_PATH_BT: -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280); -+ else -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x200); -+ else -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x80); -+ break; -+ } -+ } -+ } -+ -+ pCoexDm->preAntPosType = pCoexDm->curAntPosType; -+} -+ -+VOID -+halbtc8723b1ant_SetAntPathDCut( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAntennaAux, //For 1-Ant--> 1: Antenna at S0, 0: Antenna at S1. Set 0 for 2-Ant -+ IN BOOLEAN bExtSwitch, // 1: Ext Switch (SPDT) exist on module, 0: no Ext Switch (SPDT) exist on module -+ IN BOOLEAN bTwoAntenna, // 1: 2-Antenna, 0:1-Antenna -+ IN u1Byte antennaPos, //Set Antenna Pos, For 1-Ant: BTC_ANT_PATH_WIFI, BTC_ANT_PATH_BT, BTC_ANT_PATH_PTA, For 2-Ant:BTC_ANT_WIFI_AT_MAIN, BTC_ANT_WIFI_AT_Aux -+ IN u1Byte wifiState //BTC_WIFI_STAT_INIT, BTC_WIFI_STAT_IQK, BTC_WIFI_STAT_NORMAL_OFF, BTC_WIFI_STAT_MP_OFF, BTC_WIFI_STAT_NORMAL, BTC_WIFI_STAT_ANT_DIV -+ ) -+{ -+ u1Byte dataLen=5; -+ u1Byte buf[6] = {0}; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set BT Ant, bAntennaAux/bExtSwitch/bTwoAntenna/antennaPos/wifiState=%d/%d/%d/%d/%d\n", -+ bAntennaAux, bExtSwitch, bTwoAntenna, antennaPos, wifiState)); -+ -+ buf[0] = dataLen; -+ -+ if(bAntennaAux) -+ buf[1] = 0x1; -+ -+ if(bExtSwitch) -+ buf[2] = 0x1; -+ -+ if(bTwoAntenna) -+ buf[3] = 0x1; -+ -+ buf[4] = antennaPos; -+ -+ buf[5] = wifiState; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_8723B_ANT, (PVOID)&buf[0]); -+} -+ -+VOID -+halbtc8723b1ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ u1Byte realByte1=byte1, realByte5=byte5; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ if(bApEnable) -+ { -+ if(byte1&BIT4 && !(byte1&BIT5)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FW for 1Ant AP mode\n")); -+ realByte1 &= ~BIT4; -+ realByte1 |= BIT5; -+ -+ realByte5 |= BIT5; -+ realByte5 &= ~BIT6; -+ } -+ } -+ -+ H2C_Parameter[0] = realByte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = realByte5; -+ -+ pCoexDm->psTdmaPara[0] = realByte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = realByte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], PS-TDMA H2C cmd =0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter); -+} -+ -+ -+VOID -+halbtc8723b1ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bTurnOnByCnt=FALSE, bWifiBusy=FALSE, bWiFiNoisy=FALSE; -+ u1Byte psTdmaTypeByCnt=0, rssiAdjustVal=0; -+ u1Byte psTdmaByte4Val = 0x50, psTdmaByte0Val = 0x51, psTdmaByte3Val = 0x10; -+ s1Byte nWiFiDurationAdjust = 0x0; -+ static BOOLEAN bPreWifiBusy=FALSE; -+ -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+#if BT_8723B_1ANT_ANTDET_ENABLE -+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE -+ if (pBoardInfo->btdmAntNumByAntDet == 2) -+ { -+ if (bTurnOn) -+ type = type +100; //for WiFi RSSI low or BT RSSI low -+ else -+ type = 1; //always translate to TDMA(off,1) for TDMA-off case -+ } -+ -+#endif -+#endif -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if (bWifiBusy != bPreWifiBusy) -+ { -+ bForceExec = TRUE; -+ bPreWifiBusy = bWifiBusy; -+ } -+ -+ if (pCoexDm->bCurPsTdmaOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(on, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(off, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ -+ if (pCoexSta->nScanAPNum <= 5) -+ { -+ nWiFiDurationAdjust = 5; -+ -+ if (pCoexSta->nA2DPBitPool >= 35) -+ nWiFiDurationAdjust = -10; -+ else if (pCoexSta->nA2DPBitPool >= 45) -+ nWiFiDurationAdjust = -15; -+ } -+ else if (pCoexSta->nScanAPNum >= 40) -+ { -+ nWiFiDurationAdjust = -15; -+ -+ if (pCoexSta->nA2DPBitPool < 35) -+ nWiFiDurationAdjust = -5; -+ else if (pCoexSta->nA2DPBitPool < 45) -+ nWiFiDurationAdjust = -10; -+ } -+ else if (pCoexSta->nScanAPNum >= 20) -+ { -+ nWiFiDurationAdjust = -10; -+ -+ if (pCoexSta->nA2DPBitPool >= 45) -+ nWiFiDurationAdjust = -15; -+ } -+ else -+ { -+ nWiFiDurationAdjust = 0; -+ -+ if (pCoexSta->nA2DPBitPool >= 35) -+ nWiFiDurationAdjust = -10; -+ else if (pCoexSta->nA2DPBitPool >= 45) -+ nWiFiDurationAdjust = -15; -+ } -+ -+ if ((type == 1) || (type == 2) || (type == 9) || (type == 11) || (type == 101) -+ || (type == 102) || (type == 109) || (type == 101)) -+ { -+ if (!pCoexSta->bForceLpsOn) //Native power save TDMA, only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 -+ { -+ psTdmaByte0Val = 0x61; //no null-pkt -+ psTdmaByte3Val = 0x11; // no tx-pause at BT-slot -+ psTdmaByte4Val = 0x10; // 0x778 = d/1 toggle, no dynamic slot -+ } -+ else -+ { -+ psTdmaByte0Val = 0x51; //null-pkt -+ psTdmaByte3Val = 0x10; //tx-pause at BT-slot -+ psTdmaByte4Val = 0x50; // 0x778 = d/1 toggle, dynamic slot -+ } -+ } -+ else if ((type == 3) || (type == 13) || (type == 14) || (type == 103) || (type == 113) || (type == 114)) -+ { -+ psTdmaByte0Val = 0x51; //null-pkt -+ psTdmaByte3Val = 0x10; //tx-pause at BT-slot -+ psTdmaByte4Val = 0x10; // 0x778 = d/1 toggle, no dynamic slot -+#if 0 -+ if (!bWifiBusy) -+ psTdmaByte4Val = psTdmaByte4Val | 0x1; //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) -+#endif -+ } -+ else //native power save case -+ { -+ psTdmaByte0Val = 0x61; //no null-pkt -+ psTdmaByte3Val = 0x11; // no tx-pause at BT-slot -+ psTdmaByte4Val = 0x11; // 0x778 = d/1 toggle, no dynamic slot -+ //psTdmaByte4Va is not defne for 0x778 = d/1, 1/1 case -+ } -+ -+ //if (pBtLinkInfo->bSlaveRole == TRUE) -+ if ((pBtLinkInfo->bSlaveRole == TRUE) && (pBtLinkInfo->bA2dpExist)) -+ psTdmaByte4Val = psTdmaByte4Val | 0x1; //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) -+ -+ if (type > 100) -+ { -+ psTdmaByte0Val = psTdmaByte0Val | 0x82; //set antenna control by SW -+ psTdmaByte3Val = psTdmaByte3Val | 0x60; //set antenna no toggle, control by antenna diversity -+ } -+ -+ -+ if(bTurnOn) -+ { -+ switch(type) -+ { -+ default: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x1a, 0x1a, 0x0, psTdmaByte4Val); -+ break; -+ case 1: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 2: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x2d+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 3: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 4: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x93, 0x15, 0x3, 0x14, 0x0); -+ break; -+ case 5: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x15, 0x3, psTdmaByte3Val, 0x11); -+ break; -+ case 6: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x20, 0x3, psTdmaByte3Val, 0x11); -+ break; -+ case 7: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xc, 0x5, 0x0, 0x0); -+ break; -+ case 8: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 9: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 10: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 11: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 12: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x0a, 0x0a, 0x0, 0x50); -+ break; -+ case 13: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 14: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 15: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0x3, 0x8, 0x0); -+ break; -+ case 16: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x93, 0x15, 0x3, 0x10, 0x0); -+ break; -+ case 18: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 20: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3f, 0x03, psTdmaByte3Val, 0x10); -+ break; -+ case 21: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x11); -+ break; -+ case 22: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x25, 0x03, psTdmaByte3Val, 0x10); -+ break; -+ case 23: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x18); -+ break; -+ case 24: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x3, 0x31, 0x18); -+ break; -+ case 25: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 26: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 27: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x98); -+ break; -+ case 28: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x69, 0x25, 0x3, 0x31, 0x0); -+ break; -+ case 29: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xab, 0x1a, 0x1a, 0x1, 0x10); -+ break; -+ case 30: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x30, 0x3, 0x10, 0x10); -+ break; -+ case 31: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xd3, 0x1a, 0x1a, 0, 0x58); -+ break; -+ case 32: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x35, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 33: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x35, 0x3, psTdmaByte3Val, 0x10); -+ break; -+ case 34: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x53, 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 35: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x63, 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 36: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xd3, 0x12, 0x3, 0x14, 0x50); -+ break; -+ case 40: // SoftAP only with no sta associated,BT disable ,TDMA mode for power saving -+ /* here softap mode screen off will cost 70-80mA for phone */ -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x23, 0x18, 0x00, 0x10, 0x24); -+ break; -+ -+ //for 1-Ant translate to 2-Ant -+ case 101: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 102: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x2d+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 103: -+ //halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x1d, 0x1d, 0x0, psTdmaByte4Val); -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 105: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x15, 0x3, psTdmaByte3Val, 0x11); -+ break; -+ case 106: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x20, 0x3, psTdmaByte3Val, 0x11); -+ break; -+ case 109: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 111: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 113: -+ //halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x12, 0x12, 0x0, psTdmaByte4Val); -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 114: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 120: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3f, 0x03, psTdmaByte3Val, 0x10); -+ break; -+ case 122: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x25, 0x03, psTdmaByte3Val, 0x10); -+ break; -+ case 132: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x25, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 133: -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x25, 0x03, psTdmaByte3Val, 0x11); -+ break; -+ -+ } -+ } -+ else -+ { -+ -+ // disable PS tdma -+ switch(type) -+ { -+ case 8: //PTA Control -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x8, 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 0: -+ default: //Software control, Antenna at BT side -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 1: // 2-Ant, 0x778=3, antenna control by antenna diversity -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x48, 0x0); -+ break; -+#if 0 -+ case 9: //Software control, Antenna at WiFi side -+ halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ //halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_WIFI, BTC_WIFI_STAT_NORMAL); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_WIFI, FALSE, FALSE); -+ break; -+#endif -+ } -+ } -+ rssiAdjustVal =0; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssiAdjustVal); -+ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", -+ pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948), pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765), pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67))); -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+BOOLEAN -+halbtc8723b1ant_IsCommonAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE, bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if(!bWifiConnected && -+ BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n")); -+ -+ //halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(bWifiConnected && -+ (BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT non connected-idle!!\n")); -+ -+ //halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(!bWifiConnected && -+ (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT connected-idle!!\n")); -+ -+ //halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(bWifiConnected && -+ (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT connected-idle!!\n")); -+ -+ //halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(!bWifiConnected && -+ (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT Busy!!\n")); -+ -+ //halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ if (bWifiBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n")); -+ } -+ -+ bCommon = FALSE; -+ } -+ -+ return bCommon; -+} -+ -+ -+VOID -+halbtc8723b1ant_TdmaDurationAdjustForAcl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0, btInfoExt; -+ static BOOLEAN bPreWifiBusy=FALSE; -+ BOOLEAN bWifiBusy = FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjustForAcl()\n")); -+ -+ if(BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifiStatus) -+ bWifiBusy = TRUE; -+ else -+ bWifiBusy = FALSE; -+ -+ if( (BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == wifiStatus) || -+ (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifiStatus) || -+ (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT == wifiStatus) ) -+ { -+ if( pCoexDm->curPsTdma != 1 && -+ pCoexDm->curPsTdma != 2 && -+ pCoexDm->curPsTdma != 3 && -+ pCoexDm->curPsTdma != 9 ) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ return; -+ } -+ -+ if(!pCoexDm->bAutoTdmaAdjust) -+ { -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if ( (pCoexSta->lowPriorityTx) > 1050 || (pCoexSta->lowPriorityRx) > 1250 ) -+ retryCount++; -+ -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ if(result == -1) -+ { -+/* if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 1) ||(pCoexDm->curPsTdma == 2)) ) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else */ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ else if(result == 1) -+ { -+/* if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 1) ||(pCoexDm->curPsTdma == 2)) ) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else */ if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ } -+ else //no change -+ { -+ /* Bryant Modify -+ if(bWifiBusy != bPreWifiBusy) //if busy / idle change -+ { -+ bPreWifiBusy = bWifiBusy; -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, pCoexDm->curPsTdma); -+ } -+ */ -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], ********** TDMA(on, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ -+ if( pCoexDm->curPsTdma != 1 && -+ pCoexDm->curPsTdma != 2 && -+ pCoexDm->curPsTdma != 9 && -+ pCoexDm->curPsTdma != 11 ) -+ { -+ // recover to previous adjust type -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ } -+} -+ -+VOID -+halbtc8723b1ant_PsTdmaCheckForPowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bNewPsState -+ ) -+{ -+ u1Byte lpsMode=0x0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode); -+ -+ if(lpsMode) // already under LPS state -+ { -+ if(bNewPsState) -+ { -+ // keep state under LPS, do nothing. -+ } -+ else -+ { -+ // will leave LPS state, turn off psTdma first -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ } -+ } -+ else // NO PS state -+ { -+ if(bNewPsState) -+ { -+ // will enter LPS state, turn off psTdma first -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ } -+ else -+ { -+ // keep state under NO PS state, do nothing. -+ } -+ } -+} -+ -+VOID -+halbtc8723b1ant_PowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte psType, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bLowPwrDisable=FALSE; -+ -+ switch(psType) -+ { -+ case BTC_PS_WIFI_NATIVE: -+ // recover to original 32k low power setting -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8723b1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, TRUE); -+ halbtc8723b1ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal); -+ // when coex force to enter LPS, do not enter 32k low power. -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ // power save must executed before psTdma. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); -+ pCoexSta->bForceLpsOn = TRUE; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8723b1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, FALSE); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8723b1ant_ActionWifiOnly( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+} -+ -+VOID -+halbtc8723b1ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ -+ bPreBtDisabled = bBtDisabled; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ if(bBtDisabled) -+ { -+ halbtc8723b1ant_ActionWifiOnly(pBtCoexist); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ } -+ } -+} -+ -+//============================================= -+// -+// Software Coex Mechanism start -+// -+//============================================= -+ -+// SCO only or SCO+PAN(HS) -+ -+/* -+VOID -+halbtc8723b1ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+ -+VOID -+halbtc8723b1ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -+VOID -+halbtc8723b1ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8723b1ant_ActionA2dpPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8723b1ant_ActionPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+//PAN(HS) only -+VOID -+halbtc8723b1ant_ActionPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+//PAN(EDR)+A2DP -+VOID -+halbtc8723b1ant_ActionPanEdrA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8723b1ant_ActionPanEdrHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+// HID+A2DP+PAN(EDR) -+VOID -+halbtc8723b1ant_ActionHidA2dpPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+VOID -+halbtc8723b1ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+*/ -+ -+//============================================= -+// -+// Non-Software Coex Mechanism start -+// -+//============================================= -+VOID -+halbtc8723b1ant_ActionBtWhckTest( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8723b1ant_ActionWifiMultiPort( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+} -+ -+VOID -+halbtc8723b1ant_ActionHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+} -+ -+VOID -+halbtc8723b1ant_ActionBtInquiry( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE, bApEnable=FALSE, bWifiBusy=FALSE, bBtBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ if ( (!bWifiConnected) && (!pCoexSta->bWiFiIsHighPriTask) ) -+ { -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if( (pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist) || (pBtLinkInfo->bA2dpExist) ) -+ { -+ // SCO/HID/A2DP busy -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ if (pCoexSta->bC2hBtRemoteNameReq) -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 33); -+ else -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if ( (pBtLinkInfo->bPanExist) || (bWifiBusy) ) -+ { -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ if (pCoexSta->bC2hBtRemoteNameReq) -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 33); -+ else -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ -+ } -+} -+ -+VOID -+halbtc8723b1ant_ActionBtScoHidOnlyBusy( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ // tdma and coex table -+ -+ if(pBtLinkInfo->bScoExist) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+ else //HID -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+} -+ -+VOID -+halbtc8723b1ant_ActionWifiConnectedBtAclBusy( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ u1Byte btRssiState; -+ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ btRssiState = halbtc8723b1ant_BtRssiState(2, 28, 0); -+ -+ if ( (pCoexSta->lowPriorityRx >= 950) && (!pCoexSta->bUnderIps) ) -+ { -+ pBtLinkInfo->bSlaveRole = TRUE; -+ } -+ else -+ { -+ pBtLinkInfo->bSlaveRole = FALSE; -+ } -+ -+ if(pBtLinkInfo->bHidOnly) //HID -+ { -+ halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, wifiStatus); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ return; -+ } -+ else if(pBtLinkInfo->bA2dpOnly) //A2DP -+ { -+ if(BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifiStatus) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else -+ { -+ halbtc8723b1ant_TdmaDurationAdjustForAcl(pBtCoexist, wifiStatus); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ } -+ } -+ else if ( ((pBtLinkInfo->bA2dpExist) && (pBtLinkInfo->bPanExist)) || -+ (pBtLinkInfo->bHidExist&&pBtLinkInfo->bA2dpExist&&pBtLinkInfo->bPanExist) ) //A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else if(pBtLinkInfo->bHidExist&&pBtLinkInfo->bA2dpExist) //HID+A2DP -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ } -+ else if( (pBtLinkInfo->bPanOnly) || (pBtLinkInfo->bHidExist&&pBtLinkInfo->bPanExist) ) //PAN(OPP,FTP), HID+PAN(OPP,FTP) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else -+ { -+ //BT no-profile busy (0x9) -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 33); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+} -+ -+VOID -+halbtc8723b1ant_ActionWifiNotConnected( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // power save state -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8723b1ant_ActionWifiNotConnectedScan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ if (pBtLinkInfo->bA2dpExist) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ } -+ else if( (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } -+ else -+ { -+ //Bryant Add -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8723b1ant_ActionWifiNotConnectedAssoAuth( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if( (pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist) || (pBtLinkInfo->bA2dpExist) ) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bPanExist) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 4); -+ } -+ else -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8723b1ant_ActionWifiConnectedScan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ if (pBtLinkInfo->bA2dpExist) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ } -+ else if( (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } -+ else -+ { -+ //Bryant Add -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8723b1ant_ActionWifiConnectedSpecialPacket( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiBusy = FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ //no special packet process for both WiFi and BT very busy -+ if ((bWifiBusy) && ((pBtLinkInfo->bPanExist) || (pCoexSta->nNumOfProfile >= 2))) -+ return; -+ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if((pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist)) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+ else if (pBtLinkInfo->bA2dpExist) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8723b1ant_ActionWifiConnected( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiBusy=FALSE; -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ BOOLEAN bUnder4way=FALSE, bApEnable=FALSE; -+ u4Byte wifiBw; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect()===>\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ if(bUnder4way) -+ { -+ halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ if(bScan || bLink || bRoam) -+ { -+ if(bScan) -+ halbtc8723b1ant_ActionWifiConnectedScan(pBtCoexist); -+ else -+ halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ // power save state -+ if(!bApEnable && BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus && !pBtCoexist->btLinkInfo.bHidOnly) -+ { -+ if(pBtCoexist->btLinkInfo.bA2dpOnly) //A2DP -+ { -+ if(!bWifiBusy) -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else //busy -+ { -+ if (pCoexSta->nScanAPNum >= BT_8723B_1ANT_WIFI_NOISY_THRESH) //no force LPS, no PS-TDMA, use pure TDMA -+ { -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ } -+ } -+ else if ((pCoexSta->bPanExist == FALSE) && (pCoexSta->bA2dpExist == FALSE) && (pCoexSta->bHidExist == FALSE)) -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ else -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(!bWifiBusy) -+ { -+ if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ halbtc8723b1ant_ActionWifiConnectedBtAclBusy(pBtCoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } -+ else if( (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } -+ else -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ if ( (pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60 ) -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ else -+ { -+ if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ halbtc8723b1ant_ActionWifiConnectedBtAclBusy(pBtCoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } -+ else if( (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } -+ else -+ { -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ if ( (pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60 ) -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+} -+ -+VOID -+halbtc8723b1ant_RunSwCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte algorithm=0; -+ -+ algorithm = halbtc8723b1ant_ActionAlgorithm(pBtCoexist); -+ pCoexDm->curAlgorithm = algorithm; -+ -+ if(halbtc8723b1ant_IsCommonAction(pBtCoexist)) -+ { -+ -+ } -+ else -+ { -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8723B_1ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = SCO.\n")); -+ //halbtc8723b1ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID.\n")); -+ //halbtc8723b1ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = A2DP.\n")); -+ //halbtc8723b1ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = A2DP+PAN(HS).\n")); -+ //halbtc8723b1ant_ActionA2dpPanHs(pBtCoexist); -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN(EDR).\n")); -+ //halbtc8723b1ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HS mode.\n")); -+ //halbtc8723b1ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN+A2DP.\n")); -+ //halbtc8723b1ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_PANEDR_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN(EDR)+HID.\n")); -+ //halbtc8723b1ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID+A2DP+PAN.\n")); -+ //halbtc8723b1ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8723B_1ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID+A2DP.\n")); -+ //halbtc8723b1ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = coexist All Off!!\n")); -+ //halbtc8723b1ant_CoexAllOff(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+} -+ -+VOID -+halbtc8723b1ant_RunCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE, bWifiBusy = FALSE; -+ BOOLEAN bIncreaseScanDevNum=FALSE; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ BOOLEAN bMiracastPlusBt=FALSE; -+ u1Byte aggBufSize=5; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0, wifiBw; -+ u1Byte iotPeer=BTC_IOT_PEER_UNKNOWN; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism()===>\n")); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n")); -+ return; -+ } -+ -+ if(pBtCoexist->bStopCoexDm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n")); -+ return; -+ } -+ -+ if(pCoexSta->bUnderIps) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under IPS !!!\n")); -+ return; -+ } -+ -+ if(pCoexSta->bBtWhckTest) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is under WHCK TEST!!!\n")); -+ halbtc8723b1ant_ActionBtWhckTest(pBtCoexist); -+ return; -+ } -+ -+ if( (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ bIncreaseScanDevNum = TRUE; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, &bIncreaseScanDevNum); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ -+ if((numOfWifiLink>=2) || (wifiLinkStatus&WIFI_P2P_GO_CONNECTED)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], Multi-Port numOfWifiLink = %d, wifiLinkStatus = 0x%x\n", numOfWifiLink,wifiLinkStatus) ); -+ -+ if(pBtLinkInfo->bBtLinkExist) -+ { -+ halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ bMiracastPlusBt = TRUE; -+ } -+ else -+ { -+ halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ bMiracastPlusBt = FALSE; -+ } -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ -+ if (( (pBtLinkInfo->bA2dpExist) || (bWifiBusy) ) && (pCoexSta->bC2hBtInquiryPage) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], BT Is Inquirying \n") ); -+ halbtc8723b1ant_ActionBtInquiry(pBtCoexist); -+ } -+ else -+ halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist); -+ -+ return; -+ } -+ else -+ { -+ bMiracastPlusBt = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if ( (pBtLinkInfo->bBtLinkExist) && (bWifiConnected) ) -+ { -+ halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_IOT_PEER, &iotPeer); -+ -+ if(BTC_IOT_PEER_CISCO != iotPeer) -+ { -+ if(pBtLinkInfo->bScoExist)//if (pBtLinkInfo->bBtHiPriLinkExist) -+ //halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x5); -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x5); -+ else -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x5); -+ //halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x8); -+ } -+ else -+ { -+ if(pBtLinkInfo->bScoExist) -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x5); -+ else -+ { -+ if (BTC_WIFI_BW_HT40==wifiBw) -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x10); -+ else -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x8); -+ } -+ } -+ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, TRUE); -+ halbtc8723b1ant_RunSwCoexistMechanism(pBtCoexist); //just print debug message -+ } -+ else -+ { -+ halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x5); -+ -+ halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE); -+ halbtc8723b1ant_RunSwCoexistMechanism(pBtCoexist); ////just print debug message -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], BT Is Inquirying \n") ); -+ halbtc8723b1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8723b1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ -+ if(!bWifiConnected) -+ { -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is non connected-idle !!!\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if(bScan || bLink || bRoam) -+ { -+ if (bScan) -+ halbtc8723b1ant_ActionWifiNotConnectedScan(pBtCoexist); -+ else -+ halbtc8723b1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist); -+ } -+ else -+ halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else // wifi LPS/Busy -+ { -+ halbtc8723b1ant_ActionWifiConnected(pBtCoexist); -+ } -+} -+ -+u4Byte -+halbtc8723b1ant_PSD_Log2Base( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val -+ -+ ) -+{ -+ u1Byte i,j; -+ u4Byte tmp, tmp2, val_integerdB=0, tindex, shiftcount=0; -+ u4Byte result,val_fractiondB=0,Table_fraction[21]= {0,432, 332, 274, 232, 200, -+ 174, 151,132,115,100,86,74,62,51,42, -+ 32,23,15,7,0}; -+ -+ if (val == 0) -+ return 0; -+ -+ tmp = val; -+ -+ while(1) -+ { -+ if (tmp == 1) -+ break; -+ else -+ { -+ tmp = (tmp >> 1); -+ shiftcount++; -+ } -+ } -+ -+ -+ val_integerdB = shiftcount+1; -+ -+ tmp2=1; -+ for (j=1; j<= val_integerdB;j++) -+ tmp2 = tmp2*2; -+ -+ tmp = (val*100) /tmp2; -+ tindex = tmp/5; -+ -+ if (tindex > 20) -+ tindex = 20; -+ -+ val_fractiondB = Table_fraction[tindex]; -+ -+ result = val_integerdB*100 - val_fractiondB; -+ -+ return (result); -+ -+ -+} -+ -+VOID -+halbtc8723b1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ -+ // sw all off -+ halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ //halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ //halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ pCoexSta->popEventCnt = 0; -+} -+ -+VOID -+halbtc8723b1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bBackUp, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte u4Tmp=0;//, fwVer; -+ u2Byte u2Tmp=0; -+ u1Byte u1Tmp=0, u1Tmpa=0, u1Tmpb=0; -+ u1Byte H2C_Parameter[2] ={0}; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Init HW Config!!\n")); -+ -+ pPsdScan->nAntDet_IsAntDetAvailable = FALSE; -+ -+ //0xf0[15:12] --> Chip Cut information -+ pCoexSta->nCutVersion = (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xf1) & 0xf0) >> 4; -+ -+#if 0//move to BTC_MEDIA_CONNECT -+ if(bBackUp) -+ { -+ pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ } -+#endif -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x550, 0x8, 0x1); //enable TBTT nterrupt -+ -+ // 0x790[5:0]=0x5 -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, 0x5); -+ -+ // Enable counter statistics -+ //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); //0x76e[3] =1, WLAN_Act control by PTA -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x1); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0x20, 0x1); -+ -+ -+ //pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); //BT select s0/s1 is controlled by WiFi -+ -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ -+ //Antenna config -+ if(bWifiOnly) -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_WIFI, FORCE_EXEC, TRUE, FALSE); -+ else -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, TRUE, FALSE); -+ -+#if 0 -+ if(bWifiOnly) -+ { -+ halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_WIFI, BTC_WIFI_STAT_INIT); -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ } -+ else -+ halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_BT, BTC_WIFI_STAT_INIT); -+#endif -+ -+ -+ -+ // PTA parameter -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", -+ u4Tmp, u1Tmpa, u1Tmpb)); -+} -+ -+ -+ -+ -+ -+VOID -+halbtc8723b1ant_MechanismSwitch( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSwitchTo2Antenna -+ ) -+{ -+ -+ if (bSwitchTo2Antenna) // 1-Ant -> 2-Ant -+ { -+ //un-lock TRx Mask setup for 8723b f-cut -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdd, 0x80, 0x1); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdf, 0x1, 0x1); -+ //WiFi TRx Mask on -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ //BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1 -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x2c, 0x7c45); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x30, 0x7c45); -+ -+ //BT TRx Mask on -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x1); -+ -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, FALSE); -+ } -+ else -+ { -+ //WiFi TRx Mask on -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); -+ -+ //lock TRx Mask setup for 8723b f-cut -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdd, 0x80, 0x0); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdf, 0x1, 0x0); -+ -+ //BT TRx Mask on -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); -+ -+ //BT TRx Mask ock 0x2c[0], 0x30[0] = 0 -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x2c, 0x7c44); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x30, 0x7c44); -+ -+ -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+ } -+ -+} -+ -+ -+ -+ -+VOID -+halbtc8723b1ant_PSD_ShowAntennaDetectResult( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n============[Antenna Detection info] ============\n"); -+ CL_PRINTF(cliBuf); -+ -+ if (pPsdScan->nAntDet_Result == 1) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", "Ant Det Result", "2-Antenna (Bad-Isolation)", -+ BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else if (pPsdScan->nAntDet_Result == 2) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", "Ant Det Result", "2-Antenna (Good-Isolation)", -+ BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION+pPsdScan->nAntDet_ThresOffset, BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", "Ant Det Result", "1-Antenna", -+ BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT, BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION+pPsdScan->nAntDet_ThresOffset); -+ -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", "Antenna Detection Finish", -+ (pBoardInfo->btdmAntDetFinish? "Yes":"No")); -+ CL_PRINTF(cliBuf); -+ -+ switch(pPsdScan->nAntDet_Result) -+ { -+ case 0: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is not available)"); -+ break; -+ case 1: // 2-Ant bad-isolation -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is available)"); -+ break; -+ case 2: // 2-Ant good-isolation -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is available)"); -+ break; -+ case 3: // 1-Ant -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is available)"); -+ break; -+ case 4: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(Uncertainty result)"); -+ break; -+ case 5: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); -+ break; -+ case 6: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(WiFi is Scanning)"); -+ break; -+ case 7: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is not idle)"); -+ break; -+ case 8: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(Abort by WiFi Scanning)"); -+ break; -+ case 9: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(Antenna Init is not ready)"); -+ break; -+ case 10: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is Inquiry or page)"); -+ break; -+ case 11: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is Disabled)"); -+ break; -+} -+ CL_PRINTF(cliBuf); -+ -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Ant Detect Total Count",pPsdScan->bAntDet_TryCount); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Ant Detect Fail Count",pPsdScan->bAntDet_FailCount); -+ CL_PRINTF(cliBuf); -+ -+ if ( (!pBoardInfo->btdmAntDetFinish) && (pPsdScan->nAntDet_Result != 5) ) -+ return; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response",(pPsdScan->nAntDet_Result? "ok":"fail")); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", pPsdScan->nAntDet_BTTxTime); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", pPsdScan->nAntDet_BTLEChannel); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "WiFi PSD Cent-Ch/Offset/Span", -+ pPsdScan->nRealCentFreq, pPsdScan->nRealOffset, pPsdScan->nRealSpan); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", "PSD Pre-Scan Peak Value", pPsdScan->nAntDet_PrePSDScanPeakVal/100); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", "PSD Pre-Scan result", -+ (pPsdScan->nAntDet_Result != 5? "ok":"fail"), BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND+pPsdScan->nAntDet_ThresOffset); -+ CL_PRINTF(cliBuf); -+ -+ if (pPsdScan->nAntDet_Result == 5) -+ return; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", "PSD Scan Peak Value", pPsdScan->nAntDet_PeakVal); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", "PSD Scan Peak Freq", pPsdScan->nAntDet_PeakFreq); -+ CL_PRINTF(cliBuf); -+ -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", -+ (pBoardInfo->bTfbgaPackage)? "Yes":"No"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "PSD Threshold Offset", pPsdScan->nAntDet_ThresOffset); -+ CL_PRINTF(cliBuf); -+ -+} -+ -+VOID -+halbtc8723b1ant_PSD_ShowData( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u4Byte nDeltaFreqPerPoint; -+ u4Byte freq,freq1,freq2,n=0,i=0, j=0, m=0, PsdRep1, PsdRep2; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n\n============[PSD info] (%d)============\n", -+ pPsdScan->nPSDGenCount); -+ CL_PRINTF(cliBuf); -+ -+ if (pPsdScan->nPSDGenCount == 0) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n No Data !!\n"); -+ CL_PRINTF(cliBuf); -+ return; -+ } -+ -+ if (pPsdScan->nPSDPoint == 0) -+ nDeltaFreqPerPoint = 0; -+ else -+ nDeltaFreqPerPoint = pPsdScan->nPSDBandWidth/pPsdScan->nPSDPoint; -+ -+ //if (pPsdScan->bIsPSDShowMaxOnly) -+ if (0) -+ { -+ PsdRep1 = pPsdScan->nPSDMaxValue/100; -+ PsdRep2 = pPsdScan->nPSDMaxValue - PsdRep1 * 100; -+ -+ freq = ((pPsdScan->nRealCentFreq-20) * 1000000 + pPsdScan->nPSDMaxValuePoint * nDeltaFreqPerPoint); -+ freq1 = freq/1000000; -+ freq2 = freq/1000 - freq1 * 1000; -+ -+ if (freq2 < 100) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq = %d.0%d MHz", -+ freq1, freq2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq = %d.%d MHz", -+ freq1, freq2); -+ -+ if (PsdRep2 < 10) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, ", Value = %d.0%d dB, (%d) \n", -+ PsdRep1, PsdRep2, pPsdScan->nPSDMaxValue); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, ", Value = %d.%d dB, (%d)\n", -+ PsdRep1, PsdRep2, pPsdScan->nPSDMaxValue); -+ -+ CL_PRINTF(cliBuf); -+ } -+ else -+ { -+ m = pPsdScan->nPSDStartPoint; -+ n = pPsdScan->nPSDStartPoint; -+ i = 1; -+ j = 1; -+ -+ while(1) -+ { -+ do -+ { -+ freq = ((pPsdScan->nRealCentFreq-20) * 1000000 + m * nDeltaFreqPerPoint); -+ freq1 = freq/1000000; -+ freq2 = freq/1000 - freq1 * 1000; -+ -+ if (i ==1) -+ { -+ if (freq2 == 0) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq%6d.0%2d", freq1,freq2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq%6d.%3d", freq1,freq2); -+ } -+ else if ( (i%8 == 0) || (m == pPsdScan->nPSDStopPoint) ) -+ { -+ if (freq2 == 0) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.000\n", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.0%2d\n", freq1,freq2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.%3d\n", freq1,freq2); -+ } -+ else -+ { -+ if (freq2 == 0) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.0%2d", freq1,freq2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.%3d", freq1,freq2); -+ } -+ -+ i++; -+ m++; -+ CL_PRINTF(cliBuf); -+ -+ }while( (i <= 8) && (m <= pPsdScan->nPSDStopPoint)); -+ -+ -+ do -+ { -+ PsdRep1 = pPsdScan->nPSDReport_MaxHold[n]/100; -+ PsdRep2 = pPsdScan->nPSDReport_MaxHold[n] - PsdRep1 * 100; -+ -+ if (j ==1) -+ { -+ if (PsdRep2 <10) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Val %7d.0%d", PsdRep1,PsdRep2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Val %7d.%d", PsdRep1,PsdRep2); -+ } -+ else if ( (j%8 == 0) || (n == pPsdScan->nPSDStopPoint) ) -+ { -+ if (PsdRep2 <10) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%7d.0%d\n", PsdRep1,PsdRep2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%7d.%d\n", PsdRep1,PsdRep2); -+ } -+ else -+ { -+ if (PsdRep2 <10) -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%7d.0%d", PsdRep1,PsdRep2); -+ else -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%7d.%d", PsdRep1,PsdRep2); -+ } -+ -+ j++; -+ n++; -+ CL_PRINTF(cliBuf); -+ -+ } while( (j <= 8) && (n <= pPsdScan->nPSDStopPoint)); -+ -+ if ( (m > pPsdScan->nPSDStopPoint) || (n > pPsdScan->nPSDStopPoint) ) -+ break; -+ else -+ { -+ i = 1; -+ j = 1; -+ } -+ -+ } -+ } -+ -+ -+} -+ -+VOID -+halbtc8723b1ant_PSD_MaxHoldData( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte GenCount -+ ) -+{ -+ u4Byte i=0, i_max=0, val_max=0, j; -+ -+ if (GenCount== 1) -+ { -+ memcpy(pPsdScan->nPSDReport_MaxHold, pPsdScan->nPSDReport, BT_8723B_1ANT_ANTDET_PSD_POINTS*sizeof(u4Byte)); -+ -+ for (i= pPsdScan->nPSDStartPoint; i<=pPsdScan->nPSDStopPoint; i++) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Max_Hold i = %d, PSDReport = %d dB\n", i, pPsdScan->nPSDReport_MaxHold[i])); -+ } -+ -+ pPsdScan->nPSDMaxValuePoint = 0; -+ pPsdScan->nPSDMaxValue = 0; -+ -+ } -+ else -+ { -+ for (i= pPsdScan->nPSDStartPoint; i<=pPsdScan->nPSDStopPoint; i++) -+ { -+ if (pPsdScan->nPSDReport[i] > pPsdScan->nPSDReport_MaxHold[i]) -+ pPsdScan->nPSDReport_MaxHold[i] = pPsdScan->nPSDReport[i]; -+ -+ //search Max Value -+ if (i ==pPsdScan->nPSDStartPoint ) -+ { -+ i_max = i; -+ val_max = pPsdScan->nPSDReport_MaxHold[i]; -+ } -+ else -+ { -+ if (pPsdScan->nPSDReport_MaxHold[i] > val_max) -+ { -+ i_max = i; -+ val_max = pPsdScan->nPSDReport_MaxHold[i]; -+ } -+ } -+ -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Max_Hold i = %d, PSDReport = %d dB\n", i, pPsdScan->nPSDReport_MaxHold[i])); -+ -+ } -+ -+ pPsdScan->nPSDMaxValuePoint = i_max; -+ pPsdScan->nPSDMaxValue = val_max; -+ -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Max_Hold i_Max = %d, PSDReport_Max = %d dB\n", pPsdScan->nPSDMaxValuePoint -+ // ,pPsdScan->nPSDMaxValue)); -+ } -+ -+ -+} -+ -+u4Byte -+halbtc8723b1ant_PSD_GetData( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte nPoint -+ ) -+{ -+ //reg 0x808[9:0]: FFT data x -+ //reg 0x808[22]: 0-->1 to get 1 FFT data y -+ //reg 0x8b4[15:0]: FFT data y report -+ -+ u4Byte val = 0, psd_report =0; -+ -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x808); -+ -+ val &= 0xffbffc00; -+ val |= nPoint; -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x808, val); -+ -+ val |= 0x00400000; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x808, val); -+ -+ -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x8b4); -+ -+ psd_report = val & 0x0000ffff; -+ -+ return psd_report; -+} -+ -+ -+VOID -+halbtc8723b1ant_PSD_SweepPoint( -+IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN s4Byte offset, -+ IN u4Byte span, -+ IN u4Byte points, -+ IN u4Byte avgnum -+ ) -+{ -+ u4Byte i,val,n,k=0; -+ u4Byte nPoints=0, psd_report=0; -+ u4Byte nStartP=0, nStopP=0, nDeltaFreqPerPoint=156250; -+ u4Byte nPSDCenterFreq=20*10^6, freq,freq1,freq2; -+ BOOLEAN outloop = FALSE; -+ u1Byte flag = 0; -+ u4Byte tmp, PsdRep1, PsdRep2; -+ u4Byte WiFi_OriginalChannel = 1; -+ -+ pPsdScan->bIsPSDRunning = TRUE; -+ -+ do -+ { -+ switch(flag) -+ { -+ case 0: //Get PSD parameters -+ default: -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), centFreq=0x%x, offset=0x%x, span=0x%x\n", -+ // centFreq, offset, span)); -+ -+ pPsdScan->nPSDBandWidth = 40*1000000; -+ pPsdScan->nPSDPoint = points; -+ pPsdScan->nPSDStartBase = points/2; -+ pPsdScan->nPSDAvgNum = avgnum; -+ pPsdScan->nRealCentFreq = centFreq; -+ pPsdScan->nRealOffset = offset; -+ pPsdScan->nRealSpan = span; -+ -+ -+ nPoints = pPsdScan->nPSDPoint; -+ nDeltaFreqPerPoint = pPsdScan->nPSDBandWidth/pPsdScan->nPSDPoint; -+ -+ //PSD point setup -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x808); -+ val &= 0xffff0fff; -+ -+ switch(pPsdScan->nPSDPoint) -+ { -+ case 128: -+ val |= 0x0; -+ break; -+ case 256: -+ default: -+ val |=0x00004000; -+ break; -+ case 512: -+ val |= 0x00008000; -+ break; -+ case 1024: -+ val |= 0x0000c000; -+ break; -+ } -+ -+ switch(pPsdScan->nPSDAvgNum) -+ { -+ case 1: -+ val |= 0x0; -+ break; -+ case 8: -+ val |=0x00001000; -+ break; -+ case 16: -+ val |= 0x00002000; -+ break; -+ case 32: -+ default: -+ val |= 0x00003000; -+ break; -+ } -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x808, val); -+ -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), PSD BW= %d, DeltaFreq=%d\n" -+ // , pPsdScan->nPSDBandWidth, nDeltaFreqPerPoint)); -+ flag = 1; -+ break; -+ case 1: //calculate the PSD point index from freq/offset/span -+ nPSDCenterFreq = pPsdScan->nPSDBandWidth /2 +offset*(1000000); -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), PSD Center Freq = %d\n", (centFreq + offset))); -+ -+ nStartP = pPsdScan->nPSDStartBase + (nPSDCenterFreq - span *(1000000)/2) /nDeltaFreqPerPoint; -+ pPsdScan->nPSDStartPoint = nStartP - pPsdScan->nPSDStartBase; -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Start PSD Poin Matrix Index = %d\n", pPsdScan->nPSDStartPoint)); -+ -+ nStopP = pPsdScan->nPSDStartBase + (nPSDCenterFreq + span *(1000000)/2) /nDeltaFreqPerPoint; -+ pPsdScan->nPSDStopPoint = nStopP - pPsdScan->nPSDStartBase-1; -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Stop PSD Poin Matrix Index = %d\n",pPsdScan->nPSDStopPoint)); -+ -+ flag = 2; -+ break; -+ case 2: //set RF channel/BW/Mode -+ -+ //set 3-wire off -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x88c); -+ val |= 0x00300000; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x88c,val); -+ -+ //CCK off -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x800); -+ val &= 0xfeffffff; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x800,val); -+ -+ //store WiFi original channel -+ WiFi_OriginalChannel = pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x18, 0x3ff); -+ -+ //Set RF channel -+ if (centFreq == 2484) -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x18, 0x3ff, 0xe); -+ else -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x18, 0x3ff, (centFreq-2412)/5 + 1); //WiFi TRx Mask on -+ -+ //Set RF mode = Rx, RF Gain = 0x8a0 -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x0, 0xfffff, 0x308a0); -+ -+ //Set RF Rx filter corner -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0x3e4); -+ -+ //Set TRx mask off -+ //un-lock TRx Mask setup -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdd, 0x80, 0x1); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdf, 0x1, 0x1); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ flag = 3; -+ break; -+ case 3: -+ memset(pPsdScan->nPSDReport,0, pPsdScan->nPSDPoint*sizeof(u4Byte)); -+ nStartP = pPsdScan->nPSDStartPoint + pPsdScan->nPSDStartBase; -+ nStopP = pPsdScan->nPSDStopPoint + pPsdScan->nPSDStartBase + 1; -+ -+ i = nStartP; -+ -+ while (i < nStopP) -+ { -+ if (i >= nPoints) -+ { -+ psd_report = halbtc8723b1ant_PSD_GetData(pBtCoexist,i-nPoints); -+ } -+ else -+ { -+ psd_report = halbtc8723b1ant_PSD_GetData(pBtCoexist,i); -+ } -+ -+ if (psd_report == 0) -+ tmp = 0; -+ else -+ //tmp = 20*log10((double)psd_report); -+ //20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 -+ tmp = 6 * halbtc8723b1ant_PSD_Log2Base(pBtCoexist, psd_report); -+ -+ n = i-pPsdScan->nPSDStartBase; -+ pPsdScan->nPSDReport[n] = tmp; -+ PsdRep1 = pPsdScan->nPSDReport[n] /100; -+ PsdRep2 = pPsdScan->nPSDReport[n] - PsdRep1 * 100; -+ -+ freq = ((centFreq-20) * 1000000 + n * nDeltaFreqPerPoint); -+ freq1 = freq/1000000; -+ freq2 = freq/1000 - freq1 * 1000; -+/* -+ if (freq2 < 100) -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), i = %d (%d.0%d MHz)", n, freq1, freq2)); -+ else -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), i = %d (%d.%d MHz)", n, freq1, freq2)); -+ -+ if (PsdRep2 < 10) -+ RT_TRACE(COMP_COEX, DBG_LOUD, (", PSDReport = %d (%d.0%d dB)\n",psd_report, PsdRep1, PsdRep2)); -+ else -+ RT_TRACE(COMP_COEX, DBG_LOUD, (", PSDReport = %d (%d.%d dB)\n",psd_report, PsdRep1,PsdRep2)); -+*/ -+ i++; -+ -+ k=0; -+ -+ //Add Delay between PSD point -+ while(1) -+ { -+ if (k++ > 20000) -+ break; -+ } -+ -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint()==============\n")); -+ } -+ -+ flag = 100; -+ break; -+ case 99: //error -+ -+ outloop = TRUE; -+ break; -+ case 100: //recovery -+ -+ //set 3-wire on -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x88c); -+ val &=0xffcfffff; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x88c,val); -+ -+ //CCK on -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x800); -+ val |= 0x01000000; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x800,val); -+ -+ //PSD off -+ val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x808); -+ val &=0xffbfffff; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x808,val); -+ -+ //TRx Mask on -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); -+ -+ //lock TRx Mask setup -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdd, 0x80, 0x0); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdf, 0x1, 0x0); -+ -+ //Set RF Rx filter corner -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0x0); -+ -+ //restore WiFi original channel -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x18, 0x3ff, WiFi_OriginalChannel); -+ -+ outloop = TRUE; -+ break; -+ -+ } -+ -+ }while (!outloop); -+ -+ -+ -+ pPsdScan->bIsPSDRunning = FALSE; -+ -+ -+} -+ -+VOID -+halbtc8723b1ant_PSD_AntennaDetection( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte BTTxTime, -+ IN u4Byte BTLEChannel -+ ) -+{ -+ u4Byte realseconds = 0, i=0, j=0; -+ u4Byte WLPSD_CentFreq = 2484, WLPSD_Span = 2, WLPSD_SweepCount = 50; -+ s4Byte WLPSD_Offset = -4; -+ u1Byte BTLECh[13] = {3,6,8,11,13,16,18,21,23,26,28,31,33}; -+ -+ u1Byte H2C_Parameter[3] ={0},u1Tmpa,u1Tmpb; -+ -+ u1Byte state=0; -+ BOOLEAN outloop = FALSE, BTResp = FALSE, bScan ,bRoam; -+ u4Byte freq,freq1,freq2,PsdRep1, PsdRep2, nDeltaFreqPerPoint,u4Tmp; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ memset(pPsdScan->nAntDet_PeakVal, 0, 16*sizeof(UCHAR)); -+ memset(pPsdScan->nAntDet_PeakFreq, 0, 16*sizeof(UCHAR)); -+ -+ if (pBoardInfo->bTfbgaPackage) //for TFBGA -+ pPsdScan->nAntDet_ThresOffset = 5; -+ else -+ pPsdScan->nAntDet_ThresOffset = 0; -+ -+ do -+ { -+ switch(state) -+ { -+ case 0: -+ if (BTLEChannel == 39) -+ WLPSD_CentFreq = 2484; -+ else -+ { -+ for (i=1; i<=13; i++) -+ { -+ if (BTLECh[i-1] == BTLEChannel) -+ { -+ WLPSD_CentFreq = 2412 + (i-1) * 5; -+ break; -+ } -+ } -+ -+ if (i == 14) -+ { -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", BTLEChannel)); -+ outloop = TRUE; -+ break; -+ } -+ } -+ -+ WLPSD_SweepCount = BTTxTime * 238 /100; //BTTxTime/0.42 -+ -+ if (WLPSD_SweepCount % 5 != 0) -+ WLPSD_SweepCount = (WLPSD_SweepCount/5 + 1) * 5; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", BTTxTime, BTLEChannel)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), WLPSD_CentFreq=%d, WLPSD_Offset = %d, WLPSD_Span = %d, WLPSD_SweepCount = %d\n", -+ WLPSD_CentFreq, WLPSD_Offset, WLPSD_Span,WLPSD_SweepCount)); -+ -+ state = 1; -+ break; -+ case 1: //stop coex DM & set antenna path -+ //Stop Coex DM -+ pBtCoexist->bStopCoexDm = TRUE; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n")); -+ -+ //set native power save -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ //Set TDMA off, -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ -+ //Set coex table -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n")); -+ } -+ -+ //Set Antenna path, switch WiFi to un-certain antenna port -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, FALSE); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n")); -+ -+ //Set AFH mask on at WiFi channel 2472MHz +/- 10MHz -+ H2C_Parameter[0] = 0x1; -+ H2C_Parameter[1] = 0xd; -+ H2C_Parameter[2] = 0x14; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", -+ H2C_Parameter[1],H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter); -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x778=0x%x\n", -+ u4Tmp, u1Tmpa, u1Tmpb)); -+ -+ state =2; -+ break; -+ case 2: //Pre-sweep background psd -+ for (pPsdScan->nPSDGenCount=1; pPsdScan->nPSDGenCount<=3; pPsdScan->nPSDGenCount++) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), PSDGenCount = %d\n ", pPsdScan->nPSDGenCount)); -+ halbtc8723b1ant_PSD_SweepPoint(pBtCoexist, WLPSD_CentFreq, WLPSD_Offset, WLPSD_Span, BT_8723B_1ANT_ANTDET_PSD_POINTS, BT_8723B_1ANT_ANTDET_PSD_AVGNUM); -+ halbtc8723b1ant_PSD_MaxHoldData(pBtCoexist, pPsdScan->nPSDGenCount); -+ } -+ -+ pPsdScan->nAntDet_PrePSDScanPeakVal = pPsdScan->nPSDMaxValue; -+ -+ if (pPsdScan->nPSDMaxValue > (BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND+pPsdScan->nAntDet_ThresOffset)*100) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", -+ pPsdScan->nPSDMaxValue/100, BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND+pPsdScan->nAntDet_ThresOffset)); -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pBoardInfo->btdmAntNumByAntDet = 1; -+ pPsdScan->nAntDet_Result = 5; -+ state = 99; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", -+ pPsdScan->nPSDMaxValue/100, BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND+pPsdScan->nAntDet_ThresOffset)); -+ state = 3; -+ } -+ break; -+ case 3: -+ BTResp = pBtCoexist->fBtcSetBtAntDetection(pBtCoexist, (u1Byte)(BTTxTime&0xff), (u1Byte)(BTLEChannel&0xff)); -+ -+ for (pPsdScan->nPSDGenCount=1; pPsdScan->nPSDGenCount<=WLPSD_SweepCount; pPsdScan->nPSDGenCount++) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), PSDGenCount = %d\n ", pPsdScan->nPSDGenCount)); -+ halbtc8723b1ant_PSD_SweepPoint(pBtCoexist, WLPSD_CentFreq, WLPSD_Offset, WLPSD_Span, BT_8723B_1ANT_ANTDET_PSD_POINTS, BT_8723B_1ANT_ANTDET_PSD_AVGNUM); -+ halbtc8723b1ant_PSD_MaxHoldData(pBtCoexist, pPsdScan->nPSDGenCount); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if (bScan ||bRoam) -+ { -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pBoardInfo->btdmAntNumByAntDet = 1; -+ pPsdScan->nAntDet_Result = 8; -+ state = 99; -+ break; -+ } -+ } -+ -+ pPsdScan->nAntDet_PSDScanPeakVal = pPsdScan->nPSDMaxValue; -+ pPsdScan->nAntDet_PSDScanPeakFreq = pPsdScan->nPSDMaxValuePoint; -+ state = 4; -+ break; -+ case 4: -+ -+ if (pPsdScan->nPSDPoint == 0) -+ nDeltaFreqPerPoint = 0; -+ else -+ nDeltaFreqPerPoint = pPsdScan->nPSDBandWidth/pPsdScan->nPSDPoint; -+ -+ PsdRep1 = pPsdScan->nPSDMaxValue/100; -+ PsdRep2 = pPsdScan->nPSDMaxValue - PsdRep1 * 100; -+ -+ freq = ((pPsdScan->nRealCentFreq-20) * 1000000 + pPsdScan->nPSDMaxValuePoint * nDeltaFreqPerPoint); -+ freq1 = freq/1000000; -+ freq2 = freq/1000 - freq1 * 1000; -+ -+ if (freq2 < 100) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", freq1, freq2)); -+ CL_SPRINTF(pPsdScan->nAntDet_PeakFreq, BT_8723B_1ANT_ANTDET_BUF_LEN, "%d.0%d", freq1,freq2); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", freq1, freq2)); -+ CL_SPRINTF(pPsdScan->nAntDet_PeakFreq, BT_8723B_1ANT_ANTDET_BUF_LEN, "%d.%d", freq1,freq2); -+ } -+ -+ if (PsdRep2 < 10) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, (", Value = %d.0%d dB\n", PsdRep1, PsdRep2)); -+ CL_SPRINTF(pPsdScan->nAntDet_PeakVal, BT_8723B_1ANT_ANTDET_BUF_LEN, "%d.0%d", PsdRep1,PsdRep2); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, (", Value = %d.%d dB\n",PsdRep1, PsdRep2)); -+ CL_SPRINTF(pPsdScan->nAntDet_PeakVal, BT_8723B_1ANT_ANTDET_BUF_LEN, "%d.%d", PsdRep1,PsdRep2); -+ } -+ -+ pPsdScan->nAntDet_IsBTReplyAvailable = TRUE; -+ -+ if (BTResp == FALSE) -+ { -+ pPsdScan->nAntDet_IsBTReplyAvailable = FALSE; -+ pPsdScan->nAntDet_Result = 0; -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pBoardInfo->btdmAntNumByAntDet = 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail \n ")); -+ } -+ else if (pPsdScan->nPSDMaxValue > (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION)*100) -+ { -+ pPsdScan->nAntDet_Result = 1; -+ pBoardInfo->btdmAntDetFinish = TRUE; -+ pBoardInfo->btdmAntNumByAntDet = 2; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!! \n")); -+ } -+ else if (pPsdScan->nPSDMaxValue > (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION+pPsdScan->nAntDet_ThresOffset)*100) -+ { -+ pPsdScan->nAntDet_Result = 2; -+ pBoardInfo->btdmAntDetFinish = TRUE; -+ pBoardInfo->btdmAntNumByAntDet = 2; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!! \n")); -+ } -+ else if (pPsdScan->nPSDMaxValue > (BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT)*100) -+ { -+ pPsdScan->nAntDet_Result = 3; -+ pBoardInfo->btdmAntDetFinish = TRUE; -+ pBoardInfo->btdmAntNumByAntDet = 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n")); -+ } -+ else -+ { -+ pPsdScan->nAntDet_Result = 4; -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pBoardInfo->btdmAntNumByAntDet = 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n")); -+ } -+ -+ state = 99; -+ break; -+ case 99: //restore setup -+ -+ //Set AFH mask off at WiFi channel 2472MHz +/- 10MHz -+ H2C_Parameter[0] = 0x0; -+ H2C_Parameter[1] = 0x0; -+ H2C_Parameter[2] = 0x0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", -+ H2C_Parameter[1],H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter); -+ -+ //Set Antenna Path -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!")); -+ -+ //Resume Coex DM -+ pBtCoexist->bStopCoexDm = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!")); -+ -+ //stimulate coex running -+ halbtc8723b1ant_RunCoexistMechanism(pBtCoexist); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!")); -+ -+ outloop = TRUE; -+ break; -+ } -+ -+ }while(!outloop); -+ -+ -+ -+ } -+ -+VOID -+halbtc8723b1ant_PSD_AntennaDetectionCheck( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static u4Byte AntDetCount = 0, AntDetFailCount = 0; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ -+ BOOLEAN bScan, bRoam; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ -+ pPsdScan->nAntDet_BTTxTime = 20; //0.42ms*50 = 20ms -+ pPsdScan->nAntDet_BTLEChannel = 39; -+ -+ AntDetCount++; -+ -+ pPsdScan->bAntDet_TryCount = AntDetCount; -+ -+ if (bScan ||bRoam) -+ { -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pPsdScan->nAntDet_Result = 6; -+ } -+ else if(pBtCoexist->btInfo.bBtDisabled) -+ { -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pPsdScan->nAntDet_Result = 11; -+ } -+ else if (pCoexSta->nNumOfProfile >= 1) -+ { -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pPsdScan->nAntDet_Result = 7; -+ } -+ else if (!pPsdScan->nAntDet_IsAntDetAvailable) //Antenna initial setup is not ready -+ { -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pPsdScan->nAntDet_Result = 9; -+ } -+ else if (pCoexSta->bC2hBtInquiryPage) -+ { -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pPsdScan->nAntDet_Result = 10; -+ } -+ else -+ { -+ halbtc8723b1ant_PSD_AntennaDetection(pBtCoexist, pPsdScan->nAntDet_BTTxTime, pPsdScan->nAntDet_BTLEChannel); -+ } -+ -+ if (!pBoardInfo->btdmAntDetFinish) -+ AntDetFailCount++; -+ -+ pPsdScan->bAntDet_FailCount = AntDetFailCount; -+ -+} -+ -+ -+//============================================================ -+// work around function start with wa_halbtc8723b1ant_ -+//============================================================ -+//============================================================ -+// extern function start with EXhalbtc8723b1ant_ -+//============================================================ -+VOID -+EXhalbtc8723b1ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u1Byte u1Tmp=0x0; -+ u2Byte u2Tmp=0x0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx Execute 8723b 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n")); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("Ant Det Finish = %s, Ant Det Number = %d\n", -+ (pBoardInfo->btdmAntDetFinish? "Yes":"No"), pBoardInfo->btdmAntNumByAntDet)); -+ -+ pBtCoexist->bStopCoexDm = TRUE; -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x67, 0x20); -+ -+ // enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. -+ u2Tmp = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x2); -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x2, u2Tmp|BIT0|BIT1); -+ -+ // set GRAN_BT = 1 -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ // set WLAN_ACT = 0 -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ // -+ // S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) -+ // Local setting bit define -+ // BIT0: "0" for no antenna inverse; "1" for antenna inverse -+ // BIT1: "0" for internal switch; "1" for external switch -+ // BIT2: "0" for one antenna; "1" for two antenna -+ // NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 -+ if(pBtCoexist->chipInterface == BTC_INTF_USB) -+ { -+ // fixed at S0 for USB interface -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ -+ u1Tmp |= 0x1; // antenna inverse -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0xfe08, u1Tmp); -+ -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ else -+ { -+ // for PCIE and SDIO interface, we check efuse 0xc3[6] -+ if(pBoardInfo->singleAntPath == 0) -+ { -+ // set to S1 -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280); -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+ } -+ else if(pBoardInfo->singleAntPath == 1) -+ { -+ // set to S0 -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ u1Tmp |= 0x1; // antenna inverse -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ -+ if(pBtCoexist->chipInterface == BTC_INTF_PCI) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x384, u1Tmp); -+ } -+ else if(pBtCoexist->chipInterface == BTC_INTF_SDIO) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x60, u1Tmp); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8723b1ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8723b1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ halbtc8723b1ant_InitHwConfig(pBtCoexist, TRUE, bWifiOnly); -+ pBtCoexist->bStopCoexDm = FALSE; -+} -+ -+VOID -+EXhalbtc8723b1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ pBtCoexist->bStopCoexDm = FALSE; -+ -+ halbtc8723b1ant_InitCoexDm(pBtCoexist); -+ -+ halbtc8723b1ant_QueryBtInfo(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8723b1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u2Byte u2Tmp[4]; -+ u4Byte u4Tmp[4]; -+ u4Byte faOfdm, faCck; -+ u4Byte fwVer=0, btPatchVer=0; -+ static u1Byte PopReportIn10s = 0; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ if(pBtCoexist->bStopCoexDm) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ -+ if (pPsdScan->bAntDet_TryCount == 0) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "Ant PG Num/ Mech/ Pos", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos); -+ CL_PRINTF(cliBuf); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d (%d/%d/%d)", "Ant PG Num/ Mech(Ant_Det)/ Pos", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNumByAntDet, pBoardInfo->btdmAntPos, -+ pPsdScan->bAntDet_TryCount, pPsdScan->bAntDet_FailCount, pPsdScan->nAntDet_Result); -+ CL_PRINTF(cliBuf); -+ -+ if (pBoardInfo->btdmAntDetFinish) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "Ant Det PSD Value", pPsdScan->nAntDet_PeakVal); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", "Version Coex/ Fw/ Patch/ Cut", \ -+ GLCoexVerDate8723b1Ant, GLCoexVer8723b1Ant, fwVer, btPatchVer, btPatchVer, pCoexSta->nCutVersion+65); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", "WifibHiPri/ Ccklock/ CckEverLock", \ -+ (pCoexSta->bWiFiIsHighPriTask? "Yes":"No"), -+ (pCoexSta->bCCKLock? "Yes":"No"), -+ (pCoexSta->bCCKEverLock? "Yes":"No")); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ PopReportIn10s++; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", "BT [status/ rssi/ retryCnt/ popCnt]", \ -+ ((pBtCoexist->btInfo.bBtDisabled)? ("disabled"): ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)? "non-connected idle": -+ ( (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy")))), -+ pCoexSta->btRssi, pCoexSta->btRetryCnt, pCoexSta->popEventCnt); -+ CL_PRINTF(cliBuf); -+ -+ if (PopReportIn10s >= 5) -+ { -+ pCoexSta->popEventCnt = 0; -+ PopReportIn10s = 0; -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d / %d / %d", "SCO/HID/PAN/A2DP/NameReq/WHQL", \ -+ pBtLinkInfo->bScoExist, pBtLinkInfo->bHidExist, pBtLinkInfo->bPanExist, pBtLinkInfo->bA2dpExist, pCoexSta->bC2hBtRemoteNameReq, pCoexSta->bBtWhckTest ); -+ CL_PRINTF(cliBuf); -+ -+ if (pStackInfo->bProfileNotified) -+ { -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Role", \ -+ (pBtLinkInfo->bSlaveRole )? "Slave":"Master"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d", "A2DP Rate/Bitpool", \ -+ (btInfoExt&BIT0)? "BR":"EDR", pCoexSta->nA2DPBitPool); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723b1Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism] (before Manual)============"); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ } -+ -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "SM[LowPenaltyRA]", \ -+ pCoexDm->bCurLowPenaltyRa); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %d ", "DelBA/ BtCtrlAgg/ AggSize", \ -+ (pBtCoexist->btInfo.bRejectAggPkt? "Yes":"No"), (pBtCoexist->btInfo.bBtCtrlAggBufSize? "Yes":"No"), -+ pBtCoexist->btInfo.aggBufSize); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Rate Mask", \ -+ pBtCoexist->btInfo.raMask); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism] (before Manual) ============"); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ } -+ -+ CL_PRINTF(cliBuf); -+ -+ psTdmaCase = pCoexDm->curPsTdma; -+ if (pBoardInfo->btdmAntNumByAntDet == 2) -+ { -+ if (pCoexDm->bCurPsTdmaOn) -+ psTdmaCase = psTdmaCase +100; //for WiFi RSSI low or BT RSSI low -+ else -+ psTdmaCase = 1; //always translate to TDMA(off,1) for TDMA-off case -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase, -+ (pCoexDm->bCurPsTdmaOn? "On":"Off"), -+ (pCoexDm->bAutoTdmaAdjust? "Adj":"Fix") ); -+ -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Coex Table Type", \ -+ pCoexSta->nCoexTableType); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "IgnWlanAct", \ -+ pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ -+ /* -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Latest error condition(should be 0)", \ -+ pCoexDm->errorCondition); -+ CL_PRINTF(cliBuf); -+ */ -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "backup ARFR1/ARFR2/RL/AMaxTime", \ -+ pCoexDm->backupArfrCnt1, pCoexDm->backupArfrCnt2, pCoexDm->backupRetryLimit, pCoexDm->backupAmpduMaxTime); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ u2Tmp[0] = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "0x430/0x434/0x42a/0x456", \ -+ u4Tmp[0], u4Tmp[1], u2Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/0x6cc/0x880[29:25]", \ -+ u1Tmp[0], u4Tmp[0], (u4Tmp[1]&0x3e000000) >> 25); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x764); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x948/ 0x67[5] / 0x764 / 0x76e", \ -+ u4Tmp[0], ((u1Tmp[0]&0x20)>> 5), (u4Tmp[1] & 0xffff), u1Tmp[1]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x92c); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x930); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x944); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", \ -+ u4Tmp[0]&0x3, u4Tmp[1]&0xff, u4Tmp[2]&0x3); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x39); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x64); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x38[11]/0x40/0x4c[24:23]/0x64[0]", \ -+ ((u1Tmp[0] & 0x8)>>3), u1Tmp[1], ((u4Tmp[0]&0x01800000)>>23), u1Tmp[2]&0x1); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49c); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0xc50(dig)/0x49c(null-drop)", \ -+ u4Tmp[0]&0xff, u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); -+ u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xcf0); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5b); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5c); -+ -+ faOfdm = ((u4Tmp[0]&0xffff0000) >> 16) + ((u4Tmp[1]&0xffff0000) >> 16) + (u4Tmp[1] & 0xffff) + (u4Tmp[2] & 0xffff) + \ -+ ((u4Tmp[3]&0xffff0000) >> 16) + (u4Tmp[3] & 0xffff) ; -+ faCck = (u1Tmp[0] << 8) + u1Tmp[1]; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "OFDM-CCA/OFDM-FA/CCK-FA", \ -+ u4Tmp[0]&0xffff, faOfdm, faCck); -+ CL_PRINTF(cliBuf); -+ -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_OK CCK/11g/11n/11n-Agg", \ -+ pCoexSta->nCRCOK_CCK, pCoexSta->nCRCOK_11g, pCoexSta->nCRCOK_11n, pCoexSta->nCRCOK_11nAgg); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_Err CCK/11g/11n/11n-Agg", \ -+ pCoexSta->nCRCErr_CCK, pCoexSta->nCRCErr_11g, pCoexSta->nCRCErr_11n, pCoexSta->nCRCErr_11nAgg); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770(high-pri rx/tx)", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(low-pri rx/tx)", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 1) -+ //halbtc8723b1ant_MonitorBtCtr(pBtCoexist); -+#endif -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8723b1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u4Byte u4Tmp=0; -+ -+ if(pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm) -+ return; -+ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ pCoexSta->bUnderIps = TRUE; -+ -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ //halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ -+ halbtc8723b1ant_InitHwConfig(pBtCoexist, FALSE, FALSE); -+ halbtc8723b1ant_InitCoexDm(pBtCoexist); -+ halbtc8723b1ant_QueryBtInfo(pBtCoexist); -+ -+ pCoexSta->bUnderIps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8723b1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm) -+ return; -+ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ pCoexSta->bUnderLps = TRUE; -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ pCoexSta->bUnderLps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8723b1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ -+ u1Byte u1Tmpa, u1Tmpb; -+ u4Byte u4Tmp; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm ) -+ return; -+ -+ if(BTC_SCAN_START == type) -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ pPsdScan->nAntDet_IsAntDetAvailable = TRUE; -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); //Force antenna setup for no scan result issue -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67); -+ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", -+ u4Tmp, u1Tmpa, u1Tmpb)); -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &pCoexSta->nScanAPNum); -+ } -+ -+ if(pBtCoexist->btInfo.bBtDisabled) -+ return; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ halbtc8723b1ant_QueryBtInfo(pBtCoexist); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8723b1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8723b1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if(BTC_SCAN_START == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8723b1ant_ActionWifiNotConnectedScan(pBtCoexist); -+ } -+ else // wifi is connected -+ { -+ halbtc8723b1ant_ActionWifiConnectedScan(pBtCoexist); -+ } -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else -+ { -+ halbtc8723b1ant_ActionWifiConnected(pBtCoexist); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8723b1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ pPsdScan->nAntDet_IsAntDetAvailable = TRUE; -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); //Force antenna setup for no scan result issue -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ pCoexDm->nArpCnt = 0; -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ //pCoexDm->nArpCnt = 0; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8723b1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8723b1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ halbtc8723b1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else -+ { -+ halbtc8723b1ant_ActionWifiConnected(pBtCoexist); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8723b1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ BOOLEAN bWifiUnderBMode = FALSE; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); //Force antenna setup for no scan result issue -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+ pPsdScan->nAntDet_IsAntDetAvailable = TRUE; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ -+ //Set CCK Tx/Rx high Pri except 11b mode -+ if (bWifiUnderBMode) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x00); //CCK Tx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x00); //CCK Rx -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x10); //CCK Tx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x10); //CCK Rx -+ } -+ -+ pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ pCoexDm->nArpCnt = 0; -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x0); //CCK Tx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x0); //CCK Rx -+ -+ pCoexSta->bCCKEverLock = FALSE; -+ } -+ -+ // only 2.4G we need to inform bt the chnl mask -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if( (BTC_MEDIA_CONNECT == type) && -+ (wifiCentralChnl <= 14) ) -+ { -+ //H2C_Parameter[0] = 0x1; -+ H2C_Parameter[0] = 0x0; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x66=0x%x\n", -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter); -+} -+ -+VOID -+EXhalbtc8723b1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE, bUnder4way=FALSE; -+ u1Byte aggBufSize=5; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if( BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ BTC_PACKET_ARP == type ) -+ { -+ if (BTC_PACKET_ARP == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet ARP notify\n")); -+ -+ pCoexDm->nArpCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ARP Packet Count = %d\n", pCoexDm->nArpCnt)); -+ -+ if((pCoexDm->nArpCnt >= 10) && (!bUnder4way)) // if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecialPacket(pBtCoexist) -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ } -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet DHCP or EAPOL notify\n")); -+ } -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet [Type = %d] notify\n", type)); -+ } -+ -+ pCoexSta->specialPktPeriodCnt = 0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8723b1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8723b1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if( BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ ( (BTC_PACKET_ARP == type ) && (pCoexSta->bWiFiIsHighPriTask) ) ) -+ { -+ halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8723b1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bWifiConnected=FALSE; -+ BOOLEAN bBtBusy=FALSE; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ -+ rspSource = tmpBuf[0]&0xf; -+ if(rspSource >= BT_INFO_SRC_8723B_1ANT_MAX) -+ rspSource = BT_INFO_SRC_8723B_1ANT_WIFI_FW; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 1) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ // if 0xff, it means BT is under WHCK test -+ if (btInfo == 0xff) -+ pCoexSta->bBtWhckTest = TRUE; -+ else -+ pCoexSta->bBtWhckTest = FALSE; -+ -+ if(BT_INFO_SRC_8723B_1ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = // [3:0] -+ pCoexSta->btInfoC2h[rspSource][2]&0xf; -+ -+ if (pCoexSta->btRetryCnt >= 1) -+ pCoexSta->popEventCnt++; -+ -+ if (pCoexSta->btInfoC2h[rspSource][2]&0x20) -+ pCoexSta->bC2hBtRemoteNameReq = TRUE; -+ else -+ pCoexSta->bC2hBtRemoteNameReq = FALSE; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][3]*2-90; -+ //pCoexSta->btInfoC2h[rspSource][3]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][4]; -+ -+ if (pCoexSta->btInfoC2h[rspSource][1] == 0x49) -+ { -+ pCoexSta->nA2DPBitPool = -+ pCoexSta->btInfoC2h[rspSource][6]; -+ } -+ else -+ pCoexSta->nA2DPBitPool = 0; -+ -+ pCoexSta->bBtTxRxMask = (pCoexSta->btInfoC2h[rspSource][2]&0x40); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TX_RX_MASK, &pCoexSta->bBtTxRxMask); -+ -+#if BT_8723B_1ANT_ANTDET_ENABLE -+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE -+ if ((pBoardInfo->btdmAntDetFinish) && (pBoardInfo->btdmAntNumByAntDet == 2)) -+ { -+ if(pCoexSta->bBtTxRxMask) -+ { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x1\n")); -+ -+ //BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1 -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x2c, 0x7c45); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x30, 0x7c45); -+ -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x1); -+ } -+ } -+ else -+#endif -+#endif -+ -+ { -+ if(!pCoexSta->bBtTxRxMask) -+ { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n")); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); -+ -+ //BT TRx Mask lock 0x2c[0], 0x30[0] = 0 -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x2c, 0x7c44); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x30, 0x7c44); -+ } -+ } -+ -+ // Here we need to resend some wifi info to BT -+ // because bt is reset and loss of the info. -+ if(pCoexSta->btInfoExt & BIT1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(bWifiConnected) -+ { -+ EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT); -+ } -+ else -+ { -+ EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ } -+ -+ if(pCoexSta->btInfoExt & BIT3) -+ { -+ if(!pBtCoexist->bManualControl && !pBtCoexist->bStopCoexDm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")); -+ halbtc8723b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ } -+ } -+ else -+ { -+ // BT already NOT ignore Wlan active, do nothing here. -+ } -+#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 0) -+ if( (pCoexSta->btInfoExt & BIT4) ) -+ { -+ // BT auto report already enabled, do nothing -+ } -+ else -+ { -+ halbtc8723b1ant_BtAutoReport(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+#endif -+ } -+ -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8723B_1ANT_B_INQ_PAGE) -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ else -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ -+ pCoexSta->nNumOfProfile = 0; -+ -+ // set link exist status -+ if(!(btInfo&BT_INFO_8723B_1ANT_B_CONNECTION)) -+ { -+ pCoexSta->bBtLinkExist = FALSE; -+ pCoexSta->bPanExist = FALSE; -+ pCoexSta->bA2dpExist = FALSE; -+ pCoexSta->bHidExist = FALSE; -+ pCoexSta->bScoExist = FALSE; -+ -+ pCoexSta->bBtHiPriLinkExist = FALSE; -+ } -+ else // connection exists -+ { -+ pCoexSta->bBtLinkExist = TRUE; -+ if(btInfo & BT_INFO_8723B_1ANT_B_FTP) -+ { -+ pCoexSta->bPanExist = TRUE; -+ pCoexSta->nNumOfProfile++; -+ } -+ else -+ pCoexSta->bPanExist = FALSE; -+ if(btInfo & BT_INFO_8723B_1ANT_B_A2DP) -+ { -+ pCoexSta->bA2dpExist = TRUE; -+ pCoexSta->nNumOfProfile++; -+ } -+ else -+ pCoexSta->bA2dpExist = FALSE; -+ if(btInfo & BT_INFO_8723B_1ANT_B_HID) -+ { -+ pCoexSta->bHidExist = TRUE; -+ pCoexSta->nNumOfProfile++; -+ } -+ else -+ pCoexSta->bHidExist = FALSE; -+ if(btInfo & BT_INFO_8723B_1ANT_B_SCO_ESCO) -+ { -+ pCoexSta->bScoExist = TRUE; -+ pCoexSta->nNumOfProfile++; -+ } -+ else -+ pCoexSta->bScoExist = FALSE; -+ -+ if ((pCoexSta->bHidExist == FALSE) && (pCoexSta->bC2hBtInquiryPage == FALSE) &&( pCoexSta->bScoExist == FALSE)) -+ { -+ if (pCoexSta->highPriorityTx + pCoexSta->highPriorityRx >= 160) -+ { -+ pCoexSta->bHidExist = TRUE; -+ pCoexSta->wrongProfileNotification++; -+ pCoexSta->nNumOfProfile++; -+ btInfo = btInfo | 0x28; -+ } -+ } -+ -+ //Add Hi-Pri Tx/Rx counter to avoid false detection -+ if (((pCoexSta->bHidExist) || (pCoexSta->bScoExist)) && (pCoexSta->highPriorityTx + pCoexSta->highPriorityRx >= 160) -+ && (!pCoexSta->bC2hBtInquiryPage)) -+ pCoexSta->bBtHiPriLinkExist = TRUE; -+ -+ if((btInfo&BT_INFO_8723B_1ANT_B_ACL_BUSY) && (pCoexSta->nNumOfProfile == 0)) -+ { -+ if (pCoexSta->lowPriorityTx + pCoexSta->lowPriorityRx >= 160) -+ { -+ pCoexSta->bPanExist = TRUE; -+ pCoexSta->nNumOfProfile++; -+ pCoexSta->wrongProfileNotification++; -+ btInfo = btInfo | 0x88; -+ } -+ } -+ } -+ -+ halbtc8723b1ant_UpdateBtLinkInfo(pBtCoexist); -+ -+ btInfo = btInfo & 0x1f; //mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) -+ -+ if(!(btInfo&BT_INFO_8723B_1ANT_B_CONNECTION)) -+ { -+ pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n")); -+ } -+ else if(btInfo == BT_INFO_8723B_1ANT_B_CONNECTION) // connection exists but no busy -+ { -+ pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n")); -+ } -+ else if((btInfo&BT_INFO_8723B_1ANT_B_SCO_ESCO) || -+ (btInfo&BT_INFO_8723B_1ANT_B_SCO_BUSY)) -+ { -+ pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_SCO_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n")); -+ } -+ else if(btInfo&BT_INFO_8723B_1ANT_B_ACL_BUSY) -+ { -+ if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY != pCoexDm->btStatus) -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_ACL_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n")); -+ } -+ else -+ { -+ pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_MAX; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n")); -+ } -+ -+ if( (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ bBtBusy = TRUE; -+ else -+ bBtBusy = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ halbtc8723b1ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8723b1ant_RfStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u4Byte u4Tmp; -+ u1Byte u1Tmpa,u1Tmpb, u1Tmpc; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF Status notify\n")); -+ -+ if(BTC_RF_ON == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF is turned ON!!\n")); -+ pBtCoexist->bStopCoexDm = FALSE; -+ } -+ else if(BTC_RF_OFF == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF is turned OFF!!\n")); -+ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE); -+ //halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); -+ -+ halbtc8723b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ pBtCoexist->bStopCoexDm = TRUE; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67); -+ u1Tmpc = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e); -+ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x, 0x76e=0x%x\n", -+ u4Tmp, u1Tmpa, u1Tmpb, u1Tmpc)); -+ -+ } -+} -+ -+VOID -+EXhalbtc8723b1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE); -+ //halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); -+ -+ halbtc8723b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ -+ EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ -+ pBtCoexist->bStopCoexDm = TRUE; -+} -+ -+VOID -+EXhalbtc8723b1ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify\n")); -+ -+ if(BTC_WIFI_PNP_SLEEP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to SLEEP\n")); -+ -+ halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE); -+ halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ //halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); -+ -+ pBtCoexist->bStopCoexDm = TRUE; -+ } -+ else if(BTC_WIFI_PNP_WAKE_UP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to WAKE UP\n")); -+ pBtCoexist->bStopCoexDm = FALSE; -+ halbtc8723b1ant_InitHwConfig(pBtCoexist, FALSE, FALSE); -+ halbtc8723b1ant_InitCoexDm(pBtCoexist); -+ halbtc8723b1ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8723b1ant_CoexDmReset( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], *****************Coex DM Reset*****************\n")); -+ -+ halbtc8723b1ant_InitHwConfig(pBtCoexist, FALSE, FALSE); -+ //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x2, 0xfffff, 0x0); -+ halbtc8723b1ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8723b1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static u1Byte disVerInfoCnt=0; -+ u4Byte fwVer=0, btPatchVer=0; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ==========================Periodical===========================\n")); -+ -+ if(disVerInfoCnt <= 5) -+ { -+ disVerInfoCnt += 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ant PG Num/ Ant Mech/ Ant Pos = %d/ %d/ %d\n", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT stack/ hci ext ver = %s / %d\n", -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion)); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", -+ GLCoexVerDate8723b1Ant, GLCoexVer8723b1Ant, fwVer, btPatchVer, btPatchVer)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ } -+ -+#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 0) -+ halbtc8723b1ant_QueryBtInfo(pBtCoexist); -+ halbtc8723b1ant_MonitorBtEnableDisable(pBtCoexist); -+#else -+ halbtc8723b1ant_MonitorBtCtr(pBtCoexist); -+ halbtc8723b1ant_MonitorWiFiCtr(pBtCoexist); -+#if BT_8723B_1ANT_ANTDET_ENABLE -+ halbtc8723b1ant_MonitorBtEnableDisable(pBtCoexist); -+#endif -+ -+ if ( (pCoexSta->highPriorityTx + pCoexSta->highPriorityRx < 50) && (pBtLinkInfo->bHidExist == TRUE)) -+ { -+ pBtLinkInfo->bHidExist = FALSE; -+ } -+ -+ if( halbtc8723b1ant_IsWifiStatusChanged(pBtCoexist) || -+ pCoexDm->bAutoTdmaAdjust ) -+ { -+ halbtc8723b1ant_RunCoexistMechanism(pBtCoexist); -+ } -+ -+ pCoexSta->specialPktPeriodCnt++; -+ -+ // sample to set bt to execute Ant detection -+ //pBtCoexist->fBtcSetBtAntDetection(pBtCoexist, 20, 14); -+/* -+ if (pPsdScan->bIsAntDetEnable) -+ { -+ if (pPsdScan->nPSDGenCount > pPsdScan->realseconds) -+ pPsdScan->nPSDGenCount = 0; -+ -+ halbtc8723b1ant_AntennaDetection(pBtCoexist, pPsdScan->realcentFreq, pPsdScan->realoffset, pPsdScan->realspan, pPsdScan->realseconds); -+ pPsdScan->nPSDGenTotalCount +=2; -+ pPsdScan->nPSDGenCount += 2; -+ } -+*/ -+#endif -+} -+ -+VOID -+EXhalbtc8723b1ant_AntennaDetection( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ) -+{ -+ static u4Byte AntDetCount = 0, AntDetFailCount = 0; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ BOOLEAN bScan, bRoam; -+ -+#if BT_8723B_1ANT_ANTDET_ENABLE -+ -+ if (seconds == 0) -+ { -+ pPsdScan->bAntDet_TryCount = 0; -+ pPsdScan->bAntDet_FailCount = 0; -+ AntDetCount = 0; -+ AntDetFailCount = 0; -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pBoardInfo->btdmAntNumByAntDet = 1; -+ return; -+ } -+ -+ if (!pBoardInfo->btdmAntDetFinish) -+ { -+ pPsdScan->nAntDet_IntevalCount = pPsdScan->nAntDet_IntevalCount+2; -+ -+ if (pPsdScan->nAntDet_IntevalCount >= BT_8723B_1ANT_ANTDET_RETRY_INTERVAL) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n")); -+ halbtc8723b1ant_PSD_AntennaDetectionCheck(pBtCoexist); -+ -+ if (pBoardInfo->btdmAntDetFinish) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n")); -+#if 1 -+ if (pBoardInfo->btdmAntNumByAntDet == 2) -+ halbtc8723b1ant_MechanismSwitch(pBtCoexist, TRUE); -+ else -+ halbtc8723b1ant_MechanismSwitch(pBtCoexist, FALSE); -+#endif -+ } -+ else -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n")); -+ -+ pPsdScan->nAntDet_IntevalCount = 0; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", pPsdScan->nAntDet_IntevalCount)); -+ } -+ -+ } -+#endif -+ -+ -+/* -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ -+ pPsdScan->nAntDet_BTTxTime = seconds; //0.42ms*50 = 20ms -+ pPsdScan->nAntDet_BTLEChannel = centFreq; -+ -+ if (seconds == 0) -+ { -+ pPsdScan->bAntDet_TryCount = 0; -+ pPsdScan->bAntDet_FailCount = 0; -+ AntDetCount = 0; -+ AntDetFailCount = 0; -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pBoardInfo->btdmAntNumByAntDet = 1; -+ return; -+ } -+ else -+ { -+ AntDetCount++; -+ -+ pPsdScan->bAntDet_TryCount = AntDetCount; -+ -+ if (bScan ||bRoam) -+ { -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pPsdScan->nAntDet_Result = 6; -+ } -+ else if (pCoexSta->nNumOfProfile >= 1) -+ { -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pPsdScan->nAntDet_Result = 7; -+ } -+ else if (!pPsdScan->nAntDet_IsAntDetAvailable) //Antenna initial setup is not ready -+ { -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pPsdScan->nAntDet_Result = 9; -+ } -+ else if (pCoexSta->bC2hBtInquiryPage) -+ { -+ pBoardInfo->btdmAntDetFinish = FALSE; -+ pPsdScan->nAntDet_Result = 10; -+ } -+ else -+ { -+ //halbtc8723b1ant_PSD_AntennaDetection(pBtCoexist, pPsdScan->nAntDet_BTTxTime, pPsdScan->nAntDet_BTLEChannel); -+ } -+ -+ if (!pBoardInfo->btdmAntDetFinish) -+ AntDetFailCount++; -+ -+ pPsdScan->bAntDet_FailCount = AntDetFailCount; -+ } -+*/ -+} -+ -+VOID -+EXhalbtc8723b1ant_AntennaIsolation( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ) -+{ -+ -+ -+} -+ -+VOID -+EXhalbtc8723b1ant_PSDScan( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ) -+{ -+ -+ -+} -+ -+VOID -+EXhalbtc8723b1ant_DisplayAntDetection( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ -+#if BT_8723B_1ANT_ANTDET_ENABLE -+ if (pPsdScan->bAntDet_TryCount != 0) -+ { -+ halbtc8723b1ant_PSD_ShowAntennaDetectResult(pBtCoexist); -+ -+ if (pBoardInfo->btdmAntDetFinish) -+ halbtc8723b1ant_PSD_ShowData(pBtCoexist); -+ return; -+ } -+#endif -+ -+ //halbtc8723b1ant_ShowPSDData(pBtCoexist); -+} -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723b1Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8723b1Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723b1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8723b1Ant.h 2017-06-07 23:07:21.010687485 +0300 -@@ -0,0 +1,337 @@ -+//=========================================== -+// The following is for 8723B 1ANT BT Co-exist definition -+//=========================================== -+#define BT_AUTO_REPORT_ONLY_8723B_1ANT 1 -+ -+#define BT_INFO_8723B_1ANT_B_FTP BIT7 -+#define BT_INFO_8723B_1ANT_B_A2DP BIT6 -+#define BT_INFO_8723B_1ANT_B_HID BIT5 -+#define BT_INFO_8723B_1ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8723B_1ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8723B_1ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8723B_1ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8723B_1ANT_B_CONNECTION BIT0 -+ -+#define BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT0))? TRUE:FALSE) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT 2 -+ -+#define BT_8723B_1ANT_WIFI_NOISY_THRESH 50 //30 //max: 255 -+ -+//for Antenna detection -+#define BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 -+#define BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -+#define BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 -+#define BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT 35 -+#define BT_8723B_1ANT_ANTDET_RETRY_INTERVAL 10 //retry timer if ant det is fail, unit: second -+#define BT_8723B_1ANT_ANTDET_ENABLE 0 -+#define BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 -+ -+typedef enum _BT_INFO_SRC_8723B_1ANT{ -+ BT_INFO_SRC_8723B_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8723B_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8723B_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8723B_1ANT_MAX -+}BT_INFO_SRC_8723B_1ANT,*PBT_INFO_SRC_8723B_1ANT; -+ -+typedef enum _BT_8723B_1ANT_BT_STATUS{ -+ BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8723B_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8723B_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8723B_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8723B_1ANT_BT_STATUS_MAX -+}BT_8723B_1ANT_BT_STATUS,*PBT_8723B_1ANT_BT_STATUS; -+ -+typedef enum _BT_8723B_1ANT_WIFI_STATUS{ -+ BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT = 0x3, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8723B_1ANT_WIFI_STATUS_MAX -+}BT_8723B_1ANT_WIFI_STATUS,*PBT_8723B_1ANT_WIFI_STATUS; -+ -+typedef enum _BT_8723B_1ANT_COEX_ALGO{ -+ BT_8723B_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8723B_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8723B_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8723B_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8723B_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8723B_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8723B_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8723B_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8723B_1ANT_COEX_ALGO_MAX = 0xb, -+}BT_8723B_1ANT_COEX_ALGO,*PBT_8723B_1ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8723B_1ANT{ -+ // hw setting -+ u1Byte preAntPosType; -+ u1Byte curAntPosType; -+ // fw mechanism -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ BOOLEAN bAutoTdmaAdjust; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ BOOLEAN bPreBtAutoReport; -+ BOOLEAN bCurBtAutoReport; -+ u1Byte preLps; -+ u1Byte curLps; -+ u1Byte preRpwm; -+ u1Byte curRpwm; -+ -+ // sw mechanism -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ -+ u4Byte backupArfrCnt1; // Auto Rate Fallback Retry cnt -+ u4Byte backupArfrCnt2; // Auto Rate Fallback Retry cnt -+ u2Byte backupRetryLimit; -+ u1Byte backupAmpduMaxTime; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+ -+ u4Byte preRaMask; -+ u4Byte curRaMask; -+ u1Byte preArfrType; -+ u1Byte curArfrType; -+ u1Byte preRetryLimitType; -+ u1Byte curRetryLimitType; -+ u1Byte preAmpduTimeType; -+ u1Byte curAmpduTimeType; -+ u4Byte nArpCnt; -+ -+ u1Byte errorCondition; -+} COEX_DM_8723B_1ANT, *PCOEX_DM_8723B_1ANT; -+ -+typedef struct _COEX_STA_8723B_1ANT{ -+ BOOLEAN bBtLinkExist; -+ BOOLEAN bScoExist; -+ BOOLEAN bA2dpExist; -+ BOOLEAN bHidExist; -+ BOOLEAN bPanExist; -+ BOOLEAN bBtHiPriLinkExist; -+ u1Byte nNumOfProfile; -+ -+ BOOLEAN bUnderLps; -+ BOOLEAN bUnderIps; -+ u4Byte specialPktPeriodCnt; -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ s1Byte btRssi; -+ BOOLEAN bBtTxRxMask; -+ u1Byte preBtRssiState; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8723B_1ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8723B_1ANT_MAX]; -+ BOOLEAN bBtWhckTest; -+ BOOLEAN bC2hBtInquiryPage; -+ BOOLEAN bC2hBtRemoteNameReq; -+ BOOLEAN bWiFiIsHighPriTask; //Add for win8.1 page out issue -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+ u4Byte popEventCnt; -+ u1Byte nScanAPNum; -+ -+ u4Byte nCRCOK_CCK; -+ u4Byte nCRCOK_11g; -+ u4Byte nCRCOK_11n; -+ u4Byte nCRCOK_11nAgg; -+ -+ u4Byte nCRCErr_CCK; -+ u4Byte nCRCErr_11g; -+ u4Byte nCRCErr_11n; -+ u4Byte nCRCErr_11nAgg; -+ -+ BOOLEAN bCCKLock; -+ BOOLEAN bPreCCKLock; -+ BOOLEAN bCCKEverLock; -+ u1Byte nCoexTableType; -+ -+ BOOLEAN bForceLpsOn; -+ u4Byte wrongProfileNotification; -+ -+ u1Byte nA2DPBitPool; -+ u1Byte nCutVersion; -+}COEX_STA_8723B_1ANT, *PCOEX_STA_8723B_1ANT; -+ -+#define BT_8723B_1ANT_ANTDET_PSD_POINTS 256 //MAX:1024 -+#define BT_8723B_1ANT_ANTDET_PSD_AVGNUM 1 //MAX:3 -+#define BT_8723B_1ANT_ANTDET_BUF_LEN 16 -+ -+typedef struct _PSDSCAN_STA_8723B_1ANT{ -+ -+u4Byte nAntDet_BTLEChannel; //BT LE Channel ex:2412 -+u4Byte nAntDet_BTTxTime; -+u4Byte nAntDet_PrePSDScanPeakVal; -+BOOLEAN nAntDet_IsAntDetAvailable; -+u4Byte nAntDet_PSDScanPeakVal; -+BOOLEAN nAntDet_IsBTReplyAvailable; -+u4Byte nAntDet_PSDScanPeakFreq; -+ -+u1Byte nAntDet_Result; -+u1Byte nAntDet_PeakVal[BT_8723B_1ANT_ANTDET_BUF_LEN]; -+u1Byte nAntDet_PeakFreq[BT_8723B_1ANT_ANTDET_BUF_LEN]; -+u4Byte bAntDet_TryCount; -+u4Byte bAntDet_FailCount; -+u4Byte nAntDet_IntevalCount; -+u4Byte nAntDet_ThresOffset; -+ -+u4Byte nRealCentFreq; -+s4Byte nRealOffset; -+u4Byte nRealSpan; -+ -+u4Byte nPSDBandWidth; //unit: Hz -+u4Byte nPSDPoint; //128/256/512/1024 -+u4Byte nPSDReport[1024]; //unit:dB (20logx), 0~255 -+u4Byte nPSDReport_MaxHold[1024]; //unit:dB (20logx), 0~255 -+u4Byte nPSDStartPoint; -+u4Byte nPSDStopPoint; -+u4Byte nPSDMaxValuePoint; -+u4Byte nPSDMaxValue; -+u4Byte nPSDStartBase; -+u4Byte nPSDAvgNum; // 1/8/16/32 -+u4Byte nPSDGenCount; -+BOOLEAN bIsPSDRunning; -+BOOLEAN bIsPSDShowMaxOnly; -+} PSDSCAN_STA_8723B_1ANT, *PPSDSCAN_STA_8723B_1ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8723b1ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723b1ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723b1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8723b1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723b1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723b1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723b1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723b1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723b1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723b1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723b1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8723b1ant_RfStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723b1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723b1ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ); -+VOID -+EXhalbtc8723b1ant_CoexDmReset( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723b1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723b1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723b1ant_AntennaDetection( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ); -+VOID -+EXhalbtc8723b1ant_AntennaIsolation( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ); -+ -+VOID -+EXhalbtc8723b1ant_PSDScan( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ); -+VOID -+EXhalbtc8723b1ant_DisplayAntDetection( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723b2Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8723b2Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723b2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8723b2Ant.c 2017-06-07 23:07:21.010687485 +0300 -@@ -0,0 +1,4933 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8723B Co-exist mechanism -+// -+// History -+// 2012/11/15 Cosa first check in. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8723b2Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8723B_2ANT GLCoexDm8723b2Ant; -+static PCOEX_DM_8723B_2ANT pCoexDm=&GLCoexDm8723b2Ant; -+static COEX_STA_8723B_2ANT GLCoexSta8723b2Ant; -+static PCOEX_STA_8723B_2ANT pCoexSta=&GLCoexSta8723b2Ant; -+ -+const char *const GLBtInfoSrc8723b2Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u4Byte GLCoexVerDate8723b2Ant=20150119; -+u4Byte GLCoexVer8723b2Ant=0x44; -+ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8723b2ant_ -+//============================================================ -+u1Byte -+halbtc8723b2ant_BtRssiState( -+ u1Byte levelNum, -+ u1Byte rssiThresh, -+ u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte btRssi=0; -+ u1Byte btRssiState=pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh1) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+u1Byte -+halbtc8723b2ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+VOID -+halbtc8723b2ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ -+ bPreBtDisabled = bBtDisabled; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ if(bBtDisabled) -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ } -+ } -+} -+ -+ -+VOID -+halbtc8723b2ant_LimitedRx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRejApAggPkt, -+ IN BOOLEAN bBtCtrlAggBufSize, -+ IN u1Byte aggBufSize -+ ) -+{ -+ BOOLEAN bRejectRxAgg=bRejApAggPkt; -+ BOOLEAN bBtCtrlRxAggSize=bBtCtrlAggBufSize; -+ u1Byte rxAggSize=aggBufSize; -+ -+ //============================================ -+ // Rx Aggregation related setting -+ //============================================ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg); -+ // decide BT control aggregation buf size or not -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize); -+ // aggregation buf size, only work when BT control Rx aggregation size. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize); -+ // real update aggregation setting -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+} -+ -+VOID -+halbtc8723b2ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp; -+ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ if( (pCoexSta->lowPriorityTx > 1050) && (!pCoexSta->bC2hBtInquiryPage)) -+ pCoexSta->popEventCnt++; -+ -+ if ( (pCoexSta->lowPriorityRx >= 950) && (pCoexSta->lowPriorityRx >= pCoexSta->lowPriorityTx) && (!pCoexSta->bUnderIps) ) -+ { -+ pBtLinkInfo->bSlaveRole = TRUE; -+ } -+ else -+ { -+ pBtLinkInfo->bSlaveRole = FALSE; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+} -+ -+VOID -+halbtc8723b2ant_MonitorWiFiCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ u2Byte u2Tmp[3]; -+ s4Byte wifiRssi=0; -+ BOOLEAN bWifiBusy = FALSE, bWifiUnderBMode = FALSE; -+ static u1Byte nCCKLockCounter = 0; -+ -+ -+ if (pCoexSta->bUnderIps) -+ { -+ pCoexSta->nCRCOK_CCK = 0; -+ pCoexSta->nCRCOK_11g = 0; -+ pCoexSta->nCRCOK_11n = 0; -+ pCoexSta->nCRCOK_11nAgg = 0; -+ -+ pCoexSta->nCRCErr_CCK = 0; -+ pCoexSta->nCRCErr_11g = 0; -+ pCoexSta->nCRCErr_11n = 0; -+ pCoexSta->nCRCErr_11nAgg = 0; -+ } -+ else -+ { -+ pCoexSta->nCRCOK_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf88); -+ pCoexSta->nCRCOK_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf94); -+ pCoexSta->nCRCOK_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf90); -+ pCoexSta->nCRCOK_11nAgg= pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfb8); -+ -+ pCoexSta->nCRCErr_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf84); -+ pCoexSta->nCRCErr_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf96); -+ pCoexSta->nCRCErr_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf92); -+ pCoexSta->nCRCErr_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfba); -+ } -+ -+ //reset counter -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x1); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x0); -+} -+ -+VOID -+halbtc8723b2ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = TRUE; -+ -+ H2C_Parameter[0] |= BIT0; // trigger -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x61=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter); -+} -+ -+BOOLEAN -+halbtc8723b2ant_IsWifiStatusChanged( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreWifiBusy=FALSE, bPreUnder4way=FALSE, bPreBtHsOn=FALSE; -+ BOOLEAN bWifiBusy=FALSE, bUnder4way=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bWifiConnected=FALSE; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ -+ if(bWifiConnected) -+ { -+ if(bWifiBusy != bPreWifiBusy) -+ { -+ bPreWifiBusy = bWifiBusy; -+ return TRUE; -+ } -+ if(bUnder4way != bPreUnder4way) -+ { -+ bPreUnder4way = bUnder4way; -+ return TRUE; -+ } -+ if(bBtHsOn != bPreBtHsOn) -+ { -+ bPreBtHsOn = bBtHsOn; -+ return TRUE; -+ } -+ -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist,3, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ -+ if ( (BTC_RSSI_STATE_HIGH ==wifiRssiState ) || (BTC_RSSI_STATE_LOW ==wifiRssiState )) -+ { -+ return TRUE; -+ } -+ -+ } -+ -+ return FALSE; -+} -+ -+VOID -+halbtc8723b2ant_UpdateBtLinkInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ -+#if(BT_AUTO_REPORT_ONLY_8723B_2ANT == 1) // profile from bt patch -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pCoexSta->bScoExist; -+ pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist; -+ pBtLinkInfo->bPanExist = pCoexSta->bPanExist; -+ pBtLinkInfo->bHidExist = pCoexSta->bHidExist; -+ -+ // work around for HS mode. -+ if(bBtHsOn) -+ { -+ pBtLinkInfo->bPanExist = TRUE; -+ pBtLinkInfo->bBtLinkExist = TRUE; -+ } -+#else // profile from bt stack -+ pBtLinkInfo->bBtLinkExist = pStackInfo->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pStackInfo->bScoExist; -+ pBtLinkInfo->bA2dpExist = pStackInfo->bA2dpExist; -+ pBtLinkInfo->bPanExist = pStackInfo->bPanExist; -+ pBtLinkInfo->bHidExist = pStackInfo->bHidExist; -+ -+ //for win-8 stack HID report error -+ if(!pStackInfo->bHidExist) -+ pStackInfo->bHidExist = pCoexSta->bHidExist; //sync BTInfo with BT firmware and stack -+ // when stack HID report error, here we use the info from bt fw. -+ if(!pStackInfo->bBtLinkExist) -+ pStackInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+#endif -+ // check if Sco only -+ if( pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bScoOnly = TRUE; -+ else -+ pBtLinkInfo->bScoOnly = FALSE; -+ -+ // check if A2dp only -+ if( !pBtLinkInfo->bScoExist && -+ pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bA2dpOnly = TRUE; -+ else -+ pBtLinkInfo->bA2dpOnly = FALSE; -+ -+ // check if Pan only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bPanOnly = TRUE; -+ else -+ pBtLinkInfo->bPanOnly = FALSE; -+ -+ // check if Hid only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bHidOnly = TRUE; -+ else -+ pBtLinkInfo->bHidOnly = FALSE; -+} -+ -+u1Byte -+halbtc8723b2ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ u1Byte algorithm=BT_8723B_2ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!pBtLinkInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No BT link exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pBtLinkInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(numOfDiffProfile == 1) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO only\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_A2DP; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(HS) only\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(EDR) only\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 2) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(HS)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(EDR)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+#if 0 -+ if(pStackInfo->numOfHid >= 2) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID*2 + A2DP\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ else -+#endif -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(HS)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_HID; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(EDR)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(HS)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(EDR)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP ==> HID\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(HS)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(EDR)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile >= 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+VOID -+halbtc8723b2ant_SetFwDacSwingLevel( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte dacSwingLvl -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ // There are several type of dacswing -+ // 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 -+ H2C_Parameter[0] = dacSwingLvl; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Set Dac Swing Level=0x%x\n", dacSwingLvl)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x64=0x%x\n", H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x64, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723b2ant_SetFwDecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte decBtPwrLvl -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = decBtPwrLvl; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], decrease Bt Power level = %d, FW write 0x62=0x%x\n", -+ decBtPwrLvl, H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x62, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723b2ant_DecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte decBtPwrLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s Dec BT power level = %d\n", -+ (bForceExec? "force to":""), decBtPwrLvl)); -+ pCoexDm->curBtDecPwrLvl = decBtPwrLvl; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->preBtDecPwrLvl == pCoexDm->curBtDecPwrLvl) -+ return; -+ } -+ halbtc8723b2ant_SetFwDecBtPwr(pBtCoexist, pCoexDm->curBtDecPwrLvl); -+ -+ pCoexDm->preBtDecPwrLvl = pCoexDm->curBtDecPwrLvl; -+} -+ -+VOID -+halbtc8723b2ant_SetBtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = 0; -+ -+ if(bEnableAutoReport) -+ { -+ H2C_Parameter[0] |= BIT0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], BT FW auto report : %s, FW write 0x68=0x%x\n", -+ (bEnableAutoReport? "Enabled!!":"Disabled!!"), H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x68, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723b2ant_BtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s BT Auto report = %s\n", -+ (bForceExec? "force to":""), ((bEnableAutoReport)? "Enabled":"Disabled"))); -+ pCoexDm->bCurBtAutoReport = bEnableAutoReport; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreBtAutoReport == pCoexDm->bCurBtAutoReport) -+ return; -+ } -+ halbtc8723b2ant_SetBtAutoReport(pBtCoexist, pCoexDm->bCurBtAutoReport); -+ -+ pCoexDm->bPreBtAutoReport = pCoexDm->bCurBtAutoReport; -+} -+ -+VOID -+halbtc8723b2ant_FwDacSwingLvl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte fwDacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set FW Dac Swing level = %d\n", -+ (bForceExec? "force to":""), fwDacSwingLvl)); -+ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->preFwDacSwingLvl == pCoexDm->curFwDacSwingLvl) -+ return; -+ } -+ -+ halbtc8723b2ant_SetFwDacSwingLevel(pBtCoexist, pCoexDm->curFwDacSwingLvl); -+ -+ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -+} -+ -+VOID -+halbtc8723b2ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xffffc); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+VOID -+halbtc8723b2ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8723b2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8723b2ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte H2C_Parameter[6] ={0}; -+ -+ H2C_Parameter[0] = 0x6; // opCode, 0x6= Retry_Penalty -+ -+ if(bLowPenaltyRa) -+ { -+ H2C_Parameter[1] |= BIT0; -+ H2C_Parameter[2] = 0x00; //normal rate except MCS7/6/5, OFDM54/48/36 -+ H2C_Parameter[3] = 0xf7; //MCS7 or OFDM54 -+ H2C_Parameter[4] = 0xf8; //MCS6 or OFDM48 -+ H2C_Parameter[5] = 0xf9; //MCS5 or OFDM36 -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set WiFi Low-Penalty Retry: %s", -+ (bLowPenaltyRa? "ON!!":"OFF!!")) ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter); -+} -+ -+VOID -+halbtc8723b2ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ //return; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8723b2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8723b2ant_SetDacSwingReg( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte level -+ ) -+{ -+ u1Byte val=(u1Byte)level; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Write SwDacSwing = 0x%x\n", level)); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x883, 0x3e, val); -+} -+ -+VOID -+halbtc8723b2ant_SetSwFullTimeDacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSwDacSwingOn, -+ IN u4Byte swDacSwingLvl -+ ) -+{ -+ if(bSwDacSwingOn) -+ { -+ halbtc8723b2ant_SetDacSwingReg(pBtCoexist, swDacSwingLvl); -+ } -+ else -+ { -+ halbtc8723b2ant_SetDacSwingReg(pBtCoexist, 0x18); -+ } -+} -+ -+ -+VOID -+halbtc8723b2ant_DacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacSwingOn, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", -+ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); -+ pCoexDm->bCurDacSwingOn = bDacSwingOn; -+ pCoexDm->curDacSwingLvl = dacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && -+ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) -+ return; -+ } -+ delay_ms(30); -+ halbtc8723b2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); -+ -+ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; -+ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -+} -+ -+VOID -+halbtc8723b2ant_SetAdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ if(bAdcBackOff) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xc05, 0x30, 0x3); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xc05, 0x30, 0x1); -+ } -+} -+ -+VOID -+halbtc8723b2ant_AdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", -+ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); -+ pCoexDm->bCurAdcBackOff = bAdcBackOff; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) -+ return; -+ } -+ halbtc8723b2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); -+ -+ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -+} -+ -+VOID -+halbtc8723b2ant_SetAgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ u1Byte rssiAdjustVal=0; -+ -+ //=================BB AGC Gain Table -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB Agc Table On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6e1A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6d1B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6c1C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6b1D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6a1E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x691F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x68200001); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB Agc Table Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xaa1A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa91B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa81C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa71D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa61E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa51F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa4200001); -+ } -+ -+ -+ //=================RF Gain -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x38fff); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x38ffe); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x380c3); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x28ce6); -+ } -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xed, 0xfffff, 0x1); -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x38fff); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x38ffe); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x380c3); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x28ce6); -+ } -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xed, 0xfffff, 0x0); -+ -+ // set rssiAdjustVal for wifi module. -+ if(bAgcTableEn) -+ { -+ rssiAdjustVal = 8; -+ } -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -+} -+ -+VOID -+halbtc8723b2ant_AgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", -+ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); -+ pCoexDm->bCurAgcTableEn = bAgcTableEn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) -+ return; -+ } -+ halbtc8723b2ant_SetAgcTable(pBtCoexist, bAgcTableEn); -+ -+ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -+} -+ -+VOID -+halbtc8723b2ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8723b2ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c4, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8723b2ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8723b2ant_CoexTableWithType( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexSta->nCoexTableType = type; -+ -+ switch(type) -+ { -+ case 0: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x55555555, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5afa5afa, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x5ada5ada, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0xffffffff, 0xffffffff, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0x5fff5fff, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55ff55ff, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 7: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 8: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 9: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 10: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 11: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 12: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 13: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 14: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 15: -+ halbtc8723b2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8723b2ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(bEnable) -+ { -+ H2C_Parameter[0] |= BIT0; // function enable -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723b2ant_SetLpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ u1Byte lps=lpsVal; -+ u1Byte rpwm=rpwmVal; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+VOID -+halbtc8723b2ant_LpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bForceExecPwrCmd=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set lps/rpwm=0x%x/0x%x \n", -+ (bForceExec? "force to":""), lpsVal, rpwmVal)); -+ pCoexDm->curLps = lpsVal; -+ pCoexDm->curRpwm = rpwmVal; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preLps == pCoexDm->curLps) && -+ (pCoexDm->preRpwm == pCoexDm->curRpwm) ) -+ { -+ return; -+ } -+ } -+ halbtc8723b2ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal); -+ -+ pCoexDm->preLps = pCoexDm->curLps; -+ pCoexDm->preRpwm = pCoexDm->curRpwm; -+} -+ -+VOID -+halbtc8723b2ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8723b2ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8723b2ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ -+ -+ if ( (pCoexSta->bA2dpExist) && (pCoexSta->bHidExist) ) -+ { -+ byte5 = byte5 | 0x1; -+ } -+ -+ H2C_Parameter[0] = byte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = byte5; -+ -+ pCoexDm->psTdmaPara[0] = byte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = byte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x60(5bytes)=0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter); -+} -+ -+VOID -+halbtc8723b2ant_SwMechanism1( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bShrinkRxLPF, -+ IN BOOLEAN bLowPenaltyRA, -+ IN BOOLEAN bLimitedDIG, -+ IN BOOLEAN bBTLNAConstrain -+ ) -+{ -+ /* -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if(BTC_WIFI_BW_HT40 != wifiBw) //only shrink RF Rx LPF for HT40 -+ { -+ if (bShrinkRxLPF) -+ bShrinkRxLPF = FALSE; -+ } -+ */ -+ -+ //halbtc8723b2ant_RfShrink(pBtCoexist, NORMAL_EXEC, bShrinkRxLPF); -+ halbtc8723b2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA); -+} -+ -+VOID -+halbtc8723b2ant_SwMechanism2( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAGCTableShift, -+ IN BOOLEAN bADCBackOff, -+ IN BOOLEAN bSWDACSwing, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ //halbtc8723b2ant_AgcTable(pBtCoexist, NORMAL_EXEC, bAGCTableShift); -+ //halbtc8723b2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, bADCBackOff); -+ //halbtc8723b2ant_DacSwing(pBtCoexist, NORMAL_EXEC, bSWDACSwing, dacSwingLvl); -+} -+ -+VOID -+halbtc8723b2ant_SetAntPath( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte antPosType, -+ IN BOOLEAN bInitHwCfg, -+ IN BOOLEAN bWifiOff -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte fwVer=0, u4Tmp=0; -+ BOOLEAN bPgExtSwitch=FALSE; -+ BOOLEAN bUseExtSwitch=FALSE; -+ u1Byte H2C_Parameter[2] ={0}; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_EXT_SWITCH, &bPgExtSwitch); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); // [31:16]=fw ver, [15:0]=fw sub ver -+ -+ if((fwVer>0 && fwVer<0xc0000) || bPgExtSwitch) -+ bUseExtSwitch = TRUE; -+ -+ if(bInitHwCfg) -+ { -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x39, 0x8, 0x1); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x974, 0xff); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x944, 0x3, 0x3); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x930, 0x77); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); -+ -+ if(fwVer >= 0x180000) -+ { -+ /* Use H2C to set GNT_BT to High to avoid A2DP click */ -+ H2C_Parameter[0] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ } -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); //WiFi TRx Mask off -+ //remove due to interrupt is disabled that polling c2h will fail and delay 100ms. -+ //pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x01); //BT TRx Mask off -+ -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ { -+ //tell firmware "no antenna inverse" -+ H2C_Parameter[0] = 0; -+ } -+ else -+ { -+ //tell firmware "antenna inverse" -+ H2C_Parameter[0] = 1; -+ } -+ -+ if (bUseExtSwitch) -+ { -+ //ext switch type -+ H2C_Parameter[1] = 1; -+ } -+ else -+ { -+ //int switch type -+ H2C_Parameter[1] = 0; -+ } -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } -+ else -+ { -+ if(fwVer >= 0x180000) -+ { -+ /* Use H2C to set GNT_BT to "Control by PTA"*/ -+ H2C_Parameter[0] = 0; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x0); -+ } -+ } -+ -+ // ext switch setting -+ if(bUseExtSwitch) -+ { -+ if (bInitHwCfg) -+ { -+ // 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp &=~BIT23; -+ u4Tmp |= BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ } -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); // fixed internal switch S1->WiFi, S0->BT -+ switch(antPosType) -+ { -+ case BTC_ANT_WIFI_AT_MAIN: -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1); // ext switch main at wifi -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2); // ext switch aux at wifi -+ break; -+ } -+ } -+ else // internal switch -+ { -+ if (bInitHwCfg) -+ { -+ // 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp |= BIT23; -+ u4Tmp &=~BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ } -+ -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x64, 0x1, 0x0); //fixed external switch S1->Main, S0->Aux -+ switch(antPosType) -+ { -+ case BTC_ANT_WIFI_AT_MAIN: -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); // fixed internal switch S1->WiFi, S0->BT -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280); // fixed internal switch S0->WiFi, S1->BT -+ break; -+ } -+ } -+} -+ -+VOID -+halbtc8723b2ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bTurnOnByCnt=FALSE; -+ u1Byte psTdmaTypeByCnt=0; -+ u1Byte wifiRssiState1, btRssiState; -+ s1Byte nWiFiDurationAdjust = 0x0; -+ u1Byte psTdmaByte4Modify = 0x0; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ -+ wifiRssiState1 = halbtc8723b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", -+ (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ if (!(BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) && bTurnOn) -+ { -+ type = type +100; //for WiFi RSSI low or BT RSSI low -+ pCoexDm->bIsSwitchTo1dot5Ant = TRUE; -+ } -+ else -+ { -+ pCoexDm->bIsSwitchTo1dot5Ant = FALSE; -+ } -+ -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ -+ if (pCoexSta->nScanAPNum <= 5) -+ { -+ if (pCoexSta->nA2DPBitPool >= 45) -+ nWiFiDurationAdjust = -15; -+ else if (pCoexSta->nA2DPBitPool >= 35) -+ nWiFiDurationAdjust = -10; -+ else -+ nWiFiDurationAdjust = 5; -+ } -+ else if (pCoexSta->nScanAPNum <= 20) -+ { -+ if (pCoexSta->nA2DPBitPool >= 45) -+ nWiFiDurationAdjust = -15; -+ else if (pCoexSta->nA2DPBitPool >= 35) -+ nWiFiDurationAdjust = -10; -+ else -+ nWiFiDurationAdjust = 0; -+ } -+ else if (pCoexSta->nScanAPNum <= 40) -+ { -+ if (pCoexSta->nA2DPBitPool >= 45) -+ nWiFiDurationAdjust = -15; -+ else if (pCoexSta->nA2DPBitPool >= 35) -+ nWiFiDurationAdjust = -10; -+ else -+ nWiFiDurationAdjust = -5; -+ } -+ else -+ { -+ if (pCoexSta->nA2DPBitPool >= 45) -+ nWiFiDurationAdjust = -15; -+ else if (pCoexSta->nA2DPBitPool >= 35) -+ nWiFiDurationAdjust = -10; -+ else -+ nWiFiDurationAdjust = -10; -+ } -+ -+ if ( (pBtLinkInfo->bSlaveRole == TRUE) && (pBtLinkInfo->bA2dpExist) ) -+ psTdmaByte4Modify = 0x1; //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) -+ -+ -+ if(bTurnOn) -+ { -+ switch(type) -+ { -+ case 1: -+ default: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c+nWiFiDurationAdjust, 0x03, 0xf1, 0x90|psTdmaByte4Modify); -+ break; -+ case 2: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x2d+nWiFiDurationAdjust, 0x03, 0xf1, 0x90|psTdmaByte4Modify); -+ break; -+ case 3: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0xf1, 0x90|psTdmaByte4Modify); -+ break; -+ case 4: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x10, 0x03, 0xf1, 0x90|psTdmaByte4Modify); -+ break; -+ case 5: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c+nWiFiDurationAdjust, 0x3, 0x70, 0x90|psTdmaByte4Modify); -+ break; -+ case 6: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x2d+nWiFiDurationAdjust, 0x3, 0x70, 0x90|psTdmaByte4Modify); -+ break; -+ case 7: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0x70, 0x90|psTdmaByte4Modify); -+ break; -+ case 8: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x10, 0x3, 0x70, 0x90|psTdmaByte4Modify); -+ break; -+ case 9: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c+nWiFiDurationAdjust, 0x03, 0xf1, 0x90|psTdmaByte4Modify); -+ break; -+ case 10: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x2d+nWiFiDurationAdjust, 0x03, 0xf1, 0x90|psTdmaByte4Modify); -+ break; -+ case 11: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0xf1, 0x90|psTdmaByte4Modify); -+ break; -+ case 12: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x10, 0x3, 0xf1, 0x90|psTdmaByte4Modify); -+ break; -+ case 13: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c+nWiFiDurationAdjust, 0x3, 0x70, 0x90|psTdmaByte4Modify); -+ break; -+ case 14: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x2d+nWiFiDurationAdjust, 0x3, 0x70, 0x90|psTdmaByte4Modify); -+ break; -+ case 15: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0x70, 0x90|psTdmaByte4Modify); -+ break; -+ case 16: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x10, 0x3, 0x70, 0x90|psTdmaByte4Modify); -+ break; -+ case 17: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x2f, 0x2f, 0x60, 0x90); -+ break; -+ case 18: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 19: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0xe1, 0x90); -+ break; -+ case 20: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0x60, 0x90); -+ break; -+ case 21: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x03, 0x70, 0x90); -+ break; -+ case 71: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c+nWiFiDurationAdjust, 0x03, 0xf1, 0x90); -+ break; -+ case 101: -+ case 105: -+ case 171: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x3a+nWiFiDurationAdjust, 0x03, 0x70, 0x50|psTdmaByte4Modify); -+ break; -+ case 102: -+ case 106: -+ case 110: -+ case 114: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x2d+nWiFiDurationAdjust, 0x03, 0x70, 0x50|psTdmaByte4Modify); -+ break; -+ case 103: -+ case 107: -+ case 111: -+ case 115: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x1c, 0x03, 0x70, 0x50|psTdmaByte4Modify); -+ break; -+ case 104: -+ case 108: -+ case 112: -+ case 116: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x10, 0x03, 0x70, 0x50|psTdmaByte4Modify); -+ break; -+ case 109: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0xf1, 0x90|psTdmaByte4Modify); -+ break; -+ case 113: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0x70, 0x90|psTdmaByte4Modify); -+ break; -+ case 121: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x03, 0x70, 0x90|psTdmaByte4Modify); -+ break; -+ case 22: -+ case 122: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x35, 0x03, 0x71, 0x11); -+ break; -+ } -+ } -+ else -+ { -+ // disable PS tdma -+ switch(type) -+ { -+ case 0: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x40, 0x0); -+ break; -+ case 1: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x48, 0x0); -+ break; -+ default: -+ halbtc8723b2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x40, 0x0); -+ break; -+ } -+ } -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+VOID -+halbtc8723b2ant_PsTdmaCheckForPowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bNewPsState -+ ) -+{ -+ u1Byte lpsMode=0x0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode); -+ -+ if(lpsMode) // already under LPS state -+ { -+ if(bNewPsState) -+ { -+ // keep state under LPS, do nothing. -+ } -+ else -+ { -+ // will leave LPS state, turn off psTdma first -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ } -+ else // NO PS state -+ { -+ if(bNewPsState) -+ { -+ // will enter LPS state, turn off psTdma first -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ else -+ { -+ // keep state under NO PS state, do nothing. -+ } -+ } -+} -+ -+VOID -+halbtc8723b2ant_PowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte psType, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bLowPwrDisable=FALSE; -+ -+ switch(psType) -+ { -+ case BTC_PS_WIFI_NATIVE: -+ // recover to original 32k low power setting -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8723b2ant_PsTdmaCheckForPowerSaveState(pBtCoexist, TRUE); -+ halbtc8723b2ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal); -+ // when coex force to enter LPS, do not enter 32k low power. -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ // power save must executed before psTdma. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); -+ pCoexSta->bForceLpsOn = TRUE; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8723b2ant_PsTdmaCheckForPowerSaveState(pBtCoexist, FALSE); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+VOID -+halbtc8723b2ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw all off -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ // hw all off -+ //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8723b2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 6); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, FORCE_EXEC, 0); -+ -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ pCoexSta->popEventCnt = 0; -+ -+} -+ -+VOID -+halbtc8723b2ant_ActionBtInquiry( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ BOOLEAN bWifiConnected=FALSE; -+ BOOLEAN bLowPwrDisable=TRUE; -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8723b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ if(bScan || bLink || bRoam) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi link process + BT Inq/Page!!\n")); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 15); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ } -+ else if(bWifiConnected) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT Inq/Page!!\n")); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 15); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi no-link + BT Inq/Page!!\n")); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 6); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+/* -+ pCoexDm->bNeedRecover0x948 = TRUE; -+ pCoexDm->backup0x948 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ -+ halbtc8723b2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_AUX, FALSE, FALSE); -+*/ -+} -+ -+ -+VOID -+halbtc8723b2ant_ActionWiFiLinkProcess( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ u1Byte u1Tmpa, u1Tmpb; -+ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 15); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x76e=0x%x\n", -+ u4Tmp, u1Tmpa, u1Tmpb)); -+} -+ -+BOOLEAN -+halbtc8723b2ant_ActionWifiIdleProcess( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ u1Byte apNum=0; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ //wifiRssiState1 = halbtc8723b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ wifiRssiState1 = halbtc8723b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES-20, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ -+ // define the office environment -+ if(BTC_RSSI_HIGH(wifiRssiState1) && -+ (pCoexSta->bHidExist == TRUE) && (pCoexSta->bA2dpExist == TRUE)) -+ { -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle process for BT HID+A2DP exist!!\n")); -+ -+ halbtc8723b2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x6); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ -+ return TRUE; -+ } -+ else -+ { -+ halbtc8723b2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ return FALSE; -+ } -+ -+ -+} -+ -+ -+ -+BOOLEAN -+halbtc8723b2ant_IsCommonAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte btRssiState=BTC_RSSI_STATE_HIGH; -+ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE, bWifiBusy=FALSE; -+ BOOLEAN bBtHsOn=FALSE, bLowPwrDisable=FALSE; -+ BOOLEAN bAsus8723b=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if(!bWifiConnected) -+ { -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-connected idle!!\n")); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ if(BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT non connected-idle!!\n")); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0xb); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else if(BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ if(bBtHsOn) -+ return FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT connected-idle!!\n")); -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0xb); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ if(bWifiBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_IS_ASUS_8723B, &bAsus8723b); -+ if(!bAsus8723b) -+ bCommon = FALSE; -+ else -+ bCommon = halbtc8723b2ant_ActionWifiIdleProcess(pBtCoexist); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n")); -+ //bCommon = FALSE; -+ bCommon = halbtc8723b2ant_ActionWifiIdleProcess(pBtCoexist); -+ } -+ } -+ } -+ -+ return bCommon; -+} -+VOID -+halbtc8723b2ant_TdmaDurationAdjust( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bScoHid, -+ IN BOOLEAN bTxPause, -+ IN u1Byte maxInterval -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjust()\n")); -+ -+ if(!pCoexDm->bAutoTdmaAdjust) -+ { -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ { -+ if(bScoHid) -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ else -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ } -+ } -+ } -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ -+ if ( (pCoexSta->lowPriorityTx) > 1050 || (pCoexSta->lowPriorityRx) > 1250 ) -+ retryCount++; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], retryCount = %d\n", retryCount)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], up=%d, dn=%d, m=%d, n=%d, WaitCount=%d\n", -+ up, dn, m, n, WaitCount)); -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], max Interval = %d\n", maxInterval)); -+ if(maxInterval == 1) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ -+ if(pCoexDm->curPsTdma == 71) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 71); -+ pCoexDm->psTdmaDuAdjType = 71; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 71) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 71); -+ pCoexDm->psTdmaDuAdjType = 71; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 2) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 3) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ } -+ } -+ -+ // if current PsTdma not match with the recorded one (when scan, dhcp...), -+ // then we have to adjust it back to the previous record one. -+ if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) -+ { -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", -+ pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if( !bScan && !bLink && !bRoam) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); -+ } -+ } -+} -+ -+// SCO only or SCO+PAN(HS) -+VOID -+halbtc8723b2ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 4); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) //for SCO quality at 11b/g mode -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+ else //for SCO quality & wifi performance balance at 11n mode -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); //for voice quality -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x4); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x4); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x4); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x4); -+ } -+ } -+} -+ -+ -+VOID -+halbtc8723b2ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) //for HID at 11b/g mode -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else //for HID quality & wifi performance balance at 11n mode -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 9); -+ } -+ -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ } -+ else -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -+VOID -+halbtc8723b2ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ u1Byte apNum=0; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8723b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ -+ // define the office environment -+ if( (apNum >= 10) && BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ //DbgPrint(" AP#>10(%d)\n", apNum); -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x18); -+ } -+ return; -+ -+ } -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 13); -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); -+ } -+ else -+ { -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); -+ } -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8723b2ant_ActionA2dpPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8723b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 13); -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 2); -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8723b2ant_ActionPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState,wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8723b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 10); -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 13); -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ } -+ else -+ { -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ } -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+ -+//PAN(HS) only -+VOID -+halbtc8723b2ant_ActionPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8723b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+//PAN(EDR)+A2DP -+VOID -+halbtc8723b2ant_ActionPanEdrA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8723b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 12); -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ else -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); -+ } -+ else -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 13); -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8723b2ant_ActionPanEdrHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8723b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 14); -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 3); -+ //halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 11); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); -+ } -+ else -+ { -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ //halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ } -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 2); -+ } -+ else -+ { -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ //halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 14); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+// HID+A2DP+PAN(EDR) -+VOID -+halbtc8723b2ant_ActionHidA2dpPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState,wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8723b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(2, BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 14); -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ else -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); -+ } -+ else -+ { -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8723b2ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ u1Byte apNum=0; -+ -+ wifiRssiState = halbtc8723b2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ //btRssiState = halbtc8723b2ant_BtRssiState(2, 29, 0); -+ wifiRssiState1 = halbtc8723b2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8723b2ant_BtRssiState(3, BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES, 37); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x5); -+ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_LEGACY == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else -+ { // only 802.11N mode we have to dec bt power to 4 degree -+ if(BTC_RSSI_HIGH(btRssiState)) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ // need to check ap Number of Not -+ if(apNum < 10) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ } -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 14); -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); -+ } -+ else -+ { -+ halbtc8723b2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8723b2ant_ActionBtWhckTest( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8723b2ant_ActionWifiMultiPort( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723b2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8723b2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8723b2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8723b2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ // hw all off -+ //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+} -+ -+VOID -+halbtc8723b2ant_RunCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiUnder5G=FALSE, bBtHsOn=FALSE; -+ u1Byte btInfoOriginal=0, btRetryCnt=0; -+ u1Byte algorithm=0; -+ u4Byte numOfWifiLink=0; -+ u4Byte wifiLinkStatus=0; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bMiracastPlusBt=FALSE; -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism()===>\n")); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n")); -+ return; -+ } -+ -+ if(pCoexSta->bUnderIps) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under IPS !!!\n")); -+ return; -+ } -+ -+ if(pCoexSta->bBtWhckTest) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is under WHCK TEST!!!\n")); -+ halbtc8723b2ant_ActionBtWhckTest(pBtCoexist); -+ return; -+ } -+ -+ algorithm = halbtc8723b2ant_ActionAlgorithm(pBtCoexist); -+ if(pCoexSta->bC2hBtInquiryPage && (BT_8723B_2ANT_COEX_ALGO_PANHS!=algorithm)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is under inquiry/page scan !!\n")); -+ halbtc8723b2ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else -+ { -+ /* -+ if(pCoexDm->bNeedRecover0x948) -+ { -+ pCoexDm->bNeedRecover0x948 = FALSE; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, pCoexDm->backup0x948); -+ } -+ */ -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if(bScan || bLink || bRoam) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], WiFi is under Link Process !!\n")); -+ halbtc8723b2ant_ActionWiFiLinkProcess(pBtCoexist); -+ return; -+ } -+ -+ //for P2P -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ -+ if((numOfWifiLink>=2) || (wifiLinkStatus&WIFI_P2P_GO_CONNECTED)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], Multi-Port numOfWifiLink = %d, wifiLinkStatus = 0x%x\n", numOfWifiLink,wifiLinkStatus) ); -+ -+ if(pBtLinkInfo->bBtLinkExist) -+ { -+ bMiracastPlusBt = TRUE; -+ } -+ else -+ { -+ bMiracastPlusBt = FALSE; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ halbtc8723b2ant_ActionWifiMultiPort(pBtCoexist); -+ -+ return; -+ } -+ else -+ { -+ bMiracastPlusBt = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ } -+ -+ pCoexDm->curAlgorithm = algorithm; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Algorithm = %d \n", pCoexDm->curAlgorithm)); -+ -+ if(halbtc8723b2ant_IsCommonAction(pBtCoexist)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant common.\n")); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else -+ { -+ if(pCoexDm->curAlgorithm != pCoexDm->preAlgorithm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], preAlgorithm=%d, curAlgorithm=%d\n", -+ pCoexDm->preAlgorithm, pCoexDm->curAlgorithm)); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8723B_2ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO.\n")); -+ halbtc8723b2ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID.\n")); -+ halbtc8723b2ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP.\n")); -+ halbtc8723b2ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n")); -+ halbtc8723b2ant_ActionA2dpPanHs(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n")); -+ halbtc8723b2ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HS mode.\n")); -+ halbtc8723b2ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n")); -+ halbtc8723b2ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_PANEDR_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n")); -+ halbtc8723b2ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n")); -+ halbtc8723b2ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n")); -+ halbtc8723b2ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n")); -+ halbtc8723b2ant_CoexAllOff(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+} -+ -+VOID -+halbtc8723b2ant_WifiOffHwCfg( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bIsInMpMode = FALSE; -+ u1Byte H2C_Parameter[2] ={0}; -+ u4Byte fwVer=0; -+ -+ // set wlan_act to low -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); //WiFi goto standby while GNT_BT 0-->1 -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ if(fwVer >= 0x180000) -+ { -+ /* Use H2C to set GNT_BT to HIGH */ -+ H2C_Parameter[0] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, &bIsInMpMode); -+ if(!bIsInMpMode) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x0); //BT select s0/s1 is controlled by BT -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); //BT select s0/s1 is controlled by WiFi -+} -+ -+VOID -+halbtc8723b2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bBackUp -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte u4Tmp=0, fwVer; -+ u2Byte u2Tmp=0; -+ u1Byte u1Tmp=0; -+ u1Byte H2C_Parameter[2] ={0}; -+ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); -+ -+ //0xf0[15:12] --> Chip Cut information -+ pCoexSta->nCutVersion = (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xf1) & 0xf0) >> 4; -+ -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ // 0x790[5:0]=0x5 -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x790); -+ u1Tmp &= 0xc0; -+ u1Tmp |= 0x5; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, u1Tmp); -+ -+ //Antenna config -+ halbtc8723b2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_MAIN, TRUE, FALSE); -+ pCoexSta->disVerInfoCnt = 0; -+ -+ // PTA parameter -+ halbtc8723b2ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ // Enable counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); //0x76e[3] =1, WLAN_Act control by PTA -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x3); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0x20, 0x1); -+} -+ -+//============================================================ -+// work around function start with wa_halbtc8723b2ant_ -+//============================================================ -+//============================================================ -+// extern function start with EXhalbtc8723b2ant_ -+//============================================================ -+VOID -+EXhalbtc8723b2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u2Byte u2Tmp=0x0; -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x67, 0x20); -+ -+ // enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. -+ u2Tmp = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x2); -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x2, u2Tmp|BIT0|BIT1); -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); -+ -+ if(pBtCoexist->chipInterface == BTC_INTF_USB) -+ { -+ // fixed at S0 for USB interface -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ else -+ { -+ // for PCIE and SDIO interface, we check efuse 0xc3[6] -+ if(pBoardInfo->singleAntPath == 0) -+ { -+ // set to S1 -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+ } -+ else if(pBoardInfo->singleAntPath == 1) -+ { -+ // set to S0 -+ pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ } -+} -+ -+VOID -+EXhalbtc8723b2ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u1Byte u1Tmp=0x4; /* Set BIT2 by default since it's 2ant case */ -+ -+ // -+ // S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) -+ // Local setting bit define -+ // BIT0: "0" for no antenna inverse; "1" for antenna inverse -+ // BIT1: "0" for internal switch; "1" for external switch -+ // BIT2: "0" for one antenna; "1" for two antenna -+ // NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 -+ if(pBtCoexist->chipInterface == BTC_INTF_USB) -+ { -+ // fixed at S0 for USB interface -+ u1Tmp |= 0x1; // antenna inverse -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0xfe08, u1Tmp); -+ } -+ else -+ { -+ // for PCIE and SDIO interface, we check efuse 0xc3[6] -+ if(pBoardInfo->singleAntPath == 0) -+ { -+ } -+ else if(pBoardInfo->singleAntPath == 1) -+ { -+ // set to S0 -+ u1Tmp |= 0x1; // antenna inverse -+ } -+ -+ if(pBtCoexist->chipInterface == BTC_INTF_PCI) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x384, u1Tmp); -+ } -+ else if(pBtCoexist->chipInterface == BTC_INTF_SDIO) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x60, u1Tmp); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8723b2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ halbtc8723b2ant_InitHwConfig(pBtCoexist, TRUE); -+} -+ -+VOID -+EXhalbtc8723b2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8723b2ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8723b2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ u4Byte faOfdm, faCck; -+ u4Byte fwVer=0, btPatchVer=0; -+ static u1Byte PopReportIn10s = 0; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", "Version Coex/ Fw/ Patch/ Cut", \ -+ GLCoexVerDate8723b2Ant, GLCoexVer8723b2Ant, fwVer, btPatchVer, btPatchVer, pCoexSta->nCutVersion+65); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ PopReportIn10s++; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", "BT [status/ rssi/ retryCnt/ popCnt]", \ -+ ((pBtCoexist->btInfo.bBtDisabled)? ("disabled"): ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)? "non-connected idle": -+ ( (BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy")))), -+ pCoexSta->btRssi-100, pCoexSta->btRetryCnt, pCoexSta->popEventCnt); -+ CL_PRINTF(cliBuf); -+ -+ if (PopReportIn10s >= 5) -+ { -+ pCoexSta->popEventCnt = 0; -+ PopReportIn10s = 0; -+ } -+ -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d / %d / %d", "SCO/HID/PAN/A2DP/NameReq/WHQL", \ -+ pBtLinkInfo->bScoExist, pBtLinkInfo->bHidExist, pBtLinkInfo->bPanExist, pBtLinkInfo->bA2dpExist, pCoexSta->bC2hBtRemoteNameReq, pCoexSta->bBtWhckTest ); -+ CL_PRINTF(cliBuf); -+ -+ if (pStackInfo->bProfileNotified) -+ { -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Role", \ -+ (pBtLinkInfo->bSlaveRole )? "Slave":"Master"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "A2DP Rate/Bitpool", \ -+ (btInfoExt&BIT0)? "BR":"EDR", pCoexSta->nA2DPBitPool); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723b2Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ // Sw mechanism -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism] (before Manual)============"); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", "SM1[ShRf/ LpRA/ LimDig]", \ -+ pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ -+ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism] (before Manual) ============"); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ } -+ -+ psTdmaCase = pCoexDm->curPsTdma; -+ -+ if (pCoexDm->bIsSwitchTo1dot5Ant) -+ psTdmaCase = psTdmaCase + 100; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase, -+ (pCoexDm->bCurPsTdmaOn? "On":"Off"), -+ (pCoexDm->bAutoTdmaAdjust? "Adj":"Fix") ); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Coex Table Type", \ -+ pCoexSta->nCoexTableType); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "DecBtPwr/ IgnWlanAct", \ -+ pCoexDm->curBtDecPwrLvl, pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x778/0x880[29:25]", \ -+ u1Tmp[0], (u4Tmp[0]&0x3e000000) >> 25); -+ CL_PRINTF(cliBuf); -+ -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x948/ 0x67[5] / 0x765", \ -+ u4Tmp[0], ((u1Tmp[0]&0x20)>> 5), u1Tmp[1]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x92c); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x930); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x944); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", \ -+ u4Tmp[0]&0x3, u4Tmp[1]&0xff, u4Tmp[2]&0x3); -+ CL_PRINTF(cliBuf); -+ -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x39); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x64); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x38[11]/0x40/0x4c[24:23]/0x64[0]", \ -+ ((u1Tmp[0] & 0x8)>>3), u1Tmp[1], ((u4Tmp[0]&0x01800000)>>23), u1Tmp[2]&0x1); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49c); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0xc50(dig)/0x49c(null-drop)", \ -+ u4Tmp[0]&0xff, u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); -+ u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xcf0); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5b); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5c); -+ -+ faOfdm = ((u4Tmp[0]&0xffff0000) >> 16) + ((u4Tmp[1]&0xffff0000) >> 16) + (u4Tmp[1] & 0xffff) + (u4Tmp[2] & 0xffff) + \ -+ ((u4Tmp[3]&0xffff0000) >> 16) + (u4Tmp[3] & 0xffff) ; -+ faCck = (u1Tmp[0] << 8) + u1Tmp[1]; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "OFDM-CCA/OFDM-FA/CCK-FA", \ -+ u4Tmp[0]&0xffff, faOfdm, faCck); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_OK CCK/11g/11n/11n-Agg", \ -+ pCoexSta->nCRCOK_CCK, pCoexSta->nCRCOK_11g, pCoexSta->nCRCOK_11n, pCoexSta->nCRCOK_11nAgg); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_Err CCK/11g/11n/11n-Agg", \ -+ pCoexSta->nCRCErr_CCK, pCoexSta->nCRCErr_11g, pCoexSta->nCRCErr_11n, pCoexSta->nCRCErr_11nAgg); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770(high-pri rx/tx)", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(low-pri rx/tx)", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+#if(BT_AUTO_REPORT_ONLY_8723B_2ANT == 1) -+ //halbtc8723b2ant_MonitorBtCtr(pBtCoexist); -+#endif -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8723b2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ pCoexSta->bUnderIps = TRUE; -+ halbtc8723b2ant_WifiOffHwCfg(pBtCoexist); -+ halbtc8723b2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ halbtc8723b2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ pCoexSta->bUnderIps = FALSE; -+ halbtc8723b2ant_InitHwConfig(pBtCoexist, FALSE); -+ halbtc8723b2ant_InitCoexDm(pBtCoexist); -+ halbtc8723b2ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8723b2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ pCoexSta->bUnderLps = TRUE; -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ pCoexSta->bUnderLps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8723b2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u4Byte u4Tmp; -+ u1Byte u1Tmpa, u1Tmpb; -+ -+ -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948); -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e); -+ -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &pCoexSta->nScanAPNum); -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x76e=0x%x\n", -+ u4Tmp, u1Tmpa, u1Tmpb)); -+} -+ -+VOID -+EXhalbtc8723b2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8723b2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ u1Byte apNum=0; -+ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+ -+ // only 2.4G we need to inform bt the chnl mask -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if( (BTC_MEDIA_CONNECT == type) && -+ (wifiCentralChnl <= 14) ) -+ { -+ H2C_Parameter[0] = 0x1; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ if(apNum < 10) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x66=0x%x\n", -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter); -+} -+ -+VOID -+EXhalbtc8723b2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8723b2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bBtBusy=FALSE, bLimitedDig=FALSE; -+ BOOLEAN bWifiConnected=FALSE; -+ static BOOLEAN bPreScoExist=FALSE; -+ u4Byte raMask=0x0; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ -+ rspSource = tmpBuf[0]&0xf; -+ if(rspSource >= BT_INFO_SRC_8723B_2ANT_MAX) -+ rspSource = BT_INFO_SRC_8723B_2ANT_WIFI_FW; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 1) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), return for Manual CTRL<===\n")); -+ return; -+ } -+ -+ // if 0xff, it means BT is under WHCK test -+ if (btInfo == 0xff) -+ pCoexSta->bBtWhckTest = TRUE; -+ else -+ pCoexSta->bBtWhckTest = FALSE; -+ -+ if(BT_INFO_SRC_8723B_2ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = // [3:0] -+ pCoexSta->btInfoC2h[rspSource][2]&0xf; -+ -+ if (pCoexSta->btRetryCnt >= 1) -+ pCoexSta->popEventCnt++; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][3]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][4]; -+ -+ if (pCoexSta->btInfoC2h[rspSource][2]&0x20) -+ pCoexSta->bC2hBtRemoteNameReq = TRUE; -+ else -+ pCoexSta->bC2hBtRemoteNameReq = FALSE; -+ -+ if (pCoexSta->btInfoC2h[rspSource][1] == 0x49) -+ { -+ pCoexSta->nA2DPBitPool = -+ pCoexSta->btInfoC2h[rspSource][6]; -+ } -+ else -+ pCoexSta->nA2DPBitPool = 0; -+ -+ pCoexSta->bBtTxRxMask = (pCoexSta->btInfoC2h[rspSource][2]&0x40); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TX_RX_MASK, &pCoexSta->bBtTxRxMask); -+ if (pCoexSta->bBtTxRxMask) -+ { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x01 => Need to switch BT TRx Mask */ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x01\n")); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x01); -+ } -+ -+ // Here we need to resend some wifi info to BT -+ // because bt is reset and loss of the info. -+ if( (pCoexSta->btInfoExt & BIT1) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(bWifiConnected) -+ { -+ EXhalbtc8723b2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT); -+ } -+ else -+ { -+ EXhalbtc8723b2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ } -+ -+ if( (pCoexSta->btInfoExt & BIT3) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")); -+ halbtc8723b2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ } -+ else -+ { -+ // BT already NOT ignore Wlan active, do nothing here. -+ } -+#if(BT_AUTO_REPORT_ONLY_8723B_2ANT == 0) -+ if( (pCoexSta->btInfoExt & BIT4) ) -+ { -+ // BT auto report already enabled, do nothing -+ } -+ else -+ { -+ halbtc8723b2ant_BtAutoReport(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+#endif -+ } -+ -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8723B_2ANT_B_INQ_PAGE) -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ else -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ -+ // set link exist status -+ if(!(btInfo&BT_INFO_8723B_2ANT_B_CONNECTION)) -+ { -+ pCoexSta->bBtLinkExist = FALSE; -+ pCoexSta->bPanExist = FALSE; -+ pCoexSta->bA2dpExist = FALSE; -+ pCoexSta->bHidExist = FALSE; -+ pCoexSta->bScoExist = FALSE; -+ } -+ else // connection exists -+ { -+ pCoexSta->bBtLinkExist = TRUE; -+ if(btInfo & BT_INFO_8723B_2ANT_B_FTP) -+ pCoexSta->bPanExist = TRUE; -+ else -+ pCoexSta->bPanExist = FALSE; -+ if(btInfo & BT_INFO_8723B_2ANT_B_A2DP) -+ pCoexSta->bA2dpExist = TRUE; -+ else -+ pCoexSta->bA2dpExist = FALSE; -+ if(btInfo & BT_INFO_8723B_2ANT_B_HID) -+ pCoexSta->bHidExist = TRUE; -+ else -+ pCoexSta->bHidExist = FALSE; -+ if(btInfo & BT_INFO_8723B_2ANT_B_SCO_ESCO) -+ pCoexSta->bScoExist = TRUE; -+ else -+ pCoexSta->bScoExist = FALSE; -+ -+ if ( (pCoexSta->bHidExist == FALSE) && (pCoexSta->bC2hBtInquiryPage == FALSE) && (pCoexSta->bScoExist == FALSE)) -+ { -+ if (pCoexSta->highPriorityTx + pCoexSta->highPriorityRx >= 160) -+ { -+ pCoexSta->bHidExist = TRUE; -+ btInfo = btInfo | 0x28; -+ } -+ } -+ } -+ -+ halbtc8723b2ant_UpdateBtLinkInfo(pBtCoexist); -+ -+ if(!(btInfo&BT_INFO_8723B_2ANT_B_CONNECTION)) -+ { -+ pCoexDm->btStatus = BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n")); -+ } -+ else if(btInfo == BT_INFO_8723B_2ANT_B_CONNECTION) // connection exists but no busy -+ { -+ pCoexDm->btStatus = BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n")); -+ } -+ else if((btInfo&BT_INFO_8723B_2ANT_B_SCO_ESCO) || -+ (btInfo&BT_INFO_8723B_2ANT_B_SCO_BUSY)) -+ { -+ pCoexDm->btStatus = BT_8723B_2ANT_BT_STATUS_SCO_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n")); -+ } -+ else if(btInfo&BT_INFO_8723B_2ANT_B_ACL_BUSY) -+ { -+ pCoexDm->btStatus = BT_8723B_2ANT_BT_STATUS_ACL_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n")); -+ } -+ else -+ { -+ pCoexDm->btStatus = BT_8723B_2ANT_BT_STATUS_MAX; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n")); -+ } -+ -+ if( (BT_8723B_2ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_2ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8723B_2ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ bBtBusy = TRUE; -+ bLimitedDig = TRUE; -+ } -+ else -+ { -+ bBtBusy = FALSE; -+ bLimitedDig = FALSE; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ pCoexDm->bLimitedDig = bLimitedDig; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bLimitedDig); -+ -+ halbtc8723b2ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8723b2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8723b2ant_WifiOffHwCfg(pBtCoexist); -+ //remove due to interrupt is disabled that polling c2h will fail and delay 100ms. -+ //pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT goto standby while GNT_BT 1-->0 -+ halbtc8723b2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ -+ EXhalbtc8723b2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+VOID -+EXhalbtc8723b2ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify\n")); -+ -+ if(BTC_WIFI_PNP_SLEEP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to SLEEP\n")); -+ } -+ else if(BTC_WIFI_PNP_WAKE_UP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to WAKE UP\n")); -+ halbtc8723b2ant_InitHwConfig(pBtCoexist, FALSE); -+ halbtc8723b2ant_InitCoexDm(pBtCoexist); -+ halbtc8723b2ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8723b2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ //static u1Byte disVerInfoCnt=0; -+ u4Byte fwVer=0, btPatchVer=0; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ==========================Periodical===========================\n")); -+ -+ if(pCoexSta->disVerInfoCnt <= 5) -+ { -+ pCoexSta->disVerInfoCnt += 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ant PG Num/ Ant Mech/ Ant Pos = %d/ %d/ %d\n", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT stack/ hci ext ver = %s / %d\n", -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion)); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", -+ GLCoexVerDate8723b2Ant, GLCoexVer8723b2Ant, fwVer, btPatchVer, btPatchVer)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ -+ if (pCoexSta->disVerInfoCnt == 3) -+ { -+ //Antenna config to set 0x765 = 0x0 (GNT_BT control by PTA) after initial -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set GNT_BT control by PTA\n")); -+ halbtc8723b2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_MAIN, FALSE, FALSE); -+ } -+ } -+ -+#if(BT_AUTO_REPORT_ONLY_8723B_2ANT == 0) -+ halbtc8723b2ant_QueryBtInfo(pBtCoexist); -+ halbtc8723b2ant_MonitorBtEnableDisable(pBtCoexist); -+#else -+ halbtc8723b2ant_MonitorBtCtr(pBtCoexist); -+ halbtc8723b2ant_MonitorWiFiCtr(pBtCoexist); -+ -+ //for some BT speaker that Hi-Pri pkt appear begore start play, this will cause HID exist -+ if ( (pCoexSta->highPriorityTx + pCoexSta->highPriorityRx < 50) && (pBtLinkInfo->bHidExist == TRUE)) -+ { -+ pBtLinkInfo->bHidExist = FALSE; -+ } -+ -+ if( halbtc8723b2ant_IsWifiStatusChanged(pBtCoexist) || -+ pCoexDm->bAutoTdmaAdjust) -+ { -+ halbtc8723b2ant_RunCoexistMechanism(pBtCoexist); -+ } -+#endif -+} -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723b2Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8723b2Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8723b2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8723b2Ant.h 2017-06-07 23:07:21.010687485 +0300 -@@ -0,0 +1,234 @@ -+//=========================================== -+// The following is for 8723B 2Ant BT Co-exist definition -+//=========================================== -+#define BT_AUTO_REPORT_ONLY_8723B_2ANT 1 -+ -+ -+#define BT_INFO_8723B_2ANT_B_FTP BIT7 -+#define BT_INFO_8723B_2ANT_B_A2DP BIT6 -+#define BT_INFO_8723B_2ANT_B_HID BIT5 -+#define BT_INFO_8723B_2ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8723B_2ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8723B_2ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8723B_2ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8723B_2ANT_B_CONNECTION BIT0 -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT 2 -+ -+ -+#define BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES 42 //WiFi RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation -+#define BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES 46 //BT RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation -+ -+typedef enum _BT_INFO_SRC_8723B_2ANT{ -+ BT_INFO_SRC_8723B_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8723B_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8723B_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8723B_2ANT_MAX -+}BT_INFO_SRC_8723B_2ANT,*PBT_INFO_SRC_8723B_2ANT; -+ -+typedef enum _BT_8723B_2ANT_BT_STATUS{ -+ BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8723B_2ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8723B_2ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8723B_2ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8723B_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8723B_2ANT_BT_STATUS_MAX -+}BT_8723B_2ANT_BT_STATUS,*PBT_8723B_2ANT_BT_STATUS; -+ -+typedef enum _BT_8723B_2ANT_COEX_ALGO{ -+ BT_8723B_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8723B_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8723B_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8723B_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8723B_2ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8723B_2ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8723B_2ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8723B_2ANT_COEX_ALGO_MAX = 0xb, -+}BT_8723B_2ANT_COEX_ALGO,*PBT_8723B_2ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8723B_2ANT{ -+ // fw mechanism -+ u1Byte preBtDecPwrLvl; -+ u1Byte curBtDecPwrLvl; -+ u1Byte preFwDacSwingLvl; -+ u1Byte curFwDacSwingLvl; -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ BOOLEAN bResetTdmaAdjust; -+ BOOLEAN bAutoTdmaAdjust; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ BOOLEAN bPreBtAutoReport; -+ BOOLEAN bCurBtAutoReport; -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ BOOLEAN bPreDacSwingOn; -+ u4Byte preDacSwingLvl; -+ BOOLEAN bCurDacSwingOn; -+ u4Byte curDacSwingLvl; -+ BOOLEAN bPreAdcBackOff; -+ BOOLEAN bCurAdcBackOff; -+ BOOLEAN bPreAgcTableEn; -+ BOOLEAN bCurAgcTableEn; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+ -+ BOOLEAN bNeedRecover0x948; -+ u4Byte backup0x948; -+ -+ u1Byte preLps; -+ u1Byte curLps; -+ u1Byte preRpwm; -+ u1Byte curRpwm; -+ -+ BOOLEAN bIsSwitchTo1dot5Ant; -+} COEX_DM_8723B_2ANT, *PCOEX_DM_8723B_2ANT; -+ -+typedef struct _COEX_STA_8723B_2ANT{ -+ BOOLEAN bBtLinkExist; -+ BOOLEAN bScoExist; -+ BOOLEAN bA2dpExist; -+ BOOLEAN bHidExist; -+ BOOLEAN bPanExist; -+ -+ BOOLEAN bUnderLps; -+ BOOLEAN bUnderIps; -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ u1Byte btRssi; -+ BOOLEAN bBtTxRxMask; -+ u1Byte preBtRssiState; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8723B_2ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8723B_2ANT_MAX]; -+ BOOLEAN bBtWhckTest; -+ BOOLEAN bC2hBtInquiryPage; -+ BOOLEAN bC2hBtRemoteNameReq; -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+ u4Byte popEventCnt; -+ u1Byte nScanAPNum; -+ -+ u4Byte nCRCOK_CCK; -+ u4Byte nCRCOK_11g; -+ u4Byte nCRCOK_11n; -+ u4Byte nCRCOK_11nAgg; -+ -+ u4Byte nCRCErr_CCK; -+ u4Byte nCRCErr_11g; -+ u4Byte nCRCErr_11n; -+ u4Byte nCRCErr_11nAgg; -+ -+ u1Byte nCoexTableType; -+ BOOLEAN bForceLpsOn; -+ -+ u1Byte disVerInfoCnt; -+ -+ u1Byte nA2DPBitPool; -+ u1Byte nCutVersion; -+}COEX_STA_8723B_2ANT, *PCOEX_STA_8723B_2ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8723b2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723b2ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723b2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8723b2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723b2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723b2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723b2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723b2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723b2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723b2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723b2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8723b2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723b2ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ); -+VOID -+EXhalbtc8723b2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723b2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8812a1Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8812a1Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8812a1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8812a1Ant.c 2017-06-07 23:07:21.011687576 +0300 -@@ -0,0 +1,3717 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8812A Co-exist mechanism -+// -+// History -+// 2012/11/15 Cosa first check in. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8812a1Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8812A_1ANT GLCoexDm8812a1Ant; -+static PCOEX_DM_8812A_1ANT pCoexDm=&GLCoexDm8812a1Ant; -+static COEX_STA_8812A_1ANT GLCoexSta8812a1Ant; -+static PCOEX_STA_8812A_1ANT pCoexSta=&GLCoexSta8812a1Ant; -+ -+const char *const GLBtInfoSrc8812a1Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u4Byte GLCoexVerDate8812a1Ant=20140708; -+u4Byte GLCoexVer8812a1Ant=0x52; -+ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8812a1ant_ -+//============================================================ -+u1Byte -+halbtc8812a1ant_BtRssiState( -+ u1Byte levelNum, -+ u1Byte rssiThresh, -+ u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte btRssi=0; -+ u1Byte btRssiState=pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh1) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+u1Byte -+halbtc8812a1ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+VOID -+halbtc8812a1ant_UpdateRaMask( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte disRateMask -+ ) -+{ -+ pCoexDm->curRaMask = disRateMask; -+ -+ if( bForceExec || (pCoexDm->preRaMask != pCoexDm->curRaMask)) -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_UPDATE_RAMASK, &pCoexDm->curRaMask); -+ } -+ pCoexDm->preRaMask = pCoexDm->curRaMask; -+} -+ -+//to check 0x430/0x434 is correct?? -+VOID -+halbtc8812a1ant_AutoRateFallbackRetry( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiUnderBMode=FALSE; -+ -+ pCoexDm->curArfrType = type; -+ -+ if( bForceExec || (pCoexDm->preArfrType != pCoexDm->curArfrType)) -+ { -+ switch(pCoexDm->curArfrType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, pCoexDm->backupArfrCnt1); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, pCoexDm->backupArfrCnt2); -+ break; -+ case 1: -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ if(bWifiUnderBMode) -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x01010101); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preArfrType = pCoexDm->curArfrType; -+} -+ -+//to check 0x42a ?? -+VOID -+halbtc8812a1ant_RetryLimit( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curRetryLimitType = type; -+ -+ if( bForceExec || (pCoexDm->preRetryLimitType != pCoexDm->curRetryLimitType)) -+ { -+ switch(pCoexDm->curRetryLimitType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, pCoexDm->backupRetryLimit); -+ break; -+ case 1: // retry limit=8 -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preRetryLimitType = pCoexDm->curRetryLimitType; -+} -+ -+//to check 0x456?? -+VOID -+halbtc8812a1ant_AmpduMaxTime( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curAmpduTimeType = type; -+ -+ if( bForceExec || (pCoexDm->preAmpduTimeType != pCoexDm->curAmpduTimeType)) -+ { -+ switch(pCoexDm->curAmpduTimeType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, pCoexDm->backupAmpduMaxTime); -+ break; -+ case 1: // AMPDU timw = 0x38 * 32us -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preAmpduTimeType = pCoexDm->curAmpduTimeType; -+} -+ -+VOID -+halbtc8812a1ant_LimitedTx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte raMaskType, -+ IN u1Byte arfrType, -+ IN u1Byte retryLimitType, -+ IN u1Byte ampduTimeType -+ ) -+{ -+ switch(raMaskType) -+ { -+ case 0: // normal mode -+ halbtc8812a1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0); -+ break; -+ case 1: // disable cck 1/2 -+ halbtc8812a1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x00000003); -+ break; -+ case 2: // disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 -+ halbtc8812a1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8812a1ant_AutoRateFallbackRetry(pBtCoexist, bForceExec, arfrType); -+ halbtc8812a1ant_RetryLimit(pBtCoexist, bForceExec, retryLimitType); -+ halbtc8812a1ant_AmpduMaxTime(pBtCoexist, bForceExec, ampduTimeType); -+} -+ -+VOID -+halbtc8812a1ant_LimitedRx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRejApAggPkt, -+ IN BOOLEAN bBtCtrlAggBufSize, -+ IN u1Byte aggBufSize -+ ) -+{ -+ BOOLEAN bRejectRxAgg=bRejApAggPkt; -+ BOOLEAN bBtCtrlRxAggSize=bBtCtrlAggBufSize; -+ u1Byte rxAggSize=aggBufSize; -+ -+ //============================================ -+ // Rx Aggregation related setting -+ //============================================ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg); -+ // decide BT control aggregation buf size or not -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize); -+ // aggregation buf size, only work when BT control Rx aggregation size. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize); -+ // real update aggregation setting -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+VOID -+halbtc8812a1ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte dataLen=3; -+ u1Byte buf[5] = {0}; -+ -+ if(!pBtCoexist->btInfo.bBtDisabled) -+ { -+ if(!pCoexSta->btInfoQueryCnt || -+ (pCoexSta->btInfoC2hCnt[BT_INFO_SRC_8812A_1ANT_BT_RSP]-pCoexSta->btInfoQueryCnt)>2) -+ { -+ buf[0] = dataLen; -+ buf[1] = 0x1; // polling enable, 1=enable, 0=disable -+ buf[2] = 0x2; // polling time in seconds -+ buf[3] = 0x1; // auto report enable, 1=enable, 0=disable -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_BT_INFO, (PVOID)&buf[0]); -+ } -+ } -+ pCoexSta->btInfoQueryCnt++; -+} -+ -+VOID -+halbtc8812a1ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp, u4Tmp1; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp, u1Tmp1; -+ s4Byte wifiRssi; -+ static u1Byte NumOfBtCounterChk = 0; -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ if( (pCoexSta->lowPriorityTx > 1150) && (!pCoexSta->bC2hBtInquiryPage)) -+ pCoexSta->popEventCnt++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", -+ regHPRx, regHPTx, regLPRx, regLPTx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+ -+ if ((regHPTx == 0) && (regHPRx ==0) && (regLPTx == 0) && (regLPRx == 0)) -+ { -+ NumOfBtCounterChk++; -+ if (NumOfBtCounterChk >= 3) -+ { -+ halbtc8812a1ant_QueryBtInfo(pBtCoexist); -+ NumOfBtCounterChk = 0; -+ } -+ } -+} -+ -+//to check registers -+VOID -+halbtc8812a1ant_MonitorWiFiCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ u2Byte u2Tmp[3]; -+ s4Byte wifiRssi=0; -+ BOOLEAN bWifiBusy = FALSE, bWifiUnderBMode = FALSE; -+ static u1Byte nCCKLockCounter = 0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ -+ if (pCoexSta->bUnderIps) -+ { -+ pCoexSta->nCRCOK_CCK = 0; -+ pCoexSta->nCRCOK_11g = 0; -+ pCoexSta->nCRCOK_11n = 0; -+ pCoexSta->nCRCOK_11nAgg = 0; -+ -+ pCoexSta->nCRCErr_CCK = 0; -+ pCoexSta->nCRCErr_11g = 0; -+ pCoexSta->nCRCErr_11n = 0; -+ pCoexSta->nCRCErr_11nAgg = 0; -+ } -+ else -+ { -+ pCoexSta->nCRCOK_CCK = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf04); -+ pCoexSta->nCRCOK_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf14); -+ pCoexSta->nCRCOK_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf10); -+ pCoexSta->nCRCOK_11nAgg= pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf40); -+ -+ pCoexSta->nCRCErr_CCK = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf06); -+ pCoexSta->nCRCErr_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf16); -+ pCoexSta->nCRCErr_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf12); -+ pCoexSta->nCRCErr_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf42); -+ } -+ -+ -+ //reset counter -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xb58, 0x1, 0x1); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xb58, 0x1, 0x0); -+ -+ if ( (bWifiBusy) && (wifiRssi >= 30) && (!bWifiUnderBMode)) -+ { -+ if ( (pCoexDm->btStatus == BT_8812A_1ANT_BT_STATUS_ACL_BUSY) || -+ (pCoexDm->btStatus == BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY) || -+ (pCoexDm->btStatus == BT_8812A_1ANT_BT_STATUS_SCO_BUSY) ) -+ { -+ if (pCoexSta->nCRCOK_CCK >(pCoexSta->nCRCOK_11g + pCoexSta->nCRCOK_11n + -+ pCoexSta->nCRCOK_11nAgg) ) -+ { -+ if (nCCKLockCounter < 5) -+ nCCKLockCounter++; -+ } -+ else -+ { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ -+ } -+ else -+ { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ } -+ else -+ { -+ if (nCCKLockCounter > 0) -+ nCCKLockCounter--; -+ } -+ -+ if (!pCoexSta->bPreCCKLock) -+ { -+ -+ if (nCCKLockCounter >= 5) -+ pCoexSta->bCCKLock = TRUE; -+ else -+ pCoexSta->bCCKLock = FALSE; -+ } -+ else -+ { -+ if (nCCKLockCounter == 0) -+ pCoexSta->bCCKLock = FALSE; -+ else -+ pCoexSta->bCCKLock = TRUE; -+ } -+ -+ pCoexSta->bPreCCKLock = pCoexSta->bCCKLock; -+ -+ -+} -+ -+BOOLEAN -+halbtc8812a1ant_IsWifiStatusChanged( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreWifiBusy=FALSE, bPreUnder4way=FALSE, bPreBtHsOn=FALSE; -+ BOOLEAN bWifiBusy=FALSE, bUnder4way=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bWifiConnected=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ -+ if(bWifiConnected) -+ { -+ if(bWifiBusy != bPreWifiBusy) -+ { -+ bPreWifiBusy = bWifiBusy; -+ return TRUE; -+ } -+ if(bUnder4way != bPreUnder4way) -+ { -+ bPreUnder4way = bUnder4way; -+ return TRUE; -+ } -+ if(bBtHsOn != bPreBtHsOn) -+ { -+ bPreBtHsOn = bBtHsOn; -+ return TRUE; -+ } -+ } -+ -+ return FALSE; -+} -+ -+VOID -+halbtc8812a1ant_UpdateBtLinkInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pCoexSta->bScoExist; -+ pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist; -+ pBtLinkInfo->bPanExist = pCoexSta->bPanExist; -+ pBtLinkInfo->bHidExist = pCoexSta->bHidExist; -+ -+ // work around for HS mode. -+ if(bBtHsOn) -+ { -+ pBtLinkInfo->bPanExist = TRUE; -+ pBtLinkInfo->bBtLinkExist = TRUE; -+ } -+ -+ // check if Sco only -+ if( pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bScoOnly = TRUE; -+ else -+ pBtLinkInfo->bScoOnly = FALSE; -+ -+ // check if A2dp only -+ if( !pBtLinkInfo->bScoExist && -+ pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bA2dpOnly = TRUE; -+ else -+ pBtLinkInfo->bA2dpOnly = FALSE; -+ -+ // check if Pan only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bPanOnly = TRUE; -+ else -+ pBtLinkInfo->bPanOnly = FALSE; -+ -+ // check if Hid only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bHidOnly = TRUE; -+ else -+ pBtLinkInfo->bHidOnly = FALSE; -+} -+ -+u1Byte -+halbtc8812a1ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ u1Byte algorithm=BT_8812A_1ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!pBtLinkInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No BT link exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pBtLinkInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(numOfDiffProfile == 1) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO only\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID only\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP only\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_A2DP; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = PAN(HS) only\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = PAN(EDR) only\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 2) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_SCO; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + PAN(HS)\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + PAN(EDR)\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + PAN(HS)\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + PAN(EDR)\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP + PAN(HS)\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_A2DP_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP + PAN(EDR)\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_HID; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + PAN(HS)\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile >= 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+VOID -+halbtc8812a1ant_SetBtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = 0; -+ -+ if(bEnableAutoReport) -+ { -+ H2C_Parameter[0] |= BIT0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], BT FW auto report : %s, FW write 0x68=0x%x\n", -+ (bEnableAutoReport? "Enabled!!":"Disabled!!"), H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x68, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8812a1ant_BtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s BT Auto report = %s\n", -+ (bForceExec? "force to":""), ((bEnableAutoReport)? "Enabled":"Disabled"))); -+ pCoexDm->bCurBtAutoReport = bEnableAutoReport; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreBtAutoReport == pCoexDm->bCurBtAutoReport) -+ return; -+ } -+ halbtc8812a1ant_SetBtAutoReport(pBtCoexist, pCoexDm->bCurBtAutoReport); -+ -+ pCoexDm->bPreBtAutoReport = pCoexDm->bCurBtAutoReport; -+} -+ -+//to check -+VOID -+halbtc8812a1ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte tmpU1; -+ -+ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); -+ tmpU1 |= BIT0; -+ if(bLowPenaltyRa) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); -+ tmpU1 &= ~BIT2; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); -+ tmpU1 |= BIT2; -+ } -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -+} -+ -+VOID -+halbtc8812a1ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8812a1ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8812a1ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8812a1ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c4=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c4, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8812a1ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8812a1ant_CoexTableWithType( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** CoexTable(%d) **********\n", type)); -+ -+ pCoexSta->nCoexTableType = type; -+ -+ switch(type) -+ { -+ case 0: -+ halbtc8812a1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x55555555, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8812a1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8812a1ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8812a1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8812a1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8812a1ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0xaa5a5a5a, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8812a1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 7: -+ halbtc8812a1ant_CoexTable(pBtCoexist, bForceExec, 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8812a1ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte dataLen=3; -+ u1Byte buf[5] = {0}; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s BT Ignore Wlan_Act\n", -+ (bEnable? "Enable":"Disable"))); -+ -+ buf[0] = dataLen; -+ buf[1] = 0x1; // OP_Code -+ buf[2] = 0x1; // OP_Code_Length -+ if(bEnable) -+ buf[3] = 0x1; // OP_Code_Content -+ else -+ buf[3] = 0x0; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_BT_COEX, (PVOID)&buf[0]); -+} -+ -+VOID -+halbtc8812a1ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8812a1ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8812a1ant_SetLpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ u1Byte lps=lpsVal; -+ u1Byte rpwm=rpwmVal; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+VOID -+halbtc8812a1ant_LpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bForceExecPwrCmd=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set lps/rpwm=0x%x/0x%x \n", -+ (bForceExec? "force to":""), lpsVal, rpwmVal)); -+ pCoexDm->curLps = lpsVal; -+ pCoexDm->curRpwm = rpwmVal; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preLps == pCoexDm->curLps) && -+ (pCoexDm->preRpwm == pCoexDm->curRpwm) ) -+ { -+ return; -+ } -+ } -+ halbtc8812a1ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal); -+ -+ pCoexDm->preLps = pCoexDm->curLps; -+ pCoexDm->preRpwm = pCoexDm->curRpwm; -+} -+ -+VOID -+halbtc8812a1ant_SwMechanism( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRA -+ ) -+{ -+ halbtc8812a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA); -+} -+ -+//to check bForceExec -+VOID -+halbtc8812a1ant_SetAntPath( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte antPosType, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bInitHwCfg, -+ IN BOOLEAN bWifiOff -+ ) -+{ -+ u1Byte u1Tmp=0; -+ -+ pCoexDm->curAntPosType = antPosType; -+ -+ if(bInitHwCfg) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xcb3, 0x77); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x900, 0x00000400); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76d, 0x1); -+ } -+ else if(bWifiOff) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xcb3, 0x77); -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xcb7); -+ u1Tmp &= ~BIT3; -+ u1Tmp |= BIT2; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xcb7, u1Tmp); -+ } -+ -+ if(bForceExec || (pCoexDm->curAntPosType != pCoexDm->preAntPosType)) -+ { -+ // ext switch setting -+ switch(antPosType) -+ { -+ case BTC_ANT_PATH_WIFI: -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xcb7); -+ u1Tmp |= BIT3; -+ u1Tmp &= ~BIT2; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xcb7, u1Tmp); -+ break; -+ case BTC_ANT_PATH_BT: -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xcb7); -+ u1Tmp &= ~BIT3; -+ u1Tmp |= BIT2; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xcb7, u1Tmp); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xcb7); -+ u1Tmp |= BIT3; -+ u1Tmp &= ~BIT2; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xcb7, u1Tmp); -+ break; -+ } -+ } -+ -+ pCoexDm->preAntPosType = pCoexDm->curAntPosType; -+} -+ -+VOID -+halbtc8812a1ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ u1Byte realByte1=byte1, realByte5=byte5; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ if(bApEnable) -+ { -+ if(byte1&BIT4 && !(byte1&BIT5)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FW for 1Ant AP mode\n")); -+ realByte1 &= ~BIT4; -+ realByte1 |= BIT5; -+ -+ realByte5 |= BIT5; -+ realByte5 &= ~BIT6; -+ } -+ } -+ -+ H2C_Parameter[0] = realByte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = realByte5; -+ -+ pCoexDm->psTdmaPara[0] = realByte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = realByte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], PS-TDMA H2C cmd =0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter); -+} -+ -+ -+VOID -+halbtc8812a1ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bTurnOnByCnt=FALSE, bWifiBusy=FALSE, bWiFiNoisy=FALSE; -+ u1Byte psTdmaTypeByCnt=0, rssiAdjustVal=0; -+ u1Byte psTdmaByte4Val = 0x50, psTdmaByte0Val = 0x51, psTdmaByte3Val = 0x10; -+ s1Byte nWiFiDurationAdjust = 0x0; -+ static BOOLEAN bPreWifiBusy=FALSE; -+ -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if (bWifiBusy != bPreWifiBusy) -+ { -+ bForceExec = TRUE; -+ bPreWifiBusy = bWifiBusy; -+ } -+ -+ if (pCoexDm->bCurPsTdmaOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(on, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(off, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ -+ if (pCoexSta->nScanAPNum <= 5) -+ nWiFiDurationAdjust = 2; -+ else if (pCoexSta->nScanAPNum >= 40) -+ nWiFiDurationAdjust = -15; -+ else if (pCoexSta->nScanAPNum >= 20) -+ nWiFiDurationAdjust = -10; -+ -+ if (!pCoexSta->bForceLpsOn) //only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 -+ { -+ psTdmaByte0Val = 0x61; //no null-pkt -+ psTdmaByte3Val = 0x11; // no tx-pause at BT-slot -+ psTdmaByte4Val = 0x10; // 0x778 = d/1 toggle -+ } -+ -+ if ( (type == 3) || (type == 13) || (type == 14) ) -+ { -+ psTdmaByte4Val = psTdmaByte4Val & 0xbf; //no dynamic slot for multi-profile -+ -+ if (!bWifiBusy) -+ psTdmaByte4Val = psTdmaByte4Val | 0x1; //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) -+ } -+ -+ if (pBtLinkInfo->bSlaveRole == TRUE) -+ psTdmaByte4Val = psTdmaByte4Val | 0x1; //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) -+ -+ if(bTurnOn) -+ { -+ switch(type) -+ { -+ default: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x1a, 0x1a, 0x0, psTdmaByte4Val); -+ break; -+ case 1: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 2: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x2d+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 3: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x1d, 0x1d, 0x0, psTdmaByte4Val); -+ break; -+ case 4: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x93, 0x15, 0x3, 0x14, 0x0); -+ break; -+ case 5: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x61, 0x15, 0x3, 0x11, 0x11); -+ break; -+ case 6: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x61, 0x20, 0x3, 0x11, 0x11); -+ break; -+ case 7: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x13, 0xc, 0x5, 0x0, 0x0); -+ break; -+ case 8: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 9: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 10: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 11: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x03, psTdmaByte3Val, psTdmaByte4Val); -+ break; -+ case 12: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x0a, 0x0a, 0x0, 0x50); -+ break; -+ case 13: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x12, 0x12, 0x0, psTdmaByte4Val); -+ break; -+ case 14: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x21, 0x3, 0x10, psTdmaByte4Val); -+ break; -+ case 15: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0x3, 0x8, 0x0); -+ break; -+ case 16: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x93, 0x15, 0x3, 0x10, 0x0); -+ break; -+ case 18: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 20: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x61, 0x3f, 0x03, 0x11, 0x10); -+ break; -+ case 21: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x11); -+ break; -+ case 22: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x10); -+ break; -+ case 23: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x18); -+ break; -+ case 24: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x3, 0x31, 0x18); -+ break; -+ case 25: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 26: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 27: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x98); -+ break; -+ case 28: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x69, 0x25, 0x3, 0x31, 0x0); -+ break; -+ case 29: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0xab, 0x1a, 0x1a, 0x1, 0x10); -+ break; -+ case 30: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x30, 0x3, 0x10, 0x10); -+ break; -+ case 31: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0xd3, 0x1a, 0x1a, 0, 0x58); -+ break; -+ case 32: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x61, 0x35, 0x3, 0x11, 0x11); -+ break; -+ case 33: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0xa3, 0x25, 0x3, 0x30, 0x90); -+ break; -+ case 34: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x53, 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 35: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x63, 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 36: -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0xd3, 0x12, 0x3, 0x14, 0x50); -+ break; -+ case 40: // SoftAP only with no sta associated,BT disable ,TDMA mode for power saving -+ /* here softap mode screen off will cost 70-80mA for phone */ -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x23, 0x18, 0x00, 0x10, 0x24); -+ break; -+ } -+ } -+ else -+ { -+ -+ // disable PS tdma -+ switch(type) -+ { -+ case 8: //PTA Control -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x8, 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 0: -+ default: //Software control, Antenna at BT side -+ halbtc8812a1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ break; -+ } -+ } -+ rssiAdjustVal =0; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssiAdjustVal); -+ -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+BOOLEAN -+halbtc8812a1ant_IsCommonAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE, bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if(!bWifiConnected && -+ BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n")); -+ -+ //halbtc8812a1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(bWifiConnected && -+ (BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT non connected-idle!!\n")); -+ -+ //halbtc8812a1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(!bWifiConnected && -+ (BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT connected-idle!!\n")); -+ -+ //halbtc8812a1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(bWifiConnected && -+ (BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT connected-idle!!\n")); -+ -+ //halbtc8812a1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(!bWifiConnected && -+ (BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT Busy!!\n")); -+ -+ //halbtc8812a1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ if (bWifiBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n")); -+ } -+ -+ bCommon = FALSE; -+ } -+ -+ return bCommon; -+} -+ -+ -+VOID -+halbtc8812a1ant_TdmaDurationAdjustForAcl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0, btInfoExt; -+ static BOOLEAN bPreWifiBusy=FALSE; -+ BOOLEAN bWifiBusy = FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjustForAcl()\n")); -+ -+ if(BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifiStatus) -+ bWifiBusy = TRUE; -+ else -+ bWifiBusy = FALSE; -+ -+ if( (BT_8812A_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == wifiStatus) || -+ (BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifiStatus) || -+ (BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT == wifiStatus) ) -+ { -+ if( pCoexDm->curPsTdma != 1 && -+ pCoexDm->curPsTdma != 2 && -+ pCoexDm->curPsTdma != 3 && -+ pCoexDm->curPsTdma != 9 ) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ return; -+ } -+ -+ if(!pCoexDm->bAutoTdmaAdjust) -+ { -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if ( (pCoexSta->lowPriorityTx) > 1150 || (pCoexSta->lowPriorityRx) > 1250 ) -+ retryCount++; -+ -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ if(result == -1) -+ { -+ if( (BT_INFO_8812A_1ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 1) ||(pCoexDm->curPsTdma == 2)) ) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ else if(result == 1) -+ { -+ if( (BT_INFO_8812A_1ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 1) ||(pCoexDm->curPsTdma == 2)) ) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ } -+ else //no change -+ { -+ /* Bryant Modify -+ if(bWifiBusy != bPreWifiBusy) //if busy / idle change -+ { -+ bPreWifiBusy = bWifiBusy; -+ halbtc8812a1ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, pCoexDm->curPsTdma); -+ } -+ */ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(on, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ -+ if( pCoexDm->curPsTdma != 1 && -+ pCoexDm->curPsTdma != 2 && -+ pCoexDm->curPsTdma != 9 && -+ pCoexDm->curPsTdma != 11 ) -+ { -+ // recover to previous adjust type -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ } -+} -+ -+VOID -+halbtc8812a1ant_PsTdmaCheckForPowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bNewPsState -+ ) -+{ -+ u1Byte lpsMode=0x0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode); -+ -+ if(lpsMode) // already under LPS state -+ { -+ if(bNewPsState) -+ { -+ // keep state under LPS, do nothing. -+ } -+ else -+ { -+ // will leave LPS state, turn off psTdma first -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ } -+ } -+ else // NO PS state -+ { -+ if(bNewPsState) -+ { -+ // will enter LPS state, turn off psTdma first -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ } -+ else -+ { -+ // keep state under NO PS state, do nothing. -+ } -+ } -+} -+ -+VOID -+halbtc8812a1ant_PowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte psType, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bLowPwrDisable=FALSE; -+ -+ switch(psType) -+ { -+ case BTC_PS_WIFI_NATIVE: -+ // recover to original 32k low power setting -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8812a1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, TRUE); -+ halbtc8812a1ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal); -+ // when coex force to enter LPS, do not enter 32k low power. -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ // power save must executed before psTdma. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); -+ pCoexSta->bForceLpsOn = TRUE; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8812a1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, FALSE); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8812a1ant_ActionWifiOnly( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ halbtc8812a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+} -+ -+VOID -+halbtc8812a1ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ halbtc8812a1ant_ActionWifiOnly(pBtCoexist); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ bPreBtDisabled = bBtDisabled; -+ if(!bBtDisabled) -+ { -+ } -+ else -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ } -+ } -+} -+ -+//============================================= -+// -+// Software Coex Mechanism start -+// -+//============================================= -+ -+// SCO only or SCO+PAN(HS) -+ -+/* -+VOID -+halbtc8812a1ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+ -+VOID -+halbtc8812a1ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -+VOID -+halbtc8812a1ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8812a1ant_ActionA2dpPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8812a1ant_ActionPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+//PAN(HS) only -+VOID -+halbtc8812a1ant_ActionPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+//PAN(EDR)+A2DP -+VOID -+halbtc8812a1ant_ActionPanEdrA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8812a1ant_ActionPanEdrHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+// HID+A2DP+PAN(EDR) -+VOID -+halbtc8812a1ant_ActionHidA2dpPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+VOID -+halbtc8812a1ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+*/ -+ -+//============================================= -+// -+// Non-Software Coex Mechanism start -+// -+//============================================= -+VOID -+halbtc8812a1ant_ActionWifiMultiPort( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+} -+ -+VOID -+halbtc8812a1ant_ActionHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+} -+ -+VOID -+halbtc8812a1ant_ActionBtInquiry( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE, bApEnable=FALSE, bWifiBusy=FALSE, bBtBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ if((!bWifiConnected) && (!pCoexSta->bWiFiIsHighPriTask)) -+ { -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if((pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist) || (pBtLinkInfo->bA2dpExist)) -+ { -+ // SCO/HID/A2DP busy -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if ((pBtLinkInfo->bPanExist) || (bWifiBusy)) -+ { -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+} -+ -+VOID -+halbtc8812a1ant_ActionBtScoHidOnlyBusy( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ // tdma and coex table -+ -+ if(pBtLinkInfo->bScoExist) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+ else //HID -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+} -+ -+VOID -+halbtc8812a1ant_ActionWifiConnectedBtAclBusy( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ u1Byte btRssiState; -+ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ btRssiState = halbtc8812a1ant_BtRssiState(2, 28, 0); -+ -+ if ( (pCoexSta->lowPriorityRx >= 950) && (!pCoexSta->bUnderIps) ) -+ { -+ pBtLinkInfo->bSlaveRole = TRUE; -+ } -+ else -+ { -+ pBtLinkInfo->bSlaveRole = FALSE; -+ } -+ -+ if(pBtLinkInfo->bHidOnly) //HID -+ { -+ halbtc8812a1ant_ActionBtScoHidOnlyBusy(pBtCoexist, wifiStatus); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ return; -+ } -+ else if(pBtLinkInfo->bA2dpOnly) //A2DP -+ { -+ if(BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifiStatus) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else -+ { -+ halbtc8812a1ant_TdmaDurationAdjustForAcl(pBtCoexist, wifiStatus); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ } -+ } -+ else if ( ((pBtLinkInfo->bA2dpExist) && (pBtLinkInfo->bPanExist)) || -+ (pBtLinkInfo->bHidExist&&pBtLinkInfo->bA2dpExist&&pBtLinkInfo->bPanExist) ) //A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else if(pBtLinkInfo->bHidExist&&pBtLinkInfo->bA2dpExist) //HID+A2DP -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ } -+ else if( (pBtLinkInfo->bPanOnly) || (pBtLinkInfo->bHidExist&&pBtLinkInfo->bPanExist) ) //PAN(OPP,FTP), HID+PAN(OPP,FTP) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else -+ { -+ //BT no-profile busy (0x9) -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+} -+ -+VOID -+halbtc8812a1ant_ActionWifiNotConnected( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // power save state -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ halbtc8812a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8812a1ant_ActionWifiNotConnectedScan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(BT_8812A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ if (pBtLinkInfo->bA2dpExist) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ } -+ else if( (BT_8812A_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8812a1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } -+ else -+ { -+ //Bryant Add -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8812a1ant_ActionWifiNotConnectedAssoAuth( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if( (pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist) || (pBtLinkInfo->bA2dpExist) ) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bPanExist) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 4); -+ } -+ else -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8812a1ant_ActionWifiConnectedScan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(BT_8812A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ if (pBtLinkInfo->bA2dpExist) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ } -+ else if( (BT_8812A_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8812a1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } -+ else -+ { -+ //Bryant Add -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8812a1ant_ActionWifiConnectedSpecialPacket( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if((pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist) || (pBtLinkInfo->bA2dpExist)) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8812a1ant_ActionWifiConnected( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiBusy=FALSE; -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ BOOLEAN bUnder4way=FALSE, bApEnable=FALSE; -+ u4Byte wifiBw; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect()===>\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ if(bUnder4way) -+ { -+ halbtc8812a1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ if(bScan || bLink || bRoam) -+ { -+ if(bScan) -+ halbtc8812a1ant_ActionWifiConnectedScan(pBtCoexist); -+ else -+ halbtc8812a1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ // power save state -+ if(!bApEnable && BT_8812A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus && !pBtCoexist->btLinkInfo.bHidOnly) -+ { -+ if(pBtCoexist->btLinkInfo.bA2dpOnly) //A2DP -+ { -+ if(!bWifiBusy) -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else //busy -+ { -+ if (pCoexSta->nScanAPNum >= BT_8812A_1ANT_WIFI_NOISY_THRESH) //no force LPS, no PS-TDMA, use pure TDMA -+ { -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ } -+ } -+ else if ((pCoexSta->bPanExist == FALSE) && (pCoexSta->bA2dpExist == FALSE) && (pCoexSta->bHidExist == FALSE)) -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ else -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(!bWifiBusy) -+ { -+ if(BT_8812A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ halbtc8812a1ant_ActionWifiConnectedBtAclBusy(pBtCoexist, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } -+ else if( (BT_8812A_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8812a1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } -+ else -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ if ( (pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60 ) -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ else -+ { -+ if(BT_8812A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ halbtc8812a1ant_ActionWifiConnectedBtAclBusy(pBtCoexist, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } -+ else if( (BT_8812A_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8812a1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } -+ else -+ { -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE); -+ if ( (pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60 ) -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+} -+ -+VOID -+halbtc8812a1ant_RunSwCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte algorithm=0; -+ -+ algorithm = halbtc8812a1ant_ActionAlgorithm(pBtCoexist); -+ pCoexDm->curAlgorithm = algorithm; -+ -+ if(halbtc8812a1ant_IsCommonAction(pBtCoexist)) -+ { -+ -+ } -+ else -+ { -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8812A_1ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = SCO.\n")); -+ //halbtc8812a1ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID.\n")); -+ //halbtc8812a1ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = A2DP.\n")); -+ //halbtc8812a1ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_A2DP_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = A2DP+PAN(HS).\n")); -+ //halbtc8812a1ant_ActionA2dpPanHs(pBtCoexist); -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN(EDR).\n")); -+ //halbtc8812a1ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HS mode.\n")); -+ //halbtc8812a1ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_PANEDR_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN+A2DP.\n")); -+ //halbtc8812a1ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_PANEDR_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN(EDR)+HID.\n")); -+ //halbtc8812a1ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID+A2DP+PAN.\n")); -+ //halbtc8812a1ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID+A2DP.\n")); -+ //halbtc8812a1ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = coexist All Off!!\n")); -+ //halbtc8812a1ant_CoexAllOff(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+} -+ -+VOID -+halbtc8812a1ant_RunCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bIncreaseScanDevNum=FALSE; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ BOOLEAN bMiracastPlusBt=FALSE; -+ u1Byte aggBufSize=5; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0, wifiBw; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism()===>\n")); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n")); -+ return; -+ } -+ -+ if(pBtCoexist->bStopCoexDm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n")); -+ return; -+ } -+ -+ if(pCoexSta->bUnderIps) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under IPS !!!\n")); -+ return; -+ } -+ -+ if( (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8812A_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ bIncreaseScanDevNum = TRUE; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, &bIncreaseScanDevNum); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ -+ if((numOfWifiLink>=2) || (wifiLinkStatus&WIFI_P2P_GO_CONNECTED)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], Multi-Port numOfWifiLink = %d, wifiLinkStatus = 0x%x\n", numOfWifiLink,wifiLinkStatus) ); -+ -+ if(pBtLinkInfo->bBtLinkExist) -+ { -+ halbtc8812a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ bMiracastPlusBt = TRUE; -+ } -+ else -+ { -+ halbtc8812a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ bMiracastPlusBt = FALSE; -+ } -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ halbtc8812a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ -+ if ( (pBtLinkInfo->bA2dpExist) && (pCoexSta->bC2hBtInquiryPage) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], BT Is Inquirying \n") ); -+ halbtc8812a1ant_ActionBtInquiry(pBtCoexist); -+ } -+ else -+ halbtc8812a1ant_ActionWifiMultiPort(pBtCoexist); -+ -+ return; -+ } -+ else -+ { -+ bMiracastPlusBt = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if ( (pBtLinkInfo->bBtLinkExist) && (bWifiConnected) ) -+ { -+ halbtc8812a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ -+ if(pBtLinkInfo->bScoExist) -+ halbtc8812a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x5); -+ else -+ { -+ if (BTC_WIFI_BW_HT40==wifiBw) -+ halbtc8812a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x10); -+ else -+ halbtc8812a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x8); -+ } -+ -+ halbtc8812a1ant_SwMechanism(pBtCoexist, TRUE); -+ halbtc8812a1ant_RunSwCoexistMechanism(pBtCoexist); //just print debug message -+ } -+ else -+ { -+ halbtc8812a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8812a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x5); -+ -+ halbtc8812a1ant_SwMechanism(pBtCoexist, FALSE); -+ halbtc8812a1ant_RunSwCoexistMechanism(pBtCoexist); ////just print debug message -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], BT Is Inquirying \n") ); -+ halbtc8812a1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8812a1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ -+ if(!bWifiConnected) -+ { -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is non connected-idle !!!\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if(bScan || bLink || bRoam) -+ { -+ if (bScan) -+ halbtc8812a1ant_ActionWifiNotConnectedScan(pBtCoexist); -+ else -+ halbtc8812a1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist); -+ } -+ else -+ halbtc8812a1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else // wifi LPS/Busy -+ { -+ halbtc8812a1ant_ActionWifiConnected(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8812a1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ -+ // sw all off -+ halbtc8812a1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ //halbtc8812a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ //halbtc8812a1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ pCoexSta->popEventCnt = 0; -+} -+ -+VOID -+halbtc8812a1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bBackUp, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ u4Byte u4Tmp=0; -+ u2Byte u2Tmp=0; -+ u1Byte u1Tmp=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Init HW Config!!\n")); -+ -+ //ant sw control to BT -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, TRUE, FALSE); -+ -+ // 0x790[5:0]=0x5 -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x790); -+ u1Tmp &= 0xc0; -+ u1Tmp |= 0x5; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, u1Tmp); -+ -+ // PTA parameter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, 0xffff); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, 0x55555555); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, 0x55555555); -+ -+ // coex parameters -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x1); -+ -+ // enable counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ // enable PTA -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x20); -+ -+ // bt clock related -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4); -+ u1Tmp |= BIT7; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4, u1Tmp); -+ -+ // bt clock related -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x7); -+ u1Tmp |= BIT1; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x7, u1Tmp); -+} -+ -+//============================================================ -+// work around function start with wa_halbtc8812a1ant_ -+//============================================================ -+//============================================================ -+// extern function start with EXhalbtc8812a1ant_ -+//============================================================ -+VOID -+EXhalbtc8812a1ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8812a1ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8812a1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ halbtc8812a1ant_InitHwConfig(pBtCoexist, TRUE, bWifiOnly); -+ pBtCoexist->bStopCoexDm = FALSE; -+} -+ -+VOID -+EXhalbtc8812a1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ pBtCoexist->bStopCoexDm = FALSE; -+ -+ halbtc8812a1ant_InitCoexDm(pBtCoexist); -+ -+ halbtc8812a1ant_QueryBtInfo(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8812a1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ u4Byte fwVer=0, btPatchVer=0; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ if(pBtCoexist->bStopCoexDm) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", "CoexVer/ FwVer/ PatchVer", \ -+ GLCoexVerDate8812a1Ant, GLCoexVer8812a1Ant, fwVer, btPatchVer, btPatchVer); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ -+ ((pBtCoexist->btInfo.bBtDisabled)? ("disabled"): ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)? "non-connected idle": -+ ( (BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy")))), -+ pCoexSta->btRssi, pCoexSta->btRetryCnt); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pBtLinkInfo->bScoExist, pBtLinkInfo->bHidExist, pBtLinkInfo->bPanExist, pBtLinkInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8812a1Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ if(!pBtCoexist->bManualControl) -+ { -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %d ", "DelBA/ BtCtrlAgg/ AggSize", \ -+ (pBtCoexist->btInfo.bRejectAggPkt? "Yes":"No"), (pBtCoexist->btInfo.bBtCtrlAggBufSize? "Yes":"No"), -+ pBtCoexist->btInfo.aggBufSize); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Rate Mask", \ -+ pBtCoexist->btInfo.raMask); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Latest error condition(should be 0)", \ -+ pCoexDm->errorCondition); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", "IgnWlanAct", \ -+ pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ } -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x778", \ -+ u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xcb3); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xcb7); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x900); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0xcb3/0xcb7/0x900", \ -+ u1Tmp[0], u1Tmp[1], u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ -+ u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770(hp rx[31:16]/tx[15:0])", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(lp rx[31:16]/tx[15:0])", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+ -+VOID -+EXhalbtc8812a1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u4Byte u4Tmp=0; -+ -+ if(pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm) -+ return; -+ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ pCoexSta->bUnderIps = TRUE; -+ -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ -+ halbtc8812a1ant_InitHwConfig(pBtCoexist, FALSE, FALSE); -+ halbtc8812a1ant_InitCoexDm(pBtCoexist); -+ halbtc8812a1ant_QueryBtInfo(pBtCoexist); -+ -+ pCoexSta->bUnderIps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8812a1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm) -+ return; -+ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ pCoexSta->bUnderLps = TRUE; -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ pCoexSta->bUnderLps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8812a1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ -+ u1Byte u1Tmpa, u1Tmpb; -+ u4Byte u4Tmp; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm ) -+ return; -+ -+ if(BTC_SCAN_START == type) -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ -+ halbtc8812a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); //Force antenna setup for no scan result issue -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &pCoexSta->nScanAPNum); -+ } -+ -+ if(pBtCoexist->btInfo.bBtDisabled) -+ return; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ halbtc8812a1ant_QueryBtInfo(pBtCoexist); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8812a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8812a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8812a1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8812a1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8812a1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if(BTC_SCAN_START == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8812a1ant_ActionWifiNotConnectedScan(pBtCoexist); -+ } -+ else // wifi is connected -+ { -+ halbtc8812a1ant_ActionWifiConnectedScan(pBtCoexist); -+ } -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8812a1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else -+ { -+ halbtc8812a1ant_ActionWifiConnected(pBtCoexist); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8812a1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ halbtc8812a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); //Force antenna setup for no scan result issue -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ pCoexDm->nArpCnt = 0; -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ //pCoexDm->nArpCnt = 0; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8812a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8812a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8812a1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8812a1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8812a1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ halbtc8812a1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8812a1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else -+ { -+ halbtc8812a1ant_ActionWifiConnected(pBtCoexist); -+ } -+ } -+} -+ -+//to check registers... -+VOID -+EXhalbtc8812a1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte dataLen=5; -+ u1Byte buf[6] = {0}; -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ BOOLEAN bWifiUnderBMode = FALSE; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ halbtc8812a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); //Force antenna setup for no scan result issue -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+#if 0 -+ //Set CCK Tx/Rx high Pri except 11b mode -+ if (bWifiUnderBMode) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x00); //CCK Tx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x00); //CCK Rx -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x10); //CCK Tx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x10); //CCK Rx -+ } -+#endif -+ pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ pCoexDm->nArpCnt = 0; -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x0); //CCK Tx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x0); //CCK Rx -+ } -+ -+ // only 2.4G we need to inform bt the chnl mask -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if( (BTC_MEDIA_CONNECT == type) && -+ (wifiCentralChnl <= 14) ) -+ { -+ //H2C_Parameter[0] = 0x1; -+ H2C_Parameter[0] = 0x0; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ buf[0] = dataLen; -+ buf[1] = 0x5; // OP_Code -+ buf[2] = 0x3; // OP_Code_Length -+ buf[3] = H2C_Parameter[0]; // OP_Code_Content -+ buf[4] = H2C_Parameter[1]; -+ buf[5] = H2C_Parameter[2]; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_BT_COEX, (PVOID)&buf[0]); -+} -+ -+VOID -+EXhalbtc8812a1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if( BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ BTC_PACKET_ARP == type ) -+ { -+ if(BTC_PACKET_ARP == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet ARP notify\n")); -+ -+ pCoexDm->nArpCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ARP Packet Count = %d\n", pCoexDm->nArpCnt)); -+ -+ if(pCoexDm->nArpCnt >= 10) // if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecialPacket(pBtCoexist) -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ } -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet DHCP or EAPOL notify\n")); -+ } -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet [Type = %d] notify\n", type)); -+ } -+ -+ pCoexSta->specialPktPeriodCnt = 0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8812a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8812a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8812a1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8812a1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8812a1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if( BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ ( (BTC_PACKET_ARP == type ) && (pCoexSta->bWiFiIsHighPriTask) ) ) -+ { -+ halbtc8812a1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8812a1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bWifiConnected=FALSE; -+ BOOLEAN bBtBusy=FALSE; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ -+ rspSource = tmpBuf[0]&0xf; -+ if(rspSource >= BT_INFO_SRC_8812A_1ANT_MAX) -+ rspSource = BT_INFO_SRC_8812A_1ANT_WIFI_FW; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 1) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ if(BT_INFO_SRC_8812A_1ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = // [3:0] -+ pCoexSta->btInfoC2h[rspSource][2]&0xf; -+ -+ if (pCoexSta->btRetryCnt >= 1) -+ pCoexSta->popEventCnt++; -+ -+ if (pCoexSta->btInfoC2h[rspSource][2]&0x20) -+ pCoexSta->bC2hBtPage = TRUE; -+ else -+ pCoexSta->bC2hBtPage = FALSE; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][3]*2-90; -+ //pCoexSta->btInfoC2h[rspSource][3]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][4]; -+ -+ pCoexSta->bBtTxRxMask = (pCoexSta->btInfoC2h[rspSource][2]&0x40); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TX_RX_MASK, &pCoexSta->bBtTxRxMask); -+ if(!pCoexSta->bBtTxRxMask) -+ { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n")); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); -+ } -+ -+ // Here we need to resend some wifi info to BT -+ // because bt is reset and loss of the info. -+ if(pCoexSta->btInfoExt & BIT1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(bWifiConnected) -+ { -+ EXhalbtc8812a1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT); -+ } -+ else -+ { -+ EXhalbtc8812a1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ } -+ -+ if(pCoexSta->btInfoExt & BIT3) -+ { -+ if(!pBtCoexist->bManualControl && !pBtCoexist->bStopCoexDm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")); -+ halbtc8812a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ } -+ } -+ else -+ { -+ // BT already NOT ignore Wlan active, do nothing here. -+ } -+#if(BT_AUTO_REPORT_ONLY_8812A_1ANT == 0) -+ if( (pCoexSta->btInfoExt & BIT4) ) -+ { -+ // BT auto report already enabled, do nothing -+ } -+ else -+ { -+ halbtc8812a1ant_BtAutoReport(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+#endif -+ } -+ -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8812A_1ANT_B_INQ_PAGE) -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ else -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ -+ // set link exist status -+ if(!(btInfo&BT_INFO_8812A_1ANT_B_CONNECTION)) -+ { -+ pCoexSta->bBtLinkExist = FALSE; -+ pCoexSta->bPanExist = FALSE; -+ pCoexSta->bA2dpExist = FALSE; -+ pCoexSta->bHidExist = FALSE; -+ pCoexSta->bScoExist = FALSE; -+ } -+ else // connection exists -+ { -+ pCoexSta->bBtLinkExist = TRUE; -+ if(btInfo & BT_INFO_8812A_1ANT_B_FTP) -+ pCoexSta->bPanExist = TRUE; -+ else -+ pCoexSta->bPanExist = FALSE; -+ if(btInfo & BT_INFO_8812A_1ANT_B_A2DP) -+ pCoexSta->bA2dpExist = TRUE; -+ else -+ pCoexSta->bA2dpExist = FALSE; -+ if(btInfo & BT_INFO_8812A_1ANT_B_HID) -+ pCoexSta->bHidExist = TRUE; -+ else -+ pCoexSta->bHidExist = FALSE; -+ if(btInfo & BT_INFO_8812A_1ANT_B_SCO_ESCO) -+ pCoexSta->bScoExist = TRUE; -+ else -+ pCoexSta->bScoExist = FALSE; -+ } -+ -+ halbtc8812a1ant_UpdateBtLinkInfo(pBtCoexist); -+ -+ btInfo = btInfo & 0x1f; //mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) -+ -+ if(!(btInfo&BT_INFO_8812A_1ANT_B_CONNECTION)) -+ { -+ pCoexDm->btStatus = BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n")); -+ } -+ else if(btInfo == BT_INFO_8812A_1ANT_B_CONNECTION) // connection exists but no busy -+ { -+ pCoexDm->btStatus = BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n")); -+ } -+ else if((btInfo&BT_INFO_8812A_1ANT_B_SCO_ESCO) || -+ (btInfo&BT_INFO_8812A_1ANT_B_SCO_BUSY)) -+ { -+ pCoexDm->btStatus = BT_8812A_1ANT_BT_STATUS_SCO_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n")); -+ } -+ else if(btInfo&BT_INFO_8812A_1ANT_B_ACL_BUSY) -+ { -+ if(BT_8812A_1ANT_BT_STATUS_ACL_BUSY != pCoexDm->btStatus) -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->btStatus = BT_8812A_1ANT_BT_STATUS_ACL_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n")); -+ } -+ else -+ { -+ pCoexDm->btStatus = BT_8812A_1ANT_BT_STATUS_MAX; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n")); -+ } -+ -+ if( (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8812A_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ bBtBusy = TRUE; -+ else -+ bBtBusy = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ halbtc8812a1ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8812a1ant_RfStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u4Byte u4Tmp; -+ u1Byte u1Tmpa,u1Tmpb, u1Tmpc; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF Status notify\n")); -+ -+ if(BTC_RF_ON == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF is turned ON!!\n")); -+ pBtCoexist->bStopCoexDm = FALSE; -+ } -+ else if(BTC_RF_OFF == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF is turned OFF!!\n")); -+ -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE); -+ -+ halbtc8812a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ pBtCoexist->bStopCoexDm = TRUE; -+ } -+} -+ -+VOID -+EXhalbtc8812a1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE); -+ -+ halbtc8812a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ -+ EXhalbtc8812a1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ -+ pBtCoexist->bStopCoexDm = TRUE; -+} -+ -+VOID -+EXhalbtc8812a1ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify\n")); -+ -+ if(BTC_WIFI_PNP_SLEEP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to SLEEP\n")); -+ -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8812a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE); -+ halbtc8812a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ -+ pBtCoexist->bStopCoexDm = TRUE; -+ } -+ else if(BTC_WIFI_PNP_WAKE_UP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to WAKE UP\n")); -+ pBtCoexist->bStopCoexDm = FALSE; -+ halbtc8812a1ant_InitHwConfig(pBtCoexist, FALSE, FALSE); -+ halbtc8812a1ant_InitCoexDm(pBtCoexist); -+ halbtc8812a1ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8812a1ant_CoexDmReset( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], *****************Coex DM Reset*****************\n")); -+ -+ halbtc8812a1ant_InitHwConfig(pBtCoexist, FALSE, FALSE); -+ halbtc8812a1ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8812a1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static u1Byte disVerInfoCnt=0; -+ u4Byte fwVer=0, btPatchVer=0; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ==========================Periodical===========================\n")); -+ -+ if(disVerInfoCnt <= 5) -+ { -+ disVerInfoCnt += 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ant PG Num/ Ant Mech/ Ant Pos = %d/ %d/ %d\n", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT stack/ hci ext ver = %s / %d\n", -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion)); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", -+ GLCoexVerDate8812a1Ant, GLCoexVer8812a1Ant, fwVer, btPatchVer, btPatchVer)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ } -+ -+#if(BT_AUTO_REPORT_ONLY_8812A_1ANT == 0) -+ halbtc8812a1ant_QueryBtInfo(pBtCoexist); -+ halbtc8812a1ant_MonitorBtEnableDisable(pBtCoexist); -+#else -+ halbtc8812a1ant_MonitorBtCtr(pBtCoexist); -+ halbtc8812a1ant_MonitorWiFiCtr(pBtCoexist); -+ -+ if( halbtc8812a1ant_IsWifiStatusChanged(pBtCoexist) || -+ pCoexDm->bAutoTdmaAdjust ) -+ { -+ halbtc8812a1ant_RunCoexistMechanism(pBtCoexist); -+ } -+ -+ pCoexSta->specialPktPeriodCnt++; -+#endif -+} -+ -+VOID -+EXhalbtc8812a1ant_DbgControl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte opCode, -+ IN u1Byte opLen, -+ IN pu1Byte pData -+ ) -+{ -+ switch(opCode) -+ { -+ case BTC_DBG_SET_COEX_NORMAL: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set CoexMode to Normal\n")); -+ pBtCoexist->bManualControl = FALSE; -+ halbtc8812a1ant_InitCoexDm(pBtCoexist); -+ break; -+ case BTC_DBG_SET_COEX_WIFI_ONLY: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set CoexMode to Wifi Only\n")); -+ pBtCoexist->bManualControl = TRUE; -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+ break; -+ case BTC_DBG_SET_COEX_BT_ONLY: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set CoexMode to BT only\n")); -+ pBtCoexist->bManualControl = TRUE; -+ halbtc8812a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ break; -+ case BTC_DBG_SET_COEX_DEC_BT_PWR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set Dec BT power\n")); -+ { -+ u1Byte dataLen=4; -+ u1Byte buf[6] = {0}; -+ u1Byte decBtPwr=0, pwrLevel=0; -+ if(opLen == 2) -+ { -+ decBtPwr = pData[0]; -+ pwrLevel = pData[1]; -+ -+ buf[0] = dataLen; -+ buf[1] = 0x3; // OP_Code -+ buf[2] = 0x2; // OP_Code_Length -+ -+ buf[3] = decBtPwr; // OP_Code_Content -+ buf[4] = pwrLevel; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set Dec BT power=%d, pwrLevel=%d\n", decBtPwr, pwrLevel)); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_BT_COEX, (PVOID)&buf[0]); -+ } -+ } -+ break; -+ -+ case BTC_DBG_SET_COEX_BT_AFH_MAP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set BT AFH Map\n")); -+ { -+ u1Byte dataLen=5; -+ u1Byte buf[6] = {0}; -+ if(opLen == 3) -+ { -+ buf[0] = dataLen; -+ buf[1] = 0x5; // OP_Code -+ buf[2] = 0x3; // OP_Code_Length -+ -+ buf[3] = pData[0]; // OP_Code_Content -+ buf[4] = pData[1]; -+ buf[5] = pData[2]; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set BT AFH Map = %02x %02x %02x\n", -+ pData[0], pData[1], pData[2])); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_BT_COEX, (PVOID)&buf[0]); -+ } -+ } -+ break; -+ -+ case BTC_DBG_SET_COEX_BT_IGNORE_WLAN_ACT: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set BT Ignore Wlan Active\n")); -+ { -+ u1Byte dataLen=3; -+ u1Byte buf[6] = {0}; -+ if(opLen == 1) -+ { -+ buf[0] = dataLen; -+ buf[1] = 0x1; // OP_Code -+ buf[2] = 0x1; // OP_Code_Length -+ -+ buf[3] = pData[0]; // OP_Code_Content -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set BT Ignore Wlan Active = 0x%x\n", -+ pData[0])); -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_BT_COEX, (PVOID)&buf[0]); -+ } -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8812a1Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8812a1Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8812a1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8812a1Ant.h 2017-06-07 23:07:21.011687576 +0300 -@@ -0,0 +1,258 @@ -+//=========================================== -+// The following is for 8812A 1ANT BT Co-exist definition -+//=========================================== -+#define BT_AUTO_REPORT_ONLY_8812A_1ANT 1 -+ -+#define BT_INFO_8812A_1ANT_B_FTP BIT7 -+#define BT_INFO_8812A_1ANT_B_A2DP BIT6 -+#define BT_INFO_8812A_1ANT_B_HID BIT5 -+#define BT_INFO_8812A_1ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8812A_1ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8812A_1ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8812A_1ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8812A_1ANT_B_CONNECTION BIT0 -+ -+#define BT_INFO_8812A_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT0))? TRUE:FALSE) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT 2 -+ -+#define BT_8812A_1ANT_WIFI_NOISY_THRESH 30 //max: 255 -+ -+typedef enum _BT_INFO_SRC_8812A_1ANT{ -+ BT_INFO_SRC_8812A_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8812A_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8812A_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8812A_1ANT_MAX -+}BT_INFO_SRC_8812A_1ANT,*PBT_INFO_SRC_8812A_1ANT; -+ -+typedef enum _BT_8812A_1ANT_BT_STATUS{ -+ BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8812A_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8812A_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8812A_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8812A_1ANT_BT_STATUS_MAX -+}BT_8812A_1ANT_BT_STATUS,*PBT_8812A_1ANT_BT_STATUS; -+ -+typedef enum _BT_8812A_1ANT_WIFI_STATUS{ -+ BT_8812A_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8812A_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT = 0x3, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8812A_1ANT_WIFI_STATUS_MAX -+}BT_8812A_1ANT_WIFI_STATUS,*PBT_8812A_1ANT_WIFI_STATUS; -+ -+typedef enum _BT_8812A_1ANT_COEX_ALGO{ -+ BT_8812A_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8812A_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8812A_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8812A_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8812A_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8812A_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8812A_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8812A_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8812A_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8812A_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8812A_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8812A_1ANT_COEX_ALGO_MAX = 0xb, -+}BT_8812A_1ANT_COEX_ALGO,*PBT_8812A_1ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8812A_1ANT{ -+ // hw setting -+ u1Byte preAntPosType; -+ u1Byte curAntPosType; -+ // fw mechanism -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ BOOLEAN bAutoTdmaAdjust; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ BOOLEAN bPreBtAutoReport; -+ BOOLEAN bCurBtAutoReport; -+ u1Byte preLps; -+ u1Byte curLps; -+ u1Byte preRpwm; -+ u1Byte curRpwm; -+ -+ // sw mechanism -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ -+ u4Byte backupArfrCnt1; // Auto Rate Fallback Retry cnt -+ u4Byte backupArfrCnt2; // Auto Rate Fallback Retry cnt -+ u2Byte backupRetryLimit; -+ u1Byte backupAmpduMaxTime; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+ -+ u4Byte preRaMask; -+ u4Byte curRaMask; -+ u1Byte preArfrType; -+ u1Byte curArfrType; -+ u1Byte preRetryLimitType; -+ u1Byte curRetryLimitType; -+ u1Byte preAmpduTimeType; -+ u1Byte curAmpduTimeType; -+ u4Byte nArpCnt; -+ -+ u1Byte errorCondition; -+} COEX_DM_8812A_1ANT, *PCOEX_DM_8812A_1ANT; -+ -+typedef struct _COEX_STA_8812A_1ANT{ -+ BOOLEAN bBtLinkExist; -+ BOOLEAN bScoExist; -+ BOOLEAN bA2dpExist; -+ BOOLEAN bHidExist; -+ BOOLEAN bPanExist; -+ -+ BOOLEAN bUnderLps; -+ BOOLEAN bUnderIps; -+ u4Byte specialPktPeriodCnt; -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ s1Byte btRssi; -+ BOOLEAN bBtTxRxMask; -+ u1Byte preBtRssiState; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8812A_1ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8812A_1ANT_MAX]; -+ u4Byte btInfoQueryCnt; -+ BOOLEAN bC2hBtInquiryPage; -+ BOOLEAN bC2hBtPage; //Add for win8.1 page out issue -+ BOOLEAN bWiFiIsHighPriTask; //Add for win8.1 page out issue -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+ u4Byte popEventCnt; -+ u1Byte nScanAPNum; -+ -+ u4Byte nCRCOK_CCK; -+ u4Byte nCRCOK_11g; -+ u4Byte nCRCOK_11n; -+ u4Byte nCRCOK_11nAgg; -+ -+ u4Byte nCRCErr_CCK; -+ u4Byte nCRCErr_11g; -+ u4Byte nCRCErr_11n; -+ u4Byte nCRCErr_11nAgg; -+ -+ BOOLEAN bCCKLock; -+ BOOLEAN bPreCCKLock; -+ u1Byte nCoexTableType; -+ -+ BOOLEAN bForceLpsOn; -+}COEX_STA_8812A_1ANT, *PCOEX_STA_8812A_1ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8812a1ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8812a1ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8812a1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8812a1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8812a1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8812a1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8812a1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8812a1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8812a1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8812a1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8812a1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8812a1ant_RfStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8812a1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8812a1ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ); -+VOID -+EXhalbtc8812a1ant_CoexDmReset( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8812a1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8812a1ant_DbgControl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte opCode, -+ IN u1Byte opLen, -+ IN pu1Byte pData -+ ); -+VOID -+EXhalbtc8812a1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8812a2Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8812a2Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8812a2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8812a2Ant.c 2017-06-07 23:07:21.011687576 +0300 -@@ -0,0 +1,5411 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8812A Co-exist mechanism -+// -+// History -+// 2012/08/22 Cosa first check in. -+// 2012/11/14 Cosa Revise for 8812A 2Ant out sourcing. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8812a2Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8812A_2ANT GLCoexDm8812a2Ant; -+static PCOEX_DM_8812A_2ANT pCoexDm=&GLCoexDm8812a2Ant; -+static COEX_STA_8812A_2ANT GLCoexSta8812a2Ant; -+static PCOEX_STA_8812A_2ANT pCoexSta=&GLCoexSta8812a2Ant; -+ -+const char *const GLBtInfoSrc8812a2Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u4Byte GLCoexVerDate8812a2Ant=20151028; -+u4Byte GLCoexVer8812a2Ant=0x3a; -+//fix 8812AE+8761AU, xtal off as wifi disable -+//fine tune coex. parameter -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8812a2ant_ -+//============================================================ -+u1Byte -+halbtc8812a2ant_BtRssiState( -+ u1Byte levelNum, -+ u1Byte rssiThresh, -+ u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte btRssi=0; -+ u1Byte btRssiState=pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh1) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+u1Byte -+halbtc8812a2ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+VOID -+halbtc8812a2ant_SetEnablePTA( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnablePTA -+ ) -+{ -+ if(bEnablePTA) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PTA is enable!\n")); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x20); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PTA is disable!\n")); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x00); -+ -+ } -+} -+ -+VOID -+halbtc8812a2ant_EnablePTA( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE (COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Enable PTA %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurEnablePTA = bEnable; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bPreEnablePTA = %d, bCurEnablePTA = %d!!\n", -+ pCoexDm->bPreEnablePTA, pCoexDm->bCurEnablePTA)); -+ -+ if(pCoexDm->bPreEnablePTA == pCoexDm->bCurEnablePTA) -+ return; -+ } -+ halbtc8812a2ant_SetEnablePTA(pBtCoexist, bEnable); -+ -+ -+ pCoexDm->bPreEnablePTA = pCoexDm->bCurEnablePTA; -+} -+ -+VOID -+halbtc8812a2ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ // only 8812a need to consider if core stack is installed. -+ if(!pStackInfo->hciVersion) -+ { -+ bBtActive = FALSE; -+ } -+/* -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+*/ -+ -+ if((pCoexSta->prebtInfoC2hCnt_BT_RSP == pCoexSta->btInfoC2hCnt[1]) && -+ (pCoexSta->prebtInfoC2hCnt_BT_SEND == pCoexSta->btInfoC2hCnt[2])) -+ { -+ bBtActive = FALSE; -+ } -+ -+ pCoexSta->prebtInfoC2hCnt_BT_RSP = pCoexSta->btInfoC2hCnt[1]; -+ pCoexSta->prebtInfoC2hCnt_BT_SEND = pCoexSta->btInfoC2hCnt[2]; -+ -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt is detected as disabled %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ } -+ } -+ if(pCoexSta->preBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (pCoexSta->preBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ pCoexSta->preBtDisabled = bBtDisabled; -+ -+ if(!bBtDisabled) -+ { -+ // enable PTA -+// halbtc8812a2ant_EnablePTA(pBtCoexist,FORCE_EXEC, TRUE); -+ } -+ else -+ { -+ // disable PTA -+// halbtc8812a2ant_EnablePTA(pBtCoexist,FORCE_EXEC, FALSE); -+ } -+ } -+} -+ -+u4Byte -+halbtc8812a2ant_DecideRaMask( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte raMaskType -+ ) -+{ -+ u4Byte disRaMask=0x0; -+ -+ switch(raMaskType) -+ { -+ case 0: // normal mode -+ disRaMask = 0x0; -+ break; -+ case 1: // disable cck 1/2 -+ disRaMask = 0x00000003; -+ break; -+ case 2: // disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 -+ disRaMask = 0x0001f1f7; -+ break; -+ default: -+ break; -+ } -+ -+ return disRaMask; -+} -+ -+VOID -+halbtc8812a2ant_UpdateRaMask( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte disRateMask -+ ) -+{ -+ pCoexDm->curRaMask = disRateMask; -+ -+ if( bForceExec || (pCoexDm->preRaMask != pCoexDm->curRaMask)) -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_UPDATE_RAMASK, &pCoexDm->curRaMask); -+ } -+ pCoexDm->preRaMask = pCoexDm->curRaMask; -+} -+ -+VOID -+halbtc8812a2ant_AutoRateFallbackRetry( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiUnderBMode=FALSE; -+ -+ pCoexDm->curArfrType = type; -+ -+ if( bForceExec || (pCoexDm->preArfrType != pCoexDm->curArfrType)) -+ { -+ switch(pCoexDm->curArfrType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, pCoexDm->backupArfrCnt1); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, pCoexDm->backupArfrCnt2); -+ break; -+ case 1: -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ if(bWifiUnderBMode) -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x01010101); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preArfrType = pCoexDm->curArfrType; -+} -+ -+VOID -+halbtc8812a2ant_RetryLimit( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curRetryLimitType = type; -+ -+ if( bForceExec || (pCoexDm->preRetryLimitType != pCoexDm->curRetryLimitType)) -+ { -+ switch(pCoexDm->curRetryLimitType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, pCoexDm->backupRetryLimit); -+ break; -+ case 1: // retry limit=8 -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preRetryLimitType = pCoexDm->curRetryLimitType; -+} -+ -+VOID -+halbtc8812a2ant_AmpduMaxTime( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curAmpduTimeType = type; -+ -+ if( bForceExec || (pCoexDm->preAmpduTimeType != pCoexDm->curAmpduTimeType)) -+ { -+ switch(pCoexDm->curAmpduTimeType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, pCoexDm->backupAmpduMaxTime); -+ break; -+ case 1: // AMPDU timw = 0x38 * 32us -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preAmpduTimeType = pCoexDm->curAmpduTimeType; -+} -+ -+VOID -+halbtc8812a2ant_LimitedTx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte raMaskType, -+ IN u1Byte arfrType, -+ IN u1Byte retryLimitType, -+ IN u1Byte ampduTimeType -+ ) -+{ -+ u4Byte disRaMask=0x0; -+ -+ pCoexDm->curRaMaskType = raMaskType; -+ disRaMask = halbtc8812a2ant_DecideRaMask(pBtCoexist, raMaskType); -+ halbtc8812a2ant_UpdateRaMask(pBtCoexist, bForceExec, disRaMask); -+ -+ halbtc8812a2ant_AutoRateFallbackRetry(pBtCoexist, bForceExec, arfrType); -+ halbtc8812a2ant_RetryLimit(pBtCoexist, bForceExec, retryLimitType); -+ halbtc8812a2ant_AmpduMaxTime(pBtCoexist, bForceExec, ampduTimeType); -+} -+ -+VOID -+halbtc8812a2ant_LimitedRx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRejApAggPkt, -+ IN BOOLEAN bBtCtrlAggBufSize, -+ IN u1Byte aggBufSize -+ ) -+{ -+ BOOLEAN bRejectRxAgg=bRejApAggPkt; -+ BOOLEAN bBtCtrlRxAggSize=bBtCtrlAggBufSize; -+ u1Byte rxAggSize=aggBufSize; -+ -+ //============================================ -+ // Rx Aggregation related setting -+ //============================================ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg); -+ // decide BT control aggregation buf size or not -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize); -+ // aggregation buf size, only work when BT control Rx aggregation size. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize); -+ // real update aggregation setting -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+VOID -+halbtc8812a2ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp; -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+} -+ -+VOID -+halbtc8812a2ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte dataLen=3; -+ u1Byte buf[5] = {0}; -+//8812a watch btifo to check BT enable/disable -+// if(!pBtCoexist->btInfo.bBtDisabled) -+ { -+ if(!pCoexSta->btInfoQueryCnt || -+ (pCoexSta->btInfoC2hCnt[BT_INFO_SRC_8812A_2ANT_BT_RSP]-pCoexSta->btInfoQueryCnt)>2) -+ { -+ buf[0] = dataLen; -+ buf[1] = 0x1; // polling enable, 1=enable, 0=disable -+ buf[2] = 0x2; // polling time in seconds -+ buf[3] = 0x1; // auto report enable, 1=enable, 0=disable -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_BT_INFO, (PVOID)&buf[0]); -+ } -+ } -+ pCoexSta->btInfoQueryCnt++; -+} -+ -+BOOLEAN -+halbtc8812a2ant_IsWifiStatusChanged( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreWifiBusy=FALSE, bPreUnder4way=FALSE, bPreBtHsOn=FALSE; -+ BOOLEAN bWifiBusy=FALSE, bUnder4way=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bWifiConnected=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ -+ if(bWifiConnected) -+ { -+ if(bWifiBusy != bPreWifiBusy) -+ { -+ bPreWifiBusy = bWifiBusy; -+ return TRUE; -+ } -+ if(bUnder4way != bPreUnder4way) -+ { -+ bPreUnder4way = bUnder4way; -+ return TRUE; -+ } -+ if(bBtHsOn != bPreBtHsOn) -+ { -+ bPreBtHsOn = bBtHsOn; -+ return TRUE; -+ } -+ } -+ -+ return FALSE; -+} -+ -+VOID -+halbtc8812a2ant_UpdateBtLinkInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ -+#if 1//(BT_AUTO_REPORT_ONLY_8812A_2ANT == 1) // profile from bt patch -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pCoexSta->bScoExist; -+ pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist; -+ pBtLinkInfo->bPanExist = pCoexSta->bPanExist; -+ pBtLinkInfo->bHidExist = pCoexSta->bHidExist; -+ pBtLinkInfo->bAclBusy = pCoexSta->bAclBusy; -+ -+ // work around for HS mode. -+ if(bBtHsOn) -+ { -+ pBtLinkInfo->bPanExist = TRUE; -+ pBtLinkInfo->bBtLinkExist = TRUE; -+ } -+#else // profile from bt stack -+ pBtLinkInfo->bBtLinkExist = pStackInfo->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pStackInfo->bScoExist; -+ pBtLinkInfo->bA2dpExist = pStackInfo->bA2dpExist; -+ pBtLinkInfo->bPanExist = pStackInfo->bPanExist; -+ pBtLinkInfo->bHidExist = pStackInfo->bHidExist; -+ -+ //for win-8 stack HID report error -+ if(!pStackInfo->bHidExist) -+ pStackInfo->bHidExist = pCoexSta->bHidExist; //sync BTInfo with BT firmware and stack -+ // when stack HID report error, here we use the info from bt fw. -+ if(!pStackInfo->bBtLinkExist) -+ pStackInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+#endif -+ // check if Sco only -+ if( pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bScoOnly = TRUE; -+ else -+ pBtLinkInfo->bScoOnly = FALSE; -+ -+ // check if A2dp only -+ if( !pBtLinkInfo->bScoExist && -+ pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bA2dpOnly = TRUE; -+ else -+ pBtLinkInfo->bA2dpOnly = FALSE; -+ -+ // check if Pan only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bPanOnly = TRUE; -+ else -+ pBtLinkInfo->bPanOnly = FALSE; -+ -+ // check if Hid only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bHidOnly = TRUE; -+ else -+ pBtLinkInfo->bHidOnly = FALSE; -+} -+ -+u1Byte -+halbtc8812a2ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ u1Byte algorithm=BT_8812A_2ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!pBtLinkInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No BT link exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pBtLinkInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(numOfDiffProfile == 0) -+ { -+ if(pBtLinkInfo->bAclBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ACL Busy only\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ else if(numOfDiffProfile == 1) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO only\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_A2DP; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(HS) only\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(EDR) only\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 2) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(HS)\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(EDR)\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(pStackInfo->numOfHid >= 2) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID*2 + A2DP\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(HS)\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_HID; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(EDR)\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(HS)\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_A2DP_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(EDR)\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP ==> HID\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(HS)\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO_HID; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(EDR)\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile >= 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+VOID -+halbtc8812a2ant_SetFwDacSwingLevel( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte dacSwingLvl -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ // There are several type of dacswing -+ // 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 -+ H2C_Parameter[0] = dacSwingLvl; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Set Dac Swing Level=0x%x\n", dacSwingLvl)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x64=0x%x\n", H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x64, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8812a2ant_SetFwDecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte decBtPwrLvl -+ ) -+{ -+ u1Byte dataLen=4; -+ u1Byte buf[6] = {0}; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], decrease Bt Power level = %d\n", -+ decBtPwrLvl)); -+ -+ buf[0] = dataLen; -+ buf[1] = 0x3; // OP_Code -+ buf[2] = 0x2; // OP_Code_Length -+ if(decBtPwrLvl) -+ buf[3] = 0x1; // OP_Code_Content -+ else -+ buf[3] = 0x0; -+ buf[4] = decBtPwrLvl;// pwrLevel -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_BT_COEX, (PVOID)&buf[0]); -+} -+ -+VOID -+halbtc8812a2ant_DecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte decBtPwrLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s Dec BT power level = %d\n", -+ (bForceExec? "force to":""), decBtPwrLvl)); -+ pCoexDm->curBtDecPwrLvl = decBtPwrLvl; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->preBtDecPwrLvl == pCoexDm->curBtDecPwrLvl) -+ return; -+ } -+ halbtc8812a2ant_SetFwDecBtPwr(pBtCoexist, pCoexDm->curBtDecPwrLvl); -+ -+ pCoexDm->preBtDecPwrLvl = pCoexDm->curBtDecPwrLvl; -+} -+ -+VOID -+halbtc8812a2ant_FwDacSwingLvl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte fwDacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set FW Dac Swing level = %d\n", -+ (bForceExec? "force to":""), fwDacSwingLvl)); -+ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->preFwDacSwingLvl == pCoexDm->curFwDacSwingLvl) -+ return; -+ } -+ -+ halbtc8812a2ant_SetFwDacSwingLevel(pBtCoexist, pCoexDm->curFwDacSwingLvl); -+ -+ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -+} -+ -+VOID -+halbtc8812a2ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xffffc); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+VOID -+halbtc8812a2ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8812a2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8812a2ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte tmpU1; -+ -+ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); -+ tmpU1 |= BIT0; -+ if(bLowPenaltyRa) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); -+ tmpU1 &= ~BIT2; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); -+ tmpU1 |= BIT2; -+ } -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -+} -+ -+VOID -+halbtc8812a2ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ return; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8812a2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8812a2ant_SetDacSwingReg( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte level -+ ) -+{ -+ u1Byte val=(u1Byte)level; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Write SwDacSwing = 0x%x\n", level)); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xc5b, 0x3e, val); -+} -+ -+VOID -+halbtc8812a2ant_SetSwFullTimeDacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSwDacSwingOn, -+ IN u4Byte swDacSwingLvl -+ ) -+{ -+ if(bSwDacSwingOn) -+ { -+ halbtc8812a2ant_SetDacSwingReg(pBtCoexist, swDacSwingLvl); -+ } -+ else -+ { -+ halbtc8812a2ant_SetDacSwingReg(pBtCoexist, 0x18); -+ } -+} -+ -+ -+VOID -+halbtc8812a2ant_DacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacSwingOn, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", -+ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); -+ pCoexDm->bCurDacSwingOn = bDacSwingOn; -+ pCoexDm->curDacSwingLvl = dacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && -+ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) -+ return; -+ } -+ delay_ms(30); -+ halbtc8812a2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); -+ -+ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; -+ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -+} -+ -+VOID -+halbtc8812a2ant_SetAdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ if(bAdcBackOff) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x8db, 0x60, 0x3); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x8db, 0x60, 0x1); -+ } -+} -+ -+VOID -+halbtc8812a2ant_AdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", -+ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); -+ pCoexDm->bCurAdcBackOff = bAdcBackOff; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) -+ return; -+ } -+ halbtc8812a2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); -+ -+ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -+} -+ -+VOID -+halbtc8812a2ant_SetAgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ u1Byte rssiAdjustVal=0; -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x28F4B); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x10AB2); -+ rssiAdjustVal = 8; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x2884B); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x104B2); -+ } -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); -+ -+ // set rssiAdjustVal for wifi module. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -+} -+ -+VOID -+halbtc8812a2ant_AgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", -+ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); -+ pCoexDm->bCurAgcTableEn = bAgcTableEn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) -+ return; -+ } -+ halbtc8812a2ant_SetAgcTable(pBtCoexist, bAgcTableEn); -+ -+ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -+} -+ -+VOID -+halbtc8812a2ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8812a2ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c4, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8812a2ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8812a2ant_CoexTableWithType( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ switch(type) -+ { -+ case 0: -+ halbtc8812a2ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8812a2ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8812a2ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5ffb5ffb, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8812a2ant_CoexTable(pBtCoexist, bForceExec, 0x5fdf5fdf, 0x5fdb5fdb, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8812a2ant_CoexTable(pBtCoexist, bForceExec, 0xdfffdfff, 0x5fdb5fdb, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8812a2ant_CoexTable(pBtCoexist, bForceExec, 0x5ddd5ddd, 0x5fdb5fdb, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8812a2ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 7: -+ if(pCoexSta->nScanAPNum <= 5) -+ halbtc8812a2ant_CoexTable(pBtCoexist, bForceExec, 0xffffffff, 0xfafafafa, 0xffffff, 0x3); -+ else -+ halbtc8812a2ant_CoexTable(pBtCoexist, bForceExec, 0xffffffff, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 8: -+ halbtc8812a2ant_CoexTable(pBtCoexist, bForceExec, 0x5f5f5f5f, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8812a2ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte dataLen=3; -+ u1Byte buf[5] = {0}; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s BT Ignore Wlan_Act\n", -+ (bEnable? "Enable":"Disable"))); -+ -+ buf[0] = dataLen; -+ buf[1] = 0x1; // OP_Code -+ buf[2] = 0x1; // OP_Code_Length -+ if(bEnable) -+ buf[3] = 0x1; // OP_Code_Content -+ else -+ buf[3] = 0x0; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_BT_COEX, (PVOID)&buf[0]); -+} -+ -+VOID -+halbtc8812a2ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8812a2ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8812a2ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ u1Byte realByte1=byte1, realByte5=byte5; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ if(bApEnable) -+ { -+ if(byte1&BIT4 && !(byte1&BIT5)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FW for 1Ant AP mode\n")); -+ realByte1 &= ~BIT4; -+ realByte1 |= BIT5; -+ -+ realByte5 |= BIT5; -+ realByte5 &= ~BIT6; -+ } -+ } -+ -+ H2C_Parameter[0] = realByte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = realByte5; -+ -+ -+ pCoexDm->psTdmaPara[0] = realByte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = realByte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], PS-TDMA H2C cmd =0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter); -+} -+ -+VOID -+halbtc8812a2ant_SetLpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ u1Byte lps=lpsVal; -+ u1Byte rpwm=rpwmVal; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+VOID -+halbtc8812a2ant_LpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bForceExecPwrCmd=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set lps/rpwm=0x%x/0x%x \n", -+ (bForceExec? "force to":""), lpsVal, rpwmVal)); -+ pCoexDm->curLps = lpsVal; -+ pCoexDm->curRpwm = rpwmVal; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preLps == pCoexDm->curLps) && -+ (pCoexDm->preRpwm == pCoexDm->curRpwm) ) -+ { -+ return; -+ } -+ } -+ halbtc8812a2ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal); -+ -+ pCoexDm->preLps = pCoexDm->curLps; -+ pCoexDm->preRpwm = pCoexDm->curRpwm; -+} -+ -+VOID -+halbtc8812a2ant_SwMechanism1( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bShrinkRxLPF, -+ IN BOOLEAN bLowPenaltyRA, -+ IN BOOLEAN bLimitedDIG, -+ IN BOOLEAN bBTLNAConstrain -+ ) -+{ -+ /* -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if(BTC_WIFI_BW_HT40 != wifiBw) //only shrink RF Rx LPF for HT40 -+ { -+ if (bShrinkRxLPF) -+ bShrinkRxLPF = FALSE; -+ } -+ */ -+ -+ halbtc8812a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, bShrinkRxLPF); -+ //halbtc8812a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA); -+} -+ -+VOID -+halbtc8812a2ant_SwMechanism2( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAGCTableShift, -+ IN BOOLEAN bADCBackOff, -+ IN BOOLEAN bSWDACSwing, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ //halbtc8812a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, bAGCTableShift); -+ halbtc8812a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, bADCBackOff); -+ halbtc8812a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, bSWDACSwing, dacSwingLvl); -+} -+ -+VOID -+halbtc8812a2ant_SetAntPath( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte antPosType, -+ IN BOOLEAN bInitHwCfg, -+ IN BOOLEAN bWifiOff -+ ) -+{ -+ u1Byte u1Tmp=0; -+ -+ if(bInitHwCfg) -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x900, 0x00000400); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76d, 0x1); -+ } -+ else if(bWifiOff) -+ { -+ -+ } -+ -+ // ext switch setting -+ switch(antPosType) -+ { -+ case BTC_ANT_WIFI_AT_CPL_MAIN: -+ break; -+ case BTC_ANT_WIFI_AT_CPL_AUX: -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xcb7); -+ u1Tmp &= ~BIT3; -+ u1Tmp |= BIT2; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xcb7, u1Tmp); -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8812a2ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bTurnOnByCnt=FALSE; -+ u1Byte psTdmaTypeByCnt=0; -+ s1Byte nWiFiDurationAdjust = 0x0; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", -+ (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ if(!bForceExec) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bPrePsTdmaOn = %d, bCurPsTdmaOn = %d!!\n", -+ pCoexDm->bPrePsTdmaOn, pCoexDm->bCurPsTdmaOn)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], prePsTdma = %d, curPsTdma = %d!!\n", -+ pCoexDm->prePsTdma, pCoexDm->curPsTdma)); -+ -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ -+ if (pCoexSta->nScanAPNum >= 40) -+ nWiFiDurationAdjust = -15; -+ else if (pCoexSta->nScanAPNum >= 20) -+ nWiFiDurationAdjust = -10; -+ -+/* -+ if (!pCoexSta->bForceLpsOn) //only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 -+ { -+ psTdmaByte0Val = 0x61; //no null-pkt -+ psTdmaByte3Val = 0x11; // no tx-pause at BT-slot -+ psTdmaByte4Val = 0x10; // 0x778 = d/1 toggle -+ } -+ -+ -+ if ( (type == 3) || (type == 13) || (type == 14) ) -+ { -+ psTdmaByte4Val = psTdmaByte4Val & 0xbf; //no dynamic slot for multi-profile -+ -+ if (!bWifiBusy) -+ psTdmaByte4Val = psTdmaByte4Val | 0x1; //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) -+ } -+ -+ if (pBtLinkInfo->bSlaveRole == TRUE) -+ psTdmaByte4Val = psTdmaByte4Val | 0x1; //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) -+ -+*/ -+ if(bTurnOn) -+ { -+ switch(type) -+ { -+ case 1: -+ default: //d1,wb -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0x11, 0x10); -+ break; -+ case 2: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x32, 0x03, 0x11, 0x10); -+ break; -+ case 3: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x28, 0x03, 0x11, 0x10); -+ break; -+ case 4: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1e, 0x03, 0x11, 0x10); -+ break; -+ case 5: //d1,pb,TXpause -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x63, 0x3c, 0x03, 0x90, 0x10); -+ break; -+ case 6: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x63, 0x32, 0x03, 0x90, 0x10); -+ break; -+ case 7: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x63, 0x28, 0x03, 0x90, 0x10); -+ break; -+ case 8: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x63, 0x1e, 0x03, 0x90, 0x10); -+ break; -+ case 9: //d1,bb -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0x31, 0x10); -+ break; -+ case 10: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x32, 0x03, 0x31, 0x10); -+ break; -+ case 11: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x28, 0x03, 0x31, 0x10); -+ break; -+ case 12: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1e, 0x03, 0x31, 0x10); -+ break; -+ case 13: //d1,bb,TXpause -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0x30, 0x10); -+ break; -+ case 14: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x32, 0x03, 0x30, 0x10); -+ break; -+ case 15: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x28, 0x03, 0x30, 0x10); -+ break; -+ case 16: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1e, 0x03, 0x30, 0x10); -+ break; -+ case 17: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x61, 0x35, 0x3, 0x11, 0x11); -+ break; -+ case 18: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 19: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0xe1, 0x90); -+ break; -+ case 20: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0x60, 0x90); -+ break; -+ case 21: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x3, 0x70, 0x90); -+ break; -+ case 22: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x61, 0x1a, 0x1a, 0x21, 0x10); -+ break; -+ case 23: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x03, 0x31, 0x10); -+ break; -+ -+ case 71: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ break; -+ -+ // following cases is for wifi rssi low, started from 81 -+ case 80: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x53, 0x3c, 0x3, 0x90, 0x50); -+ break; -+ case 81: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x53, 0x3a+nWiFiDurationAdjust, 0x3, 0x90, 0x50); -+ break; -+ case 82: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x53, 0x30+nWiFiDurationAdjust, 0x03, 0x90, 0x50); -+ break; -+ case 83: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x53, 0x21, 0x03, 0x90, 0x50); -+ break; -+ case 84: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x53, 0x15, 0x3, 0x90, 0x50); -+ break; -+ case 85: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x53, 0x1d, 0x1d, 0x80, 0x50); -+ break; -+ case 86: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x53, 0x15, 0x15, 0x80, 0x50); -+ break; -+ } -+ } -+ else -+ { -+ // disable PS tdma -+ switch(type) -+ { -+ case 0: //ANT2PTA, 0x778=0x1 -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x8, 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 1: //ANT2BT, 0x778=3 -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x8, 0x0); -+ delay_ms(5); -+ halbtc8812a2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_CPL_AUX, FALSE, FALSE); -+ break; -+ default: -+ halbtc8812a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ break; -+ } -+ } -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+VOID -+halbtc8812a2ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw all off -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ // hw all off -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8812a2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 6); -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, FORCE_EXEC, 0); -+ -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+VOID -+halbtc8812a2ant_PsTdmaCheckForPowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bNewPsState -+ ) -+{ -+ u1Byte lpsMode=0x0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode); -+ -+ if(lpsMode) // already under LPS state -+ { -+ if(bNewPsState) -+ { -+ // keep state under LPS, do nothing. -+ } -+ else -+ { -+ // will leave LPS state, turn off psTdma first -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ } -+ else // NO PS state -+ { -+ if(bNewPsState) -+ { -+ // will enter LPS state, turn off psTdma first -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ else -+ { -+ // keep state under NO PS state, do nothing. -+ } -+ } -+} -+ -+VOID -+halbtc8812a2ant_PowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte psType, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bLowPwrDisable=FALSE; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ if(bApEnable) -+ { -+ psType = BTC_PS_WIFI_NATIVE; -+ lpsVal = 0x0; -+ rpwmVal = 0x0; -+ } -+ switch(psType) -+ { -+ case BTC_PS_WIFI_NATIVE: -+ // recover to original 32k low power setting -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8812a2ant_PsTdmaCheckForPowerSaveState(pBtCoexist, TRUE); -+ halbtc8812a2ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal); -+ // when coex force to enter LPS, do not enter 32k low power. -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ // power save must executed before psTdma. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); -+ pCoexSta->bForceLpsOn = TRUE; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8812a2ant_PsTdmaCheckForPowerSaveState(pBtCoexist, FALSE); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8812a2ant_ActionBtInquiry( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+BOOLEAN -+halbtc8812a2ant_IsCommonAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE, bWifiBusy=FALSE; -+ BOOLEAN bBtHsOn=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is under inquiry/page scan !!\n")); -+ halbtc8812a2ant_ActionBtInquiry(pBtCoexist); -+ return TRUE; -+ } -+ -+ if(pBtLinkInfo->bScoExist || pBtLinkInfo->bHidExist) -+ { -+ halbtc8812a2ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 0, 0, 0); -+ } -+ else -+ { -+ halbtc8812a2ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ } -+ -+ if(!bWifiConnected) -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-connected idle!!\n")); -+ -+ if( (BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) || -+ (BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 1); -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ else -+ { -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ if(BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT non connected-idle!!\n")); -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else if(BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+ if(bBtHsOn) -+ return FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT connected-idle!!\n")); -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ if(bWifiBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n")); -+ bCommon = FALSE; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n")); -+ -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 17); -+ -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ bCommon = TRUE; -+ } -+ } -+ } -+ -+ return bCommon; -+} -+ -+VOID -+halbtc8812a2ant_TdmaDurationAdjust( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bScoHid, -+ IN BOOLEAN bTxPause, -+ IN u1Byte maxInterval -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjust()\n")); -+ -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ -+ if(!pCoexDm->bAutoTdmaAdjust) -+ { -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ { -+ if(bScoHid) -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ else -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ } -+ } -+ } -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], retryCount = %d\n", retryCount)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], up=%d, dn=%d, m=%d, n=%d, WaitCount=%d\n", -+ up, dn, m, n, WaitCount)); -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], max Interval = %d\n", maxInterval)); -+ if(maxInterval == 1) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 2) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 3) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ } -+ } -+ -+ // if current PsTdma not match with the recorded one (when scan, dhcp...), -+ // then we have to adjust it back to the previous record one. -+ if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) -+ { -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", -+ pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if( !bScan && !bLink && !bRoam) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); -+ } -+ } -+} -+ -+//================== -+// pstdma for wifi rssi low -+//================== -+VOID -+halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow( -+ IN PBTC_COEXIST pBtCoexist//, -+ //IN u1Byte wifiStatus -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0, btInfoExt; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow()\n")); -+#if 0 -+ if( (BT_8812A_2ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == wifiStatus) || -+ (BT_8812A_2ANT_WIFI_STATUS_CONNECTED_SCAN == wifiStatus) || -+ (BT_8812A_2ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT == wifiStatus) ) -+ { -+ if( pCoexDm->curPsTdma != 81 && -+ pCoexDm->curPsTdma != 82 && -+ pCoexDm->curPsTdma != 83 && -+ pCoexDm->curPsTdma != 84 ) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 82); -+ pCoexDm->psTdmaDuAdjType = 82; -+ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ return; -+ } -+#endif -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ -+ retryCount = pCoexSta->btRetryCnt; -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if(!pCoexDm->bAutoTdmaAdjustLowRssi) -+ { -+ pCoexDm->bAutoTdmaAdjustLowRssi = TRUE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjustForWifiRssiLow()!!\n")); -+ -+ if(BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(btInfoExt)) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 83); -+ pCoexDm->psTdmaDuAdjType = 83; -+ } -+ else -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 82); -+ pCoexDm->psTdmaDuAdjType = 82; -+ } -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+// retryCount = pCoexSta->btRetryCnt; -+// btInfoExt = pCoexSta->btInfoExt; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], retryCount = %d\n", retryCount)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], up=%d, dn=%d, m=%d, n=%d, WaitCount=%d\n", -+ up, dn, m, n, WaitCount)); -+ result = 0; -+ WaitCount++; -+ -+ if ( (pCoexSta->lowPriorityTx) > 1050 || (pCoexSta->lowPriorityRx) > 1250 ) -+ retryCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ if(result == -1) -+ { -+/* -+ if( (BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 81) ||(pCoexDm->curPsTdma == 82)) ) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 84); -+ pCoexDm->psTdmaDuAdjType = 84; -+ } -+*/ -+ if(pCoexDm->curPsTdma == 80) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 82); -+ pCoexDm->psTdmaDuAdjType = 82; -+ } -+ else if(pCoexDm->curPsTdma == 81) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 82); -+ pCoexDm->psTdmaDuAdjType = 82; -+ } -+ else if(pCoexDm->curPsTdma == 82) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 83); -+ pCoexDm->psTdmaDuAdjType = 83; -+ } -+ else if(pCoexDm->curPsTdma == 83) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 84); -+ pCoexDm->psTdmaDuAdjType = 84; -+ } -+ } -+ else if(result == 1) -+ { -+/* -+ if( (BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 81) ||(pCoexDm->curPsTdma == 82)) ) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 83); -+ pCoexDm->psTdmaDuAdjType = 83; -+ } -+*/ -+ if(pCoexDm->curPsTdma == 84) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 83); -+ pCoexDm->psTdmaDuAdjType = 83; -+ } -+ else if(pCoexDm->curPsTdma == 83) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 82); -+ pCoexDm->psTdmaDuAdjType = 82; -+ } -+ else if(pCoexDm->curPsTdma == 82) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 81); -+ pCoexDm->psTdmaDuAdjType = 81; -+ } -+ else if((pCoexDm->curPsTdma == 81)&&((pCoexSta->nScanAPNum <= 5))) -+ { -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 81); -+ pCoexDm->psTdmaDuAdjType = 81; -+ } -+ } -+ -+ if( pCoexDm->curPsTdma != 80 && -+ pCoexDm->curPsTdma != 81 && -+ pCoexDm->curPsTdma != 82 && -+ pCoexDm->curPsTdma != 83 && -+ pCoexDm->curPsTdma != 84 ) -+ { -+ // recover to previous adjust type -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ } -+} -+ -+VOID -+halbtc8812a2ant_GetBtRssiThreshold( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte pThres0, -+ IN pu1Byte pThres1 -+ ) -+{ -+ u1Byte antType, btThreshold=0; -+ -+// pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_ANT_TYPE, &antType); -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ -+ antType = pBoardInfo->antType; -+ -+ -+ switch(antType) -+ { -+ case BTC_ANT_TYPE_0: -+ *pThres0 = 100; -+ *pThres1 = 100; -+ break; -+ case BTC_ANT_TYPE_1: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ case BTC_ANT_TYPE_2: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ case BTC_ANT_TYPE_3: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ case BTC_ANT_TYPE_4: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+ -+VOID -+halbtc8812a2ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0; -+ -+ -+// halbtc8812a2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8812a2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // coex table -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ else -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ -+ // pstdma -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ else -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+ -+ // limited Rx -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x6); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x6); -+ } -+ } -+ else -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x6); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x6); -+ } -+ } -+} -+ -+VOID -+halbtc8812a2ant_ActionScoHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0; -+ -+// halbtc8812a2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8812a2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // coex table -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ -+ // pstdma -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ else -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+ -+ // limited Rx -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x8); -+ -+ // fw dac swing level -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x6); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x6); -+ } -+ } -+ else -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x6); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x6); -+ } -+ } -+} -+ -+VOID -+halbtc8812a2ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte anttype=0; -+ -+ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ -+ anttype = pBoardInfo->antType; -+ -+ -+// halbtc8812a2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+// btRssiState = halbtc8812a2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8812a2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, 34, 42); -+ -+ -+ if(anttype == 0)//ANTTYPE = 0 92E 2ant with SPDT -+ { -+ // power save state & pstdma & coex table -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if(anttype == 1) //92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation -+ { -+ // power save state & pstdma & coex table -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if(anttype == 2)//ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 9); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 9); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 9); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ } -+ } -+ else if(anttype == 3) //ANTTYPE = 3, 92E 3ant with good ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ } -+ else //ANTTYPE = 4 for test -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ -+ -+ // power save state -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // coex table -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // pstdma -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ -+ // decrease BT power -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // limited Rx -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -+VOID -+halbtc8812a2ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte anttype=0; -+ BOOLEAN bApEnable=FALSE; -+ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ anttype = pBoardInfo->antType; -+ -+// halbtc8812a2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+// btRssiState = halbtc8812a2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8812a2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, 34, 42); -+ -+// anttype = 4; -+ -+ if(anttype == 0)//ANTTYPE = 0 92E 2ant with SPDT -+ { -+ -+ if((pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ -+ // power save state & pstdma & coex table -+/* -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+*/ -+ } -+ else if(anttype == 1) //92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); //shielding room -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ -+ } -+ else if(anttype == 2)//ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ else if(anttype == 3) //ANTTYPE = 3, 92E 3ant with good ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ } -+ else //ANTTYPE = 4 for test -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ -+ // decrease BT power -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // decrease BT power -+/* -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else if (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A) // BT HIGH RSSI & shielding room -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ // limited Rx -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8812a2ant_ActionA2dpPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0; -+ -+// halbtc8812a2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8812a2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ -+ // pstdma -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 2); -+ else -+ halbtc8812a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 2); -+ -+ // decrease BT power -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+/* -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ // limited Rx -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x6); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x6); -+ } -+ } -+ else -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x6); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x6); -+ } -+ } -+} -+ -+VOID -+halbtc8812a2ant_ActionPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte anttype=0; -+ u1Byte btThresh0=0, btThresh1=0; -+ -+ -+ -+ halbtc8812a2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8812a2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+// btRssiState = halbtc8812a2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ // coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // pstdma -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ else -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 85); -+ -+ // decrease BT power -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // limited Rx -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+//PAN(HS) only -+VOID -+halbtc8812a2ant_ActionPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8812a2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // coex table -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ -+ // pstdma -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ -+ // decrease BT power -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+/* -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ // limited Rx -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+//PAN(EDR)+A2DP -+VOID -+halbtc8812a2ant_ActionPanEdrA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0; -+ -+ halbtc8812a2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8812a2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ // btRssiState = halbtc8812a2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ // coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // pstdma -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); -+ else -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 86); -+ } -+ -+ // decrease BT power -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // limited Rx -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+ -+VOID -+halbtc8812a2ant_ActionPanEdrHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0; -+ -+ -+ halbtc8812a2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8812a2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+// btRssiState = halbtc8812a2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else if(BTC_RSSI_LOW(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ // coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ else if(BTC_RSSI_LOW(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ else -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // pstdma -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ else if(BTC_RSSI_LOW(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ else -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 85); -+ -+ // decrease BT power -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+/* -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ // limited Rx -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ else if(BTC_RSSI_LOW(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ else -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x8); -+ -+ // fw dac swing level -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+// HID+A2DP+PAN(EDR) -+VOID -+halbtc8812a2ant_ActionHidA2dpPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0; -+ -+ halbtc8812a2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8812a2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+// btRssiState = halbtc8812a2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else if(BTC_RSSI_LOW(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ // coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ else if(BTC_RSSI_LOW(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ else -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // pstdma -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); -+ else if(BTC_RSSI_LOW(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ else -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ halbtc8812a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 86); -+ } -+ -+ // decrease BT power -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+/* -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ // limited Rx -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ else if(BTC_RSSI_LOW(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ else -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x8); -+ -+ -+ // fw dac swing level -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8812a2ant_ActionHidA2dpPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0; -+ -+ halbtc8812a2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ -+ wifiRssiState = halbtc8812a2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+// btRssiState = halbtc8812a2ant_BtRssiState(3, 34, 42); -+ -+ // power save state -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3); -+ else if(BTC_RSSI_LOW(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ else -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // pstdma -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 2); -+ else if(BTC_RSSI_LOW(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ else -+ halbtc8812a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ -+ // decrease BT power -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+/* -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ // limited Rx -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ else if(BTC_RSSI_LOW(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState))) -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ else -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x8); -+ -+ // fw dac swing level -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8812a2ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH, btRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw; -+ u1Byte btThresh0=0, btThresh1=0, anttype=0; -+ -+ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ -+ anttype = pBoardInfo->antType; -+ -+ -+// halbtc8812a2ant_GetBtRssiThreshold(pBtCoexist, &btThresh0, &btThresh1); -+// btRssiState = halbtc8812a2ant_BtRssiState(3, btThresh0, btThresh1); -+ -+ wifiRssiState = halbtc8812a2ant_WifiRssiState(pBtCoexist, 0, 2, 34, 0); -+ btRssiState = halbtc8812a2ant_BtRssiState(3, 34, 42); -+ -+ if(anttype == 0)//ANTTYPE = 0 92E 2ant with SPDT -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A)) -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 83); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 83); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ } -+ else if(anttype == 1) //92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A)) -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 83); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ } -+ else if(anttype == 2)//ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, 83); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ } -+ } -+ else if(anttype == 3) //ANTTYPE = 3, 92E 3ant with good ant. isolation -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ } -+ else //ANTTYPE = 4 for test -+ { -+ // power save state & pstdma & coex table -+ if(BTC_RSSI_HIGH(wifiRssiState) && (!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & shielding room -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else if (BTC_RSSI_HIGH(wifiRssiState)&&(!BTC_RSSI_LOW(btRssiState)) && (pCoexSta->nScanAPNum > NOISY_AP_NUM_THRESH_8812A)) -+ { //WIFI RSSI = high & BT RSSI = high & noisy enviroment -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else //WIFI RSSI || BT RSSI == low -+ { -+ halbtc8812a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8812a2ant_TdmaDurationAdjustForWifiRssiLow(pBtCoexist); -+ halbtc8812a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ } -+ -+ // decrease BT power -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+/* -+ // decrease BT power -+ if(BTC_RSSI_LOW(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else if (pCoexSta->nScanAPNum < NOISY_AP_NUM_THRESH_8812A) // BT HIGH RSSI & shielding room -+ halbtc8812a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+*/ -+ // limited Rx -+ halbtc8812a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ // fw dac swing level -+ halbtc8812a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if(BTC_RSSI_HIGH(wifiRssiState)) -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8812a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8812a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8812a2ant_CoexUnder5G( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8812a2ant_CoexAllOff(pBtCoexist); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Under 5G, force set BT to ignore Wlan active!!\n")); -+ halbtc8812a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, TRUE); -+} -+//==================================================== -+VOID -+halbtc8812a2ant_RunCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiUnder5G=FALSE, bBtHsOn=FALSE; -+ u1Byte btInfoOriginal=0, btRetryCnt=0; -+ u1Byte algorithm=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism()===>\n")); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n")); -+ return; -+ } -+ -+ if(pCoexSta->bUnderIps) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under IPS !!!\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ if(bWifiUnder5G) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), run 5G coex setting!!<===\n")); -+ halbtc8812a2ant_CoexUnder5G(pBtCoexist); -+ return; -+ } -+ -+ -+ algorithm = halbtc8812a2ant_ActionAlgorithm(pBtCoexist); -+ if(pCoexSta->bC2hBtInquiryPage && (BT_8812A_2ANT_COEX_ALGO_PANHS!=algorithm)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is under inquiry/page scan !!\n")); -+ halbtc8812a2ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ -+ pCoexDm->curAlgorithm = algorithm; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Algorithm = %d \n", pCoexDm->curAlgorithm)); -+ -+ if(halbtc8812a2ant_IsCommonAction(pBtCoexist)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant common.\n")); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ } -+ else -+ { -+ if(pCoexDm->curAlgorithm != pCoexDm->preAlgorithm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], preAlgorithm=%d, curAlgorithm=%d\n", -+ pCoexDm->preAlgorithm, pCoexDm->curAlgorithm)); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->bAutoTdmaAdjustLowRssi = FALSE; -+ } -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8812A_2ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO.\n")); -+ halbtc8812a2ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_SCO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO+HID.\n")); -+ halbtc8812a2ant_ActionScoHid(pBtCoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID.\n")); -+ halbtc8812a2ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP.\n")); -+ halbtc8812a2ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_A2DP_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n")); -+ halbtc8812a2ant_ActionA2dpPanHs(pBtCoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n")); -+ halbtc8812a2ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HS mode.\n")); -+ halbtc8812a2ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_PANEDR_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n")); -+ halbtc8812a2ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_PANEDR_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n")); -+ halbtc8812a2ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n")); -+ halbtc8812a2ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN(HS).\n")); -+ halbtc8812a2ant_ActionHidA2dpPanHs(pBtCoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n")); -+ halbtc8812a2ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n")); -+ halbtc8812a2ant_CoexAllOff(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+ -+} -+ -+VOID -+halbtc8812a2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bBackUp -+ ) -+{ -+ u4Byte u4Tmp=0; -+ u2Byte u2Tmp=0; -+ u1Byte u1Tmp=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); -+ -+ if(bBackUp) -+ { -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ } -+ -+ //ant sw control to BT -+ halbtc8812a2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_CPL_AUX, TRUE, FALSE); -+ -+ // 0x790[5:0]=0x5 -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x790); -+ u1Tmp &= 0xc0; -+ u1Tmp |= 0x5; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, u1Tmp); -+ -+ // PTA parameter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, 0xffff); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, 0x55555555); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, 0x55555555); -+ -+ // coex parameters -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x1); -+ -+ // enable counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ // disable PTA to avoid BT insn't on -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x00); -+ -+ // bt clock related -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4); -+ u1Tmp |= BIT7; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4, u1Tmp); -+ -+ // bt clock related -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x7); -+ u1Tmp |= BIT1; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x7, u1Tmp); -+} -+ -+//============================================================ -+// work around function start with wa_halbtc8812a2ant_ -+//============================================================ -+//============================================================ -+// extern function start with EXhalbtc8812a2ant_ -+//============================================================ -+VOID -+EXhalbtc8812a2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8812a2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ halbtc8812a2ant_InitHwConfig(pBtCoexist, TRUE); -+} -+ -+VOID -+EXhalbtc8812a2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8812a2ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8812a2ant_PTAOffOnNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte BTstatus -+ ) -+{ -+ u1Byte u1Tmp=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BToff/on notify\n")); -+ DBG_871X("%s, BTstatus:%d \n", __func__, BTstatus); -+ -+ if(BTC_BT_OFF == BTstatus) -+ { -+ //PTA off -+ pBtCoexist->btInfo.bBtDisabled = TRUE; -+ halbtc8812a2ant_EnablePTA(pBtCoexist,FORCE_EXEC, FALSE); -+ -+ } -+ else -+ { -+ //PTA on -+ pBtCoexist->btInfo.bBtDisabled = FALSE; -+ halbtc8812a2ant_EnablePTA(pBtCoexist,FORCE_EXEC, TRUE); -+ } -+ -+} -+ -+ -+ -+VOID -+EXhalbtc8812a2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u2Byte u2Tmp[4]; -+ u4Byte u4Tmp[4]; -+ u4Byte fwVer=0, btPatchVer=0; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Antenna type:", \ -+ pBoardInfo->antType); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", "CoexVer/ FwVer/ PatchVer", \ -+ GLCoexVerDate8812a2Ant, GLCoexVer8812a2Ant, fwVer, btPatchVer, btPatchVer); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ -+ ((pBtCoexist->btInfo.bBtDisabled)? ("disabled"): ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)? "non-connected idle": -+ ( (BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy")))), -+ pCoexSta->btRssi, pCoexSta->btRetryCnt); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pBtLinkInfo->bScoExist, pBtLinkInfo->bHidExist, pBtLinkInfo->bPanExist, pBtLinkInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8812a2Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", "SM1[ShRf/ LpRA/ LimDig]", \ -+ pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ -+ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Rate Mask", \ -+ pBtCoexist->btInfo.raMask); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d/%d)", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase, pCoexDm->bAutoTdmaAdjust, pCoexDm->bAutoTdmaAdjustLowRssi); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "DecBtPwr/ IgnWlanAct", \ -+ pCoexDm->curBtDecPwrLvl, pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "backup ARFR1/ARFR2/RL/AMaxTime", \ -+ pCoexDm->backupArfrCnt1, pCoexDm->backupArfrCnt2, pCoexDm->backupRetryLimit, pCoexDm->backupAmpduMaxTime); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ u2Tmp[0] = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "0x430/0x434/0x42a/0x456", \ -+ u4Tmp[0], u4Tmp[1], u2Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x ", "0x778 (W_Act)/ 0x6cc (CoTab Sel)", \ -+ u1Tmp[0], u1Tmp[1]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x8db); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xc5b); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x8db(ADC)/0xc5b[29:25](DAC)", \ -+ ((u1Tmp[0]&0x60)>>5), ((u1Tmp[1]&0x3e)>>1)); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xcb3); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xcb7); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0xcb3/ 0xcb7", \ -+ u1Tmp[0], u1Tmp[1]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x974); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x40/ 0x4c[24:23]/ 0x974", \ -+ u1Tmp[0], ((u4Tmp[0]&0x01800000)>>23), u4Tmp[1]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa0a); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0xc50(DIG)/0xa0a(CCK-TH)", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf48); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5b); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5c); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0xf48/ 0xa5b (FA cnt-- OFDM : CCK)", \ -+ u4Tmp[0], (u1Tmp[0]<<8) + u1Tmp[1] ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770(high-pri rx/tx)", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(low-pri rx/tx)", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+#if(BT_AUTO_REPORT_ONLY_8812A_2ANT == 1) -+ halbtc8812a2ant_MonitorBtCtr(pBtCoexist); -+#endif -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8812a2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiUnder5G=FALSE; -+ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ pCoexSta->bUnderIps = TRUE; -+ halbtc8812a2ant_CoexAllOff(pBtCoexist); -+ halbtc8812a2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_CPL_AUX, FALSE, TRUE); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS notify, force set BT to ignore Wlan active!!\n")); -+ halbtc8812a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ EXhalbtc8812a2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ pCoexSta->bUnderIps = FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ if(!bWifiUnder5G) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS notify, force set BT NOT to ignore Wlan active!!\n")); -+ halbtc8812a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8812a2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ pCoexSta->bUnderLps = TRUE; -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ pCoexSta->bUnderLps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8812a2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &pCoexSta->nScanAPNum); -+ } -+} -+ -+VOID -+EXhalbtc8812a2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8812a2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte dataLen=5; -+ u1Byte buf[6] = {0}; -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+ -+ // only 2.4G we need to inform bt the chnl mask -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if( (BTC_MEDIA_CONNECT == type) && -+ (wifiCentralChnl <= 14) ) -+ { -+ H2C_Parameter[0] = 0x1; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ buf[0] = dataLen; -+ buf[1] = 0x5; // OP_Code -+ buf[2] = 0x3; // OP_Code_Length -+ buf[3] = H2C_Parameter[0]; // OP_Code_Content -+ buf[4] = H2C_Parameter[1]; -+ buf[5] = H2C_Parameter[2]; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_BT_COEX, (PVOID)&buf[0]); -+} -+ -+VOID -+EXhalbtc8812a2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ } -+ -+} -+ -+VOID -+EXhalbtc8812a2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bBtBusy=FALSE, bLimitedDig=FALSE; -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE, bWifiUnder5G=FALSE; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ -+ rspSource = tmpBuf[0]&0xf; -+ if(rspSource >= BT_INFO_SRC_8812A_2ANT_MAX) -+ rspSource = BT_INFO_SRC_8812A_2ANT_WIFI_FW; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 1) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ if(BT_INFO_SRC_8812A_2ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = // [3:0] -+ pCoexSta->btInfoC2h[rspSource][2]&0xf; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][3]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][4]; -+ -+ // Here we need to resend some wifi info to BT -+ // because bt is reset and loss of the info. -+ if( (pCoexSta->btInfoExt & BIT1) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(bWifiConnected) -+ { -+ EXhalbtc8812a2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT); -+ } -+ else -+ { -+ EXhalbtc8812a2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ } -+ -+ if( (pCoexSta->btInfoExt&BIT3) && !bWifiUnder5G) -+ { -+ // BT already ignored WlanAct -+ if(!pBtCoexist->bManualControl && !pBtCoexist->bStopCoexDm) -+ { -+ if(!pCoexSta->bUnderIps) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")); -+ halbtc8812a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ } -+ } -+ } -+ else -+ { -+ // BT already NOT ignore Wlan active, do nothing here. -+ -+ if(pCoexSta->bUnderIps) -+ { -+ // work around for 8812a combo hw bug => when IPS, wlanAct is always high. -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under IPS, set BT to ignore Wlan active!!\n")); -+ halbtc8812a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+ } -+ } -+ -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8812A_2ANT_B_INQ_PAGE) -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ else -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ -+ // set link exist status -+ if(!(btInfo&BT_INFO_8812A_2ANT_B_CONNECTION)) -+ { -+ pCoexSta->bBtLinkExist = FALSE; -+ pCoexSta->bPanExist = FALSE; -+ pCoexSta->bA2dpExist = FALSE; -+ pCoexSta->bHidExist = FALSE; -+ pCoexSta->bScoExist = FALSE; -+ pCoexSta->bAclBusy = FALSE; -+ } -+ else // connection exists -+ { -+ pCoexSta->bBtLinkExist = TRUE; -+ if(btInfo & BT_INFO_8812A_2ANT_B_FTP) -+ pCoexSta->bPanExist = TRUE; -+ else -+ pCoexSta->bPanExist = FALSE; -+ if(btInfo & BT_INFO_8812A_2ANT_B_A2DP) -+ pCoexSta->bA2dpExist = TRUE; -+ else -+ pCoexSta->bA2dpExist = FALSE; -+ if(btInfo & BT_INFO_8812A_2ANT_B_HID) -+ pCoexSta->bHidExist = TRUE; -+ else -+ pCoexSta->bHidExist = FALSE; -+ if(btInfo & BT_INFO_8812A_2ANT_B_SCO_ESCO) -+ pCoexSta->bScoExist = TRUE; -+ else -+ pCoexSta->bScoExist = FALSE; -+ if(btInfo & BT_INFO_8812A_2ANT_B_ACL_BUSY) -+ pCoexSta->bAclBusy = TRUE; -+ else -+ pCoexSta->bAclBusy = FALSE; -+ -+ } -+ -+ halbtc8812a2ant_UpdateBtLinkInfo(pBtCoexist); -+ -+ if(!(btInfo&BT_INFO_8812A_2ANT_B_CONNECTION)) -+ { -+ pCoexDm->btStatus = BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n")); -+ } -+ else if(btInfo == BT_INFO_8812A_2ANT_B_CONNECTION) // connection exists but no busy -+ { -+ pCoexDm->btStatus = BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n")); -+ } -+ else if((btInfo&BT_INFO_8812A_2ANT_B_SCO_ESCO) || -+ (btInfo&BT_INFO_8812A_2ANT_B_SCO_BUSY)) -+ { -+ pCoexDm->btStatus = BT_8812A_2ANT_BT_STATUS_SCO_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n")); -+ } -+ else if(btInfo&BT_INFO_8812A_2ANT_B_ACL_BUSY) -+ { -+ pCoexDm->btStatus = BT_8812A_2ANT_BT_STATUS_ACL_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n")); -+ } -+ else -+ { -+ pCoexDm->btStatus = BT_8812A_2ANT_BT_STATUS_MAX; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n")); -+ } -+ -+ if( (BT_8812A_2ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8812A_2ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8812A_2ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ bBtBusy = TRUE; -+ if(!bWifiUnder5G) -+ bLimitedDig = TRUE; -+ } -+ else -+ { -+ bBtBusy = FALSE; -+ bLimitedDig = FALSE; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ pCoexDm->bLimitedDig = bLimitedDig; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bLimitedDig); -+ -+ halbtc8812a2ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8812a2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte u1Tmp=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8812a2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_CPL_AUX, FALSE, TRUE); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify, force set BT to ignore Wlan active!!\n")); -+ halbtc8812a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ EXhalbtc8812a2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ -+ // 0x522=0xff, pause tx -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x522, 0xff); -+ // 0x40[7:6]=2'b01, modify BT mode. -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0xc0, 0x2); -+ //PTA off. -+#ifndef CONFIG_PCI_HCI -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0x20, 0x0); -+#endif -+} -+ -+VOID -+EXhalbtc8812a2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static u1Byte disVerInfoCnt=0; -+ u4Byte fwVer=0, btPatchVer=0; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ==========================Periodical===========================\n")); -+ -+ if(disVerInfoCnt <= 5) -+ { -+ disVerInfoCnt += 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ant PG Num/ Ant Mech/ Ant Pos = %d/ %d/ %d\n", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT stack/ hci ext ver = %s / %d\n", -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion)); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", -+ GLCoexVerDate8812a2Ant, GLCoexVer8812a2Ant, fwVer, btPatchVer, btPatchVer)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ } -+ -+#if(BT_AUTO_REPORT_ONLY_8812A_2ANT == 0) -+ halbtc8812a2ant_QueryBtInfo(pBtCoexist); -+ halbtc8812a2ant_MonitorBtCtr(pBtCoexist); -+// halbtc8812a2ant_MonitorBtEnableDisable(pBtCoexist); -+#else -+ if( halbtc8812a2ant_IsWifiStatusChanged(pBtCoexist) || -+ pCoexDm->bAutoTdmaAdjust || -+ pCoexDm->bAutoTdmaAdjustLowRssi) -+ { -+ halbtc8812a2ant_RunCoexistMechanism(pBtCoexist); -+ } -+#endif -+} -+ -+VOID -+EXhalbtc8812a2ant_DbgControl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte opCode, -+ IN u1Byte opLen, -+ IN pu1Byte pData -+ ) -+{ -+ switch(opCode) -+ { -+ case BTC_DBG_SET_COEX_DEC_BT_PWR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set Dec BT power\n")); -+ { -+ u1Byte dataLen=4; -+ u1Byte buf[6] = {0}; -+ u1Byte decBtPwr=0, pwrLevel=0; -+ if(opLen == 2) -+ { -+ decBtPwr = pData[0]; -+ pwrLevel = pData[1]; -+ -+ buf[0] = dataLen; -+ buf[1] = 0x3; // OP_Code -+ buf[2] = 0x2; // OP_Code_Length -+ -+ buf[3] = decBtPwr; // OP_Code_Content -+ buf[4] = pwrLevel; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set Dec BT power=%d, pwrLevel=%d\n", decBtPwr, pwrLevel)); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_BT_COEX, (PVOID)&buf[0]); -+ } -+ } -+ break; -+ -+ case BTC_DBG_SET_COEX_BT_AFH_MAP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set BT AFH Map\n")); -+ { -+ u1Byte dataLen=5; -+ u1Byte buf[6] = {0}; -+ if(opLen == 3) -+ { -+ buf[0] = dataLen; -+ buf[1] = 0x5; // OP_Code -+ buf[2] = 0x3; // OP_Code_Length -+ -+ buf[3] = pData[0]; // OP_Code_Content -+ buf[4] = pData[1]; -+ buf[5] = pData[2]; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set BT AFH Map = %02x %02x %02x\n", -+ pData[0], pData[1], pData[2])); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_BT_COEX, (PVOID)&buf[0]); -+ } -+ } -+ break; -+ -+ case BTC_DBG_SET_COEX_BT_IGNORE_WLAN_ACT: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set BT Ignore Wlan Active\n")); -+ { -+ u1Byte dataLen=3; -+ u1Byte buf[6] = {0}; -+ if(opLen == 1) -+ { -+ buf[0] = dataLen; -+ buf[1] = 0x1; // OP_Code -+ buf[2] = 0x1; // OP_Code_Length -+ -+ buf[3] = pData[0]; // OP_Code_Content -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set BT Ignore Wlan Active = 0x%x\n", -+ pData[0])); -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_BT_COEX, (PVOID)&buf[0]); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8812a2Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8812a2Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8812a2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8812a2Ant.h 2017-06-07 23:07:21.011687576 +0300 -@@ -0,0 +1,249 @@ -+//=========================================== -+// The following is for 8812A 2Ant BT Co-exist definition -+//=========================================== -+#define BT_AUTO_REPORT_ONLY_8812A_2ANT 0 -+ -+#define BT_INFO_8812A_2ANT_B_FTP BIT7 -+#define BT_INFO_8812A_2ANT_B_A2DP BIT6 -+#define BT_INFO_8812A_2ANT_B_HID BIT5 -+#define BT_INFO_8812A_2ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8812A_2ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8812A_2ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8812A_2ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8812A_2ANT_B_CONNECTION BIT0 -+ -+#define BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT0))? TRUE:FALSE) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT 2 -+#define NOISY_AP_NUM_THRESH_8812A 50 -+ -+ -+typedef enum _BT_INFO_SRC_8812A_2ANT{ -+ BT_INFO_SRC_8812A_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8812A_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8812A_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8812A_2ANT_MAX -+}BT_INFO_SRC_8812A_2ANT,*PBT_INFO_SRC_8812A_2ANT; -+ -+typedef enum _BT_8812A_2ANT_BT_STATUS{ -+ BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8812A_2ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8812A_2ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8812A_2ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8812A_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8812A_2ANT_BT_STATUS_MAX -+}BT_8812A_2ANT_BT_STATUS,*PBT_8812A_2ANT_BT_STATUS; -+ -+typedef enum _BT_8812A_2ANT_COEX_ALGO{ -+ BT_8812A_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8812A_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8812A_2ANT_COEX_ALGO_SCO_HID = 0x2, -+ BT_8812A_2ANT_COEX_ALGO_HID = 0x3, -+ BT_8812A_2ANT_COEX_ALGO_A2DP = 0x4, -+ BT_8812A_2ANT_COEX_ALGO_A2DP_PANHS = 0x5, -+ BT_8812A_2ANT_COEX_ALGO_PANEDR = 0x6, -+ BT_8812A_2ANT_COEX_ALGO_PANHS = 0x7, -+ BT_8812A_2ANT_COEX_ALGO_PANEDR_A2DP = 0x8, -+ BT_8812A_2ANT_COEX_ALGO_PANEDR_HID = 0x9, -+ BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0xa, -+ BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANHS = 0xb, -+ BT_8812A_2ANT_COEX_ALGO_HID_A2DP = 0xc, -+ BT_8812A_2ANT_COEX_ALGO_MAX = 0xd -+}BT_8812A_2ANT_COEX_ALGO,*PBT_8812A_2ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8812A_2ANT{ -+ // fw mechanism -+ u1Byte preBtDecPwrLvl; -+ u1Byte curBtDecPwrLvl; -+ u1Byte preFwDacSwingLvl; -+ u1Byte curFwDacSwingLvl; -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ BOOLEAN bAutoTdmaAdjust; -+ BOOLEAN bAutoTdmaAdjustLowRssi; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ BOOLEAN bPreBtAutoReport; -+ BOOLEAN bCurBtAutoReport; -+ u1Byte preLps; -+ u1Byte curLps; -+ u1Byte preRpwm; -+ u1Byte curRpwm; -+ BOOLEAN bPreEnablePTA; -+ BOOLEAN bCurEnablePTA; -+ -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ BOOLEAN bPreDacSwingOn; -+ u4Byte preDacSwingLvl; -+ BOOLEAN bCurDacSwingOn; -+ u4Byte curDacSwingLvl; -+ BOOLEAN bPreAdcBackOff; -+ BOOLEAN bCurAdcBackOff; -+ BOOLEAN bPreAgcTableEn; -+ BOOLEAN bCurAgcTableEn; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ u4Byte backupArfrCnt1; // Auto Rate Fallback Retry cnt -+ u4Byte backupArfrCnt2; // Auto Rate Fallback Retry cnt -+ u2Byte backupRetryLimit; -+ u1Byte backupAmpduMaxTime; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+ -+ u4Byte preRaMask; -+ u4Byte curRaMask; -+ u1Byte curRaMaskType; -+ u1Byte preArfrType; -+ u1Byte curArfrType; -+ u1Byte preRetryLimitType; -+ u1Byte curRetryLimitType; -+ u1Byte preAmpduTimeType; -+ u1Byte curAmpduTimeType; -+} COEX_DM_8812A_2ANT, *PCOEX_DM_8812A_2ANT; -+ -+typedef struct _COEX_STA_8812A_2ANT{ -+ BOOLEAN bBtLinkExist; -+ BOOLEAN bScoExist; -+ BOOLEAN bA2dpExist; -+ BOOLEAN bHidExist; -+ BOOLEAN bPanExist; -+ BOOLEAN bAclBusy; -+ -+ BOOLEAN bUnderLps; -+ BOOLEAN bUnderIps; -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ u1Byte btRssi; -+ u1Byte preBtRssiState; -+ u1Byte preBtDisabled; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8812A_2ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8812A_2ANT_MAX]; -+ u4Byte prebtInfoC2hCnt_BT_RSP; -+ u4Byte prebtInfoC2hCnt_BT_SEND; -+ u4Byte btInfoQueryCnt; -+ BOOLEAN bC2hBtInquiryPage; -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+ u1Byte nScanAPNum; -+ -+ u4Byte nCRCOK_CCK; -+ u4Byte nCRCOK_11g; -+ u4Byte nCRCOK_11n; -+ u4Byte nCRCOK_11nAgg; -+ -+ u4Byte nCRCErr_CCK; -+ u4Byte nCRCErr_11g; -+ u4Byte nCRCErr_11n; -+ u4Byte nCRCErr_11nAgg; -+ -+ u1Byte nCoexTableType; -+ BOOLEAN bForceLpsOn; -+ -+ u1Byte disVerInfoCnt; -+ -+}COEX_STA_8812A_2ANT, *PCOEX_STA_8812A_2ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8812a2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8812a2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8812a2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8812a2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8812a2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8812a2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8812a2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8812a2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8812a2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8812a2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8812a2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8812a2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8812a2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8812a2ant_DbgControl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte opCode, -+ IN u1Byte opLen, -+ IN pu1Byte pData -+ ); -+VOID -+EXhalbtc8812a2ant_PTAOffOnNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte BTstatus -+ ); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8821a1Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8821a1Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8821a1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8821a1Ant.c 2017-06-07 23:07:21.011687576 +0300 -@@ -0,0 +1,3433 @@ -+//============================================================ -+// Description: -+// -+// This file is for 8821A_1ANT Co-exist mechanism -+// -+// History -+// 2012/11/15 Cosa first check in. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8821a1Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8821A_1ANT GLCoexDm8821a1Ant; -+static PCOEX_DM_8821A_1ANT pCoexDm=&GLCoexDm8821a1Ant; -+static COEX_STA_8821A_1ANT GLCoexSta8821a1Ant; -+static PCOEX_STA_8821A_1ANT pCoexSta=&GLCoexSta8821a1Ant; -+ -+const char *const GLBtInfoSrc8821a1Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u4Byte GLCoexVerDate8821a1Ant=20140306; -+u4Byte GLCoexVer8821a1Ant=0x4b; -+ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8821a1ant_ -+//============================================================ -+u1Byte -+halbtc8821a1ant_BtRssiState( -+ u1Byte levelNum, -+ u1Byte rssiThresh, -+ u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte btRssi=0; -+ u1Byte btRssiState=pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh1) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+u1Byte -+halbtc8821a1ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+VOID -+halbtc8821a1ant_UpdateRaMask( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte disRateMask -+ ) -+{ -+ pCoexDm->curRaMask = disRateMask; -+ -+ if( bForceExec || (pCoexDm->preRaMask != pCoexDm->curRaMask)) -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_UPDATE_RAMASK, &pCoexDm->curRaMask); -+ } -+ pCoexDm->preRaMask = pCoexDm->curRaMask; -+} -+ -+VOID -+halbtc8821a1ant_AutoRateFallbackRetry( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiUnderBMode=FALSE; -+ -+ pCoexDm->curArfrType = type; -+ -+ if( bForceExec || (pCoexDm->preArfrType != pCoexDm->curArfrType)) -+ { -+ switch(pCoexDm->curArfrType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, pCoexDm->backupArfrCnt1); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, pCoexDm->backupArfrCnt2); -+ break; -+ case 1: -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ if(bWifiUnderBMode) -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x01010101); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preArfrType = pCoexDm->curArfrType; -+} -+ -+VOID -+halbtc8821a1ant_RetryLimit( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curRetryLimitType = type; -+ -+ if( bForceExec || (pCoexDm->preRetryLimitType != pCoexDm->curRetryLimitType)) -+ { -+ switch(pCoexDm->curRetryLimitType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, pCoexDm->backupRetryLimit); -+ break; -+ case 1: // retry limit=8 -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preRetryLimitType = pCoexDm->curRetryLimitType; -+} -+ -+VOID -+halbtc8821a1ant_AmpduMaxTime( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curAmpduTimeType = type; -+ -+ if( bForceExec || (pCoexDm->preAmpduTimeType != pCoexDm->curAmpduTimeType)) -+ { -+ switch(pCoexDm->curAmpduTimeType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, pCoexDm->backupAmpduMaxTime); -+ break; -+ case 1: // AMPDU timw = 0x38 * 32us -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preAmpduTimeType = pCoexDm->curAmpduTimeType; -+} -+ -+VOID -+halbtc8821a1ant_LimitedTx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte raMaskType, -+ IN u1Byte arfrType, -+ IN u1Byte retryLimitType, -+ IN u1Byte ampduTimeType -+ ) -+{ -+ switch(raMaskType) -+ { -+ case 0: // normal mode -+ halbtc8821a1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0); -+ break; -+ case 1: // disable cck 1/2 -+ halbtc8821a1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x00000003); -+ break; -+ case 2: // disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 -+ halbtc8821a1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8821a1ant_AutoRateFallbackRetry(pBtCoexist, bForceExec, arfrType); -+ halbtc8821a1ant_RetryLimit(pBtCoexist, bForceExec, retryLimitType); -+ halbtc8821a1ant_AmpduMaxTime(pBtCoexist, bForceExec, ampduTimeType); -+} -+ -+VOID -+halbtc8821a1ant_LimitedRx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRejApAggPkt, -+ IN BOOLEAN bBtCtrlAggBufSize, -+ IN u1Byte aggBufSize -+ ) -+{ -+ BOOLEAN bRejectRxAgg=bRejApAggPkt; -+ BOOLEAN bBtCtrlRxAggSize=bBtCtrlAggBufSize; -+ u1Byte rxAggSize=aggBufSize; -+ -+ //============================================ -+ // Rx Aggregation related setting -+ //============================================ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg); -+ // decide BT control aggregation buf size or not -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize); -+ // aggregation buf size, only work when BT control Rx aggregation size. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize); -+ // real update aggregation setting -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+VOID -+halbtc8821a1ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp, u4Tmp1; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp, u1Tmp1; -+ s4Byte wifiRssi; -+#if 0 -+ //to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS -+ if (! (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e) & 0x8) ) -+ { -+ pCoexSta->highPriorityTx = 65535; -+ pCoexSta->highPriorityRx = 65535; -+ pCoexSta->lowPriorityTx = 65535; -+ pCoexSta->lowPriorityRx = 65535; -+ return; -+ } -+#endif -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+} -+ -+VOID -+halbtc8821a1ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = TRUE; -+ -+ H2C_Parameter[0] |= BIT0; // trigger -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x61=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter); -+} -+ -+BOOLEAN -+halbtc8821a1ant_IsWifiStatusChanged( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreWifiBusy=FALSE, bPreUnder4way=FALSE, bPreBtHsOn=FALSE; -+ BOOLEAN bWifiBusy=FALSE, bUnder4way=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bWifiConnected=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ -+ if(bWifiConnected) -+ { -+ if(bWifiBusy != bPreWifiBusy) -+ { -+ bPreWifiBusy = bWifiBusy; -+ return TRUE; -+ } -+ if(bUnder4way != bPreUnder4way) -+ { -+ bPreUnder4way = bUnder4way; -+ return TRUE; -+ } -+ if(bBtHsOn != bPreBtHsOn) -+ { -+ bPreBtHsOn = bBtHsOn; -+ return TRUE; -+ } -+ } -+ -+ return FALSE; -+} -+ -+VOID -+halbtc8821a1ant_UpdateBtLinkInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pCoexSta->bScoExist; -+ pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist; -+ pBtLinkInfo->bPanExist = pCoexSta->bPanExist; -+ pBtLinkInfo->bHidExist = pCoexSta->bHidExist; -+ -+ // work around for HS mode. -+ if(bBtHsOn) -+ { -+ pBtLinkInfo->bPanExist = TRUE; -+ pBtLinkInfo->bBtLinkExist = TRUE; -+ } -+ -+ // check if Sco only -+ if( pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bScoOnly = TRUE; -+ else -+ pBtLinkInfo->bScoOnly = FALSE; -+ -+ // check if A2dp only -+ if( !pBtLinkInfo->bScoExist && -+ pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bA2dpOnly = TRUE; -+ else -+ pBtLinkInfo->bA2dpOnly = FALSE; -+ -+ // check if Pan only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bPanOnly = TRUE; -+ else -+ pBtLinkInfo->bPanOnly = FALSE; -+ -+ // check if Hid only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bHidOnly = TRUE; -+ else -+ pBtLinkInfo->bHidOnly = FALSE; -+} -+ -+u1Byte -+halbtc8821a1ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ u1Byte algorithm=BT_8821A_1ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!pBtLinkInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No BT link exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pBtLinkInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(numOfDiffProfile == 1) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO only\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID only\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP only\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_A2DP; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = PAN(HS) only\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = PAN(EDR) only\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 2) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_SCO; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + PAN(HS)\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + PAN(EDR)\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + PAN(HS)\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + PAN(EDR)\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP + PAN(HS)\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_A2DP_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP + PAN(EDR)\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_HID; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + PAN(HS)\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile >= 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+VOID -+halbtc8821a1ant_SetBtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = 0; -+ -+ if(bEnableAutoReport) -+ { -+ H2C_Parameter[0] |= BIT0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], BT FW auto report : %s, FW write 0x68=0x%x\n", -+ (bEnableAutoReport? "Enabled!!":"Disabled!!"), H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x68, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8821a1ant_BtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s BT Auto report = %s\n", -+ (bForceExec? "force to":""), ((bEnableAutoReport)? "Enabled":"Disabled"))); -+ pCoexDm->bCurBtAutoReport = bEnableAutoReport; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreBtAutoReport == pCoexDm->bCurBtAutoReport) -+ return; -+ } -+ halbtc8821a1ant_SetBtAutoReport(pBtCoexist, pCoexDm->bCurBtAutoReport); -+ -+ pCoexDm->bPreBtAutoReport = pCoexDm->bCurBtAutoReport; -+} -+ -+VOID -+halbtc8821a1ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte H2C_Parameter[6] ={0}; -+ -+ H2C_Parameter[0] = 0x6; // opCode, 0x6= Retry_Penalty -+ -+ if(bLowPenaltyRa) -+ { -+ H2C_Parameter[1] |= BIT0; -+ H2C_Parameter[2] = 0x00; //normal rate except MCS7/6/5, OFDM54/48/36 -+ H2C_Parameter[3] = 0xf7; //MCS7 or OFDM54 -+ H2C_Parameter[4] = 0xf8; //MCS6 or OFDM48 -+ H2C_Parameter[5] = 0xf9; //MCS5 or OFDM36 -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set WiFi Low-Penalty Retry: %s", -+ (bLowPenaltyRa? "ON!!":"OFF!!") )); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter); -+} -+ -+VOID -+halbtc8821a1ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8821a1ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8821a1ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8821a1ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c4, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8821a1ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8821a1ant_CoexTableWithType( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** CoexTable(%d) **********\n", type)); -+ -+ switch(type) -+ { -+ case 0: -+ halbtc8821a1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x55555555, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8821a1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8821a1ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8821a1ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8821a1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8821a1ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0xaaaa5a5a, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8821a1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3); -+ break; -+ case 7: -+ halbtc8821a1ant_CoexTable(pBtCoexist, bForceExec, 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8821a1ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(bEnable) -+ { -+ H2C_Parameter[0] |= BIT0; // function enable -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8821a1ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8821a1ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8821a1ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ u1Byte realByte1=byte1, realByte5=byte5; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ if(bApEnable) -+ { -+ if(byte1&BIT4 && !(byte1&BIT5)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FW for 1Ant AP mode\n")); -+ realByte1 &= ~BIT4; -+ realByte1 |= BIT5; -+ -+ realByte5 |= BIT5; -+ realByte5 &= ~BIT6; -+ } -+ } -+ -+ H2C_Parameter[0] = realByte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = realByte5; -+ -+ pCoexDm->psTdmaPara[0] = realByte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = realByte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], PS-TDMA H2C cmd =0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter); -+} -+ -+VOID -+halbtc8821a1ant_SetLpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ u1Byte lps=lpsVal; -+ u1Byte rpwm=rpwmVal; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+VOID -+halbtc8821a1ant_LpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bForceExecPwrCmd=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set lps/rpwm=0x%x/0x%x \n", -+ (bForceExec? "force to":""), lpsVal, rpwmVal)); -+ pCoexDm->curLps = lpsVal; -+ pCoexDm->curRpwm = rpwmVal; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preLps == pCoexDm->curLps) && -+ (pCoexDm->preRpwm == pCoexDm->curRpwm) ) -+ { -+ return; -+ } -+ } -+ halbtc8821a1ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal); -+ -+ pCoexDm->preLps = pCoexDm->curLps; -+ pCoexDm->preRpwm = pCoexDm->curRpwm; -+} -+ -+VOID -+halbtc8821a1ant_SwMechanism( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRA -+ ) -+{ -+ halbtc8821a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA); -+} -+ -+VOID -+halbtc8821a1ant_SetAntPath( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte antPosType, -+ IN BOOLEAN bInitHwCfg, -+ IN BOOLEAN bWifiOff -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte fwVer=0, u4Tmp=0; -+ u1Byte H2C_Parameter[2] ={0}; -+ -+ if(bInitHwCfg) -+ { -+ // 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp &=~BIT23; -+ u4Tmp |= BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ -+ //0x765 = 0x18 -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x765, 0x18, 0x3); -+ -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ { -+ //tell firmware "antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix -+ H2C_Parameter[0] = 1; -+ H2C_Parameter[1] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ -+ //pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x64, 0x1, 0x1); //Main Ant to BT for IPS case 0x4c[23]=1 -+ } -+ else -+ { -+ //tell firmware "no antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix -+ H2C_Parameter[0] = 0; -+ H2C_Parameter[1] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ -+ //pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x64, 0x1, 0x0); //Aux Ant to BT for IPS case 0x4c[23]=1 -+ } -+ } -+ else if(bWifiOff) -+ { -+ // 0x4c[24:23]=00, Set Antenna control by BT_RFE_CTRL BT Vendor 0xac=0xf002 -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp &= ~BIT23; -+ u4Tmp &= ~BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ -+ //0x765 = 0x18 -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x765, 0x18, 0x3); -+ } -+ else -+ { -+ //0x765 = 0x0 -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x765, 0x18, 0x0); -+ } -+ -+ // ext switch setting -+ switch(antPosType) -+ { -+ case BTC_ANT_PATH_WIFI: -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xcb4, 0x77); -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xcb7, 0x30, 0x1); -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xcb7, 0x30, 0x2); -+ break; -+ case BTC_ANT_PATH_BT: -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xcb4, 0x77); -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xcb7, 0x30, 0x2); -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xcb7, 0x30, 0x1); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xcb4, 0x66); -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xcb7, 0x30, 0x1); -+ else -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xcb7, 0x30, 0x2); -+ break; -+ } -+} -+ -+VOID -+halbtc8821a1ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ BOOLEAN bTurnOnByCnt=FALSE; -+ u1Byte psTdmaTypeByCnt=0, rssiAdjustVal=0; -+ //u4Byte fwVer=0; -+ -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ if (pCoexDm->bCurPsTdmaOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(on, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(off, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ if(bTurnOn) -+ { -+ switch(type) -+ { -+ default: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x1a, 0x1a, 0x0, 0x50); -+ break; -+ case 1: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x3a, 0x03, 0x10, 0x50); -+ rssiAdjustVal = 11; -+ break; -+ case 2: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x2b, 0x03, 0x10, 0x50); -+ rssiAdjustVal = 14; -+ break; -+ case 3: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x1d, 0x1d, 0x0, 0x52); -+ break; -+ case 4: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x93, 0x15, 0x3, 0x14, 0x0); -+ rssiAdjustVal = 17; -+ break; -+ case 5: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x61, 0x15, 0x3, 0x11, 0x10); -+ break; -+ case 6: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x61, 0x20, 0x3, 0x11, 0x13); -+ break; -+ case 7: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x13, 0xc, 0x5, 0x0, 0x0); -+ break; -+ case 8: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 9: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x21, 0x3, 0x10, 0x50); -+ rssiAdjustVal = 18; -+ break; -+ case 10: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 11: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x15, 0x03, 0x10, 0x50); -+ rssiAdjustVal = 20; -+ break; -+ case 12: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x0a, 0x0a, 0x0, 0x50); -+ break; -+ case 13: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x12, 0x12, 0x0, 0x50); -+ break; -+ case 14: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x21, 0x3, 0x10, 0x52); -+ break; -+ case 15: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0x3, 0x8, 0x0); -+ break; -+ case 16: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x93, 0x15, 0x3, 0x10, 0x0); -+ rssiAdjustVal = 18; -+ break; -+ case 18: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0); -+ rssiAdjustVal = 14; -+ break; -+ case 20: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x61, 0x35, 0x03, 0x11, 0x10); -+ break; -+ case 21: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x11); -+ break; -+ case 22: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x10); -+ break; -+ case 23: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x18); -+ rssiAdjustVal = 22; -+ break; -+ case 24: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x3, 0x31, 0x18); -+ rssiAdjustVal = 22; -+ break; -+ case 25: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18); -+ rssiAdjustVal = 22; -+ break; -+ case 26: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18); -+ rssiAdjustVal = 22; -+ break; -+ case 27: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x98); -+ rssiAdjustVal = 22; -+ break; -+ case 28: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x69, 0x25, 0x3, 0x31, 0x0); -+ break; -+ case 29: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0xab, 0x1a, 0x1a, 0x1, 0x10); -+ break; -+ case 30: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x51, 0x30, 0x3, 0x10, 0x10); -+ break; -+ case 31: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0xd3, 0x1a, 0x1a, 0, 0x58); -+ break; -+ case 32: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x61, 0x35, 0x3, 0x11, 0x11); -+ break; -+ case 33: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0xa3, 0x25, 0x3, 0x30, 0x90); -+ break; -+ case 34: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x53, 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 35: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x63, 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 36: -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0xd3, 0x12, 0x3, 0x14, 0x50); -+ break; -+ case 40: // SoftAP only with no sta associated,BT disable ,TDMA mode for power saving -+ /* here softap mode screen off will cost 70-80mA for phone */ -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x23, 0x18, 0x00, 0x10, 0x24); -+ break; -+ } -+ } -+ else -+ { -+ // disable PS tdma -+ switch(type) -+ { -+ case 8: //PTA Control -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x8, 0x0, 0x0, 0x0, 0x0); -+ halbtc8821a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FALSE, FALSE); -+ break; -+ case 0: -+ default: //Software control, Antenna at BT side -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ halbtc8821a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FALSE, FALSE); -+ break; -+ case 9: //Software control, Antenna at WiFi side -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ halbtc8821a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_WIFI, FALSE, FALSE); -+ break; -+ case 10: // under 5G -+ halbtc8821a1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x8, 0x0); -+ halbtc8821a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FALSE, FALSE); -+ break; -+ } -+ } -+ rssiAdjustVal =0; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssiAdjustVal); -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+VOID -+halbtc8821a1ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // sw all off -+ halbtc8821a1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ // hw all off -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+BOOLEAN -+halbtc8821a1ant_IsCommonAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE, bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if(!bWifiConnected && -+ BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n")); -+ halbtc8821a1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(bWifiConnected && -+ (BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT non connected-idle!!\n")); -+ halbtc8821a1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(!bWifiConnected && -+ (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT connected-idle!!\n")); -+ halbtc8821a1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(bWifiConnected && -+ (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT connected-idle!!\n")); -+ halbtc8821a1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else if(!bWifiConnected && -+ (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT Busy!!\n")); -+ halbtc8821a1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ if (bWifiBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n")); -+ } -+ -+ bCommon = FALSE; -+ } -+ -+ return bCommon; -+} -+ -+ -+VOID -+halbtc8821a1ant_TdmaDurationAdjustForAcl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0, btInfoExt; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjustForAcl()\n")); -+ -+ if( (BT_8821A_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == wifiStatus) || -+ (BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifiStatus) || -+ (BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT == wifiStatus) ) -+ { -+ if( pCoexDm->curPsTdma != 1 && -+ pCoexDm->curPsTdma != 2 && -+ pCoexDm->curPsTdma != 3 && -+ pCoexDm->curPsTdma != 9 ) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ return; -+ } -+ -+ if(!pCoexDm->bAutoTdmaAdjust) -+ { -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ btInfoExt = pCoexSta->btInfoExt; -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ if(result == -1) -+ { -+ if( (BT_INFO_8821A_1ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 1) ||(pCoexDm->curPsTdma == 2)) ) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ else if(result == 1) -+ { -+ if( (BT_INFO_8821A_1ANT_A2DP_BASIC_RATE(btInfoExt)) && -+ ((pCoexDm->curPsTdma == 1) ||(pCoexDm->curPsTdma == 2)) ) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ } -+ else //no change -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(on, %d) **********\n", -+ pCoexDm->curPsTdma)); -+ } -+ -+ if( pCoexDm->curPsTdma != 1 && -+ pCoexDm->curPsTdma != 2 && -+ pCoexDm->curPsTdma != 9 && -+ pCoexDm->curPsTdma != 11 ) -+ { -+ // recover to previous adjust type -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ } -+} -+ -+VOID -+halbtc8821a1ant_PsTdmaCheckForPowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bNewPsState -+ ) -+{ -+ u1Byte lpsMode=0x0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode); -+ -+ if(lpsMode) // already under LPS state -+ { -+ if(bNewPsState) -+ { -+ // keep state under LPS, do nothing. -+ } -+ else -+ { -+ // will leave LPS state, turn off psTdma first -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ } -+ else // NO PS state -+ { -+ if(bNewPsState) -+ { -+ // will enter LPS state, turn off psTdma first -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ else -+ { -+ // keep state under NO PS state, do nothing. -+ } -+ } -+} -+ -+VOID -+halbtc8821a1ant_PowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte psType, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bLowPwrDisable=FALSE; -+ -+ switch(psType) -+ { -+ case BTC_PS_WIFI_NATIVE: -+ // recover to original 32k low power setting -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8821a1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, TRUE); -+ halbtc8821a1ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal); -+ // when coex force to enter LPS, do not enter 32k low power. -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ // power save must executed before psTdma. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8821a1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, FALSE); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8821a1ant_CoexUnder5G( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8821a1ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, TRUE); -+ -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 10); -+ -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8821a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 5); -+} -+ -+VOID -+halbtc8821a1ant_ActionWifiOnly( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+} -+ -+VOID -+halbtc8821a1ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ halbtc8821a1ant_ActionWifiOnly(pBtCoexist); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ bPreBtDisabled = bBtDisabled; -+ if(!bBtDisabled) -+ { -+ } -+ else -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ } -+ } -+} -+ -+//============================================= -+// -+// Software Coex Mechanism start -+// -+//============================================= -+ -+// SCO only or SCO+PAN(HS) -+VOID -+halbtc8821a1ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+VOID -+halbtc8821a1ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -+VOID -+halbtc8821a1ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8821a1ant_ActionA2dpPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8821a1ant_ActionPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+//PAN(HS) only -+VOID -+halbtc8821a1ant_ActionPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+//PAN(EDR)+A2DP -+VOID -+halbtc8821a1ant_ActionPanEdrA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_SwMechanism(pBtCoexist, FALSE); -+} -+ -+VOID -+halbtc8821a1ant_ActionPanEdrHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+// HID+A2DP+PAN(EDR) -+VOID -+halbtc8821a1ant_ActionHidA2dpPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+VOID -+halbtc8821a1ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_SwMechanism(pBtCoexist, TRUE); -+} -+ -+//============================================= -+// -+// Non-Software Coex Mechanism start -+// -+//============================================= -+VOID -+halbtc8821a1ant_ActionWifiMultiPort( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+} -+ -+VOID -+halbtc8821a1ant_ActionHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+} -+ -+VOID -+halbtc8821a1ant_ActionBtInquiry( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE, bApEnable=FALSE, bWifiBusy=FALSE, bBtBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ if((!bWifiConnected) && (!pCoexSta->bWiFiIsHighPriTask)) -+ { -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else if((pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist) || (pBtLinkInfo->bA2dpExist)) -+ { -+ // SCO/HID/A2DP busy -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if ((pBtLinkInfo->bPanExist) || (bWifiBusy)) -+ { -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+} -+ -+VOID -+halbtc8821a1ant_ActionBtScoHidOnlyBusy( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ // tdma and coex table -+ -+ if(pBtLinkInfo->bScoExist) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+ else //HID -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5); -+ } -+} -+ -+VOID -+halbtc8821a1ant_ActionWifiConnectedBtAclBusy( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte wifiStatus -+ ) -+{ -+ u1Byte btRssiState; -+ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ btRssiState = halbtc8821a1ant_BtRssiState(2, 28, 0); -+ -+ if(pBtLinkInfo->bHidOnly) //HID -+ { -+ halbtc8821a1ant_ActionBtScoHidOnlyBusy(pBtCoexist, wifiStatus); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ return; -+ } -+ else if(pBtLinkInfo->bA2dpOnly) //A2DP -+ { -+ if(BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifiStatus) -+ { -+ //halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ //halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 1); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a1ant_TdmaDurationAdjustForAcl(pBtCoexist, wifiStatus); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 1); -+ } -+ else //for low BT RSSI -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 1); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ } -+ else if(pBtLinkInfo->bHidExist&&pBtLinkInfo->bA2dpExist) //HID+A2DP -+ { -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else //for low BT RSSI -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 6); -+ } -+ else if( (pBtLinkInfo->bPanOnly) || (pBtLinkInfo->bHidExist&&pBtLinkInfo->bPanExist) ) //PAN(OPP,FTP), HID+PAN(OPP,FTP) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 6); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else if ( ((pBtLinkInfo->bA2dpExist) && (pBtLinkInfo->bPanExist)) || -+ (pBtLinkInfo->bHidExist&&pBtLinkInfo->bA2dpExist&&pBtLinkInfo->bPanExist) ) //A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 1); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 1); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+} -+ -+VOID -+halbtc8821a1ant_ActionWifiNotConnected( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // power save state -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ halbtc8821a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8821a1ant_ActionWifiNotConnectedScan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(BT_8821A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ if (pBtLinkInfo->bA2dpExist) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ } -+ else if( (BT_8821A_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8821a1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } -+ else -+ { -+ //halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ //halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 1); -+ -+ //Bryant Add -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8821a1ant_ActionWifiNotConnectedAssoAuth( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if( (pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist) ) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if( (pBtLinkInfo->bA2dpExist) || (pBtLinkInfo->bPanExist) ) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8821a1ant_ActionWifiConnectedScan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(BT_8821A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ if (pBtLinkInfo->bA2dpExist) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ } -+ else if( (BT_8821A_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8821a1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } -+ else -+ { -+ //halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ //halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 1); -+ -+ //Bryant Add -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8821a1ant_ActionWifiConnectedSpecialPacket( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if((pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist) || (pBtLinkInfo->bA2dpExist)) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4); -+ } -+ else -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+VOID -+halbtc8821a1ant_ActionWifiConnected( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiBusy=FALSE; -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ BOOLEAN bUnder4way=FALSE, bApEnable=FALSE; -+ u4Byte wifiBw; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect()===>\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ if(bUnder4way) -+ { -+ halbtc8821a1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ if(bScan || bLink || bRoam) -+ { -+ if(bScan) -+ halbtc8821a1ant_ActionWifiConnectedScan(pBtCoexist); -+ else -+ halbtc8821a1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ // power save state -+ if(!bApEnable && BT_8821A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus && !pBtCoexist->btLinkInfo.bHidOnly) -+ { -+ if(!bWifiBusy && pBtCoexist->btLinkInfo.bA2dpOnly) //A2DP -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ else -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ // tdma and coex table -+ if(!bWifiBusy) -+ { -+ if(BT_8821A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ halbtc8821a1ant_ActionWifiConnectedBtAclBusy(pBtCoexist, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } -+ else if( (BT_8821A_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8821a1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } -+ else -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+ } -+ else -+ { -+ if(BT_8821A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) -+ { -+ halbtc8821a1ant_ActionWifiConnectedBtAclBusy(pBtCoexist, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } -+ else if( (BT_8821A_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ halbtc8821a1ant_ActionBtScoHidOnlyBusy(pBtCoexist, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } -+ else -+ { -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+ } -+} -+ -+VOID -+halbtc8821a1ant_RunSwCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte algorithm=0; -+ -+ algorithm = halbtc8821a1ant_ActionAlgorithm(pBtCoexist); -+ pCoexDm->curAlgorithm = algorithm; -+ -+ if(halbtc8821a1ant_IsCommonAction(pBtCoexist)) -+ { -+ -+ } -+ else -+ { -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8821A_1ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = SCO.\n")); -+ halbtc8821a1ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID.\n")); -+ halbtc8821a1ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = A2DP.\n")); -+ halbtc8821a1ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_A2DP_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = A2DP+PAN(HS).\n")); -+ halbtc8821a1ant_ActionA2dpPanHs(pBtCoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN(EDR).\n")); -+ halbtc8821a1ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HS mode.\n")); -+ halbtc8821a1ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_PANEDR_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN+A2DP.\n")); -+ halbtc8821a1ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_PANEDR_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN(EDR)+HID.\n")); -+ halbtc8821a1ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID+A2DP+PAN.\n")); -+ halbtc8821a1ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID+A2DP.\n")); -+ halbtc8821a1ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = coexist All Off!!\n")); -+ //halbtc8821a1ant_CoexAllOff(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+} -+ -+VOID -+halbtc8821a1ant_RunCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bIncreaseScanDevNum=FALSE; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bWifiUnder5G=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism()===>\n")); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n")); -+ return; -+ } -+ -+ if(pBtCoexist->bStopCoexDm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n")); -+ return; -+ } -+ -+ if(pCoexSta->bUnderIps) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under IPS !!!\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ if(bWifiUnder5G) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for 5G <===\n")); -+ halbtc8821a1ant_CoexUnder5G(pBtCoexist); -+ return; -+ } -+ -+ if( (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8821A_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ bIncreaseScanDevNum = TRUE; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, &bIncreaseScanDevNum); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if((numOfWifiLink>=2) || (wifiLinkStatus&WIFI_P2P_GO_CONNECTED)) -+ { -+ halbtc8821a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8821a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8821a1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ if(!pBtLinkInfo->bScoExist && !pBtLinkInfo->bHidExist) -+ { -+ halbtc8821a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ } -+ else -+ { -+ if(bWifiConnected) -+ { -+ wifiRssiState = halbtc8821a1ant_WifiRssiState(pBtCoexist, 1, 2, 30, 0); -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 1, 1); -+ } -+ else -+ { -+ halbtc8821a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 1, 1); -+ } -+ } -+ else -+ { -+ halbtc8821a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ } -+ -+ } -+ -+ if(pBtLinkInfo->bScoExist) -+ { -+ bBtCtrlAggBufSize = TRUE; -+ aggBufSize = 0x3; -+ } -+ else if(pBtLinkInfo->bHidExist) -+ { -+ bBtCtrlAggBufSize = TRUE; -+ aggBufSize = 0x5; -+ } -+ else if(pBtLinkInfo->bA2dpExist || pBtLinkInfo->bPanExist) -+ { -+ bBtCtrlAggBufSize = TRUE; -+ aggBufSize = 0x8; -+ } -+ halbtc8821a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ -+ halbtc8821a1ant_RunSwCoexistMechanism(pBtCoexist); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8821a1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8821a1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ -+ if(!bWifiConnected) -+ { -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is non connected-idle !!!\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if(bScan || bLink || bRoam) -+ { -+ if (bScan) -+ halbtc8821a1ant_ActionWifiNotConnectedScan(pBtCoexist); -+ else -+ halbtc8821a1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist); -+ } -+ else -+ halbtc8821a1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else // wifi LPS/Busy -+ { -+ halbtc8821a1ant_ActionWifiConnected(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8821a1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ // sw all off -+ halbtc8821a1ant_SwMechanism(pBtCoexist, FALSE); -+ -+ //halbtc8821a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+} -+ -+VOID -+halbtc8821a1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bBackUp, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte u4Tmp=0; -+ u2Byte u2Tmp=0; -+ u1Byte u1Tmp=0; -+ u1Byte H2C_Parameter[2] ={0}; -+ BOOLEAN bWifiUnder5G=FALSE; -+ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Init HW Config!!\n")); -+ -+ if(bWifiOnly) -+ return; -+ -+ if(bBackUp) -+ { -+ pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ } -+ -+ // 0x790[5:0]=0x5 -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x790); -+ u1Tmp &= 0xc0; -+ u1Tmp |= 0x5; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, u1Tmp); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ -+ //Antenna config -+ if(bWifiUnder5G) -+ halbtc8821a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, TRUE, FALSE); -+ else -+ halbtc8821a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, TRUE, FALSE); -+ -+ // PTA parameter -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ // Enable counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); //0x76e[3] =1, WLAN_Act control by PTA -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x3); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0x20, 0x1); -+} -+ -+//============================================================ -+// work around function start with wa_halbtc8821a1ant_ -+//============================================================ -+//============================================================ -+// extern function start with EXhalbtc8821a1ant_ -+//============================================================ -+VOID -+EXhalbtc8821a1ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8821a1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ halbtc8821a1ant_InitHwConfig(pBtCoexist, TRUE, bWifiOnly); -+} -+ -+VOID -+EXhalbtc8821a1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ pBtCoexist->bStopCoexDm = FALSE; -+ -+ halbtc8821a1ant_InitCoexDm(pBtCoexist); -+ -+ halbtc8821a1ant_QueryBtInfo(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8821a1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u2Byte u2Tmp[4]; -+ u4Byte u4Tmp[4]; -+ u4Byte faOfdm, faCck; -+ u4Byte fwVer=0, btPatchVer=0; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ if(pBtCoexist->bStopCoexDm) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "Ant PG Num/ Ant Mech/ Ant Pos:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", "CoexVer/ FwVer/ PatchVer", \ -+ GLCoexVerDate8821a1Ant, GLCoexVer8821a1Ant, fwVer, btPatchVer, btPatchVer); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ -+ ((pBtCoexist->btInfo.bBtDisabled)? ("disabled"): ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)? "non-connected idle": -+ ( (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy")))), -+ pCoexSta->btRssi, pCoexSta->btRetryCnt); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pBtLinkInfo->bScoExist, pBtLinkInfo->bHidExist, pBtLinkInfo->bPanExist, pBtLinkInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8821a1Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ if(!pBtCoexist->bManualControl) -+ { -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "SM[LowPenaltyRA]", \ -+ pCoexDm->bCurLowPenaltyRa); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %d ", "DelBA/ BtCtrlAgg/ AggSize", \ -+ (pBtCoexist->btInfo.bRejectAggPkt? "Yes":"No"), (pBtCoexist->btInfo.bBtCtrlAggBufSize? "Yes":"No"), -+ pBtCoexist->btInfo.aggBufSize); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Rate Mask", \ -+ pBtCoexist->btInfo.raMask); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase, pCoexDm->bAutoTdmaAdjust); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", "IgnWlanAct", \ -+ pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Latest error condition(should be 0)", \ -+ pCoexDm->errorCondition); -+ CL_PRINTF(cliBuf); -+ } -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "backup ARFR1/ARFR2/RL/AMaxTime", \ -+ pCoexDm->backupArfrCnt1, pCoexDm->backupArfrCnt2, pCoexDm->backupRetryLimit, pCoexDm->backupAmpduMaxTime); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ u2Tmp[0] = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "0x430/0x434/0x42a/0x456", \ -+ u4Tmp[0], u4Tmp[1], u2Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc58); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x778/ 0xc58[29:25]", \ -+ u1Tmp[0], (u4Tmp[0]&0x3e000000) >> 25); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x8db); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8db[6:5]", \ -+ ((u1Tmp[0]&0x60)>>5)); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x975); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xcb4); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0xcb4[29:28]/0xcb4[7:0]/0x974[9:8]", \ -+ (u4Tmp[0]&0x30000000)>>28, u4Tmp[0]&0xff, u1Tmp[0]& 0x3); -+ CL_PRINTF(cliBuf); -+ -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x64); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x40/0x4c[24:23]/0x64[0]", \ -+ u1Tmp[0], ((u4Tmp[0]&0x01800000)>>23), u1Tmp[1]&0x1); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ -+ u4Tmp[0]&0xff); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf48); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5d); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5c); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "OFDM-FA/ CCK-FA", \ -+ u4Tmp[0], (u1Tmp[0]<<8) + u1Tmp[1] ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770(high-pri rx/tx)", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(low-pri rx/tx)", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+#if(BT_AUTO_REPORT_ONLY_8821A_1ANT == 1) -+ halbtc8821a1ant_MonitorBtCtr(pBtCoexist); -+#endif -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8821a1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u4Byte u4Tmp=0; -+ -+ if(pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm) -+ return; -+ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ pCoexSta->bUnderIps = TRUE; -+ -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8821a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FALSE, TRUE); -+ //halbtc8821a1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ pCoexSta->bUnderIps = FALSE; -+ -+ halbtc8821a1ant_InitHwConfig(pBtCoexist, FALSE, FALSE); -+ halbtc8821a1ant_InitCoexDm(pBtCoexist); -+ halbtc8821a1ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8821a1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm) -+ return; -+ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ pCoexSta->bUnderLps = TRUE; -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ pCoexSta->bUnderLps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8821a1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm ) -+ return; -+ -+ if(BTC_SCAN_START == type) -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ -+ halbtc8821a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8); //Force antenna setup for no scan result issue -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ } -+ -+ if(pBtCoexist->btInfo.bBtDisabled) -+ return; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ halbtc8821a1ant_QueryBtInfo(pBtCoexist); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8821a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8821a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8821a1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8821a1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8821a1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if(BTC_SCAN_START == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8821a1ant_ActionWifiNotConnectedScan(pBtCoexist); -+ } -+ else // wifi is connected -+ { -+ halbtc8821a1ant_ActionWifiConnectedScan(pBtCoexist); -+ } -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8821a1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else -+ { -+ halbtc8821a1ant_ActionWifiConnected(pBtCoexist); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8821a1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ pCoexDm->nArpCnt = 0; -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ pCoexDm->nArpCnt = 0; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8821a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8821a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8821a1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8821a1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8821a1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ halbtc8821a1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8821a1ant_ActionWifiNotConnected(pBtCoexist); -+ } -+ else -+ { -+ halbtc8821a1ant_ActionWifiConnected(pBtCoexist); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8821a1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ pCoexDm->nArpCnt = 0; -+ } -+ -+ // only 2.4G we need to inform bt the chnl mask -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if( (BTC_MEDIA_CONNECT == type) && -+ (wifiCentralChnl <= 14) ) -+ { -+ //H2C_Parameter[0] = 0x1; -+ H2C_Parameter[0] = 0x0; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x66=0x%x\n", -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter); -+} -+ -+VOID -+EXhalbtc8821a1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE; -+ u4Byte wifiLinkStatus=0; -+ u4Byte numOfWifiLink=0; -+ BOOLEAN bBtCtrlAggBufSize=FALSE; -+ u1Byte aggBufSize=5; -+ -+ if(pBtCoexist->bManualControl || -+ pBtCoexist->bStopCoexDm || -+ pBtCoexist->btInfo.bBtDisabled ) -+ return; -+ -+ if( BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ BTC_PACKET_ARP == type ) -+ { -+ pCoexSta->bWiFiIsHighPriTask = TRUE; -+ -+ if(BTC_PACKET_ARP == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet ARP notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet DHCP or EAPOL notify\n")); -+ } -+ } -+ else -+ { -+ pCoexSta->bWiFiIsHighPriTask = FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet [Type = %d] notify\n", type)); -+ } -+ -+ pCoexSta->specialPktPeriodCnt = 0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ if(numOfWifiLink >= 2) -+ { -+ halbtc8821a1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8821a1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize); -+ halbtc8821a1ant_ActionWifiMultiPort(pBtCoexist); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ if(pCoexSta->bC2hBtInquiryPage) -+ { -+ halbtc8821a1ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else if(bBtHsOn) -+ { -+ halbtc8821a1ant_ActionHs(pBtCoexist); -+ return; -+ } -+ -+ if( BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ BTC_PACKET_ARP == type ) -+ { -+ //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet(%d) notify\n", type)); -+ if(BTC_PACKET_ARP == type) -+ { -+ pCoexDm->nArpCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ARP Packet Count = %d\n", pCoexDm->nArpCnt)); -+ if(pCoexDm->nArpCnt >= 10) // if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecialPacket(pBtCoexist) -+ return; -+ } -+ -+ halbtc8821a1ant_ActionWifiConnectedSpecialPacket(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8821a1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bWifiConnected=FALSE; -+ BOOLEAN bBtBusy=FALSE; -+ BOOLEAN bWifiUnder5G=FALSE; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ -+ rspSource = tmpBuf[0]&0xf; -+ if(rspSource >= BT_INFO_SRC_8821A_1ANT_MAX) -+ rspSource = BT_INFO_SRC_8821A_1ANT_WIFI_FW; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 1) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ if(BT_INFO_SRC_8821A_1ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = // [3:0] -+ pCoexSta->btInfoC2h[rspSource][2]&0xf; -+ -+ if (pCoexSta->btInfoC2h[rspSource][2]&0x20) -+ pCoexSta->bC2hBtPage = TRUE; -+ else -+ pCoexSta->bC2hBtPage = FALSE; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][3]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][4]; -+ -+ pCoexSta->bBtTxRxMask = (pCoexSta->btInfoC2h[rspSource][2]&0x40); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TX_RX_MASK, &pCoexSta->bBtTxRxMask); -+ if(!pCoexSta->bBtTxRxMask) -+ { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n")); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); -+ } -+ -+ // Here we need to resend some wifi info to BT -+ // because bt is reset and loss of the info. -+ if(pCoexSta->btInfoExt & BIT1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(bWifiConnected) -+ { -+ EXhalbtc8821a1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT); -+ } -+ else -+ { -+ EXhalbtc8821a1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ } -+ -+ if( (pCoexSta->btInfoExt & BIT3) && !bWifiUnder5G) -+ { -+ if(!pBtCoexist->bManualControl && !pBtCoexist->bStopCoexDm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")); -+ halbtc8821a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ } -+ } -+ else -+ { -+ // BT already NOT ignore Wlan active, do nothing here. -+ } -+#if(BT_AUTO_REPORT_ONLY_8821A_1ANT == 0) -+ if( (pCoexSta->btInfoExt & BIT4) ) -+ { -+ // BT auto report already enabled, do nothing -+ } -+ else -+ { -+ halbtc8821a1ant_BtAutoReport(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+#endif -+ } -+ -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8821A_1ANT_B_INQ_PAGE) -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ else -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ -+ // set link exist status -+ if(!(btInfo&BT_INFO_8821A_1ANT_B_CONNECTION)) -+ { -+ pCoexSta->bBtLinkExist = FALSE; -+ pCoexSta->bPanExist = FALSE; -+ pCoexSta->bA2dpExist = FALSE; -+ pCoexSta->bHidExist = FALSE; -+ pCoexSta->bScoExist = FALSE; -+ } -+ else // connection exists -+ { -+ pCoexSta->bBtLinkExist = TRUE; -+ if(btInfo & BT_INFO_8821A_1ANT_B_FTP) -+ pCoexSta->bPanExist = TRUE; -+ else -+ pCoexSta->bPanExist = FALSE; -+ if(btInfo & BT_INFO_8821A_1ANT_B_A2DP) -+ pCoexSta->bA2dpExist = TRUE; -+ else -+ pCoexSta->bA2dpExist = FALSE; -+ if(btInfo & BT_INFO_8821A_1ANT_B_HID) -+ pCoexSta->bHidExist = TRUE; -+ else -+ pCoexSta->bHidExist = FALSE; -+ if(btInfo & BT_INFO_8821A_1ANT_B_SCO_ESCO) -+ pCoexSta->bScoExist = TRUE; -+ else -+ pCoexSta->bScoExist = FALSE; -+ } -+ -+ halbtc8821a1ant_UpdateBtLinkInfo(pBtCoexist); -+ -+ btInfo = btInfo & 0x1f; //mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) -+ -+ if(!(btInfo&BT_INFO_8821A_1ANT_B_CONNECTION)) -+ { -+ pCoexDm->btStatus = BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n")); -+ } -+ else if(btInfo == BT_INFO_8821A_1ANT_B_CONNECTION) // connection exists but no busy -+ { -+ pCoexDm->btStatus = BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n")); -+ } -+ else if((btInfo&BT_INFO_8821A_1ANT_B_SCO_ESCO) || -+ (btInfo&BT_INFO_8821A_1ANT_B_SCO_BUSY)) -+ { -+ pCoexDm->btStatus = BT_8821A_1ANT_BT_STATUS_SCO_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n")); -+ } -+ else if(btInfo&BT_INFO_8821A_1ANT_B_ACL_BUSY) -+ { -+ if(BT_8821A_1ANT_BT_STATUS_ACL_BUSY != pCoexDm->btStatus) -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ pCoexDm->btStatus = BT_8821A_1ANT_BT_STATUS_ACL_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n")); -+ } -+ else -+ { -+ pCoexDm->btStatus = BT_8821A_1ANT_BT_STATUS_MAX; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n")); -+ } -+ -+ if( (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8821A_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ bBtBusy = TRUE; -+ else -+ bBtBusy = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ halbtc8821a1ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8821a1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8821a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FALSE, TRUE); -+ //halbtc8821a1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); -+ -+ halbtc8821a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ -+ EXhalbtc8821a1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ -+ pBtCoexist->bStopCoexDm = TRUE; -+} -+ -+VOID -+EXhalbtc8821a1ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify\n")); -+ -+ if(BTC_WIFI_PNP_SLEEP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to SLEEP\n")); -+ -+ halbtc8821a1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8821a1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ halbtc8821a1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FALSE, TRUE); -+ //halbtc8821a1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); -+ -+ pBtCoexist->bStopCoexDm = TRUE; -+ } -+ else if(BTC_WIFI_PNP_WAKE_UP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to WAKE UP\n")); -+ pBtCoexist->bStopCoexDm = FALSE; -+ halbtc8821a1ant_InitHwConfig(pBtCoexist, FALSE, FALSE); -+ halbtc8821a1ant_InitCoexDm(pBtCoexist); -+ halbtc8821a1ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8821a1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static u1Byte disVerInfoCnt=0; -+ u4Byte fwVer=0, btPatchVer=0; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ==========================Periodical===========================\n")); -+ -+ if(disVerInfoCnt <= 5) -+ { -+ disVerInfoCnt += 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ant PG Num/ Ant Mech/ Ant Pos = %d/ %d/ %d\n", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT stack/ hci ext ver = %s / %d\n", -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion)); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", -+ GLCoexVerDate8821a1Ant, GLCoexVer8821a1Ant, fwVer, btPatchVer, btPatchVer)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ } -+ -+#if(BT_AUTO_REPORT_ONLY_8821A_1ANT == 0) -+ halbtc8821a1ant_QueryBtInfo(pBtCoexist); -+ halbtc8821a1ant_MonitorBtCtr(pBtCoexist); -+ halbtc8821a1ant_MonitorBtEnableDisable(pBtCoexist); -+#else -+ if( halbtc8821a1ant_IsWifiStatusChanged(pBtCoexist) || -+ pCoexDm->bAutoTdmaAdjust ) -+ { -+ //if(pCoexSta->specialPktPeriodCnt > 2) -+ //{ -+ halbtc8821a1ant_RunCoexistMechanism(pBtCoexist); -+ //} -+ } -+ -+ pCoexSta->specialPktPeriodCnt++; -+#endif -+} -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8821a1Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8821a1Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8821a1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8821a1Ant.h 2017-06-07 23:07:21.011687576 +0300 -@@ -0,0 +1,213 @@ -+//=========================================== -+// The following is for 8821A 1ANT BT Co-exist definition -+//=========================================== -+#define BT_AUTO_REPORT_ONLY_8821A_1ANT 1 -+ -+#define BT_INFO_8821A_1ANT_B_FTP BIT7 -+#define BT_INFO_8821A_1ANT_B_A2DP BIT6 -+#define BT_INFO_8821A_1ANT_B_HID BIT5 -+#define BT_INFO_8821A_1ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8821A_1ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8821A_1ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8821A_1ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8821A_1ANT_B_CONNECTION BIT0 -+ -+#define BT_INFO_8821A_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT0))? TRUE:FALSE) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT 2 -+ -+typedef enum _BT_INFO_SRC_8821A_1ANT{ -+ BT_INFO_SRC_8821A_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8821A_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8821A_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8821A_1ANT_MAX -+}BT_INFO_SRC_8821A_1ANT,*PBT_INFO_SRC_8821A_1ANT; -+ -+typedef enum _BT_8821A_1ANT_BT_STATUS{ -+ BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8821A_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8821A_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8821A_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8821A_1ANT_BT_STATUS_MAX -+}BT_8821A_1ANT_BT_STATUS,*PBT_8821A_1ANT_BT_STATUS; -+ -+typedef enum _BT_8821A_1ANT_WIFI_STATUS{ -+ BT_8821A_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8821A_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT = 0x3, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8821A_1ANT_WIFI_STATUS_MAX -+}BT_8821A_1ANT_WIFI_STATUS,*PBT_8821A_1ANT_WIFI_STATUS; -+ -+typedef enum _BT_8821A_1ANT_COEX_ALGO{ -+ BT_8821A_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8821A_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8821A_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8821A_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8821A_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8821A_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8821A_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8821A_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8821A_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8821A_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8821A_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8821A_1ANT_COEX_ALGO_MAX = 0xb, -+}BT_8821A_1ANT_COEX_ALGO,*PBT_8821A_1ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8821A_1ANT{ -+ // fw mechanism -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ BOOLEAN bAutoTdmaAdjust; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ BOOLEAN bPreBtAutoReport; -+ BOOLEAN bCurBtAutoReport; -+ u1Byte preLps; -+ u1Byte curLps; -+ u1Byte preRpwm; -+ u1Byte curRpwm; -+ -+ // sw mechanism -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ -+ u4Byte backupArfrCnt1; // Auto Rate Fallback Retry cnt -+ u4Byte backupArfrCnt2; // Auto Rate Fallback Retry cnt -+ u2Byte backupRetryLimit; -+ u1Byte backupAmpduMaxTime; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+ -+ u4Byte preRaMask; -+ u4Byte curRaMask; -+ u1Byte preArfrType; -+ u1Byte curArfrType; -+ u1Byte preRetryLimitType; -+ u1Byte curRetryLimitType; -+ u1Byte preAmpduTimeType; -+ u1Byte curAmpduTimeType; -+ u4Byte nArpCnt; -+ -+ u1Byte errorCondition; -+} COEX_DM_8821A_1ANT, *PCOEX_DM_8821A_1ANT; -+ -+typedef struct _COEX_STA_8821A_1ANT{ -+ BOOLEAN bBtLinkExist; -+ BOOLEAN bScoExist; -+ BOOLEAN bA2dpExist; -+ BOOLEAN bHidExist; -+ BOOLEAN bPanExist; -+ -+ BOOLEAN bUnderLps; -+ BOOLEAN bUnderIps; -+ u4Byte specialPktPeriodCnt; -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ u1Byte btRssi; -+ BOOLEAN bBtTxRxMask; -+ u1Byte preBtRssiState; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8821A_1ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8821A_1ANT_MAX]; -+ BOOLEAN bC2hBtInquiryPage; -+ BOOLEAN bC2hBtPage; //Add for win8.1 page out issue -+ BOOLEAN bWiFiIsHighPriTask; //Add for win8.1 page out issue -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+}COEX_STA_8821A_1ANT, *PCOEX_STA_8821A_1ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8821a1ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8821a1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8821a1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8821a1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821a1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821a1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821a1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821a1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821a1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821a1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8821a1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8821a1ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ); -+VOID -+EXhalbtc8821a1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8821a1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8821a2Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8821a2Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8821a2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8821a2Ant.c 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,4852 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8821A Co-exist mechanism -+// -+// History -+// 2012/11/15 Cosa first check in. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8821a2Ant.tmh" -+#endif -+ -+#if (RTL8821A_SUPPORT == 1) -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8821A_2ANT GLCoexDm8821a2Ant; -+static PCOEX_DM_8821A_2ANT pCoexDm=&GLCoexDm8821a2Ant; -+static COEX_STA_8821A_2ANT GLCoexSta8821a2Ant; -+static PCOEX_STA_8821A_2ANT pCoexSta=&GLCoexSta8821a2Ant; -+ -+const char *const GLBtInfoSrc8821a2Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u4Byte GLCoexVerDate8821a2Ant=20150706; -+u4Byte GLCoexVer8821a2Ant=0x57; -+//modify 20140903v43 a2dpandhid tdmaonoff a2dp glitch _ tdma off 778=3(case1)->778=1(case0) -+//and to improve tp while a2dphid case23->case25 , case123->case125 for asus spec -+//and modify for asus bt WHQL test _ tdma off_ 778=3->1_ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8821a2ant_ -+//============================================================ -+u1Byte -+halbtc8821a2ant_BtRssiState( -+ u1Byte levelNum, -+ u1Byte rssiThresh, -+ u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte btRssi=0; -+ u1Byte btRssiState=pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh1) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+u1Byte -+halbtc8821a2ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+VOID -+halbtc8821a2ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ bPreBtDisabled = bBtDisabled; -+ if(!bBtDisabled) -+ { -+ } -+ else -+ { -+ } -+ } -+} -+ -+VOID -+halbtc8821a2ant_LimitedRx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRejApAggPkt, -+ IN BOOLEAN bBtCtrlAggBufSize, -+ IN u1Byte aggBufSize -+ ) -+{ -+ BOOLEAN bRejectRxAgg=bRejApAggPkt; -+ BOOLEAN bBtCtrlRxAggSize=bBtCtrlAggBufSize; -+ u1Byte rxAggSize=aggBufSize; -+ -+ //============================================ -+ // Rx Aggregation related setting -+ //============================================ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg); -+ // decide BT control aggregation buf size or not -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize); -+ // aggregation buf size, only work when BT control Rx aggregation size. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize); -+ // real update aggregation setting -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+} -+ -+VOID -+halbtc8821a2ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp; -+ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ if ( (pCoexSta->lowPriorityRx >= 950) && (pCoexSta->lowPriorityRx >= pCoexSta->lowPriorityTx) && (!pCoexSta->bUnderIps) ) -+ { -+ pBtLinkInfo->bSlaveRole = TRUE; -+ } -+ else -+ { -+ pBtLinkInfo->bSlaveRole = FALSE; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+} -+ -+VOID -+halbtc8821a2ant_MonitorWiFiCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte u4Tmp; -+ u2Byte u2Tmp[3]; -+ s4Byte wifiRssi=0; -+ BOOLEAN bWifiBusy = FALSE, bWifiUnderBMode = FALSE; -+ static u1Byte nCCKLockCounter = 0; -+ -+ -+ if (pCoexSta->bUnderIps) -+ { -+ pCoexSta->nCRCOK_CCK = 0; -+ pCoexSta->nCRCOK_11g = 0; -+ pCoexSta->nCRCOK_11n = 0; -+ pCoexSta->nCRCOK_11nAgg = 0; -+ -+ pCoexSta->nCRCErr_CCK = 0; -+ pCoexSta->nCRCErr_11g = 0; -+ pCoexSta->nCRCErr_11n = 0; -+ pCoexSta->nCRCErr_11nAgg = 0; -+ } -+ else -+ { -+ pCoexSta->nCRCOK_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf88); -+ pCoexSta->nCRCOK_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf94); -+ pCoexSta->nCRCOK_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf90); -+ pCoexSta->nCRCOK_11nAgg= pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfb8); -+ -+ pCoexSta->nCRCErr_CCK = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf84); -+ pCoexSta->nCRCErr_11g = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf96); -+ pCoexSta->nCRCErr_11n = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf92); -+ pCoexSta->nCRCErr_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfba); -+ } -+ -+ //reset counter -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x1); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x0); -+} -+ -+VOID -+halbtc8821a2ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = TRUE; -+ -+ H2C_Parameter[0] |= BIT0; // trigger -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x61=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter); -+} -+ -+BOOLEAN -+halbtc8821a2ant_IsWifiStatusChanged( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreWifiBusy=FALSE, bPreUnder4way=FALSE, bPreBtHsOn=FALSE; -+ BOOLEAN bWifiBusy=FALSE, bUnder4way=FALSE, bBtHsOn=FALSE; -+ BOOLEAN bWifiConnected=FALSE; -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way); -+ -+ if(bWifiConnected) -+ { -+ if(bWifiBusy != bPreWifiBusy) -+ { -+ bPreWifiBusy = bWifiBusy; -+ return TRUE; -+ } -+ if(bUnder4way != bPreUnder4way) -+ { -+ bPreUnder4way = bUnder4way; -+ return TRUE; -+ } -+ if(bBtHsOn != bPreBtHsOn) -+ { -+ bPreBtHsOn = bBtHsOn; -+ return TRUE; -+ } -+ -+ -+ wifiRssiState = halbtc8821a2ant_WifiRssiState(pBtCoexist,3, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ -+ if ( (BTC_RSSI_STATE_HIGH ==wifiRssiState ) || (BTC_RSSI_STATE_LOW ==wifiRssiState )) -+ { -+ return TRUE; -+ } -+ -+ } -+ -+ return FALSE; -+} -+ -+VOID -+halbtc8821a2ant_UpdateBtLinkInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ -+#if(BT_AUTO_REPORT_ONLY_8821A_2ANT == 1) // profile from bt patch -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pCoexSta->bScoExist; -+ pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist; -+ pBtLinkInfo->bPanExist = pCoexSta->bPanExist; -+ pBtLinkInfo->bHidExist = pCoexSta->bHidExist; -+ -+ // work around for HS mode. -+ if(bBtHsOn) -+ { -+ pBtLinkInfo->bPanExist = TRUE; -+ pBtLinkInfo->bBtLinkExist = TRUE; -+ } -+#else // profile from bt stack -+ pBtLinkInfo->bBtLinkExist = pStackInfo->bBtLinkExist; -+ pBtLinkInfo->bScoExist = pStackInfo->bScoExist; -+ pBtLinkInfo->bA2dpExist = pStackInfo->bA2dpExist; -+ pBtLinkInfo->bPanExist = pStackInfo->bPanExist; -+ pBtLinkInfo->bHidExist = pStackInfo->bHidExist; -+ -+ //for win-8 stack HID report error -+ if(!pStackInfo->bHidExist) -+ pStackInfo->bHidExist = pCoexSta->bHidExist; //sync BTInfo with BT firmware and stack -+ // when stack HID report error, here we use the info from bt fw. -+ if(!pStackInfo->bBtLinkExist) -+ pStackInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+#endif -+ // check if Sco only -+ if( pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bScoOnly = TRUE; -+ else -+ pBtLinkInfo->bScoOnly = FALSE; -+ -+ // check if A2dp only -+ if( !pBtLinkInfo->bScoExist && -+ pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bA2dpOnly = TRUE; -+ else -+ pBtLinkInfo->bA2dpOnly = FALSE; -+ -+ // check if Pan only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ pBtLinkInfo->bPanExist && -+ !pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bPanOnly = TRUE; -+ else -+ pBtLinkInfo->bPanOnly = FALSE; -+ -+ // check if Hid only -+ if( !pBtLinkInfo->bScoExist && -+ !pBtLinkInfo->bA2dpExist && -+ !pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bHidExist ) -+ pBtLinkInfo->bHidOnly = TRUE; -+ else -+ pBtLinkInfo->bHidOnly = FALSE; -+} -+ -+u1Byte -+halbtc8821a2ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ u1Byte algorithm=BT_8821A_2ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!pBtLinkInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No BT link exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pBtLinkInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pBtLinkInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(numOfDiffProfile == 1) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO only\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_HID; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_A2DP; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(HS) only\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(EDR) only\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 2) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if(pBtLinkInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ else if(pBtLinkInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ else if(pBtLinkInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(HS)\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(EDR)\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+#if 0 -+ if(pStackInfo->numOfHid >= 2) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID*2 + A2DP\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ else -+#endif -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(HS)\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_HID; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(EDR)\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(HS)\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_A2DP_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(EDR)\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP ==> SCO\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ else if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(HS) ==> SCO\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(EDR) ==> SCO\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ } -+ else if( pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ } -+ } -+ else -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile >= 3) -+ { -+ if(pBtLinkInfo->bScoExist) -+ { -+ if( pBtLinkInfo->bHidExist && -+ pBtLinkInfo->bPanExist && -+ pBtLinkInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+VOID -+halbtc8821a2ant_SetFwDacSwingLevel( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte dacSwingLvl -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ // There are several type of dacswing -+ // 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 -+ H2C_Parameter[0] = dacSwingLvl; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Set Dac Swing Level=0x%x\n", dacSwingLvl)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x64=0x%x\n", H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x64, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8821a2ant_SetFwDecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte decBtPwrLvl -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = decBtPwrLvl; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], decrease Bt Power level = %d, FW write 0x62=0x%x\n", -+ decBtPwrLvl, H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x62, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8821a2ant_DecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte decBtPwrLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s Dec BT power level = %d\n", -+ (bForceExec? "force to":""), decBtPwrLvl)); -+ pCoexDm->curBtDecPwrLvl = decBtPwrLvl; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->preBtDecPwrLvl == pCoexDm->curBtDecPwrLvl) -+ return; -+ } -+ halbtc8821a2ant_SetFwDecBtPwr(pBtCoexist, pCoexDm->curBtDecPwrLvl); -+ -+ pCoexDm->preBtDecPwrLvl = pCoexDm->curBtDecPwrLvl; -+} -+ -+VOID -+halbtc8821a2ant_SetBtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = 0; -+ -+ if(bEnableAutoReport) -+ { -+ H2C_Parameter[0] |= BIT0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], BT FW auto report : %s, FW write 0x68=0x%x\n", -+ (bEnableAutoReport? "Enabled!!":"Disabled!!"), H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x68, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8821a2ant_BtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s BT Auto report = %s\n", -+ (bForceExec? "force to":""), ((bEnableAutoReport)? "Enabled":"Disabled"))); -+ pCoexDm->bCurBtAutoReport = bEnableAutoReport; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreBtAutoReport == pCoexDm->bCurBtAutoReport) -+ return; -+ } -+ halbtc8821a2ant_SetBtAutoReport(pBtCoexist, pCoexDm->bCurBtAutoReport); -+ -+ pCoexDm->bPreBtAutoReport = pCoexDm->bCurBtAutoReport; -+} -+ -+VOID -+halbtc8821a2ant_FwDacSwingLvl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte fwDacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set FW Dac Swing level = %d\n", -+ (bForceExec? "force to":""), fwDacSwingLvl)); -+ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->preFwDacSwingLvl == pCoexDm->curFwDacSwingLvl) -+ return; -+ } -+ -+ halbtc8821a2ant_SetFwDacSwingLevel(pBtCoexist, pCoexDm->curFwDacSwingLvl); -+ -+ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -+} -+ -+VOID -+halbtc8821a2ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xffffc); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+VOID -+halbtc8821a2ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8821a2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8821a2ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte H2C_Parameter[6] ={0}; -+ -+ H2C_Parameter[0] = 0x6; // opCode, 0x6= Retry_Penalty -+ -+ if(bLowPenaltyRa) -+ { -+ H2C_Parameter[1] |= BIT0; -+ H2C_Parameter[2] = 0x00; //normal rate except MCS7/6/5, OFDM54/48/36 -+ H2C_Parameter[3] = 0xf5; //MCS7 or OFDM54 -+ H2C_Parameter[4] = 0xa0; //MCS6 or OFDM48 -+ H2C_Parameter[5] = 0xa0; //MCS5 or OFDM36 -+ //H2C_Parameter[3] = 0xf7; //MCS7 or OFDM54 -+ //H2C_Parameter[4] = 0xf8; //MCS6 or OFDM48 -+ //H2C_Parameter[5] = 0xf9; //MCS5 or OFDM36 -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set WiFi Low-Penalty Retry: %s", -+ (bLowPenaltyRa? "ON!!":"OFF!!")) ); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter); -+} -+ -+VOID -+halbtc8821a2ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ //return; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8821a2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8821a2ant_SetDacSwingReg( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte level -+ ) -+{ -+ u1Byte val=(u1Byte)level; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Write SwDacSwing = 0x%x\n", level)); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xc5b, 0x3e, val); -+} -+ -+VOID -+halbtc8821a2ant_SetSwFullTimeDacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSwDacSwingOn, -+ IN u4Byte swDacSwingLvl -+ ) -+{ -+ if(bSwDacSwingOn) -+ { -+ halbtc8821a2ant_SetDacSwingReg(pBtCoexist, swDacSwingLvl); -+ } -+ else -+ { -+ halbtc8821a2ant_SetDacSwingReg(pBtCoexist, 0x18); -+ } -+} -+ -+ -+VOID -+halbtc8821a2ant_DacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacSwingOn, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", -+ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); -+ pCoexDm->bCurDacSwingOn = bDacSwingOn; -+ pCoexDm->curDacSwingLvl = dacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && -+ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) -+ return; -+ } -+ delay_ms(30); -+ halbtc8821a2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); -+ -+ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; -+ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -+} -+ -+VOID -+halbtc8821a2ant_SetAdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ if(bAdcBackOff) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x8db, 0x60, 0x3); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x8db, 0x60, 0x1); -+ } -+} -+ -+VOID -+halbtc8821a2ant_AdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", -+ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); -+ pCoexDm->bCurAdcBackOff = bAdcBackOff; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) -+ return; -+ } -+ halbtc8821a2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); -+ -+ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -+} -+ -+VOID -+halbtc8821a2ant_SetAgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ u1Byte rssiAdjustVal=0; -+ -+ //=================BB AGC Gain Table -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB Agc Table On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6e1A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6d1B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6c1C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6b1D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6a1E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x691F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x68200001); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB Agc Table Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xaa1A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa91B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa81C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa71D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa61E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa51F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0xa4200001); -+ } -+ -+ -+ //=================RF Gain -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x38fff); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x38ffe); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x380c3); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x28ce6); -+ } -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xed, 0xfffff, 0x1); -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x38fff); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x38ffe); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x380c3); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x40, 0xfffff, 0x28ce6); -+ } -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xed, 0xfffff, 0x0); -+ -+ // set rssiAdjustVal for wifi module. -+ if(bAgcTableEn) -+ { -+ rssiAdjustVal = 8; -+ } -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -+} -+ -+VOID -+halbtc8821a2ant_AgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", -+ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); -+ pCoexDm->bCurAgcTableEn = bAgcTableEn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) -+ return; -+ } -+ halbtc8821a2ant_SetAgcTable(pBtCoexist, bAgcTableEn); -+ -+ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -+} -+ -+VOID -+halbtc8821a2ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8821a2ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c4, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8821a2ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8821a2ant_CoexTableWithType( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexSta->nCoexTableType = type; -+ -+ switch(type) -+ { -+ case 0: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x55555555, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5afa5afa, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x5ada5ada, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0xffffffff, 0xffffffff, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0x5fff5fff, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x55ff55ff, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 7: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 8: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 9: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 10: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 11: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 12: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 13: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 14: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 15: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 16: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0x5fdf5fdf, 0x5fdb5fdb, 0xffffff, 0x3); -+ break; -+ case 17: -+ halbtc8821a2ant_CoexTable(pBtCoexist, bForceExec, 0xfafafafa, 0xfafafafa, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+VOID -+halbtc8821a2ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(bEnable) -+ { -+ H2C_Parameter[0] |= BIT0; // function enable -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8821a2ant_SetLpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ u1Byte lps=lpsVal; -+ u1Byte rpwm=rpwmVal; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+VOID -+halbtc8821a2ant_LpsRpwm( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bForceExecPwrCmd=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set lps/rpwm=0x%x/0x%x \n", -+ (bForceExec? "force to":""), lpsVal, rpwmVal)); -+ pCoexDm->curLps = lpsVal; -+ pCoexDm->curRpwm = rpwmVal; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preLps == pCoexDm->curLps) && -+ (pCoexDm->preRpwm == pCoexDm->curRpwm) ) -+ { -+ return; -+ } -+ } -+ halbtc8821a2ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal); -+ -+ pCoexDm->preLps = pCoexDm->curLps; -+ pCoexDm->preRpwm = pCoexDm->curRpwm; -+} -+ -+VOID -+halbtc8821a2ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8821a2ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8821a2ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ -+ H2C_Parameter[0] = byte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = byte5; -+ -+ pCoexDm->psTdmaPara[0] = byte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = byte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x60(5bytes)=0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter); -+} -+ -+VOID -+halbtc8821a2ant_SwMechanism1( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bShrinkRxLPF, -+ IN BOOLEAN bLowPenaltyRA, -+ IN BOOLEAN bLimitedDIG, -+ IN BOOLEAN bBTLNAConstrain -+ ) -+{ -+ /* -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if(BTC_WIFI_BW_HT40 != wifiBw) //only shrink RF Rx LPF for HT40 -+ { -+ if (bShrinkRxLPF) -+ bShrinkRxLPF = FALSE; -+ } -+ */ -+ -+ //halbtc8821a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, bShrinkRxLPF); -+ halbtc8821a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA); -+} -+ -+VOID -+halbtc8821a2ant_SwMechanism2( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAGCTableShift, -+ IN BOOLEAN bADCBackOff, -+ IN BOOLEAN bSWDACSwing, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ //halbtc8821a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, bAGCTableShift); -+ //halbtc8821a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, bADCBackOff); -+ halbtc8821a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, bSWDACSwing, dacSwingLvl); -+} -+ -+VOID -+halbtc8821a2ant_SetAntPath( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte antPosType, -+ IN BOOLEAN bInitHwCfg, -+ IN BOOLEAN bWifiOff -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte u4Tmp=0; -+ u1Byte H2C_Parameter[2] ={0}; -+ -+ if(bInitHwCfg) -+ { -+ // 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp &=~BIT23; -+ u4Tmp |= BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x974, 0x3ff); -+ //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xcb4, 0x77); -+ -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ { -+ //tell firmware "antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix -+ H2C_Parameter[0] = 1; -+ H2C_Parameter[1] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } -+ else -+ { -+ //tell firmware "no antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix -+ H2C_Parameter[0] = 0; -+ H2C_Parameter[1] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } -+ } -+ -+ // ext switch setting -+ switch(antPosType) -+ { -+ case BTC_ANT_WIFI_AT_MAIN: -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xcb7, 0x30, 0x1); -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xcb7, 0x30, 0x2); -+ break; -+ } -+} -+ -+VOID -+halbtc8821a2ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bTurnOnByCnt=FALSE; -+ u1Byte psTdmaTypeByCnt=0; -+ u1Byte wifiRssiState1, btRssiState; -+ -+ -+ wifiRssiState1 = halbtc8821a2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8821a2ant_BtRssiState(2, BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ if (!(BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) && bTurnOn) -+ { -+ type = type +100; //for WiFi RSSI low or BT RSSI low -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", -+ (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ if(bTurnOn) -+ { -+ switch(type) -+ { -+ case 1: -+ default: -+ //halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0xf1, 0x90); -+ break; -+ case 2: -+ //halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x2d, 0x03, 0xf1, 0x90); -+ break; -+ case 3: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0xf1, 0x90); -+ break; -+ case 4: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x10, 0x03, 0xf1, 0x90); -+ break; -+ case 5: -+ //halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x3, 0x70, 0x90); -+ break; -+ case 6: -+ //halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x2d, 0x3, 0x70, 0x90); -+ break; -+ case 7: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0x70, 0x90); -+ break; -+ case 8: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x10, 0x3, 0x70, 0x90); -+ break; -+ case 9: -+ //halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0xf1, 0x90); -+ break; -+ case 10: -+ //halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x2d, 0x03, 0xf1, 0x90); -+ break; -+ case 11: -+ //halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0xe1, 0x90); -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0xf1, 0x90); -+ break; -+ case 12: -+ //halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x10, 0x3, 0xf1, 0x90); -+ break; -+ case 13: -+ //halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x3, 0x70, 0x90); -+ break; -+ case 14: -+ //halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x2d, 0x3, 0x70, 0x90); -+ break; -+ case 15: -+ //halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0x60, 0x90); -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0x70, 0x90); -+ break; -+ case 16: -+ //halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0x60, 0x90); -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x10, 0x3, 0x70, 0x90); -+ break; -+ case 17: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x2f, 0x2f, 0x60, 0x90); -+ break; -+ case 18: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 19: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0xe1, 0x90); -+ break; -+ case 20: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0x60, 0x90); -+ break; -+ case 21: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x03, 0x70, 0x90); -+ break; -+ case 23: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1e, 0x03, 0xf0, 0x14); -+ break; -+ case 24: -+ case 124: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x3c, 0x03, 0x70, 0x50); -+ break; -+ //case25/case125 : for lenovo bt pan tp degrade<30% while wifi downlink -+ case 25: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x14, 0x03, 0xf1, 0x90); -+ break; -+ case 71: -+ //halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0xf1, 0x90); -+ break; -+ case 101: -+ case 105: -+ case 171: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x3a, 0x03, 0x70, 0x50); -+ break; -+ case 102: -+ case 106: -+ case 110: -+ case 114: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x2d, 0x03, 0x70, 0x50); -+ break; -+ case 103: -+ case 107: -+ case 111: -+ case 115: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x1c, 0x03, 0x70, 0x50); -+ break; -+ case 104: -+ case 108: -+ case 112: -+ case 116: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x10, 0x03, 0x70, 0x50); -+ break; -+ case 109: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0xf1, 0x90); -+ break; -+ case 113: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x3c, 0x03, 0x70, 0x90); -+ break; -+ case 121: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x03, 0x70, 0x90); -+ break; -+ case 22: -+ case 122: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x35, 0x03, 0x71, 0x11); -+ break; -+ case 123: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x1c, 0x03, 0x70, 0x54); -+ break; -+ //case25/case125 : for lenovo bt pan tp degrade<30% while wifi downlink -+ case 125: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0xd3, 0x14, 0x03, 0x70, 0x50); -+ break; -+ } -+ } -+ else -+ { -+ // disable PS tdma -+ switch(type) -+ { -+ case 0: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x40, 0x0); -+ break; -+ case 1: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x48, 0x0); -+ break; -+ default: -+ halbtc8821a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x40, 0x0); -+ break; -+ } -+ } -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+VOID -+halbtc8821a2ant_PsTdmaCheckForPowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bNewPsState -+ ) -+{ -+ u1Byte lpsMode=0x0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode); -+ -+ if(lpsMode) // already under LPS state -+ { -+ if(bNewPsState) -+ { -+ // keep state under LPS, do nothing. -+ } -+ else -+ { -+ // will leave LPS state, turn off psTdma first -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ } -+ else // NO PS state -+ { -+ if(bNewPsState) -+ { -+ // will enter LPS state, turn off psTdma first -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ else -+ { -+ // keep state under NO PS state, do nothing. -+ } -+ } -+} -+ -+VOID -+halbtc8821a2ant_PowerSaveState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte psType, -+ IN u1Byte lpsVal, -+ IN u1Byte rpwmVal -+ ) -+{ -+ BOOLEAN bLowPwrDisable=FALSE; -+ -+ switch(psType) -+ { -+ case BTC_PS_WIFI_NATIVE: -+ // recover to original 32k low power setting -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8821a2ant_PsTdmaCheckForPowerSaveState(pBtCoexist, TRUE); -+ halbtc8821a2ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal); -+ // when coex force to enter LPS, do not enter 32k low power. -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ // power save must executed before psTdma. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); -+ pCoexSta->bForceLpsOn = TRUE; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8821a2ant_PsTdmaCheckForPowerSaveState(pBtCoexist, FALSE); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL); -+ pCoexSta->bForceLpsOn = FALSE; -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+VOID -+halbtc8821a2ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw all off -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ // hw all off -+ //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8821a2ant_CoexUnder5G( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a2ant_CoexAllOff(pBtCoexist); -+ -+ halbtc8821a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, TRUE); -+} -+ -+VOID -+halbtc8821a2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 6); -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, FORCE_EXEC, 0); -+ -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+VOID -+halbtc8821a2ant_ActionBtInquiry( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ BOOLEAN bWifiConnected=FALSE; -+ BOOLEAN bLowPwrDisable=TRUE; -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ -+ -+ wifiRssiState = halbtc8821a2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8821a2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8821a2ant_BtRssiState(2, BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ if(bScan || bLink || bRoam) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi link process + BT Inq/Page!!\n")); -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 15); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ } -+ else if(bWifiConnected) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT Inq/Page!!\n")); -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 15); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi no-link + BT Inq/Page!!\n")); -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 6); -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+} -+ -+ -+VOID -+halbtc8821a2ant_ActionWiFiLinkProcess( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte u1Tmpa, u1Tmpb; -+ -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 15); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ -+ -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x765=0x%x, 0x76e=0x%x\n", u1Tmpa, u1Tmpb)); -+} -+ -+BOOLEAN -+halbtc8821a2ant_ActionWifiIdleProcess( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ u1Byte apNum=0; -+ -+ wifiRssiState = halbtc8821a2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ //wifiRssiState1 = halbtc8821a2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ wifiRssiState1 = halbtc8821a2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES-20, 0); -+ btRssiState = halbtc8821a2ant_BtRssiState(2, BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ -+ // define the office environment -+ if(BTC_RSSI_HIGH(wifiRssiState1) && -+ (pCoexSta->bHidExist == TRUE) && (pCoexSta->bA2dpExist == TRUE)) -+ { -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle process for BT HID+A2DP exist!!\n")); -+ -+ halbtc8821a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x6); -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ -+ return TRUE; -+ } -+ -+ // -+ else if (pCoexSta->bPanExist== TRUE) -+ { -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle process for BT PAN exist!!\n")); -+ -+ halbtc8821a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x6); -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ -+ return TRUE; -+ } -+ -+ else -+ { -+ halbtc8821a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ return FALSE; -+ } -+ -+ -+} -+ -+ -+ -+BOOLEAN -+halbtc8821a2ant_IsCommonAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte btRssiState=BTC_RSSI_STATE_HIGH; -+ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE, bWifiBusy=FALSE; -+ BOOLEAN bBtHsOn=FALSE, bLowPwrDisable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if(!bWifiConnected) -+ { -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-connected idle!!\n")); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ if(BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT non connected-idle!!\n")); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0xb); -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else if(BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) -+ { -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ if(bBtHsOn) -+ return FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT connected-idle!!\n")); -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0xb); -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ if(bWifiBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n")); -+ bCommon = FALSE; -+ //bCommon = halbtc8821a2ant_ActionWifiIdleProcess(pBtCoexist); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n")); -+ //bCommon = FALSE; -+ bCommon = halbtc8821a2ant_ActionWifiIdleProcess(pBtCoexist); -+ } -+ } -+ } -+ -+ return bCommon; -+} -+VOID -+halbtc8821a2ant_TdmaDurationAdjust( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bScoHid, -+ IN BOOLEAN bTxPause, -+ IN u1Byte maxInterval -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjust()\n")); -+ -+ if(!pCoexDm->bAutoTdmaAdjust) -+ { -+ pCoexDm->bAutoTdmaAdjust = TRUE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ { -+ if(bScoHid) -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ else -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ } -+ } -+ } -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], retryCount = %d\n", retryCount)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], up=%d, dn=%d, m=%d, n=%d, WaitCount=%d\n", -+ up, dn, m, n, WaitCount)); -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], max Interval = %d\n", maxInterval)); -+ if(maxInterval == 1) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ -+ if(pCoexDm->curPsTdma == 71) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 71); -+ pCoexDm->psTdmaDuAdjType = 71; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 71) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 71); -+ pCoexDm->psTdmaDuAdjType = 71; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 2) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 3) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ } -+ } -+ -+ // if current PsTdma not match with the recorded one (when scan, dhcp...), -+ // then we have to adjust it back to the previous record one. -+ if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) -+ { -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", -+ pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if( !bScan && !bLink && !bRoam) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); -+ } -+ } -+} -+ -+// SCO only or SCO+PAN(HS) -+VOID -+halbtc8821a2ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ u1Byte wifiRssiState, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8821a2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8821a2ant_BtRssiState(2, BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 4); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) //for SCO quality at 11b/g mode -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+ else //for SCO quality & wifi performance balance at 11n mode -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 8); -+ else -+ { -+ if(pBtLinkInfo->bScoOnly) -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 17); -+ else -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 12); -+ } -+ } -+ -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); //for voice quality -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x18); -+ } -+ } -+} -+ -+ -+VOID -+halbtc8821a2ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8821a2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8821a2ant_BtRssiState(2, BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) //for HID at 11b/g mode -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ } -+ else //for HID quality & wifi performance balance at 11n mode -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2); -+ } -+ -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -+VOID -+halbtc8821a2ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ u1Byte apNum=0; -+ -+ wifiRssiState = halbtc8821a2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8821a2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8821a2ant_BtRssiState(2, BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ -+ // define the office environment -+ if( (apNum >= 10) && BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ //DbgPrint(" AP#>10(%d)\n", apNum); -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ //halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x6); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,TRUE,0x6); -+ } -+ return; -+ -+ } -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 13); -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ //halbtc8821a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ } -+ else -+ { -+ //halbtc8821a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ } -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8821a2ant_ActionA2dpPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8821a2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8821a2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8821a2ant_BtRssiState(2, BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 13); -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ halbtc8821a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 2); -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8821a2ant_ActionPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState,wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8821a2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8821a2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8821a2ant_BtRssiState(2, BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 10); -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 13); -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); -+ } -+ else -+ { -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); -+ } -+ -+ // sw mechanism -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+ -+//PAN(HS) only -+VOID -+halbtc8821a2ant_ActionPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8821a2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8821a2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8821a2ant_BtRssiState(2, BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+//PAN(EDR)+A2DP -+VOID -+halbtc8821a2ant_ActionPanEdrA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8821a2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8821a2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8821a2ant_BtRssiState(2, BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 12); -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ halbtc8821a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ else -+ halbtc8821a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); -+ } -+ else -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 13); -+ halbtc8821a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8821a2ant_ActionPanEdrHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8821a2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8821a2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8821a2ant_BtRssiState(2, BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 14); -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 3); -+ //halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 11); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); -+ } -+ else -+ { -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ //halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ } -+ halbtc8821a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 2); -+ } -+ else -+ { -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ //halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 14); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8821a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+// HID+A2DP+PAN(EDR) -+VOID -+halbtc8821a2ant_ActionHidA2dpPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState,wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8821a2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ wifiRssiState1 = halbtc8821a2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8821a2ant_BtRssiState(2, BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x8); -+ -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 14); -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ halbtc8821a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ else -+ halbtc8821a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); -+ } -+ else -+ { -+ halbtc8821a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8821a2ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btRssiState; -+ u4Byte wifiBw; -+ u1Byte apNum=0; -+ -+ wifiRssiState = halbtc8821a2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ //btRssiState = halbtc8821a2ant_BtRssiState(2, 29, 0); -+ wifiRssiState1 = halbtc8821a2ant_WifiRssiState(pBtCoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ btRssiState = halbtc8821a2ant_BtRssiState(3, BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 37); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x5); -+ -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_LEGACY == wifiBw) -+ { -+ if(BTC_RSSI_HIGH(btRssiState)) -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ else -+ { // only 802.11N mode we have to dec bt power to 4 degree -+ if(BTC_RSSI_HIGH(btRssiState)) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ // need to check ap Number of Not -+ if(apNum < 10) -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 4); -+ else -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ } -+ else if(BTC_RSSI_MEDIUM(btRssiState)) -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ } -+ -+ if (BTC_RSSI_HIGH(wifiRssiState1) && BTC_RSSI_HIGH(btRssiState)) -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } -+ else -+ { -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 14); -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ } -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ //halbtc8821a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ } -+ else -+ { -+ //halbtc8821a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8821a2ant_ActionBtWhckTest( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+} -+ -+VOID -+halbtc8821a2ant_ActionWifiMultiPort( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8821a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, 0); -+ -+ // sw all off -+ halbtc8821a2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821a2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ // hw all off -+ //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+} -+ -+VOID -+halbtc8821a2ant_RunCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiUnder5G=FALSE, bBtHsOn=FALSE; -+ u1Byte btInfoOriginal=0, btRetryCnt=0; -+ u1Byte algorithm=0; -+ u4Byte numOfWifiLink=0; -+ u4Byte wifiLinkStatus=0; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ BOOLEAN bMiracastPlusBt=FALSE; -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism()===>\n")); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ if(bWifiUnder5G) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), run 5G coex setting!!<===\n")); -+ halbtc8821a2ant_CoexUnder5G(pBtCoexist); -+ return; -+ } -+ -+ if(pCoexSta->bUnderIps) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under IPS !!!\n")); -+ return; -+ } -+ -+ if(pCoexSta->bBtWhckTest) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is under WHCK TEST!!!\n")); -+ halbtc8821a2ant_ActionBtWhckTest(pBtCoexist); -+ return; -+ } -+ -+ algorithm = halbtc8821a2ant_ActionAlgorithm(pBtCoexist); -+ if(pCoexSta->bC2hBtInquiryPage && (BT_8821A_2ANT_COEX_ALGO_PANHS!=algorithm)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is under inquiry/page scan !!\n")); -+ halbtc8821a2ant_ActionBtInquiry(pBtCoexist); -+ return; -+ } -+ else -+ { -+ -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if(bScan || bLink || bRoam) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], WiFi is under Link Process !!\n")); -+ halbtc8821a2ant_ActionWiFiLinkProcess(pBtCoexist); -+ return; -+ } -+ -+ //for P2P -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus); -+ numOfWifiLink = wifiLinkStatus>>16; -+ -+ if((numOfWifiLink>=2) || (wifiLinkStatus&WIFI_P2P_GO_CONNECTED)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], Multi-Port numOfWifiLink = %d, wifiLinkStatus = 0x%x\n", numOfWifiLink,wifiLinkStatus) ); -+ -+ if(pBtLinkInfo->bBtLinkExist) -+ { -+ bMiracastPlusBt = TRUE; -+ } -+ else -+ { -+ bMiracastPlusBt = FALSE; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ halbtc8821a2ant_ActionWifiMultiPort(pBtCoexist); -+ -+ return; -+ } -+ else -+ { -+ bMiracastPlusBt = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt); -+ } -+ -+ pCoexDm->curAlgorithm = algorithm; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Algorithm = %d \n", pCoexDm->curAlgorithm)); -+ -+ if(halbtc8821a2ant_IsCommonAction(pBtCoexist)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant common.\n")); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ else -+ { -+ if(pCoexDm->curAlgorithm != pCoexDm->preAlgorithm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], preAlgorithm=%d, curAlgorithm=%d\n", -+ pCoexDm->preAlgorithm, pCoexDm->curAlgorithm)); -+ pCoexDm->bAutoTdmaAdjust = FALSE; -+ } -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8821A_2ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO.\n")); -+ halbtc8821a2ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID.\n")); -+ halbtc8821a2ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP.\n")); -+ halbtc8821a2ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_A2DP_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n")); -+ halbtc8821a2ant_ActionA2dpPanHs(pBtCoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n")); -+ halbtc8821a2ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HS mode.\n")); -+ halbtc8821a2ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_PANEDR_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n")); -+ halbtc8821a2ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_PANEDR_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n")); -+ halbtc8821a2ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n")); -+ halbtc8821a2ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n")); -+ halbtc8821a2ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n")); -+ halbtc8821a2ant_CoexAllOff(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+} -+ -+VOID -+halbtc8821a2ant_WifiOffHwCfg( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bIsInMpMode = FALSE; -+ u1Byte H2C_Parameter[2] ={0}; -+ u4Byte fwVer=0; -+ -+ // set wlan_act to low -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); //WiFi goto standby while GNT_BT 0-->1 -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ if(fwVer >= 0x180000) -+ { -+ /* Use H2C to set GNT_BT to HIGH */ -+ H2C_Parameter[0] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); -+ } -+} -+ -+VOID -+halbtc8821a2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bBackUp -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte u4Tmp=0, fwVer; -+ u2Byte u2Tmp=0; -+ u1Byte u1Tmp=0; -+ u1Byte H2C_Parameter[2] ={0}; -+ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); -+ -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ // 0x790[5:0]=0x5 -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x790); -+ u1Tmp &= 0xc0; -+ u1Tmp |= 0x5; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, u1Tmp); -+ -+ //Antenna config -+ halbtc8821a2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_MAIN, TRUE, FALSE); -+ pCoexSta->disVerInfoCnt = 0; -+ -+ // PTA parameter -+ halbtc8821a2ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0); -+ -+ // Enable counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); //0x76e[3] =1, WLAN_Act control by PTA -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x3); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0x20, 0x1); -+} -+ -+//============================================================ -+// work around function start with wa_halbtc8821a2ant_ -+//============================================================ -+//============================================================ -+// extern function start with EXhalbtc8821a2ant_ -+//============================================================ -+VOID -+EXhalbtc8821a2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ -+} -+ -+VOID -+EXhalbtc8821a2ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u1Byte u1Tmp=0x4; /* Set BIT2 by default since it's 2ant case */ -+ -+ // -+ // S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) -+ // Local setting bit define -+ // BIT0: "0" for no antenna inverse; "1" for antenna inverse -+ // BIT1: "0" for internal switch; "1" for external switch -+ // BIT2: "0" for one antenna; "1" for two antenna -+ // NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 -+ if(pBtCoexist->chipInterface == BTC_INTF_USB) -+ { -+ // fixed at S0 for USB interface -+ u1Tmp |= 0x1; // antenna inverse -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0xfe08, u1Tmp); -+ } -+ else -+ { -+ // for PCIE and SDIO interface, we check efuse 0xc3[6] -+ if(pBoardInfo->singleAntPath == 0) -+ { -+ } -+ else if(pBoardInfo->singleAntPath == 1) -+ { -+ // set to S0 -+ u1Tmp |= 0x1; // antenna inverse -+ } -+ -+ if(pBtCoexist->chipInterface == BTC_INTF_PCI) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x384, u1Tmp); -+ } -+ else if(pBtCoexist->chipInterface == BTC_INTF_SDIO) -+ { -+ pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x60, u1Tmp); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8821a2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ halbtc8821a2ant_InitHwConfig(pBtCoexist, TRUE); -+} -+ -+VOID -+EXhalbtc8821a2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8821a2ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8821a2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ u4Byte faOfdm, faCck; -+ u4Byte fwVer=0, btPatchVer=0; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n =========================================="); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", "CoexVer/ FwVer/ PatchVer", \ -+ GLCoexVerDate8821a2Ant, GLCoexVer8821a2Ant, fwVer, btPatchVer, btPatchVer); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %ddBm/ %d] ", "BT [status/ rssi/ retryCnt]", \ -+ ((pBtCoexist->btInfo.bBtDisabled)? ("disabled"): ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)? "non-connected idle": -+ ( (BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy")))), -+ pCoexSta->btRssi-100, pCoexSta->btRetryCnt); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pBtLinkInfo->bScoExist, pBtLinkInfo->bHidExist, pBtLinkInfo->bPanExist, pBtLinkInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ -+ if (pStackInfo->bProfileNotified) -+ { -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Role", \ -+ (pBtLinkInfo->bSlaveRole )? "Slave":"Master"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8821a2Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", "SM1[ShRf/ LpRA/ LimDig]", \ -+ pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ -+ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase, pCoexDm->bAutoTdmaAdjust); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Coex Table Type", \ -+ pCoexSta->nCoexTableType); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "DecBtPwr/ IgnWlanAct", \ -+ pCoexDm->curBtDecPwrLvl, pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xc5b); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/0x880[29:25]/0xc58[29:25]", \ -+ u1Tmp[0], (u4Tmp[0]&0x3e000000) >> 25, ((u1Tmp[1]&0x3e)>>1)); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x764); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x764/ 0x765/ 0x76e", \ -+ (u4Tmp[0]&0xff), (u4Tmp[0]&0xff00)>>8, u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xcb4); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0xcb4[7:0](ctrl)/ 0xcb4[29:28](val)", \ -+ u4Tmp[0]&0xff, ((u4Tmp[0]&0x30000000)>>28)); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x974); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x40/ 0x4c[24:23]/ 0x974", \ -+ u1Tmp[0], ((u4Tmp[0]&0x01800000)>>23), u4Tmp[1]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49c); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0xc50(dig)/0x49c(null-drop)", \ -+ u4Tmp[0]&0xff, u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); -+ u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xcf0); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5b); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5c); -+ -+ faOfdm = ((u4Tmp[0]&0xffff0000) >> 16) + ((u4Tmp[1]&0xffff0000) >> 16) + (u4Tmp[1] & 0xffff) + (u4Tmp[2] & 0xffff) + \ -+ ((u4Tmp[3]&0xffff0000) >> 16) + (u4Tmp[3] & 0xffff) ; -+ faCck = (u1Tmp[0] << 8) + u1Tmp[1]; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "OFDM-CCA/OFDM-FA/CCK-FA", \ -+ u4Tmp[0]&0xffff, faOfdm, faCck); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_OK CCK/11g/11n/11n-Agg", \ -+ pCoexSta->nCRCOK_CCK, pCoexSta->nCRCOK_11g, pCoexSta->nCRCOK_11n, pCoexSta->nCRCOK_11nAgg); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_Err CCK/11g/11n/11n-Agg", \ -+ pCoexSta->nCRCErr_CCK, pCoexSta->nCRCErr_11g, pCoexSta->nCRCErr_11n, pCoexSta->nCRCErr_11nAgg); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770(high-pri rx/tx)", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(low-pri rx/tx)", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+#if(BT_AUTO_REPORT_ONLY_8821A_2ANT == 1) -+ //halbtc8821a2ant_MonitorBtCtr(pBtCoexist); -+#endif -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8821a2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ pCoexSta->bUnderIps = TRUE; -+ halbtc8821a2ant_WifiOffHwCfg(pBtCoexist); -+ halbtc8821a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ halbtc8821a2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ pCoexSta->bUnderIps = FALSE; -+ halbtc8821a2ant_InitHwConfig(pBtCoexist, FALSE); -+ halbtc8821a2ant_InitCoexDm(pBtCoexist); -+ halbtc8821a2ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8821a2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ pCoexSta->bUnderLps = TRUE; -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ pCoexSta->bUnderLps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8821a2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte u1Tmpa, u1Tmpb; -+ -+ u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765); -+ u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e); -+ -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x765=0x%x, 0x76e=0x%x\n", u1Tmpa, u1Tmpb)); -+} -+ -+VOID -+EXhalbtc8821a2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8821a2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ u1Byte apNum=0; -+ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+ -+ // only 2.4G we need to inform bt the chnl mask -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if( (BTC_MEDIA_CONNECT == type) && -+ (wifiCentralChnl <= 14) ) -+ { -+ H2C_Parameter[0] = 0x1; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &apNum); -+ if(apNum < 10) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x66=0x%x\n", -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter); -+} -+ -+VOID -+EXhalbtc8821a2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8821a2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo; -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bBtBusy=FALSE, bLimitedDig=FALSE; -+ BOOLEAN bWifiConnected=FALSE, bWifiUnder5G=FALSE; -+ static BOOLEAN bPreScoExist=FALSE; -+ u4Byte raMask=0x0; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ rspSource = tmpBuf[0]&0xf; -+ if(rspSource >= BT_INFO_SRC_8821A_2ANT_MAX) -+ rspSource = BT_INFO_SRC_8821A_2ANT_WIFI_FW; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 1) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), return for Manual CTRL<===\n")); -+ return; -+ } -+ -+ // if 0xff, it means BT is under WHCK test -+ if (btInfo == 0xff) -+ pCoexSta->bBtWhckTest = TRUE; -+ else -+ pCoexSta->bBtWhckTest = FALSE; -+ -+ if(BT_INFO_SRC_8821A_2ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = // [3:0] -+ pCoexSta->btInfoC2h[rspSource][2]&0xf; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][3]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][4]; -+ -+ pCoexSta->bBtTxRxMask = (pCoexSta->btInfoC2h[rspSource][2]&0x40); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TX_RX_MASK, &pCoexSta->bBtTxRxMask); -+ if(pCoexSta->bBtTxRxMask) -+ { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x01 => Need to switch BT TRx Mask */ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x01\n")); -+ pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x01); -+ } -+ -+ // Here we need to resend some wifi info to BT -+ // because bt is reset and loss of the info. -+ if( (pCoexSta->btInfoExt & BIT1) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n")); -+ if(bWifiConnected) -+ { -+ EXhalbtc8821a2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT); -+ } -+ else -+ { -+ EXhalbtc8821a2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ } -+ -+ -+ if(!pBtCoexist->bManualControl && !bWifiUnder5G) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info = 0x%x!!\n", pCoexSta->btInfoExt)); -+ if( (pCoexSta->btInfoExt&BIT3) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3=1, bWifiConnected=%d\n", bWifiConnected)); -+ if(bWifiConnected) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")); -+ halbtc8821a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3=0, bWifiConnected=%d\n", bWifiConnected)); -+ // BT already NOT ignore Wlan active, do nothing here. -+ if(!bWifiConnected) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT to ignore Wlan active!!\n")); -+ halbtc8821a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+ } -+ } -+ -+#if(BT_AUTO_REPORT_ONLY_8821A_2ANT == 0) -+ if( (pCoexSta->btInfoExt & BIT4) ) -+ { -+ // BT auto report already enabled, do nothing -+ } -+ else -+ { -+ halbtc8821a2ant_BtAutoReport(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+#endif -+ } -+ -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8821A_2ANT_B_INQ_PAGE) -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ else -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ -+ // set link exist status -+ if(!(btInfo&BT_INFO_8821A_2ANT_B_CONNECTION)) -+ { -+ pCoexSta->bBtLinkExist = FALSE; -+ pCoexSta->bPanExist = FALSE; -+ pCoexSta->bA2dpExist = FALSE; -+ pCoexSta->bHidExist = FALSE; -+ pCoexSta->bScoExist = FALSE; -+ } -+ else // connection exists -+ { -+ pCoexSta->bBtLinkExist = TRUE; -+ if(btInfo & BT_INFO_8821A_2ANT_B_FTP) -+ pCoexSta->bPanExist = TRUE; -+ else -+ pCoexSta->bPanExist = FALSE; -+ if(btInfo & BT_INFO_8821A_2ANT_B_A2DP) -+ pCoexSta->bA2dpExist = TRUE; -+ else -+ pCoexSta->bA2dpExist = FALSE; -+ if(btInfo & BT_INFO_8821A_2ANT_B_HID) -+ pCoexSta->bHidExist = TRUE; -+ else -+ pCoexSta->bHidExist = FALSE; -+ if(btInfo & BT_INFO_8821A_2ANT_B_SCO_ESCO) -+ pCoexSta->bScoExist = TRUE; -+ else -+ pCoexSta->bScoExist = FALSE; -+ -+ if ( (pCoexSta->bHidExist == FALSE) && (pCoexSta->bC2hBtInquiryPage == FALSE) && (pCoexSta->bScoExist == FALSE)) -+ { -+ if (pCoexSta->highPriorityTx + pCoexSta->highPriorityRx >= 160) -+ pCoexSta->bHidExist = TRUE; -+ } -+ } -+ -+ halbtc8821a2ant_UpdateBtLinkInfo(pBtCoexist); -+ -+ if(!(btInfo&BT_INFO_8821A_2ANT_B_CONNECTION)) -+ { -+ pCoexDm->btStatus = BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n")); -+ } -+ else if(btInfo == BT_INFO_8821A_2ANT_B_CONNECTION) // connection exists but no busy -+ { -+ pCoexDm->btStatus = BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n")); -+ } -+ else if((btInfo&BT_INFO_8821A_2ANT_B_SCO_ESCO) || -+ (btInfo&BT_INFO_8821A_2ANT_B_SCO_BUSY)) -+ { -+ pCoexDm->btStatus = BT_8821A_2ANT_BT_STATUS_SCO_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n")); -+ } -+ else if(btInfo&BT_INFO_8821A_2ANT_B_ACL_BUSY) -+ { -+ pCoexDm->btStatus = BT_8821A_2ANT_BT_STATUS_ACL_BUSY; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n")); -+ } -+ else -+ { -+ pCoexDm->btStatus = BT_8821A_2ANT_BT_STATUS_MAX; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n")); -+ } -+ -+ if( (BT_8821A_2ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) || -+ (BT_8821A_2ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) || -+ (BT_8821A_2ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) ) -+ { -+ bBtBusy = TRUE; -+ bLimitedDig = TRUE; -+ } -+ else -+ { -+ bBtBusy = FALSE; -+ bLimitedDig = FALSE; -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ pCoexDm->bLimitedDig = bLimitedDig; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bLimitedDig); -+ -+ halbtc8821a2ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8821a2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8821a2ant_WifiOffHwCfg(pBtCoexist); -+ //remove due to interrupt is disabled that polling c2h will fail and delay 100ms. -+ //pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT goto standby while GNT_BT 1-->0 -+ halbtc8821a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ -+ EXhalbtc8821a2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+VOID -+EXhalbtc8821a2ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify\n")); -+ -+ if(BTC_WIFI_PNP_SLEEP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to SLEEP\n")); -+ } -+ else if(BTC_WIFI_PNP_WAKE_UP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to WAKE UP\n")); -+ halbtc8821a2ant_InitHwConfig(pBtCoexist, FALSE); -+ halbtc8821a2ant_InitCoexDm(pBtCoexist); -+ halbtc8821a2ant_QueryBtInfo(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8821a2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ //static u1Byte disVerInfoCnt=0; -+ u4Byte fwVer=0, btPatchVer=0; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ==========================Periodical===========================\n")); -+ -+ if(pCoexSta->disVerInfoCnt <= 5) -+ { -+ pCoexSta->disVerInfoCnt += 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ant PG Num/ Ant Mech/ Ant Pos = %d/ %d/ %d\n", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT stack/ hci ext ver = %s / %d\n", -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion)); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", -+ GLCoexVerDate8821a2Ant, GLCoexVer8821a2Ant, fwVer, btPatchVer, btPatchVer)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ -+ if (pCoexSta->disVerInfoCnt == 3) -+ { -+ //Antenna config to set 0x765 = 0x0 (GNT_BT control by PTA) after initial -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Set GNT_BT control by PTA\n")); -+ halbtc8821a2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_MAIN, FALSE, FALSE); -+ } -+ } -+ -+#if(BT_AUTO_REPORT_ONLY_8821A_2ANT == 0) -+ halbtc8821a2ant_QueryBtInfo(pBtCoexist); -+ halbtc8821a2ant_MonitorBtEnableDisable(pBtCoexist); -+#else -+ halbtc8821a2ant_MonitorBtCtr(pBtCoexist); -+ halbtc8821a2ant_MonitorWiFiCtr(pBtCoexist); -+ -+ if( halbtc8821a2ant_IsWifiStatusChanged(pBtCoexist) || -+ pCoexDm->bAutoTdmaAdjust) -+ { -+ halbtc8821a2ant_RunCoexistMechanism(pBtCoexist); -+ } -+#endif -+} -+ -+ -+#endif -+ -+#else // #if (RTL8821A_SUPPORT == 1) -+VOID -+EXhalbtc8821a2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ){} -+VOID -+EXhalbtc8821a2ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ){} -+VOID -+EXhalbtc8821a2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ){} -+VOID -+EXhalbtc8821a2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ){} -+VOID -+EXhalbtc8821a2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ){} -+VOID -+EXhalbtc8821a2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ){} -+VOID -+EXhalbtc8821a2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ){} -+VOID -+EXhalbtc8821a2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ){} -+VOID -+EXhalbtc8821a2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ){} -+VOID -+EXhalbtc8821a2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ){} -+VOID -+EXhalbtc8821a2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ){} -+VOID -+EXhalbtc8821a2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ){} -+VOID -+EXhalbtc8821a2ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ){} -+VOID -+EXhalbtc8821a2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ){} -+VOID -+EXhalbtc8821a2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ){} -+#endif // #if (RTL8821A_SUPPORT == 1) -\ Ingen nyrad vid filslut -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8821a2Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8821a2Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8821a2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8821a2Ant.h 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,226 @@ -+//=========================================== -+// The following is for 8821A 2Ant BT Co-exist definition -+//=========================================== -+#define BT_AUTO_REPORT_ONLY_8821A_2ANT 1 -+ -+ -+#define BT_INFO_8821A_2ANT_B_FTP BIT7 -+#define BT_INFO_8821A_2ANT_B_A2DP BIT6 -+#define BT_INFO_8821A_2ANT_B_HID BIT5 -+#define BT_INFO_8821A_2ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8821A_2ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8821A_2ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8821A_2ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8821A_2ANT_B_CONNECTION BIT0 -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT 2 -+ -+ -+#define BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES 42 //WiFi RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation -+#define BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES 46 //BT RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation -+ -+typedef enum _BT_INFO_SRC_8821A_2ANT{ -+ BT_INFO_SRC_8821A_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8821A_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8821A_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8821A_2ANT_MAX -+}BT_INFO_SRC_8821A_2ANT,*PBT_INFO_SRC_8821A_2ANT; -+ -+typedef enum _BT_8821A_2ANT_BT_STATUS{ -+ BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8821A_2ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8821A_2ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8821A_2ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8821A_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8821A_2ANT_BT_STATUS_MAX -+}BT_8821A_2ANT_BT_STATUS,*PBT_8821A_2ANT_BT_STATUS; -+ -+typedef enum _BT_8821A_2ANT_COEX_ALGO{ -+ BT_8821A_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8821A_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8821A_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8821A_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8821A_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8821A_2ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8821A_2ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8821A_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8821A_2ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8821A_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8821A_2ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8821A_2ANT_COEX_ALGO_MAX = 0xb, -+}BT_8821A_2ANT_COEX_ALGO,*PBT_8821A_2ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8821A_2ANT{ -+ // fw mechanism -+ u1Byte preBtDecPwrLvl; -+ u1Byte curBtDecPwrLvl; -+ u1Byte preFwDacSwingLvl; -+ u1Byte curFwDacSwingLvl; -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ BOOLEAN bResetTdmaAdjust; -+ BOOLEAN bAutoTdmaAdjust; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ BOOLEAN bPreBtAutoReport; -+ BOOLEAN bCurBtAutoReport; -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ BOOLEAN bPreDacSwingOn; -+ u4Byte preDacSwingLvl; -+ BOOLEAN bCurDacSwingOn; -+ u4Byte curDacSwingLvl; -+ BOOLEAN bPreAdcBackOff; -+ BOOLEAN bCurAdcBackOff; -+ BOOLEAN bPreAgcTableEn; -+ BOOLEAN bCurAgcTableEn; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+ -+ BOOLEAN bNeedRecover0x948; -+ u4Byte backup0x948; -+ -+ u1Byte preLps; -+ u1Byte curLps; -+ u1Byte preRpwm; -+ u1Byte curRpwm; -+} COEX_DM_8821A_2ANT, *PCOEX_DM_8821A_2ANT; -+ -+typedef struct _COEX_STA_8821A_2ANT{ -+ BOOLEAN bBtLinkExist; -+ BOOLEAN bScoExist; -+ BOOLEAN bA2dpExist; -+ BOOLEAN bHidExist; -+ BOOLEAN bPanExist; -+ -+ BOOLEAN bUnderLps; -+ BOOLEAN bUnderIps; -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ u1Byte btRssi; -+ BOOLEAN bBtTxRxMask; -+ u1Byte preBtRssiState; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8821A_2ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8821A_2ANT_MAX]; -+ BOOLEAN bBtWhckTest; -+ BOOLEAN bC2hBtInquiryPage; -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+ -+ u4Byte nCRCOK_CCK; -+ u4Byte nCRCOK_11g; -+ u4Byte nCRCOK_11n; -+ u4Byte nCRCOK_11nAgg; -+ -+ u4Byte nCRCErr_CCK; -+ u4Byte nCRCErr_11g; -+ u4Byte nCRCErr_11n; -+ u4Byte nCRCErr_11nAgg; -+ -+ u1Byte nCoexTableType; -+ BOOLEAN bForceLpsOn; -+ -+ u1Byte disVerInfoCnt; -+}COEX_STA_8821A_2ANT, *PCOEX_STA_8821A_2ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8821a2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8821a2ant_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8821a2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8821a2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8821a2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821a2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821a2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821a2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821a2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821a2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821a2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8821a2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8821a2ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ); -+VOID -+EXhalbtc8821a2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8821a2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8821aCsr2Ant.c linux/3rdparty/rtl8812au/hal/btc/HalBtc8821aCsr2Ant.c ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8821aCsr2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8821aCsr2Ant.c 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,4343 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8821A_CSR_CSR Co-exist mechanism -+// -+// History -+// 2012/08/22 Cosa first check in. -+// 2012/11/14 Cosa Revise for 8821A_CSR 2Ant out sourcing. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtcCsr8821a2Ant.tmh" -+#endif -+ -+#define _BTCOEX_CSR 1 -+ -+#ifndef rtw_warn_on -+ #define rtw_warn_on(condition) do {} while (0) -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8821A_CSR_2ANT GLCoexDm8821aCsr2Ant; -+static PCOEX_DM_8821A_CSR_2ANT pCoexDm=&GLCoexDm8821aCsr2Ant; -+static COEX_STA_8821A_CSR_2ANT GLCoexSta8821aCsr2Ant; -+static PCOEX_STA_8821A_CSR_2ANT pCoexSta=&GLCoexSta8821aCsr2Ant; -+ -+const char *const GLBtInfoSrc8821aCsr2Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u4Byte GLCoexVerDate8821aCsr2Ant=20140901; -+u4Byte GLCoexVer8821aCsr2Ant=0x51; -+ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8821aCsr2ant_ -+//============================================================ -+u1Byte -+halbtc8821aCsr2ant_BtRssiState( -+ u1Byte levelNum, -+ u1Byte rssiThresh, -+ u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte btRssi=0; -+ u1Byte btRssiState=pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh1) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+u1Byte -+halbtc8821aCsr2ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+VOID -+halbtc8821aCsr2ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ bPreBtDisabled = bBtDisabled; -+ if(!bBtDisabled) -+ { -+ } -+ else -+ { -+ } -+ } -+} -+ -+VOID -+halbtc8821aCsr2ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp; -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x5d); -+} -+ -+VOID -+halbtc8821aCsr2ant_UpdateRaMask( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte disRateMask -+ ) -+{ -+ pCoexDm->curRaMask = disRateMask; -+ -+ if( bForceExec || (pCoexDm->preRaMask != pCoexDm->curRaMask)) -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_UPDATE_RAMASK, &pCoexDm->curRaMask); -+ } -+ pCoexDm->preRaMask = pCoexDm->curRaMask; -+} -+ -+VOID -+halbtc8821aCsr2ant_AutoRateFallbackRetry( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiUnderBMode=FALSE; -+ -+ pCoexDm->curArfrType = type; -+ -+ if( bForceExec || (pCoexDm->preArfrType != pCoexDm->curArfrType)) -+ { -+ switch(pCoexDm->curArfrType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, pCoexDm->backupArfrCnt1); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, pCoexDm->backupArfrCnt2); -+ break; -+ case 1: -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ if(bWifiUnderBMode) -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x01010101); -+ } -+ else -+ { -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preArfrType = pCoexDm->curArfrType; -+} -+ -+VOID -+halbtc8821aCsr2ant_RetryLimit( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curRetryLimitType = type; -+ -+ if( bForceExec || (pCoexDm->preRetryLimitType != pCoexDm->curRetryLimitType)) -+ { -+ switch(pCoexDm->curRetryLimitType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, pCoexDm->backupRetryLimit); -+ break; -+ case 1: // retry limit=8 -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preRetryLimitType = pCoexDm->curRetryLimitType; -+} -+ -+VOID -+halbtc8821aCsr2ant_AmpduMaxTime( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curAmpduTimeType = type; -+ -+ if( bForceExec || (pCoexDm->preAmpduTimeType != pCoexDm->curAmpduTimeType)) -+ { -+ switch(pCoexDm->curAmpduTimeType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, pCoexDm->backupAmpduMaxTime); -+ break; -+ case 1: // AMPDU timw = 0x38 * 32us -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, 0x38); -+ break; -+ case 2: -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, 0x17); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preAmpduTimeType = pCoexDm->curAmpduTimeType; -+} -+ -+VOID -+halbtc8821aCsr2Ant_AmpduMaxNum( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte type -+ ) -+{ -+ pCoexDm->curAmpduNumType = type; -+ -+ if( bForceExec || (pCoexDm->preAmpduNumType != pCoexDm->curAmpduNumType)) -+ { -+ switch(pCoexDm->curAmpduNumType) -+ { -+ case 0: // normal mode -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x4ca, pCoexDm->backupAmpduMaxNum); -+ break; -+ case 1: -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x4ca, 0x0808); -+ break; -+ case 2: -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x4ca, 0x1f1f); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pCoexDm->preAmpduNumType = pCoexDm->curAmpduNumType; -+ -+} -+ -+VOID -+halbtc8821aCsr2ant_LimitedTx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte raMaskType, -+ IN u1Byte arfrType, -+ IN u1Byte retryLimitType, -+ IN u1Byte ampduTimeType, -+ IN u1Byte ampduNumType -+ ) -+{ -+ switch(raMaskType) -+ { -+ case 0: // normal mode -+ halbtc8821aCsr2ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0); -+ break; -+ case 1: // disable cck 1/2 -+ halbtc8821aCsr2ant_UpdateRaMask(pBtCoexist, bForceExec, 0x00000003); -+ break; -+ case 2: // disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 -+ halbtc8821aCsr2ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8821aCsr2ant_AutoRateFallbackRetry(pBtCoexist, bForceExec, arfrType); -+ halbtc8821aCsr2ant_RetryLimit(pBtCoexist, bForceExec, retryLimitType); -+ halbtc8821aCsr2ant_AmpduMaxTime(pBtCoexist, bForceExec, ampduTimeType); -+ halbtc8821aCsr2Ant_AmpduMaxNum(pBtCoexist, bForceExec, ampduNumType); -+} -+ -+ -+ -+VOID -+halbtc8821aCsr2ant_LimitedRx( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRejApAggPkt, -+ IN BOOLEAN bBtCtrlAggBufSize, -+ IN u1Byte aggBufSize -+ ) -+{ -+ BOOLEAN bRejectRxAgg=bRejApAggPkt; -+ BOOLEAN bBtCtrlRxAggSize=bBtCtrlAggBufSize; -+ u1Byte rxAggSize=aggBufSize; -+ -+ //============================================ -+ // Rx Aggregation related setting -+ //============================================ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg); -+ // decide BT control aggregation buf size or not -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize); -+ // aggregation buf size, only work when BT control Rx aggregation size. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize); -+ // real update aggregation setting -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+} -+ -+VOID -+halbtc8821aCsr2ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = TRUE; -+ -+ H2C_Parameter[0] |= BIT0; // trigger -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x61=0x%x\n", -+ H2C_Parameter[0])); -+ -+ rtw_warn_on(_BTCOEX_CSR); -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter); -+} -+ -+u1Byte -+halbtc8821aCsr2ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ u1Byte algorithm=BT_8821A_CSR_2ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ //sync StackInfo with BT firmware and stack -+ pStackInfo->bHidExist = pCoexSta->bHidExist; -+ pStackInfo->bBtLinkExist = pCoexSta->bBtLinkExist; -+ pStackInfo->bScoExist = pCoexSta->bScoExist; -+ pStackInfo->bPanExist = pCoexSta->bPanExist; -+ pStackInfo->bA2dpExist = pCoexSta->bA2dpExist; -+ -+ if(!pStackInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No profile exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pStackInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(numOfDiffProfile == 1) -+ { -+ if(pStackInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO only\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(pStackInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_HID; -+ } -+ else if(pStackInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_A2DP; -+ } -+ else if(pStackInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(HS) only\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(EDR) only\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 2) -+ { -+ if(pStackInfo->bScoExist) -+ { -+ if(pStackInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else if(pStackInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else if(pStackInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(HS)\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(EDR)\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bA2dpExist ) -+ { -+ if(pStackInfo->numOfHid >= 2) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID*2 + A2DP\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ } -+ else if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(HS)\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_HID; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(EDR)\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(HS)\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_A2DP_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(EDR)\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 3) -+ { -+ if(pStackInfo->bScoExist) -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP ==> HID\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(HS)\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(EDR)\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile >= 3) -+ { -+ if(pStackInfo->bScoExist) -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+BOOLEAN -+halbtc8821aCsr2ant_NeedToDecBtPwr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bRet=FALSE; -+ BOOLEAN bBtHsOn=FALSE, bWifiConnected=FALSE; -+ s4Byte btHsRssi=0; -+ u1Byte btRssiState; -+ -+ if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn)) -+ return FALSE; -+ if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected)) -+ return FALSE; -+ if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_HS_RSSI, &btHsRssi)) -+ return FALSE; -+ -+ btRssiState = halbtc8821aCsr2ant_BtRssiState(2, 35, 0); -+ -+ if(bWifiConnected) -+ { -+ if(bBtHsOn) -+ { -+ if(btHsRssi > 37) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Need to decrease bt power for HS mode!!\n")); -+ bRet = TRUE; -+ } -+ } -+ else -+ { -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Need to decrease bt power for Wifi is connected!!\n")); -+ bRet = TRUE; -+ } -+ } -+ } -+ -+ return bRet; -+} -+ -+VOID -+halbtc8821aCsr2ant_SetFwDacSwingLevel( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte dacSwingLvl -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ // There are several type of dacswing -+ // 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 -+ H2C_Parameter[0] = dacSwingLvl; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Set Dac Swing Level=0x%x\n", dacSwingLvl)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x64=0x%x\n", H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x64, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8821aCsr2ant_SetFwDecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bDecBtPwr -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = 0; -+ -+ if(bDecBtPwr) -+ { -+ H2C_Parameter[0] |= BIT1; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], decrease Bt Power : %s, FW write 0x62=0x%x\n", -+ (bDecBtPwr? "Yes!!":"No!!"), H2C_Parameter[0])); -+ -+ rtw_warn_on(_BTCOEX_CSR); -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x62, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8821aCsr2ant_DecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDecBtPwr -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s Dec BT power = %s\n", -+ (bForceExec? "force to":""), ((bDecBtPwr)? "ON":"OFF"))); -+ pCoexDm->bCurDecBtPwr = bDecBtPwr; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreDecBtPwr == pCoexDm->bCurDecBtPwr) -+ return; -+ } -+ -+ /* TODO: may CSR consider to decrease BT power? */ -+ //halbtc8821aCsr2ant_SetFwDecBtPwr(pBtCoexist, pCoexDm->bCurDecBtPwr); -+ -+ pCoexDm->bPreDecBtPwr = pCoexDm->bCurDecBtPwr; -+} -+ -+VOID -+halbtc8821aCsr2ant_SetBtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = 0; -+ -+ if(bEnableAutoReport) -+ { -+ H2C_Parameter[0] |= BIT0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], BT FW auto report : %s, FW write 0x68=0x%x\n", -+ (bEnableAutoReport? "Enabled!!":"Disabled!!"), H2C_Parameter[0])); -+ -+ rtw_warn_on(_BTCOEX_CSR); -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x68, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8821aCsr2ant_BtAutoReport( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnableAutoReport -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s BT Auto report = %s\n", -+ (bForceExec? "force to":""), ((bEnableAutoReport)? "Enabled":"Disabled"))); -+ pCoexDm->bCurBtAutoReport = bEnableAutoReport; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreBtAutoReport == pCoexDm->bCurBtAutoReport) -+ return; -+ } -+ //halbtc8821aCsr2ant_SetBtAutoReport(pBtCoexist, pCoexDm->bCurBtAutoReport); -+ -+ pCoexDm->bPreBtAutoReport = pCoexDm->bCurBtAutoReport; -+} -+ -+VOID -+halbtc8821aCsr2ant_FwDacSwingLvl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte fwDacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set FW Dac Swing level = %d\n", -+ (bForceExec? "force to":""), fwDacSwingLvl)); -+ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->preFwDacSwingLvl == pCoexDm->curFwDacSwingLvl) -+ return; -+ } -+ -+ halbtc8821aCsr2ant_SetFwDacSwingLevel(pBtCoexist, pCoexDm->curFwDacSwingLvl); -+ -+ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -+} -+ -+VOID -+halbtc8821aCsr2ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xffffc); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+VOID -+halbtc8821aCsr2ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8821aCsr2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8821aCsr2ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte H2C_Parameter[6] ={0}; -+ -+ H2C_Parameter[0] = 0x6; // opCode, 0x6= Retry_Penalty -+ -+ if(bLowPenaltyRa) -+ { -+ H2C_Parameter[1] |= BIT0; -+ H2C_Parameter[2] = 0x00; //normal rate except MCS7/6/5, OFDM54/48/36 -+ H2C_Parameter[3] = 0xf7; //MCS7 or OFDM54 -+ H2C_Parameter[4] = 0xf8; //MCS6 or OFDM48 -+ H2C_Parameter[5] = 0xf9; //MCS5 or OFDM36 -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set WiFi Low-Penalty Retry: %s", -+ (bLowPenaltyRa? "ON!!":"OFF!!") )); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter); -+} -+ -+VOID -+halbtc8821aCsr2ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8821aCsr2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8821aCsr2ant_SetDacSwingReg( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte level -+ ) -+{ -+ u1Byte val=(u1Byte)level; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Write SwDacSwing = 0x%x\n", level)); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xc5b, 0x3e, val); -+} -+ -+VOID -+halbtc8821aCsr2ant_SetSwFullTimeDacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSwDacSwingOn, -+ IN u4Byte swDacSwingLvl -+ ) -+{ -+ if(bSwDacSwingOn) -+ { -+ halbtc8821aCsr2ant_SetDacSwingReg(pBtCoexist, swDacSwingLvl); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SetDacSwingReg(pBtCoexist, 0x18); -+ } -+} -+ -+ -+VOID -+halbtc8821aCsr2ant_DacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacSwingOn, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", -+ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); -+ pCoexDm->bCurDacSwingOn = bDacSwingOn; -+ pCoexDm->curDacSwingLvl = dacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && -+ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) -+ return; -+ } -+ delay_ms(30); -+ halbtc8821aCsr2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); -+ -+ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; -+ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -+} -+ -+VOID -+halbtc8821aCsr2ant_SetAdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ if(bAdcBackOff) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x8db, 0x60, 0x3); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x8db, 0x60, 0x1); -+ } -+} -+ -+VOID -+halbtc8821aCsr2ant_AdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", -+ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); -+ pCoexDm->bCurAdcBackOff = bAdcBackOff; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) -+ return; -+ } -+ halbtc8821aCsr2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); -+ -+ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -+} -+ -+VOID -+halbtc8821aCsr2ant_SetAgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ u1Byte rssiAdjustVal=0; -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x28F4B); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x10AB2); -+ rssiAdjustVal = 8; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x2884B); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x3b, 0xfffff, 0x104B2); -+ } -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); -+ -+ // set rssiAdjustVal for wifi module. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -+} -+ -+VOID -+halbtc8821aCsr2ant_AgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", -+ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); -+ pCoexDm->bCurAgcTableEn = bAgcTableEn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) -+ return; -+ } -+ halbtc8821aCsr2ant_SetAgcTable(pBtCoexist, bAgcTableEn); -+ -+ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -+} -+ -+VOID -+halbtc8821aCsr2ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8821aCsr2ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c4, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8821aCsr2ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8821aCsr2ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(bEnable) -+ { -+ H2C_Parameter[0] |= BIT0; // function enable -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63=0x%x\n", -+ H2C_Parameter[0])); -+ -+ rtw_warn_on(_BTCOEX_CSR); -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8821aCsr2ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ //halbtc8821aCsr2ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8821aCsr2ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[6] ={0}; -+ -+ H2C_Parameter[0] = byte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = byte5; -+ H2C_Parameter[5] = 0x01; -+ -+ pCoexDm->psTdmaPara[0] = byte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = byte5; -+ pCoexDm->psTdmaPara[5] = 0x01; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x60(6bytes)=0x%x%08x%02x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4], H2C_Parameter[5])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 6, H2C_Parameter); -+} -+ -+VOID -+halbtc8821aCsr2ant_SwMechanism1( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bShrinkRxLPF, -+ IN BOOLEAN bLowPenaltyRA, -+ IN BOOLEAN bLimitedDIG, -+ IN BOOLEAN bBTLNAConstrain -+ ) -+{ -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if(BTC_WIFI_BW_HT40 != wifiBw) //only shrink RF Rx LPF for HT40 -+ { -+ if (bShrinkRxLPF) -+ bShrinkRxLPF = FALSE; -+ } -+ -+ halbtc8821aCsr2ant_RfShrink(pBtCoexist, NORMAL_EXEC, bShrinkRxLPF); -+ halbtc8821aCsr2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA); -+ -+ //no limited DIG -+ //halbtc8821aCsr2ant_SetBtLnaConstrain(pBtCoexist, NORMAL_EXEC, bBTLNAConstrain); -+} -+ -+VOID -+halbtc8821aCsr2ant_SwMechanism2( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAGCTableShift, -+ IN BOOLEAN bADCBackOff, -+ IN BOOLEAN bSWDACSwing, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ //halbtc8821aCsr2ant_AgcTable(pBtCoexist, NORMAL_EXEC, bAGCTableShift); -+ halbtc8821aCsr2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, bADCBackOff); -+ halbtc8821aCsr2ant_DacSwing(pBtCoexist, NORMAL_EXEC, bSWDACSwing, dacSwingLvl); -+} -+ -+VOID -+halbtc8821aCsr2ant_SetAntPath( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte antPosType, -+ IN BOOLEAN bInitHwCfg, -+ IN BOOLEAN bWifiOff -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte u4Tmp=0; -+ u1Byte H2C_Parameter[2] ={0}; -+ -+ if(bInitHwCfg) -+ { -+ // 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp &=~BIT23; -+ u4Tmp |= BIT24; -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp); -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x974, 0x3ff); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0xcb4, 0x77); -+ -+ if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) -+ { -+ //tell firmware "antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix -+ H2C_Parameter[0] = 1; -+ H2C_Parameter[1] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } -+ else -+ { -+ //tell firmware "no antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix -+ H2C_Parameter[0] = 0; -+ H2C_Parameter[1] = 1; -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter); -+ } -+ } -+ -+ // ext switch setting -+ switch(antPosType) -+ { -+ case BTC_ANT_WIFI_AT_MAIN: -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xcb7, 0x30, 0x1); -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xcb7, 0x30, 0x2); -+ break; -+ } -+} -+ -+VOID -+halbtc8821aCsr2ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bTurnOnByCnt=FALSE; -+ u1Byte psTdmaTypeByCnt=0; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", -+ (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ if(bTurnOn) -+ { -+ switch(type) -+ { -+ case 1: -+ default: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ break; -+ case 2: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); -+ break; -+ case 3: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0xf1, 0x90); -+ break; -+ case 4: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x10, 0x03, 0xf1, 0x90); -+ break; -+ case 5: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); -+ break; -+ case 6: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); -+ break; -+ case 7: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1c, 0x3, 0x70, 0x90); -+ break; -+ case 8: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x10, 0x3, 0x70, 0x90); -+ break; -+ case 9: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ break; -+ case 10: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); -+ break; -+ case 11: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0xe1, 0x90); -+ break; -+ case 12: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 13: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); -+ break; -+ case 14: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); -+ break; -+ case 15: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0x60, 0x90); -+ break; -+ case 16: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0x60, 0x90); -+ break; -+ case 17: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x2f, 0x2f, 0x60, 0x90); -+ break; -+ case 18: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 19: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0xe1, 0x90); -+ break; -+ case 20: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0x60, 0x90); -+ break; -+ case 21: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x03, 0x70, 0x90); -+ break; -+ case 22: //ad2dp master -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xeb, 0x11, 0x11, 0x21, 0x10); -+ break; -+ case 23: //a2dp slave -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xeb, 0x12, 0x12, 0x20, 0x10); -+ break; -+ case 71: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ break; -+ } -+ } -+ else -+ { -+ // disable PS tdma -+ switch(type) -+ { -+ case 0: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x40, 0x0); -+ break; -+ case 1: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x48, 0x0); -+ break; -+ default: -+ halbtc8821aCsr2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x40, 0x0); -+ break; -+ } -+ } -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+VOID -+halbtc8821aCsr2ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw all off -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ // sw all off -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ -+ // hw all off -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x55555555, 0xffff, 0x3); -+} -+ -+VOID -+halbtc8821aCsr2ant_CoexUnder5G( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8821aCsr2ant_CoexAllOff(pBtCoexist); -+ -+ halbtc8821aCsr2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, TRUE); -+} -+ -+VOID -+halbtc8821aCsr2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0x55555555, 0x55555555, 0xffff, 0x3); -+ -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 1); -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 6); -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, FORCE_EXEC, FALSE); -+ -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+} -+ -+VOID -+halbtc8821aCsr2ant_BtInquiryPage( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bLowPwrDisable=TRUE; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5afa5afa, 0xffff, 0x3); -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+} -+BOOLEAN -+halbtc8821aCsr2ant_IsCommonAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE, bWifiBusy=FALSE; -+ BOOLEAN bLowPwrDisable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if(!bWifiConnected && -+ BT_8821A_CSR_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus) -+ { -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi IPS + BT IPS!!\n")); -+ -+ -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ halbtc8821aCsr2ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0, 0); -+ halbtc8821aCsr2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, 0, 0, 0); -+ -+ bCommon = TRUE; -+ } -+ else if(bWifiConnected && -+ (BT_8821A_CSR_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus) ) -+ { -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ if(bWifiBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Busy + BT IPS!!\n")); -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi LPS + BT IPS!!\n")); -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ halbtc8821aCsr2ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0, 0); -+ halbtc8821aCsr2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, 0, 0, 0); -+ -+ bCommon = TRUE; -+ } -+ else if(!bWifiConnected && -+ (BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi IPS + BT LPS!!\n")); -+ -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ halbtc8821aCsr2ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0, 0); -+ halbtc8821aCsr2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, 0, 0, 0); -+ -+ bCommon = TRUE; -+ } -+ else if(bWifiConnected && -+ (BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ if(bWifiBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Busy + BT LPS!!\n")); -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi LPS + BT LPS!!\n")); -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,TRUE,TRUE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ halbtc8821aCsr2ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0, 0); -+ halbtc8821aCsr2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, 0, 0, 0); -+ -+ bCommon = TRUE; -+ } -+ else if(!bWifiConnected && -+ (BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE == pCoexDm->btStatus) ) -+ { -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi IPS + BT Busy!!\n")); -+ -+ //halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ halbtc8821aCsr2ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0, 0); -+ halbtc8821aCsr2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, 0, 0, 0); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ if(bWifiBusy) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Busy + BT Busy!!\n")); -+ bCommon = FALSE; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi LPS + BT Busy!!\n")); -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 21); -+ -+ if(halbtc8821aCsr2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ bCommon = TRUE; -+ } -+ -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,TRUE,TRUE); -+ } -+ -+ if (bCommon == TRUE) -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5afa5afa, 0xffff, 0x3); -+ -+ return bCommon; -+} -+VOID -+halbtc8821aCsr2ant_TdmaDurationAdjust( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bScoHid, -+ IN BOOLEAN bTxPause, -+ IN u1Byte maxInterval -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjust()\n")); -+ -+ if(pCoexDm->bResetTdmaAdjust) -+ { -+ pCoexDm->bResetTdmaAdjust = FALSE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ { -+ if(bScoHid) -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ else -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ } -+ } -+ } -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], retryCount = %d\n", retryCount)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], up=%d, dn=%d, m=%d, n=%d, WaitCount=%d\n", -+ up, dn, m, n, WaitCount)); -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if s n 2 retry count0, hռeWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if s 2 2 retry count< 3, hկWiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, un1 retry count > 3, hկWiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // קK@blevelӦ^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ̤j = 20 ' ̤j120 recheckO_վ WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], max Interval = %d\n", maxInterval)); -+ if(maxInterval == 1) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ -+ if(pCoexDm->curPsTdma == 71) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 71); -+ pCoexDm->psTdmaDuAdjType = 71; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 71) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 71); -+ pCoexDm->psTdmaDuAdjType = 71; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 2) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 3) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ } -+ } -+ -+ // if current PsTdma not match with the recorded one (when scan, dhcp...), -+ // then we have to adjust it back to the previous record one. -+ if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) -+ { -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", -+ pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if( !bScan && !bLink && !bRoam) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); -+ } -+ } -+ -+ // when halbtc8821aCsr2ant_TdmaDurationAdjust() is called, fw dac swing is included in the function. -+ //if(pCoexDm->psTdmaDuAdjType == 71) -+ // halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0xc); //Skip because A2DP get worse at HT40 -+ //else -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x6); -+} -+ -+// SCO only or SCO+PAN(HS) -+VOID -+halbtc8821aCsr2ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState,btRssiState; -+ u4Byte wifiBw; -+ -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x55555555, 0xffffff, 0x3); -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ -+ halbtc8821aCsr2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ -+ halbtc8821aCsr2ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 1, 0, 2, 0); -+ -+ if(pCoexSta->bSlave == FALSE) -+ halbtc8821aCsr2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x4); -+ else -+ halbtc8821aCsr2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x2); -+ -+/* -+ wifiRssiState = halbtc8821aCsr2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8821aCsr2ant_BtRssiState(2, 35, 0); -+ -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 4); -+ -+ if(halbtc8821aCsr2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) //for SCO quality at 11b/g mode -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x5a5a5a5a, 0x5a5a5a5a, 0xffff, 0x3); -+ } -+ else //for SCO quality & wifi performance balance at 11n mode -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x5aea5aea, 0x5aea5aea, 0xffff, 0x3); -+ } -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ -+ // fw mechanism -+ //halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); //for voice quality -+ } -+ else -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); //for voice quality -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ // fw mechanism -+ //halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); //for voice quality -+ } -+ else -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); //for voice quality -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+*/ -+} -+ -+ -+VOID -+halbtc8821aCsr2ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8821aCsr2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8821aCsr2ant_BtRssiState(2, 35, 0); -+ -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(halbtc8821aCsr2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) //for HID at 11b/g mode -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); -+ } -+ else //for HID quality & wifi performance balance at 11n mode -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5aea5aea, 0xffff, 0x3); -+ } -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -+VOID -+halbtc8821aCsr2ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState; -+ u4Byte wifiBw; -+ -+ halbtc8821aCsr2ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x8); -+ -+ if(pCoexSta->bSlave == FALSE) -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0xfdfdfdfd, 0xdfdadfda, 0xffffff, 0x3); -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ halbtc8821aCsr2ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0, 1); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x0c); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0xfdfdfdfd, 0xdfdadfda, 0xffffff, 0x3); -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ halbtc8821aCsr2ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0, 2); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,TRUE,0x18); -+ } -+ -+/* -+ wifiRssiState = halbtc8821aCsr2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8821aCsr2ant_BtRssiState(2, 35, 0); -+ -+ //fw dac swing is called in halbtc8821aCsr2ant_TdmaDurationAdjust() -+ //halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ -+ if(halbtc8821aCsr2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+*/ -+} -+ -+VOID -+halbtc8821aCsr2ant_ActionA2dpPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ wifiRssiState = halbtc8821aCsr2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8821aCsr2ant_BtRssiState(2,35, 0); -+ -+ //fw dac swing is called in halbtc8821aCsr2ant_TdmaDurationAdjust() -+ //halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ -+ if(halbtc8821aCsr2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 2); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ // fw mechanism -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 2); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8821aCsr2ant_ActionPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8821aCsr2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8821aCsr2ant_BtRssiState(2, 35, 0); -+ -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(halbtc8821aCsr2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) //for HID at 11b/g mode -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5aff5aff, 0xffff, 0x3); -+ } -+ else //for HID quality & wifi performance balance at 11n mode -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5aff5aff, 0xffff, 0x3); -+ } -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+ -+//PAN(HS) only -+VOID -+halbtc8821aCsr2ant_ActionPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8821aCsr2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8821aCsr2ant_BtRssiState(2, 35, 0); -+ -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 1); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+//PAN(EDR)+A2DP -+VOID -+halbtc8821aCsr2ant_ActionPanEdrA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ wifiRssiState = halbtc8821aCsr2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8821aCsr2ant_BtRssiState(2, 35, 0); -+ -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(halbtc8821aCsr2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) //for HID at 11b/g mode -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5afa5afa, 0xffff, 0x3); -+ } -+ else //for HID quality & wifi performance balance at 11n mode -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5afa5afa, 0xffff, 0x3); -+ } -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ }; -+ } -+ else -+ { -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,FALSE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8821aCsr2ant_ActionPanEdrHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState; -+ u4Byte wifiBw; -+ -+ wifiRssiState = halbtc8821aCsr2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8821aCsr2ant_BtRssiState(2, 35, 0); -+ -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(halbtc8821aCsr2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) //for HID at 11b/g mode -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5a5f5a5f, 0xffff, 0x3); -+ } -+ else //for HID quality & wifi performance balance at 11n mode -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5a5f5a5f, 0xffff, 0x3); -+ } -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 3); -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+// HID+A2DP+PAN(EDR) -+VOID -+halbtc8821aCsr2ant_ActionHidA2dpPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ wifiRssiState = halbtc8821aCsr2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8821aCsr2ant_BtRssiState(2, 35, 0); -+ -+ halbtc8821aCsr2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 6); -+ -+ if(halbtc8821aCsr2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) //for HID at 11b/g mode -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); -+ } -+ else //for HID quality & wifi performance balance at 11n mode -+ { -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); -+ } -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8821aCsr2ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, btRssiState, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ wifiRssiState = halbtc8821aCsr2ant_WifiRssiState(pBtCoexist, 0, 2, 15, 0); -+ btRssiState = halbtc8821aCsr2ant_BtRssiState(2, 35, 0); -+ -+ if(halbtc8821aCsr2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8821aCsr2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifiBw) //for HID at 11b/g mode -+ { -+//Allen halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5f5b5f5b, 0xffffff, 0x3); -+ } -+ else //for HID quality & wifi performance balance at 11n mode -+ { -+//Allen halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55ff55ff, 0x5f5b5f5b, 0xffffff, 0x3); -+ -+ } -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,TRUE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+ else -+ { -+ // fw mechanism -+ if( (btRssiState == BTC_RSSI_STATE_HIGH) || -+ (btRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+// halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 2); -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ -+ } -+ else //a2dp edr rate -+ { -+//Allen halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 2); -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8821aCsr2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 2); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,TRUE,FALSE,FALSE,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_SwMechanism1(pBtCoexist,FALSE,TRUE,FALSE,FALSE); -+ halbtc8821aCsr2ant_SwMechanism2(pBtCoexist,FALSE,FALSE,FALSE,0x18); -+ } -+ } -+} -+ -+VOID -+halbtc8821aCsr2ant_RunCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ BOOLEAN bWifiUnder5G=FALSE; -+ u1Byte btInfoOriginal=0, btRetryCnt=0; -+ u1Byte algorithm=0; -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Manual control!!!\n")); -+ return; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ -+ if(bWifiUnder5G) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), run 5G coex setting!!<===\n")); -+ halbtc8821aCsr2ant_CoexUnder5G(pBtCoexist); -+ return; -+ } -+ -+ //if(pStackInfo->bProfileNotified) -+ { -+ algorithm = halbtc8821aCsr2ant_ActionAlgorithm(pBtCoexist); -+ if(pCoexSta->bC2hBtInquiryPage && (BT_8821A_CSR_2ANT_COEX_ALGO_PANHS!=algorithm)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is under inquiry/page scan !!\n")); -+ halbtc8821aCsr2ant_BtInquiryPage(pBtCoexist); -+ return; -+ } -+ -+ pCoexDm->curAlgorithm = algorithm; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Algorithm = %d \n", pCoexDm->curAlgorithm)); -+ -+ if(halbtc8821aCsr2ant_IsCommonAction(pBtCoexist)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant common.\n")); -+ pCoexDm->bResetTdmaAdjust = TRUE; -+ } -+ else -+ { -+ if(pCoexDm->curAlgorithm != pCoexDm->preAlgorithm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], preAlgorithm=%d, curAlgorithm=%d\n", -+ pCoexDm->preAlgorithm, pCoexDm->curAlgorithm)); -+ pCoexDm->bResetTdmaAdjust = TRUE; -+ } -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8821A_CSR_2ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO.\n")); -+ halbtc8821aCsr2ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID.\n")); -+ halbtc8821aCsr2ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP.\n")); -+ halbtc8821aCsr2ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_A2DP_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n")); -+ halbtc8821aCsr2ant_ActionA2dpPanHs(pBtCoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n")); -+ halbtc8821aCsr2ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HS mode.\n")); -+ halbtc8821aCsr2ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n")); -+ halbtc8821aCsr2ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n")); -+ halbtc8821aCsr2ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n")); -+ halbtc8821aCsr2ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n")); -+ halbtc8821aCsr2ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n")); -+ halbtc8821aCsr2ant_CoexAllOff(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+ } -+} -+ -+ -+ -+//============================================================ -+// work around function start with wa_halbtc8821aCsr2ant_ -+//============================================================ -+//============================================================ -+// extern function start with EXhalbtc8821aCsr2ant_ -+//============================================================ -+VOID -+EXhalbtc8821aCsr2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8821aCsr2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ u4Byte u4Tmp=0; -+ u2Byte u2Tmp=0; -+ u1Byte u1Tmp=0; -+ u1Byte H2C_Parameter[2] ={0}; -+ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); -+ -+ if(bWifiOnly) -+ return; -+ -+ //if(bBackUp) -+ { -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); -+ pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430); -+ pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434); -+ pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a); -+ pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456); -+ pCoexDm->backupAmpduMaxNum = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x4ca); -+ } -+ -+ #if 0 /* REMOVE */ -+ // 0x790[5:0]=0x5 -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x790); -+ u1Tmp &= 0xc0; -+ u1Tmp |= 0x5; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, u1Tmp); -+ #endif -+ -+ //Antenna config -+ halbtc8821aCsr2ant_SetAntPath(pBtCoexist, BTC_ANT_WIFI_AT_MAIN, TRUE, FALSE); -+ -+ // PTA parameter -+ halbtc8821aCsr2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0x55555555, 0x55555555, 0xffff, 0x3); -+ -+ // Enable counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); //0x76e[3] =1, WLAN_Act control by PTA -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x3); -+ -+ #if 0 /* REMOVE */ -+ pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0x20, 0x1); -+ #endif -+} -+ -+VOID -+EXhalbtc8821aCsr2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8821aCsr2ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8821aCsr2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ u4Byte fwVer=0, btPatchVer=0; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", "CoexVer/ FwVer/ PatchVer", \ -+ GLCoexVerDate8821aCsr2Ant, GLCoexVer8821aCsr2Ant, fwVer, btPatchVer, btPatchVer); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ -+ ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8821A_CSR_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus)? "idle":( (BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy"))), -+ pCoexSta->btRssi, pCoexSta->btRetryCnt); -+ CL_PRINTF(cliBuf); -+ -+ if(pStackInfo->bProfileNotified) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8821aCsr2Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", "SM1[ShRf/ LpRA/ LimDig]", \ -+ pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ -+ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(!pBtCoexist->bManualControl) -+ { -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "DecBtPwr/ IgnWlanAct", \ -+ pCoexDm->bCurDecBtPwr, pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ } -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x ", "0x778 (W_Act)/ 0x6cc (CoTab Sel)", \ -+ u1Tmp[0], u1Tmp[1]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x8db); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xc5b); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x8db(ADC)/0xc5b[29:25](DAC)", \ -+ ((u1Tmp[0]&0x60)>>5), ((u1Tmp[1]&0x3e)>>1)); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xcb4); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0xcb4[7:0](ctrl)/ 0xcb4[29:28](val)", \ -+ u4Tmp[0]&0xff, ((u4Tmp[0]&0x30000000)>>28)); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x974); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x40/ 0x4c[24:23]/ 0x974", \ -+ u1Tmp[0], ((u4Tmp[0]&0x01800000)>>23), u4Tmp[1]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa0a); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0xc50(DIG)/0xa0a(CCK-TH)", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf48); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5b); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5c); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "OFDM-FA/ CCK-FA", \ -+ u4Tmp[0], (u1Tmp[0]<<8) + u1Tmp[1] ); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770 (hi-pri Rx/Tx)", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(low-pri Rx/Tx)", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8821aCsr2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ pCoexSta->bUnderIps = TRUE; -+ halbtc8821aCsr2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ pCoexSta->bUnderIps = FALSE; -+ //halbtc8821aCsr2ant_InitCoexDm(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8821aCsr2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ pCoexSta->bUnderLps = TRUE; -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ pCoexSta->bUnderLps = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8821aCsr2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8821aCsr2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8821aCsr2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+ -+ // only 2.4G we need to inform bt the chnl mask -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if( (BTC_MEDIA_CONNECT == type) && -+ (wifiCentralChnl <= 14) ) -+ { -+ H2C_Parameter[0] = 0x1; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ -+ #if 0 /* REMOVE */ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x66=0x%x\n", -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ rtw_warn_on(_BTCOEX_CSR); -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter); -+ #endif -+} -+ -+VOID -+EXhalbtc8821aCsr2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8821aCsr2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bBtBusy=FALSE, bLimitedDig=FALSE; -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE, bWifiUnder5G=FALSE; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ -+ rspSource = tmpBuf[0]&0xf; -+ if(rspSource >= BT_INFO_SRC_8821A_CSR_2ANT_MAX) -+ rspSource = BT_INFO_SRC_8821A_CSR_2ANT_WIFI_FW; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 1) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(BT_INFO_SRC_8821A_CSR_2ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = // [3:0] -+ pCoexSta->btInfoC2h[rspSource][2]&0xf; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][3]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][4]; -+ -+ #if 0 /* REMOVE */ -+ // Here we need to resend some wifi info to BT -+ // because bt is reset and loss of the info. -+ if( (pCoexSta->btInfoExt & BIT1) ) -+ { -+ -+ if(bWifiConnected) -+ { -+ EXhalbtc8821aCsr2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT); -+ } -+ else -+ { -+ EXhalbtc8821aCsr2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ } -+ #endif -+ -+ #if 0 /* REMOVE */ -+ if(!pBtCoexist->bManualControl && !bWifiUnder5G) -+ { -+ if( (pCoexSta->btInfoExt&BIT3) ) -+ { -+ if(bWifiConnected) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")); -+ halbtc8821aCsr2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ } -+ } -+ else -+ { -+ // BT already NOT ignore Wlan active, do nothing here. -+ if(!bWifiConnected) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT to ignore Wlan active!!\n")); -+ halbtc8821aCsr2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+ } -+ } -+ #endif -+ -+ #if 0 /* REMOVE */ -+ if( (pCoexSta->btInfoExt & BIT4) ) -+ { -+ // BT auto report already enabled, do nothing -+ } -+ else -+ { -+ halbtc8821aCsr2ant_BtAutoReport(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+ #endif -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(btInfo == BT_INFO_8821A_CSR_2ANT_B_CONNECTION) // connection exists but no busy -+ { -+ pCoexSta->bBtLinkExist = TRUE; -+ pCoexDm->btStatus = BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE; -+ } -+ else if(btInfo & BT_INFO_8821A_CSR_2ANT_B_CONNECTION) // connection exists and some link is busy -+ { -+ pCoexSta->bBtLinkExist = TRUE; -+ -+ if(btInfo & BT_INFO_8821A_CSR_2ANT_B_FTP) -+ pCoexSta->bPanExist = TRUE; -+ else -+ pCoexSta->bPanExist = FALSE; -+ -+ if(btInfo & BT_INFO_8821A_CSR_2ANT_B_A2DP) -+ pCoexSta->bA2dpExist = TRUE; -+ else -+ pCoexSta->bA2dpExist = FALSE; -+ -+ if(btInfo & BT_INFO_8821A_CSR_2ANT_B_HID) -+ pCoexSta->bHidExist = TRUE; -+ else -+ pCoexSta->bHidExist = FALSE; -+ -+ if(btInfo & BT_INFO_8821A_CSR_2ANT_B_SCO_ESCO) -+ pCoexSta->bScoExist = TRUE; -+ else -+ pCoexSta->bScoExist = FALSE; -+ -+ if (pCoexSta->btInfoExt & 0x80) -+ pCoexSta->bSlave = TRUE; //Slave -+ else -+ pCoexSta->bSlave = FALSE; //Master -+ -+ pCoexDm->btStatus = BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE; -+ } -+ else -+ { -+ pCoexSta->bBtLinkExist = FALSE; -+ pCoexSta->bPanExist = FALSE; -+ pCoexSta->bA2dpExist = FALSE; -+ pCoexSta->bSlave = FALSE; -+ pCoexSta->bHidExist = FALSE; -+ pCoexSta->bScoExist = FALSE; -+ pCoexDm->btStatus = BT_8821A_CSR_2ANT_BT_STATUS_IDLE; -+ } -+ -+ if(bBtHsOn) -+ { -+ pCoexDm->btStatus = BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE; -+ } -+ -+ if(btInfo & BT_INFO_8821A_CSR_2ANT_B_INQ_PAGE) -+ { -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ pCoexDm->btStatus = BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE; -+ } -+ else -+ { -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ } -+ -+ -+ if(BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE == pCoexDm->btStatus) -+ { -+ bBtBusy = TRUE; -+ } -+ else -+ { -+ bBtBusy = FALSE; -+ } -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ -+ if(BT_8821A_CSR_2ANT_BT_STATUS_IDLE != pCoexDm->btStatus) -+ { -+ bLimitedDig = TRUE; -+ } -+ else -+ { -+ bLimitedDig = FALSE; -+ } -+ pCoexDm->bLimitedDig = bLimitedDig; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bLimitedDig); -+ -+ halbtc8821aCsr2ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8821aCsr2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8821aCsr2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ EXhalbtc8821aCsr2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+VOID -+EXhalbtc8821aCsr2ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify\n")); -+ -+ if(BTC_WIFI_PNP_SLEEP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to SLEEP\n")); -+ halbtc8821aCsr2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ } -+ else if(BTC_WIFI_PNP_WAKE_UP == pnpState) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to WAKE UP\n")); -+ } -+} -+ -+VOID -+EXhalbtc8821aCsr2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static u1Byte disVerInfoCnt=0; -+ u4Byte fwVer=0, btPatchVer=0; -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ==========================Periodical===========================\n")); -+ -+ if(disVerInfoCnt <= 5) -+ { -+ disVerInfoCnt += 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ant PG Num/ Ant Mech/ Ant Pos = %d/ %d/ %d\n", -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT stack/ hci ext ver = %s / %d\n", -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion)); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", -+ GLCoexVerDate8821aCsr2Ant, GLCoexVer8821aCsr2Ant, fwVer, btPatchVer, btPatchVer)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n")); -+ } -+ -+ //halbtc8821aCsr2ant_QueryBtInfo(pBtCoexist); -+ //halbtc8821aCsr2ant_RunCoexistMechanism(pBtCoexist); -+ halbtc8821aCsr2ant_MonitorBtCtr(pBtCoexist); -+ halbtc8821aCsr2ant_MonitorBtEnableDisable(pBtCoexist); -+} -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8821aCsr2Ant.h linux/3rdparty/rtl8812au/hal/btc/HalBtc8821aCsr2Ant.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtc8821aCsr2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtc8821aCsr2Ant.h 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,207 @@ -+//=========================================== -+// The following is for 8821A_CSR 2Ant BT Co-exist definition -+//=========================================== -+#define BT_INFO_8821A_CSR_2ANT_B_FTP BIT7 -+#define BT_INFO_8821A_CSR_2ANT_B_A2DP BIT6 -+#define BT_INFO_8821A_CSR_2ANT_B_HID BIT5 -+#define BT_INFO_8821A_CSR_2ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8821A_CSR_2ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8821A_CSR_2ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8821A_CSR_2ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8821A_CSR_2ANT_B_CONNECTION BIT0 -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT 2 -+ -+typedef enum _BT_INFO_SRC_8821A_CSR_2ANT{ -+ BT_INFO_SRC_8821A_CSR_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8821A_CSR_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8821A_CSR_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8821A_CSR_2ANT_MAX -+}BT_INFO_SRC_8821A_CSR_2ANT,*PBT_INFO_SRC_8821A_CSR_2ANT; -+ -+typedef enum _BT_8821A_CSR_2ANT_BT_STATUS{ -+ BT_8821A_CSR_2ANT_BT_STATUS_IDLE = 0x0, -+ BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE = 0x2, -+ BT_8821A_CSR_2ANT_BT_STATUS_MAX -+}BT_8821A_CSR_2ANT_BT_STATUS,*PBT_8821A_CSR_2ANT_BT_STATUS; -+ -+typedef enum _BT_8821A_CSR_2ANT_COEX_ALGO{ -+ BT_8821A_CSR_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8821A_CSR_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8821A_CSR_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8821A_CSR_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8821A_CSR_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8821A_CSR_2ANT_COEX_ALGO_MAX = 0xb, -+}BT_8821A_CSR_2ANT_COEX_ALGO,*PBT_8821A_CSR_2ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8821A_CSR_2ANT{ -+ // fw mechanism -+ BOOLEAN bPreDecBtPwr; -+ BOOLEAN bCurDecBtPwr; -+ u1Byte preFwDacSwingLvl; -+ u1Byte curFwDacSwingLvl; -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[6]; -+ u1Byte psTdmaDuAdjType; -+ BOOLEAN bResetTdmaAdjust; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ BOOLEAN bPreBtAutoReport; -+ BOOLEAN bCurBtAutoReport; -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ BOOLEAN bPreDacSwingOn; -+ u4Byte preDacSwingLvl; -+ BOOLEAN bCurDacSwingOn; -+ u4Byte curDacSwingLvl; -+ BOOLEAN bPreAdcBackOff; -+ BOOLEAN bCurAdcBackOff; -+ BOOLEAN bPreAgcTableEn; -+ BOOLEAN bCurAgcTableEn; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ -+ u4Byte preRaMask; -+ u4Byte curRaMask; -+ -+ u1Byte curAmpduNumType; -+ u1Byte preAmpduNumType; -+ u2Byte backupAmpduMaxNum; -+ -+ u1Byte curAmpduTimeType; -+ u1Byte preAmpduTimeType; -+ u1Byte backupAmpduMaxTime; -+ -+ u1Byte curArfrType; -+ u1Byte preArfrType; -+ u4Byte backupArfrCnt1; -+ u4Byte backupArfrCnt2; -+ -+ u1Byte curRetryLimitType; -+ u1Byte preRetryLimitType; -+ u2Byte backupRetryLimit; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+} COEX_DM_8821A_CSR_2ANT, *PCOEX_DM_8821A_CSR_2ANT; -+ -+typedef struct _COEX_STA_8821A_CSR_2ANT{ -+ BOOLEAN bBtLinkExist; -+ BOOLEAN bScoExist; -+ BOOLEAN bA2dpExist; -+ BOOLEAN bSlave; -+ BOOLEAN bHidExist; -+ BOOLEAN bPanExist; -+ -+ BOOLEAN bUnderLps; -+ BOOLEAN bUnderIps; -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ u1Byte btRssi; -+ u1Byte preBtRssiState; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8821A_CSR_2ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8821A_CSR_2ANT_MAX]; -+ BOOLEAN bC2hBtInquiryPage; -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+}COEX_STA_8821A_CSR_2ANT, *PCOEX_STA_8821A_CSR_2ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8821aCsr2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8821aCsr2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8821aCsr2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8821aCsr2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821aCsr2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821aCsr2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821aCsr2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821aCsr2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821aCsr2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8821aCsr2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8821aCsr2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8821aCsr2ant_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ); -+VOID -+EXhalbtc8821aCsr2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8821aCsr2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/HalBtcOutSrc.h linux/3rdparty/rtl8812au/hal/btc/HalBtcOutSrc.h ---- linux.old/3rdparty/rtl8812au/hal/btc/HalBtcOutSrc.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/HalBtcOutSrc.h 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,740 @@ -+#ifndef __HALBTC_OUT_SRC_H__ -+#define __HALBTC_OUT_SRC_H__ -+ -+#define NORMAL_EXEC FALSE -+#define FORCE_EXEC TRUE -+ -+#define BTC_RF_OFF 0x0 -+#define BTC_RF_ON 0x1 -+ -+#define BTC_RF_A 0x0 -+#define BTC_RF_B 0x1 -+#define BTC_RF_C 0x2 -+#define BTC_RF_D 0x3 -+ -+#define BTC_SMSP SINGLEMAC_SINGLEPHY -+#define BTC_DMDP DUALMAC_DUALPHY -+#define BTC_DMSP DUALMAC_SINGLEPHY -+#define BTC_MP_UNKNOWN 0xff -+ -+#define BT_COEX_ANT_TYPE_PG 0 -+#define BT_COEX_ANT_TYPE_ANTDIV 1 -+#define BT_COEX_ANT_TYPE_DETECTED 2 -+ -+#define BTC_MIMO_PS_STATIC 0 // 1ss -+#define BTC_MIMO_PS_DYNAMIC 1 // 2ss -+ -+#define BTC_RATE_DISABLE 0 -+#define BTC_RATE_ENABLE 1 -+ -+// single Antenna definition -+#define BTC_ANT_PATH_WIFI 0 -+#define BTC_ANT_PATH_BT 1 -+#define BTC_ANT_PATH_PTA 2 -+// dual Antenna definition -+#define BTC_ANT_WIFI_AT_MAIN 0 -+#define BTC_ANT_WIFI_AT_AUX 1 -+// coupler Antenna definition -+#define BTC_ANT_WIFI_AT_CPL_MAIN 0 -+#define BTC_ANT_WIFI_AT_CPL_AUX 1 -+ -+typedef enum _BTC_POWERSAVE_TYPE{ -+ BTC_PS_WIFI_NATIVE = 0, // wifi original power save behavior -+ BTC_PS_LPS_ON = 1, -+ BTC_PS_LPS_OFF = 2, -+ BTC_PS_MAX -+} BTC_POWERSAVE_TYPE, *PBTC_POWERSAVE_TYPE; -+ -+typedef enum _BTC_BT_REG_TYPE{ -+ BTC_BT_REG_RF = 0, -+ BTC_BT_REG_MODEM = 1, -+ BTC_BT_REG_BLUEWIZE = 2, -+ BTC_BT_REG_VENDOR = 3, -+ BTC_BT_REG_LE = 4, -+ BTC_BT_REG_MAX -+} BTC_BT_REG_TYPE, *PBTC_BT_REG_TYPE; -+ -+typedef enum _BTC_CHIP_INTERFACE{ -+ BTC_INTF_UNKNOWN = 0, -+ BTC_INTF_PCI = 1, -+ BTC_INTF_USB = 2, -+ BTC_INTF_SDIO = 3, -+ BTC_INTF_MAX -+} BTC_CHIP_INTERFACE, *PBTC_CHIP_INTERFACE; -+ -+typedef enum _BTC_CHIP_TYPE{ -+ BTC_CHIP_UNDEF = 0, -+ BTC_CHIP_CSR_BC4 = 1, -+ BTC_CHIP_CSR_BC8 = 2, -+ BTC_CHIP_RTL8723A = 3, -+ BTC_CHIP_RTL8821 = 4, -+ BTC_CHIP_RTL8723B = 5, -+ BTC_CHIP_MAX -+} BTC_CHIP_TYPE, *PBTC_CHIP_TYPE; -+ -+// following is for wifi link status -+#define WIFI_STA_CONNECTED BIT0 -+#define WIFI_AP_CONNECTED BIT1 -+#define WIFI_HS_CONNECTED BIT2 -+#define WIFI_P2P_GO_CONNECTED BIT3 -+#define WIFI_P2P_GC_CONNECTED BIT4 -+ -+// following is for command line utility -+#define CL_SPRINTF rsprintf -+#define CL_PRINTF DCMD_Printf -+ -+ -+typedef struct _BTC_BOARD_INFO{ -+ // The following is some board information -+ u1Byte btChipType; -+ u1Byte pgAntNum; // pg ant number -+ u1Byte btdmAntNum; // ant number for btdm -+ u1Byte btdmAntNumByAntDet; // ant number for btdm after antenna detection -+ u1Byte btdmAntPos; //Bryant Add to indicate Antenna Position for (pgAntNum = 2) && (btdmAntNum =1) (DPDT+1Ant case) -+ u1Byte singleAntPath; // current used for 8723b only, 1=>s0, 0=>s1 -+ u1Byte bTfbgaPackage; //for Antenna detect threshold -+ u1Byte btdmAntDetFinish; -+ u1Byte antType; -+} BTC_BOARD_INFO, *PBTC_BOARD_INFO; -+ -+typedef enum _BTC_DBG_OPCODE{ -+ BTC_DBG_SET_COEX_NORMAL = 0x0, -+ BTC_DBG_SET_COEX_WIFI_ONLY = 0x1, -+ BTC_DBG_SET_COEX_BT_ONLY = 0x2, -+ BTC_DBG_SET_COEX_DEC_BT_PWR = 0x3, -+ BTC_DBG_SET_COEX_BT_AFH_MAP = 0x4, -+ BTC_DBG_SET_COEX_BT_IGNORE_WLAN_ACT = 0x5, -+ BTC_DBG_MAX -+}BTC_DBG_OPCODE,*PBTC_DBG_OPCODE; -+ -+typedef enum _BTC_RSSI_STATE{ -+ BTC_RSSI_STATE_HIGH = 0x0, -+ BTC_RSSI_STATE_MEDIUM = 0x1, -+ BTC_RSSI_STATE_LOW = 0x2, -+ BTC_RSSI_STATE_STAY_HIGH = 0x3, -+ BTC_RSSI_STATE_STAY_MEDIUM = 0x4, -+ BTC_RSSI_STATE_STAY_LOW = 0x5, -+ BTC_RSSI_MAX -+}BTC_RSSI_STATE,*PBTC_RSSI_STATE; -+#define BTC_RSSI_HIGH(_rssi_) ((_rssi_==BTC_RSSI_STATE_HIGH||_rssi_==BTC_RSSI_STATE_STAY_HIGH)? TRUE:FALSE) -+#define BTC_RSSI_MEDIUM(_rssi_) ((_rssi_==BTC_RSSI_STATE_MEDIUM||_rssi_==BTC_RSSI_STATE_STAY_MEDIUM)? TRUE:FALSE) -+#define BTC_RSSI_LOW(_rssi_) ((_rssi_==BTC_RSSI_STATE_LOW||_rssi_==BTC_RSSI_STATE_STAY_LOW)? TRUE:FALSE) -+ -+typedef enum _BTC_WIFI_ROLE{ -+ BTC_ROLE_STATION = 0x0, -+ BTC_ROLE_AP = 0x1, -+ BTC_ROLE_IBSS = 0x2, -+ BTC_ROLE_HS_MODE = 0x3, -+ BTC_ROLE_MAX -+}BTC_WIFI_ROLE,*PBTC_WIFI_ROLE; -+ -+typedef enum _BTC_WIRELESS_FREQ{ -+ BTC_FREQ_2_4G = 0x0, -+ BTC_FREQ_5G = 0x1, -+ BTC_FREQ_MAX -+}BTC_WIRELESS_FREQ,*PBTC_WIRELESS_FREQ; -+ -+typedef enum _BTC_WIFI_BW_MODE{ -+ BTC_WIFI_BW_LEGACY = 0x0, -+ BTC_WIFI_BW_HT20 = 0x1, -+ BTC_WIFI_BW_HT40 = 0x2, -+ BTC_WIFI_BW_HT80 = 0x3, -+ BTC_WIFI_BW_HT160 = 0x4, -+ BTC_WIFI_BW_MAX -+}BTC_WIFI_BW_MODE,*PBTC_WIFI_BW_MODE; -+ -+typedef enum _BTC_WIFI_TRAFFIC_DIR{ -+ BTC_WIFI_TRAFFIC_TX = 0x0, -+ BTC_WIFI_TRAFFIC_RX = 0x1, -+ BTC_WIFI_TRAFFIC_MAX -+}BTC_WIFI_TRAFFIC_DIR,*PBTC_WIFI_TRAFFIC_DIR; -+ -+typedef enum _BTC_WIFI_PNP{ -+ BTC_WIFI_PNP_WAKE_UP = 0x0, -+ BTC_WIFI_PNP_SLEEP = 0x1, -+ BTC_WIFI_PNP_MAX -+}BTC_WIFI_PNP,*PBTC_WIFI_PNP; -+ -+typedef enum _BTC_IOT_PEER -+{ -+ BTC_IOT_PEER_UNKNOWN = 0, -+ BTC_IOT_PEER_REALTEK = 1, -+ BTC_IOT_PEER_REALTEK_92SE = 2, -+ BTC_IOT_PEER_BROADCOM = 3, -+ BTC_IOT_PEER_RALINK = 4, -+ BTC_IOT_PEER_ATHEROS = 5, -+ BTC_IOT_PEER_CISCO = 6, -+ BTC_IOT_PEER_MERU = 7, -+ BTC_IOT_PEER_MARVELL = 8, -+ BTC_IOT_PEER_REALTEK_SOFTAP = 9,// peer is RealTek SOFT_AP, by Bohn, 2009.12.17 -+ BTC_IOT_PEER_SELF_SOFTAP = 10, // Self is SoftAP -+ BTC_IOT_PEER_AIRGO = 11, -+ BTC_IOT_PEER_INTEL = 12, -+ BTC_IOT_PEER_RTK_APCLIENT = 13, -+ BTC_IOT_PEER_REALTEK_81XX = 14, -+ BTC_IOT_PEER_REALTEK_WOW = 15, -+ BTC_IOT_PEER_REALTEK_JAGUAR_BCUTAP = 16, -+ BTC_IOT_PEER_REALTEK_JAGUAR_CCUTAP = 17, -+ BTC_IOT_PEER_MAX, -+}BTC_IOT_PEER, *PBTC_IOT_PEER; -+ -+//for 8723b-d cut large current issue -+typedef enum _BT_WIFI_COEX_STATE{ -+ BTC_WIFI_STAT_INIT, -+ BTC_WIFI_STAT_IQK, -+ BTC_WIFI_STAT_NORMAL_OFF, -+ BTC_WIFI_STAT_MP_OFF, -+ BTC_WIFI_STAT_NORMAL, -+ BTC_WIFI_STAT_ANT_DIV, -+ BTC_WIFI_STAT_MAX -+}BT_WIFI_COEX_STATE,*PBT_WIFI_COEX_STATE; -+ -+typedef enum _BT_ANT_TYPE{ -+ BTC_ANT_TYPE_0, -+ BTC_ANT_TYPE_1, -+ BTC_ANT_TYPE_2, -+ BTC_ANT_TYPE_3, -+ BTC_ANT_TYPE_4, -+ BTC_ANT_TYPE_MAX -+}BT_ANT_TYPE,*PBT_ANT_TYPE; -+ -+// defined for BFP_BTC_GET -+typedef enum _BTC_GET_TYPE{ -+ // type BOOLEAN -+ BTC_GET_BL_HS_OPERATION, -+ BTC_GET_BL_HS_CONNECTING, -+ BTC_GET_BL_WIFI_CONNECTED, -+ BTC_GET_BL_WIFI_BUSY, -+ BTC_GET_BL_WIFI_SCAN, -+ BTC_GET_BL_WIFI_LINK, -+ BTC_GET_BL_WIFI_ROAM, -+ BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ BTC_GET_BL_WIFI_UNDER_5G, -+ BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ BTC_GET_BL_WIFI_ENABLE_ENCRYPTION, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ BTC_GET_BL_EXT_SWITCH, -+ BTC_GET_BL_WIFI_IS_IN_MP_MODE, -+ BTC_GET_BL_IS_ASUS_8723B, -+ -+ // type s4Byte -+ BTC_GET_S4_WIFI_RSSI, -+ BTC_GET_S4_HS_RSSI, -+ -+ // type u4Byte -+ BTC_GET_U4_WIFI_BW, -+ BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, -+ BTC_GET_U4_WIFI_FW_VER, -+ BTC_GET_U4_WIFI_LINK_STATUS, -+ BTC_GET_U4_BT_PATCH_VER, -+ -+ // type u1Byte -+ BTC_GET_U1_WIFI_DOT11_CHNL, -+ BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ BTC_GET_U1_WIFI_HS_CHNL, -+ BTC_GET_U1_MAC_PHY_MODE, -+ BTC_GET_U1_AP_NUM, -+ BTC_GET_U1_ANT_TYPE, -+ BTC_GET_U1_IOT_PEER, -+ -+ //===== for 1Ant ====== -+ BTC_GET_U1_LPS_MODE, -+ -+ BTC_GET_MAX -+}BTC_GET_TYPE,*PBTC_GET_TYPE; -+ -+// defined for BFP_BTC_SET -+typedef enum _BTC_SET_TYPE{ -+ // type BOOLEAN -+ BTC_SET_BL_BT_DISABLE, -+ BTC_SET_BL_BT_TRAFFIC_BUSY, -+ BTC_SET_BL_BT_LIMITED_DIG, -+ BTC_SET_BL_FORCE_TO_ROAM, -+ BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ BTC_SET_BL_INC_SCAN_DEV_NUM, -+ BTC_SET_BL_BT_TX_RX_MASK, -+ BTC_SET_BL_MIRACAST_PLUS_BT, -+ -+ // type u1Byte -+ BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, -+ BTC_SET_U1_AGG_BUF_SIZE, -+ -+ // type trigger some action -+ BTC_SET_ACT_GET_BT_RSSI, -+ BTC_SET_ACT_AGGREGATE_CTRL, -+ //===== for 1Ant ====== -+ // type BOOLEAN -+ -+ // type u1Byte -+ BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, -+ BTC_SET_U1_LPS_VAL, -+ BTC_SET_U1_RPWM_VAL, -+ // type trigger some action -+ BTC_SET_ACT_LEAVE_LPS, -+ BTC_SET_ACT_ENTER_LPS, -+ BTC_SET_ACT_NORMAL_LPS, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ BTC_SET_ACT_UPDATE_RAMASK, -+ BTC_SET_ACT_SEND_MIMO_PS, -+ // BT Coex related -+ BTC_SET_ACT_CTRL_BT_INFO, -+ BTC_SET_ACT_CTRL_BT_COEX, -+ BTC_SET_ACT_CTRL_8723B_ANT, -+ //================= -+ BTC_SET_MAX -+}BTC_SET_TYPE,*PBTC_SET_TYPE; -+ -+typedef enum _BTC_DBG_DISP_TYPE{ -+ BTC_DBG_DISP_COEX_STATISTICS = 0x0, -+ BTC_DBG_DISP_BT_LINK_INFO = 0x1, -+ BTC_DBG_DISP_WIFI_STATUS = 0x2, -+ BTC_DBG_DISP_MAX -+}BTC_DBG_DISP_TYPE,*PBTC_DBG_DISP_TYPE; -+ -+typedef enum _BTC_NOTIFY_TYPE_IPS{ -+ BTC_IPS_LEAVE = 0x0, -+ BTC_IPS_ENTER = 0x1, -+ BTC_IPS_MAX -+}BTC_NOTIFY_TYPE_IPS,*PBTC_NOTIFY_TYPE_IPS; -+typedef enum _BTC_NOTIFY_TYPE_LPS{ -+ BTC_LPS_DISABLE = 0x0, -+ BTC_LPS_ENABLE = 0x1, -+ BTC_LPS_MAX -+}BTC_NOTIFY_TYPE_LPS,*PBTC_NOTIFY_TYPE_LPS; -+typedef enum _BTC_NOTIFY_TYPE_SCAN{ -+ BTC_SCAN_FINISH = 0x0, -+ BTC_SCAN_START = 0x1, -+ BTC_SCAN_MAX -+}BTC_NOTIFY_TYPE_SCAN,*PBTC_NOTIFY_TYPE_SCAN; -+typedef enum _BTC_NOTIFY_TYPE_ASSOCIATE{ -+ BTC_ASSOCIATE_FINISH = 0x0, -+ BTC_ASSOCIATE_START = 0x1, -+ BTC_ASSOCIATE_MAX -+}BTC_NOTIFY_TYPE_ASSOCIATE,*PBTC_NOTIFY_TYPE_ASSOCIATE; -+typedef enum _BTC_NOTIFY_TYPE_MEDIA_STATUS{ -+ BTC_MEDIA_DISCONNECT = 0x0, -+ BTC_MEDIA_CONNECT = 0x1, -+ BTC_MEDIA_MAX -+}BTC_NOTIFY_TYPE_MEDIA_STATUS,*PBTC_NOTIFY_TYPE_MEDIA_STATUS; -+typedef enum _BTC_NOTIFY_TYPE_SPECIAL_PACKET{ -+ BTC_PACKET_UNKNOWN = 0x0, -+ BTC_PACKET_DHCP = 0x1, -+ BTC_PACKET_ARP = 0x2, -+ BTC_PACKET_EAPOL = 0x3, -+ BTC_PACKET_MAX -+}BTC_NOTIFY_TYPE_SPECIAL_PACKET,*PBTC_NOTIFY_TYPE_SPECIAL_PACKET; -+typedef enum _BTC_NOTIFY_TYPE_STACK_OPERATION{ -+ BTC_STACK_OP_NONE = 0x0, -+ BTC_STACK_OP_INQ_PAGE_PAIR_START = 0x1, -+ BTC_STACK_OP_INQ_PAGE_PAIR_FINISH = 0x2, -+ BTC_STACK_OP_MAX -+}BTC_NOTIFY_TYPE_STACK_OPERATION,*PBTC_NOTIFY_TYPE_STACK_OPERATION; -+ -+//Bryant Add -+typedef enum _BTC_ANTENNA_POS{ -+ BTC_ANTENNA_AT_MAIN_PORT = 0x1, -+ BTC_ANTENNA_AT_AUX_PORT = 0x2, -+}BTC_ANTENNA_POS,*PBTC_ANTENNA_POS; -+ -+//Bryant Add -+typedef enum _BTC_BT_OFFON{ -+ BTC_BT_OFF = 0x0, -+ BTC_BT_ON = 0x1, -+}BTC_BTOFFON,*PBTC_BT_OFFON; -+ -+typedef u1Byte -+(*BFP_BTC_R1)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr -+ ); -+typedef u2Byte -+(*BFP_BTC_R2)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr -+ ); -+typedef u4Byte -+(*BFP_BTC_R4)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr -+ ); -+typedef VOID -+(*BFP_BTC_W1)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr, -+ IN u1Byte Data -+ ); -+typedef VOID -+(*BFP_BTC_W1_BIT_MASK)( -+ IN PVOID pBtcContext, -+ IN u4Byte regAddr, -+ IN u1Byte bitMask, -+ IN u1Byte data1b -+ ); -+typedef VOID -+(*BFP_BTC_W2)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr, -+ IN u2Byte Data -+ ); -+typedef VOID -+(*BFP_BTC_W4)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr, -+ IN u4Byte Data -+ ); -+typedef VOID -+(*BFP_BTC_LOCAL_REG_W1)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr, -+ IN u1Byte Data -+ ); -+typedef VOID -+(*BFP_BTC_SET_BB_REG)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ); -+typedef u4Byte -+(*BFP_BTC_GET_BB_REG)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ); -+typedef VOID -+(*BFP_BTC_SET_RF_REG)( -+ IN PVOID pBtcContext, -+ IN u1Byte eRFPath, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ); -+typedef u4Byte -+(*BFP_BTC_GET_RF_REG)( -+ IN PVOID pBtcContext, -+ IN u1Byte eRFPath, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ); -+typedef VOID -+(*BFP_BTC_FILL_H2C)( -+ IN PVOID pBtcContext, -+ IN u1Byte elementId, -+ IN u4Byte cmdLen, -+ IN pu1Byte pCmdBuffer -+ ); -+ -+typedef BOOLEAN -+(*BFP_BTC_GET)( -+ IN PVOID pBtCoexist, -+ IN u1Byte getType, -+ OUT PVOID pOutBuf -+ ); -+ -+typedef BOOLEAN -+(*BFP_BTC_SET)( -+ IN PVOID pBtCoexist, -+ IN u1Byte setType, -+ OUT PVOID pInBuf -+ ); -+typedef VOID -+(*BFP_BTC_SET_BT_REG)( -+ IN PVOID pBtcContext, -+ IN u1Byte regType, -+ IN u4Byte offset, -+ IN u4Byte value -+ ); -+typedef BOOLEAN -+(*BFP_BTC_SET_BT_ANT_DETECTION)( -+ IN PVOID pBtcContext, -+ IN u1Byte txTime, -+ IN u1Byte btChnl -+ ); -+typedef u4Byte -+(*BFP_BTC_GET_BT_REG)( -+ IN PVOID pBtcContext, -+ IN u1Byte regType, -+ IN u4Byte offset -+ ); -+typedef VOID -+(*BFP_BTC_DISP_DBG_MSG)( -+ IN PVOID pBtCoexist, -+ IN u1Byte dispType -+ ); -+ -+typedef struct _BTC_BT_INFO{ -+ BOOLEAN bBtDisabled; -+ u1Byte rssiAdjustForAgcTableOn; -+ u1Byte rssiAdjustFor1AntCoexType; -+ BOOLEAN bPreBtCtrlAggBufSize; -+ BOOLEAN bBtCtrlAggBufSize; -+ BOOLEAN bPreRejectAggPkt; -+ BOOLEAN bRejectAggPkt; -+ BOOLEAN bIncreaseScanDevNum; -+ BOOLEAN bBtTxRxMask; -+ u1Byte preAggBufSize; -+ u1Byte aggBufSize; -+ BOOLEAN bBtBusy; -+ BOOLEAN bLimitedDig; -+ u2Byte btHciVer; -+ u2Byte btRealFwVer; -+ u1Byte btFwVer; -+ u4Byte getBtFwVerCnt; -+ BOOLEAN bMiracastPlusBt; -+ -+ BOOLEAN bBtDisableLowPwr; -+ -+ BOOLEAN bBtCtrlLps; -+ BOOLEAN bBtLpsOn; -+ BOOLEAN bForceToRoam; // for 1Ant solution -+ u1Byte lpsVal; -+ u1Byte rpwmVal; -+ u4Byte raMask; -+} BTC_BT_INFO, *PBTC_BT_INFO; -+ -+typedef struct _BTC_STACK_INFO{ -+ BOOLEAN bProfileNotified; -+ u2Byte hciVersion; // stack hci version -+ u1Byte numOfLink; -+ BOOLEAN bBtLinkExist; -+ BOOLEAN bScoExist; -+ BOOLEAN bAclExist; -+ BOOLEAN bA2dpExist; -+ BOOLEAN bHidExist; -+ u1Byte numOfHid; -+ BOOLEAN bPanExist; -+ BOOLEAN bUnknownAclExist; -+ s1Byte minBtRssi; -+} BTC_STACK_INFO, *PBTC_STACK_INFO; -+ -+typedef struct _BTC_BT_LINK_INFO{ -+ BOOLEAN bBtLinkExist; -+ BOOLEAN bBtHiPriLinkExist; -+ BOOLEAN bScoExist; -+ BOOLEAN bScoOnly; -+ BOOLEAN bA2dpExist; -+ BOOLEAN bA2dpOnly; -+ BOOLEAN bHidExist; -+ BOOLEAN bHidOnly; -+ BOOLEAN bPanExist; -+ BOOLEAN bPanOnly; -+ BOOLEAN bSlaveRole; -+ BOOLEAN bAclBusy; -+} BTC_BT_LINK_INFO, *PBTC_BT_LINK_INFO; -+ -+typedef struct _BTC_STATISTICS{ -+ u4Byte cntBind; -+ u4Byte cntPowerOn; -+ u4Byte cntPreLoadFirmware; -+ u4Byte cntInitHwConfig; -+ u4Byte cntInitCoexDm; -+ u4Byte cntIpsNotify; -+ u4Byte cntLpsNotify; -+ u4Byte cntScanNotify; -+ u4Byte cntConnectNotify; -+ u4Byte cntMediaStatusNotify; -+ u4Byte cntSpecialPacketNotify; -+ u4Byte cntBtInfoNotify; -+ u4Byte cntRfStatusNotify; -+ u4Byte cntPeriodical; -+ u4Byte cntCoexDmSwitch; -+ u4Byte cntStackOperationNotify; -+ u4Byte cntDbgCtrl; -+} BTC_STATISTICS, *PBTC_STATISTICS; -+ -+typedef struct _BTC_COEXIST{ -+ BOOLEAN bBinded; // make sure only one adapter can bind the data context -+ PVOID Adapter; // default adapter -+ BTC_BOARD_INFO boardInfo; -+ BTC_BT_INFO btInfo; // some bt info referenced by non-bt module -+ BTC_STACK_INFO stackInfo; -+ BTC_BT_LINK_INFO btLinkInfo; -+ BTC_CHIP_INTERFACE chipInterface; -+ -+ BOOLEAN bInitilized; -+ BOOLEAN bStopCoexDm; -+ BOOLEAN bManualControl; -+ pu1Byte cliBuf; -+ BTC_STATISTICS statistics; -+ u1Byte pwrModeVal[10]; -+ -+ // function pointers -+ // io related -+ BFP_BTC_R1 fBtcRead1Byte; -+ BFP_BTC_W1 fBtcWrite1Byte; -+ BFP_BTC_W1_BIT_MASK fBtcWrite1ByteBitMask; -+ BFP_BTC_R2 fBtcRead2Byte; -+ BFP_BTC_W2 fBtcWrite2Byte; -+ BFP_BTC_R4 fBtcRead4Byte; -+ BFP_BTC_W4 fBtcWrite4Byte; -+ BFP_BTC_LOCAL_REG_W1 fBtcWriteLocalReg1Byte; -+ // read/write bb related -+ BFP_BTC_SET_BB_REG fBtcSetBbReg; -+ BFP_BTC_GET_BB_REG fBtcGetBbReg; -+ -+ // read/write rf related -+ BFP_BTC_SET_RF_REG fBtcSetRfReg; -+ BFP_BTC_GET_RF_REG fBtcGetRfReg; -+ -+ // fill h2c related -+ BFP_BTC_FILL_H2C fBtcFillH2c; -+ // other -+ BFP_BTC_DISP_DBG_MSG fBtcDispDbgMsg; -+ // normal get/set related -+ BFP_BTC_GET fBtcGet; -+ BFP_BTC_SET fBtcSet; -+ -+ BFP_BTC_GET_BT_REG fBtcGetBtReg; -+ BFP_BTC_SET_BT_REG fBtcSetBtReg; -+ -+ BFP_BTC_SET_BT_ANT_DETECTION fBtcSetBtAntDetection; -+} BTC_COEXIST, *PBTC_COEXIST; -+ -+extern BTC_COEXIST GLBtCoexist; -+ -+BOOLEAN -+EXhalbtcoutsrc_InitlizeVariables( -+ IN PVOID Adapter -+ ); -+VOID -+EXhalbtcoutsrc_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtcoutsrc_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtcoutsrc_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtcoutsrc_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtcoutsrc_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte action -+ ); -+VOID -+EXhalbtcoutsrc_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN RT_MEDIA_STATUS mediaStatus -+ ); -+VOID -+EXhalbtcoutsrc_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pktType -+ ); -+VOID -+EXhalbtcoutsrc_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtcoutsrc_RfStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtcoutsrc_StackOperationNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtcoutsrc_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ); -+VOID -+EXhalbtcoutsrc_CoexDmSwitch( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_DbgControl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte opCode, -+ IN u1Byte opLen, -+ IN pu1Byte pData -+ ); -+VOID -+EXhalbtcoutsrc_AntennaDetection( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ); -+VOID -+EXhalbtcoutsrc_StackUpdateProfileInfo( -+ VOID -+ ); -+VOID -+EXhalbtcoutsrc_SetHciVersion( -+ IN u2Byte hciVersion -+ ); -+VOID -+EXhalbtcoutsrc_SetBtPatchVersion( -+ IN u2Byte btHciVersion, -+ IN u2Byte btPatchVersion -+ ); -+VOID -+EXhalbtcoutsrc_UpdateMinBtRssi( -+ IN s1Byte btRssi -+ ); -+#if 0 -+VOID -+EXhalbtcoutsrc_SetBtExist( -+ IN BOOLEAN bBtExist -+ ); -+#endif -+VOID -+EXhalbtcoutsrc_SetChipType( -+ IN u1Byte chipType -+ ); -+VOID -+EXhalbtcoutsrc_SetAntNum( -+ IN u1Byte type, -+ IN u1Byte antNum -+ ); -+VOID -+EXhalbtcoutsrc_SetSingleAntPath( -+ IN u1Byte singleAntPath -+ ); -+VOID -+EXhalbtcoutsrc_DisplayBtCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_DisplayAntDetection( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/btc/Mp_Precomp.h linux/3rdparty/rtl8812au/hal/btc/Mp_Precomp.h ---- linux.old/3rdparty/rtl8812au/hal/btc/Mp_Precomp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/btc/Mp_Precomp.h 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,89 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __MP_PRECOMP_H__ -+#define __MP_PRECOMP_H__ -+ -+#include -+#include -+ -+#define BT_TMP_BUF_SIZE 100 -+ -+#ifdef PLATFORM_LINUX -+#define rsprintf snprintf -+#elif defined(PLATFORM_WINDOWS) -+#define rsprintf sprintf_s -+#endif -+ -+#define DCMD_Printf DBG_BT_INFO -+ -+#define delay_ms(ms) rtw_mdelay_os(ms) -+ -+#ifdef bEnable -+#undef bEnable -+#endif -+ -+#define WPP_SOFTWARE_TRACE 0 -+ -+typedef enum _BTC_MSG_COMP_TYPE{ -+ COMP_COEX = 0, -+ COMP_MAX -+}BTC_MSG_COMP_TYPE; -+extern u4Byte GLBtcDbgType[]; -+ -+#define DBG_OFF 0 -+#define DBG_SEC 1 -+#define DBG_SERIOUS 2 -+#define DBG_WARNING 3 -+#define DBG_LOUD 4 -+#define DBG_TRACE 5 -+ -+#if DBG -+#ifdef RT_TRACE -+#undef RT_TRACE -+#define RT_TRACE(dbgtype, dbgflag, printstr)\ -+do {\ -+ if (GLBtcDbgType[dbgtype] & BIT(dbgflag))\ -+ {\ -+ DbgPrint printstr;\ -+ }\ -+} while (0) -+#endif -+#else -+#define RT_TRACE(dbgtype, dbgflag, printstr) -+#endif -+ -+#include "HalBtcOutSrc.h" -+#include "HalBtc8188c2Ant.h" -+#include "HalBtc8192d2Ant.h" -+#include "HalBtc8192e1Ant.h" -+#include "HalBtc8192e2Ant.h" -+#include "HalBtc8723a1Ant.h" -+#include "HalBtc8723a2Ant.h" -+#include "HalBtc8723b1Ant.h" -+#include "HalBtc8723b2Ant.h" -+#include "HalBtc8812a1Ant.h" -+#include "HalBtc8812a2Ant.h" -+#include "HalBtc8821a1Ant.h" -+#include "HalBtc8821a2Ant.h" -+#include "HalBtc8821aCsr2Ant.h" -+#include "HalBtc8703b1Ant.h" -+#include "HalBtc8703b2Ant.h" -+ -+#endif // __MP_PRECOMP_H__ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/efuse/efuse_mask.h linux/3rdparty/rtl8812au/hal/efuse/efuse_mask.h ---- linux.old/3rdparty/rtl8812au/hal/efuse/efuse_mask.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/efuse/efuse_mask.h 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,80 @@ -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ -+ #if defined(CONFIG_RTL8188E) -+ #include "rtl8188e/HalEfuseMask8188E_USB.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8812A) -+ #include "rtl8812a/HalEfuseMask8812A_USB.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8821A) -+ #include "rtl8812a/HalEfuseMask8821A_USB.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8192E) -+ #include "rtl8192e/HalEfuseMask8192E_USB.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8723B) -+ #include "rtl8723b/HalEfuseMask8723B_USB.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8814A) -+ #include "rtl8814a/HalEfuseMask8814A_USB.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8703B) -+ #include "rtl8703b/HalEfuseMask8703B_USB.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8188F) -+ #include "rtl8188f/HalEfuseMask8188F_USB.h" -+ #endif -+ -+#elif DEV_BUS_TYPE == RT_PCI_INTERFACE -+ -+ #if defined(CONFIG_RTL8188E) -+ #include "rtl8188e/HalEfuseMask8188E_PCIE.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8812A) -+ #include "rtl8812a/HalEfuseMask8812A_PCIE.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8821A) -+ #include "rtl8812a/HalEfuseMask8821A_PCIE.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8192E) -+ #include "rtl8192e/HalEfuseMask8192E_PCIE.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8723B) -+ #include "rtl8723b/HalEfuseMask8723B_PCIE.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8814A) -+ #include "rtl8814a/HalEfuseMask8814A_PCIE.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8703B) -+ #include "rtl8703b/HalEfuseMask8703B_PCIE.h" -+ #endif -+ -+#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ -+ #if defined(CONFIG_RTL8188E) -+ #include "rtl8188e/HalEfuseMask8188E_SDIO.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8703B) -+ #include "rtl8703b/HalEfuseMask8703B_SDIO.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8188F) -+ #include "rtl8188f/HalEfuseMask8188F_SDIO.h" -+ #endif -+ -+#endif -\ Ingen nyrad vid filslut -diff -Nurp linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_PCIE.c linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_PCIE.c ---- linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_PCIE.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_PCIE.c 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,100 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+//#include "Mp_Precomp.h" -+//#include "../odm_precomp.h" -+ -+#include -+ -+#include "HalEfuseMask8812A_PCIE.h" -+ -+/****************************************************************************** -+* MPCIE.TXT -+******************************************************************************/ -+ -+u1Byte Array_MP_8812A_MPCIE[] = { -+ 0xFF, -+ 0xF7, -+ 0xEF, -+ 0xDE, -+ 0xFD, -+ 0xFB, -+ 0x10, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x0F, -+ 0xF3, -+ 0xFF, -+ 0xFF, -+ 0x7C, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ -+}; -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8812A_MPCIE(VOID) -+{ -+ return sizeof(Array_MP_8812A_MPCIE)/sizeof(u1Byte); -+} -+ -+VOID -+EFUSE_GetMaskArray_MP_8812A_MPCIE( -+ IN OUT pu1Byte Array -+ ) -+{ -+ u2Byte len = EFUSE_GetArrayLen_MP_8812A_MPCIE(), i = 0; -+ -+ for (i = 0; i < len; ++i) -+ Array[i] = Array_MP_8812A_MPCIE[i]; -+} -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8812A_MPCIE( -+ IN u2Byte Offset -+ ) -+{ -+ int r = Offset/16; -+ int c = (Offset%16) / 2; -+ int result = 0; -+ -+ if (c < 4) // Upper double word -+ result = (Array_MP_8812A_MPCIE[r] & (0x10 << c)); -+ else -+ result = (Array_MP_8812A_MPCIE[r] & (0x01 << (c-4))); -+ -+ return (result > 0) ? 0 : 1; -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_PCIE.h linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_PCIE.h ---- linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_PCIE.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_PCIE.h 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,40 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+ -+/****************************************************************************** -+* MPCIE.TXT -+******************************************************************************/ -+ -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8812A_MPCIE(VOID); -+ -+VOID -+EFUSE_GetMaskArray_MP_8812A_MPCIE( -+ IN OUT pu1Byte Array -+); -+ -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8812A_MPCIE( // TC: Test Chip, MP: MP Chip -+ IN u2Byte Offset -+); -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_USB.c linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_USB.c ---- linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_USB.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_USB.c 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,102 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+//#include "Mp_Precomp.h" -+//#include "../odm_precomp.h" -+ -+#include -+ -+#include "HalEfuseMask8812A_USB.h" -+ -+/****************************************************************************** -+* MUSB.TXT -+******************************************************************************/ -+ -+u1Byte Array_MP_8812A_MUSB[] = { -+ 0xFF, -+ 0xF7, -+ 0xEF, -+ 0xDE, -+ 0xFC, -+ 0xFB, -+ 0x10, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x0F, -+ 0xF3, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xF7, -+ 0x00, -+ 0xFF, -+ 0xFF, -+ 0xF3, -+ 0x0F, -+ 0xFF, -+ 0xF3, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ -+}; -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8812A_MUSB(VOID) -+{ -+ return sizeof(Array_MP_8812A_MUSB)/sizeof(u1Byte); -+} -+ -+VOID -+EFUSE_GetMaskArray_MP_8812A_MUSB( -+ IN OUT pu1Byte Array -+ ) -+{ -+ u2Byte len = EFUSE_GetArrayLen_MP_8812A_MUSB(), i = 0; -+ -+ for (i = 0; i < len; ++i) -+ Array[i] = Array_MP_8812A_MUSB[i]; -+} -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8812A_MUSB( -+ IN u2Byte Offset -+ ) -+{ -+ int r = Offset/16; -+ int c = (Offset%16) / 2; -+ int result = 0; -+ -+ if (c < 4) // Upper double word -+ result = (Array_MP_8812A_MUSB[r] & (0x10 << c)); -+ else -+ result = (Array_MP_8812A_MUSB[r] & (0x01 << (c-4))); -+ -+ return (result > 0) ? 0 : 1; -+} -+ -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_USB.h linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_USB.h ---- linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_USB.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8812A_USB.h 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,40 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+ -+ -+/****************************************************************************** -+* MUSB.TXT -+******************************************************************************/ -+ -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8812A_MUSB(VOID); -+ -+VOID -+EFUSE_GetMaskArray_MP_8812A_MUSB( -+ IN OUT pu1Byte Array -+); -+ -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8812A_MUSB( // TC: Test Chip, MP: MP Chip -+ IN u2Byte Offset -+); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_PCIE.c linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_PCIE.c ---- linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_PCIE.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_PCIE.c 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,102 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+//#include "Mp_Precomp.h" -+//#include "../odm_precomp.h" -+ -+#include -+ -+#include "HalEfuseMask8821A_PCIE.h" -+ -+/****************************************************************************** -+* MPCIE.TXT -+******************************************************************************/ -+ -+u1Byte Array_MP_8821A_MPCIE[] = { -+ 0xFF, -+ 0xF3, -+ 0xEF, -+ 0x90, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x0F, -+ 0xF1, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xF1, -+ 0x00, -+ 0x80, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ -+}; -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8821A_MPCIE(VOID) -+{ -+ return sizeof(Array_MP_8821A_MPCIE)/sizeof(u1Byte); -+} -+ -+VOID -+EFUSE_GetMaskArray_MP_8821A_MPCIE( -+ IN OUT pu1Byte Array -+ ) -+{ -+ u2Byte len = EFUSE_GetArrayLen_MP_8821A_MPCIE(), i = 0; -+ -+ for (i = 0; i < len; ++i) -+ Array[i] = Array_MP_8821A_MPCIE[i]; -+} -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8821A_MPCIE( -+ IN u2Byte Offset -+ ) -+{ -+ int r = Offset/16; -+ int c = (Offset%16) / 2; -+ int result = 0; -+ -+ if (c < 4) // Upper double word -+ result = (Array_MP_8821A_MPCIE[r] & (0x10 << c)); -+ else -+ result = (Array_MP_8821A_MPCIE[r] & (0x01 << (c-4))); -+ -+ return (result > 0) ? 0 : 1; -+} -+ -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_PCIE.h linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_PCIE.h ---- linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_PCIE.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_PCIE.h 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+ -+/****************************************************************************** -+* MPCIE.TXT -+******************************************************************************/ -+ -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8821A_MPCIE(VOID); -+ -+VOID -+EFUSE_GetMaskArray_MP_8821A_MPCIE( -+ IN OUT pu1Byte Array -+); -+ -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8821A_MPCIE( // TC: Test Chip, MP: MP Chip -+ IN u2Byte Offset -+); -+ -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_USB.c linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_USB.c ---- linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_USB.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_USB.c 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,102 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+//#include "Mp_Precomp.h" -+//#include "../odm_precomp.h" -+ -+#include -+ -+#include "HalEfuseMask8821A_USB.h" -+ -+ -+/****************************************************************************** -+* MUSB.TXT -+******************************************************************************/ -+ -+ -+u1Byte Array_MP_8821A_MUSB[] = { -+ 0xFF, -+ 0xF3, -+ 0xEF, -+ 0x90, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x0F, -+ 0xF1, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0xBF, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xB0, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ -+}; -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8821A_MUSB(VOID) -+{ -+ return sizeof(Array_MP_8821A_MUSB)/sizeof(u1Byte); -+} -+ -+VOID -+EFUSE_GetMaskArray_MP_8821A_MUSB( -+ IN OUT pu1Byte Array -+ ) -+{ -+ u2Byte len = EFUSE_GetArrayLen_MP_8821A_MUSB(), i = 0; -+ -+ for (i = 0; i < len; ++i) -+ Array[i] = Array_MP_8821A_MUSB[i]; -+} -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8821A_MUSB( -+ IN u2Byte Offset -+ ) -+{ -+ int r = Offset/16; -+ int c = (Offset%16) / 2; -+ int result = 0; -+ -+ if (c < 4) // Upper double word -+ result = (Array_MP_8821A_MUSB[r] & (0x10 << c)); -+ else -+ result = (Array_MP_8821A_MUSB[r] & (0x01 << (c-4))); -+ -+ return (result > 0) ? 0 : 1; -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_USB.h linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_USB.h ---- linux.old/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_USB.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/efuse/rtl8812a/HalEfuseMask8821A_USB.h 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,39 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/****************************************************************************** -+* MUSB.TXT -+******************************************************************************/ -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8821A_MUSB(VOID); -+ -+VOID -+EFUSE_GetMaskArray_MP_8821A_MUSB( -+ IN OUT pu1Byte Array -+); -+ -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8821A_MUSB( // TC: Test Chip, MP: MP Chip -+ IN u2Byte Offset -+); -+ -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_btcoex.c linux/3rdparty/rtl8812au/hal/hal_btcoex.c ---- linux.old/3rdparty/rtl8812au/hal/hal_btcoex.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/hal_btcoex.c 2017-06-07 23:07:21.012687667 +0300 -@@ -0,0 +1,3423 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define __HAL_BTCOEX_C__ -+ -+#ifdef CONFIG_BT_COEXIST -+ -+#include -+#include -+#include -+ -+//==================================== -+// Global variables -+//==================================== -+const char *const BtProfileString[] = -+{ -+ "NONE", -+ "A2DP", -+ "PAN", -+ "HID", -+ "SCO", -+}; -+ -+const char *const BtSpecString[] = -+{ -+ "1.0b", -+ "1.1", -+ "1.2", -+ "2.0+EDR", -+ "2.1+EDR", -+ "3.0+HS", -+ "4.0", -+}; -+ -+const char *const BtLinkRoleString[] = -+{ -+ "Master", -+ "Slave", -+}; -+ -+const char *const h2cStaString[] = -+{ -+ "successful", -+ "h2c busy", -+ "rf off", -+ "fw not read", -+}; -+ -+const char *const ioStaString[] = -+{ -+ "success", -+ "can not IO", -+ "rf off", -+ "fw not read", -+ "wait io timeout", -+ "invalid len", -+ "idle Q empty", -+ "insert waitQ fail", -+ "unknown fail", -+ "wrong level", -+ "h2c stopped", -+}; -+ -+const char *const GLBtcWifiBwString[]={ -+ "11bg", -+ "HT20", -+ "HT40", -+ "HT80", -+ "HT160" -+}; -+ -+const char *const GLBtcWifiFreqString[]={ -+ "2.4G", -+ "5G" -+}; -+ -+const char *const GLBtcIotPeerString[] = { -+ "UNKNOWN", -+ "REALTEK", -+ "REALTEK_92SE", -+ "BROADCOM", -+ "RALINK", -+ "ATHEROS", -+ "CISCO", -+ "MERU", -+ "MARVELL", -+ "REALTEK_SOFTAP", /* peer is RealTek SOFT_AP, by Bohn, 2009.12.17 */ -+ "SELF_SOFTAP", /* Self is SoftAP */ -+ "AIRGO", -+ "INTEL", -+ "RTK_APCLIENT", -+ "REALTEK_81XX", -+ "REALTEK_WOW", -+ "REALTEK_JAGUAR_BCUTAP", -+ "REALTEK_JAGUAR_CCUTAP" -+}; -+ -+#define HALBTCOUTSRC_AGG_CHK_WINDOW_IN_MS 8000 -+ -+BTC_COEXIST GLBtCoexist; -+u8 GLBtcWiFiInScanState; -+u8 GLBtcWiFiInIQKState; -+u8 GLBtcWiFiInIPS; -+u8 GLBtcWiFiInLPS; -+u8 GLBtcBtCoexAliveRegistered; -+ -+u32 GLBtcDbgType[COMP_MAX]; -+u8 GLBtcDbgBuf[BT_TMP_BUF_SIZE]; -+ -+typedef struct _btcoexdbginfo -+{ -+ u8 *info; -+ u32 size; // buffer total size -+ u32 len; // now used length -+} BTCDBGINFO, *PBTCDBGINFO; -+ -+BTCDBGINFO GLBtcDbgInfo; -+ -+#define BT_Operation(Adapter) _FALSE -+ -+static void DBG_BT_INFO_INIT(PBTCDBGINFO pinfo, u8 *pbuf, u32 size) -+{ -+ if (NULL == pinfo) return; -+ -+ _rtw_memset(pinfo, 0, sizeof(BTCDBGINFO)); -+ -+ if (pbuf && size) { -+ pinfo->info = pbuf; -+ pinfo->size = size; -+ } -+} -+ -+void DBG_BT_INFO(u8 *dbgmsg) -+{ -+ PBTCDBGINFO pinfo; -+ u32 msglen, buflen; -+ u8 *pbuf; -+ -+ -+ pinfo = &GLBtcDbgInfo; -+ -+ if (NULL == pinfo->info) -+ return; -+ -+ msglen = strlen(dbgmsg); -+ if (pinfo->len + msglen > pinfo->size) -+ return; -+ -+ pbuf = pinfo->info + pinfo->len; -+ _rtw_memcpy(pbuf, dbgmsg, msglen); -+ pinfo->len += msglen; -+} -+ -+//==================================== -+// Debug related function -+//==================================== -+static u8 halbtcoutsrc_IsBtCoexistAvailable(PBTC_COEXIST pBtCoexist) -+{ -+ if (!pBtCoexist->bBinded || -+ NULL == pBtCoexist->Adapter) -+ { -+ return _FALSE; -+ } -+ return _TRUE; -+} -+ -+static void halbtcoutsrc_DbgInit(void) -+{ -+ u8 i; -+ -+ for (i = 0; i < COMP_MAX; i++) -+ GLBtcDbgType[i] = 0; -+} -+ -+static u8 halbtcoutsrc_IsCsrBtCoex(PBTC_COEXIST pBtCoexist) -+{ -+ if (pBtCoexist->boardInfo.btChipType == BTC_CHIP_CSR_BC4 -+ || pBtCoexist->boardInfo.btChipType == BTC_CHIP_CSR_BC8 -+ ){ -+ return _TRUE; -+ } -+ return _FALSE; -+} -+ -+static u8 halbtcoutsrc_IsHwMailboxExist(PBTC_COEXIST pBtCoexist) -+{ -+ if (pBtCoexist->boardInfo.btChipType == BTC_CHIP_CSR_BC4 -+ || pBtCoexist->boardInfo.btChipType == BTC_CHIP_CSR_BC8 -+ ){ -+ return _FALSE; -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ return _FALSE; -+ } -+ else -+ return _TRUE; -+} -+ -+static void halbtcoutsrc_LeaveLps(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter; -+ -+ -+ padapter = pBtCoexist->Adapter; -+ -+ pBtCoexist->btInfo.bBtCtrlLps = _TRUE; -+ pBtCoexist->btInfo.bBtLpsOn = _FALSE; -+ -+ rtw_btcoex_LPS_Leave(padapter); -+} -+ -+void halbtcoutsrc_EnterLps(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter; -+ -+ -+ padapter = pBtCoexist->Adapter; -+ -+ pBtCoexist->btInfo.bBtCtrlLps = _TRUE; -+ pBtCoexist->btInfo.bBtLpsOn = _TRUE; -+ -+ rtw_btcoex_LPS_Enter(padapter); -+} -+ -+void halbtcoutsrc_NormalLps(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter; -+ -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Normal LPS behavior!!!\n")); -+ -+ padapter = pBtCoexist->Adapter; -+ -+ if (pBtCoexist->btInfo.bBtCtrlLps) -+ { -+ pBtCoexist->btInfo.bBtLpsOn = _FALSE; -+ rtw_btcoex_LPS_Leave(padapter); -+ pBtCoexist->btInfo.bBtCtrlLps = _FALSE; -+ -+ // recover the LPS state to the original -+#if 0 -+ padapter->HalFunc.UpdateLPSStatusHandler( -+ padapter, -+ pPSC->RegLeisurePsMode, -+ pPSC->RegPowerSaveMode); -+#endif -+ } -+} -+ -+/* -+ * Constraint: -+ * 1. this function will request pwrctrl->lock -+ */ -+void halbtcoutsrc_LeaveLowPower(PBTC_COEXIST pBtCoexist) -+{ -+#ifdef CONFIG_LPS_LCLK -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ struct pwrctrl_priv *pwrctrl; -+ s32 ready; -+ u32 stime; -+ s32 utime; -+ u32 timeout; // unit: ms -+ -+ -+ padapter = pBtCoexist->Adapter; -+ pHalData = GET_HAL_DATA(padapter); -+ pwrctrl = adapter_to_pwrctl(padapter); -+ ready = _FAIL; -+#ifdef LPS_RPWM_WAIT_MS -+ timeout = LPS_RPWM_WAIT_MS; -+#else // !LPS_RPWM_WAIT_MS -+ timeout = 30; -+#endif // !LPS_RPWM_WAIT_MS -+ -+ if (GLBtcBtCoexAliveRegistered == _TRUE) -+ return; -+ -+ stime = rtw_get_current_time(); -+ do { -+ ready = rtw_register_task_alive(padapter, BTCOEX_ALIVE); -+ if (_SUCCESS == ready) -+ break; -+ -+ utime = rtw_get_passing_time_ms(stime); -+ if (utime > timeout) -+ break; -+ -+ rtw_msleep_os(1); -+ } while (1); -+ -+ GLBtcBtCoexAliveRegistered = _TRUE; -+#endif // CONFIG_LPS_LCLK -+} -+ -+/* -+ * Constraint: -+ * 1. this function will request pwrctrl->lock -+ */ -+void halbtcoutsrc_NormalLowPower(PBTC_COEXIST pBtCoexist) -+{ -+#ifdef CONFIG_LPS_LCLK -+ PADAPTER padapter; -+ -+ if (GLBtcBtCoexAliveRegistered == _FALSE) -+ return; -+ -+ padapter = pBtCoexist->Adapter; -+ rtw_unregister_task_alive(padapter, BTCOEX_ALIVE); -+ -+ GLBtcBtCoexAliveRegistered = _FALSE; -+#endif // CONFIG_LPS_LCLK -+} -+ -+void halbtcoutsrc_DisableLowPower(PBTC_COEXIST pBtCoexist, u8 bLowPwrDisable) -+{ -+ pBtCoexist->btInfo.bBtDisableLowPwr = bLowPwrDisable; -+ if (bLowPwrDisable) -+ halbtcoutsrc_LeaveLowPower(pBtCoexist); // leave 32k low power. -+ else -+ halbtcoutsrc_NormalLowPower(pBtCoexist); // original 32k low power behavior. -+} -+ -+void halbtcoutsrc_AggregationCheck(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter; -+ BOOLEAN bNeedToAct = _FALSE; -+ static u32 preTime = 0; -+ u32 curTime = 0; -+ -+ padapter = pBtCoexist->Adapter; -+ -+ //===================================== -+ // To void continuous deleteBA=>addBA=>deleteBA=>addBA -+ // This function is not allowed to continuous called. -+ // It can only be called after 8 seconds. -+ //===================================== -+ -+ curTime = rtw_systime_to_ms(rtw_get_current_time()); -+ if((curTime - preTime) < HALBTCOUTSRC_AGG_CHK_WINDOW_IN_MS) // over 8 seconds you can execute this function again. -+ { -+ return; -+ } -+ else -+ { -+ preTime = curTime; -+ } -+ -+ if (pBtCoexist->btInfo.bRejectAggPkt) -+ { -+ bNeedToAct = _TRUE; -+ pBtCoexist->btInfo.bPreRejectAggPkt = pBtCoexist->btInfo.bRejectAggPkt; -+ } -+ else -+ { -+ if(pBtCoexist->btInfo.bPreRejectAggPkt) -+ { -+ bNeedToAct = _TRUE; -+ pBtCoexist->btInfo.bPreRejectAggPkt = pBtCoexist->btInfo.bRejectAggPkt; -+ } -+ -+ if (pBtCoexist->btInfo.bPreBtCtrlAggBufSize != -+ pBtCoexist->btInfo.bBtCtrlAggBufSize) -+ { -+ bNeedToAct = _TRUE; -+ pBtCoexist->btInfo.bPreBtCtrlAggBufSize = pBtCoexist->btInfo.bBtCtrlAggBufSize; -+ } -+ -+ if (pBtCoexist->btInfo.bBtCtrlAggBufSize) -+ { -+ if (pBtCoexist->btInfo.preAggBufSize != -+ pBtCoexist->btInfo.aggBufSize) -+ { -+ bNeedToAct = _TRUE; -+ } -+ pBtCoexist->btInfo.preAggBufSize = pBtCoexist->btInfo.aggBufSize; -+ } -+ } -+ -+ if (bNeedToAct) -+ rtw_btcoex_rx_ampdu_apply(padapter); -+} -+ -+u8 halbtcoutsrc_IsWifiBusy(PADAPTER padapter) -+{ -+ struct mlme_priv *pmlmepriv; -+ -+ -+ pmlmepriv = &padapter->mlmepriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) -+ { -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ return _TRUE; -+ if (_TRUE == pmlmepriv->LinkDetectInfo.bBusyTraffic) -+ return _TRUE; -+ } -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+ pmlmepriv = &padapter->pbuddy_adapter->mlmepriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) -+ { -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ return _TRUE; -+ if (_TRUE == pmlmepriv->LinkDetectInfo.bBusyTraffic) -+ return _TRUE; -+ } -+#endif -+ -+ return _FALSE; -+} -+ -+static u32 _halbtcoutsrc_GetWifiLinkStatus(PADAPTER padapter) -+{ -+ struct mlme_priv *pmlmepriv; -+ u8 bp2p; -+ u32 portConnectedStatus; -+ -+ -+ pmlmepriv = &padapter->mlmepriv; -+ bp2p = _FALSE; -+ portConnectedStatus = 0; -+ -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE)) -+ bp2p = _TRUE; -+#endif // CONFIG_P2P -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) -+ { -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ { -+ if (_TRUE == bp2p) -+ portConnectedStatus |= WIFI_P2P_GO_CONNECTED; -+ else -+ portConnectedStatus |= WIFI_AP_CONNECTED; -+ } -+ else -+ { -+ if (_TRUE == bp2p) -+ portConnectedStatus |= WIFI_P2P_GC_CONNECTED; -+ else -+ portConnectedStatus |= WIFI_STA_CONNECTED; -+ } -+ } -+ -+ return portConnectedStatus; -+} -+ -+u32 halbtcoutsrc_GetWifiLinkStatus(PBTC_COEXIST pBtCoexist) -+{ -+ //================================= -+ // return value: -+ // [31:16]=> connected port number -+ // [15:0]=> port connected bit define -+ //================================ -+ -+ PADAPTER padapter; -+ u32 retVal; -+ u32 portConnectedStatus, numOfConnectedPort; -+ -+ -+ padapter = pBtCoexist->Adapter; -+ retVal = 0; -+ portConnectedStatus = 0; -+ numOfConnectedPort = 0; -+ -+ retVal = _halbtcoutsrc_GetWifiLinkStatus(padapter); -+ if (retVal) -+ { -+ portConnectedStatus |= retVal; -+ numOfConnectedPort++; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->pbuddy_adapter) -+ { -+ retVal = _halbtcoutsrc_GetWifiLinkStatus(padapter->pbuddy_adapter); -+ if (retVal) -+ { -+ portConnectedStatus |= retVal; -+ numOfConnectedPort++; -+ } -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ -+ retVal = (numOfConnectedPort << 16) | portConnectedStatus; -+ -+ return retVal; -+} -+ -+u32 halbtcoutsrc_GetBtPatchVer(PBTC_COEXIST pBtCoexist) -+{ -+ u16 btRealFwVer = 0x0; -+ u8 btFwVer = 0x0; -+ u8 cnt = 0; -+ -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ if (!pBtCoexist->btInfo.btRealFwVer && cnt<=5) -+ { -+#if 0 -+ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist)) -+ { // mailbox exists, through mailbox -+ if (NDBG_GetBtFwVersion(pBtCoexist->Adapter, &btRealFwVer, &btFwVer)) -+ { -+ pBtCoexist->btInfo.btRealFwVer = btRealFwVer; -+ pBtCoexist->btInfo.btFwVer = btFwVer; -+ } -+ else -+ { -+ pBtCoexist->btInfo.btRealFwVer = 0x0; -+ pBtCoexist->btInfo.btFwVer = 0x0; -+ } -+ } -+ else // no mailbox, query bt patch version through stack. -+#endif -+ // query bt patch version through socket. -+ { -+ u1Byte dataLen=2; -+ u1Byte buf[4] = {0}; -+ buf[0] = 0x0; // OP_Code -+ buf[1] = 0x0; // OP_Code_Length -+ BT_SendEventExtBtCoexControl(pBtCoexist->Adapter, _FALSE, dataLen, &buf[0]); -+ } -+ cnt++; -+ } -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+ return pBtCoexist->btInfo.btRealFwVer; -+} -+ -+s32 halbtcoutsrc_GetWifiRssi(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ s32 UndecoratedSmoothedPWDB = 0; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ -+ return UndecoratedSmoothedPWDB; -+} -+ -+static u8 halbtcoutsrc_GetWifiScanAPNum(PADAPTER padapter) -+{ -+ struct mlme_priv *pmlmepriv; -+ struct mlme_ext_priv *pmlmeext; -+ static u8 scan_AP_num = 0; -+ -+ -+ pmlmepriv = &padapter->mlmepriv; -+ pmlmeext = &padapter->mlmeextpriv; -+ -+ if (GLBtcWiFiInScanState == _FALSE) { -+ if (pmlmepriv->num_of_scanned > 0xFF) -+ scan_AP_num = 0xFF; -+ else -+ scan_AP_num = (u8)pmlmepriv->num_of_scanned; -+ } -+ -+ return scan_AP_num; -+} -+ -+u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ struct mlme_ext_priv *mlmeext; -+ u8 bSoftApExist, bVwifiExist; -+ u8 *pu8; -+ s32 *pS4Tmp; -+ u32 *pU4Tmp; -+ u8 *pU1Tmp; -+ u8 ret; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return _FALSE; -+ -+ padapter = pBtCoexist->Adapter; -+ pHalData = GET_HAL_DATA(padapter); -+ mlmeext = &padapter->mlmeextpriv; -+ bSoftApExist = _FALSE; -+ bVwifiExist = _FALSE; -+ pu8 = (u8*)pOutBuf; -+ pS4Tmp = (s32*)pOutBuf; -+ pU4Tmp = (u32*)pOutBuf; -+ pU1Tmp = (u8*)pOutBuf; -+ ret = _TRUE; -+ -+ switch (getType) -+ { -+ case BTC_GET_BL_HS_OPERATION: -+ *pu8 = _FALSE; -+ ret = _FALSE; -+ break; -+ -+ case BTC_GET_BL_HS_CONNECTING: -+ *pu8 = _FALSE; -+ ret = _FALSE; -+ break; -+ -+ case BTC_GET_BL_WIFI_CONNECTED: -+ *pu8 = check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE); -+#ifdef CONFIG_CONCURRENT_MODE -+ if ((_FALSE == *pu8) && padapter->pbuddy_adapter) -+ { -+ *pu8 = check_fwstate(&padapter->pbuddy_adapter->mlmepriv, WIFI_ASOC_STATE); -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ break; -+ -+ case BTC_GET_BL_WIFI_BUSY: -+ *pu8 = halbtcoutsrc_IsWifiBusy(padapter); -+ break; -+ -+ case BTC_GET_BL_WIFI_SCAN: -+#if 0 -+ *pu8 = check_fwstate(&padapter->mlmepriv, WIFI_SITE_MONITOR); -+#ifdef CONFIG_CONCURRENT_MODE -+ if ((_FALSE == *pu8) && padapter->pbuddy_adapter) -+ { -+ *pu8 = check_fwstate(&padapter->pbuddy_adapter->mlmepriv, WIFI_SITE_MONITOR); -+ } -+#endif // CONFIG_CONCURRENT_MODE -+#else -+ /* Use the value of the new variable GLBtcWiFiInScanState to judge whether WiFi is in scan state or not, since the originally used flag -+ WIFI_SITE_MONITOR in fwstate may not be cleared in time */ -+ *pu8 = GLBtcWiFiInScanState; -+#endif -+ break; -+ -+ case BTC_GET_BL_WIFI_LINK: -+ *pu8 = check_fwstate(&padapter->mlmepriv, WIFI_UNDER_LINKING); -+#ifdef CONFIG_CONCURRENT_MODE -+ if ((_FALSE == *pu8) && padapter->pbuddy_adapter) -+ { -+ *pu8 = check_fwstate(&padapter->pbuddy_adapter->mlmepriv, WIFI_UNDER_LINKING); -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ break; -+ -+ case BTC_GET_BL_WIFI_ROAM: -+ *pu8 = check_fwstate(&padapter->mlmepriv, WIFI_UNDER_LINKING); -+#ifdef CONFIG_CONCURRENT_MODE -+ if ((_FALSE == *pu8) && padapter->pbuddy_adapter) -+ { -+ *pu8 = check_fwstate(&padapter->pbuddy_adapter->mlmepriv, WIFI_UNDER_LINKING); -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ break; -+ -+ case BTC_GET_BL_WIFI_4_WAY_PROGRESS: -+ *pu8 = _FALSE; -+ break; -+ -+ case BTC_GET_BL_WIFI_UNDER_5G: -+ *pu8 = (pHalData->CurrentBandType == 1)? _TRUE : _FALSE; -+ break; -+ -+ case BTC_GET_BL_WIFI_AP_MODE_ENABLE: -+ *pu8 = check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE); -+#ifdef CONFIG_CONCURRENT_MODE -+ if ((_FALSE == *pu8) && padapter->pbuddy_adapter) -+ { -+ *pu8 = check_fwstate(&padapter->pbuddy_adapter->mlmepriv, WIFI_AP_STATE); -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ break; -+ -+ case BTC_GET_BL_WIFI_ENABLE_ENCRYPTION: -+ *pu8 = padapter->securitypriv.dot11PrivacyAlgrthm == 0? _FALSE: _TRUE; -+ break; -+ -+ case BTC_GET_BL_WIFI_UNDER_B_MODE: -+ if (mlmeext->cur_wireless_mode == WIRELESS_11B) -+ *pu8 = _TRUE; -+ else -+ *pu8 = _FALSE; -+ break; -+ -+ case BTC_GET_BL_WIFI_IS_IN_MP_MODE: -+ if (padapter->registrypriv.mp_mode == 0) -+ { -+ *pu8 = _FALSE; -+ } -+ else -+ { -+ *pu8 = _TRUE; -+ } -+ break; -+ -+ case BTC_GET_BL_EXT_SWITCH: -+ *pu8 = _FALSE; -+ break; -+ case BTC_GET_BL_IS_ASUS_8723B: -+ /* Always return FALSE in linux driver since this case is added only for windows driver */ -+ *pu8 = _FALSE; -+ break; -+ -+ case BTC_GET_S4_WIFI_RSSI: -+ *pS4Tmp = halbtcoutsrc_GetWifiRssi(padapter); -+ break; -+ -+ case BTC_GET_S4_HS_RSSI: -+ *pS4Tmp = 0; -+ ret = _FALSE; -+ break; -+ -+ case BTC_GET_U4_WIFI_BW: -+ if (IsLegacyOnly(mlmeext->cur_wireless_mode)) -+ *pU4Tmp = BTC_WIFI_BW_LEGACY; -+ else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) -+ *pU4Tmp = BTC_WIFI_BW_HT20; -+ else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) -+ *pU4Tmp = BTC_WIFI_BW_HT40; -+ else -+ *pU4Tmp = BTC_WIFI_BW_HT40; /* todo */ -+ break; -+ -+ case BTC_GET_U4_WIFI_TRAFFIC_DIRECTION: -+ { -+ PRT_LINK_DETECT_T plinkinfo; -+ plinkinfo = &padapter->mlmepriv.LinkDetectInfo; -+ -+ if (plinkinfo->NumTxOkInPeriod > plinkinfo->NumRxOkInPeriod) -+ *pU4Tmp = BTC_WIFI_TRAFFIC_TX; -+ else -+ *pU4Tmp = BTC_WIFI_TRAFFIC_RX; -+ } -+ break; -+ -+ case BTC_GET_U4_WIFI_FW_VER: -+ *pU4Tmp = pHalData->FirmwareVersion << 16; -+ *pU4Tmp |= pHalData->FirmwareSubVersion; -+ break; -+ -+ case BTC_GET_U4_WIFI_LINK_STATUS: -+ *pU4Tmp = halbtcoutsrc_GetWifiLinkStatus(pBtCoexist); -+ break; -+ -+ case BTC_GET_U4_BT_PATCH_VER: -+ *pU4Tmp = halbtcoutsrc_GetBtPatchVer(pBtCoexist); -+ break; -+ -+ case BTC_GET_U1_WIFI_DOT11_CHNL: -+ *pU1Tmp = padapter->mlmeextpriv.cur_channel; -+ break; -+ -+ case BTC_GET_U1_WIFI_CENTRAL_CHNL: -+ *pU1Tmp = pHalData->CurrentChannel; -+ break; -+ -+ case BTC_GET_U1_WIFI_HS_CHNL: -+ *pU1Tmp = 0; -+ ret = _FALSE; -+ break; -+ -+ case BTC_GET_U1_MAC_PHY_MODE: -+// *pU1Tmp = BTC_SMSP; -+// *pU1Tmp = BTC_DMSP; -+// *pU1Tmp = BTC_DMDP; -+// *pU1Tmp = BTC_MP_UNKNOWN; -+ break; -+ -+ case BTC_GET_U1_AP_NUM: -+ *pU1Tmp = halbtcoutsrc_GetWifiScanAPNum(padapter); -+ break; -+ case BTC_GET_U1_ANT_TYPE: -+ switch(pHalData->bt_coexist.btAntisolation) -+ { -+ case 0: -+ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_0; -+ pBtCoexist->boardInfo.antType = (u1Byte)BTC_ANT_TYPE_0; -+ break; -+ case 1: -+ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_1; -+ pBtCoexist->boardInfo.antType = (u1Byte)BTC_ANT_TYPE_1; -+ break; -+ case 2: -+ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_2; -+ pBtCoexist->boardInfo.antType = (u1Byte)BTC_ANT_TYPE_2; -+ break; -+ case 3: -+ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_3; -+ pBtCoexist->boardInfo.antType = (u1Byte)BTC_ANT_TYPE_3; -+ break; -+ case 4: -+ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_4; -+ pBtCoexist->boardInfo.antType = (u1Byte)BTC_ANT_TYPE_4; -+ break; -+ } -+ break; -+ case BTC_GET_U1_IOT_PEER: -+ *pU1Tmp = mlmeext->mlmext_info.assoc_AP_vendor; -+ break; -+ -+ //=======1Ant=========== -+ case BTC_GET_U1_LPS_MODE: -+ *pU1Tmp = padapter->dvobj->pwrctl_priv.pwr_mode; -+ break; -+ -+ default: -+ ret = _FALSE; -+ break; -+ } -+ -+ return ret; -+} -+ -+u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ u8 *pu8; -+ u8 *pU1Tmp; -+ u32 *pU4Tmp; -+ u8 ret; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ pHalData = GET_HAL_DATA(padapter); -+ pu8 = (u8*)pInBuf; -+ pU1Tmp = (u8*)pInBuf; -+ pU4Tmp = (u32*)pInBuf; -+ ret = _TRUE; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return _FALSE; -+ -+ switch (setType) -+ { -+ // set some u8 type variables. -+ case BTC_SET_BL_BT_DISABLE: -+ pBtCoexist->btInfo.bBtDisabled = *pu8; -+ break; -+ -+ case BTC_SET_BL_BT_TRAFFIC_BUSY: -+ pBtCoexist->btInfo.bBtBusy = *pu8; -+ break; -+ -+ case BTC_SET_BL_BT_LIMITED_DIG: -+ pBtCoexist->btInfo.bLimitedDig = *pu8; -+ break; -+ -+ case BTC_SET_BL_FORCE_TO_ROAM: -+ pBtCoexist->btInfo.bForceToRoam = *pu8; -+ break; -+ -+ case BTC_SET_BL_TO_REJ_AP_AGG_PKT: -+ pBtCoexist->btInfo.bRejectAggPkt = *pu8; -+ break; -+ -+ case BTC_SET_BL_BT_CTRL_AGG_SIZE: -+ pBtCoexist->btInfo.bBtCtrlAggBufSize = *pu8; -+ break; -+ -+ case BTC_SET_BL_INC_SCAN_DEV_NUM: -+ pBtCoexist->btInfo.bIncreaseScanDevNum = *pu8; -+ break; -+ -+ case BTC_SET_BL_BT_TX_RX_MASK: -+ pBtCoexist->btInfo.bBtTxRxMask = *pu8; -+ break; -+ -+ case BTC_SET_BL_MIRACAST_PLUS_BT: -+ pBtCoexist->btInfo.bMiracastPlusBt = *pu8; -+ break; -+ -+ // set some u8 type variables. -+ case BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON: -+ pBtCoexist->btInfo.rssiAdjustForAgcTableOn = *pU1Tmp; -+ break; -+ -+ case BTC_SET_U1_AGG_BUF_SIZE: -+ pBtCoexist->btInfo.aggBufSize = *pU1Tmp; -+ break; -+ -+ // the following are some action which will be triggered -+ case BTC_SET_ACT_GET_BT_RSSI: -+#if 0 -+ BT_SendGetBtRssiEvent(padapter); -+#else -+ ret = _FALSE; -+#endif -+ break; -+ -+ case BTC_SET_ACT_AGGREGATE_CTRL: -+ halbtcoutsrc_AggregationCheck(pBtCoexist); -+ break; -+ -+ //=======1Ant=========== -+ // set some u8 type variables. -+ case BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE: -+ pBtCoexist->btInfo.rssiAdjustFor1AntCoexType = *pU1Tmp; -+ break; -+ -+ case BTC_SET_U1_LPS_VAL: -+ pBtCoexist->btInfo.lpsVal = *pU1Tmp; -+ break; -+ -+ case BTC_SET_U1_RPWM_VAL: -+ pBtCoexist->btInfo.rpwmVal = *pU1Tmp; -+ break; -+ -+ // the following are some action which will be triggered -+ case BTC_SET_ACT_LEAVE_LPS: -+ halbtcoutsrc_LeaveLps(pBtCoexist); -+ break; -+ -+ case BTC_SET_ACT_ENTER_LPS: -+ halbtcoutsrc_EnterLps(pBtCoexist); -+ break; -+ -+ case BTC_SET_ACT_NORMAL_LPS: -+ halbtcoutsrc_NormalLps(pBtCoexist); -+ break; -+ -+ case BTC_SET_ACT_DISABLE_LOW_POWER: -+ halbtcoutsrc_DisableLowPower(pBtCoexist, *pu8); -+ break; -+ -+ case BTC_SET_ACT_UPDATE_RAMASK: -+ pBtCoexist->btInfo.raMask = *pU4Tmp; -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) == _TRUE) -+ { -+ struct sta_info *psta; -+ PWLAN_BSSID_EX cur_network; -+ -+ cur_network = &padapter->mlmeextpriv.mlmext_info.network; -+ psta = rtw_get_stainfo(&padapter->stapriv, cur_network->MacAddress); -+ rtw_hal_update_ra_mask(psta, 0); -+ } -+ break; -+ -+ case BTC_SET_ACT_SEND_MIMO_PS: -+ { -+ u8 newMimoPsMode = 3; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* *pU1Tmp = 0 use SM_PS static type */ -+ /* *pU1Tmp = 1 disable SM_PS */ -+ if (*pU1Tmp == 0) -+ newMimoPsMode = WLAN_HT_CAP_SM_PS_STATIC; -+ else if (*pU1Tmp == 1) -+ newMimoPsMode = WLAN_HT_CAP_SM_PS_DISABLED; -+ -+ if (check_fwstate(&padapter->mlmepriv , WIFI_ASOC_STATE) == _TRUE) { -+ /* issue_action_SM_PS(padapter, get_my_bssid(&(pmlmeinfo->network)), newMimoPsMode); */ -+ issue_action_SM_PS_wait_ack(padapter , get_my_bssid(&(pmlmeinfo->network)) , newMimoPsMode, 3 , 1); -+ } -+ } -+ break; -+ -+ case BTC_SET_ACT_CTRL_BT_INFO: -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ { -+ u8 dataLen = *pU1Tmp; -+ u8 tmpBuf[20]; -+ if (dataLen) -+ { -+ _rtw_memcpy(tmpBuf, pU1Tmp+1, dataLen); -+ } -+ BT_SendEventExtBtInfoControl(padapter, dataLen, &tmpBuf[0]); -+ } -+#else //!CONFIG_BT_COEXIST_SOCKET_TRX -+ ret = _FALSE; -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+ break; -+ -+ case BTC_SET_ACT_CTRL_BT_COEX: -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ { -+ u8 dataLen = *pU1Tmp; -+ u8 tmpBuf[20]; -+ if (dataLen) -+ { -+ _rtw_memcpy(tmpBuf, pU1Tmp+1, dataLen); -+ } -+ BT_SendEventExtBtCoexControl(padapter, _FALSE, dataLen, &tmpBuf[0]); -+ } -+#else //!CONFIG_BT_COEXIST_SOCKET_TRX -+ ret = _FALSE; -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+ break; -+ case BTC_SET_ACT_CTRL_8723B_ANT: -+#if 0 -+ { -+ u1Byte dataLen=*pU1Tmp; -+ u1Byte tmpBuf[20]; -+ if(dataLen) -+ { -+ PlatformMoveMemory(&tmpBuf[0], pU1Tmp+1, dataLen); -+ } -+ BT_Set8723bAnt(Adapter, dataLen, &tmpBuf[0]); -+ } -+#else -+ ret = _FALSE; -+#endif -+ break; -+ //===================== -+ default: -+ ret = _FALSE; -+ break; -+ } -+ -+ return ret; -+} -+ -+u8 halbtcoutsrc_UnderIps(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter; -+ struct pwrctrl_priv *pwrpriv; -+ u8 bMacPwrCtrlOn; -+ -+ padapter = pBtCoexist->Adapter; -+ pwrpriv = &padapter->dvobj->pwrctl_priv; -+ bMacPwrCtrlOn = _FALSE; -+ -+ if ((_TRUE == pwrpriv->bips_processing) -+ && (IPS_NONE != pwrpriv->ips_mode_req) -+ ) -+ { -+ return _TRUE; -+ } -+ -+ if (rf_off == pwrpriv->rf_pwrstate) -+ { -+ return _TRUE; -+ } -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if (_FALSE == bMacPwrCtrlOn) -+ { -+ return _TRUE; -+ } -+ -+ return _FALSE; -+} -+ -+u8 halbtcoutsrc_UnderLps(PBTC_COEXIST pBtCoexist) -+{ -+ return GLBtcWiFiInLPS; -+} -+ -+u8 halbtcoutsrc_Under32K(PBTC_COEXIST pBtCoexist) -+{ -+ /* todo: the method to check whether wifi is under 32K or not */ -+ return _FALSE; -+} -+ -+void halbtcoutsrc_DisplayCoexStatistics(PBTC_COEXIST pBtCoexist) -+{ -+#if 0 -+ PADAPTER padapter = (PADAPTER)pBtCoexist->Adapter; -+ PBT_MGNT pBtMgnt = &padapter->MgntInfo.BtInfo.BtMgnt; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ u8 *cliBuf = pBtCoexist->cliBuf; -+ u8 i; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Statistics]============"); -+ CL_PRINTF(cliBuf); -+ -+#if (H2C_USE_IO_THREAD != 1) -+ for(i=0; ih2cStatistics[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s] = %d", "H2C statistics", \ -+ h2cStaString[i], pHalData->h2cStatistics[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+#else -+ for(i=0; iioComStr.ioH2cStatistics[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s] = %d", "H2C statistics", \ -+ ioStaString[i], Adapter->ioComStr.ioH2cStatistics[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+#endif -+#if 0 -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "lastHMEBoxNum", \ -+ pHalData->LastHMEBoxNum); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x / 0x%x", "LastOkH2c/FirstFailH2c(fwNotRead)", \ -+ pHalData->lastSuccessH2cEid, pHalData->firstFailedH2cEid); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", "c2hIsr/c2hIntr/clr1AF/noRdy/noBuf", \ -+ pHalData->InterruptLog.nIMR_C2HCMD, DBG_Var.c2hInterruptCnt, DBG_Var.c2hClrReadC2hCnt, -+ DBG_Var.c2hNotReadyCnt, DBG_Var.c2hBufAlloFailCnt); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "c2hPacket", \ -+ DBG_Var.c2hPacketCnt); -+ CL_PRINTF(cliBuf); -+#endif -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "Periodical/ DbgCtrl", \ -+ pBtCoexist->statistics.cntPeriodical, pBtCoexist->statistics.cntDbgCtrl); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "PowerOn/InitHw/InitCoexDm/RfStatus", \ -+ pBtCoexist->statistics.cntPowerOn, pBtCoexist->statistics.cntInitHwConfig, pBtCoexist->statistics.cntInitCoexDm, -+ pBtCoexist->statistics.cntRfStatusNotify); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", "Ips/Lps/Scan/Connect/Mstatus", \ -+ pBtCoexist->statistics.cntIpsNotify, pBtCoexist->statistics.cntLpsNotify, -+ pBtCoexist->statistics.cntScanNotify, pBtCoexist->statistics.cntConnectNotify, -+ pBtCoexist->statistics.cntMediaStatusNotify); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "Special pkt/Bt info/ bind", -+ pBtCoexist->statistics.cntSpecialPacketNotify, pBtCoexist->statistics.cntBtInfoNotify, -+ pBtCoexist->statistics.cntBind); -+ CL_PRINTF(cliBuf); -+#endif -+} -+ -+void halbtcoutsrc_DisplayBtLinkInfo(PBTC_COEXIST pBtCoexist) -+{ -+#if 0 -+ PADAPTER padapter = (PADAPTER)pBtCoexist->Adapter; -+ PBT_MGNT pBtMgnt = &padapter->MgntInfo.BtInfo.BtMgnt; -+ u8 *cliBuf = pBtCoexist->cliBuf; -+ u8 i; -+ -+ -+ if (pBtCoexist->stackInfo.bProfileNotified) -+ { -+ for (i=0; iExtConfig.NumberOfACL; i++) -+ { -+ if (pBtMgnt->ExtConfig.HCIExtensionVer >= 1) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", "Bt link type/spec/role", \ -+ BtProfileString[pBtMgnt->ExtConfig.aclLink[i].BTProfile], -+ BtSpecString[pBtMgnt->ExtConfig.aclLink[i].BTCoreSpec], -+ BtLinkRoleString[pBtMgnt->ExtConfig.aclLink[i].linkRole]); -+ CL_PRINTF(cliBuf); } -+ else -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", "Bt link type/spec", \ -+ BtProfileString[pBtMgnt->ExtConfig.aclLink[i].BTProfile], -+ BtSpecString[pBtMgnt->ExtConfig.aclLink[i].BTCoreSpec]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ } -+#endif -+} -+ -+void halbtcoutsrc_DisplayWifiStatus(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter = pBtCoexist->Adapter; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8* cliBuf=pBtCoexist->cliBuf; -+ s32 wifiRssi=0, btHsRssi=0; -+ BOOLEAN bScan=_FALSE, bLink=_FALSE, bRoam=_FALSE, bWifiBusy=_FALSE, bWifiUnderBMode=_FALSE; -+ u32 wifiBw=BTC_WIFI_BW_HT20, wifiTrafficDir=BTC_WIFI_TRAFFIC_TX, wifiFreq=BTC_FREQ_2_4G; -+ u32 wifiLinkStatus=0x0; -+ BOOLEAN bBtHsOn=_FALSE, bLowPower=_FALSE; -+ u8 wifiChnl=0, wifiHsChnl=0, nScanAPNum = 0, FwPSState; -+ -+ wifiLinkStatus = halbtcoutsrc_GetWifiLinkStatus(pBtCoexist); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", "STA/vWifi/HS/p2pGo/p2pGc", \ -+ ((wifiLinkStatus&WIFI_STA_CONNECTED)? 1:0), ((wifiLinkStatus&WIFI_AP_CONNECTED)? 1:0), -+ ((wifiLinkStatus&WIFI_HS_CONNECTED)? 1:0), ((wifiLinkStatus&WIFI_P2P_GO_CONNECTED)? 1:0), -+ ((wifiLinkStatus&WIFI_P2P_GC_CONNECTED)? 1:0) ); -+ CL_PRINTF(cliBuf); -+ -+ if (wifiLinkStatus&WIFI_STA_CONNECTED) { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "IOT Peer", GLBtcIotPeerString[padapter->mlmeextpriv.mlmext_info.assoc_AP_vendor]); -+ CL_PRINTF(cliBuf); -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_DOT11_CHNL, &wifiChnl); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_HS_CHNL, &wifiHsChnl); CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d(%d)", "Dot11 channel / HsChnl(High Speed)", \ -+ wifiChnl, wifiHsChnl, bBtHsOn); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_HS_RSSI, &btHsRssi); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "Wifi rssi/ HS rssi", \ -+ wifiRssi-100, btHsRssi-100); -+ CL_PRINTF(cliBuf); -+ -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", "Wifi bLink/ bRoam/ bScan", \ -+ bLink, bRoam, bScan); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifiFreq); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &nScanAPNum); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s/ %s/ AP=%d ", "Wifi freq/ bw/ traffic", \ -+ GLBtcWifiFreqString[wifiFreq], ((bWifiUnderBMode)? "11b": GLBtcWifiBwString[wifiBw]), -+ ((!bWifiBusy)? "idle": ((BTC_WIFI_TRAFFIC_TX==wifiTrafficDir)? "uplink":"downlink")), -+ nScanAPNum); -+ CL_PRINTF(cliBuf); -+ -+ // power status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s%s%s", "Power Status", \ -+ ((halbtcoutsrc_UnderIps(pBtCoexist) == _TRUE)? "IPS ON":"IPS OFF"), -+ ((halbtcoutsrc_UnderLps(pBtCoexist) == _TRUE)? ", LPS ON":", LPS OFF"), -+ ((halbtcoutsrc_Under32K(pBtCoexist) == _TRUE)? ", 32k":"")); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x (0x%x/0x%x)", "Power mode cmd(lps/rpwm)", \ -+ pBtCoexist->pwrModeVal[0], pBtCoexist->pwrModeVal[1], -+ pBtCoexist->pwrModeVal[2], pBtCoexist->pwrModeVal[3], -+ pBtCoexist->pwrModeVal[4], pBtCoexist->pwrModeVal[5], -+ pBtCoexist->btInfo.lpsVal, -+ pBtCoexist->btInfo.rpwmVal); -+ CL_PRINTF(cliBuf); -+} -+ -+void halbtcoutsrc_DisplayDbgMsg(void *pBtcContext, u8 dispType) -+{ -+ PBTC_COEXIST pBtCoexist; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ switch(dispType) -+ { -+ case BTC_DBG_DISP_COEX_STATISTICS: -+ halbtcoutsrc_DisplayCoexStatistics(pBtCoexist); -+ break; -+ case BTC_DBG_DISP_BT_LINK_INFO: -+ halbtcoutsrc_DisplayBtLinkInfo(pBtCoexist); -+ break; -+ case BTC_DBG_DISP_WIFI_STATUS: -+ halbtcoutsrc_DisplayWifiStatus(pBtCoexist); -+ break; -+ default: -+ break; -+ } -+} -+ -+//==================================== -+// IO related function -+//==================================== -+u8 halbtcoutsrc_Read1Byte(void *pBtcContext, u32 RegAddr) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return rtw_read8(padapter, RegAddr); -+} -+ -+u16 halbtcoutsrc_Read2Byte(void *pBtcContext, u32 RegAddr) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return rtw_read16(padapter, RegAddr); -+} -+ -+u32 halbtcoutsrc_Read4Byte(void *pBtcContext, u32 RegAddr) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return rtw_read32(padapter, RegAddr); -+} -+ -+void halbtcoutsrc_Write1Byte(void *pBtcContext, u32 RegAddr, u8 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ rtw_write8(padapter, RegAddr, Data); -+} -+ -+void halbtcoutsrc_BitMaskWrite1Byte(void *pBtcContext, u32 regAddr, u8 bitMask, u8 data1b) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ u8 originalValue, bitShift; -+ u8 i; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ originalValue = 0; -+ bitShift = 0; -+ -+ if(bitMask != 0xff) -+ { -+ originalValue = rtw_read8(padapter, regAddr); -+ -+ for (i=0; i<=7; i++) -+ { -+ if ((bitMask>>i)&0x1) -+ break; -+ } -+ bitShift = i; -+ -+ data1b = (originalValue & ~bitMask) | ((data1b << bitShift) & bitMask); -+ } -+ -+ rtw_write8(padapter, regAddr, data1b); -+} -+ -+void halbtcoutsrc_Write2Byte(void *pBtcContext, u32 RegAddr, u16 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ rtw_write16(padapter, RegAddr, Data); -+} -+ -+void halbtcoutsrc_Write4Byte(void *pBtcContext, u32 RegAddr, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ rtw_write32(padapter, RegAddr, Data); -+} -+ -+void halbtcoutsrc_WriteLocalReg1Byte(void *pBtcContext, u32 RegAddr, u8 Data) -+{ -+ PBTC_COEXIST pBtCoexist=(PBTC_COEXIST)pBtcContext; -+ PADAPTER Adapter=pBtCoexist->Adapter; -+ -+ if(BTC_INTF_SDIO == pBtCoexist->chipInterface) -+ { -+ rtw_write8(Adapter, SDIO_LOCAL_BASE | RegAddr, Data); -+ } -+ else -+ { -+ rtw_write8(Adapter, RegAddr, Data); -+ } -+} -+ -+void halbtcoutsrc_SetBbReg(void *pBtcContext, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ PHY_SetBBReg(padapter, RegAddr, BitMask, Data); -+} -+ -+ -+u32 halbtcoutsrc_GetBbReg(void *pBtcContext, u32 RegAddr, u32 BitMask) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return PHY_QueryBBReg(padapter, RegAddr, BitMask); -+} -+ -+void halbtcoutsrc_SetRfReg(void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ PHY_SetRFReg(padapter, eRFPath, RegAddr, BitMask, Data); -+} -+ -+u32 halbtcoutsrc_GetRfReg(void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMask) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return PHY_QueryRFReg(padapter, eRFPath, RegAddr, BitMask); -+} -+ -+void halbtcoutsrc_SetBtReg(void *pBtcContext, u8 RegType, u32 RegAddr, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ u8 CmdBuffer1[4] = {0}; -+ u8 CmdBuffer2[4] = {0}; -+ u8* AddrToSet = (u8*)&RegAddr; -+ u8* ValueToSet = (u8*)&Data; -+ u8 OperVer = 0; -+ u8 ReqNum = 0; -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ if (IS_HARDWARE_TYPE_8723B(padapter)) -+ { -+ CmdBuffer1[0] |= (OperVer & 0x0f); /* Set OperVer */ -+ CmdBuffer1[0] |= ((ReqNum << 4) & 0xf0); /* Set ReqNum */ -+ CmdBuffer1[1] = 0x0d; /* Set OpCode to BT_LO_OP_WRITE_REG_VALUE */ -+ CmdBuffer1[2] = ValueToSet[0]; /* Set WriteRegValue */ -+ rtw_hal_fill_h2c_cmd(padapter, 0x67, 4, &(CmdBuffer1[0])); -+ -+ rtw_msleep_os(200); -+ ReqNum++; -+ -+ CmdBuffer2[0] |= (OperVer & 0x0f); /* Set OperVer */ -+ CmdBuffer2[0] |= ((ReqNum << 4) & 0xf0); /* Set ReqNum */ -+ CmdBuffer2[1] = 0x0c; /* Set OpCode of BT_LO_OP_WRITE_REG_ADDR */ -+ CmdBuffer2[3] = AddrToSet[0]; /* Set WriteRegAddr */ -+ rtw_hal_fill_h2c_cmd(padapter, 0x67, 4, &(CmdBuffer2[0])); -+ } -+} -+ -+u8 halbtcoutsrc_SetBtAntDetection(void *pBtcContext, u8 txTime, u8 btChnl) -+{ -+/* Always return _FALSE since we don't implement this yet */ -+#if 0 -+ PBTC_COEXIST pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ PADAPTER Adapter = pBtCoexist->Adapter; -+ u1Byte btCanTx = 0; -+ BOOLEAN bStatus = FALSE; -+ -+ bStatus = NDBG_SetBtAntDetection(Adapter, txTime, btChnl, &btCanTx); -+ if (bStatus && btCanTx) -+ return _TRUE; -+ else -+ return _FALSE; -+#else -+ return _FALSE; -+#endif -+} -+ -+u32 halbtcoutsrc_GetBtReg(void *pBtcContext, u8 RegType, u32 RegAddr) -+{ -+ /* To be implemented. Always return 0 temporarily */ -+ return 0; -+} -+ -+void halbtcoutsrc_FillH2cCmd(void *pBtcContext, u8 elementId, u32 cmdLen, u8 *pCmdBuffer) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ rtw_hal_fill_h2c_cmd(padapter, elementId, cmdLen, pCmdBuffer); -+} -+ -+//==================================== -+// Extern functions called by other module -+//==================================== -+u8 EXhalbtcoutsrc_IsTfbgaPackageType(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+#ifdef CONFIG_RTL8723B -+ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA80) -+ || (pHalData->PackageType == PACKAGE_TFBGA90)) { -+ return _TRUE; -+ } -+#endif -+ -+ return _FALSE; -+} -+ -+u8 EXhalbtcoutsrc_BindBtCoexWithAdapter(void *padapter) -+{ -+ PBTC_COEXIST pBtCoexist=&GLBtCoexist; -+ u1Byte antNum=2, chipType; -+ -+ if(pBtCoexist->bBinded) -+ return _FALSE; -+ else -+ pBtCoexist->bBinded = _TRUE; -+ -+ pBtCoexist->statistics.cntBind++; -+ -+ pBtCoexist->Adapter = padapter; -+ -+ pBtCoexist->stackInfo.bProfileNotified = _FALSE; -+ -+ pBtCoexist->btInfo.bBtCtrlAggBufSize = _FALSE; -+ pBtCoexist->btInfo.aggBufSize = 5; -+ -+ pBtCoexist->btInfo.bIncreaseScanDevNum = _FALSE; -+ pBtCoexist->btInfo.bMiracastPlusBt = _FALSE; -+ -+#if 0 -+ chipType = HALBT_GetBtChipType(Adapter); -+ EXhalbtcoutsrc_SetChipType(chipType); -+ antNum = HALBT_GetPgAntNum(Adapter); -+ EXhalbtcoutsrc_SetAntNum(BT_COEX_ANT_TYPE_PG, antNum); -+#endif -+ // set default antenna position to main port -+ pBtCoexist->boardInfo.btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+ -+ pBtCoexist->boardInfo.btdmAntDetFinish = _FALSE; -+ pBtCoexist->boardInfo.btdmAntNumByAntDet = 1; -+ -+ pBtCoexist->boardInfo.bTfbgaPackage = EXhalbtcoutsrc_IsTfbgaPackageType((PADAPTER)padapter); -+ -+ if (pBtCoexist->boardInfo.bTfbgaPackage) -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Package Type = TFBGA\n")); -+ else -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Package Type = Non-TFBGA\n")); -+ -+ return _TRUE; -+} -+ -+u8 EXhalbtcoutsrc_InitlizeVariables(void *padapter) -+{ -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ -+ //pBtCoexist->statistics.cntBind++; -+ -+ halbtcoutsrc_DbgInit(); -+ -+#ifdef CONFIG_PCI_HCI -+ pBtCoexist->chipInterface = BTC_INTF_PCI; -+#elif defined(CONFIG_USB_HCI) -+ pBtCoexist->chipInterface = BTC_INTF_USB; -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pBtCoexist->chipInterface = BTC_INTF_SDIO; -+#else -+ pBtCoexist->chipInterface = BTC_INTF_UNKNOWN; -+#endif -+ -+ EXhalbtcoutsrc_BindBtCoexWithAdapter(padapter); -+ -+ pBtCoexist->fBtcRead1Byte = halbtcoutsrc_Read1Byte; -+ pBtCoexist->fBtcWrite1Byte = halbtcoutsrc_Write1Byte; -+ pBtCoexist->fBtcWrite1ByteBitMask = halbtcoutsrc_BitMaskWrite1Byte; -+ pBtCoexist->fBtcRead2Byte = halbtcoutsrc_Read2Byte; -+ pBtCoexist->fBtcWrite2Byte = halbtcoutsrc_Write2Byte; -+ pBtCoexist->fBtcRead4Byte = halbtcoutsrc_Read4Byte; -+ pBtCoexist->fBtcWrite4Byte = halbtcoutsrc_Write4Byte; -+ pBtCoexist->fBtcWriteLocalReg1Byte = halbtcoutsrc_WriteLocalReg1Byte; -+ -+ pBtCoexist->fBtcSetBbReg = halbtcoutsrc_SetBbReg; -+ pBtCoexist->fBtcGetBbReg = halbtcoutsrc_GetBbReg; -+ -+ pBtCoexist->fBtcSetRfReg = halbtcoutsrc_SetRfReg; -+ pBtCoexist->fBtcGetRfReg = halbtcoutsrc_GetRfReg; -+ -+ pBtCoexist->fBtcFillH2c = halbtcoutsrc_FillH2cCmd; -+ pBtCoexist->fBtcDispDbgMsg = halbtcoutsrc_DisplayDbgMsg; -+ -+ pBtCoexist->fBtcGet = halbtcoutsrc_Get; -+ pBtCoexist->fBtcSet = halbtcoutsrc_Set; -+ pBtCoexist->fBtcGetBtReg = halbtcoutsrc_GetBtReg; -+ pBtCoexist->fBtcSetBtReg = halbtcoutsrc_SetBtReg; -+ pBtCoexist->fBtcSetBtAntDetection = halbtcoutsrc_SetBtAntDetection; -+ -+ pBtCoexist->cliBuf = &GLBtcDbgBuf[0]; -+ -+ pBtCoexist->boardInfo.singleAntPath = 0; -+ -+ GLBtcWiFiInScanState = _FALSE; -+ -+ GLBtcWiFiInIQKState = _FALSE; -+ -+ GLBtcWiFiInIPS = _FALSE; -+ -+ GLBtcWiFiInLPS = _FALSE; -+ -+ GLBtcBtCoexAliveRegistered = _FALSE; -+ -+ return _TRUE; -+} -+ -+void EXhalbtcoutsrc_PowerOnSetting(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ /* Power on setting function is only added in 8723B currently */ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_PowerOnSetting(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_PowerOnSetting(pBtCoexist); -+ } -+} -+ -+void EXhalbtcoutsrc_PreLoadFirmware(PBTC_COEXIST pBtCoexist) -+{ -+ if(!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntPreLoadFirmware++; -+ -+ if(IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if(pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_PreLoadFirmware(pBtCoexist); -+ else if(pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_PreLoadFirmware(pBtCoexist); -+ } -+} -+ -+void EXhalbtcoutsrc_InitHwConfig(PBTC_COEXIST pBtCoexist, u8 bWifiOnly) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntInitHwConfig++; -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ EXhalbtc8821aCsr2ant_InitHwConfig(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8821a2ant_InitHwConfig(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8821a1ant_InitHwConfig(pBtCoexist, bWifiOnly); -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_InitHwConfig(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_InitHwConfig(pBtCoexist, bWifiOnly); -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8703b2ant_InitHwConfig(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_InitHwConfig(pBtCoexist, bWifiOnly); -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8192e2ant_InitHwConfig(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_InitHwConfig(pBtCoexist, bWifiOnly); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_InitHwConfig(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_InitHwConfig(pBtCoexist, bWifiOnly); -+ } -+} -+ -+void EXhalbtcoutsrc_InitCoexDm(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntInitCoexDm++; -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ EXhalbtc8821aCsr2ant_InitCoexDm(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8821a2ant_InitCoexDm(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8821a1ant_InitCoexDm(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_InitCoexDm(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_InitCoexDm(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8703b2ant_InitCoexDm(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_InitCoexDm(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8192e2ant_InitCoexDm(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_InitCoexDm(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_InitCoexDm(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_InitCoexDm(pBtCoexist); -+ } -+ -+ pBtCoexist->bInitilized = _TRUE; -+} -+ -+void EXhalbtcoutsrc_IpsNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ u8 ipsType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntIpsNotify++; -+ if (pBtCoexist->bManualControl) -+ return; -+ -+ if (IPS_NONE == type) -+ { -+ ipsType = BTC_IPS_LEAVE; -+ GLBtcWiFiInIPS = _FALSE; -+ } -+ else -+ { -+ ipsType = BTC_IPS_ENTER; -+ GLBtcWiFiInIPS = _TRUE; -+ } -+ -+ // All notify is called in cmd thread, don't need to leave low power again -+// halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ EXhalbtc8821aCsr2ant_IpsNotify(pBtCoexist, ipsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8821a2ant_IpsNotify(pBtCoexist, ipsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8821a1ant_IpsNotify(pBtCoexist, ipsType); -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_IpsNotify(pBtCoexist, ipsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_IpsNotify(pBtCoexist, ipsType); -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8703b2ant_IpsNotify(pBtCoexist, ipsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_IpsNotify(pBtCoexist, ipsType); -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8192e2ant_IpsNotify(pBtCoexist, ipsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_IpsNotify(pBtCoexist, ipsType); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_IpsNotify(pBtCoexist, ipsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_IpsNotify(pBtCoexist, ipsType); -+ } -+ -+// halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+void EXhalbtcoutsrc_LpsNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ u8 lpsType; -+ -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntLpsNotify++; -+ if (pBtCoexist->bManualControl) -+ return; -+ -+ if (PS_MODE_ACTIVE == type) -+ { -+ lpsType = BTC_LPS_DISABLE; -+ GLBtcWiFiInLPS = _FALSE; -+ } -+ else -+ { -+ lpsType = BTC_LPS_ENABLE; -+ GLBtcWiFiInLPS = _TRUE; -+ } -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ EXhalbtc8821aCsr2ant_LpsNotify(pBtCoexist, lpsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8821a2ant_LpsNotify(pBtCoexist, lpsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8821a1ant_LpsNotify(pBtCoexist, lpsType); -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_LpsNotify(pBtCoexist, lpsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_LpsNotify(pBtCoexist, lpsType); -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8703b2ant_LpsNotify(pBtCoexist, lpsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_LpsNotify(pBtCoexist, lpsType); -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8192e2ant_LpsNotify(pBtCoexist, lpsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_LpsNotify(pBtCoexist, lpsType); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_LpsNotify(pBtCoexist, lpsType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_LpsNotify(pBtCoexist, lpsType); -+ } -+} -+ -+void EXhalbtcoutsrc_ScanNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ u8 scanType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cntScanNotify++; -+ if (pBtCoexist->bManualControl) -+ return; -+ -+ if (type) -+ { -+ scanType = BTC_SCAN_START; -+ GLBtcWiFiInScanState = _TRUE; -+ } -+ else -+ { -+ scanType = BTC_SCAN_FINISH; -+ GLBtcWiFiInScanState = _FALSE; -+ } -+ -+ // All notify is called in cmd thread, don't need to leave low power again -+// halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ EXhalbtc8821aCsr2ant_ScanNotify(pBtCoexist, scanType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8821a2ant_ScanNotify(pBtCoexist, scanType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8821a1ant_ScanNotify(pBtCoexist, scanType); -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_ScanNotify(pBtCoexist, scanType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_ScanNotify(pBtCoexist, scanType); -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8703b2ant_ScanNotify(pBtCoexist, scanType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_ScanNotify(pBtCoexist, scanType); -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8192e2ant_ScanNotify(pBtCoexist, scanType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_ScanNotify(pBtCoexist, scanType); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_ScanNotify(pBtCoexist, scanType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_ScanNotify(pBtCoexist, scanType); -+ } -+ -+// halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+void EXhalbtcoutsrc_ConnectNotify(PBTC_COEXIST pBtCoexist, u8 action) -+{ -+ u8 assoType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cntConnectNotify++; -+ if (pBtCoexist->bManualControl) -+ return; -+ -+ if (action) -+ assoType = BTC_ASSOCIATE_START; -+ else -+ assoType = BTC_ASSOCIATE_FINISH; -+ -+ // All notify is called in cmd thread, don't need to leave low power again -+// halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ EXhalbtc8821aCsr2ant_ConnectNotify(pBtCoexist, assoType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8821a2ant_ConnectNotify(pBtCoexist, assoType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8821a1ant_ConnectNotify(pBtCoexist, assoType); -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_ConnectNotify(pBtCoexist, assoType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_ConnectNotify(pBtCoexist, assoType); -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8703b2ant_ConnectNotify(pBtCoexist, assoType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_ConnectNotify(pBtCoexist, assoType); -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8192e2ant_ConnectNotify(pBtCoexist, assoType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_ConnectNotify(pBtCoexist, assoType); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_ConnectNotify(pBtCoexist, assoType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_ConnectNotify(pBtCoexist, assoType); -+ } -+ -+// halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+void EXhalbtcoutsrc_MediaStatusNotify(PBTC_COEXIST pBtCoexist, RT_MEDIA_STATUS mediaStatus) -+{ -+ u8 mStatus; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntMediaStatusNotify++; -+ if (pBtCoexist->bManualControl) -+ return; -+ -+ if (RT_MEDIA_CONNECT == mediaStatus) -+ mStatus = BTC_MEDIA_CONNECT; -+ else -+ mStatus = BTC_MEDIA_DISCONNECT; -+ -+ // All notify is called in cmd thread, don't need to leave low power again -+// halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ EXhalbtc8821aCsr2ant_MediaStatusNotify(pBtCoexist, mStatus); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8821a2ant_MediaStatusNotify(pBtCoexist, mStatus); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8821a1ant_MediaStatusNotify(pBtCoexist, mStatus); -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_MediaStatusNotify(pBtCoexist, mStatus); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, mStatus); -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8703b2ant_MediaStatusNotify(pBtCoexist, mStatus); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_MediaStatusNotify(pBtCoexist, mStatus); -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8192e2ant_MediaStatusNotify(pBtCoexist, mStatus); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_MediaStatusNotify(pBtCoexist, mStatus); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_MediaStatusNotify(pBtCoexist, mStatus); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_MediaStatusNotify(pBtCoexist, mStatus); -+ } -+ -+// halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+void EXhalbtcoutsrc_SpecialPacketNotify(PBTC_COEXIST pBtCoexist, u8 pktType) -+{ -+ u8 packetType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cntSpecialPacketNotify++; -+ if (pBtCoexist->bManualControl) -+ return; -+ -+ if (PACKET_DHCP == pktType) -+ packetType = BTC_PACKET_DHCP; -+ else if (PACKET_EAPOL == pktType) -+ packetType = BTC_PACKET_EAPOL; -+ else if (PACKET_ARP == pktType) -+ packetType = BTC_PACKET_ARP; -+ else -+ { -+ packetType = BTC_PACKET_UNKNOWN; -+ return; -+ } -+ -+ // All notify is called in cmd thread, don't need to leave low power again -+// halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ EXhalbtc8821aCsr2ant_SpecialPacketNotify(pBtCoexist, packetType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8821a2ant_SpecialPacketNotify(pBtCoexist, packetType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8821a1ant_SpecialPacketNotify(pBtCoexist, packetType); -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_SpecialPacketNotify(pBtCoexist, packetType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_SpecialPacketNotify(pBtCoexist, packetType); -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8703b2ant_SpecialPacketNotify(pBtCoexist, packetType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_SpecialPacketNotify(pBtCoexist, packetType); -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8192e2ant_SpecialPacketNotify(pBtCoexist, packetType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_SpecialPacketNotify(pBtCoexist, packetType); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_SpecialPacketNotify(pBtCoexist, packetType); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_SpecialPacketNotify(pBtCoexist, packetType); -+ } -+ -+// halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+void EXhalbtcoutsrc_BtInfoNotify(PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 length) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntBtInfoNotify++; -+ -+ // All notify is called in cmd thread, don't need to leave low power again -+// halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ EXhalbtc8821aCsr2ant_BtInfoNotify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8821a2ant_BtInfoNotify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8821a1ant_BtInfoNotify(pBtCoexist, tmpBuf, length); -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_BtInfoNotify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_BtInfoNotify(pBtCoexist, tmpBuf, length); -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8703b2ant_BtInfoNotify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_BtInfoNotify(pBtCoexist, tmpBuf, length); -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8192e2ant_BtInfoNotify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_BtInfoNotify(pBtCoexist, tmpBuf, length); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_BtInfoNotify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_BtInfoNotify(pBtCoexist, tmpBuf, length); -+ } -+ -+// halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+VOID -+EXhalbtcoutsrc_RfStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cntRfStatusNotify++; -+ -+ if(IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ } -+ else if(IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if(pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_RfStatusNotify(pBtCoexist, type); -+ } -+ else if(IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if(pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_RfStatusNotify(pBtCoexist, type); -+ } -+ else if(IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ } -+ else if(IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ } -+} -+ -+void EXhalbtcoutsrc_StackOperationNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+#if 0 -+ u8 stackOpType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cntStackOperationNotify++; -+ if (pBtCoexist->bManualControl) -+ return; -+ -+ if ((HCI_BT_OP_INQUIRY_START == type) || -+ (HCI_BT_OP_PAGING_START == type) || -+ (HCI_BT_OP_PAIRING_START == type)) -+ { -+ stackOpType = BTC_STACK_OP_INQ_PAGE_PAIR_START; -+ } -+ else if ((HCI_BT_OP_INQUIRY_FINISH == type) || -+ (HCI_BT_OP_PAGING_SUCCESS == type) || -+ (HCI_BT_OP_PAGING_UNSUCCESS == type) || -+ (HCI_BT_OP_PAIRING_FINISH == type) ) -+ { -+ stackOpType = BTC_STACK_OP_INQ_PAGE_PAIR_FINISH; -+ } -+ else -+ { -+ stackOpType = BTC_STACK_OP_NONE; -+ } -+ -+#endif -+} -+ -+void EXhalbtcoutsrc_HaltNotify(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ EXhalbtc8821aCsr2ant_HaltNotify(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8821a2ant_HaltNotify(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8821a1ant_HaltNotify(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_HaltNotify(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_HaltNotify(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8703b2ant_HaltNotify(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_HaltNotify(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8192e2ant_HaltNotify(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_HaltNotify(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_HaltNotify(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_HaltNotify(pBtCoexist); -+ } -+ -+ pBtCoexist->bBinded = FALSE; -+} -+ -+void EXhalbtcoutsrc_SwitchBtTRxMask(PBTC_COEXIST pBtCoexist) -+{ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ { -+ halbtcoutsrc_SetBtReg(pBtCoexist, 0, 0x3c, 0x01); //BT goto standby while GNT_BT 1-->0 -+ } -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ { -+ halbtcoutsrc_SetBtReg(pBtCoexist, 0, 0x3c, 0x15); //BT goto standby while GNT_BT 1-->0 -+ } -+ } -+} -+ -+void EXhalbtcoutsrc_PnpNotify(PBTC_COEXIST pBtCoexist, u8 pnpState) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ // -+ // currently only 1ant we have to do the notification, -+ // once pnp is notified to sleep state, we have to leave LPS that we can sleep normally. -+ // -+ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_PnpNotify(pBtCoexist,pnpState); -+ else if(pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_PnpNotify(pBtCoexist,pnpState); -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_PnpNotify(pBtCoexist,pnpState); -+ else if(pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8703b2ant_PnpNotify(pBtCoexist,pnpState); -+ } -+ else if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ EXhalbtc8821aCsr2ant_PnpNotify(pBtCoexist, pnpState); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8821a1ant_PnpNotify(pBtCoexist,pnpState); -+ else if(pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8821a2ant_PnpNotify(pBtCoexist,pnpState); -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_PnpNotify(pBtCoexist, pnpState); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_PnpNotify(pBtCoexist, pnpState); -+ } -+} -+ -+void EXhalbtcoutsrc_CoexDmSwitch(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cntCoexDmSwitch++; -+ -+ halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ { -+ pBtCoexist->bStopCoexDm = TRUE; -+ EXhalbtc8723b1ant_CoexDmReset(pBtCoexist); -+ EXhalbtcoutsrc_SetAntNum(BT_COEX_ANT_TYPE_DETECTED, 2); -+ EXhalbtc8723b2ant_InitHwConfig(pBtCoexist, FALSE); -+ EXhalbtc8723b2ant_InitCoexDm(pBtCoexist); -+ pBtCoexist->bStopCoexDm = FALSE; -+ } -+ } -+ -+ halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+void EXhalbtcoutsrc_Periodical(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cntPeriodical++; -+ -+ // Periodical should be called in cmd thread, -+ // don't need to leave low power again -+// halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ EXhalbtc8821aCsr2ant_Periodical(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8821a2ant_Periodical(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ { -+ if (!halbtcoutsrc_UnderIps(pBtCoexist)) -+ { -+ EXhalbtc8821a1ant_Periodical(pBtCoexist); -+ } -+ } -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_Periodical(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_Periodical(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8703b2ant_Periodical(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_Periodical(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8192e2ant_Periodical(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_Periodical(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_Periodical(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_Periodical(pBtCoexist); -+ } -+ -+// halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+void EXhalbtcoutsrc_DbgControl(PBTC_COEXIST pBtCoexist, u8 opCode, u8 opLen, u8 *pData) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cntDbgCtrl++; -+ -+ // This function doesn't be called yet, -+ // default no need to leave low power to avoid deadlock -+// halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_DbgControl(pBtCoexist, opCode, opLen, pData); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_DbgControl(pBtCoexist, opCode, opLen, pData); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_DbgControl(pBtCoexist, opCode, opLen, pData); -+ } -+ -+// halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+#if 0 -+VOID -+EXhalbtcoutsrc_AntennaDetection( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ) -+{ -+ if(!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ /* Need to refine the following power save operations to enable this function in the future */ -+#if 0 -+ IPSDisable(pBtCoexist->Adapter, FALSE, 0); -+ LeisurePSLeave(pBtCoexist->Adapter, LPS_DISABLE_BT_COEX); -+#endif -+ -+ if(IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if(pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_AntennaDetection(pBtCoexist, centFreq, offset, span, seconds); -+ } -+ -+ //IPSReturn(pBtCoexist->Adapter, 0xff); -+} -+#endif -+ -+void EXhalbtcoutsrc_StackUpdateProfileInfo(void) -+{ -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ PADAPTER padapter = (PADAPTER)GLBtCoexist.Adapter; -+ PBT_MGNT pBtMgnt = &padapter->coex_info.BtMgnt; -+ u8 i; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->stackInfo.bProfileNotified = _TRUE; -+ -+ pBtCoexist->stackInfo.numOfLink = -+ pBtMgnt->ExtConfig.NumberOfACL+pBtMgnt->ExtConfig.NumberOfSCO; -+ -+ // reset first -+ pBtCoexist->stackInfo.bBtLinkExist = _FALSE; -+ pBtCoexist->stackInfo.bScoExist = _FALSE; -+ pBtCoexist->stackInfo.bAclExist = _FALSE; -+ pBtCoexist->stackInfo.bA2dpExist = _FALSE; -+ pBtCoexist->stackInfo.bHidExist = _FALSE; -+ pBtCoexist->stackInfo.numOfHid = 0; -+ pBtCoexist->stackInfo.bPanExist = _FALSE; -+ -+ if (!pBtMgnt->ExtConfig.NumberOfACL) -+ pBtCoexist->stackInfo.minBtRssi = 0; -+ -+ if (pBtCoexist->stackInfo.numOfLink) -+ { -+ pBtCoexist->stackInfo.bBtLinkExist = _TRUE; -+ if (pBtMgnt->ExtConfig.NumberOfSCO) -+ pBtCoexist->stackInfo.bScoExist = _TRUE; -+ if (pBtMgnt->ExtConfig.NumberOfACL) -+ pBtCoexist->stackInfo.bAclExist = _TRUE; -+ } -+ -+ for (i=0; iExtConfig.NumberOfACL; i++) -+ { -+ if (BT_PROFILE_A2DP == pBtMgnt->ExtConfig.aclLink[i].BTProfile) -+ { -+ pBtCoexist->stackInfo.bA2dpExist = _TRUE; -+ } -+ else if (BT_PROFILE_PAN == pBtMgnt->ExtConfig.aclLink[i].BTProfile) -+ { -+ pBtCoexist->stackInfo.bPanExist = _TRUE; -+ } -+ else if (BT_PROFILE_HID == pBtMgnt->ExtConfig.aclLink[i].BTProfile) -+ { -+ pBtCoexist->stackInfo.bHidExist = _TRUE; -+ pBtCoexist->stackInfo.numOfHid++; -+ } -+ else -+ { -+ pBtCoexist->stackInfo.bUnknownAclExist = _TRUE; -+ } -+ } -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+} -+ -+void EXhalbtcoutsrc_UpdateMinBtRssi(s8 btRssi) -+{ -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->stackInfo.minBtRssi = btRssi; -+} -+ -+void EXhalbtcoutsrc_SetHciVersion(u16 hciVersion) -+{ -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->stackInfo.hciVersion = hciVersion; -+} -+ -+void EXhalbtcoutsrc_SetBtPatchVersion(u16 btHciVersion, u16 btPatchVersion) -+{ -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->btInfo.btRealFwVer = btPatchVersion; -+ pBtCoexist->btInfo.btHciVer = btHciVersion; -+} -+ -+#if 0 -+void EXhalbtcoutsrc_SetBtExist(u8 bBtExist) -+{ -+ GLBtCoexist.boardInfo.bBtExist = bBtExist; -+} -+#endif -+void EXhalbtcoutsrc_SetChipType(u8 chipType) -+{ -+ switch(chipType) -+ { -+ default: -+ case BT_2WIRE: -+ case BT_ISSC_3WIRE: -+ case BT_ACCEL: -+ case BT_RTL8756: -+ GLBtCoexist.boardInfo.btChipType = BTC_CHIP_UNDEF; -+ break; -+ case BT_CSR_BC4: -+ GLBtCoexist.boardInfo.btChipType = BTC_CHIP_CSR_BC4; -+ break; -+ case BT_CSR_BC8: -+ GLBtCoexist.boardInfo.btChipType = BTC_CHIP_CSR_BC8; -+ break; -+ case BT_RTL8723A: -+ GLBtCoexist.boardInfo.btChipType = BTC_CHIP_RTL8723A; -+ break; -+ case BT_RTL8821: -+ GLBtCoexist.boardInfo.btChipType = BTC_CHIP_RTL8821; -+ break; -+ case BT_RTL8723B: -+ GLBtCoexist.boardInfo.btChipType = BTC_CHIP_RTL8723B; -+ break; -+ } -+} -+ -+void EXhalbtcoutsrc_SetAntNum(u8 type, u8 antNum) -+{ -+ if (BT_COEX_ANT_TYPE_PG == type) -+ { -+ GLBtCoexist.boardInfo.pgAntNum = antNum; -+ GLBtCoexist.boardInfo.btdmAntNum = antNum; -+#if 0 -+ //The antenna position: Main (default) or Aux for pgAntNum=2 && btdmAntNum =1 -+ //The antenna position should be determined by auto-detect mechanism -+ // The following is assumed to main, and those must be modified if y auto-detect mechanism is ready -+ if ((GLBtCoexist.boardInfo.pgAntNum == 2) && (GLBtCoexist.boardInfo.btdmAntNum == 1) ) -+ GLBtCoexist.boardInfo.btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+ else -+ GLBtCoexist.boardInfo.btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+#endif -+ } -+ else if (BT_COEX_ANT_TYPE_ANTDIV == type) -+ { -+ GLBtCoexist.boardInfo.btdmAntNum = antNum; -+ //GLBtCoexist.boardInfo.btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+ } -+ else if (BT_COEX_ANT_TYPE_DETECTED == type) -+ { -+ GLBtCoexist.boardInfo.btdmAntNum = antNum; -+ //GLBtCoexist.boardInfo.btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; -+ } -+} -+ -+// -+// Currently used by 8723b only, S0 or S1 -+// -+void EXhalbtcoutsrc_SetSingleAntPath(u8 singleAntPath) -+{ -+ GLBtCoexist.boardInfo.singleAntPath = singleAntPath; -+} -+ -+void EXhalbtcoutsrc_DisplayBtCoexInfo(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) -+ { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ EXhalbtc8821aCsr2ant_DisplayCoexInfo(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8821a2ant_DisplayCoexInfo(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8821a1ant_DisplayCoexInfo(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8723b2ant_DisplayCoexInfo(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_DisplayCoexInfo(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8703b2ant_DisplayCoexInfo(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8703b1ant_DisplayCoexInfo(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8192e2ant_DisplayCoexInfo(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8192e1ant_DisplayCoexInfo(pBtCoexist); -+ } -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_DisplayCoexInfo(pBtCoexist); -+ else if (pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8812a1ant_DisplayCoexInfo(pBtCoexist); -+ } -+ -+ halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+void EXhalbtcoutsrc_DisplayAntDetection(PBTC_COEXIST pBtCoexist) -+{ -+ if(!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if(IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ if(pBtCoexist->boardInfo.btdmAntNum == 1) -+ EXhalbtc8723b1ant_DisplayAntDetection(pBtCoexist); -+ } -+ -+ halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+void EXhalbtcoutsrc_PTAOffOnNotify(PBTC_COEXIST pBtCoexist, u8 bONOFF) -+{ -+ -+ if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->boardInfo.btdmAntNum == 2) -+ EXhalbtc8812a2ant_PTAOffOnNotify(pBtCoexist, (bONOFF == _TRUE)?BTC_BT_ON:BTC_BT_OFF); -+ } -+ -+} -+ -+static void halbt_InitHwConfig92C(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ u8 u1Tmp; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if( (pHalData->bt_coexist.btChipType == BT_CSR_BC4) || -+ (pHalData->bt_coexist.btChipType == BT_CSR_BC8)) -+ { -+ if (pHalData->rf_type == RF_1T1R) -+ { -+ // Config to 1T1R -+ u1Tmp = rtw_read8(padapter, rOFDM0_TRxPathEnable); -+ u1Tmp &= ~BIT(1); -+ rtw_write8(padapter, rOFDM0_TRxPathEnable, u1Tmp); -+ RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xC04 = 0x%x\n", u1Tmp)); -+ -+ u1Tmp = rtw_read8(padapter, rOFDM1_TRxPathEnable); -+ u1Tmp &= ~BIT(1); -+ rtw_write8(padapter, rOFDM1_TRxPathEnable, u1Tmp); -+ RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xD04 = 0x%x\n", u1Tmp)); -+ } -+ } -+} -+ -+static void halbt_InitHwConfig92D(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ u8 u1Tmp; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if ((pHalData->bt_coexist.btChipType == BT_CSR_BC4) || -+ (pHalData->bt_coexist.btChipType == BT_CSR_BC8)) -+ { -+ if (pHalData->rf_type == RF_1T1R) -+ { -+ // Config to 1T1R -+ u1Tmp = rtw_read8(padapter, rOFDM0_TRxPathEnable); -+ u1Tmp &= ~BIT(1); -+ rtw_write8(padapter, rOFDM0_TRxPathEnable, u1Tmp); -+ RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xC04 = 0x%x\n", u1Tmp)); -+ -+ u1Tmp = rtw_read8(padapter, rOFDM1_TRxPathEnable); -+ u1Tmp &= ~BIT(1); -+ rtw_write8(padapter, rOFDM1_TRxPathEnable, u1Tmp); -+ RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xD04 = 0x%x\n", u1Tmp)); -+ } -+ } -+} -+ -+/* -+ * Description: -+ * Run BT-Coexist mechansim or not -+ * -+ */ -+void hal_btcoex_SetBTCoexist(PADAPTER padapter, u8 bBtExist) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pHalData->bt_coexist.bBtExist = bBtExist; -+ -+ //EXhalbtcoutsrc_SetBtExist(bBtExist); -+} -+ -+/* -+ * Dewcription: -+ * Check is co-exist mechanism enabled or not -+ * -+ * Return: -+ * _TRUE Enable BT co-exist mechanism -+ * _FALSE Disable BT co-exist mechanism -+ */ -+u8 hal_btcoex_IsBtExist(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ return pHalData->bt_coexist.bBtExist; -+} -+ -+u8 hal_btcoex_IsBtDisabled(PADAPTER padapter) -+{ -+ if (!hal_btcoex_IsBtExist(padapter)) -+ return _TRUE; -+ -+ if (GLBtCoexist.btInfo.bBtDisabled) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+void hal_btcoex_SetChipType(PADAPTER padapter, u8 chipType) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pHalData->bt_coexist.btChipType = chipType; -+ -+ EXhalbtcoutsrc_SetChipType(chipType); -+} -+ -+u8 hal_btcoex_GetChipType(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ return pHalData->bt_coexist.btChipType; -+} -+ -+void hal_btcoex_SetPgAntNum(PADAPTER padapter, u8 antNum) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ pHalData->bt_coexist.btTotalAntNum = antNum; -+ EXhalbtcoutsrc_SetAntNum(BT_COEX_ANT_TYPE_PG, antNum); -+} -+ -+u8 hal_btcoex_GetPgAntNum(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ return pHalData->bt_coexist.btTotalAntNum; -+} -+ -+void hal_btcoex_SetSingleAntPath(PADAPTER padapter, u8 singleAntPath) -+{ -+ EXhalbtcoutsrc_SetSingleAntPath(singleAntPath); -+} -+ -+u8 hal_btcoex_Initialize(PADAPTER padapter) -+{ -+ u8 ret1; -+ u8 ret2; -+ -+ -+ _rtw_memset(&GLBtCoexist, 0, sizeof(GLBtCoexist)); -+ ret1 = EXhalbtcoutsrc_InitlizeVariables((void*)padapter); -+ ret2 = (ret1==_TRUE) ? _TRUE : _FALSE; -+ -+ return ret2; -+} -+ -+void hal_btcoex_PowerOnSetting(PADAPTER padapter) -+{ -+ EXhalbtcoutsrc_PowerOnSetting(&GLBtCoexist); -+} -+ -+void hal_btcoex_PreLoadFirmware(PADAPTER padapter) -+{ -+ EXhalbtcoutsrc_PreLoadFirmware(&GLBtCoexist); -+} -+ -+void hal_btcoex_InitHwConfig(PADAPTER padapter, u8 bWifiOnly) -+{ -+ if (!hal_btcoex_IsBtExist(padapter)) -+ return; -+ -+ EXhalbtcoutsrc_InitHwConfig(&GLBtCoexist, bWifiOnly); -+ EXhalbtcoutsrc_InitCoexDm(&GLBtCoexist); -+} -+ -+void hal_btcoex_IpsNotify(PADAPTER padapter, u8 type) -+{ -+ EXhalbtcoutsrc_IpsNotify(&GLBtCoexist, type); -+} -+ -+void hal_btcoex_LpsNotify(PADAPTER padapter, u8 type) -+{ -+ EXhalbtcoutsrc_LpsNotify(&GLBtCoexist, type); -+} -+ -+void hal_btcoex_ScanNotify(PADAPTER padapter, u8 type) -+{ -+ EXhalbtcoutsrc_ScanNotify(&GLBtCoexist, type); -+} -+ -+void hal_btcoex_ConnectNotify(PADAPTER padapter, u8 action) -+{ -+ EXhalbtcoutsrc_ConnectNotify(&GLBtCoexist, action); -+} -+ -+void hal_btcoex_MediaStatusNotify(PADAPTER padapter, u8 mediaStatus) -+{ -+ EXhalbtcoutsrc_MediaStatusNotify(&GLBtCoexist, mediaStatus); -+} -+ -+void hal_btcoex_SpecialPacketNotify(PADAPTER padapter, u8 pktType) -+{ -+ EXhalbtcoutsrc_SpecialPacketNotify(&GLBtCoexist, pktType); -+} -+ -+void hal_btcoex_IQKNotify(PADAPTER padapter, u8 state) -+{ -+ GLBtcWiFiInIQKState = state; -+} -+ -+void hal_btcoex_BtInfoNotify(PADAPTER padapter, u8 length, u8 *tmpBuf) -+{ -+ if (GLBtcWiFiInIQKState == _TRUE) -+ return; -+ -+ EXhalbtcoutsrc_BtInfoNotify(&GLBtCoexist, tmpBuf, length); -+} -+ -+void hal_btcoex_SuspendNotify(PADAPTER padapter, u8 state) -+{ -+ if (state == 1) -+ state = BTC_WIFI_PNP_SLEEP; -+ else -+ state = BTC_WIFI_PNP_WAKE_UP; -+ -+ EXhalbtcoutsrc_PnpNotify(&GLBtCoexist, state); -+} -+ -+void hal_btcoex_HaltNotify(PADAPTER padapter) -+{ -+ EXhalbtcoutsrc_HaltNotify(&GLBtCoexist); -+} -+ -+void hal_btcoex_SwitchBtTRxMask(PADAPTER padapter) -+{ -+ EXhalbtcoutsrc_SwitchBtTRxMask(&GLBtCoexist); -+} -+ -+void hal_btcoex_Hanlder(PADAPTER padapter) -+{ -+ EXhalbtcoutsrc_Periodical(&GLBtCoexist); -+} -+ -+s32 hal_btcoex_IsBTCoexRejectAMPDU(PADAPTER padapter) -+{ -+ return (s32)GLBtCoexist.btInfo.bRejectAggPkt; -+} -+ -+s32 hal_btcoex_IsBTCoexCtrlAMPDUSize(PADAPTER padapter) -+{ -+ return (s32)GLBtCoexist.btInfo.bBtCtrlAggBufSize; -+} -+ -+u32 hal_btcoex_GetAMPDUSize(PADAPTER padapter) -+{ -+ return (u32)GLBtCoexist.btInfo.aggBufSize; -+} -+ -+void hal_btcoex_SetManualControl(PADAPTER padapter, u8 bmanual) -+{ -+ GLBtCoexist.bManualControl = bmanual; -+} -+ -+u8 hal_btcoex_1Ant(PADAPTER padapter) -+{ -+ if (hal_btcoex_IsBtExist(padapter) == _FALSE) -+ return _FALSE; -+ -+ if (GLBtCoexist.boardInfo.btdmAntNum == 1) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+u8 hal_btcoex_IsBtControlLps(PADAPTER padapter) -+{ -+ if (hal_btcoex_IsBtExist(padapter) == _FALSE) -+ return _FALSE; -+ -+ if (GLBtCoexist.btInfo.bBtDisabled) -+ return _FALSE; -+ -+ if (GLBtCoexist.btInfo.bBtCtrlLps) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+u8 hal_btcoex_IsLpsOn(PADAPTER padapter) -+{ -+ if (hal_btcoex_IsBtExist(padapter) == _FALSE) -+ return _FALSE; -+ -+ if (GLBtCoexist.btInfo.bBtDisabled) -+ return _FALSE; -+ -+ if (GLBtCoexist.btInfo.bBtLpsOn) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+u8 hal_btcoex_RpwmVal(PADAPTER padapter) -+{ -+ return GLBtCoexist.btInfo.rpwmVal; -+} -+ -+u8 hal_btcoex_LpsVal(PADAPTER padapter) -+{ -+ return GLBtCoexist.btInfo.lpsVal; -+} -+ -+u32 hal_btcoex_GetRaMask(PADAPTER padapter) -+{ -+ if (!hal_btcoex_IsBtExist(padapter)) -+ return 0; -+ -+ if (GLBtCoexist.btInfo.bBtDisabled) -+ return 0; -+ -+ /* Modify by YiWei , suggest by Cosa and Jenyu -+ * Remove the limit antenna number , because 2 antenna case (ex: 8192eu)also want to get BT coex report rate mask. -+ */ -+ /*if (GLBtCoexist.boardInfo.btdmAntNum != 1) -+ return 0;*/ -+ -+ return GLBtCoexist.btInfo.raMask; -+} -+ -+void hal_btcoex_RecordPwrMode(PADAPTER padapter, u8 *pCmdBuf, u8 cmdLen) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FW write pwrModeCmd=0x%04x%08x\n", -+ pCmdBuf[0]<<8|pCmdBuf[1], -+ pCmdBuf[2]<<24|pCmdBuf[3]<<16|pCmdBuf[4]<<8|pCmdBuf[5])); -+ -+ _rtw_memcpy(GLBtCoexist.pwrModeVal, pCmdBuf, cmdLen); -+} -+ -+void hal_btcoex_DisplayBtCoexInfo(PADAPTER padapter, u8 *pbuf, u32 bufsize) -+{ -+ PBTCDBGINFO pinfo; -+ -+ -+ pinfo = &GLBtcDbgInfo; -+ DBG_BT_INFO_INIT(pinfo, pbuf, bufsize); -+ EXhalbtcoutsrc_DisplayBtCoexInfo(&GLBtCoexist); -+ DBG_BT_INFO_INIT(pinfo, NULL, 0); -+} -+ -+void hal_btcoex_SetDBG(PADAPTER padapter, u32 *pDbgModule) -+{ -+ u32 i; -+ -+ -+ if (NULL == pDbgModule) -+ return; -+ -+ for (i = 0; i < COMP_MAX; i++) -+ GLBtcDbgType[i] = pDbgModule[i]; -+} -+ -+u32 hal_btcoex_GetDBG(PADAPTER padapter, u8 *pStrBuf, u32 bufSize) -+{ -+ s32 count; -+ u8 *pstr; -+ u32 leftSize; -+ -+ -+ if ((NULL == pStrBuf) || (0 == bufSize)) -+ return 0; -+ -+ count = 0; -+ pstr = pStrBuf; -+ leftSize = bufSize; -+// DBG_871X(FUNC_ADPT_FMT ": bufsize=%d\n", FUNC_ADPT_ARG(padapter), bufSize); -+ -+ count = rtw_sprintf(pstr, leftSize, "#define DBG\t%d\n", DBG); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ -+ count = rtw_sprintf(pstr, leftSize, "BTCOEX Debug Setting:\n"); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ -+ count = rtw_sprintf(pstr, leftSize, -+ "COMP_COEX: 0x%08X\n\n", -+ GLBtcDbgType[COMP_COEX]); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ -+#if 0 -+ count = rtw_sprintf(pstr, leftSize, "INTERFACE Debug Setting Definition:\n"); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[0]=%d for INTF_INIT\n", -+ GLBtcDbgType[BTC_MSG_INTERFACE]&INTF_INIT?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[2]=%d for INTF_NOTIFY\n\n", -+ GLBtcDbgType[BTC_MSG_INTERFACE]&INTF_NOTIFY?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ -+ count = rtw_sprintf(pstr, leftSize, "ALGORITHM Debug Setting Definition:\n"); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[0]=%d for BT_RSSI_STATE\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_BT_RSSI_STATE?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[1]=%d for WIFI_RSSI_STATE\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_WIFI_RSSI_STATE?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[2]=%d for BT_MONITOR\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_BT_MONITOR?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[3]=%d for TRACE\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[4]=%d for TRACE_FW\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE_FW?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[5]=%d for TRACE_FW_DETAIL\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE_FW_DETAIL?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[6]=%d for TRACE_FW_EXEC\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE_FW_EXEC?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[7]=%d for TRACE_SW\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE_SW?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[8]=%d for TRACE_SW_DETAIL\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE_SW_DETAIL?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[9]=%d for TRACE_SW_EXEC\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM]&ALGO_TRACE_SW_EXEC?1:0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+#endif -+ -+exit: -+ count = pstr - pStrBuf; -+// DBG_871X(FUNC_ADPT_FMT ": usedsize=%d\n", FUNC_ADPT_ARG(padapter), count); -+ -+ return count; -+} -+ -+u8 hal_btcoex_IncreaseScanDeviceNum(PADAPTER padapter) -+{ -+ if (!hal_btcoex_IsBtExist(padapter)) -+ return _FALSE; -+ -+ if (GLBtCoexist.btInfo.bIncreaseScanDevNum) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+u8 hal_btcoex_IsBtLinkExist(PADAPTER padapter) -+{ -+ if (GLBtCoexist.btLinkInfo.bBtLinkExist) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+void hal_btcoex_SetBtPatchVersion(PADAPTER padapter,u16 btHciVer,u16 btPatchVer) -+{ -+ EXhalbtcoutsrc_SetBtPatchVersion(btHciVer,btPatchVer); -+} -+ -+void hal_btcoex_SetHciVersion(PADAPTER padapter, u16 hciVersion) -+{ -+ EXhalbtcoutsrc_SetHciVersion(hciVersion); -+} -+ -+void hal_btcoex_StackUpdateProfileInfo(void) -+{ -+ EXhalbtcoutsrc_StackUpdateProfileInfo(); -+} -+ -+void hal_btcoex_PTAOffOnNotify(PADAPTER padapter, u8 bONOFF) -+{ -+ EXhalbtcoutsrc_PTAOffOnNotify(&GLBtCoexist, bONOFF); -+} -+ -+/* -+ * Description: -+ * Setting BT coex antenna isolation type . -+ * coex mechanisn/ spital stream/ best throughput -+ * anttype = 0 , PSTDMA / 2SS / 0.5T , bad isolation , WiFi/BT ANT Distance<15cm , (<20dB) for 2,3 antenna -+ * anttype = 1 , PSTDMA / 1SS / 0.5T , normal isolaiton , 50cm>WiFi/BT ANT Distance>15cm , (>20dB) for 2 antenna -+ * anttype = 2 , TDMA / 2SS / T , normal isolaiton , 50cm>WiFi/BT ANT Distance>15cm , (>20dB) for 3 antenna -+ * anttype = 3 , no TDMA / 1SS / 0.5T , good isolation , WiFi/BT ANT Distance >50cm , (>40dB) for 2 antenna -+ * anttype = 4 , no TDMA / 2SS / T , good isolation , WiFi/BT ANT Distance >50cm , (>40dB) for 3 antenna -+ * wifi only throughput ~ T -+ * wifi/BT share one antenna with SPDT -+ */ -+void hal_btcoex_SetAntIsolationType(PADAPTER padapter, u8 anttype) -+{ -+ PHAL_DATA_TYPE pHalData; -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ -+ /*DBG_871X("####%s , anttype = %d , %d\n" , __func__ , anttype , __LINE__); */ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ -+ pHalData->bt_coexist.btAntisolation = anttype; -+ -+ switch (pHalData->bt_coexist.btAntisolation) { -+ case 0: -+ pBtCoexist->boardInfo.antType = (u1Byte)BTC_ANT_TYPE_0; -+ break; -+ case 1: -+ pBtCoexist->boardInfo.antType = (u1Byte)BTC_ANT_TYPE_1; -+ break; -+ case 2: -+ pBtCoexist->boardInfo.antType = (u1Byte)BTC_ANT_TYPE_2; -+ break; -+ case 3: -+ pBtCoexist->boardInfo.antType = (u1Byte)BTC_ANT_TYPE_3; -+ break; -+ case 4: -+ pBtCoexist->boardInfo.antType = (u1Byte)BTC_ANT_TYPE_4; -+ break; -+ } -+ -+} -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+int -+hal_btcoex_ParseAntIsolationConfigFile( -+ PADAPTER Adapter, -+ char* buffer -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u32 i = 0 , j = 0; -+ char *szLine , *ptmp; -+ int rtStatus = _SUCCESS; -+ char param_value_string[10]; -+ u8 param_value; -+ u8 anttype = 4; -+ -+ u8 ant_num = 3 , ant_distance = 50 , rfe_type = 1; -+ -+ typedef struct ant_isolation { -+ char *param_name; /* antenna isolation config parameter name */ -+ u8 *value; /* antenna isolation config parameter value */ -+ } ANT_ISOLATION; -+ -+ ANT_ISOLATION ant_isolation_param[] = { -+ {"ANT_NUMBER" , &ant_num}, -+ {"ANT_DISTANCE" , &ant_distance}, -+ {"RFE_TYPE" , &rfe_type}, -+ {NULL , 0} -+ }; -+ -+ -+ -+ /* DBG_871X("===>Hal_ParseAntIsolationConfigFile()\n" ); */ -+ -+ ptmp = buffer; -+ for (szLine = GetLineFromBuffer(ptmp) ; szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ /* skip comment */ -+ if (IsCommentString(szLine)) -+ continue; -+ -+ /* DBG_871X("%s : szLine = %s , strlen(szLine) = %d\n" , __func__ , szLine , strlen(szLine));*/ -+ for (j = 0 ; ant_isolation_param[j].param_name != NULL ; j++) { -+ if (strstr(szLine , ant_isolation_param[j].param_name) != NULL) { -+ i = 0; -+ while (i < strlen(szLine)) { -+ if (szLine[i] != '"') -+ ++i; -+ else { -+ /* skip only has one " */ -+ if (strpbrk(szLine , "\"") == strrchr(szLine , '"')) { -+ DBG_871X("Fail to parse parameters , format error!\n"); -+ break; -+ } -+ _rtw_memset((PVOID)param_value_string , 0 , 10); -+ if (!ParseQualifiedString(szLine , &i , param_value_string , '"' , '"')) { -+ DBG_871X("Fail to parse parameters\n"); -+ return _FAIL; -+ } else if (!GetU1ByteIntegerFromStringInDecimal(param_value_string , ant_isolation_param[j].value)) -+ DBG_871X("Fail to GetU1ByteIntegerFromStringInDecimal\n"); -+ -+ break; -+ } -+ } -+ } -+ } -+ } -+ -+ /* YiWei 20140716 , for BT coex antenna isolation control */ -+ /* rfe_type = 0 was SPDT , rfe_type = 1 was coupler */ -+ if (ant_num == 3 && ant_distance >= 50) -+ anttype = 3; -+ else if (ant_num == 2 && ant_distance >= 50 && rfe_type == 1) -+ anttype = 2; -+ else if (ant_num == 3 && ant_distance >= 15 && ant_distance < 50) -+ anttype = 2; -+ else if (ant_num == 2 && ant_distance >= 15 && ant_distance < 50 && rfe_type == 1) -+ anttype = 2; -+ else if ((ant_num == 2 && ant_distance < 15 && rfe_type == 1) || (ant_num == 3 && ant_distance < 15)) -+ anttype = 1; -+ else if (ant_num == 2 && rfe_type == 0) -+ anttype = 0; -+ else -+ anttype = 0; -+ -+ hal_btcoex_SetAntIsolationType(Adapter, anttype); -+ -+ DBG_871X("%s : ant_num = %d\n" , __func__ , ant_num); -+ DBG_871X("%s : ant_distance = %d\n" , __func__ , ant_distance); -+ DBG_871X("%s : rfe_type = %d\n" , __func__ , rfe_type); -+ /* DBG_871X("<===Hal_ParseAntIsolationConfigFile()\n"); */ -+ return rtStatus; -+} -+ -+ -+int -+hal_btcoex_AntIsolationConfig_ParaFile( -+ IN PADAPTER Adapter, -+ IN char* pFileName -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0 , rtStatus = _FAIL; -+ -+ _rtw_memset(pHalData->para_file_buf , 0 , MAX_PARA_FILE_BUF_LEN); -+ -+ -+ rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) -+ { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) -+ { -+ rtStatus = _SUCCESS; -+ } -+ } -+ -+ -+ if (rtStatus == _SUCCESS) { -+ /*DBG_871X("%s(): read %s ok\n", __func__ , pFileName);*/ -+ rtStatus = hal_btcoex_ParseAntIsolationConfigFile(Adapter , pHalData->para_file_buf); -+ } else { -+ DBG_871X("%s(): No File %s, Load from *** Array!\n" , __func__ , pFileName); -+ } -+ -+ return rtStatus; -+} -+#endif // CONFIG_LOAD_PHY_PARA_FROM_FILE -+#endif // CONFIG_BT_COEXIST -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/hal/hal_com.c ---- linux.old/3rdparty/rtl8812au/hal/hal_com.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/hal_com.c 2017-06-07 23:07:21.013687758 +0300 -@@ -0,0 +1,7742 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/Hal8812PwrSeq.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/Hal8812PwrSeq.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/Hal8812PwrSeq.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/Hal8812PwrSeq.c 2018-02-06 17:42:30.701967031 +0200 +@@ -0,0 +1,92 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -156351,416 +63174,366 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++ ++#include "Hal8812PwrSeq.h" ++#include ++ ++/* ++ drivers should parse below arrays and do the corresponding actions ++*/ ++//3 Power on Array ++WLAN_PWR_CFG rtl8812_power_on_flow[RTL8812_TRANS_CARDEMU_TO_ACT_STEPS+RTL8812_TRANS_END_STEPS]= ++{ ++ RTL8812_TRANS_CARDEMU_TO_ACT ++ RTL8812_TRANS_END ++}; ++ ++//3Radio off GPIO Array ++WLAN_PWR_CFG rtl8812_radio_off_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_END_STEPS]= ++{ ++ RTL8812_TRANS_ACT_TO_CARDEMU ++ RTL8812_TRANS_END ++}; ++ ++//3Card Disable Array ++WLAN_PWR_CFG rtl8812_card_disable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]= ++{ ++ RTL8812_TRANS_ACT_TO_CARDEMU ++ RTL8812_TRANS_CARDEMU_TO_CARDDIS ++ RTL8812_TRANS_END ++}; ++ ++//3 Card Enable Array ++WLAN_PWR_CFG rtl8812_card_enable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]= ++{ ++ RTL8812_TRANS_CARDDIS_TO_CARDEMU ++ RTL8812_TRANS_CARDEMU_TO_ACT ++ RTL8812_TRANS_END ++}; ++ ++//3Suspend Array ++WLAN_PWR_CFG rtl8812_suspend_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_SUS_STEPS+RTL8812_TRANS_END_STEPS]= ++{ ++ RTL8812_TRANS_ACT_TO_CARDEMU ++ RTL8812_TRANS_CARDEMU_TO_SUS ++ RTL8812_TRANS_END ++}; ++ ++//3 Resume Array ++WLAN_PWR_CFG rtl8812_resume_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_SUS_STEPS+RTL8812_TRANS_END_STEPS]= ++{ ++ RTL8812_TRANS_SUS_TO_CARDEMU ++ RTL8812_TRANS_CARDEMU_TO_ACT ++ RTL8812_TRANS_END ++}; ++ ++ ++ ++//3HWPDN Array ++WLAN_PWR_CFG rtl8812_hwpdn_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]= ++{ ++ RTL8812_TRANS_ACT_TO_CARDEMU ++ RTL8812_TRANS_CARDEMU_TO_PDN ++ RTL8812_TRANS_END ++}; ++ ++//3 Enter LPS ++WLAN_PWR_CFG rtl8812_enter_lps_flow[RTL8812_TRANS_ACT_TO_LPS_STEPS+RTL8812_TRANS_END_STEPS]= ++{ ++ //FW behavior ++ RTL8812_TRANS_ACT_TO_LPS ++ RTL8812_TRANS_END ++}; ++ ++//3 Leave LPS ++WLAN_PWR_CFG rtl8812_leave_lps_flow[RTL8812_TRANS_LPS_TO_ACT_STEPS+RTL8812_TRANS_END_STEPS]= ++{ ++ //FW behavior ++ RTL8812_TRANS_LPS_TO_ACT ++ RTL8812_TRANS_END ++}; +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/Hal8821APwrSeq.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/Hal8821APwrSeq.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/Hal8821APwrSeq.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/Hal8821APwrSeq.c 2018-02-06 17:42:30.701967031 +0200 +@@ -0,0 +1,96 @@ ++ ++/*++ ++Copyright (c) Realtek Semiconductor Corp. All rights reserved. ++ ++Module Name: ++ Hal8821PwrSeq.c ++ ++Abstract: ++ This file includes all kinds of Power Action event for RTL8821A and corresponding hardware configurtions which are released from HW SD. ++ ++Major Change History: ++ When Who What ++ ---------- --------------- ------------------------------- ++ 2011-08-08 Roger Create. ++ ++--*/ ++ ++ ++#include "Hal8821APwrSeq.h" ++#include ++ ++ ++/* ++ drivers should parse below arrays and do the corresponding actions ++*/ ++//3 Power on Array ++WLAN_PWR_CFG rtl8821A_power_on_flow[RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]= ++{ ++ RTL8821A_TRANS_CARDEMU_TO_ACT ++ RTL8821A_TRANS_END ++}; ++ ++//3Radio off GPIO Array ++WLAN_PWR_CFG rtl8821A_radio_off_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_END_STEPS]= ++{ ++ RTL8821A_TRANS_ACT_TO_CARDEMU ++ RTL8821A_TRANS_END ++}; ++ ++//3Card Disable Array ++WLAN_PWR_CFG rtl8821A_card_disable_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8821A_TRANS_END_STEPS]= ++{ ++ RTL8821A_TRANS_ACT_TO_CARDEMU ++ RTL8821A_TRANS_CARDEMU_TO_CARDDIS ++ RTL8821A_TRANS_END ++}; ++ ++//3 Card Enable Array ++WLAN_PWR_CFG rtl8821A_card_enable_flow[RTL8821A_TRANS_CARDDIS_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]= ++{ ++ RTL8821A_TRANS_CARDDIS_TO_CARDEMU ++ RTL8821A_TRANS_CARDEMU_TO_ACT ++ RTL8821A_TRANS_END ++}; ++ ++//3Suspend Array ++WLAN_PWR_CFG rtl8821A_suspend_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8821A_TRANS_END_STEPS]= ++{ ++ RTL8821A_TRANS_ACT_TO_CARDEMU ++ RTL8821A_TRANS_CARDEMU_TO_SUS ++ RTL8821A_TRANS_END ++}; ++ ++//3 Resume Array ++WLAN_PWR_CFG rtl8821A_resume_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8821A_TRANS_END_STEPS]= ++{ ++ RTL8821A_TRANS_SUS_TO_CARDEMU ++ RTL8821A_TRANS_CARDEMU_TO_ACT ++ RTL8821A_TRANS_END ++}; ++ ++ ++ ++//3HWPDN Array ++WLAN_PWR_CFG rtl8821A_hwpdn_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8821A_TRANS_END_STEPS]= ++{ ++ RTL8821A_TRANS_ACT_TO_CARDEMU ++ RTL8821A_TRANS_CARDEMU_TO_PDN ++ RTL8821A_TRANS_END ++}; ++ ++//3 Enter LPS ++WLAN_PWR_CFG rtl8821A_enter_lps_flow[RTL8821A_TRANS_ACT_TO_LPS_STEPS+RTL8821A_TRANS_END_STEPS]= ++{ ++ //FW behavior ++ RTL8821A_TRANS_ACT_TO_LPS ++ RTL8821A_TRANS_END ++}; ++ ++//3 Leave LPS ++WLAN_PWR_CFG rtl8821A_leave_lps_flow[RTL8821A_TRANS_LPS_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]= ++{ ++ //FW behavior ++ RTL8821A_TRANS_LPS_TO_ACT ++ RTL8821A_TRANS_END ++}; +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/hal_com.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_com.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/hal_com.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_com.c 2018-02-06 17:42:30.709967150 +0200 +@@ -0,0 +1,486 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#define _HAL_COM_C_ + +#include -+#include "hal_com_h2c.h" + -+#include "hal_data.h" ++#include "../hal/odm_precomp.h" + -+//#define CONFIG_GTK_OL_DBG -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+char rtw_phy_para_file_path[PATH_LENGTH_MAX]; -+#endif + +void dump_chip_info(HAL_VERSION ChipVersion) +{ + int cnt = 0; -+ u8 buf[128]={0}; -+ -+ if (IS_8188E(ChipVersion)) ++ u8 buf[128]; ++ ++ if(IS_81XXC(ChipVersion)){ ++ cnt += sprintf((buf+cnt), "Chip Version Info: %s_", IS_92C_SERIAL(ChipVersion)?"CHIP_8192C":"CHIP_8188C"); ++ } ++ else if(IS_92D(ChipVersion)){ ++ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8192D_"); ++ } ++ else if(IS_8723_SERIES(ChipVersion)){ ++ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8723A_"); ++ } ++ else if(IS_8188E(ChipVersion)){ + cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8188E_"); -+ else if (IS_8188F(ChipVersion)) -+ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8188F_"); -+ else if (IS_8812_SERIES(ChipVersion)) ++ } ++ else if(IS_8812_SERIES(ChipVersion)){ + cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8812_"); -+ else if (IS_8192E(ChipVersion)) ++ } ++ else if(IS_8192E(ChipVersion)){ + cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8192E_"); -+ else if (IS_8821_SERIES(ChipVersion)) ++ } ++ else if(IS_8821_SERIES(ChipVersion)){ + cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8821_"); -+ else if (IS_8723B_SERIES(ChipVersion)) ++ } ++ else if(IS_8723B_SERIES(ChipVersion)){ + cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8723B_"); -+ else if (IS_8703B_SERIES(ChipVersion)) -+ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8703B_"); -+ else if (IS_8814A_SERIES(ChipVersion)) -+ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8814A_"); -+ else -+ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_UNKNOWN_"); ++ } + + cnt += sprintf((buf+cnt), "%s_", IS_NORMAL_CHIP(ChipVersion)?"Normal_Chip":"Test_Chip"); + if(IS_CHIP_VENDOR_TSMC(ChipVersion)) + cnt += sprintf((buf+cnt), "%s_","TSMC"); -+ else if(IS_CHIP_VENDOR_UMC(ChipVersion)) ++ else if(IS_CHIP_VENDOR_UMC(ChipVersion)) + cnt += sprintf((buf+cnt), "%s_","UMC"); + else if(IS_CHIP_VENDOR_SMIC(ChipVersion)) -+ cnt += sprintf((buf+cnt), "%s_","SMIC"); -+ -+ if (IS_A_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "A_CUT_"); -+ else if (IS_B_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "B_CUT_"); -+ else if (IS_C_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "C_CUT_"); -+ else if (IS_D_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "D_CUT_"); -+ else if (IS_E_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "E_CUT_"); -+ else if (IS_F_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "F_CUT_"); -+ else if (IS_I_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "I_CUT_"); -+ else if (IS_J_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "J_CUT_"); -+ else if (IS_K_CUT(ChipVersion)) -+ cnt += sprintf((buf+cnt), "K_CUT_"); -+ else -+ cnt += sprintf((buf+cnt), "UNKNOWN_CUT(%d)_", ChipVersion.CUTVersion); ++ cnt += sprintf((buf+cnt), "%s_","SMIC"); ++ ++ if(IS_A_CUT(ChipVersion)) cnt += sprintf((buf+cnt), "A_CUT_"); ++ else if(IS_B_CUT(ChipVersion)) cnt += sprintf((buf+cnt), "B_CUT_"); ++ else if(IS_C_CUT(ChipVersion)) cnt += sprintf((buf+cnt), "C_CUT_"); ++ else if(IS_D_CUT(ChipVersion)) cnt += sprintf((buf+cnt), "D_CUT_"); ++ else if(IS_E_CUT(ChipVersion)) cnt += sprintf((buf+cnt), "E_CUT_"); ++ else cnt += sprintf((buf+cnt), "UNKNOWN_CUT(%d)_", ChipVersion.CUTVersion); + + if(IS_1T1R(ChipVersion)) cnt += sprintf((buf+cnt), "1T1R_"); + else if(IS_1T2R(ChipVersion)) cnt += sprintf((buf+cnt), "1T2R_"); + else if(IS_2T2R(ChipVersion)) cnt += sprintf((buf+cnt), "2T2R_"); -+ else if(IS_3T3R(ChipVersion)) cnt += sprintf((buf+cnt), "3T3R_"); -+ else if(IS_3T4R(ChipVersion)) cnt += sprintf((buf+cnt), "3T4R_"); -+ else if(IS_4T4R(ChipVersion)) cnt += sprintf((buf+cnt), "4T4R_"); + else cnt += sprintf((buf+cnt), "UNKNOWN_RFTYPE(%d)_", ChipVersion.RFType); + + cnt += sprintf((buf+cnt), "RomVer(%d)\n", ChipVersion.ROMVer); + + DBG_871X("%s", buf); +} -+void rtw_hal_config_rftype(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (IS_1T1R(pHalData->VersionID)) { -+ pHalData->rf_type = RF_1T1R; -+ pHalData->NumTotalRFPath = 1; -+ } -+ else if (IS_2T2R(pHalData->VersionID)) { -+ pHalData->rf_type = RF_2T2R; -+ pHalData->NumTotalRFPath = 2; -+ } -+ else if (IS_1T2R(pHalData->VersionID)) { -+ pHalData->rf_type = RF_1T2R; -+ pHalData->NumTotalRFPath = 2; -+ } -+ else if(IS_3T3R(pHalData->VersionID)) { -+ pHalData->rf_type = RF_3T3R; -+ pHalData->NumTotalRFPath = 3; -+ } -+ else if(IS_4T4R(pHalData->VersionID)) { -+ pHalData->rf_type = RF_4T4R; -+ pHalData->NumTotalRFPath = 4; -+ } -+ else { -+ pHalData->rf_type = RF_1T1R; -+ pHalData->NumTotalRFPath = 1; -+ } -+ -+ DBG_871X("%s RF_Type is %d TotalTxPath is %d \n", __FUNCTION__, pHalData->rf_type, pHalData->NumTotalRFPath); -+} ++ + +#define EEPROM_CHANNEL_PLAN_BY_HW_MASK 0x80 + -+/* -+ * Description: -+ * Use hardware(efuse), driver parameter(registry) and default channel plan -+ * to decide which one should be used. -+ * -+ * Parameters: -+ * padapter pointer of adapter -+ * hw_channel_plan channel plan from HW (efuse/eeprom) -+ * BIT[7] software configure mode; 0:Enable, 1:disable -+ * BIT[6:0] Channel Plan -+ * sw_channel_plan channel plan from SW (registry/module param) -+ * def_channel_plan channel plan used when HW/SW both invalid -+ * AutoLoadFail efuse autoload fail or not -+ * -+ * Return: -+ * Final channel plan decision -+ * -+ */ -+u8 -+hal_com_config_channel_plan( -+ IN PADAPTER padapter, -+ IN u8 hw_channel_plan, -+ IN u8 sw_channel_plan, -+ IN u8 def_channel_plan, -+ IN BOOLEAN AutoLoadFail ++u8 //return the final channel plan decision ++hal_com_get_channel_plan( ++ PADAPTER padapter, ++ u8 hw_channel_plan, //channel plan from HW (efuse/eeprom) ++ u8 sw_channel_plan, //channel plan from SW (registry/module param) ++ u8 def_channel_plan, //channel plan used when the former two is invalid ++ bool AutoLoadFail + ) +{ -+ PHAL_DATA_TYPE pHalData; -+ u8 hwConfig; ++ u8 swConfig; + u8 chnlPlan; + -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pHalData->bDisableSWChannelPlan = _FALSE; -+ chnlPlan = def_channel_plan; -+ -+ if (0xFF == hw_channel_plan) -+ AutoLoadFail = _TRUE; -+ -+ if (_FALSE == AutoLoadFail) ++ swConfig = true; ++ if (!AutoLoadFail) + { -+ u8 hw_chnlPlan; -+ -+ hw_chnlPlan = hw_channel_plan & (~EEPROM_CHANNEL_PLAN_BY_HW_MASK); -+ if (rtw_is_channel_plan_valid(hw_chnlPlan)) -+ { -+#ifndef CONFIG_SW_CHANNEL_PLAN -+ if (hw_channel_plan & EEPROM_CHANNEL_PLAN_BY_HW_MASK) -+ pHalData->bDisableSWChannelPlan = _TRUE; -+#endif // !CONFIG_SW_CHANNEL_PLAN -+ -+ chnlPlan = hw_chnlPlan; -+ } ++ if (!rtw_is_channel_plan_valid(sw_channel_plan)) ++ swConfig = false; ++ if (hw_channel_plan & EEPROM_CHANNEL_PLAN_BY_HW_MASK) ++ swConfig = false; + } + -+ if ((_FALSE == pHalData->bDisableSWChannelPlan) -+ && rtw_is_channel_plan_valid(sw_channel_plan)) -+ { ++ if (swConfig == true) + chnlPlan = sw_channel_plan; -+ } ++ else ++ chnlPlan = hw_channel_plan & (~EEPROM_CHANNEL_PLAN_BY_HW_MASK); ++ ++ if (!rtw_is_channel_plan_valid(chnlPlan)) ++ chnlPlan = def_channel_plan; + + return chnlPlan; +} + -+BOOLEAN ++bool +HAL_IsLegalChannel( -+ IN PADAPTER Adapter, -+ IN u32 Channel ++ PADAPTER Adapter, ++ u32 Channel + ) +{ -+ BOOLEAN bLegalChannel = _TRUE; ++ bool bLegalChannel = true; + + if (Channel > 14) { -+ if(IsSupported5G(Adapter->registrypriv.wireless_mode) == _FALSE) { -+ bLegalChannel = _FALSE; ++ if(IsSupported5G(Adapter->registrypriv.wireless_mode) == false) { ++ bLegalChannel = false; + DBG_871X("Channel > 14 but wireless_mode do not support 5G\n"); + } + } else if ((Channel <= 14) && (Channel >=1)){ -+ if(IsSupported24G(Adapter->registrypriv.wireless_mode) == _FALSE) { -+ bLegalChannel = _FALSE; ++ if(IsSupported24G(Adapter->registrypriv.wireless_mode) == false) { ++ bLegalChannel = false; + DBG_871X("(Channel <= 14) && (Channel >=1) but wireless_mode do not support 2.4G\n"); + } + } else { -+ bLegalChannel = _FALSE; ++ bLegalChannel = false; + DBG_871X("Channel is Invalid !!!\n"); + } + + return bLegalChannel; -+} ++} + +u8 MRateToHwRate(u8 rate) +{ + u8 ret = DESC_RATE1M; -+ ++ + switch(rate) + { -+ case MGN_1M: ret = DESC_RATE1M; break; -+ case MGN_2M: ret = DESC_RATE2M; break; -+ case MGN_5_5M: ret = DESC_RATE5_5M; break; -+ case MGN_11M: ret = DESC_RATE11M; break; -+ case MGN_6M: ret = DESC_RATE6M; break; -+ case MGN_9M: ret = DESC_RATE9M; break; -+ case MGN_12M: ret = DESC_RATE12M; break; -+ case MGN_18M: ret = DESC_RATE18M; break; -+ case MGN_24M: ret = DESC_RATE24M; break; -+ case MGN_36M: ret = DESC_RATE36M; break; -+ case MGN_48M: ret = DESC_RATE48M; break; -+ case MGN_54M: ret = DESC_RATE54M; break; ++ // CCK and OFDM non-HT rates ++ case IEEE80211_CCK_RATE_1MB: ret = DESC_RATE1M; break; ++ case IEEE80211_CCK_RATE_2MB: ret = DESC_RATE2M; break; ++ case IEEE80211_CCK_RATE_5MB: ret = DESC_RATE5_5M; break; ++ case IEEE80211_CCK_RATE_11MB: ret = DESC_RATE11M; break; ++ case IEEE80211_OFDM_RATE_6MB: ret = DESC_RATE6M; break; ++ case IEEE80211_OFDM_RATE_9MB: ret = DESC_RATE9M; break; ++ case IEEE80211_OFDM_RATE_12MB: ret = DESC_RATE12M; break; ++ case IEEE80211_OFDM_RATE_18MB: ret = DESC_RATE18M; break; ++ case IEEE80211_OFDM_RATE_24MB: ret = DESC_RATE24M; break; ++ case IEEE80211_OFDM_RATE_36MB: ret = DESC_RATE36M; break; ++ case IEEE80211_OFDM_RATE_48MB: ret = DESC_RATE48M; break; ++ case IEEE80211_OFDM_RATE_54MB: ret = DESC_RATE54M; break; + -+ case MGN_MCS0: ret = DESC_RATEMCS0; break; -+ case MGN_MCS1: ret = DESC_RATEMCS1; break; -+ case MGN_MCS2: ret = DESC_RATEMCS2; break; -+ case MGN_MCS3: ret = DESC_RATEMCS3; break; -+ case MGN_MCS4: ret = DESC_RATEMCS4; break; -+ case MGN_MCS5: ret = DESC_RATEMCS5; break; -+ case MGN_MCS6: ret = DESC_RATEMCS6; break; -+ case MGN_MCS7: ret = DESC_RATEMCS7; break; -+ case MGN_MCS8: ret = DESC_RATEMCS8; break; -+ case MGN_MCS9: ret = DESC_RATEMCS9; break; -+ case MGN_MCS10: ret = DESC_RATEMCS10; break; -+ case MGN_MCS11: ret = DESC_RATEMCS11; break; -+ case MGN_MCS12: ret = DESC_RATEMCS12; break; -+ case MGN_MCS13: ret = DESC_RATEMCS13; break; -+ case MGN_MCS14: ret = DESC_RATEMCS14; break; -+ case MGN_MCS15: ret = DESC_RATEMCS15; break; -+ case MGN_MCS16: ret = DESC_RATEMCS16; break; -+ case MGN_MCS17: ret = DESC_RATEMCS17; break; -+ case MGN_MCS18: ret = DESC_RATEMCS18; break; -+ case MGN_MCS19: ret = DESC_RATEMCS19; break; -+ case MGN_MCS20: ret = DESC_RATEMCS20; break; -+ case MGN_MCS21: ret = DESC_RATEMCS21; break; -+ case MGN_MCS22: ret = DESC_RATEMCS22; break; -+ case MGN_MCS23: ret = DESC_RATEMCS23; break; -+ case MGN_MCS24: ret = DESC_RATEMCS24; break; -+ case MGN_MCS25: ret = DESC_RATEMCS25; break; -+ case MGN_MCS26: ret = DESC_RATEMCS26; break; -+ case MGN_MCS27: ret = DESC_RATEMCS27; break; -+ case MGN_MCS28: ret = DESC_RATEMCS28; break; -+ case MGN_MCS29: ret = DESC_RATEMCS29; break; -+ case MGN_MCS30: ret = DESC_RATEMCS30; break; -+ case MGN_MCS31: ret = DESC_RATEMCS31; break; ++ // HT rates since here ++ //case MGN_MCS0: ret = DESC_RATEMCS0; break; ++ //case MGN_MCS1: ret = DESC_RATEMCS1; break; ++ //case MGN_MCS2: ret = DESC_RATEMCS2; break; ++ //case MGN_MCS3: ret = DESC_RATEMCS3; break; ++ //case MGN_MCS4: ret = DESC_RATEMCS4; break; ++ //case MGN_MCS5: ret = DESC_RATEMCS5; break; ++ //case MGN_MCS6: ret = DESC_RATEMCS6; break; ++ //case MGN_MCS7: ret = DESC_RATEMCS7; break; + -+ case MGN_VHT1SS_MCS0: ret = DESC_RATEVHTSS1MCS0; break; -+ case MGN_VHT1SS_MCS1: ret = DESC_RATEVHTSS1MCS1; break; -+ case MGN_VHT1SS_MCS2: ret = DESC_RATEVHTSS1MCS2; break; -+ case MGN_VHT1SS_MCS3: ret = DESC_RATEVHTSS1MCS3; break; -+ case MGN_VHT1SS_MCS4: ret = DESC_RATEVHTSS1MCS4; break; -+ case MGN_VHT1SS_MCS5: ret = DESC_RATEVHTSS1MCS5; break; -+ case MGN_VHT1SS_MCS6: ret = DESC_RATEVHTSS1MCS6; break; -+ case MGN_VHT1SS_MCS7: ret = DESC_RATEVHTSS1MCS7; break; -+ case MGN_VHT1SS_MCS8: ret = DESC_RATEVHTSS1MCS8; break; -+ case MGN_VHT1SS_MCS9: ret = DESC_RATEVHTSS1MCS9; break; -+ case MGN_VHT2SS_MCS0: ret = DESC_RATEVHTSS2MCS0; break; -+ case MGN_VHT2SS_MCS1: ret = DESC_RATEVHTSS2MCS1; break; -+ case MGN_VHT2SS_MCS2: ret = DESC_RATEVHTSS2MCS2; break; -+ case MGN_VHT2SS_MCS3: ret = DESC_RATEVHTSS2MCS3; break; -+ case MGN_VHT2SS_MCS4: ret = DESC_RATEVHTSS2MCS4; break; -+ case MGN_VHT2SS_MCS5: ret = DESC_RATEVHTSS2MCS5; break; -+ case MGN_VHT2SS_MCS6: ret = DESC_RATEVHTSS2MCS6; break; -+ case MGN_VHT2SS_MCS7: ret = DESC_RATEVHTSS2MCS7; break; -+ case MGN_VHT2SS_MCS8: ret = DESC_RATEVHTSS2MCS8; break; -+ case MGN_VHT2SS_MCS9: ret = DESC_RATEVHTSS2MCS9; break; -+ case MGN_VHT3SS_MCS0: ret = DESC_RATEVHTSS3MCS0; break; -+ case MGN_VHT3SS_MCS1: ret = DESC_RATEVHTSS3MCS1; break; -+ case MGN_VHT3SS_MCS2: ret = DESC_RATEVHTSS3MCS2; break; -+ case MGN_VHT3SS_MCS3: ret = DESC_RATEVHTSS3MCS3; break; -+ case MGN_VHT3SS_MCS4: ret = DESC_RATEVHTSS3MCS4; break; -+ case MGN_VHT3SS_MCS5: ret = DESC_RATEVHTSS3MCS5; break; -+ case MGN_VHT3SS_MCS6: ret = DESC_RATEVHTSS3MCS6; break; -+ case MGN_VHT3SS_MCS7: ret = DESC_RATEVHTSS3MCS7; break; -+ case MGN_VHT3SS_MCS8: ret = DESC_RATEVHTSS3MCS8; break; -+ case MGN_VHT3SS_MCS9: ret = DESC_RATEVHTSS3MCS9; break; -+ case MGN_VHT4SS_MCS0: ret = DESC_RATEVHTSS4MCS0; break; -+ case MGN_VHT4SS_MCS1: ret = DESC_RATEVHTSS4MCS1; break; -+ case MGN_VHT4SS_MCS2: ret = DESC_RATEVHTSS4MCS2; break; -+ case MGN_VHT4SS_MCS3: ret = DESC_RATEVHTSS4MCS3; break; -+ case MGN_VHT4SS_MCS4: ret = DESC_RATEVHTSS4MCS4; break; -+ case MGN_VHT4SS_MCS5: ret = DESC_RATEVHTSS4MCS5; break; -+ case MGN_VHT4SS_MCS6: ret = DESC_RATEVHTSS4MCS6; break; -+ case MGN_VHT4SS_MCS7: ret = DESC_RATEVHTSS4MCS7; break; -+ case MGN_VHT4SS_MCS8: ret = DESC_RATEVHTSS4MCS8; break; -+ case MGN_VHT4SS_MCS9: ret = DESC_RATEVHTSS4MCS9; break; -+ default: break; ++ default: break; + } + + return ret; +} + -+u8 HwRateToMRate(u8 rate) -+{ -+ u8 ret_rate = MGN_1M; -+ -+ switch(rate) -+ { -+ -+ case DESC_RATE1M: ret_rate = MGN_1M; break; -+ case DESC_RATE2M: ret_rate = MGN_2M; break; -+ case DESC_RATE5_5M: ret_rate = MGN_5_5M; break; -+ case DESC_RATE11M: ret_rate = MGN_11M; break; -+ case DESC_RATE6M: ret_rate = MGN_6M; break; -+ case DESC_RATE9M: ret_rate = MGN_9M; break; -+ case DESC_RATE12M: ret_rate = MGN_12M; break; -+ case DESC_RATE18M: ret_rate = MGN_18M; break; -+ case DESC_RATE24M: ret_rate = MGN_24M; break; -+ case DESC_RATE36M: ret_rate = MGN_36M; break; -+ case DESC_RATE48M: ret_rate = MGN_48M; break; -+ case DESC_RATE54M: ret_rate = MGN_54M; break; -+ case DESC_RATEMCS0: ret_rate = MGN_MCS0; break; -+ case DESC_RATEMCS1: ret_rate = MGN_MCS1; break; -+ case DESC_RATEMCS2: ret_rate = MGN_MCS2; break; -+ case DESC_RATEMCS3: ret_rate = MGN_MCS3; break; -+ case DESC_RATEMCS4: ret_rate = MGN_MCS4; break; -+ case DESC_RATEMCS5: ret_rate = MGN_MCS5; break; -+ case DESC_RATEMCS6: ret_rate = MGN_MCS6; break; -+ case DESC_RATEMCS7: ret_rate = MGN_MCS7; break; -+ case DESC_RATEMCS8: ret_rate = MGN_MCS8; break; -+ case DESC_RATEMCS9: ret_rate = MGN_MCS9; break; -+ case DESC_RATEMCS10: ret_rate = MGN_MCS10; break; -+ case DESC_RATEMCS11: ret_rate = MGN_MCS11; break; -+ case DESC_RATEMCS12: ret_rate = MGN_MCS12; break; -+ case DESC_RATEMCS13: ret_rate = MGN_MCS13; break; -+ case DESC_RATEMCS14: ret_rate = MGN_MCS14; break; -+ case DESC_RATEMCS15: ret_rate = MGN_MCS15; break; -+ case DESC_RATEMCS16: ret_rate = MGN_MCS16; break; -+ case DESC_RATEMCS17: ret_rate = MGN_MCS17; break; -+ case DESC_RATEMCS18: ret_rate = MGN_MCS18; break; -+ case DESC_RATEMCS19: ret_rate = MGN_MCS19; break; -+ case DESC_RATEMCS20: ret_rate = MGN_MCS20; break; -+ case DESC_RATEMCS21: ret_rate = MGN_MCS21; break; -+ case DESC_RATEMCS22: ret_rate = MGN_MCS22; break; -+ case DESC_RATEMCS23: ret_rate = MGN_MCS23; break; -+ case DESC_RATEMCS24: ret_rate = MGN_MCS24; break; -+ case DESC_RATEMCS25: ret_rate = MGN_MCS25; break; -+ case DESC_RATEMCS26: ret_rate = MGN_MCS26; break; -+ case DESC_RATEMCS27: ret_rate = MGN_MCS27; break; -+ case DESC_RATEMCS28: ret_rate = MGN_MCS28; break; -+ case DESC_RATEMCS29: ret_rate = MGN_MCS29; break; -+ case DESC_RATEMCS30: ret_rate = MGN_MCS30; break; -+ case DESC_RATEMCS31: ret_rate = MGN_MCS31; break; -+ case DESC_RATEVHTSS1MCS0: ret_rate = MGN_VHT1SS_MCS0; break; -+ case DESC_RATEVHTSS1MCS1: ret_rate = MGN_VHT1SS_MCS1; break; -+ case DESC_RATEVHTSS1MCS2: ret_rate = MGN_VHT1SS_MCS2; break; -+ case DESC_RATEVHTSS1MCS3: ret_rate = MGN_VHT1SS_MCS3; break; -+ case DESC_RATEVHTSS1MCS4: ret_rate = MGN_VHT1SS_MCS4; break; -+ case DESC_RATEVHTSS1MCS5: ret_rate = MGN_VHT1SS_MCS5; break; -+ case DESC_RATEVHTSS1MCS6: ret_rate = MGN_VHT1SS_MCS6; break; -+ case DESC_RATEVHTSS1MCS7: ret_rate = MGN_VHT1SS_MCS7; break; -+ case DESC_RATEVHTSS1MCS8: ret_rate = MGN_VHT1SS_MCS8; break; -+ case DESC_RATEVHTSS1MCS9: ret_rate = MGN_VHT1SS_MCS9; break; -+ case DESC_RATEVHTSS2MCS0: ret_rate = MGN_VHT2SS_MCS0; break; -+ case DESC_RATEVHTSS2MCS1: ret_rate = MGN_VHT2SS_MCS1; break; -+ case DESC_RATEVHTSS2MCS2: ret_rate = MGN_VHT2SS_MCS2; break; -+ case DESC_RATEVHTSS2MCS3: ret_rate = MGN_VHT2SS_MCS3; break; -+ case DESC_RATEVHTSS2MCS4: ret_rate = MGN_VHT2SS_MCS4; break; -+ case DESC_RATEVHTSS2MCS5: ret_rate = MGN_VHT2SS_MCS5; break; -+ case DESC_RATEVHTSS2MCS6: ret_rate = MGN_VHT2SS_MCS6; break; -+ case DESC_RATEVHTSS2MCS7: ret_rate = MGN_VHT2SS_MCS7; break; -+ case DESC_RATEVHTSS2MCS8: ret_rate = MGN_VHT2SS_MCS8; break; -+ case DESC_RATEVHTSS2MCS9: ret_rate = MGN_VHT2SS_MCS9; break; -+ case DESC_RATEVHTSS3MCS0: ret_rate = MGN_VHT3SS_MCS0; break; -+ case DESC_RATEVHTSS3MCS1: ret_rate = MGN_VHT3SS_MCS1; break; -+ case DESC_RATEVHTSS3MCS2: ret_rate = MGN_VHT3SS_MCS2; break; -+ case DESC_RATEVHTSS3MCS3: ret_rate = MGN_VHT3SS_MCS3; break; -+ case DESC_RATEVHTSS3MCS4: ret_rate = MGN_VHT3SS_MCS4; break; -+ case DESC_RATEVHTSS3MCS5: ret_rate = MGN_VHT3SS_MCS5; break; -+ case DESC_RATEVHTSS3MCS6: ret_rate = MGN_VHT3SS_MCS6; break; -+ case DESC_RATEVHTSS3MCS7: ret_rate = MGN_VHT3SS_MCS7; break; -+ case DESC_RATEVHTSS3MCS8: ret_rate = MGN_VHT3SS_MCS8; break; -+ case DESC_RATEVHTSS3MCS9: ret_rate = MGN_VHT3SS_MCS9; break; -+ case DESC_RATEVHTSS4MCS0: ret_rate = MGN_VHT4SS_MCS0; break; -+ case DESC_RATEVHTSS4MCS1: ret_rate = MGN_VHT4SS_MCS1; break; -+ case DESC_RATEVHTSS4MCS2: ret_rate = MGN_VHT4SS_MCS2; break; -+ case DESC_RATEVHTSS4MCS3: ret_rate = MGN_VHT4SS_MCS3; break; -+ case DESC_RATEVHTSS4MCS4: ret_rate = MGN_VHT4SS_MCS4; break; -+ case DESC_RATEVHTSS4MCS5: ret_rate = MGN_VHT4SS_MCS5; break; -+ case DESC_RATEVHTSS4MCS6: ret_rate = MGN_VHT4SS_MCS6; break; -+ case DESC_RATEVHTSS4MCS7: ret_rate = MGN_VHT4SS_MCS7; break; -+ case DESC_RATEVHTSS4MCS8: ret_rate = MGN_VHT4SS_MCS8; break; -+ case DESC_RATEVHTSS4MCS9: ret_rate = MGN_VHT4SS_MCS9; break; -+ -+ default: -+ DBG_871X("HwRateToMRate(): Non supported Rate [%x]!!!\n",rate ); -+ break; -+ } -+ -+ return ret_rate; -+} -+ +void HalSetBrateCfg( -+ IN PADAPTER Adapter, -+ IN u8 *mBratesOS, -+ OUT u16 *pBrateCfg) ++ PADAPTER Adapter, ++ u8 *mBratesOS, ++ u16 *pBrateCfg) +{ + u8 i, is_brate, brate; + @@ -156768,9 +63541,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + { + is_brate = mBratesOS[i] & IEEE80211_BASIC_RATE_MASK; + brate = mBratesOS[i] & 0x7f; -+ ++ + if( is_brate ) -+ { ++ { + switch(brate) + { + case IEEE80211_CCK_RATE_1MB: *pBrateCfg |= RATE_1M; break; @@ -156790,9 +63563,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + } +} + -+static VOID ++static void +_OneOutPipeMapping( -+ IN PADAPTER pAdapter ++ PADAPTER pAdapter + ) +{ + struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); @@ -156801,156 +63574,156 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];//VI + pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[0];//BE + pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[0];//BK -+ ++ + pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN + pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT + pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];//HIGH + pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD +} + -+static VOID ++static void +_TwoOutPipeMapping( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bWIFICfg ++ PADAPTER pAdapter, ++ bool bWIFICfg + ) +{ + struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); + + if(bWIFICfg){ //WMM -+ -+ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA -+ //{ 0, 1, 0, 1, 0, 0, 0, 0, 0 }; -+ //0:ep_0 num, 1:ep_1 num -+ ++ ++ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA ++ //{ 0, 1, 0, 1, 0, 0, 0, 0, 0 }; ++ //0:H, 1:N ++ + pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[1];//VO + pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];//VI + pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[1];//BE + pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[0];//BK -+ ++ + pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN + pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT + pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];//HIGH + pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD -+ ++ + } + else{//typical setting + -+ -+ //BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA -+ //{ 1, 1, 0, 0, 0, 0, 0, 0, 0 }; -+ //0:ep_0 num, 1:ep_1 num -+ ++ ++ //BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA ++ //{ 1, 1, 0, 0, 0, 0, 0, 0, 0 }; ++ //0:H, 1:N ++ + pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];//VO + pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];//VI + pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[1];//BE + pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];//BK -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];//HIGH -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD -+ -+ } -+ -+} + -+static VOID _ThreeOutPipeMapping( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bWIFICfg -+ ) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); -+ -+ if(bWIFICfg){//for WMM -+ -+ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA -+ //{ 1, 2, 1, 0, 0, 0, 0, 0, 0 }; -+ //0:H, 1:N, 2:L -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];//VO -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];//VI -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];//BE -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];//BK -+ + pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN + pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT + pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];//HIGH + pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD -+ -+ } -+ else{//typical setting + -+ -+ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA -+ //{ 2, 2, 1, 0, 0, 0, 0, 0, 0 }; -+ //0:H, 1:N, 2:L -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];//VO -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];//VI -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];//BE -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[2];//BK -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];//HIGH -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD + } + +} -+static VOID _FourOutPipeMapping( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bWIFICfg ++ ++static void _ThreeOutPipeMapping( ++ PADAPTER pAdapter, ++ bool bWIFICfg + ) +{ + struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); + + if(bWIFICfg){//for WMM -+ -+ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA -+ //{ 1, 2, 1, 0, 0, 0, 0, 0, 0 }; ++ ++ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA ++ //{ 1, 2, 1, 0, 0, 0, 0, 0, 0 }; ++ //0:H, 1:N, 2:L ++ ++ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];//VO ++ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];//VI ++ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];//BE ++ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];//BK ++ ++ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN ++ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT ++ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];//HIGH ++ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD ++ ++ } ++ else{//typical setting ++ ++ ++ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA ++ //{ 2, 2, 1, 0, 0, 0, 0, 0, 0 }; ++ //0:H, 1:N, 2:L ++ ++ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];//VO ++ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];//VI ++ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];//BE ++ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[2];//BK ++ ++ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN ++ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT ++ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];//HIGH ++ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD ++ } ++ ++} ++static void _FourOutPipeMapping( ++ PADAPTER pAdapter, ++ bool bWIFICfg ++ ) ++{ ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); ++ ++ if(bWIFICfg){//for WMM ++ ++ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA ++ //{ 1, 2, 1, 0, 0, 0, 0, 0, 0 }; + //0:H, 1:N, 2:L ,3:E -+ ++ + pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];//VO + pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];//VI + pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];//BE + pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];//BK -+ ++ + pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN + pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT + pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[3];//HIGH + pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD -+ ++ + } + else{//typical setting + -+ -+ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA -+ //{ 2, 2, 1, 0, 0, 0, 0, 0, 0 }; -+ //0:H, 1:N, 2:L -+ ++ ++ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA ++ //{ 2, 2, 1, 0, 0, 0, 0, 0, 0 }; ++ //0:H, 1:N, 2:L ++ + pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];//VO + pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];//VI + pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];//BE + pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[2];//BK -+ ++ + pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN + pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT + pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[3];//HIGH -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD ++ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD + } + +} -+BOOLEAN ++bool +Hal_MappingOutPipe( -+ IN PADAPTER pAdapter, -+ IN u8 NumOutPipe ++ PADAPTER pAdapter, ++ u8 NumOutPipe + ) +{ + struct registry_priv *pregistrypriv = &pAdapter->registrypriv; + -+ BOOLEAN bWIFICfg = (pregistrypriv->wifi_spec) ?_TRUE:_FALSE; -+ -+ BOOLEAN result = _TRUE; ++ bool bWIFICfg = (pregistrypriv->wifi_spec) ?true:false; ++ ++ bool result = true; + + switch(NumOutPipe) + { @@ -156960,39 +63733,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + case 3: + case 4: + _ThreeOutPipeMapping(pAdapter, bWIFICfg); -+ break; ++ break; + case 1: + _OneOutPipeMapping(pAdapter); + break; + default: -+ result = _FALSE; ++ result = false; + break; + } + + return result; -+ ++ +} + +void hal_init_macaddr(_adapter *adapter) +{ -+ rtw_hal_set_hwreg(adapter, HW_VAR_MAC_ADDR, adapter_mac_addr(adapter)); ++ rtw_hal_set_hwreg(adapter, HW_VAR_MAC_ADDR, adapter->eeprompriv.mac_addr); +#ifdef CONFIG_CONCURRENT_MODE + if (adapter->pbuddy_adapter) -+ rtw_hal_set_hwreg(adapter->pbuddy_adapter, HW_VAR_MAC_ADDR, adapter_mac_addr(adapter->pbuddy_adapter)); ++ rtw_hal_set_hwreg(adapter->pbuddy_adapter, HW_VAR_MAC_ADDR, adapter->pbuddy_adapter->eeprompriv.mac_addr); +#endif +} + -+void rtw_init_hal_com_default_value(PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ pHalData->AntDetection = 1; -+} -+ -+/* ++/* +* C2H event format: -+* Field TRIGGER CONTENT CMD_SEQ CMD_LEN CMD_ID -+* BITS [127:120] [119:16] [15:8] [7:4] [3:0] ++* Field TRIGGER CONTENT CMD_SEQ CMD_LEN CMD_ID ++* BITS [127:120] [119:16] [15:8] [7:4] [3:0] +*/ + +void c2h_evt_clear(_adapter *adapter) @@ -157010,8 +63776,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + if (buf == NULL) + goto exit; + -+#if defined (CONFIG_RTL8188E) -+ + trigger = rtw_read8(adapter, REG_C2HEVT_CLEAR); + + if (trigger == C2H_EVT_HOST_CLOSE) { @@ -157025,7 +63789,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + _rtw_memset(c2h_evt, 0, 16); + + *buf = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL); -+ *(buf+1) = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL + 1); ++ *(buf+1) = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL + 1); + + RT_PRINT_DATA(_module_hal_init_c_, _drv_info_, "c2h_evt_read(): ", + &c2h_evt , sizeof(c2h_evt)); @@ -157037,7 +63801,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + + /* Read the content */ + for (i = 0; i < c2h_evt->plen; i++) -+ c2h_evt->payload[i] = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL + 2 + i); ++ c2h_evt->payload[i] = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL + sizeof(*c2h_evt) + i); + + RT_PRINT_DATA(_module_hal_init_c_, _drv_info_, "c2h_evt_read(): Command Content:\n", + c2h_evt->payload, c2h_evt->plen); @@ -157045,3239 +63809,45975 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + ret = _SUCCESS; + +clear_evt: -+ /* ++ /* + * Clear event to notify FW we have read the command. + * If this field isn't clear, the FW won't update the next command message. + */ + c2h_evt_clear(adapter); -+#endif +exit: + return ret; +} + -+/* -+* C2H event format: -+* Field TRIGGER CMD_LEN CONTENT CMD_SEQ CMD_ID -+* BITS [127:120] [119:112] [111:16] [15:8] [7:0] -+*/ -+s32 c2h_evt_read_88xx(_adapter *adapter, u8 *buf) -+{ -+ s32 ret = _FAIL; -+ struct c2h_evt_hdr_88xx *c2h_evt; -+ int i; -+ u8 trigger; -+ -+ if (buf == NULL) -+ goto exit; -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) -+ -+ trigger = rtw_read8(adapter, REG_C2HEVT_CLEAR); -+ -+ if (trigger == C2H_EVT_HOST_CLOSE) { -+ goto exit; /* Not ready */ -+ } else if (trigger != C2H_EVT_FW_CLOSE) { -+ goto clear_evt; /* Not a valid value */ -+ } -+ -+ c2h_evt = (struct c2h_evt_hdr_88xx *)buf; -+ -+ _rtw_memset(c2h_evt, 0, 16); -+ -+ c2h_evt->id = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL); -+ c2h_evt->seq = rtw_read8(adapter, REG_C2HEVT_CMD_SEQ_88XX); -+ c2h_evt->plen = rtw_read8(adapter, REG_C2HEVT_CMD_LEN_88XX); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_info_, "c2h_evt_read(): ", -+ &c2h_evt , sizeof(c2h_evt)); -+ -+ if (0) { -+ DBG_871X("%s id:%u, len:%u, seq:%u, trigger:0x%02x\n", __func__ -+ , c2h_evt->id, c2h_evt->plen, c2h_evt->seq, trigger); -+ } -+ -+ /* Read the content */ -+ for (i = 0; i < c2h_evt->plen; i++) -+ c2h_evt->payload[i] = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL + 2 + i); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_info_, "c2h_evt_read(): Command Content:\n", -+ c2h_evt->payload, c2h_evt->plen); -+ -+ ret = _SUCCESS; -+ -+clear_evt: -+ /* -+ * Clear event to notify FW we have read the command. -+ * If this field isn't clear, the FW won't update the next command message. -+ */ -+ c2h_evt_clear(adapter); -+#endif -+exit: -+ return ret; -+} -+ -+ -+u8 rtw_hal_networktype_to_raid(_adapter *adapter, struct sta_info *psta) ++u8 rtw_hal_networktype_to_raid(_adapter *adapter,unsigned char network_type) +{ + if(IS_NEW_GENERATION_IC(adapter)){ -+ return networktype_to_raid_ex(adapter,psta); ++ return networktype_to_raid_ex(adapter,network_type); + } + else{ -+ return networktype_to_raid(adapter,psta); ++ return networktype_to_raid(adapter,network_type); + } + +} +u8 rtw_get_mgntframe_raid(_adapter *adapter,unsigned char network_type) -+{ ++{ + + u8 raid; + if(IS_NEW_GENERATION_IC(adapter)){ -+ ++ + raid = (network_type & WIRELESS_11B) ?RATEID_IDX_B -+ :RATEID_IDX_G; ++ :RATEID_IDX_G; + } + else{ + raid = (network_type & WIRELESS_11B) ?RATR_INX_WIRELESS_B -+ :RATR_INX_WIRELESS_G; -+ } ++ :RATR_INX_WIRELESS_G; ++ } + return raid; +} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/hal_com_phycfg.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_com_phycfg.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/hal_com_phycfg.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_com_phycfg.c 2018-02-06 17:42:30.709967150 +0200 +@@ -0,0 +1,97 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++#define _HAL_COM_PHYCFG_C_ + -+void rtw_hal_update_sta_rate_mask(PADAPTER padapter, struct sta_info *psta) ++#include ++ ++ ++#ifndef CONFIG_EMBEDDED_FWIMG ++int ++phy_ConfigMACWithParaFile( ++ IN PADAPTER Adapter, ++ IN u8* pFileName ++) +{ -+ u8 i, rf_type, limit; -+ u64 tx_ra_bitmap; ++ int rtStatus = _FAIL; + ++ return rtStatus; ++} ++ ++int ++PHY_ConfigBBWithPowerLimitTableParaFile( ++ IN PADAPTER Adapter, ++ IN s8* pFileName ++) ++{ ++ int rtStatus = _SUCCESS; ++ ++ return rtStatus; ++} ++ ++int ++phy_ConfigBBWithParaFile( ++ IN PADAPTER Adapter, ++ IN u8* pFileName ++) ++{ ++ int rtStatus = _SUCCESS; ++ ++ return rtStatus; ++} ++ ++int ++phy_ConfigBBWithPgParaFile( ++ IN PADAPTER Adapter, ++ IN u8* pFileName) ++{ ++ int rtStatus = _SUCCESS; ++ ++ return rtStatus; ++} ++ ++int ++phy_ConfigBBWithMpParaFile( ++ IN PADAPTER Adapter, ++ IN u8* pFileName ++) ++{ ++ int rtStatus = _SUCCESS; ++ ++ return rtStatus; ++} ++ ++int ++PHY_ConfigRFWithParaFile( ++ IN PADAPTER Adapter, ++ IN u8* pFileName, ++ IN u8 eRFPath ++) ++{ ++ int rtStatus = _SUCCESS; ++ ++ return rtStatus; ++} ++ ++int ++PHY_ConfigRFWithTxPwrTrackParaFile( ++ IN PADAPTER Adapter, ++ IN u8* pFileName ++) ++{ ++ int rtStatus = _SUCCESS; ++ ++ return rtStatus; ++} ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.c 2018-02-06 17:42:30.702967046 +0200 +@@ -0,0 +1,1429 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#include "odm_precomp.h" ++ ++static bool ++CheckCondition( ++ const u4Byte Condition, ++ const u4Byte Hex ++ ) ++{ ++ u4Byte _board = (Hex & 0x000000FF); ++ u4Byte _interface = (Hex & 0x0000FF00) >> 8; ++ u4Byte _platform = (Hex & 0x00FF0000) >> 16; ++ u4Byte cond = Condition; ++ ++ if ( Condition == 0xCDCDCDCD ) ++ return true; ++ ++ cond = Condition & 0x000000FF; ++ if ( (_board != cond) && (cond != 0xFF) ) ++ return false; ++ ++ cond = Condition & 0x0000FF00; ++ cond = cond >> 8; ++ if ( ((_interface & cond) == 0) && (cond != 0x07) ) ++ return false; ++ ++ cond = Condition & 0x00FF0000; ++ cond = cond >> 16; ++ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) ++ return false; ++ return true; ++} ++ ++ ++/****************************************************************************** ++* AGC_TAB.TXT ++******************************************************************************/ ++ ++u4Byte Array_MP_8812A_AGC_TAB[] = { ++ 0xFF0F07D8, 0xABCD, ++ 0x81C, 0xFF000001, ++ 0x81C, 0xFF020001, ++ 0x81C, 0xFF040001, ++ 0x81C, 0xFE060001, ++ 0x81C, 0xFD080001, ++ 0x81C, 0xFC0A0001, ++ 0x81C, 0xFB0C0001, ++ 0x81C, 0xFA0E0001, ++ 0x81C, 0xF9100001, ++ 0x81C, 0xF8120001, ++ 0x81C, 0xF7140001, ++ 0x81C, 0xF6160001, ++ 0x81C, 0xF5180001, ++ 0x81C, 0xF41A0001, ++ 0x81C, 0xF31C0001, ++ 0x81C, 0xF21E0001, ++ 0x81C, 0xF1200001, ++ 0x81C, 0xF0220001, ++ 0x81C, 0xEF240001, ++ 0x81C, 0xEE260001, ++ 0x81C, 0xED280001, ++ 0x81C, 0xEC2A0001, ++ 0x81C, 0xEB2C0001, ++ 0x81C, 0xEA2E0001, ++ 0x81C, 0xE9300001, ++ 0x81C, 0xE8320001, ++ 0x81C, 0xC7340001, ++ 0x81C, 0xC6360001, ++ 0x81C, 0xC5380001, ++ 0x81C, 0xC43A0001, ++ 0x81C, 0xC33C0001, ++ 0x81C, 0xC23E0001, ++ 0x81C, 0xC1400001, ++ 0x81C, 0xA6420001, ++ 0x81C, 0xA5440001, ++ 0x81C, 0xA4460001, ++ 0x81C, 0x69480001, ++ 0x81C, 0x684A0001, ++ 0x81C, 0x674C0001, ++ 0x81C, 0x664E0001, ++ 0x81C, 0x65500001, ++ 0x81C, 0x64520001, ++ 0x81C, 0x63540001, ++ 0x81C, 0x62560001, ++ 0x81C, 0x48580001, ++ 0x81C, 0x475A0001, ++ 0x81C, 0x465C0001, ++ 0x81C, 0x455E0001, ++ 0x81C, 0x44600001, ++ 0x81C, 0x43620001, ++ 0x81C, 0x42640001, ++ 0x81C, 0x41660001, ++ 0x81C, 0x41680001, ++ 0x81C, 0x416A0001, ++ 0x81C, 0x416C0001, ++ 0x81C, 0x416E0001, ++ 0x81C, 0x41700001, ++ 0x81C, 0x41720001, ++ 0x81C, 0x41740001, ++ 0x81C, 0x41760001, ++ 0x81C, 0x41780001, ++ 0x81C, 0x417A0001, ++ 0x81C, 0x417C0001, ++ 0x81C, 0x417E0001, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x81C, 0xFF000001, ++ 0x81C, 0xFF020001, ++ 0x81C, 0xFF040001, ++ 0x81C, 0xFF060001, ++ 0x81C, 0xFF080001, ++ 0x81C, 0xFE0A0001, ++ 0x81C, 0xFD0C0001, ++ 0x81C, 0xFC0E0001, ++ 0x81C, 0xFB100001, ++ 0x81C, 0xFA120001, ++ 0x81C, 0xF9140001, ++ 0x81C, 0xF8160001, ++ 0x81C, 0xF7180001, ++ 0x81C, 0xF61A0001, ++ 0x81C, 0xF51C0001, ++ 0x81C, 0xF41E0001, ++ 0x81C, 0xF3200001, ++ 0x81C, 0xF2220001, ++ 0x81C, 0xF1240001, ++ 0x81C, 0xF0260001, ++ 0x81C, 0xEF280001, ++ 0x81C, 0xEE2A0001, ++ 0x81C, 0xED2C0001, ++ 0x81C, 0xEC2E0001, ++ 0x81C, 0xEB300001, ++ 0x81C, 0xEA320001, ++ 0x81C, 0xE9340001, ++ 0x81C, 0xE8360001, ++ 0x81C, 0xE7380001, ++ 0x81C, 0xE63A0001, ++ 0x81C, 0xE53C0001, ++ 0x81C, 0xC73E0001, ++ 0x81C, 0xC6400001, ++ 0x81C, 0xC5420001, ++ 0x81C, 0xC4440001, ++ 0x81C, 0xC3460001, ++ 0x81C, 0xC2480001, ++ 0x81C, 0xC14A0001, ++ 0x81C, 0xA74C0001, ++ 0x81C, 0xA64E0001, ++ 0x81C, 0xA5500001, ++ 0x81C, 0xA4520001, ++ 0x81C, 0xA3540001, ++ 0x81C, 0xA2560001, ++ 0x81C, 0xA1580001, ++ 0x81C, 0x675A0001, ++ 0x81C, 0x665C0001, ++ 0x81C, 0x655E0001, ++ 0x81C, 0x64600001, ++ 0x81C, 0x63620001, ++ 0x81C, 0x48640001, ++ 0x81C, 0x47660001, ++ 0x81C, 0x46680001, ++ 0x81C, 0x456A0001, ++ 0x81C, 0x446C0001, ++ 0x81C, 0x436E0001, ++ 0x81C, 0x42700001, ++ 0x81C, 0x41720001, ++ 0x81C, 0x41740001, ++ 0x81C, 0x41760001, ++ 0x81C, 0x41780001, ++ 0x81C, 0x417A0001, ++ 0x81C, 0x417C0001, ++ 0x81C, 0x417E0001, ++ 0xFF0F07D8, 0xDEAD, ++ 0xFF0F0780, 0xABCD, ++ 0x81C, 0xFC800001, ++ 0x81C, 0xFB820001, ++ 0x81C, 0xFA840001, ++ 0x81C, 0xF9860001, ++ 0x81C, 0xF8880001, ++ 0x81C, 0xF78A0001, ++ 0x81C, 0xF68C0001, ++ 0x81C, 0xF58E0001, ++ 0x81C, 0xF4900001, ++ 0x81C, 0xF3920001, ++ 0x81C, 0xF2940001, ++ 0x81C, 0xF1960001, ++ 0x81C, 0xF0980001, ++ 0x81C, 0xEF9A0001, ++ 0x81C, 0xEE9C0001, ++ 0x81C, 0xED9E0001, ++ 0x81C, 0xECA00001, ++ 0x81C, 0xEBA20001, ++ 0x81C, 0xEAA40001, ++ 0x81C, 0xE9A60001, ++ 0x81C, 0xE8A80001, ++ 0x81C, 0xE7AA0001, ++ 0x81C, 0xE6AC0001, ++ 0x81C, 0xE5AE0001, ++ 0x81C, 0xE4B00001, ++ 0x81C, 0xE3B20001, ++ 0x81C, 0xA8B40001, ++ 0x81C, 0xA7B60001, ++ 0x81C, 0xA6B80001, ++ 0x81C, 0xA5BA0001, ++ 0x81C, 0xA4BC0001, ++ 0x81C, 0xA3BE0001, ++ 0x81C, 0xA2C00001, ++ 0x81C, 0xA1C20001, ++ 0x81C, 0x68C40001, ++ 0x81C, 0x67C60001, ++ 0x81C, 0x66C80001, ++ 0x81C, 0x65CA0001, ++ 0x81C, 0x64CC0001, ++ 0x81C, 0x47CE0001, ++ 0x81C, 0x46D00001, ++ 0x81C, 0x45D20001, ++ 0x81C, 0x44D40001, ++ 0x81C, 0x43D60001, ++ 0x81C, 0x42D80001, ++ 0x81C, 0x08DA0001, ++ 0x81C, 0x07DC0001, ++ 0x81C, 0x06DE0001, ++ 0x81C, 0x05E00001, ++ 0x81C, 0x04E20001, ++ 0x81C, 0x03E40001, ++ 0x81C, 0x02E60001, ++ 0x81C, 0x01E80001, ++ 0x81C, 0x01EA0001, ++ 0x81C, 0x01EC0001, ++ 0x81C, 0x01EE0001, ++ 0x81C, 0x01F00001, ++ 0x81C, 0x01F20001, ++ 0x81C, 0x01F40001, ++ 0x81C, 0x01F60001, ++ 0x81C, 0x01F80001, ++ 0x81C, 0x01FA0001, ++ 0x81C, 0x01FC0001, ++ 0x81C, 0x01FE0001, ++ 0xFF0F07C0, 0xCDEF, ++ 0x81C, 0xFC800001, ++ 0x81C, 0xFB820001, ++ 0x81C, 0xFA840001, ++ 0x81C, 0xF9860001, ++ 0x81C, 0xF8880001, ++ 0x81C, 0xF78A0001, ++ 0x81C, 0xF68C0001, ++ 0x81C, 0xF58E0001, ++ 0x81C, 0xF4900001, ++ 0x81C, 0xF3920001, ++ 0x81C, 0xF2940001, ++ 0x81C, 0xF1960001, ++ 0x81C, 0xF0980001, ++ 0x81C, 0xEF9A0001, ++ 0x81C, 0xEE9C0001, ++ 0x81C, 0xED9E0001, ++ 0x81C, 0xECA00001, ++ 0x81C, 0xEBA20001, ++ 0x81C, 0xEAA40001, ++ 0x81C, 0xE9A60001, ++ 0x81C, 0xE8A80001, ++ 0x81C, 0xE7AA0001, ++ 0x81C, 0xE6AC0001, ++ 0x81C, 0xE5AE0001, ++ 0x81C, 0xE4B00001, ++ 0x81C, 0xE3B20001, ++ 0x81C, 0xA8B40001, ++ 0x81C, 0xA7B60001, ++ 0x81C, 0xA6B80001, ++ 0x81C, 0xA5BA0001, ++ 0x81C, 0xA4BC0001, ++ 0x81C, 0xA3BE0001, ++ 0x81C, 0xA2C00001, ++ 0x81C, 0xA1C20001, ++ 0x81C, 0x68C40001, ++ 0x81C, 0x67C60001, ++ 0x81C, 0x66C80001, ++ 0x81C, 0x65CA0001, ++ 0x81C, 0x64CC0001, ++ 0x81C, 0x47CE0001, ++ 0x81C, 0x46D00001, ++ 0x81C, 0x45D20001, ++ 0x81C, 0x44D40001, ++ 0x81C, 0x43D60001, ++ 0x81C, 0x42D80001, ++ 0x81C, 0x08DA0001, ++ 0x81C, 0x07DC0001, ++ 0x81C, 0x06DE0001, ++ 0x81C, 0x05E00001, ++ 0x81C, 0x04E20001, ++ 0x81C, 0x03E40001, ++ 0x81C, 0x02E60001, ++ 0x81C, 0x01E80001, ++ 0x81C, 0x01EA0001, ++ 0x81C, 0x01EC0001, ++ 0x81C, 0x01EE0001, ++ 0x81C, 0x01F00001, ++ 0x81C, 0x01F20001, ++ 0x81C, 0x01F40001, ++ 0x81C, 0x01F60001, ++ 0x81C, 0x01F80001, ++ 0x81C, 0x01FA0001, ++ 0x81C, 0x01FC0001, ++ 0x81C, 0x01FE0001, ++ 0xFF0F07D8, 0xCDEF, ++ 0x81C, 0xFC800001, ++ 0x81C, 0xFB820001, ++ 0x81C, 0xFA840001, ++ 0x81C, 0xF9860001, ++ 0x81C, 0xF8880001, ++ 0x81C, 0xF78A0001, ++ 0x81C, 0xF68C0001, ++ 0x81C, 0xF58E0001, ++ 0x81C, 0xF4900001, ++ 0x81C, 0xF3920001, ++ 0x81C, 0xF2940001, ++ 0x81C, 0xF1960001, ++ 0x81C, 0xF0980001, ++ 0x81C, 0xEF9A0001, ++ 0x81C, 0xEE9C0001, ++ 0x81C, 0xED9E0001, ++ 0x81C, 0xECA00001, ++ 0x81C, 0xEBA20001, ++ 0x81C, 0xEAA40001, ++ 0x81C, 0xE9A60001, ++ 0x81C, 0xE8A80001, ++ 0x81C, 0xE7AA0001, ++ 0x81C, 0xE6AC0001, ++ 0x81C, 0xE5AE0001, ++ 0x81C, 0xE4B00001, ++ 0x81C, 0xE3B20001, ++ 0x81C, 0xA8B40001, ++ 0x81C, 0xA7B60001, ++ 0x81C, 0xA6B80001, ++ 0x81C, 0xA5BA0001, ++ 0x81C, 0xA4BC0001, ++ 0x81C, 0xA3BE0001, ++ 0x81C, 0xA2C00001, ++ 0x81C, 0xA1C20001, ++ 0x81C, 0x68C40001, ++ 0x81C, 0x67C60001, ++ 0x81C, 0x66C80001, ++ 0x81C, 0x65CA0001, ++ 0x81C, 0x64CC0001, ++ 0x81C, 0x47CE0001, ++ 0x81C, 0x46D00001, ++ 0x81C, 0x45D20001, ++ 0x81C, 0x44D40001, ++ 0x81C, 0x43D60001, ++ 0x81C, 0x42D80001, ++ 0x81C, 0x08DA0001, ++ 0x81C, 0x07DC0001, ++ 0x81C, 0x06DE0001, ++ 0x81C, 0x05E00001, ++ 0x81C, 0x04E20001, ++ 0x81C, 0x03E40001, ++ 0x81C, 0x02E60001, ++ 0x81C, 0x01E80001, ++ 0x81C, 0x01EA0001, ++ 0x81C, 0x01EC0001, ++ 0x81C, 0x01EE0001, ++ 0x81C, 0x01F00001, ++ 0x81C, 0x01F20001, ++ 0x81C, 0x01F40001, ++ 0x81C, 0x01F60001, ++ 0x81C, 0x01F80001, ++ 0x81C, 0x01FA0001, ++ 0x81C, 0x01FC0001, ++ 0x81C, 0x01FE0001, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x81C, 0xFF800001, ++ 0x81C, 0xFF820001, ++ 0x81C, 0xFF840001, ++ 0x81C, 0xFE860001, ++ 0x81C, 0xFD880001, ++ 0x81C, 0xFC8A0001, ++ 0x81C, 0xFB8C0001, ++ 0x81C, 0xFA8E0001, ++ 0x81C, 0xF9900001, ++ 0x81C, 0xF8920001, ++ 0x81C, 0xF7940001, ++ 0x81C, 0xF6960001, ++ 0x81C, 0xF5980001, ++ 0x81C, 0xF49A0001, ++ 0x81C, 0xF39C0001, ++ 0x81C, 0xF29E0001, ++ 0x81C, 0xF1A00001, ++ 0x81C, 0xF0A20001, ++ 0x81C, 0xEFA40001, ++ 0x81C, 0xEEA60001, ++ 0x81C, 0xEDA80001, ++ 0x81C, 0xECAA0001, ++ 0x81C, 0xEBAC0001, ++ 0x81C, 0xEAAE0001, ++ 0x81C, 0xE9B00001, ++ 0x81C, 0xE8B20001, ++ 0x81C, 0xE7B40001, ++ 0x81C, 0xE6B60001, ++ 0x81C, 0xE5B80001, ++ 0x81C, 0xE4BA0001, ++ 0x81C, 0xE3BC0001, ++ 0x81C, 0xA8BE0001, ++ 0x81C, 0xA7C00001, ++ 0x81C, 0xA6C20001, ++ 0x81C, 0xA5C40001, ++ 0x81C, 0xA4C60001, ++ 0x81C, 0xA3C80001, ++ 0x81C, 0xA2CA0001, ++ 0x81C, 0xA1CC0001, ++ 0x81C, 0x68CE0001, ++ 0x81C, 0x67D00001, ++ 0x81C, 0x66D20001, ++ 0x81C, 0x65D40001, ++ 0x81C, 0x64D60001, ++ 0x81C, 0x47D80001, ++ 0x81C, 0x46DA0001, ++ 0x81C, 0x45DC0001, ++ 0x81C, 0x44DE0001, ++ 0x81C, 0x43E00001, ++ 0x81C, 0x42E20001, ++ 0x81C, 0x08E40001, ++ 0x81C, 0x07E60001, ++ 0x81C, 0x06E80001, ++ 0x81C, 0x05EA0001, ++ 0x81C, 0x04EC0001, ++ 0x81C, 0x03EE0001, ++ 0x81C, 0x02F00001, ++ 0x81C, 0x01F20001, ++ 0x81C, 0x01F40001, ++ 0x81C, 0x01F60001, ++ 0x81C, 0x01F80001, ++ 0x81C, 0x01FA0001, ++ 0x81C, 0x01FC0001, ++ 0x81C, 0x01FE0001, ++ 0xFF0F0780, 0xDEAD, ++ 0xC50, 0x00000022, ++ 0xC50, 0x00000020, ++ 0xE50, 0x00000022, ++ 0xE50, 0x00000020, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_AGC_TAB( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8812A_AGC_TAB)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8812A_AGC_TAB; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_AGC_TAB, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* AGC_TAB_DIFF.TXT ++******************************************************************************/ ++ ++u4Byte Array_MP_8812A_AGC_TAB_DIFF_LB[] = { ++ 0xFF0F0780, 0xABCD, ++ 0x81C, 0x47CE0001, ++ 0x81C, 0x46D00001, ++ 0x81C, 0x45D20001, ++ 0x81C, 0x44D40001, ++ 0x81C, 0x43D60001, ++ 0x81C, 0x42D80001, ++ 0x81C, 0x08DA0001, ++ 0x81C, 0x07DC0001, ++ 0x81C, 0x06DE0001, ++ 0x81C, 0x05E00001, ++ 0x81C, 0x04E20001, ++ 0x81C, 0x03E40001, ++ 0x81C, 0x02E60001, ++ 0xFF0F07C0, 0xCDEF, ++ 0x81C, 0x47CE0001, ++ 0x81C, 0x46D00001, ++ 0x81C, 0x45D20001, ++ 0x81C, 0x44D40001, ++ 0x81C, 0x43D60001, ++ 0x81C, 0x42D80001, ++ 0x81C, 0x08DA0001, ++ 0x81C, 0x07DC0001, ++ 0x81C, 0x06DE0001, ++ 0x81C, 0x05E00001, ++ 0x81C, 0x04E20001, ++ 0x81C, 0x03E40001, ++ 0x81C, 0x02E60001, ++ 0xFF0F07D8, 0xCDEF, ++ 0x81C, 0x47CE0001, ++ 0x81C, 0x46D00001, ++ 0x81C, 0x45D20001, ++ 0x81C, 0x44D40001, ++ 0x81C, 0x43D60001, ++ 0x81C, 0x42D80001, ++ 0x81C, 0x08DA0001, ++ 0x81C, 0x07DC0001, ++ 0x81C, 0x06DE0001, ++ 0x81C, 0x05E00001, ++ 0x81C, 0x04E20001, ++ 0x81C, 0x03E40001, ++ 0x81C, 0x02E60001, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x81C, 0x47D80001, ++ 0x81C, 0x46DA0001, ++ 0x81C, 0x45DC0001, ++ 0x81C, 0x44DE0001, ++ 0x81C, 0x43E00001, ++ 0x81C, 0x42E20001, ++ 0x81C, 0x08E40001, ++ 0x81C, 0x07E60001, ++ 0x81C, 0x06E80001, ++ 0x81C, 0x05EA0001, ++ 0x81C, 0x04EC0001, ++ 0x81C, 0x03EE0001, ++ 0x81C, 0x02F00001, ++ 0xFF0F0780, 0xDEAD, ++}; ++ ++u4Byte Array_MP_8812A_AGC_TAB_DIFF_HB[] = { ++ 0xFF0F0780, 0xABCD, ++ 0x81C, 0x45CE0001, ++ 0x81C, 0x44D00001, ++ 0x81C, 0x43D20001, ++ 0x81C, 0x42D40001, ++ 0x81C, 0x08D60001, ++ 0x81C, 0x07D80001, ++ 0x81C, 0x06DA0001, ++ 0x81C, 0x05DC0001, ++ 0x81C, 0x04DE0001, ++ 0x81C, 0x03E00001, ++ 0x81C, 0x02E20001, ++ 0x81C, 0x01E40001, ++ 0x81C, 0x01E60001, ++ 0xFF0F07C0, 0xCDEF, ++ 0x81C, 0x45CE0001, ++ 0x81C, 0x44D00001, ++ 0x81C, 0x43D20001, ++ 0x81C, 0x42D40001, ++ 0x81C, 0x08D60001, ++ 0x81C, 0x07D80001, ++ 0x81C, 0x06DA0001, ++ 0x81C, 0x05DC0001, ++ 0x81C, 0x04DE0001, ++ 0x81C, 0x03E00001, ++ 0x81C, 0x02E20001, ++ 0x81C, 0x01E40001, ++ 0x81C, 0x01E60001, ++ 0xFF0F07D8, 0xCDEF, ++ 0x81C, 0x45CE0001, ++ 0x81C, 0x44D00001, ++ 0x81C, 0x43D20001, ++ 0x81C, 0x42D40001, ++ 0x81C, 0x08D60001, ++ 0x81C, 0x07D80001, ++ 0x81C, 0x06DA0001, ++ 0x81C, 0x05DC0001, ++ 0x81C, 0x04DE0001, ++ 0x81C, 0x03E00001, ++ 0x81C, 0x02E20001, ++ 0x81C, 0x01E40001, ++ 0x81C, 0x01E60001, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x81C, 0x45D80001, ++ 0x81C, 0x44DA0001, ++ 0x81C, 0x43DC0001, ++ 0x81C, 0x42DE0001, ++ 0x81C, 0x08E00001, ++ 0x81C, 0x07E20001, ++ 0x81C, 0x06E40001, ++ 0x81C, 0x05E60001, ++ 0x81C, 0x04E80001, ++ 0x81C, 0x03EA0001, ++ 0x81C, 0x02EC0001, ++ 0x81C, 0x01EE0001, ++ 0x81C, 0x01F00001, ++ 0xFF0F0780, 0xDEAD, ++}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_AGC_TAB_DIFF( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Array[], ++ u4Byte ArrayLen ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_AGC_TAB_DIFF, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* PHY_REG.TXT ++******************************************************************************/ ++ ++u4Byte Array_MP_8812A_PHY_REG[] = { ++ 0x800, 0x8020D010, ++ 0x804, 0x080112E0, ++ 0x808, 0x0E028233, ++ 0x80C, 0x12131113, ++ 0x810, 0x20101263, ++ 0x814, 0x020C3D10, ++ 0x818, 0x03A00385, ++ 0x820, 0x00000000, ++ 0x824, 0x00030FE0, ++ 0x828, 0x00000000, ++ 0x82C, 0x002083DD, ++ 0x830, 0x2AAA6C86, ++ 0x834, 0x0037A706, ++ 0x838, 0x06C89B44, ++ 0x83C, 0x0000095B, ++ 0x840, 0xC0000001, ++ 0x844, 0x40003CDE, ++ 0x848, 0x6210FF8B, ++ 0x84C, 0x6CFDFFB8, ++ 0x850, 0x28874706, ++ 0x854, 0x0001520C, ++ 0x858, 0x8060E000, ++ 0x85C, 0x74210168, ++ 0x860, 0x6929C321, ++ 0x864, 0x796A7432, ++ 0x868, 0x8CA7A314, ++ 0x86C, 0x338C2878, ++ 0x870, 0x03333333, ++ 0x874, 0x31602C2E, ++ 0x878, 0x00003152, ++ 0x87C, 0x000FC000, ++ 0x8A0, 0x00000013, ++ 0x8A4, 0x7F7F7F7F, ++ 0x8A8, 0xA202033E, ++ 0x8AC, 0x0FF0FA0A, ++ 0x8B0, 0x00000600, ++ 0x8B4, 0x000FC080, ++ 0x8B8, 0x7C0057FF, ++ 0x8BC, 0x4CA520A3, ++ 0x8C0, 0x27F00020, ++ 0x8C4, 0x00000000, ++ 0x8C8, 0x00013169, ++ 0x8CC, 0x08248492, ++ 0x8D0, 0x0000B800, ++ 0x8DC, 0x00000000, ++ 0x8D4, 0x940008A0, ++ 0x8D8, 0x290B1612, ++ 0x8F8, 0x400002C0, ++ 0x8FC, 0x00000000, ++ 0xFF0F07D8, 0xABCD, ++ 0x900, 0x00000701, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x900, 0x00000700, ++ 0xFF0F07D8, 0xDEAD, ++ 0x90C, 0x00000000, ++ 0x910, 0x0000FC00, ++ 0x914, 0x00000404, ++ 0x918, 0x1C1028C0, ++ 0x91C, 0x64B11A1C, ++ 0x920, 0xE0767233, ++ 0x924, 0x055AA500, ++ 0x928, 0x00000004, ++ 0x92C, 0xFFFE0000, ++ 0x930, 0xFFFFFFFE, ++ 0x934, 0x001FFFFF, ++ 0x960, 0x00000000, ++ 0x964, 0x00000000, ++ 0x968, 0x00000000, ++ 0x96C, 0x00000000, ++ 0x970, 0x801FFFFF, ++ 0x978, 0x00000000, ++ 0x97C, 0x00000000, ++ 0x980, 0x00000000, ++ 0x984, 0x00000000, ++ 0x988, 0x00000000, ++ 0x9A4, 0x00080080, ++ 0x9A8, 0x00000000, ++ 0x9AC, 0x00000000, ++ 0x9B0, 0x01081008, ++ 0x9B4, 0x00000000, ++ 0x9B8, 0x01081008, ++ 0x9BC, 0x01081008, ++ 0x9D0, 0x00000000, ++ 0x9D4, 0x00000000, ++ 0x9D8, 0x00000000, ++ 0x9DC, 0x00000000, ++ 0x9E4, 0x00000002, ++ 0x9E8, 0x000002D4, ++ 0xA00, 0x00D047C8, ++ 0xA04, 0x01FF000C, ++ 0xA08, 0x8C8A8300, ++ 0xA0C, 0x2E7F000F, ++ 0xA10, 0x9500BB78, ++ 0xA14, 0x11144028, ++ 0xA18, 0x00881117, ++ 0xA1C, 0x89140F00, ++ 0xA20, 0x1A1B0000, ++ 0xA24, 0x090E1317, ++ 0xA28, 0x00000204, ++ 0xA2C, 0x00900000, ++ 0xA70, 0x101FFF00, ++ 0xA74, 0x00000008, ++ 0xA78, 0x00000900, ++ 0xA7C, 0x225B0606, ++ 0xA80, 0x218075B2, ++ 0xA84, 0x001F8C80, ++ 0xB00, 0x03100000, ++ 0xB04, 0x0000B000, ++ 0xB08, 0xAE0201EB, ++ 0xB0C, 0x01003207, ++ 0xB10, 0x00009807, ++ 0xB14, 0x01000000, ++ 0xB18, 0x00000002, ++ 0xB1C, 0x00000002, ++ 0xB20, 0x0000001F, ++ 0xB24, 0x03020100, ++ 0xB28, 0x07060504, ++ 0xB2C, 0x0B0A0908, ++ 0xB30, 0x0F0E0D0C, ++ 0xB34, 0x13121110, ++ 0xB38, 0x17161514, ++ 0xB3C, 0x0000003A, ++ 0xB40, 0x00000000, ++ 0xB44, 0x00000000, ++ 0xB48, 0x13000032, ++ 0xB4C, 0x48080000, ++ 0xB50, 0x00000000, ++ 0xB54, 0x00000000, ++ 0xB58, 0x00000000, ++ 0xB5C, 0x00000000, ++ 0xC00, 0x00000007, ++ 0xC04, 0x00042020, ++ 0xC08, 0x80410231, ++ 0xC0C, 0x00000000, ++ 0xC10, 0x00000100, ++ 0xC14, 0x01000000, ++ 0xC1C, 0x40000003, ++ 0xC20, 0x12121212, ++ 0xC24, 0x12121212, ++ 0xC28, 0x12121212, ++ 0xC2C, 0x12121212, ++ 0xC30, 0x12121212, ++ 0xC34, 0x12121212, ++ 0xC38, 0x12121212, ++ 0xC3C, 0x12121212, ++ 0xC40, 0x12121212, ++ 0xC44, 0x12121212, ++ 0xC48, 0x12121212, ++ 0xC4C, 0x12121212, ++ 0xC50, 0x00000020, ++ 0xC54, 0x0008121C, ++ 0xC58, 0x30000C1C, ++ 0xC5C, 0x00000058, ++ 0xC60, 0x34344443, ++ 0xC64, 0x07003333, ++ 0xC68, 0x59791979, ++ 0xC6C, 0x59795979, ++ 0xC70, 0x19795979, ++ 0xC74, 0x19795979, ++ 0xC78, 0x19791979, ++ 0xC7C, 0x19791979, ++ 0xC80, 0x19791979, ++ 0xC84, 0x19791979, ++ 0xC94, 0x0100005C, ++ 0xC98, 0x00000000, ++ 0xC9C, 0x00000000, ++ 0xCA0, 0x00000029, ++ 0xCA4, 0x08040201, ++ 0xCA8, 0x80402010, ++ 0xFF0F0740, 0xABCD, ++ 0xCB0, 0x77547717, ++ 0xFF0F07C0, 0xCDEF, ++ 0xCB0, 0x77547717, ++ 0xFF0F07D8, 0xCDEF, ++ 0xCB0, 0x54547710, ++ 0xCDCDCDCD, 0xCDCD, ++ 0xCB0, 0x77547777, ++ 0xFF0F0740, 0xDEAD, ++ 0xCB4, 0x00000077, ++ 0xCB8, 0x00508242, ++ 0xE00, 0x00000007, ++ 0xE04, 0x00042020, ++ 0xE08, 0x80410231, ++ 0xE0C, 0x00000000, ++ 0xE10, 0x00000100, ++ 0xE14, 0x01000000, ++ 0xE1C, 0x40000003, ++ 0xE20, 0x12121212, ++ 0xE24, 0x12121212, ++ 0xE28, 0x12121212, ++ 0xE2C, 0x12121212, ++ 0xE30, 0x12121212, ++ 0xE34, 0x12121212, ++ 0xE38, 0x12121212, ++ 0xE3C, 0x12121212, ++ 0xE40, 0x12121212, ++ 0xE44, 0x12121212, ++ 0xE48, 0x12121212, ++ 0xE4C, 0x12121212, ++ 0xE50, 0x00000020, ++ 0xE54, 0x0008121C, ++ 0xE58, 0x30000C1C, ++ 0xE5C, 0x00000058, ++ 0xE60, 0x34344443, ++ 0xE64, 0x07003333, ++ 0xE68, 0x59791979, ++ 0xE6C, 0x59795979, ++ 0xE70, 0x19795979, ++ 0xE74, 0x19795979, ++ 0xE78, 0x19791979, ++ 0xE7C, 0x19791979, ++ 0xE80, 0x19791979, ++ 0xE84, 0x19791979, ++ 0xE94, 0x0100005C, ++ 0xE98, 0x00000000, ++ 0xE9C, 0x00000000, ++ 0xEA0, 0x00000029, ++ 0xEA4, 0x08040201, ++ 0xEA8, 0x80402010, ++ 0xFF0F0740, 0xABCD, ++ 0xEB0, 0x77547717, ++ 0xFF0F07C0, 0xCDEF, ++ 0xEB0, 0x77547717, ++ 0xFF0F07D8, 0xCDEF, ++ 0xEB0, 0x54547710, ++ 0xCDCDCDCD, 0xCDCD, ++ 0xEB0, 0x77547777, ++ 0xFF0F0740, 0xDEAD, ++ 0xEB4, 0x00000077, ++ 0xEB8, 0x00508242, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_PHY_REG( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8812A_PHY_REG; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_PHY_REG, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* PHY_REG_MP.TXT ++******************************************************************************/ ++ ++u4Byte Array_MP_8812A_PHY_REG_MP[] = { ++ 0x800, 0x8020D410, ++ 0x830, 0x2EAA8EB6, ++ 0xC90, 0x01E00000, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_PHY_REG_MP( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG_MP)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8812A_PHY_REG_MP; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_PHY_REG_MP, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* PHY_REG_PG.TXT ++******************************************************************************/ ++ ++u4Byte Array_MP_8812A_PHY_REG_PG[] = { ++ 0xC20, 0x00000000, 0x34363840, ++ 0xC24, 0x00000000, 0x42424444, ++ 0xC28, 0x00000000, 0x30323638, ++ 0xC2C, 0x00000000, 0x40424444, ++ 0xC30, 0x00000000, 0x28303236, ++ 0xC34, 0x00000000, 0x38404242, ++ 0xC38, 0x00000000, 0x26283034, ++ 0xE20, 0x00000000, 0x34363840, ++ 0xE24, 0x00000000, 0x42424444, ++ 0xE28, 0x00000000, 0x30323638, ++ 0xE2C, 0x00000000, 0x40424444, ++ 0xE30, 0x00000000, 0x28303236, ++ 0xE34, 0x00000000, 0x38404242, ++ 0xE38, 0x00000000, 0x26283034, ++ 0xC24, 0x00000000, 0x42424444, ++ 0xC28, 0x00000000, 0x30323640, ++ 0xC2C, 0x00000000, 0x40424444, ++ 0xC30, 0x00000000, 0x28303236, ++ 0xC34, 0x00000000, 0x38404242, ++ 0xC38, 0x00000000, 0x26283034, ++ 0xC3C, 0x00000000, 0x40424444, ++ 0xC40, 0x00000000, 0x28303236, ++ 0xC44, 0x00000000, 0x42422426, ++ 0xC48, 0x00000000, 0x30343840, ++ 0xC4C, 0x00000000, 0x22242628, ++ 0xE24, 0x00000000, 0x42424444, ++ 0xE28, 0x00000000, 0x30323640, ++ 0xE2C, 0x00000000, 0x40424444, ++ 0xE30, 0x00000000, 0x28303236, ++ 0xE34, 0x00000000, 0x38404242, ++ 0xE38, 0x00000000, 0x26283034, ++ 0xE3C, 0x00000000, 0x40424444, ++ 0xE40, 0x00000000, 0x28303236, ++ 0xE44, 0x00000000, 0x42422426, ++ 0xE48, 0x00000000, 0x30343840, ++ 0xE4C, 0x00000000, 0x22242628, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_PHY_REG_PG( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG_PG)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8812A_PHY_REG_PG; ++ ++ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ for (i = 0; i < ArrayLen; i += 3 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ u4Byte v3 = Array[i+2]; ++ ++ // this line is a line of pure_body ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_PHY_REG_PG_8812A(pDM_Odm, v1, v2, v3); ++ continue; ++ } ++ else ++ { // this line is the start of branch ++ if ( !CheckCondition(Array[i], hex) ) ++ { // don't need the hw_body ++ i += 2; // skip the pair of expression ++ v1 = Array[i]; ++ v2 = Array[i+1]; ++ v3 = Array[i+2]; ++ while (v2 != 0xDEAD) ++ { ++ i += 3; ++ v1 = Array[i]; ++ v2 = Array[i+1]; ++ v3 = Array[i+1]; ++ } ++ } ++ } ++ } ++} ++ ++ ++ ++/****************************************************************************** ++* PHY_REG_PG_ASUS.TXT ++******************************************************************************/ ++ ++u4Byte Array_MP_8812A_PHY_REG_PG_ASUS[] = { ++ 0xC20, 0x00000000, 0x34343434, ++ 0xC24, 0x00000000, 0x32323232, ++ 0xC28, 0x00000000, 0x28303232, ++ 0xC2C, 0x00000000, 0x32323232, ++ 0xC30, 0x00000000, 0x24283032, ++ 0xC34, 0x00000000, 0x32323232, ++ 0xC38, 0x00000000, 0x24283032, ++ 0xE20, 0x00000000, 0x34343434, ++ 0xE24, 0x00000000, 0x32323232, ++ 0xE28, 0x00000000, 0x28303232, ++ 0xE2C, 0x00000000, 0x32323232, ++ 0xE30, 0x00000000, 0x24283032, ++ 0xE34, 0x00000000, 0x32323232, ++ 0xE38, 0x00000000, 0x24283032, ++ 0xC24, 0x00000000, 0x32323232, ++ 0xC28, 0x00000000, 0x28303232, ++ 0xC2C, 0x00000000, 0x32323232, ++ 0xC30, 0x00000000, 0x24283032, ++ 0xC34, 0x00000000, 0x32323232, ++ 0xC38, 0x00000000, 0x24283032, ++ 0xC3C, 0x00000000, 0x32323232, ++ 0xC40, 0x00000000, 0x24283032, ++ 0xC44, 0x00000000, 0x32322222, ++ 0xC48, 0x00000000, 0x30323232, ++ 0xC4C, 0x00000000, 0x22222428, ++ 0xE24, 0x00000000, 0x32323232, ++ 0xE28, 0x00000000, 0x28303232, ++ 0xE2C, 0x00000000, 0x32323232, ++ 0xE30, 0x00000000, 0x24283032, ++ 0xE34, 0x00000000, 0x32323232, ++ 0xE38, 0x00000000, 0x24283032, ++ 0xE3C, 0x00000000, 0x32323232, ++ 0xE40, 0x00000000, 0x24283032, ++ 0xE44, 0x00000000, 0x32322222, ++ 0xE48, 0x00000000, 0x30323232, ++ 0xE4C, 0x00000000, 0x22222428, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_ASUS( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG_PG_ASUS)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8812A_PHY_REG_PG_ASUS; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_ASUS, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* PHY_REG_PG_NEC.TXT ++******************************************************************************/ ++ ++u4Byte Array_MP_8812A_PHY_REG_PG_NEC[] = { ++ 0xC20, 0x00000000, 0x32323232, ++ 0xC24, 0x00000000, 0x32343434, ++ 0xC28, 0x00000000, 0x24262830, ++ 0xC2C, 0x00000000, 0x32343434, ++ 0xC30, 0x00000000, 0x24262830, ++ 0xC34, 0x00000000, 0x32343434, ++ 0xC38, 0x00000000, 0x24262830, ++ 0xE20, 0x00000000, 0x32323232, ++ 0xE24, 0x00000000, 0x32343434, ++ 0xE28, 0x00000000, 0x24262830, ++ 0xE2C, 0x00000000, 0x32343434, ++ 0xE30, 0x00000000, 0x24262830, ++ 0xE34, 0x00000000, 0x32343434, ++ 0xE38, 0x00000000, 0x24262830, ++ 0xC24, 0x00000000, 0x32343434, ++ 0xC28, 0x00000000, 0x24262830, ++ 0xC2C, 0x00000000, 0x32343434, ++ 0xC30, 0x00000000, 0x24262830, ++ 0xC34, 0x00000000, 0x28282828, ++ 0xC38, 0x00000000, 0x24262828, ++ 0xC3C, 0x00000000, 0x32343434, ++ 0xC40, 0x00000000, 0x24262830, ++ 0xC44, 0x00000000, 0x28282022, ++ 0xC48, 0x00000000, 0x28282828, ++ 0xC4C, 0x00000000, 0x20222426, ++ 0xE24, 0x00000000, 0x32343434, ++ 0xE28, 0x00000000, 0x24262830, ++ 0xE2C, 0x00000000, 0x32343434, ++ 0xE30, 0x00000000, 0x24262830, ++ 0xE34, 0x00000000, 0x28282828, ++ 0xE38, 0x00000000, 0x24262828, ++ 0xE3C, 0x00000000, 0x32343434, ++ 0xE40, 0x00000000, 0x24262830, ++ 0xE44, 0x00000000, 0x28282022, ++ 0xE48, 0x00000000, 0x28282828, ++ 0xE4C, 0x00000000, 0x20222426, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_NEC( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG_PG_NEC)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8812A_PHY_REG_PG_NEC; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_NEC, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.h 2018-02-06 17:42:30.702967046 +0200 +@@ -0,0 +1,88 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#ifndef __INC_MP_BB_HW_IMG_8812A_H ++#define __INC_MP_BB_HW_IMG_8812A_H ++ ++static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); ++ ++/****************************************************************************** ++* AGC_TAB.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_AGC_TAB( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* AGC_TAB_DIFF.TXT ++******************************************************************************/ ++ ++extern u4Byte Array_MP_8812A_AGC_TAB_DIFF_LB[116]; ++extern u4Byte Array_MP_8812A_AGC_TAB_DIFF_HB[116]; ++void ++ODM_ReadAndConfig_MP_8812A_AGC_TAB_DIFF( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Array[], ++ u4Byte ArrayLen ++); ++ ++/****************************************************************************** ++* PHY_REG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_PHY_REG( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* PHY_REG_MP.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_PHY_REG_MP( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* PHY_REG_PG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_PHY_REG_PG( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* PHY_REG_PG_ASUS.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_ASUS( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* PHY_REG_PG_NEC.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_NEC( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.c 2018-02-06 17:42:30.704967075 +0200 +@@ -0,0 +1,5303 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#include "odm_precomp.h" ++ ++u1Byte Array_MP_8812A_FW_NIC[] = { ++0x01, 0x95, 0x10, 0x00, 0x0F, 0x00, 0x00, 0x00, 0x05, 0x14, 0x10, 0x48, 0x84, 0x7A, 0x00, 0x00, ++0xCC, 0xCC, 0xCC, 0xCC, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x02, 0x4C, 0xB1, 0x02, 0x60, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x61, 0x0E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x70, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x60, 0x85, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x6F, 0x7E, 0x00, 0x00, ++0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, ++0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, ++0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, ++0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, ++0xF0, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x0A, 0x08, 0x03, ++0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, 0x04, 0x08, ++0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, 0x04, 0x00, ++0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, 0x0A, 0x03, ++0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, 0x10, 0x24, ++0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, 0x06, 0x00, ++0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, 0x21, 0x0C, ++0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, 0x20, 0x21, ++0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, 0x10, 0x00, ++0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, 0x28, 0x14, ++0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, 0x30, 0x04, ++0x04, 0x04, 0x05, 0x04, 0x04, 0x05, 0x07, 0x07, 0x07, 0x08, 0x0A, 0x01, 0x02, 0x03, 0x06, 0x07, ++0x0A, 0x0B, 0x0D, 0x03, 0x04, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, ++0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x07, 0x08, 0x08, 0x0A, 0x0A, ++0x0C, 0x0E, 0x10, 0x11, 0x11, 0x07, 0x09, 0x09, 0x0B, 0x0B, 0x0D, 0x0F, 0x11, 0x12, 0x12, 0x05, ++0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, ++0x0F, 0x0F, 0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, 0x07, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x04, ++0x06, 0x07, 0x07, 0x09, 0x0B, 0x11, 0x13, 0x07, 0x0A, 0x0C, 0x0D, 0x0D, 0x0F, 0x11, 0x13, 0x09, ++0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x05, ++0x06, 0x08, 0x09, 0x0C, 0x0E, 0x12, 0x12, 0x13, 0x14, 0x07, 0x08, 0x0A, 0x0B, 0x0D, 0x10, 0x12, ++0x13, 0x15, 0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x09, 0x09, 0x09, ++0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, 0x25, 0x27, 0x28, 0x00, 0x00, 0x00, 0x00, 0x23, ++0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, ++0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, ++0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x2A, ++0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x04, 0x00, ++0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00, 0x18, 0x00, ++0x00, 0x00, 0x24, 0x00, 0x00, 0x00, 0x30, 0x00, 0x00, 0x00, 0x48, 0x00, 0x00, 0x00, 0x60, 0x00, ++0x00, 0x00, 0x90, 0x00, 0x00, 0x00, 0xC0, 0x00, 0x00, 0x00, 0xD8, 0x00, 0x00, 0x00, 0x3C, 0x00, ++0x00, 0x00, 0x64, 0x00, 0x00, 0x00, 0x78, 0x00, 0x00, 0x00, 0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, ++0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x00, 0xA0, 0x00, ++0x00, 0x00, 0xF0, 0x00, 0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x02, 0x58, 0x00, ++0x00, 0x03, 0x20, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x00, 0xC8, 0x00, ++0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, ++0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, ++0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, ++0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0x64, 0x00, ++0x00, 0x00, 0x78, 0x00, 0x00, 0x00, 0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, 0x00, 0x01, 0x40, 0x00, ++0x00, 0x01, 0x90, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0x30, 0x00, 0x00, 0x02, 0x80, 0x00, ++0x00, 0x02, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x2C, 0x00, 0x00, 0x01, 0x90, 0x00, ++0x00, 0x02, 0x58, 0x00, 0x00, 0x03, 0xC0, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, ++0x00, 0x07, 0xD0, 0x00, 0x00, 0x0A, 0xF0, 0x00, 0x00, 0x0E, 0x10, 0x00, 0x00, 0x00, 0xC8, 0x00, ++0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, ++0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, ++0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, ++0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, ++0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x02, 0x00, 0x02, 0x00, ++0x04, 0x00, 0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x48, 0x00, ++0x60, 0x00, 0x6C, 0x00, 0x1E, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, ++0xC8, 0x00, 0xF0, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x01, 0x2C, 0x01, 0x90, 0x02, ++0x58, 0x03, 0x20, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, ++0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, ++0x20, 0x03, 0xE8, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x00, ++0xF0, 0x01, 0x18, 0x01, 0x40, 0x01, 0x68, 0x00, 0x64, 0x00, 0x96, 0x00, 0xC8, 0x01, 0x2C, 0x01, ++0xE0, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x05, 0x78, 0x07, 0x08, 0x00, 0x64, 0x00, 0x8C, 0x00, ++0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x00, ++0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, ++0xE8, 0x03, 0xE8, 0x02, 0x04, 0x06, 0x08, 0x0A, 0x0C, 0x10, 0x18, 0x20, 0x30, 0x40, 0x50, 0x02, ++0x02, 0x02, 0x02, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, 0x05, 0x04, 0x05, 0x05, 0x05, 0x06, ++0x07, 0x08, 0x08, 0x06, 0x06, 0x06, 0x07, 0x09, 0x09, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, ++0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, ++0x07, 0x08, 0x08, 0x0A, 0x0A, 0x06, 0x06, 0x06, 0x07, 0x07, 0x07, 0x08, 0x08, 0x0A, 0x0B, 0x05, ++0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, ++0x0A, 0x0A, 0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x01, ++0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x05, 0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, ++0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x05, ++0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, ++0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, ++0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x05, 0x22, 0x05, ++0x50, 0x05, 0x51, 0x08, 0x08, 0x08, 0x38, 0x09, 0x0C, 0x0B, 0x00, 0x0C, 0x00, 0x0E, 0x00, 0x08, ++0xC4, 0x08, 0x2C, 0x0C, 0x5C, 0x0C, 0x60, 0x0C, 0x64, 0x0C, 0x68, 0x0C, 0xB8, 0x0C, 0xB0, 0x0C, ++0xB4, 0x0E, 0x5C, 0x0E, 0x60, 0x0E, 0x64, 0x0E, 0x68, 0x0E, 0xB8, 0x0E, 0xB0, 0x0E, 0xB4, 0x0C, ++0x00, 0x0C, 0x94, 0x0C, 0x88, 0x0C, 0x8C, 0x0C, 0xE8, 0x0C, 0x10, 0x0D, 0x00, 0x0C, 0x90, 0x0C, ++0xC4, 0x0C, 0xC8, 0x0C, 0xCC, 0x0C, 0xD4, 0x0C, 0x80, 0x0C, 0x84, 0x0E, 0x00, 0x0E, 0x94, 0x0E, ++0x88, 0x0E, 0x8C, 0x0E, 0xE8, 0x0E, 0x10, 0x0D, 0x40, 0x0E, 0x90, 0x0E, 0xC4, 0x0E, 0xC8, 0x0E, ++0xCC, 0x0E, 0xD4, 0x0E, 0x80, 0x0E, 0x84, 0x00, 0x01, 0x04, 0x02, 0x03, 0x05, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, ++0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, ++0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, ++0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, ++0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, ++0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, ++0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, ++0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, ++0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, ++0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, ++0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, ++0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, ++0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, ++0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, ++0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, ++0x82, 0x23, 0x90, 0x47, 0x50, 0x73, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, ++0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, 0x22, 0xBB, 0x01, 0x0A, 0x89, ++0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE0, 0x22, 0x50, 0x06, 0x87, 0xF0, 0x09, 0xE7, 0x19, ++0x22, 0xBB, 0xFE, 0x07, 0xE3, 0xF5, 0xF0, 0x09, 0xE3, 0x19, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xE4, ++0x93, 0xF5, 0xF0, 0x74, 0x01, 0x93, 0x22, 0xBB, 0x01, 0x10, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, ++0x83, 0x3A, 0xF5, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE0, 0x22, 0x50, 0x09, 0xE9, 0x25, 0x82, 0xF8, ++0x86, 0xF0, 0x08, 0xE6, 0x22, 0xBB, 0xFE, 0x0A, 0xE9, 0x25, 0x82, 0xF8, 0xE2, 0xF5, 0xF0, 0x08, ++0xE2, 0x22, 0xE5, 0x83, 0x2A, 0xF5, 0x83, 0xE9, 0x93, 0xF5, 0xF0, 0xA3, 0xE9, 0x93, 0x22, 0xEF, ++0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, ++0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, ++0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, ++0x42, 0xF0, 0xEC, 0x64, 0x80, 0xC8, 0x64, 0x80, 0x98, 0x45, 0xF0, 0x22, 0xEB, 0x9F, 0xF5, 0xF0, ++0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, 0xE8, 0x9C, 0x45, 0xF0, 0x22, 0xBB, 0x01, 0x07, ++0x89, 0x82, 0x8A, 0x83, 0x02, 0x49, 0x4B, 0x50, 0x05, 0xE9, 0xF8, 0x02, 0x49, 0xEC, 0xBB, 0xFE, ++0x05, 0xE9, 0xF8, 0x02, 0x49, 0x57, 0x89, 0x82, 0x8A, 0x83, 0x02, 0x49, 0x63, 0xBB, 0x01, 0x0D, ++0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0x02, 0x49, 0x4B, 0x50, 0x07, 0xE9, ++0x25, 0x82, 0xF8, 0x02, 0x49, 0xEC, 0xBB, 0xFE, 0x07, 0xE9, 0x25, 0x82, 0xF8, 0x02, 0x49, 0x57, ++0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0x02, 0x49, 0x63, 0xBB, 0x01, 0x07, ++0x89, 0x82, 0x8A, 0x83, 0x02, 0x27, 0x48, 0x50, 0x05, 0xE9, 0xF8, 0x02, 0x49, 0xF8, 0xBB, 0xFE, ++0x05, 0xE9, 0xF8, 0x02, 0x49, 0x9C, 0x22, 0xBB, 0x01, 0x0D, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, ++0x83, 0x3A, 0xF5, 0x83, 0x02, 0x27, 0x48, 0x50, 0x07, 0xE9, 0x25, 0x82, 0xF8, 0x02, 0x49, 0xF8, ++0xBB, 0xFE, 0x07, 0xE9, 0x25, 0x82, 0xF8, 0x02, 0x49, 0x9C, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, ++0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE2, 0xFC, 0x08, 0xE2, 0xFD, 0x08, 0xE2, 0xFE, 0x08, ++0xE2, 0xFF, 0x22, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x93, 0xFD, 0x74, 0x02, 0x93, 0xFE, 0x74, 0x03, ++0x93, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE2, ++0xFB, 0x08, 0xE2, 0xF9, 0x08, 0xE2, 0xFA, 0x08, 0xE2, 0xCB, 0xF8, 0x22, 0xE4, 0x93, 0xF8, 0x74, ++0x01, 0x93, 0xF9, 0x74, 0x02, 0x93, 0xFA, 0x74, 0x03, 0x93, 0xFB, 0x22, 0xEC, 0xF2, 0x08, 0xED, ++0xF2, 0x08, 0xEE, 0xF2, 0x08, 0xEF, 0xF2, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, ++0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, ++0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, ++0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, ++0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0xE6, 0xFC, 0x08, 0xE6, ++0xFD, 0x08, 0xE6, 0xFE, 0x08, 0xE6, 0xFF, 0x22, 0xEC, 0xF6, 0x08, 0xED, 0xF6, 0x08, 0xEE, 0xF6, ++0x08, 0xEF, 0xF6, 0x22, 0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x4A, 0x08, 0x85, 0xD0, 0x0B, 0x75, ++0xD0, 0x08, 0xAA, 0xE0, 0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, ++0xF5, 0x8C, 0xD2, 0x8C, 0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, ++0x81, 0xB4, 0x40, 0x00, 0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, ++0xAF, 0xE6, 0x30, 0xE1, 0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, ++0x22, 0xE5, 0x0C, 0xFF, 0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, ++0x78, 0x81, 0xE6, 0x30, 0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, ++0x86, 0x25, 0x0C, 0xF8, 0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, ++0xFF, 0xCD, 0xF8, 0xE8, 0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, ++0x9F, 0x40, 0x27, 0xE5, 0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, ++0xFD, 0x18, 0xE6, 0xCD, 0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, ++0xE5, 0x0C, 0x24, 0x86, 0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, ++0x7F, 0x04, 0xC2, 0xAF, 0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, ++0x30, 0xE3, 0x04, 0x7F, 0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, ++0x22, 0x78, 0x86, 0xA6, 0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, ++0x03, 0xE4, 0x78, 0x80, 0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4D, ++0x73, 0x74, 0x01, 0x93, 0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, ++0x75, 0x8C, 0x79, 0xD2, 0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, ++0xFF, 0x22, 0x74, 0x81, 0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, ++0xF6, 0xD2, 0xAF, 0xAE, 0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, ++0xF9, 0x08, 0xE6, 0x18, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, ++0x19, 0x19, 0xF7, 0x09, 0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, ++0x05, 0x81, 0x05, 0x81, 0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, ++0xEE, 0xB5, 0x0C, 0x02, 0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, ++0x19, 0xE7, 0x09, 0x09, 0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, ++0x04, 0xF8, 0xEF, 0x2F, 0x04, 0x90, 0x4D, 0x73, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, ++0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, ++0xE6, 0x30, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, ++0x0A, 0x74, 0x86, 0x2F, 0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x4A, 0x51, 0x50, 0x2E, 0x74, 0x87, 0x2F, ++0xF8, 0xE6, 0xBF, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, ++0xE6, 0xFC, 0xE9, 0x6C, 0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, ++0xA6, 0x05, 0x1F, 0xE5, 0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, ++0xFD, 0x18, 0x86, 0x01, 0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, ++0xB5, 0x07, 0x02, 0xAC, 0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, ++0xF4, 0xE5, 0x0C, 0xB5, 0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, ++0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, ++0xE0, 0x02, 0xD2, 0xE4, 0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, ++0x4A, 0x50, 0x8F, 0xF0, 0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, ++0xF7, 0x0D, 0x7F, 0x08, 0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, ++0xF1, 0x06, 0xED, 0xF6, 0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, ++0xE7, 0x25, 0x0E, 0x30, 0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, ++0xE7, 0x15, 0x54, 0xEC, 0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x4A, 0x51, 0x7F, 0x08, 0x08, ++0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, ++0x22, 0x02, 0x4C, 0xEF, 0x02, 0x4A, 0xE1, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, ++0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, ++0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, ++0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, ++0x4D, 0x34, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, ++0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, ++0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, ++0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, ++0xDE, 0xE7, 0x80, 0xBE, 0x00, 0x41, 0xA4, 0xA2, 0x00, 0x41, 0xA4, 0xA3, 0x00, 0x41, 0xA4, 0xA4, ++0x00, 0x60, 0x26, 0xA4, 0x27, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, ++0x0C, 0x0D, 0x0E, 0x24, 0x28, 0x2C, 0x30, 0x34, 0x38, 0x3C, 0x40, 0x64, 0x68, 0x6C, 0x70, 0x74, ++0x78, 0x7C, 0x80, 0x84, 0x88, 0x8C, 0x95, 0x99, 0x9D, 0xA1, 0xA5, 0x41, 0xA4, 0xB9, 0x00, 0x41, ++0xA4, 0xBC, 0x00, 0x4E, 0x7D, 0x4F, 0xA9, 0x4F, 0xFA, 0x90, 0x00, 0xF0, 0xE0, 0x7F, 0x01, 0x20, ++0xE2, 0x02, 0x7F, 0x03, 0x22, 0xB1, 0x79, 0x90, 0xA0, 0x8B, 0xEF, 0xF0, 0xB1, 0x97, 0x90, 0x01, ++0x64, 0x74, 0x01, 0xF0, 0x02, 0x35, 0x95, 0xD1, 0x1C, 0xD1, 0x4C, 0xB1, 0xB9, 0xB1, 0xD8, 0xB1, ++0xF7, 0xE4, 0xF5, 0x51, 0x75, 0x52, 0x58, 0xAB, 0x51, 0x7D, 0x02, 0x7F, 0x01, 0x12, 0x39, 0x04, ++0xAB, 0x52, 0x7D, 0x03, 0x7F, 0x01, 0x02, 0x39, 0x04, 0x75, 0x5D, 0x12, 0xE4, 0xF5, 0x5E, 0x75, ++0x5F, 0x07, 0x75, 0x60, 0x72, 0x90, 0x01, 0x30, 0xE5, 0x5D, 0xF0, 0xA3, 0xE5, 0x5E, 0xF0, 0xA3, ++0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, 0xF0, 0x22, 0x75, 0x65, 0x0E, 0x75, 0x66, 0x01, 0x75, 0x67, ++0x03, 0x75, 0x68, 0x62, 0x90, 0x01, 0x38, 0xE5, 0x65, 0xF0, 0xA3, 0xE5, 0x66, 0xF0, 0xA3, 0xE5, ++0x67, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x22, 0xE4, 0xF5, 0x55, 0xF5, 0x56, 0xF5, 0x57, 0xF5, 0x58, ++0xAD, 0x55, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xAD, 0x56, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xAD, 0x57, ++0x7F, 0x52, 0x12, 0x3A, 0x96, 0xAD, 0x58, 0x7F, 0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x30, 0xE4, ++0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x38, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, ++0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xE4, 0xFD, ++0x7F, 0x52, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x34, 0x74, ++0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x3C, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, ++0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0x7D, ++0xFF, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x3A, 0x96, 0x90, 0x00, 0x80, ++0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, 0xF1, 0x1A, 0x12, 0x3A, 0xB8, 0xF1, 0x79, ++0xD1, 0xFF, 0x7F, 0x01, 0x71, 0x19, 0x90, 0xA1, 0xCE, 0x74, 0x02, 0xF0, 0xFF, 0x71, 0x19, 0x90, ++0xA1, 0xCE, 0xE0, 0x04, 0xF0, 0xB1, 0x85, 0xD1, 0xDB, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, ++0x7F, 0x80, 0x12, 0x3A, 0x96, 0x75, 0x28, 0xFF, 0xF1, 0x0B, 0x12, 0x7A, 0xFE, 0x90, 0x00, 0xF1, ++0xE0, 0x54, 0xF0, 0xD3, 0x94, 0x10, 0x40, 0x08, 0x90, 0xA2, 0xE8, 0x74, 0x01, 0xF0, 0x80, 0x05, ++0xE4, 0x90, 0xA2, 0xE8, 0xF0, 0xF1, 0x22, 0xE4, 0xFF, 0x61, 0xA2, 0xF1, 0x05, 0xF1, 0x12, 0x12, ++0x81, 0x44, 0x12, 0x9A, 0x89, 0x12, 0xB7, 0x8F, 0xF1, 0x2C, 0xF1, 0x3B, 0x90, 0xA1, 0xD2, 0xE0, ++0x54, 0xFE, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xE4, ++0x90, 0xA0, 0x8A, 0xF0, 0x22, 0xE4, 0x90, 0xA1, 0x2D, 0xF0, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, ++0x85, 0x22, 0xE4, 0x90, 0xA1, 0x27, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, ++0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x0F, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0xA1, 0xCA, 0xE0, ++0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0xA1, 0xCF, 0xE0, 0x54, ++0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xD1, 0xEC, 0x12, ++0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0xA1, 0xD2, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, ++0x13, 0x30, 0xE0, 0x14, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xD3, 0xF0, 0x90, 0x00, ++0x02, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xD4, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, ++0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, ++0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, ++0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0xA2, 0xEC, 0xF0, 0x90, 0xA2, ++0xEC, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0xA9, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x4F, 0xA3, 0xF0, 0x12, ++0x3A, 0xEB, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x69, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x0E, 0x90, 0xA1, ++0xB4, 0xE0, 0xFF, 0x90, 0xA1, 0xB3, 0xE0, 0x6F, 0x60, 0x02, 0xF1, 0xF0, 0xC2, 0xAF, 0x12, 0x7B, ++0x54, 0xBF, 0x01, 0x03, 0x12, 0x81, 0x06, 0xD2, 0xAF, 0x12, 0x58, 0x5D, 0x51, 0x51, 0x80, 0xBE, ++0x90, 0xA1, 0xB3, 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x62, 0x53, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, ++0x12, 0x4C, 0x52, 0x90, 0xA2, 0xF0, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0xA0, 0x8A, 0xE0, 0x60, 0xEA, ++0xC2, 0xAF, 0x30, 0xE0, 0x11, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x66, 0xA4, 0x12, 0x8E, 0x47, ++0x90, 0xA1, 0xED, 0xE0, 0x04, 0xF0, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0xA0, 0x8A, 0xE0, 0xFF, 0x30, ++0xE1, 0x0B, 0x54, 0xFD, 0xF0, 0x90, 0xA1, 0xEF, 0xE0, 0x04, 0xF0, 0x31, 0xEE, 0xD2, 0xAF, 0xC2, ++0xAF, 0x90, 0xA0, 0x8A, 0xE0, 0xFF, 0x30, 0xE2, 0x05, 0x54, 0xFB, 0xF0, 0x11, 0x52, 0xD2, 0xAF, ++0x80, 0xB8, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA1, 0x28, 0xE0, 0xFE, ++0x90, 0xA1, 0x27, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, ++0x01, 0x60, 0x48, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x13, 0xED, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x91, ++0xF9, 0x74, 0xA0, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x11, 0xC0, 0x7F, 0x01, 0x90, 0xA1, 0x27, 0xE0, ++0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x91, 0xF9, 0x74, 0xA0, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x31, 0x23, ++0x7F, 0x01, 0xEF, 0x60, 0x16, 0x90, 0xA1, 0x27, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, ++0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA1, 0x27, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0xF1, 0x12, 0x49, 0xBD, 0x90, 0xA4, 0xA4, ++0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, 0x7F, 0xAF, 0x7E, 0x01, 0x31, ++0x98, 0xEF, 0x60, 0x3A, 0x90, 0xA2, 0xF1, 0x12, 0x49, 0xB4, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, ++0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, ++0x12, 0x34, 0x2C, 0x90, 0xA2, 0xF1, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x90, ++0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x9E, 0x12, 0x49, 0xBD, ++0x7F, 0x96, 0x7E, 0x02, 0x31, 0x98, 0xEF, 0x60, 0x5A, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, ++0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, ++0xFE, 0x90, 0xA4, 0xA1, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0xA4, 0xA1, 0xE0, ++0xFD, 0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA4, 0x9E, 0x12, 0x49, 0xB4, 0x90, 0x00, ++0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0x12, 0x7A, 0x2A, 0x90, 0xA4, 0xA1, ++0xE0, 0x24, 0x18, 0xFF, 0x90, 0xA4, 0x9E, 0x12, 0x49, 0xB4, 0x12, 0x7A, 0x85, 0x90, 0x02, 0x96, ++0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0xA4, 0x96, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x96, 0xE0, ++0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, 0x2D, 0xC3, 0x90, 0xA4, 0x99, 0xE0, 0x94, ++0xE8, 0x90, 0xA4, 0x98, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, ++0x7F, 0x00, 0x80, 0x15, 0x90, 0xA4, 0x98, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x7F, 0x0A, ++0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x80, 0xC5, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0xA2, 0xF1, 0xF0, 0x90, ++0xA2, 0xF1, 0xE0, 0xFD, 0x70, 0x02, 0x61, 0x18, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x01, 0x7E, ++0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, ++0x70, 0x02, 0x61, 0x11, 0x90, 0xA4, 0xA2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x49, ++0xA8, 0xE0, 0x90, 0xA2, 0xF2, 0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, 0xA2, 0x75, 0x42, 0xF2, 0x75, ++0x43, 0x01, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0xF3, 0x12, 0x34, 0x2C, 0x90, 0xA4, 0xA2, 0xE0, 0x75, ++0xF0, 0x04, 0x90, 0x01, 0xD1, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xF4, 0xF0, 0x90, 0xA4, 0xA2, ++0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD2, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xF5, 0xF0, 0x90, ++0xA4, 0xA2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD3, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xF6, ++0xF0, 0x90, 0xA4, 0xA2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF0, 0x12, 0x49, 0xA8, 0xE0, 0x90, ++0xA2, 0xF7, 0xF0, 0x90, 0xA4, 0xA2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF1, 0x12, 0x49, 0xA8, ++0xE0, 0x90, 0xA2, 0xF8, 0xF0, 0x90, 0xA4, 0xA2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF2, 0x12, ++0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xF9, 0xF0, 0x90, 0xA4, 0xA2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, ++0xF3, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xFA, 0xF0, 0x90, 0xA2, 0xF1, 0xE0, 0xFF, 0x90, 0xA4, ++0xA2, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, ++0x90, 0xA2, 0xF1, 0xF0, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, ++0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0xA2, 0xF3, 0xE0, 0xFF, 0x7B, 0x01, 0x7A, ++0xA2, 0x79, 0xF4, 0x71, 0x1D, 0x90, 0xA4, 0xA2, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x21, ++0xFF, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0xFB, ++0x12, 0x49, 0xBD, 0xEF, 0x12, 0x49, 0xC6, 0x53, 0x58, 0x00, 0x53, 0x61, 0x01, 0x53, 0x6A, 0x02, ++0x53, 0x73, 0x03, 0x53, 0x7C, 0x04, 0x53, 0x85, 0x20, 0x53, 0x8E, 0x21, 0x53, 0x97, 0x23, 0x53, ++0x9F, 0x25, 0x53, 0xA8, 0x27, 0x53, 0xB1, 0x40, 0x53, 0xC0, 0x42, 0x53, 0xC9, 0x43, 0x53, 0xD2, ++0x45, 0x53, 0xDA, 0x87, 0x00, 0x00, 0x53, 0xE2, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x70, ++0x41, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x70, 0x89, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, ++0x02, 0x71, 0x62, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0xB7, 0x3A, 0x90, 0xA2, 0xFB, 0x12, ++0x49, 0xB4, 0x02, 0x4F, 0x4D, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x71, 0x9A, 0x90, 0xA2, ++0xFB, 0x12, 0x49, 0xB4, 0x02, 0x77, 0xE6, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0xE1, 0xE4, 0x90, ++0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x78, 0x2C, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x78, ++0x3C, 0x90, 0xA1, 0xF0, 0xE0, 0x04, 0xF0, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x97, 0x5D, ++0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x98, 0xE7, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, ++0x99, 0x88, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x80, 0x10, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, ++0x80, 0x50, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, ++0x90, 0xA1, 0xF7, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xF8, 0xF0, 0x12, 0xA2, ++0x61, 0x7F, 0x01, 0x90, 0xA2, 0xFE, 0x74, 0x11, 0xF0, 0x90, 0xA3, 0x0C, 0x74, 0x01, 0xF0, 0x90, ++0xA3, 0x00, 0xEF, 0xF1, 0xEC, 0x7F, 0x04, 0x90, 0xA4, 0xB7, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x4C, ++0x2B, 0x90, 0xA0, 0x8A, 0xE0, 0xFF, 0x90, 0xA4, 0xB7, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0xA0, 0x8A, ++0xF0, 0x22, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xBD, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0xA2, 0xFE, 0x12, ++0x49, 0xB4, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA3, 0x13, 0xF0, 0xE4, 0xFB, 0xFD, 0x91, ++0x76, 0x90, 0xA3, 0x01, 0x74, 0x10, 0xF0, 0x90, 0xA3, 0x0F, 0x74, 0x07, 0xF0, 0x90, 0xA2, 0xFE, ++0x12, 0x49, 0xB4, 0x12, 0x26, 0x1E, 0x90, 0xA3, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x01, ++0xF1, 0xF3, 0x7F, 0x04, 0x80, 0xA1, 0x90, 0xA3, 0x11, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA3, ++0x10, 0xEF, 0xF0, 0x90, 0xA3, 0x13, 0xE0, 0xFD, 0x12, 0x9A, 0xE8, 0x90, 0xA3, 0x10, 0xE0, 0xC3, ++0x94, 0x0E, 0x50, 0x46, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA3, ++0x86, 0x12, 0x27, 0x54, 0x12, 0xD4, 0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0xF1, 0x99, 0x90, 0xA3, ++0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, 0x00, ++0x00, 0x00, 0xF1, 0x0F, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, ++0x7E, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xC1, 0x23, 0x90, 0xA3, 0x10, 0xE0, 0xFF, 0x74, ++0x24, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x30, 0x50, 0x16, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, ++0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x09, 0x28, 0x00, 0x00, 0x80, 0x70, ++0x90, 0xA3, 0x10, 0xE0, 0xFF, 0x74, 0x32, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x40, 0x50, 0x16, ++0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, ++0x08, 0xA6, 0x00, 0x00, 0x80, 0x4A, 0x90, 0xA3, 0x10, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, ++0x1B, 0xEF, 0x94, 0x74, 0x50, 0x16, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, ++0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x08, 0xA4, 0x00, 0x00, 0x80, 0x24, 0x90, 0xA3, 0x10, 0xE0, ++0xFF, 0x74, 0x76, 0xD3, 0x9F, 0x50, 0x1F, 0xEF, 0x94, 0xA5, 0x50, 0x1A, 0x90, 0xA3, 0x82, 0x12, ++0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x08, 0x24, 0x00, 0x00, ++0x7F, 0x60, 0x7E, 0x08, 0xF1, 0x99, 0x90, 0xA3, 0x10, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, ++0x31, 0xEF, 0x94, 0x40, 0x50, 0x2C, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, ++0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0xF1, 0x0F, 0x90, 0xA3, 0x7A, 0x12, ++0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, ++0x80, 0x71, 0x90, 0xA3, 0x10, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x31, 0xEF, 0x94, 0x8C, ++0x50, 0x2C, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, 0x7E, 0x12, ++0x27, 0x54, 0x00, 0x03, 0x01, 0x00, 0xF1, 0x0F, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, ++0x03, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, 0x03, 0x01, 0x00, 0x80, 0x35, 0x90, 0xA3, ++0x10, 0xE0, 0xFF, 0x74, 0x8C, 0xC3, 0x9F, 0x50, 0x32, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, ++0x07, 0x03, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, 0x05, 0x01, 0x00, 0xF1, 0x0F, 0x90, ++0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, ++0x05, 0x01, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0xF1, 0x15, 0x90, 0xA3, 0x11, 0xE0, 0x64, ++0x02, 0x70, 0x66, 0x90, 0xA3, 0x10, 0xE0, 0xFF, 0xD3, 0x94, 0x30, 0x50, 0x08, 0x90, 0xA3, 0x14, ++0x74, 0x2A, 0xF0, 0x80, 0x70, 0xEF, 0xD3, 0x94, 0x40, 0x50, 0x08, 0x90, 0xA3, 0x14, 0x74, 0x3A, ++0xF0, 0x80, 0x62, 0xEF, 0xD3, 0x94, 0x70, 0x50, 0x08, 0x90, 0xA3, 0x14, 0x74, 0x6A, 0xF0, 0x80, ++0x54, 0xEF, 0xD3, 0x94, 0x80, 0x50, 0x08, 0x90, 0xA3, 0x14, 0x74, 0x7A, 0xF0, 0x80, 0x46, 0xEF, ++0xD3, 0x94, 0x90, 0x50, 0x08, 0x90, 0xA3, 0x14, 0x74, 0x8A, 0xF0, 0x80, 0x38, 0xEF, 0xD3, 0x94, ++0xA1, 0x50, 0x08, 0x90, 0xA3, 0x14, 0x74, 0x9B, 0xF0, 0x80, 0x2A, 0xEF, 0xD3, 0x94, 0xB1, 0x50, ++0x24, 0x90, 0xA3, 0x14, 0x74, 0xAB, 0xF0, 0x80, 0x1C, 0x90, 0xA3, 0x11, 0xE0, 0x64, 0x01, 0x70, ++0x32, 0xA3, 0xE0, 0x90, 0xA3, 0x10, 0xB4, 0x01, 0x05, 0xE0, 0x24, 0x02, 0x80, 0x03, 0xE0, 0x24, ++0xFE, 0x90, 0xA3, 0x14, 0xF0, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, ++0xA3, 0x14, 0xF1, 0x03, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA3, ++0x14, 0x80, 0x1C, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA3, 0x10, ++0xF1, 0x03, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA3, 0x10, 0xE0, ++0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, 0x00, 0x7F, ++0x01, 0x80, 0x12, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x48, 0x7D, ++0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x90, 0xA3, 0x78, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA3, 0x77, ++0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x3A, 0xA9, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x48, 0x90, ++0xA3, 0x7A, 0x12, 0x49, 0x4B, 0x12, 0x27, 0x15, 0x90, 0xA3, 0x82, 0x12, 0x49, 0x73, 0x12, 0x48, ++0x7C, 0x90, 0xA3, 0x7E, 0x12, 0x49, 0x73, 0x12, 0x48, 0x89, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x48, ++0x90, 0xA3, 0x78, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0xA3, 0x86, 0x12, 0x49, 0x4B, 0x90, 0xAC, ++0x96, 0x12, 0x27, 0x48, 0x90, 0xA3, 0x77, 0xE0, 0xFF, 0xD0, 0x05, 0x02, 0x39, 0xBA, 0x90, 0x07, ++0x1F, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, 0xA3, 0x94, 0xF0, 0x90, ++0xA3, 0x92, 0x74, 0x02, 0xF0, 0x90, 0xA3, 0xA0, 0x14, 0xF0, 0xFB, 0x7A, 0xA3, 0x79, 0x92, 0xF1, ++0xF3, 0x7F, 0x04, 0x81, 0x17, 0x7F, 0x2C, 0x7E, 0x08, 0x90, 0xA3, 0x80, 0xEE, 0xF0, 0xA3, 0xEF, ++0xF0, 0x12, 0x36, 0xCE, 0x90, 0xA3, 0x8A, 0x12, 0x27, 0x48, 0x90, 0xA3, 0x82, 0x12, 0x49, 0x4B, ++0x12, 0x27, 0x15, 0x90, 0xA3, 0x8A, 0x12, 0x49, 0x73, 0x12, 0x48, 0x7C, 0x90, 0xA3, 0x86, 0x12, ++0x49, 0x73, 0x12, 0x48, 0x89, 0x90, 0xA3, 0x8E, 0x12, 0x27, 0x48, 0x90, 0xA3, 0x8E, 0x12, 0x49, ++0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x90, 0xA3, 0x80, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x02, ++0x37, 0x5D, 0x80, 0x8A, 0x12, 0x26, 0x1E, 0x90, 0xA1, 0xBB, 0xF0, 0x22, 0xF0, 0x7B, 0x01, 0x7A, ++0xA2, 0x79, 0xFE, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA1, 0x27, 0xE0, 0xFF, 0x70, ++0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA1, 0x28, 0xE0, 0xB5, 0x07, ++0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, ++0xF0, 0x80, 0x35, 0xC0, 0x01, 0x90, 0xA1, 0x28, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x91, 0xF9, ++0x74, 0xA0, 0x35, 0xF0, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, ++0x47, 0xD0, 0x90, 0xA1, 0x28, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, ++0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA1, 0x28, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD1, 0x38, 0xB1, ++0x79, 0x11, 0xB4, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA4, 0x61, 0xF0, ++0x90, 0x01, 0xC7, 0xE0, 0x64, 0xAD, 0x70, 0x37, 0xF0, 0x90, 0xA4, 0x6E, 0x74, 0x0F, 0xF0, 0x90, ++0xA4, 0x60, 0x74, 0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x61, 0xE0, 0x2F, 0xFE, 0x74, ++0x62, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x0F, 0xE9, ++0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x60, 0x12, 0x51, 0x23, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x00, 0x8F, 0xE0, 0x20, ++0xE6, 0x02, 0x81, 0x7E, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0xA4, 0xA5, 0xF0, 0x90, 0x00, 0x8D, 0xE0, ++0x90, 0xA4, 0xA6, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0xA4, 0xA7, 0xF0, 0x90, 0xA4, 0xA6, 0xE0, ++0x12, 0x49, 0xC6, 0x58, 0xFC, 0x01, 0x59, 0x05, 0x02, 0x59, 0x0E, 0x03, 0x59, 0x17, 0x04, 0x5A, ++0x33, 0x05, 0x5B, 0x2C, 0x06, 0x5B, 0xB4, 0x08, 0x00, 0x00, 0x5C, 0x70, 0x90, 0xA4, 0xA5, 0xE0, ++0xFF, 0xB1, 0xD8, 0x81, 0x70, 0x90, 0xA4, 0xA5, 0xE0, 0xFF, 0x91, 0xB1, 0x81, 0x70, 0x90, 0xA4, ++0xA5, 0xE0, 0xFF, 0xB1, 0x21, 0x81, 0x70, 0x90, 0xA4, 0xA5, 0xE0, 0x24, 0x0A, 0xF5, 0x82, 0xE4, ++0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, ++0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, ++0xFF, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, ++0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0xE4, 0xFF, 0x91, 0x89, 0x90, 0xA4, 0xA5, ++0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x54, 0x03, 0xFB, 0x0D, ++0xE4, 0xFF, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0A, 0x12, 0x49, ++0xA8, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x04, 0x90, ++0x95, 0x0B, 0x91, 0x83, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0C, 0x12, 0x49, ++0xA8, 0xE0, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, ++0x75, 0xF0, 0x04, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x1F, 0xFB, 0x0D, 0x91, 0x89, ++0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0xFB, 0xE4, ++0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x01, 0x91, 0x83, ++0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x91, 0x83, 0x90, 0xA4, 0xA5, 0xE0, ++0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x91, 0x83, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x08, 0x90, ++0x89, 0x04, 0x12, 0x49, 0xA8, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, ++0x75, 0xF0, 0x08, 0x90, 0x89, 0x05, 0x91, 0x83, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x08, 0x90, ++0x89, 0x06, 0x91, 0x83, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x07, 0x12, 0x49, ++0xA8, 0x61, 0xAF, 0x90, 0xA4, 0xA5, 0xE0, 0x25, 0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x92, ++0xF5, 0x83, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x25, 0xE0, ++0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA4, ++0xA5, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x79, 0x12, 0x49, 0xA8, 0xA3, 0xE0, 0xFB, 0x0D, 0x91, ++0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x79, 0x91, 0x83, 0x90, 0xA4, 0xA5, ++0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x7B, 0x12, 0x49, 0xA8, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, ++0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x7D, 0x12, 0x49, 0xA8, 0xA3, ++0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x7F, 0x12, ++0x49, 0xA8, 0xA3, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x0A, 0x90, ++0x8D, 0x81, 0x12, 0x49, 0xA8, 0xA3, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x24, ++0x0A, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0xE4, ++0xFB, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, ++0xF5, 0x83, 0xA3, 0xE0, 0xFB, 0x7D, 0x02, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x25, 0xE0, 0x24, ++0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xD7, ++0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA1, 0xD8, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, ++0xA1, 0xD9, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xDA, 0x61, 0xAF, 0x90, 0xA1, 0xDF, 0xE0, ++0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x89, 0x90, 0xA1, 0xE0, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, ++0xE1, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xE2, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, ++0xE3, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA1, 0xE4, 0xE0, 0xFB, 0x0D, 0x91, 0x89, ++0x90, 0xA1, 0xE5, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xE6, 0xE0, 0xFB, 0x0D, 0x91, 0x89, ++0x90, 0xA1, 0xE7, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA1, 0xE8, 0xE0, 0xFB, 0x0D, ++0x91, 0x89, 0x90, 0xA1, 0xE9, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xEA, 0xE0, 0xFB, 0x0D, ++0x91, 0x89, 0x90, 0xA1, 0xEB, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA1, 0xEC, 0xE0, ++0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xED, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xEE, 0xE0, ++0xFB, 0x0D, 0x81, 0x6E, 0x90, 0xA1, 0xB1, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x89, 0x90, 0xA1, ++0xB0, 0xE0, 0x54, 0x0F, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xB3, 0xE0, 0xFB, 0x0D, 0x91, 0x89, ++0x90, 0xA1, 0xB4, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x24, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA1, 0xAE, 0xE0, ++0x54, 0x01, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xAE, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFB, ++0x0D, 0x7F, 0x01, 0x91, 0x89, 0x90, 0xA1, 0xAE, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, ++0x0D, 0x7F, 0x01, 0x91, 0x89, 0x90, 0xA1, 0xC9, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, ++0xA1, 0xB9, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xB8, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, ++0xA1, 0xB7, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xB0, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, 0xE4, ++0xFD, 0x7F, 0x03, 0x91, 0x89, 0x90, 0xA1, 0xAF, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, ++0x03, 0x91, 0x89, 0x90, 0xA1, 0xAF, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, ++0x91, 0x89, 0x90, 0xA1, 0xAE, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0x91, 0x89, ++0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x12, 0x49, 0xA8, 0xE0, 0xFB, 0x0D, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, ++0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, ++0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, ++0x22, 0x90, 0xA4, 0xB5, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x63, 0x90, 0x00, 0x8D, ++0xE0, 0x64, 0x02, 0x70, 0x5B, 0x90, 0xA4, 0xB6, 0xF0, 0x90, 0xA4, 0xB6, 0xE0, 0xFD, 0x90, 0xA4, ++0xB5, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, ++0x82, 0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x91, 0x89, 0x90, ++0xA4, 0xB6, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x08, 0x40, 0xCE, 0x90, 0xA4, 0xB6, 0xE0, 0xFD, ++0xC3, 0x94, 0x10, 0x50, 0x0D, 0xE4, 0xFB, 0xFF, 0x91, 0x89, 0x90, 0xA4, 0xB6, 0xE0, 0x04, 0xF0, ++0x80, 0xE9, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, ++0x22, 0x90, 0xA2, 0xED, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x4B, 0x90, 0x00, 0x8D, ++0xE0, 0x64, 0x03, 0x70, 0x43, 0x90, 0xA2, 0xEE, 0xF0, 0x90, 0xA2, 0xEE, 0xE0, 0xFD, 0x90, 0xA2, ++0xED, 0xE0, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, ++0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x91, 0x89, 0x90, 0xA2, ++0xEE, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCF, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, ++0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x57, ++0x90, 0x00, 0x8D, 0xE0, 0x64, 0x03, 0x70, 0x4F, 0x90, 0x00, 0x8F, 0xE0, 0xFE, 0x90, 0x00, 0x8E, ++0xE0, 0xFD, 0xED, 0xFF, 0x90, 0xA2, 0xEE, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0xA2, 0xED, ++0xF0, 0x90, 0xA2, 0xED, 0xE0, 0xFD, 0xFF, 0x90, 0xA2, 0xEF, 0xE0, 0x2F, 0xFF, 0x90, 0xA2, 0xEE, ++0xE0, 0x34, 0x00, 0x8F, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x91, 0x89, 0x90, 0xA2, 0xED, ++0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD8, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, ++0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0xA4, 0xB3, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x48, 0x90, 0x00, 0x8D, 0xE0, 0x64, ++0x01, 0x70, 0x40, 0x90, 0xA4, 0xB4, 0xF0, 0x90, 0xA4, 0xB4, 0xE0, 0xFD, 0x90, 0xA4, 0xB3, 0xE0, ++0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2D, 0xF5, 0x82, 0xE4, 0x35, ++0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x91, 0x89, 0x90, 0xA4, 0xB4, 0xE0, 0x04, 0xF0, 0xE0, ++0xC3, 0x94, 0x10, 0x40, 0xD2, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, ++0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE5, 0x2A, 0x90, ++0x00, 0x8E, 0xE0, 0x64, 0x05, 0x70, 0x22, 0xA3, 0xE0, 0xFF, 0x90, 0x00, 0x8E, 0xE0, 0xFE, 0x74, ++0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, ++0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8E, 0x12, 0x3A, 0x96, 0x22, 0x90, 0xA3, 0x77, 0xEF, 0xF0, 0xA3, ++0xED, 0xF0, 0xFB, 0xA3, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xE4, 0x90, 0xA3, 0x81, 0xF0, ++0xEB, 0x90, 0xA3, 0x78, 0xF0, 0x90, 0xA2, 0xE8, 0xE0, 0x70, 0x3D, 0x90, 0xA3, 0x77, 0xE0, 0x70, ++0x17, 0xFF, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x04, 0xFF, 0xEC, 0x90, 0xAC, 0xB9, 0x12, ++0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x80, 0x1D, 0x90, 0xA3, 0x77, 0xE0, 0xB4, 0x01, 0x19, 0x7F, ++0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x04, 0xFF, 0xEC, 0x90, 0xAC, 0xB9, 0x12, 0x27, ++0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x78, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, ++0xFE, 0x90, 0xA3, 0x7D, 0x12, 0x27, 0x48, 0x90, 0xA3, 0x7D, 0x12, 0x49, 0x4B, 0x90, 0xAC, 0xB9, ++0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0xA2, 0xE8, 0xE0, 0x70, 0x26, ++0x90, 0xA3, 0x7D, 0x12, 0x49, 0x4B, 0xEE, 0x44, 0x01, 0xFE, 0xEC, 0x90, 0xA3, 0x7D, 0x12, 0x27, ++0x48, 0x90, 0xA3, 0x7D, 0x12, 0x49, 0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, ++0x08, 0x12, 0x37, 0x5D, 0x80, 0x07, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA3, 0x77, ++0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0xAF, 0xF5, 0x83, 0xE0, 0xFE, ++0xA3, 0xE0, 0xFF, 0x12, 0x36, 0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x90, 0xA3, 0x79, 0x12, ++0x27, 0x48, 0x90, 0xA3, 0x79, 0x02, 0x49, 0x4B, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD1, ++0x6A, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xBD, 0x90, 0xA3, 0x82, 0x12, ++0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, ++0x12, 0x57, 0x95, 0x7D, 0x65, 0xE4, 0xFF, 0xF1, 0x48, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xB4, 0x12, ++0x49, 0x0D, 0x7D, 0x8F, 0xE4, 0xFF, 0xF1, 0x48, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xB4, 0x90, 0x00, ++0x04, 0x12, 0x49, 0x27, 0xE4, 0xFD, 0xFF, 0xF1, 0x48, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xB4, 0x90, ++0x00, 0x08, 0x12, 0x49, 0x27, 0x7D, 0x65, 0x7F, 0x01, 0xF1, 0x48, 0x90, 0xA3, 0x74, 0x12, 0x49, ++0xB4, 0x12, 0x49, 0x0D, 0x7D, 0x8F, 0x7F, 0x01, 0xF1, 0x48, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xB4, ++0x90, 0x00, 0x04, 0x12, 0x49, 0x27, 0xE4, 0xFD, 0x7F, 0x01, 0xF1, 0x48, 0x90, 0xA3, 0x74, 0x12, ++0x49, 0xB4, 0x90, 0x00, 0x08, 0x02, 0x49, 0x27, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0xEF, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0xA3, 0x79, 0x12, 0x49, 0x4B, ++0x90, 0xAC, 0x9C, 0x12, 0x27, 0x48, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0x32, 0x65, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, ++0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0x01, 0xC4, 0x74, 0x02, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0x11, 0x51, 0x74, 0x02, 0x04, 0x90, 0x01, ++0xC4, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, ++0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, ++0x32, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x51, ++0x52, 0x53, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, ++0x52, 0x52, 0x54, 0xAB, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x54, 0x7D, 0x01, ++0x7F, 0x01, 0x02, 0x39, 0x04, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, ++0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, ++0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x85, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0x11, 0xD4, 0x74, 0x85, ++0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, ++0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, ++0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x00, 0x54, 0xE0, 0x55, 0x55, 0xF5, 0x59, 0xA3, 0xE0, 0x55, 0x56, ++0xF5, 0x5A, 0xA3, 0xE0, 0x55, 0x57, 0xF5, 0x5B, 0xA3, 0xE0, 0x55, 0x58, 0xF5, 0x5C, 0xAD, 0x59, ++0x7F, 0x54, 0x12, 0x3A, 0x96, 0xAD, 0x5A, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0xAD, 0x5B, 0x7F, 0x56, ++0x12, 0x3A, 0x96, 0xAD, 0x5C, 0x7F, 0x57, 0x12, 0x3A, 0x96, 0x53, 0x91, 0xEF, 0x22, 0xC0, 0xE0, ++0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, ++0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x0E, ++0xF0, 0x74, 0x61, 0xA3, 0xF0, 0x12, 0x7B, 0x7B, 0xE5, 0x61, 0x30, 0xE1, 0x02, 0x91, 0x9A, 0xE5, ++0x61, 0x30, 0xE4, 0x05, 0x7F, 0x02, 0x12, 0x77, 0xD7, 0xE5, 0x63, 0x30, 0xE0, 0x02, 0x31, 0xC3, ++0xE5, 0x63, 0x30, 0xE1, 0x03, 0x12, 0x73, 0xA4, 0xE5, 0x63, 0x30, 0xE2, 0x03, 0x12, 0x73, 0x2B, ++0xE5, 0x63, 0x30, 0xE3, 0x03, 0x12, 0x7B, 0xD8, 0xE5, 0x63, 0x30, 0xE4, 0x03, 0x12, 0x7C, 0x0B, ++0xE5, 0x63, 0x30, 0xE5, 0x03, 0x12, 0x7C, 0x3A, 0xE5, 0x63, 0x30, 0xE6, 0x03, 0x12, 0x7D, 0x3D, ++0xE5, 0x64, 0x30, 0xE1, 0x02, 0xD1, 0x3E, 0xE5, 0x64, 0x30, 0xE4, 0x02, 0xD1, 0x9C, 0xE5, 0x64, ++0x30, 0xE5, 0x02, 0xB1, 0x20, 0xE5, 0x64, 0x30, 0xE6, 0x03, 0x12, 0x57, 0xE2, 0x74, 0x0E, 0x04, ++0x90, 0x01, 0xC4, 0xF0, 0x74, 0x61, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, ++0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, ++0xD0, 0xE0, 0x32, 0xE4, 0xFF, 0x90, 0xA1, 0xB1, 0xE0, 0x70, 0x02, 0x41, 0x4E, 0x90, 0xA1, 0x2D, ++0xE0, 0x64, 0x01, 0x70, 0x79, 0x90, 0xA1, 0xB0, 0xE0, 0xC4, 0x54, 0x0F, 0x60, 0x24, 0x24, 0xFE, ++0x60, 0x03, 0x04, 0x70, 0x1F, 0x90, 0xA1, 0xB8, 0xE0, 0x14, 0xF0, 0xE0, 0xFE, 0x60, 0x06, 0x90, ++0xA1, 0xBA, 0xE0, 0x60, 0x0F, 0xEE, 0x70, 0x06, 0x90, 0xA1, 0xB7, 0xE0, 0xA3, 0xF0, 0x7F, 0x01, ++0x80, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x47, 0x90, 0xA1, 0xB5, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA1, ++0xBA, 0xE0, 0x60, 0x03, 0xB4, 0x01, 0x09, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0xBA, 0xE0, 0x80, 0x0D, ++0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0xBA, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0xA1, ++0xB9, 0xE0, 0x2F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, ++0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0xB4, 0xE0, 0x20, 0xE2, 0x02, 0x51, 0x4F, 0x22, 0x7D, ++0x01, 0x7F, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xBB, 0xED, 0xF0, 0x90, ++0xA1, 0xAE, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x61, 0xA0, 0xEE, 0xC4, ++0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x02, 0x61, 0xA0, 0x90, 0xA1, 0xB4, 0xE0, 0xFE, 0x6F, ++0x70, 0x02, 0x61, 0xA0, 0xEF, 0x70, 0x02, 0x61, 0x15, 0x24, 0xFE, 0x70, 0x02, 0x61, 0x4F, 0x24, ++0xFE, 0x60, 0x4A, 0x24, 0xFC, 0x70, 0x02, 0x61, 0x8A, 0x24, 0xFC, 0x60, 0x02, 0x61, 0xA0, 0xEE, ++0xB4, 0x0E, 0x02, 0x91, 0x21, 0x90, 0xA1, 0xB4, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x91, 0x49, 0x90, ++0xA1, 0xB4, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0xFB, 0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x04, 0x0F, 0x90, ++0xA4, 0xBB, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0xB9, 0x3E, 0x80, 0x03, 0x12, 0x71, 0x4F, 0x90, 0xA1, ++0xB4, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x61, 0xA0, 0x12, 0x78, 0x9C, 0x61, 0xA0, 0x90, 0xA1, 0xB4, ++0xE0, 0x70, 0x04, 0x7F, 0x01, 0x91, 0x49, 0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0xFB, ++0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x0E, 0x07, 0x71, 0xA5, 0xBF, 0x01, 0x02, 0x91, 0x21, 0x90, 0xA1, ++0xB4, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x61, 0xA0, 0x71, 0xA5, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x61, ++0xA0, 0x91, 0x63, 0x61, 0xA0, 0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x0E, 0x07, 0x71, 0xA5, 0xBF, 0x01, ++0x02, 0x91, 0x21, 0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0xFB, 0x90, 0xA1, 0xB4, 0xE0, ++0xB4, 0x0C, 0x07, 0x71, 0xA5, 0xBF, 0x01, 0x02, 0x91, 0x63, 0x90, 0xA1, 0xB4, 0xE0, 0x64, 0x04, ++0x70, 0x5E, 0x12, 0xB8, 0x8E, 0xEF, 0x64, 0x01, 0x70, 0x56, 0x12, 0x76, 0x7B, 0x80, 0x51, 0x90, ++0xA1, 0xB4, 0xE0, 0xB4, 0x0E, 0x07, 0x71, 0xA5, 0xBF, 0x01, 0x02, 0x91, 0x21, 0x90, 0xA1, 0xB4, ++0xE0, 0xB4, 0x06, 0x02, 0x71, 0xFB, 0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x0C, 0x07, 0x71, 0xA5, 0xBF, ++0x01, 0x02, 0x91, 0x63, 0x90, 0xA1, 0xB4, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x91, 0x49, 0x90, 0xA1, ++0xB4, 0xE0, 0xB4, 0x04, 0x1B, 0x12, 0xB9, 0x80, 0x80, 0x16, 0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x0C, ++0x0F, 0x90, 0xA1, 0xAF, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x76, 0x6C, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0xB8, 0x75, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, ++0x74, 0x01, 0xF0, 0x80, 0x3D, 0x90, 0xA1, 0xAE, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, ++0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x28, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, ++0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x19, 0x90, 0xA1, 0xB3, 0xE0, 0xD3, 0x94, 0x04, ++0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, ++0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0xA1, 0xAF, 0xE0, 0x90, ++0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x04, 0xF0, 0x80, ++0x0A, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x0C, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, ++0x22, 0x90, 0xA1, 0xAF, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0x90, 0xA1, 0xB4, 0x74, 0x0C, 0xF0, ++0x80, 0x11, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA1, 0xB4, ++0x74, 0x04, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0xA4, 0xBA, 0xEF, 0xF0, 0x12, 0x78, ++0xAA, 0x90, 0xA4, 0xBA, 0xE0, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0xB4, 0x74, ++0x04, 0xF0, 0x22, 0x90, 0xA1, 0x2D, 0xE0, 0x64, 0x01, 0x70, 0x2E, 0x90, 0xA1, 0xAF, 0xE0, 0x54, ++0xFD, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x7F, 0x01, 0x12, 0x74, 0xDD, 0xBF, 0x01, 0x0E, ++0x90, 0xA1, 0xAE, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x0E, 0xF0, 0x22, 0x90, 0x01, ++0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x22, 0xE4, 0xFF, 0x90, 0xA3, 0x92, 0xEF, ++0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, 0x1B, 0xA3, 0xE0, 0xF5, 0x1C, 0x65, 0x1B, 0x60, 0x70, 0x90, ++0xA3, 0x93, 0x74, 0x03, 0xF0, 0x90, 0xA3, 0xA1, 0x74, 0x08, 0xF0, 0xE5, 0x1C, 0x04, 0x54, 0x0F, ++0xF5, 0x1D, 0xE4, 0xF5, 0x1A, 0xE5, 0x1D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, ++0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, ++0xFF, 0x74, 0x95, 0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x1A, ++0xE5, 0x1A, 0xB4, 0x08, 0xD0, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x93, 0x12, 0x57, 0xF3, 0xE5, 0x1C, ++0x04, 0x54, 0x0F, 0xF5, 0x1C, 0xB4, 0x0F, 0x03, 0xE4, 0xF5, 0x1C, 0x90, 0x04, 0x7F, 0xE5, 0x1C, ++0xF0, 0x90, 0xA3, 0x92, 0xE0, 0x7F, 0x04, 0x70, 0x03, 0x02, 0x77, 0xD7, 0x12, 0x54, 0x17, 0x22, ++0x90, 0xA1, 0xEC, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x1A, 0x90, 0x04, 0x30, 0xE0, 0xB4, 0x01, 0x06, ++0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0x74, 0x2D, 0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, ++0x83, 0xE0, 0x70, 0x02, 0xC1, 0x32, 0xE5, 0x1A, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0xE5, 0x1A, ++0x54, 0x07, 0xFE, 0x74, 0x79, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFD, 0xAF, ++0x06, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, ++0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0xC1, 0x32, 0x75, 0xF0, 0x10, 0xE5, 0x1A, 0x90, 0x81, 0x01, ++0x12, 0x49, 0xA8, 0xE0, 0x20, 0xE7, 0x02, 0x80, 0x10, 0x75, 0xF0, 0x10, 0xE5, 0x1A, 0x90, 0x81, ++0x02, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0x20, 0xE7, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x20, 0xF0, ++0xC1, 0x32, 0xEF, 0x30, 0xE6, 0x2B, 0x90, 0xA1, 0xE9, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x10, 0xE5, ++0x1A, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x90, 0x95, ++0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA4, 0x80, 0xF0, 0xE4, 0xFB, 0x80, ++0x5C, 0x90, 0xA1, 0xEA, 0xE0, 0x04, 0xF0, 0x74, 0x0A, 0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0x9F, ++0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x74, 0x0A, 0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, ++0xE0, 0xD3, 0x94, 0x02, 0x40, 0x14, 0xAF, 0x1A, 0x12, 0x6E, 0x8A, 0x74, 0x0A, 0x25, 0x1A, 0xF5, ++0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x28, 0x75, 0xF0, 0x10, 0xE5, 0x1A, 0x90, ++0x81, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x90, 0x95, 0x0D, 0x12, ++0x49, 0xA8, 0xE0, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA4, 0x80, 0xF0, 0x7B, 0x01, 0xAF, 0x1A, 0x12, ++0x68, 0xFD, 0x05, 0x1A, 0xE5, 0x1A, 0xC3, 0x94, 0x80, 0x50, 0x02, 0xA1, 0x29, 0x22, 0x90, 0xA1, ++0xB1, 0xE0, 0x60, 0x02, 0xD1, 0x47, 0x22, 0x90, 0xA1, 0xB1, 0xE0, 0x64, 0x01, 0x70, 0x4C, 0x90, ++0xA1, 0xB0, 0xE0, 0x54, 0x0F, 0x60, 0x3C, 0xE4, 0xFD, 0x7F, 0x0C, 0x51, 0x53, 0x90, 0x01, 0x5B, ++0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0xC4, 0xE0, 0xC3, ++0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, ++0x01, 0x5B, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x44, ++0x08, 0xF0, 0x22, 0x90, 0xA1, 0xB4, 0xE0, 0x70, 0x02, 0x51, 0x4F, 0x22, 0x90, 0xA1, 0xEB, 0xE0, ++0x04, 0xF0, 0xE4, 0xFF, 0x90, 0xA3, 0xA6, 0xEF, 0xF0, 0xE4, 0xF5, 0x24, 0x74, 0xA7, 0x25, 0x24, ++0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, ++0x03, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0x30, 0xE7, 0x10, 0xE5, 0x24, 0x70, 0x1F, 0xEF, 0x30, 0xE6, ++0x1B, 0x90, 0xA1, 0xE8, 0xE0, 0x04, 0xF0, 0x80, 0x13, 0xAF, 0x24, 0x12, 0x9A, 0x7A, 0x74, 0xA7, ++0x25, 0x24, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x05, 0x24, 0xE5, 0x24, ++0xC3, 0x94, 0x80, 0x40, 0xB7, 0x7F, 0x0C, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xE4, 0xF5, 0x24, 0x74, ++0xA7, 0x25, 0x24, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, 0x68, 0x63, ++0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, 0x06, 0x12, 0x49, 0xA8, 0xE0, 0xF5, 0x22, 0x75, 0xF0, ++0x10, 0xE5, 0x24, 0x90, 0x81, 0x07, 0x12, 0x49, 0xA8, 0xE0, 0xF5, 0x23, 0xFE, 0xE5, 0x22, 0xFF, ++0xE5, 0x24, 0x25, 0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, 0x0A, 0x12, 0x49, 0xA8, 0xE0, 0xF5, 0x22, ++0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, 0x0B, 0x12, 0x49, 0xA8, 0xE0, 0xF5, 0x23, 0xFE, 0xE5, ++0x22, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x24, 0x90, 0x8D, 0x79, 0x12, 0x49, 0xA8, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0x75, ++0xF0, 0x0A, 0xE5, 0x24, 0x90, 0x8D, 0x7B, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, ++0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, ++0x24, 0x90, 0x8D, 0x7D, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, ++0x24, 0x90, 0x81, 0x0E, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x24, 0x90, 0x8D, ++0x7F, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, ++0x0F, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x24, 0x90, 0x8D, 0x81, 0x12, 0x49, ++0xA8, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, 0x09, 0x12, 0x49, ++0xA8, 0xE0, 0xFF, 0x74, 0x0A, 0x25, 0x24, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xEF, 0xF0, ++0xE5, 0x24, 0x70, 0x56, 0xE5, 0x23, 0x30, 0xE7, 0x05, 0x90, 0xA1, 0xE7, 0x80, 0x49, 0xE5, 0x23, ++0x30, 0xE6, 0x05, 0x90, 0xA1, 0xE6, 0x80, 0x3F, 0xE5, 0x23, 0x30, 0xE5, 0x05, 0x90, 0xA1, 0xE5, ++0x80, 0x35, 0xE5, 0x23, 0x30, 0xE4, 0x05, 0x90, 0xA1, 0xE4, 0x80, 0x2B, 0xE5, 0x23, 0x30, 0xE3, ++0x05, 0x90, 0xA1, 0xE3, 0x80, 0x21, 0xE5, 0x23, 0x30, 0xE2, 0x05, 0x90, 0xA1, 0xE2, 0x80, 0x17, ++0xE5, 0x23, 0x30, 0xE1, 0x05, 0x90, 0xA1, 0xE1, 0x80, 0x0D, 0xE5, 0x23, 0x30, 0xE0, 0x05, 0x90, ++0xA1, 0xE0, 0x80, 0x03, 0x90, 0xA1, 0xDF, 0xE0, 0x04, 0xF0, 0x90, 0xA3, 0xA6, 0xE0, 0xFD, 0xAF, ++0x24, 0x11, 0x70, 0x05, 0x24, 0xE5, 0x24, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x66, 0xFF, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x62, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, ++0x79, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x7B, 0x12, ++0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x7D, 0x12, 0x49, 0xA8, ++0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x7F, 0x12, 0x49, 0xA8, 0xE4, 0xF0, ++0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x81, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, ++0xEF, 0x25, 0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, ++0x74, 0x0A, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xEF, ++0x90, 0x81, 0x03, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0x75, 0xF0, 0x10, 0xEF, ++0x90, 0x81, 0x03, 0x12, 0x49, 0xA8, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x7F, 0xEB, 0xF0, 0x90, 0xA4, 0x7D, 0xEF, 0xF0, 0xFC, 0xA3, ++0xED, 0xF0, 0xF9, 0x90, 0xA4, 0x7D, 0xE0, 0xFE, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA4, 0x81, ++0xF0, 0xEE, 0x54, 0x07, 0x90, 0xA4, 0x83, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x01, 0x12, ++0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x84, 0xF0, 0xE4, 0x90, 0xA4, 0x86, 0xF0, 0xE9, 0x54, 0x7F, 0x90, ++0xA4, 0x82, 0xF0, 0xFB, 0x25, 0xE0, 0x24, 0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xE4, ++0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, 0x04, 0xEB, 0x90, 0x42, 0x3B, ++0x12, 0x49, 0xA8, 0x12, 0x49, 0x8C, 0x12, 0x48, 0x6F, 0x78, 0x01, 0x12, 0x27, 0x22, 0x90, 0xA4, ++0x7D, 0xE0, 0xFD, 0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, ++0xA3, 0xEF, 0xF0, 0x90, 0xA4, 0x7E, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0x90, 0xA4, 0x82, 0xF0, 0xEF, ++0x54, 0x80, 0x90, 0xA4, 0x85, 0xF0, 0xEE, 0xD3, 0x94, 0x35, 0x50, 0x0B, 0x90, 0xA4, 0x82, 0xE0, ++0xC3, 0x94, 0x2C, 0x40, 0x02, 0x80, 0x10, 0x90, 0xA4, 0x82, 0xE0, 0xFF, 0xD3, 0x94, 0x13, 0x50, ++0x0E, 0xEF, 0xC3, 0x94, 0x0C, 0x40, 0x08, 0x90, 0xA4, 0x86, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, ++0x90, 0xA4, 0x86, 0xF0, 0xED, 0x70, 0x10, 0x90, 0xA4, 0x7D, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0xA4, ++0x50, 0xF0, 0xE4, 0xFD, 0xFF, 0xD1, 0x2B, 0x90, 0xA4, 0x7D, 0xE0, 0xFF, 0x90, 0xA4, 0x82, 0xE0, ++0xFD, 0xB1, 0xEC, 0x90, 0xA4, 0x7F, 0xE0, 0x70, 0x39, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0x90, ++0xA4, 0x81, 0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, ++0xE0, 0xFF, 0x90, 0xA4, 0x83, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, ++0xD8, 0xFC, 0xF4, 0x5F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA4, 0x84, 0xE0, 0x54, 0x7F, 0xF0, ++0x80, 0x6C, 0x90, 0xA4, 0x7D, 0xE0, 0xFF, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, ++0xE0, 0x90, 0x04, 0xCF, 0x30, 0xE0, 0x05, 0x74, 0x20, 0xF0, 0x80, 0x02, 0xE4, 0xF0, 0x90, 0xA4, ++0x81, 0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, ++0xFE, 0x90, 0xA4, 0x83, 0xE0, 0xFD, 0x74, 0x01, 0xA8, 0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, ++0xFC, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x01, 0x12, 0x49, ++0xA8, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0xA4, 0x84, 0xF0, 0x90, 0xA4, 0x82, 0xE0, 0x90, 0x44, 0x3F, ++0x93, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x4F, 0x90, 0xA4, 0x84, 0xF0, 0x44, 0x80, 0xF0, 0x90, 0xA4, ++0x7E, 0xE0, 0xFF, 0x90, 0xA4, 0x7D, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, ++0xA8, 0xEF, 0xF0, 0x90, 0xA4, 0x84, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x01, 0x12, ++0x49, 0xA8, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x05, 0x12, 0x49, 0xA8, 0xE0, 0x54, ++0xFC, 0xFF, 0x90, 0xA4, 0x80, 0xE0, 0x4F, 0xFE, 0x90, 0xA4, 0x7D, 0xE0, 0xFF, 0x75, 0xF0, 0x10, ++0x90, 0x81, 0x05, 0x12, 0x49, 0xA8, 0xEE, 0xF0, 0x7D, 0x01, 0x11, 0x70, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x25, 0x90, 0xA1, 0xEE, 0xE0, 0x04, 0xF0, ++0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x1F, 0x90, 0xA4, 0x93, ++0xF0, 0x24, 0xF5, 0x50, 0x0D, 0x60, 0x52, 0x14, 0x60, 0x55, 0x14, 0x60, 0x58, 0x14, 0x60, 0x5B, ++0x80, 0x62, 0xE4, 0xF5, 0x26, 0x90, 0xA4, 0x93, 0xE0, 0x75, 0xF0, 0x07, 0xA4, 0x24, 0x50, 0xF5, ++0x82, 0xE4, 0x34, 0x40, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, ++0x83, 0xE4, 0x93, 0xFF, 0x90, 0xA4, 0x95, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x25, 0x90, 0x89, 0x00, ++0x12, 0x49, 0xA8, 0xE5, 0x82, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, ++0x05, 0x26, 0xE5, 0x26, 0xB4, 0x07, 0xBE, 0x80, 0x1B, 0xAD, 0x25, 0x7F, 0x8C, 0x80, 0x10, 0xAD, ++0x25, 0x7F, 0x94, 0x80, 0x0A, 0xAD, 0x25, 0x7F, 0x9C, 0x80, 0x04, 0xAD, 0x25, 0x7F, 0xA4, 0x7E, ++0x04, 0x12, 0x87, 0x7D, 0x75, 0xF0, 0x04, 0xE5, 0x25, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, ++0xFF, 0xC4, 0x54, 0x03, 0xFD, 0xE4, 0x90, 0xA4, 0x91, 0xF0, 0x7C, 0x06, 0x75, 0xF0, 0x08, 0xE5, ++0x25, 0x90, 0x89, 0x00, 0xBC, 0x06, 0x12, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, ++0x35, 0x83, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x80, 0x0E, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2C, 0xF5, ++0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x90, 0xA4, 0x94, 0xF0, 0x90, 0xA4, 0x94, 0xE0, 0x60, ++0x64, 0x75, 0x26, 0x07, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x26, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, ++0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0xA4, 0x94, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x3E, 0xEC, 0x75, ++0xF0, 0x08, 0xA4, 0x25, 0x26, 0x90, 0xA4, 0x91, 0xF0, 0xBD, 0x01, 0x0C, 0xE0, 0xD3, 0x94, 0x0B, ++0x40, 0x06, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x39, 0xBD, 0x02, 0x0F, 0x90, 0xA4, 0x91, 0xE0, 0xD3, ++0x94, 0x1B, 0x40, 0x06, 0xE0, 0x24, 0x18, 0xF0, 0x80, 0x27, 0xBD, 0x03, 0x24, 0x90, 0xA4, 0x91, ++0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x1B, 0xE0, 0x24, 0x22, 0xF0, 0x80, 0x15, 0x15, 0x26, 0xE5, 0x26, ++0xC3, 0x94, 0x00, 0x50, 0x9F, 0xEC, 0x60, 0x09, 0x1C, 0xEC, 0xC3, 0x94, 0x00, 0x40, 0x02, 0x61, ++0x8C, 0xE4, 0x90, 0xA4, 0x92, 0xF0, 0xFC, 0x75, 0xF0, 0x08, 0xE5, 0x25, 0x90, 0x89, 0x00, 0xBC, ++0x06, 0x12, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, ++0x54, 0x0F, 0x80, 0x0E, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, ++0x83, 0xE0, 0x90, 0xA4, 0x94, 0xF0, 0x90, 0xA4, 0x94, 0xE0, 0x60, 0x63, 0xE4, 0xF5, 0x26, 0x74, ++0x01, 0x7E, 0x00, 0xA8, 0x26, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, ++0x90, 0xA4, 0x94, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x3E, 0xEC, 0x75, 0xF0, 0x08, 0xA4, 0x25, 0x26, ++0x90, 0xA4, 0x92, 0xF0, 0xBD, 0x01, 0x0C, 0xE0, 0xD3, 0x94, 0x0B, 0x40, 0x06, 0xE0, 0x24, 0x20, ++0xF0, 0x80, 0x34, 0xBD, 0x02, 0x0F, 0x90, 0xA4, 0x92, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x06, 0xE0, ++0x24, 0x18, 0xF0, 0x80, 0x22, 0xBD, 0x03, 0x1F, 0x90, 0xA4, 0x92, 0xE0, 0xD3, 0x94, 0x1B, 0x40, ++0x16, 0xE0, 0x24, 0x22, 0xF0, 0x80, 0x10, 0x05, 0x26, 0xE5, 0x26, 0x64, 0x08, 0x70, 0xA0, 0x0C, ++0xEC, 0x64, 0x07, 0x60, 0x02, 0x81, 0x37, 0x90, 0xA4, 0x91, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xE5, ++0x25, 0x90, 0x95, 0x0A, 0x12, 0x49, 0xA8, 0xEF, 0xF0, 0x90, 0xA4, 0x92, 0xE0, 0xFE, 0x75, 0xF0, ++0x04, 0xE5, 0x25, 0x90, 0x95, 0x0B, 0x12, 0x49, 0xA8, 0xEE, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x25, ++0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0xFC, 0x54, 0x7F, 0xFD, 0xEC, 0x54, 0x80, 0xFC, 0xED, ++0xD3, 0x9F, 0x40, 0x05, 0x90, 0xA4, 0x91, 0x80, 0x08, 0xED, 0xC3, 0x9E, 0x50, 0x06, 0x90, 0xA4, ++0x92, 0xE0, 0x4C, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x25, 0x90, 0x98, 0x8B, 0x12, 0x49, 0xA8, 0xED, ++0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x25, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x13, 0x13, 0x54, ++0x03, 0x90, 0xA4, 0x80, 0xF0, 0xE4, 0xFB, 0xAF, 0x25, 0x11, 0xFD, 0x75, 0xF0, 0x10, 0xE5, 0x25, ++0x90, 0x81, 0x03, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0x90, 0xA4, 0x91, 0xE0, 0xFF, 0xC3, 0x94, 0x36, ++0x40, 0x13, 0x75, 0xF0, 0x04, 0xE5, 0x25, 0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF1, ++0x44, 0x0A, 0xF0, 0x80, 0x72, 0xEF, 0xC3, 0x94, 0x2C, 0x40, 0x13, 0x75, 0xF0, 0x04, 0xE5, 0x25, ++0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF1, 0x44, 0x08, 0xF0, 0x80, 0x59, 0x90, 0xA4, ++0x91, 0xE0, 0xFF, 0xC3, 0x94, 0x14, 0x40, 0x13, 0x75, 0xF0, 0x04, 0xE5, 0x25, 0x90, 0x98, 0x8D, ++0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF1, 0x44, 0x06, 0xF0, 0x80, 0x3C, 0xEF, 0xC3, 0x94, 0x0C, 0x40, ++0x13, 0x75, 0xF0, 0x04, 0xE5, 0x25, 0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF1, 0x44, ++0x04, 0xF0, 0x80, 0x23, 0x90, 0xA4, 0x91, 0xE0, 0xC3, 0x94, 0x04, 0x75, 0xF0, 0x04, 0xE5, 0x25, ++0x90, 0x98, 0x8D, 0x40, 0x0B, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF1, 0x44, 0x02, 0xF0, 0x80, 0x07, ++0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF1, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x04, 0xEF, ++0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x54, 0x03, 0x70, 0x2E, 0xED, 0xC3, 0x94, 0x14, ++0x40, 0x15, 0xED, 0xD3, 0x94, 0x18, 0x50, 0x0F, 0x90, 0x04, 0x33, 0x74, 0x06, 0xF0, 0xA3, 0x04, ++0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x80, 0x0F, 0x90, 0x04, 0x33, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, ++0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0x22, 0x90, 0xA4, 0x4F, 0xEB, 0xF0, ++0x70, 0x57, 0x90, 0xA4, 0x4F, 0xE0, 0xFE, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, ++0xE0, 0xFC, 0x90, 0xA4, 0x50, 0xE0, 0xFB, 0xEC, 0x6B, 0x60, 0x3E, 0x90, 0xA4, 0x53, 0xEB, 0xF0, ++0xA3, 0xEE, 0xF0, 0xAE, 0x05, 0xEE, 0x25, 0xE0, 0x4F, 0xA3, 0xF0, 0x90, 0xA4, 0x51, 0x74, 0x0C, ++0xF0, 0x90, 0xA4, 0x5F, 0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x51, 0x12, 0x57, 0xF3, ++0x7F, 0x04, 0x12, 0x54, 0x17, 0x90, 0xA4, 0x50, 0xE0, 0xFF, 0x90, 0xA4, 0x4F, 0xE0, 0x24, 0x8A, ++0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0xAD, 0x07, 0x90, 0x01, 0xC4, 0x74, ++0x8A, 0xF0, 0x74, 0x6E, 0xA3, 0xF0, 0x90, 0x9C, 0x8A, 0x74, 0x05, 0xF0, 0x74, 0x8A, 0x2D, 0xF5, ++0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x74, 0x8A, 0x2D, 0xF5, 0x82, 0xE4, 0x34, ++0x9F, 0xF5, 0x83, 0xE0, 0xC3, 0x94, 0x03, 0x40, 0x40, 0x74, 0x8A, 0x2D, 0xF5, 0x82, 0xE4, 0x34, ++0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x0A, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, ++0xFF, 0x74, 0x89, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x0A, 0x2D, ++0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x25, 0xE0, 0x24, 0x1E, 0xFF, 0x74, 0x8A, 0x2D, ++0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, 0x81, 0x05, ++0x12, 0x49, 0xA8, 0xE0, 0x54, 0x03, 0xF5, 0x1C, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0A, 0x12, ++0x49, 0xA8, 0xE0, 0xF5, 0x1D, 0x74, 0x0A, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, ++0x54, 0x7F, 0xF5, 0x1B, 0x64, 0x2C, 0x70, 0x2C, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0D, 0x12, ++0x49, 0xA8, 0xE0, 0xFF, 0x54, 0x03, 0x65, 0x1C, 0x60, 0x1A, 0x15, 0x1C, 0xE5, 0x1C, 0x54, 0x03, ++0x25, 0xE0, 0x25, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xEF, ++0x54, 0xF3, 0x4E, 0xF0, 0xE5, 0x1B, 0xD3, 0x95, 0x1D, 0x40, 0x03, 0x85, 0x1D, 0x1B, 0x74, 0x0A, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0x54, 0x80, 0x42, 0x1B, 0xAF, 0x05, 0x90, ++0xA4, 0x80, 0xE5, 0x1C, 0xF0, 0xE4, 0xFB, 0xAD, 0x1B, 0x11, 0xFD, 0xAF, 0x1B, 0x22, 0xC0, 0xE0, ++0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, ++0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x7E, ++0xF0, 0x74, 0x6F, 0xA3, 0xF0, 0x12, 0x7B, 0xA8, 0xE5, 0x69, 0x30, 0xE1, 0x03, 0x12, 0x7D, 0x59, ++0xE5, 0x69, 0x30, 0xE2, 0x03, 0x12, 0x7D, 0xC0, 0xE5, 0x69, 0x30, 0xE3, 0x03, 0x12, 0x7D, 0xFC, ++0xE5, 0x6A, 0x30, 0xE0, 0x03, 0x12, 0x7E, 0x38, 0xE5, 0x6C, 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, ++0x77, 0xD7, 0xE5, 0x6C, 0x30, 0xE4, 0x03, 0x12, 0x73, 0x92, 0xE5, 0x6C, 0x30, 0xE5, 0x03, 0x12, ++0x7E, 0xC8, 0xE5, 0x6C, 0x30, 0xE6, 0x03, 0x12, 0x7F, 0x5E, 0x74, 0x7E, 0x04, 0x90, 0x01, 0xC4, ++0xF0, 0x74, 0x6F, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, ++0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, ++0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, ++0x10, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x70, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, ++0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, ++0x32, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0xA0, ++0x8C, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA0, 0x8D, 0xF0, 0x90, ++0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA0, 0x8E, 0xF0, 0x90, 0x00, 0x03, 0x12, ++0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA0, 0x8F, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, ++0xAE, 0x05, 0xED, 0x2F, 0x90, 0xA0, 0x90, 0xF0, 0x22, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xBD, 0x90, ++0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xFE, 0x12, 0x26, 0x1E, 0xFD, 0xC3, 0x13, 0x30, 0xE0, 0x12, ++0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA3, 0x02, 0xF0, ++0x80, 0x05, 0x90, 0xA3, 0x02, 0xEF, 0xF0, 0x90, 0xA3, 0x01, 0xEE, 0xF0, 0x90, 0xA3, 0x02, 0xE0, ++0xFE, 0x90, 0xA3, 0x01, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x38, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, ++0x12, 0x26, 0x1E, 0x54, 0x01, 0xFE, 0x74, 0x2D, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, ++0xEE, 0xF0, 0x74, 0x2D, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0x70, 0x04, 0x31, ++0x3E, 0x80, 0x07, 0x90, 0xA3, 0x01, 0xE0, 0xFF, 0x31, 0x2D, 0x90, 0xA3, 0x01, 0xE0, 0x04, 0xF0, ++0x80, 0xBA, 0x90, 0xA1, 0x2D, 0xE0, 0x70, 0x24, 0x90, 0xA1, 0xB4, 0xE0, 0x70, 0x04, 0xFF, 0x12, ++0x64, 0x49, 0x90, 0xA1, 0xB4, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x31, 0x4F, 0x90, 0xA1, 0xAE, 0xE0, ++0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x8F, 0x0F, 0x75, ++0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x8F, 0x0F, ++0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x49, 0xA8, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, ++0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x0C, ++0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0xA1, 0xAD, ++0xF0, 0xBF, 0x01, 0x12, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x64, 0x01, 0x60, 0x17, 0x90, 0x05, ++0x22, 0x74, 0x6F, 0xF0, 0x80, 0x0F, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x64, 0x01, 0x60, 0x05, ++0x90, 0x05, 0x22, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xBD, ++0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, 0x90, 0xA3, 0x01, 0x12, 0x49, 0xBD, 0x90, 0xA2, 0xFE, 0x12, ++0x49, 0xB4, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xC9, 0xF0, 0x90, 0xA3, 0x01, 0x12, ++0x49, 0xB4, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x7F, 0x90, 0xA1, 0xB1, 0xF0, 0xEF, 0xC4, 0x13, 0x13, ++0x13, 0x54, 0x01, 0xA3, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0x54, 0xF0, 0xC4, 0x54, ++0x0F, 0xFE, 0x90, 0xA1, 0xB0, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, ++0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, ++0xC4, 0x54, 0xF0, 0xFF, 0x90, 0xA1, 0xB0, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, ++0x26, 0x37, 0x90, 0xA1, 0xB3, 0xF0, 0x51, 0x3D, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, ++0xB8, 0xF0, 0x90, 0xA1, 0xB1, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0xA1, 0xB3, 0xE0, 0x90, 0x01, ++0xBB, 0xF0, 0x90, 0xA1, 0xB0, 0xE0, 0x54, 0x0F, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x90, 0xA3, 0x04, ++0x12, 0x49, 0xBD, 0x12, 0xB8, 0x64, 0x90, 0xA1, 0xB1, 0xE0, 0xFF, 0x51, 0x6D, 0x90, 0xA1, 0xB1, ++0xE0, 0x60, 0x19, 0x90, 0xA3, 0x04, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x54, ++0x0F, 0xFF, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x12, 0xB9, 0x0D, 0x22, 0xEF, 0x70, 0x37, ++0x7D, 0x78, 0x7F, 0x02, 0x71, 0x13, 0x7D, 0x02, 0x7F, 0x03, 0x71, 0x13, 0x7D, 0xC8, 0x7F, 0x02, ++0x12, 0x79, 0xE3, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x7D, 0x01, ++0x7F, 0x0C, 0x12, 0x62, 0x53, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x90, ++0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, ++0xF0, 0x7D, 0x78, 0xFF, 0x51, 0xF4, 0x7D, 0x02, 0x7F, 0x03, 0x51, 0xF4, 0x90, 0x06, 0x0A, 0xE0, ++0x44, 0x07, 0xF0, 0x90, 0xA1, 0xBC, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0xA1, 0x2D, 0xE0, ++0xB4, 0x01, 0x15, 0x90, 0xA1, 0xAF, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA1, 0xB4, 0xE0, 0x20, 0xE2, ++0x0E, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x62, 0x53, 0x90, 0xA1, 0xAF, 0xE0, 0x44, 0x04, 0xF0, 0x22, ++0x7D, 0x02, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x71, 0x13, 0x7D, ++0x01, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x30, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0xA1, 0xB4, 0xE0, 0x64, ++0x02, 0x60, 0x28, 0x91, 0x46, 0x90, 0xA1, 0xAF, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, ++0x14, 0x90, 0xA1, 0xB7, 0xE0, 0xFF, 0xA3, 0xE0, 0x6F, 0x70, 0x0A, 0xF1, 0xB3, 0x71, 0x09, 0x90, ++0xA1, 0xB8, 0xE0, 0x14, 0xF0, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0xCA, 0xE0, ++0x30, 0xE0, 0x2E, 0x90, 0xA1, 0xCC, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x90, 0xA1, 0xCD, 0xE0, 0x60, ++0x04, 0x14, 0xF0, 0xC1, 0x6C, 0x90, 0xA1, 0xCB, 0xE0, 0x14, 0x90, 0xA1, 0xCD, 0xF0, 0x90, 0x05, ++0x73, 0x74, 0x01, 0xF0, 0xE4, 0xFF, 0x12, 0x78, 0x6D, 0x51, 0xF0, 0x7D, 0x01, 0x7F, 0x02, 0x51, ++0xF4, 0x22, 0x12, 0xB9, 0x99, 0x90, 0xA1, 0xB7, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x51, 0xF0, ++0x91, 0x11, 0x80, 0xB8, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x45, 0x90, 0xA1, 0xAF, 0xE0, 0xFF, 0x13, ++0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x12, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0B, 0x71, 0x09, ++0x90, 0xA1, 0xB7, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0xA4, 0xAB, 0xE4, 0x75, 0xF0, 0x01, ++0x12, 0x47, 0xF6, 0xC3, 0x90, 0xA4, 0xAC, 0xE0, 0x94, 0x80, 0x90, 0xA4, 0xAB, 0xE0, 0x64, 0x80, ++0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x12, ++0xB7, 0x5A, 0x91, 0x11, 0x7F, 0x01, 0xF1, 0xD7, 0x90, 0xA1, 0xCA, 0xE0, 0x30, 0xE0, 0x11, 0x90, ++0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0A, 0x71, 0x09, 0x90, 0xA1, 0xCC, 0xE0, 0x90, 0x05, 0x73, 0xF0, ++0x22, 0x90, 0xA1, 0xCF, 0xE0, 0x30, 0xE0, 0x2D, 0x90, 0xA1, 0x2D, 0xE0, 0xB4, 0x01, 0x26, 0x90, ++0xA4, 0xB9, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0xA1, 0xD1, 0xE0, 0x04, 0xF0, 0xE4, ++0x90, 0xA4, 0xB9, 0xF0, 0x90, 0xA1, 0xD1, 0xE0, 0xFF, 0x90, 0xA1, 0xD0, 0xE0, 0xB5, 0x07, 0x05, ++0xE4, 0xA3, 0xF0, 0x91, 0xDB, 0x22, 0x90, 0xA1, 0x2D, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x81, 0xDA, ++0x90, 0xA1, 0xB1, 0xE0, 0x70, 0x02, 0x81, 0xDA, 0x90, 0xA1, 0xB0, 0xE0, 0xC4, 0x54, 0x0F, 0x64, ++0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0xA1, 0xB8, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, ++0xA1, 0xB7, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0xA1, 0xB7, 0xE0, 0xFE, 0xFF, 0x80, 0x00, ++0x90, 0xA1, 0xB8, 0xEF, 0xF0, 0x90, 0xA1, 0xAF, 0xE0, 0x44, 0x04, 0xF0, 0xE4, 0x90, 0xA1, 0xBA, ++0xF0, 0x90, 0xA1, 0xBC, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, ++0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA1, 0xB5, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xEF, 0xF0, 0x90, ++0xA1, 0xB0, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x03, 0x12, 0x7C, 0x71, ++0x90, 0xA1, 0xAF, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0E, 0x90, 0xA1, 0xB7, 0xE0, ++0xFF, 0xA3, 0xE0, 0xB5, 0x07, 0x04, 0xF1, 0xB3, 0x71, 0x0F, 0x22, 0xE4, 0xFF, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x1E, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1D, 0x90, 0x05, 0x22, 0xE0, ++0xF5, 0x21, 0x74, 0xFF, 0xF0, 0xF1, 0x6B, 0xBF, 0x01, 0x07, 0xAF, 0x1E, 0x12, 0xB9, 0xD9, 0xB1, ++0x63, 0x90, 0x05, 0x22, 0xE5, 0x21, 0xF0, 0x80, 0x02, 0xB1, 0x63, 0x90, 0x04, 0x1F, 0x74, 0x20, ++0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x1D, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, ++0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x54, 0xEF, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, ++0x40, 0xF0, 0x22, 0x90, 0xA0, 0x8E, 0xE0, 0xFF, 0x7D, 0x01, 0xD1, 0x00, 0x8E, 0x1F, 0x8F, 0x20, ++0xAD, 0x20, 0xAC, 0x1F, 0xAF, 0x1E, 0xB1, 0x18, 0xAF, 0x20, 0xAE, 0x1F, 0x90, 0x81, 0x00, 0xE0, ++0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, ++0x44, 0x01, 0xF0, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xFB, ++0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0xFA, ++0xF0, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, ++0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0E, 0xF0, 0x90, ++0x04, 0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, ++0xA4, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, ++0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xED, 0xF0, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xAE, 0xED, 0xF0, 0x90, 0xA4, 0xAD, 0xEF, ++0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xBA, 0x26, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0xA4, 0xAD, 0xE0, 0x90, ++0x04, 0x25, 0xF0, 0x90, 0xA4, 0xAE, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, ++0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, 0x22, 0x74, ++0xFF, 0xF0, 0xD1, 0x96, 0x90, 0xA1, 0xB4, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, ++0xF0, 0xF1, 0x6B, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, 0x03, 0x51, 0xF4, 0xD1, 0x96, ++0xE4, 0x90, 0xA1, 0xB4, 0xF0, 0x22, 0xF1, 0x6B, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, ++0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA4, 0x8D, 0x12, 0x27, 0x48, 0x90, 0xA4, 0x8D, 0x12, 0x49, 0x4B, ++0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, ++0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA4, 0x8D, 0x12, 0x27, 0x48, 0x90, ++0xA4, 0x8D, 0x12, 0x49, 0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, ++0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x54, 0xFE, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, ++0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0xA4, 0x8D, 0x12, 0x27, 0x48, 0x90, 0xA4, 0x8D, 0x12, 0x49, ++0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x01, ++0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, ++0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0x90, 0xA1, 0xBE, 0x12, 0x27, 0x48, 0x90, 0xAC, 0xB9, ++0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, ++0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, ++0x00, 0xFF, 0xE0, 0x70, 0x15, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x8C, 0x12, 0x79, 0xB0, 0x90, 0xA4, ++0x8C, 0xE0, 0x44, 0x18, 0xFB, 0x7F, 0x01, 0x12, 0x79, 0xFB, 0x22, 0xE4, 0x90, 0xA4, 0xAF, 0xF0, ++0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, ++0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0xA4, 0xB0, 0xE0, 0x94, 0xE8, 0x90, 0xA4, ++0xAF, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, ++0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA4, 0xAF, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, ++0xF6, 0x80, 0xBF, 0xEF, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, ++0x7F, 0x03, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x8F, 0x27, 0x7F, 0x02, 0x12, 0x4C, 0x2B, 0x90, 0xA0, ++0x8A, 0xE0, 0x45, 0x27, 0xF0, 0x22, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x30, 0xE0, 0x26, ++0x12, 0x26, 0x1E, 0x90, 0xA1, 0xC2, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xC3, ++0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xA3, 0xE0, 0x54, 0x01, 0x4F, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, ++0x37, 0x90, 0xA1, 0xC5, 0xF0, 0x22, 0x90, 0xA1, 0xC2, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, ++0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, ++0xA1, 0xC8, 0xF0, 0x90, 0xA1, 0xC8, 0xE0, 0x90, 0x01, 0xE7, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x54, ++0x01, 0xFF, 0x90, 0xA1, 0xCA, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, ++0x90, 0xA1, 0xCB, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xCC, 0xF0, 0x90, 0xA1, ++0xCB, 0xE0, 0x90, 0xA1, 0xCD, 0xF0, 0x90, 0xA1, 0xCA, 0xE0, 0x54, 0x01, 0xFF, 0xAC, 0x07, 0xEF, ++0x54, 0x01, 0xFE, 0x90, 0xA1, 0xCA, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0x90, 0x01, 0x53, 0xB4, ++0x01, 0x12, 0xE4, 0xF0, 0x7D, 0x10, 0x7F, 0x03, 0x12, 0x77, 0xC2, 0x90, 0xA1, 0xCC, 0xE0, 0x90, ++0x05, 0x73, 0xF0, 0x22, 0x74, 0x03, 0xF0, 0x7D, 0x10, 0xFF, 0x31, 0xE3, 0x11, 0xAA, 0x90, 0x05, ++0x22, 0xE4, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x0C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0xA1, 0xBE, 0x12, 0x49, 0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, ++0x0C, 0x12, 0x37, 0x5D, 0x90, 0xA1, 0xBE, 0x12, 0x49, 0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, ++0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x10, 0xE0, 0x44, 0x0C, 0xFD, 0x7F, 0x10, ++0x12, 0x3A, 0x96, 0x90, 0x00, 0x72, 0xE0, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x3A, 0x96, 0x90, ++0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, ++0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, ++0x54, 0xBF, 0xFF, 0xEC, 0x90, 0xA4, 0x87, 0x12, 0x27, 0x48, 0x90, 0xA4, 0x87, 0x12, 0x49, 0x4B, ++0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, ++0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, ++0x90, 0xA4, 0x87, 0x12, 0x27, 0x48, 0x90, 0xA4, 0x87, 0x12, 0x49, 0x4B, 0x90, 0xAC, 0xB9, 0x12, ++0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, ++0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0xA4, 0x87, 0x12, 0x27, 0x48, 0x90, 0xA4, 0x87, 0x12, 0x49, ++0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, ++0xFF, 0xE0, 0x70, 0x27, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x8B, 0x31, 0xB0, 0x90, 0xA4, 0x8B, 0xE0, ++0x54, 0xE7, 0xFB, 0x7F, 0x01, 0x31, 0xFB, 0x7B, 0x01, 0x7F, 0x01, 0x31, 0xB4, 0x90, 0xA4, 0x8B, ++0xE0, 0x54, 0x18, 0x70, 0x06, 0x90, 0x01, 0xBF, 0xE0, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x7D, 0x08, 0x7F, 0x01, 0xEF, 0x70, 0x04, 0x7E, 0x01, 0x80, 0x07, 0xEF, 0x64, 0x01, 0x70, 0x19, ++0x7E, 0x40, 0x90, 0x00, 0xE2, 0xED, 0xF0, 0xA3, 0xEE, 0xF0, 0x90, 0x00, 0xE1, 0xE0, 0x12, 0x26, ++0x64, 0x90, 0x00, 0xE3, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, ++0x7F, 0x00, 0x22, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x38, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0xEF, 0x70, 0x04, 0x7E, 0x03, ++0x80, 0x07, 0xEF, 0x64, 0x01, 0x70, 0x19, 0x7E, 0x42, 0x90, 0x00, 0xE2, 0xED, 0xF0, 0x90, 0x00, ++0xE0, 0xEB, 0xF0, 0x90, 0x00, 0xE3, 0xEE, 0xF0, 0x54, 0xFD, 0xF0, 0xE4, 0xF0, 0x7F, 0x01, 0x22, ++0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, ++0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xEE, 0x74, 0x00, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, ++0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, ++0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, ++0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA4, 0x9A, 0xEF, 0xF0, 0xA3, 0x12, 0x49, 0xBD, 0x90, 0xA4, ++0xA3, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, 0x76, 0x74, 0x00, 0x2F, 0xF9, ++0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0xA4, 0x9B, 0x12, ++0x49, 0xB4, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, ++0x03, 0x12, 0x34, 0x2C, 0x90, 0xA4, 0x9A, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, ++0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x49, 0xB4, 0xE9, 0x24, 0x02, 0xF9, 0xE4, ++0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0xA4, 0x9B, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x0E, ++0x12, 0x26, 0x37, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x2C, 0xE4, 0x90, ++0xA2, 0xE9, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, ++0xEF, 0x64, 0x01, 0x60, 0x3E, 0xC3, 0x90, 0xA2, 0xEA, 0xE0, 0x94, 0x88, 0x90, 0xA2, 0xE9, 0xE0, ++0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA2, 0xE9, 0xE4, ++0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0xA2, ++0xEA, 0xE0, 0x94, 0x32, 0x90, 0xA2, 0xE9, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, ++0x30, 0xE3, 0xB2, 0x22, 0x7F, 0x02, 0x90, 0xA1, 0xCE, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, ++0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, ++0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, ++0x5D, 0xF5, 0x61, 0xA3, 0xE0, 0x55, 0x5E, 0xF5, 0x62, 0xA3, 0xE0, 0x55, 0x5F, 0xF5, 0x63, 0xA3, ++0xE0, 0x55, 0x60, 0xF5, 0x64, 0x90, 0x01, 0x34, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, 0x62, 0xF0, 0xA3, ++0xE5, 0x63, 0xF0, 0xA3, 0xE5, 0x64, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x65, 0xF5, 0x69, ++0xA3, 0xE0, 0x55, 0x66, 0xF5, 0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, 0x6B, 0xA3, 0xE0, 0x55, 0x68, ++0xF5, 0x6C, 0x90, 0x01, 0x3C, 0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, 0x6B, 0xF0, ++0xA3, 0xE5, 0x6C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0xA1, 0x2D, 0xE0, 0x64, 0x01, 0x70, 0x2A, ++0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, ++0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0xC3, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, ++0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x22, 0x90, 0xA1, 0x2D, 0xE0, 0x64, ++0x01, 0x70, 0x26, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x20, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, ++0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA1, 0xB5, 0xE0, 0x54, ++0xFD, 0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x4F, 0xF0, 0x22, 0x90, 0xA1, 0x2D, 0xE0, 0xB4, 0x01, ++0x14, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x0E, 0x90, 0xA1, 0xB0, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, ++0x02, 0x80, 0x03, 0x91, 0xF3, 0x22, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x14, 0x90, 0xA0, 0x8D, 0xE0, ++0xFF, 0xE4, 0xFD, 0x12, 0x76, 0x00, 0x8E, 0x1A, 0x8F, 0x1B, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, ++0x22, 0xE4, 0x90, 0xA3, 0x92, 0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x90, 0xA3, 0x92, 0xF0, 0xE0, 0x54, ++0xC0, 0x70, 0x0D, 0x90, 0xA1, 0xB5, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x02, 0x4F, 0xF0, ++0x90, 0xA3, 0x92, 0xE0, 0x30, 0xE6, 0x21, 0x90, 0xA1, 0xB1, 0xE0, 0x64, 0x01, 0x70, 0x20, 0x90, ++0xA1, 0xB5, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0xA1, 0xB0, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x04, ++0x91, 0x56, 0x80, 0x0B, 0x91, 0xF3, 0x80, 0x07, 0x90, 0xA1, 0xB5, 0xE0, 0x54, 0xFE, 0xF0, 0x90, ++0xA3, 0x92, 0xE0, 0x90, 0xA1, 0xB5, 0x30, 0xE7, 0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, ++0x90, 0xA1, 0xC3, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, ++0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, ++0xFD, 0xF0, 0x22, 0x90, 0x01, 0x5F, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x08, 0xF0, 0xE4, 0xF5, ++0x3B, 0x90, 0xA1, 0xC4, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x5C, ++0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5F, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, ++0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA1, 0xB4, 0xE0, 0x64, 0x0C, 0x60, 0x0C, ++0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x62, 0x53, 0xE4, 0xFF, 0x12, 0x74, 0xDD, 0x22, 0x90, 0xA1, 0x2D, ++0xE0, 0xB4, 0x01, 0x14, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x0E, 0x90, 0xA1, 0xB5, 0xE0, 0x54, 0xFE, ++0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x4F, 0xF0, 0x22, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x02, 0xB1, ++0x62, 0x22, 0x90, 0xA1, 0xAE, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x11, 0xEF, 0x54, ++0xFB, 0xF0, 0x90, 0xA1, 0xB5, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x42, 0x80, 0x3D, 0x90, ++0xA1, 0xBA, 0xE0, 0x04, 0xF0, 0x90, 0xA1, 0xB5, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0xA1, 0xBA, 0xE0, ++0xFF, 0xB4, 0x01, 0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, 0x06, 0x90, 0x05, 0x58, 0xE0, 0x04, 0xF0, ++0x90, 0xA1, 0xC2, 0xE0, 0xFF, 0x90, 0xA1, 0xBA, 0xE0, 0xD3, 0x9F, 0x40, 0x0F, 0x90, 0xA1, 0x2D, ++0xE0, 0xB4, 0x01, 0x0B, 0x90, 0xA1, 0xAF, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x12, 0x4F, 0xF0, 0x22, ++0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x35, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE0, 0x24, 0xE4, 0xF5, 0x3B, ++0x90, 0xA1, 0xC4, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, ++0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5B, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x01, 0xF0, ++0x22, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xF7, 0xF0, 0x12, 0x4F, 0xF0, 0x22, 0x90, 0xA1, 0xB1, 0xE0, ++0x60, 0x35, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x24, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0xC4, 0xE0, ++0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x5C, 0x7E, 0x01, 0x12, 0x34, 0x8C, ++0x90, 0x01, 0x5F, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x22, 0x90, 0xA1, 0xAE, ++0xE0, 0x54, 0xEF, 0xF0, 0x12, 0x4F, 0xF0, 0x22, 0xD1, 0x81, 0x90, 0xA3, 0xA2, 0xEF, 0xF0, 0x90, ++0xA1, 0xAE, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x90, ++0xA3, 0xA2, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, ++0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0xA1, ++0xBC, 0xE4, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0xBC, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, ++0x22, 0xE4, 0x90, 0xA3, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, 0xA3, ++0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, 0xA3, 0xA3, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, ++0xC3, 0x90, 0xA3, 0xA5, 0xE0, 0x94, 0x64, 0x90, 0xA3, 0xA4, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, ++0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA3, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0xA3, 0xA4, 0xE4, ++0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x80, 0xC2, 0x90, 0xA1, 0xAE, 0xE0, 0xFF, 0xC4, 0x13, 0x13, ++0x54, 0x03, 0x30, 0xE0, 0x27, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA1, 0xAF, ++0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0xB9, ++0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x12, 0x4F, 0xF0, 0xE4, 0xFF, 0x90, 0xA1, ++0xD2, 0xE0, 0x30, 0xE0, 0x48, 0x90, 0xA1, 0xD6, 0xE0, 0xFD, 0x60, 0x41, 0x74, 0x01, 0x7E, 0x00, ++0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, ++0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x06, 0xE4, 0x90, 0xA1, 0xD6, 0xF0, 0x22, 0x90, 0xA1, 0xD4, 0xE0, ++0xD3, 0x9D, 0x50, 0x10, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0xF1, 0x4E, 0x90, 0xA1, 0xD2, 0xE0, ++0x54, 0xFE, 0xF0, 0x22, 0x12, 0x74, 0xDB, 0x90, 0xA1, 0xD6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA0, ++0x8B, 0xE0, 0x64, 0x02, 0x60, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0xA1, ++0xAE, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x2C, 0xEF, 0x54, 0x7F, 0xF0, ++0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA1, 0xAF, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x0F, ++0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x90, ++0xA1, 0xB1, 0xE0, 0x60, 0x03, 0x12, 0x4F, 0xF0, 0x7F, 0x01, 0xC1, 0xFE, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x90, 0x60, ++0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE1, 0xE4, 0x7F, ++0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x0A, ++0x0D, 0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, ++0x1E, 0x90, 0xFD, 0x11, 0xE0, 0xB5, 0x05, 0x14, 0x90, 0x01, 0x17, 0xE0, 0xB5, 0x05, 0x07, 0x90, ++0xFD, 0x11, 0xE4, 0xF0, 0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, 0x11, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, ++0x8F, 0x6E, 0xE4, 0x90, 0xA4, 0xB1, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, ++0xE7, 0x02, 0x7F, 0x01, 0xEF, 0x65, 0x6E, 0x60, 0x3E, 0xC3, 0x90, 0xA4, 0xB2, 0xE0, 0x94, 0x88, ++0x90, 0xA4, 0xB1, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, ++0x90, 0xA4, 0xB1, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, ++0xF7, 0xD3, 0x90, 0xA4, 0xB2, 0xE0, 0x94, 0x32, 0x90, 0xA4, 0xB1, 0xE0, 0x94, 0x00, 0x40, 0xB9, ++0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB2, 0x22, 0x11, 0xFE, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, ++0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0xE4, 0xFF, 0x11, 0x00, 0x90, 0xA0, 0x8B, 0xE0, 0xB4, 0x03, ++0x0C, 0x90, 0x00, 0x70, 0xE0, 0x54, 0x7F, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, 0xA6, 0x11, 0x58, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, ++0xB4, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0D, 0x31, 0x10, 0xBF, 0x01, 0x08, 0x11, 0x7E, 0x90, ++0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA0, 0x8B, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, ++0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0xA1, 0xBB, 0xE0, 0xFD, 0x7F, 0x93, ++0x12, 0x3A, 0x96, 0x90, 0xA1, 0xB2, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, ++0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, 0x44, ++0x10, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0x7F, 0x01, 0x11, 0x00, 0x90, 0x00, 0x90, 0xE0, 0x44, ++0x01, 0xFD, 0x7F, 0x90, 0x12, 0x3A, 0x96, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3A, 0xF7, 0x90, 0x00, ++0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x22, 0x90, 0xA1, 0xAE, 0xE0, 0x30, 0xE0, 0x02, 0x11, 0x8E, 0x22, ++0x90, 0x02, 0x96, 0xE0, 0xFF, 0x90, 0x02, 0x87, 0xE0, 0x4F, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, ++0x01, 0xF0, 0x80, 0x17, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, ++0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, ++0xF0, 0x7F, 0x00, 0x22, 0xE4, 0x90, 0xA2, 0xE9, 0xF0, 0xE4, 0x90, 0xA2, 0xEA, 0xF0, 0x90, 0xA2, ++0xEA, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x50, 0x75, 0x90, 0xA2, 0xE9, 0xE0, 0xFE, 0x24, 0x8A, 0xF5, ++0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x90, 0xA2, 0xEA, 0xB4, 0x03, ++0x1B, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2F, ++0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x74, 0x80, 0xF0, 0x80, 0x1B, 0xE0, 0xFF, 0x90, 0xA2, ++0xE9, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2F, 0xF5, 0x82, ++0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0xEA, 0xE0, 0xFF, 0x90, 0xA2, 0xE9, 0xE0, ++0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, ++0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0xEA, 0xE0, 0x04, 0xF0, 0x80, 0x81, 0x90, 0xA2, 0xE9, ++0xE0, 0x04, 0xF0, 0xE0, 0x64, 0x80, 0x60, 0x02, 0x21, 0x49, 0xE4, 0x90, 0xAF, 0x7D, 0xF0, 0x90, ++0xA2, 0xE9, 0xF0, 0x90, 0xA2, 0xE9, 0xE0, 0xFF, 0xC3, 0x94, 0x80, 0x40, 0x02, 0x61, 0x60, 0xE0, ++0xFE, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x79, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, ++0x0A, 0xEE, 0x90, 0x8D, 0x7B, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEE, ++0x90, 0x8D, 0x7D, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEE, 0x90, 0x8D, ++0x7F, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEE, 0x90, 0x8D, 0x81, 0x12, ++0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x9C, 0x8A, 0xF0, 0x90, 0xA0, 0x0A, 0xF0, 0x75, 0xF0, ++0x04, 0xEE, 0x90, 0x98, 0x8B, 0x12, 0x49, 0xA8, 0x74, 0x3F, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, ++0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x0F, 0xF0, 0x90, 0xA2, 0xE9, 0xE0, 0xFE, 0x75, 0xF0, ++0x04, 0x90, 0x98, 0x8A, 0x12, 0x49, 0xA8, 0x74, 0xC0, 0xF0, 0xEE, 0x25, 0xE0, 0x24, 0x79, 0xF5, ++0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x0A, 0x2E, 0xF5, 0x82, 0xE4, ++0x34, 0x97, 0xF5, 0x83, 0xE4, 0xF0, 0xEE, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9C, ++0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEE, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9D, ++0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x0A, 0x12, 0x49, 0xA8, ++0x74, 0x3F, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x0B, 0x12, 0x49, 0xA8, 0x74, 0x03, 0xF0, ++0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xE0, 0x44, 0x09, 0xF0, ++0x90, 0xA2, 0xE9, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, ++0xF3, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xFC, 0xF0, ++0x90, 0xA2, 0xE9, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0x44, ++0x20, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xCF, 0xF0, ++0x90, 0xA2, 0xE9, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x44, ++0x40, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x7F, 0xF0, ++0x90, 0xA2, 0xE9, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0A, 0x12, 0x49, 0xA8, 0xE0, 0xFD, ++0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xED, 0xF0, 0x74, 0x8A, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0xE9, 0xE0, 0x04, 0xF0, 0x21, 0xE3, ++0xE4, 0x90, 0xA2, 0xEB, 0xF0, 0x90, 0xA2, 0xEB, 0xE0, 0xFF, 0xC3, 0x94, 0x20, 0x50, 0x14, 0x74, ++0xD7, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0xEB, 0xE0, 0x04, ++0xF0, 0x80, 0xE2, 0x90, 0x04, 0x49, 0x74, 0xF0, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, ++0x90, 0x04, 0x33, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, ++0xA3, 0x04, 0xF0, 0x90, 0xA2, 0xE9, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, ++0x74, 0xFF, 0xF0, 0x22, 0xED, 0xB4, 0x3E, 0x04, 0x7E, 0xBD, 0x80, 0x1E, 0xED, 0xB4, 0x3F, 0x18, ++0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x7E, ++0xFF, 0x30, 0xE0, 0x06, 0x7E, 0xBE, 0x80, 0x02, 0x7E, 0xFF, 0xAF, 0x06, 0x22, 0x8F, 0x19, 0xAC, ++0x05, 0x90, 0x01, 0xC4, 0x74, 0xDD, 0xF0, 0x74, 0x83, 0xA3, 0xF0, 0x74, 0x8A, 0x25, 0x19, 0xF5, ++0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x19, 0x90, 0x81, 0x00, ++0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA3, 0x06, 0xF0, 0x54, 0x7F, 0x90, 0xA3, 0x0E, 0xF0, 0x75, 0xF0, ++0x04, 0xE5, 0x19, 0x90, 0x95, 0x0B, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA3, 0x10, 0xF0, 0x75, 0xF0, ++0x04, 0xE5, 0x19, 0x90, 0x95, 0x0A, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA3, 0x11, 0xF0, 0x75, 0xF0, ++0x10, 0xE5, 0x19, 0x90, 0x81, 0x05, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x03, 0x90, 0xA3, 0x0A, 0xF0, ++0x90, 0xA3, 0x0E, 0xE0, 0xFF, 0x25, 0xE0, 0x24, 0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, ++0xE4, 0x93, 0xFA, 0x74, 0x01, 0x93, 0xFB, 0xE5, 0x19, 0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, ++0x34, 0x94, 0xF5, 0x83, 0xEA, 0xF0, 0xA3, 0xEB, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x19, 0x90, 0x95, ++0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xFE, 0xC4, 0x54, 0x03, 0x90, 0xA3, 0x0B, 0xF0, 0x74, 0x0A, 0x25, ++0x19, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xEF, 0xF0, 0xE5, 0x19, 0x70, 0x06, 0x90, 0x04, ++0x97, 0xE0, 0x04, 0xF0, 0x90, 0xA3, 0x11, 0xE0, 0xFF, 0x90, 0xA3, 0x0E, 0xE0, 0xD3, 0x9F, 0x40, ++0x13, 0xEF, 0xF0, 0x90, 0xA3, 0x06, 0xF0, 0x74, 0x0A, 0x25, 0x19, 0xF5, 0x82, 0xE4, 0x34, 0xA0, ++0xF5, 0x83, 0xEF, 0xF0, 0xEC, 0x70, 0x02, 0xC1, 0x39, 0x90, 0xA3, 0x0F, 0xEC, 0xF0, 0x90, 0xA3, ++0x06, 0xE0, 0x30, 0xE7, 0x0E, 0x90, 0xA3, 0x0E, 0xE0, 0x90, 0xA3, 0x06, 0xF0, 0x90, 0xA3, 0x0F, ++0xE0, 0x14, 0xF0, 0x90, 0xA3, 0x0F, 0xE0, 0x70, 0x02, 0xC1, 0x39, 0x90, 0xA3, 0x06, 0xE0, 0xFD, ++0xAF, 0x19, 0x71, 0xB4, 0x90, 0xA3, 0x09, 0xEF, 0xF0, 0xF4, 0x60, 0x15, 0xE0, 0x90, 0xA3, 0x06, ++0xF0, 0x90, 0xA3, 0x0F, 0xE0, 0x14, 0xF0, 0xE0, 0xFD, 0x70, 0x02, 0xC1, 0x39, 0xAF, 0x19, 0x71, ++0xDD, 0x90, 0xA3, 0x0E, 0xE0, 0xFF, 0x64, 0x2C, 0x70, 0x38, 0x75, 0xF0, 0x04, 0xE5, 0x19, 0x90, ++0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xFE, 0x54, 0x03, 0xFD, 0x90, 0xA3, 0x0A, 0xE0, 0x6D, 0x60, ++0x21, 0xE0, 0x14, 0xF0, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, ++0x19, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xEE, 0x54, 0xF3, 0x4D, 0xF0, 0x90, 0xA3, 0x0F, 0xE0, ++0x14, 0xF0, 0x90, 0xA3, 0x0F, 0xE0, 0x70, 0x02, 0xC1, 0x39, 0x90, 0xA3, 0x10, 0xE0, 0xF9, 0xEF, ++0xD3, 0x99, 0x50, 0x02, 0xC1, 0x34, 0xE4, 0x90, 0xA3, 0x0D, 0xF0, 0x90, 0xA3, 0x0B, 0xE0, 0xFF, ++0x90, 0xA3, 0x0E, 0xE0, 0xFD, 0xD1, 0x67, 0xEF, 0xF0, 0x90, 0xA3, 0x06, 0xF0, 0x90, 0xA3, 0x0B, ++0xE0, 0xFF, 0x90, 0xA3, 0x10, 0xE0, 0xFD, 0xD1, 0x67, 0xEF, 0xF0, 0x90, 0xA3, 0x06, 0xE0, 0x90, ++0xA3, 0x08, 0xF0, 0x90, 0xA3, 0x0E, 0xE0, 0x14, 0x90, 0xA3, 0x0C, 0xF0, 0x90, 0xA3, 0x10, 0xE0, ++0xFF, 0x90, 0xA3, 0x0C, 0xE0, 0xFD, 0xC3, 0x9F, 0x40, 0x74, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, ++0x1F, 0xFE, 0x75, 0xF0, 0x08, 0xE5, 0x19, 0x90, 0x89, 0x00, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2E, ++0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0x7A, 0x00, 0xEF, 0x54, 0x07, 0xFF, 0x74, ++0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, ++0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x26, 0x90, 0xA3, 0x0D, 0xE0, 0x04, 0xF0, 0x90, 0xA3, ++0x08, 0xED, 0xF0, 0x90, 0xA3, 0x0F, 0xE0, 0xFF, 0x90, 0xA3, 0x0D, 0xE0, 0x6F, 0x60, 0x1F, 0x90, ++0xA3, 0x10, 0xE0, 0xFF, 0x90, 0xA3, 0x08, 0xE0, 0xD3, 0x9F, 0x50, 0x0A, 0x80, 0x10, 0x90, 0xA3, ++0x10, 0xE0, 0x90, 0xA3, 0x08, 0xF0, 0x90, 0xA3, 0x0C, 0xE0, 0x14, 0xF0, 0xA1, 0x8C, 0x90, 0xA3, ++0x10, 0xE0, 0xFF, 0x90, 0xA3, 0x08, 0xE0, 0xC3, 0x9F, 0x50, 0x02, 0xEF, 0xF0, 0x90, 0xA3, 0x08, ++0xE0, 0x90, 0xA3, 0x06, 0xF0, 0xFD, 0x90, 0xA3, 0x0B, 0xE0, 0xFF, 0xD1, 0x98, 0x90, 0xA3, 0x06, ++0xEF, 0xF0, 0x80, 0x05, 0x90, 0xA3, 0x06, 0xE9, 0xF0, 0xE5, 0x19, 0x70, 0x10, 0x74, 0x0A, 0x25, ++0x19, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0x90, 0x04, 0x96, 0xF0, 0x90, 0xA3, 0x06, ++0xE0, 0xFD, 0x90, 0xA3, 0x0A, 0xE0, 0x90, 0xA4, 0x80, 0xF0, 0xE4, 0xFB, 0xAF, 0x19, 0x12, 0x68, ++0xFD, 0x90, 0xA3, 0x06, 0xE0, 0xFF, 0x22, 0xEF, 0xB4, 0x01, 0x0A, 0xED, 0xC3, 0x94, 0x2C, 0x40, ++0x04, 0x7E, 0x20, 0x80, 0x1E, 0xEF, 0xB4, 0x02, 0x0A, 0xED, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0x7E, ++0x18, 0x80, 0x10, 0xEF, 0xB4, 0x03, 0x0A, 0xED, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0x7E, 0x22, 0x80, ++0x02, 0xE4, 0xFE, 0xC3, 0xED, 0x9E, 0xFF, 0x22, 0xEF, 0xB4, 0x01, 0x0F, 0xED, 0xD3, 0x94, 0x0B, ++0x40, 0x09, 0xED, 0x94, 0x34, 0x50, 0x04, 0x7E, 0x20, 0x80, 0x1E, 0xEF, 0xB4, 0x02, 0x0A, 0xED, ++0xD3, 0x94, 0x1B, 0x40, 0x04, 0x7E, 0x18, 0x80, 0x10, 0xEF, 0xB4, 0x03, 0x0A, 0xED, 0xD3, 0x94, ++0x1B, 0x40, 0x04, 0x7E, 0x22, 0x80, 0x02, 0xE4, 0xFE, 0xED, 0x2E, 0xFF, 0x22, 0xED, 0x54, 0x7F, ++0xFC, 0xED, 0x54, 0x80, 0x60, 0x03, 0xAF, 0x04, 0x22, 0xEC, 0xB4, 0x3D, 0x02, 0x80, 0x1F, 0xEC, ++0xC3, 0x94, 0x3E, 0x40, 0x22, 0xEC, 0xD3, 0x94, 0x3F, 0x50, 0x1C, 0x75, 0xF0, 0x04, 0xEF, 0x90, ++0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x06, 0xEC, 0x44, 0x80, ++0xFE, 0x80, 0x06, 0x7E, 0xFF, 0x80, 0x02, 0x7E, 0xFF, 0xAF, 0x06, 0x22, 0xE4, 0xFE, 0x75, 0xF0, ++0x04, 0xEF, 0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0xF9, 0xC3, 0x13, 0x54, 0x07, 0xFC, 0xBC, ++0x05, 0x09, 0xED, 0xC3, 0x94, 0x3B, 0x40, 0x52, 0x0E, 0x80, 0x4F, 0xBC, 0x04, 0x0A, 0xED, 0xC3, ++0x94, 0x31, 0x40, 0x46, 0x7E, 0x01, 0x80, 0x42, 0xE9, 0xC3, 0x13, 0x54, 0x07, 0xFC, 0xBC, 0x03, ++0x0A, 0xED, 0xC3, 0x94, 0x19, 0x40, 0x33, 0x7E, 0x01, 0x80, 0x2F, 0xBC, 0x02, 0x0A, 0xED, 0xC3, ++0x94, 0x11, 0x40, 0x26, 0x7E, 0x01, 0x80, 0x22, 0xE9, 0xC3, 0x13, 0x54, 0x07, 0xFC, 0xBC, 0x01, ++0x0A, 0xED, 0xC3, 0x94, 0x0A, 0x40, 0x13, 0x7E, 0x01, 0x80, 0x0F, 0xEC, 0x70, 0x0A, 0xED, 0xC3, ++0x94, 0x03, 0x40, 0x06, 0x7E, 0x01, 0x80, 0x02, 0xE4, 0xFE, 0xAF, 0x06, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x6F, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xE4, ++0xA3, 0xF0, 0x90, 0xA4, 0x72, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x14, 0x74, 0x74, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA4, 0x72, 0xE0, 0x04, 0xF0, 0x80, 0xE2, ++0x90, 0xA4, 0x71, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x54, ++0x03, 0x90, 0xA4, 0x7C, 0xF0, 0x64, 0x01, 0x70, 0x52, 0x90, 0xA4, 0x71, 0xE0, 0xFF, 0x75, 0xF0, ++0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x74, 0xF0, 0x75, 0xF0, 0x08, 0xEF, ++0x90, 0x89, 0x01, 0x12, 0x49, 0xA8, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA4, 0x75, 0xF0, 0xE4, 0xA3, ++0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xEE, 0x54, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x71, 0xE0, 0x75, 0xF0, ++0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x7A, 0xF0, 0x75, 0xF0, 0x08, 0xEF, ++0x90, 0x89, 0x03, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x7B, 0xF0, 0x90, 0xA4, 0x7C, 0xE0, 0xFC, ++0xC3, 0x94, 0x02, 0x40, 0x64, 0x90, 0xA4, 0x71, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, ++0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x74, 0xF0, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x89, 0x01, 0x12, ++0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x75, 0xF0, 0x90, 0xA4, 0x71, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, ++0x02, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x76, 0xF0, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x89, 0x03, ++0x12, 0x49, 0xA8, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA4, 0x77, 0xF0, 0xEE, 0x54, 0xF0, 0x90, 0xA4, ++0x73, 0xF0, 0xEC, 0xB4, 0x03, 0x0B, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x90, 0xA4, 0x7B, 0xF0, 0x80, ++0x08, 0x90, 0xA4, 0x73, 0xE0, 0x90, 0xA4, 0x7A, 0xF0, 0xE4, 0x90, 0xA4, 0x72, 0xF0, 0x90, 0xA4, ++0x72, 0xE0, 0xFF, 0x24, 0x74, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, ++0xE0, 0xFE, 0xEF, 0xFD, 0x90, 0xA4, 0x70, 0xE0, 0x2D, 0xFD, 0x90, 0xA4, 0x6F, 0xE0, 0x34, 0x00, ++0x8D, 0x82, 0xF5, 0x83, 0xE0, 0xFF, 0xEE, 0x5F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA4, 0x72, ++0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xC7, 0x90, 0xA4, 0x79, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x70, ++0x08, 0xA3, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x37, 0x90, 0xA4, 0x7C, 0xE0, 0x64, 0x01, 0x70, ++0x2F, 0x90, 0xA4, 0x75, 0xE0, 0x54, 0x0F, 0xFE, 0x90, 0xA4, 0x73, 0xF0, 0xEF, 0x54, 0xF0, 0x4E, ++0xF0, 0x90, 0xA4, 0x75, 0xF0, 0x90, 0xA4, 0x7A, 0xE0, 0x90, 0xA4, 0x76, 0xF0, 0x90, 0xA4, 0x7B, ++0xE0, 0x90, 0xA4, 0x77, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x80, 0xF0, ++0x90, 0xA4, 0x7C, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, 0x26, 0xEF, 0x90, 0xA4, 0x77, 0xB4, 0x02, ++0x08, 0xE0, 0xFF, 0x90, 0xA4, 0x7A, 0xE0, 0x80, 0x0A, 0xE0, 0xFF, 0x90, 0xA4, 0x7B, 0xE0, 0x13, ++0x13, 0x54, 0x3F, 0xFE, 0xEF, 0x4E, 0x90, 0xA4, 0x77, 0xF0, 0x90, 0xA4, 0x7B, 0x74, 0x80, 0xF0, ++0xE4, 0x90, 0xA4, 0x72, 0xF0, 0x90, 0xA4, 0x72, 0xE0, 0xFF, 0x24, 0x74, 0xF5, 0x82, 0xE4, 0x34, ++0xA4, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0xA4, 0x71, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, ++0x49, 0xA8, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0xA4, ++0x72, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xCD, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA3, 0x06, ++0xEF, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0x7D, 0xF0, 0x74, 0x89, 0xA3, 0xF0, 0x90, 0xA3, 0x06, 0xE0, ++0xFD, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA3, 0x07, 0xF0, 0xE4, ++0x90, 0xA3, 0x0D, 0xF0, 0x90, 0xA3, 0x07, 0xE0, 0xFE, 0x54, 0x7F, 0xA3, 0xF0, 0xEE, 0x54, 0x80, ++0xA3, 0xF0, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0A, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA3, 0x0B, ++0xF0, 0x90, 0xA3, 0x06, 0xE0, 0xFC, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, ++0xFE, 0xC4, 0x54, 0x03, 0x90, 0xA3, 0x0C, 0xF0, 0xEE, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA3, 0x0A, ++0xF0, 0xEC, 0x70, 0x06, 0x90, 0x04, 0x93, 0xE0, 0x04, 0xF0, 0x90, 0xA3, 0x08, 0xE0, 0xFB, 0x75, ++0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x49, 0xA8, 0x12, 0x49, 0x63, 0xAD, 0x07, 0x90, 0xA3, 0x06, ++0xE0, 0xFF, 0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, ++0xED, 0xF0, 0x90, 0xA3, 0x09, 0xE0, 0xFE, 0x90, 0xA3, 0x07, 0xE0, 0x4E, 0xFE, 0x74, 0x0A, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x8A, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x9A, 0xF5, 0x83, 0xE0, 0x30, 0xE0, 0x3F, 0xEB, 0x64, 0x3F, 0x70, 0x3A, 0x90, 0xA3, 0x08, 0x74, ++0x3E, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0xFE, 0xC4, 0x13, ++0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0xA3, 0x07, 0x74, 0xBE, 0xF0, 0x80, 0x08, 0x90, 0xA3, 0x08, ++0xE0, 0x90, 0xA3, 0x07, 0xF0, 0x90, 0xA3, 0x07, 0xE0, 0xFD, 0x90, 0xA3, 0x0A, 0xE0, 0x90, 0xA4, ++0x80, 0xF0, 0xE4, 0xFB, 0xC1, 0x3E, 0x90, 0xA3, 0x06, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x86, ++0xCD, 0xEF, 0xF4, 0x60, 0x10, 0x90, 0xA3, 0x07, 0xEF, 0xF0, 0x30, 0xE7, 0x02, 0xC1, 0x2C, 0x90, ++0xA3, 0x07, 0xE0, 0xA3, 0xF0, 0x90, 0xA3, 0x0B, 0xE0, 0xFF, 0x90, 0xA3, 0x08, 0xE0, 0xFE, 0xC3, ++0x9F, 0x40, 0x02, 0xA1, 0xBB, 0xEE, 0x64, 0x2C, 0x70, 0x36, 0x90, 0xA3, 0x06, 0xE0, 0xFF, 0x75, ++0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xFE, 0x54, 0x03, 0xFD, 0x90, 0xA3, 0x0A, ++0xE0, 0x6D, 0x60, 0x1C, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFD, 0x75, ++0xF0, 0x04, 0xEF, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xEE, 0x54, 0xF3, 0x4D, 0xF0, 0xA1, 0xB5, ++0x90, 0xA3, 0x08, 0xE0, 0xFF, 0xC3, 0x94, 0x0C, 0x40, 0x1F, 0xEF, 0x94, 0x13, 0x50, 0x1A, 0x90, ++0xA3, 0x06, 0xE0, 0xFF, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFE, 0x20, ++0xE3, 0x07, 0x90, 0xA3, 0x0D, 0x74, 0x01, 0x80, 0x27, 0x90, 0xA3, 0x08, 0xE0, 0xFF, 0xC3, 0x94, ++0x2C, 0x40, 0x2E, 0xEF, 0x94, 0x35, 0x50, 0x29, 0x90, 0xA3, 0x06, 0xE0, 0xFF, 0x24, 0x8A, 0xF5, ++0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFE, 0x20, 0xE3, 0x16, 0x90, 0xA3, 0x0D, 0x74, 0x02, ++0xF0, 0x74, 0x8A, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEE, 0x44, 0x08, 0xF0, 0x80, ++0x16, 0xE4, 0x90, 0xA3, 0x0D, 0xF0, 0x90, 0xA3, 0x06, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, ++0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0xA3, 0x0D, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x61, ++0xF0, 0x90, 0xA3, 0x06, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0xA8, 0xE0, 0x20, ++0xE7, 0x1A, 0x20, 0xE6, 0x17, 0x20, 0xE5, 0x14, 0x20, 0xE4, 0x11, 0x90, 0xA3, 0x06, 0xE0, 0x75, ++0xF0, 0x08, 0x90, 0x89, 0x03, 0x12, 0x49, 0xA8, 0xE0, 0x30, 0xE0, 0x64, 0x90, 0xA3, 0x06, 0xE0, ++0xFF, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0xA3, ++0x08, 0xE0, 0xFE, 0xB4, 0x0C, 0x05, 0x74, 0x14, 0xF0, 0x80, 0x2F, 0xEE, 0xB4, 0x0D, 0x02, 0x80, ++0x04, 0xEE, 0xB4, 0x0E, 0x08, 0x90, 0xA3, 0x08, 0x74, 0x15, 0xF0, 0x80, 0x1D, 0xEE, 0xB4, 0x0F, ++0x08, 0x90, 0xA3, 0x08, 0x74, 0x16, 0xF0, 0x80, 0x11, 0xEE, 0xC3, 0x94, 0x10, 0x90, 0xA3, 0x08, ++0x40, 0x05, 0x74, 0x17, 0xF0, 0x80, 0x03, 0x74, 0x18, 0xF0, 0x90, 0xA3, 0x08, 0xE0, 0xFE, 0x90, ++0xA3, 0x07, 0xF0, 0xFD, 0x90, 0xA3, 0x0A, 0xE0, 0x90, 0xA4, 0x80, 0xF0, 0x7B, 0x01, 0xC1, 0x3E, ++0x90, 0xA3, 0x0D, 0xE0, 0x64, 0x02, 0x60, 0x02, 0x81, 0xA7, 0x90, 0xA3, 0x06, 0xE0, 0x75, 0xF0, ++0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0xA8, 0xE0, 0x20, 0xE6, 0x1C, 0x20, 0xE7, 0x19, 0x90, 0xA3, ++0x06, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x12, 0x49, 0xA8, 0xE0, 0x20, 0xE0, 0x08, 0x20, ++0xE1, 0x05, 0x20, 0xE2, 0x02, 0x81, 0xA7, 0x90, 0xA3, 0x06, 0xE0, 0xFF, 0x24, 0x8A, 0xF5, 0x82, ++0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0xA3, 0x08, 0xE0, 0xFE, 0x64, 0x2C, ++0x60, 0x04, 0xEE, 0xB4, 0x2D, 0x08, 0x90, 0xA3, 0x08, 0x74, 0x36, 0xF0, 0x80, 0x43, 0xEE, 0x64, ++0x2E, 0x60, 0x04, 0xEE, 0xB4, 0x2F, 0x08, 0x90, 0xA3, 0x08, 0x74, 0x37, 0xF0, 0x80, 0x32, 0xEE, ++0xB4, 0x30, 0x08, 0x90, 0xA3, 0x08, 0x74, 0x38, 0xF0, 0x80, 0x26, 0xEE, 0xB4, 0x31, 0x08, 0x90, ++0xA3, 0x08, 0x74, 0x39, 0xF0, 0x80, 0x1A, 0xEE, 0xC3, 0x94, 0x32, 0x40, 0x0E, 0xEE, 0xD3, 0x94, ++0x34, 0x50, 0x08, 0x90, 0xA3, 0x08, 0x74, 0x3A, 0xF0, 0x80, 0x06, 0x90, 0xA3, 0x08, 0x74, 0x3B, ++0xF0, 0x90, 0xA3, 0x08, 0xE0, 0xFE, 0x90, 0xA3, 0x07, 0xF0, 0xFD, 0x90, 0xA3, 0x0A, 0xE0, 0x90, ++0xA4, 0x80, 0xF0, 0x7B, 0x01, 0xC1, 0x3E, 0x90, 0xA3, 0x06, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, ++0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA3, 0x0C, 0xE0, 0xFF, 0x90, 0xA3, 0x08, ++0xE0, 0xFD, 0x12, 0x86, 0x67, 0xEF, 0xF0, 0x90, 0xA3, 0x0C, 0xE0, 0xFF, 0x90, 0xA3, 0x0B, 0xE0, ++0xFD, 0x12, 0x86, 0x67, 0xEF, 0xF0, 0x90, 0xA3, 0x08, 0xE0, 0x04, 0xFD, 0x90, 0xA3, 0x0B, 0xE0, ++0xFF, 0xED, 0xD3, 0x9F, 0x50, 0x76, 0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0x90, 0xA3, 0x06, ++0xE0, 0xFC, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2F, 0xF5, 0x82, ++0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0x7A, 0x00, 0xED, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, ++0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5A, ++0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x33, 0x74, 0x0A, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, ++0xE0, 0x90, 0xA3, 0x08, 0xB4, 0x13, 0x1A, 0x74, 0x18, 0xF0, 0x90, 0xA3, 0x07, 0xF0, 0x90, 0xA3, ++0x06, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x44, 0x04, 0xF0, 0x80, ++0x0B, 0xED, 0xF0, 0x90, 0xA3, 0x07, 0xF0, 0x80, 0x03, 0x0D, 0x80, 0x80, 0x90, 0xA3, 0x0B, 0xE0, ++0xFF, 0x90, 0xA3, 0x07, 0xE0, 0xD3, 0x9F, 0x40, 0x02, 0xEF, 0xF0, 0x90, 0xA3, 0x0C, 0xE0, 0xFF, ++0x90, 0xA3, 0x07, 0xE0, 0xFD, 0x12, 0x86, 0x98, 0xEF, 0xF0, 0x90, 0xA3, 0x06, 0xE0, 0xFF, 0x24, ++0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x20, 0xE0, 0x02, 0xC1, 0x2C, 0x90, 0xA3, ++0x08, 0xE0, 0x64, 0x3F, 0x60, 0x02, 0xC1, 0x2C, 0x74, 0x3E, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, ++0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0xA3, 0x07, ++0x74, 0xBE, 0xF0, 0x80, 0x77, 0x90, 0xA3, 0x08, 0xE0, 0x80, 0x6D, 0x90, 0xA3, 0x0B, 0xE0, 0xFF, ++0x90, 0xA3, 0x08, 0xE0, 0xFE, 0x6F, 0x70, 0x47, 0x90, 0xA3, 0x06, 0xE0, 0xFB, 0x75, 0xF0, 0x04, ++0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0D, 0x90, ++0xA3, 0x09, 0xE0, 0x64, 0x80, 0x60, 0x05, 0xEE, 0x44, 0x80, 0x80, 0x3C, 0x90, 0xA3, 0x08, 0xE0, ++0x75, 0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x49, 0xA8, 0x12, 0x49, 0x63, 0xEB, 0x25, 0xE0, 0x24, ++0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x80, 0x32, 0x90, ++0xA3, 0x0B, 0xE0, 0xFF, 0x90, 0xA3, 0x06, 0xE0, 0x24, 0x0A, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, ++0x83, 0xEF, 0xF0, 0x90, 0xA3, 0x08, 0xEF, 0xF0, 0x90, 0xA3, 0x07, 0xF0, 0x90, 0xA3, 0x06, 0xE0, ++0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA3, 0x0A, 0xE0, 0x90, 0xA4, 0x80, 0xF0, 0x7B, 0x01, 0x12, 0x68, ++0xFD, 0x90, 0xA3, 0x07, 0xE0, 0xFF, 0x22, 0x90, 0x01, 0xC4, 0x74, 0x47, 0xF0, 0x74, 0x8E, 0xA3, ++0xF0, 0xE4, 0xF5, 0x0F, 0x74, 0x2D, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, ++0x70, 0x03, 0x02, 0x97, 0x50, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, ++0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x03, 0x02, 0x97, 0x50, 0xE5, 0x0F, 0x25, ++0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xD3, 0x94, ++0x00, 0xEE, 0x94, 0x00, 0x50, 0x03, 0x02, 0x97, 0x50, 0xE5, 0x0F, 0x75, 0xF0, 0x0A, 0xA4, 0x24, ++0x79, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x8B, 0x13, 0xF5, 0x14, 0x89, 0x15, 0xE5, ++0x0F, 0x25, 0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFF, 0xA3, 0xE0, ++0x90, 0xA2, 0xF4, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, ++0x97, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA2, 0xF6, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x00, 0x02, ++0x12, 0x48, 0x37, 0xFF, 0xAE, 0xF0, 0x12, 0x48, 0x0C, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xFE, 0x90, ++0x00, 0x04, 0x12, 0x48, 0x37, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x06, 0x12, 0x48, ++0x37, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x08, 0x12, 0x48, 0x37, 0x2F, 0xFF, 0xEE, ++0x35, 0xF0, 0x90, 0xA2, 0xF8, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, ++0x00, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xF3, 0xF0, 0x90, 0xA2, 0xF1, 0xF0, 0x54, 0x7F, 0xA3, ++0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x95, 0x0A, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xFB, ++0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x13, 0x13, 0x54, ++0x03, 0x90, 0xA2, 0xFD, 0xF0, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, ++0xE0, 0xC3, 0x94, 0x05, 0x40, 0x03, 0x02, 0x93, 0x47, 0x90, 0xA2, 0xFB, 0xE0, 0xFF, 0x90, 0xA2, ++0xF2, 0xE0, 0x9F, 0x40, 0x06, 0xEF, 0xF0, 0x90, 0xA2, 0xF1, 0xF0, 0x90, 0xA2, 0xF2, 0xE0, 0xFF, ++0x90, 0x41, 0xE7, 0x93, 0xFE, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, ++0xE0, 0xC3, 0x9E, 0x40, 0x06, 0xEF, 0x90, 0x41, 0x3F, 0x80, 0x07, 0x90, 0xA2, 0xF2, 0xE0, 0x90, ++0x41, 0x93, 0x93, 0x90, 0xA2, 0xFA, 0xF0, 0x90, 0xA2, 0xFA, 0xE0, 0x75, 0xF0, 0x06, 0xA4, 0x24, ++0x9D, 0xF9, 0x74, 0x40, 0x35, 0xF0, 0x75, 0x10, 0xFF, 0xF5, 0x11, 0x89, 0x12, 0x90, 0xA2, 0xF1, ++0xE0, 0x90, 0x44, 0x93, 0x93, 0xFF, 0xD3, 0x90, 0xA2, 0xF7, 0xE0, 0x9F, 0x90, 0xA2, 0xF6, 0xE0, ++0x94, 0x00, 0x40, 0x05, 0x7D, 0x01, 0x02, 0x93, 0x40, 0xC3, 0x90, 0xA2, 0xF5, 0xE0, 0x94, 0x0F, ++0x90, 0xA2, 0xF4, 0xE0, 0x94, 0x00, 0x50, 0x6C, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x90, 0x00, ++0x06, 0x12, 0x48, 0x37, 0xFF, 0xAE, 0xF0, 0x90, 0x00, 0x08, 0x12, 0x48, 0x37, 0x2F, 0xFD, 0xE5, ++0xF0, 0x3E, 0xFC, 0x90, 0xA2, 0xF4, 0xE0, 0xC3, 0x13, 0xFE, 0xA3, 0xE0, 0x13, 0xFF, 0xD3, 0xED, ++0x9F, 0xEC, 0x9E, 0x40, 0x09, 0x7D, 0x01, 0xAF, 0x0F, 0x12, 0x83, 0xDD, 0x80, 0x36, 0x90, 0xA2, ++0xF4, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xAE, 0x04, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, ++0xF9, 0xFB, 0xAA, 0x06, 0xEC, 0xC3, 0x13, 0xFE, 0xED, 0x13, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xAB, ++0x13, 0xAA, 0x14, 0xA9, 0x15, 0x12, 0x48, 0x0C, 0xD3, 0x9F, 0xE5, 0xF0, 0x9E, 0x40, 0x05, 0xAF, ++0x0F, 0x12, 0x89, 0x7D, 0x90, 0xA2, 0xF4, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x94, 0xE8, 0xEE, ++0x94, 0x03, 0x40, 0x08, 0x90, 0xA2, 0xFC, 0x74, 0x05, 0xF0, 0x80, 0x16, 0xD3, 0xEF, 0x94, 0xC8, ++0xEE, 0x94, 0x00, 0x40, 0x08, 0x90, 0xA2, 0xFC, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, ++0xFC, 0xF0, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, ++0xF5, 0x16, 0xA3, 0xE0, 0xF5, 0x17, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x12, 0x48, 0x0C, 0xFF, ++0xAE, 0xF0, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, ++0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, 0xAA, 0x11, 0xA9, 0x12, 0x12, 0x26, 0x1E, 0xFD, 0x7C, ++0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, ++0xAA, 0x14, 0xA9, 0x15, 0x90, 0x00, 0x02, 0x12, 0x48, 0x37, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0xFC, ++0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, ++0xAB, 0x10, 0xAA, 0x11, 0xA9, 0x12, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, ++0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, 0xAA, 0x14, ++0xA9, 0x15, 0x90, 0x00, 0x04, 0x12, 0x48, 0x37, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, ++0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, ++0xAA, 0x11, 0xA9, 0x12, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, ++0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, ++0x90, 0x00, 0x06, 0x12, 0x48, 0x37, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, 0xEF, 0xA8, ++0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, 0xAA, 0x11, ++0xA9, 0x12, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, ++0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x90, 0x00, ++0x08, 0x12, 0x48, 0x37, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, ++0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, 0xAA, 0x11, 0xA9, 0x12, ++0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, ++0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFD, 0x90, 0xA2, 0xFC, ++0xE0, 0xFF, 0x90, 0xA2, 0xF4, 0xE0, 0xFE, 0xA3, 0xE0, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xCE, 0xC3, ++0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x26, 0x98, 0xD3, 0xE5, 0x17, 0x9F, 0xE5, 0x16, 0x9E, ++0x40, 0x0C, 0xE5, 0x17, 0x9F, 0xF5, 0x17, 0xE5, 0x16, 0x9E, 0xF5, 0x16, 0x80, 0x05, 0xE4, 0xF5, ++0x16, 0xF5, 0x17, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xD3, ++0x94, 0x00, 0x40, 0x10, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, ++0x14, 0xF0, 0xC1, 0x83, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, ++0x83, 0xE5, 0x16, 0xF0, 0xA3, 0xE5, 0x17, 0xF0, 0xE5, 0x0F, 0x70, 0x0A, 0xE5, 0x17, 0x90, 0x04, ++0x90, 0xF0, 0xE5, 0x16, 0xA3, 0xF0, 0xAE, 0x16, 0xAF, 0x17, 0xE4, 0xFC, 0xFD, 0x90, 0xA2, 0xF2, ++0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x49, 0xA8, 0x12, 0x49, 0x8C, 0xC3, 0x12, 0x48, ++0xAC, 0x40, 0x02, 0x61, 0x17, 0x74, 0x89, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, ++0xE0, 0xFF, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFE, 0xD3, ++0x9F, 0x40, 0x03, 0xEE, 0x80, 0x1A, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, ++0x83, 0xE0, 0xFF, 0x74, 0x89, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xC3, ++0x9F, 0x90, 0xA2, 0xFE, 0xF0, 0x90, 0xA2, 0xFE, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x04, 0x74, 0x8A, ++0x80, 0x21, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xD3, 0x94, ++0x00, 0x74, 0x8A, 0x40, 0x0E, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x14, ++0xF0, 0x80, 0x0B, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, ++0xF2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x49, 0xA8, 0x12, 0x49, 0x63, 0xE5, 0x0F, ++0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, ++0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x60, 0x02, 0xC1, 0x83, ++0xAF, 0x0F, 0x12, 0x89, 0x7D, 0xC1, 0x83, 0x90, 0xA2, 0xF2, 0xE0, 0xFF, 0x25, 0xE0, 0x24, 0x8B, ++0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xD3, 0x74, 0x01, 0x93, 0x95, 0x17, 0xE4, 0x93, 0x95, ++0x16, 0x50, 0x02, 0xC1, 0x83, 0xEF, 0x64, 0x36, 0x60, 0x04, 0x7D, 0x01, 0x80, 0x02, 0x7D, 0x09, ++0xAF, 0x0F, 0x12, 0x83, 0xDD, 0xC1, 0x83, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, ++0xF5, 0x83, 0xE0, 0xFB, 0x64, 0x05, 0x60, 0x02, 0x81, 0xE7, 0x90, 0xA2, 0xF2, 0xE0, 0xFD, 0xAF, ++0x0F, 0x12, 0x87, 0x0C, 0xEF, 0x54, 0x01, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8D, ++0x12, 0x49, 0xA8, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, ++0x12, 0x49, 0xA8, 0xE0, 0x54, 0x07, 0x90, 0xA2, 0xFF, 0xF0, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, ++0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFF, 0xC3, 0x94, 0x30, 0x50, 0x13, 0xE4, 0x90, 0xA2, 0xFF, ++0xF0, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0x81, 0x4B, 0x75, ++0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0x20, 0xE0, 0x02, 0x81, 0x8A, ++0xC4, 0x54, 0x0F, 0x64, 0x0A, 0x60, 0x51, 0xEF, 0x24, 0x05, 0xFF, 0xE4, 0x33, 0xFE, 0x75, 0xF0, ++0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8C, 0x12, 0x49, 0xA8, 0xE0, 0xFD, 0xD3, 0x9F, 0xEE, 0x64, 0x80, ++0xF8, 0x74, 0x80, 0x98, 0x50, 0x32, 0xED, 0x24, 0x05, 0xFF, 0xE4, 0x33, 0xFE, 0x74, 0x0A, 0x25, ++0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xD3, 0x9F, 0xEE, 0x64, 0x80, 0xF8, 0x74, ++0x80, 0x98, 0x50, 0x14, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8B, 0x12, 0x49, 0xA8, 0xE0, ++0xFF, 0x90, 0xA2, 0xF2, 0xE0, 0x6F, 0x60, 0x45, 0x90, 0xA2, 0xFF, 0xE0, 0xFF, 0x70, 0x04, 0x04, ++0xF0, 0x80, 0x0F, 0xEF, 0x90, 0xA2, 0xFF, 0xB4, 0x01, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, ++0x05, 0xF0, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFF, 0x75, ++0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8C, 0x12, 0x49, 0xA8, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0xE5, ++0x0F, 0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x0F, 0xF0, 0x80, 0x3F, 0x74, 0x8A, 0x25, ++0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, ++0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0xFE, 0xEF, 0x54, 0x0F, 0xFF, 0xEE, ++0x04, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0x4F, 0xF0, 0x80, 0x12, 0xE4, 0x90, 0xA2, 0xFF, 0xF0, 0x74, ++0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0xF2, 0xE0, ++0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8B, 0x12, 0x49, 0xA8, 0xEF, 0xF0, 0x75, 0xF0, ++0x04, 0xE5, 0x0F, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, ++0xE0, 0x02, 0xC1, 0x59, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, ++0x54, 0x0F, 0xF0, 0xE4, 0x90, 0xA2, 0xFF, 0xF0, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, ++0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xC1, 0x59, 0xEB, 0x64, 0x06, 0x60, 0x02, 0xC1, 0x83, 0xF5, 0x16, ++0xF5, 0x17, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x07, ++0x90, 0xA2, 0xFF, 0xF0, 0x90, 0xA2, 0xF4, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x94, 0xE8, 0xEE, ++0x94, 0x03, 0x40, 0x08, 0x90, 0xA2, 0xFC, 0x74, 0x05, 0xF0, 0x80, 0x16, 0xD3, 0xEF, 0x94, 0xFA, ++0xEE, 0x94, 0x00, 0x40, 0x08, 0x90, 0xA2, 0xFC, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, ++0xFC, 0xF0, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, ++0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x44, 0xEC, 0xE4, 0x93, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, ++0x90, 0xA3, 0x00, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xF5, 0x18, 0xAB, 0x13, 0xAA, 0x14, 0xA9, ++0x15, 0x75, 0xF0, 0x02, 0xE5, 0x18, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x48, 0x37, 0xFF, ++0xAE, 0xF0, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, ++0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xE5, 0x18, 0x90, 0x44, 0xE7, 0x93, 0xFD, 0x7C, 0x00, 0x12, 0x26, ++0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xC3, 0x90, 0xA3, 0x01, 0xE0, ++0x95, 0x17, 0x90, 0xA3, 0x00, 0xE0, 0x95, 0x16, 0x40, 0x07, 0x05, 0x18, 0xE5, 0x18, 0xB4, 0x05, ++0xAA, 0xE5, 0x18, 0xC3, 0x13, 0xF5, 0x18, 0x90, 0xA2, 0xFF, 0xE0, 0x24, 0x01, 0xFF, 0xE4, 0x33, ++0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x90, 0xA3, 0x03, 0xF0, 0xD3, 0x95, 0x18, 0x40, 0x06, 0xE0, 0x95, ++0x18, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA3, 0x03, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, ++0x8A, 0x12, 0x49, 0xA8, 0xE0, 0xC3, 0x13, 0xFF, 0x90, 0xA3, 0x03, 0xE0, 0xC4, 0x33, 0x54, 0xE0, ++0x2F, 0x04, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8A, 0x12, 0x49, 0xA8, 0xEF, 0xF0, ++0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8A, 0x12, 0x49, 0xA8, 0xE0, 0xC3, 0x94, 0xC0, 0x40, ++0x0E, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8A, 0x12, 0x49, 0xA8, 0x74, 0xC0, 0xF0, 0x75, ++0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8A, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, ++0x90, 0xA3, 0x03, 0xF0, 0xE0, 0x25, 0xE0, 0xF0, 0x70, 0x02, 0x80, 0x05, 0x90, 0xA3, 0x03, 0xE0, ++0x14, 0x90, 0xA2, 0xFF, 0xF0, 0xD3, 0x90, 0xA2, 0xF7, 0xE0, 0x94, 0x03, 0x90, 0xA2, 0xF6, 0xE0, ++0x94, 0x00, 0x40, 0x05, 0xE4, 0x90, 0xA2, 0xFF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, ++0x01, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF8, 0xFF, 0x90, 0xA3, 0x02, 0xF0, 0x90, 0xA2, 0xFF, 0xE0, ++0x4F, 0xFF, 0x90, 0xA3, 0x02, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, 0x12, 0x49, ++0xA8, 0xEF, 0xF0, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xD3, ++0x94, 0x05, 0x74, 0x8A, 0x50, 0x0E, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, ++0x04, 0xF0, 0x80, 0x0B, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0x90, ++0xA2, 0xF6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, 0x9E, 0xFC, ++0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFA, 0xA3, ++0xE0, 0xD3, 0x9D, 0xEA, 0x9C, 0xE5, 0x0F, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, ++0x34, 0x9C, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x47, 0xF6, 0x80, 0x10, 0x25, 0xE0, 0x24, 0x8A, ++0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0x90, 0xA2, 0xF8, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, 0x9E, 0xFC, 0xE5, 0x0F, 0x25, ++0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0xFA, 0xA3, 0xE0, 0xD3, 0x9D, ++0xEA, 0x9C, 0xE5, 0x0F, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, ++0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x47, 0xF6, 0x80, 0x10, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, ++0x34, 0x9D, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xE4, 0xFD, 0xAF, 0x0F, 0x12, 0x68, 0x70, ++0x05, 0x0F, 0xE5, 0x0F, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x8E, 0x54, 0x22, 0x90, 0xA2, 0xFE, ++0x12, 0x49, 0xBD, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, 0x12, 0x26, 0x1E, 0x54, 0x7F, 0xFD, 0x90, ++0x00, 0x01, 0x12, 0x26, 0x37, 0xFE, 0x54, 0x1F, 0x90, 0xA3, 0x02, 0xF0, 0xEE, 0x54, 0x80, 0xC4, ++0x13, 0x13, 0x13, 0x54, 0x01, 0x90, 0xA3, 0x01, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFE, ++0x54, 0x03, 0xFF, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0xA3, 0x04, 0xF0, 0x90, 0x00, 0x02, ++0x12, 0x26, 0x37, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA3, 0x03, 0xF0, 0xEE, ++0x54, 0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFE, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFB, ++0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFC, 0x90, 0xA3, 0x05, 0xF0, 0xEB, 0x54, 0x04, 0x13, ++0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEE, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0xFE, 0x75, ++0xF0, 0x04, 0xED, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x7F, 0x4E, 0xF0, 0x90, 0xA3, ++0x03, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, ++0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xBF, 0x4E, 0xF0, 0xEC, 0x60, 0x02, 0x01, 0xE6, 0x90, 0xA3, ++0x02, 0xE0, 0x54, 0x1F, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, ++0x54, 0xE0, 0x4E, 0xF0, 0xEF, 0x54, 0x03, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0D, 0x12, ++0x49, 0xA8, 0xE0, 0x54, 0xFC, 0x4E, 0xF0, 0xEF, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x75, ++0xF0, 0x04, 0xED, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF3, 0x4F, 0xF0, 0x90, 0xA3, ++0x01, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0C, ++0x12, 0x49, 0xA8, 0xE0, 0x54, 0xDF, 0x4F, 0xF0, 0x90, 0xA3, 0x04, 0xE0, 0x54, 0x03, 0xC4, 0x54, ++0xF0, 0xFF, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xCF, 0x4F, ++0xF0, 0x74, 0x8A, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0x74, ++0x8A, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, ++0xA3, 0x06, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xE4, ++0xFC, 0xEC, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, 0x8F, 0x82, ++0x8E, 0x83, 0x12, 0x26, 0x37, 0xFF, 0x75, 0xF0, 0x08, 0xED, 0x90, 0x89, 0x00, 0x12, 0x49, 0xA8, ++0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x0C, 0xEC, 0xB4, 0x04, ++0xD0, 0xAF, 0x05, 0x12, 0x6A, 0xE1, 0x22, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xBD, 0x12, 0x26, 0x1E, ++0xF5, 0x0F, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFE, 0xF0, 0x74, ++0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, ++0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x54, 0x01, 0xFE, 0xEF, ++0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, ++0x83, 0xE0, 0x54, 0xFD, 0xF0, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, ++0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x03, 0x12, ++0x26, 0x37, 0x54, 0x02, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xE5, 0x0F, 0xC3, 0x94, ++0x80, 0x50, 0x15, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, ++0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0xE5, 0x0F, 0xB4, 0x80, 0x0A, 0x90, 0x00, 0x02, ++0x12, 0x26, 0x37, 0x90, 0x95, 0x09, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0xFD, 0x90, 0x00, 0x01, 0x12, ++0x26, 0x37, 0xFC, 0xED, 0xC3, 0x94, 0x80, 0x90, 0xA3, 0x00, 0xED, 0x50, 0x3F, 0xF0, 0x25, 0xE0, ++0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA3, 0x01, ++0xF0, 0xEE, 0xA3, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, ++0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA3, 0x03, 0xF0, 0xEE, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, ++0x81, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA3, 0x05, 0xF0, 0x80, 0x01, 0xF0, 0xEC, 0xC3, 0x94, ++0x80, 0x90, 0xA3, 0x06, 0xEC, 0x50, 0x3F, 0xF0, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, ++0x9D, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA3, 0x07, 0xF0, 0xEE, 0xA3, 0xF0, 0xEC, 0x25, ++0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA3, ++0x09, 0xF0, 0xEE, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE0, ++0x90, 0xA3, 0x0B, 0xF0, 0x80, 0x01, 0xF0, 0x90, 0xA2, 0xFE, 0x74, 0x04, 0xF0, 0x90, 0xA3, 0x0C, ++0x74, 0x0C, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, ++0xF0, 0xA3, 0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, ++0xF0, 0xA3, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, ++0xF0, 0xA3, 0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, ++0xF0, 0xA3, 0x12, 0x57, 0xEC, 0x7F, 0x04, 0x02, 0x54, 0x17, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, ++0x03, 0x12, 0x49, 0xA8, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0xE4, 0xF5, 0x0D, 0xE4, 0xF5, 0x0E, 0xE5, ++0x0E, 0xB4, 0x03, 0x1E, 0xFF, 0xE5, 0x0D, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, ++0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x74, 0x40, 0xF0, ++0x80, 0x1B, 0xE5, 0x0D, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, ++0xE5, 0x82, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x05, 0x0E, 0xE5, ++0x0E, 0xB4, 0x10, 0xBB, 0x05, 0x0D, 0xE5, 0x0D, 0xB4, 0x08, 0xB1, 0x22, 0x90, 0x04, 0x54, 0xE0, ++0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x90, 0xA3, 0x16, 0xED, 0xF0, 0x90, 0xA3, 0x15, ++0xEF, 0xF0, 0xD3, 0x94, 0x0E, 0x50, 0x15, 0x51, 0xDC, 0xEF, 0x60, 0x29, 0x51, 0xDC, 0xEF, 0x64, ++0x01, 0x70, 0x22, 0x90, 0xA3, 0x16, 0xE0, 0xFD, 0xE4, 0xFF, 0x80, 0x15, 0x90, 0xA3, 0x15, 0xE0, ++0xD3, 0x94, 0x0E, 0x40, 0x10, 0x51, 0xDC, 0xEF, 0x70, 0x09, 0x90, 0xA3, 0x16, 0xE0, 0xFD, 0x7F, ++0x01, 0x80, 0x03, 0x51, 0xDC, 0x22, 0x90, 0xA3, 0x18, 0xED, 0xF0, 0x90, 0xA3, 0x17, 0xEF, 0xF0, ++0x60, 0x02, 0x61, 0xC2, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA3, ++0x86, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x12, 0x57, 0x99, 0x90, ++0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0F, 0x00, ++0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x91, 0x75, 0x90, 0xA3, 0x82, 0x12, ++0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, ++0x7F, 0x0C, 0x7E, 0x08, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x0F, 0x00, 0x00, ++0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0x04, 0x7E, 0x0A, 0x12, ++0x57, 0x99, 0x90, 0x04, 0x54, 0xE0, 0x54, 0x7F, 0x90, 0xA3, 0x19, 0xF0, 0xE0, 0x90, 0x04, 0x54, ++0xF0, 0x22, 0x90, 0xA3, 0x17, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x81, 0x74, 0x90, 0x04, 0x54, 0xE0, ++0x44, 0x80, 0x90, 0xA3, 0x19, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x90, 0xA3, 0x82, 0x12, 0x27, ++0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, ++0x08, 0xFF, 0xFE, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, ++0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x82, ++0x12, 0x27, 0x54, 0x00, 0x00, 0x0F, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, ++0x00, 0x91, 0x75, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA3, 0x86, ++0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x0C, 0x7E, 0x08, 0x12, 0x57, 0x99, 0x90, 0xA3, ++0x82, 0x12, 0x27, 0x54, 0x0F, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x0F, 0x00, ++0x00, 0x00, 0x7F, 0x04, 0x7E, 0x0A, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x30, ++0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, ++0xFE, 0x12, 0x57, 0x99, 0x22, 0x7F, 0x1C, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x17, 0xE0, ++0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA3, 0x1A, 0xED, 0xF0, 0xEF, 0x60, 0x02, 0xA1, 0x63, 0xE0, 0x24, ++0xFD, 0x50, 0x07, 0x60, 0x36, 0x14, 0x60, 0x64, 0xE1, 0x3F, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, ++0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, ++0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, ++0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0xC1, 0x15, 0x90, 0xA3, 0x82, 0x12, 0x27, ++0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0x7F, ++0xB0, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, ++0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0xC1, 0xE7, 0x90, 0xA3, 0x82, 0x12, ++0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, ++0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, ++0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, ++0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, ++0x27, 0x54, 0x00, 0x10, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, ++0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x10, 0x00, ++0x00, 0xC1, 0xB2, 0x90, 0xA3, 0x1A, 0xE0, 0x14, 0x60, 0x7C, 0x14, 0x70, 0x02, 0xC1, 0x4D, 0x14, ++0x70, 0x02, 0xC1, 0xB8, 0x14, 0x70, 0x02, 0xC1, 0x4D, 0x24, 0x04, 0x60, 0x02, 0xE1, 0x3F, 0x90, ++0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, ++0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, ++0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, ++0x7E, 0x0E, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, ++0xA3, 0x86, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x57, 0x99, ++0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, ++0x01, 0x00, 0x00, 0x00, 0xC1, 0xB2, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, ++0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x57, ++0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, ++0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, ++0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, ++0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, ++0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x80, 0x65, 0x90, 0xA3, 0x82, ++0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, ++0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, ++0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, ++0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, ++0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, ++0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x01, 0x00, ++0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0E, 0xE1, 0x3C, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, ++0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, ++0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, ++0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x57, 0x99, 0x90, 0xA3, ++0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x01, 0x00, ++0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x3F, ++0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, ++0x0E, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0x03, 0x90, 0xA3, ++0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x09, 0x12, 0x57, 0x99, 0x22, ++0x90, 0xA4, 0xA9, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA4, 0xA8, 0xEF, 0xF0, 0xE4, 0xFE, 0xF1, ++0xED, 0x90, 0xA4, 0xA8, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0x12, 0xA1, 0x61, 0xAE, ++0x07, 0x90, 0x04, 0x83, 0xEE, 0xF0, 0x90, 0xA4, 0xA8, 0xE0, 0xFF, 0xAD, 0x06, 0x12, 0xA0, 0x20, ++0x90, 0xA4, 0xA8, 0xE0, 0xFF, 0xEF, 0x14, 0x60, 0x3A, 0x14, 0x60, 0x53, 0x24, 0x02, 0x70, 0x6C, ++0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, ++0x00, 0x00, 0x0C, 0x00, 0x12, 0x57, 0x0F, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, ++0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0x7F, ++0x01, 0x80, 0x36, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA3, 0x7E, ++0x12, 0x27, 0x54, 0x00, 0x00, 0x04, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x80, 0x1A, 0x90, ++0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0x57, 0x15, 0x22, 0xA9, 0x07, 0x90, ++0x06, 0x69, 0xE0, 0xFE, 0x90, 0x06, 0x68, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0xFE, ++0xE9, 0x14, 0x60, 0x13, 0x14, 0x60, 0x10, 0x24, 0x02, 0x70, 0x14, 0xEE, 0x54, 0xFE, 0xFE, 0xEF, ++0x54, 0x7F, 0x90, 0x06, 0x68, 0x80, 0x04, 0x90, 0x06, 0x68, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, ++0x90, 0xA4, 0xB8, 0xED, 0xF0, 0xEF, 0x14, 0x60, 0x23, 0x14, 0x70, 0x02, 0x01, 0xF0, 0x24, 0x02, ++0x60, 0x02, 0x21, 0x60, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA3, ++0x86, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x00, 0x7F, 0xAC, 0x21, 0x5B, 0x90, 0xA3, 0x82, 0x12, ++0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x01, ++0x7F, 0xAC, 0x7E, 0x08, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, ++0x3C, 0x90, 0xA4, 0xB8, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0xFF, 0xAE, 0xF0, 0xEE, 0x33, 0x95, 0xE0, ++0xFD, 0xFC, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x48, 0x7F, 0xAC, 0x7E, 0x08, 0x12, 0x57, 0x99, 0x90, ++0xA3, 0x82, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xB8, 0xE0, 0x7E, 0x00, 0x78, ++0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, ++0xA3, 0x86, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x12, 0x57, 0x99, 0x90, 0xA4, 0xB8, 0xE0, ++0x90, 0xA3, 0x82, 0xB4, 0x01, 0x13, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0xA3, 0x86, ++0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x80, 0x11, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, ++0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, 0x0A, 0x80, 0x6D, ++0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, ++0x00, 0x30, 0x02, 0x02, 0x7F, 0xAC, 0x7E, 0x08, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x00, 0x3C, 0x90, 0xA4, 0xB8, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0xFF, 0xAE, 0xF0, ++0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x48, 0x7F, 0xAC, 0x7E, 0x08, ++0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xB8, ++0xE0, 0x7E, 0x00, 0x78, 0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, ++0xE0, 0xFD, 0xFC, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x12, 0x57, 0x99, ++0x22, 0xE4, 0xFE, 0xFC, 0xEF, 0x64, 0x02, 0x70, 0x40, 0xED, 0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, ++0x06, 0xED, 0xB4, 0x02, 0x02, 0x7E, 0x09, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, ++0x04, 0x80, 0x38, 0xEB, 0xB4, 0x02, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, ++0xB4, 0x01, 0x08, 0xED, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, ++0xED, 0x64, 0x02, 0x70, 0x16, 0x7C, 0x03, 0x80, 0x12, 0xEF, 0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, ++0x04, 0x7C, 0x01, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7C, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, ++0xF0, 0x4C, 0xFF, 0x22, 0x90, 0x01, 0xC3, 0xE0, 0xD3, 0x9F, 0x40, 0xF8, 0x22, 0x90, 0xA3, 0x71, ++0x12, 0x49, 0xBD, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, ++0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0xE4, 0x78, 0x00, 0xF2, 0x78, 0x00, ++0xE2, 0xFF, 0x25, 0xE0, 0x24, 0xED, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0xF5, 0x83, 0xE4, 0x93, 0xFC, ++0x74, 0x01, 0x93, 0xF5, 0x82, 0x8C, 0x83, 0xE0, 0xFE, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xB4, 0x8F, ++0x82, 0x75, 0x83, 0x00, 0xEE, 0x12, 0x26, 0x76, 0x78, 0x00, 0xE2, 0x04, 0xF2, 0xE2, 0xB4, 0x03, ++0xCD, 0xE4, 0x78, 0x00, 0xF2, 0x78, 0x00, 0xE2, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x32, 0xEF, 0x25, ++0xE0, 0x24, 0xF3, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, ++0xFF, 0x12, 0x36, 0xCE, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xB4, 0x78, 0x00, 0xE2, 0x75, 0xF0, 0x04, ++0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x49, 0x27, 0x78, 0x00, 0xE2, 0x04, 0xF2, 0x80, 0xC5, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x01, 0x90, 0xA3, ++0x74, 0x12, 0x49, 0xBD, 0x7A, 0xA2, 0x79, 0xFE, 0x31, 0xCD, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x3D, ++0x90, 0xA3, 0x74, 0x12, 0x49, 0xBD, 0x7A, 0xA3, 0x79, 0x21, 0x71, 0xE7, 0x7B, 0x01, 0x7A, 0xA3, ++0x79, 0x65, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xBD, 0x7A, 0xA3, 0x79, 0x59, 0x12, 0x5F, 0x56, 0x71, ++0x6D, 0xE4, 0xFF, 0x12, 0xAB, 0xE4, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x59, 0xE4, 0xFF, 0x51, 0xE8, ++0x7F, 0x01, 0x12, 0xAB, 0xE4, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x65, 0x7F, 0x01, 0x51, 0xE8, 0x7B, ++0x01, 0x7A, 0xA3, 0x79, 0x3D, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xBD, 0x7A, 0xA3, 0x79, 0x21, 0xB1, ++0x10, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x01, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xBD, 0x7A, 0xA2, 0x79, ++0xFE, 0x91, 0x71, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA3, 0x71, 0xEF, 0xF0, 0xA3, 0x12, 0x49, ++0xBD, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x72, 0x12, 0x49, 0xB4, 0x12, 0x48, ++0xBD, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x48, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x65, 0x12, 0x5F, ++0xDF, 0x90, 0xA3, 0x72, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x04, 0x12, 0x48, 0xDD, 0x90, 0xA3, 0x79, ++0x12, 0x27, 0x48, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x8F, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x72, ++0x12, 0x49, 0xB4, 0x90, 0x00, 0x08, 0x12, 0x48, 0xDD, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x48, 0x90, ++0xA3, 0x71, 0xE0, 0xFF, 0xE4, 0xFD, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0x00, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0xEF, 0x02, 0x5F, 0xDF, 0x90, 0xA3, 0x82, ++0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, ++0x00, 0x12, 0x57, 0x95, 0x90, 0x05, 0x22, 0x74, 0x3F, 0xF0, 0x90, 0x05, 0x50, 0xE0, 0x54, 0xF7, ++0xF0, 0xA3, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x10, 0x00, 0x00, 0x00, ++0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x12, 0x57, ++0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, ++0x27, 0x54, 0x00, 0x00, 0x00, 0x0F, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x0C, ++0x7F, 0x38, 0x7E, 0x08, 0x02, 0x57, 0x99, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xBD, 0x90, 0xA3, 0x82, ++0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, ++0x00, 0x12, 0x57, 0x95, 0xE4, 0x78, 0x00, 0xF2, 0x78, 0x00, 0xE2, 0xFF, 0xC3, 0x94, 0x07, 0x50, ++0x5F, 0xEF, 0x25, 0xE0, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, ++0x74, 0x01, 0x93, 0xFF, 0x12, 0x36, 0xCE, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xB4, 0x78, 0x00, 0xE2, ++0x75, 0xF0, 0x04, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x49, 0x27, 0x78, 0x00, 0xE2, 0x25, ++0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, ++0xFF, 0x12, 0x36, 0xCE, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xB4, 0x78, 0x00, 0xE2, 0x75, 0xF0, 0x04, ++0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x49, 0x27, 0x78, 0x00, 0xE2, 0x04, 0xF2, 0x80, 0x98, ++0x22, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xBD, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, ++0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0xE4, 0x78, ++0x00, 0xF2, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xB4, 0x78, 0x00, 0xE2, 0xFF, 0xF5, 0x82, 0x75, 0x83, ++0x00, 0x12, 0x26, 0x37, 0xFE, 0xEF, 0x25, 0xE0, 0x24, 0xED, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0xF5, ++0x83, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x8C, 0x83, 0xEE, 0xF0, 0x78, 0x00, 0xE2, ++0x04, 0xF2, 0xE2, 0xB4, 0x03, 0xCC, 0xE4, 0x78, 0x00, 0xF2, 0x78, 0x00, 0xE2, 0xFD, 0x25, 0xE0, ++0x24, 0xF3, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, ++0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xB4, 0x75, 0xF0, 0x04, 0xED, 0xA4, 0xF5, ++0x82, 0x85, 0xF0, 0x83, 0x12, 0x48, 0xDD, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0xD0, 0x07, 0xD0, ++0x06, 0x12, 0x37, 0x5D, 0x78, 0x00, 0xE2, 0x04, 0xF2, 0xE2, 0xC3, 0x94, 0x08, 0x40, 0xBB, 0x22, ++0x90, 0xA3, 0x71, 0x12, 0x49, 0xBD, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, ++0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0xE4, 0x78, 0x00, ++0xF2, 0x78, 0x00, 0xE2, 0xFD, 0x25, 0xE0, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, ++0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x71, 0x12, 0x49, ++0xB4, 0x75, 0xF0, 0x04, 0xED, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x48, 0xDD, 0x90, 0xAC, ++0xB9, 0x12, 0x27, 0x48, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x78, 0x00, 0xE2, 0xFD, 0x25, ++0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, ++0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xB4, 0x75, 0xF0, 0x04, 0xED, 0xA4, ++0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x48, 0xDD, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0xD0, 0x07, ++0xD0, 0x06, 0x12, 0x37, 0x5D, 0x78, 0x00, 0xE2, 0x04, 0xF2, 0xE2, 0xC3, 0x94, 0x07, 0x40, 0x81, ++0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, ++0x80, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, ++0x00, 0x7F, 0x80, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, ++0x00, 0x00, 0x7F, 0x84, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0x00, 0x7F, 0x88, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, ++0x3C, 0x00, 0x00, 0x00, 0x7F, 0x8C, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB8, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, ++0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x80, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, ++0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x84, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0xAC, ++0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x88, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, ++0xAC, 0xB9, 0x12, 0x27, 0x54, 0x3C, 0x00, 0x00, 0x00, 0x7F, 0x8C, 0x7E, 0x0E, 0x12, 0x37, 0x5D, ++0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB8, 0x7E, 0x0E, 0x02, 0x37, ++0x5D, 0x90, 0xA3, 0x77, 0xEF, 0xF0, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, ++0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x78, ++0x12, 0x49, 0x4B, 0x78, 0x01, 0x12, 0x27, 0x22, 0xE4, 0x7B, 0x12, 0x7A, 0x01, 0xF9, 0xF8, 0xC3, ++0x12, 0x48, 0xAC, 0x60, 0x17, 0x90, 0xA3, 0x7C, 0x12, 0x49, 0x4B, 0x78, 0x01, 0x12, 0x27, 0x22, ++0xE4, 0x7B, 0xEE, 0x7A, 0x03, 0xF8, 0xC3, 0x12, 0x48, 0xAC, 0x70, 0x69, 0x90, 0xA3, 0x77, 0xE0, ++0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x29, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, ++0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, ++0x03, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, 0x00, 0xD0, 0x07, 0xD0, 0x06, ++0x12, 0x57, 0x99, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x29, 0xF5, 0x82, 0xE4, ++0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0xA3, 0x82, 0x12, 0x27, 0x54, 0x03, 0xFF, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0x00, 0x80, 0x70, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x29, 0xF5, ++0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, ++0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0xFF, 0x90, 0xA3, 0x78, 0x12, 0x49, ++0x4B, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x48, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0x90, 0xA3, ++0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x29, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, ++0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, ++0x03, 0xFF, 0x00, 0x00, 0x90, 0xA3, 0x7C, 0x12, 0x49, 0x4B, 0x78, 0x10, 0x12, 0x27, 0x35, 0x90, ++0xA3, 0x86, 0x12, 0x27, 0x48, 0xD0, 0x07, 0xD0, 0x06, 0x02, 0x57, 0x99, 0x90, 0xA3, 0x77, 0xEF, ++0xF0, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, ++0x54, 0x80, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, ++0x24, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, ++0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x80, 0xD0, 0x07, ++0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, ++0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x20, 0x04, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, ++0x37, 0x5D, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x31, 0xF5, 0x82, 0xE4, 0x34, ++0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, ++0xB9, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, ++0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x33, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, ++0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x07, 0xFF, 0x90, 0xA3, 0x7C, 0x12, 0x49, 0x4B, 0x90, 0xA3, 0x86, 0x12, 0x27, ++0x48, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, ++0x24, 0x35, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, ++0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x07, 0xFF, 0x90, 0xA3, ++0x78, 0x12, 0x49, 0x4B, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x48, 0xD0, 0x07, 0xD0, 0x06, 0x02, 0x57, ++0x99, 0x90, 0xA3, 0x77, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xE4, 0x78, 0x3C, 0xF2, 0x90, 0xA3, 0x77, ++0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x0B, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, ++0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, ++0x10, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, ++0xFA, 0x00, 0x00, 0x00, 0x7F, 0x80, 0x7E, 0x09, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, ++0x54, 0xF8, 0x00, 0x00, 0x00, 0x7F, 0x80, 0x7E, 0x09, 0x12, 0x37, 0x5D, 0x7F, 0x03, 0x7E, 0x00, ++0x12, 0x3A, 0x69, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x0B, 0xF5, 0x82, 0xE4, ++0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, ++0xE4, 0x78, 0x3D, 0xF2, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x2B, 0xF5, 0x82, ++0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x36, 0xCE, 0xE4, ++0xFF, 0xEE, 0x54, 0x04, 0xFE, 0xE4, 0xFD, 0xFC, 0x78, 0x0A, 0x12, 0x27, 0x22, 0x78, 0x3E, 0xEF, ++0xF2, 0x70, 0x15, 0x18, 0xE2, 0xD3, 0x94, 0x14, 0x50, 0x0E, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, ++0x69, 0x78, 0x3D, 0xE2, 0x04, 0xF2, 0x80, 0xBC, 0x78, 0x3D, 0xE2, 0xC3, 0x94, 0x14, 0x40, 0x02, ++0x61, 0xCF, 0x90, 0xA3, 0x78, 0xE0, 0x60, 0x02, 0x41, 0x63, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, ++0x1C, 0xA4, 0x24, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, ++0x93, 0xFF, 0x12, 0x36, 0xCE, 0xE4, 0xFF, 0xEE, 0x54, 0x10, 0xFE, 0xE4, 0xFD, 0xFC, 0x90, 0xA3, ++0x79, 0x12, 0x27, 0x48, 0xE4, 0xFF, 0xFE, 0xFD, 0xFC, 0x90, 0xA3, 0x79, 0x12, 0x49, 0x73, 0xC3, ++0x12, 0x48, 0xAC, 0x70, 0x7C, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x0B, 0xF5, ++0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, ++0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x02, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, ++0x37, 0x5D, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x2B, 0xF5, 0x82, 0xE4, 0x34, ++0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x36, 0xCE, 0xE4, 0xFF, 0xFE, ++0xEC, 0x54, 0x07, 0xFC, 0x78, 0x70, 0x12, 0x49, 0x9C, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x0E, ++0xA4, 0x24, 0x0B, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, ++0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x04, 0x00, 0x00, 0x00, 0x61, ++0x1A, 0xE4, 0x78, 0x3F, 0xF2, 0x78, 0x3C, 0xE2, 0x04, 0xF2, 0xE2, 0x64, 0x0A, 0x60, 0x02, 0x01, ++0xBD, 0x61, 0xDF, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x2B, 0xF5, 0x82, 0xE4, ++0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x36, 0xCE, 0xE4, 0xFF, ++0xEE, 0x54, 0x08, 0xFE, 0xE4, 0xFD, 0xFC, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x48, 0xE4, 0xFF, 0xFE, ++0xFD, 0xFC, 0x90, 0xA3, 0x79, 0x12, 0x49, 0x73, 0xC3, 0x12, 0x48, 0xAC, 0x60, 0x02, 0x61, 0x4F, ++0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x0B, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, ++0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, ++0x27, 0x54, 0x06, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x77, ++0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, ++0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x36, 0xCE, 0xE4, 0xFF, 0xFE, 0xEC, 0x54, 0x07, 0xFC, 0x78, ++0x70, 0x12, 0x49, 0x9C, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x0B, 0xF5, 0x82, ++0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, ++0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x08, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, ++0x5D, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0x45, ++0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x36, 0xCE, 0xE4, 0xFF, 0xFE, 0xEC, ++0x54, 0x07, 0xFC, 0x78, 0x74, 0x12, 0x49, 0x9C, 0x78, 0x3F, 0x74, 0x01, 0xF2, 0x61, 0xDF, 0x90, ++0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x29, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, ++0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x03, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, 0x00, 0xD0, ++0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x29, ++0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, ++0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x03, 0xFF, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, ++0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0xE4, 0x78, 0x3F, ++0xF2, 0x78, 0x3C, 0xE2, 0x04, 0xF2, 0xE2, 0x64, 0x0A, 0x60, 0x02, 0x01, 0xBD, 0x80, 0x10, 0xE4, ++0x78, 0x3F, 0xF2, 0x78, 0x3C, 0xE2, 0x04, 0xF2, 0xE2, 0x64, 0x0A, 0x60, 0x02, 0x01, 0xBD, 0x78, ++0x3F, 0xE2, 0xFF, 0x22, 0x90, 0xA3, 0x71, 0xEF, 0xF0, 0xE4, 0x78, 0x00, 0xF2, 0xA3, 0xF0, 0xA3, ++0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x78, 0x1E, 0x7C, 0x8D, 0x7D, 0xFE, 0x7B, 0xFF, 0x7A, 0x45, 0x79, ++0x57, 0xFE, 0x7F, 0x06, 0x12, 0x47, 0xD0, 0xE4, 0x78, 0x1C, 0xF2, 0x08, 0xF2, 0x90, 0xA1, 0xF7, ++0xE0, 0x90, 0xA3, 0x76, 0xF0, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, ++0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x71, 0xE0, ++0x90, 0xAC, 0xB9, 0x70, 0x4E, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x90, 0x45, 0x05, 0xE4, ++0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, ++0x77, 0x77, 0x77, 0x90, 0x45, 0x07, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x37, 0x5D, ++0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x90, 0x45, 0x13, 0xE4, 0x93, 0xFE, ++0x74, 0x01, 0x93, 0xFF, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, ++0x00, 0x80, 0x4C, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x90, 0x45, 0x05, 0xE4, 0x93, 0xFE, ++0x74, 0x01, 0x93, 0xFF, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, ++0x00, 0x90, 0x45, 0x07, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x37, 0x5D, 0x90, 0xAC, ++0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x90, 0x45, 0x13, 0xE4, 0x93, 0xFE, 0x74, 0x01, ++0x93, 0xFF, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x90, ++0x45, 0x15, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, ++0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, ++0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x19, 0x79, ++0x19, 0x79, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, ++0xA4, 0x24, 0x1F, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, ++0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x0F, 0x90, ++0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x04, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, ++0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, ++0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, ++0x27, 0x54, 0x07, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x07, 0x00, 0x00, 0x00, ++0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, ++0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, 0x00, 0x7F, 0xC4, 0x7E, 0x08, 0x12, ++0x57, 0x99, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, ++0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, ++0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, ++0x00, 0x04, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, ++0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, ++0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x08, 0x00, 0x02, 0x12, 0x5F, 0xD8, 0x90, 0xA3, 0x79, ++0x12, 0x27, 0x54, 0x00, 0x02, 0x00, 0x00, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x30, 0x12, 0x5F, ++0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x03, 0xFF, 0xFD, 0x90, 0xA3, 0x71, 0xE0, 0xFF, ++0x7D, 0x31, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x0F, 0xE8, 0x3F, 0x90, ++0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x32, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, ++0x09, 0x31, 0xD5, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x65, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, ++0x12, 0x27, 0x54, 0x00, 0x08, 0xA0, 0x01, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x8F, 0x12, 0x5F, ++0xDF, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x80, 0x00, 0x7F, 0x0C, 0x7E, 0x09, 0x12, ++0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x21, 0xF5, 0x82, 0xE4, 0x34, ++0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, ++0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, ++0x00, 0x01, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x29, ++0x00, 0x20, 0x00, 0x7F, 0x78, 0x7E, 0x09, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, ++0xA9, 0x00, 0x20, 0x00, 0x7F, 0x7C, 0x7E, 0x09, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, ++0x54, 0x00, 0x46, 0x29, 0x10, 0x7F, 0x84, 0x7E, 0x09, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x82, 0x12, ++0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, ++0x12, 0x57, 0x95, 0x90, 0xA1, 0xF8, 0xE0, 0x90, 0xA3, 0x71, 0x30, 0xE0, 0x25, 0xE0, 0x75, 0xF0, ++0x1C, 0xA4, 0x24, 0x23, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, ++0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x82, 0x14, 0x03, 0xF7, ++0x80, 0x23, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x23, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, ++0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, ++0x54, 0x82, 0x14, 0x03, 0xF1, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA1, 0xF7, 0xE0, ++0x30, 0xE5, 0x28, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x25, 0xF5, 0x82, 0xE4, ++0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0xAC, 0xB9, 0x12, 0x27, 0x54, 0x68, 0x16, 0x3E, 0x96, 0x80, 0x2D, 0x90, 0xA1, 0xF7, 0xE0, 0x30, ++0xE4, 0x2D, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x25, 0xF5, 0x82, 0xE4, 0x34, ++0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, ++0xB9, 0x12, 0x27, 0x54, 0x28, 0x16, 0x3E, 0x96, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, ++0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x37, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, ++0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, ++0x54, 0x18, 0x00, 0x8C, 0x10, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, ++0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x39, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, ++0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x38, 0x00, ++0x8C, 0x10, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, ++0xA4, 0x24, 0x27, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, ++0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xD0, ++0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0xE4, 0x78, 0x00, 0xF2, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0xE4, ++0xFD, 0x12, 0xA8, 0xB1, 0x78, 0x1C, 0xEF, 0xF2, 0xFB, 0x78, 0x70, 0x12, 0x49, 0x57, 0x78, 0x00, ++0xE2, 0xFA, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x40, 0xF8, 0x12, 0x49, 0x9C, 0x78, 0x74, 0x12, 0x49, ++0x57, 0xEA, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x4C, 0xF8, 0x12, 0x49, 0x9C, 0xEB, 0x60, 0x06, 0x90, ++0xA3, 0x72, 0xE0, 0x04, 0xF0, 0x78, 0x00, 0xE2, 0x04, 0xF2, 0xE2, 0xC3, 0x94, 0x03, 0x40, 0xBA, ++0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, ++0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x08, 0x12, 0x5F, ++0x48, 0xE4, 0xFF, 0xEE, 0x54, 0xFC, 0xFE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x90, 0xA3, 0x7E, ++0x12, 0x27, 0x48, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, 0xFE, 0x00, 0x90, 0xA3, 0x71, ++0xE0, 0xFF, 0x7D, 0x58, 0x7C, 0x00, 0x12, 0x57, 0x15, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, ++0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, ++0x78, 0x1C, 0xE2, 0x70, 0x02, 0x61, 0x98, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, ++0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, ++0x79, 0x12, 0x27, 0x54, 0x00, 0x08, 0x00, 0x00, 0x12, 0x5F, 0xD8, 0x90, 0xA3, 0x79, 0x12, 0x27, ++0x54, 0x00, 0x03, 0x00, 0x00, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x30, 0x12, 0x5F, 0xDF, 0x90, ++0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x03, 0xF7, 0xFF, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x31, ++0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x0F, 0xE7, 0xBF, 0x90, 0xA3, 0x71, ++0xE0, 0xFF, 0x7D, 0x32, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x08, 0x80, ++0x01, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x8F, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, ++0x54, 0x00, 0x09, 0x31, 0xD0, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x65, 0x12, 0x5F, 0xDF, 0x90, ++0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x5F, 0xD8, 0x90, 0xA3, 0x82, 0x12, ++0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, ++0x7F, 0x78, 0x7E, 0x09, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, ++0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x7C, 0x7E, 0x09, 0x12, ++0x57, 0x99, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x80, 0x00, 0x7F, 0x0C, 0x7E, 0x09, ++0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x46, 0xA8, 0x91, 0x7F, 0x84, 0x7E, ++0x09, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, ++0x86, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x71, 0xE0, 0x75, ++0xF0, 0x1C, 0xA4, 0x24, 0x37, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, ++0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x38, 0x00, 0x8C, ++0x10, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, ++0x24, 0x39, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, ++0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x18, 0x00, 0x8C, 0x10, 0xD0, 0x07, ++0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x23, 0xF5, ++0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, ++0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x02, 0x14, 0x01, 0x19, 0xD0, 0x07, 0xD0, 0x06, 0x12, ++0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x70, 0x25, 0xEF, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x25, ++0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, ++0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x28, 0x16, 0x0D, 0x40, 0x80, 0x26, 0x90, 0xA3, ++0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x25, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, ++0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, ++0x28, 0x16, 0x11, 0x80, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0xE4, 0x78, 0x02, 0xF2, 0x90, ++0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x03, 0xFF, 0x80, 0x00, ++0x78, 0x02, 0xE2, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x40, 0xF8, 0x12, 0x49, 0x57, 0x78, 0x01, 0x12, ++0x27, 0x22, 0xE4, 0xFF, 0xEE, 0x54, 0x80, 0xFE, 0xEC, 0x54, 0x03, 0xFC, 0x90, 0xA3, 0x86, 0x12, ++0x27, 0x48, 0x7F, 0x78, 0x7E, 0x09, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x07, 0xFF, 0x78, 0x02, 0xE2, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x4C, 0xF8, 0x12, 0x49, 0x57, ++0x78, 0x10, 0x12, 0x27, 0x22, 0xEE, 0x54, 0x07, 0xFE, 0xE4, 0xFD, 0xFC, 0x90, 0xA3, 0x86, 0x12, ++0x27, 0x48, 0x7F, 0x78, 0x7E, 0x09, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, ++0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, ++0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0xA8, 0xB1, 0x78, 0x1D, 0xEF, 0xF2, 0xFB, 0x78, ++0x70, 0x12, 0x49, 0x57, 0x78, 0x02, 0xE2, 0xFA, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x58, 0xF8, 0x12, ++0x49, 0x9C, 0x78, 0x74, 0x12, 0x49, 0x57, 0xEA, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x64, 0xF8, 0x12, ++0x49, 0x9C, 0xEB, 0x60, 0x06, 0x90, 0xA3, 0x73, 0xE0, 0x04, 0xF0, 0x78, 0x02, 0xE2, 0x04, 0xF2, ++0xE2, 0xC3, 0x94, 0x03, 0x50, 0x02, 0x41, 0xBF, 0x90, 0xA3, 0x72, 0xE0, 0x70, 0x1C, 0x90, 0xA3, ++0x78, 0x12, 0x27, 0x54, 0x00, 0x00, 0x02, 0x00, 0x90, 0xA3, 0x7C, 0x12, 0x27, 0x54, 0x00, 0x00, ++0x00, 0x00, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x02, 0xA7, 0x9C, 0xE4, 0x78, 0x02, 0xF2, 0x78, 0x02, ++0xE2, 0xFB, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x40, 0xF8, 0x12, 0x49, 0x57, 0x78, 0x10, 0x12, 0x27, ++0x22, 0xEB, 0x25, 0xE0, 0x24, 0x24, 0xF8, 0xEE, 0xF2, 0x08, 0xEF, 0xF2, 0x78, 0x02, 0xE2, 0xFB, ++0x25, 0xE0, 0x25, 0xE0, 0x24, 0x4C, 0xF8, 0x12, 0x49, 0x57, 0x78, 0x10, 0x12, 0x27, 0x22, 0xEB, ++0x25, 0xE0, 0x24, 0x2A, 0xF8, 0xEE, 0xF2, 0x08, 0xEF, 0xF2, 0x78, 0x02, 0xE2, 0xFB, 0x25, 0xE0, ++0x25, 0xE0, 0x24, 0x58, 0xF8, 0x12, 0x49, 0x57, 0x78, 0x11, 0x12, 0x27, 0x22, 0xEB, 0x25, 0xE0, ++0x24, 0x30, 0xF8, 0xEE, 0xF2, 0x08, 0xEF, 0xF2, 0x78, 0x02, 0xE2, 0xFB, 0x25, 0xE0, 0x25, 0xE0, ++0x24, 0x64, 0xF8, 0x12, 0x49, 0x57, 0x78, 0x11, 0x12, 0x27, 0x22, 0xEB, 0x25, 0xE0, 0x24, 0x36, ++0xF8, 0xEE, 0xF2, 0x08, 0xEF, 0xF2, 0x78, 0x02, 0xE2, 0x04, 0xF2, 0xE2, 0x64, 0x03, 0x60, 0x02, ++0x61, 0xBE, 0xE4, 0x78, 0x01, 0xF2, 0x90, 0xA3, 0x72, 0xE0, 0xFF, 0x78, 0x01, 0xE2, 0xFE, 0xC3, ++0x9F, 0x40, 0x02, 0xA1, 0x75, 0xEE, 0x04, 0x78, 0x03, 0xF2, 0x90, 0xA3, 0x72, 0xE0, 0xFF, 0x78, ++0x03, 0xE2, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0xA1, 0x66, 0xEE, 0x25, 0xE0, 0x24, 0x24, 0xF8, 0xE2, ++0xFE, 0x08, 0xE2, 0xFF, 0x78, 0x01, 0xE2, 0x25, 0xE0, 0x24, 0x25, 0xF8, 0xC3, 0xE2, 0x9F, 0xFF, ++0x18, 0xE2, 0x9E, 0xFE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x78, 0x14, 0x12, 0x49, 0x9C, 0xE4, 0x7F, ++0x04, 0xFE, 0xFD, 0xFC, 0x78, 0x14, 0x12, 0x49, 0x7F, 0xC3, 0x12, 0x48, 0x96, 0x40, 0x02, 0xA1, ++0x5F, 0x74, 0xFF, 0x7F, 0xFC, 0xFE, 0xFD, 0xFC, 0x78, 0x14, 0x12, 0x49, 0x7F, 0xD3, 0x12, 0x48, ++0x96, 0x50, 0x02, 0xA1, 0x5F, 0x78, 0x03, 0xE2, 0x25, 0xE0, 0x24, 0x2A, 0xF8, 0xE2, 0xFE, 0x08, ++0xE2, 0xFF, 0x78, 0x01, 0xE2, 0x25, 0xE0, 0x24, 0x2B, 0xF8, 0xC3, 0xE2, 0x9F, 0xFF, 0x18, 0xE2, ++0x9E, 0xFE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x78, 0x18, 0x12, 0x49, 0x9C, 0xE4, 0x7F, 0x04, 0xFE, ++0xFD, 0xFC, 0x78, 0x18, 0x12, 0x49, 0x7F, 0xC3, 0x12, 0x48, 0x96, 0x50, 0x72, 0x74, 0xFF, 0x7F, ++0xFC, 0xFE, 0xFD, 0xFC, 0x78, 0x18, 0x12, 0x49, 0x7F, 0xD3, 0x12, 0x48, 0x96, 0x40, 0x60, 0x78, ++0x03, 0xE2, 0xFB, 0x25, 0xE0, 0x24, 0x24, 0xF8, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x78, 0x01, 0xE2, ++0xFA, 0x25, 0xE0, 0x24, 0x25, 0xF8, 0xE2, 0x2F, 0xFF, 0x18, 0xE2, 0x3E, 0xA2, 0xE7, 0x13, 0xFE, ++0xEF, 0x13, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x78, 0x04, 0x12, 0x49, 0x9C, 0xEB, 0x25, ++0xE0, 0x24, 0x2A, 0xF8, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0xEA, 0x25, 0xE0, 0x24, 0x2B, 0xF8, 0xE2, ++0x2F, 0xFF, 0x18, 0xE2, 0x3E, 0xA2, 0xE7, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xEE, 0x33, 0x95, 0xE0, ++0xFD, 0xFC, 0x78, 0x08, 0x12, 0x49, 0x9C, 0x90, 0xA3, 0x74, 0x74, 0x01, 0xF0, 0x80, 0x07, 0x78, ++0x03, 0xE2, 0x04, 0xF2, 0x81, 0x5A, 0x90, 0xA3, 0x74, 0xE0, 0x64, 0x01, 0x60, 0x07, 0x78, 0x01, ++0xE2, 0x04, 0xF2, 0x81, 0x46, 0x90, 0xA3, 0x74, 0xE0, 0xB4, 0x01, 0x18, 0x78, 0x04, 0x12, 0x49, ++0x57, 0x90, 0xA3, 0x78, 0x12, 0x27, 0x48, 0x78, 0x08, 0x12, 0x49, 0x57, 0x90, 0xA3, 0x7C, 0x12, ++0x27, 0x48, 0x80, 0x14, 0x90, 0xA3, 0x78, 0x12, 0x27, 0x54, 0x00, 0x00, 0x02, 0x00, 0x90, 0xA3, ++0x7C, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x12, 0xA7, 0x9C, ++0x90, 0xA3, 0x73, 0xE0, 0x70, 0x16, 0x90, 0xA3, 0x78, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, 0x00, ++0x90, 0xA3, 0x7C, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xE1, 0x32, 0xE4, 0x78, 0x01, 0xF2, ++0x90, 0xA3, 0x73, 0xE0, 0xFF, 0x78, 0x01, 0xE2, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0xC1, 0xFF, 0xEE, ++0x04, 0x78, 0x03, 0xF2, 0x90, 0xA3, 0x73, 0xE0, 0xFF, 0x78, 0x03, 0xE2, 0xFE, 0xC3, 0x9F, 0x40, ++0x02, 0xC1, 0xF0, 0xEE, 0x25, 0xE0, 0x24, 0x30, 0xF8, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x78, 0x01, ++0xE2, 0x25, 0xE0, 0x24, 0x31, 0xF8, 0xC3, 0xE2, 0x9F, 0xFF, 0x18, 0xE2, 0x9E, 0xFE, 0x33, 0x95, ++0xE0, 0xFD, 0xFC, 0x78, 0x14, 0x12, 0x49, 0x9C, 0xE4, 0x7F, 0x04, 0xFE, 0xFD, 0xFC, 0x78, 0x14, ++0x12, 0x49, 0x7F, 0xC3, 0x12, 0x48, 0x96, 0x40, 0x02, 0xC1, 0xE9, 0x74, 0xFF, 0x7F, 0xFC, 0xFE, ++0xFD, 0xFC, 0x78, 0x14, 0x12, 0x49, 0x7F, 0xD3, 0x12, 0x48, 0x96, 0x50, 0x02, 0xC1, 0xE9, 0x78, ++0x03, 0xE2, 0x25, 0xE0, 0x24, 0x36, 0xF8, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x78, 0x01, 0xE2, 0x25, ++0xE0, 0x24, 0x37, 0xF8, 0xC3, 0xE2, 0x9F, 0xFF, 0x18, 0xE2, 0x9E, 0xFE, 0x33, 0x95, 0xE0, 0xFD, ++0xFC, 0x78, 0x18, 0x12, 0x49, 0x9C, 0xE4, 0x7F, 0x04, 0xFE, 0xFD, 0xFC, 0x78, 0x18, 0x12, 0x49, ++0x7F, 0xC3, 0x12, 0x48, 0x96, 0x50, 0x72, 0x74, 0xFF, 0x7F, 0xFC, 0xFE, 0xFD, 0xFC, 0x78, 0x18, ++0x12, 0x49, 0x7F, 0xD3, 0x12, 0x48, 0x96, 0x40, 0x60, 0x78, 0x03, 0xE2, 0xFB, 0x25, 0xE0, 0x24, ++0x30, 0xF8, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x78, 0x01, 0xE2, 0xFA, 0x25, 0xE0, 0x24, 0x31, 0xF8, ++0xE2, 0x2F, 0xFF, 0x18, 0xE2, 0x3E, 0xA2, 0xE7, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xEE, 0x33, 0x95, ++0xE0, 0xFD, 0xFC, 0x78, 0x0C, 0x12, 0x49, 0x9C, 0xEB, 0x25, 0xE0, 0x24, 0x36, 0xF8, 0xE2, 0xFE, ++0x08, 0xE2, 0xFF, 0xEA, 0x25, 0xE0, 0x24, 0x37, 0xF8, 0xE2, 0x2F, 0xFF, 0x18, 0xE2, 0x3E, 0xA2, ++0xE7, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x78, 0x10, 0x12, 0x49, ++0x9C, 0x90, 0xA3, 0x75, 0x74, 0x01, 0xF0, 0x80, 0x07, 0x78, 0x03, 0xE2, 0x04, 0xF2, 0xA1, 0xE4, ++0x90, 0xA3, 0x75, 0xE0, 0x64, 0x01, 0x60, 0x07, 0x78, 0x01, 0xE2, 0x04, 0xF2, 0xA1, 0xD0, 0x90, ++0xA3, 0x75, 0xE0, 0xB4, 0x01, 0x18, 0x78, 0x0C, 0x12, 0x49, 0x57, 0x90, 0xA3, 0x78, 0x12, 0x27, ++0x48, 0x78, 0x10, 0x12, 0x49, 0x57, 0x90, 0xA3, 0x7C, 0x12, 0x27, 0x48, 0x80, 0x14, 0x90, 0xA3, ++0x78, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, 0x00, 0x90, 0xA3, 0x7C, 0x12, 0x27, 0x54, 0x00, 0x00, ++0x00, 0x00, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x02, 0xA6, 0x71, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, ++0xFE, 0x90, 0xA1, 0xCF, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, ++0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xD0, 0xF0, 0x22, 0x90, 0xA1, 0xD2, 0xE0, 0x30, 0xE0, ++0x2D, 0x90, 0xA1, 0xD5, 0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x90, 0xA1, 0xD3, 0xE0, 0xB5, 0x07, 0x1E, ++0x90, 0x06, 0x92, 0xE0, 0x54, 0x1C, 0x70, 0x0B, 0x12, 0x74, 0xDB, 0x90, 0xA1, 0xD6, 0xE0, 0x04, ++0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, 0x74, 0x1C, 0xF0, 0xE4, 0x90, 0xA1, 0xD5, 0xF0, 0x22, 0xE4, ++0x90, 0xA1, 0xB1, 0xF0, 0xA3, 0xF0, 0x90, 0xA1, 0xB0, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, 0xF0, ++0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x90, 0xA1, 0xB7, ++0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, ++0xF0, 0xE4, 0x90, 0xA1, 0xBA, 0xF0, 0x90, 0xA1, 0xB9, 0x74, 0x07, 0xF0, 0x90, 0xA1, 0xBC, 0xE4, ++0xF0, 0xA3, 0x74, 0x02, 0xF0, 0xE4, 0x90, 0xA1, 0xB5, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xFE, ++0xF0, 0x90, 0xA1, 0xB3, 0x74, 0x0C, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0xA1, ++0xB4, 0x74, 0x0C, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, ++0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0xA1, 0xBE, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0x00, 0x90, 0xA0, 0x8B, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0xA1, 0xBB, 0x74, 0xFF, 0xF0, ++0x80, 0x12, 0x90, 0xA0, 0x8B, 0xE0, 0x90, 0xA1, 0xBB, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, ++0x03, 0x74, 0x41, 0xF0, 0x90, 0xA1, 0xC2, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, ++0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, ++0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, ++0xE4, 0xA3, 0xF0, 0x22, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA1, 0xBA, 0xF0, ++0x90, 0xA1, 0xB5, 0xF0, 0x22, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, ++0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x11, 0x75, ++0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x67, 0x90, 0xA1, 0xB5, ++0xE0, 0xFF, 0x54, 0x03, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x56, 0x90, 0xA1, ++0xB3, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x44, ++0xEF, 0x30, 0xE2, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x38, 0x90, 0xA1, 0xB5, 0xE0, ++0x30, 0xE4, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x29, 0x90, 0xA1, 0xAF, 0xE0, 0x13, ++0x13, 0x54, 0x3F, 0x20, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x20, 0xF0, 0x80, 0x16, 0x90, 0xA1, ++0xC8, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x80, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, ++0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0xEF, 0x24, 0xFE, ++0x60, 0x0C, 0x04, 0x70, 0x28, 0x90, 0xA1, 0xB7, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x22, 0xED, 0x70, ++0x0A, 0x90, 0xA1, 0xC5, 0xE0, 0x90, 0xA1, 0xB7, 0xF0, 0x80, 0x05, 0x90, 0xA1, 0xB7, 0xED, 0xF0, ++0x90, 0xA1, 0xB7, 0xE0, 0xA3, 0xF0, 0x90, 0xA1, 0xAF, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0xEF, 0x60, ++0x3E, 0x90, 0xA1, 0x2D, 0xE0, 0x64, 0x01, 0x70, 0x36, 0x90, 0xA1, 0xAF, 0xE0, 0x54, 0xFE, 0xF0, ++0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE4, 0xFF, 0x12, ++0x74, 0xDD, 0xBF, 0x01, 0x0E, 0x90, 0xA1, 0xAE, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA1, 0xB4, 0x74, ++0x06, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x22, ++0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x05, 0x22, ++0xE4, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x39, 0x90, ++0xA1, 0x2D, 0xE0, 0x64, 0x01, 0x70, 0x31, 0x90, 0xA1, 0xB8, 0xF0, 0x04, 0x60, 0x2A, 0x90, 0xA1, ++0xB5, 0xE0, 0x44, 0x10, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0xB9, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, ++0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA1, ++0xB4, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x62, 0x4F, 0x22, 0x90, 0xA0, 0x8E, 0xE0, 0xFE, 0x90, 0x04, ++0x1C, 0xE0, 0x6E, 0x70, 0x40, 0x90, 0xA1, 0xB4, 0xE0, 0xFE, 0x64, 0x0E, 0x70, 0x1C, 0xEF, 0x70, ++0x34, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE0, ++0x44, 0x80, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x04, 0xF0, 0x22, 0xEE, 0xB4, 0x06, 0x17, 0xEF, 0x60, ++0x14, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, ++0xA1, 0xB4, 0x74, 0x0C, 0xF0, 0x22, 0xE4, 0xFE, 0xEF, 0x25, 0xE0, 0xFD, 0xEF, 0xC3, 0x94, 0x80, ++0x90, 0xFD, 0x12, 0x50, 0x04, 0xE4, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x90, 0xFD, 0x10, 0xED, ++0xF0, 0xAF, 0x06, 0x22, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, ++0xA1, 0x2A, 0xE0, 0x9B, 0x90, 0xA1, 0x29, 0xE0, 0x9A, 0x50, 0x13, 0xA3, 0xE0, 0x24, 0x01, 0xFF, ++0x90, 0xA1, 0x29, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, ++0xFD, 0x11, 0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, ++0xFF, 0x22, 0xE3, 0xAC, ++}; ++u4Byte ArrayLength_MP_8812A_FW_NIC = 31396; ++ ++ ++void ++ODM_ReadFirmware_MP_8812A_FW_NIC( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++) ++{ ++ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8812A_FW_NIC; ++ *pFirmwareSize = ArrayLength_MP_8812A_FW_NIC; ++} ++ ++u1Byte Array_MP_8812A_FW_NIC_BT[] = { ++0x01, 0x95, 0x10, 0x00, 0x12, 0x00, 0x00, 0x00, 0x04, 0x29, 0x18, 0x19, 0x32, 0x7C, 0x00, 0x00, ++0x7D, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x02, 0x4B, 0xCC, 0x02, 0x61, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x62, 0x41, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x78, 0x0B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x61, 0xB8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x6F, 0xC0, 0x00, 0x00, ++0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, ++0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, ++0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, ++0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, ++0xF0, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x0A, 0x08, 0x03, ++0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, 0x04, 0x08, ++0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, 0x04, 0x00, ++0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, 0x0A, 0x03, ++0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, 0x10, 0x24, ++0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, 0x06, 0x00, ++0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, 0x21, 0x0C, ++0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, 0x20, 0x21, ++0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, 0x10, 0x00, ++0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, 0x28, 0x14, ++0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, 0x30, 0x04, ++0x04, 0x04, 0x05, 0x04, 0x04, 0x05, 0x07, 0x07, 0x07, 0x08, 0x0A, 0x04, 0x07, 0x0A, 0x0E, 0x11, ++0x13, 0x14, 0x15, 0x03, 0x04, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, ++0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x07, 0x08, 0x08, 0x0A, 0x0A, ++0x0C, 0x0E, 0x10, 0x11, 0x11, 0x07, 0x09, 0x09, 0x0B, 0x0B, 0x0D, 0x0F, 0x11, 0x11, 0x12, 0x05, ++0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, ++0x0F, 0x0F, 0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, 0x07, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x05, ++0x06, 0x07, 0x0D, 0x10, 0x11, 0x12, 0x12, 0x07, 0x08, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, ++0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x05, ++0x06, 0x08, 0x09, 0x0C, 0x0E, 0x12, 0x12, 0x13, 0x14, 0x07, 0x08, 0x0A, 0x0B, 0x0D, 0x10, 0x11, ++0x11, 0x14, 0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x09, 0x09, 0x09, ++0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, 0x25, 0x27, 0x28, 0x00, 0x00, 0x00, 0x00, 0x23, ++0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, ++0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, ++0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x2A, ++0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x04, 0x00, ++0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00, 0x18, 0x00, ++0x00, 0x00, 0x24, 0x00, 0x00, 0x00, 0x30, 0x00, 0x00, 0x00, 0x48, 0x00, 0x00, 0x00, 0x60, 0x00, ++0x00, 0x00, 0x90, 0x00, 0x00, 0x00, 0xC0, 0x00, 0x00, 0x00, 0xD8, 0x00, 0x00, 0x00, 0x3C, 0x00, ++0x00, 0x00, 0x64, 0x00, 0x00, 0x00, 0x78, 0x00, 0x00, 0x00, 0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, ++0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x00, 0xA0, 0x00, ++0x00, 0x00, 0xF0, 0x00, 0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x02, 0x58, 0x00, ++0x00, 0x03, 0x20, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x00, 0xC8, 0x00, ++0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, ++0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, ++0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, ++0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0x3C, 0x00, ++0x00, 0x00, 0x64, 0x00, 0x00, 0x00, 0x78, 0x00, 0x00, 0x00, 0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, ++0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0x58, 0x00, ++0x00, 0x03, 0x20, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, ++0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x0B, 0xB8, 0x00, ++0x00, 0x13, 0x88, 0x00, 0x00, 0x17, 0x70, 0x00, 0x00, 0x1F, 0x40, 0x00, 0x00, 0x00, 0xC8, 0x00, ++0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, ++0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, ++0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, ++0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, ++0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x02, 0x00, 0x02, 0x00, ++0x04, 0x00, 0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x48, 0x00, ++0x60, 0x00, 0x6C, 0x00, 0x14, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, ++0xC8, 0x00, 0xF0, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x01, 0x2C, 0x01, 0x90, 0x02, ++0x58, 0x03, 0x20, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, ++0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, ++0x20, 0x03, 0xE8, 0x00, 0x1E, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, ++0xC8, 0x00, 0xF0, 0x01, 0x2C, 0x01, 0x90, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, ++0xF4, 0x03, 0xE8, 0x05, 0xDC, 0x09, 0xC4, 0x0B, 0xB8, 0x0F, 0xA0, 0x00, 0x64, 0x00, 0x8C, 0x00, ++0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x00, ++0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, ++0xE8, 0x03, 0xE8, 0x02, 0x04, 0x06, 0x08, 0x0A, 0x0C, 0x10, 0x18, 0x20, 0x30, 0x40, 0x50, 0x02, ++0x02, 0x02, 0x02, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, 0x05, 0x02, 0x06, 0x06, 0x07, 0x07, ++0x08, 0x08, 0x08, 0x02, 0x02, 0x03, 0x03, 0x05, 0x05, 0x06, 0x06, 0x05, 0x06, 0x06, 0x07, 0x07, ++0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, ++0x07, 0x08, 0x08, 0x0A, 0x0A, 0x06, 0x06, 0x06, 0x07, 0x07, 0x07, 0x08, 0x08, 0x0A, 0x0B, 0x05, ++0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, ++0x0A, 0x0A, 0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x01, ++0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x05, 0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, ++0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x05, ++0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, ++0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, ++0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x47, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, ++0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, ++0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, ++0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, ++0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, ++0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, ++0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, ++0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, ++0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, ++0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, ++0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, ++0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, ++0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, ++0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, ++0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, ++0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4C, 0x68, 0x74, 0x01, 0x93, ++0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, ++0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, ++0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, ++0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, ++0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, ++0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, ++0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, ++0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, ++0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, ++0x04, 0x90, 0x4C, 0x68, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, ++0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, ++0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, ++0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x47, 0x4D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, ++0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, ++0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, ++0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, ++0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, ++0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, ++0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, ++0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, ++0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x47, 0x4C, 0x8F, 0xF0, ++0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, ++0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, 0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, ++0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, ++0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, ++0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x47, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, ++0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, ++0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, 0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, ++0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, ++0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, ++0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, ++0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, 0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, ++0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, 0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, ++0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, ++0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, ++0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, ++0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, 0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, ++0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, ++0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, 0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, ++0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, ++0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, ++0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x49, 0xF9, 0x73, 0xC5, ++0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, 0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, ++0x83, 0xE0, 0x38, 0xF0, 0x22, 0xBB, 0x01, 0x0A, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, ++0xE0, 0x22, 0x50, 0x06, 0x87, 0xF0, 0x09, 0xE7, 0x19, 0x22, 0xBB, 0xFE, 0x07, 0xE3, 0xF5, 0xF0, ++0x09, 0xE3, 0x19, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0x74, 0x01, 0x93, 0x22, ++0xBB, 0x01, 0x10, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0xE0, 0xF5, 0xF0, ++0xA3, 0xE0, 0x22, 0x50, 0x09, 0xE9, 0x25, 0x82, 0xF8, 0x86, 0xF0, 0x08, 0xE6, 0x22, 0xBB, 0xFE, ++0x0A, 0xE9, 0x25, 0x82, 0xF8, 0xE2, 0xF5, 0xF0, 0x08, 0xE2, 0x22, 0xE5, 0x83, 0x2A, 0xF5, 0x83, ++0xE9, 0x93, 0xF5, 0xF0, 0xA3, 0xE9, 0x93, 0x22, 0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, ++0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, ++0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xEB, ++0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, 0xE8, 0x9C, 0x45, 0xF0, 0x22, ++0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE4, 0x93, 0xFC, 0x74, ++0x01, 0x93, 0xFD, 0x74, 0x02, 0x93, 0xFE, 0x74, 0x03, 0x93, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, ++0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE4, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF9, 0x74, ++0x02, 0x93, 0xFA, 0x74, 0x03, 0x93, 0xFB, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, ++0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, ++0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, ++0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, ++0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x02, 0x4C, 0x0A, 0x02, ++0x47, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, ++0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, ++0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, ++0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x4C, 0x4F, 0xE4, 0x7E, 0x01, ++0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, ++0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, ++0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, ++0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0x00, ++0x41, 0xA6, 0x2B, 0x00, 0x41, 0xA6, 0x2C, 0x00, 0x41, 0xA6, 0x2D, 0x00, 0x41, 0xA6, 0x2E, 0x00, ++0x41, 0xA6, 0x61, 0x00, 0x41, 0xA6, 0x64, 0x00, 0x4D, 0x75, 0x4F, 0xC8, 0x58, 0x26, 0x90, 0x00, ++0xF0, 0xE0, 0x7F, 0x01, 0x20, 0xE2, 0x02, 0x7F, 0x03, 0x22, 0x91, 0x6E, 0x90, 0xA2, 0x95, 0xEF, ++0xF0, 0x91, 0x8C, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x02, 0x35, 0x95, 0xB1, 0x14, 0xB1, 0x44, ++0x91, 0xAE, 0x91, 0xCD, 0x91, 0xEF, 0xE4, 0xF5, 0x51, 0x75, 0x52, 0x58, 0xAB, 0x51, 0x7D, 0x02, ++0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x52, 0x7D, 0x03, 0x7F, 0x01, 0x02, 0x39, 0x04, 0x75, 0x5D, ++0x12, 0xE4, 0xF5, 0x5E, 0x75, 0x5F, 0x07, 0x75, 0x60, 0x72, 0x90, 0x01, 0x30, 0xE5, 0x5D, 0xF0, ++0xA3, 0xE5, 0x5E, 0xF0, 0xA3, 0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, 0xF0, 0x22, 0x75, 0x65, 0x06, ++0x75, 0x66, 0x01, 0x75, 0x67, 0x03, 0x75, 0x68, 0x62, 0x43, 0x65, 0x01, 0x90, 0x01, 0x38, 0xE5, ++0x65, 0xF0, 0xA3, 0xE5, 0x66, 0xF0, 0xA3, 0xE5, 0x67, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x22, 0xE4, ++0xF5, 0x55, 0xF5, 0x56, 0xF5, 0x57, 0xF5, 0x58, 0xAD, 0x55, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xAD, ++0x56, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xAD, 0x57, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xAD, 0x58, 0x7F, ++0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x30, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, ++0x01, 0x38, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xE4, ++0xFD, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, ++0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x34, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, ++0x90, 0x01, 0x3C, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, 0x3A, 0x96, ++0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0x7D, 0xFF, ++0x7F, 0x57, 0x02, 0x3A, 0x96, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x3A, ++0x96, 0xD1, 0x66, 0x12, 0x3A, 0xB8, 0xD1, 0xE3, 0xD1, 0x52, 0x7F, 0x01, 0x11, 0x15, 0x90, 0xA4, ++0x6D, 0x74, 0x02, 0xF0, 0xFF, 0x11, 0x15, 0x90, 0xA4, 0x6D, 0xE0, 0x04, 0xF0, 0x91, 0x7A, 0xB1, ++0xD2, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, 0x75, 0x28, 0xFF, ++0xD1, 0x4B, 0xF1, 0x66, 0x90, 0x00, 0xF1, 0xE0, 0x54, 0xF0, 0xD3, 0x94, 0x10, 0x40, 0x08, 0x90, ++0xA4, 0xB7, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA4, 0xB7, 0xF0, 0xD1, 0x5C, 0xE4, 0xFF, ++0x01, 0x9E, 0xD1, 0x45, 0xD1, 0x73, 0x12, 0x8B, 0xFE, 0xF1, 0x13, 0x12, 0xB8, 0x30, 0xD1, 0x81, ++0xD1, 0x90, 0xD1, 0xA2, 0x90, 0xA4, 0x55, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xFD, ++0xF0, 0x54, 0xF7, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x36, 0xCE, ++0x90, 0xA4, 0x5C, 0x12, 0x27, 0x48, 0x90, 0xA4, 0x5C, 0x71, 0x50, 0x90, 0xA4, 0x58, 0x12, 0x27, ++0x48, 0xE4, 0x90, 0xA4, 0x62, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x65, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, ++0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xFD, 0x68, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x07, 0x78, 0x74, 0x03, ++0xF0, 0x12, 0xB6, 0xCE, 0x90, 0xA4, 0x3F, 0x74, 0x01, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0xA4, 0x49, ++0xF0, 0xA3, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0xA3, 0x87, 0xF0, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, ++0x85, 0x22, 0xE4, 0x90, 0xA2, 0x92, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, ++0x12, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, ++0xE4, 0xF0, 0x22, 0xE4, 0x90, 0xA3, 0x83, 0xF0, 0xA3, 0xF0, 0x90, 0xA2, 0xEB, 0xF0, 0xA3, 0xF0, ++0x22, 0x90, 0xA4, 0x23, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, ++0x90, 0xA4, 0x6E, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, ++0xF0, 0x22, 0x90, 0xA4, 0x71, 0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, ++0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xD1, 0xA2, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, ++0x90, 0xA4, 0x71, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x14, 0x90, 0x00, ++0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x72, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA4, ++0x73, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, ++0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, ++0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, ++0x04, 0xF0, 0x22, 0xE4, 0xF5, 0x0D, 0xE4, 0xF5, 0x0E, 0xE5, 0x0E, 0xB4, 0x03, 0x1E, 0xFF, 0xE5, ++0x0D, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2F, ++0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x74, 0x40, 0xF0, 0x80, 0x1B, 0xE5, 0x0D, 0xC4, 0x54, ++0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x0E, 0xF5, 0x82, ++0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x05, 0x0E, 0xE5, 0x0E, 0xB4, 0x10, 0xBB, 0x05, 0x0D, ++0xE5, 0x0D, 0xB4, 0x08, 0xB1, 0x22, 0xE4, 0x90, 0xA5, 0x39, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x98, ++0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x44, 0xC3, 0x90, 0xA5, ++0x3A, 0xE0, 0x94, 0x88, 0x90, 0xA5, 0x39, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, ++0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x03, 0xF0, 0x80, 0x26, 0x90, 0xA5, 0x39, 0xE4, 0x75, ++0xF0, 0x01, 0x51, 0x9F, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0xA5, 0x3A, 0xE0, ++0x94, 0x32, 0x90, 0xA5, 0x39, 0xE0, 0x94, 0x00, 0x40, 0xB3, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, ++0xAC, 0x90, 0x01, 0xC7, 0x74, 0x05, 0xF0, 0x22, 0xE4, 0x90, 0xA5, 0x3C, 0xF0, 0x90, 0xA5, 0x3C, ++0xE0, 0x64, 0x01, 0xF0, 0x24, 0xC8, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x4F, 0xA3, 0xF0, 0x12, 0x3A, ++0xEB, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x69, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x0F, 0x90, 0xA4, 0x0E, ++0xE0, 0xFF, 0x90, 0xA4, 0x0D, 0xE0, 0x6F, 0x60, 0x03, 0x12, 0x77, 0xBF, 0xC2, 0xAF, 0xF1, 0xA7, ++0xBF, 0x01, 0x02, 0x11, 0x0E, 0xD2, 0xAF, 0x11, 0x18, 0x12, 0x47, 0x4D, 0x80, 0xBF, 0x90, 0xA4, ++0x08, 0xE0, 0x30, 0xE0, 0x02, 0xD1, 0xF8, 0x22, 0x12, 0xAC, 0x9F, 0x12, 0xAB, 0xDE, 0x11, 0x71, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA5, 0xB5, 0xF0, 0x90, 0x01, 0xC7, ++0xE0, 0x64, 0xAD, 0x70, 0x37, 0xF0, 0x90, 0xA5, 0xC2, 0x74, 0x0F, 0xF0, 0x90, 0xA5, 0xB4, 0x74, ++0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0xA5, 0xB5, 0xE0, 0x2F, 0xFE, 0x74, 0xB6, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x0F, 0xE9, 0x90, 0x01, 0x3F, ++0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0xB4, 0x12, 0x59, 0xB1, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x00, 0x8F, 0xE0, 0x20, 0xE6, 0x02, 0xC1, ++0x55, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0xA6, 0x3B, 0xF0, 0x90, 0x00, 0x8D, 0xE0, 0x90, 0xA6, 0x3C, ++0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0xA6, 0x3D, 0xF0, 0x90, 0xA6, 0x3C, 0xE0, 0x12, 0x4B, 0xA6, ++0x50, 0xC5, 0x01, 0x50, 0xCF, 0x02, 0x50, 0xD8, 0x03, 0x50, 0xE2, 0x04, 0x51, 0xFE, 0x05, 0x52, ++0xF7, 0x06, 0x53, 0x7C, 0x08, 0x54, 0x38, 0x09, 0x54, 0xC0, 0x0A, 0x55, 0x48, 0x0B, 0x55, 0xBB, ++0x0C, 0x00, 0x00, 0x56, 0x47, 0x90, 0xA6, 0x3B, 0xE0, 0xFF, 0x12, 0xAC, 0x3E, 0xC1, 0x47, 0x90, ++0xA6, 0x3B, 0xE0, 0xFF, 0xD1, 0x88, 0xC1, 0x47, 0x90, 0xA6, 0x3B, 0xE0, 0xFF, 0x12, 0xAC, 0xD1, ++0xC1, 0x47, 0x90, 0xA6, 0x3B, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, ++0xFB, 0xE4, 0xFD, 0xFF, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, ++0x12, 0x4B, 0x88, 0xE0, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0xD1, 0x60, 0x90, 0xA6, ++0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x13, 0x13, ++0x54, 0x01, 0xFB, 0x0D, 0xE4, 0xFF, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, ++0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0xD1, 0x60, 0x90, ++0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x92, 0x12, 0x4B, 0x88, 0xE0, 0xFB, 0xE4, 0xFD, ++0x0F, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x93, 0xD1, 0x5A, 0x90, ++0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x54, ++0x01, 0xFB, 0x0D, 0x7F, 0x01, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, ++0x94, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0x1F, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, ++0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x4B, 0x88, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, ++0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x01, 0xD1, 0x5A, 0x90, 0xA6, 0x3B, 0xE0, 0x75, ++0xF0, 0x08, 0x90, 0x89, 0x02, 0xD1, 0x5A, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, ++0x03, 0xD1, 0x5A, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x04, 0x12, 0x4B, 0x88, ++0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, ++0x05, 0xD1, 0x5A, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x06, 0xD1, 0x5A, 0x90, ++0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x07, 0x12, 0x4B, 0x88, 0x81, 0xBB, 0x90, 0xA6, ++0x3B, 0xE0, 0x25, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xA3, 0xE0, 0xFB, ++0xE4, 0xFD, 0xFF, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x25, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, ++0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x0A, ++0x90, 0x8D, 0x01, 0x12, 0x4B, 0x88, 0xA3, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, ++0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0xD1, 0x5A, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x0A, 0x90, ++0x8D, 0x03, 0x12, 0x4B, 0x88, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA6, 0x3B, ++0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x05, 0x12, 0x4B, 0x88, 0xA3, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, ++0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x07, 0x12, 0x4B, 0x88, 0xA3, 0xE0, 0xFB, ++0x0D, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x09, 0x12, 0x4B, 0x88, ++0xA3, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, ++0x99, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0xE4, 0xFB, 0xD1, 0x60, 0x90, 0xA6, ++0x3B, 0xE0, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xA3, 0xE0, 0xFB, ++0x7D, 0x02, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, ++0x95, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x77, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, ++0xD1, 0x60, 0x90, 0xA4, 0x78, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x79, 0xE0, 0xFB, 0x0D, ++0xD1, 0x60, 0x90, 0xA4, 0x7A, 0x81, 0xBB, 0x90, 0xA4, 0x7F, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0xD1, ++0x60, 0x90, 0xA4, 0x80, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x81, 0xE0, 0xFB, 0x0D, 0xD1, ++0x60, 0x90, 0xA4, 0x82, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, ++0x0F, 0xD1, 0x60, 0x90, 0xA4, 0x84, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x85, 0xE0, 0xFB, ++0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x86, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x87, 0xE0, 0xFB, ++0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0x88, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x89, ++0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x8A, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x8B, ++0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0x8C, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, ++0xA4, 0x8D, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x8E, 0x81, 0xBB, 0x90, 0xA4, 0x0B, 0xE0, ++0xFB, 0xE4, 0xFD, 0xFF, 0xD1, 0x60, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, 0xFB, 0x0D, 0xD1, 0x60, ++0x90, 0xA4, 0x0D, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x0E, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, ++0x90, 0xA6, 0x3B, 0xE0, 0x24, 0x87, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, ++0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0x01, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, ++0x08, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0xD1, 0x60, 0x90, 0xA4, 0x08, ++0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0xD1, 0x60, 0x90, 0xA2, 0x93, ++0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA2, 0x94, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, ++0xA4, 0x12, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x11, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, ++0xA4, 0x0A, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, 0xE4, 0xFD, 0x7F, 0x03, 0xD1, 0x60, 0x90, 0xA4, 0x09, ++0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0xD1, 0x60, 0x90, 0xA4, 0x09, 0xE0, 0x13, ++0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0xD1, 0x60, 0x90, 0xA4, 0x08, 0xE0, 0x13, 0x13, ++0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0xC1, 0x45, 0x90, 0xA4, 0x97, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, ++0xD1, 0x60, 0x90, 0xA4, 0x98, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x99, 0xE0, 0xFB, 0x0D, ++0xD1, 0x60, 0x90, 0xA4, 0x9A, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x9B, 0xE0, 0xFB, 0xE4, ++0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0x9C, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x9D, 0xE0, ++0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x9E, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x9F, 0xE0, ++0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0xA0, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, ++0xA1, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xA2, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, ++0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0xA4, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, ++0x90, 0xA4, 0xA5, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xA6, 0xE0, 0xFB, 0x0D, 0xC1, 0x45, ++0x90, 0xA4, 0xA7, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0xD1, 0x60, 0x90, 0xA4, 0xA8, 0xE0, 0xFB, 0x0D, ++0xD1, 0x60, 0x90, 0xA4, 0xA9, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xAA, 0xE0, 0xFB, 0x0D, ++0xD1, 0x60, 0x90, 0xA4, 0xAB, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0xAC, 0xE0, ++0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xAD, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xAE, 0xE0, ++0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xAF, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, ++0xB0, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xB1, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, ++0xB2, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xB3, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, ++0x90, 0xA4, 0xB4, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xB5, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, ++0x90, 0xA4, 0xB6, 0xE0, 0xFB, 0x0D, 0xC1, 0x45, 0x90, 0xA4, 0x55, 0xE0, 0xC3, 0x13, 0x54, 0x01, ++0xFB, 0xE4, 0xFD, 0xFF, 0xD1, 0x60, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0x78, 0x18, 0x12, ++0x27, 0x22, 0x90, 0xA6, 0x3E, 0xEF, 0xF0, 0xE0, 0xC3, 0x13, 0xF0, 0x54, 0x1F, 0xF0, 0xFB, 0x7D, ++0x01, 0xE4, 0xFF, 0xD1, 0x60, 0x90, 0xA4, 0x5C, 0x12, 0x4B, 0x50, 0x78, 0x18, 0x12, 0x27, 0x22, ++0x90, 0xA6, 0x3E, 0xEF, 0xF0, 0xE0, 0xC3, 0x13, 0xF0, 0x54, 0x1F, 0xF0, 0xFB, 0x7D, 0x02, 0xE4, ++0xFF, 0xD1, 0x60, 0x90, 0xA4, 0x58, 0x12, 0x4B, 0x50, 0x78, 0x18, 0x12, 0x27, 0x22, 0x90, 0xA6, ++0x3E, 0xEF, 0xF0, 0xE0, 0xC3, 0x13, 0xF0, 0x54, 0x1F, 0xF0, 0xFB, 0x7D, 0x03, 0xE4, 0xFF, 0xD1, ++0x60, 0x90, 0xA4, 0x64, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xC1, 0x45, 0x90, 0xA4, 0x2D, 0xE0, 0xC4, ++0x13, 0x54, 0x01, 0xFB, 0xE4, 0xFD, 0xFF, 0xD1, 0x60, 0x90, 0xA4, 0x38, 0xE0, 0xFB, 0x0D, 0xD1, ++0x60, 0x90, 0xA4, 0x39, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x2F, 0xE0, 0xFB, 0x0D, 0xD1, ++0x60, 0x90, 0xA4, 0x3C, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0x07, 0x78, 0xE0, 0xFB, ++0x0D, 0xD1, 0x60, 0x90, 0x05, 0x22, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, ++0x36, 0xCE, 0x78, 0x18, 0x12, 0x27, 0x22, 0x90, 0xA6, 0x3E, 0xEF, 0xF0, 0xFB, 0x7D, 0x03, 0x7F, ++0x01, 0xD1, 0x60, 0x90, 0xA4, 0x30, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0x31, ++0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x32, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x33, ++0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x34, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, ++0xA4, 0x0D, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, ++0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x4B, 0x88, 0xE0, 0xFB, 0x0D, ++0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, ++0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0x90, 0xA6, 0x58, 0xEF, 0xF0, 0x90, 0x00, 0x8F, ++0xE0, 0x30, 0xE6, 0x63, 0x90, 0x00, 0x8D, 0xE0, 0x64, 0x02, 0x70, 0x5B, 0x90, 0xA6, 0x59, 0xF0, ++0x90, 0xA6, 0x59, 0xE0, 0xFD, 0x90, 0xA6, 0x58, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, ++0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, ++0xE0, 0xFB, 0xE4, 0xFF, 0xD1, 0x60, 0x90, 0xA6, 0x59, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x08, ++0x40, 0xCE, 0x90, 0xA6, 0x59, 0xE0, 0xFD, 0xC3, 0x94, 0x10, 0x50, 0x0D, 0xE4, 0xFB, 0xFF, 0xD1, ++0x60, 0x90, 0xA6, 0x59, 0xE0, 0x04, 0xF0, 0x80, 0xE9, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, ++0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0x90, 0xA4, 0x0E, 0xE0, 0xFF, 0x60, 0x03, 0xB4, ++0x08, 0x0E, 0x12, 0xB9, 0xC2, 0xBF, 0x01, 0x08, 0xF1, 0x11, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0x47, 0xF1, 0x21, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xF1, 0x9F, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0xE4, ++0xFF, 0xF1, 0xCE, 0x90, 0xA2, 0x95, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x54, 0x7F, ++0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x22, 0x90, 0xA2, 0x95, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, ++0x70, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0xA4, 0x15, 0xE0, 0xFD, 0x7F, ++0x93, 0x12, 0x3A, 0x96, 0x90, 0xA4, 0x0C, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, ++0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, ++0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0x7F, 0x01, 0xF1, 0xCE, 0x90, 0x00, 0x90, 0xE0, ++0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x3A, 0x96, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3A, 0xF7, 0x90, ++0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x22, 0x7F, 0x02, 0x90, 0xA4, 0x6D, 0xE0, 0xFE, 0xEF, 0xC3, ++0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, ++0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0x8F, 0x71, ++0xE4, 0x90, 0xA6, 0x54, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, ++0x7F, 0x01, 0xEF, 0x65, 0x71, 0x60, 0x3E, 0xC3, 0x90, 0xA6, 0x55, 0xE0, 0x94, 0x88, 0x90, 0xA6, ++0x54, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA6, ++0x54, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x4A, 0x9F, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, ++0x90, 0xA6, 0x55, 0xE0, 0x94, 0x32, 0x90, 0xA6, 0x54, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, ++0xC6, 0xE0, 0x30, 0xE0, 0xB2, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x49, 0x4E, 0x90, ++0xA5, 0x40, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0xA2, 0x92, 0xE0, 0x60, 0xEA, 0xC2, 0xAF, 0x30, 0xE0, ++0x11, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x66, 0x74, 0x12, 0x9A, 0x61, 0x90, 0xA4, 0x8D, 0xE0, ++0x04, 0xF0, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0xA2, 0x92, 0xE0, 0xFF, 0x30, 0xE1, 0x0B, 0x54, 0xFD, ++0xF0, 0x90, 0xA4, 0x8F, 0xE0, 0x04, 0xF0, 0x11, 0x7E, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0xA2, 0x92, ++0xE0, 0xFF, 0x30, 0xE2, 0x05, 0x54, 0xFB, 0xF0, 0x11, 0xE0, 0xD2, 0xAF, 0x80, 0xB8, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0xEC, 0xE0, 0xFF, 0x90, 0xA2, 0xEB, 0xE0, 0xB5, 0x07, ++0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x41, 0x90, 0xA2, 0xEB, 0xE0, 0xFE, 0x75, ++0xF0, 0x08, 0x90, 0xA2, 0x9B, 0x12, 0x4B, 0x88, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, ++0x9C, 0xF9, 0x74, 0xA2, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x51, 0x7C, 0x90, 0xA2, 0xEB, ++0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, ++0xA2, 0xEB, 0xF0, 0x12, 0x80, 0x45, 0x7F, 0x02, 0x12, 0x63, 0x18, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA3, 0x84, 0xE0, 0xFE, 0x90, 0xA3, ++0x83, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, ++0x48, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x13, 0xED, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xED, 0xF9, 0x74, ++0xA2, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x31, 0x4E, 0x7F, 0x01, 0x90, 0xA3, 0x83, 0xE0, 0x75, 0xF0, ++0x0F, 0xA4, 0x24, 0xED, 0xF9, 0x74, 0xA2, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x31, 0xB1, 0x7F, 0x01, ++0xEF, 0x60, 0x16, 0x90, 0xA3, 0x83, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, 0x02, 0x7F, ++0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA3, 0x83, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x9D, 0x90, 0xA6, 0x2E, 0xE0, 0xFF, ++0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, 0x7F, 0xAF, 0x7E, 0x01, 0x51, 0x26, 0xEF, ++0x60, 0x3A, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x90, 0x00, ++0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x34, ++0x2C, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x90, 0x01, 0xAE, ++0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x37, 0x12, 0x4B, 0x9D, 0x7F, 0x96, ++0x7E, 0x02, 0x51, 0x26, 0xEF, 0x60, 0x5A, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, ++0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, ++0xA6, 0x3A, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0xA6, 0x3A, 0xE0, 0xFD, 0x90, ++0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA6, 0x37, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x0E, 0x12, ++0x26, 0x37, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0x12, 0x81, 0xFA, 0x90, 0xA6, 0x3A, 0xE0, 0x24, ++0x18, 0xFF, 0x90, 0xA6, 0x37, 0x12, 0x4B, 0x94, 0x12, 0x82, 0x55, 0x90, 0x02, 0x96, 0x74, 0x01, ++0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x2F, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xA6, 0x2F, 0xE0, 0xFE, 0xA3, ++0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, 0x2D, 0xC3, 0x90, 0xA6, 0x32, 0xE0, 0x94, 0xE8, 0x90, ++0xA6, 0x31, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, ++0x80, 0x15, 0x90, 0xA6, 0x31, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x4A, 0x9F, 0x7F, 0x0A, 0x7E, 0x00, ++0x12, 0x3A, 0xF7, 0x80, 0xC5, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA5, 0x41, 0x12, ++0x4B, 0x9D, 0xEF, 0x12, 0x4B, 0xA6, 0x5A, 0xBD, 0x00, 0x5A, 0xC6, 0x01, 0x5A, 0xCF, 0x02, 0x5A, ++0xD8, 0x03, 0x5A, 0xE1, 0x04, 0x5A, 0xEA, 0x20, 0x5A, 0xF3, 0x21, 0x5A, 0xFC, 0x23, 0x5B, 0x04, ++0x25, 0x5B, 0x0D, 0x27, 0x5B, 0x15, 0x40, 0x5B, 0x24, 0x42, 0x5B, 0x2D, 0x43, 0x5B, 0x36, 0x60, ++0x5B, 0x3F, 0x64, 0x5B, 0x48, 0x65, 0x5B, 0x50, 0x87, 0x00, 0x00, 0x5B, 0x59, 0x90, 0xA5, 0x41, ++0x12, 0x4B, 0x94, 0x02, 0x78, 0x3C, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x78, 0x84, 0x90, ++0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x79, 0x5A, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0xB8, ++0x10, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x4E, 0xB7, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, ++0x02, 0x79, 0x92, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x7B, 0x21, 0x90, 0xA5, 0x41, 0x12, ++0x4B, 0x94, 0xE1, 0xDC, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x7B, 0x67, 0x90, 0xA5, 0x41, ++0x12, 0x4B, 0x94, 0x80, 0x4C, 0x90, 0xA4, 0x90, 0xE0, 0x04, 0xF0, 0x90, 0xA5, 0x41, 0x12, 0x4B, ++0x94, 0x02, 0xA8, 0xAB, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0xAA, 0x35, 0x90, 0xA5, 0x41, ++0x12, 0x4B, 0x94, 0x02, 0xAA, 0xD6, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x7B, 0xB0, 0x90, ++0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x7F, 0xDC, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0xE1, 0xE4, ++0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x6C, 0xCB, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, ++0x22, 0x12, 0x26, 0x1E, 0x54, 0x01, 0xFF, 0x90, 0xA4, 0x23, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x90, ++0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x24, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, ++0xA4, 0x25, 0xF0, 0x90, 0xA4, 0x24, 0xE0, 0x90, 0xA4, 0x26, 0xF0, 0x90, 0xA4, 0x23, 0xE0, 0x54, ++0x01, 0xFF, 0xAC, 0x07, 0xEF, 0x54, 0x01, 0xFE, 0x90, 0xA4, 0x23, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, ++0xEF, 0x90, 0x01, 0x53, 0xB4, 0x01, 0x12, 0xE4, 0xF0, 0x7D, 0x10, 0x7F, 0x03, 0x12, 0x7E, 0xF9, ++0x90, 0xA4, 0x25, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x74, 0x03, 0xF0, 0x7D, 0x10, 0xFF, 0xF1, ++0xC4, 0x12, 0x8A, 0xAC, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x0C, 0xF0, 0x22, ++0x90, 0xA4, 0x23, 0xE0, 0x30, 0xE0, 0x2D, 0x90, 0xA4, 0x25, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x90, ++0xA4, 0x26, 0xE0, 0x60, 0x04, 0x14, 0xF0, 0x81, 0x7B, 0x90, 0xA4, 0x24, 0xE0, 0x14, 0x90, 0xA4, ++0x26, 0xF0, 0x90, 0x05, 0x73, 0x74, 0x01, 0xF0, 0xE4, 0xFF, 0x71, 0x92, 0x91, 0x05, 0x7D, 0x01, ++0x7F, 0x02, 0x91, 0x09, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, ++0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0xF1, 0x7F, ++0x90, 0xA4, 0x11, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x91, 0x05, 0x12, 0x63, 0xBA, 0x12, 0x86, ++0xFF, 0x80, 0x9D, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, ++0x91, 0x09, 0x7D, 0x02, 0x7F, 0x03, 0x91, 0x09, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0xF0, 0x90, ++0xA4, 0x16, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0xA3, 0x87, 0xE0, 0xB4, 0x01, 0x14, 0x90, ++0xA4, 0x09, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA4, 0x0E, 0xE0, 0x20, 0xE2, 0x0D, 0x7D, 0x01, 0x7F, ++0x04, 0x80, 0x1F, 0x90, 0xA4, 0x09, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, ++0xF0, 0x12, 0x88, 0xCA, 0x90, 0xA4, 0x0E, 0x74, 0x08, 0xF0, 0x22, 0x90, 0xA4, 0x0D, 0xE0, 0xFF, ++0xE4, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x63, 0xED, 0xF0, 0x90, 0xA4, ++0x08, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xA1, 0xDC, 0xEE, 0xC4, 0x13, ++0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x02, 0xA1, 0xDC, 0x90, 0xA4, 0x0E, 0xE0, 0xFE, 0x6F, 0x70, ++0x02, 0xA1, 0xDC, 0xEF, 0x70, 0x02, 0xA1, 0x53, 0x24, 0xFE, 0x70, 0x02, 0xA1, 0x8C, 0x24, 0xFE, ++0x60, 0x49, 0x24, 0xFC, 0x70, 0x02, 0xA1, 0xC7, 0x24, 0xFC, 0x60, 0x02, 0xA1, 0xDC, 0xEE, 0xB4, ++0x0E, 0x02, 0xD1, 0x67, 0x90, 0xA4, 0x0E, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xD1, 0x8F, 0x90, 0xA4, ++0x0E, 0xE0, 0xB4, 0x06, 0x02, 0xD1, 0x41, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x04, 0x0F, 0x90, 0xA6, ++0x63, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x87, 0x71, 0x80, 0x03, 0x12, 0x79, 0x47, 0x90, 0xA4, 0x0E, ++0xE0, 0x64, 0x08, 0x60, 0x02, 0xA1, 0xDC, 0x71, 0xC1, 0xA1, 0xDC, 0x90, 0xA4, 0x0E, 0xE0, 0x70, ++0x04, 0x7F, 0x01, 0xD1, 0x8F, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x06, 0x02, 0xD1, 0x41, 0x90, 0xA4, ++0x0E, 0xE0, 0xB4, 0x0E, 0x07, 0xB1, 0xE1, 0xBF, 0x01, 0x02, 0xD1, 0x67, 0x90, 0xA4, 0x0E, 0xE0, ++0x64, 0x0C, 0x60, 0x02, 0xA1, 0xDC, 0xB1, 0xE1, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xA1, 0xDC, 0xD1, ++0xA9, 0xA1, 0xDC, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x0E, 0x07, 0xB1, 0xE1, 0xBF, 0x01, 0x02, 0xD1, ++0x67, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x06, 0x02, 0xD1, 0x41, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x0C, ++0x07, 0xB1, 0xE1, 0xBF, 0x01, 0x02, 0xD1, 0xA9, 0x90, 0xA4, 0x0E, 0xE0, 0x64, 0x04, 0x70, 0x5C, ++0x12, 0xB9, 0x1B, 0xEF, 0x64, 0x01, 0x70, 0x54, 0xD1, 0xE0, 0x80, 0x50, 0x90, 0xA4, 0x0E, 0xE0, ++0xB4, 0x0E, 0x07, 0xB1, 0xE1, 0xBF, 0x01, 0x02, 0xD1, 0x67, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x06, ++0x02, 0xD1, 0x41, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x0C, 0x07, 0xB1, 0xE1, 0xBF, 0x01, 0x02, 0xD1, ++0xA9, 0x90, 0xA4, 0x0E, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xD1, 0x8F, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, ++0x04, 0x1A, 0x12, 0xB9, 0xF6, 0x80, 0x15, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x0C, 0x0E, 0x90, 0xA4, ++0x09, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0x91, 0x7B, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x90, 0xA4, 0x27, 0xE0, 0x30, 0xE0, 0x13, 0x90, 0xA4, 0x2D, 0xE0, 0xC4, 0x13, 0x54, 0x07, ++0x30, 0xE0, 0x18, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x3D, 0x12, 0xB9, 0x02, 0xEF, 0x64, ++0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2D, 0x90, 0xA4, 0x08, 0xE0, 0x13, ++0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x19, 0x90, ++0xA4, 0x0D, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, ++0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, ++0x22, 0x90, 0xA4, 0x09, 0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, ++0xA4, 0x0E, 0x74, 0x04, 0xF0, 0x80, 0x0A, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x0C, ++0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0xA4, 0x09, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, ++0x90, 0xA4, 0x0E, 0x74, 0x0C, 0xF0, 0x80, 0x11, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, ++0x44, 0x80, 0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, ++0xA6, 0x62, 0xEF, 0xF0, 0x12, 0x8A, 0xAC, 0x90, 0xA6, 0x62, 0xE0, 0x60, 0x05, 0x90, 0x05, 0x22, ++0xE4, 0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x04, 0xF0, 0x22, 0x90, 0xA3, 0x87, 0xE0, 0x64, 0x01, 0x70, ++0x2E, 0x90, 0xA4, 0x09, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x7F, 0x01, ++0x12, 0x84, 0xEB, 0xBF, 0x01, 0x0E, 0x90, 0xA4, 0x08, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA4, 0x0E, ++0x74, 0x0E, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x22, ++0x12, 0x8A, 0x07, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, 0x03, 0x91, 0x09, 0x12, 0x88, ++0xCA, 0xE4, 0x90, 0xA4, 0x0E, 0xF0, 0x22, 0x90, 0xA4, 0x27, 0xE0, 0x20, 0xE0, 0x27, 0x90, 0xA4, ++0x0B, 0xE0, 0x64, 0x01, 0x70, 0x1F, 0xF1, 0xEC, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, 0x60, 0x09, ++0xE4, 0xFD, 0x7F, 0x0C, 0x91, 0x92, 0x02, 0x77, 0xC9, 0x90, 0xA4, 0x0E, 0xE0, 0x70, 0x06, 0x7D, ++0x01, 0x7F, 0x04, 0x91, 0x92, 0x22, 0xEF, 0x70, 0x32, 0x7D, 0x78, 0x7F, 0x02, 0xF1, 0x67, 0x7D, ++0x02, 0x7F, 0x03, 0xF1, 0x67, 0x7D, 0xC8, 0x7F, 0x02, 0xF1, 0xC4, 0x90, 0x01, 0x57, 0xE4, 0xF0, ++0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x7D, 0x01, 0x7F, 0x0C, 0x91, 0x92, 0x90, 0xA4, 0x08, 0xE0, ++0x54, 0xF7, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x81, 0x33, 0x7D, 0x02, 0x7F, ++0x02, 0xF1, 0x67, 0x7D, 0x01, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, ++0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, ++0xA4, 0x0B, 0xE0, 0x60, 0x3E, 0x90, 0xA3, 0x87, 0xE0, 0x64, 0x01, 0x70, 0x36, 0x90, 0xA4, 0x12, ++0xF0, 0x04, 0x60, 0x2F, 0x90, 0xA4, 0x0F, 0xE0, 0x44, 0x10, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, ++0x13, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, ++0x57, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x0E, 0xE0, 0x20, 0xE2, 0x06, 0x7D, 0x01, 0x7F, 0x04, 0x91, ++0x92, 0xF1, 0xEC, 0x22, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, ++0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, ++0xA4, 0x15, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0xA4, 0x64, 0xF0, 0x22, 0x90, 0xA4, 0x21, 0xE0, ++0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x2F, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x26, 0x90, ++0xA4, 0x2A, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x07, 0x90, 0x07, 0x78, 0x74, 0x03, 0xF0, 0x22, ++0x90, 0xA4, 0x21, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x04, 0x74, 0x0D, ++0xF0, 0x22, 0x74, 0x09, 0xF0, 0x22, 0x90, 0xA5, 0xEF, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xFB, 0xA3, ++0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xE4, 0x90, 0xA5, 0xF9, 0xF0, 0xEB, 0x90, 0xA5, 0xF0, ++0xF0, 0x90, 0xA4, 0xB7, 0xE0, 0x70, 0x3D, 0x90, 0xA5, 0xEF, 0xE0, 0x70, 0x17, 0xFF, 0x7E, 0x0C, ++0x12, 0x36, 0xCE, 0xEF, 0x44, 0x04, 0xFF, 0xEC, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, ++0x7E, 0x0C, 0x80, 0x1D, 0x90, 0xA5, 0xEF, 0xE0, 0xB4, 0x01, 0x19, 0x7F, 0x00, 0x7E, 0x0E, 0x12, ++0x36, 0xCE, 0xEF, 0x44, 0x04, 0xFF, 0xEC, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, ++0x0E, 0x12, 0x37, 0x5D, 0x90, 0xA5, 0xF0, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA5, 0xF5, ++0x12, 0x27, 0x48, 0x90, 0xA5, 0xF5, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, ++0xB0, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0xA4, 0xB7, 0xE0, 0x70, 0x26, 0x90, 0xA5, 0xF5, 0x12, ++0x4B, 0x50, 0xEE, 0x44, 0x01, 0xFE, 0xEC, 0x90, 0xA5, 0xF5, 0x12, 0x27, 0x48, 0x90, 0xA5, 0xF5, ++0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, 0x5D, ++0x80, 0x07, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA5, 0xEF, 0xE0, 0x75, 0xF0, 0x08, ++0xA4, 0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0xAF, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, ++0x36, 0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x90, 0xA5, 0xF1, 0x12, 0x27, 0x48, 0x90, 0xA5, ++0xF1, 0x02, 0x4B, 0x50, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, 0x26, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0xA6, 0x1D, ++0x12, 0x4B, 0x50, 0x90, 0xAC, 0x9C, 0x12, 0x27, 0x48, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0x32, 0x65, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, ++0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, ++0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x35, 0xF0, 0x74, 0x61, 0xA3, 0xF0, 0x31, 0x84, 0x74, 0x35, ++0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x61, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, ++0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, ++0xF0, 0xD0, 0xE0, 0x32, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, ++0x33, 0xE5, 0x51, 0x52, 0x53, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x12, ++0x39, 0x33, 0xE5, 0x52, 0x52, 0x54, 0xAB, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, ++0x54, 0x7D, 0x01, 0x7F, 0x01, 0x02, 0x39, 0x04, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, ++0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, ++0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xB8, 0xF0, 0x74, 0x61, 0xA3, 0xF0, 0x51, ++0x07, 0x74, 0xB8, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x61, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, ++0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, ++0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x00, 0x54, 0xE0, 0x55, 0x55, 0xF5, 0x59, 0xA3, ++0xE0, 0x55, 0x56, 0xF5, 0x5A, 0xA3, 0xE0, 0x55, 0x57, 0xF5, 0x5B, 0xA3, 0xE0, 0x55, 0x58, 0xF5, ++0x5C, 0xAD, 0x59, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0xAD, 0x5A, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0xAD, ++0x5B, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0xAD, 0x5C, 0x7F, 0x57, 0x12, 0x3A, 0x96, 0x53, 0x91, 0xEF, ++0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, ++0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, ++0xC4, 0x74, 0x41, 0xF0, 0x74, 0x62, 0xA3, 0xF0, 0x12, 0x82, 0xCE, 0xE5, 0x61, 0x30, 0xE1, 0x02, ++0x71, 0x33, 0xE5, 0x61, 0x30, 0xE4, 0x02, 0x91, 0xC1, 0xE5, 0x63, 0x30, 0xE0, 0x02, 0x71, 0xB7, ++0xE5, 0x63, 0x30, 0xE1, 0x02, 0x91, 0xD5, 0xE5, 0x63, 0x30, 0xE2, 0x03, 0x12, 0x7F, 0x0E, 0xE5, ++0x63, 0x30, 0xE3, 0x03, 0x12, 0x83, 0x2B, 0xE5, 0x63, 0x30, 0xE4, 0x03, 0x12, 0x83, 0x5E, 0xE5, ++0x63, 0x30, 0xE5, 0x03, 0x12, 0x76, 0xE8, 0xE5, 0x63, 0x30, 0xE6, 0x03, 0x12, 0x83, 0x8D, 0xE5, ++0x64, 0x30, 0xE1, 0x03, 0x12, 0x83, 0xA9, 0xE5, 0x64, 0x30, 0xE4, 0x02, 0xD1, 0x6C, 0xE5, 0x64, ++0x30, 0xE5, 0x02, 0xB1, 0x48, 0xE5, 0x64, 0x30, 0xE6, 0x02, 0x51, 0xF2, 0x74, 0x41, 0x04, 0x90, ++0x01, 0xC4, 0xF0, 0x74, 0x62, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, ++0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, ++0xE0, 0x32, 0x90, 0x07, 0x1F, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, ++0xA5, 0x60, 0xF0, 0x90, 0xA5, 0x5E, 0x74, 0x02, 0xF0, 0x90, 0xA5, 0x6C, 0x14, 0xF0, 0xFB, 0x7A, ++0xA5, 0x79, 0x5E, 0x12, 0x6C, 0x61, 0x7F, 0x04, 0x90, 0xA6, 0x5E, 0xEF, 0xF0, 0x7F, 0x02, 0x12, ++0x49, 0x27, 0x90, 0xA2, 0x92, 0xE0, 0xFF, 0x90, 0xA6, 0x5E, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0xA2, ++0x92, 0xF0, 0x22, 0xE4, 0xFF, 0x90, 0xA5, 0x5E, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, 0x1C, ++0xA3, 0xE0, 0xF5, 0x1D, 0x65, 0x1C, 0x60, 0x6E, 0x90, 0xA5, 0x5F, 0x74, 0x03, 0xF0, 0x90, 0xA5, ++0x6D, 0x74, 0x08, 0xF0, 0xE5, 0x1D, 0x04, 0x54, 0x0F, 0xF5, 0x1E, 0xE4, 0xF5, 0x1B, 0xE5, 0x1E, ++0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, ++0x1B, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x61, 0x25, 0x1B, 0xF5, 0x82, ++0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x1B, 0xE5, 0x1B, 0xB4, 0x08, 0xD0, 0x7B, 0x01, ++0x7A, 0xA5, 0x79, 0x5F, 0x12, 0x6C, 0x61, 0xE5, 0x1D, 0x04, 0x54, 0x0F, 0xF5, 0x1D, 0xB4, 0x0F, ++0x03, 0xE4, 0xF5, 0x1D, 0x90, 0x04, 0x7F, 0xE5, 0x1D, 0xF0, 0x90, 0xA5, 0x5E, 0xE0, 0x7F, 0x04, ++0x70, 0x02, 0x81, 0xC6, 0x71, 0x18, 0x22, 0x12, 0xBA, 0x93, 0x90, 0xA6, 0x5C, 0x74, 0x02, 0xF0, ++0x90, 0xA4, 0x27, 0xE0, 0x20, 0xE0, 0x02, 0x81, 0xC0, 0xE4, 0xFF, 0x12, 0x75, 0x89, 0x90, 0xA4, ++0x2B, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x8A, 0xAC, 0x90, 0xA4, 0x27, ++0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x08, 0x90, 0x07, 0x78, 0x74, 0x0D, 0xF0, ++0x80, 0x2D, 0x90, 0xA4, 0x2A, 0xE0, 0xFE, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x0D, 0xEE, 0x13, 0x13, ++0x54, 0x3F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x0F, 0x80, 0x12, 0x90, 0xA4, 0x2A, 0xE0, 0xFE, 0xC3, ++0x13, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x09, 0xF0, 0xEF, ++0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA6, 0x5D, 0xF0, 0x80, 0x06, ++0x90, 0xA6, 0x5D, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, ++0x13, 0x90, 0xA4, 0x64, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0xA6, 0x5C, 0xF0, 0x80, 0x06, 0x90, 0xA6, ++0x5C, 0x74, 0x01, 0xF0, 0x90, 0xA6, 0x5C, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x75, 0xCC, 0x90, ++0xA4, 0x38, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, ++0x07, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x80, 0x26, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1F, 0x90, ++0xA4, 0x2D, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0xA4, 0x22, 0xE0, 0x60, 0x06, 0x7D, 0x01, 0x7F, 0x04, ++0x80, 0x09, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x5C, 0x92, 0x90, 0xA4, ++0x22, 0xE0, 0x90, 0x05, 0x22, 0x60, 0x05, 0x74, 0x6F, 0xF0, 0x80, 0x02, 0xE4, 0xF0, 0x90, 0xA4, ++0x2A, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0xB4, 0xA0, ++0x22, 0x12, 0x80, 0x45, 0x7F, 0x02, 0x8F, 0x70, 0x7F, 0x02, 0x12, 0x49, 0x27, 0x90, 0xA2, 0x92, ++0xE0, 0x45, 0x70, 0xF0, 0x22, 0x12, 0xB7, 0x75, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x46, 0x90, 0xA4, ++0x09, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x13, 0x90, 0x01, 0x3B, 0xE0, 0x30, ++0xE4, 0x0C, 0x12, 0x5F, 0x5D, 0x90, 0xA4, 0x11, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0xA6, ++0x4C, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x4A, 0x9F, 0xC3, 0x90, 0xA6, 0x4D, 0xE0, 0x94, 0x80, 0x90, ++0xA6, 0x4C, 0xE0, 0x64, 0x80, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, ++0xE0, 0x44, 0x01, 0xF0, 0x12, 0x87, 0x34, 0x12, 0x86, 0xFF, 0x7F, 0x01, 0x91, 0xC6, 0x90, 0xA4, ++0x23, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0B, 0x12, 0x5F, 0x5D, 0x90, ++0xA4, 0x25, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x90, 0xA4, 0x8C, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, ++0x1B, 0x90, 0x04, 0x30, 0xE0, 0xB4, 0x01, 0x06, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0x74, 0x87, ++0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0x70, 0x02, 0xC1, 0x60, 0xE5, 0x1B, ++0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0xE5, 0x1B, 0x54, 0x07, 0xFE, 0x74, 0x81, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0xFD, 0xAF, 0x06, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, ++0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0xC1, 0x60, ++0x75, 0xF0, 0x10, 0xE5, 0x1B, 0x90, 0x81, 0x01, 0x12, 0x4B, 0x88, 0xE0, 0x20, 0xE7, 0x02, 0x80, ++0x10, 0x75, 0xF0, 0x10, 0xE5, 0x1B, 0x90, 0x81, 0x02, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x20, 0xE7, ++0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x20, 0xF0, 0xC1, 0x60, 0xEF, 0x30, 0xE6, 0x2B, 0x90, 0xA4, ++0x89, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x1B, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE0, ++0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x1B, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0x13, 0x13, 0x54, ++0x03, 0x90, 0xA6, 0x07, 0xF0, 0xE4, 0xFB, 0x80, 0x62, 0x90, 0xA4, 0x8A, 0xE0, 0x04, 0xF0, 0x74, ++0x12, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x74, 0x12, 0x25, ++0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0xD3, 0x94, 0x03, 0x40, 0x14, 0xAF, 0x1B, ++0x12, 0x96, 0x52, 0x74, 0x12, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE4, 0xF0, ++0x80, 0x2E, 0x90, 0x9D, 0x92, 0x74, 0x03, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x1B, 0x90, 0x81, 0x00, ++0x12, 0x4B, 0x88, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x1B, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, ++0xE0, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA6, 0x07, 0xF0, 0x7B, 0x01, 0xAF, 0x1B, 0x12, 0x68, 0xCD, ++0x05, 0x1B, 0xE5, 0x1B, 0xC3, 0x94, 0x80, 0x50, 0x02, 0xA1, 0x51, 0x22, 0x90, 0xA4, 0x8B, 0xE0, ++0x04, 0xF0, 0xE4, 0xFF, 0x90, 0xA4, 0xB8, 0xEF, 0xF0, 0xE4, 0xF5, 0x25, 0x74, 0xB9, 0x25, 0x25, ++0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, ++0x03, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x30, 0xE7, 0x10, 0xE5, 0x25, 0x70, 0x1F, 0xEF, 0x30, 0xE6, ++0x1B, 0x90, 0xA4, 0x88, 0xE0, 0x04, 0xF0, 0x80, 0x13, 0xAF, 0x25, 0x12, 0xAB, 0xCF, 0x74, 0xB9, ++0x25, 0x25, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x05, 0x25, 0xE5, 0x25, ++0xC3, 0x94, 0x80, 0x40, 0xB7, 0x7F, 0x0C, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xE4, 0xF5, 0x25, 0x74, ++0xB9, 0x25, 0x25, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, 0x68, 0x33, ++0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, 0x06, 0x12, 0x4B, 0x88, 0xE0, 0xF5, 0x23, 0x75, 0xF0, ++0x10, 0xE5, 0x25, 0x90, 0x81, 0x07, 0x12, 0x4B, 0x88, 0xE0, 0xF5, 0x24, 0xFE, 0xE5, 0x23, 0xFF, ++0xE5, 0x25, 0x25, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, 0x0A, 0x12, 0x4B, 0x88, 0xE0, 0xF5, 0x23, ++0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, 0x0B, 0x12, 0x4B, 0x88, 0xE0, 0xF5, 0x24, 0xFE, 0xE5, ++0x23, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x25, 0x90, 0x8D, 0x01, 0x12, 0x4B, 0x88, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, 0x0C, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, ++0xF0, 0x0A, 0xE5, 0x25, 0x90, 0x8D, 0x03, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, ++0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, 0x0D, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, ++0x25, 0x90, 0x8D, 0x05, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, ++0x25, 0x90, 0x81, 0x0E, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x25, 0x90, 0x8D, ++0x07, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, ++0x0F, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x25, 0x90, 0x8D, 0x09, 0x12, 0x4B, ++0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, 0x09, 0x12, 0x4B, ++0x88, 0xE0, 0xFF, 0x74, 0x12, 0x25, 0x25, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xEF, 0xF0, ++0xE5, 0x25, 0x70, 0x56, 0xE5, 0x24, 0x30, 0xE7, 0x05, 0x90, 0xA4, 0x87, 0x80, 0x49, 0xE5, 0x24, ++0x30, 0xE6, 0x05, 0x90, 0xA4, 0x86, 0x80, 0x3F, 0xE5, 0x24, 0x30, 0xE5, 0x05, 0x90, 0xA4, 0x85, ++0x80, 0x35, 0xE5, 0x24, 0x30, 0xE4, 0x05, 0x90, 0xA4, 0x84, 0x80, 0x2B, 0xE5, 0x24, 0x30, 0xE3, ++0x05, 0x90, 0xA4, 0x83, 0x80, 0x21, 0xE5, 0x24, 0x30, 0xE2, 0x05, 0x90, 0xA4, 0x82, 0x80, 0x17, ++0xE5, 0x24, 0x30, 0xE1, 0x05, 0x90, 0xA4, 0x81, 0x80, 0x0D, 0xE5, 0x24, 0x30, 0xE0, 0x05, 0x90, ++0xA4, 0x80, 0x80, 0x03, 0x90, 0xA4, 0x7F, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0xB8, 0xE0, 0xFD, 0xAF, ++0x25, 0x11, 0x40, 0x05, 0x25, 0xE5, 0x25, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x66, 0xCF, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x62, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, ++0x01, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x03, 0x12, ++0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x05, 0x12, 0x4B, 0x88, ++0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x07, 0x12, 0x4B, 0x88, 0xE4, 0xF0, ++0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x09, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, ++0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, ++0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xEF, ++0x90, 0x81, 0x03, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0x75, 0xF0, 0x10, 0xEF, ++0x90, 0x81, 0x03, 0x12, 0x4B, 0x88, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x04, 0xEF, 0xF0, 0x90, 0xA6, 0x06, 0xEB, 0xF0, 0x90, 0xA6, ++0x05, 0xED, 0xF0, 0xE4, 0x90, 0xA6, 0x0C, 0xF0, 0x90, 0xA6, 0x04, 0xE0, 0xFF, 0x13, 0x13, 0x13, ++0x54, 0x1F, 0x90, 0xA6, 0x08, 0xF0, 0xEF, 0x54, 0x07, 0x90, 0xA6, 0x0A, 0xF0, 0x90, 0xA6, 0x04, ++0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x01, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA6, 0x0B, 0xF0, 0xED, ++0x54, 0x7F, 0x90, 0xA6, 0x09, 0xF0, 0xFB, 0x25, 0xE0, 0x24, 0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x43, ++0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, 0x04, 0xEB, ++0x90, 0x42, 0x3B, 0x12, 0x4B, 0x88, 0x12, 0x4B, 0x78, 0x12, 0x4B, 0x18, 0x78, 0x01, 0x12, 0x27, ++0x22, 0x90, 0xA6, 0x04, 0xE0, 0xFD, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, ++0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA6, 0x05, 0xE0, 0xB4, 0x3F, 0x18, 0x75, 0xF0, 0x04, ++0xED, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x06, 0x90, ++0xA6, 0x05, 0x74, 0xBE, 0xF0, 0x90, 0xA6, 0x05, 0xE0, 0xB4, 0x34, 0x18, 0x75, 0xF0, 0x04, 0xED, ++0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x06, 0x90, 0xA6, ++0x05, 0x74, 0xB3, 0xF0, 0x90, 0xA6, 0x05, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0x90, 0xA6, 0x09, 0xF0, ++0xEF, 0x54, 0x80, 0xFF, 0xEE, 0xD3, 0x94, 0x35, 0x50, 0x08, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x02, ++0x80, 0x10, 0x90, 0xA6, 0x09, 0xE0, 0xFE, 0xD3, 0x94, 0x13, 0x50, 0x0E, 0xEE, 0xC3, 0x94, 0x0C, ++0x40, 0x08, 0x90, 0xA6, 0x0C, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA6, 0x0C, 0xF0, 0x90, ++0xA6, 0x04, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFE, 0x20, 0xE2, ++0x02, 0x41, 0xAC, 0x90, 0xA6, 0x06, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x41, 0xAC, 0xEE, 0x30, 0xE7, ++0x02, 0x41, 0x99, 0x90, 0xA6, 0x09, 0xE0, 0xFE, 0x64, 0x3F, 0x60, 0x05, 0xEE, 0x64, 0x3E, 0x70, ++0x64, 0xEF, 0x60, 0x61, 0x90, 0xA6, 0x04, 0xE0, 0xFB, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x94, 0x12, ++0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x4B, 0x90, 0xA6, 0x0C, 0xE0, 0xFD, 0x90, ++0xA6, 0x05, 0xE0, 0x90, 0xA5, 0x7F, 0xF0, 0xE4, 0xFF, 0x91, 0x03, 0x90, 0xA6, 0x04, 0xE0, 0xFF, ++0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA6, 0x05, ++0xE0, 0xFE, 0x74, 0x01, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0xA6, ++0x04, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0x90, 0xA6, 0x05, 0xF0, ++0xE4, 0xA3, 0xF0, 0x80, 0x5B, 0x90, 0xA6, 0x04, 0xE0, 0xFB, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, ++0x9A, 0xF5, 0x83, 0xE0, 0x90, 0xA6, 0x0C, 0x30, 0xE2, 0x0E, 0xE0, 0xFD, 0x90, 0xA6, 0x05, 0xE0, ++0x90, 0xA5, 0x7F, 0xF0, 0x7F, 0x01, 0x80, 0x36, 0xE0, 0xFD, 0x90, 0xA6, 0x04, 0xE0, 0xFB, 0xA3, ++0xE0, 0x90, 0xA5, 0x7F, 0xF0, 0xE4, 0xFF, 0x80, 0x25, 0x90, 0xA6, 0x04, 0xE0, 0x24, 0x92, 0xF5, ++0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x14, 0x90, 0xA6, 0x0C, 0xE0, ++0xFD, 0x90, 0xA6, 0x04, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0xA5, 0x7F, 0xF0, 0xE4, 0xFF, 0x91, 0x03, ++0x90, 0xA6, 0x04, 0xE0, 0xFC, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xC4, ++0x54, 0x03, 0x70, 0x32, 0x90, 0xA6, 0x09, 0xE0, 0xFE, 0xC3, 0x94, 0x14, 0x40, 0x15, 0xEE, 0xD3, ++0x94, 0x18, 0x50, 0x0F, 0x90, 0x04, 0x33, 0x74, 0x06, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, ++0xA3, 0x80, 0x0F, 0x90, 0x04, 0x33, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0xA3, 0x04, 0xF0, ++0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0x90, 0xA6, 0x06, 0xE0, 0x70, 0x39, 0x90, 0x04, 0xCF, 0x74, ++0x30, 0xF0, 0x90, 0xA6, 0x08, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xC0, ++0x83, 0xC0, 0x82, 0xE0, 0xFE, 0x90, 0xA6, 0x0A, 0xE0, 0xFD, 0x74, 0x01, 0xA8, 0x05, 0x08, 0x80, ++0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA6, 0x0B, 0xE0, ++0x54, 0x7F, 0xF0, 0x80, 0x6B, 0x74, 0x92, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, ++0x90, 0x04, 0xCF, 0x30, 0xE0, 0x05, 0x74, 0x20, 0xF0, 0x80, 0x02, 0xE4, 0xF0, 0x90, 0xA6, 0x08, ++0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, ++0x90, 0xA6, 0x0A, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, ++0x4F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA6, 0x04, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x01, ++0x12, 0x4B, 0x88, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0xA6, 0x0B, 0xF0, 0x90, 0xA6, 0x09, 0xE0, 0x90, ++0x44, 0x3F, 0x93, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x4F, 0x90, 0xA6, 0x0B, 0xF0, 0x44, 0x80, 0xF0, ++0x90, 0xA6, 0x05, 0xE0, 0xFF, 0x90, 0xA6, 0x04, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, ++0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x90, 0xA6, 0x0B, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, ++0x01, 0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x05, 0x12, 0x4B, 0x88, ++0xE0, 0x54, 0xFC, 0xFF, 0x90, 0xA6, 0x07, 0xE0, 0x4F, 0xFE, 0x90, 0xA6, 0x04, 0xE0, 0xFF, 0x75, ++0xF0, 0x10, 0x90, 0x81, 0x05, 0x12, 0x4B, 0x88, 0xEE, 0xF0, 0x7D, 0x01, 0x11, 0x40, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x90, 0xA5, 0x7E, 0xEB, 0xF0, 0x70, 0x56, 0x90, 0xA5, 0x7E, 0xE0, 0xFE, 0x24, ++0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0xFC, 0x90, 0xA5, 0x7F, 0xE0, 0xFB, 0xEC, ++0x6B, 0x60, 0x3D, 0x90, 0xA5, 0x82, 0xEB, 0xF0, 0xA3, 0xEE, 0xF0, 0xAE, 0x05, 0xEE, 0x25, 0xE0, ++0x4F, 0xA3, 0xF0, 0x90, 0xA5, 0x80, 0x74, 0x0C, 0xF0, 0x90, 0xA5, 0x8E, 0x74, 0x03, 0xF0, 0x7B, ++0x01, 0x7A, 0xA5, 0x79, 0x80, 0x91, 0x61, 0x7F, 0x04, 0x12, 0x63, 0x18, 0x90, 0xA5, 0x7F, 0xE0, ++0xFF, 0x90, 0xA5, 0x7E, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xEF, 0xF0, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x83, 0xE0, 0xFF, 0x70, 0x06, 0xA3, ++0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA3, 0x84, 0xE0, 0xB5, 0x07, 0x04, 0x7F, ++0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, ++0x35, 0xC0, 0x01, 0x90, 0xA3, 0x84, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xED, 0xF9, 0x74, 0xA2, ++0x35, 0xF0, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x4A, 0x79, ++0x90, 0xA3, 0x84, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, ++0x05, 0xE4, 0x90, 0xA3, 0x84, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA5, 0x44, 0x12, 0x4B, ++0x9D, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x02, 0x12, 0x26, ++0x37, 0x90, 0xA6, 0x29, 0xF0, 0xE4, 0xFB, 0xFD, 0xB1, 0x10, 0x90, 0xA5, 0x47, 0x74, 0x10, 0xF0, ++0x90, 0xA5, 0x55, 0x74, 0x07, 0xF0, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x12, 0x26, 0x1E, 0x90, ++0xA5, 0x49, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x47, 0x91, 0x61, 0x7F, 0x04, 0x02, 0x63, 0x18, ++0x90, 0xA6, 0x27, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA6, 0x26, 0xEF, 0xF0, 0x90, 0xA6, 0x29, ++0xE0, 0xFD, 0x12, 0xB1, 0x96, 0x90, 0xA6, 0x26, 0xE0, 0xC3, 0x94, 0x0E, 0x50, 0x48, 0x90, 0xA5, ++0xA4, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x12, 0xD4, ++0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, ++0x07, 0x03, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0xAF, 0xE7, ++0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, ++0x00, 0x00, 0x00, 0x00, 0xC1, 0xC3, 0x90, 0xA6, 0x26, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, ++0x1B, 0xEF, 0x94, 0x30, 0x50, 0x16, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, ++0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x09, 0x28, 0x00, 0x00, 0x80, 0x70, 0x90, 0xA6, 0x26, 0xE0, ++0xFF, 0x74, 0x32, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x40, 0x50, 0x16, 0x90, 0xA5, 0xA4, 0x12, ++0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x08, 0xA6, 0x00, 0x00, ++0x80, 0x4A, 0x90, 0xA6, 0x26, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x74, ++0x50, 0x16, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, ++0x27, 0x54, 0x08, 0xA4, 0x00, 0x00, 0x80, 0x24, 0x90, 0xA6, 0x26, 0xE0, 0xFF, 0x74, 0x76, 0xD3, ++0x9F, 0x50, 0x20, 0xEF, 0x94, 0xA5, 0x50, 0x1B, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x1F, 0xFE, ++0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x08, 0x24, 0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, ++0x12, 0xAD, 0x45, 0x90, 0xA6, 0x26, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, 0x32, 0xEF, 0x94, ++0x40, 0x50, 0x2D, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0x96, ++0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0x12, 0xAF, 0xE7, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, ++0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0x80, 0x73, ++0x90, 0xA6, 0x26, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x32, 0xEF, 0x94, 0x8C, 0x50, 0x2D, ++0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, ++0x00, 0x03, 0x01, 0x00, 0x12, 0xAF, 0xE7, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, ++0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, 0x00, 0x03, 0x01, 0x00, 0x80, 0x36, 0x90, 0xA6, 0x26, ++0xE0, 0xFF, 0x74, 0x8C, 0xC3, 0x9F, 0x50, 0x34, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x07, ++0x03, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, 0x00, 0x05, 0x01, 0x00, 0x12, 0xAF, 0xE7, 0x90, ++0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, 0x00, ++0x05, 0x01, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0x12, 0xAF, 0xED, 0x90, 0xA6, 0x27, 0xE0, ++0x64, 0x02, 0x70, 0x66, 0x90, 0xA6, 0x26, 0xE0, 0xFF, 0xD3, 0x94, 0x30, 0x50, 0x08, 0x90, 0xA6, ++0x2A, 0x74, 0x2A, 0xF0, 0x80, 0x70, 0xEF, 0xD3, 0x94, 0x40, 0x50, 0x08, 0x90, 0xA6, 0x2A, 0x74, ++0x3A, 0xF0, 0x80, 0x62, 0xEF, 0xD3, 0x94, 0x70, 0x50, 0x08, 0x90, 0xA6, 0x2A, 0x74, 0x6A, 0xF0, ++0x80, 0x54, 0xEF, 0xD3, 0x94, 0x80, 0x50, 0x08, 0x90, 0xA6, 0x2A, 0x74, 0x7A, 0xF0, 0x80, 0x46, ++0xEF, 0xD3, 0x94, 0x90, 0x50, 0x08, 0x90, 0xA6, 0x2A, 0x74, 0x8A, 0xF0, 0x80, 0x38, 0xEF, 0xD3, ++0x94, 0xA1, 0x50, 0x08, 0x90, 0xA6, 0x2A, 0x74, 0x9B, 0xF0, 0x80, 0x2A, 0xEF, 0xD3, 0x94, 0xB1, ++0x50, 0x24, 0x90, 0xA6, 0x2A, 0x74, 0xAB, 0xF0, 0x80, 0x1C, 0x90, 0xA6, 0x27, 0xE0, 0x64, 0x01, ++0x70, 0x33, 0xA3, 0xE0, 0x90, 0xA6, 0x26, 0xB4, 0x01, 0x05, 0xE0, 0x24, 0x02, 0x80, 0x03, 0xE0, ++0x24, 0xFE, 0x90, 0xA6, 0x2A, 0xF0, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, ++0x90, 0xA6, 0x2A, 0x12, 0xAF, 0xDB, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, ++0x90, 0xA6, 0x2A, 0x80, 0x1D, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, ++0xA6, 0x26, 0x12, 0xAF, 0xDB, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, ++0xA6, 0x26, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x48, 0x7D, 0x18, ++0x7C, 0x00, 0x7F, 0x01, 0x02, 0xAF, 0xED, 0x90, 0xA5, 0xC3, 0x74, 0x08, 0xF0, 0x90, 0xA5, 0xD1, ++0x74, 0x01, 0xF0, 0x90, 0xA5, 0xC5, 0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0xC3, 0x81, 0x61, ++0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, ++0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, ++0x74, 0xC0, 0xF0, 0x74, 0x6F, 0xA3, 0xF0, 0x12, 0x82, 0xFB, 0xE5, 0x69, 0x30, 0xE0, 0x03, 0x12, ++0x70, 0x51, 0xE5, 0x69, 0x30, 0xE1, 0x03, 0x12, 0x76, 0xA1, 0xE5, 0x69, 0x30, 0xE2, 0x02, 0xD1, ++0xAB, 0xE5, 0x6A, 0x30, 0xE0, 0x03, 0x12, 0x83, 0xB3, 0xE5, 0x6C, 0x30, 0xE1, 0x05, 0x7F, 0x04, ++0x12, 0x64, 0xC6, 0xE5, 0x6C, 0x30, 0xE4, 0x03, 0x12, 0x5C, 0x1E, 0xE5, 0x6C, 0x30, 0xE5, 0x03, ++0x12, 0x84, 0x44, 0xE5, 0x6C, 0x30, 0xE6, 0x03, 0x12, 0x87, 0xB2, 0x74, 0xC0, 0x04, 0x90, 0x01, ++0xC4, 0xF0, 0x74, 0x6F, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, ++0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, ++0x32, 0x90, 0xA5, 0x6F, 0x74, 0x02, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0x20, 0xE0, 0x02, 0xA1, 0x88, ++0x12, 0xB5, 0x3B, 0x90, 0xA4, 0x39, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x21, 0x3E, 0xF5, 0x3B, 0x75, ++0x3C, 0x03, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x53, 0x74, 0x05, ++0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x54, 0x0F, 0x90, 0xA4, 0x39, 0x30, 0xE0, 0x05, 0x74, 0x05, ++0xF0, 0x80, 0x03, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, ++0x0F, 0x90, 0xA4, 0x28, 0xE0, 0xFF, 0x90, 0xA4, 0x37, 0xE0, 0xC3, 0x9F, 0x90, 0xA4, 0x3D, 0xF0, ++0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x28, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, ++0x13, 0x54, 0x07, 0x30, 0xE0, 0x6D, 0x90, 0xA4, 0x3D, 0xE0, 0xC3, 0x94, 0x20, 0x50, 0x0A, 0xE0, ++0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xE4, 0xFD, 0x80, 0x05, 0x7B, 0x7F, 0x7D, 0xFF, 0xE4, 0xFF, 0xF1, ++0x1B, 0x80, 0x50, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x40, 0x90, 0xA4, 0x2D, ++0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x5C, 0x92, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, ++0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x26, 0x90, 0xA4, 0x2E, 0xE0, 0x44, 0x02, 0xF0, 0x54, 0xFB, ++0xF0, 0xE4, 0x90, 0xA4, 0x3C, 0xF0, 0x90, 0xA4, 0x39, 0xF0, 0x90, 0xA4, 0x2F, 0x74, 0x06, 0xF0, ++0x90, 0xA4, 0x22, 0xE0, 0x60, 0x07, 0x90, 0xA4, 0x2E, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x05, 0x22, ++0x74, 0x6F, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0x20, 0xE0, 0x02, 0xA1, 0x88, 0x81, 0xB0, 0x90, 0xA4, ++0x39, 0xE0, 0x64, 0x02, 0x60, 0x02, 0x41, 0x33, 0x7F, 0x01, 0xB1, 0x89, 0x90, 0xA4, 0x2B, 0xE0, ++0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x09, 0x12, 0x8A, 0x07, 0xBF, 0x01, 0x03, 0x12, 0x88, ++0xCA, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x90, 0x07, 0x78, 0x30, 0xE0, ++0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x28, 0xE0, ++0x24, 0x03, 0xFF, 0x90, 0xA4, 0x37, 0xE0, 0xC3, 0x9F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x50, ++0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x53, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xC3, ++0x13, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA5, 0x6E, 0xF0, 0x80, 0x06, 0x90, 0xA5, 0x6E, 0x74, 0x01, ++0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x13, 0x90, 0xA4, 0x64, 0xE0, ++0x60, 0x08, 0x90, 0xA5, 0x6F, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA5, 0x6F, 0xF0, 0xB1, ++0xC2, 0xE4, 0x90, 0xA4, 0x38, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x13, ++0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x29, 0x90, 0xA4, 0x27, ++0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x10, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, ++0xE0, 0x0E, 0x12, 0x5C, 0x8B, 0x80, 0x09, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x09, 0x12, 0x5C, 0x8B, ++0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x05, 0x22, ++0xE4, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x20, 0xE0, 0x02, 0xA1, ++0x88, 0xA1, 0x83, 0x90, 0xA4, 0x39, 0xE0, 0x64, 0x03, 0x60, 0x02, 0x61, 0xE6, 0xFF, 0xB1, 0x89, ++0x90, 0xA4, 0x2B, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x8A, 0xAC, 0x90, ++0xA4, 0x27, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x08, 0x90, 0x07, 0x78, 0x74, 0x0D, ++0xF0, 0x80, 0x14, 0x90, 0xA4, 0x2A, 0xE0, 0xC3, 0x13, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, ++0x03, 0xF0, 0x80, 0x03, 0x74, 0x09, 0xF0, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, ++0x20, 0xE0, 0x02, 0x61, 0x0A, 0x90, 0xA4, 0x31, 0xE0, 0xFF, 0x90, 0xA4, 0x3B, 0xE0, 0xD3, 0x9F, ++0x40, 0x4D, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0xFF, 0x90, 0xA4, 0x33, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, ++0xFF, 0x24, 0x03, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0xA4, 0x29, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, ++0xF8, 0x74, 0x80, 0x98, 0x40, 0x08, 0xE0, 0x9F, 0x90, 0xA5, 0x70, 0xF0, 0x80, 0x06, 0x90, 0xA5, ++0x70, 0x74, 0x03, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA5, 0x70, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, ++0x7F, 0x50, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0xA4, 0x39, 0xE0, 0x04, 0xF0, 0x80, 0x24, 0xE4, ++0xF5, 0x3B, 0x90, 0xA4, 0x34, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, ++0x34, 0x8C, 0x90, 0xA4, 0x2F, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA4, 0x39, 0xF0, 0x90, 0x06, 0x92, ++0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA4, 0x3B, 0xF0, 0x80, 0x19, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x29, ++0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0xA4, 0x39, ++0xE0, 0x04, 0xF0, 0x90, 0x01, 0x53, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x13, 0x13, ++0x13, 0x54, 0x01, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA5, 0x6E, 0xF0, 0x80, 0x06, 0x90, 0xA5, 0x6E, ++0x74, 0x01, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x13, 0x90, 0xA4, ++0x64, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0xA5, 0x6F, 0xF0, 0x80, 0x06, 0x90, 0xA5, 0x6F, 0x74, 0x01, ++0xF0, 0xB1, 0xC2, 0x90, 0xA4, 0x38, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x13, 0x54, ++0x07, 0x20, 0xE0, 0x33, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1C, 0x90, 0xA4, ++0x2D, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0xA4, 0x22, 0xE0, 0x60, 0x04, 0x7D, 0x01, 0x80, 0x13, 0x90, ++0x05, 0x22, 0xE4, 0xF0, 0x7D, 0x01, 0x7F, 0x0C, 0x80, 0x0A, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x07, ++0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x5C, 0x92, 0x90, 0xA4, 0x22, 0xE0, 0x60, 0x08, 0x90, 0x05, 0x22, ++0x74, 0x6F, 0xF0, 0x80, 0x1E, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x0E, ++0x90, 0xA4, 0x27, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0xD1, 0xC4, 0x90, 0x05, ++0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x20, 0xE0, 0x02, ++0xA1, 0x88, 0x7F, 0x01, 0xA1, 0x85, 0x90, 0xA4, 0x39, 0xE0, 0x64, 0x04, 0x60, 0x02, 0x81, 0xB6, ++0xF5, 0x3B, 0x75, 0x3C, 0x03, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, ++0x53, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x39, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, ++0x54, 0x07, 0x30, 0xE0, 0x0F, 0x90, 0xA4, 0x29, 0xE0, 0xFF, 0x90, 0xA4, 0x37, 0xE0, 0xC3, 0x9F, ++0x90, 0xA4, 0x3D, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x28, 0x90, ++0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x6D, 0x90, 0xA4, 0x3D, 0xE0, 0xC3, 0x94, ++0x20, 0x50, 0x0A, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xE4, 0xFD, 0x80, 0x05, 0x7B, 0x7F, 0x7D, ++0xFF, 0xE4, 0xFF, 0xF1, 0x1B, 0x80, 0x50, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, ++0x40, 0x90, 0xA4, 0x2D, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x5C, 0x92, 0x90, ++0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x26, 0x90, 0xA4, 0x2E, 0xE0, 0x44, ++0x02, 0xF0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA4, 0x3C, 0xF0, 0x90, 0xA4, 0x39, 0xF0, 0x90, 0xA4, ++0x2F, 0x74, 0x07, 0xF0, 0x90, 0xA4, 0x22, 0xE0, 0x60, 0x07, 0x90, 0xA4, 0x2E, 0xE0, 0x44, 0x04, ++0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0x20, 0xE0, 0x02, 0xA1, 0x88, ++0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x64, 0x05, 0x60, 0x02, 0xA1, 0x88, ++0x7F, 0x01, 0xB1, 0x89, 0x90, 0xA4, 0x2B, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x09, ++0x12, 0x8A, 0x07, 0xBF, 0x01, 0x03, 0x12, 0x88, 0xCA, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x13, ++0x13, 0x54, 0x01, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x01, ++0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA5, 0x6E, 0xF0, 0x80, ++0x06, 0x90, 0xA5, 0x6E, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, ++0xE0, 0x13, 0x90, 0xA4, 0x64, 0xE0, 0x60, 0x08, 0x90, 0xA5, 0x6F, 0x74, 0x01, 0xF0, 0x80, 0x05, ++0xE4, 0x90, 0xA5, 0x6F, 0xF0, 0xB1, 0xC2, 0xE4, 0x90, 0xA4, 0x38, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, ++0x27, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, ++0x29, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x10, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, ++0x13, 0x54, 0x07, 0x20, 0xE0, 0x0E, 0x12, 0x5C, 0x8B, 0x80, 0x09, 0x90, 0xA4, 0x0B, 0xE0, 0x60, ++0x09, 0x12, 0x5C, 0x8B, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0x30, 0xE0, ++0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, ++0x30, 0xE0, 0x05, 0xE4, 0xFF, 0x12, 0xB4, 0xA0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0xEF, 0xB4, 0x03, 0x13, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0x06, 0xCC, ++0x30, 0xE0, 0x17, 0xE4, 0xF0, 0x80, 0x16, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, ++0x0C, 0xEF, 0x90, 0x06, 0xCC, 0x70, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x03, 0xF0, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0xA5, 0x6F, 0xE0, 0xFF, 0x90, 0xA5, 0x6E, 0xE0, 0xFD, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0xFB, 0xED, 0xF0, 0x90, 0xA5, 0xFA, 0xEF, 0xF0, 0x64, 0x02, 0x60, ++0x43, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEC, 0x54, 0xF3, 0xFC, 0x90, 0xA5, 0xFC, 0x12, ++0x27, 0x48, 0x90, 0xA5, 0xFA, 0xE0, 0x90, 0xA5, 0xFC, 0xB4, 0x01, 0x08, 0x12, 0x4B, 0x50, 0xEC, ++0x44, 0x08, 0x80, 0x06, 0x12, 0x4B, 0x50, 0xEC, 0x44, 0x04, 0xFC, 0x90, 0xA5, 0xFC, 0x12, 0x27, ++0x48, 0x90, 0xA5, 0xFC, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB4, 0x7E, ++0x0C, 0x12, 0x37, 0x5D, 0x90, 0xA5, 0xFB, 0xE0, 0x64, 0x02, 0x60, 0x70, 0x7F, 0xB0, 0x7E, 0x0C, ++0x12, 0x36, 0xCE, 0xE4, 0xFC, 0x90, 0xA5, 0xFC, 0x12, 0x27, 0x48, 0x90, 0xA5, 0xFB, 0xE0, 0x70, ++0x10, 0xA3, 0x12, 0x4B, 0x50, 0xEC, 0x44, 0x77, 0xFC, 0x90, 0xA5, 0xFC, 0x12, 0x27, 0x48, 0x80, ++0x38, 0x90, 0xA5, 0xFC, 0x12, 0x4B, 0x50, 0xEC, 0x44, 0x66, 0xFC, 0x90, 0xA5, 0xFC, 0x12, 0x27, ++0x48, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEC, 0x54, 0xF3, 0xFC, 0xEC, 0x44, 0x08, 0xFC, ++0x90, 0xA6, 0x00, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x00, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, ++0x27, 0x48, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xA5, 0xFC, 0x12, 0x4B, 0x50, 0x90, ++0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x03, 0x12, 0xBB, 0x29, 0x22, 0x90, 0xA4, 0x0B, 0xE0, 0x60, ++0x12, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x02, 0xE1, 0xC9, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xF7, ++0xF0, 0xF1, 0xBF, 0x22, 0x90, 0xA4, 0x21, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x19, 0x90, 0x04, ++0x1D, 0xE0, 0x70, 0x13, 0x90, 0xA2, 0x97, 0xE0, 0xFF, 0xE4, 0xFD, 0xF1, 0x51, 0x8E, 0x6E, 0x8F, ++0x6F, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x90, 0xA3, 0x87, 0xE0, 0xB4, 0x01, 0x14, 0x90, ++0xA4, 0x0B, 0xE0, 0x60, 0x0E, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x02, 0x80, ++0xC3, 0xF1, 0x04, 0x22, 0xF1, 0xC9, 0x90, 0xA4, 0x0E, 0xE0, 0x64, 0x0C, 0x60, 0x0C, 0xE4, 0xFD, ++0x7F, 0x0C, 0x12, 0x5C, 0x92, 0xE4, 0xFF, 0x12, 0x84, 0xEB, 0x22, 0x90, 0xA5, 0x71, 0xEF, 0xF0, ++0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1B, 0x90, 0x05, 0x22, 0xE0, ++0x90, 0xA5, 0x76, 0xF0, 0x12, 0x8A, 0x07, 0xBF, 0x01, 0x03, 0x12, 0x86, 0x45, 0x90, 0xA5, 0x76, ++0xE0, 0x90, 0x05, 0x22, 0xF0, 0x80, 0x03, 0x12, 0x86, 0x45, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x4F, 0xED, 0xF0, 0x90, 0xA6, 0x4E, ++0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xBB, 0xD4, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0xA6, 0x4E, 0xE0, ++0x90, 0x04, 0x25, 0xF0, 0x90, 0xA6, 0x4F, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x01, 0x51, 0x90, ++0xA4, 0x0D, 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x5C, 0x92, 0x90, 0xA4, 0x08, 0xE0, 0x13, 0x13, 0x13, ++0x54, 0x1F, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, ++0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x1E, 0xE0, 0xC3, 0x13, 0x54, ++0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5B, ++0x74, 0x05, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, ++0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x0B, 0x90, 0x01, 0xC4, 0xED, ++0xF0, 0x74, 0x78, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, ++0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x02, 0x09, 0xE0, ++0xFD, 0x12, 0x26, 0x1E, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0xA2, 0x96, 0xF0, 0x90, 0x00, 0x01, ++0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA2, 0x97, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, ++0xFF, 0xED, 0x2F, 0x90, 0xA2, 0x98, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, ++0x90, 0xA2, 0x99, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, ++0xA2, 0x9A, 0xF0, 0x22, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x9D, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, ++0xFF, 0xFE, 0x12, 0x26, 0x1E, 0xFD, 0xC3, 0x13, 0x30, 0xE0, 0x12, 0x90, 0xA5, 0x44, 0x12, 0x4B, ++0x94, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA5, 0x48, 0xF0, 0x80, 0x05, 0x90, 0xA5, 0x48, ++0xEF, 0xF0, 0x90, 0xA5, 0x47, 0xEE, 0xF0, 0x90, 0xA5, 0x48, 0xE0, 0xFE, 0x90, 0xA5, 0x47, 0xE0, ++0xFF, 0xD3, 0x9E, 0x50, 0x38, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x12, 0x26, 0x1E, 0x54, 0x01, ++0xFE, 0x74, 0x87, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x87, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0x70, 0x04, 0x31, 0x36, 0x80, 0x07, 0x90, 0xA5, ++0x47, 0xE0, 0xFF, 0x31, 0x25, 0x90, 0xA5, 0x47, 0xE0, 0x04, 0xF0, 0x80, 0xBA, 0x90, 0xA3, 0x87, ++0xE0, 0x70, 0x21, 0x90, 0xA4, 0x0E, 0xE0, 0x70, 0x04, 0xFF, 0x12, 0x5E, 0x8F, 0x90, 0xA4, 0x0E, ++0xE0, 0x64, 0x0C, 0x60, 0x02, 0x31, 0x47, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, ++0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x8F, 0x0F, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x4B, ++0x88, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x8F, 0x0F, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, ++0x4B, 0x88, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x05, ++0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x0C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0xA4, 0x07, 0xF0, 0xBF, 0x01, 0x12, 0x90, 0x00, 0x01, 0x12, ++0x26, 0x37, 0x64, 0x01, 0x60, 0x17, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x0F, 0x90, 0x00, ++0x01, 0x12, 0x26, 0x37, 0x64, 0x01, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x9D, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x7F, 0x90, 0xA4, ++0x0B, 0xF0, 0xEF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xA3, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, ++0x37, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, ++0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0xA4, 0x08, 0xE0, 0x54, ++0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, ++0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x0D, 0xF0, 0x90, 0x00, 0x05, 0x12, ++0x26, 0x37, 0xFF, 0x54, 0x02, 0xFE, 0x90, 0xA4, 0x21, 0xE0, 0x54, 0xFD, 0x4E, 0xFE, 0xF0, 0xEF, ++0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFE, ++0x54, 0x08, 0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xFF, 0x90, 0xA4, 0x21, 0xF0, 0xEE, 0x54, 0x10, 0xFE, ++0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFE, 0x54, 0x20, 0xFD, ++0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0x90, 0xA4, 0x21, 0xF0, 0xEE, 0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, ++0x4E, 0xF0, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x37, 0xEF, 0xC3, 0x13, 0x20, ++0xE0, 0x0E, 0x90, 0xA5, 0x48, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x64, 0xE0, 0x60, 0x0D, 0x80, 0x12, ++0xE4, 0x90, 0xA5, 0x48, 0xF0, 0x90, 0xA4, 0x64, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0xA5, 0x47, 0xF0, ++0x80, 0x06, 0x90, 0xA5, 0x47, 0x74, 0x01, 0xF0, 0x90, 0xA5, 0x47, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, ++0x12, 0x75, 0xCC, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x51, 0xB0, 0x90, 0x01, 0xB9, 0x74, 0x01, ++0xF0, 0x90, 0x01, 0xB8, 0xF0, 0x90, 0xA4, 0x0B, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0xA4, 0x0D, ++0xE0, 0x90, 0x01, 0xBB, 0xF0, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, 0x90, 0x01, 0xBE, 0xF0, 0x22, ++0x90, 0xA5, 0x49, 0x12, 0x4B, 0x9D, 0x51, 0xDF, 0x90, 0xA4, 0x0B, 0xE0, 0xFF, 0x12, 0x5F, 0x26, ++0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x18, 0x90, 0xA5, 0x49, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x01, 0x12, ++0x26, 0x37, 0x54, 0x0F, 0xFF, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x51, 0xF0, 0x22, 0x90, ++0xA4, 0x08, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA4, 0x14, 0xF0, 0x90, 0xA4, 0x0F, 0xF0, 0x22, ++0xEF, 0x24, 0xFE, 0x60, 0x0C, 0x04, 0x70, 0x28, 0x90, 0xA4, 0x11, 0x74, 0x01, 0xF0, 0xA3, 0xF0, ++0x22, 0xED, 0x70, 0x0A, 0x90, 0xA4, 0x1F, 0xE0, 0x90, 0xA4, 0x11, 0xF0, 0x80, 0x05, 0x90, 0xA4, ++0x11, 0xED, 0xF0, 0x90, 0xA4, 0x11, 0xE0, 0xA3, 0xF0, 0x90, 0xA4, 0x09, 0xE0, 0x44, 0x08, 0xF0, ++0x22, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x30, 0xE0, 0x26, 0x12, 0x26, 0x1E, 0x90, 0xA4, ++0x1C, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x1D, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, ++0xA3, 0xE0, 0x54, 0x01, 0x4F, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x1F, 0xF0, ++0x22, 0x90, 0xA4, 0x1C, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, ++0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0xA4, 0x22, 0xF0, 0x60, 0x37, ++0x90, 0xA4, 0x27, 0xE0, 0x20, 0xE0, 0x30, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x5C, 0x92, 0x90, 0xA4, ++0x21, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x1F, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, ++0x16, 0x90, 0xA4, 0x21, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, ++0x0D, 0xF0, 0x80, 0x03, 0x74, 0x09, 0xF0, 0x90, 0xA4, 0x22, 0xE0, 0x90, 0x01, 0xE7, 0xF0, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x46, 0x12, 0x4B, 0x9D, 0x12, 0x26, 0x1E, ++0xFF, 0x54, 0x01, 0xFE, 0x90, 0xA4, 0x27, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, ++0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, ++0xFB, 0x4D, 0xFF, 0x90, 0xA4, 0x27, 0xF0, 0xEE, 0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, ++0xF0, 0x12, 0x26, 0x1E, 0xFE, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0x90, 0xA4, 0x27, ++0xF0, 0xEE, 0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFE, 0x54, ++0x80, 0xFD, 0xEF, 0x54, 0x7F, 0x4D, 0x90, 0xA4, 0x27, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, ++0xFF, 0x54, 0x01, 0xFD, 0x90, 0xA4, 0x2A, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEF, 0x54, 0x02, ++0xFF, 0xED, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFD, 0x54, 0x04, ++0xFC, 0xEF, 0x54, 0xFB, 0x4C, 0xFF, 0x90, 0xA4, 0x2A, 0xF0, 0xED, 0x54, 0x10, 0xFD, 0xEF, 0x54, ++0xEF, 0x4D, 0xFF, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFD, 0x54, 0x20, 0xFC, 0xEF, 0x54, ++0xDF, 0x4C, 0xFF, 0x90, 0xA4, 0x2A, 0xF0, 0xED, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, 0x4D, 0xFF, ++0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x54, 0x80, 0xFD, 0xEF, 0x54, 0x7F, 0x4D, 0x90, 0xA4, ++0x2A, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, 0x54, 0x20, 0xFD, 0x90, 0xA4, 0x2B, 0xE0, ++0x54, 0xDF, 0x4D, 0xFD, 0xF0, 0xEF, 0x54, 0x40, 0xFF, 0xED, 0x54, 0xBF, 0x4F, 0xFF, 0xF0, 0x90, ++0x00, 0x04, 0x12, 0x26, 0x37, 0xFD, 0x54, 0x80, 0xFC, 0xEF, 0x54, 0x7F, 0x4C, 0xFF, 0x90, 0xA4, ++0x2B, 0xF0, 0xED, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0xF0, 0x90, 0x00, 0x04, 0x12, ++0x26, 0x37, 0xFD, 0x54, 0x10, 0xFC, 0xEF, 0x54, 0xEF, 0x4C, 0xFF, 0x90, 0xA4, 0x2B, 0xF0, 0xED, ++0x54, 0x08, 0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xF0, 0xEE, 0x20, 0xE0, 0x02, 0xC1, 0x51, 0x90, 0x05, ++0x54, 0xE0, 0xC3, 0x13, 0x90, 0xA4, 0x37, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x54, 0x0F, 0x30, ++0xE0, 0x1C, 0x90, 0xA5, 0x46, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, ++0x28, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x29, 0xF0, 0x80, 0x4E, 0x90, 0xA5, ++0x46, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, ++0xEF, 0xC3, 0x94, 0x03, 0x90, 0xA4, 0x28, 0x50, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, ++0x80, 0x06, 0x90, 0xA4, 0x28, 0x74, 0x2A, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xC3, ++0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, 0x94, 0x03, 0x90, 0xA4, 0x29, 0x50, 0x05, 0x74, 0x03, 0xF0, ++0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, 0x90, 0xA4, 0x29, 0x74, 0x2A, 0xF0, 0x90, 0xA4, 0x2B, 0xE0, ++0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x3C, 0x90, 0xA4, 0x28, 0xE0, 0x75, 0xF0, 0x03, 0x84, ++0x90, 0xA4, 0x30, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0xA4, 0x29, 0xE0, 0x75, 0xF0, 0x03, ++0x84, 0x90, 0xA4, 0x32, 0xF0, 0x90, 0xA4, 0x28, 0xE0, 0xC3, 0x13, 0x90, 0xA4, 0x33, 0xF0, 0x90, ++0xA4, 0x29, 0xE0, 0xC3, 0x13, 0x90, 0xA4, 0x34, 0xF0, 0x90, 0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, ++0x7F, 0x02, 0xD1, 0xF9, 0xE4, 0x90, 0xA4, 0x62, 0xF0, 0x90, 0xA5, 0x46, 0x12, 0x4B, 0x94, 0x90, ++0x00, 0x03, 0x12, 0x26, 0x37, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x30, 0x12, 0x26, 0x1E, ++0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x08, 0x90, 0xA4, 0x64, 0xE0, 0x60, 0x08, 0x80, 0x0E, ++0x90, 0xA4, 0x64, 0xE0, 0x60, 0x08, 0x90, 0xA5, 0x44, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, ++0xA5, 0x44, 0xF0, 0x90, 0xA5, 0x44, 0xE0, 0xFF, 0x7D, 0x02, 0x12, 0x75, 0xCC, 0x90, 0xA4, 0x27, ++0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1B, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, ++0xE0, 0x06, 0x90, 0xA4, 0x0D, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x74, ++0x11, 0xF0, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, 0xA4, 0x2F, 0xE0, 0xFF, 0xB4, 0x01, 0x08, ++0x90, 0xA4, 0x39, 0x74, 0x01, 0xF0, 0x80, 0x22, 0xEF, 0xB4, 0x04, 0x08, 0x90, 0xA4, 0x39, 0x74, ++0x04, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x06, 0x08, 0x90, 0xA4, 0x39, 0x74, 0x02, 0xF0, 0x80, 0x0A, ++0xEF, 0xB4, 0x07, 0x06, 0x90, 0xA4, 0x39, 0x74, 0x05, 0xF0, 0xE4, 0x90, 0xA4, 0x2F, 0xF0, 0x80, ++0x61, 0x90, 0xA5, 0x46, 0x12, 0x4B, 0x94, 0x12, 0x26, 0x1E, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, ++0x30, 0xE0, 0x08, 0x90, 0xA5, 0x45, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA5, 0x45, 0xF0, ++0x12, 0xB6, 0xCE, 0x7D, 0x20, 0x7F, 0x40, 0x12, 0x3A, 0x96, 0x90, 0xA5, 0x46, 0x12, 0x4B, 0x94, ++0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0x07, 0x78, 0x30, 0xE0, ++0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x90, 0xA5, 0x45, 0xE0, 0xFD, 0x7F, 0x02, ++0x12, 0x75, 0xCC, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x74, ++0x43, 0xF0, 0x90, 0xA4, 0x2D, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0xA4, 0x38, 0xF0, 0x90, 0xA4, ++0x2A, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x09, 0x90, 0xA4, 0x55, 0xE0, 0x44, ++0x02, 0xF0, 0x80, 0x0C, 0x7F, 0x01, 0x12, 0xB4, 0xA0, 0x90, 0xA4, 0x55, 0xE0, 0x54, 0xFD, 0xF0, ++0x7F, 0x03, 0x12, 0x75, 0x89, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x14, 0x90, 0x05, 0x73, 0xF0, ++0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, ++0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0xA4, ++0x76, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x0E, 0xE0, 0x64, 0x02, 0x60, 0x29, 0xF1, 0x46, 0x90, 0xA4, ++0x09, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x15, 0x90, 0xA4, 0x11, 0xE0, 0xFF, 0xA3, ++0xE0, 0x6F, 0x70, 0x0B, 0xD1, 0xEA, 0x12, 0x5F, 0x5D, 0x90, 0xA4, 0x12, 0xE0, 0x14, 0xF0, 0x90, ++0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA3, 0x87, 0xE0, 0x64, 0x01, 0x60, 0x02, 0xE1, 0xDB, ++0x90, 0xA4, 0x0B, 0xE0, 0x70, 0x02, 0xE1, 0xDB, 0x90, 0xA4, 0x0A, 0xE0, 0xC4, 0x54, 0x0F, 0x64, ++0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0xA4, 0x12, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, ++0xA4, 0x11, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0xA4, 0x11, 0xE0, 0xFE, 0xFF, 0x80, 0x00, ++0x90, 0xA4, 0x12, 0xEF, 0xF0, 0x90, 0xA4, 0x09, 0xE0, 0x44, 0x04, 0xF0, 0xE4, 0x90, 0xA4, 0x14, ++0xF0, 0x90, 0xA4, 0x16, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, ++0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA4, 0x0F, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xEF, 0xF0, 0x90, ++0xA4, 0x0A, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x03, 0x12, 0xBA, 0x0F, ++0x90, 0xA4, 0x09, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0F, 0x90, 0xA4, 0x11, 0xE0, ++0xFF, 0xA3, 0xE0, 0xB5, 0x07, 0x05, 0xD1, 0xEA, 0x12, 0x5F, 0x63, 0x22, 0x90, 0xA5, 0x44, 0x12, ++0x4B, 0x9D, 0x90, 0xA6, 0x2B, 0xE0, 0x70, 0x13, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0x90, ++0xA4, 0x5C, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x2B, 0x74, 0x01, 0xF0, 0x90, 0xA5, 0x44, 0x12, 0x4B, ++0x94, 0x12, 0x26, 0x1E, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA5, 0x47, 0x12, 0x27, 0x48, 0x90, ++0xA4, 0x5C, 0x12, 0x4B, 0x50, 0xEC, 0x54, 0xC1, 0xFC, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, ++0x07, 0x90, 0xA5, 0x47, 0x12, 0x4B, 0x50, 0x78, 0x19, 0x12, 0x27, 0x35, 0xD0, 0x03, 0xD0, 0x02, ++0xD0, 0x01, 0xD0, 0x00, 0x12, 0x4B, 0x32, 0x90, 0xA4, 0x58, 0x02, 0x27, 0x48, 0x12, 0x26, 0x1E, ++0x90, 0xA4, 0x4A, 0xF0, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0xA6, 0x43, 0xF0, 0x90, ++0xA6, 0x43, 0xE0, 0xFD, 0x70, 0x02, 0x21, 0xF9, 0x90, 0xA2, 0xEB, 0xE0, 0xFF, 0x70, 0x06, 0xA3, ++0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA2, 0xEC, 0xE0, 0xB5, 0x07, 0x04, 0x7F, ++0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, ++0x90, 0xA6, 0x2C, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, ++0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x21, 0xF2, 0x90, 0xA6, 0x2C, 0xE0, ++0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA6, 0x44, 0xF0, 0x75, 0x40, ++0x01, 0x75, 0x41, 0xA6, 0x75, 0x42, 0x44, 0x75, 0x43, 0x01, 0x7B, 0x01, 0x7A, 0xA6, 0x79, 0x45, ++0x12, 0x34, 0x2C, 0x90, 0xA6, 0x2C, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x4B, 0x88, ++0xE0, 0xFF, 0x90, 0xA2, 0xEC, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0xA2, 0x9B, 0x12, 0x4B, 0x88, ++0xEF, 0xF0, 0x90, 0xA6, 0x2C, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD1, 0x12, 0x4B, 0x88, 0xE0, ++0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0xA2, 0x9C, 0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x90, 0xA6, 0x2C, ++0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD2, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, ++0x90, 0xA2, 0x9D, 0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x90, 0xA6, 0x2C, 0xE0, 0x75, 0xF0, 0x04, 0x90, ++0x01, 0xD3, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0xA2, 0x9E, 0x12, 0x4B, ++0x88, 0xEF, 0xF0, 0x90, 0xA6, 0x2C, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF0, 0x12, 0x4B, 0x88, ++0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0xA2, 0x9F, 0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x90, 0xA6, ++0x2C, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF1, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x08, ++0xEE, 0x90, 0xA2, 0xA0, 0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x90, 0xA6, 0x2C, 0xE0, 0x75, 0xF0, 0x04, ++0x90, 0x01, 0xF2, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0xA2, 0xA1, 0x12, ++0x4B, 0x88, 0xEF, 0xF0, 0x90, 0xA6, 0x2C, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF3, 0x12, 0x4B, ++0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0xA2, 0xA2, 0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x90, ++0xA6, 0x43, 0xE0, 0xFF, 0x90, 0xA6, 0x2C, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, ++0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0xA6, 0x43, 0xF0, 0x90, 0xA6, 0x2C, 0xE0, 0xFF, 0x74, ++0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0xA6, ++0x2C, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0xA2, 0xEC, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, ++0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x01, 0x4F, 0xE4, 0x90, 0xA2, 0xEC, 0xF0, ++0x01, 0x4F, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, ++0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xEE, 0x74, 0x00, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, ++0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, ++0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, ++0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA6, 0x33, 0xEF, 0xF0, 0xA3, 0x12, 0x4B, 0x9D, 0x90, 0xA6, ++0x2D, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, 0x76, 0x74, 0x00, 0x2F, 0xF9, ++0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0xA6, 0x34, 0x12, ++0x4B, 0x94, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, ++0x03, 0x12, 0x34, 0x2C, 0x90, 0xA6, 0x33, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, ++0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x4B, 0x94, 0xE9, 0x24, 0x02, 0xF9, 0xE4, ++0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0xA6, 0x34, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x0E, ++0x12, 0x26, 0x37, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x2C, 0x90, 0x01, ++0x34, 0xE0, 0x55, 0x5D, 0xF5, 0x61, 0xA3, 0xE0, 0x55, 0x5E, 0xF5, 0x62, 0xA3, 0xE0, 0x55, 0x5F, ++0xF5, 0x63, 0xA3, 0xE0, 0x55, 0x60, 0xF5, 0x64, 0x90, 0x01, 0x34, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, ++0x62, 0xF0, 0xA3, 0xE5, 0x63, 0xF0, 0xA3, 0xE5, 0x64, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, ++0x65, 0xF5, 0x69, 0xA3, 0xE0, 0x55, 0x66, 0xF5, 0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, 0x6B, 0xA3, ++0xE0, 0x55, 0x68, 0xF5, 0x6C, 0x90, 0x01, 0x3C, 0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, 0xF0, 0xA3, ++0xE5, 0x6B, 0xF0, 0xA3, 0xE5, 0x6C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0xA3, 0x87, 0xE0, 0x64, ++0x01, 0x70, 0x2A, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, ++0x3C, 0x74, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x1D, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, ++0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x22, 0x90, 0xA3, ++0x87, 0xE0, 0x64, 0x01, 0x70, 0x26, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x20, 0x90, 0x01, 0x57, 0xE4, ++0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA4, ++0x0F, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x77, 0xBF, 0x22, 0x90, 0xA3, 0x87, ++0xE0, 0xB4, 0x01, 0x14, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x0E, 0x90, 0xA4, 0x0F, 0xE0, 0x54, 0xFE, ++0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x77, 0xBF, 0x22, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x03, 0x12, ++0x5E, 0xF7, 0x22, 0x71, 0xFC, 0x90, 0xA5, 0x6E, 0xEF, 0xF0, 0x90, 0xA4, 0x08, 0x30, 0xE0, 0x06, ++0xE0, 0x44, 0x01, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA5, 0x6E, 0xE0, 0x30, 0xE6, ++0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, ++0x80, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0xA4, 0x16, 0xE4, 0xF0, 0xA3, 0x74, ++0x05, 0xF0, 0x90, 0xA4, 0x16, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0xE4, 0x90, 0xA5, 0x6F, ++0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, 0xA5, 0x6F, 0xF0, 0x90, 0x00, 0x83, ++0xE0, 0xFE, 0x90, 0xA5, 0x6F, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0xA5, 0x71, 0xE0, ++0x94, 0x64, 0x90, 0xA5, 0x70, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, ++0xF0, 0x90, 0xA5, 0x6F, 0xE0, 0xFF, 0x22, 0x90, 0xA5, 0x70, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x4A, ++0x9F, 0x80, 0xC2, 0x22, 0x90, 0xA4, 0x08, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, ++0x3C, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA4, 0x09, 0x30, 0xE0, 0x06, 0xE0, ++0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, ++0x01, 0xB8, 0x74, 0x04, 0xF0, 0x90, 0xA4, 0x2D, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, ++0x09, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x5C, 0x92, 0x80, 0x03, 0x12, 0x77, 0xBF, 0xE4, 0xFF, 0x90, ++0xA4, 0x71, 0xE0, 0x30, 0xE0, 0x47, 0x90, 0xA4, 0x75, 0xE0, 0xFD, 0x60, 0x40, 0x74, 0x01, 0x7E, ++0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, ++0xE0, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x06, 0xE4, 0x90, 0xA4, 0x75, 0xF0, 0x22, 0x90, 0xA4, 0x73, ++0xE0, 0xD3, 0x9D, 0x50, 0x10, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0xD1, 0xEF, 0x90, 0xA4, 0x71, ++0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x91, 0xDE, 0x90, 0xA4, 0x75, 0xE0, 0x04, 0xF0, 0x22, 0xE4, 0xFF, ++0x80, 0x09, 0x90, 0xA4, 0x2E, 0xE0, 0x44, 0x02, 0xF0, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x8F, 0x1F, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1E, 0x90, 0x05, 0x22, 0xE0, 0xF5, 0x22, ++0x74, 0xFF, 0xF0, 0x12, 0x8A, 0x0D, 0xBF, 0x01, 0x07, 0xAF, 0x1F, 0x12, 0xBB, 0x87, 0xB1, 0xA7, ++0x90, 0x05, 0x22, 0xE5, 0x22, 0xF0, 0x80, 0x02, 0xB1, 0xA7, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, ++0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x52, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x47, 0x90, ++0xA4, 0x3D, 0xE0, 0xFF, 0xC3, 0x94, 0x20, 0x50, 0x13, 0xEF, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x74, ++0x2B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0x74, 0x2B, 0x2D, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x7F, 0xF0, 0x22, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xEF, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0x90, 0xA2, 0x98, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x77, ++0x51, 0x8E, 0x20, 0x8F, 0x21, 0xAD, 0x21, 0xAC, 0x20, 0xAF, 0x1F, 0xB1, 0x27, 0xAF, 0x21, 0xAE, ++0x20, 0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x01, 0xF0, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, 0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, ++0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF5, 0x82, 0xE4, 0x34, ++0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xED, 0xF0, 0x22, 0x90, 0xA2, 0x9A, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x77, 0x51, 0x90, ++0xA5, 0x74, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA5, 0x71, 0xE0, 0xFF, 0xA3, 0xE0, ++0xFB, 0xA3, 0xE0, 0x90, 0xA5, 0x7B, 0xF0, 0x90, 0xA5, 0x78, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, ++0xEB, 0xF0, 0x90, 0xA5, 0x78, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xB1, 0x27, 0x90, 0xA5, 0x78, 0xA3, ++0xE0, 0xFF, 0xFD, 0x24, 0x0D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, ++0x74, 0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xEF, 0xF0, 0x74, 0x12, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x02, 0xF0, 0x74, 0x12, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0xA5, 0x7A, 0xE0, 0xFF, 0x90, ++0xA5, 0x78, 0xA3, 0xE0, 0xFE, 0x24, 0x2A, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, ++0x90, 0xA5, 0x7B, 0xE0, 0xFF, 0x74, 0x2B, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, ++0xF0, 0x74, 0x2C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x22, 0x90, ++0xA2, 0x95, 0xE0, 0x64, 0x02, 0x60, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, ++0xA4, 0x6E, 0xE0, 0x30, 0xE0, 0x2D, 0x90, 0xA3, 0x87, 0xE0, 0xB4, 0x01, 0x26, 0x90, 0xA6, 0x61, ++0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0xA4, 0x70, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0xA6, ++0x61, 0xF0, 0x90, 0xA4, 0x70, 0xE0, 0xFF, 0x90, 0xA4, 0x6F, 0xE0, 0xB5, 0x07, 0x05, 0xE4, 0xA3, ++0xF0, 0x91, 0xDE, 0x22, 0x90, 0xA4, 0x71, 0xE0, 0x30, 0xE0, 0x35, 0x90, 0xA4, 0x74, 0xE0, 0x04, ++0xF0, 0xE0, 0xFF, 0x90, 0xA4, 0x72, 0xE0, 0x6F, 0x70, 0x26, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, ++0x10, 0x90, 0xA4, 0x76, 0xE0, 0x70, 0x0A, 0x91, 0xDE, 0x90, 0xA4, 0x75, 0xE0, 0x04, 0xF0, 0x80, ++0x06, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA4, 0x74, 0xF0, 0x90, 0xA4, 0x76, 0xF0, ++0x22, 0xEF, 0x60, 0x3D, 0x90, 0xA3, 0x87, 0xE0, 0x64, 0x01, 0x70, 0x35, 0x90, 0xA4, 0x09, 0xE0, ++0x54, 0xFE, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, ++0xE4, 0xFF, 0x91, 0xEB, 0xBF, 0x01, 0x0E, 0x90, 0xA4, 0x08, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA4, ++0x0E, 0x74, 0x06, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x08, ++0xF0, 0x22, 0x90, 0xA4, 0x08, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x4A, ++0xEF, 0x54, 0x7F, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA4, 0x09, 0x30, 0xE1, 0x06, 0xE0, 0x44, ++0x02, 0xF0, 0x80, 0x0F, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, ++0xB8, 0x04, 0xF0, 0x90, 0xA4, 0x2B, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x11, ++0x90, 0xA4, 0x2E, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xEF, 0x44, 0x04, 0xF0, 0x54, 0xFD, ++0xF0, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x03, 0x12, 0x77, 0xBF, 0x7F, 0x01, 0x02, 0x84, 0x8F, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, 0xE0, ++0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, 0xC6, 0xE0, 0x30, ++0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC3, 0xEE, 0x94, ++0x01, 0x40, 0x0A, 0x0D, 0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xC3, 0xEE, ++0x94, 0x01, 0x40, 0x1E, 0x90, 0xFD, 0x11, 0xE0, 0xB5, 0x05, 0x14, 0x90, 0x01, 0x17, 0xE0, 0xB5, ++0x05, 0x07, 0x90, 0xFD, 0x11, 0xE4, 0xF0, 0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, 0x11, 0xF0, 0xE4, ++0x2F, 0xFF, 0x22, 0xFB, 0x7D, 0x08, 0x7F, 0x01, 0x90, 0xA6, 0x50, 0xEB, 0xF0, 0xEF, 0x70, 0x06, ++0xA3, 0x74, 0x03, 0xF0, 0x80, 0x0B, 0xEF, 0x64, 0x01, 0x70, 0x35, 0x90, 0xA6, 0x51, 0x74, 0x42, ++0xF0, 0x7F, 0xE2, 0x12, 0x3A, 0x96, 0x90, 0xA6, 0x50, 0xE0, 0xFD, 0x7F, 0xE0, 0x12, 0x3A, 0x96, ++0x90, 0xA6, 0x51, 0xE0, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x90, 0xA6, 0x51, 0xE0, 0x54, 0xFD, ++0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x7F, 0x01, 0x22, ++0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x51, 0x0D, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, ++0xA6, 0x15, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x15, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, ++0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, ++0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA6, 0x15, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x15, 0x12, 0x4B, 0x50, ++0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, ++0xE0, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x12, 0x3A, 0x96, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, ++0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0xA6, 0x15, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x15, 0x12, 0x4B, ++0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x01, ++0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, ++0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0x90, 0xA4, 0x18, 0x12, 0x27, 0x48, 0x90, 0xAC, 0xB9, ++0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, ++0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, ++0xA4, 0x21, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x06, 0x90, 0x07, 0x78, 0x74, ++0x01, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x3C, 0x90, 0xA4, 0x64, 0xE0, 0x60, 0x08, 0x90, 0xA6, ++0x19, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA6, 0x19, 0xF0, 0x90, 0xA4, 0x21, 0xE0, 0xC4, ++0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA6, 0x1A, 0xF0, 0x80, 0x06, 0x90, 0xA6, 0x1A, ++0x74, 0x02, 0xF0, 0x90, 0xA6, 0x19, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x75, 0xCC, 0x90, 0x07, ++0x78, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x20, 0xE0, 0x60, 0x02, 0xE4, 0xF0, 0x90, 0x00, 0xFF, 0xE0, ++0x70, 0x10, 0x7B, 0x01, 0x7A, 0xA6, 0x79, 0x14, 0x51, 0x5B, 0x90, 0xA6, 0x14, 0xE0, 0x44, 0x18, ++0x11, 0x73, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0xE4, 0x90, 0xA6, ++0x52, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, ++0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0xA6, 0x53, 0xE0, 0x94, 0xE8, ++0x90, 0xA6, 0x52, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x7F, ++0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA6, 0x52, 0xE4, 0x75, 0xF0, 0x01, ++0x12, 0x4A, 0x9F, 0x80, 0xBF, 0x7B, 0x01, 0x7A, 0xA6, 0x79, 0x13, 0x7D, 0x08, 0x7F, 0x01, 0x90, ++0xA6, 0x3F, 0x12, 0x4B, 0x9D, 0xEF, 0x70, 0x07, 0x90, 0xA6, 0x42, 0x04, 0xF0, 0x80, 0x0B, 0xEF, ++0x64, 0x01, 0x70, 0x2E, 0x90, 0xA6, 0x42, 0x74, 0x40, 0xF0, 0x7F, 0xE2, 0x12, 0x3A, 0x96, 0x90, ++0xA6, 0x42, 0xE0, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x90, 0x00, 0xE1, 0xE0, 0xFF, 0x90, 0xA6, ++0x3F, 0x12, 0x4B, 0x94, 0xEF, 0x12, 0x26, 0x64, 0xE4, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x7F, ++0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x18, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, ++0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xA4, 0x18, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, ++0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x10, 0xE0, 0x44, 0x0C, 0xFD, ++0x7F, 0x10, 0x12, 0x3A, 0x96, 0x90, 0x00, 0x72, 0xE0, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x3A, ++0x96, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0xA4, ++0x21, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x06, 0x90, 0x07, 0x78, 0x74, 0x03, ++0xF0, 0x90, 0xA4, 0x41, 0xE0, 0x20, 0xE0, 0x3A, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x34, 0x90, 0xA4, ++0x64, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0xA6, 0x11, 0xF0, 0x80, 0x06, 0x90, 0xA6, 0x11, 0x74, 0x01, ++0xF0, 0x90, 0xA4, 0x21, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0xA6, 0x12, 0x30, 0xE0, 0x05, 0x74, ++0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0xA6, 0x11, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, ++0x75, 0xCC, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x7F, 0xB4, ++0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xBF, 0xFF, 0xEC, 0x90, 0xA6, 0x0D, 0x12, 0x27, 0x48, ++0x90, 0xA6, 0x0D, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB4, 0x7E, 0x08, ++0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x12, 0x3A, 0x96, 0x7F, ++0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0xA6, 0x0D, 0x12, 0x27, ++0x48, 0x90, 0xA6, 0x0D, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, ++0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, ++0x90, 0xA6, 0x0D, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x0D, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, ++0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0xFF, 0xE0, 0x70, 0x1A, 0x51, ++0x55, 0x90, 0xA6, 0x13, 0xE0, 0x54, 0xE7, 0x11, 0x73, 0x51, 0x55, 0x90, 0xA6, 0x13, 0xE0, 0x54, ++0x18, 0x70, 0x06, 0x90, 0x01, 0xBF, 0xE0, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, ++0xA5, 0x39, 0xF0, 0xE4, 0x90, 0xA5, 0x3A, 0xF0, 0x90, 0xA5, 0x3A, 0xE0, 0xFF, 0xC3, 0x94, 0x10, ++0x50, 0x75, 0x90, 0xA5, 0x39, 0xE0, 0xFE, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, ++0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x90, 0xA5, 0x3A, 0xB4, 0x03, 0x1B, 0xE0, 0xFF, 0x75, 0xF0, 0x10, ++0xEE, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, ++0x83, 0x74, 0x80, 0xF0, 0x80, 0x1B, 0xE0, 0xFF, 0x90, 0xA5, 0x39, 0xE0, 0x75, 0xF0, 0x10, 0x90, ++0x81, 0x00, 0x12, 0x4B, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, ++0xF0, 0x90, 0xA5, 0x3A, 0xE0, 0xFF, 0x90, 0xA5, 0x39, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, ++0x12, 0x4B, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x90, ++0xA5, 0x3A, 0xE0, 0x04, 0xF0, 0x80, 0x81, 0x90, 0xA5, 0x39, 0xE0, 0x04, 0xF0, 0xE0, 0x64, 0x80, ++0x60, 0x02, 0x81, 0x03, 0xE4, 0x90, 0xAF, 0x7D, 0xF0, 0x90, 0xA5, 0x39, 0xF0, 0x90, 0xA5, 0x39, ++0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, ++0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x03, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, ++0xEF, 0x90, 0x8D, 0x05, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, ++0x8D, 0x07, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x09, ++0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x9D, 0x92, 0xF0, 0x74, 0x92, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0xA0, 0xF5, 0x83, 0x74, 0x3F, 0xF0, 0x74, 0x92, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, ++0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x92, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xE4, 0xF0, ++0x74, 0x81, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x74, 0xC0, 0xF0, 0xEF, 0x25, 0xE0, ++0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x12, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE4, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, ++0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, ++0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x92, ++0x12, 0x4B, 0x88, 0x74, 0x3F, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x93, 0x12, 0x4B, 0x88, ++0x74, 0x03, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0xE0, ++0x44, 0x09, 0xF0, 0x90, 0xA5, 0x39, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, 0x12, 0x4B, ++0x88, 0xE0, 0x54, 0xF3, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, ++0x54, 0xFC, 0xF0, 0x90, 0xA5, 0x39, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x94, 0x12, 0x4B, ++0x88, 0xE0, 0x44, 0x20, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, ++0x54, 0xCF, 0xF0, 0x90, 0xA5, 0x39, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, 0x12, 0x4B, ++0x88, 0xE0, 0x44, 0x40, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, ++0x54, 0x7F, 0xF0, 0x90, 0xA5, 0x39, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x92, 0x12, 0x4B, ++0x88, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xEE, 0xF0, 0x90, ++0xA5, 0x39, 0xE0, 0xFF, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0x74, 0x05, 0xF0, ++0x74, 0x92, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA5, 0x39, 0xE0, ++0x04, 0xF0, 0xE0, 0x64, 0x80, 0x60, 0x02, 0x81, 0x9D, 0xE4, 0x90, 0xA5, 0x3B, 0xF0, 0x90, 0xA5, ++0x3B, 0xE0, 0xFF, 0xC3, 0x94, 0x20, 0x50, 0x14, 0x74, 0x77, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA4, ++0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA5, 0x3B, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x90, 0x04, 0x49, 0x74, ++0xF0, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0x33, 0x74, 0x02, 0xF0, 0xA3, ++0x74, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0x90, 0xA5, 0x39, 0xE0, ++0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0xE1, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xE4, ++0xA3, 0xF0, 0x90, 0xA5, 0xE4, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x14, 0x74, 0xE6, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA5, 0xE4, 0xE0, 0x04, 0xF0, 0x80, 0xE2, ++0x90, 0xA5, 0xE3, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x54, ++0x03, 0x90, 0xA5, 0xEE, 0xF0, 0x64, 0x01, 0x70, 0x52, 0x90, 0xA5, 0xE3, 0xE0, 0xFF, 0x75, 0xF0, ++0x08, 0x90, 0x89, 0x00, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0xE6, 0xF0, 0x75, 0xF0, 0x08, 0xEF, ++0x90, 0x89, 0x01, 0x12, 0x4B, 0x88, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA5, 0xE7, 0xF0, 0xE4, 0xA3, ++0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xEE, 0x54, 0xF0, 0xA3, 0xF0, 0x90, 0xA5, 0xE3, 0xE0, 0x75, 0xF0, ++0x08, 0x90, 0x89, 0x02, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0xEC, 0xF0, 0x75, 0xF0, 0x08, 0xEF, ++0x90, 0x89, 0x03, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0xED, 0xF0, 0x90, 0xA5, 0xEE, 0xE0, 0xFC, ++0xC3, 0x94, 0x02, 0x40, 0x64, 0x90, 0xA5, 0xE3, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, ++0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0xE6, 0xF0, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x89, 0x01, 0x12, ++0x4B, 0x88, 0xE0, 0x90, 0xA5, 0xE7, 0xF0, 0x90, 0xA5, 0xE3, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, ++0x02, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0xE8, 0xF0, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x89, 0x03, ++0x12, 0x4B, 0x88, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA5, 0xE9, 0xF0, 0xEE, 0x54, 0xF0, 0x90, 0xA5, ++0xE5, 0xF0, 0xEC, 0xB4, 0x03, 0x0B, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x90, 0xA5, 0xED, 0xF0, 0x80, ++0x08, 0x90, 0xA5, 0xE5, 0xE0, 0x90, 0xA5, 0xEC, 0xF0, 0xE4, 0x90, 0xA5, 0xE4, 0xF0, 0x90, 0xA5, ++0xE4, 0xE0, 0xFF, 0x24, 0xE6, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, ++0xE0, 0xFE, 0xEF, 0xFD, 0x90, 0xA5, 0xE2, 0xE0, 0x2D, 0xFD, 0x90, 0xA5, 0xE1, 0xE0, 0x34, 0x00, ++0x8D, 0x82, 0xF5, 0x83, 0xE0, 0xFF, 0xEE, 0x5F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA5, 0xE4, ++0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xC7, 0x90, 0xA5, 0xEB, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x70, ++0x08, 0xA3, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x37, 0x90, 0xA5, 0xEE, 0xE0, 0x64, 0x01, 0x70, ++0x2F, 0x90, 0xA5, 0xE7, 0xE0, 0x54, 0x0F, 0xFE, 0x90, 0xA5, 0xE5, 0xF0, 0xEF, 0x54, 0xF0, 0x4E, ++0xF0, 0x90, 0xA5, 0xE7, 0xF0, 0x90, 0xA5, 0xEC, 0xE0, 0x90, 0xA5, 0xE8, 0xF0, 0x90, 0xA5, 0xED, ++0xE0, 0x90, 0xA5, 0xE9, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x80, 0xF0, ++0x90, 0xA5, 0xEE, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, 0x26, 0xEF, 0x90, 0xA5, 0xE9, 0xB4, 0x02, ++0x08, 0xE0, 0xFF, 0x90, 0xA5, 0xEC, 0xE0, 0x80, 0x0A, 0xE0, 0xFF, 0x90, 0xA5, 0xED, 0xE0, 0x13, ++0x13, 0x54, 0x3F, 0xFE, 0xEF, 0x4E, 0x90, 0xA5, 0xE9, 0xF0, 0x90, 0xA5, 0xED, 0x74, 0x80, 0xF0, ++0xE4, 0x90, 0xA5, 0xE4, 0xF0, 0x90, 0xA5, 0xE4, 0xE0, 0xFF, 0x24, 0xE6, 0xF5, 0x82, 0xE4, 0x34, ++0xA5, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0xA5, 0xE3, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, ++0x4B, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0xA5, ++0xE4, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xCD, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA5, 0x54, ++0xEF, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0x7D, 0xF0, 0x74, 0x90, 0xA3, 0xF0, 0x90, 0xA5, 0x54, 0xE0, ++0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0xB4, 0xBE, 0x02, 0x7F, 0x3F, ++0xEF, 0xB4, 0xB3, 0x02, 0x7F, 0x34, 0x90, 0xA5, 0x55, 0xEF, 0xF0, 0xE4, 0x90, 0xA5, 0x5B, 0xF0, ++0x90, 0xA5, 0x55, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xA3, 0xF0, 0xEF, 0x54, 0x80, 0xA3, 0xF0, 0x90, ++0xA5, 0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x92, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, ++0x59, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0xC4, 0x54, ++0x03, 0x90, 0xA5, 0x5A, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x42, 0x3B, 0x12, 0x4B, 0x88, 0x12, ++0x4B, 0x5C, 0xAD, 0x07, 0x90, 0xA5, 0x54, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, ++0x34, 0x95, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xED, 0xF0, 0x75, 0xF0, 0x04, 0xEB, 0x90, 0x96, 0x95, ++0x12, 0x4B, 0x88, 0xE0, 0xFE, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA5, 0x58, 0xF0, 0x74, 0x92, 0x2B, ++0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x30, 0xE0, 0x40, 0x90, 0xA5, 0x56, 0xE0, 0x64, ++0x3F, 0x70, 0x38, 0x74, 0x3E, 0xF0, 0x75, 0xF0, 0x04, 0xEB, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, ++0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0xA5, 0x55, 0x74, 0xBE, 0xF0, 0x80, 0x08, ++0x90, 0xA5, 0x56, 0xE0, 0x90, 0xA5, 0x55, 0xF0, 0xAF, 0x03, 0x90, 0xA5, 0x55, 0xE0, 0xFD, 0x90, ++0xA5, 0x58, 0xE0, 0x90, 0xA6, 0x07, 0xF0, 0xE4, 0xFB, 0xC1, 0x49, 0x90, 0xA5, 0x59, 0xE0, 0xFF, ++0x90, 0xA5, 0x56, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0xA1, 0xB4, 0xE0, 0xFF, 0x90, 0xA5, 0x54, 0xE0, ++0xFE, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xEF, 0xF0, 0xEF, 0x64, 0x2C, 0x70, ++0x35, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x54, 0x03, 0xFE, ++0x90, 0xA5, 0x58, 0xE0, 0x6E, 0x60, 0x1F, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, ++0xE0, 0xFE, 0x90, 0xA5, 0x54, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xEF, ++0x54, 0xF3, 0x4E, 0xF0, 0xA1, 0xAE, 0x90, 0xA5, 0x56, 0xE0, 0xFF, 0xC3, 0x94, 0x3D, 0x40, 0x22, ++0xEF, 0xD3, 0x94, 0x3F, 0x50, 0x1C, 0xA3, 0xE0, 0x70, 0x18, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0x90, ++0xA5, 0x56, 0xE0, 0x44, 0x80, 0xFD, 0x90, 0xA5, 0x58, 0xE0, 0x90, 0xA6, 0x07, 0xF0, 0x7B, 0x01, ++0xC1, 0x49, 0x90, 0xA5, 0x56, 0xE0, 0xFF, 0xC3, 0x94, 0x0C, 0x40, 0x1F, 0xEF, 0x94, 0x13, 0x50, ++0x1A, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, ++0xFE, 0x20, 0xE3, 0x07, 0x90, 0xA5, 0x5B, 0x74, 0x01, 0x80, 0x27, 0x90, 0xA5, 0x56, 0xE0, 0xFF, ++0xC3, 0x94, 0x2C, 0x40, 0x2E, 0xEF, 0x94, 0x35, 0x50, 0x29, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0x24, ++0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFE, 0x20, 0xE3, 0x16, 0x90, 0xA5, 0x5B, ++0x74, 0x02, 0xF0, 0x74, 0x92, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEE, 0x44, 0x08, ++0xF0, 0x80, 0x16, 0xE4, 0x90, 0xA5, 0x5B, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0x24, 0x92, 0xF5, 0x82, ++0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0xA5, 0x5B, 0xE0, 0x64, 0x01, 0x60, ++0x02, 0x61, 0x59, 0x90, 0xA5, 0x54, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x4B, 0x88, ++0xE0, 0x20, 0xE7, 0x1C, 0x20, 0xE6, 0x19, 0x20, 0xE5, 0x16, 0x20, 0xE4, 0x13, 0x90, 0xA5, 0x54, ++0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x12, 0x4B, 0x88, 0xE0, 0x20, 0xE0, 0x02, 0x61, 0x59, ++0x90, 0xA5, 0x54, 0xE0, 0xFF, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x44, ++0x04, 0xF0, 0x90, 0xA5, 0x56, 0xE0, 0xFE, 0xB4, 0x0C, 0x0C, 0x74, 0x14, 0xF0, 0x90, 0xA5, 0x55, ++0xF0, 0x74, 0x12, 0x2F, 0x80, 0x14, 0xEE, 0xB4, 0x0D, 0x1C, 0x90, 0xA5, 0x56, 0x74, 0x15, 0xF0, ++0x90, 0xA5, 0x55, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, ++0x83, 0x74, 0x05, 0xF0, 0x80, 0x5F, 0x90, 0xA5, 0x56, 0xE0, 0xFF, 0xB4, 0x0E, 0x04, 0x74, 0x15, ++0x80, 0x09, 0xEF, 0xB4, 0x0F, 0x1C, 0x90, 0xA5, 0x56, 0x74, 0x16, 0xF0, 0x90, 0xA5, 0x55, 0xF0, ++0x90, 0xA5, 0x54, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0x74, 0x03, 0xF0, ++0x80, 0x33, 0x90, 0xA5, 0x56, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x40, 0x04, 0x74, 0x17, 0x80, 0x10, ++0xEF, 0xC3, 0x94, 0x11, 0x40, 0x1F, 0x90, 0xA5, 0x56, 0xE0, 0x94, 0x13, 0x50, 0x17, 0x74, 0x18, ++0xF0, 0x90, 0xA5, 0x55, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9A, ++0xF5, 0x83, 0x74, 0x02, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA5, 0x58, ++0xE0, 0x90, 0xA6, 0x07, 0xF0, 0x7B, 0x01, 0xC1, 0x49, 0x90, 0xA5, 0x5B, 0xE0, 0x64, 0x02, 0x60, ++0x02, 0x61, 0xFD, 0x90, 0xA5, 0x54, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x4B, 0x88, ++0xE0, 0x20, 0xE6, 0x1A, 0x20, 0xE7, 0x17, 0x90, 0xA5, 0x54, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, ++0x03, 0x12, 0x4B, 0x88, 0xE0, 0x20, 0xE0, 0x06, 0x20, 0xE1, 0x03, 0x30, 0xE2, 0x6F, 0x90, 0xA5, ++0x56, 0xE0, 0xFF, 0x64, 0x2C, 0x60, 0x04, 0xEF, 0xB4, 0x2D, 0x07, 0x90, 0xA5, 0x56, 0x74, 0x36, ++0x80, 0x42, 0xEF, 0x64, 0x2E, 0x60, 0x04, 0xEF, 0xB4, 0x2F, 0x07, 0x90, 0xA5, 0x56, 0x74, 0x37, ++0x80, 0x32, 0xEF, 0xB4, 0x30, 0x07, 0x90, 0xA5, 0x56, 0x74, 0x38, 0x80, 0x27, 0xEF, 0xB4, 0x31, ++0x07, 0x90, 0xA5, 0x56, 0x74, 0x39, 0x80, 0x1C, 0xEF, 0xC3, 0x94, 0x32, 0x40, 0x0D, 0xEF, 0xD3, ++0x94, 0x34, 0x50, 0x07, 0x90, 0xA5, 0x56, 0x74, 0x3A, 0x80, 0x09, 0xEF, 0xB4, 0x35, 0x0A, 0x90, ++0xA5, 0x56, 0x74, 0x3B, 0xF0, 0x90, 0xA5, 0x55, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0xA3, 0xE0, ++0xFD, 0x90, 0xA5, 0x58, 0xE0, 0x90, 0xA6, 0x07, 0xF0, 0x7B, 0x01, 0xC1, 0x49, 0x90, 0xA5, 0x54, ++0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA5, ++0x5A, 0xE0, 0xFF, 0xB4, 0x01, 0x0F, 0x90, 0xA5, 0x56, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, ++0x24, 0xE0, 0xF0, 0x80, 0x27, 0xEF, 0xB4, 0x02, 0x0F, 0x90, 0xA5, 0x56, 0xE0, 0xC3, 0x94, 0x2C, ++0x40, 0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, 0x90, 0xA5, 0x5A, 0xE0, 0xB4, 0x03, 0x0D, 0x90, ++0xA5, 0x56, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, ++0xFF, 0xB4, 0x01, 0x0F, 0x90, 0xA5, 0x59, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE0, ++0xF0, 0x80, 0x27, 0xEF, 0xB4, 0x02, 0x0F, 0x90, 0xA5, 0x59, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, ++0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, 0x90, 0xA5, 0x5A, 0xE0, 0xB4, 0x03, 0x0D, 0x90, 0xA5, 0x59, ++0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA5, 0x56, 0xE0, 0x04, 0xFD, ++0x90, 0xA5, 0x59, 0xE0, 0xFF, 0xED, 0xD3, 0x9F, 0x40, 0x02, 0xA1, 0x20, 0xED, 0x13, 0x13, 0x13, ++0x54, 0x1F, 0xFF, 0x90, 0xA5, 0x54, 0xE0, 0xFC, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x4B, ++0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0x7A, 0x00, 0xED, ++0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, ++0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x41, 0x74, 0x12, 0x2C, 0xF5, ++0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0x90, 0xA5, 0x56, 0xB4, 0x13, 0x28, 0x74, 0x18, 0xF0, ++0x90, 0xA5, 0x55, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, ++0xF5, 0x83, 0xE0, 0x44, 0x04, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, ++0x74, 0x05, 0xF0, 0x80, 0x0B, 0xED, 0xF0, 0x90, 0xA5, 0x55, 0xF0, 0x80, 0x03, 0x0D, 0x81, 0x90, ++0x90, 0xA5, 0x5A, 0xE0, 0xFF, 0xB4, 0x01, 0x1A, 0x90, 0xA5, 0x55, 0xE0, 0xFE, 0xD3, 0x94, 0x0B, ++0x40, 0x10, 0xEE, 0x94, 0x34, 0x50, 0x0B, 0xE0, 0x24, 0x20, 0xF0, 0xA3, 0xE0, 0x24, 0x20, 0xF0, ++0x80, 0x31, 0xEF, 0xB4, 0x02, 0x14, 0x90, 0xA5, 0x55, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x0B, 0xE0, ++0x24, 0x18, 0xF0, 0xA3, 0xE0, 0x24, 0x18, 0xF0, 0x80, 0x19, 0x90, 0xA5, 0x5A, 0xE0, 0xB4, 0x03, ++0x12, 0x90, 0xA5, 0x55, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x09, 0xE0, 0x24, 0x22, 0xF0, 0xA3, 0xE0, ++0x24, 0x22, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, ++0x83, 0xE0, 0x20, 0xE0, 0x02, 0xC1, 0x37, 0x90, 0xA5, 0x56, 0xE0, 0x64, 0x3F, 0x60, 0x02, 0xC1, ++0x37, 0x74, 0x3E, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0xC4, ++0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0xA5, 0x55, 0x74, 0xBE, 0xF0, 0xC1, 0x37, 0x90, 0xA5, ++0x56, 0xE0, 0x80, 0x7F, 0x90, 0xA5, 0x59, 0xE0, 0xFF, 0x90, 0xA5, 0x56, 0xE0, 0xFE, 0x6F, 0x70, ++0x57, 0x90, 0xA5, 0x55, 0xE0, 0xFF, 0x90, 0xA5, 0x54, 0xE0, 0xFD, 0x24, 0x12, 0xF5, 0x82, 0xE4, ++0x34, 0xA2, 0xF5, 0x83, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, ++0xE0, 0xFD, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x09, 0xEF, 0x20, 0xE7, 0x05, 0xEE, 0x44, 0x80, ++0x80, 0x41, 0x90, 0xA5, 0x56, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x4B, 0x88, 0x12, ++0x4B, 0x5C, 0x90, 0xA5, 0x54, 0xE0, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, ++0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x80, 0x34, 0x90, 0xA5, 0x59, 0xE0, 0xFF, 0x90, 0xA5, 0x54, ++0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0xA5, 0x56, 0xEF, ++0xF0, 0x54, 0x80, 0x90, 0xA5, 0x55, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, ++0xA5, 0x58, 0xE0, 0x90, 0xA6, 0x07, 0xF0, 0x7B, 0x01, 0x12, 0x68, 0xCD, 0x90, 0xA5, 0x55, 0xE0, ++0xFF, 0x22, 0xAD, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x52, 0xF0, 0x74, 0x96, 0xA3, 0xF0, 0x74, 0x92, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x74, 0x92, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0xC3, 0x94, 0x03, 0x40, 0x46, 0x74, 0x92, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x12, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, ++0x83, 0xE0, 0xFF, 0x74, 0x91, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEF, 0xF0, 0x74, ++0x12, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x24, 0x1E, 0xFF, 0xE4, 0x33, 0xFE, ++0xED, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, ++0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, 0x81, 0x05, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0x03, 0xF5, 0x1D, ++0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x92, 0x12, 0x4B, 0x88, 0xE0, 0xF5, 0x1E, 0x74, 0x12, 0x2D, ++0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0x54, 0x7F, 0xF5, 0x1C, 0x64, 0x2C, 0x70, 0x2C, ++0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x54, 0x03, 0x65, 0x1D, ++0x60, 0x1A, 0x15, 0x1D, 0xE5, 0x1D, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0x75, 0xF0, 0x04, ++0xED, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xEF, 0x54, 0xF3, 0x4E, 0xF0, 0xE5, 0x1C, 0xD3, 0x95, ++0x1E, 0x40, 0x03, 0x85, 0x1E, 0x1C, 0x74, 0x12, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, ++0xE0, 0x54, 0x80, 0x42, 0x1C, 0xAF, 0x05, 0x90, 0xA6, 0x07, 0xE5, 0x1D, 0xF0, 0xE4, 0xFB, 0xAD, ++0x1C, 0x12, 0x68, 0xCD, 0xAF, 0x1C, 0x22, 0x7D, 0x01, 0xAF, 0x0F, 0x8F, 0x1A, 0xAC, 0x05, 0x90, ++0x01, 0xC4, 0x74, 0x4B, 0xF0, 0x74, 0x97, 0xA3, 0xF0, 0xE5, 0x1A, 0x25, 0xE0, 0x24, 0x12, 0xF5, ++0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x1A, 0x90, ++0x81, 0x00, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x90, 0xA5, 0x55, 0xF0, 0xBF, 0xBE, 0x03, 0x74, 0x3F, ++0xF0, 0x90, 0xA5, 0x55, 0xE0, 0xB4, 0xB3, 0x03, 0x74, 0x34, 0xF0, 0x90, 0xA5, 0x55, 0xE0, 0x54, ++0x7F, 0x90, 0xA5, 0x54, 0xF0, 0x54, 0x7F, 0xF9, 0x90, 0xA5, 0x5A, 0xF0, 0x75, 0xF0, 0x04, 0xE5, ++0x1A, 0x90, 0x96, 0x93, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0x5C, 0xF0, 0x75, 0xF0, 0x04, 0xE5, ++0x1A, 0x90, 0x96, 0x92, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0x5D, 0xF0, 0xFA, 0x75, 0xF0, 0x10, ++0xE5, 0x1A, 0x90, 0x81, 0x05, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0x03, 0x90, 0xA5, 0x56, 0xF0, 0x90, ++0xA5, 0x5A, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xE4, ++0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE5, 0x1A, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, ++0x95, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x90, 0x96, 0x95, ++0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x54, 0x03, 0x90, 0xA5, 0x57, 0xF0, 0x74, 0x12, 0x25, 0x1A, 0xF5, ++0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xEB, 0xF0, 0xE9, 0xD3, 0x9A, 0x40, 0x0C, 0x90, 0xA5, 0x5D, ++0xE0, 0x90, 0xA5, 0x5A, 0xF0, 0x90, 0xA5, 0x54, 0xF0, 0xEC, 0x70, 0x02, 0x41, 0x47, 0x90, 0xA5, ++0x5B, 0xEC, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0x30, 0xE7, 0x0E, 0x90, 0xA5, 0x5A, 0xE0, 0x90, 0xA5, ++0x54, 0xF0, 0x90, 0xA5, 0x5B, 0xE0, 0x14, 0xF0, 0x90, 0xA5, 0x5B, 0xE0, 0x70, 0x02, 0x41, 0x47, ++0x90, 0xA5, 0x5A, 0xE0, 0xFC, 0x64, 0x2C, 0x70, 0x38, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x90, 0x96, ++0x95, 0x12, 0x4B, 0x88, 0xE0, 0xFD, 0x54, 0x03, 0xFF, 0x90, 0xA5, 0x56, 0xE0, 0x6F, 0x60, 0x21, ++0xE0, 0x14, 0xF0, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x1A, ++0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xED, 0x54, 0xF3, 0x4F, 0xF0, 0x90, 0xA5, 0x5B, 0xE0, 0x14, ++0xF0, 0x90, 0xA5, 0x5B, 0xE0, 0x70, 0x02, 0x41, 0x47, 0x90, 0xA5, 0x5C, 0xE0, 0xFD, 0xEC, 0xD3, ++0x9D, 0x50, 0x02, 0x41, 0x3F, 0xE4, 0x90, 0xA5, 0x59, 0xF0, 0x90, 0xA5, 0x57, 0xE0, 0xFE, 0xB4, ++0x01, 0x16, 0x90, 0xA5, 0x5A, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x0D, 0xE0, 0x24, 0xE0, 0xF0, 0x90, ++0xA5, 0x54, 0xE0, 0x24, 0xE0, 0xF0, 0x80, 0x35, 0xEE, 0xB4, 0x02, 0x16, 0x90, 0xA5, 0x5A, 0xE0, ++0xC3, 0x94, 0x2C, 0x40, 0x0D, 0xE0, 0x24, 0xE8, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0x24, 0xE8, 0xF0, ++0x80, 0x1B, 0x90, 0xA5, 0x57, 0xE0, 0xB4, 0x03, 0x14, 0x90, 0xA5, 0x5A, 0xE0, 0xC3, 0x94, 0x2C, ++0x40, 0x0B, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA5, 0x57, ++0xE0, 0xFF, 0xB4, 0x01, 0x0F, 0xED, 0xC3, 0x94, 0x2C, 0x40, 0x09, 0x90, 0xA5, 0x5C, 0xE0, 0x24, ++0xE0, 0xF0, 0x80, 0x27, 0xEF, 0xB4, 0x02, 0x0F, 0x90, 0xA5, 0x5C, 0xE0, 0xC3, 0x94, 0x2C, 0x40, ++0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, 0x90, 0xA5, 0x57, 0xE0, 0xB4, 0x03, 0x0D, 0x90, 0xA5, ++0x5C, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, 0x14, ++0x90, 0xA5, 0x58, 0xF0, 0x90, 0xA5, 0x5C, 0xE0, 0xFF, 0x90, 0xA5, 0x58, 0xE0, 0xC3, 0x9F, 0x50, ++0x02, 0x21, 0xD7, 0xE0, 0xFB, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0x75, 0xF0, 0x08, 0xE5, 0x1A, ++0x90, 0x89, 0x00, 0x12, 0x4B, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, ++0xE0, 0xFD, 0x7C, 0x00, 0xEB, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, ++0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x60, ++0x3E, 0x74, 0x12, 0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0xB4, 0x14, 0x08, ++0x90, 0xA5, 0x54, 0x74, 0x0C, 0xF0, 0x80, 0x08, 0x90, 0xA5, 0x58, 0xE0, 0x90, 0xA5, 0x54, 0xF0, ++0x90, 0xA5, 0x59, 0xE0, 0x04, 0xF0, 0x90, 0xA5, 0x5B, 0xE0, 0xFF, 0x90, 0xA5, 0x59, 0xE0, 0x6F, ++0x60, 0x15, 0x90, 0xA5, 0x5C, 0xE0, 0xFF, 0x90, 0xA5, 0x54, 0xE0, 0xD3, 0x9F, 0x40, 0x08, 0x90, ++0xA5, 0x58, 0xE0, 0x14, 0xF0, 0x21, 0x44, 0x90, 0xA5, 0x57, 0xE0, 0xFE, 0xB4, 0x01, 0x1B, 0x90, ++0xA5, 0x54, 0xE0, 0xFF, 0xD3, 0x94, 0x0B, 0x40, 0x11, 0xEF, 0x94, 0x34, 0x50, 0x0C, 0xE0, 0x24, ++0x20, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, 0x24, 0x20, 0x80, 0x33, 0xEE, 0xB4, 0x02, 0x15, 0x90, 0xA5, ++0x54, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x0C, 0xE0, 0x24, 0x18, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, 0x24, ++0x18, 0x80, 0x1A, 0x90, 0xA5, 0x57, 0xE0, 0xB4, 0x03, 0x2D, 0x90, 0xA5, 0x54, 0xE0, 0xD3, 0x94, ++0x1B, 0x40, 0x24, 0xE0, 0x24, 0x22, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, 0x24, 0x22, 0xF0, 0x74, 0x12, ++0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x08, 0x90, ++0xA5, 0x5C, 0xE0, 0x90, 0xA5, 0x54, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0xFD, 0x90, 0xA5, 0x56, 0xE0, ++0x90, 0xA6, 0x07, 0xF0, 0xE4, 0xFB, 0xAF, 0x1A, 0x12, 0x68, 0xCD, 0x90, 0xA5, 0x54, 0xE0, 0xFF, ++0x22, 0x90, 0x01, 0xC4, 0x74, 0x61, 0xF0, 0x74, 0x9A, 0xA3, 0xF0, 0xE4, 0xF5, 0x0F, 0x74, 0x87, ++0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, 0xA5, 0x82, 0x75, ++0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, ++0x01, 0x30, 0xE0, 0x03, 0x02, 0xA5, 0x82, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, ++0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xD3, 0x94, 0x00, 0xEE, 0x94, 0x00, 0x50, 0x03, ++0x02, 0xA5, 0x82, 0xE5, 0x0F, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x01, 0xF9, 0x74, 0x8D, 0x35, 0xF0, ++0xFA, 0x7B, 0x01, 0x8B, 0x13, 0xF5, 0x14, 0x89, 0x15, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x81, 0xF5, ++0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0xA5, 0x44, 0xCF, 0xF0, 0xA3, ++0xEF, 0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0xFF, 0x90, ++0xA5, 0x46, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, ++0x12, 0x4A, 0xB5, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xFE, 0x90, 0x00, 0x04, 0x12, 0x4A, 0xE0, 0x2F, ++0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x06, 0x12, 0x4A, 0xE0, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, ++0xFE, 0x90, 0x00, 0x08, 0x12, 0x4A, 0xE0, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0x90, 0xA5, 0x48, 0xF0, ++0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE0, 0xFF, ++0x90, 0xA5, 0x43, 0xF0, 0xBF, 0xBE, 0x03, 0x74, 0x3F, 0xF0, 0x90, 0xA5, 0x43, 0xE0, 0xB4, 0xB3, ++0x03, 0x74, 0x34, 0xF0, 0x90, 0xA5, 0x43, 0xE0, 0x90, 0xA5, 0x41, 0xF0, 0x54, 0x7F, 0xA3, 0xF0, ++0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x96, 0x92, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0x4B, 0xF0, ++0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0x13, 0x13, 0x54, 0x03, ++0x90, 0xA5, 0x4D, 0xF0, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, ++0x20, 0xE2, 0x02, 0x81, 0x13, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, ++0xE0, 0x60, 0x70, 0x90, 0xA5, 0x42, 0xE0, 0xFF, 0xC3, 0x94, 0x0C, 0x40, 0x66, 0xEF, 0xD3, 0x94, ++0x13, 0x50, 0x60, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x14, ++0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x60, 0x03, 0x02, ++0xA5, 0x8E, 0x90, 0xA5, 0x42, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x43, ++0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, 0x04, 0xEB, ++0x90, 0x42, 0x3B, 0x12, 0x4B, 0x88, 0x12, 0x4B, 0x78, 0x12, 0x4B, 0x18, 0x78, 0x01, 0x12, 0x27, ++0x22, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xEE, 0xF0, ++0xA3, 0xEF, 0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0xC3, ++0x94, 0x05, 0x40, 0x03, 0x02, 0xA0, 0xBD, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, ++0xF5, 0x83, 0xE0, 0x30, 0xE7, 0x1F, 0x74, 0x01, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, ++0x83, 0xE0, 0xFD, 0x90, 0xA5, 0x4D, 0xE0, 0x90, 0xA6, 0x07, 0xF0, 0x7B, 0x01, 0xAF, 0x0F, 0x12, ++0x68, 0xCD, 0x02, 0xA0, 0x9B, 0x90, 0xA5, 0x4B, 0xE0, 0xFF, 0x90, 0xA5, 0x42, 0xE0, 0xD3, 0x9F, ++0x40, 0x13, 0x90, 0xA5, 0x4B, 0xE0, 0x90, 0xA5, 0x42, 0xF0, 0x90, 0xA5, 0x41, 0xE0, 0x54, 0x80, ++0xFE, 0xF0, 0xEF, 0x4E, 0xF0, 0x90, 0xA5, 0x42, 0xE0, 0xFF, 0x90, 0x41, 0xE7, 0x93, 0xFE, 0x74, ++0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFD, 0xC3, 0x9E, 0x40, 0x06, ++0xEF, 0x90, 0x41, 0x3F, 0x80, 0x07, 0x90, 0xA5, 0x42, 0xE0, 0x90, 0x41, 0x93, 0x93, 0x90, 0xA5, ++0x4A, 0xF0, 0x90, 0xA4, 0x65, 0xE0, 0x60, 0x54, 0x90, 0xA5, 0x42, 0xE0, 0xFF, 0x64, 0x13, 0x60, ++0x04, 0xEF, 0xB4, 0x0B, 0x05, 0x90, 0xA4, 0x67, 0x80, 0x27, 0x90, 0xA5, 0x42, 0xE0, 0xFF, 0x64, ++0x12, 0x60, 0x04, 0xEF, 0xB4, 0x0A, 0x05, 0x90, 0xA4, 0x68, 0x80, 0x15, 0x90, 0xA5, 0x42, 0xE0, ++0xFF, 0x64, 0x11, 0x60, 0x04, 0xEF, 0xB4, 0x09, 0x05, 0x90, 0xA4, 0x69, 0x80, 0x03, 0x90, 0xA4, ++0x66, 0xE0, 0xF5, 0x19, 0xED, 0xC3, 0x9E, 0x90, 0xA5, 0x42, 0xE0, 0x40, 0x05, 0x90, 0x41, 0x3F, ++0x80, 0x03, 0x90, 0x41, 0x93, 0x93, 0x25, 0x19, 0x90, 0xA5, 0x4A, 0xF0, 0x90, 0xA5, 0x4A, 0xE0, ++0x75, 0xF0, 0x06, 0xA4, 0x24, 0x9D, 0xF9, 0x74, 0x40, 0x35, 0xF0, 0x75, 0x10, 0xFF, 0xF5, 0x11, ++0x89, 0x12, 0x90, 0xA5, 0x41, 0xE0, 0x90, 0x44, 0x93, 0x93, 0xFF, 0xD3, 0x90, 0xA5, 0x47, 0xE0, ++0x9F, 0x90, 0xA5, 0x46, 0xE0, 0x94, 0x00, 0x40, 0x06, 0x12, 0x97, 0x47, 0x02, 0xA4, 0xE1, 0xC3, ++0x90, 0xA5, 0x45, 0xE0, 0x94, 0x0F, 0x90, 0xA5, 0x44, 0xE0, 0x94, 0x00, 0x50, 0x68, 0xAB, 0x13, ++0xAA, 0x14, 0xA9, 0x15, 0x90, 0x00, 0x06, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, 0x90, 0x00, 0x08, ++0x12, 0x4A, 0xE0, 0x2F, 0xFD, 0xE5, 0xF0, 0x3E, 0xFC, 0x90, 0xA5, 0x44, 0xE0, 0xC3, 0x13, 0xFE, ++0xA3, 0xE0, 0x13, 0xFF, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x05, 0x12, 0x97, 0x47, 0x80, 0x36, ++0x90, 0xA5, 0x44, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xAE, 0x04, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, ++0x13, 0xD8, 0xF9, 0xFB, 0xAA, 0x06, 0xEC, 0xC3, 0x13, 0xFE, 0xED, 0x13, 0x2B, 0xFF, 0xEE, 0x3A, ++0xFE, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x12, 0x4A, 0xB5, 0xD3, 0x9F, 0xE5, 0xF0, 0x9E, 0x40, ++0x05, 0xAF, 0x0F, 0x12, 0x90, 0x7D, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, ++0x95, 0xF5, 0x83, 0xE0, 0xF5, 0x16, 0xA3, 0xE0, 0xF5, 0x17, 0x90, 0xA5, 0x44, 0xE0, 0xFE, 0xA3, ++0xE0, 0xFF, 0xD3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x08, 0x90, 0xA5, 0x4C, 0x74, 0x05, 0xF0, ++0x80, 0x16, 0xD3, 0xEF, 0x94, 0xC8, 0xEE, 0x94, 0x00, 0x40, 0x08, 0x90, 0xA5, 0x4C, 0x74, 0x02, ++0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA5, 0x4C, 0xF0, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x12, 0x4A, ++0xB5, 0xFF, 0xAE, 0xF0, 0x90, 0xA5, 0x4C, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, ++0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, 0xAA, 0x11, 0xA9, 0x12, 0x12, 0x26, 0x1E, ++0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, ++0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x90, 0x00, 0x02, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, 0x90, ++0xA5, 0x4C, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, ++0xF9, 0xFF, 0xAB, 0x10, 0xAA, 0x11, 0xA9, 0x12, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFD, 0x7C, ++0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, ++0xAA, 0x14, 0xA9, 0x15, 0x90, 0x00, 0x04, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, 0x90, 0xA5, 0x4C, ++0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, ++0xAB, 0x10, 0xAA, 0x11, 0xA9, 0x12, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, ++0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, 0xAA, 0x14, ++0xA9, 0x15, 0x90, 0x00, 0x06, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, 0x90, 0xA5, 0x4C, 0xE0, 0xFD, ++0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, ++0xAA, 0x11, 0xA9, 0x12, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, ++0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, ++0x90, 0x00, 0x08, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, 0x90, 0xA5, 0x4C, 0xE0, 0xFD, 0xEF, 0xA8, ++0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, 0xAA, 0x11, ++0xA9, 0x12, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, ++0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFD, 0x90, ++0xA5, 0x4C, 0xE0, 0xFF, 0x90, 0xA5, 0x44, 0xE0, 0xFE, 0xA3, 0xE0, 0xA8, 0x07, 0x08, 0x80, 0x05, ++0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x26, 0x98, 0xD3, 0xE5, 0x17, 0x9F, 0xE5, ++0x16, 0x9E, 0x40, 0x0C, 0xE5, 0x17, 0x9F, 0xF5, 0x17, 0xE5, 0x16, 0x9E, 0xF5, 0x16, 0x80, 0x05, ++0xE4, 0xF5, 0x16, 0xF5, 0x17, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, ++0xE0, 0x60, 0x10, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0x14, ++0xF0, 0x80, 0x14, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, ++0xE5, 0x16, 0xF0, 0xA3, 0xE5, 0x17, 0xF0, 0xAE, 0x16, 0xAF, 0x17, 0xE4, 0xFC, 0xFD, 0x90, 0xA5, ++0x42, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x4B, 0x88, 0x12, 0x4B, 0x78, 0xC3, 0x12, ++0x4B, 0x3F, 0x40, 0x03, 0x02, 0xA0, 0x6F, 0x74, 0x91, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x94, ++0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, ++0xFE, 0xD3, 0x9F, 0x40, 0x03, 0xEE, 0x80, 0x1A, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, ++0x9B, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x91, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, ++0xE0, 0xC3, 0x9F, 0x90, 0xA5, 0x4E, 0xF0, 0x90, 0xA5, 0x4E, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x04, ++0xE5, 0x0F, 0x80, 0x2F, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, ++0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xD3, 0x94, 0x01, 0xEE, 0x94, 0x00, 0xE5, 0x0F, 0x40, 0x14, 0x25, ++0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x74, 0xFF, 0xF5, 0xF0, 0x12, 0x4A, ++0x9F, 0x80, 0x0F, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, 0xF0, ++0xA3, 0xF0, 0x90, 0xA5, 0x42, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x4B, 0x88, 0x12, ++0x4B, 0x5C, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xEE, ++0xF0, 0xA3, 0xEF, 0xF0, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, ++0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x70, 0x33, 0xAF, 0x0F, 0x12, 0x90, 0x7D, 0x80, 0x2C, 0x90, ++0xA5, 0x42, 0xE0, 0xFF, 0x25, 0xE0, 0x24, 0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xD3, ++0x74, 0x01, 0x93, 0x95, 0x17, 0xE4, 0x93, 0x95, 0x16, 0x40, 0x10, 0xEF, 0x64, 0x36, 0x60, 0x04, ++0x7D, 0x01, 0x80, 0x02, 0x7D, 0x09, 0xAF, 0x0F, 0x12, 0x97, 0x4B, 0x74, 0x92, 0x25, 0x0F, 0xF5, ++0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x20, 0xE0, 0x02, 0x81, 0xB5, 0x90, 0xA5, 0x42, 0xE0, ++0x64, 0x3F, 0x60, 0x02, 0x81, 0xB5, 0xAF, 0x0F, 0x12, 0x90, 0x7D, 0x81, 0xB5, 0x74, 0x12, 0x25, ++0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0xFF, 0x64, 0x05, 0x60, 0x02, 0x61, 0x0F, ++0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x12, 0x25, ++0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0xE0, 0xFE, 0xB4, 0x05, 0x0D, 0x90, 0xA5, 0x42, ++0xE0, 0xC3, 0x94, 0x3B, 0x50, 0x02, 0x21, 0x77, 0x80, 0x60, 0xEE, 0xB4, 0x04, 0x0B, 0x90, 0xA5, ++0x42, 0xE0, 0xC3, 0x94, 0x31, 0x40, 0x70, 0x80, 0x51, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, ++0x34, 0x96, 0xF5, 0x83, 0xE0, 0xFE, 0xB4, 0x03, 0x0B, 0x90, 0xA5, 0x42, 0xE0, 0xC3, 0x94, 0x19, ++0x40, 0x55, 0x80, 0x36, 0xEE, 0xB4, 0x02, 0x0B, 0x90, 0xA5, 0x42, 0xE0, 0xC3, 0x94, 0x11, 0x40, ++0x46, 0x80, 0x27, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0xE0, 0xFE, ++0xB4, 0x01, 0x0B, 0x90, 0xA5, 0x42, 0xE0, 0xC3, 0x94, 0x0A, 0x40, 0x2B, 0x80, 0x0C, 0xEE, 0x70, ++0x19, 0x90, 0xA5, 0x42, 0xE0, 0xC3, 0x94, 0x03, 0x40, 0x1D, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, ++0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x80, 0x0D, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, ++0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x98, ++0xF5, 0x83, 0xE0, 0x90, 0xA5, 0x4F, 0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, ++0xF5, 0x83, 0xE0, 0xFE, 0xC3, 0x94, 0x30, 0x50, 0x13, 0xE4, 0x90, 0xA5, 0x4F, 0xF0, 0x74, 0x12, ++0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE4, 0x41, 0x52, 0x74, 0x92, 0x25, 0x0F, ++0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x41, 0x7B, 0x74, 0x92, ++0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0x64, 0x0A, 0x60, 0x51, 0xEE, 0x24, ++0x05, 0xFD, 0xE4, 0x33, 0xFC, 0x74, 0x01, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, ++0xE0, 0xFE, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x50, 0x32, 0xEE, 0x24, 0x05, ++0xFD, 0xE4, 0x33, 0xFC, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, ++0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x50, 0x14, 0x74, 0x92, 0x25, 0x0F, 0xF5, ++0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0xA5, 0x42, 0xE0, 0x6E, 0x60, 0x3F, 0x90, ++0xA5, 0x4F, 0xE0, 0xFE, 0x70, 0x04, 0x04, 0xF0, 0x80, 0x0F, 0xEE, 0x90, 0xA5, 0x4F, 0xB4, 0x01, ++0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x05, 0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, ++0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x01, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, ++0x83, 0xEE, 0xF0, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0x80, 0x2B, 0x74, 0x12, ++0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x92, 0x25, 0x0F, 0xF5, ++0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x12, 0xE4, 0x90, 0xA5, 0x4F, 0xF0, ++0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA5, 0x42, ++0xE0, 0xFE, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xEE, 0xF0, 0x90, ++0xA5, 0x4F, 0xE0, 0xFE, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xEE, ++0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x13, ++0x54, 0x03, 0x30, 0xE0, 0x1E, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, ++0xE4, 0xF0, 0x90, 0xA5, 0x4F, 0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, ++0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, 0x12, 0x4B, 0x88, 0xE0, 0x54, ++0xF8, 0xFE, 0x90, 0xA5, 0x52, 0xF0, 0x90, 0xA5, 0x4F, 0xE0, 0x4E, 0xFE, 0x90, 0xA5, 0x52, 0xF0, ++0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, 0x12, 0x4B, 0x88, 0xEE, 0xF0, 0x81, 0xB5, 0xEF, ++0x64, 0x06, 0x60, 0x02, 0x81, 0xB5, 0xF5, 0x16, 0xF5, 0x17, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, ++0xE4, 0x34, 0x98, 0xF5, 0x83, 0xE0, 0x90, 0xA5, 0x4F, 0xF0, 0x90, 0xA5, 0x44, 0xE0, 0xFE, 0xA3, ++0xE0, 0xFF, 0xD3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x08, 0x90, 0xA5, 0x4C, 0x74, 0x05, 0xF0, ++0x80, 0x16, 0xD3, 0xEF, 0x94, 0xFA, 0xEE, 0x94, 0x00, 0x40, 0x08, 0x90, 0xA5, 0x4C, 0x74, 0x02, ++0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA5, 0x4C, 0xF0, 0x90, 0xA5, 0x4C, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, ++0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x44, 0xEC, 0xE4, 0x93, ++0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0x90, 0xA5, 0x50, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xF5, ++0x18, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x75, 0xF0, 0x02, 0xE5, 0x18, 0xA4, 0xF5, 0x82, 0x85, ++0xF0, 0x83, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, 0x90, 0xA5, 0x4C, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, ++0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xE5, 0x18, 0x90, 0x44, 0xE7, ++0x93, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, ++0x16, 0xC3, 0x90, 0xA5, 0x51, 0xE0, 0x95, 0x17, 0x90, 0xA5, 0x50, 0xE0, 0x95, 0x16, 0x40, 0x07, ++0x05, 0x18, 0xE5, 0x18, 0xB4, 0x05, 0xAA, 0xE5, 0x18, 0xC3, 0x13, 0xF5, 0x18, 0x90, 0xA5, 0x4F, ++0xE0, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x90, 0xA5, 0x53, 0xF0, 0xD3, ++0x95, 0x18, 0x40, 0x06, 0xE0, 0x95, 0x18, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA5, 0x53, 0xF0, 0x74, ++0x81, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xC3, 0x13, 0xFF, 0x90, 0xA5, ++0x53, 0xE0, 0xC4, 0x33, 0x54, 0xE0, 0x2F, 0x04, 0xFF, 0x74, 0x81, 0x25, 0x0F, 0xF5, 0x82, 0xE4, ++0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x81, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, ++0x83, 0xE0, 0xC3, 0x94, 0xC0, 0x40, 0x0E, 0x74, 0x81, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, ++0xF5, 0x83, 0x74, 0xC0, 0xF0, 0x74, 0x81, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, ++0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA5, 0x53, 0xF0, 0xE0, 0x25, 0xE0, 0xF0, 0x70, 0x02, ++0x80, 0x05, 0x90, 0xA5, 0x53, 0xE0, 0x14, 0x90, 0xA5, 0x4F, 0xF0, 0xD3, 0x90, 0xA5, 0x47, 0xE0, ++0x94, 0x03, 0x90, 0xA5, 0x46, 0xE0, 0x94, 0x00, 0x40, 0x05, 0xE4, 0x90, 0xA5, 0x4F, 0xF0, 0x90, ++0xA5, 0x4F, 0xE0, 0xFF, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xEF, ++0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0xF8, 0xFE, ++0x90, 0xA5, 0x52, 0xF0, 0xEF, 0x4E, 0xFF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, ++0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, ++0xE0, 0xD3, 0x94, 0x05, 0x74, 0x12, 0x50, 0x0E, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, ++0x83, 0xE0, 0x04, 0xF0, 0x80, 0x0B, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE4, ++0xF0, 0x90, 0xA5, 0x46, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, ++0x9E, 0xFC, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, ++0xFA, 0xA3, 0xE0, 0xD3, 0x9D, 0xEA, 0x9C, 0xE5, 0x0F, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x12, 0xF5, ++0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x4A, 0x9F, 0x80, 0x10, 0x25, 0xE0, ++0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0x90, 0xA5, ++0x48, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, 0x9E, 0xFC, 0xE5, ++0x0F, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xFA, 0xA3, 0xE0, ++0xD3, 0x9D, 0xEA, 0x9C, 0xE5, 0x0F, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, ++0x9F, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x4A, 0x9F, 0x80, 0x10, 0x25, 0xE0, 0x24, 0x12, 0xF5, ++0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xE4, 0xFD, 0xAF, 0x0F, 0x12, ++0x68, 0x40, 0x05, 0x0F, 0xE5, 0x0F, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x9A, 0x6E, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x26, 0x90, 0xA4, 0x8E, 0xE0, 0x04, 0xF0, 0x75, 0xF0, ++0x04, 0xEF, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0x1F, 0x90, 0xA6, 0x23, 0xF0, 0x24, ++0xF5, 0x50, 0x0D, 0x60, 0x6D, 0x14, 0x60, 0x70, 0x14, 0x60, 0x73, 0x14, 0x60, 0x76, 0x80, 0x7D, ++0xE4, 0xF5, 0x27, 0x75, 0xF0, 0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0x12, 0x4B, 0x88, 0xE5, 0x82, ++0x25, 0x27, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA6, 0x23, 0xE0, 0x75, ++0xF0, 0x07, 0xA4, 0x24, 0x50, 0xF5, 0x82, 0xE4, 0x34, 0x40, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x27, ++0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0xEF, 0x5E, 0xFF, 0x90, 0xA6, 0x25, ++0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0x12, 0x4B, 0x88, 0xE5, 0x82, 0x25, 0x27, ++0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x27, 0xE5, 0x27, 0xB4, 0x07, 0xA3, ++0x80, 0x1B, 0xAD, 0x26, 0x7F, 0x8C, 0x80, 0x10, 0xAD, 0x26, 0x7F, 0x94, 0x80, 0x0A, 0xAD, 0x26, ++0x7F, 0x9C, 0x80, 0x04, 0xAD, 0x26, 0x7F, 0xA4, 0x7E, 0x04, 0x12, 0x8E, 0x7D, 0x75, 0xF0, 0x04, ++0xE5, 0x26, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0xC4, 0x54, 0x03, 0xFD, 0xE4, 0x90, ++0xA6, 0x21, 0xF0, 0x7C, 0x06, 0x75, 0xF0, 0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0xBC, 0x06, 0x12, ++0x12, 0x4B, 0x88, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x54, 0x0F, ++0x80, 0x0E, 0x12, 0x4B, 0x88, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, ++0x90, 0xA6, 0x24, 0xF0, 0x90, 0xA6, 0x24, 0xE0, 0x60, 0x64, 0x75, 0x27, 0x07, 0x74, 0x01, 0x7E, ++0x00, 0xA8, 0x27, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0xA6, ++0x24, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x3E, 0xEC, 0x75, 0xF0, 0x08, 0xA4, 0x25, 0x27, 0x90, 0xA6, ++0x21, 0xF0, 0xBD, 0x01, 0x0C, 0xE0, 0xD3, 0x94, 0x0B, 0x40, 0x06, 0xE0, 0x24, 0x20, 0xF0, 0x80, ++0x39, 0xBD, 0x02, 0x0F, 0x90, 0xA6, 0x21, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x06, 0xE0, 0x24, 0x18, ++0xF0, 0x80, 0x27, 0xBD, 0x03, 0x24, 0x90, 0xA6, 0x21, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x1B, 0xE0, ++0x24, 0x22, 0xF0, 0x80, 0x15, 0x15, 0x27, 0xE5, 0x27, 0xC3, 0x94, 0x00, 0x50, 0x9F, 0xEC, 0x60, ++0x09, 0x1C, 0xEC, 0xC3, 0x94, 0x00, 0x40, 0x02, 0xC1, 0x55, 0xE4, 0x90, 0xA6, 0x22, 0xF0, 0xFC, ++0x75, 0xF0, 0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0xBC, 0x06, 0x12, 0x12, 0x4B, 0x88, 0xE5, 0x82, ++0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x80, 0x0E, 0x12, 0x4B, 0x88, ++0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x90, 0xA6, 0x24, 0xF0, 0x90, ++0xA6, 0x24, 0xE0, 0x60, 0x63, 0xE4, 0xF5, 0x27, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x27, 0x08, 0x80, ++0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0xA6, 0x24, 0xE0, 0xFB, 0xEF, 0x5B, ++0x60, 0x3E, 0xEC, 0x75, 0xF0, 0x08, 0xA4, 0x25, 0x27, 0x90, 0xA6, 0x22, 0xF0, 0xBD, 0x01, 0x0C, ++0xE0, 0xD3, 0x94, 0x0B, 0x40, 0x06, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x34, 0xBD, 0x02, 0x0F, 0x90, ++0xA6, 0x22, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x06, 0xE0, 0x24, 0x18, 0xF0, 0x80, 0x22, 0xBD, 0x03, ++0x1F, 0x90, 0xA6, 0x22, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x16, 0xE0, 0x24, 0x22, 0xF0, 0x80, 0x10, ++0x05, 0x27, 0xE5, 0x27, 0x64, 0x08, 0x70, 0xA0, 0x0C, 0xEC, 0x64, 0x07, 0x60, 0x02, 0xE1, 0x00, ++0x90, 0xA6, 0x21, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, 0x96, 0x92, 0x12, 0x4B, 0x88, ++0xEF, 0xF0, 0x90, 0xA6, 0x22, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, 0x96, 0x93, 0x12, ++0x4B, 0x88, 0xEE, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x26, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE0, ++0xFC, 0x54, 0x7F, 0xFD, 0xEC, 0x54, 0x80, 0xFC, 0xED, 0xD3, 0x9F, 0x40, 0x05, 0x90, 0xA6, 0x21, ++0x80, 0x08, 0xED, 0xC3, 0x9E, 0x50, 0x06, 0x90, 0xA6, 0x22, 0xE0, 0x4C, 0xFD, 0x74, 0x92, 0x25, ++0x26, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xED, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, ++0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA6, 0x07, 0xF0, 0xE4, 0xFB, ++0xAF, 0x26, 0x12, 0x68, 0xCD, 0x75, 0xF0, 0x10, 0xE5, 0x26, 0x90, 0x81, 0x03, 0x12, 0x4B, 0x88, ++0xE4, 0xF0, 0x90, 0xA6, 0x21, 0xE0, 0xFF, 0xC3, 0x94, 0x36, 0x40, 0x10, 0x74, 0x12, 0x25, 0x26, ++0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x80, 0x6A, 0xEF, 0xC3, 0x94, 0x2C, ++0x40, 0x10, 0x74, 0x12, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x74, 0x04, 0xF0, ++0x80, 0x54, 0x90, 0xA6, 0x21, 0xE0, 0xFF, 0xC3, 0x94, 0x14, 0x40, 0x10, 0x74, 0x12, 0x25, 0x26, ++0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x74, 0x03, 0xF0, 0x80, 0x3A, 0xEF, 0xC3, 0x94, 0x0C, ++0x40, 0x10, 0x74, 0x12, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x74, 0x02, 0xF0, ++0x80, 0x24, 0x90, 0xA6, 0x21, 0xE0, 0xC3, 0x94, 0x04, 0x74, 0x12, 0x40, 0x0E, 0x25, 0x26, 0xF5, ++0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x80, 0x0B, 0x25, 0x26, 0xF5, 0x82, 0xE4, ++0x34, 0x96, 0xF5, 0x83, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA5, 0x44, 0x12, 0x4B, ++0x9D, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x12, 0x26, 0x1E, 0x54, 0x7F, 0xFD, 0x90, 0x00, 0x01, ++0x12, 0x26, 0x37, 0xFE, 0x54, 0x1F, 0x90, 0xA5, 0x48, 0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, ++0x13, 0x54, 0x01, 0x90, 0xA5, 0x47, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFE, 0x54, 0x03, ++0xFF, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0xA5, 0x4A, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, ++0x37, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA5, 0x49, 0xF0, 0xEE, 0x54, 0x80, ++0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFE, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFB, 0x54, 0x08, ++0x13, 0x13, 0x13, 0x54, 0x1F, 0xFC, 0x90, 0xA5, 0x4B, 0xF0, 0xEB, 0x54, 0x04, 0x13, 0x13, 0x54, ++0x3F, 0xA3, 0xF0, 0xEE, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0xFE, 0x75, 0xF0, 0x04, ++0xED, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0x7F, 0x4E, 0xF0, 0x90, 0xA5, 0x49, 0xE0, ++0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x95, 0x12, ++0x4B, 0x88, 0xE0, 0x54, 0xBF, 0x4E, 0xF0, 0xEC, 0x60, 0x02, 0x41, 0x34, 0x90, 0xA5, 0x48, 0xE0, ++0x54, 0x1F, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0xE0, ++0x4E, 0xF0, 0xEF, 0x54, 0x03, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, ++0xE0, 0x54, 0xFC, 0x4E, 0xF0, 0xEF, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x75, 0xF0, 0x04, ++0xED, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0xF3, 0x4F, 0xF0, 0x90, 0xA5, 0x47, 0xE0, ++0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x94, 0x12, 0x4B, ++0x88, 0xE0, 0x54, 0xDF, 0x4F, 0xF0, 0x90, 0xA5, 0x4A, 0xE0, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0xFF, ++0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0xCF, 0x4F, 0xF0, 0x74, ++0x92, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0x74, 0x92, 0x2D, ++0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA5, 0x4C, ++0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xE4, 0xFC, 0xEC, ++0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x8F, 0x82, 0x8E, 0x83, ++0x12, 0x26, 0x37, 0xFF, 0x75, 0xF0, 0x08, 0xED, 0x90, 0x89, 0x00, 0x12, 0x4B, 0x88, 0xE5, 0x82, ++0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x0C, 0xEC, 0xB4, 0x04, 0xD0, 0xAF, ++0x05, 0x12, 0xA5, 0x8F, 0x22, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x9D, 0x12, 0x26, 0x1E, 0xF5, 0x0F, ++0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFE, 0xF0, 0x74, 0x92, 0x25, ++0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA5, ++0x44, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x54, 0x01, 0xFE, 0xEF, 0x4E, 0xD0, ++0x82, 0xD0, 0x83, 0xF0, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, ++0x54, 0xFD, 0xF0, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xC0, 0x83, ++0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, ++0x54, 0x02, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xE5, 0x0F, 0xC3, 0x94, 0x80, 0x50, ++0x15, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, ++0x9B, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0xE5, 0x0F, 0xB4, 0x80, 0x0A, 0x90, 0x00, 0x02, 0x12, 0x26, ++0x37, 0x90, 0x96, 0x11, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0xFD, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, ++0xFC, 0xED, 0xC3, 0x94, 0x80, 0x90, 0xA5, 0x46, 0xED, 0x50, 0x3F, 0xF0, 0x25, 0xE0, 0x24, 0x12, ++0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA5, 0x47, 0xF0, 0xEE, ++0xA3, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xFE, ++0xA3, 0xE0, 0x90, 0xA5, 0x49, 0xF0, 0xEE, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, 0x81, 0x00, ++0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0x4B, 0xF0, 0x80, 0x01, 0xF0, 0xEC, 0xC3, 0x94, 0x80, 0x90, ++0xA5, 0x4C, 0xEC, 0x50, 0x3F, 0xF0, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, ++0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA5, 0x4D, 0xF0, 0xEE, 0xA3, 0xF0, 0xEC, 0x25, 0xE0, 0x24, ++0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA5, 0x4F, 0xF0, ++0xEE, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, ++0x51, 0xF0, 0x80, 0x01, 0xF0, 0x90, 0xA5, 0x44, 0x74, 0x04, 0xF0, 0x90, 0xA5, 0x52, 0x74, 0x0C, ++0xF0, 0xED, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, ++0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, ++0xF0, 0xED, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, ++0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, ++0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x44, 0x12, 0x6C, 0x61, 0x7F, 0x04, 0x02, 0x63, 0x18, 0x75, ++0xF0, 0x10, 0xEF, 0x90, 0x81, 0x03, 0x12, 0x4B, 0x88, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0x90, 0x00, ++0x8F, 0xE0, 0x30, 0xE6, 0x58, 0x90, 0x00, 0x8D, 0xE0, 0x64, 0x03, 0x70, 0x50, 0x90, 0x00, 0x8F, ++0xE0, 0xFE, 0x90, 0x00, 0x8E, 0xE0, 0xFD, 0xED, 0xFF, 0x90, 0xA5, 0x3E, 0xEE, 0xF0, 0xA3, 0xEF, ++0xF0, 0xE4, 0x90, 0xA5, 0x3D, 0xF0, 0x90, 0xA5, 0x3D, 0xE0, 0xFD, 0xFF, 0x90, 0xA5, 0x3F, 0xE0, ++0x2F, 0xFF, 0x90, 0xA5, 0x3E, 0xE0, 0x34, 0x00, 0x8F, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, ++0x12, 0x56, 0x60, 0x90, 0xA5, 0x3D, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD7, 0x90, ++0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x56, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, ++0x49, 0x90, 0x00, 0x8D, 0xE0, 0x64, 0x01, 0x70, 0x41, 0x90, 0xA6, 0x57, 0xF0, 0x90, 0xA6, 0x57, ++0xE0, 0xFD, 0x90, 0xA6, 0x56, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE5, ++0x82, 0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x56, 0x60, ++0x90, 0xA6, 0x57, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD1, 0x90, 0x00, 0x8F, 0xE0, ++0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, ++0x00, 0x8F, 0xE0, 0x30, 0xE5, 0x2A, 0x90, 0x00, 0x8E, 0xE0, 0x64, 0x05, 0x70, 0x22, 0xA3, 0xE0, ++0xFF, 0x90, 0x00, 0x8E, 0xE0, 0xFE, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, ++0xEE, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8E, 0x12, 0x3A, 0x96, ++0x22, 0x90, 0xA5, 0x3D, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x4C, 0x90, 0x00, 0x8D, ++0xE0, 0x64, 0x03, 0x70, 0x44, 0x90, 0xA5, 0x3E, 0xF0, 0x90, 0xA5, 0x3E, 0xE0, 0xFD, 0x90, 0xA5, ++0x3D, 0xE0, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, ++0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x56, 0x60, 0x90, ++0xA5, 0x3E, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCE, 0x90, 0x00, 0x8F, 0xE0, 0x30, ++0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0x90, 0xA6, 0x5F, 0xE0, 0x75, 0xF0, ++0x04, 0xA4, 0xFF, 0xAE, 0xF0, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0xA5, 0xA8, 0x12, 0x27, ++0x48, 0x7F, 0xAC, 0x7E, 0x08, 0x90, 0xA5, 0xA2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x36, 0xCE, ++0x90, 0xA5, 0xAC, 0x12, 0x27, 0x48, 0x90, 0xA5, 0xA4, 0x12, 0x4B, 0x50, 0x12, 0x27, 0x15, 0x90, ++0xA5, 0xAC, 0x12, 0x4B, 0x6C, 0x12, 0x4B, 0x25, 0x90, 0xA5, 0xA8, 0x12, 0x4B, 0x6C, 0x12, 0x4B, ++0x32, 0x90, 0xA5, 0xB0, 0x12, 0x27, 0x48, 0x90, 0xA5, 0xB0, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, ++0x12, 0x27, 0x48, 0x90, 0xA5, 0xA2, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x02, 0x37, 0x5D, 0x90, 0xA6, ++0x4A, 0xED, 0xF0, 0x90, 0xA6, 0x49, 0xEF, 0xF0, 0x60, 0x02, 0xC1, 0x2B, 0x90, 0xA5, 0xA4, 0x12, ++0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, ++0x74, 0x08, 0xFF, 0xFE, 0xB1, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, ++0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x2C, 0x7E, 0x08, 0xB1, 0x45, ++0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0F, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, ++0x00, 0x00, 0x00, 0x00, 0x12, 0xB1, 0xD5, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, ++0xF0, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x7F, 0x0C, 0x7E, 0x08, 0xB1, ++0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x0F, 0x00, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, ++0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0x04, 0x7E, 0x0A, 0xB1, 0x45, 0x90, 0x04, 0x54, 0xE0, 0x54, ++0x7F, 0x90, 0xA6, 0x4B, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x22, 0x90, 0xA6, 0x49, 0xE0, 0x64, ++0x01, 0x60, 0x02, 0xC1, 0xDD, 0x90, 0x04, 0x54, 0xE0, 0x44, 0x80, 0x90, 0xA6, 0x4B, 0xF0, 0xE0, ++0x90, 0x04, 0x54, 0xF0, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA5, ++0xA8, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0xB1, 0x45, 0x90, 0xA5, ++0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, ++0x00, 0x01, 0x7F, 0x2C, 0x7E, 0x08, 0xB1, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, ++0x0F, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, 0x00, 0x12, 0xB1, 0xD5, 0x90, ++0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0x00, 0x7F, 0x0C, 0x7E, 0x08, 0xB1, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x0F, ++0x00, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x0F, 0x00, 0x00, 0x00, 0x7F, 0x04, 0x7E, ++0x0A, 0xB1, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA5, 0xA8, ++0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0xB1, 0x45, 0x22, 0x90, 0xA6, ++0x5F, 0xED, 0xF0, 0xEF, 0x14, 0x60, 0x23, 0x14, 0x70, 0x02, 0xE1, 0x8C, 0x24, 0x02, 0x60, 0x02, ++0xE1, 0xDA, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA5, 0xA8, 0x12, ++0x27, 0x54, 0x00, 0x30, 0x02, 0x00, 0x7F, 0xAC, 0xE1, 0xD6, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, ++0x00, 0x30, 0x03, 0xC3, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x01, 0xB1, 0x41, ++0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, 0xB1, 0x2A, 0x90, 0xA5, 0xA4, 0x12, ++0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x5F, 0xE0, 0x7E, 0x00, 0x78, 0x1C, 0xC3, 0x33, ++0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0xA5, 0xA8, 0x12, ++0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0xB1, 0x45, 0x90, 0xA6, 0x5F, 0xE0, 0x90, 0xA5, 0xA4, 0xB4, ++0x01, 0x13, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0x10, 0x80, 0x11, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0xA5, 0xA8, 0x12, ++0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, 0x0A, 0x80, 0x4C, 0x90, 0xA5, 0xA4, 0x12, ++0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x02, ++0xB1, 0x41, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, 0xB1, 0x2A, 0x90, 0xA5, ++0xA4, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x5F, 0xE0, 0x7E, 0x00, 0x78, 0x1C, ++0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0xA5, ++0xA8, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0xB1, 0x45, 0x22, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, ++0xFE, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x90, 0xA5, 0x90, ++0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA5, 0x8F, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x3A, ++0xA9, 0x90, 0xA5, 0x9A, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x92, 0x12, 0x4B, 0x50, 0x12, 0x27, 0x15, ++0x90, 0xA5, 0x9A, 0x12, 0x4B, 0x6C, 0x12, 0x4B, 0x25, 0x90, 0xA5, 0x96, 0x12, 0x4B, 0x6C, 0x12, ++0x4B, 0x32, 0x90, 0xA5, 0x9E, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x90, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, ++0x90, 0xA5, 0x9E, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0x96, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x8F, 0xE0, ++0xFF, 0xD0, 0x05, 0x02, 0x39, 0xBA, 0xEF, 0x14, 0x60, 0x3A, 0x14, 0x60, 0x53, 0x24, 0x02, 0x70, ++0x6C, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x0C, 0x00, 0x12, 0xAF, 0xE7, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, ++0x0C, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, ++0x7F, 0x01, 0x80, 0x36, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA5, ++0x96, 0x12, 0x27, 0x54, 0x00, 0x00, 0x04, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x80, 0x1A, ++0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, ++0x00, 0x00, 0x00, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0xAF, 0xED, 0x22, 0x90, 0xA6, ++0x47, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA6, 0x46, 0xEF, 0xF0, 0xE4, 0xFE, 0x11, 0xF4, 0x90, ++0xA6, 0x46, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0x31, 0x27, 0xAE, 0x07, 0x90, 0x04, ++0x83, 0xEE, 0xF0, 0x90, 0xA6, 0x46, 0xE0, 0xFF, 0xAD, 0x06, 0x12, 0xAE, 0xDE, 0x90, 0xA6, 0x46, ++0xE0, 0xFF, 0x01, 0x46, 0xA9, 0x07, 0x90, 0x06, 0x69, 0xE0, 0xFE, 0x90, 0x06, 0x68, 0xE0, 0x7A, ++0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0xFE, 0xE9, 0x14, 0x60, 0x13, 0x14, 0x60, 0x10, 0x24, 0x02, ++0x70, 0x14, 0xEE, 0x54, 0xFE, 0xFE, 0xEF, 0x54, 0x7F, 0x90, 0x06, 0x68, 0x80, 0x04, 0x90, 0x06, ++0x68, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xE4, 0xFE, 0xFC, 0xEF, 0x64, 0x02, 0x70, 0x40, 0xED, ++0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, 0x06, 0xED, 0xB4, 0x02, 0x02, 0x7E, 0x09, 0xEB, 0xB4, 0x01, ++0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x04, 0x80, 0x38, 0xEB, 0xB4, 0x02, 0x08, 0xED, 0xB4, 0x01, ++0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, ++0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, 0xED, 0x64, 0x02, 0x70, 0x16, 0x7C, 0x03, 0x80, 0x12, 0xEF, ++0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7C, ++0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4C, 0xFF, 0x22, 0x90, 0x04, 0x54, 0xE0, 0x7F, 0x00, ++0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x90, 0xA6, 0x5B, 0xED, 0xF0, 0x90, 0xA6, 0x5A, 0xEF, 0xF0, ++0xD3, 0x94, 0x0E, 0x50, 0x15, 0x31, 0x8A, 0xEF, 0x60, 0x2A, 0x31, 0x8A, 0xEF, 0x64, 0x01, 0x70, ++0x23, 0x90, 0xA6, 0x5B, 0xE0, 0xFD, 0xE4, 0xFF, 0x80, 0x15, 0x90, 0xA6, 0x5A, 0xE0, 0xD3, 0x94, ++0x0E, 0x40, 0x11, 0x31, 0x8A, 0xEF, 0x70, 0x0A, 0x90, 0xA6, 0x5B, 0xE0, 0xFD, 0x7F, 0x01, 0x02, ++0xAD, 0x8E, 0x31, 0x8A, 0x22, 0x7F, 0x1C, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA6, 0x49, 0xE0, ++0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA6, 0x60, 0xED, 0xF0, 0xEF, 0x60, 0x02, 0x41, 0xC3, 0xE0, 0x24, ++0xFD, 0x50, 0x07, 0x60, 0x36, 0x14, 0x60, 0x64, 0x81, 0x9F, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, ++0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, ++0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, ++0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x61, 0x75, 0x90, 0xA5, 0xA4, 0x12, 0x27, ++0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0x7F, ++0xB0, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, ++0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0x81, 0x47, 0x90, 0xA5, 0xA4, 0x12, ++0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, ++0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, ++0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, ++0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, ++0x27, 0x54, 0x00, 0x10, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, ++0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x10, 0x00, ++0x00, 0x81, 0x12, 0x90, 0xA6, 0x60, 0xE0, 0x14, 0x60, 0x7C, 0x14, 0x70, 0x02, 0x61, 0xAD, 0x14, ++0x70, 0x02, 0x81, 0x18, 0x14, 0x70, 0x02, 0x61, 0xAD, 0x24, 0x04, 0x60, 0x02, 0x81, 0x9F, 0x90, ++0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, ++0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, ++0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, ++0x7E, 0x0E, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, ++0xA5, 0xA8, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0xAD, 0x45, ++0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, ++0x01, 0x00, 0x00, 0x00, 0x81, 0x12, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, ++0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0xAD, ++0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, ++0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, ++0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, ++0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, ++0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x80, 0x65, 0x90, 0xA5, 0xA4, ++0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, ++0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, ++0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, ++0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, ++0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, ++0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x01, 0x00, ++0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0E, 0x81, 0x9C, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, ++0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, ++0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, ++0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0xAD, 0x45, 0x90, 0xA5, ++0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x01, 0x00, ++0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x3F, ++0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, ++0x0E, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0x03, 0x90, 0xA5, ++0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x09, 0x12, 0xAD, 0x45, 0x22, ++0x90, 0xA4, 0x55, 0xE0, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x42, 0xEF, 0xB4, 0x01, 0x18, 0x90, 0xA4, ++0x5C, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x37, ++0x5D, 0x90, 0xA4, 0x5C, 0x80, 0x16, 0x90, 0xA4, 0x58, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, ++0x27, 0x48, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xA4, 0x58, 0x12, 0x4B, 0x50, 0x90, ++0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x58, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x22, 0x90, 0xA5, 0xD2, ++0x74, 0x0A, 0xF0, 0x90, 0xA5, 0xE0, 0x74, 0x06, 0xF0, 0x12, 0x26, 0x1E, 0x90, 0xA5, 0xD4, 0xF0, ++0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA5, 0xD5, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, ++0x90, 0xA5, 0xD6, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x90, 0xA5, 0xD7, 0xF0, 0x90, 0x00, ++0x04, 0x12, 0x26, 0x37, 0x90, 0xA5, 0xD8, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0x90, 0xA5, ++0xD9, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0xD2, 0x02, 0x6C, 0x61, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, ++0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x02, 0xC1, 0xCD, 0x90, 0xA4, 0x2F, 0xE0, 0x64, 0x01, 0x70, ++0x34, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x06, 0x90, 0x04, 0xE3, 0xE0, 0x60, 0x1C, 0x90, 0x06, ++0x92, 0x74, 0x04, 0xF0, 0x90, 0xA4, 0x3B, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x30, 0xE0, 0xFF, 0x90, ++0xA4, 0x3B, 0xE0, 0xB5, 0x07, 0x02, 0x80, 0x02, 0xC1, 0xB8, 0xE4, 0x90, 0xA4, 0x2F, 0xF0, 0x90, ++0xA4, 0x39, 0x04, 0xF0, 0x22, 0x90, 0xA4, 0x2F, 0xE0, 0x64, 0x04, 0x70, 0x35, 0x90, 0x06, 0x92, ++0xE0, 0x20, 0xE2, 0x06, 0x90, 0x04, 0xE3, 0xE0, 0x60, 0x1C, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, ++0x90, 0xA4, 0x3B, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x32, 0xE0, 0xFF, 0x90, 0xA4, 0x3B, 0xE0, 0xB5, ++0x07, 0x02, 0x80, 0x02, 0xC1, 0xB8, 0xE4, 0x90, 0xA4, 0x2F, 0xF0, 0x90, 0xA4, 0x39, 0x74, 0x04, ++0xF0, 0x22, 0x90, 0xA4, 0x2F, 0xE0, 0x64, 0x06, 0x60, 0x02, 0xC1, 0x81, 0x90, 0xA4, 0x3C, 0xE0, ++0xB4, 0x04, 0x0F, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x54, 0x0F, 0x90, 0xA4, 0x39, 0x30, 0xE0, 0x4F, ++0xC1, 0xAB, 0x90, 0xA4, 0x2E, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x45, 0xEF, 0x54, ++0xFB, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x02, 0xC1, ++0x90, 0x90, 0xA4, 0x3C, 0xE0, 0xFF, 0x90, 0xA4, 0x3B, 0xE0, 0x2F, 0xFF, 0xE4, 0x33, 0xFE, 0x7C, ++0x00, 0x7D, 0x03, 0x12, 0x26, 0x98, 0x90, 0xA4, 0x33, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0xC3, ++0xEF, 0x94, 0x32, 0xEE, 0x64, 0x80, 0x94, 0x80, 0x90, 0xA4, 0x39, 0x40, 0x02, 0x80, 0x7C, 0x74, ++0x02, 0xF0, 0x22, 0x12, 0x84, 0xE2, 0x90, 0xA4, 0x3C, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x75, ++0x3C, 0x03, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x53, 0x74, 0x05, ++0xF0, 0x90, 0xA4, 0x3C, 0xE0, 0xFF, 0x90, 0xA4, 0x3B, 0xE0, 0x2F, 0xFF, 0xE4, 0x33, 0xFE, 0x7C, ++0x00, 0x7D, 0x03, 0x12, 0x26, 0x98, 0x90, 0xA4, 0x33, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0xC3, ++0xEF, 0x94, 0x32, 0xEE, 0x64, 0x80, 0x94, 0x80, 0x40, 0x53, 0x90, 0x07, 0x78, 0x74, 0x03, 0xF0, ++0x22, 0x90, 0xA4, 0x2F, 0xE0, 0x64, 0x07, 0x70, 0x44, 0x90, 0xA4, 0x3C, 0xE0, 0xB4, 0x04, 0x05, ++0x90, 0xA4, 0x39, 0x80, 0x16, 0x90, 0xA4, 0x2E, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, ++0x0E, 0xEF, 0x54, 0xFB, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0xA4, 0x39, 0x74, 0x05, 0xF0, 0x22, 0x12, ++0x84, 0xE2, 0x90, 0xA4, 0x3C, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x75, 0x3C, 0x03, 0xFB, 0xFD, ++0x7F, 0x50, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x53, 0x74, 0x05, 0xF0, 0x22, 0x90, 0xA4, ++0x27, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, ++0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, ++0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, ++0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, ++0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x90, 0xA4, 0x2D, 0xE0, 0x54, 0xDF, ++0xF0, 0xE4, 0x90, 0xA4, 0x2C, 0xF0, 0x90, 0xA4, 0x2E, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, ++0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA4, 0x35, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, ++0xA3, 0x74, 0x02, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x41, 0xE0, 0x54, 0xFE, 0xF0, ++0x54, 0xE1, 0xF0, 0xE4, 0x90, 0xA4, 0x3E, 0xF0, 0x90, 0xA4, 0x4B, 0xE0, 0x54, 0xFE, 0xF0, 0x54, ++0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x54, 0xEF, ++0xF0, 0x54, 0xDF, 0xF0, 0x22, 0xE4, 0x90, 0xA5, 0x5E, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0x20, 0xE0, ++0x03, 0x02, 0xB8, 0x0F, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x2A, ++0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x33, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, ++0x12, 0x34, 0x8C, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0x90, 0xA4, 0x2F, 0x74, 0x01, 0xF0, 0xE4, ++0x90, 0xA4, 0x3B, 0xF0, 0x90, 0xA4, 0x39, 0xF0, 0x80, 0x20, 0xE4, 0xF5, 0x3B, 0x90, 0xA5, 0x5E, ++0xE0, 0xFF, 0x90, 0xA4, 0x28, 0xE0, 0xC3, 0x9F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, ++0x01, 0x12, 0x34, 0x8C, 0x90, 0xA4, 0x39, 0x74, 0x01, 0xF0, 0x90, 0x01, 0x53, 0x74, 0x05, 0xF0, ++0x90, 0xA4, 0x38, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x22, 0xE0, 0x60, 0x07, 0x90, 0x05, 0x22, 0x74, ++0x6F, 0xF0, 0x22, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xFF, 0xC4, 0x13, 0x54, ++0x07, 0x20, 0xE0, 0x0B, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x76, 0xC4, 0x22, ++0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0xA4, 0x6E, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, ++0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x6F, 0xF0, 0x22, ++0xE4, 0x90, 0xA4, 0x0B, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, ++0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0xA4, 0x11, 0x74, 0x01, ++0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, ++0x90, 0xA4, 0x14, 0xF0, 0x90, 0xA4, 0x13, 0x74, 0x07, 0xF0, 0x90, 0xA4, 0x16, 0xE4, 0xF0, 0xA3, ++0x74, 0x02, 0xF0, 0xE4, 0x90, 0xA4, 0x0F, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xFE, 0xF0, 0x90, ++0xA4, 0x0D, 0x74, 0x0C, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0xA4, 0x0E, 0x74, ++0x0C, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, ++0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0xA4, 0x18, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, ++0x00, 0x90, 0xA2, 0x95, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0xA4, 0x15, 0x74, 0xFF, 0xF0, 0x80, 0x12, ++0x90, 0xA2, 0x95, 0xE0, 0x90, 0xA4, 0x15, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, ++0x41, 0xF0, 0x90, 0xA4, 0x1C, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, ++0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x54, ++0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0xE4, 0xA3, ++0xF0, 0x22, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, ++0x54, 0x07, 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x90, 0xA4, 0x27, 0xE0, 0x30, ++0xE0, 0x21, 0x90, 0xA4, 0x38, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x40, 0xF0, 0x21, 0xB9, ++0x90, 0xA4, 0x0D, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x32, 0x90, 0xA4, 0x22, 0xE0, 0x60, ++0x70, 0x80, 0x66, 0x31, 0x02, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, ++0x80, 0x67, 0x90, 0xA4, 0x0F, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, ++0xF0, 0x80, 0x56, 0x90, 0xA4, 0x0D, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x08, 0x90, 0x01, 0xB8, ++0x74, 0x04, 0xF0, 0x80, 0x44, 0xEF, 0x30, 0xE2, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, ++0x38, 0x90, 0xA4, 0x0F, 0xE0, 0x30, 0xE4, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x29, ++0x90, 0xA4, 0x09, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x20, ++0xF0, 0x80, 0x16, 0x90, 0xA4, 0x22, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x80, 0xF0, 0x80, ++0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x7F, ++0x00, 0x22, 0x90, 0x02, 0x96, 0xE0, 0xFF, 0x90, 0x02, 0x87, 0xE0, 0x4F, 0x60, 0x08, 0x90, 0x01, ++0xB8, 0x74, 0x01, 0xF0, 0x80, 0x17, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, ++0x74, 0x04, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, ++0x74, 0x08, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0xA4, 0x0E, 0x74, ++0x02, 0xF0, 0x22, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x04, 0xF0, 0x22, 0xE4, ++0x90, 0xA5, 0x5E, 0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x90, 0xA5, 0x5E, 0xF0, 0xE0, 0x54, 0xC0, 0x70, ++0x0D, 0x90, 0xA4, 0x0F, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x02, 0x77, 0xBF, 0x90, 0xA5, ++0x5E, 0xE0, 0x30, 0xE6, 0x23, 0x90, 0xA4, 0x0B, 0xE0, 0x64, 0x01, 0x70, 0x22, 0x90, 0xA4, 0x0F, ++0xE0, 0x44, 0x01, 0xF0, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x05, 0x12, 0x76, ++0xC4, 0x80, 0x0C, 0x12, 0x77, 0x04, 0x80, 0x07, 0x90, 0xA4, 0x0F, 0xE0, 0x54, 0xFE, 0xF0, 0x90, ++0xA5, 0x5E, 0xE0, 0x90, 0xA4, 0x0F, 0x30, 0xE7, 0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, ++0x90, 0xA4, 0x1D, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, ++0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, ++0xFD, 0xF0, 0x22, 0xE4, 0xFF, 0x90, 0xA4, 0x0B, 0xE0, 0x70, 0x02, 0x61, 0x28, 0x90, 0xA3, 0x87, ++0xE0, 0x64, 0x01, 0x60, 0x02, 0x61, 0x28, 0x90, 0xA4, 0x0A, 0xE0, 0xC4, 0x54, 0x0F, 0x60, 0x24, ++0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1F, 0x90, 0xA4, 0x12, 0xE0, 0x14, 0xF0, 0xE0, 0xFE, 0x60, ++0x06, 0x90, 0xA4, 0x14, 0xE0, 0x60, 0x0F, 0xEE, 0x70, 0x06, 0x90, 0xA4, 0x11, 0xE0, 0xA3, 0xF0, ++0x7F, 0x01, 0x80, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x4F, 0x90, 0xA4, 0x0F, 0xE0, 0x44, 0x10, 0xF0, ++0x90, 0xA4, 0x14, 0xE0, 0x60, 0x03, 0xB4, 0x01, 0x09, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x14, 0xE0, ++0x80, 0x0D, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x14, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, ++0x90, 0xA4, 0x13, 0xE0, 0x2F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, ++0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x0E, 0xE0, 0x20, 0xE2, 0x07, 0x7D, 0x01, ++0x7F, 0x04, 0x12, 0x5C, 0x92, 0x12, 0x5F, 0xEC, 0x22, 0x90, 0xA4, 0x08, 0xE0, 0xFF, 0x13, 0x13, ++0x54, 0x3F, 0x30, 0xE0, 0x11, 0xEF, 0x54, 0xFB, 0xF0, 0x90, 0xA4, 0x0F, 0xE0, 0x54, 0xFD, 0xF0, ++0x54, 0x07, 0x70, 0x42, 0x80, 0x3D, 0x90, 0xA4, 0x14, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x0F, 0xE0, ++0x54, 0xEF, 0xF0, 0x90, 0xA4, 0x14, 0xE0, 0xFF, 0xB4, 0x01, 0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, ++0x06, 0x90, 0x05, 0x58, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x1C, 0xE0, 0xFF, 0x90, 0xA4, 0x14, 0xE0, ++0xD3, 0x9F, 0x40, 0x0F, 0x90, 0xA3, 0x87, 0xE0, 0xB4, 0x01, 0x0B, 0x90, 0xA4, 0x09, 0xE0, 0x54, ++0xFB, 0xF0, 0x22, 0x12, 0x77, 0xBF, 0x22, 0x90, 0xA2, 0x98, 0xE0, 0xFE, 0x90, 0x04, 0x1C, 0xE0, ++0x6E, 0x70, 0x40, 0x90, 0xA4, 0x0E, 0xE0, 0xFE, 0x64, 0x0E, 0x70, 0x1C, 0xEF, 0x70, 0x34, 0x90, ++0xA4, 0x08, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE0, 0x44, 0x80, ++0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x04, 0xF0, 0x22, 0xEE, 0xB4, 0x06, 0x17, 0xEF, 0x60, 0x14, 0x90, ++0xA4, 0x08, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA4, 0x0E, ++0x74, 0x0C, 0xF0, 0x22, 0xE4, 0xFE, 0xEF, 0x25, 0xE0, 0xFD, 0xEF, 0xC3, 0x94, 0x80, 0x90, 0xFD, ++0x12, 0x50, 0x04, 0xE4, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, ++0x06, 0x22, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0xA3, 0x86, ++0xE0, 0x9B, 0x90, 0xA3, 0x85, 0xE0, 0x9A, 0x50, 0x13, 0xA3, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0xA3, ++0x85, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, 0xFD, 0x11, ++0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFF, 0x22, ++0x24, 0xCF, ++}; ++u4Byte ArrayLength_MP_8812A_FW_NIC_BT = 31826; ++ ++ ++void ++ODM_ReadFirmware_MP_8812A_FW_NIC_BT( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++) ++{ ++ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8812A_FW_NIC_BT; ++ *pFirmwareSize = ArrayLength_MP_8812A_FW_NIC_BT; ++} ++ ++u1Byte Array_MP_8812A_FW_WoWLAN[] = { ++0x01, 0x95, 0x30, 0x00, 0x12, 0x00, 0x00, 0x00, 0x04, 0x25, 0x11, 0x07, 0x3A, 0x50, 0x00, 0x00, ++0x7D, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x02, 0x4C, 0xD5, 0x02, 0x5B, 0xBD, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x5C, 0xC9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x6E, 0xDE, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x5C, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x68, 0x02, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, ++0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, ++0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, ++0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, ++0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, ++0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, ++0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, ++0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, ++0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, ++0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, ++0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, ++0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, ++0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, ++0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, ++0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, ++0x82, 0x23, 0x90, 0x47, 0x50, 0x73, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, ++0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, ++0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, ++0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, ++0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xA4, 0x25, ++0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, ++0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, ++0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, ++0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, ++0x80, 0xDF, 0xE3, 0xF5, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x6B, 0xDF, 0xF5, 0x80, 0x67, 0xE3, ++0xF5, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x5E, 0xDF, 0xF5, 0x80, 0x5A, 0x87, 0xF0, 0x09, 0xE6, ++0x08, 0xB5, 0xF0, 0x52, 0xDF, 0xF6, 0x80, 0x4E, 0x87, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x46, ++0xDF, 0xF6, 0x80, 0x42, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x36, ++0xDF, 0xF6, 0x80, 0x32, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, ++0x25, 0xDF, 0xF5, 0x80, 0x21, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, 0x09, 0xE0, 0xA3, 0xB5, ++0xF0, 0x14, 0xDF, 0xF5, 0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, 0x09, 0xE4, 0x93, ++0xA3, 0xB5, 0xF0, 0x02, 0xDF, 0xF4, 0x02, 0x49, 0xB1, 0x80, 0x87, 0x80, 0xE9, 0x80, 0x90, 0x80, ++0xD4, 0x80, 0x3E, 0x80, 0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, 0x80, 0xB7, 0x80, 0x8D, 0x80, ++0xA3, 0x80, 0x51, 0x80, 0x74, 0x80, 0x3C, 0x02, 0x49, 0xBD, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, ++0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, ++0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x76, 0xDF, 0xE3, 0xDE, 0xE1, 0x80, ++0x70, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, 0xB5, 0xF0, 0x62, 0xDF, ++0xF4, 0x80, 0x5E, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, 0x51, ++0xDF, 0xF5, 0x80, 0x4D, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, 0xB5, 0xF0, ++0x40, 0xDF, 0xF5, 0x80, 0x3C, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE6, 0x08, ++0xB5, 0xF0, 0x2E, 0xDF, 0xF4, 0x80, 0x2A, 0x80, 0x02, 0x80, 0x57, 0x89, 0x82, 0x8A, 0x83, 0xEC, ++0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE0, 0xA3, ++0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x06, 0xDF, 0xE4, 0xDE, 0xE2, 0x80, ++0x00, 0x7F, 0xFF, 0xB5, 0xF0, 0x02, 0x0F, 0x22, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x89, 0x82, 0x8A, ++0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE0, ++0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xD5, 0xDF, 0xE5, 0xDE, 0xE3, ++0x80, 0xCF, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, ++0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, ++0xF0, 0xAF, 0xDF, 0xE4, 0xDE, 0xE2, 0x80, 0xA9, 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, ++0xAB, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, ++0x00, 0x50, 0x8E, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x48, 0xF9, 0x73, 0xC2, 0xAF, 0x80, 0xFE, ++0x32, 0x12, 0x4A, 0x30, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, 0xC2, 0x8C, 0xE5, 0x8A, ++0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, 0xEC, 0x24, 0x87, 0xF8, ++0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, 0x40, 0xCE, 0x79, 0x03, ++0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, 0x03, 0x44, 0x18, 0xF6, ++0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, 0x23, 0x24, 0x81, 0xF8, ++0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, 0xE4, 0xF2, 0x00, 0xE5, ++0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, 0xE6, 0xFD, 0xA6, 0x81, ++0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, 0x6D, 0x60, 0xE0, 0x08, ++0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, 0x0C, 0x24, 0x87, 0xF8, ++0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, 0xF8, 0xE5, 0x81, 0x6D, ++0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, 0xC8, 0xF6, 0x15, 0x0C, ++0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, 0xE6, 0x30, 0xE0, 0x03, ++0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, 0x08, 0x54, 0xF4, 0x54, ++0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, 0x81, 0x74, 0x02, 0x60, ++0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, 0xF6, 0x08, 0xF6, 0x08, ++0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4D, 0x6D, 0x74, 0x01, 0x93, 0xC0, 0xE0, 0xE4, 0x93, ++0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, 0x8C, 0xD2, 0xAF, 0x22, ++0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, 0x2F, 0x2F, 0xF8, 0xE6, ++0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, 0x0C, 0xEE, 0xC3, 0x9F, ++0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, 0xBE, 0x02, 0x02, 0x74, ++0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, 0x09, 0x80, 0xF3, 0x16, ++0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, 0xEE, 0xD3, 0x9F, 0x40, ++0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, 0xA9, 0x81, 0x18, 0x06, ++0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, 0xF7, 0x19, 0x80, 0xF3, ++0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, 0x04, 0x90, 0x4D, 0x6D, ++0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, ++0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x54, ++0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, 0xF8, 0xE6, 0xF5, 0x81, ++0x02, 0x4A, 0x79, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, 0x02, 0x74, 0xFF, 0xFD, ++0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, 0x60, 0x08, 0xA8, 0x05, ++0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, 0x0C, 0xB5, 0x07, 0xE3, ++0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, 0x0F, 0x74, 0x86, 0x2F, ++0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, 0x81, 0xED, 0x6C, 0x60, ++0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, 0x07, 0xDE, 0x89, 0x81, ++0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, ++0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, 0xD2, 0xE2, 0xC6, 0xD2, ++0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x4A, 0x78, 0x8F, 0xF0, 0xE4, 0xFF, 0xFE, 0xE5, ++0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, 0xE6, 0x60, 0x0B, 0x2D, ++0xF6, 0x60, 0x30, 0x50, 0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, 0x60, 0x25, 0x7E, 0x02, ++0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, 0xE2, 0x0C, 0xD2, 0xAF, ++0x7F, 0x04, 0x80, 0x12, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, 0x4E, 0xF6, 0xD2, 0xAF, ++0x02, 0x4A, 0x79, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, ++0x54, 0x80, 0x4F, 0xFF, 0x22, 0x02, 0x4D, 0x13, 0x02, 0x4B, 0x09, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, ++0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, ++0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, ++0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, ++0x20, 0x40, 0x80, 0x90, 0x4D, 0x58, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, ++0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, ++0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, ++0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, ++0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0x00, 0x41, 0x90, 0xDA, 0x00, 0x41, 0x90, 0xDB, ++0x00, 0x41, 0x90, 0xDC, 0x00, 0x41, 0x90, 0xF8, 0x00, 0x41, 0x90, 0xFB, 0x00, 0x4E, 0x77, 0x4F, ++0xAE, 0x4F, 0xF6, 0x90, 0x00, 0xF0, 0xE0, 0x7F, 0x01, 0x20, 0xE2, 0x02, 0x7F, 0x03, 0x22, 0xB1, ++0x73, 0x90, 0x8D, 0x04, 0xEF, 0xF0, 0xB1, 0x91, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x02, 0x35, ++0x95, 0xD1, 0x16, 0xD1, 0x46, 0xB1, 0xB3, 0xB1, 0xD2, 0xB1, 0xF1, 0xE4, 0xF5, 0x51, 0x75, 0x52, ++0x58, 0xAB, 0x51, 0x7D, 0x02, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x52, 0x7D, 0x03, 0x7F, 0x01, ++0x02, 0x39, 0x04, 0x75, 0x5D, 0x10, 0xE4, 0xF5, 0x5E, 0x75, 0x5F, 0x07, 0x75, 0x60, 0x42, 0x90, ++0x01, 0x30, 0xE5, 0x5D, 0xF0, 0xA3, 0xE5, 0x5E, 0xF0, 0xA3, 0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, ++0xF0, 0x22, 0x75, 0x65, 0x06, 0x75, 0x66, 0x01, 0x75, 0x67, 0x03, 0x75, 0x68, 0x62, 0x90, 0x01, ++0x38, 0xE5, 0x65, 0xF0, 0xA3, 0xE5, 0x66, 0xF0, 0xA3, 0xE5, 0x67, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, ++0x22, 0xE4, 0xF5, 0x55, 0xF5, 0x56, 0xF5, 0x57, 0xF5, 0x58, 0xAD, 0x55, 0x7F, 0x50, 0x12, 0x3A, ++0x96, 0xAD, 0x56, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xAD, 0x57, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xAD, ++0x58, 0x7F, 0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x30, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, ++0xF0, 0x90, 0x01, 0x38, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x3A, ++0x96, 0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xE4, ++0xFD, 0x7F, 0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x34, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, ++0xA3, 0xF0, 0x90, 0x01, 0x3C, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, ++0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x3A, 0x96, ++0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x3A, 0x96, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, ++0x12, 0x3A, 0x96, 0xF1, 0x16, 0x12, 0x3A, 0xB8, 0xF1, 0x7E, 0xF1, 0x02, 0x7F, 0x01, 0x71, 0x41, ++0x90, 0x8F, 0xA3, 0x74, 0x02, 0xF0, 0xFF, 0x71, 0x41, 0x90, 0x8F, 0xA3, 0xE0, 0x04, 0xF0, 0xB1, ++0x7F, 0xD1, 0xD5, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, 0x75, ++0x28, 0xFF, 0xD1, 0xFB, 0x12, 0x74, 0x4A, 0x90, 0x00, 0xF1, 0xE0, 0x54, 0xF0, 0xD3, 0x94, 0x10, ++0x40, 0x08, 0x90, 0x8F, 0xAD, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x8F, 0xAD, 0xF0, 0xF1, ++0x0C, 0xE4, 0xFF, 0x61, 0xCA, 0xD1, 0xF5, 0xF1, 0x23, 0x12, 0x86, 0x1C, 0xF1, 0x31, 0xF1, 0x40, ++0x90, 0x8F, 0xA7, 0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, ++0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xE4, 0x90, 0x8D, 0xF6, 0xF0, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, ++0x85, 0x22, 0xE4, 0x90, 0x8D, 0x01, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, ++0x12, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, ++0xE4, 0xF0, 0x22, 0xE4, 0x90, 0x8D, 0xF2, 0xF0, 0xA3, 0xF0, 0x90, 0x8D, 0x5A, 0xF0, 0xA3, 0xF0, ++0x22, 0x90, 0x8E, 0x92, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, ++0x90, 0x8F, 0xA4, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, ++0xF0, 0x22, 0xD1, 0xE0, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8F, 0xA7, 0xE0, 0x54, ++0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x14, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, ++0x8F, 0xA8, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0x8F, 0xA9, 0xF0, 0x22, 0x90, 0x01, ++0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, ++0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, ++0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0xE4, 0x90, ++0x90, 0x02, 0xF0, 0x90, 0x90, 0x02, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0xAE, 0x90, 0x01, 0xC4, 0xF0, ++0x74, 0x4F, 0xA3, 0xF0, 0x12, 0x3A, 0xEB, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x69, 0x90, 0x8E, 0x7A, ++0xE0, 0x60, 0x0F, 0x90, 0x8E, 0x7D, 0xE0, 0xFF, 0x90, 0x8E, 0x7C, 0xE0, 0x6F, 0x60, 0x03, 0x12, ++0x68, 0xDF, 0xC2, 0xAF, 0x12, 0x74, 0xAD, 0xBF, 0x01, 0x03, 0x12, 0x77, 0xC4, 0xD2, 0xAF, 0x12, ++0x57, 0xED, 0x51, 0x79, 0x80, 0xBD, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x91, 0x7A, 0x90, 0x90, ++0x03, 0xEF, 0xF0, 0x60, 0xF1, 0x90, 0x8D, 0x01, 0xE0, 0xFF, 0x60, 0xEA, 0xC2, 0xAF, 0x30, 0xE1, ++0x06, 0x54, 0xFD, 0xF0, 0x12, 0x60, 0x2C, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x8D, 0x01, 0xE0, 0xFF, ++0x30, 0xE2, 0x06, 0x54, 0xFB, 0xF0, 0x12, 0x58, 0xB3, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x8D, 0x01, ++0xE0, 0xFF, 0x30, 0xE4, 0x0B, 0x54, 0xEF, 0xF0, 0x12, 0x83, 0x33, 0xBF, 0x01, 0x02, 0x11, 0x44, ++0xD2, 0xAF, 0x80, 0xC1, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x90, 0x0E, 0xF0, ++0xA3, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, ++0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, ++0x90, 0x04, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x82, 0xE0, 0x90, 0x90, 0x0D, 0xF0, 0x90, 0x8E, ++0x96, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0x85, 0x90, 0x8E, 0x9B, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x01, ++0x3F, 0xE0, 0x30, 0xE2, 0x02, 0xB1, 0x23, 0xE4, 0x90, 0x90, 0x0C, 0xF0, 0x90, 0x90, 0x0D, 0xE0, ++0xFF, 0x90, 0x90, 0x0C, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0x41, 0x85, 0x90, 0x90, 0x04, 0xE0, 0xFC, ++0xA3, 0xE0, 0xFD, 0xEC, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x90, 0x14, 0xEF, 0xF0, 0x74, 0x01, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, ++0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0xFE, 0x90, ++0x90, 0x06, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x90, 0x12, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x02, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, ++0x90, 0x90, 0x0A, 0xF0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x90, 0x05, 0xE0, 0x2F, 0xFF, ++0x90, 0x90, 0x04, 0xE0, 0x3E, 0xFE, 0x90, 0x90, 0x08, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xFD, 0x51, ++0x98, 0xC0, 0x07, 0x90, 0x90, 0x08, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7D, 0x04, 0x51, 0x98, 0xAD, ++0x07, 0xD0, 0x07, 0xB1, 0x64, 0x90, 0x90, 0x0E, 0xEF, 0xF0, 0x90, 0x90, 0x08, 0xE0, 0xFE, 0xA3, ++0xE0, 0xFF, 0xE4, 0xFD, 0x51, 0x98, 0xEF, 0x54, 0xFC, 0x90, 0x90, 0x0B, 0xF0, 0x90, 0x90, 0x0A, ++0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0x90, 0x90, 0x06, 0x8F, 0xF0, 0x12, 0x47, 0xF6, 0x90, 0x90, ++0x06, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x83, 0x0A, 0x90, 0x90, 0x06, 0xEE, 0xF0, 0xA3, 0xEF, ++0xF0, 0x90, 0x90, 0x04, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7D, 0x0F, 0x51, 0x98, 0x90, 0x90, 0x06, ++0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x90, 0x90, 0x04, 0xEC, 0x8D, 0xF0, 0x12, 0x47, 0xF6, 0x90, 0x8D, ++0xF4, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x90, 0x90, 0x05, 0xE0, 0x9D, 0x90, 0x90, 0x04, 0xE0, ++0x9C, 0x40, 0x1B, 0x90, 0x8D, 0xF5, 0xE0, 0x24, 0x01, 0xFD, 0x90, 0x8D, 0xF4, 0xE0, 0x34, 0x00, ++0xFC, 0xC3, 0x90, 0x90, 0x05, 0xE0, 0x9D, 0xF0, 0x90, 0x90, 0x04, 0xE0, 0x9C, 0xF0, 0xEF, 0x30, ++0xE7, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x21, 0xF0, 0xEF, 0x30, 0xE6, 0x06, 0x90, 0x01, 0xC7, 0x74, ++0x22, 0xF0, 0xEF, 0x30, 0xE5, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x23, 0xF0, 0x90, 0x90, 0x0B, 0xE0, ++0x24, 0x40, 0x60, 0x04, 0x24, 0x20, 0x70, 0x32, 0x90, 0x8E, 0x97, 0xE0, 0xFF, 0xC4, 0x13, 0x13, ++0x13, 0x54, 0x01, 0x30, 0xE0, 0x59, 0x90, 0x8E, 0xA8, 0xE0, 0x04, 0xF0, 0x90, 0x90, 0x08, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x84, 0x8F, 0xEF, 0x60, 0x45, 0x90, 0x90, 0x0B, 0xE0, 0xFF, 0x12, ++0x84, 0x78, 0x90, 0x8E, 0xA9, 0xE0, 0x04, 0xF0, 0x80, 0x35, 0x90, 0x90, 0x08, 0xE0, 0xFE, 0xA3, ++0xE0, 0xFF, 0x90, 0x90, 0x0E, 0xE0, 0xFD, 0x90, 0x90, 0x11, 0xE0, 0xFB, 0x90, 0x90, 0x14, 0xE0, ++0x90, 0x90, 0x19, 0xF0, 0x91, 0x98, 0x90, 0x8E, 0x96, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x0F, ++0x90, 0x90, 0x08, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x90, 0x0E, 0xE0, 0xFD, 0x51, 0xD6, 0x12, ++0x84, 0xE9, 0xEF, 0x64, 0x01, 0x60, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x02, 0xB1, 0x23, ++0x12, 0x84, 0x52, 0xBF, 0x01, 0x0E, 0x90, 0x8E, 0xAA, 0xE0, 0x04, 0xF0, 0x90, 0x90, 0x04, 0x12, ++0x82, 0x36, 0x80, 0x09, 0x90, 0x8E, 0x96, 0xE0, 0x54, 0xFE, 0xF0, 0x80, 0x08, 0x90, 0x90, 0x0C, ++0xE0, 0x04, 0xF0, 0x01, 0x9C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xCD, 0x34, 0x00, 0xFC, 0x7E, 0x00, ++0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0xE4, 0xFD, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, ++0x3A, 0xFA, 0xC3, 0x90, 0x8D, 0xF5, 0xE0, 0x9B, 0x90, 0x8D, 0xF4, 0xE0, 0x9A, 0x50, 0x13, 0xA3, ++0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8D, 0xF4, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, ++0x9E, 0xFA, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0xFB, 0xF5, 0x83, 0xE0, 0xFF, 0x22, 0x90, 0x90, 0x15, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, ++0xF0, 0x78, 0x1E, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x50, 0x7E, 0x00, 0x7F, ++0x06, 0x12, 0x47, 0xD0, 0x78, 0x24, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x56, ++0x7E, 0x00, 0x7F, 0x04, 0x12, 0x47, 0xD0, 0x78, 0x28, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, ++0x40, 0x79, 0x5A, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x47, 0xD0, 0x90, 0x90, 0x17, 0xE0, 0xFF, 0x90, ++0x90, 0x16, 0xE0, 0x2F, 0xFF, 0x90, 0x90, 0x15, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x06, 0xCF, 0x34, ++0x00, 0xFE, 0xE4, 0xFD, 0x51, 0x98, 0xEF, 0x64, 0x08, 0x60, 0x02, 0x81, 0x97, 0x90, 0x90, 0x17, ++0xE0, 0xFF, 0x90, 0x90, 0x16, 0xE0, 0x2F, 0xFF, 0x90, 0x90, 0x15, 0xE0, 0x34, 0x00, 0xCF, 0x24, ++0x07, 0xCF, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0x98, 0xEF, 0x64, 0x06, 0x60, 0x02, 0x81, 0x97, ++0x90, 0x90, 0x2C, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x50, 0x24, 0x90, 0x90, ++0x16, 0xE0, 0x24, 0x0A, 0xFD, 0x90, 0x90, 0x15, 0xE0, 0x51, 0x8B, 0x90, 0x90, 0x2C, 0xE0, 0x24, ++0x18, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0x04, 0xF0, ++0x80, 0xD2, 0xE4, 0x90, 0x90, 0x2C, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x50, ++0x2D, 0x90, 0x90, 0x17, 0xE0, 0xFD, 0x90, 0x90, 0x16, 0xE0, 0x2D, 0xFD, 0x90, 0x90, 0x15, 0xE0, ++0x34, 0x00, 0xCD, 0x24, 0x10, 0x51, 0x8A, 0x90, 0x90, 0x2C, 0xE0, 0x24, 0x1E, 0xF5, 0x82, 0xE4, ++0x34, 0x90, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0x04, 0xF0, 0x80, 0xC9, 0xE4, 0x90, ++0x90, 0x2C, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x2D, 0x90, 0x90, 0x17, ++0xE0, 0xFD, 0x90, 0x90, 0x16, 0xE0, 0x2D, 0xFD, 0x90, 0x90, 0x15, 0xE0, 0x34, 0x00, 0xCD, 0x24, ++0x16, 0x51, 0x8A, 0x90, 0x90, 0x2C, 0xE0, 0x24, 0x24, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, ++0xEF, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0x04, 0xF0, 0x80, 0xC9, 0x78, 0x18, 0x7C, 0x90, 0x7D, 0x01, ++0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xA2, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x4A, 0x08, 0xEF, 0x70, 0x77, ++0x90, 0x90, 0x2C, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x2D, 0x90, 0x90, ++0x17, 0xE0, 0xFD, 0x90, 0x90, 0x16, 0xE0, 0x2D, 0xFD, 0x90, 0x90, 0x15, 0xE0, 0x34, 0x00, 0xCD, ++0x24, 0x20, 0x51, 0x8A, 0x90, 0x90, 0x2C, 0xE0, 0x24, 0x28, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, ++0x83, 0xEF, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0x04, 0xF0, 0x80, 0xC9, 0x78, 0x28, 0x7C, 0x90, 0x7D, ++0x01, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xAB, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x4A, 0x08, 0xEF, 0x90, ++0x06, 0x30, 0x70, 0x1D, 0xE0, 0x44, 0x01, 0x54, 0xDF, 0xF0, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x1E, ++0x90, 0x90, 0x30, 0x12, 0x48, 0x53, 0xE4, 0x90, 0x90, 0x33, 0xF0, 0x7A, 0x90, 0x79, 0x24, 0xA1, ++0x7C, 0xE0, 0x44, 0x21, 0x54, 0xEF, 0xF0, 0x22, 0x90, 0x90, 0x17, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, ++0x90, 0x90, 0x15, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xFD, 0x51, 0x98, 0xEF, 0x54, 0x0C, 0x64, ++0x08, 0x70, 0x6F, 0x90, 0x90, 0x15, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0x06, 0xFD, ++0x51, 0x98, 0xEF, 0x64, 0x88, 0x70, 0x5B, 0x90, 0x90, 0x15, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, ++0xE0, 0x24, 0x07, 0xFD, 0x51, 0x98, 0xEF, 0x64, 0x8E, 0x70, 0x47, 0x90, 0x90, 0x15, 0xE0, 0xFE, ++0xA3, 0xE0, 0xFF, 0x90, 0x90, 0x18, 0xE0, 0xFD, 0x90, 0x90, 0x17, 0xE0, 0x2D, 0x04, 0xFD, 0x51, ++0x98, 0xEF, 0x64, 0x03, 0x70, 0x2C, 0x90, 0x90, 0x15, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x90, ++0x18, 0xE0, 0xFD, 0x90, 0x90, 0x17, 0xE0, 0x2D, 0x24, 0x06, 0xFD, 0x51, 0x98, 0xEF, 0x90, 0x01, ++0xC7, 0x30, 0xE3, 0x04, 0x74, 0x01, 0x80, 0x02, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x9B, 0xE0, 0x44, ++0x01, 0xF0, 0x22, 0x90, 0x8D, 0x04, 0xE0, 0xB4, 0x02, 0x15, 0x90, 0x8E, 0x98, 0xE0, 0xC4, 0x13, ++0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x0F, 0x90, 0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x22, 0x90, ++0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xFE, 0x24, 0x28, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x2C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0xFD, 0xE4, 0xFE, 0xEF, 0x30, 0xE7, 0x04, 0x7C, 0x02, 0x80, 0x02, 0xE4, 0xFC, ++0xAF, 0x05, 0xF1, 0x1F, 0xAE, 0x07, 0xEC, 0x24, 0x18, 0x2E, 0xFF, 0x22, 0x90, 0x90, 0x2D, 0x12, ++0x48, 0x53, 0x90, 0x8F, 0x97, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x6A, 0xDD, 0x90, 0x90, 0x34, 0xB1, ++0x47, 0x90, 0x90, 0x36, 0xEF, 0xF0, 0x90, 0x90, 0x34, 0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, 0x34, ++0xFC, 0xFA, 0x7B, 0x01, 0x90, 0x90, 0x33, 0xE0, 0xFD, 0xD1, 0x53, 0x90, 0x90, 0x34, 0xA3, 0xE0, ++0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, ++0x90, 0x30, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0xD0, 0x01, ++0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x34, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, ++0x24, 0x42, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, ++0x90, 0x30, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0xD0, 0x01, ++0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x34, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, ++0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, ++0x90, 0x2D, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0xD0, 0x01, ++0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x10, 0xF0, 0x12, 0x76, ++0x12, 0xBF, 0x01, 0x0E, 0x90, 0x8F, 0x97, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x04, 0x1F, 0x74, ++0x20, 0xF0, 0x22, 0x90, 0x90, 0xB8, 0xED, 0xF0, 0x90, 0x90, 0xB5, 0x12, 0x48, 0x53, 0xE4, 0x90, ++0x90, 0xB9, 0xF0, 0xA3, 0xF0, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFD, ++0xB1, 0x64, 0x90, 0x90, 0xB9, 0xEF, 0xF0, 0x90, 0x90, 0xB5, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x04, ++0x12, 0x26, 0x37, 0xFF, 0xF1, 0x1F, 0x90, 0x90, 0xBA, 0xEF, 0xF0, 0x90, 0x8E, 0xAF, 0xE0, 0x24, ++0xFE, 0x60, 0x1E, 0x24, 0xFE, 0x60, 0x1A, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x05, 0x70, ++0x54, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xB0, 0x90, 0x90, 0xB8, 0xE0, 0xFD, 0x12, 0x8F, 0xBE, 0x80, ++0x16, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xB0, 0x90, 0x90, 0xB8, 0xE0, 0xFD, 0x90, 0x8E, 0xAF, 0xE0, ++0x90, 0x90, 0x92, 0xF0, 0x12, 0x8E, 0x9C, 0x90, 0x90, 0xBA, 0xE0, 0xFF, 0x90, 0x90, 0xB5, 0x12, ++0x48, 0x4A, 0x90, 0x90, 0xB9, 0xE0, 0x7C, 0x00, 0x29, 0xF9, 0xEC, 0x3A, 0xFA, 0xC3, 0xE9, 0x9F, ++0xF9, 0xEA, 0x94, 0x00, 0xFA, 0x75, 0x40, 0x01, 0x75, 0x41, 0x8E, 0x75, 0x42, 0xB0, 0xA3, 0xE0, ++0xF5, 0x43, 0x12, 0x34, 0x2C, 0x22, 0x12, 0x6C, 0x6D, 0x7E, 0x00, 0x90, 0x90, 0x07, 0xB1, 0x47, ++0x90, 0x90, 0x07, 0xA3, 0xE0, 0x2F, 0x24, 0x3E, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, 0xF5, ++0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xAB, 0x02, 0x34, 0x2C, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x20, 0xE0, 0x05, 0x90, 0x8F, 0x94, 0x80, 0x03, 0x90, ++0x8F, 0x95, 0xE0, 0x90, 0x8E, 0xAF, 0xF0, 0x90, 0x8E, 0xAF, 0xE0, 0x14, 0x60, 0x13, 0x14, 0x60, ++0x14, 0x24, 0xFE, 0x60, 0x10, 0x14, 0x60, 0x09, 0x14, 0x60, 0x06, 0x24, 0x06, 0xE4, 0xFE, 0x80, ++0x06, 0x7E, 0x04, 0x80, 0x02, 0x7E, 0x08, 0xAF, 0x06, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8F, ++0xA7, 0xE0, 0x30, 0xE0, 0x47, 0x90, 0x8F, 0xAB, 0xE0, 0xFD, 0x60, 0x40, 0x74, 0x01, 0x7E, 0x00, ++0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, ++0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x06, 0xE4, 0x90, 0x8F, 0xAB, 0xF0, 0x22, 0x90, 0x8F, 0xA9, 0xE0, ++0xD3, 0x9D, 0x50, 0x10, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0xB1, 0x23, 0x90, 0x8F, 0xA7, 0xE0, ++0x54, 0xFE, 0xF0, 0x22, 0xF1, 0xAD, 0x90, 0x8F, 0xAB, 0xE0, 0x04, 0xF0, 0x22, 0xE4, 0xFF, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x11, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1F, 0x90, 0x05, ++0x22, 0xE0, 0xF5, 0x14, 0x74, 0xFF, 0xF0, 0x12, 0x76, 0xCD, 0xBF, 0x01, 0x08, 0xAF, 0x11, 0x12, ++0x88, 0xB4, 0x12, 0x6B, 0x48, 0x90, 0x05, 0x22, 0xE5, 0x14, 0xF0, 0x80, 0x03, 0x12, 0x6B, 0x48, ++0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x72, 0xED, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x90, 0x80, 0xF0, 0x90, 0x01, 0xC7, ++0xE0, 0x64, 0xAD, 0x70, 0x36, 0xF0, 0x90, 0x90, 0x8D, 0x74, 0x0F, 0xF0, 0x90, 0x90, 0x7F, 0x74, ++0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0x90, 0x80, 0xE0, 0x2F, 0xFE, 0x74, 0x81, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x0F, 0xE9, 0x90, 0x01, 0x3F, ++0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x7F, 0x11, 0x40, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0xD2, 0x12, 0x48, 0x53, 0x7F, 0x96, 0x7E, ++0x02, 0x31, 0x84, 0xEF, 0x60, 0x58, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, ++0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x90, ++0xD5, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x90, 0xD5, 0xE0, 0xFD, 0x90, 0x02, ++0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x90, 0xD2, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x0E, 0x12, 0x26, ++0x37, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0x31, 0xDA, 0x90, 0x90, 0xD5, 0xE0, 0x24, 0x18, 0xFF, ++0x90, 0x90, 0xD2, 0x12, 0x48, 0x4A, 0x51, 0x35, 0x90, 0x02, 0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x8D, 0xF3, 0xE0, ++0xFE, 0x90, 0x8D, 0xF2, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, ++0x64, 0x01, 0x60, 0x48, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x13, 0xED, 0x75, 0xF0, 0x0F, 0xA4, 0x24, ++0x5C, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x31, 0x21, 0x7F, 0x01, 0x90, 0x8D, 0xF2, ++0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x5C, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x11, ++0x40, 0x7F, 0x01, 0xEF, 0x60, 0x16, 0x90, 0x8D, 0xF2, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, ++0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x8D, 0xF2, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0x04, 0x12, 0x48, 0x53, 0x90, 0x90, ++0xDC, 0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, 0x7F, 0xAF, 0x7E, 0x01, ++0x31, 0x84, 0xEF, 0x60, 0x3A, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, ++0x42, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x01, 0x79, ++0xA0, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, ++0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0xCA, 0xEE, 0xF0, ++0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x90, 0xCA, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, ++0x82, 0x8E, 0x83, 0xE0, 0x60, 0x2D, 0xC3, 0x90, 0x90, 0xCD, 0xE0, 0x94, 0xE8, 0x90, 0x90, 0xCC, ++0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x15, ++0x90, 0x90, 0xCC, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3A, ++0xF7, 0x80, 0xC5, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, ++0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xEE, 0x74, 0x00, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, ++0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, ++0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, ++0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x90, 0xCE, 0xEF, 0xF0, 0xA3, 0x12, 0x48, 0x53, 0x90, 0x90, ++0xDB, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, 0x76, 0x74, 0x00, 0x2F, 0xF9, ++0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x90, 0xCF, 0x12, ++0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, ++0x03, 0x12, 0x34, 0x2C, 0x90, 0x90, 0xCE, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, ++0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x48, 0x4A, 0xE9, 0x24, 0x02, 0xF9, 0xE4, ++0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0x90, 0xCF, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x0E, ++0x12, 0x26, 0x37, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x2C, 0x90, 0x90, ++0x9C, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xFB, 0xA3, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xE4, ++0x90, 0x90, 0xA6, 0xF0, 0xEB, 0x90, 0x90, 0x9D, 0xF0, 0x90, 0x8F, 0xAD, 0xE0, 0x70, 0x3D, 0x90, ++0x90, 0x9C, 0xE0, 0x70, 0x17, 0xFF, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x04, 0xFF, 0xEC, ++0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x80, 0x1D, 0x90, 0x90, 0x9C, 0xE0, ++0xB4, 0x01, 0x19, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x04, 0xFF, 0xEC, 0x90, ++0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x90, 0x9D, 0xE0, ++0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x90, 0xA2, 0x12, 0x27, 0x48, 0x90, 0x90, 0xA2, 0x12, 0x48, ++0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x8F, ++0xAD, 0xE0, 0x70, 0x26, 0x90, 0x90, 0xA2, 0x12, 0x48, 0x26, 0xEE, 0x44, 0x01, 0xFE, 0xEC, 0x90, ++0x90, 0xA2, 0x12, 0x27, 0x48, 0x90, 0x90, 0xA2, 0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, ++0x48, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x80, 0x07, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, ++0xF7, 0x90, 0x90, 0x9C, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0xAF, ++0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x36, 0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, ++0x90, 0x90, 0x9E, 0x12, 0x27, 0x48, 0x90, 0x90, 0x9E, 0x02, 0x48, 0x26, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x51, 0xAE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0x90, 0xB1, 0x12, 0x48, 0x26, 0x90, 0xAC, 0x9C, 0x12, 0x27, ++0x48, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0x32, 0x65, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, ++0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, ++0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xBD, 0xF0, ++0x74, 0x5B, 0xA3, 0xF0, 0x91, 0x0C, 0x74, 0xBD, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x5B, 0xA3, ++0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x7B, 0x00, 0x7A, 0x00, ++0x79, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x51, 0x52, 0x53, 0x7B, 0x00, 0x7A, ++0x00, 0x79, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x52, 0x52, 0x54, 0xAB, 0x53, ++0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x02, 0x39, 0x04, ++0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, ++0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, ++0x74, 0x40, 0xF0, 0x74, 0x5C, 0xA3, 0xF0, 0x91, 0x8F, 0x74, 0x40, 0x04, 0x90, 0x01, 0xC4, 0xF0, ++0x74, 0x5C, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, ++0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, ++0x00, 0x54, 0xE0, 0x55, 0x55, 0xF5, 0x59, 0xA3, 0xE0, 0x55, 0x56, 0xF5, 0x5A, 0xA3, 0xE0, 0x55, ++0x57, 0xF5, 0x5B, 0xA3, 0xE0, 0x55, 0x58, 0xF5, 0x5C, 0xAD, 0x59, 0x7F, 0x54, 0x12, 0x3A, 0x96, ++0xAD, 0x5A, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0xAD, 0x5B, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0xAD, 0x5C, ++0x7F, 0x57, 0x12, 0x3A, 0x96, 0x53, 0x91, 0xEF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, ++0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, ++0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xC9, 0xF0, 0x74, 0x5C, 0xA3, 0xF0, ++0x12, 0x74, 0xD4, 0xE5, 0x61, 0x30, 0xE3, 0x03, 0x12, 0x6C, 0x46, 0xE5, 0x61, 0x30, 0xE4, 0x03, ++0x12, 0x6C, 0x3F, 0xE5, 0x63, 0x30, 0xE0, 0x02, 0xB1, 0x6F, 0xE5, 0x63, 0x30, 0xE1, 0x03, 0x12, ++0x75, 0x01, 0xE5, 0x63, 0x30, 0xE2, 0x03, 0x12, 0x66, 0xF9, 0xE5, 0x63, 0x30, 0xE3, 0x03, 0x12, ++0x75, 0xDF, 0xE5, 0x63, 0x30, 0xE4, 0x03, 0x12, 0x6C, 0xB7, 0xE5, 0x63, 0x30, 0xE5, 0x03, 0x12, ++0x6A, 0x7F, 0xE5, 0x63, 0x30, 0xE6, 0x03, 0x12, 0x6C, 0x52, 0xE5, 0x64, 0x30, 0xE1, 0x03, 0x12, ++0x6C, 0xAE, 0xE5, 0x64, 0x30, 0xE6, 0x02, 0xF1, 0xEB, 0x74, 0xC9, 0x04, 0x90, 0x01, 0xC4, 0xF0, ++0x74, 0x5C, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, ++0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, ++0xFF, 0x90, 0x8E, 0x7A, 0xE0, 0x70, 0x02, 0xA1, 0xFA, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, ++0x79, 0x90, 0x8E, 0x79, 0xE0, 0xC4, 0x54, 0x0F, 0x60, 0x24, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, ++0x1F, 0x90, 0x8E, 0x81, 0xE0, 0x14, 0xF0, 0xE0, 0xFE, 0x60, 0x06, 0x90, 0x8E, 0x83, 0xE0, 0x60, ++0x0F, 0xEE, 0x70, 0x06, 0x90, 0x8E, 0x80, 0xE0, 0xA3, 0xF0, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x01, ++0xEF, 0x60, 0x47, 0x90, 0x8E, 0x7E, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x8E, 0x83, 0xE0, 0x60, 0x03, ++0xB4, 0x01, 0x09, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x83, 0xE0, 0x80, 0x0D, 0xE4, 0xF5, 0x3B, 0x90, ++0x8E, 0x83, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0x8E, 0x82, 0xE0, 0x2F, 0xF5, ++0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, ++0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x20, 0xE2, 0x02, 0xB1, 0xFB, 0x22, 0x7D, 0x01, 0x7F, 0x04, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0xFA, 0xED, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0xFE, ++0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xE1, 0x52, 0xEE, 0xC4, 0x13, 0x13, 0x13, 0x54, ++0x01, 0x30, 0xE0, 0x02, 0xE1, 0x52, 0x90, 0x8E, 0x7D, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0xE1, 0x52, ++0xEF, 0x70, 0x02, 0xC1, 0xC4, 0x24, 0xFE, 0x70, 0x02, 0xC1, 0xFF, 0x24, 0xFE, 0x60, 0x4B, 0x24, ++0xFC, 0x70, 0x02, 0xE1, 0x3C, 0x24, 0xFC, 0x60, 0x02, 0xE1, 0x52, 0xEE, 0xB4, 0x0E, 0x02, 0xF1, ++0xC3, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x65, 0xFC, 0x90, 0x8E, 0x7D, 0xE0, ++0xB4, 0x06, 0x02, 0xF1, 0x9D, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x04, 0x0F, 0x90, 0x90, 0xFA, 0xE0, ++0xFF, 0x60, 0x05, 0x12, 0x87, 0xCF, 0x80, 0x03, 0x12, 0x88, 0x11, 0x90, 0x8E, 0x7D, 0xE0, 0x64, ++0x08, 0x60, 0x02, 0xE1, 0x52, 0x12, 0x61, 0xB2, 0xE1, 0x52, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x05, ++0x7F, 0x01, 0x12, 0x65, 0xFC, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x06, 0x02, 0xF1, 0x9D, 0x90, 0x8E, ++0x7D, 0xE0, 0xB4, 0x0E, 0x07, 0xF1, 0x57, 0xBF, 0x01, 0x02, 0xF1, 0xC3, 0x90, 0x8E, 0x7D, 0xE0, ++0x64, 0x0C, 0x60, 0x02, 0xE1, 0x52, 0xF1, 0x57, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xE1, 0x52, 0x12, ++0x88, 0x24, 0xE1, 0x52, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x0E, 0x07, 0xF1, 0x57, 0xBF, 0x01, 0x02, ++0xF1, 0xC3, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x06, 0x02, 0xF1, 0x9D, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, ++0x0C, 0x08, 0xF1, 0x57, 0xBF, 0x01, 0x03, 0x12, 0x88, 0x24, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x04, ++0x70, 0x60, 0x12, 0x87, 0x07, 0xEF, 0x64, 0x01, 0x70, 0x58, 0x12, 0x62, 0x2A, 0x80, 0x53, 0x90, ++0x8E, 0x7D, 0xE0, 0xB4, 0x0E, 0x07, 0xF1, 0x57, 0xBF, 0x01, 0x02, 0xF1, 0xC3, 0x90, 0x8E, 0x7D, ++0xE0, 0xB4, 0x06, 0x02, 0xF1, 0x9D, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x0C, 0x08, 0xF1, 0x57, 0xBF, ++0x01, 0x03, 0x12, 0x88, 0x24, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x65, 0xFC, ++0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x04, 0x1B, 0x12, 0x88, 0x5B, 0x80, 0x16, 0x90, 0x8E, 0x7D, 0xE0, ++0xB4, 0x0C, 0x0F, 0x90, 0x8E, 0x78, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, ++0x62, 0x21, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x86, 0xEE, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, ++0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2D, 0x90, 0x8E, 0x77, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, ++0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x19, 0x90, 0x8E, 0x7C, 0xE0, 0xD3, ++0x94, 0x04, 0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, ++0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x8E, 0x78, ++0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x04, ++0xF0, 0x80, 0x0A, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x90, 0x05, 0x22, ++0xE4, 0xF0, 0x22, 0x90, 0x8E, 0x78, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0x90, 0x8E, 0x7D, 0x74, ++0x0C, 0xF0, 0x80, 0x11, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, ++0x8E, 0x7D, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0x07, 0x1F, 0xE0, 0x54, ++0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, 0x90, 0x39, 0xF0, 0x90, 0x90, 0x37, 0x74, ++0x02, 0xF0, 0x90, 0x90, 0x45, 0x14, 0xF0, 0xFB, 0x7A, 0x90, 0x79, 0x37, 0x12, 0x6D, 0xDE, 0x7F, ++0x04, 0x90, 0x90, 0xF5, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x4C, 0x53, 0x90, 0x8D, 0x01, 0xE0, 0xFF, ++0x90, 0x90, 0xF5, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x8D, 0x01, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0x8D, 0x5B, 0xE0, 0xFF, 0x90, 0x8D, 0x5A, 0xE0, 0xB5, 0x07, 0x04, 0x7F, ++0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x40, 0x90, 0x8D, 0x5A, 0xE0, 0xFE, 0x75, 0xF0, 0x08, ++0x90, 0x8D, 0x0A, 0x12, 0x48, 0x3E, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x0B, 0xF9, ++0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x11, 0x8D, 0x90, 0x8D, 0x5A, 0xE0, 0x04, ++0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x8D, 0x5A, ++0xF0, 0x12, 0x70, 0xE2, 0x7F, 0x02, 0x11, 0x11, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x90, 0x04, ++0x12, 0x48, 0x53, 0xEF, 0x12, 0x48, 0x5C, 0x60, 0xC8, 0x00, 0x60, 0xD1, 0x01, 0x60, 0xD9, 0x02, ++0x60, 0xE2, 0x03, 0x60, 0xEB, 0x04, 0x60, 0xF4, 0x20, 0x60, 0xFD, 0x21, 0x61, 0x06, 0x23, 0x61, ++0x0E, 0x25, 0x61, 0x17, 0x27, 0x61, 0x27, 0x80, 0x61, 0x1F, 0x81, 0x61, 0x30, 0x82, 0x61, 0x39, ++0x83, 0x61, 0x42, 0x84, 0x00, 0x00, 0x61, 0x4B, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, 0x6F, ++0x0F, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0xC1, 0x15, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, ++0x6F, 0x57, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, 0x82, 0x16, 0x90, 0x90, 0x04, 0x12, 0x48, ++0x4A, 0x02, 0x4F, 0x52, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, 0x6F, 0x8F, 0x90, 0x90, 0x04, ++0x12, 0x48, 0x4A, 0x02, 0x70, 0x8C, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0xE1, 0xD6, 0x90, 0x90, ++0x04, 0x12, 0x48, 0x4A, 0x02, 0x70, 0xD2, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x80, 0x34, 0x90, ++0x90, 0x04, 0x12, 0x48, 0x4A, 0x61, 0xEC, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, 0x83, 0x94, ++0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, 0x85, 0x07, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, ++0x85, 0x21, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, 0x85, 0x76, 0x90, 0x01, 0xC0, 0xE0, 0x44, ++0x01, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x54, 0x01, 0xFF, 0x90, 0x8E, 0x92, 0xE0, 0x54, 0xFE, 0x4F, ++0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0x8E, 0x93, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, ++0x37, 0x90, 0x8E, 0x94, 0xF0, 0x90, 0x8E, 0x93, 0xE0, 0x90, 0x8E, 0x95, 0xF0, 0x90, 0x8E, 0x92, ++0xE0, 0x54, 0x01, 0xFF, 0xAC, 0x07, 0xEF, 0x54, 0x01, 0xFE, 0x90, 0x8E, 0x92, 0xE0, 0x54, 0xFE, ++0x4E, 0xF0, 0xEF, 0x90, 0x01, 0x53, 0xB4, 0x01, 0x11, 0xE4, 0xF0, 0x7D, 0x10, 0x7F, 0x03, 0xF1, ++0xED, 0x90, 0x8E, 0x94, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x74, 0x03, 0xF0, 0x7D, 0x10, 0xFF, ++0xF1, 0xB0, 0x91, 0x95, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x22, ++0x90, 0x8E, 0x92, 0xE0, 0x30, 0xE0, 0x2D, 0x90, 0x8E, 0x94, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x90, ++0x8E, 0x95, 0xE0, 0x60, 0x04, 0x14, 0xF0, 0x80, 0x48, 0x90, 0x8E, 0x93, 0xE0, 0x14, 0x90, 0x8E, ++0x95, 0xF0, 0x90, 0x05, 0x73, 0x74, 0x01, 0xF0, 0xE4, 0xFF, 0x31, 0x84, 0x31, 0xF5, 0x7D, 0x01, ++0x7F, 0x02, 0x31, 0xF9, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, ++0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x12, 0x88, ++0x74, 0x90, 0x8E, 0x80, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x31, 0xF5, 0x12, 0x75, 0x6B, 0x80, ++0x9F, 0x51, 0x46, 0x90, 0x8E, 0x7D, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, ++0x12, 0x76, 0xCD, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, 0x03, 0x31, 0xF9, 0x51, 0x4C, ++0xE4, 0x90, 0x8E, 0x7D, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x12, 0x76, 0xCD, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, ++0xFF, 0xEC, 0x90, 0x90, 0xC1, 0x12, 0x27, 0x48, 0x90, 0x90, 0xC1, 0x12, 0x48, 0x26, 0x90, 0xAC, ++0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, ++0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0x90, 0xC1, 0x12, 0x27, 0x48, 0x90, 0x90, 0xC1, ++0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, ++0x90, 0x00, 0x02, 0xE0, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x12, 0x3A, 0x96, 0x7F, 0xB4, 0x7E, 0x08, ++0x12, 0x36, 0xCE, 0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0x90, 0xC1, 0x12, 0x27, 0x48, 0x90, 0x90, ++0xC1, 0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, ++0x5D, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, ++0x44, 0x20, 0xF0, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0x90, 0x8E, 0x87, 0x12, 0x27, 0x48, ++0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, ++0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, ++0x37, 0x5D, 0x90, 0x00, 0xFF, 0xE0, 0x70, 0x11, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xC0, 0xB1, 0x9A, ++0x90, 0x90, 0xC0, 0xE0, 0x44, 0x18, 0x12, 0x76, 0x76, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x60, ++0x4E, 0x90, 0x8F, 0x96, 0xE0, 0xFF, 0x60, 0x02, 0xD1, 0xB8, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x90, ++0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, ++0x8D, 0xF4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF0, 0x51, 0x46, 0x90, ++0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0xB1, 0xEB, 0xF1, 0xC8, 0x91, 0x95, 0x90, 0x05, 0x22, 0xE4, ++0xF0, 0x12, 0x85, 0xD8, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, 0xFF, 0x21, 0xF9, 0x7D, ++0x08, 0xE4, 0xFF, 0xD1, 0xE1, 0x90, 0x06, 0x90, 0xE4, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x54, 0xFB, ++0xF0, 0x12, 0x83, 0x70, 0xF1, 0xC9, 0x90, 0x8E, 0x96, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x9B, ++0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0x90, 0x8E, 0xA8, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x06, 0x90, ++0xE0, 0x44, 0x20, 0xF0, 0x90, 0x8E, 0x97, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, ++0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, ++0xA3, 0xE0, 0x54, 0x80, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x98, ++0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x8E, 0x9A, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8E, 0x96, 0xE0, 0x54, 0xFE, ++0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x26, 0x1E, ++0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x90, 0x8E, 0x96, 0xF0, 0xEE, 0x54, 0x08, ++0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, ++0xEF, 0x4D, 0xFF, 0x90, 0x8E, 0x96, 0xF0, 0xEE, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xFF, ++0xF0, 0x12, 0x26, 0x1E, 0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0x90, 0x8E, 0x96, 0xF0, 0x90, ++0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, ++0x8D, 0xF4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x8E, 0x96, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, 0x12, ++0x86, 0x10, 0x90, 0x8E, 0x96, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFF, 0xF1, 0xCA, 0x90, 0x8E, 0x96, ++0xE0, 0xC4, 0x54, 0x01, 0xFF, 0xF1, 0xD0, 0x90, 0x8E, 0x96, 0xE0, 0x54, 0x01, 0xFF, 0x71, 0x2E, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8E, 0x87, 0x12, ++0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, ++0x8E, 0x87, 0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, ++0x37, 0x5D, 0x90, 0x00, 0x10, 0xE0, 0x44, 0x0C, 0xFD, 0x7F, 0x10, 0x12, 0x3A, 0x96, 0x90, 0x00, ++0x72, 0xE0, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x3A, 0x96, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, ++0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, ++0x74, 0x86, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xBF, 0xFF, 0xEC, 0x90, ++0x90, 0xBB, 0x12, 0x27, 0x48, 0x90, 0x90, 0xBB, 0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, ++0x48, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x01, 0xFD, 0x7F, ++0x02, 0x12, 0x3A, 0x96, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, ++0x90, 0x90, 0xBB, 0x12, 0x27, 0x48, 0x90, 0x90, 0xBB, 0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, ++0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, ++0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0x90, 0xBB, 0x12, 0x27, 0x48, 0x90, 0x90, 0xBB, 0x12, 0x48, ++0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, ++0xFF, 0xE0, 0x70, 0x1B, 0xB1, 0x94, 0x90, 0x90, 0xBF, 0xE0, 0x54, 0xE7, 0x12, 0x76, 0x76, 0xB1, ++0x94, 0x90, 0x90, 0xBF, 0xE0, 0x54, 0x18, 0x70, 0x06, 0x90, 0x01, 0xBF, 0xE0, 0x04, 0xF0, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xBF, 0x7D, 0x08, 0x7F, 0x01, 0x90, 0x90, ++0xD6, 0x12, 0x48, 0x53, 0xEF, 0x70, 0x07, 0x90, 0x90, 0xD9, 0x04, 0xF0, 0x80, 0x0B, 0xEF, 0x64, ++0x01, 0x70, 0x2E, 0x90, 0x90, 0xD9, 0x74, 0x40, 0xF0, 0x7F, 0xE2, 0x12, 0x3A, 0x96, 0x90, 0x90, ++0xD9, 0xE0, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x90, 0x00, 0xE1, 0xE0, 0xFF, 0x90, 0x90, 0xD6, ++0x12, 0x48, 0x4A, 0xEF, 0x12, 0x26, 0x64, 0xE4, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x7F, 0x01, ++0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0x12, 0x82, 0x49, 0x90, 0x02, ++0x87, 0xE0, 0x70, 0xF7, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0x90, 0x90, 0xF9, 0xEF, ++0xF0, 0x91, 0x95, 0x90, 0x90, 0xF9, 0xE0, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, ++0x7D, 0x74, 0x04, 0xF0, 0x22, 0x90, 0x90, 0x07, 0x12, 0x48, 0x53, 0x90, 0x00, 0x01, 0x12, 0x26, ++0x37, 0xFF, 0xFE, 0x12, 0x26, 0x1E, 0xFD, 0xC3, 0x13, 0x30, 0xE0, 0x12, 0x90, 0x90, 0x07, 0x12, ++0x48, 0x4A, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0x90, 0x0B, 0xF0, 0x80, 0x05, 0x90, 0x90, ++0x0B, 0xEF, 0xF0, 0x90, 0x90, 0x0A, 0xEE, 0xF0, 0x90, 0x90, 0x0B, 0xE0, 0xFE, 0x90, 0x90, 0x0A, ++0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x3A, 0x90, 0x90, 0x07, 0x12, 0x48, 0x4A, 0x12, 0x26, 0x1E, 0x54, ++0x01, 0xFE, 0x74, 0xF6, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0xF6, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xE0, 0x70, 0x05, 0x12, 0x72, 0xA8, 0x80, 0x08, ++0x90, 0x90, 0x0A, 0xE0, 0xFF, 0x12, 0x72, 0x97, 0x90, 0x90, 0x0A, 0xE0, 0x04, 0xF0, 0x80, 0xB8, ++0x90, 0x8D, 0xF6, 0xE0, 0x70, 0x21, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x03, 0xFF, 0xB1, 0xFC, 0x90, ++0x8E, 0x7D, 0xE0, 0x64, 0x0C, 0x60, 0x03, 0x12, 0x88, 0x11, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xF7, ++0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x12, 0x6C, 0x6D, 0x7E, 0x00, 0x74, 0x00, 0x2F, ++0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x08, 0x7B, 0x01, ++0x7A, 0x8E, 0x79, 0xB0, 0x02, 0x34, 0x2C, 0x7D, 0x02, 0x7F, 0x02, 0xD1, 0xE1, 0x7D, 0x01, 0x7F, ++0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0x8F, 0xAC, 0xE0, 0x04, 0xF0, 0x90, ++0x8E, 0x7D, 0xE0, 0x64, 0x02, 0x60, 0x29, 0x12, 0x6E, 0x48, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, ++0x13, 0x54, 0x1F, 0x30, 0xE0, 0x14, 0x90, 0x8E, 0x80, 0xE0, 0xFF, 0xA3, 0xE0, 0x6F, 0x70, 0x0A, ++0xF1, 0xDE, 0xD1, 0xD7, 0x90, 0x8E, 0x81, 0xE0, 0x14, 0xF0, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, ++0x22, 0xEF, 0x70, 0x33, 0x7D, 0x78, 0x7F, 0x02, 0xD1, 0xE1, 0x7D, 0x02, 0x7F, 0x03, 0xD1, 0xE1, ++0x7D, 0xC8, 0x7F, 0x02, 0xF1, 0xB0, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, ++0xF0, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x5D, 0xFF, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xF7, 0xF0, 0x90, ++0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, ++0xF0, 0x7D, 0x78, 0xFF, 0x31, 0xF9, 0x7D, 0x02, 0x7F, 0x03, 0x31, 0xF9, 0x90, 0x06, 0x0A, 0xE0, ++0x44, 0x07, 0xF0, 0x90, 0x8E, 0x85, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x8D, 0xF6, 0xE0, ++0xB4, 0x01, 0x15, 0x90, 0x8E, 0x78, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x20, 0xE2, ++0x0E, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x5D, 0xFF, 0x90, 0x8E, 0x78, 0xE0, 0x44, 0x04, 0xF0, 0x22, ++0x74, 0x65, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x22, 0x22, 0x90, 0x90, 0x07, 0xEF, 0xF0, 0x22, ++0x90, 0x90, 0x07, 0xEF, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0x8E, 0x84, 0xF0, 0x22, 0xEF, 0x14, ++0x90, 0x05, 0x73, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x74, 0x65, 0x2F, ++0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, ++0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, ++0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, ++0x01, 0xC4, 0x74, 0x02, 0xF0, 0x74, 0x68, 0xA3, 0xF0, 0x91, 0xE5, 0xE5, 0x69, 0x30, 0xE1, 0x02, ++0x11, 0x85, 0xE5, 0x69, 0x30, 0xE2, 0x02, 0x11, 0x8E, 0xE5, 0x6A, 0x30, 0xE0, 0x02, 0x31, 0x27, ++0xE5, 0x6C, 0x30, 0xE1, 0x04, 0x7F, 0x04, 0x91, 0x30, 0xE5, 0x6C, 0x30, 0xE4, 0x03, 0x12, 0x62, ++0x0E, 0xE5, 0x6C, 0x30, 0xE5, 0x02, 0x11, 0xA7, 0xE5, 0x6C, 0x30, 0xE6, 0x02, 0x11, 0xE9, 0x74, ++0x02, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x68, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, ++0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, ++0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x02, 0x31, 0x70, 0x22, 0x90, 0x8E, ++0x7A, 0xE0, 0x60, 0x12, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x02, 0x41, 0x9B, 0x90, 0x8E, 0x77, ++0xE0, 0x54, 0xF7, 0xF0, 0x11, 0xDF, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, ++0x03, 0x30, 0xE0, 0x26, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x8E, 0x78, 0x30, ++0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0xB9, 0x74, ++0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x11, 0xDF, 0xE4, 0xFF, 0x02, 0x57, 0x5E, 0x90, ++0x8E, 0x7C, 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x5D, 0xFF, 0x90, 0x8E, 0x77, 0xE0, 0xFF, 0xC4, 0x13, ++0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x2B, 0xEF, 0x54, 0x7F, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, ++0x8E, 0x78, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x0F, 0xE0, 0x54, 0xFD, 0xF0, 0x90, ++0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x02, ++0x11, 0xDF, 0x7F, 0x01, 0x02, 0x57, 0x5E, 0xB1, 0x15, 0x90, 0x90, 0x46, 0xEF, 0xF0, 0x90, 0x8E, ++0x77, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x90, ++0x46, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, ++0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0x8E, 0x85, ++0xE4, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x90, 0x8E, 0x85, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, ++0x90, 0x8E, 0x77, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x11, 0xEF, 0x54, 0xFB, 0xF0, ++0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x41, 0x80, 0x3D, 0x90, 0x8E, 0x83, ++0xE0, 0x04, 0xF0, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x8E, 0x83, 0xE0, 0xFF, 0xB4, ++0x01, 0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, 0x06, 0x90, 0x05, 0x58, 0xE0, 0x04, 0xF0, 0x90, 0x8E, ++0x8B, 0xE0, 0xFF, 0x90, 0x8E, 0x83, 0xE0, 0xD3, 0x9F, 0x40, 0x0F, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, ++0x01, 0x0A, 0x90, 0x8E, 0x78, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x11, 0xDF, 0x22, 0xE4, 0x90, 0x90, ++0x37, 0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x90, 0x90, 0x37, 0xF0, 0xE0, 0x54, 0xC0, 0x70, 0x0C, 0x90, ++0x8E, 0x7E, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x01, 0xDF, 0x90, 0x90, 0x37, 0xE0, 0x30, ++0xE6, 0x21, 0x90, 0x8E, 0x7A, 0xE0, 0x64, 0x01, 0x70, 0x20, 0x90, 0x8E, 0x7E, 0xE0, 0x44, 0x01, ++0xF0, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x04, 0x51, 0x65, 0x80, 0x0B, 0x51, ++0x4E, 0x80, 0x07, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x90, 0x37, 0xE0, 0x90, 0x8E, ++0x7E, 0x30, 0xE7, 0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x8C, 0xE0, 0xF5, ++0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, ++0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x51, 0x9B, ++0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x0C, 0x60, 0x0C, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x5D, 0xFF, 0xE4, ++0xFF, 0x12, 0x57, 0xAF, 0x22, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x13, 0x90, 0x8D, 0x06, 0xE0, 0xFF, ++0xE4, 0xFD, 0x51, 0xDD, 0x8E, 0x15, 0x8F, 0x16, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x90, ++0x8D, 0xF6, 0xE0, 0xB4, 0x01, 0x14, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x0E, 0x90, 0x8E, 0x79, 0xE0, ++0x54, 0x0F, 0x64, 0x02, 0x60, 0x02, 0x80, 0xCD, 0x51, 0x4E, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0x13, ++0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, ++0x02, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x8D, 0xE0, 0xC3, ++0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, ++0x01, 0x5B, 0x74, 0x05, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0xEC, 0xED, 0xF0, 0x90, 0x90, 0xEB, 0xEF, 0xF0, 0xE4, 0xFD, ++0xFC, 0x91, 0x6D, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x90, 0xEB, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, ++0x90, 0xEC, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, ++0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, ++0x54, 0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, ++0xF0, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0xAE, ++0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8D, 0x07, 0xE0, 0xFF, 0x7D, 0x01, 0x51, ++0xDD, 0x8E, 0x12, 0x8F, 0x13, 0xAD, 0x13, 0xAC, 0x12, 0xAF, 0x11, 0x71, 0xE5, 0xAF, 0x13, 0xAE, ++0x12, 0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x01, 0xF0, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, 0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, ++0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF5, 0x82, 0xE4, 0x34, ++0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xED, 0xF0, 0x22, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, ++0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x1D, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x44, 0x10, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, ++0x80, 0xF0, 0x22, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xEF, ++0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x40, 0xF0, 0x22, ++0x8F, 0x17, 0x7F, 0x02, 0x12, 0x4C, 0x53, 0x90, 0x8D, 0x01, 0xE0, 0x45, 0x17, 0xF0, 0x22, 0x12, ++0x70, 0xE2, 0x7F, 0x02, 0x80, 0xEA, 0x90, 0x8E, 0x96, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x10, 0x91, ++0x30, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, 0x01, 0x13, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x0D, 0x90, ++0x8E, 0x7E, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x07, 0x70, 0x02, 0x11, 0xDF, 0x22, 0xE4, 0xFE, 0xEF, ++0x25, 0xE0, 0xFD, 0xEF, 0xC3, 0x94, 0x80, 0x90, 0xFD, 0x12, 0x50, 0x04, 0xE4, 0xF0, 0x80, 0x03, ++0x74, 0x01, 0xF0, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x90, 0x8E, 0x7A, 0xE0, 0x64, ++0x01, 0x70, 0x1A, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x60, 0x09, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, ++0x5D, 0xFF, 0x41, 0x9B, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x03, 0x12, 0x5D, 0xFB, 0x22, 0x90, 0x8E, ++0x7A, 0xE0, 0x60, 0x02, 0x91, 0x8B, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x25, 0x90, ++0x8E, 0x7A, 0xE0, 0x60, 0x1F, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, ++0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, ++0x70, 0x02, 0x11, 0xDF, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x65, 0xF5, 0x69, 0xA3, 0xE0, 0x55, ++0x66, 0xF5, 0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, 0x6B, 0xA3, 0xE0, 0x55, 0x68, 0xF5, 0x6C, 0x90, ++0x01, 0x3C, 0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, 0x6B, 0xF0, 0xA3, 0xE5, 0x6C, ++0xF0, 0x53, 0x91, 0xDF, 0x22, 0xE4, 0x90, 0x90, 0x47, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x00, ++0x83, 0xE0, 0x90, 0x90, 0x47, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, 0x90, 0x47, 0xE0, 0xFF, ++0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x90, 0x49, 0xE0, 0x94, 0x64, 0x90, 0x90, 0x48, 0xE0, 0x94, ++0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x90, 0x47, 0xE0, 0xFF, 0x22, ++0x90, 0x90, 0x48, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x80, 0xC2, 0x90, 0x90, 0x6F, 0xEF, ++0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, 0x0E, 0xA3, 0xE0, 0xF5, 0x0F, 0x65, 0x0E, 0x60, 0x6E, 0x90, ++0x90, 0x70, 0x74, 0x03, 0xF0, 0x90, 0x90, 0x7E, 0x74, 0x08, 0xF0, 0xE5, 0x0F, 0x04, 0x54, 0x0F, ++0xF5, 0x10, 0xE4, 0xF5, 0x0D, 0xE5, 0x10, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, ++0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x0D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, ++0xFF, 0x74, 0x72, 0x25, 0x0D, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x0D, ++0xE5, 0x0D, 0xB4, 0x08, 0xD0, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x70, 0xB1, 0xDE, 0xE5, 0x0F, 0x04, ++0x54, 0x0F, 0xF5, 0x0F, 0xB4, 0x0F, 0x03, 0xE4, 0xF5, 0x0F, 0x90, 0x04, 0x7F, 0xE5, 0x0F, 0xF0, ++0x90, 0x90, 0x6F, 0xE0, 0x7F, 0x04, 0x70, 0x02, 0x81, 0x30, 0x12, 0x60, 0x11, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8D, 0xF2, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, ++0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x8D, 0xF3, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, ++0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x35, 0xC0, 0x01, ++0x90, 0x8D, 0xF3, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x5C, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xA8, ++0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x47, 0xD0, 0x90, 0x8D, 0xF3, ++0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, ++0x8D, 0xF3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x60, 0x02, ++0xC1, 0xDD, 0x90, 0x8E, 0x7A, 0xE0, 0x70, 0x02, 0xC1, 0xDD, 0x90, 0x8E, 0x79, 0xE0, 0xC4, 0x54, ++0x0F, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x8E, 0x81, 0xF0, 0x90, 0x06, 0xAA, ++0xE0, 0x90, 0x8E, 0x80, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x8E, 0x80, 0xE0, 0xFE, 0xFF, ++0x80, 0x00, 0x90, 0x8E, 0x81, 0xEF, 0xF0, 0x90, 0x8E, 0x78, 0xE0, 0x44, 0x04, 0xF0, 0xE4, 0x90, ++0x8E, 0x83, 0xF0, 0x90, 0x8E, 0x85, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x01, 0x57, 0xE4, ++0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xEF, ++0xF0, 0x90, 0x8E, 0x79, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x02, 0x31, ++0xCD, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x10, 0x90, 0x8E, 0x80, ++0xE0, 0xFF, 0xA3, 0xE0, 0xB5, 0x07, 0x06, 0x12, 0x67, 0xDE, 0x12, 0x66, 0xDD, 0x22, 0xC0, 0xE0, ++0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0xDE, 0x90, ++0x01, 0xC4, 0xED, 0xF0, 0x74, 0x6E, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, ++0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, ++0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8D, 0x05, 0xF0, ++0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8D, 0x06, 0xF0, 0x90, 0x00, 0x02, ++0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8D, 0x07, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, ++0xFF, 0xED, 0x2F, 0x90, 0x8D, 0x08, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, 0xAE, 0x05, ++0xED, 0x2F, 0x90, 0x8D, 0x09, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x26, ++0x1E, 0xFF, 0x90, 0x8E, 0x76, 0xF0, 0xBF, 0x01, 0x12, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x64, ++0x01, 0x60, 0x17, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x0F, 0x90, 0x00, 0x01, 0x12, 0x26, ++0x37, 0x64, 0x01, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, ++0x26, 0x1E, 0xFF, 0x54, 0x7F, 0x90, 0x8E, 0x7A, 0xF0, 0xEF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, ++0xA3, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, ++0x8E, 0x79, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x54, 0x01, 0x25, ++0xE0, 0xFE, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0x90, 0x8E, 0x96, 0xE0, 0x30, 0xE0, ++0x09, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0xF0, 0x80, 0x0F, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, ++0xFF, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0x90, ++0x8E, 0x7C, 0xF0, 0x12, 0x70, 0x1B, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0xF0, ++0x90, 0x8E, 0x7A, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x8E, 0x7C, 0xE0, 0x90, 0x01, 0xBB, 0xF0, ++0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x90, 0x90, 0x07, 0x12, 0x48, ++0x53, 0x11, 0x4A, 0x90, 0x8E, 0x7A, 0xE0, 0xFF, 0x12, 0x67, 0x31, 0x90, 0x8E, 0x7A, 0xE0, 0x60, ++0x18, 0x90, 0x90, 0x07, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x54, 0x0F, 0xFF, ++0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x11, 0x5B, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFB, ++0xF0, 0xE4, 0x90, 0x8E, 0x83, 0xF0, 0x90, 0x8E, 0x7E, 0xF0, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0C, ++0x04, 0x70, 0x28, 0x90, 0x8E, 0x80, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x22, 0xED, 0x70, 0x0A, 0x90, ++0x8E, 0x8E, 0xE0, 0x90, 0x8E, 0x80, 0xF0, 0x80, 0x05, 0x90, 0x8E, 0x80, 0xED, 0xF0, 0x90, 0x8E, ++0x80, 0xE0, 0xA3, 0xF0, 0x90, 0x8E, 0x78, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x00, 0x02, 0x12, ++0x26, 0x37, 0xFF, 0x30, 0xE0, 0x26, 0x12, 0x26, 0x1E, 0x90, 0x8E, 0x8B, 0xF0, 0x90, 0x00, 0x01, ++0x12, 0x26, 0x37, 0x90, 0x8E, 0x8C, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xA3, 0xE0, 0x54, 0x01, 0x4F, ++0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x90, 0x8E, 0x8E, 0xF0, 0x22, 0x90, 0x8E, 0x8B, 0x74, ++0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, ++0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0x8E, 0x91, 0xF0, 0x90, 0x8E, 0x91, 0xE0, 0x90, 0x01, 0xE7, ++0xF0, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0x90, 0xDD, 0xF0, 0x90, 0x90, 0xDD, 0xE0, ++0xFD, 0x70, 0x02, 0x41, 0x96, 0x90, 0x8D, 0x5A, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, ++0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x8D, 0x5B, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, ++0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x90, 0xDA, ++0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, ++0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x41, 0x8F, 0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, ++0x90, 0x01, 0xD0, 0x12, 0x48, 0x3E, 0xE0, 0x90, 0x90, 0xDE, 0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, ++0x90, 0x75, 0x42, 0xDE, 0x75, 0x43, 0x01, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xDF, 0x12, 0x34, 0x2C, ++0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x48, 0x3E, 0xE0, 0xFF, 0x90, ++0x8D, 0x5B, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0x8D, 0x0A, 0x12, 0x48, 0x3E, 0xEF, 0xF0, 0x90, ++0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD1, 0x12, 0x48, 0x3E, 0xE0, 0xFF, 0x75, 0xF0, ++0x08, 0xEE, 0x90, 0x8D, 0x0B, 0x12, 0x48, 0x3E, 0xEF, 0xF0, 0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, ++0x04, 0x90, 0x01, 0xD2, 0x12, 0x48, 0x3E, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0C, ++0x12, 0x48, 0x3E, 0xEF, 0xF0, 0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD3, 0x12, ++0x48, 0x3E, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0D, 0x12, 0x48, 0x3E, 0xEF, 0xF0, ++0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF0, 0x12, 0x48, 0x3E, 0xE0, 0xFF, 0x75, ++0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0E, 0x12, 0x48, 0x3E, 0xEF, 0xF0, 0x90, 0x90, 0xDA, 0xE0, 0x75, ++0xF0, 0x04, 0x90, 0x01, 0xF1, 0x12, 0x48, 0x3E, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, ++0x0F, 0x12, 0x48, 0x3E, 0xEF, 0xF0, 0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF2, ++0x12, 0x48, 0x3E, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x10, 0x12, 0x48, 0x3E, 0xEF, ++0xF0, 0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF3, 0x12, 0x48, 0x3E, 0xE0, 0xFF, ++0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x11, 0x12, 0x48, 0x3E, 0xEF, 0xF0, 0x90, 0x90, 0xDD, 0xE0, ++0xFF, 0x90, 0x90, 0xDA, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, ++0xFC, 0xF4, 0x5F, 0x90, 0x90, 0xDD, 0xF0, 0x90, 0x90, 0xDA, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, ++0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0x90, 0xDA, 0xE0, 0x04, ++0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0x8D, 0x5B, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, ++0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x01, 0xEC, 0xE4, 0x90, 0x8D, 0x5B, 0xF0, 0x01, 0xEC, 0x90, ++0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0x8F, 0x19, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, ++0x12, 0x48, 0x3E, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x8F, 0x19, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, ++0x05, 0x12, 0x48, 0x3E, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x0D, 0x51, 0xC5, 0xE4, 0xFD, 0x0F, 0x51, ++0xC5, 0x0D, 0x51, 0xC5, 0x0D, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, ++0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, ++0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x00, 0x8F, 0xE0, 0x20, 0xE6, 0x02, 0x81, 0x45, 0x90, 0x00, 0x8C, ++0xE0, 0x90, 0x90, 0xE0, 0xF0, 0x90, 0x00, 0x8D, 0xE0, 0x90, 0x90, 0xE1, 0xF0, 0x90, 0x00, 0x8E, ++0xE0, 0x90, 0x90, 0xE2, 0xF0, 0x90, 0x90, 0xE1, 0xE0, 0x24, 0xF1, 0x70, 0x02, 0x61, 0xE1, 0x24, ++0x07, 0x60, 0x02, 0x81, 0x37, 0x90, 0x8E, 0x7A, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x51, 0xC5, 0x90, ++0x8E, 0x79, 0xE0, 0x54, 0x0F, 0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x8E, 0x7C, 0xE0, 0xFB, 0x0D, 0x51, ++0xC5, 0x90, 0x8E, 0x7D, 0xE0, 0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x90, 0xE0, 0xE0, 0x24, 0xF6, 0xF5, ++0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xC5, 0x90, 0x8E, 0x77, ++0xE0, 0x54, 0x01, 0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x8E, 0x77, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, ++0xFB, 0x0D, 0x7F, 0x01, 0x51, 0xC5, 0x90, 0x8E, 0x77, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, ++0xFB, 0x0D, 0x7F, 0x01, 0x51, 0xC5, 0x90, 0x8D, 0x02, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xC5, ++0x90, 0x8D, 0x03, 0xE0, 0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x8E, 0x81, 0xE0, 0xFB, 0x0D, 0x51, 0xC5, ++0x90, 0x8E, 0x80, 0xE0, 0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x8E, 0x79, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, ++0xE4, 0xFD, 0x7F, 0x03, 0x51, 0xC5, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, ++0x7F, 0x03, 0x51, 0xC5, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, ++0x03, 0x51, 0xC5, 0x90, 0x8E, 0x77, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0x80, ++0x54, 0x90, 0x8E, 0x96, 0xE0, 0x54, 0x01, 0xFB, 0xE4, 0xFD, 0xFF, 0x51, 0xC5, 0x90, 0x8E, 0x97, ++0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0xE4, 0xFF, 0x51, 0xC5, 0x90, 0x8E, 0x97, ++0xE0, 0xC4, 0x54, 0x01, 0xFB, 0x0D, 0xE4, 0xFF, 0x51, 0xC5, 0x90, 0x8E, 0x9B, 0xE0, 0x54, 0x01, ++0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x8E, 0xA8, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xC5, 0x90, 0x8E, ++0xA9, 0xE0, 0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x8E, 0xAA, 0xE0, 0xFB, 0x0D, 0x51, 0xC5, 0xE4, 0xFB, ++0x51, 0xB9, 0x51, 0xB9, 0x0D, 0x51, 0xC5, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, ++0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x90, 0x00, 0xF0, 0xA3, ++0xF0, 0x90, 0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, ++0x45, 0xC3, 0x90, 0x90, 0x01, 0xE0, 0x94, 0x88, 0x90, 0x90, 0x00, 0xE0, 0x94, 0x13, 0x40, 0x0F, ++0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x03, 0xF0, 0x80, 0x27, 0x90, ++0x90, 0x00, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, ++0xD3, 0x90, 0x90, 0x01, 0xE0, 0x94, 0x32, 0x90, 0x90, 0x00, 0xE0, 0x94, 0x00, 0x40, 0xB2, 0x90, ++0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xAB, 0x90, 0x01, 0xC7, 0x74, 0x05, 0xF0, 0x22, 0x7F, 0x02, 0x90, ++0x8F, 0xA3, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, ++0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, ++0xDE, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x5D, 0xF5, 0x61, 0xA3, 0xE0, 0x55, 0x5E, ++0xF5, 0x62, 0xA3, 0xE0, 0x55, 0x5F, 0xF5, 0x63, 0xA3, 0xE0, 0x55, 0x60, 0xF5, 0x64, 0x90, 0x01, ++0x34, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, 0x62, 0xF0, 0xA3, 0xE5, 0x63, 0xF0, 0xA3, 0xE5, 0x64, 0xF0, ++0x22, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x46, 0x90, 0x8E, 0x78, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, ++0x1F, 0x30, 0xE0, 0x13, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0C, 0x12, 0x66, 0xD7, 0x90, 0x8E, ++0x80, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0x90, 0xE9, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, ++0xF6, 0xC3, 0x90, 0x90, 0xEA, 0xE0, 0x94, 0x80, 0x90, 0x90, 0xE9, 0xE0, 0x64, 0x80, 0x94, 0x80, ++0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0xB1, 0xA1, 0xB1, ++0x6B, 0x90, 0x8E, 0x92, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0B, 0x12, ++0x66, 0xD7, 0x90, 0x8E, 0x94, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x90, 0x8F, 0xA4, 0xE0, 0x30, ++0xE0, 0x2E, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, 0x01, 0x27, 0x90, 0x90, 0xF8, 0xE0, 0x04, 0xF0, 0xE0, ++0xB4, 0x0A, 0x0B, 0x90, 0x8F, 0xA6, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x90, 0xF8, 0xF0, 0x90, 0x8F, ++0xA6, 0xE0, 0xFF, 0x90, 0x8F, 0xA5, 0xE0, 0xB5, 0x07, 0x06, 0xE4, 0xA3, 0xF0, 0x12, 0x57, 0xAD, ++0x22, 0x90, 0x8F, 0xA7, 0xE0, 0x30, 0xE0, 0x36, 0x90, 0x8F, 0xAA, 0xE0, 0x04, 0xF0, 0xE0, 0xFF, ++0x90, 0x8F, 0xA8, 0xE0, 0x6F, 0x70, 0x27, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x11, 0x90, 0x8F, ++0xAC, 0xE0, 0x70, 0x0B, 0x12, 0x57, 0xAD, 0x90, 0x8F, 0xAB, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, ++0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0x8F, 0xAA, 0xF0, 0x90, 0x8F, 0xAC, 0xF0, 0x22, 0x90, ++0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x2A, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, ++0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x8C, 0xE0, 0xF5, ++0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, ++0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, ++0x05, 0x22, 0xE0, 0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, ++0xC6, 0xE0, 0x30, 0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0xC3, 0xEE, 0x94, 0x01, 0x40, 0x0A, 0x0D, 0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, ++0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x1E, 0x90, 0xFD, 0x11, 0xE0, 0xB5, 0x05, 0x14, 0x90, 0x01, ++0x17, 0xE0, 0xB5, 0x05, 0x07, 0x90, 0xFD, 0x11, 0xE4, 0xF0, 0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, ++0x11, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xFB, 0x7D, 0x08, 0x7F, 0x01, 0x90, 0x90, 0xED, 0xEB, 0xF0, ++0xEF, 0x70, 0x06, 0xA3, 0x74, 0x03, 0xF0, 0x80, 0x0B, 0xEF, 0x64, 0x01, 0x70, 0x35, 0x90, 0x90, ++0xEE, 0x74, 0x42, 0xF0, 0x7F, 0xE2, 0x12, 0x3A, 0x96, 0x90, 0x90, 0xED, 0xE0, 0xFD, 0x7F, 0xE0, ++0x12, 0x3A, 0x96, 0x90, 0x90, 0xEE, 0xE0, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x90, 0x90, 0xEE, ++0xE0, 0x54, 0xFD, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, ++0x7F, 0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0xE4, 0x90, 0x90, ++0xEF, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, ++0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0x90, 0xF0, 0xE0, 0x94, 0xE8, ++0x90, 0x90, 0xEF, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x7F, ++0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x90, 0xEF, 0xE4, 0x75, 0xF0, 0x01, ++0x12, 0x47, 0xF6, 0x80, 0xBF, 0x8F, 0x18, 0xE4, 0x90, 0x90, 0xF1, 0xF0, 0xA3, 0xF0, 0x90, 0x01, ++0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0xEF, 0x65, 0x18, 0x60, 0x3E, 0xC3, 0x90, ++0x90, 0xF2, 0xE0, 0x94, 0x88, 0x90, 0x90, 0xF1, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, ++0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x90, 0xF1, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x7F, ++0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0x90, 0xF2, 0xE0, 0x94, 0x32, 0x90, 0x90, 0xF1, ++0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB2, 0x22, 0xF1, 0xBC, 0x90, ++0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0xE4, 0xFF, 0xF1, 0x15, 0x90, ++0x8D, 0x04, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x54, 0x7F, 0xFD, 0x7F, 0x70, 0x12, ++0x3A, 0x96, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0xCE, 0xF1, 0x6D, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x90, 0x8E, 0x7D, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0E, 0x12, 0x87, 0x86, ++0xBF, 0x01, 0x08, 0xF1, 0x93, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x00, 0x90, 0xE0, ++0x20, 0xE0, 0xF9, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0x30, 0xE0, 0x02, 0xF1, 0xA3, 0x22, 0x90, 0x8D, ++0x04, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x70, 0x12, 0x3A, ++0x96, 0x90, 0x8E, 0x84, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x3A, 0x96, 0x90, 0x8E, 0x7B, 0xE0, 0x60, ++0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, ++0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0x7F, ++0x01, 0x12, 0x77, 0x15, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x3A, 0x96, ++0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3A, 0xF7, 0x90, 0x90, 0xF6, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0xFF, ++0xAE, 0xF0, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0x90, 0x63, 0x12, 0x27, 0x48, 0x7F, 0xAC, ++0x7E, 0x08, 0x90, 0x90, 0x5D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x36, 0xCE, 0x90, 0x90, 0x67, ++0x12, 0x27, 0x48, 0x90, 0x90, 0x5F, 0x12, 0x48, 0x26, 0x12, 0x27, 0x15, 0x90, 0x90, 0x67, 0x12, ++0x48, 0x32, 0x12, 0x48, 0x0C, 0x90, 0x90, 0x63, 0x12, 0x48, 0x32, 0x12, 0x48, 0x19, 0x90, 0x90, ++0x6B, 0x12, 0x27, 0x48, 0x90, 0x90, 0x6B, 0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, ++0x90, 0x90, 0x5D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x02, 0x37, 0x5D, 0x7F, 0x1C, 0x7E, 0x0C, 0x11, ++0x42, 0x90, 0x90, 0xE6, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x90, 0xF7, 0xED, 0xF0, 0xEF, 0x60, ++0x02, 0x21, 0x73, 0xE0, 0x24, 0xFD, 0x50, 0x07, 0x60, 0x35, 0x14, 0x60, 0x62, 0x61, 0x41, 0x90, ++0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, ++0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, ++0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x41, 0x21, 0x90, ++0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x54, ++0x33, 0x77, 0x70, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, ++0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0x41, 0xED, 0x90, ++0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, ++0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, ++0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, ++0x0E, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, ++0x12, 0x27, 0x54, 0x00, 0x10, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, ++0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x10, 0x00, ++0x00, 0x41, 0xB9, 0x90, 0x90, 0xF7, 0xE0, 0x14, 0x60, 0x79, 0x14, 0x70, 0x02, 0x41, 0x57, 0x14, ++0x70, 0x02, 0x41, 0xBF, 0x14, 0x70, 0x02, 0x41, 0x57, 0x24, 0x04, 0x60, 0x02, 0x61, 0x41, 0x90, ++0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, ++0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, ++0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, ++0x0E, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, ++0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, ++0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, ++0x00, 0x41, 0xB9, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, ++0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, ++0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, ++0x17, 0x7F, 0xB0, 0x7E, 0x0E, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, ++0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x11, ++0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x00, 0x00, 0x80, 0x62, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, ++0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, ++0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, ++0x54, 0x77, 0x33, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, ++0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, ++0xB4, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, ++0x90, 0x63, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0E, 0x61, 0x3F, 0x90, ++0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x54, ++0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, ++0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, ++0x0E, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, ++0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, ++0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, ++0x00, 0x7F, 0xB4, 0x7E, 0x0E, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, ++0x03, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x09, 0x11, ++0x42, 0x22, 0x90, 0x90, 0xE7, 0xED, 0xF0, 0x90, 0x90, 0xE6, 0xEF, 0xF0, 0x60, 0x02, 0x61, 0xDE, ++0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, ++0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, ++0x00, 0x00, 0x00, 0x03, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x2C, ++0x7E, 0x08, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0F, 0x00, 0x90, 0x90, ++0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x11, 0x8B, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, ++0x00, 0x00, 0x00, 0xF0, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x7F, 0x0C, ++0x7E, 0x08, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x0F, 0x00, 0x00, 0x00, 0x90, 0x90, ++0x63, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0x04, 0x7E, 0x0A, 0x11, 0x42, 0x90, 0x04, ++0x54, 0xE0, 0x54, 0x7F, 0x90, 0x90, 0xE8, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x22, 0x90, 0x90, ++0xE6, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x81, 0x8F, 0x90, 0x04, 0x54, 0xE0, 0x44, 0x80, 0x90, 0x90, ++0xE8, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, ++0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x11, ++0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0x90, 0x63, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x2C, 0x7E, 0x08, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x0F, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, 0x00, 0x11, ++0x8B, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0x90, 0x63, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x0C, 0x7E, 0x08, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, ++0x54, 0x0F, 0x00, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x0F, 0x00, 0x00, 0x00, 0x7F, ++0x04, 0x7E, 0x0A, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, ++0x90, 0x63, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x11, 0x42, 0x22, ++0x90, 0x90, 0xF6, 0xED, 0xF0, 0xEF, 0x14, 0x60, 0x23, 0x14, 0x70, 0x02, 0xA1, 0x3E, 0x24, 0x02, ++0x60, 0x02, 0xA1, 0x8C, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0x90, ++0x63, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x00, 0x7F, 0xAC, 0xA1, 0x88, 0x90, 0x90, 0x5F, 0x12, ++0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x01, ++0x11, 0x3E, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, 0x11, 0x27, 0x90, 0x90, ++0x5F, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0x90, 0xF6, 0xE0, 0x7E, 0x00, 0x78, 0x1C, ++0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0x90, ++0x63, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x11, 0x42, 0x90, 0x90, 0xF6, 0xE0, 0x90, 0x90, ++0x5F, 0xB4, 0x01, 0x13, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0x90, 0x63, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x00, 0x10, 0x80, 0x11, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0x90, ++0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, 0x0A, 0x80, 0x4C, 0x90, 0x90, ++0x5F, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x30, ++0x02, 0x02, 0x11, 0x3E, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, 0x11, 0x27, ++0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0x90, 0xF6, 0xE0, 0x7E, 0x00, ++0x78, 0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, ++0x90, 0x90, 0x63, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x11, 0x42, 0x22, 0x90, 0x90, 0xF4, ++0xED, 0xF0, 0x90, 0x90, 0xF3, 0xEF, 0xF0, 0xD3, 0x94, 0x0E, 0x50, 0x15, 0xB1, 0xCB, 0xEF, 0x60, ++0x29, 0xB1, 0xCB, 0xEF, 0x64, 0x01, 0x70, 0x22, 0x90, 0x90, 0xF4, 0xE0, 0xFD, 0xE4, 0xFF, 0x80, ++0x15, 0x90, 0x90, 0xF3, 0xE0, 0xD3, 0x94, 0x0E, 0x40, 0x10, 0xB1, 0xCB, 0xEF, 0x70, 0x09, 0x90, ++0x90, 0xF4, 0xE0, 0xFD, 0x7F, 0x01, 0x61, 0x42, 0xB1, 0xCB, 0x22, 0x90, 0x04, 0x54, 0xE0, 0x7F, ++0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x90, 0xE4, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, ++0x90, 0xE3, 0xEF, 0xF0, 0xE4, 0xFE, 0xD1, 0xEB, 0x90, 0x90, 0xE3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, ++0xA3, 0xE0, 0xFB, 0xF1, 0x1E, 0xAE, 0x07, 0x90, 0x04, 0x83, 0xEE, 0xF0, 0x90, 0x90, 0xE3, 0xE0, ++0xFF, 0xAD, 0x06, 0x91, 0x90, 0x90, 0x90, 0xE3, 0xE0, 0xFF, 0xEF, 0x14, 0x60, 0x39, 0x14, 0x60, ++0x52, 0x24, 0x02, 0x70, 0x6A, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, ++0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0xD1, 0x8C, 0x90, 0x90, 0x4D, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x7D, ++0x18, 0x7C, 0x00, 0x7F, 0x01, 0x80, 0x36, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, ++0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x00, 0x04, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, ++0xFF, 0x80, 0x1A, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x90, 0x51, ++0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0xD1, 0x92, 0x22, ++0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x90, 0x51, 0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, 0x00, ++0xE4, 0xFF, 0x90, 0x90, 0x4B, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x90, 0x4A, 0xEF, 0xF0, 0xA3, ++0xA3, 0xE0, 0xFD, 0x12, 0x3A, 0xA9, 0x90, 0x90, 0x55, 0x12, 0x27, 0x48, 0x90, 0x90, 0x4D, 0x12, ++0x48, 0x26, 0x12, 0x27, 0x15, 0x90, 0x90, 0x55, 0x12, 0x48, 0x32, 0x12, 0x48, 0x0C, 0x90, 0x90, ++0x51, 0x12, 0x48, 0x32, 0x12, 0x48, 0x19, 0x90, 0x90, 0x59, 0x12, 0x27, 0x48, 0x90, 0x90, 0x4B, ++0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x90, 0x59, 0x12, 0x48, 0x26, 0x90, 0xAC, 0x96, 0x12, 0x27, ++0x48, 0x90, 0x90, 0x4A, 0xE0, 0xFF, 0xD0, 0x05, 0x02, 0x39, 0xBA, 0xA9, 0x07, 0x90, 0x06, 0x69, ++0xE0, 0xFE, 0x90, 0x06, 0x68, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0xFE, 0xE9, 0x14, ++0x60, 0x13, 0x14, 0x60, 0x10, 0x24, 0x02, 0x70, 0x14, 0xEE, 0x54, 0xFE, 0xFE, 0xEF, 0x54, 0x7F, ++0x90, 0x06, 0x68, 0x80, 0x04, 0x90, 0x06, 0x68, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xE4, 0xFE, ++0xFC, 0xEF, 0x64, 0x02, 0x70, 0x40, 0xED, 0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, 0x06, 0xED, 0xB4, ++0x02, 0x02, 0x7E, 0x09, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x04, 0x80, 0x38, ++0xEB, 0xB4, 0x02, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, 0xB4, 0x01, 0x08, ++0xED, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, 0xED, 0x64, 0x02, ++0x70, 0x16, 0x7C, 0x03, 0x80, 0x12, 0xEF, 0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, 0x04, 0x7C, 0x01, ++0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7C, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4C, 0xFF, ++0x22, 0x90, 0x90, 0xC6, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x90, 0xC5, 0xEF, 0xF0, 0x90, 0x90, ++0xC8, 0xE0, 0xFD, 0xB1, 0x8D, 0x90, 0x90, 0xC5, 0xE0, 0xC3, 0x94, 0x0E, 0x50, 0x47, 0x90, 0x90, ++0x5F, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x12, 0xD4, ++0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0x11, 0x42, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, ++0x03, 0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xD1, 0x8C, 0x90, 0x90, ++0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x00, ++0x00, 0x00, 0x02, 0x81, 0x32, 0x90, 0x90, 0xC5, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, 0x1B, ++0xEF, 0x94, 0x30, 0x50, 0x16, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, ++0x90, 0x63, 0x12, 0x27, 0x54, 0x09, 0x28, 0x00, 0x00, 0x80, 0x70, 0x90, 0x90, 0xC5, 0xE0, 0xFF, ++0x74, 0x32, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x40, 0x50, 0x16, 0x90, 0x90, 0x5F, 0x12, 0x27, ++0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x08, 0xA6, 0x00, 0x00, 0x80, ++0x4A, 0x90, 0x90, 0xC5, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x74, 0x50, ++0x16, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, ++0x54, 0x08, 0xA4, 0x00, 0x00, 0x80, 0x24, 0x90, 0x90, 0xC5, 0xE0, 0xFF, 0x74, 0x76, 0xD3, 0x9F, ++0x50, 0x20, 0xEF, 0x94, 0xA5, 0x50, 0x1B, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, ++0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x08, 0x24, 0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0x12, ++0x78, 0x42, 0x90, 0x90, 0xC5, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, 0x32, 0xEF, 0x94, 0x40, ++0x50, 0x2D, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0x90, 0x51, 0x12, ++0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0x12, 0x7E, 0x8C, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, ++0x07, 0x03, 0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0x80, 0x73, 0x90, ++0x90, 0xC5, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x32, 0xEF, 0x94, 0x8C, 0x50, 0x2D, 0x90, ++0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, ++0x03, 0x01, 0x00, 0x12, 0x7E, 0x8C, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, ++0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x03, 0x01, 0x00, 0x80, 0x36, 0x90, 0x90, 0xC5, 0xE0, ++0xFF, 0x74, 0x8C, 0xC3, 0x9F, 0x50, 0x34, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, ++0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x05, 0x01, 0x00, 0x12, 0x7E, 0x8C, 0x90, 0x90, ++0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x05, ++0x01, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0x12, 0x7E, 0x92, 0x90, 0x90, 0xC6, 0xE0, 0x64, ++0x02, 0x70, 0x66, 0x90, 0x90, 0xC5, 0xE0, 0xFF, 0xD3, 0x94, 0x30, 0x50, 0x08, 0x90, 0x90, 0xC9, ++0x74, 0x2A, 0xF0, 0x80, 0x70, 0xEF, 0xD3, 0x94, 0x40, 0x50, 0x08, 0x90, 0x90, 0xC9, 0x74, 0x3A, ++0xF0, 0x80, 0x62, 0xEF, 0xD3, 0x94, 0x70, 0x50, 0x08, 0x90, 0x90, 0xC9, 0x74, 0x6A, 0xF0, 0x80, ++0x54, 0xEF, 0xD3, 0x94, 0x80, 0x50, 0x08, 0x90, 0x90, 0xC9, 0x74, 0x7A, 0xF0, 0x80, 0x46, 0xEF, ++0xD3, 0x94, 0x90, 0x50, 0x08, 0x90, 0x90, 0xC9, 0x74, 0x8A, 0xF0, 0x80, 0x38, 0xEF, 0xD3, 0x94, ++0xA1, 0x50, 0x08, 0x90, 0x90, 0xC9, 0x74, 0x9B, 0xF0, 0x80, 0x2A, 0xEF, 0xD3, 0x94, 0xB1, 0x50, ++0x24, 0x90, 0x90, 0xC9, 0x74, 0xAB, 0xF0, 0x80, 0x1C, 0x90, 0x90, 0xC6, 0xE0, 0x64, 0x01, 0x70, ++0x33, 0xA3, 0xE0, 0x90, 0x90, 0xC5, 0xB4, 0x01, 0x05, 0xE0, 0x24, 0x02, 0x80, 0x03, 0xE0, 0x24, ++0xFE, 0x90, 0x90, 0xC9, 0xF0, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, ++0x90, 0xC9, 0x12, 0x7E, 0x80, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, ++0x90, 0xC9, 0x80, 0x1D, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x90, ++0xC5, 0x12, 0x7E, 0x80, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x90, ++0xC5, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x90, 0x51, 0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, ++0x00, 0x7F, 0x01, 0x02, 0x7E, 0x92, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8F, 0xA4, ++0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, 0x00, 0x01, 0x12, 0x26, ++0x37, 0x90, 0x8F, 0xA5, 0xF0, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x02, 0x84, 0xEF, 0xF0, ++0xEE, 0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, ++0x1E, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x90, 0x07, 0xF0, 0xA3, 0xEF, 0xF0, ++0x90, 0x02, 0x87, 0xE0, 0xF9, 0x90, 0x8E, 0x96, 0xE0, 0x20, 0xE0, 0x02, 0x61, 0x09, 0xEC, 0xC3, ++0x99, 0x40, 0x02, 0x61, 0x09, 0x90, 0x90, 0x07, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xEA, 0x90, 0xFD, ++0x11, 0xF0, 0xAF, 0x03, 0xAD, 0x07, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, ++0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, 0x24, ++0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0xFE, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, ++0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFD, 0x24, 0x18, 0xFB, 0xEA, 0x33, 0xFA, ++0xEB, 0x2F, 0xFF, 0xEA, 0x3E, 0xFE, 0x71, 0x0A, 0x90, 0x90, 0x07, 0xEE, 0x8F, 0xF0, 0x12, 0x47, ++0xF6, 0x90, 0x8D, 0xF4, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x90, 0x90, 0x08, 0xE0, 0x9F, 0x90, ++0x90, 0x07, 0xE0, 0x9E, 0x40, 0x1B, 0x90, 0x8D, 0xF5, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8D, 0xF4, ++0xE0, 0x34, 0x00, 0xFE, 0xC3, 0x90, 0x90, 0x08, 0xE0, 0x9F, 0xF0, 0x90, 0x90, 0x07, 0xE0, 0x9E, ++0xF0, 0x90, 0x90, 0x07, 0x51, 0x36, 0x0C, 0x41, 0x6E, 0x22, 0x7D, 0x07, 0xEF, 0x5D, 0xC3, 0x60, ++0x14, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, 0x24, 0x08, 0xFF, ++0xE4, 0x3E, 0xFE, 0x80, 0x0D, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, ++0x5F, 0xFF, 0x22, 0xE4, 0x90, 0x90, 0x04, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, ++0x2C, 0xC3, 0x90, 0x90, 0x05, 0xE0, 0x94, 0xD0, 0x90, 0x90, 0x04, 0xE0, 0x94, 0x07, 0x40, 0x0A, ++0x90, 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x90, 0x04, 0xE4, 0x75, 0xF0, ++0x01, 0x12, 0x47, 0xF6, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x80, 0xCD, 0x7F, 0x01, 0x22, ++0x12, 0x63, 0xB4, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x90, 0x8D, 0x04, 0xE0, 0xFF, 0xB4, 0x01, ++0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, ++0x54, 0xFB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x26, 0x1E, 0xFE, 0x20, ++0xE0, 0x04, 0x71, 0x70, 0x81, 0x4D, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFD, 0x90, 0x8E, 0x97, ++0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xED, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, ++0x12, 0x26, 0x1E, 0xFD, 0x54, 0x04, 0xFC, 0xEF, 0x54, 0xFB, 0x4C, 0xFF, 0x90, 0x8E, 0x97, 0xF0, ++0xED, 0x54, 0x08, 0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFD, 0x54, 0x10, ++0xFC, 0xEF, 0x54, 0xEF, 0x4C, 0xFF, 0x90, 0x8E, 0x97, 0xF0, 0xED, 0x54, 0x20, 0xFD, 0xEF, 0x54, ++0xDF, 0x4D, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFD, 0x54, 0x40, 0xFC, 0xEF, 0x54, 0xBF, 0x4C, 0xFF, ++0x90, 0x8E, 0x97, 0xF0, 0xED, 0x54, 0x80, 0xFD, 0xEF, 0x54, 0x7F, 0x4D, 0xF0, 0x90, 0x00, 0x01, ++0x12, 0x26, 0x37, 0x54, 0x80, 0xFF, 0x90, 0x8E, 0x98, 0xE0, 0x54, 0x7F, 0x4F, 0xF0, 0xEE, 0x13, ++0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x04, 0xF0, 0x12, 0x26, 0x1E, ++0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, 0x90, ++0x8D, 0x04, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0x8E, 0x9B, 0xE0, 0xFF, 0x20, 0xE0, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, ++0x14, 0xEF, 0x44, 0x01, 0x90, 0x8E, 0x9B, 0xF0, 0x90, 0x8E, 0x97, 0xE0, 0xC4, 0x54, 0x0F, 0x20, ++0xE0, 0x03, 0x7F, 0x00, 0x22, 0x7F, 0x01, 0x22, 0xEF, 0x90, 0x01, 0xC7, 0xB4, 0xA0, 0x05, 0x74, ++0x04, 0xF0, 0x80, 0x03, 0x74, 0x08, 0xF0, 0x90, 0x8E, 0x9B, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, ++0x90, 0x15, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0x90, 0x1D, 0xF0, 0x90, 0x90, 0x1D, 0xE0, ++0xFD, 0xC3, 0x94, 0x06, 0x50, 0x28, 0x90, 0x90, 0x16, 0xE0, 0x24, 0x04, 0xFF, 0x90, 0x90, 0x15, ++0xE0, 0x34, 0x00, 0xFE, 0x12, 0x52, 0x98, 0x90, 0x90, 0x1D, 0xE0, 0x24, 0x17, 0xF5, 0x82, 0xE4, ++0x34, 0x90, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x90, 0x1D, 0xE0, 0x04, 0xF0, 0x80, 0xCE, 0x78, 0x9C, ++0x7C, 0x8E, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x17, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x4A, ++0x08, 0xEF, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x8E, 0x9B, 0xE0, 0x30, 0xE0, 0x03, ++0x7F, 0x01, 0x22, 0x90, 0x06, 0x90, 0xE0, 0x20, 0xE5, 0x0A, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, ++0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x90, 0x07, 0xF0, 0x12, ++0x26, 0x1E, 0x90, 0x8F, 0x94, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0x8F, 0x95, 0xF0, ++0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8F, ++0x96, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x97, 0xF0, 0x90, ++0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x98, 0xF0, 0x90, 0x00, 0x03, 0x12, ++0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x99, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, ++0xED, 0x2F, 0x90, 0x8F, 0x9A, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFF, 0xAE, 0x05, 0xED, ++0x2F, 0x90, 0x8F, 0x9B, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, 0xFE, 0xAF, ++0x05, 0xED, 0x2E, 0x90, 0x8F, 0x9C, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, ++0x90, 0x8F, 0x9D, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x9E, ++0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x9F, 0xF0, 0x90, 0x00, ++0x04, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0xA0, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x26, ++0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0xA1, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x26, 0x37, 0xFF, 0xAE, ++0x05, 0xED, 0x2F, 0x90, 0x8F, 0xA2, 0xF0, 0x22, 0xE4, 0xFF, 0x74, 0x18, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0xA2, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, ++0xEE, 0xF0, 0x74, 0x10, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x9C, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x06, 0xCB, 0x22, ++0xEF, 0x60, 0x08, 0x90, 0x8F, 0x97, 0xE0, 0xFF, 0x12, 0x56, 0xF6, 0x22, 0xE4, 0x90, 0x8E, 0x7A, ++0xF0, 0xA3, 0xF0, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, 0xF0, 0x90, 0x8E, 0x77, ++0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0x8E, 0x80, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x90, ++0x8E, 0x77, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x8E, 0x83, 0xF0, ++0x90, 0x8E, 0x82, 0x74, 0x07, 0xF0, 0x90, 0x8E, 0x85, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0xE4, ++0x90, 0x8E, 0x7E, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x7C, 0x74, 0x0C, ++0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x90, 0x8E, ++0x77, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, ++0x54, 0xF7, 0xF0, 0x90, 0x8E, 0x87, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x90, 0x8D, 0x04, ++0xE0, 0xB4, 0x01, 0x08, 0x90, 0x8E, 0x84, 0x74, 0xFF, 0xF0, 0x80, 0x12, 0x90, 0x8D, 0x04, 0xE0, ++0x90, 0x8E, 0x84, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x41, 0xF0, 0x90, 0x8E, ++0x8B, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, ++0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, ++0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0x90, 0x04, ++0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, ++0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0xD1, 0xEE, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, ++0xB8, 0x74, 0x01, 0xF0, 0x80, 0x67, 0x90, 0x8E, 0x7E, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x08, 0x90, ++0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x56, 0x90, 0x8E, 0x7C, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, ++0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x44, 0xEF, 0x30, 0xE2, 0x08, 0x90, 0x01, 0xB8, ++0x74, 0x08, 0xF0, 0x80, 0x38, 0x90, 0x8E, 0x7E, 0xE0, 0x30, 0xE4, 0x08, 0x90, 0x01, 0xB8, 0x74, ++0x10, 0xF0, 0x80, 0x29, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x08, 0x90, ++0x01, 0xB8, 0x74, 0x20, 0xF0, 0x80, 0x16, 0x90, 0x8E, 0x91, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, ++0x74, 0x80, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, ++0x74, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x02, 0x96, 0xE0, 0xFF, 0x90, 0x02, 0x87, 0xE0, 0x4F, ++0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2C, 0x90, 0x8E, 0x96, 0xE0, 0x30, 0xE0, ++0x0E, 0x90, 0x02, 0x82, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x17, 0x90, ++0x02, 0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x08, 0x90, 0x01, ++0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x7F, 0x00, 0x22, 0xEF, ++0x60, 0x3E, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x36, 0x90, 0x8E, 0x78, 0xE0, 0x54, 0xFE, ++0xF0, 0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE4, 0xFF, ++0x12, 0x57, 0xAF, 0xBF, 0x01, 0x0E, 0x90, 0x8E, 0x77, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x8E, 0x7D, ++0x74, 0x06, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, ++0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x7D, ++0x74, 0x0C, 0xF0, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x2E, 0x90, 0x8E, 0x78, 0xE0, ++0x54, 0xFD, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x7F, 0x01, 0x12, 0x57, 0xAF, 0xBF, 0x01, ++0x0E, 0x90, 0x8E, 0x77, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0E, 0xF0, 0x22, 0x90, ++0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0x6F, ++0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x7D, ++0x74, 0x04, 0xF0, 0x22, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x39, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, ++0x70, 0x31, 0x90, 0x8E, 0x81, 0xF0, 0x04, 0x60, 0x2A, 0x90, 0x8E, 0x7E, 0xE0, 0x44, 0x10, 0xF0, ++0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x82, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, ++0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x20, 0xE2, 0x03, ++0x12, 0x5D, 0xFB, 0x22, 0x90, 0x8D, 0x07, 0xE0, 0xFE, 0x90, 0x04, 0x1C, 0xE0, 0x6E, 0x70, 0x40, ++0x90, 0x8E, 0x7D, 0xE0, 0xFE, 0x64, 0x0E, 0x70, 0x1C, 0xEF, 0x70, 0x34, 0x90, 0x8E, 0x77, 0xE0, ++0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8E, ++0x7D, 0x74, 0x04, 0xF0, 0x22, 0xEE, 0xB4, 0x06, 0x17, 0xEF, 0x60, 0x14, 0x90, 0x8E, 0x77, 0xE0, ++0x54, 0xBF, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8F, 0xAE, 0x12, 0x48, 0x53, 0x90, 0x8F, ++0xB1, 0xED, 0xF0, 0xE4, 0x90, 0x8F, 0xFD, 0xF0, 0x90, 0x8F, 0xFD, 0xE0, 0xFF, 0xC3, 0x94, 0x40, ++0x50, 0x14, 0x74, 0xBA, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0x8F, ++0xFD, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x90, 0x8F, 0xAE, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, ++0x89, 0x42, 0x90, 0x8F, 0xB1, 0xE0, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xBA, 0x12, 0x34, ++0x2C, 0xE4, 0x90, 0x8F, 0xB9, 0xF0, 0x90, 0x8F, 0xB9, 0xE0, 0xFF, 0xC3, 0x94, 0x40, 0x50, 0x16, ++0x74, 0xBA, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE0, 0x64, 0x36, 0xF0, 0x90, 0x8F, ++0xB9, 0xE0, 0x04, 0xF0, 0x80, 0xE0, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xB5, 0xE0, ++0xFF, 0xF5, 0x82, 0x75, 0x83, 0x00, 0x74, 0x80, 0x12, 0x26, 0x76, 0xEF, 0x75, 0xF0, 0x08, 0xA4, ++0x24, 0x00, 0xFF, 0xE5, 0xF0, 0x34, 0x02, 0xFC, 0x90, 0x00, 0x7E, 0x12, 0x26, 0x76, 0xEF, 0x90, ++0x00, 0x7F, 0x12, 0x26, 0x76, 0xE4, 0x90, 0x8F, 0xFA, 0xF0, 0xA3, 0xF0, 0x90, 0x8F, 0xFA, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xC0, 0xEE, 0x94, 0x00, 0x40, 0x02, 0x61, 0x5B, 0xC3, 0xEF, ++0x94, 0x40, 0xEE, 0x94, 0x00, 0x50, 0x52, 0xA3, 0x74, 0x40, 0xF0, 0x74, 0xBA, 0x2F, 0xF9, 0xE4, ++0x34, 0x8F, 0xFA, 0x7B, 0x01, 0x74, 0x40, 0x44, 0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFA, ++0xA3, 0xE0, 0x24, 0xBE, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x89, 0xFD, ++0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFA, 0xA3, 0xE0, 0x24, 0xC2, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, ++0x01, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFA, 0xA3, 0xE0, 0x24, 0xC6, ++0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0x41, 0x9C, 0xE4, 0x90, 0x8F, 0xFC, 0xF0, 0x90, 0x8F, ++0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, ++0xE9, 0x24, 0xC0, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0x74, 0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, ++0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, ++0xE9, 0x24, 0xC4, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, ++0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, ++0x3E, 0xFA, 0xE9, 0x24, 0xC8, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, ++0x30, 0xA4, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, ++0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xCC, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8B, ++0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFC, 0xE0, 0x44, 0x90, 0x90, 0x01, 0x8C, 0xF0, 0xE4, 0x90, ++0x8F, 0xFE, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x30, 0xE4, 0x22, 0xC3, 0x90, 0x8F, 0xFF, ++0xE0, 0x94, 0xE8, 0x90, 0x8F, 0xFE, 0xE0, 0x94, 0x03, 0x50, 0x13, 0x7F, 0x01, 0x7E, 0x00, 0x12, ++0x3A, 0xF7, 0x90, 0x8F, 0xFE, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x80, 0xD7, 0x90, 0x8F, ++0xFE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x06, ++0x31, 0xE0, 0x44, 0x01, 0xF0, 0xEE, 0x90, 0x06, 0x36, 0xF0, 0x90, 0x8F, 0xFB, 0xE0, 0x54, 0x3F, ++0x64, 0x30, 0x70, 0x4B, 0x90, 0x8F, 0xFE, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x20, 0xE5, ++0x22, 0xC3, 0x90, 0x8F, 0xFF, 0xE0, 0x94, 0xE8, 0x90, 0x8F, 0xFE, 0xE0, 0x94, 0x03, 0x50, 0x13, ++0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x8F, 0xFE, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, ++0xF6, 0x80, 0xD7, 0x90, 0x8F, 0xFE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xE8, 0xEE, 0x94, ++0x03, 0x40, 0x0C, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x02, 0xF0, 0xEE, 0x90, 0x06, 0x36, 0xF0, 0x90, ++0x8F, 0xFA, 0xE4, 0x75, 0xF0, 0x10, 0x12, 0x47, 0xF6, 0x21, 0xAC, 0x90, 0x8F, 0xB6, 0x12, 0x48, ++0x4A, 0xE9, 0x24, 0x10, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x80, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xB6, ++0x12, 0x48, 0x4A, 0xE9, 0x24, 0x0C, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x81, 0x12, 0x33, 0x2F, 0x90, ++0x8F, 0xB6, 0x12, 0x48, 0x4A, 0xE9, 0x24, 0x08, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x82, 0x12, 0x33, ++0x2F, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, 0xE9, 0x24, 0x04, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x83, ++0x12, 0x33, 0x2F, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, 0x7D, 0x84, 0x12, 0x33, 0x2F, 0xE4, 0x90, ++0x8F, 0xFD, 0xF0, 0x90, 0x8F, 0xFD, 0xE0, 0xFF, 0xC3, 0x94, 0x40, 0x50, 0x14, 0x74, 0xBA, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0x8F, 0xFD, 0xE0, 0x04, 0xF0, 0x80, ++0xE2, 0x90, 0x8F, 0xAE, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x90, 0x8F, 0xB1, ++0xE0, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xBA, 0x12, 0x34, 0x2C, 0xE4, 0x90, 0x8F, 0xB9, ++0xF0, 0x90, 0x8F, 0xB9, 0xE0, 0xFF, 0xC3, 0x94, 0x40, 0x50, 0x16, 0x74, 0xBA, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE0, 0x64, 0x5C, 0xF0, 0x90, 0x8F, 0xB9, 0xE0, 0x04, 0xF0, 0x80, ++0xE0, 0xE4, 0x90, 0x8F, 0xB9, 0xF0, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xB9, 0xE0, ++0xFF, 0xF5, 0x82, 0x75, 0x83, 0x00, 0x12, 0x26, 0x37, 0xFE, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, ++0x8F, 0x82, 0x75, 0x83, 0x00, 0xEE, 0x12, 0x26, 0x76, 0x90, 0x8F, 0xB9, 0xE0, 0x04, 0xF0, 0xE0, ++0xB4, 0x14, 0xD3, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x14, 0x74, 0x80, 0x12, 0x26, ++0x76, 0x90, 0x8F, 0xB9, 0x74, 0x15, 0xF0, 0x90, 0x8F, 0xB9, 0xE0, 0xFF, 0xC3, 0x94, 0x3E, 0x50, ++0x17, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xE4, 0x12, 0x26, 0x76, ++0x90, 0x8F, 0xB9, 0xE0, 0x04, 0xF0, 0x80, 0xDF, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x00, ++0x3E, 0x74, 0x02, 0x12, 0x26, 0x76, 0x90, 0x00, 0x3F, 0x74, 0xA0, 0x12, 0x26, 0x76, 0xE4, 0x90, ++0x8F, 0xFA, 0xF0, 0xA3, 0xF0, 0x90, 0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0x80, ++0xEE, 0x94, 0x00, 0x40, 0x02, 0xC1, 0x44, 0xC3, 0xEF, 0x94, 0x40, 0xEE, 0x94, 0x00, 0x50, 0x52, ++0xA3, 0x74, 0x40, 0xF0, 0x74, 0xBA, 0x2F, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0x74, 0x40, ++0x44, 0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFA, 0xA3, 0xE0, 0x24, 0xBE, 0xF9, 0xE4, 0x34, ++0x8F, 0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFA, 0xA3, ++0xE0, 0x24, 0xC2, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, ++0x30, 0xA4, 0x90, 0x8F, 0xFA, 0xA3, 0xE0, 0x24, 0xC6, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, ++0xA1, 0x85, 0xE4, 0x90, 0x8F, 0xFC, 0xF0, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xFA, ++0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC0, 0xF9, 0xEA, 0x34, 0xFF, ++0xFA, 0x74, 0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xFA, ++0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC4, 0xF9, 0xEA, 0x34, 0xFF, ++0xFA, 0xA3, 0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, ++0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC8, 0xF9, 0xEA, ++0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xB2, 0x12, 0x48, ++0x4A, 0x90, 0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xCC, ++0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8B, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFC, ++0xE0, 0x44, 0x90, 0x90, 0x01, 0x8C, 0xF0, 0xE4, 0x90, 0x8F, 0xFE, 0xF0, 0xA3, 0xF0, 0x90, 0x01, ++0x8C, 0xE0, 0x30, 0xE4, 0x22, 0xC3, 0x90, 0x8F, 0xFF, 0xE0, 0x94, 0xE8, 0x90, 0x8F, 0xFE, 0xE0, ++0x94, 0x03, 0x50, 0x13, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x8F, 0xFE, 0xE4, 0x75, ++0xF0, 0x01, 0x12, 0x47, 0xF6, 0x80, 0xD7, 0x90, 0x8F, 0xFE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, ++0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x01, 0xF0, 0xEE, 0x90, ++0x06, 0x36, 0xF0, 0x90, 0x8F, 0xFB, 0xE0, 0x54, 0x3F, 0x64, 0x30, 0x70, 0x4B, 0x90, 0x8F, 0xFE, ++0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x20, 0xE5, 0x22, 0xC3, 0x90, 0x8F, 0xFF, 0xE0, 0x94, ++0xE8, 0x90, 0x8F, 0xFE, 0xE0, 0x94, 0x03, 0x50, 0x13, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, ++0x90, 0x8F, 0xFE, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x80, 0xD7, 0x90, 0x8F, 0xFE, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x06, 0x31, 0xE0, ++0x44, 0x02, 0xF0, 0xEE, 0x90, 0x06, 0x36, 0xF0, 0x90, 0x8F, 0xFA, 0xE4, 0x75, 0xF0, 0x10, 0x12, ++0x47, 0xF6, 0x81, 0x95, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, 0xE9, 0x24, 0x10, 0xF9, 0xE4, 0x3A, ++0xFA, 0x7D, 0x80, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, 0xE9, 0x24, 0x0C, 0xF9, ++0xE4, 0x3A, 0xFA, 0x7D, 0x81, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, 0xE9, 0x24, ++0x08, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x82, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, ++0xE9, 0x24, 0x04, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x83, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xB6, 0x12, ++0x48, 0x4A, 0x7D, 0x84, 0x12, 0x33, 0x2F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x90, 0x8E, 0x12, ++0x48, 0x53, 0x12, 0x26, 0x1E, 0x90, 0x90, 0x93, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, ++0x90, 0x94, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0x90, 0x90, 0x95, 0xF0, 0x90, 0x00, 0x05, ++0x12, 0x26, 0x37, 0x90, 0x90, 0x96, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x26, 0x37, 0x90, 0x90, 0x97, ++0xF0, 0x90, 0x00, 0x07, 0x12, 0x26, 0x37, 0x90, 0x90, 0x98, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, ++0x37, 0x90, 0x90, 0x9B, 0xF0, 0xED, 0x70, 0x31, 0xFF, 0x74, 0x93, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x90, 0xF5, 0x83, 0xE0, 0xB4, 0xFF, 0x0E, 0x74, 0x93, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, ++0x83, 0xE4, 0xF0, 0x80, 0x0F, 0x74, 0x93, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, ++0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x06, 0xD0, 0x90, 0x90, 0x92, 0xE0, 0xFF, 0xB4, 0x04, ++0x25, 0xA3, 0xE0, 0xFE, 0x90, 0x90, 0x8E, 0x12, 0x48, 0x4A, 0xEE, 0x12, 0x26, 0x64, 0x90, 0x90, ++0x94, 0xE0, 0xFE, 0x90, 0x90, 0x8E, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, 0x76, ++0x90, 0x00, 0x02, 0xE4, 0x80, 0x30, 0xEF, 0xB4, 0x02, 0x2F, 0x90, 0x90, 0x94, 0xE0, 0xFF, 0x90, ++0x90, 0x8E, 0x12, 0x48, 0x4A, 0xEF, 0x12, 0x26, 0x64, 0x90, 0x90, 0x94, 0xE0, 0x44, 0x20, 0x54, ++0x7F, 0xFF, 0x90, 0x90, 0x8E, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, 0x90, ++0x90, 0x93, 0xE0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x76, 0x90, 0x90, 0x8E, 0x12, 0x48, 0x4A, 0xE9, ++0x24, 0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x26, 0x1E, 0x44, 0x20, 0x12, 0x26, 0x64, 0x90, 0x90, ++0x95, 0xE0, 0xFF, 0x90, 0x90, 0x8E, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x04, 0xEF, 0x12, 0x26, 0x76, ++0x90, 0x90, 0x96, 0xE0, 0x90, 0x00, 0x05, 0x12, 0x26, 0x76, 0x90, 0x90, 0x97, 0xE0, 0x90, 0x00, ++0x06, 0x12, 0x26, 0x76, 0x90, 0x90, 0x98, 0xE0, 0x90, 0x00, 0x07, 0x02, 0x26, 0x76, 0x90, 0x90, ++0xAA, 0xED, 0xF0, 0x90, 0x90, 0xA7, 0x12, 0x48, 0x53, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x90, ++0x90, 0xAE, 0xF0, 0x90, 0x90, 0xA7, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, ++0x43, 0x03, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xAB, 0x12, 0x34, 0x2C, 0x90, 0x90, 0xAA, 0xE0, 0x70, ++0x46, 0xFF, 0x74, 0xAB, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, 0xB4, 0xFF, 0x0E, ++0x74, 0xAB, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x0F, 0x74, 0xAB, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, ++0x03, 0xD0, 0x75, 0x40, 0x01, 0x75, 0x41, 0x90, 0x75, 0x42, 0xAB, 0x75, 0x43, 0x03, 0x90, 0x90, ++0xA7, 0x12, 0x48, 0x4A, 0x12, 0x34, 0x2C, 0x22, 0x09, 0xD8, ++}; ++u4Byte ArrayLength_MP_8812A_FW_WoWLAN = 20570; ++ ++ ++void ++ODM_ReadFirmware_MP_8812A_FW_WoWLAN( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++) ++{ ++ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8812A_FW_WoWLAN; ++ *pFirmwareSize = ArrayLength_MP_8812A_FW_WoWLAN; ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.h 2018-02-06 17:42:30.704967075 +0200 +@@ -0,0 +1,53 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#ifndef __INC_MP_FW_HW_IMG_8812A_H ++#define __INC_MP_FW_HW_IMG_8812A_H ++ ++ ++/****************************************************************************** ++* FW_NIC.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadFirmware_MP_8812A_FW_NIC( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++); ++ ++/****************************************************************************** ++* FW_NIC_BT.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadFirmware_MP_8812A_FW_NIC_BT( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++); ++ ++/****************************************************************************** ++* FW_WoWLAN.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadFirmware_MP_8812A_FW_WoWLAN( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.c 2018-02-06 17:42:30.704967075 +0200 +@@ -0,0 +1,224 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#include "odm_precomp.h" ++ ++static bool ++CheckCondition( ++ const u4Byte Condition, ++ const u4Byte Hex ++ ) ++{ ++ u4Byte _board = (Hex & 0x000000FF); ++ u4Byte _interface = (Hex & 0x0000FF00) >> 8; ++ u4Byte _platform = (Hex & 0x00FF0000) >> 16; ++ u4Byte cond = Condition; ++ ++ if ( Condition == 0xCDCDCDCD ) ++ return true; ++ ++ cond = Condition & 0x000000FF; ++ if ( (_board != cond) && (cond != 0xFF) ) ++ return false; ++ ++ cond = Condition & 0x0000FF00; ++ cond = cond >> 8; ++ if ( ((_interface & cond) == 0) && (cond != 0x07) ) ++ return false; ++ ++ cond = Condition & 0x00FF0000; ++ cond = cond >> 16; ++ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) ++ return false; ++ return true; ++} ++ ++ ++/****************************************************************************** ++* MAC_REG.TXT ++******************************************************************************/ ++ ++u4Byte Array_MP_8812A_MAC_REG[] = { ++ 0x010, 0x0000000C, ++ 0x072, 0x00000000, ++ 0x428, 0x0000000A, ++ 0x429, 0x00000010, ++ 0x430, 0x00000000, ++ 0x431, 0x00000000, ++ 0x432, 0x00000000, ++ 0x433, 0x00000001, ++ 0x434, 0x00000004, ++ 0x435, 0x00000005, ++ 0x436, 0x00000007, ++ 0x437, 0x00000008, ++ 0x43C, 0x00000004, ++ 0x43D, 0x00000005, ++ 0x43E, 0x00000007, ++ 0x43F, 0x00000008, ++ 0x440, 0x0000005D, ++ 0x441, 0x00000001, ++ 0x442, 0x00000000, ++ 0x444, 0x00000010, ++ 0x445, 0x00000000, ++ 0x446, 0x00000000, ++ 0x447, 0x00000000, ++ 0x448, 0x00000000, ++ 0x449, 0x000000F0, ++ 0x44A, 0x0000000F, ++ 0x44B, 0x0000003E, ++ 0x44C, 0x00000010, ++ 0x44D, 0x00000000, ++ 0x44E, 0x00000000, ++ 0x44F, 0x00000000, ++ 0x450, 0x00000000, ++ 0x451, 0x000000F0, ++ 0x452, 0x0000000F, ++ 0x453, 0x00000000, ++ 0x45B, 0x00000080, ++ 0x460, 0x00000066, ++ 0x461, 0x00000066, ++ 0x4C8, 0x000000FF, ++ 0x4C9, 0x00000008, ++ 0x4CC, 0x000000FF, ++ 0x4CD, 0x000000FF, ++ 0x4CE, 0x00000001, ++ 0x500, 0x00000026, ++ 0x501, 0x000000A2, ++ 0x502, 0x0000002F, ++ 0x503, 0x00000000, ++ 0x504, 0x00000028, ++ 0x505, 0x000000A3, ++ 0x506, 0x0000005E, ++ 0x507, 0x00000000, ++ 0x508, 0x0000002B, ++ 0x509, 0x000000A4, ++ 0x50A, 0x0000005E, ++ 0x50B, 0x00000000, ++ 0x50C, 0x0000004F, ++ 0x50D, 0x000000A4, ++ 0x50E, 0x00000000, ++ 0x50F, 0x00000000, ++ 0x512, 0x0000001C, ++ 0x514, 0x0000000A, ++ 0x516, 0x0000000A, ++ 0x525, 0x0000004F, ++ 0x550, 0x00000010, ++ 0x551, 0x00000010, ++ 0x559, 0x00000002, ++ 0x55C, 0x00000050, ++ 0x55D, 0x000000FF, ++ 0x604, 0x00000009, ++ 0x605, 0x00000030, ++ 0x607, 0x00000007, ++ 0x608, 0x0000000E, ++ 0x609, 0x0000002A, ++ 0x620, 0x000000FF, ++ 0x621, 0x000000FF, ++ 0x622, 0x000000FF, ++ 0x623, 0x000000FF, ++ 0x624, 0x000000FF, ++ 0x625, 0x000000FF, ++ 0x626, 0x000000FF, ++ 0x627, 0x000000FF, ++ 0x638, 0x00000050, ++ 0x63C, 0x0000000A, ++ 0x63D, 0x0000000A, ++ 0x63E, 0x0000000E, ++ 0x63F, 0x0000000E, ++ 0x640, 0x00000040, ++ 0x642, 0x00000040, ++ 0x643, 0x00000000, ++ 0x66E, 0x00000005, ++ 0x700, 0x00000021, ++ 0x701, 0x00000043, ++ 0x702, 0x00000065, ++ 0x703, 0x00000087, ++ 0x708, 0x00000021, ++ 0x709, 0x00000043, ++ 0x70A, 0x00000065, ++ 0x70B, 0x00000087, ++ 0x718, 0x00000040, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_MAC_REG( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8812A_MAC_REG)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8812A_MAC_REG; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_MAC_REG, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigMAC_8812A(pDM_Odm, v1, (u1Byte)v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigMAC_8812A(pDM_Odm, v1, (u1Byte)v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.h 2018-02-06 17:42:30.704967075 +0200 +@@ -0,0 +1,30 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#ifndef __INC_MP_MAC_HW_IMG_8812A_H ++#define __INC_MP_MAC_HW_IMG_8812A_H ++ ++static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); ++ ++/****************************************************************************** ++* MAC_REG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_MAC_REG( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.c 2018-02-06 17:42:30.704967075 +0200 +@@ -0,0 +1,1954 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++ ++#include "odm_precomp.h" ++ ++static bool ++CheckCondition( ++ const u4Byte Condition, ++ const u4Byte Hex ++ ) ++{ ++ u4Byte _board = (Hex & 0x000000FF); ++ u4Byte _interface = (Hex & 0x0000FF00) >> 8; ++ u4Byte _platform = (Hex & 0x00FF0000) >> 16; ++ u4Byte cond = Condition; ++ ++ if ( Condition == 0xCDCDCDCD ) ++ return true; ++ ++ cond = Condition & 0x000000FF; ++ if ( (_board != cond) && (cond != 0xFF) ) ++ return false; ++ ++ cond = Condition & 0x0000FF00; ++ cond = cond >> 8; ++ if ( ((_interface & cond) == 0) && (cond != 0x07) ) ++ return false; ++ ++ cond = Condition & 0x00FF0000; ++ cond = cond >> 16; ++ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) ++ return false; ++ return true; ++} ++ ++ ++/****************************************************************************** ++* RadioA.TXT ++******************************************************************************/ ++ ++static u4Byte Array_MP_8812A_RadioA[] = { ++ 0x000, 0x00010000, ++ 0x018, 0x0001712A, ++ 0x056, 0x00051CF2, ++ 0x066, 0x00040000, ++ 0x01E, 0x00080000, ++ 0x089, 0x00000080, ++ 0xFF0F0740, 0xABCD, ++ 0x086, 0x00014B38, ++ 0xFF0F07C0, 0xCDEF, ++ 0x086, 0x00014B38, ++ 0xFF0F07D8, 0xCDEF, ++ 0x086, 0x00014B3C, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x086, 0x00014B38, ++ 0xFF0F0740, 0xDEAD, ++ 0x0B1, 0x0001FC1A, ++ 0x0B3, 0x000F0810, ++ 0x0B4, 0x0001A78D, ++ 0x0BA, 0x00086180, ++ 0x018, 0x00000006, ++ 0x0EF, 0x00002000, ++ 0x03B, 0x00038A58, ++ 0x03B, 0x00037A58, ++ 0x03B, 0x0002A590, ++ 0x03B, 0x00027A50, ++ 0x03B, 0x00018248, ++ 0x03B, 0x00010240, ++ 0x03B, 0x00008240, ++ 0x03B, 0x00000240, ++ 0x0EF, 0x00000100, ++ 0xFF0F07D8, 0xABCD, ++ 0x034, 0x0000A4EE, ++ 0x034, 0x00009076, ++ 0x034, 0x00008073, ++ 0x034, 0x00007070, ++ 0x034, 0x0000606D, ++ 0x034, 0x0000506A, ++ 0x034, 0x00004049, ++ 0x034, 0x00003046, ++ 0x034, 0x00002028, ++ 0x034, 0x00001025, ++ 0x034, 0x00000022, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0000ADF4, ++ 0x034, 0x00009DF1, ++ 0x034, 0x00008DEE, ++ 0x034, 0x00007DEB, ++ 0x034, 0x00006DE8, ++ 0x034, 0x00005CEC, ++ 0x034, 0x00004CE9, ++ 0x034, 0x000034EA, ++ 0x034, 0x000024E7, ++ 0x034, 0x0000146B, ++ 0x034, 0x0000006D, ++ 0xFF0F07D8, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x000020A2, ++ 0x0DF, 0x00000080, ++ 0x035, 0x00000192, ++ 0x035, 0x00008192, ++ 0x035, 0x00010192, ++ 0x036, 0x00000024, ++ 0x036, 0x00008024, ++ 0x036, 0x00010024, ++ 0x036, 0x00018024, ++ 0x0EF, 0x00000000, ++ 0x051, 0x00000C21, ++ 0x052, 0x000006D9, ++ 0x053, 0x000FC649, ++ 0x054, 0x0000017E, ++ 0x0EF, 0x00000002, ++ 0x008, 0x00008400, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00001000, ++ 0x03A, 0x00000080, ++ 0x03B, 0x0003A02C, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000400, ++ 0x03B, 0x0003202C, ++ 0x03C, 0x00010000, ++ 0x03A, 0x000000A0, ++ 0x03B, 0x0002B064, ++ 0x03C, 0x00004000, ++ 0x03A, 0x000000D8, ++ 0x03B, 0x00023070, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000468, ++ 0x03B, 0x0001B870, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000098, ++ 0x03B, 0x00012085, ++ 0x03C, 0x000E4000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x0000A080, ++ 0x03C, 0x000F0000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x00002080, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000080, ++ 0x03B, 0x0007A02C, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000400, ++ 0x03B, 0x0007202C, ++ 0x03C, 0x00010000, ++ 0x03A, 0x000000A0, ++ 0x03B, 0x0006B064, ++ 0x03C, 0x00004000, ++ 0x03A, 0x000000D8, ++ 0x03B, 0x00023070, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000468, ++ 0x03B, 0x0005B870, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000098, ++ 0x03B, 0x00052085, ++ 0x03C, 0x000E4000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x0004A080, ++ 0x03C, 0x000F0000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x00042080, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000080, ++ 0x03B, 0x000BA02C, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000400, ++ 0x03B, 0x000B202C, ++ 0x03C, 0x00010000, ++ 0x03A, 0x000000A0, ++ 0x03B, 0x000AB064, ++ 0x03C, 0x00004000, ++ 0x03A, 0x000000D8, ++ 0x03B, 0x000A3070, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000468, ++ 0x03B, 0x0009B870, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000098, ++ 0x03B, 0x00092085, ++ 0x03C, 0x000E4000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x0008A080, ++ 0x03C, 0x000F0000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x00082080, ++ 0x03C, 0x00010000, ++ 0x0EF, 0x00001100, ++ 0xFF0F0740, 0xABCD, ++ 0x034, 0x0004A0B2, ++ 0x034, 0x000490AF, ++ 0x034, 0x00048070, ++ 0x034, 0x0004706D, ++ 0x034, 0x00046050, ++ 0x034, 0x0004504D, ++ 0x034, 0x0004404A, ++ 0x034, 0x00043047, ++ 0x034, 0x0004200A, ++ 0x034, 0x00041007, ++ 0x034, 0x00040004, ++ 0xFF0F07C0, 0xCDEF, ++ 0x034, 0x0004A0B2, ++ 0x034, 0x000490AF, ++ 0x034, 0x00048070, ++ 0x034, 0x0004706D, ++ 0x034, 0x00046050, ++ 0x034, 0x0004504D, ++ 0x034, 0x0004404A, ++ 0x034, 0x00043047, ++ 0x034, 0x0004200A, ++ 0x034, 0x00041007, ++ 0x034, 0x00040004, ++ 0xFF0F07D8, 0xCDEF, ++ 0x034, 0x0004A0B2, ++ 0x034, 0x000490AF, ++ 0x034, 0x00048070, ++ 0x034, 0x0004706D, ++ 0x034, 0x00046050, ++ 0x034, 0x0004504D, ++ 0x034, 0x0004404A, ++ 0x034, 0x00043047, ++ 0x034, 0x0004200A, ++ 0x034, 0x00041007, ++ 0x034, 0x00040004, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0004ADF5, ++ 0x034, 0x00049DF2, ++ 0x034, 0x00048DEF, ++ 0x034, 0x00047DEC, ++ 0x034, 0x00046DE9, ++ 0x034, 0x00045DC9, ++ 0x034, 0x00044CE8, ++ 0x034, 0x000438CA, ++ 0x034, 0x00042889, ++ 0x034, 0x0004184A, ++ 0x034, 0x0004044A, ++ 0xFF0F0740, 0xDEAD, ++ 0xFF0F0740, 0xABCD, ++ 0x034, 0x0002A0B2, ++ 0x034, 0x000290AF, ++ 0x034, 0x00028070, ++ 0x034, 0x0002706D, ++ 0x034, 0x00026050, ++ 0x034, 0x0002504D, ++ 0x034, 0x0002404A, ++ 0x034, 0x00023047, ++ 0x034, 0x0002200A, ++ 0x034, 0x00021007, ++ 0x034, 0x00020004, ++ 0xFF0F07C0, 0xCDEF, ++ 0x034, 0x0002A0B2, ++ 0x034, 0x000290AF, ++ 0x034, 0x00028070, ++ 0x034, 0x0002706D, ++ 0x034, 0x00026050, ++ 0x034, 0x0002504D, ++ 0x034, 0x0002404A, ++ 0x034, 0x00023047, ++ 0x034, 0x0002200A, ++ 0x034, 0x00021007, ++ 0x034, 0x00020004, ++ 0xFF0F07D8, 0xCDEF, ++ 0x034, 0x0002A0B2, ++ 0x034, 0x000290AF, ++ 0x034, 0x00028070, ++ 0x034, 0x0002706D, ++ 0x034, 0x00026050, ++ 0x034, 0x0002504D, ++ 0x034, 0x0002404A, ++ 0x034, 0x00023047, ++ 0x034, 0x0002200A, ++ 0x034, 0x00021007, ++ 0x034, 0x00020004, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0002ADF5, ++ 0x034, 0x00029DF2, ++ 0x034, 0x00028DEF, ++ 0x034, 0x00027DEC, ++ 0x034, 0x00026DE9, ++ 0x034, 0x00025DC9, ++ 0x034, 0x00024CE8, ++ 0x034, 0x000238CA, ++ 0x034, 0x00022889, ++ 0x034, 0x0002184A, ++ 0x034, 0x0002044A, ++ 0xFF0F0740, 0xDEAD, ++ 0xFF0F0740, 0xABCD, ++ 0x034, 0x0000A0B2, ++ 0x034, 0x000090AF, ++ 0x034, 0x00008070, ++ 0x034, 0x0000706D, ++ 0x034, 0x00006050, ++ 0x034, 0x0000504D, ++ 0x034, 0x0000404A, ++ 0x034, 0x00003047, ++ 0x034, 0x0000200A, ++ 0x034, 0x00001007, ++ 0x034, 0x00000004, ++ 0xFF0F07C0, 0xCDEF, ++ 0x034, 0x0000A0B2, ++ 0x034, 0x000090AF, ++ 0x034, 0x00008070, ++ 0x034, 0x0000706D, ++ 0x034, 0x00006050, ++ 0x034, 0x0000504D, ++ 0x034, 0x0000404A, ++ 0x034, 0x00003047, ++ 0x034, 0x0000200A, ++ 0x034, 0x00001007, ++ 0x034, 0x00000004, ++ 0xFF0F07D8, 0xCDEF, ++ 0x034, 0x0000A0B2, ++ 0x034, 0x000090AF, ++ 0x034, 0x00008070, ++ 0x034, 0x0000706D, ++ 0x034, 0x00006050, ++ 0x034, 0x0000504D, ++ 0x034, 0x0000404A, ++ 0x034, 0x00003047, ++ 0x034, 0x0000200A, ++ 0x034, 0x00001007, ++ 0x034, 0x00000004, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0000AFF7, ++ 0x034, 0x00009DF7, ++ 0x034, 0x00008DF4, ++ 0x034, 0x00007DF1, ++ 0x034, 0x00006DEE, ++ 0x034, 0x00005DCD, ++ 0x034, 0x00004CEB, ++ 0x034, 0x000038CC, ++ 0x034, 0x0000288B, ++ 0x034, 0x0000184C, ++ 0x034, 0x0000044C, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0xFF0F0740, 0xABCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x000001D4, ++ 0x035, 0x000081D4, ++ 0x035, 0x000101D4, ++ 0x035, 0x000201B4, ++ 0x035, 0x000281B4, ++ 0x035, 0x000301B4, ++ 0x035, 0x000401B4, ++ 0x035, 0x000481B4, ++ 0x035, 0x000501B4, ++ 0xFF0F07C0, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x000001D4, ++ 0x035, 0x000081D4, ++ 0x035, 0x000101D4, ++ 0x035, 0x000201B4, ++ 0x035, 0x000281B4, ++ 0x035, 0x000301B4, ++ 0x035, 0x000401B4, ++ 0x035, 0x000481B4, ++ 0x035, 0x000501B4, ++ 0xFF0F07D8, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x000001D4, ++ 0x035, 0x000081D4, ++ 0x035, 0x000101D4, ++ 0x035, 0x000201B4, ++ 0x035, 0x000281B4, ++ 0x035, 0x000301B4, ++ 0x035, 0x000401B4, ++ 0x035, 0x000481B4, ++ 0x035, 0x000501B4, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x00000188, ++ 0x035, 0x00008188, ++ 0x035, 0x00010185, ++ 0x035, 0x000201D7, ++ 0x035, 0x000281D7, ++ 0x035, 0x000301D5, ++ 0x035, 0x000401D8, ++ 0x035, 0x000481D8, ++ 0x035, 0x000501D5, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0xFF0F0740, 0xABCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00004BFB, ++ 0x036, 0x0000CBFB, ++ 0x036, 0x00014BFB, ++ 0x036, 0x0001CBFB, ++ 0x036, 0x00024F4B, ++ 0x036, 0x0002CF4B, ++ 0x036, 0x00034F4B, ++ 0x036, 0x0003CF4B, ++ 0x036, 0x00044F4B, ++ 0x036, 0x0004CF4B, ++ 0x036, 0x00054F4B, ++ 0x036, 0x0005CF4B, ++ 0xFF0F07C0, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00004BFB, ++ 0x036, 0x0000CBFB, ++ 0x036, 0x00014BFB, ++ 0x036, 0x0001CBFB, ++ 0x036, 0x00024F4B, ++ 0x036, 0x0002CF4B, ++ 0x036, 0x00034F4B, ++ 0x036, 0x0003CF4B, ++ 0x036, 0x00044F4B, ++ 0x036, 0x0004CF4B, ++ 0x036, 0x00054F4B, ++ 0x036, 0x0005CF4B, ++ 0xFF0F07D8, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00004BFB, ++ 0x036, 0x0000CBFB, ++ 0x036, 0x00014BFB, ++ 0x036, 0x0001CBFB, ++ 0x036, 0x00024F4B, ++ 0x036, 0x0002CF4B, ++ 0x036, 0x00034F4B, ++ 0x036, 0x0003CF4B, ++ 0x036, 0x00044F4B, ++ 0x036, 0x0004CF4B, ++ 0x036, 0x00054F4B, ++ 0x036, 0x0005CF4B, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00084EB4, ++ 0x036, 0x0008C9B4, ++ 0x036, 0x000949B4, ++ 0x036, 0x0009C9B4, ++ 0x036, 0x000A4935, ++ 0x036, 0x000AC935, ++ 0x036, 0x000B4935, ++ 0x036, 0x000BC935, ++ 0x036, 0x000C4EB4, ++ 0x036, 0x000CCEB4, ++ 0x036, 0x000D4EB4, ++ 0x036, 0x000DCEB4, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x00000008, ++ 0xFF0F0740, 0xABCD, ++ 0x03C, 0x000002CC, ++ 0x03C, 0x00000522, ++ 0x03C, 0x00000902, ++ 0xFF0F07C0, 0xCDEF, ++ 0x03C, 0x000002CC, ++ 0x03C, 0x00000522, ++ 0x03C, 0x00000902, ++ 0xFF0F07D8, 0xCDEF, ++ 0x03C, 0x000002CC, ++ 0x03C, 0x00000522, ++ 0x03C, 0x00000902, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x03C, 0x000002AA, ++ 0x03C, 0x000005A2, ++ 0x03C, 0x00000880, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000002, ++ 0x0DF, 0x00000080, ++ 0x01F, 0x00040064, ++ 0xFF0F0740, 0xABCD, ++ 0x061, 0x000FDD43, ++ 0x062, 0x00038F4B, ++ 0x063, 0x00032117, ++ 0x064, 0x000194AC, ++ 0x065, 0x000931D1, ++ 0xFF0F07C0, 0xCDEF, ++ 0x061, 0x000FDD43, ++ 0x062, 0x00038F4B, ++ 0x063, 0x00032117, ++ 0x064, 0x000194AC, ++ 0x065, 0x000931D1, ++ 0xFF0F07D8, 0xCDEF, ++ 0x061, 0x000FDD43, ++ 0x062, 0x00038F4B, ++ 0x063, 0x00032117, ++ 0x064, 0x000194AC, ++ 0x065, 0x000931D1, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x061, 0x000E5D53, ++ 0x062, 0x00038FCD, ++ 0x063, 0x000314EB, ++ 0x064, 0x000196AC, ++ 0x065, 0x000931D7, ++ 0xFF0F0740, 0xDEAD, ++ 0x008, 0x00008400, ++ 0x01C, 0x000739D2, ++ 0x0B4, 0x0001E78D, ++ 0x018, 0x0001F12A, ++ 0x0FE, 0x00000000, ++ 0x0FE, 0x00000000, ++ 0x0FE, 0x00000000, ++ 0x0FE, 0x00000000, ++ 0x0B4, 0x0001A78D, ++ 0x018, 0x0001712A, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_RadioA( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8812A_RadioA)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8812A_RadioA; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_RadioA, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigRF_RadioA_8812A(pDM_Odm, v1, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigRF_RadioA_8812A(pDM_Odm, v1, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* RadioB.TXT ++******************************************************************************/ ++ ++static u4Byte Array_MP_8812A_RadioB[] = { ++ 0x056, 0x00051CF2, ++ 0x066, 0x00040000, ++ 0x089, 0x00000080, ++ 0xFF0F0740, 0xABCD, ++ 0x086, 0x00014B38, ++ 0xFF0F07C0, 0xCDEF, ++ 0x086, 0x00014B38, ++ 0xFF0F07D8, 0xCDEF, ++ 0x086, 0x00014B3C, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x086, 0x00014B38, ++ 0xFF0F0740, 0xDEAD, ++ 0x018, 0x00000006, ++ 0x0EF, 0x00002000, ++ 0x03B, 0x00038A58, ++ 0x03B, 0x00037A58, ++ 0x03B, 0x0002A590, ++ 0x03B, 0x00027A50, ++ 0x03B, 0x00018248, ++ 0x03B, 0x00010240, ++ 0x03B, 0x00008240, ++ 0x03B, 0x00000240, ++ 0x0EF, 0x00000100, ++ 0xFF0F07D8, 0xABCD, ++ 0x034, 0x0000A4EE, ++ 0x034, 0x00009076, ++ 0x034, 0x00008073, ++ 0x034, 0x00007070, ++ 0x034, 0x0000606D, ++ 0x034, 0x0000506A, ++ 0x034, 0x00004049, ++ 0x034, 0x00003046, ++ 0x034, 0x00002028, ++ 0x034, 0x00001025, ++ 0x034, 0x00000022, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0000ADF4, ++ 0x034, 0x00009DF1, ++ 0x034, 0x00008DEE, ++ 0x034, 0x00007DEB, ++ 0x034, 0x00006DE8, ++ 0x034, 0x00005CEC, ++ 0x034, 0x00004CE9, ++ 0x034, 0x000034EA, ++ 0x034, 0x000024E7, ++ 0x034, 0x0000146B, ++ 0x034, 0x0000006D, ++ 0xFF0F07D8, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x000020A2, ++ 0x0DF, 0x00000080, ++ 0x035, 0x00000192, ++ 0x035, 0x00008192, ++ 0x035, 0x00010192, ++ 0x036, 0x00000024, ++ 0x036, 0x00008024, ++ 0x036, 0x00010024, ++ 0x036, 0x00018024, ++ 0x0EF, 0x00000000, ++ 0x051, 0x00000C21, ++ 0x052, 0x000006D9, ++ 0x053, 0x000FC649, ++ 0x054, 0x0000017E, ++ 0x0EF, 0x00000002, ++ 0x008, 0x00008400, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00001000, ++ 0x03A, 0x00000080, ++ 0x03B, 0x0003A02C, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000400, ++ 0x03B, 0x0003202C, ++ 0x03C, 0x00010000, ++ 0x03A, 0x000000A0, ++ 0x03B, 0x0002B064, ++ 0x03C, 0x00004000, ++ 0x03A, 0x000000D8, ++ 0x03B, 0x00023070, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000468, ++ 0x03B, 0x0001B870, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000098, ++ 0x03B, 0x00012085, ++ 0x03C, 0x000E4000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x0000A080, ++ 0x03C, 0x000F0000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x00002080, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000080, ++ 0x03B, 0x0007A02C, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000400, ++ 0x03B, 0x0007202C, ++ 0x03C, 0x00010000, ++ 0x03A, 0x000000A0, ++ 0x03B, 0x0006B064, ++ 0x03C, 0x00004000, ++ 0x03A, 0x000000D8, ++ 0x03B, 0x00063070, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000468, ++ 0x03B, 0x0005B870, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000098, ++ 0x03B, 0x00052085, ++ 0x03C, 0x000E4000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x0004A080, ++ 0x03C, 0x000F0000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x00042080, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000080, ++ 0x03B, 0x000BA02C, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000400, ++ 0x03B, 0x000B202C, ++ 0x03C, 0x00010000, ++ 0x03A, 0x000000A0, ++ 0x03B, 0x000AB064, ++ 0x03C, 0x00004000, ++ 0x03A, 0x000000D8, ++ 0x03B, 0x000A3070, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000468, ++ 0x03B, 0x0009B870, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000098, ++ 0x03B, 0x00092085, ++ 0x03C, 0x000E4000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x0008A080, ++ 0x03C, 0x000F0000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x00082080, ++ 0x03C, 0x00010000, ++ 0x0EF, 0x00001100, ++ 0xFF0F0740, 0xABCD, ++ 0x034, 0x0004A0B2, ++ 0x034, 0x000490AF, ++ 0x034, 0x00048070, ++ 0x034, 0x0004706D, ++ 0x034, 0x00046050, ++ 0x034, 0x0004504D, ++ 0x034, 0x0004404A, ++ 0x034, 0x00043047, ++ 0x034, 0x0004200A, ++ 0x034, 0x00041007, ++ 0x034, 0x00040004, ++ 0xFF0F07C0, 0xCDEF, ++ 0x034, 0x0004A0B2, ++ 0x034, 0x000490AF, ++ 0x034, 0x00048070, ++ 0x034, 0x0004706D, ++ 0x034, 0x00046050, ++ 0x034, 0x0004504D, ++ 0x034, 0x0004404A, ++ 0x034, 0x00043047, ++ 0x034, 0x0004200A, ++ 0x034, 0x00041007, ++ 0x034, 0x00040004, ++ 0xFF0F07D8, 0xCDEF, ++ 0x034, 0x0004A0B2, ++ 0x034, 0x000490AF, ++ 0x034, 0x00048070, ++ 0x034, 0x0004706D, ++ 0x034, 0x00046050, ++ 0x034, 0x0004504D, ++ 0x034, 0x0004404A, ++ 0x034, 0x00043047, ++ 0x034, 0x0004200A, ++ 0x034, 0x00041007, ++ 0x034, 0x00040004, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0004ADF5, ++ 0x034, 0x00049DF2, ++ 0x034, 0x00048DEF, ++ 0x034, 0x00047DEC, ++ 0x034, 0x00046DE9, ++ 0x034, 0x00045DC9, ++ 0x034, 0x00044CE8, ++ 0x034, 0x000438CA, ++ 0x034, 0x00042889, ++ 0x034, 0x0004184A, ++ 0x034, 0x0004044A, ++ 0xFF0F0740, 0xDEAD, ++ 0xFF0F0740, 0xABCD, ++ 0x034, 0x0002A0B2, ++ 0x034, 0x000290AF, ++ 0x034, 0x00028070, ++ 0x034, 0x0002706D, ++ 0x034, 0x00026050, ++ 0x034, 0x0002504D, ++ 0x034, 0x0002404A, ++ 0x034, 0x00023047, ++ 0x034, 0x0002200A, ++ 0x034, 0x00021007, ++ 0x034, 0x00020004, ++ 0xFF0F07C0, 0xCDEF, ++ 0x034, 0x0002A0B2, ++ 0x034, 0x000290AF, ++ 0x034, 0x00028070, ++ 0x034, 0x0002706D, ++ 0x034, 0x00026050, ++ 0x034, 0x0002504D, ++ 0x034, 0x0002404A, ++ 0x034, 0x00023047, ++ 0x034, 0x0002200A, ++ 0x034, 0x00021007, ++ 0x034, 0x00020004, ++ 0xFF0F07D8, 0xCDEF, ++ 0x034, 0x0002A0B2, ++ 0x034, 0x000290AF, ++ 0x034, 0x00028070, ++ 0x034, 0x0002706D, ++ 0x034, 0x00026050, ++ 0x034, 0x0002504D, ++ 0x034, 0x0002404A, ++ 0x034, 0x00023047, ++ 0x034, 0x0002200A, ++ 0x034, 0x00021007, ++ 0x034, 0x00020004, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0002ADF5, ++ 0x034, 0x00029DF2, ++ 0x034, 0x00028DEF, ++ 0x034, 0x00027DEC, ++ 0x034, 0x00026DE9, ++ 0x034, 0x00025DC9, ++ 0x034, 0x00024CE8, ++ 0x034, 0x000238CA, ++ 0x034, 0x00022889, ++ 0x034, 0x0002184A, ++ 0x034, 0x0002044A, ++ 0xFF0F0740, 0xDEAD, ++ 0xFF0F0740, 0xABCD, ++ 0x034, 0x0000A0B2, ++ 0x034, 0x000090AF, ++ 0x034, 0x00008070, ++ 0x034, 0x0000706D, ++ 0x034, 0x00006050, ++ 0x034, 0x0000504D, ++ 0x034, 0x0000404A, ++ 0x034, 0x00003047, ++ 0x034, 0x0000200A, ++ 0x034, 0x00001007, ++ 0x034, 0x00000004, ++ 0xFF0F07C0, 0xCDEF, ++ 0x034, 0x0000A0B2, ++ 0x034, 0x000090AF, ++ 0x034, 0x00008070, ++ 0x034, 0x0000706D, ++ 0x034, 0x00006050, ++ 0x034, 0x0000504D, ++ 0x034, 0x0000404A, ++ 0x034, 0x00003047, ++ 0x034, 0x0000200A, ++ 0x034, 0x00001007, ++ 0x034, 0x00000004, ++ 0xFF0F07D8, 0xCDEF, ++ 0x034, 0x0000A0B2, ++ 0x034, 0x000090AF, ++ 0x034, 0x00008070, ++ 0x034, 0x0000706D, ++ 0x034, 0x00006050, ++ 0x034, 0x0000504D, ++ 0x034, 0x0000404A, ++ 0x034, 0x00003047, ++ 0x034, 0x0000200A, ++ 0x034, 0x00001007, ++ 0x034, 0x00000004, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0000AFF7, ++ 0x034, 0x00009DF7, ++ 0x034, 0x00008DF4, ++ 0x034, 0x00007DF1, ++ 0x034, 0x00006DEE, ++ 0x034, 0x00005DCD, ++ 0x034, 0x00004CEB, ++ 0x034, 0x000038CC, ++ 0x034, 0x0000288B, ++ 0x034, 0x0000184C, ++ 0x034, 0x0000044C, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0xFF0F0740, 0xABCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x000001C5, ++ 0x035, 0x000081C5, ++ 0x035, 0x000101C5, ++ 0x035, 0x00020174, ++ 0x035, 0x00028174, ++ 0x035, 0x00030174, ++ 0x035, 0x00040185, ++ 0x035, 0x00048185, ++ 0x035, 0x00050185, ++ 0x0EF, 0x00000000, ++ 0xFF0F07C0, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x000001C5, ++ 0x035, 0x000081C5, ++ 0x035, 0x000101C5, ++ 0x035, 0x00020174, ++ 0x035, 0x00028174, ++ 0x035, 0x00030174, ++ 0x035, 0x00040185, ++ 0x035, 0x00048185, ++ 0x035, 0x00050185, ++ 0x0EF, 0x00000000, ++ 0xFF0F07D8, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x000001C5, ++ 0x035, 0x000081C5, ++ 0x035, 0x000101C5, ++ 0x035, 0x00020174, ++ 0x035, 0x00028174, ++ 0x035, 0x00030174, ++ 0x035, 0x00040185, ++ 0x035, 0x00048185, ++ 0x035, 0x00050185, ++ 0x0EF, 0x00000000, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x00000186, ++ 0x035, 0x00008186, ++ 0x035, 0x00010185, ++ 0x035, 0x000201D5, ++ 0x035, 0x000281D5, ++ 0x035, 0x000301D5, ++ 0x035, 0x000401D5, ++ 0x035, 0x000481D5, ++ 0x035, 0x000501D5, ++ 0x0EF, 0x00000000, ++ 0xFF0F0740, 0xDEAD, ++ 0xFF0F0740, 0xABCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00005B8B, ++ 0x036, 0x0000DB8B, ++ 0x036, 0x00015B8B, ++ 0x036, 0x0001DB8B, ++ 0x036, 0x000262DB, ++ 0x036, 0x0002E2DB, ++ 0x036, 0x000362DB, ++ 0x036, 0x0003E2DB, ++ 0x036, 0x0004553B, ++ 0x036, 0x0004D53B, ++ 0x036, 0x0005553B, ++ 0x036, 0x0005D53B, ++ 0xFF0F07C0, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00005B8B, ++ 0x036, 0x0000DB8B, ++ 0x036, 0x00015B8B, ++ 0x036, 0x0001DB8B, ++ 0x036, 0x000262DB, ++ 0x036, 0x0002E2DB, ++ 0x036, 0x000362DB, ++ 0x036, 0x0003E2DB, ++ 0x036, 0x0004553B, ++ 0x036, 0x0004D53B, ++ 0x036, 0x0005553B, ++ 0x036, 0x0005D53B, ++ 0xFF0F07D8, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00005B8B, ++ 0x036, 0x0000DB8B, ++ 0x036, 0x00015B8B, ++ 0x036, 0x0001DB8B, ++ 0x036, 0x000262DB, ++ 0x036, 0x0002E2DB, ++ 0x036, 0x000362DB, ++ 0x036, 0x0003E2DB, ++ 0x036, 0x0004553B, ++ 0x036, 0x0004D53B, ++ 0x036, 0x0005553B, ++ 0x036, 0x0005D53B, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00084EB4, ++ 0x036, 0x0008C9B4, ++ 0x036, 0x000949B4, ++ 0x036, 0x0009C9B4, ++ 0x036, 0x000A4935, ++ 0x036, 0x000AC935, ++ 0x036, 0x000B4935, ++ 0x036, 0x000BC935, ++ 0x036, 0x000C4EB4, ++ 0x036, 0x000CCEB4, ++ 0x036, 0x000D4EB4, ++ 0x036, 0x000DCEB4, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x00000008, ++ 0xFF0F0740, 0xABCD, ++ 0x03C, 0x000002DC, ++ 0x03C, 0x00000524, ++ 0x03C, 0x00000902, ++ 0xFF0F07C0, 0xCDEF, ++ 0x03C, 0x000002DC, ++ 0x03C, 0x00000524, ++ 0x03C, 0x00000902, ++ 0xFF0F07D8, 0xCDEF, ++ 0x03C, 0x000002DC, ++ 0x03C, 0x00000524, ++ 0x03C, 0x00000902, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x03C, 0x000002AA, ++ 0x03C, 0x000005A2, ++ 0x03C, 0x00000880, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000002, ++ 0x0DF, 0x00000080, ++ 0xFF0F0740, 0xABCD, ++ 0x061, 0x000EAC43, ++ 0x062, 0x00038F47, ++ 0x063, 0x00031157, ++ 0x064, 0x0001C4AC, ++ 0x065, 0x000931D1, ++ 0xFF0F07C0, 0xCDEF, ++ 0x061, 0x000EAC43, ++ 0x062, 0x00038F47, ++ 0x063, 0x00031157, ++ 0x064, 0x0001C4AC, ++ 0x065, 0x000931D1, ++ 0xFF0F07D8, 0xCDEF, ++ 0x061, 0x000EAC43, ++ 0x062, 0x00038F47, ++ 0x063, 0x00031157, ++ 0x064, 0x0001C4AC, ++ 0x065, 0x000931D1, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x061, 0x000E5D53, ++ 0x062, 0x00038FCD, ++ 0x063, 0x000314EB, ++ 0x064, 0x000196AC, ++ 0x065, 0x000931D7, ++ 0xFF0F0740, 0xDEAD, ++ 0x008, 0x00008400, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_RadioB( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8812A_RadioB)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8812A_RadioB; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_RadioB, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigRF_RadioB_8812A(pDM_Odm, v1, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigRF_RadioB_8812A(pDM_Odm, v1, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* TxPowerTrack_AP.TXT ++******************************************************************************/ ++ ++static u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_AP_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_AP_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 17, 17, 18, 19, 20, 20, 20}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_AP_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 4, 4, 5, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 13, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_AP_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 7, 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 18, 19, 19, 19}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_AP_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_AP_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_AP_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_AP_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_AP_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_AP_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_AP_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_AP_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_TxPowerTrack_AP( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8812A\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE*3); ++} ++ ++/****************************************************************************** ++* TxPowerTrack_PCIE.TXT ++******************************************************************************/ ++ ++static u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 13, 13, 13}, ++ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 11, 12, 12, 12, 12, 12, 13, 13}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 8, 8, 9, 10, 11, 12, 13, 14, 14, 15, 15, 15, 16, 16, 16, 17, 17, 18, 18}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_TxPowerTrack_PCIE( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8812A\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); ++} ++ ++/****************************************************************************** ++* TxPowerTrack_USB.TXT ++******************************************************************************/ ++ ++static u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 12, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++static u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; ++static u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_TxPowerTrack_USB( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8812A\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE*3); ++} ++ ++/****************************************************************************** ++* TxPowerTrack_USB_RFE3.TXT ++******************************************************************************/ ++ ++static u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_RFE3_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 12, 13, 13, 14, 15, 16, 16, 17, 17, 18, 18}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_RFE3_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_RFE3_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 13, 14, 15, 16, 16, 17, 17, 18, 18}, ++ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 16, 16, 17, 17}, ++ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 12, 13, 13, 14, 14, 15, 15, 16, 17, 18, 18}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_RFE3_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 2, 3, 4, 4, 5, 5, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 2, 3, 4, 4, 5, 5, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_RFE3_8812A[] = {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15}; ++static u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_RFE3_8812A[] = {0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 9, 10, 10, 10, 10, 11, 11, 11, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_RFE3_8812A[] = {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 10, 11, 11, 12, 12, 13, 13, 13, 13, 14, 14, 15, 15}; ++static u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_RFE3_8812A[] = {0, 0, 1, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_RFE3_8812A[] = {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_RFE3_8812A[] = {0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 9, 10, 10, 10, 10, 11, 11, 11, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_RFE3_8812A[] = {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 10, 11, 11, 12, 12, 13, 13, 13, 13, 14, 14, 15, 15}; ++static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_RFE3_8812A[] = {0, 0, 1, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_TxPowerTrack_USB_RFE3( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8812A\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE*3); ++} ++ ++/****************************************************************************** ++* TXPWR_LMT.TXT ++******************************************************************************/ ++ ++static pu1Byte Array_MP_8812A_TXPWR_LMT[] = { ++ "FCC", "2.4G", "20M", "CCK", "1T", "01", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "02", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "03", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "04", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "05", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "06", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "07", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "08", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "09", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "10", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "11", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "12", "63", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "13", "63", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "32", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "63", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "63", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "FCC", "2.4G", "20M", "HT", "1T", "01", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "02", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "03", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "04", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "05", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "06", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "07", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "08", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "09", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "10", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "11", "32", ++ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "12", "63", ++ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "13", "63", ++ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", ++ "FCC", "2.4G", "20M", "HT", "2T", "01", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "02", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "03", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "04", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "05", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "06", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "07", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "08", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "09", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "10", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", ++ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", ++ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "03", "32", ++ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "04", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "05", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "06", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "07", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "08", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "09", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "10", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "11", "32", ++ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "12", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "12", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "13", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "13", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", ++ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "04", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "05", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "06", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "07", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "08", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "09", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "10", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", ++ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", ++ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", ++ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", ++ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", ++ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "36", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "36", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "40", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "40", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "44", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "48", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "52", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "56", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "60", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "64", "28", ++ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "100", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "100", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "114", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "114", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "114", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "108", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "108", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "112", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "112", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "116", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "116", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "120", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "120", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "124", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "124", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "128", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "128", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "132", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "132", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "136", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "136", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "140", "28", ++ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "140", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "149", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "153", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "157", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "161", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "165", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", ++ "FCC", "5G", "20M", "HT", "1T", "36", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "36", "32", ++ "MKK", "5G", "20M", "HT", "1T", "36", "32", ++ "FCC", "5G", "20M", "HT", "1T", "40", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "40", "32", ++ "MKK", "5G", "20M", "HT", "1T", "40", "32", ++ "FCC", "5G", "20M", "HT", "1T", "44", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "44", "32", ++ "MKK", "5G", "20M", "HT", "1T", "44", "32", ++ "FCC", "5G", "20M", "HT", "1T", "48", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "48", "32", ++ "MKK", "5G", "20M", "HT", "1T", "48", "32", ++ "FCC", "5G", "20M", "HT", "1T", "52", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "52", "32", ++ "MKK", "5G", "20M", "HT", "1T", "52", "32", ++ "FCC", "5G", "20M", "HT", "1T", "56", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "56", "32", ++ "MKK", "5G", "20M", "HT", "1T", "56", "32", ++ "FCC", "5G", "20M", "HT", "1T", "60", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "60", "32", ++ "MKK", "5G", "20M", "HT", "1T", "60", "32", ++ "FCC", "5G", "20M", "HT", "1T", "64", "28", ++ "ETSI", "5G", "20M", "HT", "1T", "64", "32", ++ "MKK", "5G", "20M", "HT", "1T", "64", "32", ++ "FCC", "5G", "20M", "HT", "1T", "100", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "100", "32", ++ "MKK", "5G", "20M", "HT", "1T", "100", "32", ++ "FCC", "5G", "20M", "HT", "1T", "114", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "114", "32", ++ "MKK", "5G", "20M", "HT", "1T", "114", "32", ++ "FCC", "5G", "20M", "HT", "1T", "108", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "108", "32", ++ "MKK", "5G", "20M", "HT", "1T", "108", "32", ++ "FCC", "5G", "20M", "HT", "1T", "112", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "112", "32", ++ "MKK", "5G", "20M", "HT", "1T", "112", "32", ++ "FCC", "5G", "20M", "HT", "1T", "116", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "116", "32", ++ "MKK", "5G", "20M", "HT", "1T", "116", "32", ++ "FCC", "5G", "20M", "HT", "1T", "120", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "120", "32", ++ "MKK", "5G", "20M", "HT", "1T", "120", "32", ++ "FCC", "5G", "20M", "HT", "1T", "124", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "124", "32", ++ "MKK", "5G", "20M", "HT", "1T", "124", "32", ++ "FCC", "5G", "20M", "HT", "1T", "128", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "128", "32", ++ "MKK", "5G", "20M", "HT", "1T", "128", "32", ++ "FCC", "5G", "20M", "HT", "1T", "132", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "132", "32", ++ "MKK", "5G", "20M", "HT", "1T", "132", "32", ++ "FCC", "5G", "20M", "HT", "1T", "136", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "136", "32", ++ "MKK", "5G", "20M", "HT", "1T", "136", "32", ++ "FCC", "5G", "20M", "HT", "1T", "140", "28", ++ "ETSI", "5G", "20M", "HT", "1T", "140", "32", ++ "MKK", "5G", "20M", "HT", "1T", "140", "32", ++ "FCC", "5G", "20M", "HT", "1T", "149", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "149", "32", ++ "MKK", "5G", "20M", "HT", "1T", "149", "63", ++ "FCC", "5G", "20M", "HT", "1T", "153", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "153", "32", ++ "MKK", "5G", "20M", "HT", "1T", "153", "63", ++ "FCC", "5G", "20M", "HT", "1T", "157", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "157", "32", ++ "MKK", "5G", "20M", "HT", "1T", "157", "63", ++ "FCC", "5G", "20M", "HT", "1T", "161", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "161", "32", ++ "MKK", "5G", "20M", "HT", "1T", "161", "63", ++ "FCC", "5G", "20M", "HT", "1T", "165", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "165", "32", ++ "MKK", "5G", "20M", "HT", "1T", "165", "63", ++ "FCC", "5G", "20M", "HT", "2T", "36", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "36", "30", ++ "MKK", "5G", "20M", "HT", "2T", "36", "30", ++ "FCC", "5G", "20M", "HT", "2T", "40", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "40", "30", ++ "MKK", "5G", "20M", "HT", "2T", "40", "30", ++ "FCC", "5G", "20M", "HT", "2T", "44", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "44", "30", ++ "MKK", "5G", "20M", "HT", "2T", "44", "30", ++ "FCC", "5G", "20M", "HT", "2T", "48", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "48", "30", ++ "MKK", "5G", "20M", "HT", "2T", "48", "30", ++ "FCC", "5G", "20M", "HT", "2T", "52", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "52", "30", ++ "MKK", "5G", "20M", "HT", "2T", "52", "30", ++ "FCC", "5G", "20M", "HT", "2T", "56", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "56", "30", ++ "MKK", "5G", "20M", "HT", "2T", "56", "30", ++ "FCC", "5G", "20M", "HT", "2T", "60", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "60", "30", ++ "MKK", "5G", "20M", "HT", "2T", "60", "30", ++ "FCC", "5G", "20M", "HT", "2T", "64", "26", ++ "ETSI", "5G", "20M", "HT", "2T", "64", "30", ++ "MKK", "5G", "20M", "HT", "2T", "64", "30", ++ "FCC", "5G", "20M", "HT", "2T", "100", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "100", "30", ++ "MKK", "5G", "20M", "HT", "2T", "100", "30", ++ "FCC", "5G", "20M", "HT", "2T", "114", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "114", "30", ++ "MKK", "5G", "20M", "HT", "2T", "114", "30", ++ "FCC", "5G", "20M", "HT", "2T", "108", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "108", "30", ++ "MKK", "5G", "20M", "HT", "2T", "108", "30", ++ "FCC", "5G", "20M", "HT", "2T", "112", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "112", "30", ++ "MKK", "5G", "20M", "HT", "2T", "112", "30", ++ "FCC", "5G", "20M", "HT", "2T", "116", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "116", "30", ++ "MKK", "5G", "20M", "HT", "2T", "116", "30", ++ "FCC", "5G", "20M", "HT", "2T", "120", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "120", "30", ++ "MKK", "5G", "20M", "HT", "2T", "120", "30", ++ "FCC", "5G", "20M", "HT", "2T", "124", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "124", "30", ++ "MKK", "5G", "20M", "HT", "2T", "124", "30", ++ "FCC", "5G", "20M", "HT", "2T", "128", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "128", "30", ++ "MKK", "5G", "20M", "HT", "2T", "128", "30", ++ "FCC", "5G", "20M", "HT", "2T", "132", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "132", "30", ++ "MKK", "5G", "20M", "HT", "2T", "132", "30", ++ "FCC", "5G", "20M", "HT", "2T", "136", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "136", "30", ++ "MKK", "5G", "20M", "HT", "2T", "136", "30", ++ "FCC", "5G", "20M", "HT", "2T", "140", "26", ++ "ETSI", "5G", "20M", "HT", "2T", "140", "30", ++ "MKK", "5G", "20M", "HT", "2T", "140", "30", ++ "FCC", "5G", "20M", "HT", "2T", "149", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "149", "30", ++ "MKK", "5G", "20M", "HT", "2T", "149", "63", ++ "FCC", "5G", "20M", "HT", "2T", "153", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "153", "30", ++ "MKK", "5G", "20M", "HT", "2T", "153", "63", ++ "FCC", "5G", "20M", "HT", "2T", "157", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "157", "30", ++ "MKK", "5G", "20M", "HT", "2T", "157", "63", ++ "FCC", "5G", "20M", "HT", "2T", "161", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "161", "30", ++ "MKK", "5G", "20M", "HT", "2T", "161", "63", ++ "FCC", "5G", "20M", "HT", "2T", "165", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "165", "30", ++ "MKK", "5G", "20M", "HT", "2T", "165", "63", ++ "FCC", "5G", "40M", "HT", "1T", "38", "30", ++ "ETSI", "5G", "40M", "HT", "1T", "38", "32", ++ "MKK", "5G", "40M", "HT", "1T", "38", "32", ++ "FCC", "5G", "40M", "HT", "1T", "46", "30", ++ "ETSI", "5G", "40M", "HT", "1T", "46", "32", ++ "MKK", "5G", "40M", "HT", "1T", "46", "32", ++ "FCC", "5G", "40M", "HT", "1T", "54", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "54", "32", ++ "MKK", "5G", "40M", "HT", "1T", "54", "32", ++ "FCC", "5G", "40M", "HT", "1T", "62", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "62", "32", ++ "MKK", "5G", "40M", "HT", "1T", "62", "32", ++ "FCC", "5G", "40M", "HT", "1T", "102", "28", ++ "ETSI", "5G", "40M", "HT", "1T", "102", "32", ++ "MKK", "5G", "40M", "HT", "1T", "102", "32", ++ "FCC", "5G", "40M", "HT", "1T", "110", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "110", "32", ++ "MKK", "5G", "40M", "HT", "1T", "110", "32", ++ "FCC", "5G", "40M", "HT", "1T", "118", "36", ++ "ETSI", "5G", "40M", "HT", "1T", "118", "32", ++ "MKK", "5G", "40M", "HT", "1T", "118", "32", ++ "FCC", "5G", "40M", "HT", "1T", "126", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "126", "32", ++ "MKK", "5G", "40M", "HT", "1T", "126", "32", ++ "FCC", "5G", "40M", "HT", "1T", "134", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "134", "32", ++ "MKK", "5G", "40M", "HT", "1T", "134", "32", ++ "FCC", "5G", "40M", "HT", "1T", "151", "36", ++ "ETSI", "5G", "40M", "HT", "1T", "151", "32", ++ "MKK", "5G", "40M", "HT", "1T", "151", "63", ++ "FCC", "5G", "40M", "HT", "1T", "159", "36", ++ "ETSI", "5G", "40M", "HT", "1T", "159", "32", ++ "MKK", "5G", "40M", "HT", "1T", "159", "63", ++ "FCC", "5G", "40M", "HT", "2T", "38", "28", ++ "ETSI", "5G", "40M", "HT", "2T", "38", "30", ++ "MKK", "5G", "40M", "HT", "2T", "38", "30", ++ "FCC", "5G", "40M", "HT", "2T", "46", "28", ++ "ETSI", "5G", "40M", "HT", "2T", "46", "30", ++ "MKK", "5G", "40M", "HT", "2T", "46", "30", ++ "FCC", "5G", "40M", "HT", "2T", "54", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "54", "30", ++ "MKK", "5G", "40M", "HT", "2T", "54", "30", ++ "FCC", "5G", "40M", "HT", "2T", "62", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "62", "30", ++ "MKK", "5G", "40M", "HT", "2T", "62", "30", ++ "FCC", "5G", "40M", "HT", "2T", "102", "26", ++ "ETSI", "5G", "40M", "HT", "2T", "102", "30", ++ "MKK", "5G", "40M", "HT", "2T", "102", "30", ++ "FCC", "5G", "40M", "HT", "2T", "110", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "110", "30", ++ "MKK", "5G", "40M", "HT", "2T", "110", "30", ++ "FCC", "5G", "40M", "HT", "2T", "118", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "118", "30", ++ "MKK", "5G", "40M", "HT", "2T", "118", "30", ++ "FCC", "5G", "40M", "HT", "2T", "126", "32", ++ "ETSI", "5G", "40M", "HT", "2T", "126", "30", ++ "MKK", "5G", "40M", "HT", "2T", "126", "30", ++ "FCC", "5G", "40M", "HT", "2T", "134", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "134", "30", ++ "MKK", "5G", "40M", "HT", "2T", "134", "30", ++ "FCC", "5G", "40M", "HT", "2T", "151", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "151", "30", ++ "MKK", "5G", "40M", "HT", "2T", "151", "63", ++ "FCC", "5G", "40M", "HT", "2T", "159", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "159", "30", ++ "MKK", "5G", "40M", "HT", "2T", "159", "63", ++ "FCC", "5G", "80M", "VHT", "1T", "42", "30", ++ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "42", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "58", "28", ++ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "58", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "106", "30", ++ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "106", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "122", "34", ++ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "122", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "155", "36", ++ "ETSI", "5G", "80M", "VHT", "1T", "155", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "155", "63", ++ "FCC", "5G", "80M", "VHT", "2T", "42", "28", ++ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "42", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "58", "26", ++ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "58", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "106", "28", ++ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "106", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "122", "32", ++ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "122", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "155", "34", ++ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "155", "63" ++}; ++ ++void ++ODM_ReadAndConfig_MP_8812A_TXPWR_LMT( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte i = 0; ++ u4Byte ArrayLen = sizeof(Array_MP_8812A_TXPWR_LMT)/sizeof(pu1Byte); ++ pu1Byte *Array = Array_MP_8812A_TXPWR_LMT; ++ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_TXPWR_LMT\n")); ++ ++ for (i = 0; i < ArrayLen; i += 7 ) ++ { ++ pu1Byte regulation = Array[i]; ++ pu1Byte band = Array[i+1]; ++ pu1Byte bandwidth = Array[i+2]; ++ pu1Byte rate = Array[i+3]; ++ pu1Byte rfPath = Array[i+4]; ++ pu1Byte chnl = Array[i+5]; ++ pu1Byte val = Array[i+6]; ++ ++ odm_ConfigBB_TXPWR_LMT_8812A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); ++ } ++ ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.h 2018-02-06 17:42:30.704967075 +0200 +@@ -0,0 +1,84 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#ifndef __INC_MP_RF_HW_IMG_8812A_H ++#define __INC_MP_RF_HW_IMG_8812A_H ++ ++static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); ++ ++/****************************************************************************** ++* RadioA.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_RadioA( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* RadioB.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_RadioB( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TxPowerTrack_AP.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_TxPowerTrack_AP( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TxPowerTrack_PCIE.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_TxPowerTrack_PCIE( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TxPowerTrack_USB.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_TxPowerTrack_USB( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TxPowerTrack_USB_RFE3.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_TxPowerTrack_USB_RFE3( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TXPWR_LMT.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8812A_TXPWR_LMT( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.c 2018-02-06 17:42:30.705967090 +0200 +@@ -0,0 +1,1123 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#include "odm_precomp.h" ++ ++static bool ++CheckCondition( ++ const u4Byte Condition, ++ const u4Byte Hex ++ ) ++{ ++ u4Byte _board = (Hex & 0x000000FF); ++ u4Byte _interface = (Hex & 0x0000FF00) >> 8; ++ u4Byte _platform = (Hex & 0x00FF0000) >> 16; ++ u4Byte cond = Condition; ++ ++ if ( Condition == 0xCDCDCDCD ) ++ return true; ++ ++ cond = Condition & 0x000000FF; ++ if ( (_board != cond) && (cond != 0xFF) ) ++ return false; ++ ++ cond = Condition & 0x0000FF00; ++ cond = cond >> 8; ++ if ( ((_interface & cond) == 0) && (cond != 0x07) ) ++ return false; ++ ++ cond = Condition & 0x00FF0000; ++ cond = cond >> 16; ++ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) ++ return false; ++ return true; ++} ++ ++ ++/****************************************************************************** ++* AGC_TAB.TXT ++******************************************************************************/ ++ ++static u4Byte Array_TC_8812A_AGC_TAB[] = { ++ 0xFF0F07D8, 0xABCD, ++ 0x81C, 0xFF000001, ++ 0x81C, 0xFF020001, ++ 0x81C, 0xFF040001, ++ 0x81C, 0xFE060001, ++ 0x81C, 0xFD080001, ++ 0x81C, 0xFC0A0001, ++ 0x81C, 0xFB0C0001, ++ 0x81C, 0xFA0E0001, ++ 0x81C, 0xF9100001, ++ 0x81C, 0xF8120001, ++ 0x81C, 0xF7140001, ++ 0x81C, 0xF6160001, ++ 0x81C, 0xF5180001, ++ 0x81C, 0xF41A0001, ++ 0x81C, 0xF31C0001, ++ 0x81C, 0xF21E0001, ++ 0x81C, 0xF1200001, ++ 0x81C, 0xF0220001, ++ 0x81C, 0xEF240001, ++ 0x81C, 0xEE260001, ++ 0x81C, 0xED280001, ++ 0x81C, 0xEC2A0001, ++ 0x81C, 0xEB2C0001, ++ 0x81C, 0xEA2E0001, ++ 0x81C, 0xE9300001, ++ 0x81C, 0xE8320001, ++ 0x81C, 0xC7340001, ++ 0x81C, 0xC6360001, ++ 0x81C, 0xC5380001, ++ 0x81C, 0xC43A0001, ++ 0x81C, 0xC33C0001, ++ 0x81C, 0xC23E0001, ++ 0x81C, 0xC1400001, ++ 0x81C, 0xA6420001, ++ 0x81C, 0xA5440001, ++ 0x81C, 0xA4460001, ++ 0x81C, 0x69480001, ++ 0x81C, 0x684A0001, ++ 0x81C, 0x674C0001, ++ 0x81C, 0x664E0001, ++ 0x81C, 0x65500001, ++ 0x81C, 0x64520001, ++ 0x81C, 0x63540001, ++ 0x81C, 0x62560001, ++ 0x81C, 0x48580001, ++ 0x81C, 0x475A0001, ++ 0x81C, 0x465C0001, ++ 0x81C, 0x455E0001, ++ 0x81C, 0x44600001, ++ 0x81C, 0x43620001, ++ 0x81C, 0x42640001, ++ 0x81C, 0x41660001, ++ 0x81C, 0x41680001, ++ 0x81C, 0x416A0001, ++ 0x81C, 0x416C0001, ++ 0x81C, 0x416E0001, ++ 0x81C, 0x41700001, ++ 0x81C, 0x41720001, ++ 0x81C, 0x41740001, ++ 0x81C, 0x41760001, ++ 0x81C, 0x41780001, ++ 0x81C, 0x417A0001, ++ 0x81C, 0x417C0001, ++ 0x81C, 0x417E0001, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x81C, 0xFF000001, ++ 0x81C, 0xFF020001, ++ 0x81C, 0xFF040001, ++ 0x81C, 0xFF060001, ++ 0x81C, 0xFF080001, ++ 0x81C, 0xFE0A0001, ++ 0x81C, 0xFD0C0001, ++ 0x81C, 0xFC0E0001, ++ 0x81C, 0xFB100001, ++ 0x81C, 0xFA120001, ++ 0x81C, 0xF9140001, ++ 0x81C, 0xF8160001, ++ 0x81C, 0xF7180001, ++ 0x81C, 0xF61A0001, ++ 0x81C, 0xF51C0001, ++ 0x81C, 0xF41E0001, ++ 0x81C, 0xF3200001, ++ 0x81C, 0xF2220001, ++ 0x81C, 0xF1240001, ++ 0x81C, 0xF0260001, ++ 0x81C, 0xEF280001, ++ 0x81C, 0xEE2A0001, ++ 0x81C, 0xED2C0001, ++ 0x81C, 0xEC2E0001, ++ 0x81C, 0xEB300001, ++ 0x81C, 0xEA320001, ++ 0x81C, 0xE9340001, ++ 0x81C, 0xE8360001, ++ 0x81C, 0xE7380001, ++ 0x81C, 0xE63A0001, ++ 0x81C, 0xE53C0001, ++ 0x81C, 0xC73E0001, ++ 0x81C, 0xC6400001, ++ 0x81C, 0xC5420001, ++ 0x81C, 0xC4440001, ++ 0x81C, 0xC3460001, ++ 0x81C, 0xC2480001, ++ 0x81C, 0xC14A0001, ++ 0x81C, 0xA74C0001, ++ 0x81C, 0xA64E0001, ++ 0x81C, 0xA5500001, ++ 0x81C, 0xA4520001, ++ 0x81C, 0xA3540001, ++ 0x81C, 0xA2560001, ++ 0x81C, 0xA1580001, ++ 0x81C, 0x675A0001, ++ 0x81C, 0x665C0001, ++ 0x81C, 0x655E0001, ++ 0x81C, 0x64600001, ++ 0x81C, 0x63620001, ++ 0x81C, 0x48640001, ++ 0x81C, 0x47660001, ++ 0x81C, 0x46680001, ++ 0x81C, 0x456A0001, ++ 0x81C, 0x446C0001, ++ 0x81C, 0x436E0001, ++ 0x81C, 0x42700001, ++ 0x81C, 0x41720001, ++ 0x81C, 0x41740001, ++ 0x81C, 0x41760001, ++ 0x81C, 0x41780001, ++ 0x81C, 0x417A0001, ++ 0x81C, 0x417C0001, ++ 0x81C, 0x417E0001, ++ 0xFF0F07D8, 0xDEAD, ++ 0xFF0F0780, 0xABCD, ++ 0x81C, 0xFC800001, ++ 0x81C, 0xFB820001, ++ 0x81C, 0xFA840001, ++ 0x81C, 0xF9860001, ++ 0x81C, 0xF8880001, ++ 0x81C, 0xF78A0001, ++ 0x81C, 0xF68C0001, ++ 0x81C, 0xF58E0001, ++ 0x81C, 0xF4900001, ++ 0x81C, 0xF3920001, ++ 0x81C, 0xF2940001, ++ 0x81C, 0xF1960001, ++ 0x81C, 0xF0980001, ++ 0x81C, 0xEF9A0001, ++ 0x81C, 0xEE9C0001, ++ 0x81C, 0xED9E0001, ++ 0x81C, 0xECA00001, ++ 0x81C, 0xEBA20001, ++ 0x81C, 0xEAA40001, ++ 0x81C, 0xE9A60001, ++ 0x81C, 0xE8A80001, ++ 0x81C, 0xE7AA0001, ++ 0x81C, 0xE6AC0001, ++ 0x81C, 0xE5AE0001, ++ 0x81C, 0xE4B00001, ++ 0x81C, 0xE3B20001, ++ 0x81C, 0xA8B40001, ++ 0x81C, 0xA7B60001, ++ 0x81C, 0xA6B80001, ++ 0x81C, 0xA5BA0001, ++ 0x81C, 0xA4BC0001, ++ 0x81C, 0xA3BE0001, ++ 0x81C, 0xA2C00001, ++ 0x81C, 0xA1C20001, ++ 0x81C, 0x68C40001, ++ 0x81C, 0x67C60001, ++ 0x81C, 0x66C80001, ++ 0x81C, 0x65CA0001, ++ 0x81C, 0x47CC0001, ++ 0x81C, 0x46CE0001, ++ 0x81C, 0x45D00001, ++ 0x81C, 0x44D20001, ++ 0x81C, 0x43D40001, ++ 0x81C, 0x42D60001, ++ 0x81C, 0x08D80001, ++ 0x81C, 0x07DA0001, ++ 0x81C, 0x06DC0001, ++ 0x81C, 0x05DE0001, ++ 0x81C, 0x04E00001, ++ 0x81C, 0x03E20001, ++ 0x81C, 0x02E40001, ++ 0x81C, 0x01E60001, ++ 0x81C, 0x01E80001, ++ 0x81C, 0x01EA0001, ++ 0x81C, 0x01EC0001, ++ 0x81C, 0x01EE0001, ++ 0x81C, 0x01F00001, ++ 0x81C, 0x01F20001, ++ 0x81C, 0x01F40001, ++ 0x81C, 0x01F60001, ++ 0x81C, 0x01F80001, ++ 0x81C, 0x01FA0001, ++ 0x81C, 0x01FC0001, ++ 0x81C, 0x01FE0001, ++ 0xFF0F07C0, 0xCDEF, ++ 0x81C, 0xFC800001, ++ 0x81C, 0xFB820001, ++ 0x81C, 0xFA840001, ++ 0x81C, 0xF9860001, ++ 0x81C, 0xF8880001, ++ 0x81C, 0xF78A0001, ++ 0x81C, 0xF68C0001, ++ 0x81C, 0xF58E0001, ++ 0x81C, 0xF4900001, ++ 0x81C, 0xF3920001, ++ 0x81C, 0xF2940001, ++ 0x81C, 0xF1960001, ++ 0x81C, 0xF0980001, ++ 0x81C, 0xEF9A0001, ++ 0x81C, 0xEE9C0001, ++ 0x81C, 0xED9E0001, ++ 0x81C, 0xECA00001, ++ 0x81C, 0xEBA20001, ++ 0x81C, 0xEAA40001, ++ 0x81C, 0xE9A60001, ++ 0x81C, 0xE8A80001, ++ 0x81C, 0xE7AA0001, ++ 0x81C, 0xE6AC0001, ++ 0x81C, 0xE5AE0001, ++ 0x81C, 0xE4B00001, ++ 0x81C, 0xE3B20001, ++ 0x81C, 0xA8B40001, ++ 0x81C, 0xA7B60001, ++ 0x81C, 0xA6B80001, ++ 0x81C, 0xA5BA0001, ++ 0x81C, 0xA4BC0001, ++ 0x81C, 0xA3BE0001, ++ 0x81C, 0xA2C00001, ++ 0x81C, 0xA1C20001, ++ 0x81C, 0x68C40001, ++ 0x81C, 0x67C60001, ++ 0x81C, 0x66C80001, ++ 0x81C, 0x65CA0001, ++ 0x81C, 0x47CC0001, ++ 0x81C, 0x46CE0001, ++ 0x81C, 0x45D00001, ++ 0x81C, 0x44D20001, ++ 0x81C, 0x43D40001, ++ 0x81C, 0x42D60001, ++ 0x81C, 0x08D80001, ++ 0x81C, 0x07DA0001, ++ 0x81C, 0x06DC0001, ++ 0x81C, 0x05DE0001, ++ 0x81C, 0x04E00001, ++ 0x81C, 0x03E20001, ++ 0x81C, 0x02E40001, ++ 0x81C, 0x01E60001, ++ 0x81C, 0x01E80001, ++ 0x81C, 0x01EA0001, ++ 0x81C, 0x01EC0001, ++ 0x81C, 0x01EE0001, ++ 0x81C, 0x01F00001, ++ 0x81C, 0x01F20001, ++ 0x81C, 0x01F40001, ++ 0x81C, 0x01F60001, ++ 0x81C, 0x01F80001, ++ 0x81C, 0x01FA0001, ++ 0x81C, 0x01FC0001, ++ 0x81C, 0x01FE0001, ++ 0xFF0F07D8, 0xCDEF, ++ 0x81C, 0xFC800001, ++ 0x81C, 0xFB820001, ++ 0x81C, 0xFA840001, ++ 0x81C, 0xF9860001, ++ 0x81C, 0xF8880001, ++ 0x81C, 0xF78A0001, ++ 0x81C, 0xF68C0001, ++ 0x81C, 0xF58E0001, ++ 0x81C, 0xF4900001, ++ 0x81C, 0xF3920001, ++ 0x81C, 0xF2940001, ++ 0x81C, 0xF1960001, ++ 0x81C, 0xF0980001, ++ 0x81C, 0xEF9A0001, ++ 0x81C, 0xEE9C0001, ++ 0x81C, 0xED9E0001, ++ 0x81C, 0xECA00001, ++ 0x81C, 0xEBA20001, ++ 0x81C, 0xEAA40001, ++ 0x81C, 0xE9A60001, ++ 0x81C, 0xE8A80001, ++ 0x81C, 0xE7AA0001, ++ 0x81C, 0xE6AC0001, ++ 0x81C, 0xE5AE0001, ++ 0x81C, 0xE4B00001, ++ 0x81C, 0xE3B20001, ++ 0x81C, 0xA8B40001, ++ 0x81C, 0xA7B60001, ++ 0x81C, 0xA6B80001, ++ 0x81C, 0xA5BA0001, ++ 0x81C, 0xA4BC0001, ++ 0x81C, 0xA3BE0001, ++ 0x81C, 0xA2C00001, ++ 0x81C, 0xA1C20001, ++ 0x81C, 0x68C40001, ++ 0x81C, 0x67C60001, ++ 0x81C, 0x66C80001, ++ 0x81C, 0x65CA0001, ++ 0x81C, 0x47CC0001, ++ 0x81C, 0x46CE0001, ++ 0x81C, 0x45D00001, ++ 0x81C, 0x44D20001, ++ 0x81C, 0x43D40001, ++ 0x81C, 0x42D60001, ++ 0x81C, 0x08D80001, ++ 0x81C, 0x07DA0001, ++ 0x81C, 0x06DC0001, ++ 0x81C, 0x05DE0001, ++ 0x81C, 0x04E00001, ++ 0x81C, 0x03E20001, ++ 0x81C, 0x02E40001, ++ 0x81C, 0x01E60001, ++ 0x81C, 0x01E80001, ++ 0x81C, 0x01EA0001, ++ 0x81C, 0x01EC0001, ++ 0x81C, 0x01EE0001, ++ 0x81C, 0x01F00001, ++ 0x81C, 0x01F20001, ++ 0x81C, 0x01F40001, ++ 0x81C, 0x01F60001, ++ 0x81C, 0x01F80001, ++ 0x81C, 0x01FA0001, ++ 0x81C, 0x01FC0001, ++ 0x81C, 0x01FE0001, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x81C, 0xFF800001, ++ 0x81C, 0xFF820001, ++ 0x81C, 0xFF840001, ++ 0x81C, 0xFE860001, ++ 0x81C, 0xFD880001, ++ 0x81C, 0xFC8A0001, ++ 0x81C, 0xFB8C0001, ++ 0x81C, 0xFA8E0001, ++ 0x81C, 0xF9900001, ++ 0x81C, 0xF8920001, ++ 0x81C, 0xF7940001, ++ 0x81C, 0xF6960001, ++ 0x81C, 0xF5980001, ++ 0x81C, 0xF49A0001, ++ 0x81C, 0xF39C0001, ++ 0x81C, 0xF29E0001, ++ 0x81C, 0xF1A00001, ++ 0x81C, 0xF0A20001, ++ 0x81C, 0xEFA40001, ++ 0x81C, 0xEEA60001, ++ 0x81C, 0xEDA80001, ++ 0x81C, 0xECAA0001, ++ 0x81C, 0xEBAC0001, ++ 0x81C, 0xEAAE0001, ++ 0x81C, 0xE9B00001, ++ 0x81C, 0xE8B20001, ++ 0x81C, 0xE7B40001, ++ 0x81C, 0xE6B60001, ++ 0x81C, 0xE5B80001, ++ 0x81C, 0xE4BA0001, ++ 0x81C, 0xE3BC0001, ++ 0x81C, 0xA8BE0001, ++ 0x81C, 0xA7C00001, ++ 0x81C, 0xA6C20001, ++ 0x81C, 0xA5C40001, ++ 0x81C, 0xA4C60001, ++ 0x81C, 0xA3C80001, ++ 0x81C, 0xA2CA0001, ++ 0x81C, 0xA1CC0001, ++ 0x81C, 0x68CE0001, ++ 0x81C, 0x67D00001, ++ 0x81C, 0x66D20001, ++ 0x81C, 0x65D40001, ++ 0x81C, 0x47D60001, ++ 0x81C, 0x46D80001, ++ 0x81C, 0x45DA0001, ++ 0x81C, 0x44DC0001, ++ 0x81C, 0x43DE0001, ++ 0x81C, 0x42E00001, ++ 0x81C, 0x08E20001, ++ 0x81C, 0x07E40001, ++ 0x81C, 0x06E60001, ++ 0x81C, 0x05E80001, ++ 0x81C, 0x04EA0001, ++ 0x81C, 0x03EC0001, ++ 0x81C, 0x02EE0001, ++ 0x81C, 0x01F00001, ++ 0x81C, 0x01F20001, ++ 0x81C, 0x01F40001, ++ 0x81C, 0x01F60001, ++ 0x81C, 0x01F80001, ++ 0x81C, 0x01FA0001, ++ 0x81C, 0x01FC0001, ++ 0x81C, 0x01FE0001, ++ 0xFF0F0780, 0xDEAD, ++ ++}; ++ ++static void ++ODM_ReadAndConfig_TC_8812A_AGC_TAB( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_TC_8812A_AGC_TAB)/sizeof(u4Byte); ++ pu4Byte Array = Array_TC_8812A_AGC_TAB; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_AGC_TAB, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* AGC_TAB_DIFF.TXT ++******************************************************************************/ ++ ++static u4Byte Array_TC_8812A_AGC_TAB_DIFF_MB[] = { ++ 0x111, 0x47CE0003, ++ 0x81C, 0x46D00001, ++ 0x81C, 0x45D20001, ++ 0x81C, 0x44D40001, ++ 0x81C, 0x43D60001, ++ 0x81C, 0x42D80001, ++ 0x81C, 0x08DA0001, ++ 0x81C, 0x07DC0001, ++ 0x81C, 0x06DE0001, ++ 0x81C, 0x05E00001, ++ 0x81C, 0x04E20001, ++ 0x81C, 0x03E40001, ++ 0x222, 0x02E60001, ++}; ++ ++static u4Byte Array_TC_8812A_AGC_TAB_DIFF_HB[] = { ++ 0x333, 0x47CE0003, ++ 0x81C, 0x46D00001, ++ 0x81C, 0x45D20001, ++ 0x81C, 0x44D40001, ++ 0x81C, 0x43D60001, ++ 0x81C, 0x42D80001, ++ 0x81C, 0x08DA0001, ++ 0x81C, 0x07DC0001, ++ 0x81C, 0x06DE0001, ++ 0x81C, 0x05E00001, ++ 0x81C, 0x04E20001, ++ 0x81C, 0x03E40001, ++ 0x444, 0x02E60001, ++}; ++ ++static u4Byte Array_TC_8812A_AGC_TAB_DIFF_LB[] = { ++ 0x555, 0x08DA0001, ++ 0x81B, 0x07DC0001, ++ 0x81C, 0x06DE0001, ++ 0x666, 0x05E00001, ++ 0xFF0F07D8, 0xABCD, ++ 0x81C, 0xFF000001, ++ 0xFF0F0708, 0xCDEF, ++ 0x81C, 0xFF000002, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x81C, 0xFF000003, ++ 0xFF0F07D8, 0xDEAD, ++ 0x777, 0x08DA0001, ++ 0x81C, 0x07DC0001, ++ 0x81C, 0x06DE0001, ++ 0x888, 0x05E00001, ++}; ++ ++static void ++ODM_ReadAndConfig_TC_8812A_AGC_TAB_DIFF( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Array[], ++ u4Byte ArrayLen ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_AGC_TAB_DIFF, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* PHY_REG.TXT ++******************************************************************************/ ++ ++static u4Byte Array_TC_8812A_PHY_REG[] = { ++ 0x800, 0x8020D010, ++ 0x804, 0x080112E0, ++ 0x808, 0x0E028233, ++ 0x80C, 0x12131113, ++ 0x810, 0x20101263, ++ 0x814, 0x020C3D10, ++ 0x818, 0x03A00385, ++ 0x820, 0x00000000, ++ 0x824, 0x00030FE0, ++ 0x828, 0x00000000, ++ 0x82C, 0x002083DD, ++ 0x830, 0x2AAA6C86, ++ 0x834, 0x0037A706, ++ 0x838, 0x06C89B44, ++ 0x83C, 0x0000095B, ++ 0x840, 0xC0000001, ++ 0x844, 0x40003CDE, ++ 0x848, 0x6210FF8B, ++ 0x84C, 0x6CFDFFB8, ++ 0x850, 0x28874706, ++ 0x854, 0x0001520C, ++ 0x858, 0x8060E000, ++ 0x85C, 0x74210168, ++ 0x860, 0x6929C321, ++ 0x864, 0x796A7432, ++ 0x868, 0x8CA7A314, ++ 0x86C, 0x338C2878, ++ 0x870, 0x03333333, ++ 0x874, 0x31602C2E, ++ 0x878, 0x00003152, ++ 0x87C, 0x000FC000, ++ 0x8A0, 0x00000013, ++ 0x8A4, 0x7F7F7F7F, ++ 0x8A8, 0xA202033E, ++ 0x8AC, 0x0FF0FA0A, ++ 0x8B0, 0x00000600, ++ 0x8B4, 0x000FC080, ++ 0x8B8, 0x7C0057FF, ++ 0x8BC, 0x8CA520A3, ++ 0x8C0, 0x27F00020, ++ 0x8C4, 0x00000000, ++ 0x8C8, 0x00013169, ++ 0x8CC, 0x08248492, ++ 0x8D0, 0x0000B800, ++ 0x8DC, 0x00000000, ++ 0x8D4, 0x940008A0, ++ 0x8D8, 0x290B1612, ++ 0x8F8, 0x400002C0, ++ 0x8FC, 0x00000000, ++ 0xFF0F07D8, 0xABCD, ++ 0x900, 0x00000701, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x900, 0x00000700, ++ 0xFF0F07D8, 0xDEAD, ++ 0x90C, 0x00000000, ++ 0x910, 0x0000FC00, ++ 0x914, 0x00000404, ++ 0x918, 0x1C1028C0, ++ 0x91C, 0x64B11A1C, ++ 0x920, 0xE0767233, ++ 0x924, 0x055AA500, ++ 0x928, 0x00000004, ++ 0x92C, 0xFFFE0000, ++ 0x930, 0xFFFFFFFE, ++ 0x934, 0x001FFFFF, ++ 0x960, 0x00000000, ++ 0x964, 0x00000000, ++ 0x968, 0x00000000, ++ 0x96C, 0x00000000, ++ 0x970, 0x801FFFFF, ++ 0x978, 0x00000000, ++ 0x97C, 0x00000000, ++ 0x980, 0x00000000, ++ 0x984, 0x00000000, ++ 0x988, 0x00000000, ++ 0x9A4, 0x00000080, ++ 0x9A8, 0x00000000, ++ 0x9AC, 0x00000000, ++ 0x9B0, 0x01081008, ++ 0x9B4, 0x01081008, ++ 0x9B8, 0x01081008, ++ 0x9BC, 0x01081008, ++ 0x9D0, 0x00000000, ++ 0x9D4, 0x00000000, ++ 0x9D8, 0x00000000, ++ 0x9DC, 0x00000000, ++ 0x9E4, 0x00000002, ++ 0x9E8, 0x000002D4, ++ 0xA00, 0x00D047C8, ++ 0xA04, 0x01FF000C, ++ 0xA08, 0x8C8A8300, ++ 0xA0C, 0x2E7F000F, ++ 0xA10, 0x9500BB78, ++ 0xA14, 0x11144028, ++ 0xA18, 0x00881117, ++ 0xA1C, 0x89140F00, ++ 0xA20, 0x1A1B0000, ++ 0xA24, 0x090E1317, ++ 0xA28, 0x00000204, ++ 0xA2C, 0x00910000, ++ 0xA70, 0x101FFF00, ++ 0xA74, 0x00000008, ++ 0xA78, 0x00000900, ++ 0xA7C, 0x225B0606, ++ 0xA80, 0x218075B2, ++ 0xA84, 0x001F8C80, ++ 0xB00, 0x03100200, ++ 0xB04, 0x0000B000, ++ 0xB08, 0xAE0201EB, ++ 0xB0C, 0x01003207, ++ 0xB10, 0x00009807, ++ 0xB14, 0x01000000, ++ 0xB18, 0x00000002, ++ 0xB1C, 0x00000002, ++ 0xB20, 0x0000001F, ++ 0xB24, 0x03020100, ++ 0xB28, 0x07060504, ++ 0xB2C, 0x0B0A0908, ++ 0xB30, 0x0F0E0D0C, ++ 0xB34, 0x13121110, ++ 0xB38, 0x17161514, ++ 0xB3C, 0x0000003A, ++ 0xB40, 0x00000000, ++ 0xB44, 0x00000000, ++ 0xB48, 0x13000032, ++ 0xB4C, 0x48080000, ++ 0xB50, 0x00000000, ++ 0xB54, 0x00000000, ++ 0xB58, 0x00000000, ++ 0xB5C, 0x00000000, ++ 0xC00, 0x00000007, ++ 0xC04, 0x00042020, ++ 0xC08, 0x80410231, ++ 0xC0C, 0x00000000, ++ 0xC10, 0x00000100, ++ 0xC14, 0x01000000, ++ 0xC1C, 0x40000003, ++ 0xC20, 0x12121212, ++ 0xC24, 0x12121212, ++ 0xC28, 0x12121212, ++ 0xC2C, 0x12121212, ++ 0xC30, 0x12121212, ++ 0xC34, 0x12121212, ++ 0xC38, 0x12121212, ++ 0xC3C, 0x12121212, ++ 0xC40, 0x12121212, ++ 0xC44, 0x12121212, ++ 0xC48, 0x12121212, ++ 0xC4C, 0x12121212, ++ 0xC50, 0x00000020, ++ 0xC54, 0x001C1208, ++ 0xC58, 0x30000C1C, ++ 0xC5C, 0x00000058, ++ 0xC60, 0x34344443, ++ 0xC64, 0x07003333, ++ 0xC68, 0x59791979, ++ 0xC6C, 0x59795979, ++ 0xC70, 0x19795979, ++ 0xC74, 0x19795979, ++ 0xC78, 0x19791979, ++ 0xC7C, 0x19791979, ++ 0xC80, 0x19791979, ++ 0xC84, 0x19791979, ++ 0xC94, 0x0100005C, ++ 0xC98, 0x00000000, ++ 0xC9C, 0x00000000, ++ 0xCA0, 0x00000029, ++ 0xCA4, 0x08040201, ++ 0xCA8, 0x80402010, ++ 0xFF0F0740, 0xABCD, ++ 0xCB0, 0x77547717, ++ 0xFF0F07C0, 0xCDEF, ++ 0xCB0, 0x77547717, ++ 0xFF0F07D8, 0xCDEF, ++ 0xCB0, 0x54547710, ++ 0xCDCDCDCD, 0xCDCD, ++ 0xCB0, 0x77547777, ++ 0xFF0F0740, 0xDEAD, ++ 0xCB4, 0x00000077, ++ 0xCB8, 0x00508242, ++ 0xE00, 0x00000007, ++ 0xE04, 0x00042020, ++ 0xE08, 0x80410231, ++ 0xE0C, 0x00000000, ++ 0xE10, 0x00000100, ++ 0xE14, 0x01000000, ++ 0xE1C, 0x40000003, ++ 0xE20, 0x12121212, ++ 0xE24, 0x12121212, ++ 0xE28, 0x12121212, ++ 0xE2C, 0x12121212, ++ 0xE30, 0x12121212, ++ 0xE34, 0x12121212, ++ 0xE38, 0x12121212, ++ 0xE3C, 0x12121212, ++ 0xE40, 0x12121212, ++ 0xE44, 0x12121212, ++ 0xE48, 0x12121212, ++ 0xE4C, 0x12121212, ++ 0xE50, 0x00000020, ++ 0xE54, 0x001C1208, ++ 0xE58, 0x30000C1C, ++ 0xE5C, 0x00000058, ++ 0xE60, 0x34344443, ++ 0xE64, 0x07003333, ++ 0xE68, 0x59791979, ++ 0xE6C, 0x59795979, ++ 0xE70, 0x19795979, ++ 0xE74, 0x19795979, ++ 0xE78, 0x19791979, ++ 0xE7C, 0x19791979, ++ 0xE80, 0x19791979, ++ 0xE84, 0x19791979, ++ 0xE94, 0x0100005C, ++ 0xE98, 0x00000000, ++ 0xE9C, 0x00000000, ++ 0xEA0, 0x00000029, ++ 0xEA4, 0x08040201, ++ 0xEA8, 0x80402010, ++ 0xFF0F0740, 0xABCD, ++ 0xEB0, 0x77547717, ++ 0xFF0F07C0, 0xCDEF, ++ 0xEB0, 0x77547717, ++ 0xFF0F07D8, 0xCDEF, ++ 0xEB0, 0x54547710, ++ 0xCDCDCDCD, 0xCDCD, ++ 0xEB0, 0x77547777, ++ 0xFF0F0740, 0xDEAD, ++ 0xEB4, 0x00000077, ++ 0xEB8, 0x00508242, ++ ++}; ++ ++static void ++ODM_ReadAndConfig_TC_8812A_PHY_REG( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_TC_8812A_PHY_REG)/sizeof(u4Byte); ++ pu4Byte Array = Array_TC_8812A_PHY_REG; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_PHY_REG, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* PHY_REG_MP.TXT ++******************************************************************************/ ++ ++static u4Byte Array_TC_8812A_PHY_REG_MP[] = { ++ 0x800, 0x8020D410, ++ ++}; ++ ++static void ++ODM_ReadAndConfig_TC_8812A_PHY_REG_MP( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_TC_8812A_PHY_REG_MP)/sizeof(u4Byte); ++ pu4Byte Array = Array_TC_8812A_PHY_REG_MP; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_PHY_REG_MP, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* PHY_REG_PG.TXT ++******************************************************************************/ ++ ++static u4Byte Array_TC_8812A_PHY_REG_PG[] = { ++ 0xC20, 0x00000000, 0x34363840, ++ 0xC24, 0x00000000, 0x42424444, ++ 0xC28, 0x00000000, 0x30323638, ++ 0xC2C, 0x00000000, 0x40424444, ++ 0xC30, 0x00000000, 0x28303236, ++ 0xC34, 0x00000000, 0x38404242, ++ 0xC38, 0x00000000, 0x26283034, ++ 0xE20, 0x00000000, 0x34363840, ++ 0xE24, 0x00000000, 0x42424444, ++ 0xE28, 0x00000000, 0x30323638, ++ 0xE2C, 0x00000000, 0x40424444, ++ 0xE30, 0x00000000, 0x28303236, ++ 0xE34, 0x00000000, 0x38404242, ++ 0xE38, 0x00000000, 0x26283034, ++ 0xC24, 0x00000000, 0x42424444, ++ 0xC28, 0x00000000, 0x30323640, ++ 0xC2C, 0x00000000, 0x40424444, ++ 0xC30, 0x00000000, 0x28303236, ++ 0xC34, 0x00000000, 0x38404242, ++ 0xC38, 0x00000000, 0x26283034, ++ 0xC3C, 0x00000000, 0x40424444, ++ 0xC40, 0x00000000, 0x28303236, ++ 0xC44, 0x00000000, 0x42422426, ++ 0xC48, 0x00000000, 0x30343840, ++ 0xC4C, 0x00000000, 0x22242628, ++ 0xE24, 0x00000000, 0x42424444, ++ 0xE28, 0x00000000, 0x30323640, ++ 0xE2C, 0x00000000, 0x40424444, ++ 0xE30, 0x00000000, 0x28303236, ++ 0xE34, 0x00000000, 0x38404242, ++ 0xE38, 0x00000000, 0x26283034, ++ 0xE3C, 0x00000000, 0x40424444, ++ 0xE40, 0x00000000, 0x28303236, ++ 0xE44, 0x00000000, 0x42422426, ++ 0xE48, 0x00000000, 0x30343840, ++ 0xE4C, 0x00000000, 0x22242628, ++ ++}; ++ ++static void ++ODM_ReadAndConfig_TC_8812A_PHY_REG_PG( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_TC_8812A_PHY_REG_PG)/sizeof(u4Byte); ++ pu4Byte Array = Array_TC_8812A_PHY_REG_PG; ++ ++ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ for (i = 0; i < ArrayLen; i += 3 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ u4Byte v3 = Array[i+2]; ++ ++ // this line is a line of pure_body ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_PHY_REG_PG_8812A(pDM_Odm, v1, v2, v3); ++ continue; ++ } ++ else ++ { // this line is the start of branch ++ if ( !CheckCondition(Array[i], hex) ) ++ { // don't need the hw_body ++ i += 2; // skip the pair of expression ++ v1 = Array[i]; ++ v2 = Array[i+1]; ++ v3 = Array[i+2]; ++ while (v2 != 0xDEAD) ++ { ++ i += 3; ++ v1 = Array[i]; ++ v2 = Array[i+1]; ++ v3 = Array[i+1]; ++ } ++ } ++ } ++ } ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.h 2018-02-06 17:42:30.705967090 +0200 +@@ -0,0 +1,71 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#ifndef __INC_TC_BB_HW_IMG_8812A_H ++#define __INC_TC_BB_HW_IMG_8812A_H ++ ++static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); ++ ++/****************************************************************************** ++* AGC_TAB.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8812A_AGC_TAB( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* AGC_TAB_DIFF.TXT ++******************************************************************************/ ++ ++extern u4Byte Array_TC_8812A_AGC_TAB_DIFF_MB[26]; ++extern u4Byte Array_TC_8812A_AGC_TAB_DIFF_HB[26]; ++extern u4Byte Array_TC_8812A_AGC_TAB_DIFF_LB[32]; ++void ++ODM_ReadAndConfig_TC_8812A_AGC_TAB_DIFF( ++ IN PDM_ODM_T pDM_Odm, ++ IN u4Byte Array[], ++ IN u4Byte ArrayLen ++); ++ ++/****************************************************************************** ++* PHY_REG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8812A_PHY_REG( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* PHY_REG_MP.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8812A_PHY_REG_MP( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* PHY_REG_PG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8812A_PHY_REG_PG( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.c 2018-02-06 17:42:30.706967105 +0200 +@@ -0,0 +1,2552 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#include "odm_precomp.h" ++ ++static u1Byte Array_TC_8812A_FW_NIC[] = { ++0x01, 0x95, 0x10, 0x00, 0x0A, 0x00, 0x00, 0x00, 0x12, 0x11, 0x21, 0x12, 0x22, 0x54, 0x00, 0x00, ++0x39, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x02, 0x49, 0xCC, 0x02, 0x5C, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x5D, 0x75, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x67, 0xEF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x5C, 0xEC, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x67, 0x0C, 0x00, 0x00, ++0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, ++0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, ++0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, ++0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0A, ++0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, ++0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, ++0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, ++0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, ++0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, ++0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, ++0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, ++0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, ++0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, ++0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, ++0x30, 0x04, 0x04, 0x04, 0x05, 0x04, 0x04, 0x05, 0x07, 0x07, 0x07, 0x08, 0x0A, 0x02, 0x03, 0x04, ++0x04, 0x06, 0x0A, 0x0B, 0x0D, 0x03, 0x04, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, ++0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x01, 0x02, 0x03, ++0x06, 0x07, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x02, 0x03, 0x04, 0x07, 0x08, 0x0B, 0x0C, 0x0D, 0x0E, ++0x10, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, ++0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, 0x07, 0x09, 0x09, 0x0C, 0x0E, 0x10, ++0x12, 0x04, 0x04, 0x05, 0x05, 0x06, 0x0A, 0x11, 0x13, 0x07, 0x08, 0x09, 0x09, 0x0C, 0x0E, 0x11, ++0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, ++0x13, 0x04, 0x08, 0x09, 0x0A, 0x0C, 0x0E, 0x10, 0x12, 0x13, 0x14, 0x04, 0x08, 0x0A, 0x0C, 0x0E, ++0x10, 0x11, 0x13, 0x14, 0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x09, ++0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, 0x25, 0x27, 0x28, 0x00, 0x00, 0x00, ++0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, ++0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, ++0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, ++0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, ++0x04, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00, ++0x18, 0x00, 0x00, 0x00, 0x24, 0x00, 0x00, 0x00, 0x30, 0x00, 0x00, 0x00, 0x48, 0x00, 0x00, 0x00, ++0x60, 0x00, 0x00, 0x00, 0x90, 0x00, 0x00, 0x00, 0xC0, 0x00, 0x00, 0x00, 0xD8, 0x00, 0x00, 0x00, ++0x50, 0x00, 0x00, 0x00, 0x78, 0x00, 0x00, 0x00, 0xA0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, ++0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0x30, 0x00, 0x00, 0x00, ++0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, ++0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, ++0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, ++0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, ++0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, ++0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, ++0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, ++0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x0C, ++0x80, 0x00, 0x00, 0x0F, 0xA0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, ++0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x07, ++0xD0, 0x00, 0x00, 0x0B, 0xB8, 0x00, 0x00, 0x0F, 0xA0, 0x00, 0x00, 0x17, 0x70, 0x00, 0x00, 0x00, ++0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, ++0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, ++0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, ++0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, ++0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x02, 0x00, ++0x02, 0x00, 0x04, 0x00, 0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, ++0x48, 0x00, 0x60, 0x00, 0x6C, 0x00, 0x28, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x64, 0x00, 0xA0, 0x00, ++0xC8, 0x00, 0xF0, 0x01, 0x18, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, ++0x58, 0x03, 0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, ++0x58, 0x03, 0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, ++0x58, 0x03, 0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, ++0x58, 0x03, 0x20, 0x03, 0xE8, 0x06, 0x40, 0x07, 0xD0, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, ++0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0xE8, 0x05, 0xDC, 0x07, 0xD0, 0x0B, 0xB8, 0x00, 0x64, 0x00, ++0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, ++0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, ++0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x02, 0x04, 0x06, 0x08, 0x0A, 0x0C, 0x10, 0x18, 0x20, 0x30, 0x40, ++0x50, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, 0x05, 0x02, 0x03, 0x03, ++0x04, 0x04, 0x05, 0x05, 0x06, 0x03, 0x03, 0x04, 0x04, 0x05, 0x06, 0x06, 0x07, 0x05, 0x06, 0x06, ++0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x01, 0x01, 0x02, ++0x02, 0x04, 0x04, 0x05, 0x05, 0x06, 0x07, 0x02, 0x02, 0x03, 0x03, 0x05, 0x05, 0x06, 0x06, 0x08, ++0x09, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, ++0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, ++0x08, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x05, 0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, ++0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, ++0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, ++0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, ++0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x20, 0x1E, 0x1C, 0x18, 0x10, 0x18, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x45, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, ++0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, ++0xEC, 0x24, 0x89, 0xF8, 0xE6, 0xBC, 0x03, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, ++0x40, 0xCE, 0x79, 0x04, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, ++0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, ++0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x04, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, ++0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x88, 0x25, 0x0C, 0xF8, ++0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x03, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, ++0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, ++0x0C, 0x24, 0x89, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x03, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, ++0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x88, ++0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, ++0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, ++0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x88, 0xA6, ++0x81, 0x74, 0x03, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x04, 0xE4, 0x78, 0x80, ++0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4A, 0x65, 0x74, 0x01, 0x93, ++0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, ++0x8C, 0xD2, 0xAF, 0x22, 0x03, 0xEF, 0xD3, 0x94, 0x03, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, ++0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, ++0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x88, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, ++0xBE, 0x03, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, ++0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, ++0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x88, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, ++0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, ++0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x88, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, ++0x04, 0x90, 0x4A, 0x65, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, ++0x94, 0x03, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, ++0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x88, 0x2F, ++0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x45, 0x4D, 0x50, 0x2E, 0x74, 0x89, 0x2F, 0xF8, 0xE6, 0xBF, 0x03, ++0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x88, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, ++0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, ++0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x89, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, ++0x0F, 0x74, 0x88, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, ++0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, ++0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x03, 0x40, 0x03, 0x7F, 0xFF, 0x22, ++0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, ++0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x45, 0x4C, 0x8F, 0xF0, ++0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, ++0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, 0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, ++0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, ++0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, ++0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x45, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, ++0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, ++0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, 0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, ++0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, ++0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, ++0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, ++0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, 0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, ++0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, 0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, ++0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, ++0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, ++0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, ++0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, 0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, ++0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, ++0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, 0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, ++0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, ++0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, ++0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x47, 0xF9, 0x73, 0xC5, ++0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, 0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, ++0x83, 0xE0, 0x38, 0xF0, 0x22, 0xBB, 0x01, 0x0A, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, ++0xE0, 0x22, 0x50, 0x06, 0x87, 0xF0, 0x09, 0xE7, 0x19, 0x22, 0xBB, 0xFE, 0x07, 0xE3, 0xF5, 0xF0, ++0x09, 0xE3, 0x19, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0x74, 0x01, 0x93, 0x22, ++0xBB, 0x01, 0x10, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0xE0, 0xF5, 0xF0, ++0xA3, 0xE0, 0x22, 0x50, 0x09, 0xE9, 0x25, 0x82, 0xF8, 0x86, 0xF0, 0x08, 0xE6, 0x22, 0xBB, 0xFE, ++0x0A, 0xE9, 0x25, 0x82, 0xF8, 0xE2, 0xF5, 0xF0, 0x08, 0xE2, 0x22, 0xE5, 0x83, 0x2A, 0xF5, 0x83, ++0xE9, 0x93, 0xF5, 0xF0, 0xA3, 0xE9, 0x93, 0x22, 0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, ++0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, ++0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xEB, ++0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, 0xE8, 0x9C, 0x45, 0xF0, 0x22, ++0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE4, 0x93, 0xFC, 0x74, ++0x01, 0x93, 0xFD, 0x74, 0x02, 0x93, 0xFE, 0x74, 0x03, 0x93, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, ++0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE4, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF9, 0x74, ++0x02, 0x93, 0xFA, 0x74, 0x03, 0x93, 0xFB, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, ++0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, ++0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, ++0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, ++0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x02, 0x4A, 0x0A, 0x02, ++0x45, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, ++0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, ++0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, ++0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x4A, 0x4F, 0xE4, 0x7E, 0x01, ++0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, ++0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, ++0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, ++0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0x00, ++0x41, 0xA5, 0x86, 0x00, 0x41, 0xA5, 0x87, 0x00, 0x41, 0xA5, 0x88, 0x00, 0x42, 0xA5, 0x97, 0x00, ++0x00, 0x41, 0xA5, 0x9C, 0x00, 0x4B, 0x71, 0x4F, 0xF7, 0x58, 0x17, 0x59, 0x61, 0x90, 0x00, 0xF0, ++0xE0, 0x7F, 0x01, 0x20, 0xE2, 0x02, 0x7F, 0x03, 0x22, 0x51, 0x6D, 0x90, 0xA3, 0x14, 0xEF, 0xF0, ++0x51, 0x8B, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x02, 0x35, 0x95, 0x71, 0x10, 0x71, 0x40, 0x51, ++0xAD, 0x51, 0xCC, 0x51, 0xEB, 0xE4, 0xF5, 0x51, 0x75, 0x52, 0x58, 0xAB, 0x51, 0x7D, 0x02, 0x7F, ++0x01, 0x12, 0x39, 0x04, 0xAB, 0x52, 0x7D, 0x03, 0x7F, 0x01, 0x02, 0x39, 0x04, 0x75, 0x5D, 0x12, ++0xE4, 0xF5, 0x5E, 0x75, 0x5F, 0x07, 0x75, 0x60, 0x72, 0x90, 0x01, 0x30, 0xE5, 0x5D, 0xF0, 0xA3, ++0xE5, 0x5E, 0xF0, 0xA3, 0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, 0xF0, 0x22, 0x75, 0x65, 0x0E, 0x75, ++0x66, 0x01, 0x75, 0x67, 0x03, 0x75, 0x68, 0x62, 0x90, 0x01, 0x38, 0xE5, 0x65, 0xF0, 0xA3, 0xE5, ++0x66, 0xF0, 0xA3, 0xE5, 0x67, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x22, 0xE4, 0xF5, 0x55, 0xF5, 0x56, ++0xF5, 0x57, 0xF5, 0x58, 0xAD, 0x55, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xAD, 0x56, 0x7F, 0x51, 0x12, ++0x3A, 0x96, 0xAD, 0x57, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xAD, 0x58, 0x7F, 0x53, 0x02, 0x3A, 0x96, ++0x90, 0x01, 0x30, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x38, 0xF0, 0xA3, ++0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x51, 0x12, ++0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x53, 0x02, 0x3A, 0x96, ++0x90, 0x01, 0x34, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x3C, 0xF0, ++0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x55, ++0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x3A, ++0x96, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, 0x71, 0xFA, 0x12, ++0x3A, 0xB8, 0xF1, 0xC7, 0x7F, 0x01, 0x12, 0x46, 0x15, 0x90, 0xA4, 0x52, 0x74, 0x02, 0xF0, 0xFF, ++0x12, 0x46, 0x15, 0x90, 0xA4, 0x52, 0xE0, 0x04, 0xF0, 0x7F, 0x03, 0x12, 0x46, 0x15, 0x90, 0xA4, ++0x52, 0xE0, 0x04, 0xF0, 0x51, 0x79, 0x71, 0xC3, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, ++0x80, 0x12, 0x3A, 0x96, 0x75, 0x28, 0xFF, 0x71, 0xEB, 0x12, 0x6F, 0xE9, 0x91, 0x02, 0xE4, 0xFF, ++0x02, 0x46, 0x9E, 0x71, 0xE5, 0x71, 0xF2, 0x12, 0x7A, 0x9E, 0x12, 0x8D, 0xAD, 0x12, 0x91, 0xEC, ++0x91, 0x0C, 0x90, 0xA4, 0x56, 0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, ++0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xE4, 0x90, 0xA3, 0xB6, 0xF0, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, ++0x85, 0x22, 0xE4, 0x90, 0xA3, 0xB0, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, ++0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x0A, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0xA4, 0x53, 0xE0, ++0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0x71, 0xD2, ++0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0xA4, 0x56, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, ++0xC3, 0x13, 0x30, 0xE0, 0x14, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x57, 0xF0, 0x90, ++0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x58, 0xF0, 0x22, 0x90, 0xA4, 0x8D, 0x31, 0x9D, 0xEF, ++0x31, 0xA6, 0x4C, 0x7A, 0x00, 0x4C, 0x82, 0x01, 0x4C, 0x8A, 0x03, 0x4C, 0x91, 0x04, 0x4C, 0x98, ++0x20, 0x4C, 0xA0, 0x21, 0x4C, 0xA8, 0x23, 0x4C, 0xAF, 0x25, 0x4C, 0xB6, 0x40, 0x4C, 0xC4, 0x42, ++0x4C, 0xCC, 0x43, 0x4C, 0xD4, 0x87, 0x00, 0x00, 0x4C, 0xDB, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0x02, ++0x68, 0x20, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0x02, 0x55, 0xAC, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0xE1, ++0xA7, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0x80, 0x86, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0x02, 0x68, 0x68, ++0x90, 0xA4, 0x8D, 0x31, 0x94, 0x02, 0x69, 0x54, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0xE1, 0x8F, 0x90, ++0xA4, 0x8D, 0x31, 0x94, 0xE1, 0x97, 0x90, 0xA4, 0x74, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x8D, 0x31, ++0x94, 0x02, 0x8B, 0x5E, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0x02, 0x8C, 0x5D, 0x90, 0xA4, 0x8D, 0x31, ++0x94, 0x12, 0x6A, 0x04, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0x80, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, ++0x01, 0xF0, 0x22, 0x90, 0xA4, 0x90, 0x31, 0x9D, 0x12, 0x26, 0x1E, 0xFF, 0xB1, 0x14, 0x90, 0xA4, ++0x93, 0x74, 0x10, 0xF0, 0x90, 0xA4, 0xA1, 0x74, 0x07, 0xF0, 0x90, 0xA4, 0x90, 0x31, 0x94, 0x12, ++0x26, 0x1E, 0x90, 0xA4, 0x95, 0xF0, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x93, 0x12, 0x69, 0x9A, 0x7F, ++0x03, 0x02, 0x47, 0x27, 0x90, 0xA4, 0xA2, 0xEF, 0xF0, 0x12, 0x8F, 0xAE, 0x90, 0xA4, 0xA2, 0xE0, ++0xC3, 0x94, 0x0E, 0x50, 0x44, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, ++0xA4, 0xAC, 0x12, 0x27, 0x54, 0x12, 0xD4, 0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0xF1, 0x4C, 0x90, ++0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0xE4, 0xFC, ++0xFD, 0xFE, 0xD1, 0xD2, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0xA4, ++0xA2, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0xC1, 0xC1, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x24, ++0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x30, 0x50, 0x16, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x1F, ++0xFE, 0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x09, 0x28, 0x00, 0x00, 0x80, 0x70, 0x90, ++0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x32, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x40, 0x50, 0x16, 0x90, ++0xA4, 0xA8, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x08, ++0xA6, 0x00, 0x00, 0x80, 0x4A, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x1B, ++0xEF, 0x94, 0x74, 0x50, 0x16, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, ++0xA4, 0xAC, 0x12, 0x27, 0x54, 0x08, 0xA4, 0x00, 0x00, 0x80, 0x24, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, ++0x74, 0x76, 0xD3, 0x9F, 0x50, 0x1F, 0xEF, 0x94, 0xA5, 0x50, 0x1A, 0x90, 0xA4, 0xA8, 0x12, 0x27, ++0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x08, 0x24, 0x00, 0x00, 0x7F, ++0x60, 0x7E, 0x08, 0xF1, 0x4C, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, 0x37, ++0xEF, 0x94, 0x40, 0x50, 0x32, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, ++0xA4, 0xA2, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0x74, 0x01, 0xFE, 0x0D, 0x14, 0xD1, 0xD2, 0x90, 0xA4, ++0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, ++0x74, 0x01, 0xFE, 0x0D, 0x14, 0x80, 0x7A, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, ++0x50, 0x37, 0xEF, 0x94, 0x8C, 0x50, 0x32, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, ++0xFF, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0xE4, 0xFC, 0x74, 0x01, 0xFE, 0x74, 0x03, 0xD1, 0xD0, 0x90, ++0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0xE4, 0xFC, ++0x74, 0x01, 0xFE, 0x74, 0x03, 0xFD, 0xE4, 0x80, 0x38, 0x90, 0xA4, 0xA2, 0xE0, 0xFB, 0x74, 0x8C, ++0xC3, 0x9B, 0x50, 0x3B, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0xAF, 0x03, ++0xE4, 0xFC, 0x74, 0x01, 0xFE, 0x74, 0x05, 0xD1, 0xD0, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, ++0x07, 0x03, 0xFF, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0xE4, 0xFC, 0x74, 0x01, 0xFE, 0x74, 0x05, 0xFD, ++0xE4, 0x90, 0xA4, 0xAA, 0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0xD1, 0xDE, 0x22, ++0xFD, 0xE4, 0x90, 0xA4, 0xAA, 0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x90, 0xA4, ++0xA4, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA4, 0xA3, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, ++0x3A, 0xA9, 0x90, 0xA4, 0xAE, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xA6, 0x31, 0x50, 0x12, 0x27, 0x15, ++0x90, 0xA4, 0xAE, 0x31, 0x6C, 0x31, 0x25, 0x90, 0xA4, 0xAA, 0x31, 0x6C, 0x31, 0x32, 0x90, 0xA4, ++0xB2, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xA4, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0xA4, 0xB2, 0x31, ++0x50, 0x90, 0xAC, 0x96, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xA3, 0xE0, 0xFF, 0xD0, 0x05, 0x02, 0x39, ++0xBA, 0x90, 0xA5, 0x9B, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0xFF, 0xAE, 0xF0, 0xEE, 0x33, 0x95, 0xE0, ++0xFD, 0xFC, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x48, 0x7F, 0xAC, 0x7E, 0x08, 0x90, 0xA4, 0xA6, 0xEE, ++0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x36, 0xCE, 0x90, 0xA4, 0xB0, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xA8, ++0x31, 0x50, 0x12, 0x27, 0x15, 0x90, 0xA4, 0xB0, 0x31, 0x6C, 0x31, 0x25, 0x90, 0xA4, 0xAC, 0x31, ++0x6C, 0x31, 0x32, 0x90, 0xA4, 0xB4, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xB4, 0x31, 0x50, 0x90, 0xAC, ++0xB9, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xA6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x02, 0x37, 0x5D, 0x12, ++0x26, 0x1E, 0x90, 0xA4, 0x43, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0xA4, 0x51, 0xF0, 0x90, 0xA4, ++0x51, 0xE0, 0x90, 0x01, 0xE7, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0xA4, ++0x53, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, 0x00, 0x01, 0x12, ++0x26, 0x37, 0x90, 0xA4, 0x54, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, ++0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, ++0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, ++0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0xA4, 0x7E, 0xF0, 0x90, 0xA4, 0x7E, 0xE0, ++0x64, 0x01, 0xF0, 0x24, 0xF7, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x4F, 0xA3, 0xF0, 0x12, 0x3A, 0xEB, ++0xBF, 0x01, 0x03, 0x12, 0x31, 0x69, 0x90, 0xA4, 0x3C, 0xE0, 0xFF, 0x90, 0xA4, 0x3B, 0xE0, 0x6F, ++0x60, 0x02, 0x11, 0x44, 0x12, 0x70, 0x3F, 0xBF, 0x01, 0x03, 0x12, 0x7A, 0x5B, 0x90, 0xA4, 0x3C, ++0xE0, 0x90, 0x01, 0xBC, 0xF0, 0x90, 0xA3, 0xB6, 0xE0, 0x90, 0x01, 0xBD, 0xF0, 0xB1, 0x3F, 0x12, ++0x45, 0x4D, 0x80, 0xB8, 0x90, 0xA4, 0x3B, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x04, 0x7D, 0x01, 0x7F, ++0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x99, 0xED, 0xF0, 0x90, 0xA4, 0x3C, ++0xE0, 0x90, 0xA5, 0x9A, 0xF0, 0x90, 0xA4, 0x36, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, ++0xE0, 0x02, 0x21, 0xA2, 0xEE, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x02, 0x21, 0xA2, ++0x90, 0xA5, 0x9A, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x21, 0xA2, 0xEF, 0x70, 0x02, 0x21, 0x19, 0x24, ++0xFE, 0x70, 0x02, 0x21, 0x52, 0x24, 0xFE, 0x60, 0x48, 0x24, 0xFC, 0x70, 0x02, 0x21, 0x8D, 0x24, ++0xFC, 0x60, 0x02, 0x21, 0xA2, 0xEE, 0xB4, 0x0E, 0x02, 0x51, 0x22, 0x90, 0xA5, 0x9A, 0xE0, 0x70, ++0x04, 0x7F, 0x01, 0x51, 0x4A, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x06, 0x02, 0x31, 0xFC, 0x90, 0xA5, ++0x9A, 0xE0, 0xB4, 0x04, 0x0E, 0x90, 0xA5, 0x99, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x76, 0xB1, 0x80, ++0x02, 0xB1, 0x99, 0x90, 0xA5, 0x9A, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x21, 0xA2, 0x71, 0x0B, 0x21, ++0xA2, 0x90, 0xA5, 0x9A, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x51, 0x4A, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, ++0x06, 0x02, 0x31, 0xFC, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x0E, 0x07, 0x31, 0xA7, 0xBF, 0x01, 0x02, ++0x51, 0x22, 0x90, 0xA5, 0x9A, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x21, 0xA2, 0x31, 0xA7, 0xEF, 0x64, ++0x01, 0x60, 0x02, 0x21, 0xA2, 0x51, 0x63, 0x21, 0xA2, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x0E, 0x07, ++0x31, 0xA7, 0xBF, 0x01, 0x02, 0x51, 0x22, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x06, 0x02, 0x31, 0xFC, ++0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x0C, 0x07, 0x31, 0xA7, 0xBF, 0x01, 0x02, 0x51, 0x63, 0x90, 0xA5, ++0x9A, 0xE0, 0x64, 0x04, 0x70, 0x5C, 0x12, 0x92, 0xB0, 0xEF, 0x64, 0x01, 0x70, 0x54, 0xB1, 0x23, ++0x80, 0x50, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x0E, 0x07, 0x31, 0xA7, 0xBF, 0x01, 0x02, 0x51, 0x22, ++0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x06, 0x02, 0x31, 0xFC, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x0C, 0x07, ++0x31, 0xA7, 0xBF, 0x01, 0x02, 0x51, 0x63, 0x90, 0xA5, 0x9A, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x51, ++0x4A, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x04, 0x1A, 0x12, 0x93, 0x30, 0x80, 0x15, 0x90, 0xA5, 0x9A, ++0xE0, 0xB4, 0x0C, 0x0E, 0x90, 0xA4, 0x37, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x02, ++0x71, 0x02, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF1, 0xD1, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, ++0xB8, 0x74, 0x01, 0xF0, 0x80, 0x3D, 0x90, 0xA4, 0x36, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, ++0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x28, 0xEF, 0xC4, 0x54, 0x0F, 0x30, ++0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x19, 0x90, 0xA4, 0x3B, 0xE0, 0xD3, 0x94, ++0x04, 0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, ++0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0xA4, 0x37, 0xE0, ++0x90, 0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA4, 0x3C, 0x74, 0x04, 0xF0, ++0x80, 0x0A, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA4, 0x3C, 0x74, 0x0C, 0xF0, 0x90, 0x05, 0x22, 0xE4, ++0xF0, 0x22, 0x90, 0xA4, 0x37, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0x90, 0xA4, 0x3C, 0x74, 0x0C, ++0xF0, 0x80, 0x11, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA4, ++0x3C, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0xA5, 0x9D, 0xEF, 0xF0, 0x71, ++0x14, 0x90, 0xA5, 0x9D, 0xE0, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x3C, 0x74, ++0x04, 0xF0, 0x22, 0x90, 0xA3, 0xB6, 0xE0, 0x64, 0x01, 0x70, 0x2E, 0x90, 0xA4, 0x37, 0xE0, 0x54, ++0xFD, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x7F, 0x01, 0x12, 0x71, 0x5C, 0xBF, 0x01, 0x0E, ++0x90, 0xA4, 0x36, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA4, 0x3C, 0x74, 0x0E, 0xF0, 0x22, 0x90, 0x01, ++0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x64, 0x01, ++0x70, 0x5F, 0x90, 0xA4, 0x38, 0xE0, 0x54, 0x0F, 0x60, 0x4F, 0x90, 0xA4, 0x3C, 0xE0, 0x70, 0x03, ++0xFF, 0x51, 0x4A, 0x90, 0xA4, 0x3C, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xB1, 0x99, 0x90, 0x01, 0x5B, ++0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xF1, 0xD1, 0xEF, 0x64, 0x01, 0x70, 0x32, 0xF5, ++0x3B, 0x90, 0xA4, 0x4C, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, ++0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5B, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x01, ++0xF0, 0x90, 0xA4, 0x36, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0xA4, 0x3C, 0xE0, 0x70, 0x02, 0x11, ++0x4D, 0x22, 0x91, 0x4E, 0x90, 0xA4, 0x3C, 0x74, 0x08, 0xF0, 0x22, 0x71, 0x14, 0x90, 0xA4, 0x3C, ++0x74, 0x0C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x46, 0x12, 0x49, ++0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xA4, ++0x46, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, ++0x5D, 0x90, 0x00, 0x10, 0xE0, 0x44, 0x0C, 0xFD, 0x7F, 0x10, 0x12, 0x3A, 0x96, 0x90, 0x00, 0x72, ++0xE0, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x3A, 0x96, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, ++0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, ++0x86, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xBF, 0xFF, 0xEC, 0x90, 0xA5, ++0x67, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x67, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, ++0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, ++0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0xA5, 0x67, 0x12, 0x27, 0x48, ++0x90, 0xA5, 0x67, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, ++0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, ++0xA5, 0x67, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x67, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, ++0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0xFF, 0xE0, 0x70, 0x28, 0x7B, 0x01, ++0x7A, 0xA5, 0x79, 0x6B, 0x91, 0x1B, 0x90, 0xA5, 0x6B, 0xE0, 0x54, 0xE7, 0xFB, 0x7F, 0x01, 0x12, ++0x79, 0x2A, 0x7B, 0x01, 0x7F, 0x01, 0x91, 0x1F, 0x90, 0xA5, 0x6B, 0xE0, 0x54, 0x18, 0x70, 0x06, ++0x90, 0x01, 0xBF, 0xE0, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x08, 0x7F, 0x01, 0xEF, ++0x70, 0x04, 0x7E, 0x01, 0x80, 0x07, 0xEF, 0x64, 0x01, 0x70, 0x19, 0x7E, 0x40, 0x90, 0x00, 0xE2, ++0xED, 0xF0, 0xA3, 0xEE, 0xF0, 0x90, 0x00, 0xE1, 0xE0, 0x12, 0x26, 0x64, 0x90, 0x00, 0xE3, 0xE4, ++0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0x12, 0x76, ++0xF2, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA5, 0x6D, ++0x12, 0x27, 0x48, 0x90, 0xA5, 0x6D, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, ++0x00, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, ++0xFF, 0xEC, 0x90, 0xA5, 0x6D, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x6D, 0x12, 0x49, 0x50, 0x90, 0xAC, ++0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x54, ++0xFE, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0xA5, ++0x6D, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x6D, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, ++0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, ++0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x36, 0xCE, ++0x90, 0xA4, 0x46, 0x12, 0x27, 0x48, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, ++0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, ++0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0xFF, 0xE0, 0x70, 0x14, 0x7B, 0x01, ++0x7A, 0xA5, 0x79, 0x6C, 0x91, 0x1B, 0x90, 0xA5, 0x6C, 0xE0, 0x44, 0x18, 0xFB, 0x7F, 0x01, 0x12, ++0x79, 0x2A, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0x12, 0x76, 0xF2, 0x90, 0x01, 0x37, 0x74, ++0x02, 0xF0, 0xFD, 0x7F, 0x03, 0xD1, 0x51, 0x91, 0x4E, 0xE4, 0x90, 0xA4, 0x3C, 0xF0, 0x22, 0x12, ++0x8D, 0x7B, 0x12, 0x8C, 0xBA, 0x12, 0x6B, 0x4C, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, ++0xFF, 0x90, 0xA5, 0x42, 0xF0, 0x90, 0x01, 0xC7, 0xE0, 0x64, 0xAD, 0x70, 0x37, 0xF0, 0x90, 0xA5, ++0x4F, 0x74, 0x0F, 0xF0, 0x90, 0xA5, 0x41, 0x74, 0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0xA5, ++0x42, 0xE0, 0x2F, 0xFE, 0x74, 0x43, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xEE, 0xF0, ++0x0F, 0xEF, 0xB4, 0x0F, 0xE9, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, ++0x41, 0x12, 0x5A, 0x46, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, ++0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x3C, 0x74, 0x0C, 0xF0, 0x22, 0x90, 0xA4, 0x90, 0x12, ++0x49, 0x9D, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xFE, 0x12, 0x26, 0x1E, 0xFD, 0xC3, 0x13, ++0x30, 0xE0, 0x12, 0x90, 0xA4, 0x90, 0x12, 0x49, 0x94, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, ++0xA4, 0x94, 0xF0, 0x80, 0x05, 0x90, 0xA4, 0x94, 0xEF, 0xF0, 0x90, 0xA4, 0x93, 0xEE, 0xF0, 0x90, ++0xA4, 0x94, 0xE0, 0xFE, 0x90, 0xA4, 0x93, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x3A, 0x90, 0xA4, 0x90, ++0x12, 0x49, 0x94, 0x12, 0x26, 0x1E, 0x54, 0x01, 0xFE, 0x74, 0xB6, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0xA3, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0xB6, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, ++0x70, 0x05, 0x12, 0x6B, 0x0D, 0x80, 0x08, 0x90, 0xA4, 0x93, 0xE0, 0xFF, 0x12, 0x6A, 0xFC, 0x90, ++0xA4, 0x93, 0xE0, 0x04, 0xF0, 0x80, 0xB8, 0x90, 0xA3, 0xB6, 0xE0, 0x70, 0x23, 0x90, 0xA4, 0x3C, ++0xE0, 0x70, 0x03, 0xFF, 0x51, 0x4A, 0x90, 0xA4, 0x3C, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xB1, 0x99, ++0x90, 0xA4, 0x36, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, ++0x22, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, ++0x7D, 0x78, 0xFF, 0xD1, 0x51, 0x7D, 0x02, 0x7F, 0x03, 0xD1, 0x51, 0x90, 0x06, 0x0A, 0xE0, 0x44, ++0x07, 0xF0, 0x90, 0xA4, 0x44, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0xA3, 0xB6, 0xE0, 0xB4, ++0x01, 0x14, 0x90, 0xA4, 0x37, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA4, 0x3C, 0xE0, 0x20, 0xE2, 0x0D, ++0x7D, 0x01, 0x7F, 0x04, 0x01, 0x51, 0x90, 0xA4, 0x37, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xEF, 0x70, ++0x36, 0x7D, 0x78, 0x7F, 0x02, 0xD1, 0xF3, 0x7D, 0x02, 0x7F, 0x03, 0xD1, 0xF3, 0x7D, 0xC8, 0x7F, ++0x02, 0x12, 0x8C, 0xA2, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x7D, ++0x01, 0x7F, 0x0C, 0x11, 0x51, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x90, ++0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0xC1, 0x66, 0x7D, 0x02, 0x7F, 0x02, 0xD1, 0xF3, 0x7D, ++0x01, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x30, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0xA4, 0x3C, 0xE0, 0x64, ++0x02, 0x60, 0x28, 0xF1, 0x3C, 0x90, 0xA4, 0x37, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, ++0x14, 0x90, 0xA4, 0x3F, 0xE0, 0xFF, 0xA3, 0xE0, 0x6F, 0x70, 0x0A, 0xF1, 0xF3, 0xD1, 0xE9, 0x90, ++0xA4, 0x40, 0xE0, 0x14, 0xF0, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA3, 0xB6, 0xE0, ++0x64, 0x01, 0x60, 0x02, 0xE1, 0xD0, 0x90, 0xA4, 0x39, 0xE0, 0x70, 0x02, 0xE1, 0xD0, 0x90, 0xA4, ++0x38, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0xA4, 0x40, ++0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0xA4, 0x3F, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0xA4, ++0x3F, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0xA4, 0x40, 0xEF, 0xF0, 0x90, 0xA4, 0x37, 0xE0, 0x44, ++0x04, 0xF0, 0xE4, 0x90, 0xA4, 0x42, 0xF0, 0x90, 0xA4, 0x44, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, ++0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA4, 0x3D, 0xE0, 0x54, ++0xFD, 0xF0, 0x54, 0xEF, 0xF0, 0x90, 0xA4, 0x38, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, ++0x02, 0x80, 0x03, 0x12, 0x75, 0x9B, 0x90, 0xA4, 0x37, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, ++0xE0, 0x0E, 0x90, 0xA4, 0x3F, 0xE0, 0xFF, 0xA3, 0xE0, 0xB5, 0x07, 0x04, 0xF1, 0xF3, 0xD1, 0xEF, ++0x22, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, ++0x07, 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x02, ++0x51, 0x9A, 0x22, 0xEF, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, ++0x7F, 0x03, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x47, 0x4E, ++0x90, 0xA4, 0x82, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0xA4, 0x73, 0xE0, 0x04, 0xF0, 0x11, 0x31, 0x80, ++0xE6, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0xA4, ++0x83, 0xF0, 0x90, 0xA4, 0x83, 0xE0, 0xFD, 0x70, 0x02, 0x21, 0x5C, 0x90, 0xA5, 0x86, 0xE0, 0xFF, ++0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, ++0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x21, 0x55, 0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, ++0xD0, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0x84, 0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, 0xA4, 0x75, ++0x42, 0x84, 0x75, 0x43, 0x01, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x85, 0x12, 0x34, 0x2C, 0x90, 0xA5, ++0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD1, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0x86, 0xF0, ++0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD2, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, ++0x87, 0xF0, 0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD3, 0x12, 0x49, 0x88, 0xE0, ++0x90, 0xA4, 0x88, 0xF0, 0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF0, 0x12, 0x49, ++0x88, 0xE0, 0x90, 0xA4, 0x89, 0xF0, 0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF1, ++0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0x8A, 0xF0, 0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, ++0x01, 0xF2, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0x8B, 0xF0, 0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, ++0x04, 0x90, 0x01, 0xF3, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0x8C, 0xF0, 0x90, 0xA4, 0x83, 0xE0, ++0xFF, 0x90, 0xA5, 0x86, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, ++0xFC, 0xF4, 0x5F, 0x90, 0xA4, 0x83, 0xF0, 0x90, 0xA5, 0x86, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, ++0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0xA4, 0x85, 0xE0, 0xFF, ++0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x86, 0x12, 0x4C, 0x4A, 0x90, 0xA5, 0x86, 0xE0, 0x04, 0xF0, 0xE0, ++0x54, 0x03, 0xF0, 0x01, 0x42, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x47, 0x4E, 0x90, 0xA4, 0xB8, 0xEF, 0xF0, 0x60, ++0xF0, 0x31, 0x75, 0x80, 0xEC, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA3, ++0xB1, 0xE0, 0xFE, 0x90, 0xA3, 0xB0, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, ++0x00, 0xEE, 0x64, 0x01, 0x60, 0x48, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x13, 0xED, 0x75, 0xF0, 0x0F, ++0xA4, 0x24, 0x1A, 0xF9, 0x74, 0xA3, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x31, 0xE3, 0x7F, 0x01, 0x90, ++0xA3, 0xB0, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x1A, 0xF9, 0x74, 0xA3, 0x35, 0xF0, 0xFA, 0x7B, ++0x01, 0x51, 0x46, 0x7F, 0x01, 0xEF, 0x60, 0x16, 0x90, 0xA3, 0xB0, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, ++0x0A, 0x02, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA3, 0xB0, 0xF0, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xB9, 0x12, 0x49, 0x9D, ++0x90, 0xA5, 0x88, 0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, 0x7F, 0xAF, ++0x7E, 0x01, 0x51, 0xB9, 0xEF, 0x60, 0x3A, 0x90, 0xA4, 0xB9, 0x12, 0x49, 0x94, 0x8B, 0x40, 0x8A, ++0x41, 0x89, 0x42, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xF5, 0x43, 0x7B, 0x01, 0x7A, ++0x01, 0x79, 0xA0, 0x12, 0x34, 0x2C, 0x90, 0xA4, 0xB9, 0x12, 0x49, 0x94, 0x90, 0x00, 0x0E, 0x12, ++0x26, 0x37, 0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, ++0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x7E, ++0x12, 0x49, 0x9D, 0x7F, 0x96, 0x7E, 0x02, 0x51, 0xB9, 0xEF, 0x60, 0x58, 0x90, 0x01, 0x17, 0xE0, ++0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, ++0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0xA5, 0x81, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, ++0xA5, 0x81, 0xE0, 0xFD, 0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA5, 0x7E, 0x12, 0x49, ++0x94, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0x71, 0x0F, 0x90, ++0xA5, 0x81, 0xE0, 0x24, 0x18, 0xFF, 0x90, 0xA5, 0x7E, 0x12, 0x49, 0x94, 0x71, 0x6A, 0x90, 0x02, ++0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x90, 0xA5, 0x76, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xA5, 0x76, ++0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, 0x2D, 0xC3, 0x90, 0xA5, 0x79, 0xE0, ++0x94, 0xE8, 0x90, 0xA5, 0x78, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, ++0xF0, 0x7F, 0x00, 0x80, 0x15, 0x90, 0xA5, 0x78, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x48, 0x9F, 0x7F, ++0x0A, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x80, 0xC5, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, ++0xFC, 0xED, 0x2C, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE4, 0xF0, 0x0C, 0xEC, ++0xB4, 0x18, 0xEE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0xEE, ++0x54, 0x3F, 0xFF, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, ++0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, ++0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA5, 0x7A, 0xEF, 0xF0, 0xA3, ++0x12, 0x49, 0x9D, 0x90, 0xA5, 0x87, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, ++0x76, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, ++0x01, 0x90, 0xA5, 0x7B, 0x12, 0x49, 0x94, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, ++0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0xA5, 0x7A, 0xE0, 0x24, 0x02, 0xF9, ++0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x49, 0x94, ++0xE9, 0x24, 0x02, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0xA5, 0x7B, 0x12, ++0x49, 0x94, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, ++0x02, 0x34, 0x2C, 0x90, 0xA5, 0x5B, 0xEF, 0xF0, 0xAB, 0x05, 0x7E, 0x00, 0x7D, 0x00, 0x7C, 0x00, ++0xE4, 0x90, 0xA5, 0x60, 0xF0, 0xEB, 0xFF, 0xE4, 0x90, 0xA5, 0x5C, 0x12, 0x27, 0x48, 0x90, 0xA5, ++0x5C, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, ++0x5D, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA5, 0x5B, 0xE0, 0x75, 0xF0, 0x08, 0xA4, ++0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0xAF, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x36, ++0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x71, ++0xE3, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, ++0x05, 0x90, 0xA5, 0x63, 0x12, 0x49, 0x50, 0x90, 0xAC, 0x9C, 0x12, 0x27, 0x48, 0xD0, 0x05, 0xD0, ++0x07, 0x12, 0x32, 0x65, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, ++0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, ++0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x69, 0xF0, 0x74, 0x5C, 0xA3, 0xF0, ++0x91, 0xB8, 0x74, 0x69, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x5C, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, ++0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, ++0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x53, 0xE4, 0xFD, ++0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x51, 0x52, 0x53, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x54, 0x7D, ++0x01, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x52, 0x52, 0x54, 0xAB, 0x53, 0xE4, 0xFD, 0x7F, 0x01, ++0x12, 0x39, 0x04, 0xAB, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x02, 0x39, 0x04, 0xC0, 0xE0, 0xC0, 0xF0, ++0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, ++0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xEC, 0xF0, 0x74, ++0x5C, 0xA3, 0xF0, 0xB1, 0x3B, 0x74, 0xEC, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x5C, 0xA3, 0xF0, ++0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, ++0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x00, 0x54, 0xE0, 0x55, ++0x55, 0xF5, 0x59, 0xA3, 0xE0, 0x55, 0x56, 0xF5, 0x5A, 0xA3, 0xE0, 0x55, 0x57, 0xF5, 0x5B, 0xA3, ++0xE0, 0x55, 0x58, 0xF5, 0x5C, 0xAD, 0x59, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0xAD, 0x5A, 0x7F, 0x55, ++0x12, 0x3A, 0x96, 0xAD, 0x5B, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0xAD, 0x5C, 0x7F, 0x57, 0x12, 0x3A, ++0x96, 0x53, 0x91, 0xEF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, ++0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, ++0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x75, 0xF0, 0x74, 0x5D, 0xA3, 0xF0, 0x12, 0x70, 0x6A, 0xE5, ++0x61, 0x30, 0xE1, 0x02, 0xD1, 0xE1, 0xE5, 0x61, 0x30, 0xE4, 0x05, 0x7F, 0x02, 0x12, 0x47, 0x27, ++0xE5, 0x63, 0x30, 0xE0, 0x02, 0xD1, 0x2B, 0xE5, 0x63, 0x30, 0xE1, 0x03, 0x12, 0x70, 0xC7, 0xE5, ++0x63, 0x30, 0xE2, 0x03, 0x12, 0x57, 0x0B, 0xE5, 0x63, 0x30, 0xE3, 0x03, 0x12, 0x77, 0x3A, 0xE5, ++0x63, 0x30, 0xE4, 0x03, 0x12, 0x77, 0x6D, 0xE5, 0x63, 0x30, 0xE5, 0x03, 0x12, 0x75, 0x36, 0xE5, ++0x63, 0x30, 0xE6, 0x03, 0x12, 0x77, 0x9C, 0xE5, 0x64, 0x30, 0xE1, 0x03, 0x12, 0x57, 0xEA, 0xE5, ++0x64, 0x30, 0xE4, 0x03, 0x12, 0x74, 0xF3, 0xE5, 0x64, 0x30, 0xE5, 0x02, 0xF1, 0x67, 0xE5, 0x64, ++0x30, 0xE6, 0x02, 0xD1, 0xB8, 0x74, 0x75, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x5D, 0xA3, 0xF0, ++0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, ++0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, 0xFF, 0x90, 0xA4, 0x39, ++0xE0, 0x70, 0x02, 0xC1, 0xB7, 0x90, 0xA3, 0xB6, 0xE0, 0x64, 0x01, 0x70, 0x7A, 0x90, 0xA4, 0x38, ++0xE0, 0xC4, 0x54, 0x0F, 0x60, 0x24, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1F, 0x90, 0xA4, 0x40, ++0xE0, 0x14, 0xF0, 0xE0, 0xFE, 0x60, 0x06, 0x90, 0xA4, 0x42, 0xE0, 0x60, 0x0F, 0xEE, 0x70, 0x06, ++0x90, 0xA4, 0x3F, 0xE0, 0xA3, 0xF0, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x48, 0x90, ++0xA4, 0x3D, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA4, 0x42, 0xE0, 0x60, 0x03, 0xB4, 0x01, 0x09, 0xE4, ++0xF5, 0x3B, 0x90, 0xA4, 0x42, 0xE0, 0x80, 0x0D, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x42, 0xE0, 0x75, ++0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0xA4, 0x41, 0xE0, 0x2F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, ++0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x3C, ++0xE0, 0x20, 0xE2, 0x03, 0x12, 0x50, 0x4D, 0x22, 0x90, 0x07, 0x1F, 0xE0, 0x54, 0x7F, 0xF0, 0x90, ++0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, 0xA4, 0xBE, 0xF0, 0x90, 0xA4, 0xBC, 0x74, 0x02, 0xF0, 0x90, ++0xA4, 0xCA, 0x14, 0xF0, 0xFB, 0x7A, 0xA4, 0x79, 0xBC, 0x12, 0x69, 0x9A, 0x7F, 0x03, 0x02, 0x47, ++0x27, 0xE4, 0xFF, 0x90, 0xA4, 0xBC, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, 0x11, 0xA3, 0xE0, ++0xF5, 0x12, 0x65, 0x11, 0x60, 0x70, 0x90, 0xA4, 0xBD, 0x74, 0x03, 0xF0, 0x90, 0xA4, 0xCB, 0x74, ++0x08, 0xF0, 0xE5, 0x12, 0x04, 0x54, 0x0F, 0xF5, 0x13, 0xE4, 0xF5, 0x10, 0xE5, 0x13, 0x75, 0xF0, ++0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x10, 0xF5, ++0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0xBF, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, ++0xA4, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x10, 0xE5, 0x10, 0xB4, 0x08, 0xD0, 0x7B, 0x01, 0x7A, 0xA4, ++0x79, 0xBD, 0x12, 0x69, 0x9A, 0xE5, 0x12, 0x04, 0x54, 0x0F, 0xF5, 0x12, 0xB4, 0x0F, 0x03, 0xE4, ++0xF5, 0x12, 0x90, 0x04, 0x7F, 0xE5, 0x12, 0xF0, 0x90, 0xA4, 0xBC, 0xE0, 0x7F, 0x03, 0x70, 0x03, ++0x02, 0x47, 0x27, 0x12, 0x47, 0x27, 0x22, 0x90, 0xA4, 0x70, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x10, ++0x90, 0x04, 0x30, 0xE0, 0xB4, 0x01, 0x06, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0x74, 0xB6, 0x25, ++0x10, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, 0x60, 0x6E, 0xE5, 0x10, ++0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0xE5, 0x10, 0x54, 0x07, 0xFE, 0x74, 0x81, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFD, 0xAF, 0x06, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, ++0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x03, 0x02, 0x60, ++0x6E, 0x75, 0xF0, 0x10, 0xE5, 0x10, 0x90, 0x81, 0x01, 0x12, 0x49, 0x88, 0xE0, 0x20, 0xE7, 0x02, ++0x80, 0x10, 0x75, 0xF0, 0x10, 0xE5, 0x10, 0x90, 0x81, 0x02, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x20, ++0xE7, 0x0A, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x20, 0xF0, 0x02, 0x60, 0x6E, 0xEF, 0x30, 0xE6, 0x25, ++0x90, 0xA4, 0x6D, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, ++0x88, 0xE0, 0xFD, 0x75, 0xF0, 0x09, 0xE5, 0x10, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xE0, 0xF5, ++0x23, 0xE4, 0xFB, 0x80, 0x55, 0x90, 0xA4, 0x6E, 0xE0, 0x04, 0xF0, 0x74, 0x94, 0x25, 0x10, 0xF5, ++0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x74, 0x94, 0x25, 0x10, 0xF5, 0x82, 0xE4, ++0x34, 0xA1, 0xF5, 0x83, 0xE0, 0xD3, 0x94, 0x03, 0x40, 0x13, 0xAF, 0x10, 0x11, 0x7B, 0x74, 0x94, ++0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x21, 0x75, 0xF0, 0x10, ++0xE5, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE0, 0xFD, 0x75, 0xF0, 0x09, 0xE5, 0x10, 0x90, ++0x95, 0x96, 0x12, 0x49, 0x88, 0xE0, 0xF5, 0x23, 0x7B, 0x01, 0xAF, 0x10, 0x31, 0x84, 0x05, 0x10, ++0xE5, 0x10, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x5F, 0x70, 0x22, 0xAD, 0x07, 0x90, 0x01, 0xC4, ++0x74, 0x7B, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0x74, 0x94, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, ++0x83, 0xE0, 0x64, 0x13, 0x70, 0x6E, 0x74, 0x14, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, ++0xE0, 0x04, 0xF0, 0x74, 0x14, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0xC3, 0x94, ++0x03, 0x40, 0x51, 0x74, 0x14, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE4, 0xF0, 0x74, ++0x93, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x91, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x93, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, ++0x83, 0xE0, 0x24, 0x1E, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x02, 0xC3, 0x33, 0xCE, 0x33, 0xCE, ++0xD8, 0xF9, 0xFF, 0xED, 0x25, 0xE0, 0x24, 0x14, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xEE, ++0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, 0x81, 0x05, 0x12, 0x49, 0x88, 0xE0, 0x54, ++0x03, 0xFE, 0x75, 0xF0, 0x09, 0xED, 0x90, 0x95, 0x93, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x74, 0x94, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0x54, 0x7F, 0xF5, 0x11, 0xB4, 0x2C, 0x1B, ++0x75, 0xF0, 0x09, 0xED, 0x90, 0x95, 0x97, 0x12, 0x49, 0x88, 0xE0, 0x6E, 0x60, 0x0D, 0x1E, 0x75, ++0xF0, 0x09, 0xED, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0xE5, 0x11, 0xD3, 0x9F, 0x40, ++0x02, 0x8F, 0x11, 0xAF, 0x05, 0x8E, 0x23, 0xE4, 0xFB, 0xAD, 0x11, 0x31, 0x84, 0xAF, 0x11, 0x22, ++0xF5, 0x26, 0x74, 0x14, 0x25, 0x24, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE5, 0x26, 0xF0, ++0x75, 0xF0, 0x09, 0xE5, 0x24, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xE0, 0xF5, 0x23, 0xE4, 0xFB, ++0xAD, 0x26, 0xAF, 0x24, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x20, 0x8D, 0x21, 0xE5, ++0x20, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA5, 0x82, 0xF0, 0xE5, 0x20, 0x54, 0x07, 0x90, 0xA5, ++0x84, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x01, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA5, 0x85, ++0xF0, 0xE5, 0x21, 0xB4, 0x3F, 0x11, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x98, 0x12, 0x49, 0x88, ++0xE0, 0xB4, 0x01, 0x03, 0x75, 0x21, 0xBE, 0xE5, 0x21, 0x54, 0x7F, 0x90, 0xA5, 0x83, 0xF0, 0x75, ++0xF0, 0x09, 0xE5, 0x20, 0x90, 0x95, 0x99, 0x12, 0x49, 0x88, 0xE0, 0x70, 0x40, 0x90, 0xA5, 0x83, ++0xE0, 0xFF, 0xC3, 0x94, 0x14, 0x40, 0x0D, 0xEF, 0xD3, 0x94, 0x16, 0x50, 0x07, 0x90, 0x04, 0x33, ++0x74, 0x08, 0x80, 0x36, 0xEF, 0xC3, 0x94, 0x17, 0x40, 0x15, 0xEF, 0xD3, 0x94, 0x18, 0x50, 0x0F, ++0x90, 0x04, 0x33, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x0A, 0x41, 0x98, 0x90, ++0x04, 0x33, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0xA3, 0x04, 0x80, 0x7B, 0x90, 0xA5, 0x83, ++0xE0, 0xFF, 0xB4, 0x36, 0x0D, 0x90, 0x04, 0x33, 0x74, 0x09, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, ++0x80, 0x66, 0xEF, 0xC3, 0x94, 0x37, 0x40, 0x14, 0xEF, 0xD3, 0x94, 0x38, 0x50, 0x0E, 0x90, 0x04, ++0x33, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xA3, 0x04, 0x80, 0x4C, 0xEF, 0xB4, 0x39, 0x0F, ++0x90, 0x04, 0x33, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x0B, 0x80, 0x39, 0xEF, ++0xB4, 0x3A, 0x12, 0x90, 0x04, 0x33, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0x04, 0xF0, ++0xA3, 0x74, 0x0C, 0x80, 0x26, 0xEF, 0x90, 0x04, 0x33, 0xB4, 0x3B, 0x13, 0x74, 0x01, 0xF0, 0xA3, ++0x74, 0x03, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x74, 0x0D, 0xF0, 0x80, 0x10, 0x74, ++0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xEB, ++0x70, 0x3F, 0x90, 0x04, 0x30, 0xE0, 0x70, 0x06, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0x90, 0xA5, ++0x82, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, ++0xFF, 0x90, 0xA5, 0x84, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, ++0xFC, 0xF4, 0x5F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA5, 0x85, 0xE0, 0x54, 0x7F, 0xF0, 0x80, ++0x70, 0x90, 0x04, 0x30, 0xE0, 0x70, 0x19, 0x74, 0x13, 0x25, 0x20, 0xF5, 0x82, 0xE4, 0x34, 0x9B, ++0xF5, 0x83, 0xE0, 0x90, 0x04, 0xCF, 0xB4, 0x01, 0x05, 0x74, 0x20, 0xF0, 0x80, 0x02, 0xE4, 0xF0, ++0x90, 0xA5, 0x82, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xC0, 0x83, 0xC0, ++0x82, 0xE0, 0xFF, 0x90, 0xA5, 0x84, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, ++0x33, 0xD8, 0xFC, 0x4F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x20, 0x90, 0x81, ++0x01, 0x12, 0x49, 0x88, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0xA5, 0x85, 0xF0, 0x90, 0xA5, 0x83, 0xE0, ++0x90, 0x44, 0x31, 0x93, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x4F, 0x90, 0xA5, 0x85, 0xF0, 0x44, 0x80, ++0xF0, 0x90, 0xA5, 0x83, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x7D, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, ++0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, 0x04, 0xEB, 0x90, ++0x42, 0x2D, 0x12, 0x49, 0x88, 0x12, 0x49, 0x78, 0x12, 0x49, 0x18, 0x78, 0x01, 0x12, 0x27, 0x22, ++0xE5, 0x20, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x20, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x21, 0xF0, ++0x90, 0xA5, 0x85, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x20, 0x90, 0x81, 0x01, 0x12, 0x49, 0x88, ++0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x20, 0x90, 0x81, 0x05, 0x12, 0x49, 0x88, 0xE0, 0x54, 0xFC, ++0x45, 0x23, 0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x20, 0x90, 0x81, 0x05, 0x12, 0x49, 0x88, 0xEF, 0xF0, ++0x7D, 0x01, 0xAF, 0x20, 0xD1, 0x7F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x8F, 0x24, 0x90, 0xA4, 0x72, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, ++0x95, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA5, 0x73, 0xF0, 0x12, 0x49, 0xA6, 0x64, 0x2D, 0x00, 0x64, ++0x2D, 0x01, 0x64, 0x2D, 0x02, 0x64, 0x2D, 0x03, 0x64, 0x2D, 0x04, 0x64, 0x2D, 0x05, 0x64, 0x2D, ++0x06, 0x64, 0x2D, 0x07, 0x64, 0x2D, 0x08, 0x64, 0x8F, 0x09, 0x64, 0x95, 0x0A, 0x64, 0x9B, 0x0B, ++0x64, 0xA1, 0x0C, 0x64, 0xA7, 0x0D, 0x64, 0xAD, 0x0E, 0x00, 0x00, 0x64, 0xB6, 0xE4, 0xF5, 0x25, ++0x75, 0xF0, 0x08, 0xE5, 0x24, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x25, 0x25, 0xF5, ++0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA5, 0x73, 0xE0, 0x75, 0xF0, 0x07, 0xA4, ++0x24, 0x50, 0xF5, 0x82, 0xE4, 0x34, 0x40, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x25, 0xF5, 0x82, 0xE4, ++0x35, 0x83, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0xEF, 0x5E, 0xFF, 0x90, 0xA5, 0x75, 0xF0, 0x75, 0xF0, ++0x08, 0xE5, 0x24, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x25, 0x25, 0xF5, 0x82, 0xE4, ++0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x25, 0xE5, 0x25, 0xB4, 0x07, 0xA3, 0x80, 0x27, 0xAD, ++0x24, 0x7F, 0x44, 0x80, 0x1C, 0xAD, 0x24, 0x7F, 0x4C, 0x80, 0x16, 0xAD, 0x24, 0x7F, 0x8C, 0x80, ++0x10, 0xAD, 0x24, 0x7F, 0x94, 0x80, 0x0A, 0xAD, 0x24, 0x7F, 0x9C, 0x80, 0x04, 0xAD, 0x24, 0x7F, ++0xA4, 0x7E, 0x04, 0x12, 0x7C, 0xA7, 0x75, 0xF0, 0x09, 0xE5, 0x24, 0x90, 0x95, 0x99, 0x12, 0x49, ++0x88, 0xE0, 0xFD, 0xE4, 0x90, 0xA5, 0x71, 0xF0, 0x7C, 0x06, 0x75, 0xF0, 0x08, 0xE5, 0x24, 0x90, ++0x89, 0x00, 0xBC, 0x06, 0x12, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, ++0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x80, 0x0E, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, ++0x35, 0x83, 0xF5, 0x83, 0xE0, 0x90, 0xA5, 0x74, 0xF0, 0x90, 0xA5, 0x74, 0xE0, 0x60, 0x64, 0x75, ++0x25, 0x07, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x25, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, ++0xD8, 0xF9, 0xFF, 0x90, 0xA5, 0x74, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x3E, 0xEC, 0x75, 0xF0, 0x08, ++0xA4, 0x25, 0x25, 0x90, 0xA5, 0x71, 0xF0, 0xBD, 0x01, 0x0C, 0xE0, 0xD3, 0x94, 0x0B, 0x40, 0x06, ++0xE0, 0x24, 0x20, 0xF0, 0x80, 0x39, 0xBD, 0x02, 0x0F, 0x90, 0xA5, 0x71, 0xE0, 0xD3, 0x94, 0x1B, ++0x40, 0x06, 0xE0, 0x24, 0x18, 0xF0, 0x80, 0x27, 0xBD, 0x03, 0x24, 0x90, 0xA5, 0x71, 0xE0, 0xD3, ++0x94, 0x1B, 0x40, 0x1B, 0xE0, 0x24, 0x22, 0xF0, 0x80, 0x15, 0x15, 0x25, 0xE5, 0x25, 0xC3, 0x94, ++0x00, 0x50, 0x9F, 0xEC, 0x60, 0x09, 0x1C, 0xEC, 0xC3, 0x94, 0x00, 0x40, 0x02, 0x81, 0xCA, 0xE4, ++0x90, 0xA5, 0x72, 0xF0, 0xFC, 0x75, 0xF0, 0x08, 0xE5, 0x24, 0x90, 0x89, 0x00, 0xBC, 0x06, 0x12, ++0x12, 0x49, 0x88, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x54, 0x0F, ++0x80, 0x0E, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, ++0x90, 0xA5, 0x74, 0xF0, 0x90, 0xA5, 0x74, 0xE0, 0x60, 0x63, 0xE4, 0xF5, 0x25, 0x74, 0x01, 0x7E, ++0x00, 0xA8, 0x25, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0xA5, ++0x74, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x3E, 0xEC, 0x75, 0xF0, 0x08, 0xA4, 0x25, 0x25, 0x90, 0xA5, ++0x72, 0xF0, 0xBD, 0x01, 0x0C, 0xE0, 0xD3, 0x94, 0x0B, 0x40, 0x06, 0xE0, 0x24, 0x20, 0xF0, 0x80, ++0x34, 0xBD, 0x02, 0x0F, 0x90, 0xA5, 0x72, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x06, 0xE0, 0x24, 0x18, ++0xF0, 0x80, 0x22, 0xBD, 0x03, 0x1F, 0x90, 0xA5, 0x72, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x16, 0xE0, ++0x24, 0x22, 0xF0, 0x80, 0x10, 0x05, 0x25, 0xE5, 0x25, 0x64, 0x08, 0x70, 0xA0, 0x0C, 0xEC, 0x64, ++0x07, 0x60, 0x02, 0xA1, 0x75, 0x90, 0xA5, 0x71, 0xE0, 0xFF, 0x75, 0xF0, 0x09, 0xE5, 0x24, 0x90, ++0x95, 0x93, 0x12, 0x49, 0x88, 0xEF, 0xF0, 0x90, 0xA5, 0x72, 0xE0, 0xFE, 0x75, 0xF0, 0x09, 0xE5, ++0x24, 0x90, 0x95, 0x94, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, ++0x00, 0x12, 0x49, 0x88, 0xE0, 0xFE, 0x54, 0x7F, 0xF5, 0x26, 0xEE, 0x54, 0x80, 0xF5, 0x27, 0xE5, ++0x26, 0xD3, 0x9F, 0x40, 0x08, 0x90, 0xA5, 0x71, 0xE0, 0x45, 0x27, 0x31, 0x60, 0x90, 0xA5, 0x72, ++0xE0, 0xFF, 0xE5, 0x26, 0xC3, 0x9F, 0x50, 0x05, 0xE5, 0x27, 0x4F, 0x31, 0x60, 0x75, 0xF0, 0x10, ++0xE5, 0x24, 0x90, 0x81, 0x03, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x62, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x01, ++0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x03, 0x12, 0x49, ++0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x05, 0x12, 0x49, 0x88, 0xE4, ++0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x07, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, ++0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x09, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, ++0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, ++0x93, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x90, ++0x81, 0x03, 0x12, 0x49, 0x88, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0x75, 0xF0, 0x10, 0xEF, 0x90, ++0x81, 0x03, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, ++0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, ++0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x0C, 0xF0, 0x74, ++0x67, 0xA3, 0xF0, 0x12, 0x70, 0x97, 0xE5, 0x69, 0x30, 0xE1, 0x02, 0xF1, 0x9C, 0xE5, 0x69, 0x30, ++0xE2, 0x03, 0x12, 0x77, 0xB8, 0xE5, 0x69, 0x30, 0xE3, 0x03, 0x12, 0x77, 0xF4, 0xE5, 0x6A, 0x30, ++0xE0, 0x03, 0x12, 0x78, 0x30, 0xE5, 0x6C, 0x30, 0xE1, 0x05, 0x7F, 0x03, 0x12, 0x47, 0x27, 0xE5, ++0x6C, 0x30, 0xE4, 0x02, 0xF1, 0xA6, 0xE5, 0x6C, 0x30, 0xE5, 0x03, 0x12, 0x76, 0x3B, 0xE5, 0x6C, ++0x30, 0xE6, 0x03, 0x12, 0x76, 0x73, 0x74, 0x0C, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x67, 0xA3, ++0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0xA4, 0x39, 0xE0, ++0x60, 0x03, 0x12, 0x93, 0x84, 0x22, 0x12, 0x93, 0x44, 0x90, 0xA4, 0x3F, 0xE0, 0x14, 0x90, 0x05, ++0x73, 0xF0, 0x7D, 0x02, 0x7F, 0x02, 0x12, 0x56, 0x51, 0x90, 0xA4, 0x53, 0xE0, 0x30, 0xE0, 0x2E, ++0x90, 0xA3, 0xB6, 0xE0, 0xB4, 0x01, 0x27, 0x90, 0xA5, 0x9C, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, ++0x0B, 0x90, 0xA4, 0x55, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0xA5, 0x9C, 0xF0, 0x90, 0xA4, 0x55, 0xE0, ++0xFF, 0x90, 0xA4, 0x54, 0xE0, 0xB5, 0x07, 0x06, 0xE4, 0xA3, 0xF0, 0x12, 0x71, 0x5A, 0x22, 0xC0, ++0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0xEF, ++0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x67, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, ++0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, ++0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0xA3, 0x15, ++0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA3, 0x16, 0xF0, 0x90, 0x00, ++0x02, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA3, 0x17, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, ++0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA3, 0x18, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, 0xAE, ++0x05, 0xED, 0x2F, 0x90, 0xA3, 0x19, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x7F, 0x90, 0xA4, ++0x39, 0xF0, 0xEF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xA3, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, ++0x37, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0xA4, 0x38, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, ++0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0xA4, 0x36, 0xE0, 0x54, ++0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0x90, 0xA4, 0x38, 0xE0, 0x54, 0x0F, ++0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x3B, 0xF0, 0x11, 0xE3, 0x90, 0x01, ++0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0xF0, 0x90, 0xA4, 0x39, 0xE0, 0x90, 0x01, 0xBA, 0xF0, ++0x90, 0xA4, 0x3B, 0xE0, 0x90, 0x01, 0xBB, 0xF0, 0x90, 0xA4, 0x38, 0xE0, 0x54, 0x0F, 0x90, 0x01, ++0xBE, 0xF0, 0x22, 0x90, 0xA4, 0x90, 0x12, 0x49, 0x9D, 0x31, 0x12, 0x90, 0xA4, 0x39, 0xE0, 0xFF, ++0x12, 0x56, 0xAE, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x18, 0x90, 0xA4, 0x90, 0x12, 0x49, 0x94, 0x90, ++0x00, 0x01, 0x12, 0x26, 0x37, 0x54, 0x0F, 0xFF, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x31, ++0x23, 0x22, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA4, 0x42, 0xF0, 0x90, 0xA4, ++0x3D, 0xF0, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0C, 0x04, 0x70, 0x28, 0x90, 0xA4, 0x3F, 0x74, 0x01, ++0xF0, 0xA3, 0xF0, 0x22, 0xED, 0x70, 0x0A, 0x90, 0xA4, 0x4D, 0xE0, 0x90, 0xA4, 0x3F, 0xF0, 0x80, ++0x05, 0x90, 0xA4, 0x3F, 0xED, 0xF0, 0x90, 0xA4, 0x3F, 0xE0, 0xA3, 0xF0, 0x90, 0xA4, 0x37, 0xE0, ++0x44, 0x08, 0xF0, 0x22, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x30, 0xE0, 0x26, 0x12, 0x26, ++0x1E, 0x90, 0xA4, 0x4A, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x4B, 0xF0, 0xEF, ++0x54, 0xFE, 0xFF, 0xA3, 0xE0, 0x54, 0x01, 0x4F, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x90, ++0xA4, 0x4D, 0xF0, 0x22, 0x90, 0xA4, 0x4A, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x07, 0xF0, 0xA3, 0xE0, ++0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0xA3, 0xB0, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, ++0xFF, 0x90, 0xA3, 0xB1, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, ++0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x35, 0xC0, 0x01, 0x90, 0xA3, 0xB1, 0xE0, ++0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x1A, 0xF9, 0x74, 0xA3, 0x35, 0xF0, 0xA8, 0x01, 0xFC, 0x7D, 0x01, ++0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x48, 0x79, 0x90, 0xA3, 0xB1, 0xE0, 0x04, 0xF0, 0xE0, ++0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA3, 0xB1, 0xF0, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0x12, 0x26, 0x1E, 0xFD, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFC, 0xED, ++0xC3, 0x94, 0x80, 0x90, 0xA4, 0x92, 0xED, 0x50, 0x3F, 0xF0, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, ++0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA4, 0x93, 0xF0, 0xEE, 0xA3, 0xF0, ++0xED, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, ++0x90, 0xA4, 0x95, 0xF0, 0xEE, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, 0x81, 0x00, 0x12, 0x49, ++0x88, 0xE0, 0x90, 0xA4, 0x97, 0xF0, 0x80, 0x01, 0xF0, 0xEC, 0xC3, 0x94, 0x80, 0x90, 0xA4, 0x98, ++0xEC, 0x50, 0x3F, 0xF0, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, ++0xFE, 0xA3, 0xE0, 0x90, 0xA4, 0x99, 0xF0, 0xEE, 0xA3, 0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x94, 0xF5, ++0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA4, 0x9B, 0xF0, 0xEE, 0xA3, ++0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0x9D, 0xF0, ++0x80, 0x01, 0xF0, 0x90, 0xA4, 0x90, 0x74, 0x04, 0xF0, 0x90, 0xA4, 0x9E, 0x74, 0x0C, 0xF0, 0xED, ++0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEC, ++0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, ++0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEC, ++0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x7B, ++0x01, 0x7A, 0xA4, 0x79, 0x90, 0x31, 0x9A, 0x7F, 0x03, 0x02, 0x47, 0x27, 0x8F, 0x0F, 0x75, 0xF0, ++0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x49, 0x88, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x8F, 0x0F, 0x75, ++0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x49, 0x88, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x12, 0x49, ++0x88, 0xE0, 0xFB, 0x0D, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, ++0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, ++0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0xA5, 0x8A, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x20, 0xE6, 0x02, 0xE1, ++0x1C, 0x90, 0x00, 0x8D, 0xE0, 0x90, 0xA5, 0x89, 0xF0, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0xA5, 0x8A, ++0xF0, 0x90, 0xA5, 0x89, 0xE0, 0x12, 0x49, 0xA6, 0x6B, 0x94, 0x01, 0x6B, 0x9E, 0x02, 0x6B, 0xA7, ++0x03, 0x6B, 0xB0, 0x04, 0x6C, 0x93, 0x05, 0x6D, 0x8C, 0x06, 0x6E, 0x11, 0x07, 0x6E, 0x55, 0x08, ++0x00, 0x00, 0x6F, 0x0E, 0x90, 0xA5, 0x8A, 0xE0, 0xFF, 0x12, 0x8D, 0x1A, 0xE1, 0x0E, 0x90, 0xA5, ++0x8A, 0xE0, 0xFF, 0xF1, 0x21, 0xE1, 0x0E, 0x90, 0xA5, 0x8A, 0xE0, 0xFF, 0xF1, 0x91, 0xE1, 0x0E, ++0x90, 0xA5, 0x8A, 0xE0, 0x24, 0x93, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, ++0xFD, 0xFF, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x09, 0x90, 0x95, 0x96, 0x71, 0x1E, ++0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x09, 0x90, 0x95, 0x9B, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, ++0x75, 0xF0, 0x09, 0x90, 0x95, 0x99, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x09, 0x90, ++0x95, 0x93, 0x12, 0x49, 0x88, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, ++0x75, 0xF0, 0x09, 0x90, 0x95, 0x94, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x09, 0x90, ++0x95, 0x98, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x09, 0x90, 0x95, 0x95, 0x71, 0x1E, ++0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE0, 0xFB, 0xE4, ++0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x01, 0x71, 0x1E, ++0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, ++0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x08, 0x90, ++0x89, 0x04, 0x12, 0x49, 0x88, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, ++0x75, 0xF0, 0x08, 0x90, 0x89, 0x05, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x08, 0x90, ++0x89, 0x06, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x07, 0x12, 0x49, ++0x88, 0xC1, 0x50, 0x90, 0xA5, 0x8A, 0xE0, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, ++0xF5, 0x83, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x25, 0xE0, ++0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA5, ++0x8A, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x12, 0x49, 0x88, 0xA3, 0xE0, 0xFB, 0x0D, 0x71, ++0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x71, 0x1E, 0x90, 0xA5, 0x8A, ++0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x03, 0x12, 0x49, 0x88, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, ++0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x05, 0x12, 0x49, 0x88, 0xA3, ++0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x07, 0x12, ++0x49, 0x88, 0xA3, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x0A, 0x90, ++0x8D, 0x09, 0x12, 0x49, 0x88, 0xA3, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x24, ++0x93, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0xE4, ++0xFB, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, ++0xF5, 0x83, 0xA3, 0xE0, 0xFB, 0x7D, 0x02, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x25, 0xE0, 0x24, ++0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x5B, ++0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x5C, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, ++0xA4, 0x5D, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x5E, 0xC1, 0x50, 0x90, 0xA4, 0x63, 0xE0, ++0xFB, 0xE4, 0xFD, 0xFF, 0x71, 0x24, 0x90, 0xA4, 0x64, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, ++0x65, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x66, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, ++0x67, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x68, 0xE0, 0xFB, 0x0D, 0x71, 0x24, ++0x90, 0xA4, 0x69, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x6A, 0xE0, 0xFB, 0x0D, 0x71, 0x24, ++0x90, 0xA4, 0x6B, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x6C, 0xE0, 0xFB, 0x0D, ++0x71, 0x24, 0x90, 0xA4, 0x6D, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x6E, 0xE0, 0xFB, 0x0D, ++0x71, 0x24, 0x90, 0xA4, 0x6F, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x70, 0xE0, ++0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x71, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x72, 0x80, ++0x3F, 0x90, 0xA4, 0x73, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x71, 0x24, 0x90, 0xA4, 0x74, 0xE0, 0xFB, ++0x0D, 0x71, 0x24, 0x90, 0xA4, 0x75, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x76, 0xE0, 0xFB, ++0x0D, 0x71, 0x24, 0x90, 0xA4, 0x77, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x78, ++0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x79, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x7A, ++0xE0, 0xFB, 0x0D, 0xE1, 0x0C, 0x90, 0xA4, 0x39, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x71, 0x24, 0x90, ++0xA4, 0x38, 0xE0, 0x54, 0x0F, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x3B, 0xE0, 0xFB, 0x0D, 0x71, ++0x24, 0x90, 0xA4, 0x3C, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x24, 0xB6, 0xF5, ++0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x36, ++0xE0, 0x54, 0x01, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x36, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, ++0xFB, 0x0D, 0x7F, 0x01, 0x71, 0x24, 0x90, 0xA4, 0x36, 0xE0, 0xC4, 0x54, 0x01, 0xFB, 0x0D, 0x7F, ++0x01, 0x71, 0x24, 0x90, 0xA4, 0x42, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x41, ++0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x40, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x3F, ++0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x38, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, 0xE4, 0xFD, 0x7F, ++0x03, 0x71, 0x24, 0x90, 0xA4, 0x37, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0x71, ++0x24, 0x90, 0xA4, 0x37, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0x71, 0x24, ++0x90, 0xA4, 0x36, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0x71, 0x24, 0x90, 0x00, ++0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x90, 0xA5, 0x95, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x63, 0x90, 0x00, 0x8D, ++0xE0, 0x64, 0x02, 0x70, 0x5B, 0x90, 0xA5, 0x96, 0xF0, 0x90, 0xA5, 0x96, 0xE0, 0xFD, 0x90, 0xA5, ++0x95, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, ++0x82, 0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x71, 0x24, 0x90, ++0xA5, 0x96, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x08, 0x40, 0xCE, 0x90, 0xA5, 0x96, 0xE0, 0xFD, ++0xC3, 0x94, 0x10, 0x50, 0x0D, 0xE4, 0xFB, 0xFF, 0x71, 0x24, 0x90, 0xA5, 0x96, 0xE0, 0x04, 0xF0, ++0x80, 0xE9, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, ++0x22, 0x90, 0xA4, 0x7F, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x4B, 0x90, 0x00, 0x8D, ++0xE0, 0x64, 0x03, 0x70, 0x43, 0x90, 0xA4, 0x80, 0xF0, 0x90, 0xA4, 0x80, 0xE0, 0xFD, 0x90, 0xA4, ++0x7F, 0xE0, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, ++0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x71, 0x24, 0x90, 0xA4, ++0x80, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCF, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, ++0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0xE4, 0x90, 0xA4, 0x7B, 0xF0, 0xA3, 0xF0, ++0x90, 0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x3E, ++0xC3, 0x90, 0xA4, 0x7C, 0xE0, 0x94, 0x88, 0x90, 0xA4, 0x7B, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, ++0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA4, 0x7B, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x48, ++0x9F, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0xA4, 0x7C, 0xE0, 0x94, 0x32, 0x90, ++0xA4, 0x7B, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB2, 0x22, 0x7F, ++0x02, 0x90, 0xA4, 0x52, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, ++0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, ++0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0xE4, 0xF5, 0x6D, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x5D, ++0xF5, 0x61, 0xA3, 0xE0, 0x55, 0x5E, 0xF5, 0x62, 0xA3, 0xE0, 0x55, 0x5F, 0xF5, 0x63, 0xA3, 0xE0, ++0x55, 0x60, 0xF5, 0x64, 0x90, 0x01, 0x34, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, 0x62, 0xF0, 0xA3, 0xE5, ++0x63, 0xF0, 0xA3, 0xE5, 0x64, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x65, 0xF5, 0x69, 0xA3, ++0xE0, 0x55, 0x66, 0xF5, 0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, 0x6B, 0xA3, 0xE0, 0x55, 0x68, 0xF5, ++0x6C, 0x90, 0x01, 0x3C, 0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, 0x6B, 0xF0, 0xA3, ++0xE5, 0x6C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x46, 0x90, 0xA4, 0x37, ++0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x13, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, ++0x0C, 0x12, 0x56, 0xE9, 0x90, 0xA4, 0x3F, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0xA5, 0x8B, ++0xE4, 0x75, 0xF0, 0x01, 0x12, 0x48, 0x9F, 0xC3, 0x90, 0xA5, 0x8C, 0xE0, 0x94, 0x80, 0x90, 0xA5, ++0x8B, 0xE0, 0x64, 0x80, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, ++0x44, 0x01, 0xF0, 0x31, 0x26, 0x12, 0x67, 0xB9, 0xE4, 0xFF, 0x71, 0x29, 0x12, 0x85, 0xCF, 0x90, ++0xA4, 0x71, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA4, 0x56, 0xE0, 0x30, 0xE0, 0x2C, 0x90, 0xA4, 0x59, ++0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x90, 0xA4, 0x57, 0xE0, 0xB5, 0x07, 0x1D, 0x90, 0x06, 0x92, 0xE0, ++0x54, 0x1C, 0x70, 0x0A, 0x31, 0x5A, 0x90, 0xA4, 0x5A, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, ++0x92, 0x74, 0x1C, 0xF0, 0xE4, 0x90, 0xA4, 0x59, 0xF0, 0x22, 0xE4, 0xFF, 0x8F, 0x6E, 0x90, 0x04, ++0x1D, 0xE0, 0x60, 0x18, 0x90, 0x05, 0x22, 0xE0, 0xF5, 0x71, 0x74, 0xFF, 0xF0, 0xD1, 0xF2, 0xBF, ++0x01, 0x02, 0x31, 0xD2, 0x90, 0x05, 0x22, 0xE5, 0x71, 0xF0, 0x80, 0x02, 0x31, 0xD2, 0x90, 0x04, ++0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0x22, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x1D, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x44, 0x80, 0xF0, 0x22, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, ++0x54, 0xEF, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x40, ++0xF0, 0x22, 0x90, 0xA3, 0x17, 0xE0, 0xFF, 0x7D, 0x01, 0x51, 0x6F, 0x8E, 0x6F, 0x8F, 0x70, 0xAD, ++0x70, 0xAC, 0x6F, 0xAF, 0x6E, 0x31, 0x87, 0xAF, 0x70, 0xAE, 0x6F, 0x90, 0x81, 0x00, 0xE0, 0x54, ++0x0F, 0xFD, 0xAC, 0x07, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, ++0x01, 0xF0, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, ++0xAC, 0x07, 0x74, 0x12, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0xFA, 0xF0, ++0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, ++0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, ++0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, ++0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, ++0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xED, 0xF0, 0x22, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x8E, 0xED, 0xF0, 0x90, 0xA5, 0x8D, 0xEF, 0xF0, ++0xE4, 0xFD, 0xFC, 0xD1, 0x1D, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0xA5, 0x8D, 0xE0, 0x90, 0x04, 0x25, ++0xF0, 0x90, 0xA5, 0x8E, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, ++0x54, 0xC0, 0xF0, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, ++0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA4, 0x56, 0xE0, 0x30, 0xE0, ++0x47, 0x90, 0xA4, 0x5A, 0xE0, 0xFD, 0x60, 0x40, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, ++0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, ++0x60, 0x06, 0xE4, 0x90, 0xA4, 0x5A, 0xF0, 0x22, 0x90, 0xA4, 0x58, 0xE0, 0xD3, 0x9D, 0x50, 0x10, ++0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0xB1, 0x0C, 0x90, 0xA4, 0x56, 0xE0, 0x54, 0xFE, 0xF0, 0x22, ++0x31, 0x5A, 0x90, 0xA4, 0x5A, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA4, 0xBC, 0xEF, 0xF0, 0xE4, 0xF5, ++0x12, 0x74, 0xBD, 0x25, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, ++0x10, 0xE5, 0x12, 0x90, 0x81, 0x03, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x30, 0xE7, 0x10, 0xE5, 0x12, ++0x70, 0x1E, 0xEF, 0x30, 0xE6, 0x1A, 0x90, 0xA4, 0x6C, 0xE0, 0x04, 0xF0, 0x80, 0x12, 0xAF, 0x12, ++0x91, 0xFD, 0x74, 0xBD, 0x25, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0x74, 0x01, 0xF0, ++0x05, 0x12, 0xE5, 0x12, 0xC3, 0x94, 0x80, 0x40, 0xB8, 0x7F, 0x0C, 0x7E, 0x00, 0x12, 0x3A, 0xF7, ++0xE4, 0xF5, 0x12, 0x74, 0xBD, 0x25, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xE0, 0x70, ++0x02, 0x81, 0xE7, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x06, 0x12, 0x49, 0x88, 0xE0, 0xF5, ++0x10, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x07, 0x12, 0x49, 0x88, 0xE0, 0xF5, 0x11, 0xFE, ++0xE5, 0x10, 0xFF, 0xE5, 0x12, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x0A, 0x12, 0x49, 0x88, ++0xE0, 0xF5, 0x10, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x0B, 0x12, 0x49, 0x88, 0xE0, 0xF5, ++0x11, 0xFE, 0xE5, 0x10, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x12, 0x90, 0x8D, 0x01, 0x12, 0x49, 0x88, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x0C, 0x12, 0x49, 0x88, ++0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x12, 0x90, 0x8D, 0x03, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, ++0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x0D, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x75, ++0xF0, 0x0A, 0xE5, 0x12, 0x90, 0x8D, 0x05, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, ++0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x0E, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, ++0x12, 0x90, 0x8D, 0x07, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, ++0x12, 0x90, 0x81, 0x0F, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x12, 0x90, 0x8D, ++0x09, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, ++0x09, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x74, 0x93, 0x25, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, ++0x83, 0xEF, 0xF0, 0xE5, 0x12, 0x70, 0x56, 0xE5, 0x11, 0x30, 0xE7, 0x05, 0x90, 0xA4, 0x6B, 0x80, ++0x49, 0xE5, 0x11, 0x30, 0xE6, 0x05, 0x90, 0xA4, 0x6A, 0x80, 0x3F, 0xE5, 0x11, 0x30, 0xE5, 0x05, ++0x90, 0xA4, 0x69, 0x80, 0x35, 0xE5, 0x11, 0x30, 0xE4, 0x05, 0x90, 0xA4, 0x68, 0x80, 0x2B, 0xE5, ++0x11, 0x30, 0xE3, 0x05, 0x90, 0xA4, 0x67, 0x80, 0x21, 0xE5, 0x11, 0x30, 0xE2, 0x05, 0x90, 0xA4, ++0x66, 0x80, 0x17, 0xE5, 0x11, 0x30, 0xE1, 0x05, 0x90, 0xA4, 0x65, 0x80, 0x0D, 0xE5, 0x11, 0x30, ++0xE0, 0x05, 0x90, 0xA4, 0x64, 0x80, 0x03, 0x90, 0xA4, 0x63, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0xBC, ++0xE0, 0xFD, 0xAF, 0x12, 0x12, 0x66, 0x7F, 0x05, 0x12, 0xE5, 0x12, 0xC3, 0x94, 0x80, 0x50, 0x02, ++0x61, 0x83, 0x22, 0x90, 0xA4, 0x6F, 0xE0, 0x04, 0xF0, 0xE4, 0xFF, 0x61, 0x29, 0x75, 0xF0, 0x10, ++0xEF, 0x90, 0x81, 0x03, 0x12, 0x49, 0x88, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0x90, 0xA3, 0x14, 0xE0, ++0x64, 0x02, 0x60, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x04, 0x1D, 0xE0, ++0x70, 0x13, 0x90, 0xA3, 0x16, 0xE0, 0xFF, 0xE4, 0xFD, 0x51, 0x6F, 0x8E, 0x10, 0x8F, 0x11, 0x90, ++0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x90, 0xA3, 0xB6, 0xE0, 0xB4, 0x01, 0x14, 0x90, 0xA4, 0x39, ++0xE0, 0x60, 0x0E, 0x90, 0xA4, 0x38, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x02, 0x80, 0xCD, 0xB1, ++0x52, 0x22, 0x90, 0x01, 0x5F, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x08, 0xF0, 0xE4, 0xF5, 0x3B, ++0x90, 0xA4, 0x4C, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x5C, 0x7E, ++0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5F, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, ++0x90, 0xA4, 0x36, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA4, 0x3C, 0xE0, 0x64, 0x0C, 0x60, 0x0B, 0xE4, ++0xFD, 0x7F, 0x0C, 0x12, 0x50, 0x51, 0xE4, 0xFF, 0x31, 0x5C, 0x22, 0xE4, 0x90, 0xA4, 0xBC, 0xF0, ++0x90, 0x06, 0xA9, 0xE0, 0x90, 0xA4, 0xBC, 0xF0, 0xE0, 0x54, 0xC0, 0x70, 0x0D, 0x90, 0xA4, 0x3D, ++0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x02, 0x50, 0x44, 0x90, 0xA4, 0xBC, 0xE0, 0x30, 0xE6, ++0x21, 0x90, 0xA4, 0x39, 0xE0, 0x64, 0x01, 0x70, 0x20, 0x90, 0xA4, 0x3D, 0xE0, 0x44, 0x01, 0xF0, ++0x90, 0xA4, 0x38, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x04, 0xB1, 0x1C, 0x80, 0x0B, 0xB1, 0x52, ++0x80, 0x07, 0x90, 0xA4, 0x3D, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA4, 0xBC, 0xE0, 0x90, 0xA4, 0x3D, ++0x30, 0xE7, 0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x4B, 0xE0, 0xF5, 0x3C, ++0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, ++0x90, 0xA4, 0x36, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xE4, 0xFE, 0xEF, ++0x25, 0xE0, 0xFD, 0xEF, 0xC3, 0x94, 0x80, 0x90, 0xFD, 0x12, 0x50, 0x04, 0xE4, 0xF0, 0x80, 0x03, ++0x74, 0x01, 0xF0, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x90, 0xA4, 0x36, 0xE0, 0xFF, ++0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x27, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, ++0x90, 0xA4, 0x37, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, 0xF0, ++0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x12, 0x50, 0x44, 0xE4, ++0xFF, 0x41, 0xDA, 0x90, 0xA4, 0x36, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, ++0x2C, 0xEF, 0x54, 0x7F, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA4, 0x37, 0x30, 0xE1, 0x06, 0xE0, ++0x44, 0x02, 0xF0, 0x80, 0x0F, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, ++0x01, 0xB8, 0x04, 0xF0, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x03, 0x12, 0x50, 0x44, 0x7F, 0x01, 0x41, ++0xDA, 0xEF, 0x60, 0x3D, 0x90, 0xA3, 0xB6, 0xE0, 0x64, 0x01, 0x70, 0x35, 0x90, 0xA4, 0x37, 0xE0, ++0x54, 0xFE, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, ++0xE4, 0xFF, 0x31, 0x5C, 0xBF, 0x01, 0x0E, 0x90, 0xA4, 0x36, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA4, ++0x3C, 0x74, 0x06, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x08, ++0xF0, 0x22, 0xE4, 0x90, 0xA5, 0x8F, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, ++0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, ++0xA5, 0x90, 0xE0, 0x94, 0xE8, 0x90, 0xA5, 0x8F, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, ++0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA5, ++0x8F, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x48, 0x9F, 0x80, 0xBF, 0x90, 0xA3, 0xB6, 0xE0, 0x64, 0x01, ++0x70, 0x2A, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, ++0x74, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x4B, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, ++0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x22, 0x90, 0xA3, 0xB6, ++0xE0, 0x64, 0x01, 0x70, 0x26, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x20, 0x90, 0x01, 0x57, 0xE4, 0xF0, ++0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA4, 0x3D, ++0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x50, 0x44, 0x22, 0x90, 0xA3, 0xB6, 0xE0, ++0xB4, 0x01, 0x14, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x0E, 0x90, 0xA4, 0x3D, 0xE0, 0x54, 0xFE, 0xF0, ++0x54, 0x07, 0x70, 0x03, 0x12, 0x50, 0x44, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x35, 0x90, 0x06, ++0x92, 0xE0, 0x30, 0xE0, 0x24, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x4C, 0xE0, 0xC3, 0x13, 0x54, 0x7F, ++0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5B, 0x74, ++0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x01, 0xF0, 0x22, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xF7, 0xF0, ++0x12, 0x50, 0x44, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x35, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, ++0x24, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x4C, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, ++0xFD, 0x7F, 0x5C, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5F, 0x74, 0x05, 0xF0, 0x90, 0x06, ++0x92, 0x74, 0x02, 0xF0, 0x22, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xEF, 0xF0, 0x12, 0x50, 0x44, 0x22, ++0x11, 0x79, 0x90, 0xA5, 0x3D, 0xEF, 0xF0, 0x90, 0xA4, 0x36, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, ++0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA5, 0x3D, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, ++0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, ++0xA4, 0x36, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0xA4, 0x44, 0xE4, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x90, ++0xA4, 0x44, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0xE4, 0x90, 0xA5, 0x3E, 0xF0, 0xA3, 0xF0, ++0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, 0xA5, 0x3E, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, ++0xA5, 0x3E, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0xA5, 0x40, 0xE0, 0x94, 0x64, 0x90, ++0xA5, 0x3F, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA5, ++0x3E, 0xE0, 0xFF, 0x22, 0x90, 0xA5, 0x3F, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x48, 0x9F, 0x80, 0xC2, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, ++0xE0, 0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, 0xC6, 0xE0, ++0x30, 0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC3, 0xEE, ++0x94, 0x01, 0x40, 0x0A, 0x0D, 0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xC3, ++0xEE, 0x94, 0x01, 0x40, 0x24, 0x90, 0xFD, 0x11, 0xE0, 0x6D, 0x70, 0x1A, 0x90, 0x01, 0x17, 0xE0, ++0xB5, 0x05, 0x0D, 0x90, 0x01, 0xE4, 0x74, 0x77, 0xF0, 0x90, 0xFD, 0x11, 0xE4, 0xF0, 0x80, 0x06, ++0xED, 0x04, 0x90, 0xFD, 0x11, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xEF, 0x70, 0x04, 0x7E, 0x03, 0x80, ++0x07, 0xEF, 0x64, 0x01, 0x70, 0x19, 0x7E, 0x42, 0x90, 0x00, 0xE2, 0xED, 0xF0, 0x90, 0x00, 0xE0, ++0xEB, 0xF0, 0x90, 0x00, 0xE3, 0xEE, 0xF0, 0x54, 0xFD, 0xF0, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, ++0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0x8F, 0x75, 0xE4, 0x90, 0xA5, 0x91, 0xF0, ++0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0xEF, 0x65, 0x75, ++0x60, 0x3E, 0xC3, 0x90, 0xA5, 0x92, 0xE0, 0x94, 0x88, 0x90, 0xA5, 0x91, 0xE0, 0x94, 0x13, 0x40, ++0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA5, 0x91, 0xE4, 0x75, 0xF0, 0x01, ++0x12, 0x48, 0x9F, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0xA5, 0x92, 0xE0, 0x94, ++0x32, 0x90, 0xA5, 0x91, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB2, ++0x22, 0x51, 0x53, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0xE4, ++0xFF, 0x31, 0x59, 0x90, 0xA3, 0x14, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x54, 0x7F, ++0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0xFB, ++0x31, 0xB1, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA4, 0x3C, 0xE0, 0x70, 0x0D, 0x51, 0x70, 0xBF, ++0x01, 0x08, 0x31, 0xD7, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA3, 0x14, 0xE0, 0xB4, ++0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0xA4, ++0x43, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x3A, 0x96, 0x90, 0xA4, 0x3A, 0xE0, 0x60, 0x12, 0x90, 0x01, ++0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, ++0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0x7F, 0x01, 0x31, 0x59, ++0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x3A, 0x96, 0x7F, 0x14, 0x7E, 0x00, ++0x02, 0x3A, 0xF7, 0x90, 0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0xA4, 0x36, 0xE0, 0x30, 0xE0, 0x02, 0x31, 0xE7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x90, 0x02, 0x87, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x17, 0x90, 0x02, ++0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, ++0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x7F, 0x00, 0x22, 0xE4, 0x90, ++0xA4, 0x7B, 0xF0, 0xE4, 0x90, 0xA4, 0x7C, 0xF0, 0x90, 0xA4, 0x7C, 0xE0, 0xFF, 0xC3, 0x94, 0x10, ++0x50, 0x74, 0x90, 0xA4, 0x7B, 0xE0, 0xFE, 0x24, 0x13, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, ++0x74, 0x03, 0xF0, 0xEF, 0x90, 0xA4, 0x7C, 0xB4, 0x03, 0x1B, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xEE, ++0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, ++0x74, 0x80, 0xF0, 0x80, 0x1B, 0xE0, 0xFF, 0x90, 0xA4, 0x7B, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, ++0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, ++0x90, 0xA4, 0x7C, 0xE0, 0xFF, 0x90, 0xA4, 0x7B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, ++0x49, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA4, ++0x7C, 0xE0, 0x04, 0xF0, 0x80, 0x82, 0x90, 0xA4, 0x7B, 0xE0, 0x04, 0xF0, 0xE0, 0x64, 0x80, 0x60, ++0x02, 0x41, 0xA3, 0xE4, 0x90, 0xAF, 0x7D, 0xF0, 0x90, 0xA4, 0x7B, 0xF0, 0x90, 0xA4, 0x7B, 0xE0, ++0xFF, 0xC3, 0x94, 0x80, 0x40, 0x02, 0x81, 0x83, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x01, 0x12, ++0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x03, 0x12, 0x49, 0x88, ++0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x05, 0x12, 0x49, 0x88, 0xE4, 0xF0, ++0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x07, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, ++0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x09, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x25, ++0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x93, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE4, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x94, 0xF5, ++0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x94, 0xF5, ++0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, ++0x93, 0x12, 0x49, 0x88, 0x74, 0x3F, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x94, 0x12, 0x49, ++0x88, 0x74, 0x03, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x95, 0x12, 0x49, 0x88, 0x74, 0x09, ++0xF0, 0xF5, 0xF0, 0xEF, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0x75, 0xF0, 0x09, 0xEF, ++0x90, 0x95, 0x97, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x98, 0x12, ++0x49, 0x88, 0x74, 0x01, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x99, 0x12, 0x49, 0x88, 0xE4, ++0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x9A, 0x12, 0x49, 0x88, 0x74, 0x01, 0xF0, 0x75, 0xF0, ++0x09, 0xEF, 0x90, 0x95, 0x9B, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, ++0x93, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x90, 0xA4, 0x7B, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x90, 0x81, ++0x00, 0x12, 0x49, 0x88, 0xEF, 0xF0, 0x74, 0x11, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, ++0xE4, 0xF0, 0x74, 0x13, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x93, ++0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x7B, 0xE0, 0x04, ++0xF0, 0x61, 0x3C, 0xE4, 0x90, 0xA4, 0x7D, 0xF0, 0x90, 0xA4, 0x7D, 0xE0, 0xFF, 0xC3, 0x94, 0x20, ++0x50, 0x14, 0x74, 0x5B, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA4, ++0x7D, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x72, ++0x8F, 0x73, 0x8D, 0x74, 0xE4, 0x90, 0xA5, 0x50, 0xF0, 0x90, 0xA5, 0x50, 0xE0, 0xFF, 0xC3, 0x94, ++0x08, 0x50, 0x14, 0x74, 0x52, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xE4, 0xF0, 0x90, ++0xA5, 0x50, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x75, 0xF0, 0x09, 0xE5, 0x74, 0x90, 0x95, 0x99, 0x12, ++0x49, 0x88, 0xE0, 0x90, 0xA5, 0x5A, 0xF0, 0x64, 0x01, 0x70, 0x4F, 0x75, 0xF0, 0x08, 0xE5, 0x74, ++0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA5, 0x52, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x74, ++0x90, 0x89, 0x01, 0x12, 0x49, 0x88, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA5, 0x53, 0xF0, 0xE4, 0xA3, ++0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xEE, 0x54, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x74, 0x90, ++0x89, 0x02, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA5, 0x58, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x74, 0x90, ++0x89, 0x03, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA5, 0x59, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, 0xFD, 0xC3, ++0x94, 0x02, 0x40, 0x61, 0x75, 0xF0, 0x08, 0xE5, 0x74, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE0, ++0x90, 0xA5, 0x52, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x74, 0x90, 0x89, 0x01, 0x12, 0x49, 0x88, 0xE0, ++0x90, 0xA5, 0x53, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x74, 0x90, 0x89, 0x02, 0x12, 0x49, 0x88, 0xE0, ++0x90, 0xA5, 0x54, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x74, 0x90, 0x89, 0x03, 0x12, 0x49, 0x88, 0xE0, ++0xFE, 0x54, 0x0F, 0x90, 0xA5, 0x55, 0xF0, 0xEE, 0x54, 0xF0, 0x90, 0xA5, 0x51, 0xF0, 0xED, 0xB4, ++0x03, 0x0B, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x90, 0xA5, 0x59, 0xF0, 0x80, 0x08, 0x90, 0xA5, 0x51, ++0xE0, 0x90, 0xA5, 0x58, 0xF0, 0xE4, 0x90, 0xA5, 0x50, 0xF0, 0x90, 0xA5, 0x50, 0xE0, 0xFF, 0x24, ++0x52, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFE, 0xEF, 0x7C, ++0x00, 0x25, 0x73, 0xFD, 0xEC, 0x35, 0x72, 0x8D, 0x82, 0xF5, 0x83, 0xE0, 0xFF, 0xEE, 0x5F, 0xD0, ++0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA5, 0x50, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xCC, 0x90, 0xA5, ++0x57, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x70, 0x08, 0xA3, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x37, ++0x90, 0xA5, 0x5A, 0xE0, 0x64, 0x01, 0x70, 0x2F, 0x90, 0xA5, 0x53, 0xE0, 0x54, 0x0F, 0xFE, 0x90, ++0xA5, 0x51, 0xF0, 0xEF, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0xA5, 0x53, 0xF0, 0x90, 0xA5, 0x58, 0xE0, ++0x90, 0xA5, 0x54, 0xF0, 0x90, 0xA5, 0x59, 0xE0, 0x90, 0xA5, 0x55, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, ++0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, ++0x26, 0xEF, 0x90, 0xA5, 0x55, 0xB4, 0x02, 0x08, 0xE0, 0xFF, 0x90, 0xA5, 0x58, 0xE0, 0x80, 0x0A, ++0xE0, 0xFF, 0x90, 0xA5, 0x59, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0xFE, 0xEF, 0x4E, 0x90, 0xA5, 0x55, ++0xF0, 0x90, 0xA5, 0x59, 0x74, 0x80, 0xF0, 0xE4, 0x90, 0xA5, 0x50, 0xF0, 0x90, 0xA5, 0x50, 0xE0, ++0xFF, 0x24, 0x52, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0xE5, ++0x74, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, ++0x83, 0xEE, 0xF0, 0x90, 0xA5, 0x50, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xCF, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x8F, 0x1B, 0x90, 0x01, 0xC4, 0x74, 0x92, 0xF0, 0x74, 0x7E, 0xA3, 0xF0, 0x75, 0xF0, ++0x10, 0xE5, 0x1B, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0xBF, 0xBE, 0x02, 0x7F, 0x3F, ++0x8F, 0x1C, 0xE4, 0xF5, 0x1F, 0xE5, 0x1C, 0x54, 0x7F, 0xF5, 0x1D, 0x75, 0xF0, 0x09, 0xE5, 0x1B, ++0x90, 0x95, 0x93, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0xC7, 0xF0, 0x75, 0xF0, 0x09, 0xE5, 0x1B, ++0x90, 0x95, 0x99, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0xC8, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x1D, ++0x90, 0x42, 0x2D, 0x12, 0x49, 0x88, 0x12, 0x49, 0x5C, 0xE5, 0x1B, 0x25, 0xE0, 0x24, 0x11, 0xF5, ++0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x09, 0xE5, 0x1B, ++0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xE0, 0xF5, 0x1E, 0x74, 0x13, 0x25, 0x1B, 0xF5, 0x82, 0xE4, ++0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x64, 0x01, 0x70, 0x28, 0xE5, 0x1D, 0x64, 0x3F, 0x70, 0x22, 0x75, ++0x1D, 0x3E, 0x75, 0xF0, 0x09, 0xE5, 0x1B, 0x90, 0x95, 0x98, 0x12, 0x49, 0x88, 0xE0, 0xB4, 0x01, ++0x05, 0x75, 0x1C, 0xBE, 0x80, 0x03, 0x85, 0x1D, 0x1C, 0x85, 0x1E, 0x23, 0xE4, 0xFB, 0x02, 0x83, ++0x38, 0x90, 0xA4, 0xC7, 0xE0, 0xFF, 0xE5, 0x1D, 0xC3, 0x9F, 0x40, 0x03, 0x02, 0x82, 0xC5, 0x74, ++0x94, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE5, 0x1D, 0xF0, 0xB4, 0x2C, 0x23, ++0x75, 0xF0, 0x09, 0xE5, 0x1B, 0x90, 0x95, 0x97, 0x12, 0x49, 0x88, 0xE0, 0x65, 0x1E, 0x60, 0x13, ++0x05, 0x1E, 0x75, 0xF0, 0x09, 0xE5, 0x1B, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xE5, 0x1E, 0xF0, ++0x02, 0x82, 0xC0, 0xE5, 0x1D, 0xC3, 0x94, 0x0C, 0x40, 0x19, 0xE5, 0x1D, 0x94, 0x13, 0x50, 0x13, ++0x74, 0x11, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0x70, 0x05, 0x75, 0x1F, ++0x01, 0x80, 0x1E, 0xE5, 0x1D, 0xC3, 0x94, 0x2C, 0x40, 0x27, 0xE5, 0x1D, 0x94, 0x35, 0x50, 0x21, ++0x74, 0x11, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0x70, 0x13, 0x75, 0x1F, ++0x02, 0x74, 0x11, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x80, ++0x10, 0xE4, 0xF5, 0x1F, 0x74, 0x11, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE4, ++0xF0, 0xE5, 0x1F, 0x64, 0x01, 0x60, 0x03, 0x02, 0x80, 0xA8, 0x75, 0xF0, 0x08, 0xE5, 0x1B, 0x90, ++0x89, 0x02, 0x12, 0x49, 0x88, 0xE0, 0x20, 0xE7, 0x1A, 0x20, 0xE6, 0x17, 0x20, 0xE5, 0x14, 0x20, ++0xE4, 0x11, 0x75, 0xF0, 0x08, 0xE5, 0x1B, 0x90, 0x89, 0x03, 0x12, 0x49, 0x88, 0xE0, 0x20, 0xE0, ++0x02, 0x01, 0xA8, 0x74, 0x13, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x74, 0x01, ++0xF0, 0xE5, 0x1D, 0xB4, 0x0C, 0x08, 0x75, 0x1D, 0x14, 0x75, 0x1C, 0x14, 0x80, 0x0B, 0xE5, 0x1D, ++0xB4, 0x0D, 0x16, 0x75, 0x1D, 0x15, 0x75, 0x1C, 0x15, 0x74, 0x93, 0x25, 0x1B, 0xF5, 0x82, 0xE4, ++0x34, 0x9B, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x80, 0x58, 0xE5, 0x1D, 0xB4, 0x0E, 0x08, 0x75, 0x1D, ++0x15, 0x75, 0x1C, 0x15, 0x80, 0x0B, 0xE5, 0x1D, 0xB4, 0x0F, 0x16, 0x75, 0x1D, 0x16, 0x75, 0x1C, ++0x16, 0x74, 0x93, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x74, 0x03, 0xF0, 0x80, ++0x30, 0xE5, 0x1D, 0xC3, 0x94, 0x10, 0x40, 0x08, 0x75, 0x1D, 0x17, 0x75, 0x1C, 0x17, 0x80, 0x13, ++0xE5, 0x1D, 0xC3, 0x94, 0x11, 0x40, 0x1A, 0xE5, 0x1D, 0x94, 0x13, 0x50, 0x14, 0x75, 0x1D, 0x18, ++0x75, 0x1C, 0x18, 0x74, 0x93, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x74, 0x02, ++0xF0, 0x85, 0x1E, 0x23, 0x7B, 0x01, 0x61, 0x38, 0xE5, 0x1F, 0x64, 0x02, 0x60, 0x02, 0x21, 0x3F, ++0x75, 0xF0, 0x08, 0xE5, 0x1B, 0x90, 0x89, 0x02, 0x12, 0x49, 0x88, 0xE0, 0x20, 0xE6, 0x18, 0x20, ++0xE7, 0x15, 0x75, 0xF0, 0x08, 0xE5, 0x1B, 0x90, 0x89, 0x03, 0x12, 0x49, 0x88, 0xE0, 0x20, 0xE0, ++0x06, 0x20, 0xE1, 0x03, 0x30, 0xE2, 0x68, 0xE5, 0x1D, 0x64, 0x2C, 0x60, 0x05, 0xE5, 0x1D, 0xB4, ++0x2D, 0x08, 0x75, 0x1D, 0x36, 0x75, 0x1C, 0x36, 0x80, 0x4E, 0xE5, 0x1D, 0x64, 0x2E, 0x60, 0x05, ++0xE5, 0x1D, 0xB4, 0x2F, 0x08, 0x75, 0x1D, 0x37, 0x75, 0x1C, 0x37, 0x80, 0x3B, 0xE5, 0x1D, 0xB4, ++0x30, 0x08, 0x75, 0x1D, 0x38, 0x75, 0x1C, 0x38, 0x80, 0x2E, 0xE5, 0x1D, 0xB4, 0x31, 0x08, 0x75, ++0x1D, 0x39, 0x75, 0x1C, 0x39, 0x80, 0x21, 0xE5, 0x1D, 0xC3, 0x94, 0x32, 0x40, 0x0F, 0xE5, 0x1D, ++0xD3, 0x94, 0x34, 0x50, 0x08, 0x75, 0x1D, 0x3A, 0x75, 0x1C, 0x3A, 0x80, 0x0B, 0xE5, 0x1D, 0xB4, ++0x35, 0x06, 0x75, 0x1D, 0x3B, 0x75, 0x1C, 0x3B, 0x85, 0x1E, 0x23, 0x7B, 0x01, 0x61, 0x38, 0x74, ++0x13, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA4, 0xC8, 0xE0, ++0xFF, 0xB4, 0x01, 0x0B, 0xE5, 0x1D, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0x74, 0xE0, 0x80, 0x1C, 0xEF, ++0xB4, 0x02, 0x0B, 0xE5, 0x1D, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0x74, 0xE8, 0x80, 0x0D, 0xEF, 0xB4, ++0x03, 0x0D, 0xE5, 0x1D, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0x74, 0xDE, 0x25, 0x1D, 0xF5, 0x1D, 0xEF, ++0xB4, 0x01, 0x0F, 0x90, 0xA4, 0xC7, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE0, 0xF0, ++0x80, 0x2A, 0x90, 0xA4, 0xC8, 0xE0, 0xB4, 0x02, 0x0F, 0x90, 0xA4, 0xC7, 0xE0, 0xC3, 0x94, 0x2C, ++0x40, 0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, 0x90, 0xA4, 0xC8, 0xE0, 0xB4, 0x03, 0x0D, 0x90, ++0xA4, 0xC7, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, 0xDE, 0xF0, 0xE5, 0x1D, 0x04, 0xFD, ++0x90, 0xA4, 0xC7, 0xE0, 0xFF, 0xED, 0xD3, 0x9F, 0x50, 0x7A, 0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, ++0xFF, 0x75, 0xF0, 0x08, 0xE5, 0x1B, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2F, 0xF5, ++0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0x7A, 0x00, 0xED, 0x54, 0x07, 0xFF, 0x74, 0x01, ++0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, ++0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x3A, 0x74, 0x94, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA2, ++0xF5, 0x83, 0xE0, 0xB4, 0x13, 0x24, 0x75, 0x1D, 0x18, 0x85, 0x1D, 0x1C, 0x74, 0x13, 0x25, 0x1B, ++0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x74, 0x93, 0x25, 0x1B, 0xF5, 0x82, ++0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x80, 0x0A, 0x8D, 0x1D, 0x85, 0x1D, 0x1C, 0x80, ++0x03, 0x0D, 0x21, 0xC0, 0x90, 0xA4, 0xC8, 0xE0, 0xFF, 0xB4, 0x01, 0x17, 0xE5, 0x1C, 0xD3, 0x94, ++0x0B, 0x40, 0x10, 0xE5, 0x1C, 0x94, 0x34, 0x50, 0x0A, 0x74, 0x20, 0x25, 0x1C, 0xF5, 0x1C, 0x74, ++0x20, 0x80, 0x28, 0xEF, 0xB4, 0x02, 0x11, 0xE5, 0x1C, 0xD3, 0x94, 0x1B, 0x40, 0x0A, 0x74, 0x18, ++0x25, 0x1C, 0xF5, 0x1C, 0x74, 0x18, 0x80, 0x13, 0xEF, 0xB4, 0x03, 0x13, 0xE5, 0x1C, 0xD3, 0x94, ++0x1B, 0x40, 0x0C, 0x74, 0x22, 0x25, 0x1C, 0xF5, 0x1C, 0x74, 0x22, 0x25, 0x1D, 0xF5, 0x1D, 0x74, ++0x13, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x61, ++0x33, 0xE5, 0x1D, 0x64, 0x3F, 0x60, 0x02, 0x61, 0x33, 0x75, 0x1D, 0x3E, 0x75, 0xF0, 0x09, 0xE5, ++0x1B, 0x90, 0x95, 0x98, 0x12, 0x49, 0x88, 0xE0, 0xB4, 0x01, 0x05, 0x75, 0x1C, 0xBE, 0x80, 0x73, ++0x85, 0x1D, 0x1C, 0x80, 0x6E, 0x90, 0xA4, 0xC7, 0xE0, 0x65, 0x1D, 0x70, 0x4D, 0x74, 0x94, 0x25, ++0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE5, 0x1C, 0xF0, 0x75, 0xF0, 0x09, 0xE5, 0x1B, ++0x90, 0x95, 0x98, 0x12, 0x49, 0x88, 0xE0, 0xB4, 0x01, 0x0D, 0xE5, 0x1C, 0x20, 0xE7, 0x08, 0xE5, ++0x1D, 0x44, 0x80, 0xF5, 0x1C, 0x80, 0x3C, 0x75, 0xF0, 0x04, 0xE5, 0x1D, 0x90, 0x42, 0x2D, 0x12, ++0x49, 0x88, 0x12, 0x49, 0x5C, 0xE5, 0x1B, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, ++0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xAF, 0x1C, 0x22, 0x90, 0xA4, 0xC7, 0xE0, 0xFF, 0x74, ++0x94, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xEF, 0xF0, 0x8F, 0x1D, 0xEF, 0x54, ++0x80, 0xF5, 0x1C, 0x85, 0x1E, 0x23, 0x7B, 0x01, 0xAD, 0x1C, 0xAF, 0x1B, 0x12, 0x61, 0x84, 0xAF, ++0x1C, 0x22, 0x8F, 0x1B, 0x90, 0x01, 0xC4, 0x74, 0x42, 0xF0, 0x74, 0x83, 0xA3, 0xF0, 0xE5, 0x1B, ++0x25, 0xE0, 0x24, 0x14, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, ++0xF0, 0x10, 0xE5, 0x1B, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0xBF, 0xBE, 0x02, 0x7F, ++0x3F, 0xEF, 0x54, 0x7F, 0xF5, 0x1C, 0x54, 0x7F, 0xF9, 0x90, 0xA4, 0xC9, 0xF0, 0x75, 0xF0, 0x09, ++0xE5, 0x1B, 0x90, 0x95, 0x94, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0xCB, 0xF0, 0x75, 0xF0, 0x09, ++0xE5, 0x1B, 0x90, 0x95, 0x93, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0xCC, 0xF0, 0x75, 0xF0, 0x10, ++0xE5, 0x1B, 0x90, 0x81, 0x05, 0x12, 0x49, 0x88, 0xE0, 0x54, 0x03, 0xFC, 0xE9, 0x25, 0xE0, 0x24, ++0x7D, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE5, ++0x1B, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, ++0xF0, 0x75, 0xF0, 0x09, 0xE5, 0x1B, 0x90, 0x95, 0x99, 0x12, 0x49, 0x88, 0xE0, 0xFB, 0x74, 0x94, ++0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE9, 0xF0, 0x90, 0xA4, 0xCC, 0xE0, 0xFF, ++0xE9, 0xD3, 0x9F, 0x40, 0x07, 0x90, 0xA4, 0xC9, 0xEF, 0xF0, 0xF5, 0x1C, 0xED, 0x70, 0x02, 0xA1, ++0xC1, 0x90, 0xA4, 0xCA, 0xED, 0xF0, 0xE5, 0x1C, 0x30, 0xE7, 0x0A, 0x90, 0xA4, 0xC9, 0xE0, 0xF5, ++0x1C, 0xA3, 0xE0, 0x14, 0xF0, 0x90, 0xA4, 0xCA, 0xE0, 0x70, 0x02, 0xA1, 0xC1, 0x90, 0xA4, 0xC9, ++0xE0, 0xFF, 0xB4, 0x2C, 0x23, 0x75, 0xF0, 0x09, 0xE5, 0x1B, 0x90, 0x95, 0x97, 0x12, 0x49, 0x88, ++0xE0, 0x6C, 0x60, 0x14, 0x1C, 0x75, 0xF0, 0x09, 0xE5, 0x1B, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, ++0xEC, 0xF0, 0x90, 0xA4, 0xCA, 0xE0, 0x14, 0xF0, 0x90, 0xA4, 0xCA, 0xE0, 0x70, 0x02, 0xA1, 0xC1, ++0x90, 0xA4, 0xCB, 0xE0, 0xFE, 0xEF, 0xD3, 0x9E, 0x50, 0x02, 0xA1, 0xBB, 0xE4, 0x90, 0xA4, 0xC8, ++0xF0, 0xBB, 0x01, 0x0F, 0xA3, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x08, 0xE0, 0x24, 0xE0, 0xF0, 0x74, ++0xE0, 0x80, 0x26, 0xBB, 0x02, 0x11, 0x90, 0xA4, 0xC9, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x08, 0xE0, ++0x24, 0xE8, 0xF0, 0x74, 0xE8, 0x80, 0x12, 0xBB, 0x03, 0x13, 0x90, 0xA4, 0xC9, 0xE0, 0xC3, 0x94, ++0x2C, 0x40, 0x0A, 0xE0, 0x24, 0xDE, 0xF0, 0x74, 0xDE, 0x25, 0x1C, 0xF5, 0x1C, 0xBB, 0x01, 0x0F, ++0xEE, 0xC3, 0x94, 0x2C, 0x40, 0x09, 0x90, 0xA4, 0xCB, 0xE0, 0x24, 0xE0, 0xF0, 0x80, 0x22, 0xBB, ++0x02, 0x0F, 0x90, 0xA4, 0xCB, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, ++0x10, 0xBB, 0x03, 0x0D, 0x90, 0xA4, 0xCB, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, 0xDE, ++0xF0, 0x90, 0xA4, 0xC9, 0xE0, 0x14, 0x90, 0xA4, 0xC7, 0xF0, 0x90, 0xA4, 0xCB, 0xE0, 0xFF, 0x90, ++0xA4, 0xC7, 0xE0, 0xF9, 0xC3, 0x9F, 0x50, 0x02, 0xA1, 0x6A, 0xE9, 0x13, 0x13, 0x13, 0x54, 0x1F, ++0xFF, 0x75, 0xF0, 0x08, 0xE5, 0x1B, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2F, 0xF5, ++0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xF5, 0x82, 0x75, 0x83, 0x00, 0xE9, 0x54, 0x07, 0xFF, ++0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, ++0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, 0x60, 0x37, 0x74, 0x94, 0x25, 0x1B, 0xF5, ++0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0xB4, 0x14, 0x05, 0x75, 0x1C, 0x0C, 0x80, 0x06, 0x90, ++0xA4, 0xC7, 0xE0, 0xF5, 0x1C, 0x90, 0xA4, 0xC8, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0xCA, 0xE0, 0xFF, ++0x90, 0xA4, 0xC8, 0xE0, 0x6F, 0x60, 0x13, 0x90, 0xA4, 0xCB, 0xE0, 0xFF, 0xE5, 0x1C, 0xD3, 0x9F, ++0x40, 0x08, 0x90, 0xA4, 0xC7, 0xE0, 0x14, 0xF0, 0x81, 0xDA, 0xBB, 0x01, 0x1C, 0xE5, 0x1C, 0xD3, ++0x94, 0x0B, 0x40, 0x15, 0xE5, 0x1C, 0x94, 0x34, 0x50, 0x0F, 0x74, 0x20, 0x25, 0x1C, 0xF5, 0x1C, ++0x90, 0xA4, 0xC9, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x38, 0xBB, 0x02, 0x16, 0xE5, 0x1C, 0xD3, 0x94, ++0x1B, 0x40, 0x0F, 0x74, 0x18, 0x25, 0x1C, 0xF5, 0x1C, 0x90, 0xA4, 0xC9, 0xE0, 0x24, 0x18, 0xF0, ++0x80, 0x1F, 0xBB, 0x03, 0x1C, 0xE5, 0x1C, 0xD3, 0x94, 0x1B, 0x40, 0x15, 0x74, 0x22, 0x25, 0x1C, ++0xF5, 0x1C, 0x90, 0xA4, 0xC9, 0xE0, 0x24, 0x22, 0xF0, 0x80, 0x06, 0x90, 0xA4, 0xCB, 0xE0, 0xF5, ++0x1C, 0x8C, 0x23, 0xE4, 0xFB, 0xAD, 0x1C, 0xAF, 0x1B, 0x12, 0x61, 0x84, 0xAF, 0x1C, 0x22, 0x90, ++0x01, 0xC4, 0x74, 0xCF, 0xF0, 0x74, 0x85, 0xA3, 0xF0, 0xE4, 0xF5, 0x10, 0x74, 0xB6, 0x25, 0x10, ++0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, 0x8B, 0x51, 0x75, 0xF0, 0x09, ++0xE5, 0x10, 0x90, 0x95, 0x9B, 0x12, 0x49, 0x88, 0xE0, 0x64, 0x01, 0x70, 0x03, 0x02, 0x8B, 0x51, ++0xE5, 0x10, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, ++0xE0, 0xD3, 0x94, 0x00, 0xEE, 0x94, 0x00, 0x50, 0x03, 0x02, 0x8B, 0x51, 0xE5, 0x10, 0x75, 0xF0, ++0x0A, 0xA4, 0x24, 0x01, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x8B, 0x14, 0xF5, 0x15, ++0x89, 0x16, 0xE5, 0x10, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, ++0xFF, 0xA3, 0xE0, 0x90, 0xA4, 0xBF, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x93, 0x25, 0x10, 0xF5, ++0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA4, 0xC1, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, ++0x90, 0x00, 0x02, 0x12, 0x48, 0xE0, 0xFF, 0xAE, 0xF0, 0x12, 0x48, 0xB5, 0x2F, 0xFF, 0xE5, 0xF0, ++0x3E, 0xFE, 0x90, 0x00, 0x04, 0x12, 0x48, 0xE0, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, ++0x06, 0x12, 0x48, 0xE0, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x08, 0x12, 0x48, 0xE0, ++0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0x90, 0xA4, 0xC3, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, ++0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x90, 0xA4, 0xBE, 0xF0, 0xBF, 0xBE, 0x03, ++0x74, 0x3F, 0xF0, 0x90, 0xA4, 0xBE, 0xE0, 0x90, 0xA4, 0xBC, 0xF0, 0x54, 0x7F, 0xA3, 0xF0, 0x75, ++0xF0, 0x09, 0xE5, 0x10, 0x90, 0x95, 0x93, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0xC6, 0xF0, 0x74, ++0x13, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0x64, 0x01, 0x60, 0x02, 0xE1, ++0x5F, 0x74, 0x93, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x60, 0x70, 0x90, ++0xA4, 0xBD, 0xE0, 0xFF, 0xC3, 0x94, 0x0C, 0x40, 0x66, 0xEF, 0xD3, 0x94, 0x13, 0x50, 0x60, 0x74, ++0x93, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x14, 0xF0, 0x74, 0x93, 0x25, ++0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x60, 0x03, 0x02, 0x8B, 0x5D, 0x90, 0xA4, ++0xBD, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x7D, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xE4, 0x93, ++0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, 0x04, 0xEB, 0x90, 0x42, 0x2D, 0x12, ++0x49, 0x88, 0x12, 0x49, 0x78, 0x12, 0x49, 0x18, 0x78, 0x01, 0x12, 0x27, 0x22, 0xE5, 0x10, 0x25, ++0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, ++0x94, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0xC3, 0x94, 0x05, 0x40, 0x03, ++0x02, 0x8A, 0xB0, 0x90, 0xA4, 0xC6, 0xE0, 0xFF, 0x90, 0xA4, 0xBD, 0xE0, 0x9F, 0x40, 0x13, 0x90, ++0xA4, 0xC6, 0xE0, 0x90, 0xA4, 0xBD, 0xF0, 0x90, 0xA4, 0xBC, 0xE0, 0x54, 0x80, 0xFE, 0xF0, 0xEF, ++0x4E, 0xF0, 0x90, 0xA4, 0xBD, 0xE0, 0xFF, 0x90, 0x41, 0xD9, 0x93, 0xFE, 0x74, 0x93, 0x25, 0x10, ++0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xC3, 0x9E, 0x40, 0x06, 0xEF, 0x90, 0x41, 0x31, ++0x80, 0x07, 0x90, 0xA4, 0xBD, 0xE0, 0x90, 0x41, 0x85, 0x93, 0x90, 0xA4, 0xC5, 0xF0, 0x90, 0xA4, ++0xC5, 0xE0, 0x75, 0xF0, 0x06, 0xA4, 0x24, 0x8F, 0xF9, 0x74, 0x40, 0x35, 0xF0, 0x75, 0x11, 0xFF, ++0xF5, 0x12, 0x89, 0x13, 0x90, 0xA4, 0xBC, 0xE0, 0x90, 0x44, 0x85, 0x93, 0xFF, 0xD3, 0x90, 0xA4, ++0xC2, 0xE0, 0x9F, 0x90, 0xA4, 0xC1, 0xE0, 0x94, 0x00, 0x40, 0x09, 0x7D, 0x01, 0xAF, 0x10, 0x71, ++0x42, 0x02, 0x8A, 0xB0, 0xE5, 0x10, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, ++0x83, 0xE0, 0xF5, 0x17, 0xA3, 0xE0, 0xF5, 0x18, 0x90, 0xA4, 0xBF, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0xD3, 0x94, 0xFA, 0xEE, 0x94, 0x00, 0x40, 0x05, 0x75, 0x1A, 0x02, 0x80, 0x11, 0xD3, 0xEF, 0x94, ++0xE8, 0xEE, 0x94, 0x03, 0x40, 0x05, 0x75, 0x1A, 0x05, 0x80, 0x03, 0xE4, 0xF5, 0x1A, 0xAB, 0x14, ++0xAA, 0x15, 0xA9, 0x16, 0x12, 0x48, 0xB5, 0xAE, 0xF0, 0xA8, 0x1A, 0x08, 0x80, 0x05, 0xCE, 0xC3, ++0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x11, 0xAA, 0x12, 0xA9, 0x13, 0x12, 0x26, 0x1E, 0xFD, ++0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x18, 0xF5, 0x18, 0xEE, 0x35, 0x17, 0xF5, 0x17, 0xAB, ++0x14, 0xAA, 0x15, 0xA9, 0x16, 0x90, 0x00, 0x02, 0x12, 0x48, 0xE0, 0xAE, 0xF0, 0xA8, 0x1A, 0x08, ++0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x11, 0xAA, 0x12, 0xA9, 0x13, ++0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x18, 0xF5, ++0x18, 0xEE, 0x35, 0x17, 0xF5, 0x17, 0xAB, 0x14, 0xAA, 0x15, 0xA9, 0x16, 0x90, 0x00, 0x04, 0x12, ++0x48, 0xE0, 0xAE, 0xF0, 0xA8, 0x1A, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, ++0xFF, 0xAB, 0x11, 0xAA, 0x12, 0xA9, 0x13, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, ++0x12, 0x26, 0x98, 0xEF, 0x25, 0x18, 0xF5, 0x18, 0xEE, 0x35, 0x17, 0xF5, 0x17, 0xAB, 0x14, 0xAA, ++0x15, 0xA9, 0x16, 0x90, 0x00, 0x06, 0x12, 0x48, 0xE0, 0xAE, 0xF0, 0xA8, 0x1A, 0x08, 0x80, 0x05, ++0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x11, 0xAA, 0x12, 0xA9, 0x13, 0x90, 0x00, ++0x03, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x18, 0xF5, 0x18, 0xEE, ++0x35, 0x17, 0xF5, 0x17, 0xAB, 0x14, 0xAA, 0x15, 0xA9, 0x16, 0x90, 0x00, 0x08, 0x12, 0x48, 0xE0, ++0xAE, 0xF0, 0xA8, 0x1A, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, ++0x11, 0xAA, 0x12, 0xA9, 0x13, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, ++0x98, 0xEF, 0x25, 0x18, 0xF5, 0x18, 0xEE, 0x35, 0x17, 0xF5, 0x17, 0x90, 0x00, 0x05, 0x12, 0x26, ++0x37, 0xFD, 0x90, 0xA4, 0xBF, 0xE0, 0xFE, 0xA3, 0xE0, 0xA8, 0x1A, 0x08, 0x80, 0x05, 0xCE, 0xC3, ++0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x26, 0x98, 0xD3, 0xE5, 0x18, 0x9F, 0xE5, 0x17, 0x9E, ++0x40, 0x0C, 0xE5, 0x18, 0x9F, 0xF5, 0x18, 0xE5, 0x17, 0x9E, 0xF5, 0x17, 0x80, 0x05, 0xE4, 0xF5, ++0x17, 0xF5, 0x18, 0xE5, 0x10, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, ++0xE5, 0x17, 0xF0, 0xA3, 0xE5, 0x18, 0xF0, 0xAE, 0x17, 0xFF, 0xE4, 0xFC, 0xFD, 0x90, 0xA4, 0xBD, ++0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x2D, 0x12, 0x49, 0x88, 0x12, 0x49, 0x78, 0xC3, 0x12, 0x49, ++0x3F, 0x40, 0x02, 0x41, 0x69, 0x74, 0x91, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, ++0xE0, 0xFF, 0x74, 0x93, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFE, 0xD3, ++0x9F, 0x40, 0x03, 0xEE, 0x80, 0x1A, 0x74, 0x93, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, ++0x83, 0xE0, 0xFF, 0x74, 0x91, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xC3, ++0x9F, 0xF5, 0x19, 0xE5, 0x19, 0xD3, 0x94, 0x04, 0x40, 0x04, 0xE5, 0x10, 0x80, 0x2F, 0xE5, 0x10, ++0x25, 0xE0, 0x24, 0x14, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xD3, ++0x94, 0x01, 0xEE, 0x94, 0x00, 0xE5, 0x10, 0x40, 0x14, 0x25, 0xE0, 0x24, 0x14, 0xF5, 0x82, 0xE4, ++0x34, 0x9D, 0xF5, 0x83, 0x74, 0xFF, 0xF5, 0xF0, 0x12, 0x48, 0x9F, 0x80, 0x0F, 0x25, 0xE0, 0x24, ++0x14, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0xBD, 0xE0, ++0x75, 0xF0, 0x04, 0x90, 0x42, 0x2D, 0x12, 0x49, 0x88, 0x12, 0x49, 0x5C, 0xE5, 0x10, 0x25, 0xE0, ++0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE5, 0x10, ++0x25, 0xE0, 0x24, 0x14, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, ++0x70, 0x33, 0xAF, 0x10, 0x12, 0x7E, 0x92, 0x80, 0x2C, 0x90, 0xA4, 0xBD, 0xE0, 0xFF, 0x25, 0xE0, ++0x24, 0x7D, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xD3, 0x74, 0x01, 0x93, 0x95, 0x18, 0xE4, ++0x93, 0x95, 0x17, 0x40, 0x10, 0xEF, 0x64, 0x36, 0x60, 0x04, 0x7D, 0x01, 0x80, 0x02, 0x7D, 0x09, ++0xAF, 0x10, 0x12, 0x83, 0x42, 0x74, 0x13, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, ++0xE0, 0xB4, 0x01, 0x0C, 0x90, 0xA4, 0xBD, 0xE0, 0xB4, 0x3F, 0x05, 0xAF, 0x10, 0x12, 0x7E, 0x92, ++0x90, 0xA4, 0xC1, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, 0x9E, ++0xFC, 0xE5, 0x10, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xFA, ++0xA3, 0xE0, 0xD3, 0x9D, 0xEA, 0x9C, 0xE5, 0x10, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, ++0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x48, 0x9F, 0x80, 0x10, 0x25, 0xE0, 0x24, ++0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0xC3, ++0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, 0x9E, 0xFC, 0xE5, 0x10, ++0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xFA, 0xA3, 0xE0, 0xD3, ++0x9D, 0xEA, 0x9C, 0xE5, 0x10, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9F, ++0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x48, 0x9F, 0x80, 0x10, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, ++0xE4, 0x34, 0x9F, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xE4, 0xFD, 0xAF, 0x10, 0x12, 0x66, ++0x7F, 0x05, 0x10, 0xE5, 0x10, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x85, 0xDC, 0x22, 0x12, 0x26, ++0x1E, 0x54, 0x7F, 0xFF, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFE, 0x54, 0x1F, 0x90, 0xA4, 0x91, ++0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x90, 0xA4, 0x90, 0xF0, 0x90, 0x00, ++0x02, 0x12, 0x26, 0x37, 0xFE, 0x54, 0x03, 0xFD, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0xA4, ++0x93, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, ++0x90, 0xA4, 0x92, 0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFE, 0x90, 0x00, ++0x02, 0x12, 0x26, 0x37, 0x54, 0x08, 0xFC, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA4, 0x94, 0xF0, ++0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x9B, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0x90, 0xA4, 0x92, 0xE0, ++0xFE, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x9A, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0x90, 0xA4, 0x94, ++0xE0, 0x70, 0x79, 0x90, 0xA4, 0x91, 0xE0, 0xFE, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x95, 0x12, ++0x49, 0x88, 0xEE, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x97, 0x12, 0x49, 0x88, 0xED, 0xF0, ++0xFE, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0x90, 0xA4, 0x90, ++0xE0, 0xFE, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x98, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0x90, 0xA4, ++0x93, 0xE0, 0xFE, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x99, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0xE4, ++0xFE, 0xEE, 0xF5, 0x82, 0x75, 0x83, 0x00, 0xA3, 0xA3, 0xA3, 0x12, 0x26, 0x37, 0xFD, 0x75, 0xF0, ++0x08, 0xEF, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2E, 0xF5, 0x82, 0xE4, 0x35, 0x83, ++0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x04, 0xD8, 0x12, 0x63, 0xDB, 0x22, 0x12, 0x26, 0x1E, ++0xF5, 0x0F, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFF, 0x74, 0x13, 0x25, 0x0F, 0xF5, 0x82, 0xE4, ++0x34, 0x9B, 0xF5, 0x83, 0xEF, 0xF0, 0xE5, 0x0F, 0xC3, 0x94, 0x80, 0x50, 0x15, 0x90, 0x00, 0x02, ++0x12, 0x26, 0x37, 0xFF, 0x74, 0x93, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xEF, ++0xF0, 0x22, 0xE5, 0x0F, 0xB4, 0x80, 0x0A, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0x95, 0x91, ++0xF0, 0x22, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x38, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, ++0x58, 0x90, 0x00, 0x8D, 0xE0, 0x64, 0x03, 0x70, 0x50, 0x90, 0x00, 0x8F, 0xE0, 0xFE, 0x90, 0x00, ++0x8E, 0xE0, 0xFD, 0xED, 0xFF, 0x90, 0xA4, 0x80, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0xA4, ++0x7F, 0xF0, 0x90, 0xA4, 0x7F, 0xE0, 0xFD, 0xFF, 0x90, 0xA4, 0x81, 0xE0, 0x2F, 0xFF, 0x90, 0xA4, ++0x80, 0xE0, 0x34, 0x00, 0x8F, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x6B, 0x24, 0x90, ++0xA4, 0x7F, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD7, 0x90, 0x00, 0x8F, 0xE0, 0x30, ++0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0xA5, 0x93, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x49, 0x90, 0x00, 0x8D, ++0xE0, 0x64, 0x01, 0x70, 0x41, 0x90, 0xA5, 0x94, 0xF0, 0x90, 0xA5, 0x94, 0xE0, 0xFD, 0x90, 0xA5, ++0x93, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2D, 0xF5, 0x82, ++0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x6B, 0x24, 0x90, 0xA5, 0x94, 0xE0, ++0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD1, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, ++0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x00, 0x8F, 0xE0, 0x30, ++0xE5, 0x2A, 0x90, 0x00, 0x8E, 0xE0, 0x64, 0x05, 0x70, 0x22, 0xA3, 0xE0, 0xFF, 0x90, 0x00, 0x8E, ++0xE0, 0xFE, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0x00, ++0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8E, 0x12, 0x3A, 0x96, 0x22, 0xE4, 0xF5, 0x0D, ++0xE4, 0xF5, 0x0E, 0xE5, 0x0E, 0xB4, 0x03, 0x1E, 0xFF, 0xE5, 0x0D, 0xC4, 0x54, 0xF0, 0x24, 0x80, ++0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, ++0x83, 0x74, 0x40, 0xF0, 0x80, 0x1B, 0xE5, 0x0D, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, ++0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, ++0xF0, 0x05, 0x0E, 0xE5, 0x0E, 0xB4, 0x10, 0xBB, 0x05, 0x0D, 0xE5, 0x0D, 0xB4, 0x08, 0xB1, 0x22, ++0xA9, 0x07, 0x90, 0x06, 0x69, 0xE0, 0xFE, 0x90, 0x06, 0x68, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, ++0xEA, 0x3E, 0xFE, 0xE9, 0x14, 0x60, 0x13, 0x14, 0x60, 0x10, 0x24, 0x02, 0x70, 0x14, 0xEE, 0x54, ++0xFE, 0xFE, 0xEF, 0x54, 0x7F, 0x90, 0x06, 0x68, 0x80, 0x04, 0x90, 0x06, 0x68, 0xEF, 0xF0, 0xEE, ++0xA3, 0xF0, 0x22, 0x90, 0xA5, 0x9B, 0xED, 0xF0, 0xEF, 0x14, 0x60, 0x23, 0x14, 0x70, 0x02, 0xC1, ++0xE4, 0x24, 0x02, 0x60, 0x02, 0xE1, 0x35, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, ++0xC3, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x00, 0x7F, 0xAC, 0xE1, 0x30, 0x90, ++0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, ++0x30, 0x02, 0x01, 0x12, 0x4F, 0x48, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, ++0x12, 0x4F, 0x31, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0xA5, 0x9B, ++0xE0, 0x7E, 0x00, 0x78, 0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, ++0xE0, 0xFD, 0xFC, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x12, 0x4F, 0x4C, ++0x90, 0xA5, 0x9B, 0xE0, 0x90, 0xA4, 0xA8, 0xB4, 0x01, 0x13, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, ++0x10, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x80, 0x11, 0x12, 0x27, 0x54, ++0x00, 0x00, 0x00, 0x10, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, ++0x7E, 0x0A, 0x80, 0x4E, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA4, ++0xAC, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x02, 0x12, 0x4F, 0x48, 0x90, 0xA4, 0xA8, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x00, 0x3C, 0x12, 0x4F, 0x31, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0xF0, 0x00, ++0x00, 0x00, 0x90, 0xA5, 0x9B, 0xE0, 0x7E, 0x00, 0x78, 0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, ++0xF9, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x48, 0x7F, 0x38, ++0x7E, 0x08, 0x12, 0x4F, 0x4C, 0x22, 0xEF, 0x14, 0x60, 0x3A, 0x14, 0x60, 0x53, 0x24, 0x02, 0x70, ++0x6C, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, 0xAA, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x0C, 0x00, 0x12, 0x4E, 0xD8, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x00, ++0x0C, 0x00, 0x90, 0xA4, 0xAA, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, ++0x7F, 0x01, 0x80, 0x36, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, ++0xAA, 0x12, 0x27, 0x54, 0x00, 0x00, 0x04, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x80, 0x1A, ++0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, 0xAA, 0x12, 0x27, 0x54, ++0x00, 0x00, 0x00, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0x4E, 0xDE, 0x22, 0x90, 0xA4, ++0xA3, 0xEF, 0xF0, 0xD3, 0x94, 0x0E, 0x50, 0x14, 0x90, 0xA5, 0x97, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0x4E, 0x60, 0x20, 0xEF, 0x64, 0x01, 0x4E, 0x70, 0x1A, 0xFF, 0x80, 0x18, 0x90, 0xA4, 0xA3, 0xE0, ++0xD3, 0x94, 0x0E, 0x40, 0x0E, 0x90, 0xA5, 0x97, 0xE0, 0x70, 0x02, 0xA3, 0xE0, 0x70, 0x04, 0x7F, ++0x01, 0xF1, 0xE4, 0x22, 0x90, 0xA4, 0xA4, 0xEF, 0xF0, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x30, ++0x00, 0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, ++0xFE, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA4, 0xE0, 0x60, 0x02, 0x01, 0xC5, 0x90, 0xA4, 0xA8, 0x12, ++0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, ++0x7F, 0x2C, 0x7E, 0x08, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, ++0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x12, ++0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA4, 0xAC, 0x12, ++0x27, 0x54, 0x00, 0x00, 0x00, 0x70, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, ++0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, ++0x70, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0xFF, ++0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x77, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, ++0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, 0x00, 0x90, 0xA4, 0xAC, ++0x12, 0x27, 0x54, 0x00, 0x77, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x4F, 0x4C, 0x90, 0x04, ++0x54, 0xE0, 0x54, 0x7F, 0x90, 0xA4, 0xA5, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0xE4, 0x90, 0xA5, ++0x97, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0xA4, 0xA4, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x21, 0x88, 0x90, ++0x04, 0x54, 0xE0, 0x44, 0x80, 0x90, 0xA4, 0xA5, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x90, 0xA4, ++0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, ++0x00, 0x01, 0x7F, 0x2C, 0x7E, 0x08, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0xF0, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x7F, 0xB0, 0x7E, ++0x0C, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA4, ++0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x4F, 0x4C, 0x90, ++0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, ++0x54, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, ++0x00, 0xFF, 0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x54, 0x00, 0x00, 0x7F, 0xB0, ++0x7E, 0x0E, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, ++0xA4, 0xAC, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x12, 0x4F, 0x4C, ++0x90, 0xA5, 0x97, 0xE4, 0xF0, 0xA3, 0x04, 0xF0, 0x22, 0xE4, 0xFE, 0xFC, 0xEF, 0x64, 0x02, 0x70, ++0x40, 0xED, 0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, 0x06, 0xED, 0xB4, 0x02, 0x02, 0x7E, 0x09, 0xEB, ++0xB4, 0x01, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x04, 0x80, 0x38, 0xEB, 0xB4, 0x02, 0x08, 0xED, ++0xB4, 0x01, 0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x02, 0x04, 0x7C, ++0x01, 0x80, 0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, 0xED, 0x64, 0x02, 0x70, 0x16, 0x7C, 0x03, 0x80, ++0x12, 0xEF, 0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x06, 0xEB, 0xB4, 0x01, ++0x02, 0x7C, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4C, 0xFF, 0x22, 0xE4, 0x90, 0xA4, 0x39, ++0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x38, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, 0xF0, 0x90, 0xA4, 0x36, ++0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x90, 0xA4, 0x3F, 0x74, 0x01, 0xF0, ++0xA3, 0xF0, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, ++0xA4, 0x42, 0xF0, 0x90, 0xA4, 0x41, 0x74, 0x07, 0xF0, 0x90, 0xA4, 0x44, 0xE4, 0xF0, 0xA3, 0x74, ++0x02, 0xF0, 0xE4, 0x90, 0xA4, 0x3D, 0xF0, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA4, ++0x3B, 0x74, 0x0C, 0xF0, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0xA4, 0x3C, 0x74, 0x0C, ++0xF0, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, ++0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0xA4, 0x46, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, ++0x90, 0xA3, 0x14, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0xA4, 0x43, 0x74, 0xFF, 0xF0, 0x80, 0x12, 0x90, ++0xA3, 0x14, 0xE0, 0x90, 0xA4, 0x43, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x41, ++0xF0, 0x90, 0xA4, 0x4A, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x07, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, ++0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, ++0x12, 0x57, 0xD1, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x67, ++0x90, 0xA4, 0x3D, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, ++0x56, 0x90, 0xA4, 0x3B, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, ++0xF0, 0x80, 0x44, 0xEF, 0x30, 0xE2, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x38, 0x90, ++0xA4, 0x3D, 0xE0, 0x30, 0xE4, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x29, 0x90, 0xA4, ++0x37, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x20, 0xF0, 0x80, ++0x16, 0x90, 0xA4, 0x51, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x80, 0xF0, 0x80, 0x08, 0x90, ++0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x7F, 0x00, 0x22, ++0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0xA4, 0x3C, ++0x74, 0x02, 0xF0, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x39, 0x90, 0xA3, 0xB6, 0xE0, 0x64, 0x01, ++0x70, 0x31, 0x90, 0xA4, 0x40, 0xF0, 0x04, 0x60, 0x2A, 0x90, 0xA4, 0x3D, 0xE0, 0x44, 0x10, 0xF0, ++0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x41, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, ++0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x3C, 0xE0, 0x20, 0xE2, 0x03, ++0x12, 0x50, 0x4D, 0x22, 0x90, 0xA4, 0x36, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x11, ++0xEF, 0x54, 0xFB, 0xF0, 0x90, 0xA4, 0x3D, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x42, 0x80, ++0x3D, 0x90, 0xA4, 0x42, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x3D, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0xA4, ++0x42, 0xE0, 0xFF, 0xB4, 0x01, 0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, 0x06, 0x90, 0x05, 0x58, 0xE0, ++0x04, 0xF0, 0x90, 0xA4, 0x4A, 0xE0, 0xFF, 0x90, 0xA4, 0x42, 0xE0, 0xD3, 0x9F, 0x40, 0x0F, 0x90, ++0xA3, 0xB6, 0xE0, 0xB4, 0x01, 0x0B, 0x90, 0xA4, 0x37, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x12, 0x50, ++0x44, 0x22, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0xA3, 0xB3, ++0xE0, 0x9B, 0x90, 0xA3, 0xB2, 0xE0, 0x9A, 0x50, 0x13, 0xA3, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0xA3, ++0xB2, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, 0xFD, 0x11, ++0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFF, 0x22, ++0x4D, 0xC2, ++}; ++ ++static u4Byte ArrayLength_TC_8812A_FW_NIC = 21570; ++ ++static void ++ODM_ReadFirmware_TC_8812A_FW_NIC( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++) ++{ ++ ODM_MoveMemory(pDM_Odm, pFirmware, Array_TC_8812A_FW_NIC, ArrayLength_TC_8812A_FW_NIC); ++ *pFirmwareSize = ArrayLength_TC_8812A_FW_NIC; ++} ++ ++ ++static u1Byte Array_TC_8812A_FW_WoWLAN[] = { ++0x01, 0x95, 0xFF, 0x00, 0x0A, 0x00, 0x00, 0x00, 0x12, 0x11, 0x21, 0x11, 0xF6, 0x47, 0x00, 0x00, ++0x39, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x02, 0x4B, 0x2A, 0x02, 0x68, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x5C, 0xD8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x6C, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x68, 0xAF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x69, 0x38, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, ++0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, ++0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, ++0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, ++0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, ++0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, ++0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, ++0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, ++0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, ++0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, ++0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, ++0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, ++0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, ++0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, ++0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, ++0x82, 0x23, 0x90, 0x45, 0x50, 0x73, 0xBB, 0x01, 0x09, 0x89, 0x82, 0x8A, 0x83, 0xF8, 0xE0, 0x28, ++0xF0, 0x22, 0x50, 0x03, 0x27, 0xF7, 0x22, 0xBB, 0xFE, 0x05, 0xF8, 0xE3, 0x28, 0xF3, 0x22, 0x8A, ++0x83, 0x89, 0x82, 0xF8, 0xE4, 0x93, 0x28, 0x22, 0xBB, 0x01, 0x0F, 0xF8, 0xE5, 0x82, 0x29, 0xF5, ++0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0xE0, 0x28, 0xF0, 0x22, 0x50, 0x09, 0xC5, 0x82, 0x29, 0xF8, ++0xE5, 0x82, 0x26, 0xF6, 0x22, 0xBB, 0xFE, 0x09, 0xC5, 0x82, 0x29, 0xF8, 0xE2, 0x25, 0x82, 0xF2, ++0x22, 0xF8, 0xEA, 0x25, 0x83, 0xF5, 0x83, 0xE9, 0x93, 0x28, 0x22, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, ++0x28, 0xF0, 0xC5, 0xF0, 0xF8, 0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, ++0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, ++0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, ++0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, ++0xE0, 0xFB, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, ++0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, ++0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, ++0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, ++0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0xE3, 0xF5, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x6B, ++0xDF, 0xF5, 0x80, 0x67, 0xE3, 0xF5, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x5E, 0xDF, 0xF5, 0x80, ++0x5A, 0x87, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x52, 0xDF, 0xF6, 0x80, 0x4E, 0x87, 0xF0, 0x09, ++0xE2, 0x08, 0xB5, 0xF0, 0x46, 0xDF, 0xF6, 0x80, 0x42, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, ++0xE0, 0xA3, 0xB5, 0xF0, 0x36, 0xDF, 0xF6, 0x80, 0x32, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, ++0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x25, 0xDF, 0xF5, 0x80, 0x21, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, ++0xF0, 0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x14, 0xDF, 0xF5, 0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, ++0xF5, 0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x02, 0xDF, 0xF4, 0x02, 0x48, 0x06, 0x80, 0x87, ++0x80, 0xE9, 0x80, 0x90, 0x80, 0xD4, 0x80, 0x3E, 0x80, 0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, ++0x80, 0xB7, 0x80, 0x8D, 0x80, 0xA3, 0x80, 0x51, 0x80, 0x74, 0x80, 0x3C, 0x02, 0x48, 0x12, 0x89, ++0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, ++0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x76, ++0xDF, 0xE3, 0xDE, 0xE1, 0x80, 0x70, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE2, ++0x08, 0xB5, 0xF0, 0x62, 0xDF, 0xF4, 0x80, 0x5E, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, ++0xE6, 0x08, 0xB5, 0xF0, 0x51, 0xDF, 0xF5, 0x80, 0x4D, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, ++0xA3, 0xE2, 0x08, 0xB5, 0xF0, 0x40, 0xDF, 0xF5, 0x80, 0x3C, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, ++0xF5, 0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, 0x2E, 0xDF, 0xF4, 0x80, 0x2A, 0x80, 0x02, 0x80, 0x57, ++0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, ++0xC5, 0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x06, ++0xDF, 0xE4, 0xDE, 0xE2, 0x80, 0x00, 0x7F, 0xFF, 0xB5, 0xF0, 0x02, 0x0F, 0x22, 0x40, 0x02, 0x7F, ++0x01, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, ++0xCC, 0xC5, 0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, ++0xD5, 0xDF, 0xE5, 0xDE, 0xE3, 0x80, 0xCF, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, ++0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, ++0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xAF, 0xDF, 0xE4, 0xDE, 0xE2, 0x80, 0xA9, 0x88, 0xF0, 0xEF, ++0x60, 0x01, 0x0E, 0x4E, 0x60, 0xAB, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, ++0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x8E, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x47, 0x4E, ++0x73, 0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x48, 0x85, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, ++0xE0, 0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, ++0x8C, 0xEC, 0x24, 0x8B, 0xF8, 0xE6, 0xBC, 0x04, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, ++0x00, 0x40, 0xCE, 0x79, 0x05, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, ++0xE1, 0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, ++0xFF, 0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x05, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, ++0x30, 0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x8A, 0x25, 0x0C, ++0xF8, 0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x04, 0x02, 0x74, 0xFF, 0xCD, 0xF8, ++0xE8, 0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, ++0xE5, 0x0C, 0x24, 0x8B, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x04, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, ++0xCD, 0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, ++0x8A, 0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, ++0xAF, 0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, ++0x7F, 0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x8A, ++0xA6, 0x81, 0x74, 0x04, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x05, 0xE4, 0x78, ++0x80, 0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4B, 0xC7, 0x74, 0x01, ++0x93, 0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, ++0xD2, 0x8C, 0xD2, 0xAF, 0x22, 0x04, 0xEF, 0xD3, 0x94, 0x04, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, ++0x81, 0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, ++0xAE, 0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x8A, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, ++0x18, 0xBE, 0x04, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, ++0x09, 0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, ++0x81, 0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x8A, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, ++0x02, 0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, ++0x09, 0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x8A, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, ++0x2F, 0x04, 0x90, 0x4B, 0xC7, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, ++0xD3, 0x94, 0x04, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, ++0xF4, 0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x8A, ++0x2F, 0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x48, 0xCE, 0x50, 0x2E, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xBF, ++0x04, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x8A, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, ++0x6C, 0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, ++0xE5, 0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, ++0x01, 0x0F, 0x74, 0x8A, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, ++0xAC, 0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, ++0xB5, 0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x04, 0x40, 0x03, 0x7F, 0xFF, ++0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, ++0xE4, 0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x48, 0xCD, 0x8F, ++0xF0, 0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, ++0x08, 0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, 0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, ++0xF6, 0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, ++0x30, 0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, ++0xEC, 0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x48, 0xCE, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, ++0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0x02, 0x4B, 0x68, 0x02, 0x49, 0x5E, ++0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, ++0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, ++0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, ++0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x4B, 0xAD, 0xE4, 0x7E, 0x01, 0x93, 0x60, ++0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, ++0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, ++0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, ++0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0x00, 0x41, 0x90, ++0x93, 0x00, 0x41, 0x90, 0x94, 0x00, 0x41, 0x90, 0x95, 0x00, 0x42, 0x90, 0xA2, 0x00, 0x00, 0x41, ++0x90, 0xA4, 0x00, 0x41, 0x90, 0xA5, 0x00, 0x4C, 0xD5, 0x4F, 0xF3, 0x58, 0x15, 0x5F, 0xED, 0x62, ++0x70, 0x90, 0x00, 0xF0, 0xE0, 0x7F, 0x01, 0x20, 0xE2, 0x02, 0x7F, 0x03, 0x22, 0x71, 0xD1, 0x90, ++0x8D, 0x01, 0xEF, 0xF0, 0x71, 0xEF, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x02, 0x35, 0x95, 0x91, ++0x74, 0x91, 0xA4, 0x91, 0x11, 0x91, 0x30, 0x91, 0x4F, 0xE4, 0xF5, 0x51, 0x75, 0x52, 0x58, 0xAB, ++0x51, 0x7D, 0x02, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x52, 0x7D, 0x03, 0x7F, 0x01, 0x02, 0x39, ++0x04, 0x75, 0x5D, 0x10, 0xE4, 0xF5, 0x5E, 0x75, 0x5F, 0x07, 0x75, 0x60, 0x42, 0x90, 0x01, 0x30, ++0xE5, 0x5D, 0xF0, 0xA3, 0xE5, 0x5E, 0xF0, 0xA3, 0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, 0xF0, 0x22, ++0x75, 0x65, 0x0E, 0x75, 0x66, 0x01, 0x75, 0x67, 0x03, 0x75, 0x68, 0x62, 0x90, 0x01, 0x38, 0xE5, ++0x65, 0xF0, 0xA3, 0xE5, 0x66, 0xF0, 0xA3, 0xE5, 0x67, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x22, 0xE4, ++0xF5, 0x55, 0xF5, 0x56, 0xF5, 0x57, 0xF5, 0x58, 0xAD, 0x55, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xAD, ++0x56, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xAD, 0x57, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xAD, 0x58, 0x7F, ++0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x30, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, ++0x01, 0x38, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xE4, ++0xFD, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, ++0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x34, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, ++0x90, 0x01, 0x3C, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, 0x3A, 0x96, ++0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0x7D, 0xFF, ++0x7F, 0x57, 0x02, 0x3A, 0x96, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x3A, ++0x96, 0xF1, 0xE1, 0x12, 0x3A, 0xB8, 0x12, 0x6D, 0x88, 0x7F, 0x01, 0x31, 0x96, 0x90, 0x8F, 0x57, ++0x74, 0x02, 0xF0, 0xFF, 0x31, 0x96, 0x90, 0x8F, 0x57, 0xE0, 0x04, 0xF0, 0x7F, 0x03, 0x31, 0x96, ++0x90, 0x8F, 0x57, 0xE0, 0x04, 0xF0, 0x7F, 0x04, 0x31, 0x96, 0x90, 0x8F, 0x57, 0xE0, 0x04, 0xF0, ++0x71, 0xDD, 0xB1, 0x2E, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, ++0x75, 0x28, 0xFF, 0xF1, 0xD2, 0x12, 0x6D, 0xB8, 0xF1, 0xE9, 0xE4, 0xFF, 0x41, 0x1F, 0xF1, 0xCC, ++0xF1, 0xD9, 0x12, 0x7F, 0x5A, 0xB1, 0x4D, 0x12, 0x77, 0x8F, 0x90, 0x8F, 0x5B, 0xE0, 0x54, 0xFE, ++0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x8E, 0x40, ++0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x45, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x06, 0x90, 0xE0, 0x44, ++0x20, 0xF0, 0x90, 0x8E, 0x41, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, ++0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, ++0x54, 0x80, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x42, 0xE0, 0x54, ++0x7F, 0xF0, 0x90, 0x8E, 0x44, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xEF, 0x60, 0x54, 0x90, 0x8F, 0x4D, ++0xE0, 0xFF, 0x60, 0x03, 0x12, 0x7C, 0x8B, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x90, 0x01, 0x17, 0xE0, ++0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8D, 0x9F, 0xF0, ++0xA3, 0xEF, 0xF0, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, ++0x12, 0x55, 0xAD, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0xD1, 0x0A, 0xF1, 0xCA, 0x12, 0x54, ++0x74, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, 0xFF, 0x80, ++0x2A, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x5B, 0x04, 0x90, 0x06, 0x90, 0xE4, 0xF0, 0x90, 0x02, 0x86, ++0xE0, 0x54, 0xFB, 0xF0, 0xF1, 0xA7, 0xF1, 0xCB, 0xA1, 0x4D, 0x12, 0x66, 0x7A, 0x90, 0x02, 0x87, ++0xE0, 0x70, 0xF7, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, ++0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, ++0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, 0xD1, 0x1B, 0x7D, ++0x02, 0x7F, 0x03, 0xD1, 0x1B, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0xF0, 0x90, 0x8E, 0x32, 0xA3, ++0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x8D, 0xA3, 0xE0, 0xB4, 0x01, 0x15, 0x90, 0x8E, 0x25, 0xE0, ++0x54, 0xFB, 0xF0, 0x90, 0x8E, 0x2A, 0xE0, 0x20, 0xE2, 0x0E, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x51, ++0xB1, 0x90, 0x8E, 0x25, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x12, 0x81, 0x79, 0x90, 0x8E, 0x2D, 0xE0, ++0x14, 0x90, 0x05, 0x73, 0xF0, 0x7D, 0x02, 0x7F, 0x02, 0xD1, 0x1B, 0x90, 0x8F, 0x58, 0xE0, 0x30, ++0xE0, 0x2D, 0x90, 0x8D, 0xA3, 0xE0, 0xB4, 0x01, 0x26, 0x90, 0x90, 0xA4, 0xE0, 0x04, 0xF0, 0xE0, ++0xB4, 0x0A, 0x0B, 0x90, 0x8F, 0x5A, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x90, 0xA4, 0xF0, 0x90, 0x8F, ++0x5A, 0xE0, 0xFF, 0x90, 0x8F, 0x59, 0xE0, 0xB5, 0x07, 0x05, 0xE4, 0xA3, 0xF0, 0xD1, 0xC0, 0x22, ++0xE4, 0xFF, 0x8F, 0x0D, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, 0xE0, 0xF5, 0x10, ++0x74, 0xFF, 0xF0, 0x12, 0x70, 0x22, 0xBF, 0x01, 0x03, 0x12, 0x81, 0xB9, 0x90, 0x05, 0x22, 0xE5, ++0x10, 0xF0, 0x80, 0x03, 0x12, 0x81, 0xB9, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0x22, ++0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0x3F, 0xF0, 0xEF, 0x60, ++0x1D, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x74, ++0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x74, 0x29, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xEF, 0xF0, 0x74, 0x09, 0x2D, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0x90, 0x9B, 0xED, 0xF0, 0x90, 0x90, 0x9A, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, ++0x7C, 0xEA, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x90, 0x9A, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x90, ++0x9B, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, ++0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, ++0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, ++0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0xAE, 0x04, ++0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xB1, 0x62, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x90, ++0x8D, 0x01, 0xE0, 0xFF, 0xB4, 0x01, 0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xEF, 0xF0, 0xEF, 0xB4, ++0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x22, 0x22, 0xE4, 0x90, 0x8D, 0xA3, ++0xF0, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, 0x85, 0x22, 0xE4, 0x90, 0x8D, 0x9D, 0xF0, 0xA3, 0xF0, ++0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x0A, 0xF0, 0xA3, ++0xE4, 0xF0, 0x22, 0xE4, 0x90, 0x8F, 0x62, 0xF0, 0x90, 0x8F, 0x62, 0xE0, 0x64, 0x01, 0xF0, 0x24, ++0xF3, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x4F, 0xA3, 0xF0, 0x12, 0x3A, 0xEB, 0xBF, 0x01, 0x03, 0x12, ++0x31, 0x69, 0x90, 0x8E, 0x2A, 0xE0, 0xFF, 0x90, 0x8E, 0x29, 0xE0, 0x6F, 0x60, 0x02, 0x31, 0xA4, ++0x12, 0x6E, 0x0E, 0xBF, 0x01, 0x02, 0xF1, 0x54, 0x90, 0x8E, 0x2A, 0xE0, 0x90, 0x01, 0xBC, 0xF0, ++0x90, 0x8D, 0xA3, 0xE0, 0x90, 0x01, 0xBD, 0xF0, 0x11, 0x3F, 0x12, 0x48, 0xCE, 0x80, 0xB9, 0x11, ++0x92, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x90, 0x43, 0xF0, 0x90, 0x01, ++0xC7, 0xE0, 0x64, 0xAD, 0x70, 0x37, 0xF0, 0x90, 0x90, 0x50, 0x74, 0x0F, 0xF0, 0x90, 0x90, 0x42, ++0x74, 0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0x90, 0x43, 0xE0, 0x2F, 0xFE, 0x74, 0x44, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x0F, 0xE9, 0x90, 0x01, ++0x3F, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x42, 0x12, 0x60, 0xD3, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x90, 0x97, 0xF0, 0x90, 0x00, ++0x8F, 0xE0, 0x20, 0xE6, 0x02, 0x21, 0x6E, 0x90, 0x00, 0x8D, 0xE0, 0x90, 0x90, 0x96, 0xF0, 0x90, ++0x00, 0x8C, 0xE0, 0x90, 0x90, 0x97, 0xF0, 0x90, 0x90, 0x96, 0xE0, 0x24, 0xF8, 0x60, 0x02, 0x21, ++0x60, 0x90, 0x8E, 0x27, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x31, 0x7C, 0x90, 0x8E, 0x26, 0xE0, 0x54, ++0x0F, 0xFB, 0x0D, 0x31, 0x7C, 0x90, 0x8E, 0x29, 0xE0, 0xFB, 0x0D, 0x31, 0x7C, 0x90, 0x8E, 0x2A, ++0xE0, 0xFB, 0x0D, 0x31, 0x7C, 0x90, 0x90, 0x97, 0xE0, 0x24, 0xA3, 0xF5, 0x82, 0xE4, 0x34, 0x8D, ++0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x31, 0x7C, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0x01, 0xFB, ++0x0D, 0x31, 0x7C, 0x90, 0x8E, 0x24, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, ++0x31, 0x7C, 0x90, 0x8E, 0x24, 0xE0, 0xC4, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0x31, 0x7C, 0x90, ++0x8E, 0x30, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x31, 0x7C, 0x90, 0x8E, 0x2F, 0xE0, 0xFB, 0x0D, 0x31, ++0x7C, 0x90, 0x8E, 0x2E, 0xE0, 0xFB, 0x0D, 0x31, 0x7C, 0x90, 0x8E, 0x2D, 0xE0, 0xFB, 0x0D, 0x31, ++0x7C, 0x90, 0x8E, 0x26, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, 0xE4, 0xFD, 0x7F, 0x03, 0x31, 0x7C, 0x90, ++0x8E, 0x25, 0x31, 0x73, 0x90, 0x8E, 0x25, 0xE0, 0x13, 0x31, 0x74, 0x90, 0x8E, 0x24, 0x31, 0x73, ++0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0xEF, 0x70, 0x04, 0x74, ++0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, ++0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, ++0x83, 0xEB, 0xF0, 0x22, 0x90, 0x8E, 0x29, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x04, 0x7D, 0x01, 0x7F, ++0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0xA6, 0xED, 0xF0, 0x90, 0x8E, 0x2A, ++0xE0, 0x90, 0x90, 0xA7, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, ++0xE0, 0x02, 0x61, 0x02, 0xEE, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x02, 0x61, 0x02, ++0x90, 0x90, 0xA7, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x61, 0x02, 0xEF, 0x70, 0x02, 0x41, 0x79, 0x24, ++0xFE, 0x70, 0x02, 0x41, 0xB2, 0x24, 0xFE, 0x60, 0x48, 0x24, 0xFC, 0x70, 0x02, 0x41, 0xED, 0x24, ++0xFC, 0x60, 0x02, 0x61, 0x02, 0xEE, 0xB4, 0x0E, 0x02, 0x71, 0x82, 0x90, 0x90, 0xA7, 0xE0, 0x70, ++0x04, 0x7F, 0x01, 0x71, 0xAA, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x5C, 0x90, 0x90, ++0xA7, 0xE0, 0xB4, 0x04, 0x0E, 0x90, 0x90, 0xA6, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x81, 0x23, 0x80, ++0x02, 0xD1, 0x9E, 0x90, 0x90, 0xA7, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x61, 0x02, 0x91, 0x6B, 0x61, ++0x02, 0x90, 0x90, 0xA7, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x71, 0xAA, 0x90, 0x90, 0xA7, 0xE0, 0xB4, ++0x06, 0x02, 0x71, 0x5C, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x0E, 0x07, 0x71, 0x07, 0xBF, 0x01, 0x02, ++0x71, 0x82, 0x90, 0x90, 0xA7, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x61, 0x02, 0x71, 0x07, 0xEF, 0x64, ++0x01, 0x60, 0x02, 0x61, 0x02, 0x71, 0xC3, 0x61, 0x02, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x0E, 0x07, ++0x71, 0x07, 0xBF, 0x01, 0x02, 0x71, 0x82, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x5C, ++0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x0C, 0x07, 0x71, 0x07, 0xBF, 0x01, 0x02, 0x71, 0xC3, 0x90, 0x90, ++0xA7, 0xE0, 0x64, 0x04, 0x70, 0x5C, 0x12, 0x80, 0x60, 0xEF, 0x64, 0x01, 0x70, 0x54, 0xD1, 0x81, ++0x80, 0x50, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x0E, 0x07, 0x71, 0x07, 0xBF, 0x01, 0x02, 0x71, 0x82, ++0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x5C, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x0C, 0x07, ++0x71, 0x07, 0xBF, 0x01, 0x02, 0x71, 0xC3, 0x90, 0x90, 0xA7, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x71, ++0xAA, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x04, 0x1A, 0x12, 0x81, 0x65, 0x80, 0x15, 0x90, 0x90, 0xA7, ++0xE0, 0xB4, 0x0C, 0x0E, 0x90, 0x8E, 0x25, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x02, ++0x91, 0x62, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF1, 0x8F, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, ++0xB8, 0x74, 0x01, 0xF0, 0x80, 0x3D, 0x90, 0x8E, 0x24, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, ++0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x28, 0xEF, 0xC4, 0x54, 0x0F, 0x30, ++0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x19, 0x90, 0x8E, 0x29, 0xE0, 0xD3, 0x94, ++0x04, 0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, ++0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x8E, 0x25, 0xE0, ++0x90, 0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x04, 0xF0, ++0x80, 0x0A, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x0C, 0xF0, 0x90, 0x05, 0x22, 0xE4, ++0xF0, 0x22, 0x90, 0x8E, 0x25, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0x90, 0x8E, 0x2A, 0x74, 0x0C, ++0xF0, 0x80, 0x11, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8E, ++0x2A, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0x90, 0xAB, 0xEF, 0xF0, 0x91, ++0x74, 0x90, 0x90, 0xAB, 0xE0, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x2A, 0x74, ++0x04, 0xF0, 0x22, 0x90, 0x8D, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x2E, 0x90, 0x8E, 0x25, 0xE0, 0x54, ++0xFD, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x7F, 0x01, 0x12, 0x4E, 0xC2, 0xBF, 0x01, 0x0E, ++0x90, 0x8E, 0x24, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x0E, 0xF0, 0x22, 0x90, 0x01, ++0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x22, 0x90, 0x8E, 0x27, 0xE0, 0x64, 0x01, ++0x70, 0x5F, 0x90, 0x8E, 0x26, 0xE0, 0x54, 0x0F, 0x60, 0x4F, 0x90, 0x8E, 0x2A, 0xE0, 0x70, 0x03, ++0xFF, 0x71, 0xAA, 0x90, 0x8E, 0x2A, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xD1, 0x9E, 0x90, 0x01, 0x5B, ++0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xF1, 0x8F, 0xEF, 0x64, 0x01, 0x70, 0x32, 0xF5, ++0x3B, 0x90, 0x8E, 0x3A, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, ++0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5B, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x01, ++0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x8E, 0x2A, 0xE0, 0x70, 0x02, 0x31, ++0xAD, 0x22, 0xB1, 0xAD, 0x90, 0x8E, 0x2A, 0x74, 0x08, 0xF0, 0x22, 0x91, 0x74, 0x90, 0x8E, 0x2A, ++0x74, 0x0C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8E, 0x34, 0x12, 0x46, ++0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0x8E, ++0x34, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, ++0x5D, 0x90, 0x00, 0x10, 0xE0, 0x44, 0x0C, 0xFD, 0x7F, 0x10, 0x12, 0x3A, 0x96, 0x90, 0x00, 0x72, ++0xE0, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x3A, 0x96, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, ++0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, ++0x86, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xBF, 0xFF, 0xEC, 0x90, 0x90, ++0x7D, 0x12, 0x27, 0x48, 0x90, 0x90, 0x7D, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, ++0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, ++0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0x90, 0x7D, 0x12, 0x27, 0x48, ++0x90, 0x90, 0x7D, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, ++0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, ++0x90, 0x7D, 0x12, 0x27, 0x48, 0x90, 0x90, 0x7D, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, ++0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0xFF, 0xE0, 0x70, 0x27, 0x7B, 0x01, ++0x7A, 0x90, 0x79, 0x81, 0xB1, 0x7A, 0x90, 0x90, 0x81, 0xE0, 0x54, 0xE7, 0xFB, 0x7F, 0x01, 0xF1, ++0xE6, 0x7B, 0x01, 0x7F, 0x01, 0xB1, 0x7E, 0x90, 0x90, 0x81, 0xE0, 0x54, 0x18, 0x70, 0x06, 0x90, ++0x01, 0xBF, 0xE0, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x08, 0x7F, 0x01, 0xEF, 0x70, ++0x04, 0x7E, 0x01, 0x80, 0x07, 0xEF, 0x64, 0x01, 0x70, 0x19, 0x7E, 0x40, 0x90, 0x00, 0xE2, 0xED, ++0xF0, 0xA3, 0xEE, 0xF0, 0x90, 0x00, 0xE1, 0xE0, 0x12, 0x26, 0x64, 0x90, 0x00, 0xE3, 0xE4, 0xF0, ++0x7F, 0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0x12, 0x70, 0x22, ++0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0x90, 0x83, 0x12, ++0x27, 0x48, 0x90, 0x90, 0x83, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, ++0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, ++0xEC, 0x90, 0x90, 0x83, 0x12, 0x27, 0x48, 0x90, 0x90, 0x83, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, ++0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x54, 0xFE, ++0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0x90, 0x83, ++0x12, 0x27, 0x48, 0x90, 0x90, 0x83, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, ++0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, ++0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0x90, ++0x8E, 0x34, 0x12, 0x27, 0x48, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, ++0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, ++0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0xFF, 0xE0, 0x70, 0x13, 0x7B, 0x01, 0x7A, ++0x90, 0x79, 0x82, 0xB1, 0x7A, 0x90, 0x90, 0x82, 0xE0, 0x44, 0x18, 0xFB, 0x7F, 0x01, 0xF1, 0xE6, ++0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0x12, 0x70, 0x22, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, ++0xFD, 0x7F, 0x03, 0x12, 0x4E, 0x1B, 0xB1, 0xAD, 0xE4, 0x90, 0x8E, 0x2A, 0xF0, 0x22, 0x90, 0x06, ++0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x0C, 0xF0, ++0x22, 0x90, 0x8F, 0x71, 0x12, 0x46, 0xA8, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xFE, 0x12, ++0x26, 0x1E, 0xFD, 0xC3, 0x13, 0x30, 0xE0, 0x12, 0x90, 0x8F, 0x71, 0x12, 0x46, 0x9F, 0x90, 0x00, ++0x02, 0x12, 0x26, 0x37, 0x90, 0x8F, 0x75, 0xF0, 0x80, 0x05, 0x90, 0x8F, 0x75, 0xEF, 0xF0, 0x90, ++0x8F, 0x74, 0xEE, 0xF0, 0x90, 0x8F, 0x75, 0xE0, 0xFE, 0x90, 0x8F, 0x74, 0xE0, 0xFF, 0xD3, 0x9E, ++0x50, 0x38, 0x90, 0x8F, 0x71, 0x12, 0x46, 0x9F, 0x12, 0x26, 0x1E, 0x54, 0x01, 0xFE, 0x74, 0xA3, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0xA3, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0x8D, 0xF5, 0x83, 0xE0, 0x70, 0x04, 0xF1, 0xD2, 0x80, 0x07, 0x90, 0x8F, 0x74, 0xE0, 0xFF, ++0xF1, 0xCF, 0x90, 0x8F, 0x74, 0xE0, 0x04, 0xF0, 0x80, 0xBA, 0x90, 0x8D, 0xA3, 0xE0, 0x70, 0x23, ++0x90, 0x8E, 0x2A, 0xE0, 0x70, 0x03, 0xFF, 0x71, 0xAA, 0x90, 0x8E, 0x2A, 0xE0, 0x64, 0x0C, 0x60, ++0x02, 0xD1, 0x9E, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xBF, 0xF0, ++0x54, 0x7F, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8E, 0x24, 0xE0, 0x30, ++0xE0, 0x02, 0xF1, 0x69, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8E, 0x2A, 0xE0, 0x70, 0x0E, 0x12, ++0x80, 0xE0, 0xBF, 0x01, 0x08, 0xF1, 0x7E, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x70, 0xC2, 0xF1, 0xA8, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, ++0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, ++0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0xF1, 0xD5, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, ++0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0xE4, 0xFF, 0x12, 0x70, 0x6A, 0x90, 0x8D, 0x01, 0xE0, 0xB4, ++0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x54, 0x7F, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x22, 0x8F, ++0x11, 0x22, 0x8F, 0x11, 0x22, 0x90, 0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x22, 0x90, 0x8E, 0x27, ++0xE0, 0x60, 0x02, 0x71, 0xFA, 0x22, 0xEF, 0x70, 0x04, 0x7E, 0x03, 0x80, 0x07, 0xEF, 0x64, 0x01, ++0x70, 0x19, 0x7E, 0x42, 0x90, 0x00, 0xE2, 0xED, 0xF0, 0x90, 0x00, 0xE0, 0xEB, 0xF0, 0x90, 0x00, ++0xE3, 0xEE, 0xF0, 0x54, 0xFD, 0xF0, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, ++0x01, 0xF0, 0x7F, 0x00, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x4A, 0xCF, 0x90, 0x8F, ++0x63, 0xEF, 0xF0, 0x60, 0xF0, 0x11, 0x29, 0x80, 0xEC, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0x8F, 0x64, 0xF0, 0x90, 0x8F, 0x64, 0xE0, 0xFD, 0x70, ++0x02, 0x21, 0x53, 0x90, 0x90, 0x93, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, ++0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x21, 0x4C, 0x90, ++0x90, 0x93, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, 0x65, ++0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, 0x8F, 0x75, 0x42, 0x65, 0x75, 0x43, 0x01, 0x7B, 0x01, 0x7A, ++0x8F, 0x79, 0x66, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x93, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD1, ++0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, 0x67, 0xF0, 0x90, 0x90, 0x93, 0xE0, 0x75, 0xF0, 0x04, 0x90, ++0x01, 0xD2, 0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, 0x68, 0xF0, 0x90, 0x90, 0x93, 0xE0, 0x75, 0xF0, ++0x04, 0x90, 0x01, 0xD3, 0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, 0x69, 0xF0, 0x90, 0x90, 0x93, 0xE0, ++0x75, 0xF0, 0x04, 0x90, 0x01, 0xF0, 0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, 0x6A, 0xF0, 0x90, 0x90, ++0x93, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF1, 0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, 0x6B, 0xF0, ++0x90, 0x90, 0x93, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF2, 0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, ++0x6C, 0xF0, 0x90, 0x90, 0x93, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF3, 0x12, 0x46, 0x93, 0xE0, ++0x90, 0x8F, 0x6D, 0xF0, 0x90, 0x8F, 0x64, 0xE0, 0xFF, 0x90, 0x90, 0x93, 0xE0, 0xFE, 0x74, 0x01, ++0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0x8F, 0x64, 0xF0, 0x90, ++0x90, 0x93, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, ++0x01, 0xCC, 0xF0, 0x90, 0x8F, 0x66, 0xE0, 0xFF, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x67, 0x31, 0x58, ++0x90, 0x90, 0x93, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x01, 0x3A, 0x90, 0x01, 0xC0, 0xE0, ++0x44, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0xA8, 0xEF, 0x12, ++0x46, 0xB1, 0x59, 0x90, 0x00, 0x59, 0x99, 0x01, 0x59, 0xA2, 0x02, 0x59, 0xAB, 0x03, 0x59, 0xB4, ++0x04, 0x59, 0xBD, 0x20, 0x59, 0xC5, 0x21, 0x59, 0xCE, 0x23, 0x59, 0xD6, 0x25, 0x59, 0xE6, 0x80, ++0x59, 0xDE, 0x81, 0x59, 0xEF, 0x82, 0x59, 0xF8, 0x83, 0x5A, 0x01, 0x84, 0x00, 0x00, 0x5A, 0x0A, ++0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x6C, 0x58, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, ++0x56, 0xB1, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x6C, 0xA0, 0x90, 0x8F, 0x6E, 0x12, 0x46, ++0x9F, 0x02, 0x77, 0xA1, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x7F, 0x2D, 0x90, 0x8F, 0x6E, ++0x12, 0x46, 0x9F, 0x80, 0x4D, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x6C, 0xD8, 0x90, 0x8F, ++0x6E, 0x12, 0x46, 0x9F, 0xE1, 0xC8, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0xE1, 0xDD, 0x90, 0x8F, ++0x6E, 0x12, 0x46, 0x9F, 0xC1, 0xB3, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x77, 0xC1, 0x90, ++0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x7E, 0x4E, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x7E, ++0x68, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x7E, 0xCA, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, ++0xF0, 0x22, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x7F, 0x90, 0x8E, 0x27, 0xF0, 0xEF, 0xC4, 0x13, 0x13, ++0x13, 0x54, 0x01, 0xA3, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0x54, 0xF0, 0xC4, 0x54, ++0x0F, 0xFE, 0x90, 0x8E, 0x26, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, ++0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, ++0xC4, 0x54, 0xF0, 0xFF, 0x90, 0x8E, 0x26, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, ++0x26, 0x37, 0x90, 0x8E, 0x29, 0xF0, 0x51, 0x8D, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, ++0xB8, 0xF0, 0x90, 0x8E, 0x27, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x8E, 0x29, 0xE0, 0x90, 0x01, ++0xBB, 0xF0, 0x90, 0x8E, 0x26, 0xE0, 0x54, 0x0F, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x90, 0x8F, 0x71, ++0x12, 0x46, 0xA8, 0x12, 0x80, 0x1E, 0x90, 0x8E, 0x27, 0xE0, 0xFF, 0x51, 0xBD, 0x90, 0x8E, 0x27, ++0xE0, 0x60, 0x19, 0x90, 0x8F, 0x71, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x54, ++0x0F, 0xFF, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x12, 0x80, 0x2F, 0x22, 0xEF, 0x70, 0x37, ++0x7D, 0x78, 0x7F, 0x02, 0x71, 0x04, 0x7D, 0x02, 0x7F, 0x03, 0x71, 0x04, 0x7D, 0xC8, 0x7F, 0x02, ++0x12, 0x71, 0x1A, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x7D, 0x01, ++0x7F, 0x0C, 0x12, 0x51, 0xB1, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x90, ++0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x02, 0x4E, 0x30, 0x7D, 0x02, 0x7F, 0x02, 0x71, 0x04, ++0x7D, 0x01, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, ++0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0x8E, 0x2A, 0xE0, ++0x64, 0x02, 0x60, 0x28, 0x71, 0x9E, 0x90, 0x8E, 0x25, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, ++0xE0, 0x14, 0x90, 0x8E, 0x2D, 0xE0, 0xFF, 0xA3, 0xE0, 0x6F, 0x70, 0x0A, 0x91, 0x32, 0x51, 0xFA, ++0x90, 0x8E, 0x2E, 0xE0, 0x14, 0xF0, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x8E, 0x27, ++0xE0, 0x60, 0x45, 0x90, 0x8E, 0x25, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x12, ++0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0B, 0x51, 0xFA, 0x90, 0x8E, 0x2D, 0xE0, 0x14, 0x90, 0x05, ++0x73, 0xF0, 0x90, 0x90, 0x98, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0xC3, 0x90, 0x90, 0x99, ++0xE0, 0x94, 0x80, 0x90, 0x90, 0x98, 0xE0, 0x64, 0x80, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, ++0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x12, 0x7E, 0xF8, 0x02, 0x4E, 0x8B, 0x90, 0x8D, ++0xA3, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x81, 0x31, 0x90, 0x8E, 0x27, 0xE0, 0x70, 0x02, 0x81, 0x31, ++0x90, 0x8E, 0x26, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, ++0x8E, 0x2E, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0x8E, 0x2D, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, ++0x90, 0x8E, 0x2D, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x8E, 0x2E, 0xEF, 0xF0, 0x90, 0x8E, 0x25, ++0xE0, 0x44, 0x04, 0xF0, 0xE4, 0x90, 0x8E, 0x30, 0xF0, 0x90, 0x8E, 0x32, 0xA3, 0xE0, 0x90, 0x05, ++0x58, 0xF0, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x2B, ++0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xEF, 0xF0, 0x90, 0x8E, 0x26, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, ++0xFD, 0x50, 0x02, 0x80, 0x02, 0x91, 0x56, 0x90, 0x8E, 0x25, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, ++0x30, 0xE0, 0x0E, 0x90, 0x8E, 0x2D, 0xE0, 0xFF, 0xA3, 0xE0, 0xB5, 0x07, 0x04, 0x91, 0x32, 0x71, ++0x00, 0x22, 0xEF, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, ++0x03, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0xE4, 0x90, 0x8F, 0xA2, 0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x90, ++0x8F, 0xA2, 0xF0, 0xE0, 0x54, 0xC0, 0x70, 0x0D, 0x90, 0x8E, 0x2B, 0xE0, 0x54, 0xFE, 0xF0, 0x54, ++0xFD, 0xF0, 0x02, 0x51, 0xA4, 0x90, 0x8F, 0xA2, 0xE0, 0x30, 0xE6, 0x21, 0x90, 0x8E, 0x27, 0xE0, ++0x64, 0x01, 0x70, 0x20, 0x90, 0x8E, 0x2B, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x8E, 0x26, 0xE0, 0x54, ++0x0F, 0x64, 0x02, 0x60, 0x04, 0xD1, 0x4E, 0x80, 0x0B, 0xD1, 0x69, 0x80, 0x07, 0x90, 0x8E, 0x2B, ++0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8F, 0xA2, 0xE0, 0x90, 0x8E, 0x2B, 0x30, 0xE7, 0x25, 0xE0, 0x44, ++0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x39, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, ++0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x44, ++0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, ++0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, ++0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xD8, 0xF0, 0x74, 0x5C, 0xA3, 0xF0, 0x12, ++0x6E, 0x39, 0xE5, 0x61, 0x30, 0xE3, 0x02, 0xF1, 0xD0, 0xE5, 0x61, 0x30, 0xE4, 0x05, 0x7F, 0x02, ++0x12, 0x4A, 0xA8, 0xE5, 0x63, 0x30, 0xE0, 0x02, 0xB1, 0x7C, 0xE5, 0x63, 0x30, 0xE1, 0x02, 0x71, ++0x4D, 0xE5, 0x63, 0x30, 0xE2, 0x02, 0x71, 0x1C, 0xE5, 0x63, 0x30, 0xE3, 0x03, 0x12, 0x6E, 0x66, ++0xE5, 0x63, 0x30, 0xE4, 0x03, 0x12, 0x6E, 0x99, 0xE5, 0x63, 0x30, 0xE5, 0x02, 0xD1, 0x32, 0xE5, ++0x63, 0x30, 0xE6, 0x03, 0x12, 0x6E, 0xC8, 0xE5, 0x64, 0x30, 0xE1, 0x03, 0x12, 0x57, 0xDD, 0xE5, ++0x64, 0x30, 0xE6, 0x02, 0xD1, 0x09, 0x74, 0xD8, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x5C, 0xA3, ++0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, 0xFF, 0x90, 0x8E, ++0x27, 0xE0, 0x70, 0x02, 0xC1, 0x08, 0x90, 0x8D, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x7A, 0x90, 0x8E, ++0x26, 0xE0, 0xC4, 0x54, 0x0F, 0x60, 0x24, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1F, 0x90, 0x8E, ++0x2E, 0xE0, 0x14, 0xF0, 0xE0, 0xFE, 0x60, 0x06, 0x90, 0x8E, 0x30, 0xE0, 0x60, 0x0F, 0xEE, 0x70, ++0x06, 0x90, 0x8E, 0x2D, 0xE0, 0xA3, 0xF0, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x48, ++0x90, 0x8E, 0x2B, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x8E, 0x30, 0xE0, 0x60, 0x03, 0xB4, 0x01, 0x09, ++0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x30, 0xE0, 0x80, 0x0D, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x30, 0xE0, ++0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0x8E, 0x2F, 0xE0, 0x2F, 0xF5, 0x3C, 0xE4, 0xFB, ++0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0x8E, ++0x2A, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x51, 0xAD, 0x22, 0x90, 0x07, 0x1F, 0xE0, 0x54, 0x7F, 0xF0, ++0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, 0x8F, 0xA4, 0xF0, 0x90, 0x8F, 0xA2, 0x74, 0x02, 0xF0, ++0x90, 0x8F, 0xB0, 0x14, 0xF0, 0xFB, 0x7A, 0x8F, 0x79, 0xA2, 0x12, 0x6D, 0x1E, 0x7F, 0x03, 0x02, ++0x4A, 0xA8, 0x90, 0x8D, 0xA3, 0xE0, 0xB4, 0x01, 0x14, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x0E, 0x90, ++0x8E, 0x26, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x02, 0x80, 0x03, 0xD1, 0x69, 0x22, 0x90, 0x04, ++0x1D, 0xE0, 0x70, 0x14, 0x90, 0x8D, 0x03, 0xE0, 0xFF, 0xE4, 0xFD, 0x12, 0x4F, 0x3B, 0x8E, 0x12, ++0x8F, 0x13, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x90, 0x01, 0x5F, 0xE4, 0xF0, 0x90, 0x01, ++0x3C, 0x74, 0x08, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x3A, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, ++0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x5C, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5F, 0x74, 0x05, ++0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x8E, ++0x2A, 0xE0, 0x64, 0x0C, 0x60, 0x0C, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x51, 0xB1, 0xE4, 0xFF, 0x12, ++0x4E, 0xC2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, ++0xFE, 0x90, 0x8E, 0x40, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, ++0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, ++0x90, 0x8E, 0x40, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0xFF, 0xF0, 0x12, 0x26, ++0x1E, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x90, 0x8E, 0x40, 0xF0, 0xEE, 0x54, ++0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xF0, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, ++0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8D, 0x9F, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x01, ++0xC2, 0x74, 0x01, 0xF0, 0x90, 0x8E, 0x40, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, 0xF1, 0x67, 0x90, ++0x8E, 0x40, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFF, 0xF1, 0xBC, 0x90, 0x01, 0xC2, 0x74, 0x02, 0xF0, ++0x90, 0x8E, 0x40, 0xE0, 0xC4, 0x54, 0x01, 0xFF, 0xF1, 0xC2, 0x90, 0x01, 0xC2, 0x74, 0x03, 0xF0, ++0x04, 0xF0, 0x90, 0x8E, 0x40, 0xE0, 0x54, 0x01, 0xFF, 0x12, 0x4D, 0x9A, 0x90, 0x01, 0xC2, 0x74, ++0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x60, 0x07, 0x90, 0x8F, 0x4E, 0xE0, 0xFF, 0xF1, ++0x72, 0x22, 0x12, 0x7C, 0xEA, 0x7E, 0x00, 0x90, 0x8F, 0x71, 0x12, 0x79, 0x98, 0x90, 0x8F, 0x71, ++0xA3, 0xE0, 0x2F, 0x24, 0x3E, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, ++0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0x52, 0x12, 0x34, 0x2C, 0xE4, 0xFF, 0x74, 0x18, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x46, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0x8E, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x06, 0xE3, 0x22, 0x90, 0x8F, 0x71, 0xEF, ++0xF0, 0x22, 0x90, 0x8F, 0x71, 0xEF, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0x8E, 0x31, 0xF0, 0x22, ++0x90, 0x8E, 0x40, 0xE0, 0x30, 0xE0, 0x05, 0x7F, 0x04, 0x12, 0x4A, 0xA8, 0x22, 0x12, 0x26, 0x1E, ++0x90, 0x8E, 0x3F, 0xF0, 0x90, 0x8E, 0x3F, 0xE0, 0x90, 0x01, 0xE7, 0xF0, 0x22, 0xE4, 0xFB, 0xFA, ++0xFD, 0x7F, 0x01, 0x12, 0x4A, 0xCF, 0x90, 0x8F, 0x7E, 0xEF, 0xF0, 0x60, 0xF0, 0x12, 0x60, 0x02, ++0x80, 0xEB, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x8D, 0x9E, 0xE0, 0xFE, ++0x90, 0x8D, 0x9D, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, ++0x01, 0x60, 0x48, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x13, 0xED, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x07, ++0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x11, 0x70, 0x7F, 0x01, 0x90, 0x8D, 0x9D, 0xE0, ++0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x07, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x11, 0xD3, ++0x7F, 0x01, 0xEF, 0x60, 0x16, 0x90, 0x8D, 0x9D, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, ++0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x8D, 0x9D, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8F, 0x7F, 0x12, 0x46, 0xA8, 0x90, 0x90, 0x95, ++0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, 0x7F, 0xAF, 0x7E, 0x01, 0x31, ++0x46, 0xEF, 0x60, 0x3A, 0x90, 0x8F, 0x7F, 0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, ++0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, ++0x12, 0x34, 0x2C, 0x90, 0x8F, 0x7F, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x90, ++0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0x8F, 0x12, 0x46, 0xA8, ++0x7F, 0x96, 0x7E, 0x02, 0x31, 0x46, 0xEF, 0x60, 0x58, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, ++0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, ++0xFE, 0x90, 0x90, 0x92, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x90, 0x92, 0xE0, ++0xFD, 0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x90, 0x8F, 0x12, 0x46, 0x9F, 0x90, 0x00, ++0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0x31, 0x9C, 0x90, 0x90, 0x92, 0xE0, ++0x24, 0x18, 0xFF, 0x90, 0x90, 0x8F, 0x12, 0x46, 0x9F, 0x31, 0xF7, 0x90, 0x02, 0x96, 0x74, 0x01, ++0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0x87, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x90, 0x87, 0xE0, 0xFE, 0xA3, ++0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, 0x2D, 0xC3, 0x90, 0x90, 0x8A, 0xE0, 0x94, 0xE8, 0x90, ++0x90, 0x89, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, ++0x80, 0x15, 0x90, 0x90, 0x89, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0x7F, 0x0A, 0x7E, 0x00, ++0x12, 0x3A, 0xF7, 0x80, 0xC5, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFC, 0xED, 0x2C, ++0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xEE, ++0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, ++0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, ++0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, ++0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, ++0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x90, 0x8B, 0xEF, 0xF0, 0xA3, 0x12, 0x46, 0xA8, ++0x90, 0x90, 0x94, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, 0x76, 0x74, 0x00, ++0x2F, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x90, ++0x8C, 0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, ++0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x8B, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, ++0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x02, ++0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0x90, 0x8C, 0x12, 0x46, 0x9F, 0x90, ++0x00, 0x0E, 0x12, 0x26, 0x37, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x2C, ++0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x4A, 0xCF, 0x90, 0x8F, 0x82, 0xEF, 0xF0, 0x60, 0xF0, ++0xF1, 0x68, 0xBF, 0x01, 0xEB, 0x51, 0x89, 0x80, 0xE7, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0xE4, 0x90, 0x8F, 0x8D, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0xE4, 0xFF, 0x74, 0x10, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x90, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x8F, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x06, 0xE3, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, ++0x01, 0x1E, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8F, 0x83, 0xF0, 0xA3, 0xEF, ++0xF0, 0x90, 0x02, 0x82, 0xE0, 0x90, 0x8F, 0x8C, 0xF0, 0x90, 0x8E, 0x40, 0xE0, 0x20, 0xE0, 0x02, ++0x81, 0x87, 0x90, 0x8E, 0x45, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x0A, ++0xB1, 0x75, 0x90, 0x90, 0xA5, 0xE0, 0x90, 0x01, 0xC7, 0xF0, 0xE4, 0x90, 0x8F, 0x8B, 0xF0, 0x90, ++0x8F, 0x8C, 0xE0, 0xFF, 0x90, 0x8F, 0x8B, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0x81, 0x87, 0x90, 0x8F, ++0x83, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, 0x90, 0xFD, 0x11, 0xF0, 0x74, 0x01, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, ++0x83, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0x90, 0x8F, 0x85, 0xF0, 0xA3, ++0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, ++0x33, 0x33, 0x54, 0xF8, 0x90, 0x8F, 0x89, 0xF0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x8F, ++0x84, 0xE0, 0x2F, 0xFF, 0x90, 0x8F, 0x83, 0xE0, 0x3E, 0xFE, 0x90, 0x8F, 0x87, 0x91, 0x8C, 0xEF, ++0x54, 0xFC, 0x90, 0x8F, 0x8A, 0xF0, 0x90, 0x8F, 0x89, 0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0x90, ++0x8F, 0x85, 0x8F, 0xF0, 0x12, 0x46, 0x4B, 0x90, 0x8F, 0x85, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD1, ++0x51, 0x90, 0x8F, 0x85, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x8F, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, ++0xFF, 0x7D, 0x0F, 0x91, 0x92, 0x90, 0x8F, 0x85, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x90, 0x8F, 0x83, ++0xEC, 0x8D, 0xF0, 0x12, 0x46, 0x4B, 0x90, 0x8D, 0x9F, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x90, ++0x8F, 0x84, 0xE0, 0x9D, 0x90, 0x8F, 0x83, 0xE0, 0x9C, 0x40, 0x1B, 0x90, 0x8D, 0xA0, 0xE0, 0x24, ++0x01, 0xFD, 0x90, 0x8D, 0x9F, 0xE0, 0x34, 0x00, 0xFC, 0xC3, 0x90, 0x8F, 0x84, 0xE0, 0x9D, 0xF0, ++0x90, 0x8F, 0x83, 0xE0, 0x9C, 0xF0, 0xEF, 0x54, 0xE0, 0x60, 0x1F, 0xEF, 0x30, 0xE7, 0x07, 0x90, ++0x01, 0xC7, 0x74, 0x21, 0x80, 0x0D, 0xEF, 0x90, 0x01, 0xC7, 0x30, 0xE6, 0x04, 0x74, 0x22, 0x80, ++0x02, 0x74, 0x23, 0xF0, 0x90, 0x90, 0xA5, 0xF0, 0x80, 0x5B, 0x90, 0x8F, 0x8A, 0xE0, 0x24, 0x40, ++0x60, 0x04, 0x24, 0x20, 0x70, 0x2A, 0x90, 0x8E, 0x41, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, ++0x01, 0x30, 0xE0, 0x41, 0x90, 0x8F, 0x87, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7B, 0x01, 0x7A, 0x8F, ++0x79, 0x90, 0xB1, 0x99, 0xEF, 0x60, 0x2E, 0x90, 0x8F, 0x8A, 0xE0, 0xFF, 0xB1, 0xF6, 0x80, 0x25, ++0x90, 0x8E, 0x41, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x18, 0x90, 0x8F, 0x87, ++0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8F, 0x8D, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, ++0x8F, 0x9A, 0xF0, 0x91, 0xD0, 0xD1, 0x0D, 0xEF, 0x64, 0x01, 0x60, 0x07, 0x90, 0x01, 0x3F, 0xE0, ++0x30, 0xE2, 0x02, 0xB1, 0x75, 0xD1, 0x2B, 0xBF, 0x01, 0x0D, 0x90, 0x8F, 0x83, 0xF1, 0x3B, 0x90, ++0x8F, 0x8B, 0xE0, 0x04, 0xF0, 0x41, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, ++0xE4, 0xFD, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0x8D, 0xA0, ++0xE0, 0x9B, 0x90, 0x8D, 0x9F, 0xE0, 0x9A, 0x50, 0x13, 0xA3, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8D, ++0x9F, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, 0xFD, 0x11, ++0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFF, 0x22, ++0x90, 0x8F, 0x98, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x8F, 0x96, 0xEE, 0x91, 0x8C, 0xEF, 0x54, ++0x0C, 0x64, 0x08, 0x60, 0x02, 0xA1, 0x74, 0x90, 0x8F, 0x96, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, ++0x8F, 0x99, 0xE0, 0xFD, 0x90, 0x8F, 0x98, 0xE0, 0x2D, 0x24, 0x1E, 0xFD, 0x91, 0x92, 0xEF, 0x64, ++0x88, 0x70, 0x71, 0x90, 0x8F, 0x96, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8F, 0x99, 0xE0, 0xFD, ++0x90, 0x8F, 0x98, 0xE0, 0x2D, 0x24, 0x1F, 0xFD, 0x91, 0x92, 0xEF, 0x64, 0x8E, 0x70, 0x55, 0x90, ++0x8F, 0x96, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8F, 0x99, 0xE0, 0xFD, 0x90, 0x8F, 0x98, 0xE0, ++0x2D, 0xFD, 0x90, 0x8F, 0x9A, 0xE0, 0x2D, 0x24, 0x19, 0xFD, 0x91, 0x92, 0xEF, 0x64, 0x03, 0x70, ++0x33, 0x90, 0x8F, 0x96, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8F, 0x99, 0xE0, 0xFD, 0x90, 0x8F, ++0x98, 0xE0, 0x2D, 0xFD, 0x90, 0x8F, 0x9A, 0xE0, 0x2D, 0x24, 0x1E, 0xFD, 0x91, 0x92, 0xEF, 0x90, ++0x01, 0xC7, 0x30, 0xE3, 0x05, 0x74, 0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x45, ++0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x8D, 0x01, 0xE0, 0xB4, 0x02, 0x15, 0x90, 0x8E, 0x42, 0xE0, ++0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x0F, 0x90, 0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, ++0x22, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x8F, 0x96, 0xEE, 0xF0, 0xA3, 0xEF, ++0xF0, 0xA3, 0x12, 0x46, 0xA8, 0xE4, 0x90, 0x8F, 0xA1, 0xF0, 0x90, 0x8F, 0xA1, 0xE0, 0xFD, 0xC3, ++0x94, 0x06, 0x50, 0x27, 0x90, 0x8F, 0x97, 0xE0, 0x24, 0x04, 0xFF, 0x90, 0x8F, 0x96, 0xE0, 0x34, ++0x00, 0xFE, 0x91, 0x92, 0x90, 0x8F, 0xA1, 0xE0, 0x24, 0x9B, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, ++0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xA1, 0xE0, 0x04, 0xF0, 0x80, 0xCF, 0x78, 0x98, 0x7C, 0x8F, 0x7D, ++0x01, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x9B, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x48, 0x5D, 0xEF, 0x7F, ++0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, 0xEF, 0x90, 0x01, 0xC7, 0xB4, 0xA0, 0x05, 0x74, 0x04, 0xF0, ++0x80, 0x03, 0x74, 0x08, 0xF0, 0x90, 0x8E, 0x45, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x8E, 0x45, ++0xE0, 0x30, 0xE0, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x06, 0x90, 0xE0, 0x20, 0xE5, 0x0A, 0x90, 0x01, ++0x3F, 0xE0, 0x30, 0xE2, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x8E, 0x45, 0xE0, 0xFF, ++0x20, 0xE0, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x14, 0xEF, 0x44, 0x01, 0x90, 0x8E, 0x45, ++0xF0, 0x90, 0x8E, 0x41, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x03, 0x7F, 0x00, 0x22, 0x7F, 0x01, ++0x22, 0x7D, 0x07, 0xEF, 0x5D, 0xC3, 0x60, 0x14, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, ++0x5E, 0xFE, 0xED, 0x5F, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x0D, 0x74, 0xFF, 0x9D, 0xFD, ++0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, 0xFF, 0x22, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, ++0x01, 0x1E, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8F, 0x71, 0xF0, 0xA3, 0xEF, ++0xF0, 0x90, 0x02, 0x87, 0xE0, 0xF9, 0x90, 0x8E, 0x40, 0xE0, 0x20, 0xE0, 0x02, 0xE1, 0x3A, 0xEC, ++0xC3, 0x99, 0x40, 0x02, 0xE1, 0x3A, 0x90, 0x8F, 0x71, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xEA, 0x90, ++0xFD, 0x11, 0xF0, 0xAF, 0x03, 0xAD, 0x07, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, ++0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, ++0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0xFE, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, ++0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFD, 0x24, 0x18, 0xFB, 0xEA, 0x33, ++0xFA, 0xEB, 0x2F, 0xFF, 0xEA, 0x3E, 0xFE, 0xD1, 0x51, 0x90, 0x8F, 0x71, 0xEE, 0x8F, 0xF0, 0x12, ++0x46, 0x4B, 0x90, 0x8D, 0x9F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x90, 0x8F, 0x72, 0xE0, 0x9F, ++0x90, 0x8F, 0x71, 0xE0, 0x9E, 0x40, 0x1B, 0x90, 0x8D, 0xA0, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8D, ++0x9F, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0x90, 0x8F, 0x72, 0xE0, 0x9F, 0xF0, 0x90, 0x8F, 0x71, 0xE0, ++0x9E, 0xF0, 0x90, 0x8F, 0x71, 0xF1, 0x3B, 0x0C, 0xC1, 0x9F, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x06, 0x90, ++0xE0, 0x20, 0xE1, 0x06, 0x90, 0x01, 0xBC, 0xE0, 0x04, 0xF0, 0x90, 0x06, 0x90, 0xE0, 0x30, 0xE1, ++0x06, 0x90, 0x01, 0xBD, 0xE0, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0x8F, 0x83, 0xF0, 0xA3, 0xF0, 0x90, ++0x02, 0x86, 0xE0, 0x20, 0xE1, 0x2C, 0xC3, 0x90, 0x8F, 0x84, 0xE0, 0x94, 0xD0, 0x90, 0x8F, 0x83, ++0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, ++0x8F, 0x83, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3A, 0xF7, ++0x80, 0xCD, 0x7F, 0x01, 0x22, 0x90, 0x90, 0x6B, 0xEF, 0xF0, 0xAB, 0x05, 0x7E, 0x00, 0x7D, 0x00, ++0x7C, 0x00, 0xE4, 0x90, 0x90, 0x70, 0xF0, 0xEB, 0xFF, 0xE4, 0x90, 0x90, 0x6C, 0x12, 0x27, 0x48, ++0x90, 0x90, 0x6C, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x08, ++0x12, 0x37, 0x5D, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x90, 0x6B, 0xE0, 0x75, 0xF0, ++0x08, 0xA4, 0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0xAF, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0x12, 0x36, 0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x12, 0x67, 0xA5, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0xC0, 0x07, 0xC0, 0x05, 0x90, 0x90, 0x73, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0x9C, 0x12, 0x27, 0x48, ++0xD0, 0x05, 0xD0, 0x07, 0x12, 0x32, 0x65, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, ++0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, ++0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x2C, 0xF0, 0x74, ++0x68, 0xA3, 0xF0, 0x11, 0x7B, 0x74, 0x2C, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x68, 0xA3, 0xF0, ++0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, ++0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x7B, 0x00, 0x7A, 0x00, 0x79, ++0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x51, 0x52, 0x53, 0x7B, 0x00, 0x7A, 0x00, ++0x79, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x52, 0x52, 0x54, 0xAB, 0x53, 0xE4, ++0xFD, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x02, 0x39, 0x04, 0xC0, ++0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, ++0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, ++0xAF, 0xF0, 0x74, 0x68, 0xA3, 0xF0, 0x11, 0xFE, 0x74, 0xAF, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, ++0x68, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, ++0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x00, ++0x54, 0xE0, 0x55, 0x55, 0xF5, 0x59, 0xA3, 0xE0, 0x55, 0x56, 0xF5, 0x5A, 0xA3, 0xE0, 0x55, 0x57, ++0xF5, 0x5B, 0xA3, 0xE0, 0x55, 0x58, 0xF5, 0x5C, 0xAD, 0x59, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0xAD, ++0x5A, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0xAD, 0x5B, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0xAD, 0x5C, 0x7F, ++0x57, 0x12, 0x3A, 0x96, 0x53, 0x91, 0xEF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, ++0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, ++0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x38, 0xF0, 0x74, 0x69, 0xA3, 0xF0, 0x51, ++0xDA, 0xE5, 0x69, 0x30, 0xE1, 0x02, 0x31, 0xC3, 0xE5, 0x69, 0x30, 0xE2, 0x02, 0x71, 0x0A, 0xE5, ++0x69, 0x30, 0xE3, 0x02, 0x71, 0x46, 0xE5, 0x6A, 0x30, 0xE0, 0x02, 0x51, 0x91, 0xE5, 0x6C, 0x30, ++0xE1, 0x05, 0x7F, 0x03, 0x12, 0x4A, 0xA8, 0xE5, 0x6C, 0x30, 0xE4, 0x03, 0x12, 0x4E, 0x79, 0xE5, ++0x6C, 0x30, 0xE5, 0x02, 0x31, 0xCC, 0xE5, 0x6C, 0x30, 0xE6, 0x02, 0x51, 0x53, 0x74, 0x38, 0x04, ++0x90, 0x01, 0xC4, 0xF0, 0x74, 0x69, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, ++0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, ++0xD0, 0xE0, 0x32, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x02, 0x71, 0xC9, 0x22, 0x90, 0x8E, 0x24, 0xE0, ++0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x27, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, ++0xE0, 0x90, 0x8E, 0x25, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, ++0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x12, 0x51, 0xA4, ++0xE4, 0xFF, 0x90, 0x8F, 0x5B, 0xE0, 0x30, 0xE0, 0x49, 0x90, 0x8F, 0x5F, 0xE0, 0xFD, 0x60, 0x42, ++0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, ++0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x06, 0xE4, 0x90, 0x8F, 0x5F, 0xF0, 0x22, ++0x90, 0x8F, 0x5D, 0xE0, 0xD3, 0x9D, 0x50, 0x11, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0x12, 0x65, ++0x75, 0x90, 0x8F, 0x5B, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x12, 0x4E, 0xC0, 0x90, 0x8F, 0x5F, 0xE0, ++0x04, 0xF0, 0x22, 0x90, 0x8E, 0x24, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, ++0x2C, 0xEF, 0x54, 0x7F, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x8E, 0x25, 0x30, 0xE1, 0x06, 0xE0, ++0x44, 0x02, 0xF0, 0x80, 0x0F, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, ++0x01, 0xB8, 0x04, 0xF0, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x03, 0x12, 0x51, 0xA4, 0x7F, 0x01, 0x41, ++0x02, 0x71, 0x82, 0x90, 0x8F, 0xB1, 0xEF, 0xF0, 0x90, 0x8E, 0x24, 0x30, 0xE0, 0x06, 0xE0, 0x44, ++0x01, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8F, 0xB1, 0xE0, 0x30, 0xE6, 0x11, 0x90, ++0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, ++0x90, 0x8E, 0x24, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0x8E, 0x32, 0xE4, 0xF0, 0xA3, 0x74, 0x05, 0xF0, ++0x90, 0x8E, 0x32, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x65, ++0xF5, 0x69, 0xA3, 0xE0, 0x55, 0x66, 0xF5, 0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, 0x6B, 0xA3, 0xE0, ++0x55, 0x68, 0xF5, 0x6C, 0x90, 0x01, 0x3C, 0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, ++0x6B, 0xF0, 0xA3, 0xE5, 0x6C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x35, ++0x90, 0x06, 0x92, 0xE0, 0x30, 0xE0, 0x24, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x3A, 0xE0, 0xC3, 0x13, ++0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, ++0x5B, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x8E, 0x24, 0xE0, 0x54, ++0xF7, 0xF0, 0x12, 0x51, 0xA4, 0x22, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x35, 0x90, 0x06, 0x92, 0xE0, ++0x30, 0xE1, 0x24, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x3A, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, ++0xE4, 0xFB, 0xFD, 0x7F, 0x5C, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5F, 0x74, 0x05, 0xF0, ++0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xEF, 0xF0, 0x12, 0x51, ++0xA4, 0x22, 0xE4, 0x90, 0x8F, 0xB2, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, ++0x8F, 0xB2, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, 0x8F, 0xB2, 0xE0, 0xFF, 0xB5, 0x06, 0x01, ++0x22, 0xC3, 0x90, 0x8F, 0xB4, 0xE0, 0x94, 0x64, 0x90, 0x8F, 0xB3, 0xE0, 0x94, 0x00, 0x40, 0x0D, ++0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x8F, 0xB2, 0xE0, 0xFF, 0x22, 0x90, 0x8F, 0xB3, ++0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0x80, 0xC2, 0x90, 0x8E, 0x24, 0xE0, 0xFF, 0x13, 0x13, ++0x54, 0x3F, 0x30, 0xE0, 0x11, 0xEF, 0x54, 0xFB, 0xF0, 0x90, 0x8E, 0x2B, 0xE0, 0x54, 0xFD, 0xF0, ++0x54, 0x07, 0x70, 0x42, 0x80, 0x3D, 0x90, 0x8E, 0x30, 0xE0, 0x04, 0xF0, 0x90, 0x8E, 0x2B, 0xE0, ++0x54, 0xEF, 0xF0, 0x90, 0x8E, 0x30, 0xE0, 0xFF, 0xB4, 0x01, 0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, ++0x06, 0x90, 0x05, 0x58, 0xE0, 0x04, 0xF0, 0x90, 0x8E, 0x38, 0xE0, 0xFF, 0x90, 0x8E, 0x30, 0xE0, ++0xD3, 0x9F, 0x40, 0x0F, 0x90, 0x8D, 0xA3, 0xE0, 0xB4, 0x01, 0x0B, 0x90, 0x8E, 0x25, 0xE0, 0x54, ++0xFB, 0xF0, 0x22, 0x12, 0x51, 0xA4, 0x22, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, ++0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x27, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x6C, 0xFF, ++0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, ++0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, ++0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8D, 0x02, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, ++0xED, 0x2F, 0x90, 0x8D, 0x03, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, ++0x8D, 0x04, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8D, 0x05, 0xF0, ++0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x8D, 0x06, 0xF0, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0x8E, 0x23, 0xF0, 0xBF, ++0x01, 0x12, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x64, 0x01, 0x60, 0x17, 0x90, 0x05, 0x22, 0x74, ++0x6F, 0xF0, 0x80, 0x0F, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x64, 0x01, 0x60, 0x05, 0x90, 0x05, ++0x22, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x30, ++0xE0, 0x26, 0x12, 0x26, 0x1E, 0x90, 0x8E, 0x38, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, ++0x8E, 0x39, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xA3, 0xE0, 0x54, 0x01, 0x4F, 0xF0, 0x90, 0x00, 0x03, ++0x12, 0x26, 0x37, 0x90, 0x8E, 0x3B, 0xF0, 0x22, 0x90, 0x8E, 0x38, 0x74, 0x01, 0xF0, 0xA3, 0x74, ++0x07, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8D, 0x9D, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, ++0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x8D, 0x9E, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, ++0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x35, 0xC0, 0x01, ++0x90, 0x8D, 0x9E, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x07, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xA8, ++0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x45, 0xD0, 0x90, 0x8D, 0x9E, ++0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, ++0x8D, 0x9E, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, ++0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, ++0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, ++0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0x8F, 0x60, 0xF0, 0xA3, 0xF0, 0x90, ++0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x3E, 0xC3, ++0x90, 0x8F, 0x61, 0xE0, 0x94, 0x88, 0x90, 0x8F, 0x60, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, ++0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x8F, 0x60, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, ++0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0x8F, 0x61, 0xE0, 0x94, 0x32, 0x90, 0x8F, ++0x60, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB2, 0x22, 0x7F, 0x02, ++0x90, 0x8F, 0x57, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, ++0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, ++0x80, 0xDE, 0x7F, 0x01, 0x22, 0xE4, 0xF5, 0x6D, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x5D, 0xF5, ++0x61, 0xA3, 0xE0, 0x55, 0x5E, 0xF5, 0x62, 0xA3, 0xE0, 0x55, 0x5F, 0xF5, 0x63, 0xA3, 0xE0, 0x55, ++0x60, 0xF5, 0x64, 0x90, 0x01, 0x34, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, 0x62, 0xF0, 0xA3, 0xE5, 0x63, ++0xF0, 0xA3, 0xE5, 0x64, 0xF0, 0x22, 0x90, 0x8D, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x2A, 0x90, 0x8E, ++0x27, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0xE4, ++0xF5, 0x3B, 0x90, 0x8E, 0x39, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, ++0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x22, 0x90, 0x8D, 0xA3, 0xE0, 0x64, 0x01, 0x70, ++0x26, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x20, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, ++0x02, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8E, 0x2B, 0xE0, 0x54, 0xFD, 0xF0, ++0x54, 0x07, 0x70, 0x03, 0x12, 0x51, 0xA4, 0x22, 0x90, 0x8D, 0xA3, 0xE0, 0xB4, 0x01, 0x14, 0x90, ++0x8E, 0x27, 0xE0, 0x60, 0x0E, 0x90, 0x8E, 0x2B, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x07, 0x70, 0x03, ++0x12, 0x51, 0xA4, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, ++0x1A, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, ++0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x90, 0x90, 0x51, 0x12, 0x46, 0xA8, 0xD1, 0xE4, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xE1, ++0xE5, 0x90, 0x8F, 0x4E, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x4F, 0x3B, 0x90, 0x90, 0x58, 0x12, 0x79, ++0x98, 0x90, 0x90, 0x5A, 0xEF, 0xF0, 0x90, 0x90, 0x58, 0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, 0x34, ++0xFC, 0xFA, 0x7B, 0x01, 0x90, 0x90, 0x57, 0xE0, 0xFD, 0x12, 0x78, 0xFC, 0x90, 0x90, 0x58, 0xA3, ++0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, ++0x90, 0x90, 0x54, 0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0xD0, ++0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x58, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, ++0x2F, 0x24, 0x42, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, ++0x90, 0x90, 0x54, 0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0xD0, ++0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x58, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, ++0x2F, 0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, ++0x90, 0x90, 0x51, 0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0xD0, ++0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x10, 0xF0, 0x90, ++0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x0A, 0x0D, 0xED, 0x13, 0x90, ++0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x24, 0x90, 0xFD, 0x11, ++0xE0, 0x6D, 0x70, 0x1A, 0x90, 0x01, 0x17, 0xE0, 0xB5, 0x05, 0x0D, 0x90, 0x01, 0xE4, 0x74, 0x77, ++0xF0, 0x90, 0xFD, 0x11, 0xE4, 0xF0, 0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, 0x11, 0xF0, 0xE4, 0x2F, ++0xFF, 0x22, 0xE4, 0x90, 0x90, 0x9C, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, ++0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, ++0x90, 0x9D, 0xE0, 0x94, 0xE8, 0x90, 0x90, 0x9C, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, ++0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x90, ++0x9C, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0x80, 0xBF, 0x8F, 0x14, 0xE4, 0x90, 0x90, 0x9E, ++0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0xEF, 0x65, ++0x14, 0x60, 0x3E, 0xC3, 0x90, 0x90, 0x9F, 0xE0, 0x94, 0x88, 0x90, 0x90, 0x9E, 0xE0, 0x94, 0x13, ++0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x90, 0x9E, 0xE4, 0x75, 0xF0, ++0x01, 0x12, 0x46, 0x4B, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0x90, 0x9F, 0xE0, ++0x94, 0x32, 0x90, 0x90, 0x9E, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, ++0xB2, 0x22, 0x90, 0x8D, 0x01, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x44, 0x80, 0xFD, ++0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0x8E, 0x31, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x3A, 0x96, 0x90, ++0x8E, 0x28, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, ++0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, 0xFD, 0x7F, 0x08, ++0x12, 0x3A, 0x96, 0x7F, 0x01, 0x11, 0x6A, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x90, ++0x12, 0x3A, 0x96, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3A, 0xF7, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0xFE, ++0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, ++0xF0, 0x22, 0xA9, 0x07, 0x90, 0x06, 0x69, 0xE0, 0xFE, 0x90, 0x06, 0x68, 0xE0, 0x7A, 0x00, 0x24, ++0x00, 0xFF, 0xEA, 0x3E, 0xFE, 0xE9, 0x14, 0x60, 0x13, 0x14, 0x60, 0x10, 0x24, 0x02, 0x70, 0x14, ++0xEE, 0x54, 0xFE, 0xFE, 0xEF, 0x54, 0x7F, 0x90, 0x06, 0x68, 0x80, 0x04, 0x90, 0x06, 0x68, 0xEF, ++0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0x90, 0x90, 0xA8, 0xED, 0xF0, 0xEF, 0x14, 0x60, 0x23, 0x14, 0x70, ++0x02, 0x41, 0x13, 0x24, 0x02, 0x60, 0x02, 0x41, 0x61, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, ++0x30, 0x03, 0xC3, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x00, 0x7F, 0xAC, 0x41, ++0x5D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0x90, 0x36, 0x12, 0x27, ++0x54, 0x00, 0x30, 0x02, 0x01, 0x51, 0x79, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, ++0x3C, 0x51, 0x62, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0x90, 0xA8, ++0xE0, 0x7E, 0x00, 0x78, 0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, ++0xE0, 0xFD, 0xFC, 0x90, 0x90, 0x36, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x51, 0x7D, 0x90, ++0x90, 0xA8, 0xE0, 0x90, 0x90, 0x32, 0xB4, 0x01, 0x13, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, ++0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x80, 0x11, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0x10, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, ++0x0A, 0x80, 0x4C, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0x90, 0x36, ++0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x02, 0x51, 0x79, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0x3C, 0x51, 0x62, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, ++0x90, 0xA8, 0xE0, 0x7E, 0x00, 0x78, 0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, ++0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0x90, 0x36, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x51, ++0x7D, 0x22, 0x90, 0x90, 0xA8, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0xFF, 0xAE, 0xF0, 0xEE, 0x33, 0x95, ++0xE0, 0xFD, 0xFC, 0x90, 0x90, 0x36, 0x12, 0x27, 0x48, 0x7F, 0xAC, 0x7E, 0x08, 0x90, 0x90, 0x30, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x36, 0xCE, 0x90, 0x90, 0x3A, 0x12, 0x27, 0x48, 0x90, 0x90, ++0x32, 0x12, 0x46, 0x7B, 0x12, 0x27, 0x15, 0x90, 0x90, 0x3A, 0x12, 0x46, 0x87, 0x12, 0x46, 0x61, ++0x90, 0x90, 0x36, 0x12, 0x46, 0x87, 0x12, 0x46, 0x6E, 0x90, 0x90, 0x3E, 0x12, 0x27, 0x48, 0x90, ++0x90, 0x3E, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x90, 0x90, 0x30, 0xE0, 0xFE, ++0xA3, 0xE0, 0xFF, 0x02, 0x37, 0x5D, 0x90, 0x90, 0xA0, 0xEF, 0xF0, 0x90, 0x90, 0x32, 0x12, 0x27, ++0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x74, ++0x08, 0xFF, 0xFE, 0x51, 0x7D, 0x90, 0x90, 0xA0, 0xE0, 0x60, 0x02, 0x61, 0xA0, 0x90, 0x90, 0x32, ++0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, ++0x00, 0x7F, 0x2C, 0x7E, 0x08, 0x51, 0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, ++0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x51, ++0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0x90, 0x36, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x00, 0x70, 0x7F, 0xB0, 0x7E, 0x0C, 0x51, 0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x70, 0x7F, ++0xB0, 0x7E, 0x0E, 0x51, 0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, 0x00, 0x90, ++0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x77, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, 0x51, 0x7D, 0x90, ++0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, ++0x77, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0E, 0x51, 0x7D, 0x90, 0x04, 0x54, 0xE0, 0x54, 0x7F, 0x90, ++0x90, 0xA1, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0xE4, 0x90, 0x90, 0xA2, 0xF0, 0xA3, 0xF0, 0x22, ++0x90, 0x90, 0xA0, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x81, 0x5D, 0x90, 0x04, 0x54, 0xE0, 0x44, 0x80, ++0x90, 0x90, 0xA1, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0x03, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x2C, 0x7E, ++0x08, 0x51, 0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0x90, 0x36, ++0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x7F, 0xB0, 0x7E, 0x0C, 0x51, 0x7D, 0x90, 0x90, 0x32, ++0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, ++0x10, 0x7F, 0xB0, 0x7E, 0x0E, 0x51, 0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, ++0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x54, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, 0x51, ++0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, ++0x54, 0x00, 0x54, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0E, 0x51, 0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, ++0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0x74, ++0x08, 0xFF, 0xFE, 0x51, 0x7D, 0x90, 0x90, 0xA2, 0xE4, 0xF0, 0xA3, 0x04, 0xF0, 0x22, 0x90, 0x90, ++0xA9, 0xEF, 0xF0, 0xD1, 0x80, 0x90, 0x90, 0xA9, 0xE0, 0xC3, 0x94, 0x0E, 0x50, 0x44, 0x90, 0x90, ++0x32, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x12, 0xD4, ++0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0x51, 0x7D, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x07, ++0x03, 0xFF, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0xD1, 0x1B, 0x90, 0x90, 0x20, ++0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, ++0xC1, 0x0A, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x30, ++0x50, 0x16, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, ++0x27, 0x54, 0x09, 0x28, 0x00, 0x00, 0x80, 0x70, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0x74, 0x32, 0xD3, ++0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x40, 0x50, 0x16, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x1F, 0xFE, ++0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x08, 0xA6, 0x00, 0x00, 0x80, 0x4A, 0x90, 0x90, ++0xA9, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x74, 0x50, 0x16, 0x90, 0x90, ++0x32, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x08, 0xA4, ++0x00, 0x00, 0x80, 0x24, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0x74, 0x76, 0xD3, 0x9F, 0x50, 0x1F, 0xEF, ++0x94, 0xA5, 0x50, 0x1A, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, ++0x36, 0x12, 0x27, 0x54, 0x08, 0x24, 0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0x51, 0x7D, 0x90, 0x90, ++0xA9, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, 0x37, 0xEF, 0x94, 0x40, 0x50, 0x32, 0x90, 0x90, ++0x20, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, ++0x74, 0x01, 0xFE, 0x0D, 0x14, 0xD1, 0x1B, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, ++0xFF, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0x74, 0x01, 0xFE, 0x0D, 0x14, 0x80, 0x7A, ++0x90, 0x90, 0xA9, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x37, 0xEF, 0x94, 0x8C, 0x50, 0x32, ++0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0xE4, ++0xFC, 0x74, 0x01, 0xFE, 0x74, 0x03, 0xD1, 0x19, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x07, ++0x03, 0xFF, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0xE4, 0xFC, 0x74, 0x01, 0xFE, 0x74, 0x03, 0xFD, 0xE4, ++0x80, 0x38, 0x90, 0x90, 0xA9, 0xE0, 0xFB, 0x74, 0x8C, 0xC3, 0x9B, 0x50, 0x3B, 0x90, 0x90, 0x20, ++0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0xAF, 0x03, 0xE4, 0xFC, 0x74, 0x01, 0xFE, 0x74, 0x05, ++0xD1, 0x19, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0x90, 0xA9, 0xE0, ++0xFF, 0xE4, 0xFC, 0x74, 0x01, 0xFE, 0x74, 0x05, 0xFD, 0xE4, 0x90, 0x90, 0x24, 0x12, 0x27, 0x48, ++0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0xD1, 0x27, 0x22, 0xFD, 0xE4, 0x90, 0x90, 0x24, 0x12, 0x27, ++0x48, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x90, 0x90, 0x1E, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, ++0x90, 0x1D, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x3A, 0xA9, 0x90, 0x90, 0x28, 0x12, 0x27, ++0x48, 0x90, 0x90, 0x20, 0x12, 0x46, 0x7B, 0x12, 0x27, 0x15, 0x90, 0x90, 0x28, 0x12, 0x46, 0x87, ++0x12, 0x46, 0x61, 0x90, 0x90, 0x24, 0x12, 0x46, 0x87, 0x12, 0x46, 0x6E, 0x90, 0x90, 0x2C, 0x12, ++0x27, 0x48, 0x90, 0x90, 0x1E, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x90, 0x2C, 0x12, 0x46, 0x7B, ++0x90, 0xAC, 0x96, 0x12, 0x27, 0x48, 0x90, 0x90, 0x1D, 0xE0, 0xFF, 0xD0, 0x05, 0x02, 0x39, 0xBA, ++0x90, 0x90, 0xAA, 0xEF, 0xF0, 0xD3, 0x94, 0x0E, 0x50, 0x14, 0x90, 0x90, 0xA2, 0xE0, 0xFE, 0xA3, ++0xE0, 0xFF, 0x4E, 0x60, 0x20, 0xEF, 0x64, 0x01, 0x4E, 0x70, 0x1A, 0xFF, 0x41, 0xC6, 0x90, 0x90, ++0xAA, 0xE0, 0xD3, 0x94, 0x0E, 0x40, 0x0E, 0x90, 0x90, 0xA2, 0xE0, 0x70, 0x02, 0xA3, 0xE0, 0x70, ++0x04, 0x7F, 0x01, 0x51, 0xC6, 0x22, 0xEF, 0x14, 0x60, 0x39, 0x14, 0x60, 0x52, 0x24, 0x02, 0x70, ++0x6A, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x90, 0x24, 0x12, 0x27, ++0x54, 0x00, 0x00, 0x0C, 0x00, 0xD1, 0x21, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, ++0x00, 0x90, 0x90, 0x24, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0x7F, ++0x01, 0x80, 0x36, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x90, 0x24, ++0x12, 0x27, 0x54, 0x00, 0x00, 0x04, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x80, 0x1A, 0x90, ++0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x90, 0x24, 0x12, 0x27, 0x54, 0x00, ++0x00, 0x00, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0xD1, 0x27, 0x22, 0xE4, 0xFE, 0xFC, 0xEF, ++0x64, 0x02, 0x70, 0x40, 0xED, 0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, 0x06, 0xED, 0xB4, 0x02, 0x02, ++0x7E, 0x09, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x04, 0x80, 0x38, 0xEB, 0xB4, ++0x02, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, ++0x02, 0x04, 0x7C, 0x01, 0x80, 0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, 0xED, 0x64, 0x02, 0x70, 0x16, ++0x7C, 0x03, 0x80, 0x12, 0xEF, 0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x06, ++0xEB, 0xB4, 0x01, 0x02, 0x7C, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4C, 0xFF, 0x22, 0x90, ++0x8F, 0x58, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, ++0x22, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8F, 0x58, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, ++0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0x8F, 0x59, 0xF0, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x26, 0x1E, 0xFE, 0x20, 0xE0, 0x06, 0x12, ++0x4F, 0xA7, 0x02, 0x78, 0x7C, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFD, 0x90, 0x8E, 0x41, 0xE0, ++0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xED, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, ++0x26, 0x1E, 0xFD, 0x54, 0x04, 0xFC, 0xEF, 0x54, 0xFB, 0x4C, 0xFF, 0x90, 0x8E, 0x41, 0xF0, 0xED, ++0x54, 0x08, 0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFD, 0x54, 0x10, 0xFC, ++0xEF, 0x54, 0xEF, 0x4C, 0xFF, 0x90, 0x8E, 0x41, 0xF0, 0xED, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, ++0x4D, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFD, 0x54, 0x40, 0xFC, 0xEF, 0x54, 0xBF, 0x4C, 0xFF, 0x90, ++0x8E, 0x41, 0xF0, 0xED, 0x54, 0x80, 0xFD, 0xEF, 0x54, 0x7F, 0x4D, 0xF0, 0x90, 0x00, 0x01, 0x12, ++0x26, 0x37, 0x54, 0x80, 0xFF, 0x90, 0x8E, 0x42, 0xE0, 0x54, 0x7F, 0x4F, 0xF0, 0xEE, 0x13, 0x13, ++0x54, 0x3F, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x04, 0xF0, 0x12, 0x26, 0x1E, 0x13, ++0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x8D, ++0x01, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8F, 0x74, 0x12, 0x46, 0xA8, 0xE4, 0x90, ++0x8F, 0x77, 0xF0, 0x90, 0x8F, 0x74, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x04, 0xF9, 0xE4, 0x3A, 0x8B, ++0x40, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x78, 0x12, 0x34, ++0x2C, 0x90, 0x8F, 0x78, 0xE0, 0x20, 0xE0, 0x05, 0x90, 0x8F, 0x4B, 0x80, 0x03, 0x90, 0x8F, 0x4C, ++0xE0, 0x90, 0x8E, 0x56, 0xF0, 0x90, 0x8E, 0x56, 0xE0, 0x14, 0x60, 0x11, 0x14, 0x60, 0x16, 0x24, ++0xFE, 0x60, 0x12, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x06, 0x80, 0x10, 0x90, 0x8F, 0x77, ++0x74, 0x04, 0xF0, 0x80, 0x0D, 0x90, 0x8F, 0x77, 0x74, 0x08, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x8F, ++0x77, 0xF0, 0x90, 0x8F, 0x77, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x90, 0x7A, 0xED, ++0xF0, 0x90, 0x90, 0x77, 0x12, 0x46, 0xA8, 0xE4, 0x90, 0x90, 0x7B, 0xF0, 0xA3, 0xF0, 0x31, 0xA6, ++0x90, 0x90, 0x7B, 0xEF, 0xF0, 0x90, 0x90, 0x77, 0x12, 0x46, 0x9F, 0x11, 0x81, 0x90, 0x90, 0x7C, ++0xEF, 0xF0, 0x90, 0x8E, 0x56, 0xE0, 0x24, 0xFE, 0x60, 0x1D, 0x24, 0xFE, 0x60, 0x19, 0x14, 0x60, ++0x07, 0x14, 0x60, 0x04, 0x24, 0x05, 0x70, 0x5F, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0x57, 0x90, 0x90, ++0x7A, 0xE0, 0xFD, 0x31, 0xCA, 0x80, 0x22, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0x5F, 0x90, 0x90, 0x5E, ++0x12, 0x46, 0xA8, 0x90, 0x90, 0x7A, 0xE0, 0x90, 0x90, 0x61, 0xF0, 0x90, 0x8E, 0x56, 0xE0, 0x90, ++0x90, 0x62, 0xF0, 0x7A, 0x8E, 0x79, 0x57, 0x51, 0x44, 0x90, 0x90, 0x7C, 0xE0, 0xFF, 0x90, 0x90, ++0x77, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x7B, 0xE0, 0x7C, 0x00, 0x29, 0xF9, 0xEC, 0x3A, 0xFA, 0xC3, ++0xE9, 0x9F, 0xF9, 0xEA, 0x94, 0x00, 0xFA, 0x75, 0x40, 0x01, 0x75, 0x41, 0x8E, 0x75, 0x42, 0x57, ++0xA3, 0xE0, 0xF5, 0x43, 0x12, 0x34, 0x2C, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x24, 0x28, 0xF9, ++0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xE4, 0x90, 0x8F, 0x73, 0xF0, 0xFF, 0x12, 0x26, 0x1E, 0x30, ++0xE7, 0x08, 0x90, 0x8F, 0x73, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x8F, 0x73, 0xF0, 0x11, ++0x81, 0x90, 0x8F, 0x73, 0xE0, 0x24, 0x18, 0x2F, 0xFF, 0x22, 0x90, 0x90, 0x66, 0xED, 0xF0, 0x90, ++0x90, 0x63, 0x12, 0x46, 0xA8, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x90, 0x90, 0x6A, 0xF0, 0x90, ++0x90, 0x63, 0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x03, 0x7B, 0x01, ++0x7A, 0x90, 0x79, 0x67, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x66, 0xE0, 0x70, 0x46, 0xFF, 0x74, 0x67, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, 0xB4, 0xFF, 0x0E, 0x74, 0x67, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x0F, 0x74, 0x67, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0x90, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x03, 0xD0, 0x75, 0x40, ++0x01, 0x75, 0x41, 0x90, 0x75, 0x42, 0x67, 0x75, 0x43, 0x03, 0x90, 0x90, 0x63, 0x12, 0x46, 0x9F, ++0x12, 0x34, 0x2C, 0x22, 0x90, 0x90, 0x5B, 0x12, 0x46, 0xA8, 0x90, 0x90, 0x61, 0xE0, 0x60, 0x02, ++0x61, 0x18, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x12, 0x26, 0x1E, 0xF4, 0x60, 0x02, 0x61, 0x0D, ++0x12, 0x26, 0x64, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xF4, ++0x60, 0x02, 0x41, 0xFD, 0x90, 0x00, 0x01, 0x12, 0x26, 0x76, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, ++0xF4, 0x70, 0x6F, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x02, 0xE4, 0x12, 0x26, 0x76, ++0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xF4, 0x70, 0x4E, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, ++0x00, 0x03, 0xE4, 0x12, 0x26, 0x76, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xF4, 0x70, 0x2D, 0x90, ++0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x04, 0xE4, 0x12, 0x26, 0x76, 0x90, 0x00, 0x05, 0x12, ++0x26, 0x37, 0x90, 0x90, 0x5E, 0xB4, 0xFF, 0x0C, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x05, 0xE4, 0x12, ++0x26, 0x76, 0x80, 0x44, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x05, 0x80, 0x2A, 0x90, 0x90, 0x5E, 0x12, ++0x46, 0x9F, 0x90, 0x00, 0x04, 0x80, 0x1F, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x03, ++0x80, 0x14, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x02, 0x80, 0x09, 0x90, 0x90, 0x5E, ++0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0x74, 0x01, 0x12, 0x46, 0x18, 0x80, 0x0B, 0x90, 0x90, 0x5E, ++0x12, 0x46, 0x9F, 0x74, 0x01, 0x12, 0x45, 0xF6, 0x90, 0x90, 0x62, 0xE0, 0xFF, 0x64, 0x04, 0x60, ++0x02, 0x61, 0xC7, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x12, 0x26, 0x1E, 0xFE, 0x90, 0x90, 0x5B, ++0x12, 0x46, 0x9F, 0xEE, 0x12, 0x26, 0x64, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, ++0x12, 0x26, 0x37, 0xFE, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, ++0x76, 0x90, 0x00, 0x02, 0xE4, 0x12, 0x26, 0x76, 0x90, 0x00, 0x03, 0x74, 0x20, 0x12, 0x26, 0x76, ++0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFE, 0x90, 0x90, 0x5B, ++0x12, 0x46, 0x9F, 0x90, 0x00, 0x04, 0xEE, 0x12, 0x26, 0x76, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, ++0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFE, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x05, ++0xEE, 0x12, 0x26, 0x76, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, ++0xFE, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x06, 0xEE, 0x12, 0x26, 0x76, 0x90, 0x90, ++0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFE, 0x90, 0x90, 0x5B, 0x12, 0x46, ++0x9F, 0x90, 0x00, 0x07, 0xEE, 0x81, 0x87, 0xEF, 0x64, 0x02, 0x60, 0x02, 0x81, 0x8A, 0x90, 0x90, ++0x5E, 0x12, 0x46, 0x9F, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0xEF, 0x12, ++0x26, 0x64, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x44, 0x20, ++0x54, 0x7F, 0xFF, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, ++0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0x90, 0x90, 0x5B, ++0x12, 0x46, 0x9F, 0x90, 0x00, 0x02, 0xEF, 0x12, 0x26, 0x76, 0x90, 0x00, 0x03, 0x74, 0x20, 0x12, ++0x26, 0x76, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x90, ++0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x04, 0xEF, 0x12, 0x26, 0x76, 0x90, 0x90, 0x5E, 0x12, ++0x46, 0x9F, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFF, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, ++0x00, 0x05, 0xEF, 0x12, 0x26, 0x76, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x04, 0x12, ++0x26, 0x37, 0xFF, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x06, 0xEF, 0x12, 0x26, 0x76, ++0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFF, 0x90, 0x90, 0x5B, ++0x12, 0x46, 0x9F, 0x90, 0x00, 0x07, 0xEF, 0x12, 0x26, 0x76, 0x22, 0x91, 0xEA, 0x7E, 0x00, 0x74, ++0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x08, ++0x7B, 0x01, 0x7A, 0x8E, 0x79, 0x57, 0x12, 0x34, 0x2C, 0x90, 0x8E, 0x57, 0xE0, 0x90, 0x8E, 0x5F, ++0xF0, 0x90, 0x8E, 0x58, 0xE0, 0x90, 0x8E, 0x60, 0xF0, 0x90, 0x8E, 0x59, 0xE0, 0x90, 0x8E, 0x61, ++0xF0, 0x90, 0x8E, 0x5A, 0xE0, 0x90, 0x8E, 0x62, 0xF0, 0x90, 0x8E, 0x5B, 0xE0, 0x90, 0x8E, 0x63, ++0xF0, 0x90, 0x8E, 0x5C, 0xE0, 0x90, 0x8E, 0x64, 0xF0, 0x90, 0x8E, 0x5D, 0xE0, 0x90, 0x8E, 0x65, ++0xF0, 0x90, 0x8E, 0x5E, 0xE0, 0x90, 0x8E, 0x66, 0xF0, 0x22, 0xE4, 0xFE, 0xEF, 0x25, 0xE0, 0xFD, ++0xEF, 0xC3, 0x94, 0x80, 0x90, 0xFD, 0x12, 0x50, 0x04, 0xE4, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, ++0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x90, 0x90, 0x07, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, ++0x78, 0x0F, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x50, 0x7E, 0x00, 0x7F, 0x06, ++0x12, 0x45, 0xD0, 0x78, 0x15, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x56, 0x7E, ++0x00, 0x7F, 0x04, 0x12, 0x45, 0xD0, 0x78, 0x19, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, ++0x79, 0x5A, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x45, 0xD0, 0x90, 0x90, 0x08, 0xE0, 0xFF, 0x90, 0x90, ++0x07, 0xE0, 0x2F, 0xFF, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x64, 0x08, ++0x60, 0x02, 0xC1, 0x4D, 0x74, 0x07, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x64, ++0x06, 0x60, 0x02, 0xC1, 0x4D, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x90, 0x07, 0xE0, ++0x24, 0x0A, 0xF9, 0xE4, 0x34, 0xFB, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, ++0x7B, 0x01, 0x7A, 0x90, 0x79, 0x09, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x08, 0xE0, 0xFF, 0x90, 0x90, ++0x07, 0xE0, 0x2F, 0x24, 0x10, 0xF9, 0xE4, 0x34, 0xFB, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, ++0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x0F, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x08, 0xE0, ++0xFF, 0x90, 0x90, 0x07, 0xE0, 0x2F, 0x24, 0x16, 0xF9, 0xE4, 0x34, 0xFB, 0x75, 0x40, 0x01, 0xF5, ++0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x15, 0x12, 0x34, 0x2C, 0x78, ++0x09, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0x46, 0x7E, 0x00, 0x7F, 0x06, 0x12, ++0x48, 0x5D, 0xEF, 0x70, 0x58, 0x90, 0x90, 0x08, 0xE0, 0xFF, 0x90, 0x90, 0x07, 0xE0, 0x2F, 0x24, ++0x20, 0xF9, 0xE4, 0x34, 0xFB, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, ++0x01, 0x7A, 0x90, 0x79, 0x19, 0x12, 0x34, 0x2C, 0x78, 0x19, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0x01, ++0x7A, 0x8E, 0x79, 0x52, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x48, 0x5D, 0xEF, 0x70, 0x18, 0x7B, 0x01, ++0x7A, 0x90, 0x79, 0x0F, 0x90, 0x90, 0x54, 0x12, 0x46, 0xA8, 0xE4, 0x90, 0x90, 0x57, 0xF0, 0x7A, ++0x90, 0x79, 0x15, 0x02, 0x6F, 0x12, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x02, ++0x09, 0xE0, 0x90, 0x8F, 0x71, 0xF0, 0x12, 0x26, 0x1E, 0x90, 0x8F, 0x4B, 0xF0, 0x90, 0x00, 0x01, ++0x12, 0x26, 0x37, 0x90, 0x8F, 0x4C, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, ++0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8F, 0x4D, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, ++0xED, 0x2F, 0x90, 0x8F, 0x4E, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, ++0x8F, 0x4F, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x50, 0xF0, ++0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x51, 0xF0, 0x90, 0x00, 0x05, ++0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x52, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x26, 0x37, ++0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x8F, 0x53, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, ++0x26, 0x1E, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8F, 0x54, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, ++0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x55, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xAE, ++0x05, 0xED, 0x2F, 0x90, 0x8F, 0x56, 0xF0, 0x22, 0x90, 0x8F, 0x5B, 0xE0, 0x30, 0xE0, 0x2D, 0x90, ++0x8F, 0x5E, 0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x90, 0x8F, 0x5C, 0xE0, 0xB5, 0x07, 0x1E, 0x90, 0x06, ++0x92, 0xE0, 0x54, 0x1C, 0x70, 0x0B, 0x12, 0x4E, 0xC0, 0x90, 0x8F, 0x5F, 0xE0, 0x04, 0xF0, 0x80, ++0x06, 0x90, 0x06, 0x92, 0x74, 0x1C, 0xF0, 0xE4, 0x90, 0x8F, 0x5E, 0xF0, 0x22, 0x12, 0x4D, 0x3A, ++0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8F, 0x5B, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, ++0xC3, 0x13, 0x30, 0xE0, 0x14, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0x8F, 0x5C, 0xF0, 0x90, ++0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0x8F, 0x5D, 0xF0, 0x22, 0xE4, 0x90, 0x8E, 0x27, 0xF0, 0xA3, ++0xF0, 0x90, 0x8E, 0x26, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x54, ++0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x90, 0x8E, 0x2D, 0x74, 0x01, 0xF0, 0xA3, 0xF0, ++0x90, 0x8E, 0x24, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x8E, 0x30, ++0xF0, 0x90, 0x8E, 0x2F, 0x74, 0x07, 0xF0, 0x90, 0x8E, 0x32, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF0, ++0xE4, 0x90, 0x8E, 0x2B, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x29, 0x74, ++0x0C, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x0C, 0xF0, 0x90, ++0x8E, 0x24, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, ++0xF0, 0x54, 0xF7, 0xF0, 0x90, 0x8E, 0x34, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x90, 0x8D, ++0x01, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0x8E, 0x31, 0x74, 0xFF, 0xF0, 0x80, 0x12, 0x90, 0x8D, 0x01, ++0xE0, 0x90, 0x8E, 0x31, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x41, 0xF0, 0x90, ++0x8E, 0x38, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x07, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, ++0xA3, 0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x8E, ++0x24, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x8E, 0x30, 0xF0, 0x90, 0x8E, 0x2B, 0xF0, 0x22, 0xEF, ++0x24, 0xFE, 0x60, 0x0C, 0x04, 0x70, 0x28, 0x90, 0x8E, 0x2D, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x22, ++0xED, 0x70, 0x0A, 0x90, 0x8E, 0x3B, 0xE0, 0x90, 0x8E, 0x2D, 0xF0, 0x80, 0x05, 0x90, 0x8E, 0x2D, ++0xED, 0xF0, 0x90, 0x8E, 0x2D, 0xE0, 0xA3, 0xF0, 0x90, 0x8E, 0x25, 0xE0, 0x44, 0x08, 0xF0, 0x22, ++0x12, 0x57, 0x8F, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x67, ++0x90, 0x8E, 0x2B, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, ++0x56, 0x90, 0x8E, 0x29, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, ++0xF0, 0x80, 0x44, 0xEF, 0x30, 0xE2, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x38, 0x90, ++0x8E, 0x2B, 0xE0, 0x30, 0xE4, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x29, 0x90, 0x8E, ++0x25, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x20, 0xF0, 0x80, ++0x16, 0x90, 0x8E, 0x3F, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x80, 0xF0, 0x80, 0x08, 0x90, ++0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x7F, 0x00, 0x22, ++0x90, 0x02, 0x87, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2C, 0x90, 0x8E, ++0x40, 0xE0, 0x30, 0xE0, 0x0E, 0x90, 0x02, 0x82, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, ++0xF0, 0x80, 0x17, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, ++0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, ++0x7F, 0x00, 0x22, 0xEF, 0x60, 0x3E, 0x90, 0x8D, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x36, 0x90, 0x8E, ++0x25, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, ++0xBF, 0xF0, 0xE4, 0xFF, 0x12, 0x4E, 0xC2, 0xBF, 0x01, 0x0E, 0x90, 0x8E, 0x24, 0xE0, 0x44, 0x40, ++0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x06, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, ++0xB8, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x54, ++0xBF, 0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x39, 0x90, ++0x8D, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x31, 0x90, 0x8E, 0x2E, 0xF0, 0x04, 0x60, 0x2A, 0x90, 0x8E, ++0x2B, 0xE0, 0x44, 0x10, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x2F, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, ++0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0x8E, ++0x2A, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x51, 0xAD, 0x22, 0x90, 0x8D, 0x04, 0xE0, 0xFF, 0x7D, 0x01, ++0x12, 0x4F, 0x3B, 0x8E, 0x0E, 0x8F, 0x0F, 0xAD, 0x0F, 0xAC, 0x0E, 0xAF, 0x0D, 0x12, 0x4E, 0xF0, ++0xAF, 0x0F, 0xAE, 0x0E, 0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x74, 0x0D, 0x2C, ++0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x01, 0xF0, 0x74, 0x0D, 0x2C, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, ++0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, ++0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, 0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, ++0x90, 0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xED, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0x8F, 0xB5, 0x12, 0x46, 0xA8, 0x90, 0x8F, 0xB8, 0xED, 0xF0, 0xE4, 0x90, 0x90, 0x04, 0xF0, 0x90, ++0x90, 0x04, 0xE0, 0xFF, 0xC3, 0x94, 0x40, 0x50, 0x14, 0x74, 0xC1, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x8F, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0x90, 0x04, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x90, 0x8F, 0xB5, ++0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x90, 0x8F, 0xB8, 0xE0, 0xF5, 0x43, 0x7B, ++0x01, 0x7A, 0x8F, 0x79, 0xC1, 0x12, 0x34, 0x2C, 0xE4, 0x90, 0x8F, 0xC0, 0xF0, 0x90, 0x8F, 0xC0, ++0xE0, 0xFF, 0xC3, 0x94, 0x40, 0x50, 0x16, 0x74, 0xC1, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, ++0x83, 0xE0, 0x64, 0x36, 0xF0, 0x90, 0x8F, 0xC0, 0xE0, 0x04, 0xF0, 0x80, 0xE0, 0x90, 0x8F, 0xB9, ++0x12, 0x46, 0x9F, 0x90, 0x8F, 0xBC, 0xE0, 0xFF, 0xF5, 0x82, 0x75, 0x83, 0x00, 0x74, 0x80, 0x12, ++0x26, 0x76, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xFF, 0xE5, 0xF0, 0x34, 0x02, 0xFC, 0x90, ++0x00, 0x7E, 0x12, 0x26, 0x76, 0xEF, 0x90, 0x00, 0x7F, 0x12, 0x26, 0x76, 0xE4, 0x90, 0x90, 0x01, ++0xF0, 0xA3, 0xF0, 0x90, 0x90, 0x01, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xC0, 0xEE, 0x94, ++0x00, 0x40, 0x02, 0x81, 0xB2, 0xC3, 0xEF, 0x94, 0x40, 0xEE, 0x94, 0x00, 0x50, 0x52, 0xA3, 0x74, ++0x40, 0xF0, 0x74, 0xC1, 0x2F, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0x74, 0x40, 0x44, 0x88, ++0xFD, 0x12, 0x30, 0xA4, 0x90, 0x90, 0x01, 0xA3, 0xE0, 0x24, 0xC5, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, ++0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x90, 0x01, 0xA3, 0xE0, 0x24, ++0xC9, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, 0x30, 0xA4, ++0x90, 0x90, 0x01, 0xA3, 0xE0, 0x24, 0xCD, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0x61, 0xF3, ++0xE4, 0x90, 0x90, 0x03, 0xF0, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, 0xE0, 0xFE, ++0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC0, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0x74, ++0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, 0xE0, 0xFE, ++0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC4, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, ++0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, ++0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC8, 0xF9, 0xEA, 0x34, 0xFF, ++0xFA, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, ++0x90, 0x01, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xCC, 0xF9, 0xEA, ++0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8B, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x90, 0x03, 0xE0, 0x44, ++0x90, 0x90, 0x01, 0x8C, 0xF0, 0xE4, 0x90, 0x90, 0x05, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, ++0x30, 0xE4, 0x22, 0xC3, 0x90, 0x90, 0x06, 0xE0, 0x94, 0xE8, 0x90, 0x90, 0x05, 0xE0, 0x94, 0x03, ++0x50, 0x13, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x90, 0x05, 0xE4, 0x75, 0xF0, 0x01, ++0x12, 0x46, 0x4B, 0x80, 0xD7, 0x90, 0x90, 0x05, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xE8, ++0xEE, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x01, 0xF0, 0xEE, 0x90, 0x06, 0x36, ++0xF0, 0x90, 0x90, 0x02, 0xE0, 0x54, 0x3F, 0x64, 0x30, 0x70, 0x4B, 0x90, 0x90, 0x05, 0xF0, 0xA3, ++0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x20, 0xE5, 0x22, 0xC3, 0x90, 0x90, 0x06, 0xE0, 0x94, 0xE8, 0x90, ++0x90, 0x05, 0xE0, 0x94, 0x03, 0x50, 0x13, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x90, ++0x05, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0x80, 0xD7, 0x90, 0x90, 0x05, 0xE0, 0xFE, 0xA3, ++0xE0, 0xFF, 0xC3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x02, ++0xF0, 0xEE, 0x90, 0x06, 0x36, 0xF0, 0x90, 0x90, 0x01, 0xE4, 0x75, 0xF0, 0x10, 0x12, 0x46, 0x4B, ++0x61, 0x03, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x10, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, ++0x80, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x0C, 0xF9, 0xE4, 0x3A, ++0xFA, 0x7D, 0x81, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x08, 0xF9, ++0xE4, 0x3A, 0xFA, 0x7D, 0x82, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, 0xE9, 0x24, ++0x04, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x83, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, ++0x7D, 0x84, 0x12, 0x33, 0x2F, 0xE4, 0x90, 0x90, 0x04, 0xF0, 0x90, 0x90, 0x04, 0xE0, 0xFF, 0xC3, ++0x94, 0x40, 0x50, 0x14, 0x74, 0xC1, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE4, 0xF0, ++0x90, 0x90, 0x04, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x90, 0x8F, 0xB5, 0x12, 0x46, 0x9F, 0x8B, 0x40, ++0x8A, 0x41, 0x89, 0x42, 0x90, 0x8F, 0xB8, 0xE0, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xC1, ++0x12, 0x34, 0x2C, 0xE4, 0x90, 0x8F, 0xC0, 0xF0, 0x90, 0x8F, 0xC0, 0xE0, 0xFF, 0xC3, 0x94, 0x40, ++0x50, 0x16, 0x74, 0xC1, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE0, 0x64, 0x5C, 0xF0, ++0x90, 0x8F, 0xC0, 0xE0, 0x04, 0xF0, 0x80, 0xE0, 0xE4, 0x90, 0x8F, 0xC0, 0xF0, 0x90, 0x8F, 0xBD, ++0x12, 0x46, 0x9F, 0x90, 0x8F, 0xC0, 0xE0, 0xFF, 0xF5, 0x82, 0x75, 0x83, 0x00, 0x12, 0x26, 0x37, ++0xFE, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xEE, 0x12, 0x26, 0x76, ++0x90, 0x8F, 0xC0, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0xD3, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, ++0x90, 0x00, 0x14, 0x74, 0x80, 0x12, 0x26, 0x76, 0x90, 0x8F, 0xC0, 0x74, 0x15, 0xF0, 0x90, 0x8F, ++0xC0, 0xE0, 0xFF, 0xC3, 0x94, 0x3E, 0x50, 0x17, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x8F, 0x82, ++0x75, 0x83, 0x00, 0xE4, 0x12, 0x26, 0x76, 0x90, 0x8F, 0xC0, 0xE0, 0x04, 0xF0, 0x80, 0xDF, 0x90, ++0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x3E, 0x74, 0x02, 0x12, 0x26, 0x76, 0x90, 0x00, 0x3F, ++0x74, 0xA0, 0x12, 0x26, 0x76, 0xE4, 0x90, 0x90, 0x01, 0xF0, 0xA3, 0xF0, 0x90, 0x90, 0x01, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0x80, 0xEE, 0x94, 0x00, 0x40, 0x02, 0xE1, 0x9B, 0xC3, 0xEF, ++0x94, 0x40, 0xEE, 0x94, 0x00, 0x50, 0x52, 0xA3, 0x74, 0x40, 0xF0, 0x74, 0xC1, 0x2F, 0xF9, 0xE4, ++0x34, 0x8F, 0xFA, 0x7B, 0x01, 0x74, 0x40, 0x44, 0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x90, 0x01, ++0xA3, 0xE0, 0x24, 0xC5, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x89, 0xFD, ++0x12, 0x30, 0xA4, 0x90, 0x90, 0x01, 0xA3, 0xE0, 0x24, 0xC9, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, ++0x01, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x90, 0x01, 0xA3, 0xE0, 0x24, 0xCD, ++0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0xC1, 0xDC, 0xE4, 0x90, 0x90, 0x03, 0xF0, 0x90, 0x8F, ++0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, ++0xE9, 0x24, 0xC0, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0x74, 0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, ++0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, ++0xE9, 0x24, 0xC4, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, ++0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, ++0x3E, 0xFA, 0xE9, 0x24, 0xC8, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, ++0x30, 0xA4, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, ++0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xCC, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8B, ++0xFD, 0x12, 0x30, 0xA4, 0x90, 0x90, 0x03, 0xE0, 0x44, 0x90, 0x90, 0x01, 0x8C, 0xF0, 0xE4, 0x90, ++0x90, 0x05, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x30, 0xE4, 0x22, 0xC3, 0x90, 0x90, 0x06, ++0xE0, 0x94, 0xE8, 0x90, 0x90, 0x05, 0xE0, 0x94, 0x03, 0x50, 0x13, 0x7F, 0x01, 0x7E, 0x00, 0x12, ++0x3A, 0xF7, 0x90, 0x90, 0x05, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0x80, 0xD7, 0x90, 0x90, ++0x05, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x06, ++0x31, 0xE0, 0x44, 0x01, 0xF0, 0xEE, 0x90, 0x06, 0x36, 0xF0, 0x90, 0x90, 0x02, 0xE0, 0x54, 0x3F, ++0x64, 0x30, 0x70, 0x4B, 0x90, 0x90, 0x05, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x20, 0xE5, ++0x22, 0xC3, 0x90, 0x90, 0x06, 0xE0, 0x94, 0xE8, 0x90, 0x90, 0x05, 0xE0, 0x94, 0x03, 0x50, 0x13, ++0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x90, 0x05, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, ++0x4B, 0x80, 0xD7, 0x90, 0x90, 0x05, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xE8, 0xEE, 0x94, ++0x03, 0x40, 0x0C, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x02, 0xF0, 0xEE, 0x90, 0x06, 0x36, 0xF0, 0x90, ++0x90, 0x01, 0xE4, 0x75, 0xF0, 0x10, 0x12, 0x46, 0x4B, 0xA1, 0xEC, 0x90, 0x8F, 0xBD, 0x12, 0x46, ++0x9F, 0xE9, 0x24, 0x10, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x80, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xBD, ++0x12, 0x46, 0x9F, 0xE9, 0x24, 0x0C, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x81, 0x12, 0x33, 0x2F, 0x90, ++0x8F, 0xBD, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x08, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x82, 0x12, 0x33, ++0x2F, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x04, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x83, ++0x12, 0x33, 0x2F, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, 0x7D, 0x84, 0x12, 0x33, 0x2F, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x00, 0xFD, 0x15, ++}; ++ ++static u4Byte ArrayLength_TC_8812A_FW_WoWLAN = 18454; ++ ++static void ++ODM_ReadFirmware_TC_8812A_FW_WoWLAN( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++) ++{ ++ ODM_MoveMemory(pDM_Odm, pFirmware, Array_TC_8812A_FW_WoWLAN, ArrayLength_TC_8812A_FW_WoWLAN); ++ *pFirmwareSize = ArrayLength_TC_8812A_FW_WoWLAN; ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.h 2018-02-06 17:42:30.706967105 +0200 +@@ -0,0 +1,42 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#ifndef __INC_TC_FW_HW_IMG_8812A_H ++#define __INC_TC_FW_HW_IMG_8812A_H ++ ++ ++/****************************************************************************** ++* FW_NIC.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadFirmware_TC_8812A_FW_NIC( ++ IN PDM_ODM_T pDM_Odm, ++ OUT u1Byte *pFirmware, ++ OUT u4Byte *pFirmwareSize ++); ++ ++/****************************************************************************** ++* FW_WoWLAN.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadFirmware_TC_8812A_FW_WoWLAN( ++ IN PDM_ODM_T pDM_Odm, ++ OUT u1Byte *pFirmware, ++ OUT u4Byte *pFirmwareSize ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.c 2018-02-06 17:42:30.706967105 +0200 +@@ -0,0 +1,224 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#include "odm_precomp.h" ++ ++static bool ++CheckCondition( ++ const u4Byte Condition, ++ const u4Byte Hex ++ ) ++{ ++ u4Byte _board = (Hex & 0x000000FF); ++ u4Byte _interface = (Hex & 0x0000FF00) >> 8; ++ u4Byte _platform = (Hex & 0x00FF0000) >> 16; ++ u4Byte cond = Condition; ++ ++ if ( Condition == 0xCDCDCDCD ) ++ return true; ++ ++ cond = Condition & 0x000000FF; ++ if ( (_board != cond) && (cond != 0xFF) ) ++ return false; ++ ++ cond = Condition & 0x0000FF00; ++ cond = cond >> 8; ++ if ( ((_interface & cond) == 0) && (cond != 0x07) ) ++ return false; ++ ++ cond = Condition & 0x00FF0000; ++ cond = cond >> 16; ++ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) ++ return false; ++ return true; ++} ++ ++ ++/****************************************************************************** ++* MAC_REG.TXT ++******************************************************************************/ ++ ++static u4Byte Array_TC_8812A_MAC_REG[] = { ++ 0x010, 0x0000000C, ++ 0x072, 0x00000000, ++ 0x428, 0x0000000A, ++ 0x429, 0x00000010, ++ 0x430, 0x00000000, ++ 0x431, 0x00000000, ++ 0x432, 0x00000000, ++ 0x433, 0x00000001, ++ 0x434, 0x00000004, ++ 0x435, 0x00000005, ++ 0x436, 0x00000007, ++ 0x437, 0x00000008, ++ 0x43C, 0x00000004, ++ 0x43D, 0x00000005, ++ 0x43E, 0x00000007, ++ 0x43F, 0x00000008, ++ 0x440, 0x0000005D, ++ 0x441, 0x00000001, ++ 0x442, 0x00000000, ++ 0x444, 0x00000010, ++ 0x445, 0x00000000, ++ 0x446, 0x00000000, ++ 0x447, 0x00000000, ++ 0x448, 0x00000000, ++ 0x449, 0x000000F0, ++ 0x44A, 0x0000000F, ++ 0x44B, 0x0000003E, ++ 0x44C, 0x00000010, ++ 0x44D, 0x00000000, ++ 0x44E, 0x00000000, ++ 0x44F, 0x00000000, ++ 0x450, 0x00000000, ++ 0x451, 0x000000F0, ++ 0x452, 0x0000000F, ++ 0x453, 0x00000000, ++ 0x45B, 0x00000080, ++ 0x460, 0x00000066, ++ 0x461, 0x00000066, ++ 0x4C8, 0x000000FF, ++ 0x4C9, 0x00000008, ++ 0x4CC, 0x000000FF, ++ 0x4CD, 0x000000FF, ++ 0x4CE, 0x00000001, ++ 0x500, 0x00000026, ++ 0x501, 0x000000A2, ++ 0x502, 0x0000002F, ++ 0x503, 0x00000000, ++ 0x504, 0x00000028, ++ 0x505, 0x000000A3, ++ 0x506, 0x0000005E, ++ 0x507, 0x00000000, ++ 0x508, 0x0000002B, ++ 0x509, 0x000000A4, ++ 0x50A, 0x0000005E, ++ 0x50B, 0x00000000, ++ 0x50C, 0x0000004F, ++ 0x50D, 0x000000A4, ++ 0x50E, 0x00000000, ++ 0x50F, 0x00000000, ++ 0x512, 0x0000001C, ++ 0x514, 0x0000000A, ++ 0x516, 0x0000000A, ++ 0x525, 0x0000004F, ++ 0x550, 0x00000010, ++ 0x551, 0x00000010, ++ 0x559, 0x00000002, ++ 0x55C, 0x00000050, ++ 0x55D, 0x000000FF, ++ 0x604, 0x00000009, ++ 0x605, 0x00000030, ++ 0x607, 0x00000007, ++ 0x608, 0x0000000E, ++ 0x609, 0x0000002A, ++ 0x620, 0x000000FF, ++ 0x621, 0x000000FF, ++ 0x622, 0x000000FF, ++ 0x623, 0x000000FF, ++ 0x624, 0x000000FF, ++ 0x625, 0x000000FF, ++ 0x626, 0x000000FF, ++ 0x627, 0x000000FF, ++ 0x638, 0x00000050, ++ 0x63C, 0x0000000A, ++ 0x63D, 0x0000000A, ++ 0x63E, 0x0000000E, ++ 0x63F, 0x0000000E, ++ 0x640, 0x00000040, ++ 0x642, 0x00000040, ++ 0x643, 0x00000000, ++ 0x66E, 0x00000005, ++ 0x700, 0x00000021, ++ 0x701, 0x00000043, ++ 0x702, 0x00000065, ++ 0x703, 0x00000087, ++ 0x708, 0x00000021, ++ 0x709, 0x00000043, ++ 0x70A, 0x00000065, ++ 0x70B, 0x00000087, ++ 0x718, 0x00000040, ++ ++}; ++ ++static void ++ODM_ReadAndConfig_TC_8812A_MAC_REG( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_TC_8812A_MAC_REG)/sizeof(u4Byte); ++ pu4Byte Array = Array_TC_8812A_MAC_REG; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_MAC_REG, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigMAC_8812A(pDM_Odm, v1, (u1Byte)v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigMAC_8812A(pDM_Odm, v1, (u1Byte)v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.h 2018-02-06 17:42:30.706967105 +0200 +@@ -0,0 +1,30 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#ifndef __INC_TC_MAC_HW_IMG_8812A_H ++#define __INC_TC_MAC_HW_IMG_8812A_H ++ ++static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); ++ ++/****************************************************************************** ++* MAC_REG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8812A_MAC_REG( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.c 2018-02-06 17:42:30.706967105 +0200 +@@ -0,0 +1,1893 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#include "odm_precomp.h" ++ ++static bool ++CheckCondition( ++ u4Byte Condition, ++ u4Byte Hex ++ ) ++{ ++ u4Byte _board = (Hex & 0x000000FF); ++ u4Byte _interface = (Hex & 0x0000FF00) >> 8; ++ u4Byte _platform = (Hex & 0x00FF0000) >> 16; ++ u4Byte cond = Condition; ++ ++ if ( Condition == 0xCDCDCDCD ) ++ return true; ++ ++ cond = Condition & 0x000000FF; ++ if ( (_board != cond) && (cond != 0xFF) ) ++ return false; ++ ++ cond = Condition & 0x0000FF00; ++ cond = cond >> 8; ++ if ( ((_interface & cond) == 0) && (cond != 0x07) ) ++ return false; ++ ++ cond = Condition & 0x00FF0000; ++ cond = cond >> 16; ++ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) ++ return false; ++ return true; ++} ++ ++ ++/****************************************************************************** ++* RadioA.TXT ++******************************************************************************/ ++ ++static u4Byte Array_TC_8812A_RadioA[] = { ++ 0x000, 0x00010000, ++ 0x018, 0x0001712A, ++ 0x056, 0x00051CF2, ++ 0x066, 0x00040000, ++ 0x01E, 0x000F8000, ++ 0x089, 0x00000080, ++ 0xFF0F0740, 0xABCD, ++ 0x086, 0x00014B38, ++ 0xFF0F07C0, 0xCDEF, ++ 0x086, 0x00014B38, ++ 0xFF0F07D8, 0xCDEF, ++ 0x086, 0x00014B3C, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x086, 0x00014B38, ++ 0xFF0F0740, 0xDEAD, ++ 0x0B1, 0x0001FC1A, ++ 0x0B3, 0x000F0810, ++ 0x0B4, 0x0001A78D, ++ 0x0BA, 0x00086180, ++ 0x018, 0x00000006, ++ 0x0EF, 0x00002000, ++ 0x03B, 0x00038A58, ++ 0x03B, 0x00037A58, ++ 0x03B, 0x0002A590, ++ 0x03B, 0x00027A50, ++ 0x03B, 0x00018248, ++ 0x03B, 0x00010240, ++ 0x03B, 0x00008240, ++ 0x03B, 0x00000240, ++ 0x0EF, 0x00000100, ++ 0xFF0F07D8, 0xABCD, ++ 0x034, 0x0000A4EE, ++ 0x034, 0x00009076, ++ 0x034, 0x00008073, ++ 0x034, 0x00007070, ++ 0x034, 0x0000606D, ++ 0x034, 0x0000506A, ++ 0x034, 0x00004049, ++ 0x034, 0x00003046, ++ 0x034, 0x00002028, ++ 0x034, 0x00001025, ++ 0x034, 0x00000022, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0000ADF4, ++ 0x034, 0x00009DF1, ++ 0x034, 0x00008DEE, ++ 0x034, 0x00007DEB, ++ 0x034, 0x00006DE8, ++ 0x034, 0x00005CEC, ++ 0x034, 0x00004CE9, ++ 0x034, 0x000034EA, ++ 0x034, 0x000024E7, ++ 0x034, 0x0000146B, ++ 0x034, 0x0000006D, ++ 0xFF0F07D8, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x000020A2, ++ 0x0DF, 0x00000080, ++ 0x035, 0x00000192, ++ 0x035, 0x00008192, ++ 0x035, 0x00010192, ++ 0x036, 0x00000024, ++ 0x036, 0x00008024, ++ 0x036, 0x00010024, ++ 0x036, 0x00018024, ++ 0x0EF, 0x00000000, ++ 0x051, 0x00000C21, ++ 0x052, 0x000006D9, ++ 0x053, 0x000FC649, ++ 0x054, 0x0000017E, ++ 0x0EF, 0x00000002, ++ 0x008, 0x00008400, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00001000, ++ 0x03A, 0x00000080, ++ 0x03B, 0x0003A02C, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000400, ++ 0x03B, 0x0003202C, ++ 0x03C, 0x00010000, ++ 0x03A, 0x000000A0, ++ 0x03B, 0x0002B064, ++ 0x03C, 0x00004000, ++ 0x03A, 0x000000D8, ++ 0x03B, 0x00023070, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000468, ++ 0x03B, 0x0001B870, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000098, ++ 0x03B, 0x00012085, ++ 0x03C, 0x000E4000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x0000A080, ++ 0x03C, 0x000F0000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x00002080, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000080, ++ 0x03B, 0x0007A02C, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000400, ++ 0x03B, 0x0007202C, ++ 0x03C, 0x00010000, ++ 0x03A, 0x000000A0, ++ 0x03B, 0x0006B064, ++ 0x03C, 0x00004000, ++ 0x03A, 0x000000D8, ++ 0x03B, 0x00023070, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000468, ++ 0x03B, 0x0005B870, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000098, ++ 0x03B, 0x00052085, ++ 0x03C, 0x000E4000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x0004A080, ++ 0x03C, 0x000F0000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x00042080, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000080, ++ 0x03B, 0x000BA02C, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000400, ++ 0x03B, 0x000B202C, ++ 0x03C, 0x00010000, ++ 0x03A, 0x000000A0, ++ 0x03B, 0x000AB064, ++ 0x03C, 0x00004000, ++ 0x03A, 0x000000D8, ++ 0x03B, 0x000A3070, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000468, ++ 0x03B, 0x0009B870, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000098, ++ 0x03B, 0x00092085, ++ 0x03C, 0x000E4000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x0008A080, ++ 0x03C, 0x000F0000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x00082080, ++ 0x03C, 0x00010000, ++ 0x0EF, 0x00001100, ++ 0xFF0F0740, 0xABCD, ++ 0x034, 0x0004A0B2, ++ 0x034, 0x000490AF, ++ 0x034, 0x00048070, ++ 0x034, 0x0004706D, ++ 0x034, 0x00046050, ++ 0x034, 0x0004504D, ++ 0x034, 0x0004404A, ++ 0x034, 0x00043047, ++ 0x034, 0x0004200A, ++ 0x034, 0x00041007, ++ 0x034, 0x00040004, ++ 0xFF0F07C0, 0xCDEF, ++ 0x034, 0x0004A0B2, ++ 0x034, 0x000490AF, ++ 0x034, 0x00048070, ++ 0x034, 0x0004706D, ++ 0x034, 0x00046050, ++ 0x034, 0x0004504D, ++ 0x034, 0x0004404A, ++ 0x034, 0x00043047, ++ 0x034, 0x0004200A, ++ 0x034, 0x00041007, ++ 0x034, 0x00040004, ++ 0xFF0F07D8, 0xCDEF, ++ 0x034, 0x0004A0B2, ++ 0x034, 0x000490AF, ++ 0x034, 0x00048070, ++ 0x034, 0x0004706D, ++ 0x034, 0x00046050, ++ 0x034, 0x0004504D, ++ 0x034, 0x0004404A, ++ 0x034, 0x00043047, ++ 0x034, 0x0004200A, ++ 0x034, 0x00041007, ++ 0x034, 0x00040004, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0004ADF5, ++ 0x034, 0x00049DF2, ++ 0x034, 0x00048DEF, ++ 0x034, 0x00047DEC, ++ 0x034, 0x00046DE9, ++ 0x034, 0x00045DC9, ++ 0x034, 0x00044CE8, ++ 0x034, 0x000438CA, ++ 0x034, 0x00042889, ++ 0x034, 0x0004184A, ++ 0x034, 0x0004044A, ++ 0xFF0F0740, 0xDEAD, ++ 0xFF0F0740, 0xABCD, ++ 0x034, 0x0002A0B2, ++ 0x034, 0x000290AF, ++ 0x034, 0x00028070, ++ 0x034, 0x0002706D, ++ 0x034, 0x00026050, ++ 0x034, 0x0002504D, ++ 0x034, 0x0002404A, ++ 0x034, 0x00023047, ++ 0x034, 0x0002200A, ++ 0x034, 0x00021007, ++ 0x034, 0x00020004, ++ 0xFF0F07C0, 0xCDEF, ++ 0x034, 0x0002A0B2, ++ 0x034, 0x000290AF, ++ 0x034, 0x00028070, ++ 0x034, 0x0002706D, ++ 0x034, 0x00026050, ++ 0x034, 0x0002504D, ++ 0x034, 0x0002404A, ++ 0x034, 0x00023047, ++ 0x034, 0x0002200A, ++ 0x034, 0x00021007, ++ 0x034, 0x00020004, ++ 0xFF0F07D8, 0xCDEF, ++ 0x034, 0x0002A0B2, ++ 0x034, 0x000290AF, ++ 0x034, 0x00028070, ++ 0x034, 0x0002706D, ++ 0x034, 0x00026050, ++ 0x034, 0x0002504D, ++ 0x034, 0x0002404A, ++ 0x034, 0x00023047, ++ 0x034, 0x0002200A, ++ 0x034, 0x00021007, ++ 0x034, 0x00020004, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0002ADF5, ++ 0x034, 0x00029DF2, ++ 0x034, 0x00028DEF, ++ 0x034, 0x00027DEC, ++ 0x034, 0x00026DE9, ++ 0x034, 0x00025DC9, ++ 0x034, 0x00024CE8, ++ 0x034, 0x000238CA, ++ 0x034, 0x00022889, ++ 0x034, 0x0002184A, ++ 0x034, 0x0002044A, ++ 0xFF0F0740, 0xDEAD, ++ 0xFF0F0740, 0xABCD, ++ 0x034, 0x0000A0B2, ++ 0x034, 0x000090AF, ++ 0x034, 0x00008070, ++ 0x034, 0x0000706D, ++ 0x034, 0x00006050, ++ 0x034, 0x0000504D, ++ 0x034, 0x0000404A, ++ 0x034, 0x00003047, ++ 0x034, 0x0000200A, ++ 0x034, 0x00001007, ++ 0x034, 0x00000004, ++ 0xFF0F07C0, 0xCDEF, ++ 0x034, 0x0000A0B2, ++ 0x034, 0x000090AF, ++ 0x034, 0x00008070, ++ 0x034, 0x0000706D, ++ 0x034, 0x00006050, ++ 0x034, 0x0000504D, ++ 0x034, 0x0000404A, ++ 0x034, 0x00003047, ++ 0x034, 0x0000200A, ++ 0x034, 0x00001007, ++ 0x034, 0x00000004, ++ 0xFF0F07D8, 0xCDEF, ++ 0x034, 0x0000A0B2, ++ 0x034, 0x000090AF, ++ 0x034, 0x00008070, ++ 0x034, 0x0000706D, ++ 0x034, 0x00006050, ++ 0x034, 0x0000504D, ++ 0x034, 0x0000404A, ++ 0x034, 0x00003047, ++ 0x034, 0x0000200A, ++ 0x034, 0x00001007, ++ 0x034, 0x00000004, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0000AFF7, ++ 0x034, 0x00009DF7, ++ 0x034, 0x00008DF4, ++ 0x034, 0x00007DF1, ++ 0x034, 0x00006DEE, ++ 0x034, 0x00005DCD, ++ 0x034, 0x00004CEB, ++ 0x034, 0x000038CC, ++ 0x034, 0x0000288B, ++ 0x034, 0x0000184C, ++ 0x034, 0x0000044C, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0xFF0F0740, 0xABCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x000001D4, ++ 0x035, 0x000081D4, ++ 0x035, 0x000101D4, ++ 0x035, 0x000201B4, ++ 0x035, 0x000281B4, ++ 0x035, 0x000301B4, ++ 0x035, 0x000401B4, ++ 0x035, 0x000481B4, ++ 0x035, 0x000501B4, ++ 0xFF0F07C0, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x000001D4, ++ 0x035, 0x000081D4, ++ 0x035, 0x000101D4, ++ 0x035, 0x000201B4, ++ 0x035, 0x000281B4, ++ 0x035, 0x000301B4, ++ 0x035, 0x000401B4, ++ 0x035, 0x000481B4, ++ 0x035, 0x000501B4, ++ 0xFF0F07D8, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x000001D4, ++ 0x035, 0x000081D4, ++ 0x035, 0x000101D4, ++ 0x035, 0x000201B4, ++ 0x035, 0x000281B4, ++ 0x035, 0x000301B4, ++ 0x035, 0x000401B4, ++ 0x035, 0x000481B4, ++ 0x035, 0x000501B4, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x00000188, ++ 0x035, 0x00008188, ++ 0x035, 0x00010185, ++ 0x035, 0x000201D7, ++ 0x035, 0x000281D7, ++ 0x035, 0x000301D5, ++ 0x035, 0x000401D8, ++ 0x035, 0x000481D8, ++ 0x035, 0x000501D5, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0xFF0F0740, 0xABCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00004BFB, ++ 0x036, 0x0000CBFB, ++ 0x036, 0x00014BFB, ++ 0x036, 0x0001CBFB, ++ 0x036, 0x00024F4B, ++ 0x036, 0x0002CF4B, ++ 0x036, 0x00034F4B, ++ 0x036, 0x0003CF4B, ++ 0x036, 0x00044F4B, ++ 0x036, 0x0004CF4B, ++ 0x036, 0x00054F4B, ++ 0x036, 0x0005CF4B, ++ 0xFF0F07C0, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00004BFB, ++ 0x036, 0x0000CBFB, ++ 0x036, 0x00014BFB, ++ 0x036, 0x0001CBFB, ++ 0x036, 0x00024F4B, ++ 0x036, 0x0002CF4B, ++ 0x036, 0x00034F4B, ++ 0x036, 0x0003CF4B, ++ 0x036, 0x00044F4B, ++ 0x036, 0x0004CF4B, ++ 0x036, 0x00054F4B, ++ 0x036, 0x0005CF4B, ++ 0xFF0F07D8, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00004BFB, ++ 0x036, 0x0000CBFB, ++ 0x036, 0x00014BFB, ++ 0x036, 0x0001CBFB, ++ 0x036, 0x00024F4B, ++ 0x036, 0x0002CF4B, ++ 0x036, 0x00034F4B, ++ 0x036, 0x0003CF4B, ++ 0x036, 0x00044F4B, ++ 0x036, 0x0004CF4B, ++ 0x036, 0x00054F4B, ++ 0x036, 0x0005CF4B, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00084EB4, ++ 0x036, 0x0008C9B4, ++ 0x036, 0x000949B4, ++ 0x036, 0x0009C9B4, ++ 0x036, 0x000A4935, ++ 0x036, 0x000AC935, ++ 0x036, 0x000B4935, ++ 0x036, 0x000BC935, ++ 0x036, 0x000C4EB4, ++ 0x036, 0x000CCEB4, ++ 0x036, 0x000D4EB4, ++ 0x036, 0x000DCEB4, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x00000008, ++ 0xFF0F0740, 0xABCD, ++ 0x03C, 0x000002CC, ++ 0x03C, 0x00000522, ++ 0x03C, 0x00000902, ++ 0xFF0F07C0, 0xCDEF, ++ 0x03C, 0x000002CC, ++ 0x03C, 0x00000522, ++ 0x03C, 0x00000902, ++ 0xFF0F07D8, 0xCDEF, ++ 0x03C, 0x000002CC, ++ 0x03C, 0x00000522, ++ 0x03C, 0x00000902, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x03C, 0x000002AA, ++ 0x03C, 0x000005A2, ++ 0x03C, 0x00000880, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000002, ++ 0x0DF, 0x00000080, ++ 0x01F, 0x00040064, ++ 0xFF0F0740, 0xABCD, ++ 0x061, 0x000FDD43, ++ 0x062, 0x00038F4B, ++ 0x063, 0x00032117, ++ 0x064, 0x000194AC, ++ 0x065, 0x000931D1, ++ 0xFF0F07C0, 0xCDEF, ++ 0x061, 0x000FDD43, ++ 0x062, 0x00038F4B, ++ 0x063, 0x00032117, ++ 0x064, 0x000194AC, ++ 0x065, 0x000931D1, ++ 0xFF0F07D8, 0xCDEF, ++ 0x061, 0x000FDD43, ++ 0x062, 0x00038F4B, ++ 0x063, 0x00032117, ++ 0x064, 0x000194AC, ++ 0x065, 0x000931D1, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x061, 0x000E5D53, ++ 0x062, 0x00038FCD, ++ 0x063, 0x000314EB, ++ 0x064, 0x000196AC, ++ 0x065, 0x000931D7, ++ 0xFF0F0740, 0xDEAD, ++ 0x008, 0x00008400, ++ 0x01C, 0x000739D2, ++ 0x0B4, 0x0001E78D, ++ 0x018, 0x0001F12A, ++ 0x0FE, 0x00000000, ++ 0x0FE, 0x00000000, ++ 0x0FE, 0x00000000, ++ 0x0FE, 0x00000000, ++ 0x0B4, 0x0001A78D, ++ ++}; ++ ++static void ++ODM_ReadAndConfig_TC_8812A_RadioA( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_TC_8812A_RadioA)/sizeof(u4Byte); ++ static pu4Byte Array = Array_TC_8812A_RadioA; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_RadioA, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigRF_RadioA_8812A(pDM_Odm, v1, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigRF_RadioA_8812A(pDM_Odm, v1, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* RadioB.TXT ++******************************************************************************/ ++ ++static u4Byte Array_TC_8812A_RadioB[] = { ++ 0x056, 0x00051CF2, ++ 0x066, 0x00040000, ++ 0x089, 0x00000080, ++ 0xFF0F0740, 0xABCD, ++ 0x086, 0x00014B38, ++ 0xFF0F07C0, 0xCDEF, ++ 0x086, 0x00014B38, ++ 0xFF0F07D8, 0xCDEF, ++ 0x086, 0x00014B3C, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x086, 0x00014B38, ++ 0xFF0F0740, 0xDEAD, ++ 0x018, 0x00000006, ++ 0x0EF, 0x00002000, ++ 0x03B, 0x00038A58, ++ 0x03B, 0x00037A58, ++ 0x03B, 0x0002A590, ++ 0x03B, 0x00027A50, ++ 0x03B, 0x00018248, ++ 0x03B, 0x00010240, ++ 0x03B, 0x00008240, ++ 0x03B, 0x00000240, ++ 0x0EF, 0x00000100, ++ 0xFF0F07D8, 0xABCD, ++ 0x034, 0x0000A4EE, ++ 0x034, 0x00009076, ++ 0x034, 0x00008073, ++ 0x034, 0x00007070, ++ 0x034, 0x0000606D, ++ 0x034, 0x0000506A, ++ 0x034, 0x00004049, ++ 0x034, 0x00003046, ++ 0x034, 0x00002028, ++ 0x034, 0x00001025, ++ 0x034, 0x00000022, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0000ADF4, ++ 0x034, 0x00009DF1, ++ 0x034, 0x00008DEE, ++ 0x034, 0x00007DEB, ++ 0x034, 0x00006DE8, ++ 0x034, 0x00005CEC, ++ 0x034, 0x00004CE9, ++ 0x034, 0x000034EA, ++ 0x034, 0x000024E7, ++ 0x034, 0x0000146B, ++ 0x034, 0x0000006D, ++ 0xFF0F07D8, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x000020A2, ++ 0x0DF, 0x00000080, ++ 0x035, 0x00000192, ++ 0x035, 0x00008192, ++ 0x035, 0x00010192, ++ 0x036, 0x00000024, ++ 0x036, 0x00008024, ++ 0x036, 0x00010024, ++ 0x036, 0x00018024, ++ 0x0EF, 0x00000000, ++ 0x051, 0x00000C21, ++ 0x052, 0x000006D9, ++ 0x053, 0x000FC649, ++ 0x054, 0x0000017E, ++ 0x0EF, 0x00000002, ++ 0x008, 0x00008400, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00001000, ++ 0x03A, 0x00000080, ++ 0x03B, 0x0003A02C, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000400, ++ 0x03B, 0x0003202C, ++ 0x03C, 0x00010000, ++ 0x03A, 0x000000A0, ++ 0x03B, 0x0002B064, ++ 0x03C, 0x00004000, ++ 0x03A, 0x000000D8, ++ 0x03B, 0x00023070, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000468, ++ 0x03B, 0x0001B870, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000098, ++ 0x03B, 0x00012085, ++ 0x03C, 0x000E4000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x0000A080, ++ 0x03C, 0x000F0000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x00002080, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000080, ++ 0x03B, 0x0007A02C, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000400, ++ 0x03B, 0x0007202C, ++ 0x03C, 0x00010000, ++ 0x03A, 0x000000A0, ++ 0x03B, 0x0006B064, ++ 0x03C, 0x00004000, ++ 0x03A, 0x000000D8, ++ 0x03B, 0x00063070, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000468, ++ 0x03B, 0x0005B870, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000098, ++ 0x03B, 0x00052085, ++ 0x03C, 0x000E4000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x0004A080, ++ 0x03C, 0x000F0000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x00042080, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000080, ++ 0x03B, 0x000BA02C, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000400, ++ 0x03B, 0x000B202C, ++ 0x03C, 0x00010000, ++ 0x03A, 0x000000A0, ++ 0x03B, 0x000AB064, ++ 0x03C, 0x00004000, ++ 0x03A, 0x000000D8, ++ 0x03B, 0x000A3070, ++ 0x03C, 0x00004000, ++ 0x03A, 0x00000468, ++ 0x03B, 0x0009B870, ++ 0x03C, 0x00010000, ++ 0x03A, 0x00000098, ++ 0x03B, 0x00092085, ++ 0x03C, 0x000E4000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x0008A080, ++ 0x03C, 0x000F0000, ++ 0x03A, 0x00000418, ++ 0x03B, 0x00082080, ++ 0x03C, 0x00010000, ++ 0x0EF, 0x00001100, ++ 0xFF0F0740, 0xABCD, ++ 0x034, 0x0004A0B2, ++ 0x034, 0x000490AF, ++ 0x034, 0x00048070, ++ 0x034, 0x0004706D, ++ 0x034, 0x00046050, ++ 0x034, 0x0004504D, ++ 0x034, 0x0004404A, ++ 0x034, 0x00043047, ++ 0x034, 0x0004200A, ++ 0x034, 0x00041007, ++ 0x034, 0x00040004, ++ 0xFF0F07C0, 0xCDEF, ++ 0x034, 0x0004A0B2, ++ 0x034, 0x000490AF, ++ 0x034, 0x00048070, ++ 0x034, 0x0004706D, ++ 0x034, 0x00046050, ++ 0x034, 0x0004504D, ++ 0x034, 0x0004404A, ++ 0x034, 0x00043047, ++ 0x034, 0x0004200A, ++ 0x034, 0x00041007, ++ 0x034, 0x00040004, ++ 0xFF0F07D8, 0xCDEF, ++ 0x034, 0x0004A0B2, ++ 0x034, 0x000490AF, ++ 0x034, 0x00048070, ++ 0x034, 0x0004706D, ++ 0x034, 0x00046050, ++ 0x034, 0x0004504D, ++ 0x034, 0x0004404A, ++ 0x034, 0x00043047, ++ 0x034, 0x0004200A, ++ 0x034, 0x00041007, ++ 0x034, 0x00040004, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0004ADF5, ++ 0x034, 0x00049DF2, ++ 0x034, 0x00048DEF, ++ 0x034, 0x00047DEC, ++ 0x034, 0x00046DE9, ++ 0x034, 0x00045DC9, ++ 0x034, 0x00044CE8, ++ 0x034, 0x000438CA, ++ 0x034, 0x00042889, ++ 0x034, 0x0004184A, ++ 0x034, 0x0004044A, ++ 0xFF0F0740, 0xDEAD, ++ 0xFF0F0740, 0xABCD, ++ 0x034, 0x0002A0B2, ++ 0x034, 0x000290AF, ++ 0x034, 0x00028070, ++ 0x034, 0x0002706D, ++ 0x034, 0x00026050, ++ 0x034, 0x0002504D, ++ 0x034, 0x0002404A, ++ 0x034, 0x00023047, ++ 0x034, 0x0002200A, ++ 0x034, 0x00021007, ++ 0x034, 0x00020004, ++ 0xFF0F07C0, 0xCDEF, ++ 0x034, 0x0002A0B2, ++ 0x034, 0x000290AF, ++ 0x034, 0x00028070, ++ 0x034, 0x0002706D, ++ 0x034, 0x00026050, ++ 0x034, 0x0002504D, ++ 0x034, 0x0002404A, ++ 0x034, 0x00023047, ++ 0x034, 0x0002200A, ++ 0x034, 0x00021007, ++ 0x034, 0x00020004, ++ 0xFF0F07D8, 0xCDEF, ++ 0x034, 0x0002A0B2, ++ 0x034, 0x000290AF, ++ 0x034, 0x00028070, ++ 0x034, 0x0002706D, ++ 0x034, 0x00026050, ++ 0x034, 0x0002504D, ++ 0x034, 0x0002404A, ++ 0x034, 0x00023047, ++ 0x034, 0x0002200A, ++ 0x034, 0x00021007, ++ 0x034, 0x00020004, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0002ADF5, ++ 0x034, 0x00029DF2, ++ 0x034, 0x00028DEF, ++ 0x034, 0x00027DEC, ++ 0x034, 0x00026DE9, ++ 0x034, 0x00025DC9, ++ 0x034, 0x00024CE8, ++ 0x034, 0x000238CA, ++ 0x034, 0x00022889, ++ 0x034, 0x0002184A, ++ 0x034, 0x0002044A, ++ 0xFF0F0740, 0xDEAD, ++ 0xFF0F0740, 0xABCD, ++ 0x034, 0x0000A0B2, ++ 0x034, 0x000090AF, ++ 0x034, 0x00008070, ++ 0x034, 0x0000706D, ++ 0x034, 0x00006050, ++ 0x034, 0x0000504D, ++ 0x034, 0x0000404A, ++ 0x034, 0x00003047, ++ 0x034, 0x0000200A, ++ 0x034, 0x00001007, ++ 0x034, 0x00000004, ++ 0xFF0F07C0, 0xCDEF, ++ 0x034, 0x0000A0B2, ++ 0x034, 0x000090AF, ++ 0x034, 0x00008070, ++ 0x034, 0x0000706D, ++ 0x034, 0x00006050, ++ 0x034, 0x0000504D, ++ 0x034, 0x0000404A, ++ 0x034, 0x00003047, ++ 0x034, 0x0000200A, ++ 0x034, 0x00001007, ++ 0x034, 0x00000004, ++ 0xFF0F07D8, 0xCDEF, ++ 0x034, 0x0000A0B2, ++ 0x034, 0x000090AF, ++ 0x034, 0x00008070, ++ 0x034, 0x0000706D, ++ 0x034, 0x00006050, ++ 0x034, 0x0000504D, ++ 0x034, 0x0000404A, ++ 0x034, 0x00003047, ++ 0x034, 0x0000200A, ++ 0x034, 0x00001007, ++ 0x034, 0x00000004, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0000AFF7, ++ 0x034, 0x00009DF7, ++ 0x034, 0x00008DF4, ++ 0x034, 0x00007DF1, ++ 0x034, 0x00006DEE, ++ 0x034, 0x00005DCD, ++ 0x034, 0x00004CEB, ++ 0x034, 0x000038CC, ++ 0x034, 0x0000288B, ++ 0x034, 0x0000184C, ++ 0x034, 0x0000044C, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0xFF0F0740, 0xABCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x000001C5, ++ 0x035, 0x000081C5, ++ 0x035, 0x000101C5, ++ 0x035, 0x00020174, ++ 0x035, 0x00028174, ++ 0x035, 0x00030174, ++ 0x035, 0x00040185, ++ 0x035, 0x00048185, ++ 0x035, 0x00050185, ++ 0x0EF, 0x00000000, ++ 0xFF0F07C0, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x000001C5, ++ 0x035, 0x000081C5, ++ 0x035, 0x000101C5, ++ 0x035, 0x00020174, ++ 0x035, 0x00028174, ++ 0x035, 0x00030174, ++ 0x035, 0x00040185, ++ 0x035, 0x00048185, ++ 0x035, 0x00050185, ++ 0x0EF, 0x00000000, ++ 0xFF0F07D8, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x000001C5, ++ 0x035, 0x000081C5, ++ 0x035, 0x000101C5, ++ 0x035, 0x00020174, ++ 0x035, 0x00028174, ++ 0x035, 0x00030174, ++ 0x035, 0x00040185, ++ 0x035, 0x00048185, ++ 0x035, 0x00050185, ++ 0x0EF, 0x00000000, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x00000186, ++ 0x035, 0x00008186, ++ 0x035, 0x00010185, ++ 0x035, 0x000201D5, ++ 0x035, 0x000281D5, ++ 0x035, 0x000301D5, ++ 0x035, 0x000401D5, ++ 0x035, 0x000481D5, ++ 0x035, 0x000501D5, ++ 0x0EF, 0x00000000, ++ 0xFF0F0740, 0xDEAD, ++ 0xFF0F0740, 0xABCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00005B8B, ++ 0x036, 0x0000DB8B, ++ 0x036, 0x00015B8B, ++ 0x036, 0x0001DB8B, ++ 0x036, 0x000262DB, ++ 0x036, 0x0002E2DB, ++ 0x036, 0x000362DB, ++ 0x036, 0x0003E2DB, ++ 0x036, 0x0004553B, ++ 0x036, 0x0004D53B, ++ 0x036, 0x0005553B, ++ 0x036, 0x0005D53B, ++ 0xFF0F07C0, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00005B8B, ++ 0x036, 0x0000DB8B, ++ 0x036, 0x00015B8B, ++ 0x036, 0x0001DB8B, ++ 0x036, 0x000262DB, ++ 0x036, 0x0002E2DB, ++ 0x036, 0x000362DB, ++ 0x036, 0x0003E2DB, ++ 0x036, 0x0004553B, ++ 0x036, 0x0004D53B, ++ 0x036, 0x0005553B, ++ 0x036, 0x0005D53B, ++ 0xFF0F07D8, 0xCDEF, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00005B8B, ++ 0x036, 0x0000DB8B, ++ 0x036, 0x00015B8B, ++ 0x036, 0x0001DB8B, ++ 0x036, 0x000262DB, ++ 0x036, 0x0002E2DB, ++ 0x036, 0x000362DB, ++ 0x036, 0x0003E2DB, ++ 0x036, 0x0004553B, ++ 0x036, 0x0004D53B, ++ 0x036, 0x0005553B, ++ 0x036, 0x0005D53B, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x00084EB4, ++ 0x036, 0x0008C9B4, ++ 0x036, 0x000949B4, ++ 0x036, 0x0009C9B4, ++ 0x036, 0x000A4935, ++ 0x036, 0x000AC935, ++ 0x036, 0x000B4935, ++ 0x036, 0x000BC935, ++ 0x036, 0x000C4EB4, ++ 0x036, 0x000CCEB4, ++ 0x036, 0x000D4EB4, ++ 0x036, 0x000DCEB4, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x00000008, ++ 0xFF0F0740, 0xABCD, ++ 0x03C, 0x000002DC, ++ 0x03C, 0x00000524, ++ 0x03C, 0x00000902, ++ 0xFF0F07C0, 0xCDEF, ++ 0x03C, 0x000002DC, ++ 0x03C, 0x00000524, ++ 0x03C, 0x00000902, ++ 0xFF0F07D8, 0xCDEF, ++ 0x03C, 0x000002DC, ++ 0x03C, 0x00000524, ++ 0x03C, 0x00000902, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x03C, 0x000002AA, ++ 0x03C, 0x000005A2, ++ 0x03C, 0x00000880, ++ 0xFF0F0740, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000002, ++ 0x0DF, 0x00000080, ++ 0xFF0F0740, 0xABCD, ++ 0x061, 0x000EAC43, ++ 0x062, 0x00038F47, ++ 0x063, 0x00031157, ++ 0x064, 0x0001C4AC, ++ 0x065, 0x000931D1, ++ 0xFF0F07C0, 0xCDEF, ++ 0x061, 0x000EAC43, ++ 0x062, 0x00038F47, ++ 0x063, 0x00031157, ++ 0x064, 0x0001C4AC, ++ 0x065, 0x000931D1, ++ 0xFF0F07D8, 0xCDEF, ++ 0x061, 0x000EAC43, ++ 0x062, 0x00038F47, ++ 0x063, 0x00031157, ++ 0x064, 0x0001C4AC, ++ 0x065, 0x000931D1, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x061, 0x000E5D53, ++ 0x062, 0x00038FCD, ++ 0x063, 0x000314EB, ++ 0x064, 0x000196AC, ++ 0x065, 0x000931D7, ++ 0xFF0F0740, 0xDEAD, ++ 0x008, 0x00008400, ++ ++}; ++ ++static void ++ODM_ReadAndConfig_TC_8812A_RadioB( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_TC_8812A_RadioB)/sizeof(u4Byte); ++ pu4Byte Array = Array_TC_8812A_RadioB; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_RadioB, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigRF_RadioB_8812A(pDM_Odm, v1, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigRF_RadioB_8812A(pDM_Odm, v1, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* TxPowerTrack_AP.TXT ++******************************************************************************/ ++ ++static u1Byte gDeltaSwingTableIdx_TC_5GB_N__8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++}; ++static u1Byte gDeltaSwingTableIdx_TC_5GB_P__8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 17, 17, 18, 19, 20, 20, 20}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++}; ++static u1Byte gDeltaSwingTableIdx_TC_5GA_N__8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 4, 4, 5, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 13, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16}, ++}; ++static u1Byte gDeltaSwingTableIdx_TC_5GA_P__8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 7, 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 18, 19, 19, 19}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++}; ++static u1Byte gDeltaSwingTableIdx_TC_2GB_N__8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_TC_2GB_P__8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static u1Byte gDeltaSwingTableIdx_TC_2GA_N__8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_TC_2GA_P__8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static u1Byte gDeltaSwingTableIdx_TC_2GCCKB_N__8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_TC_2GCCKB_P__8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static u1Byte gDeltaSwingTableIdx_TC_2GCCKA_N__8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_TC_2GCCKA_P__8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++ ++static void ++ODM_ReadAndConfig_TC_8812A_TxPowerTrack_AP( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_TC_8812A\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_TC_2GA_P__8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_TC_2GA_N__8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_TC_2GB_P__8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_TC_2GB_N__8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_TC_2GCCKA_P__8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_TC_2GCCKA_N__8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_TC_2GCCKB_P__8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_TC_2GCCKB_N__8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_TC_5GA_P__8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_TC_5GA_N__8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_TC_5GB_P__8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_TC_5GB_N__8812A, DELTA_SWINGIDX_SIZE*3); ++} ++ ++/****************************************************************************** ++* TxPowerTrack_PCIE.TXT ++******************************************************************************/ ++ ++static u1Byte gDeltaSwingTableIdx_TC_5GB_N_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_TC_5GB_P_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_TC_5GA_N_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 13, 13, 13}, ++ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 11, 12, 12, 12, 12, 12, 13, 13}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 8, 8, 9, 10, 11, 12, 13, 14, 14, 15, 15, 15, 16, 16, 16, 17, 17, 18, 18}, ++}; ++static u1Byte gDeltaSwingTableIdx_TC_5GA_P_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_TC_2GB_N_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_TC_2GB_P_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static u1Byte gDeltaSwingTableIdx_TC_2GA_N_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_TC_2GA_P_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static u1Byte gDeltaSwingTableIdx_TC_2GCCKB_N_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_TC_2GCCKB_P_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static u1Byte gDeltaSwingTableIdx_TC_2GCCKA_N_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_TC_2GCCKA_P_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++ ++static void ++ODM_ReadAndConfig_TC_8812A_TxPowerTrack_PCIE( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_TC_8812A\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_TC_2GA_P_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_TC_2GA_N_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_TC_2GB_P_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_TC_2GB_N_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_TC_2GCCKA_P_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_TC_2GCCKA_N_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_TC_2GCCKB_P_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_TC_2GCCKB_N_PCIE_8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_TC_5GA_P_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_TC_5GA_N_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_TC_5GB_P_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_TC_5GB_N_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); ++} ++ ++/****************************************************************************** ++* TxPowerTrack_USB.TXT ++******************************************************************************/ ++ ++static u1Byte gDeltaSwingTableIdx_TC_5GB_N_USB_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_TC_5GB_P_USB_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_TC_5GA_N_USB_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, ++}; ++static u1Byte gDeltaSwingTableIdx_TC_5GA_P_USB_8812A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 12, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static u1Byte gDeltaSwingTableIdx_TC_2GB_N_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_TC_2GB_P_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++static u1Byte gDeltaSwingTableIdx_TC_2GA_N_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; ++static u1Byte gDeltaSwingTableIdx_TC_2GA_P_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++static u1Byte gDeltaSwingTableIdx_TC_2GCCKB_N_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; ++static u1Byte gDeltaSwingTableIdx_TC_2GCCKB_P_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++static u1Byte gDeltaSwingTableIdx_TC_2GCCKA_N_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; ++static u1Byte gDeltaSwingTableIdx_TC_2GCCKA_P_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++ ++static void ++ODM_ReadAndConfig_TC_8812A_TxPowerTrack_USB( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_TC_8812A\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_TC_2GA_P_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_TC_2GA_N_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_TC_2GB_P_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_TC_2GB_N_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_TC_2GCCKA_P_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_TC_2GCCKA_N_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_TC_2GCCKB_P_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_TC_2GCCKB_N_USB_8812A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_TC_5GA_P_USB_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_TC_5GA_N_USB_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_TC_5GB_P_USB_8812A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_TC_5GB_N_USB_8812A, DELTA_SWINGIDX_SIZE*3); ++} ++ ++/****************************************************************************** ++* TXPWR_LMT.TXT ++******************************************************************************/ ++ ++static pu1Byte Array_TC_8812A_TXPWR_LMT[] = { ++ "FCC", "2.4G", "20M", "CCK", "1T", "01", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "02", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "03", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "04", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "05", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "06", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "07", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "08", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "09", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "10", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "11", "36", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "12", "63", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "13", "63", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "36", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "32", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "63", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "63", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "FCC", "2.4G", "20M", "HT", "1T", "01", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "02", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "03", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "04", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "05", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "06", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "07", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "08", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "09", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "10", "36", ++ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "11", "32", ++ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "12", "63", ++ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "13", "63", ++ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", ++ "FCC", "2.4G", "20M", "HT", "2T", "01", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "02", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "03", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "04", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "05", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "06", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "07", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "08", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "09", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "10", "34", ++ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", ++ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", ++ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "03", "32", ++ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "04", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "05", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "06", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "07", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "08", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "09", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "10", "36", ++ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "11", "32", ++ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "12", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "12", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "13", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "13", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", ++ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "04", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "05", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "06", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "07", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "08", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "09", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "10", "34", ++ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", ++ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", ++ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", ++ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", ++ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", ++ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "36", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "36", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "40", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "40", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "44", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "48", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "52", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "56", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "60", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "64", "28", ++ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "100", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "100", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "114", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "114", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "114", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "108", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "108", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "112", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "112", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "116", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "116", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "120", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "120", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "124", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "124", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "128", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "128", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "132", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "132", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "136", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "136", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "140", "28", ++ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "140", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "149", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "153", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "157", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "161", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "165", "36", ++ "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", ++ "FCC", "5G", "20M", "HT", "1T", "36", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "36", "32", ++ "MKK", "5G", "20M", "HT", "1T", "36", "32", ++ "FCC", "5G", "20M", "HT", "1T", "40", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "40", "32", ++ "MKK", "5G", "20M", "HT", "1T", "40", "32", ++ "FCC", "5G", "20M", "HT", "1T", "44", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "44", "32", ++ "MKK", "5G", "20M", "HT", "1T", "44", "32", ++ "FCC", "5G", "20M", "HT", "1T", "48", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "48", "32", ++ "MKK", "5G", "20M", "HT", "1T", "48", "32", ++ "FCC", "5G", "20M", "HT", "1T", "52", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "52", "32", ++ "MKK", "5G", "20M", "HT", "1T", "52", "32", ++ "FCC", "5G", "20M", "HT", "1T", "56", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "56", "32", ++ "MKK", "5G", "20M", "HT", "1T", "56", "32", ++ "FCC", "5G", "20M", "HT", "1T", "60", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "60", "32", ++ "MKK", "5G", "20M", "HT", "1T", "60", "32", ++ "FCC", "5G", "20M", "HT", "1T", "64", "28", ++ "ETSI", "5G", "20M", "HT", "1T", "64", "32", ++ "MKK", "5G", "20M", "HT", "1T", "64", "32", ++ "FCC", "5G", "20M", "HT", "1T", "100", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "100", "32", ++ "MKK", "5G", "20M", "HT", "1T", "100", "32", ++ "FCC", "5G", "20M", "HT", "1T", "114", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "114", "32", ++ "MKK", "5G", "20M", "HT", "1T", "114", "32", ++ "FCC", "5G", "20M", "HT", "1T", "108", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "108", "32", ++ "MKK", "5G", "20M", "HT", "1T", "108", "32", ++ "FCC", "5G", "20M", "HT", "1T", "112", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "112", "32", ++ "MKK", "5G", "20M", "HT", "1T", "112", "32", ++ "FCC", "5G", "20M", "HT", "1T", "116", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "116", "32", ++ "MKK", "5G", "20M", "HT", "1T", "116", "32", ++ "FCC", "5G", "20M", "HT", "1T", "120", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "120", "32", ++ "MKK", "5G", "20M", "HT", "1T", "120", "32", ++ "FCC", "5G", "20M", "HT", "1T", "124", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "124", "32", ++ "MKK", "5G", "20M", "HT", "1T", "124", "32", ++ "FCC", "5G", "20M", "HT", "1T", "128", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "128", "32", ++ "MKK", "5G", "20M", "HT", "1T", "128", "32", ++ "FCC", "5G", "20M", "HT", "1T", "132", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "132", "32", ++ "MKK", "5G", "20M", "HT", "1T", "132", "32", ++ "FCC", "5G", "20M", "HT", "1T", "136", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "136", "32", ++ "MKK", "5G", "20M", "HT", "1T", "136", "32", ++ "FCC", "5G", "20M", "HT", "1T", "140", "28", ++ "ETSI", "5G", "20M", "HT", "1T", "140", "32", ++ "MKK", "5G", "20M", "HT", "1T", "140", "32", ++ "FCC", "5G", "20M", "HT", "1T", "149", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "149", "32", ++ "MKK", "5G", "20M", "HT", "1T", "149", "63", ++ "FCC", "5G", "20M", "HT", "1T", "153", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "153", "32", ++ "MKK", "5G", "20M", "HT", "1T", "153", "63", ++ "FCC", "5G", "20M", "HT", "1T", "157", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "157", "32", ++ "MKK", "5G", "20M", "HT", "1T", "157", "63", ++ "FCC", "5G", "20M", "HT", "1T", "161", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "161", "32", ++ "MKK", "5G", "20M", "HT", "1T", "161", "63", ++ "FCC", "5G", "20M", "HT", "1T", "165", "36", ++ "ETSI", "5G", "20M", "HT", "1T", "165", "32", ++ "MKK", "5G", "20M", "HT", "1T", "165", "63", ++ "FCC", "5G", "20M", "HT", "2T", "36", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "36", "30", ++ "MKK", "5G", "20M", "HT", "2T", "36", "30", ++ "FCC", "5G", "20M", "HT", "2T", "40", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "40", "30", ++ "MKK", "5G", "20M", "HT", "2T", "40", "30", ++ "FCC", "5G", "20M", "HT", "2T", "44", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "44", "30", ++ "MKK", "5G", "20M", "HT", "2T", "44", "30", ++ "FCC", "5G", "20M", "HT", "2T", "48", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "48", "30", ++ "MKK", "5G", "20M", "HT", "2T", "48", "30", ++ "FCC", "5G", "20M", "HT", "2T", "52", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "52", "30", ++ "MKK", "5G", "20M", "HT", "2T", "52", "30", ++ "FCC", "5G", "20M", "HT", "2T", "56", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "56", "30", ++ "MKK", "5G", "20M", "HT", "2T", "56", "30", ++ "FCC", "5G", "20M", "HT", "2T", "60", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "60", "30", ++ "MKK", "5G", "20M", "HT", "2T", "60", "30", ++ "FCC", "5G", "20M", "HT", "2T", "64", "26", ++ "ETSI", "5G", "20M", "HT", "2T", "64", "30", ++ "MKK", "5G", "20M", "HT", "2T", "64", "30", ++ "FCC", "5G", "20M", "HT", "2T", "100", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "100", "30", ++ "MKK", "5G", "20M", "HT", "2T", "100", "30", ++ "FCC", "5G", "20M", "HT", "2T", "114", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "114", "30", ++ "MKK", "5G", "20M", "HT", "2T", "114", "30", ++ "FCC", "5G", "20M", "HT", "2T", "108", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "108", "30", ++ "MKK", "5G", "20M", "HT", "2T", "108", "30", ++ "FCC", "5G", "20M", "HT", "2T", "112", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "112", "30", ++ "MKK", "5G", "20M", "HT", "2T", "112", "30", ++ "FCC", "5G", "20M", "HT", "2T", "116", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "116", "30", ++ "MKK", "5G", "20M", "HT", "2T", "116", "30", ++ "FCC", "5G", "20M", "HT", "2T", "120", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "120", "30", ++ "MKK", "5G", "20M", "HT", "2T", "120", "30", ++ "FCC", "5G", "20M", "HT", "2T", "124", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "124", "30", ++ "MKK", "5G", "20M", "HT", "2T", "124", "30", ++ "FCC", "5G", "20M", "HT", "2T", "128", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "128", "30", ++ "MKK", "5G", "20M", "HT", "2T", "128", "30", ++ "FCC", "5G", "20M", "HT", "2T", "132", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "132", "30", ++ "MKK", "5G", "20M", "HT", "2T", "132", "30", ++ "FCC", "5G", "20M", "HT", "2T", "136", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "136", "30", ++ "MKK", "5G", "20M", "HT", "2T", "136", "30", ++ "FCC", "5G", "20M", "HT", "2T", "140", "26", ++ "ETSI", "5G", "20M", "HT", "2T", "140", "30", ++ "MKK", "5G", "20M", "HT", "2T", "140", "30", ++ "FCC", "5G", "20M", "HT", "2T", "149", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "149", "30", ++ "MKK", "5G", "20M", "HT", "2T", "149", "63", ++ "FCC", "5G", "20M", "HT", "2T", "153", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "153", "30", ++ "MKK", "5G", "20M", "HT", "2T", "153", "63", ++ "FCC", "5G", "20M", "HT", "2T", "157", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "157", "30", ++ "MKK", "5G", "20M", "HT", "2T", "157", "63", ++ "FCC", "5G", "20M", "HT", "2T", "161", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "161", "30", ++ "MKK", "5G", "20M", "HT", "2T", "161", "63", ++ "FCC", "5G", "20M", "HT", "2T", "165", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "165", "30", ++ "MKK", "5G", "20M", "HT", "2T", "165", "63", ++ "FCC", "5G", "40M", "HT", "1T", "38", "30", ++ "ETSI", "5G", "40M", "HT", "1T", "38", "32", ++ "MKK", "5G", "40M", "HT", "1T", "38", "32", ++ "FCC", "5G", "40M", "HT", "1T", "46", "30", ++ "ETSI", "5G", "40M", "HT", "1T", "46", "32", ++ "MKK", "5G", "40M", "HT", "1T", "46", "32", ++ "FCC", "5G", "40M", "HT", "1T", "54", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "54", "32", ++ "MKK", "5G", "40M", "HT", "1T", "54", "32", ++ "FCC", "5G", "40M", "HT", "1T", "62", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "62", "32", ++ "MKK", "5G", "40M", "HT", "1T", "62", "32", ++ "FCC", "5G", "40M", "HT", "1T", "102", "28", ++ "ETSI", "5G", "40M", "HT", "1T", "102", "32", ++ "MKK", "5G", "40M", "HT", "1T", "102", "32", ++ "FCC", "5G", "40M", "HT", "1T", "110", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "110", "32", ++ "MKK", "5G", "40M", "HT", "1T", "110", "32", ++ "FCC", "5G", "40M", "HT", "1T", "118", "36", ++ "ETSI", "5G", "40M", "HT", "1T", "118", "32", ++ "MKK", "5G", "40M", "HT", "1T", "118", "32", ++ "FCC", "5G", "40M", "HT", "1T", "126", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "126", "32", ++ "MKK", "5G", "40M", "HT", "1T", "126", "32", ++ "FCC", "5G", "40M", "HT", "1T", "134", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "134", "32", ++ "MKK", "5G", "40M", "HT", "1T", "134", "32", ++ "FCC", "5G", "40M", "HT", "1T", "151", "36", ++ "ETSI", "5G", "40M", "HT", "1T", "151", "32", ++ "MKK", "5G", "40M", "HT", "1T", "151", "63", ++ "FCC", "5G", "40M", "HT", "1T", "159", "36", ++ "ETSI", "5G", "40M", "HT", "1T", "159", "32", ++ "MKK", "5G", "40M", "HT", "1T", "159", "63", ++ "FCC", "5G", "40M", "HT", "2T", "38", "28", ++ "ETSI", "5G", "40M", "HT", "2T", "38", "30", ++ "MKK", "5G", "40M", "HT", "2T", "38", "30", ++ "FCC", "5G", "40M", "HT", "2T", "46", "28", ++ "ETSI", "5G", "40M", "HT", "2T", "46", "30", ++ "MKK", "5G", "40M", "HT", "2T", "46", "30", ++ "FCC", "5G", "40M", "HT", "2T", "54", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "54", "30", ++ "MKK", "5G", "40M", "HT", "2T", "54", "30", ++ "FCC", "5G", "40M", "HT", "2T", "62", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "62", "30", ++ "MKK", "5G", "40M", "HT", "2T", "62", "30", ++ "FCC", "5G", "40M", "HT", "2T", "102", "26", ++ "ETSI", "5G", "40M", "HT", "2T", "102", "30", ++ "MKK", "5G", "40M", "HT", "2T", "102", "30", ++ "FCC", "5G", "40M", "HT", "2T", "110", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "110", "30", ++ "MKK", "5G", "40M", "HT", "2T", "110", "30", ++ "FCC", "5G", "40M", "HT", "2T", "118", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "118", "30", ++ "MKK", "5G", "40M", "HT", "2T", "118", "30", ++ "FCC", "5G", "40M", "HT", "2T", "126", "32", ++ "ETSI", "5G", "40M", "HT", "2T", "126", "30", ++ "MKK", "5G", "40M", "HT", "2T", "126", "30", ++ "FCC", "5G", "40M", "HT", "2T", "134", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "134", "30", ++ "MKK", "5G", "40M", "HT", "2T", "134", "30", ++ "FCC", "5G", "40M", "HT", "2T", "151", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "151", "30", ++ "MKK", "5G", "40M", "HT", "2T", "151", "63", ++ "FCC", "5G", "40M", "HT", "2T", "159", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "159", "30", ++ "MKK", "5G", "40M", "HT", "2T", "159", "63", ++ "FCC", "5G", "80M", "VHT", "1T", "42", "30", ++ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "42", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "58", "28", ++ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "58", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "106", "30", ++ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "106", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "122", "34", ++ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "122", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "155", "36", ++ "ETSI", "5G", "80M", "VHT", "1T", "155", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "155", "63", ++ "FCC", "5G", "80M", "VHT", "2T", "42", "28", ++ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "42", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "58", "26", ++ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "58", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "106", "28", ++ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "106", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "122", "32", ++ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "122", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "155", "34", ++ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "155", "63" ++}; ++ ++static void ++ODM_ReadAndConfig_TC_8812A_TXPWR_LMT( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte i = 0; ++ u4Byte ArrayLen = sizeof(Array_TC_8812A_TXPWR_LMT)/sizeof(pu1Byte); ++ pu1Byte *Array = Array_TC_8812A_TXPWR_LMT; ++ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_TXPWR_LMT\n")); ++ ++ for (i = 0; i < ArrayLen; i += 7 ) ++ { ++ pu1Byte regulation = Array[i]; ++ pu1Byte band = Array[i+1]; ++ pu1Byte bandwidth = Array[i+2]; ++ pu1Byte rate = Array[i+3]; ++ pu1Byte rfPath = Array[i+4]; ++ pu1Byte chnl = Array[i+5]; ++ pu1Byte val = Array[i+6]; ++ ++ odm_ConfigBB_TXPWR_LMT_8812A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); ++ } ++ ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.h 2018-02-06 17:42:30.706967105 +0200 +@@ -0,0 +1,76 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* ++******************************************************************************/ ++ ++#ifndef __INC_TC_RF_HW_IMG_8812A_H ++#define __INC_TC_RF_HW_IMG_8812A_H ++ ++static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); ++ ++/****************************************************************************** ++* RadioA.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8812A_RadioA( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* RadioB.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8812A_RadioB( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TxPowerTrack_AP.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8812A_TxPowerTrack_AP( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TxPowerTrack_PCIE.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8812A_TxPowerTrack_PCIE( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TxPowerTrack_USB.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8812A_TxPowerTrack_USB( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TXPWR_LMT.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8812A_TXPWR_LMT( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.c 2018-02-06 17:42:30.706967105 +0200 +@@ -0,0 +1,658 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++//#include "Mp_Precomp.h" ++#include "odm_precomp.h" ++ ++static bool ++CheckCondition( ++ const u4Byte Condition, ++ const u4Byte Hex ++ ) ++{ ++ u4Byte _board = (Hex & 0x000000FF); ++ u4Byte _interface = (Hex & 0x0000FF00) >> 8; ++ u4Byte _platform = (Hex & 0x00FF0000) >> 16; ++ u4Byte cond = Condition; ++ ++ if ( Condition == 0xCDCDCDCD ) ++ return true; ++ ++ cond = Condition & 0x000000FF; ++ if ( (_board != cond) && (cond != 0xFF) ) ++ return false; ++ ++ cond = Condition & 0x0000FF00; ++ cond = cond >> 8; ++ if ( ((_interface & cond) == 0) && (cond != 0x07) ) ++ return false; ++ ++ cond = Condition & 0x00FF0000; ++ cond = cond >> 16; ++ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) ++ return false; ++ return true; ++} ++ ++ ++/****************************************************************************** ++* AGC_TAB.TXT ++******************************************************************************/ ++ ++static const u4Byte Array_MP_8821A_AGC_TAB[] = { ++ 0x81C, 0xBF000001, ++ 0x81C, 0xBF020001, ++ 0x81C, 0xBF040001, ++ 0x81C, 0xBF060001, ++ 0x81C, 0xBE080001, ++ 0x81C, 0xBD0A0001, ++ 0x81C, 0xBC0C0001, ++ 0x81C, 0xBA0E0001, ++ 0x81C, 0xB9100001, ++ 0x81C, 0xB8120001, ++ 0x81C, 0xB7140001, ++ 0x81C, 0xB6160001, ++ 0x81C, 0xB5180001, ++ 0x81C, 0xB41A0001, ++ 0x81C, 0xB31C0001, ++ 0x81C, 0xB21E0001, ++ 0x81C, 0xB1200001, ++ 0x81C, 0xB0220001, ++ 0x81C, 0xAF240001, ++ 0x81C, 0xAE260001, ++ 0x81C, 0xAD280001, ++ 0x81C, 0xAC2A0001, ++ 0x81C, 0xAB2C0001, ++ 0x81C, 0xAA2E0001, ++ 0x81C, 0xA9300001, ++ 0x81C, 0xA8320001, ++ 0x81C, 0xA7340001, ++ 0x81C, 0xA6360001, ++ 0x81C, 0xA5380001, ++ 0x81C, 0xA43A0001, ++ 0x81C, 0xA33C0001, ++ 0x81C, 0x673E0001, ++ 0x81C, 0x66400001, ++ 0x81C, 0x65420001, ++ 0x81C, 0x64440001, ++ 0x81C, 0x63460001, ++ 0x81C, 0x62480001, ++ 0x81C, 0x614A0001, ++ 0x81C, 0x474C0001, ++ 0x81C, 0x464E0001, ++ 0x81C, 0x45500001, ++ 0x81C, 0x44520001, ++ 0x81C, 0x43540001, ++ 0x81C, 0x42560001, ++ 0x81C, 0x41580001, ++ 0x81C, 0x285A0001, ++ 0x81C, 0x275C0001, ++ 0x81C, 0x265E0001, ++ 0x81C, 0x25600001, ++ 0x81C, 0x24620001, ++ 0x81C, 0x0A640001, ++ 0x81C, 0x09660001, ++ 0x81C, 0x08680001, ++ 0x81C, 0x076A0001, ++ 0x81C, 0x066C0001, ++ 0x81C, 0x056E0001, ++ 0x81C, 0x04700001, ++ 0x81C, 0x03720001, ++ 0x81C, 0x02740001, ++ 0x81C, 0x01760001, ++ 0x81C, 0x01780001, ++ 0x81C, 0x017A0001, ++ 0x81C, 0x017C0001, ++ 0x81C, 0x017E0001, ++ 0xFF0F02C0, 0xABCD, ++ 0x81C, 0xFB000101, ++ 0x81C, 0xFA020101, ++ 0x81C, 0xF9040101, ++ 0x81C, 0xF8060101, ++ 0x81C, 0xF7080101, ++ 0x81C, 0xF60A0101, ++ 0x81C, 0xF50C0101, ++ 0x81C, 0xF40E0101, ++ 0x81C, 0xF3100101, ++ 0x81C, 0xF2120101, ++ 0x81C, 0xF1140101, ++ 0x81C, 0xF0160101, ++ 0x81C, 0xEF180101, ++ 0x81C, 0xEE1A0101, ++ 0x81C, 0xED1C0101, ++ 0x81C, 0xEC1E0101, ++ 0x81C, 0xEB200101, ++ 0x81C, 0xEA220101, ++ 0x81C, 0xE9240101, ++ 0x81C, 0xE8260101, ++ 0x81C, 0xE7280101, ++ 0x81C, 0xE62A0101, ++ 0x81C, 0xE52C0101, ++ 0x81C, 0xE42E0101, ++ 0x81C, 0xE3300101, ++ 0x81C, 0xA5320101, ++ 0x81C, 0xA4340101, ++ 0x81C, 0xA3360101, ++ 0x81C, 0x87380101, ++ 0x81C, 0x863A0101, ++ 0x81C, 0x853C0101, ++ 0x81C, 0x843E0101, ++ 0x81C, 0x69400101, ++ 0x81C, 0x68420101, ++ 0x81C, 0x67440101, ++ 0x81C, 0x66460101, ++ 0x81C, 0x49480101, ++ 0x81C, 0x484A0101, ++ 0x81C, 0x474C0101, ++ 0x81C, 0x2A4E0101, ++ 0x81C, 0x29500101, ++ 0x81C, 0x28520101, ++ 0x81C, 0x27540101, ++ 0x81C, 0x26560101, ++ 0x81C, 0x25580101, ++ 0x81C, 0x245A0101, ++ 0x81C, 0x235C0101, ++ 0x81C, 0x055E0101, ++ 0x81C, 0x04600101, ++ 0x81C, 0x03620101, ++ 0x81C, 0x02640101, ++ 0x81C, 0x01660101, ++ 0x81C, 0x01680101, ++ 0x81C, 0x016A0101, ++ 0x81C, 0x016C0101, ++ 0x81C, 0x016E0101, ++ 0x81C, 0x01700101, ++ 0x81C, 0x01720101, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x81C, 0xFF000101, ++ 0x81C, 0xFF020101, ++ 0x81C, 0xFE040101, ++ 0x81C, 0xFD060101, ++ 0x81C, 0xFC080101, ++ 0x81C, 0xFD0A0101, ++ 0x81C, 0xFC0C0101, ++ 0x81C, 0xFB0E0101, ++ 0x81C, 0xFA100101, ++ 0x81C, 0xF9120101, ++ 0x81C, 0xF8140101, ++ 0x81C, 0xF7160101, ++ 0x81C, 0xF6180101, ++ 0x81C, 0xF51A0101, ++ 0x81C, 0xF41C0101, ++ 0x81C, 0xF31E0101, ++ 0x81C, 0xF2200101, ++ 0x81C, 0xF1220101, ++ 0x81C, 0xF0240101, ++ 0x81C, 0xEF260101, ++ 0x81C, 0xEE280101, ++ 0x81C, 0xED2A0101, ++ 0x81C, 0xEC2C0101, ++ 0x81C, 0xEB2E0101, ++ 0x81C, 0xEA300101, ++ 0x81C, 0xE9320101, ++ 0x81C, 0xE8340101, ++ 0x81C, 0xE7360101, ++ 0x81C, 0xE6380101, ++ 0x81C, 0xE53A0101, ++ 0x81C, 0xE43C0101, ++ 0x81C, 0xE33E0101, ++ 0x81C, 0xA5400101, ++ 0x81C, 0xA4420101, ++ 0x81C, 0xA3440101, ++ 0x81C, 0x87460101, ++ 0x81C, 0x86480101, ++ 0x81C, 0x854A0101, ++ 0x81C, 0x844C0101, ++ 0x81C, 0x694E0101, ++ 0x81C, 0x68500101, ++ 0x81C, 0x67520101, ++ 0x81C, 0x66540101, ++ 0x81C, 0x49560101, ++ 0x81C, 0x48580101, ++ 0x81C, 0x475A0101, ++ 0x81C, 0x2A5C0101, ++ 0x81C, 0x295E0101, ++ 0x81C, 0x28600101, ++ 0x81C, 0x27620101, ++ 0x81C, 0x26640101, ++ 0x81C, 0x25660101, ++ 0x81C, 0x24680101, ++ 0x81C, 0x236A0101, ++ 0x81C, 0x056C0101, ++ 0x81C, 0x046E0101, ++ 0x81C, 0x03700101, ++ 0x81C, 0x02720101, ++ 0xFF0F02C0, 0xDEAD, ++ 0x81C, 0x01740101, ++ 0x81C, 0x01760101, ++ 0x81C, 0x01780101, ++ 0x81C, 0x017A0101, ++ 0x81C, 0x017C0101, ++ 0x81C, 0x017E0101, ++ 0xC50, 0x00000022, ++ 0xC50, 0x00000020, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8821A_AGC_TAB( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8821A_AGC_TAB)/sizeof(u4Byte); ++ const pu4Byte Array = Array_MP_8821A_AGC_TAB; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8821A_AGC_TAB, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_AGC_8821A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_AGC_8821A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* PHY_REG.TXT ++******************************************************************************/ ++ ++static const u4Byte Array_MP_8821A_PHY_REG[] = { ++ 0x800, 0x0020D090, ++ 0x804, 0x080112E0, ++ 0x808, 0x0E028211, ++ 0x80C, 0x92131111, ++ 0x810, 0x20101261, ++ 0x814, 0x020C3D10, ++ 0x818, 0x03A00385, ++ 0x820, 0x00000000, ++ 0x824, 0x00030FE0, ++ 0x828, 0x00000000, ++ 0x82C, 0x002081DD, ++ 0x830, 0x2AAA8E24, ++ 0x834, 0x0037A706, ++ 0x838, 0x06489B44, ++ 0x83C, 0x0000095B, ++ 0x840, 0xC0000001, ++ 0x844, 0x40003CDE, ++ 0x848, 0x62103F8B, ++ 0x84C, 0x6CFDFFB8, ++ 0x850, 0x28874706, ++ 0x854, 0x0001520C, ++ 0x858, 0x8060E000, ++ 0x85C, 0x74210168, ++ 0x860, 0x6929C321, ++ 0x864, 0x79727432, ++ 0x868, 0x8CA7A314, ++ 0x86C, 0x888C2878, ++ 0x870, 0x08888888, ++ 0x874, 0x31612C2E, ++ 0x878, 0x00000152, ++ 0x87C, 0x000FD000, ++ 0x8A0, 0x00000013, ++ 0x8A4, 0x7F7F7F7F, ++ 0x8A8, 0xA2000338, ++ 0x8AC, 0x0FF0FA0A, ++ 0x8B4, 0x000FC080, ++ 0x8B8, 0x7C0057FF, ++ 0x8BC, 0x0CA52090, ++ 0x8C0, 0x1BF00020, ++ 0x8C4, 0x00000000, ++ 0x8C8, 0x00013169, ++ 0x8CC, 0x08248492, ++ 0x8D4, 0x940008A0, ++ 0x8D8, 0x290B5612, ++ 0x8F8, 0x400002C0, ++ 0x8FC, 0x00000000, ++ 0x900, 0x00000700, ++ 0x90C, 0x00000000, ++ 0x910, 0x0000FC00, ++ 0x914, 0x00000404, ++ 0x918, 0x1C1028C0, ++ 0x91C, 0x64B11A1C, ++ 0x920, 0xE0767233, ++ 0x924, 0x055AA500, ++ 0x928, 0x00000004, ++ 0x92C, 0xFFFE0000, ++ 0x930, 0xFFFFFFFE, ++ 0x934, 0x001FFFFF, ++ 0x960, 0x00000000, ++ 0x964, 0x00000000, ++ 0x968, 0x00000000, ++ 0x96C, 0x00000000, ++ 0x970, 0x801FFFFF, ++ 0x974, 0x000003FF, ++ 0x978, 0x00000000, ++ 0x97C, 0x00000000, ++ 0x980, 0x00000000, ++ 0x984, 0x00000000, ++ 0x988, 0x00000000, ++ 0x9A4, 0x00480080, ++ 0x9A8, 0x00000000, ++ 0x9AC, 0x00000000, ++ 0x9B0, 0x81081008, ++ 0x9B4, 0x01081008, ++ 0x9B8, 0x01081008, ++ 0x9BC, 0x01081008, ++ 0x9D0, 0x00000000, ++ 0x9D4, 0x00000000, ++ 0x9D8, 0x00000000, ++ 0x9DC, 0x00000000, ++ 0x9E0, 0x00005D00, ++ 0x9E4, 0x00000002, ++ 0x9E8, 0x00000000, ++ 0xA00, 0x00D047C8, ++ 0xA04, 0x01FF000C, ++ 0xA08, 0x8C8A8300, ++ 0xA0C, 0x2E68000F, ++ 0xA10, 0x9500BB78, ++ 0xA14, 0x11144028, ++ 0xA18, 0x00881117, ++ 0xA1C, 0x89140F00, ++ 0xA20, 0x1A1B0000, ++ 0xA24, 0x090E1317, ++ 0xA28, 0x00000204, ++ 0xA2C, 0x00900000, ++ 0xA70, 0x101FFF00, ++ 0xA74, 0x00000008, ++ 0xA78, 0x00000900, ++ 0xA7C, 0x225B0606, ++ 0xA80, 0x21805490, ++ 0xA84, 0x001F0000, ++ 0xB00, 0x03100040, ++ 0xB04, 0x0000B000, ++ 0xB08, 0xAE0201EB, ++ 0xB0C, 0x01003207, ++ 0xB10, 0x00009807, ++ 0xB14, 0x01000000, ++ 0xB18, 0x00000002, ++ 0xB1C, 0x00000002, ++ 0xB20, 0x0000001F, ++ 0xB24, 0x03020100, ++ 0xB28, 0x07060504, ++ 0xB2C, 0x0B0A0908, ++ 0xB30, 0x0F0E0D0C, ++ 0xB34, 0x13121110, ++ 0xB38, 0x17161514, ++ 0xB3C, 0x0000003A, ++ 0xB40, 0x00000000, ++ 0xB44, 0x00000000, ++ 0xB48, 0x13000032, ++ 0xB4C, 0x48080000, ++ 0xB50, 0x00000000, ++ 0xB54, 0x00000000, ++ 0xB58, 0x00000000, ++ 0xB5C, 0x00000000, ++ 0xC00, 0x00000007, ++ 0xC04, 0x00042020, ++ 0xC08, 0x80410231, ++ 0xC0C, 0x00000000, ++ 0xC10, 0x00000100, ++ 0xC14, 0x01000000, ++ 0xC1C, 0x40000003, ++ 0xC20, 0x2C2C2C2C, ++ 0xC24, 0x30303030, ++ 0xC28, 0x30303030, ++ 0xC2C, 0x2C2C2C2C, ++ 0xC30, 0x2C2C2C2C, ++ 0xC34, 0x2C2C2C2C, ++ 0xC38, 0x2C2C2C2C, ++ 0xC3C, 0x2A2A2A2A, ++ 0xC40, 0x2A2A2A2A, ++ 0xC44, 0x2A2A2A2A, ++ 0xC48, 0x2A2A2A2A, ++ 0xC4C, 0x2A2A2A2A, ++ 0xC50, 0x00000020, ++ 0xC54, 0x001C1208, ++ 0xC58, 0x30000C1C, ++ 0xC5C, 0x00000058, ++ 0xC60, 0x34344443, ++ 0xC64, 0x07003333, ++ 0xC68, 0x19791979, ++ 0xC6C, 0x19791979, ++ 0xC70, 0x19791979, ++ 0xC74, 0x19791979, ++ 0xC78, 0x19791979, ++ 0xC7C, 0x19791979, ++ 0xC80, 0x19791979, ++ 0xC84, 0x19791979, ++ 0xC94, 0x0100005C, ++ 0xC98, 0x00000000, ++ 0xC9C, 0x00000000, ++ 0xCA0, 0x00000029, ++ 0xCA4, 0x08040201, ++ 0xCA8, 0x80402010, ++ 0xCB0, 0x77775747, ++ 0xCB4, 0x10000077, ++ 0xCB8, 0x00508240, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8821A_PHY_REG( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8821A_PHY_REG)/sizeof(u4Byte); ++ const pu4Byte Array = Array_MP_8821A_PHY_REG; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8821A_PHY_REG, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_PHY_8821A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_PHY_8821A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* PHY_REG_PG.TXT ++******************************************************************************/ ++ ++static const u4Byte Array_MP_8821A_PHY_REG_PG[] = { ++ 0xC20, 0x00000000, 0x32343638, ++ 0xC24, 0x00000000, 0x36363838, ++ 0xC28, 0x00000000, 0x28303234, ++ 0xC2C, 0x00000000, 0x34363838, ++ 0xC30, 0x00000000, 0x26283032, ++ 0xC34, 0x00000000, 0x34363838, ++ 0xC38, 0x00000000, 0x26283032, ++ 0xE20, 0x00000000, 0x32343638, ++ 0xE24, 0x00000000, 0x36363838, ++ 0xE28, 0x00000000, 0x28303234, ++ 0xE2C, 0x00000000, 0x34363838, ++ 0xE30, 0x00000000, 0x26283032, ++ 0xE34, 0x00000000, 0x34363838, ++ 0xE38, 0x00000000, 0x26283032, ++ 0xC24, 0x00000000, 0x34343636, ++ 0xC28, 0x00000000, 0x26283032, ++ 0xC2C, 0x00000000, 0x32343636, ++ 0xC30, 0x00000000, 0x24262830, ++ 0xC34, 0x00000000, 0x32343636, ++ 0xC38, 0x00000000, 0x24262830, ++ 0xC3C, 0x00000000, 0x32343636, ++ 0xC40, 0x00000000, 0x24262830, ++ 0xC44, 0x00000000, 0x36362022, ++ 0xC48, 0x00000000, 0x28303234, ++ 0xC4C, 0x00000000, 0x20222426, ++ 0xE24, 0x00000000, 0x34343636, ++ 0xE28, 0x00000000, 0x26283032, ++ 0xE2C, 0x00000000, 0x32343636, ++ 0xE30, 0x00000000, 0x24262830, ++ 0xE34, 0x00000000, 0x32343636, ++ 0xE38, 0x00000000, 0x24262830, ++ 0xE3C, 0x00000000, 0x32343636, ++ 0xE40, 0x00000000, 0x24262830, ++ 0xE44, 0x00000000, 0x36362022, ++ 0xE48, 0x00000000, 0x28303234, ++ 0xE4C, 0x00000000, 0x20222426, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8821A_PHY_REG_PG( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8821A_PHY_REG_PG)/sizeof(u4Byte); ++ const pu4Byte Array = Array_MP_8821A_PHY_REG_PG; ++ ++ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ for (i = 0; i < ArrayLen; i += 3 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ u4Byte v3 = Array[i+2]; ++ ++ // this line is a line of pure_body ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_PHY_REG_PG_8821A(pDM_Odm, v1, v2, v3); ++ continue; ++ } ++ else ++ { // this line is the start of branch ++ if ( !CheckCondition(Array[i], hex) ) ++ { // don't need the hw_body ++ i += 2; // skip the pair of expression ++ v1 = Array[i]; ++ v2 = Array[i+1]; ++ v3 = Array[i+2]; ++ while (v2 != 0xDEAD) ++ { ++ i += 3; ++ v1 = Array[i]; ++ v2 = Array[i+1]; ++ v3 = Array[i+1]; ++ } ++ } ++ } ++ } ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.h 2018-02-06 17:42:30.706967105 +0200 +@@ -0,0 +1,48 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#ifndef __INC_MP_BB_HW_IMG_8821A_H ++#define __INC_MP_BB_HW_IMG_8821A_H ++ ++static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); ++ ++/****************************************************************************** ++* AGC_TAB.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8821A_AGC_TAB( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* PHY_REG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8821A_PHY_REG( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* PHY_REG_PG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8821A_PHY_REG_PG( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.c 2018-02-06 17:42:30.708967135 +0200 +@@ -0,0 +1,3709 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++//#include "Mp_Precomp.h" ++#include "odm_precomp.h" ++ ++static const u1Byte Array_MP_8821A_FW_BT[] = { ++0xFC, 0x63, 0x07, 0x62, 0xCF, 0xF7, 0x12, 0x6B, 0x6B, 0xEB, 0x2C, 0xB2, 0x60, 0xCA, 0x48, 0xF7, ++0x11, 0x6B, 0x2B, 0xB2, 0x80, 0x18, 0x39, 0x2D, 0x60, 0xCA, 0x2A, 0xB3, 0x2A, 0xB2, 0x60, 0xDA, ++0x2A, 0xB3, 0x2B, 0xB2, 0x60, 0xDA, 0x2B, 0xB2, 0x45, 0xF1, 0x09, 0x6B, 0x00, 0xF1, 0x70, 0xCA, ++0x29, 0xB3, 0x80, 0xF0, 0x9C, 0xA2, 0x63, 0xDA, 0x28, 0xB3, 0x64, 0xDA, 0x00, 0x6B, 0x65, 0xDA, ++0x66, 0xDA, 0x67, 0xDA, 0x68, 0xDA, 0x69, 0xDA, 0x04, 0x6B, 0x8D, 0xEB, 0xE0, 0xF1, 0x82, 0xA2, ++0x80, 0xF0, 0x7C, 0xC2, 0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x0F, 0x6C, 0x8B, 0xEC, 0x8C, 0xEB, ++0x10, 0x6C, 0x8D, 0xEB, 0x9D, 0x67, 0x70, 0xC4, 0xE0, 0xF1, 0x62, 0xC2, 0x1C, 0xB3, 0x1D, 0xB2, ++0x60, 0xDA, 0x1D, 0xB3, 0x1D, 0xB2, 0x60, 0xDA, 0x1D, 0xB3, 0x1E, 0xB2, 0x60, 0xDA, 0x1E, 0xB3, ++0x1E, 0xB2, 0x60, 0xDA, 0x1E, 0xB3, 0x1F, 0xB2, 0x60, 0xDA, 0x1F, 0xB3, 0x1F, 0xB2, 0x60, 0xDA, ++0x1F, 0xB3, 0x20, 0xB2, 0x60, 0xDA, 0x20, 0xB3, 0x20, 0xB2, 0x60, 0xDA, 0x20, 0xB3, 0x21, 0xB2, ++0x60, 0xDA, 0x21, 0xB3, 0x21, 0xB2, 0x60, 0xDA, 0x21, 0xB3, 0x22, 0xB2, 0x80, 0x18, 0x81, 0x2D, ++0x60, 0xDA, 0x07, 0x97, 0x00, 0xEF, 0x04, 0x63, 0x42, 0x00, 0x11, 0x80, 0x40, 0x00, 0x11, 0x80, ++0xF1, 0xB7, 0x10, 0x80, 0xFC, 0x06, 0x11, 0x80, 0xE1, 0xB5, 0x10, 0x80, 0x04, 0x08, 0x11, 0x80, ++0x48, 0x00, 0x11, 0x80, 0x14, 0xC0, 0x52, 0x02, 0x58, 0xC5, 0xC8, 0x19, 0xB1, 0xB4, 0x10, 0x80, ++0x38, 0x1B, 0x11, 0x80, 0xF5, 0xBB, 0x10, 0x80, 0xC8, 0x1A, 0x11, 0x80, 0x59, 0xB8, 0x10, 0x80, ++0x6C, 0x07, 0x11, 0x80, 0x49, 0xB8, 0x10, 0x80, 0x18, 0x19, 0x11, 0x80, 0xA1, 0xB5, 0x10, 0x80, ++0x90, 0x07, 0x11, 0x80, 0xDD, 0xB5, 0x10, 0x80, 0x24, 0x08, 0x11, 0x80, 0xE9, 0xB5, 0x10, 0x80, ++0x5C, 0x07, 0x11, 0x80, 0x35, 0xBE, 0x10, 0x80, 0xD0, 0x1A, 0x11, 0x80, 0x89, 0xB6, 0x10, 0x80, ++0x5C, 0x1B, 0x11, 0x80, 0xE5, 0xB5, 0x10, 0x80, 0xE8, 0x19, 0x11, 0x80, 0xBD, 0xB6, 0x10, 0x80, ++0xD0, 0x06, 0x11, 0x80, 0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x0A, 0xB0, 0x90, 0x67, 0x00, 0x6D, ++0x00, 0x18, 0x29, 0x34, 0x38, 0x6E, 0x01, 0x6A, 0x4B, 0xEA, 0x47, 0xD8, 0x70, 0x6A, 0x43, 0xC0, ++0x0A, 0x6A, 0x4C, 0xC0, 0x08, 0x6A, 0x4D, 0xC0, 0x05, 0x97, 0x04, 0x90, 0x00, 0xEF, 0x03, 0x63, ++0xE8, 0x93, 0x11, 0x80, 0xD6, 0x63, 0x53, 0x62, 0x52, 0xD1, 0x51, 0xD0, 0x00, 0xF4, 0x05, 0x6A, ++0x7D, 0x67, 0x52, 0xCB, 0x0D, 0x6A, 0x20, 0xF0, 0x46, 0xC3, 0x20, 0xF0, 0x07, 0x04, 0x71, 0xB5, ++0x00, 0x18, 0xF6, 0x33, 0x06, 0x6E, 0x9D, 0x67, 0x01, 0x6A, 0x00, 0x6B, 0x20, 0xF0, 0x4F, 0xC4, ++0x20, 0xF0, 0x53, 0xC4, 0x6C, 0xB2, 0x20, 0xF0, 0x6D, 0xC4, 0x20, 0xF0, 0x6E, 0xC4, 0x20, 0xF0, ++0x70, 0xC4, 0x20, 0xF0, 0x71, 0xC4, 0x20, 0xF0, 0x72, 0xC4, 0xC0, 0xF1, 0x6A, 0xC2, 0xC0, 0xF1, ++0x7E, 0xC2, 0x03, 0x6B, 0x02, 0x6C, 0xC0, 0xF1, 0x7C, 0xC2, 0x64, 0xB3, 0xC0, 0xF1, 0x89, 0xC2, ++0xC0, 0xF1, 0x88, 0xC2, 0xC0, 0xF1, 0x9D, 0xC2, 0x80, 0xC3, 0x61, 0xB3, 0x00, 0x6C, 0x80, 0xDB, ++0x81, 0xDB, 0x60, 0xF1, 0x70, 0xA2, 0x44, 0x67, 0x02, 0x73, 0x07, 0x60, 0x03, 0x73, 0xA0, 0xF0, ++0x07, 0x60, 0x01, 0x73, 0xA0, 0xF0, 0x04, 0x60, 0x0F, 0x10, 0xC0, 0xF2, 0x0C, 0x6B, 0x78, 0xEA, ++0x58, 0xB4, 0x12, 0xEB, 0x6D, 0xE4, 0xC0, 0xF0, 0x68, 0xA3, 0x80, 0xF0, 0x19, 0x2B, 0x01, 0x4A, ++0xFF, 0x6B, 0x6C, 0xEA, 0x0A, 0x5A, 0xF1, 0x61, 0x00, 0x18, 0xBD, 0x5E, 0x09, 0x04, 0x4A, 0xD2, ++0x80, 0xF0, 0x10, 0x2A, 0x7D, 0x67, 0x20, 0xF0, 0x6D, 0xA3, 0x5D, 0x67, 0x9D, 0x67, 0x20, 0xF0, ++0x4E, 0xA2, 0x20, 0xF0, 0x8F, 0xA4, 0x4E, 0xD3, 0x7D, 0x67, 0x4F, 0xD2, 0x4D, 0xD4, 0x5D, 0x67, ++0x20, 0xF0, 0x93, 0xA3, 0x20, 0xF0, 0x50, 0xA2, 0x20, 0xF0, 0x02, 0x05, 0x4B, 0xD4, 0x4C, 0xD2, ++0x20, 0xF0, 0x12, 0xA3, 0x20, 0xF0, 0x31, 0xA3, 0x00, 0x18, 0xCB, 0xE1, 0x08, 0x04, 0x02, 0x22, ++0x4A, 0xD2, 0x70, 0x10, 0x5D, 0x67, 0x00, 0x30, 0x2D, 0xE8, 0x31, 0xAA, 0xC0, 0xF2, 0x0C, 0x6A, ++0x38, 0xB5, 0x58, 0xE9, 0x3B, 0xB2, 0x12, 0xE9, 0x45, 0xE1, 0xE0, 0xF0, 0x88, 0x41, 0x00, 0x18, ++0xF6, 0x33, 0x06, 0x6E, 0x4F, 0x93, 0x4E, 0x94, 0x60, 0x32, 0x8D, 0xEA, 0x60, 0xF2, 0x58, 0xC9, ++0x5D, 0x67, 0x30, 0xF1, 0x64, 0x42, 0x40, 0xA3, 0x7D, 0x67, 0x30, 0xF1, 0x80, 0x43, 0xE0, 0xF0, ++0x55, 0xC1, 0x60, 0xA4, 0x9D, 0x67, 0x20, 0xF1, 0x4C, 0x44, 0xE0, 0xF0, 0x77, 0xC1, 0x80, 0xA2, ++0x7D, 0x67, 0xE0, 0xF0, 0x98, 0xC1, 0x20, 0xF0, 0x40, 0xA3, 0xE0, 0xF0, 0x4E, 0xC1, 0x01, 0x6A, ++0x60, 0xF2, 0x5A, 0xC1, 0x00, 0x18, 0x3A, 0x9D, 0x91, 0xAB, 0x9D, 0x67, 0x20, 0xF1, 0x48, 0x44, ++0x80, 0xA2, 0x02, 0x32, 0x5E, 0x32, 0x00, 0xF1, 0x8C, 0xC1, 0x13, 0x22, 0xEF, 0xF7, 0x1F, 0x6A, ++0x0C, 0xEA, 0x01, 0x6B, 0x80, 0xF0, 0x44, 0xC9, 0x06, 0x6C, 0x04, 0xD3, 0xFC, 0x6D, 0x1E, 0xB3, ++0x00, 0xF5, 0x1B, 0x6E, 0x20, 0xF5, 0x17, 0x6F, 0x05, 0xD3, 0x20, 0x18, 0xC5, 0x30, 0x06, 0xD2, ++0x06, 0x10, 0x5D, 0x67, 0x20, 0xF1, 0x68, 0x42, 0x40, 0xAB, 0x80, 0xF0, 0x44, 0xC9, 0x00, 0x18, ++0xE6, 0xA0, 0x09, 0x04, 0x02, 0x67, 0x0E, 0x22, 0x7D, 0x67, 0x20, 0xF0, 0x80, 0xA3, 0xE0, 0xF0, ++0xA3, 0xA1, 0x00, 0x18, 0xA8, 0xE1, 0x00, 0x65, 0x0A, 0xB4, 0x00, 0x18, 0xA4, 0xE1, 0x00, 0x65, ++0x4A, 0xD0, 0x08, 0x10, 0x5D, 0x67, 0x91, 0xAA, 0x20, 0x18, 0x21, 0x26, 0x01, 0x6D, 0x02, 0x10, ++0x0C, 0x6B, 0x4A, 0xD3, 0x4A, 0x92, 0x53, 0x97, 0x52, 0x91, 0x51, 0x90, 0x00, 0xEF, 0x2A, 0x63, ++0xFC, 0x93, 0x11, 0x80, 0x80, 0x50, 0x11, 0x80, 0x09, 0x50, 0x11, 0x80, 0xB0, 0x51, 0x11, 0x80, ++0x74, 0x54, 0x11, 0x80, 0xB0, 0xE7, 0x04, 0x80, 0xFD, 0x63, 0x05, 0x62, 0x10, 0xB3, 0x00, 0x6D, ++0xC0, 0xF1, 0xAA, 0xC3, 0xC0, 0xF1, 0xBE, 0xC3, 0xFF, 0x6A, 0x03, 0x6D, 0x8C, 0xEA, 0xC0, 0xF1, ++0xBC, 0xC3, 0x02, 0x6C, 0x0B, 0xB5, 0xC0, 0xF1, 0x89, 0xC3, 0xC0, 0xF1, 0x88, 0xC3, 0xC0, 0xF1, ++0x9D, 0xC3, 0x60, 0xF1, 0x40, 0xC3, 0x80, 0xC5, 0x00, 0x18, 0x82, 0xA9, 0x82, 0x67, 0x06, 0xB2, ++0x00, 0x6B, 0x60, 0xDA, 0x61, 0xDA, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0x80, 0x50, 0x11, 0x80, ++0x09, 0x50, 0x11, 0x80, 0xB0, 0x51, 0x11, 0x80, 0xDC, 0x63, 0x47, 0x62, 0x00, 0xF4, 0x06, 0x6A, ++0x7D, 0x67, 0x4A, 0xCB, 0x03, 0x6A, 0x56, 0xC3, 0x13, 0x6A, 0x59, 0xC3, 0x1D, 0xB2, 0x6D, 0xA2, ++0x08, 0x73, 0x1A, 0x60, 0xFF, 0x6C, 0x09, 0x4C, 0x98, 0xEB, 0x1B, 0xB2, 0x01, 0x6D, 0x12, 0xEC, ++0x91, 0xE2, 0x20, 0xF1, 0xCF, 0xA4, 0xAC, 0xEE, 0x0F, 0x26, 0x00, 0xF1, 0x52, 0xAA, 0x47, 0xEB, ++0xAC, 0xEA, 0x0A, 0x22, 0x20, 0xF1, 0x4C, 0xAC, 0x7D, 0x67, 0x05, 0x04, 0x57, 0xC3, 0x42, 0x32, ++0x58, 0xC3, 0x00, 0x18, 0x47, 0x4F, 0x04, 0x05, 0x0E, 0xB2, 0x4C, 0xA2, 0x0A, 0x72, 0x14, 0x60, ++0xC0, 0xF2, 0x0C, 0x6B, 0x78, 0xEA, 0x0D, 0xB3, 0x12, 0xEA, 0x49, 0xE3, 0xE0, 0xF0, 0x66, 0xA2, ++0x01, 0x73, 0x0A, 0x61, 0x60, 0xF2, 0x56, 0xAA, 0x7D, 0x67, 0x05, 0x04, 0x57, 0xC3, 0x42, 0x32, ++0x58, 0xC3, 0x00, 0x18, 0x47, 0x4F, 0x04, 0x05, 0x47, 0x97, 0x00, 0xEF, 0x24, 0x63, 0x00, 0x65, ++0xE8, 0x93, 0x11, 0x80, 0x00, 0x3B, 0x11, 0x80, 0x74, 0x54, 0x11, 0x80, 0xDC, 0x63, 0x47, 0x62, ++0x46, 0xD0, 0x00, 0x6A, 0x18, 0xB3, 0x9D, 0x67, 0x40, 0xDB, 0x41, 0xDB, 0x04, 0xF0, 0x06, 0x6B, ++0x68, 0xCC, 0x54, 0xC4, 0x56, 0xC4, 0x57, 0xC4, 0x58, 0xC4, 0x59, 0xC4, 0x5A, 0xC4, 0x5B, 0xC4, ++0x5C, 0xC4, 0x5D, 0xC4, 0x5E, 0xC4, 0x5F, 0xC4, 0x0F, 0x6B, 0x07, 0x6A, 0x04, 0x00, 0x72, 0xC4, ++0x20, 0xF0, 0x40, 0xC4, 0x20, 0x6B, 0x03, 0x6A, 0x73, 0xC4, 0x75, 0xC4, 0x20, 0xF0, 0x41, 0xC4, ++0x00, 0x18, 0xB5, 0xC9, 0x90, 0x67, 0x7D, 0x67, 0x04, 0xF0, 0x0A, 0x6A, 0x48, 0xCB, 0x01, 0x6A, ++0x90, 0x67, 0x52, 0xC3, 0x00, 0x18, 0x2D, 0xCA, 0x53, 0xC3, 0x47, 0x97, 0x46, 0x90, 0x00, 0xEF, ++0x24, 0x63, 0x00, 0x65, 0xB0, 0x51, 0x11, 0x80, 0xDC, 0x63, 0x47, 0x62, 0x00, 0x6A, 0x21, 0xB3, ++0x9D, 0x67, 0x40, 0xDB, 0x41, 0xDB, 0x04, 0xF0, 0x0D, 0x6B, 0x68, 0xCC, 0x19, 0x6B, 0x72, 0xC4, ++0x60, 0x6B, 0x6B, 0xEB, 0x73, 0xC4, 0x75, 0xC4, 0x1B, 0xB3, 0x54, 0xC4, 0x56, 0xC4, 0x57, 0xC4, ++0x58, 0xC4, 0x94, 0xA3, 0xBD, 0x67, 0x5F, 0xC5, 0x99, 0xC5, 0x95, 0xA3, 0x20, 0xF0, 0x40, 0xC5, ++0x20, 0xF0, 0x42, 0xC5, 0x9A, 0xC5, 0x96, 0xA3, 0x20, 0xF0, 0x44, 0xC5, 0x20, 0xF0, 0x45, 0xC5, ++0x9B, 0xC5, 0x97, 0xA3, 0x20, 0xF0, 0x47, 0xC5, 0x20, 0xF0, 0x49, 0xC5, 0x9C, 0xC5, 0x98, 0xA3, ++0x79, 0xA3, 0x9D, 0xC5, 0x7E, 0xC5, 0x02, 0x6B, 0x20, 0xF0, 0x61, 0xC5, 0x20, 0xF0, 0x63, 0xC5, ++0x1E, 0x6B, 0x20, 0xF0, 0x66, 0xC5, 0x12, 0x6B, 0x20, 0xF0, 0x68, 0xC5, 0x20, 0xF0, 0x6A, 0xC5, ++0x20, 0xF0, 0x4B, 0xC5, 0x00, 0x18, 0xEE, 0xC7, 0x04, 0x04, 0x47, 0x97, 0x00, 0xEF, 0x24, 0x63, ++0xB0, 0x51, 0x11, 0x80, 0xE8, 0x93, 0x11, 0x80, 0xDC, 0x63, 0x47, 0x62, 0x0C, 0xB2, 0x00, 0x6B, ++0x60, 0xDA, 0x61, 0xDA, 0x7D, 0x67, 0x04, 0xF0, 0x1D, 0x6A, 0x48, 0xCB, 0x01, 0x6A, 0x52, 0xC3, ++0x08, 0xB2, 0x41, 0xAA, 0x7F, 0x6B, 0x04, 0x04, 0x4A, 0x32, 0x6C, 0xEA, 0x7D, 0x67, 0x00, 0x18, ++0x51, 0xC5, 0x53, 0xC3, 0x47, 0x97, 0x00, 0xEF, 0x24, 0x63, 0x00, 0x65, 0xB0, 0x51, 0x11, 0x80, ++0xE8, 0x93, 0x11, 0x80, 0xDB, 0x63, 0x49, 0x62, 0x48, 0xD1, 0x47, 0xD0, 0x00, 0x69, 0x0E, 0xB2, ++0x7D, 0x67, 0x20, 0xDA, 0x21, 0xDA, 0x04, 0xF0, 0x1F, 0x6A, 0x48, 0xCB, 0x0B, 0xB2, 0x81, 0xF1, ++0x48, 0xAA, 0x0B, 0xB0, 0x32, 0xC3, 0x04, 0x04, 0x00, 0x18, 0xCB, 0xC4, 0x4B, 0xD8, 0x64, 0xA0, ++0x41, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x29, 0xC0, 0x44, 0xC0, 0x49, 0x97, 0x48, 0x91, 0x47, 0x90, ++0x00, 0xEF, 0x25, 0x63, 0xB0, 0x51, 0x11, 0x80, 0x00, 0x3B, 0x11, 0x80, 0xE8, 0x93, 0x11, 0x80, ++0xDC, 0x63, 0x47, 0x62, 0x46, 0xD0, 0x00, 0x68, 0x0B, 0xB2, 0x7D, 0x67, 0x00, 0xDA, 0x01, 0xDA, ++0x04, 0xF0, 0x1F, 0x6A, 0x12, 0xC3, 0x04, 0x04, 0x00, 0x18, 0xCB, 0xC4, 0x48, 0xCB, 0x07, 0xB2, ++0x84, 0xA2, 0x41, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x64, 0xC2, 0x09, 0xC2, 0x47, 0x97, 0x46, 0x90, ++0x00, 0xEF, 0x24, 0x63, 0xB0, 0x51, 0x11, 0x80, 0xE8, 0x93, 0x11, 0x80, 0xDC, 0x63, 0x47, 0x62, ++0x1C, 0xB2, 0x00, 0x6B, 0x60, 0xDA, 0x61, 0xDA, 0x1B, 0xB2, 0x64, 0xA2, 0x07, 0x6D, 0x6E, 0x34, ++0xAC, 0xEC, 0x05, 0x54, 0x06, 0x61, 0x39, 0x6C, 0x8B, 0xEC, 0x6C, 0xEC, 0x20, 0x6B, 0x6D, 0xEC, ++0x84, 0xC2, 0x15, 0xB2, 0x64, 0xA2, 0x07, 0x6C, 0x14, 0xB5, 0x6E, 0x33, 0x8C, 0xEB, 0x6D, 0xE5, ++0x60, 0xA3, 0xC3, 0xA2, 0x6C, 0xEC, 0x0F, 0x6B, 0x6B, 0xEB, 0x84, 0x35, 0xCC, 0xEB, 0xAD, 0xEB, ++0x63, 0xC2, 0xBD, 0x67, 0x04, 0xF0, 0x1E, 0x6B, 0x68, 0xCD, 0x03, 0x6B, 0x72, 0xC5, 0x61, 0xAA, ++0x7F, 0x6D, 0x6A, 0x33, 0xAC, 0xEB, 0xBD, 0x67, 0x73, 0xC5, 0x40, 0x9A, 0x95, 0xC5, 0x04, 0x04, ++0x42, 0x32, 0x00, 0x18, 0x07, 0xC5, 0x54, 0xC5, 0x47, 0x97, 0x00, 0xEF, 0x24, 0x63, 0x00, 0x65, ++0xB0, 0x51, 0x11, 0x80, 0xE8, 0x93, 0x11, 0x80, 0x44, 0xBF, 0x10, 0x80, 0xFD, 0x63, 0x05, 0x62, ++0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, 0x1F, 0x6B, 0x02, 0xF1, 0x01, 0x6E, ++0x4C, 0xEB, 0xCB, 0xEE, 0x6C, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x00, 0x6C, ++0xA4, 0x67, 0x00, 0x18, 0x01, 0xA6, 0xC4, 0x67, 0x06, 0xB2, 0x84, 0xA2, 0x41, 0x6B, 0x6B, 0xEB, ++0x8C, 0xEB, 0x64, 0xC2, 0x00, 0x6B, 0x69, 0xC2, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0x00, 0x65, ++0xE8, 0x93, 0x11, 0x80, 0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, 0x7C, 0x6C, 0x00, 0x18, ++0xA1, 0xA5, 0x01, 0x6D, 0x79, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0xA1, 0xA5, 0x22, 0x67, 0x1E, 0xB3, ++0xFF, 0xF7, 0x1F, 0x68, 0x80, 0x9B, 0x0C, 0xE9, 0x4C, 0xE8, 0x4B, 0x9B, 0x96, 0x34, 0xE3, 0xF7, ++0x1F, 0x6D, 0x49, 0xE0, 0xAC, 0xEC, 0x98, 0xEA, 0x4B, 0xDB, 0x4D, 0x9B, 0x49, 0xE1, 0x4D, 0xDB, ++0x12, 0xEC, 0x8C, 0xDB, 0x7D, 0xF2, 0x01, 0x6B, 0x63, 0xE8, 0x02, 0x60, 0x63, 0xE9, 0x1D, 0x61, ++0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, 0x1F, 0x68, 0x0C, 0xEA, 0x01, 0xF6, ++0x01, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x6C, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, ++0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x01, 0xF6, 0x00, 0x6B, 0xC2, 0x67, ++0x57, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x6D, 0xEE, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, ++0x00, 0xEF, 0x04, 0x63, 0xE8, 0x93, 0x11, 0x80, 0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, ++0x11, 0xB2, 0x47, 0x9A, 0xFF, 0x68, 0x8C, 0xE8, 0x01, 0x4A, 0x04, 0x22, 0x0F, 0xB4, 0x00, 0x18, ++0x4D, 0x1D, 0x00, 0x65, 0x11, 0x20, 0x00, 0x69, 0x0B, 0xB0, 0x01, 0x6C, 0x0B, 0xB5, 0x0C, 0xB6, ++0xF1, 0x67, 0x00, 0x18, 0x5B, 0x1D, 0x04, 0xD1, 0x87, 0x98, 0x00, 0x18, 0x40, 0x1D, 0x14, 0x6D, ++0x00, 0x6A, 0x30, 0xC8, 0x20, 0xF0, 0x49, 0xC0, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x00, 0xEF, ++0x05, 0x63, 0x00, 0x65, 0xE8, 0x93, 0x11, 0x80, 0x04, 0x94, 0x11, 0x80, 0x29, 0xA8, 0x10, 0x80, ++0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, ++0x1F, 0x68, 0xFF, 0x6B, 0x0C, 0xEA, 0x02, 0x4B, 0x6B, 0xEB, 0xC2, 0x67, 0x6C, 0xEE, 0x57, 0x6C, ++0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x59, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, ++0x00, 0xF2, 0x01, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x6C, 0xEE, 0x59, 0x6C, 0x00, 0x18, 0x01, 0xA6, ++0x01, 0x6D, 0x00, 0x6C, 0x0C, 0xB0, 0xA4, 0x67, 0x00, 0x18, 0x01, 0xA6, 0xC4, 0x67, 0xD1, 0xA8, ++0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x42, 0x6C, 0x80, 0x18, 0xD6, 0x29, 0x00, 0x6C, 0x64, 0xA0, ++0x41, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x44, 0xC0, 0x00, 0x6A, 0x49, 0xC0, 0x05, 0x97, 0x04, 0x90, ++0x00, 0xEF, 0x03, 0x63, 0xE8, 0x93, 0x11, 0x80, 0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, ++0x20, 0xB2, 0x47, 0x9A, 0x08, 0xD4, 0x8E, 0xEA, 0x05, 0x22, 0x01, 0x4C, 0x03, 0x24, 0x00, 0x18, ++0x4D, 0x1D, 0x08, 0x04, 0x1B, 0xB0, 0x64, 0xA0, 0x40, 0x6A, 0x6C, 0xEA, 0x08, 0x2A, 0x47, 0x98, ++0x01, 0x4A, 0x29, 0x22, 0x18, 0xB4, 0x00, 0x18, 0x4D, 0x1D, 0x00, 0x65, 0x24, 0x10, 0x02, 0x69, ++0x6C, 0xE9, 0xFF, 0x6A, 0x4C, 0xE9, 0x07, 0x21, 0x80, 0x18, 0xB1, 0x29, 0x00, 0x65, 0x50, 0xA8, ++0x01, 0x4A, 0x50, 0xC8, 0x18, 0x10, 0x7D, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x04, 0x6B, ++0x4C, 0xEB, 0x06, 0x23, 0x50, 0xA8, 0x20, 0xF0, 0x29, 0xC0, 0x01, 0x4A, 0x50, 0xC8, 0x0B, 0x10, ++0x20, 0xF0, 0x49, 0xA0, 0x19, 0x5A, 0x04, 0x60, 0x01, 0x4A, 0x20, 0xF0, 0x49, 0xC0, 0x03, 0x10, ++0x80, 0x18, 0xEC, 0x29, 0x00, 0x65, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x00, 0xEF, 0x04, 0x63, ++0xE8, 0x93, 0x11, 0x80, 0x04, 0x94, 0x11, 0x80, 0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, ++0x00, 0x6C, 0x02, 0xF0, 0x00, 0x6E, 0x00, 0x18, 0x01, 0xA6, 0xA4, 0x67, 0x2B, 0xB2, 0xC1, 0xAA, ++0x7F, 0x6A, 0x3C, 0x6C, 0xCA, 0x36, 0x4C, 0xEE, 0x29, 0xB2, 0x00, 0xF6, 0xC0, 0x36, 0x00, 0x6D, ++0x00, 0x18, 0x01, 0xA6, 0x4D, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, ++0x1F, 0x68, 0x0C, 0xEA, 0x01, 0xF6, 0x01, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x6C, 0xEE, 0x57, 0x6C, ++0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, ++0x01, 0xF6, 0x00, 0x6B, 0xC2, 0x67, 0x6D, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, ++0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x03, 0x69, 0x2B, 0xE9, 0xC2, 0x67, ++0x2C, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, ++0x01, 0x6D, 0x0C, 0xEA, 0x02, 0x6B, 0xC2, 0x67, 0x6D, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, ++0x01, 0x6D, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0xC2, 0x67, 0x2C, 0xEE, ++0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x57, 0x6C, 0x80, 0x18, 0xD6, 0x29, 0x01, 0x6C, 0x07, 0x97, ++0x06, 0x91, 0x05, 0x90, 0x00, 0xEF, 0x04, 0x63, 0xE8, 0x93, 0x11, 0x80, 0x00, 0x00, 0x00, 0x80, ++0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x00, 0x6C, 0xC4, 0x67, 0x00, 0x18, 0x01, 0xA6, 0xA4, 0x67, ++0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0x6E, 0xFF, 0xF7, 0x1F, 0x6B, 0x04, 0x4E, ++0x4C, 0xEB, 0xCB, 0xEE, 0x6C, 0xEE, 0x01, 0x6D, 0x0B, 0xB0, 0x00, 0x18, 0x01, 0xA6, 0x57, 0x6C, ++0x64, 0xA0, 0x41, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x00, 0x6C, 0x80, 0x18, 0xD6, 0x29, 0x44, 0xC0, ++0x80, 0x18, 0xB1, 0x29, 0x00, 0x65, 0x00, 0x6A, 0x49, 0xC0, 0x05, 0x97, 0x04, 0x90, 0x00, 0xEF, ++0x03, 0x63, 0x00, 0x65, 0xE8, 0x93, 0x11, 0x80, 0xFB, 0x63, 0x09, 0x62, 0x08, 0xD0, 0x38, 0xB0, ++0x90, 0xA0, 0x4F, 0xA0, 0x04, 0x05, 0x80, 0x34, 0x4D, 0xEC, 0x4E, 0xA0, 0x80, 0x34, 0x00, 0x18, ++0x15, 0xBC, 0x4D, 0xEC, 0x7D, 0x67, 0x48, 0xAB, 0x8F, 0xA0, 0xDD, 0x67, 0x4C, 0xCB, 0x49, 0xAB, ++0xAA, 0xAE, 0x4D, 0xCB, 0x4E, 0xA0, 0x80, 0x33, 0x68, 0x33, 0x48, 0x32, 0x6D, 0xEA, 0x03, 0x6B, ++0xAC, 0xEB, 0x6D, 0xEA, 0x70, 0xA0, 0x4E, 0xCE, 0x9A, 0x34, 0x68, 0x32, 0x7E, 0x33, 0x8D, 0xEA, ++0x05, 0x23, 0x09, 0xF4, 0x00, 0x6B, 0x4D, 0xEB, 0x6F, 0xCE, 0x06, 0x10, 0x0A, 0xF0, 0x00, 0x6B, ++0x6B, 0xEB, 0x4D, 0xEB, 0x5D, 0x67, 0x6F, 0xCA, 0x00, 0x6A, 0x21, 0x10, 0xDD, 0x67, 0x44, 0x35, ++0xB5, 0xE6, 0xAC, 0xAD, 0x01, 0x6E, 0xA7, 0xEB, 0xCC, 0xED, 0x0C, 0x25, 0x0F, 0x6D, 0x77, 0xE5, ++0xC4, 0xED, 0xA6, 0x67, 0x8D, 0xED, 0xA0, 0x34, 0x80, 0x34, 0x83, 0x34, 0x83, 0x34, 0xFF, 0xF7, ++0x1F, 0x6D, 0xAC, 0xEC, 0x01, 0x4B, 0xFF, 0x6D, 0xAC, 0xEB, 0x10, 0x5B, 0xE7, 0x61, 0x44, 0x33, ++0x01, 0x4A, 0xDD, 0x67, 0xAC, 0xEA, 0x6D, 0xE6, 0x04, 0x5A, 0x8C, 0xCB, 0x03, 0x60, 0x00, 0x6B, ++0x83, 0x67, 0xDC, 0x17, 0x5D, 0x67, 0xCC, 0xAA, 0x51, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, ++0x7D, 0x67, 0xCD, 0xAB, 0x50, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x5D, 0x67, 0xCE, 0xAA, ++0x4F, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x7D, 0x67, 0xCF, 0xAB, 0x4E, 0x6C, 0x00, 0x18, ++0x01, 0xA6, 0x01, 0x6D, 0x09, 0x97, 0x08, 0x90, 0x00, 0xEF, 0x05, 0x63, 0xE8, 0x93, 0x11, 0x80, ++0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, ++0xFF, 0xF7, 0x1F, 0x6B, 0xFF, 0x6E, 0x6C, 0xEA, 0x01, 0x4E, 0x53, 0xB1, 0x4D, 0xEE, 0x57, 0x6C, ++0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x04, 0xD3, 0x44, 0xA1, 0x07, 0x68, 0xA3, 0xA1, 0x4E, 0x32, ++0x0C, 0xEA, 0x44, 0x34, 0x0F, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, 0x8D, 0xEA, 0x01, 0x6D, 0x57, 0x6C, ++0x00, 0x18, 0xA1, 0xA5, 0x43, 0xC1, 0x04, 0x93, 0xC3, 0xA1, 0x57, 0x6C, 0x6C, 0xEA, 0xC6, 0x36, ++0x71, 0x6B, 0x6B, 0xEB, 0x0C, 0xEE, 0x6C, 0xEA, 0xD0, 0x36, 0x4D, 0xEE, 0x00, 0x18, 0x01, 0xA6, ++0x01, 0x6D, 0x60, 0xA1, 0x01, 0x6A, 0x01, 0x68, 0x6C, 0xEA, 0x0B, 0x22, 0x44, 0xA1, 0x80, 0x48, ++0xFF, 0x48, 0x4C, 0xE8, 0xFF, 0x6A, 0x4C, 0xE8, 0x0B, 0xE8, 0xC0, 0xF7, 0x02, 0x30, 0x03, 0x6A, ++0x03, 0xE2, 0x39, 0xB1, 0x56, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x80, 0x99, 0x00, 0x33, ++0xE3, 0xF7, 0x1F, 0x6D, 0x96, 0x34, 0xAC, 0xEC, 0x78, 0x33, 0x8D, 0xEB, 0xFB, 0xF7, 0x1F, 0x6C, ++0x8C, 0xEB, 0xFF, 0xF7, 0x1F, 0x68, 0x1C, 0xF0, 0x00, 0x6C, 0x8B, 0xEC, 0x0C, 0xEA, 0xC3, 0x67, ++0x8C, 0xEA, 0x4D, 0xEE, 0x56, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0xC7, 0xA1, 0x46, 0xA1, ++0x58, 0x6C, 0xC0, 0x36, 0x4D, 0xEE, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x59, 0x6C, 0x00, 0x18, ++0xA1, 0xA5, 0x01, 0x6D, 0x04, 0x6B, 0x6B, 0xEB, 0x0C, 0xEA, 0x6C, 0xEA, 0x68, 0xA1, 0x03, 0x6C, ++0xC2, 0x67, 0x8C, 0xEB, 0x6D, 0xEE, 0x59, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x80, 0x18, ++0x76, 0x2A, 0x00, 0x65, 0x63, 0xA1, 0x80, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, ++0x1E, 0x22, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x80, 0x6B, 0xC2, 0x67, ++0x6D, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x59, 0x6C, 0x00, 0x18, 0xA1, 0xA5, ++0x01, 0x6D, 0xC5, 0xA1, 0xE0, 0xF1, 0x1D, 0x6B, 0x6B, 0xEB, 0x0C, 0xEA, 0x6C, 0xEA, 0xC8, 0x36, ++0xE0, 0xF3, 0x19, 0x4B, 0x6C, 0xEE, 0x59, 0x6C, 0x01, 0x6D, 0x4D, 0xEE, 0x0B, 0x10, 0x57, 0x6C, ++0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x81, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x57, 0x6C, ++0x01, 0x6D, 0x6C, 0xEE, 0x00, 0x18, 0x01, 0xA6, 0x00, 0x65, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, ++0x00, 0xEF, 0x05, 0x63, 0xE8, 0x93, 0x11, 0x80, 0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, ++0x80, 0x18, 0xB0, 0x2A, 0x00, 0x65, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, ++0x1F, 0x68, 0x0C, 0xEA, 0x02, 0xF0, 0x01, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x6C, 0xEE, 0x57, 0x6C, ++0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x59, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, ++0x00, 0xF2, 0x00, 0x6B, 0xC2, 0x67, 0x6D, 0xEE, 0x59, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, ++0x42, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x33, 0xB3, 0xD2, 0xAB, 0x51, 0xCB, 0x53, 0xAB, ++0xC0, 0x36, 0xC0, 0x36, 0x4D, 0xEE, 0x02, 0xF0, 0x00, 0x5E, 0x02, 0x61, 0xE1, 0xF7, 0x1F, 0x6E, ++0x2D, 0xB1, 0x20, 0xF0, 0x48, 0xA1, 0x0F, 0x6B, 0xD0, 0x36, 0x6C, 0xEA, 0x4D, 0xEE, 0x42, 0x6C, ++0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x00, 0x6C, 0x02, 0xF0, 0x00, 0x6E, 0x00, 0x18, 0x01, 0xA6, ++0xA4, 0x67, 0x63, 0xA1, 0x07, 0x6A, 0x03, 0x6C, 0x72, 0x33, 0x4C, 0xEB, 0x05, 0x4B, 0x00, 0x6D, ++0xFF, 0xF7, 0x1F, 0x68, 0x00, 0x18, 0xA1, 0xA5, 0x04, 0xD3, 0x04, 0x93, 0x1F, 0xF4, 0x01, 0x6C, ++0x0C, 0xEA, 0x8B, 0xEC, 0x8C, 0xEA, 0x1D, 0xB4, 0x6D, 0xE4, 0x20, 0xF1, 0xDA, 0xA3, 0x03, 0x6C, ++0x00, 0x6D, 0xC0, 0x36, 0xC8, 0x36, 0x0C, 0xEE, 0x00, 0x18, 0x01, 0xA6, 0x4D, 0xEE, 0xC1, 0xA9, ++0x7F, 0x6A, 0x3C, 0x6C, 0xCA, 0x36, 0x4C, 0xEE, 0x00, 0xF6, 0xC0, 0x36, 0x00, 0x18, 0x01, 0xA6, ++0x00, 0x6D, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x01, 0x6D, 0xC2, 0x67, ++0xAD, 0xEE, 0x00, 0x18, 0x01, 0xA6, 0x57, 0x6C, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, ++0x0C, 0xEA, 0x02, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x01, 0x6D, 0x6C, 0xEE, 0x00, 0x18, 0x01, 0xA6, ++0x57, 0x6C, 0x80, 0x18, 0xD6, 0x29, 0x01, 0x6C, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x00, 0xEF, ++0x05, 0x63, 0x00, 0x65, 0xE8, 0x93, 0x11, 0x80, 0x48, 0x00, 0x11, 0x80, 0xFB, 0x63, 0x09, 0x62, ++0x08, 0xD1, 0x07, 0xD0, 0x80, 0x18, 0xB0, 0x2A, 0x00, 0x65, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, ++0x01, 0x6D, 0xFF, 0xF7, 0x1F, 0x68, 0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x69, 0xC2, 0x67, 0x2D, 0xEE, ++0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x59, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, ++0x0C, 0xEA, 0x00, 0xF2, 0x01, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x6C, 0xEE, 0x59, 0x6C, 0x00, 0x18, ++0x01, 0xA6, 0x01, 0x6D, 0x00, 0x6C, 0xD1, 0x67, 0x24, 0xB1, 0x00, 0x18, 0x01, 0xA6, 0xA4, 0x67, ++0x63, 0xA1, 0x07, 0x6A, 0x03, 0x6C, 0x72, 0x33, 0x4C, 0xEB, 0x05, 0x4B, 0x00, 0x6D, 0x00, 0x18, ++0xA1, 0xA5, 0x04, 0xD3, 0x04, 0x93, 0x1F, 0xF4, 0x01, 0x6C, 0x0C, 0xEA, 0x8B, 0xEC, 0x8C, 0xEA, ++0x1B, 0xB4, 0x6D, 0xE4, 0x20, 0xF1, 0xDA, 0xA3, 0x03, 0x6C, 0x00, 0x6D, 0xC0, 0x36, 0xC8, 0x36, ++0x0C, 0xEE, 0x00, 0x18, 0x01, 0xA6, 0x4D, 0xEE, 0xC1, 0xA9, 0x7F, 0x6A, 0x3C, 0x6C, 0xCA, 0x36, ++0x4C, 0xEE, 0x00, 0xF6, 0xC0, 0x36, 0x00, 0x18, 0x01, 0xA6, 0x00, 0x6D, 0x57, 0x6C, 0x00, 0x18, ++0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x01, 0x6D, 0xC2, 0x67, 0xAD, 0xEE, 0x00, 0x18, 0x01, 0xA6, ++0x57, 0x6C, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x02, 0x6B, 0x6B, 0xEB, ++0xC2, 0x67, 0x57, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x6C, 0xEE, 0x09, 0x97, 0x08, 0x91, ++0x07, 0x90, 0x00, 0xEF, 0x05, 0x63, 0x00, 0x65, 0xE8, 0x93, 0x11, 0x80, 0x48, 0x00, 0x11, 0x80, ++0xFD, 0x63, 0x05, 0x62, 0x80, 0x18, 0xB0, 0x2A, 0x00, 0x65, 0x00, 0x6B, 0x0C, 0xB2, 0x6D, 0xDA, ++0x6B, 0xDA, 0x59, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, 0x1F, 0x6B, 0x00, 0xF2, ++0x01, 0x6E, 0x4C, 0xEB, 0xCB, 0xEE, 0x59, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x6C, 0xEE, ++0x80, 0x18, 0x2E, 0x2A, 0x00, 0x65, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0xE8, 0x93, 0x11, 0x80, ++0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, 0x42, 0xA4, 0x04, 0x67, 0x23, 0xA4, 0x1E, 0x5A, ++0xE0, 0xF2, 0x0A, 0x60, 0x04, 0x0B, 0x44, 0x32, 0x49, 0xE3, 0x40, 0x8A, 0x4D, 0xE3, 0x00, 0xEB, ++0x00, 0x65, 0x00, 0x65, 0x3D, 0x00, 0x45, 0x00, 0x99, 0x00, 0x1F, 0x02, 0xAD, 0x02, 0xE7, 0x02, ++0x5D, 0x03, 0x81, 0x03, 0x93, 0x03, 0xA1, 0x03, 0xB7, 0x03, 0xC5, 0x03, 0xC5, 0x05, 0xC5, 0x05, ++0xD3, 0x03, 0xCB, 0x04, 0xE3, 0x04, 0xC5, 0x05, 0xFB, 0x04, 0x09, 0x05, 0x17, 0x05, 0x47, 0x05, ++0x57, 0x05, 0x69, 0x05, 0x77, 0x05, 0x89, 0x05, 0x8D, 0x05, 0x91, 0x05, 0x9B, 0x05, 0xAD, 0x05, ++0xA0, 0xF5, 0x1C, 0xB2, 0x40, 0xAA, 0xBD, 0x12, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, ++0xFF, 0xF7, 0x1F, 0x6B, 0x02, 0xF1, 0x03, 0x6E, 0x4C, 0xEB, 0xCB, 0xEE, 0x6C, 0xEE, 0x57, 0x6C, ++0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x00, 0x6C, 0xA4, 0x67, 0x00, 0x18, 0x01, 0xA6, 0xC4, 0x67, ++0x80, 0x18, 0xD6, 0x29, 0x00, 0x6C, 0x00, 0x18, 0xAF, 0x58, 0x00, 0x65, 0x00, 0x6D, 0x01, 0xF4, ++0x03, 0x6C, 0x00, 0x18, 0xEA, 0x53, 0xC5, 0x67, 0x60, 0xF5, 0x18, 0xB2, 0x0A, 0x6B, 0x6C, 0xC2, ++0x08, 0x6B, 0x6D, 0xC2, 0x00, 0x6B, 0x69, 0xC2, 0x6A, 0xC2, 0x90, 0x10, 0x0B, 0x59, 0x80, 0xF2, ++0x17, 0x60, 0x60, 0xF5, 0x00, 0xB2, 0x06, 0x21, 0x64, 0xA2, 0x40, 0x6A, 0x6C, 0xEA, 0x80, 0xF2, ++0x0F, 0x2A, 0x06, 0x10, 0x84, 0xA2, 0x40, 0x6B, 0x8C, 0xEB, 0x02, 0x2B, 0x29, 0xC2, 0x7E, 0x10, ++0x40, 0xF5, 0x00, 0xB3, 0x0B, 0x59, 0x49, 0xA3, 0x29, 0xC3, 0xA0, 0xF0, 0x00, 0x60, 0x04, 0x0B, ++0x24, 0x31, 0x25, 0xE3, 0x80, 0x89, 0x8D, 0xE3, 0x00, 0xEB, 0x00, 0x65, 0x17, 0x00, 0x95, 0x00, ++0xAB, 0x00, 0xE9, 0x00, 0x09, 0x01, 0x0D, 0x01, 0x11, 0x01, 0x33, 0x01, 0x1B, 0x01, 0x23, 0x01, ++0x2B, 0x01, 0x00, 0xF5, 0x10, 0xB3, 0x64, 0xA3, 0x01, 0x6C, 0x6C, 0xEC, 0x11, 0x24, 0x02, 0x6C, ++0x6C, 0xEC, 0x04, 0x24, 0x80, 0x18, 0x60, 0x2A, 0x00, 0x65, 0x17, 0x10, 0x02, 0x72, 0x04, 0x61, ++0x80, 0x18, 0xEC, 0x29, 0x00, 0x65, 0x11, 0x10, 0x80, 0x18, 0x9F, 0x29, 0x00, 0x65, 0x0D, 0x10, ++0x04, 0x6A, 0x6C, 0xEA, 0x0A, 0x22, 0x02, 0x6A, 0x6C, 0xEA, 0x04, 0x22, 0x80, 0x18, 0x5D, 0x29, ++0x00, 0x65, 0x03, 0x10, 0x80, 0x18, 0x70, 0x29, 0x00, 0x65, 0xC0, 0xF4, 0x08, 0xB1, 0x6B, 0x99, ++0xEC, 0x99, 0x4D, 0x99, 0x06, 0xD3, 0x05, 0xD7, 0x00, 0x18, 0xAF, 0x58, 0x04, 0xD2, 0x00, 0x6D, ++0x01, 0xF4, 0x03, 0x6C, 0x00, 0x18, 0xEA, 0x53, 0xC5, 0x67, 0x0A, 0x6A, 0x4C, 0xC1, 0x08, 0x6A, ++0x4D, 0xC1, 0x06, 0x93, 0x04, 0x94, 0x6B, 0xD9, 0x05, 0x97, 0x8D, 0xD9, 0xEC, 0xD9, 0x26, 0x10, ++0x80, 0xF4, 0x10, 0xB1, 0x64, 0xA1, 0x02, 0x6A, 0x6D, 0xEA, 0x01, 0x6B, 0x6D, 0xEA, 0x80, 0x18, ++0x8C, 0x2B, 0x44, 0xC1, 0x2A, 0x10, 0x60, 0xF4, 0x1C, 0xB3, 0x84, 0xA3, 0x03, 0x6A, 0x4B, 0xEA, ++0x8C, 0xEA, 0x04, 0x6C, 0x4C, 0xEC, 0x07, 0x24, 0x02, 0x6C, 0x8B, 0xEC, 0x4C, 0xEC, 0x80, 0x18, ++0x7F, 0x29, 0x84, 0xC3, 0x05, 0x10, 0x01, 0x6C, 0x4D, 0xEC, 0x80, 0x18, 0x0A, 0x2B, 0x84, 0xC3, ++0x40, 0xF4, 0x10, 0xB3, 0x84, 0xA3, 0x40, 0x6A, 0x8D, 0xEA, 0x44, 0xC3, 0x00, 0x6C, 0x64, 0x67, ++0x44, 0x67, 0x09, 0x12, 0x20, 0xF4, 0x1C, 0xB1, 0x64, 0xA1, 0x03, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, ++0x01, 0x6B, 0x6D, 0xEA, 0x80, 0x18, 0x53, 0x2B, 0x44, 0xC1, 0x64, 0xA1, 0x40, 0x6A, 0x6D, 0xEA, ++0x44, 0xC1, 0xEC, 0x17, 0x01, 0x6C, 0x03, 0x10, 0x02, 0x6C, 0x01, 0x10, 0x03, 0x6C, 0x80, 0x18, ++0xD6, 0x28, 0x00, 0x65, 0xE3, 0x17, 0x80, 0x18, 0x2A, 0x29, 0x00, 0x65, 0xDF, 0x17, 0x80, 0x18, ++0x0F, 0x29, 0x00, 0x65, 0xDB, 0x17, 0x80, 0x18, 0xEA, 0x28, 0x00, 0x65, 0xD7, 0x17, 0x80, 0x18, ++0x59, 0x28, 0x00, 0x65, 0xD3, 0x22, 0x12, 0x72, 0xC0, 0xF1, 0x1A, 0x60, 0x00, 0x6C, 0x04, 0x6B, ++0xD9, 0x11, 0x04, 0x59, 0xC0, 0xF1, 0x14, 0x60, 0x80, 0x18, 0xD6, 0x29, 0x00, 0x6C, 0x57, 0x6C, ++0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, 0x1F, 0x6B, 0x02, 0xF1, 0x03, 0x6E, 0x4C, 0xEB, ++0xCB, 0xEE, 0x6C, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x00, 0x6C, 0xA4, 0x67, ++0x00, 0x18, 0x01, 0xA6, 0xC4, 0x67, 0x00, 0x18, 0xAF, 0x58, 0x00, 0x65, 0x00, 0x6D, 0x01, 0xF4, ++0x03, 0x6C, 0x00, 0x18, 0xEA, 0x53, 0xC5, 0x67, 0xE6, 0xB3, 0x0A, 0x6A, 0x4C, 0xC3, 0x08, 0x6A, ++0x2A, 0xC3, 0x4D, 0xC3, 0x00, 0x1C, 0xF6, 0x1B, 0x06, 0xD3, 0x06, 0x93, 0xA2, 0x67, 0x05, 0x6A, ++0x84, 0xA3, 0x4B, 0xEA, 0x01, 0x71, 0x8C, 0xEA, 0x44, 0xC3, 0x09, 0x61, 0x03, 0x6C, 0x80, 0x18, ++0xD6, 0x28, 0x05, 0xD5, 0x00, 0x18, 0x4A, 0x56, 0x00, 0x6C, 0x05, 0x95, 0x05, 0x10, 0x02, 0x71, ++0x03, 0x61, 0x04, 0x6C, 0x4D, 0xEC, 0x84, 0xC3, 0x00, 0x1C, 0xFD, 0x1B, 0x85, 0x67, 0x86, 0x17, ++0x4F, 0x59, 0x80, 0xF1, 0x0D, 0x60, 0x44, 0xA4, 0x08, 0x5A, 0x80, 0xF1, 0x09, 0x60, 0xD1, 0xB3, ++0x7F, 0x6A, 0xA1, 0xAB, 0x2C, 0xEA, 0x48, 0x34, 0xE0, 0xF1, 0x1D, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, ++0x8D, 0xEA, 0x41, 0xCB, 0x84, 0xA0, 0x07, 0x6A, 0xA3, 0xA3, 0x8C, 0xEA, 0x50, 0x34, 0x71, 0x6A, ++0x4B, 0xEA, 0xAC, 0xEA, 0x8D, 0xEA, 0x43, 0xC3, 0x69, 0x17, 0x0A, 0x59, 0x44, 0xA4, 0x65, 0xA4, ++0x60, 0xF1, 0x0E, 0x60, 0x60, 0x33, 0x4D, 0xEB, 0xE3, 0xF7, 0x1F, 0x6C, 0xC1, 0xB2, 0x6C, 0xEC, ++0x94, 0x35, 0xC1, 0xB6, 0x80, 0x9A, 0xCC, 0xEC, 0xAD, 0xEC, 0x80, 0xDA, 0xBF, 0xB5, 0x24, 0x34, ++0x91, 0xE5, 0x80, 0xAC, 0x8C, 0x34, 0x62, 0xEC, 0x40, 0xF1, 0x1A, 0x61, 0x03, 0x59, 0x06, 0x60, ++0x80, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x60, 0xC2, 0x0C, 0x10, 0x80, 0xA2, 0xA4, 0xA2, ++0x01, 0x6B, 0x8D, 0xEB, 0x06, 0x59, 0x60, 0xC2, 0x98, 0x67, 0x7F, 0x6B, 0x9C, 0x34, 0xAC, 0xEB, ++0x8D, 0xEB, 0x64, 0xC2, 0xB2, 0xB2, 0x25, 0xE2, 0x80, 0xA1, 0xAE, 0xB3, 0x0F, 0x6A, 0x8C, 0xEA, ++0xA0, 0xA3, 0x44, 0x34, 0x1F, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, 0x8D, 0xEA, 0x40, 0xC3, 0x2E, 0x17, ++0x45, 0xA4, 0x08, 0x5A, 0x20, 0xF1, 0x14, 0x60, 0x44, 0xA4, 0xA6, 0xB3, 0xA4, 0xA3, 0x40, 0x32, ++0x2D, 0xEA, 0x53, 0xCB, 0x85, 0xA4, 0x07, 0x6A, 0x8C, 0xEA, 0x4C, 0x34, 0x39, 0x6A, 0x4B, 0xEA, ++0xAC, 0xEA, 0x1A, 0x17, 0x44, 0xA4, 0x9F, 0xB3, 0x40, 0x32, 0x2D, 0xEA, 0x52, 0xCB, 0x45, 0xA4, ++0x20, 0xF0, 0x48, 0xC3, 0x13, 0x17, 0x9B, 0xB2, 0x26, 0xC2, 0x64, 0xA4, 0x67, 0xC2, 0x65, 0xA4, ++0x68, 0xC2, 0x0C, 0x17, 0x97, 0xB2, 0x63, 0xA2, 0x3E, 0x35, 0x7F, 0x6C, 0xBC, 0x35, 0x8C, 0xEB, ++0xAD, 0xEB, 0x8C, 0xE9, 0x63, 0xC2, 0x25, 0xC2, 0x01, 0x17, 0x92, 0xB2, 0x2E, 0xC2, 0x64, 0xA4, ++0x6F, 0xC2, 0x65, 0xA4, 0x70, 0xC2, 0xFA, 0x16, 0x8E, 0xB2, 0x31, 0xC2, 0x64, 0xA4, 0x72, 0xC2, ++0x65, 0xA4, 0x73, 0xC2, 0xF3, 0x16, 0x8B, 0xB3, 0x49, 0xA3, 0x0A, 0x72, 0x2C, 0x61, 0x8C, 0xA3, ++0x00, 0x6A, 0x0A, 0x74, 0x0E, 0x60, 0xC0, 0xF2, 0x0C, 0x4A, 0x58, 0xEC, 0x89, 0xB2, 0x12, 0xEC, ++0x91, 0xE2, 0xC0, 0xF0, 0x48, 0xA4, 0x04, 0x72, 0x05, 0x6A, 0x03, 0x60, 0x0A, 0x6A, 0x4C, 0xC3, ++0x00, 0x6A, 0x80, 0xB3, 0x8D, 0xA3, 0x08, 0x74, 0x5D, 0x60, 0xFF, 0x6A, 0x09, 0x4A, 0x58, 0xEC, ++0x81, 0xB3, 0x12, 0xEA, 0x49, 0xE3, 0x20, 0xF1, 0xAF, 0xA2, 0x01, 0x6A, 0x4C, 0xED, 0x06, 0x25, ++0x00, 0xF1, 0x72, 0xAB, 0x67, 0xEC, 0x4C, 0xEB, 0x05, 0x6A, 0x4C, 0x2B, 0x75, 0xB2, 0x08, 0x6B, ++0x6D, 0xC2, 0x00, 0x6A, 0x47, 0x10, 0x8B, 0x42, 0xFF, 0x6B, 0x6C, 0xEC, 0x03, 0x5C, 0x1A, 0x60, ++0x00, 0x6A, 0xC0, 0xF2, 0x0C, 0x6C, 0x98, 0xEA, 0x72, 0xB3, 0x12, 0xEC, 0x91, 0xE3, 0xC0, 0xF0, ++0x68, 0xA4, 0x04, 0x73, 0x09, 0x61, 0xE0, 0xF0, 0xA8, 0x9C, 0x6A, 0xB3, 0xA5, 0xDB, 0xE0, 0xF0, ++0x8C, 0xAC, 0x4C, 0xC3, 0x8C, 0xCB, 0x26, 0x10, 0x01, 0x4A, 0xFF, 0x6B, 0x6C, 0xEA, 0x0A, 0x5A, ++0xE8, 0x61, 0x27, 0x10, 0x88, 0x42, 0x6C, 0xEC, 0x02, 0x5C, 0x24, 0x60, 0x00, 0x6A, 0xFF, 0x6C, ++0x09, 0x4C, 0x98, 0xEA, 0x64, 0xB3, 0x01, 0x6D, 0x12, 0xEC, 0x91, 0xE3, 0x20, 0xF1, 0xCF, 0xA4, ++0xAC, 0xEE, 0x12, 0x26, 0x00, 0xF1, 0x72, 0xAB, 0x67, 0xEA, 0xAC, 0xEB, 0x0D, 0x23, 0x60, 0xF1, ++0xBE, 0xAC, 0x58, 0xB3, 0xAA, 0xCB, 0x80, 0xF1, 0xA0, 0xAC, 0xAB, 0xCB, 0x80, 0xF1, 0x82, 0xAC, ++0x4D, 0xC3, 0x8C, 0xCB, 0x05, 0x6A, 0x06, 0x10, 0x01, 0x4A, 0xFF, 0x6B, 0x6C, 0xEA, 0x08, 0x5A, ++0xDE, 0x61, 0x04, 0x6A, 0x4F, 0xB3, 0x6A, 0xA3, 0x40, 0x32, 0x6D, 0xEA, 0x44, 0x10, 0x53, 0xB3, ++0x20, 0xF0, 0x9E, 0xA3, 0x20, 0xF0, 0x5D, 0xA3, 0x20, 0xF0, 0x7C, 0xA3, 0x80, 0x34, 0x40, 0x32, ++0x80, 0x34, 0x8D, 0xEA, 0x6D, 0x10, 0x4D, 0xB3, 0x40, 0xF0, 0x81, 0xA3, 0x40, 0xF0, 0x40, 0xA3, ++0x20, 0xF0, 0x7F, 0xA3, 0x80, 0x34, 0x40, 0x32, 0x80, 0x34, 0x8D, 0xEA, 0x61, 0x10, 0x41, 0xB2, ++0x34, 0xC2, 0x64, 0xA4, 0x75, 0xC2, 0x65, 0xA4, 0x76, 0xC2, 0x58, 0x16, 0x3D, 0xB2, 0x37, 0xC2, ++0x64, 0xA4, 0x78, 0xC2, 0x65, 0xA4, 0x79, 0xC2, 0x51, 0x16, 0x4F, 0x41, 0xFF, 0x6B, 0x6C, 0xEA, ++0x09, 0x5A, 0x56, 0x60, 0x5C, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, 0x1F, 0x6B, ++0x4C, 0xEB, 0x79, 0x6A, 0x4B, 0xEA, 0x4C, 0xEB, 0x2C, 0x36, 0x78, 0x6A, 0x4C, 0xEE, 0x5C, 0x6C, ++0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x6D, 0xEE, 0x39, 0x16, 0x2E, 0xB3, 0x8B, 0x9B, 0x34, 0xB5, ++0x56, 0xAB, 0xAC, 0xEC, 0x8B, 0xDB, 0x02, 0x6C, 0x35, 0x10, 0x2A, 0xB4, 0xAB, 0x9C, 0xFF, 0xF7, ++0x1F, 0x6B, 0xA2, 0x32, 0xAC, 0xEB, 0x42, 0x32, 0x6B, 0xDC, 0xF5, 0x17, 0x25, 0xB3, 0x8D, 0x9B, ++0x2B, 0xB5, 0x5A, 0xAB, 0xAC, 0xEC, 0x8D, 0xDB, 0xEE, 0x17, 0x22, 0xB4, 0xAD, 0x9C, 0xFF, 0xF7, ++0x1F, 0x6B, 0xA2, 0x32, 0xAC, 0xEB, 0x42, 0x32, 0x6D, 0xDC, 0xE5, 0x17, 0x78, 0x6C, 0x03, 0x10, ++0x76, 0x6C, 0x01, 0x10, 0x77, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xDC, 0x17, 0x19, 0xB3, ++0x96, 0xA3, 0x55, 0xA3, 0x74, 0xA3, 0x80, 0x34, 0x40, 0x32, 0x80, 0x34, 0x8D, 0xEA, 0x08, 0x10, ++0x14, 0xB3, 0x99, 0xA3, 0x58, 0xA3, 0x77, 0xA3, 0x80, 0x34, 0x40, 0x32, 0x80, 0x34, 0x8D, 0xEA, ++0x6D, 0xEA, 0x03, 0x6C, 0x00, 0x6B, 0x07, 0x10, 0x00, 0x18, 0x00, 0x30, 0x90, 0x67, 0x10, 0x10, ++0x00, 0x6C, 0x03, 0x6B, 0x44, 0x67, 0x90, 0x34, 0x6D, 0xEC, 0x83, 0xC0, 0x81, 0xA0, 0x10, 0x6B, ++0x6B, 0xEB, 0x8C, 0xEB, 0x61, 0xC0, 0xA0, 0x98, 0x02, 0x6C, 0x00, 0x18, 0x55, 0x2F, 0xC2, 0x67, ++0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x01, 0x6A, 0x00, 0xEF, 0x06, 0x63, 0x40, 0x00, 0x11, 0x80, ++0xE8, 0x93, 0x11, 0x80, 0x1F, 0x00, 0xFC, 0xFF, 0x30, 0xBF, 0x10, 0x80, 0x24, 0xBF, 0x10, 0x80, ++0x74, 0x54, 0x11, 0x80, 0x00, 0x3B, 0x11, 0x80, 0x48, 0x00, 0x11, 0x80, 0x00, 0x00, 0xFF, 0xFF, ++0x0B, 0xB3, 0x7C, 0x4B, 0x77, 0x9B, 0x0C, 0x6E, 0x0A, 0xB2, 0x40, 0xF7, 0x62, 0x33, 0xD8, 0xEB, ++0xE0, 0xF0, 0x86, 0xAA, 0xE0, 0xF0, 0xA8, 0xAA, 0xB7, 0xE4, 0x12, 0xEB, 0x63, 0xED, 0x03, 0x60, ++0x6D, 0xE4, 0xE0, 0xF0, 0x66, 0xCA, 0x20, 0xE8, 0x00, 0x65, 0x00, 0x65, 0x48, 0x00, 0x11, 0x80, ++0x00, 0x3B, 0x11, 0x80, 0x00, 0x6A, 0x21, 0xB5, 0x55, 0xE5, 0xA0, 0xA5, 0x20, 0xB3, 0x51, 0xE3, ++0x20, 0xF1, 0xBA, 0xC4, 0x01, 0x4A, 0xFF, 0x6C, 0x8C, 0xEA, 0x10, 0x5A, 0xF4, 0x61, 0x60, 0xF1, ++0x41, 0xA3, 0x0D, 0x72, 0x03, 0x61, 0x15, 0x6A, 0x60, 0xF1, 0x41, 0xC3, 0x18, 0xB2, 0x0A, 0x6B, ++0x40, 0xF1, 0x7A, 0xC2, 0x09, 0x6B, 0x40, 0xF1, 0x7B, 0xC2, 0x40, 0xF1, 0x7C, 0xC2, 0x40, 0xF1, ++0x7D, 0xC2, 0x40, 0xF1, 0x7E, 0xC2, 0x24, 0xF0, 0x13, 0x6B, 0x60, 0xF1, 0x62, 0xCA, 0x06, 0xF4, ++0x1F, 0x6B, 0x60, 0xF1, 0x64, 0xCA, 0x0A, 0xF4, 0x17, 0x6B, 0x60, 0xF1, 0x66, 0xCA, 0x0E, 0xF2, ++0x0D, 0x6B, 0x60, 0xF1, 0x68, 0xCA, 0x04, 0xF5, 0x00, 0x6B, 0x6B, 0xEB, 0x60, 0xF1, 0x6A, 0xCA, ++0x00, 0x6B, 0xC0, 0xF1, 0x68, 0xCA, 0xC0, 0xF1, 0x6A, 0xCA, 0xC0, 0xF1, 0x6C, 0xCA, 0xC0, 0xF1, ++0x6E, 0xCA, 0x20, 0xE8, 0x00, 0x65, 0x00, 0x65, 0x58, 0xC0, 0x10, 0x80, 0x48, 0x00, 0x11, 0x80, ++0xFF, 0x6A, 0x4C, 0xEE, 0x4C, 0xEC, 0x4C, 0xED, 0xEC, 0xEA, 0x57, 0xE5, 0x00, 0xF6, 0xA0, 0x35, ++0x00, 0xF6, 0xA3, 0x35, 0xB8, 0xED, 0xD3, 0xE4, 0x00, 0xF6, 0x80, 0x34, 0x00, 0xF6, 0x83, 0x34, ++0xFF, 0xF7, 0x1F, 0x6B, 0x12, 0xED, 0x98, 0xEC, 0x12, 0xEC, 0x89, 0xE5, 0x20, 0xE8, 0x6C, 0xEA, ++0x62, 0xA4, 0x60, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x0B, 0x22, 0x00, 0x6A, ++0x06, 0xB3, 0x40, 0xDB, 0x06, 0xB3, 0x40, 0xDB, 0x06, 0xB3, 0x40, 0xDB, 0x06, 0xB3, 0x40, 0xDB, ++0x06, 0xB3, 0x40, 0xDB, 0x20, 0xE8, 0x01, 0x6A, 0x24, 0xC1, 0x10, 0x80, 0x4C, 0x8B, 0x10, 0x80, ++0x54, 0x8B, 0x10, 0x80, 0x58, 0x8B, 0x10, 0x80, 0x60, 0x8B, 0x10, 0x80, 0x20, 0xE8, 0x01, 0x6A, ++0x20, 0xE8, 0x00, 0x6A, 0x20, 0xE8, 0x00, 0x6A, 0xFD, 0x63, 0x05, 0x62, 0x40, 0x9C, 0x3F, 0x6B, ++0x6C, 0xEA, 0x30, 0x72, 0x00, 0x6A, 0x03, 0x61, 0x80, 0x18, 0x9C, 0x2B, 0x00, 0x65, 0x05, 0x97, ++0x00, 0xEF, 0x03, 0x63, 0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, 0x18, 0xB2, 0x19, 0xB3, ++0x63, 0xEA, 0x26, 0x61, 0x18, 0xB2, 0x80, 0x9A, 0x18, 0xB3, 0x8E, 0xEB, 0x21, 0x2B, 0x02, 0xAA, ++0x17, 0xB5, 0x1D, 0x10, 0x17, 0xB4, 0x42, 0x45, 0x43, 0xEC, 0x1A, 0x61, 0xC0, 0xA2, 0xFF, 0xF7, ++0x1F, 0x6F, 0x43, 0x46, 0x43, 0xE8, 0x14, 0x61, 0x45, 0xE5, 0x23, 0xEC, 0x11, 0x61, 0x81, 0xA5, ++0x60, 0xA5, 0x80, 0x34, 0x6D, 0xEC, 0xEC, 0xEC, 0xE0, 0xF3, 0x14, 0x5C, 0x09, 0x60, 0x43, 0xE0, ++0x0D, 0xB2, 0x03, 0x4D, 0x91, 0xE2, 0x00, 0x18, 0xF6, 0x33, 0xEC, 0xE8, 0xB1, 0x67, 0xE2, 0x28, ++0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x00, 0xEF, 0x05, 0x63, 0x00, 0x65, 0xF0, 0xFF, 0x10, 0x80, ++0x20, 0xC1, 0x10, 0x80, 0x24, 0xC1, 0x10, 0x80, 0x55, 0xAB, 0x23, 0x87, 0x2A, 0xC1, 0x10, 0x80, ++0xFF, 0xFF, 0x10, 0x80, 0x48, 0x00, 0x11, 0x80, 0xFC, 0x63, 0x07, 0x62, 0x0B, 0xB2, 0x42, 0xAA, ++0x60, 0xAC, 0x9D, 0x67, 0x4F, 0xEA, 0x6C, 0xEA, 0xFF, 0xF7, 0x1F, 0x6B, 0x4C, 0xEB, 0x48, 0xCC, ++0x62, 0x33, 0x20, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x18, 0x0C, 0xD6, 0x00, 0x65, 0x07, 0x97, ++0x00, 0x6A, 0x00, 0xEF, 0x04, 0x63, 0x00, 0x65, 0x00, 0x3B, 0x11, 0x80, 0xF8, 0x63, 0x0F, 0x62, ++0x0E, 0xD0, 0x68, 0xA4, 0x01, 0x6A, 0x04, 0x67, 0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, 0x19, 0x02, ++0x00, 0x65, 0x63, 0x2A, 0x68, 0xA0, 0x04, 0x6A, 0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, 0xB0, 0x01, ++0x90, 0x67, 0x5B, 0x2A, 0x68, 0xA0, 0x08, 0x6A, 0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, 0x8B, 0x01, ++0x90, 0x67, 0x53, 0x2A, 0x66, 0xA0, 0x80, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, ++0x2B, 0x22, 0x00, 0x18, 0x82, 0xA9, 0x00, 0x6C, 0x20, 0x18, 0x08, 0x2F, 0x00, 0x65, 0x1A, 0x22, ++0x30, 0xB2, 0x61, 0xA2, 0x0C, 0x6A, 0x6C, 0xEA, 0x04, 0x72, 0x14, 0x60, 0x66, 0xA0, 0x7F, 0x6A, ++0x01, 0x6C, 0x6C, 0xEA, 0xC0, 0xF5, 0x1C, 0x6D, 0x20, 0x18, 0xED, 0x2E, 0x46, 0xC0, 0x00, 0x6A, ++0x29, 0xB3, 0x40, 0xDB, 0x29, 0xB3, 0x40, 0xDB, 0x29, 0xB3, 0x40, 0xDB, 0x29, 0xB3, 0x40, 0xDB, ++0x29, 0xB3, 0x40, 0xDB, 0x23, 0xB2, 0x61, 0xA2, 0x0C, 0x6A, 0x6C, 0xEA, 0x04, 0x72, 0x04, 0x61, ++0x66, 0xA0, 0x7F, 0x6A, 0x6C, 0xEA, 0x46, 0xC0, 0x24, 0xB2, 0x80, 0xF0, 0x7C, 0xA2, 0x5D, 0x67, ++0x20, 0xF0, 0x70, 0xC2, 0x04, 0x6A, 0x6C, 0xEA, 0x07, 0x22, 0x66, 0xA0, 0x7F, 0x6A, 0x6C, 0xEA, ++0x21, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, 0x46, 0xC0, 0x1C, 0xB2, 0x20, 0xF0, 0x7B, 0xA2, 0x5D, 0x67, ++0x20, 0xF0, 0x74, 0xC2, 0x40, 0x6A, 0x6C, 0xEA, 0x05, 0x22, 0x66, 0xA0, 0x21, 0x6A, 0x4B, 0xEA, ++0x6C, 0xEA, 0x46, 0xC0, 0x00, 0x18, 0xB8, 0x37, 0x84, 0x40, 0x05, 0x6A, 0x04, 0xD2, 0x14, 0xB2, ++0x05, 0xD2, 0x40, 0x98, 0x04, 0x6C, 0xFA, 0x6D, 0x06, 0xD2, 0x43, 0x98, 0xC0, 0xF6, 0x1A, 0x6E, ++0xA1, 0xF1, 0x1A, 0x6F, 0x07, 0xD2, 0x42, 0x98, 0x08, 0xD2, 0x41, 0x98, 0x09, 0xD2, 0x44, 0x98, ++0x20, 0x18, 0xC5, 0x30, 0x0A, 0xD2, 0x0F, 0x97, 0x0E, 0x90, 0x01, 0x6A, 0x00, 0xEF, 0x08, 0x63, ++0xC0, 0x1E, 0x11, 0x80, 0x24, 0xC1, 0x10, 0x80, 0x4C, 0x8B, 0x10, 0x80, 0x54, 0x8B, 0x10, 0x80, ++0x58, 0x8B, 0x10, 0x80, 0x60, 0x8B, 0x10, 0x80, 0x48, 0x00, 0x11, 0x80, 0xB0, 0xE7, 0x04, 0x80, ++0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x00, 0x1C, 0xF6, 0x1B, 0x00, 0x65, 0x02, 0x67, 0x0F, 0xB2, ++0x60, 0x9A, 0x0F, 0xB2, 0x00, 0x6C, 0x6E, 0xEA, 0x02, 0x2A, 0x0E, 0xB2, 0x80, 0x9A, 0x0E, 0xB3, ++0x82, 0x34, 0x82, 0x34, 0x40, 0x9B, 0xFF, 0xF7, 0x1F, 0x6D, 0x80, 0x34, 0xAC, 0xEA, 0x80, 0x34, ++0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x18, 0xB5, 0x26, 0x00, 0x6C, 0x00, 0x1C, 0xFD, 0x1B, 0x90, 0x67, ++0x05, 0x97, 0x04, 0x90, 0x00, 0xEF, 0x03, 0x63, 0x58, 0x8B, 0x10, 0x80, 0x32, 0x97, 0x79, 0x23, ++0x5C, 0x8B, 0x10, 0x80, 0x30, 0x00, 0x00, 0xB5, 0xFD, 0x63, 0x05, 0x62, 0x80, 0x18, 0x4D, 0x28, ++0x00, 0x65, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, 0x0C, 0xB2, 0x0D, 0xB3, ++0x72, 0xDA, 0x0D, 0xB3, 0x75, 0xDA, 0x0D, 0xB3, 0x69, 0xDA, 0x0D, 0xB3, 0x6C, 0xDA, 0x0D, 0xB3, ++0x6F, 0xDA, 0x0D, 0xB3, 0x66, 0xDA, 0x0D, 0xB3, 0x7B, 0xDA, 0x0D, 0xB3, 0x60, 0xDA, 0x0D, 0xB3, ++0x80, 0x18, 0x4D, 0x28, 0x78, 0xDA, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0x84, 0x88, 0x11, 0x80, ++0x15, 0xBF, 0x10, 0x80, 0x05, 0xBF, 0x10, 0x80, 0xF5, 0xBE, 0x10, 0x80, 0xE5, 0xBE, 0x10, 0x80, ++0xD5, 0xBE, 0x10, 0x80, 0xC5, 0xBE, 0x10, 0x80, 0x7D, 0xBE, 0x10, 0x80, 0x6D, 0xBE, 0x10, 0x80, ++0x5D, 0xBE, 0x10, 0x80, 0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x00, 0x68, 0x18, 0xB4, 0x04, 0x32, ++0x49, 0xE4, 0x60, 0xAA, 0xFF, 0xF7, 0x1F, 0x73, 0x0E, 0x60, 0x41, 0x40, 0x44, 0x32, 0x49, 0xE4, ++0xC0, 0xAA, 0x3F, 0x6C, 0x6C, 0xEC, 0x00, 0x18, 0x01, 0xA6, 0x00, 0x6D, 0x02, 0x48, 0xFF, 0x6A, ++0x4C, 0xE8, 0x10, 0x58, 0xEB, 0x61, 0x00, 0x68, 0x0E, 0xB4, 0x04, 0x32, 0x49, 0xE4, 0x60, 0xAA, ++0xFF, 0xF7, 0x1F, 0x73, 0x0E, 0x60, 0x41, 0x40, 0x44, 0x32, 0x49, 0xE4, 0xC0, 0xAA, 0x3F, 0x6C, ++0x6C, 0xEC, 0x00, 0x18, 0x01, 0xA6, 0x00, 0x6D, 0x02, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, 0x1A, 0x58, ++0xEB, 0x61, 0x05, 0x97, 0x04, 0x90, 0x00, 0xEF, 0x03, 0x63, 0x00, 0x65, 0x04, 0xC0, 0x10, 0x80, ++0x24, 0xC0, 0x10, 0x80, 0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0xF7, 0x1F, 0x6A, ++0x4C, 0xEE, 0x4C, 0xED, 0xFF, 0x6A, 0x0C, 0xD4, 0x06, 0xD6, 0x04, 0xD5, 0x05, 0xD2, 0x5C, 0x10, ++0x04, 0x93, 0x0C, 0x94, 0x64, 0x32, 0x49, 0xE4, 0x40, 0xAA, 0xFF, 0xF7, 0x1F, 0x72, 0x58, 0x60, ++0xE0, 0xF3, 0x1F, 0x68, 0x01, 0x4B, 0x4C, 0xE8, 0x64, 0x33, 0x42, 0x32, 0x6D, 0xE4, 0x56, 0x32, ++0x20, 0xAB, 0x44, 0x32, 0x03, 0x0B, 0x49, 0xE3, 0x40, 0x8A, 0x4D, 0xE3, 0x00, 0xEB, 0x00, 0x65, ++0x11, 0x00, 0x19, 0x00, 0x6F, 0x00, 0x45, 0x00, 0x4D, 0x00, 0x6F, 0x00, 0x57, 0x00, 0x61, 0x00, ++0x3F, 0x6C, 0x0C, 0xEC, 0x00, 0x6D, 0x12, 0x10, 0x05, 0x93, 0x02, 0x32, 0x4A, 0xEB, 0x08, 0x60, ++0xC2, 0x67, 0x40, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x07, 0xD2, 0x07, 0x92, 0x05, 0xD2, ++0x7F, 0x6C, 0x0C, 0xEC, 0x87, 0x34, 0x40, 0x6A, 0x4D, 0xEC, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, ++0xD1, 0x67, 0x1C, 0x10, 0x00, 0x18, 0xC6, 0x1C, 0x91, 0x67, 0x18, 0x10, 0x01, 0x6A, 0x0C, 0xEA, ++0x15, 0x2A, 0x13, 0xB2, 0x09, 0x10, 0x01, 0x6A, 0x0C, 0xEA, 0x10, 0x2A, 0x11, 0xB2, 0x04, 0x10, ++0x01, 0x6A, 0x0C, 0xEA, 0x0B, 0x2A, 0x10, 0xB2, 0x41, 0xE0, 0x20, 0xC8, 0x07, 0x10, 0x01, 0x6A, ++0x0C, 0xEA, 0x04, 0x2A, 0x90, 0x67, 0x00, 0x18, 0xC3, 0x3B, 0xB1, 0x67, 0x04, 0x94, 0xFF, 0xF7, ++0x1F, 0x6A, 0x02, 0x4C, 0x4C, 0xEC, 0x04, 0xD4, 0x04, 0x92, 0x06, 0x93, 0x63, 0xEA, 0xA0, 0x61, ++0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x00, 0xEF, 0x06, 0x63, 0x00, 0x65, 0x00, 0xA0, 0x00, 0xB0, ++0x00, 0x00, 0x00, 0xB5, 0x00, 0x10, 0x00, 0xB6, 0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, ++0x00, 0x68, 0x24, 0x67, 0x04, 0x32, 0x49, 0xE1, 0x60, 0xAA, 0xFF, 0xF7, 0x1F, 0x73, 0x29, 0x60, ++0x1E, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x0C, 0xF0, 0x00, 0x72, 0x07, 0x61, 0x41, 0x40, 0x44, 0x32, ++0x49, 0xE1, 0x00, 0x18, 0xC1, 0x1C, 0x80, 0xAA, 0x18, 0x10, 0x04, 0xF0, 0x00, 0x72, 0x0B, 0x61, ++0xFF, 0x6C, 0x8C, 0xEB, 0x40, 0x6A, 0x67, 0x33, 0x4D, 0xEB, 0x41, 0x40, 0x44, 0x32, 0x49, 0xE1, ++0x6C, 0xEC, 0x01, 0x6D, 0x07, 0x10, 0x0D, 0x2A, 0x41, 0x40, 0x44, 0x32, 0xFF, 0x6C, 0x49, 0xE1, ++0x6C, 0xEC, 0x00, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0xC0, 0xAA, 0x02, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, ++0xD1, 0x17, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x00, 0xEF, 0x04, 0x63, 0xF9, 0x63, 0x0D, 0x62, ++0x0C, 0xD1, 0x0B, 0xD0, 0xFF, 0x68, 0x00, 0x6E, 0x8C, 0xE8, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, ++0x40, 0x6C, 0x5A, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x5C, 0x6C, 0x01, 0x6D, 0x00, 0x18, ++0xA1, 0xA5, 0x22, 0x67, 0xFF, 0xF7, 0x1F, 0x6B, 0x6C, 0xE9, 0xFF, 0xF7, 0x1E, 0x6E, 0x6C, 0xEA, ++0x5A, 0x6C, 0x01, 0x6D, 0x2C, 0xEE, 0x08, 0xD2, 0x00, 0x18, 0x01, 0xA6, 0x09, 0xD3, 0x08, 0x92, ++0x09, 0x93, 0x03, 0x6E, 0x4D, 0xEE, 0x5C, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x6C, 0xEE, ++0x42, 0xB4, 0x80, 0x18, 0x86, 0x2E, 0x00, 0x65, 0x06, 0x20, 0x90, 0x67, 0x00, 0x18, 0xC6, 0x1C, ++0x00, 0x68, 0x70, 0x67, 0x24, 0x10, 0x01, 0x6D, 0xC5, 0x67, 0x00, 0x18, 0x01, 0xA6, 0x40, 0x6C, ++0x41, 0x6C, 0x38, 0xF0, 0x03, 0x6E, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x00, 0x18, 0xC1, 0x1C, ++0x0A, 0x6C, 0x00, 0x68, 0x7E, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x00, 0xF2, 0x00, 0x6B, ++0x4C, 0xEB, 0x02, 0x23, 0x00, 0x6B, 0x0B, 0x10, 0x00, 0x18, 0xC6, 0x1C, 0x0A, 0x6C, 0x01, 0x48, ++0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xE8, 0xE0, 0xF3, 0x08, 0x58, 0xEC, 0x61, 0x01, 0x6B, 0x2C, 0xB4, ++0x80, 0x18, 0x86, 0x2E, 0x09, 0xD3, 0x5A, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0xD1, 0x67, ++0x08, 0x96, 0x5C, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x01, 0x6D, 0xC5, 0x67, 0x00, 0x18, ++0x01, 0xA6, 0x40, 0x6C, 0x7E, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x40, 0x6C, 0x01, 0x6D, ++0x00, 0x6E, 0x00, 0x18, 0x01, 0xA6, 0x08, 0xD2, 0x09, 0x93, 0x09, 0x23, 0x21, 0x6C, 0x08, 0xF2, ++0x00, 0x6E, 0x00, 0x18, 0x01, 0xA6, 0x00, 0x6D, 0xFF, 0xF7, 0x1F, 0x69, 0x07, 0x10, 0x21, 0x6C, ++0x00, 0x18, 0xA1, 0xA5, 0x00, 0x6D, 0xFF, 0xF7, 0x1F, 0x69, 0x4C, 0xE9, 0x15, 0xB3, 0x01, 0x6A, ++0x04, 0x6C, 0xFA, 0x6D, 0xE0, 0xF4, 0x0B, 0x6E, 0xC4, 0xF3, 0x15, 0x6F, 0x05, 0xD3, 0x06, 0xD0, ++0x09, 0xD3, 0x20, 0x18, 0xC5, 0x30, 0x04, 0xD2, 0x09, 0x93, 0x02, 0x6A, 0x04, 0xD2, 0x05, 0xD3, ++0x08, 0x93, 0xFF, 0xF7, 0x1F, 0x6A, 0x05, 0x6C, 0x6C, 0xEA, 0xFA, 0x6D, 0xE0, 0xF4, 0x0C, 0x6E, ++0x44, 0xF5, 0x18, 0x6F, 0x06, 0xD1, 0x20, 0x18, 0xC5, 0x30, 0x07, 0xD2, 0x51, 0x67, 0x0D, 0x97, ++0x0C, 0x91, 0x0B, 0x90, 0x00, 0xEF, 0x07, 0x63, 0x68, 0xC0, 0x10, 0x80, 0xFC, 0xC0, 0x10, 0x80, ++0xB0, 0xE7, 0x04, 0x80, 0xF5, 0x63, 0x15, 0x62, 0x14, 0xD1, 0x13, 0xD0, 0x8A, 0xB2, 0xA0, 0xF2, ++0x6C, 0xAA, 0x04, 0x2B, 0x01, 0x6B, 0x6B, 0xEB, 0xA0, 0xF2, 0x6C, 0xCA, 0x00, 0x18, 0x71, 0xA7, ++0x00, 0x65, 0x86, 0xB4, 0x00, 0x6D, 0x80, 0x18, 0x49, 0x2E, 0x5C, 0x6E, 0x82, 0xB2, 0xA0, 0xF2, ++0x50, 0xAA, 0x3D, 0x72, 0x06, 0x60, 0xFF, 0x6E, 0x81, 0xB4, 0x5E, 0x6D, 0x80, 0x18, 0x49, 0x2E, ++0x01, 0x4E, 0x80, 0x18, 0x2D, 0x2E, 0xFF, 0x69, 0x00, 0x18, 0x62, 0xA6, 0x00, 0x65, 0x00, 0x18, ++0x47, 0xA6, 0x00, 0x65, 0x00, 0x18, 0x87, 0xA4, 0x00, 0x65, 0x00, 0x18, 0x91, 0xA4, 0x00, 0x65, ++0x02, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x00, 0x6D, 0x3F, 0x6C, 0x00, 0x6D, 0x00, 0x18, 0xA1, 0xA5, ++0x11, 0xD2, 0x11, 0x93, 0x2C, 0xEA, 0xFF, 0xF7, 0x1F, 0x68, 0x0C, 0xD2, 0x0C, 0xEB, 0x0C, 0x95, ++0x62, 0x33, 0x2C, 0xEB, 0x01, 0x6A, 0xC3, 0x67, 0x82, 0x67, 0xE2, 0x67, 0x11, 0xD3, 0x80, 0x18, ++0xA3, 0x2E, 0x04, 0xD2, 0x11, 0x93, 0x0C, 0x95, 0x03, 0x6A, 0xC3, 0x67, 0x00, 0x6C, 0x0F, 0x6F, ++0x80, 0x18, 0xA3, 0x2E, 0x04, 0xD2, 0x42, 0x34, 0x1F, 0x6D, 0x11, 0x93, 0x8A, 0x34, 0x56, 0x32, ++0xAC, 0xEC, 0xAC, 0xEA, 0x0C, 0x95, 0x03, 0x6E, 0x0B, 0xD4, 0x04, 0xD6, 0x00, 0x6C, 0xC3, 0x67, ++0x0F, 0x6F, 0x80, 0x18, 0xA3, 0x2E, 0x0A, 0xD2, 0x42, 0x37, 0x1F, 0x6C, 0xEA, 0x37, 0x8C, 0xEF, ++0x09, 0xD7, 0x56, 0x35, 0x8C, 0xED, 0x0B, 0x96, 0x09, 0x94, 0x08, 0xD5, 0x2C, 0xED, 0x2C, 0xEE, ++0x2C, 0xEC, 0x0D, 0xD5, 0x0A, 0x97, 0x97, 0xE6, 0x10, 0xD6, 0x0D, 0x96, 0x2C, 0xEF, 0x0E, 0xD4, ++0xD3, 0xE7, 0x00, 0xF6, 0x80, 0x34, 0x00, 0xF6, 0x83, 0x34, 0x98, 0xEC, 0x00, 0xF6, 0xA0, 0x35, ++0x00, 0xF6, 0xA3, 0x35, 0x0F, 0xD7, 0x11, 0x93, 0x12, 0xEC, 0xB8, 0xED, 0x12, 0xED, 0xB1, 0xE4, ++0x0C, 0xEC, 0x11, 0x5C, 0x09, 0x60, 0x09, 0x93, 0x0B, 0x94, 0x08, 0x95, 0x0A, 0x97, 0x99, 0xE3, ++0xC7, 0x36, 0x0C, 0xEE, 0xED, 0xE5, 0x55, 0x10, 0x0C, 0x95, 0xC3, 0x67, 0x03, 0x6A, 0x00, 0x6C, ++0x0F, 0x6F, 0x80, 0x18, 0xA3, 0x2E, 0x04, 0xD2, 0x42, 0x36, 0x1F, 0x6B, 0xCA, 0x36, 0x6C, 0xEE, ++0x10, 0x95, 0xE6, 0x67, 0x2C, 0xEF, 0x1F, 0x6C, 0x56, 0x33, 0x8C, 0xEB, 0xF3, 0xE5, 0x00, 0xF6, ++0x80, 0x34, 0x00, 0xF6, 0x83, 0x34, 0x0C, 0x65, 0x0F, 0x94, 0x6C, 0xE9, 0x37, 0xE4, 0x00, 0xF6, ++0xA0, 0x35, 0x00, 0xF6, 0xA3, 0x35, 0xB8, 0xED, 0x88, 0x67, 0x12, 0xED, 0x98, 0xEC, 0x12, 0xEC, ++0x95, 0xE5, 0x0E, 0x94, 0x0C, 0xED, 0x11, 0x5D, 0xFF, 0xE4, 0x0D, 0x94, 0x00, 0xF6, 0xE0, 0x37, ++0x00, 0xF6, 0xE3, 0x37, 0x27, 0xE4, 0x00, 0xF6, 0x20, 0x34, 0x00, 0xF6, 0x83, 0x34, 0x98, 0xEC, ++0x12, 0xEC, 0xF8, 0xEF, 0x12, 0xEF, 0xF1, 0xE4, 0x0C, 0xEC, 0x10, 0x60, 0xA3, 0xEC, 0x07, 0x60, ++0x09, 0x94, 0x08, 0x95, 0x99, 0xE6, 0xC7, 0x36, 0x0C, 0xEE, 0xAD, 0xE3, 0x12, 0x10, 0x0B, 0x97, ++0x0A, 0x94, 0xF9, 0xE6, 0xC7, 0x36, 0x0C, 0xEE, 0x8D, 0xE3, 0x0B, 0x10, 0x11, 0x5C, 0x03, 0x61, ++0x10, 0x6B, 0xC3, 0x67, 0x08, 0x10, 0x09, 0x95, 0x08, 0x97, 0xB9, 0xE6, 0xC7, 0x36, 0x0C, 0xEE, ++0xED, 0xE3, 0x67, 0x33, 0x0C, 0xEB, 0x1F, 0x6C, 0x4C, 0xEC, 0x10, 0xF0, 0x00, 0x6A, 0x4B, 0xEA, ++0xC0, 0x36, 0x4D, 0xEC, 0xC8, 0x36, 0x74, 0x33, 0x8D, 0xEE, 0x6D, 0xEE, 0xFF, 0xF7, 0x1F, 0x6A, ++0x4C, 0xEE, 0x21, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x00, 0x6D, 0x0E, 0x6C, 0x00, 0x18, 0xA1, 0xA5, ++0x00, 0x6D, 0x21, 0x6C, 0x00, 0x6D, 0x00, 0x18, 0xA1, 0xA5, 0x02, 0x67, 0x02, 0x6B, 0x04, 0xD3, ++0x01, 0x6C, 0x0C, 0xB3, 0xFA, 0x6D, 0x60, 0xF5, 0x15, 0x6E, 0xA4, 0xF3, 0x0D, 0x6F, 0x06, 0xD0, ++0x05, 0xD3, 0x20, 0x18, 0xC5, 0x30, 0x07, 0xD2, 0x15, 0x97, 0x14, 0x91, 0x13, 0x90, 0x00, 0xEF, ++0x0B, 0x63, 0x00, 0x65, 0x48, 0x00, 0x11, 0x80, 0x4C, 0xBF, 0x10, 0x80, 0x3C, 0x02, 0x11, 0x80, ++0xB0, 0xE7, 0x04, 0x80, 0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEE, 0x85, 0x67, 0x01, 0x76, ++0x4C, 0xEC, 0x05, 0x61, 0x40, 0x6B, 0x8D, 0xEB, 0x83, 0x67, 0x4C, 0xEC, 0x01, 0x10, 0x03, 0x2E, ++0x00, 0x18, 0xBC, 0xA5, 0xA7, 0x67, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, ++0x00, 0x18, 0x6D, 0xF5, 0x00, 0x65, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, ++0x00, 0x18, 0x5B, 0x3A, 0x00, 0x65, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, ++0x44, 0xAC, 0x01, 0x72, 0x10, 0x61, 0x60, 0x9C, 0x3F, 0x6A, 0x6C, 0xEA, 0x20, 0x72, 0x0B, 0x61, ++0x09, 0xB2, 0x6C, 0xEA, 0x08, 0x2A, 0x09, 0xB3, 0x40, 0xDB, 0x09, 0xB3, 0x40, 0xDB, 0x40, 0x9C, ++0x08, 0xB3, 0x6D, 0xEA, 0x40, 0xDC, 0x00, 0x18, 0xCE, 0x31, 0x00, 0x65, 0x05, 0x97, 0x00, 0xEF, ++0x03, 0x63, 0x00, 0x65, 0x00, 0x00, 0xFF, 0x00, 0x24, 0xC1, 0x10, 0x80, 0x4C, 0x8B, 0x10, 0x80, ++0x00, 0x00, 0x01, 0x00, 0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xA8, 0xBA, 0x00, 0x65, 0x05, 0x97, ++0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x25, 0xBB, 0x00, 0x65, 0x05, 0x97, ++0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xC7, 0x5C, 0x00, 0x65, 0x05, 0x97, ++0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x8C, 0x8E, 0x00, 0x65, 0x05, 0x97, ++0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x50, 0x5D, 0x00, 0x65, 0x05, 0x97, ++0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, 0x20, 0x18, 0x6A, 0x24, 0x00, 0x65, 0x05, 0x97, ++0x00, 0xEF, 0x03, 0x63, 0x04, 0x0B, 0x0F, 0x04, 0x0A, 0x0E, 0x08, 0x0B, 0x0F, 0x00, 0x00, 0x00, ++0x1B, 0x00, 0xB7, 0x00, 0x53, 0x01, 0x36, 0x00, 0x6F, 0x01, 0xA7, 0x02, 0x53, 0x00, 0x28, 0x02, ++0xFD, 0x03, 0x25, 0x00, 0x07, 0x04, 0x05, 0x01, 0x00, 0x00, 0x00, 0x00, 0x74, 0x41, 0x01, 0x10, ++0xAC, 0x80, 0x01, 0xF0, 0x78, 0x41, 0x07, 0x20, 0x7A, 0x41, 0xB1, 0x01, 0x7C, 0x41, 0x07, 0x00, ++0x7E, 0x41, 0xB1, 0x01, 0x0A, 0x22, 0x62, 0x02, 0x4E, 0x22, 0x9A, 0x06, 0x50, 0x22, 0x9A, 0x06, ++0x18, 0x20, 0x0F, 0x69, 0x34, 0x20, 0x55, 0x22, 0x38, 0x20, 0xA8, 0xC0, 0x00, 0x00, 0x06, 0x10, ++0x0E, 0x00, 0x2A, 0x10, 0x16, 0x00, 0x00, 0x24, 0x16, 0x00, 0x00, 0x00, 0x1C, 0x00, 0x20, 0x81, ++0x25, 0x00, 0x93, 0x23, 0x2B, 0x00, 0x80, 0x48, 0x21, 0x00, 0x00, 0x42, 0x24, 0x00, 0x00, 0xFE, ++0x26, 0x00, 0x2A, 0x08, 0x26, 0x00, 0x2A, 0x08, 0x27, 0x00, 0x60, 0x04, 0x28, 0x00, 0x42, 0x80, ++0x29, 0x00, 0x18, 0x46, 0x2A, 0x00, 0xC0, 0x40, 0x2D, 0x00, 0x08, 0x00, 0x37, 0x00, 0x04, 0xC0, ++0x0E, 0x00, 0x2A, 0x90, 0x31, 0x00, 0x01, 0x50, 0x32, 0x00, 0x71, 0x00, 0x33, 0x00, 0x70, 0x6F, ++0x0E, 0x00, 0xAA, 0x11, 0x2A, 0x00, 0xC0, 0x46, 0x24, 0x00, 0x01, 0xFE, 0x00, 0x60, 0x00, 0x01, ++0x2A, 0x00, 0xD0, 0x40, 0x1C, 0x00, 0x21, 0x81, 0x00, 0x60, 0x01, 0x00, 0x3F, 0x00, 0x00, 0x00, ++0x00, 0x60, 0x01, 0x00, 0x3F, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0F, 0x00, 0x00, 0x20, ++0xFF, 0xFF, 0xFF, 0xFF, 0x13, 0x00, 0x9B, 0x7D, 0x13, 0x00, 0x0E, 0x60, 0x13, 0x00, 0x9E, 0x5C, ++0x13, 0x00, 0x0A, 0x30, 0x13, 0x00, 0xF8, 0x2F, 0x13, 0x00, 0xC5, 0x1F, 0x13, 0x00, 0x90, 0x00, ++0xFF, 0xFF, 0xFF, 0xFF, 0x1F, 0x00, 0xCB, 0x70, 0x20, 0x00, 0xC4, 0xFF, 0x22, 0x00, 0x00, 0x00, ++0x23, 0x00, 0x15, 0xE0, 0x15, 0x00, 0x40, 0x00, 0x15, 0x00, 0xC0, 0x20, 0x15, 0x00, 0xC0, 0x48, ++0x15, 0x00, 0xC0, 0x69, 0x15, 0x00, 0xC0, 0x90, 0x15, 0x00, 0xC0, 0xB1, 0x15, 0x00, 0xC0, 0xD8, ++0x15, 0x00, 0xC0, 0xF9, 0xFF, 0xFF, 0xFF, 0xFF, 0x08, 0x0B, 0x28, 0x2B, 0x48, 0x4B, 0xC8, 0xCC, ++0xE9, 0xEC, 0xEE, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x21, 0x00, 0x00, 0xC2, 0x00, 0x00, 0x00, 0x50, ++0x01, 0x00, 0x00, 0x17, 0x02, 0x00, 0x00, 0xCC, 0x3F, 0x00, 0x01, 0x00, 0x3F, 0x00, 0x00, 0x00, ++0x00, 0x60, 0xF4, 0x01, 0x00, 0x20, 0x01, 0x00, 0x02, 0x20, 0x00, 0x00, 0x00, 0x20, 0x00, 0x00, ++0x40, 0x20, 0x00, 0x48, 0x42, 0x20, 0x00, 0x01, 0x44, 0x20, 0x00, 0x48, 0x46, 0x20, 0x00, 0x81, ++0x48, 0x20, 0x00, 0x00, 0x4A, 0x20, 0x00, 0xF8, 0x4C, 0x20, 0x00, 0x00, 0x4E, 0x20, 0x38, 0x01, ++0x50, 0x20, 0x30, 0xCC, 0x52, 0x20, 0x00, 0x08, 0x54, 0x20, 0x10, 0x8C, 0x56, 0x20, 0x00, 0xE0, ++0x58, 0x20, 0x00, 0x50, 0x5A, 0x20, 0x00, 0x80, 0x5C, 0x20, 0x00, 0x20, 0x5E, 0x20, 0x00, 0x00, ++0x00, 0x20, 0x01, 0x00, 0x08, 0x20, 0x14, 0x14, 0x0E, 0x20, 0x01, 0x00, 0x02, 0x20, 0x60, 0xC0, ++0x00, 0x60, 0x0A, 0x00, 0x02, 0x20, 0x20, 0xC0, 0x00, 0x60, 0x0A, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, ++0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x20, 0x01, 0x00, ++0x02, 0x20, 0x20, 0x00, 0x0C, 0x20, 0x10, 0x00, 0x0E, 0x20, 0x00, 0x80, 0x00, 0x20, 0x00, 0x00, ++0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, ++0x51, 0x47, 0x2E, 0x80, ++}; ++static const u4Byte ArrayLength_MP_8821A_FW_BT = 8484; ++ ++ ++void ++ODM_ReadFirmware_MP_8821A_FW_BT( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++) ++{ ++ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8821A_FW_BT; ++ *pFirmwareSize = ArrayLength_MP_8821A_FW_BT; ++} ++ ++ ++static const u1Byte Array_MP_8821A_FW_NIC[] = { ++0x01, 0x21, 0x10, 0x00, 0x0B, 0x00, 0x00, 0x00, 0x04, 0x23, 0x15, 0x35, 0xC4, 0x7C, 0x00, 0x00, ++0x71, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x02, 0x49, 0x61, 0x02, 0x5F, 0xF9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x60, 0x7A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x70, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x60, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x6F, 0x33, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x6F, 0xE6, 0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, ++0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, ++0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, ++0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x3F, 0x00, ++0x00, 0x00, 0x00, 0x0A, 0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, ++0x06, 0x03, 0x02, 0x00, 0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, ++0x08, 0x0C, 0x0A, 0x07, 0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, ++0x03, 0x00, 0x08, 0x0B, 0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, ++0x12, 0x09, 0x04, 0x00, 0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, ++0x20, 0x24, 0x22, 0x14, 0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, ++0x04, 0x00, 0x20, 0x23, 0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, ++0x1F, 0x0F, 0x04, 0x00, 0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, ++0x30, 0x31, 0x2F, 0x18, 0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, ++0x0C, 0x00, 0x30, 0x31, 0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, ++0x1E, 0x14, 0x00, 0x00, 0x30, 0x04, 0x04, 0x04, 0x05, 0x04, 0x04, 0x05, 0x07, 0x07, 0x07, 0x08, ++0x0A, 0x04, 0x07, 0x0A, 0x0E, 0x11, 0x13, 0x14, 0x15, 0x03, 0x04, 0x07, 0x07, 0x08, 0x0B, 0x0D, ++0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, ++0x0F, 0x07, 0x08, 0x08, 0x0A, 0x0A, 0x0C, 0x0E, 0x10, 0x11, 0x11, 0x07, 0x09, 0x09, 0x0B, 0x0B, ++0x0D, 0x0F, 0x11, 0x11, 0x12, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x05, ++0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, 0x07, 0x09, ++0x09, 0x0C, 0x0E, 0x10, 0x12, 0x05, 0x06, 0x07, 0x0D, 0x10, 0x11, 0x12, 0x12, 0x07, 0x08, 0x09, ++0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, ++0x09, 0x0C, 0x0E, 0x11, 0x13, 0x05, 0x06, 0x08, 0x09, 0x0C, 0x0E, 0x12, 0x12, 0x13, 0x14, 0x07, ++0x08, 0x0A, 0x0B, 0x0D, 0x10, 0x11, 0x11, 0x14, 0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, ++0x13, 0x13, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, 0x25, 0x27, ++0x28, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, ++0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, ++0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, ++0x00, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, 0x2A, 0x2A, ++0x2A, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, ++0x10, 0x00, 0x00, 0x00, 0x18, 0x00, 0x00, 0x00, 0x24, 0x00, 0x00, 0x00, 0x30, 0x00, 0x00, 0x00, ++0x48, 0x00, 0x00, 0x00, 0x60, 0x00, 0x00, 0x00, 0x90, 0x00, 0x00, 0x00, 0xC0, 0x00, 0x00, 0x00, ++0xD8, 0x00, 0x00, 0x00, 0x3C, 0x00, 0x00, 0x00, 0x64, 0x00, 0x00, 0x00, 0x78, 0x00, 0x00, 0x00, ++0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, 0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x01, ++0xE0, 0x00, 0x00, 0x00, 0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, 0x00, 0x01, 0x40, 0x00, 0x00, 0x01, ++0x90, 0x00, 0x00, 0x02, 0x58, 0x00, 0x00, 0x03, 0x20, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, ++0x40, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, ++0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, ++0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, ++0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, ++0xD0, 0x00, 0x00, 0x00, 0x3C, 0x00, 0x00, 0x00, 0x64, 0x00, 0x00, 0x00, 0x78, 0x00, 0x00, 0x00, ++0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, 0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x01, ++0xE0, 0x00, 0x00, 0x02, 0x58, 0x00, 0x00, 0x03, 0x20, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, ++0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x07, ++0xD0, 0x00, 0x00, 0x0B, 0xB8, 0x00, 0x00, 0x13, 0x88, 0x00, 0x00, 0x17, 0x70, 0x00, 0x00, 0x1F, ++0x40, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, ++0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, ++0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, ++0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, ++0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, ++0xD0, 0x00, 0x02, 0x00, 0x02, 0x00, 0x04, 0x00, 0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, ++0x24, 0x00, 0x30, 0x00, 0x48, 0x00, 0x60, 0x00, 0x6C, 0x00, 0x14, 0x00, 0x32, 0x00, 0x3C, 0x00, ++0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x00, 0xF0, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, ++0xC8, 0x01, 0x2C, 0x01, 0x90, 0x02, 0x58, 0x03, 0x20, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, ++0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, ++0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x00, 0x1E, 0x00, 0x32, 0x00, 0x3C, 0x00, ++0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x00, 0xF0, 0x01, 0x2C, 0x01, 0x90, 0x00, 0x64, 0x00, ++0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x03, 0xE8, 0x05, 0xDC, 0x09, 0xC4, 0x0B, 0xB8, 0x0F, ++0xA0, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, ++0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, ++0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x02, 0x04, 0x06, 0x08, 0x0A, 0x0C, 0x10, ++0x18, 0x20, 0x30, 0x40, 0x50, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, ++0x05, 0x02, 0x06, 0x06, 0x07, 0x07, 0x08, 0x08, 0x08, 0x02, 0x02, 0x03, 0x03, 0x05, 0x05, 0x06, ++0x06, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, ++0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x07, 0x08, 0x08, 0x0A, 0x0A, 0x06, 0x06, 0x06, 0x07, 0x07, ++0x07, 0x08, 0x08, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, ++0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, ++0x04, 0x05, 0x06, 0x07, 0x08, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x05, 0x06, 0x06, ++0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, ++0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, ++0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, ++0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x19, 0x06, 0x04, ++0x02, 0x00, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x46, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, ++0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, ++0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, ++0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, ++0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, ++0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, ++0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, ++0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, ++0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, ++0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, ++0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, ++0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, ++0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, ++0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, ++0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, ++0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4A, 0x01, 0x74, 0x01, 0x93, ++0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, ++0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, ++0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, ++0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, ++0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, ++0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, ++0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, ++0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, ++0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, ++0x04, 0x90, 0x4A, 0x01, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, ++0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, ++0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, ++0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x46, 0x4D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, ++0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, ++0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, ++0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, ++0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, ++0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, ++0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, ++0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, ++0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x46, 0x4C, 0x8F, 0xF0, ++0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, ++0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, ++0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, ++0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, ++0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x46, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, ++0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xEF, 0x2B, 0xFF, ++0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, ++0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, ++0xEC, 0x48, 0xFC, 0x22, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, ++0xE8, 0x9C, 0x45, 0xF0, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0x22, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x93, 0xFD, 0x74, 0x02, 0x93, 0xFE, 0x74, 0x03, 0x93, 0xFF, ++0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE4, 0x93, 0xF8, ++0x74, 0x01, 0x93, 0xF9, 0x74, 0x02, 0x93, 0xFA, 0x74, 0x03, 0x93, 0xFB, 0x22, 0xA4, 0x25, 0x82, ++0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, ++0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, ++0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, ++0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, ++0xDF, 0x02, 0x49, 0x9F, 0x02, 0x46, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, ++0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, ++0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, ++0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, ++0x49, 0xE4, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, ++0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, ++0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, ++0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, ++0xDE, 0xE7, 0x80, 0xBE, 0x00, 0x41, 0xA3, 0x51, 0x00, 0x41, 0xA3, 0x52, 0x00, 0x41, 0xA3, 0x37, ++0x00, 0x41, 0xA3, 0x38, 0x00, 0x41, 0xA3, 0x39, 0x00, 0x41, 0xA3, 0x3A, 0x00, 0x41, 0xA3, 0x65, ++0x00, 0x4B, 0x86, 0x52, 0xFC, 0x59, 0x1A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, ++0x75, 0x83, 0x00, 0xED, 0xF0, 0x7F, 0x10, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x62, 0xED, 0xF0, 0x90, 0xA3, 0x61, ++0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x6D, 0x7F, 0x47, 0x71, 0x24, 0x90, 0xA3, 0x61, 0xE0, 0xFE, ++0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, ++0x51, 0x07, 0x7F, 0x46, 0x71, 0x24, 0x90, 0xA3, 0x61, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, ++0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x46, 0x51, 0x07, 0x90, 0xA3, 0x62, 0xE0, ++0x60, 0x17, 0x7F, 0x45, 0x71, 0x24, 0x90, 0xA3, 0x61, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, ++0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x80, 0x16, 0x7F, 0x45, 0x71, 0x24, 0x90, 0xA3, 0x61, ++0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, ++0x7F, 0x45, 0x80, 0x75, 0x90, 0xA3, 0x61, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0x71, 0x24, 0x90, ++0xA3, 0x61, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, ++0x5F, 0xFD, 0x7F, 0x63, 0x51, 0x07, 0x7F, 0x62, 0x71, 0x24, 0x90, 0xA3, 0x61, 0xE0, 0xFE, 0x74, ++0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0x51, 0x07, ++0x90, 0xA3, 0x62, 0xE0, 0x60, 0x1A, 0x7F, 0x61, 0x71, 0x24, 0x90, 0xA3, 0x61, 0xE0, 0xFE, 0x74, ++0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x19, ++0x7F, 0x61, 0x71, 0x24, 0x90, 0xA3, 0x61, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, ++0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x51, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0xEF, 0xF0, 0x7F, 0x8F, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, 0x75, 0x83, 0x00, ++0xE0, 0x90, 0xA3, 0x63, 0xF0, 0x7F, 0x10, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0xA3, 0x63, 0xE0, ++0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x54, 0x71, 0x24, 0xE5, 0x0D, 0x5F, 0xF5, 0x11, 0x7F, ++0x55, 0x71, 0x24, 0xE5, 0x0E, 0x5F, 0xF5, 0x12, 0x7F, 0x56, 0x71, 0x24, 0xE5, 0x0F, 0x5F, 0xF5, ++0x13, 0x7F, 0x57, 0x71, 0x24, 0xE5, 0x10, 0x5F, 0xF5, 0x14, 0xAD, 0x11, 0x7F, 0x54, 0x51, 0x07, ++0xAD, 0x12, 0x7F, 0x55, 0x51, 0x07, 0xAD, 0x13, 0x7F, 0x56, 0x51, 0x07, 0xAD, 0x14, 0x7F, 0x57, ++0x51, 0x07, 0x53, 0x91, 0xEF, 0x22, 0x7F, 0x81, 0x71, 0x24, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, 0x81, ++0x51, 0x07, 0x7F, 0x80, 0x71, 0x24, 0xEF, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x51, 0x07, 0x12, 0x99, ++0x6B, 0x12, 0x3D, 0x3B, 0x12, 0x99, 0x78, 0x12, 0x9A, 0x3A, 0x7F, 0x01, 0x12, 0x47, 0x15, 0x90, ++0xA1, 0x6E, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x47, 0x15, 0x90, 0xA1, 0x6E, 0xE0, 0x04, 0xF0, 0x12, ++0x58, 0x2B, 0x12, 0x92, 0xA5, 0x7F, 0x80, 0x71, 0x24, 0xEF, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x51, ++0x07, 0x75, 0x28, 0xFF, 0x12, 0x59, 0x13, 0x12, 0x99, 0xB9, 0x7F, 0x81, 0x71, 0x24, 0xEF, 0x44, ++0x04, 0xFD, 0x7F, 0x81, 0x51, 0x07, 0x12, 0x9A, 0x44, 0xE4, 0xFF, 0x02, 0x47, 0x9E, 0x7F, 0x8F, ++0x71, 0x24, 0xEF, 0x30, 0xE6, 0x64, 0x7F, 0x8D, 0x71, 0x24, 0xEF, 0x64, 0x03, 0x70, 0x5B, 0x7F, ++0x8F, 0x71, 0x24, 0xEF, 0x7F, 0x00, 0xFE, 0xC0, 0x07, 0xC0, 0x06, 0x7F, 0x8E, 0x71, 0x24, 0xEF, ++0xFD, 0xD0, 0xE0, 0xFF, 0xD0, 0xE0, 0x4D, 0x90, 0xA2, 0x3F, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, ++0x90, 0xA2, 0x3E, 0xF0, 0x90, 0xA2, 0x3E, 0xE0, 0xFD, 0xFF, 0x90, 0xA2, 0x40, 0xE0, 0x2F, 0xFF, ++0x90, 0xA2, 0x3F, 0xE0, 0x34, 0x00, 0x8F, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x91, 0x60, ++0x90, 0xA2, 0x3E, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD8, 0x7F, 0x8F, 0x71, 0x24, ++0xEF, 0x30, 0xE0, 0x06, 0xE4, 0xFD, 0x7F, 0x8D, 0x51, 0x07, 0x22, 0x31, 0x1D, 0xE0, 0xFB, 0x0D, ++0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, ++0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, ++0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, ++0x8F, 0x71, 0x24, 0xEF, 0x20, 0xE6, 0x03, 0x02, 0x52, 0xB5, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0xA3, ++0x47, 0xF0, 0x7F, 0x8D, 0x71, 0x24, 0x90, 0xA3, 0x48, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, ++0xA3, 0x49, 0xF0, 0x90, 0xA3, 0x48, 0xE0, 0x31, 0x3B, 0x4C, 0xE1, 0x01, 0x4C, 0xEC, 0x02, 0x4C, ++0xF7, 0x03, 0x4D, 0x02, 0x04, 0x4E, 0x16, 0x05, 0x4F, 0x0B, 0x06, 0x4F, 0x91, 0x08, 0x50, 0x53, ++0x09, 0x50, 0xEA, 0x0A, 0x51, 0x81, 0x0B, 0x51, 0xF8, 0x0C, 0x52, 0x91, 0x20, 0x00, 0x00, 0x52, ++0xA5, 0x90, 0xA3, 0x47, 0xE0, 0xFF, 0x12, 0xB6, 0xCD, 0x02, 0x52, 0xA5, 0x90, 0xA3, 0x47, 0xE0, ++0xFF, 0x12, 0xB7, 0x30, 0x02, 0x52, 0xA5, 0x90, 0xA3, 0x47, 0xE0, 0xFF, 0x12, 0xB7, 0xA4, 0x02, ++0x52, 0xA5, 0x90, 0xA3, 0x47, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, ++0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, ++0x31, 0x1D, 0xE0, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x91, 0x60, 0x90, 0xA3, 0x47, ++0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, 0x31, 0x1D, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, ++0xFB, 0x0D, 0xE4, 0xFF, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, ++0x31, 0x1D, 0xE0, 0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, ++0x75, 0xF0, 0x04, 0x90, 0x95, 0x92, 0x31, 0x1D, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, ++0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x93, 0x91, 0x5B, 0x90, 0xA3, 0x47, 0xE0, 0x75, ++0xF0, 0x04, 0x90, 0x95, 0x94, 0x31, 0x1D, 0xE0, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, ++0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x94, 0x31, 0x1D, 0xE0, 0x54, ++0x1F, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x31, ++0x1D, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x08, 0x90, ++0x89, 0x01, 0x91, 0x5B, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x91, 0x5B, ++0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x91, 0x5B, 0x90, 0xA3, 0x47, 0xE0, ++0x75, 0xF0, 0x08, 0x90, 0x89, 0x04, 0x31, 0x1D, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, ++0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x05, 0x91, 0x5B, 0x90, 0xA3, 0x47, 0xE0, 0x75, ++0xF0, 0x08, 0x90, 0x89, 0x06, 0x91, 0x5B, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, ++0x07, 0x31, 0x1D, 0x02, 0x50, 0xE5, 0x90, 0xA3, 0x47, 0xE0, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, ++0xE4, 0x34, 0x92, 0xF5, 0x83, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x60, 0x90, 0xA3, 0x47, ++0xE0, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x91, ++0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x31, 0x1D, 0xA3, 0xE0, 0xFB, ++0x0D, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x91, 0x5B, 0x90, ++0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x03, 0x31, 0x1D, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, ++0x0F, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x05, 0x31, 0x1D, 0xA3, ++0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x07, 0x31, ++0x1D, 0xA3, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, ++0x09, 0x31, 0x1D, 0xA3, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x24, 0x12, 0xF5, ++0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0xE4, 0xFB, 0x91, ++0x60, 0x90, 0xA3, 0x47, 0xE0, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, ++0xA3, 0xE0, 0xFB, 0x7D, 0x02, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x25, 0xE0, 0x24, 0x11, 0xF5, ++0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x78, 0xE0, 0xFB, ++0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0xA1, 0x79, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x7A, ++0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x7B, 0x02, 0x50, 0xE5, 0x90, 0xA1, 0x80, 0xE0, 0xFB, ++0xE4, 0xFD, 0xFF, 0x91, 0x60, 0x90, 0xA1, 0x81, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x82, ++0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x83, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x84, ++0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0xA1, 0x85, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, ++0xA1, 0x86, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x87, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, ++0xA1, 0x88, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0xA1, 0x89, 0xE0, 0xFB, 0x0D, 0x91, ++0x60, 0x90, 0xA1, 0x8A, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x8B, 0xE0, 0xFB, 0x0D, 0x91, ++0x60, 0x90, 0xA1, 0x8C, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0xA1, 0x8D, 0xE0, 0xFB, ++0x0D, 0x91, 0x60, 0x90, 0xA1, 0x8E, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x8F, 0x02, 0x50, ++0xE5, 0x90, 0xA1, 0x10, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x60, 0x90, 0xA1, 0x0F, 0xE0, 0x54, ++0x0F, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x12, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x13, ++0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x24, 0x87, 0xF5, 0x82, 0xE4, 0x34, 0xA0, ++0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0x01, 0xFB, ++0x0D, 0x91, 0x60, 0x90, 0xA1, 0x0D, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, ++0x91, 0x60, 0x90, 0xA1, 0x0D, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, ++0x91, 0x60, 0x90, 0x9F, 0x93, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0x9F, 0x94, 0xE0, ++0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x17, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, ++0x16, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x0F, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, 0xE4, ++0xFD, 0x7F, 0x03, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x0E, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, ++0x7F, 0x03, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x0E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, ++0x7F, 0x03, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x0D, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, ++0x03, 0x41, 0xA2, 0x90, 0xA1, 0x98, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x12, 0x4C, 0x60, 0x90, 0xA1, ++0x99, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x9A, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, ++0x90, 0xA1, 0x9B, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x9C, 0xE0, 0xFB, 0xE4, 0xFD, ++0x0F, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x9D, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x9E, ++0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x9F, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, ++0xA1, 0xA0, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xA1, 0xE0, 0xFB, 0x0D, ++0x12, 0x4C, 0x60, 0x90, 0xA1, 0xA2, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xA3, 0xE0, ++0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xA4, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, 0x60, ++0x90, 0xA1, 0xA5, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xA6, 0xE0, 0xFB, 0x0D, 0x12, ++0x4C, 0x60, 0x90, 0xA1, 0xA7, 0xE0, 0xFB, 0x0D, 0x41, 0xA2, 0x90, 0xA1, 0xA8, 0xE0, 0xFB, 0xE4, ++0xFD, 0xFF, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xA9, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, ++0xAA, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xAB, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, ++0x90, 0xA1, 0xAC, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xAD, 0xE0, 0xFB, ++0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xAE, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xAF, ++0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xB0, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, ++0x60, 0x90, 0xA1, 0xB1, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xB2, 0xE0, 0xFB, 0x0D, ++0x12, 0x4C, 0x60, 0x90, 0xA1, 0xB3, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xB4, 0xE0, ++0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xB5, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, ++0x90, 0xA1, 0xB6, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xB7, 0xE0, 0xFB, 0x0D, 0x41, ++0xA2, 0x90, 0xA1, 0x56, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFB, 0xE4, 0xFD, 0xFF, 0x12, 0x4C, 0x60, ++0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0xA3, 0x4A, 0xEF, ++0xF0, 0xE0, 0xC3, 0x13, 0xF0, 0x54, 0x1F, 0xF0, 0xFB, 0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x4C, 0x60, ++0x90, 0xA1, 0x5D, 0x12, 0x48, 0xE5, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0xA3, 0x4A, 0xEF, 0xF0, ++0xE0, 0xC3, 0x13, 0xF0, 0x54, 0x1F, 0xF0, 0xFB, 0x7D, 0x02, 0xE4, 0xFF, 0x12, 0x4C, 0x60, 0x90, ++0xA1, 0x59, 0x12, 0x48, 0xE5, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0xA3, 0x4A, 0xEF, 0xF0, 0xE0, ++0xC3, 0x13, 0xF0, 0x54, 0x1F, 0xF0, 0xFB, 0x7D, 0x03, 0xE4, 0xFF, 0x12, 0x4C, 0x60, 0x90, 0xA1, ++0x65, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x41, 0xA2, 0x90, 0xA1, 0x2E, 0xE0, 0xC4, 0x13, 0x54, 0x01, ++0xFB, 0xE4, 0xFD, 0xFF, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x39, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, ++0x90, 0xA1, 0x3A, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x30, 0xE0, 0xFB, 0x0D, 0x12, ++0x4C, 0x60, 0x90, 0xA1, 0x3D, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, 0x60, 0x90, 0x07, 0x78, ++0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0x05, 0x22, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x7F, ++0xB4, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0xA3, 0x4A, 0xEF, 0xF0, ++0xFB, 0x7D, 0x03, 0x7F, 0x01, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x31, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, ++0x12, 0x4C, 0x60, 0x90, 0xA1, 0x32, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x33, 0xE0, ++0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x34, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, ++0x35, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x12, 0xE0, 0xFB, 0x0D, 0x80, ++0x11, 0x90, 0xA0, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x12, 0x4C, 0x60, 0x90, 0xA0, 0x84, 0xE0, ++0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x7F, 0x8F, 0x12, 0x4B, 0x24, 0xEF, 0x30, 0xE0, 0x07, 0xE4, 0xFD, ++0x7F, 0x8D, 0x12, 0x4A, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x51, 0xC2, 0x12, 0x4B, 0xEE, 0x02, ++0x4C, 0x88, 0x7F, 0x8F, 0x12, 0x4B, 0x24, 0xEF, 0x30, 0xE5, 0x30, 0x7F, 0x8E, 0x12, 0x4B, 0x24, ++0xEF, 0x64, 0x05, 0x70, 0x26, 0x7F, 0x8F, 0x12, 0x4B, 0x24, 0x90, 0x00, 0x8E, 0xE0, 0xFE, 0x74, ++0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xEE, 0xF0, 0x7F, 0x8F, 0x12, 0x4B, 0x24, ++0xEF, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8E, 0x12, 0x4A, 0x07, 0x22, 0xE4, 0x90, 0xA2, 0x3D, ++0xF0, 0x90, 0xA2, 0x3D, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0xFC, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x52, ++0xA3, 0xF0, 0x12, 0x3D, 0x6E, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x38, 0x90, 0xA1, 0x10, 0xE0, 0x60, ++0x0E, 0x90, 0xA1, 0x13, 0xE0, 0xFF, 0x90, 0xA1, 0x12, 0xE0, 0x6F, 0x60, 0x02, 0x71, 0x43, 0xC2, ++0xAF, 0x12, 0x9A, 0x13, 0xBF, 0x01, 0x03, 0x12, 0x9F, 0x13, 0xD2, 0xAF, 0x51, 0xBA, 0x12, 0x46, ++0x4D, 0x80, 0xBE, 0x90, 0xA1, 0x08, 0xE0, 0x90, 0xA1, 0x12, 0x30, 0xE0, 0x04, 0xE0, 0xFF, 0xA1, ++0xCF, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x07, 0x90, 0xA1, 0x12, 0xE0, 0xFF, 0xE4, 0xFD, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x68, 0xED, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0xFE, 0xC4, ++0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x81, 0xAB, 0xEE, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, ++0x30, 0xE0, 0x02, 0x81, 0xAB, 0x90, 0xA1, 0x13, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x81, 0xAB, 0xEF, ++0x70, 0x02, 0x81, 0x20, 0x24, 0xFE, 0x70, 0x02, 0x81, 0x5A, 0x24, 0xFE, 0x60, 0x4A, 0x24, 0xFC, ++0x70, 0x02, 0x81, 0x95, 0x24, 0xFC, 0x60, 0x02, 0x81, 0xAB, 0xEE, 0xB4, 0x0E, 0x02, 0xB1, 0x42, ++0x90, 0xA1, 0x13, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xB1, 0x77, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x06, ++0x02, 0xB1, 0x0F, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x04, 0x0F, 0x90, 0xA3, 0x68, 0xE0, 0xFF, 0x60, ++0x05, 0x12, 0xBA, 0x90, 0x80, 0x03, 0x12, 0x8D, 0x75, 0x90, 0xA1, 0x13, 0xE0, 0x64, 0x08, 0x60, ++0x02, 0x81, 0xAB, 0x12, 0xBC, 0x23, 0x81, 0xAB, 0x90, 0xA1, 0x13, 0xE0, 0x70, 0x04, 0x7F, 0x01, ++0xB1, 0x77, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x06, 0x02, 0xB1, 0x0F, 0x90, 0xA1, 0x13, 0xE0, 0xB4, ++0x0E, 0x07, 0x91, 0xB0, 0xBF, 0x01, 0x02, 0xB1, 0x42, 0x90, 0xA1, 0x13, 0xE0, 0x64, 0x0C, 0x60, ++0x02, 0x81, 0xAB, 0x91, 0xB0, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x81, 0xAB, 0xB1, 0x95, 0x81, 0xAB, ++0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x0E, 0x07, 0x91, 0xB0, 0xBF, 0x01, 0x02, 0xB1, 0x42, 0x90, 0xA1, ++0x13, 0xE0, 0xB4, 0x06, 0x02, 0xB1, 0x0F, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x0C, 0x07, 0x91, 0xB0, ++0xBF, 0x01, 0x02, 0xB1, 0x95, 0x90, 0xA1, 0x13, 0xE0, 0x64, 0x04, 0x70, 0x5E, 0x12, 0xB9, 0xC1, ++0xEF, 0x64, 0x01, 0x70, 0x56, 0x12, 0x8B, 0xA6, 0x80, 0x51, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x0E, ++0x07, 0x91, 0xB0, 0xBF, 0x01, 0x02, 0xB1, 0x42, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x06, 0x02, 0xB1, ++0x0F, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x0C, 0x07, 0x91, 0xB0, 0xBF, 0x01, 0x02, 0xB1, 0x95, 0x90, ++0xA1, 0x13, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xB1, 0x77, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x04, 0x1B, ++0x12, 0xBA, 0xD6, 0x80, 0x16, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x0C, 0x0F, 0x90, 0xA1, 0x0E, 0xE0, ++0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x8B, 0x8A, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x90, 0xA1, 0x28, 0xE0, 0x30, 0xE0, 0x13, 0x90, 0xA1, 0x2E, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, ++0xE0, 0x17, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x3C, 0xF1, 0xF8, 0xEF, 0x64, 0x01, 0x60, ++0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2D, 0x90, 0xA1, 0x0D, 0xE0, 0x13, 0x13, 0x13, ++0x54, 0x1F, 0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x19, 0x90, 0xA1, 0x12, ++0xE0, 0xD3, 0x94, 0x04, 0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, 0x90, 0x01, ++0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, 0x22, 0x90, ++0xA1, 0x0E, 0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA1, 0x13, ++0x74, 0x04, 0xF0, 0x80, 0x17, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA1, 0x13, 0x74, 0x0C, 0xF0, 0x90, ++0x05, 0x27, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA1, 0x0C, 0x74, 0x0C, 0xF0, 0x90, 0x05, 0x22, 0xE4, ++0xF0, 0x22, 0x90, 0xA1, 0x0E, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0x90, 0xA1, 0x13, 0x74, 0x0C, ++0xF0, 0x80, 0x1E, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA1, ++0x13, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA1, 0x0C, 0x74, 0x04, ++0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0xA3, 0x67, 0xEF, 0xF0, 0x12, 0x86, 0xBC, 0x90, ++0xA3, 0x67, 0xE0, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x13, 0x74, 0x04, 0xF0, ++0x90, 0xA1, 0x0C, 0xF0, 0x22, 0x90, 0xA0, 0x87, 0xE0, 0x64, 0x01, 0x70, 0x31, 0x90, 0xA1, 0x0E, ++0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x7F, 0x01, 0xD1, 0x26, 0xBF, 0x01, ++0x12, 0x90, 0xA1, 0x0D, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA1, 0x13, 0x74, 0x0E, 0xF0, 0x90, 0xA1, ++0x0C, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x22, 0xAE, ++0x07, 0xF1, 0xEC, 0xBF, 0x01, 0x15, 0x90, 0xA1, 0x08, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, ++0xE0, 0x09, 0xAF, 0x06, 0x7D, 0x01, 0x71, 0x5E, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0xA1, ++0x28, 0xE0, 0x20, 0xE0, 0x27, 0x90, 0xA1, 0x10, 0xE0, 0x64, 0x01, 0x70, 0x1F, 0x12, 0x82, 0x1C, ++0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0x60, 0x08, 0xE4, 0xFD, 0x7F, 0x0C, 0x71, 0x5E, 0xE1, 0x9A, ++0x90, 0xA1, 0x13, 0xE0, 0x70, 0x06, 0x7D, 0x01, 0x7F, 0x04, 0x71, 0x5E, 0x22, 0x90, 0xA1, 0x2F, ++0xE0, 0x44, 0x02, 0xF0, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x63, 0x90, ++0x04, 0x1D, 0xE0, 0x60, 0x1F, 0x90, 0x05, 0x22, 0xE0, 0xF5, 0x66, 0x74, 0xFF, 0xF0, 0x12, 0x77, ++0x9E, 0xBF, 0x01, 0x08, 0xAF, 0x63, 0x12, 0xBC, 0x36, 0x12, 0x7E, 0xE5, 0x90, 0x05, 0x22, 0xE5, ++0x66, 0xF0, 0x80, 0x03, 0x12, 0x7E, 0xE5, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0xF1, 0x9A, 0x90, 0xA1, 0x13, 0xE0, 0x64, 0x0C, 0x60, 0x0A, 0xE4, 0xFD, ++0x7F, 0x0C, 0x71, 0x5E, 0xE4, 0xFF, 0xD1, 0x26, 0x22, 0x90, 0xA1, 0x0D, 0xE0, 0xFF, 0xC4, 0x13, ++0x13, 0x54, 0x03, 0x30, 0xE0, 0x3A, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA1, ++0x0E, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, ++0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x90, 0xA1, 0x2E, 0xE0, 0xFF, 0xC4, ++0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x7D, 0x01, 0x7F, 0x0C, 0x71, 0x5E, 0x80, 0x02, 0x71, 0x43, ++0xE4, 0xFF, 0x90, 0xA1, 0x72, 0xE0, 0x30, 0xE0, 0x48, 0x90, 0xA1, 0x76, 0xE0, 0xFD, 0x60, 0x41, ++0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, ++0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x06, 0xE4, 0x90, 0xA1, 0x76, 0xF0, 0x22, ++0x90, 0xA1, 0x74, 0xE0, 0xD3, 0x9D, 0x50, 0x11, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0x12, 0xB8, ++0xB9, 0x90, 0xA1, 0x72, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xF1, 0x7D, 0x90, 0xA1, 0x76, 0xE0, 0x04, ++0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x58, 0xED, 0xF0, 0x90, 0xA3, ++0x57, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0xF1, 0xDC, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0xA3, 0x57, 0xE0, ++0x90, 0x04, 0x25, 0xF0, 0x90, 0xA3, 0x58, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFF, 0xC1, ++0x26, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x12, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x02, 0x80, 0x0A, ++0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xF7, 0xF0, 0x71, 0x43, 0x22, 0x90, 0xA1, 0x0D, 0xE0, 0x13, 0x13, ++0x13, 0x54, 0x1F, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, ++0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x23, 0xE0, 0xC3, 0x13, ++0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, ++0x5B, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0xFD, 0x10, 0xEF, ++0xF0, 0x7F, 0x00, 0x22, 0xF1, 0xF8, 0xEF, 0x70, 0x02, 0xB1, 0xEE, 0x22, 0x90, 0x05, 0x43, 0xE0, ++0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, ++0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, ++0x22, 0x7F, 0xF4, 0x12, 0x4B, 0x24, 0xEF, 0x20, 0xE5, 0x0E, 0x7F, 0xF4, 0x12, 0x4B, 0x24, 0xEF, ++0x7F, 0x01, 0x20, 0xE4, 0x05, 0x7F, 0x02, 0x22, 0x7F, 0x03, 0x22, 0x11, 0x11, 0x90, 0x9F, 0x95, ++0xEF, 0xF0, 0x11, 0x44, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, ++0xF0, 0x02, 0x36, 0x83, 0x11, 0xB2, 0x11, 0xE2, 0x11, 0x71, 0x11, 0x90, 0xE4, 0xF5, 0x0D, 0xF5, ++0x0E, 0xF5, 0x0F, 0xF5, 0x10, 0xAD, 0x0D, 0x7F, 0x50, 0x12, 0x4A, 0x07, 0xAD, 0x0E, 0x7F, 0x51, ++0x12, 0x4A, 0x07, 0xAD, 0x0F, 0x7F, 0x52, 0x12, 0x4A, 0x07, 0xAD, 0x10, 0x7F, 0x53, 0x02, 0x4A, ++0x07, 0x75, 0x15, 0x12, 0xE4, 0xF5, 0x16, 0x75, 0x17, 0x07, 0x75, 0x18, 0x72, 0x90, 0x01, 0x30, ++0xE5, 0x15, 0xF0, 0xA3, 0xE5, 0x16, 0xF0, 0xA3, 0xE5, 0x17, 0xF0, 0xA3, 0xE5, 0x18, 0xF0, 0x22, ++0x75, 0x1D, 0x06, 0x75, 0x1E, 0x01, 0x75, 0x1F, 0x03, 0x75, 0x20, 0x62, 0x43, 0x20, 0x80, 0x90, ++0x01, 0x38, 0xE5, 0x1D, 0xF0, 0xA3, 0xE5, 0x1E, 0xF0, 0xA3, 0xE5, 0x1F, 0xF0, 0xA3, 0xE5, 0x20, ++0xF0, 0x22, 0x90, 0x01, 0x30, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x38, ++0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x4A, 0x07, 0xE4, 0xFD, 0x7F, ++0x51, 0x12, 0x4A, 0x07, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x4A, 0x07, 0xE4, 0xFD, 0x7F, 0x53, 0x02, ++0x4A, 0x07, 0x90, 0x01, 0x34, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, ++0x3C, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, 0x4A, 0x07, 0x7D, 0xFF, ++0x7F, 0x55, 0x12, 0x4A, 0x07, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x4A, 0x07, 0x7D, 0xFF, 0x7F, 0x57, ++0x02, 0x4A, 0x07, 0x75, 0xE8, 0x07, 0x75, 0xA8, 0x85, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, ++0x12, 0x48, 0x4E, 0x90, 0xA2, 0x41, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x9F, 0x92, 0xE0, 0x60, 0xEA, ++0xC2, 0xAF, 0x30, 0xE0, 0x11, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x9B, 0x7B, 0x12, 0xAA, 0x83, ++0x90, 0xA1, 0x8E, 0xE0, 0x04, 0xF0, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x9F, 0x92, 0xE0, 0xFF, 0x30, ++0xE1, 0x0B, 0x54, 0xFD, 0xF0, 0x90, 0xA1, 0x90, 0xE0, 0x04, 0xF0, 0x31, 0xAE, 0xD2, 0xAF, 0xC2, ++0xAF, 0x90, 0x9F, 0x92, 0xE0, 0xFF, 0x30, 0xE2, 0x06, 0x54, 0xFB, 0xF0, 0x12, 0x98, 0xFC, 0xD2, ++0xAF, 0xC2, 0xAF, 0x90, 0x9F, 0x92, 0xE0, 0xFF, 0x30, 0xE6, 0x05, 0x54, 0xBF, 0xF0, 0x31, 0x84, ++0xD2, 0xAF, 0x80, 0xA6, 0xE4, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x6B, 0x51, 0x45, 0xEF, 0xB4, 0x02, ++0x1C, 0x90, 0xA3, 0x51, 0xE0, 0x64, 0x04, 0x60, 0x09, 0x7F, 0x40, 0x51, 0x0F, 0x90, 0xA3, 0x51, ++0x80, 0x08, 0xE4, 0x90, 0xA3, 0x51, 0xF0, 0x90, 0xA1, 0x9B, 0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9F, 0xEC, 0xE0, 0xFF, 0x90, 0x9F, 0xEB, 0xE0, 0xB5, 0x07, ++0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x40, 0x90, 0x9F, 0xEB, 0xE0, 0xFE, 0x75, ++0xF0, 0x08, 0x90, 0x9F, 0x9B, 0x12, 0x49, 0x1D, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, ++0x9C, 0xF9, 0x74, 0x9F, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x71, 0x20, 0x90, 0x9F, 0xEB, ++0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, ++0x9F, 0xEB, 0xF0, 0x12, 0x90, 0xE2, 0x7F, 0x02, 0x51, 0x0F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, ++0xA3, 0x64, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x48, 0x27, 0x90, 0x9F, 0x92, 0xE0, 0xFF, 0x90, 0xA3, ++0x64, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x9F, 0x92, 0xF0, 0x22, 0x90, 0xA1, 0x4C, 0xE0, 0x44, 0x04, ++0xF0, 0x7D, 0x01, 0x7F, 0x23, 0x51, 0x49, 0xEF, 0xB4, 0x03, 0x09, 0xE4, 0xFF, 0x12, 0x63, 0x56, ++0x7F, 0x04, 0x51, 0x0F, 0x22, 0x7D, 0x03, 0x7F, 0x11, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x90, 0xA3, 0x29, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x49, 0x32, 0x7F, 0xA3, 0x12, 0x4B, ++0x24, 0xEF, 0x54, 0xF8, 0x44, 0x05, 0xFD, 0x7F, 0xA3, 0x12, 0x4A, 0x07, 0x7F, 0xA0, 0x12, 0x4B, ++0x24, 0xEF, 0x54, 0x0F, 0x64, 0x04, 0x70, 0x24, 0x90, 0xFD, 0x58, 0xE0, 0x20, 0xE0, 0x13, 0x90, ++0xA3, 0x29, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0x12, 0x49, 0x29, 0x12, 0x8F, 0xAC, 0x7F, 0x01, ++0x80, 0x12, 0x90, 0xA1, 0x99, 0xE0, 0x04, 0xF0, 0x7F, 0x02, 0x80, 0x08, 0x90, 0xA1, 0x98, 0xE0, ++0x04, 0xF0, 0x7F, 0x03, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0x12, 0x06, 0x89, 0x90, 0xA2, 0x45, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x46, ++0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x47, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, ++0xA2, 0x90, 0xA2, 0x48, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x49, 0xF0, 0xE4, ++0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xA1, 0x4C, 0xE0, 0x44, 0x40, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, ++0x45, 0x7D, 0x07, 0x7F, 0x30, 0x51, 0x49, 0xEF, 0xB4, 0x01, 0x08, 0x90, 0xA2, 0x4C, 0x74, 0x01, ++0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x4C, 0xF0, 0x90, 0xA2, 0x4C, 0xE0, 0xFD, 0x90, 0xA2, 0x45, ++0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x81, 0x12, 0x7F, 0x04, 0x51, 0x0F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x90, 0xA2, 0x42, 0x12, 0x49, 0x32, 0xEF, 0x12, 0x49, 0x3B, 0x5B, 0x76, 0x00, 0x5B, 0x7F, 0x01, ++0x5B, 0x88, 0x02, 0x5B, 0x91, 0x03, 0x5B, 0x9A, 0x04, 0x5B, 0xA2, 0x20, 0x5B, 0xAB, 0x21, 0x5B, ++0xB4, 0x23, 0x5B, 0xBD, 0x24, 0x5B, 0xC6, 0x25, 0x5B, 0xCF, 0x40, 0x5B, 0xDE, 0x42, 0x5B, 0xE7, ++0x43, 0x5B, 0xEF, 0x60, 0x5B, 0xF8, 0x61, 0x5C, 0x00, 0x62, 0x5C, 0x08, 0x63, 0x5C, 0x10, 0x64, ++0x5C, 0x19, 0x65, 0x5C, 0x22, 0x66, 0x5C, 0x2A, 0x67, 0x5C, 0x32, 0x68, 0x5C, 0x3A, 0x69, 0x5C, ++0x42, 0x6A, 0x00, 0x00, 0x5C, 0x4A, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x8C, 0x6A, 0x90, ++0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x8C, 0xB2, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x85, ++0x0E, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0xB8, 0xC9, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, ++0xE1, 0x15, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x8D, 0x88, 0x90, 0xA2, 0x42, 0x12, 0x49, ++0x29, 0x02, 0x8F, 0x17, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x8F, 0x5D, 0x90, 0xA2, 0x42, ++0x12, 0x49, 0x29, 0x02, 0x65, 0x6A, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x8F, 0x65, 0x90, ++0xA1, 0x91, 0xE0, 0x04, 0xF0, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0xB4, 0xA2, 0x90, 0xA2, ++0x42, 0x12, 0x49, 0x29, 0x02, 0xB6, 0x2C, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0xA1, 0xBB, 0x90, ++0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x78, 0xEE, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x41, 0x2A, ++0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0xC1, 0xB2, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0xC1, 0xB8, ++0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x90, 0x71, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, ++0x90, 0xD2, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x80, 0x28, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, ++0x41, 0xA9, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0xC1, 0xD0, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, ++0x81, 0xD5, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x80, 0x47, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, ++0xF0, 0x22, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x12, 0x06, ++0x89, 0x90, 0xA1, 0x6B, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0xA1, 0x6C, 0xF0, 0x90, ++0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0xA1, 0x6D, 0xF0, 0x90, 0xA1, 0x4C, 0xE0, 0x44, 0x01, 0xF0, ++0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x51, 0x45, 0xEF, 0xB4, 0x02, 0x04, 0x7F, 0x40, 0x51, 0x0F, ++0x22, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x7D, 0x06, 0x7F, 0x0A, 0x51, 0x49, 0xEF, 0x64, 0x01, ++0x60, 0x0A, 0x7F, 0x88, 0x12, 0x4B, 0x24, 0xEF, 0x44, 0x40, 0x80, 0x23, 0x90, 0xA2, 0x45, 0x12, ++0x49, 0x29, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFE, 0x12, 0x06, 0x89, 0x7C, 0x00, 0x24, 0x00, ++0xFF, 0xEC, 0x3E, 0xFE, 0x12, 0x80, 0x7A, 0x7F, 0x88, 0x12, 0x4B, 0x24, 0xEF, 0x44, 0x80, 0xFD, ++0x7F, 0x88, 0x02, 0x4A, 0x07, 0x12, 0x06, 0x89, 0xFF, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, ++0xA2, 0x47, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x48, 0xF0, 0x90, 0x00, 0x03, ++0x12, 0x06, 0xA2, 0x90, 0xA2, 0x49, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x4A, ++0xF0, 0x90, 0x00, 0x05, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x4B, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x06, ++0xA2, 0x90, 0xA2, 0x4C, 0xF0, 0xEF, 0x12, 0x49, 0x3B, 0x5D, 0x32, 0x00, 0x5D, 0x3E, 0x01, 0x5D, ++0x4A, 0x02, 0x5D, 0x56, 0x03, 0x5D, 0x62, 0x04, 0x5D, 0x6E, 0x05, 0x5D, 0x76, 0x06, 0x00, 0x00, ++0x5D, 0x9F, 0x90, 0xA2, 0x45, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x29, 0xF0, 0x80, 0x6B, 0x90, 0xA2, ++0x45, 0x74, 0x06, 0xF0, 0xA3, 0x74, 0x2A, 0xF0, 0x80, 0x5F, 0x90, 0xA2, 0x45, 0x74, 0x01, 0xF0, ++0xA3, 0x74, 0x31, 0xF0, 0x80, 0x53, 0x90, 0xA2, 0x45, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x32, 0xF0, ++0x80, 0x47, 0x90, 0xA2, 0x45, 0x74, 0x06, 0xF0, 0xA3, 0x74, 0x33, 0xF0, 0x80, 0x3B, 0x7B, 0x01, ++0x7A, 0xA2, 0x79, 0x47, 0xE1, 0xAC, 0x90, 0xA2, 0x47, 0xE0, 0x90, 0xA1, 0x66, 0xF0, 0x90, 0xA2, ++0x48, 0xE0, 0x90, 0xA1, 0x67, 0xF0, 0x90, 0xA2, 0x49, 0xE0, 0x90, 0xA1, 0x68, 0xF0, 0x90, 0xA2, ++0x4A, 0xE0, 0x90, 0xA1, 0x69, 0xF0, 0x90, 0xA2, 0x4B, 0xE0, 0x90, 0xA1, 0x6A, 0xF0, 0x22, 0x90, ++0xA2, 0x45, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0xA2, 0x46, 0xE0, 0xFF, 0x90, 0xA2, ++0x45, 0xE0, 0xFD, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x47, 0x41, 0x49, 0x12, 0x06, 0x89, 0xFD, 0x90, ++0x00, 0x01, 0x12, 0x06, 0xA2, 0xFC, 0xED, 0xC3, 0x94, 0x80, 0x90, 0xA2, 0x47, 0xED, 0x50, 0x3F, ++0xF0, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, ++0x90, 0xA2, 0x48, 0xF0, 0xEE, 0xA3, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, ++0x9B, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA2, 0x4A, 0xF0, 0xEE, 0xA3, 0xF0, 0x75, 0xF0, ++0x10, 0xED, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0x4C, 0xF0, 0x80, 0x01, 0xF0, ++0xEC, 0xC3, 0x94, 0x80, 0x90, 0xA2, 0x4D, 0xEC, 0x50, 0x3F, 0xF0, 0x25, 0xE0, 0x24, 0x92, 0xF5, ++0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA2, 0x4E, 0xF0, 0xEE, 0xA3, ++0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, ++0xE0, 0x90, 0xA2, 0x50, 0xF0, 0xEE, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x00, 0x12, ++0x49, 0x1D, 0xE0, 0x90, 0xA2, 0x52, 0xF0, 0x80, 0x01, 0xF0, 0x90, 0xA2, 0x45, 0x74, 0x04, 0xF0, ++0x90, 0xA2, 0x53, 0x74, 0x0C, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9C, ++0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9C, ++0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, ++0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, ++0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x45, 0xF1, 0x42, 0x7F, 0x04, ++0x41, 0x0F, 0x7D, 0x01, 0x7F, 0x17, 0x41, 0x49, 0xE4, 0x90, 0xA2, 0x45, 0xF0, 0x90, 0xA1, 0x4C, ++0xE0, 0x44, 0x10, 0xF0, 0x7D, 0x01, 0x7F, 0x1B, 0x51, 0x49, 0x90, 0xA2, 0x45, 0xEF, 0xF0, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA1, 0x4D, 0xE0, 0x44, 0x01, 0xF0, 0x7D, 0x01, ++0x7F, 0x28, 0x51, 0x49, 0x90, 0xA2, 0x45, 0xEF, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x07, ++0x1F, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, 0xA2, 0x60, 0xF0, 0x90, ++0xA2, 0x5E, 0x74, 0x02, 0xF0, 0x90, 0xA2, 0x6C, 0x14, 0xF0, 0xFB, 0x7A, 0xA2, 0x79, 0x5E, 0xF1, ++0x42, 0x7F, 0x04, 0x41, 0x0F, 0x12, 0x92, 0xD0, 0x12, 0x06, 0x89, 0xFF, 0x54, 0x01, 0xFE, 0x90, ++0xA1, 0x72, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x14, 0x90, 0x00, 0x01, ++0x12, 0x06, 0xA2, 0x90, 0xA1, 0x73, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0xA1, 0x74, ++0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA0, 0x83, 0xE0, 0xFF, 0x70, 0x06, ++0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA0, 0x84, 0xE0, 0xB5, 0x07, 0x04, ++0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, ++0x80, 0x35, 0xC0, 0x01, 0x90, 0xA0, 0x84, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xED, 0xF9, 0x74, ++0x9F, 0x35, 0xF0, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x06, ++0x63, 0x90, 0xA0, 0x84, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, ++0x60, 0x05, 0xE4, 0x90, 0xA0, 0x84, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0x4D, 0x74, ++0x0A, 0xF0, 0x90, 0xA2, 0x5B, 0x74, 0x06, 0xF0, 0x12, 0x06, 0x89, 0x90, 0xA2, 0x4F, 0xF0, 0x90, ++0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x50, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, ++0xA2, 0x51, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x52, 0xF0, 0x90, 0x00, 0x04, ++0x12, 0x06, 0xA2, 0x90, 0xA2, 0x53, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x54, ++0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x4D, 0xE1, 0x42, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, ++0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0xF9, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, ++0x5F, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, ++0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, ++0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, ++0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x2A, 0xF0, 0x74, 0x60, 0xA3, ++0xF0, 0x12, 0x4B, 0x46, 0x74, 0x2A, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0xD0, ++0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, ++0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, ++0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, ++0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x7A, 0xF0, 0x74, 0x60, 0xA3, ++0xF0, 0x12, 0x9A, 0x4E, 0xE5, 0x19, 0x30, 0xE1, 0x02, 0x31, 0x35, 0xE5, 0x19, 0x30, 0xE4, 0x02, ++0x71, 0xDF, 0xE5, 0x19, 0x30, 0xE6, 0x03, 0x12, 0x9A, 0xAB, 0xE5, 0x1B, 0x30, 0xE0, 0x03, 0x12, ++0x84, 0x17, 0xE5, 0x1B, 0x30, 0xE1, 0x02, 0x71, 0xE6, 0xE5, 0x1B, 0x30, 0xE2, 0x02, 0x91, 0x79, ++0xE5, 0x1B, 0x30, 0xE3, 0x03, 0x12, 0x9A, 0xB8, 0xE5, 0x1B, 0x30, 0xE4, 0x03, 0x12, 0x9A, 0xEB, ++0xE5, 0x1B, 0x30, 0xE5, 0x03, 0x12, 0x7F, 0x83, 0xE5, 0x1B, 0x30, 0xE6, 0x03, 0x12, 0x9B, 0x1A, ++0xE5, 0x1C, 0x30, 0xE1, 0x03, 0x12, 0x9B, 0x36, 0xE5, 0x1C, 0x30, 0xE4, 0x03, 0x12, 0x9B, 0x73, ++0xE5, 0x1C, 0x30, 0xE5, 0x02, 0xF1, 0x78, 0xE5, 0x1C, 0x30, 0xE6, 0x03, 0x12, 0x9D, 0x54, 0x74, ++0x7A, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, ++0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, ++0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, 0xFF, 0x90, 0xA2, 0x5E, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, ++0xF5, 0x60, 0xA3, 0xE0, 0xF5, 0x61, 0x65, 0x60, 0x60, 0x6F, 0x90, 0xA2, 0x5F, 0x74, 0x03, 0xF0, ++0x90, 0xA2, 0x6D, 0x74, 0x08, 0xF0, 0xE5, 0x61, 0x04, 0x54, 0x0F, 0xF5, 0x62, 0xE4, 0xF5, 0x5F, ++0xE5, 0x62, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, ++0x82, 0x25, 0x5F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x61, 0x25, 0x5F, ++0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x5F, 0xE5, 0x5F, 0xB4, 0x08, 0xD0, ++0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x5F, 0x12, 0x5F, 0x42, 0xE5, 0x61, 0x04, 0x54, 0x0F, 0xF5, 0x61, ++0xB4, 0x0F, 0x03, 0xE4, 0xF5, 0x61, 0x90, 0x04, 0x7F, 0xE5, 0x61, 0xF0, 0x90, 0xA2, 0x5E, 0xE0, ++0x7F, 0x04, 0x70, 0x02, 0x80, 0x08, 0x12, 0x5A, 0x0F, 0x22, 0x71, 0x56, 0x7F, 0x04, 0x8F, 0x6C, ++0x7F, 0x02, 0x12, 0x48, 0x27, 0x90, 0x9F, 0x92, 0xE0, 0x45, 0x6C, 0xF0, 0x22, 0x90, 0xFD, 0x68, ++0xE0, 0xFF, 0x90, 0xFD, 0x60, 0xE0, 0x90, 0xA2, 0x7E, 0xF0, 0xEF, 0x20, 0xE0, 0x02, 0x61, 0x55, ++0x90, 0xA3, 0x52, 0xE0, 0x70, 0x1A, 0x7F, 0x2E, 0x12, 0x4B, 0x24, 0x90, 0xA1, 0x61, 0xEF, 0xF0, ++0x7F, 0x2D, 0x12, 0x4B, 0x24, 0x90, 0xA1, 0x62, 0xEF, 0xF0, 0x90, 0xA3, 0x52, 0x74, 0x01, 0xF0, ++0x90, 0xA2, 0x7E, 0xE0, 0x64, 0x15, 0x70, 0x6E, 0x90, 0xFD, 0x62, 0xE0, 0xFF, 0x30, 0xE6, 0x1C, ++0xF4, 0x54, 0x3F, 0x04, 0xFE, 0x90, 0xA1, 0x61, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0xC3, 0x9E, 0x90, ++0xA2, 0x7D, 0xF0, 0xD3, 0x94, 0x3F, 0x40, 0x1D, 0xE4, 0xF0, 0x80, 0x19, 0x90, 0xA1, 0x61, 0xE0, ++0x13, 0x13, 0x54, 0x3F, 0xFE, 0xEF, 0x54, 0x3F, 0x2E, 0x90, 0xA2, 0x7D, 0xF0, 0xD3, 0x94, 0x3F, ++0x40, 0x03, 0x74, 0x3F, 0xF0, 0x90, 0xA2, 0x7D, 0xE0, 0xFF, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0xFE, ++0xEF, 0x25, 0xE0, 0x25, 0xE0, 0x4E, 0x90, 0xA2, 0x7C, 0xF0, 0xE0, 0xFD, 0x7F, 0x2E, 0x12, 0x4A, ++0x07, 0x90, 0xA2, 0x7D, 0xE0, 0xC4, 0x54, 0xF0, 0xFF, 0x90, 0xA1, 0x62, 0xE0, 0x54, 0x0F, 0x4F, ++0xFD, 0x7F, 0x2D, 0x12, 0x4A, 0x07, 0x90, 0xA2, 0x7E, 0xE0, 0xB4, 0x21, 0x0C, 0x90, 0xFD, 0x62, ++0xE0, 0xFF, 0x12, 0x80, 0xF8, 0x7F, 0x04, 0x31, 0xBE, 0x90, 0xA2, 0x7E, 0xE0, 0xB4, 0x23, 0x04, ++0x7F, 0x01, 0x31, 0xBA, 0x90, 0xA2, 0x7E, 0xE0, 0xB4, 0x27, 0x07, 0x12, 0x8B, 0xC1, 0x7F, 0x02, ++0x31, 0xBA, 0x90, 0xA2, 0x7E, 0xE0, 0xB4, 0x30, 0x0C, 0xE4, 0xFB, 0xFD, 0x7F, 0x01, 0x12, 0x81, ++0x12, 0x7F, 0x04, 0x31, 0xBE, 0x90, 0xA2, 0x7E, 0xE0, 0x64, 0x34, 0x70, 0x2E, 0x90, 0xFD, 0x62, ++0xE0, 0x30, 0xE0, 0x24, 0x90, 0xA2, 0x7C, 0x74, 0x01, 0xF0, 0xFB, 0x7A, 0xA2, 0x79, 0x7C, 0xFD, ++0x7F, 0x34, 0x12, 0x5A, 0x49, 0x90, 0xA2, 0x7C, 0x74, 0x03, 0xF0, 0xE0, 0xFF, 0x12, 0x8A, 0x23, ++0x90, 0xA1, 0xA8, 0xE0, 0x04, 0xF0, 0x80, 0x03, 0x12, 0x8B, 0xE5, 0x90, 0xA2, 0x7E, 0xE0, 0xB4, ++0x40, 0x14, 0x90, 0xFD, 0x62, 0xE0, 0x30, 0xE0, 0x08, 0x90, 0xA1, 0x4A, 0x74, 0x01, 0xF0, 0x80, ++0x05, 0xE4, 0x90, 0xA1, 0x4A, 0xF0, 0x90, 0xFD, 0x68, 0xE0, 0x90, 0xA1, 0x9F, 0xF0, 0x90, 0xFD, ++0x60, 0xE0, 0x90, 0xA1, 0xA0, 0xF0, 0x90, 0xFD, 0x61, 0xE0, 0x90, 0xA1, 0xA1, 0xF0, 0x90, 0xFD, ++0x62, 0xE0, 0x90, 0xA1, 0xA2, 0xF0, 0x90, 0xFD, 0x63, 0xE0, 0x90, 0xA1, 0xA3, 0xF0, 0x90, 0xFD, ++0x64, 0xE0, 0x90, 0xA1, 0xA4, 0xF0, 0x90, 0xFD, 0x65, 0xE0, 0x90, 0xA1, 0xA5, 0xF0, 0x90, 0xFD, ++0x66, 0xE0, 0x90, 0xA1, 0xA6, 0xF0, 0x90, 0xFD, 0x67, 0xE0, 0x90, 0xA1, 0xA7, 0xF0, 0x90, 0xFD, ++0x68, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0xA2, 0xC6, 0x74, 0x09, 0xF0, 0x90, 0xA2, 0xD4, 0x74, ++0x07, 0xF0, 0x90, 0xA2, 0xC8, 0xEF, 0xF0, 0x70, 0x31, 0x90, 0xA1, 0x40, 0xE0, 0x60, 0x1A, 0xA3, ++0xE0, 0x60, 0x02, 0x80, 0x0C, 0x90, 0x07, 0x70, 0xE0, 0x70, 0x06, 0x90, 0x07, 0x74, 0xE0, 0x60, ++0x08, 0x90, 0xA2, 0xC9, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0xC9, 0xF0, 0xE4, 0x90, ++0xA2, 0xCA, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0x80, 0x39, 0x90, 0xFD, 0x62, 0xE0, 0x90, 0xA2, ++0xC9, 0xF0, 0x90, 0xFD, 0x63, 0xE0, 0x90, 0xA2, 0xCA, 0xF0, 0x90, 0xFD, 0x64, 0xE0, 0x90, 0xA2, ++0xCB, 0xF0, 0x90, 0xFD, 0x65, 0xE0, 0x90, 0xA2, 0xCC, 0xF0, 0x90, 0xFD, 0x66, 0xE0, 0x90, 0xA2, ++0xCD, 0xF0, 0x90, 0xFD, 0x67, 0xE0, 0x90, 0xA2, 0xCE, 0xF0, 0x90, 0xA2, 0xC9, 0xE0, 0x54, 0x01, ++0x90, 0xA1, 0x40, 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0xC6, 0x02, 0x5F, 0x42, 0x12, ++0x90, 0xE2, 0x7F, 0x02, 0x21, 0xBE, 0x90, 0xA1, 0x42, 0xE0, 0x30, 0xE0, 0x05, 0x12, 0x8C, 0x33, ++0x80, 0x03, 0x12, 0x89, 0x89, 0x90, 0xA1, 0x08, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0xA1, 0x0A, 0x74, ++0x01, 0xF0, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x45, 0x90, 0xA1, 0x0E, 0xE0, 0xFF, 0x13, 0x13, 0x13, ++0x54, 0x1F, 0x30, 0xE0, 0x12, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0B, 0x91, 0x57, 0x90, 0xA1, ++0x16, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0xA3, 0x55, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, ++0xD6, 0xC3, 0x90, 0xA3, 0x56, 0xE0, 0x94, 0x80, 0x90, 0xA3, 0x55, 0xE0, 0x64, 0x80, 0x94, 0x80, ++0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x12, 0xB8, 0xE9, ++0x12, 0x82, 0xDB, 0x7F, 0x01, 0x21, 0xBE, 0x7D, 0x02, 0x7F, 0x02, 0x91, 0x61, 0x7D, 0x01, 0x7F, ++0x02, 0x74, 0x15, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0xA1, 0x77, 0xE0, 0x04, 0xF0, 0x90, ++0xA1, 0x08, 0xE0, 0xFF, 0x30, 0xE0, 0x08, 0x90, 0xA1, 0x0C, 0xE0, 0x64, 0x02, 0x60, 0x3C, 0x90, ++0xA1, 0x10, 0xE0, 0x70, 0x04, 0xEF, 0x30, 0xE0, 0x0B, 0x90, 0xA1, 0x13, 0xE0, 0x64, 0x02, 0x60, ++0x2A, 0x12, 0x7C, 0x4B, 0x90, 0xA1, 0x0E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x15, ++0x90, 0xA1, 0x16, 0xE0, 0xFF, 0xA3, 0xE0, 0x6F, 0x70, 0x0B, 0x12, 0x7C, 0x27, 0x91, 0x57, 0x90, ++0xA1, 0x17, 0xE0, 0x14, 0xF0, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0xEF, 0x70, 0x34, 0x7D, ++0x78, 0x7F, 0x02, 0x91, 0x61, 0x7D, 0x02, 0x7F, 0x03, 0x91, 0x61, 0x7D, 0xC8, 0x7F, 0x02, 0x12, ++0xB7, 0xFF, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x7D, 0x01, 0x7F, ++0x0C, 0x12, 0x53, 0x5E, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, ++0xF8, 0xF0, 0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, ++0xB1, 0x55, 0x7D, 0x02, 0x7F, 0x03, 0xB1, 0x55, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0xF0, 0x90, ++0xA1, 0x1B, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0xA0, 0x87, 0xE0, 0xB4, 0x01, 0x15, 0x90, ++0xA1, 0x0E, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA1, 0x13, 0xE0, 0x20, 0xE2, 0x0E, 0x7D, 0x01, 0x7F, ++0x04, 0x02, 0x53, 0x5E, 0x90, 0xA1, 0x0E, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x01, 0x34, 0x74, ++0x40, 0xF0, 0xFD, 0xE4, 0xFF, 0x74, 0x15, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x05, 0x27, 0xE0, 0x90, 0xA2, 0x45, 0xF0, 0x12, 0x06, 0x89, 0xFF, 0x54, 0x01, 0xFE, ++0x90, 0xA1, 0x08, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, ++0x4F, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x90, ++0xA1, 0x08, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0xFF, 0xF0, 0x12, 0x06, 0x89, ++0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x90, 0xA1, 0x08, 0xF0, 0xEE, 0x54, 0x20, ++0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFE, 0x54, 0x40, 0xFD, 0xEF, 0x54, ++0xBF, 0x4D, 0x90, 0xA1, 0x08, 0xF0, 0xEE, 0xC3, 0x13, 0x20, 0xE0, 0x02, 0xC1, 0x9D, 0xE0, 0xFF, ++0x20, 0xE0, 0x02, 0xC1, 0x83, 0x90, 0xA2, 0x45, 0x74, 0x21, 0xF0, 0xEF, 0x13, 0x13, 0x54, 0x3F, ++0x30, 0xE0, 0x0B, 0xB1, 0x4C, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x08, 0xF0, 0x80, 0x0C, 0xE4, 0x90, ++0xA1, 0x09, 0xF0, 0xA3, 0xF0, 0x7D, 0x40, 0xFF, 0x91, 0x61, 0x90, 0xA1, 0x08, 0xE0, 0xFD, 0x13, ++0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x12, 0xF0, 0xED, 0xC4, ++0x54, 0x0F, 0x30, 0xE0, 0x07, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x14, 0xF0, 0x90, 0xA1, 0x08, 0xE0, ++0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA1, ++0x08, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x07, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x40, ++0xF0, 0x90, 0xA2, 0x45, 0xE0, 0x90, 0x05, 0x27, 0xF0, 0x90, 0xA1, 0x0B, 0xE0, 0x70, 0x05, 0x7F, ++0x01, 0x12, 0x85, 0x5C, 0x90, 0xA1, 0x08, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, ++0x04, 0x7F, 0x04, 0x80, 0x23, 0x12, 0x57, 0xEC, 0xEF, 0x60, 0x04, 0x7F, 0x01, 0x80, 0x19, 0x7F, ++0x02, 0x80, 0x15, 0x90, 0xA2, 0x45, 0x74, 0x01, 0xF0, 0x90, 0x05, 0x27, 0xF0, 0x90, 0xA1, 0x0B, ++0xE0, 0x64, 0x04, 0x60, 0x02, 0xE1, 0x73, 0xFF, 0x12, 0x85, 0x5C, 0xE1, 0x73, 0x90, 0xA1, 0x08, ++0xE0, 0xFD, 0x20, 0xE0, 0x02, 0xE1, 0x3E, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x31, 0xF0, 0xED, 0x13, ++0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0B, 0xB1, 0x4C, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x08, 0xF0, 0x80, ++0x06, 0x7D, 0x40, 0xE4, 0xFF, 0x91, 0x61, 0x90, 0xA1, 0x08, 0xE0, 0xFD, 0x13, 0x13, 0x13, 0x54, ++0x1F, 0x30, 0xE0, 0x07, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x02, 0xF0, 0xED, 0xC4, 0x54, 0x0F, 0x30, ++0xE0, 0x07, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0xA2, 0x45, 0xE0, 0x90, 0x05, 0x27, ++0xF0, 0x90, 0xA1, 0x08, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x0E, 0x90, 0xA1, ++0x0C, 0xE0, 0x64, 0x02, 0x60, 0x6D, 0xE4, 0xFD, 0x7F, 0x02, 0x80, 0x23, 0x90, 0x05, 0x27, 0xE0, ++0x44, 0x40, 0xF0, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x02, 0x1A, 0x12, 0xBA, 0xF0, 0x12, 0x57, 0xEC, ++0xBF, 0x01, 0x09, 0x90, 0xA1, 0x12, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x03, 0xE4, 0xFD, 0xFF, 0x12, ++0x53, 0x5E, 0x80, 0x3F, 0x90, 0xA1, 0x13, 0xE0, 0x90, 0xA1, 0x0C, 0xF0, 0x80, 0x35, 0x90, 0xA2, ++0x45, 0x74, 0x01, 0xF0, 0x90, 0x05, 0x27, 0xF0, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x02, 0x06, 0x7D, ++0x01, 0x7F, 0x04, 0x80, 0x0B, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x08, 0x07, 0x7D, 0x01, 0x7F, 0x0C, ++0x12, 0x53, 0x5E, 0x12, 0x57, 0xE4, 0x90, 0xA1, 0x12, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x53, 0x5E, ++0x12, 0x92, 0xE5, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x8D, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, ++0x5F, 0x74, 0x87, 0x25, 0x5F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, ++0x68, 0x7E, 0xE5, 0x5F, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0xE5, 0x5F, 0x54, 0x07, 0xFE, 0x74, ++0x01, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0xFD, 0xAF, 0x06, 0x74, 0x01, 0x7E, ++0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, ++0x70, 0x03, 0x02, 0x68, 0x7E, 0x75, 0xF0, 0x10, 0xE5, 0x5F, 0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, ++0xE0, 0x20, 0xE7, 0x02, 0x80, 0x10, 0x75, 0xF0, 0x10, 0xE5, 0x5F, 0x90, 0x81, 0x02, 0x12, 0x49, ++0x1D, 0xE0, 0xFF, 0x20, 0xE7, 0x0A, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x20, 0xF0, 0x02, 0x68, 0x7E, ++0xEF, 0x30, 0xE6, 0x2B, 0x90, 0xA1, 0x8A, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x5F, 0x90, ++0x81, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x5F, 0x90, 0x95, 0x95, 0x12, ++0x49, 0x1D, 0xE0, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA3, 0x04, 0xF0, 0xE4, 0xFB, 0x80, 0x5B, 0x90, ++0xA1, 0x8B, 0xE0, 0x04, 0xF0, 0x74, 0x92, 0x25, 0x5F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, ++0xE0, 0x04, 0xF0, 0x74, 0x92, 0x25, 0x5F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xD3, ++0x94, 0x03, 0x40, 0x13, 0xAF, 0x5F, 0x11, 0x8B, 0x74, 0x92, 0x25, 0x5F, 0xF5, 0x82, 0xE4, 0x34, ++0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x27, 0x75, 0xF0, 0x10, 0xE5, 0x5F, 0x90, 0x81, 0x00, 0x12, ++0x49, 0x1D, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x5F, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, ++0x13, 0x13, 0x54, 0x03, 0x90, 0xA3, 0x04, 0xF0, 0x7B, 0x01, 0xAF, 0x5F, 0x31, 0x1C, 0x05, 0x5F, ++0xE5, 0x5F, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x67, 0x81, 0x22, 0xAD, 0x07, 0x90, 0x01, 0xC4, ++0x74, 0x8B, 0xF0, 0x74, 0x68, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, 0x81, 0x05, 0x12, 0x49, ++0x1D, 0xE0, 0x54, 0x03, 0xF5, 0x61, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x92, 0x12, 0x49, 0x1D, ++0xE0, 0xF5, 0x62, 0x74, 0x12, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0x54, 0x7F, ++0xF5, 0x60, 0x64, 0x2C, 0x70, 0x2C, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, ++0xE0, 0xFF, 0x54, 0x03, 0x65, 0x61, 0x60, 0x1A, 0x15, 0x61, 0xE5, 0x61, 0x54, 0x03, 0x25, 0xE0, ++0x25, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xEF, 0x54, 0xF3, ++0x4E, 0xF0, 0xE5, 0x60, 0xD3, 0x95, 0x62, 0x40, 0x03, 0x85, 0x62, 0x60, 0x74, 0x12, 0x2D, 0xF5, ++0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0x54, 0x80, 0x42, 0x60, 0xAF, 0x05, 0x90, 0xA3, 0x04, ++0xE5, 0x61, 0xF0, 0xE4, 0xFB, 0xAD, 0x60, 0x31, 0x1C, 0xAF, 0x60, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x01, 0xEF, 0xF0, 0x90, 0xA3, 0x03, 0xEB, 0xF0, 0x90, 0xA3, 0x02, ++0xED, 0xF0, 0xE4, 0x90, 0xA3, 0x0A, 0xF0, 0x90, 0xA3, 0x01, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, ++0x1F, 0x90, 0xA3, 0x05, 0xF0, 0xEF, 0x54, 0x07, 0x90, 0xA3, 0x07, 0xF0, 0x90, 0xA3, 0x01, 0xE0, ++0x75, 0xF0, 0x10, 0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA3, 0x08, 0xF0, 0xED, 0x54, ++0x7F, 0x90, 0xA3, 0x06, 0xF0, 0xFB, 0x25, 0xE0, 0x24, 0x91, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, ++0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, 0x04, 0xEB, 0x90, ++0x42, 0x41, 0x12, 0x49, 0x1D, 0x12, 0x49, 0x0D, 0x12, 0x48, 0xAD, 0x78, 0x01, 0x12, 0x08, 0x47, ++0x90, 0xA3, 0x01, 0xE0, 0xFD, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA3, 0x02, 0xE0, 0xB4, 0x3F, 0x19, 0x75, 0xF0, 0x04, 0xED, ++0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x06, 0x90, ++0xA3, 0x02, 0x74, 0xBE, 0xF0, 0x90, 0xA3, 0x02, 0xE0, 0xB4, 0x34, 0x19, 0x75, 0xF0, 0x04, 0xED, ++0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x06, 0x90, ++0xA3, 0x02, 0x74, 0xB3, 0xF0, 0x90, 0xA3, 0x02, 0xE0, 0xFE, 0x54, 0x7F, 0x90, 0xA3, 0x06, 0xF0, ++0xEE, 0x54, 0x80, 0x90, 0xA3, 0x09, 0xF0, 0xED, 0x70, 0x10, 0x90, 0xA3, 0x01, 0xE0, 0xFB, 0xA3, ++0xE0, 0x90, 0xA2, 0x91, 0xF0, 0xE4, 0xFD, 0xFF, 0xD1, 0x47, 0x90, 0xA3, 0x01, 0xE0, 0xFC, 0x75, ++0xF0, 0x04, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0xC4, 0x54, 0x03, 0x70, 0x32, 0x90, 0xA3, ++0x06, 0xE0, 0xFE, 0xC3, 0x94, 0x14, 0x40, 0x15, 0xEE, 0xD3, 0x94, 0x18, 0x50, 0x0F, 0x90, 0x04, ++0x33, 0x74, 0x06, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x80, 0x0F, 0x90, 0x04, 0x33, ++0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, ++0x90, 0xA3, 0x03, 0xE0, 0x70, 0x33, 0x90, 0xA3, 0x05, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, ++0x94, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFE, 0x90, 0xA3, 0x07, 0xE0, 0xFD, 0x74, 0x01, ++0xA8, 0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, ++0x90, 0xA3, 0x08, 0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x50, 0x90, 0xA3, 0x05, 0xE0, 0x24, 0x01, 0xF5, ++0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA3, 0x07, 0xE0, ++0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xD0, 0x82, 0xD0, ++0x83, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0x07, 0xFF, ++0x90, 0xA3, 0x08, 0xF0, 0x90, 0xA3, 0x06, 0xE0, 0x90, 0x44, 0x45, 0x93, 0x33, 0x33, 0x33, 0x54, ++0xF8, 0x4F, 0x90, 0xA3, 0x08, 0xF0, 0x44, 0x80, 0xF0, 0x90, 0xA3, 0x02, 0xE0, 0xFF, 0x90, 0xA3, ++0x01, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, 0xA3, ++0x08, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x75, ++0xF0, 0x10, 0xEE, 0x90, 0x81, 0x05, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xFC, 0xFF, 0x90, 0xA3, 0x04, ++0xE0, 0x4F, 0xFE, 0x90, 0xA3, 0x01, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x05, 0x12, 0x49, ++0x1D, 0xEE, 0xF0, 0x7D, 0x01, 0xD1, 0xA6, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x8F, 0x26, 0x90, 0xA1, 0x8F, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, ++0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0x1F, 0x90, 0xA3, 0x30, 0xF0, 0x24, 0xF5, 0x50, 0x0D, ++0x60, 0x6D, 0x14, 0x60, 0x70, 0x14, 0x60, 0x73, 0x14, 0x60, 0x76, 0x80, 0x7D, 0xE4, 0xF5, 0x27, ++0x75, 0xF0, 0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x25, 0x27, 0xF5, ++0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA3, 0x30, 0xE0, 0x75, 0xF0, 0x07, 0xA4, ++0x24, 0x56, 0xF5, 0x82, 0xE4, 0x34, 0x40, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x27, 0xF5, 0x82, 0xE4, ++0x35, 0x83, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0xEF, 0x5E, 0xFF, 0x90, 0xA3, 0x32, 0xF0, 0x75, 0xF0, ++0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x25, 0x27, 0xF5, 0x82, 0xE4, ++0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x27, 0xE5, 0x27, 0xB4, 0x07, 0xA3, 0x80, 0x1B, 0xAD, ++0x26, 0x7F, 0x8C, 0x80, 0x10, 0xAD, 0x26, 0x7F, 0x94, 0x80, 0x0A, 0xAD, 0x26, 0x7F, 0x9C, 0x80, ++0x04, 0xAD, 0x26, 0x7F, 0xA4, 0x7E, 0x04, 0x12, 0x9F, 0xD1, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, ++0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0xC4, 0x54, 0x03, 0xFD, 0xE4, 0x90, 0xA3, 0x2E, 0xF0, ++0x7C, 0x06, 0x75, 0xF0, 0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0xBC, 0x06, 0x12, 0x12, 0x49, 0x1D, ++0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x80, 0x0E, 0x12, ++0x49, 0x1D, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x90, 0xA3, 0x31, ++0xF0, 0x90, 0xA3, 0x31, 0xE0, 0x60, 0x64, 0x75, 0x27, 0x07, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x27, ++0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0xA3, 0x31, 0xE0, 0xFB, ++0xEF, 0x5B, 0x60, 0x3E, 0xEC, 0x75, 0xF0, 0x08, 0xA4, 0x25, 0x27, 0x90, 0xA3, 0x2E, 0xF0, 0xBD, ++0x01, 0x0C, 0xE0, 0xD3, 0x94, 0x0B, 0x40, 0x06, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x39, 0xBD, 0x02, ++0x0F, 0x90, 0xA3, 0x2E, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x06, 0xE0, 0x24, 0x18, 0xF0, 0x80, 0x27, ++0xBD, 0x03, 0x24, 0x90, 0xA3, 0x2E, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x1B, 0xE0, 0x24, 0x22, 0xF0, ++0x80, 0x15, 0x15, 0x27, 0xE5, 0x27, 0xC3, 0x94, 0x00, 0x50, 0x9F, 0xEC, 0x60, 0x09, 0x1C, 0xEC, ++0xC3, 0x94, 0x00, 0x40, 0x02, 0x61, 0xF2, 0xE4, 0x90, 0xA3, 0x2F, 0xF0, 0xFC, 0x75, 0xF0, 0x08, ++0xE5, 0x26, 0x90, 0x89, 0x00, 0xBC, 0x06, 0x12, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2C, 0xF5, 0x82, ++0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x80, 0x0E, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2C, ++0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x90, 0xA3, 0x31, 0xF0, 0x90, 0xA3, 0x31, 0xE0, ++0x60, 0x63, 0xE4, 0xF5, 0x27, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x27, 0x08, 0x80, 0x05, 0xC3, 0x33, ++0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0xA3, 0x31, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x3E, 0xEC, ++0x75, 0xF0, 0x08, 0xA4, 0x25, 0x27, 0x90, 0xA3, 0x2F, 0xF0, 0xBD, 0x01, 0x0C, 0xE0, 0xD3, 0x94, ++0x0B, 0x40, 0x06, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x34, 0xBD, 0x02, 0x0F, 0x90, 0xA3, 0x2F, 0xE0, ++0xD3, 0x94, 0x1B, 0x40, 0x06, 0xE0, 0x24, 0x18, 0xF0, 0x80, 0x22, 0xBD, 0x03, 0x1F, 0x90, 0xA3, ++0x2F, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x16, 0xE0, 0x24, 0x22, 0xF0, 0x80, 0x10, 0x05, 0x27, 0xE5, ++0x27, 0x64, 0x08, 0x70, 0xA0, 0x0C, 0xEC, 0x64, 0x07, 0x60, 0x02, 0x81, 0x9D, 0x90, 0xA3, 0x2E, ++0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, 0x95, 0x92, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, ++0xA3, 0x2F, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, 0x95, 0x93, 0x12, 0x49, 0x1D, 0xEE, ++0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x26, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0xFC, 0x54, 0x7F, ++0xFD, 0xEC, 0x54, 0x80, 0xFC, 0xED, 0xD3, 0x9F, 0x40, 0x05, 0x90, 0xA3, 0x2E, 0x80, 0x08, 0xED, ++0xC3, 0x9E, 0x50, 0x06, 0x90, 0xA3, 0x2F, 0xE0, 0x4C, 0xFD, 0x74, 0x12, 0x25, 0x26, 0xF5, 0x82, ++0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xED, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, 0x95, 0x95, 0x12, ++0x49, 0x1D, 0xE0, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA3, 0x04, 0xF0, 0xE4, 0xFB, 0xAF, 0x26, 0x31, ++0x1C, 0x75, 0xF0, 0x10, 0xE5, 0x26, 0x90, 0x81, 0x03, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0x90, 0xA3, ++0x2E, 0xE0, 0xFF, 0xC3, 0x94, 0x36, 0x40, 0x10, 0x74, 0x12, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, ++0x95, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x80, 0x6A, 0xEF, 0xC3, 0x94, 0x2C, 0x40, 0x10, 0x74, 0x12, ++0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x74, 0x04, 0xF0, 0x80, 0x54, 0x90, 0xA3, ++0x2E, 0xE0, 0xFF, 0xC3, 0x94, 0x14, 0x40, 0x10, 0x74, 0x12, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, ++0x95, 0xF5, 0x83, 0x74, 0x03, 0xF0, 0x80, 0x3A, 0xEF, 0xC3, 0x94, 0x0C, 0x40, 0x10, 0x74, 0x12, ++0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x74, 0x02, 0xF0, 0x80, 0x24, 0x90, 0xA3, ++0x2E, 0xE0, 0xC3, 0x94, 0x04, 0x74, 0x12, 0x40, 0x0E, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0x95, ++0xF5, 0x83, 0x74, 0x01, 0xF0, 0x80, 0x0B, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, ++0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0x90, 0xEB, 0xF0, 0x70, 0x57, 0x90, 0xA2, ++0x90, 0xE0, 0xFE, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xE0, 0xFC, 0x90, 0xA2, ++0x91, 0xE0, 0xFB, 0xEC, 0x6B, 0x60, 0x3E, 0x90, 0xA2, 0x94, 0xEB, 0xF0, 0xA3, 0xEE, 0xF0, 0xAE, ++0x05, 0xEE, 0x25, 0xE0, 0x4F, 0xA3, 0xF0, 0x90, 0xA2, 0x92, 0x74, 0x0C, 0xF0, 0x90, 0xA2, 0xA0, ++0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x92, 0x12, 0x5F, 0x42, 0x7F, 0x04, 0x12, 0x5A, ++0x0F, 0x90, 0xA2, 0x91, 0xE0, 0xFF, 0x90, 0xA2, 0x90, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, ++0x98, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x62, ++0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x01, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, ++0x0A, 0xEF, 0x90, 0x8D, 0x03, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, ++0x90, 0x8D, 0x05, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, ++0x07, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x09, 0x12, ++0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, ++0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, ++0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x03, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xBF, 0x44, ++0x80, 0xFE, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x03, 0x12, 0x49, 0x1D, 0xEE, 0xF0, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, ++0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, ++0x90, 0x01, 0xC4, 0x74, 0x33, 0xF0, 0x74, 0x6F, 0xA3, 0xF0, 0x12, 0x9A, 0x7B, 0xE5, 0x21, 0x30, ++0xE1, 0x02, 0xF1, 0xDC, 0xE5, 0x21, 0x30, 0xE2, 0x03, 0x12, 0x57, 0x81, 0xE5, 0x22, 0x30, 0xE0, ++0x03, 0x12, 0x9D, 0x57, 0xE5, 0x23, 0x30, 0xE1, 0x03, 0x12, 0x84, 0xC6, 0xE5, 0x23, 0x30, 0xE0, ++0x03, 0x12, 0x84, 0x58, 0xE5, 0x23, 0x30, 0xE3, 0x02, 0xF1, 0xDB, 0xE5, 0x24, 0x30, 0xE1, 0x05, ++0x7F, 0x04, 0x12, 0x61, 0xBE, 0xE5, 0x24, 0x30, 0xE4, 0x03, 0x12, 0x82, 0xC7, 0xE5, 0x24, 0x30, ++0xE5, 0x03, 0x12, 0x56, 0x79, 0xE5, 0x24, 0x30, 0xE6, 0x03, 0x12, 0x9D, 0xEC, 0xE5, 0x24, 0x30, ++0xE7, 0x03, 0x12, 0x77, 0x3D, 0x74, 0x33, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x6F, 0xA3, 0xF0, ++0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, ++0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x22, 0x90, 0xA1, 0x10, 0xE0, ++0x60, 0x03, 0x12, 0xBB, 0xC5, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, ++0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, ++0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xE6, 0xF0, 0x74, 0x6F, 0xA3, 0xF0, 0x90, 0xA1, 0x9C, ++0xE0, 0x04, 0xF0, 0x12, 0x61, 0xCD, 0x53, 0x91, 0xBF, 0x74, 0xE6, 0x04, 0x90, 0x01, 0xC4, 0xF0, ++0x74, 0x6F, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, ++0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, ++0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x3F, ++0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x70, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, ++0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, ++0x90, 0xA3, 0x0B, 0xEF, 0xF0, 0xAB, 0x05, 0x7E, 0x00, 0x7D, 0x00, 0x7C, 0x00, 0xE4, 0x90, 0xA3, ++0x10, 0xF0, 0xAF, 0x03, 0x90, 0xA3, 0x0C, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x0C, 0x12, 0x48, 0xE5, ++0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x38, 0x07, 0x7F, 0x14, 0x7E, ++0x00, 0x12, 0x3D, 0x7A, 0x90, 0xA3, 0x0B, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0xB5, 0xF5, 0x82, ++0xE4, 0x34, 0xAD, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x37, 0xBC, 0xED, 0x54, 0x0F, ++0xFD, 0xE4, 0xFC, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, 0x70, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0xA3, 0x13, ++0x12, 0x48, 0xE5, 0x90, 0xAA, 0x9C, 0x12, 0x08, 0x6D, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0x32, 0x34, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x56, 0xE0, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x1C, 0xEF, ++0xB4, 0x01, 0x05, 0x90, 0xA1, 0x5D, 0x80, 0x03, 0x90, 0xA1, 0x59, 0x12, 0x48, 0xE5, 0x90, 0xAA, ++0xB9, 0x12, 0x08, 0x6D, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x38, 0x07, 0x22, 0x90, 0xA2, 0x6F, 0x74, ++0x02, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0x20, 0xE0, 0x02, 0xC1, 0x51, 0x12, 0x87, 0xF6, 0x90, 0xA1, ++0x3A, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x41, 0x09, 0xF5, 0x3B, 0x75, 0x3C, 0x03, 0xFB, 0xFD, 0x7F, ++0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x6F, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, ++0xC4, 0x54, 0x0F, 0x90, 0xA1, 0x3A, 0x30, 0xE0, 0x05, 0x74, 0x05, 0xF0, 0x80, 0x03, 0xE0, 0x04, ++0xF0, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0F, 0x90, 0xA1, 0x29, 0xE0, ++0xFF, 0x90, 0xA1, 0x38, 0xE0, 0xC3, 0x9F, 0x90, 0xA1, 0x3E, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC4, ++0x13, 0x54, 0x07, 0x30, 0xE0, 0x28, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, ++0x6D, 0x90, 0xA1, 0x3E, 0xE0, 0xC3, 0x94, 0x20, 0x50, 0x0A, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, ++0xE4, 0xFD, 0x80, 0x05, 0x7B, 0x7F, 0x7D, 0xFF, 0xE4, 0xFF, 0xF1, 0x63, 0x80, 0x50, 0x90, 0xA1, ++0x28, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x40, 0x90, 0xA1, 0x2E, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, ++0xFD, 0x7F, 0x04, 0x12, 0x53, 0x5E, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, ++0xE0, 0x26, 0x90, 0xA1, 0x2F, 0xE0, 0x44, 0x02, 0xF0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA1, 0x3D, ++0xF0, 0x90, 0xA1, 0x3A, 0xF0, 0x90, 0xA1, 0x30, 0x74, 0x06, 0xF0, 0x90, 0xA1, 0x27, 0xE0, 0x60, ++0x07, 0x90, 0xA1, 0x2F, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0xA1, ++0x2B, 0xE0, 0x20, 0xE0, 0x02, 0xC1, 0x51, 0xA1, 0x7B, 0x90, 0xA1, 0x3A, 0xE0, 0x64, 0x02, 0x60, ++0x02, 0x41, 0xFD, 0x7F, 0x01, 0xD1, 0x52, 0x90, 0xA1, 0x2C, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, ++0x30, 0xE0, 0x08, 0xF1, 0x98, 0xBF, 0x01, 0x03, 0x12, 0x8A, 0x8F, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, ++0x13, 0x13, 0x13, 0x54, 0x01, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, ++0x74, 0x01, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x29, 0xE0, 0x24, 0x03, 0xFF, 0x90, 0xA1, 0x38, ++0xE0, 0xC3, 0x9F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, ++0x01, 0x6F, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xE4, 0x90, ++0xA2, 0x6E, 0xF0, 0x80, 0x06, 0x90, 0xA2, 0x6E, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0xC4, ++0x13, 0x54, 0x07, 0x20, 0xE0, 0x13, 0x90, 0xA1, 0x65, 0xE0, 0x60, 0x08, 0x90, 0xA2, 0x6F, 0x74, ++0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x6F, 0xF0, 0xD1, 0x8B, 0xE4, 0x90, 0xA1, 0x39, 0xF0, ++0xA3, 0xE0, 0x04, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, ++0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x29, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, ++0x10, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x0E, 0x12, 0x53, 0x57, 0x80, ++0x09, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x09, 0x12, 0x53, 0x57, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, ++0x90, 0xA1, 0x2B, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, ++0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x20, 0xE0, 0x02, 0xC1, 0x51, 0xC1, 0x4D, 0x90, 0xA1, 0x3A, ++0xE0, 0x64, 0x03, 0x60, 0x02, 0x81, 0xB1, 0xFF, 0xD1, 0x52, 0x90, 0xA1, 0x2C, 0xE0, 0xFF, 0x13, ++0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x86, 0xBC, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x13, ++0x54, 0x03, 0x30, 0xE0, 0x08, 0x90, 0x07, 0x78, 0x74, 0x0D, 0xF0, 0x80, 0x14, 0x90, 0xA1, 0x2B, ++0xE0, 0xC3, 0x13, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x09, ++0xF0, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x02, 0x61, 0xD4, 0x90, ++0xA1, 0x32, 0xE0, 0xFF, 0x90, 0xA1, 0x3C, 0xE0, 0xD3, 0x9F, 0x40, 0x4D, 0xE0, 0x75, 0xF0, 0x03, ++0xA4, 0xFF, 0x90, 0xA1, 0x34, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, 0xFF, 0x24, 0x03, 0xFD, 0xE4, 0x33, ++0xFC, 0x90, 0xA1, 0x2A, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x40, 0x08, ++0xE0, 0x9F, 0x90, 0xA2, 0x70, 0xF0, 0x80, 0x06, 0x90, 0xA2, 0x70, 0x74, 0x03, 0xF0, 0xE4, 0xF5, ++0x3B, 0x90, 0xA2, 0x70, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x6C, 0x7E, 0x01, 0x12, 0x35, ++0x7A, 0x90, 0xA1, 0x3A, 0xE0, 0x04, 0xF0, 0x80, 0x24, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x35, 0xE0, ++0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0xA1, 0x30, 0x74, ++0x04, 0xF0, 0xE4, 0x90, 0xA1, 0x3A, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA1, ++0x3C, 0xF0, 0x80, 0x19, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x2A, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, ++0x7F, 0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0xA1, 0x3A, 0xE0, 0x04, 0xF0, 0x90, 0x01, 0x6F, ++0x74, 0x05, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x07, ++0xE4, 0x90, 0xA2, 0x6E, 0xF0, 0x80, 0x06, 0x90, 0xA2, 0x6E, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x2B, ++0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x13, 0x90, 0xA1, 0x65, 0xE0, 0x60, 0x07, 0xE4, 0x90, ++0xA2, 0x6F, 0xF0, 0x80, 0x06, 0x90, 0xA2, 0x6F, 0x74, 0x01, 0xF0, 0xD1, 0x8B, 0x90, 0xA1, 0x39, ++0x74, 0x01, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x33, 0x90, 0xA1, ++0x28, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1C, 0x90, 0xA1, 0x2E, 0xE0, 0x44, 0x20, 0xF0, 0x90, ++0xA1, 0x27, 0xE0, 0x60, 0x04, 0x7D, 0x01, 0x80, 0x13, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x7D, 0x01, ++0x7F, 0x0C, 0x80, 0x0A, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x07, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x53, ++0x5E, 0x90, 0xA1, 0x27, 0xE0, 0x60, 0x08, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x1F, 0x90, ++0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x0F, 0x90, 0xA1, 0x28, 0xE0, 0xFF, 0x13, ++0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x7E, 0x40, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, ++0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x20, 0xE0, 0x02, 0xC1, 0x51, 0x7F, 0x01, 0xC1, ++0x4F, 0x90, 0xA1, 0x3A, 0xE0, 0x64, 0x04, 0x60, 0x02, 0xA1, 0x81, 0xF5, 0x3B, 0x75, 0x3C, 0x03, ++0xFB, 0xFD, 0x7F, 0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x6F, 0x74, 0x05, 0xF0, 0x90, ++0xA1, 0x3A, 0xE0, 0x04, 0xF0, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0F, ++0x90, 0xA1, 0x2A, 0xE0, 0xFF, 0x90, 0xA1, 0x38, 0xE0, 0xC3, 0x9F, 0x90, 0xA1, 0x3E, 0xF0, 0x90, ++0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x28, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, ++0x54, 0x07, 0x30, 0xE0, 0x6D, 0x90, 0xA1, 0x3E, 0xE0, 0xC3, 0x94, 0x20, 0x50, 0x0A, 0xE0, 0x25, ++0xE0, 0x25, 0xE0, 0xFB, 0xE4, 0xFD, 0x80, 0x05, 0x7B, 0x7F, 0x7D, 0xFF, 0xE4, 0xFF, 0xF1, 0x63, ++0x80, 0x50, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x40, 0x90, 0xA1, 0x2E, 0xE0, ++0x54, 0xDF, 0xF0, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x53, 0x5E, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, ++0x13, 0x54, 0x03, 0x30, 0xE0, 0x26, 0x90, 0xA1, 0x2F, 0xE0, 0x44, 0x02, 0xF0, 0x54, 0xFB, 0xF0, ++0xE4, 0x90, 0xA1, 0x3D, 0xF0, 0x90, 0xA1, 0x3A, 0xF0, 0x90, 0xA1, 0x30, 0x74, 0x07, 0xF0, 0x90, ++0xA1, 0x27, 0xE0, 0x60, 0x07, 0x90, 0xA1, 0x2F, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x05, 0x22, 0x74, ++0x6F, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0x20, 0xE0, 0x02, 0xC1, 0x51, 0x90, 0x05, 0x22, 0xE4, 0xF0, ++0x22, 0x90, 0xA1, 0x3A, 0xE0, 0x64, 0x05, 0x60, 0x02, 0xC1, 0x51, 0x7F, 0x01, 0xD1, 0x52, 0x90, ++0xA1, 0x2C, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x08, 0xF1, 0x98, 0xBF, 0x01, 0x03, ++0x12, 0x8A, 0x8F, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x90, 0x07, 0x78, ++0x30, 0xE0, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC3, ++0x13, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA2, 0x6E, 0xF0, 0x80, 0x06, 0x90, 0xA2, 0x6E, 0x74, 0x01, ++0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x13, 0x90, 0xA1, 0x65, 0xE0, ++0x60, 0x08, 0x90, 0xA2, 0x6F, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x6F, 0xF0, 0xD1, ++0x8B, 0xE4, 0x90, 0xA1, 0x39, 0xF0, 0xA3, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x54, 0x07, ++0x30, 0xE0, 0x08, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x29, 0x90, 0xA1, 0x28, 0xE0, 0xC4, ++0x54, 0x0F, 0x30, 0xE0, 0x10, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x0E, ++0x12, 0x53, 0x57, 0x80, 0x09, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x09, 0x12, 0x53, 0x57, 0x90, 0x05, ++0x22, 0x74, 0xFF, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, ++0x90, 0xA1, 0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x04, 0xE4, 0xFF, 0x11, ++0xF5, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0xB4, 0x03, 0x13, 0x90, 0xA1, 0x2B, ++0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0x06, 0xCC, 0x30, 0xE0, 0x17, 0xE4, 0xF0, 0x80, 0x16, ++0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x0C, 0xEF, 0x90, 0x06, 0xCC, 0x70, 0x03, ++0xF0, 0x80, 0x03, 0x74, 0x03, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0x6F, 0xE0, 0xFF, ++0x90, 0xA2, 0x6E, 0xE0, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x17, 0xEF, ++0xF0, 0xA3, 0xED, 0xF0, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0x90, 0xA3, 0x19, 0x12, 0x08, ++0x6D, 0x90, 0xA3, 0x17, 0xE0, 0xFB, 0x64, 0x02, 0x60, 0x2A, 0x90, 0xA3, 0x19, 0x12, 0x48, 0xE5, ++0xE4, 0xFC, 0x90, 0xA3, 0x19, 0x12, 0x08, 0x6D, 0xEB, 0x90, 0xA3, 0x19, 0xB4, 0x01, 0x08, 0x12, ++0x48, 0xE5, 0xEC, 0x44, 0x20, 0x80, 0x06, 0x12, 0x48, 0xE5, 0xEC, 0x44, 0x10, 0xFC, 0x90, 0xA3, ++0x19, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x18, 0xE0, 0xFB, 0x64, 0x02, 0x60, 0x2B, 0x90, 0xA3, 0x19, ++0x12, 0x48, 0xE5, 0xE4, 0xFF, 0xEC, 0x90, 0xA3, 0x19, 0x12, 0x08, 0x6D, 0xEB, 0x90, 0xA3, 0x19, ++0x70, 0x08, 0x12, 0x48, 0xE5, 0xEF, 0x44, 0x77, 0x80, 0x06, 0x12, 0x48, 0xE5, 0xEF, 0x44, 0x66, ++0xFF, 0xEC, 0x90, 0xA3, 0x19, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x17, 0xE0, 0xB4, 0x02, 0x06, 0xA3, ++0xE0, 0x64, 0x02, 0x60, 0x13, 0x90, 0xA3, 0x19, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, ++0x6D, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x38, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x42, ++0xE0, 0x30, 0xE0, 0x08, 0x90, 0x01, 0xBE, 0x74, 0x44, 0xF0, 0x80, 0x02, 0x21, 0x1C, 0x90, 0x05, ++0x22, 0x74, 0xFF, 0xF0, 0x90, 0x07, 0x78, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x65, 0xE0, 0xFF, 0xE4, ++0xFD, 0xC1, 0x95, 0x90, 0xA2, 0x71, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x04, ++0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA2, 0x76, 0xF0, 0xF1, 0x98, 0xBF, 0x01, ++0x03, 0x12, 0x81, 0x71, 0x90, 0xA2, 0x76, 0xE0, 0x90, 0x05, 0x22, 0xF0, 0x80, 0x03, 0x12, 0x81, ++0x71, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0xE4, 0x90, ++0xA3, 0x59, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, ++0xE0, 0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0xA3, 0x5A, 0xE0, 0x94, ++0xE8, 0x90, 0xA3, 0x59, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, ++0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0xA3, 0x59, 0xE4, 0x75, 0xF0, ++0x01, 0x12, 0x08, 0xD6, 0x80, 0xBF, 0x90, 0xA1, 0x56, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFB, 0xF0, ++0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x7F, 0x58, 0x7E, 0x0C, 0x12, ++0x37, 0xBC, 0x90, 0xA1, 0x5D, 0x12, 0x08, 0x6D, 0x90, 0xA1, 0x5D, 0x12, 0x48, 0xE5, 0x90, 0xA1, ++0x59, 0x12, 0x08, 0x6D, 0xE4, 0x90, 0xA1, 0x63, 0xF0, 0xA3, 0xF0, 0x90, 0xA1, 0x66, 0xF0, 0xA3, ++0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xFD, 0x68, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x07, ++0x78, 0x74, 0x03, 0xF0, 0x11, 0x47, 0x90, 0xA1, 0x40, 0x74, 0x01, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, ++0xA1, 0x4A, 0xF0, 0xA3, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0x28, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, ++0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, ++0xA3, 0x74, 0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, ++0x54, 0xFB, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, ++0xE0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, ++0x54, 0x7F, 0xF0, 0x90, 0xA1, 0x2E, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0xA1, 0x2D, 0xF0, 0x90, ++0xA1, 0x2F, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA1, 0x36, ++0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0xE4, 0xA3, 0xF0, ++0xA3, 0xF0, 0x90, 0xA1, 0x42, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, 0xE4, 0x90, 0xA1, 0x3F, ++0xF0, 0x90, 0xA1, 0x4C, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, ++0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0x47, 0x12, 0x49, 0x32, 0x12, 0x06, 0x89, 0xFF, 0x54, ++0x01, 0xFE, 0x90, 0xA1, 0x28, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, ++0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, ++0xFF, 0x90, 0xA1, 0x28, 0xF0, 0xEE, 0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, 0x12, ++0x06, 0x89, 0xFE, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0x90, 0xA1, 0x28, 0xF0, 0xEE, ++0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFE, 0x54, 0x80, 0xFD, ++0xEF, 0x54, 0x7F, 0x4D, 0x90, 0xA1, 0x28, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFF, 0x54, ++0x01, 0xFD, 0x90, 0xA1, 0x2B, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xED, ++0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFD, 0x54, 0x04, 0xFC, 0xEF, ++0x54, 0xFB, 0x4C, 0xFF, 0x90, 0xA1, 0x2B, 0xF0, 0xED, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, ++0xFF, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFD, 0x54, 0x20, 0xFC, 0xEF, 0x54, 0xDF, 0x4C, ++0xFF, 0x90, 0xA1, 0x2B, 0xF0, 0xED, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, 0x4D, 0xFF, 0xF0, 0x90, ++0x00, 0x03, 0x12, 0x06, 0xA2, 0x54, 0x80, 0xFD, 0xEF, 0x54, 0x7F, 0x4D, 0x90, 0xA1, 0x2B, 0xF0, ++0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0xFF, 0x54, 0x20, 0xFD, 0x90, 0xA1, 0x2C, 0xE0, 0x54, 0xDF, ++0x4D, 0xFD, 0xF0, 0xEF, 0x54, 0x40, 0xFF, 0xED, 0x54, 0xBF, 0x4F, 0xFF, 0xF0, 0x90, 0x00, 0x04, ++0x12, 0x06, 0xA2, 0xFD, 0x54, 0x80, 0xFC, 0xEF, 0x54, 0x7F, 0x4C, 0xFF, 0x90, 0xA1, 0x2C, 0xF0, ++0xED, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, ++0xFD, 0x54, 0x10, 0xFC, 0xEF, 0x54, 0xEF, 0x4C, 0xFF, 0x90, 0xA1, 0x2C, 0xF0, 0xED, 0x54, 0x08, ++0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xF0, 0xEE, 0x20, 0xE0, 0x02, 0x61, 0x8F, 0x90, 0x05, 0x54, 0xE0, ++0xC3, 0x13, 0x90, 0xA1, 0x38, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1C, ++0x90, 0xA2, 0x47, 0x12, 0x49, 0x29, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0xA1, 0x29, 0xF0, ++0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0xA1, 0x2A, 0xF0, 0x80, 0x4E, 0x90, 0xA2, 0x47, 0x12, ++0x49, 0x29, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, ++0x94, 0x03, 0x90, 0xA1, 0x29, 0x50, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, ++0x90, 0xA1, 0x29, 0x74, 0x2A, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFF, 0xC3, 0x94, 0x2A, ++0x50, 0x12, 0xEF, 0xC3, 0x94, 0x03, 0x90, 0xA1, 0x2A, 0x50, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x0A, ++0xEF, 0xF0, 0x80, 0x06, 0x90, 0xA1, 0x2A, 0x74, 0x2A, 0xF0, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, ++0x13, 0x54, 0x03, 0x30, 0xE0, 0x3C, 0x90, 0xA1, 0x29, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0xA1, ++0x31, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0xA1, 0x2A, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, ++0xA1, 0x33, 0xF0, 0x90, 0xA1, 0x29, 0xE0, 0xC3, 0x13, 0x90, 0xA1, 0x34, 0xF0, 0x90, 0xA1, 0x2A, ++0xE0, 0xC3, 0x13, 0x90, 0xA1, 0x35, 0xF0, 0x90, 0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, ++0x91, 0x36, 0xE4, 0x90, 0xA1, 0x63, 0xF0, 0x90, 0xA2, 0x47, 0x12, 0x49, 0x29, 0x90, 0x00, 0x03, ++0x12, 0x06, 0xA2, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x30, 0x12, 0x06, 0x89, 0x13, 0x13, ++0x13, 0x54, 0x1F, 0x30, 0xE0, 0x08, 0x90, 0xA1, 0x65, 0xE0, 0x60, 0x08, 0x80, 0x0E, 0x90, 0xA1, ++0x65, 0xE0, 0x60, 0x08, 0x90, 0xA2, 0x45, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x45, ++0xF0, 0x90, 0xA2, 0x45, 0xE0, 0xFF, 0x7D, 0x02, 0x12, 0x76, 0x95, 0x90, 0xA1, 0x28, 0xE0, 0xC4, ++0x54, 0x0F, 0x30, 0xE0, 0x1B, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x06, ++0x90, 0xA1, 0x12, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x74, 0x11, 0xF0, ++0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, 0xA1, 0x30, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0xA1, ++0x3A, 0x74, 0x01, 0xF0, 0x80, 0x22, 0xEF, 0xB4, 0x04, 0x08, 0x90, 0xA1, 0x3A, 0x74, 0x04, 0xF0, ++0x80, 0x16, 0xEF, 0xB4, 0x06, 0x08, 0x90, 0xA1, 0x3A, 0x74, 0x02, 0xF0, 0x80, 0x0A, 0xEF, 0xB4, ++0x07, 0x06, 0x90, 0xA1, 0x3A, 0x74, 0x05, 0xF0, 0xE4, 0x90, 0xA1, 0x30, 0xF0, 0x80, 0x60, 0x90, ++0xA2, 0x47, 0x12, 0x49, 0x29, 0x12, 0x06, 0x89, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, ++0x08, 0x90, 0xA2, 0x46, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x46, 0xF0, 0x11, 0x47, ++0x7D, 0x20, 0x7F, 0x40, 0x12, 0x4A, 0x07, 0x90, 0xA2, 0x47, 0x12, 0x49, 0x29, 0x90, 0x00, 0x03, ++0x12, 0x06, 0xA2, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x03, ++0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x90, 0xA2, 0x46, 0xE0, 0xFD, 0x7F, 0x02, 0x12, 0x76, 0x95, ++0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x74, 0x43, 0xF0, 0x90, ++0xA1, 0x2E, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0xA1, 0x39, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0xC4, ++0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x09, 0x90, 0xA1, 0x56, 0xE0, 0x44, 0x02, 0xF0, 0x80, ++0x0C, 0x7F, 0x01, 0x12, 0x70, 0xF5, 0x90, 0xA1, 0x56, 0xE0, 0x54, 0xFD, 0xF0, 0x7F, 0x03, 0x12, ++0x76, 0x52, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0x01, 0x3F, ++0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x74, 0x1D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x38, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0xA0, 0x87, 0xE0, 0x64, ++0x01, 0x60, 0x02, 0x81, 0xEA, 0x90, 0xA1, 0x10, 0xE0, 0x70, 0x02, 0x81, 0xEA, 0x90, 0xA1, 0x0F, ++0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0xA1, 0x17, 0xF0, ++0x90, 0x06, 0xAA, 0xE0, 0x90, 0xA1, 0x16, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0xA1, 0x16, ++0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0xA1, 0x17, 0xEF, 0xF0, 0x90, 0xA1, 0x0E, 0xE0, 0x44, 0x04, ++0xF0, 0xE4, 0x90, 0xA1, 0x19, 0xF0, 0x90, 0xA1, 0x1B, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, ++0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA1, 0x14, 0xE0, 0x54, 0xFD, ++0xF0, 0x54, 0xEF, 0xF0, 0x90, 0xA1, 0x0F, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, ++0x80, 0x0D, 0x90, 0xA1, 0x08, 0xE0, 0x30, 0xE0, 0x04, 0xB1, 0x7E, 0x80, 0x02, 0x91, 0xFB, 0x90, ++0xA1, 0x0E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0F, 0x90, 0xA1, 0x16, 0xE0, 0xFF, ++0xA3, 0xE0, 0xB5, 0x07, 0x05, 0x91, 0x27, 0x12, 0x64, 0x5D, 0x90, 0xA1, 0x08, 0xE0, 0xC3, 0x13, ++0x20, 0xE0, 0x07, 0x90, 0xA1, 0x0E, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0xA2, 0x5E, 0xF0, ++0x90, 0x06, 0xA9, 0xE0, 0x90, 0xA2, 0x5E, 0xF0, 0xE0, 0x54, 0xC0, 0x70, 0x0D, 0x90, 0xA1, 0x14, ++0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x02, 0x53, 0x43, 0x90, 0xA2, 0x5E, 0xE0, 0x30, 0xE6, ++0x22, 0x90, 0xA1, 0x10, 0xE0, 0x64, 0x01, 0x70, 0x21, 0x90, 0xA1, 0x14, 0xE0, 0x44, 0x01, 0xF0, ++0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x04, 0xD1, 0x40, 0x80, 0x0C, 0x12, 0x56, ++0x64, 0x80, 0x07, 0x90, 0xA1, 0x14, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA2, 0x5E, 0xE0, 0x90, 0xA1, ++0x14, 0x30, 0xE7, 0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x22, 0xE0, 0xF5, ++0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, 0x74, 0x05, ++0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x06, ++0xA9, 0xE0, 0x90, 0xA2, 0x5E, 0xF0, 0xE0, 0xFD, 0x54, 0xC0, 0x70, 0x09, 0x90, 0xA1, 0x14, 0xE0, ++0x54, 0xFE, 0xF0, 0xC1, 0x1C, 0xED, 0x30, 0xE6, 0x4C, 0x90, 0xA1, 0x10, 0xE0, 0x64, 0x02, 0x70, ++0x2A, 0x90, 0xA1, 0x0D, 0xE0, 0xFF, 0xC3, 0x13, 0x20, 0xE0, 0x09, 0x90, 0xA1, 0x14, 0xE0, 0x44, ++0x01, 0xF0, 0x80, 0x28, 0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x2E, 0x90, 0xA1, ++0x14, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x01, 0xD1, 0x20, 0x80, 0x21, 0x90, 0xA1, 0x14, 0xE0, 0x44, ++0x01, 0xF0, 0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x04, 0xD1, 0x40, 0x80, 0x0C, ++0x12, 0x56, 0x64, 0x80, 0x07, 0x90, 0xA1, 0x14, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA2, 0x5E, 0xE0, ++0x90, 0xA1, 0x14, 0x30, 0xE7, 0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x22, ++0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, ++0x74, 0x05, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, ++0x8F, 0x5F, 0xF1, 0xA0, 0xBF, 0x01, 0x18, 0x90, 0x9F, 0x99, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x57, ++0x12, 0xAD, 0x07, 0xAC, 0x06, 0xAF, 0x5F, 0xD1, 0x65, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, ++0x90, 0xA1, 0x26, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x1A, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x14, ++0x90, 0x9F, 0x97, 0xE0, 0xFF, 0xE4, 0xFD, 0x12, 0x57, 0x12, 0x8E, 0x6A, 0x8F, 0x6B, 0x90, 0x04, ++0x1F, 0x74, 0x20, 0xF0, 0x22, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, ++0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x52, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x44, 0x10, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, ++0x80, 0xF0, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x47, 0x90, 0xA1, 0x3E, ++0xE0, 0xFF, 0xC3, 0x94, 0x20, 0x50, 0x13, 0xEF, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x74, 0x2B, 0x2D, ++0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0x74, 0x2B, 0x2D, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0x74, 0x7F, 0xF0, 0x22, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x54, 0xEF, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x44, 0x40, 0xF0, 0x22, 0x90, 0x9F, 0x98, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x57, 0x12, 0x8E, ++0x64, 0x8F, 0x65, 0xAD, 0x65, 0xAC, 0x64, 0xAF, 0x63, 0xD1, 0x65, 0xAF, 0x65, 0xAE, 0x64, 0x90, ++0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, ++0xF5, 0x83, 0xE0, 0x44, 0x01, 0xF0, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, ++0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, ++0x0E, 0xF0, 0x90, 0x04, 0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, 0x74, 0xFF, ++0xF0, 0x90, 0x04, 0xA4, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xED, 0xF0, 0x22, 0x90, 0xA0, 0x87, 0xE0, 0xB4, 0x01, 0x15, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x0F, ++0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x02, 0xC1, 0x40, 0x12, 0x56, 0x64, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, ++0xE0, 0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, 0xC6, 0xE0, ++0x30, 0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xFD, ++0x58, 0xE0, 0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0xE0, 0x04, 0xF0, 0x80, 0xF1, 0xEF, 0x75, 0xF0, ++0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, 0xFD, 0x50, 0xF0, ++0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, ++0xFD, 0x51, 0xF0, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x02, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0x90, 0xFD, 0x52, 0xF0, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0xF5, 0x82, 0xE4, ++0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, 0xFD, 0x53, 0xF0, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x04, ++0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, 0xFD, 0x54, 0xF0, 0xEF, 0x75, 0xF0, 0x08, ++0xA4, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, 0xFD, 0x55, 0xF0, 0xEF, ++0x75, 0xF0, 0x08, 0xA4, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, 0xFD, ++0x56, 0xF0, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, ++0xE0, 0x90, 0xFD, 0x57, 0xF0, 0xA3, 0x74, 0x01, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0xE4, 0xFC, 0x74, 0x28, 0x2F, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0xA2, 0x48, 0xEF, 0xF0, 0xEE, ++0xF9, 0x90, 0x01, 0xBD, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x02, 0x09, 0xE0, 0xC3, 0x13, 0x90, 0xFD, ++0x10, 0xF0, 0xEC, 0xC3, 0x99, 0x50, 0x45, 0xEC, 0x70, 0x04, 0x7D, 0x05, 0x80, 0x02, 0xE4, 0xFD, ++0xED, 0xC3, 0x94, 0x20, 0x50, 0x08, 0xAF, 0x05, 0x12, 0x7F, 0xCE, 0x0D, 0x80, 0xF2, 0x0C, 0x90, ++0xFD, 0x10, 0xE0, 0x04, 0xF0, 0xEC, 0xB5, 0x01, 0xD9, 0xE4, 0xFD, 0xED, 0x75, 0xF0, 0x08, 0xA4, ++0xFF, 0x90, 0xA2, 0x48, 0xE0, 0xFB, 0xC3, 0xEF, 0x9B, 0x74, 0x80, 0xF8, 0x65, 0xF0, 0x98, 0x50, ++0x08, 0xAF, 0x05, 0x12, 0x7F, 0xCE, 0x0D, 0x80, 0xE2, 0x0C, 0x80, 0xB6, 0x90, 0x01, 0xBD, 0xE0, ++0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0x7F, 0x74, 0x08, 0xF0, 0x90, 0xA2, ++0x8D, 0x74, 0x01, 0xF0, 0x90, 0xA2, 0x81, 0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x7F, 0x02, ++0x5F, 0x42, 0x90, 0xA2, 0xD5, 0x74, 0x0B, 0xF0, 0x90, 0xA2, 0xE3, 0x74, 0x07, 0xF0, 0x90, 0xA2, ++0xD7, 0xEF, 0xF0, 0x60, 0x32, 0x90, 0xFD, 0x63, 0xE0, 0x90, 0xA2, 0xD8, 0xF0, 0x90, 0xFD, 0x61, ++0xE0, 0x90, 0xA2, 0xD9, 0xF0, 0x90, 0xFD, 0x64, 0xE0, 0x90, 0xA2, 0xDA, 0xF0, 0x90, 0xFD, 0x65, ++0xE0, 0x90, 0xA2, 0xDB, 0xF0, 0x90, 0xFD, 0x66, 0xE0, 0x90, 0xA2, 0xDC, 0xF0, 0x90, 0xFD, 0x67, ++0xE0, 0x90, 0xA2, 0xDD, 0xF0, 0x80, 0x11, 0x90, 0xA2, 0xD8, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0xE4, ++0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0xD5, 0x02, 0x5F, ++0x42, 0x90, 0x9F, 0x9A, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x57, 0x12, 0x90, 0xA2, 0x74, 0xEE, 0xF0, ++0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA2, 0x71, 0xE0, 0xFF, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, ++0xA2, 0x7B, 0xF0, 0x90, 0xA2, 0x78, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA2, ++0x78, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x12, 0x7E, 0x65, 0x90, 0xA2, 0x78, 0xA3, 0xE0, 0xFF, 0xFD, ++0x24, 0x0D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0D, 0x2D, ++0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xEF, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x02, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0xFC, 0xF5, 0x83, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0xA2, 0x7A, 0xE0, 0xFF, 0x90, 0xA2, 0x78, 0xA3, ++0xE0, 0xFE, 0x24, 0x2A, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0xA2, 0x7B, ++0xE0, 0xFF, 0x74, 0x2B, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x2C, ++0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0x26, 0xE0, ++0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x2F, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x26, 0x90, ++0xA1, 0x2B, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x07, 0x90, 0x07, 0x78, 0x74, 0x03, 0xF0, 0x22, ++0x90, 0xA1, 0x26, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x04, 0x74, 0x0D, ++0xF0, 0x22, 0x74, 0x09, 0xF0, 0x22, 0xE4, 0x90, 0xA2, 0x6E, 0xF0, 0x90, 0xA1, 0x10, 0xE0, 0x60, ++0x65, 0x90, 0xA0, 0x87, 0xE0, 0x64, 0x01, 0x70, 0x5D, 0x90, 0xA2, 0x6E, 0x04, 0xF0, 0xE4, 0x90, ++0xA1, 0x17, 0xF0, 0x90, 0xA1, 0x08, 0xE0, 0x30, 0xE0, 0x16, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x02, ++0x05, 0xE4, 0x90, 0xA2, 0x6E, 0xF0, 0x12, 0x57, 0xEC, 0xEF, 0x70, 0x04, 0x90, 0xA2, 0x6E, 0xF0, ++0x90, 0xA2, 0x6E, 0xE0, 0x60, 0x30, 0x90, 0xA1, 0x14, 0xE0, 0x44, 0x10, 0xF0, 0xE4, 0xF5, 0x3B, ++0x90, 0xA1, 0x18, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, ++0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0x13, 0xE0, 0x20, 0xE2, 0x07, 0x7D, 0x01, 0x7F, ++0x04, 0x12, 0x53, 0x5E, 0x51, 0x1C, 0x22, 0x51, 0x56, 0x90, 0xA1, 0x16, 0xE0, 0x14, 0x90, 0x05, ++0x73, 0xF0, 0x7D, 0x02, 0x7F, 0x02, 0x12, 0x65, 0x55, 0x71, 0x11, 0x90, 0xA1, 0x6F, 0xE0, 0x30, ++0xE0, 0x2E, 0x90, 0xA0, 0x87, 0xE0, 0xB4, 0x01, 0x27, 0x90, 0xA3, 0x65, 0xE0, 0x04, 0xF0, 0xE0, ++0xB4, 0x0A, 0x0B, 0x90, 0xA1, 0x71, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0xA3, 0x65, 0xF0, 0x90, 0xA1, ++0x71, 0xE0, 0xFF, 0x90, 0xA1, 0x70, 0xE0, 0xB5, 0x07, 0x06, 0xE4, 0xA3, 0xF0, 0x12, 0x57, 0x7D, ++0x22, 0x90, 0xA3, 0x53, 0x74, 0x02, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0x20, 0xE0, 0x02, 0x81, 0x16, ++0xE4, 0xFF, 0x12, 0x76, 0x52, 0x90, 0xA1, 0x2C, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, ++0x02, 0xD1, 0xBC, 0x90, 0xA1, 0x28, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x08, ++0x90, 0x07, 0x78, 0x74, 0x0D, 0xF0, 0x80, 0x2D, 0x90, 0xA1, 0x2B, 0xE0, 0xFE, 0xC4, 0x54, 0x0F, ++0x30, 0xE0, 0x0D, 0xEE, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x0F, 0x80, 0x12, ++0x90, 0xA1, 0x2B, 0xE0, 0xFE, 0xC3, 0x13, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x03, 0xF0, ++0x80, 0x03, 0x74, 0x09, 0xF0, 0xEF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x07, 0xE4, ++0x90, 0xA3, 0x54, 0xF0, 0x80, 0x06, 0x90, 0xA3, 0x54, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, ++0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x13, 0x90, 0xA1, 0x65, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0xA3, ++0x53, 0xF0, 0x80, 0x06, 0x90, 0xA3, 0x53, 0x74, 0x01, 0xF0, 0x90, 0xA3, 0x53, 0xE0, 0xFF, 0xA3, ++0xE0, 0xFD, 0x12, 0x76, 0x95, 0x90, 0xA1, 0x39, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xFF, ++0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x80, 0x26, 0xEF, 0xC4, ++0x54, 0x0F, 0x30, 0xE0, 0x1F, 0x90, 0xA1, 0x2E, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0xA1, 0x27, 0xE0, ++0x60, 0x06, 0x7D, 0x01, 0x7F, 0x04, 0x80, 0x09, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x7D, 0x01, 0x7F, ++0x0C, 0x12, 0x53, 0x5E, 0x90, 0xA1, 0x27, 0xE0, 0x90, 0x05, 0x22, 0x60, 0x05, 0x74, 0x6F, 0xF0, ++0x80, 0x02, 0xE4, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, ++0x05, 0x7F, 0x01, 0x12, 0x70, 0xF5, 0x22, 0x90, 0xA1, 0x08, 0xE0, 0x30, 0xE0, 0x10, 0xA3, 0x74, ++0x01, 0xF0, 0x90, 0xA1, 0x08, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x91, 0x33, 0x12, 0xBB, ++0x09, 0x61, 0x11, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA1, 0x07, 0xE0, 0xB4, 0x01, ++0x04, 0x7F, 0x04, 0x80, 0x0C, 0x12, 0x57, 0xEC, 0xBF, 0x01, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, ++0x02, 0xB1, 0x5C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x08, 0xE0, 0xFF, 0x30, 0xE0, 0x3D, ++0x90, 0xA1, 0x0C, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0xA1, 0x0B, 0xE0, 0x7D, ++0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x23, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x02, ++0x80, 0xB1, 0x91, 0x9E, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x08, 0x06, 0xE4, 0xFD, 0x7F, 0x0C, 0x80, ++0x09, 0x90, 0xA1, 0x0C, 0xE0, 0x70, 0x06, 0xFD, 0x7F, 0x04, 0x12, 0x53, 0x5E, 0x22, 0x90, 0xA1, ++0x08, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x0F, 0x90, 0xA1, 0x0C, 0xE0, 0x64, ++0x02, 0x60, 0x07, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x53, 0x5E, 0x90, 0xA1, 0x0C, 0xE0, 0x64, 0x02, ++0x60, 0x03, 0x12, 0x9B, 0x56, 0x22, 0x90, 0xA1, 0x08, 0xE0, 0xFF, 0x30, 0xE0, 0x3F, 0x90, 0xA1, ++0x0C, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0xA1, 0x0B, 0xE0, 0x7D, 0x00, 0xB4, ++0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x25, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x81, 0x33, ++0x12, 0xB9, 0x72, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x0C, 0x06, 0xE4, 0xFD, 0x7F, 0x08, 0x80, 0x0A, ++0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x04, 0x06, 0xE4, 0xFD, 0xFF, 0x12, 0x53, 0x5E, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x12, 0x06, 0x89, 0xFF, 0x90, ++0xA1, 0x07, 0xF0, 0xBF, 0x01, 0x12, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x90, 0x00, 0x01, 0x12, ++0x06, 0xA2, 0x64, 0x01, 0x60, 0x21, 0x80, 0x1D, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x90, 0x00, ++0x01, 0x12, 0x06, 0xA2, 0x64, 0x01, 0x60, 0x0F, 0x90, 0xA1, 0x08, 0xE0, 0x20, 0xE0, 0x06, 0xE4, ++0xFF, 0xB1, 0x5C, 0x80, 0x02, 0x91, 0x33, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0xA1, 0x0B, 0xE0, 0x90, 0xA3, 0x66, 0xF0, 0x6F, 0x70, 0x02, 0xC1, 0x52, ++0xEF, 0x14, 0x60, 0x3E, 0x14, 0x60, 0x62, 0x14, 0x70, 0x02, 0xC1, 0x05, 0x14, 0x70, 0x02, 0xC1, ++0x2C, 0x24, 0x04, 0x60, 0x02, 0xC1, 0x52, 0x90, 0xA3, 0x66, 0xE0, 0xFF, 0xB4, 0x04, 0x04, 0xD1, ++0x8F, 0xC1, 0x52, 0xEF, 0xB4, 0x02, 0x04, 0xD1, 0x9E, 0xC1, 0x52, 0x90, 0xA3, 0x66, 0xE0, 0xFF, ++0xB4, 0x03, 0x04, 0xD1, 0xA2, 0xC1, 0x52, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xC1, 0x52, 0xD1, 0x91, ++0xC1, 0x52, 0x90, 0xA3, 0x66, 0xE0, 0xFF, 0xB4, 0x04, 0x04, 0xF1, 0xE3, 0xC1, 0x52, 0xEF, 0xB4, ++0x02, 0x04, 0xD1, 0xA6, 0xC1, 0x52, 0x90, 0xA3, 0x66, 0xE0, 0xFF, 0xB4, 0x03, 0x04, 0xF1, 0xCE, ++0xC1, 0x52, 0xEF, 0x70, 0x7D, 0xD1, 0x79, 0x80, 0x79, 0x90, 0xA3, 0x66, 0xE0, 0xB4, 0x04, 0x05, ++0x12, 0x8B, 0x97, 0x80, 0x6D, 0x90, 0xA3, 0x66, 0xE0, 0xB4, 0x01, 0x04, 0xD1, 0x6F, 0x80, 0x62, ++0x90, 0xA3, 0x66, 0xE0, 0xB4, 0x03, 0x04, 0xF1, 0xD9, 0x80, 0x57, 0x90, 0xA3, 0x66, 0xE0, 0x70, ++0x51, 0xD1, 0x6D, 0x80, 0x4D, 0x90, 0xA3, 0x66, 0xE0, 0xFF, 0xB4, 0x04, 0x05, 0x12, 0xB9, 0x33, ++0x80, 0x40, 0xEF, 0xB4, 0x01, 0x04, 0xD1, 0x82, 0x80, 0x38, 0xEF, 0xB4, 0x02, 0x04, 0xD1, 0xB3, ++0x80, 0x30, 0x90, 0xA3, 0x66, 0xE0, 0x70, 0x2A, 0xD1, 0x80, 0x80, 0x26, 0x90, 0xA3, 0x66, 0xE0, ++0xFF, 0xB4, 0x03, 0x05, 0x12, 0xB9, 0x5E, 0x80, 0x19, 0xEF, 0xB4, 0x01, 0x04, 0xD1, 0x59, 0x80, ++0x11, 0xEF, 0xB4, 0x02, 0x05, 0x12, 0xB9, 0x47, 0x80, 0x08, 0x90, 0xA3, 0x66, 0xE0, 0x70, 0x02, ++0xD1, 0x57, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD1, 0x79, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, ++0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0xA1, 0x0B, 0x74, 0x04, 0xF0, 0x22, 0xD1, 0x79, 0x12, ++0x8A, 0x89, 0x90, 0xA1, 0x0B, 0x74, 0x02, 0xF0, 0x22, 0x90, 0xA1, 0x0B, 0x74, 0x01, 0xF0, 0x22, ++0xD1, 0x79, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0x90, 0xA1, 0x0B, 0x74, 0x03, 0xF0, 0x22, 0xF1, ++0xE3, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0xE4, 0x90, 0xA1, 0x0B, 0xF0, 0x22, 0xD1, 0xA6, ++0x80, 0xEF, 0xF1, 0xCE, 0x80, 0xEB, 0xD1, 0xBC, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x0B, ++0x04, 0xF0, 0x22, 0xD1, 0xBC, 0x90, 0xA1, 0x0B, 0x74, 0x03, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x7F, 0x10, 0x12, 0x4B, 0x24, 0xEF, 0x44, 0x0C, 0xFD, 0x7F, 0x10, 0x12, 0x4A, ++0x07, 0x7F, 0x72, 0x12, 0x4B, 0x24, 0xEF, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x4A, 0x07, 0x90, ++0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0xA1, 0x26, 0xE0, ++0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x06, 0x90, 0x07, 0x78, 0x74, 0x03, 0xF0, 0x90, ++0xA1, 0x42, 0xE0, 0x20, 0xE0, 0x3A, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x34, 0x90, 0xA1, 0x65, 0xE0, ++0x60, 0x07, 0xE4, 0x90, 0xA3, 0x21, 0xF0, 0x80, 0x06, 0x90, 0xA3, 0x21, 0x74, 0x01, 0xF0, 0x90, ++0xA1, 0x26, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0xA3, 0x22, 0x30, 0xE0, 0x05, 0x74, 0x01, 0xF0, ++0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0xA3, 0x21, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x76, 0x95, ++0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, ++0x12, 0x37, 0xBC, 0xEF, 0x54, 0xBF, 0xFF, 0xEC, 0x90, 0xA3, 0x1D, 0x12, 0x08, 0x6D, 0x90, 0xA3, ++0x1D, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x38, ++0x07, 0x7F, 0x02, 0x12, 0x4B, 0x24, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x12, 0x4A, 0x07, 0x7F, ++0x00, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0xA3, 0x1D, 0x12, 0x08, ++0x6D, 0x90, 0xA3, 0x1D, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0x00, 0x7E, ++0x0C, 0x12, 0x38, 0x07, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x03, 0xFF, 0xEC, ++0x90, 0xA3, 0x1D, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x1D, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, ++0x08, 0x6D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x38, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, ++0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x0B, 0x04, 0xF0, 0x22, 0x12, 0x8A, 0x8F, 0x90, 0xA1, 0x0B, 0x74, ++0x02, 0xF0, 0x22, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0xF0, 0x90, ++0xA1, 0x0B, 0x74, 0x01, 0xF0, 0x22, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, ++0xE0, 0x02, 0x21, 0x88, 0x90, 0xA1, 0x30, 0xE0, 0x64, 0x01, 0x70, 0x34, 0x90, 0x06, 0x92, 0xE0, ++0x20, 0xE2, 0x06, 0x90, 0x04, 0xE3, 0xE0, 0x60, 0x1C, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0x90, ++0xA1, 0x3C, 0xE0, 0x04, 0xF0, 0x90, 0xA1, 0x31, 0xE0, 0xFF, 0x90, 0xA1, 0x3C, 0xE0, 0xB5, 0x07, ++0x02, 0x80, 0x02, 0x21, 0x73, 0xE4, 0x90, 0xA1, 0x30, 0xF0, 0x90, 0xA1, 0x3A, 0x04, 0xF0, 0x22, ++0x90, 0xA1, 0x30, 0xE0, 0x64, 0x04, 0x70, 0x35, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x06, 0x90, ++0x04, 0xE3, 0xE0, 0x60, 0x1C, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0x90, 0xA1, 0x3C, 0xE0, 0x04, ++0xF0, 0x90, 0xA1, 0x33, 0xE0, 0xFF, 0x90, 0xA1, 0x3C, 0xE0, 0xB5, 0x07, 0x02, 0x80, 0x02, 0x21, ++0x73, 0xE4, 0x90, 0xA1, 0x30, 0xF0, 0x90, 0xA1, 0x3A, 0x74, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0x30, ++0xE0, 0x64, 0x06, 0x60, 0x02, 0x21, 0x3C, 0x90, 0xA1, 0x3D, 0xE0, 0xB4, 0x04, 0x0F, 0x90, 0xA1, ++0x2B, 0xE0, 0xC4, 0x54, 0x0F, 0x90, 0xA1, 0x3A, 0x30, 0xE0, 0x4F, 0x21, 0x66, 0x90, 0xA1, 0x2F, ++0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x45, 0xEF, 0x54, 0xFB, 0xF0, 0xE4, 0xA3, 0xF0, ++0x90, 0xA1, 0x2B, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x02, 0x21, 0x4B, 0x90, 0xA1, 0x3D, 0xE0, ++0xFF, 0x90, 0xA1, 0x3C, 0xE0, 0x2F, 0xFF, 0xE4, 0x33, 0xFE, 0x7C, 0x00, 0x7D, 0x03, 0x12, 0x07, ++0x03, 0x90, 0xA1, 0x34, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0xC3, 0xEF, 0x94, 0x32, 0xEE, 0x64, ++0x80, 0x94, 0x80, 0x90, 0xA1, 0x3A, 0x40, 0x02, 0x80, 0x7C, 0x74, 0x02, 0xF0, 0x22, 0x12, 0x56, ++0x1D, 0x90, 0xA1, 0x3D, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x75, 0x3C, 0x03, 0xFB, 0xFD, 0x7F, ++0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x6F, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0x3D, 0xE0, ++0xFF, 0x90, 0xA1, 0x3C, 0xE0, 0x2F, 0xFF, 0xE4, 0x33, 0xFE, 0x7C, 0x00, 0x7D, 0x03, 0x12, 0x07, ++0x03, 0x90, 0xA1, 0x34, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0xC3, 0xEF, 0x94, 0x32, 0xEE, 0x64, ++0x80, 0x94, 0x80, 0x40, 0x53, 0x90, 0x07, 0x78, 0x74, 0x03, 0xF0, 0x22, 0x90, 0xA1, 0x30, 0xE0, ++0x64, 0x07, 0x70, 0x44, 0x90, 0xA1, 0x3D, 0xE0, 0xB4, 0x04, 0x05, 0x90, 0xA1, 0x3A, 0x80, 0x16, ++0x90, 0xA1, 0x2F, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0E, 0xEF, 0x54, 0xFB, 0xF0, ++0xE4, 0xA3, 0xF0, 0x90, 0xA1, 0x3A, 0x74, 0x05, 0xF0, 0x22, 0x12, 0x56, 0x1D, 0x90, 0xA1, 0x3D, ++0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x75, 0x3C, 0x03, 0xFB, 0xFD, 0x7F, 0x6C, 0x7E, 0x01, 0x12, ++0x35, 0x7A, 0x90, 0x01, 0x6F, 0x74, 0x05, 0xF0, 0x22, 0xE4, 0x90, 0xA2, 0x5E, 0xF0, 0x90, 0xA1, ++0x28, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0x22, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, ++0x30, 0xE0, 0x2A, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x34, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, ++0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0x90, 0xA1, 0x30, 0x74, ++0x01, 0xF0, 0xE4, 0x90, 0xA1, 0x3C, 0xF0, 0x90, 0xA1, 0x3A, 0xF0, 0x80, 0x20, 0xE4, 0xF5, 0x3B, ++0x90, 0xA2, 0x5E, 0xE0, 0xFF, 0x90, 0xA1, 0x29, 0xE0, 0xC3, 0x9F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, ++0x7F, 0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0xA1, 0x3A, 0x74, 0x01, 0xF0, 0x90, 0x01, 0x6F, ++0x74, 0x05, 0xF0, 0x90, 0xA1, 0x39, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x27, 0xE0, 0x60, 0x07, 0x90, ++0x05, 0x22, 0x74, 0x6F, 0xF0, 0x22, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xFF, ++0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x0B, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, ++0x7E, 0x40, 0x22, 0x90, 0xA2, 0x80, 0xEF, 0xF0, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0xE4, ++0xFE, 0xFD, 0xEC, 0x90, 0xA1, 0x43, 0x12, 0x08, 0x6D, 0x90, 0xA1, 0x42, 0xE0, 0x44, 0x01, 0x51, ++0x88, 0x90, 0x07, 0x78, 0xE0, 0x90, 0xA1, 0x47, 0xF0, 0x90, 0xA1, 0x65, 0xE0, 0xFF, 0xE4, 0xFD, ++0x12, 0x76, 0x95, 0x90, 0xA2, 0x80, 0xE0, 0xFD, 0x70, 0x02, 0x80, 0x24, 0xED, 0xB4, 0x01, 0x0A, ++0x90, 0xA1, 0x42, 0xE0, 0x54, 0x1F, 0x44, 0x20, 0xF0, 0x22, 0x90, 0xA2, 0x80, 0xE0, 0xFD, 0xB4, ++0x02, 0x0A, 0x90, 0xA1, 0x42, 0xE0, 0x54, 0x1F, 0x44, 0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x07, ++0x90, 0xA1, 0x42, 0xE0, 0x54, 0x1F, 0xF0, 0x22, 0xF0, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x77, 0x9E, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0xBC, ++0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA3, 0x23, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x23, 0x12, 0x48, ++0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x38, 0x07, 0x7F, 0x00, ++0x7E, 0x0E, 0x12, 0x37, 0xBC, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA3, 0x23, 0x12, 0x08, 0x6D, ++0x90, 0xA3, 0x23, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0x00, 0x7E, 0x0E, ++0x12, 0x38, 0x07, 0x7F, 0x02, 0x12, 0x4B, 0x24, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x12, 0x4A, ++0x07, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0xA3, 0x23, ++0x12, 0x08, 0x6D, 0x90, 0xA3, 0x23, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, ++0xB4, 0x7E, 0x08, 0x12, 0x38, 0x07, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, ++0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0xA1, 0x26, 0xE0, 0xFF, 0x13, 0x13, 0x13, ++0x54, 0x1F, 0x30, 0xE0, 0x06, 0x90, 0x07, 0x78, 0x74, 0x01, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, ++0x3C, 0x90, 0xA1, 0x65, 0xE0, 0x60, 0x08, 0x90, 0xA3, 0x27, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, ++0x90, 0xA3, 0x27, 0xF0, 0x90, 0xA1, 0x26, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0xE4, ++0x90, 0xA3, 0x28, 0xF0, 0x80, 0x06, 0x90, 0xA3, 0x28, 0x74, 0x02, 0xF0, 0x90, 0xA3, 0x27, 0xE0, ++0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x76, 0x95, 0x90, 0x07, 0x78, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x25, ++0xE0, 0x60, 0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x51, 0x89, 0x90, 0xA1, 0x13, 0x74, ++0x08, 0xF0, 0x90, 0xA1, 0x0C, 0xF0, 0x22, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0x51, 0x88, 0x90, ++0xA1, 0x0B, 0x74, 0x02, 0xF0, 0x22, 0x12, 0x77, 0x98, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, ++0x7F, 0x03, 0x12, 0x65, 0x55, 0x51, 0x8F, 0xE4, 0x90, 0xA1, 0x13, 0xF0, 0x90, 0xA1, 0x0C, 0xF0, ++0x22, 0x90, 0xFD, 0x65, 0xE0, 0x30, 0xE5, 0x1C, 0xE0, 0x90, 0xA2, 0x7F, 0x30, 0xE6, 0x05, 0x74, ++0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0xA2, 0x7F, 0xE0, 0xFF, 0x51, 0x23, 0x90, 0xA1, ++0xAA, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0x42, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, 0x90, ++0xA1, 0x47, 0xE0, 0x90, 0x07, 0x78, 0xF0, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0xE4, 0xFF, ++0xE4, 0xFC, 0x90, 0xA3, 0x33, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x33, 0x12, 0x48, 0xE5, 0x90, 0xA1, ++0x43, 0x12, 0x49, 0x01, 0x12, 0x48, 0xC7, 0x90, 0xA3, 0x33, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x33, ++0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x38, 0x07, ++0x02, 0x86, 0xBC, 0x12, 0x77, 0x4E, 0x90, 0xA1, 0x42, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0xFE, ++0xEF, 0xC3, 0x13, 0x54, 0x0F, 0xC3, 0x9E, 0x40, 0x04, 0x71, 0xE5, 0x80, 0x16, 0x90, 0xA1, 0x42, ++0xE0, 0xFF, 0xC3, 0x13, 0x54, 0x0F, 0xFE, 0xEF, 0x54, 0xE1, 0xFF, 0xEE, 0x04, 0x54, 0x0F, 0x25, ++0xE0, 0x4F, 0xF0, 0x90, 0xA1, 0xA9, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, ++0x06, 0x89, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x9F, 0x96, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, ++0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x9F, 0x97, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFF, 0xED, ++0x2F, 0x90, 0x9F, 0x98, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x9F, ++0x99, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x9F, 0x9A, ++0xF0, 0x22, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, 0xFE, ++0x12, 0x06, 0x89, 0xFD, 0xC3, 0x13, 0x30, 0xE0, 0x12, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x90, ++0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x49, 0xF0, 0x80, 0x05, 0x90, 0xA2, 0x49, 0xEF, 0xF0, ++0x90, 0xA2, 0x48, 0xEE, 0xF0, 0x90, 0xA2, 0x49, 0xE0, 0xFE, 0x90, 0xA2, 0x48, 0xE0, 0xFF, 0xD3, ++0x9E, 0x50, 0x38, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x12, 0x06, 0x89, 0x54, 0x01, 0xFE, 0x74, ++0x87, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x87, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0x70, 0x04, 0xB1, 0x64, 0x80, 0x07, 0x90, 0xA2, 0x48, 0xE0, ++0xFF, 0xB1, 0x53, 0x90, 0xA2, 0x48, 0xE0, 0x04, 0xF0, 0x80, 0xBA, 0x90, 0xA0, 0x87, 0xE0, 0x70, ++0x21, 0x90, 0xA1, 0x13, 0xE0, 0x70, 0x04, 0xFF, 0x12, 0x55, 0x77, 0x90, 0xA1, 0x13, 0xE0, 0x64, ++0x0C, 0x60, 0x02, 0xB1, 0x75, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, 0xF0, 0x54, ++0x7F, 0xF0, 0x22, 0x8F, 0x53, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x49, 0x1D, 0xE0, ++0x54, 0xFB, 0xF0, 0x22, 0x8F, 0x53, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x49, 0x1D, ++0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x05, 0x22, 0xE4, ++0xF0, 0x90, 0xA1, 0x13, 0x74, 0x0C, 0xF0, 0x22, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x12, 0x06, ++0x89, 0xFF, 0x54, 0x7F, 0x90, 0xA1, 0x10, 0xF0, 0xEF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xA3, ++0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0xA1, ++0x0F, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0x54, 0x01, 0x25, 0xE0, ++0xFE, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, ++0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0x90, 0xA1, ++0x12, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x06, 0xA2, 0xFF, 0x54, 0x02, 0xFE, 0x90, 0xA1, 0x26, 0xE0, ++0x54, 0xFD, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xFF, 0xF0, 0x90, ++0x00, 0x05, 0x12, 0x06, 0xA2, 0xFE, 0x54, 0x08, 0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xFF, 0x90, 0xA1, ++0x26, 0xF0, 0xEE, 0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x12, ++0x06, 0xA2, 0xFE, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0x90, 0xA1, 0x26, 0xF0, 0xEE, ++0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0xF0, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, ++0xE0, 0x37, 0xEF, 0xC3, 0x13, 0x20, 0xE0, 0x0E, 0x90, 0xA2, 0x49, 0x74, 0x01, 0xF0, 0x90, 0xA1, ++0x65, 0xE0, 0x60, 0x0D, 0x80, 0x12, 0xE4, 0x90, 0xA2, 0x49, 0xF0, 0x90, 0xA1, 0x65, 0xE0, 0x60, ++0x07, 0xE4, 0x90, 0xA2, 0x48, 0xF0, 0x80, 0x06, 0x90, 0xA2, 0x48, 0x74, 0x01, 0xF0, 0x90, 0xA2, ++0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x76, 0x95, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0xD1, ++0xA6, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0xF0, 0x90, 0xA1, 0x10, 0xE0, 0x90, ++0x01, 0xBA, 0xF0, 0x90, 0xA1, 0x12, 0xE0, 0x90, 0x01, 0xBB, 0xF0, 0x90, 0xA1, 0x0F, 0xE0, 0x54, ++0x0F, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x90, 0xA2, 0x4A, 0x12, 0x49, 0x32, 0xD1, 0xD5, 0x90, 0xA1, ++0x10, 0xE0, 0xFF, 0x12, 0x64, 0xCC, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x18, 0x90, 0xA2, 0x4A, 0x12, ++0x49, 0x29, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x54, 0x0F, 0xFF, 0x90, 0x00, 0x02, 0x12, 0x06, ++0xA2, 0xFD, 0xD1, 0xE6, 0x22, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA1, 0x19, ++0xF0, 0x90, 0xA1, 0x14, 0xF0, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0C, 0x04, 0x70, 0x28, 0x90, 0xA1, ++0x16, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x22, 0xED, 0x70, 0x0A, 0x90, 0xA1, 0x24, 0xE0, 0x90, 0xA1, ++0x16, 0xF0, 0x80, 0x05, 0x90, 0xA1, 0x16, 0xED, 0xF0, 0x90, 0xA1, 0x16, 0xE0, 0xA3, 0xF0, 0x90, ++0xA1, 0x0E, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFF, 0x30, 0xE0, ++0x26, 0x12, 0x06, 0x89, 0x90, 0xA1, 0x21, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0xA1, ++0x22, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xA3, 0xE0, 0x54, 0x01, 0x4F, 0xF0, 0x90, 0x00, 0x03, 0x12, ++0x06, 0xA2, 0x90, 0xA1, 0x24, 0xF0, 0x22, 0x90, 0xA1, 0x21, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, ++0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x22, 0x12, 0x06, 0x89, ++0x90, 0xA1, 0x1A, 0xF0, 0x22, 0x12, 0x06, 0x89, 0x90, 0xA1, 0x27, 0xF0, 0x60, 0x35, 0xA3, 0xE0, ++0x20, 0xE0, 0x30, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x53, 0x5E, 0x90, 0xA1, 0x26, 0xE0, 0xFF, 0xC3, ++0x13, 0x30, 0xE0, 0x1F, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x16, 0x90, 0xA1, 0x26, ++0xE0, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x0D, 0xF0, 0x80, 0x03, ++0x74, 0x09, 0xF0, 0x90, 0xA1, 0x27, 0xE0, 0x90, 0x01, 0xE7, 0xF0, 0x22, 0x90, 0xA3, 0x4B, 0x12, ++0x49, 0x32, 0xE4, 0xFE, 0x90, 0xFD, 0x50, 0xEF, 0xF0, 0x64, 0x30, 0x60, 0x3B, 0xA3, 0xED, 0xF0, ++0xEE, 0xC3, 0x9D, 0x50, 0x1E, 0x90, 0xA3, 0x4B, 0x12, 0x49, 0x29, 0x8E, 0x82, 0x75, 0x83, 0x00, ++0x12, 0x06, 0xA2, 0xFF, 0x74, 0x52, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFD, 0xF5, 0x83, 0xEF, 0xF0, ++0x0E, 0x80, 0xDD, 0xEE, 0xC3, 0x94, 0x06, 0x50, 0x33, 0x74, 0x52, 0x2E, 0xF5, 0x82, 0xE4, 0x34, ++0xFD, 0xF5, 0x83, 0xE4, 0xF0, 0x0E, 0x80, 0xEB, 0xEE, 0xC3, 0x94, 0x07, 0x50, 0x1E, 0x90, 0xA3, ++0x4B, 0x12, 0x49, 0x29, 0x8E, 0x82, 0x75, 0x83, 0x00, 0x12, 0x06, 0xA2, 0xFF, 0x74, 0x51, 0x2E, ++0xF5, 0x82, 0xE4, 0x34, 0xFD, 0xF5, 0x83, 0xEF, 0xF0, 0x0E, 0x80, 0xDC, 0x90, 0xFD, 0x58, 0x74, ++0x01, 0xF0, 0x90, 0xA1, 0x9A, 0xE0, 0x04, 0xF0, 0x90, 0xFD, 0x58, 0xE0, 0x90, 0xA1, 0xAF, 0xF0, ++0x90, 0xFD, 0x50, 0xE0, 0x90, 0xA1, 0xB0, 0xF0, 0x90, 0xFD, 0x51, 0xE0, 0x90, 0xA1, 0xB1, 0xF0, ++0x90, 0xFD, 0x52, 0xE0, 0x90, 0xA1, 0xB2, 0xF0, 0x90, 0xFD, 0x53, 0xE0, 0x90, 0xA1, 0xB3, 0xF0, ++0x90, 0xFD, 0x54, 0xE0, 0x90, 0xA1, 0xB4, 0xF0, 0x90, 0xFD, 0x55, 0xE0, 0x90, 0xA1, 0xB5, 0xF0, ++0x90, 0xFD, 0x56, 0xE0, 0x90, 0xA1, 0xB6, 0xF0, 0x90, 0xFD, 0x57, 0xE0, 0x90, 0xA1, 0xB7, 0xF0, ++0x22, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x90, 0xA3, 0x37, 0xE0, 0x70, 0x13, 0x7F, 0x58, 0x7E, ++0x0C, 0x12, 0x37, 0xBC, 0x90, 0xA1, 0x5D, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x37, 0x74, 0x01, 0xF0, ++0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x12, 0x06, 0x89, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA2, ++0x48, 0x12, 0x08, 0x6D, 0x90, 0xA1, 0x5D, 0x12, 0x48, 0xE5, 0xEC, 0x54, 0xC1, 0xFC, 0xC0, 0x04, ++0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA2, 0x48, 0x12, 0x48, 0xE5, 0x78, 0x19, 0x12, 0x08, ++0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0xC7, 0x90, 0xA1, 0x59, 0x02, ++0x08, 0x6D, 0x12, 0x06, 0x89, 0x90, 0xA1, 0x65, 0xF0, 0x22, 0x12, 0x06, 0x89, 0x90, 0xA1, 0x4B, ++0xF0, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0xA3, 0x4E, 0xF0, 0x90, 0xA3, 0x4E, 0xE0, ++0xFD, 0x70, 0x02, 0x41, 0x96, 0x90, 0x9F, 0xEB, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, ++0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x9F, 0xEC, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, ++0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0xA3, 0x38, ++0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, ++0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x41, 0x8F, 0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, ++0x90, 0x01, 0xD0, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA3, 0x4F, 0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, ++0xA3, 0x75, 0x42, 0x4F, 0x75, 0x43, 0x01, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x50, 0x12, 0x34, 0x62, ++0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x90, ++0x9F, 0xEC, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0x9F, 0x9B, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, ++0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD1, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, ++0x08, 0xEE, 0x90, 0x9F, 0x9C, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, ++0x04, 0x90, 0x01, 0xD2, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x9F, 0x9D, ++0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD3, 0x12, ++0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x9F, 0x9E, 0x12, 0x49, 0x1D, 0xEF, 0xF0, ++0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF0, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, ++0xF0, 0x08, 0xEE, 0x90, 0x9F, 0x9F, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, 0xA3, 0x38, 0xE0, 0x75, ++0xF0, 0x04, 0x90, 0x01, 0xF1, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x9F, ++0xA0, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF2, ++0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x9F, 0xA1, 0x12, 0x49, 0x1D, 0xEF, ++0xF0, 0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF3, 0x12, 0x49, 0x1D, 0xE0, 0xFF, ++0x75, 0xF0, 0x08, 0xEE, 0x90, 0x9F, 0xA2, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, 0xA3, 0x4E, 0xE0, ++0xFF, 0x90, 0xA3, 0x38, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, ++0xFC, 0xF4, 0x5F, 0x90, 0xA3, 0x4E, 0xF0, 0x90, 0xA3, 0x38, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, ++0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0xA3, 0x38, 0xE0, 0x04, ++0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0x9F, 0xEC, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, ++0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x01, 0xEC, 0xE4, 0x90, 0x9F, 0xEC, 0xF0, 0x01, 0xEC, 0x90, ++0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0xE4, 0x90, 0xA0, 0x83, 0xF0, 0xA3, 0xF0, 0x90, 0x9F, ++0xEB, 0xF0, 0xA3, 0xF0, 0x22, 0x51, 0xB8, 0x51, 0x97, 0x91, 0x2F, 0x71, 0x0A, 0x51, 0xE5, 0x71, ++0x5D, 0x51, 0xBE, 0x51, 0xD0, 0x02, 0x77, 0xE6, 0xE4, 0x90, 0xA0, 0x87, 0xF0, 0x22, 0x90, 0xA1, ++0x6F, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, ++0x90, 0xA1, 0x72, 0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, ++0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0xA1, 0x08, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, ++0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0xE4, 0xA3, ++0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x0C, 0xF0, 0x22, 0xE4, 0xF5, 0x51, 0xE4, 0xF5, 0x52, ++0xE5, 0x52, 0xB4, 0x03, 0x1E, 0xFF, 0xE5, 0x51, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, ++0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x74, 0x40, ++0xF0, 0x80, 0x1B, 0xE5, 0x51, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, ++0x83, 0xE5, 0x82, 0x25, 0x52, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x05, 0x52, ++0xE5, 0x52, 0xB4, 0x10, 0xBB, 0x05, 0x51, 0xE5, 0x51, 0xB4, 0x08, 0xB1, 0x22, 0xE4, 0x90, 0xA1, ++0x10, 0xF0, 0xA3, 0xF0, 0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, 0xF0, 0x90, 0xA1, ++0x0D, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0xA1, 0x16, 0x74, 0x01, 0xF0, 0xA3, 0xF0, ++0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA1, 0x19, ++0xF0, 0x90, 0xA1, 0x18, 0x74, 0x07, 0xF0, 0x90, 0xA1, 0x1B, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF0, ++0xE4, 0x90, 0xA1, 0x14, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA1, 0x12, 0x74, ++0x0C, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0xA1, 0x13, 0x74, 0x0C, 0xF0, 0x90, ++0xA1, 0x0D, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, ++0xF0, 0x54, 0xF7, 0xF0, 0x90, 0xA1, 0x1D, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x90, 0x9F, ++0x95, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0xA1, 0x1A, 0x74, 0xFF, 0xF0, 0x80, 0x12, 0x90, 0x9F, 0x95, ++0xE0, 0x90, 0xA1, 0x1A, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x41, 0xF0, 0x90, ++0xA1, 0x21, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, ++0xA3, 0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, ++0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xE4, ++0x90, 0xA2, 0x3A, 0xF0, 0xE4, 0x90, 0xA2, 0x3B, 0xF0, 0x90, 0xA2, 0x3B, 0xE0, 0xFF, 0xC3, 0x94, ++0x10, 0x50, 0x75, 0x90, 0xA2, 0x3A, 0xE0, 0xFE, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, ++0x83, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x90, 0xA2, 0x3B, 0xB4, 0x03, 0x1B, 0xE0, 0xFF, 0x75, 0xF0, ++0x10, 0xEE, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, ++0xF5, 0x83, 0x74, 0x80, 0xF0, 0x80, 0x1B, 0xE0, 0xFF, 0x90, 0xA2, 0x3A, 0xE0, 0x75, 0xF0, 0x10, ++0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, ++0xE4, 0xF0, 0x90, 0xA2, 0x3B, 0xE0, 0xFF, 0x90, 0xA2, 0x3A, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, ++0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, ++0x90, 0xA2, 0x3B, 0xE0, 0x04, 0xF0, 0x80, 0x81, 0x90, 0xA2, 0x3A, 0xE0, 0x04, 0xF0, 0xE0, 0x64, ++0x80, 0x60, 0x02, 0x81, 0x34, 0xE4, 0x90, 0xAD, 0xE2, 0xF0, 0x90, 0xA2, 0x3A, 0xF0, 0x90, 0xA2, ++0x3A, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, ++0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x03, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, ++0x0A, 0xEF, 0x90, 0x8D, 0x05, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, ++0x90, 0x8D, 0x07, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, ++0x09, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, ++0xF5, 0x83, 0x74, 0x3F, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE4, ++0xF0, 0x74, 0x92, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x74, 0xC0, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x01, 0xF5, ++0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0x98, 0xF5, 0x83, 0xE4, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, ++0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9C, ++0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x92, 0x12, 0x49, 0x1D, ++0x74, 0x3F, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x93, 0x12, 0x49, 0x1D, 0x74, 0x03, 0xF0, ++0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xE0, 0x44, 0x09, 0xF0, ++0x90, 0xA2, 0x3A, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, ++0xF3, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xFC, 0xF0, ++0x90, 0xA2, 0x3A, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0x44, ++0x20, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xCF, 0xF0, ++0x90, 0xA2, 0x3A, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x44, ++0x40, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0x7F, 0xF0, ++0x90, 0xA2, 0x3A, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x92, 0x12, 0x49, 0x1D, 0xE0, 0xFE, ++0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xEE, 0xF0, 0x90, 0xA2, 0x3A, 0xE0, ++0xFF, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x74, 0x92, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0x3A, 0xE0, 0x04, 0xF0, 0xE0, ++0x64, 0x80, 0x60, 0x02, 0x81, 0xCE, 0xE4, 0x90, 0xA2, 0x3C, 0xF0, 0x90, 0xA2, 0x3C, 0xE0, 0xFF, ++0xC3, 0x94, 0x20, 0x50, 0x14, 0x74, 0x78, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE4, ++0xF0, 0x90, 0xA2, 0x3C, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x90, 0x04, 0x49, 0x74, 0xF0, 0xF0, 0xA3, ++0xE4, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0x33, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, 0xF0, ++0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0x90, 0xA2, 0x3A, 0xE0, 0x24, 0x92, 0xF5, ++0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0xA3, 0x3B, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xA3, ++0x3B, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, 0x2D, 0xC3, 0x90, 0xA3, 0x3E, ++0xE0, 0x94, 0xE8, 0x90, 0xA3, 0x3D, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, ++0x80, 0xF0, 0x7F, 0x00, 0x80, 0x15, 0x90, 0xA3, 0x3D, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, ++0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x80, 0xC5, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x43, 0x12, 0x49, 0x32, 0x7F, 0x96, 0x7E, ++0x02, 0xD1, 0xAA, 0xEF, 0x60, 0x59, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, ++0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0xA3, ++0x46, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0xA3, 0x46, 0xE0, 0xFD, 0x90, 0x02, ++0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA3, 0x43, 0x12, 0x49, 0x29, 0x90, 0x00, 0x0E, 0x12, 0x06, ++0xA2, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0xF1, 0xC4, 0x90, 0xA3, 0x46, 0xE0, 0x24, 0x18, 0xFF, ++0x90, 0xA3, 0x43, 0x12, 0x49, 0x29, 0x12, 0x98, 0x1F, 0x90, 0x02, 0x96, 0x74, 0x01, 0xF0, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA2, 0xE5, ++0xF0, 0x90, 0x01, 0xC7, 0xE0, 0x64, 0xAD, 0x70, 0x36, 0xF0, 0x90, 0xA2, 0xF2, 0x74, 0x0F, 0xF0, ++0x90, 0xA2, 0xE4, 0x74, 0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0xA2, 0xE5, 0xE0, 0x2F, 0xFE, ++0x74, 0xE6, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x0F, ++0xE9, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0xE4, 0xF1, 0x00, 0xD0, ++0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, ++0x83, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xEE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, ++0xF5, 0x83, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, ++0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, ++0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, ++0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, ++0xA3, 0x3F, 0xEF, 0xF0, 0xA3, 0x12, 0x49, 0x32, 0x90, 0xA3, 0x39, 0xE0, 0xFE, 0x04, 0xF0, 0x90, ++0x00, 0x01, 0xEE, 0x12, 0x06, 0xE1, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, ++0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0xA3, 0x40, 0x12, 0x49, 0x29, 0x8B, 0x40, 0x8A, 0x41, ++0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x90, 0xA3, ++0x3F, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, ++0x01, 0xA3, 0x12, 0x49, 0x29, 0xE9, 0x24, 0x02, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, ++0x42, 0x90, 0xA3, 0x40, 0x12, 0x49, 0x29, 0x90, 0x00, 0x0E, 0x12, 0x06, 0xA2, 0xF5, 0x43, 0xD0, ++0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x62, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, ++0xA2, 0x42, 0x12, 0x49, 0x32, 0x90, 0xA3, 0x3A, 0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, ++0x12, 0x06, 0xE1, 0x7F, 0xAF, 0x7E, 0x01, 0x12, 0x96, 0xAA, 0xEF, 0x60, 0x3A, 0x90, 0xA2, 0x42, ++0x12, 0x49, 0x29, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x90, 0x00, 0x0E, 0x12, 0x06, 0xA2, 0x24, ++0x02, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x34, 0x62, 0x90, 0xA2, 0x42, 0x12, ++0x49, 0x29, 0x90, 0x00, 0x0E, 0x12, 0x06, 0xA2, 0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, ++0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA0, 0x84, 0xE0, 0xFE, 0x90, 0xA0, 0x83, 0xE0, 0xFD, 0xB5, ++0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, 0x49, 0x90, 0x01, 0xAF, ++0xE0, 0x70, 0x13, 0xED, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xED, 0xF9, 0x74, 0x9F, 0x35, 0xF0, 0xFA, ++0x7B, 0x01, 0x11, 0x98, 0x7F, 0x01, 0x90, 0xA0, 0x83, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xED, ++0xF9, 0x74, 0x9F, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x12, 0x97, 0x00, 0x7F, 0x01, 0xEF, 0x60, 0x16, ++0x90, 0xA0, 0x83, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, ++0x05, 0xE4, 0x90, 0xA0, 0x83, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, ++0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, ++0x01, 0x9A, 0xE0, 0x54, 0xC0, 0xF0, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x01, 0x99, ++0xE0, 0x44, 0xC0, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x80, 0xF0, 0x22, 0x90, 0x01, 0x9A, 0xE0, 0x54, ++0xC0, 0x44, 0x0B, 0xF0, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x01, 0x98, 0xE0, 0x54, ++0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0xA2, 0x3A, 0xF0, 0xA3, 0xF0, ++0x31, 0x9B, 0xEF, 0x64, 0x01, 0x60, 0x45, 0xC3, 0x90, 0xA2, 0x3B, 0xE0, 0x94, 0x88, 0x90, 0xA2, ++0x3A, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, ++0x74, 0x03, 0xF0, 0x80, 0x27, 0x90, 0xA2, 0x3A, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x7F, ++0x14, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xD3, 0x90, 0xA2, 0x3B, 0xE0, 0x94, 0x32, 0x90, 0xA2, 0x3A, ++0xE0, 0x94, 0x00, 0x40, 0xBB, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB4, 0x90, 0x01, 0xC7, 0x74, ++0x05, 0xF0, 0x22, 0x7F, 0x02, 0x90, 0xA1, 0x6E, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, ++0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, ++0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x9F, 0x92, 0xF0, 0xA3, ++0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x0B, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, ++0x34, 0xE0, 0x55, 0x15, 0xF5, 0x19, 0xA3, 0xE0, 0x55, 0x16, 0xF5, 0x1A, 0xA3, 0xE0, 0x55, 0x17, ++0xF5, 0x1B, 0xA3, 0xE0, 0x55, 0x18, 0xF5, 0x1C, 0x90, 0x01, 0x34, 0xE5, 0x19, 0xF0, 0xA3, 0xE5, ++0x1A, 0xF0, 0xA3, 0xE5, 0x1B, 0xF0, 0xA3, 0xE5, 0x1C, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, ++0x1D, 0xF5, 0x21, 0xA3, 0xE0, 0x55, 0x1E, 0xF5, 0x22, 0xA3, 0xE0, 0x55, 0x1F, 0xF5, 0x23, 0xA3, ++0xE0, 0x55, 0x20, 0xF5, 0x24, 0x90, 0x01, 0x3C, 0xE5, 0x21, 0xF0, 0xA3, 0xE5, 0x22, 0xF0, 0xA3, ++0xE5, 0x23, 0xF0, 0xA3, 0xE5, 0x24, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0xA1, 0x08, 0xE0, 0x30, ++0xE0, 0x05, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0xA0, 0x87, 0xE0, 0x64, 0x01, 0x70, 0x2A, ++0x90, 0xA1, 0x10, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, ++0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x22, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, ++0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x22, 0x90, 0xA0, 0x87, 0xE0, 0x64, ++0x01, 0x70, 0x26, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x20, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, ++0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA1, 0x14, 0xE0, 0x54, ++0xFD, 0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x53, 0x43, 0x22, 0x90, 0xA0, 0x87, 0xE0, 0xB4, 0x01, ++0x14, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x0E, 0x90, 0xA1, 0x14, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x07, ++0x70, 0x03, 0x12, 0x53, 0x43, 0x22, 0x90, 0xA1, 0x10, 0xE0, 0x70, 0x07, 0x90, 0xA1, 0x08, 0xE0, ++0x30, 0xE0, 0x12, 0x90, 0xA1, 0x08, 0xE0, 0x30, 0xE0, 0x08, 0x12, 0x57, 0xEC, 0xBF, 0x01, 0x05, ++0x80, 0x04, 0x12, 0x55, 0xEE, 0x22, 0x90, 0xA1, 0x10, 0xE0, 0x64, 0x02, 0x60, 0x14, 0x90, 0xA1, ++0x0F, 0xE0, 0x54, 0x0F, 0x60, 0x0C, 0x12, 0x57, 0xF8, 0xEF, 0x70, 0x06, 0xFD, 0x7F, 0x0C, 0x12, ++0x53, 0x5E, 0x22, 0x90, 0xA1, 0x8C, 0xE0, 0x04, 0xF0, 0xE4, 0xFF, 0x90, 0xA1, 0xB9, 0xEF, 0xF0, ++0xE4, 0xF5, 0x69, 0x74, 0xBA, 0x25, 0x69, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE4, 0xF0, ++0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x03, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x30, 0xE7, 0x10, ++0xE5, 0x69, 0x70, 0x1E, 0xEF, 0x30, 0xE6, 0x1A, 0x90, 0xA1, 0x89, 0xE0, 0x04, 0xF0, 0x80, 0x12, ++0xAF, 0x69, 0xB1, 0x45, 0x74, 0xBA, 0x25, 0x69, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0x74, ++0x01, 0xF0, 0x05, 0x69, 0xE5, 0x69, 0xC3, 0x94, 0x80, 0x40, 0xB8, 0x7F, 0x0C, 0x7E, 0x00, 0x12, ++0x3D, 0x7A, 0xE4, 0xF5, 0x69, 0x74, 0xBA, 0x25, 0x69, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, ++0xE0, 0x70, 0x02, 0xA1, 0x39, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x06, 0x12, 0x49, 0x1D, ++0xE0, 0xF5, 0x67, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x07, 0x12, 0x49, 0x1D, 0xE0, 0xF5, ++0x68, 0xFE, 0xE5, 0x67, 0xFF, 0xE5, 0x69, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, ++0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x0A, 0x12, ++0x49, 0x1D, 0xE0, 0xF5, 0x67, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x0B, 0x12, 0x49, 0x1D, ++0xE0, 0xF5, 0x68, 0xFE, 0xE5, 0x67, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x69, 0x90, 0x8D, 0x01, 0x12, ++0x49, 0x1D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x0C, 0x12, ++0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x69, 0x90, 0x8D, 0x03, 0x12, 0x49, 0x1D, 0xE4, ++0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x0D, 0x12, 0x49, 0x1D, 0xE0, ++0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x69, 0x90, 0x8D, 0x05, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xEF, ++0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x0E, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, ++0x0A, 0xE5, 0x69, 0x90, 0x8D, 0x07, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, ++0x10, 0xE5, 0x69, 0x90, 0x81, 0x0F, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x69, ++0x90, 0x8D, 0x09, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x69, ++0x90, 0x81, 0x09, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x74, 0x12, 0x25, 0x69, 0xF5, 0x82, 0xE4, 0x34, ++0x98, 0xF5, 0x83, 0xEF, 0xF0, 0xE5, 0x69, 0x70, 0x56, 0xE5, 0x68, 0x30, 0xE7, 0x05, 0x90, 0xA1, ++0x88, 0x80, 0x49, 0xE5, 0x68, 0x30, 0xE6, 0x05, 0x90, 0xA1, 0x87, 0x80, 0x3F, 0xE5, 0x68, 0x30, ++0xE5, 0x05, 0x90, 0xA1, 0x86, 0x80, 0x35, 0xE5, 0x68, 0x30, 0xE4, 0x05, 0x90, 0xA1, 0x85, 0x80, ++0x2B, 0xE5, 0x68, 0x30, 0xE3, 0x05, 0x90, 0xA1, 0x84, 0x80, 0x21, 0xE5, 0x68, 0x30, 0xE2, 0x05, ++0x90, 0xA1, 0x83, 0x80, 0x17, 0xE5, 0x68, 0x30, 0xE1, 0x05, 0x90, 0xA1, 0x82, 0x80, 0x0D, 0xE5, ++0x68, 0x30, 0xE0, 0x05, 0x90, 0xA1, 0x81, 0x80, 0x03, 0x90, 0xA1, 0x80, 0xE0, 0x04, 0xF0, 0x90, ++0xA1, 0xB9, 0xE0, 0xFD, 0xAF, 0x69, 0x12, 0x6E, 0xA6, 0x05, 0x69, 0xE5, 0x69, 0xC3, 0x94, 0x80, ++0x50, 0x02, 0x61, 0xD5, 0x22, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x03, 0x12, 0x49, 0x1D, 0xE0, ++0x44, 0x40, 0xF0, 0x22, 0x02, 0x5E, 0xEE, 0xB1, 0xA0, 0x90, 0xA2, 0x6E, 0xEF, 0xF0, 0x90, 0xA1, ++0x0D, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA2, ++0x6E, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, ++0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0xA1, 0x1B, ++0xE4, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0x1B, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, ++0xE4, 0x90, 0xA2, 0x6F, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x4B, 0x24, 0x90, 0xA2, ++0x6F, 0xEF, 0xF0, 0x7F, 0x83, 0x12, 0x4B, 0x24, 0xAE, 0x07, 0x90, 0xA2, 0x6F, 0xE0, 0xFF, 0xB5, ++0x06, 0x01, 0x22, 0xC3, 0x90, 0xA2, 0x71, 0xE0, 0x94, 0x64, 0x90, 0xA2, 0x70, 0xE0, 0x94, 0x00, ++0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA2, 0x6F, 0xE0, 0xFF, 0x22, 0x90, ++0xA2, 0x70, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x80, 0xBE, 0x22, 0x90, 0xA1, 0x0D, 0xE0, ++0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x4A, 0xEF, 0x54, 0x7F, 0xF0, 0x90, 0x04, ++0xE0, 0xE0, 0x90, 0xA1, 0x0E, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x0F, 0xE0, 0x54, ++0xFD, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x90, 0xA1, 0x2C, ++0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x11, 0x90, 0xA1, 0x2F, 0xE0, 0xFF, 0xC3, ++0x13, 0x30, 0xE0, 0x07, 0xEF, 0x44, 0x04, 0xF0, 0x54, 0xFD, 0xF0, 0x90, 0xA1, 0x10, 0xE0, 0x60, ++0x03, 0x12, 0x53, 0x43, 0x7F, 0x01, 0x02, 0x56, 0xC2, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x0A, 0x0D, ++0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x1E, ++0x90, 0xFD, 0x11, 0xE0, 0xB5, 0x05, 0x14, 0x90, 0x01, 0x17, 0xE0, 0xB5, 0x05, 0x07, 0x90, 0xFD, ++0x11, 0xE4, 0xF0, 0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, 0x11, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0x8F, ++0x6D, 0xE4, 0x90, 0xA3, 0x5B, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, ++0x02, 0x7F, 0x01, 0xEF, 0x65, 0x6D, 0x60, 0x3E, 0xC3, 0x90, 0xA3, 0x5C, 0xE0, 0x94, 0x88, 0x90, ++0xA3, 0x5B, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, ++0xA3, 0x5B, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3D, 0x7A, ++0xD3, 0x90, 0xA3, 0x5C, 0xE0, 0x94, 0x32, 0x90, 0xA3, 0x5B, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, ++0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB2, 0x22, 0xF1, 0x86, 0x7F, 0x08, 0x12, 0x4B, 0x24, 0xEF, 0x54, ++0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x4A, 0x07, 0xE4, 0xFF, 0x80, 0x94, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0xF1, 0x3D, 0xD1, 0xD7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x13, 0xE0, 0xFF, ++0x60, 0x03, 0xB4, 0x08, 0x0D, 0xF1, 0x9D, 0xBF, 0x01, 0x08, 0xD1, 0xEB, 0x90, 0x01, 0xE5, 0xE0, ++0x04, 0xF0, 0x22, 0x90, 0xA1, 0x0D, 0xE0, 0x30, 0xE0, 0x22, 0x90, 0xA1, 0x08, 0xE0, 0xFF, 0x30, ++0xE0, 0x18, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xF1, 0x90, 0xBF, 0x01, 0x10, 0x80, 0x0A, 0x90, 0xA1, ++0x0C, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x04, 0x80, 0xB1, 0xD1, 0xFB, 0x22, 0x90, 0xA1, 0x1A, ++0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x4A, 0x07, 0x90, 0xA1, 0x11, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, ++0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x7F, ++0x08, 0x12, 0x4B, 0x24, 0xEF, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x4A, 0x07, 0x7F, 0x01, 0xD1, ++0x7F, 0x7F, 0x90, 0x12, 0x4B, 0x24, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x4A, 0x07, 0x7F, ++0x14, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0x7F, 0x90, 0x12, 0x4B, 0x24, 0xEF, 0x20, 0xE0, 0xF7, 0x22, ++0x90, 0xA1, 0x0B, 0xE0, 0x64, 0x02, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x90, 0x02, 0x96, ++0xE0, 0xFF, 0x90, 0x02, 0x87, 0xE0, 0x4F, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, ++0x17, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x08, ++0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x7F, 0x00, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0xF3, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, ++0xA3, 0xED, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0xA2, 0xF6, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x14, ++0x74, 0xF8, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0xF6, 0xE0, ++0x04, 0xF0, 0x80, 0xE2, 0x90, 0xA2, 0xF5, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, 0x12, 0x49, ++0x1D, 0xE0, 0xC4, 0x54, 0x03, 0x90, 0xA3, 0x00, 0xF0, 0x64, 0x01, 0x70, 0x52, 0x90, 0xA2, 0xF5, ++0xE0, 0xFF, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0xF8, 0xF0, ++0x75, 0xF0, 0x08, 0xEF, 0x90, 0x89, 0x01, 0x12, 0x49, 0x1D, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA2, ++0xF9, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xEE, 0x54, 0xF0, 0xA3, 0xF0, 0x90, 0xA2, ++0xF5, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0xFE, 0xF0, ++0x75, 0xF0, 0x08, 0xEF, 0x90, 0x89, 0x03, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0xFF, 0xF0, 0x90, ++0xA3, 0x00, 0xE0, 0xFC, 0xC3, 0x94, 0x02, 0x40, 0x64, 0x90, 0xA2, 0xF5, 0xE0, 0xFE, 0x75, 0xF0, ++0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0xF8, 0xF0, 0x75, 0xF0, 0x08, 0xEE, ++0x90, 0x89, 0x01, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0xF9, 0xF0, 0x90, 0xA2, 0xF5, 0xE0, 0x75, ++0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0xFA, 0xF0, 0x75, 0xF0, 0x08, ++0xEE, 0x90, 0x89, 0x03, 0x12, 0x49, 0x1D, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA2, 0xFB, 0xF0, 0xEE, ++0x54, 0xF0, 0x90, 0xA2, 0xF7, 0xF0, 0xEC, 0xB4, 0x03, 0x0B, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x90, ++0xA2, 0xFF, 0xF0, 0x80, 0x08, 0x90, 0xA2, 0xF7, 0xE0, 0x90, 0xA2, 0xFE, 0xF0, 0xE4, 0x90, 0xA2, ++0xF6, 0xF0, 0x90, 0xA2, 0xF6, 0xE0, 0xFF, 0x24, 0xF8, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, ++0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFE, 0xEF, 0xFD, 0x90, 0xA2, 0xF4, 0xE0, 0x2D, 0xFD, 0x90, 0xA2, ++0xF3, 0xE0, 0x34, 0x00, 0x8D, 0x82, 0xF5, 0x83, 0xE0, 0xFF, 0xEE, 0x5F, 0xD0, 0x82, 0xD0, 0x83, ++0xF0, 0x90, 0xA2, 0xF6, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xC7, 0x90, 0xA2, 0xFD, 0xE0, 0xFF, ++0xC4, 0x54, 0x0F, 0x70, 0x08, 0xA3, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x37, 0x90, 0xA3, 0x00, ++0xE0, 0x64, 0x01, 0x70, 0x2F, 0x90, 0xA2, 0xF9, 0xE0, 0x54, 0x0F, 0xFE, 0x90, 0xA2, 0xF7, 0xF0, ++0xEF, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0xA2, 0xF9, 0xF0, 0x90, 0xA2, 0xFE, 0xE0, 0x90, 0xA2, 0xFA, ++0xF0, 0x90, 0xA2, 0xFF, 0xE0, 0x90, 0xA2, 0xFB, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, ++0xA3, 0x74, 0x80, 0xF0, 0x90, 0xA3, 0x00, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, 0x26, 0xEF, 0x90, ++0xA2, 0xFB, 0xB4, 0x02, 0x08, 0xE0, 0xFF, 0x90, 0xA2, 0xFE, 0xE0, 0x80, 0x0A, 0xE0, 0xFF, 0x90, ++0xA2, 0xFF, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0xFE, 0xEF, 0x4E, 0x90, 0xA2, 0xFB, 0xF0, 0x90, 0xA2, ++0xFF, 0x74, 0x80, 0xF0, 0xE4, 0x90, 0xA2, 0xF6, 0xF0, 0x90, 0xA2, 0xF6, 0xE0, 0xFF, 0x24, 0xF8, ++0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0xA2, 0xF5, 0xE0, 0x75, 0xF0, 0x08, ++0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, ++0xEE, 0xF0, 0x90, 0xA2, 0xF6, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xCD, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0x90, 0xA2, 0x54, 0xEF, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0xD1, 0xF0, 0x74, 0xA1, 0xA3, 0xF0, ++0x90, 0xA2, 0x54, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0xB4, ++0xBE, 0x02, 0x7F, 0x3F, 0xEF, 0xB4, 0xB3, 0x02, 0x7F, 0x34, 0x90, 0xA2, 0x55, 0xEF, 0xF0, 0xE4, ++0x90, 0xA2, 0x5B, 0xF0, 0x90, 0xA2, 0x55, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xA3, 0xF0, 0xEF, 0x54, ++0x80, 0xA3, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x92, 0x12, 0x49, ++0x1D, 0xE0, 0x90, 0xA2, 0x59, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, ++0xE0, 0xFF, 0xC4, 0x54, 0x03, 0x90, 0xA2, 0x5A, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x42, 0x41, ++0x12, 0x49, 0x1D, 0x12, 0x48, 0xF1, 0xAD, 0x07, 0x90, 0xA2, 0x54, 0xE0, 0xFB, 0x25, 0xE0, 0x24, ++0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xED, 0xF0, 0x75, 0xF0, 0x04, ++0xEB, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0xFE, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA2, 0x58, ++0xF0, 0x74, 0x92, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x30, 0xE0, 0x40, 0x90, ++0xA2, 0x56, 0xE0, 0x64, 0x3F, 0x70, 0x38, 0x74, 0x3E, 0xF0, 0x75, 0xF0, 0x04, 0xEB, 0x90, 0x95, ++0x94, 0x12, 0x49, 0x1D, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0xA2, 0x55, 0x74, ++0xBE, 0xF0, 0x80, 0x08, 0x90, 0xA2, 0x56, 0xE0, 0x90, 0xA2, 0x55, 0xF0, 0xAF, 0x03, 0x90, 0xA2, ++0x55, 0xE0, 0xFD, 0x90, 0xA2, 0x58, 0xE0, 0x90, 0xA3, 0x04, 0xF0, 0xE4, 0xFB, 0xE1, 0x71, 0x90, ++0xA2, 0x59, 0xE0, 0xFF, 0x90, 0xA2, 0x56, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0xC1, 0xDC, 0xE0, 0xFF, ++0x90, 0xA2, 0x54, 0xE0, 0xFE, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xEF, 0xF0, ++0xEF, 0x64, 0x2C, 0x70, 0x35, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, ++0xFF, 0x54, 0x03, 0xFE, 0x90, 0xA2, 0x58, 0xE0, 0x6E, 0x60, 0x1F, 0xE0, 0x04, 0xF0, 0xE0, 0x54, ++0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0x90, 0xA2, 0x54, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, ++0x12, 0x49, 0x1D, 0xEF, 0x54, 0xF3, 0x4E, 0xF0, 0xC1, 0xD6, 0x90, 0xA2, 0x56, 0xE0, 0xFF, 0xC3, ++0x94, 0x0C, 0x40, 0x1F, 0xEF, 0x94, 0x13, 0x50, 0x1A, 0x90, 0xA2, 0x54, 0xE0, 0xFF, 0x24, 0x92, ++0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0xFE, 0x20, 0xE3, 0x07, 0x90, 0xA2, 0x5B, 0x74, ++0x01, 0x80, 0x27, 0x90, 0xA2, 0x56, 0xE0, 0xFF, 0xC3, 0x94, 0x2C, 0x40, 0x2E, 0xEF, 0x94, 0x35, ++0x50, 0x29, 0x90, 0xA2, 0x54, 0xE0, 0xFF, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, ++0xE0, 0xFE, 0x20, 0xE3, 0x16, 0x90, 0xA2, 0x5B, 0x74, 0x02, 0xF0, 0x74, 0x92, 0x2F, 0xF5, 0x82, ++0xE4, 0x34, 0x99, 0xF5, 0x83, 0xEE, 0x44, 0x08, 0xF0, 0x80, 0x16, 0xE4, 0x90, 0xA2, 0x5B, 0xF0, ++0x90, 0xA2, 0x54, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x54, 0xF7, ++0xF0, 0x90, 0xA2, 0x5B, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x81, 0x81, 0x90, 0xA2, 0x54, 0xE0, 0x75, ++0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0x1D, 0xE0, 0x20, 0xE7, 0x1C, 0x20, 0xE6, 0x19, 0x20, ++0xE5, 0x16, 0x20, 0xE4, 0x13, 0x90, 0xA2, 0x54, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x12, ++0x49, 0x1D, 0xE0, 0x20, 0xE0, 0x02, 0x81, 0x81, 0x90, 0xA2, 0x54, 0xE0, 0xFF, 0x24, 0x92, 0xF5, ++0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0xA2, 0x56, 0xE0, 0xFE, 0xB4, ++0x0C, 0x0C, 0x74, 0x14, 0xF0, 0x90, 0xA2, 0x55, 0xF0, 0x74, 0x12, 0x2F, 0x80, 0x14, 0xEE, 0xB4, ++0x0D, 0x1C, 0x90, 0xA2, 0x56, 0x74, 0x15, 0xF0, 0x90, 0xA2, 0x55, 0xF0, 0x90, 0xA2, 0x54, 0xE0, ++0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x80, 0x5F, 0x90, 0xA2, ++0x56, 0xE0, 0xFF, 0xB4, 0x0E, 0x04, 0x74, 0x15, 0x80, 0x09, 0xEF, 0xB4, 0x0F, 0x1C, 0x90, 0xA2, ++0x56, 0x74, 0x16, 0xF0, 0x90, 0xA2, 0x55, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0x24, 0x12, 0xF5, 0x82, ++0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0x03, 0xF0, 0x80, 0x33, 0x90, 0xA2, 0x56, 0xE0, 0xFF, 0xC3, ++0x94, 0x10, 0x40, 0x04, 0x74, 0x17, 0x80, 0x10, 0xEF, 0xC3, 0x94, 0x11, 0x40, 0x1F, 0x90, 0xA2, ++0x56, 0xE0, 0x94, 0x13, 0x50, 0x17, 0x74, 0x18, 0xF0, 0x90, 0xA2, 0x55, 0xF0, 0x90, 0xA2, 0x54, ++0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0x02, 0xF0, 0x90, 0xA2, 0x54, ++0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA2, 0x58, 0xE0, 0x90, 0xA3, 0x04, 0xF0, 0x7B, 0x01, 0xE1, ++0x71, 0x90, 0xA2, 0x5B, 0xE0, 0x64, 0x02, 0x60, 0x02, 0xA1, 0x25, 0x90, 0xA2, 0x54, 0xE0, 0x75, ++0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0x1D, 0xE0, 0x20, 0xE6, 0x1A, 0x20, 0xE7, 0x17, 0x90, ++0xA2, 0x54, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x12, 0x49, 0x1D, 0xE0, 0x20, 0xE0, 0x06, ++0x20, 0xE1, 0x03, 0x30, 0xE2, 0x6F, 0x90, 0xA2, 0x56, 0xE0, 0xFF, 0x64, 0x2C, 0x60, 0x04, 0xEF, ++0xB4, 0x2D, 0x07, 0x90, 0xA2, 0x56, 0x74, 0x36, 0x80, 0x42, 0xEF, 0x64, 0x2E, 0x60, 0x04, 0xEF, ++0xB4, 0x2F, 0x07, 0x90, 0xA2, 0x56, 0x74, 0x37, 0x80, 0x32, 0xEF, 0xB4, 0x30, 0x07, 0x90, 0xA2, ++0x56, 0x74, 0x38, 0x80, 0x27, 0xEF, 0xB4, 0x31, 0x07, 0x90, 0xA2, 0x56, 0x74, 0x39, 0x80, 0x1C, ++0xEF, 0xC3, 0x94, 0x32, 0x40, 0x0D, 0xEF, 0xD3, 0x94, 0x34, 0x50, 0x07, 0x90, 0xA2, 0x56, 0x74, ++0x3A, 0x80, 0x09, 0xEF, 0xB4, 0x35, 0x0A, 0x90, 0xA2, 0x56, 0x74, 0x3B, 0xF0, 0x90, 0xA2, 0x55, ++0xF0, 0x90, 0xA2, 0x54, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA2, 0x58, 0xE0, 0x90, 0xA3, 0x04, ++0xF0, 0x7B, 0x01, 0xE1, 0x71, 0x90, 0xA2, 0x54, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, ++0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA2, 0x5A, 0xE0, 0xFF, 0xB4, 0x01, 0x0F, 0x90, 0xA2, ++0x56, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE0, 0xF0, 0x80, 0x27, 0xEF, 0xB4, 0x02, ++0x0F, 0x90, 0xA2, 0x56, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, ++0x90, 0xA2, 0x5A, 0xE0, 0xB4, 0x03, 0x0D, 0x90, 0xA2, 0x56, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, ++0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA2, 0x5A, 0xE0, 0xFF, 0xB4, 0x01, 0x0F, 0x90, 0xA2, 0x59, 0xE0, ++0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE0, 0xF0, 0x80, 0x27, 0xEF, 0xB4, 0x02, 0x0F, 0x90, ++0xA2, 0x59, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, 0x90, 0xA2, ++0x5A, 0xE0, 0xB4, 0x03, 0x0D, 0x90, 0xA2, 0x59, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, ++0xDE, 0xF0, 0x90, 0xA2, 0x56, 0xE0, 0x04, 0xFD, 0x90, 0xA2, 0x59, 0xE0, 0xFF, 0xED, 0xD3, 0x9F, ++0x40, 0x02, 0xC1, 0x48, 0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0x90, 0xA2, 0x54, 0xE0, 0xFC, ++0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, ++0x83, 0xF5, 0x83, 0xE0, 0xFB, 0x7A, 0x00, 0xED, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, ++0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5A, 0xFE, 0xEF, ++0x5B, 0x4E, 0x60, 0x41, 0x74, 0x12, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0x90, ++0xA2, 0x56, 0xB4, 0x13, 0x28, 0x74, 0x18, 0xF0, 0x90, 0xA2, 0x55, 0xF0, 0x90, 0xA2, 0x54, 0xE0, ++0xFF, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x44, 0x04, 0xF0, 0x74, 0x12, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x80, 0x0B, 0xED, 0xF0, 0x90, ++0xA2, 0x55, 0xF0, 0x80, 0x03, 0x0D, 0xA1, 0xB8, 0x90, 0xA2, 0x5A, 0xE0, 0xFF, 0xB4, 0x01, 0x1A, ++0x90, 0xA2, 0x55, 0xE0, 0xFE, 0xD3, 0x94, 0x0B, 0x40, 0x10, 0xEE, 0x94, 0x34, 0x50, 0x0B, 0xE0, ++0x24, 0x20, 0xF0, 0xA3, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x31, 0xEF, 0xB4, 0x02, 0x14, 0x90, 0xA2, ++0x55, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x0B, 0xE0, 0x24, 0x18, 0xF0, 0xA3, 0xE0, 0x24, 0x18, 0xF0, ++0x80, 0x19, 0x90, 0xA2, 0x5A, 0xE0, 0xB4, 0x03, 0x12, 0x90, 0xA2, 0x55, 0xE0, 0xD3, 0x94, 0x1B, ++0x40, 0x09, 0xE0, 0x24, 0x22, 0xF0, 0xA3, 0xE0, 0x24, 0x22, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0xFF, ++0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x20, 0xE0, 0x02, 0xE1, 0x5F, 0x90, ++0xA2, 0x56, 0xE0, 0x64, 0x3F, 0x60, 0x02, 0xE1, 0x5F, 0x74, 0x3E, 0xF0, 0x75, 0xF0, 0x04, 0xEF, ++0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0xA2, ++0x55, 0x74, 0xBE, 0xF0, 0xE1, 0x5F, 0x90, 0xA2, 0x56, 0xE0, 0x80, 0x7F, 0x90, 0xA2, 0x59, 0xE0, ++0xFF, 0x90, 0xA2, 0x56, 0xE0, 0xFE, 0x6F, 0x70, 0x57, 0x90, 0xA2, 0x55, 0xE0, 0xFF, 0x90, 0xA2, ++0x54, 0xE0, 0xFD, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xEF, 0xF0, 0x75, 0xF0, ++0x04, 0xED, 0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0xFD, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, ++0x09, 0xEF, 0x20, 0xE7, 0x05, 0xEE, 0x44, 0x80, 0x80, 0x41, 0x90, 0xA2, 0x56, 0xE0, 0x75, 0xF0, ++0x04, 0x90, 0x42, 0x41, 0x12, 0x49, 0x1D, 0x12, 0x48, 0xF1, 0x90, 0xA2, 0x54, 0xE0, 0x25, 0xE0, ++0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x80, 0x34, ++0x90, 0xA2, 0x59, 0xE0, 0xFF, 0x90, 0xA2, 0x54, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, ++0xF5, 0x83, 0xEF, 0xF0, 0x90, 0xA2, 0x56, 0xEF, 0xF0, 0x54, 0x80, 0x90, 0xA2, 0x55, 0xF0, 0x90, ++0xA2, 0x54, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA2, 0x58, 0xE0, 0x90, 0xA3, 0x04, 0xF0, 0x7B, ++0x01, 0x12, 0x69, 0x1C, 0x90, 0xA2, 0x55, 0xE0, 0xFF, 0x22, 0x7D, 0x01, 0xAF, 0x53, 0x8F, 0x5E, ++0xAC, 0x05, 0x90, 0x01, 0xC4, 0x74, 0x7E, 0xF0, 0x74, 0xA7, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xE5, ++0x5E, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x90, 0xA2, 0x55, 0xF0, 0xBF, 0xBE, 0x03, ++0x74, 0x3F, 0xF0, 0x90, 0xA2, 0x55, 0xE0, 0xB4, 0xB3, 0x03, 0x74, 0x34, 0xF0, 0x90, 0xA2, 0x55, ++0xE0, 0x54, 0x7F, 0x90, 0xA2, 0x54, 0xF0, 0x54, 0x7F, 0xF9, 0x90, 0xA2, 0x5A, 0xF0, 0x75, 0xF0, ++0x04, 0xE5, 0x5E, 0x90, 0x95, 0x93, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0x5C, 0xF0, 0x75, 0xF0, ++0x04, 0xE5, 0x5E, 0x90, 0x95, 0x92, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0x5D, 0xF0, 0xFA, 0x75, ++0xF0, 0x10, 0xE5, 0x5E, 0x90, 0x81, 0x05, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0x03, 0x90, 0xA2, 0x56, ++0xF0, 0x90, 0xA2, 0x5A, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x91, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, ++0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE5, 0x5E, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, ++0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x5E, 0x90, ++0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0xC4, 0x54, 0x03, 0x90, 0xA2, 0x57, 0xF0, 0x74, 0x12, 0x25, ++0x5E, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xEB, 0xF0, 0xE9, 0xD3, 0x9A, 0x40, 0x0C, 0x90, ++0xA2, 0x5D, 0xE0, 0x90, 0xA2, 0x5A, 0xF0, 0x90, 0xA2, 0x54, 0xF0, 0xEC, 0x70, 0x02, 0x41, 0x69, ++0x90, 0xA2, 0x5B, 0xEC, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0x30, 0xE7, 0x0E, 0x90, 0xA2, 0x5A, 0xE0, ++0x90, 0xA2, 0x54, 0xF0, 0x90, 0xA2, 0x5B, 0xE0, 0x14, 0xF0, 0x90, 0xA2, 0x5B, 0xE0, 0x70, 0x02, ++0x41, 0x69, 0x90, 0xA2, 0x5A, 0xE0, 0xFC, 0x64, 0x2C, 0x70, 0x38, 0x75, 0xF0, 0x04, 0xE5, 0x5E, ++0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0xFD, 0x54, 0x03, 0xFF, 0x90, 0xA2, 0x56, 0xE0, 0x6F, ++0x60, 0x21, 0xE0, 0x14, 0xF0, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x75, 0xF0, 0x04, ++0xE5, 0x5E, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xED, 0x54, 0xF3, 0x4F, 0xF0, 0x90, 0xA2, 0x5B, ++0xE0, 0x14, 0xF0, 0x90, 0xA2, 0x5B, 0xE0, 0x70, 0x02, 0x41, 0x69, 0x90, 0xA2, 0x5C, 0xE0, 0xFD, ++0xEC, 0xD3, 0x9D, 0x50, 0x02, 0x41, 0x61, 0xE4, 0x90, 0xA2, 0x59, 0xF0, 0x90, 0xA2, 0x57, 0xE0, ++0xFE, 0xB4, 0x01, 0x16, 0x90, 0xA2, 0x5A, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x0D, 0xE0, 0x24, 0xE0, ++0xF0, 0x90, 0xA2, 0x54, 0xE0, 0x24, 0xE0, 0xF0, 0x80, 0x35, 0xEE, 0xB4, 0x02, 0x16, 0x90, 0xA2, ++0x5A, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x0D, 0xE0, 0x24, 0xE8, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0x24, ++0xE8, 0xF0, 0x80, 0x1B, 0x90, 0xA2, 0x57, 0xE0, 0xB4, 0x03, 0x14, 0x90, 0xA2, 0x5A, 0xE0, 0xC3, ++0x94, 0x2C, 0x40, 0x0B, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0x24, 0xDE, 0xF0, 0x90, ++0xA2, 0x57, 0xE0, 0xFF, 0xB4, 0x01, 0x0F, 0xED, 0xC3, 0x94, 0x2C, 0x40, 0x09, 0x90, 0xA2, 0x5C, ++0xE0, 0x24, 0xE0, 0xF0, 0x80, 0x27, 0xEF, 0xB4, 0x02, 0x0F, 0x90, 0xA2, 0x5C, 0xE0, 0xC3, 0x94, ++0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, 0x90, 0xA2, 0x57, 0xE0, 0xB4, 0x03, 0x0D, ++0x90, 0xA2, 0x5C, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA2, 0x5A, ++0xE0, 0x14, 0x90, 0xA2, 0x58, 0xF0, 0x90, 0xA2, 0x5C, 0xE0, 0xFF, 0x90, 0xA2, 0x58, 0xE0, 0xC3, ++0x9F, 0x50, 0x02, 0x21, 0xF9, 0xE0, 0xFB, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0x75, 0xF0, 0x08, ++0xE5, 0x5E, 0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, ++0xF5, 0x83, 0xE0, 0xFD, 0x7C, 0x00, 0xEB, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, ++0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, ++0x4E, 0x60, 0x3E, 0x74, 0x12, 0x25, 0x5E, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xB4, ++0x14, 0x08, 0x90, 0xA2, 0x54, 0x74, 0x0C, 0xF0, 0x80, 0x08, 0x90, 0xA2, 0x58, 0xE0, 0x90, 0xA2, ++0x54, 0xF0, 0x90, 0xA2, 0x59, 0xE0, 0x04, 0xF0, 0x90, 0xA2, 0x5B, 0xE0, 0xFF, 0x90, 0xA2, 0x59, ++0xE0, 0x6F, 0x60, 0x15, 0x90, 0xA2, 0x5C, 0xE0, 0xFF, 0x90, 0xA2, 0x54, 0xE0, 0xD3, 0x9F, 0x40, ++0x08, 0x90, 0xA2, 0x58, 0xE0, 0x14, 0xF0, 0x21, 0x66, 0x90, 0xA2, 0x57, 0xE0, 0xFE, 0xB4, 0x01, ++0x1B, 0x90, 0xA2, 0x54, 0xE0, 0xFF, 0xD3, 0x94, 0x0B, 0x40, 0x11, 0xEF, 0x94, 0x34, 0x50, 0x0C, ++0xE0, 0x24, 0x20, 0xF0, 0x90, 0xA2, 0x5A, 0xE0, 0x24, 0x20, 0x80, 0x33, 0xEE, 0xB4, 0x02, 0x15, ++0x90, 0xA2, 0x54, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x0C, 0xE0, 0x24, 0x18, 0xF0, 0x90, 0xA2, 0x5A, ++0xE0, 0x24, 0x18, 0x80, 0x1A, 0x90, 0xA2, 0x57, 0xE0, 0xB4, 0x03, 0x2D, 0x90, 0xA2, 0x54, 0xE0, ++0xD3, 0x94, 0x1B, 0x40, 0x24, 0xE0, 0x24, 0x22, 0xF0, 0x90, 0xA2, 0x5A, 0xE0, 0x24, 0x22, 0xF0, ++0x74, 0x12, 0x25, 0x5E, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0x24, 0x20, 0xF0, 0x80, ++0x08, 0x90, 0xA2, 0x5C, 0xE0, 0x90, 0xA2, 0x54, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0xFD, 0x90, 0xA2, ++0x56, 0xE0, 0x90, 0xA3, 0x04, 0xF0, 0xE4, 0xFB, 0xAF, 0x5E, 0x12, 0x69, 0x1C, 0x90, 0xA2, 0x54, ++0xE0, 0xFF, 0x22, 0x90, 0x01, 0xC4, 0x74, 0x83, 0xF0, 0x74, 0xAA, 0xA3, 0xF0, 0xE4, 0xF5, 0x53, ++0x74, 0x87, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, 0xB4, ++0x95, 0x75, 0xF0, 0x04, 0xE5, 0x53, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0xC4, 0x13, 0x13, ++0x13, 0x54, 0x01, 0x30, 0xE0, 0x03, 0x02, 0xB4, 0x95, 0xE5, 0x53, 0x25, 0xE0, 0x24, 0x01, 0xF5, ++0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xD3, 0x94, 0x00, 0xEE, 0x94, 0x00, ++0x50, 0x03, 0x02, 0xB4, 0x95, 0xE5, 0x53, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x01, 0xF9, 0x74, 0x8D, ++0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x8B, 0x57, 0xF5, 0x58, 0x89, 0x59, 0xE5, 0x53, 0x25, 0xE0, 0x24, ++0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0xA2, 0x45, 0xCF, ++0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xE0, ++0xFF, 0x90, 0xA2, 0x47, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x07, 0xAB, 0xFF, ++0xAE, 0xF0, 0x12, 0x07, 0x80, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xFE, 0x90, 0x00, 0x04, 0x12, 0x07, ++0xAB, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x06, 0x12, 0x07, 0xAB, 0x2F, 0xFF, 0xEE, ++0x35, 0xF0, 0xFE, 0x90, 0x00, 0x08, 0x12, 0x07, 0xAB, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0x90, 0xA2, ++0x49, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x53, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, ++0xE0, 0xFF, 0x90, 0xA2, 0x44, 0xF0, 0xBF, 0xBE, 0x03, 0x74, 0x3F, 0xF0, 0x90, 0xA2, 0x44, 0xE0, ++0xB4, 0xB3, 0x03, 0x74, 0x34, 0xF0, 0x90, 0xA2, 0x44, 0xE0, 0x90, 0xA2, 0x42, 0xF0, 0x54, 0x7F, ++0xA3, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x53, 0x90, 0x95, 0x92, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, ++0x4C, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x53, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x13, 0x13, ++0x54, 0x03, 0x90, 0xA2, 0x4E, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, ++0x83, 0xE0, 0x20, 0xE2, 0x02, 0x81, 0x35, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x99, ++0xF5, 0x83, 0xE0, 0x60, 0x70, 0x90, 0xA2, 0x43, 0xE0, 0xFF, 0xC3, 0x94, 0x0C, 0x40, 0x66, 0xEF, ++0xD3, 0x94, 0x13, 0x50, 0x60, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, ++0xE0, 0x14, 0xF0, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x60, ++0x03, 0x02, 0xB4, 0xA1, 0x90, 0xA2, 0x43, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x91, 0xF5, 0x82, 0xE4, ++0x34, 0x43, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, ++0x04, 0xEB, 0x90, 0x42, 0x41, 0x12, 0x49, 0x1D, 0x12, 0x49, 0x0D, 0x12, 0x48, 0xAD, 0x78, 0x01, ++0x12, 0x08, 0x47, 0xE5, 0x53, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, ++0xE0, 0xC3, 0x94, 0x05, 0x40, 0x02, 0xE1, 0xCF, 0x90, 0xA2, 0x4C, 0xE0, 0xFF, 0x90, 0xA2, 0x43, ++0xE0, 0x9F, 0x40, 0x13, 0x90, 0xA2, 0x4C, 0xE0, 0x90, 0xA2, 0x43, 0xF0, 0x90, 0xA2, 0x42, 0xE0, ++0x54, 0x80, 0xFE, 0xF0, 0xEF, 0x4E, 0xF0, 0x90, 0xA2, 0x43, 0xE0, 0xFF, 0x90, 0x41, 0xED, 0x93, ++0xFE, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFD, 0xC3, 0x9E, ++0x40, 0x06, 0xEF, 0x90, 0x41, 0x45, 0x80, 0x07, 0x90, 0xA2, 0x43, 0xE0, 0x90, 0x41, 0x99, 0x93, ++0x90, 0xA2, 0x4B, 0xF0, 0x90, 0xA1, 0x66, 0xE0, 0x60, 0x54, 0x90, 0xA2, 0x43, 0xE0, 0xFF, 0x64, ++0x13, 0x60, 0x04, 0xEF, 0xB4, 0x0B, 0x05, 0x90, 0xA1, 0x68, 0x80, 0x27, 0x90, 0xA2, 0x43, 0xE0, ++0xFF, 0x64, 0x12, 0x60, 0x04, 0xEF, 0xB4, 0x0A, 0x05, 0x90, 0xA1, 0x69, 0x80, 0x15, 0x90, 0xA2, ++0x43, 0xE0, 0xFF, 0x64, 0x11, 0x60, 0x04, 0xEF, 0xB4, 0x09, 0x05, 0x90, 0xA1, 0x6A, 0x80, 0x03, ++0x90, 0xA1, 0x67, 0xE0, 0xF5, 0x5D, 0xED, 0xC3, 0x9E, 0x90, 0xA2, 0x43, 0xE0, 0x40, 0x05, 0x90, ++0x41, 0x45, 0x80, 0x03, 0x90, 0x41, 0x99, 0x93, 0x25, 0x5D, 0x90, 0xA2, 0x4B, 0xF0, 0x90, 0xA2, ++0x4B, 0xE0, 0x75, 0xF0, 0x06, 0xA4, 0x24, 0xA3, 0xF9, 0x74, 0x40, 0x35, 0xF0, 0x75, 0x54, 0xFF, ++0xF5, 0x55, 0x89, 0x56, 0x90, 0xA2, 0x42, 0xE0, 0x90, 0x44, 0x99, 0x93, 0xFF, 0xD3, 0x90, 0xA2, ++0x48, 0xE0, 0x9F, 0x90, 0xA2, 0x47, 0xE0, 0x94, 0x00, 0x40, 0x06, 0x12, 0xA7, 0x7A, 0x02, 0xB3, ++0xF4, 0xC3, 0x90, 0xA2, 0x46, 0xE0, 0x94, 0x0F, 0x90, 0xA2, 0x45, 0xE0, 0x94, 0x00, 0x50, 0x68, ++0xAB, 0x57, 0xAA, 0x58, 0xA9, 0x59, 0x90, 0x00, 0x06, 0x12, 0x07, 0xAB, 0xFF, 0xAE, 0xF0, 0x90, ++0x00, 0x08, 0x12, 0x07, 0xAB, 0x2F, 0xFD, 0xE5, 0xF0, 0x3E, 0xFC, 0x90, 0xA2, 0x45, 0xE0, 0xC3, ++0x13, 0xFE, 0xA3, 0xE0, 0x13, 0xFF, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x05, 0x12, 0xA7, 0x7A, ++0x80, 0x36, 0x90, 0xA2, 0x45, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xAE, 0x04, 0x78, 0x02, 0xCE, 0xC3, ++0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFB, 0xAA, 0x06, 0xEC, 0xC3, 0x13, 0xFE, 0xED, 0x13, 0x2B, 0xFF, ++0xEE, 0x3A, 0xFE, 0xAB, 0x57, 0xAA, 0x58, 0xA9, 0x59, 0x12, 0x07, 0x80, 0xD3, 0x9F, 0xE5, 0xF0, ++0x9E, 0x40, 0x05, 0xAF, 0x53, 0x12, 0xA1, 0xD1, 0xE5, 0x53, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, ++0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0xF5, 0x5A, 0xA3, 0xE0, 0xF5, 0x5B, 0x90, 0xA2, 0x45, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x08, 0x90, 0xA2, 0x4D, 0x74, ++0x05, 0xF0, 0x80, 0x16, 0xD3, 0xEF, 0x94, 0xC8, 0xEE, 0x94, 0x00, 0x40, 0x08, 0x90, 0xA2, 0x4D, ++0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x4D, 0xF0, 0xAB, 0x57, 0xAA, 0x58, 0xA9, 0x59, ++0x12, 0x07, 0x80, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0x4D, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, ++0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x54, 0xAA, 0x55, 0xA9, 0x56, 0x12, ++0x06, 0x89, 0xFD, 0x7C, 0x00, 0x12, 0x07, 0x03, 0xEF, 0x25, 0x5B, 0xF5, 0x5B, 0xEE, 0x35, 0x5A, ++0xF5, 0x5A, 0xAB, 0x57, 0xAA, 0x58, 0xA9, 0x59, 0x90, 0x00, 0x02, 0x12, 0x07, 0xAB, 0xFF, 0xAE, ++0xF0, 0x90, 0xA2, 0x4D, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, ++0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x54, 0xAA, 0x55, 0xA9, 0x56, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, ++0xFD, 0x7C, 0x00, 0x12, 0x07, 0x03, 0xEF, 0x25, 0x5B, 0xF5, 0x5B, 0xEE, 0x35, 0x5A, 0xF5, 0x5A, ++0xAB, 0x57, 0xAA, 0x58, 0xA9, 0x59, 0x90, 0x00, 0x04, 0x12, 0x07, 0xAB, 0xFF, 0xAE, 0xF0, 0x90, ++0xA2, 0x4D, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, ++0xF9, 0xFF, 0xAB, 0x54, 0xAA, 0x55, 0xA9, 0x56, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFD, 0x7C, ++0x00, 0x12, 0x07, 0x03, 0xEF, 0x25, 0x5B, 0xF5, 0x5B, 0xEE, 0x35, 0x5A, 0xF5, 0x5A, 0xAB, 0x57, ++0xAA, 0x58, 0xA9, 0x59, 0x90, 0x00, 0x06, 0x12, 0x07, 0xAB, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0x4D, ++0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, ++0xAB, 0x54, 0xAA, 0x55, 0xA9, 0x56, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFD, 0x7C, 0x00, 0x12, ++0x07, 0x03, 0xEF, 0x25, 0x5B, 0xF5, 0x5B, 0xEE, 0x35, 0x5A, 0xF5, 0x5A, 0xAB, 0x57, 0xAA, 0x58, ++0xA9, 0x59, 0x90, 0x00, 0x08, 0x12, 0x07, 0xAB, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0x4D, 0xE0, 0xFD, ++0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x54, ++0xAA, 0x55, 0xA9, 0x56, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0xFD, 0x7C, 0x00, 0x12, 0x07, 0x03, ++0xEF, 0x25, 0x5B, 0xF5, 0x5B, 0xEE, 0x35, 0x5A, 0xF5, 0x5A, 0x90, 0x00, 0x05, 0x12, 0x06, 0xA2, ++0xFD, 0x90, 0xA2, 0x4D, 0xE0, 0xFF, 0x90, 0xA2, 0x45, 0xE0, 0xFE, 0xA3, 0xE0, 0xA8, 0x07, 0x08, ++0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x07, 0x03, 0xD3, 0xE5, 0x5B, ++0x9F, 0xE5, 0x5A, 0x9E, 0x40, 0x0C, 0xE5, 0x5B, 0x9F, 0xF5, 0x5B, 0xE5, 0x5A, 0x9E, 0xF5, 0x5A, ++0x80, 0x05, 0xE4, 0xF5, 0x5A, 0xF5, 0x5B, 0xE5, 0x53, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, ++0x34, 0x94, 0xF5, 0x83, 0xE5, 0x5A, 0xF0, 0xA3, 0xE5, 0x5B, 0xF0, 0xAE, 0x5A, 0xFF, 0xE4, 0xFC, ++0xFD, 0x90, 0xA2, 0x43, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x41, 0x12, 0x49, 0x1D, 0x12, 0x49, ++0x0D, 0xC3, 0x12, 0x48, 0xD4, 0x50, 0x07, 0xAF, 0x53, 0x12, 0xA1, 0xD1, 0x80, 0x2C, 0x90, 0xA2, ++0x43, 0xE0, 0xFF, 0x25, 0xE0, 0x24, 0x91, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xD3, 0x74, ++0x01, 0x93, 0x95, 0x5B, 0xE4, 0x93, 0x95, 0x5A, 0x40, 0x10, 0xEF, 0x64, 0x36, 0x60, 0x04, 0x7D, ++0x01, 0x80, 0x02, 0x7D, 0x09, 0xAF, 0x53, 0x12, 0xA7, 0x7E, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, ++0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x20, 0xE0, 0x03, 0x02, 0xB3, 0xC8, 0x90, 0xA2, 0x43, 0xE0, ++0x64, 0x3F, 0x60, 0x03, 0x02, 0xB3, 0xC8, 0xAF, 0x53, 0x12, 0xA1, 0xD1, 0x02, 0xB3, 0xC8, 0x74, ++0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0xFF, 0x64, 0x05, 0x60, 0x03, ++0x02, 0xB2, 0x22, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE4, 0xF0, ++0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFE, 0xB4, 0x05, 0x0D, ++0x90, 0xA2, 0x43, 0xE0, 0xC3, 0x94, 0x3B, 0x50, 0x02, 0x01, 0x8A, 0x80, 0x60, 0xEE, 0xB4, 0x04, ++0x0B, 0x90, 0xA2, 0x43, 0xE0, 0xC3, 0x94, 0x31, 0x40, 0x70, 0x80, 0x51, 0x74, 0x12, 0x25, 0x53, ++0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFE, 0xB4, 0x03, 0x0B, 0x90, 0xA2, 0x43, 0xE0, ++0xC3, 0x94, 0x19, 0x40, 0x55, 0x80, 0x36, 0xEE, 0xB4, 0x02, 0x0B, 0x90, 0xA2, 0x43, 0xE0, 0xC3, ++0x94, 0x11, 0x40, 0x46, 0x80, 0x27, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, ++0x83, 0xE0, 0xFE, 0xB4, 0x01, 0x0B, 0x90, 0xA2, 0x43, 0xE0, 0xC3, 0x94, 0x0A, 0x40, 0x2B, 0x80, ++0x0C, 0xEE, 0x70, 0x19, 0x90, 0xA2, 0x43, 0xE0, 0xC3, 0x94, 0x03, 0x40, 0x1D, 0x74, 0x92, 0x25, ++0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x80, 0x0D, 0x74, 0x92, 0x25, ++0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, ++0xE4, 0x34, 0x97, 0xF5, 0x83, 0xE0, 0x90, 0xA2, 0x4F, 0xF0, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, ++0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFE, 0xC3, 0x94, 0x30, 0x50, 0x13, 0xE4, 0x90, 0xA2, 0x4F, ++0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, 0x21, 0x65, 0x74, ++0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x21, ++0x8E, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x64, 0x0A, 0x60, ++0x51, 0xEE, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0x74, 0x81, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, ++0x93, 0xF5, 0x83, 0xE0, 0xFE, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x50, 0x32, ++0xEE, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, ++0xF5, 0x83, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x50, 0x14, 0x74, 0x12, ++0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0xA2, 0x43, 0xE0, 0x6E, ++0x60, 0x3F, 0x90, 0xA2, 0x4F, 0xE0, 0xFE, 0x70, 0x04, 0x04, 0xF0, 0x80, 0x0F, 0xEE, 0x90, 0xA2, ++0x4F, 0xB4, 0x01, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x05, 0xF0, 0x74, 0x12, 0x25, 0x53, ++0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x81, 0x25, 0x53, 0xF5, 0x82, 0xE4, ++0x34, 0x93, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0x80, ++0x2B, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x12, ++0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x12, 0xE4, 0x90, ++0xA2, 0x4F, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, 0xF0, ++0x90, 0xA2, 0x43, 0xE0, 0xFE, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, ++0xEE, 0xF0, 0x90, 0xA2, 0x4F, 0xE0, 0xFE, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x97, ++0xF5, 0x83, 0xEE, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x53, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, ++0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x1E, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, ++0x9B, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0x4F, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, ++0x34, 0x9D, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x53, 0x90, 0x81, 0x01, 0x12, 0x49, ++0x1D, 0xE0, 0x54, 0xF8, 0xFE, 0x90, 0xA2, 0x52, 0xF0, 0x90, 0xA2, 0x4F, 0xE0, 0x4E, 0xFE, 0x90, ++0xA2, 0x52, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x53, 0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, 0xEE, 0xF0, ++0x61, 0xC8, 0xEF, 0x64, 0x06, 0x60, 0x02, 0x61, 0xC8, 0xF5, 0x5A, 0xF5, 0x5B, 0x74, 0x92, 0x25, ++0x53, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xE0, 0x90, 0xA2, 0x4F, 0xF0, 0x90, 0xA2, 0x45, ++0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x08, 0x90, 0xA2, 0x4D, ++0x74, 0x05, 0xF0, 0x80, 0x16, 0xD3, 0xEF, 0x94, 0xFA, 0xEE, 0x94, 0x00, 0x40, 0x08, 0x90, 0xA2, ++0x4D, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x4D, 0xF0, 0x90, 0xA2, 0x4D, 0xE0, 0xFD, ++0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x44, ++0xF2, 0xE4, 0x93, 0xFD, 0x7C, 0x00, 0x12, 0x07, 0x03, 0x90, 0xA2, 0x50, 0xEE, 0xF0, 0xA3, 0xEF, ++0xF0, 0xE4, 0xF5, 0x5C, 0xAB, 0x57, 0xAA, 0x58, 0xA9, 0x59, 0x75, 0xF0, 0x02, 0xE5, 0x5C, 0xA4, ++0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x07, 0xAB, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0x4D, 0xE0, 0xFD, ++0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xE5, 0x5C, ++0x90, 0x44, 0xED, 0x93, 0xFD, 0x7C, 0x00, 0x12, 0x07, 0x03, 0xEF, 0x25, 0x5B, 0xF5, 0x5B, 0xEE, ++0x35, 0x5A, 0xF5, 0x5A, 0xC3, 0x90, 0xA2, 0x51, 0xE0, 0x95, 0x5B, 0x90, 0xA2, 0x50, 0xE0, 0x95, ++0x5A, 0x40, 0x07, 0x05, 0x5C, 0xE5, 0x5C, 0xB4, 0x05, 0xAA, 0xE5, 0x5C, 0xC3, 0x13, 0xF5, 0x5C, ++0x90, 0xA2, 0x4F, 0xE0, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x90, 0xA2, ++0x53, 0xF0, 0xD3, 0x95, 0x5C, 0x40, 0x06, 0xE0, 0x95, 0x5C, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, ++0x53, 0xF0, 0x74, 0x01, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xC3, 0x13, ++0xFF, 0x90, 0xA2, 0x53, 0xE0, 0xC4, 0x33, 0x54, 0xE0, 0x2F, 0x04, 0xFF, 0x74, 0x01, 0x25, 0x53, ++0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x01, 0x25, 0x53, 0xF5, 0x82, 0xE4, ++0x34, 0x93, 0xF5, 0x83, 0xE0, 0xC3, 0x94, 0xC0, 0x40, 0x0E, 0x74, 0x01, 0x25, 0x53, 0xF5, 0x82, ++0xE4, 0x34, 0x93, 0xF5, 0x83, 0x74, 0xC0, 0xF0, 0x74, 0x01, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, ++0x93, 0xF5, 0x83, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA2, 0x53, 0xF0, 0xE0, 0x25, 0xE0, ++0xF0, 0x70, 0x02, 0x80, 0x05, 0x90, 0xA2, 0x53, 0xE0, 0x14, 0x90, 0xA2, 0x4F, 0xF0, 0xD3, 0x90, ++0xA2, 0x48, 0xE0, 0x94, 0x03, 0x90, 0xA2, 0x47, 0xE0, 0x94, 0x00, 0x40, 0x05, 0xE4, 0x90, 0xA2, ++0x4F, 0xF0, 0x90, 0xA2, 0x4F, 0xE0, 0xFF, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x97, ++0xF5, 0x83, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x53, 0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, 0xE0, ++0x54, 0xF8, 0xFE, 0x90, 0xA2, 0x52, 0xF0, 0xEF, 0x4E, 0xFF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x53, ++0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, ++0x9D, 0xF5, 0x83, 0xE0, 0xD3, 0x94, 0x05, 0x74, 0x92, 0x50, 0x0E, 0x25, 0x53, 0xF5, 0x82, 0xE4, ++0x34, 0x9D, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x0B, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9D, ++0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0x47, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, ++0xFD, 0x74, 0xFF, 0x9E, 0xFC, 0xE5, 0x53, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, ++0xF5, 0x83, 0xE0, 0xFA, 0xA3, 0xE0, 0xD3, 0x9D, 0xEA, 0x9C, 0xE5, 0x53, 0x50, 0x13, 0x25, 0xE0, ++0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x08, 0xD6, 0x80, ++0x10, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, ++0xF0, 0x90, 0xA2, 0x49, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, ++0x9E, 0xFC, 0xE5, 0x53, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, ++0xFA, 0xA3, 0xE0, 0xD3, 0x9D, 0xEA, 0x9C, 0xE5, 0x53, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x92, 0xF5, ++0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x08, 0xD6, 0x80, 0x10, 0x25, 0xE0, ++0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xE4, 0xFD, ++0xAF, 0x53, 0x12, 0x6E, 0xA6, 0x05, 0x53, 0xE5, 0x53, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0xAA, ++0x90, 0x22, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x12, 0x06, ++0x89, 0x54, 0x7F, 0xFD, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFE, 0x54, 0x1F, 0x90, 0xA2, 0x49, ++0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x90, 0xA2, 0x48, 0xF0, 0x90, 0x00, ++0x02, 0x12, 0x06, 0xA2, 0xFE, 0x54, 0x03, 0xFF, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0xA2, ++0x4B, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, ++0x90, 0xA2, 0x4A, 0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFE, 0x90, 0x00, ++0x02, 0x12, 0x06, 0xA2, 0xFB, 0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFC, 0x90, 0xA2, 0x4C, ++0xF0, 0xEB, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEE, 0x54, 0x01, 0xC4, 0x33, 0x33, ++0x33, 0x54, 0x80, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, ++0x7F, 0x4E, 0xF0, 0x90, 0xA2, 0x4A, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0xFE, 0x75, ++0xF0, 0x04, 0xED, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xBF, 0x4E, 0xF0, 0xEC, 0x60, ++0x02, 0xC1, 0x2B, 0x90, 0xA2, 0x49, 0xE0, 0x54, 0x1F, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, ++0x94, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xE0, 0x4E, 0xF0, 0xEF, 0x54, 0x03, 0xFE, 0x75, 0xF0, 0x04, ++0xED, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xFC, 0x4E, 0xF0, 0xEF, 0x54, 0x03, 0x25, ++0xE0, 0x25, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, ++0xF3, 0x4F, 0xF0, 0x90, 0xA2, 0x48, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0xFF, 0x75, 0xF0, ++0x04, 0xED, 0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xDF, 0x4F, 0xF0, 0x90, 0xA2, 0x4B, ++0xE0, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0xFF, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x95, 0x12, 0x49, ++0x1D, 0xE0, 0x54, 0xCF, 0x4F, 0xF0, 0x74, 0x92, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, ++0xE0, 0x54, 0xFB, 0xF0, 0x74, 0x92, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xC0, 0x83, ++0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA2, 0x4D, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0xD0, ++0x82, 0xD0, 0x83, 0xF0, 0xE4, 0xFC, 0xEC, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0xA2, 0x45, ++0x12, 0x49, 0x29, 0x8F, 0x82, 0x8E, 0x83, 0x12, 0x06, 0xA2, 0xFF, 0x75, 0xF0, 0x08, 0xED, 0x90, ++0x89, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, ++0xF0, 0x0C, 0xEC, 0xB4, 0x04, 0xD0, 0xAF, 0x05, 0x12, 0x6B, 0x2C, 0x22, 0x90, 0xA2, 0x45, 0x12, ++0x49, 0x32, 0x12, 0x06, 0x89, 0xF5, 0x53, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, ++0xE0, 0x54, 0xFE, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xC0, ++0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x90, 0x00, 0x03, 0x12, 0x06, ++0xA2, 0x54, 0x01, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, ++0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x54, 0xFD, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, ++0xE4, 0x34, 0x99, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA2, 0x45, 0x12, 0x49, ++0x29, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0x54, 0x02, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, ++0xF0, 0xE5, 0x53, 0xC3, 0x94, 0x80, 0x50, 0x15, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFF, 0x74, ++0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0xE5, 0x53, 0xB4, ++0x80, 0x0A, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0x95, 0x11, 0xF0, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x5D, 0x12, 0x4B, 0x20, 0xEF, 0x30, 0xE6, 0x4D, 0x7F, 0x8D, ++0x12, 0x4B, 0x24, 0xEF, 0x64, 0x01, 0x70, 0x43, 0x90, 0xA3, 0x5E, 0xF0, 0x90, 0xA3, 0x5E, 0xE0, ++0xFD, 0x90, 0xA3, 0x5D, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, ++0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x4C, 0x60, 0x90, ++0xA3, 0x5E, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD1, 0x7F, 0x8F, 0x12, 0x4B, 0x24, ++0xEF, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x4A, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, ++0x90, 0xA3, 0x5F, 0x12, 0x4B, 0x20, 0xEF, 0x30, 0xE6, 0x69, 0x7F, 0x8D, 0x12, 0x4B, 0x24, 0xEF, ++0x64, 0x02, 0x70, 0x5F, 0x90, 0xA3, 0x60, 0xF0, 0x90, 0xA3, 0x60, 0xE0, 0xFD, 0x90, 0xA3, 0x5F, ++0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, ++0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x4C, 0x60, 0x90, ++0xA3, 0x60, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x08, 0x40, 0xCD, 0x90, 0xA3, 0x60, 0xE0, 0xFD, ++0xC3, 0x94, 0x10, 0x50, 0x0E, 0xE4, 0xFB, 0xFF, 0x12, 0x4C, 0x60, 0x90, 0xA3, 0x60, 0xE0, 0x04, ++0xF0, 0x80, 0xE8, 0x7F, 0x8F, 0x12, 0x4B, 0x24, 0xEF, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, ++0x12, 0x4A, 0x07, 0x22, 0x90, 0xA2, 0x3E, 0x12, 0x4B, 0x20, 0xEF, 0x30, 0xE6, 0x50, 0x7F, 0x8D, ++0x12, 0x4B, 0x24, 0xEF, 0x64, 0x03, 0x70, 0x46, 0x90, 0xA2, 0x3F, 0xF0, 0x90, 0xA2, 0x3F, 0xE0, ++0xFD, 0x90, 0xA2, 0x3E, 0xE0, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, ++0x83, 0xE5, 0x82, 0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, ++0x4C, 0x60, 0x90, 0xA2, 0x3F, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCE, 0x7F, 0x8F, ++0x12, 0x4B, 0x24, 0xEF, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x4A, 0x07, 0x22, 0x74, ++0x1D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0xA2, 0xB4, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, ++0x37, 0xBC, 0x90, 0xA2, 0xBE, 0x12, 0x08, 0x6D, 0x90, 0xA2, 0xB6, 0x12, 0x48, 0xE5, 0x12, 0x08, ++0x3A, 0x90, 0xA2, 0xBE, 0x12, 0x49, 0x01, 0x12, 0x48, 0xBA, 0x90, 0xA2, 0xBA, 0x12, 0x49, 0x01, ++0x12, 0x48, 0xC7, 0x90, 0xA2, 0xC2, 0x12, 0x08, 0x6D, 0x90, 0xA2, 0xC2, 0x12, 0x48, 0xE5, 0x90, ++0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x90, 0xA2, 0xB4, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x02, 0x38, 0x07, ++0x90, 0xA2, 0xA2, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA2, 0xA1, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, ++0xFD, 0x12, 0x3D, 0x2C, 0x90, 0xA2, 0xAC, 0x12, 0x08, 0x6D, 0x90, 0xA2, 0xA4, 0x12, 0x48, 0xE5, ++0x12, 0x08, 0x3A, 0x90, 0xA2, 0xAC, 0x12, 0x49, 0x01, 0x12, 0x48, 0xBA, 0x90, 0xA2, 0xA8, 0x12, ++0x49, 0x01, 0x12, 0x48, 0xC7, 0x90, 0xA2, 0xB0, 0x12, 0x08, 0x6D, 0x90, 0xA2, 0xA2, 0xA3, 0xE0, ++0xFD, 0xC0, 0x05, 0x90, 0xA2, 0xB0, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0x96, 0x12, 0x08, 0x6D, 0x90, ++0xA2, 0xA1, 0xE0, 0xFF, 0xD0, 0x05, 0x02, 0x3C, 0x33, 0x90, 0x9F, 0x95, 0xE0, 0x64, 0x02, 0x60, ++0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x12, 0x06, 0x89, 0xFF, 0x54, 0x01, 0xFE, ++0x90, 0xA1, 0x6F, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, 0x00, ++0x01, 0x12, 0x06, 0xA2, 0x90, 0xA1, 0x70, 0xF0, 0x22, 0x90, 0xA1, 0x72, 0xE0, 0x30, 0xE0, 0x36, ++0x90, 0xA1, 0x75, 0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x90, 0xA1, 0x73, 0xE0, 0x6F, 0x70, 0x27, 0x90, ++0x06, 0x92, 0xE0, 0x20, 0xE2, 0x11, 0x90, 0xA1, 0x77, 0xE0, 0x70, 0x0B, 0x12, 0x57, 0x7D, 0x90, ++0xA1, 0x76, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA1, ++0x75, 0xF0, 0x90, 0xA1, 0x77, 0xF0, 0x22, 0x90, 0x05, 0x2B, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, ++0x7F, 0x01, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0xF0, ++0x90, 0xA1, 0x0B, 0x74, 0x03, 0xF0, 0x22, 0x12, 0x86, 0xBC, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, ++0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0xA1, 0x0B, 0x74, 0x04, 0xF0, 0x22, 0x90, 0x05, ++0x22, 0x74, 0x6F, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0xA1, 0x0B, 0x74, 0x04, ++0xF0, 0x22, 0x90, 0x01, 0x57, 0xE0, 0x60, 0x48, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, ++0x90, 0xA1, 0x0D, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0C, 0xEF, 0x54, 0xFB, 0xF0, ++0x90, 0xA1, 0x14, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0xA1, 0x19, 0xE0, 0x04, 0xF0, 0x90, 0xA1, ++0x14, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0xA1, 0x21, 0xE0, 0xFF, 0x90, 0xA1, 0x19, 0xE0, 0xD3, 0x9F, ++0x40, 0x0E, 0x90, 0xA0, 0x87, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0xA1, 0x0E, 0xE0, 0x54, 0xFB, 0xF0, ++0x22, 0x90, 0xA1, 0x28, 0xE0, 0x30, 0xE0, 0x23, 0x90, 0xA1, 0x39, 0xE0, 0x60, 0x08, 0x90, 0x01, ++0xB8, 0x74, 0x40, 0xF0, 0x41, 0x87, 0x90, 0xA1, 0x12, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, ++0x35, 0x90, 0xA1, 0x27, 0xE0, 0x70, 0x02, 0x41, 0x7F, 0x80, 0x67, 0x12, 0x57, 0xF8, 0xEF, 0x64, ++0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x41, 0x87, 0x90, 0xA1, 0x14, 0xE0, 0xFF, ++0x54, 0x03, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x7B, 0x90, 0xA1, 0x12, 0xE0, ++0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x69, 0xEF, 0x30, ++0xE2, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x5D, 0x90, 0xA1, 0x14, 0xE0, 0x30, 0xE4, ++0x08, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x4E, 0x90, 0xA1, 0x0E, 0xE0, 0x13, 0x13, 0x54, ++0x3F, 0x20, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x20, 0xF0, 0x80, 0x3B, 0x90, 0xA1, 0x27, 0xE0, ++0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x80, 0xF0, 0x80, 0x2D, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, ++0x08, 0x90, 0x01, 0xB8, 0x74, 0x11, 0xF0, 0x80, 0x1E, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0F, ++0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x12, 0xF0, 0x80, 0x08, 0x90, ++0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x7F, 0x00, 0x22, ++0xEF, 0x60, 0x42, 0x90, 0xA0, 0x87, 0xE0, 0x64, 0x01, 0x70, 0x3A, 0x90, 0xA1, 0x0E, 0xE0, 0x54, ++0xFE, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE4, ++0xFF, 0x12, 0x56, 0x26, 0xBF, 0x01, 0x12, 0x90, 0xA1, 0x0D, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA1, ++0x13, 0x74, 0x06, 0xF0, 0x90, 0xA1, 0x0C, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, ++0x01, 0xB8, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0xA1, 0x13, 0x74, ++0x02, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0xA1, 0x0C, 0x74, 0x02, 0xF0, 0x22, ++0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x13, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x44, ++0x40, 0xF0, 0x90, 0xA1, 0x0C, 0x74, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0xA2, 0x5E, 0xF0, 0x90, 0xA1, ++0x10, 0xE0, 0x70, 0x02, 0x61, 0xC4, 0x90, 0xA0, 0x87, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x61, 0xC4, ++0x90, 0xA1, 0x0F, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x60, 0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, ++0x21, 0x90, 0xA1, 0x17, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, 0xA1, 0x19, 0xE0, 0x60, ++0x11, 0xEF, 0x70, 0x08, 0x90, 0xA1, 0x16, 0xE0, 0xA3, 0xF0, 0x80, 0x00, 0x90, 0xA2, 0x5E, 0x74, ++0x01, 0xF0, 0x90, 0xA1, 0x08, 0xE0, 0x30, 0xE0, 0x16, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x02, 0x05, ++0xE4, 0x90, 0xA2, 0x5E, 0xF0, 0x12, 0x57, 0xEC, 0xEF, 0x70, 0x04, 0x90, 0xA2, 0x5E, 0xF0, 0x90, ++0xA2, 0x5E, 0xE0, 0x60, 0x4F, 0x90, 0xA1, 0x14, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA1, 0x19, 0xE0, ++0x60, 0x03, 0xB4, 0x01, 0x09, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x19, 0xE0, 0x80, 0x0D, 0xE4, 0xF5, ++0x3B, 0x90, 0xA1, 0x19, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0xA1, 0x18, 0xE0, ++0x2F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, ++0x74, 0x05, 0xF0, 0x90, 0xA1, 0x13, 0xE0, 0x20, 0xE2, 0x07, 0x7D, 0x01, 0x7F, 0x04, 0x12, 0x53, ++0x5E, 0x12, 0x82, 0x1C, 0x22, 0x90, 0xA1, 0x0D, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, ++0x11, 0xEF, 0x54, 0xFB, 0xF0, 0x90, 0xA1, 0x14, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x42, ++0x80, 0x3D, 0x90, 0xA1, 0x19, 0xE0, 0x04, 0xF0, 0x90, 0xA1, 0x14, 0xE0, 0x54, 0xEF, 0xF0, 0x90, ++0xA1, 0x19, 0xE0, 0xFF, 0xB4, 0x01, 0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, 0x06, 0x90, 0x05, 0x58, ++0xE0, 0x04, 0xF0, 0x90, 0xA1, 0x21, 0xE0, 0xFF, 0x90, 0xA1, 0x19, 0xE0, 0xD3, 0x9F, 0x40, 0x0F, ++0x90, 0xA0, 0x87, 0xE0, 0xB4, 0x01, 0x0B, 0x90, 0xA1, 0x0E, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x12, ++0x53, 0x43, 0x22, 0x12, 0x86, 0xBC, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x13, 0x74, 0x0C, ++0xF0, 0x90, 0xA1, 0x0C, 0xF0, 0x22, 0x90, 0x9F, 0x98, 0xE0, 0xFE, 0x90, 0x04, 0x1C, 0xE0, 0x6E, ++0x70, 0x40, 0x90, 0xA1, 0x13, 0xE0, 0xFE, 0x64, 0x0E, 0x70, 0x1C, 0xEF, 0x70, 0x34, 0x90, 0xA1, ++0x0D, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE0, 0x44, 0x80, 0xF0, ++0x90, 0xA1, 0x13, 0x74, 0x04, 0xF0, 0x22, 0xEE, 0xB4, 0x06, 0x17, 0xEF, 0x60, 0x14, 0x90, 0xA1, ++0x0D, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA1, 0x13, 0x74, ++0x0C, 0xF0, 0x22, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0xA0, ++0x86, 0xE0, 0x9B, 0x90, 0xA0, 0x85, 0xE0, 0x9A, 0x50, 0x13, 0xA3, 0xE0, 0x24, 0x01, 0xFF, 0x90, ++0xA0, 0x85, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, 0xFD, ++0x11, 0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFF, ++0x22, 0x00, 0xD4, 0x15, ++}; ++static const u4Byte ArrayLength_MP_8821A_FW_NIC = 31972; ++ ++ ++void ++ODM_ReadFirmware_MP_8821A_FW_NIC( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++) ++{ ++ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8821A_FW_NIC; ++ *pFirmwareSize = ArrayLength_MP_8821A_FW_NIC; ++} ++ ++static const u1Byte Array_MP_8821A_FW_WoWLAN[] = { ++0x01, 0x21, 0x30, 0x00, 0x0B, 0x00, 0x00, 0x00, 0x04, 0x23, 0x15, 0x35, 0x6E, 0x45, 0x00, 0x00, ++0x71, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x02, 0x4A, 0xCD, 0x02, 0x5F, 0xED, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x60, 0x6E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x69, 0xA2, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x60, 0x1E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x64, 0x18, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x02, 0x69, 0xA1, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x46, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, ++0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, ++0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, ++0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, ++0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, ++0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, ++0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, ++0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, ++0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, ++0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, ++0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, ++0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, ++0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, ++0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, ++0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, ++0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4B, 0x61, 0x74, 0x01, 0x93, ++0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, ++0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, ++0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, ++0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, ++0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, ++0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, ++0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, ++0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, ++0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, ++0x04, 0x90, 0x4B, 0x61, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, ++0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, ++0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, ++0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x46, 0x4D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, ++0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, ++0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, ++0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, ++0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, ++0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, ++0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, ++0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, ++0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x46, 0x4C, 0x8F, 0xF0, ++0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, ++0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, ++0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, ++0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, ++0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x46, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, ++0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xEF, 0x5B, 0xFF, ++0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, ++0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, ++0xE0, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xA4, ++0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, ++0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, ++0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, ++0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, ++0xA3, 0x80, 0xDF, 0xE3, 0xF5, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x6B, 0xDF, 0xF5, 0x80, 0x67, ++0xE3, 0xF5, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x5E, 0xDF, 0xF5, 0x80, 0x5A, 0x87, 0xF0, 0x09, ++0xE6, 0x08, 0xB5, 0xF0, 0x52, 0xDF, 0xF6, 0x80, 0x4E, 0x87, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, ++0x46, 0xDF, 0xF6, 0x80, 0x42, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE0, 0xA3, 0xB5, 0xF0, ++0x36, 0xDF, 0xF6, 0x80, 0x32, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, ++0xF0, 0x25, 0xDF, 0xF5, 0x80, 0x21, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, 0x09, 0xE0, 0xA3, ++0xB5, 0xF0, 0x14, 0xDF, 0xF5, 0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, 0x09, 0xE4, ++0x93, 0xA3, 0xB5, 0xF0, 0x02, 0xDF, 0xF4, 0x02, 0x4A, 0x52, 0x80, 0x87, 0x80, 0xE9, 0x80, 0x90, ++0x80, 0xD4, 0x80, 0x3E, 0x80, 0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, 0x80, 0xB7, 0x80, 0x8D, ++0x80, 0xA3, 0x80, 0x51, 0x80, 0x74, 0x80, 0x3C, 0x02, 0x4A, 0x5E, 0x89, 0x82, 0x8A, 0x83, 0xEC, ++0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, ++0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x76, 0xDF, 0xE3, 0xDE, 0xE1, ++0x80, 0x70, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, 0xB5, 0xF0, 0x62, ++0xDF, 0xF4, 0x80, 0x5E, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, ++0x51, 0xDF, 0xF5, 0x80, 0x4D, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, 0xB5, ++0xF0, 0x40, 0xDF, 0xF5, 0x80, 0x3C, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE6, ++0x08, 0xB5, 0xF0, 0x2E, 0xDF, 0xF4, 0x80, 0x2A, 0x80, 0x02, 0x80, 0x57, 0x89, 0x82, 0x8A, 0x83, ++0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE0, ++0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x06, 0xDF, 0xE4, 0xDE, 0xE2, ++0x80, 0x00, 0x7F, 0xFF, 0xB5, 0xF0, 0x02, 0x0F, 0x22, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x89, 0x82, ++0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, ++0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xD5, 0xDF, 0xE5, 0xDE, ++0xE3, 0x80, 0xCF, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, ++0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, ++0xB5, 0xF0, 0xAF, 0xDF, 0xE4, 0xDE, 0xE2, 0x80, 0xA9, 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, ++0x60, 0xAB, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, ++0x04, 0x00, 0x50, 0x8E, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x49, 0x9A, 0x73, 0x02, 0x4B, 0x0B, ++0x02, 0x46, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, ++0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, ++0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, ++0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x4B, 0x50, 0xE4, 0x7E, ++0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, ++0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, ++0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, ++0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, ++0x00, 0x41, 0x91, 0x0F, 0x00, 0x41, 0x91, 0x10, 0x00, 0x41, 0x91, 0x11, 0x00, 0x41, 0x91, 0x24, ++0x00, 0x4E, 0x92, 0x50, 0xF6, 0x58, 0x3A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, ++0x75, 0x83, 0x00, 0xED, 0xF0, 0x7F, 0x10, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xD0, 0xD0, 0x92, 0xAF, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x8F, 0xD1, 0x30, 0xEF, 0x20, 0xE6, 0x02, ++0x81, 0xF3, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x91, 0x15, 0xF0, 0x7F, 0x8D, 0xD1, 0x30, 0x90, 0x91, ++0x16, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0x91, 0x17, 0xF0, 0x90, 0x91, 0x16, 0xE0, 0x24, ++0xF1, 0x70, 0x02, 0x81, 0x7D, 0x24, 0xEF, 0x70, 0x02, 0x81, 0xD3, 0x24, 0x18, 0x60, 0x02, 0x81, ++0xE5, 0x90, 0x8E, 0x7A, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0xB1, 0x04, 0x90, 0x8E, 0x79, 0xE0, 0x54, ++0x0F, 0xFB, 0x0D, 0xB1, 0x04, 0x90, 0x8E, 0x7C, 0xE0, 0xFB, 0x0D, 0xB1, 0x04, 0x90, 0x8E, 0x7D, ++0xE0, 0xFB, 0x0D, 0xB1, 0x04, 0x90, 0x91, 0x15, 0xE0, 0x24, 0xF6, 0xF5, 0x82, 0xE4, 0x34, 0x8D, ++0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xB1, 0x04, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0x01, 0xFB, ++0x0D, 0xB1, 0x04, 0x90, 0x8E, 0x77, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, ++0xB1, 0x04, 0x90, 0x8E, 0x77, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, ++0xB1, 0x04, 0x90, 0x8D, 0x02, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xB1, 0x04, 0x90, 0x8D, 0x03, 0xE0, ++0xFB, 0x0D, 0xB1, 0x04, 0x90, 0x8E, 0x81, 0xE0, 0xFB, 0x0D, 0xB1, 0x04, 0x90, 0x8E, 0x80, 0xE0, ++0xFB, 0x0D, 0xB1, 0x04, 0x90, 0x8E, 0x79, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, 0xE4, 0xFD, 0x7F, 0x03, ++0xB1, 0x04, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0xB1, 0x04, ++0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0xB1, 0x04, 0x90, ++0x8E, 0x77, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0x80, 0x66, 0x90, 0x8E, 0x92, ++0xE0, 0x54, 0x01, 0xFB, 0xE4, 0xFD, 0xFF, 0xB1, 0x04, 0x90, 0x8E, 0x93, 0xE0, 0xC4, 0x13, 0x13, ++0x13, 0x54, 0x01, 0xFB, 0x0D, 0xE4, 0xFF, 0xB1, 0x04, 0x90, 0x8E, 0x93, 0xE0, 0xC4, 0x54, 0x01, ++0xFB, 0x0D, 0xE4, 0xFF, 0xB1, 0x04, 0x90, 0x8E, 0x97, 0xE0, 0x54, 0x01, 0xFB, 0x0D, 0xB1, 0x04, ++0x90, 0x8E, 0xA4, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xB1, 0x04, 0x90, 0x8E, 0xA5, 0xE0, 0xFB, 0x0D, ++0xB1, 0x04, 0x90, 0x8E, 0xA6, 0xE0, 0xFB, 0x0D, 0xB1, 0x04, 0xE4, 0xFB, 0x91, 0xF8, 0x91, 0xF8, ++0x0D, 0x80, 0x10, 0x90, 0x8D, 0xF2, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0xB1, 0x04, 0x90, 0x8D, 0xF3, ++0xE0, 0xFB, 0x0D, 0xB1, 0x04, 0x7F, 0x8F, 0xD1, 0x30, 0xEF, 0x30, 0xE0, 0x06, 0xE4, 0xFD, 0x7F, ++0x8D, 0x71, 0x67, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x0D, 0xB1, 0x04, 0xE4, 0xFD, 0x0F, 0xB1, 0x04, ++0x0D, 0xB1, 0x04, 0x0D, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, ++0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, ++0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, ++0xC3, 0xC0, 0xD0, 0x90, 0x91, 0x21, 0xED, 0xF0, 0x90, 0x91, 0x20, 0xEF, 0xF0, 0xD3, 0x94, 0x07, ++0x50, 0x6D, 0x7F, 0x47, 0xD1, 0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, ++0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, 0x71, 0x67, 0x7F, 0x46, 0xD1, ++0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, ++0xFC, 0x4F, 0xFD, 0x7F, 0x46, 0x71, 0x67, 0x90, 0x91, 0x21, 0xE0, 0x60, 0x17, 0x7F, 0x45, 0xD1, ++0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, ++0xFC, 0x4F, 0x80, 0x16, 0x7F, 0x45, 0xD1, 0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, ++0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x45, 0x80, 0x75, 0x90, ++0x91, 0x20, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0xD1, 0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, ++0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x71, ++0x67, 0x7F, 0x62, 0xD1, 0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, ++0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0x71, 0x67, 0x90, 0x91, 0x21, 0xE0, 0x60, ++0x1A, 0x7F, 0x61, 0xD1, 0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, ++0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x19, 0x7F, 0x61, 0xD1, 0x30, 0x90, ++0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, ++0x5F, 0xFD, 0x7F, 0x61, 0x71, 0x67, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x38, 0x07, 0x7F, 0x02, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xE0, 0x90, 0x91, 0x22, ++0xF0, 0x7F, 0x10, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x91, 0x22, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, ++0xAF, 0x22, 0x7F, 0x54, 0xD1, 0x30, 0xE5, 0x0D, 0x5F, 0xF5, 0x11, 0x7F, 0x55, 0xD1, 0x30, 0xE5, ++0x0E, 0x5F, 0xF5, 0x12, 0x7F, 0x56, 0xD1, 0x30, 0xE5, 0x0F, 0x5F, 0xF5, 0x13, 0x7F, 0x57, 0xD1, ++0x30, 0xE5, 0x10, 0x5F, 0xF5, 0x14, 0xAD, 0x11, 0x7F, 0x54, 0x71, 0x67, 0xAD, 0x12, 0x7F, 0x55, ++0x71, 0x67, 0xAD, 0x13, 0x7F, 0x56, 0x71, 0x67, 0xAD, 0x14, 0x7F, 0x57, 0x71, 0x67, 0x53, 0x91, ++0xEF, 0x22, 0x7F, 0x81, 0xD1, 0x30, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, 0x81, 0x71, 0x67, 0x7F, 0x80, ++0xD1, 0x30, 0xEF, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x71, 0x67, 0x12, 0x6F, 0xAE, 0x12, 0x3D, 0x3B, ++0x12, 0x6F, 0xBB, 0x12, 0x70, 0x7E, 0x7F, 0x01, 0x12, 0x47, 0x15, 0x90, 0x8F, 0x9D, 0x74, 0x02, ++0xF0, 0xFF, 0x12, 0x47, 0x15, 0x90, 0x8F, 0x9D, 0xE0, 0x04, 0xF0, 0x12, 0x50, 0x10, 0x12, 0x67, ++0x82, 0x7F, 0x80, 0xD1, 0x30, 0xEF, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x71, 0x67, 0x75, 0x28, 0xFF, ++0xF1, 0xF0, 0x12, 0x6F, 0xFC, 0x7F, 0x81, 0xD1, 0x30, 0xEF, 0x44, 0x04, 0xFD, 0x7F, 0x81, 0x71, ++0x67, 0x12, 0x70, 0x88, 0xE4, 0xFF, 0x02, 0x47, 0x9E, 0x90, 0x8E, 0x84, 0xE0, 0xFD, 0x7F, 0x93, ++0x71, 0x67, 0x90, 0x8E, 0x7B, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, ++0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x7F, 0x08, 0xD1, 0x30, 0xEF, 0x44, ++0x10, 0xFD, 0x7F, 0x08, 0x71, 0x67, 0x7F, 0x01, 0x12, 0x56, 0x17, 0x7F, 0x90, 0xD1, 0x30, 0xEF, ++0x44, 0x01, 0xFD, 0x7F, 0x90, 0x71, 0x67, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x10, 0xD1, 0x30, 0xEF, 0x44, 0x0C, 0xFD, 0x7F, 0x10, 0x71, ++0x67, 0x7F, 0x72, 0xD1, 0x30, 0xEF, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x71, 0x67, 0x90, 0x01, 0x01, ++0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, ++0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0xBC, 0xEF, 0x54, 0xBF, ++0xFF, 0xEC, 0x90, 0x91, 0x07, 0x12, 0x08, 0x6D, 0x90, 0x91, 0x07, 0x11, 0xC7, 0x90, 0xAA, 0xB9, ++0x12, 0x08, 0x6D, 0x7F, 0xB4, 0x7E, 0x08, 0xD1, 0x2B, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x71, ++0x67, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0x91, 0x07, ++0x12, 0x08, 0x6D, 0x90, 0x91, 0x07, 0x11, 0xC7, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0x00, ++0x7E, 0x0C, 0x12, 0x38, 0x07, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x03, 0xFF, ++0xEC, 0x90, 0x91, 0x07, 0x12, 0x08, 0x6D, 0x90, 0x91, 0x07, 0x11, 0xC7, 0x90, 0xAA, 0xB9, 0x12, ++0x08, 0x6D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x38, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x61, 0x81, ++0x75, 0xE8, 0x03, 0x75, 0xA8, 0x85, 0x22, 0x7F, 0xF4, 0xD1, 0x30, 0xEF, 0x20, 0xE5, 0x0E, 0x7F, ++0xF4, 0x12, 0x4E, 0x30, 0xEF, 0x7F, 0x01, 0x20, 0xE4, 0x05, 0x7F, 0x02, 0x22, 0x7F, 0x03, 0x22, ++0x12, 0x4F, 0xF7, 0x90, 0x8D, 0x04, 0xEF, 0xF0, 0x11, 0x2A, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, ++0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, 0x36, 0x83, 0x11, 0x95, 0x11, 0xC5, 0x11, 0x57, ++0x11, 0x76, 0xE4, 0xF5, 0x0D, 0xF5, 0x0E, 0xF5, 0x0F, 0xF5, 0x10, 0xAD, 0x0D, 0x7F, 0x50, 0x12, ++0x4B, 0x67, 0xAD, 0x0E, 0x7F, 0x51, 0x12, 0x4B, 0x67, 0xAD, 0x0F, 0x7F, 0x52, 0x12, 0x4B, 0x67, ++0xAD, 0x10, 0x7F, 0x53, 0x02, 0x4B, 0x67, 0x75, 0x15, 0x10, 0xE4, 0xF5, 0x16, 0x75, 0x17, 0x07, ++0x75, 0x18, 0x42, 0x90, 0x01, 0x30, 0xE5, 0x15, 0xF0, 0xA3, 0xE5, 0x16, 0xF0, 0xA3, 0xE5, 0x17, ++0xF0, 0xA3, 0xE5, 0x18, 0xF0, 0x22, 0x75, 0x1D, 0x06, 0x75, 0x1E, 0x01, 0x75, 0x1F, 0x03, 0x75, ++0x20, 0x62, 0x90, 0x01, 0x38, 0xE5, 0x1D, 0xF0, 0xA3, 0xE5, 0x1E, 0xF0, 0xA3, 0xE5, 0x1F, 0xF0, ++0xA3, 0xE5, 0x20, 0xF0, 0x22, 0x90, 0x01, 0x30, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, ++0x90, 0x01, 0x38, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x4B, 0x67, ++0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x4B, 0x67, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x4B, 0x67, 0xE4, 0xFD, ++0x7F, 0x53, 0x02, 0x4B, 0x67, 0x90, 0x01, 0x34, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, ++0xF0, 0x90, 0x01, 0x3C, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, 0x4B, ++0x67, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x4B, 0x67, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x4B, 0x67, 0x7D, ++0xFF, 0x7F, 0x57, 0x02, 0x4B, 0x67, 0xE4, 0x90, 0x8F, 0xAA, 0xF0, 0x90, 0x8F, 0xAA, 0xE0, 0x64, ++0x01, 0xF0, 0x24, 0xF6, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x50, 0xA3, 0xF0, 0x12, 0x3D, 0x6E, 0xBF, ++0x01, 0x03, 0x12, 0x31, 0x38, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x0E, 0x90, 0x8E, 0x7D, 0xE0, 0xFF, ++0x90, 0x8E, 0x7C, 0xE0, 0x6F, 0x60, 0x02, 0x31, 0x3D, 0xC2, 0xAF, 0x12, 0x70, 0x57, 0xBF, 0x01, ++0x02, 0x71, 0xA9, 0xD2, 0xAF, 0x12, 0x4F, 0xEE, 0x12, 0x46, 0x4D, 0x80, 0xBE, 0x90, 0x8E, 0x7C, ++0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x04, 0x7D, 0x01, 0x7F, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0x90, 0x91, 0x26, 0xED, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, ++0x30, 0xE0, 0x02, 0x41, 0x95, 0xEE, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x02, 0x41, ++0x95, 0x90, 0x8E, 0x7D, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x41, 0x95, 0xEF, 0x70, 0x02, 0x41, 0x0C, ++0x24, 0xFE, 0x70, 0x02, 0x41, 0x45, 0x24, 0xFE, 0x60, 0x4A, 0x24, 0xFC, 0x70, 0x02, 0x41, 0x80, ++0x24, 0xFC, 0x60, 0x02, 0x41, 0x95, 0xEE, 0xB4, 0x0E, 0x02, 0x71, 0x06, 0x90, 0x8E, 0x7D, 0xE0, ++0x70, 0x04, 0x7F, 0x01, 0x71, 0x64, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x06, 0x02, 0x51, 0xE0, 0x90, ++0x8E, 0x7D, 0xE0, 0xB4, 0x04, 0x0F, 0x90, 0x91, 0x26, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x81, 0x54, ++0x80, 0x03, 0x12, 0x6B, 0x63, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x41, 0x95, 0x12, ++0x82, 0x4D, 0x41, 0x95, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x71, 0x64, 0x90, 0x8E, ++0x7D, 0xE0, 0xB4, 0x06, 0x02, 0x51, 0xE0, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x0E, 0x07, 0x51, 0x9A, ++0xBF, 0x01, 0x02, 0x71, 0x06, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x41, 0x95, 0x51, ++0x9A, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x41, 0x95, 0x71, 0x2E, 0x41, 0x95, 0x90, 0x8E, 0x7D, 0xE0, ++0xB4, 0x0E, 0x07, 0x51, 0x9A, 0xBF, 0x01, 0x02, 0x71, 0x06, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x06, ++0x02, 0x51, 0xE0, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x0C, 0x07, 0x51, 0x9A, 0xBF, 0x01, 0x02, 0x71, ++0x2E, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x04, 0x70, 0x5C, 0x12, 0x80, 0x67, 0xEF, 0x64, 0x01, 0x70, ++0x54, 0xF1, 0x00, 0x80, 0x50, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x0E, 0x07, 0x51, 0x9A, 0xBF, 0x01, ++0x02, 0x71, 0x06, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x06, 0x02, 0x51, 0xE0, 0x90, 0x8E, 0x7D, 0xE0, ++0xB4, 0x0C, 0x07, 0x51, 0x9A, 0xBF, 0x01, 0x02, 0x71, 0x2E, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x04, ++0x7F, 0x01, 0x71, 0x64, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x04, 0x1A, 0x12, 0x81, 0x96, 0x80, 0x15, ++0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x0C, 0x0E, 0x90, 0x8E, 0x78, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, ++0x30, 0xE0, 0x02, 0x71, 0x9F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x80, 0x4E, 0xEF, 0x64, 0x01, ++0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2D, 0x90, 0x8E, 0x77, 0xE0, 0x13, 0x13, ++0x13, 0x54, 0x1F, 0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x19, 0x90, 0x8E, ++0x7C, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, 0x90, ++0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, 0x22, ++0x90, 0x8E, 0x78, 0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x8E, ++0x7D, 0x74, 0x04, 0xF0, 0x80, 0x0A, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, ++0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0x8E, 0x78, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0x90, ++0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x80, 0x11, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, ++0x80, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0x8D, ++0xF6, 0xE0, 0x64, 0x01, 0x70, 0x2D, 0x90, 0x8E, 0x78, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x22, ++0x74, 0x6F, 0xF0, 0x7F, 0x01, 0x71, 0xC8, 0xBF, 0x01, 0x0E, 0x90, 0x8E, 0x77, 0xE0, 0x44, 0x80, ++0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0E, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, ++0xB8, 0x04, 0xF0, 0x22, 0x90, 0x91, 0x25, 0xEF, 0xF0, 0x12, 0x4F, 0x3E, 0x90, 0x91, 0x25, 0xE0, ++0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x04, 0xF0, 0x22, 0x90, 0x8E, ++0x7A, 0xE0, 0x64, 0x01, 0x70, 0x18, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x60, 0x08, 0xE4, 0xFD, ++0x7F, 0x0C, 0x31, 0x4A, 0xC1, 0x88, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x02, 0x31, 0x46, 0x22, 0x12, ++0x77, 0xDC, 0x90, 0x8E, 0x7D, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0x30, 0xE0, 0x02, ++0xB1, 0xDB, 0x22, 0xD1, 0x88, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x0C, 0x60, 0x0A, 0xE4, 0xFD, 0x7F, ++0x0C, 0x31, 0x4A, 0xE4, 0xFF, 0x71, 0xC8, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, ++0x55, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1D, 0x90, 0x05, 0x22, 0xE0, 0xF5, 0x58, 0x74, 0xFF, 0xF0, ++0xF1, 0xF2, 0xBF, 0x01, 0x07, 0xAF, 0x55, 0x12, 0x82, 0x5C, 0x91, 0x4E, 0x90, 0x05, 0x22, 0xE5, ++0x58, 0xF0, 0x80, 0x02, 0x91, 0x4E, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, ++0x92, 0xAF, 0x22, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0x3F, ++0xF0, 0xEF, 0x60, 0x1D, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, ++0x10, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, ++0x22, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xEF, 0xF0, 0x74, ++0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0x90, 0x8D, ++0x07, 0xE0, 0xFF, 0x7D, 0x01, 0x91, 0xEF, 0x8E, 0x56, 0x8F, 0x57, 0xAD, 0x57, 0xAC, 0x56, 0xAF, ++0x55, 0x91, 0x03, 0xAF, 0x57, 0xAE, 0x56, 0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, ++0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x01, 0xF0, 0x74, 0x0D, ++0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, ++0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x11, 0x2C, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, 0xA7, 0xE4, 0xF0, 0x90, ++0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, 0x74, 0xFD, 0xF0, 0x74, ++0x14, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xED, 0xF0, 0x22, 0xE0, 0xFF, 0x7D, 0x01, 0xD3, ++0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x91, 0x1B, 0xED, 0xF0, 0x90, 0x91, 0x1A, 0xEF, 0xF0, ++0xE4, 0xFD, 0xFC, 0xF1, 0xD7, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x91, 0x1A, 0xE0, 0x90, 0x04, 0x25, ++0xF0, 0x90, 0x91, 0x1B, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, ++0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, ++0x54, 0xC0, 0xF0, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, ++0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x90, 0x5D, 0xF0, 0x90, ++0x06, 0xA9, 0xE0, 0x90, 0x90, 0x5D, 0xF0, 0xE0, 0x54, 0xC0, 0x70, 0x0C, 0x90, 0x8E, 0x7E, 0xE0, ++0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x21, 0x3D, 0x90, 0x90, 0x5D, 0xE0, 0x30, 0xE6, 0x21, 0x90, ++0x8E, 0x7A, 0xE0, 0x64, 0x01, 0x70, 0x20, 0x90, 0x8E, 0x7E, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x8E, ++0x79, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x04, 0xD1, 0xCA, 0x80, 0x0B, 0x71, 0xB3, 0x80, 0x07, ++0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x90, 0x5D, 0xE0, 0x90, 0x8E, 0x7E, 0x30, 0xE7, ++0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x8C, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, ++0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0x8E, ++0x77, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x8E, 0x7D, 0xE0, 0xFF, ++0x60, 0x03, 0xB4, 0x08, 0x0E, 0x12, 0x81, 0x0B, 0xBF, 0x01, 0x08, 0xB1, 0xF4, 0x90, 0x01, 0xE5, ++0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x4E, 0xF9, 0xD1, 0x05, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF1, 0xE8, 0x7F, 0x08, 0x12, 0x4E, 0x30, 0xEF, 0x54, 0xEF, 0xFD, ++0x7F, 0x08, 0x12, 0x4B, 0x67, 0xE4, 0xFF, 0x8F, 0x5A, 0xE4, 0x90, 0x91, 0x1E, 0xF0, 0xA3, 0xF0, ++0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0xEF, 0x65, 0x5A, 0x60, 0x3E, ++0xC3, 0x90, 0x91, 0x1F, 0xE0, 0x94, 0x88, 0x90, 0x91, 0x1E, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, ++0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x91, 0x1E, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, ++0xD6, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xD3, 0x90, 0x91, 0x1F, 0xE0, 0x94, 0x32, 0x90, ++0x91, 0x1E, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB2, 0x22, 0x90, ++0x8E, 0x7A, 0xE0, 0x60, 0x12, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x02, 0x80, 0x0A, 0x90, 0x8E, ++0x77, 0xE0, 0x54, 0xF7, 0xF0, 0x31, 0x3D, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0x13, 0x13, 0x13, 0x54, ++0x1F, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x90, ++0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x8D, 0xE0, 0xC3, 0x13, 0x54, 0x7F, ++0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x5B, 0x74, ++0x05, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x13, ++0x90, 0x8D, 0x06, 0xE0, 0xFF, 0xE4, 0xFD, 0x91, 0xEF, 0x8E, 0x26, 0x8F, 0x27, 0x90, 0x04, 0x1F, ++0x74, 0x20, 0xF0, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, 0x01, 0x14, 0x90, 0x8E, 0x7A, 0xE0, 0x60, ++0x0E, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x02, 0x80, 0xCD, 0x71, 0xB3, 0x22, ++0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0xF1, 0xF2, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, ++0x03, 0xF1, 0x1C, 0x12, 0x77, 0xE2, 0xE4, 0x90, 0x8E, 0x7D, 0xF0, 0x22, 0x74, 0x15, 0x2F, 0xF8, ++0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, ++0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, 0xF1, 0x1C, ++0x7D, 0x02, 0x7F, 0x03, 0xF1, 0x1C, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0xF0, 0x90, 0x8E, 0x85, ++0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, 0x01, 0x14, 0x90, 0x8E, 0x78, ++0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x20, 0xE2, 0x0D, 0x7D, 0x01, 0x7F, 0x04, 0x21, ++0x4A, 0x90, 0x8E, 0x78, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xEF, 0x70, 0x33, 0x7D, 0x78, 0x7F, 0x02, ++0xF1, 0xBB, 0x7D, 0x02, 0x7F, 0x03, 0xF1, 0xBB, 0x7D, 0xC8, 0x7F, 0x02, 0x12, 0x78, 0xC6, 0x90, ++0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x7D, 0x01, 0x7F, 0x0C, 0x31, 0x4A, ++0x90, 0x8E, 0x77, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x80, ++0x80, 0x7D, 0x02, 0x7F, 0x02, 0xF1, 0xBB, 0x7D, 0x01, 0x7F, 0x02, 0x74, 0x15, 0x2F, 0xF8, 0xE6, ++0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, ++0xEE, 0xF0, 0x22, 0xE4, 0xFF, 0x61, 0xC8, 0x90, 0xFD, 0x10, 0xEF, 0xF0, 0x7F, 0x00, 0x22, 0x90, ++0x8E, 0x7A, 0xE0, 0x60, 0x02, 0x71, 0x7E, 0x22, 0x7F, 0x90, 0x12, 0x4E, 0x30, 0xEF, 0x20, 0xE0, ++0xF7, 0x22, 0xE4, 0x90, 0x91, 0x1C, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, ++0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, ++0x91, 0x1D, 0xE0, 0x94, 0xE8, 0x90, 0x91, 0x1C, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, ++0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x91, ++0x1C, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x80, 0xBF, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, ++0x12, 0x48, 0x4E, 0x90, 0x8F, 0xAB, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x8D, 0x01, 0xE0, 0xFF, 0x60, ++0xE9, 0xC2, 0xAF, 0x30, 0xE1, 0x06, 0x54, 0xFD, 0xF0, 0x12, 0x62, 0xCD, 0xD2, 0xAF, 0xC2, 0xAF, ++0x90, 0x8D, 0x01, 0xE0, 0xFF, 0x30, 0xE2, 0x06, 0x54, 0xFB, 0xF0, 0x12, 0x6D, 0xB9, 0xD2, 0xAF, ++0xC2, 0xAF, 0x90, 0x8D, 0x01, 0xE0, 0xFF, 0x30, 0xE4, 0x0B, 0x54, 0xEF, 0xF0, 0x12, 0x79, 0xA0, ++0xBF, 0x01, 0x02, 0x11, 0x89, 0xD2, 0xAF, 0x80, 0xC1, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0xE4, 0x90, 0x90, 0x9F, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, ++0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0xE0, 0x7C, 0x00, 0x24, ++0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x90, 0x95, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x82, 0xE0, 0x90, ++0x90, 0x9E, 0xF0, 0x90, 0x8E, 0x92, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0xC8, 0x90, 0x8E, 0x97, 0xE0, ++0x20, 0xE0, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x02, 0xF1, 0x27, 0xE4, 0x90, 0x90, 0x9D, ++0xF0, 0x90, 0x90, 0x9E, 0xE0, 0xFF, 0x90, 0x90, 0x9D, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0x41, 0xC8, ++0x90, 0x90, 0x95, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x90, ++0xA5, 0xEF, 0xF0, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, ++0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, ++0x3E, 0x54, 0x3F, 0xFE, 0x90, 0x90, 0x97, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x90, 0xA3, 0xEE, 0xF0, ++0xA3, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, ++0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x90, 0x9B, 0xF0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0xFE, 0x90, ++0x90, 0x96, 0xE0, 0x2F, 0xFF, 0x90, 0x90, 0x95, 0xE0, 0x3E, 0xFE, 0x90, 0x90, 0x99, 0xF0, 0xA3, ++0xEF, 0xF0, 0xE4, 0xFD, 0x51, 0xDF, 0xC0, 0x07, 0x90, 0x90, 0x99, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, ++0x7D, 0x04, 0x51, 0xDF, 0xAD, 0x07, 0xD0, 0x07, 0xF1, 0x68, 0x90, 0x90, 0x9F, 0xEF, 0xF0, 0x90, ++0x90, 0x99, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xE4, 0xFD, 0x51, 0xDF, 0xEF, 0x54, 0xFC, 0x90, 0x90, ++0x9C, 0xF0, 0x90, 0x90, 0x9B, 0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0x90, 0x90, 0x97, 0x8F, 0xF0, ++0x12, 0x08, 0xD6, 0x90, 0x90, 0x97, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x79, 0xDD, 0x90, 0x90, ++0x97, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x90, 0x95, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7D, 0x0F, ++0x51, 0xDF, 0x90, 0x90, 0x97, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x90, 0x90, 0x95, 0xEC, 0x8D, 0xF0, ++0x12, 0x08, 0xD6, 0x90, 0x8D, 0xF4, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x90, 0x90, 0x96, 0xE0, ++0x9D, 0x90, 0x90, 0x95, 0xE0, 0x9C, 0x40, 0x1B, 0x90, 0x8D, 0xF5, 0xE0, 0x24, 0x01, 0xFD, 0x90, ++0x8D, 0xF4, 0xE0, 0x34, 0x00, 0xFC, 0xC3, 0x90, 0x90, 0x96, 0xE0, 0x9D, 0xF0, 0x90, 0x90, 0x95, ++0xE0, 0x9C, 0xF0, 0xEF, 0x30, 0xE7, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x21, 0xF0, 0xEF, 0x30, 0xE6, ++0x06, 0x90, 0x01, 0xC7, 0x74, 0x22, 0xF0, 0xEF, 0x30, 0xE5, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x23, ++0xF0, 0x90, 0x90, 0x9C, 0xE0, 0x24, 0x40, 0x60, 0x04, 0x24, 0x20, 0x70, 0x31, 0x90, 0x8E, 0x93, ++0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x58, 0x90, 0x8E, 0xA4, 0xE0, 0x04, ++0xF0, 0x90, 0x90, 0x99, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF1, 0x81, 0xEF, 0x60, 0x45, 0x90, 0x90, ++0x9C, 0xE0, 0xFF, 0x12, 0x7E, 0x52, 0x90, 0x8E, 0xA5, 0xE0, 0x04, 0xF0, 0x80, 0x35, 0x90, 0x90, ++0x99, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x90, 0x9F, 0xE0, 0xFD, 0x90, 0x90, 0xA2, 0xE0, 0xFB, ++0x90, 0x90, 0xA5, 0xE0, 0x90, 0x90, 0xFA, 0xF0, 0xD1, 0x90, 0x90, 0x8E, 0x92, 0xE0, 0xFF, 0xC3, ++0x13, 0x30, 0xE0, 0x0F, 0x90, 0x90, 0x99, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x90, 0x9F, 0xE0, ++0xFD, 0x91, 0xCB, 0x12, 0x7E, 0x69, 0xEF, 0x64, 0x01, 0x60, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, ++0xE2, 0x02, 0xF1, 0x27, 0x12, 0x7E, 0x2C, 0xBF, 0x01, 0x0D, 0x90, 0x8E, 0xA6, 0xE0, 0x04, 0xF0, ++0x90, 0x90, 0x95, 0xF1, 0xDA, 0x80, 0x09, 0x90, 0x8E, 0x92, 0xE0, 0x54, 0xFE, 0xF0, 0x80, 0x08, ++0x90, 0x90, 0x9D, 0xE0, 0x04, 0xF0, 0x01, 0xE1, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFD, 0x90, 0x8F, ++0xB6, 0xE0, 0x34, 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0xE4, 0xFD, 0xAB, ++0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0x8D, 0xF5, 0xE0, 0x9B, 0x90, ++0x8D, 0xF4, 0xE0, 0x9A, 0x50, 0x13, 0xA3, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8D, 0xF4, 0xE0, 0x34, ++0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, ++0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFF, 0x22, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8F, 0xAF, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, ++0x8F, 0xB4, 0x74, 0x08, 0xF0, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xEF, 0x44, 0x08, 0xF0, 0x90, 0x8F, ++0xAF, 0xA3, 0xE0, 0xFE, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFF, 0x74, ++0x04, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF1, 0x64, 0x90, 0x8F, 0xB0, 0xE0, 0x2F, 0xFF, 0x90, ++0x8F, 0xAF, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x8F, 0xB4, 0xE0, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x3E, ++0x90, 0x8F, 0xB6, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, 0x00, 0x7F, 0x83, 0x7D, 0x00, 0x7B, 0x01, 0x7A, ++0x8E, 0x79, 0xF4, 0x12, 0x08, 0xAA, 0x90, 0x8F, 0xB7, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8F, 0xB6, ++0xE0, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0x90, 0x8E, 0xF5, 0xEF, 0xF0, 0x90, 0x8F, 0xB7, ++0xE0, 0x24, 0x04, 0xFF, 0x90, 0x8F, 0xB6, 0xE0, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0x90, ++0x8E, 0xF8, 0xEF, 0xF0, 0x90, 0x8F, 0xB7, 0xE0, 0x24, 0x05, 0xFF, 0x90, 0x8F, 0xB6, 0xE0, 0x34, ++0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0x90, 0x8E, 0xF9, 0xEF, 0xF0, 0x90, 0x8F, 0xB7, 0xE0, 0x24, ++0x06, 0xFF, 0x90, 0x8F, 0xB6, 0xE0, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0x90, 0x8E, 0xFA, ++0xEF, 0xF0, 0x90, 0x8F, 0xB7, 0xE0, 0x24, 0x07, 0xFF, 0x90, 0x8F, 0xB6, 0xE0, 0x34, 0x00, 0xFE, ++0xE4, 0xFD, 0x51, 0xDF, 0x90, 0x8E, 0xFB, 0xEF, 0xF0, 0x90, 0x8F, 0xB7, 0xE0, 0x24, 0x08, 0xFF, ++0x90, 0x8F, 0xB6, 0xE0, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0x90, 0x8E, 0xFC, 0xEF, 0xF0, ++0xE4, 0x90, 0x8F, 0xB5, 0xF0, 0x90, 0x8F, 0xB5, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x1F, 0x90, ++0x8F, 0xB7, 0xE0, 0x24, 0x09, 0x51, 0xCD, 0x90, 0x8F, 0xB5, 0xE0, 0x24, 0xFD, 0xF5, 0x82, 0xE4, ++0x34, 0x8E, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xB5, 0xE0, 0x04, 0xF0, 0x80, 0xD7, 0xE4, 0x90, ++0x8F, 0xB5, 0xF0, 0x90, 0x8F, 0xB5, 0xE0, 0xFF, 0xC3, 0x94, 0x20, 0x50, 0x1F, 0x90, 0x8F, 0xB7, ++0xE0, 0x24, 0x63, 0x51, 0xCD, 0x90, 0x8F, 0xB5, 0xE0, 0x24, 0x57, 0xF5, 0x82, 0xE4, 0x34, 0x8F, ++0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xB5, 0xE0, 0x04, 0xF0, 0x80, 0xD7, 0x90, 0x8E, 0xF9, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFD, 0xED, 0xFF, 0x90, 0x8F, 0xB2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x30, 0xE3, ++0x04, 0xF1, 0x27, 0x80, 0x3F, 0x90, 0x8F, 0xB2, 0xA3, 0xE0, 0xFF, 0x7C, 0x00, 0x54, 0x07, 0xFD, ++0x64, 0x01, 0x60, 0x05, 0xED, 0x64, 0x02, 0x70, 0x2B, 0xED, 0x64, 0x02, 0x4C, 0x70, 0x25, 0xEF, ++0x54, 0x30, 0xFF, 0xE4, 0xC4, 0xF8, 0x54, 0xF0, 0xC8, 0xEF, 0xC4, 0x54, 0x0F, 0x48, 0x90, 0x8F, ++0x8D, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xE4, 0xFD, 0x12, 0x76, 0x35, 0x90, 0x06, 0x31, 0xE0, 0x54, ++0xF7, 0x44, 0x10, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8F, 0xAF, 0xEE, 0xF0, ++0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x78, 0xB8, 0x7C, 0x8F, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, ++0x79, 0x56, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x06, 0x63, 0x78, 0xBE, 0x7C, 0x8F, 0x7D, 0x01, 0x7B, ++0xFF, 0x7A, 0x40, 0x79, 0x5C, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x06, 0x63, 0x78, 0xC2, 0x7C, 0x8F, ++0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x60, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x06, 0x63, 0x90, ++0x8F, 0xB1, 0xE0, 0xFF, 0x90, 0x8F, 0xB0, 0xE0, 0x2F, 0xFF, 0x90, 0x8F, 0xAF, 0xE0, 0x34, 0x00, ++0xCF, 0x24, 0x06, 0xCF, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0xEF, 0x64, 0x08, 0x60, 0x02, ++0xC1, 0x8F, 0x90, 0x8F, 0xB1, 0xE0, 0xFF, 0x90, 0x8F, 0xB0, 0xE0, 0x2F, 0xFF, 0x90, 0x8F, 0xAF, ++0xE0, 0x34, 0x00, 0xCF, 0x24, 0x07, 0xCF, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0xEF, 0x64, ++0x06, 0x60, 0x02, 0xC1, 0x8F, 0x90, 0x8F, 0xC6, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0xFF, 0xC3, 0x94, ++0x06, 0x50, 0x23, 0x90, 0x8F, 0xB0, 0xE0, 0x24, 0x0A, 0xFD, 0x90, 0x8F, 0xAF, 0x51, 0xD1, 0x90, ++0x8F, 0xC6, 0xE0, 0x24, 0xB2, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, ++0xC6, 0xE0, 0x04, 0xF0, 0x80, 0xD3, 0xE4, 0x90, 0x8F, 0xC6, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0xFF, ++0xC3, 0x94, 0x06, 0x50, 0x2E, 0x90, 0x8F, 0xB1, 0xE0, 0xFD, 0x90, 0x8F, 0xB0, 0xE0, 0x2D, 0xFD, ++0x90, 0x8F, 0xAF, 0xE0, 0x34, 0x00, 0xCD, 0x24, 0x10, 0xCD, 0x51, 0xD2, 0x90, 0x8F, 0xC6, 0xE0, ++0x24, 0xB8, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0x04, ++0xF0, 0x80, 0xC8, 0xE4, 0x90, 0x8F, 0xC6, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0xFF, 0xC3, 0x94, 0x04, ++0x50, 0x2E, 0x90, 0x8F, 0xB1, 0xE0, 0xFD, 0x90, 0x8F, 0xB0, 0xE0, 0x2D, 0xFD, 0x90, 0x8F, 0xAF, ++0xE0, 0x34, 0x00, 0xCD, 0x24, 0x16, 0xCD, 0x51, 0xD2, 0x90, 0x8F, 0xC6, 0xE0, 0x24, 0xBE, 0xF5, ++0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0x04, 0xF0, 0x80, 0xC8, ++0x78, 0xB2, 0x7C, 0x8F, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0x9E, 0x7E, 0x00, 0x7F, 0x06, ++0x12, 0x4A, 0xA9, 0xEF, 0x70, 0x79, 0x90, 0x8F, 0xC6, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0xFF, 0xC3, ++0x94, 0x04, 0x50, 0x2E, 0x90, 0x8F, 0xB1, 0xE0, 0xFD, 0x90, 0x8F, 0xB0, 0xE0, 0x2D, 0xFD, 0x90, ++0x8F, 0xAF, 0xE0, 0x34, 0x00, 0xCD, 0x24, 0x20, 0xCD, 0x51, 0xD2, 0x90, 0x8F, 0xC6, 0xE0, 0x24, ++0xC2, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0x04, 0xF0, ++0x80, 0xC8, 0x78, 0xC2, 0x7C, 0x8F, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xA7, 0x7E, 0x00, ++0x7F, 0x04, 0x12, 0x4A, 0xA9, 0xEF, 0x90, 0x06, 0x30, 0x70, 0x1E, 0xE0, 0x44, 0x01, 0x54, 0xDF, ++0xF0, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xB8, 0x90, 0x8F, 0xCA, 0x12, 0x48, 0xF4, 0xE4, 0x90, 0x8F, ++0xCD, 0xF0, 0x7A, 0x8F, 0x79, 0xBE, 0x02, 0x71, 0x7F, 0xE0, 0x44, 0x21, 0x54, 0xEF, 0xF0, 0x22, ++0x90, 0x90, 0xF8, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x90, 0xF6, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, ++0xE4, 0xFD, 0x51, 0xDF, 0xEF, 0x54, 0x0C, 0x64, 0x08, 0x70, 0x7B, 0x90, 0x90, 0xF6, 0xE0, 0xFE, ++0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0x06, 0xFD, 0x51, 0xDF, 0xEF, 0x64, 0x88, 0x70, 0x67, 0x90, ++0x90, 0xF6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0x07, 0xFD, 0x51, 0xDF, 0xEF, 0x64, ++0x8E, 0x70, 0x53, 0x90, 0x90, 0xF6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x90, 0xF9, 0xE0, 0xFD, ++0x90, 0x90, 0xF8, 0xE0, 0x2D, 0x04, 0xFD, 0x51, 0xDF, 0xEF, 0x64, 0x03, 0x70, 0x38, 0x90, 0x90, ++0xF6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x90, 0xF9, 0xE0, 0xFD, 0x90, 0x90, 0xF8, 0xE0, 0x2D, ++0x24, 0x06, 0xFD, 0x51, 0xDF, 0xEF, 0x30, 0xE3, 0x0E, 0x90, 0x01, 0xC7, 0x74, 0x01, 0xF0, 0x90, ++0x8E, 0x97, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x90, 0xF6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, ++0x90, 0xFA, 0xE0, 0xFD, 0x71, 0x1D, 0x22, 0x90, 0x8D, 0x04, 0xE0, 0xB4, 0x02, 0x15, 0x90, 0x8E, ++0x94, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x0F, 0x90, 0x01, 0x4D, 0xE0, 0x64, ++0x80, 0xF0, 0x22, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, ++0xFE, 0x24, 0x28, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x2C, 0x2E, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFD, 0xE4, 0xFE, 0xEF, 0x30, 0xE7, 0x04, 0x7C, 0x02, ++0x80, 0x02, 0xE4, 0xFC, 0xAF, 0x05, 0x12, 0x77, 0x78, 0xAE, 0x07, 0xEC, 0x24, 0x18, 0x2E, 0xFF, ++0x22, 0x90, 0x90, 0xD3, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0x90, 0xDB, 0xF0, 0x90, 0x90, ++0xDB, 0xE0, 0xFD, 0xC3, 0x94, 0x06, 0x50, 0x27, 0x90, 0x90, 0xD4, 0xE0, 0x24, 0x04, 0xFF, 0x90, ++0x90, 0xD3, 0xE0, 0x34, 0x00, 0xFE, 0x51, 0xDF, 0x90, 0x90, 0xDB, 0xE0, 0x24, 0xD5, 0xF5, 0x82, ++0xE4, 0x34, 0x90, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x90, 0xDB, 0xE0, 0x04, 0xF0, 0x80, 0xCF, 0x78, ++0x98, 0x7C, 0x8E, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xD5, 0x7E, 0x00, 0x7F, 0x06, 0x12, ++0x4A, 0xA9, 0xEF, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, ++0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, ++0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0xED, 0x90, 0x01, ++0xC4, 0xED, 0xF0, 0x74, 0x5F, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, ++0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, ++0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, ++0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x1E, ++0xF0, 0x74, 0x60, 0xA3, 0xF0, 0x12, 0x4E, 0x52, 0x74, 0x1E, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, ++0x60, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, ++0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, ++0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, ++0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x6E, ++0xF0, 0x74, 0x60, 0xA3, 0xF0, 0x12, 0x70, 0x92, 0xE5, 0x19, 0x30, 0xE3, 0x02, 0x31, 0xEF, 0xE5, ++0x19, 0x30, 0xE4, 0x02, 0x31, 0xDC, 0xE5, 0x1B, 0x30, 0xE0, 0x02, 0x31, 0x0F, 0xE5, 0x1B, 0x30, ++0xE1, 0x02, 0x51, 0x33, 0xE5, 0x1B, 0x30, 0xE2, 0x02, 0x31, 0xFB, 0xE5, 0x1B, 0x30, 0xE3, 0x03, ++0x12, 0x70, 0xEF, 0xE5, 0x1B, 0x30, 0xE4, 0x03, 0x12, 0x71, 0x22, 0xE5, 0x1B, 0x30, 0xE5, 0x03, ++0x12, 0x56, 0xE4, 0xE5, 0x1B, 0x30, 0xE6, 0x02, 0xF1, 0xCD, 0xE5, 0x1C, 0x30, 0xE1, 0x03, 0x12, ++0x57, 0xDF, 0xE5, 0x1C, 0x30, 0xE6, 0x02, 0x31, 0x9C, 0x74, 0x6E, 0x04, 0x90, 0x01, 0xC4, 0xF0, ++0x74, 0x60, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, ++0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, ++0xFF, 0x90, 0x8E, 0x7A, 0xE0, 0x70, 0x02, 0x21, 0x9B, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, ++0x7A, 0x90, 0x8E, 0x79, 0xE0, 0xC4, 0x54, 0x0F, 0x60, 0x24, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, ++0x1F, 0x90, 0x8E, 0x81, 0xE0, 0x14, 0xF0, 0xE0, 0xFE, 0x60, 0x06, 0x90, 0x8E, 0x83, 0xE0, 0x60, ++0x0F, 0xEE, 0x70, 0x06, 0x90, 0x8E, 0x80, 0xE0, 0xA3, 0xF0, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x01, ++0xEF, 0x60, 0x48, 0x90, 0x8E, 0x7E, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x8E, 0x83, 0xE0, 0x60, 0x03, ++0xB4, 0x01, 0x09, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x83, 0xE0, 0x80, 0x0D, 0xE4, 0xF5, 0x3B, 0x90, ++0x8E, 0x83, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0x8E, 0x82, 0xE0, 0x2F, 0xF5, ++0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, 0x74, 0x05, ++0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x51, 0x46, 0x22, 0x90, 0x07, 0x1F, 0xE0, ++0x54, 0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, 0x90, 0x5F, 0xF0, 0x90, 0x90, 0x5D, ++0x74, 0x02, 0xF0, 0x90, 0x90, 0x6B, 0x14, 0xF0, 0xFB, 0x7A, 0x90, 0x79, 0x5D, 0x71, 0xAE, 0x7F, ++0x04, 0x90, 0x91, 0x23, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x48, 0x27, 0x90, 0x8D, 0x01, 0xE0, 0xFF, ++0x90, 0x91, 0x23, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x8D, 0x01, 0xF0, 0x22, 0xF1, 0xE9, 0x7F, 0x02, ++0x8F, 0x59, 0x7F, 0x02, 0x12, 0x48, 0x27, 0x90, 0x8D, 0x01, 0xE0, 0x45, 0x59, 0xF0, 0x22, 0x90, ++0x8E, 0x92, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x10, 0x31, 0xE0, 0x22, 0x90, 0x8F, 0xA6, 0xE0, 0x04, ++0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x02, 0x60, 0x29, 0xB1, 0xB5, 0x90, 0x8E, 0x78, 0xE0, 0x13, ++0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x15, 0x90, 0x8E, 0x80, 0xE0, 0xFF, 0xA3, 0xE0, 0x6F, 0x70, ++0x0B, 0xD1, 0x4B, 0x12, 0x57, 0xB1, 0x90, 0x8E, 0x81, 0xE0, 0x14, 0xF0, 0x90, 0x01, 0xE6, 0xE0, ++0x04, 0xF0, 0x22, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x46, 0x90, 0x8E, 0x78, 0xE0, 0xFF, 0x13, 0x13, ++0x13, 0x54, 0x1F, 0x30, 0xE0, 0x13, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0C, 0x12, 0x57, 0xB1, ++0x90, 0x8E, 0x80, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0x91, 0x18, 0xE4, 0x75, 0xF0, 0x01, ++0x12, 0x08, 0xD6, 0xC3, 0x90, 0x91, 0x19, 0xE0, 0x94, 0x80, 0x90, 0x91, 0x18, 0xE0, 0x64, 0x80, ++0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x12, ++0x7F, 0x3E, 0x90, 0x8F, 0x9E, 0xE0, 0x30, 0xE0, 0x2E, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, 0x01, 0x27, ++0x90, 0x91, 0x24, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0x8F, 0xA0, 0xE0, 0x04, 0xF0, ++0xE4, 0x90, 0x91, 0x24, 0xF0, 0x90, 0x8F, 0xA0, 0xE0, 0xFF, 0x90, 0x8F, 0x9F, 0xE0, 0xB5, 0x07, ++0x06, 0xE4, 0xA3, 0xF0, 0x12, 0x57, 0xD3, 0x22, 0x12, 0x81, 0xAF, 0x90, 0x8E, 0x80, 0xE0, 0x14, ++0x90, 0x05, 0x73, 0xF0, 0x7D, 0x02, 0x7F, 0x02, 0x12, 0x57, 0x1C, 0x80, 0xB5, 0xD3, 0x10, 0xAF, ++0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8D, 0x5B, 0xE0, 0xFF, 0x90, 0x8D, 0x5A, 0xE0, 0xB5, 0x07, 0x04, ++0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x3F, 0x90, 0x8D, 0x5A, 0xE0, 0xFE, 0x75, 0xF0, ++0x08, 0x90, 0x8D, 0x0A, 0x12, 0x48, 0xDF, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x0B, ++0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0xD1, 0x6F, 0x90, 0x8D, 0x5A, 0xE0, ++0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x8D, ++0x5A, 0xF0, 0xF1, 0xE9, 0x7F, 0x02, 0x31, 0xC1, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x90, 0xA6, ++0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, 0x52, 0xA3, 0xE0, 0xF5, 0x53, 0x65, 0x52, 0x60, 0x6D, ++0x90, 0x90, 0xA7, 0x74, 0x03, 0xF0, 0x90, 0x90, 0xB5, 0x74, 0x08, 0xF0, 0xE5, 0x53, 0x04, 0x54, ++0x0F, 0xF5, 0x54, 0xE4, 0xF5, 0x51, 0xE5, 0x54, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, ++0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x51, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, ++0xE0, 0xFF, 0x74, 0xA9, 0x25, 0x51, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xEF, 0xF0, 0x05, ++0x51, 0xE5, 0x51, 0xB4, 0x08, 0xD0, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xA7, 0x71, 0xAE, 0xE5, 0x53, ++0x04, 0x54, 0x0F, 0xF5, 0x53, 0xB4, 0x0F, 0x03, 0xE4, 0xF5, 0x53, 0x90, 0x04, 0x7F, 0xE5, 0x53, ++0xF0, 0x90, 0x90, 0xA6, 0xE0, 0x7F, 0x04, 0x70, 0x02, 0x21, 0xE0, 0x31, 0xC1, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8D, 0xF2, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, ++0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x8D, 0xF3, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, ++0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x35, 0xC0, 0x01, ++0x90, 0x8D, 0xF3, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x5C, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xA8, ++0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x06, 0x63, 0x90, 0x8D, 0xF3, ++0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, ++0x8D, 0xF3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, ++0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, ++0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x18, 0xF0, 0x74, 0x64, 0xA3, 0xF0, 0x12, ++0x70, 0xBF, 0xE5, 0x21, 0x30, 0xE1, 0x02, 0x91, 0x9C, 0xE5, 0x21, 0x30, 0xE2, 0x03, 0x12, 0x56, ++0x6F, 0xE5, 0x22, 0x30, 0xE0, 0x02, 0xB1, 0x6B, 0xE5, 0x24, 0x30, 0xE1, 0x04, 0x7F, 0x04, 0x31, ++0xE0, 0xE5, 0x24, 0x30, 0xE4, 0x02, 0x51, 0xB8, 0xE5, 0x24, 0x30, 0xE5, 0x02, 0x91, 0xA6, 0xE5, ++0x24, 0x30, 0xE6, 0x02, 0xB1, 0x2D, 0x74, 0x18, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x64, 0xA3, ++0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, ++0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x8E, 0x7A, 0xE0, ++0x60, 0x03, 0x12, 0x81, 0xEF, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, ++0x30, 0xE0, 0x27, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x8E, 0x78, 0x30, 0xE0, ++0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, ++0xF0, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x12, 0x51, 0x3D, 0xE4, 0xFF, 0x90, 0x8F, 0xA1, 0xE0, ++0x30, 0xE0, 0x49, 0x90, 0x8F, 0xA5, 0xE0, 0xFD, 0x60, 0x42, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, ++0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, ++0xEF, 0x5B, 0x60, 0x06, 0xE4, 0x90, 0x8F, 0xA5, 0xF0, 0x22, 0x90, 0x8F, 0xA3, 0xE0, 0xD3, 0x9D, ++0x50, 0x11, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0x12, 0x5F, 0x27, 0x90, 0x8F, 0xA1, 0xE0, 0x54, ++0xFE, 0xF0, 0x22, 0x12, 0x57, 0xD3, 0x90, 0x8F, 0xA5, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x8E, 0x77, ++0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x2C, 0xEF, 0x54, 0x7F, 0xF0, 0x90, ++0x04, 0xE0, 0xE0, 0x90, 0x8E, 0x78, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x0F, 0xE0, ++0x54, 0xFD, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x90, 0x8E, ++0x7A, 0xE0, 0x60, 0x03, 0x12, 0x51, 0x3D, 0x7F, 0x01, 0x81, 0xDC, 0x12, 0x78, 0x7B, 0x90, 0x90, ++0x6C, 0xEF, 0xF0, 0x90, 0x8E, 0x77, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x04, 0xE0, ++0x54, 0xFE, 0xF0, 0x90, 0x90, 0x6C, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, ++0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x30, ++0xE0, 0x12, 0x90, 0x8E, 0x85, 0xE4, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x90, 0x8E, 0x85, 0xA3, 0xE0, ++0x90, 0x05, 0x58, 0xF0, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x60, 0x02, 0xC1, 0x4A, 0x90, ++0x8E, 0x7A, 0xE0, 0x70, 0x02, 0xC1, 0x4A, 0x90, 0x8E, 0x79, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, ++0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x8E, 0x81, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0x8E, ++0x80, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x8E, 0x80, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, ++0x8E, 0x81, 0xEF, 0xF0, 0x90, 0x8E, 0x78, 0xE0, 0x44, 0x04, 0xF0, 0xE4, 0x90, 0x8E, 0x83, 0xF0, ++0x90, 0x8E, 0x85, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, ++0x3C, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xEF, 0xF0, 0x90, 0x8E, ++0x79, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x03, 0x12, 0x55, 0x5A, 0x90, ++0x8E, 0x78, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0F, 0x90, 0x8E, 0x80, 0xE0, 0xFF, ++0xA3, 0xE0, 0xB5, 0x07, 0x05, 0xD1, 0x4B, 0x12, 0x57, 0xB7, 0x22, 0xEF, 0x14, 0x90, 0x05, 0x73, ++0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x74, 0x1D, 0x2F, 0xF8, 0xE6, 0x4D, ++0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, ++0x8F, 0xAC, 0x12, 0x48, 0xF4, 0xEF, 0x12, 0x48, 0xFD, 0x66, 0xA7, 0x00, 0x66, 0xB0, 0x01, 0x66, ++0xB9, 0x02, 0x66, 0xC2, 0x03, 0x66, 0xCB, 0x04, 0x66, 0xD3, 0x20, 0x66, 0xDC, 0x21, 0x66, 0xE5, ++0x23, 0x66, 0xED, 0x25, 0x66, 0xFE, 0x80, 0x66, 0xF5, 0x81, 0x67, 0x07, 0x82, 0x67, 0x0F, 0x83, ++0x67, 0x18, 0x84, 0x00, 0x00, 0x67, 0x21, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x6A, 0x58, ++0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x6A, 0xA0, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, ++0x6B, 0x76, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x79, 0x80, 0x90, 0x8F, 0xAC, 0x12, 0x48, ++0xEB, 0x80, 0x56, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x6B, 0xAE, 0x90, 0x8F, 0xAC, 0x12, ++0x48, 0xEB, 0x02, 0x6C, 0xAA, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x80, 0x68, 0x90, 0x8F, 0xAC, ++0x12, 0x48, 0xEB, 0x80, 0x68, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x7B, 0xC4, 0x90, 0x8F, ++0xAC, 0x12, 0x48, 0xEB, 0x02, 0x7D, 0x6E, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0xE1, 0xB3, 0x90, ++0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x7E, 0x87, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x7E, ++0xDC, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xF1, 0x6D, 0x12, 0x06, 0x89, 0xFF, 0x54, ++0x01, 0xFE, 0x90, 0x8F, 0xA1, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x14, ++0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0x8F, 0xA2, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, ++0x90, 0x8F, 0xA3, 0xF0, 0x22, 0x12, 0x06, 0x89, 0x90, 0x8E, 0x84, 0xF0, 0x22, 0x12, 0x06, 0x89, ++0x90, 0x8E, 0x91, 0xF0, 0x90, 0x8E, 0x91, 0xE0, 0x90, 0x01, 0xE7, 0xF0, 0x22, 0x90, 0x8F, 0xA1, ++0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, ++0xF0, 0x22, 0xF1, 0x8D, 0xF1, 0x93, 0x12, 0x7F, 0x7C, 0xF1, 0xA1, 0x80, 0xE0, 0xE4, 0x90, 0x8D, ++0xF6, 0xF0, 0x22, 0xE4, 0x90, 0x8D, 0xF2, 0xF0, 0xA3, 0xF0, 0x90, 0x8D, 0x5A, 0xF0, 0xA3, 0xF0, ++0x22, 0x90, 0x8F, 0x9E, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, ++0xA3, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x8F, 0xAF, 0xF0, 0x12, 0x06, 0x89, 0x90, 0x8F, ++0x8E, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0x8F, 0x8F, 0xF0, 0x22, 0x90, 0x8D, 0xF6, ++0xE0, 0xB4, 0x01, 0x14, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x0E, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFE, ++0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x51, 0x3D, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, ++0x91, 0x12, 0xF0, 0x90, 0x91, 0x12, 0xE0, 0xFD, 0x70, 0x03, 0x02, 0x69, 0xA0, 0x90, 0x8D, 0x5A, ++0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x8D, 0x5B, ++0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, ++0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x91, 0x0F, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, ++0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x21, ++0x99, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x48, 0xDF, 0xE0, 0x90, ++0x91, 0x13, 0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, 0x91, 0x75, 0x42, 0x13, 0x75, 0x43, 0x01, 0x7B, ++0x01, 0x7A, 0x91, 0x79, 0x14, 0x12, 0x34, 0x62, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, ++0x01, 0xD0, 0x12, 0x48, 0xDF, 0xE0, 0xFF, 0x90, 0x8D, 0x5B, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, ++0x8D, 0x0A, 0x12, 0x48, 0xDF, 0xEF, 0xF0, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, ++0xD1, 0x12, 0x48, 0xDF, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0B, 0x12, 0x48, 0xDF, ++0xEF, 0xF0, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD2, 0x12, 0x48, 0xDF, 0xE0, ++0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0C, 0x12, 0x48, 0xDF, 0xEF, 0xF0, 0x90, 0x91, 0x0F, ++0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD3, 0x12, 0x48, 0xDF, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, ++0x90, 0x8D, 0x0D, 0x12, 0x48, 0xDF, 0xEF, 0xF0, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, ++0x01, 0xF0, 0x12, 0x48, 0xDF, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0E, 0x12, 0x48, ++0xDF, 0xEF, 0xF0, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF1, 0x12, 0x48, 0xDF, ++0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0F, 0x12, 0x48, 0xDF, 0xEF, 0xF0, 0x90, 0x91, ++0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF2, 0x12, 0x48, 0xDF, 0xE0, 0xFF, 0x75, 0xF0, 0x08, ++0xEE, 0x90, 0x8D, 0x10, 0x12, 0x48, 0xDF, 0xEF, 0xF0, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, ++0x90, 0x01, 0xF3, 0x12, 0x48, 0xDF, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x11, 0x12, ++0x48, 0xDF, 0xEF, 0xF0, 0x90, 0x91, 0x12, 0xE0, 0xFF, 0x90, 0x91, 0x0F, 0xE0, 0xFE, 0x74, 0x01, ++0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0x91, 0x12, 0xF0, 0x90, ++0x91, 0x0F, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, ++0x01, 0xCC, 0xF0, 0x90, 0x91, 0x0F, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0x8D, 0x5B, ++0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x03, 0x02, 0x67, ++0xF3, 0xE4, 0x90, 0x8D, 0x5B, 0xF0, 0x02, 0x67, 0xF3, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, ++0x22, 0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, ++0x07, 0x7D, 0xA2, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x69, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, ++0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, ++0xD0, 0xE0, 0x32, 0x90, 0x90, 0xE4, 0xEF, 0xF0, 0xAB, 0x05, 0x7E, 0x00, 0x7D, 0x00, 0x7C, 0x00, ++0xE4, 0x90, 0x90, 0xE9, 0xF0, 0xAF, 0x03, 0x90, 0x90, 0xE5, 0x12, 0x08, 0x6D, 0x90, 0x90, 0xE5, ++0x12, 0x48, 0xC7, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x38, 0x07, ++0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x90, 0xE4, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, ++0xB5, 0xF5, 0x82, 0xE4, 0x34, 0xAD, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x37, 0xBC, ++0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0xD3, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, ++0x90, 0x90, 0xEC, 0x12, 0x48, 0xC7, 0x90, 0xAA, 0x9C, 0x12, 0x08, 0x6D, 0xD0, 0x05, 0xD0, 0x07, ++0x12, 0x32, 0x34, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x06, 0x89, ++0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8D, 0x05, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, ++0xED, 0x2F, 0x90, 0x8D, 0x06, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, ++0x8D, 0x07, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8D, 0x08, 0xF0, ++0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x8D, 0x09, 0xF0, 0x22, ++0x90, 0x8F, 0xAF, 0x12, 0x48, 0xF4, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, 0xFE, 0x12, 0x06, ++0x89, 0xFD, 0xC3, 0x13, 0x30, 0xE0, 0x12, 0x90, 0x8F, 0xAF, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x02, ++0x12, 0x06, 0xA2, 0x90, 0x8F, 0xB3, 0xF0, 0x80, 0x05, 0x90, 0x8F, 0xB3, 0xEF, 0xF0, 0x90, 0x8F, ++0xB2, 0xEE, 0xF0, 0x90, 0x8F, 0xB3, 0xE0, 0xFE, 0x90, 0x8F, 0xB2, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, ++0x38, 0x90, 0x8F, 0xAF, 0x12, 0x48, 0xEB, 0x12, 0x06, 0x89, 0x54, 0x01, 0xFE, 0x74, 0xF6, 0x2F, ++0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0xF6, 0x2F, 0xF5, 0x82, 0xE4, 0x34, ++0x8D, 0xF5, 0x83, 0xE0, 0x70, 0x04, 0x71, 0x52, 0x80, 0x07, 0x90, 0x8F, 0xB2, 0xE0, 0xFF, 0x71, ++0x41, 0x90, 0x8F, 0xB2, 0xE0, 0x04, 0xF0, 0x80, 0xBA, 0x90, 0x8D, 0xF6, 0xE0, 0x70, 0x21, 0x90, ++0x8E, 0x7D, 0xE0, 0x70, 0x04, 0xFF, 0x12, 0x53, 0x64, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x0C, 0x60, ++0x02, 0x71, 0x63, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, ++0x22, 0x8F, 0x5B, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x48, 0xDF, 0xE0, 0x54, 0xFB, ++0xF0, 0x22, 0x8F, 0x5B, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x48, 0xDF, 0xE0, 0x44, ++0x04, 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, ++0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x06, 0x89, ++0xFF, 0x90, 0x8E, 0x76, 0xF0, 0xBF, 0x01, 0x12, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x64, 0x01, ++0x60, 0x17, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x0F, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, ++0x64, 0x01, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x06, ++0x89, 0xFF, 0x54, 0x7F, 0x90, 0x8E, 0x7A, 0xF0, 0xEF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xA3, ++0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0x8E, ++0x79, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0x54, 0x01, 0x25, 0xE0, ++0xFE, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0x90, 0x8E, 0x92, 0xE0, 0x30, 0xE0, 0x09, ++0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0xF0, 0x80, 0x0F, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, ++0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0x90, 0x8E, ++0x7C, 0xF0, 0x91, 0x39, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0xF0, 0x90, 0x8E, ++0x7A, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x8E, 0x7C, 0xE0, 0x90, 0x01, 0xBB, 0xF0, 0x90, 0x8E, ++0x79, 0xE0, 0x54, 0x0F, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x90, 0x8F, 0xAF, 0x12, 0x48, 0xF4, 0x91, ++0x68, 0x90, 0x8E, 0x7A, 0xE0, 0xFF, 0x12, 0x57, 0x79, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x18, 0x90, ++0x8F, 0xAF, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x54, 0x0F, 0xFF, 0x90, 0x00, ++0x02, 0x12, 0x06, 0xA2, 0xFD, 0x91, 0x79, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, ++0x90, 0x8E, 0x83, 0xF0, 0x90, 0x8E, 0x7E, 0xF0, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0C, 0x04, 0x70, ++0x28, 0x90, 0x8E, 0x80, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x22, 0xED, 0x70, 0x0A, 0x90, 0x8E, 0x8E, ++0xE0, 0x90, 0x8E, 0x80, 0xF0, 0x80, 0x05, 0x90, 0x8E, 0x80, 0xED, 0xF0, 0x90, 0x8E, 0x80, 0xE0, ++0xA3, 0xF0, 0x90, 0x8E, 0x78, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, ++0xFF, 0x30, 0xE0, 0x26, 0x12, 0x06, 0x89, 0x90, 0x8E, 0x8B, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, ++0xA2, 0x90, 0x8E, 0x8C, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xA3, 0xE0, 0x54, 0x01, 0x4F, 0xF0, 0x90, ++0x00, 0x03, 0x12, 0x06, 0xA2, 0x90, 0x8E, 0x8E, 0xF0, 0x22, 0x90, 0x8E, 0x8B, 0x74, 0x01, 0xF0, ++0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x22, ++0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0xFB, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, ++0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x90, 0xFB, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, ++0x60, 0x2D, 0xC3, 0x90, 0x90, 0xFE, 0xE0, 0x94, 0xE8, 0x90, 0x90, 0xFD, 0xE0, 0x94, 0x03, 0x40, ++0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x15, 0x90, 0x90, 0xFD, 0xE4, ++0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x80, 0xC5, 0x7F, ++0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x91, 0x03, ++0x12, 0x48, 0xF4, 0x7F, 0x96, 0x7E, 0x02, 0x91, 0xF0, 0xEF, 0x60, 0x58, 0x90, 0x01, 0x17, 0xE0, ++0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, ++0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x91, 0x06, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, ++0x91, 0x06, 0xE0, 0xFD, 0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x91, 0x03, 0x12, 0x48, ++0xEB, 0x90, 0x00, 0x0E, 0x12, 0x06, 0xA2, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0xD1, 0xDA, 0x90, ++0x91, 0x06, 0xE0, 0x24, 0x18, 0xFF, 0x90, 0x91, 0x03, 0x12, 0x48, 0xEB, 0xF1, 0x35, 0x90, 0x02, ++0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, ++0xE4, 0xFF, 0x90, 0x8D, 0xF3, 0xE0, 0xFE, 0x90, 0x8D, 0xF2, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, ++0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, 0x48, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x13, ++0xED, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x5C, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xD1, ++0x27, 0x7F, 0x01, 0x90, 0x8D, 0xF2, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x5C, 0xF9, 0x74, 0x8D, ++0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xB1, 0x46, 0x7F, 0x01, 0xEF, 0x60, 0x16, 0x90, 0x8D, 0xF2, 0xE0, ++0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x8D, ++0xF2, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8F, ++0xAC, 0x12, 0x48, 0xF4, 0x90, 0x91, 0x11, 0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, ++0x06, 0xE1, 0x7F, 0xAF, 0x7E, 0x01, 0x91, 0xF0, 0xEF, 0x60, 0x3A, 0x90, 0x8F, 0xAC, 0x12, 0x48, ++0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x90, 0x00, 0x0E, 0x12, 0x06, 0xA2, 0x24, 0x02, 0xF5, ++0x43, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x34, 0x62, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, ++0x90, 0x00, 0x0E, 0x12, 0x06, 0xA2, 0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, ++0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, ++0xD0, 0xE4, 0xFF, 0x90, 0x90, 0xB7, 0xF0, 0x90, 0x01, 0xC7, 0xE0, 0x64, 0xAD, 0x70, 0x36, 0xF0, ++0x90, 0x90, 0xC4, 0x74, 0x0F, 0xF0, 0x90, 0x90, 0xB6, 0x74, 0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, ++0x90, 0x90, 0xB7, 0xE0, 0x2F, 0xFE, 0x74, 0xB8, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, ++0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x0F, 0xE9, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, ++0x90, 0x79, 0xB6, 0xB1, 0x46, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, ++0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xEE, 0x74, 0x00, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, ++0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, ++0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, ++0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, ++0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x90, 0xFF, 0xEF, 0xF0, 0xA3, 0x12, 0x48, 0xF4, 0x90, 0x91, ++0x10, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x06, 0xE1, 0x74, 0x00, 0x2F, 0xF9, ++0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x91, 0x00, 0x12, ++0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, ++0x03, 0x12, 0x34, 0x62, 0x90, 0x90, 0xFF, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, ++0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x48, 0xEB, 0xE9, 0x24, 0x02, 0xF9, 0xE4, ++0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0x91, 0x00, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x0E, ++0x12, 0x06, 0xA2, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x62, 0x90, 0x01, ++0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, ++0x04, 0xF0, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0xF0, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, ++0x90, 0x01, 0x99, 0xE0, 0x44, 0xC0, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x80, 0xF0, 0x22, 0x90, 0x01, ++0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, 0xF0, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x01, ++0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x8F, 0xA8, ++0xF0, 0xA3, 0xF0, 0x12, 0x6F, 0xDE, 0xEF, 0x64, 0x01, 0x60, 0x45, 0xC3, 0x90, 0x8F, 0xA9, 0xE0, ++0x94, 0x88, 0x90, 0x8F, 0xA8, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, ++0xF0, 0x90, 0x01, 0xC7, 0x74, 0x03, 0xF0, 0x80, 0x27, 0x90, 0x8F, 0xA8, 0xE4, 0x75, 0xF0, 0x01, ++0x12, 0x08, 0xD6, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xD3, 0x90, 0x8F, 0xA9, 0xE0, 0x94, ++0x32, 0x90, 0x8F, 0xA8, 0xE0, 0x94, 0x00, 0x40, 0xBA, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB3, ++0x90, 0x01, 0xC7, 0x74, 0x05, 0xF0, 0x22, 0x7F, 0x02, 0x90, 0x8F, 0x9D, 0xE0, 0xFE, 0xEF, 0xC3, ++0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, ++0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0xE4, 0x90, ++0x8D, 0x01, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x0B, 0xF0, 0xA3, 0xE4, ++0xF0, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x15, 0xF5, 0x19, 0xA3, 0xE0, 0x55, 0x16, 0xF5, 0x1A, ++0xA3, 0xE0, 0x55, 0x17, 0xF5, 0x1B, 0xA3, 0xE0, 0x55, 0x18, 0xF5, 0x1C, 0x90, 0x01, 0x34, 0xE5, ++0x19, 0xF0, 0xA3, 0xE5, 0x1A, 0xF0, 0xA3, 0xE5, 0x1B, 0xF0, 0xA3, 0xE5, 0x1C, 0xF0, 0x22, 0x90, ++0x01, 0x3C, 0xE0, 0x55, 0x1D, 0xF5, 0x21, 0xA3, 0xE0, 0x55, 0x1E, 0xF5, 0x22, 0xA3, 0xE0, 0x55, ++0x1F, 0xF5, 0x23, 0xA3, 0xE0, 0x55, 0x20, 0xF5, 0x24, 0x90, 0x01, 0x3C, 0xE5, 0x21, 0xF0, 0xA3, ++0xE5, 0x22, 0xF0, 0xA3, 0xE5, 0x23, 0xF0, 0xA3, 0xE5, 0x24, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, ++0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x2A, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, ++0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x8C, 0xE0, 0xF5, ++0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, 0x74, 0x05, ++0xF0, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x26, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x20, ++0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x54, ++0xFB, 0xF0, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x51, 0x3D, ++0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, ++0x22, 0xE0, 0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, 0xC6, ++0xE0, 0x30, 0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, ++0x8F, 0xC7, 0x12, 0x48, 0xF4, 0x90, 0x8F, 0x91, 0x12, 0x54, 0xEB, 0x90, 0x8F, 0xCE, 0x12, 0x5F, ++0x4B, 0x90, 0x8F, 0xD0, 0xEF, 0xF0, 0x90, 0x8F, 0xCE, 0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, 0x34, ++0xFC, 0xFA, 0x7B, 0x01, 0x90, 0x8F, 0xCD, 0xE0, 0xFD, 0x51, 0x52, 0x90, 0x8F, 0xCE, 0xA3, 0xE0, ++0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, ++0x8F, 0xCA, 0x12, 0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0xD0, 0x01, ++0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x90, 0x8F, 0xCE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, ++0x24, 0x42, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, ++0x8F, 0xCA, 0x12, 0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0xD0, 0x01, ++0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x90, 0x8F, 0xCE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, ++0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, ++0x8F, 0xC7, 0x12, 0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0xD0, 0x01, ++0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x10, 0xF0, 0x31, 0x51, ++0xBF, 0x01, 0x0E, 0x90, 0x8F, 0x91, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x04, 0x1F, 0x74, 0x20, ++0xF0, 0x22, 0x90, 0x90, 0xF3, 0xED, 0xF0, 0x90, 0x90, 0xF0, 0x12, 0x48, 0xF4, 0xE4, 0x90, 0x90, ++0xF4, 0xF0, 0xA3, 0xF0, 0x12, 0x06, 0x89, 0xFF, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0xFD, 0x12, ++0x5F, 0x68, 0x90, 0x90, 0xF4, 0xEF, 0xF0, 0x90, 0x90, 0xF0, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x04, ++0x12, 0x06, 0xA2, 0xFF, 0xF1, 0x78, 0x90, 0x90, 0xF5, 0xEF, 0xF0, 0x90, 0x8E, 0xAB, 0xE0, 0x24, ++0xFE, 0x60, 0x1E, 0x24, 0xFE, 0x60, 0x1A, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x05, 0x70, ++0x54, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xAC, 0x90, 0x90, 0xF3, 0xE0, 0xFD, 0x12, 0x84, 0xF1, 0x80, ++0x16, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xAC, 0x90, 0x90, 0xF3, 0xE0, 0xFD, 0x90, 0x8E, 0xAB, 0xE0, ++0x90, 0x90, 0xC9, 0xF0, 0x12, 0x83, 0xCF, 0x90, 0x90, 0xF5, 0xE0, 0xFF, 0x90, 0x90, 0xF0, 0x12, ++0x48, 0xEB, 0x90, 0x90, 0xF4, 0xE0, 0x7C, 0x00, 0x29, 0xF9, 0xEC, 0x3A, 0xFA, 0xC3, 0xE9, 0x9F, ++0xF9, 0xEA, 0x94, 0x00, 0xFA, 0x75, 0x40, 0x01, 0x75, 0x41, 0x8E, 0x75, 0x42, 0xAC, 0xA3, 0xE0, ++0xF5, 0x43, 0x12, 0x34, 0x62, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8F, 0xBB, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8F, 0xD3, 0x74, 0x18, 0xF0, 0x7E, 0x00, ++0x7F, 0x80, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xDB, 0x12, 0x08, 0xAA, 0x90, 0x8F, 0x93, ++0xE0, 0xFF, 0x12, 0x57, 0xD7, 0x90, 0x8F, 0xD2, 0xEF, 0xF0, 0xF9, 0xE0, 0xFE, 0x24, 0x29, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x41, 0xF0, 0xEE, 0x24, 0x28, 0xFD, 0xE4, 0x33, 0xFC, ++0x90, 0x8F, 0xD3, 0xE0, 0x7A, 0x00, 0x2D, 0xFE, 0xEA, 0x3C, 0x90, 0x8F, 0xD7, 0xF0, 0xA3, 0xCE, ++0xF0, 0x74, 0x28, 0x29, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x90, 0x8F, 0xBD, 0xE0, 0xFD, ++0x51, 0x52, 0x90, 0x8F, 0xD7, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x08, 0xD6, 0x90, 0x8F, 0xD7, 0xE4, ++0x75, 0xF0, 0x08, 0x12, 0x08, 0xD6, 0x90, 0x8F, 0xD7, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x8F, 0xD5, ++0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x8F, 0xDB, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xE4, ++0xA3, 0xF0, 0xA3, 0x74, 0x5F, 0xF0, 0x90, 0x8F, 0xD7, 0xE4, 0x75, 0xF0, 0x04, 0x12, 0x08, 0xD6, ++0x90, 0x8E, 0xF8, 0xE0, 0xFF, 0x7E, 0x02, 0xB4, 0xFE, 0x02, 0x7E, 0xFE, 0x90, 0x8F, 0xD7, 0xA3, ++0xE0, 0xFD, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x00, 0x2D, ++0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, 0x8F, 0xDF, 0xF0, 0x90, 0x8F, 0xD7, 0xE4, ++0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x90, 0x8F, 0x8D, 0xE0, 0x90, 0x8F, 0xBB, 0xB4, 0x01, 0x0B, ++0xE0, 0x44, 0x03, 0xFC, 0xA3, 0xE0, 0x44, 0x10, 0xFD, 0x80, 0x09, 0xE0, 0x44, 0x03, 0xFC, 0xA3, ++0xE0, 0x44, 0x20, 0xFD, 0x90, 0x8F, 0xD9, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8F, 0xE0, 0x74, ++0x03, 0xF0, 0xA3, 0x74, 0x12, 0xF0, 0x90, 0x8F, 0xD7, 0xE4, 0x75, 0xF0, 0x02, 0x12, 0x08, 0xD6, ++0xEF, 0x64, 0xFE, 0x70, 0x37, 0x90, 0x8F, 0xD7, 0xA3, 0xE0, 0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, ++0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x40, 0x75, 0x41, 0x8E, 0x75, 0x42, 0xFB, 0x75, 0x43, 0x02, ++0xD0, 0x03, 0x12, 0x34, 0x62, 0x75, 0x40, 0x01, 0x75, 0x41, 0x8E, 0x75, 0x42, 0xFB, 0x75, 0x43, ++0x02, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xE2, 0x12, 0x34, 0x62, 0x80, 0x60, 0x90, 0x8F, 0x8E, 0xE0, ++0xFF, 0xB4, 0x02, 0x2B, 0x90, 0x8F, 0xD7, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x24, 0x00, 0xF5, 0x82, ++0x74, 0xFC, 0x3C, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0x74, 0xFC, 0x3C, 0xF5, ++0x83, 0x74, 0x20, 0xF0, 0xE4, 0x90, 0x8F, 0xE2, 0xF0, 0xA3, 0x74, 0x20, 0xF0, 0x80, 0x2D, 0xEF, ++0xB4, 0x04, 0x29, 0x90, 0x8F, 0xD7, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x24, 0x00, 0xF5, 0x82, 0x74, ++0xFC, 0x3E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2F, 0xF5, 0x82, 0x74, 0xFC, 0x3E, 0xF5, 0x83, ++0x74, 0x10, 0xF0, 0xE4, 0x90, 0x8F, 0xE2, 0xF0, 0xA3, 0x74, 0x10, 0xF0, 0x90, 0x8F, 0xD7, 0xE4, ++0x75, 0xF0, 0x02, 0x12, 0x08, 0xD6, 0xE4, 0x90, 0x8F, 0xD4, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, 0xFF, ++0x24, 0xFD, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0x8F, 0xD7, 0xA3, 0xE0, ++0xFD, 0xEF, 0x2D, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0x8F, ++0xD4, 0xE0, 0xFF, 0x24, 0xFD, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0xE4, ++0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, 0x04, 0xF0, ++0xE0, 0xB4, 0x08, 0xB7, 0x90, 0x8F, 0xD7, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x08, 0xD6, 0x90, 0x8F, ++0xD7, 0xE4, 0x75, 0xF0, 0x20, 0x12, 0x08, 0xD6, 0x90, 0x8F, 0xD7, 0xE4, 0x75, 0xF0, 0x10, 0x12, ++0x08, 0xD6, 0x90, 0x8F, 0xD7, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x08, 0xD6, 0x90, 0x8F, 0xD7, 0xE4, ++0x75, 0xF0, 0x08, 0x12, 0x08, 0xD6, 0xE4, 0x90, 0x8F, 0xD4, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, 0xFF, ++0xC3, 0x94, 0x10, 0x50, 0x1B, 0xD1, 0x51, 0x90, 0x8F, 0xD2, 0xEF, 0xF0, 0xE0, 0x24, 0x00, 0xF5, ++0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, 0x04, 0xF0, 0x80, 0xDB, ++0x7F, 0x64, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x8F, 0x94, 0xE0, 0xFD, 0xFF, 0x90, 0x8F, 0x93, ++0xE0, 0xC3, 0x9F, 0xFF, 0xEF, 0xFE, 0x90, 0x8F, 0xD3, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, ++0x3E, 0xCF, 0x24, 0x38, 0xCF, 0x34, 0x00, 0xFE, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0x7A, 0x74, ++0x10, 0xF0, 0xED, 0xFE, 0xE4, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, ++0xAC, 0x7B, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0x7B, 0x63, 0xE4, 0xFD, 0xFC, ++0x12, 0x38, 0xC6, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xDB, 0x90, 0xAC, 0xA0, 0x12, 0x48, 0xF4, 0x7A, ++0x8F, 0x79, 0xBE, 0x90, 0xAC, 0xA3, 0x12, 0x48, 0xF4, 0x90, 0xAC, 0xA6, 0x74, 0x10, 0xF0, 0x7A, ++0x8E, 0x79, 0xB4, 0x12, 0x34, 0xC2, 0xE4, 0x90, 0x8F, 0xD4, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, 0xFF, ++0xC3, 0x94, 0x10, 0x50, 0x2D, 0xD1, 0x51, 0x90, 0x8F, 0xD2, 0xEF, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, ++0x24, 0xBE, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x8F, 0xD2, 0xE0, 0x24, ++0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, 0x04, 0xF0, ++0x80, 0xC9, 0x31, 0x51, 0xBF, 0x01, 0x19, 0x90, 0x8F, 0x93, 0x12, 0x54, 0xEB, 0x90, 0x8F, 0xD2, ++0xEF, 0xF0, 0x90, 0x8F, 0x93, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, ++0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8F, 0xBA, 0xED, 0xF0, 0x90, 0x8F, 0xB8, 0xEE, 0xF0, 0xA3, ++0xEF, 0xF0, 0xD1, 0x7B, 0x90, 0x8F, 0xB8, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x41, ++0xF6, 0x90, 0x8F, 0xD8, 0xE0, 0x2F, 0xFF, 0x90, 0x8F, 0xD7, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x90, ++0x5B, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x8F, 0x93, 0xE0, 0xFD, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x0A, ++0x0D, 0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, ++0xC0, 0xD0, 0x90, 0x8F, 0x8F, 0xE0, 0xFD, 0xB4, 0x02, 0x0C, 0x90, 0x90, 0x0B, 0x74, 0x80, 0xF0, ++0xA3, 0x74, 0x08, 0xF0, 0x80, 0x0E, 0xED, 0xB4, 0x04, 0x0A, 0x90, 0x90, 0x0B, 0x74, 0x80, 0xF0, ++0xA3, 0x74, 0x10, 0xF0, 0xEF, 0x64, 0x02, 0x4E, 0x60, 0x02, 0xE1, 0x73, 0x90, 0x8E, 0xF5, 0xE0, ++0xFF, 0x64, 0xFE, 0x70, 0x02, 0xE1, 0x73, 0xEF, 0x64, 0x02, 0x60, 0x07, 0xEF, 0x64, 0x03, 0x60, ++0x02, 0xE1, 0x73, 0x90, 0x8F, 0x55, 0xE0, 0xFE, 0xA3, 0xE0, 0xFD, 0xED, 0xFF, 0x90, 0x90, 0x0D, ++0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, 0x00, 0x7F, 0x20, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x8F, 0x79, ++0xCB, 0x12, 0x08, 0xAA, 0x7E, 0x00, 0x7F, 0x20, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xEB, ++0x12, 0x08, 0xAA, 0x90, 0xAC, 0x7A, 0x74, 0x10, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x7B, 0x20, ++0xFD, 0xFC, 0xFF, 0xFE, 0x12, 0x38, 0xC6, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x57, 0x90, 0xAC, 0x89, ++0x12, 0x48, 0xF4, 0x7A, 0x8F, 0x79, 0xEB, 0x90, 0xAC, 0x8C, 0x12, 0x48, 0xF4, 0x90, 0xAC, 0x8F, ++0x74, 0x20, 0xF0, 0x7A, 0x8E, 0x79, 0xC4, 0x12, 0x33, 0x97, 0x75, 0x40, 0x01, 0x75, 0x41, 0x8F, ++0x75, 0x42, 0xF3, 0x75, 0x43, 0x18, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xCB, 0x12, 0x34, 0x62, 0x75, ++0x40, 0x01, 0x75, 0x41, 0x8F, 0x75, 0x42, 0xD3, 0x75, 0x43, 0x10, 0x7B, 0x01, 0x7A, 0x8F, 0x79, ++0xBB, 0x12, 0x34, 0x62, 0x90, 0x8F, 0xD1, 0xE0, 0x54, 0x03, 0xFF, 0x24, 0xA0, 0xF5, 0x82, 0xE4, ++0x34, 0x04, 0xF5, 0x83, 0xEF, 0xF0, 0x70, 0x02, 0x7F, 0x01, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xBB, ++0x12, 0x82, 0xA9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, ++0x20, 0xE0, 0x05, 0x90, 0x8F, 0x8E, 0x80, 0x03, 0x90, 0x8F, 0x8F, 0xE0, 0x90, 0x8E, 0xAB, 0xF0, ++0x90, 0x8E, 0xAB, 0xE0, 0x14, 0x60, 0x13, 0x14, 0x60, 0x14, 0x24, 0xFE, 0x60, 0x10, 0x14, 0x60, ++0x09, 0x14, 0x60, 0x06, 0x24, 0x06, 0xE4, 0xFE, 0x80, 0x06, 0x7E, 0x04, 0x80, 0x02, 0x7E, 0x08, ++0xAF, 0x06, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x1E, 0x90, 0xFD, 0x11, ++0xE0, 0xB5, 0x05, 0x14, 0x90, 0x01, 0x17, 0xE0, 0xB5, 0x05, 0x07, 0x90, 0xFD, 0x11, 0xE4, 0xF0, ++0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, 0x11, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0x90, 0x05, 0x22, 0x74, ++0xFF, 0xF0, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x57, 0xF2, 0x7F, 0x00, 0x7E, 0x0C, ++0x12, 0x37, 0xBC, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0x91, 0x0B, 0x12, 0x08, 0x6D, 0x90, 0x91, ++0x0B, 0x12, 0x48, 0xC7, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x38, ++0x07, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0xBC, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0x91, 0x0B, ++0x12, 0x08, 0x6D, 0x90, 0x91, 0x0B, 0x12, 0x48, 0xC7, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, ++0x00, 0x7E, 0x0E, 0x12, 0x4E, 0x2B, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x12, 0x4B, 0x67, 0x7F, ++0xB4, 0x7E, 0x08, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0x91, 0x0B, 0x12, 0x08, ++0x6D, 0x90, 0x91, 0x0B, 0x12, 0x48, 0xC7, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0xB4, 0x7E, ++0x08, 0x12, 0x38, 0x07, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, ++0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x90, 0x6D, 0xF0, ++0xA3, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x4E, 0x30, 0x90, 0x90, 0x6D, 0xEF, 0xF0, 0x7F, 0x83, ++0x12, 0x4E, 0x30, 0xAE, 0x07, 0x90, 0x90, 0x6D, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, ++0x90, 0x6F, 0xE0, 0x94, 0x64, 0x90, 0x90, 0x6E, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, ++0xE0, 0x44, 0x40, 0xF0, 0x90, 0x90, 0x6D, 0xE0, 0xFF, 0x22, 0x90, 0x90, 0x6E, 0xE4, 0x75, 0xF0, ++0x01, 0x12, 0x08, 0xD6, 0x80, 0xBE, 0x74, 0x1D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, ++0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0x90, ++0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x37, 0xBC, 0x90, 0x90, 0x8D, 0x12, 0x08, 0x6D, 0x90, ++0x90, 0x85, 0x12, 0x48, 0xC7, 0x12, 0x08, 0x3A, 0x90, 0x90, 0x8D, 0x12, 0x48, 0xD3, 0x12, 0x48, ++0xAD, 0x90, 0x90, 0x89, 0x12, 0x48, 0xD3, 0x12, 0x48, 0xBA, 0x90, 0x90, 0x91, 0x12, 0x08, 0x6D, ++0x90, 0x90, 0x91, 0x12, 0x48, 0xC7, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x90, 0x90, 0x83, 0xE0, ++0xFE, 0xA3, 0xE0, 0xFF, 0x02, 0x38, 0x07, 0x90, 0x90, 0x71, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, ++0x90, 0x70, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x3D, 0x2C, 0x90, 0x90, 0x7B, 0x12, 0x08, ++0x6D, 0x90, 0x90, 0x73, 0x12, 0x48, 0xC7, 0x12, 0x08, 0x3A, 0x90, 0x90, 0x7B, 0x12, 0x48, 0xD3, ++0x12, 0x48, 0xAD, 0x90, 0x90, 0x77, 0x12, 0x48, 0xD3, 0x12, 0x48, 0xBA, 0x90, 0x90, 0x7F, 0x12, ++0x08, 0x6D, 0x90, 0x90, 0x71, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x90, 0x7F, 0x12, 0x48, 0xC7, ++0x90, 0xAA, 0x96, 0x12, 0x08, 0x6D, 0x90, 0x90, 0x70, 0xE0, 0xFF, 0xD0, 0x05, 0x02, 0x3C, 0x33, ++0x12, 0x06, 0x89, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8F, 0x9E, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, ++0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0x8F, 0x9F, 0xF0, 0x22, ++0xE4, 0x90, 0x8F, 0xAC, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x2C, 0xC3, 0x90, ++0x8F, 0xAD, 0xE0, 0x94, 0xD0, 0x90, 0x8F, 0xAC, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, ++0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x8F, 0xAC, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, ++0xD6, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x80, 0xCD, 0x7F, 0x01, 0x22, 0x7D, 0x07, 0xEF, ++0x5D, 0xC3, 0x60, 0x14, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, ++0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x0D, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, ++0x5E, 0xFE, 0xED, 0x5F, 0xFF, 0x22, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0xE0, 0x7C, ++0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8F, 0xAF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x87, ++0xE0, 0xF9, 0x90, 0x8E, 0x92, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0xC7, 0xEC, 0xC3, 0x99, 0x40, 0x02, ++0x41, 0xC7, 0x90, 0x8F, 0xAF, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, ++0x03, 0xAD, 0x07, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, ++0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, ++0x3E, 0x54, 0x3F, 0xFE, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, ++0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFD, 0x24, 0x18, 0xFB, 0xEA, 0x33, 0xFA, 0xEB, 0x2F, 0xFF, ++0xEA, 0x3E, 0xFE, 0x31, 0xDD, 0x90, 0x8F, 0xAF, 0xEE, 0x8F, 0xF0, 0x12, 0x08, 0xD6, 0x90, 0x8D, ++0xF4, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x90, 0x8F, 0xB0, 0xE0, 0x9F, 0x90, 0x8F, 0xAF, 0xE0, ++0x9E, 0x40, 0x1B, 0x90, 0x8D, 0xF5, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8D, 0xF4, 0xE0, 0x34, 0x00, ++0xFE, 0xC3, 0x90, 0x8F, 0xB0, 0xE0, 0x9F, 0xF0, 0x90, 0x8F, 0xAF, 0xE0, 0x9E, 0xF0, 0x90, 0x8F, ++0xAF, 0x12, 0x5F, 0xDA, 0x0C, 0x41, 0x2B, 0x22, 0x51, 0x06, 0x90, 0x02, 0x87, 0xE0, 0x70, 0xF8, ++0x90, 0x06, 0x90, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0xEF, 0x60, 0x59, 0x90, 0x8F, 0x90, 0xE0, 0xFF, ++0x60, 0x02, 0x91, 0x91, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, ++0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8D, 0xF4, 0xF0, 0xA3, 0xEF, 0xF0, ++0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF0, 0x12, 0x77, 0xDC, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, ++0xF0, 0x51, 0xC8, 0x91, 0x83, 0x12, 0x4F, 0x3E, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x06, 0x64, ++0xE0, 0x60, 0x03, 0x12, 0x58, 0x89, 0x91, 0xDA, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, ++0xFF, 0x02, 0x57, 0x1C, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x57, 0xBB, 0x90, 0x06, 0x90, 0xE4, 0xF0, ++0x90, 0x02, 0x86, 0xE0, 0x54, 0xFB, 0xF0, 0x71, 0xA1, 0x91, 0x84, 0x90, 0x8E, 0x92, 0xE0, 0x54, ++0xFE, 0xF0, 0x90, 0x8E, 0x97, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0x90, 0x8E, 0xA4, 0xF0, 0xA3, 0xF0, ++0xA3, 0xF0, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x8E, 0x93, 0xE0, 0x54, 0xFE, 0xF0, ++0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, ++0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0x80, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, ++0xFE, 0xF0, 0x90, 0x8E, 0x94, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x8E, 0x96, 0xE0, 0x54, 0xFD, 0xF0, ++0x22, 0x71, 0x69, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x90, 0x8D, 0x04, 0xE0, 0xFF, 0xB4, 0x01, ++0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, ++0x54, 0xFB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x06, 0x89, 0xFF, 0x54, ++0x01, 0xFE, 0x90, 0x8E, 0x92, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, ++0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, ++0xFF, 0x90, 0x8E, 0x92, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0xFF, 0xF0, 0x12, ++0x06, 0x89, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x90, 0x8E, 0x92, 0xF0, 0xEE, ++0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0x54, 0x40, 0xFE, 0xEF, ++0x54, 0xBF, 0x4E, 0x90, 0x8E, 0x92, 0xF0, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, ++0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8D, 0xF4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x8E, ++0x92, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, 0x91, 0x78, 0x90, 0x8E, 0x92, 0xE0, 0x13, 0x13, 0x54, ++0x01, 0xFF, 0x91, 0x85, 0x90, 0x8E, 0x92, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFF, 0xB1, 0x12, ++0x90, 0x8E, 0x92, 0xE0, 0xC4, 0x54, 0x01, 0xFF, 0x91, 0x8B, 0x90, 0x8E, 0x92, 0xE0, 0x54, 0x01, ++0xFF, 0x51, 0xD8, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x60, 0x07, 0x90, 0x8F, 0x91, 0xE0, 0xFF, ++0x91, 0xB0, 0x22, 0x22, 0x22, 0x90, 0x8F, 0xAF, 0xEF, 0xF0, 0x22, 0x90, 0x8F, 0xAF, 0xEF, 0xF0, ++0x22, 0x12, 0x57, 0xD7, 0x7E, 0x00, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, ++0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x08, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xAC, 0x02, 0x34, 0x62, ++0x12, 0x57, 0xD7, 0x7E, 0x00, 0x90, 0x8F, 0xAF, 0x12, 0x5F, 0x4B, 0x90, 0x8F, 0xAF, 0xA3, 0xE0, ++0x2F, 0x24, 0x3E, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, ++0x04, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xA7, 0x02, 0x34, 0x62, 0xE4, 0xFF, 0x74, 0x18, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x9E, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8E, ++0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x10, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, ++0x74, 0x98, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x06, ++0xCB, 0x22, 0xE4, 0xFD, 0xFC, 0xEF, 0x60, 0x55, 0x90, 0x8F, 0x94, 0xE0, 0xFF, 0x12, 0x57, 0xD7, ++0x7C, 0x00, 0xAD, 0x07, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x90, 0x8F, ++0xAF, 0x12, 0x48, 0xF4, 0x90, 0x8F, 0xAF, 0x12, 0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, ++0x75, 0x43, 0x40, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xB4, 0x12, 0x34, 0x62, 0xE4, 0xFD, 0x7F, 0x03, ++0x12, 0x30, 0x0A, 0x90, 0x8F, 0x95, 0xE0, 0xFE, 0xE4, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, ++0xD8, 0xF9, 0xFF, 0x12, 0x39, 0x00, 0x7D, 0x01, 0x7F, 0x03, 0x12, 0x30, 0x0A, 0x22, 0xD3, 0x10, ++0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x06, 0x89, 0xFE, 0x20, 0xE0, 0x04, 0x71, 0xA1, 0xC1, 0x27, ++0x12, 0x06, 0x89, 0xFF, 0x54, 0x01, 0xFD, 0x90, 0x8E, 0x93, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, ++0xEF, 0x54, 0x02, 0xFF, 0xED, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFD, 0x54, 0x04, ++0xFC, 0xEF, 0x54, 0xFB, 0x4C, 0xFF, 0x90, 0x8E, 0x93, 0xF0, 0xED, 0x54, 0x08, 0xFD, 0xEF, 0x54, ++0xF7, 0x4D, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFD, 0x54, 0x10, 0xFC, 0xEF, 0x54, 0xEF, 0x4C, 0xFF, ++0x90, 0x8E, 0x93, 0xF0, 0xED, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0xF0, 0x12, 0x06, ++0x89, 0xFD, 0x54, 0x40, 0xFC, 0xEF, 0x54, 0xBF, 0x4C, 0xFF, 0x90, 0x8E, 0x93, 0xF0, 0xED, 0x54, ++0x80, 0xFD, 0xEF, 0x54, 0x7F, 0x4D, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x54, 0x80, 0xFF, ++0x90, 0x8E, 0x94, 0xE0, 0x54, 0x7F, 0x4F, 0xF0, 0xEE, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, ++0x90, 0x06, 0x90, 0xE0, 0x44, 0x04, 0xF0, 0x12, 0x06, 0x89, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, ++0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x8D, 0x04, 0xE0, 0xB4, 0x01, 0x07, ++0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8E, 0x97, 0xE0, ++0xFF, 0x20, 0xE0, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x14, 0xEF, 0x44, 0x01, 0x90, 0x8E, ++0x97, 0xF0, 0x90, 0x8E, 0x93, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x03, 0x7F, 0x00, 0x22, 0x7F, ++0x01, 0x22, 0xEF, 0x90, 0x01, 0xC7, 0xB4, 0xA0, 0x05, 0x74, 0x04, 0xF0, 0x80, 0x03, 0x74, 0x08, ++0xF0, 0x90, 0x8E, 0x97, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x8E, 0x97, 0xE0, 0x30, 0xE0, 0x03, ++0x7F, 0x01, 0x22, 0x90, 0x06, 0x90, 0xE0, 0x20, 0xE5, 0x0A, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, ++0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x06, 0x89, 0xFE, ++0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8F, 0x90, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, 0xED, ++0x2F, 0x90, 0x8F, 0x91, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8F, ++0x92, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x93, 0xF0, 0x90, ++0x00, 0x04, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x94, 0xF0, 0x90, 0x00, 0x05, 0x12, ++0x06, 0xA2, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x8F, 0x95, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, ++0xFD, 0x12, 0x06, 0x89, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8F, 0x96, 0xF0, 0x90, 0x00, 0x01, ++0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x97, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, ++0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x98, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, ++0x90, 0x8F, 0x99, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x9A, ++0xF0, 0x90, 0x00, 0x05, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x9B, 0xF0, 0x90, 0x00, ++0x06, 0x12, 0x06, 0xA2, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x8F, 0x9C, 0xF0, 0x22, 0x90, 0x8F, ++0xA1, 0xE0, 0x30, 0xE0, 0x36, 0x90, 0x8F, 0xA4, 0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x90, 0x8F, 0xA2, ++0xE0, 0x6F, 0x70, 0x27, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x11, 0x90, 0x8F, 0xA6, 0xE0, 0x70, ++0x0B, 0x12, 0x57, 0xD3, 0x90, 0x8F, 0xA5, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, 0x74, ++0x04, 0xF0, 0xE4, 0x90, 0x8F, 0xA4, 0xF0, 0x90, 0x8F, 0xA6, 0xF0, 0x22, 0xE4, 0x90, 0x8E, 0x7A, ++0xF0, 0xA3, 0xF0, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, 0xF0, 0x90, 0x8E, 0x77, ++0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0x8E, 0x80, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x90, ++0x8E, 0x77, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x8E, 0x83, 0xF0, ++0x90, 0x8E, 0x82, 0x74, 0x07, 0xF0, 0x90, 0x8E, 0x85, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0xE4, ++0x90, 0x8E, 0x7E, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x7C, 0x74, 0x0C, ++0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x90, 0x8E, ++0x77, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, ++0x54, 0xF7, 0xF0, 0x90, 0x8E, 0x87, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x90, 0x8D, 0x04, ++0xE0, 0xB4, 0x01, 0x08, 0x90, 0x8E, 0x84, 0x74, 0xFF, 0xF0, 0x80, 0x12, 0x90, 0x8D, 0x04, 0xE0, ++0x90, 0x8E, 0x84, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x41, 0xF0, 0x90, 0x8E, ++0x8B, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, ++0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, ++0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0x90, 0x04, ++0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, ++0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x11, 0x4E, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, ++0xB8, 0x74, 0x01, 0xF0, 0x21, 0x02, 0x90, 0x8E, 0x7E, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x08, 0x90, ++0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x7B, 0x90, 0x8E, 0x7C, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, ++0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x69, 0xEF, 0x30, 0xE2, 0x08, 0x90, 0x01, 0xB8, ++0x74, 0x08, 0xF0, 0x80, 0x5D, 0x90, 0x8E, 0x7E, 0xE0, 0x30, 0xE4, 0x08, 0x90, 0x01, 0xB8, 0x74, ++0x10, 0xF0, 0x80, 0x4E, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x08, 0x90, ++0x01, 0xB8, 0x74, 0x20, 0xF0, 0x80, 0x3B, 0x90, 0x8E, 0x91, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, ++0x74, 0x80, 0xF0, 0x80, 0x2D, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, ++0x11, 0xF0, 0x80, 0x1E, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0F, 0xE0, 0x54, 0xFC, 0xFF, 0xBF, ++0x80, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x12, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, ++0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x02, 0x96, 0xE0, 0xFF, ++0x90, 0x02, 0x87, 0xE0, 0x4F, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2C, 0x90, ++0x8E, 0x92, 0xE0, 0x30, 0xE0, 0x0E, 0x90, 0x02, 0x82, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, ++0x02, 0xF0, 0x80, 0x17, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, ++0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, ++0xF0, 0x7F, 0x00, 0x22, 0xEF, 0x60, 0x3E, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x36, 0x90, ++0x8E, 0x78, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, ++0x54, 0xBF, 0xF0, 0xE4, 0xFF, 0x12, 0x53, 0xC8, 0xBF, 0x01, 0x0E, 0x90, 0x8E, 0x77, 0xE0, 0x44, ++0x40, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x06, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, ++0x01, 0xB8, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0x8E, 0x7D, 0x74, ++0x02, 0xF0, 0x22, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x04, 0xF0, 0x22, 0x90, ++0x8E, 0x7A, 0xE0, 0x60, 0x39, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x31, 0x90, 0x8E, 0x81, ++0xF0, 0x04, 0x60, 0x2A, 0x90, 0x8E, 0x7E, 0xE0, 0x44, 0x10, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, ++0x82, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, ++0x57, 0x74, 0x05, 0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x51, 0x46, 0x22, 0x90, ++0x8E, 0x77, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x11, 0xEF, 0x54, 0xFB, 0xF0, 0x90, ++0x8E, 0x7E, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x42, 0x80, 0x3D, 0x90, 0x8E, 0x83, 0xE0, ++0x04, 0xF0, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x8E, 0x83, 0xE0, 0xFF, 0xB4, 0x01, ++0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, 0x06, 0x90, 0x05, 0x58, 0xE0, 0x04, 0xF0, 0x90, 0x8E, 0x8B, ++0xE0, 0xFF, 0x90, 0x8E, 0x83, 0xE0, 0xD3, 0x9F, 0x40, 0x0F, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, 0x01, ++0x0B, 0x90, 0x8E, 0x78, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x12, 0x51, 0x3D, 0x22, 0x12, 0x4F, 0x3E, ++0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x22, 0x90, 0x8D, 0x07, 0xE0, ++0xFE, 0x90, 0x04, 0x1C, 0xE0, 0x6E, 0x70, 0x40, 0x90, 0x8E, 0x7D, 0xE0, 0xFE, 0x64, 0x0E, 0x70, ++0x1C, 0xEF, 0x70, 0x34, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, ++0xBF, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x04, 0xF0, 0x22, 0xEE, 0xB4, 0x06, ++0x17, 0xEF, 0x60, 0x14, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, ++0x7F, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x22, 0x90, 0x90, 0x0F, 0xEF, 0xF0, 0xA3, 0x12, ++0x48, 0xF4, 0x90, 0x90, 0x10, 0x12, 0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, ++0x04, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x13, 0x12, 0x34, 0x62, 0x90, 0x90, 0x0F, 0xE0, 0x75, 0xF0, ++0x08, 0xA4, 0x24, 0x02, 0x71, 0x8D, 0x90, 0x90, 0x10, 0x12, 0x48, 0xEB, 0xE9, 0x24, 0x04, 0xF9, ++0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x90, 0x79, ++0x13, 0x12, 0x34, 0x62, 0x90, 0x90, 0x0F, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0x71, 0x8D, ++0x90, 0x90, 0x10, 0x12, 0x48, 0xEB, 0xE9, 0x24, 0x08, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, ++0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x13, 0x12, 0x34, 0x62, 0x90, 0x90, ++0x0F, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x04, 0x71, 0x8D, 0x90, 0x90, 0x10, 0x12, 0x48, 0xEB, ++0xE9, 0x24, 0x0C, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, ++0x01, 0x7A, 0x90, 0x79, 0x13, 0x12, 0x34, 0x62, 0x90, 0x90, 0x0F, 0xE0, 0x75, 0xF0, 0x08, 0xA4, ++0x24, 0x05, 0x71, 0x8D, 0x90, 0x90, 0x0F, 0xE0, 0xFE, 0x44, 0x10, 0x90, 0x90, 0x13, 0xF0, 0xA3, ++0x74, 0x80, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x71, 0x8D, ++0x90, 0x90, 0x13, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x90, 0x0F, 0xE0, ++0x75, 0xF0, 0x08, 0xA4, 0x04, 0x71, 0x8D, 0x90, 0x06, 0x72, 0xE4, 0xF0, 0x22, 0xFF, 0x7B, 0x01, ++0x7A, 0x90, 0x79, 0x13, 0x12, 0x06, 0x89, 0x90, 0x06, 0x74, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, ++0xA2, 0x90, 0x06, 0x75, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0x06, 0x76, 0xF0, 0x90, ++0x00, 0x03, 0x12, 0x06, 0xA2, 0x90, 0x06, 0x77, 0xF0, 0x90, 0x06, 0x70, 0xEF, 0xF0, 0xA3, 0xE4, ++0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0x90, ++0x90, 0xC5, 0x12, 0x48, 0xF4, 0x12, 0x06, 0x89, 0x90, 0x90, 0xCA, 0xF0, 0x90, 0x00, 0x01, 0x12, ++0x06, 0xA2, 0x90, 0x90, 0xCB, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0x90, 0x90, 0xCC, 0xF0, ++0x90, 0x00, 0x05, 0x12, 0x06, 0xA2, 0x90, 0x90, 0xCD, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x06, 0xA2, ++0x90, 0x90, 0xCE, 0xF0, 0x90, 0x00, 0x07, 0x12, 0x06, 0xA2, 0x90, 0x90, 0xCF, 0xF0, 0x90, 0x00, ++0x03, 0x12, 0x06, 0xA2, 0x90, 0x90, 0xD2, 0xF0, 0xED, 0x70, 0x31, 0xFF, 0x74, 0xCA, 0x2F, 0xF5, ++0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, 0xB4, 0xFF, 0x0E, 0x74, 0xCA, 0x2F, 0xF5, 0x82, 0xE4, ++0x34, 0x90, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x0F, 0x74, 0xCA, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, ++0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x06, 0xD0, 0x90, 0x90, 0xC9, 0xE0, ++0xFF, 0xB4, 0x04, 0x25, 0xA3, 0xE0, 0xFE, 0x90, 0x90, 0xC5, 0x12, 0x48, 0xEB, 0xEE, 0x12, 0x06, ++0xCF, 0x90, 0x90, 0xCB, 0xE0, 0xFE, 0x90, 0x90, 0xC5, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x01, 0xEE, ++0x12, 0x06, 0xE1, 0x90, 0x00, 0x02, 0xE4, 0x80, 0x30, 0xEF, 0xB4, 0x02, 0x2F, 0x90, 0x90, 0xCB, ++0xE0, 0xFF, 0x90, 0x90, 0xC5, 0x12, 0x48, 0xEB, 0xEF, 0x12, 0x06, 0xCF, 0x90, 0x90, 0xCB, 0xE0, ++0x44, 0x20, 0x54, 0x7F, 0xFF, 0x90, 0x90, 0xC5, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x01, 0xEF, 0x12, ++0x06, 0xE1, 0x90, 0x90, 0xCA, 0xE0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xE1, 0x90, 0x90, 0xC5, 0x12, ++0x48, 0xEB, 0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x06, 0x89, 0x44, 0x20, 0x12, 0x06, ++0xCF, 0x90, 0x90, 0xCC, 0xE0, 0xFF, 0x90, 0x90, 0xC5, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x04, 0xEF, ++0x12, 0x06, 0xE1, 0x90, 0x90, 0xCD, 0xE0, 0x90, 0x00, 0x05, 0x12, 0x06, 0xE1, 0x90, 0x90, 0xCE, ++0xE0, 0x90, 0x00, 0x06, 0x12, 0x06, 0xE1, 0x90, 0x90, 0xCF, 0xE0, 0x90, 0x00, 0x07, 0x02, 0x06, ++0xE1, 0x90, 0x90, 0xDF, 0xED, 0xF0, 0x90, 0x90, 0xDC, 0x12, 0x48, 0xF4, 0x90, 0x00, 0x03, 0x12, ++0x06, 0xA2, 0x90, 0x90, 0xE3, 0xF0, 0x90, 0x90, 0xDC, 0x12, 0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, ++0x89, 0x42, 0x75, 0x43, 0x03, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xE0, 0x12, 0x34, 0x62, 0x90, 0x90, ++0xDF, 0xE0, 0x70, 0x46, 0xFF, 0x74, 0xE0, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, ++0xB4, 0xFF, 0x0E, 0x74, 0xE0, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE4, 0xF0, 0x80, ++0x0F, 0x74, 0xE0, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x05, ++0x0F, 0xEF, 0xB4, 0x03, 0xD0, 0x75, 0x40, 0x01, 0x75, 0x41, 0x90, 0x75, 0x42, 0xE0, 0x75, 0x43, ++0x03, 0x90, 0x90, 0xDC, 0x12, 0x48, 0xEB, 0x12, 0x34, 0x62, 0x22, 0x00, 0x9D, 0x91, ++}; ++static const u4Byte ArrayLength_MP_8821A_FW_WoWLAN = 17806; ++ ++ ++void ++ODM_ReadFirmware_MP_8821A_FW_WoWLAN( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++) ++{ ++ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8821A_FW_WoWLAN; ++ *pFirmwareSize = ArrayLength_MP_8821A_FW_WoWLAN; ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.h 2018-02-06 17:42:30.708967135 +0200 +@@ -0,0 +1,64 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#ifndef __INC_MP_FW_HW_IMG_8821A_H ++#define __INC_MP_FW_HW_IMG_8821A_H ++ ++ ++/****************************************************************************** ++* FW_AP.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadFirmware_MP_8821A_FW_AP( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++); ++ ++/****************************************************************************** ++* FW_BT.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadFirmware_MP_8821A_FW_BT( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++); ++ ++/****************************************************************************** ++* FW_NIC.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadFirmware_MP_8821A_FW_NIC( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++); ++ ++/****************************************************************************** ++* FW_WoWLAN.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadFirmware_MP_8821A_FW_WoWLAN( ++ PDM_ODM_T pDM_Odm, ++ u1Byte *pFirmware, ++ u4Byte *pFirmwareSize ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.c 2018-02-06 17:42:30.708967135 +0200 +@@ -0,0 +1,219 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++//#include "Mp_Precomp.h" ++#include "odm_precomp.h" ++ ++static bool ++CheckCondition( ++ const u4Byte Condition, ++ const u4Byte Hex ++ ) ++{ ++ u4Byte _board = (Hex & 0x000000FF); ++ u4Byte _interface = (Hex & 0x0000FF00) >> 8; ++ u4Byte _platform = (Hex & 0x00FF0000) >> 16; ++ u4Byte cond = Condition; ++ ++ if ( Condition == 0xCDCDCDCD ) ++ return true; ++ ++ cond = Condition & 0x000000FF; ++ if ( (_board != cond) && (cond != 0xFF) ) ++ return false; ++ ++ cond = Condition & 0x0000FF00; ++ cond = cond >> 8; ++ if ( ((_interface & cond) == 0) && (cond != 0x07) ) ++ return false; ++ ++ cond = Condition & 0x00FF0000; ++ cond = cond >> 16; ++ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) ++ return false; ++ return true; ++} ++ ++ ++/****************************************************************************** ++* MAC_REG.TXT ++******************************************************************************/ ++ ++static u4Byte Array_MP_8821A_MAC_REG[] = { ++ 0x428, 0x0000000A, ++ 0x429, 0x00000010, ++ 0x430, 0x00000000, ++ 0x431, 0x00000000, ++ 0x432, 0x00000000, ++ 0x433, 0x00000001, ++ 0x434, 0x00000004, ++ 0x435, 0x00000005, ++ 0x436, 0x00000007, ++ 0x437, 0x00000008, ++ 0x43C, 0x00000004, ++ 0x43D, 0x00000005, ++ 0x43E, 0x00000007, ++ 0x43F, 0x00000008, ++ 0x440, 0x0000005D, ++ 0x441, 0x00000001, ++ 0x442, 0x00000000, ++ 0x444, 0x00000010, ++ 0x445, 0x00000000, ++ 0x446, 0x00000000, ++ 0x447, 0x00000000, ++ 0x448, 0x00000000, ++ 0x449, 0x000000F0, ++ 0x44A, 0x0000000F, ++ 0x44B, 0x0000003E, ++ 0x44C, 0x00000010, ++ 0x44D, 0x00000000, ++ 0x44E, 0x00000000, ++ 0x44F, 0x00000000, ++ 0x450, 0x00000000, ++ 0x451, 0x000000F0, ++ 0x452, 0x0000000F, ++ 0x453, 0x00000000, ++ 0x456, 0x0000005E, ++ 0x460, 0x00000066, ++ 0x461, 0x00000066, ++ 0x4C8, 0x000000FF, ++ 0x4C9, 0x00000008, ++ 0x4CC, 0x000000FF, ++ 0x4CD, 0x000000FF, ++ 0x4CE, 0x00000001, ++ 0x500, 0x00000026, ++ 0x501, 0x000000A2, ++ 0x502, 0x0000002F, ++ 0x503, 0x00000000, ++ 0x504, 0x00000028, ++ 0x505, 0x000000A3, ++ 0x506, 0x0000005E, ++ 0x507, 0x00000000, ++ 0x508, 0x0000002B, ++ 0x509, 0x000000A4, ++ 0x50A, 0x0000005E, ++ 0x50B, 0x00000000, ++ 0x50C, 0x0000004F, ++ 0x50D, 0x000000A4, ++ 0x50E, 0x00000000, ++ 0x50F, 0x00000000, ++ 0x512, 0x0000001C, ++ 0x514, 0x0000000A, ++ 0x516, 0x0000000A, ++ 0x525, 0x0000004F, ++ 0x550, 0x00000010, ++ 0x551, 0x00000010, ++ 0x559, 0x00000002, ++ 0x55C, 0x00000050, ++ 0x55D, 0x000000FF, ++ 0x605, 0x00000030, ++ 0x607, 0x00000007, ++ 0x608, 0x0000000E, ++ 0x609, 0x0000002A, ++ 0x620, 0x000000FF, ++ 0x621, 0x000000FF, ++ 0x622, 0x000000FF, ++ 0x623, 0x000000FF, ++ 0x624, 0x000000FF, ++ 0x625, 0x000000FF, ++ 0x626, 0x000000FF, ++ 0x627, 0x000000FF, ++ 0x638, 0x00000050, ++ 0x63C, 0x0000000A, ++ 0x63D, 0x0000000A, ++ 0x63E, 0x0000000E, ++ 0x63F, 0x0000000E, ++ 0x640, 0x00000040, ++ 0x642, 0x00000040, ++ 0x643, 0x00000000, ++ 0x66E, 0x00000005, ++ 0x700, 0x00000021, ++ 0x701, 0x00000043, ++ 0x702, 0x00000065, ++ 0x703, 0x00000087, ++ 0x708, 0x00000021, ++ 0x709, 0x00000043, ++ 0x70A, 0x00000065, ++ 0x70B, 0x00000087, ++ 0x718, 0x00000040, ++ ++}; ++ ++void ODM_ReadAndConfig_MP_8821A_MAC_REG(PDM_ODM_T pDM_Odm) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8821A_MAC_REG)/sizeof(u4Byte); ++ pu4Byte Array = Array_MP_8821A_MAC_REG; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8821A_MAC_REG, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigMAC_8821A(pDM_Odm, v1, (u1Byte)v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigMAC_8821A(pDM_Odm, v1, (u1Byte)v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.h 2018-02-06 17:42:30.708967135 +0200 +@@ -0,0 +1,31 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++* ++******************************************************************************/ ++ ++#ifndef __INC_MP_MAC_HW_IMG_8821A_H ++#define __INC_MP_MAC_HW_IMG_8821A_H ++ ++static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); ++ ++/****************************************************************************** ++* MAC_REG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8821A_MAC_REG( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.c 2018-02-06 17:42:30.708967135 +0200 +@@ -0,0 +1,1500 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++//#include "Mp_Precomp.h" ++#include "odm_precomp.h" ++ ++static bool ++CheckCondition( ++ const u4Byte Condition, ++ const u4Byte Hex ++ ) ++{ ++ u4Byte _board = (Hex & 0x000000FF); ++ u4Byte _interface = (Hex & 0x0000FF00) >> 8; ++ u4Byte _platform = (Hex & 0x00FF0000) >> 16; ++ u4Byte cond = Condition; ++ ++ if ( Condition == 0xCDCDCDCD ) ++ return true; ++ ++ cond = Condition & 0x000000FF; ++ if ( (_board != cond) && (cond != 0xFF) ) ++ return false; ++ ++ cond = Condition & 0x0000FF00; ++ cond = cond >> 8; ++ if ( ((_interface & cond) == 0) && (cond != 0x07) ) ++ return false; ++ ++ cond = Condition & 0x00FF0000; ++ cond = cond >> 16; ++ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) ++ return false; ++ return true; ++} ++ ++ ++/****************************************************************************** ++* RadioA.TXT ++******************************************************************************/ ++ ++static const u4Byte Array_MP_8821A_RadioA[] = { ++ 0x018, 0x0001712A, ++ 0x056, 0x00051CF2, ++ 0x066, 0x00040000, ++ 0x000, 0x00010000, ++ 0x01E, 0x00080000, ++ 0x082, 0x00000830, ++ 0x083, 0x00021800, ++ 0x084, 0x00028000, ++ 0x085, 0x00048000, ++ 0x086, 0x00094838, ++ 0x087, 0x00044980, ++ 0x088, 0x00048000, ++ 0x089, 0x0000D480, ++ 0x08A, 0x00042240, ++ 0x08B, 0x000F0380, ++ 0x08C, 0x00090000, ++ 0x08D, 0x00022852, ++ 0x08E, 0x00065540, ++ 0x08F, 0x00088001, ++ 0x0EF, 0x00020000, ++ 0x03E, 0x00000380, ++ 0x03F, 0x00090018, ++ 0x03E, 0x00020380, ++ 0x03F, 0x000A0018, ++ 0x03E, 0x00040308, ++ 0x03F, 0x000A0018, ++ 0x03E, 0x00060018, ++ 0x03F, 0x000A0018, ++ 0x0EF, 0x00000000, ++ 0x018, 0x0001712A, ++ 0x089, 0x00000080, ++ 0x08B, 0x00080180, ++ 0x0EF, 0x00001000, ++ 0x03A, 0x00000244, ++ 0x03B, 0x00038027, ++ 0x03C, 0x00082000, ++ 0x03A, 0x00000244, ++ 0x03B, 0x00030113, ++ 0x03C, 0x00082000, ++ 0x03A, 0x0000014C, ++ 0x03B, 0x00028027, ++ 0x03C, 0x00082000, ++ 0x03A, 0x000000CC, ++ 0x03B, 0x00027027, ++ 0x03C, 0x00042000, ++ 0x03A, 0x0000014C, ++ 0x03B, 0x0001F913, ++ 0x03C, 0x00042000, ++ 0x03A, 0x0000010C, ++ 0x03B, 0x00017F10, ++ 0x03C, 0x00012000, ++ 0x03A, 0x000000D0, ++ 0x03B, 0x00008027, ++ 0x03C, 0x000CA000, ++ 0x03A, 0x00000244, ++ 0x03B, 0x00078027, ++ 0x03C, 0x00082000, ++ 0x03A, 0x00000244, ++ 0x03B, 0x00070113, ++ 0x03C, 0x00082000, ++ 0x03A, 0x0000014C, ++ 0x03B, 0x00068027, ++ 0x03C, 0x00082000, ++ 0x03A, 0x000000CC, ++ 0x03B, 0x00067027, ++ 0x03C, 0x00042000, ++ 0x03A, 0x0000014C, ++ 0x03B, 0x0005F913, ++ 0x03C, 0x00042000, ++ 0x03A, 0x0000010C, ++ 0x03B, 0x00057F10, ++ 0x03C, 0x00012000, ++ 0x03A, 0x000000D0, ++ 0x03B, 0x00048027, ++ 0x03C, 0x000CA000, ++ 0x03A, 0x00000244, ++ 0x03B, 0x000B8027, ++ 0x03C, 0x00082000, ++ 0x03A, 0x00000244, ++ 0x03B, 0x000B0113, ++ 0x03C, 0x00082000, ++ 0x03A, 0x0000014C, ++ 0x03B, 0x000A8027, ++ 0x03C, 0x00082000, ++ 0x03A, 0x000000CC, ++ 0x03B, 0x000A7027, ++ 0x03C, 0x00042000, ++ 0x03A, 0x0000014C, ++ 0x03B, 0x0009F913, ++ 0x03C, 0x00042000, ++ 0x03A, 0x0000010C, ++ 0x03B, 0x00097F10, ++ 0x03C, 0x00012000, ++ 0x03A, 0x000000D0, ++ 0x03B, 0x00088027, ++ 0x03C, 0x000CA000, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x00001100, ++ 0xFF0F0104, 0xABCD, ++ 0x034, 0x0004ADF3, ++ 0x034, 0x00049DF0, ++ 0xFF0F0204, 0xCDEF, ++ 0x034, 0x0004ADF3, ++ 0x034, 0x00049DF0, ++ 0xFF0F0404, 0xCDEF, ++ 0x034, 0x0004ADF3, ++ 0x034, 0x00049DF0, ++ 0xFF0F0200, 0xCDEF, ++ 0x034, 0x0004ADF5, ++ 0x034, 0x00049DF2, ++ 0xFF0F02C0, 0xCDEF, ++ 0x034, 0x0004A0F3, ++ 0x034, 0x000490B1, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0004ADF7, ++ 0x034, 0x00049DF3, ++ 0xFF0F0104, 0xDEAD, ++ 0xFF0F0104, 0xABCD, ++ 0x034, 0x00048DED, ++ 0x034, 0x00047DEA, ++ 0x034, 0x00046DE7, ++ 0x034, 0x00045CE9, ++ 0x034, 0x00044CE6, ++ 0x034, 0x000438C6, ++ 0x034, 0x00042886, ++ 0x034, 0x00041486, ++ 0x034, 0x00040447, ++ 0xFF0F0204, 0xCDEF, ++ 0x034, 0x00048DED, ++ 0x034, 0x00047DEA, ++ 0x034, 0x00046DE7, ++ 0x034, 0x00045CE9, ++ 0x034, 0x00044CE6, ++ 0x034, 0x000438C6, ++ 0x034, 0x00042886, ++ 0x034, 0x00041486, ++ 0x034, 0x00040447, ++ 0xFF0F0404, 0xCDEF, ++ 0x034, 0x00048DED, ++ 0x034, 0x00047DEA, ++ 0x034, 0x00046DE7, ++ 0x034, 0x00045CE9, ++ 0x034, 0x00044CE6, ++ 0x034, 0x000438C6, ++ 0x034, 0x00042886, ++ 0x034, 0x00041486, ++ 0x034, 0x00040447, ++ 0xFF0F02C0, 0xCDEF, ++ 0x034, 0x000480AE, ++ 0x034, 0x000470AB, ++ 0x034, 0x0004608B, ++ 0x034, 0x00045069, ++ 0x034, 0x00044048, ++ 0x034, 0x00043045, ++ 0x034, 0x00042026, ++ 0x034, 0x00041023, ++ 0x034, 0x00040002, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x00048DEF, ++ 0x034, 0x00047DEC, ++ 0x034, 0x00046DE9, ++ 0x034, 0x00045CCB, ++ 0x034, 0x0004488D, ++ 0x034, 0x0004348D, ++ 0x034, 0x0004248A, ++ 0x034, 0x0004108D, ++ 0x034, 0x0004008A, ++ 0xFF0F0104, 0xDEAD, ++ 0xFF0F0200, 0xABCD, ++ 0x034, 0x0002ADF4, ++ 0xFF0F02C0, 0xCDEF, ++ 0x034, 0x0002A0F3, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0002ADF7, ++ 0xFF0F0200, 0xDEAD, ++ 0xFF0F0104, 0xABCD, ++ 0x034, 0x00029DF4, ++ 0xFF0F0204, 0xCDEF, ++ 0x034, 0x00029DF4, ++ 0xFF0F0404, 0xCDEF, ++ 0x034, 0x00029DF4, ++ 0xFF0F0200, 0xCDEF, ++ 0x034, 0x00029DF1, ++ 0xFF0F02C0, 0xCDEF, ++ 0x034, 0x000290F0, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x00029DF2, ++ 0xFF0F0104, 0xDEAD, ++ 0xFF0F0104, 0xABCD, ++ 0x034, 0x00028DF1, ++ 0x034, 0x00027DEE, ++ 0x034, 0x00026DEB, ++ 0x034, 0x00025CEC, ++ 0x034, 0x00024CE9, ++ 0x034, 0x000238CA, ++ 0x034, 0x00022889, ++ 0x034, 0x00021489, ++ 0x034, 0x0002044A, ++ 0xFF0F0204, 0xCDEF, ++ 0x034, 0x00028DF1, ++ 0x034, 0x00027DEE, ++ 0x034, 0x00026DEB, ++ 0x034, 0x00025CEC, ++ 0x034, 0x00024CE9, ++ 0x034, 0x000238CA, ++ 0x034, 0x00022889, ++ 0x034, 0x00021489, ++ 0x034, 0x0002044A, ++ 0xFF0F0404, 0xCDEF, ++ 0x034, 0x00028DF1, ++ 0x034, 0x00027DEE, ++ 0x034, 0x00026DEB, ++ 0x034, 0x00025CEC, ++ 0x034, 0x00024CE9, ++ 0x034, 0x000238CA, ++ 0x034, 0x00022889, ++ 0x034, 0x00021489, ++ 0x034, 0x0002044A, ++ 0xFF0F02C0, 0xCDEF, ++ 0x034, 0x000280AF, ++ 0x034, 0x000270AC, ++ 0x034, 0x0002608B, ++ 0x034, 0x00025069, ++ 0x034, 0x00024048, ++ 0x034, 0x00023045, ++ 0x034, 0x00022026, ++ 0x034, 0x00021023, ++ 0x034, 0x00020002, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x00028DEE, ++ 0x034, 0x00027DEB, ++ 0x034, 0x00026CCD, ++ 0x034, 0x00025CCA, ++ 0x034, 0x0002488C, ++ 0x034, 0x0002384C, ++ 0x034, 0x00022849, ++ 0x034, 0x00021449, ++ 0x034, 0x0002004D, ++ 0xFF0F0104, 0xDEAD, ++ 0xFF0F02C0, 0xABCD, ++ 0x034, 0x0000A0D7, ++ 0x034, 0x000090D3, ++ 0x034, 0x000080B1, ++ 0x034, 0x000070AE, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0000ADF7, ++ 0x034, 0x00009DF4, ++ 0x034, 0x00008DF1, ++ 0x034, 0x00007DEE, ++ 0xFF0F02C0, 0xDEAD, ++ 0xFF0F0104, 0xABCD, ++ 0x034, 0x00006DEB, ++ 0x034, 0x00005CEC, ++ 0x034, 0x00004CE9, ++ 0x034, 0x000038CA, ++ 0x034, 0x00002889, ++ 0x034, 0x00001489, ++ 0x034, 0x0000044A, ++ 0xFF0F0204, 0xCDEF, ++ 0x034, 0x00006DEB, ++ 0x034, 0x00005CEC, ++ 0x034, 0x00004CE9, ++ 0x034, 0x000038CA, ++ 0x034, 0x00002889, ++ 0x034, 0x00001489, ++ 0x034, 0x0000044A, ++ 0xFF0F0404, 0xCDEF, ++ 0x034, 0x00006DEB, ++ 0x034, 0x00005CEC, ++ 0x034, 0x00004CE9, ++ 0x034, 0x000038CA, ++ 0x034, 0x00002889, ++ 0x034, 0x00001489, ++ 0x034, 0x0000044A, ++ 0xFF0F02C0, 0xCDEF, ++ 0x034, 0x0000608D, ++ 0x034, 0x0000506B, ++ 0x034, 0x0000404A, ++ 0x034, 0x00003047, ++ 0x034, 0x00002044, ++ 0x034, 0x00001025, ++ 0x034, 0x00000004, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x00006DCD, ++ 0x034, 0x00005CCD, ++ 0x034, 0x00004CCA, ++ 0x034, 0x0000388C, ++ 0x034, 0x00002888, ++ 0x034, 0x00001488, ++ 0x034, 0x00000486, ++ 0xFF0F0104, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0xFF0F0104, 0xABCD, ++ 0x035, 0x00000187, ++ 0x035, 0x00008187, ++ 0x035, 0x00010187, ++ 0x035, 0x00020188, ++ 0x035, 0x00028188, ++ 0x035, 0x00030188, ++ 0x035, 0x00040188, ++ 0x035, 0x00048188, ++ 0x035, 0x00050188, ++ 0xFF0F0204, 0xCDEF, ++ 0x035, 0x00000187, ++ 0x035, 0x00008187, ++ 0x035, 0x00010187, ++ 0x035, 0x00020188, ++ 0x035, 0x00028188, ++ 0x035, 0x00030188, ++ 0x035, 0x00040188, ++ 0x035, 0x00048188, ++ 0x035, 0x00050188, ++ 0xFF0F0404, 0xCDEF, ++ 0x035, 0x00000187, ++ 0x035, 0x00008187, ++ 0x035, 0x00010187, ++ 0x035, 0x00020188, ++ 0x035, 0x00028188, ++ 0x035, 0x00030188, ++ 0x035, 0x00040188, ++ 0x035, 0x00048188, ++ 0x035, 0x00050188, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x035, 0x00000145, ++ 0x035, 0x00008145, ++ 0x035, 0x00010145, ++ 0x035, 0x00020196, ++ 0x035, 0x00028196, ++ 0x035, 0x00030196, ++ 0x035, 0x000401C7, ++ 0x035, 0x000481C7, ++ 0x035, 0x000501C7, ++ 0xFF0F0104, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0xFF0F0104, 0xABCD, ++ 0x036, 0x00085733, ++ 0x036, 0x0008D733, ++ 0x036, 0x00095733, ++ 0x036, 0x0009D733, ++ 0x036, 0x000A64B4, ++ 0x036, 0x000AE4B4, ++ 0x036, 0x000B64B4, ++ 0x036, 0x000BE4B4, ++ 0x036, 0x000C64B4, ++ 0x036, 0x000CE4B4, ++ 0x036, 0x000D64B4, ++ 0x036, 0x000DE4B4, ++ 0xFF0F0204, 0xCDEF, ++ 0x036, 0x00085733, ++ 0x036, 0x0008D733, ++ 0x036, 0x00095733, ++ 0x036, 0x0009D733, ++ 0x036, 0x000A64B4, ++ 0x036, 0x000AE4B4, ++ 0x036, 0x000B64B4, ++ 0x036, 0x000BE4B4, ++ 0x036, 0x000C64B4, ++ 0x036, 0x000CE4B4, ++ 0x036, 0x000D64B4, ++ 0x036, 0x000DE4B4, ++ 0xFF0F0404, 0xCDEF, ++ 0x036, 0x00085733, ++ 0x036, 0x0008D733, ++ 0x036, 0x00095733, ++ 0x036, 0x0009D733, ++ 0x036, 0x000A64B4, ++ 0x036, 0x000AE4B4, ++ 0x036, 0x000B64B4, ++ 0x036, 0x000BE4B4, ++ 0x036, 0x000C64B4, ++ 0x036, 0x000CE4B4, ++ 0x036, 0x000D64B4, ++ 0x036, 0x000DE4B4, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x036, 0x000056B3, ++ 0x036, 0x0000D6B3, ++ 0x036, 0x000156B3, ++ 0x036, 0x0001D6B3, ++ 0x036, 0x00026634, ++ 0x036, 0x0002E634, ++ 0x036, 0x00036634, ++ 0x036, 0x0003E634, ++ 0x036, 0x000467B4, ++ 0x036, 0x0004E7B4, ++ 0x036, 0x000567B4, ++ 0x036, 0x0005E7B4, ++ 0xFF0F0104, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x00000008, ++ 0xFF0F0104, 0xABCD, ++ 0x03C, 0x000001C8, ++ 0x03C, 0x00000492, ++ 0xFF0F0204, 0xCDEF, ++ 0x03C, 0x000001C8, ++ 0x03C, 0x00000492, ++ 0xFF0F0404, 0xCDEF, ++ 0x03C, 0x000001C8, ++ 0x03C, 0x00000492, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x03C, 0x0000022A, ++ 0x03C, 0x00000594, ++ 0xFF0F0104, 0xDEAD, ++ 0xFF0F0104, 0xABCD, ++ 0x03C, 0x00000800, ++ 0xFF0F0204, 0xCDEF, ++ 0x03C, 0x00000800, ++ 0xFF0F0404, 0xCDEF, ++ 0x03C, 0x00000800, ++ 0xFF0F02C0, 0xCDEF, ++ 0x03C, 0x00000820, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x03C, 0x00000900, ++ 0xFF0F0104, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000002, ++ 0xFF0F0104, 0xABCD, ++ 0x008, 0x0004E400, ++ 0xFF0F0204, 0xCDEF, ++ 0x008, 0x0004E400, ++ 0xFF0F0404, 0xCDEF, ++ 0x008, 0x0004E400, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x008, 0x00002000, ++ 0xFF0F0104, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x0DF, 0x000000C0, ++ 0x01F, 0x00040064, ++ 0xFF0F0104, 0xABCD, ++ 0x058, 0x000A7284, ++ 0x059, 0x000600EC, ++ 0xFF0F0204, 0xCDEF, ++ 0x058, 0x000A7284, ++ 0x059, 0x000600EC, ++ 0xFF0F0404, 0xCDEF, ++ 0x058, 0x000A7284, ++ 0x059, 0x000600EC, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x058, 0x00081184, ++ 0x059, 0x0006016C, ++ 0xFF0F0104, 0xDEAD, ++ 0xFF0F0104, 0xABCD, ++ 0x061, 0x000E8D73, ++ 0x062, 0x00093FC5, ++ 0xFF0F0204, 0xCDEF, ++ 0x061, 0x000E8D73, ++ 0x062, 0x00093FC5, ++ 0xFF0F0404, 0xCDEF, ++ 0x061, 0x000E8D73, ++ 0x062, 0x00093FC5, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x061, 0x000EAD53, ++ 0x062, 0x00093BC4, ++ 0xFF0F0104, 0xDEAD, ++ 0xFF0F0104, 0xABCD, ++ 0x063, 0x000110E9, ++ 0xFF0F0204, 0xCDEF, ++ 0x063, 0x000110E9, ++ 0xFF0F0404, 0xCDEF, ++ 0x063, 0x000110E9, ++ 0xFF0F0200, 0xCDEF, ++ 0x063, 0x000710E9, ++ 0xFF0F02C0, 0xCDEF, ++ 0x063, 0x000110E9, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x063, 0x000714E9, ++ 0xFF0F0104, 0xDEAD, ++ 0xFF0F0104, 0xABCD, ++ 0x064, 0x0001C27C, ++ 0xFF0F0204, 0xCDEF, ++ 0x064, 0x0001C27C, ++ 0xFF0F0404, 0xCDEF, ++ 0x064, 0x0001C27C, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x064, 0x0001C67C, ++ 0xFF0F0104, 0xDEAD, ++ 0xFF0F0200, 0xABCD, ++ 0x065, 0x00093016, ++ 0xFF0F02C0, 0xCDEF, ++ 0x065, 0x00093015, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x065, 0x00091016, ++ 0xFF0F0200, 0xDEAD, ++ 0x018, 0x00000006, ++ 0x0EF, 0x00002000, ++ 0x03B, 0x0003824B, ++ 0x03B, 0x0003024B, ++ 0x03B, 0x0002884B, ++ 0x03B, 0x00020F4B, ++ 0x03B, 0x00018F4B, ++ 0x03B, 0x000104B2, ++ 0x03B, 0x00008049, ++ 0x03B, 0x00000148, ++ 0x03B, 0x0007824B, ++ 0x03B, 0x0007024B, ++ 0x03B, 0x0006824B, ++ 0x03B, 0x00060F4B, ++ 0x03B, 0x00058F4B, ++ 0x03B, 0x000504B2, ++ 0x03B, 0x00048049, ++ 0x03B, 0x00040148, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x00000100, ++ 0x034, 0x0000ADF2, ++ 0x035, 0x00004800, ++ 0x034, 0x00009DEF, ++ 0x035, 0x00003C00, ++ 0x034, 0x00008DEC, ++ 0x035, 0x00003000, ++ 0x034, 0x00007DE9, ++ 0x035, 0x00002400, ++ 0x034, 0x00006CEC, ++ 0x035, 0x00003000, ++ 0x034, 0x00005CE9, ++ 0x035, 0x00002400, ++ 0x034, 0x000044EC, ++ 0x035, 0x00003000, ++ 0x034, 0x000034E9, ++ 0x035, 0x00002400, ++ 0x034, 0x0000246C, ++ 0x035, 0x00003000, ++ 0x034, 0x00001469, ++ 0x035, 0x00002400, ++ 0x034, 0x0000006C, ++ 0x035, 0x00003000, ++ 0x0EF, 0x00000000, ++ 0x0ED, 0x00000010, ++ 0x044, 0x0000ADF2, ++ 0x044, 0x00009DEF, ++ 0x044, 0x00008DEC, ++ 0x044, 0x00007DE9, ++ 0x044, 0x00006CEC, ++ 0x044, 0x00005CE9, ++ 0x044, 0x000044EC, ++ 0x044, 0x000034E9, ++ 0x044, 0x0000246C, ++ 0x044, 0x00001469, ++ 0x044, 0x0000006C, ++ 0x0ED, 0x00000000, ++ 0x0ED, 0x00000001, ++ 0x040, 0x00038DA7, ++ 0x040, 0x000300C2, ++ 0x040, 0x000288E2, ++ 0x040, 0x000200B8, ++ 0x040, 0x000188A5, ++ 0x040, 0x00010FBC, ++ 0x040, 0x00008F71, ++ 0x040, 0x00000240, ++ 0x0ED, 0x00000000, ++ 0x0EF, 0x000020A2, ++ 0x0DF, 0x00000080, ++ 0x035, 0x00000120, ++ 0x035, 0x00008120, ++ 0x035, 0x00010120, ++ 0x036, 0x00000085, ++ 0x036, 0x00008085, ++ 0x036, 0x00010085, ++ 0x036, 0x00018085, ++ 0x0EF, 0x00000000, ++ 0x051, 0x00000C31, ++ 0x052, 0x00000622, ++ 0x053, 0x000FC70B, ++ 0x054, 0x0000017E, ++ 0x056, 0x00051DF3, ++ 0x051, 0x00000C01, ++ 0x052, 0x000006D6, ++ 0x053, 0x000FC649, ++ 0x070, 0x00049661, ++ 0x071, 0x0007843E, ++ 0x072, 0x00000382, ++ 0x074, 0x00051400, ++ 0x035, 0x00000160, ++ 0x035, 0x00008160, ++ 0x035, 0x00010160, ++ 0x036, 0x00000124, ++ 0x036, 0x00008124, ++ 0x036, 0x00010124, ++ 0x036, 0x00018124, ++ 0x0ED, 0x0000000C, ++ 0x045, 0x00000140, ++ 0x045, 0x00008140, ++ 0x045, 0x00010140, ++ 0x046, 0x00000124, ++ 0x046, 0x00008124, ++ 0x046, 0x00010124, ++ 0x046, 0x00018124, ++ 0x0DF, 0x00000088, ++ 0x0B3, 0x000F0E18, ++ 0x0B4, 0x0001214C, ++ 0x0B7, 0x0003000C, ++ 0x01C, 0x000539D2, ++ 0x018, 0x0001F12A, ++ 0x0FE, 0x00000000, ++ 0x0FE, 0x00000000, ++ 0x018, 0x0001712A, ++ ++}; ++ ++void ++ODM_ReadAndConfig_MP_8821A_RadioA( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_MP_8821A_RadioA)/sizeof(u4Byte); ++ const pu4Byte Array = Array_MP_8821A_RadioA; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8821A_RadioA, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigRF_RadioA_8821A(pDM_Odm, v1, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigRF_RadioA_8821A(pDM_Odm, v1, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* TxPowerTrack_AP.TXT ++******************************************************************************/ ++ ++static const u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_AP_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++}; ++static const u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_AP_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 17, 17, 18, 19, 20, 20, 20}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++}; ++static const u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_AP_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 4, 4, 5, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 13, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16}, ++}; ++static const u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_AP_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 7, 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 18, 19, 19, 19}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_AP_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_AP_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_AP_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_AP_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_AP_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_AP_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_AP_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_AP_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++ ++void ++ODM_ReadAndConfig_MP_8821A_TxPowerTrack_AP( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8821A\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE*3); ++} ++ ++/****************************************************************************** ++* TxPowerTrack_PCIE.TXT ++******************************************************************************/ ++ ++static const u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static const u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static const u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 13, 13, 13}, ++ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 11, 12, 12, 12, 12, 12, 13, 13}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 8, 8, 9, 10, 11, 12, 13, 14, 14, 15, 15, 15, 16, 16, 16, 17, 17, 18, 18}, ++}; ++static const u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++ ++void ++ODM_ReadAndConfig_MP_8821A_TxPowerTrack_PCIE( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8821A\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); ++} ++ ++/****************************************************************************** ++* TxPowerTrack_USB.TXT ++******************************************************************************/ ++ ++static const u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static const u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++}; ++static const u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 0, 0, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15}, ++ {0, 0, 0, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15}, ++ {0, 0, 0, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15}, ++}; ++static const u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16}, ++ {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16}, ++ {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16}, ++}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; ++static const u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++ ++void ++ODM_ReadAndConfig_MP_8821A_TxPowerTrack_USB( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8821A\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE*3); ++} ++ ++/****************************************************************************** ++* TXPWR_LMT.TXT ++******************************************************************************/ ++ ++static const pu1Byte Array_MP_8821A_TXPWR_LMT[] = { ++ "FCC", "2.4G", "20M", "CCK", "1T", "01", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "02", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "03", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "04", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "05", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "06", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "07", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "08", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "09", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "10", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "11", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "12", "63", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "13", "63", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "32", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "32", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "63", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "63", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "FCC", "2.4G", "20M", "HT", "1T", "01", "32", ++ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "02", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "03", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "04", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "05", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "06", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "07", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "08", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "09", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "10", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "11", "32", ++ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "12", "63", ++ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "13", "63", ++ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", ++ "FCC", "2.4G", "20M", "HT", "2T", "01", "30", ++ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "02", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "03", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "04", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "05", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "06", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "07", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "08", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "09", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "10", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", ++ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", ++ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "03", "32", ++ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "04", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "05", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "06", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "07", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "08", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "09", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "10", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "11", "32", ++ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "12", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "12", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "13", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "13", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", ++ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "04", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "05", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "06", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "07", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "08", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "09", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "10", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", ++ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", ++ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", ++ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", ++ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", ++ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "36", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "36", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "40", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "40", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "44", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "48", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "52", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "56", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "60", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "64", "28", ++ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "100", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "100", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "114", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "114", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "114", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "108", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "108", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "112", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "112", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "116", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "116", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "120", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "120", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "124", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "124", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "128", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "128", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "132", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "132", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "136", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "136", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "140", "28", ++ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "140", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "149", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "153", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "157", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "161", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "165", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", ++ "FCC", "5G", "20M", "HT", "1T", "36", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "36", "32", ++ "MKK", "5G", "20M", "HT", "1T", "36", "32", ++ "FCC", "5G", "20M", "HT", "1T", "40", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "40", "32", ++ "MKK", "5G", "20M", "HT", "1T", "40", "32", ++ "FCC", "5G", "20M", "HT", "1T", "44", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "44", "32", ++ "MKK", "5G", "20M", "HT", "1T", "44", "32", ++ "FCC", "5G", "20M", "HT", "1T", "48", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "48", "32", ++ "MKK", "5G", "20M", "HT", "1T", "48", "32", ++ "FCC", "5G", "20M", "HT", "1T", "52", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "52", "32", ++ "MKK", "5G", "20M", "HT", "1T", "52", "32", ++ "FCC", "5G", "20M", "HT", "1T", "56", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "56", "32", ++ "MKK", "5G", "20M", "HT", "1T", "56", "32", ++ "FCC", "5G", "20M", "HT", "1T", "60", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "60", "32", ++ "MKK", "5G", "20M", "HT", "1T", "60", "32", ++ "FCC", "5G", "20M", "HT", "1T", "64", "28", ++ "ETSI", "5G", "20M", "HT", "1T", "64", "32", ++ "MKK", "5G", "20M", "HT", "1T", "64", "32", ++ "FCC", "5G", "20M", "HT", "1T", "100", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "100", "32", ++ "MKK", "5G", "20M", "HT", "1T", "100", "32", ++ "FCC", "5G", "20M", "HT", "1T", "114", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "114", "32", ++ "MKK", "5G", "20M", "HT", "1T", "114", "32", ++ "FCC", "5G", "20M", "HT", "1T", "108", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "108", "32", ++ "MKK", "5G", "20M", "HT", "1T", "108", "32", ++ "FCC", "5G", "20M", "HT", "1T", "112", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "112", "32", ++ "MKK", "5G", "20M", "HT", "1T", "112", "32", ++ "FCC", "5G", "20M", "HT", "1T", "116", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "116", "32", ++ "MKK", "5G", "20M", "HT", "1T", "116", "32", ++ "FCC", "5G", "20M", "HT", "1T", "120", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "120", "32", ++ "MKK", "5G", "20M", "HT", "1T", "120", "32", ++ "FCC", "5G", "20M", "HT", "1T", "124", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "124", "32", ++ "MKK", "5G", "20M", "HT", "1T", "124", "32", ++ "FCC", "5G", "20M", "HT", "1T", "128", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "128", "32", ++ "MKK", "5G", "20M", "HT", "1T", "128", "32", ++ "FCC", "5G", "20M", "HT", "1T", "132", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "132", "32", ++ "MKK", "5G", "20M", "HT", "1T", "132", "32", ++ "FCC", "5G", "20M", "HT", "1T", "136", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "136", "32", ++ "MKK", "5G", "20M", "HT", "1T", "136", "32", ++ "FCC", "5G", "20M", "HT", "1T", "140", "28", ++ "ETSI", "5G", "20M", "HT", "1T", "140", "32", ++ "MKK", "5G", "20M", "HT", "1T", "140", "32", ++ "FCC", "5G", "20M", "HT", "1T", "149", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "149", "32", ++ "MKK", "5G", "20M", "HT", "1T", "149", "63", ++ "FCC", "5G", "20M", "HT", "1T", "153", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "153", "32", ++ "MKK", "5G", "20M", "HT", "1T", "153", "63", ++ "FCC", "5G", "20M", "HT", "1T", "157", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "157", "32", ++ "MKK", "5G", "20M", "HT", "1T", "157", "63", ++ "FCC", "5G", "20M", "HT", "1T", "161", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "161", "32", ++ "MKK", "5G", "20M", "HT", "1T", "161", "63", ++ "FCC", "5G", "20M", "HT", "1T", "165", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "165", "32", ++ "MKK", "5G", "20M", "HT", "1T", "165", "63", ++ "FCC", "5G", "20M", "HT", "2T", "36", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "36", "30", ++ "MKK", "5G", "20M", "HT", "2T", "36", "30", ++ "FCC", "5G", "20M", "HT", "2T", "40", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "40", "30", ++ "MKK", "5G", "20M", "HT", "2T", "40", "30", ++ "FCC", "5G", "20M", "HT", "2T", "44", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "44", "30", ++ "MKK", "5G", "20M", "HT", "2T", "44", "30", ++ "FCC", "5G", "20M", "HT", "2T", "48", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "48", "30", ++ "MKK", "5G", "20M", "HT", "2T", "48", "30", ++ "FCC", "5G", "20M", "HT", "2T", "52", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "52", "30", ++ "MKK", "5G", "20M", "HT", "2T", "52", "30", ++ "FCC", "5G", "20M", "HT", "2T", "56", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "56", "30", ++ "MKK", "5G", "20M", "HT", "2T", "56", "30", ++ "FCC", "5G", "20M", "HT", "2T", "60", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "60", "30", ++ "MKK", "5G", "20M", "HT", "2T", "60", "30", ++ "FCC", "5G", "20M", "HT", "2T", "64", "26", ++ "ETSI", "5G", "20M", "HT", "2T", "64", "30", ++ "MKK", "5G", "20M", "HT", "2T", "64", "30", ++ "FCC", "5G", "20M", "HT", "2T", "100", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "100", "30", ++ "MKK", "5G", "20M", "HT", "2T", "100", "30", ++ "FCC", "5G", "20M", "HT", "2T", "114", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "114", "30", ++ "MKK", "5G", "20M", "HT", "2T", "114", "30", ++ "FCC", "5G", "20M", "HT", "2T", "108", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "108", "30", ++ "MKK", "5G", "20M", "HT", "2T", "108", "30", ++ "FCC", "5G", "20M", "HT", "2T", "112", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "112", "30", ++ "MKK", "5G", "20M", "HT", "2T", "112", "30", ++ "FCC", "5G", "20M", "HT", "2T", "116", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "116", "30", ++ "MKK", "5G", "20M", "HT", "2T", "116", "30", ++ "FCC", "5G", "20M", "HT", "2T", "120", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "120", "30", ++ "MKK", "5G", "20M", "HT", "2T", "120", "30", ++ "FCC", "5G", "20M", "HT", "2T", "124", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "124", "30", ++ "MKK", "5G", "20M", "HT", "2T", "124", "30", ++ "FCC", "5G", "20M", "HT", "2T", "128", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "128", "30", ++ "MKK", "5G", "20M", "HT", "2T", "128", "30", ++ "FCC", "5G", "20M", "HT", "2T", "132", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "132", "30", ++ "MKK", "5G", "20M", "HT", "2T", "132", "30", ++ "FCC", "5G", "20M", "HT", "2T", "136", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "136", "30", ++ "MKK", "5G", "20M", "HT", "2T", "136", "30", ++ "FCC", "5G", "20M", "HT", "2T", "140", "26", ++ "ETSI", "5G", "20M", "HT", "2T", "140", "30", ++ "MKK", "5G", "20M", "HT", "2T", "140", "30", ++ "FCC", "5G", "20M", "HT", "2T", "149", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "149", "30", ++ "MKK", "5G", "20M", "HT", "2T", "149", "63", ++ "FCC", "5G", "20M", "HT", "2T", "153", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "153", "30", ++ "MKK", "5G", "20M", "HT", "2T", "153", "63", ++ "FCC", "5G", "20M", "HT", "2T", "157", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "157", "30", ++ "MKK", "5G", "20M", "HT", "2T", "157", "63", ++ "FCC", "5G", "20M", "HT", "2T", "161", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "161", "30", ++ "MKK", "5G", "20M", "HT", "2T", "161", "63", ++ "FCC", "5G", "20M", "HT", "2T", "165", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "165", "30", ++ "MKK", "5G", "20M", "HT", "2T", "165", "63", ++ "FCC", "5G", "40M", "HT", "1T", "38", "30", ++ "ETSI", "5G", "40M", "HT", "1T", "38", "32", ++ "MKK", "5G", "40M", "HT", "1T", "38", "32", ++ "FCC", "5G", "40M", "HT", "1T", "46", "30", ++ "ETSI", "5G", "40M", "HT", "1T", "46", "32", ++ "MKK", "5G", "40M", "HT", "1T", "46", "32", ++ "FCC", "5G", "40M", "HT", "1T", "54", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "54", "32", ++ "MKK", "5G", "40M", "HT", "1T", "54", "32", ++ "FCC", "5G", "40M", "HT", "1T", "62", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "62", "32", ++ "MKK", "5G", "40M", "HT", "1T", "62", "32", ++ "FCC", "5G", "40M", "HT", "1T", "102", "28", ++ "ETSI", "5G", "40M", "HT", "1T", "102", "32", ++ "MKK", "5G", "40M", "HT", "1T", "102", "32", ++ "FCC", "5G", "40M", "HT", "1T", "110", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "110", "32", ++ "MKK", "5G", "40M", "HT", "1T", "110", "32", ++ "FCC", "5G", "40M", "HT", "1T", "118", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "118", "32", ++ "MKK", "5G", "40M", "HT", "1T", "118", "32", ++ "FCC", "5G", "40M", "HT", "1T", "126", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "126", "32", ++ "MKK", "5G", "40M", "HT", "1T", "126", "32", ++ "FCC", "5G", "40M", "HT", "1T", "134", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "134", "32", ++ "MKK", "5G", "40M", "HT", "1T", "134", "32", ++ "FCC", "5G", "40M", "HT", "1T", "151", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "151", "32", ++ "MKK", "5G", "40M", "HT", "1T", "151", "63", ++ "FCC", "5G", "40M", "HT", "1T", "159", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "159", "32", ++ "MKK", "5G", "40M", "HT", "1T", "159", "63", ++ "FCC", "5G", "40M", "HT", "2T", "38", "28", ++ "ETSI", "5G", "40M", "HT", "2T", "38", "30", ++ "MKK", "5G", "40M", "HT", "2T", "38", "30", ++ "FCC", "5G", "40M", "HT", "2T", "46", "28", ++ "ETSI", "5G", "40M", "HT", "2T", "46", "30", ++ "MKK", "5G", "40M", "HT", "2T", "46", "30", ++ "FCC", "5G", "40M", "HT", "2T", "54", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "54", "30", ++ "MKK", "5G", "40M", "HT", "2T", "54", "30", ++ "FCC", "5G", "40M", "HT", "2T", "62", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "62", "30", ++ "MKK", "5G", "40M", "HT", "2T", "62", "30", ++ "FCC", "5G", "40M", "HT", "2T", "102", "26", ++ "ETSI", "5G", "40M", "HT", "2T", "102", "30", ++ "MKK", "5G", "40M", "HT", "2T", "102", "30", ++ "FCC", "5G", "40M", "HT", "2T", "110", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "110", "30", ++ "MKK", "5G", "40M", "HT", "2T", "110", "30", ++ "FCC", "5G", "40M", "HT", "2T", "118", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "118", "30", ++ "MKK", "5G", "40M", "HT", "2T", "118", "30", ++ "FCC", "5G", "40M", "HT", "2T", "126", "32", ++ "ETSI", "5G", "40M", "HT", "2T", "126", "30", ++ "MKK", "5G", "40M", "HT", "2T", "126", "30", ++ "FCC", "5G", "40M", "HT", "2T", "134", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "134", "30", ++ "MKK", "5G", "40M", "HT", "2T", "134", "30", ++ "FCC", "5G", "40M", "HT", "2T", "151", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "151", "30", ++ "MKK", "5G", "40M", "HT", "2T", "151", "63", ++ "FCC", "5G", "40M", "HT", "2T", "159", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "159", "30", ++ "MKK", "5G", "40M", "HT", "2T", "159", "63", ++ "FCC", "5G", "80M", "VHT", "1T", "42", "30", ++ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "42", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "58", "28", ++ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "58", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "106", "30", ++ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "106", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "122", "34", ++ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "122", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "155", "34", ++ "ETSI", "5G", "80M", "VHT", "1T", "155", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "155", "63", ++ "FCC", "5G", "80M", "VHT", "2T", "42", "28", ++ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "42", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "58", "26", ++ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "58", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "106", "28", ++ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "106", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "122", "32", ++ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "122", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "155", "34", ++ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "155", "63" ++}; ++ ++void ++ODM_ReadAndConfig_MP_8821A_TXPWR_LMT( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte i = 0; ++ u4Byte ArrayLen = sizeof(Array_MP_8821A_TXPWR_LMT)/sizeof(pu1Byte); ++ const pu1Byte *Array = Array_MP_8821A_TXPWR_LMT; ++ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8821A_TXPWR_LMT\n")); ++ ++ for (i = 0; i < ArrayLen; i += 7 ) ++ { ++ const pu1Byte regulation = Array[i]; ++ const pu1Byte band = Array[i+1]; ++ const pu1Byte bandwidth = Array[i+2]; ++ const pu1Byte rate = Array[i+3]; ++ const pu1Byte rfPath = Array[i+4]; ++ const pu1Byte chnl = Array[i+5]; ++ const pu1Byte val = Array[i+6]; ++ ++ odm_ConfigBB_TXPWR_LMT_8821A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); ++ } ++ ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.h 2018-02-06 17:42:30.708967135 +0200 +@@ -0,0 +1,66 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#ifndef __INC_MP_RF_HW_IMG_8821A_H ++#define __INC_MP_RF_HW_IMG_8821A_H ++ ++static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); ++ ++/****************************************************************************** ++* RadioA.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8821A_RadioA( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TxPowerTrack_AP.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8821A_TxPowerTrack_AP( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TxPowerTrack_PCIE.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8821A_TxPowerTrack_PCIE( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TxPowerTrack_USB.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8821A_TxPowerTrack_USB( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TXPWR_LMT.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_MP_8821A_TXPWR_LMT( // TC: Test Chip, MP: MP Chip ++ PDM_ODM_T pDM_Odm ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.c 2018-02-06 17:42:30.708967135 +0200 +@@ -0,0 +1,637 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++//#include "Mp_Precomp.h" ++#include "odm_precomp.h" ++ ++static bool ++CheckCondition( ++ const u4Byte Condition, ++ const u4Byte Hex ++ ) ++{ ++ u4Byte _board = (Hex & 0x000000FF); ++ u4Byte _interface = (Hex & 0x0000FF00) >> 8; ++ u4Byte _platform = (Hex & 0x00FF0000) >> 16; ++ u4Byte cond = Condition; ++ ++ if ( Condition == 0xCDCDCDCD ) ++ return true; ++ ++ cond = Condition & 0x000000FF; ++ if ( (_board != cond) && (cond != 0xFF) ) ++ return false; ++ ++ cond = Condition & 0x0000FF00; ++ cond = cond >> 8; ++ if ( ((_interface & cond) == 0) && (cond != 0x07) ) ++ return false; ++ ++ cond = Condition & 0x00FF0000; ++ cond = cond >> 16; ++ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) ++ return false; ++ return true; ++} ++ ++ ++/****************************************************************************** ++* AGC_TAB.TXT ++******************************************************************************/ ++ ++static const u4Byte Array_TC_8821A_AGC_TAB[] = { ++ 0x81C, 0xBF000001, ++ 0x81C, 0xBF020001, ++ 0x81C, 0xBF040001, ++ 0x81C, 0xBF060001, ++ 0x81C, 0xBE080001, ++ 0x81C, 0xBD0A0001, ++ 0x81C, 0xBC0C0001, ++ 0x81C, 0xBA0E0001, ++ 0x81C, 0xB9100001, ++ 0x81C, 0xB8120001, ++ 0x81C, 0xB7140001, ++ 0x81C, 0xB6160001, ++ 0x81C, 0xB5180001, ++ 0x81C, 0xB41A0001, ++ 0x81C, 0xB41C0001, ++ 0x81C, 0xB31E0001, ++ 0x81C, 0xB2200001, ++ 0x81C, 0xB1220001, ++ 0x81C, 0xB0240001, ++ 0x81C, 0xAF260001, ++ 0x81C, 0xAE280001, ++ 0x81C, 0xAD2A0001, ++ 0x81C, 0xAC2C0001, ++ 0x81C, 0xAB2E0001, ++ 0x81C, 0xAA300001, ++ 0x81C, 0xA9320001, ++ 0x81C, 0xA8340001, ++ 0x81C, 0xA7360001, ++ 0x81C, 0xA6380001, ++ 0x81C, 0xA53A0001, ++ 0x81C, 0xA43C0001, ++ 0x81C, 0x673E0001, ++ 0x81C, 0x66400001, ++ 0x81C, 0x65420001, ++ 0x81C, 0x64440001, ++ 0x81C, 0x63460001, ++ 0x81C, 0x62480001, ++ 0x81C, 0x614A0001, ++ 0x81C, 0x474C0001, ++ 0x81C, 0x464E0001, ++ 0x81C, 0x45500001, ++ 0x81C, 0x44520001, ++ 0x81C, 0x43540001, ++ 0x81C, 0x42560001, ++ 0x81C, 0x41580001, ++ 0x81C, 0x285A0001, ++ 0x81C, 0x275C0001, ++ 0x81C, 0x265E0001, ++ 0x81C, 0x25600001, ++ 0x81C, 0x24620001, ++ 0x81C, 0x0A640001, ++ 0x81C, 0x09660001, ++ 0x81C, 0x08680001, ++ 0x81C, 0x076A0001, ++ 0x81C, 0x066C0001, ++ 0x81C, 0x056E0001, ++ 0x81C, 0x04700001, ++ 0x81C, 0x03720001, ++ 0x81C, 0x02740001, ++ 0x81C, 0x01760001, ++ 0x81C, 0x01780001, ++ 0x81C, 0x017A0001, ++ 0x81C, 0x017C0001, ++ 0x81C, 0x017E0001, ++ 0xFF0F02C0, 0xABCD, ++ 0x81C, 0xFD800001, ++ 0x81C, 0xFC820001, ++ 0x81C, 0xFB840001, ++ 0x81C, 0xFA860001, ++ 0x81C, 0xF9880001, ++ 0x81C, 0xF88A0001, ++ 0x81C, 0xF78C0001, ++ 0x81C, 0xF68E0001, ++ 0x81C, 0xF5900001, ++ 0x81C, 0xF4920001, ++ 0x81C, 0xF3940001, ++ 0x81C, 0xF2960001, ++ 0x81C, 0xF1980001, ++ 0x81C, 0xF09A0001, ++ 0x81C, 0xEF9C0001, ++ 0x81C, 0xEE9E0001, ++ 0x81C, 0xEDA00001, ++ 0x81C, 0xECA20001, ++ 0x81C, 0xEBA40001, ++ 0x81C, 0xEAA60001, ++ 0x81C, 0xE9A80001, ++ 0x81C, 0xE8AA0001, ++ 0x81C, 0xE7AC0001, ++ 0x81C, 0xE6AE0001, ++ 0x81C, 0xC6B00001, ++ 0x81C, 0xC5B20001, ++ 0x81C, 0xA5B40001, ++ 0x81C, 0xA4B60001, ++ 0x81C, 0xA3B80001, ++ 0x81C, 0xA2BA0001, ++ 0x81C, 0xA1BC0001, ++ 0x81C, 0x65BE0001, ++ 0x81C, 0x64C00001, ++ 0x81C, 0x63C20001, ++ 0x81C, 0x62C40001, ++ 0x81C, 0x61C60001, ++ 0x81C, 0x60C80001, ++ 0x81C, 0x60CA0001, ++ 0x81C, 0x60CC0001, ++ 0x81C, 0x60CE0001, ++ 0x81C, 0x60D00001, ++ 0x81C, 0x60D20001, ++ 0x81C, 0x60D40001, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x81C, 0xFF800001, ++ 0x81C, 0xFF820001, ++ 0x81C, 0xFF840001, ++ 0x81C, 0xFF860001, ++ 0x81C, 0xFF880001, ++ 0x81C, 0xFF8A0001, ++ 0x81C, 0xFE8C0001, ++ 0x81C, 0xFD8E0001, ++ 0x81C, 0xFC900001, ++ 0x81C, 0xFB920001, ++ 0x81C, 0xFA940001, ++ 0x81C, 0xF9960001, ++ 0x81C, 0xF8980001, ++ 0x81C, 0xF79A0001, ++ 0x81C, 0xF69C0001, ++ 0x81C, 0xF59E0001, ++ 0x81C, 0xF4A00001, ++ 0x81C, 0xF3A20001, ++ 0x81C, 0xF2A40001, ++ 0x81C, 0xF1A60001, ++ 0x81C, 0xF0A80001, ++ 0x81C, 0xEFAA0001, ++ 0x81C, 0xEEAC0001, ++ 0x81C, 0xEDAE0001, ++ 0x81C, 0xECB00001, ++ 0x81C, 0xEBB20001, ++ 0x81C, 0xEAB40001, ++ 0x81C, 0xE9B60001, ++ 0x81C, 0xE8B80001, ++ 0x81C, 0xE7BA0001, ++ 0x81C, 0xE6BC0001, ++ 0x81C, 0xC6BE0001, ++ 0x81C, 0xC5C00001, ++ 0x81C, 0xA5C20001, ++ 0x81C, 0xA4C40001, ++ 0x81C, 0xA3C60001, ++ 0x81C, 0xA2C80001, ++ 0x81C, 0xA1CA0001, ++ 0x81C, 0x65CC0001, ++ 0x81C, 0x64CE0001, ++ 0x81C, 0x63D00001, ++ 0x81C, 0x62D20001, ++ 0x81C, 0x61D40001, ++ 0xFF0F02C0, 0xDEAD, ++ 0x81C, 0x60D60001, ++ 0x81C, 0x60D80001, ++ 0x81C, 0x60DA0001, ++ 0x81C, 0x60DC0001, ++ 0x81C, 0x60DE0001, ++ 0x81C, 0x60E00001, ++ 0x81C, 0x60E20001, ++ 0x81C, 0x60E40001, ++ 0x81C, 0x60E60001, ++ 0x81C, 0x60E80001, ++ 0x81C, 0x60EA0001, ++ 0x81C, 0x60EC0001, ++ 0x81C, 0x60EE0001, ++ 0x81C, 0x60F00001, ++ 0x81C, 0x60F20001, ++ 0x81C, 0x60F40001, ++ 0x81C, 0x60F60001, ++ 0x81C, 0x60F80001, ++ 0x81C, 0x60FA0001, ++ 0x81C, 0x60FC0001, ++ 0x81C, 0x60FE0001, ++ ++}; ++ ++static void ODM_ReadAndConfig_TC_8821A_AGC_TAB(PDM_ODM_T pDM_Odm) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_TC_8821A_AGC_TAB)/sizeof(u4Byte); ++ const pu4Byte Array = Array_TC_8821A_AGC_TAB; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8821A_AGC_TAB, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_AGC_8821A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_AGC_8821A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* PHY_REG.TXT ++******************************************************************************/ ++ ++static const u32 Array_TC_8821A_PHY_REG[] = { ++ 0x800, 0x0020D410, ++ 0x804, 0x080112E0, ++ 0x808, 0x0E028211, ++ 0x80C, 0x12131111, ++ 0x810, 0x20101261, ++ 0x814, 0x020C3D10, ++ 0x818, 0x03A00385, ++ 0x820, 0x00000000, ++ 0x824, 0x00030FE0, ++ 0x828, 0x00000000, ++ 0x82C, 0x002083DD, ++ 0x830, 0x2AAA8E24, ++ 0x834, 0x0037A705, ++ 0x838, 0x06489B45, ++ 0x83C, 0x0000095B, ++ 0x840, 0xC0000001, ++ 0x844, 0x40003CDE, ++ 0x848, 0x62103F8B, ++ 0x84C, 0x6CFDFFB8, ++ 0x850, 0x28874706, ++ 0x854, 0x0001520C, ++ 0x858, 0x8060E000, ++ 0x85C, 0x74210168, ++ 0x860, 0x6929C321, ++ 0x864, 0x79727432, ++ 0x868, 0x8CA7A314, ++ 0x86C, 0x338C2878, ++ 0x870, 0x03333333, ++ 0x874, 0x31612C2E, ++ 0x878, 0x00000152, ++ 0x87C, 0x000FC000, ++ 0x8A0, 0x00000013, ++ 0x8A4, 0x7F7F7F7F, ++ 0x8A8, 0xA0000338, ++ 0x8AC, 0x0FF0FA0A, ++ 0x8B4, 0x000FC080, ++ 0x8B8, 0x7C005FFF, ++ 0x8BC, 0x8CA520A0, ++ 0x8C0, 0x01F00020, ++ 0x8C4, 0x00000000, ++ 0x8C8, 0x00013169, ++ 0x8CC, 0x08248492, ++ 0x8D4, 0x940008A0, ++ 0x8D8, 0x290B5612, ++ 0x8F8, 0x400002C0, ++ 0x8FC, 0x00000000, ++ 0x900, 0x00000700, ++ 0x90C, 0x00000000, ++ 0x910, 0x0000FC00, ++ 0x914, 0x00000404, ++ 0x918, 0x1C1028C0, ++ 0x91C, 0x64B11A1C, ++ 0x920, 0xE0767233, ++ 0x924, 0x055AA500, ++ 0x928, 0x00000004, ++ 0x92C, 0xFFFE0000, ++ 0x930, 0xFFFFFFFE, ++ 0x934, 0x001FFFFF, ++ 0x960, 0x00000000, ++ 0x964, 0x00000000, ++ 0x968, 0x00000000, ++ 0x96C, 0x00000000, ++ 0x970, 0x801FFFFF, ++ 0x974, 0x000003FF, ++ 0x978, 0x00000000, ++ 0x97C, 0x00000000, ++ 0x980, 0x00000000, ++ 0x984, 0x00000000, ++ 0x988, 0x00000000, ++ 0x9A4, 0x00000080, ++ 0x9A8, 0x00000000, ++ 0x9AC, 0x00000000, ++ 0x9B0, 0x01081008, ++ 0x9B4, 0x01081008, ++ 0x9B8, 0x01081008, ++ 0x9BC, 0x01081008, ++ 0x9D0, 0x00000000, ++ 0x9D4, 0x00000000, ++ 0x9D8, 0x00000000, ++ 0x9DC, 0x00000000, ++ 0x9E4, 0x00000002, ++ 0x9E8, 0x00000000, ++ 0xA00, 0x00D047C8, ++ 0xA04, 0x01FF000C, ++ 0xA08, 0x8C8A8300, ++ 0xA0C, 0x2E68000F, ++ 0xA10, 0x9500BB78, ++ 0xA14, 0x11144028, ++ 0xA18, 0x00881117, ++ 0xA1C, 0x89140F00, ++ 0xA20, 0x1A1B0000, ++ 0xA24, 0x090E1317, ++ 0xA28, 0x00000204, ++ 0xA2C, 0x00910000, ++ 0xA70, 0x101FFF00, ++ 0xA74, 0x00000008, ++ 0xA78, 0x00000900, ++ 0xA7C, 0x225B0606, ++ 0xA80, 0x21805490, ++ 0xA84, 0x001F0000, ++ 0xB00, 0x03100000, ++ 0xB04, 0x0000B000, ++ 0xB08, 0xAE0201EB, ++ 0xB0C, 0x01003207, ++ 0xB10, 0x00009807, ++ 0xB14, 0x01000000, ++ 0xB18, 0x00000002, ++ 0xB1C, 0x00000002, ++ 0xB20, 0x0000001F, ++ 0xB24, 0x03020100, ++ 0xB28, 0x07060504, ++ 0xB2C, 0x0B0A0908, ++ 0xB30, 0x0F0E0D0C, ++ 0xB34, 0x13121110, ++ 0xB38, 0x17161514, ++ 0xB3C, 0x0000003A, ++ 0xB40, 0x00000000, ++ 0xB44, 0x00000000, ++ 0xB48, 0x13000032, ++ 0xB4C, 0x48080000, ++ 0xB50, 0x00000000, ++ 0xB54, 0x00000000, ++ 0xB58, 0x00000000, ++ 0xB5C, 0x00000000, ++ 0xC00, 0x00000007, ++ 0xC04, 0x00042020, ++ 0xC08, 0x80410231, ++ 0xC0C, 0x00000000, ++ 0xC10, 0x00000100, ++ 0xC14, 0x01000000, ++ 0xC1C, 0x40000003, ++ 0xC20, 0x2C2C2C2C, ++ 0xC24, 0x30303030, ++ 0xC28, 0x30303030, ++ 0xC2C, 0x2C2C2C2C, ++ 0xC30, 0x2C2C2C2C, ++ 0xC34, 0x2C2C2C2C, ++ 0xC38, 0x2C2C2C2C, ++ 0xC3C, 0x2A2A2A2A, ++ 0xC40, 0x2A2A2A2A, ++ 0xC44, 0x2A2A2A2A, ++ 0xC48, 0x2A2A2A2A, ++ 0xC4C, 0x2A2A2A2A, ++ 0xC50, 0x00000020, ++ 0xC54, 0x001C1208, ++ 0xC58, 0x30000C1C, ++ 0xC5C, 0x00000058, ++ 0xC60, 0x34344443, ++ 0xC64, 0x07003333, ++ 0xC68, 0x19791979, ++ 0xC6C, 0x19791979, ++ 0xC70, 0x19791979, ++ 0xC74, 0x19791979, ++ 0xC78, 0x19791979, ++ 0xC7C, 0x19791979, ++ 0xC80, 0x19791979, ++ 0xC84, 0x19791979, ++ 0xC94, 0x00000000, ++ 0xC98, 0x00000000, ++ 0xC9C, 0x00000000, ++ 0xCA0, 0x00000029, ++ 0xCA4, 0x08040201, ++ 0xCA8, 0x80402010, ++ 0xCB0, 0x77775745, ++ 0xCB4, 0x10000077, ++ 0xCB8, 0x00508240, ++ ++}; ++ ++static void ++ODM_ReadAndConfig_TC_8821A_PHY_REG( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_TC_8821A_PHY_REG)/sizeof(u4Byte); ++ const pu4Byte Array = Array_TC_8821A_PHY_REG; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8821A_PHY_REG, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_PHY_8821A(pDM_Odm, v1, bMaskDWord, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigBB_PHY_8821A(pDM_Odm, v1, bMaskDWord, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} ++ ++/****************************************************************************** ++* PHY_REG_PG.TXT ++******************************************************************************/ ++ ++static const u32 Array_TC_8821A_PHY_REG_PG[] = { ++ 0xC20, 0x00000000, 0x34343434, ++ 0xC24, 0x00000000, 0x34343434, ++ 0xC28, 0x00000000, 0x30323234, ++ 0xC2C, 0x00000000, 0x34343434, ++ 0xC30, 0x00000000, 0x26283032, ++ 0xC34, 0x00000000, 0x34343434, ++ 0xC38, 0x00000000, 0x26283032, ++ 0xE20, 0x00000000, 0x34343434, ++ 0xE24, 0x00000000, 0x34343434, ++ 0xE28, 0x00000000, 0x30323234, ++ 0xE2C, 0x00000000, 0x34343434, ++ 0xE30, 0x00000000, 0x26283032, ++ 0xE34, 0x00000000, 0x34343434, ++ 0xE38, 0x00000000, 0x26283032, ++ 0xC24, 0x00000000, 0x32323434, ++ 0xC28, 0x00000000, 0x30303032, ++ 0xC2C, 0x00000000, 0x32323434, ++ 0xC30, 0x00000000, 0x30303032, ++ 0xC34, 0x00000000, 0x32323434, ++ 0xC38, 0x00000000, 0x30303032, ++ 0xC3C, 0x00000000, 0x32323434, ++ 0xC40, 0x00000000, 0x30303032, ++ 0xC44, 0x00000000, 0x34342828, ++ 0xC48, 0x00000000, 0x30323232, ++ 0xC4C, 0x00000000, 0x28283030, ++ 0xE24, 0x00000000, 0x32323434, ++ 0xE28, 0x00000000, 0x30303032, ++ 0xE2C, 0x00000000, 0x32323434, ++ 0xE30, 0x00000000, 0x28303032, ++ 0xE34, 0x00000000, 0x32323434, ++ 0xE38, 0x00000000, 0x30303032, ++ 0xE3C, 0x00000000, 0x32323434, ++ 0xE40, 0x00000000, 0x30303032, ++ 0xE44, 0x00000000, 0x34342828, ++ 0xE48, 0x00000000, 0x30323232, ++ 0xE4C, 0x00000000, 0x28283030, ++ ++}; ++ ++static void ++ODM_ReadAndConfig_TC_8821A_PHY_REG_PG( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_TC_8821A_PHY_REG_PG)/sizeof(u4Byte); ++ const pu4Byte Array = Array_TC_8821A_PHY_REG_PG; ++ ++ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ for (i = 0; i < ArrayLen; i += 3 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ u4Byte v3 = Array[i+2]; ++ ++ // this line is a line of pure_body ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigBB_PHY_REG_PG_8821A(pDM_Odm, v1, v2, v3); ++ continue; ++ } ++ else ++ { // this line is the start of branch ++ if ( !CheckCondition(Array[i], hex) ) ++ { // don't need the hw_body ++ i += 2; // skip the pair of expression ++ v1 = Array[i]; ++ v2 = Array[i+1]; ++ v3 = Array[i+2]; ++ while (v2 != 0xDEAD) ++ { ++ i += 3; ++ v1 = Array[i]; ++ v2 = Array[i+1]; ++ v3 = Array[i+1]; ++ } ++ } ++ } ++ } ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.h 2018-02-06 17:42:30.708967135 +0200 +@@ -0,0 +1,48 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#ifndef __INC_TC_BB_HW_IMG_8821A_H ++#define __INC_TC_BB_HW_IMG_8821A_H ++ ++static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); ++ ++/****************************************************************************** ++* AGC_TAB.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8821A_AGC_TAB( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* PHY_REG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8821A_PHY_REG( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* PHY_REG_PG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8821A_PHY_REG_PG( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.c 2018-02-06 17:42:30.708967135 +0200 +@@ -0,0 +1,219 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++//#include "Mp_Precomp.h" ++#include "odm_precomp.h" ++ ++static bool ++CheckCondition( ++ const u4Byte Condition, ++ const u4Byte Hex ++ ) ++{ ++ u4Byte _board = (Hex & 0x000000FF); ++ u4Byte _interface = (Hex & 0x0000FF00) >> 8; ++ u4Byte _platform = (Hex & 0x00FF0000) >> 16; ++ u4Byte cond = Condition; ++ ++ if ( Condition == 0xCDCDCDCD ) ++ return true; ++ ++ cond = Condition & 0x000000FF; ++ if ( (_board != cond) && (cond != 0xFF) ) ++ return false; ++ ++ cond = Condition & 0x0000FF00; ++ cond = cond >> 8; ++ if ( ((_interface & cond) == 0) && (cond != 0x07) ) ++ return false; ++ ++ cond = Condition & 0x00FF0000; ++ cond = cond >> 16; ++ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) ++ return false; ++ return true; ++} ++ ++ ++/****************************************************************************** ++* MAC_REG.TXT ++******************************************************************************/ ++ ++static const u4Byte Array_TC_8821A_MAC_REG[] = { ++ 0x428, 0x0000000A, ++ 0x429, 0x00000010, ++ 0x430, 0x00000000, ++ 0x431, 0x00000000, ++ 0x432, 0x00000000, ++ 0x433, 0x00000001, ++ 0x434, 0x00000004, ++ 0x435, 0x00000005, ++ 0x436, 0x00000007, ++ 0x437, 0x00000008, ++ 0x43C, 0x00000004, ++ 0x43D, 0x00000005, ++ 0x43E, 0x00000007, ++ 0x43F, 0x00000008, ++ 0x440, 0x0000005D, ++ 0x441, 0x00000001, ++ 0x442, 0x00000000, ++ 0x444, 0x00000010, ++ 0x445, 0x00000000, ++ 0x446, 0x00000000, ++ 0x447, 0x00000000, ++ 0x448, 0x00000000, ++ 0x449, 0x000000F0, ++ 0x44A, 0x0000000F, ++ 0x44B, 0x0000003E, ++ 0x44C, 0x00000010, ++ 0x44D, 0x00000000, ++ 0x44E, 0x00000000, ++ 0x44F, 0x00000000, ++ 0x450, 0x00000000, ++ 0x451, 0x000000F0, ++ 0x452, 0x0000000F, ++ 0x453, 0x00000000, ++ 0x460, 0x00000066, ++ 0x461, 0x00000066, ++ 0x4C8, 0x000000FF, ++ 0x4C9, 0x00000008, ++ 0x4CC, 0x000000FF, ++ 0x4CD, 0x000000FF, ++ 0x4CE, 0x00000001, ++ 0x500, 0x00000026, ++ 0x501, 0x000000A2, ++ 0x502, 0x0000002F, ++ 0x503, 0x00000000, ++ 0x504, 0x00000028, ++ 0x505, 0x000000A3, ++ 0x506, 0x0000005E, ++ 0x507, 0x00000000, ++ 0x508, 0x0000002B, ++ 0x509, 0x000000A4, ++ 0x50A, 0x0000005E, ++ 0x50B, 0x00000000, ++ 0x50C, 0x0000004F, ++ 0x50D, 0x000000A4, ++ 0x50E, 0x00000000, ++ 0x50F, 0x00000000, ++ 0x512, 0x0000001C, ++ 0x514, 0x0000000A, ++ 0x516, 0x0000000A, ++ 0x525, 0x0000004F, ++ 0x550, 0x00000010, ++ 0x551, 0x00000010, ++ 0x559, 0x00000002, ++ 0x55C, 0x00000050, ++ 0x55D, 0x000000FF, ++ 0x605, 0x00000030, ++ 0x608, 0x0000000E, ++ 0x609, 0x0000002A, ++ 0x620, 0x000000FF, ++ 0x621, 0x000000FF, ++ 0x622, 0x000000FF, ++ 0x623, 0x000000FF, ++ 0x624, 0x000000FF, ++ 0x625, 0x000000FF, ++ 0x626, 0x000000FF, ++ 0x627, 0x000000FF, ++ 0x638, 0x00000050, ++ 0x63C, 0x0000000A, ++ 0x63D, 0x0000000A, ++ 0x63E, 0x0000000E, ++ 0x63F, 0x0000000E, ++ 0x640, 0x00000040, ++ 0x642, 0x00000040, ++ 0x643, 0x00000000, ++ 0x66E, 0x00000005, ++ 0x700, 0x00000021, ++ 0x701, 0x00000043, ++ 0x702, 0x00000065, ++ 0x703, 0x00000087, ++ 0x708, 0x00000021, ++ 0x709, 0x00000043, ++ 0x70A, 0x00000065, ++ 0x70B, 0x00000087, ++ ++}; ++ ++static void ++ODM_ReadAndConfig_TC_8821A_MAC_REG( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_TC_8821A_MAC_REG)/sizeof(u4Byte); ++ const pu4Byte Array = Array_TC_8821A_MAC_REG; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8821A_MAC_REG, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigMAC_8821A(pDM_Odm, v1, (u1Byte)v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigMAC_8821A(pDM_Odm, v1, (u1Byte)v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.h 2018-02-06 17:42:30.708967135 +0200 +@@ -0,0 +1,30 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#ifndef __INC_TC_MAC_HW_IMG_8821A_H ++#define __INC_TC_MAC_HW_IMG_8821A_H ++ ++static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); ++ ++/****************************************************************************** ++* MAC_REG.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8821A_MAC_REG( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.c 2018-02-06 17:42:30.708967135 +0200 +@@ -0,0 +1,1195 @@ ++ /****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++ //#include "Mp_Precomp.h" ++ #include "odm_precomp.h" ++ ++ static bool ++ CheckCondition( ++ const u4Byte Condition, ++ const u4Byte Hex ++ ) ++ { ++ u4Byte _board = (Hex & 0x000000FF); ++ u4Byte _interface = (Hex & 0x0000FF00) >> 8; ++ u4Byte _platform = (Hex & 0x00FF0000) >> 16; ++ u4Byte cond = Condition; ++ ++ if ( Condition == 0xCDCDCDCD ) ++ return true; ++ ++ cond = Condition & 0x000000FF; ++ if ( (_board != cond) && (cond != 0xFF) ) ++ return false; ++ ++ cond = Condition & 0x0000FF00; ++ cond = cond >> 8; ++ if ( ((_interface & cond) == 0) && (cond != 0x07) ) ++ return false; ++ ++ cond = Condition & 0x00FF0000; ++ cond = cond >> 16; ++ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) ++ return false; ++ return true; ++ } ++ ++ ++ /****************************************************************************** ++ * RadioA.TXT ++ ******************************************************************************/ ++ ++static const u4Byte Array_TC_8821A_RadioA[] = { ++ 0x018, 0x0001712A, ++ 0x056, 0x00051CF2, ++ 0x066, 0x00040000, ++ 0x01C, 0x000739D2, ++ 0x01E, 0x000F8000, ++ 0x082, 0x00000830, ++ 0x083, 0x00021800, ++ 0x084, 0x00028000, ++ 0x085, 0x00048000, ++ 0x086, 0x00094838, ++ 0x087, 0x00044980, ++ 0x088, 0x00048000, ++ 0x089, 0x0000D480, ++ 0x08A, 0x00042240, ++ 0x08B, 0x000F0380, ++ 0x08C, 0x00090000, ++ 0x08D, 0x00022852, ++ 0x08E, 0x00065540, ++ 0x08F, 0x00088001, ++ 0x0EF, 0x00020000, ++ 0x03E, 0x00000380, ++ 0x03F, 0x00090018, ++ 0x03E, 0x00020380, ++ 0x03F, 0x000A0018, ++ 0x03E, 0x00040308, ++ 0x03F, 0x000A0018, ++ 0x03E, 0x00060018, ++ 0x03F, 0x000A0018, ++ 0x0EF, 0x00000000, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00001000, ++ 0x03A, 0x000000C4, ++ 0x03B, 0x0003A000, ++ 0x03A, 0x000001FC, ++ 0x03B, 0x00032000, ++ 0x03A, 0x000001B4, ++ 0x03B, 0x0002A000, ++ 0x03A, 0x000001C4, ++ 0x03B, 0x000221C8, ++ 0x03A, 0x00000188, ++ 0x03B, 0x0001A001, ++ 0x03A, 0x000000C4, ++ 0x03B, 0x0007A000, ++ 0x03A, 0x000001FC, ++ 0x03B, 0x00072000, ++ 0x03A, 0x000001B4, ++ 0x03B, 0x0006A000, ++ 0x03A, 0x000001C4, ++ 0x03B, 0x000621C8, ++ 0x03A, 0x00000188, ++ 0x03B, 0x0005A001, ++ 0x03A, 0x000000C4, ++ 0x03B, 0x000BA000, ++ 0x03A, 0x000001FC, ++ 0x03B, 0x000B2000, ++ 0x03A, 0x000001B4, ++ 0x03B, 0x000AA000, ++ 0x03A, 0x000001C4, ++ 0x03B, 0x000A21C8, ++ 0x03A, 0x00000188, ++ 0x03B, 0x0009A001, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x00001100, ++ 0xFF0F02C0, 0xABCD, ++ 0x034, 0x0004A8B1, ++ 0x034, 0x000498AE, ++ 0x034, 0x000484AE, ++ 0x034, 0x000474AB, ++ 0x034, 0x0004648E, ++ 0x034, 0x0004548B, ++ 0x034, 0x0004408D, ++ 0x034, 0x0004308A, ++ 0x034, 0x00042087, ++ 0x034, 0x00041084, ++ 0x034, 0x00040081, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0004ADF7, ++ 0x034, 0x00049DF3, ++ 0x034, 0x00048DEF, ++ 0x034, 0x00047DEC, ++ 0x034, 0x00046DE9, ++ 0x034, 0x00045CCB, ++ 0x034, 0x0004488D, ++ 0x034, 0x0004348D, ++ 0x034, 0x0004248A, ++ 0x034, 0x0004108D, ++ 0x034, 0x0004008A, ++ 0xFF0F02C0, 0xDEAD, ++ 0xFF0F02C0, 0xABCD, ++ 0x034, 0x0002A8F0, ++ 0x034, 0x000298AF, ++ 0x034, 0x000284AF, ++ 0x034, 0x000274AC, ++ 0x034, 0x0002648E, ++ 0x034, 0x0002548B, ++ 0x034, 0x0002408D, ++ 0x034, 0x0002308A, ++ 0x034, 0x00022087, ++ 0x034, 0x00021084, ++ 0x034, 0x00020081, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0002ADF7, ++ 0x034, 0x00029DF2, ++ 0x034, 0x00028DEE, ++ 0x034, 0x00027DEB, ++ 0x034, 0x00026CCD, ++ 0x034, 0x00025CCA, ++ 0x034, 0x0002488C, ++ 0x034, 0x0002384C, ++ 0x034, 0x00022849, ++ 0x034, 0x00021449, ++ 0x034, 0x0002004D, ++ 0xFF0F02C0, 0xDEAD, ++ 0xFF0F02C0, 0xABCD, ++ 0x034, 0x0000A9EF, ++ 0x034, 0x000098EF, ++ 0x034, 0x000088AE, ++ 0x034, 0x000074AE, ++ 0x034, 0x000064AB, ++ 0x034, 0x0000548E, ++ 0x034, 0x0000448B, ++ 0x034, 0x0000308D, ++ 0x034, 0x0000208A, ++ 0x034, 0x00001087, ++ 0x034, 0x00000084, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x034, 0x0000ADF7, ++ 0x034, 0x00009DF4, ++ 0x034, 0x00008DF1, ++ 0x034, 0x00007DEE, ++ 0x034, 0x00006DCD, ++ 0x034, 0x00005CCD, ++ 0x034, 0x00004CCA, ++ 0x034, 0x0000388C, ++ 0x034, 0x00002888, ++ 0x034, 0x00001488, ++ 0x034, 0x00000486, ++ 0xFF0F02C0, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000040, ++ 0x035, 0x00000145, ++ 0x035, 0x00008145, ++ 0x035, 0x00010145, ++ 0x035, 0x00020196, ++ 0x035, 0x00028196, ++ 0x035, 0x00030196, ++ 0x035, 0x000401C7, ++ 0x035, 0x000481C7, ++ 0x035, 0x000501C7, ++ 0x0EF, 0x00000000, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000010, ++ 0x036, 0x000056B3, ++ 0x036, 0x0000D6B3, ++ 0x036, 0x000156B3, ++ 0x036, 0x0001D6B3, ++ 0x036, 0x00026634, ++ 0x036, 0x0002E634, ++ 0x036, 0x00036634, ++ 0x036, 0x0003E634, ++ 0x036, 0x000467B4, ++ 0x036, 0x0004E7B4, ++ 0x036, 0x000567B4, ++ 0x036, 0x0005E7B4, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x00000008, ++ 0x03C, 0x0000022A, ++ 0x03C, 0x00000594, ++ 0xFF0F02C0, 0xABCD, ++ 0x03C, 0x00000820, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x03C, 0x00000900, ++ 0xFF0F02C0, 0xDEAD, ++ 0x0EF, 0x00000000, ++ 0x018, 0x0001712A, ++ 0x0EF, 0x00000002, ++ 0x008, 0x00002000, ++ 0x0EF, 0x00000000, ++ 0x0DF, 0x000000C0, ++ 0x01F, 0x00040064, ++ 0x058, 0x00081184, ++ 0x059, 0x0006016C, ++ 0x061, 0x000EAD53, ++ 0x062, 0x00093BC4, ++ 0x063, 0x000714E9, ++ 0x064, 0x0001C67C, ++ 0xFF0F02C0, 0xABCD, ++ 0x065, 0x00091011, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x065, 0x00091016, ++ 0xFF0F02C0, 0xDEAD, ++ 0x018, 0x00000006, ++ 0x0EF, 0x00002000, ++ 0x03B, 0x00039258, ++ 0x03B, 0x00031258, ++ 0x03B, 0x00029258, ++ 0x03B, 0x00027A58, ++ 0x03B, 0x0001FA58, ++ 0x03B, 0x00012590, ++ 0x03B, 0x00008248, ++ 0x03B, 0x00000A40, ++ 0x0EF, 0x00000000, ++ 0x0EF, 0x00000100, ++ 0x034, 0x0000ADF2, ++ 0x035, 0x00004800, ++ 0x034, 0x00009DEF, ++ 0x035, 0x00003C00, ++ 0x034, 0x00008DEC, ++ 0x035, 0x00003000, ++ 0x034, 0x00007DE9, ++ 0x035, 0x00002400, ++ 0x034, 0x00006CEC, ++ 0x035, 0x00003000, ++ 0x034, 0x00005CE9, ++ 0x035, 0x00002400, ++ 0x034, 0x000044EC, ++ 0x035, 0x00003000, ++ 0x034, 0x000034E9, ++ 0x035, 0x00002400, ++ 0x034, 0x0000246C, ++ 0x035, 0x00003000, ++ 0x034, 0x00001469, ++ 0x035, 0x00002400, ++ 0x034, 0x0000006C, ++ 0x035, 0x00003000, ++ 0x0EF, 0x00000000, ++ 0x0ED, 0x00000010, ++ 0x044, 0x0000ADF2, ++ 0x044, 0x00009DEF, ++ 0x044, 0x00008DEC, ++ 0x044, 0x00007DE9, ++ 0x044, 0x00006CEC, ++ 0x044, 0x00005CE9, ++ 0x044, 0x000044EC, ++ 0x044, 0x000034E9, ++ 0x044, 0x0000246C, ++ 0x044, 0x00001469, ++ 0x044, 0x0000006C, ++ 0x0ED, 0x00000000, ++ 0x0ED, 0x00000001, ++ 0x040, 0x00038DA7, ++ 0x040, 0x000300C2, ++ 0x040, 0x000288E2, ++ 0x040, 0x000200B8, ++ 0x040, 0x000188A5, ++ 0x040, 0x00010FBC, ++ 0x040, 0x00008F71, ++ 0x040, 0x00000240, ++ 0x0ED, 0x00000000, ++ 0x0EF, 0x000020A2, ++ 0x0DF, 0x00000080, ++ 0x035, 0x00000120, ++ 0x035, 0x00008120, ++ 0x035, 0x00010120, ++ 0x036, 0x00000085, ++ 0x036, 0x00008085, ++ 0x036, 0x00010085, ++ 0x036, 0x00018085, ++ 0x0EF, 0x00000000, ++ 0x051, 0x00000C31, ++ 0x052, 0x00000622, ++ 0x053, 0x000FC70B, ++ 0x054, 0x0000017E, ++ 0x056, 0x00051DF3, ++ 0x051, 0x00000C01, ++ 0x052, 0x000006D6, ++ 0x053, 0x000FC649, ++ 0xFF0F0104, 0xABCD, ++ 0x0DD, 0x00000060, ++ 0xCDCDCDCD, 0xCDCD, ++ 0x0DD, 0x00000040, ++ 0xFF0F0104, 0xDEAD, ++ 0x070, 0x00049661, ++ 0x071, 0x0007843E, ++ 0x072, 0x00000382, ++ 0x074, 0x00051400, ++ 0x035, 0x00000160, ++ 0x035, 0x00008160, ++ 0x035, 0x00010160, ++ 0x036, 0x00000124, ++ 0x036, 0x00008124, ++ 0x036, 0x00010124, ++ 0x036, 0x00018124, ++ 0x0ED, 0x0000000C, ++ 0x045, 0x00000140, ++ 0x045, 0x00008140, ++ 0x045, 0x00010140, ++ 0x046, 0x00000124, ++ 0x046, 0x00008124, ++ 0x046, 0x00010124, ++ 0x046, 0x00018124, ++ 0x0DF, 0x00000088, ++ 0x0B3, 0x000F0618, ++ 0x0B4, 0x00013E4C, ++ 0x0B7, 0x00030008, ++ 0x018, 0x0001F12A, ++ 0x0FE, 0x00000000, ++ 0x0FE, 0x00000000, ++ 0x0FE, 0x00000000, ++ 0x0FE, 0x00000000, ++ 0x0B3, 0x000F0E18, ++ 0x0B4, 0x0001364C, ++ ++ }; ++ ++static void ++ ODM_ReadAndConfig_TC_8821A_RadioA( ++ PDM_ODM_T pDM_Odm ++ ) ++ { ++ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++ ++ u4Byte hex = 0; ++ u4Byte i = 0; ++ u2Byte count = 0; ++ pu4Byte ptr_array = NULL; ++ u1Byte platform = pDM_Odm->SupportPlatform; ++ u1Byte _interface = pDM_Odm->SupportInterface; ++ u1Byte board = pDM_Odm->BoardType; ++ u4Byte ArrayLen = sizeof(Array_TC_8821A_RadioA)/sizeof(u4Byte); ++ const pu4Byte Array = Array_TC_8821A_RadioA; ++ ++ ++ hex += board; ++ hex += _interface << 8; ++ hex += platform << 16; ++ hex += 0xFF000000; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8821A_RadioA, hex = 0x%X\n", hex)); ++ ++ for (i = 0; i < ArrayLen; i += 2 ) ++ { ++ u4Byte v1 = Array[i]; ++ u4Byte v2 = Array[i+1]; ++ ++ // This (offset, data) pair meets the condition. ++ if ( v1 < 0xCDCDCDCD ) ++ { ++ odm_ConfigRF_RadioA_8821A(pDM_Odm, v1, v2); ++ continue; ++ } ++ else ++ { // This line is the start line of branch. ++ if ( !CheckCondition(Array[i], hex) ) ++ { // Discard the following (offset, data) pairs. ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ i -= 2; // prevent from for-loop += 2 ++ } ++ else // Configure matched pairs and skip to end of if-else. ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ while (v2 != 0xDEAD && ++ v2 != 0xCDEF && ++ v2 != 0xCDCD && i < ArrayLen -2) ++ { ++ odm_ConfigRF_RadioA_8821A(pDM_Odm, v1, v2); ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ while (v2 != 0xDEAD && i < ArrayLen -2) ++ { ++ READ_NEXT_PAIR(v1, v2, i); ++ } ++ ++ } ++ } ++ } ++ ++ } ++ ++ /****************************************************************************** ++ * TxPowerTrack_AP.TXT ++ ******************************************************************************/ ++ ++static const u1Byte gDeltaSwingTableIdx_TC_5GB_N__8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++ }; ++static const u1Byte gDeltaSwingTableIdx_TC_5GB_P__8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 17, 17, 18, 19, 20, 20, 20}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++ }; ++static const u1Byte gDeltaSwingTableIdx_TC_5GA_N__8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 2, 3, 3, 4, 4, 5, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 13, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16}, ++ }; ++static const u1Byte gDeltaSwingTableIdx_TC_5GA_P__8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 7, 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 18, 19, 19, 19}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, ++ }; ++static const u1Byte gDeltaSwingTableIdx_TC_2GB_N__8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GB_P__8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GA_N__8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GA_P__8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GCCKB_N__8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GCCKB_P__8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GCCKA_N__8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GCCKA_P__8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++ ++static void ++ ODM_ReadAndConfig_TC_8821A_TxPowerTrack_AP( ++ PDM_ODM_T pDM_Odm ++ ) ++ { ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_TC_8821A\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_TC_2GA_P__8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_TC_2GA_N__8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_TC_2GB_P__8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_TC_2GB_N__8821A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_TC_2GCCKA_P__8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_TC_2GCCKA_N__8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_TC_2GCCKB_P__8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_TC_2GCCKB_N__8821A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_TC_5GA_P__8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_TC_5GA_N__8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_TC_5GB_P__8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_TC_5GB_N__8821A, DELTA_SWINGIDX_SIZE*3); ++ } ++ ++ /****************************************************************************** ++ * TxPowerTrack_PCIE.TXT ++ ******************************************************************************/ ++ ++static const u1Byte gDeltaSwingTableIdx_TC_5GB_N_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ }; ++static const u1Byte gDeltaSwingTableIdx_TC_5GB_P_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ }; ++static const u1Byte gDeltaSwingTableIdx_TC_5GA_N_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 13, 13, 13}, ++ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 11, 12, 12, 12, 12, 12, 13, 13}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 8, 8, 9, 10, 11, 12, 13, 14, 14, 15, 15, 15, 16, 16, 16, 17, 17, 18, 18}, ++ }; ++static const u1Byte gDeltaSwingTableIdx_TC_5GA_P_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ }; ++static const u1Byte gDeltaSwingTableIdx_TC_2GB_N_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GB_P_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GA_N_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GA_P_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GCCKB_N_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GCCKB_P_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GCCKA_N_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GCCKA_P_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; ++ ++static void ODM_ReadAndConfig_TC_8821A_TxPowerTrack_PCIE(PDM_ODM_T pDM_Odm) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_TC_8821A\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_TC_2GA_P_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_TC_2GA_N_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_TC_2GB_P_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_TC_2GB_N_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_TC_2GCCKA_P_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_TC_2GCCKA_N_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_TC_2GCCKB_P_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_TC_2GCCKB_N_PCIE_8821A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_TC_5GA_P_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_TC_5GA_N_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_TC_5GB_P_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_TC_5GB_N_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); ++ } ++ ++ /****************************************************************************** ++ * TxPowerTrack_USB.TXT ++ ******************************************************************************/ ++ ++static const u1Byte gDeltaSwingTableIdx_TC_5GB_N_USB_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ }; ++static const u1Byte gDeltaSwingTableIdx_TC_5GB_P_USB_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ }; ++static const u1Byte gDeltaSwingTableIdx_TC_5GA_N_USB_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, ++ }; ++static const u1Byte gDeltaSwingTableIdx_TC_5GA_P_USB_8821A[][DELTA_SWINGIDX_SIZE] = { ++ {0, 1, 1, 2, 2, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 12, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, ++ }; ++static const u1Byte gDeltaSwingTableIdx_TC_2GB_N_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GB_P_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GA_N_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GA_P_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GCCKB_N_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GCCKB_P_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GCCKA_N_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; ++static const u1Byte gDeltaSwingTableIdx_TC_2GCCKA_P_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; ++ ++static void ODM_ReadAndConfig_TC_8821A_TxPowerTrack_USB(PDM_ODM_T pDM_Odm) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_TC_8821A\n")); ++ ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_TC_2GA_P_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_TC_2GA_N_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_TC_2GB_P_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_TC_2GB_N_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_TC_2GCCKA_P_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_TC_2GCCKA_N_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_TC_2GCCKB_P_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_TC_2GCCKB_N_USB_8821A, DELTA_SWINGIDX_SIZE); ++ ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_TC_5GA_P_USB_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_TC_5GA_N_USB_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_TC_5GB_P_USB_8821A, DELTA_SWINGIDX_SIZE*3); ++ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_TC_5GB_N_USB_8821A, DELTA_SWINGIDX_SIZE*3); ++} ++ ++ /****************************************************************************** ++ * TXPWR_LMT.TXT ++ ******************************************************************************/ ++ ++static pu1Byte Array_TC_8821A_TXPWR_LMT[] = { ++ "FCC", "2.4G", "20M", "CCK", "1T", "01", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "02", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "03", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "04", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "05", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "06", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "07", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "08", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "09", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "10", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "11", "34", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "12", "63", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "13", "63", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "32", ++ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", ++ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "32", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "34", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "32", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "63", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "63", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", ++ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", ++ "FCC", "2.4G", "20M", "HT", "1T", "01", "32", ++ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "02", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "03", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "04", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "05", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "06", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "07", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "08", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "09", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "10", "34", ++ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "11", "32", ++ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "12", "63", ++ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "13", "63", ++ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", ++ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", ++ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", ++ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", ++ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", ++ "FCC", "2.4G", "20M", "HT", "2T", "01", "30", ++ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "02", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "03", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "04", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "05", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "06", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "07", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "08", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "09", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "10", "32", ++ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", ++ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", ++ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", ++ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", ++ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", ++ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", ++ "FCC", "2.4G", "40M", "HT", "1T", "03", "32", ++ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "04", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "05", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "06", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "07", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "08", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "09", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "10", "34", ++ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "11", "32", ++ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "12", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "12", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "13", "32", ++ "MKK", "2.4G", "40M", "HT", "1T", "13", "32", ++ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", ++ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", ++ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", ++ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", ++ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "04", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "05", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "06", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "07", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "08", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "09", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "10", "32", ++ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", ++ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", ++ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", ++ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", ++ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", ++ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", ++ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", ++ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", ++ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", ++ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "36", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "36", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "40", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "40", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "44", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "48", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "52", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "56", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "60", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "64", "28", ++ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "100", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "100", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "114", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "114", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "114", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "108", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "108", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "112", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "112", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "116", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "116", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "120", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "120", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "124", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "124", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "128", "32", ++ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "128", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "132", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "132", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "136", "30", ++ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "136", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "140", "28", ++ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "140", "32", ++ "FCC", "5G", "20M", "OFDM", "1T", "149", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "153", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "157", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "161", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", ++ "FCC", "5G", "20M", "OFDM", "1T", "165", "34", ++ "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", ++ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", ++ "FCC", "5G", "20M", "HT", "1T", "36", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "36", "32", ++ "MKK", "5G", "20M", "HT", "1T", "36", "32", ++ "FCC", "5G", "20M", "HT", "1T", "40", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "40", "32", ++ "MKK", "5G", "20M", "HT", "1T", "40", "32", ++ "FCC", "5G", "20M", "HT", "1T", "44", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "44", "32", ++ "MKK", "5G", "20M", "HT", "1T", "44", "32", ++ "FCC", "5G", "20M", "HT", "1T", "48", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "48", "32", ++ "MKK", "5G", "20M", "HT", "1T", "48", "32", ++ "FCC", "5G", "20M", "HT", "1T", "52", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "52", "32", ++ "MKK", "5G", "20M", "HT", "1T", "52", "32", ++ "FCC", "5G", "20M", "HT", "1T", "56", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "56", "32", ++ "MKK", "5G", "20M", "HT", "1T", "56", "32", ++ "FCC", "5G", "20M", "HT", "1T", "60", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "60", "32", ++ "MKK", "5G", "20M", "HT", "1T", "60", "32", ++ "FCC", "5G", "20M", "HT", "1T", "64", "28", ++ "ETSI", "5G", "20M", "HT", "1T", "64", "32", ++ "MKK", "5G", "20M", "HT", "1T", "64", "32", ++ "FCC", "5G", "20M", "HT", "1T", "100", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "100", "32", ++ "MKK", "5G", "20M", "HT", "1T", "100", "32", ++ "FCC", "5G", "20M", "HT", "1T", "114", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "114", "32", ++ "MKK", "5G", "20M", "HT", "1T", "114", "32", ++ "FCC", "5G", "20M", "HT", "1T", "108", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "108", "32", ++ "MKK", "5G", "20M", "HT", "1T", "108", "32", ++ "FCC", "5G", "20M", "HT", "1T", "112", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "112", "32", ++ "MKK", "5G", "20M", "HT", "1T", "112", "32", ++ "FCC", "5G", "20M", "HT", "1T", "116", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "116", "32", ++ "MKK", "5G", "20M", "HT", "1T", "116", "32", ++ "FCC", "5G", "20M", "HT", "1T", "120", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "120", "32", ++ "MKK", "5G", "20M", "HT", "1T", "120", "32", ++ "FCC", "5G", "20M", "HT", "1T", "124", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "124", "32", ++ "MKK", "5G", "20M", "HT", "1T", "124", "32", ++ "FCC", "5G", "20M", "HT", "1T", "128", "32", ++ "ETSI", "5G", "20M", "HT", "1T", "128", "32", ++ "MKK", "5G", "20M", "HT", "1T", "128", "32", ++ "FCC", "5G", "20M", "HT", "1T", "132", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "132", "32", ++ "MKK", "5G", "20M", "HT", "1T", "132", "32", ++ "FCC", "5G", "20M", "HT", "1T", "136", "30", ++ "ETSI", "5G", "20M", "HT", "1T", "136", "32", ++ "MKK", "5G", "20M", "HT", "1T", "136", "32", ++ "FCC", "5G", "20M", "HT", "1T", "140", "28", ++ "ETSI", "5G", "20M", "HT", "1T", "140", "32", ++ "MKK", "5G", "20M", "HT", "1T", "140", "32", ++ "FCC", "5G", "20M", "HT", "1T", "149", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "149", "32", ++ "MKK", "5G", "20M", "HT", "1T", "149", "63", ++ "FCC", "5G", "20M", "HT", "1T", "153", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "153", "32", ++ "MKK", "5G", "20M", "HT", "1T", "153", "63", ++ "FCC", "5G", "20M", "HT", "1T", "157", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "157", "32", ++ "MKK", "5G", "20M", "HT", "1T", "157", "63", ++ "FCC", "5G", "20M", "HT", "1T", "161", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "161", "32", ++ "MKK", "5G", "20M", "HT", "1T", "161", "63", ++ "FCC", "5G", "20M", "HT", "1T", "165", "34", ++ "ETSI", "5G", "20M", "HT", "1T", "165", "32", ++ "MKK", "5G", "20M", "HT", "1T", "165", "63", ++ "FCC", "5G", "20M", "HT", "2T", "36", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "36", "30", ++ "MKK", "5G", "20M", "HT", "2T", "36", "30", ++ "FCC", "5G", "20M", "HT", "2T", "40", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "40", "30", ++ "MKK", "5G", "20M", "HT", "2T", "40", "30", ++ "FCC", "5G", "20M", "HT", "2T", "44", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "44", "30", ++ "MKK", "5G", "20M", "HT", "2T", "44", "30", ++ "FCC", "5G", "20M", "HT", "2T", "48", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "48", "30", ++ "MKK", "5G", "20M", "HT", "2T", "48", "30", ++ "FCC", "5G", "20M", "HT", "2T", "52", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "52", "30", ++ "MKK", "5G", "20M", "HT", "2T", "52", "30", ++ "FCC", "5G", "20M", "HT", "2T", "56", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "56", "30", ++ "MKK", "5G", "20M", "HT", "2T", "56", "30", ++ "FCC", "5G", "20M", "HT", "2T", "60", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "60", "30", ++ "MKK", "5G", "20M", "HT", "2T", "60", "30", ++ "FCC", "5G", "20M", "HT", "2T", "64", "26", ++ "ETSI", "5G", "20M", "HT", "2T", "64", "30", ++ "MKK", "5G", "20M", "HT", "2T", "64", "30", ++ "FCC", "5G", "20M", "HT", "2T", "100", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "100", "30", ++ "MKK", "5G", "20M", "HT", "2T", "100", "30", ++ "FCC", "5G", "20M", "HT", "2T", "114", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "114", "30", ++ "MKK", "5G", "20M", "HT", "2T", "114", "30", ++ "FCC", "5G", "20M", "HT", "2T", "108", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "108", "30", ++ "MKK", "5G", "20M", "HT", "2T", "108", "30", ++ "FCC", "5G", "20M", "HT", "2T", "112", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "112", "30", ++ "MKK", "5G", "20M", "HT", "2T", "112", "30", ++ "FCC", "5G", "20M", "HT", "2T", "116", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "116", "30", ++ "MKK", "5G", "20M", "HT", "2T", "116", "30", ++ "FCC", "5G", "20M", "HT", "2T", "120", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "120", "30", ++ "MKK", "5G", "20M", "HT", "2T", "120", "30", ++ "FCC", "5G", "20M", "HT", "2T", "124", "32", ++ "ETSI", "5G", "20M", "HT", "2T", "124", "30", ++ "MKK", "5G", "20M", "HT", "2T", "124", "30", ++ "FCC", "5G", "20M", "HT", "2T", "128", "30", ++ "ETSI", "5G", "20M", "HT", "2T", "128", "30", ++ "MKK", "5G", "20M", "HT", "2T", "128", "30", ++ "FCC", "5G", "20M", "HT", "2T", "132", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "132", "30", ++ "MKK", "5G", "20M", "HT", "2T", "132", "30", ++ "FCC", "5G", "20M", "HT", "2T", "136", "28", ++ "ETSI", "5G", "20M", "HT", "2T", "136", "30", ++ "MKK", "5G", "20M", "HT", "2T", "136", "30", ++ "FCC", "5G", "20M", "HT", "2T", "140", "26", ++ "ETSI", "5G", "20M", "HT", "2T", "140", "30", ++ "MKK", "5G", "20M", "HT", "2T", "140", "30", ++ "FCC", "5G", "20M", "HT", "2T", "149", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "149", "30", ++ "MKK", "5G", "20M", "HT", "2T", "149", "63", ++ "FCC", "5G", "20M", "HT", "2T", "153", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "153", "30", ++ "MKK", "5G", "20M", "HT", "2T", "153", "63", ++ "FCC", "5G", "20M", "HT", "2T", "157", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "157", "30", ++ "MKK", "5G", "20M", "HT", "2T", "157", "63", ++ "FCC", "5G", "20M", "HT", "2T", "161", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "161", "30", ++ "MKK", "5G", "20M", "HT", "2T", "161", "63", ++ "FCC", "5G", "20M", "HT", "2T", "165", "34", ++ "ETSI", "5G", "20M", "HT", "2T", "165", "30", ++ "MKK", "5G", "20M", "HT", "2T", "165", "63", ++ "FCC", "5G", "40M", "HT", "1T", "38", "30", ++ "ETSI", "5G", "40M", "HT", "1T", "38", "32", ++ "MKK", "5G", "40M", "HT", "1T", "38", "32", ++ "FCC", "5G", "40M", "HT", "1T", "46", "30", ++ "ETSI", "5G", "40M", "HT", "1T", "46", "32", ++ "MKK", "5G", "40M", "HT", "1T", "46", "32", ++ "FCC", "5G", "40M", "HT", "1T", "54", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "54", "32", ++ "MKK", "5G", "40M", "HT", "1T", "54", "32", ++ "FCC", "5G", "40M", "HT", "1T", "62", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "62", "32", ++ "MKK", "5G", "40M", "HT", "1T", "62", "32", ++ "FCC", "5G", "40M", "HT", "1T", "102", "28", ++ "ETSI", "5G", "40M", "HT", "1T", "102", "32", ++ "MKK", "5G", "40M", "HT", "1T", "102", "32", ++ "FCC", "5G", "40M", "HT", "1T", "110", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "110", "32", ++ "MKK", "5G", "40M", "HT", "1T", "110", "32", ++ "FCC", "5G", "40M", "HT", "1T", "118", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "118", "32", ++ "MKK", "5G", "40M", "HT", "1T", "118", "32", ++ "FCC", "5G", "40M", "HT", "1T", "126", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "126", "32", ++ "MKK", "5G", "40M", "HT", "1T", "126", "32", ++ "FCC", "5G", "40M", "HT", "1T", "134", "32", ++ "ETSI", "5G", "40M", "HT", "1T", "134", "32", ++ "MKK", "5G", "40M", "HT", "1T", "134", "32", ++ "FCC", "5G", "40M", "HT", "1T", "151", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "151", "32", ++ "MKK", "5G", "40M", "HT", "1T", "151", "63", ++ "FCC", "5G", "40M", "HT", "1T", "159", "34", ++ "ETSI", "5G", "40M", "HT", "1T", "159", "32", ++ "MKK", "5G", "40M", "HT", "1T", "159", "63", ++ "FCC", "5G", "40M", "HT", "2T", "38", "28", ++ "ETSI", "5G", "40M", "HT", "2T", "38", "30", ++ "MKK", "5G", "40M", "HT", "2T", "38", "30", ++ "FCC", "5G", "40M", "HT", "2T", "46", "28", ++ "ETSI", "5G", "40M", "HT", "2T", "46", "30", ++ "MKK", "5G", "40M", "HT", "2T", "46", "30", ++ "FCC", "5G", "40M", "HT", "2T", "54", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "54", "30", ++ "MKK", "5G", "40M", "HT", "2T", "54", "30", ++ "FCC", "5G", "40M", "HT", "2T", "62", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "62", "30", ++ "MKK", "5G", "40M", "HT", "2T", "62", "30", ++ "FCC", "5G", "40M", "HT", "2T", "102", "26", ++ "ETSI", "5G", "40M", "HT", "2T", "102", "30", ++ "MKK", "5G", "40M", "HT", "2T", "102", "30", ++ "FCC", "5G", "40M", "HT", "2T", "110", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "110", "30", ++ "MKK", "5G", "40M", "HT", "2T", "110", "30", ++ "FCC", "5G", "40M", "HT", "2T", "118", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "118", "30", ++ "MKK", "5G", "40M", "HT", "2T", "118", "30", ++ "FCC", "5G", "40M", "HT", "2T", "126", "32", ++ "ETSI", "5G", "40M", "HT", "2T", "126", "30", ++ "MKK", "5G", "40M", "HT", "2T", "126", "30", ++ "FCC", "5G", "40M", "HT", "2T", "134", "30", ++ "ETSI", "5G", "40M", "HT", "2T", "134", "30", ++ "MKK", "5G", "40M", "HT", "2T", "134", "30", ++ "FCC", "5G", "40M", "HT", "2T", "151", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "151", "30", ++ "MKK", "5G", "40M", "HT", "2T", "151", "63", ++ "FCC", "5G", "40M", "HT", "2T", "159", "34", ++ "ETSI", "5G", "40M", "HT", "2T", "159", "30", ++ "MKK", "5G", "40M", "HT", "2T", "159", "63", ++ "FCC", "5G", "80M", "VHT", "1T", "42", "30", ++ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "42", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "58", "28", ++ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "58", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "106", "30", ++ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "106", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "122", "34", ++ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "122", "32", ++ "FCC", "5G", "80M", "VHT", "1T", "155", "34", ++ "ETSI", "5G", "80M", "VHT", "1T", "155", "32", ++ "MKK", "5G", "80M", "VHT", "1T", "155", "63", ++ "FCC", "5G", "80M", "VHT", "2T", "42", "28", ++ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "42", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "58", "26", ++ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "58", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "106", "28", ++ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "106", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "122", "32", ++ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "122", "30", ++ "FCC", "5G", "80M", "VHT", "2T", "155", "34", ++ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", ++ "MKK", "5G", "80M", "VHT", "2T", "155", "63" ++ }; ++ ++static void ODM_ReadAndConfig_TC_8821A_TXPWR_LMT(PDM_ODM_T pDM_Odm) ++{ ++ u4Byte i = 0; ++ u4Byte ArrayLen = sizeof(Array_TC_8821A_TXPWR_LMT)/sizeof(pu1Byte); ++ pu1Byte *Array = Array_TC_8821A_TXPWR_LMT; ++ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8821A_TXPWR_LMT\n")); ++ ++ for (i = 0; i < ArrayLen; i += 7 ) ++ { ++ pu1Byte regulation = Array[i]; ++ pu1Byte band = Array[i+1]; ++ pu1Byte bandwidth = Array[i+2]; ++ pu1Byte rate = Array[i+3]; ++ pu1Byte rfPath = Array[i+4]; ++ pu1Byte chnl = Array[i+5]; ++ pu1Byte val = Array[i+6]; ++ ++ odm_ConfigBB_TXPWR_LMT_8821A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); ++ } ++ ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.h 2018-02-06 17:42:30.708967135 +0200 +@@ -0,0 +1,66 @@ ++/****************************************************************************** ++* ++* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++* ++* This program is free software; you can redistribute it and/or modify it ++* under the terms of version 2 of the GNU General Public License as ++* published by the Free Software Foundation. ++* ++* This program is distributed in the hope that it will be useful, but WITHOUT ++* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++* more details. ++* ++******************************************************************************/ ++ ++#ifndef __INC_TC_RF_HW_IMG_8821A_H ++#define __INC_TC_RF_HW_IMG_8821A_H ++ ++static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); ++ ++/****************************************************************************** ++* RadioA.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8821A_RadioA( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TxPowerTrack_AP.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8821A_TxPowerTrack_AP( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TxPowerTrack_PCIE.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8821A_TxPowerTrack_PCIE( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TxPowerTrack_USB.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8821A_TxPowerTrack_USB( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++/****************************************************************************** ++* TXPWR_LMT.TXT ++******************************************************************************/ ++ ++void ++ODM_ReadAndConfig_TC_8821A_TXPWR_LMT( // TC: Test Chip, MP: MP Chip ++ IN PDM_ODM_T pDM_Odm ++); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/hal_intf.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_intf.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/hal_intf.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_intf.c 2018-02-06 17:42:30.709967150 +0200 +@@ -0,0 +1,530 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++#define _HAL_INTF_C_ ++ ++#include ++ ++ ++void rtw_hal_chip_configure(_adapter *padapter) ++{ ++ if(padapter->HalFunc.intf_chip_configure) ++ padapter->HalFunc.intf_chip_configure(padapter); ++} ++ ++void rtw_hal_read_chip_info(_adapter *padapter) ++{ ++ if(padapter->HalFunc.read_adapter_info) ++ padapter->HalFunc.read_adapter_info(padapter); ++} ++ ++void rtw_hal_read_chip_version(_adapter *padapter) ++{ ++ if(padapter->HalFunc.read_chip_version) ++ padapter->HalFunc.read_chip_version(padapter); ++} ++ ++void rtw_hal_def_value_init(_adapter *padapter) ++{ ++ if(padapter->HalFunc.init_default_value) ++ padapter->HalFunc.init_default_value(padapter); ++} ++void rtw_hal_free_data(_adapter *padapter) ++{ ++ if(padapter->HalFunc.free_hal_data) ++ padapter->HalFunc.free_hal_data(padapter); ++} ++void rtw_hal_dm_init(_adapter *padapter) ++{ ++ if(padapter->HalFunc.dm_init) ++ padapter->HalFunc.dm_init(padapter); ++} ++void rtw_hal_dm_deinit(_adapter *padapter) ++{ ++ // cancel dm timer ++ if(padapter->HalFunc.dm_deinit) ++ padapter->HalFunc.dm_deinit(padapter); ++} ++void rtw_hal_sw_led_init(_adapter *padapter) ++{ ++ if(padapter->HalFunc.InitSwLeds) ++ padapter->HalFunc.InitSwLeds(padapter); ++} ++ ++void rtw_hal_sw_led_deinit(_adapter *padapter) ++{ ++ if(padapter->HalFunc.DeInitSwLeds) ++ padapter->HalFunc.DeInitSwLeds(padapter); ++} ++ ++u32 rtw_hal_power_on(_adapter *padapter) ++{ ++ if(padapter->HalFunc.hal_power_on) ++ return padapter->HalFunc.hal_power_on(padapter); ++ return _FAIL; ++} ++ ++ ++uint rtw_hal_init(_adapter *padapter) ++{ ++ uint status = _SUCCESS; ++ ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ if(padapter->hw_init_completed == true) ++ { ++ DBG_871X("rtw_hal_init: hw_init_completed == true\n"); ++ return status; ++ } ++ ++ // before init mac0, driver must init mac1 first to avoid usb rx error. ++ if((padapter->pbuddy_adapter != NULL) && (padapter->DualMacConcurrent == true) ++ && (padapter->adapter_type == PRIMARY_ADAPTER)) ++ { ++ if(padapter->pbuddy_adapter->hw_init_completed == true) ++ { ++ DBG_871X("rtw_hal_init: pbuddy_adapter hw_init_completed == true\n"); ++ } ++ else ++ { ++ status = padapter->HalFunc.hal_init(padapter->pbuddy_adapter); ++ if(status == _SUCCESS){ ++ padapter->pbuddy_adapter->hw_init_completed = true; ++ } ++ else{ ++ padapter->pbuddy_adapter->hw_init_completed = false; ++ RT_TRACE(_module_hal_init_c_,_drv_err_,("rtw_hal_init: hal__init fail(pbuddy_adapter)\n")); ++ DBG_871X("rtw_hal_init: hal__init fail(pbuddy_adapter)\n"); ++ return status; ++ } ++ } ++ } ++#endif ++ ++ padapter->hw_init_completed=false; ++ ++ status = padapter->HalFunc.hal_init(padapter); ++ ++ if(status == _SUCCESS){ ++ padapter->hw_init_completed = true; ++ ++ if (padapter->registrypriv.notch_filter == 1) ++ rtw_hal_notch_filter(padapter, 1); ++ ++ rtw_hal_reset_security_engine(padapter); ++ ++ rtw_led_control(padapter, LED_CTL_POWER_ON); ++ } ++ else{ ++ padapter->hw_init_completed = false; ++ DBG_871X("rtw_hal_init: hal__init fail\n"); ++ } ++ ++ RT_TRACE(_module_hal_init_c_,_drv_err_,("-rtl871x_hal_init:status=0x%x\n",status)); ++ ++ return status; ++ ++} ++ ++uint rtw_hal_deinit(_adapter *padapter) ++{ ++ uint status = _SUCCESS; ++ ++ ++ ++ status = padapter->HalFunc.hal_deinit(padapter); ++ ++ if(status == _SUCCESS){ ++ rtw_led_control(padapter, LED_CTL_POWER_OFF); ++ padapter->hw_init_completed = false; ++ } ++ else ++ { ++ DBG_871X("\n rtw_hal_deinit: hal_init fail\n"); ++ } ++ ++ ++ ++ return status; ++} ++ ++void rtw_hal_set_hwreg(_adapter *padapter, u8 variable, u8 *val) ++{ ++ if (padapter->HalFunc.SetHwRegHandler) ++ padapter->HalFunc.SetHwRegHandler(padapter, variable, val); ++} ++ ++void rtw_hal_get_hwreg(_adapter *padapter, u8 variable, u8 *val) ++{ ++ if (padapter->HalFunc.GetHwRegHandler) ++ padapter->HalFunc.GetHwRegHandler(padapter, variable, val); ++} ++ ++u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void * pValue) ++{ ++ if(padapter->HalFunc.SetHalDefVarHandler) ++ return padapter->HalFunc.SetHalDefVarHandler(padapter,eVariable,pValue); ++ return _FAIL; ++} ++u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void * pValue) ++{ ++ if(padapter->HalFunc.GetHalDefVarHandler) ++ return padapter->HalFunc.GetHalDefVarHandler(padapter,eVariable,pValue); ++ return _FAIL; ++} ++ ++void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void * pValue1,bool bSet) ++{ ++ if(padapter->HalFunc.SetHalODMVarHandler) ++ padapter->HalFunc.SetHalODMVarHandler(padapter,eVariable,pValue1,bSet); ++} ++void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void * pValue1,bool bSet) ++{ ++ if(padapter->HalFunc.GetHalODMVarHandler) ++ padapter->HalFunc.GetHalODMVarHandler(padapter,eVariable,pValue1,bSet); ++} ++ ++void rtw_hal_enable_interrupt(_adapter *padapter) ++{ ++ if (padapter->HalFunc.enable_interrupt) ++ padapter->HalFunc.enable_interrupt(padapter); ++ else ++ DBG_871X("%s: HalFunc.enable_interrupt is NULL!\n", __FUNCTION__); ++ ++} ++void rtw_hal_disable_interrupt(_adapter *padapter) ++{ ++ if (padapter->HalFunc.disable_interrupt) ++ padapter->HalFunc.disable_interrupt(padapter); ++ else ++ DBG_871X("%s: HalFunc.disable_interrupt is NULL!\n", __FUNCTION__); ++ ++} ++ ++ ++u32 rtw_hal_inirp_init(_adapter *padapter) ++{ ++ u32 rst = _FAIL; ++ if(padapter->HalFunc.inirp_init) ++ rst = padapter->HalFunc.inirp_init(padapter); ++ else ++ DBG_871X(" %s HalFunc.inirp_init is NULL!!!\n",__FUNCTION__); ++ return rst; ++} ++ ++u32 rtw_hal_inirp_deinit(_adapter *padapter) ++{ ++ ++ if(padapter->HalFunc.inirp_deinit) ++ return padapter->HalFunc.inirp_deinit(padapter); ++ ++ return _FAIL; ++ ++} ++ ++u8 rtw_hal_intf_ps_func(_adapter *padapter,HAL_INTF_PS_FUNC efunc_id, u8* val) ++{ ++ if(padapter->HalFunc.interface_ps_func) ++ return padapter->HalFunc.interface_ps_func(padapter,efunc_id,val); ++ return _FAIL; ++} ++ ++s32 rtw_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ if(padapter->HalFunc.hal_xmitframe_enqueue) ++ return padapter->HalFunc.hal_xmitframe_enqueue(padapter, pxmitframe); ++ ++ return false; ++} ++ ++s32 rtw_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe) ++{ ++ if(padapter->HalFunc.hal_xmit) ++ return padapter->HalFunc.hal_xmit(padapter, pxmitframe); ++ ++ return false; ++} ++ ++s32 rtw_hal_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe) ++{ ++ s32 ret = _FAIL; ++ ++ update_mgntframe_attrib_addr(padapter, pmgntframe); ++ ++ if(padapter->HalFunc.mgnt_xmit) ++ ret = padapter->HalFunc.mgnt_xmit(padapter, pmgntframe); ++ return ret; ++} ++ ++s32 rtw_hal_init_xmit_priv(_adapter *padapter) ++{ ++ if(padapter->HalFunc.init_xmit_priv != NULL) ++ return padapter->HalFunc.init_xmit_priv(padapter); ++ return _FAIL; ++} ++void rtw_hal_free_xmit_priv(_adapter *padapter) ++{ ++ if(padapter->HalFunc.free_xmit_priv != NULL) ++ padapter->HalFunc.free_xmit_priv(padapter); ++} ++ ++s32 rtw_hal_init_recv_priv(_adapter *padapter) ++{ ++ if(padapter->HalFunc.init_recv_priv) ++ return padapter->HalFunc.init_recv_priv(padapter); ++ ++ return _FAIL; ++} ++void rtw_hal_free_recv_priv(_adapter *padapter) ++{ ++ ++ if(padapter->HalFunc.free_recv_priv) ++ padapter->HalFunc.free_recv_priv(padapter); ++} ++ ++void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level) ++{ ++ _adapter *padapter; ++ struct mlme_priv *pmlmepriv; ++ ++ if(!psta) ++ return; ++ ++ padapter = psta->padapter; ++ ++ pmlmepriv = &(padapter->mlmepriv); ++ ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) ++ { ++ add_RATid(padapter, psta, rssi_level); ++ } ++ else ++ { ++ if(padapter->HalFunc.UpdateRAMaskHandler) ++ padapter->HalFunc.UpdateRAMaskHandler(padapter, psta->mac_id, rssi_level); ++ } ++} ++ ++void rtw_hal_add_ra_tid(_adapter *padapter, u32 bitmap, u8* arg, u8 rssi_level) ++{ ++ if(padapter->HalFunc.Add_RateATid) ++ padapter->HalFunc.Add_RateATid(padapter, bitmap, arg, rssi_level); ++} ++#ifdef CONFIG_CONCURRENT_MODE ++void rtw_hal_clone_data(_adapter *dst_padapter, _adapter *src_padapter) ++{ ++ if(dst_padapter->HalFunc.clone_haldata) ++ dst_padapter->HalFunc.clone_haldata(dst_padapter, src_padapter); ++} ++#endif ++/* Start specifical interface thread */ ++void rtw_hal_start_thread(_adapter *padapter) ++{ ++ if(padapter->HalFunc.run_thread) ++ padapter->HalFunc.run_thread(padapter); ++} ++/* Start specifical interface thread */ ++void rtw_hal_stop_thread(_adapter *padapter) ++{ ++ if(padapter->HalFunc.cancel_thread) ++ padapter->HalFunc.cancel_thread(padapter); ++} ++ ++u32 rtw_hal_read_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask) ++{ ++ u32 data = 0; ++ if(padapter->HalFunc.read_bbreg) ++ data = padapter->HalFunc.read_bbreg(padapter, RegAddr, BitMask); ++ return data; ++} ++void rtw_hal_write_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data) ++{ ++ if(padapter->HalFunc.write_bbreg) ++ padapter->HalFunc.write_bbreg(padapter, RegAddr, BitMask, Data); ++} ++ ++u32 rtw_hal_read_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask) ++{ ++ u32 data = 0; ++ if( padapter->HalFunc.read_rfreg) ++ data = padapter->HalFunc.read_rfreg(padapter, eRFPath, RegAddr, BitMask); ++ return data; ++} ++void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask, u32 Data) ++{ ++ if(padapter->HalFunc.write_rfreg) ++ padapter->HalFunc.write_rfreg(padapter, eRFPath, RegAddr, BitMask, Data); ++} ++ ++s32 rtw_hal_interrupt_handler(_adapter *padapter) ++{ ++ if(padapter->HalFunc.interrupt_handler) ++ return padapter->HalFunc.interrupt_handler(padapter); ++ return _FAIL; ++} ++ ++void rtw_hal_set_bwmode(_adapter *padapter, CHANNEL_WIDTH Bandwidth, u8 Offset) ++{ ++ if(padapter->HalFunc.set_bwmode_handler) ++ padapter->HalFunc.set_bwmode_handler(padapter, Bandwidth, Offset); ++} ++ ++void rtw_hal_set_chan(_adapter *padapter, u8 channel) ++{ ++ if(padapter->HalFunc.set_channel_handler) ++ padapter->HalFunc.set_channel_handler(padapter, channel); ++} ++ ++void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80) ++{ ++ if(padapter->HalFunc.set_chnl_bw_handler) ++ padapter->HalFunc.set_chnl_bw_handler(padapter, channel, Bandwidth, Offset40, Offset80); ++} ++ ++void rtw_hal_dm_watchdog(_adapter *padapter) ++{ ++#if defined(CONFIG_CONCURRENT_MODE) ++ if (padapter->adapter_type != PRIMARY_ADAPTER) ++ return; ++#endif ++ if(padapter->HalFunc.hal_dm_watchdog) ++ padapter->HalFunc.hal_dm_watchdog(padapter); ++} ++ ++void rtw_hal_bcn_related_reg_setting(_adapter *padapter) ++{ ++ if(padapter->HalFunc.SetBeaconRelatedRegistersHandler) ++ padapter->HalFunc.SetBeaconRelatedRegistersHandler(padapter); ++} ++ ++ ++#ifdef CONFIG_ANTENNA_DIVERSITY ++u8 rtw_hal_antdiv_before_linked(_adapter *padapter) ++{ ++ if(padapter->HalFunc.AntDivBeforeLinkHandler) ++ return padapter->HalFunc.AntDivBeforeLinkHandler(padapter); ++ return false; ++} ++void rtw_hal_antdiv_rssi_compared(_adapter *padapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src) ++{ ++ if(padapter->HalFunc.AntDivCompareHandler) ++ padapter->HalFunc.AntDivCompareHandler(padapter, dst, src); ++} ++#endif ++ ++#ifdef CONFIG_HOSTAPD_MLME ++s32 rtw_hal_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt) ++{ ++ if(padapter->HalFunc.hostap_mgnt_xmit_entry) ++ return padapter->HalFunc.hostap_mgnt_xmit_entry(padapter, pkt); ++ return _FAIL; ++} ++#endif //CONFIG_HOSTAPD_MLME ++ ++#ifdef DBG_CONFIG_ERROR_DETECT ++void rtw_hal_sreset_init(_adapter *padapter) ++{ ++ if(padapter->HalFunc.sreset_init_value) ++ padapter->HalFunc.sreset_init_value(padapter); ++} ++void rtw_hal_sreset_reset(_adapter *padapter) ++{ ++ padapter = GET_PRIMARY_ADAPTER(padapter); ++ ++ if(padapter->HalFunc.silentreset) ++ padapter->HalFunc.silentreset(padapter); ++} ++ ++void rtw_hal_sreset_reset_value(_adapter *padapter) ++{ ++ if(padapter->HalFunc.sreset_reset_value) ++ padapter->HalFunc.sreset_reset_value(padapter); ++} ++ ++void rtw_hal_sreset_xmit_status_check(_adapter *padapter) ++{ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->adapter_type != PRIMARY_ADAPTER) ++ return; ++#endif ++ if(padapter->HalFunc.sreset_xmit_status_check) ++ padapter->HalFunc.sreset_xmit_status_check(padapter); ++} ++void rtw_hal_sreset_linked_status_check(_adapter *padapter) ++{ ++ if(padapter->HalFunc.sreset_linked_status_check) ++ padapter->HalFunc.sreset_linked_status_check(padapter); ++} ++u8 rtw_hal_sreset_get_wifi_status(_adapter *padapter) ++{ ++ u8 status = 0; ++ if(padapter->HalFunc.sreset_get_wifi_status) ++ status = padapter->HalFunc.sreset_get_wifi_status(padapter); ++ return status; ++} ++ ++bool rtw_hal_sreset_inprogress(_adapter *padapter) ++{ ++ bool inprogress = false; ++ ++ padapter = GET_PRIMARY_ADAPTER(padapter); ++ ++ if(padapter->HalFunc.sreset_inprogress) ++ inprogress = padapter->HalFunc.sreset_inprogress(padapter); ++ return inprogress; ++} ++#endif //DBG_CONFIG_ERROR_DETECT ++ ++#ifdef CONFIG_IOL ++int rtw_hal_iol_cmd(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt) ++{ ++ if(adapter->HalFunc.IOL_exec_cmds_sync) ++ return adapter->HalFunc.IOL_exec_cmds_sync(adapter, xmit_frame, max_wating_ms,bndy_cnt); ++ return _FAIL; ++} ++#endif ++ ++#ifdef CONFIG_XMIT_THREAD_MODE ++s32 rtw_hal_xmit_thread_handler(_adapter *padapter) ++{ ++ if(padapter->HalFunc.xmit_thread_handler) ++ return padapter->HalFunc.xmit_thread_handler(padapter); ++ return _FAIL; ++} ++#endif ++ ++void rtw_hal_notch_filter(_adapter *adapter, bool enable) ++{ ++ if(adapter->HalFunc.hal_notch_filter) ++ adapter->HalFunc.hal_notch_filter(adapter,enable); ++} ++ ++void rtw_hal_reset_security_engine(_adapter * adapter) ++{ ++ if(adapter->HalFunc.hal_reset_security_engine) ++ adapter->HalFunc.hal_reset_security_engine(adapter); ++} ++ ++s32 rtw_hal_c2h_handler(_adapter *adapter, struct c2h_evt_hdr *c2h_evt) ++{ ++ s32 ret = _FAIL; ++ if (adapter->HalFunc.c2h_handler) ++ ret = adapter->HalFunc.c2h_handler(adapter, c2h_evt); ++ return ret; ++} ++ ++c2h_id_filter rtw_hal_c2h_id_filter_ccx(_adapter *adapter) ++{ ++ return adapter->HalFunc.c2h_id_filter_ccx; ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/hal_phy.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_phy.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/hal_phy.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_phy.c 2018-02-06 17:42:30.709967150 +0200 +@@ -0,0 +1,278 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++#define _HAL_PHY_C_ ++ ++#include ++ ++//================================================================================ ++// Constant. ++//================================================================================ ++// 2008/11/20 MH For Debug only, RF ++static RF_SHADOW_T RF_Shadow[RF6052_MAX_PATH][RF6052_MAX_REG]; ++ ++/** ++* Function: PHY_CalculateBitShift ++* ++* OverView: Get shifted position of the BitMask ++* ++* Input: ++* u4Byte BitMask, ++* ++* Output: none ++* Return: u4Byte Return the shift bit bit position of the mask ++*/ ++u32 ++PHY_CalculateBitShift( ++ u32 BitMask ++ ) ++{ ++ u32 i; ++ ++ for(i=0; i<=31; i++) ++ { ++ if ( ((BitMask>>i) & 0x1 ) == 1) ++ break; ++ } ++ ++ return (i); ++} ++ ++ ++// ++// ==> RF shadow Operation API Code Section!!! ++// ++/*----------------------------------------------------------------------------- ++ * Function: PHY_RFShadowRead ++ * PHY_RFShadowWrite ++ * PHY_RFShadowCompare ++ * PHY_RFShadowRecorver ++ * PHY_RFShadowCompareAll ++ * PHY_RFShadowRecorverAll ++ * PHY_RFShadowCompareFlagSet ++ * PHY_RFShadowRecorverFlagSet ++ * ++ * Overview: When we set RF register, we must write shadow at first. ++ * When we are running, we must compare shadow abd locate error addr. ++ * Decide to recorver or not. ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 11/20/2008 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++u32 ++PHY_RFShadowRead( ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset) ++{ ++ return RF_Shadow[eRFPath][Offset].Value; ++ ++} /* PHY_RFShadowRead */ ++ ++ ++void ++PHY_RFShadowWrite( ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset, ++ u32 Data) ++{ ++ RF_Shadow[eRFPath][Offset].Value = (Data & bRFRegOffsetMask); ++ RF_Shadow[eRFPath][Offset].Driver_Write = true; ++ ++} /* PHY_RFShadowWrite */ ++ ++ ++bool ++PHY_RFShadowCompare( ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset) ++{ ++ u32 reg; ++ // Check if we need to check the register ++ if (RF_Shadow[eRFPath][Offset].Compare == true) ++ { ++ reg = rtw_hal_read_rfreg(Adapter, eRFPath, Offset, bRFRegOffsetMask); ++ // Compare shadow and real rf register for 20bits!! ++ if (RF_Shadow[eRFPath][Offset].Value != reg) ++ { ++ // Locate error position. ++ RF_Shadow[eRFPath][Offset].ErrorOrNot = true; ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ++ //("PHY_RFShadowCompare RF-%d Addr%02lx Err = %05lx\n", ++ //eRFPath, Offset, reg)); ++ } ++ return RF_Shadow[eRFPath][Offset].ErrorOrNot ; ++ } ++ return false; ++} /* PHY_RFShadowCompare */ ++ ++ ++void ++PHY_RFShadowRecorver( ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset) ++{ ++ // Check if the address is error ++ if (RF_Shadow[eRFPath][Offset].ErrorOrNot == true) ++ { ++ // Check if we need to recorver the register. ++ if (RF_Shadow[eRFPath][Offset].Recorver == true) ++ { ++ rtw_hal_write_rfreg(Adapter, eRFPath, Offset, bRFRegOffsetMask, ++ RF_Shadow[eRFPath][Offset].Value); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ++ //("PHY_RFShadowRecorver RF-%d Addr%02lx=%05lx", ++ //eRFPath, Offset, RF_Shadow[eRFPath][Offset].Value)); ++ } ++ } ++ ++} /* PHY_RFShadowRecorver */ ++ ++ ++void ++PHY_RFShadowCompareAll( ++ PADAPTER Adapter) ++{ ++ u8 eRFPath = 0 ; ++ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); ++ ++ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) ++ { ++ for (Offset = 0; Offset <= maxReg; Offset++) ++ { ++ PHY_RFShadowCompare(Adapter, eRFPath, Offset); ++ } ++ } ++ ++} /* PHY_RFShadowCompareAll */ ++ ++ ++void ++PHY_RFShadowRecorverAll( ++ PADAPTER Adapter) ++{ ++ u8 eRFPath =0; ++ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); ++ ++ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) ++ { ++ for (Offset = 0; Offset <= maxReg; Offset++) ++ { ++ PHY_RFShadowRecorver(Adapter, eRFPath, Offset); ++ } ++ } ++ ++} /* PHY_RFShadowRecorverAll */ ++ ++ ++void ++PHY_RFShadowCompareFlagSet( ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset, ++ u8 Type) ++{ ++ // Set True or False!!! ++ RF_Shadow[eRFPath][Offset].Compare = Type; ++ ++} /* PHY_RFShadowCompareFlagSet */ ++ ++ ++void ++PHY_RFShadowRecorverFlagSet( ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset, ++ u8 Type) ++{ ++ // Set True or False!!! ++ RF_Shadow[eRFPath][Offset].Recorver= Type; ++ ++} /* PHY_RFShadowRecorverFlagSet */ ++ ++ ++void ++PHY_RFShadowCompareFlagSetAll( ++ PADAPTER Adapter) ++{ ++ u8 eRFPath = 0; ++ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); ++ ++ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) ++ { ++ for (Offset = 0; Offset <= maxReg; Offset++) ++ { ++ // 2008/11/20 MH For S3S4 test, we only check reg 26/27 now!!!! ++ if (Offset != 0x26 && Offset != 0x27) ++ PHY_RFShadowCompareFlagSet(Adapter, eRFPath, Offset, false); ++ else ++ PHY_RFShadowCompareFlagSet(Adapter, eRFPath, Offset, true); ++ } ++ } ++ ++} /* PHY_RFShadowCompareFlagSetAll */ ++ ++ ++void ++PHY_RFShadowRecorverFlagSetAll( ++ PADAPTER Adapter) ++{ ++ u8 eRFPath = 0; ++ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); ++ ++ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) ++ { ++ for (Offset = 0; Offset <= maxReg; Offset++) ++ { ++ // 2008/11/20 MH For S3S4 test, we only check reg 26/27 now!!!! ++ if (Offset != 0x26 && Offset != 0x27) ++ PHY_RFShadowRecorverFlagSet(Adapter, eRFPath, Offset, false); ++ else ++ PHY_RFShadowRecorverFlagSet(Adapter, eRFPath, Offset, true); ++ } ++ } ++ ++} /* PHY_RFShadowCompareFlagSetAll */ ++ ++void ++PHY_RFShadowRefresh( ++ PADAPTER Adapter) ++{ ++ u8 eRFPath = 0; ++ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); ++ ++ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) ++ { ++ for (Offset = 0; Offset <= maxReg; Offset++) ++ { ++ RF_Shadow[eRFPath][Offset].Value = 0; ++ RF_Shadow[eRFPath][Offset].Compare = false; ++ RF_Shadow[eRFPath][Offset].Recorver = false; ++ RF_Shadow[eRFPath][Offset].ErrorOrNot = false; ++ RF_Shadow[eRFPath][Offset].Driver_Write = false; ++ } ++ } ++ ++} /* PHY_RFShadowRead */ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8812A.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8812A.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8812A.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8812A.c 2018-02-06 17:42:30.709967150 +0200 +@@ -0,0 +1,2724 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++#include "odm_precomp.h" ++ ++ ++ ++/*---------------------------Define Local Constant---------------------------*/ ++// 2010/04/25 MH Define the max tx power tracking tx agc power. ++#define ODM_TXPWRTRACK_MAX_IDX8812A 6 ++ ++/*---------------------------Define Local Constant---------------------------*/ ++ ++ ++//3============================================================ ++//3 Tx Power Tracking ++//3============================================================ ++ ++ ++void DoIQK_8812A( ++ PDM_ODM_T pDM_Odm, ++ u1Byte DeltaThermalIndex, ++ u1Byte ThermalValue, ++ u1Byte Threshold ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ ODM_ResetIQKResult(pDM_Odm); ++ ++ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; ++ PHY_IQCalibrate_8812A(Adapter, false); ++} ++ ++/*----------------------------------------------------------------------------- ++ * Function: odm_TxPwrTrackSetPwr88E() ++ * ++ * Overview: 88E change all channel tx power accordign to flag. ++ * OFDM & CCK are all different. ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 04/23/2012 MHC Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++void ++ODM_TxPwrTrackSetPwr8812A( ++ PDM_ODM_T pDM_Odm, ++ PWRTRACK_METHOD Method, ++ u1Byte RFPath, ++ u1Byte ChannelMappedIndex ++ ) ++{ ++ u4Byte finalBbSwingIdx[2]; ++ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ ++ u1Byte PwrTrackingLimit = 26; //+1.0dB ++ u1Byte TxRate = 0xFF; ++ s1Byte Final_OFDM_Swing_Index = 0; ++ s1Byte Final_CCK_Swing_Index = 0; ++ u1Byte i = 0; ++ ++#if 0 ++ #if (MP_DRIVER==1) ++ PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); ++ ++ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); ++ #else ++ u2Byte rate = *(pDM_Odm->pForcedDataRate); ++ ++ if(!rate) //auto rate ++ { ++ if(pDM_Odm->TxRate != 0xFF) ++ TxRate = HwRateToMRate8812(pDM_Odm->TxRate); ++ } ++ else //force rate ++ { ++ TxRate = (u1Byte) rate; ++ } ++ #endif ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8812A\n")); ++#endif ++ if(TxRate != 0xFF) ++ { ++ //2 CCK ++ if((TxRate >= MGN_1M)&&(TxRate <= MGN_11M)) ++ PwrTrackingLimit = 32; //+4dB ++ //2 OFDM ++ else if((TxRate >= MGN_6M)&&(TxRate <= MGN_48M)) ++ PwrTrackingLimit = 32; //+4dB ++ else if(TxRate == MGN_54M) ++ PwrTrackingLimit = 30; //+3dB ++ //2 HT ++ else if((TxRate >= MGN_MCS0)&&(TxRate <= MGN_MCS2)) //QPSK/BPSK ++ PwrTrackingLimit = 34; //+5dB ++ else if((TxRate >= MGN_MCS3)&&(TxRate <= MGN_MCS4)) //16QAM ++ PwrTrackingLimit = 32; //+4dB ++ else if((TxRate >= MGN_MCS5)&&(TxRate <= MGN_MCS7)) //64QAM ++ PwrTrackingLimit = 30; //+3dB ++ ++ else if((TxRate >= MGN_MCS8)&&(TxRate <= MGN_MCS10)) //QPSK/BPSK ++ PwrTrackingLimit = 34; //+5dB ++ else if((TxRate >= MGN_MCS11)&&(TxRate <= MGN_MCS12)) //16QAM ++ PwrTrackingLimit = 32; //+4dB ++ else if((TxRate >= MGN_MCS13)&&(TxRate <= MGN_MCS15)) //64QAM ++ PwrTrackingLimit = 30; //+3dB ++ ++ //2 VHT ++ else if((TxRate >= MGN_VHT1SS_MCS0)&&(TxRate <= MGN_VHT1SS_MCS2)) //QPSK/BPSK ++ PwrTrackingLimit = 34; //+5dB ++ else if((TxRate >= MGN_VHT1SS_MCS3)&&(TxRate <= MGN_VHT1SS_MCS4)) //16QAM ++ PwrTrackingLimit = 32; //+4dB ++ else if((TxRate >= MGN_VHT1SS_MCS5)&&(TxRate <= MGN_VHT1SS_MCS6)) //64QAM ++ PwrTrackingLimit = 30; //+3dB ++ else if(TxRate == MGN_VHT1SS_MCS7) //64QAM ++ PwrTrackingLimit = 28; //+2dB ++ else if(TxRate == MGN_VHT1SS_MCS8) //256QAM ++ PwrTrackingLimit = 26; //+1dB ++ else if(TxRate == MGN_VHT1SS_MCS9) //256QAM ++ PwrTrackingLimit = 24; //+0dB ++ ++ else if((TxRate >= MGN_VHT2SS_MCS0)&&(TxRate <= MGN_VHT2SS_MCS2)) //QPSK/BPSK ++ PwrTrackingLimit = 34; //+5dB ++ else if((TxRate >= MGN_VHT2SS_MCS3)&&(TxRate <= MGN_VHT2SS_MCS4)) //16QAM ++ PwrTrackingLimit = 32; //+4dB ++ else if((TxRate >= MGN_VHT2SS_MCS5)&&(TxRate <= MGN_VHT2SS_MCS6)) //64QAM ++ PwrTrackingLimit = 30; //+3dB ++ else if(TxRate == MGN_VHT2SS_MCS7) //64QAM ++ PwrTrackingLimit = 28; //+2dB ++ else if(TxRate == MGN_VHT2SS_MCS8) //256QAM ++ PwrTrackingLimit = 26; //+1dB ++ else if(TxRate == MGN_VHT2SS_MCS9) //256QAM ++ PwrTrackingLimit = 24; //+0dB ++ ++ else ++ PwrTrackingLimit = 24; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("TxRate=0x%x, PwrTrackingLimit=%d\n", TxRate, PwrTrackingLimit)); ++ ++ ++ if (Method == BBSWING) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8812A\n")); ++ ++ if (RFPath == ODM_RF_PATH_A) ++ { ++ finalBbSwingIdx[ODM_RF_PATH_A] = (pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A] > PwrTrackingLimit) ? PwrTrackingLimit : pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A]; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A]=%d, pDM_Odm->RealBbSwingIdx[ODM_RF_PATH_A]=%d\n", ++ pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A], finalBbSwingIdx[ODM_RF_PATH_A])); ++ ++ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_A]]); ++ } ++ else ++ { ++ finalBbSwingIdx[ODM_RF_PATH_B] = (pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_B] > PwrTrackingLimit) ? PwrTrackingLimit : pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_B]; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_B]=%d, pDM_Odm->RealBbSwingIdx[ODM_RF_PATH_B]=%d\n", ++ pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_B], finalBbSwingIdx[ODM_RF_PATH_B])); ++ ++ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_B]]); ++ } ++ ++ /* ++ // <20121120> +2.5dB clipping, asked by Jerry Chang. ++ pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_A] = (pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_A] > 29) ? 29 : pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_A]; ++ pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_B] = (pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_B] > 29) ? 29 : pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_B]; ++ ++ //2013.01.28 LukeLee: This is for debug request by Joe, otherwise BbSwingOffsetA and BbSwingOffsetB is 0 in normal & MP driver ++ if(pDM_Odm->IsBbSwingOffsetPositiveA) ++ { ++ finalBbSwingIdx[ODM_RF_PATH_A] = pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_A] + pDM_Odm->BbSwingOffsetA; ++ finalBbSwingIdx[ODM_RF_PATH_A] = (finalBbSwingIdx[ODM_RF_PATH_A] > 29) ? 29 : finalBbSwingIdx[ODM_RF_PATH_A]; ++ } ++ else ++ finalBbSwingIdx[ODM_RF_PATH_A] = pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_A] - pDM_Odm->BbSwingOffsetA; ++ ++ if(pDM_Odm->IsBbSwingOffsetPositiveB) ++ { ++ finalBbSwingIdx[ODM_RF_PATH_B] = pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_B] + pDM_Odm->BbSwingOffsetB; ++ finalBbSwingIdx[ODM_RF_PATH_B] = (finalBbSwingIdx[ODM_RF_PATH_B] > 29) ? 29 : finalBbSwingIdx[ODM_RF_PATH_B]; ++ } ++ else ++ finalBbSwingIdx[ODM_RF_PATH_B] = pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_B] - pDM_Odm->BbSwingOffsetB; ++ ++ // Adjust BB swing by Tx scaling, no matter CCK or OFDM. ++ if (RFPath == ODM_RF_PATH_A) ++ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_A]]); ++ else if (RFPath == ODM_RF_PATH_B) ++ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_B]]); ++ ++ */ ++ ++ } ++ ++ else if (Method == MIX_MODE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pDM_Odm->DefaultOfdmIndex=%d, pDM_Odm->Aboslute_OFDMSwingIdx[RFPath]=%d, RF_Path = %d\n", ++ pDM_Odm->DefaultOfdmIndex, pDM_Odm->Aboslute_OFDMSwingIdx[RFPath],RFPath )); ++ ++ ++ Final_OFDM_Swing_Index = pDM_Odm->DefaultOfdmIndex + pDM_Odm->Aboslute_OFDMSwingIdx[RFPath]; ++ ++ if (RFPath == ODM_RF_PATH_A) ++ { ++ if(Final_OFDM_Swing_Index > PwrTrackingLimit) //BBSwing higher then Limit ++ { ++ pDM_Odm->Remnant_CCKSwingIdx= Final_OFDM_Swing_Index - PwrTrackingLimit; // CCK Follow the same compensate value as Path A ++ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit; ++ ++ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[PwrTrackingLimit]); ++ ++ pDM_Odm->Modify_TxAGC_Flag_PathA= true; ++ ++ //Set TxAGC Page C{}; ++ //Adapter->HalFunc.SetTxPowerLevelHandler(Adapter, pHalData->CurrentChannel); ++ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit, pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); ++ } ++ else if (Final_OFDM_Swing_Index < 0) ++ { ++ pDM_Odm->Remnant_CCKSwingIdx= Final_OFDM_Swing_Index; // CCK Follow the same compensate value as Path A ++ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index; ++ ++ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[0]); ++ ++ pDM_Odm->Modify_TxAGC_Flag_PathA= true; ++ ++ //Set TxAGC Page C{}; ++ //Adapter->HalFunc.SetTxPowerLevelHandler(Adapter, pHalData->CurrentChannel); ++ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); ++ } ++ else ++ { ++ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[Final_OFDM_Swing_Index]); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); ++ ++ if(pDM_Odm->Modify_TxAGC_Flag_PathA) //If TxAGC has changed, reset TxAGC again ++ { ++ pDM_Odm->Remnant_CCKSwingIdx= 0; ++ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = 0; ++ ++ //Set TxAGC Page C{}; ++ //Adapter->HalFunc.SetTxPowerLevelHandler(Adapter, pHalData->CurrentChannel); ++ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); ++ ++ pDM_Odm->Modify_TxAGC_Flag_PathA= false; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A pDM_Odm->Modify_TxAGC_Flag = false \n")); ++ } ++ } ++ } ++ ++ if (RFPath == ODM_RF_PATH_B) ++ { ++ if(Final_OFDM_Swing_Index > PwrTrackingLimit) //BBSwing higher then Limit ++ { ++ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit; ++ ++ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[PwrTrackingLimit]); ++ ++ pDM_Odm->Modify_TxAGC_Flag_PathB= true; ++ ++ //Set TxAGC Page E{}; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_B Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit, pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); ++ } ++ else if (Final_OFDM_Swing_Index < 0) ++ { ++ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index; ++ ++ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[0]); ++ ++ pDM_Odm->Modify_TxAGC_Flag_PathB = true; ++ ++ //Set TxAGC Page E{}; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_B Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); ++ } ++ else ++ { ++ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[Final_OFDM_Swing_Index]); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_B Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); ++ ++ if(pDM_Odm->Modify_TxAGC_Flag_PathB) //If TxAGC has changed, reset TxAGC again ++ { ++ pDM_Odm->Remnant_CCKSwingIdx= 0; ++ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = 0; ++ ++ //Set TxAGC Page E{}; ++ ++ pDM_Odm->Modify_TxAGC_Flag_PathB = false; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_B pDM_Odm->Modify_TxAGC_Flag = false \n")); ++ } ++ } ++ } ++ ++ } ++ else ++ { ++ return; ++ } ++} ++ ++void ++GetDeltaSwingTable_8812A( ++ PDM_ODM_T pDM_Odm, ++ pu1Byte *TemperatureUP_A, ++ pu1Byte *TemperatureDOWN_A, ++ pu1Byte *TemperatureUP_B, ++ pu1Byte *TemperatureDOWN_B ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u2Byte rate = *(pDM_Odm->pForcedDataRate); ++ u1Byte channel = pHalData->CurrentChannel; ++ ++ if ( 1 <= channel && channel <= 14) { ++ if (IS_CCK_RATE(rate)) { ++ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P; ++ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N; ++ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P; ++ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N; ++ } else { ++ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P; ++ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N; ++ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P; ++ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N; ++ } ++ } else if ( 36 <= channel && channel <= 64) { ++ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0]; ++ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0]; ++ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0]; ++ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0]; ++ } else if ( 100 <= channel && channel <= 140) { ++ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1]; ++ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1]; ++ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1]; ++ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1]; ++ } else if ( 149 <= channel && channel <= 173) { ++ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2]; ++ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2]; ++ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2]; ++ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2]; ++ } else { ++ *TemperatureUP_A = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; ++ *TemperatureDOWN_A = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; ++ *TemperatureUP_B = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; ++ *TemperatureDOWN_B = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; ++ } ++ ++ return; ++} ++ ++void ConfigureTxpowerTrack_8812A( ++ PTXPWRTRACK_CFG pConfig ++ ) ++{ ++ pConfig->SwingTableSize_CCK = TXSCALE_TABLE_SIZE; ++ pConfig->SwingTableSize_OFDM = TXSCALE_TABLE_SIZE; ++ pConfig->Threshold_IQK = IQK_THRESHOLD; ++ pConfig->AverageThermalNum = AVG_THERMAL_NUM_8812A; ++ pConfig->RfPathCount = MAX_PATH_NUM_8812A; ++ pConfig->ThermalRegAddr = RF_T_METER_8812A; ++ ++ pConfig->ODM_TxPwrTrackSetPwr = ODM_TxPwrTrackSetPwr8812A; ++ pConfig->DoIQK = DoIQK_8812A; ++ pConfig->PHY_LCCalibrate = PHY_LCCalibrate_8812A; ++ pConfig->GetDeltaSwingTable = GetDeltaSwingTable_8812A; ++} ++ ++ ++// ++// 2011/07/26 MH Add an API for testing IQK fail case. ++// ++// MP Already declare in odm.c ++static bool ++ODM_CheckPowerStatus( ++ PADAPTER Adapter) ++{ ++ return true; ++} ++ ++#define BW_20M 0 ++#define BW_40M 1 ++#define BW_80M 2 ++ ++static void _IQK_RX_FillIQC_8812A( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_RADIO_PATH_E Path, ++ unsigned int RX_X, ++ unsigned int RX_Y ++ ) ++{ ++ switch (Path) { ++ case ODM_RF_PATH_A: ++ { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ if (RX_X>>1 ==0x112 || RX_Y>>1 == 0x3ee){ ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x100); ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); ++ } ++ else{ ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, RX_X>>1); ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, RX_Y>>1); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc10 = %x ====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xc10))); ++ } ++ } ++ break; ++ case ODM_RF_PATH_B: ++ { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ if (RX_X>>1 ==0x112 || RX_Y>>1 == 0x3ee){ ++ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x100); ++ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, 0); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); ++ } ++ else{ ++ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, RX_X>>1); ++ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, RX_Y>>1); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x====>fill to IQC\n ", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe10 = %x====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xe10))); ++ } ++ } ++ break; ++ default: ++ break; ++ }; ++} ++ ++static void _IQK_TX_FillIQC_8812A( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_RADIO_PATH_E Path, ++ unsigned int TX_X, ++ unsigned int TX_Y ++ ) ++{ ++ switch (Path) { ++ case ODM_RF_PATH_A: ++ { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_Write4Byte(pDM_Odm, 0xc90, 0x00000080); ++ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x20040000); ++ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); ++ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, TX_Y); ++ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, TX_X); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X&0x000007ff, TX_Y&0x000007ff)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xcd4 = %x;;0xccc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xcd4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xccc, 0x000007ff))); ++ } ++ break; ++ case ODM_RF_PATH_B: ++ { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_Write4Byte(pDM_Odm, 0xe90, 0x00000080); ++ ODM_Write4Byte(pDM_Odm, 0xec4, 0x20040000); ++ ODM_Write4Byte(pDM_Odm, 0xec8, 0x20000000); ++ ODM_SetBBReg(pDM_Odm, 0xecc, 0x000007ff, TX_Y); ++ ODM_SetBBReg(pDM_Odm, 0xed4, 0x000007ff, TX_X); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X&0x000007ff, TX_Y&0x000007ff)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xed4 = %x;;0xecc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xed4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xecc, 0x000007ff))); ++ } ++ break; ++ default: ++ break; ++ }; ++} ++ ++static void _IQK_BackupMacBB_8812A( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte MACBB_backup, ++ pu4Byte Backup_MACBB_REG, ++ u4Byte MACBB_NUM ++ ) ++{ ++ u4Byte i; ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ //save MACBB default value ++ for (i = 0; i < MACBB_NUM; i++){ ++ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupMacBB Success!!!!\n")); ++} ++ ++static void _IQK_BackupRF_8812A( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte RFA_backup, ++ pu4Byte RFB_backup, ++ pu4Byte Backup_RF_REG, ++ u4Byte RF_NUM ++ ) ++{ ++ ++ u4Byte i; ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ //Save RF Parameters ++ for (i = 0; i < RF_NUM; i++){ ++ RFA_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG[i], bMaskDWord); ++ RFB_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, Backup_RF_REG[i], bMaskDWord); ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupRF Success!!!!\n")); ++} ++ ++static void _IQK_BackupAFE_8812A( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte AFE_backup, ++ pu4Byte Backup_AFE_REG, ++ u4Byte AFE_NUM ++ ) ++{ ++ u4Byte i; ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ //Save AFE Parameters ++ for (i = 0; i < AFE_NUM; i++){ ++ AFE_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_AFE_REG[i]); ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupAFE Success!!!!\n")); ++} ++ ++static void _IQK_RestoreMacBB_8812A( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte MACBB_backup, ++ pu4Byte Backup_MACBB_REG, ++ u4Byte MACBB_NUM ++ ) ++{ ++ u4Byte i; ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ //Reload MacBB Parameters ++ for (i = 0; i < MACBB_NUM; i++){ ++ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreMacBB Success!!!!\n")); ++} ++ ++static void _IQK_RestoreRF_8812A( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_RADIO_PATH_E Path, ++ pu4Byte Backup_RF_REG, ++ pu4Byte RF_backup, ++ u4Byte RF_REG_NUM ++ ) ++{ ++ u4Byte i; ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ for (i = 0; i < RF_REG_NUM; i++) ++ ODM_SetRFReg(pDM_Odm, Path, Backup_RF_REG[i], bRFRegOffsetMask, RF_backup[i]); ++ ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x0); ++ ++ switch(Path){ ++ case ODM_RF_PATH_A: ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path A Success!!!!\n")); ++ } ++ break; ++ case ODM_RF_PATH_B: ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path B Success!!!!\n")); ++ } ++ break; ++ default: ++ break; ++ } ++} ++ ++static void _IQK_RestoreAFE_8812A( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte AFE_backup, ++ pu4Byte Backup_AFE_REG, ++ u4Byte AFE_NUM ++ ) ++{ ++ u4Byte i; ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ //Reload AFE Parameters ++ for (i = 0; i < AFE_NUM; i++){ ++ ODM_Write4Byte(pDM_Odm, Backup_AFE_REG[i], AFE_backup[i]); ++ } ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x0); ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x0); ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x0); ++ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0); ++ ODM_Write4Byte(pDM_Odm, 0xe80, 0x0); ++ ODM_Write4Byte(pDM_Odm, 0xe84, 0x0); ++ ODM_Write4Byte(pDM_Odm, 0xe88, 0x0); ++ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x3c000000); ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x0); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreAFE Success!!!!\n")); ++} ++ ++static void _IQK_ConfigureMAC_8812A( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ // ========MAC register setting======== ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_Write1Byte(pDM_Odm, 0x522, 0x3f); ++ ODM_SetBBReg(pDM_Odm, 0x550, BIT(11)|BIT(3), 0x0); ++ ODM_SetBBReg(pDM_Odm, 0x808, BIT(28), 0x0); // CCK Off ++ ODM_Write1Byte(pDM_Odm, 0x808, 0x00); // RX ante off ++ ODM_SetBBReg(pDM_Odm, 0x838, 0xf, 0xc); // CCA off ++} ++ ++#define cal_num 3 ++ ++static void _IQK_Tx_8812A( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_RADIO_PATH_E Path, ++ u1Byte chnlIdx ++ ) ++{ ++ u4Byte TX_fail,RX_fail, delay_count, IQK_ready, cal_retry, cal = 0, temp_reg65; ++ int TX_X = 0, TX_Y = 0, RX_X = 0, RX_Y = 0, TX_Average = 0, RX_Average = 0; ++ int TX_X0[cal_num], TX_Y0[cal_num], RX_X0[cal_num], RX_Y0[cal_num]; ++ bool TX0IQKOK = false, RX0IQKOK = false; ++ int TX_X1[cal_num], TX_Y1[cal_num], RX_X1[cal_num], RX_Y1[cal_num]; ++ bool TX1IQKOK = false, RX1IQKOK = false, VDF_enable = false; ++ int i, k, VDF_Y[3], VDF_X[3], Tx_dt[3], Rx_dt[3], ii, dx = 0, dy = 0, TX_finish = 0, RX_finish = 0, dt = 0; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BandWidth = %d, ExtPA5G = %d, ExtPA2G = %d\n", *pDM_Odm->pBandWidth, pDM_Odm->ExtPA5G, pDM_Odm->ExtPA)); ++ if (*pDM_Odm->pBandWidth == 2){ ++ VDF_enable = true; ++ } ++ VDF_enable = false; ++ temp_reg65 = ODM_GetRFReg(pDM_Odm, Path, 0x65, bMaskDWord); ++ ++ switch(Path){ ++ case ODM_RF_PATH_A: ++ { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ // ========Path-A AFE all on======== ++ // Port 0 DAC/ADC on ++ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); ++ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); ++ ++ // Port 1 DAC/ADC off ++ ODM_Write4Byte(pDM_Odm, 0xe60, 0x00000000); ++ ODM_Write4Byte(pDM_Odm, 0xe64, 0x00000000); ++ ++ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); ++ ++ ODM_SetBBReg(pDM_Odm, 0xc00, 0xf, 0x4);// hardware 3-wire off ++ ++ // DAC/ADC sampling rate (160 MHz) ++ ODM_SetBBReg(pDM_Odm, 0xc5c, BIT(26)|BIT(25)|BIT(24), 0x7); ++ ODM_SetBBReg(pDM_Odm, 0x8c4, BIT(30), 0x1); ++ //ODM_SetBBReg(pDM_Odm, 0xcb0, 0x00ff0000, 0x77); ++ //ODM_SetBBReg(pDM_Odm, 0xcb4, 0x03000000, 0x0); ++ } ++ break; ++ case ODM_RF_PATH_B: ++ {ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ // ========Path-B AFE all on======== ++ // Port 0 DAC/ADC off ++ ODM_Write4Byte(pDM_Odm, 0xc60, 0x00000000); ++ ODM_Write4Byte(pDM_Odm, 0xc64, 0x00000000); ++ ++ // Port 1 DAC/ADC on ++ ODM_Write4Byte(pDM_Odm, 0xe60, 0x77777777); ++ ODM_Write4Byte(pDM_Odm, 0xe64, 0x77777777); ++ ++ ODM_Write4Byte(pDM_Odm, 0xe68, 0x19791979); ++ ++ ODM_SetBBReg(pDM_Odm, 0xe00, 0xf, 0x4);// hardware 3-wire off ++ ++ // DAC/ADC sampling rate (160 MHz) ++ ODM_SetBBReg(pDM_Odm, 0xe5c, BIT(26)|BIT(25)|BIT(24), 0x7); ++ ODM_SetBBReg(pDM_Odm, 0x8c4, BIT(30), 0x1); ++ //ODM_SetBBReg(pDM_Odm, 0xeb0, 0x00ff0000, 0x77); ++ //ODM_SetBBReg(pDM_Odm, 0xeb4, 0x03000000, 0x0); ++ } ++ break; ++ default: ++ break; ++ } ++ ++ switch (Path) { ++ case ODM_RF_PATH_A: ++ { ++ //====== TX IQK ====== ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80002); ++ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3fffd); ++ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe83f); ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); ++ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); ++ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); ++ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); ++ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); ++ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) ++ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ++ if (pDM_Odm->ExtPA5G) ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); ++ else ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f1); ++ ++ if (*pDM_Odm->pBandType) ++ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); ++ else{ ++ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28163e96); ++ if (pDM_Odm->RFEType == 3) ++ { if (pDM_Odm->ExtPA) ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403e3); ++ else ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); ++ } ++ ++ } ++ ++ if (VDF_enable == 1){ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXVDF Start\n")); ++ for (k = 0;k <= 2; k++){ ++ switch (k){ ++ case 0: ++ { ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c38);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); ++ } ++ break; ++ case 1: ++ { ++ ODM_SetBBReg(pDM_Odm, 0xc80, BIT(28), 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xc84, BIT(28), 0x0); ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910);// [0]:AGC_en, [15]:idac_K_Mask ++ } ++ break; ++ case 2: ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); ++ Tx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Tx_dt = %d\n", Tx_dt[cal])); ++ Tx_dt[cal] = ((16*Tx_dt[cal])*10000/15708); ++ Tx_dt[cal] = (Tx_dt[cal] >> 1 )+(Tx_dt[cal] & BIT(0)); ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c20);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xce8, 0x3fff0000, Tx_dt[cal] & 0x00003fff); ++ } ++ break; ++ default: ++ break; ++ } ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 10ms ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); ++ if ((IQK_ready) || (delay_count>20)){ ++ break; ++ } ++ else{ ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============TXIQK Check============== ++ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); ++ ++ if (~TX_fail){ ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); ++ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); ++ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ TX0IQKOK = true; ++ break; ++ } ++ else{ ++ TX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) { ++ break; ++ } ++ } ++ } ++ else{ ++ TX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10){ ++ break; ++ } ++ } ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXA_VDF_cal_retry = %d\n", cal_retry)); ++ TX_X0[cal] = VDF_X[k-1] ; ++ TX_Y0[cal] = VDF_Y[k-1]; ++ } ++ else{ ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_Write4Byte(pDM_Odm, 0xce8, 0x00000000); ++ ++ for(cal = 0; cal < cal_num; cal++){ ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 25ms ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); ++ if ((IQK_ready) || (delay_count>20)) { ++ break; ++ } ++ else{ ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============TXIQK Check============== ++ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); ++ ++ if (~TX_fail){ ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); ++ TX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); ++ TX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ TX0IQKOK = true; ++ /* ++ ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x01000000); ++ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); ++ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); ++ Image_Power = (reg2<<32)+reg1; ++ DbgPrint("Before PW = %d\n", Image_Power); ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x03000000); ++ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); ++ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); ++ Image_Power = (reg2<<32)+reg1; ++ DbgPrint("After PW = %d\n", Image_Power); ++ */ ++ break; ++ } ++ else{ ++ TX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) { ++ break; ++ } ++ } ++ } ++ else{ ++ TX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXA_cal_retry = %d\n", cal_retry)); ++ if (TX0IQKOK) ++ TX_Average++; ++ } ++ } ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetRFReg(pDM_Odm, Path, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, Path, 0x8, 0xffc00)); // Load LOK ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ++ if (TX0IQKOK == false) ++ break; // TXK fail, Don't do RXK ++ ++ ++ if (VDF_enable == 1){ ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); // TX VDF Disable ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXVDF Start\n")); ++ ++ //====== RX IQK ====== ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3f7ff); ++ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe7bf); ++ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d0); ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); ++ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); ++ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161420); ++ ++ for (k = 0;k <= 2; k++){ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (VDF_X[k])>>21&0x000007ff); ++ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (VDF_Y[k])>>21&0x000007ff); ++ ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ switch (k){ ++ case 0: ++ { ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c38);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(30), 0x0); ++ } ++ break; ++ case 1: ++ { ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x28008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x08008c38);// RX_Tone_idx[9:0], RxK_Mask[29] ++ } ++ break; ++ case 2: ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); ++ Rx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Rx_dt = %d\n", Rx_dt[cal])); ++ Rx_dt[cal] = ((16*Rx_dt[cal])*10000/13823); ++ Rx_dt[cal] = (Rx_dt[cal] >> 1 )+(Rx_dt[cal] & BIT(0)); ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c20);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_SetBBReg(pDM_Odm, 0xce8, 0x00003fff, Rx_dt[cal] & 0x00003fff); ++ } ++ break; ++ default: ++ break; ++ } ++ ++ ++ if (k==2){ ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(30), 0x1); //RX VDF Enable ++ } ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 10ms ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); ++ if ((IQK_ready)||(delay_count>20)){ ++ break; ++ } ++ else{ ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============RXIQK Check============== ++ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); ++ if (RX_fail == 0){ ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); ++ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); ++ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ RX0IQKOK = true; ++ break; ++ } ++ else{ ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); ++ RX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ ++ } ++ } ++ else{ ++ RX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ } ++ } ++ ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXA_VDF_cal_retry = %d\n", cal_retry)); ++ RX_X0[cal] = VDF_X[k-1] ; ++ RX_Y0[cal] = VDF_Y[k-1]; ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x1); // TX VDF Enable ++ } ++ else{ ++ //====== RX IQK ====== ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ // 1. RX RF Setting ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3f7ff); ++ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe7bf); ++ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d0); ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); ++ ++ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); ++ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); ++ //ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a891); ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); ++ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28160d40); ++ ++ for(cal = 0; cal < cal_num; cal++){ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X0[cal])>>21&0x000007ff); ++ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y0[cal])>>21&0x000007ff); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 10ms ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); ++ if ((IQK_ready)||(delay_count>20)){ ++ break; ++ } ++ else{ ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============RXIQK Check============== ++ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); ++ if (RX_fail == 0){ ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); ++ RX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); ++ RX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ RX0IQKOK = true; ++ /* ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x05000000); ++ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); ++ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); ++ DbgPrint("reg1 = %d, reg2 = %d", reg1, reg2); ++ Image_Power = (reg2<<32)+reg1; ++ DbgPrint("Before PW = %d\n", Image_Power); ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x07000000); ++ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); ++ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); ++ Image_Power = (reg2<<32)+reg1; ++ DbgPrint("After PW = %d\n", Image_Power); ++ */ ++ ++ break; ++ } ++ else{ ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); ++ RX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ ++ } ++ } ++ else{ ++ RX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXA_cal_retry = %d\n", cal_retry)); ++ if (RX0IQKOK) ++ RX_Average++; ++ } ++ } ++ ++ ++ ++ ++ } ++ break; ++ case ODM_RF_PATH_B: ++ { ++ //Path-B TX/RX IQK ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80002); ++ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3fffd); ++ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe83f); ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); ++ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); ++ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); ++ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); ++ ODM_SetBBReg(pDM_Odm, 0xe94, BIT(0), 0x1); ++ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) ++ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ++ if (pDM_Odm->ExtPA5G) ++ ODM_Write4Byte(pDM_Odm, 0xe88, 0x821403f7); ++ else ++ ODM_Write4Byte(pDM_Odm, 0xe88, 0x821403f1); ++ ++ if (*pDM_Odm->pBandType) ++ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x68163e96); ++ else ++ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28163e96); ++ ++ if (VDF_enable == 1){ ++ for (k = 0;k <= 2; k++){ ++ switch (k){ ++ case 0: ++ { ++ ODM_Write4Byte(pDM_Odm, 0xe80, 0x18008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xe84, 0x38008c38);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910); ++ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x0); ++ } ++ break; ++ case 1: ++ { ++ ODM_SetBBReg(pDM_Odm, 0xe80, BIT(28), 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xe84, BIT(28), 0x0); ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910); ++ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x0); ++ } ++ break; ++ case 2: ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); ++ Tx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Tx_dt = %d\n", Tx_dt[cal])); ++ Tx_dt[cal] = ((16*Tx_dt[cal])*10000/15708); ++ Tx_dt[cal] = (Tx_dt[cal] >> 1 )+(Tx_dt[cal] & BIT(0)); ++ ODM_Write4Byte(pDM_Odm, 0xe80, 0x18008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xe84, 0x38008c20);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xee8, 0x3fff0000, Tx_dt[cal] & 0x00003fff); ++ } ++ break; ++ default: ++ break; ++ } ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 10ms ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); ++ if ((IQK_ready) || (delay_count>20)) { ++ break; ++ } ++ else { ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============TXIQK Check============== ++ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(12)); ++ ++ if (~TX_fail){ ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x02000000); ++ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x04000000); ++ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; ++ TX1IQKOK = true; ++ break; ++ } ++ else{ ++ TX1IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) { ++ break; ++ } ++ } ++ } ++ else{ ++ TX1IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10){ ++ break; ++ } ++ } ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXB_VDF_cal_retry = %d\n", cal_retry)); ++ TX_X1[cal] = VDF_X[k-1] ; ++ TX_Y1[cal] = VDF_Y[k-1]; ++ } ++ else{ ++ ODM_Write4Byte(pDM_Odm, 0xe80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xe84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_Write4Byte(pDM_Odm, 0xee8, 0x00000000); ++ ++ for(cal = 0; cal < cal_num; cal++){ ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 25ms ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); ++ if ((IQK_ready)||(delay_count>20)){ ++ break; ++ } ++ else{ ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============TXIQK Check============== ++ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(12)); ++ if (~TX_fail){ ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x02000000); ++ TX_X1[cal] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x04000000); ++ TX_Y1[cal] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; ++ TX1IQKOK = true; ++ /* ++ int reg1 = 0, reg2 = 0, Image_Power = 0; ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x01000000); ++ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x02000000); ++ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); ++ Image_Power = (reg2<<32)+reg1; ++ DbgPrint("Before PW = %d\n", Image_Power); ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x03000000); ++ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x04000000); ++ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); ++ Image_Power = (reg2<<32)+reg1; ++ DbgPrint("After PW = %d\n", Image_Power); ++ */ ++ break; ++ } ++ else{ ++ TX1IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10){ ++ break; ++ } ++ } ++ } ++ else { ++ TX1IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10){ ++ break; ++ } ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXB_cal_retry = %d\n", cal_retry)); ++ if (TX1IQKOK) ++ TX_Average++; ++ } ++ } ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetRFReg(pDM_Odm, Path, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, Path, 0x8, 0xffc00)); // Load LOK ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ++ if (TX1IQKOK == false) ++ break; // TXK fail, Don't do RXK ++ ++ if (VDF_enable == 1) { ++ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x0); // TX VDF Disable ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXVDF Start\n")); ++ ++ //====== RX IQK ====== ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3f7ff); ++ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe7bf); ++ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d0); ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); ++ ++ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_Write4Byte(pDM_Odm, 0xe88, 0x02140119); ++ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28161420); ++ ++ for (k = 0;k <= 2; k++){ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (VDF_X[k])>>21&0x000007ff); ++ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (VDF_Y[k])>>21&0x000007ff); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ switch (k){ ++ case 0: ++ ODM_Write4Byte(pDM_Odm, 0xe80, 0x38008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xe84, 0x18008c38);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(30), 0x0); ++ break; ++ case 1: ++ ODM_Write4Byte(pDM_Odm, 0xe80, 0x28008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xe84, 0x08008c38);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(30), 0x0); ++ break; ++ case 2: ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); ++ Rx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Rx_dt = %d\n", Rx_dt[cal])); ++ Rx_dt[cal] = ((16*Rx_dt[cal])*10000/13823); ++ Rx_dt[cal] = (Rx_dt[cal] >> 1 )+(Rx_dt[cal] & BIT(0)); ++ ODM_Write4Byte(pDM_Odm, 0xe80, 0x38008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xe84, 0x18008c20);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_SetBBReg(pDM_Odm, 0xee8, 0x00003fff, Rx_dt[cal] & 0x00003fff); ++ break; ++ default: ++ break; ++ } ++ ++ ++ if (k==2) ++ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(30), 0x1); //RX VDF Enable ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 10ms ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); ++ if ((IQK_ready)||(delay_count>20)) { ++ break; ++ } else { ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============RXIQK Check============== ++ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(11)); ++ if (RX_fail == 0){ ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x06000000); ++ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x08000000); ++ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; ++ RX1IQKOK = true; ++ break; ++ } else { ++ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x200>>1); ++ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, 0x0>>1); ++ RX1IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ ++ } ++ } ++ else{ ++ RX1IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ } ++ } ++ ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXB_VDF_cal_retry = %d\n", cal_retry)); ++ RX_X1[cal] = VDF_X[k-1] ; ++ RX_Y1[cal] = VDF_Y[k-1]; ++ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x1); // TX VDF Enable ++ } ++ else{ ++ ++ //====== RX IQK ====== ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3f7ff); ++ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe7bf); ++ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d0); ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); ++ ++ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); ++ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); ++ //ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a891); ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_Write4Byte(pDM_Odm, 0xe80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xe84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_Write4Byte(pDM_Odm, 0xe88, 0x02140119); ++ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28161180); ++ ++ for(cal = 0; cal < cal_num; cal++){ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X1[cal])>>21&0x000007ff); ++ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y1[cal])>>21&0x000007ff); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 10ms ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); ++ if ((IQK_ready)||(delay_count>20)){ ++ break; ++ } ++ else { ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============RXIQK Check============== ++ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(11)); ++ if (RX_fail == 0){ ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x06000000); ++ RX_X1[cal] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x08000000); ++ RX_Y1[cal] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; ++ RX1IQKOK = true; ++/* ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x05000000); ++ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x06000000); ++ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); ++ DbgPrint("reg1 = %d, reg2 = %d", reg1, reg2); ++ Image_Power = (reg2<<32)+reg1; ++ DbgPrint("Before PW = %d\n", Image_Power); ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x07000000); ++ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x08000000); ++ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); ++ Image_Power = (reg2<<32)+reg1; ++ DbgPrint("After PW = %d\n", Image_Power); ++*/ ++ break; ++ } ++ else{ ++ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x200>>1); ++ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, 0x0>>1); ++ RX1IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ } ++ } ++ else{ ++ RX1IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ } ++ ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXB_cal_retry = %d\n", cal_retry)); ++ if (RX1IQKOK) ++ RX_Average++; ++ } ++ } ++ } ++ break; ++ default: ++ break; ++ } ++ ++ // FillIQK Result ++ switch (Path){ ++ case ODM_RF_PATH_A: ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_A =======\n")); ++ if (TX_Average == 0){ ++ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); ++ break; ++ } ++ for (i = 0; i < TX_Average; i++){ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X0[%d] = %x ;; TX_Y0[%d] = %x\n", i, (TX_X0[i])>>21&0x000007ff, i, (TX_Y0[i])>>21&0x000007ff)); ++ } ++ ++ for (i = 0; i < TX_Average; i++){ ++ for (ii = i+1; ii >21) - (TX_X0[ii]>>21); ++ if (dx < 4 && dx > -4){ ++ dy = (TX_Y0[i]>>21) - (TX_Y0[ii]>>21); ++ if (dy < 4 && dy > -4){ ++ TX_X = ((TX_X0[i]>>21) + (TX_X0[ii]>>21))/2; ++ TX_Y = ((TX_Y0[i]>>21) + (TX_Y0[ii]>>21))/2; ++ if (*pDM_Odm->pBandWidth == 2){ ++ Tx_dt[0] = (Tx_dt[i] + Tx_dt[ii])/2; ++ } ++ TX_finish = 1; ++ break; ++ } ++ } ++ } ++ if (TX_finish == 1) ++ break; ++ } ++ if (*pDM_Odm->pBandWidth == 2){ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C ++ ODM_SetBBReg(pDM_Odm, 0xce8, 0x3fff0000, Tx_dt[0] & 0x00003fff); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ } ++ if (TX_finish == 1){ ++ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, TX_X, TX_Y); ++ } ++ else{ ++ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); ++ } ++ ++ if (RX_Average == 0){ ++ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); ++ break; ++ } ++ ++ for (i = 0; i < RX_Average; i++){ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[%d] = %x ;; RX_Y0[%d] = %x\n", i, (RX_X0[i])>>21&0x000007ff, i, (RX_Y0[i])>>21&0x000007ff)); ++ } ++ ++ for (i = 0; i < RX_Average; i++){ ++ for (ii = i+1; ii >21) - (RX_X0[ii]>>21); ++ if (dx < 4 && dx > -4){ ++ dy = (RX_Y0[i]>>21) - (RX_Y0[ii]>>21); ++ if (dy < 4 && dy > -4){ ++ RX_X = ((RX_X0[i]>>21) + (RX_X0[ii]>>21))/2; ++ RX_Y = ((RX_Y0[i]>>21) + (RX_Y0[ii]>>21))/2; ++ if (*pDM_Odm->pBandWidth == 2){ ++ Rx_dt[0] = (Rx_dt[i] + Rx_dt[ii])/2; ++ } ++ RX_finish = 1; ++ break; ++ } ++ } ++ } ++ if (RX_finish == 1) ++ break; ++ } ++ if (*pDM_Odm->pBandWidth == 2){ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C ++ ODM_SetBBReg(pDM_Odm, 0xce8, 0x00003fff, Rx_dt[0] & 0x00003fff); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ } ++ if (RX_finish == 1){ ++ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, RX_X, RX_Y); ++ } ++ else{ ++ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); ++ } ++ if (TX_finish && RX_finish){ ++ pRFCalibrateInfo->bNeedIQK = false; ++ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][0] = ((TX_X & 0x000007ff) << 16) + (TX_Y & 0x000007ff); //Path A TX ++ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][1] = ((RX_X & 0x000007ff) << 16) + (RX_Y & 0x000007ff); //Path A RX ++ ++ if (*pDM_Odm->pBandWidth == 2){ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C ++ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][4] = ODM_Read4Byte( pDM_Odm, 0xce8); //Path B VDF ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ } ++ } ++ ++ } ++ break; ++ case ODM_RF_PATH_B: ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_B =======\n")); ++ if (TX_Average == 0){ ++ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); ++ break; ++ } ++ ++ for (i = 0; i < TX_Average; i++){ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X1[%d] = %x ;; TX_Y1[%d] = %x\n", i, (TX_X1[i])>>21&0x000007ff, i, (TX_Y1[i])>>21&0x000007ff)); ++ } ++ ++ for (i = 0; i < TX_Average; i++){ ++ for (ii = i+1; ii >21) - (TX_X1[ii]>>21); ++ if (dx < 4 && dx > -4){ ++ dy = (TX_Y1[i]>>21) - (TX_Y1[ii]>>21); ++ if (dy < 4 && dy > -4){ ++ TX_X = ((TX_X1[i]>>21) + (TX_X1[ii]>>21))/2; ++ TX_Y = ((TX_Y1[i]>>21) + (TX_Y1[ii]>>21))/2; ++ if (*pDM_Odm->pBandWidth == 2){ ++ Tx_dt[0] = (Tx_dt[i] + Tx_dt[ii])/2; ++ } ++ TX_finish = 1; ++ break; ++ } ++ } ++ } ++ if (TX_finish == 1) ++ break; ++ } ++ if (*pDM_Odm->pBandWidth == 2){ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C ++ ODM_SetBBReg(pDM_Odm, 0xee8, 0x3fff0000, Tx_dt[0] & 0x00003fff); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ } ++ if (TX_finish == 1){ ++ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, TX_X, TX_Y); ++ } ++ else{ ++ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); ++ } ++ ++ if (RX_Average == 0){ ++ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); ++ break; ++ } ++ ++ for (i = 0; i < RX_Average; i++){ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X1[%d] = %x ;; RX_Y1[%d] = %x\n", i, (RX_X1[i])>>21&0x000007ff, i, (RX_Y1[i])>>21&0x000007ff)); ++ } ++ ++ for (i = 0; i < RX_Average; i++){ ++ for (ii = i+1; ii >21) - (RX_X1[ii]>>21); ++ if (dx < 4 && dx > -4){ ++ dy = (RX_Y1[i]>>21) - (RX_Y1[ii]>>21); ++ if (dy < 4 && dy > -4){ ++ RX_X = ((RX_X1[i]>>21) + (RX_X1[ii]>>21))/2; ++ RX_Y = ((RX_Y1[i]>>21) + (RX_Y1[ii]>>21))/2; ++ if (*pDM_Odm->pBandWidth == 2){ ++ Rx_dt[0] = (Rx_dt[i] + Rx_dt[ii])/2; ++ } ++ RX_finish = 1; ++ break; ++ } ++ } ++ } ++ if (RX_finish == 1) ++ break; ++ } ++ if (*pDM_Odm->pBandWidth == 2){ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C ++ ODM_SetBBReg(pDM_Odm, 0xee8, 0x00003fff, Rx_dt[0] & 0x00003fff); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ } ++ ++ if (RX_finish == 1){ ++ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, RX_X, RX_Y); ++ } ++ else{ ++ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); ++ } ++ if (TX_finish && RX_finish){ ++//pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].bIQKDone= true; ++ pRFCalibrateInfo->bNeedIQK = false; ++ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][2] = ((TX_X & 0x000007ff) << 16) + (TX_Y & 0x000007ff); //Path B TX ++ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][3] = ((RX_X & 0x000007ff) << 16) + (RX_Y & 0x000007ff); //Path B RX ++ ++ if (*pDM_Odm->pBandWidth == 2){ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C ++ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][5] = ODM_Read4Byte( pDM_Odm, 0xee8); //Path B VDF ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ } ++ } ++ ++ } ++ break; ++ default: ++ break; ++ } ++} ++ ++#define MACBB_REG_NUM 10 ++#define AFE_REG_NUM 14 ++#define RF_REG_NUM 3 ++ ++// Maintained by BB James. ++static void ++phy_IQCalibrate_8812A( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Channel ++ ) ++{ ++ u4Byte MACBB_backup[MACBB_REG_NUM], AFE_backup[AFE_REG_NUM], RFA_backup[RF_REG_NUM], RFB_backup[RF_REG_NUM]; ++ u4Byte Backup_MACBB_REG[MACBB_REG_NUM] = {0xb00, 0x520, 0x550, 0x808, 0x90c, 0xc00, 0xe00, 0x8c4,0x838, 0x82c}; ++ u4Byte Backup_AFE_REG[AFE_REG_NUM] = {0xc5c, 0xc60, 0xc64, 0xc68, 0xcb8, 0xcb0, 0xcb4, ++ 0xe5c, 0xe60, 0xe64, 0xe68, 0xeb8, 0xeb0, 0xeb4}; ++ u4Byte Backup_RF_REG[RF_REG_NUM] = {0x65, 0x8f, 0x0}; ++ u1Byte chnlIdx = ODM_GetRightChnlPlaceforIQK(Channel); ++ ++ _IQK_BackupMacBB_8812A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); ++ _IQK_BackupAFE_8812A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); ++ _IQK_BackupRF_8812A(pDM_Odm, RFA_backup, RFB_backup, Backup_RF_REG, RF_REG_NUM); ++ ++ _IQK_ConfigureMAC_8812A(pDM_Odm); ++ _IQK_Tx_8812A(pDM_Odm, ODM_RF_PATH_A, chnlIdx); ++ _IQK_RestoreRF_8812A(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG, RFA_backup, RF_REG_NUM); ++ ++ _IQK_Tx_8812A(pDM_Odm, ODM_RF_PATH_B, chnlIdx); ++ _IQK_RestoreRF_8812A(pDM_Odm, ODM_RF_PATH_B, Backup_RF_REG, RFB_backup, RF_REG_NUM); ++ ++ _IQK_RestoreAFE_8812A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); ++ _IQK_RestoreMacBB_8812A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); ++ ++ ++} ++ ++ ++static void ++phy_LCCalibrate_8812A( ++ PDM_ODM_T pDM_Odm, ++ bool is2T ++ ) ++{ ++ u4Byte /*RF_Amode=0, RF_Bmode=0,*/ LC_Cal = 0, tmp = 0; ++ ++ //Check continuous TX and Packet TX ++ u4Byte reg0x914 = ODM_Read4Byte(pDM_Odm, rSingleTone_ContTx_Jaguar);; ++ ++ // Backup RF reg18. ++ LC_Cal = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); ++ ++ if((reg0x914 & 0x70000) != 0) //If contTx, disable all continuous TX. 0x914[18:16] ++ // <20121121, Kordan> A workaround: If we set 0x914[18:16] as zero, BB turns off ContTx ++ // until another packet comes in. To avoid ContTx being turned off, we skip this step. ++ ;//ODM_Write4Byte(pDM_Odm, rSingleTone_ContTx_Jaguar, reg0x914 & (~0x70000)); ++ else // If packet Tx-ing, pause Tx. ++ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0xFF); ++ ++ ++/* ++ //3 1. Read original RF mode ++ RF_Amode = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask); ++ if(is2T) ++ RF_Bmode = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bRFRegOffsetMask); ++ ++ ++ //3 2. Set RF mode = standby mode ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask, (RF_Amode&0x8FFFF)|0x10000); ++ if(is2T) ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bRFRegOffsetMask, (RF_Bmode&0x8FFFF)|0x10000); ++*/ ++ ++ // Enter LCK mode ++ tmp = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask, tmp | BIT14); ++ ++ //3 3. Read RF reg18 ++ LC_Cal = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); ++ ++ //3 4. Set LC calibration begin bit15 ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal|0x08000); ++ ++ // Leave LCK mode ++ tmp = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask, tmp & ~BIT14); ++ ++ ODM_delay_ms(100); ++ ++ //3 Restore original situation ++ if((reg0x914 & 70000) != 0) //Deal with contisuous TX case, 0x914[18:16] ++ { ++ // <20121121, Kordan> A workaround: If we set 0x914[18:16] as zero, BB turns off ContTx ++ // until another packet comes in. To avoid ContTx being turned off, we skip this step. ++ //ODM_Write4Byte(pDM_Odm, rSingleTone_ContTx_Jaguar, reg0x914); ++ } ++ else // Deal with Packet TX case ++ { ++ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0x00); ++ } ++ ++ // Recover channel number ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal); ++ ++ /* ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask, RF_Amode); ++ if(is2T) ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bRFRegOffsetMask, RF_Bmode); ++ */ ++ ++} ++ ++ ++ ++ ++ ++#define DP_BB_REG_NUM 7 ++#define DP_RF_REG_NUM 1 ++#define DP_RETRY_LIMIT 10 ++#define DP_PATH_NUM 2 ++#define DP_DPK_NUM 3 ++#define DP_DPK_VALUE_NUM 2 ++ ++static void ++phy_ReloadIQKSetting_8812A( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Channel ++ ) ++{ ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ u1Byte chnlIdx = ODM_GetRightChnlPlaceforIQK(Channel); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][0]&0x7ff); ++ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][0]&0x7ff0000)>>16); ++ ODM_SetBBReg(pDM_Odm, 0xecc, 0x000007ff, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][2]&0x7ff); ++ ODM_SetBBReg(pDM_Odm, 0xed4, 0x000007ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][2]&0x7ff0000)>>16); ++ ++ if (*pDM_Odm->pBandWidth != 2){ ++ ODM_Write4Byte(pDM_Odm, 0xce8, 0x0); ++ ODM_Write4Byte(pDM_Odm, 0xee8, 0x0); ++ } ++ else{ ++ ODM_Write4Byte(pDM_Odm, 0xce8, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][4]); ++ ODM_Write4Byte(pDM_Odm, 0xee8, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][5]); ++ } ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][1]&0x7ff0000)>>17); ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][1]&0x7ff)>>1); ++ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][3]&0x7ff0000)>>17); ++ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][3]&0x7ff)>>1); ++ ++ ++} ++ ++static void ++PHY_ResetIQKResult_8812A( ++ PDM_ODM_T pDM_Odm ++) ++{ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); ++ ODM_SetBBReg(pDM_Odm, 0xecc, 0x000007ff, 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xed4, 0x000007ff, 0x200); ++ ODM_Write4Byte(pDM_Odm, 0xce8, 0x0); ++ ODM_Write4Byte(pDM_Odm, 0xee8, 0x0); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x100); ++ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x100); ++} ++ ++static void ++phy_IQCalibrate_By_FW_8812A( ++ PADAPTER pAdapter ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u1Byte IQKcmd[3] = {pHalData->CurrentChannel, 0x0, 0x0}; ++ u1Byte Buf1 = 0x0; ++ u1Byte Buf2 = 0x0; ++ ++//Byte 2, Bit 4 ~ Bit 5 : BandType ++ if(pHalData->CurrentBandType) ++ Buf1 = 0x2<<4; ++ else ++ Buf1 = 0x1<<4; ++ ++//Byte 2, Bit 0 ~ Bit 3 : Bandwidth ++ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) ++ Buf2 = 0x1; ++ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) ++ Buf2 = 0x1<<1; ++ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) ++ Buf2 = 0x1<<2; ++ else ++ Buf2 = 0x1<<3; ++ ++ IQKcmd[1] = Buf1 | Buf2; ++ IQKcmd[2] = pHalData->ExternalPA_5G | pHalData->ExternalLNA_5G<<1; ++ ++ RT_TRACE(COMP_MP, DBG_LOUD, ("== Start ==\n")); ++ ++ ++ //FillH2CCmd_8812(pAdapter, 0x45, 3, IQKcmd); ++} ++ ++void ++PHY_IQCalibrate_8812A( ++ PADAPTER pAdapter, ++ bool bReCovery ++ ) ++{ ++ ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ ++#if (MP_DRIVER == 1) ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++#endif//(MP_DRIVER == 1) ++ ++ if (ODM_CheckPowerStatus(pAdapter) == false) ++ return; ++#if MP_DRIVER == 1 ++ if( ! (pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) ) ++#endif ++ { ++ phy_IQCalibrate_8812A(pDM_Odm, pHalData->CurrentChannel); ++ } ++ ++} ++ ++ ++void ++PHY_LCCalibrate_8812A( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ bool bStartContTx = false, bSingleTone = false, bCarrierSuppression = false; ++ ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ ++ #if (MP_DRIVER == 1) ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ bStartContTx = pMptCtx->bStartContTx; ++ bSingleTone = pMptCtx->bSingleTone; ++ bCarrierSuppression = pMptCtx->bCarrierSuppression; ++ #endif//(MP_DRIVER == 1) ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> PHY_LCCalibrate_8812A\n")); ++ ++#if (MP_DRIVER == 1) ++ phy_LCCalibrate_8812A(pDM_Odm, true); ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== PHY_LCCalibrate_8812A\n")); ++ ++} ++ ++static void phy_SetRFPathSwitch_8812A( ++ PADAPTER pAdapter, ++ bool bMain, ++ bool is2T ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ ++ if (IS_HARDWARE_TYPE_8821(pAdapter)) ++ { ++ if(bMain) ++ ODM_SetBBReg(pDM_Odm, rA_RFE_Pinmux_Jaguar+4, BIT29|BIT28, 0x1); //Main ++ else ++ ODM_SetBBReg(pDM_Odm, rA_RFE_Pinmux_Jaguar+4, BIT29|BIT28, 0x2); //Aux ++ } ++ else if (IS_HARDWARE_TYPE_8812(pAdapter)) ++ { ++ if (pHalData->RFEType == 5) ++ { ++ if(bMain) { ++ //WiFi ++ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x2); ++ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); ++ } else { ++ // BT ++ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x1); ++ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); ++ } ++ } ++ } ++ ++} ++ ++void PHY_SetRFPathSwitch_8812A( ++ PADAPTER pAdapter, ++ bool bMain ++ ) ++{ ++ ++#if DISABLE_BB_RF ++ return; ++#else ++ phy_SetRFPathSwitch_8812A(pAdapter, bMain, true); ++#endif ++} ++ ++ ++static void ++_DPK_ThermalCompensation( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++} ++ ++static void ++_DPK_parareload( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte MACBB_backup, ++ pu4Byte Backup_MACBB_REG, ++ u4Byte MACBB_NUM ++ ) ++{ ++ u4Byte i; ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ //save MACBB default value ++ for (i = 0; i < MACBB_NUM; i++){ ++ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); ++ } ++} ++ ++ ++static void ++_DPK_parabackup( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte MACBB_backup, ++ pu4Byte Backup_MACBB_REG, ++ u4Byte MACBB_NUM ++ ++ ++ ) ++{ ++ u4Byte i; ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ //save MACBB default value ++ for (i = 0; i < MACBB_NUM; i++){ ++ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); ++ } ++} ++ ++static void ++_DPK_Globalparaset( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ ++ //***************************************// ++ //set MAC register ++ //***************************************// ++ ++ //TX pause ++ ODM_Write4Byte(pDM_Odm, 0x520, 0x007f3F0F); ++ ++ //***************************************// ++ //set BB register ++ //***************************************// ++ ++ // reg82c[31] = b'0, page C ++ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083d5); ++ ++ // test pin in/out control ++ ODM_Write4Byte(pDM_Odm, 0x970, 0x00000000); ++ ++ // path A regcb8[3:0] = h'd, TRSW to TX ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0050824d); ++ ++ // path B regeb8[3:0] = h'd, TRSW to TX ++ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x0050824d); ++ ++ // reg838[3:0] = h'c, CCA off ++ ODM_Write4Byte(pDM_Odm, 0x838, 0x06c8d24c); ++ ++ // path A 3-wire off ++ ODM_Write4Byte(pDM_Odm, 0xc00, 0x00000004); ++ ++ // path B 3-wire off ++ ODM_Write4Byte(pDM_Odm, 0xe00, 0x00000004); ++ ++ // reg90c[15] = b'1, DAC fifo reset by CSWU ++ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); ++ ++ // reset DPK circuit ++ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); ++ ++ // path A regc94[0] = b'1 (r_gothrough_iqkdpk), N DPK i normal path ++ ODM_Write4Byte(pDM_Odm, 0xc94, 0x01000001); ++ ++ // path B rege94[0] = b'1 (r_gothrough_iqkdpk), N DPK i normal path ++ ODM_Write4Byte(pDM_Odm, 0xe94, 0x01000001); ++ ++ //***************************************// ++ //set AFE register ++ //***************************************// ++ ++ //path A ++ //regc68 regc84ӬOn򥿱` Tx mode ɪ]w@P ++ ++ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc6c, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc70, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc74, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc78, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc7c, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x19791979); ++ ++ // force DAC/ADC power on ++ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); ++ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); ++ ++ //path B ++ //rege68 rege84ӬOn򥿱` Tx mode ɪ]w@P ++ ++ ODM_Write4Byte(pDM_Odm, 0xe68, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xe6c, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xe70, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xe74, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xe78, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xe7c, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xe80, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xe84, 0x19791979); ++ ++ // force DAC/ADC power on ++ ODM_Write4Byte(pDM_Odm, 0xe60, 0x77777777); ++ ODM_Write4Byte(pDM_Odm, 0xe64, 0x77777777); ++ ++} ++ ++ ++static void ++_DPK_GetGainLoss( ++ PDM_ODM_T pDM_Odm, ++ u1Byte path ++ ) ++{ ++ u4Byte GL_I=0,GL_Q=0; ++ u4Byte GL_I_tmp=0,GL_Q_tmp=0; ++ ++ u4Byte Power_GL; ++ u2Byte Scaler[]={0x4000, 0x41db, 0x43c7, 0x45c3, 0x47cf, 0x49ec, 0x4c19, 0x4e46, 0x5093,0x52f2, //10 ++ 0x5560, 0x57cf, 0x5a7f, 0x5d0e, 0x5fbe ++ }; ++ u1Byte sindex=0; ++ u4Byte pagesel = 0,regsel = 0; ++ ++ if(path == 0) //pathA ++ { ++ pagesel = 0; ++ regsel = 0; ++ } ++ else //pathB ++ { ++ pagesel = 0x200; ++ regsel = 0x40; ++ } ++ ++ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0601f0bf); ++ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x0c000000); ++ ++ ++ ++ GL_I_tmp = ODM_GetBBReg(pDM_Odm, 0xd00+regsel, 0xffff0000); ++ GL_Q_tmp = ODM_GetBBReg(pDM_Odm, 0xd00+regsel, 0x0000ffff); ++ ++ if(GL_I_tmp >= 0x8000) ++ GL_I = (GL_I_tmp-0x8000+0x1); ++ else ++ GL_I = GL_I_tmp; ++ ++ ++ if(GL_Q_tmp >= 0x8000) ++ GL_Q = (GL_Q_tmp-0x8000+0x1); ++ else ++ GL_Q = GL_Q_tmp; ++ ++ Power_GL = ((GL_I*GL_I)+(GL_Q*GL_Q))/4; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Power_GL = 0x%x", Power_GL)); ++ ++ if (Power_GL > 63676){ ++ sindex = 0; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 0 dB\n")); ++ } ++ else if (63676 >= Power_GL && Power_GL > 60114){ ++ sindex = 1; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 0.25 dB\n")); ++ } ++ else if (60114 >= Power_GL && Power_GL> 56751){ ++ sindex = 2; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 0.5 dB\n")); ++ } ++ else if (56751 >= Power_GL && Power_GL> 53577){ ++ sindex = 3; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 0.75 dB\n")); ++ } ++ else if (53577 >= Power_GL && Power_GL> 49145){ ++ sindex = 4; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 1 dB\n")); ++ } ++ else if (49145 >= Power_GL && Power_GL> 47750){ ++ sindex = 5; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 1.25 dB\n")); ++ } ++ else if (47750 >= Power_GL && Power_GL> 45079){ ++ sindex = 6; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 1.5 dB\n")); ++ } ++ else if (45079 >= Power_GL && Power_GL> 42557){ ++ sindex = 7; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 1.75 dB\n")); ++ } ++ else if (42557 >= Power_GL && Power_GL> 40177){ ++ sindex = 8; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 2 dB\n")); ++ } ++ else if (40177 >= Power_GL && Power_GL> 37929){ ++ sindex = 9; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 2.25 dB\n")); ++ } ++ else if (37929 >= Power_GL && Power_GL> 35807){ ++ sindex = 10; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 2.5 dB\n")); ++ } ++ else if (35807 >= Power_GL && Power_GL> 33804){ ++ sindex = 11; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 2.75 dB\n")); ++ } ++ else if (33804 >= Power_GL && Power_GL> 31913){ ++ sindex = 12; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 3 dB\n")); ++ } ++ else if (31913 >= Power_GL && Power_GL> 30128){ ++ sindex = 13; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 3.25 dB\n")); ++ } ++ else if (30128 >= Power_GL){ ++ sindex = 14; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 3.5 dB\n")); ++ } ++ ++ ++ ODM_Write4Byte(pDM_Odm, 0xc98+pagesel, (Scaler[sindex] << 16) | Scaler[sindex]); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Set Gainloss reg 0xc98(0xe98)= 0x%x\n",ODM_Read4Byte(pDM_Odm, 0xc98+pagesel))); ++ ++} ++ ++ ++static void ++_DPK_EnableDP( ++ PDM_ODM_T pDM_Odm, ++ u1Byte path, ++ u4Byte TXindex ++ ) ++{ ++ ++ //***************************************// ++ //Enable DP ++ //***************************************// ++ ++ //PWSF[6] = 0x40 = 0dB, set the address represented TXindex as 0dB ++ u1Byte PWSF[] = { 0xff, 0xca, 0xa1, 0x80, 0x65, 0x51, 0x40, //6~0dB ++ 0x33, 0x28, 0x20, 0x19, 0x14, 0x10, 0x0d, //-1~-7dB ++ 0x0a, 0x08, 0x06, 0x05, 0x04, 0x03, 0x03, //-8~-14dB ++ 0x02, 0x02, 0x01, 0x01, ++ }; ++ u1Byte zeropoint; ++ u1Byte pwsf1,pwsf2; ++ u1Byte i; ++ u4Byte pagesel = 0,regsel = 0; ++ ++ if(path == 0) ++ { ++ pagesel = 0; ++ regsel = 0; ++ } ++ else ++ { ++ pagesel = 0x200; ++ regsel = 0x40; ++ } ++ ++ ++ //=========// ++ // DPK setting // ++ //=========// ++ // reg82c[31] = b'1, page C1 ++ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083d5); ++ ++ ++ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0000f098); ++ ODM_Write4Byte(pDM_Odm, 0xc94+pagesel, 0x776c9f84); ++ ODM_Write4Byte(pDM_Odm, 0xcc4+pagesel, 0x08840000); ++ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x20000000); ++ ODM_Write4Byte(pDM_Odm, 0xc8c+pagesel, 0x3c000000); ++ ++ ++ // gPWSF table in 1st SRAM for PA = 11 use ++ ODM_Write4Byte(pDM_Odm, 0xc20+pagesel, 0x00000800); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Write PWSF table\n")); ++ ++ ++ if(TXindex == 0x1f) ++ zeropoint = 0; ++ else if(TXindex == 0x1e) ++ zeropoint = 1; ++ else if(TXindex == 0x1d) ++ zeropoint = 2; ++ else if(TXindex == 0x1c) ++ zeropoint = 3; ++ else if(TXindex == 0x1b) ++ zeropoint = 4; ++ else if(TXindex == 0x1a) ++ zeropoint = 5; ++ else if(TXindex == 0x19) ++ zeropoint = 6; ++ else ++ zeropoint = 6; ++ ++ ++ ++ for(i=0;i<16;i++) ++ { ++ if((6-zeropoint)+i*2 > 24) ++ pwsf1 = 24; ++ else ++ pwsf1 = (6-zeropoint)+i*2; ++ ++ if((6-zeropoint-1)+i*2 > 24) ++ pwsf2 = 24; ++ else ++ pwsf2 = (6-zeropoint-1)+i*2; ++ ++ ODM_Write4Byte(pDM_Odm, 0xce4+pagesel, 0x00000001 | i<<1 | (PWSF[pwsf1]<<8) | (PWSF[pwsf2]<<16)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0x%x\n", ODM_Read4Byte(pDM_Odm, 0xce4+pagesel))); ++ ODM_SetBBReg(pDM_Odm, 0xce4+pagesel, 0xff, 0x0); ++ } ++ ++ ODM_Write4Byte(pDM_Odm, 0xce4+pagesel, 0x00000000); ++ ++ // reg82c[31] = b'0, page C ++ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083d5); ++ ++} ++ ++ ++static void ++_DPK_pathABDPK( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte TXindex = 0; ++ u1Byte path = 0; ++ u4Byte pagesel = 0,regsel = 0; ++ u4Byte i=0,j=0; ++ ++ for(path=0;path<2;path ++) //path A = 0; path B = 1; ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path %s DPK start!!!\n", (path==0)?"A":"B")); ++ ++ if(path == 0) ++ { ++ pagesel = 0; ++ regsel = 0; ++ } ++ else ++ { ++ pagesel = 0x200; ++ regsel = 0x40; ++ } ++ ++ //***************************************// ++ //find compress-2.5dB TX index ++ //***************************************// ++ ++ ++ // reg82c[31] = b'1, page C1 ++ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083d5); ++ ++ // regc20[15:13] = dB sel, iD Gain Loss function hM dB_sel ҳ]wPA gain lossؼЩҹ Tx AGC . ++ // dB_sel = b'000 ' 1.0 dB PA gain loss ++ // dB_sel = b'001 ' 1.5 dB PA gain loss ++ // dB_sel = b'010 ' 2.0 dB PA gain loss ++ // dB_sel = b'011 ' 2.5 dB PA gain loss ++ // dB_sel = b'100 ' 3.0 dB PA gain loss ++ // dB_sel = b'101 ' 3.5 dB PA gain loss ++ // dB_sel = b'110 ' 4.0 dB PA gain loss ++ ODM_Write4Byte(pDM_Odm, 0xc20+pagesel, 0x00006000); ++ ++ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0401e038); ++ ODM_Write4Byte(pDM_Odm, 0xc94+pagesel, 0xf76c9f84); ++ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x000c5599); ++ ODM_Write4Byte(pDM_Odm, 0xcc4+pagesel, 0x148b0000); ++ ODM_Write4Byte(pDM_Odm, 0xc8c+pagesel, 0x3c000000); ++ ++ // tx_amp ' Mw Ramp UiTjp ++ ODM_Write4Byte(pDM_Odm, 0xc98+pagesel, 0x41382e21); ++ ODM_Write4Byte(pDM_Odm, 0xc9c+pagesel, 0x5b554f48); ++ ODM_Write4Byte(pDM_Odm, 0xca0+pagesel, 0x6f6b6661); ++ ODM_Write4Byte(pDM_Odm, 0xca4+pagesel, 0x817d7874); ++ ODM_Write4Byte(pDM_Odm, 0xca8+pagesel, 0x908c8884); ++ ODM_Write4Byte(pDM_Odm, 0xcac+pagesel, 0x9d9a9793); ++ ODM_Write4Byte(pDM_Odm, 0xcb0+pagesel, 0xaaa7a4a1); ++ ODM_Write4Byte(pDM_Odm, 0xcb4+pagesel, 0xb6b3b0ad); ++ ++ // tx_inverse ' Ramp Uipower ˼, HpX PA gain report?? ++ ODM_Write4Byte(pDM_Odm, 0xc40+pagesel, 0x02ce03e9); ++ ODM_Write4Byte(pDM_Odm, 0xc44+pagesel, 0x01fd0249); ++ ODM_Write4Byte(pDM_Odm, 0xc48+pagesel, 0x01a101c9); ++ ODM_Write4Byte(pDM_Odm, 0xc4c+pagesel, 0x016a0181); ++ ODM_Write4Byte(pDM_Odm, 0xc50+pagesel, 0x01430155); ++ ODM_Write4Byte(pDM_Odm, 0xc54+pagesel, 0x01270135); ++ ODM_Write4Byte(pDM_Odm, 0xc58+pagesel, 0x0112011c); ++ ODM_Write4Byte(pDM_Odm, 0xc5c+pagesel, 0x01000108); ++ ODM_Write4Byte(pDM_Odm, 0xc60+pagesel, 0x00f100f8); ++ ODM_Write4Byte(pDM_Odm, 0xc64+pagesel, 0x00e500eb); ++ ODM_Write4Byte(pDM_Odm, 0xc68+pagesel, 0x00db00e0); ++ ODM_Write4Byte(pDM_Odm, 0xc6c+pagesel, 0x00d100d5); ++ ODM_Write4Byte(pDM_Odm, 0xc70+pagesel, 0x00c900cd); ++ ODM_Write4Byte(pDM_Odm, 0xc74+pagesel, 0x00c200c5); ++ ODM_Write4Byte(pDM_Odm, 0xc78+pagesel, 0x00bb00be); ++ ODM_Write4Byte(pDM_Odm, 0xc7c+pagesel, 0x00b500b8); ++ ++ //============// ++ // RF setting for DPK // ++ //============// ++ ++ //pathA,pathB standby mode ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)0x0, 0x0, bRFRegOffsetMask, 0x10000); ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)0x1, 0x0, bRFRegOffsetMask, 0x10000); ++ ++ // 00[4:0] = Tx AGC, 00[9:5] = Rx AGC (BB), 00[12:10] = Rx AGC (LNA) ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)(0x0+path), 0x0, bRFRegOffsetMask, 0x50bff); ++ ++ ++ // 64[14:12] = loop back attenuation ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)(0x0+path), 0x64, bRFRegOffsetMask, 0x19aac); ++ ++ // 8f[14:13] = PGA2 gain ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)(0x0+path), 0x8f, bRFRegOffsetMask, 0x8e001); ++ ++ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x800c5599); ++ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x000c5599); ++ ++ ++ // delay 100 ms ++ ODM_delay_ms(100); ++ ++ ++ // read back ++ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0109f018); ++ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x09000000); ++ // iHb d00[3:0] Ū^, dB_sel ҳ]w gain loss |b@ Tx AGC ]w ++ // Ū^d00[3:0] = h'1 ' Tx AGC = 15 ++ // Ū^d00[3:0] = h'2 ' Tx AGC = 16 ++ // Ū^d00[3:0] = h'3 ' Tx AGC = 17 ++ // Ū^d00[3:0] = h'4 ' Tx AGC = 18 ++ // Ū^d00[3:0] = h'5 ' Tx AGC = 19 ++ // Ū^d00[3:0] = h'6 ' Tx AGC = 1a ++ // Ū^d00[3:0] = h'7 ' Tx AGC = 1b ++ // Ū^d00[3:0] = h'8 ' Tx AGC = 1c ++ // Ū^d00[3:0] = h'9 ' Tx AGC = 1d ++ // Ū^d00[3:0] = h'a ' Tx AGC = 1e ++ // Ū^d00[3:0] = h'b ' Tx AGC = 1f ++ ++ TXindex = ODM_GetBBReg(pDM_Odm, 0xd00+regsel, 0x0000000f); ++ ++ ++ //***************************************// ++ //get LUT ++ //***************************************// ++ ++ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0001e038); ++ ODM_Write4Byte(pDM_Odm, 0xc94+pagesel, 0xf76c9f84); ++ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x400c5599); ++ ODM_Write4Byte(pDM_Odm, 0xcc4+pagesel, 0x11930080); //0xcc4[9:4]= DPk fail threshold ++ ODM_Write4Byte(pDM_Odm, 0xc8c+pagesel, 0x3c000000); ++ ++ ++ // tx_amp ' Mw Ramp UiTjp ++ ++ ODM_Write4Byte(pDM_Odm, 0xc98+pagesel, 0x41382e21); ++ ODM_Write4Byte(pDM_Odm, 0xc9c+pagesel, 0x5b554f48); ++ ODM_Write4Byte(pDM_Odm, 0xca0+pagesel, 0x6f6b6661); ++ ODM_Write4Byte(pDM_Odm, 0xca4+pagesel, 0x817d7874); ++ ODM_Write4Byte(pDM_Odm, 0xca8+pagesel, 0x908c8884); ++ ODM_Write4Byte(pDM_Odm, 0xcac+pagesel, 0x9d9a9793); ++ ODM_Write4Byte(pDM_Odm, 0xcb0+pagesel, 0xaaa7a4a1); ++ ODM_Write4Byte(pDM_Odm, 0xcb4+pagesel, 0xb6b3b0ad); ++ ++ // tx_inverse ' Ramp Uipower ˼, HpX PA gain ++ ODM_Write4Byte(pDM_Odm, 0xc40+pagesel, 0x02ce03e9); ++ ODM_Write4Byte(pDM_Odm, 0xc44+pagesel, 0x01fd0249); ++ ODM_Write4Byte(pDM_Odm, 0xc48+pagesel, 0x01a101c9); ++ ODM_Write4Byte(pDM_Odm, 0xc4c+pagesel, 0x016a0181); ++ ODM_Write4Byte(pDM_Odm, 0xc50+pagesel, 0x01430155); ++ ODM_Write4Byte(pDM_Odm, 0xc54+pagesel, 0x01270135); ++ ODM_Write4Byte(pDM_Odm, 0xc58+pagesel, 0x0112011c); ++ ODM_Write4Byte(pDM_Odm, 0xc5c+pagesel, 0x01000108); ++ ODM_Write4Byte(pDM_Odm, 0xc60+pagesel, 0x00f100f8); ++ ODM_Write4Byte(pDM_Odm, 0xc64+pagesel, 0x00e500eb); ++ ODM_Write4Byte(pDM_Odm, 0xc68+pagesel, 0x00db00e0); ++ ODM_Write4Byte(pDM_Odm, 0xc6c+pagesel, 0x00d100d5); ++ ODM_Write4Byte(pDM_Odm, 0xc70+pagesel, 0x00c900cd); ++ ODM_Write4Byte(pDM_Odm, 0xc74+pagesel, 0x00c200c5); ++ ODM_Write4Byte(pDM_Odm, 0xc78+pagesel, 0x00bb00be); ++ ODM_Write4Byte(pDM_Odm, 0xc7c+pagesel, 0x00b500b8); ++ ++ //fill BB TX index for the DPK reference ++ // reg82c[31] =1b'0, page C ++ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083d5); ++ ++ ODM_Write4Byte(pDM_Odm, 0xc20+pagesel, 0x3c3c3c3c); ++ ODM_Write4Byte(pDM_Odm, 0xc24+pagesel, 0x3c3c3c3c); ++ ODM_Write4Byte(pDM_Odm, 0xc28+pagesel, 0x3c3c3c3c); ++ ODM_Write4Byte(pDM_Odm, 0xc2c+pagesel, 0x3c3c3c3c); ++ ODM_Write4Byte(pDM_Odm, 0xc30+pagesel, 0x3c3c3c3c); ++ ODM_Write4Byte(pDM_Odm, 0xc34+pagesel, 0x3c3c3c3c); ++ ODM_Write4Byte(pDM_Odm, 0xc38+pagesel, 0x3c3c3c3c); ++ ODM_Write4Byte(pDM_Odm, 0xc3c+pagesel, 0x3c3c3c3c); ++ ODM_Write4Byte(pDM_Odm, 0xc40+pagesel, 0x3c3c3c3c); ++ ODM_Write4Byte(pDM_Odm, 0xc44+pagesel, 0x3c3c3c3c); ++ ODM_Write4Byte(pDM_Odm, 0xc48+pagesel, 0x3c3c3c3c); ++ ODM_Write4Byte(pDM_Odm, 0xc4c+pagesel, 0x3c3c3c3c); ++ ++ // reg82c[31] =1b'1, page C1 ++ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083d5); ++ ++ ++ ++ // r_agc_boudary ++ // PA gain = 11 tx_agc q1f 11 boundary = b'11111 ' PageC1 bc0[4:0] = 11111 ++ // PA gain = 10 tx_agc q11 11 ? boundary = b'10011 ' PageC1 bc0[9:5] = 10001 ++ // PA gain = 01 tx_agc q10 0e ? boundary = b'10000 ' PageC1 bc0[14:10] = 10000 ++ // PA gain = 00 tx_agc q0d 00 ? boundary = b'01101 ' PageC1 bc0[19:15] = 01101 ++ ODM_Write4Byte(pDM_Odm, 0xcbc+pagesel, 0x0006c23f); ++ ++ // r_bnd, t~4 PWSF (power scaling factor) boundary, ]ثeub PA gain = 11 ɤ~v, ҥH] h'fffff Yi. ++ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x000fffff); ++ ++ //============// ++ // RF setting for DPK // ++ //============// ++ // 00[4:0] = Tx AGC, 00[9:5] = Rx AGC (BB), 00[12:10] = Rx AGC (LNA) ++ // B reg00[4:0] = h'1d, Oѫe gain loss function o쪺G. ++ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)(0x0+path), 0x0, bRFRegOffsetMask, 0x517e0 | TXindex); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF 0x0 = 0x%x\n", 0x517e0 | TXindex)); ++ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0xc00c5599); ++ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x400c5599); ++ ++ // delay 100 ms ++ ODM_delay_ms(100); ++ ++ // read back dp_fail report ++ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x00000000); ++ ++ //if d00[6] = 1, DPK fail ++ if(ODM_GetBBReg(pDM_Odm, 0xd00+regsel, BIT6)) ++ { ++ //bypass DPK ++ ODM_Write4Byte(pDM_Odm, 0xcc4+pagesel, 0x28848000); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path %s DPK fail!!!!!!!!!!!!!!!!!!!!!\n", (path==0)?"A":"B")); ++ ++ return; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path %s DPK ok!!!!!!!!!!!!!!!!!!!!!\n", (path==0)?"A":"B")); ++ ++ ++ ++ //read LMS table -->debug message only ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("read LMS\n")); ++ ++ for(i=0;i<8;i++){ ++ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0601f0b8+i); ++ for(j=0;j<4;j++){ ++ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x09000000+(j<<24)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0x%x", ODM_Read4Byte(pDM_Odm, 0xd00+regsel))); ++ } ++ } ++ ++ ++ //***************************************// ++ //get gain loss ++ //***************************************// ++ ++ _DPK_GetGainLoss(pDM_Odm,path); ++ ++ ++ //***************************************// ++ //Enable DP ++ //***************************************// ++ ++ _DPK_EnableDP(pDM_Odm, path, TXindex); ++ ++ ++} ++ ++ ++} ++ ++ ++ ++static void ++phy_DPCalibrate_8812A( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte backupRegAddrs[] = { ++ 0x970, 0xcb8, 0x838, 0xc00, 0x90c, 0xb00, 0xc94, 0x82c, 0x520, 0xc60, // 10 ++ 0xc64, 0xc68, 0xc6c, 0xc70, 0xc74, 0xc78, 0xc7c, 0xc80, 0xc84, 0xc50, // 20 ++ 0xc20, 0xc24, 0xc28, 0xc2c, 0xc30, 0xc34, 0xc38, 0xc3c, 0xc40, 0xc44, // 30 ++ 0xc48, 0xc4c, 0xe50, 0xe20, 0xe24, 0xe28, 0xe2c, 0xe30, 0xe34, 0xe38, // 40 ++ 0xe3c, 0xe40, 0xe44, 0xe48, 0xe4c, 0xeb8, 0xe00, 0xe94, 0xe60, 0xe64, //50 ++ 0xe68, 0xe6c, 0xe70, 0xe74, 0xe78, 0xe7c, 0xe80, 0xe84 ++ }; ++ ++ u4Byte backupRegData[sizeof(backupRegAddrs)/sizeof(u4Byte)]; ++ ++ ++ //backup BB&MAC default value ++ ++ _DPK_parabackup(pDM_Odm,backupRegAddrs, backupRegData, sizeof(backupRegAddrs)/sizeof(u4Byte)); ++ ++ //set global parameters ++ _DPK_Globalparaset(pDM_Odm); ++ ++ //DPK ++ _DPK_pathABDPK(pDM_Odm); ++ ++ // TH_DPK=thermalmeter ++ ++ ++ //reload BB&MAC defaul value; ++ _DPK_parareload(pDM_Odm,backupRegAddrs, backupRegData, sizeof(backupRegAddrs)/sizeof(u4Byte)); ++ ++} ++ ++void ++PHY_DPCalibrate_8812A( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> PHY_DPCalibrate_8812A\n")); ++ phy_DPCalibrate_8812A(pDM_Odm); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== PHY_DPCalibrate_8812A\n")); ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8812A.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8812A.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8812A.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8812A.h 2018-02-06 17:42:30.709967150 +0200 +@@ -0,0 +1,90 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++#ifndef __HAL_PHY_RF_8812A_H__ ++#define __HAL_PHY_RF_8812A_H__ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++#define IQK_DELAY_TIME_8812A 10 //ms ++#define IQK_DEFERRED_TIME_8812A 4 //sec ++#define index_mapping_NUM_8812A 15 ++#define AVG_THERMAL_NUM_8812A 4 ++#define RF_T_METER_8812A 0x42 ++ ++ ++void ConfigureTxpowerTrack_8812A( ++ PTXPWRTRACK_CFG pConfig ++ ); ++ ++void ++GetDeltaSwingTable_8812A( ++ PDM_ODM_T pDM_Odm, ++ pu1Byte *TemperatureUP_A, ++ pu1Byte *TemperatureDOWN_A, ++ pu1Byte *TemperatureUP_B, ++ pu1Byte *TemperatureDOWN_B ++ ); ++ ++void DoIQK_8812A( ++ PDM_ODM_T pDM_Odm, ++ u1Byte DeltaThermalIndex, ++ u1Byte ThermalValue, ++ u1Byte Threshold ++ ); ++ ++void ++ODM_TxPwrTrackSetPwr8812A( ++ PDM_ODM_T pDM_Odm, ++ PWRTRACK_METHOD Method, ++ u1Byte RFPath, ++ u1Byte ChannelMappedIndex ++ ); ++ ++//1 7. IQK ++ ++void ++PHY_IQCalibrate_8812A( ++ PADAPTER pAdapter, ++ bool bReCovery ++); ++ ++ ++// ++// LC calibrate ++// ++void ++PHY_LCCalibrate_8812A( ++ PDM_ODM_T pDM_Odm ++); ++ ++// ++// AP calibrate ++// ++void ++PHY_APCalibrate_8812A(PADAPTER pAdapter, s1Byte delta); ++void ++PHY_DigitalPredistortion_8812A(PADAPTER pAdapter); ++ ++void ++PHY_DPCalibrate_8812A( ++ PDM_ODM_T pDM_Odm ++); ++void PHY_SetRFPathSwitch_8812A( ++ PADAPTER pAdapter, ++ bool bMain ++ ); ++ ++ ++#endif // #ifndef __HAL_PHY_RF_8812A_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8821A.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8821A.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8821A.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8821A.c 2018-02-06 17:42:30.709967150 +0200 +@@ -0,0 +1,1347 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++//#include "Mp_Precomp.h" ++#include "odm_precomp.h" ++ ++ ++ ++/*---------------------------Define Local Constant---------------------------*/ ++// 2010/04/25 MH Define the max tx power tracking tx agc power. ++#define ODM_TXPWRTRACK_MAX_IDX8821A 6 ++ ++/*---------------------------Define Local Constant---------------------------*/ ++ ++ ++//3 ============================================================ ++//3 Tx Power Tracking ++//3 ============================================================ ++ ++ ++static void setIqkMatrix_8821A( ++ PDM_ODM_T pDM_Odm, ++ u1Byte OFDM_index, ++ u1Byte RFPath, ++ s4Byte IqkResult_X, ++ s4Byte IqkResult_Y ++ ) ++{ ++ s4Byte ele_A=0, ele_D, ele_C=0, value32; ++ ++ ele_D = (OFDMSwingTable_New[OFDM_index] & 0xFFC00000)>>22; ++ ++ //new element A = element D x X ++ if((IqkResult_X != 0) && (*(pDM_Odm->pBandType) == ODM_BAND_2_4G)) ++ { ++ if ((IqkResult_X & 0x00000200) != 0) //consider minus ++ IqkResult_X = IqkResult_X | 0xFFFFFC00; ++ ele_A = ((IqkResult_X * ele_D)>>8)&0x000003FF; ++ ++ //new element C = element D x Y ++ if ((IqkResult_Y & 0x00000200) != 0) ++ IqkResult_Y = IqkResult_Y | 0xFFFFFC00; ++ ele_C = ((IqkResult_Y * ele_D)>>8)&0x000003FF; ++ ++ if (RFPath == ODM_RF_PATH_A) ++ switch (RFPath) ++ { ++ case ODM_RF_PATH_A: ++ //wirte new elements A, C, D to regC80 and regC94, element B is always 0 ++ value32 = (ele_D<<22)|((ele_C&0x3F)<<16)|ele_A; ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord, value32); ++ ++ value32 = (ele_C&0x000003C0)>>6; ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, bMaskH4Bits, value32); ++ ++ value32 = ((IqkResult_X * ele_D)>>7)&0x01; ++ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT24, value32); ++ break; ++ default: ++ break; ++ } ++ } ++ else ++ { ++ switch (RFPath) ++ { ++ case ODM_RF_PATH_A: ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord, OFDMSwingTable_New[OFDM_index]); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, bMaskH4Bits, 0x00); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT24, 0x00); ++ break; ++ ++ default: ++ break; ++ } ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("TxPwrTracking path B: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x 0xeb4 = 0x%x 0xebc = 0x%x\n", ++ (u4Byte)IqkResult_X, (u4Byte)IqkResult_Y, (u4Byte)ele_A, (u4Byte)ele_C, (u4Byte)ele_D, (u4Byte)IqkResult_X, (u4Byte)IqkResult_Y)); ++} ++ ++void DoIQK_8821A( ++ PDM_ODM_T pDM_Odm, ++ u1Byte DeltaThermalIndex, ++ u1Byte ThermalValue, ++ u1Byte Threshold ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ ODM_ResetIQKResult(pDM_Odm); ++ ++ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; ++ PHY_IQCalibrate_8821A(Adapter, false); ++} ++ ++void ++ODM_TxPwrTrackSetPwr8821A( ++ PDM_ODM_T pDM_Odm, ++ PWRTRACK_METHOD Method, ++ u1Byte RFPath, ++ u1Byte ChannelMappedIndex ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ ++ u1Byte PwrTrackingLimit = 26; //+1.0dB ++ u1Byte TxRate = 0xFF; ++ s1Byte Final_OFDM_Swing_Index = 0; ++ s1Byte Final_CCK_Swing_Index = 0; ++ u1Byte i = 0; ++ u4Byte finalBbSwingIdx[1]; ++ ++ ++#if 0 //gtemp ++#if (MP_DRIVER==1) ++ //PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); ++ PMPT_CONTEXT pMptCtx = &Adapter->mppriv.MptCtx; ++ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); ++#else ++ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); ++ ++ if(!pMgntInfo->ForcedDataRate) //auto rate ++ { ++ if(pDM_Odm->TxRate != 0xFF) ++ TxRate = HwRateToMRate8812(pDM_Odm->TxRate); ++ } ++ else //force rate ++ { ++ TxRate = (u1Byte) pMgntInfo->ForcedDataRate; ++ } ++#endif ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8821A\n")); ++ ++ if(TxRate != 0xFF) ++ { ++ //2 CCK ++ if((TxRate >= MGN_1M)&&(TxRate <= MGN_11M)) ++ PwrTrackingLimit = 32; //+4dB ++ //2 OFDM ++ else if((TxRate >= MGN_6M)&&(TxRate <= MGN_48M)) ++ PwrTrackingLimit = 32; //+4dB ++ else if(TxRate == MGN_54M) ++ PwrTrackingLimit = 30; //+3dB ++ //2 HT ++ else if((TxRate >= MGN_MCS0)&&(TxRate <= MGN_MCS2)) //QPSK/BPSK ++ PwrTrackingLimit = 34; //+5dB ++ else if((TxRate >= MGN_MCS3)&&(TxRate <= MGN_MCS4)) //16QAM ++ PwrTrackingLimit = 32; //+4dB ++ else if((TxRate >= MGN_MCS5)&&(TxRate <= MGN_MCS7)) //64QAM ++ PwrTrackingLimit = 30; //+3dB ++ //2 VHT ++ else if((TxRate >= MGN_VHT1SS_MCS0)&&(TxRate <= MGN_VHT1SS_MCS2)) //QPSK/BPSK ++ PwrTrackingLimit = 34; //+5dB ++ else if((TxRate >= MGN_VHT1SS_MCS3)&&(TxRate <= MGN_VHT1SS_MCS4)) //16QAM ++ PwrTrackingLimit = 32; //+4dB ++ else if((TxRate >= MGN_VHT1SS_MCS5)&&(TxRate <= MGN_VHT1SS_MCS6)) //64QAM ++ PwrTrackingLimit = 30; //+3dB ++ else if(TxRate == MGN_VHT1SS_MCS7) //64QAM ++ PwrTrackingLimit = 28; //+2dB ++ else if(TxRate == MGN_VHT1SS_MCS8) //256QAM ++ PwrTrackingLimit = 26; //+1dB ++ else if(TxRate == MGN_VHT1SS_MCS9) //256QAM ++ PwrTrackingLimit = 24; //+0dB ++ else ++ PwrTrackingLimit = 24; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("TxRate=0x%x, PwrTrackingLimit=%d\n", TxRate, PwrTrackingLimit)); ++ ++ if (Method == BBSWING) ++ { ++ if (RFPath == ODM_RF_PATH_A) ++ { ++ finalBbSwingIdx[ODM_RF_PATH_A] = (pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A] > PwrTrackingLimit) ? PwrTrackingLimit : pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A]; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A]=%d, pDM_Odm->RealBbSwingIdx[ODM_RF_PATH_A]=%d\n", ++ pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A], finalBbSwingIdx[ODM_RF_PATH_A])); ++ ++ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_A]]); ++ } ++ } ++ else if (Method == MIX_MODE) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pDM_Odm->DefaultOfdmIndex=%d, pDM_Odm->Aboslute_OFDMSwingIdx[RFPath]=%d, RF_Path = %d\n", ++ pDM_Odm->DefaultOfdmIndex, pDM_Odm->Aboslute_OFDMSwingIdx[RFPath],RFPath )); ++ ++ ++ Final_OFDM_Swing_Index = pDM_Odm->DefaultOfdmIndex + pDM_Odm->Aboslute_OFDMSwingIdx[RFPath]; ++ ++ if (RFPath == ODM_RF_PATH_A) ++ { ++ if(Final_OFDM_Swing_Index > PwrTrackingLimit) //BBSwing higher then Limit ++ { ++ pDM_Odm->Remnant_CCKSwingIdx= Final_OFDM_Swing_Index - PwrTrackingLimit; // CCK Follow the same compensate value as Path A ++ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit; ++ ++ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[PwrTrackingLimit]); ++ ++ pDM_Odm->Modify_TxAGC_Flag_PathA= true; ++ ++ //Set TxAGC Page C{}; ++ //Adapter->HalFunc.SetTxPowerLevelHandler(Adapter, pHalData->CurrentChannel); ++ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit, pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); ++ } ++ else if (Final_OFDM_Swing_Index < 0) ++ { ++ pDM_Odm->Remnant_CCKSwingIdx= Final_OFDM_Swing_Index; // CCK Follow the same compensate value as Path A ++ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index; ++ ++ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[0]); ++ ++ pDM_Odm->Modify_TxAGC_Flag_PathA= true; ++ ++ //Set TxAGC Page C{}; ++ //Adapter->HalFunc.SetTxPowerLevelHandler(Adapter, pHalData->CurrentChannel); ++ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); ++ } ++ else ++ { ++ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[Final_OFDM_Swing_Index]); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); ++ ++ if(pDM_Odm->Modify_TxAGC_Flag_PathA) //If TxAGC has changed, reset TxAGC again ++ { ++ pDM_Odm->Remnant_CCKSwingIdx= 0; ++ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = 0; ++ ++ //Set TxAGC Page C{}; ++ //Adapter->HalFunc.SetTxPowerLevelHandler(Adapter, pHalData->CurrentChannel); ++ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); ++ ++ pDM_Odm->Modify_TxAGC_Flag_PathA= false; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A pDM_Odm->Modify_TxAGC_Flag = false \n")); ++ } ++ } ++ } ++ ++ } ++ else ++ { ++ return; ++ } ++} // odm_TxPwrTrackSetPwr88E ++ ++void ++GetDeltaSwingTable_8821A( ++ PDM_ODM_T pDM_Odm, ++ pu1Byte *TemperatureUP_A, ++ pu1Byte *TemperatureDOWN_A, ++ pu1Byte *TemperatureUP_B, ++ pu1Byte *TemperatureDOWN_B ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ //u2Byte rate = pMgntInfo->ForcedDataRate; ++ u2Byte rate = 0; ++ u1Byte channel = pHalData->CurrentChannel; ++ ++ ++ if ( 1 <= channel && channel <= 14) { ++ if (IS_CCK_RATE(rate)) { ++ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P; ++ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N; ++ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P; ++ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N; ++ } else { ++ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P; ++ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N; ++ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P; ++ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N; ++ } ++ } else if ( 36 <= channel && channel <= 64) { ++ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0]; ++ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0]; ++ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0]; ++ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0]; ++ } else if ( 100 <= channel && channel <= 140) { ++ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1]; ++ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1]; ++ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1]; ++ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1]; ++ } else if ( 149 <= channel && channel <= 173) { ++ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2]; ++ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2]; ++ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2]; ++ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2]; ++ } else { ++ *TemperatureUP_A = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; ++ *TemperatureDOWN_A = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; ++ *TemperatureUP_B = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; ++ *TemperatureDOWN_B = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; ++ } ++ ++ return; ++} ++ ++void ConfigureTxpowerTrack_8821A( ++ PTXPWRTRACK_CFG pConfig ++ ) ++{ ++ pConfig->SwingTableSize_CCK = TXSCALE_TABLE_SIZE; ++ pConfig->SwingTableSize_OFDM = TXSCALE_TABLE_SIZE; ++ pConfig->Threshold_IQK = IQK_THRESHOLD; ++ pConfig->AverageThermalNum = AVG_THERMAL_NUM_8812A; ++ pConfig->RfPathCount = MAX_PATH_NUM_8821A; ++ pConfig->ThermalRegAddr = RF_T_METER_8812A; ++ ++ pConfig->ODM_TxPwrTrackSetPwr = ODM_TxPwrTrackSetPwr8821A; ++ pConfig->DoIQK = DoIQK_8821A; ++ pConfig->PHY_LCCalibrate = PHY_LCCalibrate_8821A; ++ pConfig->GetDeltaSwingTable = GetDeltaSwingTable_8821A; ++} ++ ++//1 7. IQK ++#define MAX_TOLERANCE 5 ++#define IQK_DELAY_TIME 1 //ms ++ ++static void _IQK_RX_FillIQC_8821A( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_RADIO_PATH_E Path, ++ unsigned int RX_X, ++ unsigned int RX_Y ++ ) ++{ ++ switch (Path) { ++ case ODM_RF_PATH_A: ++ { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, RX_X>>1); ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, RX_Y>>1); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1, RX_Y>>1)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc10 = %x ====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xc10))); ++ } ++ break; ++ default: ++ break; ++ }; ++} ++ ++static void _IQK_TX_FillIQC_8821A( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_RADIO_PATH_E Path, ++ unsigned int TX_X, ++ unsigned int TX_Y ++ ) ++{ ++ switch (Path) { ++ case ODM_RF_PATH_A: ++ { ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_Write4Byte(pDM_Odm, 0xc90, 0x00000080); ++ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x20040000); ++ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); ++ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, TX_Y); ++ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, TX_X); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X, TX_Y)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xcd4 = %x;;0xccc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xcd4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xccc, 0x000007ff))); ++ } ++ break; ++ default: ++ break; ++ }; ++} ++ ++static void _IQK_BackupMacBB_8821A( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte MACBB_backup, ++ pu4Byte Backup_MACBB_REG, ++ u4Byte MACBB_NUM ++ ) ++{ ++ u4Byte i; ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ //save MACBB default value ++ for (i = 0; i < MACBB_NUM; i++){ ++ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupMacBB Success!!!!\n")); ++} ++ ++static void _IQK_BackupRF_8821A( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte RFA_backup, ++ pu4Byte RFB_backup, ++ pu4Byte Backup_RF_REG, ++ u4Byte RF_NUM ++ ) ++{ ++ ++ u4Byte i; ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ //Save RF Parameters ++ for (i = 0; i < RF_NUM; i++){ ++ RFA_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG[i], bMaskDWord); ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupRF Success!!!!\n")); ++} ++ ++static void _IQK_BackupAFE_8821A( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte AFE_backup, ++ pu4Byte Backup_AFE_REG, ++ u4Byte AFE_NUM ++ ) ++{ ++ u4Byte i; ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ //Save AFE Parameters ++ for (i = 0; i < AFE_NUM; i++){ ++ AFE_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_AFE_REG[i]); ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupAFE Success!!!!\n")); ++} ++ ++static void _IQK_RestoreMacBB_8821A( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte MACBB_backup, ++ pu4Byte Backup_MACBB_REG, ++ u4Byte MACBB_NUM ++ ) ++{ ++ u4Byte i; ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ //Reload MacBB Parameters ++ for (i = 0; i < MACBB_NUM; i++){ ++ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreMacBB Success!!!!\n")); ++} ++ ++static void _IQK_RestoreRF_8821A( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_RADIO_PATH_E Path, ++ pu4Byte Backup_RF_REG, ++ pu4Byte RF_backup, ++ u4Byte RF_REG_NUM ++ ) ++{ ++ u4Byte i; ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ for (i = 0; i < RF_REG_NUM; i++) ++ ODM_SetRFReg(pDM_Odm, Path, Backup_RF_REG[i], bRFRegOffsetMask, RF_backup[i]); ++ ++ switch(Path){ ++ case ODM_RF_PATH_A: ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path A Success!!!!\n")); ++ } ++ break; ++ default: ++ break; ++ } ++} ++ ++static void _IQK_RestoreAFE_8821A( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte AFE_backup, ++ pu4Byte Backup_AFE_REG, ++ u4Byte AFE_NUM ++ ) ++{ ++ u4Byte i; ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ //Reload AFE Parameters ++ for (i = 0; i < AFE_NUM; i++){ ++ ODM_Write4Byte(pDM_Odm, Backup_AFE_REG[i], AFE_backup[i]); ++ } ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x0); ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x0); ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x0); ++ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreAFE Success!!!!\n")); ++} ++ ++static void _IQK_ConfigureMAC_8821A( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ // ========MAC register setting======== ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_Write1Byte(pDM_Odm, 0x522, 0x3f); ++ ODM_SetBBReg(pDM_Odm, 0x550, BIT(3), 0x0); ++ ODM_SetBBReg(pDM_Odm, 0x551, BIT(3), 0x0); ++ ODM_SetBBReg(pDM_Odm, 0x808, BIT(28), 0x0); // CCK Off ++ ODM_Write1Byte(pDM_Odm, 0x808, 0x00); // RX ante off ++ ODM_SetBBReg(pDM_Odm, 0x838, 0xf, 0xc); // CCA off ++} ++ ++#define cal_num 3 ++ ++static void _IQK_Tx_8821A( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_RADIO_PATH_E Path ++ ) ++{ ++ u4Byte TX_fail, RX_fail, delay_count, IQK_ready, cal_retry, cal = 0, temp_reg65; ++ int TX_X = 0, TX_Y = 0, RX_X = 0, RX_Y = 0, TX_Average = 0, RX_Average = 0; ++ int TX_X0[cal_num], TX_Y0[cal_num], TX_X0_RXK[cal_num], TX_Y0_RXK[cal_num], RX_X0[cal_num], RX_Y0[cal_num]; ++ bool TX0IQKOK = false, RX0IQKOK = false; ++ bool VDF_enable = false; ++ int i, k, VDF_Y[3], VDF_X[3], Tx_dt[3], Rx_dt[3], ii, dx = 0, dy = 0, TX_finish = 0, RX_finish = 0; ++ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BandWidth = %d\n", *pDM_Odm->pBandWidth)); ++ if (*pDM_Odm->pBandWidth == 2){ ++ VDF_enable = true; ++ } ++ ++ while (cal < cal_num){ ++ switch (Path) { ++ case ODM_RF_PATH_A: ++ { ++ temp_reg65 = ODM_GetRFReg(pDM_Odm, Path, 0x65, bMaskDWord); ++ ++ if (pDM_Odm->ExtPA){ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); ++ } ++ ++ //Path-A LOK ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ // ========Path-A AFE all on======== ++ // Port 0 DAC/ADC on ++ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); ++ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); ++ ++ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc6c, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc70, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc74, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc78, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc7c, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x19791979); ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x19791979); ++ ++ ODM_SetBBReg(pDM_Odm, 0xc00, 0xf, 0x4);// hardware 3-wire off ++ ++ // LOK Setting ++ //====== LOK ====== ++ // 1. DAC/ADC sampling rate (160 MHz) ++ ODM_SetBBReg(pDM_Odm, 0xc5c, BIT(26)|BIT(25)|BIT(24), 0x7); ++ ++ // 2. LoK RF Setting (at BW = 20M) ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80002); ++ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x3); // BW 20M ++ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0003f); ++ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xf3fc3); ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); ++ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); ++ ODM_SetBBReg(pDM_Odm, 0xcb8, 0xf, 0xd); ++ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); ++ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); ++ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); ++ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) ++ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ++ if (pDM_Odm->ExtPA) ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); ++ else ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f4); ++ ++ if (*pDM_Odm->pBandType) ++ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); ++ else ++ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28163e96); ++ ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 10ms ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetRFReg(pDM_Odm, Path, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, Path, 0x8, 0xffc00)); // Load LOK ++ switch (*pDM_Odm->pBandWidth) ++ { ++ case 1: ++ { ++ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x1); ++ } ++ break; ++ case 2: ++ { ++ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x0); ++ } ++ break; ++ default: ++ break; ++ ++ } ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ++ // 3. TX RF Setting ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0003f); ++ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xf3fc3); ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); ++ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); ++ ODM_SetBBReg(pDM_Odm, 0xcb8, 0xf, 0xd); ++ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); ++ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); ++ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); ++ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) ++ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910);// [0]:AGC_en, [15]:idac_K_Mask ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ++ if (pDM_Odm->ExtPA) ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); ++ else ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f1); ++ ++ if (*pDM_Odm->pBandType) ++ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x40163e96); ++ else ++ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x00163e96); ++ ++ if (VDF_enable == 1){ ++ DbgPrint("VDF_enable\n"); ++ for (k = 0;k <= 2; k++){ ++ switch (k){ ++ case 0: ++ { ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c38);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); ++ } ++ break; ++ case 1: ++ { ++ ODM_SetBBReg(pDM_Odm, 0xc80, BIT(28), 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xc84, BIT(28), 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); ++ } ++ break; ++ case 2: ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); ++ Tx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); ++ Tx_dt[cal] = ((16*Tx_dt[cal])*10000/15708); ++ Tx_dt[cal] = (Tx_dt[cal] >> 1 )+(Tx_dt[cal] & BIT(0)); ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c20);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xce8, 0x3fff0000, Tx_dt[cal] & 0x00003fff); ++ } ++ break; ++ default: ++ break; ++ } ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 10ms ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); ++ if ((~IQK_ready) || (delay_count>20)){ ++ break; ++ } ++ else{ ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============TXIQK Check============== ++ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); ++ ++ if (~TX_fail){ ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); ++ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); ++ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ TX0IQKOK = true; ++ break; ++ } ++ else{ ++ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); ++ TX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) { ++ break; ++ } ++ } ++ } ++ else{ ++ TX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10){ ++ break; ++ } ++ } ++ } ++ } ++ if (k == 3){ ++ TX_X0[cal] = VDF_X[k-1] ; ++ TX_Y0[cal] = VDF_Y[k-1]; ++ } ++ } ++ else{ ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 10ms ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); ++ if ((~IQK_ready) || (delay_count>20)) { ++ break; ++ } ++ else{ ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============TXIQK Check============== ++ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); ++ ++ if (~TX_fail){ ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); ++ TX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); ++ TX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ TX0IQKOK = true; ++ break; ++ } ++ else{ ++ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); ++ TX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) { ++ break; ++ } ++ } ++ } ++ else{ ++ TX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ } ++ } ++ } ++ ++ ++ if (TX0IQKOK == false) ++ break; // TXK fail, Don't do RXK ++ ++ if (VDF_enable == 1){ ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); // TX VDF Disable ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXVDF Start\n")); ++ for (k = 0;k <= 2; k++){ ++ //====== RX mode TXK (RXK Step 1) ====== ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ // 1. TX RF Setting ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x00029); ++ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xd7ffb); ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, temp_reg65); ++ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); ++ ++ ODM_SetBBReg(pDM_Odm, 0xcb8, 0xf, 0xd); ++ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) ++ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910);// [0]:AGC_en, [15]:idac_K_Mask ++ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); ++ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ switch (k){ ++ case 0: ++ { ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c38);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(30), 0x0); ++ } ++ break; ++ case 1: ++ { ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x08008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x28008c38);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(30), 0x0); ++ } ++ break; ++ case 2: ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); ++ Rx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Rx_dt = %d\n", Rx_dt[cal])); ++ Rx_dt[cal] = ((16*Rx_dt[cal])*10000/13823); ++ Rx_dt[cal] = (Rx_dt[cal] >> 1 )+(Rx_dt[cal] & BIT(0)); ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c20);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_SetBBReg(pDM_Odm, 0xce8, 0x00003fff, Rx_dt[cal] & 0x00003fff); ++ } ++ break; ++ default: ++ break; ++ } ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821603e0); ++ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 10ms ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); ++ if ((~IQK_ready)||(delay_count>20)){ ++ break; ++ } ++ else{ ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============TXIQK Check============== ++ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); ++ ++ if (~TX_fail){ ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); ++ TX_X0_RXK[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); ++ TX_Y0_RXK[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ TX0IQKOK = true; ++ break; ++ } ++ else{ ++ TX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ } ++ } ++ else{ ++ TX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ } ++ } ++ ++ if (TX0IQKOK == false){ //If RX mode TXK fail, then take TXK Result ++ TX_X0_RXK[cal] = TX_X0[cal]; ++ TX_Y0_RXK[cal] = TX_Y0[cal]; ++ TX0IQKOK = true; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXK Step 1 fail\n")); ++ } ++ ++ ++ //====== RX IQK ====== ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ // 1. RX RF Setting ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0002f); ++ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfffbb); ++ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d8); ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); ++ ++ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X0_RXK[cal])>>21&0x000007ff); ++ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y0_RXK[cal])>>21&0x000007ff); ++ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xcb8, 0xF, 0xe); ++ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_SetBBReg(pDM_Odm, 0xc80, BIT(29), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0xc84, BIT(29), 0x0); ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); ++ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161420); ++ ++ if (k==2){ ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(30), 0x1); //RX VDF Enable ++ } ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 10ms ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); ++ if ((~IQK_ready)||(delay_count>20)){ ++ break; ++ } ++ else{ ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============RXIQK Check============== ++ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); ++ if (RX_fail == 0){ ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); ++ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); ++ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ RX0IQKOK = true; ++ break; ++ } ++ else{ ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); ++ RX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ ++ } ++ } ++ else{ ++ RX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ } ++ } ++ ++ } ++ if (k == 3){ ++ RX_X0[cal] = VDF_X[k-1] ; ++ RX_Y0[cal] = VDF_Y[k-1]; ++ } ++ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x1); // TX VDF Enable ++ } ++ else{ ++ //====== RX mode TXK (RXK Step 1) ====== ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ // 1. TX RF Setting ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x00029); ++ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xd7ffb); ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, temp_reg65); ++ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); ++ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); ++ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910);// [0]:AGC_en, [15]:idac_K_Mask ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821603e0); ++ //ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 10ms ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); ++ if ((~IQK_ready)||(delay_count>20)){ ++ break; ++ } ++ else{ ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============TXIQK Check============== ++ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); ++ ++ if (~TX_fail){ ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); ++ TX_X0_RXK[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); ++ TX_Y0_RXK[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ TX0IQKOK = true; ++ break; ++ } ++ else{ ++ TX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ } ++ } ++ else{ ++ TX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ } ++ } ++ ++ ++ if (TX0IQKOK == false){ //If RX mode TXK fail, then take TXK Result ++ TX_X0_RXK[cal] = TX_X0[cal]; ++ TX_Y0_RXK[cal] = TX_Y0[cal]; ++ TX0IQKOK = true; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("1")); ++ } ++ ++ ++ //====== RX IQK ====== ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ // 1. RX RF Setting ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); ++ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0002f); ++ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfffbb); ++ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d8); ++ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); ++ ++ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X0_RXK[cal])>>21&0x000007ff); ++ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y0_RXK[cal])>>21&0x000007ff); ++ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); ++ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); ++ ODM_SetBBReg(pDM_Odm, 0xcb8, 0xF, 0xe); ++ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); ++ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); ++ ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 ++ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 ++ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] ++ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); ++ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161440); ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module ++ ++ cal_retry = 0; ++ while(1){ ++ // one shot ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); ++ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); ++ ++ ODM_delay_ms(10); //Delay 10ms ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); ++ delay_count = 0; ++ while (1){ ++ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); ++ if ((~IQK_ready)||(delay_count>20)){ ++ break; ++ } ++ else{ ++ ODM_delay_ms(1); ++ delay_count++; ++ } ++ } ++ ++ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ ++ // ============RXIQK Check============== ++ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); ++ if (RX_fail == 0){ ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); ++ RX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); ++ RX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; ++ RX0IQKOK = true; ++ break; ++ } ++ else{ ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); ++ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); ++ RX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ ++ } ++ } ++ else{ ++ RX0IQKOK = false; ++ cal_retry++; ++ if (cal_retry == 10) ++ break; ++ } ++ } ++ } ++ if (TX0IQKOK) ++ TX_Average++; ++ if (RX0IQKOK) ++ RX_Average++; ++ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C ++ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, temp_reg65); ++ } ++ break; ++ default: ++ break; ++ } ++ cal++; ++ } ++ // FillIQK Result ++ switch (Path){ ++ case ODM_RF_PATH_A: ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_A =======\n")); ++ if (TX_Average == 0) ++ break; ++ ++ for (i = 0; i < TX_Average; i++){ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, (" TX_X0_RXK[%d] = %x ;; TX_Y0_RXK[%d] = %x\n", i, (TX_X0_RXK[i])>>21&0x000007ff, i, (TX_Y0_RXK[i])>>21&0x000007ff)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X0[%d] = %x ;; TX_Y0[%d] = %x\n", i, (TX_X0[i])>>21&0x000007ff, i, (TX_Y0[i])>>21&0x000007ff)); ++ } ++ for (i = 0; i < TX_Average; i++){ ++ for (ii = i+1; ii >21) - (TX_X0[ii]>>21); ++ if (dx < 3 && dx > -3){ ++ dy = (TX_Y0[i]>>21) - (TX_Y0[ii]>>21); ++ if (dy < 3 && dy > -3){ ++ TX_X = ((TX_X0[i]>>21) + (TX_X0[ii]>>21))/2; ++ TX_Y = ((TX_Y0[i]>>21) + (TX_Y0[ii]>>21))/2; ++ TX_finish = 1; ++ break; ++ } ++ } ++ } ++ if (TX_finish == 1) ++ break; ++ } ++ ++ if (TX_finish == 1){ ++ _IQK_TX_FillIQC_8821A(pDM_Odm, Path, TX_X, TX_Y); ++ } ++ else{ ++ _IQK_TX_FillIQC_8821A(pDM_Odm, Path, 0x200, 0x0); ++ } ++ ++ if (RX_Average == 0) ++ break; ++ ++ for (i = 0; i < RX_Average; i++){ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[%d] = %x ;; RX_Y0[%d] = %x\n", i, (RX_X0[i])>>21&0x000007ff, i, (RX_Y0[i])>>21&0x000007ff)); ++ } ++ for (i = 0; i < RX_Average; i++){ ++ for (ii = i+1; ii >21) - (RX_X0[ii]>>21); ++ if (dx < 3 && dx > -3){ ++ dy = (RX_Y0[i]>>21) - (RX_Y0[ii]>>21); ++ if (dy < 3 && dy > -3){ ++ RX_X = ((RX_X0[i]>>21) + (RX_X0[ii]>>21))/2; ++ RX_Y = ((RX_Y0[i]>>21) + (RX_Y0[ii]>>21))/2; ++ RX_finish = 1; ++ break; ++ } ++ } ++ } ++ if (RX_finish == 1) ++ break; ++ } ++ ++ if (RX_finish == 1){ ++ _IQK_RX_FillIQC_8821A(pDM_Odm, Path, RX_X, RX_Y); ++ } ++ else{ ++ _IQK_RX_FillIQC_8821A(pDM_Odm, Path, 0x200, 0x0); ++ } ++ } ++ break; ++ default: ++ break; ++ } ++} ++ ++#define MACBB_REG_NUM 11 ++#define AFE_REG_NUM 12 ++#define RF_REG_NUM 3 ++ ++static void phy_IQCalibrate_By_FW_8821A( ++ PADAPTER pAdapter ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u1Byte IQKcmd[3] = {pHalData->CurrentChannel, 0x0, 0x0}; ++ u1Byte Buf1 = 0x0; ++ u1Byte Buf2 = 0x0; ++ ++//Byte 2, Bit 4 ~ Bit 5 : BandType ++ if(pHalData->CurrentBandType) ++ Buf1 = 0x2<<4; ++ else ++ Buf1 = 0x1<<4; ++ ++//Byte 2, Bit 0 ~ Bit 3 : Bandwidth ++ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) ++ Buf2 = 0x1; ++ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) ++ Buf2 = 0x1<<1; ++ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) ++ Buf2 = 0x1<<2; ++ else ++ Buf2 = 0x1<<3; ++ ++ IQKcmd[1] = Buf1 | Buf2; ++ IQKcmd[2] = pHalData->ExternalPA_5G | pHalData->ExternalLNA_5G<<1; ++ ++ ++ //RT_TRACE(COMP_MP, DBG_LOUD, ("== IQK Start ==\n")); ++ ++ //FillH2CCmd_8812(pAdapter, 0x45, 3, IQKcmd); ++ ++} ++ ++static void phy_IQCalibrate_8821A( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte MACBB_backup[MACBB_REG_NUM], AFE_backup[AFE_REG_NUM], RFA_backup[RF_REG_NUM], RFB_backup[RF_REG_NUM]; ++ u4Byte Backup_MACBB_REG[MACBB_REG_NUM] = {0xb00, 0x520, 0x550, 0x808, 0x90c, 0xc00, 0xc50, 0xe00, 0xe50, 0x838, 0x82c}; ++ u4Byte Backup_AFE_REG[AFE_REG_NUM] = {0xc5c, 0xc60, 0xc64, 0xc68, 0xc6c, 0xc70, 0xc74, 0xc78, 0xc7c, 0xc80, 0xc84, 0xcb8}; ++ u4Byte Backup_RF_REG[RF_REG_NUM] = {0x65, 0x8f, 0x0}; ++ ++ _IQK_BackupMacBB_8821A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); ++ _IQK_BackupAFE_8821A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); ++ _IQK_BackupRF_8821A(pDM_Odm, RFA_backup, RFB_backup, Backup_RF_REG, RF_REG_NUM); ++ ++ _IQK_ConfigureMAC_8821A(pDM_Odm); ++ _IQK_Tx_8821A(pDM_Odm, ODM_RF_PATH_A); ++ _IQK_RestoreRF_8821A(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG, RFA_backup, RF_REG_NUM); ++ ++ _IQK_RestoreAFE_8821A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); ++ _IQK_RestoreMacBB_8821A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); ++ ++ //_IQK_Exit_8821A(pDM_Odm); ++ //_IQK_TX_CheckResult_8821A ++ ++} ++ ++ ++ ++ ++#define DP_BB_REG_NUM 7 ++#define DP_RF_REG_NUM 1 ++#define DP_RETRY_LIMIT 10 ++#define DP_PATH_NUM 2 ++#define DP_DPK_NUM 3 ++#define DP_DPK_VALUE_NUM 2 ++ ++ ++ ++ ++ ++void ++PHY_IQCalibrate_8821A( ++ PADAPTER pAdapter, ++ bool bReCovery ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ ++#if (MP_DRIVER == 1) ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++#endif//(MP_DRIVER == 1) ++ ++#if MP_DRIVER == 1 ++ if( ! (pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) ) ++#endif ++ { ++ phy_IQCalibrate_8821A(pDM_Odm); ++ } ++} ++ ++ ++void ++PHY_LCCalibrate_8821A( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PHY_LCCalibrate_8812A(pDM_Odm); ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8821A.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8821A.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8821A.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8821A.h 2018-02-06 17:42:30.709967150 +0200 +@@ -0,0 +1,73 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++#ifndef __HAL_PHY_RF_8821A_H__ ++#define __HAL_PHY_RF_8821A_H__ ++ ++/*--------------------------Define Parameters-------------------------------*/ ++#define IQK_DELAY_TIME_8821A 10 //ms ++#define index_mapping_NUM_8821A 15 ++#define AVG_THERMAL_NUM_8821A 4 ++#define RF_T_METER_8821A 0x42 ++ ++ ++void ConfigureTxpowerTrack_8821A( ++ PTXPWRTRACK_CFG pConfig ++ ); ++ ++void DoIQK_8821A( ++ PDM_ODM_T pDM_Odm, ++ u1Byte DeltaThermalIndex, ++ u1Byte ThermalValue, ++ u1Byte Threshold ++ ); ++ ++void ++ODM_TxPwrTrackSetPwr8821A( ++ PDM_ODM_T pDM_Odm, ++ PWRTRACK_METHOD Method, ++ u1Byte RFPath, ++ u1Byte ChannelMappedIndex ++ ); ++ ++//1 7. IQK ++ ++void ++PHY_IQCalibrate_8821A( ++ PADAPTER pAdapter, ++ bool bReCovery ++); ++ ++void ++PHY_LCCalibrate_8821A( ++ PDM_ODM_T pDM_Odm ++); ++ ++void ++GetDeltaSwingTable_8821A( ++ PDM_ODM_T pDM_Odm, ++ pu1Byte *TemperatureUP_A, ++ pu1Byte *TemperatureDOWN_A, ++ pu1Byte *TemperatureUP_B, ++ pu1Byte *TemperatureDOWN_B ++); ++ ++void PHY_SetRFPathSwitch_8821A( ++ PADAPTER pAdapter, ++ bool bMain ++ ); ++ ++ ++#endif // #ifndef __HAL_PHY_RF_8821A_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf.c 2018-02-06 17:42:30.708967135 +0200 +@@ -0,0 +1,467 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++ #include "odm_precomp.h" ++ ++ ++ ++#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ ++ do {\ ++ for(_offset = 0; _offset < _size; _offset++)\ ++ {\ ++ if(_deltaThermal < thermalThreshold[_direction][_offset])\ ++ {\ ++ if(_offset != 0)\ ++ _offset--;\ ++ break;\ ++ }\ ++ } \ ++ if(_offset >= _size)\ ++ _offset = _size-1;\ ++ } while(0) ++ ++ ++void ConfigureTxpowerTrack( ++ PDM_ODM_T pDM_Odm, ++ PTXPWRTRACK_CFG pConfig ++ ) ++{ ++ if(pDM_Odm->SupportICType==ODM_RTL8821) ++ ConfigureTxpowerTrack_8821A(pConfig); ++ if(pDM_Odm->SupportICType==ODM_RTL8812) ++ ConfigureTxpowerTrack_8812A(pConfig); ++} ++ ++//====================================================================== ++// <20121113, Kordan> This function should be called when TxAGC changed. ++// Otherwise the previous compensation is gone, because we record the ++// delta of temperature between two TxPowerTracking watch dogs. ++// ++// NOTE: If Tx BB swing or Tx scaling is varified during run-time, still ++// need to call this function. ++//====================================================================== ++void ++ODM_ClearTxPowerTrackingState( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDM_Odm->Adapter); ++ u1Byte p = 0; ++ ++ pDM_Odm->BbSwingIdxCckBase = pDM_Odm->DefaultCckIndex; ++ pDM_Odm->BbSwingIdxCck = pDM_Odm->DefaultCckIndex; ++ pDM_Odm->RFCalibrateInfo.CCK_index = 0; ++ ++ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) ++ { ++ pDM_Odm->BbSwingIdxOfdmBase[p] = pDM_Odm->DefaultOfdmIndex; ++ pDM_Odm->BbSwingIdxOfdm[p] = pDM_Odm->DefaultOfdmIndex; ++ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pDM_Odm->DefaultOfdmIndex; ++ ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = 0; ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] = 0; ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; ++ ++ pDM_Odm->Aboslute_OFDMSwingIdx[p] = 0; // Initial Mix mode power tracking ++ pDM_Odm->Remnant_OFDMSwingIdx[p] = 0; ++ } ++ ++ pDM_Odm->Modify_TxAGC_Flag_PathA= false; //Initial at Modify Tx Scaling Mode ++ pDM_Odm->Modify_TxAGC_Flag_PathB= false; //Initial at Modify Tx Scaling Mode ++ pDM_Odm->Remnant_CCKSwingIdx= 0; ++ pDM_Odm->RFCalibrateInfo.ThermalValue = pHalData->EEPROMThermalMeter; ++ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = pHalData->EEPROMThermalMeter; ++ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = pHalData->EEPROMThermalMeter; ++} ++ ++void ++ODM_TXPowerTrackingCallback_ThermalMeter( ++ PADAPTER Adapter ++ ) ++{ ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ ++ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; ++ u1Byte ThermalValue_AVG_count = 0; ++ u4Byte ThermalValue_AVG = 0; ++ ++ u1Byte OFDM_min_index = 0; // OFDM BB Swing should be less than +3.0dB, which is required by Arthur ++ u1Byte Indexforchannel = 0; // GetRightChnlPlaceforIQK(pHalData->CurrentChannel) ++ ++ TXPWRTRACK_CFG c; ++ ++ ++ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. ++ pu1Byte deltaSwingTableIdx_TUP_A; ++ pu1Byte deltaSwingTableIdx_TDOWN_A; ++ pu1Byte deltaSwingTableIdx_TUP_B; ++ pu1Byte deltaSwingTableIdx_TDOWN_B; ++ ++ //4 2. Initilization ( 7 steps in total ) ++ ++ ConfigureTxpowerTrack(pDM_Odm, &c); ++ ++ (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte*)&deltaSwingTableIdx_TUP_A, (pu1Byte*)&deltaSwingTableIdx_TDOWN_A, ++ (pu1Byte*)&deltaSwingTableIdx_TUP_B, (pu1Byte*)&deltaSwingTableIdx_TDOWN_B); ++ ++ pDM_Odm->RFCalibrateInfo.TXPowerTrackingCallbackCnt++; //cosa add for debug ++ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = true; ++ ++#if (MP_DRIVER == 1) ++ if ( *(pDM_Odm->mp_mode) == 1) ++ // RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. ++ pDM_Odm->RFCalibrateInfo.RegA24 = 0x090e1317; ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("===>ODM_TXPowerTrackingCallback_ThermalMeter, \ ++ \n pDM_Odm->BbSwingIdxCckBase: %d, pDM_Odm->BbSwingIdxOfdmBase[A]: %d, pDM_Odm->DefaultOfdmIndex: %d\n", ++ pDM_Odm->BbSwingIdxCckBase, pDM_Odm->BbSwingIdxOfdmBase[ODM_RF_PATH_A], pDM_Odm->DefaultOfdmIndex)); ++ ++ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E ++ if( ! pDM_Odm->RFCalibrateInfo.TxPowerTrackControl || pHalData->EEPROMThermalMeter == 0 || ++ pHalData->EEPROMThermalMeter == 0xFF) ++ return; ++ ++ ++ //4 3. Initialize ThermalValues of RFCalibrateInfo ++ ++ if(pDM_Odm->RFCalibrateInfo.bReloadtxpowerindex) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); ++ } ++ ++ //4 4. Calculate average thermal meter ++ ++ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; ++ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; ++ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) //Average times = c.AverageThermalNum ++ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; ++ ++ for(i = 0; i < c.AverageThermalNum; i++) ++ { ++ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) ++ { ++ ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; ++ ThermalValue_AVG_count++; ++ } ++ } ++ ++ if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times ++ { ++ ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("AVG Thermal Meter = 0x%X, EFUSE Thermal Base = 0x%X\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ } ++ ++ //4 5. Calculate delta, delta_LCK, delta_IQK. ++ ++ //"delta" here is used to determine whether thermal value changes or not. ++ delta = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue):(pDM_Odm->RFCalibrateInfo.ThermalValue - ThermalValue); ++ delta_LCK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_LCK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK):(pDM_Odm->RFCalibrateInfo.ThermalValue_LCK - ThermalValue); ++ delta_IQK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_IQK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK):(pDM_Odm->RFCalibrateInfo.ThermalValue_IQK - ThermalValue); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK)); ++ ++ //4 6. If necessary, do LCK. ++ ++ if ((delta_LCK >= c.Threshold_IQK)) // Delta temperature is equal to or larger than 20 centigrade. ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); ++ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; ++ if(c.PHY_LCCalibrate) ++ (*c.PHY_LCCalibrate)(pDM_Odm); ++ } ++ ++ //3 7. If necessary, move the index of swing table to adjust Tx power. ++ ++ if (delta > 0 && pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) ++ { ++ //"delta" here is used to record the absolute value of differrence. ++ delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); ++ if (delta >= TXSCALE_TABLE_SIZE) ++ delta = TXSCALE_TABLE_SIZE - 1; ++ ++ //4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset ++ ++ if(ThermalValue > pHalData->EEPROMThermalMeter) { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[ODM_RF_PATH_A] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_A]; ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_A] = deltaSwingTableIdx_TUP_A[delta]; ++ ++ pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_A] = deltaSwingTableIdx_TUP_A[delta]; // Record delta swing for mix mode power tracking ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Temp is higher and pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_A])); ++ ++ if(c.RfPathCount > 1) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[ODM_RF_PATH_B] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_B]; ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_B] = deltaSwingTableIdx_TUP_B[delta]; ++ ++ pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_B] = deltaSwingTableIdx_TUP_B[delta]; // Record delta swing for mix mode power tracking ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Temp is higher and pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_B])); ++ } ++ ++ } ++ else { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); ++ ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[ODM_RF_PATH_A] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_A]; ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_A] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; ++ ++ pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_A] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; // Record delta swing for mix mode power tracking ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Temp is lower and pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_A])); ++ ++ if(c.RfPathCount > 1) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); ++ ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[ODM_RF_PATH_B] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_B]; ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_B] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; ++ ++ pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_B] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; // Record delta swing for mix mode power tracking ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Temp is lower and pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_B])); ++ } ++ } ++ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("\n\n================================ [Path-%c] Calculating PowerIndexOffset ================================\n", (p == ODM_RF_PATH_A ? 'A' : 'B'))); ++ ++ if (pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] == pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p]) // If Thermal value changes but lookup table value still the same ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; ++ else ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] - pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p]; // Power Index Diff between 2 times Power Tracking ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("[Path-%c] PowerIndexOffset(%d) = DeltaPowerIndex(%d) - DeltaPowerIndexLast(%d)\n", ++ (p == ODM_RF_PATH_A ? 'A' : 'B'), pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p], pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p], ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p])); ++ ++ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pDM_Odm->BbSwingIdxOfdmBase[p] + pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p]; ++ pDM_Odm->RFCalibrateInfo.CCK_index = pDM_Odm->BbSwingIdxCckBase + pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p]; ++ ++ pDM_Odm->BbSwingIdxCck = pDM_Odm->RFCalibrateInfo.CCK_index; ++ pDM_Odm->BbSwingIdxOfdm[p] = pDM_Odm->RFCalibrateInfo.OFDM_index[p]; ++ ++ // *************Print BB Swing Base and Index Offset************* ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", ++ pDM_Odm->BbSwingIdxCck, pDM_Odm->BbSwingIdxCckBase, pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p])); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("The 'OFDM' final index(%d) = BaseIndex[%c](%d) + PowerIndexOffset(%d)\n", ++ pDM_Odm->BbSwingIdxOfdm[p], (p == ODM_RF_PATH_A ? 'A' : 'B'), pDM_Odm->BbSwingIdxOfdmBase[p], pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p])); ++ ++ //4 7.1 Handle boundary conditions of index. ++ ++ ++ if(pDM_Odm->RFCalibrateInfo.OFDM_index[p] > c.SwingTableSize_OFDM-1) ++ { ++ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = c.SwingTableSize_OFDM-1; ++ } ++ else if (pDM_Odm->RFCalibrateInfo.OFDM_index[p] < OFDM_min_index) ++ { ++ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = OFDM_min_index; ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("\n\n========================================================================================================\n")); ++ if(pDM_Odm->RFCalibrateInfo.CCK_index > c.SwingTableSize_CCK-1) ++ pDM_Odm->RFCalibrateInfo.CCK_index = c.SwingTableSize_CCK-1; ++ //else if (pDM_Odm->RFCalibrateInfo.CCK_index < 0) ++ //pDM_Odm->RFCalibrateInfo.CCK_index = 0; ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("The thermal meter is unchanged or TxPowerTracking OFF(%d): ThermalValue: %d , pDM_Odm->RFCalibrateInfo.ThermalValue: %d\n", ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl, ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue)); ++ ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", ++ pDM_Odm->RFCalibrateInfo.CCK_index, pDM_Odm->BbSwingIdxCckBase)); //Print Swing base & current ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index[%c]: %d\n", ++ pDM_Odm->RFCalibrateInfo.OFDM_index[p], (p == ODM_RF_PATH_A ? 'A' : 'B'), pDM_Odm->BbSwingIdxOfdmBase[p])); ++ } ++ ++ if ((pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_A] != 0 || ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_B] != 0 ) && ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) ++ { ++ //4 7.2 Configure the Swing Table to adjust Tx Power. ++ ++ pDM_Odm->RFCalibrateInfo.bTxPowerChanged = true; // Always true after Tx Power is adjusted by power tracking. ++ // ++ // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital ++ // to increase TX power. Otherwise, EVM will be bad. ++ // ++ // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. ++ if (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature Increasing(A): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_A], delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); ++ ++ if(c.RfPathCount > 1) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature Increasing(B): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_B], delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); ++ ++ } ++ else if (ThermalValue < pDM_Odm->RFCalibrateInfo.ThermalValue)// Low temperature ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature Decreasing(A): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_A], delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); ++ ++ if(c.RfPathCount > 1) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature Decreasing(B): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_B], delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); ++ ++ } ++ if (ThermalValue > pHalData->EEPROMThermalMeter) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E) ++ { ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TXAGC, p, 0); ++ } ++ else if(pDM_Odm->SupportICType == ODM_RTL8821) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("**********Enter POWER Tracking MIX_MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); ++ } ++ else ++ { ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); ++ } ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8821) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("**********Enter POWER Tracking MIX_MODE**********\n")); ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); ++ } ++ else ++ { ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); ++ } ++ } ++ ++ pDM_Odm->BbSwingIdxCckBase = pDM_Odm->BbSwingIdxCck; // Record last time Power Tracking result as base. ++ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) ++ pDM_Odm->BbSwingIdxOfdmBase[p] = pDM_Odm->BbSwingIdxOfdm[p]; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ++ ("pDM_Odm->RFCalibrateInfo.ThermalValue = %d ThermalValue= %d\n", pDM_Odm->RFCalibrateInfo.ThermalValue, ThermalValue)); ++ ++ pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; //Record last Power Tracking Thermal Value ++ ++ } ++ if ((delta_IQK >= c.Threshold_IQK)) // Delta temperature is equal to or larger than 20 centigrade (When threshold is 8). ++ (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("<===ODM_TXPowerTrackingCallback_ThermalMeter\n")); ++ ++ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; ++} ++ ++ ++ ++ ++//3============================================================ ++//3 IQ Calibration ++//3============================================================ ++ ++void ++ODM_ResetIQKResult( ++ PDM_ODM_T pDM_Odm ++) ++{ ++ u1Byte i; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ if (!IS_HARDWARE_TYPE_8192D(Adapter)) ++ return; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD,("PHY_ResetIQKResult:: settings regs %d default regs %d\n", (u32)(sizeof(pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting)/sizeof(IQK_MATRIX_REGS_SETTING)), IQK_Matrix_Settings_NUM)); ++ //0xe94, 0xe9c, 0xea4, 0xeac, 0xeb4, 0xebc, 0xec4, 0xecc ++ ++ for(i = 0; i < IQK_Matrix_Settings_NUM; i++) ++ { ++ { ++ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][0] = ++ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][2] = ++ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][4] = ++ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][6] = 0x100; ++ ++ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][1] = ++ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][3] = ++ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][5] = ++ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][7] = 0x0; ++ ++ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].bIQKDone = false; ++ ++ } ++ } ++ ++} ++ ++u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) ++{ ++ u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = ++ {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; ++ u1Byte place = chnl; ++ ++ ++ if(chnl > 14) ++ { ++ for(place = 14; place ++ ++ ++// ++// Description: ++// This routine deal with the Power Configuration CMDs parsing for RTL8723/RTL8188E Series IC. ++// ++// Assumption: ++// We should follow specific format which was released from HW SD. ++// ++// 2011.07.07, added by Roger. ++// ++u8 HalPwrSeqCmdParsing( ++ PADAPTER padapter, ++ u8 CutVersion, ++ u8 FabVersion, ++ u8 InterfaceType, ++ WLAN_PWR_CFG PwrSeqCmd[]) ++{ ++ WLAN_PWR_CFG PwrCfgCmd = {0}; ++ u8 bPollingBit = false; ++ u32 AryIdx = 0; ++ u8 value = 0; ++ u32 offset = 0; ++ u32 pollingCount = 0; // polling autoload done. ++ u32 maxPollingCnt = 5000; ++ ++ do { ++ PwrCfgCmd = PwrSeqCmd[AryIdx]; ++ ++ RT_TRACE(_module_hal_init_c_ , _drv_info_, ++ ("HalPwrSeqCmdParsing: offset(%#x) cut_msk(%#x) fab_msk(%#x) interface_msk(%#x) base(%#x) cmd(%#x) msk(%#x) value(%#x)\n", ++ GET_PWR_CFG_OFFSET(PwrCfgCmd), ++ GET_PWR_CFG_CUT_MASK(PwrCfgCmd), ++ GET_PWR_CFG_FAB_MASK(PwrCfgCmd), ++ GET_PWR_CFG_INTF_MASK(PwrCfgCmd), ++ GET_PWR_CFG_BASE(PwrCfgCmd), ++ GET_PWR_CFG_CMD(PwrCfgCmd), ++ GET_PWR_CFG_MASK(PwrCfgCmd), ++ GET_PWR_CFG_VALUE(PwrCfgCmd))); ++ ++ //2 Only Handle the command whose FAB, CUT, and Interface are matched ++ if ((GET_PWR_CFG_FAB_MASK(PwrCfgCmd) & FabVersion) && ++ (GET_PWR_CFG_CUT_MASK(PwrCfgCmd) & CutVersion) && ++ (GET_PWR_CFG_INTF_MASK(PwrCfgCmd) & InterfaceType)) { ++ switch (GET_PWR_CFG_CMD(PwrCfgCmd)) { ++ case PWR_CMD_READ: ++ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_READ\n")); ++ break; ++ case PWR_CMD_WRITE: ++ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_WRITE\n")); ++ offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); ++ // Read the value from system register ++ value = rtw_read8(padapter, offset); ++ ++ value=value&(~(GET_PWR_CFG_MASK(PwrCfgCmd))); ++ value=value|(GET_PWR_CFG_VALUE(PwrCfgCmd)&GET_PWR_CFG_MASK(PwrCfgCmd)); ++ ++ // Write the value back to sytem register ++ rtw_write8(padapter, offset, value); ++ break; ++ case PWR_CMD_POLLING: ++ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_POLLING\n")); ++ ++ bPollingBit = false; ++ offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); ++ do { ++ value = rtw_read8(padapter, offset); ++ ++ value=value&GET_PWR_CFG_MASK(PwrCfgCmd); ++ if (value == (GET_PWR_CFG_VALUE(PwrCfgCmd) & GET_PWR_CFG_MASK(PwrCfgCmd))) ++ bPollingBit = true; ++ else ++ rtw_udelay_os(10); ++ ++ if (pollingCount++ > maxPollingCnt) { ++ DBG_871X("Fail to polling Offset[%#x]\n", offset); ++ return false; ++ } ++ } while (!bPollingBit); ++ ++ break; ++ case PWR_CMD_DELAY: ++ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_DELAY\n")); ++ if (GET_PWR_CFG_VALUE(PwrCfgCmd) == PWRSEQ_DELAY_US) ++ rtw_udelay_os(GET_PWR_CFG_OFFSET(PwrCfgCmd)); ++ else ++ rtw_udelay_os(GET_PWR_CFG_OFFSET(PwrCfgCmd)*1000); ++ break; ++ case PWR_CMD_END: ++ // When this command is parsed, end the process ++ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_END\n")); ++ return true; ++ break; ++ default: ++ RT_TRACE(_module_hal_init_c_ , _drv_err_, ("HalPwrSeqCmdParsing: Unknown CMD!!\n")); ++ break; ++ } ++ } ++ AryIdx++;//Add Array Index ++ } while(1); ++ ++ return true; ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/hal_usb_led.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_usb_led.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/hal_usb_led.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_usb_led.c 2018-02-06 17:42:30.710967164 +0200 +@@ -0,0 +1,4710 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++#include ++#include ++ ++// ++// Description: ++// Implementation of LED blinking behavior. ++// It toggle off LED and schedule corresponding timer if necessary. ++// ++static void ++SwLedBlink( ++ PLED_USB pLed ++ ) ++{ ++ _adapter *padapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u8 bStopBlinking = false; ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ { ++ SwLedOn(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ SwLedOff(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,( "Blinktimes (%d): turn off\n", pLed->BlinkTimes)); ++ } ++ ++ // Determine if we shall change LED state again. ++ pLed->BlinkTimes--; ++ switch(pLed->CurrLedState) ++ { ++ ++ case LED_BLINK_NORMAL: ++ if(pLed->BlinkTimes == 0) ++ { ++ bStopBlinking = true; ++ } ++ break; ++ ++ case LED_BLINK_StartToBlink: ++ if( check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE) ) ++ { ++ bStopBlinking = true; ++ } ++ if( check_fwstate(pmlmepriv, _FW_LINKED) && ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) ) ++ { ++ bStopBlinking = true; ++ } ++ else if(pLed->BlinkTimes == 0) ++ { ++ bStopBlinking = true; ++ } ++ break; ++ ++ case LED_BLINK_WPS: ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ break; ++ ++ ++ default: ++ bStopBlinking = true; ++ break; ++ ++ } ++ ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else if( (check_fwstate(pmlmepriv, _FW_LINKED)== true) && (pLed->bLedOn == false)) ++ { ++ SwLedOn(padapter, pLed); ++ } ++ else if( (check_fwstate(pmlmepriv, _FW_LINKED)== false) && pLed->bLedOn == true) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ ++ pLed->BlinkTimes = 0; ++ pLed->bLedBlinkInProgress = false; ++ } ++ else ++ { ++ // Assign LED state to toggle. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ // Schedule a timer to toggle LED state. ++ switch( pLed->CurrLedState ) ++ { ++ case LED_BLINK_NORMAL: ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ break; ++ ++ case LED_BLINK_SLOWLY: ++ case LED_BLINK_StartToBlink: ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); ++ break; ++ ++ case LED_BLINK_WPS: ++ { ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LONG_INTERVAL); ++ else ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LONG_INTERVAL); ++ } ++ break; ++ ++ default: ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); ++ break; ++ } ++ } ++} ++ ++static void ++SwLedBlink1( ++ PLED_USB pLed ++ ) ++{ ++ _adapter *padapter = pLed->padapter; ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ PLED_USB pLed1 = &(ledpriv->SwLed1); ++ u8 bStopBlinking = false; ++ ++ u32 uLedBlinkNoLinkInterval = LED_BLINK_NO_LINK_INTERVAL_ALPHA; //add by ylb 20121012 for customer led for alpha ++ if(pEEPROM->CustomerID == RT_CID_819x_ALPHA_Dlink) ++ uLedBlinkNoLinkInterval= LED_BLINK_NO_LINK_INTERVAL_ALPHA_500MS; ++ ++ if(pEEPROM->CustomerID == RT_CID_819x_CAMEO) ++ pLed = &(ledpriv->SwLed1); ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ { ++ SwLedOn(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,( "Blinktimes (%d): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ SwLedOff(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); ++ } ++ ++ ++ if(pEEPROM->CustomerID == RT_CID_DEFAULT) ++ { ++ if(check_fwstate(pmlmepriv, _FW_LINKED)== true) ++ { ++ if(!pLed1->bSWLedCtrl) ++ { ++ SwLedOn(padapter, pLed1); ++ pLed1->bSWLedCtrl = true; ++ } ++ else if(!pLed1->bLedOn) ++ SwLedOn(padapter, pLed1); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (): turn on pLed1\n")); ++ } ++ else ++ { ++ if(!pLed1->bSWLedCtrl) ++ { ++ SwLedOff(padapter, pLed1); ++ pLed1->bSWLedCtrl = true; ++ } ++ else if(pLed1->bLedOn) ++ SwLedOff(padapter, pLed1); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (): turn off pLed1\n")); ++ } ++ } ++ ++ switch(pLed->CurrLedState) ++ { ++ case LED_BLINK_SLOWLY: ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval);//change by ylb 20121012 for customer led for alpha ++ break; ++ ++ case LED_BLINK_NORMAL: ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); ++ break; ++ ++ case LED_BLINK_SCAN: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) ++ { ++ pLed->bLedLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_NORMAL; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) ++ { ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ else ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ case LED_BLINK_TXRX: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) ++ { ++ pLed->bLedLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_NORMAL; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) ++ { ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ pLed->BlinkTimes = 0; ++ pLed->bLedBlinkInProgress = false; ++ } ++ else ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ case LED_BLINK_WPS: ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ break; ++ ++ case LED_BLINK_WPS_STOP: //WPS success ++ if(pLed->BlinkingLedState == RTW_LED_ON) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA); ++ bStopBlinking = false; ++ } ++ else ++ { ++ bStopBlinking = true; ++ } ++ ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ pLed->bLedLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_NORMAL; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ break; ++ ++ default: ++ break; ++ } ++ ++} ++ ++static void ++SwLedBlink2( ++ PLED_USB pLed ++ ) ++{ ++ _adapter *padapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u8 bStopBlinking = false; ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON) ++ { ++ SwLedOn(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ SwLedOff(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); ++ } ++ ++ switch(pLed->CurrLedState) ++ { ++ case LED_BLINK_SCAN: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) ++ { ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ SwLedOn(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("stop scan blink CurrLedState %d\n", pLed->CurrLedState)); ++ ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ SwLedOff(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("stop scan blink CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ else ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ case LED_BLINK_TXRX: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) ++ { ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ SwLedOn(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("stop CurrLedState %d\n", pLed->CurrLedState)); ++ ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ SwLedOff(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("stop CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ pLed->bLedBlinkInProgress = false; ++ } ++ else ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ default: ++ break; ++ } ++ ++} ++ ++static void ++SwLedBlink3( ++ PLED_USB pLed ++ ) ++{ ++ _adapter *padapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u8 bStopBlinking = false; ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ { ++ SwLedOn(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ if(pLed->CurrLedState != LED_BLINK_WPS_STOP) ++ SwLedOff(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); ++ } ++ ++ switch(pLed->CurrLedState) ++ { ++ case LED_BLINK_SCAN: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) ++ { ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ if( !pLed->bLedOn ) ++ SwLedOn(padapter, pLed); ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ if( pLed->bLedOn ) ++ SwLedOff(padapter, pLed); ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ else ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ case LED_BLINK_TXRX: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) ++ { ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ if( !pLed->bLedOn ) ++ SwLedOn(padapter, pLed); ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ ++ if( pLed->bLedOn ) ++ SwLedOff(padapter, pLed); ++ ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ pLed->bLedBlinkInProgress = false; ++ } ++ else ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ case LED_BLINK_WPS: ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ break; ++ ++ case LED_BLINK_WPS_STOP: //WPS success ++ if(pLed->BlinkingLedState == RTW_LED_ON) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA); ++ bStopBlinking = false; ++ } ++ else ++ { ++ bStopBlinking = true; ++ } ++ ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ SwLedOn(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ break; ++ ++ ++ default: ++ break; ++ } ++ ++} ++ ++ ++static void ++SwLedBlink4( ++ PLED_USB pLed ++ ) ++{ ++ _adapter *padapter = pLed->padapter; ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ PLED_USB pLed1 = &(ledpriv->SwLed1); ++ u8 bStopBlinking = false; ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ { ++ SwLedOn(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ SwLedOff(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); ++ } ++ ++ if(!pLed1->bLedWPSBlinkInProgress && pLed1->BlinkingLedState == LED_UNKNOWN) ++ { ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ pLed1->CurrLedState = RTW_LED_OFF; ++ SwLedOff(padapter, pLed1); ++ } ++ ++ switch(pLed->CurrLedState) ++ { ++ case LED_BLINK_SLOWLY: ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ break; ++ ++ case LED_BLINK_StartToBlink: ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ break; ++ ++ case LED_BLINK_SCAN: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = false; ++ } ++ ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ pLed->bLedNoLinkBlinkInProgress = false; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ } ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ else ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ case LED_BLINK_TXRX: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ } ++ pLed->bLedBlinkInProgress = false; ++ } ++ else ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ if(IS_HARDWARE_TYPE_8192DU(padapter)) ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ case LED_BLINK_WPS: ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ break; ++ ++ case LED_BLINK_WPS_STOP: //WPS authentication fail ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ break; ++ ++ case LED_BLINK_WPS_STOP_OVERLAP: //WPS session overlap ++ pLed->BlinkTimes--; ++ if(pLed->BlinkTimes == 0) ++ { ++ if(pLed->bLedOn) ++ { ++ pLed->BlinkTimes = 1; ++ } ++ else ++ { ++ bStopBlinking = true; ++ } ++ } ++ ++ if(bStopBlinking) ++ { ++ pLed->BlinkTimes = 10; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ break; ++ ++ case LED_BLINK_ALWAYS_ON: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ if(IS_HARDWARE_TYPE_8192DU(padapter)) ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; ++ } ++ else ++ { ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ } ++ pLed->bLedBlinkInProgress = false; ++ } ++ else ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("RFOff Status \n")); ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ if(IS_HARDWARE_TYPE_8192DU(padapter)) ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ default: ++ break; ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink4 CurrLedState %d\n", pLed->CurrLedState)); ++ ++ ++} ++ ++static void ++SwLedBlink5( ++ PLED_USB pLed ++ ) ++{ ++ _adapter *padapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u8 bStopBlinking = false; ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ { ++ SwLedOn(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ SwLedOff(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); ++ } ++ ++ switch(pLed->CurrLedState) ++ { ++ case LED_BLINK_SCAN: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ if(pLed->bLedOn) ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ if(!pLed->bLedOn) ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ else ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ ++ case LED_BLINK_TXRX: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ ++ if(bStopBlinking) ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ if(pLed->bLedOn) ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ if(!pLed->bLedOn) ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ ++ pLed->bLedBlinkInProgress = false; ++ } ++ else ++ { ++ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(padapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ default: ++ break; ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink5 CurrLedState %d\n", pLed->CurrLedState)); ++ ++ ++} ++ ++static void ++SwLedBlink6( ++ PLED_USB pLed ++ ) ++{ ++ _adapter *padapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ u8 bStopBlinking = false; ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ { ++ SwLedOn(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ SwLedOff(padapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink6\n")); ++} ++ ++static void ++SwLedBlink7( ++ PLED_USB pLed ++ ) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ bool bStopBlinking = false; ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ { ++ SwLedOn(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ if(pLed->CurrLedState != LED_BLINK_WPS_STOP) ++ SwLedOff(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); ++ } ++ ++ switch(pLed->CurrLedState) ++ { ++ case LED_BLINK_SCAN: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ ++ if(bStopBlinking) ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(Adapter, pLed); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) ++ { ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ if( !pLed->bLedOn ) ++ SwLedOn(Adapter, pLed); ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ if( pLed->bLedOn ) ++ SwLedOff(Adapter, pLed); ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ else ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(Adapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); ++ } ++ } ++ break; ++ ++ case LED_BLINK_WPS: ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); ++ break; ++ ++ case LED_BLINK_WPS_STOP: //WPS success ++ if(pLed->BlinkingLedState == RTW_LED_ON) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); ++ bStopBlinking = false; ++ } ++ else ++ { ++ bStopBlinking = true; ++ } ++ ++ if(bStopBlinking) ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(Adapter, pLed); ++ } ++ else ++ { ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ SwLedOn(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ break; ++ ++ ++ default: ++ break; ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink7\n")); ++ ++} ++ ++static void ++SwLedBlink8( ++ PLED_USB pLed ++ ) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ { ++ SwLedOn(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes blink8(%d): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ SwLedOff(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes blink8(%d): turn off\n", pLed->BlinkTimes)); ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink8\n")); ++ ++} ++ ++//page added for Belkin AC950. 20120813 ++static void ++SwLedBlink9( ++ PLED_USB pLed ++ ) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ bool bStopBlinking = false; ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ { ++ SwLedOn(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ SwLedOff(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); ++ } ++ ++ ++ switch(pLed->CurrLedState) ++ { ++ case RTW_LED_ON: ++ SwLedOn(Adapter, pLed); ++ break; ++ ++ case RTW_LED_OFF: ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ case LED_BLINK_SLOWLY: ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ break; ++ ++ case LED_BLINK_StartToBlink: ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ break; ++ ++ case LED_BLINK_SCAN: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ ++ if(bStopBlinking) ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(Adapter, pLed); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED) == true) ++ { ++ pLed->bLedLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; ++ ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) ++ { ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ pLed->BlinkTimes = 0; ++ pLed->bLedBlinkInProgress = false; ++ } ++ else ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(Adapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ case LED_BLINK_TXRX: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ if(bStopBlinking) ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(Adapter, pLed); ++ } ++ else ++ { ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ pLed->bLedBlinkInProgress = false; ++ } ++ else ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(Adapter, pLed); ++ } ++ else ++ { ++ if(IS_HARDWARE_TYPE_8192DU(Adapter)) ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ case LED_BLINK_WPS: ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ break; ++ ++ case LED_BLINK_WPS_STOP: //WPS authentication fail ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ break; ++ ++ case LED_BLINK_WPS_STOP_OVERLAP: //WPS session overlap ++ pLed->BlinkTimes--; ++ pLed->BlinkCounter --; ++ if(pLed->BlinkCounter == 0) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ pLed->CurrLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ else ++ { ++ if(pLed->BlinkTimes == 0) ++ { ++ if(pLed->bLedOn) ++ { ++ pLed->BlinkTimes = 1; ++ } ++ else ++ { ++ bStopBlinking = true; ++ } ++ } ++ ++ if(bStopBlinking) ++ { ++ pLed->BlinkTimes = 10; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ } ++ break; ++ ++ case LED_BLINK_ALWAYS_ON: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ if(bStopBlinking) ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(Adapter, pLed); ++ } ++ else ++ { ++ if(IS_HARDWARE_TYPE_8192DU(Adapter) || IS_HARDWARE_TYPE_8812AU(Adapter)) ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; ++ } ++ else ++ { ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ } ++ pLed->bLedBlinkInProgress = false; ++ } ++ else ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("RFOff Status \n")); ++ SwLedOff(Adapter, pLed); ++ } ++ else ++ { ++ if(IS_HARDWARE_TYPE_8192DU(Adapter) || IS_HARDWARE_TYPE_8723AU(Adapter) || IS_HARDWARE_TYPE_8812AU(Adapter)) ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ case LED_BLINK_LINK_IN_PROCESS: ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ON_BELKIN); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_OFF_BELKIN); ++ } ++ break; ++ ++ case LED_BLINK_AUTH_ERROR: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ if(bStopBlinking == false) ++ { ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); ++ } ++ } ++ else ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); ++ } ++ break; ++ ++ default: ++ break; ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink9 CurrLedState %d\n", pLed->CurrLedState)); ++} ++ ++//page added for Netgear A6200V2. 20120827 ++static void ++SwLedBlink10( ++ PLED_USB pLed ++ ) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ bool bStopBlinking = false; ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ { ++ SwLedOn(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ SwLedOff(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); ++ } ++ ++ ++ switch(pLed->CurrLedState) ++ { ++ case RTW_LED_ON: ++ SwLedOn(Adapter, pLed); ++ break; ++ ++ case RTW_LED_OFF: ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ case LED_BLINK_SLOWLY: ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ break; ++ ++ case LED_BLINK_StartToBlink: ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ break; ++ ++ case LED_BLINK_SCAN: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ ++ if(bStopBlinking) ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on ) ++ { ++ SwLedOff(Adapter, pLed); ++ } ++ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) ++ { ++ pLed->bLedNoLinkBlinkInProgress = false; ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ pLed->BlinkTimes = 0; ++ pLed->bLedBlinkInProgress = false; ++ } ++ else ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(Adapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_SLOWLY_INTERVAL_NETGEAR+LED_BLINK_LINK_INTERVAL_NETGEAR); ++ } ++ } ++ } ++ break; ++ ++ case LED_BLINK_WPS: ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL+LED_BLINK_LINK_INTERVAL_NETGEAR); ++ } ++ break; ++ ++ case LED_BLINK_WPS_STOP: //WPS authentication fail ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ break; ++ ++ case LED_BLINK_WPS_STOP_OVERLAP: //WPS session overlap ++ pLed->BlinkTimes--; ++ pLed->BlinkCounter --; ++ if(pLed->BlinkCounter == 0) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ pLed->CurrLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ else ++ { ++ if(pLed->BlinkTimes == 0) ++ { ++ if(pLed->bLedOn) ++ { ++ pLed->BlinkTimes = 1; ++ } ++ else ++ { ++ bStopBlinking = true; ++ } ++ } ++ ++ if(bStopBlinking) ++ { ++ pLed->BlinkTimes = 10; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ } ++ break; ++ ++ case LED_BLINK_ALWAYS_ON: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ if(bStopBlinking) ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(Adapter, pLed); ++ } ++ else ++ { ++ if(IS_HARDWARE_TYPE_8192DU(Adapter) || IS_HARDWARE_TYPE_8812AU(Adapter)) ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; ++ } ++ else ++ { ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ } ++ pLed->bLedBlinkInProgress = false; ++ } ++ else ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("RFOff Status \n")); ++ SwLedOff(Adapter, pLed); ++ } ++ else ++ { ++ if(IS_HARDWARE_TYPE_8192DU(Adapter) || IS_HARDWARE_TYPE_8723AU(Adapter) || IS_HARDWARE_TYPE_8812AU(Adapter)) ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ case LED_BLINK_LINK_IN_PROCESS: ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ON_BELKIN); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_OFF_BELKIN); ++ } ++ break; ++ ++ case LED_BLINK_AUTH_ERROR: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ if(bStopBlinking == false) ++ { ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); ++ } ++ } ++ else ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); ++ } ++ break; ++ ++ default: ++ break; ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink10 CurrLedState %d\n", pLed->CurrLedState)); ++ ++} ++ ++static void ++SwLedBlink11( ++ PLED_USB pLed ++ ) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ bool bStopBlinking = false; ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ { ++ SwLedOn(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ SwLedOff(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); ++ } ++ ++ switch(pLed->CurrLedState) ++ { ++ case LED_BLINK_TXRX: ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(Adapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ ++ break; ++ ++ case LED_BLINK_WPS: ++ if(pLed->BlinkTimes == 5) ++ { ++ SwLedOn(Adapter, pLed); ++ _set_timer(&(pLed->BlinkTimer), LED_CM11_LINK_ON_INTERVEL); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_CM11_BLINK_INTERVAL); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_CM11_BLINK_INTERVAL); ++ } ++ } ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ if(bStopBlinking == true) ++ pLed->BlinkTimes = 5; ++ break; ++ ++ case LED_BLINK_WPS_STOP: //WPS authentication fail ++ if(check_fwstate(pmlmepriv, _FW_LINKED)== true) ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ else ++ { ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ SwLedOn(Adapter, pLed); ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ break; ++ ++ default: ++ break; ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink5 CurrLedState %d\n", pLed->CurrLedState)); ++} ++ ++static void ++SwLedBlink12( ++ PLED_USB pLed ++ ) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ bool bStopBlinking = false; ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ { ++ SwLedOn(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%ld): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ SwLedOff(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%ld): turn off\n", pLed->BlinkTimes)); ++ } ++ ++ switch(pLed->CurrLedState) ++ { ++ case LED_BLINK_SLOWLY: ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ break; ++ ++ case LED_BLINK_TXRX: ++ pLed->BlinkTimes--; ++ if( pLed->BlinkTimes == 0 ) ++ { ++ bStopBlinking = true; ++ } ++ ++ if(bStopBlinking) ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ if(pLed->bLedOn) ++ SwLedOff(Adapter, pLed); ++ } ++ else ++ { ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ } ++ ++ pLed->bLedBlinkInProgress = false; ++ } ++ else ++ { ++ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) ++ { ++ SwLedOff(Adapter, pLed); ++ } ++ else ++ { ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ } ++ break; ++ ++ default: ++ break; ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink8 CurrLedState %d\n", pLed->CurrLedState)); ++ ++ ++} ++ ++static void ++SwLedBlink13( ++ PLED_USB pLed ++ ) ++{ ++ PADAPTER Adapter = pLed->padapter; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ bool bStopBlinking = false; ++ static u8 LinkBlinkCnt=0; ++ ++ // Change LED according to BlinkingLedState specified. ++ if( pLed->BlinkingLedState == RTW_LED_ON ) ++ { ++ SwLedOn(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); ++ } ++ else ++ { ++ if(pLed->CurrLedState != LED_BLINK_WPS_STOP) ++ SwLedOff(Adapter, pLed); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); ++ } ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("!!! SwLedBlink13 CurrLedState %d, bLedWPSBlinkInProgress %d, bLedBlinkInProgress %d\n", pLed->CurrLedState,pLed->bLedWPSBlinkInProgress,pLed->bLedBlinkInProgress)); ++ switch(pLed->CurrLedState) ++ { ++ case LED_BLINK_LINK_IN_PROCESS: ++ if(!pLed->bLedWPSBlinkInProgress) ++ LinkBlinkCnt++; ++ ++ if(LinkBlinkCnt>15) ++ { ++ LinkBlinkCnt=0; ++ pLed->bLedBlinkInProgress = false; ++ break; ++ } ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), 500); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), 500); ++ } ++ ++ break; ++ ++ case LED_BLINK_WPS: ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_ON_INTERVAL_NETGEAR); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_OFF_INTERVAL_NETGEAR); ++ } ++ ++ break; ++ ++ case LED_BLINK_WPS_STOP: //WPS success ++ SwLedOff(Adapter, pLed); ++ pLed->bLedWPSBlinkInProgress = false; ++ break; ++ ++ default: ++ LinkBlinkCnt=0; ++ break; ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink13\n")); ++ ++} ++ ++// ++// Description: ++// Handler function of LED Blinking. ++// We dispatch acture LED blink action according to LedStrategy. ++// ++void BlinkHandler(PLED_USB pLed) ++{ ++ _adapter *padapter = pLed->padapter; ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ ++ //DBG_871X("%s (%s:%d)\n",__FUNCTION__, current->comm, current->pid); ++ ++ if( (padapter->bSurpriseRemoved == true) || ( padapter->bDriverStopped == true)) ++ { ++ //DBG_871X("%s bSurpriseRemoved:%d, bDriverStopped:%d\n", __FUNCTION__, padapter->bSurpriseRemoved, padapter->bDriverStopped); ++ return; ++ } ++ ++ switch(ledpriv->LedStrategy) ++ { ++ case SW_LED_MODE0: ++ SwLedBlink(pLed); ++ break; ++ ++ case SW_LED_MODE1: ++ SwLedBlink1(pLed); ++ break; ++ ++ case SW_LED_MODE2: ++ SwLedBlink2(pLed); ++ break; ++ ++ case SW_LED_MODE3: ++ SwLedBlink3(pLed); ++ break; ++ ++ case SW_LED_MODE4: ++ SwLedBlink4(pLed); ++ break; ++ ++ case SW_LED_MODE5: ++ SwLedBlink5(pLed); ++ break; ++ ++ case SW_LED_MODE6: ++ SwLedBlink6(pLed); ++ break; ++ ++ case SW_LED_MODE7: ++ SwLedBlink7(pLed); ++ break; ++ ++ case SW_LED_MODE8: ++ SwLedBlink8(pLed); ++ break; ++ ++ case SW_LED_MODE9: ++ SwLedBlink9(pLed); ++ break; ++ ++ case SW_LED_MODE10: ++ SwLedBlink10(pLed); ++ break; ++ ++ case SW_LED_MODE11: ++ SwLedBlink11(pLed); ++ break; ++ ++ case SW_LED_MODE12: ++ SwLedBlink12(pLed); ++ ++ default: ++ //RT_TRACE(COMP_LED, DBG_LOUD, ("BlinkWorkItemCallback 0x%x \n", pHalData->LedStrategy)); ++ //SwLedBlink(pLed); ++ break; ++ } ++} ++ ++// ++// Description: ++// Callback function of LED BlinkTimer, ++// it just schedules to corresponding BlinkWorkItem/led_blink_hdl ++// ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++void BlinkTimerCallback(void *data) ++#else ++void BlinkTimerCallback(struct timer_list *t) ++#endif ++{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++ PLED_USB pLed = (PLED_USB)data; ++#else ++ PLED_USB pLed = from_timer(pLed, t, BlinkTimer); ++#endif ++ _adapter *padapter = pLed->padapter; ++ ++ //DBG_871X("%s\n", __FUNCTION__); ++ ++ if( (padapter->bSurpriseRemoved == true) || ( padapter->bDriverStopped == true)) ++ { ++ //DBG_871X("%s bSurpriseRemoved:%d, bDriverStopped:%d\n", __FUNCTION__, padapter->bSurpriseRemoved, padapter->bDriverStopped); ++ return; ++ } ++ ++ #ifdef CONFIG_LED_HANDLED_BY_CMD_THREAD ++ rtw_led_blink_cmd(padapter, (void *)pLed); ++ #else ++ _set_workitem(&(pLed->BlinkWorkItem)); ++ #endif ++} ++ ++// ++// Description: ++// Callback function of LED BlinkWorkItem. ++// We dispatch acture LED blink action according to LedStrategy. ++// ++void BlinkWorkItemCallback(_workitem *work) ++{ ++ PLED_USB pLed = container_of(work, LED_USB, BlinkWorkItem); ++ BlinkHandler(pLed); ++} ++ ++static void ++SwLedControlMode0( ++ _adapter *padapter, ++ LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ PLED_USB pLed = &(ledpriv->SwLed1); ++ ++ // Decide led state ++ switch(LedAction) ++ { ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if( pLed->bLedBlinkInProgress == false ) ++ { ++ pLed->bLedBlinkInProgress = true; ++ ++ pLed->CurrLedState = LED_BLINK_NORMAL; ++ pLed->BlinkTimes = 2; ++ ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ break; ++ ++ case LED_CTL_START_TO_LINK: ++ if( pLed->bLedBlinkInProgress == false ) ++ { ++ pLed->bLedBlinkInProgress = true; ++ ++ pLed->CurrLedState = LED_BLINK_StartToBlink; ++ pLed->BlinkTimes = 24; ++ ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); ++ } ++ else ++ { ++ pLed->CurrLedState = LED_BLINK_StartToBlink; ++ } ++ break; ++ ++ case LED_CTL_LINK: ++ pLed->CurrLedState = RTW_LED_ON; ++ if( pLed->bLedBlinkInProgress == false ) ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ break; ++ ++ case LED_CTL_NO_LINK: ++ pLed->CurrLedState = RTW_LED_OFF; ++ if( pLed->bLedBlinkInProgress == false ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed->CurrLedState = RTW_LED_OFF; ++ if(pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ SwLedOff(padapter, pLed); ++ break; ++ ++ case LED_CTL_START_WPS: ++ if( pLed->bLedBlinkInProgress == false || pLed->CurrLedState == RTW_LED_ON) ++ { ++ pLed->bLedBlinkInProgress = true; ++ ++ pLed->CurrLedState = LED_BLINK_WPS; ++ pLed->BlinkTimes = 20; ++ ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LONG_INTERVAL); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LONG_INTERVAL); ++ } ++ } ++ break; ++ ++ case LED_CTL_STOP_WPS: ++ if(pLed->bLedBlinkInProgress) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ break; ++ ++ ++ default: ++ break; ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led %d\n", pLed->CurrLedState)); ++ ++} ++ ++ //ALPHA, added by chiyoko, 20090106 ++static void ++SwLedControlMode1( ++ _adapter *padapter, ++ LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ PLED_USB pLed = &(ledpriv->SwLed0); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); ++ ++ u32 uLedBlinkNoLinkInterval = LED_BLINK_NO_LINK_INTERVAL_ALPHA; //add by ylb 20121012 for customer led for alpha ++ if(pEEPROM->CustomerID == RT_CID_819x_ALPHA_Dlink) ++ uLedBlinkNoLinkInterval= LED_BLINK_NO_LINK_INTERVAL_ALPHA_500MS; ++ ++ if(pEEPROM->CustomerID == RT_CID_819x_CAMEO) ++ pLed = &(ledpriv->SwLed1); ++ ++ switch(LedAction) ++ { ++ case LED_CTL_POWER_ON: ++ case LED_CTL_START_TO_LINK: ++ case LED_CTL_NO_LINK: ++ if( pLed->bLedNoLinkBlinkInProgress == false ) ++ { ++ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) ++ { ++ return; ++ } ++ if( pLed->bLedLinkBlinkInProgress == true ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedLinkBlinkInProgress = false; ++ } ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval);//change by ylb 20121012 for customer led for alpha ++ } ++ break; ++ ++ case LED_CTL_LINK: ++ if( pLed->bLedLinkBlinkInProgress == false ) ++ { ++ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) ++ { ++ return; ++ } ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ pLed->bLedLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_NORMAL; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_SITE_SURVEY: ++ if((pmlmepriv->LinkDetectInfo.bBusyTraffic) && (check_fwstate(pmlmepriv, _FW_LINKED)== true)) ++ ; ++ else if(pLed->bLedScanBlinkInProgress ==false) ++ { ++ if(IS_LED_WPS_BLINKING(pLed)) ++ return; ++ ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ if( pLed->bLedLinkBlinkInProgress == true ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedLinkBlinkInProgress = false; ++ } ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ pLed->bLedScanBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SCAN; ++ pLed->BlinkTimes = 24; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ if (padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason == RF_CHANGE_BY_IPS) ++ _set_timer(&(pLed->BlinkTimer), LED_INITIAL_INTERVAL); ++ else ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ ++ } ++ break; ++ ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if(pLed->bLedBlinkInProgress ==false) ++ { ++ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) ++ { ++ return; ++ } ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ if( pLed->bLedLinkBlinkInProgress == true ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedLinkBlinkInProgress = false; ++ } ++ pLed->bLedBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_TXRX; ++ pLed->BlinkTimes = 2; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_START_WPS: //wait until xinpin finish ++ case LED_CTL_START_WPS_BOTTON: ++ if(pLed->bLedWPSBlinkInProgress ==false) ++ { ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ if( pLed->bLedLinkBlinkInProgress == true ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedLinkBlinkInProgress = false; ++ } ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if(pLed->bLedScanBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ pLed->bLedWPSBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_WPS; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ break; ++ ++ ++ case LED_CTL_STOP_WPS: ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ if( pLed->bLedLinkBlinkInProgress == true ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedLinkBlinkInProgress = false; ++ } ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if(pLed->bLedScanBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ if(pLed->bLedWPSBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ } ++ else ++ { ++ pLed->bLedWPSBlinkInProgress = true; ++ } ++ ++ pLed->CurrLedState = LED_BLINK_WPS_STOP; ++ if(pLed->bLedOn) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ break; ++ ++ case LED_CTL_STOP_WPS_FAIL: ++ if(pLed->bLedWPSBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval);//change by ylb 20121012 for customer led for alpha ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ if( pLed->bLedNoLinkBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ if( pLed->bLedLinkBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedLinkBlinkInProgress = false; ++ } ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if( pLed->bLedWPSBlinkInProgress ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ ++ SwLedOff(padapter, pLed); ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led %d\n", pLed->CurrLedState)); ++} ++ ++ //Arcadyan/Sitecom , added by chiyoko, 20090216 ++static void ++SwLedControlMode2( ++ _adapter *padapter, ++ LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ PLED_USB pLed = &(ledpriv->SwLed0); ++ ++ switch(LedAction) ++ { ++ case LED_CTL_SITE_SURVEY: ++ if(pmlmepriv->LinkDetectInfo.bBusyTraffic) ++ ; ++ else if(pLed->bLedScanBlinkInProgress ==false) ++ { ++ if(IS_LED_WPS_BLINKING(pLed)) ++ return; ++ ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ pLed->bLedScanBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SCAN; ++ pLed->BlinkTimes = 24; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if((pLed->bLedBlinkInProgress ==false) && (check_fwstate(pmlmepriv, _FW_LINKED)== true)) ++ { ++ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) ++ { ++ return; ++ } ++ ++ pLed->bLedBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_TXRX; ++ pLed->BlinkTimes = 2; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_LINK: ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ ++ _set_timer(&(pLed->BlinkTimer), 0); ++ break; ++ ++ case LED_CTL_START_WPS: //wait until xinpin finish ++ case LED_CTL_START_WPS_BOTTON: ++ if(pLed->bLedWPSBlinkInProgress ==false) ++ { ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if(pLed->bLedScanBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ pLed->bLedWPSBlinkInProgress = true; ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ break; ++ ++ case LED_CTL_STOP_WPS: ++ pLed->bLedWPSBlinkInProgress = false; ++ if(padapter->pwrctrlpriv.rf_pwrstate != rf_on) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ else ++ { ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ } ++ break; ++ ++ case LED_CTL_STOP_WPS_FAIL: ++ pLed->bLedWPSBlinkInProgress = false; ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++ break; ++ ++ case LED_CTL_START_TO_LINK: ++ case LED_CTL_NO_LINK: ++ if(!IS_LED_BLINKING(pLed)) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ if( pLed->bLedWPSBlinkInProgress ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ ++ SwLedOff(padapter, pLed); ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++} ++ ++ //COREGA, added by chiyoko, 20090316 ++ static void ++ SwLedControlMode3( ++ _adapter *padapter, ++ LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ PLED_USB pLed = &(ledpriv->SwLed0); ++ ++ switch(LedAction) ++ { ++ case LED_CTL_SITE_SURVEY: ++ if(pmlmepriv->LinkDetectInfo.bBusyTraffic) ++ ; ++ else if(pLed->bLedScanBlinkInProgress ==false) ++ { ++ if(IS_LED_WPS_BLINKING(pLed)) ++ return; ++ ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ pLed->bLedScanBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SCAN; ++ pLed->BlinkTimes = 24; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if((pLed->bLedBlinkInProgress ==false) && (check_fwstate(pmlmepriv, _FW_LINKED)== true)) ++ { ++ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) ++ { ++ return; ++ } ++ ++ pLed->bLedBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_TXRX; ++ pLed->BlinkTimes = 2; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_LINK: ++ if(IS_LED_WPS_BLINKING(pLed)) ++ return; ++ ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ ++ _set_timer(&(pLed->BlinkTimer), 0); ++ break; ++ ++ case LED_CTL_START_WPS: //wait until xinpin finish ++ case LED_CTL_START_WPS_BOTTON: ++ if(pLed->bLedWPSBlinkInProgress ==false) ++ { ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if(pLed->bLedScanBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ pLed->bLedWPSBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_WPS; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_STOP_WPS: ++ if(pLed->bLedWPSBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ else ++ { ++ pLed->bLedWPSBlinkInProgress = true; ++ } ++ ++ pLed->CurrLedState = LED_BLINK_WPS_STOP; ++ if(pLed->bLedOn) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ ++ break; ++ ++ case LED_CTL_STOP_WPS_FAIL: ++ if(pLed->bLedWPSBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ break; ++ ++ case LED_CTL_START_TO_LINK: ++ case LED_CTL_NO_LINK: ++ if(!IS_LED_BLINKING(pLed)) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ if( pLed->bLedWPSBlinkInProgress ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ ++ SwLedOff(padapter, pLed); ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); ++} ++ ++ ++ //Edimax-Belkin, added by chiyoko, 20090413 ++static void ++SwLedControlMode4( ++ _adapter *padapter, ++ LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ PLED_USB pLed = &(ledpriv->SwLed0); ++ PLED_USB pLed1 = &(ledpriv->SwLed1); ++ ++ switch(LedAction) ++ { ++ case LED_CTL_START_TO_LINK: ++ if(pLed1->bLedWPSBlinkInProgress) ++ { ++ pLed1->bLedWPSBlinkInProgress = false; ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ pLed1->CurrLedState = RTW_LED_OFF; ++ ++ if(pLed1->bLedOn) ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ ++ if( pLed->bLedStartToLinkBlinkInProgress == false ) ++ { ++ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) ++ { ++ return; ++ } ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if(pLed->bLedNoLinkBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ ++ pLed->bLedStartToLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_StartToBlink; ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ } ++ break; ++ ++ case LED_CTL_LINK: ++ case LED_CTL_NO_LINK: ++ //LED1 settings ++ if(LedAction == LED_CTL_LINK) ++ { ++ if(pLed1->bLedWPSBlinkInProgress) ++ { ++ pLed1->bLedWPSBlinkInProgress = false; ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ pLed1->CurrLedState = RTW_LED_OFF; ++ ++ if(pLed1->bLedOn) ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ } ++ ++ if( pLed->bLedNoLinkBlinkInProgress == false ) ++ { ++ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) ++ { ++ return; ++ } ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ ++ pLed->bLedNoLinkBlinkInProgress = true; ++ if(IS_HARDWARE_TYPE_8192DU(padapter)) ++ { ++ if(LedAction == LED_CTL_LINK) ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; ++ } ++ else ++ { ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ } ++ } ++ else ++ { ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_SITE_SURVEY: ++ if((pmlmepriv->LinkDetectInfo.bBusyTraffic) && (check_fwstate(pmlmepriv, _FW_LINKED)== true)) ++ ; ++ else if(pLed->bLedScanBlinkInProgress ==false) ++ { ++ if(IS_LED_WPS_BLINKING(pLed)) ++ return; ++ ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ pLed->bLedScanBlinkInProgress = true; ++ if(IS_HARDWARE_TYPE_8192D(padapter)) ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ else ++ pLed->CurrLedState = LED_BLINK_SCAN; ++ pLed->BlinkTimes = 24; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if(pLed->bLedBlinkInProgress ==false) ++ { ++ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) ++ { ++ return; ++ } ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ pLed->bLedBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_TXRX; ++ pLed->BlinkTimes = 2; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_START_WPS: //wait until xinpin finish ++ case LED_CTL_START_WPS_BOTTON: ++ if(pLed1->bLedWPSBlinkInProgress) ++ { ++ pLed1->bLedWPSBlinkInProgress = false; ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ pLed1->CurrLedState = RTW_LED_OFF; ++ ++ if(pLed1->bLedOn) ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ ++ if(pLed->bLedWPSBlinkInProgress ==false) ++ { ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if(pLed->bLedScanBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ pLed->bLedWPSBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_WPS; ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ } ++ } ++ break; ++ ++ case LED_CTL_STOP_WPS: //WPS connect success ++ if(pLed->bLedWPSBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ ++ break; ++ ++ case LED_CTL_STOP_WPS_FAIL: //WPS authentication fail ++ if(pLed->bLedWPSBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ ++ //LED1 settings ++ if(pLed1->bLedWPSBlinkInProgress) ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ else ++ pLed1->bLedWPSBlinkInProgress = true; ++ ++ pLed1->CurrLedState = LED_BLINK_WPS_STOP; ++ if( pLed1->bLedOn ) ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ ++ break; ++ ++ case LED_CTL_STOP_WPS_FAIL_OVERLAP: //WPS session overlap ++ if(pLed->bLedWPSBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ ++ //LED1 settings ++ if(pLed1->bLedWPSBlinkInProgress) ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ else ++ pLed1->bLedWPSBlinkInProgress = true; ++ ++ pLed1->CurrLedState = LED_BLINK_WPS_STOP_OVERLAP; ++ pLed1->BlinkTimes = 10; ++ if( pLed1->bLedOn ) ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); ++ ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ ++ if( pLed->bLedNoLinkBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ if( pLed->bLedLinkBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedLinkBlinkInProgress = false; ++ } ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if( pLed->bLedWPSBlinkInProgress ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ if( pLed->bLedStartToLinkBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedStartToLinkBlinkInProgress = false; ++ } ++ ++ if( pLed1->bLedWPSBlinkInProgress ) ++ { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->bLedWPSBlinkInProgress = false; ++ } ++ ++ pLed1->BlinkingLedState = LED_UNKNOWN; ++ SwLedOff(padapter, pLed); ++ SwLedOff(padapter, pLed1); ++ break; ++ ++ case LED_CTL_CONNECTION_NO_TRANSFER: ++ if(pLed->bLedBlinkInProgress == false) ++ { ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ pLed->bLedBlinkInProgress = true; ++ ++ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ } ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led %d\n", pLed->CurrLedState)); ++} ++ ++ ++ ++ //Sercomm-Belkin, added by chiyoko, 20090415 ++static void ++SwLedControlMode5( ++ _adapter *padapter, ++ LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); ++ PLED_USB pLed = &(ledpriv->SwLed0); ++ ++ if(pEEPROM->CustomerID == RT_CID_819x_CAMEO) ++ pLed = &(ledpriv->SwLed1); ++ ++ switch(LedAction) ++ { ++ case LED_CTL_POWER_ON: ++ case LED_CTL_NO_LINK: ++ case LED_CTL_LINK: //solid blue ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ ++ _set_timer(&(pLed->BlinkTimer), 0); ++ break; ++ ++ case LED_CTL_SITE_SURVEY: ++ if((pmlmepriv->LinkDetectInfo.bBusyTraffic) && (check_fwstate(pmlmepriv, _FW_LINKED)== true)) ++ ; ++ else if(pLed->bLedScanBlinkInProgress ==false) ++ { ++ if(pLed->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ pLed->bLedScanBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SCAN; ++ pLed->BlinkTimes = 24; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if(pLed->bLedBlinkInProgress ==false) ++ { ++ if(pLed->CurrLedState == LED_BLINK_SCAN) ++ { ++ return; ++ } ++ pLed->bLedBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_TXRX; ++ pLed->BlinkTimes = 2; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ ++ SwLedOff(padapter, pLed); ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led %d\n", pLed->CurrLedState)); ++} ++ ++ //WNC-Corega, added by chiyoko, 20090902 ++static void ++SwLedControlMode6( ++ _adapter *padapter, ++ LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ PLED_USB pLed0 = &(ledpriv->SwLed0); ++ ++ switch(LedAction) ++ { ++ case LED_CTL_POWER_ON: ++ case LED_CTL_LINK: ++ case LED_CTL_NO_LINK: ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->CurrLedState = RTW_LED_ON; ++ pLed0->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed0->BlinkTimer), 0); ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ SwLedOff(padapter, pLed0); ++ break; ++ ++ default: ++ break; ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("ledcontrol 6 Led %d\n", pLed0->CurrLedState)); ++} ++ ++//Netgear, added by sinda, 2011/11/11 ++static void ++ SwLedControlMode7( ++ PADAPTER Adapter, ++ LED_CTL_MODE LedAction ++ ) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ PLED_USB pLed = &(ledpriv->SwLed0); ++ ++ switch(LedAction) ++ { ++ case LED_CTL_SITE_SURVEY: ++ if(pmlmepriv->LinkDetectInfo.bBusyTraffic) ++ ; ++ else if(pLed->bLedScanBlinkInProgress == false) ++ { ++ if(IS_LED_WPS_BLINKING(pLed)) ++ return; ++ ++ if(pLed->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ pLed->bLedScanBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SCAN; ++ pLed->BlinkTimes = 6; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); ++ } ++ break; ++ ++ case LED_CTL_LINK: ++ if(IS_LED_WPS_BLINKING(pLed)) ++ return; ++ ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ ++ _set_timer(&(pLed->BlinkTimer), 0); ++ break; ++ ++ case LED_CTL_START_WPS: //wait until xinpin finish ++ case LED_CTL_START_WPS_BOTTON: ++ if(pLed->bLedWPSBlinkInProgress ==false) ++ { ++ if(pLed->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if(pLed->bLedScanBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ pLed->bLedWPSBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_WPS; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); ++ } ++ break; ++ ++ case LED_CTL_STOP_WPS: ++ if(pLed->bLedWPSBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ else ++ { ++ pLed->bLedWPSBlinkInProgress = true; ++ } ++ ++ pLed->CurrLedState = LED_BLINK_WPS_STOP; ++ if(pLed->bLedOn) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ ++ break; ++ ++ ++ case LED_CTL_STOP_WPS_FAIL: ++ case LED_CTL_STOP_WPS_FAIL_OVERLAP: //WPS session overlap ++ if(pLed->bLedWPSBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ break; ++ ++ case LED_CTL_START_TO_LINK: ++ case LED_CTL_NO_LINK: ++ if(!IS_LED_BLINKING(pLed)) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ case LED_CTL_POWER_ON: ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ if( pLed->bLedWPSBlinkInProgress ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ ++ _set_timer(&(pLed->BlinkTimer), 0); ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("LEd control mode 7 CurrLedState %d\n", pLed->CurrLedState)); ++} ++ ++static void ++SwLedControlMode8( ++ PADAPTER Adapter, ++ LED_CTL_MODE LedAction ++ ) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ PLED_USB pLed0 = &(ledpriv->SwLed0); ++ ++ switch(LedAction) ++ { ++ case LED_CTL_LINK: ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->CurrLedState = RTW_LED_ON; ++ pLed0->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed0->BlinkTimer), 0); ++ break; ++ ++ case LED_CTL_NO_LINK: ++ _cancel_timer_ex(&(pLed0->BlinkTimer)); ++ pLed0->CurrLedState = RTW_LED_OFF; ++ pLed0->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed0->BlinkTimer), 0); ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ SwLedOff(Adapter, pLed0); ++ break; ++ ++ default: ++ break; ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 8 %d\n", pLed0->CurrLedState)); ++ ++} ++ ++//page added for Belkin AC950, 20120813 ++static void ++SwLedControlMode9( ++ PADAPTER Adapter, ++ LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ PLED_USB pLed = &(ledpriv->SwLed0); ++ PLED_USB pLed1 = &(ledpriv->SwLed1); ++ PLED_USB pLed2 = &(ledpriv->SwLed2); ++ bool bWPSOverLap = false; ++ ++ switch(LedAction) ++ { ++ case LED_CTL_START_TO_LINK: ++ if(pLed2->bLedBlinkInProgress == false) ++ { ++ pLed2->bLedBlinkInProgress = true; ++ pLed2->BlinkingLedState = RTW_LED_ON; ++ pLed2->CurrLedState = LED_BLINK_LINK_IN_PROCESS; ++ ++ _set_timer(&(pLed2->BlinkTimer), 0); ++ } ++ break; ++ ++ case LED_CTL_LINK: ++ case LED_CTL_NO_LINK: ++ //LED1 settings ++ if(LedAction == LED_CTL_NO_LINK) ++ { ++ //if(pMgntInfo->AuthStatus == AUTH_STATUS_FAILED) ++ if(0) ++ { ++ pLed1->CurrLedState = LED_BLINK_AUTH_ERROR; ++ if( pLed1->bLedOn ) ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ } ++ else ++ { ++ pLed1->CurrLedState = RTW_LED_OFF; ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ if( pLed1->bLedOn ) ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ } ++ } ++ else ++ { ++ pLed1->CurrLedState = RTW_LED_OFF; ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ if( pLed1->bLedOn ) ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ } ++ ++ //LED2 settings ++ if(LedAction == LED_CTL_LINK) ++ { ++ if(Adapter->securitypriv.dot11PrivacyAlgrthm != _NO_PRIVACY_) ++ { ++ if(pLed2->bLedBlinkInProgress ==true) ++ { ++ _cancel_timer_ex(&(pLed2->BlinkTimer)); ++ pLed2->bLedBlinkInProgress = false; ++ } ++ pLed2->CurrLedState = RTW_LED_ON; ++ pLed2->bLedNoLinkBlinkInProgress = true; ++ if(!pLed2->bLedOn) ++ _set_timer(&(pLed2->BlinkTimer), 0); ++ } ++ else ++ { ++ if(pLed2->bLedWPSBlinkInProgress != true) ++ { ++ pLed2->CurrLedState = RTW_LED_OFF; ++ pLed2->BlinkingLedState = RTW_LED_OFF; ++ if(pLed2->bLedOn) ++ _set_timer(&(pLed2->BlinkTimer), 0); ++ } ++ } ++ } ++ else //NO_LINK ++ { ++ if(pLed2->bLedWPSBlinkInProgress == false) ++ { ++ pLed2->CurrLedState = RTW_LED_OFF; ++ pLed2->BlinkingLedState = RTW_LED_OFF; ++ if(pLed2->bLedOn) ++ _set_timer(&(pLed2->BlinkTimer), 0); ++ } ++ } ++ ++ //LED0 settings ++ if( pLed->bLedNoLinkBlinkInProgress == false ) ++ { ++ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) ++ { ++ return; ++ } ++ if(pLed->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ ++ pLed->bLedNoLinkBlinkInProgress = true; ++ if(IS_HARDWARE_TYPE_8192DU(Adapter) || IS_HARDWARE_TYPE_8812AU(Adapter)) ++ { ++ if(LedAction == LED_CTL_LINK) ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; ++ } ++ else ++ { ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ } ++ else ++ { ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ } ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ } ++ ++ break; ++ ++ case LED_CTL_SITE_SURVEY: ++ if((pmlmepriv->LinkDetectInfo.bBusyTraffic) && (check_fwstate(pmlmepriv, _FW_LINKED)== true)) ++ ; ++ else //if(pLed->bLedScanBlinkInProgress ==false) ++ { ++ if(IS_LED_WPS_BLINKING(pLed)) ++ return; ++ ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ if(pLed->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ pLed->bLedScanBlinkInProgress = true; ++ if(IS_HARDWARE_TYPE_8192D(Adapter)) ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ else ++ pLed->CurrLedState = LED_BLINK_SCAN; ++ pLed->BlinkTimes = 24; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ ++ } ++ break; ++ ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if(pLed->bLedBlinkInProgress == false) ++ { ++ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) ++ { ++ return; ++ } ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ pLed->bLedBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_TXRX; ++ pLed->BlinkTimes = 2; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_START_WPS: //wait until xinpin finish ++ case LED_CTL_START_WPS_BOTTON: ++ pLed2->bLedBlinkInProgress = true; ++ pLed2->BlinkingLedState = RTW_LED_ON; ++ pLed2->CurrLedState = LED_BLINK_LINK_IN_PROCESS; ++ pLed2->bLedWPSBlinkInProgress = true; ++ ++ _set_timer(&(pLed2->BlinkTimer), 0); ++ ++ break; ++ ++ case LED_CTL_STOP_WPS: //WPS connect success ++ //LED2 settings ++ if(pLed2->bLedWPSBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed2->BlinkTimer)); ++ pLed2->bLedBlinkInProgress = false; ++ pLed2->bLedWPSBlinkInProgress = false; ++ } ++ pLed2->CurrLedState = RTW_LED_ON; ++ pLed2->bLedNoLinkBlinkInProgress = true; ++ if(!pLed2->bLedOn) ++ _set_timer(&(pLed2->BlinkTimer), 0); ++ ++ //LED1 settings ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->CurrLedState = RTW_LED_OFF; ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ if( pLed1->bLedOn ) ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ ++ ++ break; ++ ++ case LED_CTL_STOP_WPS_FAIL: //WPS authentication fail ++ //LED1 settings ++ if(bWPSOverLap == false) ++ { ++ pLed1->CurrLedState = LED_BLINK_AUTH_ERROR; ++ pLed1->BlinkTimes = 50; ++ if( pLed1->bLedOn ) ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ } ++ else ++ { ++ bWPSOverLap = false; ++ pLed1->CurrLedState = RTW_LED_OFF; ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ } ++ ++ //LED2 settings ++ pLed2->CurrLedState = RTW_LED_OFF; ++ pLed2->BlinkingLedState = RTW_LED_OFF; ++ pLed2->bLedWPSBlinkInProgress = false; ++ if( pLed2->bLedOn ) ++ _set_timer(&(pLed2->BlinkTimer), 0); ++ ++ break; ++ ++ case LED_CTL_STOP_WPS_FAIL_OVERLAP: //WPS session overlap ++ //LED1 settings ++ bWPSOverLap = true; ++ pLed1->CurrLedState = LED_BLINK_WPS_STOP_OVERLAP; ++ pLed1->BlinkTimes = 10; ++ pLed1->BlinkCounter = 50; ++ if( pLed1->bLedOn ) ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ ++ //LED2 settings ++ pLed2->CurrLedState = RTW_LED_OFF; ++ pLed2->BlinkingLedState = RTW_LED_OFF; ++ pLed2->bLedWPSBlinkInProgress = false; ++ if( pLed2->bLedOn ) ++ _set_timer(&(pLed2->BlinkTimer), 0); ++ ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ ++ if( pLed->bLedNoLinkBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ if( pLed->bLedLinkBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedLinkBlinkInProgress = false; ++ } ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if( pLed->bLedWPSBlinkInProgress ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ if( pLed->bLedStartToLinkBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedStartToLinkBlinkInProgress = false; ++ } ++ ++ if( pLed1->bLedWPSBlinkInProgress ) ++ { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->bLedWPSBlinkInProgress = false; ++ } ++ ++ ++ pLed1->BlinkingLedState = LED_UNKNOWN; ++ SwLedOff(Adapter, pLed); ++ SwLedOff(Adapter, pLed1); ++ break; ++ ++ case LED_CTL_CONNECTION_NO_TRANSFER: ++ if(pLed->bLedBlinkInProgress == false) ++ { ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ pLed->bLedBlinkInProgress = true; ++ ++ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ } ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 9 Led %d\n", pLed->CurrLedState)); ++} ++ ++//page added for Netgear A6200V2, 20120827 ++static void ++SwLedControlMode10( ++ PADAPTER Adapter, ++ LED_CTL_MODE LedAction ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ PLED_USB pLed = &(ledpriv->SwLed0); ++ PLED_USB pLed1 = &(ledpriv->SwLed1); ++ ++ switch(LedAction) ++ { ++ case LED_CTL_START_TO_LINK: ++ if(pLed1->bLedBlinkInProgress == false) ++ { ++ pLed1->bLedBlinkInProgress = true; ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ pLed1->CurrLedState = LED_BLINK_LINK_IN_PROCESS; ++ ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ } ++ break; ++ ++ case LED_CTL_LINK: ++ case LED_CTL_NO_LINK: ++ if(LedAction == LED_CTL_LINK) ++ { ++ if(pLed->bLedWPSBlinkInProgress == true || pLed1->bLedWPSBlinkInProgress == true) ++ ; ++ else ++ { ++ if(pHalData->CurrentBandType == BAND_ON_2_4G) ++ //LED0 settings ++ { ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ if(pLed->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ _set_timer(&(pLed->BlinkTimer), 0); ++ ++ pLed1->CurrLedState = RTW_LED_OFF; ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ } ++ else if(pHalData->CurrentBandType == BAND_ON_5G) ++ //LED1 settings ++ { ++ pLed1->CurrLedState = RTW_LED_ON; ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ if(pLed1->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->bLedBlinkInProgress = false; ++ } ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ } ++ } ++ else if(LedAction == LED_CTL_NO_LINK) //TODO by page ++ { ++ if(pLed->bLedWPSBlinkInProgress == true || pLed1->bLedWPSBlinkInProgress == true) ++ ; ++ else ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ if( pLed->bLedOn ) ++ _set_timer(&(pLed->BlinkTimer), 0); ++ ++ pLed1->CurrLedState = RTW_LED_OFF; ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ if( pLed1->bLedOn ) ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ } ++ } ++ ++ break; ++ ++ case LED_CTL_SITE_SURVEY: ++ if(check_fwstate(pmlmepriv, _FW_LINKED)== true) ++ ; //don't blink when media connect ++ else //if(pLed->bLedScanBlinkInProgress ==false) ++ { ++ if(IS_LED_WPS_BLINKING(pLed) || IS_LED_WPS_BLINKING(pLed1)) ++ return; ++ ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ if(pLed->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ pLed->bLedScanBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SCAN; ++ pLed->BlinkTimes = 12; ++ pLed->BlinkingLedState = LED_BLINK_SCAN; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ ++ if(pLed1->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->bLedNoLinkBlinkInProgress = false; ++ } ++ if(pLed1->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->bLedBlinkInProgress = false; ++ } ++ pLed1->bLedScanBlinkInProgress = true; ++ pLed1->CurrLedState = LED_BLINK_SCAN; ++ pLed1->BlinkTimes = 12; ++ pLed1->BlinkingLedState = LED_BLINK_SCAN; ++ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_LINK_SLOWLY_INTERVAL_NETGEAR); ++ ++ } ++ break; ++ ++ case LED_CTL_START_WPS: //wait until xinpin finish ++ case LED_CTL_START_WPS_BOTTON: ++ //LED0 settings ++ if(pLed->bLedBlinkInProgress == false) ++ { ++ pLed->bLedBlinkInProgress = true; ++ pLed->bLedWPSBlinkInProgress = true; ++ pLed->BlinkingLedState = LED_BLINK_WPS; ++ pLed->CurrLedState = LED_BLINK_WPS; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ ++ //LED1 settings ++ if(pLed1->bLedBlinkInProgress == false) ++ { ++ pLed1->bLedBlinkInProgress = true; ++ pLed1->bLedWPSBlinkInProgress = true; ++ pLed1->BlinkingLedState = LED_BLINK_WPS; ++ pLed1->CurrLedState = LED_BLINK_WPS; ++ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_NORMAL_INTERVAL+LED_BLINK_LINK_INTERVAL_NETGEAR); ++ } ++ ++ ++ break; ++ ++ case LED_CTL_STOP_WPS: //WPS connect success ++ if(pHalData->CurrentBandType == BAND_ON_2_4G) ++ //LED0 settings ++ { ++ pLed->bLedWPSBlinkInProgress = false; ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ if(pLed->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ _set_timer(&(pLed->BlinkTimer), 0); ++ ++ pLed1->CurrLedState = RTW_LED_OFF; ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ } ++ else if(pHalData->CurrentBandType == BAND_ON_5G) ++ //LED1 settings ++ { ++ pLed1->bLedWPSBlinkInProgress = false; ++ pLed1->CurrLedState = RTW_LED_ON; ++ pLed1->BlinkingLedState = RTW_LED_ON; ++ if(pLed1->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed1->BlinkTimer)); ++ pLed1->bLedBlinkInProgress = false; ++ } ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ ++ break; ++ ++ case LED_CTL_STOP_WPS_FAIL: //WPS authentication fail ++ //LED1 settings ++ pLed1->bLedWPSBlinkInProgress = false; ++ pLed1->CurrLedState = RTW_LED_OFF; ++ pLed1->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed1->BlinkTimer), 0); ++ ++ //LED0 settings ++ pLed->bLedWPSBlinkInProgress = false; ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ if( pLed->bLedOn ) ++ _set_timer(&(pLed->BlinkTimer), 0); ++ ++ break; ++ ++ ++ default: ++ break; ++ ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 10 Led %d\n", pLed->CurrLedState)); ++} ++ ++ //Edimax-ASUS, added by Page, 20121221 ++static void ++SwLedControlMode11( ++ PADAPTER Adapter, ++ LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ PLED_USB pLed = &(ledpriv->SwLed0); ++ ++ switch(LedAction) ++ { ++ case LED_CTL_POWER_ON: ++ case LED_CTL_START_TO_LINK: ++ case LED_CTL_NO_LINK: ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ break; ++ ++ case LED_CTL_LINK: ++ if( pLed->bLedBlinkInProgress == true ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ pLed->bLedBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_TXRX; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); ++ break; ++ ++ case LED_CTL_START_WPS: //wait until xinpin finish ++ case LED_CTL_START_WPS_BOTTON: ++ if(pLed->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ pLed->bLedWPSBlinkInProgress = true; ++ pLed->bLedBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_WPS; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ pLed->BlinkTimes = 5; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ ++ break; ++ ++ ++ case LED_CTL_STOP_WPS: ++ case LED_CTL_STOP_WPS_FAIL: ++ if(pLed->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ pLed->CurrLedState = LED_BLINK_WPS_STOP; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ ++ if( pLed->bLedNoLinkBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ if( pLed->bLedLinkBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedLinkBlinkInProgress = false; ++ } ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if( pLed->bLedWPSBlinkInProgress ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led mode 1 CurrLedState %d\n", pLed->CurrLedState)); ++} ++ ++// page added for NEC ++ ++static void ++SwLedControlMode12( ++ PADAPTER Adapter, ++ LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ PLED_USB pLed = &(ledpriv->SwLed0); ++ ++ switch(LedAction) ++ { ++ case LED_CTL_POWER_ON: ++ case LED_CTL_NO_LINK: ++ case LED_CTL_LINK: ++ case LED_CTL_SITE_SURVEY: ++ ++ if( pLed->bLedNoLinkBlinkInProgress == false ) ++ { ++ if(pLed->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ ++ pLed->bLedNoLinkBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_SLOWLY; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_TX: ++ case LED_CTL_RX: ++ if(pLed->bLedBlinkInProgress == false) ++ { ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ pLed->bLedBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_TXRX; ++ pLed->BlinkTimes = 2; ++ if( pLed->bLedOn ) ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ else ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); ++ } ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ ++ if(pLed->bLedNoLinkBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedNoLinkBlinkInProgress = false; ++ } ++ ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SWLed12 %d\n", pLed->CurrLedState)); ++} ++ ++// Maddest add for NETGEAR R6100 ++ ++static void ++SwLedControlMode13( ++ PADAPTER Adapter, ++ LED_CTL_MODE LedAction ++) ++{ ++ struct led_priv *ledpriv = &(Adapter->ledpriv); ++ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ PLED_USB pLed = &(ledpriv->SwLed0); ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 13 CurrLedState %d, LedAction %d\n", pLed->CurrLedState,LedAction)); ++ switch(LedAction) ++ { ++ case LED_CTL_LINK: ++ if(pLed->bLedWPSBlinkInProgress) ++ { ++ return; ++ } ++ ++ ++ pLed->CurrLedState = RTW_LED_ON; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ ++ _set_timer(&(pLed->BlinkTimer), 0); ++ break; ++ ++ case LED_CTL_START_WPS: //wait until xinpin finish ++ case LED_CTL_START_WPS_BOTTON: ++ if(pLed->bLedWPSBlinkInProgress == false) ++ { ++ if(pLed->bLedBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if(pLed->bLedScanBlinkInProgress == true) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ pLed->bLedWPSBlinkInProgress = true; ++ pLed->CurrLedState = LED_BLINK_WPS; ++ if( pLed->bLedOn ) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_OFF_INTERVAL_NETGEAR); ++ } ++ else ++ { ++ pLed->BlinkingLedState = RTW_LED_ON; ++ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_ON_INTERVAL_NETGEAR); ++ } ++ } ++ break; ++ ++ case LED_CTL_STOP_WPS: ++ if(pLed->bLedWPSBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ else ++ { ++ pLed->bLedWPSBlinkInProgress = true; ++ } ++ ++ pLed->bLedWPSBlinkInProgress = false; ++ pLed->CurrLedState = LED_BLINK_WPS_STOP; ++ if(pLed->bLedOn) ++ { ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ ++ break; ++ ++ ++ case LED_CTL_STOP_WPS_FAIL: ++ case LED_CTL_STOP_WPS_FAIL_OVERLAP: //WPS session overlap ++ if(pLed->bLedWPSBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ break; ++ ++ case LED_CTL_START_TO_LINK: ++ if((pLed->bLedBlinkInProgress == false) && (pLed->bLedWPSBlinkInProgress == false)) ++ { ++ pLed->bLedBlinkInProgress = true; ++ pLed->BlinkingLedState = RTW_LED_ON; ++ pLed->CurrLedState = LED_BLINK_LINK_IN_PROCESS; ++ ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ break; ++ ++ case LED_CTL_NO_LINK: ++ ++ if(pLed->bLedWPSBlinkInProgress) ++ { ++ return; ++ } ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ //if(!IS_LED_BLINKING(pLed)) ++ { ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ _set_timer(&(pLed->BlinkTimer), 0); ++ } ++ break; ++ ++ case LED_CTL_POWER_OFF: ++ case LED_CTL_POWER_ON: ++ pLed->CurrLedState = RTW_LED_OFF; ++ pLed->BlinkingLedState = RTW_LED_OFF; ++ if( pLed->bLedBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedBlinkInProgress = false; ++ } ++ if( pLed->bLedScanBlinkInProgress) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedScanBlinkInProgress = false; ++ } ++ if( pLed->bLedWPSBlinkInProgress ) ++ { ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ pLed->bLedWPSBlinkInProgress = false; ++ } ++ ++ if (LedAction == LED_CTL_POWER_ON) ++ _set_timer(&(pLed->BlinkTimer), 0); ++ else ++ SwLedOff(Adapter, pLed); ++ break; ++ ++ default: ++ break; ++ ++ } ++ ++ ++} ++ ++void ++LedControlUSB( ++ _adapter *padapter, ++ LED_CTL_MODE LedAction ++ ) ++{ ++ struct led_priv *ledpriv = &(padapter->ledpriv); ++ ++#if(MP_DRIVER == 1) ++ if (padapter->registrypriv.mp_mode == 1) ++ return; ++#endif ++ ++ if( (padapter->bSurpriseRemoved == true) ||(padapter->hw_init_completed == false) ) ++ { ++ return; ++ } ++ ++ if( ledpriv->bRegUseLed == false) ++ return; ++ ++ //if(priv->bInHctTest) ++ // return; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ // Only do led action for PRIMARY_ADAPTER ++ if (padapter->adapter_type != PRIMARY_ADAPTER) ++ return; ++#endif ++ ++ if( (padapter->pwrctrlpriv.rf_pwrstate != rf_on && ++ padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) && ++ (LedAction == LED_CTL_TX || LedAction == LED_CTL_RX || ++ LedAction == LED_CTL_SITE_SURVEY || ++ LedAction == LED_CTL_LINK || ++ LedAction == LED_CTL_NO_LINK || ++ LedAction == LED_CTL_POWER_ON) ) ++ { ++ return; ++ } ++ ++ switch(ledpriv->LedStrategy) ++ { ++ case SW_LED_MODE0: ++ SwLedControlMode0(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE1: ++ SwLedControlMode1(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE2: ++ SwLedControlMode2(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE3: ++ SwLedControlMode3(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE4: ++ SwLedControlMode4(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE5: ++ SwLedControlMode5(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE6: ++ SwLedControlMode6(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE7: ++ SwLedControlMode7(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE8: ++ SwLedControlMode8(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE9: ++ SwLedControlMode9(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE10: ++ SwLedControlMode10(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE11: ++ SwLedControlMode11(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE12: ++ SwLedControlMode12(padapter, LedAction); ++ break; ++ ++ case SW_LED_MODE13: ++ SwLedControlMode13(padapter, LedAction); ++ break; ++ ++ default: ++ break; ++ } ++ ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("LedStrategy:%d, LedAction %d\n", ledpriv->LedStrategy,LedAction)); ++} ++ ++// ++// Description: ++// Reset status of LED_871x object. ++// ++void ResetLedStatus(PLED_USB pLed) { ++ ++ pLed->CurrLedState = RTW_LED_OFF; // Current LED state. ++ pLed->bLedOn = false; // true if LED is ON, false if LED is OFF. ++ ++ pLed->bLedBlinkInProgress = false; // true if it is blinking, false o.w.. ++ pLed->bLedWPSBlinkInProgress = false; ++ ++ pLed->BlinkTimes = 0; // Number of times to toggle led state for blinking. ++ pLed->BlinkCounter = 0; ++ pLed->BlinkingLedState = LED_UNKNOWN; // Next state for blinking, either RTW_LED_ON or RTW_LED_OFF are. ++ ++ pLed->bLedNoLinkBlinkInProgress = false; ++ pLed->bLedLinkBlinkInProgress = false; ++ pLed->bLedStartToLinkBlinkInProgress = false; ++ pLed->bLedScanBlinkInProgress = false; ++} ++ ++ // ++// Description: ++// Initialize an LED_871x object. ++// ++void ++InitLed( ++ _adapter *padapter, ++ PLED_USB pLed, ++ LED_PIN LedPin ++ ) ++{ ++ pLed->padapter = padapter; ++ pLed->LedPin = LedPin; ++ ++ ResetLedStatus(pLed); ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++ _init_timer(&(pLed->BlinkTimer), padapter->pnetdev, BlinkTimerCallback, pLed); ++#else ++ timer_setup(&pLed->BlinkTimer, BlinkTimerCallback, 0); ++#endif ++ _init_workitem(&(pLed->BlinkWorkItem), BlinkWorkItemCallback, pLed); ++} ++ ++ ++// ++// Description: ++// DeInitialize an LED_871x object. ++// ++void ++DeInitLed( ++ PLED_USB pLed ++ ) ++{ ++ _cancel_workitem_sync(&(pLed->BlinkWorkItem)); ++ _cancel_timer_ex(&(pLed->BlinkTimer)); ++ ResetLedStatus(pLed); ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm.c 2018-02-06 17:42:30.711967179 +0200 +@@ -0,0 +1,4874 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++ ++#include "odm_precomp.h" ++ ++ ++const u2Byte dB_Invert_Table[8][12] = { ++ { 1, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4}, ++ { 4, 5, 6, 6, 7, 8, 9, 10, 11, 13, 14, 16}, ++ { 18, 20, 22, 25, 28, 32, 35, 40, 45, 50, 56, 63}, ++ { 71, 79, 89, 100, 112, 126, 141, 158, 178, 200, 224, 251}, ++ { 282, 316, 355, 398, 447, 501, 562, 631, 708, 794, 891, 1000}, ++ { 1122, 1259, 1413, 1585, 1778, 1995, 2239, 2512, 2818, 3162, 3548, 3981}, ++ { 4467, 5012, 5623, 6310, 7079, 7943, 8913, 10000, 11220, 12589, 14125, 15849}, ++ { 17783, 19953, 22387, 25119, 28184, 31623, 35481, 39811, 44668, 50119, 56234, 65535}}; ++ ++// 20100515 Joseph: Add global variable to keep temporary scan list for antenna switching test. ++//u1Byte tmpNumBssDesc; ++//RT_WLAN_BSS tmpbssDesc[MAX_BSS_DESC]; ++ ++static u4Byte edca_setting_UL[HT_IOT_PEER_MAX] = ++// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU MARVELL 92U_AP SELF_AP(DownLink/Tx) ++{ 0x5e4322, 0xa44f, 0x5e4322, 0x5ea32b, 0x5ea422, 0x5ea322, 0x3ea430, 0x5ea42b, 0x5ea44f, 0x5e4322, 0x5e4322}; ++ ++ ++static u4Byte edca_setting_DL[HT_IOT_PEER_MAX] = ++// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU, MARVELL 92U_AP SELF_AP(UpLink/Rx) ++{ 0xa44f, 0x5ea44f, 0x5e4322, 0x5ea42b, 0xa44f, 0xa630, 0x5ea630, 0x5ea42b, 0xa44f, 0xa42b, 0xa42b}; ++ ++static u4Byte edca_setting_DL_GMode[HT_IOT_PEER_MAX] = ++// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU, MARVELL 92U_AP SELF_AP ++{ 0x4322, 0xa44f, 0x5e4322, 0xa42b, 0x5e4322, 0x4322, 0xa42b, 0x5ea42b, 0xa44f, 0x5e4322, 0x5ea42b}; ++ ++//============================================================ ++// Global var ++//============================================================ ++ ++u4Byte OFDMSwingTable[OFDM_TABLE_SIZE_92D] = { ++ 0x7f8001fe, // 0, +6.0dB ++ 0x788001e2, // 1, +5.5dB ++ 0x71c001c7, // 2, +5.0dB ++ 0x6b8001ae, // 3, +4.5dB ++ 0x65400195, // 4, +4.0dB ++ 0x5fc0017f, // 5, +3.5dB ++ 0x5a400169, // 6, +3.0dB ++ 0x55400155, // 7, +2.5dB ++ 0x50800142, // 8, +2.0dB ++ 0x4c000130, // 9, +1.5dB ++ 0x47c0011f, // 10, +1.0dB ++ 0x43c0010f, // 11, +0.5dB ++ 0x40000100, // 12, +0dB ++ 0x3c8000f2, // 13, -0.5dB ++ 0x390000e4, // 14, -1.0dB ++ 0x35c000d7, // 15, -1.5dB ++ 0x32c000cb, // 16, -2.0dB ++ 0x300000c0, // 17, -2.5dB ++ 0x2d4000b5, // 18, -3.0dB ++ 0x2ac000ab, // 19, -3.5dB ++ 0x288000a2, // 20, -4.0dB ++ 0x26000098, // 21, -4.5dB ++ 0x24000090, // 22, -5.0dB ++ 0x22000088, // 23, -5.5dB ++ 0x20000080, // 24, -6.0dB ++ 0x1e400079, // 25, -6.5dB ++ 0x1c800072, // 26, -7.0dB ++ 0x1b00006c, // 27. -7.5dB ++ 0x19800066, // 28, -8.0dB ++ 0x18000060, // 29, -8.5dB ++ 0x16c0005b, // 30, -9.0dB ++ 0x15800056, // 31, -9.5dB ++ 0x14400051, // 32, -10.0dB ++ 0x1300004c, // 33, -10.5dB ++ 0x12000048, // 34, -11.0dB ++ 0x11000044, // 35, -11.5dB ++ 0x10000040, // 36, -12.0dB ++}; ++ ++u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { ++ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, // 0, +0dB ++ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 1, -0.5dB ++ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 2, -1.0dB ++ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 3, -1.5dB ++ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 4, -2.0dB ++ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 5, -2.5dB ++ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 6, -3.0dB ++ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 7, -3.5dB ++ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 8, -4.0dB ++ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 9, -4.5dB ++ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 10, -5.0dB ++ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 11, -5.5dB ++ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 12, -6.0dB <== default ++ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 13, -6.5dB ++ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 14, -7.0dB ++ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 15, -7.5dB ++ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB ++ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 17, -8.5dB ++ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 18, -9.0dB ++ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 19, -9.5dB ++ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 20, -10.0dB ++ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 21, -10.5dB ++ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 22, -11.0dB ++ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 23, -11.5dB ++ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 24, -12.0dB ++ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 25, -12.5dB ++ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 26, -13.0dB ++ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 27, -13.5dB ++ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 28, -14.0dB ++ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 29, -14.5dB ++ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 30, -15.0dB ++ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 31, -15.5dB ++ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} // 32, -16.0dB ++}; ++ ++ ++u1Byte CCKSwingTable_Ch14[CCK_TABLE_SIZE][8] = { ++ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, // 0, +0dB ++ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 1, -0.5dB ++ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 2, -1.0dB ++ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 3, -1.5dB ++ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 4, -2.0dB ++ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 5, -2.5dB ++ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 6, -3.0dB ++ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 7, -3.5dB ++ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 8, -4.0dB ++ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 9, -4.5dB ++ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 10, -5.0dB ++ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 11, -5.5dB ++ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 12, -6.0dB <== default ++ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 13, -6.5dB ++ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 14, -7.0dB ++ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 15, -7.5dB ++ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB ++ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 17, -8.5dB ++ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 18, -9.0dB ++ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 19, -9.5dB ++ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 20, -10.0dB ++ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 21, -10.5dB ++ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 22, -11.0dB ++ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 23, -11.5dB ++ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 24, -12.0dB ++ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 25, -12.5dB ++ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 26, -13.0dB ++ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 27, -13.5dB ++ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 28, -14.0dB ++ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 29, -14.5dB ++ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 30, -15.0dB ++ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 31, -15.5dB ++ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00} // 32, -16.0dB ++}; ++ ++ ++u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE_92D] = { ++ 0x0b40002d, // 0, -15.0dB ++ 0x0c000030, // 1, -14.5dB ++ 0x0cc00033, // 2, -14.0dB ++ 0x0d800036, // 3, -13.5dB ++ 0x0e400039, // 4, -13.0dB ++ 0x0f00003c, // 5, -12.5dB ++ 0x10000040, // 6, -12.0dB ++ 0x11000044, // 7, -11.5dB ++ 0x12000048, // 8, -11.0dB ++ 0x1300004c, // 9, -10.5dB ++ 0x14400051, // 10, -10.0dB ++ 0x15800056, // 11, -9.5dB ++ 0x16c0005b, // 12, -9.0dB ++ 0x18000060, // 13, -8.5dB ++ 0x19800066, // 14, -8.0dB ++ 0x1b00006c, // 15, -7.5dB ++ 0x1c800072, // 16, -7.0dB ++ 0x1e400079, // 17, -6.5dB ++ 0x20000080, // 18, -6.0dB ++ 0x22000088, // 19, -5.5dB ++ 0x24000090, // 20, -5.0dB ++ 0x26000098, // 21, -4.5dB ++ 0x288000a2, // 22, -4.0dB ++ 0x2ac000ab, // 23, -3.5dB ++ 0x2d4000b5, // 24, -3.0dB ++ 0x300000c0, // 25, -2.5dB ++ 0x32c000cb, // 26, -2.0dB ++ 0x35c000d7, // 27, -1.5dB ++ 0x390000e4, // 28, -1.0dB ++ 0x3c8000f2, // 29, -0.5dB ++ 0x40000100, // 30, +0dB ++ 0x43c0010f, // 31, +0.5dB ++ 0x47c0011f, // 32, +1.0dB ++ 0x4c000130, // 33, +1.5dB ++ 0x50800142, // 34, +2.0dB ++ 0x55400155, // 35, +2.5dB ++ 0x5a400169, // 36, +3.0dB ++ 0x5fc0017f, // 37, +3.5dB ++ 0x65400195, // 38, +4.0dB ++ 0x6b8001ae, // 39, +4.5dB ++ 0x71c001c7, // 40, +5.0dB ++ 0x788001e2, // 41, +5.5dB ++ 0x7f8001fe // 42, +6.0dB ++}; ++ ++ ++u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { ++ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB ++ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB ++ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB ++ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB ++ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB ++ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB ++ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB ++ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB ++ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB ++ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB ++ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB ++ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB ++ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB ++ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB ++ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB ++ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB ++ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB ++ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB ++ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB ++ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB ++ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 20, -6.0dB ++ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB ++ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB ++ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB ++ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB ++ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB ++ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB ++ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB ++ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB ++ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB ++ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB ++ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB ++ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB ++}; ++ ++ ++u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { ++ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB ++ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB ++ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB ++ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB ++ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB ++ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB ++ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB ++ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB ++ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB ++ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB ++ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB ++ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB ++ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB ++ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB ++ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB ++ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB ++ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB ++ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB ++ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB ++ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB ++ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB ++ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB ++ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB ++ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB ++ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB ++ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB ++ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB ++ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB ++ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB ++ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB ++ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB ++ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB ++ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB ++}; ++ ++u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = ++{ ++ 0x081, // 0, -12.0dB ++ 0x088, // 1, -11.5dB ++ 0x090, // 2, -11.0dB ++ 0x099, // 3, -10.5dB ++ 0x0A2, // 4, -10.0dB ++ 0x0AC, // 5, -9.5dB ++ 0x0B6, // 6, -9.0dB ++ 0x0C0, // 7, -8.5dB ++ 0x0CC, // 8, -8.0dB ++ 0x0D8, // 9, -7.5dB ++ 0x0E5, // 10, -7.0dB ++ 0x0F2, // 11, -6.5dB ++ 0x101, // 12, -6.0dB ++ 0x110, // 13, -5.5dB ++ 0x120, // 14, -5.0dB ++ 0x131, // 15, -4.5dB ++ 0x143, // 16, -4.0dB ++ 0x156, // 17, -3.5dB ++ 0x16A, // 18, -3.0dB ++ 0x180, // 19, -2.5dB ++ 0x197, // 20, -2.0dB ++ 0x1AF, // 21, -1.5dB ++ 0x1C8, // 22, -1.0dB ++ 0x1E3, // 23, -0.5dB ++ 0x200, // 24, +0 dB ++ 0x21E, // 25, +0.5dB ++ 0x23E, // 26, +1.0dB ++ 0x261, // 27, +1.5dB ++ 0x285, // 28, +2.0dB ++ 0x2AB, // 29, +2.5dB ++ 0x2D3, // 30, +3.0dB ++ 0x2FE, // 31, +3.5dB ++ 0x32B, // 32, +4.0dB ++ 0x35C, // 33, +4.5dB ++ 0x38E, // 34, +5.0dB ++ 0x3C4, // 35, +5.5dB ++ 0x3FE // 36, +6.0dB ++}; ++ ++#ifdef AP_BUILD_WORKAROUND ++ ++unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { ++ /* +6.0dB */ 0x7f8001fe, ++ /* +5.5dB */ 0x788001e2, ++ /* +5.0dB */ 0x71c001c7, ++ /* +4.5dB */ 0x6b8001ae, ++ /* +4.0dB */ 0x65400195, ++ /* +3.5dB */ 0x5fc0017f, ++ /* +3.0dB */ 0x5a400169, ++ /* +2.5dB */ 0x55400155, ++ /* +2.0dB */ 0x50800142, ++ /* +1.5dB */ 0x4c000130, ++ /* +1.0dB */ 0x47c0011f, ++ /* +0.5dB */ 0x43c0010f, ++ /* 0.0dB */ 0x40000100, ++ /* -0.5dB */ 0x3c8000f2, ++ /* -1.0dB */ 0x390000e4, ++ /* -1.5dB */ 0x35c000d7, ++ /* -2.0dB */ 0x32c000cb, ++ /* -2.5dB */ 0x300000c0, ++ /* -3.0dB */ 0x2d4000b5, ++ /* -3.5dB */ 0x2ac000ab, ++ /* -4.0dB */ 0x288000a2, ++ /* -4.5dB */ 0x26000098, ++ /* -5.0dB */ 0x24000090, ++ /* -5.5dB */ 0x22000088, ++ /* -6.0dB */ 0x20000080, ++ /* -6.5dB */ 0x1a00006c, ++ /* -7.0dB */ 0x1c800072, ++ /* -7.5dB */ 0x18000060, ++ /* -8.0dB */ 0x19800066, ++ /* -8.5dB */ 0x15800056, ++ /* -9.0dB */ 0x26c0005b, ++ /* -9.5dB */ 0x14400051, ++ /* -10.0dB */ 0x24400051, ++ /* -10.5dB */ 0x1300004c, ++ /* -11.0dB */ 0x12000048, ++ /* -11.5dB */ 0x11000044, ++ /* -12.0dB */ 0x10000040 ++}; ++#endif ++ ++//============================================================ ++// Local Function predefine. ++//============================================================ ++ ++//START------------COMMON INFO RELATED---------------// ++void ++odm_CommonInfoSelfInit( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_CommonInfoSelfUpdate( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_CmnInfoInit_Debug( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_CmnInfoHook_Debug( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_CmnInfoUpdate_Debug( ++ PDM_ODM_T pDM_Odm ++ ); ++void ++odm_BasicDbgMessage ++( ++ PDM_ODM_T pDM_Odm ++ ); ++/* ++void ++odm_FindMinimumRSSI( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_IsLinked( ++ PDM_ODM_T pDM_Odm ++ ); ++*/ ++//END------------COMMON INFO RELATED---------------// ++ ++//START---------------DIG---------------------------// ++void ++odm_FalseAlarmCounterStatistics( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_DIGInit( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_DIG( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++bool ++odm_DigAbort( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_CCKPacketDetectionThresh( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_AdaptivityInit( ++ PDM_ODM_T pDM_Odm ++); ++ ++void ++odm_Adaptivity( ++ PDM_ODM_T pDM_Odm, ++ u1Byte IGI ++); ++//END---------------DIG---------------------------// ++ ++//START-------BB POWER SAVE-----------------------// ++void ++odm_DynamicBBPowerSavingInit( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_DynamicBBPowerSaving( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_1R_CCA( ++ PDM_ODM_T pDM_Odm ++ ); ++//END---------BB POWER SAVE-----------------------// ++ ++void ++odm_RefreshRateAdaptiveMaskMP( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_RefreshRateAdaptiveMaskCE( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_RefreshRateAdaptiveMaskAPADSL( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_DynamicATCSwitch_init( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_DynamicATCSwitch( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_Write_CrystalCap( ++ PDM_ODM_T pDM_Odm, ++ u1Byte CrystalCap ++); ++ ++void ++odm_DynamicTxPowerInit( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_DynamicTxPowerRestorePowerIndex( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_DynamicTxPowerNIC( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_DynamicTxPowerSavePowerIndex( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_DynamicTxPowerWritePowerIndex( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Value); ++ ++void ++odm_DynamicTxPower_92C( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_DynamicTxPower_92D( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_MPT_DIGCallback( ++ PRT_TIMER pTimer ++); ++ ++void ++odm_MPT_DIGWorkItemCallback( ++ void * pContext ++ ); ++ ++void ++odm_RSSIMonitorInit( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_RSSIMonitorCheckMP( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_RSSIMonitorCheckCE( ++ PDM_ODM_T pDM_Odm ++ ); ++void ++odm_RSSIMonitorCheckAP( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++ ++ ++void ++odm_RSSIMonitorCheck( ++ PDM_ODM_T pDM_Odm ++ ); ++void ++odm_DynamicTxPower( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_DynamicTxPowerAP( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++ ++void ++odm_SwAntDivInit( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_SwAntDivInit_NIC( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_SwAntDivChkAntSwitch( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Step ++ ); ++ ++void ++odm_SwAntDivChkAntSwitchNIC( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Step ++ ); ++ ++ ++void odm_SwAntDivChkAntSwitchCallback(void *FunctionContext); ++ ++void ++odm_GlobalAdapterCheck( ++ void ++ ); ++ ++void ++odm_RefreshBasicRateMask( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_RefreshRateAdaptiveMask( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++ODM_TXPowerTrackingCheck( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_TXPowerTrackingCheckAP( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++ ++ ++ ++ ++ ++ ++void ++odm_RateAdaptiveMaskInit( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_TXPowerTrackingThermalMeterInit( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++ ++void ++odm_TXPowerTrackingInit( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_TXPowerTrackingCheckMP( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++ ++void ++odm_TXPowerTrackingCheckCE( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++odm_EdcaTurboCheck( ++ PDM_ODM_T pDM_Odm ++ ); ++void ++ODM_EdcaTurboInit( ++ PDM_ODM_T pDM_Odm ++); ++ ++void ++odm_EdcaTurboCheckCE( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++#define RxDefaultAnt1 0x65a9 ++#define RxDefaultAnt2 0x569a ++ ++void ++odm_InitHybridAntDiv( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++bool ++odm_StaDefAntSel( ++ PDM_ODM_T pDM_Odm, ++ u4Byte OFDM_Ant1_Cnt, ++ u4Byte OFDM_Ant2_Cnt, ++ u4Byte CCK_Ant1_Cnt, ++ u4Byte CCK_Ant2_Cnt, ++ u1Byte *pDefAnt ++ ); ++ ++void ++odm_SetRxIdleAnt( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Ant, ++ bool bDualPath ++); ++ ++ ++ ++void ++odm_HwAntDiv( ++ PDM_ODM_T pDM_Odm ++); ++ ++void odm_PathDiversityInit(PDM_ODM_T pDM_Odm); ++void odm_PathDiversity( PDM_ODM_T pDM_Odm); ++ ++//============================================================ ++//3 Export Interface ++//============================================================ ++ ++// ++// 2011/09/21 MH Add to describe different team necessary resource allocate?? ++// ++void ++ODM_DMInit( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ ++ //2012.05.03 Luke: For all IC series ++ odm_CommonInfoSelfInit(pDM_Odm); ++ odm_CmnInfoInit_Debug(pDM_Odm); ++ odm_DIGInit(pDM_Odm); ++ odm_AdaptivityInit(pDM_Odm); ++ odm_RateAdaptiveMaskInit(pDM_Odm); ++ ++ if ( *(pDM_Odm->mp_mode) != 1) ++ odm_PathDiversityInit(pDM_Odm); ++ ODM_EdcaTurboInit(pDM_Odm); ++ ++ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ odm_TXPowerTrackingInit(pDM_Odm); ++ if (*(pDM_Odm->mp_mode) != 1) ++ odm_InitHybridAntDiv(pDM_Odm); ++ } else if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { ++ odm_DynamicBBPowerSavingInit(pDM_Odm); ++ odm_DynamicTxPowerInit(pDM_Odm); ++ odm_TXPowerTrackingInit(pDM_Odm); ++ ++ if ( *(pDM_Odm->mp_mode) != 1) { ++ if(pDM_Odm->SupportICType==ODM_RTL8723A) { ++ odm_SwAntDivInit(pDM_Odm); ++ } else if(pDM_Odm->SupportICType & (ODM_RTL8192C|ODM_RTL8192D)) { ++ if(pDM_Odm->AntDivType == HW_ANTDIV) ++ odm_InitHybridAntDiv(pDM_Odm); ++ else ++ odm_SwAntDivInit(pDM_Odm); ++ } else { ++ odm_InitHybridAntDiv(pDM_Odm); ++ } ++ } ++ } ++ ++ odm_DynamicATCSwitch_init(pDM_Odm); ++} ++ ++// ++// 2011/09/20 MH This is the entry pointer for all team to execute HW out source DM. ++// You can not add any dummy function here, be care, you can only use DM structure ++// to perform any new ODM_DM. ++// ++void ++ODM_DMWatchdog( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ //odm_CmnInfoHook_Debug(pDM_Odm); ++ //odm_CmnInfoUpdate_Debug(pDM_Odm); ++ ++ odm_CommonInfoSelfUpdate(pDM_Odm); ++ odm_BasicDbgMessage(pDM_Odm); ++ odm_FalseAlarmCounterStatistics(pDM_Odm); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): RSSI=0x%x\n",pDM_Odm->RSSI_Min)); ++ ++ odm_RSSIMonitorCheck(pDM_Odm); ++ ++ //For CE Platform(SPRD or Tablet) ++ //8723A or 8189ES platform ++ //NeilChen--2012--08--24-- ++ //Fix Leave LPS issue ++ if( (pDM_Odm->Adapter->pwrctrlpriv.pwr_mode != PS_MODE_ACTIVE) &&// in LPS mode ++ ( ++ (pDM_Odm->SupportICType & (ODM_RTL8723A ) )|| ++ (pDM_Odm->SupportICType & (ODM_RTL8188E) &&((pDM_Odm->SupportInterface == ODM_ITRF_SDIO)) ) ++ ) ++ ) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("----Step1: odm_DIG is in LPS mode\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("---Step2: 8723AS is in LPS mode\n")); ++ odm_DIGbyRSSI_LPS(pDM_Odm); ++ } ++ else ++ { ++ odm_DIG(pDM_Odm); ++ } ++ ++ { ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ odm_Adaptivity(pDM_Odm, pDM_DigTable->CurIGValue); ++ } ++ odm_CCKPacketDetectionThresh(pDM_Odm); ++ ++ if(*(pDM_Odm->pbPowerSaving)==true) ++ return; ++ ++ ++ odm_RefreshRateAdaptiveMask(pDM_Odm); ++ odm_RefreshBasicRateMask(pDM_Odm); ++ odm_DynamicBBPowerSaving(pDM_Odm); ++ odm_EdcaTurboCheck(pDM_Odm); ++ odm_PathDiversity(pDM_Odm); ++ odm_DynamicATCSwitch(pDM_Odm); ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8192E) ++ return; ++ ++ if ( *(pDM_Odm->mp_mode) != 1) { ++ if(pDM_Odm->SupportICType==ODM_RTL8723A) { ++ odm_SwAntDivChkAntSwitch(pDM_Odm, SWAW_STEP_PEAK); ++ } else if(pDM_Odm->SupportICType & (ODM_RTL8192C|ODM_RTL8192D)) { ++ if(pDM_Odm->AntDivType == HW_ANTDIV) ++ odm_HwAntDiv(pDM_Odm); ++ else ++ odm_SwAntDivChkAntSwitch(pDM_Odm, SWAW_STEP_PEAK); ++ } else { ++ odm_HwAntDiv(pDM_Odm); ++ } ++ } ++ ++ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { ++ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) { ++ ODM_TXPowerTrackingCheck(pDM_Odm); ++ } ++ if(pDM_Odm->SupportICType & ODM_RTL8821) ++ { ++ if(pDM_Odm->bLinked) ++ { ++ if((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) ++ { ++ pDM_Odm->preChannel = *pDM_Odm->pChannel; ++ pDM_Odm->LinkedInterval = 0; ++ } ++ ++ if(pDM_Odm->LinkedInterval < 3) ++ pDM_Odm->LinkedInterval++; ++ ++ if(pDM_Odm->LinkedInterval == 2) ++ { ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ ++ //mark out IQK flow to prevent tx stuck. by Maddest 20130306 ++ //PHY_IQCalibrate_8821A(pAdapter, false); ++ } ++ } ++ else ++ pDM_Odm->LinkedInterval = 0; ++ } ++ } ++ else if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ { ++ if (!(pDM_Odm->SupportICType & (ODM_RTL8723B))) ++ ODM_TXPowerTrackingCheck(pDM_Odm); ++ ++ //odm_EdcaTurboCheck(pDM_Odm); ++ odm_DynamicTxPower(pDM_Odm); ++ ++//2010.05.30 LukeLee: For CE platform, files in IC subfolders may not be included to be compiled, ++// so compile flags must be left here to prevent from compile errors ++ odm_DynamicBBPowerSaving(pDM_Odm); ++ } ++ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt = 0; ++ ++ odm_dtc(pDM_Odm); ++} ++ ++ ++// ++// Init /.. Fixed HW value. Only init time. ++// ++void ++ODM_CmnInfoInit( ++ PDM_ODM_T pDM_Odm, ++ ODM_CMNINFO_E CmnInfo, ++ u4Byte Value ++ ) ++{ ++ //ODM_RT_TRACE(pDM_Odm,); ++ ++ // ++ // This section is used for init value ++ // ++ switch (CmnInfo) ++ { ++ // ++ // Fixed ODM value. ++ // ++ case ODM_CMNINFO_ABILITY: ++ pDM_Odm->SupportAbility = (u4Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_RF_TYPE: ++ pDM_Odm->RFType = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_PLATFORM: ++ pDM_Odm->SupportPlatform = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_INTERFACE: ++ pDM_Odm->SupportInterface = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_MP_TEST_CHIP: ++ pDM_Odm->bIsMPChip= (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_IC_TYPE: ++ pDM_Odm->SupportICType = Value; ++ break; ++ ++ case ODM_CMNINFO_CUT_VER: ++ pDM_Odm->CutVersion = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_FAB_VER: ++ pDM_Odm->FabVersion = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_RFE_TYPE: ++ pDM_Odm->RFEType = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_RF_ANTENNA_TYPE: ++ pDM_Odm->AntDivType= (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_BOARD_TYPE: ++ pDM_Odm->BoardType = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_EXT_LNA: ++ pDM_Odm->ExtLNA = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_5G_EXT_LNA: ++ pDM_Odm->ExtLNA5G = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_EXT_PA: ++ pDM_Odm->ExtPA = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_5G_EXT_PA: ++ pDM_Odm->ExtPA5G = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_EXT_TRSW: ++ pDM_Odm->ExtTRSW = (u1Byte)Value; ++ break; ++ case ODM_CMNINFO_PATCH_ID: ++ pDM_Odm->PatchID = (u1Byte)Value; ++ break; ++ case ODM_CMNINFO_BINHCT_TEST: ++ pDM_Odm->bInHctTest = (bool)Value; ++ break; ++ case ODM_CMNINFO_BWIFI_TEST: ++ pDM_Odm->bWIFITest = (bool)Value; ++ break; ++ ++ case ODM_CMNINFO_SMART_CONCURRENT: ++ pDM_Odm->bDualMacSmartConcurrent = (bool )Value; ++ break; ++ ++ //To remove the compiler warning, must add an empty default statement to handle the other values. ++ default: ++ //do nothing ++ break; ++ ++ } ++ ++} ++ ++ ++void ++ODM_CmnInfoHook( ++ PDM_ODM_T pDM_Odm, ++ ODM_CMNINFO_E CmnInfo, ++ void * pValue ++ ) ++{ ++ // ++ // Hook call by reference pointer. ++ // ++ switch (CmnInfo) ++ { ++ // ++ // Dynamic call by reference pointer. ++ // ++ case ODM_CMNINFO_MAC_PHY_MODE: ++ pDM_Odm->pMacPhyMode = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_TX_UNI: ++ pDM_Odm->pNumTxBytesUnicast = (u8Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_RX_UNI: ++ pDM_Odm->pNumRxBytesUnicast = (u8Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_WM_MODE: ++ pDM_Odm->pWirelessMode = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_BAND: ++ pDM_Odm->pBandType = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_SEC_CHNL_OFFSET: ++ pDM_Odm->pSecChOffset = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_SEC_MODE: ++ pDM_Odm->pSecurity = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_BW: ++ pDM_Odm->pBandWidth = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_CHNL: ++ pDM_Odm->pChannel = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_DMSP_GET_VALUE: ++ pDM_Odm->pbGetValueFromOtherMac = (bool *)pValue; ++ break; ++ ++ case ODM_CMNINFO_BUDDY_ADAPTOR: ++ pDM_Odm->pBuddyAdapter = (PADAPTER *)pValue; ++ break; ++ ++ case ODM_CMNINFO_DMSP_IS_MASTER: ++ pDM_Odm->pbMasterOfDMSP = (bool *)pValue; ++ break; ++ ++ case ODM_CMNINFO_SCAN: ++ pDM_Odm->pbScanInProcess = (bool *)pValue; ++ break; ++ ++ case ODM_CMNINFO_POWER_SAVING: ++ pDM_Odm->pbPowerSaving = (bool *)pValue; ++ break; ++ ++ case ODM_CMNINFO_ONE_PATH_CCA: ++ pDM_Odm->pOnePathCCA = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_DRV_STOP: ++ pDM_Odm->pbDriverStopped = (bool *)pValue; ++ break; ++ ++ case ODM_CMNINFO_PNP_IN: ++ pDM_Odm->pbDriverIsGoingToPnpSetPowerSleep = (bool *)pValue; ++ break; ++ ++ case ODM_CMNINFO_INIT_ON: ++ pDM_Odm->pinit_adpt_in_progress = (bool *)pValue; ++ break; ++ ++ case ODM_CMNINFO_ANT_TEST: ++ pDM_Odm->pAntennaTest = (u1Byte *)pValue; ++ break; ++ ++ case ODM_CMNINFO_NET_CLOSED: ++ pDM_Odm->pbNet_closed = (bool *)pValue; ++ break; ++ ++ case ODM_CMNINFO_FORCED_RATE: ++ pDM_Odm->pForcedDataRate = (pu2Byte)pValue; ++ break; ++ ++ case ODM_CMNINFO_MP_MODE: ++ pDM_Odm->mp_mode = (u1Byte *)pValue; ++ break; ++ ++ //case ODM_CMNINFO_RTSTA_AID: ++ // pDM_Odm->pAidMap = (u1Byte *)pValue; ++ // break; ++ ++ //case ODM_CMNINFO_BT_COEXIST: ++ // pDM_Odm->BTCoexist = (bool *)pValue; ++ ++ //case ODM_CMNINFO_STA_STATUS: ++ //pDM_Odm->pODM_StaInfo[] = (PSTA_INFO_T)pValue; ++ //break; ++ ++ //case ODM_CMNINFO_PHY_STATUS: ++ // pDM_Odm->pPhyInfo = (ODM_PHY_INFO *)pValue; ++ // break; ++ ++ //case ODM_CMNINFO_MAC_STATUS: ++ // pDM_Odm->pMacInfo = (ODM_MAC_INFO *)pValue; ++ // break; ++ //To remove the compiler warning, must add an empty default statement to handle the other values. ++ default: ++ //do nothing ++ break; ++ ++ } ++ ++} ++ ++ ++void ++ODM_CmnInfoPtrArrayHook( ++ PDM_ODM_T pDM_Odm, ++ ODM_CMNINFO_E CmnInfo, ++ u2Byte Index, ++ void * pValue ++ ) ++{ ++ // ++ // Hook call by reference pointer. ++ // ++ switch (CmnInfo) ++ { ++ // ++ // Dynamic call by reference pointer. ++ // ++ case ODM_CMNINFO_STA_STATUS: ++ pDM_Odm->pODM_StaInfo[Index] = (PSTA_INFO_T)pValue; ++ break; ++ //To remove the compiler warning, must add an empty default statement to handle the other values. ++ default: ++ //do nothing ++ break; ++ } ++ ++} ++ ++ ++// ++// Update Band/CHannel/.. The values are dynamic but non-per-packet. ++// ++void ++ODM_CmnInfoUpdate( ++ PDM_ODM_T pDM_Odm, ++ u4Byte CmnInfo, ++ u8Byte Value ++ ) ++{ ++ // ++ // This init variable may be changed in run time. ++ // ++ switch (CmnInfo) ++ { ++ case ODM_CMNINFO_LINK_IN_PROGRESS: ++ pDM_Odm->bLinkInProcess = (bool)Value; ++ break; ++ ++ case ODM_CMNINFO_ABILITY: ++ pDM_Odm->SupportAbility = (u4Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_RF_TYPE: ++ pDM_Odm->RFType = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_WIFI_DIRECT: ++ pDM_Odm->bWIFI_Direct = (bool)Value; ++ break; ++ ++ case ODM_CMNINFO_WIFI_DISPLAY: ++ pDM_Odm->bWIFI_Display = (bool)Value; ++ break; ++ ++ case ODM_CMNINFO_LINK: ++ pDM_Odm->bLinked = (bool)Value; ++ break; ++ ++ case ODM_CMNINFO_RSSI_MIN: ++ pDM_Odm->RSSI_Min= (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_DBG_COMP: ++ pDM_Odm->DebugComponents = Value; ++ break; ++ ++ case ODM_CMNINFO_DBG_LEVEL: ++ pDM_Odm->DebugLevel = (u4Byte)Value; ++ break; ++ case ODM_CMNINFO_RA_THRESHOLD_HIGH: ++ pDM_Odm->RateAdaptive.HighRSSIThresh = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_RA_THRESHOLD_LOW: ++ pDM_Odm->RateAdaptive.LowRSSIThresh = (u1Byte)Value; ++ break; ++ // The following is for BT HS mode and BT coexist mechanism. ++ case ODM_CMNINFO_BT_DISABLED: ++ pDM_Odm->bBtDisabled = (bool)Value; ++ break; ++ ++ case ODM_CMNINFO_BT_HS_CONNECT_PROCESS: ++ pDM_Odm->bBtConnectProcess = (bool)Value; ++ break; ++ ++ case ODM_CMNINFO_BT_HS_RSSI: ++ pDM_Odm->btHsRssi = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_BT_OPERATION: ++ pDM_Odm->bBtHsOperation = (bool)Value; ++ break; ++ ++ case ODM_CMNINFO_BT_LIMITED_DIG: ++ pDM_Odm->bBtLimitedDig = (bool)Value; ++ break; ++ ++ case ODM_CMNINFO_BT_DISABLE_EDCA: ++ pDM_Odm->bBtDisableEdcaTurbo = (bool)Value; ++ break; ++ ++/* ++ case ODM_CMNINFO_OP_MODE: ++ pDM_Odm->OPMode = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_WM_MODE: ++ pDM_Odm->WirelessMode = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_BAND: ++ pDM_Odm->BandType = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_SEC_CHNL_OFFSET: ++ pDM_Odm->SecChOffset = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_SEC_MODE: ++ pDM_Odm->Security = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_BW: ++ pDM_Odm->BandWidth = (u1Byte)Value; ++ break; ++ ++ case ODM_CMNINFO_CHNL: ++ pDM_Odm->Channel = (u1Byte)Value; ++ break; ++*/ ++ default: ++ //do nothing ++ break; ++ } ++ ++ ++} ++ ++void ++odm_CommonInfoSelfInit( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ pDM_Odm->bCckHighPower = (bool) ODM_GetBBReg(pDM_Odm, ODM_REG(CCK_RPT_FORMAT,pDM_Odm), ODM_BIT(CCK_RPT_FORMAT,pDM_Odm)); ++ pDM_Odm->RFPathRxEnable = (u1Byte) ODM_GetBBReg(pDM_Odm, ODM_REG(BB_RX_PATH,pDM_Odm), ODM_BIT(BB_RX_PATH,pDM_Odm)); ++ ++ if(pDM_Odm->SupportICType==ODM_RTL8723A) ++ { ++ pDM_Odm->AntDivType = SW_ANTDIV; ++ } ++ ++ else if(pDM_Odm->SupportICType==ODM_RTL8723B) ++ { ++ //pDM_Odm->AntDivType = S0S1_HW_ANTDIV; ++ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; ++ } ++ ++ else if(pDM_Odm->SupportICType & (ODM_RTL8192C|ODM_RTL8192D)) ++ { ++#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) ++ pDM_Odm->AntDivType = HW_ANTDIV; ++#elif (defined(CONFIG_SW_ANTENNA_DIVERSITY)) ++ pDM_Odm->AntDivType = SW_ANTDIV; ++#endif ++ } ++ pDM_Odm->TxRate = 0xFF; ++ ODM_InitDebugSetting(pDM_Odm); ++} ++ ++void ++odm_CommonInfoSelfUpdate( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u1Byte EntryCnt=0; ++ u1Byte i; ++ PSTA_INFO_T pEntry; ++ ++ if(*(pDM_Odm->pBandWidth) == ODM_BW40M) ++ { ++ if(*(pDM_Odm->pSecChOffset) == 1) ++ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) -2; ++ else if(*(pDM_Odm->pSecChOffset) == 2) ++ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) +2; ++ } ++ else ++ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel); ++ ++ for (i=0; ipODM_StaInfo[i]; ++ if(IS_STA_VALID(pEntry)) ++ EntryCnt++; ++ } ++ if(EntryCnt == 1) ++ pDM_Odm->bOneEntryOnly = true; ++ else ++ pDM_Odm->bOneEntryOnly = false; ++} ++ ++void ++odm_CmnInfoInit_Debug( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_CmnInfoInit_Debug==>\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("SupportPlatform=%d\n",pDM_Odm->SupportPlatform) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("SupportAbility=0x%x\n",pDM_Odm->SupportAbility) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("SupportInterface=%d\n",pDM_Odm->SupportInterface) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("SupportICType=0x%x\n",pDM_Odm->SupportICType) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("CutVersion=%d\n",pDM_Odm->CutVersion) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("FabVersion=%d\n",pDM_Odm->FabVersion) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("RFType=%d\n",pDM_Odm->RFType) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("BoardType=%d\n",pDM_Odm->BoardType) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("ExtLNA=%d\n",pDM_Odm->ExtLNA) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("ExtPA=%d\n",pDM_Odm->ExtPA) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("ExtTRSW=%d\n",pDM_Odm->ExtTRSW) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("PatchID=%d\n",pDM_Odm->PatchID) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bInHctTest=%d\n",pDM_Odm->bInHctTest) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bWIFITest=%d\n",pDM_Odm->bWIFITest) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bDualMacSmartConcurrent=%d\n",pDM_Odm->bDualMacSmartConcurrent) ); ++ ++} ++ ++void ++odm_CmnInfoHook_Debug( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_CmnInfoHook_Debug==>\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pNumTxBytesUnicast=%llu\n",*(pDM_Odm->pNumTxBytesUnicast)) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pNumRxBytesUnicast=%llu\n",*(pDM_Odm->pNumRxBytesUnicast)) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pWirelessMode=0x%x\n",*(pDM_Odm->pWirelessMode)) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pSecChOffset=%d\n",*(pDM_Odm->pSecChOffset)) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pSecurity=%d\n",*(pDM_Odm->pSecurity)) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pBandWidth=%d\n",*(pDM_Odm->pBandWidth)) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pChannel=%d\n",*(pDM_Odm->pChannel)) ); ++ ++ if(pDM_Odm->SupportICType==ODM_RTL8192D) ++ { ++ if(pDM_Odm->pBandType) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pBandType=%d\n",*(pDM_Odm->pBandType)) ); ++ if(pDM_Odm->pMacPhyMode) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pMacPhyMode=%d\n",*(pDM_Odm->pMacPhyMode)) ); ++ if(pDM_Odm->pBuddyAdapter) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pbGetValueFromOtherMac=%d\n",*(pDM_Odm->pbGetValueFromOtherMac)) ); ++ if(pDM_Odm->pBuddyAdapter) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pBuddyAdapter=%p\n",*(pDM_Odm->pBuddyAdapter)) ); ++ if(pDM_Odm->pbMasterOfDMSP) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pbMasterOfDMSP=%d\n",*(pDM_Odm->pbMasterOfDMSP)) ); ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pbScanInProcess=%d\n",*(pDM_Odm->pbScanInProcess)) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pbPowerSaving=%d\n",*(pDM_Odm->pbPowerSaving)) ); ++ ++ if(pDM_Odm->SupportPlatform & (ODM_AP|ODM_ADSL)) ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pOnePathCCA=%d\n",*(pDM_Odm->pOnePathCCA)) ); ++} ++ ++void ++odm_CmnInfoUpdate_Debug( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_CmnInfoUpdate_Debug==>\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bWIFI_Direct=%d\n",pDM_Odm->bWIFI_Direct) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bWIFI_Display=%d\n",pDM_Odm->bWIFI_Display) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bLinked=%d\n",pDM_Odm->bLinked) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("RSSI_Min=%d\n",pDM_Odm->RSSI_Min) ); ++} ++ ++void ++odm_BasicDbgMessage ++( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PFALSE_ALARM_STATISTICS FalseAlmCnt = &(pDM_Odm->FalseAlmCnt); ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_BasicDbgMsg==>\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bLinked = %d, RSSI_Min = %d, CurrentIGI = 0x%x \n", ++ pDM_Odm->bLinked, pDM_Odm->RSSI_Min, pDM_DigTable->CurIGValue) ); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("Cnt_Cck_fail = %d, Cnt_Ofdm_fail = %d, Total False Alarm = %d\n", ++ FalseAlmCnt->Cnt_Cck_fail, FalseAlmCnt->Cnt_Ofdm_fail, FalseAlmCnt->Cnt_all)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("RxRate = 0x%x, RSSI_A = %d, RSSI_B = %d\n", ++ pDM_Odm->RxRate, pDM_Odm->RSSI_A, pDM_Odm->RSSI_B)); ++ ++} ++ ++//3============================================================ ++//3 DIG ++//3============================================================ ++/*----------------------------------------------------------------------------- ++ * Function: odm_DIGInit() ++ * ++ * Overview: Set DIG scheme init value. ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * ++ *---------------------------------------------------------------------------*/ ++void ++ODM_ChangeDynamicInitGainThresh( ++ PDM_ODM_T pDM_Odm, ++ u4Byte DM_Type, ++ u4Byte DM_Value ++ ) ++{ ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++ if (DM_Type == DIG_TYPE_THRESH_HIGH) ++ { ++ pDM_DigTable->RssiHighThresh = DM_Value; ++ } ++ else if (DM_Type == DIG_TYPE_THRESH_LOW) ++ { ++ pDM_DigTable->RssiLowThresh = DM_Value; ++ } ++ else if (DM_Type == DIG_TYPE_ENABLE) ++ { ++ pDM_DigTable->Dig_Enable_Flag = true; ++ } ++ else if (DM_Type == DIG_TYPE_DISABLE) ++ { ++ pDM_DigTable->Dig_Enable_Flag = false; ++ } ++ else if (DM_Type == DIG_TYPE_BACKOFF) ++ { ++ if(DM_Value > 30) ++ DM_Value = 30; ++ pDM_DigTable->BackoffVal = (u1Byte)DM_Value; ++ } ++ else if(DM_Type == DIG_TYPE_RX_GAIN_MIN) ++ { ++ if(DM_Value == 0) ++ DM_Value = 0x1; ++ pDM_DigTable->rx_gain_range_min = (u1Byte)DM_Value; ++ } ++ else if(DM_Type == DIG_TYPE_RX_GAIN_MAX) ++ { ++ if(DM_Value > 0x50) ++ DM_Value = 0x50; ++ pDM_DigTable->rx_gain_range_max = (u1Byte)DM_Value; ++ } ++} /* DM_ChangeDynamicInitGainThresh */ ++ ++int getIGIForDiff(int value_IGI) ++{ ++ #define ONERCCA_LOW_TH 0x30 ++ #define ONERCCA_LOW_DIFF 8 ++ ++ if (value_IGI < ONERCCA_LOW_TH) { ++ if ((ONERCCA_LOW_TH - value_IGI) < ONERCCA_LOW_DIFF) ++ return ONERCCA_LOW_TH; ++ else ++ return value_IGI + ONERCCA_LOW_DIFF; ++ } else { ++ return value_IGI; ++ } ++} ++ ++ ++void ++odm_AdaptivityInit( ++PDM_ODM_T pDM_Odm ++) ++{ ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ ++ if(IS_HARDWARE_TYPE_8723B(pAdapter)) ++ { ++ pDM_Odm->TH_H = 0xf8; //-8dB ++ pDM_Odm->TH_L = 0xfb; //-5dB ++ } ++ else if(IS_HARDWARE_TYPE_8192EE(pAdapter)) ++ { ++ pDM_Odm->TH_H = 0xf0; //-16dB ++ pDM_Odm->TH_L = 0xf3; //-13dB ++ } ++ else ++ { ++ pDM_Odm->TH_H = 0xfa; //-6dB ++ pDM_Odm->TH_L = 0xfd; //-3dB ++ } ++ ++ pDM_Odm->IGI_Base = 0x32; ++ pDM_Odm->IGI_target = 0x1c; ++ pDM_Odm->ForceEDCCA = 0; ++ pDM_Odm->AdapEn_RSSI = 32;//45; ++} ++ ++// Add by Neil Chen to enable edcca to MP Platform ++ ++void ++odm_DynamicATCSwitch_init( ++ PDM_ODM_T pDM_Odm ++) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++} ++ ++void ++odm_DynamicATCSwitch( ++ PDM_ODM_T pDM_Odm ++) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u1Byte CrystalCap,ATC_status_temp = 0; ++ u4Byte packet_count; ++ int CFO_kHz_A,CFO_kHz_B,CFO_ave = 0, Adjust_Xtal = 0; ++ int CFO_ave_diff; ++ ++} ++ ++void ++odm_Write_CrystalCap( ++ PDM_ODM_T pDM_Odm, ++ u1Byte CrystalCap ++) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ if(IS_HARDWARE_TYPE_8192D(Adapter)) ++ { ++ PHY_SetBBReg(Adapter, 0x24, 0xF0, CrystalCap & 0x0F); ++ PHY_SetBBReg(Adapter, 0x28, 0xF0000000, ((CrystalCap & 0xF0) >> 4)); ++ } ++ ++ if(IS_HARDWARE_TYPE_8188E(Adapter)) ++ { ++ // write 0x24[16:11] = 0x24[22:17] = CrystalCap ++ PHY_SetBBReg(Adapter, REG_AFE_XTAL_CTRL, 0x7ff800, (CrystalCap | (CrystalCap << 6))); ++ } ++ ++ if(IS_HARDWARE_TYPE_8812(Adapter)) ++ { ++ // write 0x2C[30:25] = 0x2C[24:19] = CrystalCap ++ CrystalCap = CrystalCap & 0x3F; ++ PHY_SetBBReg(Adapter, REG_MAC_PHY_CTRL, 0x7FF80000, (CrystalCap | (CrystalCap << 6))); ++ } ++ ++ //only for B-cut ++ if ((IS_HARDWARE_TYPE_8723A(Adapter) && pHalData->EEPROMVersion >= 0x01) || ++ IS_HARDWARE_TYPE_8723B(Adapter) ||IS_HARDWARE_TYPE_8192E(Adapter) || IS_HARDWARE_TYPE_8821(Adapter)) ++ { ++ // 0x2C[23:18] = 0x2C[17:12] = CrystalCap ++ CrystalCap = CrystalCap & 0x3F; ++ PHY_SetBBReg(Adapter, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCap | (CrystalCap << 6))); ++ } ++ ++ if(IS_HARDWARE_TYPE_8723AE(Adapter)) ++ PHY_SetBBReg(Adapter, REG_LDOA15_CTRL, bMaskDWord, 0x01572505); ++ ++} ++ ++void ++odm_Adaptivity( ++ PDM_ODM_T pDM_Odm, ++ u1Byte IGI ++) ++{ ++ s4Byte TH_H_dmc, TH_L_dmc; ++ s4Byte TH_H, TH_L, Diff, IGI_target; ++ u4Byte value32; ++ bool EDCCA_State; ++ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY)) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("Go to odm_DynamicEDCCA() \n")); ++ // Add by Neil Chen to enable edcca to MP Platform ++ return; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_Adaptivity() =====> \n")); ++ ++ if(pDM_Odm->bForceThresh) ++ { ++ pDM_Odm->TH_H = pDM_Odm->Force_TH_H; ++ pDM_Odm->TH_L = pDM_Odm->Force_TH_L; ++ } ++ else ++ { ++ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ { ++ if(*pDM_Odm->pBandType == BAND_ON_5G) ++ { ++ pDM_Odm->TH_H = 0xf4;//0xf8; ++ pDM_Odm->TH_L = 0xf7;//0xfb; ++ } ++ else ++ { ++ pDM_Odm->TH_H = 0xf4;//0xfa; ++ pDM_Odm->TH_L = 0xf7;//0xfd; ++ } ++ } ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("pDM_Odm->ForceEDCCA=%d, IGI_Base=0x%x, TH_H=0x%x, TH_L=0x%x, AdapEn_RSSI = %d\n", ++ pDM_Odm->ForceEDCCA, pDM_Odm->IGI_Base, pDM_Odm->TH_H, pDM_Odm->TH_L, pDM_Odm->AdapEn_RSSI)); ++ ++ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ ODM_SetBBReg(pDM_Odm, 0x800, BIT10, 0); //ADC_mask enable ++ ++ if(!pDM_Odm->bLinked) ++ { ++ return; ++ } ++ ++ if(!pDM_Odm->ForceEDCCA) ++ { ++ if(pDM_Odm->RSSI_Min > pDM_Odm->AdapEn_RSSI) ++ EDCCA_State = 1; ++ else if(pDM_Odm->RSSI_Min < (pDM_Odm->AdapEn_RSSI - 5)) ++ EDCCA_State = 0; ++ } ++ else ++ EDCCA_State = 1; ++ //if((pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) && (*pDM_Odm->pBandType == BAND_ON_5G)) ++ //IGI_target = pDM_Odm->IGI_Base; ++ //else ++ { ++ ++ if(*pDM_Odm->pBandWidth == ODM_BW20M) //CHANNEL_WIDTH_20 ++ IGI_target = pDM_Odm->IGI_Base; ++ else if(*pDM_Odm->pBandWidth == ODM_BW40M) ++ IGI_target = pDM_Odm->IGI_Base + 2; ++ else if(*pDM_Odm->pBandWidth == ODM_BW80M) ++ IGI_target = pDM_Odm->IGI_Base + 6; ++ else ++ IGI_target = pDM_Odm->IGI_Base; ++ } ++ ++ pDM_Odm->IGI_target = IGI_target; ++ ++ if(pDM_Odm->TH_H & BIT7) ++ TH_H = pDM_Odm->TH_H | 0xFFFFFF00; ++ else ++ TH_H = pDM_Odm->TH_H; ++ if(pDM_Odm->TH_L & BIT7) ++ TH_L = pDM_Odm->TH_L | 0xFFFFFF00; ++ else ++ TH_L = pDM_Odm->TH_L; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("BandWidth=%s, IGI_target=0x%x, EDCCA_State=%d\n", ++ (*pDM_Odm->pBandWidth==ODM_BW80M)?"80M":((*pDM_Odm->pBandWidth==ODM_BW40M)?"40M":"20M"), IGI_target, EDCCA_State)); ++ ++ if(EDCCA_State == 1) ++ { ++ if(IGI < IGI_target) ++ { ++ Diff = IGI_target -(s4Byte)IGI; ++ TH_H_dmc = TH_H + Diff; ++ if(TH_H_dmc > 10) ++ TH_H_dmc = 10; ++ TH_L_dmc = TH_L + Diff; ++ if(TH_L_dmc > 10) ++ TH_L_dmc = 10; ++ } ++ else ++ { ++ Diff = (s4Byte)IGI - IGI_target; ++ TH_H_dmc = TH_H - Diff; ++ TH_L_dmc = TH_L - Diff; ++ } ++ TH_H_dmc = (TH_H_dmc & 0xFF); ++ TH_L_dmc = (TH_L_dmc & 0xFF); ++ } ++ else ++ { ++ TH_H_dmc = 0x7f; ++ TH_L_dmc = 0x7f; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("IGI=0x%x, TH_H_dmc=0x%x, TH_L_dmc=0x%x\n", ++ IGI, TH_H_dmc, TH_L_dmc)); ++ ++ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ { ++ ODM_SetBBReg(pDM_Odm,rOFDM0_ECCAThreshold, bMaskByte0, TH_L_dmc); ++ ODM_SetBBReg(pDM_Odm,rOFDM0_ECCAThreshold, bMaskByte2, TH_H_dmc); ++ } ++ else ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, 0xFFFF, (TH_H_dmc<<8) | TH_L_dmc); ++} ++ ++ ++void ++ODM_Write_DIG( ++ PDM_ODM_T pDM_Odm, ++ u1Byte CurrentIGI ++ ) ++{ ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++ if(pDM_Odm->StopDIG) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("Stop Writing IGI\n")); ++ return; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("ODM_REG(IGI_A,pDM_Odm)=0x%x, ODM_BIT(IGI,pDM_Odm)=0x%x \n", ++ ODM_REG(IGI_A,pDM_Odm),ODM_BIT(IGI,pDM_Odm))); ++ ++ if(pDM_DigTable->CurIGValue != CurrentIGI)//if(pDM_DigTable->PreIGValue != CurrentIGI) ++ { ++ if(pDM_Odm->SupportPlatform & (ODM_CE|ODM_WIN)) ++ { ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ if(pDM_Odm->RFType != ODM_1T1R) ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ } ++ else if(pDM_Odm->SupportPlatform & (ODM_AP|ODM_ADSL)) ++ { ++ switch(*(pDM_Odm->pOnePathCCA)) ++ { ++ case ODM_CCA_2R: ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ if(pDM_Odm->RFType != ODM_1T1R) ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ break; ++ case ODM_CCA_1R_A: ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ if(pDM_Odm->RFType != ODM_1T1R) ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), getIGIForDiff(CurrentIGI)); ++ break; ++ case ODM_CCA_1R_B: ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), getIGIForDiff(CurrentIGI)); ++ if(pDM_Odm->RFType != ODM_1T1R) ++ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); ++ break; ++ } ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("CurrentIGI(0x%02x). \n",CurrentIGI)); ++ //pDM_DigTable->PreIGValue = pDM_DigTable->CurIGValue; ++ pDM_DigTable->CurIGValue = CurrentIGI; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("ODM_Write_DIG():CurrentIGI=0x%x \n",CurrentIGI)); ++ ++} ++ ++void ++odm_DIGbyRSSI_LPS( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ //PADAPTER pAdapter =pDM_Odm->Adapter; ++ //pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ PFALSE_ALARM_STATISTICS pFalseAlmCnt = &pDM_Odm->FalseAlmCnt; ++ ++ u1Byte RSSI_Lower=DM_DIG_MIN_NIC; //0x1E or 0x1C ++ u1Byte CurrentIGI=pDM_Odm->RSSI_Min; ++ ++ CurrentIGI=CurrentIGI+RSSI_OFFSET_DIG; ++ ++ // Using FW PS mode to make IGI ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("---Neil---odm_DIG is in LPS mode\n")); ++ //Adjust by FA in LPS MODE ++ if(pFalseAlmCnt->Cnt_all> DM_DIG_FA_TH2_LPS) ++ CurrentIGI = CurrentIGI+2; ++ else if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH1_LPS) ++ CurrentIGI = CurrentIGI+1; ++ else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0_LPS) ++ CurrentIGI = CurrentIGI-1; ++ ++ ++ //Lower bound checking ++ ++ //RSSI Lower bound check ++ if((pDM_Odm->RSSI_Min-10) > DM_DIG_MIN_NIC) ++ RSSI_Lower =(pDM_Odm->RSSI_Min-10); ++ else ++ RSSI_Lower =DM_DIG_MIN_NIC; ++ ++ //Upper and Lower Bound checking ++ if(CurrentIGI > DM_DIG_MAX_NIC) ++ CurrentIGI=DM_DIG_MAX_NIC; ++ else if(CurrentIGI < RSSI_Lower) ++ CurrentIGI =RSSI_Lower; ++ ++ ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); ++ ++} ++ ++void ++odm_DIGInit( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++ //pDM_DigTable->Dig_Enable_Flag = true; ++ //pDM_DigTable->Dig_Ext_Port_Stage = DIG_EXT_PORT_STAGE_MAX; ++ pDM_DigTable->CurIGValue = (u1Byte) ODM_GetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm)); ++ //pDM_DigTable->PreIGValue = 0x0; ++ //pDM_DigTable->CurSTAConnectState = pDM_DigTable->PreSTAConnectState = DIG_STA_DISCONNECT; ++ //pDM_DigTable->CurMultiSTAConnectState = DIG_MultiSTA_DISCONNECT; ++ pDM_DigTable->RssiLowThresh = DM_DIG_THRESH_LOW; ++ pDM_DigTable->RssiHighThresh = DM_DIG_THRESH_HIGH; ++ pDM_DigTable->FALowThresh = DMfalseALARM_THRESH_LOW; ++ pDM_DigTable->FAHighThresh = DMfalseALARM_THRESH_HIGH; ++ if(pDM_Odm->BoardType & (ODM_BOARD_EXT_PA|ODM_BOARD_EXT_LNA)) ++ { ++ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; ++ pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; ++ } ++ else ++ { ++ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; ++ pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; ++ } ++ pDM_DigTable->BackoffVal = DM_DIG_BACKOFF_DEFAULT; ++ pDM_DigTable->BackoffVal_range_max = DM_DIG_BACKOFF_MAX; ++ pDM_DigTable->BackoffVal_range_min = DM_DIG_BACKOFF_MIN; ++ pDM_DigTable->PreCCK_CCAThres = 0xFF; ++ pDM_DigTable->CurCCK_CCAThres = 0x83; ++ pDM_DigTable->ForbiddenIGI = DM_DIG_MIN_NIC; ++ pDM_DigTable->LargeFAHit = 0; ++ pDM_DigTable->Recover_cnt = 0; ++ pDM_DigTable->DIG_Dynamic_MIN_0 = DM_DIG_MIN_NIC; ++ pDM_DigTable->DIG_Dynamic_MIN_1 = DM_DIG_MIN_NIC; ++ pDM_DigTable->bMediaConnect_0 = false; ++ pDM_DigTable->bMediaConnect_1 = false; ++ ++ //To Initialize pDM_Odm->bDMInitialGainEnable == false to avoid DIG error ++ pDM_Odm->bDMInitialGainEnable = true; ++ ++ //To Initi BT30 IGI ++ pDM_DigTable->BT30_CurIGI=0x32; ++ ++} ++ ++void ++odm_DigForBtHsMode( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++} ++ ++void ++odm_DIG( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ PFALSE_ALARM_STATISTICS pFalseAlmCnt = &pDM_Odm->FalseAlmCnt; ++ pRXHP_T pRX_HP_Table = &pDM_Odm->DM_RXHP_Table; ++ u1Byte DIG_Dynamic_MIN; ++ u1Byte DIG_MaxOfMin; ++ bool FirstConnect, FirstDisConnect; ++ u1Byte dm_dig_max, dm_dig_min, offset; ++ u1Byte CurrentIGI = pDM_DigTable->CurIGValue; ++ ++#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV ++ if((pDM_Odm->bLinked) && (pDM_Odm->Adapter->registrypriv.force_igi !=0)) ++ { ++ printk("pDM_Odm->RSSI_Min=%d \n",pDM_Odm->RSSI_Min); ++ ODM_Write_DIG(pDM_Odm,pDM_Odm->Adapter->registrypriv.force_igi); ++ return; ++ } ++#endif ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG()==>\n")); ++ if((!(pDM_Odm->SupportAbility&ODM_BB_DIG)) ||(!(pDM_Odm->SupportAbility&ODM_BB_FA_CNT))) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() Return: SupportAbility ODM_BB_DIG or ODM_BB_FA_CNT is disabled\n")); ++ return; ++ } ++ ++ if(*(pDM_Odm->pbScanInProcess)) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() Return: In Scan Progress \n")); ++ return; ++ } ++ ++ //add by Neil Chen to avoid PSD is processing ++ if(pDM_Odm->SupportICType==ODM_RTL8723A) ++ { ++ if(pDM_Odm->bDMInitialGainEnable == false) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() Return: PSD is Processing \n")); ++ return; ++ } ++ } ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8192D) ++ { ++ if(*(pDM_Odm->pMacPhyMode) == ODM_DMSP) ++ { ++ if(*(pDM_Odm->pbMasterOfDMSP)) ++ { ++ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_0; ++ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == false); ++ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == true); ++ } ++ else ++ { ++ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_1; ++ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_1 == false); ++ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_1 == true); ++ } ++ } ++ else ++ { ++ if(*(pDM_Odm->pBandType) == ODM_BAND_5G) ++ { ++ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_0; ++ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == false); ++ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == true); ++ } ++ else ++ { ++ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_1; ++ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_1 == false); ++ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_1 == true); ++ } ++ } ++ } ++ else ++ { ++ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_0; ++ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == false); ++ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == true); ++ } ++ ++ //1 Boundary Decision ++ if(pDM_Odm->SupportICType & (ODM_RTL8192C) &&(pDM_Odm->BoardType & (ODM_BOARD_EXT_LNA | ODM_BOARD_EXT_PA))) ++ { ++ if(pDM_Odm->SupportPlatform & (ODM_AP|ODM_ADSL)) ++ { ++ ++ dm_dig_max = DM_DIG_MAX_AP_HP; ++ dm_dig_min = DM_DIG_MIN_AP_HP; ++ } ++ else ++ { ++ dm_dig_max = DM_DIG_MAX_NIC_HP; ++ dm_dig_min = DM_DIG_MIN_NIC_HP; ++ } ++ DIG_MaxOfMin = DM_DIG_MAX_AP_HP; ++ } ++ else ++ { ++ if(pDM_Odm->SupportPlatform & (ODM_AP|ODM_ADSL)) ++ { ++ dm_dig_max = DM_DIG_MAX_AP; ++ dm_dig_min = DM_DIG_MIN_AP; ++ DIG_MaxOfMin = dm_dig_max; ++ } ++ else ++ { ++ if((pDM_Odm->SupportICType >= ODM_RTL8188E) && (pDM_Odm->SupportPlatform & (ODM_WIN|ODM_CE))) ++ dm_dig_max = 0x5A; ++ else ++ dm_dig_max = DM_DIG_MAX_NIC; ++ ++ if(pDM_Odm->SupportICType != ODM_RTL8821) ++ dm_dig_min = DM_DIG_MIN_NIC; ++ else ++ dm_dig_min = 0x1C; ++ ++ DIG_MaxOfMin = DM_DIG_MAX_AP; ++ } ++ } ++ ++ ++ if(pDM_Odm->bLinked) ++ { ++ if(pDM_Odm->SupportICType&(ODM_RTL8723A/*|ODM_RTL8821*/)) ++ { ++ //2 Upper Bound ++ if(( pDM_Odm->RSSI_Min + 10) > DM_DIG_MAX_NIC ) ++ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; ++ else if(( pDM_Odm->RSSI_Min + 10) < DM_DIG_MIN_NIC ) ++ pDM_DigTable->rx_gain_range_max = DM_DIG_MIN_NIC; ++ else ++ pDM_DigTable->rx_gain_range_max = pDM_Odm->RSSI_Min + 10; ++ ++ //BT is Concurrent ++ ++ if(pDM_Odm->bBtLimitedDig) ++ { ++ if(pDM_Odm->RSSI_Min>10) ++ { ++ if((pDM_Odm->RSSI_Min - 10) > DM_DIG_MAX_NIC) ++ DIG_Dynamic_MIN = DM_DIG_MAX_NIC; ++ else if((pDM_Odm->RSSI_Min - 10) < DM_DIG_MIN_NIC) ++ DIG_Dynamic_MIN = DM_DIG_MIN_NIC; ++ else ++ DIG_Dynamic_MIN = pDM_Odm->RSSI_Min - 10; ++ } ++ else ++ DIG_Dynamic_MIN=DM_DIG_MIN_NIC; ++ } ++ else ++ { ++ if((pDM_Odm->RSSI_Min + 20) > dm_dig_max ) ++ pDM_DigTable->rx_gain_range_max = dm_dig_max; ++ else if((pDM_Odm->RSSI_Min + 20) < dm_dig_min ) ++ pDM_DigTable->rx_gain_range_max = dm_dig_min; ++ else ++ pDM_DigTable->rx_gain_range_max = pDM_Odm->RSSI_Min + 20; ++ ++ } ++ } ++ else ++ { ++ if((pDM_Odm->SupportICType & (ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8812|ODM_RTL8821)) && (pDM_Odm->bBtLimitedDig==1)){ ++ //2 Modify DIG upper bound for 92E, 8723B, 8821 & 8812 BT ++ if((pDM_Odm->RSSI_Min + 10) > dm_dig_max ) ++ pDM_DigTable->rx_gain_range_max = dm_dig_max; ++ else if((pDM_Odm->RSSI_Min + 10) < dm_dig_min ) ++ pDM_DigTable->rx_gain_range_max = dm_dig_min; ++ else ++ pDM_DigTable->rx_gain_range_max = pDM_Odm->RSSI_Min + 10; ++ } ++ else{ ++ ++ //2 Modify DIG upper bound ++ //2013.03.19 Luke: Modified upper bound for Netgear rental house test ++ if(pDM_Odm->SupportICType != ODM_RTL8821) ++ offset = 20; ++ else ++ offset = 10; ++ ++ if((pDM_Odm->RSSI_Min + offset) > dm_dig_max ) ++ pDM_DigTable->rx_gain_range_max = dm_dig_max; ++ else if((pDM_Odm->RSSI_Min + offset) < dm_dig_min ) ++ pDM_DigTable->rx_gain_range_max = dm_dig_min; ++ else ++ pDM_DigTable->rx_gain_range_max = pDM_Odm->RSSI_Min + offset; ++ ++ } ++ ++ //2 Modify DIG lower bound ++ /* ++ if((pFalseAlmCnt->Cnt_all > 500)&&(DIG_Dynamic_MIN < 0x25)) ++ DIG_Dynamic_MIN++; ++ else if(((pFalseAlmCnt->Cnt_all < 500)||(pDM_Odm->RSSI_Min < 8))&&(DIG_Dynamic_MIN > dm_dig_min)) ++ DIG_Dynamic_MIN--; ++ */ ++ if(pDM_Odm->bOneEntryOnly) ++ { ++ if(pDM_Odm->RSSI_Min < dm_dig_min) ++ DIG_Dynamic_MIN = dm_dig_min; ++ else if (pDM_Odm->RSSI_Min > DIG_MaxOfMin) ++ DIG_Dynamic_MIN = DIG_MaxOfMin; ++ else ++ DIG_Dynamic_MIN = pDM_Odm->RSSI_Min; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() : bOneEntryOnly=true, DIG_Dynamic_MIN=0x%x\n",DIG_Dynamic_MIN)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() : pDM_Odm->RSSI_Min=%d\n",pDM_Odm->RSSI_Min)); ++ } ++ //1 Lower Bound for 88E AntDiv ++ else ++ { ++ DIG_Dynamic_MIN=dm_dig_min; ++ } ++ } ++ } ++ else ++ { ++ pDM_DigTable->rx_gain_range_max = dm_dig_max; ++ DIG_Dynamic_MIN = dm_dig_min; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() : No Link\n")); ++ } ++ ++ //1 Modify DIG lower bound, deal with abnorally large false alarm ++ if(pFalseAlmCnt->Cnt_all > 10000) ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("dm_DIG(): Abnornally false alarm case. \n")); ++ ++ if(pDM_DigTable->LargeFAHit != 3) ++ pDM_DigTable->LargeFAHit++; ++ if(pDM_DigTable->ForbiddenIGI < CurrentIGI)//if(pDM_DigTable->ForbiddenIGI < pDM_DigTable->CurIGValue) ++ { ++ pDM_DigTable->ForbiddenIGI = (u1Byte)CurrentIGI;//pDM_DigTable->ForbiddenIGI = pDM_DigTable->CurIGValue; ++ pDM_DigTable->LargeFAHit = 1; ++ } ++ ++ if(pDM_DigTable->LargeFAHit >= 3) ++ { ++ if((pDM_DigTable->ForbiddenIGI+1) >pDM_DigTable->rx_gain_range_max) ++ pDM_DigTable->rx_gain_range_min = pDM_DigTable->rx_gain_range_max; ++ else ++ pDM_DigTable->rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 1); ++ pDM_DigTable->Recover_cnt = 3600; //3600=2hr ++ } ++ ++ } ++ else ++ { ++ //Recovery mechanism for IGI lower bound ++ if(pDM_DigTable->Recover_cnt != 0) ++ pDM_DigTable->Recover_cnt --; ++ else ++ { ++ if(pDM_DigTable->LargeFAHit < 3) ++ { ++ if((pDM_DigTable->ForbiddenIGI -1) < DIG_Dynamic_MIN) //DM_DIG_MIN) ++ { ++ pDM_DigTable->ForbiddenIGI = DIG_Dynamic_MIN; //DM_DIG_MIN; ++ pDM_DigTable->rx_gain_range_min = DIG_Dynamic_MIN; //DM_DIG_MIN; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: At Lower Bound\n")); ++ } ++ else ++ { ++ pDM_DigTable->ForbiddenIGI --; ++ pDM_DigTable->rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 1); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: Approach Lower Bound\n")); ++ } ++ } ++ else ++ { ++ pDM_DigTable->LargeFAHit = 0; ++ } ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): pDM_DigTable->LargeFAHit=%d\n",pDM_DigTable->LargeFAHit)); ++ ++ if((pDM_Odm->SupportPlatform&(ODM_WIN|ODM_CE))&&(pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 10)) ++ pDM_DigTable->rx_gain_range_min = dm_dig_min; ++ ++ if(pDM_DigTable->rx_gain_range_min > pDM_DigTable->rx_gain_range_max) ++ pDM_DigTable->rx_gain_range_min = pDM_DigTable->rx_gain_range_max; ++ ++ //1 Adjust initial gain by false alarm ++ if(pDM_Odm->bLinked) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DIG AfterLink\n")); ++ if(FirstConnect) ++ { ++ if(pDM_Odm->RSSI_Min <= DIG_MaxOfMin) ++ CurrentIGI = pDM_Odm->RSSI_Min; ++ else ++ CurrentIGI = DIG_MaxOfMin; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("DIG: First Connect\n")); ++ } ++ else ++ { ++ if(pDM_Odm->SupportICType == ODM_RTL8192D) ++ { ++ if(pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH2_92D) ++ CurrentIGI = CurrentIGI + 4;//pDM_DigTable->CurIGValue = pDM_DigTable->PreIGValue+2; ++ else if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH1_92D) ++ CurrentIGI = CurrentIGI + 2; //pDM_DigTable->CurIGValue = pDM_DigTable->PreIGValue+1; ++ else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0_92D) ++ CurrentIGI = CurrentIGI - 2;//pDM_DigTable->CurIGValue =pDM_DigTable->PreIGValue-1; ++ } ++ else ++ { ++ //FA for Combo IC--NeilChen--2012--09--28 ++ if(pDM_Odm->SupportICType == ODM_RTL8723A) ++ { ++ //WLAN and BT ConCurrent ++ if(pDM_Odm->bBtLimitedDig) ++ { ++ if(pFalseAlmCnt->Cnt_all > 0x300) ++ CurrentIGI = CurrentIGI + 4; ++ else if (pFalseAlmCnt->Cnt_all > 0x250) ++ CurrentIGI = CurrentIGI + 2; ++ else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0) ++ CurrentIGI = CurrentIGI -2; ++ } ++ else //Not Concurrent ++ { ++ if(pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH2) ++ CurrentIGI = CurrentIGI + 4;//pDM_DigTable->CurIGValue = pDM_DigTable->PreIGValue+2; ++ else if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH1) ++ CurrentIGI = CurrentIGI + 2;//pDM_DigTable->CurIGValue = pDM_DigTable->PreIGValue+1; ++ else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0) ++ CurrentIGI = CurrentIGI - 2;//pDM_DigTable->CurIGValue =pDM_DigTable->PreIGValue-1; ++ } ++ } ++ else ++ { ++ if(pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH2) ++ CurrentIGI = CurrentIGI + 4;//pDM_DigTable->CurIGValue = pDM_DigTable->PreIGValue+2; ++ else if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH1) ++ CurrentIGI = CurrentIGI + 2;//pDM_DigTable->CurIGValue = pDM_DigTable->PreIGValue+1; ++ else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0) ++ CurrentIGI = CurrentIGI - 2;//pDM_DigTable->CurIGValue =pDM_DigTable->PreIGValue-1; ++ ++ if((pDM_Odm->SupportPlatform&(ODM_WIN|ODM_CE))&&(pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 10) ++ &&(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH1)) ++ CurrentIGI = pDM_DigTable->rx_gain_range_min; ++ } ++ } ++ } ++ } ++ else ++ { ++ //CurrentIGI = pDM_DigTable->rx_gain_range_min;//pDM_DigTable->CurIGValue = pDM_DigTable->rx_gain_range_min ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DIG BeforeLink\n")); ++ if(FirstDisConnect) ++ { ++ CurrentIGI = pDM_DigTable->rx_gain_range_min; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): First DisConnect \n")); ++ } ++ else ++ { ++ //2012.03.30 LukeLee: enable DIG before link but with very high thresholds ++ if(pFalseAlmCnt->Cnt_all > 10000) ++ CurrentIGI = CurrentIGI + 4; ++ else if (pFalseAlmCnt->Cnt_all > 8000) ++ CurrentIGI = CurrentIGI + 2; ++ else if(pFalseAlmCnt->Cnt_all < 500) ++ CurrentIGI = CurrentIGI - 2; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): England DIG \n")); ++ } ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DIG End Adjust IGI\n")); ++ //1 Check initial gain by upper/lower bound ++ ++ if(CurrentIGI > pDM_DigTable->rx_gain_range_max) ++ CurrentIGI = pDM_DigTable->rx_gain_range_max; ++ if(CurrentIGI < pDM_DigTable->rx_gain_range_min) ++ CurrentIGI = pDM_DigTable->rx_gain_range_min; ++ ++ if(pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) ++ { ++ if(CurrentIGI > (pDM_Odm->IGI_target + 4)) ++ CurrentIGI = (u1Byte)pDM_Odm->IGI_target + 4; ++ } ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): rx_gain_range_max=0x%x, rx_gain_range_min=0x%x\n", ++ pDM_DigTable->rx_gain_range_max, pDM_DigTable->rx_gain_range_min)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): TotalFA=%d\n", pFalseAlmCnt->Cnt_all)); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): CurIGValue=0x%x\n", CurrentIGI)); ++ ++ //2 High power RSSI threshold ++ { ++ if(pDM_Odm->bBtHsOperation) ++ { ++ if(pDM_Odm->bLinked) ++ { ++ if(pDM_DigTable->BT30_CurIGI > (CurrentIGI)) ++ { ++ ODM_Write_DIG(pDM_Odm, CurrentIGI); ++ ++ } ++ else ++ { ++ ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI); ++ } ++ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; ++ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; ++ } ++ else ++ { ++ if(pDM_Odm->bLinkInProcess) ++ { ++ ODM_Write_DIG(pDM_Odm, 0x1c); ++ } ++ else if(pDM_Odm->bBtConnectProcess) ++ { ++ ODM_Write_DIG(pDM_Odm, 0x28); ++ } ++ else ++ { ++ ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); ++ } ++ } ++ } ++ else // BT is not using ++ { ++ ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); ++ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; ++ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; ++ } ++ } ++} ++ ++ ++bool ++odm_DigAbort( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ return false; ++} ++ ++//3============================================================ ++//3 FASLE ALARM CHECK ++//3============================================================ ++ ++void ++odm_FalseAlarmCounterStatistics( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u4Byte ret_value; ++ PFALSE_ALARM_STATISTICS FalseAlmCnt = &(pDM_Odm->FalseAlmCnt); ++ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT)) ++ return; ++ ++ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) ++ { ++ ++ //hold ofdm counter ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT31, 1); //hold page C counter ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT31, 1); //hold page D counter ++ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE1_11N, bMaskDWord); ++ FalseAlmCnt->Cnt_Fast_Fsync = (ret_value&0xffff); ++ FalseAlmCnt->Cnt_SB_Search_fail = ((ret_value&0xffff0000)>>16); ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE2_11N, bMaskDWord); ++ FalseAlmCnt->Cnt_OFDM_CCA = (ret_value&0xffff); ++ FalseAlmCnt->Cnt_Parity_Fail = ((ret_value&0xffff0000)>>16); ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE3_11N, bMaskDWord); ++ FalseAlmCnt->Cnt_Rate_Illegal = (ret_value&0xffff); ++ FalseAlmCnt->Cnt_Crc8_fail = ((ret_value&0xffff0000)>>16); ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE4_11N, bMaskDWord); ++ FalseAlmCnt->Cnt_Mcs_fail = (ret_value&0xffff); ++ ++ FalseAlmCnt->Cnt_Ofdm_fail = FalseAlmCnt->Cnt_Parity_Fail + FalseAlmCnt->Cnt_Rate_Illegal + ++ FalseAlmCnt->Cnt_Crc8_fail + FalseAlmCnt->Cnt_Mcs_fail + ++ FalseAlmCnt->Cnt_Fast_Fsync + FalseAlmCnt->Cnt_SB_Search_fail; ++ ++ { ++ //hold cck counter ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT12, 1); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT14, 1); ++ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_LSB_11N, bMaskByte0); ++ FalseAlmCnt->Cnt_Cck_fail = ret_value; ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_MSB_11N, bMaskByte3); ++ FalseAlmCnt->Cnt_Cck_fail += (ret_value& 0xff)<<8; ++ ++ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CCA_CNT_11N, bMaskDWord); ++ FalseAlmCnt->Cnt_CCK_CCA = ((ret_value&0xFF)<<8) |((ret_value&0xFF00)>>8); ++ } ++ ++ FalseAlmCnt->Cnt_all = ( FalseAlmCnt->Cnt_Fast_Fsync + ++ FalseAlmCnt->Cnt_SB_Search_fail + ++ FalseAlmCnt->Cnt_Parity_Fail + ++ FalseAlmCnt->Cnt_Rate_Illegal + ++ FalseAlmCnt->Cnt_Crc8_fail + ++ FalseAlmCnt->Cnt_Mcs_fail + ++ FalseAlmCnt->Cnt_Cck_fail); ++ ++ FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_OFDM_CCA + FalseAlmCnt->Cnt_CCK_CCA; ++ ++ if(pDM_Odm->SupportICType >=ODM_RTL8723A) ++ { ++ //reset false alarm counter registers ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT31, 1); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT31, 0); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT27, 1); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT27, 0); ++ //update ofdm counter ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT31, 0); //update page C counter ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT31, 0); //update page D counter ++ ++ //reset CCK CCA counter ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT13|BIT12, 0); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT13|BIT12, 2); ++ //reset CCK FA counter ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT15|BIT14, 0); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT15|BIT14, 2); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Enter odm_FalseAlarmCounterStatistics\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Cnt_Fast_Fsync=%d, Cnt_SB_Search_fail=%d\n", ++ FalseAlmCnt->Cnt_Fast_Fsync, FalseAlmCnt->Cnt_SB_Search_fail)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Cnt_Parity_Fail=%d, Cnt_Rate_Illegal=%d\n", ++ FalseAlmCnt->Cnt_Parity_Fail, FalseAlmCnt->Cnt_Rate_Illegal)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Cnt_Crc8_fail=%d, Cnt_Mcs_fail=%d\n", ++ FalseAlmCnt->Cnt_Crc8_fail, FalseAlmCnt->Cnt_Mcs_fail)); ++ } ++ else if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) ++ { ++ u4Byte CCKenable; ++ //read OFDM FA counter ++ FalseAlmCnt->Cnt_Ofdm_fail = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_11AC, bMaskLWord); ++ FalseAlmCnt->Cnt_Cck_fail = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_11AC, bMaskLWord); ++ ++ CCKenable = ODM_GetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT28); ++ if(CCKenable)//if(*pDM_Odm->pBandType == ODM_BAND_2_4G) ++ FalseAlmCnt->Cnt_all = FalseAlmCnt->Cnt_Ofdm_fail + FalseAlmCnt->Cnt_Cck_fail; ++ else ++ FalseAlmCnt->Cnt_all = FalseAlmCnt->Cnt_Ofdm_fail; ++ ++ // reset OFDM FA coutner ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RST_11AC, BIT17, 1); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RST_11AC, BIT17, 0); ++ // reset CCK FA counter ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11AC, BIT15, 0); ++ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11AC, BIT15, 1); ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Cnt_Cck_fail=%d\n", FalseAlmCnt->Cnt_Cck_fail)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Total False Alarm=%d\n", FalseAlmCnt->Cnt_all)); ++} ++ ++//3============================================================ ++//3 CCK Packet Detect Threshold ++//3============================================================ ++ ++void ++odm_CCKPacketDetectionThresh( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ ++ u1Byte CurCCK_CCAThres; ++ PFALSE_ALARM_STATISTICS FalseAlmCnt = &(pDM_Odm->FalseAlmCnt); ++ ++ if(!(pDM_Odm->SupportAbility & (ODM_BB_CCK_PD|ODM_BB_FA_CNT))) ++ return; ++ ++ if(pDM_Odm->ExtLNA) ++ return; ++ ++ if(pDM_Odm->bLinked) ++ { ++ if(pDM_Odm->RSSI_Min > 25) ++ CurCCK_CCAThres = 0xcd; ++ else if((pDM_Odm->RSSI_Min <= 25) && (pDM_Odm->RSSI_Min > 10)) ++ CurCCK_CCAThres = 0x83; ++ else ++ { ++ if(FalseAlmCnt->Cnt_Cck_fail > 1000) ++ CurCCK_CCAThres = 0x83; ++ else ++ CurCCK_CCAThres = 0x40; ++ } ++ } ++ else ++ { ++ if(FalseAlmCnt->Cnt_Cck_fail > 1000) ++ CurCCK_CCAThres = 0x83; ++ else ++ CurCCK_CCAThres = 0x40; ++ } ++ ODM_Write_CCK_CCA_Thres(pDM_Odm, CurCCK_CCAThres); ++} ++ ++void ++ODM_Write_CCK_CCA_Thres( ++ PDM_ODM_T pDM_Odm, ++ u1Byte CurCCK_CCAThres ++ ) ++{ ++ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; ++ ++ if(pDM_DigTable->CurCCK_CCAThres!=CurCCK_CCAThres) //modify by Guo.Mingzhi 2012-01-03 ++ { ++ ODM_Write1Byte(pDM_Odm, ODM_REG(CCK_CCA,pDM_Odm), CurCCK_CCAThres); ++ } ++ pDM_DigTable->PreCCK_CCAThres = pDM_DigTable->CurCCK_CCAThres; ++ pDM_DigTable->CurCCK_CCAThres = CurCCK_CCAThres; ++ ++} ++ ++//3============================================================ ++//3 BB Power Save ++//3============================================================ ++void ++odm_DynamicBBPowerSavingInit( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; ++ ++ pDM_PSTable->PreCCAState = CCA_MAX; ++ pDM_PSTable->CurCCAState = CCA_MAX; ++ pDM_PSTable->PreRFState = RF_MAX; ++ pDM_PSTable->CurRFState = RF_MAX; ++ pDM_PSTable->Rssi_val_min = 0; ++ pDM_PSTable->initialize = 0; ++} ++ ++ ++void ++odm_DynamicBBPowerSaving( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ if (pDM_Odm->SupportICType != ODM_RTL8723A) ++ return; ++ if(!(pDM_Odm->SupportAbility & ODM_BB_PWR_SAVE)) ++ return; ++ if(!(pDM_Odm->SupportPlatform & (ODM_WIN|ODM_CE))) ++ return; ++ ++ //1 2.Power Saving for 92C ++ if((pDM_Odm->SupportICType == ODM_RTL8192C) &&(pDM_Odm->RFType == ODM_2T2R)) ++ { ++ odm_1R_CCA(pDM_Odm); ++ } ++ ++ // 20100628 Joseph: Turn off BB power save for 88CE because it makesthroughput unstable. ++ // 20100831 Joseph: Turn ON BB power save again after modifying AGC delay from 900ns ot 600ns. ++ //1 3.Power Saving for 88C ++ else ++ { ++ ODM_RF_Saving(pDM_Odm, false); ++ } ++} ++ ++void ++odm_1R_CCA( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; ++ ++ if(pDM_Odm->RSSI_Min!= 0xFF) ++ { ++ ++ if(pDM_PSTable->PreCCAState == CCA_2R) ++ { ++ if(pDM_Odm->RSSI_Min >= 35) ++ pDM_PSTable->CurCCAState = CCA_1R; ++ else ++ pDM_PSTable->CurCCAState = CCA_2R; ++ ++ } ++ else{ ++ if(pDM_Odm->RSSI_Min <= 30) ++ pDM_PSTable->CurCCAState = CCA_2R; ++ else ++ pDM_PSTable->CurCCAState = CCA_1R; ++ } ++ } ++ else{ ++ pDM_PSTable->CurCCAState=CCA_MAX; ++ } ++ ++ if(pDM_PSTable->PreCCAState != pDM_PSTable->CurCCAState) ++ { ++ if(pDM_PSTable->CurCCAState == CCA_1R) ++ { ++ if( pDM_Odm->RFType ==ODM_2T2R ) ++ { ++ ODM_SetBBReg(pDM_Odm, 0xc04 , bMaskByte0, 0x13); ++ //PHY_SetBBReg(pAdapter, 0xe70, bMaskByte3, 0x20); ++ } ++ else ++ { ++ ODM_SetBBReg(pDM_Odm, 0xc04 , bMaskByte0, 0x23); ++ //PHY_SetBBReg(pAdapter, 0xe70, 0x7fc00000, 0x10c); // Set RegE70[30:22] = 9b'100001100 ++ } ++ } ++ else ++ { ++ ODM_SetBBReg(pDM_Odm, 0xc04 , bMaskByte0, 0x33); ++ //PHY_SetBBReg(pAdapter,0xe70, bMaskByte3, 0x63); ++ } ++ pDM_PSTable->PreCCAState = pDM_PSTable->CurCCAState; ++ } ++ //ODM_RT_TRACE(pDM_Odm, COMP_BB_POWERSAVING, DBG_LOUD, ("CCAStage = %s\n",(pDM_PSTable->CurCCAState==0)?"1RCCA":"2RCCA")); ++} ++ ++void ++ODM_RF_Saving( ++ PDM_ODM_T pDM_Odm, ++ u1Byte bForceInNormal ++ ) ++{ ++ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; ++ u1Byte Rssi_Up_bound = 30 ; ++ u1Byte Rssi_Low_bound = 25; ++ if(pDM_Odm->PatchID == 40 ) //RT_CID_819x_FUNAI_TV ++ { ++ Rssi_Up_bound = 50 ; ++ Rssi_Low_bound = 45; ++ } ++ if(pDM_PSTable->initialize == 0){ ++ ++ pDM_PSTable->Reg874 = (ODM_GetBBReg(pDM_Odm, 0x874, bMaskDWord)&0x1CC000)>>14; ++ pDM_PSTable->RegC70 = (ODM_GetBBReg(pDM_Odm, 0xc70, bMaskDWord)&BIT3)>>3; ++ pDM_PSTable->Reg85C = (ODM_GetBBReg(pDM_Odm, 0x85c, bMaskDWord)&0xFF000000)>>24; ++ pDM_PSTable->RegA74 = (ODM_GetBBReg(pDM_Odm, 0xa74, bMaskDWord)&0xF000)>>12; ++ pDM_PSTable->initialize = 1; ++ } ++ ++ if(!bForceInNormal) ++ { ++ if(pDM_Odm->RSSI_Min != 0xFF) ++ { ++ if(pDM_PSTable->PreRFState == RF_Normal) ++ { ++ if(pDM_Odm->RSSI_Min >= Rssi_Up_bound) ++ pDM_PSTable->CurRFState = RF_Save; ++ else ++ pDM_PSTable->CurRFState = RF_Normal; ++ } ++ else{ ++ if(pDM_Odm->RSSI_Min <= Rssi_Low_bound) ++ pDM_PSTable->CurRFState = RF_Normal; ++ else ++ pDM_PSTable->CurRFState = RF_Save; ++ } ++ } ++ else ++ pDM_PSTable->CurRFState=RF_MAX; ++ } ++ else ++ { ++ pDM_PSTable->CurRFState = RF_Normal; ++ } ++ ++ if(pDM_PSTable->PreRFState != pDM_PSTable->CurRFState) ++ { ++ if(pDM_PSTable->CurRFState == RF_Save) ++ { ++ // 8723 RSSI report will be wrong. Set 0x874[5]=1 when enter BB power saving mode. ++ // Suggested by SD3 Yu-Nan. 2011.01.20. ++ if(pDM_Odm->SupportICType == ODM_RTL8723A) ++ { ++ ODM_SetBBReg(pDM_Odm, 0x874 , BIT5, 0x1); //Reg874[5]=1b'1 ++ } ++ ODM_SetBBReg(pDM_Odm, 0x874 , 0x1C0000, 0x2); //Reg874[20:18]=3'b010 ++ ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, 0); //RegC70[3]=1'b0 ++ ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, 0x63); //Reg85C[31:24]=0x63 ++ ODM_SetBBReg(pDM_Odm, 0x874, 0xC000, 0x2); //Reg874[15:14]=2'b10 ++ ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, 0x3); //RegA75[7:4]=0x3 ++ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x0); //Reg818[28]=1'b0 ++ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x1); //Reg818[28]=1'b1 ++ //ODM_RT_TRACE(pDM_Odm, COMP_BB_POWERSAVING, DBG_LOUD, (" RF_Save")); ++ } ++ else ++ { ++ ODM_SetBBReg(pDM_Odm, 0x874 , 0x1CC000, pDM_PSTable->Reg874); ++ ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, pDM_PSTable->RegC70); ++ ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, pDM_PSTable->Reg85C); ++ ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, pDM_PSTable->RegA74); ++ ODM_SetBBReg(pDM_Odm,0x818, BIT28, 0x0); ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8723A) ++ { ++ ODM_SetBBReg(pDM_Odm,0x874 , BIT5, 0x0); //Reg874[5]=1b'0 ++ } ++ //ODM_RT_TRACE(pDM_Odm, COMP_BB_POWERSAVING, DBG_LOUD, (" RF_Normal")); ++ } ++ pDM_PSTable->PreRFState =pDM_PSTable->CurRFState; ++ } ++} ++ ++ ++//3============================================================ ++//3 RATR MASK ++//3============================================================ ++//3============================================================ ++//3 Rate Adaptive ++//3============================================================ ++ ++void ++odm_RateAdaptiveMaskInit( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PODM_RATE_ADAPTIVE pOdmRA = &pDM_Odm->RateAdaptive; ++ ++ pOdmRA->Type = DM_Type_ByDriver; ++ if (pOdmRA->Type == DM_Type_ByDriver) ++ pDM_Odm->bUseRAMask = true; ++ else ++ pDM_Odm->bUseRAMask = false; ++ ++ pOdmRA->RATRState = DM_RATR_STA_INIT; ++ pOdmRA->LdpcThres = 35; ++ pOdmRA->bUseLdpc = false; ++ pOdmRA->HighRSSIThresh = 50; ++ pOdmRA->LowRSSIThresh = 20; ++} ++ ++u4Byte ODM_Get_Rate_Bitmap( ++ PDM_ODM_T pDM_Odm, ++ u4Byte macid, ++ u4Byte ra_mask, ++ u1Byte rssi_level) ++{ ++ PSTA_INFO_T pEntry; ++ u4Byte rate_bitmap = 0; ++ u1Byte WirelessMode; ++ ++ ++ pEntry = pDM_Odm->pODM_StaInfo[macid]; ++ if(!IS_STA_VALID(pEntry)) ++ return ra_mask; ++ ++ WirelessMode = pEntry->wireless_mode; ++ ++ switch(WirelessMode) ++ { ++ case ODM_WM_B: ++ if(ra_mask & 0x0000000c) //11M or 5.5M enable ++ rate_bitmap = 0x0000000d; ++ else ++ rate_bitmap = 0x0000000f; ++ break; ++ ++ case (ODM_WM_G): ++ case (ODM_WM_A): ++ if(rssi_level == DM_RATR_STA_HIGH) ++ rate_bitmap = 0x00000f00; ++ else ++ rate_bitmap = 0x00000ff0; ++ break; ++ ++ case (ODM_WM_B|ODM_WM_G): ++ if(rssi_level == DM_RATR_STA_HIGH) ++ rate_bitmap = 0x00000f00; ++ else if(rssi_level == DM_RATR_STA_MIDDLE) ++ rate_bitmap = 0x00000ff0; ++ else ++ rate_bitmap = 0x00000ff5; ++ break; ++ ++ case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G) : ++ case (ODM_WM_B|ODM_WM_N24G) : ++ case (ODM_WM_A|ODM_WM_N5G) : ++ { ++ if ( pDM_Odm->RFType == ODM_1T2R ||pDM_Odm->RFType == ODM_1T1R) ++ { ++ if(rssi_level == DM_RATR_STA_HIGH) ++ { ++ rate_bitmap = 0x000f0000; ++ } ++ else if(rssi_level == DM_RATR_STA_MIDDLE) ++ { ++ rate_bitmap = 0x000ff000; ++ } ++ else{ ++ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) ++ rate_bitmap = 0x000ff015; ++ else ++ rate_bitmap = 0x000ff005; ++ } ++ } ++ else ++ { ++ if(rssi_level == DM_RATR_STA_HIGH) ++ { ++ rate_bitmap = 0x0f8f0000; ++ } ++ else if(rssi_level == DM_RATR_STA_MIDDLE) ++ { ++ rate_bitmap = 0x0f8ff000; ++ } ++ else ++ { ++ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) ++ rate_bitmap = 0x0f8ff015; ++ else ++ rate_bitmap = 0x0f8ff005; ++ } ++ } ++ } ++ break; ++ case (ODM_WM_AC|ODM_WM_A): ++ case (ODM_WM_AC|ODM_WM_G): ++ ++ if (pDM_Odm->RFType == RF_1T1R) ++ { ++ if( (pDM_Odm->SupportICType == ODM_RTL8821)|| ++ (pDM_Odm->SupportICType == ODM_RTL8812 && pDM_Odm->bIsMPChip)) ++ { ++ if( (pDM_Odm->SupportICType == ODM_RTL8821) ++ && (pDM_Odm->SupportInterface == ODM_ITRF_USB) ++ && (*(pDM_Odm->pChannel) >= 149)) ++ { ++ if(rssi_level == 1) // add by Gary for ac-series ++ rate_bitmap = 0x001f8000; ++ else if (rssi_level == 2) ++ rate_bitmap = 0x001ff000; ++ else ++ rate_bitmap = 0x001ff010; ++ } ++ else ++ { ++ if(rssi_level == 1) // add by Gary for ac-series ++ rate_bitmap = 0x003f8000; ++ else if (rssi_level == 2) ++ rate_bitmap = 0x003ff000; ++ else ++ rate_bitmap = 0x003ff010; ++ } ++ } ++ else{ ++ rate_bitmap = 0x000ff010; ++ } ++ } ++ else ++ { ++ if(pDM_Odm->bIsMPChip) ++ { ++ if(rssi_level == 1) // add by Gary for ac-series ++ rate_bitmap = 0xfe3f8000; // VHT 2SS MCS3~9 ++ else if (rssi_level == 2) ++ rate_bitmap = 0xfffff000; // VHT 2SS MCS0~9 ++ else ++ rate_bitmap = 0xfffff010; // All ++ } ++ else ++ rate_bitmap = 0x3fcff010; ++ } ++ break; ++ ++ default: ++ if(pDM_Odm->RFType == RF_1T2R) ++ rate_bitmap = 0x000fffff; ++ else ++ rate_bitmap = 0x0fffffff; ++ break; ++ ++ } ++ ++ //printk("%s ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x \n",__FUNCTION__,rssi_level,WirelessMode,rate_bitmap); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, (" ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x \n",rssi_level,WirelessMode,rate_bitmap)); ++ ++ return (ra_mask&rate_bitmap); ++ ++} ++ ++void ++odm_RefreshBasicRateMask( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++} ++ ++/*----------------------------------------------------------------------------- ++ * Function: odm_RefreshRateAdaptiveMask() ++ * ++ * Overview: Update rate table mask according to rssi ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 05/27/2009 hpfan Create Version 0. ++ * ++ *---------------------------------------------------------------------------*/ ++void ++odm_RefreshRateAdaptiveMask( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("odm_RefreshRateAdaptiveMask()---------->\n")); ++ if (!(pDM_Odm->SupportAbility & ODM_BB_RA_MASK)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("odm_RefreshRateAdaptiveMask(): Return cos not supported\n")); ++ return; ++ } ++ // ++ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate ++ // at the same time. In the stage2/3, we need to prive universal interface and merge all ++ // HW dynamic mechanism. ++ // ++ switch (pDM_Odm->SupportPlatform) ++ { ++ case ODM_WIN: ++ odm_RefreshRateAdaptiveMaskMP(pDM_Odm); ++ break; ++ ++ case ODM_CE: ++ odm_RefreshRateAdaptiveMaskCE(pDM_Odm); ++ break; ++ ++ case ODM_AP: ++ case ODM_ADSL: ++ odm_RefreshRateAdaptiveMaskAPADSL(pDM_Odm); ++ break; ++ } ++ ++} ++ ++void ++odm_RefreshRateAdaptiveMaskMP( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++} ++ ++void ++odm_RefreshRateAdaptiveMaskCE( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u1Byte i; ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; ++ ++ if(pAdapter->bDriverStopped) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_RefreshRateAdaptiveMask(): driver is going to unload\n")); ++ return; ++ } ++ ++ if(!pDM_Odm->bUseRAMask) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_RefreshRateAdaptiveMask(): driver does not control rate adaptive mask\n")); ++ return; ++ } ++ ++ for(i=0; ipODM_StaInfo[i]; ++ if(IS_STA_VALID(pstat) ) { ++ ++ if((pDM_Odm->SupportICType == ODM_RTL8812)||(pDM_Odm->SupportICType == ODM_RTL8821)) ++ { ++ if(pstat->rssi_stat.UndecoratedSmoothedPWDB < pRA->LdpcThres) ++ { ++ pRA->bUseLdpc = true; ++ pRA->bLowerRtsRate = true; ++ Set_RA_LDPC_8812(pstat, true); ++ } ++ else if(pstat->rssi_stat.UndecoratedSmoothedPWDB > (pRA->LdpcThres-5)) ++ { ++ pRA->bUseLdpc = false; ++ pRA->bLowerRtsRate = false; ++ Set_RA_LDPC_8812(pstat, false); ++ } ++ } ++ ++ if( true == ODM_RAStateCheck(pDM_Odm, pstat->rssi_stat.UndecoratedSmoothedPWDB, false , &pstat->rssi_level) ) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pstat->rssi_stat.UndecoratedSmoothedPWDB, pstat->rssi_level)); ++ rtw_hal_update_ra_mask(pstat, pstat->rssi_level); ++ } ++ ++ } ++ } ++} ++ ++void ++odm_RefreshRateAdaptiveMaskAPADSL( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++} ++ ++// Return Value: bool ++// - true: RATRState is changed. ++bool ++ODM_RAStateCheck( ++ PDM_ODM_T pDM_Odm, ++ s4Byte RSSI, ++ bool bForceUpdate, ++ pu1Byte pRATRState ++ ) ++{ ++ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; ++ const u1Byte GoUpGap = 5; ++ u1Byte HighRSSIThreshForRA = pRA->HighRSSIThresh; ++ u1Byte LowRSSIThreshForRA = pRA->LowRSSIThresh; ++ u1Byte RATRState; ++ ++ // Threshold Adjustment: ++ // when RSSI state trends to go up one or two levels, make sure RSSI is high enough. ++ // Here GoUpGap is added to solve the boundary's level alternation issue. ++ switch (*pRATRState) ++ { ++ case DM_RATR_STA_INIT: ++ case DM_RATR_STA_HIGH: ++ break; ++ ++ case DM_RATR_STA_MIDDLE: ++ HighRSSIThreshForRA += GoUpGap; ++ break; ++ ++ case DM_RATR_STA_LOW: ++ HighRSSIThreshForRA += GoUpGap; ++ LowRSSIThreshForRA += GoUpGap; ++ break; ++ ++ default: ++ ODM_RT_ASSERT(pDM_Odm, false, ("wrong rssi level setting %d !", *pRATRState) ); ++ break; ++ } ++ ++ // Decide RATRState by RSSI. ++ if(RSSI > HighRSSIThreshForRA) ++ RATRState = DM_RATR_STA_HIGH; ++ else if(RSSI > LowRSSIThreshForRA) ++ RATRState = DM_RATR_STA_MIDDLE; ++ else ++ RATRState = DM_RATR_STA_LOW; ++ //printk("==>%s,RATRState:0x%02x ,RSSI:%d \n",__FUNCTION__,RATRState,RSSI); ++ ++ if( *pRATRState!=RATRState || bForceUpdate) ++ { ++ ODM_RT_TRACE( pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI Level %d -> %d\n", *pRATRState, RATRState) ); ++ *pRATRState = RATRState; ++ return true; ++ } ++ ++ return false; ++} ++ ++ ++//============================================================ ++ ++//3============================================================ ++//3 Dynamic Tx Power ++//3============================================================ ++ ++void ++odm_DynamicTxPowerInit( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ pdmpriv->bDynamicTxPowerEnable = false; ++ ++ pdmpriv->LastDTPLvl = TxHighPwrLevel_Normal; ++ pdmpriv->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; ++} ++ ++void ++odm_DynamicTxPowerSavePowerIndex( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u1Byte index; ++ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; ++ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ for(index = 0; index< 6; index++) ++ pdmpriv->PowerIndex_backup[index] = rtw_read8(Adapter, Power_Index_REG[index]); ++} ++ ++void ++odm_DynamicTxPowerRestorePowerIndex( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u1Byte index; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ for(index = 0; index< 6; index++) ++ rtw_write8(Adapter, Power_Index_REG[index], pdmpriv->PowerIndex_backup[index]); ++} ++ ++void ++odm_DynamicTxPowerWritePowerIndex( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Value) ++{ ++ ++ u1Byte index; ++ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; ++ ++ for(index = 0; index< 6; index++) ++ //PlatformEFIOWrite1Byte(Adapter, Power_Index_REG[index], Value); ++ ODM_Write1Byte(pDM_Odm, Power_Index_REG[index], Value); ++ ++} ++ ++ ++void ++odm_DynamicTxPower( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ // ++ // For AP/ADSL use prtl8192cd_priv ++ // For CE/NIC use PADAPTER ++ // ++ //PADAPTER pAdapter = pDM_Odm->Adapter; ++// prtl8192cd_priv priv = pDM_Odm->priv; ++ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) ++ return; ++ ++ // 2012/01/12 MH According to Luke's suggestion, only high power will support the feature. ++ if (pDM_Odm->ExtPA == false) ++ return; ++ ++ ++ // ++ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate ++ // at the same time. In the stage2/3, we need to prive universal interface and merge all ++ // HW dynamic mechanism. ++ // ++ switch (pDM_Odm->SupportPlatform) ++ { ++ case ODM_WIN: ++ case ODM_CE: ++ odm_DynamicTxPowerNIC(pDM_Odm); ++ break; ++ case ODM_AP: ++ odm_DynamicTxPowerAP(pDM_Odm); ++ break; ++ ++ case ODM_ADSL: ++ //odm_DIGAP(pDM_Odm); ++ break; ++ } ++ ++ ++} ++ ++ ++void ++odm_DynamicTxPowerNIC( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) ++ return; ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8192C) ++ { ++ odm_DynamicTxPower_92C(pDM_Odm); ++ } ++ else if(pDM_Odm->SupportICType == ODM_RTL8192D) ++ { ++ odm_DynamicTxPower_92D(pDM_Odm); ++ } ++ else if (pDM_Odm->SupportICType & ODM_RTL8188E) ++ { ++ // Add Later. ++ } ++ else if (pDM_Odm->SupportICType == ODM_RTL8188E) ++ { ++ // ??? ++ // This part need to be redefined. ++ } ++} ++ ++void ++odm_DynamicTxPowerAP( ++ PDM_ODM_T pDM_Odm ++ ++ ) ++{ ++} ++ ++ ++void ++odm_DynamicTxPower_92C( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++} ++ ++ ++void ++odm_DynamicTxPower_92D( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++} ++ ++//3============================================================ ++//3 RSSI Monitor ++//3============================================================ ++ ++void ++odm_RSSIDumpToRegister( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++} ++ ++ ++void ++odm_RSSIMonitorInit( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++} ++ ++void ++odm_RSSIMonitorCheck( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ // ++ // For AP/ADSL use prtl8192cd_priv ++ // For CE/NIC use PADAPTER ++ // ++ ++ if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)) ++ return; ++ ++ // ++ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate ++ // at the same time. In the stage2/3, we need to prive universal interface and merge all ++ // HW dynamic mechanism. ++ // ++ switch (pDM_Odm->SupportPlatform) ++ { ++ case ODM_WIN: ++ odm_RSSIMonitorCheckMP(pDM_Odm); ++ break; ++ ++ case ODM_CE: ++ odm_RSSIMonitorCheckCE(pDM_Odm); ++ break; ++ ++ case ODM_AP: ++ odm_RSSIMonitorCheckAP(pDM_Odm); ++ break; ++ ++ case ODM_ADSL: ++ //odm_DIGAP(pDM_Odm); ++ break; ++ } ++ ++} // odm_RSSIMonitorCheck ++ ++ ++void ++odm_RSSIMonitorCheckMP( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++} ++ ++// ++//sherry move from DUSC to here 20110517 ++// ++static void ++FindMinimumRSSI_Dmsp( ++ PADAPTER pAdapter ++) ++{ ++} ++ ++static void ++FindMinimumRSSI( ++PADAPTER pAdapter ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ ++ //1 1.Determine the minimum RSSI ++ ++ if((pDM_Odm->bLinked != true) && ++ (pdmpriv->EntryMinUndecoratedSmoothedPWDB == 0)) ++ { ++ pdmpriv->MinUndecoratedPWDBForDM = 0; ++ //ODM_RT_TRACE(pDM_Odm,COMP_BB_POWERSAVING, DBG_LOUD, ("Not connected to any \n")); ++ } ++ else ++ { ++ pdmpriv->MinUndecoratedPWDBForDM = pdmpriv->EntryMinUndecoratedSmoothedPWDB; ++ } ++ ++ //DBG_8192C("%s=>MinUndecoratedPWDBForDM(%d)\n",__FUNCTION__,pdmpriv->MinUndecoratedPWDBForDM); ++ //ODM_RT_TRACE(pDM_Odm,COMP_DIG, DBG_LOUD, ("MinUndecoratedPWDBForDM =%d\n",pHalData->MinUndecoratedPWDBForDM)); ++} ++ ++void ++odm_RSSIMonitorCheckCE( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ int i; ++ int tmpEntryMaxPWDB=0, tmpEntryMinPWDB=0xff; ++ u8 sta_cnt=0; ++ u8 UL_DL_STATE = 0;// for 8812 use ++ u32 PWDB_rssi[NUM_STA]={0};//[0~15]:MACID, [16~31]:PWDB_rssi ++ ++ if(pDM_Odm->bLinked != true) ++ return; ++ ++ if((pDM_Odm->SupportICType == ODM_RTL8812)||(pDM_Odm->SupportICType == ODM_RTL8821)) ++ { ++ u64 curTxOkCnt = Adapter->xmitpriv.tx_bytes - Adapter->xmitpriv.last_tx_bytes; ++ u64 curRxOkCnt = Adapter->recvpriv.rx_bytes - Adapter->recvpriv.last_rx_bytes; ++ ++ if(curRxOkCnt >(curTxOkCnt*6)) ++ UL_DL_STATE = 1; ++ else ++ UL_DL_STATE = 0; ++ } ++ ++ { ++ struct sta_info *psta; ++ ++ for(i=0; ipODM_StaInfo[i])) ++ { ++ if(psta->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB) ++ tmpEntryMinPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB; ++ ++ if(psta->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB) ++ tmpEntryMaxPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB; ++ ++ #if 0 ++ DBG_871X("%s mac_id:%u, mac:"MAC_FMT", rssi:%d\n", __func__, ++ psta->mac_id, MAC_ARG(psta->hwaddr), psta->rssi_stat.UndecoratedSmoothedPWDB); ++ #endif ++ ++ if(psta->rssi_stat.UndecoratedSmoothedPWDB != (-1)) { ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8192D) ++ PWDB_rssi[sta_cnt++] = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB<<16) | ((Adapter->stapriv.asoc_sta_count+1) << 8)); ++ else if ((pDM_Odm->SupportICType == ODM_RTL8192E)||(pDM_Odm->SupportICType == ODM_RTL8812)||(pDM_Odm->SupportICType == ODM_RTL8821)) ++ PWDB_rssi[sta_cnt++] = (((u8)(psta->mac_id&0xFF)) | ((psta->rssi_stat.UndecoratedSmoothedPWDB&0x7F)<<16) ); ++ else ++ PWDB_rssi[sta_cnt++] = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB<<16) ); ++ ++ } ++ } ++ } ++ ++ //printk("%s==> sta_cnt(%d)\n",__FUNCTION__,sta_cnt); ++ ++ for(i=0; i< sta_cnt; i++) ++ { ++ if(PWDB_rssi[i] != (0)){ ++ if(pHalData->fw_ractrl == true)// Report every sta's RSSI to FW ++ { ++ if((pDM_Odm->SupportICType == ODM_RTL8812)||(pDM_Odm->SupportICType == ODM_RTL8821)){ ++ PWDB_rssi[i] |= (UL_DL_STATE << 24); ++ rtl8812_set_rssi_cmd(Adapter, (u8 *)(&PWDB_rssi[i])); ++ } ++ } ++ } ++ } ++ } ++ ++ if(tmpEntryMaxPWDB != 0) // If associated entry is found ++ { ++ pdmpriv->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB; ++ } ++ else ++ { ++ pdmpriv->EntryMaxUndecoratedSmoothedPWDB = 0; ++ } ++ ++ if(tmpEntryMinPWDB != 0xff) // If associated entry is found ++ { ++ pdmpriv->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB; ++ } ++ else ++ { ++ pdmpriv->EntryMinUndecoratedSmoothedPWDB = 0; ++ } ++ ++ FindMinimumRSSI(Adapter);//get pdmpriv->MinUndecoratedPWDBForDM ++ ++ ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM); ++} ++ ++void ++odm_RSSIMonitorCheckAP( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++} ++ ++void ++ODM_InitAllTimers( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++#if(defined(CONFIG_SW_ANTENNA_DIVERSITY)) ++ ODM_InitializeTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer, ++ (RT_TIMER_CALL_BACK)odm_SwAntDivChkAntSwitchCallback, NULL, "SwAntennaSwitchTimer"); ++#endif ++} ++ ++void ++ODM_CancelAllTimers( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++#if(defined(CONFIG_SW_ANTENNA_DIVERSITY)) ++ ODM_CancelTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer); ++#endif ++} ++ ++void ++ODM_ReleaseAllTimers( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer); ++} ++ ++//3============================================================ ++//3 Tx Power Tracking ++//3============================================================ ++ ++void ++odm_TXPowerTrackingInit( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ odm_TXPowerTrackingThermalMeterInit(pDM_Odm); ++} ++ ++u1Byte ++getSwingIndex( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u1Byte i = 0; ++ u4Byte bbSwing; ++ ++ bbSwing = PHY_GetTxBBSwing_8812A(Adapter, pHalData->CurrentBandType, ODM_RF_PATH_A); ++ ++ for (i = 0; i < TXSCALE_TABLE_SIZE; ++i) ++ if ( bbSwing == TxScalingTable_Jaguar[i]) ++ break; ++ ++ return i; ++} ++ ++void ++odm_TXPowerTrackingThermalMeterInit( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u1Byte p = 0; ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ pDM_Odm->RFCalibrateInfo.bTXPowerTracking = true; ++ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; ++ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = false; ++ if ( *(pDM_Odm->mp_mode) != 1) ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = true; ++ MSG_8192C("pDM_Odm TxPowerTrackControl = %d\n", pDM_Odm->RFCalibrateInfo.TxPowerTrackControl); ++ ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = true; ++ pDM_Odm->RFCalibrateInfo.ThermalValue = pHalData->EEPROMThermalMeter; ++ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = pHalData->EEPROMThermalMeter; ++ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = pHalData->EEPROMThermalMeter; ++ ++ // The index of "0 dB" in SwingTable. ++ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || ++ pDM_Odm->SupportICType == ODM_RTL8192E) ++ { ++ pDM_Odm->DefaultOfdmIndex = 30; ++ pDM_Odm->DefaultCckIndex = 20; ++ } else { ++ u1Byte defaultSwingIndex = getSwingIndex(pDM_Odm); ++ ++ pDM_Odm->DefaultOfdmIndex = (defaultSwingIndex == TXSCALE_TABLE_SIZE) ? 24 : defaultSwingIndex; ++ pDM_Odm->DefaultCckIndex = 24; ++ } ++ ++ pDM_Odm->BbSwingIdxCckBase = pDM_Odm->DefaultCckIndex; ++ pDM_Odm->RFCalibrateInfo.CCK_index = pDM_Odm->DefaultCckIndex; ++ ++ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) ++ { ++ pDM_Odm->BbSwingIdxOfdmBase[p] = pDM_Odm->DefaultOfdmIndex; ++ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pDM_Odm->DefaultOfdmIndex; ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = 0; ++ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] = 0; ++ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; ++ } ++ ++} ++ ++void ++ODM_TXPowerTrackingCheck( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ // ++ // For AP/ADSL use prtl8192cd_priv ++ // For CE/NIC use PADAPTER ++ // ++ ++ //if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) ++ //return; ++ ++ // ++ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate ++ // at the same time. In the stage2/3, we need to prive universal interface and merge all ++ // HW dynamic mechanism. ++ // ++ switch (pDM_Odm->SupportPlatform) ++ { ++ case ODM_WIN: ++ odm_TXPowerTrackingCheckMP(pDM_Odm); ++ break; ++ ++ case ODM_CE: ++ odm_TXPowerTrackingCheckCE(pDM_Odm); ++ break; ++ ++ case ODM_AP: ++ odm_TXPowerTrackingCheckAP(pDM_Odm); ++ break; ++ ++ case ODM_ADSL: ++ //odm_DIGAP(pDM_Odm); ++ break; ++ } ++ ++} ++ ++void ++odm_TXPowerTrackingCheckCE( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ ++ if(!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) ++ return; ++ ++ if(!pDM_Odm->RFCalibrateInfo.TM_Trigger) { //at least delay 1 sec ++ if(IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) )//||IS_HARDWARE_TYPE_8723B(Adapter)) ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_NEW, (BIT17 | BIT16), 0x03); ++ else ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_OLD, bRFRegOffsetMask, 0x60); ++ ++ pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; ++ return; ++ } ++ ODM_TXPowerTrackingCallback_ThermalMeter(Adapter); ++ pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; ++} ++ ++void ++odm_TXPowerTrackingCheckMP( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++} ++ ++void ++odm_TXPowerTrackingCheckAP( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++} ++ ++//3============================================================ ++//3 SW Antenna Diversity ++//3============================================================ ++#if(defined(CONFIG_SW_ANTENNA_DIVERSITY)) ++void ++odm_SwAntDivInit( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ odm_SwAntDivInit_NIC(pDM_Odm); ++} ++ ++void ++odm_SwAntDivInit_NIC( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ ++ ++// Init SW ANT DIV mechanism for 8723AE/AU/AS ++// CE/AP/ADSL no using SW ANT DIV for 8723A Series IC ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("SWAS:Init SW Antenna Switch\n")); ++ pDM_SWAT_Table->RSSI_sum_A = 0; ++ pDM_SWAT_Table->RSSI_cnt_A = 0; ++ pDM_SWAT_Table->RSSI_sum_B = 0; ++ pDM_SWAT_Table->RSSI_cnt_B = 0; ++ pDM_SWAT_Table->CurAntenna = MAIN_ANT; ++ pDM_SWAT_Table->PreAntenna = MAIN_ANT; ++ pDM_SWAT_Table->try_flag = 0xff; ++ pDM_SWAT_Table->PreRSSI = 0; ++ pDM_SWAT_Table->SWAS_NoLink_State = 0; ++ pDM_SWAT_Table->bTriggerAntennaSwitch = 0; ++ pDM_SWAT_Table->SelectAntennaMap=0xAA; ++ pDM_SWAT_Table->lastTxOkCnt = 0; ++ pDM_SWAT_Table->lastRxOkCnt = 0; ++ pDM_SWAT_Table->TXByteCnt_A = 0; ++ pDM_SWAT_Table->TXByteCnt_B = 0; ++ pDM_SWAT_Table->RXByteCnt_A = 0; ++ pDM_SWAT_Table->RXByteCnt_B = 0; ++ pDM_SWAT_Table->TrafficLoad = TRAFFIC_LOW; ++ pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 = ODM_Read4Byte(pDM_Odm, 0x860); ++ ++} ++ ++// ++// 20100514 Joseph: ++// Add new function to reset the state of antenna diversity before link. ++// ++void ++ODM_SwAntDivResetBeforeLink( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ ++ pDM_SWAT_Table->SWAS_NoLink_State = 0; ++ ++} ++ ++// ++// 20100514 Luke/Joseph: ++// Add new function to reset antenna diversity state after link. ++// ++void ++ODM_SwAntDivRestAfterLink( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ ++ pDM_SWAT_Table->RSSI_cnt_A = 0; ++ pDM_SWAT_Table->RSSI_cnt_B = 0; ++ pDM_Odm->RSSI_test = false; ++ pDM_SWAT_Table->try_flag = 0xff; ++ pDM_SWAT_Table->RSSI_Trying = 0; ++ pDM_SWAT_Table->SelectAntennaMap=0xAA; ++} ++ ++void ++ODM_SwAntDivChkPerPktRssi( ++ PDM_ODM_T pDM_Odm, ++ u1Byte StationID, ++ PODM_PHY_INFO_T pPhyInfo ++ ) ++{ ++ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ ++ if(!(pDM_Odm->SupportAbility & (ODM_BB_ANT_DIV))) ++ return; ++ ++// temporary Fix 8723A MP SW ANT DIV Bug --NeilChen--2012--07--11 ++ if(pDM_Odm->SupportICType == ODM_RTL8723A) ++ { ++ //if(StationID == pDM_SWAT_Table->RSSI_target) ++ //{ ++ //1 RSSI for SW Antenna Switch ++ if(pDM_SWAT_Table->CurAntenna == MAIN_ANT) ++ { ++ pDM_SWAT_Table->RSSI_sum_A += pPhyInfo->RxPWDBAll; ++ pDM_SWAT_Table->RSSI_cnt_A++; ++ } ++ else ++ { ++ pDM_SWAT_Table->RSSI_sum_B += pPhyInfo->RxPWDBAll; ++ pDM_SWAT_Table->RSSI_cnt_B++; ++ ++ } ++ //} ++ } ++ else ++ { ++ if(StationID == pDM_SWAT_Table->RSSI_target) ++ { ++ //1 RSSI for SW Antenna Switch ++ if(pDM_SWAT_Table->CurAntenna == MAIN_ANT) ++ { ++ pDM_SWAT_Table->RSSI_sum_A += pPhyInfo->RxPWDBAll; ++ pDM_SWAT_Table->RSSI_cnt_A++; ++ } ++ else ++ { ++ pDM_SWAT_Table->RSSI_sum_B += pPhyInfo->RxPWDBAll; ++ pDM_SWAT_Table->RSSI_cnt_B++; ++ ++ } ++ } ++ } ++} ++ ++// ++void ++odm_SwAntDivChkAntSwitch( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Step ++ ) ++{ ++ // ++ // For AP/ADSL use prtl8192cd_priv ++ // For CE/NIC use PADAPTER ++ // ++ prtl8192cd_priv priv = pDM_Odm->priv; ++ ++ // ++ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate ++ // at the same time. In the stage2/3, we need to prive universal interface and merge all ++ // HW dynamic mechanism. ++ // ++ switch (pDM_Odm->SupportPlatform) ++ { ++ case ODM_WIN: ++ odm_SwAntDivChkAntSwitchNIC(pDM_Odm, Step); ++ break; ++ case ODM_CE: ++ odm_SwAntDivChkAntSwitchNIC(pDM_Odm, Step); ++ break; ++ ++ case ODM_AP: ++ case ODM_ADSL: ++ break; ++ } ++ ++} ++ ++// ++// 20100514 Luke/Joseph: ++// Add new function for antenna diversity after link. ++// This is the main function of antenna diversity after link. ++// This function is called in HalDmWatchDog() and ODM_SwAntDivChkAntSwitchCallback(). ++// HalDmWatchDog() calls this function with SWAW_STEP_PEAK to initialize the antenna test. ++// In SWAW_STEP_PEAK, another antenna and a 500ms timer will be set for testing. ++// After 500ms, ODM_SwAntDivChkAntSwitchCallback() calls this function to compare the signal just ++// listened on the air with the RSSI of original antenna. ++// It chooses the antenna with better RSSI. ++// There is also a aged policy for error trying. Each error trying will cost more 5 seconds waiting ++// penalty to get next try. ++ ++ ++void ++ODM_SetAntenna( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Antenna) ++{ ++ ODM_SetBBReg(pDM_Odm, 0x860, BIT8|BIT9, Antenna); ++} ++ ++void ++odm_SwAntDivChkAntSwitchNIC( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Step ++ ) ++{ ++} ++ ++// ++// 20100514 Luke/Joseph: ++// Callback function for 500ms antenna test trying. ++// ++void odm_SwAntDivChkAntSwitchCallback(void *FunctionContext) ++{ ++ PDM_ODM_T pDM_Odm= (PDM_ODM_T)FunctionContext; ++ PADAPTER padapter = pDM_Odm->Adapter; ++ if(padapter->net_closed == true) ++ return; ++ odm_SwAntDivChkAntSwitch(pDM_Odm, SWAW_STEP_DETERMINE); ++} ++ ++#else //#if(defined(CONFIG_SW_ANTENNA_DIVERSITY)) ++ ++void odm_SwAntDivInit( PDM_ODM_T pDM_Odm ) {} ++void ODM_SwAntDivChkPerPktRssi( ++ PDM_ODM_T pDM_Odm, ++ u1Byte StationID, ++ PODM_PHY_INFO_T pPhyInfo ++ ) {} ++void odm_SwAntDivChkAntSwitch( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Step ++ ) {} ++void ODM_SwAntDivResetBeforeLink( PDM_ODM_T pDM_Odm ){} ++void ODM_SwAntDivRestAfterLink( PDM_ODM_T pDM_Odm ){} ++void odm_SwAntDivChkAntSwitchCallback(void *FunctionContext){} ++ ++#endif //#if(defined(CONFIG_SW_ANTENNA_DIVERSITY)) ++ ++//3============================================================ ++//3 SW Antenna Diversity ++//3============================================================ ++ ++#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) ++void ++odm_InitHybridAntDiv_88C_92D( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ ++ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ u1Byte bTxPathSel=0; //0:Path-A 1:Path-B ++ u1Byte i; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_InitHybridAntDiv==============>\n")); ++ ++ //whether to do antenna diversity or not ++ ++ if((pDM_Odm->SupportICType != ODM_RTL8192C) && (pDM_Odm->SupportICType != ODM_RTL8192D)) ++ return; ++ ++ ++ bTxPathSel=(pDM_Odm->RFType==ODM_1T1R)?false:true; ++ ++ ODM_SetBBReg(pDM_Odm,ODM_REG_BB_PWR_SAV1_11N, BIT23, 0); //No update ANTSEL during GNT_BT=1 ++ ODM_SetBBReg(pDM_Odm,ODM_REG_TX_ANT_CTRL_11N, BIT21, 1); //TX atenna selection from tx_info ++ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_PIN_11N, BIT23, 1); //enable LED[1:0] pin as ANTSEL ++ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_CTRL_11N, BIT8|BIT9, 0x01); // 0x01: left antenna, 0x02: right antenna ++ ++ // only AP support different path selection temperarly ++ if(!bTxPathSel){ //PATH-A ++ ODM_SetBBReg(pDM_Odm,ODM_REG_PIN_CTRL_11N, BIT8|BIT9, 0 ); // ANTSEL as HW control ++ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_PATH_11N, BIT13, 1); //select TX ANTESEL from path A ++ } ++ else { ++ ODM_SetBBReg(pDM_Odm,ODM_REG_PIN_CTRL_11N, BIT24|BIT25, 0 ); // ANTSEL as HW control ++ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_PATH_11N, BIT13, 0); //select ANTESEL from path B ++ } ++ ++ //Set OFDM HW RX Antenna Diversity ++ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTDIV_PARA1_11N, 0x7FF, 0x0c0); //Pwdb threshold=8dB ++ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTDIV_PARA1_11N, BIT11, 0); //Switch to another antenna by checking pwdb threshold ++ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTDIV_PARA3_11N, BIT23, 1); // Decide final antenna by comparing 2 antennas' pwdb ++ ++ //Set CCK HW RX Antenna Diversity ++ ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA2_11N, BIT4, 0); //Antenna diversity decision period = 32 sample ++ ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA2_11N, 0xf, 0xf); //Threshold for antenna diversity. Check another antenna power if input power < ANT_lim*4 ++ ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA3_11N, BIT13, 1); //polarity ana_A=1 and ana_B=0 ++ ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA4_11N, 0x1f, 0x8); //default antenna power = inpwr*(0.5 + r_ant_step/16) ++ ++ ++ //Enable HW Antenna Diversity ++ if(!bTxPathSel) //PATH-A ++ ODM_SetBBReg(pDM_Odm,ODM_REG_IGI_A_11N, BIT7,1); // Enable Hardware antenna switch ++ else ++ ODM_SetBBReg(pDM_Odm,ODM_REG_IGI_B_11N, BIT7,1); // Enable Hardware antenna switch ++ ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA1_11N, BIT15, 1);//Enable antenna diversity ++ ++ pDM_SWAT_Table->CurAntenna=0; //choose left antenna as default antenna ++ pDM_SWAT_Table->PreAntenna=0; ++ for(i=0; iCCK_Ant1_Cnt[i] = 0; ++ pDM_SWAT_Table->CCK_Ant2_Cnt[i] = 0; ++ pDM_SWAT_Table->OFDM_Ant1_Cnt[i] = 0; ++ pDM_SWAT_Table->OFDM_Ant2_Cnt[i] = 0; ++ pDM_SWAT_Table->RSSI_Ant1_Sum[i] = 0; ++ pDM_SWAT_Table->RSSI_Ant2_Sum[i] = 0; ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("<==============odm_InitHybridAntDiv\n")); ++} ++ ++ ++void ++odm_InitHybridAntDiv( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("Return: Not Support HW AntDiv\n")); ++ return; ++ } ++} ++ ++bool ++odm_StaDefAntSel( ++ PDM_ODM_T pDM_Odm, ++ u4Byte OFDM_Ant1_Cnt, ++ u4Byte OFDM_Ant2_Cnt, ++ u4Byte CCK_Ant1_Cnt, ++ u4Byte CCK_Ant2_Cnt, ++ u1Byte *pDefAnt ++ ++ ) ++{ ++#if 1 ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_StaDefAntSelect==============>\n")); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("OFDM_Ant1_Cnt:%d, OFDM_Ant2_Cnt:%d\n",OFDM_Ant1_Cnt,OFDM_Ant2_Cnt)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("CCK_Ant1_Cnt:%d, CCK_Ant2_Cnt:%d\n",CCK_Ant1_Cnt,CCK_Ant2_Cnt)); ++ ++ ++ if(((OFDM_Ant1_Cnt+OFDM_Ant2_Cnt)==0)&&((CCK_Ant1_Cnt + CCK_Ant2_Cnt) <10)){ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_StaDefAntSelect Fail: No enough packet info!\n")); ++ return false; ++ } ++ ++ if(OFDM_Ant1_Cnt || OFDM_Ant2_Cnt ) { ++ //if RX OFDM packet number larger than 0 ++ if(OFDM_Ant1_Cnt > OFDM_Ant2_Cnt) ++ (*pDefAnt)=1; ++ else ++ (*pDefAnt)=0; ++ } ++ // else if RX CCK packet number larger than 10 ++ else if((CCK_Ant1_Cnt + CCK_Ant2_Cnt) >=10 ) ++ { ++ if(CCK_Ant1_Cnt > (5*CCK_Ant2_Cnt)) ++ (*pDefAnt)=1; ++ else if(CCK_Ant2_Cnt > (5*CCK_Ant1_Cnt)) ++ (*pDefAnt)=0; ++ else if(CCK_Ant1_Cnt > CCK_Ant2_Cnt) ++ (*pDefAnt)=0; ++ else ++ (*pDefAnt)=1; ++ ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("TxAnt = %s\n",((*pDefAnt)==1)?"Ant1":"Ant2")); ++ ++#endif ++ //u4Byte antsel = ODM_GetBBReg(pDM_Odm, 0xc88, bMaskByte0); ++ //(*pDefAnt)= (u1Byte) antsel; ++ ++ ++ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("<==============odm_StaDefAntSelect\n")); ++ ++ return true; ++ ++ ++} ++ ++ ++void ++odm_SetRxIdleAnt( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Ant, ++ bool bDualPath ++) ++{ ++ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ ++ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_SetRxIdleAnt==============>\n")); ++ ++ if(Ant != pDM_SWAT_Table->RxIdleAnt) ++ { ++ //for path-A ++ if(Ant==1) ++ ODM_SetBBReg(pDM_Odm,ODM_REG_RX_DEFUALT_A_11N, 0xFFFF, 0x65a9); //right-side antenna ++ else ++ ODM_SetBBReg(pDM_Odm,ODM_REG_RX_DEFUALT_A_11N, 0xFFFF, 0x569a); //left-side antenna ++ ++ //for path-B ++ if(bDualPath){ ++ if(Ant==0) ++ ODM_SetBBReg(pDM_Odm,ODM_REG_RX_DEFUALT_A_11N, 0xFFFF0000, 0x65a9); //right-side antenna ++ else ++ ODM_SetBBReg(pDM_Odm,ODM_REG_RX_DEFUALT_A_11N, 0xFFFF0000, 0x569a); //left-side antenna ++ } ++ } ++ pDM_SWAT_Table->RxIdleAnt = Ant; ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("RxIdleAnt: %s Reg858=0x%x\n",(Ant==1)?"Ant1":"Ant2",(Ant==1)?0x65a9:0x569a)); ++ ++ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("<==============odm_SetRxIdleAnt\n")); ++ ++ } ++ ++void ++ODM_AntselStatistics_88C( ++ PDM_ODM_T pDM_Odm, ++ u1Byte MacId, ++ u4Byte PWDBAll, ++ bool isCCKrate ++) ++{ ++ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ ++ if(pDM_SWAT_Table->antsel == 1) ++ { ++ if(isCCKrate) ++ pDM_SWAT_Table->CCK_Ant1_Cnt[MacId]++; ++ else ++ { ++ pDM_SWAT_Table->OFDM_Ant1_Cnt[MacId]++; ++ pDM_SWAT_Table->RSSI_Ant1_Sum[MacId] += PWDBAll; ++ } ++ } ++ else ++ { ++ if(isCCKrate) ++ pDM_SWAT_Table->CCK_Ant2_Cnt[MacId]++; ++ else ++ { ++ pDM_SWAT_Table->OFDM_Ant2_Cnt[MacId]++; ++ pDM_SWAT_Table->RSSI_Ant2_Sum[MacId] += PWDBAll; ++ } ++ } ++ ++} ++ ++ ++ ++ ++void ++ODM_SetTxAntByTxInfo_88C_92D( ++ PDM_ODM_T pDM_Odm ++) ++{ ++} ++ ++void ++odm_HwAntDiv_92C_92D( ++ PDM_ODM_T pDM_Odm ++) ++{ ++ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ u4Byte RSSI_Min=0xFF, RSSI, RSSI_Ant1, RSSI_Ant2; ++ u1Byte RxIdleAnt, i; ++ bool bRet=false; ++ PSTA_INFO_T pEntry; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_HwAntDiv==============>\n")); ++ ++ if(!(pDM_Odm->SupportAbility&ODM_BB_ANT_DIV)) //if don't support antenna diveristy ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_HwAntDiv: Not supported!\n")); ++ return; ++ } ++ ++ if((pDM_Odm->SupportICType != ODM_RTL8192C) && (pDM_Odm->SupportICType != ODM_RTL8192D)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("Return: IC Type is not 92C or 92D\n")); ++ return; ++ } ++ ++ if(!pDM_Odm->bLinked) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("Return: bLinked is false\n")); ++ return; ++ } ++ ++ for (i=0; ipODM_StaInfo[i]; ++ if(IS_STA_VALID(pEntry)) ++ { ++ ++ RSSI_Ant1 = (pDM_SWAT_Table->OFDM_Ant1_Cnt[i] == 0)?0:(pDM_SWAT_Table->RSSI_Ant1_Sum[i]/pDM_SWAT_Table->OFDM_Ant1_Cnt[i]); ++ RSSI_Ant2 = (pDM_SWAT_Table->OFDM_Ant2_Cnt[i] == 0)?0:(pDM_SWAT_Table->RSSI_Ant2_Sum[i]/pDM_SWAT_Table->OFDM_Ant2_Cnt[i]); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("RSSI_Ant1=%d, RSSI_Ant2=%d\n", RSSI_Ant1, RSSI_Ant2)); ++ ++ if(RSSI_Ant1 ||RSSI_Ant2) { ++ RSSI = (RSSI_Ant1 < RSSI_Ant2) ? RSSI_Ant1 : RSSI_Ant2; ++ if((!RSSI) || ( RSSI < RSSI_Min) ) { ++ pDM_SWAT_Table->TargetSTA = i; ++ RSSI_Min = RSSI; ++ } ++ } ++ ///STA: found out default antenna ++ bRet=odm_StaDefAntSel(pDM_Odm, ++ pDM_SWAT_Table->OFDM_Ant1_Cnt[i], ++ pDM_SWAT_Table->OFDM_Ant2_Cnt[i], ++ pDM_SWAT_Table->CCK_Ant1_Cnt[i], ++ pDM_SWAT_Table->CCK_Ant2_Cnt[i], ++ &pDM_SWAT_Table->TxAnt[i]); ++ ++ //if Tx antenna selection: successful ++ if(bRet){ ++ pDM_SWAT_Table->RSSI_Ant1_Sum[i] = 0; ++ pDM_SWAT_Table->RSSI_Ant2_Sum[i] = 0; ++ pDM_SWAT_Table->OFDM_Ant1_Cnt[i] = 0; ++ pDM_SWAT_Table->OFDM_Ant2_Cnt[i] = 0; ++ pDM_SWAT_Table->CCK_Ant1_Cnt[i] = 0; ++ pDM_SWAT_Table->CCK_Ant2_Cnt[i] = 0; ++ } ++ } ++ } ++ ++ //set RX Idle Ant ++ RxIdleAnt = pDM_SWAT_Table->TxAnt[pDM_SWAT_Table->TargetSTA]; ++ odm_SetRxIdleAnt(pDM_Odm, RxIdleAnt, false); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("<==============odm_HwAntDiv\n")); ++} ++ ++void ++odm_HwAntDiv( ++ PDM_ODM_T pDM_Odm ++) ++{ ++ ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("Return: Not Support HW AntDiv\n")); ++ return; ++ } ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8821) ++ ODM_AntennaDiversity_8821A(pDM_Odm); ++} ++ ++#else //#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) ++ ++void odm_InitHybridAntDiv(PDM_ODM_T pDM_Odm ){} ++void odm_HwAntDiv( PDM_ODM_T pDM_Odm){} ++void ODM_SetTxAntByTxInfo_88C_92D(PDM_ODM_T pDM_Odm){ } ++ ++#endif //#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) ++ ++ ++ ++//============================================================ ++//EDCA Turbo ++//============================================================ ++void ++ODM_EdcaTurboInit( ++ PDM_ODM_T pDM_Odm) ++{ ++ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = false; ++ pDM_Odm->DM_EDCA_Table.bIsCurRDLState = false; ++ Adapter->recvpriv.bIsAnyNonBEPkts =false; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VO PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VO_PARAM))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VI PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VI_PARAM))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BE PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BE_PARAM))); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BK PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BK_PARAM))); ++ ++ ++} // ODM_InitEdcaTurbo ++ ++void ++odm_EdcaTurboCheck( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ // ++ // For AP/ADSL use prtl8192cd_priv ++ // For CE/NIC use PADAPTER ++ // ++ ++ // ++ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate ++ // at the same time. In the stage2/3, we need to prive universal interface and merge all ++ // HW dynamic mechanism. ++ // ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("odm_EdcaTurboCheck========================>\n")); ++ ++ if(!(pDM_Odm->SupportAbility& ODM_MAC_EDCA_TURBO )) ++ return; ++ ++ switch (pDM_Odm->SupportPlatform) { ++ case ODM_WIN: ++ break; ++ case ODM_CE: ++ odm_EdcaTurboCheckCE(pDM_Odm); ++ break; ++ case ODM_AP: ++ case ODM_ADSL: ++ break; ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("<========================odm_EdcaTurboCheck\n")); ++ ++} // odm_CheckEdcaTurbo ++ ++void ++odm_EdcaTurboCheckCE( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ u32 EDCA_BE_UL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[pMgntInfo->IOTPeer]; ++ u32 EDCA_BE_DL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[pMgntInfo->IOTPeer]; ++ u32 ICType=pDM_Odm->SupportICType; ++ u32 IOTPeer=0; ++ u8 WirelessMode=0xFF; //invalid value ++ u32 trafficIndex; ++ u32 edca_param; ++ u64 cur_tx_bytes = 0; ++ u64 cur_rx_bytes = 0; ++ u8 bbtchange = false; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); ++ struct recv_priv *precvpriv = &(Adapter->recvpriv); ++ struct registry_priv *pregpriv = &Adapter->registrypriv; ++ struct mlme_ext_priv *pmlmeext = &(Adapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ ++ if ((pregpriv->wifi_spec == 1) )//|| (pmlmeinfo->HT_enable == 0)) ++ { ++ goto dm_CheckEdcaTurbo_EXIT; ++ } ++ ++ if(pDM_Odm->pWirelessMode!=NULL) ++ WirelessMode=*(pDM_Odm->pWirelessMode); ++ ++ IOTPeer = pmlmeinfo->assoc_AP_vendor; ++ ++ if (IOTPeer >= HT_IOT_PEER_MAX) ++ { ++ goto dm_CheckEdcaTurbo_EXIT; ++ } ++ ++ // Check if the status needs to be changed. ++ if((bbtchange) || (!precvpriv->bIsAnyNonBEPkts) ) ++ { ++ cur_tx_bytes = pxmitpriv->tx_bytes - pxmitpriv->last_tx_bytes; ++ cur_rx_bytes = precvpriv->rx_bytes - precvpriv->last_rx_bytes; ++ ++ //traffic, TX or RX ++ if((IOTPeer == HT_IOT_PEER_RALINK)||(IOTPeer == HT_IOT_PEER_ATHEROS)) ++ { ++ if (cur_tx_bytes > (cur_rx_bytes << 2)) ++ { // Uplink TP is present. ++ trafficIndex = UP_LINK; ++ } ++ else ++ { // Balance TP is present. ++ trafficIndex = DOWN_LINK; ++ } ++ } ++ else ++ { ++ if (cur_rx_bytes > (cur_tx_bytes << 2)) ++ { // Downlink TP is present. ++ trafficIndex = DOWN_LINK; ++ } ++ else ++ { // Balance TP is present. ++ trafficIndex = UP_LINK; ++ } ++ } ++ ++ if ((pDM_Odm->DM_EDCA_Table.prv_traffic_idx != trafficIndex) || (!pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA)) ++ { ++ if(ICType==ODM_RTL8192D) ++ { ++ // Single PHY ++ if(pDM_Odm->RFType==ODM_2T2R) ++ { ++ EDCA_BE_UL = 0x60a42b; //0x5ea42b; ++ EDCA_BE_DL = 0x60a42b; //0x5ea42b; ++ } ++ else ++ { ++ EDCA_BE_UL = 0x6ea42b; ++ EDCA_BE_DL = 0x6ea42b; ++ } ++ } ++ else ++ { ++ if(pDM_Odm->SupportInterface==ODM_ITRF_PCIE) { ++ if((ICType==ODM_RTL8192C)&&(pDM_Odm->RFType==ODM_2T2R)) { ++ EDCA_BE_UL = 0x60a42b; ++ EDCA_BE_DL = 0x60a42b; ++ } ++ else ++ { ++ EDCA_BE_UL = 0x6ea42b; ++ EDCA_BE_DL = 0x6ea42b; ++ } ++ } ++ } ++ ++ //92D txop can't be set to 0x3e for cisco1250 ++ if((ICType!=ODM_RTL8192D) && (IOTPeer== HT_IOT_PEER_CISCO) &&(WirelessMode==ODM_WM_N24G)) ++ { ++ EDCA_BE_DL = edca_setting_DL[IOTPeer]; ++ EDCA_BE_UL = edca_setting_UL[IOTPeer]; ++ } ++ //merge from 92s_92c_merge temp brunch v2445 20120215 ++ else if((IOTPeer == HT_IOT_PEER_CISCO) &&((WirelessMode==ODM_WM_G)||(WirelessMode==(ODM_WM_B|ODM_WM_G))||(WirelessMode==ODM_WM_A)||(WirelessMode==ODM_WM_B))) ++ { ++ EDCA_BE_DL = edca_setting_DL_GMode[IOTPeer]; ++ } ++ else if((IOTPeer== HT_IOT_PEER_AIRGO )&& ((WirelessMode==ODM_WM_G)||(WirelessMode==ODM_WM_A))) ++ { ++ EDCA_BE_DL = 0xa630; ++ } ++ else if(IOTPeer == HT_IOT_PEER_MARVELL) ++ { ++ EDCA_BE_DL = edca_setting_DL[IOTPeer]; ++ EDCA_BE_UL = edca_setting_UL[IOTPeer]; ++ } ++ else if(IOTPeer == HT_IOT_PEER_ATHEROS) ++ { ++ // Set DL EDCA for Atheros peer to 0x3ea42b. Suggested by SD3 Wilson for ASUS TP issue. ++ EDCA_BE_DL = edca_setting_DL[IOTPeer]; ++ } ++ ++ if((ICType==ODM_RTL8812)||(ICType==ODM_RTL8192E)) //add 8812AU/8812AE ++ { ++ EDCA_BE_UL = 0x5ea42b; ++ EDCA_BE_DL = 0x5ea42b; ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8812A: EDCA_BE_UL=0x%x EDCA_BE_DL =0x%x",EDCA_BE_UL,EDCA_BE_DL)); ++ } ++ ++ if (trafficIndex == DOWN_LINK) ++ edca_param = EDCA_BE_DL; ++ else ++ edca_param = EDCA_BE_UL; ++ ++ rtw_write32(Adapter, REG_EDCA_BE_PARAM, edca_param); ++ ++ pDM_Odm->DM_EDCA_Table.prv_traffic_idx = trafficIndex; ++ } ++ ++ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = true; ++ } ++ else ++ { ++ // ++ // Turn Off EDCA turbo here. ++ // Restore original EDCA according to the declaration of AP. ++ // ++ if(pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA) ++ { ++ rtw_write32(Adapter, REG_EDCA_BE_PARAM, pHalData->AcParam_BE); ++ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = false; ++ } ++ } ++ ++dm_CheckEdcaTurbo_EXIT: ++ // Set variables for next time. ++ precvpriv->bIsAnyNonBEPkts = false; ++ pxmitpriv->last_tx_bytes = pxmitpriv->tx_bytes; ++ precvpriv->last_rx_bytes = precvpriv->rx_bytes; ++} ++ ++// need to ODM CE Platform ++//move to here for ANT detection mechanism using ++ ++u4Byte ++GetPSDData( ++ PDM_ODM_T pDM_Odm, ++ unsigned int point, ++ u1Byte initial_gain_psd) ++{ ++ //unsigned int val, rfval; ++ //int psd_report; ++ u4Byte psd_report; ++ ++ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ //Debug Message ++ //val = PHY_QueryBBReg(Adapter,0x908, bMaskDWord); ++ //DbgPrint("Reg908 = 0x%x\n",val); ++ //val = PHY_QueryBBReg(Adapter,0xDF4, bMaskDWord); ++ //rfval = PHY_QueryRFReg(Adapter, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask); ++ //DbgPrint("RegDF4 = 0x%x, RFReg00 = 0x%x\n",val, rfval); ++ //DbgPrint("PHYTXON = %x, OFDMCCA_PP = %x, CCKCCA_PP = %x, RFReg00 = %x\n", ++ //(val&BIT25)>>25, (val&BIT14)>>14, (val&BIT15)>>15, rfval); ++ ++ //Set DCO frequency index, offset=(40MHz/SamplePts)*point ++ ODM_SetBBReg(pDM_Odm, 0x808, 0x3FF, point); ++ ++ //Start PSD calculation, Reg808[22]=0->1 ++ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 1); ++ //Need to wait for HW PSD report ++ ODM_StallExecution(1000); ++ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 0); ++ //Read PSD report, Reg8B4[15:0] ++ psd_report = ODM_GetBBReg(pDM_Odm,0x8B4, bMaskDWord) & 0x0000FFFF; ++ ++ psd_report = (u4Byte) (ConvertTo_dB(psd_report))+(u4Byte)(initial_gain_psd-0x1c); ++ ++ return psd_report; ++} ++ ++u4Byte ++ConvertTo_dB( ++ u4Byte Value) ++{ ++ u1Byte i; ++ u1Byte j; ++ u4Byte dB; ++ ++ Value = Value & 0xFFFF; ++ ++ for (i=0;i<8;i++) ++ { ++ if (Value <= dB_Invert_Table[i][11]) ++ { ++ break; ++ } ++ } ++ ++ if (i >= 8) ++ { ++ return (96); // maximum 96 dB ++ } ++ ++ for (j=0;j<12;j++) ++ { ++ if (Value <= dB_Invert_Table[i][j]) ++ { ++ break; ++ } ++ } ++ ++ dB = i*12 + j + 1; ++ ++ return (dB); ++} ++ ++void ++odm_PathDiversityInit( ++ PDM_ODM_T pDM_Odm ++) ++{ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Return: Not Support PathDiv\n")); ++ return; ++ } ++} ++ ++void ++odm_PathDiversity( ++ PDM_ODM_T pDM_Odm ++) ++{ ++ if(!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) ++ { ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Return: Not Support PathDiv\n")); ++ return; ++ } ++} ++ ++void ++odm_PHY_SaveAFERegisters( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte AFEReg, ++ pu4Byte AFEBackup, ++ u4Byte RegisterNum ++ ) ++{ ++ u4Byte i; ++ ++ //RT_DISP(FINIT, INIT_IQK, ("Save ADDA parameters.\n")); ++ for( i = 0 ; i < RegisterNum ; i++){ ++ AFEBackup[i] = ODM_GetBBReg(pDM_Odm, AFEReg[i], bMaskDWord); ++ } ++} ++ ++void ++odm_PHY_ReloadAFERegisters( ++ PDM_ODM_T pDM_Odm, ++ pu4Byte AFEReg, ++ pu4Byte AFEBackup, ++ u4Byte RegiesterNum ++ ) ++{ ++ u4Byte i; ++ ++ //RT_DISP(FINIT, INIT_IQK, ("Reload ADDA power saving parameters !\n")); ++ for(i = 0 ; i < RegiesterNum; i++) ++ { ++ ++ ODM_SetBBReg(pDM_Odm, AFEReg[i], bMaskDWord, AFEBackup[i]); ++ } ++} ++ ++// ++// Description: ++// Set Single/Dual Antenna default setting for products that do not do detection in advance. ++// ++// Added by Joseph, 2012.03.22 ++// ++void ++ODM_SingleDualAntennaDefaultSetting( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ pDM_SWAT_Table->ANTA_ON=true; ++ pDM_SWAT_Table->ANTB_ON=true; ++} ++ ++ ++ ++//2 8723A ANT DETECT ++// ++// Description: ++// Implement IQK single tone for RF DPK loopback and BB PSD scanning. ++// This function is cooperated with BB team Neil. ++// ++// Added by Roger, 2011.12.15 ++// ++bool ++ODM_SingleDualAntennaDetection( ++ PDM_ODM_T pDM_Odm, ++ u1Byte mode ++ ) ++{ ++ PADAPTER pAdapter = pDM_Odm->Adapter; ++ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ u4Byte CurrentChannel,RfLoopReg; ++ u1Byte n; ++ u4Byte Reg88c, Regc08, Reg874, Regc50; ++ u1Byte initial_gain = 0x5a; ++ u4Byte PSD_report_tmp; ++ u4Byte AntA_report = 0x0, AntB_report = 0x0,AntO_report=0x0; ++ bool bResult = true; ++ bool bAntDetection = false; ++ u4Byte AFE_Backup[16]; ++ u4Byte AFE_REG_8723A[16] = { ++ rRx_Wait_CCA, rTx_CCK_RFON, ++ rTx_CCK_BBON, rTx_OFDM_RFON, ++ rTx_OFDM_BBON, rTx_To_Rx, ++ rTx_To_Tx, rRx_CCK, ++ rRx_OFDM, rRx_Wait_RIFS, ++ rRx_TO_Rx, rStandby, ++ rSleep, rPMPD_ANAEN, ++ rFPGA0_XCD_SwitchControl, rBlue_Tooth}; ++ ++ ++ // Retrieve antenna detection registry info, added by Roger, 2012.11.27. ++ pAdapter->HalFunc.GetHalDefVarHandler(pAdapter, HAL_DEF_ANT_DETECT, &bAntDetection); ++ ++ if(!(pDM_Odm->SupportICType & (ODM_RTL8723A|ODM_RTL8192C))) ++ return bResult; ++ ++ if(!(pDM_Odm->SupportAbility&ODM_BB_ANT_DIV) && !bAntDetection) ++ return bResult; ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8192C) ++ { ++ //Which path in ADC/DAC is turnned on for PSD: both I/Q ++ ODM_SetBBReg(pDM_Odm, 0x808, BIT10|BIT11, 0x3); ++ //Ageraged number: 8 ++ ODM_SetBBReg(pDM_Odm, 0x808, BIT12|BIT13, 0x1); ++ //pts = 128; ++ ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x0); ++ } ++ ++ //1 Backup Current RF/BB Settings ++ ++ CurrentChannel = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask); ++ RfLoopReg = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, ODM_DPDT, Antenna_A); // change to Antenna A ++ // Step 1: USE IQK to transmitter single tone ++ ++ ODM_StallExecution(10); ++ ++ //Store A Path Register 88c, c08, 874, c50 ++ Reg88c = ODM_GetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord); ++ Regc08 = ODM_GetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord); ++ Reg874 = ODM_GetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord); ++ Regc50 = ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord); ++ ++ // Store AFE Registers ++ odm_PHY_SaveAFERegisters(pDM_Odm, AFE_REG_8723A, AFE_Backup, 16); ++ ++ //Set PSD 128 pts ++ ODM_SetBBReg(pDM_Odm, rFPGA0_PSDFunction, BIT14|BIT15, 0x0); //128 pts ++ ++ // To SET CH1 to do ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask, 0x7401); //Channel 1 ++ ++ // AFE all on step ++ ODM_SetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rTx_CCK_RFON, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rTx_CCK_BBON, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rTx_OFDM_RFON, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rTx_OFDM_BBON, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rTx_To_Rx, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rTx_To_Tx, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rRx_CCK, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rRx_OFDM, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rRx_Wait_RIFS, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rRx_TO_Rx, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rStandby, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rSleep, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rPMPD_ANAEN, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_SwitchControl, bMaskDWord, 0x6FDB25A4); ++ ODM_SetBBReg(pDM_Odm, rBlue_Tooth, bMaskDWord, 0x6FDB25A4); ++ ++ // 3 wire Disable ++ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord, 0xCCF000C0); ++ ++ //BB IQK Setting ++ ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, 0x000800E4); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x22208000); ++ ++ //IQK setting tone@ 4.34Mhz ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x10008C1C); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); ++ ++ ++ //Page B init ++ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00080000); ++ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x0f600000); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x10008c1f); ++ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82150008); ++ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28150008); ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x001028d0); ++ ++ //RF loop Setting ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x0, 0xFFFFF, 0x50008); ++ ++ //IQK Single tone start ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, bMaskDWord, 0x80800000); ++ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); ++ ODM_StallExecution(10000); ++ PSD_report_tmp=0x0; ++ ++ for (n=0;n<2;n++) ++ { ++ PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); ++ if(PSD_report_tmp >AntA_report) ++ AntA_report=PSD_report_tmp; ++ } ++ ++ PSD_report_tmp=0x0; ++ ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, 0x300, Antenna_B); // change to Antenna B ++ ODM_StallExecution(10); ++ ++ ++ for (n=0;n<2;n++) ++ { ++ PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); ++ if(PSD_report_tmp > AntB_report) ++ AntB_report=PSD_report_tmp; ++ } ++ ++ // change to open case ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, 0x300, 0); // change to Ant A and B all open case ++ ODM_StallExecution(10); ++ ++ for (n=0;n<2;n++) ++ { ++ PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); ++ if(PSD_report_tmp > AntO_report) ++ AntO_report=PSD_report_tmp; ++ } ++ ++ //Close IQK Single Tone function ++ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, bMaskDWord, 0x00000000); ++ PSD_report_tmp = 0x0; ++ ++ //1 Return to antanna A ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, 0x300, Antenna_A); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord, Reg88c); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, Regc08); ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, Reg874); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, 0x7F, 0x40); ++ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord, Regc50); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask,CurrentChannel); ++ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask,RfLoopReg); ++ ++ //Reload AFE Registers ++ odm_PHY_ReloadAFERegisters(pDM_Odm, AFE_REG_8723A, AFE_Backup, 16); ++ ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_A[%d]= %d \n", 2416, AntA_report)); ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_B[%d]= %d \n", 2416, AntB_report)); ++ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_O[%d]= %d \n", 2416, AntO_report)); ++ ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8723A) ++ { ++ //2 Test Ant B based on Ant A is ON ++ if(mode==ANTTESTB) ++ { ++ if(AntA_report >= 100) ++ { ++ if(AntB_report > (AntA_report+1)) ++ { ++ pDM_SWAT_Table->ANTB_ON=false; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Single Antenna A\n")); ++ } ++ else ++ { ++ pDM_SWAT_Table->ANTB_ON=true; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Dual Antenna is A and B\n")); ++ } ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Need to check again\n")); ++ pDM_SWAT_Table->ANTB_ON=false; // Set Antenna B off as default ++ bResult = false; ++ } ++ } ++ //2 Test Ant A and B based on DPDT Open ++ else if(mode==ANTTESTALL) ++ { ++ if((AntO_report >=100) && (AntO_report <=118)) ++ { ++ if(AntA_report > (AntO_report+1)) ++ { ++ pDM_SWAT_Table->ANTA_ON=false; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Ant A is OFF\n")); ++ } ++ else ++ { ++ pDM_SWAT_Table->ANTA_ON=true; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Ant A is ON\n")); ++ } ++ ++ if(AntB_report > (AntO_report+2)) ++ { ++ pDM_SWAT_Table->ANTB_ON=false; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Ant B is OFF\n")); ++ } ++ else ++ { ++ pDM_SWAT_Table->ANTB_ON=true; ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Ant B is ON\n")); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_A[%d]= %d \n", 2416, AntA_report)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_B[%d]= %d \n", 2416, AntB_report)); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_O[%d]= %d \n", 2416, AntO_report)); ++ ++ pDM_Odm->AntDetectedInfo.bAntDetected= true; ++ pDM_Odm->AntDetectedInfo.dBForAntA = AntA_report; ++ pDM_Odm->AntDetectedInfo.dBForAntB = AntB_report; ++ pDM_Odm->AntDetectedInfo.dBForAntO = AntO_report; ++ ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("return false!!\n")); ++ bResult = false; ++ } ++ } ++ } ++ else if(pDM_Odm->SupportICType == ODM_RTL8192C) ++ { ++ if(AntA_report >= 100) ++ { ++ if(AntB_report > (AntA_report+2)) ++ { ++ pDM_SWAT_Table->ANTA_ON=false; ++ pDM_SWAT_Table->ANTB_ON=true; ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, 0x300, Antenna_B); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Single Antenna B\n")); ++ } ++ else if(AntA_report > (AntB_report+2)) ++ { ++ pDM_SWAT_Table->ANTA_ON=true; ++ pDM_SWAT_Table->ANTB_ON=false; ++ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, 0x300, Antenna_A); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Single Antenna A\n")); ++ } ++ else ++ { ++ pDM_SWAT_Table->ANTA_ON=true; ++ pDM_SWAT_Table->ANTB_ON=true; ++ RT_TRACE(COMP_ANTENNA, DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Dual Antenna \n")); ++ } ++ } ++ else ++ { ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Need to check again\n")); ++ pDM_SWAT_Table->ANTA_ON=true; // Set Antenna A on as default ++ pDM_SWAT_Table->ANTB_ON=false; // Set Antenna B off as default ++ bResult = false; ++ } ++ } ++ return bResult; ++ ++} ++ ++/* Justin: According to the current RRSI to adjust Response Frame TX power, 2012/11/05 */ ++void odm_dtc(PDM_ODM_T pDM_Odm) ++{ ++#ifdef CONFIG_DM_RESP_TXAGC ++ #define DTC_BASE 35 /* RSSI higher than this value, start to decade TX power */ ++ #define DTC_DWN_BASE (DTC_BASE-5) /* RSSI lower than this value, start to increase TX power */ ++ ++ /* RSSI vs TX power step mapping: decade TX power */ ++ static const u8 dtc_table_down[]={ ++ DTC_BASE, ++ (DTC_BASE+5), ++ (DTC_BASE+10), ++ (DTC_BASE+15), ++ (DTC_BASE+20), ++ (DTC_BASE+25) ++ }; ++ ++ /* RSSI vs TX power step mapping: increase TX power */ ++ static const u8 dtc_table_up[]={ ++ DTC_DWN_BASE, ++ (DTC_DWN_BASE-5), ++ (DTC_DWN_BASE-10), ++ (DTC_DWN_BASE-15), ++ (DTC_DWN_BASE-15), ++ (DTC_DWN_BASE-20), ++ (DTC_DWN_BASE-20), ++ (DTC_DWN_BASE-25), ++ (DTC_DWN_BASE-25), ++ (DTC_DWN_BASE-30), ++ (DTC_DWN_BASE-35) ++ }; ++ ++ u8 i; ++ u8 dtc_steps=0; ++ u8 sign; ++ u8 resp_txagc=0; ++ ++ #if 0 ++ /* As DIG is disabled, DTC is also disable */ ++ if(!(pDM_Odm->SupportAbility & ODM_XXXXXX)) ++ return; ++ #endif ++ ++ if (DTC_BASE < pDM_Odm->RSSI_Min) { ++ /* need to decade the CTS TX power */ ++ sign = 1; ++ for (i=0;i= pDM_Odm->RSSI_Min) || (dtc_steps >= 6)) ++ break; ++ else ++ dtc_steps++; ++ } ++ } ++ else ++ { ++ sign = 0; ++ dtc_steps = 0; ++ } ++ ++ resp_txagc = dtc_steps | (sign << 4); ++ resp_txagc = resp_txagc | (resp_txagc << 5); ++ ODM_Write1Byte(pDM_Odm, 0x06d9, resp_txagc); ++ ++ DBG_871X("%s RSSI_Min:%u, set RESP_TXAGC to %s %u\n", ++ __func__, pDM_Odm->RSSI_Min, sign?"minus":"plus", dtc_steps); ++#endif /* CONFIG_RESP_TXAGC_ADJUST */ ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_debug.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_debug.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_debug.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_debug.c 2018-02-06 17:42:30.712967194 +0200 +@@ -0,0 +1,63 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++ ++#include "odm_precomp.h" ++ ++ ++void ++ODM_InitDebugSetting( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++pDM_Odm->DebugLevel = ODM_DBG_LOUD; ++ ++pDM_Odm->DebugComponents = ++\ ++#if DBG ++//BB Functions ++// ODM_COMP_DIG | ++// ODM_COMP_RA_MASK | ++// ODM_COMP_DYNAMIC_TXPWR | ++// ODM_COMP_FA_CNT | ++// ODM_COMP_RSSI_MONITOR | ++// ODM_COMP_CCK_PD | ++// ODM_COMP_ANT_DIV | ++// ODM_COMP_PWR_SAVE | ++// ODM_COMP_PWR_TRAIN | ++// ODM_COMP_RATE_ADAPTIVE | ++// ODM_COMP_PATH_DIV | ++// ODM_COMP_DYNAMIC_PRICCA | ++// ODM_COMP_RXHP | ++// ODM_COMP_MP | ++// ODM_COMP_DYNAMIC_ATC | ++ ++//MAC Functions ++// ODM_COMP_EDCA_TURBO | ++// ODM_COMP_EARLY_MODE | ++//RF Functions ++// ODM_COMP_TX_PWR_TRACK | ++// ODM_COMP_RX_GAIN_TRACK | ++// ODM_COMP_CALIBRATION | ++//Common ++// ODM_COMP_COMMON | ++// ODM_COMP_INIT | ++// ODM_COMP_PSD | ++#endif ++ 0; ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_debug.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_debug.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_debug.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_debug.h 2018-02-06 17:42:30.712967194 +0200 +@@ -0,0 +1,870 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++ ++#ifndef __ODM_DBG_H__ ++#define __ODM_DBG_H__ ++ ++ ++//----------------------------------------------------------------------------- ++// Define the debug levels ++// ++// 1. DBG_TRACE and DBG_LOUD are used for normal cases. ++// So that, they can help SW engineer to develope or trace states changed ++// and also help HW enginner to trace every operation to and from HW, ++// e.g IO, Tx, Rx. ++// ++// 2. DBG_WARNNING and DBG_SERIOUS are used for unusual or error cases, ++// which help us to debug SW or HW. ++// ++//----------------------------------------------------------------------------- ++// ++// Never used in a call to ODM_RT_TRACE()! ++// ++#define ODM_DBG_OFF 1 ++ ++// ++// Fatal bug. ++// For example, Tx/Rx/IO locked up, OS hangs, memory access violation, ++// resource allocation failed, unexpected HW behavior, HW BUG and so on. ++// ++#define ODM_DBG_SERIOUS 2 ++ ++// ++// Abnormal, rare, or unexpeted cases. ++// For example, IRP/Packet/OID canceled, device suprisely unremoved and so on. ++// ++#define ODM_DBG_WARNING 3 ++ ++// ++// Normal case with useful information about current SW or HW state. ++// For example, Tx/Rx descriptor to fill, Tx/Rx descriptor completed status, ++// SW protocol state change, dynamic mechanism state change and so on. ++// ++#define ODM_DBG_LOUD 4 ++ ++// ++// Normal case with detail execution flow or information. ++// ++#define ODM_DBG_TRACE 5 ++ ++//----------------------------------------------------------------------------- ++// Define the tracing components ++// ++//----------------------------------------------------------------------------- ++//BB Functions ++#define ODM_COMP_DIG BIT0 ++#define ODM_COMP_RA_MASK BIT1 ++#define ODM_COMP_DYNAMIC_TXPWR BIT2 ++#define ODM_COMP_FA_CNT BIT3 ++#define ODM_COMP_RSSI_MONITOR BIT4 ++#define ODM_COMP_CCK_PD BIT5 ++#define ODM_COMP_ANT_DIV BIT6 ++#define ODM_COMP_PWR_SAVE BIT7 ++#define ODM_COMP_PWR_TRAIN BIT8 ++#define ODM_COMP_RATE_ADAPTIVE BIT9 ++#define ODM_COMP_PATH_DIV BIT10 ++#define ODM_COMP_PSD BIT11 ++#define ODM_COMP_DYNAMIC_PRICCA BIT12 ++#define ODM_COMP_RXHP BIT13 ++#define ODM_COMP_MP BIT14 ++#define ODM_COMP_DYNAMIC_ATC BIT15 ++//MAC Functions ++#define ODM_COMP_EDCA_TURBO BIT16 ++#define ODM_COMP_EARLY_MODE BIT17 ++//RF Functions ++#define ODM_COMP_TX_PWR_TRACK BIT24 ++#define ODM_COMP_RX_GAIN_TRACK BIT25 ++#define ODM_COMP_CALIBRATION BIT26 ++//Common Functions ++#define ODM_COMP_COMMON BIT30 ++#define ODM_COMP_INIT BIT31 ++ ++/*------------------------Export Marco Definition---------------------------*/ ++ #define DbgPrint printk ++ #define RT_PRINTK(fmt, args...) DbgPrint( "%s(): " fmt, __FUNCTION__, ## args); ++ #define RT_DISP(dbgtype, dbgflag, printstr) ++ ++#ifndef ASSERT ++ #define ASSERT(expr) ++#endif ++ ++#if DBG ++#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt) \ ++ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel || level == ODM_DBG_SERIOUS)) \ ++ { \ ++ RT_PRINTK fmt; \ ++ } ++ ++#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt) \ ++ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel)) \ ++ { \ ++ RT_PRINTK fmt; \ ++ } ++ ++#define ODM_RT_ASSERT(pDM_Odm, expr, fmt) \ ++ if(!(expr)) { \ ++ DbgPrint( "Assertion failed! %s at ......\n", #expr); \ ++ DbgPrint( " ......%s,%s,line=%d\n",__FILE__,__FUNCTION__,__LINE__); \ ++ RT_PRINTK fmt; \ ++ ASSERT(false); \ ++ } ++#define ODM_dbg_enter() { DbgPrint("==> %s\n", __FUNCTION__); } ++#define ODM_dbg_exit() { DbgPrint("<== %s\n", __FUNCTION__); } ++#define ODM_dbg_trace(str) { DbgPrint("%s:%s\n", __FUNCTION__, str); } ++ ++#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr) \ ++ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel)) \ ++ { \ ++ int __i; \ ++ pu1Byte __ptr = (pu1Byte)ptr; \ ++ DbgPrint("[ODM] "); \ ++ DbgPrint(title_str); \ ++ DbgPrint(" "); \ ++ for( __i=0; __i<6; __i++ ) \ ++ DbgPrint("%02X%s", __ptr[__i], (__i==5)?"":"-"); \ ++ DbgPrint("\n"); \ ++ } ++#else ++#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt) ++#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt) ++#define ODM_RT_ASSERT(pDM_Odm, expr, fmt) ++#define ODM_dbg_enter() ++#define ODM_dbg_exit() ++#define ODM_dbg_trace(str) ++#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr) ++#endif ++ ++ ++void ODM_InitDebugSetting(PDM_ODM_T pDM_Odm); ++ ++ ++ ++#if 0 ++#if DBG ++#define DbgPrint printk ++ ++#define PRINT_DATA(_TitleString, _HexData, _HexDataLen) \ ++ { \ ++ char *szTitle = _TitleString; \ ++ pu1Byte pbtHexData = _HexData; \ ++ u4Byte u4bHexDataLen = _HexDataLen; \ ++ u4Byte __i; \ ++ DbgPrint("%s", szTitle); \ ++ for (__i=0;__i=' ' &&_ch<='~' ) // I want to see ASCII 33 to 126 only. Otherwise, I print '?'. Annie, 2005-11-22. ++ ++#define RT_PRINT_STR(_Comp, _Level, _TitleString, _Ptr, _Len) \ ++ if(((_Comp) & ODM_GlobalDebugComponents) && (_Level <= ODM_GlobalDebugLevel)) \ ++ { \ ++ int __i; \ ++ u1Byte buffer[MAX_STR_LEN]; \ ++ int length = (_Len\n", _Len, buffer); \ ++ } ++ ++#else // of #if DBG ++#define DbgPrint(...) ++#define PRINT_DATA(_TitleString, _HexData, _HexDataLen) ++#define RT_PRINT_DATA(_Comp, _Level, _TitleString, _HexData, _HexDataLen) ++#define RT_PRINT_ADDR(_Comp, _Level, _TitleString, _Ptr) ++#define RT_PRINT_ADDRS(_Comp, _Level, _TitleString, _Ptr, _AddNum) ++#define RT_PRINT_STR(_Comp, _Level, _TitleString, _Ptr, _Len) ++#endif // of #if DBG ++ ++#endif ++ ++ ++#if 0 ++/* Define debug print header for every service module.*/ ++typedef struct tag_ODM_DBGP_Service_Module_Header_Name_Structure ++{ ++ const char *pMANS; ++ const char *pRTOS; ++ const char *pALM; ++ const char *pPEM; ++ const char *pCMPK; ++ const char *pRAPD; ++ const char *pTXPB; ++ const char *pQUMG; ++}ODM_DBGP_HEAD_T; ++ ++ ++/* Define different debug flag for dedicated service modules in debug flag array. */ ++// Each module has independt 32 bit debug flag you cnn define the flag as yout require. ++typedef enum tag_ODM_DBGP_Flag_Type_Definition ++{ ++ ODM_FTX = 0, ++ ODM_FRX , ++ ODM_FPHY , ++ ODM_FPWR , ++ ODM_FDM , ++ ODM_FC2H , ++ ODM_FBT , ++ ODM_DBGP_TYPE_MAX ++}ODM_DBGP_FLAG_E; ++ ++ ++// Define TX relative debug bit --> FTX ++#define ODM_TX_DESC BIT0 ++#define ODM_TX_DESC_TID BIT1 ++#define ODM_TX_PATH BIT2 ++ ++// Define RX relative debug bit --> FRX ++#define ODM_RX_DATA BIT0 ++#define ODM_RX_PHY_STS BIT1 ++#define ODM_RX_PHY_SS BIT2 ++#define ODM_RX_PHY_SQ BIT3 ++#define ODM_RX_PHY_ASTS BIT4 ++#define ODM_RX_ERR_LEN BIT5 ++#define ODM_RX_DEFRAG BIT6 ++#define ODM_RX_ERR_RATE BIT7 ++#define ODM_RX_PATH BIT8 ++#define ODM_RX_BEACON BIT9 ++ ++// Define PHY-BB/RF/MAC check module bit --> FPHY ++#define ODM_PHY_BBR BIT0 ++#define ODM_PHY_BBW BIT1 ++#define ODM_PHY_RFR BIT2 ++#define ODM_PHY_RFW BIT3 ++#define ODM_PHY_MACR BIT4 ++#define ODM_PHY_MACW BIT5 ++#define ODM_PHY_ALLR BIT6 ++#define ODM_PHY_ALLW BIT7 ++#define ODM_PHY_TXPWR BIT8 ++#define ODM_PHY_PWRDIFF BIT9 ++#define ODM_PHY_SICR BIT10 ++#define ODM_PHY_SICW BIT11 ++ ++ ++ ++ ++extern u4Byte ODM_GlobalDebugLevel; ++ ++ ++#if DBG ++extern u8Byte ODM_GlobalDebugComponents; ++#endif ++#endif ++#if 0 ++ ++//----------------------------------------------------------------------------- ++// Define the debug levels ++// ++// 1. DBG_TRACE and DBG_LOUD are used for normal cases. ++// So that, they can help SW engineer to develope or trace states changed ++// and also help HW enginner to trace every operation to and from HW, ++// e.g IO, Tx, Rx. ++// ++// 2. DBG_WARNNING and DBG_SERIOUS are used for unusual or error cases, ++// which help us to debug SW or HW. ++// ++//----------------------------------------------------------------------------- ++// ++// Never used in a call to ODM_RT_TRACE(pDM_Odm,)! ++// ++#define DBG_OFF 0 ++ ++// ++// Deprecated! Don't use it! ++// TODO: fix related debug message! ++// ++//#define DBG_SEC 1 ++ ++// ++// Fatal bug. ++// For example, Tx/Rx/IO locked up, OS hangs, memory access violation, ++// resource allocation failed, unexpected HW behavior, HW BUG and so on. ++// ++#define DBG_SERIOUS 2 ++ ++// ++// Abnormal, rare, or unexpeted cases. ++// For example, IRP/Packet/OID canceled, device suprisely unremoved and so on. ++// ++#define DBG_WARNING 3 ++ ++// ++// Normal case with useful information about current SW or HW state. ++// For example, Tx/Rx descriptor to fill, Tx/Rx descriptor completed status, ++// SW protocol state change, dynamic mechanism state change and so on. ++// ++#define DBG_LOUD 4 ++ ++// ++// Normal case with detail execution flow or information. ++// ++#define DBG_TRACE 5 ++ ++ ++ ++//----------------------------------------------------------------------------- ++// Define the tracing components ++// ++//----------------------------------------------------------------------------- ++#define COMP_TRACE BIT0 // For function call tracing. ++#define COMP_DBG BIT1 // Only for temporary debug message. ++#define COMP_INIT BIT2 // during driver initialization / halt / reset. ++#define COMP_OID_QUERY BIT3 // Query OID. ++#define COMP_OID_SET BIT4 // Set OID. ++#define COMP_RECV BIT5 // Reveive part data path. ++#define COMP_SEND BIT6 // Send part path. ++#define COMP_IO BIT7 // I/O Related. Added by Annie, 2006-03-02. ++#define COMP_POWER BIT8 // 802.11 Power Save mode or System/Device Power state related. ++#define COMP_MLME BIT9 // 802.11 link related: join/start BSS, leave BSS. ++#define COMP_SCAN BIT10 // For site survey. ++#define COMP_SYSTEM BIT11 // For general platform function. ++#define COMP_SEC BIT12 // For Security. ++#define COMP_AP BIT13 // For AP mode related. ++#define COMP_TURBO BIT14 // For Turbo Mode related. By Annie, 2005-10-21. ++#define COMP_QOS BIT15 // For QoS. ++#define COMP_AUTHENTICATOR BIT16 // For AP mode Authenticator. Added by Annie, 2006-01-30. ++#define COMP_BEACON BIT17 // For Beacon related, by rcnjko. ++#define COMP_ANTENNA BIT18 // For Antenna diversity related, by rcnjko. ++#define COMP_RATE BIT19 // For Rate Adaptive mechanism, 2006.07.02, by rcnjko. #define COMP_EVENTS 0x00000080 // Event handling ++#define COMP_EVENTS BIT20 // Event handling ++#define COMP_FPGA BIT21 // For FPGA verfication ++#define COMP_RM BIT22 // For Radio Measurement. ++#define COMP_MP BIT23 // For mass production test, by shien chang, 2006.07.13 ++#define COMP_RXDESC BIT24 // Show Rx desc information for SD3 debug. Added by Annie, 2006-07-15. ++#define COMP_CKIP BIT25 // For CCX 1 S13: CKIP. Added by Annie, 2006-08-14. ++#define COMP_DIG BIT26 // For DIG, 2006.09.25, by rcnjko. ++#define COMP_TXAGC BIT27 // For Tx power, 060928, by rcnjko. ++#define COMP_HIPWR BIT28 // For High Power Mechanism, 060928, by rcnjko. ++#define COMP_HALDM BIT29 // For HW Dynamic Mechanism, 061010, by rcnjko. ++#define COMP_RSNA BIT30 // For RSNA IBSS , 061201, by CCW. ++#define COMP_INDIC BIT31 // For link indication ++#define COMP_LED BIT32 // For LED. ++#define COMP_RF BIT33 // For RF. ++//1!!!!!!!!!!!!!!!!!!!!!!!!!!! ++//1//1Attention Please!!!<11n or 8190 specific code should be put below this line> ++//1!!!!!!!!!!!!!!!!!!!!!!!!!!! ++ ++#define COMP_HT BIT34 // For 802.11n HT related information. by Emily 2006-8-11 ++#define COMP_POWER_TRACKING BIT35 //FOR 8190 TX POWER TRACKING ++#define COMP_RX_REORDER BIT36 // 8190 Rx Reorder ++#define COMP_AMSDU BIT37 // For A-MSDU Debugging ++#define COMP_WPS BIT38 //WPS Debug Message ++#define COMP_RATR BIT39 ++#define COMP_RESET BIT40 ++// For debug command to print on dbgview!! ++#define COMP_CMD BIT41 ++#define COMP_EFUSE BIT42 ++#define COMP_MESH_INTERWORKING BIT43 ++#define COMP_CCX BIT44 //CCX Debug Flag ++#define COMP_IOCTL BIT45 // IO Control ++#define COMP_GP BIT46 // For generic parser. ++#define COMP_TXAGG BIT47 ++#define COMP_HVL BIT48 // For Ndis 6.2 Context Swirch and Hardware Virtualiztion Layer ++#define COMP_TEST BIT49 ++#define COMP_BB_POWERSAVING BIT50 ++#define COMP_SWAS BIT51 // For SW Antenna Switch ++#define COMP_P2P BIT52 ++#define COMP_MUX BIT53 ++#define COMP_FUNC BIT54 ++#define COMP_TDLS BIT55 ++#define COMP_OMNIPEEK BIT56 ++#define COMP_DUALMACSWITCH BIT60 // 2010/12/27 Add for Dual mac mode debug ++#define COMP_EASY_CONCURRENT BIT61 // 2010/12/27 Add for easy cncurrent mode debug ++#define COMP_PSD BIT63 //2011/3/9 Add for WLAN PSD for BT AFH ++ ++#define COMP_DFS BIT62 ++ ++#define COMP_ALL u3264_C(0xFFFFFFFFFFFFFFFF) // All components ++// For debug print flag to use ++/*------------------------------Define structure----------------------------*/ ++/* 2007/07/13 MH *//*------For DeBuG Print modeue------*/ ++ ++/* Defnie structure to store different debug flag variable. Every debug flag ++ is a u3232 integer and you can assign 32 different events. */ ++typedef struct tag_DBGP_Debug_Flag_Structure ++{ ++ u4Byte Mans; /* Main Scheduler module. */ ++ u4Byte Rtos; /* RTOS module. */ ++ u4Byte Alarm; /* Alarm module. */ ++ u4Byte Pm; /* Performance monitor module. */ ++}DBGP_FLAG_T; ++ ++/* Define debug print header for every service module.*/ ++typedef struct tag_DBGP_Service_Module_Header_Name_Structure ++{ ++ const char *pMANS; ++ const char *pRTOS; ++ const char *pALM; ++ const char *pPEM; ++ const char *pCMPK; ++ const char *pRAPD; ++ const char *pTXPB; ++ const char *pQUMG; ++}DBGP_HEAD_T; ++ ++ ++/* Define different debug flag for dedicated service modules in debug flag array. */ ++// Each module has independt 32 bit debug flag you cnn define the flag as yout require. ++typedef enum tag_DBGP_Flag_Type_Definition ++{ ++ FQoS = 0, ++ FTX = 1, ++ FRX = 2, ++ FSEC = 3, ++ FMGNT = 4, ++ FMLME = 5, ++ FRESOURCE = 6, ++ FBEACON = 7, ++ FISR = 8, ++ FPHY = 9, ++ FMP = 10, ++ FEEPROM = 11, ++ FPWR = 12, ++ FDM = 13, ++ FDBG_CTRL = 14, ++ FC2H = 15, ++ FBT = 16, ++ FINIT = 17, ++ FIOCTL = 18, ++ FSHORT_CUT = 19, ++ DBGP_TYPE_MAX ++}DBGP_FLAG_E; ++ ++ ++// Define Qos Relative debug flag bit --> FQoS ++#define QoS_INIT BIT0 ++#define QoS_VISTA BIT1 ++ ++// Define TX relative debug bit --> FTX ++#define TX_DESC BIT0 ++#define TX_DESC_TID BIT1 ++#define TX_PATH BIT2 ++ ++// Define RX relative debug bit --> FRX ++#define RX_DATA BIT0 ++#define RX_PHY_STS BIT1 ++#define RX_PHY_SS BIT2 ++#define RX_PHY_SQ BIT3 ++#define RX_PHY_ASTS BIT4 ++#define RX_ERR_LEN BIT5 ++#define RX_DEFRAG BIT6 ++#define RX_ERR_RATE BIT7 ++#define RX_PATH BIT8 ++#define RX_BEACON BIT9 ++ ++// Define Security relative debug bit --> FSEC ++ ++// Define MGNT relative debug bit --> FMGNT ++ ++// Define MLME relative debug bit --> FMLME ++#define MEDIA_STS BIT0 ++#define LINK_STS BIT1 ++ ++// Define OS resource check module bit --> FRESOURCE ++#define OS_CHK BIT0 ++ ++// Define beacon content check module bit --> FBEACON ++#define BCN_SHOW BIT0 ++#define BCN_PEER BIT1 ++ ++// Define ISR/IMR check module bit --> FISR ++#define ISR_CHK BIT0 ++ ++// Define PHY-BB/RF/MAC check module bit --> FPHY ++#define PHY_BBR BIT0 ++#define PHY_BBW BIT1 ++#define PHY_RFR BIT2 ++#define PHY_RFW BIT3 ++#define PHY_MACR BIT4 ++#define PHY_MACW BIT5 ++#define PHY_ALLR BIT6 ++#define PHY_ALLW BIT7 ++#define PHY_TXPWR BIT8 ++#define PHY_PWRDIFF BIT9 ++#define PHY_SICR BIT10 ++#define PHY_SICW BIT11 ++ ++// Define MPT driver check module bit --> FMP ++#define MP_RX BIT0 ++#define MP_SWICH_CH BIT1 ++ ++// Define EEPROM and EFUSE check module bit --> FEEPROM ++#define EEPROM_W BIT0 ++#define EFUSE_PG BIT1 ++#define EFUSE_READ_ALL BIT2 ++#define EFUSE_ANALYSIS BIT3 ++#define EFUSE_PG_DETAIL BIT4 ++ ++// Define power save check module bit --> FPWR ++#define LPS BIT0 ++#define IPS BIT1 ++#define PWRSW BIT2 ++#define PWRHW BIT3 ++#define PWRHAL BIT4 ++ ++// Define Dynamic Mechanism check module bit --> FDM ++#define WA_IOT BIT0 ++#define DM_PWDB BIT1 ++#define DM_Monitor BIT2 ++#define DM_DIG BIT3 ++#define DM_EDCA_Turbo BIT4 ++#define DM_BT30 BIT5 ++ ++// Define Dbg Control module bit --> FDBG_CTRL ++#define DBG_CTRL_TRACE BIT0 ++#define DBG_CTRL_INBAND_NOISE BIT1 ++ ++// Define FW C2H Cmd check module bit --> FC2H ++#define C2H_Summary BIT0 ++#define C2H_PacketData BIT1 ++#define C2H_ContentData BIT2 ++// Define BT Cmd check module bit --> FBT ++#define BT_TRACE BIT0 ++#define BT_RFPoll BIT1 ++ ++// Define init check for module bit --> FINIT ++#define INIT_EEPROM BIT0 ++#define INIT_TxPower BIT1 ++#define INIT_IQK BIT2 ++#define INIT_RF BIT3 ++ ++// Define IOCTL Cmd check module bit --> FIOCTL ++// section 1 : IRP related ++#define IOCTL_IRP BIT0 ++#define IOCTL_IRP_DETAIL BIT1 ++#define IOCTL_IRP_STATISTICS BIT2 ++#define IOCTL_IRP_HANDLE BIT3 ++// section 2 : HCI command/event ++#define IOCTL_BT_HCICMD BIT8 ++#define IOCTL_BT_HCICMD_DETAIL BIT9 ++#define IOCTL_BT_HCICMD_EXT BIT10 ++#define IOCTL_BT_EVENT BIT11 ++#define IOCTL_BT_EVENT_DETAIL BIT12 ++#define IOCTL_BT_EVENT_PERIODICAL BIT13 ++// section 3 : BT tx/rx data and throughput ++#define IOCTL_BT_TX_ACLDATA BIT16 ++#define IOCTL_BT_TX_ACLDATA_DETAIL BIT17 ++#define IOCTL_BT_RX_ACLDATA BIT18 ++#define IOCTL_BT_RX_ACLDATA_DETAIL BIT19 ++#define IOCTL_BT_TP BIT20 ++// section 4 : BT connection state machine. ++#define IOCTL_STATE BIT21 ++#define IOCTL_BT_LOGO BIT22 ++// section 5 : BT function trace ++#define IOCTL_CALLBACK_FUN BIT24 ++#define IOCTL_PARSE_BT_PKT BIT25 ++#define IOCTL_BT_TX_PKT BIT26 ++#define IOCTL_BT_FLAG_MON BIT27 ++ ++// ++// Define init check for module bit --> FSHORT_CUT ++// 2011/07/20 MH Add for short but definition. ++// ++#define SHCUT_TX BIT0 ++#define SHCUT_RX BIT1 ++ ++ ++/* 2007/07/13 MH *//*------For DeBuG Print modeue------*/ ++/*------------------------------Define structure----------------------------*/ ++ ++ ++/*------------------------Export Marco Definition---------------------------*/ ++#define RT_PRINTK(fmt, args...) printk( "%s(): " fmt, __FUNCTION__, ## args); ++ ++#if DBG ++#define ODM_RT_TRACE(pDM_Odm,comp, level, fmt) \ ++ if(((comp) & GlobalDebugComponents) && (level <= GlobalDebugLevel)) \ ++ { \ ++ RT_PRINTK fmt; \ ++ } ++ ++#define RT_TRACE_F(comp, level, fmt) \ ++ if(((comp) & GlobalDebugComponents) && (level <= GlobalDebugLevel)) \ ++ { \ ++ RT_PRINTK fmt; \ ++ } ++ ++#define RT_ASSERT(expr,fmt) \ ++ if(!(expr)) { \ ++ printk( "Assertion failed! %s at ......\n", #expr); \ ++ printk( " ......%s,%s,line=%d\n",__FILE__,__FUNCTION__,__LINE__); \ ++ } ++#define dbg_enter() { printk("==> %s\n", __FUNCTION__); } ++#define dbg_exit() { printk("<== %s\n", __FUNCTION__); } ++#define dbg_trace(str) { printk("%s:%s\n", __FUNCTION__, str); } ++#else ++#define ODM_RT_TRACE(pDM_Odm,comp, level, fmt) ++#define RT_TRACE_F(comp, level, fmt) ++#define RT_ASSERT(expr, fmt) ++#define dbg_enter() ++#define dbg_exit() ++#define dbg_trace(str) ++#endif ++ ++#if DBG ++#define DbgPrint printk ++ ++#define PRINT_DATA(_TitleString, _HexData, _HexDataLen) \ ++ { \ ++ char *szTitle = _TitleString; \ ++ pu1Byte pbtHexData = _HexData; \ ++ u4Byte u4bHexDataLen = _HexDataLen; \ ++ u4Byte __i; \ ++ DbgPrint("%s", szTitle); \ ++ for (__i=0;__i=' ' &&_ch<='~' ) // I want to see ASCII 33 to 126 only. Otherwise, I print '?'. Annie, 2005-11-22. ++ ++#define RT_PRINT_STR(_Comp, _Level, _TitleString, _Ptr, _Len) \ ++ if(((_Comp) & GlobalDebugComponents) && (_Level <= GlobalDebugLevel)) \ ++ { \ ++ int __i; \ ++ u1Byte buffer[MAX_STR_LEN]; \ ++ int length = (_Len\n", _Len, buffer); \ ++ } ++ ++#else // of #if DBG ++#define DbgPrint(...) ++#define PRINT_DATA(_TitleString, _HexData, _HexDataLen) ++#define RT_PRINT_DATA(_Comp, _Level, _TitleString, _HexData, _HexDataLen) ++#define RT_PRINT_ADDR(_Comp, _Level, _TitleString, _Ptr) ++#define RT_PRINT_ADDRS(_Comp, _Level, _TitleString, _Ptr, _AddNum) ++#define RT_PRINT_STR(_Comp, _Level, _TitleString, _Ptr, _Len) ++#endif // of #if DBG ++ ++#define DEBUG_PRINT 1 ++ ++// Please add new OS's print API by yourself ++ ++#if (DEBUG_PRINT == 1) && DBG ++#define RT_DISP(dbgtype, dbgflag, printstr)\ ++{\ ++ if (DBGP_Type[dbgtype] & dbgflag)\ ++ {\ ++ DbgPrint printstr;\ ++ }\ ++} ++ ++#define RT_DISP_ADDR(dbgtype, dbgflag, printstr, _Ptr)\ ++{\ ++ if (DBGP_Type[dbgtype] & dbgflag)\ ++ {\ ++ int __i; \ ++ pu1Byte ptr = (pu1Byte)_Ptr; \ ++ DbgPrint printstr; \ ++ DbgPrint(" "); \ ++ for( __i=0; __i<6; __i++ ) \ ++ DbgPrint("%02X%s", ptr[__i], (__i==5)?"":"-"); \ ++ DbgPrint("\n"); \ ++ }\ ++} ++ ++#define RT_DISP_DATA(dbgtype, dbgflag, _TitleString, _HexData, _HexDataLen)\ ++{\ ++ if (DBGP_Type[dbgtype] & dbgflag)\ ++ {\ ++ int __i; \ ++ pu1Byte ptr = (pu1Byte)_HexData; \ ++ DbgPrint(_TitleString); \ ++ for( __i=0; __i<(int)_HexDataLen; __i++ ) \ ++ { \ ++ DbgPrint("%02X%s", ptr[__i], (((__i + 1) % 4) == 0)?" ":" ");\ ++ if (((__i + 1) % 16) == 0) DbgPrint("\n");\ ++ } \ ++ DbgPrint("\n"); \ ++ }\ ++} ++ ++#define FunctionIn(_comp) ODM_RT_TRACE(pDM_Odm,(_comp), DBG_LOUD, ("==========> %s\n", __FUNCTION__)) ++#define FunctionOut(_comp) ODM_RT_TRACE(pDM_Odm,(_comp), DBG_LOUD, ("<========== %s\n", __FUNCTION__)) ++ ++ ++#else ++ ++#define RT_DISP(dbgtype, dbgflag, printstr) ++#define RT_DISP_ADDR(dbgtype, dbgflag, printstr, _Ptr) ++#define RT_DISP_DATA(dbgtype, dbgflag, _TitleString, _HexData, _HexDataLen) ++ ++#define FunctionIn(_comp) ++#define FunctionOut(_comp) ++#endif ++/*------------------------Export Marco Definition---------------------------*/ ++ ++ ++/*------------------------Export global variable----------------------------*/ ++extern u4Byte DBGP_Type[DBGP_TYPE_MAX]; ++extern DBGP_HEAD_T DBGP_Head; ++ ++/*------------------------Export global variable----------------------------*/ ++ ++ ++/*--------------------------Exported Function prototype---------------------*/ ++extern void DBGP_Flag_Init(void); ++extern void DBG_PrintAllFlag(void); ++extern void DBG_PrintAllComp(void); ++extern void DBG_PrintFlagEvent(u1Byte DbgFlag); ++extern void DBG_DumpMem(const u1Byte DbgComp, ++ const u1Byte DbgLevel, ++ pu1Byte pMem, ++ u2Byte Len); ++ ++/*--------------------------Exported Function prototype---------------------*/ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++extern u4Byte GlobalDebugLevel; ++extern u8Byte GlobalDebugComponents; ++ ++ ++#endif ++ ++ ++#endif // __ODM_DBG_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm.h 2018-02-06 17:42:30.712967194 +0200 +@@ -0,0 +1,1750 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++ ++#ifndef __HALDMOUTSRC_H__ ++#define __HALDMOUTSRC_H__ ++ ++//============================================================ ++// Definition ++//============================================================ ++// ++// 20100503 Joseph: ++// Add new function SwAntDivCheck8192C(). ++// This is the main function of Antenna diversity function before link. ++// Mainly, it just retains last scan result and scan again. ++// After that, it compares the scan result to see which one gets better RSSI. ++// It selects antenna with better receiving power and returns better scan result. ++// ++#define TP_MODE 0 ++#define RSSI_MODE 1 ++#define TRAFFIC_LOW 0 ++#define TRAFFIC_HIGH 1 ++ ++//============================================================ ++//3 Tx Power Tracking ++//3============================================================ ++#define DPK_DELTA_MAPPING_NUM 13 ++#define index_mapping_HP_NUM 15 ++#define OFDM_TABLE_SIZE 37 ++#define OFDM_TABLE_SIZE_92D 43 ++#define CCK_TABLE_SIZE 33 ++#define TXSCALE_TABLE_SIZE 37 ++#define DELTA_SWINGIDX_SIZE 30 ++#define BAND_NUM 3 ++ ++//============================================================ ++//3 PSD Handler ++//3============================================================ ++ ++#define AFH_PSD 1 //0:normal PSD scan, 1: only do 20 pts PSD ++#define MODE_40M 0 //0:20M, 1:40M ++#define PSD_TH2 3 ++#define PSD_CHMIN 20 // Minimum channel number for BT AFH ++#define SIR_STEP_SIZE 3 ++#define Smooth_Size_1 5 ++#define Smooth_TH_1 3 ++#define Smooth_Size_2 10 ++#define Smooth_TH_2 4 ++#define Smooth_Size_3 20 ++#define Smooth_TH_3 4 ++#define Smooth_Step_Size 5 ++#define Adaptive_SIR 1 ++#if(RTL8723_FPGA_VERIFICATION == 1) ++#define PSD_RESCAN 1 ++#else ++#define PSD_RESCAN 4 ++#endif ++#define PSD_SCAN_INTERVAL 700 //ms ++ ++ ++ ++//8723A High Power IGI Setting ++#define DM_DIG_HIGH_PWR_IGI_LOWER_BOUND 0x22 ++#define DM_DIG_Gmode_HIGH_PWR_IGI_LOWER_BOUND 0x28 ++#define DM_DIG_HIGH_PWR_THRESHOLD 0x3a ++#define DM_DIG_LOW_PWR_THRESHOLD 0x14 ++ ++//ANT Test ++#define ANTTESTALL 0x00 //Ant A or B will be Testing ++#define ANTTESTA 0x01 //Ant A will be Testing ++#define ANTTESTB 0x02 //Ant B will be testing ++ ++// LPS define ++#define DM_DIG_FA_TH0_LPS 4 //-> 4 in lps ++#define DM_DIG_FA_TH1_LPS 15 //-> 15 lps ++#define DM_DIG_FA_TH2_LPS 30 //-> 30 lps ++#define RSSI_OFFSET_DIG 0x05; ++ ++ ++ ++//for 8723A Ant Definition--2012--06--07 due to different IC may be different ANT define ++#define MAIN_ANT 1 //Ant A or Ant Main ++#define AUX_ANT 2 //AntB or Ant Aux ++#define MAX_ANT 3 // 3 for AP using ++ ++ ++//Antenna Diversity Type ++#define SW_ANTDIV 0 ++#define HW_ANTDIV 1 ++ ++//Antenna Diversty Control Type ++#define ODM_AUTO_ANT 0 ++#define ODM_FIX_MAIN_ANT 1 ++#define ODM_FIX_AUX_ANT 2 ++ ++//============================================================ ++// structure and define ++//============================================================ ++ ++// ++// 2011/09/20 MH Add for AP/ADSLpseudo DM structuer requirement. ++// We need to remove to other position??? ++// ++typedef struct rtl8192cd_priv { ++ u1Byte temp; ++ ++}rtl8192cd_priv, *prtl8192cd_priv; ++ ++typedef struct _Dynamic_Initial_Gain_Threshold_ ++{ ++ u1Byte Dig_Enable_Flag; ++ u1Byte Dig_Ext_Port_Stage; ++ ++ int RssiLowThresh; ++ int RssiHighThresh; ++ ++ u4Byte FALowThresh; ++ u4Byte FAHighThresh; ++ ++ u1Byte CurSTAConnectState; ++ u1Byte PreSTAConnectState; ++ u1Byte CurMultiSTAConnectState; ++ ++ u1Byte PreIGValue; ++ u1Byte CurIGValue; ++ u1Byte BT30_CurIGI; ++ u1Byte BackupIGValue; ++ ++ s1Byte BackoffVal; ++ s1Byte BackoffVal_range_max; ++ s1Byte BackoffVal_range_min; ++ u1Byte rx_gain_range_max; ++ u1Byte rx_gain_range_min; ++ u1Byte Rssi_val_min; ++ ++ u1Byte PreCCK_CCAThres; ++ u1Byte CurCCK_CCAThres; ++ u1Byte PreCCKPDState; ++ u1Byte CurCCKPDState; ++ ++ u1Byte LargeFAHit; ++ u1Byte ForbiddenIGI; ++ u4Byte Recover_cnt; ++ ++ u1Byte DIG_Dynamic_MIN_0; ++ u1Byte DIG_Dynamic_MIN_1; ++ bool bMediaConnect_0; ++ bool bMediaConnect_1; ++ ++ u4Byte AntDiv_RSSI_max; ++ u4Byte RSSI_max; ++}DIG_T,*pDIG_T; ++ ++typedef struct _Dynamic_Power_Saving_ ++{ ++ u1Byte PreCCAState; ++ u1Byte CurCCAState; ++ ++ u1Byte PreRFState; ++ u1Byte CurRFState; ++ ++ int Rssi_val_min; ++ ++ u1Byte initialize; ++ u4Byte Reg874,RegC70,Reg85C,RegA74; ++ ++}PS_T,*pPS_T; ++ ++typedef struct false_ALARM_STATISTICS{ ++ u4Byte Cnt_Parity_Fail; ++ u4Byte Cnt_Rate_Illegal; ++ u4Byte Cnt_Crc8_fail; ++ u4Byte Cnt_Mcs_fail; ++ u4Byte Cnt_Ofdm_fail; ++ u4Byte Cnt_Cck_fail; ++ u4Byte Cnt_all; ++ u4Byte Cnt_Fast_Fsync; ++ u4Byte Cnt_SB_Search_fail; ++ u4Byte Cnt_OFDM_CCA; ++ u4Byte Cnt_CCK_CCA; ++ u4Byte Cnt_CCA_all; ++ u4Byte Cnt_BW_USC; //Gary ++ u4Byte Cnt_BW_LSC; //Gary ++}FALSE_ALARM_STATISTICS, *PFALSE_ALARM_STATISTICS; ++ ++typedef struct _Dynamic_Primary_CCA{ ++ u1Byte PriCCA_flag; ++ u1Byte intf_flag; ++ u1Byte intf_type; ++ u1Byte DupRTS_flag; ++ u1Byte Monitor_flag; ++ u1Byte CH_offset; ++ u1Byte MF_state; ++}Pri_CCA_T, *pPri_CCA_T; ++ ++typedef struct _RX_High_Power_ ++{ ++ u1Byte RXHP_flag; ++ u1Byte PSD_func_trigger; ++ u1Byte PSD_bitmap_RXHP[80]; ++ u1Byte Pre_IGI; ++ u1Byte Cur_IGI; ++ u1Byte Pre_pw_th; ++ u1Byte Cur_pw_th; ++ bool First_time_enter; ++ bool RXHP_enable; ++ u1Byte TP_Mode; ++ RT_TIMER PSDTimer; ++}RXHP_T, *pRXHP_T; ++ ++#define ASSOCIATE_ENTRY_NUM 32 // Max size of AsocEntry[]. ++#define ODM_ASSOCIATE_ENTRY_NUM ASSOCIATE_ENTRY_NUM ++ ++// This indicates two different the steps. ++// In SWAW_STEP_PEAK, driver needs to switch antenna and listen to the signal on the air. ++// In SWAW_STEP_DETERMINE, driver just compares the signal captured in SWAW_STEP_PEAK ++// with original RSSI to determine if it is necessary to switch antenna. ++#define SWAW_STEP_PEAK 0 ++#define SWAW_STEP_DETERMINE 1 ++ ++#define TP_MODE 0 ++#define RSSI_MODE 1 ++#define TRAFFIC_LOW 0 ++#define TRAFFIC_HIGH 1 ++ ++typedef struct _SW_Antenna_Switch_ ++{ ++ u1Byte try_flag; ++ s4Byte PreRSSI; ++ u1Byte CurAntenna; ++ u1Byte PreAntenna; ++ u1Byte RSSI_Trying; ++ u1Byte TestMode; ++ u1Byte bTriggerAntennaSwitch; ++ u1Byte SelectAntennaMap; ++ u1Byte RSSI_target; ++ ++ // Before link Antenna Switch check ++ u1Byte SWAS_NoLink_State; ++ u4Byte SWAS_NoLink_BK_Reg860; ++ bool ANTA_ON; //To indicate Ant A is or not ++ bool ANTB_ON; //To indicate Ant B is on or not ++ ++ s4Byte RSSI_sum_A; ++ s4Byte RSSI_sum_B; ++ s4Byte RSSI_cnt_A; ++ s4Byte RSSI_cnt_B; ++ ++ u8Byte lastTxOkCnt; ++ u8Byte lastRxOkCnt; ++ u8Byte TXByteCnt_A; ++ u8Byte TXByteCnt_B; ++ u8Byte RXByteCnt_A; ++ u8Byte RXByteCnt_B; ++ u1Byte TrafficLoad; ++ RT_TIMER SwAntennaSwitchTimer; ++#ifdef CONFIG_HW_ANTENNA_DIVERSITY ++ //Hybrid Antenna Diversity ++ u4Byte CCK_Ant1_Cnt[ASSOCIATE_ENTRY_NUM+1]; ++ u4Byte CCK_Ant2_Cnt[ASSOCIATE_ENTRY_NUM+1]; ++ u4Byte OFDM_Ant1_Cnt[ASSOCIATE_ENTRY_NUM+1]; ++ u4Byte OFDM_Ant2_Cnt[ASSOCIATE_ENTRY_NUM+1]; ++ u4Byte RSSI_Ant1_Sum[ASSOCIATE_ENTRY_NUM+1]; ++ u4Byte RSSI_Ant2_Sum[ASSOCIATE_ENTRY_NUM+1]; ++ u1Byte TxAnt[ASSOCIATE_ENTRY_NUM+1]; ++ u1Byte TargetSTA; ++ u1Byte antsel; ++ u1Byte RxIdleAnt; ++ ++#endif ++ ++}SWAT_T, *pSWAT_T; ++ ++typedef struct _EDCA_TURBO_ ++{ ++ bool bCurrentTurboEDCA; ++ bool bIsCurRDLState; ++ u4Byte prv_traffic_idx; // edca turbo ++}EDCA_T,*pEDCA_T; ++ ++typedef struct _ODM_RATE_ADAPTIVE ++{ ++ u1Byte Type; // DM_Type_ByFW/DM_Type_ByDriver ++ u1Byte LdpcThres; // if RSSI > LdpcThres => switch from LPDC to BCC ++ bool bUseLdpc; ++ bool bLowerRtsRate; ++ u1Byte HighRSSIThresh; // if RSSI > HighRSSIThresh => RATRState is DM_RATR_STA_HIGH ++ u1Byte LowRSSIThresh; // if RSSI <= LowRSSIThresh => RATRState is DM_RATR_STA_LOW ++ u1Byte RATRState; // Current RSSI level, DM_RATR_STA_HIGH/DM_RATR_STA_MIDDLE/DM_RATR_STA_LOW ++ ++} ODM_RATE_ADAPTIVE, *PODM_RATE_ADAPTIVE; ++ ++#define IQK_MAC_REG_NUM 4 ++#define IQK_ADDA_REG_NUM 16 ++#define IQK_BB_REG_NUM_MAX 10 ++ ++ ++#define IQK_BB_REG_NUM 10 ++#define HP_THERMAL_NUM 8 ++ ++#define AVG_THERMAL_NUM 8 ++#define IQK_Matrix_REG_NUM 8 ++#define IQK_Matrix_Settings_NUM 14+24+21 // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G ++ ++#define DM_Type_ByFW 0 ++#define DM_Type_ByDriver 1 ++ ++// ++// Declare for common info ++// ++#define MAX_PATH_NUM_92CS 2 ++#define MAX_PATH_NUM_8188E 1 ++#define MAX_PATH_NUM_8192E 2 ++#define MAX_PATH_NUM_8723B 1 ++#define MAX_PATH_NUM_8812A 2 ++#define MAX_PATH_NUM_8821A 1 ++ ++#define IQK_THRESHOLD 8 ++ ++typedef struct _ODM_Phy_Status_Info_ ++{ ++ // ++ // Be care, if you want to add any element please insert between ++ // RxPWDBAll & SignalStrength. ++ // ++ u1Byte RxPWDBAll; ++ ++ u1Byte SignalQuality; // in 0-100 index. ++ s1Byte RxMIMOSignalQuality[4]; //per-path's EVM ++ u1Byte RxMIMOEVMdbm[4]; //per-path's EVM dbm ++ ++ u1Byte RxMIMOSignalStrength[4];// in 0~100 index ++ ++ u2Byte Cfo_short[4]; // per-path's Cfo_short ++ u2Byte Cfo_tail[4]; // per-path's Cfo_tail ++ ++ s1Byte RxPower; // in dBm Translate from PWdB ++ s1Byte RecvSignalPower; // Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. ++ u1Byte BTRxRSSIPercentage; ++ u1Byte SignalStrength; // in 0-100 index. ++ ++ u1Byte RxPwr[4]; //per-path's pwdb ++ u1Byte RxSNR[4]; //per-path's SNR ++ u1Byte BandWidth; ++ u1Byte btCoexPwrAdjust; ++}ODM_PHY_INFO_T,*PODM_PHY_INFO_T; ++ ++ ++typedef struct _ODM_Per_Pkt_Info_ ++{ ++ //u1Byte Rate; ++ u1Byte DataRate; ++ u1Byte StationID; ++ bool bPacketMatchBSSID; ++ bool bPacketToSelf; ++ bool bPacketBeacon; ++}ODM_PACKET_INFO_T,*PODM_PACKET_INFO_T; ++ ++ ++typedef struct _ODM_Phy_Dbg_Info_ ++{ ++ //ODM Write,debug info ++ s1Byte RxSNRdB[4]; ++ u8Byte NumQryPhyStatus; ++ u8Byte NumQryPhyStatusCCK; ++ u8Byte NumQryPhyStatusOFDM; ++ u1Byte NumQryBeaconPkt; ++ //Others ++ s4Byte RxEVM[4]; ++ ++}ODM_PHY_DBG_INFO_T; ++ ++ ++typedef struct _ODM_Mac_Status_Info_ ++{ ++ u1Byte test; ++ ++}ODM_MAC_INFO; ++ ++ ++typedef enum tag_Dynamic_ODM_Support_Ability_Type ++{ ++ // BB Team ++ ODM_DIG = 0x00000001, ++ ODM_HIGH_POWER = 0x00000002, ++ ODM_CCK_CCA_TH = 0x00000004, ++ ODM_FA_STATISTICS = 0x00000008, ++ ODM_RAMASK = 0x00000010, ++ ODM_RSSI_MONITOR = 0x00000020, ++ ODM_SW_ANTDIV = 0x00000040, ++ ODM_HW_ANTDIV = 0x00000080, ++ ODM_BB_PWRSV = 0x00000100, ++ ODM_2TPATHDIV = 0x00000200, ++ ODM_1TPATHDIV = 0x00000400, ++ ODM_PSD2AFH = 0x00000800 ++}ODM_Ability_E; ++ ++// ++// 2011/20/20 MH For MP driver RT_WLAN_STA = STA_INFO_T ++// Please declare below ODM relative info in your STA info structure. ++// ++#if 1 ++typedef struct _ODM_STA_INFO{ ++ // Driver Write ++ bool bUsed; // record the sta status link or not? ++ //u1Byte WirelessMode; // ++ u1Byte IOTPeer; // Enum value. HT_IOT_PEER_E ++ ++ // ODM Write ++ //1 PHY_STATUS_INFO ++ u1Byte RSSI_Path[4]; // ++ u1Byte RSSI_Ave; ++ u1Byte RXEVM[4]; ++ u1Byte RXSNR[4]; ++ ++ // ODM Write ++ //1 TX_INFO (may changed by IC) ++ //TX_INFO_T pTxInfo; // Define in IC folder. Move lower layer. ++#if 0 ++ u1Byte ANTSEL_A; //in Jagar: 4bit; others: 2bit ++ u1Byte ANTSEL_B; //in Jagar: 4bit; others: 2bit ++ u1Byte ANTSEL_C; //only in Jagar: 4bit ++ u1Byte ANTSEL_D; //only in Jagar: 4bit ++ u1Byte TX_ANTL; //not in Jagar: 2bit ++ u1Byte TX_ANT_HT; //not in Jagar: 2bit ++ u1Byte TX_ANT_CCK; //not in Jagar: 2bit ++ u1Byte TXAGC_A; //not in Jagar: 4bit ++ u1Byte TXAGC_B; //not in Jagar: 4bit ++ u1Byte TXPWR_OFFSET; //only in Jagar: 3bit ++ u1Byte TX_ANT; //only in Jagar: 4bit for TX_ANTL/TX_ANTHT/TX_ANT_CCK ++#endif ++ ++ // ++ // Please use compile flag to disabe the strcutrue for other IC except 88E. ++ // Move To lower layer. ++ // ++ // ODM Write Wilson will handle this part(said by Luke.Lee) ++ //TX_RPT_T pTxRpt; // Define in IC folder. Move lower layer. ++#if 0 ++ //1 For 88E RA (don't redefine the naming) ++ u1Byte rate_id; ++ u1Byte rate_SGI; ++ u1Byte rssi_sta_ra; ++ u1Byte SGI_enable; ++ u1Byte Decision_rate; ++ u1Byte Pre_rate; ++ u1Byte Active; ++ ++ // Driver write Wilson handle. ++ //1 TX_RPT (don't redefine the naming) ++ u2Byte RTY[4]; // ??? ++ u2Byte TOTAL; // ??? ++ u2Byte DROP; // ??? ++ // ++ // Please use compile flag to disabe the strcutrue for other IC except 88E. ++ // ++#endif ++ ++}ODM_STA_INFO_T, *PODM_STA_INFO_T; ++#endif ++ ++// ++// 2011/10/20 MH Define Common info enum for all team. ++// ++typedef enum _ODM_Common_Info_Definition ++{ ++//-------------REMOVED CASE-----------// ++ //ODM_CMNINFO_CCK_HP, ++ //ODM_CMNINFO_RFPATH_ENABLE, // Define as ODM write??? ++ //ODM_CMNINFO_BT_COEXIST, // ODM_BT_COEXIST_E ++ //ODM_CMNINFO_OP_MODE, // ODM_OPERATION_MODE_E ++//-------------REMOVED CASE-----------// ++ ++ // ++ // Fixed value: ++ // ++ ++ //-----------HOOK BEFORE REG INIT-----------// ++ ODM_CMNINFO_PLATFORM = 0, ++ ODM_CMNINFO_ABILITY, // ODM_ABILITY_E ++ ODM_CMNINFO_INTERFACE, // ODM_INTERFACE_E ++ ODM_CMNINFO_MP_TEST_CHIP, ++ ODM_CMNINFO_IC_TYPE, // ODM_IC_TYPE_E ++ ODM_CMNINFO_CUT_VER, // ODM_CUT_VERSION_E ++ ODM_CMNINFO_FAB_VER, // ODM_FAB_E ++ ODM_CMNINFO_RF_TYPE, // ODM_RF_PATH_E or ODM_RF_TYPE_E? ++ ODM_CMNINFO_RFE_TYPE, ++ ODM_CMNINFO_BOARD_TYPE, // ODM_BOARD_TYPE_E ++ ODM_CMNINFO_EXT_LNA, // TRUE ++ ODM_CMNINFO_5G_EXT_LNA, ++ ODM_CMNINFO_EXT_PA, ++ ODM_CMNINFO_5G_EXT_PA, ++ ODM_CMNINFO_EXT_TRSW, ++ ODM_CMNINFO_PATCH_ID, //CUSTOMER ID ++ ODM_CMNINFO_BINHCT_TEST, ++ ODM_CMNINFO_BWIFI_TEST, ++ ODM_CMNINFO_SMART_CONCURRENT, ++ //-----------HOOK BEFORE REG INIT-----------// ++ ++ ++ // ++ // Dynamic value: ++ // ++//--------- POINTER REFERENCE-----------// ++ ODM_CMNINFO_MAC_PHY_MODE, // ODM_MAC_PHY_MODE_E ++ ODM_CMNINFO_TX_UNI, ++ ODM_CMNINFO_RX_UNI, ++ ODM_CMNINFO_WM_MODE, // ODM_WIRELESS_MODE_E ++ ODM_CMNINFO_BAND, // ODM_BAND_TYPE_E ++ ODM_CMNINFO_SEC_CHNL_OFFSET, // ODM_SEC_CHNL_OFFSET_E ++ ODM_CMNINFO_SEC_MODE, // ODM_SECURITY_E ++ ODM_CMNINFO_BW, // ODM_BW_E ++ ODM_CMNINFO_CHNL, ++ ODM_CMNINFO_FORCED_RATE, ++ ++ ODM_CMNINFO_DMSP_GET_VALUE, ++ ODM_CMNINFO_BUDDY_ADAPTOR, ++ ODM_CMNINFO_DMSP_IS_MASTER, ++ ODM_CMNINFO_SCAN, ++ ODM_CMNINFO_POWER_SAVING, ++ ODM_CMNINFO_ONE_PATH_CCA, // ODM_CCA_PATH_E ++ ODM_CMNINFO_DRV_STOP, ++ ODM_CMNINFO_PNP_IN, ++ ODM_CMNINFO_INIT_ON, ++ ODM_CMNINFO_ANT_TEST, ++ ODM_CMNINFO_NET_CLOSED, ++ ODM_CMNINFO_MP_MODE, ++ //ODM_CMNINFO_RTSTA_AID, // For win driver only? ++//--------- POINTER REFERENCE-----------// ++ ++//------------CALL BY VALUE-------------// ++ ODM_CMNINFO_WIFI_DIRECT, ++ ODM_CMNINFO_WIFI_DISPLAY, ++ ODM_CMNINFO_LINK_IN_PROGRESS, ++ ODM_CMNINFO_LINK, ++ ODM_CMNINFO_RSSI_MIN, ++ ODM_CMNINFO_DBG_COMP, // u8Byte ++ ODM_CMNINFO_DBG_LEVEL, // u4Byte ++ ODM_CMNINFO_RA_THRESHOLD_HIGH, // u1Byte ++ ODM_CMNINFO_RA_THRESHOLD_LOW, // u1Byte ++ ODM_CMNINFO_RF_ANTENNA_TYPE, // u1Byte ++ ODM_CMNINFO_BT_DISABLED, ++ ODM_CMNINFO_BT_HS_CONNECT_PROCESS, ++ ODM_CMNINFO_BT_HS_RSSI, ++ ODM_CMNINFO_BT_OPERATION, ++ ODM_CMNINFO_BT_LIMITED_DIG, //Need to Limited Dig or not ++ ODM_CMNINFO_BT_DISABLE_EDCA, ++//------------CALL BY VALUE-------------// ++ ++ // ++ // Dynamic ptr array hook itms. ++ // ++ ODM_CMNINFO_STA_STATUS, ++ ODM_CMNINFO_PHY_STATUS, ++ ODM_CMNINFO_MAC_STATUS, ++ ++ ODM_CMNINFO_MAX, ++ ++ ++}ODM_CMNINFO_E; ++ ++// ++// 2011/10/20 MH Define ODM support ability. ODM_CMNINFO_ABILITY ++// ++typedef enum _ODM_Support_Ability_Definition ++{ ++ // ++ // BB ODM section BIT 0-15 ++ // ++ ODM_BB_DIG = BIT0, ++ ODM_BB_RA_MASK = BIT1, ++ ODM_BB_DYNAMIC_TXPWR = BIT2, ++ ODM_BB_FA_CNT = BIT3, ++ ODM_BB_RSSI_MONITOR = BIT4, ++ ODM_BB_CCK_PD = BIT5, ++ ODM_BB_ANT_DIV = BIT6, ++ ODM_BB_PWR_SAVE = BIT7, ++ ODM_BB_PWR_TRAIN = BIT8, ++ ODM_BB_RATE_ADAPTIVE = BIT9, ++ ODM_BB_PATH_DIV = BIT10, ++ ODM_BB_PSD = BIT11, ++ ODM_BB_RXHP = BIT12, ++ ODM_BB_ADAPTIVITY = BIT13, ++ ODM_BB_DYNAMIC_ATC = BIT14, ++ ++ // ++ // MAC DM section BIT 16-23 ++ // ++ ODM_MAC_EDCA_TURBO = BIT16, ++ ODM_MAC_EARLY_MODE = BIT17, ++ ++ // ++ // RF ODM section BIT 24-31 ++ // ++ ODM_RF_TX_PWR_TRACK = BIT24, ++ ODM_RF_RX_GAIN_TRACK = BIT25, ++ ODM_RF_CALIBRATION = BIT26, ++ ++}ODM_ABILITY_E; ++ ++// ODM_CMNINFO_INTERFACE ++typedef enum tag_ODM_Support_Interface_Definition ++{ ++ ODM_ITRF_PCIE = 0x1, ++ ODM_ITRF_USB = 0x2, ++ ODM_ITRF_SDIO = 0x4, ++ ODM_ITRF_ALL = 0x7, ++}ODM_INTERFACE_E; ++ ++// ODM_CMNINFO_IC_TYPE ++typedef enum tag_ODM_Support_IC_Type_Definition ++{ ++ ODM_RTL8192S = BIT0, ++ ODM_RTL8192C = BIT1, ++ ODM_RTL8192D = BIT2, ++ ODM_RTL8723A = BIT3, ++ ODM_RTL8188E = BIT4, ++ ODM_RTL8812 = BIT5, ++ ODM_RTL8821 = BIT6, ++ ODM_RTL8192E = BIT7, ++ ODM_RTL8723B = BIT8, ++ ODM_RTL8813A = BIT9 ++}ODM_IC_TYPE_E; ++ ++#define ODM_IC_11N_SERIES (ODM_RTL8192S|ODM_RTL8192C|ODM_RTL8192D|ODM_RTL8723A|ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B) ++#define ODM_IC_11AC_SERIES (ODM_RTL8812 | ODM_RTL8821|ODM_RTL8813A) ++ ++//ODM_CMNINFO_CUT_VER ++typedef enum tag_ODM_Cut_Version_Definition ++{ ++ ODM_CUT_A = 1, ++ ODM_CUT_B = 2, ++ ODM_CUT_C = 3, ++ ODM_CUT_D = 4, ++ ODM_CUT_E = 5, ++ ODM_CUT_F = 6, ++ ODM_CUT_I = 9, ++ ODM_CUT_TEST = 7, ++}ODM_CUT_VERSION_E; ++ ++// ODM_CMNINFO_FAB_VER ++typedef enum tag_ODM_Fab_Version_Definition ++{ ++ ODM_TSMC = 0, ++ ODM_UMC = 1, ++ ODM_SMIC = 2, ++}ODM_FAB_E; ++ ++// ODM_CMNINFO_RF_TYPE ++// ++// For example 1T2R (A+AB = BIT0|BIT4|BIT5) ++// ++typedef enum tag_ODM_RF_Path_Bit_Definition ++{ ++ ODM_RF_TX_A = BIT0, ++ ODM_RF_TX_B = BIT1, ++ ODM_RF_TX_C = BIT2, ++ ODM_RF_TX_D = BIT3, ++ ODM_RF_RX_A = BIT4, ++ ODM_RF_RX_B = BIT5, ++ ODM_RF_RX_C = BIT6, ++ ODM_RF_RX_D = BIT7, ++}ODM_RF_PATH_E; ++ ++ ++typedef enum tag_ODM_RF_Type_Definition ++{ ++ ODM_1T1R = 0, ++ ODM_1T2R = 1, ++ ODM_2T2R = 2, ++ ODM_2T3R = 3, ++ ODM_2T4R = 4, ++ ODM_3T3R = 5, ++ ODM_3T4R = 6, ++ ODM_4T4R = 7, ++}ODM_RF_TYPE_E; ++ ++ ++// ++// ODM Dynamic common info value definition ++// ++ ++//typedef enum _MACPHY_MODE_8192D{ ++// SINGLEMAC_SINGLEPHY, ++// DUALMAC_DUALPHY, ++// DUALMAC_SINGLEPHY, ++//}MACPHY_MODE_8192D,*PMACPHY_MODE_8192D; ++// Above is the original define in MP driver. Please use the same define. THX. ++typedef enum tag_ODM_MAC_PHY_Mode_Definition ++{ ++ ODM_SMSP = 0, ++ ODM_DMSP = 1, ++ ODM_DMDP = 2, ++}ODM_MAC_PHY_MODE_E; ++ ++ ++typedef enum tag_BT_Coexist_Definition ++{ ++ ODM_BT_BUSY = 1, ++ ODM_BT_ON = 2, ++ ODM_BT_OFF = 3, ++ ODM_BT_NONE = 4, ++}ODM_BT_COEXIST_E; ++ ++// ODM_CMNINFO_OP_MODE ++typedef enum tag_Operation_Mode_Definition ++{ ++ ODM_NO_LINK = BIT0, ++ ODM_LINK = BIT1, ++ ODM_SCAN = BIT2, ++ ODM_POWERSAVE = BIT3, ++ ODM_AP_MODE = BIT4, ++ ODM_CLIENT_MODE = BIT5, ++ ODM_AD_HOC = BIT6, ++ ODM_WIFI_DIRECT = BIT7, ++ ODM_WIFI_DISPLAY = BIT8, ++}ODM_OPERATION_MODE_E; ++ ++// ODM_CMNINFO_WM_MODE ++typedef enum tag_Wireless_Mode_Definition ++{ ++ ODM_WM_UNKNOW = 0x0, ++ ODM_WM_B = BIT0, ++ ODM_WM_G = BIT1, ++ ODM_WM_A = BIT2, ++ ODM_WM_N24G = BIT3, ++ ODM_WM_N5G = BIT4, ++ ODM_WM_AUTO = BIT5, ++ ODM_WM_AC = BIT6, ++}ODM_WIRELESS_MODE_E; ++ ++// ODM_CMNINFO_BAND ++typedef enum tag_Band_Type_Definition ++{ ++ ODM_BAND_2_4G = BIT0, ++ ODM_BAND_5G = BIT1, ++ ++}ODM_BAND_TYPE_E; ++ ++// ODM_CMNINFO_SEC_CHNL_OFFSET ++typedef enum tag_Secondary_Channel_Offset_Definition ++{ ++ ODM_DONT_CARE = 0, ++ ODM_BELOW = 1, ++ ODM_ABOVE = 2 ++}ODM_SEC_CHNL_OFFSET_E; ++ ++// ODM_CMNINFO_SEC_MODE ++typedef enum tag_Security_Definition ++{ ++ ODM_SEC_OPEN = 0, ++ ODM_SEC_WEP40 = 1, ++ ODM_SEC_TKIP = 2, ++ ODM_SEC_RESERVE = 3, ++ ODM_SEC_AESCCMP = 4, ++ ODM_SEC_WEP104 = 5, ++ ODM_WEP_WPA_MIXED = 6, // WEP + WPA ++ ODM_SEC_SMS4 = 7, ++}ODM_SECURITY_E; ++ ++// ODM_CMNINFO_BW ++typedef enum tag_Bandwidth_Definition ++{ ++ ODM_BW20M = 0, ++ ODM_BW40M = 1, ++ ODM_BW80M = 2, ++ ODM_BW160M = 3, ++ ODM_BW10M = 4, ++}ODM_BW_E; ++ ++// ODM_CMNINFO_CHNL ++ ++// ODM_CMNINFO_BOARD_TYPE ++// For non-AC-series IC , ODM_BOARD_5G_EXT_PA and ODM_BOARD_5G_EXT_LNA are ignored ++// For AC-series IC, external PA & LNA can be indivisuallly added on 2.4G and/or 5G ++typedef enum tag_Board_Definition ++{ ++ ODM_BOARD_DEFAULT = 0, // The DEFAULT case. ++ ODM_BOARD_MINICARD = BIT(0), // 0 = non-mini card, 1= mini card. ++ ODM_BOARD_SLIM = BIT(1), // 0 = non-slim card, 1 = slim card ++ ODM_BOARD_BT = BIT(2), // 0 = without BT card, 1 = with BT ++ ODM_BOARD_EXT_PA = BIT(3), // 0 = no 2G ext-PA, 1 = existing 2G ext-PA ++ ODM_BOARD_EXT_LNA = BIT(4), // 0 = no 2G ext-LNA, 1 = existing 2G ext-LNA ++ ODM_BOARD_EXT_TRSW = BIT(5), // 0 = no ext-TRSW, 1 = existing ext-TRSW ++ ODM_BOARD_EXT_PA_5G = BIT(6), // 0 = no 5G ext-PA, 1 = existing 5G ext-PA ++ ODM_BOARD_EXT_LNA_5G = BIT(7), // 0 = no 5G ext-LNA, 1 = existing 5G ext-LNA ++}ODM_BOARD_TYPE_E; ++ ++ ++// ODM_CMNINFO_ONE_PATH_CCA ++typedef enum tag_CCA_Path ++{ ++ ODM_CCA_2R = 0, ++ ODM_CCA_1R_A = 1, ++ ODM_CCA_1R_B = 2, ++}ODM_CCA_PATH_E; ++ ++ ++typedef struct _ODM_RA_Info_ ++{ ++ u1Byte RateID; ++ u4Byte RateMask; ++ u4Byte RAUseRate; ++ u1Byte RateSGI; ++ u1Byte RssiStaRA; ++ u1Byte PreRssiStaRA; ++ u1Byte SGIEnable; ++ u1Byte DecisionRate; ++ u1Byte PreRate; ++ u1Byte HighestRate; ++ u1Byte LowestRate; ++ u4Byte NscUp; ++ u4Byte NscDown; ++ u2Byte RTY[5]; ++ u4Byte TOTAL; ++ u2Byte DROP; ++ u1Byte Active; ++ u2Byte RptTime; ++ u1Byte RAWaitingCounter; ++ u1Byte RAPendingCounter; ++#if 1 //POWER_TRAINING_ACTIVE == 1 // For compile pass only~! ++ u1Byte PTActive; // on or off ++ u1Byte PTTryState; // 0 trying state, 1 for decision state ++ u1Byte PTStage; // 0~6 ++ u1Byte PTStopCount; //Stop PT counter ++ u1Byte PTPreRate; // if rate change do PT ++ u1Byte PTPreRssi; // if RSSI change 5% do PT ++ u1Byte PTModeSS; // decide whitch rate should do PT ++ u1Byte RAstage; // StageRA, decide how many times RA will be done between PT ++ u1Byte PTSmoothFactor; ++#endif ++} ODM_RA_INFO_T,*PODM_RA_INFO_T; ++ ++typedef struct _IQK_MATRIX_REGS_SETTING{ ++ bool bIQKDone; ++ s4Byte Value[3][IQK_Matrix_REG_NUM]; ++ bool bBWIqkResultSaved[3]; ++}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; ++ ++typedef struct ODM_RF_Calibration_Structure ++{ ++ //for tx power tracking ++ ++ u4Byte RegA24; // for TempCCK ++ s4Byte RegE94; ++ s4Byte RegE9C; ++ s4Byte RegEB4; ++ s4Byte RegEBC; ++ ++ u1Byte TXPowercount; ++ bool bTXPowerTrackingInit; ++ bool bTXPowerTracking; ++ u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default ++ u1Byte TM_Trigger; ++ u1Byte InternalPA5G[2]; //pathA / pathB ++ ++ u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 ++ u1Byte ThermalValue; ++ u1Byte ThermalValue_LCK; ++ u1Byte ThermalValue_IQK; ++ u1Byte ThermalValue_DPK; ++ u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; ++ u1Byte ThermalValue_AVG_index; ++ u1Byte ThermalValue_RxGain; ++ u1Byte ThermalValue_Crystal; ++ u1Byte ThermalValue_DPKstore; ++ u1Byte ThermalValue_DPKtrack; ++ bool TxPowerTrackingInProgress; ++ bool bDPKenable; ++ ++ bool bReloadtxpowerindex; ++ u1Byte bRfPiEnable; ++ u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug ++ ++ ++ //------------------------- Tx power Tracking -------------------------// ++ u1Byte bCCKinCH14; ++ u1Byte CCK_index; ++ u1Byte OFDM_index[MAX_RF_PATH]; ++ s1Byte PowerIndexOffset[MAX_RF_PATH]; ++ s1Byte DeltaPowerIndex[MAX_RF_PATH]; ++ s1Byte DeltaPowerIndexLast[MAX_RF_PATH]; ++ bool bTxPowerChanged; ++ ++ u1Byte ThermalValue_HP[HP_THERMAL_NUM]; ++ u1Byte ThermalValue_HP_index; ++ IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; ++ bool bNeedIQK; ++ u1Byte Delta_IQK; ++ u1Byte Delta_LCK; ++ s1Byte BBSwingDiff2G, BBSwingDiff5G; // Unit: dB ++ u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; ++ u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; ++ ++ //--------------------------------------------------------------------// ++ ++ //for IQK ++ u4Byte RegC04; ++ u4Byte Reg874; ++ u4Byte RegC08; ++ u4Byte RegB68; ++ u4Byte RegB6C; ++ u4Byte Reg870; ++ u4Byte Reg860; ++ u4Byte Reg864; ++ ++ bool bIQKInitialized; ++ bool bLCKInProgress; ++ bool bAntennaDetected; ++ u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; ++ u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; ++ u4Byte IQK_BB_backup_recover[9]; ++ u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; ++ ++ //for APK ++ u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a ++ u1Byte bAPKdone; ++ u1Byte bAPKThermalMeterIgnore; ++ u1Byte bDPdone; ++ u1Byte bDPPathAOK; ++ u1Byte bDPPathBOK; ++ ++ u4Byte TxIQC_8723B[2][3][2]; // { {S0: 0xc94, 0xc80, 0xc4c} , {S1: 0xc9c, 0xc88, 0xc4c}} ++ u4Byte RxIQC_8723B[2][2][2]; // { {S0: 0xc14, 0xca0} , {S1: 0xc1c, 0xc78}} ++ ++}ODM_RF_CAL_T,*PODM_RF_CAL_T; ++// ++// ODM Dynamic common info value definition ++// ++ ++typedef struct _FAST_ANTENNA_TRAINNING_ ++{ ++ u1Byte Bssid[6]; ++ u1Byte antsel_rx_keep_0; ++ u1Byte antsel_rx_keep_1; ++ u1Byte antsel_rx_keep_2; ++ u4Byte antSumRSSI[7]; ++ u4Byte antRSSIcnt[7]; ++ u4Byte antAveRSSI[7]; ++ u1Byte FAT_State; ++ u4Byte TrainIdx; ++ u1Byte antsel_a[ODM_ASSOCIATE_ENTRY_NUM]; ++ u1Byte antsel_b[ODM_ASSOCIATE_ENTRY_NUM]; ++ u1Byte antsel_c[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte MainAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte AuxAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte MainAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte AuxAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; ++ u1Byte RxIdleAnt; ++ bool bBecomeLinked; ++ ++}FAT_T,*pFAT_T; ++ ++typedef enum _FAT_STATE ++{ ++ FAT_NORMAL_STATE = 0, ++ FAT_TRAINING_STATE = 1, ++}FAT_STATE_E, *PFAT_STATE_E; ++ ++typedef enum _ANT_DIV_TYPE ++{ ++ NO_ANTDIV = 0xFF, ++ CG_TRX_HW_ANTDIV = 0x01, ++ CGCS_RX_HW_ANTDIV = 0x02, ++ FIXED_HW_ANTDIV = 0x03, ++ CG_TRX_SMART_ANTDIV = 0x04, ++ CGCS_RX_SW_ANTDIV = 0x05, ++ S0S1_HW_ANTDIV = 0x06, //8723B intrnal switch S0 S1 ++}ANT_DIV_TYPE_E, *PANT_DIV_TYPE_E; ++ ++typedef struct _ODM_PATH_DIVERSITY_ ++{ ++ u1Byte RespTxPath; ++ u1Byte PathSel[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte PathA_Sum[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte PathB_Sum[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte PathA_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; ++ u4Byte PathB_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; ++}PATHDIV_T, *pPATHDIV_T; ++ ++ ++typedef enum _BASEBAND_CONFIG_PHY_REG_PG_VALUE_TYPE{ ++ PHY_REG_PG_RELATIVE_VALUE = 0, ++ PHY_REG_PG_EXACT_VALUE = 1 ++} PHY_REG_PG_TYPE; ++ ++ ++// ++// Antenna detection information from single tone mechanism, added by Roger, 2012.11.27. ++// ++typedef struct _ANT_DETECTED_INFO{ ++ bool bAntDetected; ++ u4Byte dBForAntA; ++ u4Byte dBForAntB; ++ u4Byte dBForAntO; ++}ANT_DETECTED_INFO, *PANT_DETECTED_INFO; ++ ++// ++// 2011/09/22 MH Copy from SD4 defined structure. We use to support PHY DM integration. ++// ++typedef struct DM_Out_Source_Dynamic_Mechanism_Structure ++{ ++ //RT_TIMER FastAntTrainingTimer; ++ // ++ // Add for different team use temporarily ++ // ++ PADAPTER Adapter; // For CE/NIC team ++ prtl8192cd_priv priv; // For AP/ADSL team ++ // WHen you use Adapter or priv pointer, you must make sure the pointer is ready. ++ bool odm_ready; ++ ++ rtl8192cd_priv fake_priv; ++ PHY_REG_PG_TYPE PhyRegPgValueType; ++ ++ u8Byte DebugComponents; ++ u4Byte DebugLevel; ++ ++ u8Byte NumQryPhyStatusAll; //CCK + OFDM ++ u8Byte LastNumQryPhyStatusAll; ++ u8Byte RxPWDBAve; ++ u8Byte RxPWDBAve_final; ++ bool MPDIG_2G; //off MPDIG ++ u1Byte Times_2G; ++ ++//------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------// ++ bool bCckHighPower; ++ u1Byte RFPathRxEnable; // ODM_CMNINFO_RFPATH_ENABLE ++ u1Byte ControlChannel; ++//------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------// ++ ++//--------REMOVED COMMON INFO----------// ++ //u1Byte PseudoMacPhyMode; ++ //bool *BTCoexist; ++ //bool PseudoBtCoexist; ++ //u1Byte OPMode; ++ //bool bAPMode; ++ //bool bClientMode; ++ //bool bAdHocMode; ++ //bool bSlaveOfDMSP; ++//--------REMOVED COMMON INFO----------// ++ ++ ++//1 COMMON INFORMATION ++ ++ // ++ // Init Value ++ // ++//-----------HOOK BEFORE REG INIT-----------// ++ // ODM Platform info AP/ADSL/CE/MP = 1/2/3/4 ++ u1Byte SupportPlatform; ++ // ODM Support Ability DIG/RATR/TX_PWR_TRACK/ KK = 1/2/3/K ++ u4Byte SupportAbility; ++ // ODM PCIE/USB/SDIO = 1/2/3 ++ u1Byte SupportInterface; ++ // ODM composite or independent. Bit oriented/ 92C+92D+ .... or any other type = 1/2/3/... ++ u4Byte SupportICType; ++ // Cut Version TestChip/A-cut/B-cut... = 0/1/2/3/... ++ u1Byte CutVersion; ++ // Fab Version TSMC/UMC = 0/1 ++ u1Byte FabVersion; ++ // RF Type 4T4R/3T3R/2T2R/1T2R/1T1R/... ++ u1Byte RFType; ++ u1Byte RFEType; ++ // Board Type Normal/HighPower/MiniCard/SLIM/Combo/... = 0/1/2/3/4/... ++ u1Byte BoardType; ++ // with external LNA NO/Yes = 0/1 ++ u1Byte ExtLNA; ++ u1Byte ExtLNA5G; ++ // with external PA NO/Yes = 0/1 ++ u1Byte ExtPA; ++ u1Byte ExtPA5G; ++ // with external TRSW NO/Yes = 0/1 ++ u1Byte ExtTRSW; ++ u1Byte PatchID; //Customer ID ++ bool bInHctTest; ++ bool bWIFITest; ++ ++ bool bDualMacSmartConcurrent; ++ u4Byte BK_SupportAbility; ++ u1Byte AntDivType; ++//-----------HOOK BEFORE REG INIT-----------// ++ ++ // ++ // Dynamic Value ++ // ++//--------- POINTER REFERENCE-----------// ++ ++ u1Byte u1Byte_temp; ++ bool bool_temp; ++ PADAPTER PADAPTER_temp; ++ ++ // MAC PHY Mode SMSP/DMSP/DMDP = 0/1/2 ++ u1Byte *pMacPhyMode; ++ //TX Unicast byte count ++ u8Byte *pNumTxBytesUnicast; ++ //RX Unicast byte count ++ u8Byte *pNumRxBytesUnicast; ++ // Wireless mode B/G/A/N = BIT0/BIT1/BIT2/BIT3 ++ u1Byte *pWirelessMode; //ODM_WIRELESS_MODE_E ++ // Frequence band 2.4G/5G = 0/1 ++ u1Byte *pBandType; ++ // Secondary channel offset don't_care/below/above = 0/1/2 ++ u1Byte *pSecChOffset; ++ // Security mode Open/WEP/AES/TKIP = 0/1/2/3 ++ u1Byte *pSecurity; ++ // BW info 20M/40M/80M = 0/1/2 ++ u1Byte *pBandWidth; ++ // Central channel location Ch1/Ch2/.... ++ u1Byte *pChannel; //central channel number ++ // Common info for 92D DMSP ++ ++ bool *pbGetValueFromOtherMac; ++ PADAPTER *pBuddyAdapter; ++ bool *pbMasterOfDMSP; //MAC0: master, MAC1: slave ++ // Common info for Status ++ bool *pbScanInProcess; ++ bool *pbPowerSaving; ++ // CCA Path 2-path/path-A/path-B = 0/1/2; using ODM_CCA_PATH_E. ++ u1Byte *pOnePathCCA; ++ //pMgntInfo->AntennaTest ++ u1Byte *pAntennaTest; ++ bool *pbNet_closed; ++ u1Byte *mp_mode; ++ //u1Byte *pAidMap; ++//--------- POINTER REFERENCE-----------// ++ pu2Byte pForcedDataRate; ++//------------CALL BY VALUE-------------// ++ bool bLinkInProcess; ++ bool bWIFI_Direct; ++ bool bWIFI_Display; ++ bool bLinked; ++ u1Byte RSSI_Min; ++ u1Byte InterfaceIndex; // Add for 92D dual MAC: 0--Mac0 1--Mac1 ++ bool bIsMPChip; ++ bool bOneEntryOnly; ++ // Common info for BTDM ++ bool bBtDisabled; // BT is disabled ++ bool bBtConnectProcess; // BT HS is under connection progress. ++ u1Byte btHsRssi; // BT HS mode wifi rssi value. ++ bool bBtHsOperation; // BT HS mode is under progress ++ bool bBtDisableEdcaTurbo; // Under some condition, don't enable the EDCA Turbo ++ bool bBtLimitedDig; // BT is busy. ++//------------CALL BY VALUE-------------// ++ u1Byte RSSI_A; ++ u1Byte RSSI_B; ++ u8Byte RSSI_TRSW; ++ u8Byte RSSI_TRSW_H; ++ u8Byte RSSI_TRSW_L; ++ u8Byte RSSI_TRSW_iso; ++ ++ u1Byte RxRate; ++ bool StopDIG; ++ u1Byte TxRate; ++ u1Byte LinkedInterval; ++ u1Byte preChannel; ++ u1Byte AntType; ++ u4Byte TxagcOffsetValueA; ++ bool IsTxagcOffsetPositiveA; ++ u4Byte TxagcOffsetValueB; ++ bool IsTxagcOffsetPositiveB; ++ u8Byte lastTxOkCnt; ++ u8Byte lastRxOkCnt; ++ u4Byte BbSwingOffsetA; ++ bool IsBbSwingOffsetPositiveA; ++ u4Byte BbSwingOffsetB; ++ bool IsBbSwingOffsetPositiveB; ++ u4Byte TH_H; ++ u4Byte TH_L; ++ u4Byte IGI_Base; ++ u4Byte IGI_target; ++ bool ForceEDCCA; ++ u1Byte AdapEn_RSSI; ++ bool bForceThresh; ++ u4Byte Force_TH_H; ++ u4Byte Force_TH_L; ++ ++ //2 Define STA info. ++ // _ODM_STA_INFO ++ // 2012/01/12 MH For MP, we need to reduce one array pointer for default port.?? ++ PSTA_INFO_T pODM_StaInfo[ODM_ASSOCIATE_ENTRY_NUM]; ++ ++#if (RATE_ADAPTIVE_SUPPORT == 1) ++ u2Byte CurrminRptTime; ++ ODM_RA_INFO_T RAInfo[ODM_ASSOCIATE_ENTRY_NUM]; //See HalMacID support ++#endif ++ // ++ // 2012/02/14 MH Add to share 88E ra with other SW team. ++ // We need to colelct all support abilit to a proper area. ++ // ++ bool RaSupport88E; ++ ++ // Define ........... ++ ++ // Latest packet phy info (ODM write) ++ ODM_PHY_DBG_INFO_T PhyDbgInfo; ++ //PHY_INFO_88E PhyInfo; ++ ++ // Latest packet phy info (ODM write) ++ ODM_MAC_INFO *pMacInfo; ++ //MAC_INFO_88E MacInfo; ++ ++ // Different Team independt structure?? ++ ++ // ++ //TX_RTP_CMN TX_retrpo; ++ //TX_RTP_88E TX_retrpo; ++ //TX_RTP_8195 TX_retrpo; ++ ++ // ++ //ODM Structure ++ // ++ FAT_T DM_FatTable; ++ DIG_T DM_DigTable; ++ PS_T DM_PSTable; ++ Pri_CCA_T DM_PriCCA; ++ RXHP_T DM_RXHP_Table; ++ FALSE_ALARM_STATISTICS FalseAlmCnt; ++ FALSE_ALARM_STATISTICS FlaseAlmCntBuddyAdapter; ++ SWAT_T DM_SWAT_Table; ++ bool RSSI_test; ++ ++ EDCA_T DM_EDCA_Table; ++ u4Byte WMMEDCA_BE; ++ PATHDIV_T DM_PathDiv; ++ // Copy from SD4 structure ++ // ++ // ================================================== ++ // ++ ++ //common ++ //u1Byte DM_Type; ++ //u1Byte PSD_Report_RXHP[80]; // Add By Gary ++ //u1Byte PSD_func_flag; // Add By Gary ++ //for DIG ++ //u1Byte bDMInitialGainEnable; ++ //u1Byte binitialized; // for dm_initial_gain_Multi_STA use. ++ //for Antenna diversity ++ //u8 AntDivCfg;// 0:OFF , 1:ON, 2:by efuse ++ //PSTA_INFO_T RSSI_target; ++ ++ bool *pbDriverStopped; ++ bool *pbDriverIsGoingToPnpSetPowerSleep; ++ bool *pinit_adpt_in_progress; ++ ++ //PSD ++ bool bUserAssignLevel; ++ RT_TIMER PSDTimer; ++ u1Byte RSSI_BT; //come from BT ++ bool bPSDinProcess; ++ bool bPSDactive; ++ bool bDMInitialGainEnable; ++ ++ //MPT DIG ++ RT_TIMER MPT_DIGTimer; ++ ++ //for rate adaptive, in fact, 88c/92c fw will handle this ++ u1Byte bUseRAMask; ++ ++ ODM_RATE_ADAPTIVE RateAdaptive; ++ ++ ANT_DETECTED_INFO AntDetectedInfo; // Antenna detected information for RSSI tool ++ ++ ODM_RF_CAL_T RFCalibrateInfo; ++ ++ // ++ // TX power tracking ++ // ++ u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; ++ u1Byte BbSwingIdxOfdmCurrent; ++ u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; ++ bool BbSwingFlagOfdm; ++ u1Byte BbSwingIdxCck; ++ u1Byte BbSwingIdxCckCurrent; ++ u1Byte BbSwingIdxCckBase; ++ u1Byte DefaultOfdmIndex; ++ u1Byte DefaultCckIndex; ++ bool BbSwingFlagCck; ++ ++ s1Byte Aboslute_OFDMSwingIdx[MAX_RF_PATH]; ++ s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; ++ s1Byte Remnant_CCKSwingIdx; ++ s1Byte Modify_TxAGC_Value; //Remnat compensate value at TxAGC ++ bool Modify_TxAGC_Flag_PathA; ++ bool Modify_TxAGC_Flag_PathB; ++ ++ // ++ // Dynamic ATC switch ++ // ++ bool bATCStatus; ++ bool largeCFOHit; ++ bool bIsfreeze; ++ int CFO_tail[2]; ++ int CFO_ave_pre; ++ int CrystalCap; ++ u1Byte CFOThreshold; ++ u4Byte packetCount; ++ u4Byte packetCount_pre; ++ ++ // ++ // ODM system resource. ++ // ++ ++ // ODM relative time. ++ RT_TIMER PathDivSwitchTimer; ++ //2011.09.27 add for Path Diversity ++ RT_TIMER CCKPathDiversityTimer; ++ RT_TIMER FastAntTrainingTimer; ++} DM_ODM_T, *PDM_ODM_T; // DM_Dynamic_Mechanism_Structure ++ ++#define ODM_RF_PATH_MAX 2 ++ ++typedef enum _ODM_RF_RADIO_PATH { ++ ODM_RF_PATH_A = 0, //Radio Path A ++ ODM_RF_PATH_B = 1, //Radio Path B ++ ODM_RF_PATH_C = 2, //Radio Path C ++ ODM_RF_PATH_D = 3, //Radio Path D ++ // ODM_RF_PATH_MAX, //Max RF number 90 support ++} ODM_RF_RADIO_PATH_E, *PODM_RF_RADIO_PATH_E; ++ ++ typedef enum _ODM_RF_CONTENT{ ++ odm_radioa_txt = 0x1000, ++ odm_radiob_txt = 0x1001, ++ odm_radioc_txt = 0x1002, ++ odm_radiod_txt = 0x1003 ++} ODM_RF_CONTENT; ++ ++typedef enum _ODM_BB_Config_Type{ ++ CONFIG_BB_PHY_REG, ++ CONFIG_BB_AGC_TAB, ++ CONFIG_BB_AGC_TAB_2G, ++ CONFIG_BB_AGC_TAB_5G, ++ CONFIG_BB_PHY_REG_PG, ++ CONFIG_BB_PHY_REG_MP, ++} ODM_BB_Config_Type, *PODM_BB_Config_Type; ++ ++typedef enum _ODM_RF_Config_Type{ ++ CONFIG_RF_RADIO, ++ CONFIG_RF_TXPWR_LMT, ++} ODM_RF_Config_Type, *PODM_RF_Config_Type; ++ ++typedef enum _ODM_FW_Config_Type{ ++ CONFIG_FW_NIC, ++ CONFIG_FW_NIC_2, ++ CONFIG_FW_AP, ++ CONFIG_FW_MP, ++ CONFIG_FW_WoWLAN, ++ CONFIG_FW_WoWLAN_2, ++ CONFIG_FW_BT, ++} ODM_FW_Config_Type; ++ ++// Status code ++typedef enum _RT_STATUS{ ++ RT_STATUS_SUCCESS, ++ RT_STATUS_FAILURE, ++ RT_STATUS_PENDING, ++ RT_STATUS_RESOURCE, ++ RT_STATUS_INVALID_CONTEXT, ++ RT_STATUS_INVALID_PARAMETER, ++ RT_STATUS_NOT_SUPPORT, ++ RT_STATUS_OS_API_FAILED, ++}RT_STATUS,*PRT_STATUS; ++ ++#ifdef REMOVE_PACK ++#pragma pack() ++#endif ++ ++//#include "odm_function.h" ++ ++//3=========================================================== ++//3 DIG ++//3=========================================================== ++ ++typedef enum tag_Dynamic_Init_Gain_Operation_Type_Definition ++{ ++ DIG_TYPE_THRESH_HIGH = 0, ++ DIG_TYPE_THRESH_LOW = 1, ++ DIG_TYPE_BACKOFF = 2, ++ DIG_TYPE_RX_GAIN_MIN = 3, ++ DIG_TYPE_RX_GAIN_MAX = 4, ++ DIG_TYPE_ENABLE = 5, ++ DIG_TYPE_DISABLE = 6, ++ DIG_OP_TYPE_MAX ++}DM_DIG_OP_E; ++/* ++typedef enum tag_CCK_Packet_Detection_Threshold_Type_Definition ++{ ++ CCK_PD_STAGE_LowRssi = 0, ++ CCK_PD_STAGE_HighRssi = 1, ++ CCK_PD_STAGE_MAX = 3, ++}DM_CCK_PDTH_E; ++ ++typedef enum tag_DIG_EXT_PORT_ALGO_Definition ++{ ++ DIG_EXT_PORT_STAGE_0 = 0, ++ DIG_EXT_PORT_STAGE_1 = 1, ++ DIG_EXT_PORT_STAGE_2 = 2, ++ DIG_EXT_PORT_STAGE_3 = 3, ++ DIG_EXT_PORT_STAGE_MAX = 4, ++}DM_DIG_EXT_PORT_ALG_E; ++ ++typedef enum tag_DIG_Connect_Definition ++{ ++ DIG_STA_DISCONNECT = 0, ++ DIG_STA_CONNECT = 1, ++ DIG_STA_BEFORE_CONNECT = 2, ++ DIG_MultiSTA_DISCONNECT = 3, ++ DIG_MultiSTA_CONNECT = 4, ++ DIG_CONNECT_MAX ++}DM_DIG_CONNECT_E; ++ ++ ++#define DM_MultiSTA_InitGainChangeNotify(Event) {DM_DigTable.CurMultiSTAConnectState = Event;} ++ ++#define DM_MultiSTA_InitGainChangeNotify_CONNECT(_ADAPTER) \ ++ DM_MultiSTA_InitGainChangeNotify(DIG_MultiSTA_CONNECT) ++ ++#define DM_MultiSTA_InitGainChangeNotify_DISCONNECT(_ADAPTER) \ ++ DM_MultiSTA_InitGainChangeNotify(DIG_MultiSTA_DISCONNECT) ++*/ ++#define DM_DIG_THRESH_HIGH 40 ++#define DM_DIG_THRESH_LOW 35 ++ ++#define DMfalseALARM_THRESH_LOW 400 ++#define DMfalseALARM_THRESH_HIGH 1000 ++ ++#define DM_DIG_MAX_NIC 0x3e ++#define DM_DIG_MIN_NIC 0x1e //0x22//0x1c ++ ++#define DM_DIG_MAX_AP 0x32 ++#define DM_DIG_MIN_AP 0x20 ++ ++#define DM_DIG_MAX_NIC_HP 0x46 ++#define DM_DIG_MIN_NIC_HP 0x2e ++ ++#define DM_DIG_MAX_AP_HP 0x42 ++#define DM_DIG_MIN_AP_HP 0x30 ++ ++//vivi 92c&92d has different definition, 20110504 ++//this is for 92c ++#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV ++#define DM_DIG_FA_TH0 0x80//0x20 ++#else ++#define DM_DIG_FA_TH0 0x200//0x20 ++#endif ++#define DM_DIG_FA_TH1 0x300//0x100 ++#define DM_DIG_FA_TH2 0x400//0x200 ++//this is for 92d ++#define DM_DIG_FA_TH0_92D 0x100 ++#define DM_DIG_FA_TH1_92D 0x400 ++#define DM_DIG_FA_TH2_92D 0x600 ++ ++#define DM_DIG_BACKOFF_MAX 12 ++#define DM_DIG_BACKOFF_MIN -4 ++#define DM_DIG_BACKOFF_DEFAULT 10 ++ ++//3=========================================================== ++//3 AGC RX High Power Mode ++//3=========================================================== ++#define LNA_Low_Gain_1 0x64 ++#define LNA_Low_Gain_2 0x5A ++#define LNA_Low_Gain_3 0x58 ++ ++#define FA_RXHP_TH1 5000 ++#define FA_RXHP_TH2 1500 ++#define FA_RXHP_TH3 800 ++#define FA_RXHP_TH4 600 ++#define FA_RXHP_TH5 500 ++ ++//3=========================================================== ++//3 EDCA ++//3=========================================================== ++ ++//3=========================================================== ++//3 Dynamic Tx Power ++//3=========================================================== ++//Dynamic Tx Power Control Threshold ++#define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 ++#define TX_POWER_NEAR_FIELD_THRESH_LVL1 67 ++#define TX_POWER_NEAR_FIELD_THRESH_AP 0x3F ++ ++#define TxHighPwrLevel_Normal 0 ++#define TxHighPwrLevel_Level1 1 ++#define TxHighPwrLevel_Level2 2 ++#define TxHighPwrLevel_BT1 3 ++#define TxHighPwrLevel_BT2 4 ++#define TxHighPwrLevel_15 5 ++#define TxHighPwrLevel_35 6 ++#define TxHighPwrLevel_50 7 ++#define TxHighPwrLevel_70 8 ++#define TxHighPwrLevel_100 9 ++ ++//3=========================================================== ++//3 Tx Power Tracking ++//3=========================================================== ++#if 0 //mask this, since these have been defined in typdef.h, vivi ++#define OFDM_TABLE_SIZE 37 ++#define OFDM_TABLE_SIZE_92D 43 ++#define CCK_TABLE_SIZE 33 ++#endif ++ ++ ++//3=========================================================== ++//3 Rate Adaptive ++//3=========================================================== ++#define DM_RATR_STA_INIT 0 ++#define DM_RATR_STA_HIGH 1 ++#define DM_RATR_STA_MIDDLE 2 ++#define DM_RATR_STA_LOW 3 ++ ++//3=========================================================== ++//3 BB Power Save ++//3=========================================================== ++ ++ ++//3=========================================================== ++//3 Dynamic ATC switch ++//3=========================================================== ++#define ATC_Status_Off 0x0 // enable ++#define ATC_Status_On 0x1 // disable ++#define CFO_Threshold_Xtal 10 // kHz ++#define CFO_Threshold_ATC 80 // kHz ++ ++typedef enum tag_1R_CCA_Type_Definition ++{ ++ CCA_1R =0, ++ CCA_2R = 1, ++ CCA_MAX = 2, ++}DM_1R_CCA_E; ++ ++typedef enum tag_RF_Type_Definition ++{ ++ RF_Save =0, ++ RF_Normal = 1, ++ RF_MAX = 2, ++}DM_RF_E; ++ ++//3=========================================================== ++//3 Antenna Diversity ++//3=========================================================== ++typedef enum tag_SW_Antenna_Switch_Definition ++{ ++ Antenna_A = 1, ++ Antenna_B = 2, ++ Antenna_MAX = 3, ++}DM_SWAS_E; ++ ++ ++// Maximal number of antenna detection mechanism needs to perform, added by Roger, 2011.12.28. ++#define MAX_ANTENNA_DETECTION_CNT 10 ++ ++// ++// Extern Global Variables. ++// ++extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE_92D]; ++extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; ++extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; ++ ++extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE_92D]; ++extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; ++extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; ++ ++extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; ++ ++// <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. ++static u1Byte DeltaSwingTableIdx_2GA_P_8188E[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; ++static u1Byte DeltaSwingTableIdx_2GA_N_8188E[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; ++ ++// ++// check Sta pointer valid or not ++// ++#define IS_STA_VALID(pSta) (pSta) ++// 20100514 Joseph: Add definition for antenna switching test after link. ++// This indicates two different the steps. ++// In SWAW_STEP_PEAK, driver needs to switch antenna and listen to the signal on the air. ++// In SWAW_STEP_DETERMINE, driver just compares the signal captured in SWAW_STEP_PEAK ++// with original RSSI to determine if it is necessary to switch antenna. ++#define SWAW_STEP_PEAK 0 ++#define SWAW_STEP_DETERMINE 1 ++ ++void ODM_Write_DIG(PDM_ODM_T pDM_Odm, u1Byte CurrentIGI); ++void ODM_Write_CCK_CCA_Thres(PDM_ODM_T pDM_Odm, u1Byte CurCCK_CCAThres); ++ ++void ++ODM_SetAntenna( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Antenna); ++ ++ ++#define dm_RF_Saving ODM_RF_Saving ++void ODM_RF_Saving(PDM_ODM_T pDM_Odm, ++ u1Byte bForceInNormal ); ++ ++#define SwAntDivRestAfterLink ODM_SwAntDivRestAfterLink ++void ODM_SwAntDivRestAfterLink(PDM_ODM_T pDM_Odm); ++ ++#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck ++void ++ODM_TXPowerTrackingCheck( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++bool ++ODM_RAStateCheck( ++ PDM_ODM_T pDM_Odm, ++ s4Byte RSSI, ++ bool bForceUpdate, ++ pu1Byte pRATRState ++ ); ++ ++#define dm_SWAW_RSSI_Check ODM_SwAntDivChkPerPktRssi ++void ODM_SwAntDivChkPerPktRssi( ++ PDM_ODM_T pDM_Odm, ++ u1Byte StationID, ++ PODM_PHY_INFO_T pPhyInfo ++ ); ++ ++u4Byte ConvertTo_dB(u4Byte Value); ++ ++u4Byte ++GetPSDData( ++ PDM_ODM_T pDM_Odm, ++ unsigned int point, ++ u1Byte initial_gain_psd); ++ ++void ++odm_DIGbyRSSI_LPS( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++u4Byte ODM_Get_Rate_Bitmap( ++ PDM_ODM_T pDM_Odm, ++ u4Byte macid, ++ u4Byte ra_mask, ++ u1Byte rssi_level); ++ ++#if (BEAMFORMING_SUPPORT == 1) ++BEAMFORMING_CAP ++Beamforming_GetEntryBeamCapByMacId( ++ PMGNT_INFO pMgntInfo, ++ u1Byte MacId ++ ); ++#endif ++ ++void ODM_DMInit(PDM_ODM_T pDM_Odm); ++ ++void ++ODM_DMWatchdog( ++ PDM_ODM_T pDM_Odm // For common use in the future ++ ); ++ ++void ++ODM_CmnInfoInit( ++ PDM_ODM_T pDM_Odm, ++ ODM_CMNINFO_E CmnInfo, ++ u4Byte Value ++ ); ++ ++void ++ODM_CmnInfoHook( ++ PDM_ODM_T pDM_Odm, ++ ODM_CMNINFO_E CmnInfo, ++ void * pValue ++ ); ++ ++void ++ODM_CmnInfoPtrArrayHook( ++ PDM_ODM_T pDM_Odm, ++ ODM_CMNINFO_E CmnInfo, ++ u2Byte Index, ++ void * pValue ++ ); ++ ++void ++ODM_CmnInfoUpdate( ++ PDM_ODM_T pDM_Odm, ++ u4Byte CmnInfo, ++ u8Byte Value ++ ); ++ ++void ++ODM_InitAllTimers( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++ODM_CancelAllTimers( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++ODM_ReleaseAllTimers( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++ODM_ResetIQKResult( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++ODM_AntselStatistics_88C( ++ PDM_ODM_T pDM_Odm, ++ u1Byte MacId, ++ u4Byte PWDBAll, ++ bool isCCKrate ++); ++ ++void ++ODM_SingleDualAntennaDefaultSetting( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++bool ++ODM_SingleDualAntennaDetection( ++ PDM_ODM_T pDM_Odm, ++ u1Byte mode ++ ); ++ ++void ++ODM_UpdateInitRate( ++ PDM_ODM_T pDM_Odm, ++ u1Byte Rate ++ ); ++void odm_dtc(PDM_ODM_T pDM_Odm); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_HWConfig.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_HWConfig.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_HWConfig.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_HWConfig.c 2018-02-06 17:42:30.712967194 +0200 +@@ -0,0 +1,1454 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++ ++ ++#include "odm_precomp.h" ++ ++#define READ_AND_CONFIG_MP(ic, txt) (ODM_ReadAndConfig_MP_##ic##txt(pDM_Odm)) ++#define READ_AND_CONFIG_TC(ic, txt) (ODM_ReadAndConfig_TC_##ic##txt(pDM_Odm)) ++ ++ ++#if (TEST_CHIP_SUPPORT == 1) ++#define READ_AND_CONFIG(ic, txt) do {\ ++ if (pDM_Odm->bIsMPChip)\ ++ READ_AND_CONFIG_MP(ic,txt);\ ++ else\ ++ READ_AND_CONFIG_TC(ic,txt);\ ++ } while(0) ++#else ++ #define READ_AND_CONFIG READ_AND_CONFIG_MP ++#endif ++ ++ ++#define READ_FIRMWARE_MP(ic, txt) (ODM_ReadFirmware_MP_##ic##txt(pDM_Odm, pFirmware, pSize)) ++#define READ_FIRMWARE_TC(ic, txt) (ODM_ReadFirmware_TC_##ic##txt(pDM_Odm, pFirmware, pSize)) ++ ++#if (TEST_CHIP_SUPPORT == 1) ++#define READ_FIRMWARE(ic, txt) do {\ ++ if (pDM_Odm->bIsMPChip)\ ++ READ_FIRMWARE_MP(ic,txt);\ ++ else\ ++ READ_FIRMWARE_TC(ic,txt);\ ++ } while(0) ++#else ++#define READ_FIRMWARE READ_FIRMWARE_MP ++#endif ++ ++u1Byte ++odm_QueryRxPwrPercentage( ++ s1Byte AntPower ++ ) ++{ ++ if ((AntPower <= -100) || (AntPower >= 20)) ++ { ++ return 0; ++ } ++ else if (AntPower >= 0) ++ { ++ return 100; ++ } ++ else ++ { ++ return (100+AntPower); ++ } ++ ++} ++ ++// ++// 2012/01/12 MH MOve some signal strength smooth method to MP HAL layer. ++// IF other SW team do not support the feature, remove this section.?? ++// ++s4Byte ++odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Lenovo( ++ PDM_ODM_T pDM_Odm, ++ s4Byte CurrSig ++) ++{ ++ s4Byte RetSig; ++ return RetSig; ++} ++ ++s4Byte ++odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Netcore( ++ PDM_ODM_T pDM_Odm, ++ s4Byte CurrSig ++) ++{ ++ s4Byte RetSig; ++ return RetSig; ++} ++ ++ ++s4Byte ++odm_SignalScaleMapping_92CSeries( ++ PDM_ODM_T pDM_Odm, ++ s4Byte CurrSig ++) ++{ ++ s4Byte RetSig; ++#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) ++ if(pDM_Odm->SupportInterface == ODM_ITRF_PCIE) ++ { ++ // Step 1. Scale mapping. ++ if(CurrSig >= 61 && CurrSig <= 100) ++ { ++ RetSig = 90 + ((CurrSig - 60) / 4); ++ } ++ else if(CurrSig >= 41 && CurrSig <= 60) ++ { ++ RetSig = 78 + ((CurrSig - 40) / 2); ++ } ++ else if(CurrSig >= 31 && CurrSig <= 40) ++ { ++ RetSig = 66 + (CurrSig - 30); ++ } ++ else if(CurrSig >= 21 && CurrSig <= 30) ++ { ++ RetSig = 54 + (CurrSig - 20); ++ } ++ else if(CurrSig >= 5 && CurrSig <= 20) ++ { ++ RetSig = 42 + (((CurrSig - 5) * 2) / 3); ++ } ++ else if(CurrSig == 4) ++ { ++ RetSig = 36; ++ } ++ else if(CurrSig == 3) ++ { ++ RetSig = 27; ++ } ++ else if(CurrSig == 2) ++ { ++ RetSig = 18; ++ } ++ else if(CurrSig == 1) ++ { ++ RetSig = 9; ++ } ++ else ++ { ++ RetSig = CurrSig; ++ } ++ } ++#endif ++ ++#if ((DEV_BUS_TYPE == RT_USB_INTERFACE) ||(DEV_BUS_TYPE == RT_SDIO_INTERFACE)) ++ if((pDM_Odm->SupportInterface == ODM_ITRF_USB) || (pDM_Odm->SupportInterface == ODM_ITRF_SDIO)) ++ { ++ if(CurrSig >= 51 && CurrSig <= 100) ++ { ++ RetSig = 100; ++ } ++ else if(CurrSig >= 41 && CurrSig <= 50) ++ { ++ RetSig = 80 + ((CurrSig - 40)*2); ++ } ++ else if(CurrSig >= 31 && CurrSig <= 40) ++ { ++ RetSig = 66 + (CurrSig - 30); ++ } ++ else if(CurrSig >= 21 && CurrSig <= 30) ++ { ++ RetSig = 54 + (CurrSig - 20); ++ } ++ else if(CurrSig >= 10 && CurrSig <= 20) ++ { ++ RetSig = 42 + (((CurrSig - 10) * 2) / 3); ++ } ++ else if(CurrSig >= 5 && CurrSig <= 9) ++ { ++ RetSig = 22 + (((CurrSig - 5) * 3) / 2); ++ } ++ else if(CurrSig >= 1 && CurrSig <= 4) ++ { ++ RetSig = 6 + (((CurrSig - 1) * 3) / 2); ++ } ++ else ++ { ++ RetSig = CurrSig; ++ } ++ } ++ ++#endif ++ return RetSig; ++} ++s4Byte ++odm_SignalScaleMapping( ++ PDM_ODM_T pDM_Odm, ++ s4Byte CurrSig ++) ++{ ++ if( (pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->SupportInterface != ODM_ITRF_PCIE) && //USB & SDIO ++ (pDM_Odm->PatchID==10))//pMgntInfo->CustomerID == RT_CID_819x_Netcore ++ { ++ return odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Netcore(pDM_Odm,CurrSig); ++ } ++ else if( (pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) && ++ (pDM_Odm->PatchID==19))//pMgntInfo->CustomerID == RT_CID_819x_Lenovo) ++ { ++ return odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Lenovo(pDM_Odm, CurrSig); ++ } ++ else{ ++ return odm_SignalScaleMapping_92CSeries(pDM_Odm,CurrSig); ++ } ++ ++} ++ ++static u1Byte odm_SQ_process_patch_RT_CID_819x_Lenovo( ++ PDM_ODM_T pDM_Odm, ++ u1Byte isCCKrate, ++ u1Byte PWDB_ALL, ++ u1Byte path, ++ u1Byte RSSI ++) ++{ ++ u1Byte SQ; ++ return SQ; ++} ++ ++static u1Byte ++odm_EVMdbToPercentage( ++ s1Byte Value ++ ) ++{ ++ // ++ // -33dB~0dB to 0%~99% ++ // ++ s1Byte ret_val; ++ ++ ret_val = Value; ++ //ret_val /= 2; ++ ++ //ODM_RT_DISP(FRX, RX_PHY_SQ, ("EVMdbToPercentage92C Value=%d / %x \n", ret_val, ret_val)); ++ ++ if(ret_val >= 0) ++ ret_val = 0; ++ if(ret_val <= -33) ++ ret_val = -33; ++ ++ ret_val = 0 - ret_val; ++ ret_val*=3; ++ ++ if(ret_val == 99) ++ ret_val = 100; ++ ++ return(ret_val); ++} ++ ++static u1Byte ++odm_EVMdbm_JaguarSeries( ++ s1Byte Value ++ ) ++{ ++ s1Byte ret_val = Value; ++ ++ // -33dB~0dB to 33dB ~ 0dB ++ if(ret_val == -128) ++ ret_val = 127; ++ else if (ret_val < 0) ++ ret_val = 0 - ret_val; ++ ++ ret_val = ret_val >> 1; ++ return ret_val; ++} ++ ++static u2Byte ++odm_Cfo( ++ s1Byte Value ++) ++{ ++ s2Byte ret_val; ++ ++ if (Value < 0) ++ { ++ ret_val = 0 - Value; ++ ret_val = (ret_val << 1) + (ret_val >> 1) ; // *2.5~=312.5/2^7 ++ ret_val = ret_val | BIT12; // set bit12 as 1 for negative cfo ++ } ++ else ++ { ++ ret_val = Value; ++ ret_val = (ret_val << 1) + (ret_val>>1) ; // *2.5~=312.5/2^7 ++ } ++ return ret_val; ++} ++ ++ ++void ++odm_RxPhyStatus92CSeries_Parsing( ++ PDM_ODM_T pDM_Odm, ++ PODM_PHY_INFO_T pPhyInfo, ++ pu1Byte pPhyStatus, ++ PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ u1Byte i, Max_spatial_stream; ++ s1Byte rx_pwr[4], rx_pwr_all=0; ++ u1Byte EVM, PWDB_ALL = 0, PWDB_ALL_BT; ++ u1Byte RSSI, total_rssi=0; ++ bool isCCKrate=false; ++ u1Byte rf_rx_num = 0; ++ u1Byte cck_highpwr = 0; ++ u1Byte LNA_idx, VGA_idx; ++ PPHY_STATUS_RPT_8192CD_T pPhyStaRpt = (PPHY_STATUS_RPT_8192CD_T)pPhyStatus; ++ ++ isCCKrate = (pPktinfo->DataRate <= DESC92C_RATE11M)?true :false; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = -1; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; ++ ++ ++ if(isCCKrate) ++ { ++ u1Byte report; ++ u1Byte cck_agc_rpt; ++ ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; ++ // ++ // (1)Hardware does not provide RSSI for CCK ++ // (2)PWDB, Average PWDB cacluated by hardware (for rate adaptive) ++ // ++ ++ //if(pHalData->eRFPowerState == eRfOn) ++ cck_highpwr = pDM_Odm->bCckHighPower; ++ //else ++ // cck_highpwr = false; ++ ++ cck_agc_rpt = pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a ; ++ ++ //2011.11.28 LukeLee: 88E use different LNA & VGA gain table ++ //The RSSI formula should be modified according to the gain table ++ //In 88E, cck_highpwr is always set to 1 ++ if(pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B)) ++ { ++ LNA_idx = ((cck_agc_rpt & 0xE0) >>5); ++ VGA_idx = (cck_agc_rpt & 0x1F); ++ if(pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8192E)) ++ { ++ switch(LNA_idx) ++ { ++ case 7: ++ if(VGA_idx <= 27) ++ rx_pwr_all = -100 + 2*(27-VGA_idx); //VGA_idx = 27~2 ++ else ++ rx_pwr_all = -100; ++ break; ++ case 6: ++ rx_pwr_all = -48 + 2*(2-VGA_idx); //VGA_idx = 2~0 ++ break; ++ case 5: ++ rx_pwr_all = -42 + 2*(7-VGA_idx); //VGA_idx = 7~5 ++ break; ++ case 4: ++ rx_pwr_all = -36 + 2*(7-VGA_idx); //VGA_idx = 7~4 ++ break; ++ case 3: ++ //rx_pwr_all = -28 + 2*(7-VGA_idx); //VGA_idx = 7~0 ++ rx_pwr_all = -24 + 2*(7-VGA_idx); //VGA_idx = 7~0 ++ break; ++ case 2: ++ if(cck_highpwr) ++ rx_pwr_all = -12 + 2*(5-VGA_idx); //VGA_idx = 5~0 ++ else ++ rx_pwr_all = -6+ 2*(5-VGA_idx); ++ break; ++ case 1: ++ rx_pwr_all = 8-2*VGA_idx; ++ break; ++ case 0: ++ rx_pwr_all = 14-2*VGA_idx; ++ break; ++ default: ++ //DbgPrint("CCK Exception default\n"); ++ break; ++ } ++ rx_pwr_all += 6; ++ ++ //2012.10.08 LukeLee: Modify for 92E CCK RSSI ++ if(pDM_Odm->SupportICType == ODM_RTL8192E) ++ rx_pwr_all += 10; ++ ++ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); ++ if(cck_highpwr == false) ++ { ++ if(PWDB_ALL >= 80) ++ PWDB_ALL = ((PWDB_ALL-80)<<1)+((PWDB_ALL-80)>>1)+80; ++ else if((PWDB_ALL <= 78) && (PWDB_ALL >= 20)) ++ PWDB_ALL += 3; ++ if(PWDB_ALL>100) ++ PWDB_ALL = 100; ++ } ++ } ++ } ++ else ++ { ++ if(!cck_highpwr) ++ { ++ report =( cck_agc_rpt & 0xc0 )>>6; ++ switch(report) ++ { ++ // 03312009 modified by cosa ++ // Modify the RF RNA gain value to -40, -20, -2, 14 by Jenyu's suggestion ++ // Note: different RF with the different RNA gain. ++ case 0x3: ++ rx_pwr_all = -46 - (cck_agc_rpt & 0x3e); ++ break; ++ case 0x2: ++ rx_pwr_all = -26 - (cck_agc_rpt & 0x3e); ++ break; ++ case 0x1: ++ rx_pwr_all = -12 - (cck_agc_rpt & 0x3e); ++ break; ++ case 0x0: ++ rx_pwr_all = 16 - (cck_agc_rpt & 0x3e); ++ break; ++ } ++ } ++ else ++ { ++ //report = pDrvInfo->cfosho[0] & 0x60; ++ //report = pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a& 0x60; ++ ++ report = (cck_agc_rpt & 0x60)>>5; ++ switch(report) ++ { ++ case 0x3: ++ rx_pwr_all = -46 - ((cck_agc_rpt & 0x1f)<<1) ; ++ break; ++ case 0x2: ++ rx_pwr_all = -26 - ((cck_agc_rpt & 0x1f)<<1); ++ break; ++ case 0x1: ++ rx_pwr_all = -12 - ((cck_agc_rpt & 0x1f)<<1) ; ++ break; ++ case 0x0: ++ rx_pwr_all = 16 - ((cck_agc_rpt & 0x1f)<<1) ; ++ break; ++ } ++ } ++ ++ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); ++ ++ //Modification for ext-LNA board ++ if(pDM_Odm->BoardType & (ODM_BOARD_EXT_LNA | ODM_BOARD_EXT_PA)) ++ { ++ if((cck_agc_rpt>>7) == 0){ ++ PWDB_ALL = (PWDB_ALL>94)?100:(PWDB_ALL +6); ++ } ++ else ++ { ++ if(PWDB_ALL > 38) ++ PWDB_ALL -= 16; ++ else ++ PWDB_ALL = (PWDB_ALL<=16)?(PWDB_ALL>>2):(PWDB_ALL -12); ++ } ++ ++ //CCK modification ++ if(PWDB_ALL > 25 && PWDB_ALL <= 60) ++ PWDB_ALL += 6; ++ //else if (PWDB_ALL <= 25) ++ // PWDB_ALL += 8; ++ } ++ else//Modification for int-LNA board ++ { ++ if(PWDB_ALL > 99) ++ PWDB_ALL -= 8; ++ else if(PWDB_ALL > 50 && PWDB_ALL <= 68) ++ PWDB_ALL += 4; ++ } ++ } ++ ++ pPhyInfo->RxPWDBAll = PWDB_ALL; ++ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL; ++ pPhyInfo->RecvSignalPower = rx_pwr_all; ++ // ++ // (3) Get Signal Quality (EVM) ++ // ++ if(pPktinfo->bPacketMatchBSSID) ++ { ++ u1Byte SQ,SQ_rpt; ++ ++ if((pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)){ ++ SQ = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,0,0); ++ } ++ else if(pPhyInfo->RxPWDBAll > 40 && !pDM_Odm->bInHctTest){ ++ SQ = 100; ++ } ++ else{ ++ SQ_rpt = pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all; ++ ++ if(SQ_rpt > 64) ++ SQ = 0; ++ else if (SQ_rpt < 20) ++ SQ = 100; ++ else ++ SQ = ((64-SQ_rpt) * 100) / 44; ++ ++ } ++ ++ //DbgPrint("cck SQ = %d\n", SQ); ++ pPhyInfo->SignalQuality = SQ; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = SQ; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; ++ } ++ } ++ else //is OFDM rate ++ { ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; ++ ++ // ++ // (1)Get RSSI for HT rate ++ // ++ ++ for(i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) ++ { ++ // 2008/01/30 MH we will judge RF RX path now. ++ if (pDM_Odm->RFPathRxEnable & BIT(i)) ++ rf_rx_num++; ++ //else ++ //continue; ++ ++ rx_pwr[i] = ((pPhyStaRpt->path_agc[i].gain& 0x3F)*2) - 110; ++ ++ pPhyInfo->RxPwr[i] = rx_pwr[i]; ++ ++ /* Translate DBM to percentage. */ ++ RSSI = odm_QueryRxPwrPercentage(rx_pwr[i]); ++ total_rssi += RSSI; ++ //RT_DISP(FRX, RX_PHY_SS, ("RF-%d RXPWR=%x RSSI=%d\n", i, rx_pwr[i], RSSI)); ++ ++ //Modification for ext-LNA board ++ if(pDM_Odm->SupportICType&ODM_RTL8192C) ++ { ++ if(pDM_Odm->BoardType & (ODM_BOARD_EXT_LNA | ODM_BOARD_EXT_PA)) ++ { ++ if((pPhyStaRpt->path_agc[i].trsw) == 1) ++ RSSI = (RSSI>94)?100:(RSSI +6); ++ else ++ RSSI = (RSSI<=16)?(RSSI>>3):(RSSI -16); ++ ++ if((RSSI <= 34) && (RSSI >=4)) ++ RSSI -= 4; ++ } ++ } ++ ++ pPhyInfo->RxMIMOSignalStrength[i] =(u1Byte) RSSI; ++ ++ //Get Rx snr value in DB ++ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = (s4Byte)(pPhyStaRpt->path_rxsnr[i]/2); ++ ++ /* Record Signal Strength for next packet */ ++ if(pPktinfo->bPacketMatchBSSID) ++ { ++ if((pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)) ++ { ++ if(i==ODM_RF_PATH_A) ++ pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,i,RSSI); ++ ++ } ++ ++ } ++ } ++ ++ ++ // ++ // (2)PWDB, Average PWDB cacluated by hardware (for rate adaptive) ++ // ++ rx_pwr_all = (((pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all) >> 1 )& 0x7f) -110; ++ ++ PWDB_ALL_BT = PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); ++ ++ pPhyInfo->RxPWDBAll = PWDB_ALL; ++ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL_BT; ++ pPhyInfo->RxPower = rx_pwr_all; ++ pPhyInfo->RecvSignalPower = rx_pwr_all; ++ ++ if((pDM_Odm->SupportPlatform == ODM_WIN) &&(pDM_Odm->PatchID==19)){ ++ //do nothing ++ } ++ else{//pMgntInfo->CustomerID != RT_CID_819x_Lenovo ++ // ++ // (3)EVM of HT rate ++ // ++ if(pPktinfo->DataRate >=DESC92C_RATEMCS8 && pPktinfo->DataRate <=DESC92C_RATEMCS15) ++ Max_spatial_stream = 2; //both spatial stream make sense ++ else ++ Max_spatial_stream = 1; //only spatial stream 1 makes sense ++ ++ for(i=0; i>= 1" because the compilor of free build environment ++ // fill most significant bit to "zero" when doing shifting operation which may change a negative ++ // value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore. ++ EVM = odm_EVMdbToPercentage( (pPhyStaRpt->stream_rxevm[i] )); //dbm ++ ++ //RT_DISP(FRX, RX_PHY_SQ, ("RXRATE=%x RXEVM=%x EVM=%s%d\n", ++ //GET_RX_STATUS_DESC_RX_MCS(pDesc), pDrvInfo->rxevm[i], "%", EVM)); ++ ++ if(pPktinfo->bPacketMatchBSSID) ++ { ++ if(i==ODM_RF_PATH_A) // Fill value in RFD, Get the first spatial stream only ++ { ++ pPhyInfo->SignalQuality = (u1Byte)(EVM & 0xff); ++ } ++ pPhyInfo->RxMIMOSignalQuality[i] = (u1Byte)(EVM & 0xff); ++ } ++ } ++ } ++ ++ //2 For dynamic ATC switch ++ if(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_ATC) ++ { ++ if(pPktinfo->bPacketMatchBSSID) ++ { ++ //3 Update CFO report for path-A & path-B ++ for(i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) ++ { ++ pDM_Odm->CFO_tail[i] = (int)pPhyStaRpt->path_cfotail[i]; ++ } ++ ++ //3 Update packet counter ++ if(pDM_Odm->packetCount == 0xffffffff) ++ pDM_Odm->packetCount = 0; ++ else ++ pDM_Odm->packetCount++; ++ ++ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_ATC, ODM_DBG_LOUD, ++ //("pPhyStaRpt->path_cfotail[i] = 0x%x, pDM_Odm->CFO_tail[i] = 0x%x\n", pPhyStaRpt->path_cfotail[0], pDM_Odm->CFO_tail[1])); ++ } ++ } ++ ++ } ++ //UI BSS List signal strength(in percentage), make it good looking, from 0~100. ++ //It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp(). ++ if(isCCKrate) ++ { ++ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, PWDB_ALL));//PWDB_ALL; ++ } ++ else ++ { ++ if (rf_rx_num != 0) ++ { ++ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, total_rssi/=rf_rx_num)); ++ } ++ } ++ ++ //For 92C/92D HW (Hybrid) Antenna Diversity ++#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) ++ pDM_SWAT_Table->antsel = pPhyStaRpt->ant_sel; ++ //For 88E HW Antenna Diversity ++ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->ant_sel; ++ pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->ant_sel_b; ++ pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antsel_rx_keep_2; ++#endif ++} ++ ++void ++odm_RxPhyStatusJaguarSeries_Parsing( ++ PDM_ODM_T pDM_Odm, ++ PODM_PHY_INFO_T pPhyInfo, ++ pu1Byte pPhyStatus, ++ PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++ u1Byte i, Max_spatial_stream; ++ s1Byte rx_pwr[4], rx_pwr_all=0; ++ u1Byte EVM, EVMdbm, PWDB_ALL = 0, PWDB_ALL_BT; ++ u1Byte RSSI, total_rssi=0; ++ u1Byte isCCKrate=0; ++ u1Byte rf_rx_num = 0; ++ u1Byte cck_highpwr = 0; ++ u1Byte LNA_idx, VGA_idx; ++ ++ PPHY_STATUS_RPT_8812_T pPhyStaRpt = (PPHY_STATUS_RPT_8812_T)pPhyStatus; ++ ++ if(pPktinfo->DataRate <= DESC_RATE54M) ++ { ++ switch(pPhyStaRpt->r_RFMOD){ ++ case 1: ++ if(pPhyStaRpt->sub_chnl == 0) ++ pPhyInfo->BandWidth = 1; ++ else ++ pPhyInfo->BandWidth = 0; ++ break; ++ ++ case 2: ++ if(pPhyStaRpt->sub_chnl == 0) ++ pPhyInfo->BandWidth = 2; ++ else if(pPhyStaRpt->sub_chnl == 9 || pPhyStaRpt->sub_chnl == 10) ++ pPhyInfo->BandWidth = 1; ++ else ++ pPhyInfo->BandWidth = 0; ++ break; ++ ++ default: case 0: ++ pPhyInfo->BandWidth = 0; ++ break; ++ } ++ } ++ ++ if(pPktinfo->DataRate <= DESC_RATE11M) ++ isCCKrate = true; ++ else ++ isCCKrate = false; ++ ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = -1; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; ++ ++ ++ if(isCCKrate) ++ { ++ u1Byte cck_agc_rpt; ++ ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; ++ // ++ // (1)Hardware does not provide RSSI for CCK ++ // (2)PWDB, Average PWDB cacluated by hardware (for rate adaptive) ++ // ++ ++ //if(pHalData->eRFPowerState == eRfOn) ++ cck_highpwr = pDM_Odm->bCckHighPower; ++ //else ++ // cck_highpwr = false; ++ ++ cck_agc_rpt = pPhyStaRpt->cfosho[0] ; ++ ++ LNA_idx = ((cck_agc_rpt & 0xE0) >>5); ++ VGA_idx = (cck_agc_rpt & 0x1F); ++ if(pDM_Odm->SupportICType == ODM_RTL8812) { ++ switch(LNA_idx) { ++ case 7: ++ if(VGA_idx <= 27) ++ rx_pwr_all = -100 + 2*(27-VGA_idx); //VGA_idx = 27~2 ++ else ++ rx_pwr_all = -100; ++ break; ++ case 6: ++ rx_pwr_all = -48 + 2*(2-VGA_idx); //VGA_idx = 2~0 ++ break; ++ case 5: ++ rx_pwr_all = -42 + 2*(7-VGA_idx); //VGA_idx = 7~5 ++ break; ++ case 4: ++ rx_pwr_all = -36 + 2*(7-VGA_idx); //VGA_idx = 7~4 ++ break; ++ case 3: ++ rx_pwr_all = -24 + 2*(7-VGA_idx); //VGA_idx = 7~0 ++ break; ++ case 2: ++ if(cck_highpwr) ++ rx_pwr_all = -12 + 2*(5-VGA_idx); //VGA_idx = 5~0 ++ else ++ rx_pwr_all = -6+ 2*(5-VGA_idx); ++ break; ++ case 1: ++ rx_pwr_all = 8-2*VGA_idx; ++ break; ++ case 0: ++ rx_pwr_all = 14-2*VGA_idx; ++ break; ++ default: ++ break; ++ } ++ rx_pwr_all += 6; ++ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); ++ if(cck_highpwr == false) { ++ if(PWDB_ALL >= 80) ++ PWDB_ALL = ((PWDB_ALL-80)<<1)+((PWDB_ALL-80)>>1)+80; ++ else if((PWDB_ALL <= 78) && (PWDB_ALL >= 20)) ++ PWDB_ALL += 3; ++ if(PWDB_ALL>100) ++ PWDB_ALL = 100; ++ } ++ } else if(pDM_Odm->SupportICType == ODM_RTL8821) { ++ s1Byte Pout = -6; ++ ++ switch(LNA_idx) { ++ case 5: ++ rx_pwr_all = Pout -32 -(2*VGA_idx); ++ break; ++ case 4: ++ rx_pwr_all = Pout -24 -(2*VGA_idx); ++ break; ++ case 2: ++ rx_pwr_all = Pout -11 -(2*VGA_idx); ++ break; ++ case 1: ++ rx_pwr_all = Pout + 5 -(2*VGA_idx); ++ break; ++ case 0: ++ rx_pwr_all = Pout + 21 -(2*VGA_idx); ++ break; ++ } ++ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); ++ } ++ ++ pPhyInfo->RxPWDBAll = PWDB_ALL; ++ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL; ++ pPhyInfo->RecvSignalPower = rx_pwr_all; ++ // ++ // (3) Get Signal Quality (EVM) ++ // ++ if(pPktinfo->bPacketMatchBSSID) { ++ u1Byte SQ,SQ_rpt; ++ ++ if((pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)){ ++ SQ = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,0,0); ++ } else if(pPhyInfo->RxPWDBAll > 40 && !pDM_Odm->bInHctTest){ ++ SQ = 100; ++ } else{ ++ SQ_rpt = pPhyStaRpt->pwdb_all; ++ ++ if(SQ_rpt > 64) ++ SQ = 0; ++ else if (SQ_rpt < 20) ++ SQ = 100; ++ else ++ SQ = ((64-SQ_rpt) * 100) / 44; ++ ++ } ++ ++ pPhyInfo->SignalQuality = SQ; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = SQ; ++ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; ++ } ++ } else { //is OFDM rate ++ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; ++ ++ // ++ // (1)Get RSSI for OFDM rate ++ // ++ ++ for(i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) { ++ // 2008/01/30 MH we will judge RF RX path now. ++ if (pDM_Odm->RFPathRxEnable & BIT(i)) { ++ rf_rx_num++; ++ } ++ rx_pwr[i] = (pPhyStaRpt->gain_trsw[i]&0x7F) - 110; ++ ++ pPhyInfo->RxPwr[i] = rx_pwr[i]; ++ ++ /* Translate DBM to percentage. */ ++ RSSI = odm_QueryRxPwrPercentage(rx_pwr[i]); ++ ++ total_rssi += RSSI; ++ ++ pPhyInfo->RxMIMOSignalStrength[i] =(u1Byte) RSSI; ++ ++ //Get Rx snr value in DB ++ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = pPhyStaRpt->rxsnr[i]/2; ++ ++ // ++ // (2) CFO_short & CFO_tail ++ // ++ pPhyInfo->Cfo_short[i] = odm_Cfo( (pPhyStaRpt->cfosho[i]) ); ++ pPhyInfo->Cfo_tail[i] = odm_Cfo( (pPhyStaRpt->cfotail[i]) ); ++ ++ /* Record Signal Strength for next packet */ ++ if(pPktinfo->bPacketMatchBSSID) { ++ if ((pDM_Odm->SupportPlatform == ODM_WIN) && ++ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)) { ++ if (i==ODM_RF_PATH_A) ++ pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,i,RSSI); ++ ++ } ++ } ++ } ++ ++ ++ // ++ // (3)PWDB, Average PWDB cacluated by hardware (for rate adaptive) ++ // ++ //2012.05.25 LukeLee: Testchip AGC report is wrong, it should be restored back to old formula in MP chip ++ if((pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) && (!pDM_Odm->bIsMPChip)) ++ rx_pwr_all = (pPhyStaRpt->pwdb_all& 0x7f) -110; ++ else ++ rx_pwr_all = (((pPhyStaRpt->pwdb_all) >> 1 )& 0x7f) -110; //OLD FORMULA ++ ++ ++ PWDB_ALL_BT = PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); ++ ++ ++ pPhyInfo->RxPWDBAll = PWDB_ALL; ++ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL_BT; ++ pPhyInfo->RxPower = rx_pwr_all; ++ pPhyInfo->RecvSignalPower = rx_pwr_all; ++ ++ if((pDM_Odm->SupportPlatform == ODM_WIN) &&(pDM_Odm->PatchID==19)){ ++ //do nothing ++ } else{//pMgntInfo->CustomerID != RT_CID_819x_Lenovo ++ // ++ // (4)EVM of OFDM rate ++ // ++ if ((pPktinfo->DataRate>=DESC_RATEMCS8) && ++ (pPktinfo->DataRate <=DESC_RATEMCS15)) ++ Max_spatial_stream = 2; ++ else if ((pPktinfo->DataRate>=DESC_RATEVHTSS2MCS0) && ++ (pPktinfo->DataRate <=DESC_RATEVHTSS2MCS9)) ++ Max_spatial_stream = 2; ++ else ++ Max_spatial_stream = 1; ++ ++ for (i=0; i>= 1" because the compilor of free build environment ++ // fill most significant bit to "zero" when doing shifting operation which may change a negative ++ // value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore. ++ EVM = odm_EVMdbToPercentage( (pPhyStaRpt->rxevm[i] )); //dbm ++ EVMdbm = odm_EVMdbm_JaguarSeries(pPhyStaRpt->rxevm[i]); ++ ++ if(pPktinfo->bPacketMatchBSSID) { ++ if(i==ODM_RF_PATH_A) // Fill value in RFD, Get the first spatial stream only ++ pPhyInfo->SignalQuality = EVM; ++ pPhyInfo->RxMIMOSignalQuality[i] = EVM; ++ pPhyInfo->RxMIMOEVMdbm[i] = EVMdbm; ++ } ++ } ++ } ++ //2 For dynamic ATC switch ++ if(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_ATC) { ++ if(pPktinfo->bPacketMatchBSSID) { ++ //3 Update CFO report for path-A & path-B ++ for(i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) ++ pDM_Odm->CFO_tail[i] = (int)pPhyStaRpt->cfotail[i]; ++ ++ //3 Update packet counter ++ if(pDM_Odm->packetCount == 0xffffffff) ++ pDM_Odm->packetCount = 0; ++ else ++ pDM_Odm->packetCount++; ++ } ++ } ++ } ++ ++ //UI BSS List signal strength(in percentage), make it good looking, from 0~100. ++ //It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp(). ++ if(isCCKrate) { ++ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, PWDB_ALL));//PWDB_ALL; ++ } else { ++ if (rf_rx_num != 0) ++ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, total_rssi/=rf_rx_num)); ++ } ++ pDM_Odm->RxPWDBAve = pDM_Odm->RxPWDBAve + pPhyInfo->RxPWDBAll; ++ ++ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->antidx_anta; ++} ++ ++void ++odm_Init_RSSIForDM( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ ++} ++ ++void ++odm_Process_RSSIForDM( ++ PDM_ODM_T pDM_Odm, ++ PODM_PHY_INFO_T pPhyInfo, ++ PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++ ++ s4Byte UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK, UndecoratedSmoothedOFDM, RSSI_Ave; ++ u1Byte isCCKrate=0; ++ u1Byte RSSI_max, RSSI_min, i; ++ u4Byte OFDM_pkt=0; ++ u4Byte Weighting=0; ++ ++ PSTA_INFO_T pEntry; ++ ++ if(pPktinfo->StationID == 0xFF) ++ return; ++ ++ // ++ // 2012/05/30 MH/Luke.Lee Add some description ++ // In windows driver: AP/IBSS mode STA ++ // ++ //if (pDM_Odm->SupportPlatform == ODM_WIN) ++ //{ ++ // pEntry = pDM_Odm->pODM_StaInfo[pDM_Odm->pAidMap[pPktinfo->StationID-1]]; ++ //} ++ //else ++ pEntry = pDM_Odm->pODM_StaInfo[pPktinfo->StationID]; ++ ++ if(!IS_STA_VALID(pEntry) ){ ++ return; ++ } ++ if((!pPktinfo->bPacketMatchBSSID) ) ++ { ++ return; ++ } ++ ++ if(pPktinfo->bPacketBeacon) ++ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt++; ++ isCCKrate = (pPktinfo->DataRate <= DESC92C_RATE11M)?true :false; ++ pDM_Odm->RxRate = pPktinfo->DataRate; ++ /* ++ if(!isCCKrate) ++ { ++ DbgPrint("OFDM: pPktinfo->StationID=%d, isCCKrate=%d, pPhyInfo->RxPWDBAll=%d\n", ++ pPktinfo->StationID, isCCKrate, pPhyInfo->RxPWDBAll); ++ } ++ */ ++#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) ++ if(pDM_Odm->SupportICType == ODM_RTL8821) ++ { ++ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; ++ if(pPktinfo->bPacketToSelf || pPktinfo->bPacketMatchBSSID) ++ { ++ if(pPktinfo->DataRate > DESC8812_RATE11M) ++ ODM_AntselStatistics_8821A(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, pPhyInfo->RxPWDBAll); ++ } ++ } ++ ++#endif //#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) ++ ++ //-----------------Smart Antenna Debug Message------------------// ++ ++ UndecoratedSmoothedCCK = pEntry->rssi_stat.UndecoratedSmoothedCCK; ++ UndecoratedSmoothedOFDM = pEntry->rssi_stat.UndecoratedSmoothedOFDM; ++ UndecoratedSmoothedPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; ++ ++ if(pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon) ++ { ++ ++ if(!isCCKrate)//ofdm rate ++ { ++ if(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B] == 0){ ++ RSSI_Ave = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; ++ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; ++ pDM_Odm->RSSI_B = 0; ++ } ++ else ++ { ++ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; ++ pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; ++ ++ if(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A] > pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]) ++ { ++ RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; ++ RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; ++ } ++ else ++ { ++ RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; ++ RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; ++ } ++ if((RSSI_max -RSSI_min) < 3) ++ RSSI_Ave = RSSI_max; ++ else if((RSSI_max -RSSI_min) < 6) ++ RSSI_Ave = RSSI_max - 1; ++ else if((RSSI_max -RSSI_min) < 10) ++ RSSI_Ave = RSSI_max - 2; ++ else ++ RSSI_Ave = RSSI_max - 3; ++ } ++ ++ //1 Process OFDM RSSI ++ if(UndecoratedSmoothedOFDM <= 0) // initialize ++ { ++ UndecoratedSmoothedOFDM = pPhyInfo->RxPWDBAll; ++ } ++ else ++ { ++ if(pPhyInfo->RxPWDBAll > (u4Byte)UndecoratedSmoothedOFDM) ++ { ++ UndecoratedSmoothedOFDM = ++ ( ((UndecoratedSmoothedOFDM)*(Rx_Smooth_Factor-1)) + ++ (RSSI_Ave)) /(Rx_Smooth_Factor); ++ UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM + 1; ++ } ++ else ++ { ++ UndecoratedSmoothedOFDM = ++ ( ((UndecoratedSmoothedOFDM)*(Rx_Smooth_Factor-1)) + ++ (RSSI_Ave)) /(Rx_Smooth_Factor); ++ } ++ } ++ ++ pEntry->rssi_stat.PacketMap = (pEntry->rssi_stat.PacketMap<<1) | BIT0; ++ ++ } ++ else ++ { ++ RSSI_Ave = pPhyInfo->RxPWDBAll; ++ pDM_Odm->RSSI_A = (u1Byte) pPhyInfo->RxPWDBAll; ++ pDM_Odm->RSSI_B = 0xFF; ++ ++ //1 Process CCK RSSI ++ if(UndecoratedSmoothedCCK <= 0) // initialize ++ { ++ UndecoratedSmoothedCCK = pPhyInfo->RxPWDBAll; ++ } ++ else ++ { ++ if(pPhyInfo->RxPWDBAll > (u4Byte)UndecoratedSmoothedCCK) ++ { ++ UndecoratedSmoothedCCK = ++ ( ((UndecoratedSmoothedCCK)*(Rx_Smooth_Factor-1)) + ++ (pPhyInfo->RxPWDBAll)) /(Rx_Smooth_Factor); ++ UndecoratedSmoothedCCK = UndecoratedSmoothedCCK + 1; ++ } ++ else ++ { ++ UndecoratedSmoothedCCK = ++ ( ((UndecoratedSmoothedCCK)*(Rx_Smooth_Factor-1)) + ++ (pPhyInfo->RxPWDBAll)) /(Rx_Smooth_Factor); ++ } ++ } ++ pEntry->rssi_stat.PacketMap = pEntry->rssi_stat.PacketMap<<1; ++ } ++ ++ //if(pEntry) ++ { ++ //2011.07.28 LukeLee: modified to prevent unstable CCK RSSI ++ if(pEntry->rssi_stat.ValidBit >= 64) ++ pEntry->rssi_stat.ValidBit = 64; ++ else ++ pEntry->rssi_stat.ValidBit++; ++ ++ for(i=0; irssi_stat.ValidBit; i++) ++ OFDM_pkt += (u1Byte)(pEntry->rssi_stat.PacketMap>>i)&BIT0; ++ ++ if(pEntry->rssi_stat.ValidBit == 64) ++ { ++ Weighting = ((OFDM_pkt<<4) > 64)?64:(OFDM_pkt<<4); ++ UndecoratedSmoothedPWDB = (Weighting*UndecoratedSmoothedOFDM+(64-Weighting)*UndecoratedSmoothedCCK)>>6; ++ } ++ else ++ { ++ if(pEntry->rssi_stat.ValidBit != 0) ++ UndecoratedSmoothedPWDB = (OFDM_pkt*UndecoratedSmoothedOFDM+(pEntry->rssi_stat.ValidBit-OFDM_pkt)*UndecoratedSmoothedCCK)/pEntry->rssi_stat.ValidBit; ++ else ++ UndecoratedSmoothedPWDB = 0; ++ } ++ ++ pEntry->rssi_stat.UndecoratedSmoothedCCK = UndecoratedSmoothedCCK; ++ pEntry->rssi_stat.UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM; ++ pEntry->rssi_stat.UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; ++ ++ //DbgPrint("OFDM_pkt=%d, Weighting=%d\n", OFDM_pkt, Weighting); ++ //DbgPrint("UndecoratedSmoothedOFDM=%d, UndecoratedSmoothedPWDB=%d, UndecoratedSmoothedCCK=%d\n", ++ // UndecoratedSmoothedOFDM, UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK); ++ ++ } ++ ++ } ++} ++ ++ ++// ++// Endianness before calling this API ++// ++void ++ODM_PhyStatusQuery_92CSeries( ++ PDM_ODM_T pDM_Odm, ++ PODM_PHY_INFO_T pPhyInfo, ++ pu1Byte pPhyStatus, ++ PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++ ++ odm_RxPhyStatus92CSeries_Parsing( ++ pDM_Odm, ++ pPhyInfo, ++ pPhyStatus, ++ pPktinfo); ++ ++ if( pDM_Odm->RSSI_test == true) ++ { ++ // Select the packets to do RSSI checking for antenna switching. ++ if(pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon ) ++ { ++ ODM_SwAntDivChkPerPktRssi(pDM_Odm,pPktinfo->StationID,pPhyInfo); ++ } ++ } ++ else ++ { ++ odm_Process_RSSIForDM(pDM_Odm,pPhyInfo,pPktinfo); ++ } ++} ++ ++// ++// Endianness before calling this API ++// ++void ++ODM_PhyStatusQuery_JaguarSeries( ++ PDM_ODM_T pDM_Odm, ++ PODM_PHY_INFO_T pPhyInfo, ++ pu1Byte pPhyStatus, ++ PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++ odm_RxPhyStatusJaguarSeries_Parsing( ++ pDM_Odm, ++ pPhyInfo, ++ pPhyStatus, ++ pPktinfo); ++ ++ odm_Process_RSSIForDM(pDM_Odm,pPhyInfo,pPktinfo); ++} ++ ++void ++ODM_PhyStatusQuery( ++ PDM_ODM_T pDM_Odm, ++ PODM_PHY_INFO_T pPhyInfo, ++ pu1Byte pPhyStatus, ++ PODM_PACKET_INFO_T pPktinfo ++ ) ++{ ++ ++ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES ) ++ { ++ ODM_PhyStatusQuery_JaguarSeries(pDM_Odm,pPhyInfo,pPhyStatus,pPktinfo); ++ } ++ else ++ { ++ ODM_PhyStatusQuery_92CSeries(pDM_Odm,pPhyInfo,pPhyStatus,pPktinfo); ++ } ++} ++ ++// For future use. ++void ++ODM_MacStatusQuery( ++ PDM_ODM_T pDM_Odm, ++ pu1Byte pMacStatus, ++ u1Byte MacID, ++ bool bPacketMatchBSSID, ++ bool bPacketToSelf, ++ bool bPacketBeacon ++ ) ++{ ++ // 2011/10/19 Driver team will handle in the future. ++ ++} ++ ++ ++// ++// If you want to add a new IC, Please follow below template and generate a new one. ++// ++// ++ ++HAL_STATUS ++ODM_ConfigRFWithHeaderFile( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_Config_Type ConfigType, ++ ODM_RF_RADIO_PATH_E eRFPath ++ ) ++{ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("===>ODM_ConfigRFWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", ++ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ { ++ if(ConfigType == CONFIG_RF_RADIO) { ++ if(eRFPath == ODM_RF_PATH_A) ++ { ++ READ_AND_CONFIG(8812A,_RadioA); ++ } ++ else if(eRFPath == ODM_RF_PATH_B) ++ { ++ READ_AND_CONFIG(8812A,_RadioB); ++ } ++ } ++ else if(ConfigType == CONFIG_RF_TXPWR_LMT) { ++ READ_AND_CONFIG(8812A,_TXPWR_LMT); ++ } ++ } ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8821) ++ { ++ if(ConfigType == CONFIG_RF_RADIO) { ++ if(eRFPath == ODM_RF_PATH_A) ++ { ++ READ_AND_CONFIG(8821A,_RadioA); ++ } ++ } ++ else if(ConfigType == CONFIG_RF_TXPWR_LMT) { ++ READ_AND_CONFIG(8821A,_TXPWR_LMT); ++ } ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigRFWithHeaderFile\n")); ++ } ++ return HAL_STATUS_SUCCESS; ++} ++ ++HAL_STATUS ++ODM_ConfigRFWithTxPwrTrackHeaderFile( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("===>ODM_ConfigRFWithTxPwrTrackHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", ++ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); ++ if (pDM_Odm->SupportICType == ODM_RTL8821) ++ { ++ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) ++ READ_AND_CONFIG(8821A,_TxPowerTrack_PCIE); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) ++ READ_AND_CONFIG(8821A,_TxPowerTrack_USB); ++ } ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ { ++ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) ++ READ_AND_CONFIG(8812A,_TxPowerTrack_PCIE); ++ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { ++ if (pDM_Odm->RFEType == 3 && pDM_Odm->bIsMPChip) ++ READ_AND_CONFIG_MP(8812A,_TxPowerTrack_USB_RFE3); ++ else ++ READ_AND_CONFIG(8812A,_TxPowerTrack_USB); ++ } ++ ++ } ++ return HAL_STATUS_SUCCESS; ++} ++ ++HAL_STATUS ++ODM_ConfigBBWithHeaderFile( ++ PDM_ODM_T pDM_Odm, ++ ODM_BB_Config_Type ConfigType ++ ) ++{ ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("===>ODM_ConfigBBWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", ++ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); ++ if(pDM_Odm->SupportICType == ODM_RTL8812) ++ { ++ if(ConfigType == CONFIG_BB_PHY_REG) ++ { ++ READ_AND_CONFIG(8812A,_PHY_REG); ++ } ++ else if(ConfigType == CONFIG_BB_AGC_TAB) ++ { ++ READ_AND_CONFIG(8812A,_AGC_TAB); ++ } ++ else if(ConfigType == CONFIG_BB_PHY_REG_PG) ++ { ++ if (pDM_Odm->RFEType == 3 && pDM_Odm->bIsMPChip) ++ READ_AND_CONFIG_MP(8812A,_PHY_REG_PG_ASUS); ++ else ++ READ_AND_CONFIG(8812A,_PHY_REG_PG); ++ } ++ else if(ConfigType == CONFIG_BB_PHY_REG_MP) ++ { ++ READ_AND_CONFIG_MP(8812A,_PHY_REG_MP); ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8812AGCTABArray\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8812PHY_REGArray\n")); ++ } ++ ++ if(pDM_Odm->SupportICType == ODM_RTL8821) ++ { ++ if(ConfigType == CONFIG_BB_PHY_REG) ++ { ++ READ_AND_CONFIG(8821A,_PHY_REG); ++ } ++ else if(ConfigType == CONFIG_BB_AGC_TAB) ++ { ++ READ_AND_CONFIG(8821A,_AGC_TAB); ++ } ++ else if(ConfigType == CONFIG_BB_PHY_REG_PG) ++ { ++ READ_AND_CONFIG(8821A,_PHY_REG_PG); ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8821AGCTABArray\n")); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8821PHY_REGArray\n")); ++ } ++ return HAL_STATUS_SUCCESS; ++} ++ ++HAL_STATUS ++ODM_ConfigMACWithHeaderFile( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ u1Byte result = HAL_STATUS_SUCCESS; ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("===>ODM_ConfigMACWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ++ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", ++ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); ++ ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ { ++ READ_AND_CONFIG(8812A,_MAC_REG); ++ } ++ if (pDM_Odm->SupportICType == ODM_RTL8821) ++ { ++ READ_AND_CONFIG(8821A,_MAC_REG); ++ ++ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigMACwithHeaderFile\n")); ++ } ++ return result; ++} ++ ++HAL_STATUS ++ODM_ConfigFWWithHeaderFile( ++ PDM_ODM_T pDM_Odm, ++ ODM_FW_Config_Type ConfigType, ++ u1Byte *pFirmware, ++ u4Byte *pSize ++ ) ++{ ++ if (pDM_Odm->SupportICType == ODM_RTL8812) ++ { ++ if (ConfigType == CONFIG_FW_NIC) ++ { ++ READ_FIRMWARE(8812A,_FW_NIC); ++ } ++ else if (ConfigType == CONFIG_FW_WoWLAN) ++ { ++ READ_FIRMWARE(8812A,_FW_WoWLAN); ++ } ++ else if (ConfigType == CONFIG_FW_BT) ++ { ++ READ_FIRMWARE(8812A,_FW_NIC_BT); ++ } ++ } ++ if (pDM_Odm->SupportICType == ODM_RTL8821) ++ { ++ if (ConfigType == CONFIG_FW_NIC) ++ { ++ READ_FIRMWARE(8821A,_FW_NIC); ++ } ++ else if (ConfigType == CONFIG_FW_WoWLAN) ++ { ++ READ_FIRMWARE(8821A,_FW_WoWLAN); ++ } ++ else if (ConfigType == CONFIG_FW_BT) ++ { ++ READ_FIRMWARE(8821A,_FW_BT); ++ } ++ } ++ return HAL_STATUS_SUCCESS; ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_HWConfig.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_HWConfig.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_HWConfig.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_HWConfig.h 2018-02-06 17:42:30.712967194 +0200 +@@ -0,0 +1,294 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++ ++#ifndef __HALHWOUTSRC_H__ ++#define __HALHWOUTSRC_H__ ++ ++//============================================================ ++// C Series Rate ++//============================================================ ++// ++//----------------------------------------------------------- ++// CCK Rates, TxHT = 0 ++#define DESC92C_RATE1M 0x00 ++#define DESC92C_RATE2M 0x01 ++#define DESC92C_RATE5_5M 0x02 ++#define DESC92C_RATE11M 0x03 ++ ++// OFDM Rates, TxHT = 0 ++#define DESC92C_RATE6M 0x04 ++#define DESC92C_RATE9M 0x05 ++#define DESC92C_RATE12M 0x06 ++#define DESC92C_RATE18M 0x07 ++#define DESC92C_RATE24M 0x08 ++#define DESC92C_RATE36M 0x09 ++#define DESC92C_RATE48M 0x0a ++#define DESC92C_RATE54M 0x0b ++ ++// MCS Rates, TxHT = 1 ++#define DESC92C_RATEMCS0 0x0c ++#define DESC92C_RATEMCS1 0x0d ++#define DESC92C_RATEMCS2 0x0e ++#define DESC92C_RATEMCS3 0x0f ++#define DESC92C_RATEMCS4 0x10 ++#define DESC92C_RATEMCS5 0x11 ++#define DESC92C_RATEMCS6 0x12 ++#define DESC92C_RATEMCS7 0x13 ++#define DESC92C_RATEMCS8 0x14 ++#define DESC92C_RATEMCS9 0x15 ++#define DESC92C_RATEMCS10 0x16 ++#define DESC92C_RATEMCS11 0x17 ++#define DESC92C_RATEMCS12 0x18 ++#define DESC92C_RATEMCS13 0x19 ++#define DESC92C_RATEMCS14 0x1a ++#define DESC92C_RATEMCS15 0x1b ++#define DESC92C_RATEMCS15_SG 0x1c ++#define DESC92C_RATEMCS32 0x20 ++ ++ ++/*--------------------------Define -------------------------------------------*/ ++/* BIT 7 HT Rate*/ ++// TxHT = 0 ++#define MGN_1M 0x02 ++#define MGN_2M 0x04 ++#define MGN_5_5M 0x0b ++#define MGN_11M 0x16 ++ ++#define MGN_6M 0x0c ++#define MGN_9M 0x12 ++#define MGN_12M 0x18 ++#define MGN_18M 0x24 ++#define MGN_24M 0x30 ++#define MGN_36M 0x48 ++#define MGN_48M 0x60 ++#define MGN_54M 0x6c ++ ++// TxHT = 1 ++#define MGN_MCS0 0x80 ++#define MGN_MCS1 0x81 ++#define MGN_MCS2 0x82 ++#define MGN_MCS3 0x83 ++#define MGN_MCS4 0x84 ++#define MGN_MCS5 0x85 ++#define MGN_MCS6 0x86 ++#define MGN_MCS7 0x87 ++#define MGN_MCS8 0x88 ++#define MGN_MCS9 0x89 ++#define MGN_MCS10 0x8a ++#define MGN_MCS11 0x8b ++#define MGN_MCS12 0x8c ++#define MGN_MCS13 0x8d ++#define MGN_MCS14 0x8e ++#define MGN_MCS15 0x8f ++#define MGN_VHT1SS_MCS0 0x90 ++#define MGN_VHT1SS_MCS1 0x91 ++#define MGN_VHT1SS_MCS2 0x92 ++#define MGN_VHT1SS_MCS3 0x93 ++#define MGN_VHT1SS_MCS4 0x94 ++#define MGN_VHT1SS_MCS5 0x95 ++#define MGN_VHT1SS_MCS6 0x96 ++#define MGN_VHT1SS_MCS7 0x97 ++#define MGN_VHT1SS_MCS8 0x98 ++#define MGN_VHT1SS_MCS9 0x99 ++#define MGN_VHT2SS_MCS0 0x9a ++#define MGN_VHT2SS_MCS1 0x9b ++#define MGN_VHT2SS_MCS2 0x9c ++#define MGN_VHT2SS_MCS3 0x9d ++#define MGN_VHT2SS_MCS4 0x9e ++#define MGN_VHT2SS_MCS5 0x9f ++#define MGN_VHT2SS_MCS6 0xa0 ++#define MGN_VHT2SS_MCS7 0xa1 ++#define MGN_VHT2SS_MCS8 0xa2 ++#define MGN_VHT2SS_MCS9 0xa3 ++ ++#define MGN_MCS0_SG 0xc0 ++#define MGN_MCS1_SG 0xc1 ++#define MGN_MCS2_SG 0xc2 ++#define MGN_MCS3_SG 0xc3 ++#define MGN_MCS4_SG 0xc4 ++#define MGN_MCS5_SG 0xc5 ++#define MGN_MCS6_SG 0xc6 ++#define MGN_MCS7_SG 0xc7 ++#define MGN_MCS8_SG 0xc8 ++#define MGN_MCS9_SG 0xc9 ++#define MGN_MCS10_SG 0xca ++#define MGN_MCS11_SG 0xcb ++#define MGN_MCS12_SG 0xcc ++#define MGN_MCS13_SG 0xcd ++#define MGN_MCS14_SG 0xce ++#define MGN_MCS15_SG 0xcf ++ ++#define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) ++#define AGC_DIFF_CONFIG_MP(ic, band) (ODM_ReadAndConfig_MP_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_MP_##ic##_AGC_TAB_DIFF_##band, \ ++ sizeof(Array_MP_##ic##_AGC_TAB_DIFF_##band)/sizeof(u4Byte))) ++#define AGC_DIFF_CONFIG_TC(ic, band) (ODM_ReadAndConfig_TC_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_TC_##ic##_AGC_TAB_DIFF_##band, \ ++ sizeof(Array_TC_##ic##_AGC_TAB_DIFF_##band)/sizeof(u4Byte))) ++ ++#define AGC_DIFF_CONFIG(ic, band) do {\ ++ if (pDM_Odm->bIsMPChip)\ ++ AGC_DIFF_CONFIG_MP(ic,band);\ ++ else\ ++ AGC_DIFF_CONFIG_TC(ic,band);\ ++ } while(0) ++ ++ ++//============================================================ ++// structure and define ++//============================================================ ++ ++typedef struct _Phy_Rx_AGC_Info ++{ ++ #ifdef __LITTLE_ENDIAN ++ u1Byte gain:7,trsw:1; ++ #else ++ u1Byte trsw:1,gain:7; ++ #endif ++} PHY_RX_AGC_INFO_T,*pPHY_RX_AGC_INFO_T; ++ ++typedef struct _Phy_Status_Rpt_8192cd ++{ ++ PHY_RX_AGC_INFO_T path_agc[2]; ++ u1Byte ch_corr[2]; ++ u1Byte cck_sig_qual_ofdm_pwdb_all; ++ u1Byte cck_agc_rpt_ofdm_cfosho_a; ++ u1Byte cck_rpt_b_ofdm_cfosho_b; ++ u1Byte rsvd_1;//ch_corr_msb; ++ u1Byte noise_power_db_msb; ++ s1Byte path_cfotail[2]; ++ u1Byte pcts_mask[2]; ++ s1Byte stream_rxevm[2]; ++ u1Byte path_rxsnr[2]; ++ u1Byte noise_power_db_lsb; ++ u1Byte rsvd_2[3]; ++ u1Byte stream_csi[2]; ++ u1Byte stream_target_csi[2]; ++ s1Byte sig_evm; ++ u1Byte rsvd_3; ++ ++#ifdef __LITTLE_ENDIAN ++ u1Byte antsel_rx_keep_2:1; //ex_intf_flg:1; ++ u1Byte sgi_en:1; ++ u1Byte rxsc:2; ++ u1Byte idle_long:1; ++ u1Byte r_ant_train_en:1; ++ u1Byte ant_sel_b:1; ++ u1Byte ant_sel:1; ++#else // __BIG_ENDIAN ++ u1Byte ant_sel:1; ++ u1Byte ant_sel_b:1; ++ u1Byte r_ant_train_en:1; ++ u1Byte idle_long:1; ++ u1Byte rxsc:2; ++ u1Byte sgi_en:1; ++ u1Byte antsel_rx_keep_2:1; //ex_intf_flg:1; ++#endif ++} PHY_STATUS_RPT_8192CD_T,*PPHY_STATUS_RPT_8192CD_T; ++ ++ ++typedef struct _Phy_Status_Rpt_8812 ++{ ++ //2012.05.24 LukeLee: This structure should take big/little endian in consideration later..... ++ ++ //DWORD 0 ++ u1Byte gain_trsw[2]; ++ u2Byte chl_num:10; ++ u2Byte sub_chnl:4; ++ u2Byte r_RFMOD:2; ++ ++ //DWORD 1 ++ u1Byte pwdb_all; ++ u1Byte cfosho[4]; // DW 1 byte 1 DW 2 byte 0 ++ ++ //DWORD 2 ++ s1Byte cfotail[4]; // DW 2 byte 1 DW 3 byte 0 ++ ++ //DWORD 3 ++ s1Byte rxevm[2]; // DW 3 byte 1 DW 3 byte 2 ++ s1Byte rxsnr[2]; // DW 3 byte 3 DW 4 byte 0 ++ ++ //DWORD 4 ++ u1Byte PCTS_MSK_RPT[2]; ++ u1Byte pdsnr[2]; // DW 4 byte 3 DW 5 Byte 0 ++ ++ //DWORD 5 ++ u1Byte csi_current[2]; ++ u1Byte rx_gain_c; ++ ++ //DWORD 6 ++ u1Byte rx_gain_d; ++ u1Byte sigevm; ++ u1Byte resvd_0; ++ u1Byte antidx_anta:3; ++ u1Byte antidx_antb:3; ++ u1Byte resvd_1:2; ++} PHY_STATUS_RPT_8812_T,*PPHY_STATUS_RPT_8812_T; ++ ++ ++void ++odm_Init_RSSIForDM( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++void ++ODM_PhyStatusQuery( ++ PDM_ODM_T pDM_Odm, ++ PODM_PHY_INFO_T pPhyInfo, ++ pu1Byte pPhyStatus, ++ PODM_PACKET_INFO_T pPktinfo ++ ); ++ ++void ++ODM_MacStatusQuery( ++ PDM_ODM_T pDM_Odm, ++ pu1Byte pMacStatus, ++ u1Byte MacID, ++ bool bPacketMatchBSSID, ++ bool bPacketToSelf, ++ bool bPacketBeacon ++ ); ++ ++HAL_STATUS ++ODM_ConfigRFWithTxPwrTrackHeaderFile( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++HAL_STATUS ++ODM_ConfigRFWithHeaderFile( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_Config_Type ConfigType, ++ ODM_RF_RADIO_PATH_E eRFPath ++ ); ++ ++HAL_STATUS ++ODM_ConfigBBWithHeaderFile( ++ PDM_ODM_T pDM_Odm, ++ ODM_BB_Config_Type ConfigType ++ ); ++ ++HAL_STATUS ++ODM_ConfigMACWithHeaderFile( ++ PDM_ODM_T pDM_Odm ++ ); ++ ++HAL_STATUS ++ODM_ConfigFWWithHeaderFile( ++ PDM_ODM_T pDM_Odm, ++ ODM_FW_Config_Type ConfigType, ++ u1Byte *pFirmware, ++ u4Byte *pSize ++ ); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_interface.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_interface.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_interface.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_interface.c 2018-02-06 17:42:30.713967209 +0200 +@@ -0,0 +1,384 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++//============================================================ ++// include files ++//============================================================ ++ ++#include "odm_precomp.h" ++// ++// ODM IO Relative API. ++// ++ ++u1Byte ++ODM_Read1Byte( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ return rtw_read8(Adapter,RegAddr); ++} ++ ++ ++u2Byte ++ODM_Read2Byte( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ return rtw_read16(Adapter,RegAddr); ++} ++ ++u4Byte ++ODM_Read4Byte( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ return rtw_read32(Adapter,RegAddr); ++} ++ ++ ++void ++ODM_Write1Byte( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u1Byte Data ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ rtw_write8(Adapter,RegAddr, Data); ++} ++ ++ ++void ++ODM_Write2Byte( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u2Byte Data ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ rtw_write16(Adapter,RegAddr, Data); ++} ++ ++ ++void ++ODM_Write4Byte( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u4Byte Data ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ rtw_write32(Adapter,RegAddr, Data); ++} ++ ++void ++ODM_SetMACReg( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u4Byte BitMask, ++ u4Byte Data ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ PHY_SetBBReg(Adapter, RegAddr, BitMask, Data); ++} ++ ++u4Byte ++ODM_GetMACReg( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u4Byte BitMask ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ return PHY_QueryBBReg(Adapter, RegAddr, BitMask); ++} ++ ++void ++ODM_SetBBReg( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u4Byte BitMask, ++ u4Byte Data ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ PHY_SetBBReg(Adapter, RegAddr, BitMask, Data); ++} ++ ++u4Byte ++ODM_GetBBReg( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u4Byte BitMask ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ return PHY_QueryBBReg(Adapter, RegAddr, BitMask); ++} ++ ++ ++void ++ODM_SetRFReg( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_RADIO_PATH_E eRFPath, ++ u4Byte RegAddr, ++ u4Byte BitMask, ++ u4Byte Data ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ PHY_SetRFReg(Adapter, eRFPath, RegAddr, BitMask, Data); ++} ++ ++ ++u4Byte ++ODM_GetRFReg( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_RADIO_PATH_E eRFPath, ++ u4Byte RegAddr, ++ u4Byte BitMask ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ return PHY_QueryRFReg(Adapter, eRFPath, RegAddr, BitMask); ++} ++ ++// ++// ODM Memory relative API. ++// ++void ++ODM_AllocateMemory( ++ PDM_ODM_T pDM_Odm, ++ void * *pPtr, ++ u4Byte length ++ ) ++{ ++ *pPtr = rtw_zvmalloc(length); ++} ++ ++// length could be ignored, used to detect memory leakage. ++void ++ODM_FreeMemory( ++ PDM_ODM_T pDM_Odm, ++ void * pPtr, ++ u4Byte length ++ ) ++{ ++ rtw_vmfree(pPtr, length); ++} ++ ++void ++ODM_MoveMemory( ++ PDM_ODM_T pDM_Odm, ++ void * pDest, ++ const void * pSrc, ++ u4Byte Length ++ ) ++{ ++ _rtw_memcpy(pDest, (void *)pSrc, Length); ++} ++ ++s4Byte ODM_CompareMemory( ++ PDM_ODM_T pDM_Odm, ++ void * pBuf1, ++ void * pBuf2, ++ u4Byte length ++ ) ++{ ++ return _rtw_memcmp(pBuf1,pBuf2,length); ++} ++ ++// ++// ODM MISC relative API. ++// ++void ++ODM_AcquireSpinLock( ++ PDM_ODM_T pDM_Odm, ++ RT_SPINLOCK_TYPE type ++ ) ++{ ++} ++ ++void ++ODM_ReleaseSpinLock( ++ PDM_ODM_T pDM_Odm, ++ RT_SPINLOCK_TYPE type ++ ) ++{ ++} ++ ++// ++// Work item relative API. FOr MP driver only~! ++// ++void ++ODM_InitializeWorkItem( ++ PDM_ODM_T pDM_Odm, ++ PRT_WORK_ITEM pRtWorkItem, ++ RT_WORKITEM_CALL_BACK RtWorkItemCallback, ++ void * pContext, ++ const char* szID ++ ) ++{ ++} ++ ++void ++ODM_StartWorkItem( ++ PRT_WORK_ITEM pRtWorkItem ++ ) ++{ ++} ++ ++ ++void ++ODM_StopWorkItem( ++ PRT_WORK_ITEM pRtWorkItem ++ ) ++{ ++} ++ ++void ++ODM_FreeWorkItem( ++ PRT_WORK_ITEM pRtWorkItem ++ ) ++{ ++} ++ ++void ++ODM_ScheduleWorkItem( ++ PRT_WORK_ITEM pRtWorkItem ++ ) ++{ ++} ++ ++void ++ODM_IsWorkItemScheduled( ++ PRT_WORK_ITEM pRtWorkItem ++ ) ++{ ++} ++ ++// ++// ODM Timer relative API. ++// ++void ++ODM_StallExecution( ++ u4Byte usDelay ++ ) ++{ ++ rtw_udelay_os(usDelay); ++} ++ ++void ++ODM_delay_ms(u4Byte ms) ++{ ++ rtw_mdelay_os(ms); ++} ++ ++void ++ODM_delay_us(u4Byte us) ++{ ++ rtw_udelay_os(us); ++} ++ ++void ++ODM_sleep_ms(u4Byte ms) ++{ ++ rtw_msleep_os(ms); ++} ++ ++void ++ODM_sleep_us(u4Byte us) ++{ ++ rtw_usleep_os(us); ++} ++ ++void ++ODM_SetTimer( ++ PDM_ODM_T pDM_Odm, ++ PRT_TIMER pTimer, ++ u4Byte msDelay ++ ) ++{ ++ _set_timer(pTimer,msDelay ); //ms ++} ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++void ++ODM_InitializeTimer( ++ PDM_ODM_T pDM_Odm, ++ PRT_TIMER pTimer, ++ RT_TIMER_CALL_BACK CallBackFunc, ++ void * pContext, ++ const char* szID ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ ++ _init_timer(pTimer,Adapter->pnetdev,CallBackFunc,pDM_Odm); ++} ++#endif ++ ++void ++ODM_CancelTimer( ++ PDM_ODM_T pDM_Odm, ++ PRT_TIMER pTimer ++ ) ++{ ++ _cancel_timer_ex(pTimer); ++} ++ ++void ++ODM_ReleaseTimer( ++ PDM_ODM_T pDM_Odm, ++ PRT_TIMER pTimer ++ ) ++{ ++} ++ ++// ++// ODM FW relative API. ++// ++u4Byte ++ODM_FillH2CCmd( ++ pu1Byte pH2CBuffer, ++ u4Byte H2CBufferLen, ++ u4Byte CmdNum, ++ pu4Byte pElementID, ++ pu4Byte pCmdLen, ++ pu1Byte* pCmbBuffer, ++ pu1Byte CmdStartSeq ++ ) ++{ ++ return true; ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_interface.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_interface.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_interface.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_interface.h 2018-02-06 17:42:30.713967209 +0200 +@@ -0,0 +1,315 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++ ++#ifndef __ODM_INTERFACE_H__ ++#define __ODM_INTERFACE_H__ ++ ++ ++ ++// ++// =========== Constant/Structure/Enum/... Define ++// ++ ++ ++ ++// ++// =========== Macro Define ++// ++ ++#define _reg_all(_name) ODM_##_name ++#define _reg_ic(_name, _ic) ODM_##_name##_ic ++#define _bit_all(_name) BIT_##_name ++#define _bit_ic(_name, _ic) BIT_##_name##_ic ++ ++ ++#define _reg_11N(_name) ODM_REG_##_name##_11N ++#define _reg_11AC(_name) ODM_REG_##_name##_11AC ++#define _bit_11N(_name) ODM_BIT_##_name##_11N ++#define _bit_11AC(_name) ODM_BIT_##_name##_11AC ++ ++#define _cat(_name, _ic_type, _func) \ ++ ( \ ++ ((_ic_type) & ODM_IC_11N_SERIES)? _func##_11N(_name): \ ++ _func##_11AC(_name) \ ++ ) ++ ++// _name: name of register or bit. ++// Example: "ODM_REG(R_A_AGC_CORE1, pDM_Odm)" ++// gets "ODM_R_A_AGC_CORE1" or "ODM_R_A_AGC_CORE1_8192C", depends on SupportICType. ++#define ODM_REG(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _reg) ++#define ODM_BIT(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _bit) ++ ++typedef enum _ODM_H2C_CMD ++{ ++ ODM_H2C_RSSI_REPORT = 0, ++ ODM_H2C_PSD_RESULT=1, ++ ODM_H2C_PathDiv = 2, ++ ODM_MAX_H2CCMD ++}ODM_H2C_CMD; ++ ++ ++// ++// 2012/02/17 MH For non-MP compile pass only. Linux does not support workitem. ++// Suggest HW team to use thread instead of workitem. Windows also support the feature. ++// ++typedef void *PRT_WORK_ITEM ; ++typedef void RT_WORKITEM_HANDLE,*PRT_WORKITEM_HANDLE; ++typedef void (*RT_WORKITEM_CALL_BACK)(void * pContext); ++ ++// ++// =========== Extern Variable ??? It should be forbidden. ++// ++ ++ ++// ++// =========== EXtern Function Prototype ++// ++ ++ ++u1Byte ++ODM_Read1Byte( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr ++ ); ++ ++u2Byte ++ODM_Read2Byte( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr ++ ); ++ ++u4Byte ++ODM_Read4Byte( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr ++ ); ++ ++void ++ODM_Write1Byte( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u1Byte Data ++ ); ++ ++void ++ODM_Write2Byte( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u2Byte Data ++ ); ++ ++void ++ODM_Write4Byte( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u4Byte Data ++ ); ++ ++void ++ODM_SetMACReg( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u4Byte BitMask, ++ u4Byte Data ++ ); ++ ++u4Byte ++ODM_GetMACReg( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u4Byte BitMask ++ ); ++ ++void ++ODM_SetBBReg( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u4Byte BitMask, ++ u4Byte Data ++ ); ++ ++u4Byte ++ODM_GetBBReg( ++ PDM_ODM_T pDM_Odm, ++ u4Byte RegAddr, ++ u4Byte BitMask ++ ); ++ ++void ++ODM_SetRFReg( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_RADIO_PATH_E eRFPath, ++ u4Byte RegAddr, ++ u4Byte BitMask, ++ u4Byte Data ++ ); ++ ++u4Byte ++ODM_GetRFReg( ++ PDM_ODM_T pDM_Odm, ++ ODM_RF_RADIO_PATH_E eRFPath, ++ u4Byte RegAddr, ++ u4Byte BitMask ++ ); ++ ++// ++// Memory Relative Function. ++// ++void ++ODM_AllocateMemory( ++ PDM_ODM_T pDM_Odm, ++ void * *pPtr, ++ u4Byte length ++ ); ++void ++ODM_FreeMemory( ++ PDM_ODM_T pDM_Odm, ++ void * pPtr, ++ u4Byte length ++ ); ++ ++void ++ODM_MoveMemory( ++ PDM_ODM_T pDM_Odm, ++ void * pDest, ++ const void * pSrc, ++ u4Byte Length ++ ); ++ ++s4Byte ODM_CompareMemory( ++ PDM_ODM_T pDM_Odm, ++ void * pBuf1, ++ void * pBuf2, ++ u4Byte length ++ ); ++ ++// ++// ODM MISC-spin lock relative API. ++// ++void ++ODM_AcquireSpinLock( ++ PDM_ODM_T pDM_Odm, ++ RT_SPINLOCK_TYPE type ++ ); ++ ++void ++ODM_ReleaseSpinLock( ++ PDM_ODM_T pDM_Odm, ++ RT_SPINLOCK_TYPE type ++ ); ++ ++ ++// ++// ODM MISC-workitem relative API. ++// ++void ++ODM_InitializeWorkItem( ++ PDM_ODM_T pDM_Odm, ++ PRT_WORK_ITEM pRtWorkItem, ++ RT_WORKITEM_CALL_BACK RtWorkItemCallback, ++ void * pContext, ++ const char* szID ++ ); ++ ++void ++ODM_StartWorkItem( ++ PRT_WORK_ITEM pRtWorkItem ++ ); ++ ++void ++ODM_StopWorkItem( ++ PRT_WORK_ITEM pRtWorkItem ++ ); ++ ++void ++ODM_FreeWorkItem( ++ PRT_WORK_ITEM pRtWorkItem ++ ); ++ ++void ++ODM_ScheduleWorkItem( ++ PRT_WORK_ITEM pRtWorkItem ++ ); ++ ++void ++ODM_IsWorkItemScheduled( ++ PRT_WORK_ITEM pRtWorkItem ++ ); ++ ++// ++// ODM Timer relative API. ++// ++void ++ODM_StallExecution( ++ u4Byte usDelay ++ ); ++ ++void ++ODM_delay_ms(u4Byte ms); ++ ++ ++void ++ODM_delay_us(u4Byte us); ++ ++void ++ODM_sleep_ms(u4Byte ms); ++ ++void ++ODM_sleep_us(u4Byte us); ++ ++void ++ODM_SetTimer( ++ PDM_ODM_T pDM_Odm, ++ PRT_TIMER pTimer, ++ u4Byte msDelay ++ ); ++ ++void ++ODM_InitializeTimer( ++ PDM_ODM_T pDM_Odm, ++ PRT_TIMER pTimer, ++ RT_TIMER_CALL_BACK CallBackFunc, ++ void * pContext, ++ const char* szID ++ ); ++ ++void ++ODM_CancelTimer( ++ PDM_ODM_T pDM_Odm, ++ PRT_TIMER pTimer ++ ); ++ ++void ++ODM_ReleaseTimer( ++ PDM_ODM_T pDM_Odm, ++ PRT_TIMER pTimer ++ ); ++ ++// ++// ODM FW relative API. ++// ++u4Byte ++ODM_FillH2CCmd( ++ pu1Byte pH2CBuffer, ++ u4Byte H2CBufferLen, ++ u4Byte CmdNum, ++ pu4Byte pElementID, ++ pu4Byte pCmdLen, ++ pu1Byte* pCmbBuffer, ++ pu1Byte CmdStartSeq ++ ); ++ ++#endif // __ODM_INTERFACE_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_precomp.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_precomp.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_precomp.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_precomp.h 2018-02-06 17:42:30.713967209 +0200 +@@ -0,0 +1,74 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++#ifndef __ODM_PRECOMP_H__ ++#define __ODM_PRECOMP_H__ ++ ++#include "odm_types.h" ++ ++#define TEST_FALG___ 1 ++ ++#define BEAMFORMING_SUPPORT 0 ++ ++//2 Hardware Parameter Files ++ ++//2 OutSrc Header Files ++ ++#include "odm.h" ++#include "odm_HWConfig.h" ++#include "odm_debug.h" ++#include "odm_RegDefine11AC.h" ++#include "odm_RegDefine11N.h" ++ ++#include "HalPhyRf.h" ++#include "HalPhyRf_8812A.h"//for IQK,LCK,Power-tracking ++#include "rtl8812a_hal.h" ++ ++#include "HalPhyRf_8821A.h"//for IQK,LCK,Power-tracking ++#include "HalPhyRf_8812A.h"//for IQK,LCK,Power-tracking ++#include "rtl8812a_hal.h" ++ ++#include "odm_interface.h" ++#include "odm_reg.h" ++ ++#if (TEST_CHIP_SUPPORT == 1) ++#include "rtl8188e/HalHWImg8188E_TestChip_MAC.h" ++#include "rtl8188e/HalHWImg8188E_TestChip_RF.h" ++#include "rtl8188e/HalHWImg8188E_TestChip_BB.h" ++#endif ++ ++#include "HalHWImg8812A_MAC.h" ++#include "HalHWImg8812A_RF.h" ++#include "HalHWImg8812A_BB.h" ++#include "HalHWImg8812A_FW.h" ++#include "odm_RegConfig8812A.h" ++#if (TEST_CHIP_SUPPORT == 1) ++#include "HalHWImg8812A_TestChip_MAC.h" ++#include "HalHWImg8812A_TestChip_RF.h" ++#include "HalHWImg8812A_TestChip_BB.h" ++#endif ++ ++#include "HalHWImg8821A_MAC.h" ++#include "HalHWImg8821A_RF.h" ++#include "HalHWImg8821A_BB.h" ++#include "HalHWImg8821A_FW.h" ++#include "odm_RegConfig8821A.h" ++#if (TEST_CHIP_SUPPORT == 1) ++#include "HalHWImg8821A_TestChip_MAC.h" ++#include "HalHWImg8821A_TestChip_RF.h" ++#include "HalHWImg8821A_TestChip_BB.h" ++#endif ++ ++#endif // __ODM_PRECOMP_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8812A.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8812A.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8812A.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8812A.c 2018-02-06 17:42:30.712967194 +0200 +@@ -0,0 +1,177 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++#include "odm_precomp.h" ++ ++void ++odm_ConfigRFReg_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Data, ++ ODM_RF_RADIO_PATH_E RF_PATH, ++ u4Byte RegAddr ++ ) ++{ ++ if(Addr == 0xfe || Addr == 0xffe) ++ { ++ #ifdef CONFIG_LONG_DELAY_ISSUE ++ ODM_sleep_ms(50); ++ #else ++ ODM_delay_ms(50); ++ #endif ++ } ++ else ++ { ++ ODM_SetRFReg(pDM_Odm, RF_PATH, RegAddr, bRFRegOffsetMask, Data); ++ // Add 1us delay between BB/RF register setting. ++ ODM_delay_us(1); ++ } ++} ++ ++ ++void ++odm_ConfigRF_RadioA_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Data ++ ) ++{ ++ u4Byte content = 0x1000; // RF_Content: radioa_txt ++ u4Byte maskforPhySet= (u4Byte)(content&0xE000); ++ ++ odm_ConfigRFReg_8812A(pDM_Odm, Addr, Data, ODM_RF_PATH_A, Addr|maskforPhySet); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioA] %08X %08X\n", Addr, Data)); ++} ++ ++void ++odm_ConfigRF_RadioB_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Data ++ ) ++{ ++ u4Byte content = 0x1001; // RF_Content: radiob_txt ++ u4Byte maskforPhySet= (u4Byte)(content&0xE000); ++ ++ odm_ConfigRFReg_8812A(pDM_Odm, Addr, Data, ODM_RF_PATH_B, Addr|maskforPhySet); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioB] %08X %08X\n", Addr, Data)); ++ ++} ++ ++void ++odm_ConfigMAC_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u1Byte Data ++ ) ++{ ++ ODM_Write1Byte(pDM_Odm, Addr, Data); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigMACWithHeaderFile: [MAC_REG] %08X %08X\n", Addr, Data)); ++} ++ ++void ++odm_ConfigBB_AGC_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Bitmask, ++ u4Byte Data ++ ) ++{ ++ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); ++ // Add 1us delay between BB/RF register setting. ++ ODM_delay_us(1); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [AGC_TAB] %08X %08X\n", Addr, Data)); ++} ++ ++void ++odm_ConfigBB_PHY_REG_PG_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Bitmask, ++ u4Byte Data ++ ) ++{ ++ if (Addr == 0xfe || Addr == 0xffe) { ++ #ifdef CONFIG_LONG_DELAY_ISSUE ++ ODM_sleep_ms(50); ++ #else ++ ODM_delay_ms(50); ++ #endif ++ } ++ else ++ { ++ storePwrIndexDiffRateOffset(pDM_Odm->Adapter, Addr, Bitmask, Data); ++ } ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X %08X\n", Addr, Bitmask, Data)); ++} ++ ++void ++odm_ConfigBB_PHY_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Bitmask, ++ u4Byte Data ++ ) ++{ ++ if (Addr == 0xfe) { ++ #ifdef CONFIG_LONG_DELAY_ISSUE ++ ODM_sleep_ms(50); ++ #else ++ ODM_delay_ms(50); ++ #endif ++ } ++ else if (Addr == 0xfd) { ++ ODM_delay_ms(5); ++ } ++ else if (Addr == 0xfc) { ++ ODM_delay_ms(1); ++ } ++ else if (Addr == 0xfb) { ++ ODM_delay_us(50); ++ } ++ else if (Addr == 0xfa) { ++ ODM_delay_us(5); ++ } ++ else if (Addr == 0xf9) { ++ ODM_delay_us(1); ++ } ++ else ++ { ++ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); ++ // Add 1us delay between BB/RF register setting. ++ ODM_delay_us(1); ++ } ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X\n", Addr, Data)); ++} ++ ++void ++odm_ConfigBB_TXPWR_LMT_8812A( ++ PDM_ODM_T pDM_Odm, ++ const pu1Byte Regulation, ++ const pu1Byte Band, ++ const pu1Byte Bandwidth, ++ const pu1Byte RateSection, ++ const pu1Byte RfPath, ++ const pu1Byte Channel, ++ const pu1Byte PowerLimit ++ ) ++{ ++ PHY_SetPowerLimitTableValue(pDM_Odm, Regulation, Band, ++ Bandwidth, RateSection, RfPath, Channel, PowerLimit); ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8812A.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8812A.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8812A.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8812A.h 2018-02-06 17:42:30.712967194 +0200 +@@ -0,0 +1,84 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++#ifndef __INC_ODM_REGCONFIG_H_8812A ++#define __INC_ODM_REGCONFIG_H_8812A ++ ++void ++odm_ConfigRFReg_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Data, ++ ODM_RF_RADIO_PATH_E RF_PATH, ++ u4Byte RegAddr ++ ); ++ ++void ++odm_ConfigRF_RadioA_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Data ++ ); ++ ++void ++odm_ConfigRF_RadioB_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Data ++ ); ++ ++void ++odm_ConfigMAC_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u1Byte Data ++ ); ++ ++void ++odm_ConfigBB_AGC_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Bitmask, ++ u4Byte Data ++ ); ++ ++void ++odm_ConfigBB_PHY_REG_PG_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Bitmask, ++ u4Byte Data ++ ); ++ ++void ++odm_ConfigBB_PHY_8812A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Bitmask, ++ u4Byte Data ++ ); ++ ++void ++odm_ConfigBB_TXPWR_LMT_8812A( ++ PDM_ODM_T pDM_Odm, ++ const pu1Byte Regulation, ++ const pu1Byte Band, ++ const pu1Byte Bandwidth, ++ const pu1Byte RateSection, ++ const pu1Byte RfPath, ++ const pu1Byte Channel, ++ const pu1Byte PowerLimit ++ ); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8821A.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8821A.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8821A.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8821A.c 2018-02-06 17:42:30.712967194 +0200 +@@ -0,0 +1,201 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++#include "odm_precomp.h" ++ ++void ++odm_ConfigRFReg_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Data, ++ ODM_RF_RADIO_PATH_E RF_PATH, ++ u4Byte RegAddr ++ ) ++{ ++ if(Addr == 0xfe || Addr == 0xffe) ++ { ++ #ifdef CONFIG_LONG_DELAY_ISSUE ++ ODM_sleep_ms(50); ++ #else ++ ODM_delay_ms(50); ++ #endif ++ } ++ else if (Addr == 0xfd) ++ { ++ ODM_delay_ms(5); ++ } ++ else if (Addr == 0xfc) ++ { ++ ODM_delay_ms(1); ++ } ++ else if (Addr == 0xfb) ++ { ++ ODM_delay_us(50); ++ } ++ else if (Addr == 0xfa) ++ { ++ ODM_delay_us(5); ++ } ++ else if (Addr == 0xf9) ++ { ++ ODM_delay_us(1); ++ } ++ else ++ { ++ ODM_SetRFReg(pDM_Odm, RF_PATH, RegAddr, bRFRegOffsetMask, Data); ++ // Add 1us delay between BB/RF register setting. ++ ODM_delay_us(1); ++ } ++} ++ ++ ++void ++odm_ConfigRF_RadioA_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Data ++ ) ++{ ++ u4Byte content = 0x1000; // RF_Content: radioa_txt ++ u4Byte maskforPhySet= (u4Byte)(content&0xE000); ++ ++ odm_ConfigRFReg_8821A(pDM_Odm, Addr, Data, ODM_RF_PATH_A, Addr|maskforPhySet); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioA] %08X %08X\n", Addr, Data)); ++} ++ ++// 8821 no RF B ++/* ++void ++odm_ConfigRF_RadioB_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Data ++ ) ++{ ++ u4Byte content = 0x1001; // RF_Content: radiob_txt ++ u4Byte maskforPhySet= (u4Byte)(content&0xE000); ++ ++ odm_ConfigRFReg_8812A(pDM_Odm, Addr, Data, ODM_RF_PATH_B, Addr|maskforPhySet); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioB] %08X %08X\n", Addr, Data)); ++ ++} ++*/ ++ ++void ++odm_ConfigMAC_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u1Byte Data ++ ) ++{ ++ ODM_Write1Byte(pDM_Odm, Addr, Data); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigMACWithHeaderFile: [MAC_REG] %08X %08X\n", Addr, Data)); ++} ++ ++void ++odm_ConfigBB_AGC_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Bitmask, ++ u4Byte Data ++ ) ++{ ++ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); ++ // Add 1us delay between BB/RF register setting. ++ ODM_delay_us(1); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [AGC_TAB] %08X %08X\n", Addr, Data)); ++} ++ ++void ++odm_ConfigBB_PHY_REG_PG_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Bitmask, ++ u4Byte Data ++ ) ++{ ++ if (Addr == 0xfe) ++ #ifdef CONFIG_LONG_DELAY_ISSUE ++ ODM_sleep_ms(50); ++ #else ++ ODM_delay_ms(50); ++ #endif ++ else if (Addr == 0xfd) ++ ODM_delay_ms(5); ++ else if (Addr == 0xfc) ++ ODM_delay_ms(1); ++ else if (Addr == 0xfb) ++ ODM_delay_us(50); ++ else if (Addr == 0xfa) ++ ODM_delay_us(5); ++ else if (Addr == 0xf9) ++ ODM_delay_us(1); ++ ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("===> @@@@@@@ ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X %08X\n", Addr, Bitmask, Data)); ++ ++ storePwrIndexDiffRateOffset(pDM_Odm->Adapter, Addr, Bitmask, Data); ++} ++ ++void ++odm_ConfigBB_PHY_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Bitmask, ++ u4Byte Data ++ ) ++{ ++ if (Addr == 0xfe) ++ #ifdef CONFIG_LONG_DELAY_ISSUE ++ ODM_sleep_ms(50); ++ #else ++ ODM_delay_ms(50); ++ #endif ++ else if (Addr == 0xfd) ++ ODM_delay_ms(5); ++ else if (Addr == 0xfc) ++ ODM_delay_ms(1); ++ else if (Addr == 0xfb) ++ ODM_delay_us(50); ++ else if (Addr == 0xfa) ++ ODM_delay_us(5); ++ else if (Addr == 0xf9) ++ ODM_delay_us(1); ++ else if (Addr == 0xa24) ++ pDM_Odm->RFCalibrateInfo.RegA24 = Data; ++ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); ++ ++ // Add 1us delay between BB/RF register setting. ++ ODM_delay_us(1); ++ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X\n", Addr, Data)); ++} ++ ++void ++odm_ConfigBB_TXPWR_LMT_8821A( ++ PDM_ODM_T pDM_Odm, ++ const pu1Byte Regulation, ++ const pu1Byte Band, ++ const pu1Byte Bandwidth, ++ const pu1Byte RateSection, ++ const pu1Byte RfPath, ++ const pu1Byte Channel, ++ const pu1Byte PowerLimit ++ ) ++{ ++ PHY_SetPowerLimitTableValue(pDM_Odm, Regulation, Band, ++ Bandwidth, RateSection, RfPath, Channel, PowerLimit); ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8821A.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8821A.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8821A.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8821A.h 2018-02-06 17:42:30.712967194 +0200 +@@ -0,0 +1,84 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++#ifndef __INC_ODM_REGCONFIG_H_8821A ++#define __INC_ODM_REGCONFIG_H_8821A ++ ++void ++odm_ConfigRFReg_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Data, ++ ODM_RF_RADIO_PATH_E RF_PATH, ++ u4Byte RegAddr ++ ); ++ ++void ++odm_ConfigRF_RadioA_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Data ++ ); ++ ++void ++odm_ConfigRF_RadioB_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Data ++ ); ++ ++void ++odm_ConfigMAC_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u1Byte Data ++ ); ++ ++void ++odm_ConfigBB_AGC_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Bitmask, ++ u4Byte Data ++ ); ++ ++void ++odm_ConfigBB_PHY_REG_PG_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Bitmask, ++ u4Byte Data ++ ); ++ ++void ++odm_ConfigBB_PHY_8821A( ++ PDM_ODM_T pDM_Odm, ++ u4Byte Addr, ++ u4Byte Bitmask, ++ u4Byte Data ++ ); ++ ++void ++odm_ConfigBB_TXPWR_LMT_8821A( ++ PDM_ODM_T pDM_Odm, ++ const pu1Byte Regulation, ++ const pu1Byte Band, ++ const pu1Byte Bandwidth, ++ const pu1Byte RateSection, ++ const pu1Byte RfPath, ++ const pu1Byte Channel, ++ const pu1Byte PowerLimit ++ ); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegDefine11AC.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegDefine11AC.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegDefine11AC.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegDefine11AC.h 2018-02-06 17:42:30.712967194 +0200 +@@ -0,0 +1,51 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++#ifndef __ODM_REGDEFINE11AC_H__ ++#define __ODM_REGDEFINE11AC_H__ ++ ++//2 RF REG LIST ++ ++ ++ ++//2 BB REG LIST ++//PAGE 8 ++#define ODM_REG_CCK_RPT_FORMAT_11AC 0x804 ++#define ODM_REG_BB_RX_PATH_11AC 0x808 ++//PAGE 9 ++#define ODM_REG_OFDM_FA_RST_11AC 0x9A4 ++//PAGE A ++#define ODM_REG_CCK_CCA_11AC 0xA0A ++#define ODM_REG_CCK_FA_RST_11AC 0xA2C ++#define ODM_REG_CCK_FA_11AC 0xA5C ++//PAGE C ++#define ODM_REG_IGI_A_11AC 0xC50 ++//PAGE E ++#define ODM_REG_IGI_B_11AC 0xE50 ++//PAGE F ++#define ODM_REG_OFDM_FA_11AC 0xF48 ++ ++ ++//2 MAC REG LIST ++ ++ ++ ++ ++//DIG Related ++#define ODM_BIT_IGI_11AC 0xFFFFFFFF ++#define ODM_BIT_CCK_RPT_FORMAT_11AC BIT16 ++#define ODM_BIT_BB_RX_PATH_11AC 0xF ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegDefine11N.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegDefine11N.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegDefine11N.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegDefine11N.h 2018-02-06 17:42:30.712967194 +0200 +@@ -0,0 +1,168 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++#ifndef __ODM_REGDEFINE11N_H__ ++#define __ODM_REGDEFINE11N_H__ ++ ++ ++//2 RF REG LIST ++#define ODM_REG_RF_MODE_11N 0x00 ++#define ODM_REG_RF_0B_11N 0x0B ++#define ODM_REG_CHNBW_11N 0x18 ++#define ODM_REG_T_METER_11N 0x24 ++#define ODM_REG_RF_25_11N 0x25 ++#define ODM_REG_RF_26_11N 0x26 ++#define ODM_REG_RF_27_11N 0x27 ++#define ODM_REG_RF_2B_11N 0x2B ++#define ODM_REG_RF_2C_11N 0x2C ++#define ODM_REG_RXRF_A3_11N 0x3C ++#define ODM_REG_T_METER_92D_11N 0x42 ++#define ODM_REG_T_METER_88E_11N 0x42 ++ ++ ++ ++//2 BB REG LIST ++//PAGE 8 ++#define ODM_REG_BB_CTRL_11N 0x800 ++#define ODM_REG_RF_PIN_11N 0x804 ++#define ODM_REG_PSD_CTRL_11N 0x808 ++#define ODM_REG_TX_ANT_CTRL_11N 0x80C ++#define ODM_REG_BB_PWR_SAV5_11N 0x818 ++#define ODM_REG_CCK_RPT_FORMAT_11N 0x824 ++#define ODM_REG_RX_DEFUALT_A_11N 0x858 ++#define ODM_REG_RX_DEFUALT_B_11N 0x85A ++#define ODM_REG_BB_PWR_SAV3_11N 0x85C ++#define ODM_REG_ANTSEL_CTRL_11N 0x860 ++#define ODM_REG_RX_ANT_CTRL_11N 0x864 ++#define ODM_REG_PIN_CTRL_11N 0x870 ++#define ODM_REG_BB_PWR_SAV1_11N 0x874 ++#define ODM_REG_ANTSEL_PATH_11N 0x878 ++#define ODM_REG_BB_3WIRE_11N 0x88C ++#define ODM_REG_SC_CNT_11N 0x8C4 ++#define ODM_REG_PSD_DATA_11N 0x8B4 ++//PAGE 9 ++#define ODM_REG_ANT_MAPPING1_11N 0x914 ++#define ODM_REG_ANT_MAPPING2_11N 0x918 ++//PAGE A ++#define ODM_REG_CCK_ANTDIV_PARA1_11N 0xA00 ++#define ODM_REG_CCK_CCA_11N 0xA0A ++#define ODM_REG_CCK_ANTDIV_PARA2_11N 0xA0C ++#define ODM_REG_CCK_ANTDIV_PARA3_11N 0xA10 ++#define ODM_REG_CCK_ANTDIV_PARA4_11N 0xA14 ++#define ODM_REG_CCK_FILTER_PARA1_11N 0xA22 ++#define ODM_REG_CCK_FILTER_PARA2_11N 0xA23 ++#define ODM_REG_CCK_FILTER_PARA3_11N 0xA24 ++#define ODM_REG_CCK_FILTER_PARA4_11N 0xA25 ++#define ODM_REG_CCK_FILTER_PARA5_11N 0xA26 ++#define ODM_REG_CCK_FILTER_PARA6_11N 0xA27 ++#define ODM_REG_CCK_FILTER_PARA7_11N 0xA28 ++#define ODM_REG_CCK_FILTER_PARA8_11N 0xA29 ++#define ODM_REG_CCK_FA_RST_11N 0xA2C ++#define ODM_REG_CCK_FA_MSB_11N 0xA58 ++#define ODM_REG_CCK_FA_LSB_11N 0xA5C ++#define ODM_REG_CCK_CCA_CNT_11N 0xA60 ++#define ODM_REG_BB_PWR_SAV4_11N 0xA74 ++//PAGE B ++#define ODM_REG_LNA_SWITCH_11N 0xB2C ++#define ODM_REG_PATH_SWITCH_11N 0xB30 ++#define ODM_REG_RSSI_CTRL_11N 0xB38 ++#define ODM_REG_CONFIG_ANTA_11N 0xB68 ++#define ODM_REG_RSSI_BT_11N 0xB9C ++//PAGE C ++#define ODM_REG_OFDM_FA_HOLDC_11N 0xC00 ++#define ODM_REG_BB_RX_PATH_11N 0xC04 ++#define ODM_REG_TRMUX_11N 0xC08 ++#define ODM_REG_OFDM_FA_RSTC_11N 0xC0C ++#define ODM_REG_RXIQI_MATRIX_11N 0xC14 ++#define ODM_REG_TXIQK_MATRIX_LSB1_11N 0xC4C ++#define ODM_REG_IGI_A_11N 0xC50 ++#define ODM_REG_ANTDIV_PARA2_11N 0xC54 ++#define ODM_REG_IGI_B_11N 0xC58 ++#define ODM_REG_ANTDIV_PARA3_11N 0xC5C ++#define ODM_REG_L1SBD_PD_CH_11N 0XC6C ++#define ODM_REG_BB_PWR_SAV2_11N 0xC70 ++#define ODM_REG_RX_OFF_11N 0xC7C ++#define ODM_REG_TXIQK_MATRIXA_11N 0xC80 ++#define ODM_REG_TXIQK_MATRIXB_11N 0xC88 ++#define ODM_REG_TXIQK_MATRIXA_LSB2_11N 0xC94 ++#define ODM_REG_TXIQK_MATRIXB_LSB2_11N 0xC9C ++#define ODM_REG_RXIQK_MATRIX_LSB_11N 0xCA0 ++#define ODM_REG_ANTDIV_PARA1_11N 0xCA4 ++#define ODM_REG_OFDM_FA_TYPE1_11N 0xCF0 ++//PAGE D ++#define ODM_REG_OFDM_FA_RSTD_11N 0xD00 ++#define ODM_REG_OFDM_FA_TYPE2_11N 0xDA0 ++#define ODM_REG_OFDM_FA_TYPE3_11N 0xDA4 ++#define ODM_REG_OFDM_FA_TYPE4_11N 0xDA8 ++//PAGE E ++#define ODM_REG_TXAGC_A_6_18_11N 0xE00 ++#define ODM_REG_TXAGC_A_24_54_11N 0xE04 ++#define ODM_REG_TXAGC_A_1_MCS32_11N 0xE08 ++#define ODM_REG_TXAGC_A_MCS0_3_11N 0xE10 ++#define ODM_REG_TXAGC_A_MCS4_7_11N 0xE14 ++#define ODM_REG_TXAGC_A_MCS8_11_11N 0xE18 ++#define ODM_REG_TXAGC_A_MCS12_15_11N 0xE1C ++#define ODM_REG_FPGA0_IQK_11N 0xE28 ++#define ODM_REG_TXIQK_TONE_A_11N 0xE30 ++#define ODM_REG_RXIQK_TONE_A_11N 0xE34 ++#define ODM_REG_TXIQK_PI_A_11N 0xE38 ++#define ODM_REG_RXIQK_PI_A_11N 0xE3C ++#define ODM_REG_TXIQK_11N 0xE40 ++#define ODM_REG_RXIQK_11N 0xE44 ++#define ODM_REG_IQK_AGC_PTS_11N 0xE48 ++#define ODM_REG_IQK_AGC_RSP_11N 0xE4C ++#define ODM_REG_BLUETOOTH_11N 0xE6C ++#define ODM_REG_RX_WAIT_CCA_11N 0xE70 ++#define ODM_REG_TX_CCK_RFON_11N 0xE74 ++#define ODM_REG_TX_CCK_BBON_11N 0xE78 ++#define ODM_REG_OFDM_RFON_11N 0xE7C ++#define ODM_REG_OFDM_BBON_11N 0xE80 ++#define ODM_REG_TX2RX_11N 0xE84 ++#define ODM_REG_TX2TX_11N 0xE88 ++#define ODM_REG_RX_CCK_11N 0xE8C ++#define ODM_REG_RX_OFDM_11N 0xED0 ++#define ODM_REG_RX_WAIT_RIFS_11N 0xED4 ++#define ODM_REG_RX2RX_11N 0xED8 ++#define ODM_REG_STANDBY_11N 0xEDC ++#define ODM_REG_SLEEP_11N 0xEE0 ++#define ODM_REG_PMPD_ANAEN_11N 0xEEC ++ ++ ++ ++ ++ ++ ++ ++//2 MAC REG LIST ++#define ODM_REG_BB_RST_11N 0x02 ++#define ODM_REG_ANTSEL_PIN_11N 0x4C ++#define ODM_REG_EARLY_MODE_11N 0x4D0 ++#define ODM_REG_RSSI_MONITOR_11N 0x4FE ++#define ODM_REG_EDCA_VO_11N 0x500 ++#define ODM_REG_EDCA_VI_11N 0x504 ++#define ODM_REG_EDCA_BE_11N 0x508 ++#define ODM_REG_EDCA_BK_11N 0x50C ++#define ODM_REG_TXPAUSE_11N 0x522 ++#define ODM_REG_RESP_TX_11N 0x6D8 ++#define ODM_REG_ANT_TRAIN_PARA1_11N 0x7b0 ++#define ODM_REG_ANT_TRAIN_PARA2_11N 0x7b4 ++ ++ ++//DIG Related ++#define ODM_BIT_IGI_11N 0x0000007F ++#define ODM_BIT_CCK_RPT_FORMAT_11N BIT9 ++#define ODM_BIT_BB_RX_PATH_11N 0xF ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_reg.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_reg.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_reg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_reg.h 2018-02-06 17:42:30.713967209 +0200 +@@ -0,0 +1,117 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++//============================================================ ++// File Name: odm_reg.h ++// ++// Description: ++// ++// This file is for general register definition. ++// ++// ++//============================================================ ++#ifndef __HAL_ODM_REG_H__ ++#define __HAL_ODM_REG_H__ ++ ++// ++// Register Definition ++// ++ ++//MAC REG ++#define ODM_BB_RESET 0x002 ++#define ODM_DUMMY 0x4fe ++#define RF_T_METER_OLD 0x24 ++#define RF_T_METER_NEW 0x42 ++ ++#define ODM_EDCA_VO_PARAM 0x500 ++#define ODM_EDCA_VI_PARAM 0x504 ++#define ODM_EDCA_BE_PARAM 0x508 ++#define ODM_EDCA_BK_PARAM 0x50C ++#define ODM_TXPAUSE 0x522 ++ ++//BB REG ++#define ODM_FPGA_PHY0_PAGE8 0x800 ++#define ODM_PSD_SETTING 0x808 ++#define ODM_AFE_SETTING 0x818 ++#define ODM_TXAGC_B_6_18 0x830 ++#define ODM_TXAGC_B_24_54 0x834 ++#define ODM_TXAGC_B_MCS32_5 0x838 ++#define ODM_TXAGC_B_MCS0_MCS3 0x83c ++#define ODM_TXAGC_B_MCS4_MCS7 0x848 ++#define ODM_TXAGC_B_MCS8_MCS11 0x84c ++#define ODM_ANALOG_REGISTER 0x85c ++#define ODM_RF_INTERFACE_OUTPUT 0x860 ++#define ODM_TXAGC_B_MCS12_MCS15 0x868 ++#define ODM_TXAGC_B_11_A_2_11 0x86c ++#define ODM_AD_DA_LSB_MASK 0x874 ++#define ODM_ENABLE_3_WIRE 0x88c ++#define ODM_PSD_REPORT 0x8b4 ++#define ODM_R_ANT_SELECT 0x90c ++#define ODM_CCK_ANT_SELECT 0xa07 ++#define ODM_CCK_PD_THRESH 0xa0a ++#define ODM_CCK_RF_REG1 0xa11 ++#define ODM_CCK_MATCH_FILTER 0xa20 ++#define ODM_CCK_RAKE_MAC 0xa2e ++#define ODM_CCK_CNT_RESET 0xa2d ++#define ODM_CCK_TX_DIVERSITY 0xa2f ++#define ODM_CCK_FA_CNT_MSB 0xa5b ++#define ODM_CCK_FA_CNT_LSB 0xa5c ++#define ODM_CCK_NEW_FUNCTION 0xa75 ++#define ODM_OFDM_PHY0_PAGE_C 0xc00 ++#define ODM_OFDM_RX_ANT 0xc04 ++#define ODM_R_A_RXIQI 0xc14 ++#define ODM_R_A_AGC_CORE1 0xc50 ++#define ODM_R_A_AGC_CORE2 0xc54 ++#define ODM_R_B_AGC_CORE1 0xc58 ++#define ODM_R_AGC_PAR 0xc70 ++#define ODM_R_HTSTF_AGC_PAR 0xc7c ++#define ODM_TX_PWR_TRAINING_A 0xc90 ++#define ODM_TX_PWR_TRAINING_B 0xc98 ++#define ODM_OFDM_FA_CNT1 0xcf0 ++#define ODM_OFDM_PHY0_PAGE_D 0xd00 ++#define ODM_OFDM_FA_CNT2 0xda0 ++#define ODM_OFDM_FA_CNT3 0xda4 ++#define ODM_OFDM_FA_CNT4 0xda8 ++#define ODM_TXAGC_A_6_18 0xe00 ++#define ODM_TXAGC_A_24_54 0xe04 ++#define ODM_TXAGC_A_1_MCS32 0xe08 ++#define ODM_TXAGC_A_MCS0_MCS3 0xe10 ++#define ODM_TXAGC_A_MCS4_MCS7 0xe14 ++#define ODM_TXAGC_A_MCS8_MCS11 0xe18 ++#define ODM_TXAGC_A_MCS12_MCS15 0xe1c ++ ++//RF REG ++#define ODM_GAIN_SETTING 0x00 ++#define ODM_CHANNEL 0x18 ++ ++//Ant Detect Reg ++#define ODM_DPDT 0x300 ++ ++//PSD Init ++#define ODM_PSDREG 0x808 ++ ++//92D Path Div ++#define PATHDIV_REG 0xB30 ++#define PATHDIV_TRI 0xBA0 ++ ++ ++// ++// Bitmap Definition ++// ++ ++#define BIT_FA_RESET BIT0 ++ ++ ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_types.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_types.h +--- linux-4.14.17/3rdparty/rtl8812au/hal/odm_types.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_types.h 2018-02-06 17:42:30.713967209 +0200 +@@ -0,0 +1,82 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++#ifndef __ODM_TYPES_H__ ++#define __ODM_TYPES_H__ ++ ++// ++// Define Different SW team support ++// ++#define ODM_AP 0x01 //BIT0 ++#define ODM_ADSL 0x02 //BIT1 ++#define ODM_CE 0x04 //BIT2 ++#define ODM_WIN 0x08 //BIT3 ++ ++#define RT_PCI_INTERFACE 1 ++#define RT_USB_INTERFACE 2 ++#define RT_SDIO_INTERFACE 3 ++ ++typedef enum _HAL_STATUS{ ++ HAL_STATUS_SUCCESS, ++ HAL_STATUS_FAILURE, ++}HAL_STATUS,*PHAL_STATUS; ++ ++typedef enum _RT_SPINLOCK_TYPE{ ++ RT_TEMP =1, ++}RT_SPINLOCK_TYPE; ++ ++ #include ++ ++ #define u1Byte u8 ++ #define pu1Byte u8* ++ ++ #define u2Byte u16 ++ #define pu2Byte u16* ++ ++ #define u4Byte u32 ++ #define pu4Byte u32* ++ ++ #define u8Byte u64 ++ #define pu8Byte u64* ++ ++ #define s1Byte s8 ++ #define ps1Byte s8* ++ ++ #define s2Byte s16 ++ #define ps2Byte s16* ++ ++ #define s4Byte s32 ++ #define ps4Byte s32* ++ ++ #define s8Byte s64 ++ #define ps8Byte s64* ++ ++ #define DEV_BUS_TYPE RT_USB_INTERFACE ++ ++ typedef struct timer_list RT_TIMER, *PRT_TIMER; ++ typedef void * RT_TIMER_CALL_BACK; ++ #define STA_INFO_T struct sta_info ++ #define PSTA_INFO_T struct sta_info * ++ ++ #define SET_TX_DESC_ANTSEL_A_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 1, __Value) ++ #define SET_TX_DESC_ANTSEL_B_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 25, 1, __Value) ++ #define SET_TX_DESC_ANTSEL_C_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 29, 1, __Value) ++ ++ //define useless flag to avoid compile warning ++ #define USE_WORKITEM 0 ++ #define FOR_BRAZIL_PRETEST 0 ++ #define BT_30_SUPPORT 0 ++ #define FPGA_TWO_MAC_VERIFICATION 0 ++ ++#endif // __ODM_TYPES_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_cmd.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_cmd.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_cmd.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_cmd.c 2018-02-06 17:42:30.713967209 +0200 +@@ -0,0 +1,1338 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++#define _RTL8812A_CMD_C_ ++ ++//#include ++#include ++ ++#define CONFIG_H2C_EF ++ ++#define RTL8812_MAX_H2C_BOX_NUMS 4 ++#define RTL8812_MAX_CMD_LEN 7 ++#define RTL8812_MESSAGE_BOX_SIZE 4 ++#define RTL8812_EX_MESSAGE_BOX_SIZE 4 ++ ++ ++static u8 _is_fw_read_cmd_down(_adapter* padapter, u8 msgbox_num) ++{ ++ u8 read_down = false; ++ int retry_cnts = 100; ++ ++ u8 valid; ++ ++ //DBG_8192C(" _is_fw_read_cmd_down ,reg_1cc(%x),msg_box(%d)...\n",rtw_read8(padapter,REG_HMETFR),msgbox_num); ++ ++ do{ ++ valid = rtw_read8(padapter,REG_HMETFR) & BIT(msgbox_num); ++ if(0 == valid ){ ++ read_down = true; ++ } ++#ifdef CONFIG_WOWLAN ++ rtw_msleep_os(2); ++#endif ++ }while( (!read_down) && (retry_cnts--)); ++ ++ return read_down; ++ ++} ++ ++ ++/***************************************** ++* H2C Msg format : ++* 0x1DF - 0x1D0 ++*| 31 - 8 | 7-5 4 - 0 | ++*| h2c_msg |Class_ID CMD_ID | ++* ++* Extend 0x1FF - 0x1F0 ++*|31 - 0 | ++*|ext_msg| ++******************************************/ ++static s32 FillH2CCmd_8812(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) ++{ ++ u8 bcmd_down = false; ++ s32 retry_cnts = 100; ++ u8 h2c_box_num; ++ u32 msgbox_addr; ++ u32 msgbox_ex_addr; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 cmd_idx,ext_cmd_len; ++ u32 h2c_cmd = 0; ++ u32 h2c_cmd_ex = 0; ++ s32 ret = _FAIL; ++ ++ ++ ++ padapter = GET_PRIMARY_ADAPTER(padapter); ++ pHalData = GET_HAL_DATA(padapter); ++ ++ ++ if(padapter->bFWReady == false) ++ { ++ //DBG_8192C("FillH2CCmd_8812(): return H2C cmd because fw is not ready\n"); ++ return ret; ++ } ++ ++ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->h2c_fwcmd_mutex), NULL); ++ ++ ++ if (!pCmdBuffer) { ++ goto exit; ++ } ++ if (CmdLen > RTL8812_MAX_CMD_LEN) { ++ goto exit; ++ } ++ if (padapter->bSurpriseRemoved == true) ++ goto exit; ++ ++ //pay attention to if race condition happened in H2C cmd setting. ++ do{ ++ h2c_box_num = pHalData->LastHMEBoxNum; ++ ++ if(!_is_fw_read_cmd_down(padapter, h2c_box_num)){ ++ DBG_8192C(" fw read cmd failed...\n"); ++ goto exit; ++ } ++ ++ *(u8*)(&h2c_cmd) = ElementID; ++ ++ if(CmdLen<=3) ++ { ++ _rtw_memcpy((u8*)(&h2c_cmd)+1, pCmdBuffer, CmdLen ); ++ } ++ else{ ++ _rtw_memcpy((u8*)(&h2c_cmd)+1, pCmdBuffer,3); ++ ext_cmd_len = CmdLen-3; ++ _rtw_memcpy((u8*)(&h2c_cmd_ex), pCmdBuffer+3,ext_cmd_len ); ++ ++ //Write Ext command ++ msgbox_ex_addr = REG_HMEBOX_EXT0_8812 + (h2c_box_num *RTL8812_EX_MESSAGE_BOX_SIZE); ++ #ifdef CONFIG_H2C_EF ++ for(cmd_idx=0;cmd_idxh2c_cmd:0x%x, reg:0x%x =>h2c_cmd_ex:0x%x ..\n" ++ // ,pHalData->LastHMEBoxNum ,CmdLen,msgbox_addr,h2c_cmd,msgbox_ex_addr,h2c_cmd_ex); ++ ++ pHalData->LastHMEBoxNum = (h2c_box_num+1) % RTL8812_MAX_H2C_BOX_NUMS; ++ ++ }while((!bcmd_down) && (retry_cnts--)); ++ ++ ret = _SUCCESS; ++ ++exit: ++ ++ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->h2c_fwcmd_mutex), NULL); ++ ++ ++ ++ return ret; ++} ++ ++static u8 rtl8812_h2c_msg_hdl(_adapter *padapter, unsigned char *pbuf) ++{ ++ u8 ElementID, CmdLen; ++ u8 *pCmdBuffer; ++ struct cmd_msg_parm *pcmdmsg; ++ ++ if(!pbuf) ++ return H2C_PARAMETERS_ERROR; ++ ++ pcmdmsg = (struct cmd_msg_parm*)pbuf; ++ ElementID = pcmdmsg->eid; ++ CmdLen = pcmdmsg->sz; ++ pCmdBuffer = pcmdmsg->buf; ++ ++ FillH2CCmd_8812(padapter, ElementID, CmdLen, pCmdBuffer); ++ ++ return H2C_SUCCESS; ++} ++ ++u8 rtl8812_set_rssi_cmd(_adapter*padapter, u8 *param) ++{ ++ u8 res=_SUCCESS; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ *((__le32*) param ) = cpu_to_le32( *((u32*) param ) ); ++ ++ FillH2CCmd_8812(padapter, H2C_8812_RSSI_REPORT, 4, param); ++ ++ ++ ++ return res; ++} ++ ++static u8 Get_VHT_ENI( ++ u32 IOTAction, ++ u32 WirelessMode, ++ u32 ratr_bitmap ++ ) ++{ ++ u8 Ret = 0; ++ ++ if(WirelessMode == WIRELESS_11_24AC) ++ { ++ if(ratr_bitmap & 0xfff00000) // Mix , 2SS ++ Ret = 3; ++ else // Mix, 1SS ++ Ret = 2; ++ } ++ else if(WirelessMode == WIRELESS_11_5AC) ++ { ++ Ret = 1; // VHT ++ } ++ ++ return (Ret << 4); ++} ++ ++static bool ++Get_RA_ShortGI( ++ PADAPTER Adapter, ++ struct sta_info *psta, ++ u8 shortGIrate ++) ++{ ++ bool bShortGI; ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ bShortGI = shortGIrate; ++ ++#ifdef CONFIG_80211AC_VHT ++ if( bShortGI && ++ IsSupportedVHT(psta->wireless_mode) && ++ (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP) && ++ TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX) ++ ) ++ { ++ if(psta->vhtpriv.vht_highest_rate >= MGN_VHT2SS_MCS8) ++ bShortGI = false; ++ } ++#endif ++ ++ return bShortGI; ++} ++ ++ ++void ++Set_RA_LDPC_8812( ++ struct sta_info *psta, ++ bool bLDPC ++ ) ++{ ++ if(psta == NULL) ++ return; ++#ifdef CONFIG_80211AC_VHT ++ if(psta->wireless_mode == WIRELESS_11_5AC) ++ { ++ if(bLDPC && TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_CAP_TX)) ++ SET_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX); ++ else ++ CLEAR_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX); ++ } ++ else if(IsSupportedTxHT(psta->wireless_mode) || IsSupportedVHT(psta->wireless_mode)) ++ { ++ if(bLDPC && TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_CAP_TX)) ++ SET_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_ENABLE_TX); ++ else ++ CLEAR_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_ENABLE_TX); ++ } ++#endif ++ ++ //DBG_871X("MacId %d bLDPC %d\n", psta->mac_id, bLDPC); ++} ++ ++ ++static u8 ++Get_RA_LDPC_8812( ++ struct sta_info *psta ++) ++{ ++ u8 bLDPC = 0; ++ ++ if(psta->mac_id == 1) ++ bLDPC = 0; ++ else if(psta != NULL) ++ { ++#ifdef CONFIG_80211AC_VHT ++ if(IsSupportedVHT(psta->wireless_mode)) ++ { ++ if(TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_CAP_TX)) ++ bLDPC = 1; ++ else ++ bLDPC = 0; ++ } ++ else if(IsSupportedTxHT(psta->wireless_mode)) ++ { ++ if(TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_CAP_TX)) ++ bLDPC =1; ++ else ++ bLDPC =0; ++ } ++ else ++#endif ++ bLDPC = 0; ++ } ++ ++ return (bLDPC << 2); ++} ++ ++void rtl8812_set_raid_cmd(PADAPTER padapter, u32 bitmap, u8* arg) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct sta_info *psta; ++ u8 macid, init_rate, raid, shortGIrate=false; ++ ++ ++ ++ macid = arg[0]; ++ raid = arg[1]; ++ shortGIrate = arg[2]; ++ init_rate = arg[3]; ++ ++ psta = pmlmeinfo->FW_sta_info[macid].psta; + if(psta == NULL) + { + return; + } + -+ tx_ra_bitmap = 0; -+ -+ //b/g mode ra_bitmap -+ for (i=0; ibssrateset); i++) ++ if(pHalData->fw_ractrl == true) + { -+ if (psta->bssrateset[i]) -+ tx_ra_bitmap |= rtw_get_bit_value_from_ieee_value(psta->bssrateset[i]&0x7f); ++ u8 H2CCommand[7] ={0}; ++ ++ shortGIrate = Get_RA_ShortGI(padapter, psta, shortGIrate); ++ ++ H2CCommand[0] = macid; ++ H2CCommand[1] = (raid & 0x1F) | (shortGIrate?0x80:0x00) ; ++ H2CCommand[2] = (pmlmeext->cur_bwmode & 0x3) |Get_RA_LDPC_8812(psta) |Get_VHT_ENI(0, psta->wireless_mode, bitmap); ++ ++ H2CCommand[3] = (u8)(bitmap & 0x000000ff); ++ H2CCommand[4] = (u8)((bitmap & 0x0000ff00) >>8); ++ H2CCommand[5] = (u8)((bitmap & 0x00ff0000) >> 16); ++ H2CCommand[6] = (u8)((bitmap & 0xff000000) >> 24); ++ ++ DBG_871X("rtl8812_set_raid_cmd, bitmap=0x%x, mac_id=0x%x, raid=0x%x, shortGIrate=%x\n", bitmap, macid, raid, shortGIrate); ++ ++ FillH2CCmd_8812(padapter, H2C_8812_RA_MASK, 7, H2CCommand); + } + -+#ifdef CONFIG_80211N_HT -+#ifdef CONFIG_80211AC_VHT -+ //AC mode ra_bitmap -+ if(psta->vhtpriv.vht_option) -+ { -+ tx_ra_bitmap |= (rtw_vht_rate_to_bitmap(psta->vhtpriv.vht_mcs_map) << 12); -+ } -+ else -+#endif //CONFIG_80211AC_VHT -+ { -+ //n mode ra_bitmap -+ if(psta->htpriv.ht_option) -+ { -+ rf_type = RF_1T1R; -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if(rf_type == RF_2T2R) -+ limit=16;// 2R -+ else if(rf_type == RF_3T3R) -+ limit=24;// 3R -+ else -+ limit=8;// 1R ++ if (shortGIrate==true) ++ init_rate |= BIT(7); ++ ++ pdmpriv->INIDATA_RATE[macid] = init_rate; + + -+ /* Handling SMPS mode for AP MODE only*/ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { -+ /*0:static SMPS, 1:dynamic SMPS, 3:SMPS disabled, 2:reserved*/ -+ if (psta->htpriv.smps_cap == 0 || psta->htpriv.smps_cap == 1) { -+ /*operate with only one active receive chain // 11n-MCS rate <= MSC7*/ -+ limit = 8;/* 1R*/ -+ } -+ } + -+ for (i=0; ihtpriv.ht_cap.supp_mcs_set[i/8] & BIT(i%8)) -+ tx_ra_bitmap |= BIT(i+12); -+ } -+ } -+ } -+#endif //CONFIG_80211N_HT -+ DBG_871X("supp_mcs_set = %02x, %02x, %02x, rf_type=%d, tx_ra_bitmap=%016llx\n" -+ , psta->htpriv.ht_cap.supp_mcs_set[0], psta->htpriv.ht_cap.supp_mcs_set[1], psta->htpriv.ht_cap.supp_mcs_set[2], rf_type, tx_ra_bitmap); -+ psta->ra_mask = tx_ra_bitmap; -+ psta->init_rate = get_highest_rate_idx(tx_ra_bitmap)&0x3f; +} + -+#ifndef SEC_CAM_ACCESS_TIMEOUT_MS -+ #define SEC_CAM_ACCESS_TIMEOUT_MS 200 -+#endif -+ -+#ifndef DBG_SEC_CAM_ACCESS -+ #define DBG_SEC_CAM_ACCESS 0 -+#endif -+ -+u32 rtw_sec_read_cam(_adapter *adapter, u8 addr) ++void rtl8812_Add_RateATid(PADAPTER pAdapter, u32 bitmap, u8* arg, u8 rssi_level) +{ -+ _mutex *mutex = &adapter_to_dvobj(adapter)->cam_ctl.sec_cam_access_mutex; -+ u32 rdata; -+ u32 cnt = 0; -+ u32 start = 0, end = 0; -+ u8 timeout = 0; -+ u8 sr = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u8 macid; + -+ _enter_critical_mutex(mutex, NULL); ++ macid = arg[0]; + -+ rtw_write32(adapter, REG_CAMCMD, CAM_POLLINIG | addr); ++#ifdef CONFIG_ODM_REFRESH_RAMASK ++ if(rssi_level != DM_RATR_STA_INIT) ++ bitmap = ODM_Get_Rate_Bitmap(&pHalData->odmpriv, macid, bitmap, rssi_level); ++#endif //CONFIG_ODM_REFRESH_RAMASK + -+ start = rtw_get_current_time(); -+ while (1) { -+ if (rtw_is_surprise_removed(adapter)) { -+ sr = 1; -+ break; -+ } -+ -+ cnt++; -+ if (0 == (rtw_read32(adapter, REG_CAMCMD) & CAM_POLLINIG)) -+ break; -+ -+ if (rtw_get_passing_time_ms(start) > SEC_CAM_ACCESS_TIMEOUT_MS) { -+ timeout = 1; -+ break; -+ } -+ } -+ end = rtw_get_current_time(); -+ -+ rdata = rtw_read32(adapter, REG_CAMREAD); -+ -+ _exit_critical_mutex(mutex, NULL); -+ -+ if (DBG_SEC_CAM_ACCESS || timeout) { -+ DBG_871X(FUNC_ADPT_FMT" addr:0x%02x, rdata:0x%08x, to:%u, polling:%u, %d ms\n" -+ , FUNC_ADPT_ARG(adapter), addr, rdata, timeout, cnt, rtw_get_time_interval_ms(start, end)); -+ } -+ -+ return rdata; ++ rtl8812_set_raid_cmd(pAdapter, bitmap, arg); +} + -+void rtw_sec_write_cam(_adapter *adapter, u8 addr, u32 wdata) ++void rtl8812_set_FwPwrMode_cmd(PADAPTER padapter, u8 PSMode) +{ -+ _mutex *mutex = &adapter_to_dvobj(adapter)->cam_ctl.sec_cam_access_mutex; -+ u32 cnt = 0; -+ u32 start = 0, end = 0; -+ u8 timeout = 0; -+ u8 sr = 0; ++ u8 u1H2CSetPwrMode[5]={0}; ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; ++ u8 Mode = 0, RLBM = 0, PowerState = 0, LPSAwakeIntvl = 1; + -+ _enter_critical_mutex(mutex, NULL); + -+ rtw_write32(adapter, REG_CAMWRITE, wdata); -+ rtw_write32(adapter, REG_CAMCMD, CAM_POLLINIG | CAM_WRITE | addr); + -+ start = rtw_get_current_time(); -+ while (1) { -+ if (rtw_is_surprise_removed(adapter)) { -+ sr = 1; ++ DBG_871X("%s: Mode=%d SmartPS=%d UAPSD=%d\n", __FUNCTION__, ++ PSMode, pwrpriv->smart_ps, padapter->registrypriv.uapsd_enable); ++ ++ switch(PSMode) ++ { ++ case PS_MODE_ACTIVE: ++ Mode = 0; + break; -+ } -+ -+ cnt++; -+ if (0 == (rtw_read32(adapter, REG_CAMCMD) & CAM_POLLINIG)) ++ case PS_MODE_MIN: ++ Mode = 1; + break; -+ -+ if (rtw_get_passing_time_ms(start) > SEC_CAM_ACCESS_TIMEOUT_MS) { -+ timeout = 1; ++ case PS_MODE_MAX: ++ RLBM = 1; ++ Mode = 1; + break; -+ } -+ } -+ end = rtw_get_current_time(); -+ -+ _exit_critical_mutex(mutex, NULL); -+ -+ if (DBG_SEC_CAM_ACCESS || timeout) { -+ DBG_871X(FUNC_ADPT_FMT" addr:0x%02x, wdata:0x%08x, to:%u, polling:%u, %d ms\n" -+ , FUNC_ADPT_ARG(adapter), addr, wdata, timeout, cnt, rtw_get_time_interval_ms(start, end)); -+ } -+} -+ -+void rtw_sec_read_cam_ent(_adapter *adapter, u8 id, u8 *ctrl, u8 *mac, u8 *key) -+{ -+ unsigned int val, addr; -+ u8 i; -+ u32 rdata; -+ u8 begin = 0; -+ u8 end = 5; /* TODO: consider other key length accordingly */ -+ -+ if (!ctrl && !mac && !key) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ /* TODO: check id range */ -+ -+ if (!ctrl && !mac) -+ begin = 2; /* read from key */ -+ -+ if (!key && !mac) -+ end = 0; /* read to ctrl */ -+ else if (!key) -+ end = 2; /* read to mac */ -+ -+ for (i = begin; i <= end; i++) { -+ rdata = rtw_sec_read_cam(adapter, (id << 3) | i); -+ -+ switch (i) { -+ case 0: -+ if (ctrl) -+ _rtw_memcpy(ctrl, (u8 *)(&rdata), 2); -+ if (mac) -+ _rtw_memcpy(mac, ((u8 *)(&rdata)) + 2, 2); ++ case PS_MODE_DTIM: ++ RLBM = 2; ++ Mode = 1; + break; -+ case 1: -+ if (mac) -+ _rtw_memcpy(mac + 2, (u8 *)(&rdata), 4); ++ case PS_MODE_UAPSD_WMM: ++ Mode = 2; + break; + default: -+ if (key) -+ _rtw_memcpy(key + (i - 2) * 4, (u8 *)(&rdata), 4); ++ Mode = 0; + break; -+ } + } + -+exit: -+ return; -+} -+ -+ -+void rtw_sec_write_cam_ent(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) -+{ -+ unsigned int i; -+ int j; -+ u8 addr; -+ u32 wdata; -+ -+ /* TODO: consider other key length accordingly */ -+#if 0 -+ switch ((ctrl & 0x1c) >> 2) { -+ case _WEP40_: -+ case _TKIP_ -+ case _AES_ -+ case _WEP104_ -+ -+ } -+#else -+ j = 5; -+#endif -+ -+ for (; j >= 0; j--) { -+ switch (j) { -+ case 0: -+ wdata = (ctrl | (mac[0] << 16) | (mac[1] << 24)); -+ break; -+ case 1: -+ wdata = (mac[2] | (mac[3] << 8) | (mac[4] << 16) | (mac[5] << 24)); -+ break; -+ default: -+ i = (j - 2) << 2; -+ wdata = (key[i] | (key[i + 1] << 8) | (key[i + 2] << 16) | (key[i + 3] << 24)); -+ break; -+ } -+ -+ addr = (id << 3) + j; -+ -+ rtw_sec_write_cam(adapter, addr, wdata); -+ } -+} -+ -+bool rtw_sec_read_cam_is_gk(_adapter *adapter, u8 id) -+{ -+ bool res; -+ u16 ctrl; -+ -+ rtw_sec_read_cam_ent(adapter, id, (u8 *)&ctrl, NULL, NULL); -+ -+ res = (ctrl & BIT6) ? _TRUE : _FALSE; -+ return res; -+} -+ -+void hw_var_port_switch(_adapter *adapter) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_RUNTIME_PORT_SWITCH -+/* -+0x102: MSR -+0x550: REG_BCN_CTRL -+0x551: REG_BCN_CTRL_1 -+0x55A: REG_ATIMWND -+0x560: REG_TSFTR -+0x568: REG_TSFTR1 -+0x570: REG_ATIMWND_1 -+0x610: REG_MACID -+0x618: REG_BSSID -+0x700: REG_MACID1 -+0x708: REG_BSSID1 -+*/ -+ -+ int i; -+ u8 msr; -+ u8 bcn_ctrl; -+ u8 bcn_ctrl_1; -+ u8 atimwnd[2]; -+ u8 atimwnd_1[2]; -+ u8 tsftr[8]; -+ u8 tsftr_1[8]; -+ u8 macid[6]; -+ u8 bssid[6]; -+ u8 macid_1[6]; -+ u8 bssid_1[6]; -+ -+ u8 iface_type; -+ -+ msr = rtw_read8(adapter, MSR); -+ bcn_ctrl = rtw_read8(adapter, REG_BCN_CTRL); -+ bcn_ctrl_1 = rtw_read8(adapter, REG_BCN_CTRL_1); -+ -+ for (i=0; i<2; i++) -+ atimwnd[i] = rtw_read8(adapter, REG_ATIMWND+i); -+ for (i=0; i<2; i++) -+ atimwnd_1[i] = rtw_read8(adapter, REG_ATIMWND_1+i); -+ -+ for (i=0; i<8; i++) -+ tsftr[i] = rtw_read8(adapter, REG_TSFTR+i); -+ for (i=0; i<8; i++) -+ tsftr_1[i] = rtw_read8(adapter, REG_TSFTR1+i); -+ -+ for (i=0; i<6; i++) -+ macid[i] = rtw_read8(adapter, REG_MACID+i); -+ -+ for (i=0; i<6; i++) -+ bssid[i] = rtw_read8(adapter, REG_BSSID+i); -+ -+ for (i=0; i<6; i++) -+ macid_1[i] = rtw_read8(adapter, REG_MACID1+i); -+ -+ for (i=0; i<6; i++) -+ bssid_1[i] = rtw_read8(adapter, REG_BSSID1+i); -+ -+#ifdef DBG_RUNTIME_PORT_SWITCH -+ DBG_871X(FUNC_ADPT_FMT" before switch\n" -+ "msr:0x%02x\n" -+ "bcn_ctrl:0x%02x\n" -+ "bcn_ctrl_1:0x%02x\n" -+ "atimwnd:0x%04x\n" -+ "atimwnd_1:0x%04x\n" -+ "tsftr:%llu\n" -+ "tsftr1:%llu\n" -+ "macid:"MAC_FMT"\n" -+ "bssid:"MAC_FMT"\n" -+ "macid_1:"MAC_FMT"\n" -+ "bssid_1:"MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter) -+ , msr -+ , bcn_ctrl -+ , bcn_ctrl_1 -+ , *((u16*)atimwnd) -+ , *((u16*)atimwnd_1) -+ , *((u64*)tsftr) -+ , *((u64*)tsftr_1) -+ , MAC_ARG(macid) -+ , MAC_ARG(bssid) -+ , MAC_ARG(macid_1) -+ , MAC_ARG(bssid_1) -+ ); -+#endif /* DBG_RUNTIME_PORT_SWITCH */ -+ -+ /* disable bcn function, disable update TSF */ -+ rtw_write8(adapter, REG_BCN_CTRL, (bcn_ctrl & (~EN_BCN_FUNCTION)) | DIS_TSF_UDT); -+ rtw_write8(adapter, REG_BCN_CTRL_1, (bcn_ctrl_1 & (~EN_BCN_FUNCTION)) | DIS_TSF_UDT); -+ -+ /* switch msr */ -+ msr = (msr&0xf0) |((msr&0x03) << 2) | ((msr&0x0c) >> 2); -+ rtw_write8(adapter, MSR, msr); -+ -+ /* write port0 */ -+ rtw_write8(adapter, REG_BCN_CTRL, bcn_ctrl_1 & ~EN_BCN_FUNCTION); -+ for (i=0; i<2; i++) -+ rtw_write8(adapter, REG_ATIMWND+i, atimwnd_1[i]); -+ for (i=0; i<8; i++) -+ rtw_write8(adapter, REG_TSFTR+i, tsftr_1[i]); -+ for (i=0; i<6; i++) -+ rtw_write8(adapter, REG_MACID+i, macid_1[i]); -+ for (i=0; i<6; i++) -+ rtw_write8(adapter, REG_BSSID+i, bssid_1[i]); -+ -+ /* write port1 */ -+ rtw_write8(adapter, REG_BCN_CTRL_1, bcn_ctrl & ~EN_BCN_FUNCTION); -+ for (i=0; i<2; i++) -+ rtw_write8(adapter, REG_ATIMWND_1+1, atimwnd[i]); -+ for (i=0; i<8; i++) -+ rtw_write8(adapter, REG_TSFTR1+i, tsftr[i]); -+ for (i=0; i<6; i++) -+ rtw_write8(adapter, REG_MACID1+i, macid[i]); -+ for (i=0; i<6; i++) -+ rtw_write8(adapter, REG_BSSID1+i, bssid[i]); -+ -+ /* write bcn ctl */ -+#ifdef CONFIG_BT_COEXIST -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) -+ // always enable port0 beacon function for PSTDMA -+ bcn_ctrl_1 |= EN_BCN_FUNCTION; -+ // always disable port1 beacon function for PSTDMA -+ bcn_ctrl &= ~EN_BCN_FUNCTION; -+#endif -+#endif -+ rtw_write8(adapter, REG_BCN_CTRL, bcn_ctrl_1); -+ rtw_write8(adapter, REG_BCN_CTRL_1, bcn_ctrl); -+ -+ if (adapter->iface_type == IFACE_PORT0) { -+ adapter->iface_type = IFACE_PORT1; -+ adapter->pbuddy_adapter->iface_type = IFACE_PORT0; -+ DBG_871X_LEVEL(_drv_always_, "port switch - port0("ADPT_FMT"), port1("ADPT_FMT")\n", -+ ADPT_ARG(adapter->pbuddy_adapter), ADPT_ARG(adapter)); ++ if (Mode > PS_MODE_ACTIVE) { ++ PowerState = 0x00;// AllON(0x0C), RFON(0x04), RFOFF(0x00) ++#ifdef CONFIG_EXT_CLK ++ Mode |= BIT(7);//supporting 26M XTAL CLK_Request feature. ++#endif //CONFIG_EXT_CLK + } else { -+ adapter->iface_type = IFACE_PORT0; -+ adapter->pbuddy_adapter->iface_type = IFACE_PORT1; -+ DBG_871X_LEVEL(_drv_always_, "port switch - port0("ADPT_FMT"), port1("ADPT_FMT")\n", -+ ADPT_ARG(adapter), ADPT_ARG(adapter->pbuddy_adapter)); ++ PowerState = 0x0C;// AllON(0x0C), RFON(0x04), RFOFF(0x00) + } + -+#ifdef DBG_RUNTIME_PORT_SWITCH -+ msr = rtw_read8(adapter, MSR); -+ bcn_ctrl = rtw_read8(adapter, REG_BCN_CTRL); -+ bcn_ctrl_1 = rtw_read8(adapter, REG_BCN_CTRL_1); ++ // 0: Active, 1: LPS, 2: WMMPS ++ SET_8812_H2CCMD_PWRMODE_PARM_MODE(u1H2CSetPwrMode, Mode); + -+ for (i=0; i<2; i++) -+ atimwnd[i] = rtw_read8(adapter, REG_ATIMWND+i); -+ for (i=0; i<2; i++) -+ atimwnd_1[i] = rtw_read8(adapter, REG_ATIMWND_1+i); ++ // 0:Min, 1:Max , 2:User define ++ SET_8812_H2CCMD_PWRMODE_PARM_RLBM(u1H2CSetPwrMode, RLBM); + -+ for (i=0; i<8; i++) -+ tsftr[i] = rtw_read8(adapter, REG_TSFTR+i); -+ for (i=0; i<8; i++) -+ tsftr_1[i] = rtw_read8(adapter, REG_TSFTR1+i); ++ // (LPS) smart_ps: 0: PS_Poll, 1: PS_Poll , 2: NullData ++ // (WMM)smart_ps: 0:PS_Poll, 1:NullData ++ SET_8812_H2CCMD_PWRMODE_PARM_SMART_PS(u1H2CSetPwrMode, pwrpriv->smart_ps); + -+ for (i=0; i<6; i++) -+ macid[i] = rtw_read8(adapter, REG_MACID+i); ++ // AwakeInterval: Unit is beacon interval, this field is only valid in PS_DTIM mode ++ SET_8812_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(u1H2CSetPwrMode, LPSAwakeIntvl); + -+ for (i=0; i<6; i++) -+ bssid[i] = rtw_read8(adapter, REG_BSSID+i); ++ // (WMM only)bAllQueueUAPSD ++ SET_8812_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(u1H2CSetPwrMode, padapter->registrypriv.uapsd_enable); + -+ for (i=0; i<6; i++) -+ macid_1[i] = rtw_read8(adapter, REG_MACID1+i); ++ // AllON(0x0C), RFON(0x04), RFOFF(0x00) ++ SET_8812_H2CCMD_PWRMODE_PARM_PWR_STATE(u1H2CSetPwrMode, PowerState); + -+ for (i=0; i<6; i++) -+ bssid_1[i] = rtw_read8(adapter, REG_BSSID1+i); ++ FillH2CCmd_8812(padapter, H2C_8812_SETPWRMODE, sizeof(u1H2CSetPwrMode), (u8 *)&u1H2CSetPwrMode); + -+ DBG_871X(FUNC_ADPT_FMT" after switch\n" -+ "msr:0x%02x\n" -+ "bcn_ctrl:0x%02x\n" -+ "bcn_ctrl_1:0x%02x\n" -+ "atimwnd:%u\n" -+ "atimwnd_1:%u\n" -+ "tsftr:%llu\n" -+ "tsftr1:%llu\n" -+ "macid:"MAC_FMT"\n" -+ "bssid:"MAC_FMT"\n" -+ "macid_1:"MAC_FMT"\n" -+ "bssid_1:"MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter) -+ , msr -+ , bcn_ctrl -+ , bcn_ctrl_1 -+ , *((u16*)atimwnd) -+ , *((u16*)atimwnd_1) -+ , *((u64*)tsftr) -+ , *((u64*)tsftr_1) -+ , MAC_ARG(macid) -+ , MAC_ARG(bssid) -+ , MAC_ARG(macid_1) -+ , MAC_ARG(bssid_1) -+ ); -+#endif /* DBG_RUNTIME_PORT_SWITCH */ + -+#endif /* CONFIG_RUNTIME_PORT_SWITCH */ -+#endif /* CONFIG_CONCURRENT_MODE */ +} + -+void rtw_hal_set_FwRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) ++void rtl8812_set_FwMediaStatus_cmd(PADAPTER padapter, u16 mstatus_rpt ) +{ -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ u8 u1H2CRsvdPageParm[H2C_RSVDPAGE_LOC_LEN]={0}; -+ u8 ret = 0; ++ u8 u1JoinBssRptParm[3]={0}; ++ u8 mstatus, macId, macId_Ind = 0, macId_End = 0; + -+ DBG_871X("RsvdPageLoc: ProbeRsp=%d PsPoll=%d BTNull=%d Null=%d QoSNull=%d\n", -+ rsvdpageloc->LocProbeRsp, rsvdpageloc->LocPsPoll, rsvdpageloc->LocBTQosNull, -+ rsvdpageloc->LocNullData, rsvdpageloc->LocQosNull); ++ mstatus = (u8) (mstatus_rpt & 0xFF); ++ macId = (u8)(mstatus_rpt >> 8) ; + -+ SET_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(u1H2CRsvdPageParm, rsvdpageloc->LocProbeRsp); -+ SET_H2CCMD_RSVDPAGE_LOC_PSPOLL(u1H2CRsvdPageParm, rsvdpageloc->LocPsPoll); -+ SET_H2CCMD_RSVDPAGE_LOC_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocNullData); -+ SET_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocQosNull); -+ SET_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocBTQosNull); ++ SET_8812_H2CCMD_MSRRPT_PARM_OPMODE(u1JoinBssRptParm, mstatus); ++ SET_8812_H2CCMD_MSRRPT_PARM_MACID_IND(u1JoinBssRptParm, macId_Ind); + -+ ret = rtw_hal_fill_h2c_cmd(padapter, -+ H2C_RSVD_PAGE, -+ H2C_RSVDPAGE_LOC_LEN, -+ u1H2CRsvdPageParm); ++ SET_8812_H2CCMD_MSRRPT_PARM_MACID(u1JoinBssRptParm, macId); ++ SET_8812_H2CCMD_MSRRPT_PARM_MACID_END(u1JoinBssRptParm, macId_End); + ++ DBG_871X("[MacId], Set MacId Ctrl(original) = 0x%x \n", u1JoinBssRptParm[0]<<16|u1JoinBssRptParm[1]<<8|u1JoinBssRptParm[2]); ++ ++ FillH2CCmd_8812(padapter, H2C_8812_MSRRPT, 3, u1JoinBssRptParm); +} + -+#ifdef CONFIG_GPIO_WAKEUP -+/* -+ * Switch GPIO_13, GPIO_14 to wlan control, or pull GPIO_13,14 MUST fail. -+ * It happended at 8723B/8192E/8821A. New IC will check multi function GPIO, -+ * and implement HAL function. -+ */ -+static void rtw_hal_switch_gpio_wl_ctrl(_adapter* padapter, u8 index, u8 enable) -+{ -+ if (index !=13 && index != 14) return; -+ -+ rtw_hal_set_hwreg(padapter, HW_SET_GPIO_WL_CTRL, (u8 *)(&enable)); -+} -+ -+void rtw_hal_set_output_gpio(_adapter *padapter, u8 index, u8 outputval) -+{ -+ if ( index <= 7 ) { -+ /* config GPIO mode */ -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 3, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL + 3) & ~BIT(index) ); -+ -+ /* config GPIO Sel */ -+ /* 0: input */ -+ /* 1: output */ -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 2, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL + 2) | BIT(index)); -+ -+ /* set output value */ -+ if ( outputval ) { -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 1, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL + 1) | BIT(index)); -+ } else { -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 1, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL + 1) & ~BIT(index)); -+ } -+ } else if (index <= 15){ -+ /* 88C Series: */ -+ /* index: 11~8 transform to 3~0 */ -+ /* 8723 Series: */ -+ /* index: 12~8 transform to 4~0 */ -+ -+ index -= 8; -+ -+ /* config GPIO mode */ -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 3, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 3) & ~BIT(index) ); -+ -+ /* config GPIO Sel */ -+ /* 0: input */ -+ /* 1: output */ -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 2, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 2) | BIT(index)); -+ -+ /* set output value */ -+ if ( outputval ) { -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 1, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 1) | BIT(index)); -+ } else { -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 1, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 1) & ~BIT(index)); -+ } -+ } else { -+ DBG_871X("%s: invalid GPIO%d=%d\n", -+ __FUNCTION__, index, outputval); -+ } -+} -+#endif -+ -+void rtw_hal_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) -+{ -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 res = 0, count = 0, ret = 0; -+#ifdef CONFIG_WOWLAN -+ u8 u1H2CAoacRsvdPageParm[H2C_AOAC_RSVDPAGE_LOC_LEN]={0}; -+ -+ DBG_871X("AOACRsvdPageLoc: ArpRsp=%d RWC=%d GtkInfo=%d GtkRsp=%d NbrAdv=%d ProbeReq=%d NetworkList=%d\n", -+ rsvdpageloc->LocArpRsp, rsvdpageloc->LocRemoteCtrlInfo, -+ rsvdpageloc->LocGTKInfo, rsvdpageloc->LocGTKRsp, -+ rsvdpageloc->LocNbrAdv, rsvdpageloc->LocProbeReq, -+ rsvdpageloc->LocNetList); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) { -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocRemoteCtrlInfo); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocArpRsp); -+ //SET_H2CCMD_AOAC_RSVDPAGE_LOC_NEIGHBOR_ADV(u1H2CAoacRsvdPageParm, rsvdpageloc->LocNbrAdv); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKRsp); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKInfo); -+#ifdef CONFIG_GTK_OL -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_EXT_MEM(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKEXTMEM); -+#endif // CONFIG_GTK_OL -+ ret = rtw_hal_fill_h2c_cmd(padapter, -+ H2C_AOAC_RSVD_PAGE, -+ H2C_AOAC_RSVDPAGE_LOC_LEN, -+ u1H2CAoacRsvdPageParm); -+ } -+#ifdef CONFIG_PNO_SUPPORT -+ else -+ { -+ -+ if(!pwrpriv->pno_in_resume) { -+ DBG_871X("NLO_INFO=%d\n", rsvdpageloc->LocPNOInfo); -+ _rtw_memset(&u1H2CAoacRsvdPageParm, 0, -+ sizeof(u1H2CAoacRsvdPageParm)); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_NLO_INFO(u1H2CAoacRsvdPageParm, -+ rsvdpageloc->LocPNOInfo); -+ ret = rtw_hal_fill_h2c_cmd(padapter, -+ H2C_AOAC_RSVDPAGE3, -+ H2C_AOAC_RSVDPAGE_LOC_LEN, -+ u1H2CAoacRsvdPageParm); -+ } -+ } -+#endif //CONFIG_PNO_SUPPORT -+#endif // CONFIG_WOWLAN -+} -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+static void rtw_hal_force_enable_rxdma(_adapter *adapter) -+{ -+ DBG_871X("%s: Set 0x690=0x00\n", __func__); -+ rtw_write8(adapter, REG_WOW_CTRL, -+ (rtw_read8(adapter, REG_WOW_CTRL)&0xf0)); -+ DBG_871X_LEVEL(_drv_always_, "%s: Release RXDMA\n", __func__); -+ rtw_write32(adapter, REG_RXPKT_NUM, -+ (rtw_read32(adapter,REG_RXPKT_NUM)&(~RW_RELEASE_EN))); -+} -+ -+static void rtw_hal_disable_tx_report(_adapter *adapter) -+{ -+ rtw_write8(adapter, REG_TX_RPT_CTRL, -+ ((rtw_read8(adapter, REG_TX_RPT_CTRL)&~BIT(1)))&~BIT(5)); -+ DBG_871X("disable TXRPT:0x%02x\n", rtw_read8(adapter, REG_TX_RPT_CTRL)); -+} -+ -+static void rtw_hal_enable_tx_report(_adapter *adapter) -+{ -+ rtw_write8(adapter, REG_TX_RPT_CTRL, -+ ((rtw_read8(adapter, REG_TX_RPT_CTRL)|BIT(1)))|BIT(5)); -+ DBG_871X("enable TX_RPT:0x%02x\n", rtw_read8(adapter, REG_TX_RPT_CTRL)); -+} -+ -+static void rtw_hal_release_rx_dma(_adapter *adapter) -+{ -+ u32 val32 = 0; -+ -+ val32 = rtw_read32(adapter, REG_RXPKT_NUM); -+ -+ rtw_write32(adapter, REG_RXPKT_NUM, (val32 & (~RW_RELEASE_EN))); -+ -+ DBG_871X("%s, [0x%04x]: 0x%08x\n", -+ __func__, REG_RXPKT_NUM, (val32 & (~RW_RELEASE_EN))); -+} -+ -+static u8 rtw_hal_pause_rx_dma(_adapter *adapter) -+{ -+ u8 ret = 0; -+ s8 trycnt = 100; -+ u16 len = 0; -+ u32 tmp = 0; -+ int res = 0; -+ //RX DMA stop -+ DBG_871X_LEVEL(_drv_always_, "Pause DMA\n"); -+ rtw_write32(adapter, REG_RXPKT_NUM, -+ (rtw_read32(adapter,REG_RXPKT_NUM)|RW_RELEASE_EN)); -+ do{ -+ if((rtw_read32(adapter, REG_RXPKT_NUM)&RXDMA_IDLE)) { -+ DBG_871X_LEVEL(_drv_always_, "RX_DMA_IDLE is true\n"); -+ ret = _SUCCESS; -+ break; -+ } -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ else { -+ // If RX_DMA is not idle, receive one pkt from DMA -+ res = sdio_local_read(adapter, -+ SDIO_REG_RX0_REQ_LEN, 4, (u8*)&tmp); -+ len = le16_to_cpu(tmp); -+ DBG_871X_LEVEL(_drv_always_, "RX len:%d\n", len); -+ -+ if (len > 0) -+ res = RecvOnePkt(adapter, len); -+ else -+ DBG_871X_LEVEL(_drv_always_, "read length fail %d\n", len); -+ -+ DBG_871X_LEVEL(_drv_always_, -+ "RecvOnePkt Result: %d\n", res); -+ } -+#endif //CONFIG_SDIO_HCI || CONFIG_GSPI_HCI -+#ifdef CONFIG_USB_HCI -+ else { -+ if (adapter->intf_start) -+ adapter->intf_start(adapter); -+ tmp = rtw_read32(adapter, REG_RXPKT_NUM) & RXDMA_IDLE; -+ if (tmp) { -+ if (adapter->intf_stop) -+ adapter->intf_stop(adapter); -+ RTW_ENABLE_FUNC(adapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(adapter, DF_TX_BIT); -+ } -+ } -+#endif -+ }while(trycnt--); -+ -+ if (trycnt < 0) { -+ tmp = rtw_read16(adapter, REG_RXPKT_NUM + 3); -+ -+ DBG_871X_LEVEL(_drv_always_, "Stop RX DMA failed......\n"); -+ DBG_871X_LEVEL(_drv_always_, "%s, RXPKT_NUM: 0x%04x\n", -+ __func__, tmp); -+ tmp = rtw_read16(adapter, REG_RXPKT_NUM + 2); -+ if (tmp & BIT(3)) -+ DBG_871X_LEVEL(_drv_always_, "%s, RX DMA has req\n", -+ __func__); -+ else -+ DBG_871X_LEVEL(_drv_always_, "%s, RX DMA no req\n", -+ __func__); -+ ret = _FAIL; -+ } -+ -+ return ret; -+} -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+static u8 rtw_hal_enable_cpwm2(_adapter* adapter) -+{ -+ u8 ret = 0; -+ int res = 0; -+ u32 tmp = 0; -+ -+ DBG_871X_LEVEL(_drv_always_, "%s\n", __func__); -+ -+ res = sdio_local_read(adapter, SDIO_REG_HIMR, 4, (u8*)&tmp); -+ if (!res) -+ DBG_871X_LEVEL(_drv_info_, "read SDIO_REG_HIMR: 0x%08x\n", tmp); -+ else -+ DBG_871X_LEVEL(_drv_info_, "sdio_local_read fail\n"); -+ -+ tmp = SDIO_HIMR_CPWM2_MSK; -+ -+ res = sdio_local_write(adapter, SDIO_REG_HIMR, 4, (u8*)&tmp); -+ -+ if (!res){ -+ res = sdio_local_read(adapter, SDIO_REG_HIMR, 4, (u8*)&tmp); -+ DBG_871X_LEVEL(_drv_info_, "read again SDIO_REG_HIMR: 0x%08x\n", tmp); -+ ret = _SUCCESS; -+ }else { -+ DBG_871X_LEVEL(_drv_info_, "sdio_local_write fail\n"); -+ ret = _FAIL; -+ } -+ -+ return ret; -+} -+#endif /* CONFIG_SDIO_HCI, CONFIG_GSPI_HCI */ -+#endif /* CONFIG_WOWLAN || CONFIG_AP_WOWLAN */ -+ -+#ifdef CONFIG_WOWLAN -+/* -+ * rtw_hal_check_wow_ctrl -+ * chk_type: _TRUE means to check enable, if 0x690 & bit1, WOW enable successful -+ * _FALSE means to check disable, if 0x690 & bit1, WOW disable fail -+ */ -+static u8 rtw_hal_check_wow_ctrl(_adapter *adapter, u8 chk_type) -+{ -+ u8 mstatus = 0; -+ u8 trycnt = 25; -+ u8 res = _FALSE; -+ -+ mstatus = rtw_read8(adapter, REG_WOW_CTRL); -+ DBG_871X_LEVEL(_drv_info_, "%s mstatus:0x%02x\n", __func__, mstatus); -+ -+ if (chk_type) { -+ while (!(mstatus&BIT1) && trycnt > 1) { -+ mstatus = rtw_read8(adapter, REG_WOW_CTRL); -+ DBG_871X_LEVEL(_drv_always_, -+ "Loop index: %d :0x%02x\n", -+ trycnt, mstatus); -+ trycnt--; -+ rtw_msleep_os(20); -+ } -+ if (mstatus & BIT1) -+ res = _TRUE; -+ else -+ res = _FALSE; -+ } else { -+ while (mstatus&BIT1 && trycnt > 1) { -+ mstatus = rtw_read8(adapter, REG_WOW_CTRL); -+ DBG_871X_LEVEL(_drv_always_, -+ "Loop index: %d :0x%02x\n", -+ trycnt, mstatus); -+ trycnt--; -+ rtw_msleep_os(20); -+ } -+ -+ if (mstatus & BIT1) -+ res = _FALSE; -+ else -+ res = _TRUE; -+ } -+ DBG_871X_LEVEL(_drv_always_, "%s check_type: %d res: %d trycnt: %d\n", -+ __func__, chk_type, res, (25 - trycnt)); -+ return res; -+} -+ -+#ifdef CONFIG_PNO_SUPPORT -+static u8 rtw_hal_check_pno_enabled(_adapter *adapter) -+{ -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); -+ u8 res = 0, count = 0; -+ u8 ret = _FALSE; -+ -+ if (ppwrpriv->wowlan_pno_enable && ppwrpriv->pno_in_resume == _FALSE) { -+ res = rtw_read8(adapter, REG_PNO_STATUS); -+ while (!(res&BIT(7)) && count < 25) { -+ DBG_871X("[%d] cmd: 0x81 REG_PNO_STATUS: 0x%02x\n", -+ count, res); -+ res = rtw_read8(adapter, REG_PNO_STATUS); -+ count++; -+ rtw_msleep_os(2); -+ } -+ if (res & BIT(7)) -+ ret = _TRUE; -+ else -+ ret = _FALSE; -+ DBG_871X("cmd: 0x81 REG_PNO_STATUS: ret(%d)\n", ret); -+ } -+ return ret; -+} -+#endif -+ -+static void rtw_hal_backup_rate(_adapter *adapter) -+{ -+ DBG_871X("%s\n", __func__); -+ /* backup data rate to register 0x8b for wowlan FW */ -+ rtw_write8(adapter, 0x8d, 1); -+ rtw_write8(adapter, 0x8c, 0); -+ rtw_write8(adapter, 0x8f, 0x40); -+ rtw_write8(adapter, 0x8b, rtw_read8(adapter, 0x2f0)); -+} -+ -+#ifdef CONFIG_GTK_OL -+static void rtw_hal_fw_sync_cam_id(_adapter *adapter) -+{ -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ u8 null_addr[] = {0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; -+ int cam_id; -+ u32 algorithm = 0; -+ u16 ctrl = 0; -+ u8 *addr; -+ u8 index = 0; -+ u8 get_key[16]; -+ -+ addr = get_bssid(&adapter->mlmepriv); -+ -+ if (addr == NULL) { -+ DBG_871X("%s: get bssid MAC addr fail!!\n", __func__); -+ return; -+ } -+ -+ do{ -+ cam_id = rtw_camid_search(adapter, addr, index, -1); -+ if (cam_id == -1) { -+ DBG_871X("%s: cam_id: %d, key_id:%d\n", -+ __func__, cam_id, index); -+ } else if (rtw_camid_is_gk(adapter, cam_id) != _TRUE) { -+ DBG_871X("%s: cam_id: %d key_id(%d) is not GK\n", -+ __func__, cam_id, index); -+ } else { -+ rtw_sec_read_cam_ent(adapter, cam_id, NULL, NULL, get_key); -+ algorithm = psecuritypriv->dot11PrivacyAlgrthm; -+ ctrl = BIT(15) | BIT6 |(algorithm << 2) | index; -+ write_cam(adapter, index, ctrl, addr, get_key); -+ ctrl = 0; -+ write_cam(adapter, cam_id, ctrl, null_addr, get_key); -+ } -+ index++; -+ }while(index < 4); -+ -+ rtw_write8(adapter, REG_SECCFG, 0xcc); -+} -+ -+static void rtw_hal_update_gtk_offload_info(_adapter *adapter) -+{ -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ u8 default_cam_id = 0; -+ u8 cam_id=5; -+ u8 *addr; -+ u8 null_addr[] = {0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; -+ u8 gtk_keyindex=0; -+ u8 get_key[16]; -+ u8 index = 1; -+ u16 ctrl = 0; -+ u32 algorithm = 0; -+ -+ addr = get_bssid(&adapter->mlmepriv); -+ -+ if (addr == NULL) { -+ DBG_871X("%s: get bssid MAC addr fail!!\n", __func__); -+ return; -+ } -+ -+ _rtw_memset(get_key, 0, sizeof(get_key)); -+ -+ algorithm = psecuritypriv->dot11PrivacyAlgrthm; -+ -+ if(psecuritypriv->binstallKCK_KEK == _TRUE) { -+ -+ //read gtk key index -+ gtk_keyindex = rtw_read8(adapter, 0x48c); -+ do{ -+ /* chech if GK */ -+ if (rtw_sec_read_cam_is_gk(adapter, default_cam_id) == _TRUE) { -+ rtw_sec_read_cam_ent(adapter, default_cam_id, NULL, NULL, get_key); -+ algorithm = psecuritypriv->dot11PrivacyAlgrthm; -+ /* in default cam entry, cam id = key id */ -+ ctrl = BIT(15) | BIT6 | (algorithm << 2) | default_cam_id; -+ write_cam(adapter, cam_id, ctrl, addr, get_key); -+ cam_id++; -+ ctrl = 0; -+ write_cam(adapter, default_cam_id, ctrl, null_addr, get_key); -+ } -+ -+ if (gtk_keyindex < 4 && (default_cam_id == gtk_keyindex)) { -+ psecuritypriv->dot118021XGrpKeyid = gtk_keyindex; -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey, -+ get_key, 16); -+ -+ DBG_871X_LEVEL(_drv_always_, "GTK (%d) = 0x%08x, 0x%08x, 0x%08x, 0x%08x\n", -+ gtk_keyindex, -+ psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].lkey[0], -+ psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].lkey[1], -+ psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].lkey[2], -+ psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].lkey[3]); -+ } -+ default_cam_id++; -+ } while (default_cam_id < 4); -+ -+ rtw_write8(adapter, REG_SECCFG, 0x0c); -+#ifdef CONFIG_GTK_OL_DBG -+ //if (gtk_keyindex != 5) -+ dump_sec_cam(RTW_DBGDUMP, adapter); -+#endif -+ } -+} -+#endif -+ -+static void rtw_hal_update_tx_iv(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ u64 iv_low = 0, iv_high = 0; -+ -+ // 3.1 read fw iv -+ iv_low = rtw_read32(adapter, REG_TXPKTBUF_IV_LOW); -+ //only low two bytes is PN, check AES_IV macro for detail -+ iv_low &= 0xffff; -+ iv_high = rtw_read32(adapter, REG_TXPKTBUF_IV_HIGH); -+ //get the real packet number -+ pwrctl->wowlan_fw_iv = iv_high << 16 | iv_low; -+ DBG_871X_LEVEL(_drv_always_, -+ "fw_iv: 0x%016llx\n", pwrctl->wowlan_fw_iv); -+ //Update TX iv data. -+ rtw_set_sec_pn(adapter); -+} -+ -+static u8 rtw_hal_set_keep_alive_cmd(_adapter *adapter, u8 enable, u8 pkt_type) -+{ -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ -+ u8 u1H2CKeepAliveParm[H2C_KEEP_ALIVE_CTRL_LEN]={0}; -+ u8 adopt = 1, check_period = 5; -+ u8 ret = _FAIL; -+ -+ DBG_871X("%s(): enable = %d\n", __func__, enable); -+ SET_H2CCMD_KEEPALIVE_PARM_ENABLE(u1H2CKeepAliveParm, enable); -+ SET_H2CCMD_KEEPALIVE_PARM_ADOPT(u1H2CKeepAliveParm, adopt); -+ SET_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(u1H2CKeepAliveParm, pkt_type); -+ SET_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(u1H2CKeepAliveParm, check_period); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_KEEP_ALIVE, -+ H2C_KEEP_ALIVE_CTRL_LEN, -+ u1H2CKeepAliveParm); -+ -+ return ret; -+} -+ -+static u8 rtw_hal_set_disconnect_decision_cmd(_adapter *adapter, u8 enable) -+{ -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ u8 u1H2CDisconDecisionParm[H2C_DISCON_DECISION_LEN]={0}; -+ u8 adopt = 1, check_period = 10, trypkt_num = 0; -+ u8 ret = _FAIL; -+ -+ DBG_871X("%s(): enable = %d\n", __func__, enable); -+ SET_H2CCMD_DISCONDECISION_PARM_ENABLE(u1H2CDisconDecisionParm, enable); -+ SET_H2CCMD_DISCONDECISION_PARM_ADOPT(u1H2CDisconDecisionParm, adopt); -+ SET_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(u1H2CDisconDecisionParm, check_period); -+ SET_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(u1H2CDisconDecisionParm, trypkt_num); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_DISCON_DECISION, -+ H2C_DISCON_DECISION_LEN, -+ u1H2CDisconDecisionParm); -+ return ret; -+} -+ -+static u8 rtw_hal_set_wowlan_ctrl_cmd(_adapter *adapter, u8 enable, u8 change_unit) -+{ -+ struct security_priv *psecpriv = &adapter->securitypriv; -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ -+ u8 u1H2CWoWlanCtrlParm[H2C_WOWLAN_LEN]={0}; -+ u8 discont_wake = 1, gpionum = 0, gpio_dur = 0; -+ u8 hw_unicast = 0, gpio_pulse_cnt = 0, gpio_pulse_en = 0; -+ u8 sdio_wakeup_enable = 1; -+ u8 gpio_high_active = 0; -+ u8 pattern_en = 0; -+ u8 magic_pkt = 0; -+ u8 gpio_unit = 0; /*0: 64ns, 1: 8ms*/ -+ u8 ret = _FAIL; -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ gpio_high_active = ppwrpriv->is_high_active; -+ gpionum = WAKEUP_GPIO_IDX; -+ sdio_wakeup_enable = 0; -+#endif //CONFIG_GPIO_WAKEUP -+ -+ if (!ppwrpriv->wowlan_pno_enable) -+ magic_pkt = enable; -+ -+ if (psecpriv->dot11PrivacyAlgrthm == _WEP40_ || psecpriv->dot11PrivacyAlgrthm == _WEP104_) -+ hw_unicast = 1; -+ else -+ hw_unicast = 0; -+ -+ if (ppwrpriv->wowlan_pattern) { -+ if (enable) -+ pattern_en = 1; -+ else -+ pattern_en = 0; -+ } -+ -+ DBG_871X("%s(): enable=%d change_unit=%d\n", __func__, -+ enable, change_unit); -+ -+ /* time = (gpio_dur/2) * gpio_unit, default:256 ms */ -+ if (enable && change_unit) { -+ gpio_dur = 0x40; -+ gpio_unit = 1; -+ gpio_pulse_en = 1; -+ } -+ -+#ifdef CONFIG_PLATFORM_ARM_RK3188 -+ if (enable) { -+ gpio_pulse_en = 1; -+ gpio_pulse_cnt = 0x04; -+ } -+#endif -+ -+ SET_H2CCMD_WOWLAN_FUNC_ENABLE(u1H2CWoWlanCtrlParm, enable); -+ SET_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(u1H2CWoWlanCtrlParm, pattern_en); -+ SET_H2CCMD_WOWLAN_MAGIC_PKT_ENABLE(u1H2CWoWlanCtrlParm, magic_pkt); -+ SET_H2CCMD_WOWLAN_UNICAST_PKT_ENABLE(u1H2CWoWlanCtrlParm, hw_unicast); -+ SET_H2CCMD_WOWLAN_ALL_PKT_DROP(u1H2CWoWlanCtrlParm, 0); -+ SET_H2CCMD_WOWLAN_GPIO_ACTIVE(u1H2CWoWlanCtrlParm, gpio_high_active); -+ -+#ifdef CONFIG_GTK_OL -+ if (enable == _TRUE) { -+ /* GTK rekey only for AES, if GTK rekey is TKIP, then wake up*/ -+ if (psecpriv->dot118021XGrpPrivacy == _AES_) -+ SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(u1H2CWoWlanCtrlParm, 0); -+ else if (psecpriv->dot118021XGrpPrivacy == _TKIP_) -+ SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(u1H2CWoWlanCtrlParm, 1); -+ } -+#else -+ SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(u1H2CWoWlanCtrlParm, enable); -+#endif -+ SET_H2CCMD_WOWLAN_DISCONNECT_WAKE_UP(u1H2CWoWlanCtrlParm, discont_wake); -+ SET_H2CCMD_WOWLAN_GPIONUM(u1H2CWoWlanCtrlParm, gpionum); -+ SET_H2CCMD_WOWLAN_DATAPIN_WAKE_UP(u1H2CWoWlanCtrlParm, sdio_wakeup_enable); -+ -+ SET_H2CCMD_WOWLAN_GPIO_DURATION(u1H2CWoWlanCtrlParm, gpio_dur); -+ SET_H2CCMD_WOWLAN_CHANGE_UNIT(u1H2CWoWlanCtrlParm, gpio_unit); -+ -+ SET_H2CCMD_WOWLAN_GPIO_PULSE_EN(u1H2CWoWlanCtrlParm, gpio_pulse_en); -+ SET_H2CCMD_WOWLAN_GPIO_PULSE_COUNT(u1H2CWoWlanCtrlParm, gpio_pulse_cnt); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_WOWLAN, -+ H2C_WOWLAN_LEN, -+ u1H2CWoWlanCtrlParm); -+ return ret; -+} -+ -+static u8 rtw_hal_set_remote_wake_ctrl_cmd(_adapter *adapter, u8 enable) -+{ -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ struct security_priv* psecuritypriv=&(adapter->securitypriv); -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); -+ u8 u1H2CRemoteWakeCtrlParm[H2C_REMOTE_WAKE_CTRL_LEN]={0}; -+ u8 ret = _FAIL, count = 0; -+ -+ DBG_871X("%s(): enable=%d\n", __func__, enable); -+ -+ if (!ppwrpriv->wowlan_pno_enable) { -+ SET_H2CCMD_REMOTE_WAKECTRL_ENABLE( -+ u1H2CRemoteWakeCtrlParm, enable); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, 1); -+#ifdef CONFIG_GTK_OL -+ if (psecuritypriv->binstallKCK_KEK == _TRUE && -+ psecuritypriv->dot11PrivacyAlgrthm == _AES_) { -+ SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, 1); -+ } else { -+ DBG_871X("no kck or security is not AES\n"); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, 0); -+ } -+#endif //CONFIG_GTK_OL -+ -+ SET_H2CCMD_REMOTE_WAKE_CTRL_FW_UNICAST_EN( -+ u1H2CRemoteWakeCtrlParm, -+ !ppwrpriv->wowlan_pattern); -+ -+ /* -+ * filter NetBios name service pkt to avoid being waked-up -+ * by this kind of unicast pkt this exceptional modification -+ * is used for match competitor's behavior -+ */ -+ SET_H2CCMD_REMOTE_WAKE_CTRL_NBNS_FILTER_EN( -+ u1H2CRemoteWakeCtrlParm, !ppwrpriv->wowlan_pattern); -+ -+ if ((psecuritypriv->dot11PrivacyAlgrthm == _AES_) || -+ (psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_)) { -+ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION( -+ u1H2CRemoteWakeCtrlParm, 0); -+ } else { -+ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION( -+ u1H2CRemoteWakeCtrlParm, 1); -+ } -+ -+ SET_H2CCMD_REMOTE_WAKE_CTRL_FW_PARSING_UNTIL_WAKEUP( -+ u1H2CRemoteWakeCtrlParm, 1); -+ } -+#ifdef CONFIG_PNO_SUPPORT -+ else { -+ SET_H2CCMD_REMOTE_WAKECTRL_ENABLE( -+ u1H2CRemoteWakeCtrlParm, enable); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_NLO_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, enable); -+ } -+#endif -+ -+#ifdef CONFIG_P2P_WOWLAN -+ if (_TRUE == ppwrpriv->wowlan_p2p_mode) -+ { -+ DBG_871X("P2P OFFLOAD ENABLE\n"); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(u1H2CRemoteWakeCtrlParm,1); -+ } -+ else -+ { -+ DBG_871X("P2P OFFLOAD DISABLE\n"); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(u1H2CRemoteWakeCtrlParm,0); -+ } -+#endif //CONFIG_P2P_WOWLAN -+ -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_REMOTE_WAKE_CTRL, -+ H2C_REMOTE_WAKE_CTRL_LEN, -+ u1H2CRemoteWakeCtrlParm); -+ return ret; -+} -+ -+static u8 rtw_hal_set_global_info_cmd(_adapter* adapter, u8 group_alg, u8 pairwise_alg) -+{ -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ u8 ret = _FAIL; -+ u8 u1H2CAOACGlobalInfoParm[H2C_AOAC_GLOBAL_INFO_LEN]={0}; -+ -+ DBG_871X("%s(): group_alg=%d pairwise_alg=%d\n", -+ __func__, group_alg, pairwise_alg); -+ SET_H2CCMD_AOAC_GLOBAL_INFO_PAIRWISE_ENC_ALG(u1H2CAOACGlobalInfoParm, -+ pairwise_alg); -+ SET_H2CCMD_AOAC_GLOBAL_INFO_GROUP_ENC_ALG(u1H2CAOACGlobalInfoParm, -+ group_alg); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_AOAC_GLOBAL_INFO, -+ H2C_AOAC_GLOBAL_INFO_LEN, -+ u1H2CAOACGlobalInfoParm); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_PNO_SUPPORT -+static u8 rtw_hal_set_scan_offload_info_cmd(_adapter* adapter, -+ PRSVDPAGE_LOC rsvdpageloc, u8 enable) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ -+ u8 u1H2CScanOffloadInfoParm[H2C_SCAN_OFFLOAD_CTRL_LEN]={0}; -+ u8 res = 0, count = 0, ret = _FAIL; -+ -+ DBG_871X("%s: loc_probe_packet:%d, loc_scan_info: %d loc_ssid_info:%d\n", -+ __func__, rsvdpageloc->LocProbePacket, -+ rsvdpageloc->LocScanInfo, rsvdpageloc->LocSSIDInfo); -+ -+ SET_H2CCMD_AOAC_NLO_FUN_EN(u1H2CScanOffloadInfoParm, enable); -+ SET_H2CCMD_AOAC_NLO_IPS_EN(u1H2CScanOffloadInfoParm, enable); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_SCAN_INFO(u1H2CScanOffloadInfoParm, -+ rsvdpageloc->LocScanInfo); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_PROBE_PACKET(u1H2CScanOffloadInfoParm, -+ rsvdpageloc->LocProbePacket); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_SSID_INFO(u1H2CScanOffloadInfoParm, -+ rsvdpageloc->LocSSIDInfo); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_D0_SCAN_OFFLOAD_INFO, -+ H2C_SCAN_OFFLOAD_CTRL_LEN, -+ u1H2CScanOffloadInfoParm); -+ return ret; -+} -+#endif //CONFIG_PNO_SUPPORT -+ -+void rtw_hal_set_fw_wow_related_cmd(_adapter* padapter, u8 enable) -+{ -+ struct security_priv *psecpriv = &padapter->securitypriv; -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_info *psta = NULL; -+ u16 media_status_rpt; -+ u8 pkt_type = 0; -+ u8 ret = _SUCCESS; -+ -+ DBG_871X_LEVEL(_drv_always_, "+%s()+: enable=%d\n", __func__, enable); -+_func_enter_; -+ -+ rtw_hal_set_wowlan_ctrl_cmd(padapter, enable, _FALSE); -+ -+ if (enable) { -+ rtw_hal_set_global_info_cmd(padapter, -+ psecpriv->dot118021XGrpPrivacy, -+ psecpriv->dot11PrivacyAlgrthm); -+ -+ if (!(ppwrpriv->wowlan_pno_enable)) { -+ rtw_hal_set_disconnect_decision_cmd(padapter, enable); -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ if ((psecpriv->dot11PrivacyAlgrthm == _WEP40_) || -+ (psecpriv->dot11PrivacyAlgrthm == _WEP104_)) -+ pkt_type = 0; -+ else -+ pkt_type = 1; -+#else -+ pkt_type = 0; -+#endif //CONFIG_ARP_KEEP_ALIVE -+ rtw_hal_set_keep_alive_cmd(padapter, enable, pkt_type); -+ } -+ rtw_hal_set_remote_wake_ctrl_cmd(padapter, enable); -+#ifdef CONFIG_PNO_SUPPORT -+ rtw_hal_check_pno_enabled(padapter); -+#endif //CONFIG_PNO_SUPPORT -+ } else { -+#if 0 -+ { -+ u32 PageSize = 0; -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&PageSize); -+ dump_TX_FIFO(padapter, 4, PageSize); -+ } -+#endif -+ -+ rtw_hal_set_remote_wake_ctrl_cmd(padapter, enable); -+ } -+_func_exit_; -+ DBG_871X_LEVEL(_drv_always_, "-%s()-\n", __func__); -+} -+#endif //CONFIG_WOWLAN -+ -+#ifdef CONFIG_AP_WOWLAN -+static u8 rtw_hal_set_ap_wowlan_ctrl_cmd(_adapter *adapter, u8 enable) -+{ -+ struct security_priv *psecpriv = &adapter->securitypriv; -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ -+ u8 u1H2CAPWoWlanCtrlParm[H2C_AP_WOW_GPIO_CTRL_LEN] = {0}; -+ u8 gpionum = 0, gpio_dur = 0; -+ u8 gpio_pulse = enable; -+ u8 sdio_wakeup_enable = 1; -+ u8 gpio_high_active = 0; -+ u8 ret = _FAIL; -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ gpio_high_active = ppwrpriv->is_high_active; -+ gpionum = WAKEUP_GPIO_IDX; -+ sdio_wakeup_enable = 0; -+#endif /*CONFIG_GPIO_WAKEUP*/ -+ -+ DBG_871X("%s(): enable=%d\n", __func__, enable); -+ -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_INDEX(u1H2CAPWoWlanCtrlParm, -+ gpionum); -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_PLUS(u1H2CAPWoWlanCtrlParm, -+ gpio_pulse); -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_HIGH_ACTIVE(u1H2CAPWoWlanCtrlParm, -+ gpio_high_active); -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_EN(u1H2CAPWoWlanCtrlParm, -+ enable); -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_DURATION(u1H2CAPWoWlanCtrlParm, -+ gpio_dur); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_AP_WOW_GPIO_CTRL, -+ H2C_AP_WOW_GPIO_CTRL_LEN, -+ u1H2CAPWoWlanCtrlParm); -+ -+ return ret; -+} -+ -+static u8 rtw_hal_set_ap_offload_ctrl_cmd(_adapter *adapter, u8 enable) -+{ -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ u8 u1H2CAPOffloadCtrlParm[H2C_WOWLAN_LEN] = {0}; -+ u8 ret = _FAIL; -+ -+ DBG_871X("%s(): bFuncEn=%d\n", __func__, enable); -+ -+ SET_H2CCMD_AP_WOWLAN_EN(u1H2CAPOffloadCtrlParm, enable); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_AP_OFFLOAD, -+ H2C_AP_OFFLOAD_LEN, -+ u1H2CAPOffloadCtrlParm); -+ -+ return ret; -+} -+ -+static u8 rtw_hal_set_ap_ps_cmd(_adapter *adapter, u8 enable) -+{ -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ u8 ap_ps_parm[H2C_AP_PS_LEN] = {0}; -+ u8 ret = _FAIL; -+ -+ DBG_871X("%s(): enable=%d\n" , __func__ , enable); -+ -+ SET_H2CCMD_AP_WOW_PS_EN(ap_ps_parm, enable); -+#ifndef CONFIG_USB_HCI -+ SET_H2CCMD_AP_WOW_PS_32K_EN(ap_ps_parm, enable); -+#endif /*CONFIG_USB_HCI*/ -+ SET_H2CCMD_AP_WOW_PS_RF(ap_ps_parm, enable); -+ -+ if (enable) -+ SET_H2CCMD_AP_WOW_PS_DURATION(ap_ps_parm, 0x32); -+ else -+ SET_H2CCMD_AP_WOW_PS_DURATION(ap_ps_parm, 0x0); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_SAP_PS_, -+ H2C_AP_PS_LEN, ap_ps_parm); -+ -+ return ret; -+} -+ -+static void rtw_hal_set_ap_rsvdpage_loc_cmd(PADAPTER padapter, -+ PRSVDPAGE_LOC rsvdpageloc) -+{ -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ u8 rsvdparm[H2C_AOAC_RSVDPAGE_LOC_LEN] = {0}; -+ u8 ret = _FAIL, header = 0; -+ -+ if (pHalFunc->fill_h2c_cmd == NULL) { -+ DBG_871X("%s: Please hook fill_h2c_cmd first!\n", __func__); -+ return; -+ } -+ -+ header = rtw_read8(padapter, REG_BCNQ_BDNY); -+ -+ DBG_871X("%s: beacon: %d, probeRsp: %d, header:0x%02x\n", __func__, -+ rsvdpageloc->LocApOffloadBCN, -+ rsvdpageloc->LocProbeRsp, -+ header); -+ -+ SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_BCN(rsvdparm, -+ rsvdpageloc->LocApOffloadBCN + header); -+ -+ ret = rtw_hal_fill_h2c_cmd(padapter, H2C_BCN_RSVDPAGE, -+ H2C_BCN_RSVDPAGE_LEN, rsvdparm); -+ -+ if (ret == _FAIL) -+ DBG_871X("%s: H2C_BCN_RSVDPAGE cmd fail\n", __func__); -+ -+ rtw_msleep_os(10); -+ -+ _rtw_memset(&rsvdparm, 0, sizeof(rsvdparm)); -+ -+ SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_ProbeRsp(rsvdparm, -+ rsvdpageloc->LocProbeRsp + header); -+ -+ ret = rtw_hal_fill_h2c_cmd(padapter, H2C_PROBERSP_RSVDPAGE, -+ H2C_PROBERSP_RSVDPAGE_LEN, rsvdparm); -+ -+ if (ret == _FAIL) -+ DBG_871X("%s: H2C_PROBERSP_RSVDPAGE cmd fail\n", __func__); -+ -+ rtw_msleep_os(10); -+} -+ -+static void rtw_hal_set_fw_ap_wow_related_cmd(_adapter *padapter, u8 enable) -+{ -+ rtw_hal_set_ap_offload_ctrl_cmd(padapter, enable); -+ rtw_hal_set_ap_wowlan_ctrl_cmd(padapter, enable); -+ rtw_hal_set_ap_ps_cmd(padapter, enable); -+} -+ -+static void rtw_hal_ap_wow_enable(_adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ struct sta_info *psta = NULL; -+#ifdef DBG_CHECK_FW_PS_STATE -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+#endif /*DBG_CHECK_FW_PS_STATE*/ -+ int res; -+ u16 media_status_rpt; -+ -+ DBG_871X("%s, WOWLAN_AP_ENABLE\n", __func__); -+#ifdef DBG_CHECK_FW_PS_STATE -+ if (rtw_fw_ps_state(padapter) == _FAIL) { -+ pdbgpriv->dbg_enwow_dload_fw_fail_cnt++; -+ DBG_871X_LEVEL(_drv_always_, "wowlan enable no leave 32k\n"); -+ } -+#endif /*DBG_CHECK_FW_PS_STATE*/ -+ -+ /* 1. Download WOWLAN FW*/ -+ if (pHalFunc->hal_set_wowlan_fw != NULL) -+ pHalFunc->hal_set_wowlan_fw(padapter, _TRUE); -+ else -+ DBG_871X("hal_set_wowlan_fw is null\n"); -+ -+ media_status_rpt = RT_MEDIA_CONNECT; -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, -+ (u8 *)&media_status_rpt); -+ -+ issue_beacon(padapter, 0); -+ -+ rtw_msleep_os(2); -+ -+ if (IS_HARDWARE_TYPE_8188E(padapter)) -+ rtw_hal_disable_tx_report(padapter); -+ -+ /* RX DMA stop */ -+ res = rtw_hal_pause_rx_dma(padapter); -+ if (res == _FAIL) -+ DBG_871X_LEVEL(_drv_always_, "[WARNING] pause RX DMA fail\n"); -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ /* Enable CPWM2 only. */ -+ res = rtw_hal_enable_cpwm2(padapter); -+ if (res == _FAIL) -+ DBG_871X_LEVEL(_drv_always_, "[WARNING] enable cpwm2 fail\n"); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ rtw_hal_switch_gpio_wl_ctrl(padapter, WAKEUP_GPIO_IDX, _TRUE); -+#endif -+ /* 5. Set Enable WOWLAN H2C command. */ -+ DBG_871X_LEVEL(_drv_always_, "Set Enable AP WOWLan cmd\n"); -+ rtw_hal_set_fw_ap_wow_related_cmd(padapter, 1); -+ -+ rtw_write8(padapter, REG_MCUTST_WOWLAN, 0); -+#ifdef CONFIG_USB_HCI -+ if (padapter->intf_stop) -+ padapter->intf_stop(padapter); -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter))/*free buddy adapter's resource*/ -+ padapter->pbuddy_adapter->intf_stop(padapter->pbuddy_adapter); -+#endif /*CONFIG_CONCURRENT_MODE*/ -+ /* Invoid SE0 reset signal during suspending*/ -+ rtw_write8(padapter, REG_RSV_CTRL, 0x20); -+ rtw_write8(padapter, REG_RSV_CTRL, 0x60); -+#endif /*CONFIG_USB_HCI*/ -+} -+ -+static void rtw_hal_ap_wow_disable(_adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+#ifdef DBG_CHECK_FW_PS_STATE -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+#endif /*DBG_CHECK_FW_PS_STATE*/ -+ u16 media_status_rpt; -+ u8 val8; -+ -+ DBG_871X("%s, WOWLAN_AP_DISABLE\n", __func__); -+ /* 1. Read wakeup reason*/ -+ pwrctl->wowlan_wake_reason = rtw_read8(padapter, REG_MCUTST_WOWLAN); -+ -+ DBG_871X_LEVEL(_drv_always_, "wakeup_reason: 0x%02x\n", -+ pwrctl->wowlan_wake_reason); -+ -+ rtw_hal_set_fw_ap_wow_related_cmd(padapter, 0); -+ -+ rtw_msleep_os(2); -+#ifdef DBG_CHECK_FW_PS_STATE -+ if (rtw_fw_ps_state(padapter) == _FAIL) { -+ pdbgpriv->dbg_diswow_dload_fw_fail_cnt++; -+ DBG_871X_LEVEL(_drv_always_, "wowlan enable no leave 32k\n"); -+ } -+#endif /*DBG_CHECK_FW_PS_STATE*/ -+ -+ if (IS_HARDWARE_TYPE_8188E(padapter)) -+ rtw_hal_enable_tx_report(padapter); -+ -+ rtw_hal_force_enable_rxdma(padapter); -+ -+ if (pHalFunc->hal_set_wowlan_fw != NULL) -+ pHalFunc->hal_set_wowlan_fw(padapter, _FALSE); -+ else -+ DBG_871X("hal_set_wowlan_fw is null\n"); -+#ifdef CONFIG_GPIO_WAKEUP -+ val8 = (pwrctl->is_high_active == 0) ? 1 : 0; -+ DBG_871X_LEVEL(_drv_always_, "Set Wake GPIO to default(%d).\n", val8); -+ rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, val8); -+ rtw_hal_switch_gpio_wl_ctrl(padapter, WAKEUP_GPIO_IDX, _FALSE); -+#endif -+ media_status_rpt = RT_MEDIA_CONNECT; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, -+ (u8 *)&media_status_rpt); -+ -+ issue_beacon(padapter, 0); -+} -+#endif /*CONFIG_AP_WOWLAN*/ -+ -+#ifdef CONFIG_P2P_WOWLAN -+static int update_hidden_ssid(u8 *ies, u32 ies_len, u8 hidden_ssid_mode) -+{ -+ u8 *ssid_ie; -+ sint ssid_len_ori; -+ int len_diff = 0; -+ -+ ssid_ie = rtw_get_ie(ies, WLAN_EID_SSID, &ssid_len_ori, ies_len); -+ -+ //DBG_871X("%s hidden_ssid_mode:%u, ssid_ie:%p, ssid_len_ori:%d\n", __FUNCTION__, hidden_ssid_mode, ssid_ie, ssid_len_ori); -+ -+ if(ssid_ie && ssid_len_ori>0) -+ { -+ switch(hidden_ssid_mode) -+ { -+ case 1: -+ { -+ u8 *next_ie = ssid_ie + 2 + ssid_len_ori; -+ u32 remain_len = 0; -+ -+ remain_len = ies_len -(next_ie-ies); -+ -+ ssid_ie[1] = 0; -+ _rtw_memcpy(ssid_ie+2, next_ie, remain_len); -+ len_diff -= ssid_len_ori; -+ -+ break; -+ } -+ case 2: -+ _rtw_memset(&ssid_ie[2], 0, ssid_len_ori); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ return len_diff; -+} -+ -+static void rtw_hal_construct_P2PBeacon(_adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ //struct xmit_frame *pmgntframe; -+ //struct pkt_attrib *pattrib; -+ //unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned int rate_len; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ u32 pktlen; -+//#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+// _irqL irqL; -+// struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+//#endif //#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif //CONFIG_P2P -+ -+ //for debug -+ u8 *dbgbuf = pframe; -+ u8 dbgbufLen = 0, index = 0; -+ -+ DBG_871X("%s\n", __FUNCTION__); -+//#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+// _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+//#endif //#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ //pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pktlen = sizeof (struct rtw_ieee80211_hdr_3addr); -+ -+ if( (pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ { -+ //DBG_871X("ie len=%d\n", cur_network->IELength); -+#ifdef CONFIG_P2P -+ // for P2P : Primary Device Type & Device Name -+ u32 wpsielen=0, insert_len=0; -+ u8 *wpsie=NULL; -+ wpsie = rtw_get_wps_ie(cur_network->IEs+_FIXED_IE_LENGTH_, cur_network->IELength-_FIXED_IE_LENGTH_, NULL, &wpsielen); -+ -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && wpsie && wpsielen>0) -+ { -+ uint wps_offset, remainder_ielen; -+ u8 *premainder_ie, *pframe_wscie; -+ -+ wps_offset = (uint)(wpsie - cur_network->IEs); -+ -+ premainder_ie = wpsie + wpsielen; -+ -+ remainder_ielen = cur_network->IELength - wps_offset - wpsielen; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(pmlmepriv->wps_beacon_ie && pmlmepriv->wps_beacon_ie_len>0) -+ { -+ _rtw_memcpy(pframe, cur_network->IEs, wps_offset); -+ pframe += wps_offset; -+ pktlen += wps_offset; -+ -+ _rtw_memcpy(pframe, pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len); -+ pframe += pmlmepriv->wps_beacon_ie_len; -+ pktlen += pmlmepriv->wps_beacon_ie_len; -+ -+ //copy remainder_ie to pframe -+ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; -+ pktlen += remainder_ielen; -+ } -+ else -+ { -+ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ pframe += cur_network->IELength; -+ pktlen += cur_network->IELength; -+ } -+ } -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ pframe_wscie = pframe + wps_offset; -+ _rtw_memcpy(pframe, cur_network->IEs, wps_offset+wpsielen); -+ pframe += (wps_offset + wpsielen); -+ pktlen += (wps_offset + wpsielen); -+ -+ //now pframe is end of wsc ie, insert Primary Device Type & Device Name -+ // Primary Device Type -+ // Type: -+ *(u16*) ( pframe + insert_len) = cpu_to_be16( WPS_ATTR_PRIMARY_DEV_TYPE ); -+ insert_len += 2; -+ -+ // Length: -+ *(u16*) ( pframe + insert_len ) = cpu_to_be16( 0x0008 ); -+ insert_len += 2; -+ -+ // Value: -+ // Category ID -+ *(u16*) ( pframe + insert_len ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); -+ insert_len += 2; -+ -+ // OUI -+ *(u32*) ( pframe + insert_len ) = cpu_to_be32( WPSOUI ); -+ insert_len += 4; -+ -+ // Sub Category ID -+ *(u16*) ( pframe + insert_len ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); -+ insert_len += 2; -+ -+ -+ // Device Name -+ // Type: -+ *(u16*) ( pframe + insert_len ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); -+ insert_len += 2; -+ -+ // Length: -+ *(u16*) ( pframe + insert_len ) = cpu_to_be16( pwdinfo->device_name_len ); -+ insert_len += 2; -+ -+ // Value: -+ _rtw_memcpy( pframe + insert_len, pwdinfo->device_name, pwdinfo->device_name_len ); -+ insert_len += pwdinfo->device_name_len; -+ -+ -+ //update wsc ie length -+ *(pframe_wscie+1) = (wpsielen -2) + insert_len; -+ -+ //pframe move to end -+ pframe+=insert_len; -+ pktlen += insert_len; -+ -+ //copy remainder_ie to pframe -+ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; -+ pktlen += remainder_ielen; -+ } -+ } -+ else -+#endif //CONFIG_P2P -+ { -+ int len_diff; -+ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ len_diff = update_hidden_ssid( -+ pframe+_BEACON_IE_OFFSET_ -+ , cur_network->IELength-_BEACON_IE_OFFSET_ -+ , pmlmeinfo->hidden_ssid_mode -+ ); -+ pframe += (cur_network->IELength+len_diff); -+ pktlen += (cur_network->IELength+len_diff); -+ } -+#if 0 -+ { -+ u8 *wps_ie; -+ uint wps_ielen; -+ u8 sr = 0; -+ wps_ie = rtw_get_wps_ie(pmgntframe->buf_addr+TXDESC_OFFSET+sizeof (struct rtw_ieee80211_hdr_3addr)+_BEACON_IE_OFFSET_, -+ pattrib->pktlen-sizeof (struct rtw_ieee80211_hdr_3addr)-_BEACON_IE_OFFSET_, NULL, &wps_ielen); -+ if (wps_ie && wps_ielen>0) { -+ rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8*)(&sr), NULL); -+ } -+ if (sr != 0) -+ set_fwstate(pmlmepriv, WIFI_UNDER_WPS); -+ else -+ _clr_fwstate_(pmlmepriv, WIFI_UNDER_WPS); -+ } -+#endif -+#ifdef CONFIG_P2P -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ u32 len; -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ len = pmlmepriv->p2p_beacon_ie_len; -+ if(pmlmepriv->p2p_beacon_ie && len>0) -+ _rtw_memcpy(pframe, pmlmepriv->p2p_beacon_ie, len); -+ } -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ len = build_beacon_p2p_ie(pwdinfo, pframe); -+ } -+ -+ pframe += len; -+ pktlen += len; -+#ifdef CONFIG_WFD -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(_TRUE == pwdinfo->wfd_info->wfd_enable) -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ len = build_beacon_wfd_ie( pwdinfo, pframe ); -+ } -+#ifdef CONFIG_IOCTL_CFG80211 -+ else -+ { -+ len = 0; -+ if(pmlmepriv->wfd_beacon_ie && pmlmepriv->wfd_beacon_ie_len>0) -+ { -+ len = pmlmepriv->wfd_beacon_ie_len; -+ _rtw_memcpy(pframe, pmlmepriv->wfd_beacon_ie, len); -+ } -+ } -+#endif //CONFIG_IOCTL_CFG80211 -+ pframe += len; -+ pktlen += len; -+#endif //CONFIG_WFD -+ } -+#endif //CONFIG_P2P -+ -+ goto _issue_bcn; -+ -+ } -+ -+ //below for ad-hoc mode -+ -+ //timestamp will be inserted by hardware -+ pframe += 8; -+ pktlen += 8; -+ -+ // beacon interval: 2 bytes -+ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ // capability info: 2 bytes -+ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ // SSID -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pktlen); -+ -+ // supported rates... -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8)? 8: rate_len), cur_network->SupportedRates, &pktlen); -+ -+ // DS parameter set -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pktlen); -+ -+ //if( (pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) -+ { -+ u8 erpinfo=0; -+ u32 ATIMWindow; -+ // IBSS Parameter Set... -+ //ATIMWindow = cur->Configuration.ATIMWindow; -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pktlen); -+ -+ //ERP IE -+ pframe = rtw_set_ie(pframe, _ERPINFO_IE_, 1, &erpinfo, &pktlen); -+ } -+ -+ -+ // EXTERNDED SUPPORTED RATE -+ if (rate_len > 8) -+ { -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen); -+ } -+ -+ -+ //todo:HT for adhoc -+ -+_issue_bcn: -+ -+//#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+// pmlmepriv->update_bcn = _FALSE; -+// -+// _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+//#endif //#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ -+ *pLength = pktlen; -+#if 0 -+ // printf dbg msg -+ dbgbufLen = pktlen; -+ DBG_871X("======> DBG MSG FOR CONSTRAUCT P2P BEACON\n"); -+ -+ for(index=0;indexxmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ //WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ u16 beacon_interval = 100; -+ u16 capInfo = 0; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 wpsie[255] = { 0x00 }; -+ u32 wpsielen = 0, p2pielen = 0; -+ u32 pktlen; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+#ifdef CONFIG_INTEL_WIDI -+ u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; -+#endif //CONFIG_INTEL_WIDI -+ -+ //for debug -+ u8 *dbgbuf = pframe; -+ u8 dbgbufLen = 0, index = 0; -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = adapter_mac_addr(padapter); -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ //DA filled by FW -+ _rtw_memset(pwlanhdr->addr1, 0, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ -+ // Use the device address for BSSID field. -+ _rtw_memcpy(pwlanhdr->addr3, mac, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(fctrl, WIFI_PROBERSP); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pframe += pktlen; -+ -+ -+ //timestamp will be inserted by hardware -+ pframe += 8; -+ pktlen += 8; -+ -+ // beacon interval: 2 bytes -+ _rtw_memcpy(pframe, (unsigned char *) &beacon_interval, 2); -+ pframe += 2; -+ pktlen += 2; -+ -+ // capability info: 2 bytes -+ // ESS and IBSS bits must be 0 (defined in the 3.1.2.1.1 of WiFi Direct Spec) -+ capInfo |= cap_ShortPremble; -+ capInfo |= cap_ShortSlot; -+ -+ _rtw_memcpy(pframe, (unsigned char *) &capInfo, 2); -+ pframe += 2; -+ pktlen += 2; -+ -+ -+ // SSID -+ pframe = rtw_set_ie(pframe, _SSID_IE_, 7, pwdinfo->p2p_wildcard_ssid, &pktlen); -+ -+ // supported rates... -+ // Use the OFDM rate in the P2P probe response frame. ( 6(B), 9(B), 12, 18, 24, 36, 48, 54 ) -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pwdinfo->support_rate, &pktlen); -+ -+ // DS parameter set -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&pwdinfo->listen_channel, &pktlen); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if( pmlmepriv->wps_probe_resp_ie != NULL && pmlmepriv->p2p_probe_resp_ie != NULL ) -+ { -+ //WPS IE -+ _rtw_memcpy(pframe, pmlmepriv->wps_probe_resp_ie, pmlmepriv->wps_probe_resp_ie_len); -+ pktlen += pmlmepriv->wps_probe_resp_ie_len; -+ pframe += pmlmepriv->wps_probe_resp_ie_len; -+ -+ //P2P IE -+ _rtw_memcpy(pframe, pmlmepriv->p2p_probe_resp_ie, pmlmepriv->p2p_probe_resp_ie_len); -+ pktlen += pmlmepriv->p2p_probe_resp_ie_len; -+ pframe += pmlmepriv->p2p_probe_resp_ie_len; -+ } -+ } -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ -+ // Todo: WPS IE -+ // Noted by Albert 20100907 -+ // According to the WPS specification, all the WPS attribute is presented by Big Endian. -+ -+ wpsielen = 0; -+ // WPS OUI -+ *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); -+ wpsielen += 4; -+ -+ // WPS version -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_VERSION_1; // Version 1.0 -+ -+#ifdef CONFIG_INTEL_WIDI -+ // Commented by Kurt -+ // Appended WiDi info. only if we did issued_probereq_widi(), and then we saved ven. ext. in pmlmepriv->sa_ext. -+ if( _rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE -+ || pmlmepriv->num_p2p_sdt != 0 ) -+ { -+ //Sec dev type -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_SEC_DEV_TYPE_LIST ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0008 ); -+ wpsielen += 2; -+ -+ // Value: -+ // Category ID -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_CID_DISPLAYS ); -+ wpsielen += 2; -+ -+ // OUI -+ *(u32*) ( wpsie + wpsielen ) = cpu_to_be32( INTEL_DEV_TYPE_OUI ); -+ wpsielen += 4; -+ -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_SCID_WIDI_CONSUMER_SINK ); -+ wpsielen += 2; -+ -+ if( _rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE ) -+ { -+ // Vendor Extension -+ _rtw_memcpy( wpsie + wpsielen, pmlmepriv->sa_ext, L2SDTA_SERVICE_VE_LEN ); -+ wpsielen += L2SDTA_SERVICE_VE_LEN; -+ } -+ } -+#endif //CONFIG_INTEL_WIDI -+ -+ // WiFi Simple Config State -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_SIMPLE_CONF_STATE ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_WSC_STATE_NOT_CONFIG; // Not Configured. -+ -+ // Response Type -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_RESP_TYPE ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_RESPONSE_TYPE_8021X; -+ -+ // UUID-E -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_UUID_E ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0010 ); -+ wpsielen += 2; -+ -+ // Value: -+ if (pwdinfo->external_uuid == 0) { -+ _rtw_memset( wpsie + wpsielen, 0x0, 16 ); -+ _rtw_memcpy(wpsie + wpsielen, mac, ETH_ALEN); -+ } else { -+ _rtw_memcpy( wpsie + wpsielen, pwdinfo->uuid, 0x10 ); -+ } -+ wpsielen += 0x10; -+ -+ // Manufacturer -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_MANUFACTURER ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0007 ); -+ wpsielen += 2; -+ -+ // Value: -+ _rtw_memcpy( wpsie + wpsielen, "Realtek", 7 ); -+ wpsielen += 7; -+ -+ // Model Name -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_MODEL_NAME ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0006 ); -+ wpsielen += 2; -+ -+ // Value: -+ _rtw_memcpy( wpsie + wpsielen, "8192CU", 6 ); -+ wpsielen += 6; -+ -+ // Model Number -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_MODEL_NUMBER ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[ wpsielen++ ] = 0x31; // character 1 -+ -+ // Serial Number -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_SERIAL_NUMBER ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( ETH_ALEN ); -+ wpsielen += 2; -+ -+ // Value: -+ _rtw_memcpy( wpsie + wpsielen, "123456" , ETH_ALEN ); -+ wpsielen += ETH_ALEN; -+ -+ // Primary Device Type -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_PRIMARY_DEV_TYPE ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0008 ); -+ wpsielen += 2; -+ -+ // Value: -+ // Category ID -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); -+ wpsielen += 2; -+ -+ // OUI -+ *(u32*) ( wpsie + wpsielen ) = cpu_to_be32( WPSOUI ); -+ wpsielen += 4; -+ -+ // Sub Category ID -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); -+ wpsielen += 2; -+ -+ // Device Name -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->device_name_len ); -+ wpsielen += 2; -+ -+ // Value: -+ _rtw_memcpy( wpsie + wpsielen, pwdinfo->device_name, pwdinfo->device_name_len ); -+ wpsielen += pwdinfo->device_name_len; -+ -+ // Config Method -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); -+ wpsielen += 2; -+ -+ // Value: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); -+ wpsielen += 2; -+ -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pktlen ); -+ -+ -+ p2pielen = build_probe_resp_p2p_ie(pwdinfo, pframe); -+ pframe += p2pielen; -+ pktlen += p2pielen; -+ } -+ -+#ifdef CONFIG_WFD -+#ifdef CONFIG_IOCTL_CFG80211 -+ if ( _TRUE == pwdinfo->wfd_info->wfd_enable ) -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ wfdielen = build_probe_resp_wfd_ie(pwdinfo, pframe, 0); -+ pframe += wfdielen; -+ pktlen += wfdielen; -+ } -+#ifdef CONFIG_IOCTL_CFG80211 -+ else if (pmlmepriv->wfd_probe_resp_ie != NULL && pmlmepriv->wfd_probe_resp_ie_len>0) -+ { -+ //WFD IE -+ _rtw_memcpy(pframe, pmlmepriv->wfd_probe_resp_ie, pmlmepriv->wfd_probe_resp_ie_len); -+ pktlen += pmlmepriv->wfd_probe_resp_ie_len; -+ pframe += pmlmepriv->wfd_probe_resp_ie_len; -+ } -+#endif //CONFIG_IOCTL_CFG80211 -+#endif //CONFIG_WFD -+ -+ *pLength = pktlen; -+ -+#if 0 -+ // printf dbg msg -+ dbgbufLen = pktlen; -+ DBG_871X("======> DBG MSG FOR CONSTRAUCT P2P Probe Rsp\n"); -+ -+ for(index=0;indexxmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo); -+ //WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ -+ //for debug -+ u8 *dbgbuf = pframe; -+ u8 dbgbufLen = 0, index = 0; -+ -+ DBG_871X( "%s\n", __FUNCTION__); -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ //RA, filled by FW -+ _rtw_memset(pwlanhdr->addr1, 0, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pframe += pktlen; -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pktlen)); -+ -+ //dialog token, filled by FW -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pktlen)); -+ -+ _rtw_memset( wpsie, 0x00, 255 ); -+ wpsielen = 0; -+ -+ // WPS Section -+ wpsielen = 0; -+ // WPS OUI -+ *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); -+ wpsielen += 4; -+ -+ // WPS version -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_VERSION_1; // Version 1.0 -+ -+ // Device Password ID -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_PWID ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); -+ wpsielen += 2; -+ -+ // Value: -+ if ( wps_devicepassword_id == WPS_DPID_USER_SPEC ) -+ { -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_REGISTRAR_SPEC ); -+ } -+ else if ( wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC ) -+ { -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_USER_SPEC ); -+ } -+ else -+ { -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_PBC ); -+ } -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pktlen ); -+ -+ -+ // P2P IE Section. -+ -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // Commented by Albert 20100908 -+ // According to the P2P Specification, the group negoitation response frame should contain 9 P2P attributes -+ // 1. Status -+ // 2. P2P Capability -+ // 3. Group Owner Intent -+ // 4. Configuration Timeout -+ // 5. Operating Channel -+ // 6. Intended P2P Interface Address -+ // 7. Channel List -+ // 8. Device Info -+ // 9. Group ID ( Only GO ) -+ -+ -+ // ToDo: -+ -+ // P2P Status -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_STATUS; -+ -+ // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); -+ p2pielen += 2; -+ -+ // Value, filled by FW -+ p2pie[ p2pielen++ ] = 1; -+ -+ // P2P Capability -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; -+ -+ // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Device Capability Bitmap, 1 byte -+ -+ if ( rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) ) -+ { -+ // Commented by Albert 2011/03/08 -+ // According to the P2P specification -+ // if the sending device will be client, the P2P Capability should be reserved of group negotation response frame -+ p2pie[ p2pielen++ ] = 0; -+ } -+ else -+ { -+ // Be group owner or meet the error case -+ p2pie[ p2pielen++ ] = DMP_P2P_DEVCAP_SUPPORT; -+ } -+ -+ // Group Capability Bitmap, 1 byte -+ if ( pwdinfo->persistent_supported ) -+ { -+ p2pie[ p2pielen++ ] = P2P_GRPCAP_CROSS_CONN | P2P_GRPCAP_PERSISTENT_GROUP; -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = P2P_GRPCAP_CROSS_CONN; -+ } -+ -+ // Group Owner Intent -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_GO_INTENT; -+ -+ // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); -+ p2pielen += 2; -+ -+ // Value: -+ if ( pwdinfo->peer_intent & 0x01 ) -+ { -+ // Peer's tie breaker bit is 1, our tie breaker bit should be 0 -+ p2pie[ p2pielen++ ] = ( pwdinfo->intent << 1 ); -+ } -+ else -+ { -+ // Peer's tie breaker bit is 0, our tie breaker bit should be 1 -+ p2pie[ p2pielen++ ] = ( ( pwdinfo->intent << 1 ) | BIT(0) ); -+ } -+ -+ -+ // Configuration Timeout -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CONF_TIMEOUT; -+ -+ // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ p2pielen += 2; -+ -+ // Value: -+ p2pie[ p2pielen++ ] = 200; // 2 seconds needed to be the P2P GO -+ p2pie[ p2pielen++ ] = 200; // 2 seconds needed to be the P2P Client -+ -+ // Operating Channel -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; -+ -+ // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Operating Class -+ if ( pwdinfo->operating_channel <= 14 ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x51; -+ } -+ else if ( ( pwdinfo->operating_channel >= 36 ) && ( pwdinfo->operating_channel <= 48 ) ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x73; -+ } -+ else -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x7c; -+ } -+ -+ // Channel Number -+ p2pie[ p2pielen++ ] = pwdinfo->operating_channel; // operating channel number -+ -+ // Intended P2P Interface Address -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_INTENTED_IF_ADDR; -+ -+ // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ // Channel List -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CH_LIST; -+ -+ // Country String(3) -+ // + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) -+ // + number of channels in all classes -+ len_channellist_attr = 3 -+ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes -+ + get_reg_classes_full_count(pmlmeext->channel_list); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); -+ } -+ else -+ { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); -+ } -+#else -+ -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); -+ -+ #endif -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Channel Entry List -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ // Operating Class -+ if ( pbuddy_mlmeext->cur_channel > 14 ) -+ { -+ if ( pbuddy_mlmeext->cur_channel >= 149 ) -+ { -+ p2pie[ p2pielen++ ] = 0x7c; -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = 0x73; -+ } -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = 0x51; -+ } -+ -+ // Number of Channels -+ // Just support 1 channel and this channel is AP's channel -+ p2pie[ p2pielen++ ] = 1; -+ -+ // Channel List -+ p2pie[ p2pielen++ ] = pbuddy_mlmeext->cur_channel; -+ } -+ else -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ // Operating Class -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ // Number of Channels -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ // Channel List -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) { -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+ } -+#else // CONFIG_CONCURRENT_MODE -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ // Operating Class -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ // Number of Channels -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ // Channel List -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) { -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ -+ -+ // Device Info -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) -+ // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); -+ p2pielen += 2; -+ -+ // Value: -+ // P2P Device Address -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ // Config Method -+ // This field should be big endian. Noted by P2P specification. -+ -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); -+ -+ p2pielen += 2; -+ -+ // Primary Device Type -+ // Category ID -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); -+ p2pielen += 2; -+ -+ // OUI -+ *(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); -+ p2pielen += 4; -+ -+ // Sub Category ID -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); -+ p2pielen += 2; -+ -+ // Number of Secondary Device Types -+ p2pie[ p2pielen++ ] = 0x00; // No Secondary Device Type List -+ -+ // Device Name -+ // Type: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); -+ p2pielen += 2; -+ -+ // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_name , pwdinfo->device_name_len ); -+ p2pielen += pwdinfo->device_name_len; -+ -+ if ( rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) ) -+ { -+ // Group ID Attribute -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_ID; -+ -+ // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN + pwdinfo->nego_ssidlen ); -+ p2pielen += 2; -+ -+ // Value: -+ // p2P Device Address -+ _rtw_memcpy( p2pie + p2pielen , pwdinfo->device_addr, ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ // SSID -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen ); -+ p2pielen += pwdinfo->nego_ssidlen; -+ -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pktlen ); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_nego_resp_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pktlen += wfdielen; -+#endif //CONFIG_WFD -+ -+ *pLength = pktlen; -+#if 0 -+ // printf dbg msg -+ dbgbufLen = pktlen; -+ DBG_871X("======> DBG MSG FOR CONSTRAUCT Nego Rsp\n"); -+ -+ for(index=0;indexpbuddy_adapter; -+ struct wifidirect_info *pbuddy_wdinfo = &pbuddy_adapter->wdinfo; -+ struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ -+ //struct xmit_frame *pmgntframe; -+ //struct pkt_attrib *pattrib; -+ //unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo); -+ -+ //for debug -+ u8 *dbgbuf = pframe; -+ u8 dbgbufLen = 0, index = 0; -+ -+ -+ DBG_871X( "%s\n", __FUNCTION__); -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ //RA fill by FW -+ _rtw_memset(pwlanhdr->addr1, 0, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ //BSSID fill by FW -+ _rtw_memset(pwlanhdr->addr3, 0, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pktlen)); -+ -+ //dialog token, filled by FW -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pktlen)); -+ -+ // P2P IE Section. -+ -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // Commented by Albert 20101005 -+ // According to the P2P Specification, the P2P Invitation response frame should contain 5 P2P attributes -+ // 1. Status -+ // 2. Configuration Timeout -+ // 3. Operating Channel ( Only GO ) -+ // 4. P2P Group BSSID ( Only GO ) -+ // 5. Channel List -+ -+ // P2P Status -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_STATUS; -+ -+ // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); -+ p2pielen += 2; -+ -+ // Value: filled by FW, defult value is FAIL INFO UNAVAILABLE -+ p2pie[ p2pielen++ ] = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ -+ // Configuration Timeout -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CONF_TIMEOUT; -+ -+ // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ p2pielen += 2; -+ -+ // Value: -+ p2pie[ p2pielen++ ] = 200; // 2 seconds needed to be the P2P GO -+ p2pie[ p2pielen++ ] = 200; // 2 seconds needed to be the P2P Client -+ -+ // due to defult value is FAIL INFO UNAVAILABLE, so the following IE is not needed -+#if 0 -+ if( status_code == P2P_STATUS_SUCCESS ) -+ { -+ if( rtw_p2p_chk_role( pwdinfo, P2P_ROLE_GO ) ) -+ { -+ // The P2P Invitation request frame asks this Wi-Fi device to be the P2P GO -+ // In this case, the P2P Invitation response frame should carry the two more P2P attributes. -+ // First one is operating channel attribute. -+ // Second one is P2P Group BSSID attribute. -+ -+ // Operating Channel -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; -+ -+ // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x51; // Copy from SD7 -+ -+ // Channel Number -+ p2pie[ p2pielen++ ] = pwdinfo->operating_channel; // operating channel number -+ -+ -+ // P2P Group BSSID -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_BSSID; -+ -+ // Length: -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); -+ p2pielen += 2; -+ -+ // Value: -+ // P2P Device Address for GO -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ } -+ -+ // Channel List -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CH_LIST; -+ -+ // Length: -+ // Country String(3) -+ // + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) -+ // + number of channels in all classes -+ len_channellist_attr = 3 -+ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes -+ + get_reg_classes_full_count(pmlmeext->channel_list); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); -+ } -+ else -+ { -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); -+ } -+#else -+ -+ *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); -+ -+#endif -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Channel Entry List -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ // Operating Class -+ if ( pbuddy_mlmeext->cur_channel > 14 ) -+ { -+ if ( pbuddy_mlmeext->cur_channel >= 149 ) -+ { -+ p2pie[ p2pielen++ ] = 0x7c; -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = 0x73; -+ } -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = 0x51; -+ } -+ -+ // Number of Channels -+ // Just support 1 channel and this channel is AP's channel -+ p2pie[ p2pielen++ ] = 1; -+ -+ // Channel List -+ p2pie[ p2pielen++ ] = pbuddy_mlmeext->cur_channel; -+ } -+ else -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ // Operating Class -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ // Number of Channels -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ // Channel List -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) { -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+ } -+#else // CONFIG_CONCURRENT_MODE -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ // Operating Class -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ // Number of Channels -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ // Channel List -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) { -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ } -+#endif -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pktlen ); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_invitation_resp_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pktlen += wfdielen; -+#endif //CONFIG_WFD -+ -+ *pLength = pktlen; -+ -+#if 0 -+ // printf dbg msg -+ dbgbufLen = pktlen; -+ DBG_871X("======> DBG MSG FOR CONSTRAUCT Invite Rsp\n"); -+ -+ for(index=0;indexxmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo); -+ -+ //for debug -+ u8 *dbgbuf = pframe; -+ u8 dbgbufLen = 0, index = 0; -+ -+ DBG_871X( "%s\n", __FUNCTION__); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ //RA filled by FW -+ _rtw_memset(pwlanhdr->addr1, 0, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr,0); -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pktlen)); -+ //dialog token, filled by FW -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pktlen)); -+ -+ wpsielen = 0; -+ // WPS OUI -+ //*(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); -+ RTW_PUT_BE32(wpsie, WPSOUI); -+ wpsielen += 4; -+ -+#if 0 -+ // WPS version -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_VERSION_1; // Version 1.0 -+#endif -+ -+ // Config Method -+ // Type: -+ //*(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); -+ RTW_PUT_BE16(wpsie + wpsielen, WPS_ATTR_CONF_METHOD); -+ wpsielen += 2; -+ -+ // Length: -+ //*(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); -+ RTW_PUT_BE16(wpsie + wpsielen, 0x0002); -+ wpsielen += 2; -+ -+ // Value: filled by FW, default value is PBC -+ //*(u16*) ( wpsie + wpsielen ) = cpu_to_be16( config_method ); -+ RTW_PUT_BE16(wpsie + wpsielen, WPS_CM_PUSH_BUTTON); -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pktlen ); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_provdisc_resp_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pktlen += wfdielen; -+#endif //CONFIG_WFD -+ -+ *pLength = pktlen; -+ -+ // printf dbg msg -+#if 0 -+ dbgbufLen = pktlen; -+ DBG_871X("======> DBG MSG FOR CONSTRAUCT ProvisionDis Rsp\n"); -+ -+ for(index=0;indexHalFunc; -+ u8 ret = _FAIL; -+ -+ DBG_871X("P2PRsvdPageLoc: P2PBeacon=%d P2PProbeRsp=%d NegoRsp=%d InviteRsp=%d PDRsp=%d\n", -+ rsvdpageloc->LocP2PBeacon, rsvdpageloc->LocP2PProbeRsp, -+ rsvdpageloc->LocNegoRsp, rsvdpageloc->LocInviteRsp, -+ rsvdpageloc->LocPDRsp); -+ -+ SET_H2CCMD_RSVDPAGE_LOC_P2P_BCN(u1H2CP2PRsvdPageParm, rsvdpageloc->LocProbeRsp); -+ SET_H2CCMD_RSVDPAGE_LOC_P2P_PROBE_RSP(u1H2CP2PRsvdPageParm, rsvdpageloc->LocPsPoll); -+ SET_H2CCMD_RSVDPAGE_LOC_P2P_NEGO_RSP(u1H2CP2PRsvdPageParm, rsvdpageloc->LocNullData); -+ SET_H2CCMD_RSVDPAGE_LOC_P2P_INVITE_RSP(u1H2CP2PRsvdPageParm, rsvdpageloc->LocQosNull); -+ SET_H2CCMD_RSVDPAGE_LOC_P2P_PD_RSP(u1H2CP2PRsvdPageParm, rsvdpageloc->LocBTQosNull); -+ -+ //FillH2CCmd8723B(padapter, H2C_8723B_P2P_OFFLOAD_RSVD_PAGE, H2C_P2PRSVDPAGE_LOC_LEN, u1H2CP2PRsvdPageParm); -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_P2P_OFFLOAD_RSVD_PAGE, -+ H2C_P2PRSVDPAGE_LOC_LEN, -+ u1H2CP2PRsvdPageParm); -+ -+ return ret; -+} -+ -+u8 rtw_hal_set_p2p_wowlan_offload_cmd(_adapter* adapter) -+{ -+ -+ u8 offload_cmd[H2C_P2P_OFFLOAD_LEN] = {0}; -+ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); -+ struct P2P_WoWlan_Offload_t *p2p_wowlan_offload = (struct P2P_WoWlan_Offload_t *)offload_cmd; -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ u8 ret = _FAIL; -+ -+ _rtw_memset(p2p_wowlan_offload,0 ,sizeof(struct P2P_WoWlan_Offload_t)); -+ DBG_871X("%s\n",__func__); -+ switch(pwdinfo->role) -+ { -+ case P2P_ROLE_DEVICE: -+ DBG_871X("P2P_ROLE_DEVICE\n"); -+ p2p_wowlan_offload->role = 0; -+ break; -+ case P2P_ROLE_CLIENT: -+ DBG_871X("P2P_ROLE_CLIENT\n"); -+ p2p_wowlan_offload->role = 1; -+ break; -+ case P2P_ROLE_GO: -+ DBG_871X("P2P_ROLE_GO\n"); -+ p2p_wowlan_offload->role = 2; -+ break; -+ default: -+ DBG_871X("P2P_ROLE_DISABLE\n"); -+ break; -+ } -+ p2p_wowlan_offload->Wps_Config[0] = pwdinfo->supported_wps_cm>>8; -+ p2p_wowlan_offload->Wps_Config[1] = pwdinfo->supported_wps_cm; -+ offload_cmd = (u8*)p2p_wowlan_offload; -+ DBG_871X("p2p_wowlan_offload: %x:%x:%x\n",offload_cmd[0],offload_cmd[1],offload_cmd[2]); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_P2P_OFFLOAD, -+ H2C_P2P_OFFLOAD_LEN, -+ offload_cmd); -+ return ret; -+ -+ //FillH2CCmd8723B(adapter, H2C_8723B_P2P_OFFLOAD, sizeof(struct P2P_WoWlan_Offload_t), (u8 *)p2p_wowlan_offload); -+} -+#endif //CONFIG_P2P_WOWLAN -+ -+static void rtw_hal_construct_beacon(_adapter *padapter, -+ u8 *pframe, u32 *pLength) ++static void ConstructBeacon(_adapter *padapter, u8 *pframe, u32 *pLength) +{ + struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; ++ __le16 *fctrl; + u32 rate_len, pktlen; + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -160293,7 +109793,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); + + SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); @@ -160376,11 +109876,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + +} + -+static void rtw_hal_construct_PSPoll(_adapter *padapter, -+ u8 *pframe, u32 *pLength) ++static void ConstructPSPoll(_adapter *padapter, u8 *pframe, u32 *pLength) +{ + struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; ++ __le16 *fctrl; + u32 pktlen; + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -160402,12 +109901,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + + // TA. -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + + *pLength = 16; +} + -+static void rtw_hal_construct_NullFunctionData( ++static void ConstructNullFunctionData( + PADAPTER padapter, + u8 *pframe, + u32 *pLength, @@ -160418,7 +109917,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + u8 bForcePowerSave) +{ + struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; ++ __le16 *fctrl; + u32 pktlen; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct wlan_network *cur_network = &pmlmepriv->cur_network; @@ -160442,26 +109941,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + case Ndis802_11Infrastructure: + SetToDs(fctrl); + _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, StaAddr, ETH_ALEN); + break; + case Ndis802_11APMode: + SetFrDs(fctrl); + _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); + break; + case Ndis802_11IBSS: + default: + _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + break; + } + + SetSeqNum(pwlanhdr, 0); + -+ if (bQoS == _TRUE) { ++ if (bQoS == true) { + struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; + + SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); @@ -160480,22 +109979,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + *pLength = pktlen; +} + -+void rtw_hal_construct_ProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength, -+ u8 *StaAddr, BOOLEAN bHideSSID) ++static void ConstructProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength, u8 *StaAddr, bool bHideSSID) +{ + struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; ++ __le16 *fctrl; + u8 *mac, *bssid; + u32 pktlen; + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + -+ /*DBG_871X("%s\n", __FUNCTION__);*/ ++ ++ //DBG_871X("%s\n", __FUNCTION__); + + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + -+ mac = adapter_mac_addr(padapter); ++ mac = myid(&(padapter->eeprompriv)); + bssid = cur_network->MacAddress; + + fctrl = &(pwlanhdr->frame_ctl); @@ -160510,7 +110009,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); + pframe += pktlen; + -+ if (cur_network->IELength > MAX_IE_SZ) ++ if(cur_network->IELength>MAX_IE_SZ) + return; + + _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); @@ -160520,1238 +110019,66 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + *pLength = pktlen; +} + -+#ifdef CONFIG_WOWLAN ++// To check if reserved page content is destroyed by beacon beacuse beacon is too large. ++// 2010.06.23. Added by tynli. ++void ++CheckFwRsvdPageContent( ++ PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE* pHalData = GET_HAL_DATA(Adapter); ++ u32 MaxBcnPageNum; ++ ++ if(pHalData->FwRsvdPageStartOffset != 0) ++ { ++ /*MaxBcnPageNum = PageNum_128(pMgntInfo->MaxBeaconSize); ++ RT_ASSERT((MaxBcnPageNum <= pHalData->FwRsvdPageStartOffset), ++ ("CheckFwRsvdPageContent(): The reserved page content has been"\ ++ "destroyed by beacon!!! MaxBcnPageNum(%d) FwRsvdPageStartOffset(%d)\n!", ++ MaxBcnPageNum, pHalData->FwRsvdPageStartOffset));*/ ++ } ++} ++ +// -+// Description: -+// Construct the ARP response packet to support ARP offload. ++// Description: Get the reserved page number in Tx packet buffer. ++// Retrun value: the page number. ++// 2012.08.09, by tynli. +// -+static void rtw_hal_construct_ARPRsp( -+ PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength, -+ u8 *pIPAddress -+ ) ++static u8 ++GetTxBufferRsvdPageNum8812( ++ PADAPTER Adapter, ++ bool bWoWLANBoundary ++) +{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ static u8 ARPLLCHeader[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x08, 0x06}; -+ u8 *pARPRspPkt = pframe; -+ //for TKIP Cal MIC -+ u8 *payload = pframe; -+ u8 EncryptionHeadOverhead = 0; -+ //DBG_871X("%s:%d\n", __FUNCTION__, bForcePowerSave); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 RsvdPageNum=0; ++ u8 TxPageBndy= LAST_ENTRY_OF_TX_PKT_BUFFER_8812; // default reseved 1 page for the IC type which is undefined. + -+ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ //------------------------------------------------------------------------- -+ // MAC Header. -+ //------------------------------------------------------------------------- -+ SetFrameType(fctrl, WIFI_DATA); -+ //SetFrameSubType(fctrl, 0); -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetDuration(pwlanhdr, 0); -+ //SET_80211_HDR_FRAME_CONTROL(pARPRspPkt, 0); -+ //SET_80211_HDR_TYPE_AND_SUBTYPE(pARPRspPkt, Type_Data); -+ //SET_80211_HDR_TO_DS(pARPRspPkt, 1); -+ //SET_80211_HDR_ADDRESS1(pARPRspPkt, pMgntInfo->Bssid); -+ //SET_80211_HDR_ADDRESS2(pARPRspPkt, Adapter->CurrentAddress); -+ //SET_80211_HDR_ADDRESS3(pARPRspPkt, pMgntInfo->Bssid); -+ -+ //SET_80211_HDR_DURATION(pARPRspPkt, 0); -+ //SET_80211_HDR_FRAGMENT_SEQUENCE(pARPRspPkt, 0); -+#ifdef CONFIG_WAPI_SUPPORT -+ *pLength = sMacHdrLng; -+#else -+ *pLength = 24; -+#endif -+ switch (psecuritypriv->dot11PrivacyAlgrthm) { -+ case _WEP40_: -+ case _WEP104_: -+ EncryptionHeadOverhead = 4; -+ break; -+ case _TKIP_: -+ EncryptionHeadOverhead = 8; -+ break; -+ case _AES_: -+ EncryptionHeadOverhead = 8; -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ EncryptionHeadOverhead = 18; -+ break; -+#endif -+ default: -+ EncryptionHeadOverhead = 0; -+ } -+ -+ if(EncryptionHeadOverhead > 0) { -+ _rtw_memset(&(pframe[*pLength]), 0,EncryptionHeadOverhead); -+ *pLength += EncryptionHeadOverhead; -+ //SET_80211_HDR_WEP(pARPRspPkt, 1); //Suggested by CCW. -+ SetPrivacy(fctrl); -+ } -+ -+ //------------------------------------------------------------------------- -+ // Frame Body. -+ //------------------------------------------------------------------------- -+ pARPRspPkt = (u8*)(pframe+ *pLength); -+ payload = pARPRspPkt; //Get Payload pointer -+ // LLC header -+ _rtw_memcpy(pARPRspPkt, ARPLLCHeader, 8); -+ *pLength += 8; -+ -+ // ARP element -+ pARPRspPkt += 8; -+ SET_ARP_PKT_HW(pARPRspPkt, 0x0100); -+ SET_ARP_PKT_PROTOCOL(pARPRspPkt, 0x0008); // IP protocol -+ SET_ARP_PKT_HW_ADDR_LEN(pARPRspPkt, 6); -+ SET_ARP_PKT_PROTOCOL_ADDR_LEN(pARPRspPkt, 4); -+ SET_ARP_PKT_OPERATION(pARPRspPkt, 0x0200); // ARP response -+ SET_ARP_PKT_SENDER_MAC_ADDR(pARPRspPkt, adapter_mac_addr(padapter)); -+ SET_ARP_PKT_SENDER_IP_ADDR(pARPRspPkt, pIPAddress); -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ if (!is_zero_mac_addr(pmlmepriv->gw_mac_addr)) { -+ SET_ARP_PKT_TARGET_MAC_ADDR(pARPRspPkt, pmlmepriv->gw_mac_addr); -+ SET_ARP_PKT_TARGET_IP_ADDR(pARPRspPkt, pmlmepriv->gw_ip); -+ } -+ else -+#endif ++ if(bWoWLANBoundary) + { -+ SET_ARP_PKT_TARGET_MAC_ADDR(pARPRspPkt, -+ get_my_bssid(&(pmlmeinfo->network))); -+ SET_ARP_PKT_TARGET_IP_ADDR(pARPRspPkt, -+ pIPAddress); -+ DBG_871X("%s Target Mac Addr:" MAC_FMT "\n", __FUNCTION__, -+ MAC_ARG(get_my_bssid(&(pmlmeinfo->network)))); -+ DBG_871X("%s Target IP Addr" IP_FMT "\n", __FUNCTION__, -+ IP_ARG(pIPAddress)); -+ } -+ -+ *pLength += 28; -+ -+ if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) { -+ u8 mic[8]; -+ struct mic_data micdata; -+ struct sta_info *psta = NULL; -+ u8 priority[4]={0x0,0x0,0x0,0x0}; -+ u8 null_key[16]={0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0}; -+ -+ DBG_871X("%s(): Add MIC\n",__FUNCTION__); -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, -+ get_my_bssid(&(pmlmeinfo->network))); -+ if (psta != NULL) { -+ if(_rtw_memcmp(&psta->dot11tkiptxmickey.skey[0], -+ null_key, 16)==_TRUE) { -+ DBG_871X("%s(): STA dot11tkiptxmickey==0\n", -+ __func__); -+ } -+ //start to calculate the mic code -+ rtw_secmicsetkey(&micdata, -+ &psta->dot11tkiptxmickey.skey[0]); -+ } -+ -+ rtw_secmicappend(&micdata, pwlanhdr->addr3, 6); //DA -+ -+ rtw_secmicappend(&micdata, pwlanhdr->addr2, 6); //SA -+ -+ priority[0]=0; -+ -+ rtw_secmicappend(&micdata, &priority[0], 4); -+ -+ rtw_secmicappend(&micdata, payload, 36); //payload length = 8 + 28 -+ -+ rtw_secgetmic(&micdata,&(mic[0])); -+ -+ pARPRspPkt += 28; -+ _rtw_memcpy(pARPRspPkt, &(mic[0]),8); -+ -+ *pLength += 8; -+ } -+} -+ -+#ifdef CONFIG_PNO_SUPPORT -+static void rtw_hal_construct_ProbeReq(_adapter *padapter, u8 *pframe, -+ u32 *pLength, pno_ssid_t *ssid) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ unsigned char *mac; -+ unsigned char bssrate[NumRates]; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int bssrate_len = 0; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ mac = adapter_mac_addr(padapter); -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, bc_addr, ETH_ALEN); -+ -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(pframe, WIFI_PROBEREQ); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pframe += pktlen; -+ -+ if (ssid == NULL) { -+ pframe = rtw_set_ie(pframe, _SSID_IE_, 0, NULL, &pktlen); -+ } else { -+ //DBG_871X("%s len:%d\n", ssid->SSID, ssid->SSID_len); -+ pframe = rtw_set_ie(pframe, _SSID_IE_, ssid->SSID_len, ssid->SSID, &pktlen); -+ } -+ -+ get_rate_set(padapter, bssrate, &bssrate_len); -+ -+ if (bssrate_len > 8) -+ { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &pktlen); -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &pktlen); ++ rtw_hal_get_def_var(Adapter, HAL_DEF_TX_PAGE_BOUNDARY_WOWLAN, (u8 *)&TxPageBndy); + } + else + { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &pktlen); ++ rtw_hal_get_def_var(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&TxPageBndy); + } + -+ *pLength = pktlen; ++ RsvdPageNum = LAST_ENTRY_OF_TX_PKT_BUFFER_8812 -TxPageBndy + 1; ++ ++ return RsvdPageNum; +} + -+static void rtw_hal_construct_PNO_info(_adapter *padapter, -+ u8 *pframe, u32*pLength) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ -+ u8 *pPnoInfoPkt = pframe; -+ pPnoInfoPkt = (u8*)(pframe+ *pLength); -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_num, 1); -+ -+ *pLength+=1; -+ pPnoInfoPkt += 1; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->hidden_ssid_num, 1); -+ -+ *pLength+=3; -+ pPnoInfoPkt += 3; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->fast_scan_period, 1); -+ -+ *pLength+=4; -+ pPnoInfoPkt += 4; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->fast_scan_iterations, 4); -+ -+ *pLength+=4; -+ pPnoInfoPkt += 4; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->slow_scan_period, 4); -+ -+ *pLength+=4; -+ pPnoInfoPkt += 4; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_length, -+ MAX_PNO_LIST_COUNT); -+ -+ *pLength+=MAX_PNO_LIST_COUNT; -+ pPnoInfoPkt += MAX_PNO_LIST_COUNT; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_cipher_info, -+ MAX_PNO_LIST_COUNT); -+ -+ *pLength+=MAX_PNO_LIST_COUNT; -+ pPnoInfoPkt += MAX_PNO_LIST_COUNT; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_channel_info, -+ MAX_PNO_LIST_COUNT); -+ -+ *pLength+=MAX_PNO_LIST_COUNT; -+ pPnoInfoPkt += MAX_PNO_LIST_COUNT; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->loc_probe_req, -+ MAX_HIDDEN_AP); -+ -+ *pLength+=MAX_HIDDEN_AP; -+ pPnoInfoPkt += MAX_HIDDEN_AP; -+} -+ -+static void rtw_hal_construct_ssid_list(_adapter *padapter, -+ u8 *pframe, u32 *pLength) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ u8 *pSSIDListPkt = pframe; -+ int i; -+ -+ pSSIDListPkt = (u8*)(pframe+ *pLength); -+ -+ for(i = 0; i < pwrctl->pnlo_info->ssid_num ; i++) { -+ _rtw_memcpy(pSSIDListPkt, &pwrctl->pno_ssid_list->node[i].SSID, -+ pwrctl->pnlo_info->ssid_length[i]); -+ -+ *pLength += WLAN_SSID_MAXLEN; -+ pSSIDListPkt += WLAN_SSID_MAXLEN; -+ } -+} -+ -+static void rtw_hal_construct_scan_info(_adapter *padapter, -+ u8 *pframe, u32 *pLength) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ u8 *pScanInfoPkt = pframe; -+ int i; -+ -+ pScanInfoPkt = (u8*)(pframe+ *pLength); -+ -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->channel_num, 1); -+ -+ *pLength+=1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_ch, 1); -+ -+ -+ *pLength+=1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_bw, 1); -+ -+ -+ *pLength+=1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_40_offset, 1); -+ -+ *pLength+=1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_80_offset, 1); -+ -+ *pLength+=1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->periodScan, 1); -+ -+ *pLength+=1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->period_scan_time, 1); -+ -+ *pLength+=1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->enableRFE, 1); -+ -+ *pLength+=1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->rfe_type, 8); -+ -+ *pLength+=8; -+ pScanInfoPkt += 8; -+ -+ for(i = 0 ; i < MAX_SCAN_LIST_COUNT ; i ++) { -+ _rtw_memcpy(pScanInfoPkt, -+ &pwrctl->pscan_info->ssid_channel_info[i], 4); -+ *pLength+=4; -+ pScanInfoPkt += 4; -+ } -+} -+#endif //CONFIG_PNO_SUPPORT -+ -+#ifdef CONFIG_GTK_OL -+static void rtw_hal_construct_GTKRsp( -+ PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength -+ ) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ static u8 LLCHeader[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x88, 0x8E}; -+ static u8 GTKbody_a[11] ={0x01, 0x03, 0x00, 0x5F, 0x02, 0x03, 0x12, 0x00, 0x10, 0x42, 0x0B}; -+ u8 *pGTKRspPkt = pframe; -+ u8 EncryptionHeadOverhead = 0; -+ //DBG_871X("%s:%d\n", __FUNCTION__, bForcePowerSave); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ //------------------------------------------------------------------------- -+ // MAC Header. -+ //------------------------------------------------------------------------- -+ SetFrameType(fctrl, WIFI_DATA); -+ //SetFrameSubType(fctrl, 0); -+ SetToDs(fctrl); -+ -+ _rtw_memcpy(pwlanhdr->addr1, -+ get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ _rtw_memcpy(pwlanhdr->addr2, -+ adapter_mac_addr(padapter), ETH_ALEN); -+ -+ _rtw_memcpy(pwlanhdr->addr3, -+ get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetDuration(pwlanhdr, 0); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ *pLength = sMacHdrLng; -+#else -+ *pLength = 24; -+#endif //CONFIG_WAPI_SUPPORT -+ -+ //------------------------------------------------------------------------- -+ // Security Header: leave space for it if necessary. -+ //------------------------------------------------------------------------- -+ switch (psecuritypriv->dot11PrivacyAlgrthm) { -+ case _WEP40_: -+ case _WEP104_: -+ EncryptionHeadOverhead = 4; -+ break; -+ case _TKIP_: -+ EncryptionHeadOverhead = 8; -+ break; -+ case _AES_: -+ EncryptionHeadOverhead = 8; -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ EncryptionHeadOverhead = 18; -+ break; -+#endif //CONFIG_WAPI_SUPPORT -+ default: -+ EncryptionHeadOverhead = 0; -+ } -+ -+ if (EncryptionHeadOverhead > 0) { -+ _rtw_memset(&(pframe[*pLength]), 0,EncryptionHeadOverhead); -+ *pLength += EncryptionHeadOverhead; -+ //SET_80211_HDR_WEP(pGTKRspPkt, 1); //Suggested by CCW. -+ //GTK's privacy bit is done by FW -+ //SetPrivacy(fctrl); -+ } -+ //------------------------------------------------------------------------- -+ // Frame Body. -+ //------------------------------------------------------------------------- -+ pGTKRspPkt = (u8*)(pframe+ *pLength); -+ // LLC header -+ _rtw_memcpy(pGTKRspPkt, LLCHeader, 8); -+ *pLength += 8; -+ -+ // GTK element -+ pGTKRspPkt += 8; -+ -+ //GTK frame body after LLC, part 1 -+ _rtw_memcpy(pGTKRspPkt, GTKbody_a, 11); -+ *pLength += 11; -+ pGTKRspPkt += 11; -+ //GTK frame body after LLC, part 2 -+ _rtw_memset(&(pframe[*pLength]), 0, 88); -+ *pLength += 88; -+ pGTKRspPkt += 88; -+ -+} -+#endif //CONFIG_GTK_OL -+ -+void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, -+ u8 tx_desc, u32 page_size, u8 *page_num, u32 *total_pkt_len, -+ RSVDPAGE_LOC *rsvd_page_loc) -+{ -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ u32 ARPLegnth = 0, GTKLegnth = 0, PNOLength = 0, ScanInfoLength = 0; -+ u32 SSIDLegnth = 0, ProbeReqLength = 0; -+ u8 CurtPktPageNum = 0; -+ u8 currentip[4]; -+ u8 cur_dot11txpn[8]; -+ -+#ifdef CONFIG_GTK_OL -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info * psta; -+ u8 kek[RTW_KEK_LEN]; -+ u8 kck[RTW_KCK_LEN]; -+#endif //CONFIG_GTK_OL -+#ifdef CONFIG_PNO_SUPPORT -+ int pno_index; -+ u8 ssid_num; -+#endif //CONFIG_PNO_SUPPORT -+ -+ pmlmeext = &adapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ if (pwrctl->wowlan_pno_enable == _FALSE) { -+ //ARP RSP * 1 page -+ rtw_get_current_ip_address(adapter, currentip); -+ -+ rsvd_page_loc->LocArpRsp = *page_num; -+ -+ DBG_871X("LocArpRsp: %d\n", rsvd_page_loc->LocArpRsp); -+ -+ rtw_hal_construct_ARPRsp( adapter, &pframe[index], -+ &ARPLegnth, currentip); -+ -+ rtw_hal_fill_fake_txdesc(adapter, -+ &pframe[index-tx_desc], -+ ARPLegnth, _FALSE, _FALSE, _TRUE); -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + ARPLegnth, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ //3 SEC IV * 1 page -+ rtw_get_sec_iv(adapter, cur_dot11txpn, -+ get_my_bssid(&pmlmeinfo->network)); -+ -+ rsvd_page_loc->LocRemoteCtrlInfo = *page_num; -+ -+ DBG_871X("LocRemoteCtrlInfo: %d\n", rsvd_page_loc->LocRemoteCtrlInfo); -+ -+ _rtw_memcpy(pframe+index-tx_desc, cur_dot11txpn, _AES_IV_LEN_); -+ -+ CurtPktPageNum = (u8)PageNum(_AES_IV_LEN_, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ *total_pkt_len = index + _AES_IV_LEN_; -+#ifdef CONFIG_GTK_OL -+ index += (CurtPktPageNum * page_size); -+ -+ //if the ap staion info. exists, get the kek, kck from staion info. -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ _rtw_memset(kek, 0, RTW_KEK_LEN); -+ _rtw_memset(kck, 0, RTW_KCK_LEN); -+ DBG_8192C("%s, KEK, KCK download rsvd page all zero \n", -+ __func__); -+ } else { -+ _rtw_memcpy(kek, psta->kek, RTW_KEK_LEN); -+ _rtw_memcpy(kck, psta->kck, RTW_KCK_LEN); -+ } -+ -+ //3 KEK, KCK -+ rsvd_page_loc->LocGTKInfo = *page_num; -+ DBG_871X("LocGTKInfo: %d\n", rsvd_page_loc->LocGTKInfo); -+ -+ if (IS_HARDWARE_TYPE_8188E(adapter) || IS_HARDWARE_TYPE_8812(adapter)) { -+ struct security_priv *psecpriv = NULL; -+ -+ psecpriv = &adapter->securitypriv; -+ _rtw_memcpy(pframe+index-tx_desc, -+ &psecpriv->dot11PrivacyAlgrthm, 1); -+ _rtw_memcpy(pframe+index-tx_desc+1, -+ &psecpriv->dot118021XGrpPrivacy, 1); -+ _rtw_memcpy(pframe+index-tx_desc+2, -+ kck, RTW_KCK_LEN); -+ _rtw_memcpy(pframe+index-tx_desc+2+RTW_KCK_LEN, -+ kek, RTW_KEK_LEN); -+ CurtPktPageNum = (u8)PageNum(tx_desc + 2 + RTW_KCK_LEN + RTW_KEK_LEN, page_size); -+ } else { -+ _rtw_memcpy(pframe+index-tx_desc, kck, RTW_KCK_LEN); -+ _rtw_memcpy(pframe+index-tx_desc+RTW_KCK_LEN, kek, RTW_KEK_LEN); -+ CurtPktPageNum = (u8)PageNum(tx_desc + RTW_KCK_LEN + RTW_KEK_LEN, page_size); -+ } -+ -+ -+ -+#if 0 -+ { -+ int i; -+ printk("\ntoFW KCK: "); -+ for(i=0;i<16; i++) -+ printk(" %02x ", kck[i]); -+ printk("\ntoFW KEK: "); -+ for(i=0;i<16; i++) -+ printk(" %02x ", kek[i]); -+ printk("\n"); -+ } -+ -+ DBG_871X("%s(): HW_VAR_SET_TX_CMD: KEK KCK %p %d\n", -+ __FUNCTION__, &pframe[index-tx_desc], -+ (tx_desc + RTW_KCK_LEN + RTW_KEK_LEN)); -+#endif -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ //3 GTK Response -+ rsvd_page_loc->LocGTKRsp= *page_num; -+ DBG_871X("LocGTKRsp: %d\n", rsvd_page_loc->LocGTKRsp); -+ rtw_hal_construct_GTKRsp(adapter, &pframe[index], >KLegnth); -+ -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index-tx_desc], -+ GTKLegnth, _FALSE, _FALSE, _TRUE); -+#if 0 -+ { -+ int gj; -+ printk("123GTK pkt=> \n"); -+ for(gj=0; gj < GTKLegnth+tx_desc; gj++) { -+ printk(" %02x ", pframe[index-tx_desc+gj]); -+ if ((gj + 1)%16==0) -+ printk("\n"); -+ } -+ printk(" <=end\n"); -+ } -+ -+ DBG_871X("%s(): HW_VAR_SET_TX_CMD: GTK RSP %p %d\n", -+ __FUNCTION__, &pframe[index-tx_desc], -+ (tx_desc + GTKLegnth)); -+#endif -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + GTKLegnth, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ //below page is empty for GTK extension memory -+ //3(11) GTK EXT MEM -+ rsvd_page_loc->LocGTKEXTMEM = *page_num; -+ -+ CurtPktPageNum = 2; -+ -+ if (page_size >= 256) -+ CurtPktPageNum = 1; -+ -+ *page_num += CurtPktPageNum; -+ //extension memory for FW -+ *total_pkt_len = index + (page_size * CurtPktPageNum); -+ -+#endif //CONFIG_GTK_OL -+ } else { -+#ifdef CONFIG_PNO_SUPPORT -+ if (pwrctl->pno_in_resume == _FALSE && -+ pwrctl->pno_inited == _TRUE) { -+ -+ //Broadcast Probe Request -+ rsvd_page_loc->LocProbePacket = *page_num; -+ -+ DBG_871X("loc_probe_req: %d\n", -+ rsvd_page_loc->LocProbePacket); -+ -+ rtw_hal_construct_ProbeReq( -+ adapter, -+ &pframe[index], -+ &ProbeReqLength, -+ NULL); -+ -+ rtw_hal_fill_fake_txdesc(adapter, -+ &pframe[index-tx_desc], -+ ProbeReqLength, _FALSE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = -+ (u8)PageNum(tx_desc + ProbeReqLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ //Hidden SSID Probe Request -+ ssid_num = pwrctl->pnlo_info->hidden_ssid_num; -+ -+ for (pno_index = 0 ; pno_index < ssid_num ; pno_index++) { -+ pwrctl->pnlo_info->loc_probe_req[pno_index] = -+ *page_num; -+ -+ rtw_hal_construct_ProbeReq( -+ adapter, -+ &pframe[index], -+ &ProbeReqLength, -+ &pwrctl->pno_ssid_list->node[pno_index]); -+ -+ rtw_hal_fill_fake_txdesc(adapter, -+ &pframe[index - tx_desc], -+ ProbeReqLength, _FALSE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = -+ (u8)PageNum(tx_desc + ProbeReqLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ } -+ -+ //PNO INFO Page -+ rsvd_page_loc->LocPNOInfo = *page_num; -+ DBG_871X("LocPNOInfo: %d\n", rsvd_page_loc->LocPNOInfo); -+ rtw_hal_construct_PNO_info(adapter, -+ &pframe[index - tx_desc], -+ &PNOLength); -+ -+ CurtPktPageNum = (u8)PageNum(PNOLength, page_size); -+ *page_num += CurtPktPageNum; -+ index += (CurtPktPageNum * page_size); -+ -+ //SSID List Page -+ rsvd_page_loc->LocSSIDInfo = *page_num; -+ DBG_871X("LocSSIDInfo: %d\n", rsvd_page_loc->LocSSIDInfo); -+ rtw_hal_construct_ssid_list(adapter, -+ &pframe[index - tx_desc], -+ &SSIDLegnth); -+ -+ CurtPktPageNum = (u8)PageNum(SSIDLegnth, page_size); -+ *page_num += CurtPktPageNum; -+ index += (CurtPktPageNum * page_size); -+ -+ //Scan Info Page -+ rsvd_page_loc->LocScanInfo = *page_num; -+ DBG_871X("LocScanInfo: %d\n", rsvd_page_loc->LocScanInfo); -+ rtw_hal_construct_scan_info(adapter, -+ &pframe[index - tx_desc], -+ &ScanInfoLength); -+ -+ CurtPktPageNum = (u8)PageNum(ScanInfoLength, page_size); -+ *page_num += CurtPktPageNum; -+ *total_pkt_len = index + ScanInfoLength; -+ index += (CurtPktPageNum * page_size); -+ -+ } -+#endif //CONFIG_PNO_SUPPORT -+ } -+} -+ -+static void rtw_hal_gate_bb(_adapter *adapter, bool stop) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ u8 val8 = 0; -+ u16 val16 = 0; -+ -+ if (stop) { -+ /* Pause TX*/ -+ pwrpriv->wowlan_txpause_status = rtw_read8(adapter, REG_TXPAUSE); -+ rtw_write8(adapter, REG_TXPAUSE, 0xff); -+ val8 = rtw_read8(adapter, REG_SYS_FUNC_EN); -+ val8 &= ~BIT(0); -+ rtw_write8(adapter, REG_SYS_FUNC_EN, val8); -+ DBG_871X("%s: BB gated: 0x%02x, store TXPAUSE: %02x\n", -+ __func__, -+ rtw_read8(adapter, REG_SYS_FUNC_EN), -+ pwrpriv->wowlan_txpause_status); -+ } else { -+ val8 = rtw_read8(adapter, REG_SYS_FUNC_EN); -+ val8 |= BIT(0); -+ rtw_write8(adapter, REG_SYS_FUNC_EN, val8); -+ DBG_871X("%s: BB release: 0x%02x, recover TXPAUSE:%02x\n", -+ __func__, rtw_read8(adapter, REG_SYS_FUNC_EN), -+ pwrpriv->wowlan_txpause_status); -+ /* release TX*/ -+ rtw_write8(adapter, REG_TXPAUSE, pwrpriv->wowlan_txpause_status); -+ } -+} -+ -+static void rtw_hal_reset_mac_rx(_adapter *adapter) -+{ -+ u8 val8 = 0; -+ /* Set REG_CR bit1, bit3, bit7 to 0*/ -+ val8 = rtw_read8(adapter, REG_CR); -+ val8 &= 0x75; -+ rtw_write8(adapter, REG_CR, val8); -+ val8 = rtw_read8(adapter, REG_CR); -+ /* Set REG_CR bit1, bit3, bit7 to 1*/ -+ val8 |= 0x8a; -+ rtw_write8(adapter, REG_CR, val8); -+ DBG_871X("0x%04x: %02x\n", REG_CR, rtw_read8(adapter, REG_CR)); -+} -+ -+static void rtw_hal_set_wow_rxff_boundary(_adapter *adapter, bool wow_mode) -+{ -+ u8 val8 = 0; -+ u16 rxff_bndy = 0; -+ u32 rx_dma_buff_sz = 0; -+ -+ val8 = rtw_read8(adapter, REG_FIFOPAGE + 3); -+ if (val8 != 0) -+ DBG_871X("%s:[%04x]some PKTs in TXPKTBUF\n", -+ __func__, (REG_FIFOPAGE + 3)); -+ -+ rtw_hal_reset_mac_rx(adapter); -+ -+ if (wow_mode) { -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ_WOW, -+ (u8 *)&rx_dma_buff_sz); -+ rxff_bndy = rx_dma_buff_sz - 1; -+ -+ rtw_write16(adapter, (REG_TRXFF_BNDY + 2), rxff_bndy); -+ DBG_871X("%s: wow mode, 0x%04x: 0x%04x\n", __func__, -+ REG_TRXFF_BNDY + 2, -+ rtw_read16(adapter, (REG_TRXFF_BNDY+2))); -+ } else { -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ, -+ (u8 *)&rx_dma_buff_sz); -+ rxff_bndy = rx_dma_buff_sz - 1; -+ rtw_write16(adapter, (REG_TRXFF_BNDY + 2), rxff_bndy); -+ DBG_871X("%s: normal mode, 0x%04x: 0x%04x\n", __func__, -+ REG_TRXFF_BNDY + 2, -+ rtw_read16(adapter, (REG_TRXFF_BNDY+2))); -+ } -+} -+ -+static int rtw_hal_set_pattern(_adapter *adapter, u8 *pattern, -+ u8 len, u8 *mask) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct mlme_ext_priv *pmlmeext = NULL; -+ struct mlme_ext_info *pmlmeinfo = NULL; -+ struct rtl_wow_pattern wow_pattern; -+ u8 mask_hw[MAX_WKFM_SIZE] = {0}; -+ u8 content[MAX_WKFM_PATTERN_SIZE] = {0}; -+ u8 broadcast_addr[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 multicast_addr1[2] = {0x33, 0x33}; -+ u8 multicast_addr2[3] = {0x01, 0x00, 0x5e}; -+ u8 res = _FALSE, index = 0, mask_len = 0; -+ u8 mac_addr[ETH_ALEN] = {0}; -+ u16 count = 0; -+ int i, j; -+ -+ if (pwrctl->wowlan_pattern_idx > MAX_WKFM_NUM) { -+ DBG_871X("%s pattern_idx is more than MAX_FMC_NUM: %d\n", -+ __func__, MAX_WKFM_NUM); -+ return _FALSE; -+ } -+ -+ pmlmeext = &adapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ _rtw_memcpy(mac_addr, adapter_mac_addr(adapter), ETH_ALEN); -+ _rtw_memset(&wow_pattern, 0, sizeof(struct rtl_wow_pattern)); -+ -+ mask_len = DIV_ROUND_UP(len, 8); -+ -+ /* 1. setup A1 table */ -+ if (memcmp(pattern, broadcast_addr, ETH_ALEN) == 0) -+ wow_pattern.type = PATTERN_BROADCAST; -+ else if (memcmp(pattern, multicast_addr1, 2) == 0) -+ wow_pattern.type = PATTERN_MULTICAST; -+ else if (memcmp(pattern, multicast_addr2, 3) == 0) -+ wow_pattern.type = PATTERN_MULTICAST; -+ else if (memcmp(pattern, mac_addr, ETH_ALEN) == 0) -+ wow_pattern.type = PATTERN_UNICAST; -+ else -+ wow_pattern.type = PATTERN_INVALID; -+ -+ /* translate mask from os to mask for hw */ -+ -+/****************************************************************************** -+ * pattern from OS uses 'ethenet frame', like this: -+ -+ | 6 | 6 | 2 | 20 | Variable | 4 | -+ |--------+--------+------+-----------+------------+-----| -+ | 802.3 Mac Header | IP Header | TCP Packet | FCS | -+ | DA | SA | Type | -+ -+ * BUT, packet catched by our HW is in '802.11 frame', begin from LLC, -+ -+ | 24 or 30 | 6 | 2 | 20 | Variable | 4 | -+ |-------------------+--------+------+-----------+------------+-----| -+ | 802.11 MAC Header | LLC | IP Header | TCP Packet | FCS | -+ | Others | Tpye | -+ -+ * Therefore, we need translate mask_from_OS to mask_to_hw. -+ * We should left-shift mask by 6 bits, then set the new bit[0~5] = 0, -+ * because new mask[0~5] means 'SA', but our HW packet begins from LLC, -+ * bit[0~5] corresponds to first 6 Bytes in LLC, they just don't match. -+ ******************************************************************************/ -+ /* Shift 6 bits */ -+ for (i = 0; i < mask_len - 1; i++) { -+ mask_hw[i] = mask[i] >> 6; -+ mask_hw[i] |= (mask[i + 1] & 0x3F) << 2; -+ } -+ -+ mask_hw[i] = (mask[i] >> 6) & 0x3F; -+ /* Set bit 0-5 to zero */ -+ mask_hw[0] &= 0xC0; -+ -+ for (i = 0; i < (MAX_WKFM_SIZE/4); i++) { -+ wow_pattern.mask[i] = mask_hw[i * 4]; -+ wow_pattern.mask[i] |= (mask_hw[i * 4 + 1] << 8); -+ wow_pattern.mask[i] |= (mask_hw[i * 4 + 2] << 16); -+ wow_pattern.mask[i] |= (mask_hw[i * 4 + 3] << 24); -+ } -+ -+ /* To get the wake up pattern from the mask. -+ * We do not count first 12 bits which means -+ * DA[6] and SA[6] in the pattern to match HW design. */ -+ count = 0; -+ for (i = 12; i < len; i++) { -+ if ((mask[i / 8] >> (i % 8)) & 0x01) { -+ content[count] = pattern[i]; -+ count++; -+ } -+ } -+ -+ wow_pattern.crc = rtw_calc_crc(content, count); -+ -+ if (wow_pattern.crc != 0 && wow_pattern.type == PATTERN_INVALID) -+ wow_pattern.type = PATTERN_VALID; -+ -+ index = rtw_read8(adapter, REG_WKFMCAM_NUM); -+ -+ if (!pwrctl->bInSuspend) -+ index += 2; -+ -+ /* write pattern */ -+ res = rtw_write_to_frame_mask(adapter, index, &wow_pattern); -+ -+ if (res == _TRUE) { -+ pwrctl->wowlan_pattern_idx++; -+ rtw_write8(adapter, -+ REG_WKFMCAM_NUM, -+ pwrctl->wowlan_pattern_idx); -+ } else { -+ DBG_871X("%s: ERROR write_to_frame_mask_cam fail\n", __func__); -+ } -+ -+ return res; -+} -+ -+static void rtw_hal_dl_pattern(_adapter *adapter, u8 clean_all) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ int i = 0, total = 0; -+ -+ total = pwrpriv->wowlan_pattern_idx + 1; -+ -+ rtw_clean_pattern(adapter); -+ -+ if (!clean_all) { -+ for (i = 0 ; i < total ; i++) { -+ rtw_hal_set_pattern(adapter, -+ pwrpriv->patterns[i].content, -+ pwrpriv->patterns[i].len, -+ pwrpriv->patterns[i].mask); -+ } -+ DBG_871X("pattern downloaded\n"); -+ } else { -+ for (i = 0 ; i < MAX_WKFM_NUM ; i++) { -+ _rtw_memset(pwrpriv->patterns[i].content, '\0', -+ sizeof(pwrpriv->patterns[i].content)); -+ _rtw_memset(pwrpriv->patterns[i].mask, '\0', -+ sizeof(pwrpriv->patterns[i].mask)); -+ pwrpriv->patterns[i].len = 0; -+ } -+ DBG_871X("clean all pattern\n"); -+ } -+} -+ -+static void rtw_hal_wow_enable(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ struct sta_info *psta = NULL; -+ int res; -+ u16 media_status_rpt; -+ -+ -+ DBG_871X_LEVEL(_drv_always_, "%s, WOWLAN_ENABLE\n", __func__); -+ rtw_hal_gate_bb(adapter, _TRUE); -+#ifdef CONFIG_GTK_OL -+ if (psecuritypriv->dot11PrivacyAlgrthm == _AES_) -+ rtw_hal_fw_sync_cam_id(adapter); -+#endif -+ if (IS_HARDWARE_TYPE_8723B(adapter)) -+ rtw_hal_backup_rate(adapter); -+ -+ /* RX DMA stop */ -+ if (IS_HARDWARE_TYPE_8188E(adapter)) -+ rtw_hal_disable_tx_report(adapter); -+ -+ res = rtw_hal_pause_rx_dma(adapter); -+ if (res == _FAIL) -+ DBG_871X_LEVEL(_drv_always_, "[WARNING] pause RX DMA fail\n"); -+ -+ /* Reconfig RX_FF Boundary */ -+ rtw_hal_set_wow_rxff_boundary(adapter, _TRUE); -+ -+ /* redownload pattern match */ -+ if (pwrctl->wowlan_pattern) -+ rtw_hal_dl_pattern(adapter, _FALSE); -+ -+ rtw_hal_set_wowlan_fw(adapter, _TRUE); -+ media_status_rpt = RT_MEDIA_CONNECT; -+ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_FW_JOINBSSRPT, -+ (u8 *)&media_status_rpt); -+ -+ if (!pwrctl->wowlan_pno_enable) { -+ psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); -+ media_status_rpt = (u16)((psta->mac_id<<8)|RT_MEDIA_CONNECT); -+ if (psta != NULL) { -+ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_MEDIA_STATUS_RPT, -+ (u8 *)&media_status_rpt); -+ } -+ } -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ /* Enable CPWM2 only. */ -+ res = rtw_hal_enable_cpwm2(adapter); -+ if (res == _FAIL) -+ DBG_871X_LEVEL(_drv_always_, "[WARNING] enable cpwm2 fail\n"); -+#endif -+#ifdef CONFIG_GPIO_WAKEUP -+ rtw_hal_switch_gpio_wl_ctrl(adapter, WAKEUP_GPIO_IDX, _TRUE); -+#endif -+ /* Set WOWLAN H2C command. */ -+ DBG_871X_LEVEL(_drv_always_, "Set WOWLan cmd\n"); -+ rtw_hal_set_fw_wow_related_cmd(adapter, 1); -+ -+ res = rtw_hal_check_wow_ctrl(adapter, _TRUE); -+ -+ if (res == _FALSE) -+ DBG_871X("[Error]%s: set wowlan CMD fail!!\n", __func__); -+ -+ pwrctl->wowlan_wake_reason = -+ rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); -+ -+ DBG_871X_LEVEL(_drv_always_, "wowlan_wake_reason: 0x%02x\n", -+ pwrctl->wowlan_wake_reason); -+#ifdef CONFIG_GTK_OL_DBG -+ dump_sec_cam(RTW_DBGDUMP, adapter); -+#endif -+#ifdef CONFIG_USB_HCI -+ if (adapter->intf_stop) /* free adapter's resource */ -+ adapter->intf_stop(adapter); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(adapter)) /*free buddy adapter's resource*/ -+ adapter->pbuddy_adapter->intf_stop(adapter->pbuddy_adapter); -+#endif /*CONFIG_CONCURRENT_MODE*/ -+ /* Invoid SE0 reset signal during suspending*/ -+ rtw_write8(adapter, REG_RSV_CTRL, 0x20); -+ rtw_write8(adapter, REG_RSV_CTRL, 0x60); -+#endif /*CONFIG_USB_HCI*/ -+ -+ rtw_hal_gate_bb(adapter, _FALSE); -+} -+ -+static void rtw_hal_wow_disable(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ struct sta_info *psta = NULL; -+ int res; -+ u16 media_status_rpt; -+ u8 val8; -+ -+ DBG_871X_LEVEL(_drv_always_, "%s, WOWLAN_DISABLE\n", __func__); -+ -+ if (!pwrctl->wowlan_pno_enable) { -+ psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); -+ if (psta != NULL) { -+ media_status_rpt = -+ (u16)((psta->mac_id<<8)|RT_MEDIA_DISCONNECT); -+ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_MEDIA_STATUS_RPT, -+ (u8 *)&media_status_rpt); -+ } else { -+ DBG_871X("%s: psta is null\n", __func__); -+ } -+ } -+ -+ if (0) { -+ DBG_871X("0x630:0x%02x\n", rtw_read8(adapter, 0x630)); -+ DBG_871X("0x631:0x%02x\n", rtw_read8(adapter, 0x631)); -+ } -+ -+ pwrctl->wowlan_wake_reason = rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); -+ -+ DBG_871X_LEVEL(_drv_always_, "wakeup_reason: 0x%02x\n", -+ pwrctl->wowlan_wake_reason); -+ -+ rtw_hal_set_fw_wow_related_cmd(adapter, 0); -+ -+ res = rtw_hal_check_wow_ctrl(adapter, _FALSE); -+ -+ if (res == _FALSE) { -+ DBG_871X("[Error]%s: disable WOW cmd fail\n!!", __func__); -+ rtw_hal_force_enable_rxdma(adapter); -+ } -+ -+ rtw_hal_gate_bb(adapter, _TRUE); -+ -+ res = rtw_hal_pause_rx_dma(adapter); -+ if (res == _FAIL) -+ DBG_871X_LEVEL(_drv_always_, "[WARNING] pause RX DMA fail\n"); -+ -+ /* clean pattern match */ -+ if (pwrctl->wowlan_pattern) -+ rtw_hal_dl_pattern(adapter, _TRUE); -+ -+ /* config RXFF boundary to original */ -+ rtw_hal_set_wow_rxff_boundary(adapter, _FALSE); -+ -+ rtw_hal_release_rx_dma(adapter); -+ -+ if (IS_HARDWARE_TYPE_8188E(adapter)) -+ rtw_hal_enable_tx_report(adapter); -+ -+ rtw_hal_update_tx_iv(adapter); -+ -+#ifdef CONFIG_GTK_OL -+ if (psecuritypriv->dot11PrivacyAlgrthm == _AES_) -+ rtw_hal_update_gtk_offload_info(adapter); -+#endif /*CONFIG_GTK_OL*/ -+ -+ rtw_hal_set_wowlan_fw(adapter, _FALSE); -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ val8 = (pwrctl->is_high_active == 0) ? 1 : 0; -+ DBG_871X_LEVEL(_drv_always_, "Set Wake GPIO to default(%d).\n", val8); -+ rtw_hal_set_output_gpio(adapter, WAKEUP_GPIO_IDX, val8); -+ rtw_hal_switch_gpio_wl_ctrl(adapter, WAKEUP_GPIO_IDX, _FALSE); -+#endif -+ if ((pwrctl->wowlan_wake_reason != FWDecisionDisconnect) && -+ (pwrctl->wowlan_wake_reason != Rx_Pairwisekey) && -+ (pwrctl->wowlan_wake_reason != Rx_DisAssoc) && -+ (pwrctl->wowlan_wake_reason != Rx_DeAuth)) { -+ -+ media_status_rpt = RT_MEDIA_CONNECT; -+ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_FW_JOINBSSRPT, -+ (u8 *)&media_status_rpt); -+ -+ if (psta != NULL) { -+ media_status_rpt = (u16)((psta->mac_id<<8)|RT_MEDIA_CONNECT); -+ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_MEDIA_STATUS_RPT, -+ (u8 *)&media_status_rpt); -+ } -+ } -+ rtw_hal_gate_bb(adapter, _FALSE); -+} -+#endif /*CONFIG_WOWLAN*/ -+ -+#ifdef CONFIG_P2P_WOWLAN -+void rtw_hal_set_p2p_wow_fw_rsvd_page(_adapter* adapter, u8 *pframe, u16 index, -+ u8 tx_desc, u32 page_size, u8 *page_num, u32 *total_pkt_len, -+ RSVDPAGE_LOC* rsvd_page_loc) -+{ -+ u32 P2PNegoRspLength = 0, P2PInviteRspLength = 0; -+ u32 P2PPDRspLength = 0, P2PProbeRspLength = 0, P2PBCNLength = 0; -+ u8 CurtPktPageNum = 0; -+ -+ /* P2P Beacon */ -+ rsvd_page_loc->LocP2PBeacon = *page_num; -+ rtw_hal_construct_P2PBeacon(adapter, &pframe[index], &P2PBCNLength); -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index-tx_desc], -+ P2PBCNLength, _FALSE, _FALSE, _FALSE); -+ -+#if 0 -+ DBG_871X("%s(): HW_VAR_SET_TX_CMD: PROBE RSP %p %d\n", -+ __FUNCTION__, &pframe[index-tx_desc], (P2PBCNLength+tx_desc)); -+#endif -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + P2PBCNLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ // P2P Probe rsp -+ rsvd_page_loc->LocP2PProbeRsp = *page_num; -+ rtw_hal_construct_P2PProbeRsp(adapter, &pframe[index], -+ &P2PProbeRspLength); -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index-tx_desc], -+ P2PProbeRspLength, _FALSE, _FALSE, _FALSE); -+ -+ //DBG_871X("%s(): HW_VAR_SET_TX_CMD: PROBE RSP %p %d\n", -+ // __FUNCTION__, &pframe[index-tx_desc], (P2PProbeRspLength+tx_desc)); -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + P2PProbeRspLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ //P2P nego rsp -+ rsvd_page_loc->LocNegoRsp = *page_num; -+ rtw_hal_construct_P2PNegoRsp(adapter, &pframe[index], -+ &P2PNegoRspLength); -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index-tx_desc], -+ P2PNegoRspLength, _FALSE, _FALSE, _FALSE); -+ -+ //DBG_871X("%s(): HW_VAR_SET_TX_CMD: QOS NULL DATA %p %d\n", -+ // __FUNCTION__, &pframe[index-tx_desc], (NegoRspLength+tx_desc)); -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + P2PNegoRspLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ //P2P invite rsp -+ rsvd_page_loc->LocInviteRsp = *page_num; -+ rtw_hal_construct_P2PInviteRsp(adapter, &pframe[index], -+ &P2PInviteRspLength); -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index-tx_desc], -+ P2PInviteRspLength, _FALSE, _FALSE, _FALSE); -+ -+ //DBG_871X("%s(): HW_VAR_SET_TX_CMD: QOS NULL DATA %p %d\n", -+ //__FUNCTION__, &pframe[index-tx_desc], (InviteRspLength+tx_desc)); -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + P2PInviteRspLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ //P2P provision discovery rsp -+ rsvd_page_loc->LocPDRsp = *page_num; -+ rtw_hal_construct_P2PProvisionDisRsp( adapter, -+ &pframe[index], &P2PPDRspLength); -+ -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index-tx_desc], -+ P2PPDRspLength, _FALSE, _FALSE, _FALSE); -+ -+ //DBG_871X("%s(): HW_VAR_SET_TX_CMD: QOS NULL DATA %p %d\n", -+ // __FUNCTION__, &pframe[index-tx_desc], (PDRspLength+tx_desc)); -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + P2PPDRspLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ *total_pkt_len = index + P2PPDRspLength; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ -+} -+#endif //CONFIG_P2P_WOWLAN -+ -+/* -+ * Description: Fill the reserved packets that FW will use to RSVD page. -+ * Now we just send 4 types packet to rsvd page. -+ * (1)Beacon, (2)Ps-poll, (3)Null data, (4)ProbeRsp. -+ * Input: -+ * finished - FALSE:At the first time we will send all the packets as a large packet to Hw, -+ * so we need to set the packet length to total lengh. -+ * TRUE: At the second time, we should send the first packet (default:beacon) -+ * to Hw again and set the lengh in descriptor to the real beacon lengh. -+ * 2009.10.15 by tynli. -+ * -+ * Page Size = 128: 8188e, 8723a/b, 8192c/d, -+ * Page Size = 256: 8192e, 8821a -+ * Page Size = 512: 8812a -+ */ -+ -+void rtw_hal_set_fw_rsvd_page(_adapter* adapter, bool finished) ++// ++// Description: Fill the reserved packets that FW will use to RSVD page. ++// Now we just send 4 types packet to rsvd page. ++// (1)Beacon, (2)Ps-poll, (3)Null data, (4)ProbeRsp. ++// Input: ++// bDLFinished - false: At the first time we will send all the packets as a large packet to Hw, ++// so we need to set the packet length to total lengh. ++// true: At the second time, we should send the first packet (default:beacon) ++// to Hw again and set the lengh in descriptor to the real beacon lengh. ++// 2009.10.15 by tynli. ++static void SetFwRsvdPagePkt_8812(PADAPTER padapter, bool bDLFinished) +{ + PHAL_DATA_TYPE pHalData; + struct xmit_frame *pcmdframe; @@ -161759,2335 +110086,579 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com.c linux/3rdparty/rtl8812au/h + struct xmit_priv *pxmitpriv; + struct mlme_ext_priv *pmlmeext; + struct mlme_ext_info *pmlmeinfo; -+ struct pwrctrl_priv *pwrctl; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ u32 BeaconLength = 0, ProbeRspLength = 0, PSPollLength = 0; -+ u32 NullDataLength = 0, QosNullLength = 0, BTQosNullLength = 0; -+ u32 ProbeReqLength = 0, NullFunctionDataLength = 0; -+ u8 TxDescLen = TXDESC_SIZE, TxDescOffset = TXDESC_OFFSET; -+ u8 TotalPageNum = 0 , CurtPktPageNum = 0 , RsvdPageNum = 0; ++ u32 PSPollLength, NullFunctionDataLength, QosNullLength; ++ u32 BcnLen; ++ u8 TotalPageNum=0, CurtPktPageNum=0, TxDescLen=0, RsvdPageNum=0; + u8 *ReservedPagePacket; -+ u16 BufIndex = 0; -+ u32 TotalPacketLen = 0, MaxRsvdPageBufSize = 0, PageSize = 0; -+ RSVDPAGE_LOC RsvdPageLoc; -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ struct sreset_priv *psrtpriv; -+#endif /* DBG_CONFIG_ERROR_DETECT */ ++ u8 RsvdPageLoc[5] = {0}; ++ u16 BufIndex=0, PageSize = 256; ++ u32 TotalPacketLen, MaxRsvdPageBufSize=0;; + + -+ pHalData = GET_HAL_DATA(adapter); -+#ifdef DBG_CONFIG_ERROR_DETECT -+ psrtpriv = &pHalData->srestpriv; -+#endif -+ pxmitpriv = &adapter->xmitpriv; -+ pmlmeext = &adapter->mlmeextpriv; ++ //DBG_871X("%s\n", __FUNCTION__); ++ ++ pHalData = GET_HAL_DATA(padapter); ++ pxmitpriv = &padapter->xmitpriv; ++ pmlmeext = &padapter->mlmeextpriv; + pmlmeinfo = &pmlmeext->mlmext_info; -+ pwrctl = adapter_to_pwrctl(adapter); + -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&PageSize); -+ -+ if (PageSize == 0) { -+ DBG_871X("[Error]: %s, PageSize is zero!!\n", __func__); -+ return; -+ } ++ if(IS_HARDWARE_TYPE_8812(padapter)) ++ PageSize = 512; ++ else if (IS_HARDWARE_TYPE_8821(padapter)) ++ PageSize = PAGE_SIZE_TX_8821A; + -+ if (pwrctl->wowlan_mode == _TRUE || pwrctl->wowlan_ap_mode == _TRUE) -+ RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _TRUE); -+ else -+ RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _FALSE); -+ -+ DBG_871X("%s PageSize: %d, RsvdPageNUm: %d\n",__func__, PageSize, RsvdPageNum); -+ ++ // The function SetFwRsvdPagePkt_8812() input must be added a value "bDLWholePackets" to ++ // decide if download wowlan packets, and use "bDLWholePackets" to be GetTxBufferRsvdPageNum8812() 2nd input value. ++ RsvdPageNum = GetTxBufferRsvdPageNum8812(padapter, false); + MaxRsvdPageBufSize = RsvdPageNum*PageSize; + -+ if (MaxRsvdPageBufSize > MAX_CMDBUF_SZ) { -+ DBG_871X("%s MaxRsvdPageBufSize(%d) is larger than MAX_CMDBUF_SZ(%d)", -+ __func__, MaxRsvdPageBufSize, MAX_CMDBUF_SZ); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); -+ ++ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv, MaxRsvdPageBufSize); + if (pcmdframe == NULL) { -+ DBG_871X("%s: alloc ReservedPagePacket fail!\n", __FUNCTION__); + return; + } + + ReservedPagePacket = pcmdframe->buf_addr; -+ _rtw_memset(&RsvdPageLoc, 0, sizeof(RSVDPAGE_LOC)); + -+ /* beacon * 2 pages */ -+ BufIndex = TxDescOffset; -+ rtw_hal_construct_beacon(adapter, -+ &ReservedPagePacket[BufIndex], &BeaconLength); ++ TxDescLen = TXDESC_SIZE;//The desc lengh in Tx packet buffer of 8812A is 40 bytes. + -+ /* -+ * When we count the first page size, we need to reserve description size for the RSVD -+ * packet, it will be filled in front of the packet in TXPKTBUF. -+ */ -+ CurtPktPageNum = (u8)PageNum((TxDescLen + BeaconLength), PageSize); -+ /* If we don't add 1 more page, ARP offload function will fail at 8723bs.*/ -+ if (CurtPktPageNum == 1) -+ CurtPktPageNum += 1; ++ //(1) beacon ++ BufIndex = TXDESC_OFFSET; ++ ConstructBeacon(padapter, &ReservedPagePacket[BufIndex], &BcnLen); + -+ TotalPageNum += CurtPktPageNum; ++ // When we count the first page size, we need to reserve description size for the RSVD ++ // packet, it will be filled in front of the packet in TXPKTBUF. ++ CurtPktPageNum = (u8)PageNum(BcnLen+TxDescLen, PageSize); + -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ if (pwrctl->wowlan_ap_mode == _TRUE) { -+ /* (4) probe response*/ -+ RsvdPageLoc.LocProbeRsp = TotalPageNum; -+ rtw_hal_construct_ProbeRsp( -+ adapter, &ReservedPagePacket[BufIndex], -+ &ProbeRspLength, -+ get_my_bssid(&pmlmeinfo->network), _FALSE); -+ rtw_hal_fill_fake_txdesc(adapter, -+ &ReservedPagePacket[BufIndex-TxDescLen], -+ ProbeRspLength, _FALSE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum(TxDescLen + ProbeRspLength, PageSize); ++ if(bDLFinished) ++ { + TotalPageNum += CurtPktPageNum; -+ TotalPacketLen = BufIndex + ProbeRspLength; -+ BufIndex += (CurtPktPageNum*PageSize); -+ goto download_page; ++ TotalPacketLen = (TotalPageNum*PageSize); ++ DBG_871X("%s(): Beacon page size = %d\n",__FUNCTION__,TotalPageNum); + } ++ else ++ { ++ TotalPageNum += CurtPktPageNum; + -+ /* ps-poll * 1 page */ -+ RsvdPageLoc.LocPsPoll = TotalPageNum; -+ DBG_871X("LocPsPoll: %d\n", RsvdPageLoc.LocPsPoll); -+ rtw_hal_construct_PSPoll(adapter, -+ &ReservedPagePacket[BufIndex], &PSPollLength); -+ rtw_hal_fill_fake_txdesc(adapter, -+ &ReservedPagePacket[BufIndex-TxDescLen], -+ PSPollLength, _TRUE, _FALSE, _FALSE); ++ pHalData->FwRsvdPageStartOffset = TotalPageNum; + -+ CurtPktPageNum = (u8)PageNum((TxDescLen + PSPollLength), PageSize); ++ BufIndex += (CurtPktPageNum*PageSize); + -+ TotalPageNum += CurtPktPageNum; ++ if(BufIndex > MaxRsvdPageBufSize) ++ { ++ DBG_871X("%s(): Beacon: The rsvd page size is not enough!!BufIndex %d, MaxRsvdPageBufSize %d\n",__FUNCTION__, ++ BufIndex,MaxRsvdPageBufSize); ++ goto error; ++ } + -+ BufIndex += (CurtPktPageNum*PageSize); ++ //(2) ps-poll ++ ConstructPSPoll(padapter, &ReservedPagePacket[BufIndex], &PSPollLength); ++ rtl8812a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], PSPollLength, true, false); + -+#ifdef CONFIG_BT_COEXIST -+ /* BT Qos null data * 1 page */ -+ RsvdPageLoc.LocBTQosNull = TotalPageNum; -+ DBG_871X("LocBTQosNull: %d\n", RsvdPageLoc.LocBTQosNull); -+ rtw_hal_construct_NullFunctionData( -+ adapter, ++ SET_8812_H2CCMD_RSVDPAGE_LOC_PSPOLL(RsvdPageLoc, TotalPageNum); ++ ++ //DBG_871X("SetFwRsvdPagePkt_8812(): HW_VAR_SET_TX_CMD: PS-POLL %p %d\n", ++ // &ReservedPagePacket[BufIndex-TxDescLen], (PSPollLength+TxDescLen)); ++ ++ CurtPktPageNum = (u8)PageNum(PSPollLength+TxDescLen, PageSize); ++ ++ BufIndex += (CurtPktPageNum*PageSize); ++ ++ TotalPageNum += CurtPktPageNum; ++ ++ if(BufIndex > MaxRsvdPageBufSize) ++ { ++ DBG_871X("%s(): ps-poll: The rsvd page size is not enough!!BufIndex %d, MaxRsvdPageBufSize %d\n",__FUNCTION__, ++ BufIndex,MaxRsvdPageBufSize); ++ goto error; ++ } ++ ++ //(3) null data ++ ConstructNullFunctionData( ++ padapter, + &ReservedPagePacket[BufIndex], -+ &BTQosNullLength, ++ &NullFunctionDataLength, + get_my_bssid(&pmlmeinfo->network), -+ _TRUE, 0, 0, _FALSE); -+ rtw_hal_fill_fake_txdesc(adapter, -+ &ReservedPagePacket[BufIndex-TxDescLen], -+ BTQosNullLength, _FALSE, _TRUE, _FALSE); ++ false, 0, 0, false); ++ rtl8812a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], NullFunctionDataLength, false, false); + -+ CurtPktPageNum = (u8)PageNum(TxDescLen + BTQosNullLength, PageSize); ++ SET_8812_H2CCMD_RSVDPAGE_LOC_NULL_DATA(RsvdPageLoc, TotalPageNum); + -+ TotalPageNum += CurtPktPageNum; ++ //DBG_871X("SetFwRsvdPagePkt_8812(): HW_VAR_SET_TX_CMD: NULL DATA %p %d\n", ++ // &ReservedPagePacket[BufIndex-TxDescLen], (NullFunctionDataLength+TxDescLen)); + -+ BufIndex += (CurtPktPageNum*PageSize); -+#endif /* CONFIG_BT_COEXIT */ ++ CurtPktPageNum = (u8)PageNum(NullFunctionDataLength+TxDescLen, PageSize); + -+ /* null data * 1 page */ -+ RsvdPageLoc.LocNullData = TotalPageNum; -+ DBG_871X("LocNullData: %d\n", RsvdPageLoc.LocNullData); -+ rtw_hal_construct_NullFunctionData( -+ adapter, -+ &ReservedPagePacket[BufIndex], -+ &NullDataLength, -+ get_my_bssid(&pmlmeinfo->network), -+ _FALSE, 0, 0, _FALSE); -+ rtw_hal_fill_fake_txdesc(adapter, -+ &ReservedPagePacket[BufIndex-TxDescLen], -+ NullDataLength, _FALSE, _FALSE, _FALSE); ++ BufIndex += (CurtPktPageNum*PageSize); + -+ CurtPktPageNum = (u8)PageNum(TxDescLen + NullDataLength, PageSize); ++ TotalPageNum += CurtPktPageNum; + -+ TotalPageNum += CurtPktPageNum; ++ if(BufIndex > MaxRsvdPageBufSize) ++ { ++ DBG_871X("%s(): Null-data: The rsvd page size is not enough!!BufIndex %d, MaxRsvdPageBufSize %d\n",__FUNCTION__, ++ BufIndex,MaxRsvdPageBufSize); ++ goto error; ++ } + -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ //Qos null data * 1 page -+ RsvdPageLoc.LocQosNull = TotalPageNum; -+ DBG_871X("LocQosNull: %d\n", RsvdPageLoc.LocQosNull); -+ rtw_hal_construct_NullFunctionData( -+ adapter, ++ //(5) Qos null data ++ ConstructNullFunctionData( ++ padapter, + &ReservedPagePacket[BufIndex], + &QosNullLength, + get_my_bssid(&pmlmeinfo->network), -+ _TRUE, 0, 0, _FALSE); -+ rtw_hal_fill_fake_txdesc(adapter, -+ &ReservedPagePacket[BufIndex-TxDescLen], -+ QosNullLength, _FALSE, _FALSE, _FALSE); ++ true, 0, 0, false); ++ rtl8812a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], QosNullLength, false, false); + -+ CurtPktPageNum = (u8)PageNum(TxDescLen + QosNullLength, PageSize); ++ SET_8812_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(RsvdPageLoc, TotalPageNum); + -+ TotalPageNum += CurtPktPageNum; ++ //DBG_871X("SetFwRsvdPagePkt_8812(): HW_VAR_SET_TX_CMD: QOS NULL DATA %p %d\n", ++ // &ReservedPagePacket[BufIndex-TxDescLen], (QosNullLength+TxDescLen)); + -+ TotalPacketLen = BufIndex + QosNullLength; ++ CurtPktPageNum = (u8)PageNum(QosNullLength+TxDescLen, PageSize); + -+ BufIndex += (CurtPktPageNum*PageSize); ++ BufIndex += (CurtPktPageNum*PageSize); + -+#ifdef CONFIG_WOWLAN -+ if (pwrctl->wowlan_mode == _TRUE && -+ check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ rtw_hal_set_wow_fw_rsvd_page(adapter, ReservedPagePacket, -+ BufIndex, TxDescLen, PageSize, -+ &TotalPageNum, &TotalPacketLen, &RsvdPageLoc); ++ TotalPageNum += CurtPktPageNum; ++ ++ TotalPacketLen = (TotalPageNum * PageSize); + } -+#endif /* CONFIG_WOWLAN */ + -+#ifdef CONFIG_P2P_WOWLAN -+ if(_TRUE == pwrctl->wowlan_p2p_mode) { -+ rtw_hal_set_p2p_wow_fw_rsvd_page(adapter, ReservedPagePacket, -+ BufIndex, TxDescLen, PageSize, -+ &TotalPageNum, &TotalPacketLen, &RsvdPageLoc); -+ } -+#endif /* CONFIG_P2P_WOWLAN */ + -+download_page: -+ //DBG_871X("%s BufIndex(%d), TxDescLen(%d), PageSize(%d)\n",__func__, BufIndex, TxDescLen, PageSize); -+ DBG_871X("%s PageNum(%d), pktlen(%d)\n", -+ __func__, TotalPageNum, TotalPacketLen); -+ -+ if (TotalPacketLen > MaxRsvdPageBufSize) { -+ DBG_871X("%s(ERROR): rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n", -+ __FUNCTION__, TotalPacketLen,MaxRsvdPageBufSize); -+ rtw_warn_on(1); ++ if(TotalPacketLen > MaxRsvdPageBufSize) ++ { ++ DBG_871X("%s(): ERROR: The rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n",__FUNCTION__, ++ TotalPacketLen,MaxRsvdPageBufSize); + goto error; -+ } else { -+ /* update attribute */ ++ } ++ else ++ { ++ // update attribute + pattrib = &pcmdframe->attrib; -+ update_mgntframe_attrib(adapter, pattrib); -+ pattrib->qsel = QSLT_BEACON; -+ pattrib->pktlen = TotalPacketLen - TxDescOffset; -+ pattrib->last_txcmdsz = TotalPacketLen - TxDescOffset; -+#ifdef CONFIG_PCI_HCI -+ dump_mgntframe(adapter, pcmdframe); -+#else -+ dump_mgntframe_and_wait(adapter, pcmdframe, 100); -+#endif ++ update_mgntframe_attrib(padapter, pattrib); ++ pattrib->qsel = 0x10; ++ pattrib->pktlen = pattrib->last_txcmdsz = TotalPacketLen - TxDescLen; ++ ++ dump_mgntframe_and_wait(padapter, pcmdframe, 100); + } + -+ DBG_871X("%s: Set RSVD page location to Fw ,TotalPacketLen(%d), TotalPageNum(%d)\n", -+ __func__,TotalPacketLen,TotalPageNum); -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ rtw_hal_set_FwRsvdPage_cmd(adapter, &RsvdPageLoc); -+ if (pwrctl->wowlan_mode == _TRUE) -+ rtw_hal_set_FwAoacRsvdPage_cmd(adapter, &RsvdPageLoc); -+#ifdef CONFIG_AP_WOWLAN -+ if (pwrctl->wowlan_ap_mode == _TRUE) -+ rtw_hal_set_ap_rsvdpage_loc_cmd(adapter, &RsvdPageLoc); -+#endif /* CONFIG_AP_WOWLAN */ -+ } else if (pwrctl->wowlan_pno_enable) { -+#ifdef CONFIG_PNO_SUPPORT -+ rtw_hal_set_FwAoacRsvdPage_cmd(adapter, &RsvdPageLoc); -+ if(pwrctl->pno_in_resume) -+ rtw_hal_set_scan_offload_info_cmd(adapter, -+ &RsvdPageLoc, 0); -+ else -+ rtw_hal_set_scan_offload_info_cmd(adapter, -+ &RsvdPageLoc, 1); -+#endif /* CONFIG_PNO_SUPPORT */ ++ if(!bDLFinished) ++ { ++ DBG_871X("%s: Set RSVD page location to Fw ,TotalPacketLen(%d), TotalPageNum(%d)\n", __FUNCTION__,TotalPacketLen,TotalPageNum); ++ FillH2CCmd_8812(padapter, H2C_8812_RSVDPAGE, 5, RsvdPageLoc); + } -+#ifdef CONFIG_P2P_WOWLAN -+ if(_TRUE == pwrctl->wowlan_p2p_mode) -+ rtw_hal_set_FwP2PRsvdPage_cmd(adapter, &RsvdPageLoc); -+#endif /* CONFIG_P2P_WOWLAN */ ++ ++ rtw_free_cmd_xmitbuf(pxmitpriv); ++ + return; ++ +error: -+ rtw_free_xmitframe(pxmitpriv, pcmdframe); ++ rtw_free_cmdxmitframe(pxmitpriv, pcmdframe); +} + -+void SetHwReg(_adapter *adapter, u8 variable, u8 *val) ++void rtl8812_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus) +{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+_func_enter_; -+ -+ switch (variable) { -+ case HW_VAR_PORT_SWITCH: -+ hw_var_port_switch(adapter); -+ break; -+ case HW_VAR_INIT_RTS_RATE: -+ { -+ u16 brate_cfg = *((u16*)val); -+ u8 rate_index = 0; -+ HAL_VERSION *hal_ver = &hal_data->VersionID; -+ -+ if (IS_8188E(*hal_ver)) { -+ -+ while (brate_cfg > 0x1) { -+ brate_cfg = (brate_cfg >> 1); -+ rate_index++; -+ } -+ rtw_write8(adapter, REG_INIRTS_RATE_SEL, rate_index); -+ } else { -+ rtw_warn_on(1); -+ } -+ } -+ break; -+ case HW_VAR_SEC_CFG: -+ { -+ #if defined(CONFIG_CONCURRENT_MODE) && !defined(DYNAMIC_CAMID_ALLOC) -+ // enable tx enc and rx dec engine, and no key search for MC/BC -+ rtw_write8(adapter, REG_SECCFG, SCR_NoSKMC|SCR_RxDecEnable|SCR_TxEncEnable); -+ #elif defined(DYNAMIC_CAMID_ALLOC) -+ u16 reg_scr_ori; -+ u16 reg_scr; -+ -+ reg_scr = reg_scr_ori = rtw_read16(adapter, REG_SECCFG); -+ reg_scr |= (SCR_CHK_KEYID|SCR_RxDecEnable|SCR_TxEncEnable); -+ -+ if (_rtw_camctl_chk_cap(adapter, SEC_CAP_CHK_BMC)) -+ reg_scr |= SCR_CHK_BMC; -+ -+ if (_rtw_camctl_chk_flags(adapter, SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH)) -+ reg_scr |= SCR_NoSKMC; -+ -+ if (reg_scr != reg_scr_ori) -+ rtw_write16(adapter, REG_SECCFG, reg_scr); -+ #else -+ rtw_write8(adapter, REG_SECCFG, *((u8*)val)); -+ #endif -+ } -+ break; -+ case HW_VAR_SEC_DK_CFG: -+ { -+ struct security_priv *sec = &adapter->securitypriv; -+ u8 reg_scr = rtw_read8(adapter, REG_SECCFG); -+ -+ if (val) /* Enable default key related setting */ -+ { -+ reg_scr |= SCR_TXBCUSEDK; -+ if (sec->dot11AuthAlgrthm != dot11AuthAlgrthm_8021X) -+ reg_scr |= (SCR_RxUseDK|SCR_TxUseDK); -+ } -+ else /* Disable default key related setting */ -+ { -+ reg_scr &= ~(SCR_RXBCUSEDK|SCR_TXBCUSEDK|SCR_RxUseDK|SCR_TxUseDK); -+ } -+ -+ rtw_write8(adapter, REG_SECCFG, reg_scr); -+ } -+ break; -+ -+ case HW_VAR_ASIX_IOT: -+ // enable ASIX IOT function -+ if (*((u8*)val) == _TRUE) { -+ // 0xa2e[0]=0 (disable rake receiver) -+ rtw_write8(adapter, rCCK0_FalseAlarmReport+2, -+ rtw_read8(adapter, rCCK0_FalseAlarmReport+2) & ~(BIT0)); -+ // 0xa1c=0xa0 (reset channel estimation if signal quality is bad) -+ rtw_write8(adapter, rCCK0_DSPParameter2, 0xa0); -+ } else { -+ // restore reg:0xa2e, reg:0xa1c -+ rtw_write8(adapter, rCCK0_FalseAlarmReport+2, -+ rtw_read8(adapter, rCCK0_FalseAlarmReport+2)|(BIT0)); -+ rtw_write8(adapter, rCCK0_DSPParameter2, 0x00); -+ } -+ break; -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ case HW_VAR_WOWLAN: -+ { -+ struct wowlan_ioctl_param *poidparam; -+ -+ poidparam = (struct wowlan_ioctl_param *)val; -+ switch (poidparam->subcode) { -+#ifdef CONFIG_WOWLAN -+ case WOWLAN_PATTERN_CLEAN: -+ rtw_hal_dl_pattern(adapter, _TRUE); -+ break; -+ case WOWLAN_ENABLE: -+ rtw_hal_wow_enable(adapter); -+ break; -+ case WOWLAN_DISABLE: -+ rtw_hal_wow_disable(adapter); -+ break; -+#endif /*CONFIG_WOWLAN*/ -+#ifdef CONFIG_AP_WOWLAN -+ case WOWLAN_AP_ENABLE: -+ rtw_hal_ap_wow_enable(adapter); -+ break; -+ case WOWLAN_AP_DISABLE: -+ rtw_hal_ap_wow_disable(adapter); -+ break; -+#endif /*CONFIG_AP_WOWLAN*/ -+ default: -+ break; -+ } -+ } -+ break; -+#endif /*defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN)*/ -+ default: -+ if (0) -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" variable(%d) not defined!\n", -+ FUNC_ADPT_ARG(adapter), variable); -+ break; -+ } -+ -+_func_exit_; -+} -+ -+void GetHwReg(_adapter *adapter, u8 variable, u8 *val) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+_func_enter_; -+ -+ switch (variable) { -+ case HW_VAR_BASIC_RATE: -+ *((u16*)val) = hal_data->BasicRateSet; -+ break; -+ case HW_VAR_RF_TYPE: -+ *((u8*)val) = hal_data->rf_type; -+ break; -+ default: -+ if (0) -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" variable(%d) not defined!\n", -+ FUNC_ADPT_ARG(adapter), variable); -+ break; -+ } -+ -+_func_exit_; -+} -+ -+u8 -+SetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 bResult = _SUCCESS; -+ -+ switch(variable) { -+ -+ case HAL_DEF_DBG_DUMP_RXPKT: -+ hal_data->bDumpRxPkt = *((u8*)value); -+ break; -+ case HAL_DEF_DBG_DUMP_TXPKT: -+ hal_data->bDumpTxPkt = *((u8*)value); -+ break; -+ case HAL_DEF_ANT_DETECT: -+ hal_data->AntDetection = *((u8 *)value); -+ break; -+ case HAL_DEF_DBG_DIS_PWT: -+ hal_data->bDisableTXPowerTraining = *((u8*)value); -+ break; -+ default: -+ DBG_871X_LEVEL(_drv_always_, "%s: [WARNING] HAL_DEF_VARIABLE(%d) not defined!\n", __FUNCTION__, variable); -+ bResult = _FAIL; -+ break; -+ } -+ -+ return bResult; -+} -+ -+#ifdef CONFIG_BEAMFORMING -+u8 rtw_hal_query_txbfer_rf_num(_adapter *adapter) -+{ -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ if ((pregistrypriv->beamformer_rf_num) && (IS_HARDWARE_TYPE_8814AE(adapter) || IS_HARDWARE_TYPE_8814AU(adapter) || IS_HARDWARE_TYPE_8822BU(adapter))) -+ return pregistrypriv->beamformer_rf_num; -+ else if (IS_HARDWARE_TYPE_8814AE(adapter) -+/* -+#if defined(CONFIG_USB_HCI) -+ || (IS_HARDWARE_TYPE_8814AU(adapter) && (pUsbModeMech->CurUsbMode == 2 || pUsbModeMech->HubUsbMode == 2)) //for USB3.0 -+#endif -+*/ -+ ) { -+ /*BF cap provided by Yu Chen, Sean, 2015, 01 */ -+ if (hal_data->rf_type == RF_3T3R) -+ return 2; -+ else if (hal_data->rf_type == RF_4T4R) -+ return 3; -+ else -+ return 1; -+ } else -+ return 1; -+ -+} -+u8 rtw_hal_query_txbfee_rf_num(_adapter *adapter) -+{ -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ if ((pregistrypriv->beamformee_rf_num) && (IS_HARDWARE_TYPE_8814AE(adapter) || IS_HARDWARE_TYPE_8814AU(adapter) || IS_HARDWARE_TYPE_8822BU(adapter))) -+ return pregistrypriv->beamformee_rf_num; -+ else if (IS_HARDWARE_TYPE_8814AE(adapter) || IS_HARDWARE_TYPE_8814AU(adapter)) { -+ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_BROADCOM) -+ return 2; -+ else -+ return 2;/*TODO: May be 3 in the future, by ChenYu. */ -+ } else -+ return 1; -+ -+} -+#endif ++ bool bSendBeacon=false; ++ bool bcn_valid = false; ++ u8 DLBcnCount=0; ++ u32 poll = 0; + -+u8 -+GetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 bResult = _SUCCESS; + -+ switch(variable) { -+ case HAL_DEF_UNDERCORATEDSMOOTHEDPWDB: ++ ++ DBG_871X("%s mstatus(%x)\n", __FUNCTION__,mstatus); ++ ++ if(mstatus == 1) ++ { ++ // We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. ++ // Suggested by filen. Added by tynli. ++ rtw_write16(padapter, REG_BCN_PSR_RPT, (0xC000|pmlmeinfo->aid)); ++ // Do not set TSF again here or vWiFi beacon DMA INT will not work. ++ //correct_TSF(padapter, pmlmeext); ++ // Hw sequende enable by dedault. 2010.06.23. by tynli. ++ //rtw_write16(padapter, REG_NQOS_SEQ, ((pmlmeext->mgnt_seq+100)&0xFFF)); ++ //rtw_write8(padapter, REG_HWSEQ_CTRL, 0xFF); ++ ++ //Set REG_CR bit 8. DMA beacon by SW. ++ pHalData->RegCR_1 |= BIT0; ++ rtw_write8(padapter, REG_CR+1, pHalData->RegCR_1); ++ ++ // Disable Hw protection for a time which revserd for Hw sending beacon. ++ // Fix download reserved page packet fail that access collision with the protection time. ++ // 2010.05.11. Added by tynli. ++ //SetBcnCtrlReg(padapter, 0, BIT3); ++ //SetBcnCtrlReg(padapter, BIT4, 0); ++ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)&(~BIT(3))); ++ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)|BIT(4)); ++ ++ if(pHalData->RegFwHwTxQCtrl&BIT6) ++ { ++ DBG_871X("HalDownloadRSVDPage(): There is an Adapter is sending beacon.\n"); ++ bSendBeacon = true; ++ } ++ ++ // Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. ++ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, (pHalData->RegFwHwTxQCtrl&(~BIT6))); ++ pHalData->RegFwHwTxQCtrl &= (~BIT6); ++ ++ // Clear beacon valid check bit. ++ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); ++ DLBcnCount = 0; ++ poll = 0; ++ do ++ { ++ // download rsvd page. ++ SetFwRsvdPagePkt_8812(padapter, false); ++ DLBcnCount++; ++ do + { -+ struct mlme_priv *pmlmepriv; -+ struct sta_priv *pstapriv; -+ struct sta_info *psta; ++ rtw_yield_os(); ++ //rtw_mdelay_os(10); ++ // check rsvd page download OK. ++ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8*)(&bcn_valid)); ++ poll++; ++ } while(!bcn_valid && (poll%10)!=0 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); + -+ pmlmepriv = &adapter->mlmepriv; -+ pstapriv = &adapter->stapriv; -+ psta = rtw_get_stainfo(pstapriv, pmlmepriv->cur_network.network.MacAddress); -+ if (psta) ++ }while(!bcn_valid && DLBcnCount<=100 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); ++ ++ //RT_ASSERT(bcn_valid, ("HalDownloadRSVDPage88ES(): 1 Download RSVD page failed!\n")); ++ if(padapter->bSurpriseRemoved || padapter->bDriverStopped) ++ { ++ } ++ else if(!bcn_valid) ++ DBG_871X("%s: 1 Download RSVD page failed! DLBcnCount:%u, poll:%u\n", __FUNCTION__ ,DLBcnCount, poll); ++ else ++ DBG_871X("%s: 1 Download RSVD success! DLBcnCount:%u, poll:%u\n", __FUNCTION__, DLBcnCount, poll); ++ // ++ // We just can send the reserved page twice during the time that Tx thread is stopped (e.g. pnpsetpower) ++ // becuase we need to free the Tx BCN Desc which is used by the first reserved page packet. ++ // At run time, we cannot get the Tx Desc until it is released in TxHandleInterrupt() so we will return ++ // the beacon TCB in the following code. 2011.11.23. by tynli. ++ // ++ //if(bcn_valid && padapter->bEnterPnpSleep) ++ if(0) ++ { ++ if(bSendBeacon) ++ { ++ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); ++ DLBcnCount = 0; ++ poll = 0; ++ do + { -+ *((int*)value) = psta->rssi_stat.UndecoratedSmoothedPWDB; -+ } -+ } -+ break; -+ case HAL_DEF_DBG_DUMP_RXPKT: -+ *((u8*)value) = hal_data->bDumpRxPkt; -+ break; -+ case HAL_DEF_DBG_DUMP_TXPKT: -+ *((u8*)value) = hal_data->bDumpTxPkt; -+ break; -+ case HAL_DEF_ANT_DETECT: -+ *((u8 *)value) = hal_data->AntDetection; -+ break; -+ case HAL_DEF_MACID_SLEEP: -+ *(u8*)value = _FALSE; -+ break; -+ case HAL_DEF_TX_PAGE_SIZE: -+ *(( u32*)value) = PAGE_SIZE_128; -+ break; -+ case HAL_DEF_DBG_DIS_PWT: -+ *(u8*)value = hal_data->bDisableTXPowerTraining; -+ break; -+#ifdef CONFIG_BEAMFORMING -+ case HAL_DEF_BEAMFORMER_CAP: -+ *(u8 *)value = rtw_hal_query_txbfer_rf_num(adapter); -+ break; -+ case HAL_DEF_BEAMFORMEE_CAP: -+ *(u8 *)value = rtw_hal_query_txbfee_rf_num(adapter); -+ break; -+#endif -+ default: -+ DBG_871X_LEVEL(_drv_always_, "%s: [WARNING] HAL_DEF_VARIABLE(%d) not defined!\n", __FUNCTION__, variable); -+ bResult = _FAIL; -+ break; -+ } ++ SetFwRsvdPagePkt_8812(padapter, true); ++ DLBcnCount++; ++ ++ do ++ { ++ rtw_yield_os(); ++ //rtw_mdelay_os(10); ++ // check rsvd page download OK. ++ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8*)(&bcn_valid)); ++ poll++; ++ } while(!bcn_valid && (poll%10)!=0 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); ++ }while(!bcn_valid && DLBcnCount<=100 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); ++ ++ //RT_ASSERT(bcn_valid, ("HalDownloadRSVDPage(): 2 Download RSVD page failed!\n")); ++ if(padapter->bSurpriseRemoved || padapter->bDriverStopped) ++ { ++ } ++ else if(!bcn_valid) ++ DBG_871X("%s: 2 Download RSVD page failed! DLBcnCount:%u, poll:%u\n", __FUNCTION__ ,DLBcnCount, poll); ++ else ++ DBG_871X("%s: 2 Download RSVD success! DLBcnCount:%u, poll:%u\n", __FUNCTION__, DLBcnCount, poll); ++ } ++ } ++ ++ // Enable Bcn ++ //SetBcnCtrlReg(padapter, BIT3, 0); ++ //SetBcnCtrlReg(padapter, 0, BIT4); ++ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)|BIT(3)); ++ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)&(~BIT(4))); ++ ++ // To make sure that if there exists an adapter which would like to send beacon. ++ // If exists, the origianl value of 0x422[6] will be 1, we should check this to ++ // prevent from setting 0x422[6] to 0 after download reserved page, or it will cause ++ // the beacon cannot be sent by HW. ++ // 2010.06.23. Added by tynli. ++ if(bSendBeacon) ++ { ++ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, (pHalData->RegFwHwTxQCtrl|BIT6)); ++ pHalData->RegFwHwTxQCtrl |= BIT6; ++ } ++ ++ // ++ // Update RSVD page location H2C to Fw. ++ // ++ if(bcn_valid) ++ { ++ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); ++ DBG_871X("Set RSVD page location to Fw.\n"); ++ //FillH2CCmd88E(Adapter, H2C_88E_RSVDPAGE, H2C_RSVDPAGE_LOC_LENGTH, pMgntInfo->u1RsvdPageLoc); ++ } ++ ++ // Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli. ++ //if(!padapter->bEnterPnpSleep) ++ { ++ // Clear CR[8] or beacon packet will not be send to TxBuf anymore. ++ pHalData->RegCR_1 &= (~BIT0); ++ rtw_write8(padapter, REG_CR+1, pHalData->RegCR_1); ++ } ++ } ++#ifdef CONFIG_WOWLAN ++ if (padapter->pwrctrlpriv.wowlan_mode){ ++ u16 media_status; ++ ++ media_status = mstatus; ++ rtl8812_set_FwMediaStatus_cmd(padapter, media_status); ++ DBG_871X_LEVEL(_drv_info_, "%s wowlan_mode is on\n", __func__); ++ } else { ++ DBG_871X_LEVEL(_drv_info_, "%s wowlan_mode is off\n", __func__); ++ } ++#endif //CONFIG_WOWLAN + -+ return bResult; +} + -+void SetHalODMVar( -+ PADAPTER Adapter, -+ HAL_ODM_VARIABLE eVariable, -+ PVOID pValue1, -+ BOOLEAN bSet) ++#ifdef CONFIG_P2P_PS ++void rtl8812_set_p2p_ps_offload_cmd(_adapter* padapter, u8 p2p_ps_state) +{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ //_irqL irqL; -+ switch(eVariable){ -+ case HAL_ODM_STA_INFO: -+ { -+ struct sta_info *psta = (struct sta_info *)pValue1; -+ if(bSet){ -+ DBG_8192C("### Set STA_(%d) info ###\n",psta->mac_id); -+ ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS,psta->mac_id,psta); -+ } -+ else{ -+ DBG_8192C("### Clean STA_(%d) info ###\n",psta->mac_id); -+ //_enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); -+ ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS,psta->mac_id,NULL); -+ -+ //_exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); -+ } -+ } -+ break; -+ case HAL_ODM_P2P_STATE: -+ ODM_CmnInfoUpdate(podmpriv,ODM_CMNINFO_WIFI_DIRECT,bSet); -+ break; -+ case HAL_ODM_WIFI_DISPLAY_STATE: -+ ODM_CmnInfoUpdate(podmpriv,ODM_CMNINFO_WIFI_DISPLAY,bSet); -+ break; -+ case HAL_ODM_REGULATION: -+ ODM_CmnInfoInit(podmpriv, ODM_CMNINFO_DOMAIN_CODE_2G, pHalData->Regulation2_4G); -+ ODM_CmnInfoInit(podmpriv, ODM_CMNINFO_DOMAIN_CODE_5G, pHalData->Regulation5G); -+ break; -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ case HAL_ODM_NOISE_MONITOR: -+ { -+ struct noise_info *pinfo = (struct noise_info *)pValue1; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; ++ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); ++ u8 *p2p_ps_offload = (u8 *)&pHalData->p2p_ps_offload; ++ u8 i; + -+ #ifdef DBG_NOISE_MONITOR -+ DBG_8192C("### Noise monitor chan(%d)-bPauseDIG:%d,IGIValue:0x%02x,max_time:%d (ms) ###\n", -+ pinfo->chan,pinfo->bPauseDIG,pinfo->IGIValue,pinfo->max_time); -+ #endif -+ -+ pHalData->noise[pinfo->chan] = ODM_InbandNoise_Monitor(podmpriv,pinfo->bPauseDIG,pinfo->IGIValue,pinfo->max_time); -+ DBG_871X("chan_%d, noise = %d (dBm)\n",pinfo->chan,pHalData->noise[pinfo->chan]); -+ #ifdef DBG_NOISE_MONITOR -+ DBG_871X("noise_a = %d, noise_b = %d noise_all:%d \n", -+ podmpriv->noise_level.noise[ODM_RF_PATH_A], -+ podmpriv->noise_level.noise[ODM_RF_PATH_B], -+ podmpriv->noise_level.noise_all); -+ #endif -+ } -+ break; -+#endif/*#ifdef CONFIG_BACKGROUND_NOISE_MONITOR*/ + -+ case HAL_ODM_INITIAL_GAIN: ++ ++#if 1 ++ switch(p2p_ps_state) ++ { ++ case P2P_PS_DISABLE: ++ DBG_8192C("P2P_PS_DISABLE \n"); ++ _rtw_memset(p2p_ps_offload, 0, 1); ++ break; ++ case P2P_PS_ENABLE: ++ DBG_8192C("P2P_PS_ENABLE \n"); ++ // update CTWindow value. ++ if( pwdinfo->ctwindow > 0 ) + { -+ u8 rx_gain = *((u8 *)(pValue1)); -+ /*printk("rx_gain:%x\n",rx_gain);*/ -+ if (rx_gain == 0xff) {/*restore rx gain*/ -+ /*ODM_Write_DIG(podmpriv,pDigTable->BackupIGValue);*/ -+ odm_PauseDIG(podmpriv, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_0, rx_gain); ++ SET_8812_H2CCMD_P2P_PS_OFFLOAD_CTWINDOW_EN(p2p_ps_offload, 1); ++ rtw_write8(padapter, REG_P2P_CTWIN, pwdinfo->ctwindow); ++ } ++ ++ // hw only support 2 set of NoA ++ for( i=0 ; inoa_num ; i++) ++ { ++ // To control the register setting for which NOA ++ rtw_write8(padapter, REG_NOA_DESC_SEL, (i << 4)); ++ if(i == 0) { ++ SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(p2p_ps_offload, 1); + } else { -+ /*pDigTable->BackupIGValue = pDigTable->CurIGValue;*/ -+ /*ODM_Write_DIG(podmpriv,rx_gain);*/ -+ odm_PauseDIG(podmpriv, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_0, rx_gain); ++ SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(p2p_ps_offload, 1); + } ++ ++ // config P2P NoA Descriptor Register ++ //DBG_8192C("%s(): noa_duration = %x\n",__FUNCTION__,pwdinfo->noa_duration[i]); ++ rtw_write32(padapter, REG_NOA_DESC_DURATION, pwdinfo->noa_duration[i]); ++ ++ //DBG_8192C("%s(): noa_interval = %x\n",__FUNCTION__,pwdinfo->noa_interval[i]); ++ rtw_write32(padapter, REG_NOA_DESC_INTERVAL, pwdinfo->noa_interval[i]); ++ ++ //DBG_8192C("%s(): start_time = %x\n",__FUNCTION__,pwdinfo->noa_start_time[i]); ++ rtw_write32(padapter, REG_NOA_DESC_START, pwdinfo->noa_start_time[i]); ++ ++ //DBG_8192C("%s(): noa_count = %x\n",__FUNCTION__,pwdinfo->noa_count[i]); ++ rtw_write8(padapter, REG_NOA_DESC_COUNT, pwdinfo->noa_count[i]); + } -+ break; -+ case HAL_ODM_FA_CNT_DUMP: -+ if (*((u8 *)pValue1)) -+ podmpriv->DebugComponents |= (ODM_COMP_DIG | ODM_COMP_FA_CNT); -+ else -+ podmpriv->DebugComponents &= ~(ODM_COMP_DIG | ODM_COMP_FA_CNT); -+ break; -+ case HAL_ODM_DBG_FLAG: -+ ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_DBG_COMP, *((u8Byte *)pValue1)); -+ break; -+ case HAL_ODM_DBG_LEVEL: -+ ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_DBG_LEVEL, *((u4Byte *)pValue1)); -+ break; -+ case HAL_ODM_RX_INFO_DUMP: -+ { -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure(podmpriv , PHYDM_FALSEALMCNT); -+ pDIG_T pDM_DigTable = &podmpriv->DM_DigTable; + -+ DBG_871X("============ Rx Info dump ===================\n"); -+ DBG_871X("bLinked = %d, RSSI_Min = %d(%%), CurrentIGI = 0x%x\n", -+ podmpriv->bLinked, podmpriv->RSSI_Min, pDM_DigTable->CurIGValue); -+ if (FalseAlmCnt) -+ DBG_871X("Cnt_Cck_fail = %d, Cnt_Ofdm_fail = %d, Total False Alarm = %d\n", -+ FalseAlmCnt->Cnt_Cck_fail, FalseAlmCnt->Cnt_Ofdm_fail, FalseAlmCnt->Cnt_all); -+ -+ if (podmpriv->bLinked) { -+ DBG_871X("RxRate = %s, RSSI_A = %d(%%), RSSI_B = %d(%%)\n", -+ HDATA_RATE(podmpriv->RxRate), podmpriv->RSSI_A, podmpriv->RSSI_B); -+ -+ #ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ rtw_dump_raw_rssi_info(Adapter); -+ #endif -+ } -+ } -+ break; -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ case HAL_ODM_AUTO_CHNL_SEL: -+ { -+ ACS_OP acs_op = *(ACS_OP *)pValue1; -+ -+ rtw_phydm_func_set(Adapter, ODM_BB_NHM_CNT); -+ -+ if (ACS_INIT == acs_op) { -+ #ifdef DBG_AUTO_CHNL_SEL_NHM -+ DBG_871X("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: ACS_INIT\n", ADPT_ARG(Adapter)); -+ #endif -+ odm_AutoChannelSelectInit(podmpriv); -+ } else if (ACS_RESET == acs_op) { -+ /* Reset statistics for auto channel selection mechanism.*/ -+ #ifdef DBG_AUTO_CHNL_SEL_NHM -+ DBG_871X("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: ACS_RESET\n", ADPT_ARG(Adapter)); -+ #endif -+ odm_AutoChannelSelectReset(podmpriv); -+ -+ } else if (ACS_SELECT == acs_op) { -+ /* Collect NHM measurement result after current channel */ -+ #ifdef DBG_AUTO_CHNL_SEL_NHM -+ DBG_871X("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: ACS_SELECT, CH(%d)\n", ADPT_ARG(Adapter), rtw_get_acs_channel(Adapter)); -+ #endif -+ odm_AutoChannelSelect(podmpriv, rtw_get_acs_channel(Adapter)); -+ } else -+ DBG_871X("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: Unexpected OP\n", ADPT_ARG(Adapter)); -+ -+ } -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+void GetHalODMVar( -+ PADAPTER Adapter, -+ HAL_ODM_VARIABLE eVariable, -+ PVOID pValue1, -+ PVOID pValue2) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ -+ switch (eVariable) { -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ case HAL_ODM_NOISE_MONITOR: -+ { -+ u8 chan = *(u8 *)pValue1; -+ *(s16 *)pValue2 = pHalData->noise[chan]; -+ #ifdef DBG_NOISE_MONITOR -+ DBG_8192C("### Noise monitor chan(%d)-noise:%d (dBm) ###\n", -+ chan, pHalData->noise[chan]); -+ #endif -+ } -+ break; -+#endif/*#ifdef CONFIG_BACKGROUND_NOISE_MONITOR*/ -+ case HAL_ODM_DBG_FLAG: -+ *((u8Byte *)pValue1) = podmpriv->DebugComponents; -+ break; -+ case HAL_ODM_DBG_LEVEL: -+ *((u4Byte *)pValue1) = podmpriv->DebugLevel; -+ break; -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ case HAL_ODM_AUTO_CHNL_SEL: -+ { -+ #ifdef DBG_AUTO_CHNL_SEL_NHM -+ DBG_871X("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: GET_BEST_CHAN\n", ADPT_ARG(Adapter)); -+ #endif -+ /* Retrieve better channel from NHM mechanism */ -+ if (IsSupported24G(Adapter->registrypriv.wireless_mode)) -+ *((u8 *)(pValue1)) = ODM_GetAutoChannelSelectResult(podmpriv, BAND_ON_2_4G); -+ if (IsSupported5G(Adapter->registrypriv.wireless_mode)) -+ *((u8 *)(pValue2)) = ODM_GetAutoChannelSelectResult(podmpriv, BAND_ON_5G); -+ } -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+ -+u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ u32 result = 0; -+ -+ switch (ops) { -+ case HAL_PHYDM_DIS_ALL_FUNC: -+ podmpriv->SupportAbility = DYNAMIC_FUNC_DISABLE; -+ break; -+ case HAL_PHYDM_FUNC_SET: -+ podmpriv->SupportAbility |= ability; -+ break; -+ case HAL_PHYDM_FUNC_CLR: -+ podmpriv->SupportAbility &= ~(ability); -+ break; -+ case HAL_PHYDM_ABILITY_BK: -+ /* dm flag backup*/ -+ podmpriv->BK_SupportAbility = podmpriv->SupportAbility; -+ break; -+ case HAL_PHYDM_ABILITY_RESTORE: -+ /* restore dm flag */ -+ podmpriv->SupportAbility = podmpriv->BK_SupportAbility; -+ break; -+ case HAL_PHYDM_ABILITY_SET: -+ podmpriv->SupportAbility = ability; -+ break; -+ case HAL_PHYDM_ABILITY_GET: -+ result = podmpriv->SupportAbility; -+ break; -+ } -+ return result; -+} -+ -+ -+BOOLEAN -+eqNByte( -+ u8* str1, -+ u8* str2, -+ u32 num -+ ) -+{ -+ if(num==0) -+ return _FALSE; -+ while(num>0) -+ { -+ num--; -+ if(str1[num]!=str2[num]) -+ return _FALSE; -+ } -+ return _TRUE; -+} -+ -+// -+// Description: -+// Return TRUE if chTmp is represent for hex digit and -+// FALSE otherwise. -+// -+// -+BOOLEAN -+IsHexDigit( -+ IN char chTmp -+) -+{ -+ if( (chTmp >= '0' && chTmp <= '9') || -+ (chTmp >= 'a' && chTmp <= 'f') || -+ (chTmp >= 'A' && chTmp <= 'F') ) -+ { -+ return _TRUE; -+ } -+ else -+ { -+ return _FALSE; -+ } -+} -+ -+ -+// -+// Description: -+// Translate a character to hex digit. -+// -+u32 -+MapCharToHexDigit( -+ IN char chTmp -+) -+{ -+ if(chTmp >= '0' && chTmp <= '9') -+ return (chTmp - '0'); -+ else if(chTmp >= 'a' && chTmp <= 'f') -+ return (10 + (chTmp - 'a')); -+ else if(chTmp >= 'A' && chTmp <= 'F') -+ return (10 + (chTmp - 'A')); -+ else -+ return 0; -+} -+ -+ -+ -+// -+// Description: -+// Parse hex number from the string pucStr. -+// -+BOOLEAN -+GetHexValueFromString( -+ IN char* szStr, -+ IN OUT u32* pu4bVal, -+ IN OUT u32* pu4bMove -+) -+{ -+ char* szScan = szStr; -+ -+ // Check input parameter. -+ if(szStr == NULL || pu4bVal == NULL || pu4bMove == NULL) -+ { -+ DBG_871X("GetHexValueFromString(): Invalid inpur argumetns! szStr: %p, pu4bVal: %p, pu4bMove: %p\n", szStr, pu4bVal, pu4bMove); -+ return _FALSE; -+ } -+ -+ // Initialize output. -+ *pu4bMove = 0; -+ *pu4bVal = 0; -+ -+ // Skip leading space. -+ while( *szScan != '\0' && -+ (*szScan == ' ' || *szScan == '\t') ) -+ { -+ szScan++; -+ (*pu4bMove)++; -+ } -+ -+ // Skip leading '0x' or '0X'. -+ if(*szScan == '0' && (*(szScan+1) == 'x' || *(szScan+1) == 'X')) -+ { -+ szScan += 2; -+ (*pu4bMove) += 2; -+ } -+ -+ // Check if szScan is now pointer to a character for hex digit, -+ // if not, it means this is not a valid hex number. -+ if(!IsHexDigit(*szScan)) -+ { -+ return _FALSE; -+ } -+ -+ // Parse each digit. -+ do -+ { -+ (*pu4bVal) <<= 4; -+ *pu4bVal += MapCharToHexDigit(*szScan); -+ -+ szScan++; -+ (*pu4bMove)++; -+ } while(IsHexDigit(*szScan)); -+ -+ return _TRUE; -+} -+ -+BOOLEAN -+GetFractionValueFromString( -+ IN char* szStr, -+ IN OUT u8* pInteger, -+ IN OUT u8* pFraction, -+ IN OUT u32* pu4bMove -+) -+{ -+ char *szScan = szStr; -+ -+ // Initialize output. -+ *pu4bMove = 0; -+ *pInteger = 0; -+ *pFraction = 0; -+ -+ // Skip leading space. -+ while ( *szScan != '\0' && (*szScan == ' ' || *szScan == '\t') ) { -+ ++szScan; -+ ++(*pu4bMove); -+ } -+ -+ // Parse each digit. -+ do { -+ (*pInteger) *= 10; -+ *pInteger += ( *szScan - '0' ); -+ -+ ++szScan; -+ ++(*pu4bMove); -+ -+ if ( *szScan == '.' ) -+ { -+ ++szScan; -+ ++(*pu4bMove); -+ -+ if ( *szScan < '0' || *szScan > '9' ) -+ return _FALSE; -+ else { -+ *pFraction = *szScan - '0'; -+ ++szScan; -+ ++(*pu4bMove); -+ return _TRUE; -+ } -+ } -+ } while(*szScan >= '0' && *szScan <= '9'); -+ -+ return _TRUE; -+} -+ -+// -+// Description: -+// Return TRUE if szStr is comment out with leading "//". -+// -+BOOLEAN -+IsCommentString( -+ IN char *szStr -+) -+{ -+ if(*szStr == '/' && *(szStr+1) == '/') -+ { -+ return _TRUE; -+ } -+ else -+ { -+ return _FALSE; -+ } -+} -+ -+BOOLEAN -+GetU1ByteIntegerFromStringInDecimal( -+ IN char* Str, -+ IN OUT u8* pInt -+ ) -+{ -+ u16 i = 0; -+ *pInt = 0; -+ -+ while ( Str[i] != '\0' ) -+ { -+ if ( Str[i] >= '0' && Str[i] <= '9' ) -+ { -+ *pInt *= 10; -+ *pInt += ( Str[i] - '0' ); -+ } -+ else -+ { -+ return _FALSE; -+ } -+ ++i; -+ } -+ -+ return _TRUE; -+} -+ -+// <20121004, Kordan> For example, -+// ParseQualifiedString(inString, 0, outString, '[', ']') gets "Kordan" from a string "Hello [Kordan]". -+// If RightQualifier does not exist, it will hang on in the while loop -+BOOLEAN -+ParseQualifiedString( -+ IN char* In, -+ IN OUT u32* Start, -+ OUT char* Out, -+ IN char LeftQualifier, -+ IN char RightQualifier -+ ) -+{ -+ u32 i = 0, j = 0; -+ char c = In[(*Start)++]; -+ -+ if (c != LeftQualifier) -+ return _FALSE; -+ -+ i = (*Start); -+ while ((c = In[(*Start)++]) != RightQualifier) -+ ; // find ']' -+ j = (*Start) - 2; -+ strncpy((char *)Out, (const char*)(In+i), j-i+1); -+ -+ return _TRUE; -+} -+ -+BOOLEAN -+isAllSpaceOrTab( -+ u8* data, -+ u8 size -+ ) -+{ -+ u8 cnt = 0, NumOfSpaceAndTab = 0; -+ -+ while( size > cnt ) -+ { -+ if ( data[cnt] == ' ' || data[cnt] == '\t' || data[cnt] == '\0' ) -+ ++NumOfSpaceAndTab; -+ -+ ++cnt; -+ } -+ -+ return size == NumOfSpaceAndTab; -+} -+ -+ -+void rtw_hal_check_rxfifo_full(_adapter *adapter) -+{ -+ struct dvobj_priv *psdpriv = adapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ int save_cnt=_FALSE; -+ -+ //switch counter to RX fifo -+ if (IS_8188E(pHalData->VersionID) || IS_8188F(pHalData->VersionID) -+ || IS_8812_SERIES(pHalData->VersionID) || IS_8821_SERIES(pHalData->VersionID) -+ || IS_8723B_SERIES(pHalData->VersionID) || IS_8192E(pHalData->VersionID) || IS_8703B_SERIES(pHalData->VersionID)) -+ { -+ rtw_write8(adapter, REG_RXERR_RPT+3, rtw_read8(adapter, REG_RXERR_RPT+3)|0xa0); -+ save_cnt = _TRUE; -+ } -+ else -+ { -+ //todo: other chips -+ } -+ -+ -+ if (save_cnt) { -+ pdbgpriv->dbg_rx_fifo_last_overflow = pdbgpriv->dbg_rx_fifo_curr_overflow; -+ pdbgpriv->dbg_rx_fifo_curr_overflow = rtw_read16(adapter, REG_RXERR_RPT); -+ pdbgpriv->dbg_rx_fifo_diff_overflow = pdbgpriv->dbg_rx_fifo_curr_overflow-pdbgpriv->dbg_rx_fifo_last_overflow; -+ } else { -+ /* special value to indicate no implementation */ -+ pdbgpriv->dbg_rx_fifo_last_overflow = 1; -+ pdbgpriv->dbg_rx_fifo_curr_overflow = 1; -+ pdbgpriv->dbg_rx_fifo_diff_overflow = 1; -+ } -+} -+ -+void linked_info_dump(_adapter *padapter,u8 benable) -+{ -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if(padapter->bLinkInfoDump == benable) -+ return; -+ -+ DBG_871X("%s %s \n",__FUNCTION__,(benable)?"enable":"disable"); -+ -+ if(benable){ -+ #ifdef CONFIG_LPS -+ pwrctrlpriv->org_power_mgnt = pwrctrlpriv->power_mgnt;//keep org value -+ rtw_pm_set_lps(padapter,PS_MODE_ACTIVE); -+ #endif -+ -+ #ifdef CONFIG_IPS -+ pwrctrlpriv->ips_org_mode = pwrctrlpriv->ips_mode;//keep org value -+ rtw_pm_set_ips(padapter,IPS_NONE); -+ #endif -+ } -+ else{ -+ #ifdef CONFIG_IPS -+ rtw_pm_set_ips(padapter, pwrctrlpriv->ips_org_mode); -+ #endif // CONFIG_IPS -+ -+ #ifdef CONFIG_LPS -+ rtw_pm_set_lps(padapter, pwrctrlpriv->org_power_mgnt ); -+ #endif // CONFIG_LPS -+ } -+ padapter->bLinkInfoDump = benable ; -+} -+ -+#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+void rtw_get_raw_rssi_info(void *sel, _adapter *padapter) -+{ -+ u8 isCCKrate,rf_path; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; -+ -+ DBG_871X_SEL_NL(sel,"RxRate = %s, PWDBALL = %d(%%), rx_pwr_all = %d(dBm)\n", -+ HDATA_RATE(psample_pkt_rssi->data_rate), psample_pkt_rssi->pwdball, psample_pkt_rssi->pwr_all); -+ isCCKrate = (psample_pkt_rssi->data_rate <= DESC_RATE11M)?TRUE :FALSE; -+ -+ if(isCCKrate) -+ psample_pkt_rssi->mimo_signal_strength[0] = psample_pkt_rssi->pwdball; -+ -+ for(rf_path = 0;rf_pathNumTotalRFPath;rf_path++) -+ { -+ DBG_871X_SEL_NL(sel, "RF_PATH_%d=>signal_strength:%d(%%),signal_quality:%d(%%)\n" -+ , rf_path, psample_pkt_rssi->mimo_signal_strength[rf_path], psample_pkt_rssi->mimo_signal_quality[rf_path]); -+ -+ if(!isCCKrate){ -+ DBG_871X_SEL_NL(sel,"\trx_ofdm_pwr:%d(dBm),rx_ofdm_snr:%d(dB)\n", -+ psample_pkt_rssi->ofdm_pwr[rf_path],psample_pkt_rssi->ofdm_snr[rf_path]); -+ } -+ } -+} -+ -+void rtw_dump_raw_rssi_info(_adapter *padapter) -+{ -+ u8 isCCKrate,rf_path; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; -+ DBG_871X("============ RAW Rx Info dump ===================\n"); -+ DBG_871X("RxRate = %s, PWDBALL = %d(%%), rx_pwr_all = %d(dBm)\n", -+ HDATA_RATE(psample_pkt_rssi->data_rate), psample_pkt_rssi->pwdball, psample_pkt_rssi->pwr_all); -+ -+ isCCKrate = (psample_pkt_rssi->data_rate <= DESC_RATE11M)?TRUE :FALSE; -+ -+ if(isCCKrate) -+ psample_pkt_rssi->mimo_signal_strength[0] = psample_pkt_rssi->pwdball; -+ -+ for(rf_path = 0;rf_pathNumTotalRFPath;rf_path++) -+ { -+ DBG_871X("RF_PATH_%d=>signal_strength:%d(%%),signal_quality:%d(%%)" -+ , rf_path, psample_pkt_rssi->mimo_signal_strength[rf_path], psample_pkt_rssi->mimo_signal_quality[rf_path]); -+ -+ if(!isCCKrate){ -+ printk(",rx_ofdm_pwr:%d(dBm),rx_ofdm_snr:%d(dB)\n", -+ psample_pkt_rssi->ofdm_pwr[rf_path],psample_pkt_rssi->ofdm_snr[rf_path]); -+ }else{ -+ printk("\n"); -+ } -+ } -+} -+ -+void rtw_store_phy_info(_adapter *padapter, union recv_frame *prframe) -+{ -+ u8 isCCKrate,rf_path; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ -+ PODM_PHY_INFO_T pPhyInfo = (PODM_PHY_INFO_T)(&pattrib->phy_info); -+ struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; -+ -+ psample_pkt_rssi->data_rate = pattrib->data_rate; -+ isCCKrate = (pattrib->data_rate <= DESC_RATE11M)?TRUE :FALSE; -+ -+ psample_pkt_rssi->pwdball = pPhyInfo->RxPWDBAll; -+ psample_pkt_rssi->pwr_all = pPhyInfo->RecvSignalPower; -+ -+ for(rf_path = 0;rf_pathNumTotalRFPath;rf_path++) -+ { -+ psample_pkt_rssi->mimo_signal_strength[rf_path] = pPhyInfo->RxMIMOSignalStrength[rf_path]; -+ psample_pkt_rssi->mimo_signal_quality[rf_path] = pPhyInfo->RxMIMOSignalQuality[rf_path]; -+ if(!isCCKrate){ -+ psample_pkt_rssi->ofdm_pwr[rf_path] = pPhyInfo->RxPwr[rf_path]; -+ psample_pkt_rssi->ofdm_snr[rf_path] = pPhyInfo->RxSNR[rf_path]; -+ } -+ } -+} -+#endif -+ -+int check_phy_efuse_tx_power_info_valid(PADAPTER padapter) { -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ u8* pContent = pHalData->efuse_eeprom_data; -+ int index = 0; -+ u16 tx_index_offset = 0x0000; -+ -+ switch (rtw_get_chip_type(padapter)) { -+ case RTL8723B: -+ tx_index_offset = EEPROM_TX_PWR_INX_8723B; -+ break; -+ case RTL8703B: -+ tx_index_offset = EEPROM_TX_PWR_INX_8703B; -+ break; -+ case RTL8188E: -+ tx_index_offset = EEPROM_TX_PWR_INX_88E; -+ break; -+ case RTL8188F: -+ tx_index_offset = EEPROM_TX_PWR_INX_8188F; -+ break; -+ case RTL8192E: -+ tx_index_offset = EEPROM_TX_PWR_INX_8192E; -+ break; -+ case RTL8821: -+ tx_index_offset = EEPROM_TX_PWR_INX_8821; -+ break; -+ case RTL8812: -+ tx_index_offset = EEPROM_TX_PWR_INX_8812; -+ break; -+ case RTL8814A: -+ tx_index_offset = EEPROM_TX_PWR_INX_8814; -+ break; -+ default: -+ tx_index_offset = 0x0010; -+ break; -+ } -+ -+ /* TODO: chacking length by ICs */ -+ for (index = 0 ; index < 11 ; index++) { -+ if (pContent[tx_index_offset + index] == 0xFF) -+ return _FALSE; -+ } -+ return _TRUE; -+} -+ -+int hal_efuse_macaddr_offset(_adapter *adapter) -+{ -+ u8 interface_type = 0; -+ int addr_offset = -1; -+ -+ interface_type = rtw_get_intf_type(adapter); -+ -+ switch (rtw_get_chip_type(adapter)) { -+#ifdef CONFIG_RTL8723B -+ case RTL8723B: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8723BU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8723BS; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8723BE; -+ break; -+#endif -+#ifdef CONFIG_RTL8703B -+ case RTL8703B: -+ if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8703BS; -+ break; -+#endif -+#ifdef CONFIG_RTL8188E -+ case RTL8188E: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_88EU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_88ES; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_88EE; -+ break; -+#endif -+#ifdef CONFIG_RTL8188F -+ case RTL8188F: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8188FU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8188FS; -+ break; -+#endif -+#ifdef CONFIG_RTL8812A -+ case RTL8812: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8812AU; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8812AE; -+ break; -+#endif -+#ifdef CONFIG_RTL8821A -+ case RTL8821: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8821AU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8821AS; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8821AE; -+ break; -+#endif -+#ifdef CONFIG_RTL8192E -+ case RTL8192E: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8192EU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8192ES; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8192EE; -+ break; -+#endif -+#ifdef CONFIG_RTL8814A -+ case RTL8814A: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8814AU; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8814AE; -+ break; -+#endif -+ } -+ -+ if (addr_offset == -1) { -+ DBG_871X_LEVEL(_drv_err_, "%s: unknown combination - chip_type:%u, interface:%u\n" -+ , __func__, rtw_get_chip_type(adapter), rtw_get_intf_type(adapter)); -+ } -+ -+ return addr_offset; -+} -+ -+int Hal_GetPhyEfuseMACAddr(PADAPTER padapter, u8 *mac_addr) -+{ -+ int ret = _FAIL; -+ int addr_offset; -+ -+ addr_offset = hal_efuse_macaddr_offset(padapter); -+ if (addr_offset == -1) -+ goto exit; -+ -+ ret = rtw_efuse_map_read(padapter, addr_offset, ETH_ALEN, mac_addr); -+ -+exit: -+ return ret; -+} -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+u32 Hal_readPGDataFromConfigFile(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ u32 ret; -+ -+ ret = rtw_read_efuse_from_file(EFUSE_MAP_PATH, hal_data->efuse_eeprom_data); -+ hal_data->efuse_file_status = ((ret == _FAIL) ? EFUSE_FILE_FAILED : EFUSE_FILE_LOADED); -+ -+ return ret; -+} -+ -+u32 Hal_ReadMACAddrFromFile(PADAPTER padapter, u8 *mac_addr) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ u32 ret = _FAIL; -+ -+ if (rtw_read_macaddr_from_file(WIFIMAC_PATH, mac_addr) == _SUCCESS -+ && rtw_check_invalid_mac_address(mac_addr, _TRUE) == _FALSE -+ ) { -+ hal_data->macaddr_file_status = MACADDR_FILE_LOADED; -+ ret = _SUCCESS; -+ } else { -+ hal_data->macaddr_file_status = MACADDR_FILE_FAILED; -+ } -+ -+ return ret; -+} -+#endif /* CONFIG_EFUSE_CONFIG_FILE */ -+ -+int hal_config_macaddr(_adapter *adapter, bool autoload_fail) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 addr[ETH_ALEN]; -+ int addr_offset = hal_efuse_macaddr_offset(adapter); -+ u8 *hw_addr = NULL; -+ int ret = _SUCCESS; -+ -+ if (autoload_fail) -+ goto bypass_hw_pg; -+ -+ if (addr_offset != -1) -+ hw_addr = &hal_data->efuse_eeprom_data[addr_offset]; -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ /* if the hw_addr is written by efuse file, set to NULL */ -+ if (hal_data->efuse_file_status == EFUSE_FILE_LOADED) -+ hw_addr = NULL; -+#endif -+ -+ if (!hw_addr) { -+ /* try getting hw pg data */ -+ if (Hal_GetPhyEfuseMACAddr(adapter, addr) == _SUCCESS) -+ hw_addr = addr; -+ } -+ -+ /* check hw pg data */ -+ if (hw_addr && rtw_check_invalid_mac_address(hw_addr, _TRUE) == _FALSE) { -+ _rtw_memcpy(hal_data->EEPROMMACAddr, hw_addr, ETH_ALEN); -+ goto exit; -+ } -+ -+bypass_hw_pg: -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ /* check wifi mac file */ -+ if (Hal_ReadMACAddrFromFile(adapter, addr) == _SUCCESS) { -+ _rtw_memcpy(hal_data->EEPROMMACAddr, addr, ETH_ALEN); -+ goto exit; -+ } -+#endif -+ -+ _rtw_memset(hal_data->EEPROMMACAddr, 0, ETH_ALEN); -+ ret = _FAIL; -+ -+exit: -+ return ret; -+} -+ -+#ifdef CONFIG_RF_GAIN_OFFSET -+u32 Array_kfreemap[] = { -+0x08,0xe, -+0x06,0xc, -+0x04,0xa, -+0x02,0x8, -+0x00,0x6, -+0x03,0x4, -+0x05,0x2, -+0x07,0x0, -+0x09,0x0, -+0x0c,0x0, -+}; -+ -+void rtw_bb_rf_gain_offset(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ struct kfree_data_t *kfree_data = &pHalData->kfree_data; -+ u8 value = pHalData->EEPROMRFGainOffset; -+ u8 tmp = 0x3e; -+ u32 res, i = 0; -+ u4Byte ArrayLen = sizeof(Array_kfreemap)/sizeof(u32); -+ pu4Byte Array = Array_kfreemap; -+ u4Byte v1 = 0, v2 = 0, GainValue = 0, target = 0; -+ -+ if (registry_par->RegRfKFreeEnable == 2) { -+ DBG_871X("Registry kfree default force disable.\n"); -+ return; -+ } -+ -+#if defined(CONFIG_RTL8723B) -+ if (value & BIT4 || (registry_par->RegRfKFreeEnable == 1)) { -+ DBG_871X("Offset RF Gain.\n"); -+ DBG_871X("Offset RF Gain. pHalData->EEPROMRFGainVal=0x%x\n",pHalData->EEPROMRFGainVal); -+ -+ if(pHalData->EEPROMRFGainVal != 0xff){ -+ -+ if(pHalData->ant_path == ODM_RF_PATH_A) { -+ GainValue=(pHalData->EEPROMRFGainVal & 0x0f); -+ -+ } else { -+ GainValue=(pHalData->EEPROMRFGainVal & 0xf0)>>4; -+ } -+ DBG_871X("Ant PATH_%d GainValue Offset = 0x%x\n",(pHalData->ant_path == ODM_RF_PATH_A) ? (ODM_RF_PATH_A) : (ODM_RF_PATH_B),GainValue); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) ++ if( (pwdinfo->opp_ps == 1) || (pwdinfo->noa_num > 0) ) + { -+ //DBG_871X("ArrayLen in =%d ,Array 1 =0x%x ,Array2 =0x%x \n",i,Array[i],Array[i]+1); -+ v1 = Array[i]; -+ v2 = Array[i+1]; -+ if ( v1 == GainValue ) { -+ DBG_871X("Offset RF Gain. got v1 =0x%x ,v2 =0x%x \n",v1,v2); -+ target=v2; -+ break; -+ } -+ } -+ DBG_871X("pHalData->EEPROMRFGainVal=0x%x ,Gain offset Target Value=0x%x\n",pHalData->EEPROMRFGainVal,target); ++ // rst p2p circuit ++ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(4)); + -+ res = rtw_hal_read_rfreg(padapter, RF_PATH_A, 0x7f, 0xffffffff); -+ DBG_871X("Offset RF Gain. before reg 0x7f=0x%08x\n",res); -+ PHY_SetRFReg(padapter, RF_PATH_A, REG_RF_BB_GAIN_OFFSET, BIT18|BIT17|BIT16|BIT15, target); -+ res = rtw_hal_read_rfreg(padapter, RF_PATH_A, 0x7f, 0xffffffff); ++ SET_8812_H2CCMD_P2P_PS_OFFLOAD_ENABLE(p2p_ps_offload, 1); + -+ DBG_871X("Offset RF Gain. After reg 0x7f=0x%08x\n",res); -+ -+ }else { ++ if(pwdinfo->role == P2P_ROLE_GO) ++ { ++ // 1: Owner, 0: Client ++ SET_8812_H2CCMD_P2P_PS_OFFLOAD_ROLE(p2p_ps_offload, 1); ++ SET_8812_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(p2p_ps_offload, 0); ++ } ++ else ++ { ++ // 1: Owner, 0: Client ++ SET_8812_H2CCMD_P2P_PS_OFFLOAD_ROLE(p2p_ps_offload, 0); ++ } + -+ DBG_871X("Offset RF Gain. pHalData->EEPROMRFGainVal=0x%x != 0xff, didn't run Kfree\n",pHalData->EEPROMRFGainVal); -+ } -+ } else { -+ DBG_871X("Using the default RF gain.\n"); -+ } -+ -+#elif defined(CONFIG_RTL8188E) -+ if (value & BIT4 || (registry_par->RegRfKFreeEnable == 1)) { -+ DBG_871X("8188ES Offset RF Gain.\n"); -+ DBG_871X("8188ES Offset RF Gain. EEPROMRFGainVal=0x%x\n", -+ pHalData->EEPROMRFGainVal); -+ -+ if (pHalData->EEPROMRFGainVal != 0xff) { -+ res = rtw_hal_read_rfreg(padapter, RF_PATH_A, -+ REG_RF_BB_GAIN_OFFSET, 0xffffffff); -+ -+ DBG_871X("Offset RF Gain. reg 0x55=0x%x\n",res); -+ res &= 0xfff87fff; -+ -+ res |= (pHalData->EEPROMRFGainVal & 0x0f) << 15; -+ DBG_871X("Offset RF Gain. res=0x%x\n",res); -+ -+ rtw_hal_write_rfreg(padapter, RF_PATH_A, -+ REG_RF_BB_GAIN_OFFSET, -+ RF_GAIN_OFFSET_MASK, res); -+ } else { -+ DBG_871X("Offset RF Gain. EEPROMRFGainVal=0x%x == 0xff, didn't run Kfree\n", -+ pHalData->EEPROMRFGainVal); -+ } -+ } else { -+ DBG_871X("Using the default RF gain.\n"); -+ } -+#else -+ /* TODO: call this when channel switch */ -+ if (kfree_data->flag & KFREE_FLAG_ON) -+ rtw_rf_apply_tx_gain_offset(padapter, 6); /* input ch6 to select BB_GAIN_2G */ -+#endif -+ -+} -+#endif //CONFIG_RF_GAIN_OFFSET -+ -+bool kfree_data_is_bb_gain_empty(struct kfree_data_t *data) -+{ -+#ifdef CONFIG_RF_GAIN_OFFSET -+ int i, j; -+ -+ for (i = 0; i < BB_GAIN_NUM; i++) -+ for (j = 0; j < RF_PATH_MAX; j++) -+ if (data->bb_gain[i][j] != 0) -+ return 0; -+#endif -+ return 1; -+} -+ -+#ifdef CONFIG_USB_RX_AGGREGATION -+void rtw_set_usb_agg_by_mode_normal(_adapter *padapter, u8 cur_wireless_mode) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ if(cur_wireless_mode < WIRELESS_11_24N -+ && cur_wireless_mode > 0) //ABG mode -+ { -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ u32 remainder = 0; -+ u8 quotient = 0; -+ -+ remainder = MAX_RECVBUF_SZ % (4*1024); -+ quotient = (u8)(MAX_RECVBUF_SZ >> 12); -+ -+ if (quotient > 5) { -+ pHalData->RegAcUsbDmaSize = 0x6; -+ pHalData->RegAcUsbDmaTime = 0x10; -+ } else { -+ if (remainder >= 2048) { -+ pHalData->RegAcUsbDmaSize = quotient; -+ pHalData->RegAcUsbDmaTime = 0x10; -+ } else { -+ pHalData->RegAcUsbDmaSize = (quotient-1); -+ pHalData->RegAcUsbDmaTime = 0x10; ++ SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(p2p_ps_offload, 0); + } -+ } -+#else /* !CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ if(0x6 != pHalData->RegAcUsbDmaSize || 0x10 !=pHalData->RegAcUsbDmaTime) -+ { -+ pHalData->RegAcUsbDmaSize = 0x6; -+ pHalData->RegAcUsbDmaTime = 0x10; -+ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, -+ pHalData->RegAcUsbDmaSize | (pHalData->RegAcUsbDmaTime<<8)); -+ } -+#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ ++ break; ++ case P2P_PS_SCAN: ++ DBG_8192C("P2P_PS_SCAN \n"); ++ SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(p2p_ps_offload, 1); ++ break; ++ case P2P_PS_SCAN_DONE: ++ DBG_8192C("P2P_PS_SCAN_DONE \n"); ++ SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(p2p_ps_offload, 0); ++ pwdinfo->p2p_ps_state = P2P_PS_ENABLE; ++ break; ++ default: ++ break; + } -+ else if(cur_wireless_mode >= WIRELESS_11_24N -+ && cur_wireless_mode <= WIRELESS_MODE_MAX)//N AC mode -+ { -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ u32 remainder = 0; -+ u8 quotient = 0; + -+ remainder = MAX_RECVBUF_SZ % (4*1024); -+ quotient = (u8)(MAX_RECVBUF_SZ >> 12); -+ -+ if (quotient > 5) { -+ pHalData->RegAcUsbDmaSize = 0x5; -+ pHalData->RegAcUsbDmaTime = 0x20; -+ } else { -+ if (remainder >= 2048) { -+ pHalData->RegAcUsbDmaSize = quotient; -+ pHalData->RegAcUsbDmaTime = 0x10; -+ } else { -+ pHalData->RegAcUsbDmaSize = (quotient-1); -+ pHalData->RegAcUsbDmaTime = 0x10; -+ } -+ } -+#else /* !CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ if(0x5 != pHalData->RegAcUsbDmaSize || 0x20 !=pHalData->RegAcUsbDmaTime) -+ { -+ pHalData->RegAcUsbDmaSize = 0x5; -+ pHalData->RegAcUsbDmaTime = 0x20; -+ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, -+ pHalData->RegAcUsbDmaSize | (pHalData->RegAcUsbDmaTime<<8)); -+ } -+#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ -+ } -+ else -+ { -+ /* DBG_871X("%s: Unknow wireless mode(0x%x)\n",__func__,padapter->mlmeextpriv.cur_wireless_mode); */ -+ } -+} -+ -+void rtw_set_usb_agg_by_mode_customer(_adapter *padapter, u8 cur_wireless_mode, u8 UsbDmaSize, u8 Legacy_UsbDmaSize) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (cur_wireless_mode < WIRELESS_11_24N -+ && cur_wireless_mode > 0) { /* ABG mode */ -+ if (Legacy_UsbDmaSize != pHalData->RegAcUsbDmaSize -+ || 0x10 != pHalData->RegAcUsbDmaTime) { -+ pHalData->RegAcUsbDmaSize = Legacy_UsbDmaSize; -+ pHalData->RegAcUsbDmaTime = 0x10; -+ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, -+ pHalData->RegAcUsbDmaSize | (pHalData->RegAcUsbDmaTime<<8)); -+ } -+ } else if (cur_wireless_mode >= WIRELESS_11_24N -+ && cur_wireless_mode <= WIRELESS_MODE_MAX) { /* N AC mode */ -+ if (UsbDmaSize != pHalData->RegAcUsbDmaSize -+ || 0x20 != pHalData->RegAcUsbDmaTime) { -+ pHalData->RegAcUsbDmaSize = UsbDmaSize; -+ pHalData->RegAcUsbDmaTime = 0x20; -+ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, -+ pHalData->RegAcUsbDmaSize | (pHalData->RegAcUsbDmaTime<<8)); -+ } -+ } else { -+ /* DBG_871X("%s: Unknown wireless mode(0x%x)\n",__func__,padapter->mlmeextpriv.cur_wireless_mode); */ -+ } -+} -+ -+void rtw_set_usb_agg_by_mode(_adapter *padapter, u8 cur_wireless_mode) -+{ -+#ifdef CONFIG_PLATFORM_NOVATEK_NT72668 -+ rtw_set_usb_agg_by_mode_customer(padapter, cur_wireless_mode, 0x3, 0x3); -+ return; -+#endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */ -+ -+ rtw_set_usb_agg_by_mode_normal(padapter, cur_wireless_mode); -+} -+#endif //CONFIG_USB_RX_AGGREGATION -+ -+//To avoid RX affect TX throughput -+void dm_DynamicUsbTxAgg(_adapter *padapter, u8 from_timer) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeextpriv = &(padapter->mlmeextpriv); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 cur_wireless_mode = pmlmeextpriv->cur_wireless_mode; -+#ifdef CONFIG_CONCURRENT_MODE -+ struct mlme_ext_priv *pbuddymlmeextpriv = &(padapter->pbuddy_adapter->mlmeextpriv); -+#endif //CONFIG_CONCURRENT_MODE -+ -+#ifdef CONFIG_USB_RX_AGGREGATION -+ if(IS_HARDWARE_TYPE_8821U(padapter) )//|| IS_HARDWARE_TYPE_8192EU(padapter)) -+ { -+ //This AGG_PH_TH only for UsbRxAggMode == USB_RX_AGG_USB -+ if((pHalData->UsbRxAggMode == USB_RX_AGG_USB) && (check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE)) -+ { -+ if(pdvobjpriv->traffic_stat.cur_tx_tp > 2 && pdvobjpriv->traffic_stat.cur_rx_tp < 30) -+ rtw_write16(padapter , REG_RXDMA_AGG_PG_TH , 0x1010); -+ else if (pdvobjpriv->traffic_stat.last_tx_bytes > 220000 && pdvobjpriv->traffic_stat.cur_rx_tp < 30) -+ rtw_write16(padapter , REG_RXDMA_AGG_PG_TH , 0x1006); -+ else -+ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH,0x2005); //dmc agg th 20K -+ -+ //DBG_871X("TX_TP=%u, RX_TP=%u \n", pdvobjpriv->traffic_stat.cur_tx_tp, pdvobjpriv->traffic_stat.cur_rx_tp); -+ } -+ } -+ else if(IS_HARDWARE_TYPE_8812(padapter)) -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ if(rtw_linked_check(padapter) == _TRUE && rtw_linked_check(padapter->pbuddy_adapter) == _TRUE) -+ { -+ if(pbuddymlmeextpriv->cur_wireless_mode >= pmlmeextpriv->cur_wireless_mode) -+ cur_wireless_mode = pbuddymlmeextpriv->cur_wireless_mode; -+ else -+ cur_wireless_mode = pmlmeextpriv->cur_wireless_mode; -+ -+ rtw_set_usb_agg_by_mode(padapter,cur_wireless_mode); -+ } -+ else if (rtw_linked_check(padapter) == _TRUE && rtw_linked_check(padapter->pbuddy_adapter) == _FALSE) -+ { -+ rtw_set_usb_agg_by_mode(padapter,cur_wireless_mode); -+ } -+#else //!CONFIG_CONCURRENT_MODE -+ rtw_set_usb_agg_by_mode(padapter,cur_wireless_mode); -+#endif //CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_PLATFORM_NOVATEK_NT72668 -+ } else { -+ rtw_set_usb_agg_by_mode(padapter, cur_wireless_mode); -+#endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */ -+ } ++ DBG_871X("P2P_PS_OFFLOAD : %x\n", p2p_ps_offload[0]); ++ FillH2CCmd_8812(padapter, H2C_8812_P2P_PS_OFFLOAD, 1, p2p_ps_offload); +#endif ++ ++ ++ +} ++#endif //CONFIG_P2P + -+//bus-agg check for SoftAP mode -+inline u8 rtw_hal_busagg_qsel_check(_adapter *padapter,u8 pre_qsel,u8 next_qsel) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 chk_rst = _SUCCESS; -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return chk_rst; -+ -+ //if((pre_qsel == 0xFF)||(next_qsel== 0xFF)) -+ // return chk_rst; -+ -+ if( ((pre_qsel == QSLT_HIGH)||((next_qsel== QSLT_HIGH))) -+ && (pre_qsel != next_qsel )){ -+ //DBG_871X("### bus-agg break cause of qsel misatch, pre_qsel=0x%02x,next_qsel=0x%02x ###\n", -+ // pre_qsel,next_qsel); -+ chk_rst = _FAIL; -+ } -+ return chk_rst; -+} -+ ++#ifdef CONFIG_TSF_RESET_OFFLOAD +/* -+ * Description: -+ * dump_TX_FIFO: This is only used to dump TX_FIFO for debug WoW mode offload -+ * contant. -+ * -+ * Input: -+ * adapter: adapter pointer. -+ * page_num: The max. page number that user want to dump. -+ * page_size: page size of each page. eg. 128 bytes, 256 bytes, 512byte. -+ */ -+void dump_TX_FIFO(_adapter* padapter, u8 page_num, u16 page_size){ -+ -+ int i; -+ u8 val = 0; -+ u8 base = 0; -+ u32 addr = 0; -+ u32 count = (page_size / 8); -+ -+ if (page_num <= 0) { -+ DBG_871X("!!%s: incorrect input page_num paramter!\n", __func__); -+ return; -+ } -+ -+ if (page_size < 128 || page_size > 512) { -+ DBG_871X("!!%s: incorrect input page_size paramter!\n", __func__); -+ return; -+ } -+ -+ DBG_871X("+%s+\n", __func__); -+ val = rtw_read8(padapter, 0x106); -+ rtw_write8(padapter, 0x106, 0x69); -+ DBG_871X("0x106: 0x%02x\n", val); -+ base = rtw_read8(padapter, 0x209); -+ DBG_871X("0x209: 0x%02x\n", base); -+ -+ addr = ((base) * page_size)/8; -+ for (i = 0 ; i < page_num * count ; i+=2) { -+ rtw_write32(padapter, 0x140, addr + i); -+ printk(" %08x %08x ", rtw_read32(padapter, 0x144), rtw_read32(padapter, 0x148)); -+ rtw_write32(padapter, 0x140, addr + i + 1); -+ printk(" %08x %08x \n", rtw_read32(padapter, 0x144), rtw_read32(padapter, 0x148)); -+ } -+} -+ -+#ifdef CONFIG_GPIO_API -+u8 rtw_hal_get_gpio(_adapter* adapter, u8 gpio_num) ++ ask FW to Reset sync register at Beacon early interrupt ++*/ ++u8 rtl8812_reset_tsf(_adapter *padapter, u8 reset_port ) +{ -+ u8 value; -+ u8 direction; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); ++ u8 buf[2]; ++ u8 res=_SUCCESS; + -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); ++ s32 ret; + -+ DBG_871X("rf_pwrstate=0x%02x\n", pwrpriv->rf_pwrstate); -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ /* Read GPIO Direction */ -+ direction = (rtw_read8(adapter,REG_GPIO_PIN_CTRL + 2) & BIT(gpio_num)) >> gpio_num; -+ -+ /* According the direction to read register value */ -+ if( direction ) -+ value = (rtw_read8(adapter, REG_GPIO_PIN_CTRL + 1)& BIT(gpio_num)) >> gpio_num; -+ else -+ value = (rtw_read8(adapter, REG_GPIO_PIN_CTRL)& BIT(gpio_num)) >> gpio_num; -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ DBG_871X("%s direction=%d value=%d\n",__FUNCTION__,direction,value); -+ -+ return value; -+} -+ -+int rtw_hal_set_gpio_output_value(_adapter* adapter, u8 gpio_num, bool isHigh) -+{ -+ u8 direction = 0; -+ u8 res = -1; -+ if (IS_HARDWARE_TYPE_8188E(adapter)){ -+ /* Check GPIO is 4~7 */ -+ if( gpio_num > 7 || gpio_num < 4) -+ { -+ DBG_871X("%s The gpio number does not included 4~7.\n",__FUNCTION__); -+ return -1; -+ } -+ } -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ /* Read GPIO direction */ -+ direction = (rtw_read8(adapter,REG_GPIO_PIN_CTRL + 2) & BIT(gpio_num)) >> gpio_num; -+ -+ /* If GPIO is output direction, setting value. */ -+ if( direction ) -+ { -+ if(isHigh) -+ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 1, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 1) | BIT(gpio_num)); -+ else -+ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 1, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 1) & ~BIT(gpio_num)); -+ -+ DBG_871X("%s Set gpio %x[%d]=%d\n",__FUNCTION__,REG_GPIO_PIN_CTRL+1,gpio_num,isHigh ); -+ res = 0; -+ } -+ else -+ { -+ DBG_871X("%s The gpio is input,not be set!\n",__FUNCTION__); -+ res = -1; ++ if (IFACE_PORT0==reset_port) { ++ buf[0] = 0x1; buf[1] = 0; ++ } else{ ++ buf[0] = 0x0; buf[1] = 0x1; + } + -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); ++ ret = FillH2CCmd_8812(padapter, H2C_8812_TSF_RESET, 2, buf); ++ ++ ++ + return res; +} + -+int rtw_hal_config_gpio(_adapter* adapter, u8 gpio_num, bool isOutput) ++int reset_tsf(PADAPTER Adapter, u8 reset_port ) +{ -+ if (IS_HARDWARE_TYPE_8188E(adapter)){ -+ if( gpio_num > 7 || gpio_num < 4) -+ { -+ DBG_871X("%s The gpio number does not included 4~7.\n",__FUNCTION__); -+ return -1; -+ } -+ } ++ u8 reset_cnt_before = 0, reset_cnt_after = 0, loop_cnt = 0; ++ u32 reg_reset_tsf_cnt = (IFACE_PORT0==reset_port) ? ++ REG_FW_RESET_TSF_CNT_0:REG_FW_RESET_TSF_CNT_1; ++ u32 reg_bcncrtl = (IFACE_PORT0==reset_port) ? ++ REG_BCN_CTRL_1:REG_BCN_CTRL; + -+ DBG_871X("%s gpio_num =%d direction=%d\n",__FUNCTION__,gpio_num,isOutput); ++ rtw_scan_abort(Adapter->pbuddy_adapter); /* site survey will cause reset_tsf fail */ ++ reset_cnt_after = reset_cnt_before = rtw_read8(Adapter,reg_reset_tsf_cnt); ++ rtl8812_reset_tsf(Adapter, reset_port); + -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ if( isOutput ) -+ { -+ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 2, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 2) | BIT(gpio_num)); -+ } -+ else -+ { -+ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 2, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 2) & ~BIT(gpio_num)); ++ while ((reset_cnt_after == reset_cnt_before ) && (loop_cnt < 10)) { ++ rtw_msleep_os(100); ++ loop_cnt++; ++ reset_cnt_after = rtw_read8(Adapter, reg_reset_tsf_cnt); + } + -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ -+ return 0; -+} -+int rtw_hal_register_gpio_interrupt(_adapter* adapter, int gpio_num, void(*callback)(u8 level)) -+{ -+ u8 value; -+ u8 direction; -+ PHAL_DATA_TYPE phal = GET_HAL_DATA(adapter); -+ -+ if (IS_HARDWARE_TYPE_8188E(adapter)){ -+ if(gpio_num > 7 || gpio_num < 4) -+ { -+ DBG_871X_LEVEL(_drv_always_, "%s The gpio number does not included 4~7.\n",__FUNCTION__); -+ return -1; -+ } -+ } -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ /* Read GPIO direction */ -+ direction = (rtw_read8(adapter,REG_GPIO_PIN_CTRL + 2) & BIT(gpio_num)) >> gpio_num; -+ if(direction){ -+ DBG_871X_LEVEL(_drv_always_, "%s Can't register output gpio as interrupt.\n",__FUNCTION__); -+ return -1; -+ } -+ -+ /* Config GPIO Mode */ -+ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 3, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 3) | BIT(gpio_num)); -+ -+ /* Register GPIO interrupt handler*/ -+ adapter->gpiointpriv.callback[gpio_num] = callback; -+ -+ /* Set GPIO interrupt mode, 0:positive edge, 1:negative edge */ -+ value = rtw_read8(adapter, REG_GPIO_PIN_CTRL) & BIT(gpio_num); -+ adapter->gpiointpriv.interrupt_mode = rtw_read8(adapter, REG_HSIMR + 2)^value; -+ rtw_write8(adapter, REG_GPIO_INTM, adapter->gpiointpriv.interrupt_mode); -+ -+ /* Enable GPIO interrupt */ -+ adapter->gpiointpriv.interrupt_enable_mask = rtw_read8(adapter, REG_HSIMR + 2) | BIT(gpio_num); -+ rtw_write8(adapter, REG_HSIMR + 2, adapter->gpiointpriv.interrupt_enable_mask); -+ -+ rtw_hal_update_hisr_hsisr_ind(adapter, 1); -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ -+ return 0; -+} -+int rtw_hal_disable_gpio_interrupt(_adapter* adapter, int gpio_num) -+{ -+ u8 value; -+ u8 direction; -+ PHAL_DATA_TYPE phal = GET_HAL_DATA(adapter); -+ -+ if (IS_HARDWARE_TYPE_8188E(adapter)){ -+ if(gpio_num > 7 || gpio_num < 4) -+ { -+ DBG_871X("%s The gpio number does not included 4~7.\n",__FUNCTION__); -+ return -1; -+ } -+ } -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ /* Config GPIO Mode */ -+ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 3, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 3) &~ BIT(gpio_num)); -+ -+ /* Unregister GPIO interrupt handler*/ -+ adapter->gpiointpriv.callback[gpio_num] = NULL; -+ -+ /* Reset GPIO interrupt mode, 0:positive edge, 1:negative edge */ -+ adapter->gpiointpriv.interrupt_mode = rtw_read8(adapter, REG_GPIO_INTM) &~ BIT(gpio_num); -+ rtw_write8(adapter, REG_GPIO_INTM, 0x00); -+ -+ /* Disable GPIO interrupt */ -+ adapter->gpiointpriv.interrupt_enable_mask = rtw_read8(adapter, REG_HSIMR + 2) &~ BIT(gpio_num); -+ rtw_write8(adapter, REG_HSIMR + 2, adapter->gpiointpriv.interrupt_enable_mask); -+ -+ if(!adapter->gpiointpriv.interrupt_enable_mask) -+ rtw_hal_update_hisr_hsisr_ind(adapter, 0); -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ -+ return 0; -+} -+#endif -+ -+void rtw_dump_mac_rx_counters(_adapter* padapter,struct dbg_rx_counter *rx_counter) -+{ -+ u32 mac_cck_ok=0, mac_ofdm_ok=0, mac_ht_ok=0, mac_vht_ok=0; -+ u32 mac_cck_err=0, mac_ofdm_err=0, mac_ht_err=0, mac_vht_err=0; -+ u32 mac_cck_fa=0, mac_ofdm_fa=0, mac_ht_fa=0; -+ u32 DropPacket=0; -+ -+ if(!rx_counter){ -+ rtw_warn_on(1); -+ return; -+ } -+ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28|BIT29|BIT30|BIT31, 0x3); -+ mac_cck_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);// [15:0] -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28|BIT29|BIT30|BIT31, 0x0); -+ mac_ofdm_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);// [15:0] -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28|BIT29|BIT30|BIT31, 0x6); -+ mac_ht_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);// [15:0] -+ mac_vht_ok = 0; -+ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28|BIT29|BIT30|BIT31, 0x0); -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x1); -+ mac_vht_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);// [15:0] -+ } -+ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28|BIT29|BIT30|BIT31, 0x4); -+ mac_cck_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);// [15:0] -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28|BIT29|BIT30|BIT31, 0x1); -+ mac_ofdm_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);// [15:0] -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28|BIT29|BIT30|BIT31, 0x7); -+ mac_ht_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);// [15:0] -+ mac_vht_err = 0; -+ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28|BIT29|BIT30|BIT31, 0x1); -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x1); -+ mac_vht_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);// [15:0] -+ } -+ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28|BIT29|BIT30|BIT31, 0x5); -+ mac_cck_fa = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);// [15:0] -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28|BIT29|BIT30|BIT31, 0x2); -+ mac_ofdm_fa = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);// [15:0] -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28|BIT29|BIT30|BIT31, 0x9); -+ mac_ht_fa = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);// [15:0] -+ -+ //Mac_DropPacket -+ rtw_write32(padapter, REG_RXERR_RPT, (rtw_read32(padapter, REG_RXERR_RPT)& 0x0FFFFFFF)| Mac_DropPacket); -+ DropPacket = rtw_read32(padapter, REG_RXERR_RPT)& 0x0000FFFF; -+ -+ rx_counter->rx_pkt_ok = mac_cck_ok+mac_ofdm_ok+mac_ht_ok+mac_vht_ok; -+ rx_counter->rx_pkt_crc_error = mac_cck_err+mac_ofdm_err+mac_ht_err+mac_vht_err; -+ rx_counter->rx_cck_fa = mac_cck_fa; -+ rx_counter->rx_ofdm_fa = mac_ofdm_fa; -+ rx_counter->rx_ht_fa = mac_ht_fa; -+ rx_counter->rx_pkt_drop = DropPacket; -+} -+void rtw_reset_mac_rx_counters(_adapter* padapter) -+{ -+ -+ if (IS_HARDWARE_TYPE_8703B(padapter) || IS_HARDWARE_TYPE_8188F(padapter)) -+ PHY_SetMacReg(padapter, 0x608, BIT19, 0x1); /* If no packet rx, MaxRx clock be gating ,BIT_DISGCLK bit19 set 1 for fix*/ -+ -+ //reset mac counter -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT27, 0x1); -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT27, 0x0); ++ return(loop_cnt >= 10) ? _FAIL : true; +} + -+void rtw_dump_phy_rx_counters(_adapter* padapter,struct dbg_rx_counter *rx_counter) ++ ++#endif // CONFIG_TSF_RESET_OFFLOAD ++ ++#ifdef CONFIG_WOWLAN ++void rtl8812_set_wowlan_cmd(_adapter* padapter, u8 enable) +{ -+ u32 cckok=0,cckcrc=0,ofdmok=0,ofdmcrc=0,htok=0,htcrc=0,OFDM_FA=0,CCK_FA=0,vht_ok=0,vht_err=0; -+ if(!rx_counter){ -+ rtw_warn_on(1); -+ return; -+ } -+ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)){ -+ cckok = PHY_QueryBBReg(padapter, 0xF04, 0x3FFF); // [13:0] -+ ofdmok = PHY_QueryBBReg(padapter, 0xF14, 0x3FFF); // [13:0] -+ htok = PHY_QueryBBReg(padapter, 0xF10, 0x3FFF); // [13:0] -+ vht_ok = PHY_QueryBBReg(padapter, 0xF0C, 0x3FFF); // [13:0] -+ cckcrc = PHY_QueryBBReg(padapter, 0xF04, 0x3FFF0000); // [29:16] -+ ofdmcrc = PHY_QueryBBReg(padapter, 0xF14, 0x3FFF0000); // [29:16] -+ htcrc = PHY_QueryBBReg(padapter, 0xF10, 0x3FFF0000); // [29:16] -+ vht_err = PHY_QueryBBReg(padapter, 0xF0C, 0x3FFF0000); // [29:16] -+ CCK_FA = PHY_QueryBBReg(padapter, 0xA5C, bMaskLWord); -+ OFDM_FA = PHY_QueryBBReg(padapter, 0xF48, bMaskLWord); -+ } -+ else -+ { -+ cckok = PHY_QueryBBReg(padapter, 0xF88, bMaskDWord); -+ ofdmok = PHY_QueryBBReg(padapter, 0xF94, bMaskLWord); -+ htok = PHY_QueryBBReg(padapter, 0xF90, bMaskLWord); -+ vht_ok = 0; -+ cckcrc = PHY_QueryBBReg(padapter, 0xF84, bMaskDWord); -+ ofdmcrc = PHY_QueryBBReg(padapter, 0xF94, bMaskHWord); -+ htcrc = PHY_QueryBBReg(padapter, 0xF90, bMaskHWord); -+ vht_err = 0; -+ OFDM_FA = PHY_QueryBBReg(padapter, 0xCF0, bMaskLWord) + PHY_QueryBBReg(padapter, 0xCF2, bMaskLWord) + -+ PHY_QueryBBReg(padapter, 0xDA2, bMaskLWord) + PHY_QueryBBReg(padapter, 0xDA4, bMaskLWord) + -+ PHY_QueryBBReg(padapter, 0xDA6, bMaskLWord) + PHY_QueryBBReg(padapter, 0xDA8, bMaskLWord); -+ -+ CCK_FA=(rtw_read8(padapter, 0xA5B )<<8 ) | (rtw_read8(padapter, 0xA5C)); -+ } -+ -+ rx_counter->rx_pkt_ok = cckok+ofdmok+htok+vht_ok; -+ rx_counter->rx_pkt_crc_error = cckcrc+ofdmcrc+htcrc+vht_err; -+ rx_counter->rx_ofdm_fa = OFDM_FA; -+ rx_counter->rx_cck_fa = CCK_FA; -+ -+} ++ u8 res=_SUCCESS; ++ u32 test=0; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ SETWOWLAN_PARM pwowlan_parm; ++ struct pwrctrl_priv *pwrpriv=&padapter->pwrctrlpriv; + -+void rtw_reset_phy_rx_counters(_adapter* padapter) -+{ -+ //reset phy counter -+ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) -+ { -+ PHY_SetBBReg(padapter, 0xB58, BIT0, 0x1); -+ PHY_SetBBReg(padapter, 0xB58, BIT0, 0x0); + -+ PHY_SetBBReg(padapter, 0x9A4, BIT17, 0x1);//reset OFDA FA counter -+ PHY_SetBBReg(padapter, 0x9A4, BIT17, 0x0); -+ -+ PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x0);//reset CCK FA counter -+ PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x1); -+ } -+ else -+ { -+ PHY_SetBBReg(padapter, 0xF14, BIT16, 0x1); -+ rtw_msleep_os(10); -+ PHY_SetBBReg(padapter, 0xF14, BIT16, 0x0); -+ -+ PHY_SetBBReg(padapter, 0xD00, BIT27, 0x1);//reset OFDA FA counter -+ PHY_SetBBReg(padapter, 0xC0C, BIT31, 0x1);//reset OFDA FA counter -+ PHY_SetBBReg(padapter, 0xD00, BIT27, 0x0); -+ PHY_SetBBReg(padapter, 0xC0C, BIT31, 0x0); -+ -+ PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x0);//reset CCK FA counter -+ PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x1); -+ } -+} -+#ifdef DBG_RX_COUNTER_DUMP -+void rtw_dump_drv_rx_counters(_adapter* padapter,struct dbg_rx_counter *rx_counter) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ if(!rx_counter){ -+ rtw_warn_on(1); -+ return; -+ } -+ rx_counter->rx_pkt_ok = padapter->drv_rx_cnt_ok; -+ rx_counter->rx_pkt_crc_error = padapter->drv_rx_cnt_crcerror; -+ rx_counter->rx_pkt_drop = precvpriv->rx_drop - padapter->drv_rx_cnt_drop; -+} -+void rtw_reset_drv_rx_counters(_adapter* padapter) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ padapter->drv_rx_cnt_ok = 0; -+ padapter->drv_rx_cnt_crcerror = 0; -+ padapter->drv_rx_cnt_drop = precvpriv->rx_drop; -+} -+void rtw_dump_phy_rxcnts_preprocess(_adapter* padapter,u8 rx_cnt_mode) -+{ -+ u8 initialgain; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ DM_ODM_T *odm = &(hal_data->odmpriv); -+ DIG_T *pDigTable = &odm->DM_DigTable; -+ -+ if((!(padapter->dump_rx_cnt_mode& DUMP_PHY_RX_COUNTER)) && (rx_cnt_mode & DUMP_PHY_RX_COUNTER)) -+ { -+ initialgain = pDigTable->CurIGValue; -+ DBG_871X("%s CurIGValue:0x%02x\n",__FUNCTION__,initialgain); -+ rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE); -+ /*disable dynamic functions, such as high power, DIG*/ -+ rtw_phydm_ability_backup(padapter); -+ rtw_phydm_func_clr(padapter, (ODM_BB_DIG|ODM_BB_FA_CNT)); -+ } -+ else if((padapter->dump_rx_cnt_mode& DUMP_PHY_RX_COUNTER) &&(!(rx_cnt_mode & DUMP_PHY_RX_COUNTER ))) -+ { -+ //turn on phy-dynamic functions -+ rtw_phydm_ability_restore(padapter); -+ initialgain = 0xff; //restore RX GAIN -+ rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE); -+ -+ } -+} -+ -+void rtw_dump_rx_counters(_adapter* padapter) -+{ -+ struct dbg_rx_counter rx_counter; ++ DBG_871X_LEVEL(_drv_always_, "+%s+\n", __func__); + -+ if( padapter->dump_rx_cnt_mode & DUMP_DRV_RX_COUNTER ){ -+ _rtw_memset(&rx_counter,0,sizeof(struct dbg_rx_counter)); -+ rtw_dump_drv_rx_counters(padapter,&rx_counter); -+ DBG_871X( "Drv Received packet OK:%d CRC error:%d Drop Packets: %d\n", -+ rx_counter.rx_pkt_ok,rx_counter.rx_pkt_crc_error,rx_counter.rx_pkt_drop); -+ rtw_reset_drv_rx_counters(padapter); -+ } -+ -+ if( padapter->dump_rx_cnt_mode & DUMP_MAC_RX_COUNTER ){ -+ _rtw_memset(&rx_counter,0,sizeof(struct dbg_rx_counter)); -+ rtw_dump_mac_rx_counters(padapter,&rx_counter); -+ DBG_871X( "Mac Received packet OK:%d CRC error:%d FA Counter: %d Drop Packets: %d\n", -+ rx_counter.rx_pkt_ok,rx_counter.rx_pkt_crc_error, -+ rx_counter.rx_cck_fa+rx_counter.rx_ofdm_fa+rx_counter.rx_ht_fa, -+ rx_counter.rx_pkt_drop); -+ rtw_reset_mac_rx_counters(padapter); -+ } ++ pwowlan_parm.mode =0; ++ pwowlan_parm.gpio_index=0; ++ pwowlan_parm.gpio_duration=0; ++ pwowlan_parm.second_mode =0; ++ pwowlan_parm.reserve=0; + -+ if(padapter->dump_rx_cnt_mode & DUMP_PHY_RX_COUNTER ){ -+ _rtw_memset(&rx_counter,0,sizeof(struct dbg_rx_counter)); -+ rtw_dump_phy_rx_counters(padapter,&rx_counter); -+ //DBG_871X("%s: OFDM_FA =%d\n", __FUNCTION__, rx_counter.rx_ofdm_fa); -+ //DBG_871X("%s: CCK_FA =%d\n", __FUNCTION__, rx_counter.rx_cck_fa); -+ DBG_871X("Phy Received packet OK:%d CRC error:%d FA Counter: %d\n",rx_counter.rx_pkt_ok,rx_counter.rx_pkt_crc_error, -+ rx_counter.rx_ofdm_fa+rx_counter.rx_cck_fa); -+ rtw_reset_phy_rx_counters(padapter); -+ } -+} -+#endif -+void rtw_get_noise(_adapter* padapter) -+{ -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct noise_info info; -+ if(rtw_linked_check(padapter)){ -+ info.bPauseDIG = _TRUE; -+ info.IGIValue = 0x1e; -+ info.max_time = 100;//ms -+ info.chan = pmlmeext->cur_channel ;//rtw_get_oper_ch(padapter); -+ rtw_ps_deny(padapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(padapter); ++ if(enable){ + -+ rtw_hal_set_odm_var(padapter, HAL_ODM_NOISE_MONITOR,&info, _FALSE); -+ //ODM_InbandNoise_Monitor(podmpriv,_TRUE,0x20,100); -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR,&(info.chan), &(padapter->recvpriv.noise)); -+ #ifdef DBG_NOISE_MONITOR -+ DBG_871X("chan:%d,noise_level:%d\n",info.chan,padapter->recvpriv.noise); -+ #endif -+ } -+#endif ++ pwowlan_parm.mode |=FW_WOWLAN_FUN_EN; ++ pwrpriv->wowlan_magic =true; ++ pwrpriv->wowlan_unicast =true; + -+} ++ if(pwrpriv->wowlan_pattern ==true){ ++ pwowlan_parm.mode |= FW_WOWLAN_PATTERN_MATCH; ++ DBG_871X_LEVEL(_drv_info_, "%s 2.pwowlan_parm.mode=0x%x \n",__FUNCTION__,pwowlan_parm.mode ); ++ } ++ if(pwrpriv->wowlan_magic ==true){ ++ pwowlan_parm.mode |=FW_WOWLAN_MAGIC_PKT; ++ DBG_871X_LEVEL(_drv_info_, "%s 3.pwowlan_parm.mode=0x%x \n",__FUNCTION__,pwowlan_parm.mode ); ++ } ++ if(pwrpriv->wowlan_unicast ==true){ ++ pwowlan_parm.mode |=FW_WOWLAN_UNICAST; ++ DBG_871X_LEVEL(_drv_info_, "%s 4.pwowlan_parm.mode=0x%x \n",__FUNCTION__,pwowlan_parm.mode ); ++ } + -+#ifdef CONFIG_FW_C2H_DEBUG ++ if(!(padapter->pwrctrlpriv.wowlan_wake_reason & FWDecisionDisconnect)) ++ rtl8812a_set_FwJoinBssReport_cmd(padapter, 1); ++ else ++ DBG_871X_LEVEL(_drv_always_, "%s, disconnected, no FwJoinBssReport\n",__FUNCTION__); ++ rtw_msleep_os(2); + -+/* C2H RX package original is 128. -+if enable CONFIG_FW_C2H_DEBUG, it should increase to 256. -+ C2H FW debug message: -+ without aggregate: -+ {C2H_CmdID,Seq,SubID,Len,Content[0~n]} -+ Content[0~n]={'a','b','c',...,'z','\n'} -+ with aggregate: -+ {C2H_CmdID,Seq,SubID,Len,Content[0~n]} -+ Content[0~n]={'a','b','c',...,'z','\n',Extend C2H pkt 2...} -+ Extend C2H pkt 2={C2H CmdID,Seq,SubID,Len,Content = {'a','b','c',...,'z','\n'}} -+ Author: Isaac */ ++ //WOWLAN_GPIO_ACTIVE means GPIO high active ++ //pwowlan_parm.mode |=FW_WOWLAN_GPIO_ACTIVE; ++ //pwowlan_parm.mode |=FW_WOWLAN_REKEY_WAKEUP; ++ pwowlan_parm.mode |=FW_WOWLAN_DEAUTH_WAKEUP; ++ //pwowlan_parm.mode |=FW_WOWLAN_ALL_PKT_DROP; + -+void Debug_FwC2H(PADAPTER padapter, u8 *pdata, u8 len) -+{ -+ int i = 0; -+ int cnt = 0, total_length = 0; -+ u8 buf[128] = {0}; -+ u8 more_data = _FALSE; -+ u8 *nextdata = NULL; -+ u8 test = 0; ++ //DataPinWakeUp ++ pwowlan_parm.gpio_index=0x80; + -+ u8 data_len; -+ u8 seq_no; ++ DBG_871X_LEVEL(_drv_info_, "%s 5.pwowlan_parm.mode=0x%x \n",__FUNCTION__,pwowlan_parm.mode); ++ DBG_871X_LEVEL(_drv_info_, "%s 6.pwowlan_parm.index=0x%x \n",__FUNCTION__,pwowlan_parm.gpio_index); + -+ nextdata = pdata; -+ do { -+ data_len = *(nextdata + 1); -+ seq_no = *(nextdata + 2); ++ res = FillH2CCmd_8812(padapter, H2C_8812_WO_WLAN, 2, (u8 *)&pwowlan_parm); + -+ for (i = 0 ; i < data_len - 2 ; i++) { -+ cnt += sprintf((buf+cnt), "%c", nextdata[3 + i]); ++ rtw_msleep_os(2); + -+ if (nextdata[3 + i] == 0x0a && nextdata[4 + i] == 0xff) -+ more_data = _TRUE; -+ else if (nextdata[3 + i] == 0x0a && nextdata[4 + i] != 0xff) -+ more_data = _FALSE; ++ //disconnect decision ++ pwowlan_parm.mode =1; ++ pwowlan_parm.gpio_index=0; ++ pwowlan_parm.gpio_duration=0; ++ FillH2CCmd_8812(padapter, H2C_8812_DISCONNECT_DECISION, 3, (u8 *)&pwowlan_parm); ++ ++ //keep alive period = 10 * 10 BCN interval ++ pwowlan_parm.mode =1; ++ pwowlan_parm.gpio_index=10; ++ ++ res = FillH2CCmd_8812(padapter, H2C_8812_KEEP_ALIVE_CTRL, 2, (u8 *)&pwowlan_parm); ++ ++ rtw_msleep_os(2); ++ //enable Remote wake ctrl ++ pwowlan_parm.mode = 1; ++ pwowlan_parm.gpio_index=0; ++ pwowlan_parm.gpio_duration=0; ++ ++ res = FillH2CCmd_8812(padapter, H2C_8812_REMOTE_WAKE_CTRL, 3, (u8 *)&pwowlan_parm); ++ } else { ++ pwrpriv->wowlan_magic =false; ++ res = FillH2CCmd_8812(padapter, H2C_8812_WO_WLAN, 2, (u8 *)&pwowlan_parm); ++ rtw_msleep_os(2); ++ res = FillH2CCmd_8812(padapter, H2C_8812_REMOTE_WAKE_CTRL, 3, (u8 *)&pwowlan_parm); + } + -+ DBG_871X("[RTKFW, SEQ=%d]: %s", seq_no, buf); -+ data_len += 3; -+ total_length += data_len; -+ -+ if (more_data == _TRUE) { -+ _rtw_memset(buf, '\0', 128); -+ cnt = 0; -+ nextdata = (pdata + total_length); -+ } -+ } while (more_data == _TRUE); ++ DBG_871X_LEVEL(_drv_always_, "-%s res:%d-\n", __func__, res); ++ return ; +} -+#endif /*CONFIG_FW_C2H_DEBUG*/ -+void update_IOT_info(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ switch (pmlmeinfo->assoc_AP_vendor) -+ { -+ case HT_IOT_PEER_MARVELL: -+ pmlmeinfo->turboMode_cts2self = 1; -+ pmlmeinfo->turboMode_rtsen = 0; -+ break; -+ -+ case HT_IOT_PEER_RALINK: -+ pmlmeinfo->turboMode_cts2self = 0; -+ pmlmeinfo->turboMode_rtsen = 1; -+ //disable high power -+ rtw_phydm_func_clr(padapter, ODM_BB_DYNAMIC_TXPWR); -+ break; -+ case HT_IOT_PEER_REALTEK: -+ //rtw_write16(padapter, 0x4cc, 0xffff); -+ //rtw_write16(padapter, 0x546, 0x01c0); -+ //disable high power -+ rtw_phydm_func_clr(padapter, ODM_BB_DYNAMIC_TXPWR); -+ break; -+ default: -+ pmlmeinfo->turboMode_cts2self = 0; -+ pmlmeinfo->turboMode_rtsen = 1; -+ break; -+ } -+ -+} -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+void rtw_acs_start(_adapter *padapter, bool bStart) -+{ -+ if (_TRUE == bStart) { -+ ACS_OP acs_op = ACS_INIT; -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &acs_op, _TRUE); -+ rtw_set_acs_channel(padapter, 0); -+ SET_ACS_STATE(padapter, ACS_ENABLE); -+ } else { -+ SET_ACS_STATE(padapter, ACS_DISABLE); -+ #ifdef DBG_AUTO_CHNL_SEL_NHM -+ if (1) { -+ u8 best_24g_ch = 0; -+ u8 best_5g_ch = 0; -+ -+ rtw_hal_get_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &(best_24g_ch), &(best_5g_ch)); -+ DBG_871X("[ACS-"ADPT_FMT"] Best 2.4G CH:%u\n", ADPT_ARG(padapter), best_24g_ch); -+ DBG_871X("[ACS-"ADPT_FMT"] Best 5G CH:%u\n", ADPT_ARG(padapter), best_5g_ch); -+ } -+ #endif -+ } -+} -+#endif -+ -+/* TODO: merge with phydm, see odm_SetCrystalCap() */ -+void hal_set_crystal_cap(_adapter *adapter, u8 crystal_cap) -+{ -+ crystal_cap = crystal_cap & 0x3F; -+ -+ switch (rtw_get_chip_type(adapter)) { -+#if defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8188F) -+ case RTL8188E: -+ case RTL8188F: -+ /* write 0x24[16:11] = 0x24[22:17] = CrystalCap */ -+ PHY_SetBBReg(adapter, REG_AFE_XTAL_CTRL, 0x007FF800, (crystal_cap | (crystal_cap << 6))); -+ break; -+#endif -+#if defined(CONFIG_RTL8812A) -+ case RTL8812: -+ /* write 0x2C[30:25] = 0x2C[24:19] = CrystalCap */ -+ PHY_SetBBReg(adapter, REG_MAC_PHY_CTRL, 0x7FF80000, (crystal_cap | (crystal_cap << 6))); -+ break; -+#endif -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8192E) -+ case RTL8723B: -+ case RTL8703B: -+ case RTL8821: -+ case RTL8192E: -+ /* write 0x2C[23:18] = 0x2C[17:12] = CrystalCap */ -+ PHY_SetBBReg(adapter, REG_MAC_PHY_CTRL, 0x00FFF000, (crystal_cap | (crystal_cap << 6))); -+ break; -+#endif -+#if defined(CONFIG_RTL8814A) -+ case RTL8814A: -+ /* write 0x2C[26:21] = 0x2C[20:15] = CrystalCap*/ -+ PHY_SetBBReg(adapter, REG_MAC_PHY_CTRL, 0x07FF8000, (crystal_cap | (crystal_cap << 6))); -+ break; -+#endif -+ default: -+ rtw_warn_on(1); -+ } -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com_phycfg.c linux/3rdparty/rtl8812au/hal/hal_com_phycfg.c ---- linux.old/3rdparty/rtl8812au/hal/hal_com_phycfg.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/hal_com_phycfg.c 2017-06-07 23:07:21.013687758 +0300 -@@ -0,0 +1,4114 @@ ++#endif //CONFIG_WOWLAN +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_dm.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_dm.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_dm.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_dm.c 2018-02-06 17:42:30.713967209 +0200 +@@ -0,0 +1,597 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -164097,107635 +110668,594 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_com_phycfg.c linux/3rdparty/rtl8 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ -+#define _HAL_COM_PHYCFG_C_ -+ -+#include -+#include -+ -+ ++//============================================================ ++// Description: +// -+// Description: -+// Map Tx power index into dBm according to -+// current HW model, for example, RF and PA, and -+// current wireless mode. -+// By Bruce, 2008-01-29. ++// This file is for 92CE/92CU dynamic mechanism only +// -+s32 -+phy_TxPwrIdxToDbm( -+ IN PADAPTER Adapter, -+ IN WIRELESS_MODE WirelessMode, -+ IN u8 TxPwrIdx ++// ++//============================================================ ++#define _RTL8812A_DM_C_ ++ ++//============================================================ ++// include files ++//============================================================ ++//#include ++#include ++ ++//============================================================ ++// Global var ++//============================================================ ++ ++ ++static void ++dm_CheckProtection( ++ PADAPTER Adapter + ) +{ -+ s32 Offset = 0; -+ s32 PwrOutDbm = 0; -+ -+ // -+ // Tested by MP, we found that CCK Index 0 equals to -7dbm, OFDM legacy equals to -8dbm. -+ // Note: -+ // The mapping may be different by different NICs. Do not use this formula for what needs accurate result. -+ // By Bruce, 2008-01-29. -+ // -+ switch(WirelessMode) ++#if 0 ++ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); ++ u1Byte CurRate, RateThreshold; ++ ++ if(pMgntInfo->pHTInfo->bCurBW40MHz) ++ RateThreshold = MGN_MCS1; ++ else ++ RateThreshold = MGN_MCS3; ++ ++ if(Adapter->TxStats.CurrentInitTxRate <= RateThreshold) + { -+ case WIRELESS_MODE_B: -+ Offset = -7; -+ break; -+ -+ case WIRELESS_MODE_G: -+ case WIRELESS_MODE_N_24G: -+ Offset = -8; -+ break; -+ -+ default: //for MacOSX compiler warning -+ break; -+ } -+ -+ PwrOutDbm = TxPwrIdx / 2 + Offset; // Discard the decimal part. -+ -+ return PwrOutDbm; -+} -+ -+bool rtw_regsty_tx_power_by_rate_base_valid( -+ IN PADAPTER Adapter -+ ) -+{ -+ /* TODO: check registry power by rate base valid */ -+ return _FALSE; -+} -+ -+u8 rtw_regsty_get_tx_power_by_rate_base( -+ IN PADAPTER Adapter, -+ IN u8 Band, -+ IN u8 RfPath, -+ IN u8 TxNum, -+ IN RATE_SECTION RateSection -+ ) -+{ -+ /* TODO: return registry power by rate base */ -+ return 0; -+} -+ -+u8 -+PHY_GetTxPowerByRateBase( -+ IN PADAPTER Adapter, -+ IN u8 Band, -+ IN u8 RfPath, -+ IN u8 TxNum, -+ IN RATE_SECTION RateSection -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 value = 0; -+ -+ if ( RfPath > ODM_RF_PATH_D ) -+ { -+ DBG_871X("Invalid Rf Path %d in PHY_GetTxPowerByRateBase()\n", RfPath ); -+ return 0; -+ } -+ -+ if ( Band == BAND_ON_2_4G ) -+ { -+ switch ( RateSection ) { -+ case CCK: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][0]; -+ break; -+ case OFDM: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][1]; -+ break; -+ case HT_MCS0_MCS7: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][2]; -+ break; -+ case HT_MCS8_MCS15: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][3]; -+ break; -+ case HT_MCS16_MCS23: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][4]; -+ break; -+ case HT_MCS24_MCS31: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][5]; -+ break; -+ case VHT_1SSMCS0_1SSMCS9: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][6]; -+ break; -+ case VHT_2SSMCS0_2SSMCS9: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][7]; -+ break; -+ case VHT_3SSMCS0_3SSMCS9: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][8]; -+ break; -+ case VHT_4SSMCS0_4SSMCS9: -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][9]; -+ break; -+ default: -+ DBG_871X("Invalid RateSection %d in Band 2.4G, Rf Path %d, %dTx in PHY_GetTxPowerByRateBase()\n", -+ RateSection, RfPath, TxNum ); -+ break; -+ -+ }; -+ } -+ else if ( Band == BAND_ON_5G ) -+ { -+ switch ( RateSection ) { -+ case OFDM: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][0]; -+ break; -+ case HT_MCS0_MCS7: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][1]; -+ break; -+ case HT_MCS8_MCS15: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][2]; -+ break; -+ case HT_MCS16_MCS23: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][3]; -+ break; -+ case HT_MCS24_MCS31: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][4]; -+ break; -+ case VHT_1SSMCS0_1SSMCS9: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][5]; -+ break; -+ case VHT_2SSMCS0_2SSMCS9: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][6]; -+ break; -+ case VHT_3SSMCS0_3SSMCS9: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][7]; -+ break; -+ case VHT_4SSMCS0_4SSMCS9: -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][8]; -+ break; -+ default: -+ DBG_871X("Invalid RateSection %d in Band 5G, Rf Path %d, %dTx in PHY_GetTxPowerByRateBase()\n", -+ RateSection, RfPath, TxNum ); -+ break; -+ }; ++ pMgntInfo->bDmDisableProtect = true; ++ DbgPrint("Forced disable protect: %x\n", Adapter->TxStats.CurrentInitTxRate); + } + else + { -+ DBG_871X("Invalid Band %d in PHY_GetTxPowerByRateBase()\n", Band ); ++ pMgntInfo->bDmDisableProtect = false; ++ DbgPrint("Enable protect: %x\n", Adapter->TxStats.CurrentInitTxRate); + } -+ -+ return value; ++#endif +} + -+VOID -+phy_SetTxPowerByRateBase( -+ IN PADAPTER Adapter, -+ IN u8 Band, -+ IN u8 RfPath, -+ IN RATE_SECTION RateSection, -+ IN u8 TxNum, -+ IN u8 Value ++static void ++dm_CheckStatistics( ++ PADAPTER Adapter + ) +{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if ( RfPath > ODM_RF_PATH_D ) -+ { -+ DBG_871X("Invalid Rf Path %d in phy_SetTxPowerByRatBase()\n", RfPath ); ++#if 0 ++ if(!Adapter->MgntInfo.bMediaConnect) + return; -+ } -+ -+ if ( Band == BAND_ON_2_4G ) -+ { -+ switch ( RateSection ) { -+ case CCK: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][0] = Value; -+ break; -+ case OFDM: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][1] = Value; -+ break; -+ case HT_MCS0_MCS7: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][2] = Value; -+ break; -+ case HT_MCS8_MCS15: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][3] = Value; -+ break; -+ case HT_MCS16_MCS23: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][4] = Value; -+ break; -+ case HT_MCS24_MCS31: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][5] = Value; -+ break; -+ case VHT_1SSMCS0_1SSMCS9: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][6] = Value; -+ break; -+ case VHT_2SSMCS0_2SSMCS9: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][7] = Value; -+ break; -+ case VHT_3SSMCS0_3SSMCS9: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][8] = Value; -+ break; -+ case VHT_4SSMCS0_4SSMCS9: -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][9] = Value; -+ break; -+ default: -+ DBG_871X("Invalid RateSection %d in Band 2.4G, Rf Path %d, %dTx in phy_SetTxPowerByRateBase()\n", -+ RateSection, RfPath, TxNum ); -+ break; -+ }; -+ } -+ else if ( Band == BAND_ON_5G ) -+ { -+ switch ( RateSection ) { -+ case OFDM: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][0] = Value; -+ break; -+ case HT_MCS0_MCS7: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][1] = Value; -+ break; -+ case HT_MCS8_MCS15: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][2] = Value; -+ break; -+ case HT_MCS16_MCS23: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][3] = Value; -+ break; -+ case HT_MCS24_MCS31: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][4] = Value; -+ break; -+ case VHT_1SSMCS0_1SSMCS9: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][5] = Value; -+ break; -+ case VHT_2SSMCS0_2SSMCS9: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][6] = Value; -+ break; -+ case VHT_3SSMCS0_3SSMCS9: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][7] = Value; -+ break; -+ case VHT_4SSMCS0_4SSMCS9: -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][8] = Value; -+ break; -+ default: -+ DBG_871X("Invalid RateSection %d in Band 5G, Rf Path %d, %dTx in phy_SetTxPowerByRateBase()\n", -+ RateSection, RfPath, TxNum ); -+ break; -+ }; -+ } -+ else -+ { -+ DBG_871X("Invalid Band %d in phy_SetTxPowerByRateBase()\n", Band ); -+ } ++ ++ //2008.12.10 tynli Add for getting Current_Tx_Rate_Reg flexibly. ++ rtw_hal_get_hwreg( Adapter, HW_VAR_INIT_TX_RATE, (pu1Byte)(&Adapter->TxStats.CurrentInitTxRate) ); ++ ++ // Calculate current Tx Rate(Successful transmited!!) ++ ++ // Calculate current Rx Rate(Successful received!!) ++ ++ //for tx tx retry count ++ rtw_hal_get_hwreg( Adapter, HW_VAR_RETRY_COUNT, (pu1Byte)(&Adapter->TxStats.NumTxRetryCount) ); ++#endif +} + -+VOID -+phy_StoreTxPowerByRateBaseOld( -+ IN PADAPTER pAdapter -+ ) ++static void dm_CheckPbcGPIO(_adapter *padapter) +{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter ); -+ u16 rawValue = 0; -+ u8 base = 0; -+ u8 path = 0; ++ u8 tmp1byte; ++ u8 bPbcPressed = false; + -+ rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][7] >> 8 ) & 0xFF; -+ base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF ); -+ phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, CCK, RF_1TX, base ); ++ if(!padapter->registrypriv.hw_wps_pbc) ++ return; + -+ rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][1] >> 24 ) & 0xFF; -+ base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF ); -+ phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, OFDM, RF_1TX, base ); ++ if (IS_HARDWARE_TYPE_8812(padapter)) ++ { ++ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL); ++ tmp1byte |= (HAL_8192C_HW_GPIO_WPS_BIT); ++ rtw_write8(padapter, GPIO_IO_SEL, tmp1byte); //enable GPIO[2] as output mode + -+ rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][3] >> 24 ) & 0xFF; -+ base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF ); -+ phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, HT_MCS0_MCS7, RF_1TX, base ); ++ tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT); ++ rtw_write8(padapter, GPIO_IN, tmp1byte); //reset the floating voltage level + -+ rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][5] >> 24 ) & 0xFF; -+ base = ( rawValue >> 4) * 10 + ( rawValue & 0xF ); -+ phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, HT_MCS8_MCS15, RF_2TX, base ); ++ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL); ++ tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT); ++ rtw_write8(padapter, GPIO_IO_SEL, tmp1byte); //enable GPIO[2] as input mode + -+ rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][7] & 0xFF ); -+ base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF ); -+ phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, CCK, RF_1TX, base ); ++ tmp1byte =rtw_read8(padapter, GPIO_IN); + -+ rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][9] >> 24 ) & 0xFF; -+ base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF ); -+ phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, OFDM, RF_1TX, base ); ++ if (tmp1byte == 0xff) ++ return ; + -+ rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][11] >> 24 ) & 0xFF; -+ base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF ); -+ phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, HT_MCS0_MCS7, RF_1TX, base ); -+ -+ rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][13] >> 24 ) & 0xFF; -+ base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF ); -+ phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, HT_MCS8_MCS15, RF_2TX, base ); -+} -+ -+VOID -+phy_StoreTxPowerByRateBase( -+ IN PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(pAdapter); -+ -+ u8 rate_sec_base[RATE_SECTION_NUM] = { -+ MGN_11M, -+ MGN_54M, -+ MGN_MCS7, -+ MGN_MCS15, -+ MGN_MCS23, -+ MGN_MCS31, -+ MGN_VHT1SS_MCS7, -+ MGN_VHT2SS_MCS7, -+ MGN_VHT3SS_MCS7, -+ MGN_VHT4SS_MCS7, -+ }; -+ -+ u8 band, path, rs, tx_num, base, index; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { -+ -+ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { -+ /* TODO: 8814A's NumTotalRFPath differs at probe(3) and up(4), need fixed -+ if (path >= hal_data->NumTotalRFPath) -+ break; -+ */ -+ -+ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { -+ tx_num = rate_section_to_tx_num(rs); -+ if (tx_num >= hal_data->nss_num) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ base = PHY_GetTxPowerByRate(pAdapter, band, path, tx_num, rate_sec_base[rs]); -+ phy_SetTxPowerByRateBase(pAdapter, band, path, rs, tx_num, base); -+ } ++ if (tmp1byte&HAL_8192C_HW_GPIO_WPS_BIT) ++ { ++ bPbcPressed = true; + } + } -+} -+ -+u8 -+PHY_GetRateSectionIndexOfTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u32 RegAddr, -+ IN u32 BitMask -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter ); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ u8 index = 0; -+ -+ if ( pDM_Odm->PhyRegPgVersion == 0 ) ++ else if (IS_HARDWARE_TYPE_8821(padapter)) + { -+ switch ( RegAddr ) ++ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL_8811A); ++ tmp1byte |= (BIT4); ++ rtw_write8(padapter, GPIO_IO_SEL_8811A, tmp1byte); //enable GPIO[2] as output mode ++ ++ tmp1byte &= ~(BIT4); ++ rtw_write8(padapter, GPIO_IN_8811A, tmp1byte); //reset the floating voltage level ++ ++ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL_8811A); ++ tmp1byte &= ~(BIT4); ++ rtw_write8(padapter, GPIO_IO_SEL_8811A, tmp1byte); //enable GPIO[2] as input mode ++ ++ tmp1byte =rtw_read8(padapter, GPIO_IN_8811A); ++ ++ if (tmp1byte == 0xff) ++ return ; ++ ++ if (tmp1byte&BIT4) + { -+ case rTxAGC_A_Rate18_06: index = 0; break; -+ case rTxAGC_A_Rate54_24: index = 1; break; -+ case rTxAGC_A_CCK1_Mcs32: index = 6; break; -+ case rTxAGC_B_CCK11_A_CCK2_11: -+ if ( BitMask == bMaskH3Bytes ) -+ index = 7; -+ else if ( BitMask == 0x000000ff ) -+ index = 15; -+ break; -+ -+ case rTxAGC_A_Mcs03_Mcs00: index = 2; break; -+ case rTxAGC_A_Mcs07_Mcs04: index = 3; break; -+ case rTxAGC_A_Mcs11_Mcs08: index = 4; break; -+ case rTxAGC_A_Mcs15_Mcs12: index = 5; break; -+ case rTxAGC_B_Rate18_06: index = 8; break; -+ case rTxAGC_B_Rate54_24: index = 9; break; -+ case rTxAGC_B_CCK1_55_Mcs32: index = 14; break; -+ case rTxAGC_B_Mcs03_Mcs00: index = 10; break; -+ case rTxAGC_B_Mcs07_Mcs04: index = 11; break; -+ case rTxAGC_B_Mcs11_Mcs08: index = 12; break; -+ case rTxAGC_B_Mcs15_Mcs12: index = 13; break; -+ default: -+ DBG_871X("Invalid RegAddr 0x3%x in PHY_GetRateSectionIndexOfTxPowerByRate()", RegAddr ); -+ break; -+ }; ++ bPbcPressed = true; ++ } ++ } ++ ++ if( true == bPbcPressed) ++ { ++ // Here we only set bPbcPressed to true ++ // After trigger PBC, the variable will be set to false ++ DBG_8192C("CheckPbcGPIO - PBC is pressed\n"); ++ ++ rtw_request_wps_pbc_event(padapter); + } -+ -+ return index; +} + -+VOID -+PHY_GetRateValuesOfTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Value, -+ OUT u8 *Rate, -+ OUT s8 *PwrByRateVal, -+ OUT u8 *RateNum ++// ++// Initialize GPIO setting registers ++// ++static void ++dm_InitGPIOSetting( ++ PADAPTER Adapter + ) +{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter ); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ u8 index = 0, i = 0; -+ -+ switch ( RegAddr ) ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ ++ u8 tmp1byte; ++ ++ tmp1byte = rtw_read8(Adapter, REG_GPIO_MUXCFG); ++ tmp1byte &= (GPIOSEL_GPIO | ~GPIOSEL_ENBT); ++ ++#ifdef CONFIG_BT_COEXIST ++ // UMB-B cut bug. We need to support the modification. ++ if (IS_81xxC_VENDOR_UMC_B_CUT(pHalData->VersionID) && ++ pHalData->bt_coexist.BT_Coexist) + { -+ case rTxAGC_A_Rate18_06: -+ case rTxAGC_B_Rate18_06: -+ Rate[0] = MGN_6M; -+ Rate[1] = MGN_9M; -+ Rate[2] = MGN_12M; -+ Rate[3] = MGN_18M; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_Rate54_24: -+ case rTxAGC_B_Rate54_24: -+ Rate[0] = MGN_24M; -+ Rate[1] = MGN_36M; -+ Rate[2] = MGN_48M; -+ Rate[3] = MGN_54M; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_CCK1_Mcs32: -+ Rate[0] = MGN_1M; -+ PwrByRateVal[0] = ( s8 ) ( ( ( ( Value >> (8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> 8 ) & 0xF ) ); -+ *RateNum = 1; -+ break; -+ -+ case rTxAGC_B_CCK11_A_CCK2_11: -+ if ( BitMask == 0xffffff00 ) -+ { -+ Rate[0] = MGN_2M; -+ Rate[1] = MGN_5_5M; -+ Rate[2] = MGN_11M; -+ for ( i = 1; i < 4; ++ i ) -+ { -+ PwrByRateVal[i - 1] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 3; -+ } -+ else if ( BitMask == 0x000000ff ) -+ { -+ Rate[0] = MGN_11M; -+ PwrByRateVal[0] = ( s8 ) ( ( ( ( Value >> 4 ) & 0xF ) ) * 10 + -+ ( Value & 0xF ) ); -+ *RateNum = 1; -+ } -+ break; -+ -+ case rTxAGC_A_Mcs03_Mcs00: -+ case rTxAGC_B_Mcs03_Mcs00: -+ Rate[0] = MGN_MCS0; -+ Rate[1] = MGN_MCS1; -+ Rate[2] = MGN_MCS2; -+ Rate[3] = MGN_MCS3; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_Mcs07_Mcs04: -+ case rTxAGC_B_Mcs07_Mcs04: -+ Rate[0] = MGN_MCS4; -+ Rate[1] = MGN_MCS5; -+ Rate[2] = MGN_MCS6; -+ Rate[3] = MGN_MCS7; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_Mcs11_Mcs08: -+ case rTxAGC_B_Mcs11_Mcs08: -+ Rate[0] = MGN_MCS8; -+ Rate[1] = MGN_MCS9; -+ Rate[2] = MGN_MCS10; -+ Rate[3] = MGN_MCS11; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_Mcs15_Mcs12: -+ case rTxAGC_B_Mcs15_Mcs12: -+ Rate[0] = MGN_MCS12; -+ Rate[1] = MGN_MCS13; -+ Rate[2] = MGN_MCS14; -+ Rate[3] = MGN_MCS15; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ -+ break; -+ -+ case rTxAGC_B_CCK1_55_Mcs32: -+ Rate[0] = MGN_1M; -+ Rate[1] = MGN_2M; -+ Rate[2] = MGN_5_5M; -+ for ( i = 1; i < 4; ++ i ) -+ { -+ PwrByRateVal[i - 1] = ( s8 ) ( ( ( ( Value >> ( i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> ( i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 3; -+ break; -+ -+ case 0xC20: -+ case 0xE20: -+ case 0x1820: -+ case 0x1a20: -+ Rate[0] = MGN_1M; -+ Rate[1] = MGN_2M; -+ Rate[2] = MGN_5_5M; -+ Rate[3] = MGN_11M; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC24: -+ case 0xE24: -+ case 0x1824: -+ case 0x1a24: -+ Rate[0] = MGN_6M; -+ Rate[1] = MGN_9M; -+ Rate[2] = MGN_12M; -+ Rate[3] = MGN_18M; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; ++ tmp1byte |= (BIT5); ++ } ++#endif ++ rtw_write8(Adapter, REG_GPIO_MUXCFG, tmp1byte); + -+ case 0xC28: -+ case 0xE28: -+ case 0x1828: -+ case 0x1a28: -+ Rate[0] = MGN_24M; -+ Rate[1] = MGN_36M; -+ Rate[2] = MGN_48M; -+ Rate[3] = MGN_54M; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; ++} + -+ case 0xC2C: -+ case 0xE2C: -+ case 0x182C: -+ case 0x1a2C: -+ Rate[0] = MGN_MCS0; -+ Rate[1] = MGN_MCS1; -+ Rate[2] = MGN_MCS2; -+ Rate[3] = MGN_MCS3; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; ++// A mapping from HalData to ODM. ++ODM_BOARD_TYPE_E boardType(u8 InterfaceSel) ++{ ++ ODM_BOARD_TYPE_E board = ODM_BOARD_DEFAULT; + -+ case 0xC30: -+ case 0xE30: -+ case 0x1830: -+ case 0x1a30: -+ Rate[0] = MGN_MCS4; -+ Rate[1] = MGN_MCS5; -+ Rate[2] = MGN_MCS6; -+ Rate[3] = MGN_MCS7; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; ++ INTERFACE_SELECT_USB usb = (INTERFACE_SELECT_USB)InterfaceSel; ++ switch (usb) ++ { ++ case INTF_SEL1_USB_High_Power: ++ board |= ODM_BOARD_EXT_LNA; ++ board |= ODM_BOARD_EXT_PA; ++ break; ++ case INTF_SEL2_MINICARD: ++ board |= ODM_BOARD_MINICARD; ++ break; ++ case INTF_SEL4_USB_Combo: ++ board |= ODM_BOARD_BT; ++ break; ++ case INTF_SEL5_USB_Combo_MF: ++ board |= ODM_BOARD_BT; ++ break; ++ case INTF_SEL0_USB: ++ case INTF_SEL3_USB_Solo: ++ default: ++ board = ODM_BOARD_DEFAULT; ++ break; ++ } + -+ case 0xC34: -+ case 0xE34: -+ case 0x1834: -+ case 0x1a34: -+ Rate[0] = MGN_MCS8; -+ Rate[1] = MGN_MCS9; -+ Rate[2] = MGN_MCS10; -+ Rate[3] = MGN_MCS11; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; ++ return board; ++} + -+ case 0xC38: -+ case 0xE38: -+ case 0x1838: -+ case 0x1a38: -+ Rate[0] = MGN_MCS12; -+ Rate[1] = MGN_MCS13; -+ Rate[2] = MGN_MCS14; -+ Rate[3] = MGN_MCS15; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; ++//============================================================ ++// functions ++//============================================================ ++static void Init_ODM_ComInfo_8812(PADAPTER Adapter) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ u8 cut_ver,fab_ver; ++ u8 BoardType = ODM_BOARD_DEFAULT; + -+ case 0xC3C: -+ case 0xE3C: -+ case 0x183C: -+ case 0x1a3C: -+ Rate[0] = MGN_VHT1SS_MCS0; -+ Rate[1] = MGN_VHT1SS_MCS1; -+ Rate[2] = MGN_VHT1SS_MCS2; -+ Rate[3] = MGN_VHT1SS_MCS3; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; ++ // ++ // Init Value ++ // ++ _rtw_memset(pDM_Odm,0,sizeof(pDM_Odm)); + -+ case 0xC40: -+ case 0xE40: -+ case 0x1840: -+ case 0x1a40: -+ Rate[0] = MGN_VHT1SS_MCS4; -+ Rate[1] = MGN_VHT1SS_MCS5; -+ Rate[2] = MGN_VHT1SS_MCS6; -+ Rate[3] = MGN_VHT1SS_MCS7; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; ++ pDM_Odm->Adapter = Adapter; + -+ case 0xC44: -+ case 0xE44: -+ case 0x1844: -+ case 0x1a44: -+ Rate[0] = MGN_VHT1SS_MCS8; -+ Rate[1] = MGN_VHT1SS_MCS9; -+ Rate[2] = MGN_VHT2SS_MCS0; -+ Rate[3] = MGN_VHT2SS_MCS1; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; ++ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_PLATFORM,ODM_CE); + -+ case 0xC48: -+ case 0xE48: -+ case 0x1848: -+ case 0x1a48: -+ Rate[0] = MGN_VHT2SS_MCS2; -+ Rate[1] = MGN_VHT2SS_MCS3; -+ Rate[2] = MGN_VHT2SS_MCS4; -+ Rate[3] = MGN_VHT2SS_MCS5; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; ++ if (Adapter->interface_type == RTW_GSPI) ++ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_INTERFACE,ODM_ITRF_SDIO); ++ else ++ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_INTERFACE,Adapter->interface_type); + -+ case 0xC4C: -+ case 0xE4C: -+ case 0x184C: -+ case 0x1a4C: -+ Rate[0] = MGN_VHT2SS_MCS6; -+ Rate[1] = MGN_VHT2SS_MCS7; -+ Rate[2] = MGN_VHT2SS_MCS8; -+ Rate[3] = MGN_VHT2SS_MCS9; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; + -+ case 0xCD8: -+ case 0xED8: -+ case 0x18D8: -+ case 0x1aD8: -+ Rate[0] = MGN_MCS16; -+ Rate[1] = MGN_MCS17; -+ Rate[2] = MGN_MCS18; -+ Rate[3] = MGN_MCS19; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; ++ if (IS_HARDWARE_TYPE_8812(Adapter)) ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_IC_TYPE, ODM_RTL8812); ++ else if (IS_HARDWARE_TYPE_8821(Adapter)) ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_IC_TYPE, ODM_RTL8821); + -+ case 0xCDC: -+ case 0xEDC: -+ case 0x18DC: -+ case 0x1aDC: -+ Rate[0] = MGN_MCS20; -+ Rate[1] = MGN_MCS21; -+ Rate[2] = MGN_MCS22; -+ Rate[3] = MGN_MCS23; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; + -+ case 0xCE0: -+ case 0xEE0: -+ case 0x18E0: -+ case 0x1aE0: -+ Rate[0] = MGN_VHT3SS_MCS0; -+ Rate[1] = MGN_VHT3SS_MCS1; -+ Rate[2] = MGN_VHT3SS_MCS2; -+ Rate[3] = MGN_VHT3SS_MCS3; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; ++ fab_ver = ODM_TSMC; ++ if (IS_VENDOR_8812A_C_CUT(Adapter)) ++ cut_ver = ODM_CUT_C; ++ else ++ cut_ver = ODM_CUT_A; + -+ case 0xCE4: -+ case 0xEE4: -+ case 0x18E4: -+ case 0x1aE4: -+ Rate[0] = MGN_VHT3SS_MCS4; -+ Rate[1] = MGN_VHT3SS_MCS5; -+ Rate[2] = MGN_VHT3SS_MCS6; -+ Rate[3] = MGN_VHT3SS_MCS7; -+ for ( i = 0; i < 4; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 4; -+ break; ++ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_FAB_VER,fab_ver); ++ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_CUT_VER,cut_ver); + -+ case 0xCE8: -+ case 0xEE8: -+ case 0x18E8: -+ case 0x1aE8: -+ Rate[0] = MGN_VHT3SS_MCS8; -+ Rate[1] = MGN_VHT3SS_MCS9; -+ for ( i = 0; i < 2; ++ i ) -+ { -+ PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 + -+ ( ( Value >> (i * 8) ) & 0xF ) ); -+ } -+ *RateNum = 2; -+ break; -+ -+ default: -+ DBG_871X_LEVEL(_drv_always_, "Invalid RegAddr 0x%x in %s()\n", RegAddr, __func__); -+ break; -+ }; ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_MP_TEST_CHIP,IS_NORMAL_CHIP(pHalData->VersionID)); ++ ++ //1 ======= BoardType: ODM_CMNINFO_BOARD_TYPE ======= ++ if(pHalData->InterfaceSel == INTF_SEL1_USB_High_Power) ++ { ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_PA, 1); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_LNA, 1); ++ } ++ else ++ { ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_PA, pHalData->ExternalPA_2G); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_LNA, 0); ++ } ++ ++ if (pHalData->ExternalLNA_2G != 0) { ++ BoardType |= ODM_BOARD_EXT_LNA; ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_LNA, 1); ++ } ++ if (pHalData->ExternalLNA_5G != 0) { ++ BoardType |= ODM_BOARD_EXT_LNA_5G; ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_5G_EXT_LNA, 1); ++ } ++ if (pHalData->ExternalPA_2G != 0) { ++ BoardType |= ODM_BOARD_EXT_PA; ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_PA, 1); ++ } ++ if (pHalData->ExternalPA_5G != 0) { ++ BoardType |= ODM_BOARD_EXT_PA_5G; ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_5G_EXT_PA, 1); ++ } ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BOARD_TYPE, BoardType); ++ ++ //1 ============== End of BoardType ============== ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RFE_TYPE, pHalData->RFEType); ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_TRSW, 0); ++ ++ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_PATCH_ID,pEEPROM->CustomerID); ++ // ODM_CMNINFO_BINHCT_TEST only for MP Team ++ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_BWIFI_TEST,Adapter->registrypriv.wifi_spec); ++ ++ ++ if(pHalData->rf_type == RF_1T1R){ ++ ODM_CmnInfoUpdate(pDM_Odm,ODM_CMNINFO_RF_TYPE,ODM_1T1R); ++ } ++ else if(pHalData->rf_type == RF_2T2R){ ++ ODM_CmnInfoUpdate(pDM_Odm,ODM_CMNINFO_RF_TYPE,ODM_2T2R); ++ } ++ else if(pHalData->rf_type == RF_1T2R){ ++ ODM_CmnInfoUpdate(pDM_Odm,ODM_CMNINFO_RF_TYPE,ODM_1T2R); ++ } ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RFE_TYPE, pHalData->RFEType); ++ ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, pHalData->TRxAntDivType); ++ ++ #ifdef CONFIG_DISABLE_ODM ++ pdmpriv->InitODMFlag = 0; ++ #else ++ pdmpriv->InitODMFlag = ODM_RF_CALIBRATION | ++ ODM_RF_TX_PWR_TRACK //| ++ ; ++ //if(pHalData->AntDivCfg) ++ // pdmpriv->InitODMFlag |= ODM_BB_ANT_DIV; ++ #endif ++ ++ ODM_CmnInfoUpdate(pDM_Odm,ODM_CMNINFO_ABILITY,pdmpriv->InitODMFlag); ++ ++} ++static void Update_ODM_ComInfo_8812(PADAPTER Adapter) ++{ ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ struct pwrctrl_priv *pwrctrlpriv = &Adapter->pwrctrlpriv; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ int i; ++ #ifdef CONFIG_DISABLE_ODM ++ pdmpriv->InitODMFlag = 0; ++ #else //CONFIG_DISABLE_ODM ++ ++ pdmpriv->InitODMFlag = ODM_BB_DIG | ++#ifdef CONFIG_ODM_REFRESH_RAMASK ++ ODM_BB_RA_MASK | ++#endif ++ ODM_BB_FA_CNT | ++ ODM_BB_RSSI_MONITOR | ++ ODM_RF_TX_PWR_TRACK | // For RF ++ ODM_MAC_EDCA_TURBO ++ ; ++ if(pHalData->AntDivCfg) ++ pdmpriv->InitODMFlag |= ODM_BB_ANT_DIV; ++ ++ #if (MP_DRIVER==1) ++ if (Adapter->registrypriv.mp_mode == 1) ++ { ++ pdmpriv->InitODMFlag = ODM_RF_CALIBRATION | ++ ODM_RF_TX_PWR_TRACK; ++ } ++ #endif//(MP_DRIVER==1) ++ ++ #endif//CONFIG_DISABLE_ODM ++ ODM_CmnInfoUpdate(pDM_Odm,ODM_CMNINFO_ABILITY,pdmpriv->InitODMFlag); ++ ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_TX_UNI,&(Adapter->xmitpriv.tx_bytes)); ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_RX_UNI,&(Adapter->recvpriv.rx_bytes)); ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_WM_MODE,&(pmlmeext->cur_wireless_mode)); ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_BAND,&(pHalData->CurrentBandType)); ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_FORCED_RATE,&(pHalData->ForcedDataRate)); ++ ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_SEC_CHNL_OFFSET,&(pHalData->nCur40MhzPrimeSC)); ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_SEC_MODE,&(Adapter->securitypriv.dot11PrivacyAlgrthm)); ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_BW,&(pHalData->CurrentChannelBW )); ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_CHNL,&( pHalData->CurrentChannel)); ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_NET_CLOSED,&( Adapter->net_closed)); ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_MP_MODE,&(Adapter->registrypriv.mp_mode)); ++ //================= only for 8192D ================= ++ /* ++ //pHalData->CurrentBandType92D ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_DMSP_GET_VALUE,&(pDM_Odm->u1Byte_temp)); ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_BUDDY_ADAPTOR,&(pDM_Odm->PADAPTER_temp)); ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_DMSP_IS_MASTER,&(pDM_Odm->u1Byte_temp)); ++ //================= only for 8192D ================= ++ // driver havn't those variable now ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_BT_OPERATION,&(pDM_Odm->u1Byte_temp)); ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_BT_DISABLE_EDCA,&(pDM_Odm->u1Byte_temp)); ++ */ ++ ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_SCAN,&(pmlmepriv->bScanInProcess)); ++ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_POWER_SAVING,&(pwrctrlpriv->bpower_saving)); ++ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, pHalData->TRxAntDivType); ++ ++ for(i=0; i< NUM_STA; i++) ++ { ++ //pDM_Odm->pODM_StaInfo[i] = NULL; ++ ODM_CmnInfoPtrArrayHook(pDM_Odm, ODM_CMNINFO_STA_STATUS,i,NULL); ++ } +} + +void -+PHY_StoreTxPowerByRateNew( -+ IN PADAPTER pAdapter, -+ IN u32 Band, -+ IN u32 RfPath, -+ IN u32 TxNum, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 i = 0, rates[4] = {0}, rateNum = 0; -+ s8 PwrByRateVal[4] = {0}; -+ -+ PHY_GetRateValuesOfTxPowerByRate(pAdapter, RegAddr, BitMask, Data, rates, PwrByRateVal, &rateNum); -+ -+ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { -+ DBG_871X_LEVEL(_drv_always_, "Invalid Band %d\n", Band); -+ return; -+ } -+ -+ if (RfPath > ODM_RF_PATH_D) { -+ DBG_871X_LEVEL(_drv_always_, "Invalid RfPath %d\n", RfPath); -+ return; -+ } -+ -+ if (TxNum > ODM_RF_PATH_D) { -+ DBG_871X_LEVEL(_drv_always_, "Invalid TxNum %d\n", TxNum); -+ return; -+ } -+ -+ for (i = 0; i < rateNum; ++i) { -+ u8 rate_idx = PHY_GetRateIndexOfTxPowerByRate(rates[i]); -+ -+ if (IS_1T_RATE(rates[i])) -+ pHalData->TxPwrByRateOffset[Band][RfPath][RF_1TX][rate_idx] = PwrByRateVal[i]; -+ else if (IS_2T_RATE(rates[i])) -+ pHalData->TxPwrByRateOffset[Band][RfPath][RF_2TX][rate_idx] = PwrByRateVal[i]; -+ else if (IS_3T_RATE(rates[i])) -+ pHalData->TxPwrByRateOffset[Band][RfPath][RF_3TX][rate_idx] = PwrByRateVal[i]; -+ else if (IS_4T_RATE(rates[i])) -+ pHalData->TxPwrByRateOffset[Band][RfPath][RF_4TX][rate_idx] = PwrByRateVal[i]; -+ else -+ rtw_warn_on(1); -+ } -+} -+ -+void -+PHY_StoreTxPowerByRateOld( -+ IN PADAPTER pAdapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 index = PHY_GetRateSectionIndexOfTxPowerByRate( pAdapter, RegAddr, BitMask ); -+ -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][index] = Data; -+ //DBG_871X("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][0]); -+} -+ -+VOID -+PHY_InitTxPowerByRate( -+ IN PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 band = 0, rfPath = 0, TxNum = 0, rate = 0, i = 0, j = 0; -+ -+ if ( IS_HARDWARE_TYPE_8188E( pAdapter ) ) -+ { -+ for ( i = 0; i < MAX_PG_GROUP; ++i ) -+ for ( j = 0; j < 16; ++j ) -+ pHalData->MCSTxPowerLevelOriginalOffset[i][j] = 0; -+ } -+ else -+ { -+ for ( band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band ) -+ for ( rfPath = 0; rfPath < TX_PWR_BY_RATE_NUM_RF; ++rfPath ) -+ for ( TxNum = 0; TxNum < TX_PWR_BY_RATE_NUM_RF; ++TxNum ) -+ for ( rate = 0; rate < TX_PWR_BY_RATE_NUM_RATE; ++rate ) -+ pHalData->TxPwrByRateOffset[band][rfPath][TxNum][rate] = 0; -+ } -+} -+ -+VOID -+PHY_StoreTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u32 Band, -+ IN u32 RfPath, -+ IN u32 TxNum, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ if ( pDM_Odm->PhyRegPgVersion > 0 ) -+ { -+ PHY_StoreTxPowerByRateNew( pAdapter, Band, RfPath, TxNum, RegAddr, BitMask, Data ); -+ } -+ else if ( pDM_Odm->PhyRegPgVersion == 0 ) -+ { -+ PHY_StoreTxPowerByRateOld( pAdapter, RegAddr, BitMask, Data ); -+ -+ if ( RegAddr == rTxAGC_A_Mcs15_Mcs12 && pHalData->rf_type == RF_1T1R ) -+ pHalData->pwrGroupCnt++; -+ else if ( RegAddr == rTxAGC_B_Mcs15_Mcs12 && pHalData->rf_type != RF_1T1R ) -+ pHalData->pwrGroupCnt++; -+ } -+ else -+ DBG_871X("Invalid PHY_REG_PG.txt version %d\n", pDM_Odm->PhyRegPgVersion ); -+ -+} -+ -+VOID -+phy_ConvertTxPowerByRateByBase( -+ IN u32* pData, -+ IN u8 Start, -+ IN u8 End, -+ IN u8 BaseValue -+ ) -+{ -+ s8 i = 0; -+ u8 TempValue = 0; -+ u32 TempData = 0; -+ -+ for ( i = 3; i >= 0; --i ) -+ { -+ if ( i >= Start && i <= End ) -+ { -+ // Get the exact value -+ TempValue = ( u8 ) ( *pData >> ( i * 8 ) ) & 0xF; -+ TempValue += ( ( u8 ) ( ( *pData >> ( i * 8 + 4 ) ) & 0xF ) ) * 10; -+ -+ // Change the value to a relative value -+ TempValue = ( TempValue > BaseValue ) ? TempValue - BaseValue : BaseValue - TempValue; -+ } -+ else -+ { -+ TempValue = ( u8 ) ( *pData >> ( i * 8 ) ) & 0xFF; -+ } -+ -+ TempData <<= 8; -+ TempData |= TempValue; -+ } -+ -+ *pData = TempData; -+} -+ -+ -+VOID -+PHY_ConvertTxPowerByRateInDbmToRelativeValuesOld( -+ IN PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter ); -+ u8 base = 0; -+ -+ //DBG_871X("===>PHY_ConvertTxPowerByRateInDbmToRelativeValuesOld()\n" ); -+ -+ // CCK -+ base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, RF_1TX, CCK ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][6] ), 1, 1, base ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][7] ), 1, 3, base ); -+ -+ // OFDM -+ base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, RF_1TX, OFDM ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][0] ), 0, 3, base ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][1] ), 0, 3, base ); -+ -+ // HT MCS0~7 -+ base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, RF_1TX, HT_MCS0_MCS7 ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][2] ), 0, 3, base ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][3] ), 0, 3, base ); -+ -+ // HT MCS8~15 -+ base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, RF_2TX, HT_MCS8_MCS15 ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][4] ), 0, 3, base ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][5] ), 0, 3, base ); -+ -+ // CCK -+ base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, RF_1TX, CCK ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][14] ), 1, 3, base ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][15] ), 0, 0, base ); -+ -+ // OFDM -+ base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, RF_1TX, OFDM ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][8] ), 0, 3, base ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][9] ), 0, 3, base ); -+ -+ // HT MCS0~7 -+ base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, RF_1TX, HT_MCS0_MCS7 ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][10] ), 0, 3, base ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][11] ), 0, 3, base ); -+ -+ // HT MCS8~15 -+ base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, RF_2TX, HT_MCS8_MCS15 ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][12] ), 0, 3, base ); -+ phy_ConvertTxPowerByRateByBase( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[0][13] ), 0, 3, base ); -+ -+ //DBG_871X("<===PHY_ConvertTxPowerByRateInDbmToRelativeValuesOld()\n" ); -+} -+ -+VOID -+phy_ConvertTxPowerByRateInDbmToRelativeValues( -+ IN PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter ); -+ u8 base = 0, i = 0, value = 0, -+ band = 0, path = 0, txNum = 0, index = 0, -+ startIndex = 0, endIndex = 0; -+ u8 cckRates[4] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}, -+ ofdmRates[8] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M}, -+ mcs0_7Rates[8] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}, -+ mcs8_15Rates[8] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}, -+ mcs16_23Rates[8] = {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23}, -+ vht1ssRates[10] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4, -+ MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9}, -+ vht2ssRates[10] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, -+ MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9}, -+ vht3ssRates[10] = {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4, -+ MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9}; -+ -+ //DBG_871X("===>PHY_ConvertTxPowerByRateInDbmToRelativeValues()\n" ); -+ -+ for ( band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band ) -+ { -+ for ( path = ODM_RF_PATH_A; path <= ODM_RF_PATH_D; ++path ) -+ { -+ for ( txNum = RF_1TX; txNum < RF_MAX_TX_NUM; ++txNum ) -+ { -+ // CCK -+ base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_11M ); -+ for ( i = 0; i < sizeof( cckRates ); ++i ) -+ { -+ value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, cckRates[i] ); -+ PHY_SetTxPowerByRate( pAdapter, band, path, txNum, cckRates[i], value - base ); -+ } -+ -+ // OFDM -+ base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_54M ); -+ for ( i = 0; i < sizeof( ofdmRates ); ++i ) -+ { -+ value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, ofdmRates[i] ); -+ PHY_SetTxPowerByRate( pAdapter, band, path, txNum, ofdmRates[i], value - base ); -+ } -+ -+ // HT MCS0~7 -+ base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_MCS7 ); -+ for ( i = 0; i < sizeof( mcs0_7Rates ); ++i ) -+ { -+ value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, mcs0_7Rates[i] ); -+ PHY_SetTxPowerByRate( pAdapter, band, path, txNum, mcs0_7Rates[i], value - base ); -+ } -+ -+ // HT MCS8~15 -+ base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_MCS15 ); -+ for ( i = 0; i < sizeof( mcs8_15Rates ); ++i ) -+ { -+ value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, mcs8_15Rates[i] ); -+ PHY_SetTxPowerByRate( pAdapter, band, path, txNum, mcs8_15Rates[i], value - base ); -+ } -+ -+ // HT MCS16~23 -+ base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_MCS23 ); -+ for ( i = 0; i < sizeof( mcs16_23Rates ); ++i ) -+ { -+ value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, mcs16_23Rates[i] ); -+ PHY_SetTxPowerByRate( pAdapter, band, path, txNum, mcs16_23Rates[i], value - base ); -+ } -+ -+ // VHT 1SS -+ base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_VHT1SS_MCS7 ); -+ for ( i = 0; i < sizeof( vht1ssRates ); ++i ) -+ { -+ value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, vht1ssRates[i] ); -+ PHY_SetTxPowerByRate( pAdapter, band, path, txNum, vht1ssRates[i], value - base ); -+ } -+ -+ // VHT 2SS -+ base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_VHT2SS_MCS7 ); -+ for ( i = 0; i < sizeof( vht2ssRates ); ++i ) -+ { -+ value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, vht2ssRates[i] ); -+ PHY_SetTxPowerByRate( pAdapter, band, path, txNum, vht2ssRates[i], value - base ); -+ } -+ -+ // VHT 3SS -+ base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_VHT3SS_MCS7 ); -+ for ( i = 0; i < sizeof( vht3ssRates ); ++i ) -+ { -+ value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, vht3ssRates[i] ); -+ PHY_SetTxPowerByRate( pAdapter, band, path, txNum, vht3ssRates[i], value - base ); -+ } -+ } -+ } -+ } -+ -+ //DBG_871X("<===PHY_ConvertTxPowerByRateInDbmToRelativeValues()\n" ); -+} -+ -+/* -+ * This function must be called if the value in the PHY_REG_PG.txt(or header) -+ * is exact dBm values -+ */ -+VOID -+PHY_TxPowerByRateConfiguration( -+ IN PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter); -+ -+ phy_StoreTxPowerByRateBase( pAdapter ); -+ phy_ConvertTxPowerByRateInDbmToRelativeValues( pAdapter ); -+} -+ -+VOID -+PHY_SetTxPowerIndexByRateSection( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Channel, -+ IN u8 RateSection -+ ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ -+ if ( RateSection == CCK ) -+ { -+ u8 cckRates[] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}; -+ if ( pHalData->CurrentBandType == BAND_ON_2_4G ) -+ PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ cckRates, sizeof(cckRates)/sizeof(u8) ); -+ -+ } -+ else if ( RateSection == OFDM ) -+ { -+ u8 ofdmRates[] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M}; -+ PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ ofdmRates, sizeof(ofdmRates)/sizeof(u8)); -+ -+ } -+ else if ( RateSection == HT_MCS0_MCS7 ) -+ { -+ u8 htRates1T[] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}; -+ PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ htRates1T, sizeof(htRates1T)/sizeof(u8)); -+ -+ } -+ else if ( RateSection == HT_MCS8_MCS15 ) -+ { -+ u8 htRates2T[] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}; -+ PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ htRates2T, sizeof(htRates2T)/sizeof(u8)); -+ -+ } -+ else if ( RateSection == HT_MCS16_MCS23 ) -+ { -+ u1Byte htRates3T[] = {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23}; -+ PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ htRates3T, sizeof(htRates3T)/sizeof(u1Byte)); -+ -+ } -+ else if ( RateSection == HT_MCS24_MCS31 ) -+ { -+ u1Byte htRates4T[] = {MGN_MCS24, MGN_MCS25, MGN_MCS26, MGN_MCS27, MGN_MCS28, MGN_MCS29, MGN_MCS30, MGN_MCS31}; -+ PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ htRates4T, sizeof(htRates4T)/sizeof(u1Byte)); -+ -+ } -+ else if ( RateSection == VHT_1SSMCS0_1SSMCS9 ) -+ { -+ u8 vhtRates1T[] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4, -+ MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9}; -+ PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ vhtRates1T, sizeof(vhtRates1T)/sizeof(u8)); -+ -+ } -+ else if ( RateSection == VHT_2SSMCS0_2SSMCS9 ) -+ { -+ u8 vhtRates2T[] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, -+ MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9}; -+ -+ PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ vhtRates2T, sizeof(vhtRates2T)/sizeof(u8)); -+ } -+ else if ( RateSection == VHT_3SSMCS0_3SSMCS9 ) -+ { -+ u1Byte vhtRates3T[] = {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4, -+ MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9}; -+ -+ PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ vhtRates3T, sizeof(vhtRates3T)/sizeof(u1Byte)); -+ } -+ else if ( RateSection == VHT_4SSMCS0_4SSMCS9 ) -+ { -+ u1Byte vhtRates4T[] = {MGN_VHT4SS_MCS0, MGN_VHT4SS_MCS1, MGN_VHT4SS_MCS2, MGN_VHT4SS_MCS3, MGN_VHT4SS_MCS4, -+ MGN_VHT4SS_MCS5, MGN_VHT4SS_MCS6, MGN_VHT4SS_MCS7, MGN_VHT4SS_MCS8, MGN_VHT4SS_MCS9}; -+ -+ PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ vhtRates4T, sizeof(vhtRates4T)/sizeof(u1Byte)); -+ } -+ else -+ { -+ DBG_871X("Invalid RateSection %d in %s", RateSection, __FUNCTION__ ); -+ } -+} -+ -+BOOLEAN -+phy_GetChnlIndex( -+ IN u8 Channel, -+ OUT u8* ChannelIdx -+ ) -+{ -+ u8 i = 0; -+ BOOLEAN bIn24G=_TRUE; -+ -+ if (Channel <= 14) { -+ bIn24G = _TRUE; -+ *ChannelIdx = Channel - 1; -+ } else { -+ bIn24G = _FALSE; -+ -+ for (i = 0; i < CENTER_CH_5G_ALL_NUM; ++i) { -+ if (center_ch_5g_all[i] == Channel) { -+ *ChannelIdx = i; -+ return bIn24G; -+ } -+ } -+ } -+ -+ return bIn24G; -+} -+ -+u8 -+PHY_GetTxPowerIndexBase( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel, -+ OUT PBOOLEAN bIn24G -+ ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ u8 i = 0; //default set to 1S -+ u8 txPower = 0; -+ u8 chnlIdx = (Channel-1); -+ -+ if (HAL_IsLegalChannel(pAdapter, Channel) == _FALSE) -+ { -+ chnlIdx = 0; -+ DBG_871X("Illegal channel!!\n"); -+ } -+ -+ *bIn24G = phy_GetChnlIndex(Channel, &chnlIdx); -+ -+ //DBG_871X("[%s] Channel Index: %d\n", (*bIn24G?"2.4G":"5G"), chnlIdx); -+ -+ if (*bIn24G) //3 ============================== 2.4 G ============================== -+ { -+ if ( IS_CCK_RATE(Rate) ) -+ { -+ txPower = pHalData->Index24G_CCK_Base[RFPath][chnlIdx]; -+ } -+ else if ( MGN_6M <= Rate ) -+ { -+ txPower = pHalData->Index24G_BW40_Base[RFPath][chnlIdx]; -+ } -+ else -+ { -+ DBG_871X("PHY_GetTxPowerIndexBase: INVALID Rate.\n"); -+ } -+ -+ //DBG_871X("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", -+ // ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower); -+ -+ // OFDM-1T -+ if ( (MGN_6M <= Rate && Rate <= MGN_54M) && ! IS_CCK_RATE(Rate) ) -+ { -+ txPower += pHalData->OFDM_24G_Diff[RFPath][TX_1S]; -+ //DBG_871X("+PowerDiff 2.4G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_24G_Diff[RFPath][TX_1S]); -+ } -+ // BW20-1S, BW20-2S -+ if (BandWidth == CHANNEL_WIDTH_20) -+ { -+ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_1S]; -+ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_2S]; -+ if ( (MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_3S]; -+ if ( (MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_4S]; -+ -+ //DBG_871X("+PowerDiff 2.4G (RF-%c): (BW20-1S, BW20-2S, BW20-3S, BW20-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), -+ // pHalData->BW20_24G_Diff[RFPath][TX_1S], pHalData->BW20_24G_Diff[RFPath][TX_2S], -+ // pHalData->BW20_24G_Diff[RFPath][TX_3S], pHalData->BW20_24G_Diff[RFPath][TX_4S]); -+ } -+ // BW40-1S, BW40-2S -+ else if (BandWidth == CHANNEL_WIDTH_40) -+ { -+ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; -+ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; -+ if ( (MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_3S]; -+ if ( (MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_4S]; -+ -+ //DBG_871X("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S, BW40-3S, BW40-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), -+ // pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S], -+ // pHalData->BW40_24G_Diff[RFPath][TX_3S], pHalData->BW40_24G_Diff[RFPath][TX_4S]); -+ } -+ // Willis suggest adopt BW 40M power index while in BW 80 mode -+ else if ( BandWidth == CHANNEL_WIDTH_80 ) -+ { -+ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; -+ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; -+ if ( (MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_3S]; -+ if ( (MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_4S]; -+ -+ //DBG_871X("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S, BW40-3S, BW40-4T) = (%d, %d, %d, %d) P.S. Current is in BW 80MHz\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), -+ // pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S], -+ // pHalData->BW40_24G_Diff[RFPath][TX_3S], pHalData->BW40_24G_Diff[RFPath][TX_4S]); -+ } -+ } -+ else //3 ============================== 5 G ============================== -+ { -+ if ( MGN_6M <= Rate ) -+ { -+ txPower = pHalData->Index5G_BW40_Base[RFPath][chnlIdx]; -+ } -+ else -+ { -+ DBG_871X("===> mpt_ProQueryCalTxPower_Jaguar: INVALID Rate.\n"); -+ } -+ -+ //DBG_871X("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", -+ // ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower); -+ -+ // OFDM-1T -+ if ( (MGN_6M <= Rate && Rate <= MGN_54M) && ! IS_CCK_RATE(Rate)) -+ { -+ txPower += pHalData->OFDM_5G_Diff[RFPath][TX_1S]; -+ //DBG_871X("+PowerDiff 5G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_5G_Diff[RFPath][TX_1S]); -+ } -+ -+ // BW20-1S, BW20-2S -+ if (BandWidth == CHANNEL_WIDTH_20) -+ { -+ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_1S]; -+ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_2S]; -+ if ( (MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_3S]; -+ if ( (MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_4S]; -+ -+ //DBG_871X("+PowerDiff 5G (RF-%c): (BW20-1S, BW20-2S, BW20-3S, BW20-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), -+ // pHalData->BW20_5G_Diff[RFPath][TX_1S], pHalData->BW20_5G_Diff[RFPath][TX_2S], -+ // pHalData->BW20_5G_Diff[RFPath][TX_3S], pHalData->BW20_5G_Diff[RFPath][TX_4S]); -+ } -+ // BW40-1S, BW40-2S -+ else if (BandWidth == CHANNEL_WIDTH_40) -+ { -+ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_1S]; -+ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_2S]; -+ if ( (MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_3S]; -+ if ( (MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_4S]; -+ -+ //DBG_871X("+PowerDiff 5G(RF-%c): (BW40-1S, BW40-2S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), -+ // pHalData->BW40_5G_Diff[RFPath][TX_1S], pHalData->BW40_5G_Diff[RFPath][TX_2S], -+ // pHalData->BW40_5G_Diff[RFPath][TX_3S], pHalData->BW40_5G_Diff[RFPath][TX_4S]); -+ } -+ // BW80-1S, BW80-2S -+ else if (BandWidth== CHANNEL_WIDTH_80) -+ { -+ // <20121220, Kordan> Get the index of array "Index5G_BW80_Base". -+ for (i = 0; i < CENTER_CH_5G_80M_NUM; ++i) -+ if (center_ch_5g_80m[i] == Channel) -+ chnlIdx = i; -+ -+ txPower = pHalData->Index5G_BW80_Base[RFPath][chnlIdx]; -+ -+ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += + pHalData->BW80_5G_Diff[RFPath][TX_1S]; -+ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW80_5G_Diff[RFPath][TX_2S]; -+ if ( (MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW80_5G_Diff[RFPath][TX_3S]; -+ if ( (MGN_MCS23 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW80_5G_Diff[RFPath][TX_4S]; -+ -+ //DBG_871X("+PowerDiff 5G(RF-%c): (BW80-1S, BW80-2S, BW80-3S, BW80-4S) = (%d, %d, %d, %d)\n",((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), -+ // pHalData->BW80_5G_Diff[RFPath][TX_1S], pHalData->BW80_5G_Diff[RFPath][TX_2S], -+ // pHalData->BW80_5G_Diff[RFPath][TX_3S], pHalData->BW80_5G_Diff[RFPath][TX_4S]); -+ } -+ } -+ -+ return txPower; -+} -+ -+s8 -+PHY_GetTxPowerTrackingOffset( -+ PADAPTER pAdapter, -+ u8 RFPath, -+ u8 Rate -+ ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ s8 offset = 0; -+ -+ if( pDM_Odm->RFCalibrateInfo.TxPowerTrackControl == _FALSE) -+ return offset; -+ -+ if ((Rate == MGN_1M) ||(Rate == MGN_2M)||(Rate == MGN_5_5M)||(Rate == MGN_11M)) -+ { -+ offset = pDM_Odm->RFCalibrateInfo.Remnant_CCKSwingIdx; -+ /*DBG_871X("+Remnant_CCKSwingIdx = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_CCKSwingIdx);*/ -+ } -+ else -+ { -+ offset = pDM_Odm->RFCalibrateInfo.Remnant_OFDMSwingIdx[RFPath]; -+ /*DBG_871X("+Remanant_OFDMSwingIdx[RFPath %u][Rate 0x%x] = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath]); */ -+ -+ } -+ -+ return offset; -+} -+ -+u8 -+PHY_GetRateIndexOfTxPowerByRate( -+ IN u8 Rate -+ ) -+{ -+ u8 index = 0; -+ switch ( Rate ) -+ { -+ case MGN_1M: index = 0; break; -+ case MGN_2M: index = 1; break; -+ case MGN_5_5M: index = 2; break; -+ case MGN_11M: index = 3; break; -+ case MGN_6M: index = 4; break; -+ case MGN_9M: index = 5; break; -+ case MGN_12M: index = 6; break; -+ case MGN_18M: index = 7; break; -+ case MGN_24M: index = 8; break; -+ case MGN_36M: index = 9; break; -+ case MGN_48M: index = 10; break; -+ case MGN_54M: index = 11; break; -+ case MGN_MCS0: index = 12; break; -+ case MGN_MCS1: index = 13; break; -+ case MGN_MCS2: index = 14; break; -+ case MGN_MCS3: index = 15; break; -+ case MGN_MCS4: index = 16; break; -+ case MGN_MCS5: index = 17; break; -+ case MGN_MCS6: index = 18; break; -+ case MGN_MCS7: index = 19; break; -+ case MGN_MCS8: index = 20; break; -+ case MGN_MCS9: index = 21; break; -+ case MGN_MCS10: index = 22; break; -+ case MGN_MCS11: index = 23; break; -+ case MGN_MCS12: index = 24; break; -+ case MGN_MCS13: index = 25; break; -+ case MGN_MCS14: index = 26; break; -+ case MGN_MCS15: index = 27; break; -+ case MGN_MCS16: index = 28; break; -+ case MGN_MCS17: index = 29; break; -+ case MGN_MCS18: index = 30; break; -+ case MGN_MCS19: index = 31; break; -+ case MGN_MCS20: index = 32; break; -+ case MGN_MCS21: index = 33; break; -+ case MGN_MCS22: index = 34; break; -+ case MGN_MCS23: index = 35; break; -+ case MGN_MCS24: index = 36; break; -+ case MGN_MCS25: index = 37; break; -+ case MGN_MCS26: index = 38; break; -+ case MGN_MCS27: index = 39; break; -+ case MGN_MCS28: index = 40; break; -+ case MGN_MCS29: index = 41; break; -+ case MGN_MCS30: index = 42; break; -+ case MGN_MCS31: index = 43; break; -+ case MGN_VHT1SS_MCS0: index = 44; break; -+ case MGN_VHT1SS_MCS1: index = 45; break; -+ case MGN_VHT1SS_MCS2: index = 46; break; -+ case MGN_VHT1SS_MCS3: index = 47; break; -+ case MGN_VHT1SS_MCS4: index = 48; break; -+ case MGN_VHT1SS_MCS5: index = 49; break; -+ case MGN_VHT1SS_MCS6: index = 50; break; -+ case MGN_VHT1SS_MCS7: index = 51; break; -+ case MGN_VHT1SS_MCS8: index = 52; break; -+ case MGN_VHT1SS_MCS9: index = 53; break; -+ case MGN_VHT2SS_MCS0: index = 54; break; -+ case MGN_VHT2SS_MCS1: index = 55; break; -+ case MGN_VHT2SS_MCS2: index = 56; break; -+ case MGN_VHT2SS_MCS3: index = 57; break; -+ case MGN_VHT2SS_MCS4: index = 58; break; -+ case MGN_VHT2SS_MCS5: index = 59; break; -+ case MGN_VHT2SS_MCS6: index = 60; break; -+ case MGN_VHT2SS_MCS7: index = 61; break; -+ case MGN_VHT2SS_MCS8: index = 62; break; -+ case MGN_VHT2SS_MCS9: index = 63; break; -+ case MGN_VHT3SS_MCS0: index = 64; break; -+ case MGN_VHT3SS_MCS1: index = 65; break; -+ case MGN_VHT3SS_MCS2: index = 66; break; -+ case MGN_VHT3SS_MCS3: index = 67; break; -+ case MGN_VHT3SS_MCS4: index = 68; break; -+ case MGN_VHT3SS_MCS5: index = 69; break; -+ case MGN_VHT3SS_MCS6: index = 70; break; -+ case MGN_VHT3SS_MCS7: index = 71; break; -+ case MGN_VHT3SS_MCS8: index = 72; break; -+ case MGN_VHT3SS_MCS9: index = 73; break; -+ case MGN_VHT4SS_MCS0: index = 74; break; -+ case MGN_VHT4SS_MCS1: index = 75; break; -+ case MGN_VHT4SS_MCS2: index = 76; break; -+ case MGN_VHT4SS_MCS3: index = 77; break; -+ case MGN_VHT4SS_MCS4: index = 78; break; -+ case MGN_VHT4SS_MCS5: index = 79; break; -+ case MGN_VHT4SS_MCS6: index = 80; break; -+ case MGN_VHT4SS_MCS7: index = 81; break; -+ case MGN_VHT4SS_MCS8: index = 82; break; -+ case MGN_VHT4SS_MCS9: index = 83; break; -+ default: -+ DBG_871X("Invalid rate 0x%x in %s\n", Rate, __FUNCTION__ ); -+ break; -+ }; -+ -+ return index; -+} -+ -+s8 -+PHY_GetTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u8 Band, -+ IN u8 RFPath, -+ IN u8 TxNum, -+ IN u8 Rate -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter ); -+ s8 value = 0, limit = 0; -+ u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate( Rate ); -+ -+ if ( ( pAdapter->registrypriv.RegEnableTxPowerByRate == 2 && pHalData->EEPROMRegulatory == 2 ) || -+ pAdapter->registrypriv.RegEnableTxPowerByRate == 0 ) -+ return 0; -+ -+ if ( Band != BAND_ON_2_4G && Band != BAND_ON_5G ) -+ { -+ DBG_871X("Invalid band %d in %s\n", Band, __FUNCTION__ ); -+ return value; -+ } -+ if ( RFPath > ODM_RF_PATH_D ) -+ { -+ DBG_871X("Invalid RfPath %d in %s\n", RFPath, __FUNCTION__ ); -+ return value; -+ } -+ if ( TxNum >= RF_MAX_TX_NUM ) -+ { -+ DBG_871X("Invalid TxNum %d in %s\n", TxNum, __FUNCTION__ ); -+ return value; -+ } -+ if ( rateIndex >= TX_PWR_BY_RATE_NUM_RATE ) -+ { -+ DBG_871X("Invalid RateIndex %d in %s\n", rateIndex, __FUNCTION__ ); -+ return value; -+ } -+ -+ value = pHalData->TxPwrByRateOffset[Band][RFPath][TxNum][rateIndex]; -+ -+ return value; -+ -+} -+ -+VOID -+PHY_SetTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u8 Band, -+ IN u8 RFPath, -+ IN u8 TxNum, -+ IN u8 Rate, -+ IN s8 Value -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter ); -+ u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate( Rate ); -+ -+ if ( Band != BAND_ON_2_4G && Band != BAND_ON_5G ) -+ { -+ DBG_871X("Invalid band %d in %s\n", Band, __FUNCTION__ ); -+ return; -+ } -+ if ( RFPath > ODM_RF_PATH_D ) -+ { -+ DBG_871X("Invalid RfPath %d in %s\n", RFPath, __FUNCTION__ ); -+ return; -+ } -+ if ( TxNum >= RF_MAX_TX_NUM ) -+ { -+ DBG_871X( "Invalid TxNum %d in %s\n", TxNum, __FUNCTION__ ); -+ return; -+ } -+ if ( rateIndex >= TX_PWR_BY_RATE_NUM_RATE ) -+ { -+ DBG_871X("Invalid RateIndex %d in %s\n", rateIndex, __FUNCTION__ ); -+ return; -+ } -+ -+ pHalData->TxPwrByRateOffset[Band][RFPath][TxNum][rateIndex] = Value; -+} -+ -+VOID -+PHY_SetTxPowerLevelByPath( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN u8 path ++rtl8812_InitHalDm( ++ PADAPTER Adapter + ) +{ + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ BOOLEAN bIsIn24G = (pHalData->CurrentBandType == BAND_ON_2_4G ); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ u8 i; + -+ //if ( pMgntInfo->RegNByteAccess == 0 ) -+ { -+ if ( bIsIn24G ) -+ PHY_SetTxPowerIndexByRateSection( Adapter, path, channel, CCK ); -+ -+ PHY_SetTxPowerIndexByRateSection( Adapter, path, channel, OFDM ); -+ PHY_SetTxPowerIndexByRateSection( Adapter, path, channel, HT_MCS0_MCS7 ); ++ dm_InitGPIOSetting(Adapter); + -+ if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter)) -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, VHT_1SSMCS0_1SSMCS9); ++ pdmpriv->DM_Type = DM_Type_ByDriver; ++ pdmpriv->DMFlag = DYNAMIC_FUNC_DISABLE; + -+ if (pHalData->NumTotalRFPath >= 2) -+ { -+ PHY_SetTxPowerIndexByRateSection( Adapter, path, channel, HT_MCS8_MCS15 ); ++ Update_ODM_ComInfo_8812(Adapter); ++ ODM_DMInit(pDM_Odm); + -+ if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter)) -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, VHT_2SSMCS0_2SSMCS9); ++ Adapter->fix_rate = 0xFF; + -+ if (IS_HARDWARE_TYPE_8814A(Adapter)) -+ { -+ PHY_SetTxPowerIndexByRateSection( Adapter, path, channel, HT_MCS16_MCS23 ); -+ PHY_SetTxPowerIndexByRateSection( Adapter, path, channel, VHT_3SSMCS0_3SSMCS9 ); -+ } -+ } -+ } +} + -+VOID -+PHY_SetTxPowerIndexByRateArray( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel, -+ IN u8* Rates, -+ IN u8 RateArraySize ++ ++void ++rtl8812_HalDmWatchDog( ++ PADAPTER Adapter + ) +{ -+ u32 powerIndex = 0; -+ int i = 0; ++ bool bFwCurrentInPSMode = false; ++ bool bFwPSAwake = true; ++ u8 hw_init_completed = false; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++#ifdef CONFIG_CONCURRENT_MODE ++ PADAPTER pbuddy_adapter = Adapter->pbuddy_adapter; ++#endif //CONFIG_CONCURRENT_MODE + -+ for (i = 0; i < RateArraySize; ++i) ++ ++ ++ hw_init_completed = Adapter->hw_init_completed; ++ ++ if (hw_init_completed == false) ++ goto skip_dm; ++ ++#ifdef CONFIG_LPS ++ #ifdef CONFIG_CONCURRENT_MODE ++ if (Adapter->iface_type != IFACE_PORT0 && pbuddy_adapter) { ++ bFwCurrentInPSMode = pbuddy_adapter->pwrctrlpriv.bFwCurrentInPSMode; ++ rtw_hal_get_hwreg(pbuddy_adapter, HW_VAR_FWLPS_RF_ON, (u8 *)(&bFwPSAwake)); ++ } else ++ #endif //CONFIG_CONCURRENT_MODE + { -+ powerIndex = PHY_GetTxPowerIndex(pAdapter, RFPath, Rates[i], BandWidth, Channel); -+ PHY_SetTxPowerIndex(pAdapter, powerIndex, RFPath, Rates[i]); ++ bFwCurrentInPSMode = Adapter->pwrctrlpriv.bFwCurrentInPSMode; ++ rtw_hal_get_hwreg(Adapter, HW_VAR_FWLPS_RF_ON, (u8 *)(&bFwPSAwake)); + } -+} ++#endif + -+s8 -+phy_GetWorldWideLimit( -+ s8* LimitTable -+) -+{ -+ s8 min = LimitTable[0]; -+ u8 i = 0; -+ -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) { -+ if (LimitTable[i] < min) -+ min = LimitTable[i]; -+ } ++#ifdef CONFIG_P2P_PS ++ // Fw is under p2p powersaving mode, driver should stop dynamic mechanism. ++ // modifed by thomas. 2011.06.11. ++ if(Adapter->wdinfo.p2p_ps_mode) ++ bFwPSAwake = false; ++#endif //CONFIG_P2P_PS + -+ return min; -+} -+ -+s8 -+phy_GetChannelIndexOfTxPowerLimit( -+ IN u8 Band, -+ IN u8 Channel -+ ) -+{ -+ s8 channelIndex = -1; -+ u8 i = 0; -+ -+ if (Band == BAND_ON_2_4G) { -+ channelIndex = Channel - 1; -+ } else if (Band == BAND_ON_5G) { -+ for (i = 0; i < CENTER_CH_5G_ALL_NUM; ++i) { -+ if (center_ch_5g_all[i] == Channel) -+ channelIndex = i; -+ } -+ } else { -+ DBG_871X_LEVEL(_drv_always_, "Invalid Band %d in %s\n", Band, __func__); -+ } -+ -+ if (channelIndex == -1) -+ DBG_871X_LEVEL(_drv_always_, "Invalid Channel %d of Band %d in %s\n", Channel, Band, __func__); -+ -+ return channelIndex; -+} -+ -+s8 -+PHY_GetTxPowerLimit( -+ IN PADAPTER Adapter, -+ IN u32 RegPwrTblSel, -+ IN BAND_TYPE Band, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 RfPath, -+ IN u8 DataRate, -+ IN u8 Channel -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ s16 band = -1, regulation = -1, bandwidth = -1, -+ rateSection = -1, channel = -1; -+ s8 powerLimit = MAX_POWER_INDEX; -+ -+ if ( ( Adapter->registrypriv.RegEnableTxPowerLimit == 2 && pHalData->EEPROMRegulatory != 1 ) || -+ Adapter->registrypriv.RegEnableTxPowerLimit == 0 ) -+ return MAX_POWER_INDEX; -+ -+ switch (RegPwrTblSel) { -+ case 1: -+ regulation = TXPWR_LMT_ETSI; -+ break; -+ case 2: -+ regulation = TXPWR_LMT_MKK; -+ break; -+ case 3: -+ regulation = TXPWR_LMT_FCC; -+ break; -+ case 4: -+ regulation = TXPWR_LMT_WW; -+ break; -+ default: -+ regulation = (Band == BAND_ON_2_4G) ? pHalData->Regulation2_4G : pHalData->Regulation5G; -+ break; -+ } -+ -+ //DBG_871X("pMgntInfo->RegPwrTblSel %d, final regulation %d\n", Adapter->registrypriv.RegPwrTblSel, regulation ); -+ -+ -+ if ( Band == BAND_ON_2_4G ) band = 0; -+ else if ( Band == BAND_ON_5G ) band = 1; -+ -+ if ( Bandwidth == CHANNEL_WIDTH_20 ) bandwidth = 0; -+ else if ( Bandwidth == CHANNEL_WIDTH_40 ) bandwidth = 1; -+ else if ( Bandwidth == CHANNEL_WIDTH_80 ) bandwidth = 2; -+ else if ( Bandwidth == CHANNEL_WIDTH_160 ) bandwidth = 3; -+ -+ switch ( DataRate ) ++ if( (hw_init_completed == true) ++ && ((!bFwCurrentInPSMode) && bFwPSAwake)) + { -+ case MGN_1M: case MGN_2M: case MGN_5_5M: case MGN_11M: -+ rateSection = 0; -+ break; ++ // ++ // Calculate Tx/Rx statistics. ++ // ++ dm_CheckStatistics(Adapter); + -+ case MGN_6M: case MGN_9M: case MGN_12M: case MGN_18M: -+ case MGN_24M: case MGN_36M: case MGN_48M: case MGN_54M: -+ rateSection = 1; -+ break; -+ -+ case MGN_MCS0: case MGN_MCS1: case MGN_MCS2: case MGN_MCS3: -+ case MGN_MCS4: case MGN_MCS5: case MGN_MCS6: case MGN_MCS7: -+ rateSection = 2; -+ break; -+ -+ case MGN_MCS8: case MGN_MCS9: case MGN_MCS10: case MGN_MCS11: -+ case MGN_MCS12: case MGN_MCS13: case MGN_MCS14: case MGN_MCS15: -+ rateSection = 3; -+ break; -+ -+ case MGN_MCS16: case MGN_MCS17: case MGN_MCS18: case MGN_MCS19: -+ case MGN_MCS20: case MGN_MCS21: case MGN_MCS22: case MGN_MCS23: -+ rateSection = 4; -+ break; -+ -+ case MGN_MCS24: case MGN_MCS25: case MGN_MCS26: case MGN_MCS27: -+ case MGN_MCS28: case MGN_MCS29: case MGN_MCS30: case MGN_MCS31: -+ rateSection = 5; -+ break; -+ -+ case MGN_VHT1SS_MCS0: case MGN_VHT1SS_MCS1: case MGN_VHT1SS_MCS2: -+ case MGN_VHT1SS_MCS3: case MGN_VHT1SS_MCS4: case MGN_VHT1SS_MCS5: -+ case MGN_VHT1SS_MCS6: case MGN_VHT1SS_MCS7: case MGN_VHT1SS_MCS8: -+ case MGN_VHT1SS_MCS9: -+ rateSection = 6; -+ break; -+ -+ case MGN_VHT2SS_MCS0: case MGN_VHT2SS_MCS1: case MGN_VHT2SS_MCS2: -+ case MGN_VHT2SS_MCS3: case MGN_VHT2SS_MCS4: case MGN_VHT2SS_MCS5: -+ case MGN_VHT2SS_MCS6: case MGN_VHT2SS_MCS7: case MGN_VHT2SS_MCS8: -+ case MGN_VHT2SS_MCS9: -+ rateSection = 7; -+ break; -+ -+ case MGN_VHT3SS_MCS0: case MGN_VHT3SS_MCS1: case MGN_VHT3SS_MCS2: -+ case MGN_VHT3SS_MCS3: case MGN_VHT3SS_MCS4: case MGN_VHT3SS_MCS5: -+ case MGN_VHT3SS_MCS6: case MGN_VHT3SS_MCS7: case MGN_VHT3SS_MCS8: -+ case MGN_VHT3SS_MCS9: -+ rateSection = 8; -+ break; -+ -+ case MGN_VHT4SS_MCS0: case MGN_VHT4SS_MCS1: case MGN_VHT4SS_MCS2: -+ case MGN_VHT4SS_MCS3: case MGN_VHT4SS_MCS4: case MGN_VHT4SS_MCS5: -+ case MGN_VHT4SS_MCS6: case MGN_VHT4SS_MCS7: case MGN_VHT4SS_MCS8: -+ case MGN_VHT4SS_MCS9: -+ rateSection = 9; -+ break; -+ -+ default: -+ DBG_871X("Wrong rate 0x%x\n", DataRate ); -+ break; ++ // ++ // Dynamically switch RTS/CTS protection. ++ // + } + -+ if ( Band == BAND_ON_5G && rateSection == 0 ) -+ DBG_871X("Wrong rate 0x%x: No CCK in 5G Band\n", DataRate ); -+ -+ // workaround for wrong index combination to obtain tx power limit, -+ // OFDM only exists in BW 20M -+ if ( rateSection == 1 ) -+ bandwidth = 0; -+ -+ // workaround for wrong index combination to obtain tx power limit, -+ // CCK table will only be given in BW 20M -+ if ( rateSection == 0 ) -+ bandwidth = 0; -+ -+ // workaround for wrong indxe combination to obtain tx power limit, -+ // HT on 80M will reference to HT on 40M -+ if ( ( rateSection == 2 || rateSection == 3 ) && Band == BAND_ON_5G && bandwidth == 2 ) { -+ bandwidth = 1; -+ } -+ -+ if ( Band == BAND_ON_2_4G ) -+ channel = phy_GetChannelIndexOfTxPowerLimit( BAND_ON_2_4G, Channel ); -+ else if ( Band == BAND_ON_5G ) -+ channel = phy_GetChannelIndexOfTxPowerLimit( BAND_ON_5G, Channel ); -+ else if ( Band == BAND_ON_BOTH ) ++ //ODM ++ if (hw_init_completed == true) + { -+ // BAND_ON_BOTH don't care temporarily -+ } -+ -+ if ( band == -1 || regulation == -1 || bandwidth == -1 || -+ rateSection == -1 || channel == -1 ) -+ { -+ //DBG_871X("Wrong index value to access power limit table [band %d][regulation %d][bandwidth %d][rf_path %d][rate_section %d][chnlGroup %d]\n", -+ // band, regulation, bandwidth, RfPath, rateSection, channelGroup ); ++ u8 bLinked=false; ++ ++ #ifdef CONFIG_DISABLE_ODM ++ pHalData->odmpriv.SupportAbility = 0; ++ #endif ++ ++ if(rtw_linked_check(Adapter)) ++ bLinked = true; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if(pbuddy_adapter && rtw_linked_check(pbuddy_adapter)) ++ bLinked = true; ++#endif //CONFIG_CONCURRENT_MODE ++ ++ ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_LINK, bLinked); ++ ODM_DMWatchdog(&pHalData->odmpriv); + -+ return MAX_POWER_INDEX; + } + -+ if ( Band == BAND_ON_2_4G ) { -+ s8 limits[10] = {0}; u8 i = 0; -+ if (bandwidth >= MAX_2_4G_BANDWIDTH_NUM) -+ bandwidth = MAX_2_4G_BANDWIDTH_NUM - 1; -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) -+ limits[i] = pHalData->TxPwrLimit_2_4G[i][bandwidth][rateSection][channel][RfPath]; ++skip_dm: + -+ powerLimit = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : -+ pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channel][RfPath]; -+ -+ } else if ( Band == BAND_ON_5G ) { -+ s8 limits[10] = {0}; u8 i = 0; -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) -+ limits[i] = pHalData->TxPwrLimit_5G[i][bandwidth][rateSection][channel][RfPath]; -+ -+ powerLimit = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : -+ pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channel][RfPath]; -+ } else -+ DBG_871X("No power limit table of the specified band\n" ); -+ -+ // combine 5G VHT & HT rate -+ // 5G 20M and 40M HT and VHT can cross reference -+ /* -+ if ( Band == BAND_ON_5G && powerLimit == MAX_POWER_INDEX ) { -+ if ( bandwidth == 0 || bandwidth == 1 ) { -+ RT_TRACE( COMP_INIT, DBG_LOUD, ( "No power limit table of the specified band %d, bandwidth %d, ratesection %d, rf path %d\n", -+ band, bandwidth, rateSection, RfPath ) ); -+ if ( rateSection == 2 ) -+ powerLimit = pHalData->TxPwrLimit_5G[regulation] -+ [bandwidth][4][channelGroup][RfPath]; -+ else if ( rateSection == 4 ) -+ powerLimit = pHalData->TxPwrLimit_5G[regulation] -+ [bandwidth][2][channelGroup][RfPath]; -+ else if ( rateSection == 3 ) -+ powerLimit = pHalData->TxPwrLimit_5G[regulation] -+ [bandwidth][5][channelGroup][RfPath]; -+ else if ( rateSection == 5 ) -+ powerLimit = pHalData->TxPwrLimit_5G[regulation] -+ [bandwidth][3][channelGroup][RfPath]; -+ } -+ } -+ */ -+ //DBG_871X("TxPwrLmt[Regulation %d][Band %d][BW %d][RFPath %d][Rate 0x%x][Chnl %d] = %d\n", -+ // regulation, pHalData->CurrentBandType, Bandwidth, RfPath, DataRate, Channel, powerLimit); -+ return powerLimit; ++ // Check GPIO to determine current RF on/off and Pbc status. ++ // Check Hardware Radio ON/OFF or not ++ //temp removed ++ dm_CheckPbcGPIO(Adapter); +} + -+VOID -+phy_CrossReferenceHTAndVHTTxPowerLimit( -+ IN PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 regulation, bw, channel, rateSection; -+ s8 tempPwrLmt = 0; -+ -+ for ( regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation ) -+ { -+ for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; ++bw) -+ { -+ for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) -+ { -+ for ( rateSection = 0; rateSection < MAX_RATE_SECTION_NUM; ++rateSection ) -+ { -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation][bw][rateSection][channel][ODM_RF_PATH_A]; -+ if ( tempPwrLmt == MAX_POWER_INDEX ) -+ { -+ u8 baseSection = 2, refSection = 6; -+ if ( bw == 0 || bw == 1 ) { // 5G 20M 40M VHT and HT can cross reference -+ //DBG_871X("No power limit table of the specified band %d, bandwidth %d, ratesection %d, channel %d, rf path %d\n", -+ // 1, bw, rateSection, channel, ODM_RF_PATH_A ); -+ if ( rateSection >= 2 && rateSection <= 9 ) { -+ if ( rateSection == 2 ) -+ { -+ baseSection = 2; -+ refSection = 6; -+ } -+ else if ( rateSection == 3 ) -+ { -+ baseSection = 3; -+ refSection = 7; -+ } -+ else if ( rateSection == 4 ) -+ { -+ baseSection = 4; -+ refSection = 8; -+ } -+ else if ( rateSection == 5 ) -+ { -+ baseSection = 5; -+ refSection = 9; -+ } -+ else if ( rateSection == 6 ) -+ { -+ baseSection = 6; -+ refSection = 2; -+ } -+ else if ( rateSection == 7 ) -+ { -+ baseSection = 7; -+ refSection = 3; -+ } -+ else if ( rateSection == 8 ) -+ { -+ baseSection = 8; -+ refSection = 4; -+ } -+ else if ( rateSection == 9 ) -+ { -+ baseSection = 9; -+ refSection = 5; -+ } -+ pHalData->TxPwrLimit_5G[regulation][bw][baseSection][channel][ODM_RF_PATH_A] = -+ pHalData->TxPwrLimit_5G[regulation][bw][refSection][channel][ODM_RF_PATH_A]; -+ } -+ -+ //DBG_871X("use other value %d", tempPwrLmt ); -+ } -+ } -+ } -+ } -+ } -+ } -+} -+ -+VOID -+PHY_ConvertTxPowerLimitToPowerIndex( -+ IN PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 base; -+ u8 regulation, bw, channel, rateSection; -+ s8 tempValue = 0, tempPwrLmt = 0; -+ u8 rfPath = 0; -+ u8 tx_num; -+ -+ if (pHalData->odmpriv.PhyRegPgValueType != PHY_REG_PG_EXACT_VALUE) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ phy_CrossReferenceHTAndVHTTxPowerLimit(Adapter); -+ -+ for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) { -+ -+ for (bw = 0; bw < MAX_2_4G_BANDWIDTH_NUM; ++bw) { -+ -+ for (channel = 0; channel < CENTER_CH_2G_NUM; ++channel) { -+ -+ for (rateSection = CCK; rateSection <= HT_4SS; ++rateSection) { -+ tx_num = rate_section_to_tx_num(rateSection); -+ tempPwrLmt = pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][channel][RF_PATH_A]; -+ -+ if (tempPwrLmt != MAX_POWER_INDEX) { -+ -+ for (rfPath = RF_PATH_A; rfPath < MAX_RF_PATH; ++rfPath) { -+ -+ if (rtw_regsty_tx_power_by_rate_base_valid(Adapter) == _TRUE) -+ base = rtw_regsty_get_tx_power_by_rate_base(Adapter, BAND_ON_2_4G, rfPath, tx_num, rateSection); -+ else -+ base = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_2_4G, rfPath, tx_num, rateSection); -+ -+ tempValue = tempPwrLmt - base; -+ pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][channel][rfPath] = tempValue; -+ } -+ } -+ } -+ } -+ } -+ } -+ -+ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(Adapter)) { -+ -+ for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) { -+ -+ for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; ++bw) { -+ -+ for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { -+ -+ for (rateSection = OFDM; rateSection <= VHT_4SS; ++rateSection) { -+ tx_num = rate_section_to_tx_num(rateSection); -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation][bw][rateSection][channel][RF_PATH_A]; -+ -+ if (tempPwrLmt != MAX_POWER_INDEX) { -+ -+ for (rfPath = RF_PATH_A; rfPath < MAX_RF_PATH; ++rfPath) { -+ -+ if (rtw_regsty_tx_power_by_rate_base_valid(Adapter) == _TRUE) -+ base = rtw_regsty_get_tx_power_by_rate_base(Adapter, BAND_ON_5G, rfPath, tx_num, rateSection); -+ else -+ base = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_5G, rfPath, tx_num, rateSection); -+ -+ tempValue = tempPwrLmt - base; -+ pHalData->TxPwrLimit_5G[regulation][bw][rateSection][channel][rfPath] = tempValue; -+ } -+ } -+ } -+ } -+ } -+ } -+ } -+} -+ -+/* -+* PHY_InitTxPowerLimit - Set all hal_data.TxPwrLimit_2_4G, TxPwrLimit_5G array to MAX_POWER_INDEX -+*/ -+VOID -+PHY_InitTxPowerLimit( -+ IN PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 i, j, k, l, m; -+ -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) -+ for (j = 0; j < MAX_2_4G_BANDWIDTH_NUM; ++j) -+ for (k = 0; k < MAX_RATE_SECTION_NUM; ++k) -+ for (m = 0; m < CENTER_CH_2G_NUM; ++m) -+ for (l = 0; l < MAX_RF_PATH; ++l) -+ pHalData->TxPwrLimit_2_4G[i][j][k][m][l] = MAX_POWER_INDEX; -+ -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) -+ for (j = 0; j < MAX_5G_BANDWIDTH_NUM; ++j) -+ for (k = 0; k < MAX_RATE_SECTION_NUM; ++k) -+ for (m = 0; m < CENTER_CH_5G_ALL_NUM; ++m) -+ for (l = 0; l < MAX_RF_PATH; ++l) -+ pHalData->TxPwrLimit_5G[i][j][k][m][l] = MAX_POWER_INDEX; -+} -+ -+VOID -+PHY_SetTxPowerLimit( -+ IN PDM_ODM_T pDM_Odm, -+ IN u8 *Regulation, -+ IN u8 *Band, -+ IN u8 *Bandwidth, -+ IN u8 *RateSection, -+ IN u8 *RfPath, -+ IN u8 *Channel, -+ IN u8 *PowerLimit -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA( Adapter ); -+ u8 regulation=0, bandwidth=0, rateSection=0, -+ channel; -+ s8 powerLimit = 0, prevPowerLimit, channelIndex; -+ -+ //DBG_871X( "Index of power limit table [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s][val %s]\n", -+ // Band, Regulation, Bandwidth, RateSection, RfPath, Channel, PowerLimit ); -+ -+ if ( !GetU1ByteIntegerFromStringInDecimal( (s8 *)Channel, &channel ) || -+ !GetU1ByteIntegerFromStringInDecimal( (s8 *)PowerLimit, &powerLimit ) ) -+ { -+ DBG_871X("Illegal index of power limit table [chnl %s][val %s]\n", Channel, PowerLimit ); -+ } -+ -+ powerLimit = powerLimit > MAX_POWER_INDEX ? MAX_POWER_INDEX : powerLimit; -+ -+ if ( eqNByte( Regulation, (u8 *)("FCC"), 3 ) ) regulation = 0; -+ else if ( eqNByte( Regulation, (u8 *)("MKK"), 3 ) ) regulation = 1; -+ else if ( eqNByte( Regulation, (u8 *)("ETSI"), 4 ) ) regulation = 2; -+ else if ( eqNByte( Regulation, (u8 *)("WW13"), 4 ) ) regulation = 3; -+ -+ if ( eqNByte( RateSection, (u8 *)("CCK"), 3 ) && eqNByte( RfPath, (u8 *)("1T"), 2 ) ) -+ rateSection = 0; -+ else if ( eqNByte( RateSection, (u8 *)("OFDM"), 4 ) && eqNByte( RfPath, (u8 *)("1T"), 2 ) ) -+ rateSection = 1; -+ else if ( eqNByte( RateSection, (u8 *)("HT"), 2 ) && eqNByte( RfPath, (u8 *)("1T"), 2 ) ) -+ rateSection = 2; -+ else if ( eqNByte( RateSection, (u8 *)("HT"), 2 ) && eqNByte( RfPath, (u8 *)("2T"), 2 ) ) -+ rateSection = 3; -+ else if ( eqNByte( RateSection, (u8 *)("HT"), 2 ) && eqNByte( RfPath, (u8 *)("3T"), 2 ) ) -+ rateSection = 4; -+ else if ( eqNByte( RateSection, (u8 *)("HT"), 2 ) && eqNByte( RfPath, (u8 *)("4T"), 2 ) ) -+ rateSection = 5; -+ else if ( eqNByte( RateSection, (u8 *)("VHT"), 3 ) && eqNByte( RfPath, (u8 *)("1T"), 2 ) ) -+ rateSection = 6; -+ else if ( eqNByte( RateSection, (u8 *)("VHT"), 3 ) && eqNByte( RfPath, (u8 *)("2T"), 2 ) ) -+ rateSection = 7; -+ else if ( eqNByte( RateSection, (u8 *)("VHT"), 3 ) && eqNByte( RfPath, (u8 *)("3T"), 2 ) ) -+ rateSection = 8; -+ else if ( eqNByte( RateSection, (u8 *)("VHT"), 3 ) && eqNByte( RfPath, (u8 *)("4T"), 2 ) ) -+ rateSection = 9; -+ else -+ { -+ DBG_871X("Wrong rate section!\n"); -+ return; -+ } -+ -+ -+ if ( eqNByte( Bandwidth, (u8 *)("20M"), 3 ) ) bandwidth = 0; -+ else if ( eqNByte( Bandwidth, (u8 *)("40M"), 3 ) ) bandwidth = 1; -+ else if ( eqNByte( Bandwidth, (u8 *)("80M"), 3 ) ) bandwidth = 2; -+ else if ( eqNByte( Bandwidth, (u8 *)("160M"), 4 ) ) bandwidth = 3; -+ -+ if ( eqNByte( Band, (u8 *)("2.4G"), 4 ) ) -+ { -+ channelIndex = phy_GetChannelIndexOfTxPowerLimit( BAND_ON_2_4G, channel ); -+ -+ if ( channelIndex == -1 ) -+ return; -+ -+ if (bandwidth >= MAX_2_4G_BANDWIDTH_NUM) -+ bandwidth = MAX_2_4G_BANDWIDTH_NUM - 1; -+ -+ prevPowerLimit = pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A]; -+ -+ if ( powerLimit < prevPowerLimit ) -+ pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A] = powerLimit; -+ -+ //DBG_871X( "2.4G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n", -+ // regulation, bandwidth, rateSection, channelIndex, pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A] ); -+ } -+ else if ( eqNByte( Band, (u8 *)("5G"), 2 ) ) -+ { -+ channelIndex = phy_GetChannelIndexOfTxPowerLimit( BAND_ON_5G, channel ); -+ -+ if ( channelIndex == -1 ) -+ return; -+ -+ prevPowerLimit = pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A]; -+ -+ if ( powerLimit < prevPowerLimit ) -+ pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A] = powerLimit; -+ -+ //DBG_871X( "5G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n", -+ // regulation, bandwidth, rateSection, channel, pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A] ); -+ } -+ else -+ { -+ DBG_871X("Cannot recognize the band info in %s\n", Band ); -+ return; -+ } -+} -+ -+u8 -+PHY_GetTxPowerIndex( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel -+ ) -+{ -+ u8 txPower = 0x3E; -+ -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) { -+#if (RTL8814A_SUPPORT == 1) -+ txPower = PHY_GetTxPowerIndex_8814A(pAdapter, RFPath, Rate, BandWidth, Channel); -+#endif -+ } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) { -+#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -+ txPower = PHY_GetTxPowerIndex_8812A(pAdapter, RFPath, Rate, BandWidth, Channel); -+#endif -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -+#if (RTL8723B_SUPPORT == 1) -+ txPower = PHY_GetTxPowerIndex_8723B(pAdapter, RFPath, Rate, BandWidth, Channel); -+#endif -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { -+#if (RTL8703B_SUPPORT == 1) -+ txPower = PHY_GetTxPowerIndex_8703B(pAdapter, RFPath, Rate, BandWidth, Channel); -+#endif -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { -+#if (RTL8192E_SUPPORT==1) -+ txPower = PHY_GetTxPowerIndex_8192E(pAdapter, RFPath, Rate, BandWidth, Channel); -+#endif -+ } -+ else if (IS_HARDWARE_TYPE_8188E(pAdapter)) { -+#if (RTL8188E_SUPPORT==1) -+ txPower = PHY_GetTxPowerIndex_8188E(pAdapter, RFPath, Rate, BandWidth, Channel); -+#endif -+ } else if (IS_HARDWARE_TYPE_8188F(pAdapter)) { -+#if (RTL8188F_SUPPORT == 1) -+ txPower = PHY_GetTxPowerIndex_8188F(pAdapter, RFPath, Rate, BandWidth, Channel); -+#endif -+ } -+ -+ return txPower; -+} -+ -+VOID -+PHY_SetTxPowerIndex( -+ IN PADAPTER pAdapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+ ) -+{ -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) { -+#if (RTL8814A_SUPPORT == 1) -+ PHY_SetTxPowerIndex_8814A(pAdapter, PowerIndex, RFPath, Rate); -+#endif -+ } -+ else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) { -+#if ((RTL8812A_SUPPORT==1) || (RTL8821A_SUPPORT == 1)) -+ PHY_SetTxPowerIndex_8812A( pAdapter, PowerIndex, RFPath, Rate ); -+#endif -+ } -+ else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -+#if (RTL8723B_SUPPORT==1) -+ PHY_SetTxPowerIndex_8723B( pAdapter, PowerIndex, RFPath, Rate ); -+#endif -+ } -+ else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { -+#if (RTL8703B_SUPPORT==1) -+ PHY_SetTxPowerIndex_8703B( pAdapter, PowerIndex, RFPath, Rate ); -+#endif -+ } -+ else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { -+#if (RTL8192E_SUPPORT==1) -+ PHY_SetTxPowerIndex_8192E( pAdapter, PowerIndex, RFPath, Rate ); -+#endif -+ } -+ else if (IS_HARDWARE_TYPE_8188E(pAdapter)) { -+#if (RTL8188E_SUPPORT==1) -+ PHY_SetTxPowerIndex_8188E( pAdapter, PowerIndex, RFPath, Rate ); -+#endif -+ } else if (IS_HARDWARE_TYPE_8188F(pAdapter)) { -+#if (RTL8188F_SUPPORT == 1) -+ PHY_SetTxPowerIndex_8188F(pAdapter, PowerIndex, RFPath, Rate); -+#endif -+ } -+} -+ -+void dump_tx_power_by_rate_base(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ int path, tx_num, band, rs; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { -+ /* TODO: hal capbility to distinguish 2.4G/5G support */ -+ if (band == BAND_ON_5G && !(IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter) || IS_HARDWARE_TYPE_8192D(adapter))) -+ continue; -+ -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (path >= hal_data->NumTotalRFPath) -+ break; -+ -+ DBG_871X_SEL_NL(sel, "[%sG][%c]\n", (band == BAND_ON_2_4G ? "2.4" : "5"), rf_path_char(path)); -+ -+ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { -+ tx_num = rate_section_to_tx_num(rs); -+ if (tx_num >= hal_data->nss_num) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) -+ continue; -+ -+ DBG_871X_SEL_NL(sel, "%7s: %3d\n" -+ , rate_section_str(rs) -+ , PHY_GetTxPowerByRateBase(adapter, band, path, tx_num, rs) -+ ); -+ } -+ } -+ } -+} -+ -+void dump_tx_power_by_rate(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ int path, tx_num, band, n, rs; -+ u8 rate_num, max_rate_num, base; -+ s8 by_rate_offset; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { -+ /* TODO: hal capbility to distinguish 2.4G/5G support */ -+ if (band == BAND_ON_5G && !(IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter) || IS_HARDWARE_TYPE_8192D(adapter))) -+ continue; -+ -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (path >= hal_data->NumTotalRFPath) -+ break; -+ -+ DBG_871X_SEL_NL(sel, "[%sG][%c]\n", (band == BAND_ON_2_4G ? "2.4" : "5"), rf_path_char(path)); -+ -+ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { -+ tx_num = rate_section_to_tx_num(rs); -+ if (tx_num >= hal_data->nss_num) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) -+ continue; -+ -+ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) -+ max_rate_num = 10; -+ else -+ max_rate_num = 8; -+ rate_num = rate_section_rate_num(rs); -+ base = PHY_GetTxPowerByRateBase(adapter, band, path, tx_num, rs); -+ -+ DBG_871X_SEL_NL(sel, "%7s: ", rate_section_str(rs)); -+ -+ /* dump power by rate in db */ -+ for (n = rate_num - 1; n >= 0; n--) { -+ by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, tx_num, rates_by_sections[rs].rates[n]); -+ -+ if ((base + by_rate_offset) % 2) -+ DBG_871X_SEL(sel, "%2d.5 ", (base + by_rate_offset) / 2); -+ else -+ DBG_871X_SEL(sel, "%4d ", (base + by_rate_offset) / 2); -+ } -+ for (n = 0; n < max_rate_num - rate_num; n++) -+ DBG_871X_SEL(sel, "%4s ", ""); -+ -+ DBG_871X_SEL(sel, "|"); -+ -+ /* dump power by rate in offset */ -+ for (n = rate_num - 1; n >= 0; n--) { -+ by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, tx_num, rates_by_sections[rs].rates[n]); -+ DBG_871X_SEL(sel, "%3d ", by_rate_offset); -+ } -+ DBG_871X_SEL_NL(sel, "\n"); -+ -+ } -+ } -+ } -+} -+ -+void dump_tx_power_limit(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); -+ -+ int bw, band, ch_num, rs, i, path; -+ u8 ch, n, rd; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { -+ /* TODO: hal capbility to distinguish 2.4G/5G support */ -+ if (band == BAND_ON_5G && !(IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter) || IS_HARDWARE_TYPE_8192D(adapter))) -+ continue; -+ -+ rd = (band == BAND_ON_2_4G ? hal_data->Regulation2_4G : hal_data->Regulation5G); -+ -+ for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; bw++) { -+ /* TODO: hal capbility to distinguish bandwidth support */ -+ -+ if (bw >= CHANNEL_WIDTH_160) -+ break; -+ if (band == BAND_ON_2_4G && bw >= CHANNEL_WIDTH_80) -+ break; -+ -+ if (band == BAND_ON_2_4G) { -+ ch_num = CENTER_CH_2G_NUM; -+ } else { -+ if (bw == CHANNEL_WIDTH_20) -+ ch_num = CENTER_CH_5G_20M_NUM; -+ else if (bw == CHANNEL_WIDTH_40) -+ ch_num = CENTER_CH_5G_40M_NUM; -+ else -+ ch_num = CENTER_CH_5G_80M_NUM; -+ } -+ -+ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { -+ if (band == BAND_ON_2_4G && IS_VHT_RATE_SECTION(rs)) -+ continue; -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ if (bw > CHANNEL_WIDTH_20 && (IS_CCK_RATE_SECTION(rs) || IS_OFDM_RATE_SECTION(rs))) -+ continue; -+ if (bw > CHANNEL_WIDTH_40 && IS_HT_RATE_SECTION(rs)) -+ continue; -+ -+ if (rate_section_to_tx_num(rs) >= hal_data->nss_num) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) -+ continue; -+ -+ DBG_871X_SEL_NL(sel, "[%sG][%s][%s]\n" -+ , (band == BAND_ON_2_4G ? "2.4" : "5") -+ , ch_width_str(bw) -+ , rate_section_str(rs) -+ ); -+ -+ /* header for limit in db */ -+ DBG_871X_SEL_NL(sel, "%3s %5s %5s %5s %5s " -+ , "ch" -+ , (rd == TXPWR_LMT_FCC ? "*FCC" : "FCC") -+ , (rd == TXPWR_LMT_ETSI ? "*ETSI" : "ETSI") -+ , (rd == TXPWR_LMT_MKK ? "*MKK" : "MKK") -+ , (rd == TXPWR_LMT_WW ? "*WW" : "WW") -+ ); -+ -+ /* header for limit offset */ -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (path >= hal_data->NumTotalRFPath) -+ break; -+ DBG_871X_SEL(sel, "|%3c %3c %3c %3c " -+ , (rd == TXPWR_LMT_FCC ? rf_path_char(path) : ' ') -+ , (rd == TXPWR_LMT_ETSI ? rf_path_char(path) : ' ') -+ , (rd == TXPWR_LMT_MKK ? rf_path_char(path) : ' ') -+ , (rd == TXPWR_LMT_WW ? rf_path_char(path) : ' ') -+ ); -+ } -+ DBG_871X_SEL(sel, "\n"); -+ -+ for (n = 0; n < ch_num; n++) { -+ s8 limit_idx[RF_PATH_MAX][MAX_REGULATION_NUM]; -+ s8 limit_offset[MAX_REGULATION_NUM]; -+ u8 base; -+ -+ if (band == BAND_ON_2_4G) { -+ ch = n + 1; -+ } else { -+ if (bw == CHANNEL_WIDTH_20) -+ ch = center_ch_5g_20m[n]; -+ else if (bw == CHANNEL_WIDTH_40) -+ ch = center_ch_5g_40m[n]; -+ else -+ ch = center_ch_5g_80m[n]; -+ } -+ -+ /* dump limit in db (calculate from path A) */ -+ limit_offset[0] = PHY_GetTxPowerLimit(adapter, 3, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* FCC */ -+ limit_offset[1] = PHY_GetTxPowerLimit(adapter, 1, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* ETSI */ -+ limit_offset[2] = PHY_GetTxPowerLimit(adapter, 2, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* MKK */ -+ limit_offset[3] = PHY_GetTxPowerLimit(adapter, 4, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* WW */ -+ -+ base = PHY_GetTxPowerByRateBase(adapter, band, RF_PATH_A, rate_section_to_tx_num(rs), rs); -+ -+ DBG_871X_SEL_NL(sel, "%3u ", ch); -+ for (i = 0; i < MAX_REGULATION_NUM; i++) { -+ if (limit_offset[i] == MAX_POWER_INDEX) { -+ limit_idx[0][i] = MAX_POWER_INDEX; -+ DBG_871X_SEL(sel, "%5s ", "NA"); -+ } else { -+ limit_idx[0][i] = limit_offset[i] + base; -+ if ((limit_offset[i] + base) % 2) -+ DBG_871X_SEL(sel, "%3d.5 ", (limit_offset[i] + base) / 2); -+ else -+ DBG_871X_SEL(sel, "%5d ", (limit_offset[i] + base) / 2); -+ } -+ } -+ -+ /* dump limit offset of each path */ -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (path >= hal_data->NumTotalRFPath) -+ break; -+ limit_offset[0] = PHY_GetTxPowerLimit(adapter, 3, band, bw, path, rates_by_sections[rs].rates[0], ch); /* FCC */ -+ limit_offset[1] = PHY_GetTxPowerLimit(adapter, 1, band, bw, path, rates_by_sections[rs].rates[0], ch); /* ETSI */ -+ limit_offset[2] = PHY_GetTxPowerLimit(adapter, 2, band, bw, path, rates_by_sections[rs].rates[0], ch); /* MKK */ -+ limit_offset[3] = PHY_GetTxPowerLimit(adapter, 4, band, bw, path, rates_by_sections[rs].rates[0], ch); /* WW */ -+ -+ base = PHY_GetTxPowerByRateBase(adapter, band, path, rate_section_to_tx_num(rs), rs); -+ -+ DBG_871X_SEL(sel, "|"); -+ for (i = 0; i < MAX_REGULATION_NUM; i++) { -+ if (limit_offset[i] == MAX_POWER_INDEX) { -+ limit_idx[path][i] = MAX_POWER_INDEX; -+ DBG_871X_SEL(sel, "%3s ", "NA"); -+ } else { -+ limit_idx[path][i] = limit_offset[i] + base; -+ DBG_871X_SEL(sel, "%3d ", limit_offset[i]); -+ } -+ } -+ } -+ -+ /* compare limit_idx of each path, print 'x' when mismatch */ -+ if (hal_data->NumTotalRFPath > 1) { -+ for (i = 0; i < MAX_REGULATION_NUM; i++) { -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (path >= hal_data->NumTotalRFPath) -+ break; -+ if (limit_idx[path][i] != limit_idx[(path + 1) % hal_data->NumTotalRFPath][i]) -+ break; -+ } -+ if (path >= hal_data->NumTotalRFPath) -+ DBG_871X_SEL(sel, " "); -+ else -+ DBG_871X_SEL(sel, "x"); -+ } -+ } -+ DBG_871X_SEL(sel, "\n"); -+ -+ } -+ DBG_871X_SEL_NL(sel, "\n"); -+ } -+ } -+ } -+} -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+int -+phy_ConfigMACWithParaFile( -+ IN PADAPTER Adapter, -+ IN char* pFileName -+) ++void rtl8812_init_dm_priv(PADAPTER Adapter) +{ + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegValue, u4bMove; -+ -+ if(!(Adapter->registrypriv.load_phy_file & LOAD_MAC_PARA_FILE)) -+ return rtStatus; -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pHalData->mac_reg_len == 0) && (pHalData->mac_reg == NULL)) -+ { -+ rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) -+ { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) -+ { -+ rtStatus = _SUCCESS; -+ pHalData->mac_reg = rtw_zvmalloc(rlen); -+ if(pHalData->mac_reg) { -+ _rtw_memcpy(pHalData->mac_reg, pHalData->para_file_buf, rlen); -+ pHalData->mac_reg_len = rlen; -+ } -+ else { -+ DBG_871X("%s mac_reg alloc fail !\n",__FUNCTION__); -+ } -+ } -+ } -+ } -+ else -+ { -+ if ((pHalData->mac_reg_len != 0) && (pHalData->mac_reg != NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pHalData->mac_reg, pHalData->mac_reg_len); -+ rtStatus = _SUCCESS; -+ } -+ else { -+ DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__); -+ } -+ } -+ -+ if (rtStatus == _SUCCESS) -+ { -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) -+ { -+ if(!IsCommentString(szLine)) -+ { -+ // Get 1st hex value as register offset -+ if(GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) -+ { -+ if(u4bRegOffset == 0xffff) -+ { // Ending. -+ break; -+ } -+ -+ // Get 2nd hex value as register value. -+ szLine += u4bMove; -+ if(GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) -+ { -+ rtw_write8(Adapter, u4bRegOffset, (u8)u4bRegValue); -+ } -+ } -+ } -+ } -+ } -+ else -+ { -+ DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+ } -+ -+ return rtStatus; -+} -+ -+int -+phy_ConfigBBWithParaFile( -+ IN PADAPTER Adapter, -+ IN char* pFileName, -+ IN u32 ConfigType -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegValue, u4bMove; -+ char *pBuf = NULL; -+ u32 *pBufLen = NULL; -+ -+ if(!(Adapter->registrypriv.load_phy_file & LOAD_BB_PARA_FILE)) -+ return rtStatus; -+ -+ switch(ConfigType) -+ { -+ case CONFIG_BB_PHY_REG: -+ pBuf = pHalData->bb_phy_reg; -+ pBufLen = &pHalData->bb_phy_reg_len; -+ break; -+ case CONFIG_BB_AGC_TAB: -+ pBuf = pHalData->bb_agc_tab; -+ pBufLen = &pHalData->bb_agc_tab_len; -+ break; -+ default: -+ DBG_871X("Unknown ConfigType!! %d\r\n", ConfigType); -+ break; -+ } -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) -+ { -+ rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) -+ { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) -+ { -+ rtStatus = _SUCCESS; -+ pBuf = rtw_zvmalloc(rlen); -+ if(pBuf) { -+ _rtw_memcpy(pBuf, pHalData->para_file_buf, rlen); -+ *pBufLen = rlen; -+ -+ switch(ConfigType) -+ { -+ case CONFIG_BB_PHY_REG: -+ pHalData->bb_phy_reg = pBuf; -+ break; -+ case CONFIG_BB_AGC_TAB: -+ pHalData->bb_agc_tab = pBuf; -+ break; -+ } -+ } -+ else { -+ DBG_871X("%s(): ConfigType %d alloc fail !\n",__FUNCTION__,ConfigType); -+ } -+ } -+ } -+ } -+ else -+ { -+ if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pBuf, *pBufLen); -+ rtStatus = _SUCCESS; -+ } -+ else { -+ DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__); -+ } -+ } -+ -+ if (rtStatus == _SUCCESS) -+ { -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) -+ { -+ if(!IsCommentString(szLine)) -+ { -+ // Get 1st hex value as register offset. -+ if(GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) -+ { -+ if(u4bRegOffset == 0xffff) -+ { // Ending. -+ break; -+ } -+ else if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) -+ { -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ rtw_msleep_os(50); -+ #else -+ rtw_mdelay_os(50); -+ #endif -+ } -+ else if (u4bRegOffset == 0xfd) -+ { -+ rtw_mdelay_os(5); -+ } -+ else if (u4bRegOffset == 0xfc) -+ { -+ rtw_mdelay_os(1); -+ } -+ else if (u4bRegOffset == 0xfb) -+ { -+ rtw_udelay_os(50); -+ } -+ else if (u4bRegOffset == 0xfa) -+ { -+ rtw_udelay_os(5); -+ } -+ else if (u4bRegOffset == 0xf9) -+ { -+ rtw_udelay_os(1); -+ } -+ -+ // Get 2nd hex value as register value. -+ szLine += u4bMove; -+ if(GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) -+ { -+ //DBG_871X("[BB-ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue); -+ PHY_SetBBReg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); -+ -+ if (u4bRegOffset == 0xa24) -+ pHalData->odmpriv.RFCalibrateInfo.RegA24 = u4bRegValue; -+ -+ // Add 1us delay between BB/RF register setting. -+ rtw_udelay_os(1); -+ } -+ } -+ } -+ } -+ } -+ else -+ { -+ DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+ } -+ -+ return rtStatus; -+} -+ -+VOID -+phy_DecryptBBPgParaFile( -+ PADAPTER Adapter, -+ char* buffer -+ ) -+{ -+ u32 i = 0, j = 0; -+ u8 map[95] = {0}; -+ u8 currentChar; -+ char *BufOfLines, *ptmp; -+ -+ //DBG_871X("=====>phy_DecryptBBPgParaFile()\n"); -+ // 32 the ascii code of the first visable char, 126 the last one -+ for ( i = 0; i < 95; ++i ) -+ map[i] = ( u8 ) ( 94 - i ); -+ -+ ptmp = buffer; -+ i = 0; -+ for (BufOfLines = GetLineFromBuffer(ptmp); BufOfLines != NULL; BufOfLines = GetLineFromBuffer(ptmp)) -+ { -+ //DBG_871X("Encrypted Line: %s\n", BufOfLines); -+ -+ for ( j = 0; j < strlen(BufOfLines); ++j ) -+ { -+ currentChar = BufOfLines[j]; -+ -+ if ( currentChar == '\0' ) -+ break; -+ -+ currentChar -= (u8) ( ( ( ( i + j ) * 3 ) % 128 ) ); -+ -+ BufOfLines[j] = map[currentChar - 32] + 32; -+ } -+ //DBG_871X("Decrypted Line: %s\n", BufOfLines ); -+ if (strlen(BufOfLines) != 0) -+ i++; -+ BufOfLines[strlen(BufOfLines)] = '\n'; -+ } -+} -+ -+int -+phy_ParseBBPgParaFile( -+ PADAPTER Adapter, -+ char* buffer -+ ) -+{ -+ int rtStatus = _SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegMask, u4bRegValue; -+ u32 u4bMove; -+ BOOLEAN firstLine = _TRUE; -+ u8 tx_num = 0; -+ u8 band = 0, rf_path = 0; -+ -+ //DBG_871X("=====>phy_ParseBBPgParaFile()\n"); -+ -+ if ( Adapter->registrypriv.RegDecryptCustomFile == 1 ) -+ phy_DecryptBBPgParaFile( Adapter, buffer); -+ -+ ptmp = buffer; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) -+ { -+ if(!IsCommentString(szLine)) -+ { -+ if( isAllSpaceOrTab( szLine, sizeof( *szLine ) ) ) -+ continue; -+ -+ // Get header info (relative value or exact value) -+ if ( firstLine ) -+ { -+ if ( eqNByte( szLine, (u8 *)("#[v1]"), 5 ) ) -+ { -+ -+ pHalData->odmpriv.PhyRegPgVersion = szLine[3] - '0'; -+ //DBG_871X("This is a new format PHY_REG_PG.txt \n"); -+ } -+ else if ( eqNByte( szLine, (u8 *)("#[v0]"), 5 )) -+ { -+ pHalData->odmpriv.PhyRegPgVersion = szLine[3] - '0'; -+ //DBG_871X("This is a old format PHY_REG_PG.txt ok\n"); -+ } -+ else -+ { -+ DBG_871X("The format in PHY_REG_PG are invalid %s\n", szLine); -+ return _FAIL; -+ } -+ -+ if ( eqNByte( szLine + 5, (u8 *)("[Exact]#"), 8 ) ) -+ { -+ pHalData->odmpriv.PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; -+ //DBG_871X("The values in PHY_REG_PG are exact values ok\n"); -+ firstLine = _FALSE; -+ continue; -+ } -+ else if ( eqNByte( szLine + 5, (pu1Byte)("[Relative]#"), 11 ) ) -+ { -+ pHalData->odmpriv.PhyRegPgValueType = PHY_REG_PG_RELATIVE_VALUE; -+ //DBG_871X("The values in PHY_REG_PG are relative values ok\n"); -+ firstLine = _FALSE; -+ continue; -+ } -+ else -+ { -+ DBG_871X("The values in PHY_REG_PG are invalid %s\n", szLine); -+ return _FAIL; -+ } -+ } -+ -+ if ( pHalData->odmpriv.PhyRegPgVersion == 0 ) -+ { -+ // Get 1st hex value as register offset. -+ if(GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) -+ { -+ szLine += u4bMove; -+ if(u4bRegOffset == 0xffff) -+ { // Ending. -+ break; -+ } -+ -+ // Get 2nd hex value as register mask. -+ if ( GetHexValueFromString(szLine, &u4bRegMask, &u4bMove) ) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_RELATIVE_VALUE ) -+ { -+ // Get 3rd hex value as register value. -+ if(GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) -+ { -+ PHY_StoreTxPowerByRate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, u4bRegValue); -+ //DBG_871X("[ADDR] %03X=%08X Mask=%08x\n", u4bRegOffset, u4bRegValue, u4bRegMask); -+ } -+ else -+ { -+ return _FAIL; -+ } -+ } -+ else if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) -+ { -+ u32 combineValue = 0; -+ u8 integer = 0, fraction = 0; -+ -+ if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) ) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if ( fraction == 5 ) integer += 1; -+ combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) ); -+ //DBG_871X(" %d", integer ); -+ -+ if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) ) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if ( fraction == 5 ) integer += 1; -+ combineValue <<= 8; -+ combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) ); -+ //DBG_871X(" %d", integer ); -+ -+ if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) ) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if ( fraction == 5 ) integer += 1; -+ combineValue <<= 8; -+ combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) ); -+ //DBG_871X(" %d", integer ); -+ -+ if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) ) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if ( fraction == 5 ) integer += 1; -+ combineValue <<= 8; -+ combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) ); -+ //DBG_871X(" %d", integer ); -+ PHY_StoreTxPowerByRate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, combineValue); -+ -+ //DBG_871X("[ADDR] 0x%3x = 0x%4x\n", u4bRegOffset, combineValue ); -+ } -+ } -+ } -+ else if ( pHalData->odmpriv.PhyRegPgVersion > 0 ) -+ { -+ u32 index = 0, cnt = 0; -+ -+ if ( eqNByte( szLine, "0xffff", 6 ) ) -+ break; -+ -+ if( !eqNByte( "#[END]#", szLine, 7 ) ) -+ { -+ // load the table label info -+ if ( szLine[0] == '#' ) -+ { -+ index = 0; -+ if ( eqNByte( szLine, "#[2.4G]" , 7 ) ) -+ { -+ band = BAND_ON_2_4G; -+ index += 8; -+ } -+ else if ( eqNByte( szLine, "#[5G]", 5) ) -+ { -+ band = BAND_ON_5G; -+ index += 6; -+ } -+ else -+ { -+ DBG_871X("Invalid band %s in PHY_REG_PG.txt \n", szLine ); -+ return _FAIL; -+ } -+ -+ rf_path= szLine[index] - 'A'; -+ //DBG_871X(" Table label Band %d, RfPath %d\n", band, rf_path ); -+ } -+ else // load rows of tables -+ { -+ if ( szLine[1] == '1' ) -+ tx_num = RF_1TX; -+ else if ( szLine[1] == '2' ) -+ tx_num = RF_2TX; -+ else if ( szLine[1] == '3' ) -+ tx_num = RF_3TX; -+ else if ( szLine[1] == '4' ) -+ tx_num = RF_4TX; -+ else -+ { -+ DBG_871X("Invalid row in PHY_REG_PG.txt %c\n", szLine[1] ); -+ return _FAIL; -+ } -+ -+ while ( szLine[index] != ']' ) -+ ++index; -+ ++index;// skip ] -+ -+ // Get 2nd hex value as register offset. -+ szLine += index; -+ if ( GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove) ) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ // Get 2nd hex value as register mask. -+ if ( GetHexValueFromString(szLine, &u4bRegMask, &u4bMove) ) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_RELATIVE_VALUE ) -+ { -+ // Get 3rd hex value as register value. -+ if(GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) -+ { -+ PHY_StoreTxPowerByRate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, u4bRegValue); -+ //DBG_871X("[ADDR] %03X (tx_num %d) =%08X Mask=%08x\n", u4bRegOffset, tx_num, u4bRegValue, u4bRegMask); -+ } -+ else -+ { -+ return _FAIL; -+ } -+ } -+ else if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) -+ { -+ u32 combineValue = 0; -+ u8 integer = 0, fraction = 0; -+ -+ if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) ) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if ( fraction == 5 ) integer += 1; -+ combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) ); -+ //DBG_871X(" %d", integer ); -+ -+ if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) ) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if ( fraction == 5 ) integer += 1; -+ combineValue <<= 8; -+ combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) ); -+ //DBG_871X(" %d", integer ); -+ -+ if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) ) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if ( fraction == 5 ) integer += 1; -+ combineValue <<= 8; -+ combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) ); -+ //DBG_871X(" %d", integer ); -+ -+ if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) ) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if ( fraction == 5 ) integer += 1; -+ combineValue <<= 8; -+ combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) ); -+ //DBG_871X(" %d", integer ); -+ PHY_StoreTxPowerByRate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, combineValue); -+ -+ //DBG_871X("[ADDR] 0x%3x (tx_num %d) = 0x%4x\n", u4bRegOffset, tx_num, combineValue ); -+ } -+ } -+ } -+ } -+ } -+ } -+ //DBG_871X("<=====phy_ParseBBPgParaFile()\n"); -+ return rtStatus; -+} -+ -+int -+phy_ConfigBBWithPgParaFile( -+ IN PADAPTER Adapter, -+ IN char* pFileName) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ -+ if(!(Adapter->registrypriv.load_phy_file & LOAD_BB_PG_PARA_FILE)) -+ return rtStatus; -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pHalData->bb_phy_reg_pg_len == 0) && (pHalData->bb_phy_reg_pg == NULL)) -+ { -+ rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) -+ { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) -+ { -+ rtStatus = _SUCCESS; -+ pHalData->bb_phy_reg_pg = rtw_zvmalloc(rlen); -+ if(pHalData->bb_phy_reg_pg) { -+ _rtw_memcpy(pHalData->bb_phy_reg_pg, pHalData->para_file_buf, rlen); -+ pHalData->bb_phy_reg_pg_len = rlen; -+ } -+ else { -+ DBG_871X("%s bb_phy_reg_pg alloc fail !\n",__FUNCTION__); -+ } -+ } -+ } -+ } -+ else -+ { -+ if ((pHalData->bb_phy_reg_pg_len != 0) && (pHalData->bb_phy_reg_pg != NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pHalData->bb_phy_reg_pg, pHalData->bb_phy_reg_pg_len); -+ rtStatus = _SUCCESS; -+ } -+ else { -+ DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__); -+ } -+ } -+ -+ if(rtStatus == _SUCCESS) -+ { -+ //DBG_871X("phy_ConfigBBWithPgParaFile(): read %s ok\n", pFileName); -+ phy_ParseBBPgParaFile(Adapter, pHalData->para_file_buf); -+ } -+ else -+ { -+ DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+ } -+ -+ return rtStatus; -+} -+ -+#if (MP_DRIVER == 1 ) -+ -+int -+phy_ConfigBBWithMpParaFile( -+ IN PADAPTER Adapter, -+ IN char* pFileName -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegValue, u4bMove; -+ -+ if(!(Adapter->registrypriv.load_phy_file & LOAD_BB_MP_PARA_FILE)) -+ return rtStatus; -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pHalData->bb_phy_reg_mp_len == 0) && (pHalData->bb_phy_reg_mp == NULL)) -+ { -+ rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) -+ { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) -+ { -+ rtStatus = _SUCCESS; -+ pHalData->bb_phy_reg_mp = rtw_zvmalloc(rlen); -+ if(pHalData->bb_phy_reg_mp) { -+ _rtw_memcpy(pHalData->bb_phy_reg_mp, pHalData->para_file_buf, rlen); -+ pHalData->bb_phy_reg_mp_len = rlen; -+ } -+ else { -+ DBG_871X("%s bb_phy_reg_mp alloc fail !\n",__FUNCTION__); -+ } -+ } -+ } -+ } -+ else -+ { -+ if ((pHalData->bb_phy_reg_mp_len != 0) && (pHalData->bb_phy_reg_mp != NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pHalData->bb_phy_reg_mp, pHalData->bb_phy_reg_mp_len); -+ rtStatus = _SUCCESS; -+ } -+ else { -+ DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__); -+ } -+ } -+ -+ if(rtStatus == _SUCCESS) -+ { -+ //DBG_871X("phy_ConfigBBWithMpParaFile(): read %s ok\n", pFileName); -+ -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) -+ { -+ if(!IsCommentString(szLine)) -+ { -+ // Get 1st hex value as register offset. -+ if(GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) -+ { -+ if(u4bRegOffset == 0xffff) -+ { // Ending. -+ break; -+ } -+ else if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) -+ { -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ rtw_msleep_os(50); -+ #else -+ rtw_mdelay_os(50); -+ #endif -+ } -+ else if (u4bRegOffset == 0xfd) -+ { -+ rtw_mdelay_os(5); -+ } -+ else if (u4bRegOffset == 0xfc) -+ { -+ rtw_mdelay_os(1); -+ } -+ else if (u4bRegOffset == 0xfb) -+ { -+ rtw_udelay_os(50); -+ } -+ else if (u4bRegOffset == 0xfa) -+ { -+ rtw_udelay_os(5); -+ } -+ else if (u4bRegOffset == 0xf9) -+ { -+ rtw_udelay_os(1); -+ } -+ -+ // Get 2nd hex value as register value. -+ szLine += u4bMove; -+ if(GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) -+ { -+ //DBG_871X("[ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue); -+ PHY_SetBBReg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); -+ -+ // Add 1us delay between BB/RF register setting. -+ rtw_udelay_os(1); -+ } -+ } -+ } -+ } -+ } -+ else -+ { -+ DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+ } -+ -+ return rtStatus; -+} -+ ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ PDM_ODM_T podmpriv = &pHalData->odmpriv; ++ _rtw_memset(pdmpriv, 0, sizeof(struct dm_priv)); ++ //_rtw_spinlock_init(&(pHalData->odm_stainfo_lock)); ++ Init_ODM_ComInfo_8812(Adapter); ++#ifdef CONFIG_SW_ANTENNA_DIVERSITY ++ //_init_timer(&(pdmpriv->SwAntennaSwitchTimer), Adapter->pnetdev , odm_SW_AntennaSwitchCallback, Adapter); ++ ODM_InitAllTimers(podmpriv ); +#endif ++ ODM_InitDebugSetting(podmpriv); + -+int -+PHY_ConfigRFWithParaFile( -+ IN PADAPTER Adapter, -+ IN char* pFileName, -+ IN u8 eRFPath -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegValue, u4bMove; -+ u16 i; -+ char *pBuf = NULL; -+ u32 *pBufLen = NULL; -+ -+ if(!(Adapter->registrypriv.load_phy_file & LOAD_RF_PARA_FILE)) -+ return rtStatus; -+ -+ switch(eRFPath) -+ { -+ case ODM_RF_PATH_A: -+ pBuf = pHalData->rf_radio_a; -+ pBufLen = &pHalData->rf_radio_a_len; -+ break; -+ case ODM_RF_PATH_B: -+ pBuf = pHalData->rf_radio_b; -+ pBufLen = &pHalData->rf_radio_b_len; -+ break; -+ default: -+ DBG_871X("Unknown RF path!! %d\r\n", eRFPath); -+ break; -+ } -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) -+ { -+ rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) -+ { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) -+ { -+ rtStatus = _SUCCESS; -+ pBuf = rtw_zvmalloc(rlen); -+ if(pBuf) { -+ _rtw_memcpy(pBuf, pHalData->para_file_buf, rlen); -+ *pBufLen = rlen; -+ -+ switch(eRFPath) -+ { -+ case ODM_RF_PATH_A: -+ pHalData->rf_radio_a = pBuf; -+ break; -+ case ODM_RF_PATH_B: -+ pHalData->rf_radio_b = pBuf; -+ break; -+ } -+ } -+ else { -+ DBG_871X("%s(): eRFPath=%d alloc fail !\n",__FUNCTION__,eRFPath); -+ } -+ } -+ } -+ } -+ else -+ { -+ if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pBuf, *pBufLen); -+ rtStatus = _SUCCESS; -+ } -+ else { -+ DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__); -+ } -+ } -+ -+ if(rtStatus == _SUCCESS) -+ { -+ //DBG_871X("%s(): read %s successfully\n", __FUNCTION__, pFileName); -+ -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) -+ { -+ if(!IsCommentString(szLine)) -+ { -+ // Get 1st hex value as register offset. -+ if(GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) -+ { -+ if(u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) -+ { // Deay specific ms. Only RF configuration require delay. -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ rtw_msleep_os(50); -+ #else -+ rtw_mdelay_os(50); -+ #endif -+ } -+ else if (u4bRegOffset == 0xfd) -+ { -+ //delay_ms(5); -+ for(i=0;i<100;i++) -+ rtw_udelay_os(MAX_STALL_TIME); -+ } -+ else if (u4bRegOffset == 0xfc) -+ { -+ //delay_ms(1); -+ for(i=0;i<20;i++) -+ rtw_udelay_os(MAX_STALL_TIME); -+ } -+ else if (u4bRegOffset == 0xfb) -+ { -+ rtw_udelay_os(50); -+ } -+ else if (u4bRegOffset == 0xfa) -+ { -+ rtw_udelay_os(5); -+ } -+ else if (u4bRegOffset == 0xf9) -+ { -+ rtw_udelay_os(1); -+ } -+ else if(u4bRegOffset == 0xffff) -+ { -+ break; -+ } -+ -+ // Get 2nd hex value as register value. -+ szLine += u4bMove; -+ if(GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) -+ { -+ PHY_SetRFReg(Adapter, eRFPath, u4bRegOffset, bRFRegOffsetMask, u4bRegValue); -+ -+ // Temp add, for frequency lock, if no delay, that may cause -+ // frequency shift, ex: 2412MHz => 2417MHz -+ // If frequency shift, the following action may works. -+ // Fractional-N table in radio_a.txt -+ //0x2a 0x00001 // channel 1 -+ //0x2b 0x00808 frequency divider. -+ //0x2b 0x53333 -+ //0x2c 0x0000c -+ rtw_udelay_os(1); -+ } -+ } -+ } -+ } -+ } -+ else -+ { -+ DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+ } -+ -+ return rtStatus; ++ Adapter->registrypriv.RegEnableTxPowerLimit = 0; ++ Adapter->registrypriv.RegPowerBase = 14; ++ Adapter->registrypriv.RegTxPwrLimit = 0xFFFFFFFF; ++ Adapter->registrypriv.TxBBSwing_2G = 0xFF; ++ Adapter->registrypriv.TxBBSwing_5G = 0xFF; ++ Adapter->registrypriv.bEn_RFE = 0; ++ Adapter->registrypriv.RFE_Type = 64; ++ pHalData->RegRFPathS1 = 0; ++ pHalData->TxPwrInPercentage = TX_PWR_PERCENTAGE_3; +} + -+VOID -+initDeltaSwingIndexTables( -+ PADAPTER Adapter, -+ char* Band, -+ char* Path, -+ char* Sign, -+ char* Channel, -+ char* Rate, -+ char* Data -+) ++void rtl8812_deinit_dm_priv(PADAPTER Adapter) +{ -+ #define STR_EQUAL_5G(_band, _path, _sign, _rate, _chnl) \ -+ ((strcmp(Band, _band) == 0) && (strcmp(Path, _path) == 0) && (strcmp(Sign, _sign) == 0) &&\ -+ (strcmp(Rate, _rate) == 0) && (strcmp(Channel, _chnl) == 0)\ -+ ) -+ #define STR_EQUAL_2G(_band, _path, _sign, _rate) \ -+ ((strcmp(Band, _band) == 0) && (strcmp(Path, _path) == 0) && (strcmp(Sign, _sign) == 0) &&\ -+ (strcmp(Rate, _rate) == 0)\ -+ ) -+ -+ #define STORE_SWING_TABLE(_array, _iteratedIdx) \ -+ for(token = strsep(&Data, delim); token != NULL; token = strsep(&Data, delim))\ -+ {\ -+ sscanf(token, "%d", &idx);\ -+ _array[_iteratedIdx++] = (u8)idx;\ -+ }\ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ u32 j = 0; -+ char *token; -+ char delim[] = ","; -+ u32 idx = 0; -+ -+ //DBG_871X("===>initDeltaSwingIndexTables(): Band: %s;\nPath: %s;\nSign: %s;\nChannel: %s;\nRate: %s;\n, Data: %s;\n", -+ // Band, Path, Sign, Channel, Rate, Data); -+ -+ if ( STR_EQUAL_2G("2G", "A", "+", "CCK") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, j); -+ } -+ else if ( STR_EQUAL_2G("2G", "A", "-", "CCK") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, j); -+ } -+ else if ( STR_EQUAL_2G("2G", "B", "+", "CCK") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, j); -+ } -+ else if ( STR_EQUAL_2G("2G", "B", "-", "CCK") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, j); -+ } -+ else if ( STR_EQUAL_2G("2G", "A", "+", "ALL") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, j); -+ } -+ else if ( STR_EQUAL_2G("2G", "A", "-", "ALL") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, j); -+ } -+ else if ( STR_EQUAL_2G("2G", "B", "+", "ALL") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, j); -+ } -+ else if ( STR_EQUAL_2G("2G", "B", "-", "ALL") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, j); -+ } -+ else if ( STR_EQUAL_5G("5G", "A", "+", "ALL", "0") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "A", "-", "ALL", "0") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "B", "+", "ALL", "0") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "B", "-", "ALL", "0") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "A", "+", "ALL", "1") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "A", "-", "ALL", "1") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "B", "+", "ALL", "1") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "B", "-", "ALL", "1") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "A", "+", "ALL", "2") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "A", "-", "ALL", "2") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "B", "+", "ALL", "2") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "B", "-", "ALL", "2") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "A", "+", "ALL", "3") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[3], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "A", "-", "ALL", "3") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[3], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "B", "+", "ALL", "3") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[3], j); -+ } -+ else if ( STR_EQUAL_5G("5G", "B", "-", "ALL", "3") ) -+ { -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[3], j); -+ } -+ else -+ { -+ DBG_871X("===>initDeltaSwingIndexTables(): The input is invalid!!\n"); -+ } -+} -+ -+int -+PHY_ConfigRFWithTxPwrTrackParaFile( -+ IN PADAPTER Adapter, -+ IN char* pFileName -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 i = 0, j = 0; -+ char c = 0; -+ -+ if(!(Adapter->registrypriv.load_phy_file & LOAD_RF_TXPWR_TRACK_PARA_FILE)) -+ return rtStatus; -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pHalData->rf_tx_pwr_track_len == 0) && (pHalData->rf_tx_pwr_track == NULL)) -+ { -+ rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) -+ { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) -+ { -+ rtStatus = _SUCCESS; -+ pHalData->rf_tx_pwr_track = rtw_zvmalloc(rlen); -+ if(pHalData->rf_tx_pwr_track) { -+ _rtw_memcpy(pHalData->rf_tx_pwr_track, pHalData->para_file_buf, rlen); -+ pHalData->rf_tx_pwr_track_len = rlen; -+ } -+ else { -+ DBG_871X("%s rf_tx_pwr_track alloc fail !\n",__FUNCTION__); -+ } -+ } -+ } -+ } -+ else -+ { -+ if ((pHalData->rf_tx_pwr_track_len != 0) && (pHalData->rf_tx_pwr_track != NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pHalData->rf_tx_pwr_track, pHalData->rf_tx_pwr_track_len); -+ rtStatus = _SUCCESS; -+ } -+ else { -+ DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__); -+ } -+ } -+ -+ if(rtStatus == _SUCCESS) -+ { -+ //DBG_871X("%s(): read %s successfully\n", __FUNCTION__, pFileName); -+ -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) -+ { -+ if ( ! IsCommentString(szLine) ) -+ { -+ char band[5]="", path[5]="", sign[5] = ""; -+ char chnl[5]="", rate[10]=""; -+ char data[300]=""; // 100 is too small -+ -+ if (strlen(szLine) < 10 || szLine[0] != '[') -+ continue; -+ -+ strncpy(band, szLine+1, 2); -+ strncpy(path, szLine+5, 1); -+ strncpy(sign, szLine+8, 1); -+ -+ i = 10; // szLine+10 -+ if ( ! ParseQualifiedString(szLine, &i, rate, '[', ']') ) { -+ //DBG_871X("Fail to parse rate!\n"); -+ } -+ if ( ! ParseQualifiedString(szLine, &i, chnl, '[', ']') ) { -+ //DBG_871X("Fail to parse channel group!\n"); -+ } -+ while ( szLine[i] != '{' && i < strlen(szLine)) -+ i++; -+ if ( ! ParseQualifiedString(szLine, &i, data, '{', '}') ) { -+ //DBG_871X("Fail to parse data!\n"); -+ } -+ -+ initDeltaSwingIndexTables(Adapter, band, path, sign, chnl, rate, data); -+ } -+ } -+ } -+ else -+ { -+ DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+ } -+#if 0 -+ for (i = 0; i < DELTA_SWINGIDX_SIZE; ++i) -+ { -+ DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P[i]); -+ DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N[i]); -+ DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P[i]); -+ DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N[i]); -+ DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P[i]); -+ DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N[i]); -+ DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P[i]); -+ DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N[i]); -+ -+ for (j = 0; j < 3; ++j) -+ { -+ DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[j][i]); -+ DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[j][i]); -+ DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[j][i]); -+ DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[j][i]); -+ } -+ } ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ PDM_ODM_T podmpriv = &pHalData->odmpriv; ++ //_rtw_spinlock_free(&pHalData->odm_stainfo_lock); ++#ifdef CONFIG_SW_ANTENNA_DIVERSITY ++ //_cancel_timer_ex(&pdmpriv->SwAntennaSwitchTimer); ++ ODM_CancelAllTimers(podmpriv); +#endif -+ return rtStatus; -+} -+ -+int -+phy_ParsePowerLimitTableFile( -+ PADAPTER Adapter, -+ char* buffer -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ u32 i = 0, forCnt = 0; -+ u8 loadingStage = 0, limitValue = 0, fraction = 0; -+ char *szLine, *ptmp; -+ int rtStatus = _SUCCESS; -+ char band[10], bandwidth[10], rateSection[10], -+ regulation[TXPWR_LMT_MAX_REGULATION_NUM][10], rfPath[10],colNumBuf[10]; -+ u8 colNum = 0; -+ -+ DBG_871X("===>phy_ParsePowerLimitTableFile()\n" ); -+ -+ if ( Adapter->registrypriv.RegDecryptCustomFile == 1 ) -+ phy_DecryptBBPgParaFile( Adapter, buffer); -+ -+ ptmp = buffer; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) -+ { -+ // skip comment -+ if ( IsCommentString( szLine ) ) { -+ continue; -+ } -+ -+ if( loadingStage == 0 ) { -+ for ( forCnt = 0; forCnt < TXPWR_LMT_MAX_REGULATION_NUM; ++forCnt ) -+ _rtw_memset( ( PVOID ) regulation[forCnt], 0, 10 ); -+ _rtw_memset( ( PVOID ) band, 0, 10 ); -+ _rtw_memset( ( PVOID ) bandwidth, 0, 10 ); -+ _rtw_memset( ( PVOID ) rateSection, 0, 10 ); -+ _rtw_memset( ( PVOID ) rfPath, 0, 10 ); -+ _rtw_memset( ( PVOID ) colNumBuf, 0, 10 ); -+ -+ if ( szLine[0] != '#' || szLine[1] != '#' ) -+ continue; -+ -+ // skip the space -+ i = 2; -+ while ( szLine[i] == ' ' || szLine[i] == '\t' ) -+ ++i; -+ -+ szLine[--i] = ' '; // return the space in front of the regulation info -+ -+ // Parse the label of the table -+ if ( ! ParseQualifiedString( szLine, &i, band, ' ', ',' ) ) { -+ DBG_871X( "Fail to parse band!\n"); -+ return _FAIL; -+ } -+ if ( ! ParseQualifiedString( szLine, &i, bandwidth, ' ', ',' ) ) { -+ DBG_871X("Fail to parse bandwidth!\n"); -+ return _FAIL; -+ } -+ if ( ! ParseQualifiedString( szLine, &i, rfPath, ' ', ',' ) ) { -+ DBG_871X("Fail to parse rf path!\n"); -+ return _FAIL; -+ } -+ if ( ! ParseQualifiedString( szLine, &i, rateSection, ' ', ',' ) ) { -+ DBG_871X("Fail to parse rate!\n"); -+ return _FAIL; -+ } -+ -+ loadingStage = 1; -+ } -+ else if ( loadingStage == 1 ) -+ { -+ if ( szLine[0] != '#' || szLine[1] != '#' ) -+ continue; -+ -+ // skip the space -+ i = 2; -+ while ( szLine[i] == ' ' || szLine[i] == '\t' ) -+ ++i; -+ -+ if ( !eqNByte( (u8 *)(szLine + i), (u8 *)("START"), 5 ) ) { -+ DBG_871X("Lost \"## START\" label\n"); -+ return _FAIL; -+ } -+ -+ loadingStage = 2; -+ } -+ else if ( loadingStage == 2 ) -+ { -+ if ( szLine[0] != '#' || szLine[1] != '#' ) -+ continue; -+ -+ // skip the space -+ i = 2; -+ while ( szLine[i] == ' ' || szLine[i] == '\t' ) -+ ++i; -+ -+ if ( ! ParseQualifiedString( szLine, &i, colNumBuf, '#', '#' ) ) { -+ DBG_871X("Fail to parse column number!\n"); -+ return _FAIL; -+ } -+ -+ if ( !GetU1ByteIntegerFromStringInDecimal( colNumBuf, &colNum ) ) -+ return _FAIL; -+ -+ if ( colNum > TXPWR_LMT_MAX_REGULATION_NUM ) { -+ DBG_871X("unvalid col number %d (greater than max %d)\n", -+ colNum, TXPWR_LMT_MAX_REGULATION_NUM ); -+ return _FAIL; -+ } -+ -+ for ( forCnt = 0; forCnt < colNum; ++forCnt ) -+ { -+ u8 regulation_name_cnt = 0; -+ -+ // skip the space -+ while ( szLine[i] == ' ' || szLine[i] == '\t' ) -+ ++i; -+ -+ while ( szLine[i] != ' ' && szLine[i] != '\t' && szLine[i] != '\0' ) -+ regulation[forCnt][regulation_name_cnt++] = szLine[i++]; -+ //DBG_871X("regulation %s!\n", regulation[forCnt]); -+ -+ if ( regulation_name_cnt == 0 ) { -+ DBG_871X("unvalid number of regulation!\n"); -+ return _FAIL; -+ } -+ } -+ -+ loadingStage = 3; -+ } -+ else if ( loadingStage == 3 ) -+ { -+ char channel[10] = {0}, powerLimit[10] = {0}; -+ u8 cnt = 0; -+ -+ // the table ends -+ if ( szLine[0] == '#' && szLine[1] == '#' ) { -+ i = 2; -+ while ( szLine[i] == ' ' || szLine[i] == '\t' ) -+ ++i; -+ -+ if ( eqNByte( (u8 *)(szLine + i), (u8 *)("END"), 3 ) ) { -+ loadingStage = 0; -+ continue; -+ } -+ else { -+ DBG_871X("Wrong format\n"); -+ DBG_871X("<===== phy_ParsePowerLimitTableFile()\n"); -+ return _FAIL; -+ } -+ } -+ -+ if ( ( szLine[0] != 'c' && szLine[0] != 'C' ) || -+ ( szLine[1] != 'h' && szLine[1] != 'H' ) ) { -+ DBG_871X("Meet wrong channel => power limt pair\n"); -+ continue; -+ } -+ i = 2;// move to the location behind 'h' -+ -+ // load the channel number -+ cnt = 0; -+ while ( szLine[i] >= '0' && szLine[i] <= '9' ) { -+ channel[cnt] = szLine[i]; -+ ++cnt; -+ ++i; -+ } -+ //DBG_871X("chnl %s!\n", channel); -+ -+ for ( forCnt = 0; forCnt < colNum; ++forCnt ) -+ { -+ // skip the space between channel number and the power limit value -+ while ( szLine[i] == ' ' || szLine[i] == '\t' ) -+ ++i; -+ -+ // load the power limit value -+ cnt = 0; -+ fraction = 0; -+ _rtw_memset( ( PVOID ) powerLimit, 0, 10 ); -+ while ( ( szLine[i] >= '0' && szLine[i] <= '9' ) || szLine[i] == '.' ) -+ { -+ if ( szLine[i] == '.' ){ -+ if ( ( szLine[i+1] >= '0' && szLine[i+1] <= '9' ) ) { -+ fraction = szLine[i+1]; -+ i += 2; -+ } -+ else { -+ DBG_871X("Wrong fraction in TXPWR_LMT.txt\n"); -+ return _FAIL; -+ } -+ -+ break; -+ } -+ -+ powerLimit[cnt] = szLine[i]; -+ ++cnt; -+ ++i; -+ } -+ -+ if ( powerLimit[0] == '\0' ) { -+ powerLimit[0] = '6'; -+ powerLimit[1] = '3'; -+ i += 2; -+ } -+ else { -+ if ( !GetU1ByteIntegerFromStringInDecimal( powerLimit, &limitValue ) ) -+ return _FAIL; -+ -+ limitValue *= 2; -+ cnt = 0; -+ if ( fraction == '5' ) -+ ++limitValue; -+ -+ // the value is greater or equal to 100 -+ if ( limitValue >= 100 ) { -+ powerLimit[cnt++] = limitValue/100 + '0'; -+ limitValue %= 100; -+ -+ if ( limitValue >= 10 ) { -+ powerLimit[cnt++] = limitValue/10 + '0'; -+ limitValue %= 10; -+ } -+ else { -+ powerLimit[cnt++] = '0'; -+ } -+ -+ powerLimit[cnt++] = limitValue + '0'; -+ } -+ // the value is greater or equal to 10 -+ else if ( limitValue >= 10 ) { -+ powerLimit[cnt++] = limitValue/10 + '0'; -+ limitValue %= 10; -+ powerLimit[cnt++] = limitValue + '0'; -+ } -+ // the value is less than 10 -+ else -+ powerLimit[cnt++] = limitValue + '0'; -+ -+ powerLimit[cnt] = '\0'; -+ } -+ -+ //DBG_871X("ch%s => %s\n", channel, powerLimit); -+ -+ // store the power limit value -+ PHY_SetTxPowerLimit(pDM_Odm, (u8 *)regulation[forCnt], (u8 *)band, -+ (u8 *)bandwidth, (u8 *)rateSection, (u8 *)rfPath, (u8 *)channel, (u8 *)powerLimit ); -+ -+ } -+ } -+ else -+ { -+ DBG_871X("Abnormal loading stage in phy_ParsePowerLimitTableFile()!\n"); -+ rtStatus = _FAIL; -+ break; -+ } -+ } -+ -+ DBG_871X("<===phy_ParsePowerLimitTableFile()\n"); -+ return rtStatus; -+} -+ -+int -+PHY_ConfigRFWithPowerLimitTableParaFile( -+ IN PADAPTER Adapter, -+ IN char* pFileName -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ -+ if(!(Adapter->registrypriv.load_phy_file & LOAD_RF_TXPWR_LMT_PARA_FILE)) -+ return rtStatus; -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pHalData->rf_tx_pwr_lmt_len == 0) && (pHalData->rf_tx_pwr_lmt == NULL)) -+ { -+ rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName); -+ -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) -+ { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) -+ { -+ rtStatus = _SUCCESS; -+ pHalData->rf_tx_pwr_lmt = rtw_zvmalloc(rlen); -+ if(pHalData->rf_tx_pwr_lmt) { -+ _rtw_memcpy(pHalData->rf_tx_pwr_lmt, pHalData->para_file_buf, rlen); -+ pHalData->rf_tx_pwr_lmt_len = rlen; -+ } -+ else { -+ DBG_871X("%s rf_tx_pwr_lmt alloc fail !\n",__FUNCTION__); -+ } -+ } -+ } -+ } -+ else -+ { -+ if ((pHalData->rf_tx_pwr_lmt_len != 0) && (pHalData->rf_tx_pwr_lmt != NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pHalData->rf_tx_pwr_lmt, pHalData->rf_tx_pwr_lmt_len); -+ rtStatus = _SUCCESS; -+ } -+ else { -+ DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__); -+ } -+ } -+ -+ if(rtStatus == _SUCCESS) -+ { -+ //DBG_871X("%s(): read %s ok\n", __FUNCTION__, pFileName); -+ rtStatus = phy_ParsePowerLimitTableFile( Adapter, pHalData->para_file_buf ); -+ } -+ else -+ { -+ DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+ } -+ -+ return rtStatus; -+} -+ -+void phy_free_filebuf(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if(pHalData->mac_reg) -+ rtw_vmfree(pHalData->mac_reg, pHalData->mac_reg_len); -+ if(pHalData->bb_phy_reg) -+ rtw_vmfree(pHalData->bb_phy_reg, pHalData->bb_phy_reg_len); -+ if(pHalData->bb_agc_tab) -+ rtw_vmfree(pHalData->bb_agc_tab, pHalData->bb_agc_tab_len); -+ if(pHalData->bb_phy_reg_pg) -+ rtw_vmfree(pHalData->bb_phy_reg_pg, pHalData->bb_phy_reg_pg_len); -+ if(pHalData->bb_phy_reg_mp) -+ rtw_vmfree(pHalData->bb_phy_reg_mp, pHalData->bb_phy_reg_mp_len); -+ if(pHalData->rf_radio_a) -+ rtw_vmfree(pHalData->rf_radio_a, pHalData->rf_radio_a_len); -+ if(pHalData->rf_radio_b) -+ rtw_vmfree(pHalData->rf_radio_b, pHalData->rf_radio_b_len); -+ if(pHalData->rf_tx_pwr_track) -+ rtw_vmfree(pHalData->rf_tx_pwr_track, pHalData->rf_tx_pwr_track_len); -+ if(pHalData->rf_tx_pwr_lmt) -+ rtw_vmfree(pHalData->rf_tx_pwr_lmt, pHalData->rf_tx_pwr_lmt_len); -+ -+} -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_dm.c linux/3rdparty/rtl8812au/hal/hal_dm.c ---- linux.old/3rdparty/rtl8812au/hal/hal_dm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/hal_dm.c 2017-06-07 23:07:21.014687849 +0300 -@@ -0,0 +1,193 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2014 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+ -+// A mapping from HalData to ODM. -+ODM_BOARD_TYPE_E boardType(u8 InterfaceSel) -+{ -+ ODM_BOARD_TYPE_E board = ODM_BOARD_DEFAULT; -+ -+#ifdef CONFIG_PCI_HCI -+ INTERFACE_SELECT_PCIE pcie = (INTERFACE_SELECT_PCIE)InterfaceSel; -+ switch (pcie) -+ { -+ case INTF_SEL0_SOLO_MINICARD: -+ board |= ODM_BOARD_MINICARD; -+ break; -+ case INTF_SEL1_BT_COMBO_MINICARD: -+ board |= ODM_BOARD_BT; -+ board |= ODM_BOARD_MINICARD; -+ break; -+ default: -+ board = ODM_BOARD_DEFAULT; -+ break; -+ } -+ -+#elif defined(CONFIG_USB_HCI) -+ INTERFACE_SELECT_USB usb = (INTERFACE_SELECT_USB)InterfaceSel; -+ switch (usb) -+ { -+ case INTF_SEL1_USB_High_Power: -+ board |= ODM_BOARD_EXT_LNA; -+ board |= ODM_BOARD_EXT_PA; -+ break; -+ case INTF_SEL2_MINICARD: -+ board |= ODM_BOARD_MINICARD; -+ break; -+ case INTF_SEL4_USB_Combo: -+ board |= ODM_BOARD_BT; -+ break; -+ case INTF_SEL5_USB_Combo_MF: -+ board |= ODM_BOARD_BT; -+ break; -+ case INTF_SEL0_USB: -+ case INTF_SEL3_USB_Solo: -+ default: -+ board = ODM_BOARD_DEFAULT; -+ break; -+ } -+ -+#endif -+ //DBG_871X("===> boardType(): (pHalData->InterfaceSel, pDM_Odm->BoardType) = (%d, %d)\n", InterfaceSel, board); -+ -+ return board; -+} -+ -+void Init_ODM_ComInfo(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ int i; -+ -+ _rtw_memset(pDM_Odm,0,sizeof(*pDM_Odm)); -+ -+ pDM_Odm->Adapter = adapter; -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PLATFORM, ODM_CE); -+ -+ if (rtw_get_intf_type(adapter) == RTW_GSPI) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_INTERFACE, ODM_ITRF_SDIO); -+ else -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_INTERFACE, rtw_get_intf_type(adapter)); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_MP_TEST_CHIP, IS_NORMAL_CHIP(pHalData->VersionID)); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PATCH_ID, pHalData->CustomerID); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BWIFI_TEST, adapter->registrypriv.wifi_spec); -+ -+ -+ if (pHalData->rf_type == RF_1T1R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_1T1R); -+ else if (pHalData->rf_type == RF_1T2R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_1T2R); -+ else if (pHalData->rf_type == RF_2T2R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T2R); -+ else if (pHalData->rf_type == RF_2T2R_GREEN) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T2R_GREEN); -+ else if (pHalData->rf_type == RF_2T3R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T3R); -+ else if (pHalData->rf_type == RF_2T4R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T4R); -+ else if (pHalData->rf_type == RF_3T3R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_3T3R); -+ else if (pHalData->rf_type == RF_3T4R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_3T4R); -+ else if (pHalData->rf_type == RF_4T4R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_4T4R); -+ else -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_XTXR); -+ -+ -+{ -+ //1 ======= BoardType: ODM_CMNINFO_BOARD_TYPE ======= -+ u8 odm_board_type = ODM_BOARD_DEFAULT; -+ -+ if (pHalData->ExternalLNA_2G != 0) { -+ odm_board_type |= ODM_BOARD_EXT_LNA; -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_LNA, 1); -+ } -+ if (pHalData->ExternalLNA_5G != 0) { -+ odm_board_type |= ODM_BOARD_EXT_LNA_5G; -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_5G_EXT_LNA, 1); -+ } -+ if (pHalData->ExternalPA_2G != 0) { -+ odm_board_type |= ODM_BOARD_EXT_PA; -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_PA, 1); -+ } -+ if (pHalData->ExternalPA_5G != 0) { -+ odm_board_type |= ODM_BOARD_EXT_PA_5G; -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_5G_EXT_PA, 1); -+ } -+ if (pHalData->EEPROMBluetoothCoexist) -+ odm_board_type |= ODM_BOARD_BT; -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BOARD_TYPE, odm_board_type); -+ //1 ============== End of BoardType ============== -+} -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_DOMAIN_CODE_2G, pHalData->Regulation2_4G); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_DOMAIN_CODE_5G, pHalData->Regulation5G); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_GPA, pHalData->TypeGPA); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_APA, pHalData->TypeAPA); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_GLNA, pHalData->TypeGLNA); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_ALNA, pHalData->TypeALNA); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RFE_TYPE, pHalData->RFEType); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_TRSW, 0); -+ -+ /* Pointer reference */ -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_TX_UNI, &(dvobj->traffic_stat.tx_bytes)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_RX_UNI, &(dvobj->traffic_stat.rx_bytes)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_WM_MODE, &(pmlmeext->cur_wireless_mode)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BAND, &(pHalData->CurrentBandType)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_FORCED_RATE, &(pHalData->ForcedDataRate)); -+ -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SEC_CHNL_OFFSET, &(pHalData->nCur40MhzPrimeSC)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SEC_MODE, &(adapter->securitypriv.dot11PrivacyAlgrthm)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BW, &(pHalData->CurrentChannelBW)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_CHNL, &( pHalData->CurrentChannel)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_NET_CLOSED, &(adapter->net_closed)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_FORCED_IGI_LB, &(pHalData->u1ForcedIgiLb)); -+ -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SCAN, &(pmlmepriv->bScanInProcess)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_POWER_SAVING, &(pwrctl->bpower_saving)); -+ /*Add by Yuchen for phydm beamforming*/ -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_TX_TP, &(dvobj->traffic_stat.cur_tx_tp)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_RX_TP, &(dvobj->traffic_stat.cur_rx_tp)); -+#ifdef CONFIG_USB_HCI -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_HUBUSBMODE, &(dvobj->usb_speed)); -+#endif -+ for(i=0; i -+#include -+ -+int usb_init_recv_priv(_adapter *padapter, u16 ini_in_buf_sz) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ int i, res = _SUCCESS; -+ struct recv_buf *precvbuf; -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+ _rtw_init_sema(&precvpriv->recv_sema, 0);//will be removed -+ _rtw_init_sema(&precvpriv->terminate_recvthread_sema, 0);//will be removed -+#endif /* CONFIG_RECV_THREAD_MODE */ -+ -+#ifdef PLATFORM_LINUX -+ tasklet_init(&precvpriv->recv_tasklet, -+ (void(*)(unsigned long))usb_recv_tasklet, -+ (unsigned long)padapter); -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ #ifdef CONFIG_RX_INDICATE_QUEUE -+ TASK_INIT(&precvpriv->rx_indicate_tasklet, 0, rtw_rx_indicate_tasklet, padapter); -+ #endif /* CONFIG_RX_INDICATE_QUEUE */ -+#endif /* PLATFORM_FREEBSD */ -+ -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+#ifdef PLATFORM_LINUX -+ precvpriv->int_in_urb = usb_alloc_urb(0, GFP_KERNEL); -+ if(precvpriv->int_in_urb == NULL){ -+ res = _FAIL; -+ DBG_8192C("alloc_urb for interrupt in endpoint fail !!!!\n"); -+ goto exit; -+ } -+#endif /* PLATFORM_LINUX */ -+ precvpriv->int_in_buf = rtw_zmalloc(ini_in_buf_sz); -+ if(precvpriv->int_in_buf == NULL){ -+ res = _FAIL; -+ DBG_8192C("alloc_mem for interrupt in endpoint fail !!!!\n"); -+ goto exit; -+ } -+#endif /* CONFIG_USB_INTERRUPT_IN_PIPE */ -+ -+ /* init recv_buf */ -+ _rtw_init_queue(&precvpriv->free_recv_buf_queue); -+ _rtw_init_queue(&precvpriv->recv_buf_pending_queue); -+ #ifndef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ /* this is used only when RX_IOBUF is sk_buff */ -+ skb_queue_head_init(&precvpriv->free_recv_skb_queue); -+ #endif -+ -+ DBG_871X("NR_RECVBUFF: %d\n", NR_RECVBUFF); -+ DBG_871X("MAX_RECVBUF_SZ: %d\n", MAX_RECVBUF_SZ); -+ precvpriv->pallocated_recv_buf = rtw_zmalloc(NR_RECVBUFF *sizeof(struct recv_buf) + 4); -+ if(precvpriv->pallocated_recv_buf==NULL){ -+ res= _FAIL; -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("alloc recv_buf fail!\n")); -+ goto exit; -+ } -+ -+ precvpriv->precv_buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(precvpriv->pallocated_recv_buf), 4); -+ -+ precvbuf = (struct recv_buf*)precvpriv->precv_buf; -+ -+ for(i=0; i < NR_RECVBUFF ; i++) -+ { -+ _rtw_init_listhead(&precvbuf->list); -+ -+ _rtw_spinlock_init(&precvbuf->recvbuf_lock); -+ -+ precvbuf->alloc_sz = MAX_RECVBUF_SZ; -+ -+ res = rtw_os_recvbuf_resource_alloc(padapter, precvbuf); -+ if(res==_FAIL) -+ break; -+ -+ precvbuf->ref_cnt = 0; -+ precvbuf->adapter =padapter; -+ -+ //rtw_list_insert_tail(&precvbuf->list, &(precvpriv->free_recv_buf_queue.queue)); -+ -+ precvbuf++; -+ } -+ -+ precvpriv->free_recv_buf_queue_cnt = NR_RECVBUFF; -+ -+#if defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) -+ -+ skb_queue_head_init(&precvpriv->rx_skb_queue); -+ -+#ifdef CONFIG_RX_INDICATE_QUEUE -+ memset(&precvpriv->rx_indicate_queue, 0, sizeof(struct ifqueue)); -+ mtx_init(&precvpriv->rx_indicate_queue.ifq_mtx, "rx_indicate_queue", NULL, MTX_DEF); -+#endif /* CONFIG_RX_INDICATE_QUEUE */ -+ -+#ifdef CONFIG_PREALLOC_RECV_SKB -+ { -+ int i; -+ SIZE_PTR tmpaddr=0; -+ SIZE_PTR alignment=0; -+ struct sk_buff *pskb=NULL; -+ -+ DBG_871X("NR_PREALLOC_RECV_SKB: %d\n", NR_PREALLOC_RECV_SKB); -+#ifdef CONFIG_FIX_NR_BULKIN_BUFFER -+ DBG_871X("Enable CONFIG_FIX_NR_BULKIN_BUFFER\n"); -+#endif -+ -+ for(i=0; idev = padapter->pifp; -+ #else -+ pskb->dev = padapter->pnetdev; -+ #endif //PLATFORM_FREEBSD -+ -+#ifndef CONFIG_PREALLOC_RX_SKB_BUFFER -+ tmpaddr = (SIZE_PTR)pskb->data; -+ alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1); -+ skb_reserve(pskb, (RECVBUFF_ALIGN_SZ - alignment)); -+#endif -+ skb_queue_tail(&precvpriv->free_recv_skb_queue, pskb); -+ } -+ } -+ } -+#endif /* CONFIG_PREALLOC_RECV_SKB */ -+ -+#endif /* defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) */ -+ -+exit: -+ -+ return res; -+} -+ -+void usb_free_recv_priv (_adapter *padapter, u16 ini_in_buf_sz) -+{ -+ int i; -+ struct recv_buf *precvbuf; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ precvbuf = (struct recv_buf *)precvpriv->precv_buf; -+ -+ for(i=0; i < NR_RECVBUFF ; i++) -+ { -+ rtw_os_recvbuf_resource_free(padapter, precvbuf); -+ precvbuf++; -+ } -+ -+ if(precvpriv->pallocated_recv_buf) -+ rtw_mfree(precvpriv->pallocated_recv_buf, NR_RECVBUFF *sizeof(struct recv_buf) + 4); -+ -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+#ifdef PLATFORM_LINUX -+ if(precvpriv->int_in_urb) -+ { -+ usb_free_urb(precvpriv->int_in_urb); -+ } -+#endif -+ if(precvpriv->int_in_buf) -+ rtw_mfree(precvpriv->int_in_buf, ini_in_buf_sz); -+#endif /* CONFIG_USB_INTERRUPT_IN_PIPE */ -+ -+#ifdef PLATFORM_LINUX -+ -+ if (skb_queue_len(&precvpriv->rx_skb_queue)) { -+ DBG_8192C(KERN_WARNING "rx_skb_queue not empty\n"); -+ } -+ -+ rtw_skb_queue_purge(&precvpriv->rx_skb_queue); -+ -+ if (skb_queue_len(&precvpriv->free_recv_skb_queue)) { -+ DBG_8192C(KERN_WARNING "free_recv_skb_queue not empty, %d\n", skb_queue_len(&precvpriv->free_recv_skb_queue)); -+ } -+ -+#if !defined(CONFIG_USE_USB_BUFFER_ALLOC_RX) -+ #if defined(CONFIG_PREALLOC_RECV_SKB) && defined(CONFIG_PREALLOC_RX_SKB_BUFFER) -+ { -+ struct sk_buff *skb; -+ -+ while ((skb = skb_dequeue(&precvpriv->free_recv_skb_queue)) != NULL) -+ { -+ if (rtw_free_skb_premem(skb) != 0) -+ rtw_skb_free(skb); -+ } -+ } -+ #else -+ rtw_skb_queue_purge(&precvpriv->free_recv_skb_queue); -+ #endif /* defined(CONFIG_PREALLOC_RX_SKB_BUFFER) && defined(CONFIG_PREALLOC_RECV_SKB) */ -+#endif /* !defined(CONFIG_USE_USB_BUFFER_ALLOC_RX) */ -+ -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ struct sk_buff *pskb; -+ while (NULL != (pskb = skb_dequeue(&precvpriv->rx_skb_queue))) -+ { -+ rtw_skb_free(pskb); -+ } -+ -+ #if !defined(CONFIG_USE_USB_BUFFER_ALLOC_RX) -+ rtw_skb_queue_purge(&precvpriv->free_recv_skb_queue); -+ #endif -+ -+#ifdef CONFIG_RX_INDICATE_QUEUE -+ struct mbuf *m; -+ for (;;) { -+ IF_DEQUEUE(&precvpriv->rx_indicate_queue, m); -+ if (m == NULL) -+ break; -+ m_freem(m); -+ } -+ mtx_destroy(&precvpriv->rx_indicate_queue.ifq_mtx); -+#endif /* CONFIG_RX_INDICATE_QUEUE */ -+ -+#endif /* PLATFORM_FREEBSD */ -+} -+ -+#ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ -+int usb_write_async(struct usb_device *udev, u32 addr, void *pdata, u16 len) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ int ret; -+ -+ requesttype = VENDOR_WRITE;//write_out -+ request = REALTEK_USB_VENQT_CMD_REQ; -+ index = REALTEK_USB_VENQT_CMD_IDX;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ -+ ret = _usbctrl_vendorreq_async_write(udev, request, wvalue, index, pdata, len, requesttype); -+ -+ return ret; -+} -+ -+int usb_async_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val) -+{ -+ u8 data; -+ int ret; -+ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; -+ struct usb_device *udev=pdvobjpriv->pusbdev; -+ -+ _func_enter_; -+ data = val; -+ ret = usb_write_async(udev, addr, &data, 1); -+ _func_exit_; -+ -+ return ret; -+} -+ -+int usb_async_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val) -+{ -+ u16 data; -+ int ret; -+ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; -+ struct usb_device *udev=pdvobjpriv->pusbdev; -+ -+ _func_enter_; -+ data = val; -+ ret = usb_write_async(udev, addr, &data, 2); -+ _func_exit_; -+ -+ return ret; -+} -+ -+int usb_async_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val) -+{ -+ u32 data; -+ int ret; -+ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; -+ struct usb_device *udev=pdvobjpriv->pusbdev; -+ -+ _func_enter_; -+ data = val; -+ ret = usb_write_async(udev, addr, &data, 4); -+ _func_exit_; -+ -+ return ret; -+} -+#endif /* CONFIG_USB_SUPPORT_ASYNC_VDN_REQ */ -+ -+u8 usb_read8(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ u8 data=0; -+ -+ _func_enter_; -+ -+ request = 0x05; -+ requesttype = 0x01;//read_in -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = 1; -+ usbctrl_vendorreq(pintfhdl, request, wvalue, index, -+ &data, len, requesttype); -+ -+ _func_exit_; -+ -+ return data; -+} -+ -+u16 usb_read16(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ u16 data=0; -+ -+ _func_enter_; -+ -+ request = 0x05; -+ requesttype = 0x01;//read_in -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = 2; -+ usbctrl_vendorreq(pintfhdl, request, wvalue, index, -+ &data, len, requesttype); -+ -+ _func_exit_; -+ -+ return data; -+ -+} -+ -+u32 usb_read32(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ u32 data=0; -+ -+ _func_enter_; -+ -+ request = 0x05; -+ requesttype = 0x01;//read_in -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = 4; -+ usbctrl_vendorreq(pintfhdl, request, wvalue, index, -+ &data, len, requesttype); -+ -+ _func_exit_; -+ -+ return data; -+} -+ -+int usb_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ u8 data; -+ int ret; -+ -+ _func_enter_; -+ -+ request = 0x05; -+ requesttype = 0x00;//write_out -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = 1; -+ -+ data = val; -+ ret = usbctrl_vendorreq(pintfhdl, request, wvalue, index, -+ &data, len, requesttype); -+ -+ _func_exit_; -+ -+ return ret; -+} -+ -+int usb_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ u16 data; -+ int ret; -+ -+ _func_enter_; -+ -+ request = 0x05; -+ requesttype = 0x00;//write_out -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = 2; -+ -+ data = val; -+ ret = usbctrl_vendorreq(pintfhdl, request, wvalue, index, -+ &data, len, requesttype); -+ -+ _func_exit_; -+ -+ return ret; -+ -+} -+ -+int usb_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ u32 data; -+ int ret; -+ -+ _func_enter_; -+ -+ request = 0x05; -+ requesttype = 0x00;//write_out -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = 4; -+ data =val; -+ ret = usbctrl_vendorreq(pintfhdl, request, wvalue, index, -+ &data, len, requesttype); -+ -+ _func_exit_; -+ -+ return ret; -+ -+} -+ -+int usb_writeN(struct intf_hdl *pintfhdl, u32 addr, u32 length, u8 *pdata) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ u8 buf[VENDOR_CMD_MAX_DATA_LEN]={0}; -+ int ret; -+ -+ _func_enter_; -+ -+ request = 0x05; -+ requesttype = 0x00;//write_out -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = length; -+ _rtw_memcpy(buf, pdata, len ); -+ ret = usbctrl_vendorreq(pintfhdl, request, wvalue, index, -+ buf, len, requesttype); -+ -+ _func_exit_; -+ -+ return ret; -+ -+} -diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_intf.c linux/3rdparty/rtl8812au/hal/hal_intf.c ---- linux.old/3rdparty/rtl8812au/hal/hal_intf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/hal_intf.c 2017-06-07 23:07:21.014687849 +0300 -@@ -0,0 +1,1092 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#define _HAL_INTF_C_ -+ -+#include -+#include -+ -+void rtw_hal_chip_configure(_adapter *padapter) -+{ -+ padapter->HalFunc.intf_chip_configure(padapter); -+} -+ -+void rtw_hal_read_chip_info(_adapter *padapter) -+{ -+ u8 hci_type = rtw_get_intf_type(padapter); -+ u32 start = rtw_get_current_time(); -+ -+ /* before access eFuse, make sure card enable has been called */ -+ if ((hci_type == RTW_SDIO || hci_type == RTW_GSPI) -+ && !rtw_is_hw_init_completed(padapter)) -+ rtw_hal_power_on(padapter); -+ -+ padapter->HalFunc.read_adapter_info(padapter); -+ -+ if ((hci_type == RTW_SDIO || hci_type == RTW_GSPI) -+ && !rtw_is_hw_init_completed(padapter)) -+ rtw_hal_power_off(padapter); -+ -+ DBG_871X("%s in %d ms\n", __func__, rtw_get_passing_time_ms(start)); -+} -+ -+void rtw_hal_read_chip_version(_adapter *padapter) -+{ -+ padapter->HalFunc.read_chip_version(padapter); -+} -+ -+void rtw_hal_def_value_init(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) { -+ padapter->HalFunc.init_default_value(padapter); -+ -+ rtw_init_hal_com_default_value(padapter); -+ -+ { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ -+ /* hal_data..macid_num is ready here */ -+ dvobj->macid_ctl.num = rtw_min(hal_data->macid_num, MACID_NUM_SW_LIMIT); -+ -+ dvobj->cam_ctl.sec_cap = hal_data->sec_cap; -+ dvobj->cam_ctl.num = rtw_min(hal_data->sec_cam_ent_num, SEC_CAM_ENT_NUM_SW_LIMIT); -+ } -+ } -+} -+ -+u8 rtw_hal_data_init(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) { -+ padapter->hal_data_sz = sizeof(HAL_DATA_TYPE); -+ padapter->HalData = rtw_zvmalloc(padapter->hal_data_sz); -+ if(padapter->HalData == NULL){ -+ DBG_8192C("cant not alloc memory for HAL DATA \n"); -+ return _FAIL; -+ } -+ } -+ return _SUCCESS; -+} -+ -+void rtw_hal_data_deinit(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) { -+ if (padapter->HalData) -+ { -+ #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ phy_free_filebuf(padapter); -+ #endif -+ rtw_vmfree(padapter->HalData, padapter->hal_data_sz); -+ padapter->HalData = NULL; -+ padapter->hal_data_sz = 0; -+ } -+ } -+} -+ -+void rtw_hal_free_data(_adapter *padapter) -+{ -+ //free HAL Data -+ rtw_hal_data_deinit(padapter); -+} -+void rtw_hal_dm_init(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) { -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ padapter->HalFunc.dm_init(padapter); -+ -+ _rtw_spinlock_init(&pHalData->IQKSpinLock); -+ } -+} -+void rtw_hal_dm_deinit(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) { -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ padapter->HalFunc.dm_deinit(padapter); -+ -+ _rtw_spinlock_free(&pHalData->IQKSpinLock); -+ } -+} -+void rtw_hal_sw_led_init(_adapter *padapter) -+{ -+ if(padapter->HalFunc.InitSwLeds) -+ padapter->HalFunc.InitSwLeds(padapter); -+} -+ -+void rtw_hal_sw_led_deinit(_adapter *padapter) -+{ -+ if(padapter->HalFunc.DeInitSwLeds) -+ padapter->HalFunc.DeInitSwLeds(padapter); -+} -+ -+u32 rtw_hal_power_on(_adapter *padapter) -+{ -+ return padapter->HalFunc.hal_power_on(padapter); -+} -+void rtw_hal_power_off(_adapter *padapter) -+{ -+ padapter->HalFunc.hal_power_off(padapter); -+} -+ -+ -+void rtw_hal_init_opmode(_adapter *padapter) -+{ -+ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType = Ndis802_11InfrastructureMax; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ sint fw_state; -+ -+ fw_state = get_fwstate(pmlmepriv); -+ -+ if (fw_state & WIFI_ADHOC_STATE) -+ networkType = Ndis802_11IBSS; -+ else if (fw_state & WIFI_STATION_STATE) -+ networkType = Ndis802_11Infrastructure; -+ else if (fw_state & WIFI_AP_STATE) -+ networkType = Ndis802_11APMode; -+ else -+ return; -+ -+ rtw_setopmode_cmd(padapter, networkType, _FALSE); -+} -+ -+uint rtw_hal_init(_adapter *padapter) -+{ -+ uint status = _SUCCESS; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ int i; -+ -+ status = padapter->HalFunc.hal_init(padapter); -+ -+ if (status == _SUCCESS) { -+ pHalData->hw_init_completed = _TRUE; -+ -+ if (padapter->registrypriv.notch_filter == 1) -+ rtw_hal_notch_filter(padapter, 1); -+ -+ for (i = 0; iiface_nums; i++) -+ rtw_sec_restore_wep_key(dvobj->padapters[i]); -+ -+ rtw_led_control(padapter, LED_CTL_POWER_ON); -+ -+ init_hw_mlme_ext(padapter); -+ -+ rtw_hal_init_opmode(padapter); -+ -+#ifdef CONFIG_RF_GAIN_OFFSET -+ rtw_bb_rf_gain_offset(padapter); -+#endif //CONFIG_RF_GAIN_OFFSET -+ -+ } else { -+ pHalData->hw_init_completed = _FALSE; -+ DBG_871X("rtw_hal_init: hal__init fail\n"); -+ } -+ -+ RT_TRACE(_module_hal_init_c_,_drv_err_,("-rtl871x_hal_init:status=0x%x\n",status)); -+ -+ return status; -+ -+} -+ -+uint rtw_hal_deinit(_adapter *padapter) -+{ -+ uint status = _SUCCESS; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ int i; -+_func_enter_; -+ -+ status = padapter->HalFunc.hal_deinit(padapter); -+ -+ if(status == _SUCCESS){ -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ pHalData->hw_init_completed = _FALSE; -+ } -+ else -+ { -+ DBG_871X("\n rtw_hal_deinit: hal_init fail\n"); -+ } -+ -+_func_exit_; -+ -+ return status; -+} -+ -+void rtw_hal_set_hwreg(_adapter *padapter, u8 variable, u8 *val) -+{ -+ padapter->HalFunc.SetHwRegHandler(padapter, variable, val); -+} -+ -+void rtw_hal_get_hwreg(_adapter *padapter, u8 variable, u8 *val) -+{ -+ padapter->HalFunc.GetHwRegHandler(padapter, variable, val); -+} -+ -+#ifdef CONFIG_C2H_PACKET_EN -+void rtw_hal_set_hwreg_with_buf(_adapter *padapter, u8 variable, u8 *pbuf, int len) -+{ -+ if (padapter->HalFunc.SetHwRegHandlerWithBuf) -+ padapter->HalFunc.SetHwRegHandlerWithBuf(padapter, variable, pbuf, len); -+} -+#endif -+ -+u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue) -+{ -+ return padapter->HalFunc.SetHalDefVarHandler(padapter,eVariable,pValue); -+} -+u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue) -+{ -+ return padapter->HalFunc.GetHalDefVarHandler(padapter,eVariable,pValue); -+} -+ -+void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1,BOOLEAN bSet) -+{ -+ padapter->HalFunc.SetHalODMVarHandler(padapter,eVariable,pValue1,bSet); -+} -+void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1,PVOID pValue2) -+{ -+ padapter->HalFunc.GetHalODMVarHandler(padapter,eVariable,pValue1,pValue2); -+} -+ -+/* FOR SDIO & PCIE */ -+void rtw_hal_enable_interrupt(_adapter *padapter) -+{ -+#if defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) -+ padapter->HalFunc.enable_interrupt(padapter); -+#endif //#if defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) -+} -+ -+/* FOR SDIO & PCIE */ -+void rtw_hal_disable_interrupt(_adapter *padapter) -+{ -+#if defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) -+ padapter->HalFunc.disable_interrupt(padapter); -+#endif //#if defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) -+} -+ -+ -+u8 rtw_hal_check_ips_status(_adapter *padapter) -+{ -+ u8 val = _FALSE; -+ if (padapter->HalFunc.check_ips_status) -+ val = padapter->HalFunc.check_ips_status(padapter); -+ else -+ DBG_871X("%s: HalFunc.check_ips_status is NULL!\n", __FUNCTION__); -+ -+ return val; -+} -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void rtw_hal_clear_interrupt(_adapter *padapter) -+{ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ padapter->HalFunc.clear_interrupt(padapter); -+#endif -+} -+void rtw_hal_set_wowlan_fw(_adapter *padapter, u8 sleep) -+{ -+ padapter->HalFunc.hal_set_wowlan_fw(padapter, sleep); -+} -+ -+#endif -+ -+#if defined(CONFIG_USB_HCI) || defined (CONFIG_PCI_HCI) -+u32 rtw_hal_inirp_init(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) -+ return padapter->HalFunc.inirp_init(padapter); -+ return _SUCCESS; -+} -+u32 rtw_hal_inirp_deinit(_adapter *padapter) -+{ -+ -+ if (is_primary_adapter(padapter)) -+ return padapter->HalFunc.inirp_deinit(padapter); -+ -+ return _SUCCESS; -+} -+#endif //#if defined(CONFIG_USB_HCI) || defined (CONFIG_PCI_HCI) -+ -+#if defined(CONFIG_PCI_HCI) -+void rtw_hal_irp_reset(_adapter *padapter) -+{ -+ padapter->HalFunc.irp_reset(padapter); -+} -+#endif //#if defined(CONFIG_PCI_HCI) -+ -+/* for USB Auto-suspend */ -+u8 rtw_hal_intf_ps_func(_adapter *padapter,HAL_INTF_PS_FUNC efunc_id, u8* val) -+{ -+ if(padapter->HalFunc.interface_ps_func) -+ return padapter->HalFunc.interface_ps_func(padapter,efunc_id,val); -+ return _FAIL; -+} -+ -+s32 rtw_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ return padapter->HalFunc.hal_xmitframe_enqueue(padapter, pxmitframe); -+} -+ -+s32 rtw_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ return padapter->HalFunc.hal_xmit(padapter, pxmitframe); -+} -+ -+/* -+ * [IMPORTANT] This function would be run in interrupt context. -+ */ -+s32 rtw_hal_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ s32 ret = _FAIL; -+ u8 *pframe, subtype; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ update_mgntframe_attrib_addr(padapter, pmgntframe); -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ subtype = GetFrameSubType(pframe); /* bit(7)~bit(2) */ -+ -+ //pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ //_rtw_memcpy(pmgntframe->attrib.ra, pwlanhdr->addr1, ETH_ALEN); -+ -+#ifdef CONFIG_IEEE80211W -+ if (padapter->securitypriv.binstallBIPkey == _TRUE && (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || -+ subtype == WIFI_ACTION)) -+ { -+ if (IS_MCAST(pmgntframe->attrib.ra) && pmgntframe->attrib.key_type != IEEE80211W_NO_KEY) { -+ pmgntframe->attrib.encrypt = _BIP_; -+ /* pmgntframe->attrib.bswenc = _TRUE; */ -+ } else if (pmgntframe->attrib.key_type != IEEE80211W_NO_KEY) { -+ psta = rtw_get_stainfo(pstapriv, pmgntframe->attrib.ra); -+ if (psta && psta->bpairwise_key_installed == _TRUE) { -+ pmgntframe->attrib.encrypt = _AES_; -+ pmgntframe->attrib.bswenc = _TRUE; -+ } else { -+ DBG_871X("%s, %d, bpairwise_key_installed is FALSE\n", __func__, __LINE__); -+ goto no_mgmt_coalesce; -+ } -+ } -+ DBG_871X("encrypt=%d, bswenc=%d\n", pmgntframe->attrib.encrypt, pmgntframe->attrib.bswenc); -+ rtw_mgmt_xmitframe_coalesce(padapter, pmgntframe->pkt, pmgntframe); -+ } -+#endif //CONFIG_IEEE80211W -+no_mgmt_coalesce: -+ ret = padapter->HalFunc.mgnt_xmit(padapter, pmgntframe); -+ return ret; -+} -+ -+s32 rtw_hal_init_xmit_priv(_adapter *padapter) -+{ -+ return padapter->HalFunc.init_xmit_priv(padapter); -+} -+void rtw_hal_free_xmit_priv(_adapter *padapter) -+{ -+ padapter->HalFunc.free_xmit_priv(padapter); -+} -+ -+s32 rtw_hal_init_recv_priv(_adapter *padapter) -+{ -+ return padapter->HalFunc.init_recv_priv(padapter); -+} -+void rtw_hal_free_recv_priv(_adapter *padapter) -+{ -+ padapter->HalFunc.free_recv_priv(padapter); -+} -+ -+void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level) -+{ -+ _adapter *padapter; -+ struct mlme_priv *pmlmepriv; -+ -+ if(!psta) -+ return; -+ -+ padapter = psta->padapter; -+ -+ pmlmepriv = &(padapter->mlmepriv); -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ { -+ add_RATid(padapter, psta, rssi_level); -+ } -+ else -+ { -+ padapter->HalFunc.UpdateRAMaskHandler(padapter, psta->mac_id, rssi_level); -+ } -+} -+ -+void rtw_hal_add_ra_tid(_adapter *padapter, u64 bitmap, u8 *arg, u8 rssi_level) -+{ -+ padapter->HalFunc.Add_RateATid(padapter, bitmap, arg, rssi_level); -+} -+ -+/* Start specifical interface thread */ -+void rtw_hal_start_thread(_adapter *padapter) -+{ -+#if defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) -+#ifndef CONFIG_SDIO_TX_TASKLET -+ padapter->HalFunc.run_thread(padapter); -+#endif -+#endif -+} -+/* Start specifical interface thread */ -+void rtw_hal_stop_thread(_adapter *padapter) -+{ -+#if defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) -+#ifndef CONFIG_SDIO_TX_TASKLET -+ -+ padapter->HalFunc.cancel_thread(padapter); -+ -+#endif -+#endif -+} -+ -+u32 rtw_hal_read_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask) -+{ -+ u32 data = 0; -+ if(padapter->HalFunc.read_bbreg) -+ data = padapter->HalFunc.read_bbreg(padapter, RegAddr, BitMask); -+ return data; -+} -+void rtw_hal_write_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ if(padapter->HalFunc.write_bbreg) -+ padapter->HalFunc.write_bbreg(padapter, RegAddr, BitMask, Data); -+} -+ -+u32 rtw_hal_read_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask) -+{ -+ u32 data = 0; -+ -+ if (padapter->HalFunc.read_rfreg) { -+ data = padapter->HalFunc.read_rfreg(padapter, eRFPath, RegAddr, BitMask); -+ -+ if (match_rf_read_sniff_ranges(eRFPath, RegAddr, BitMask)) { -+ DBG_871X("DBG_IO rtw_hal_read_rfreg(%u, 0x%04x, 0x%08x) read:0x%08x(0x%08x)\n" -+ , eRFPath, RegAddr, BitMask, (data << PHY_CalculateBitShift(BitMask)), data); -+ } -+ } -+ -+ return data; -+} -+ -+void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ if (padapter->HalFunc.write_rfreg) { -+ -+ if (match_rf_write_sniff_ranges(eRFPath, RegAddr, BitMask)) { -+ DBG_871X("DBG_IO rtw_hal_write_rfreg(%u, 0x%04x, 0x%08x) write:0x%08x(0x%08x)\n" -+ , eRFPath, RegAddr, BitMask, (Data << PHY_CalculateBitShift(BitMask)), Data); -+ } -+ -+ padapter->HalFunc.write_rfreg(padapter, eRFPath, RegAddr, BitMask, Data); -+#ifdef CONFIG_PCI_HCI -+ rtw_udelay_os(2); -+#endif -+ } -+} -+ -+#if defined(CONFIG_PCI_HCI) -+s32 rtw_hal_interrupt_handler(_adapter *padapter) -+{ -+ s32 ret = _FAIL; -+ ret = padapter->HalFunc.interrupt_handler(padapter); -+ return ret; -+} -+#endif -+#if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) -+void rtw_hal_interrupt_handler(_adapter *padapter, u16 pkt_len, u8 *pbuf) -+{ -+ padapter->HalFunc.interrupt_handler(padapter, pkt_len, pbuf); -+} -+#endif -+ -+void rtw_hal_set_bwmode(_adapter *padapter, CHANNEL_WIDTH Bandwidth, u8 Offset) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ ODM_AcquireSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ if(pDM_Odm->RFCalibrateInfo.bIQKInProgress == _TRUE) -+ DBG_871X_LEVEL(_drv_err_, "%s, %d, IQK may race condition\n", __func__,__LINE__); -+ ODM_ReleaseSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ padapter->HalFunc.set_bwmode_handler(padapter, Bandwidth, Offset); -+ -+} -+ -+void rtw_hal_set_chan(_adapter *padapter, u8 channel) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ ODM_AcquireSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ if(pDM_Odm->RFCalibrateInfo.bIQKInProgress == _TRUE) -+ DBG_871X_LEVEL(_drv_err_, "%s, %d, IQK may race condition\n", __func__,__LINE__); -+ ODM_ReleaseSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ padapter->HalFunc.set_channel_handler(padapter, channel); -+} -+ -+void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ ODM_AcquireSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ if(pDM_Odm->RFCalibrateInfo.bIQKInProgress == _TRUE) -+ DBG_871X_LEVEL(_drv_err_, "%s, %d, IQK may race condition\n", __func__,__LINE__); -+ ODM_ReleaseSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ padapter->HalFunc.set_chnl_bw_handler(padapter, channel, Bandwidth, Offset40, Offset80); -+} -+ -+void rtw_hal_set_tx_power_level(_adapter *padapter, u8 channel) -+{ -+ if(padapter->HalFunc.set_tx_power_level_handler) -+ padapter->HalFunc.set_tx_power_level_handler(padapter, channel); -+} -+ -+void rtw_hal_get_tx_power_level(_adapter *padapter, s32 *powerlevel) -+{ -+ if(padapter->HalFunc.get_tx_power_level_handler) -+ padapter->HalFunc.get_tx_power_level_handler(padapter, powerlevel); -+} -+ -+void rtw_hal_dm_watchdog(_adapter *padapter) -+{ -+ if (!is_primary_adapter(padapter)) -+ return; -+ -+ padapter->HalFunc.hal_dm_watchdog(padapter); -+ -+} -+ -+#ifdef CONFIG_LPS_LCLK_WD_TIMER -+void rtw_hal_dm_watchdog_in_lps(_adapter *padapter) -+{ -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (padapter->iface_type != IFACE_PORT0) -+ return; -+#endif -+ -+ if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode ==_TRUE ) { -+ padapter->HalFunc.hal_dm_watchdog_in_lps(padapter);//this fuction caller is in interrupt context -+ } -+} -+#endif -+ -+void rtw_hal_bcn_related_reg_setting(_adapter *padapter) -+{ -+ padapter->HalFunc.SetBeaconRelatedRegistersHandler(padapter); +} + + +#ifdef CONFIG_ANTENNA_DIVERSITY -+u8 rtw_hal_antdiv_before_linked(_adapter *padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ int i; -+ -+ if (!padapter->HalFunc.AntDivBeforeLinkHandler) -+ return _FALSE; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (rtw_linked_check(dvobj->padapters[i])) -+ return _FALSE; -+ } -+ -+ return padapter->HalFunc.AntDivBeforeLinkHandler(padapter); -+} -+void rtw_hal_antdiv_rssi_compared(_adapter *padapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src) -+{ -+ if(padapter->HalFunc.AntDivCompareHandler) -+ padapter->HalFunc.AntDivCompareHandler(padapter, dst, src); -+} -+#endif -+ -+#ifdef CONFIG_HOSTAPD_MLME -+s32 rtw_hal_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt) -+{ -+ if(padapter->HalFunc.hostap_mgnt_xmit_entry) -+ return padapter->HalFunc.hostap_mgnt_xmit_entry(padapter, pkt); -+ return _FAIL; -+} -+#endif //CONFIG_HOSTAPD_MLME -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+void rtw_hal_sreset_init(_adapter *padapter) -+{ -+ padapter->HalFunc.sreset_init_value(padapter); -+} -+void rtw_hal_sreset_reset(_adapter *padapter) -+{ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ padapter->HalFunc.silentreset(padapter); -+} -+ -+void rtw_hal_sreset_reset_value(_adapter *padapter) -+{ -+ padapter->HalFunc.sreset_reset_value(padapter); -+} -+ -+void rtw_hal_sreset_xmit_status_check(_adapter *padapter) -+{ -+ if (!is_primary_adapter(padapter)) -+ return; -+ -+ padapter->HalFunc.sreset_xmit_status_check(padapter); -+} -+void rtw_hal_sreset_linked_status_check(_adapter *padapter) -+{ -+ if (!is_primary_adapter(padapter)) -+ return; -+ padapter->HalFunc.sreset_linked_status_check(padapter); -+} -+u8 rtw_hal_sreset_get_wifi_status(_adapter *padapter) -+{ -+ return padapter->HalFunc.sreset_get_wifi_status(padapter); -+} -+ -+bool rtw_hal_sreset_inprogress(_adapter *padapter) -+{ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ return padapter->HalFunc.sreset_inprogress(padapter); -+} -+#endif //DBG_CONFIG_ERROR_DETECT -+ -+#ifdef CONFIG_IOL -+int rtw_hal_iol_cmd(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt) -+{ -+ if(adapter->HalFunc.IOL_exec_cmds_sync) -+ return adapter->HalFunc.IOL_exec_cmds_sync(adapter, xmit_frame, max_wating_ms,bndy_cnt); -+ return _FAIL; -+} -+#endif -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+s32 rtw_hal_xmit_thread_handler(_adapter *padapter) -+{ -+ return padapter->HalFunc.xmit_thread_handler(padapter); -+} -+#endif -+ -+void rtw_hal_notch_filter(_adapter *adapter, bool enable) -+{ -+ if(adapter->HalFunc.hal_notch_filter) -+ adapter->HalFunc.hal_notch_filter(adapter,enable); -+} -+ -+bool rtw_hal_c2h_valid(_adapter *adapter, u8 *buf) -+{ -+ HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); -+ HAL_VERSION *hal_ver = &HalData->VersionID; -+ bool ret = _FAIL; -+ -+ if (IS_8188E(*hal_ver)) { -+ ret = c2h_evt_valid((struct c2h_evt_hdr *)buf); -+ } else if(IS_8192E(*hal_ver) || IS_8812_SERIES(*hal_ver) || IS_8821_SERIES(*hal_ver) || IS_8723B_SERIES(*hal_ver)) { -+ ret = c2h_evt_valid((struct c2h_evt_hdr_88xx*)buf); -+ } else { -+ rtw_warn_on(1); -+ } -+ -+ return ret; -+} -+ -+s32 rtw_hal_c2h_evt_read(_adapter *adapter, u8 *buf) -+{ -+ HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); -+ HAL_VERSION *hal_ver = &HalData->VersionID; -+ s32 ret = _FAIL; -+ -+ if (IS_8188E(*hal_ver)) { -+ ret = c2h_evt_read(adapter, buf); -+ } else if(IS_8192E(*hal_ver) || IS_8812_SERIES(*hal_ver) || IS_8821_SERIES(*hal_ver) || IS_8723B_SERIES(*hal_ver)) { -+ ret = c2h_evt_read_88xx(adapter, buf); -+ } else { -+ rtw_warn_on(1); -+ } -+ -+ return ret; -+} -+ -+s32 rtw_hal_c2h_handler(_adapter *adapter, u8 *c2h_evt) -+{ -+ s32 ret = _FAIL; -+ if (adapter->HalFunc.c2h_handler) -+ ret = adapter->HalFunc.c2h_handler(adapter, c2h_evt); -+ return ret; -+} -+ -+c2h_id_filter rtw_hal_c2h_id_filter_ccx(_adapter *adapter) -+{ -+ return adapter->HalFunc.c2h_id_filter_ccx; -+} -+ -+s32 rtw_hal_is_disable_sw_channel_plan(PADAPTER padapter) -+{ -+ return GET_HAL_DATA(padapter)->bDisableSWChannelPlan; -+} -+ -+s32 rtw_hal_macid_sleep(PADAPTER padapter, u8 macid) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u8 support; -+ -+ support = _FALSE; -+ rtw_hal_get_def_var(padapter, HAL_DEF_MACID_SLEEP, &support); -+ if (_FALSE == support) -+ return _FAIL; -+ -+ if (macid >= macid_ctl->num) { -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT": Invalid macid(%u)\n", -+ FUNC_ADPT_ARG(padapter), macid); -+ return _FAIL; -+ } -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MACID_SLEEP, &macid); -+ -+ return _SUCCESS; -+} -+ -+s32 rtw_hal_macid_wakeup(PADAPTER padapter, u8 macid) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u8 support; -+ -+ support = _FALSE; -+ rtw_hal_get_def_var(padapter, HAL_DEF_MACID_SLEEP, &support); -+ if (_FALSE == support) -+ return _FAIL; -+ -+ if (macid >= macid_ctl->num) { -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT": Invalid macid(%u)\n", -+ FUNC_ADPT_ARG(padapter), macid); -+ return _FAIL; -+ } -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MACID_WAKEUP, &macid); -+ -+ return _SUCCESS; -+} -+ -+s32 rtw_hal_fill_h2c_cmd(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) -+{ -+ _adapter *pri_adapter = GET_PRIMARY_ADAPTER(padapter); -+ -+ if (pri_adapter->bFWReady == _TRUE) -+ return padapter->HalFunc.fill_h2c_cmd(padapter, ElementID, CmdLen, pCmdBuffer); -+ else if (padapter->registrypriv.mp_mode == 0) -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" FW doesn't exit when no MP mode, by pass H2C id:0x%02x\n" -+ , FUNC_ADPT_ARG(padapter), ElementID); -+ return _FAIL; -+} -+ -+void rtw_hal_fill_fake_txdesc(_adapter* padapter, u8* pDesc, u32 BufferLen, -+ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame) -+{ -+ padapter->HalFunc.fill_fake_txdesc(padapter, pDesc, BufferLen,IsPsPoll, IsBTQosNull, bDataFrame); -+ -+} -+u8 rtw_hal_get_txbuff_rsvd_page_num(_adapter *adapter, bool wowlan) -+{ -+ return adapter->HalFunc.hal_get_tx_buff_rsvd_page_num(adapter, wowlan); -+} -+ -+#ifdef CONFIG_GPIO_API -+void rtw_hal_update_hisr_hsisr_ind(_adapter *padapter, u32 flag) -+{ -+ if (padapter->HalFunc.update_hisr_hsisr_ind) -+ padapter->HalFunc.update_hisr_hsisr_ind(padapter, flag); -+} -+#endif -+ -+#define rtw_hal_error_msg(ops_fun) \ -+ DBG_871X_LEVEL(_drv_always_, "### %s - Error : Please hook HalFunc.%s ###\n",__FUNCTION__,ops_fun) -+ -+u8 rtw_hal_ops_check(_adapter *padapter) -+{ -+ u8 ret = _SUCCESS; -+#if 1 -+ /*** initialize section ***/ -+ if (NULL == padapter->HalFunc.read_chip_version) { -+ rtw_hal_error_msg("read_chip_version"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.init_default_value) { -+ rtw_hal_error_msg("init_default_value"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.intf_chip_configure) { -+ rtw_hal_error_msg("intf_chip_configure"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.read_adapter_info) { -+ rtw_hal_error_msg("read_adapter_info"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->HalFunc.hal_power_on) { -+ rtw_hal_error_msg("hal_power_on"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.hal_power_off) { -+ rtw_hal_error_msg("hal_power_off"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->HalFunc.hal_init) { -+ rtw_hal_error_msg("hal_init"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.hal_deinit) { -+ rtw_hal_error_msg("hal_deinit"); -+ ret = _FAIL; -+ } -+ -+ /*** xmit section ***/ -+ if (NULL == padapter->HalFunc.init_xmit_priv) { -+ rtw_hal_error_msg("init_xmit_priv"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.free_xmit_priv) { -+ rtw_hal_error_msg("free_xmit_priv"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.hal_xmit) { -+ rtw_hal_error_msg("hal_xmit"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.mgnt_xmit) { -+ rtw_hal_error_msg("mgnt_xmit"); -+ ret = _FAIL; -+ } -+ #ifdef CONFIG_XMIT_THREAD_MODE -+ if (NULL == padapter->HalFunc.xmit_thread_handler) { -+ rtw_hal_error_msg("xmit_thread_handler"); -+ ret = _FAIL; -+ } -+ #endif -+ if (NULL == padapter->HalFunc.hal_xmitframe_enqueue) { -+ rtw_hal_error_msg("hal_xmitframe_enqueue"); -+ ret = _FAIL; -+ } -+ #if defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) -+ #ifndef CONFIG_SDIO_TX_TASKLET -+ if (NULL == padapter->HalFunc.run_thread) { -+ rtw_hal_error_msg("run_thread"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.cancel_thread) { -+ rtw_hal_error_msg("cancel_thread"); -+ ret = _FAIL; -+ } -+ #endif -+ #endif -+ -+ /*** recv section ***/ -+ if (NULL == padapter->HalFunc.init_recv_priv) { -+ rtw_hal_error_msg("init_recv_priv"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.free_recv_priv) { -+ rtw_hal_error_msg("free_recv_priv"); -+ ret = _FAIL; -+ } -+ #if defined(CONFIG_USB_HCI) || defined (CONFIG_PCI_HCI) -+ if (NULL == padapter->HalFunc.inirp_init) { -+ rtw_hal_error_msg("inirp_init"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.inirp_deinit) { -+ rtw_hal_error_msg("inirp_deinit"); -+ ret = _FAIL; -+ } -+ #endif //#if defined(CONFIG_USB_HCI) || defined (CONFIG_PCI_HCI) -+ -+ -+ /*** interrupt hdl section ***/ -+ #if defined(CONFIG_PCI_HCI) -+ if (NULL == padapter->HalFunc.irp_reset) { -+ rtw_hal_error_msg("irp_reset"); -+ ret = _FAIL; -+ } -+ #endif/*#if defined(CONFIG_PCI_HCI)*/ -+ #if (defined(CONFIG_PCI_HCI)) || (defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT)) -+ if (NULL == padapter->HalFunc.interrupt_handler) { -+ rtw_hal_error_msg("interrupt_handler"); -+ ret = _FAIL; -+ } -+ #endif /*#if (defined(CONFIG_PCI_HCI)) || (defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT))*/ -+ -+ #if defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) -+ if (NULL == padapter->HalFunc.enable_interrupt) { -+ rtw_hal_error_msg("enable_interrupt"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.disable_interrupt) { -+ rtw_hal_error_msg("disable_interrupt"); -+ ret = _FAIL; -+ } -+ #endif //defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) -+ -+ -+ /*** DM section ***/ -+ if (NULL == padapter->HalFunc.dm_init) { -+ rtw_hal_error_msg("dm_init"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.dm_deinit) { -+ rtw_hal_error_msg("dm_deinit"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.hal_dm_watchdog) { -+ rtw_hal_error_msg("hal_dm_watchdog"); -+ ret = _FAIL; -+ } -+ #ifdef CONFIG_LPS_LCLK_WD_TIMER -+ if (NULL == padapter->HalFunc.hal_dm_watchdog_in_lps) { -+ rtw_hal_error_msg("hal_dm_watchdog_in_lps"); -+ ret = _FAIL; -+ } -+ #endif -+ -+ /*** xxx section ***/ -+ if (NULL == padapter->HalFunc.set_bwmode_handler) { -+ rtw_hal_error_msg("set_bwmode_handler"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->HalFunc.set_channel_handler) { -+ rtw_hal_error_msg("set_channel_handler"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->HalFunc.set_chnl_bw_handler) { -+ rtw_hal_error_msg("set_chnl_bw_handler"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->HalFunc.SetHwRegHandler) { -+ rtw_hal_error_msg("SetHwRegHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.GetHwRegHandler) { -+ rtw_hal_error_msg("GetHwRegHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.GetHalDefVarHandler) { -+ rtw_hal_error_msg("GetHalDefVarHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.SetHalDefVarHandler) { -+ rtw_hal_error_msg("SetHalDefVarHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.GetHalODMVarHandler) { -+ rtw_hal_error_msg("GetHalODMVarHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.SetHalODMVarHandler) { -+ rtw_hal_error_msg("SetHalODMVarHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.UpdateRAMaskHandler) { -+ rtw_hal_error_msg("UpdateRAMaskHandler"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->HalFunc.SetBeaconRelatedRegistersHandler) { -+ rtw_hal_error_msg("SetBeaconRelatedRegistersHandler"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->HalFunc.Add_RateATid) { -+ rtw_hal_error_msg("Add_RateATid"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->HalFunc.fill_h2c_cmd) { -+ rtw_hal_error_msg("fill_h2c_cmd"); -+ ret = _FAIL; -+ } -+ #if defined(CONFIG_LPS) || defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ if (NULL == padapter->HalFunc.fill_fake_txdesc) { -+ rtw_hal_error_msg("fill_fake_txdesc"); -+ ret = _FAIL; -+ } -+ #endif -+ if (NULL == padapter->HalFunc.hal_get_tx_buff_rsvd_page_num) { -+ rtw_hal_error_msg("hal_get_tx_buff_rsvd_page_num"); -+ ret = _FAIL; -+ } -+ -+ #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ if (NULL == padapter->HalFunc.clear_interrupt) { -+ rtw_hal_error_msg("clear_interrupt"); -+ ret = _FAIL; -+ } -+ #endif -+ if (NULL == padapter->HalFunc.hal_set_wowlan_fw) { -+ rtw_hal_error_msg("hal_set_wowlan_fw"); -+ ret = _FAIL; -+ } -+ #endif //CONFIG_WOWLAN -+ -+ -+ /*** SReset section ***/ -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ if (NULL == padapter->HalFunc.sreset_init_value) { -+ rtw_hal_error_msg("sreset_init_value"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.sreset_reset_value) { -+ rtw_hal_error_msg("sreset_reset_value"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.silentreset) { -+ rtw_hal_error_msg("silentreset"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.sreset_xmit_status_check) { -+ rtw_hal_error_msg("sreset_xmit_status_check"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.sreset_linked_status_check) { -+ rtw_hal_error_msg("sreset_linked_status_check"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.sreset_get_wifi_status) { -+ rtw_hal_error_msg("sreset_get_wifi_status"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.sreset_inprogress) { -+ rtw_hal_error_msg("sreset_inprogress"); -+ ret = _FAIL; -+ } -+ #endif //#ifdef DBG_CONFIG_ERROR_DETECT -+ -+#endif -+ return ret; -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_mp.c linux/3rdparty/rtl8812au/hal/hal_mp.c ---- linux.old/3rdparty/rtl8812au/hal/hal_mp.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/hal_mp.c 2017-06-07 23:07:21.014687849 +0300 -@@ -0,0 +1,1799 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _HAL_MP_C_ -+#ifdef CONFIG_MP_INCLUDED -+ -+#ifdef CONFIG_RTL8188E -+#include -+#endif -+#ifdef CONFIG_RTL8723B -+#include -+#endif -+#ifdef CONFIG_RTL8192E -+#include -+#endif -+#ifdef CONFIG_RTL8814A -+#include -+#endif -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+#include -+#endif -+#ifdef CONFIG_RTL8703B -+#include -+#endif -+#ifdef CONFIG_RTL8188F -+#include -+#endif -+ -+ -+u8 MgntQuery_NssTxRate(u16 Rate) -+{ -+ u8 NssNum = RF_TX_NUM_NONIMPLEMENT; -+ -+ if ((Rate >= MGN_MCS8 && Rate <= MGN_MCS15) || -+ (Rate >= MGN_VHT2SS_MCS0 && Rate <= MGN_VHT2SS_MCS9)) -+ NssNum = RF_2TX; -+ else if ((Rate >= MGN_MCS16 && Rate <= MGN_MCS23) || -+ (Rate >= MGN_VHT3SS_MCS0 && Rate <= MGN_VHT3SS_MCS9)) -+ NssNum = RF_3TX; -+ else if ((Rate >= MGN_MCS24 && Rate <= MGN_MCS31) || -+ (Rate >= MGN_VHT4SS_MCS0 && Rate <= MGN_VHT4SS_MCS9)) -+ NssNum = RF_4TX; -+ else -+ NssNum = RF_1TX; -+ -+ return NssNum; -+} -+ -+void hal_mpt_SwitchRfSetting(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u8 ChannelToSw = pMptCtx->MptChannelToSw; -+ ULONG ulRateIdx = pMptCtx->MptRateIndex; -+ ULONG ulbandwidth = pMptCtx->MptBandWidth; -+ -+ /* <20120525, Kordan> Dynamic mechanism for APK, asked by Dennis.*/ -+ if (IS_HARDWARE_TYPE_8188ES(pAdapter) && (1 <= ChannelToSw && ChannelToSw <= 11) && -+ (ulRateIdx == MPT_RATE_MCS0 || ulRateIdx == MPT_RATE_1M || ulRateIdx == MPT_RATE_6M)) { -+ pMptCtx->backup0x52_RF_A = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0); -+ pMptCtx->backup0x52_RF_B = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0); -+ -+ if ((PlatformEFIORead4Byte(pAdapter, 0xF4)&BIT29) == BIT29) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xB); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0xB); -+ } else { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xD); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0xD); -+ } -+ } else if (IS_HARDWARE_TYPE_8188EE(pAdapter)) { /* <20140903, VincentL> Asked by RF Eason and Edlu*/ -+ -+ if (ChannelToSw == 3 && ulbandwidth == MPT_BW_40MHZ) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xB); /*RF 0x52 = 0x0007E4BD*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0xB); /*RF 0x52 = 0x0007E4BD*/ -+ } else { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0x9); /*RF 0x52 = 0x0007E49D*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0x9); /*RF 0x52 = 0x0007E49D*/ -+ } -+ -+ } else if (IS_HARDWARE_TYPE_8188E(pAdapter)) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, pMptCtx->backup0x52_RF_A); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, pMptCtx->backup0x52_RF_B); -+ } -+} -+ -+s32 hal_mpt_SetPowerTracking(PADAPTER padapter, u8 enable) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ -+ if (!netif_running(padapter->pnetdev)) { -+ RT_TRACE(_module_mp_, _drv_warning_, ("SetPowerTracking! Fail: interface not opened!\n")); -+ return _FAIL; -+ } -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_MP_STATE) == _FALSE) { -+ RT_TRACE(_module_mp_, _drv_warning_, ("SetPowerTracking! Fail: not in MP mode!\n")); -+ return _FAIL; -+ } -+ if (enable) -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; -+ else -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _FALSE; -+ -+ return _SUCCESS; -+} -+ -+void hal_mpt_GetPowerTracking(PADAPTER padapter, u8 *enable) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ -+ *enable = pDM_Odm->RFCalibrateInfo.TxPowerTrackControl; -+} -+ -+ -+void hal_mpt_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14) -+{ -+ u32 TempVal = 0, TempVal2 = 0, TempVal3 = 0; -+ u32 CurrCCKSwingVal = 0, CCKSwingIndex = 12; -+ u8 i; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ u1Byte u1Channel = pHalData->CurrentChannel; -+ ULONG ulRateIdx = pMptCtx->MptRateIndex; -+ u1Byte DataRate = 0xFF; -+ -+ DataRate = MptToMgntRate(ulRateIdx); -+ -+ if (u1Channel == 14 && IS_CCK_RATE(DataRate)) -+ pHalData->bCCKinCH14 = TRUE; -+ else -+ pHalData->bCCKinCH14 = FALSE; -+ -+ if (IS_HARDWARE_TYPE_8703B(Adapter)) { -+ if ((u1Channel == 14) && IS_CCK_RATE(DataRate)) { -+ /* Channel 14 in CCK, need to set 0xA26~0xA29 to 0 for 8703B */ -+ PHY_SetBBReg(Adapter, rCCK0_TxFilter2, bMaskHWord, 0); -+ PHY_SetBBReg(Adapter, rCCK0_DebugPort, bMaskLWord, 0); -+ -+ RT_TRACE(_module_mp_, DBG_LOUD, ("MPT_CCKTxPowerAdjust 8703B CCK in Channel %u\n", u1Channel)); -+ } else { -+ /* Normal setting for 8703B, just recover to the default setting. */ -+ /* This hardcore values reference from the parameter which BB team gave. */ -+ for (i = 0 ; i < 2 ; ++i) -+ PHY_SetBBReg(Adapter, pHalData->RegForRecover[i].offset, bMaskDWord, pHalData->RegForRecover[i].value); -+ -+ RT_TRACE(_module_mp_, DBG_LOUD, ("MPT_CCKTxPowerAdjust 8703B in Channel %u restore to default setting\n", u1Channel)); -+ } -+ } else if (IS_HARDWARE_TYPE_8188F(Adapter)) { -+ /* No difference between CCK in CH14 and others, no need to change TX filter */ -+ } else { -+ -+ /* get current cck swing value and check 0xa22 & 0xa23 later to match the table.*/ -+ CurrCCKSwingVal = read_bbreg(Adapter, rCCK0_TxFilter1, bMaskHWord); -+ -+ if (!pHalData->bCCKinCH14) { -+ /* Readback the current bb cck swing value and compare with the table to */ -+ /* get the current swing index */ -+ for (i = 0; i < CCK_TABLE_SIZE; i++) { -+ if (((CurrCCKSwingVal&0xff) == (u32)CCKSwingTable_Ch1_Ch13[i][0]) && -+ (((CurrCCKSwingVal&0xff00)>>8) == (u32)CCKSwingTable_Ch1_Ch13[i][1])) { -+ CCKSwingIndex = i; -+ RT_TRACE(_module_mp_, DBG_LOUD, ("Ch1~13, Current reg0x%x = 0x%lx, CCKSwingIndex=0x%x\n", -+ (rCCK0_TxFilter1+2), CurrCCKSwingVal, CCKSwingIndex)); -+ break; -+ } -+ } -+ -+ /*Write 0xa22 0xa23*/ -+ TempVal = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][0] + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][1]<<8); -+ -+ -+ /*Write 0xa24 ~ 0xa27*/ -+ TempVal2 = 0; -+ TempVal2 = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][2] + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][3]<<8) + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][4]<<16) + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][5]<<24); -+ -+ /*Write 0xa28 0xa29*/ -+ TempVal3 = 0; -+ TempVal3 = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][6] + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][7]<<8); -+ } else { -+ for (i = 0; i < CCK_TABLE_SIZE; i++) { -+ if (((CurrCCKSwingVal&0xff) == (u32)CCKSwingTable_Ch14[i][0]) && -+ (((CurrCCKSwingVal&0xff00)>>8) == (u32)CCKSwingTable_Ch14[i][1])) { -+ CCKSwingIndex = i; -+ RT_TRACE(_module_mp_, DBG_LOUD, ("Ch14, Current reg0x%x = 0x%lx, CCKSwingIndex=0x%x\n", -+ (rCCK0_TxFilter1+2), CurrCCKSwingVal, CCKSwingIndex)); -+ break; -+ } -+ } -+ -+ /*Write 0xa22 0xa23*/ -+ TempVal = CCKSwingTable_Ch14[CCKSwingIndex][0] + -+ (CCKSwingTable_Ch14[CCKSwingIndex][1]<<8); -+ -+ /*Write 0xa24 ~ 0xa27*/ -+ TempVal2 = 0; -+ TempVal2 = CCKSwingTable_Ch14[CCKSwingIndex][2] + -+ (CCKSwingTable_Ch14[CCKSwingIndex][3]<<8) + -+ (CCKSwingTable_Ch14[CCKSwingIndex][4]<<16) + -+ (CCKSwingTable_Ch14[CCKSwingIndex][5]<<24); -+ -+ /*Write 0xa28 0xa29*/ -+ TempVal3 = 0; -+ TempVal3 = CCKSwingTable_Ch14[CCKSwingIndex][6] + -+ (CCKSwingTable_Ch14[CCKSwingIndex][7]<<8); -+ } -+ -+ write_bbreg(Adapter, rCCK0_TxFilter1, bMaskHWord, TempVal); -+ write_bbreg(Adapter, rCCK0_TxFilter2, bMaskDWord, TempVal2); -+ write_bbreg(Adapter, rCCK0_DebugPort, bMaskLWord, TempVal3); -+ -+ } -+ -+} -+ -+void hal_mpt_SetChannel(PADAPTER pAdapter) -+{ -+ u8 eRFPath; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ struct mp_priv *pmp = &pAdapter->mppriv; -+ u8 channel = pmp->channel; -+ u8 bandwidth = pmp->bandwidth; -+ u8 rate = pmp->rateidx; -+ -+ hal_mpt_SwitchRfSetting(pAdapter); -+ -+ SelectChannel(pAdapter, channel); -+ -+ pHalData->bSwChnl = _TRUE; -+ pHalData->bSetChnlBW = _TRUE; -+ rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, 0, 0); -+ -+ hal_mpt_CCKTxPowerAdjust(pAdapter, pHalData->bCCKinCH14); -+ -+} -+ -+/* -+ * Notice -+ * Switch bandwitdth may change center frequency(channel) -+ */ -+void hal_mpt_SetBandwidth(PADAPTER pAdapter) -+{ -+ struct mp_priv *pmp = &pAdapter->mppriv; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ u8 channel = pmp->channel; -+ u8 bandwidth = pmp->bandwidth; -+ -+ SetBWMode(pAdapter, pmp->bandwidth, pmp->prime_channel_offset); -+ pHalData->bSwChnl = _TRUE; -+ pHalData->bSetChnlBW = _TRUE; -+ rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, 0, 0); -+ -+ hal_mpt_SwitchRfSetting(pAdapter); -+} -+ -+void mpt_SetTxPower_Old(PADAPTER pAdapter, MPT_TXPWR_DEF Rate, u8 *pTxPower) -+{ -+ RT_TRACE(_module_mp_, DBG_LOUD, ("===>mpt_SetTxPower_Old(): Case = %d\n", Rate)); -+ switch (Rate) { -+ case MPT_CCK: -+ { -+ u4Byte TxAGC = 0, pwr = 0; -+ u1Byte rf; -+ -+ pwr = pTxPower[ODM_RF_PATH_A]; -+ if (pwr < 0x3f) { -+ TxAGC = (pwr<<16)|(pwr<<8)|(pwr); -+ PHY_SetBBReg(pAdapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, pTxPower[ODM_RF_PATH_A]); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, 0xffffff00, TxAGC); -+ } -+ pwr = pTxPower[ODM_RF_PATH_B]; -+ if (pwr < 0x3f) { -+ TxAGC = (pwr<<16)|(pwr<<8)|(pwr); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte0, pTxPower[ODM_RF_PATH_B]); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_CCK1_55_Mcs32, 0xffffff00, TxAGC); -+ } -+ -+ } break; -+ -+ case MPT_OFDM_AND_HT: -+ { -+ u4Byte TxAGC = 0; -+ u1Byte pwr = 0, rf; -+ -+ pwr = pTxPower[0]; -+ if (pwr < 0x3f) { -+ TxAGC |= ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); -+ DBG_871X("HT Tx-rf(A) Power = 0x%x\n", TxAGC); -+ -+ PHY_SetBBReg(pAdapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs11_Mcs08, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs15_Mcs12, bMaskDWord, TxAGC); -+ } -+ TxAGC = 0; -+ pwr = pTxPower[1]; -+ if (pwr < 0x3f) { -+ TxAGC |= ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); -+ DBG_871X("HT Tx-rf(B) Power = 0x%x\n", TxAGC); -+ -+ PHY_SetBBReg(pAdapter, rTxAGC_B_Rate18_06, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_Rate54_24, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs03_Mcs00, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs07_Mcs04, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs11_Mcs08, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs15_Mcs12, bMaskDWord, TxAGC); -+ } -+ } break; -+ -+ default: -+ break; -+ } -+ DBG_871X("<===mpt_SetTxPower_Old()\n"); -+} -+ -+ -+ -+void -+mpt_SetTxPower( -+ PADAPTER pAdapter, -+ MPT_TXPWR_DEF Rate, -+ pu1Byte pTxPower -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ u1Byte path = 0 , i = 0, MaxRate = MGN_6M; -+ u1Byte StartPath = ODM_RF_PATH_A, EndPath = ODM_RF_PATH_B; -+ -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ EndPath = ODM_RF_PATH_D; -+ -+ switch (Rate) { -+ case MPT_CCK: -+ { -+ u1Byte rate[] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}; -+ -+ for (path = StartPath; path <= EndPath; path++) -+ for (i = 0; i < sizeof(rate); ++i) -+ PHY_SetTxPowerIndex(pAdapter, pTxPower[path], path, rate[i]); -+ } -+ break; -+ -+ case MPT_OFDM: -+ { -+ u1Byte rate[] = { -+ MGN_6M, MGN_9M, MGN_12M, MGN_18M, -+ MGN_24M, MGN_36M, MGN_48M, MGN_54M, -+ }; -+ -+ for (path = StartPath; path <= EndPath; path++) -+ for (i = 0; i < sizeof(rate); ++i) -+ PHY_SetTxPowerIndex(pAdapter, pTxPower[path], path, rate[i]); -+ } break; -+ -+ case MPT_HT: -+ { -+ u1Byte rate[] = { -+ MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, -+ MGN_MCS5, MGN_MCS6, MGN_MCS7, MGN_MCS8, MGN_MCS9, -+ MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, -+ MGN_MCS15, MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, -+ MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23, MGN_MCS24, -+ MGN_MCS25, MGN_MCS26, MGN_MCS27, MGN_MCS28, MGN_MCS29, -+ MGN_MCS30, MGN_MCS31, -+ }; -+ if (pHalData->rf_type == RF_3T3R) -+ MaxRate = MGN_MCS23; -+ else if (pHalData->rf_type == RF_2T2R) -+ MaxRate = MGN_MCS15; -+ else -+ MaxRate = MGN_MCS7; -+ -+ for (path = StartPath; path <= EndPath; path++) { -+ for (i = 0; i < sizeof(rate); ++i) { -+ if (rate[i] > MaxRate) -+ break; -+ PHY_SetTxPowerIndex(pAdapter, pTxPower[path], path, rate[i]); -+ } -+ } -+ } break; -+ -+ case MPT_VHT: -+ { -+ u1Byte rate[] = { -+ MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4, -+ MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9, -+ MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, -+ MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9, -+ MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4, -+ MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9, -+ MGN_VHT4SS_MCS0, MGN_VHT4SS_MCS1, MGN_VHT4SS_MCS2, MGN_VHT4SS_MCS3, MGN_VHT4SS_MCS4, -+ MGN_VHT4SS_MCS5, MGN_VHT4SS_MCS6, MGN_VHT4SS_MCS7, MGN_VHT4SS_MCS8, MGN_VHT4SS_MCS9, -+ }; -+ -+ if (pHalData->rf_type == RF_3T3R) -+ MaxRate = MGN_VHT3SS_MCS9; -+ else if (pHalData->rf_type == RF_2T2R || pHalData->rf_type == RF_2T4R) -+ MaxRate = MGN_VHT2SS_MCS9; -+ else -+ MaxRate = MGN_VHT1SS_MCS9; -+ -+ for (path = StartPath; path <= EndPath; path++) { -+ for (i = 0; i < sizeof(rate); ++i) { -+ if (rate[i] > MaxRate) -+ break; -+ PHY_SetTxPowerIndex(pAdapter, pTxPower[path], path, rate[i]); -+ } -+ } -+ } break; -+ -+ default: -+ DBG_871X("<===mpt_SetTxPower: Illegal channel!!\n"); -+ break; -+ } -+ -+} -+ -+ -+void hal_mpt_SetTxPower(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ if (pHalData->rf_chip < RF_TYPE_MAX) { -+ if (IS_HARDWARE_TYPE_8188E(pAdapter) || -+ IS_HARDWARE_TYPE_8723B(pAdapter) || -+ IS_HARDWARE_TYPE_8192E(pAdapter) || -+ IS_HARDWARE_TYPE_8703B(pAdapter) || -+ IS_HARDWARE_TYPE_8188F(pAdapter)) { -+ u8 path = (pHalData->AntennaTxPath == ANTENNA_A) ? (ODM_RF_PATH_A) : (ODM_RF_PATH_B); -+ -+ DBG_8192C("===> MPT_ProSetTxPower: Old\n"); -+ -+ RT_TRACE(_module_mp_, DBG_LOUD, ("===> MPT_ProSetTxPower[Old]:\n")); -+ mpt_SetTxPower_Old(pAdapter, MPT_CCK, pMptCtx->TxPwrLevel); -+ mpt_SetTxPower_Old(pAdapter, MPT_OFDM_AND_HT, pMptCtx->TxPwrLevel); -+ -+ } else { -+ DBG_871X("===> MPT_ProSetTxPower: Jaguar\n"); -+ mpt_SetTxPower(pAdapter, MPT_CCK, pMptCtx->TxPwrLevel); -+ mpt_SetTxPower(pAdapter, MPT_OFDM, pMptCtx->TxPwrLevel); -+ mpt_SetTxPower(pAdapter, MPT_HT, pMptCtx->TxPwrLevel); -+ mpt_SetTxPower(pAdapter, MPT_VHT, pMptCtx->TxPwrLevel); -+ -+ } -+ } else -+ DBG_8192C("RFChipID < RF_TYPE_MAX, the RF chip is not supported - %d\n", pHalData->rf_chip); -+ -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+ -+} -+ -+ -+void hal_mpt_SetDataRate(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u32 DataRate; -+ -+ DataRate = MptToMgntRate(pAdapter->mppriv.rateidx); -+ -+ hal_mpt_SwitchRfSetting(pAdapter); -+ -+ hal_mpt_CCKTxPowerAdjust(pAdapter, pHalData->bCCKinCH14); -+#ifdef CONFIG_RTL8723B -+ if (IS_HARDWARE_TYPE_8723B(pAdapter) || IS_HARDWARE_TYPE_8188F(pAdapter)) { -+ if (IS_CCK_RATE(DataRate)) { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, 0xF, 0x6); -+ else -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0x6); -+ } else { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, 0xF, 0xE); -+ else -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0xE); -+ } -+ } -+ -+ if ((IS_HARDWARE_TYPE_8723BS(pAdapter) && -+ ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)))) { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, 0xF, 0xE); -+ else -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0xE); -+ } -+#endif -+} -+ -+ -+#define RF_PATH_AB 22 -+ -+#ifdef CONFIG_RTL8814A -+VOID mpt_ToggleIG_8814A(PADAPTER pAdapter) -+{ -+ u1Byte Path = 0; -+ u4Byte IGReg = rA_IGI_Jaguar, IGvalue = 0; -+ -+ for (Path; Path <= ODM_RF_PATH_D; Path++) { -+ switch (Path) { -+ case ODM_RF_PATH_B: -+ IGReg = rB_IGI_Jaguar; -+ break; -+ case ODM_RF_PATH_C: -+ IGReg = rC_IGI_Jaguar2; -+ break; -+ case ODM_RF_PATH_D: -+ IGReg = rD_IGI_Jaguar2; -+ break; -+ default: -+ IGReg = rA_IGI_Jaguar; -+ break; -+ } -+ -+ IGvalue = PHY_QueryBBReg(pAdapter, IGReg, bMaskByte0); -+ PHY_SetBBReg(pAdapter, IGReg, bMaskByte0, IGvalue+2); -+ PHY_SetBBReg(pAdapter, IGReg, bMaskByte0, IGvalue); -+ } -+} -+ -+VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; -+ R_ANTENNA_SELECT_OFDM *p_ofdm_tx; /* OFDM Tx register */ -+ R_ANTENNA_SELECT_CCK *p_cck_txrx; -+ -+ u8 ForcedDataRate = HwRateToMRate(pAdapter->mppriv.rateidx); -+ u8 HtStbcCap = pAdapter->registrypriv.stbc_cap; -+ /*/PRT_HIGH_THROUGHPUT pHTInfo = GET_HT_INFO(pMgntInfo);*/ -+ /*/PRT_VERY_HIGH_THROUGHPUT pVHTInfo = GET_VHT_INFO(pMgntInfo);*/ -+ -+ u32 ulAntennaTx = pHalData->AntennaTxPath; -+ u32 ulAntennaRx = pHalData->AntennaRxPath; -+ u8 NssforRate = MgntQuery_NssTxRate(ForcedDataRate); -+ -+ if (NssforRate == RF_2TX) { -+ DBG_871X("===> SetAntenna 2T ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_BC: -+ pMptCtx->MptRfPath = ODM_RF_PATH_BC; -+ /*pHalData->ValidTxPath = 0x06; linux no use */ -+ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x106); /*/ 0x940[15:4]=12'b0000_0100_0011*/ -+ break; -+ -+ case ANTENNA_CD: -+ pMptCtx->MptRfPath = ODM_RF_PATH_CD; -+ /*pHalData->ValidTxPath = 0x0C;*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x40c); /*/ 0x940[15:4]=12'b0000_0100_0011*/ -+ break; -+ case ANTENNA_AB: default: -+ pMptCtx->MptRfPath = ODM_RF_PATH_AB; -+ /*pHalData->ValidTxPath = 0x03;*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x043); /*/ 0x940[15:4]=12'b0000_0100_0011*/ -+ break; -+ } -+ -+ } else if (NssforRate == RF_3TX) { -+ DBG_871X("===> SetAntenna 3T ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_BCD: -+ pMptCtx->MptRfPath = ODM_RF_PATH_BCD; -+ /*pHalData->ValidTxPath = 0x0e;*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0fff0000, 0x90e); /*/ 0x940[27:16]=12'b0010_0100_0111*/ -+ break; -+ -+ case ANTENNA_ABC: default: -+ pMptCtx->MptRfPath = ODM_RF_PATH_ABC; -+ /*pHalData->ValidTxPath = 0x0d;*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0fff0000, 0x247); /*/ 0x940[27:16]=12'b0010_0100_0111*/ -+ break; -+ } -+ -+ } else { /*/if(NssforRate == RF_1TX)*/ -+ DBG_871X("===> SetAntenna 1T ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); -+ switch (ulAntennaTx) { -+ case ANTENNA_B: -+ pMptCtx->MptRfPath = ODM_RF_PATH_B; -+ /*pHalData->ValidTxPath = 0x02;*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x4); /*/ 0xa07[7:4] = 4'b0100*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x002); /*/ 0x93C[31:20]=12'b0000_0000_0010*/ -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x2); /* 0x80C[7:4] = 4'b0010*/ -+ break; -+ -+ case ANTENNA_C: -+ pMptCtx->MptRfPath = ODM_RF_PATH_C; -+ /*pHalData->ValidTxPath = 0x04;*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x2); /*/ 0xa07[7:4] = 4'b0010*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x004); /*/ 0x93C[31:20]=12'b0000_0000_0100*/ -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x4); /*/ 0x80C[7:4] = 4'b0100*/ -+ break; -+ -+ case ANTENNA_D: -+ pMptCtx->MptRfPath = ODM_RF_PATH_D; -+ /*pHalData->ValidTxPath = 0x08;*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x1); /*/ 0xa07[7:4] = 4'b0001*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x008); /*/ 0x93C[31:20]=12'b0000_0000_1000*/ -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x8); /*/ 0x80C[7:4] = 4'b1000*/ -+ break; -+ -+ case ANTENNA_A: default: -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; -+ /*pHalData->ValidTxPath = 0x01;*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x8); /*/ 0xa07[7:4] = 4'b1000*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x001); /*/ 0x93C[31:20]=12'b0000_0000_0001*/ -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x1); /*/ 0x80C[7:4] = 4'b0001*/ -+ break; -+ } -+ } -+ -+ switch (ulAntennaRx) { -+ case ANTENNA_A: -+ /*pHalData->ValidRxPath = 0x01;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x0); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_B: -+ /*pHalData->ValidRxPath = 0x02;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x1); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_C: -+ /*pHalData->ValidRxPath = 0x04;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x44); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x2); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_D: -+ /*pHalData->ValidRxPath = 0x08;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x88); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x3); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_BC: -+ /*pHalData->ValidRxPath = 0x06;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x66); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x6); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_CD: -+ /*pHalData->ValidRxPath = 0x0C;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xcc); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0xB); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_BCD: -+ /*pHalData->ValidRxPath = 0x0e;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xee); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x6); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, Rx mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0x8); -+ break; -+ -+ case ANTENNA_ABCD: -+ /*pHalData->ValidRxPath = 0x0f;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xff); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x1); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0x8); -+ break; -+ -+ default: -+ RT_TRACE(_module_mp_, _drv_warning_, ("Unknown Rx antenna.\n")); -+ break; -+ } -+ -+ PHY_Set_SecCCATH_by_RXANT_8814A(pAdapter, ulAntennaRx); -+ -+ mpt_ToggleIG_8814A(pAdapter); -+ RT_TRACE(_module_mp_, _drv_notice_, ("-SwitchAntenna: finished\n")); -+} -+ -+VOID -+mpt_SetSingleTone_8814A( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bSingleTone, -+ IN BOOLEAN bEnPMacTx) -+{ -+ -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u1Byte StartPath = ODM_RF_PATH_A, EndPath = ODM_RF_PATH_A; -+ static u4Byte regIG0 = 0, regIG1 = 0, regIG2 = 0, regIG3 = 0; -+ -+ if (bSingleTone) { -+ regIG0 = PHY_QueryBBReg(pAdapter, rA_TxScale_Jaguar, bMaskDWord); /*/ 0xC1C[31:21]*/ -+ regIG1 = PHY_QueryBBReg(pAdapter, rB_TxScale_Jaguar, bMaskDWord); /*/ 0xE1C[31:21]*/ -+ regIG2 = PHY_QueryBBReg(pAdapter, rC_TxScale_Jaguar2, bMaskDWord); /*/ 0x181C[31:21]*/ -+ regIG3 = PHY_QueryBBReg(pAdapter, rD_TxScale_Jaguar2, bMaskDWord); /*/ 0x1A1C[31:21]*/ -+ -+ switch (pMptCtx->MptRfPath) { -+ case ODM_RF_PATH_A: case ODM_RF_PATH_B: -+ case ODM_RF_PATH_C: case ODM_RF_PATH_D: -+ StartPath = pMptCtx->MptRfPath; -+ EndPath = pMptCtx->MptRfPath; -+ break; -+ case ODM_RF_PATH_AB: -+ EndPath = ODM_RF_PATH_B; -+ break; -+ case ODM_RF_PATH_BC: -+ StartPath = ODM_RF_PATH_B; -+ EndPath = ODM_RF_PATH_C; -+ break; -+ case ODM_RF_PATH_ABC: -+ EndPath = ODM_RF_PATH_C; -+ break; -+ case ODM_RF_PATH_BCD: -+ StartPath = ODM_RF_PATH_B; -+ EndPath = ODM_RF_PATH_D; -+ break; -+ case ODM_RF_PATH_ABCD: -+ EndPath = ODM_RF_PATH_D; -+ break; -+ } -+ -+ if (bEnPMacTx == FALSE) { -+ hal_mpt_SetOFDMContinuousTx(pAdapter, _TRUE); -+ issue_nulldata(pAdapter, NULL, 1, 3, 500); -+ } -+ -+ PHY_SetBBReg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); /*/ Disable CCA*/ -+ -+ for (StartPath; StartPath <= EndPath; StartPath++) { -+ PHY_SetRFReg(pAdapter, StartPath, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ -+ PHY_SetRFReg(pAdapter, StartPath, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ -+ -+ PHY_SetRFReg(pAdapter, StartPath, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ -+ } -+ -+ PHY_SetBBReg(pAdapter, rA_TxScale_Jaguar, 0xFFE00000, 0); /*/ 0xC1C[31:21]*/ -+ PHY_SetBBReg(pAdapter, rB_TxScale_Jaguar, 0xFFE00000, 0); /*/ 0xE1C[31:21]*/ -+ PHY_SetBBReg(pAdapter, rC_TxScale_Jaguar2, 0xFFE00000, 0); /*/ 0x181C[31:21]*/ -+ PHY_SetBBReg(pAdapter, rD_TxScale_Jaguar2, 0xFFE00000, 0); /*/ 0x1A1C[31:21]*/ -+ -+ } else { -+ -+ switch (pMptCtx->MptRfPath) { -+ case ODM_RF_PATH_A: case ODM_RF_PATH_B: -+ case ODM_RF_PATH_C: case ODM_RF_PATH_D: -+ StartPath = pMptCtx->MptRfPath; -+ EndPath = pMptCtx->MptRfPath; -+ break; -+ case ODM_RF_PATH_AB: -+ EndPath = ODM_RF_PATH_B; -+ break; -+ case ODM_RF_PATH_BC: -+ StartPath = ODM_RF_PATH_B; -+ EndPath = ODM_RF_PATH_C; -+ break; -+ case ODM_RF_PATH_ABC: -+ EndPath = ODM_RF_PATH_C; -+ break; -+ case ODM_RF_PATH_BCD: -+ StartPath = ODM_RF_PATH_B; -+ EndPath = ODM_RF_PATH_D; -+ break; -+ case ODM_RF_PATH_ABCD: -+ EndPath = ODM_RF_PATH_D; -+ break; -+ } -+ -+ for (StartPath; StartPath <= EndPath; StartPath++) -+ PHY_SetRFReg(pAdapter, StartPath, LNA_Low_Gain_3, BIT1, 0x0); /*// RF LO disabled*/ -+ -+ -+ PHY_SetBBReg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); /* Enable CCA*/ -+ -+ if (bEnPMacTx == FALSE) -+ hal_mpt_SetOFDMContinuousTx(pAdapter, _FALSE); -+ -+ PHY_SetBBReg(pAdapter, rA_TxScale_Jaguar, bMaskDWord, regIG0); /* 0xC1C[31:21]*/ -+ PHY_SetBBReg(pAdapter, rB_TxScale_Jaguar, bMaskDWord, regIG1); /* 0xE1C[31:21]*/ -+ PHY_SetBBReg(pAdapter, rC_TxScale_Jaguar2, bMaskDWord, regIG2); /* 0x181C[31:21]*/ -+ PHY_SetBBReg(pAdapter, rD_TxScale_Jaguar2, bMaskDWord, regIG3); /* 0x1A1C[31:21]*/ -+ } -+} -+ -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+void mpt_SetRFPath_8812A(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; -+ u32 ulAntennaTx, ulAntennaRx; -+ -+ ulAntennaTx = pHalData->AntennaTxPath; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_A: -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x1111); -+ if (pHalData->RFEType == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) -+ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0); -+ break; -+ case ANTENNA_B: -+ pMptCtx->MptRfPath = ODM_RF_PATH_B; -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x2222); -+ if (pHalData->RFEType == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) -+ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x1); -+ break; -+ case ANTENNA_AB: -+ pMptCtx->MptRfPath = ODM_RF_PATH_AB; -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x3333); -+ if (pHalData->RFEType == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) -+ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0); -+ break; -+ default: -+ pMptCtx->MptRfPath = ODM_RF_PATH_AB; -+ DBG_871X("Unknown Tx antenna.\n"); -+ break; -+ } -+ -+ switch (ulAntennaRx) { -+ u32 reg0xC50 = 0; -+ case ANTENNA_A: -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, BIT19|BIT18|BIT17|BIT16, 0x3); -+ -+ /*/ <20121101, Kordan> To prevent gain table from not switched, asked by Ynlin.*/ -+ reg0xC50 = PHY_QueryBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0); -+ PHY_SetBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50+2); -+ PHY_SetBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50); -+ break; -+ case ANTENNA_B: -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1);/*/ RF_A_0x0[19:16] = 1, Standby mode */ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x1); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, BIT19|BIT18|BIT17|BIT16, 0x3); -+ -+ /*/ <20121101, Kordan> To prevent gain table from not switched, asked by Ynlin.*/ -+ reg0xC50 = PHY_QueryBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0); -+ PHY_SetBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50+2); -+ PHY_SetBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50); -+ break; -+ case ANTENNA_AB: -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x33); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, Rx mode*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); -+ break; -+ default: -+ DBG_871X("Unknown Rx antenna.\n"); -+ break; -+ } -+ RT_TRACE(_module_mp_, _drv_notice_, ("-SwitchAntenna: finished\n")); -+} -+#endif -+ -+ -+#ifdef CONFIG_RTL8723B -+void mpt_SetRFPath_8723B(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u32 ulAntennaTx, ulAntennaRx; -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ulAntennaTx = pHalData->AntennaTxPath; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ -+ if (pHalData->rf_chip >= RF_TYPE_MAX) { -+ DBG_8192C("This RF chip ID is not supported\n"); -+ return; -+ } -+ -+ switch (pAdapter->mppriv.antenna_tx) { -+ u8 p = 0, i = 0; -+ case ANTENNA_A: /*/ Actually path S1 (Wi-Fi)*/ -+ { -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; -+ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7, 0x0); -+ PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x0); /* AGC Table Sel*/ -+ -+ /*/<20130522, Kordan> 0x51 and 0x71 should be set immediately after path switched, or they might be overwritten.*/ -+ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)) -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); -+ else -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); -+ -+ -+ for (i = 0; i < 3; ++i) { -+ u4Byte offset = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_A][i][0]; -+ u4Byte data = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_A][i][1]; -+ -+ if (offset != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ DBG_8192C("Switch to S1 TxIQC(offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ -+ } -+ for (i = 0; i < 2; ++i) { -+ u4Byte offset = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_A][i][0]; -+ u4Byte data = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_A][i][1]; -+ -+ if (offset != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ DBG_8192C("Switch to S1 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ } -+ break; -+ case ANTENNA_B: /*/ Actually path S0 (BT)*/ -+ { -+ u4Byte offset; -+ u4Byte data; -+ -+ pMptCtx->MptRfPath = ODM_RF_PATH_B; -+ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7, 0x5); -+ PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x1); /*/ AGC Table Sel.*/ -+ -+ /* <20130522, Kordan> 0x51 and 0x71 should be set immediately after path switched, or they might be overwritten.*/ -+ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)) -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); -+ else -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); -+ -+ for (i = 0; i < 3; ++i) { -+ /*/ <20130603, Kordan> Because BB suppors only 1T1R, we restore IQC to S1 instead of S0.*/ -+ offset = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_A][i][0]; -+ data = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_B][i][1]; -+ if (pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_B][i][0] != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ DBG_8192C("Switch to S0 TxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ /*/ <20130603, Kordan> Because BB suppors only 1T1R, we restore IQC to S1 instead of S0.*/ -+ for (i = 0; i < 2; ++i) { -+ offset = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_A][i][0]; -+ data = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_B][i][1]; -+ -+ if (pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_B][i][0] != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ DBG_8192C("Switch to S0 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ } -+ break; -+ default: -+ pMptCtx->MptRfPath = RF_PATH_AB; -+ RT_TRACE(_module_mp_, _drv_notice_, ("Unknown Tx antenna.\n")); -+ break; -+ } -+ RT_TRACE(_module_mp_, _drv_notice_, ("-SwitchAntenna: finished\n")); -+} -+#endif -+ -+#ifdef CONFIG_RTL8703B -+void mpt_SetRFPath_8703B(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u4Byte ulAntennaTx, ulAntennaRx; -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ulAntennaTx = pHalData->AntennaTxPath; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ -+ if (pHalData->rf_chip >= RF_TYPE_MAX) { -+ DBG_871X("This RF chip ID is not supported\n"); -+ return; -+ } -+ -+ switch (pAdapter->mppriv.antenna_tx) { -+ u1Byte p = 0, i = 0; -+ -+ case ANTENNA_A: /* Actually path S1 (Wi-Fi) */ -+ { -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; -+ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7, 0x0); -+ PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x0); /* AGC Table Sel*/ -+ -+ for (i = 0; i < 3; ++i) { -+ u4Byte offset = pRFCalibrateInfo->TxIQC_8703B[i][0]; -+ u4Byte data = pRFCalibrateInfo->TxIQC_8703B[i][1]; -+ -+ if (offset != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ DBG_871X("Switch to S1 TxIQC(offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ -+ } -+ for (i = 0; i < 2; ++i) { -+ u4Byte offset = pRFCalibrateInfo->RxIQC_8703B[i][0]; -+ u4Byte data = pRFCalibrateInfo->RxIQC_8703B[i][1]; -+ -+ if (offset != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ DBG_871X("Switch to S1 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ } -+ break; -+ case ANTENNA_B: /* Actually path S0 (BT)*/ -+ { -+ pMptCtx->MptRfPath = ODM_RF_PATH_B; -+ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7, 0x5); -+ PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x1); /* AGC Table Sel */ -+ -+ for (i = 0; i < 3; ++i) { -+ u4Byte offset = pRFCalibrateInfo->TxIQC_8703B[i][0]; -+ u4Byte data = pRFCalibrateInfo->TxIQC_8703B[i][1]; -+ -+ if (pRFCalibrateInfo->TxIQC_8703B[i][0] != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ DBG_871X("Switch to S0 TxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ for (i = 0; i < 2; ++i) { -+ u4Byte offset = pRFCalibrateInfo->RxIQC_8703B[i][0]; -+ u4Byte data = pRFCalibrateInfo->RxIQC_8703B[i][1]; -+ -+ if (pRFCalibrateInfo->RxIQC_8703B[i][0] != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ DBG_871X("Switch to S0 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ } -+ break; -+ default: -+ pMptCtx->MptRfPath = RF_PATH_AB; -+ RT_TRACE(_module_mp_, _drv_notice_, ("Unknown Tx antenna.\n")); -+ break; -+ } -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("-SwitchAntenna: finished\n")); -+} -+#endif -+ -+ -+VOID mpt_SetRFPath_819X(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u4Byte ulAntennaTx, ulAntennaRx; -+ R_ANTENNA_SELECT_OFDM *p_ofdm_tx; /* OFDM Tx register */ -+ R_ANTENNA_SELECT_CCK *p_cck_txrx; -+ u1Byte r_rx_antenna_ofdm = 0, r_ant_select_cck_val = 0; -+ u1Byte chgTx = 0, chgRx = 0; -+ u4Byte r_ant_sel_cck_val = 0, r_ant_select_ofdm_val = 0, r_ofdm_tx_en_val = 0; -+ -+ ulAntennaTx = pHalData->AntennaTxPath; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ -+ p_ofdm_tx = (R_ANTENNA_SELECT_OFDM *)&r_ant_select_ofdm_val; -+ p_cck_txrx = (R_ANTENNA_SELECT_CCK *)&r_ant_select_cck_val; -+ -+ p_ofdm_tx->r_ant_ht1 = 0x1; -+ p_ofdm_tx->r_ant_ht2 = 0x2;/*Second TX RF path is A*/ -+ p_ofdm_tx->r_ant_non_ht = 0x3;/*/ 0x1+0x2=0x3 */ -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_A: -+ p_ofdm_tx->r_tx_antenna = 0x1; -+ r_ofdm_tx_en_val = 0x1; -+ p_ofdm_tx->r_ant_l = 0x1; -+ p_ofdm_tx->r_ant_ht_s1 = 0x1; -+ p_ofdm_tx->r_ant_non_ht_s1 = 0x1; -+ p_cck_txrx->r_ccktx_enable = 0x8; -+ chgTx = 1; -+ /*/ From SD3 Willis suggestion !!! Set RF A=TX and B as standby*/ -+ /*/if (IS_HARDWARE_TYPE_8192S(pAdapter))*/ -+ { -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 2); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 1); -+ r_ofdm_tx_en_val = 0x3; -+ /*/ Power save*/ -+ /*/cosa r_ant_select_ofdm_val = 0x11111111;*/ -+ /*/ We need to close RFB by SW control*/ -+ if (pHalData->rf_type == RF_2T2R) { -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 1); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 1); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 0); -+ } -+ } -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; -+ break; -+ case ANTENNA_B: -+ p_ofdm_tx->r_tx_antenna = 0x2; -+ r_ofdm_tx_en_val = 0x2; -+ p_ofdm_tx->r_ant_l = 0x2; -+ p_ofdm_tx->r_ant_ht_s1 = 0x2; -+ p_ofdm_tx->r_ant_non_ht_s1 = 0x2; -+ p_cck_txrx->r_ccktx_enable = 0x4; -+ chgTx = 1; -+ /*/ From SD3 Willis suggestion !!! Set RF A as standby*/ -+ /*/if (IS_HARDWARE_TYPE_8192S(pAdapter))*/ -+ { -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 1); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 2); -+ -+ /*/ 2008/10/31 MH From SD3 Willi's suggestion. We must read RF 1T table.*/ -+ /*/ 2009/01/08 MH From Sd3 Willis. We need to close RFA by SW control*/ -+ if (pHalData->rf_type == RF_2T2R || pHalData->rf_type == RF_1T2R) { -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 1); -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_RFInterfaceOE, BIT10, 0); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0); -+ /*/PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0);*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 0); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); -+ } -+ } -+ pMptCtx->MptRfPath = ODM_RF_PATH_B; -+ break; -+ case ANTENNA_AB:/*/ For 8192S*/ -+ p_ofdm_tx->r_tx_antenna = 0x3; -+ r_ofdm_tx_en_val = 0x3; -+ p_ofdm_tx->r_ant_l = 0x3; -+ p_ofdm_tx->r_ant_ht_s1 = 0x3; -+ p_ofdm_tx->r_ant_non_ht_s1 = 0x3; -+ p_cck_txrx->r_ccktx_enable = 0xC; -+ chgTx = 1; -+ /*/ From SD3Willis suggestion !!! Set RF B as standby*/ -+ /*/if (IS_HARDWARE_TYPE_8192S(pAdapter))*/ -+ { -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 2); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 2); -+ /* Disable Power save*/ -+ /*cosa r_ant_select_ofdm_val = 0x3321333;*/ -+ /* 2009/01/08 MH From Sd3 Willis. We need to enable RFA/B by SW control*/ -+ if (pHalData->rf_type == RF_2T2R) { -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0); -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0); -+ /*/PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0);*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 1); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); -+ } -+ } -+ pMptCtx->MptRfPath = ODM_RF_PATH_AB; -+ break; -+ default: -+ break; -+ } -+ -+ -+ -+/*// r_rx_antenna_ofdm, bit0=A, bit1=B, bit2=C, bit3=D -+// r_cckrx_enable : CCK default, 0=A, 1=B, 2=C, 3=D -+// r_cckrx_enable_2 : CCK option, 0=A, 1=B, 2=C, 3=D */ -+ switch (ulAntennaRx) { -+ case ANTENNA_A: -+ r_rx_antenna_ofdm = 0x1; /* A*/ -+ p_cck_txrx->r_cckrx_enable = 0x0; /* default: A*/ -+ p_cck_txrx->r_cckrx_enable_2 = 0x0; /* option: A*/ -+ chgRx = 1; -+ break; -+ case ANTENNA_B: -+ r_rx_antenna_ofdm = 0x2; /*/ B*/ -+ p_cck_txrx->r_cckrx_enable = 0x1; /*/ default: B*/ -+ p_cck_txrx->r_cckrx_enable_2 = 0x1; /*/ option: B*/ -+ chgRx = 1; -+ break; -+ case ANTENNA_AB:/*/ For 8192S and 8192E/U...*/ -+ r_rx_antenna_ofdm = 0x3;/*/ AB*/ -+ p_cck_txrx->r_cckrx_enable = 0x0;/*/ default:A*/ -+ p_cck_txrx->r_cckrx_enable_2 = 0x1;/*/ option:B*/ -+ chgRx = 1; -+ break; -+ default: -+ break; -+ } -+ -+ -+ if (chgTx && chgRx) { -+ switch (pHalData->rf_chip) { -+ case RF_8225: -+ case RF_8256: -+ case RF_6052: -+ /*/r_ant_sel_cck_val = r_ant_select_cck_val;*/ -+ PHY_SetBBReg(pAdapter, rFPGA1_TxInfo, 0x7fffffff, r_ant_select_ofdm_val); /*/OFDM Tx*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_TxInfo, 0x0000000f, r_ofdm_tx_en_val); /*/OFDM Tx*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRxPathEnable, 0x0000000f, r_rx_antenna_ofdm); /*/OFDM Rx*/ -+ PHY_SetBBReg(pAdapter, rOFDM1_TRxPathEnable, 0x0000000f, r_rx_antenna_ofdm); /*/OFDM Rx*/ -+ if (IS_HARDWARE_TYPE_8192E(pAdapter)) { -+ PHY_SetBBReg(pAdapter, rOFDM0_TRxPathEnable, 0x000000F0, r_rx_antenna_ofdm); /*/OFDM Rx*/ -+ PHY_SetBBReg(pAdapter, rOFDM1_TRxPathEnable, 0x000000F0, r_rx_antenna_ofdm); /*/OFDM Rx*/ -+ } -+ PHY_SetBBReg(pAdapter, rCCK0_AFESetting, bMaskByte3, r_ant_select_cck_val);/*/r_ant_sel_cck_val); /CCK TxRx*/ -+ break; -+ -+ default: -+ DBG_871X("Unsupported RFChipID for switching antenna.\n"); -+ break; -+ } -+ } -+} /* MPT_ProSetRFPath */ -+ -+ -+void hal_mpt_SetAntenna(PADAPTER pAdapter) -+ -+{ -+ DBG_871X("Do %s\n", __func__); -+#ifdef CONFIG_RTL8814A -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) { -+ mpt_SetRFPath_8814A(pAdapter); -+ return; -+ } -+#endif -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) { -+ mpt_SetRFPath_8812A(pAdapter); -+ return; -+ } -+#endif -+#ifdef CONFIG_RTL8723B -+ if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -+ mpt_SetRFPath_8723B(pAdapter); -+ return; -+ } -+#endif -+#ifdef CONFIG_RTL8703B -+ if (IS_HARDWARE_TYPE_8703B(pAdapter)) { -+ mpt_SetRFPath_8703B(pAdapter); -+ return; -+ } -+#endif -+ -+/* else if (IS_HARDWARE_TYPE_8821B(pAdapter)) -+ mpt_SetRFPath_8821B(pAdapter); -+ Prepare for 8822B -+ else if (IS_HARDWARE_TYPE_8822B(Context)) -+ mpt_SetRFPath_8822B(Context); -+*/ -+ mpt_SetRFPath_819X(pAdapter); -+ DBG_871X("mpt_SetRFPath_819X Do %s\n", __func__); -+ -+} -+ -+ -+s32 hal_mpt_SetThermalMeter(PADAPTER pAdapter, u8 target_ther) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ if (!netif_running(pAdapter->pnetdev)) { -+ RT_TRACE(_module_mp_, _drv_warning_, ("SetThermalMeter! Fail: interface not opened!\n")); -+ return _FAIL; -+ } -+ -+ -+ if (check_fwstate(&pAdapter->mlmepriv, WIFI_MP_STATE) == _FALSE) { -+ RT_TRACE(_module_mp_, _drv_warning_, ("SetThermalMeter: Fail! not in MP mode!\n")); -+ return _FAIL; -+ } -+ -+ -+ target_ther &= 0xff; -+ if (target_ther < 0x07) -+ target_ther = 0x07; -+ else if (target_ther > 0x1d) -+ target_ther = 0x1d; -+ -+ pHalData->EEPROMThermalMeter = target_ther; -+ -+ return _SUCCESS; -+} -+ -+ -+void hal_mpt_TriggerRFThermalMeter(PADAPTER pAdapter) -+{ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x42, BIT17 | BIT16, 0x03); -+ -+} -+ -+ -+u8 hal_mpt_ReadRFThermalMeter(PADAPTER pAdapter) -+ -+{ -+ u32 ThermalValue = 0; -+ -+ ThermalValue = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, 0x42, 0xfc00); /*0x42: RF Reg[15:10]*/ -+ return (u8)ThermalValue; -+ -+} -+ -+ -+void hal_mpt_GetThermalMeter(PADAPTER pAdapter, u8 *value) -+{ -+#if 0 -+ fw_cmd(pAdapter, IOCMD_GET_THERMAL_METER); -+ rtw_msleep_os(1000); -+ fw_cmd_data(pAdapter, value, 1); -+ *value &= 0xFF; -+#else -+ hal_mpt_TriggerRFThermalMeter(pAdapter); -+ rtw_msleep_os(1000); -+ *value = hal_mpt_ReadRFThermalMeter(pAdapter); -+#endif -+ -+} -+ -+ -+void hal_mpt_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ pAdapter->mppriv.MptCtx.bSingleCarrier = bStart; -+ -+ if (bStart) {/*/ Start Single Carrier.*/ -+ RT_TRACE(_module_mp_, _drv_alert_, ("SetSingleCarrierTx: test start\n")); -+ /*/ Start Single Carrier.*/ -+ /*/ 1. if OFDM block on?*/ -+ if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1); /*set OFDM block on*/ -+ -+ /*/ 2. set CCK test mode off, set to CCK normal mode*/ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0); -+ -+ /*/ 3. turn on scramble setting*/ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 1); -+ -+ /*/ 4. Turn On Continue Tx and turn off the other test modes.*/ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) -+ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_SingleCarrier); -+ else -+#endif -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_SingleCarrier); -+ -+ } else { -+ /*/ Stop Single Carrier.*/ -+ /*/ Stop Single Carrier.*/ -+ /*/ Turn off all test modes.*/ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) -+ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_ALL_OFF); -+ else -+#endif -+ -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ALL_OFF); -+ -+ rtw_msleep_os(10); -+ /*/BB Reset*/ -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ } -+} -+ -+ -+void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u4Byte ulAntennaTx = pHalData->AntennaTxPath; -+ static u4Byte regRF = 0, regBB0 = 0, regBB1 = 0, regBB2 = 0, regBB3 = 0; -+ u8 rfPath; -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_B: -+ rfPath = ODM_RF_PATH_B; -+ break; -+ case ANTENNA_C: -+ rfPath = ODM_RF_PATH_C; -+ break; -+ case ANTENNA_D: -+ rfPath = ODM_RF_PATH_D; -+ break; -+ case ANTENNA_A: -+ default: -+ rfPath = ODM_RF_PATH_A; -+ break; -+ } -+ -+ pAdapter->mppriv.MptCtx.bSingleTone = bStart; -+ if (bStart) { -+ /*/ Start Single Tone.*/ -+ /*/ <20120326, Kordan> To amplify the power of tone for Xtal calibration. (asked by Edlu)*/ -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) { -+ regRF = PHY_QueryRFReg(pAdapter, rfPath, LNA_Low_Gain_3, bRFRegOffsetMask); -+ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x0); -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 0x0); -+ } else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { /*/ USB need to do RF LO disable first, PCIE isn't required to follow this order.*/ -+ /*/Set MAC REG 88C: Prevent SingleTone Fail*/ -+ PHY_SetMacReg(pAdapter, 0x88C, 0xF00000, 0xF); -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO disabled*/ -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ -+ } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x56, 0xF, 0x1); /*/ RF LO enabled*/ -+ } else { -+ /*/ S0/S1 both use PATH A to configure*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x76, 0xF, 0x1); /*/ RF LO enabled*/ -+ } -+ } else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /* Tx mode */ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, 0xF000, 0x1); /* RF LO enabled */ -+ } -+ } else if (IS_HARDWARE_TYPE_8188F(pAdapter)) { -+ /*Set BB REG 88C: Prevent SingleTone Fail*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, 0xF00000, 0xF); -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x2); -+ -+ } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) { -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ u1Byte p = ODM_RF_PATH_A; -+ -+ regRF = PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, bRFRegOffsetMask); -+ regBB0 = PHY_QueryBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord); -+ regBB1 = PHY_QueryBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord); -+ regBB2 = PHY_QueryBBReg(pAdapter, rA_RFE_Pinmux_Jaguar+4, bMaskDWord); -+ regBB3 = PHY_QueryBBReg(pAdapter, rB_RFE_Pinmux_Jaguar+4, bMaskDWord); -+ -+ PHY_SetBBReg(pAdapter, rOFDMCCKEN_Jaguar, BIT29|BIT28, 0x0); /*/ Disable CCK and OFDM*/ -+ -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_AB) { -+ for (p = ODM_RF_PATH_A; p <= ODM_RF_PATH_B; ++p) { -+ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ -+ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ -+ PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ -+ } -+ } else { -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ -+ } -+ -+ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); /*/ 0xCB0[[23:16, 7:4] = 0x77007*/ -+ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); /*/ 0xCB0[[23:16, 7:4] = 0x77007*/ -+ -+ if (pHalData->ExternalPA_5G) { -+ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar+4, 0xFF00000, 0x12); /*/ 0xCB4[23:16] = 0x12*/ -+ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar+4, 0xFF00000, 0x12); /*/ 0xEB4[23:16] = 0x12*/ -+ } else if (pHalData->ExternalPA_2G) { -+ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar+4, 0xFF00000, 0x11); /*/ 0xCB4[23:16] = 0x11*/ -+ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar+4, 0xFF00000, 0x11); /*/ 0xEB4[23:16] = 0x11*/ -+ } -+#endif -+ } -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ mpt_SetSingleTone_8814A(pAdapter, TRUE, FALSE); -+#endif -+ else /*/ Turn On SingleTone and turn off the other test modes.*/ -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_SingleTone); -+ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ } else {/*/ Stop Single Ton e.*/ -+ -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, LNA_Low_Gain_3, bRFRegOffsetMask, regRF); -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x1); -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 0x1); -+ } else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x3);/*/ Tx mode*/ -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x0);/*/ RF LO disabled */ -+ /*/ RESTORE MAC REG 88C: Enable RF Functions*/ -+ PHY_SetMacReg(pAdapter, 0x88C, 0xF00000, 0x0); -+ } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { -+ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x56, 0xF, 0x0); /*/ RF LO disabled*/ -+ } else { -+ /*/ S0/S1 both use PATH A to configure*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x76, 0xF, 0x0); /*/ RF LO disabled*/ -+ } -+ } else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { -+ -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /* Rx mode */ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, 0xF000, 0x0); /* RF LO disabled */ -+ } -+ } else if (IS_HARDWARE_TYPE_8188F(pAdapter)) { -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x3); /*Tx mode*/ -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x0); /*RF LO disabled*/ -+ /*Set BB REG 88C: Prevent SingleTone Fail*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, 0xF00000, 0xc); -+ } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) { -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ u1Byte p = ODM_RF_PATH_A; -+ -+ PHY_SetBBReg(pAdapter, rOFDMCCKEN_Jaguar, BIT29|BIT28, 0x3); /*/ Disable CCK and OFDM*/ -+ -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_AB) { -+ for (p = ODM_RF_PATH_A; p <= ODM_RF_PATH_B; ++p) { -+ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, bRFRegOffsetMask, regRF); -+ PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x0); /*/ RF LO disabled*/ -+ } -+ } else { -+ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, bRFRegOffsetMask, regRF); -+ PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x0); /*/ RF LO disabled*/ -+ } -+ -+ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord, regBB0); -+ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord, regBB1); -+ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar+4, bMaskDWord, regBB2); -+ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar+4, bMaskDWord, regBB3); -+#endif -+ } -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ mpt_SetSingleTone_8814A(pAdapter, FALSE, FALSE); -+ -+ else/*/ Turn off all test modes.*/ -+ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_ALL_OFF); -+#endif -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ -+ } -+} -+ -+ -+void hal_mpt_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) -+{ -+ pAdapter->mppriv.MptCtx.bCarrierSuppression = bStart; -+ if (bStart) {/* Start Carrier Suppression.*/ -+ RT_TRACE(_module_mp_, _drv_alert_, ("SetCarrierSuppressionTx: test start\n")); -+ if (pAdapter->mppriv.rateidx <= MPT_RATE_11M) { -+ /*/ 1. if CCK block on?*/ -+ if (!read_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn)) -+ write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, bEnable);/*set CCK block on*/ -+ -+ /*/Turn Off All Test Mode*/ -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) -+ PHY_SetBBReg(pAdapter, 0x914, BIT18|BIT17|BIT16, OFDM_ALL_OFF);/* rSingleTone_ContTx_Jaguar*/ -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ALL_OFF); -+ -+ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); /*/transmit mode*/ -+ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, 0x0); /*/turn off scramble setting*/ -+ -+ /*/Set CCK Tx Test Rate*/ -+ write_bbreg(pAdapter, rCCK0_System, bCCKTxRate, 0x0); /*/Set FTxRate to 1Mbps*/ -+ } -+ -+ /*Set for dynamic set Power index*/ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ } else {/* Stop Carrier Suppression.*/ -+ RT_TRACE(_module_mp_, _drv_alert_, ("SetCarrierSuppressionTx: test stop\n")); -+ -+ if (pAdapter->mppriv.rateidx <= MPT_RATE_11M) { -+ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); /*normal mode*/ -+ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, 0x1); /*turn on scramble setting*/ -+ -+ /*BB Reset*/ -+ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ } -+ /*Stop for dynamic set Power index*/ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ } -+ DBG_871X("\n MPT_ProSetCarrierSupp() is finished.\n"); -+} -+ -+void hal_mpt_SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ u32 cckrate; -+ -+ if (bStart) { -+ RT_TRACE(_module_mp_, _drv_alert_, -+ ("SetCCKContinuousTx: test start\n")); -+ -+ /*/ 1. if CCK block on?*/ -+ if (!read_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn)) -+ write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, bEnable);/*set CCK block on*/ -+ -+ /*/Turn Off All Test Mode*/ -+ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) -+ PHY_SetBBReg(pAdapter, 0x914, BIT18|BIT17|BIT16, OFDM_ALL_OFF);/*rSingleTone_ContTx_Jaguar*/ -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ALL_OFF); -+ -+ /*/Set CCK Tx Test Rate*/ -+ -+ cckrate = pAdapter->mppriv.rateidx; -+ -+ write_bbreg(pAdapter, rCCK0_System, bCCKTxRate, cckrate); -+ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); /*/transmit mode*/ -+ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, bEnable); /*/turn on scramble setting*/ -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) { -+ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* rCCK0_RxHP 0xa15[1:0] = 11 force cck rxiq = 0*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /*/ 0xc08[16] = 1 force ofdm rxiq = ofdm txiq*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 1); -+ PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 1); -+ } -+ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ } else { -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("SetCCKContinuousTx: test stop\n")); -+ -+ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); /*/normal mode*/ -+ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, bEnable); /*/turn on scramble setting*/ -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_8814A(pAdapter) /* && !IS_HARDWARE_TYPE_8822B(pAdapter) */) { -+ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0);/* rCCK0_RxHP 0xa15[1:0] = 2b00*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /*/ 0xc08[16] = 0*/ -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 0); -+ PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 0); -+ } -+ -+ /*/BB Reset*/ -+ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ } -+ -+ pAdapter->mppriv.MptCtx.bCckContTx = bStart; -+ pAdapter->mppriv.MptCtx.bOfdmContTx = _FALSE; -+} -+ -+void hal_mpt_SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ if (bStart) { -+ RT_TRACE(_module_mp_, _drv_info_, ("SetOFDMContinuousTx: test start\n"));/*/ 1. if OFDM block on?*/ -+ if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1);/*/set OFDM block on*/ -+ -+ /*/ 2. set CCK test mode off, set to CCK normal mode*/ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0); -+ -+ /*/ 3. turn on scramble setting*/ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 1); -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_8814A(pAdapter) /*&& !IS_HARDWARE_TYPE_8822B(pAdapter)*/) { -+ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* rCCK0_RxHP 0xa15[1:0] = 2b'11*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /* 0xc08[16] = 1*/ -+ } -+ -+ /*/ 4. Turn On Continue Tx and turn off the other test modes.*/ -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) -+ PHY_SetBBReg(pAdapter, 0x914, BIT18|BIT17|BIT16, OFDM_ContinuousTx);/*rSingleTone_ContTx_Jaguar*/ -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ContinuousTx); -+ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ } else { -+ RT_TRACE(_module_mp_, _drv_info_, ("SetOFDMContinuousTx: test stop\n")); -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) -+ PHY_SetBBReg(pAdapter, 0x914, BIT18|BIT17|BIT16, OFDM_ALL_OFF); -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ALL_OFF); -+ /*/Delay 10 ms*/ -+ rtw_msleep_os(10); -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_8814A(pAdapter) /*&&! IS_HARDWARE_TYPE_8822B(pAdapter)*/) { -+ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0);/*/ 0xa15[1:0] = 0*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0);/*/ 0xc08[16] = 0*/ -+ } -+ -+ /*/BB Reset*/ -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ } -+ -+ pAdapter->mppriv.MptCtx.bCckContTx = _FALSE; -+ pAdapter->mppriv.MptCtx.bOfdmContTx = bStart; -+} -+ -+void hal_mpt_SetContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("SetContinuousTx: rate:%d\n", pAdapter->mppriv.rateidx)); -+ -+ pAdapter->mppriv.MptCtx.bStartContTx = bStart; -+ -+ if (pAdapter->mppriv.rateidx <= MPT_RATE_11M) -+ hal_mpt_SetCCKContinuousTx(pAdapter, bStart); -+ else if (pAdapter->mppriv.rateidx >= MPT_RATE_6M) -+ hal_mpt_SetOFDMContinuousTx(pAdapter, bStart); -+} -+ -+#endif /* CONFIG_MP_INCLUDE*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/hal_phy.c linux/3rdparty/rtl8812au/hal/hal_phy.c ---- linux.old/3rdparty/rtl8812au/hal/hal_phy.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/hal_phy.c 2017-06-07 23:07:21.014687849 +0300 -@@ -0,0 +1,285 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _HAL_PHY_C_ -+ -+#include -+ -+//================================================================================ -+// Constant. -+//================================================================================ -+// 2008/11/20 MH For Debug only, RF -+static RF_SHADOW_T RF_Shadow[RF6052_MAX_PATH][RF6052_MAX_REG]; -+ -+/** -+* Function: PHY_CalculateBitShift -+* -+* OverView: Get shifted position of the BitMask -+* -+* Input: -+* u4Byte BitMask, -+* -+* Output: none -+* Return: u4Byte Return the shift bit bit position of the mask -+*/ -+u32 -+PHY_CalculateBitShift( -+ u32 BitMask -+ ) -+{ -+ u32 i; -+ -+ for(i=0; i<=31; i++) -+ { -+ if ( ((BitMask>>i) & 0x1 ) == 1) -+ break; -+ } -+ -+ return (i); -+} -+ -+ ++// Add new function to reset the state of antenna diversity before link. +// -+// ==> RF shadow Operation API Code Section!!! -+// -+/*----------------------------------------------------------------------------- -+ * Function: PHY_RFShadowRead -+ * PHY_RFShadowWrite -+ * PHY_RFShadowCompare -+ * PHY_RFShadowRecorver -+ * PHY_RFShadowCompareAll -+ * PHY_RFShadowRecorverAll -+ * PHY_RFShadowCompareFlagSet -+ * PHY_RFShadowRecorverFlagSet -+ * -+ * Overview: When we set RF register, we must write shadow at first. -+ * When we are running, we must compare shadow abd locate error addr. -+ * Decide to recorver or not. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/20/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+u32 -+PHY_RFShadowRead( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset) ++// Compare RSSI for deciding antenna ++void AntDivCompare8812(PADAPTER Adapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src) +{ -+ return RF_Shadow[eRFPath][Offset].Value; ++ //PADAPTER Adapter = pDM_Odm->Adapter ; + -+} /* PHY_RFShadowRead */ -+ -+ -+VOID -+PHY_RFShadowWrite( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset, -+ IN u32 Data) -+{ -+ RF_Shadow[eRFPath][Offset].Value = (Data & bRFRegOffsetMask); -+ RF_Shadow[eRFPath][Offset].Driver_Write = _TRUE; -+ -+} /* PHY_RFShadowWrite */ -+ -+ -+BOOLEAN -+PHY_RFShadowCompare( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset) -+{ -+ u32 reg; -+ // Check if we need to check the register -+ if (RF_Shadow[eRFPath][Offset].Compare == _TRUE) ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ if(0 != pHalData->AntDivCfg ) + { -+ reg = rtw_hal_read_rfreg(Adapter, eRFPath, Offset, bRFRegOffsetMask); -+ // Compare shadow and real rf register for 20bits!! -+ if (RF_Shadow[eRFPath][Offset].Value != reg) ++ //DBG_8192C("update_network=> orgRSSI(%d)(%d),newRSSI(%d)(%d)\n",dst->Rssi,query_rx_pwr_percentage(dst->Rssi), ++ // src->Rssi,query_rx_pwr_percentage(src->Rssi)); ++ //select optimum_antenna for before linked =>For antenna diversity ++ if(dst->Rssi >= src->Rssi )//keep org parameter + { -+ // Locate error position. -+ RF_Shadow[eRFPath][Offset].ErrorOrNot = _TRUE; -+ //RT_TRACE(COMP_INIT, DBG_LOUD, -+ //("PHY_RFShadowCompare RF-%d Addr%02lx Err = %05lx\n", -+ //eRFPath, Offset, reg)); -+ } -+ return RF_Shadow[eRFPath][Offset].ErrorOrNot ; -+ } -+ return _FALSE; -+} /* PHY_RFShadowCompare */ -+ -+ -+VOID -+PHY_RFShadowRecorver( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset) -+{ -+ // Check if the address is error -+ if (RF_Shadow[eRFPath][Offset].ErrorOrNot == _TRUE) -+ { -+ // Check if we need to recorver the register. -+ if (RF_Shadow[eRFPath][Offset].Recorver == _TRUE) -+ { -+ rtw_hal_write_rfreg(Adapter, eRFPath, Offset, bRFRegOffsetMask, -+ RF_Shadow[eRFPath][Offset].Value); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, -+ //("PHY_RFShadowRecorver RF-%d Addr%02lx=%05lx", -+ //eRFPath, Offset, RF_Shadow[eRFPath][Offset].Value)); ++ src->Rssi = dst->Rssi; ++ src->PhyInfo.Optimum_antenna = dst->PhyInfo.Optimum_antenna; + } + } -+ -+} /* PHY_RFShadowRecorver */ -+ -+ -+VOID -+PHY_RFShadowCompareAll( -+ IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0 ; -+ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) -+ { -+ for (Offset = 0; Offset < maxReg; Offset++) -+ { -+ PHY_RFShadowCompare(Adapter, eRFPath, Offset); -+ } -+ } -+ -+} /* PHY_RFShadowCompareAll */ -+ -+ -+VOID -+PHY_RFShadowRecorverAll( -+ IN PADAPTER Adapter) -+{ -+ u8 eRFPath =0; -+ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) -+ { -+ for (Offset = 0; Offset < maxReg; Offset++) -+ { -+ PHY_RFShadowRecorver(Adapter, eRFPath, Offset); -+ } -+ } -+ -+} /* PHY_RFShadowRecorverAll */ -+ -+ -+VOID -+PHY_RFShadowCompareFlagSet( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset, -+ IN u8 Type) -+{ -+ // Set True or False!!! -+ RF_Shadow[eRFPath][Offset].Compare = Type; -+ -+} /* PHY_RFShadowCompareFlagSet */ -+ -+ -+VOID -+PHY_RFShadowRecorverFlagSet( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset, -+ IN u8 Type) -+{ -+ // Set True or False!!! -+ RF_Shadow[eRFPath][Offset].Recorver= Type; -+ -+} /* PHY_RFShadowRecorverFlagSet */ -+ -+ -+VOID -+PHY_RFShadowCompareFlagSetAll( -+ IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) -+ { -+ for (Offset = 0; Offset < maxReg; Offset++) -+ { -+ // 2008/11/20 MH For S3S4 test, we only check reg 26/27 now!!!! -+ if (Offset != 0x26 && Offset != 0x27) -+ PHY_RFShadowCompareFlagSet(Adapter, eRFPath, Offset, _FALSE); -+ else -+ PHY_RFShadowCompareFlagSet(Adapter, eRFPath, Offset, _TRUE); -+ } -+ } -+ -+} /* PHY_RFShadowCompareFlagSetAll */ -+ -+ -+VOID -+PHY_RFShadowRecorverFlagSetAll( -+ IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) -+ { -+ for (Offset = 0; Offset < maxReg; Offset++) -+ { -+ // 2008/11/20 MH For S3S4 test, we only check reg 26/27 now!!!! -+ if (Offset != 0x26 && Offset != 0x27) -+ PHY_RFShadowRecorverFlagSet(Adapter, eRFPath, Offset, _FALSE); -+ else -+ PHY_RFShadowRecorverFlagSet(Adapter, eRFPath, Offset, _TRUE); -+ } -+ } -+ -+} /* PHY_RFShadowCompareFlagSetAll */ -+ -+VOID -+PHY_RFShadowRefresh( -+ IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) -+ { -+ for (Offset = 0; Offset < maxReg; Offset++) -+ { -+ RF_Shadow[eRFPath][Offset].Value = 0; -+ RF_Shadow[eRFPath][Offset].Compare = _FALSE; -+ RF_Shadow[eRFPath][Offset].Recorver = _FALSE; -+ RF_Shadow[eRFPath][Offset].ErrorOrNot = _FALSE; -+ RF_Shadow[eRFPath][Offset].Driver_Write = _FALSE; -+ } -+ } -+ -+} /* PHY_RFShadowRead */ -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/HalPwrSeqCmd.c linux/3rdparty/rtl8812au/hal/HalPwrSeqCmd.c ---- linux.old/3rdparty/rtl8812au/hal/HalPwrSeqCmd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/HalPwrSeqCmd.c 2017-06-07 23:07:21.007687211 +0300 -@@ -0,0 +1,183 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/*++ -+Copyright (c) Realtek Semiconductor Corp. All rights reserved. -+ -+Module Name: -+ HalPwrSeqCmd.c -+ -+Abstract: -+ Implement HW Power sequence configuration CMD handling routine for Realtek devices. -+ -+Major Change History: -+ When Who What -+ ---------- --------------- ------------------------------- -+ 2011-10-26 Lucas Modify to be compatible with SD4-CE driver. -+ 2011-07-07 Roger Create. -+ -+--*/ -+#include -+ -+ -+// -+// Description: -+// This routine deal with the Power Configuration CMDs parsing for RTL8723/RTL8188E Series IC. -+// -+// Assumption: -+// We should follow specific format which was released from HW SD. -+// -+// 2011.07.07, added by Roger. -+// -+u8 HalPwrSeqCmdParsing( -+ PADAPTER padapter, -+ u8 CutVersion, -+ u8 FabVersion, -+ u8 InterfaceType, -+ WLAN_PWR_CFG PwrSeqCmd[]) -+{ -+ WLAN_PWR_CFG PwrCfgCmd = {0}; -+ u8 bPollingBit = _FALSE; -+ u32 AryIdx = 0; -+ u8 value = 0; -+ u32 offset = 0; -+ u32 pollingCount = 0; // polling autoload done. -+ u32 maxPollingCnt = 5000; -+ -+ do { -+ PwrCfgCmd = PwrSeqCmd[AryIdx]; -+ -+ RT_TRACE(_module_hal_init_c_ , _drv_info_, -+ ("HalPwrSeqCmdParsing: offset(%#x) cut_msk(%#x) fab_msk(%#x) interface_msk(%#x) base(%#x) cmd(%#x) msk(%#x) value(%#x)\n", -+ GET_PWR_CFG_OFFSET(PwrCfgCmd), -+ GET_PWR_CFG_CUT_MASK(PwrCfgCmd), -+ GET_PWR_CFG_FAB_MASK(PwrCfgCmd), -+ GET_PWR_CFG_INTF_MASK(PwrCfgCmd), -+ GET_PWR_CFG_BASE(PwrCfgCmd), -+ GET_PWR_CFG_CMD(PwrCfgCmd), -+ GET_PWR_CFG_MASK(PwrCfgCmd), -+ GET_PWR_CFG_VALUE(PwrCfgCmd))); -+ -+ //2 Only Handle the command whose FAB, CUT, and Interface are matched -+ if ((GET_PWR_CFG_FAB_MASK(PwrCfgCmd) & FabVersion) && -+ (GET_PWR_CFG_CUT_MASK(PwrCfgCmd) & CutVersion) && -+ (GET_PWR_CFG_INTF_MASK(PwrCfgCmd) & InterfaceType)) -+ { -+ switch (GET_PWR_CFG_CMD(PwrCfgCmd)) -+ { -+ case PWR_CMD_READ: -+ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_READ\n")); -+ break; -+ -+ case PWR_CMD_WRITE: -+ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_WRITE\n")); -+ offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); -+ -+#ifdef CONFIG_SDIO_HCI -+ // -+ // We should deal with interface specific address mapping for some interfaces, e.g., SDIO interface -+ // 2011.07.07. -+ // -+ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) -+ { -+ // Read Back SDIO Local value -+ value = SdioLocalCmd52Read1Byte(padapter, offset); -+ -+ value &= ~(GET_PWR_CFG_MASK(PwrCfgCmd)); -+ value |= (GET_PWR_CFG_VALUE(PwrCfgCmd) & GET_PWR_CFG_MASK(PwrCfgCmd)); -+ -+ // Write Back SDIO Local value -+ SdioLocalCmd52Write1Byte(padapter, offset, value); -+ } -+ else -+#endif -+ { -+#ifdef CONFIG_GSPI_HCI -+ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) -+ offset = SPI_LOCAL_OFFSET | offset; -+#endif -+ // Read the value from system register -+ value = rtw_read8(padapter, offset); -+ -+ value=value&(~(GET_PWR_CFG_MASK(PwrCfgCmd))); -+ value=value|(GET_PWR_CFG_VALUE(PwrCfgCmd)&GET_PWR_CFG_MASK(PwrCfgCmd)); -+ -+ // Write the value back to sytem register -+ rtw_write8(padapter, offset, value); -+ } -+ break; -+ -+ case PWR_CMD_POLLING: -+ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_POLLING\n")); -+ -+ bPollingBit = _FALSE; -+ offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); -+#ifdef CONFIG_GSPI_HCI -+ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) -+ offset = SPI_LOCAL_OFFSET | offset; -+#endif -+ do { -+#ifdef CONFIG_SDIO_HCI -+ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) -+ value = SdioLocalCmd52Read1Byte(padapter, offset); -+ else -+#endif -+ value = rtw_read8(padapter, offset); -+ -+ value=value&GET_PWR_CFG_MASK(PwrCfgCmd); -+ if (value == (GET_PWR_CFG_VALUE(PwrCfgCmd) & GET_PWR_CFG_MASK(PwrCfgCmd))) -+ bPollingBit = _TRUE; -+ else -+ rtw_udelay_os(10); -+ -+ if (pollingCount++ > maxPollingCnt) { -+ DBG_871X_LEVEL(_drv_err_, "HalPwrSeqCmdParsing: Fail to polling Offset[%#x]=%02x\n", offset, value); -+ return _FALSE; -+ } -+ } while (!bPollingBit); -+ -+ break; -+ -+ case PWR_CMD_DELAY: -+ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_DELAY\n")); -+ if (GET_PWR_CFG_VALUE(PwrCfgCmd) == PWRSEQ_DELAY_US) -+ rtw_udelay_os(GET_PWR_CFG_OFFSET(PwrCfgCmd)); -+ else -+ rtw_udelay_os(GET_PWR_CFG_OFFSET(PwrCfgCmd)*1000); -+ break; -+ -+ case PWR_CMD_END: -+ // When this command is parsed, end the process -+ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_END\n")); -+ return _TRUE; -+ break; -+ -+ default: -+ RT_TRACE(_module_hal_init_c_ , _drv_err_, ("HalPwrSeqCmdParsing: Unknown CMD!!\n")); -+ break; -+ } -+ } -+ -+ AryIdx++;//Add Array Index -+ }while(1); -+ -+ return _TRUE; -+} -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/led/hal_usb_led.c linux/3rdparty/rtl8812au/hal/led/hal_usb_led.c ---- linux.old/3rdparty/rtl8812au/hal/led/hal_usb_led.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/led/hal_usb_led.c 2017-06-07 23:07:21.014687849 +0300 -@@ -0,0 +1,5183 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+ -+// -+// Description: -+// Implementation of LED blinking behavior. -+// It toggle off LED and schedule corresponding timer if necessary. -+// -+void -+SwLedBlink( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 bStopBlinking = _FALSE; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,( "Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ // Determine if we shall change LED state again. -+ pLed->BlinkTimes--; -+ switch(pLed->CurrLedState) -+ { -+ -+ case LED_BLINK_NORMAL: -+ if(pLed->BlinkTimes == 0) -+ { -+ bStopBlinking = _TRUE; -+ } -+ break; -+ -+ case LED_BLINK_StartToBlink: -+ if( check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE) ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if( check_fwstate(pmlmepriv, _FW_LINKED) && -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ else if(pLed->BlinkTimes == 0) -+ { -+ bStopBlinking = _TRUE; -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ break; -+ -+ -+ default: -+ bStopBlinking = _TRUE; -+ break; -+ -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if( (check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) && (pLed->bLedOn == _FALSE)) -+ { -+ SwLedOn(padapter, pLed); -+ } -+ else if( (check_fwstate(pmlmepriv, _FW_LINKED)== _FALSE) && pLed->bLedOn == _TRUE) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ // Assign LED state to toggle. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ // Schedule a timer to toggle LED state. -+ switch( pLed->CurrLedState ) -+ { -+ case LED_BLINK_NORMAL: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ break; -+ -+ case LED_BLINK_SLOWLY: -+ case LED_BLINK_StartToBlink: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ break; -+ -+ case LED_BLINK_WPS: -+ { -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LONG_INTERVAL); -+ else -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LONG_INTERVAL); -+ } -+ break; -+ -+ default: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ break; -+ } -+ } -+} -+ -+void -+SwLedBlink1( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ PLED_USB pLed1 = &(ledpriv->SwLed1); -+ u8 bStopBlinking = _FALSE; -+ -+ u32 uLedBlinkNoLinkInterval = LED_BLINK_NO_LINK_INTERVAL_ALPHA; //add by ylb 20121012 for customer led for alpha -+ if(pHalData->CustomerID == RT_CID_819x_ALPHA_Dlink) -+ uLedBlinkNoLinkInterval= LED_BLINK_NO_LINK_INTERVAL_ALPHA_500MS; -+ -+ if(pHalData->CustomerID == RT_CID_819x_CAMEO) -+ pLed = &(ledpriv->SwLed1); -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,( "Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ -+ if(pHalData->CustomerID == RT_CID_DEFAULT) -+ { -+ if(check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) -+ { -+ if(!pLed1->bSWLedCtrl) -+ { -+ SwLedOn(padapter, pLed1); -+ pLed1->bSWLedCtrl = _TRUE; -+ } -+ else if(!pLed1->bLedOn) -+ SwLedOn(padapter, pLed1); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (): turn on pLed1\n")); -+ } -+ else -+ { -+ if(!pLed1->bSWLedCtrl) -+ { -+ SwLedOff(padapter, pLed1); -+ pLed1->bSWLedCtrl = _TRUE; -+ } -+ else if(pLed1->bLedOn) -+ SwLedOff(padapter, pLed1); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (): turn off pLed1\n")); -+ } -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SLOWLY: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval);//change by ylb 20121012 for customer led for alpha -+ break; -+ -+ case LED_BLINK_NORMAL: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) -+ { -+ pLed->bLedLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_NORMAL; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _FALSE) -+ { -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) -+ { -+ pLed->bLedLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_NORMAL; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _FALSE) -+ { -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS success -+ if(pLed->BlinkingLedState == RTW_LED_ON) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA); -+ bStopBlinking = _FALSE; -+ } -+ else -+ { -+ bStopBlinking = _TRUE; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ pLed->bLedLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_NORMAL; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+void -+SwLedBlink2( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 bStopBlinking = _FALSE; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("stop scan blink CurrLedState %d\n", pLed->CurrLedState)); -+ -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _FALSE) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("stop scan blink CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("stop CurrLedState %d\n", pLed->CurrLedState)); -+ -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _FALSE) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("stop CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+void -+SwLedBlink3( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 bStopBlinking = _FALSE; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ if(pLed->CurrLedState != LED_BLINK_WPS_STOP) -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if( !pLed->bLedOn ) -+ SwLedOn(padapter, pLed); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _FALSE) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedOn ) -+ SwLedOff(padapter, pLed); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ if( !pLed->bLedOn ) -+ SwLedOn(padapter, pLed); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _FALSE) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ if( pLed->bLedOn ) -+ SwLedOff(padapter, pLed); -+ -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS success -+ if(pLed->BlinkingLedState == RTW_LED_ON) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA); -+ bStopBlinking = _FALSE; -+ } -+ else -+ { -+ bStopBlinking = _TRUE; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ break; -+ -+ -+ default: -+ break; -+ } -+ -+} -+ -+ -+void -+SwLedBlink4( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ PLED_USB pLed1 = &(ledpriv->SwLed1); -+ u8 bStopBlinking = _FALSE; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ if(!pLed1->bLedWPSBlinkInProgress && pLed1->BlinkingLedState == LED_UNKNOWN) -+ { -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ SwLedOff(padapter, pLed1); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SLOWLY: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_StartToBlink: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _FALSE; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS authentication fail -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ break; -+ -+ case LED_BLINK_WPS_STOP_OVERLAP: //WPS session overlap -+ pLed->BlinkTimes--; -+ if(pLed->BlinkTimes == 0) -+ { -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkTimes = 1; -+ } -+ else -+ { -+ bStopBlinking = _TRUE; -+ } -+ } -+ -+ if(bStopBlinking) -+ { -+ pLed->BlinkTimes = 10; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_ALWAYS_ON: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("RFOff Status \n")); -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink4 CurrLedState %d\n", pLed->CurrLedState)); -+ -+ -+} -+ -+void -+SwLedBlink5( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 bStopBlinking = _FALSE; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if(pLed->bLedOn) -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if(!pLed->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if(pLed->bLedOn) -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if(!pLed->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink5 CurrLedState %d\n", pLed->CurrLedState)); -+ -+ -+} -+ -+void -+SwLedBlink6( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 bStopBlinking = _FALSE; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink6\n")); -+} -+ -+void -+SwLedBlink7( -+ PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ if(pLed->CurrLedState != LED_BLINK_WPS_STOP) -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if( !pLed->bLedOn ) -+ SwLedOn(Adapter, pLed); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _FALSE) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedOn ) -+ SwLedOff(Adapter, pLed); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS success -+ if(pLed->BlinkingLedState == RTW_LED_ON) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ bStopBlinking = _FALSE; -+ } -+ else -+ { -+ bStopBlinking = _TRUE; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ break; -+ -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink7\n")); -+ -+} -+ -+void -+SwLedBlink8( -+ PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes blink8(%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes blink8(%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink8\n")); -+ -+} -+ -+//page added for Belkin AC950. 20120813 -+void -+SwLedBlink9( -+ PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ //DBG_871X("%s, pLed->CurrLedState=%d, pLed->BlinkingLedState=%d \n", __FUNCTION__, pLed->CurrLedState, pLed->BlinkingLedState); -+ -+ -+ switch(pLed->CurrLedState) -+ { -+ case RTW_LED_ON: -+ SwLedOn(Adapter, pLed); -+ break; -+ -+ case RTW_LED_OFF: -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ case LED_BLINK_SLOWLY: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_StartToBlink: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ { -+ pLed->bLedLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _FALSE) -+ { -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS authentication fail -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ break; -+ -+ case LED_BLINK_WPS_STOP_OVERLAP: //WPS session overlap -+ pLed->BlinkTimes--; -+ pLed->BlinkCounter --; -+ if(pLed->BlinkCounter == 0) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ pLed->CurrLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ else -+ { -+ if(pLed->BlinkTimes == 0) -+ { -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkTimes = 1; -+ } -+ else -+ { -+ bStopBlinking = _TRUE; -+ } -+ } -+ -+ if(bStopBlinking) -+ { -+ pLed->BlinkTimes = 10; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_BLINK_ALWAYS_ON: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if(IS_HARDWARE_TYPE_8812AU(Adapter)) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ } -+ else -+ { -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("RFOff Status \n")); -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if(IS_HARDWARE_TYPE_8812AU(Adapter)) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_LINK_IN_PROCESS: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ON_BELKIN); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_OFF_BELKIN); -+ } -+ break; -+ -+ case LED_BLINK_AUTH_ERROR: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if(bStopBlinking == _FALSE) -+ { -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); -+ } -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink9 CurrLedState %d\n", pLed->CurrLedState)); -+} -+ -+//page added for Netgear A6200V2. 20120827 -+void -+SwLedBlink10( -+ PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ -+ switch(pLed->CurrLedState) -+ { -+ case RTW_LED_ON: -+ SwLedOn(Adapter, pLed); -+ break; -+ -+ case RTW_LED_OFF: -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ case LED_BLINK_SLOWLY: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_StartToBlink: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on ) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) -+ { -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_SLOWLY_INTERVAL_NETGEAR+LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ } -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL+LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS authentication fail -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ break; -+ -+ case LED_BLINK_WPS_STOP_OVERLAP: //WPS session overlap -+ pLed->BlinkTimes--; -+ pLed->BlinkCounter --; -+ if(pLed->BlinkCounter == 0) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ pLed->CurrLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ else -+ { -+ if(pLed->BlinkTimes == 0) -+ { -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkTimes = 1; -+ } -+ else -+ { -+ bStopBlinking = _TRUE; -+ } -+ } -+ -+ if(bStopBlinking) -+ { -+ pLed->BlinkTimes = 10; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_BLINK_ALWAYS_ON: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if(IS_HARDWARE_TYPE_8812AU(Adapter)) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ } -+ else -+ { -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("RFOff Status \n")); -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if(IS_HARDWARE_TYPE_8812AU(Adapter)) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_LINK_IN_PROCESS: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ON_BELKIN); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_OFF_BELKIN); -+ } -+ break; -+ -+ case LED_BLINK_AUTH_ERROR: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if(bStopBlinking == _FALSE) -+ { -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); -+ } -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink10 CurrLedState %d\n", pLed->CurrLedState)); -+ -+} -+ -+void -+SwLedBlink11( -+ PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_TXRX: -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ -+ break; -+ -+ case LED_BLINK_WPS: -+ if(pLed->BlinkTimes == 5) -+ { -+ SwLedOn(Adapter, pLed); -+ _set_timer(&(pLed->BlinkTimer), LED_CM11_LINK_ON_INTERVEL); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_CM11_BLINK_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_CM11_BLINK_INTERVAL); -+ } -+ } -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if(bStopBlinking == _TRUE) -+ pLed->BlinkTimes = 5; -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS authentication fail -+ if(check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ SwLedOn(Adapter, pLed); -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink5 CurrLedState %d\n", pLed->CurrLedState)); -+} -+ -+void -+SwLedBlink12( -+ PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%ld): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%ld): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SLOWLY: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if(pLed->bLedOn) -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink8 CurrLedState %d\n", pLed->CurrLedState)); -+ -+ -+} -+ -+VOID -+SwLedBlink13( -+ IN PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ static u8 LinkBlinkCnt=0; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ if(pLed->CurrLedState != LED_BLINK_WPS_STOP) -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("!!! SwLedBlink13 CurrLedState %d, bLedWPSBlinkInProgress %d, bLedBlinkInProgress %d\n", pLed->CurrLedState,pLed->bLedWPSBlinkInProgress,pLed->bLedBlinkInProgress)); -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_LINK_IN_PROCESS: -+ if(!pLed->bLedWPSBlinkInProgress) -+ LinkBlinkCnt++; -+ -+ if(LinkBlinkCnt>15) -+ { -+ LinkBlinkCnt=0; -+ pLed->bLedBlinkInProgress = _FALSE; -+ break; -+ } -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 500); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 500); -+ } -+ -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_ON_INTERVAL_NETGEAR); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_OFF_INTERVAL_NETGEAR); -+ } -+ -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS success -+ SwLedOff(Adapter, pLed); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ break; -+ -+ default: -+ LinkBlinkCnt=0; -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink13\n")); -+ -+} -+ -+VOID -+SwLedBlink14( -+ IN PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ static u8 LinkBlinkCnt=0; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ if(pLed->CurrLedState != LED_BLINK_WPS_STOP) -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("!!! SwLedBlink14 CurrLedState %d, bLedWPSBlinkInProgress %d, bLedBlinkInProgress %d\n", pLed->CurrLedState,pLed->bLedWPSBlinkInProgress,pLed->bLedBlinkInProgress)); -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ SwLedOn(Adapter, pLed); -+ } -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if (IS_HARDWARE_TYPE_8812AU(Adapter)) -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ else -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if (IS_HARDWARE_TYPE_8812AU(Adapter)) -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ else -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ } -+ -+ break; -+ -+ default: -+ LinkBlinkCnt=0; -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink14\n")); -+} -+ -+VOID -+SwLedBlink15( -+ IN PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ static u8 LinkBlinkCnt=0; -+ // Change LED according to BlinkingLedState specified. -+ -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ if(pLed->CurrLedState != LED_BLINK_WPS_STOP) -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("!!! SwLedBlink15 CurrLedState %d, bLedWPSBlinkInProgress %d, bLedBlinkInProgress %d\n", pLed->CurrLedState,pLed->bLedWPSBlinkInProgress,pLed->bLedBlinkInProgress)); -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_ON_INTERVAL_DLINK); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_OFF_INTERVAL_DLINK); -+ } -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS success -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("blink15, LED_BLINK_WPS_STOP BlinkingLedState %d\n",pLed->BlinkingLedState)); -+ -+ if(pLed->BlinkingLedState == RTW_LED_OFF) -+ { -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ return; -+ } -+ -+ pLed->CurrLedState = LED_BLINK_WPS_STOP; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_LINKED_ON_INTERVAL_DLINK); -+ break; -+ -+ case LED_BLINK_NO_LINK: -+ { -+ static BOOLEAN bLedOn=_TRUE; -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("blink15, LED_NO_LINK_BLINK bLedOn %d\n",bLedOn)); -+ if(bLedOn) -+ { -+ bLedOn=_FALSE; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ } -+ else -+ { -+ bLedOn=_TRUE; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ pLed->bLedBlinkInProgress = _TRUE; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_LINK_IDEL: -+ { -+ static BOOLEAN bLedOn=_TRUE; -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("blink15, LED_BLINK_LINK_IDEL bLedOn %d\n",bLedOn)); -+ if(bLedOn) -+ { -+ bLedOn=_FALSE; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ } -+ else -+ { -+ bLedOn=_TRUE; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ } -+ pLed->bLedBlinkInProgress = _TRUE; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_IDEL_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_SCAN: -+ { -+ static u8 BlinkTime=0; -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("blink15, LED_SCAN_BLINK bLedOn %d\n",BlinkTime)); -+ if(BlinkTime %2==0) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ } -+ BlinkTime ++; -+ -+ if(BlinkTime<24) -+ { -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ if(pLed->BlinkingLedState == RTW_LED_ON) -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_OFF_INTERVAL); -+ else -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_ON_INTERVAL); -+ } -+ else -+ { -+ //if(pLed->OLDLedState ==LED_NO_LINK_BLINK) -+ if(check_fwstate(pmlmepriv, _FW_LINKED)== _FALSE) -+ { -+ pLed->CurrLedState = LED_BLINK_NO_LINK; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), 100); -+ } -+ BlinkTime =0; -+ } -+ } -+ break; -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = _TRUE; -+ } -+ if(bStopBlinking) -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ SwLedOn(Adapter, pLed); -+ } -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ if( adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ default: -+ LinkBlinkCnt=0; -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink15\n")); -+} -+ -+// -+// Description: -+// Handler function of LED Blinking. -+// We dispatch acture LED blink action according to LedStrategy. -+// -+void BlinkHandler(PLED_USB pLed) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ -+ //DBG_871X("%s (%s:%d)\n",__FUNCTION__, current->comm, current->pid); -+ -+ if (RTW_CANNOT_RUN(padapter) || (!rtw_is_hw_init_completed(padapter))) { -+ /*DBG_871X("%s bDriverStopped:%s, bSurpriseRemoved:%s\n" -+ , __func__ -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False" );*/ -+ return; -+ } -+ -+ switch(ledpriv->LedStrategy) -+ { -+ case SW_LED_MODE0: -+ SwLedBlink(pLed); -+ break; -+ -+ case SW_LED_MODE1: -+ SwLedBlink1(pLed); -+ break; -+ -+ case SW_LED_MODE2: -+ SwLedBlink2(pLed); -+ break; -+ -+ case SW_LED_MODE3: -+ SwLedBlink3(pLed); -+ break; -+ -+ case SW_LED_MODE4: -+ SwLedBlink4(pLed); -+ break; -+ -+ case SW_LED_MODE5: -+ SwLedBlink5(pLed); -+ break; -+ -+ case SW_LED_MODE6: -+ SwLedBlink6(pLed); -+ break; -+ -+ case SW_LED_MODE7: -+ SwLedBlink7(pLed); -+ break; -+ -+ case SW_LED_MODE8: -+ SwLedBlink8(pLed); -+ break; -+ -+ case SW_LED_MODE9: -+ SwLedBlink9(pLed); -+ break; -+ -+ case SW_LED_MODE10: -+ SwLedBlink10(pLed); -+ break; -+ -+ case SW_LED_MODE11: -+ SwLedBlink11(pLed); -+ break; -+ -+ case SW_LED_MODE12: -+ SwLedBlink12(pLed); -+ break; -+ -+ case SW_LED_MODE13: -+ SwLedBlink13(pLed); -+ break; -+ -+ case SW_LED_MODE14: -+ SwLedBlink14(pLed); -+ break; -+ -+ case SW_LED_MODE15: -+ SwLedBlink15(pLed); -+ break; -+ -+ default: -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("BlinkWorkItemCallback 0x%x \n", ledpriv->LedStrategy)); -+ //SwLedBlink(pLed); -+ break; -+ } -+} -+ -+// -+// Description: -+// Callback function of LED BlinkTimer, -+// it just schedules to corresponding BlinkWorkItem/led_blink_hdl -+// -+void BlinkTimerCallback(void *data) -+{ -+ PLED_USB pLed = (PLED_USB)data; -+ _adapter *padapter = pLed->padapter; -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ if (RTW_CANNOT_RUN(padapter) || (!rtw_is_hw_init_completed(padapter))) { -+ /*DBG_871X("%s bDriverStopped:%s, bSurpriseRemoved:%s\n" -+ , __func__ -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False" );*/ -+ return; -+ } -+ -+ #ifdef CONFIG_LED_HANDLED_BY_CMD_THREAD -+ rtw_led_blink_cmd(padapter, (PVOID)pLed); -+ #else -+ if(ATOMIC_READ(&pLed->bCancelWorkItem) == _FALSE) -+ _set_workitem(&(pLed->BlinkWorkItem)); -+ #endif -+} -+ -+// -+// Description: -+// Callback function of LED BlinkWorkItem. -+// We dispatch acture LED blink action according to LedStrategy. -+// -+void BlinkWorkItemCallback(_workitem *work) -+{ -+ PLED_USB pLed = container_of(work, LED_USB, BlinkWorkItem); -+ BlinkHandler(pLed); -+} -+ -+static void -+SwLedControlMode0( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ PLED_USB pLed = &(ledpriv->SwLed1); -+ -+ // Decide led state -+ switch(LedAction) -+ { -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if( pLed->bLedBlinkInProgress == _FALSE ) -+ { -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ pLed->CurrLedState = LED_BLINK_NORMAL; -+ pLed->BlinkTimes = 2; -+ -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_CTL_START_TO_LINK: -+ if( pLed->bLedBlinkInProgress == _FALSE ) -+ { -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ pLed->CurrLedState = LED_BLINK_StartToBlink; -+ pLed->BlinkTimes = 24; -+ -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->CurrLedState = LED_BLINK_StartToBlink; -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ pLed->CurrLedState = RTW_LED_ON; -+ if( pLed->bLedBlinkInProgress == _FALSE ) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_NO_LINK: -+ pLed->CurrLedState = RTW_LED_OFF; -+ if( pLed->bLedBlinkInProgress == _FALSE ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ if(pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(padapter, pLed); -+ break; -+ -+ case LED_CTL_START_WPS: -+ if( pLed->bLedBlinkInProgress == _FALSE || pLed->CurrLedState == RTW_LED_ON) -+ { -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ pLed->CurrLedState = LED_BLINK_WPS; -+ pLed->BlinkTimes = 20; -+ -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LONG_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LONG_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: -+ if(pLed->bLedBlinkInProgress) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ break; -+ -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led %d\n", pLed->CurrLedState)); -+ -+} -+ -+ //ALPHA, added by chiyoko, 20090106 -+static void -+SwLedControlMode1( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ u32 uLedBlinkNoLinkInterval = LED_BLINK_NO_LINK_INTERVAL_ALPHA; //add by ylb 20121012 for customer led for alpha -+ if(pHalData->CustomerID == RT_CID_819x_ALPHA_Dlink) -+ uLedBlinkNoLinkInterval= LED_BLINK_NO_LINK_INTERVAL_ALPHA_500MS; -+ -+ if(pHalData->CustomerID == RT_CID_819x_CAMEO) -+ pLed = &(ledpriv->SwLed1); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_POWER_ON: -+ case LED_CTL_START_TO_LINK: -+ case LED_CTL_NO_LINK: -+ if( pLed->bLedNoLinkBlinkInProgress == _FALSE ) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if( pLed->bLedLinkBlinkInProgress == _TRUE ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval);//change by ylb 20121012 for customer led for alpha -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ if( pLed->bLedLinkBlinkInProgress == _FALSE ) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->bLedLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_NORMAL; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ if((pmlmepriv->LinkDetectInfo.bBusyTraffic) && (check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE)) -+ ; -+ else if(pLed->bLedScanBlinkInProgress ==_FALSE) -+ { -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedLinkBlinkInProgress == _TRUE ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->bLedScanBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 24; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ if (adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(padapter)->rfoff_reason == RF_CHANGE_BY_IPS) -+ _set_timer(&(pLed->BlinkTimer), LED_INITIAL_INTERVAL); -+ else -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if(pLed->bLedBlinkInProgress ==_FALSE) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedLinkBlinkInProgress == _TRUE ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = _FALSE; -+ } -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed->bLedWPSBlinkInProgress ==_FALSE) -+ { -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedLinkBlinkInProgress == _TRUE ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedScanBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ break; -+ -+ -+ case LED_CTL_STOP_WPS: -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedLinkBlinkInProgress == _TRUE ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedScanBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ } -+ else -+ { -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ } -+ -+ pLed->CurrLedState = LED_BLINK_WPS_STOP; -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL: -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval);//change by ylb 20121012 for customer led for alpha -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedNoLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ -+ SwLedOff(padapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led %d\n", pLed->CurrLedState)); -+} -+ -+ //Arcadyan/Sitecom , added by chiyoko, 20090216 -+static void -+SwLedControlMode2( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_SITE_SURVEY: -+ if(pmlmepriv->LinkDetectInfo.bBusyTraffic) -+ ; -+ else if(pLed->bLedScanBlinkInProgress ==_FALSE) -+ { -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->bLedScanBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 24; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if((pLed->bLedBlinkInProgress ==_FALSE) && (check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE)) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed->bLedWPSBlinkInProgress ==_FALSE) -+ { -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedScanBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ if(adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL: -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ break; -+ -+ case LED_CTL_START_TO_LINK: -+ case LED_CTL_NO_LINK: -+ if(!IS_LED_BLINKING(pLed)) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ SwLedOff(padapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+} -+ -+ //COREGA, added by chiyoko, 20090316 -+ static void -+ SwLedControlMode3( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_SITE_SURVEY: -+ if(pmlmepriv->LinkDetectInfo.bBusyTraffic) -+ ; -+ else if(pLed->bLedScanBlinkInProgress ==_FALSE) -+ { -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->bLedScanBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 24; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if((pLed->bLedBlinkInProgress ==_FALSE) && (check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE)) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed->bLedWPSBlinkInProgress ==_FALSE) -+ { -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedScanBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ } -+ -+ pLed->CurrLedState = LED_BLINK_WPS_STOP; -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL: -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_TO_LINK: -+ case LED_CTL_NO_LINK: -+ if(!IS_LED_BLINKING(pLed)) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ SwLedOff(padapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+} -+ -+ -+ //Edimax-Belkin, added by chiyoko, 20090413 -+static void -+SwLedControlMode4( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ PLED_USB pLed1 = &(ledpriv->SwLed1); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_START_TO_LINK: -+ if(pLed1->bLedWPSBlinkInProgress) -+ { -+ pLed1->bLedWPSBlinkInProgress = _FALSE; -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ -+ if(pLed1->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ if( pLed->bLedStartToLinkBlinkInProgress == _FALSE ) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedNoLinkBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ -+ pLed->bLedStartToLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_StartToBlink; -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ case LED_CTL_NO_LINK: -+ //LED1 settings -+ if(LedAction == LED_CTL_LINK) -+ { -+ if(pLed1->bLedWPSBlinkInProgress) -+ { -+ pLed1->bLedWPSBlinkInProgress = _FALSE; -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ -+ if(pLed1->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ } -+ -+ if( pLed->bLedNoLinkBlinkInProgress == _FALSE ) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ if((pmlmepriv->LinkDetectInfo.bBusyTraffic) && (check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE)) -+ ; -+ else if(pLed->bLedScanBlinkInProgress ==_FALSE) -+ { -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->bLedScanBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 24; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if(pLed->bLedBlinkInProgress ==_FALSE) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed1->bLedWPSBlinkInProgress) -+ { -+ pLed1->bLedWPSBlinkInProgress = _FALSE; -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ -+ if(pLed1->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ if(pLed->bLedWPSBlinkInProgress ==_FALSE) -+ { -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedScanBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: //WPS connect success -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL: //WPS authentication fail -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ -+ //LED1 settings -+ if(pLed1->bLedWPSBlinkInProgress) -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ else -+ pLed1->bLedWPSBlinkInProgress = _TRUE; -+ -+ pLed1->CurrLedState = LED_BLINK_WPS_STOP; -+ if( pLed1->bLedOn ) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL_OVERLAP: //WPS session overlap -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ -+ //LED1 settings -+ if(pLed1->bLedWPSBlinkInProgress) -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ else -+ pLed1->bLedWPSBlinkInProgress = _TRUE; -+ -+ pLed1->CurrLedState = LED_BLINK_WPS_STOP_OVERLAP; -+ pLed1->BlinkTimes = 10; -+ if( pLed1->bLedOn ) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ if( pLed->bLedNoLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedStartToLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedStartToLinkBlinkInProgress = _FALSE; -+ } -+ -+ if( pLed1->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ pLed1->BlinkingLedState = LED_UNKNOWN; -+ SwLedOff(padapter, pLed); -+ SwLedOff(padapter, pLed1); -+ break; -+ -+ case LED_CTL_CONNECTION_NO_TRANSFER: -+ if(pLed->bLedBlinkInProgress == _FALSE) -+ { -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led %d\n", pLed->CurrLedState)); -+} -+ -+ -+ -+ //Sercomm-Belkin, added by chiyoko, 20090415 -+static void -+SwLedControlMode5( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ if(pHalData->CustomerID == RT_CID_819x_CAMEO) -+ pLed = &(ledpriv->SwLed1); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_POWER_ON: -+ case LED_CTL_NO_LINK: -+ case LED_CTL_LINK: //solid blue -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ if((pmlmepriv->LinkDetectInfo.bBusyTraffic) && (check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE)) -+ ; -+ else if(pLed->bLedScanBlinkInProgress ==_FALSE) -+ { -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->bLedScanBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 24; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if(pLed->bLedBlinkInProgress ==_FALSE) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN) -+ { -+ return; -+ } -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ -+ SwLedOff(padapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led %d\n", pLed->CurrLedState)); -+} -+ -+ //WNC-Corega, added by chiyoko, 20090902 -+static void -+SwLedControlMode6( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PLED_USB pLed0 = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_POWER_ON: -+ case LED_CTL_LINK: -+ case LED_CTL_NO_LINK: -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->CurrLedState = RTW_LED_ON; -+ pLed0->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed0->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ SwLedOff(padapter, pLed0); -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("ledcontrol 6 Led %d\n", pLed0->CurrLedState)); -+} -+ -+//Netgear, added by sinda, 2011/11/11 -+ void -+ SwLedControlMode7( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+ ) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_SITE_SURVEY: -+ if(pmlmepriv->LinkDetectInfo.bBusyTraffic) -+ ; -+ else if(pLed->bLedScanBlinkInProgress == _FALSE) -+ { -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ if(pLed->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->bLedScanBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 6; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed->bLedWPSBlinkInProgress ==_FALSE) -+ { -+ if(pLed->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedScanBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ } -+ -+ pLed->CurrLedState = LED_BLINK_WPS_STOP; -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ break; -+ -+ -+ case LED_CTL_STOP_WPS_FAIL: -+ case LED_CTL_STOP_WPS_FAIL_OVERLAP: //WPS session overlap -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_TO_LINK: -+ case LED_CTL_NO_LINK: -+ if(!IS_LED_BLINKING(pLed)) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ case LED_CTL_POWER_ON: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("LEd control mode 7 CurrLedState %d\n", pLed->CurrLedState)); -+} -+ -+void -+SwLedControlMode8( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+ ) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed0 = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_LINK: -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->CurrLedState = RTW_LED_ON; -+ pLed0->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed0->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_NO_LINK: -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->CurrLedState = RTW_LED_OFF; -+ pLed0->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed0->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ SwLedOff(Adapter, pLed0); -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 8 %d\n", pLed0->CurrLedState)); -+ -+} -+ -+//page added for Belkin AC950, 20120813 -+void -+SwLedControlMode9( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ PLED_USB pLed1 = &(ledpriv->SwLed1); -+ PLED_USB pLed2 = &(ledpriv->SwLed2); -+ BOOLEAN bWPSOverLap = _FALSE; -+ //DBG_871X("LedAction=%d \n", LedAction); -+ switch(LedAction) -+ { -+ case LED_CTL_START_TO_LINK: -+ if(pLed2->bLedBlinkInProgress == _FALSE) -+ { -+ pLed2->bLedBlinkInProgress = _TRUE; -+ pLed2->BlinkingLedState = RTW_LED_ON; -+ pLed2->CurrLedState = LED_BLINK_LINK_IN_PROCESS; -+ -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ case LED_CTL_NO_LINK: -+ //LED1 settings -+ if(LedAction == LED_CTL_NO_LINK) -+ { -+ //if(pMgntInfo->AuthStatus == AUTH_STATUS_FAILED) -+ if(0) -+ { -+ pLed1->CurrLedState = LED_BLINK_AUTH_ERROR; -+ if( pLed1->bLedOn ) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ else -+ { -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ if( pLed1->bLedOn ) -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ } -+ else -+ { -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ if( pLed1->bLedOn ) -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ -+ //LED2 settings -+ if(LedAction == LED_CTL_LINK) -+ { -+ if(Adapter->securitypriv.dot11PrivacyAlgrthm != _NO_PRIVACY_) -+ { -+ if(pLed2->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed2->BlinkTimer)); -+ pLed2->bLedBlinkInProgress = _FALSE; -+ } -+ pLed2->CurrLedState = RTW_LED_ON; -+ pLed2->bLedNoLinkBlinkInProgress = _TRUE; -+ if(!pLed2->bLedOn) -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ } -+ else -+ { -+ if(pLed2->bLedWPSBlinkInProgress != _TRUE) -+ { -+ pLed2->CurrLedState = RTW_LED_OFF; -+ pLed2->BlinkingLedState = RTW_LED_OFF; -+ if(pLed2->bLedOn) -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ } -+ } -+ } -+ else //NO_LINK -+ { -+ if(pLed2->bLedWPSBlinkInProgress == _FALSE) -+ { -+ pLed2->CurrLedState = RTW_LED_OFF; -+ pLed2->BlinkingLedState = RTW_LED_OFF; -+ if(pLed2->bLedOn) -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ } -+ } -+ -+ //LED0 settings -+ if( pLed->bLedNoLinkBlinkInProgress == _FALSE ) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ if(IS_HARDWARE_TYPE_8812AU(Adapter)) -+ { -+ if(LedAction == LED_CTL_LINK) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ } -+ else -+ { -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ } -+ else -+ { -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ if((pmlmepriv->LinkDetectInfo.bBusyTraffic) && (check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE)) -+ ; -+ else //if(pLed->bLedScanBlinkInProgress ==FALSE) -+ { -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->bLedScanBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 24; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if(pLed->bLedBlinkInProgress == _FALSE) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ pLed2->bLedBlinkInProgress = _TRUE; -+ pLed2->BlinkingLedState = RTW_LED_ON; -+ pLed2->CurrLedState = LED_BLINK_LINK_IN_PROCESS; -+ pLed2->bLedWPSBlinkInProgress = _TRUE; -+ -+ _set_timer(&(pLed2->BlinkTimer), 500); -+ -+ break; -+ -+ case LED_CTL_STOP_WPS: //WPS connect success -+ //LED2 settings -+ if(pLed2->bLedWPSBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed2->BlinkTimer)); -+ pLed2->bLedBlinkInProgress = _FALSE; -+ pLed2->bLedWPSBlinkInProgress = _FALSE; -+ } -+ pLed2->CurrLedState = RTW_LED_ON; -+ pLed2->bLedNoLinkBlinkInProgress = _TRUE; -+ if(!pLed2->bLedOn) -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ -+ //LED1 settings -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ if( pLed1->bLedOn ) -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ -+ -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL: //WPS authentication fail -+ //LED1 settings -+ //if(bWPSOverLap == _FALSE) -+ { -+ pLed1->CurrLedState = LED_BLINK_AUTH_ERROR; -+ pLed1->BlinkTimes = 50; -+ if( pLed1->bLedOn ) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ //else -+ //{ -+ // bWPSOverLap = _FALSE; -+ // pLed1->CurrLedState = RTW_LED_OFF; -+ // pLed1->BlinkingLedState = RTW_LED_OFF; -+ // _set_timer(&(pLed1->BlinkTimer), 0); -+ //} -+ -+ //LED2 settings -+ pLed2->CurrLedState = RTW_LED_OFF; -+ pLed2->BlinkingLedState = RTW_LED_OFF; -+ pLed2->bLedWPSBlinkInProgress = _FALSE; -+ if( pLed2->bLedOn ) -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL_OVERLAP: //WPS session overlap -+ //LED1 settings -+ bWPSOverLap = _TRUE; -+ pLed1->CurrLedState = LED_BLINK_WPS_STOP_OVERLAP; -+ pLed1->BlinkTimes = 10; -+ pLed1->BlinkCounter = 50; -+ if( pLed1->bLedOn ) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ -+ //LED2 settings -+ pLed2->CurrLedState = RTW_LED_OFF; -+ pLed2->BlinkingLedState = RTW_LED_OFF; -+ pLed2->bLedWPSBlinkInProgress = _FALSE; -+ if( pLed2->bLedOn ) -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ if( pLed->bLedNoLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedStartToLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedStartToLinkBlinkInProgress = _FALSE; -+ } -+ -+ if( pLed1->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ -+ pLed1->BlinkingLedState = LED_UNKNOWN; -+ SwLedOff(Adapter, pLed); -+ SwLedOff(Adapter, pLed1); -+ break; -+ -+ case LED_CTL_CONNECTION_NO_TRANSFER: -+ if(pLed->bLedBlinkInProgress == _FALSE) -+ { -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 9 Led %d\n", pLed->CurrLedState)); -+} -+ -+//page added for Netgear A6200V2, 20120827 -+void -+SwLedControlMode10( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ PLED_USB pLed1 = &(ledpriv->SwLed1); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_START_TO_LINK: -+ if(pLed1->bLedBlinkInProgress == _FALSE) -+ { -+ pLed1->bLedBlinkInProgress = _TRUE; -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ pLed1->CurrLedState = LED_BLINK_LINK_IN_PROCESS; -+ -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ case LED_CTL_NO_LINK: -+ if(LedAction == LED_CTL_LINK) -+ { -+ if(pLed->bLedWPSBlinkInProgress == _TRUE || pLed1->bLedWPSBlinkInProgress == _TRUE) -+ ; -+ else -+ { -+ if(pHalData->CurrentBandType == BAND_ON_2_4G) -+ //LED0 settings -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if(pLed->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ _set_timer(&(pLed->BlinkTimer), 0); -+ -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ else if(pHalData->CurrentBandType == BAND_ON_5G) -+ //LED1 settings -+ { -+ pLed1->CurrLedState = RTW_LED_ON; -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ if(pLed1->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedBlinkInProgress = _FALSE; -+ } -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ } -+ } -+ else if(LedAction == LED_CTL_NO_LINK) //TODO by page -+ { -+ if(pLed->bLedWPSBlinkInProgress == _TRUE || pLed1->bLedWPSBlinkInProgress == _TRUE) -+ ; -+ else -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedOn ) -+ _set_timer(&(pLed->BlinkTimer), 0); -+ -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ if( pLed1->bLedOn ) -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ } -+ -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ if(check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) -+ ; //don't blink when media connect -+ else //if(pLed->bLedScanBlinkInProgress ==FALSE) -+ { -+ if(IS_LED_WPS_BLINKING(pLed) || IS_LED_WPS_BLINKING(pLed1)) -+ return; -+ -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->bLedScanBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 12; -+ pLed->BlinkingLedState = LED_BLINK_SCAN; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ -+ if(pLed1->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if(pLed1->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedBlinkInProgress = _FALSE; -+ } -+ pLed1->bLedScanBlinkInProgress = _TRUE; -+ pLed1->CurrLedState = LED_BLINK_SCAN; -+ pLed1->BlinkTimes = 12; -+ pLed1->BlinkingLedState = LED_BLINK_SCAN; -+ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_LINK_SLOWLY_INTERVAL_NETGEAR); -+ -+ } -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ //LED0 settings -+ if(pLed->bLedBlinkInProgress == _FALSE) -+ { -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ pLed->BlinkingLedState = LED_BLINK_WPS; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ //LED1 settings -+ if(pLed1->bLedBlinkInProgress == _FALSE) -+ { -+ pLed1->bLedBlinkInProgress = _TRUE; -+ pLed1->bLedWPSBlinkInProgress = _TRUE; -+ pLed1->BlinkingLedState = LED_BLINK_WPS; -+ pLed1->CurrLedState = LED_BLINK_WPS; -+ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_NORMAL_INTERVAL+LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ -+ -+ break; -+ -+ case LED_CTL_STOP_WPS: //WPS connect success -+ if(pHalData->CurrentBandType == BAND_ON_2_4G) -+ //LED0 settings -+ { -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if(pLed->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ _set_timer(&(pLed->BlinkTimer), 0); -+ -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ else if(pHalData->CurrentBandType == BAND_ON_5G) -+ //LED1 settings -+ { -+ pLed1->bLedWPSBlinkInProgress = _FALSE; -+ pLed1->CurrLedState = RTW_LED_ON; -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ if(pLed1->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedBlinkInProgress = _FALSE; -+ } -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL: //WPS authentication fail -+ //LED1 settings -+ pLed1->bLedWPSBlinkInProgress = _FALSE; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ -+ //LED0 settings -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedOn ) -+ _set_timer(&(pLed->BlinkTimer), 0); -+ -+ break; -+ -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 10 Led %d\n", pLed->CurrLedState)); -+} -+ -+ //Edimax-ASUS, added by Page, 20121221 -+void -+SwLedControlMode11( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_POWER_ON: -+ case LED_CTL_START_TO_LINK: -+ case LED_CTL_NO_LINK: -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_LINK: -+ if( pLed->bLedBlinkInProgress == _TRUE ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->BlinkTimes = 5; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ -+ break; -+ -+ -+ case LED_CTL_STOP_WPS: -+ case LED_CTL_STOP_WPS_FAIL: -+ if(pLed->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->CurrLedState = LED_BLINK_WPS_STOP; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ if( pLed->bLedNoLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led mode 1 CurrLedState %d\n", pLed->CurrLedState)); -+} -+ -+// page added for NEC -+ -+VOID -+SwLedControlMode12( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_POWER_ON: -+ case LED_CTL_NO_LINK: -+ case LED_CTL_LINK: -+ case LED_CTL_SITE_SURVEY: -+ -+ if( pLed->bLedNoLinkBlinkInProgress == _FALSE ) -+ { -+ if(pLed->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if(pLed->bLedBlinkInProgress == _FALSE) -+ { -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ -+ if(pLed->bLedNoLinkBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ } -+ -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SWLed12 %d\n", pLed->CurrLedState)); -+} -+ -+// Maddest add for NETGEAR R6100 -+ -+VOID -+SwLedControlMode13( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 13 CurrLedState %d, LedAction %d\n", pLed->CurrLedState,LedAction)); -+ switch(LedAction) -+ { -+ case LED_CTL_LINK: -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ return; -+ } -+ -+ -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed->bLedWPSBlinkInProgress == _FALSE) -+ { -+ if(pLed->bLedBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedScanBlinkInProgress == _TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_OFF_INTERVAL_NETGEAR); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_ON_INTERVAL_NETGEAR); -+ } -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ else -+ { -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ } -+ -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ pLed->CurrLedState = LED_BLINK_WPS_STOP; -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ break; -+ -+ -+ case LED_CTL_STOP_WPS_FAIL: -+ case LED_CTL_STOP_WPS_FAIL_OVERLAP: //WPS session overlap -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_TO_LINK: -+ if((pLed->bLedBlinkInProgress == _FALSE) && (pLed->bLedWPSBlinkInProgress == _FALSE)) -+ { -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->CurrLedState = LED_BLINK_LINK_IN_PROCESS; -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_NO_LINK: -+ -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ return; -+ } -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ //if(!IS_LED_BLINKING(pLed)) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ case LED_CTL_POWER_ON: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ if (LedAction == LED_CTL_POWER_ON) -+ _set_timer(&(pLed->BlinkTimer), 0); -+ else -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ -+} -+ -+// Maddest add for DNI Buffalo -+ -+VOID -+SwLedControlMode14( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 14 CurrLedState %d, LedAction %d\n", pLed->CurrLedState,LedAction)); -+ switch(LedAction) -+ { -+ case LED_CTL_POWER_OFF: -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 14 LED_CTL_POWER_OFF\n")); -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ case LED_CTL_POWER_ON: -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 14 LED_CTL_POWER_ON\n")); -+ SwLedOn(Adapter, pLed); -+ break; -+ -+ case LED_CTL_LINK: -+ case LED_CTL_NO_LINK: -+ if (IS_HARDWARE_TYPE_8812AU(Adapter)) -+ SwLedOn(Adapter, pLed); -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if(pLed->bLedBlinkInProgress ==_FALSE) -+ { -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if (IS_HARDWARE_TYPE_8812AU(Adapter)) -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ else -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if (IS_HARDWARE_TYPE_8812AU(Adapter)) -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ else -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+// Maddest add for Dlink -+ -+VOID -+SwLedControlMode15( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 15 CurrLedState %d, LedAction %d\n", pLed->CurrLedState,LedAction)); -+ switch(LedAction) -+ { -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 15 LED_CTL_START_WPS\n")); -+ if(pLed->bLedWPSBlinkInProgress ==_FALSE) -+ { -+ if(pLed->bLedBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if(pLed->bLedScanBlinkInProgress ==_TRUE) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_OFF_INTERVAL_NETGEAR); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_ON_INTERVAL_NETGEAR); -+ } -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 15 LED_CTL_STOP_WPS\n")); -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ } -+ -+ pLed->CurrLedState = LED_BLINK_WPS_STOP; -+ //if(check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL: -+ case LED_CTL_STOP_WPS_FAIL_OVERLAP: //WPS session overlap -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 15 LED_CTL_STOP_WPS_FAIL\n")); -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_NO_LINK: -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 15 LED_CTL_NO_LINK\n")); -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ return; -+ } -+ -+ /*if(Adapter->securitypriv.dot11PrivacyAlgrthm > _NO_PRIVACY_) -+ { -+ if(SecIsTxKeyInstalled(Adapter, pMgntInfo->Bssid)) -+ { -+ } -+ else -+ { -+ if(pMgntInfo->LEDAssocState ==LED_ASSOC_SECURITY_BEGIN) -+ return; -+ } -+ }*/ -+ -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = _FALSE; -+ } -+ //if(!IS_LED_BLINKING(pLed)) -+ { -+ pLed->CurrLedState = LED_BLINK_NO_LINK; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 30); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 15 LED_CTL_LINK\n")); -+ -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ return; -+ } -+ -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ -+ pLed->CurrLedState = LED_BLINK_LINK_IDEL; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), 30); -+ break; -+ -+ case LED_CTL_SITE_SURVEY : -+ if(check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) -+ return; -+ -+ if(pLed->bLedWPSBlinkInProgress ==_TRUE) -+ return; -+ -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ return; -+ } -+ -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+void -+LedControlUSB( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+ ) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ -+#if(MP_DRIVER == 1) -+ if (padapter->registrypriv.mp_mode == 1) -+ return; -+#endif -+ -+ if (RTW_CANNOT_RUN(padapter) || (!rtw_is_hw_init_completed(padapter))) { -+ /*DBG_871X("%s bDriverStopped:%s, bSurpriseRemoved:%s\n" -+ , __func__ -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False" );*/ -+ return; -+ } -+ -+ if( ledpriv->bRegUseLed == _FALSE) -+ return; -+ -+ //if(priv->bInHctTest) -+ // return; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ // Only do led action for PRIMARY_ADAPTER -+ if (padapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif -+ -+ if( (adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on && -+ adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) && -+ (LedAction == LED_CTL_TX || LedAction == LED_CTL_RX || -+ LedAction == LED_CTL_SITE_SURVEY || -+ LedAction == LED_CTL_LINK || -+ LedAction == LED_CTL_NO_LINK || -+ LedAction == LED_CTL_POWER_ON) ) -+ { -+ return; -+ } -+ -+ switch(ledpriv->LedStrategy) -+ { -+ case SW_LED_MODE0: -+ SwLedControlMode0(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE1: -+ SwLedControlMode1(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE2: -+ SwLedControlMode2(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE3: -+ SwLedControlMode3(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE4: -+ SwLedControlMode4(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE5: -+ SwLedControlMode5(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE6: -+ SwLedControlMode6(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE7: -+ SwLedControlMode7(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE8: -+ SwLedControlMode8(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE9: -+ SwLedControlMode9(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE10: -+ SwLedControlMode10(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE11: -+ SwLedControlMode11(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE12: -+ SwLedControlMode12(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE13: -+ SwLedControlMode13(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE14: -+ SwLedControlMode14(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE15: -+ SwLedControlMode15(padapter, LedAction); -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("LedStrategy:%d, LedAction %d\n", ledpriv->LedStrategy,LedAction)); -+} -+ -+// -+// Description: -+// Reset status of LED_871x object. -+// -+void ResetLedStatus(PLED_USB pLed) { -+ -+ pLed->CurrLedState = RTW_LED_OFF; // Current LED state. -+ pLed->bLedOn = _FALSE; // true if LED is ON, false if LED is OFF. -+ -+ pLed->bLedBlinkInProgress = _FALSE; // true if it is blinking, false o.w.. -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ -+ pLed->BlinkTimes = 0; // Number of times to toggle led state for blinking. -+ pLed->BlinkCounter = 0; -+ pLed->BlinkingLedState = LED_UNKNOWN; // Next state for blinking, either RTW_LED_ON or RTW_LED_OFF are. -+ -+ pLed->bLedNoLinkBlinkInProgress = _FALSE; -+ pLed->bLedLinkBlinkInProgress = _FALSE; -+ pLed->bLedStartToLinkBlinkInProgress = _FALSE; -+ pLed->bLedScanBlinkInProgress = _FALSE; -+} -+ -+ // -+// Description: -+// Initialize an LED_871x object. -+// -+void -+InitLed( -+ _adapter *padapter, -+ PLED_USB pLed, -+ LED_PIN LedPin -+ ) -+{ -+ pLed->padapter = padapter; -+ pLed->LedPin = LedPin; -+ -+ ResetLedStatus(pLed); -+ ATOMIC_SET(&pLed->bCancelWorkItem, _FALSE); -+ _init_timer(&(pLed->BlinkTimer), padapter->pnetdev, BlinkTimerCallback, pLed); -+ _init_workitem(&(pLed->BlinkWorkItem), BlinkWorkItemCallback, pLed); -+} -+ -+ -+// -+// Description: -+// DeInitialize an LED_871x object. -+// -+void -+DeInitLed( -+ PLED_USB pLed -+ ) -+{ -+ ATOMIC_SET(&pLed->bCancelWorkItem, _TRUE); -+ _cancel_workitem_sync(&(pLed->BlinkWorkItem)); -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ ResetLedStatus(pLed); -+} -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/halhwimg.h linux/3rdparty/rtl8812au/hal/phydm/halhwimg.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/halhwimg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/halhwimg.h 2017-06-07 23:07:21.014687849 +0300 -@@ -0,0 +1,123 @@ -+#pragma once -+#ifndef __INC_HW_IMG_H -+#define __INC_HW_IMG_H -+ -+// -+// 2011/03/15 MH Add for different IC HW image file selection. code size consideration. -+// -+#if RT_PLATFORM == PLATFORM_LINUX -+ -+ #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ // For 92C -+ #define RTL8192CE_HWIMG_SUPPORT 1 -+ #define RTL8192CE_TEST_HWIMG_SUPPORT 0 -+ #define RTL8192CU_HWIMG_SUPPORT 0 -+ #define RTL8192CU_TEST_HWIMG_SUPPORT 0 -+ -+ // For 92D -+ #define RTL8192DE_HWIMG_SUPPORT 1 -+ #define RTL8192DE_TEST_HWIMG_SUPPORT 0 -+ #define RTL8192DU_HWIMG_SUPPORT 0 -+ #define RTL8192DU_TEST_HWIMG_SUPPORT 0 -+ -+ // For 8723 -+ #define RTL8723E_HWIMG_SUPPORT 1 -+ #define RTL8723U_HWIMG_SUPPORT 0 -+ #define RTL8723S_HWIMG_SUPPORT 0 -+ -+ //For 88E -+ #define RTL8188EE_HWIMG_SUPPORT 0 -+ #define RTL8188EU_HWIMG_SUPPORT 0 -+ #define RTL8188ES_HWIMG_SUPPORT 0 -+ -+ #elif (DEV_BUS_TYPE == RT_USB_INTERFACE) -+ // For 92C -+ #define RTL8192CE_HWIMG_SUPPORT 0 -+ #define RTL8192CE_TEST_HWIMG_SUPPORT 0 -+ #define RTL8192CU_HWIMG_SUPPORT 1 -+ #define RTL8192CU_TEST_HWIMG_SUPPORT 0 -+ -+ //For 92D -+ #define RTL8192DE_HWIMG_SUPPORT 0 -+ #define RTL8192DE_TEST_HWIMG_SUPPORT 0 -+ #define RTL8192DU_HWIMG_SUPPORT 1 -+ #define RTL8192DU_TEST_HWIMG_SUPPORT 0 -+ -+ // For 8723 -+ #define RTL8723E_HWIMG_SUPPORT 0 -+ #define RTL8723U_HWIMG_SUPPORT 1 -+ #define RTL8723S_HWIMG_SUPPORT 0 -+ -+ //For 88E -+ #define RTL8188EE_HWIMG_SUPPORT 0 -+ #define RTL8188EU_HWIMG_SUPPORT 0 -+ #define RTL8188ES_HWIMG_SUPPORT 0 -+ -+ #elif (DEV_BUS_TYPE == RT_SDIO_INTERFACE) -+ // For 92C -+ #define RTL8192CE_HWIMG_SUPPORT 0 -+ #define RTL8192CE_TEST_HWIMG_SUPPORT 0 -+ #define RTL8192CU_HWIMG_SUPPORT 1 -+ #define RTL8192CU_TEST_HWIMG_SUPPORT 0 -+ -+ //For 92D -+ #define RTL8192DE_HWIMG_SUPPORT 0 -+ #define RTL8192DE_TEST_HWIMG_SUPPORT 0 -+ #define RTL8192DU_HWIMG_SUPPORT 1 -+ #define RTL8192DU_TEST_HWIMG_SUPPORT 0 -+ -+ // For 8723 -+ #define RTL8723E_HWIMG_SUPPORT 0 -+ #define RTL8723U_HWIMG_SUPPORT 0 -+ #define RTL8723S_HWIMG_SUPPORT 1 -+ -+ //For 88E -+ #define RTL8188EE_HWIMG_SUPPORT 0 -+ #define RTL8188EU_HWIMG_SUPPORT 0 -+ #define RTL8188ES_HWIMG_SUPPORT 0 -+ #endif -+ -+#else // PLATFORM_WINDOWS & MacOSX -+ -+//For 92C -+#define RTL8192CE_HWIMG_SUPPORT 1 -+#define RTL8192CE_TEST_HWIMG_SUPPORT 1 -+#define RTL8192CU_HWIMG_SUPPORT 1 -+#define RTL8192CU_TEST_HWIMG_SUPPORT 1 -+ -+// For 92D -+#define RTL8192DE_HWIMG_SUPPORT 1 -+#define RTL8192DE_TEST_HWIMG_SUPPORT 1 -+#define RTL8192DU_HWIMG_SUPPORT 1 -+#define RTL8192DU_TEST_HWIMG_SUPPORT 1 -+ -+ #if defined(UNDER_CE) -+ // For 8723 -+ #define RTL8723E_HWIMG_SUPPORT 0 -+ #define RTL8723U_HWIMG_SUPPORT 0 -+ #define RTL8723S_HWIMG_SUPPORT 1 -+ -+ // For 88E -+ #define RTL8188EE_HWIMG_SUPPORT 0 -+ #define RTL8188EU_HWIMG_SUPPORT 0 -+ #define RTL8188ES_HWIMG_SUPPORT 0 -+ -+ #else -+ -+ // For 8723 -+ #define RTL8723E_HWIMG_SUPPORT 1 -+ //#define RTL_8723E_TEST_HWIMG_SUPPORT 1 -+ #define RTL8723U_HWIMG_SUPPORT 1 -+ //#define RTL_8723U_TEST_HWIMG_SUPPORT 1 -+ #define RTL8723S_HWIMG_SUPPORT 1 -+ //#define RTL_8723S_TEST_HWIMG_SUPPORT 1 -+ -+ //For 88E -+ #define RTL8188EE_HWIMG_SUPPORT 1 -+ #define RTL8188EU_HWIMG_SUPPORT 1 -+ #define RTL8188ES_HWIMG_SUPPORT 1 -+ #endif -+ -+#endif -+ -+#endif //__INC_HW_IMG_H -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/halphyrf_ap.c linux/3rdparty/rtl8812au/hal/phydm/halphyrf_ap.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/halphyrf_ap.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/halphyrf_ap.c 2017-06-07 23:07:21.015687940 +0300 -@@ -0,0 +1,2504 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ #include "mp_precomp.h" -+ #include "phydm_precomp.h" -+ -+#ifndef index_mapping_NUM_88E -+ #define index_mapping_NUM_88E 15 -+#endif -+ -+//#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ -+ do {\ -+ for(_offset = 0; _offset < _size; _offset++)\ -+ {\ -+ if(_deltaThermal < thermalThreshold[_direction][_offset])\ -+ {\ -+ if(_offset != 0)\ -+ _offset--;\ -+ break;\ -+ }\ -+ } \ -+ if(_offset >= _size)\ -+ _offset = _size-1;\ -+ } while(0) -+ -+ -+void ConfigureTxpowerTrack( -+ IN PVOID pDM_VOID, -+ OUT PTXPWRTRACK_CFG pConfig -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if RTL8812A_SUPPORT -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ //if (IS_HARDWARE_TYPE_8812(pDM_Odm->Adapter)) -+ if(pDM_Odm->SupportICType==ODM_RTL8812) -+ ConfigureTxpowerTrack_8812A(pConfig); -+ //else -+#endif -+#endif -+ -+#if RTL8814A_SUPPORT -+ if(pDM_Odm->SupportICType== ODM_RTL8814A) -+ ConfigureTxpowerTrack_8814A(pConfig); -+#endif -+ -+ -+#if RTL8188E_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8188E) -+ ConfigureTxpowerTrack_8188E(pConfig); -+#endif -+} -+ -+#if (RTL8192E_SUPPORT==1) -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_92E( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte ThermalValue = 0, delta, delta_IQK, delta_LCK, channel, is_decrease, rf_mimo_mode; -+ u1Byte ThermalValue_AVG_count = 0; -+ u1Byte OFDM_min_index = 10; //OFDM BB Swing should be less than +2.5dB, which is required by Arthur -+ s1Byte OFDM_index[2], index ; -+ u4Byte ThermalValue_AVG = 0, Reg0x18; -+ u4Byte i = 0, j = 0, rf; -+ s4Byte value32, CCK_index = 0, ele_A, ele_D, ele_C, X, Y; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ rf_mimo_mode = pDM_Odm->RFType; -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("%s:%d rf_mimo_mode:%d\n", __FUNCTION__, __LINE__, rf_mimo_mode)); -+ -+#ifdef MP_TEST -+ if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { -+ channel = priv->pshare->working_channel; -+ if (priv->pshare->mp_txpwr_tracking == FALSE) -+ return; -+ } else -+#endif -+ { -+ channel = (priv->pmib->dot11RFEntry.dot11channel); -+ } -+ -+ ThermalValue = (unsigned char)ODM_GetRFReg(pDM_Odm, RF_PATH_A, ODM_RF_T_METER_92E, 0xfc00); //0x42: RF Reg[15:10] 88E -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ -+ -+ switch (rf_mimo_mode) { -+ case MIMO_1T1R: -+ rf = 1; -+ break; -+ case MIMO_2T2R: -+ rf = 2; -+ break; -+ default: -+ rf = 2; -+ break; -+ } -+ -+ //Query OFDM path A default setting Bit[31:21] -+ ele_D = PHY_QueryBBReg(priv, rOFDM0_XATxIQImbalance, bMaskOFDM_D); -+ for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) { -+ if (ele_D == (OFDMSwingTable_92E[i] >> 22)) { -+ OFDM_index[0] = (unsigned char)i; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("PathA 0xC80[31:22] = 0x%x, OFDM_index=%d\n", ele_D, OFDM_index[0])); -+ break; -+ } -+ } -+ -+ //Query OFDM path B default setting -+ if (rf_mimo_mode == MIMO_2T2R) { -+ ele_D = PHY_QueryBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskOFDM_D); -+ for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) { -+ if (ele_D == (OFDMSwingTable_92E[i] >> 22)) { -+ OFDM_index[1] = (unsigned char)i; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("PathB 0xC88[31:22] = 0x%x, OFDM_index=%d\n", ele_D, OFDM_index[1])); -+ break; -+ } -+ } -+ } -+ -+ /* calculate average thermal meter */ -+ { -+ priv->pshare->ThermalValue_AVG_88XX[priv->pshare->ThermalValue_AVG_index_88XX] = ThermalValue; -+ priv->pshare->ThermalValue_AVG_index_88XX++; -+ if (priv->pshare->ThermalValue_AVG_index_88XX == AVG_THERMAL_NUM_88XX) -+ priv->pshare->ThermalValue_AVG_index_88XX = 0; -+ -+ for (i = 0; i < AVG_THERMAL_NUM_88XX; i++) { -+ if (priv->pshare->ThermalValue_AVG_88XX[i]) { -+ ThermalValue_AVG += priv->pshare->ThermalValue_AVG_88XX[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if (ThermalValue_AVG_count) { -+ ThermalValue = (unsigned char)(ThermalValue_AVG / ThermalValue_AVG_count); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("AVG Thermal Meter = 0x%x \n", ThermalValue)); -+ } -+ } -+ -+ /* Initialize */ -+ if (!priv->pshare->ThermalValue) { -+ priv->pshare->ThermalValue = priv->pmib->dot11RFEntry.ther; -+ priv->pshare->ThermalValue_IQK = ThermalValue; -+ priv->pshare->ThermalValue_LCK = ThermalValue; -+ } -+ -+ if (ThermalValue != priv->pshare->ThermalValue) { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** START POWER TRACKING ********\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ -+ delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); -+ delta_IQK = RTL_ABS(ThermalValue, priv->pshare->ThermalValue_IQK); -+ delta_LCK = RTL_ABS(ThermalValue, priv->pshare->ThermalValue_LCK); -+ is_decrease = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 1 : 0); -+ -+#ifdef _TRACKING_TABLE_FILE -+ if (priv->pshare->rf_ft_var.pwr_track_file) { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Diff: (%s)%d ==> get index from table : %d)\n", (is_decrease?"-":"+"), delta, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); -+ -+ if (is_decrease) { -+ for (i = 0; i < rf; i++) { -+ OFDM_index[i] = priv->pshare->OFDM_index0[i] + get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0); -+ OFDM_index[i] = ((OFDM_index[i] > (OFDM_TABLE_SIZE_92E- 1)) ? (OFDM_TABLE_SIZE_92E - 1) : OFDM_index[i]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> decrese power ---> new OFDM_INDEX:%d (%d + %d)\n", OFDM_index[i], priv->pshare->OFDM_index0[i], get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); -+ CCK_index = priv->pshare->CCK_index0 + get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1); -+ CCK_index = ((CCK_index > (CCK_TABLE_SIZE_92E - 1)) ? (CCK_TABLE_SIZE_92E - 1) : CCK_index); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> Decrese power ---> new CCK_INDEX:%d (%d + %d)\n", CCK_index, priv->pshare->CCK_index0, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1))); -+ } -+ } else { -+ for (i = 0; i < rf; i++) { -+ OFDM_index[i] = priv->pshare->OFDM_index0[i] - get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0); -+ OFDM_index[i] = ((OFDM_index[i] < OFDM_min_index) ? OFDM_min_index : OFDM_index[i]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> Increse power ---> new OFDM_INDEX:%d (%d - %d)\n", OFDM_index[i], priv->pshare->OFDM_index0[i], get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); -+ CCK_index = priv->pshare->CCK_index0 - get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1); -+ CCK_index = ((CCK_index < 0 )? 0 : CCK_index); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> Increse power ---> new CCK_INDEX:%d (%d - %d)\n", CCK_index, priv->pshare->CCK_index0, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1))); -+ } -+ } -+ } -+#endif //CFG_TRACKING_TABLE_FILE -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDMSwingTable_92E[(unsigned int)OFDM_index[0]] = %x \n",OFDMSwingTable_92E[(unsigned int)OFDM_index[0]])); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDMSwingTable_92E[(unsigned int)OFDM_index[1]] = %x \n",OFDMSwingTable_92E[(unsigned int)OFDM_index[1]])); -+ -+ //Adujst OFDM Ant_A according to IQK result -+ ele_D = (OFDMSwingTable_92E[(unsigned int)OFDM_index[0]] & 0xFFC00000) >> 22; -+ X = priv->pshare->RegE94; -+ Y = priv->pshare->RegE9C; -+ -+ if (X != 0) { -+ if ((X & 0x00000200) != 0) -+ X = X | 0xFFFFFC00; -+ ele_A = ((X * ele_D) >> 8) & 0x000003FF; -+ -+ //new element C = element D x Y -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ ele_C = ((Y * ele_D) >> 8) & 0x000003FF; -+ -+ //wirte new elements A, C, D to regC80 and regC94, element B is always 0 -+ value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; -+ PHY_SetBBReg(priv, rOFDM0_XATxIQImbalance, bMaskDWord, value32); -+ -+ value32 = (ele_C&0x000003C0)>>6; -+ PHY_SetBBReg(priv, rOFDM0_XCTxAFE, bMaskH4Bits, value32); -+ -+ value32 = ((X * ele_D)>>7)&0x01; -+ PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(24), value32); -+ } else { -+ PHY_SetBBReg(priv, rOFDM0_XATxIQImbalance, bMaskDWord, OFDMSwingTable_92E[(unsigned int)OFDM_index[0]]); -+ PHY_SetBBReg(priv, rOFDM0_XCTxAFE, bMaskH4Bits, 0x00); -+ PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(24), 0x00); -+ } -+ -+ set_CCK_swing_index(priv, CCK_index); -+ -+ if (rf == 2) { -+ ele_D = (OFDMSwingTable_92E[(unsigned int)OFDM_index[1]] & 0xFFC00000) >> 22; -+ X = priv->pshare->RegEB4; -+ Y = priv->pshare->RegEBC; -+ -+ if (X != 0) { -+ if ((X & 0x00000200) != 0) //consider minus -+ X = X | 0xFFFFFC00; -+ ele_A = ((X * ele_D) >> 8) & 0x000003FF; -+ -+ //new element C = element D x Y -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ ele_C = ((Y * ele_D) >> 8) & 0x00003FF; -+ -+ //wirte new elements A, C, D to regC88 and regC9C, element B is always 0 -+ value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; -+ PHY_SetBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskDWord, value32); -+ -+ value32 = (ele_C & 0x000003C0) >> 6; -+ PHY_SetBBReg(priv, rOFDM0_XDTxAFE, bMaskH4Bits, value32); -+ -+ value32 = ((X * ele_D) >> 7) & 0x01; -+ PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(28), value32); -+ } else { -+ PHY_SetBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskDWord, OFDMSwingTable_92E[(unsigned int)OFDM_index[1]]); -+ PHY_SetBBReg(priv, rOFDM0_XDTxAFE, bMaskH4Bits, 0x00); -+ PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(28), 0x00); -+ } -+ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("0xc80 = 0x%x \n", PHY_QueryBBReg(priv, rOFDM0_XATxIQImbalance, bMaskDWord))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("0xc88 = 0x%x \n", PHY_QueryBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskDWord))); -+ -+ if (delta_IQK > 3) { -+ priv->pshare->ThermalValue_IQK = ThermalValue; -+#ifdef MP_TEST -+ if (!(priv->pshare->rf_ft_var.mp_specific && (OPMODE & (WIFI_MP_CTX_BACKGROUND | WIFI_MP_CTX_PACKET)))) -+#endif -+ PHY_IQCalibrate_8192E(pDM_Odm,false); -+ } -+ -+ if (delta_LCK > 8) { -+ RTL_W8(0x522, 0xff); -+ Reg0x18 = PHY_QueryRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, 1); -+ PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 1); -+ PHY_SetRFReg(priv, RF_PATH_A, 0x18, BIT(15), 1); -+ delay_ms(1); -+ PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 0); -+ PHY_SetRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, Reg0x18); -+ RTL_W8(0x522, 0x0); -+ priv->pshare->ThermalValue_LCK = ThermalValue; -+ } -+ } -+ -+ //update thermal meter value -+ priv->pshare->ThermalValue = ThermalValue; -+ for (i = 0 ; i < rf ; i++) -+ priv->pshare->OFDM_index[i] = OFDM_index[i]; -+ priv->pshare->CCK_index = CCK_index; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n", __FUNCTION__)); -+} -+#endif -+ -+#if (RTL8814A_SUPPORT ==1) -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries2( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, channel, is_increase; -+ u1Byte ThermalValue_AVG_count = 0, p = 0, i = 0; -+ u4Byte ThermalValue_AVG = 0, Reg0x18; -+ u4Byte BBSwingReg[4] = {rA_TxScale_Jaguar,rB_TxScale_Jaguar,rC_TxScale_Jaguar2,rD_TxScale_Jaguar2}; -+ s4Byte ele_D; -+ u4Byte BBswingIdx; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ TXPWRTRACK_CFG c; -+ BOOLEAN bTSSIenable = FALSE; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. -+ pu1Byte deltaSwingTableIdx_TUP_A = NULL, deltaSwingTableIdx_TDOWN_A = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_B = NULL, deltaSwingTableIdx_TDOWN_B = NULL; -+ //for 8814 add by Yu Chen -+ pu1Byte deltaSwingTableIdx_TUP_C = NULL, deltaSwingTableIdx_TDOWN_C = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_D = NULL, deltaSwingTableIdx_TDOWN_D = NULL; -+ -+#ifdef MP_TEST -+ if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { -+ channel = priv->pshare->working_channel; -+ if (priv->pshare->mp_txpwr_tracking == FALSE) -+ return; -+ } else -+#endif -+ { -+ channel = (priv->pmib->dot11RFEntry.dot11channel); -+ } -+ -+ ConfigureTxpowerTrack(pDM_Odm, &c); -+ pRFCalibrateInfo->DefaultOfdmIndex = priv->pshare->OFDM_index0[ODM_RF_PATH_A]; -+ -+ (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte*)&deltaSwingTableIdx_TUP_A, (pu1Byte*)&deltaSwingTableIdx_TDOWN_A, -+ (pu1Byte*)&deltaSwingTableIdx_TUP_B, (pu1Byte*)&deltaSwingTableIdx_TDOWN_B); -+ -+ if(pDM_Odm->SupportICType & ODM_RTL8814A) // for 8814 path C & D -+ (*c.GetDeltaSwingTable8814only)(pDM_Odm, (pu1Byte*)&deltaSwingTableIdx_TUP_C, (pu1Byte*)&deltaSwingTableIdx_TDOWN_C, -+ (pu1Byte*)&deltaSwingTableIdx_TUP_D, (pu1Byte*)&deltaSwingTableIdx_TDOWN_D); -+ -+ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\nReadback Thermal Meter = 0x%x, pre thermal meter 0x%x, EEPROMthermalmeter 0x%x\n", ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ -+ /* Initialize */ -+ if (!pDM_Odm->RFCalibrateInfo.ThermalValue) { -+ pDM_Odm->RFCalibrateInfo.ThermalValue = priv->pmib->dot11RFEntry.ther; -+ } -+ -+ if (!pDM_Odm->RFCalibrateInfo.ThermalValue_LCK) { -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = priv->pmib->dot11RFEntry.ther; -+ } -+ -+ if (!pDM_Odm->RFCalibrateInfo.ThermalValue_IQK) { -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = priv->pmib->dot11RFEntry.ther; -+ } -+ -+ bTSSIenable = (BOOLEAN)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, rRF_TxGainOffset, BIT7); // check TSSI enable -+ -+ //4 Query OFDM BB swing default setting Bit[31:21] -+ for(p = ODM_RF_PATH_A ; p < c.RfPathCount ; p++) -+ { -+ ele_D = ODM_GetBBReg(pDM_Odm, BBSwingReg[p], 0xffe00000); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("0x%x:0x%x ([31:21] = 0x%x)\n", BBSwingReg[p], ODM_GetBBReg(pDM_Odm, BBSwingReg[p], bMaskDWord), ele_D)); -+ -+ for (BBswingIdx = 0; BBswingIdx < TXSCALE_TABLE_SIZE; BBswingIdx++) {//4 -+ if (ele_D == TxScalingTable_Jaguar[BBswingIdx]) { -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = (u1Byte)BBswingIdx; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("OFDM_index[%d]=%d\n",p, pDM_Odm->RFCalibrateInfo.OFDM_index[p])); -+ break; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("KfreeOffset[%d]=%d\n",p, pRFCalibrateInfo->KfreeOffset[p])); -+ -+ } -+ -+ /* calculate average thermal meter */ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; -+ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) //Average times = c.AverageThermalNum -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; -+ -+ for(i = 0; i < c.AverageThermalNum; i++) -+ { -+ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) -+ { -+ ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times -+ { -+ ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("AVG Thermal Meter = 0x%X, EEPROMthermalmeter = 0x%X\n", ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ } -+ -+ //4 Calculate delta, delta_LCK, delta_IQK. -+ delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); -+ delta_LCK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_LCK); -+ delta_IQK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_IQK); -+ is_increase = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 0 : 1); -+ -+ //4 if necessary, do LCK. -+ if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { -+ if (delta_LCK > c.Threshold_IQK) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; -+ if (c.PHY_LCCalibrate) -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ } -+ } -+ -+ if (delta_IQK > c.Threshold_IQK) -+ { -+ panic_printk("%s(%d)\n", __FUNCTION__, __LINE__); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= Threshold_IQK(%d)\n", delta_IQK, c.Threshold_IQK)); -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = ThermalValue; -+ if(c.DoIQK) -+ (*c.DoIQK)(pDM_Odm, TRUE, 0, 0); -+ } -+ -+ if(!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ -+ return; -+ -+ //4 Do Power Tracking -+ -+ if(bTSSIenable == TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("**********Enter PURE TSSI MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TSSI_MODE, p, 0); -+ } -+ else if (ThermalValue != pDM_Odm->RFCalibrateInfo.ThermalValue) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\n******** START POWER TRACKING ********\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ -+#ifdef _TRACKING_TABLE_FILE -+ if (priv->pshare->rf_ft_var.pwr_track_file) -+ { -+ if (is_increase) // thermal is higher than base -+ { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ switch(p) -+ { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ } -+ } -+ } -+ else // thermal is lower than base -+ { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ switch(p) -+ { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ } -+ } -+ } -+ -+ if (is_increase) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> increse power ---> \n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> decrese power --->\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); -+ } -+ } -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** END:%s() ********\n", __FUNCTION__)); -+ //update thermal meter value -+ pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; -+ -+ } -+} -+ -+#elif(ODM_IC_11AC_SERIES_SUPPORT) -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ unsigned char ThermalValue = 0, delta, delta_LCK, channel, is_decrease; -+ unsigned char ThermalValue_AVG_count = 0; -+ unsigned int ThermalValue_AVG = 0, Reg0x18; -+ unsigned int BBSwingReg[4]={0xc1c,0xe1c,0x181c,0x1a1c}; -+ int ele_D, value32; -+ char OFDM_index[2], index; -+ unsigned int i = 0, j = 0, rf_path, max_rf_path =2 ,rf; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ unsigned char OFDM_min_index = 7; //OFDM BB Swing should be less than +2.5dB, which is required by Arthur and Mimic -+ -+#ifdef MP_TEST -+ if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { -+ channel = priv->pshare->working_channel; -+ if (priv->pshare->mp_txpwr_tracking == FALSE) -+ return; -+ } else -+#endif -+ { -+ channel = (priv->pmib->dot11RFEntry.dot11channel); -+ } -+ -+#if RTL8881A_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8881A) { -+ max_rf_path = 1; -+ if ((get_bonding_type_8881A() == BOND_8881AM ||get_bonding_type_8881A() == BOND_8881AN) -+ && priv->pshare->rf_ft_var.use_intpa8881A && (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G)) -+ OFDM_min_index = 6; // intPA - upper bond set to +3 dB (base: -2 dB)ot11RFEntry.phyBandSelect == PHY_BAND_2G)) -+ else -+ OFDM_min_index = 10; //OFDM BB Swing should be less than +1dB, which is required by Arthur and Mimic -+ } -+#endif -+ -+ -+ ThermalValue = (unsigned char)PHY_QueryRFReg(priv, RF_PATH_A, 0x42, 0xfc00, 1); //0x42: RF Reg[15:10] 88E -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ -+ -+ //4 Query OFDM BB swing default setting Bit[31:21] -+ for(rf_path = 0 ; rf_path < max_rf_path ; rf_path++){ -+ ele_D = PHY_QueryBBReg(priv, BBSwingReg[rf_path], 0xffe00000); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("0x%x:0x%x ([31:21] = 0x%x)\n",BBSwingReg[rf_path], PHY_QueryBBReg(priv, BBSwingReg[rf_path], bMaskDWord),ele_D)); -+ for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {//4 -+ if (ele_D == OFDMSwingTable_8812[i]) { -+ OFDM_index[rf_path] = (unsigned char)i; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDM_index[%d]=%d\n",rf_path, OFDM_index[rf_path])); -+ break; -+ } -+ } -+ } -+#if 0 -+ //Query OFDM path A default setting Bit[31:21] -+ ele_D = PHY_QueryBBReg(priv, 0xc1c, 0xffe00000); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("0xc1c:0x%x ([31:21] = 0x%x)\n", PHY_QueryBBReg(priv, 0xc1c, bMaskDWord),ele_D)); -+ for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {//4 -+ if (ele_D == OFDMSwingTable_8812[i]) { -+ OFDM_index[0] = (unsigned char)i; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDM_index[0]=%d\n", OFDM_index[0])); -+ break; -+ } -+ } -+ //Query OFDM path B default setting -+ if (rf == 2) { -+ ele_D = PHY_QueryBBReg(priv, 0xe1c, 0xffe00000); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("0xe1c:0x%x ([32:21] = 0x%x)\n", PHY_QueryBBReg(priv, 0xe1c, bMaskDWord),ele_D)); -+ for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) { -+ if (ele_D == OFDMSwingTable_8812[i]) { -+ OFDM_index[1] = (unsigned char)i; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDM_index[1]=%d\n", OFDM_index[1])); -+ break; -+ } -+ } -+ } -+#endif -+ /* Initialize */ -+ if (!priv->pshare->ThermalValue) { -+ priv->pshare->ThermalValue = priv->pmib->dot11RFEntry.ther; -+ priv->pshare->ThermalValue_LCK = ThermalValue; -+ } -+ -+ /* calculate average thermal meter */ -+ { -+ priv->pshare->ThermalValue_AVG_8812[priv->pshare->ThermalValue_AVG_index_8812] = ThermalValue; -+ priv->pshare->ThermalValue_AVG_index_8812++; -+ if (priv->pshare->ThermalValue_AVG_index_8812 == AVG_THERMAL_NUM_8812) -+ priv->pshare->ThermalValue_AVG_index_8812 = 0; -+ -+ for (i = 0; i < AVG_THERMAL_NUM_8812; i++) { -+ if (priv->pshare->ThermalValue_AVG_8812[i]) { -+ ThermalValue_AVG += priv->pshare->ThermalValue_AVG_8812[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if (ThermalValue_AVG_count) { -+ ThermalValue = (unsigned char)(ThermalValue_AVG / ThermalValue_AVG_count); -+ //printk("AVG Thermal Meter = 0x%x \n", ThermalValue); -+ } -+ } -+ -+ -+ //4 If necessary, do power tracking -+ -+ if(!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ -+ return; -+ -+ if (ThermalValue != priv->pshare->ThermalValue) { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** START POWER TRACKING ********\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); -+ delta_LCK = RTL_ABS(ThermalValue, priv->pshare->ThermalValue_LCK); -+ is_decrease = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 1 : 0); -+ //if (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) -+ { -+#ifdef _TRACKING_TABLE_FILE -+ if (priv->pshare->rf_ft_var.pwr_track_file) { -+ for (rf_path = 0; rf_path < max_rf_path; rf_path++) { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Diff: (%s)%d ==> get index from table : %d)\n", (is_decrease?"-":"+"), delta, get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); -+ if (is_decrease) { -+ OFDM_index[rf_path] = priv->pshare->OFDM_index0[rf_path] + get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0); -+ OFDM_index[rf_path] = ((OFDM_index[rf_path] > (OFDM_TABLE_SIZE_8812 - 1)) ? (OFDM_TABLE_SIZE_8812 - 1) : OFDM_index[rf_path]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> decrese power ---> new OFDM_INDEX:%d (%d + %d)\n", OFDM_index[rf_path], priv->pshare->OFDM_index0[rf_path], get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); -+#if 0// RTL8881A_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8881A){ -+ if(priv->pshare->rf_ft_var.pwrtrk_TxAGC_enable){ -+ if(priv->pshare->AddTxAGC){//TxAGC has been added -+ AddTxPower88XX_AC(priv,0); -+ priv->pshare->AddTxAGC = 0; -+ priv->pshare->AddTxAGC_index = 0; -+ } -+ } -+ } -+#endif -+ } else { -+ -+ OFDM_index[rf_path] = priv->pshare->OFDM_index0[rf_path] - get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0); -+#if 0// RTL8881A_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8881A){ -+ if(priv->pshare->rf_ft_var.pwrtrk_TxAGC_enable){ -+ if(OFDM_index[i] < OFDM_min_index){ -+ priv->pshare->AddTxAGC_index = (OFDM_min_index - OFDM_index[i])/2; // Calculate Remnant TxAGC Value, 2 index for 1 TxAGC -+ AddTxPower88XX_AC(priv,priv->pshare->AddTxAGC_index); -+ priv->pshare->AddTxAGC = 1; //AddTxAGC Flag = 1 -+ OFDM_index[i] = OFDM_min_index; -+ } -+ else{ -+ if(priv->pshare->AddTxAGC){// TxAGC been added -+ priv->pshare->AddTxAGC = 0; -+ priv->pshare->AddTxAGC_index = 0; -+ AddTxPower88XX_AC(priv,0); //minus the added TPI -+ } -+ } -+ } -+ } -+#else -+ OFDM_index[rf_path] = ((OFDM_index[rf_path] < OFDM_min_index) ? OFDM_min_index : OFDM_index[rf_path]); -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> increse power ---> new OFDM_INDEX:%d (%d - %d)\n", OFDM_index[rf_path], priv->pshare->OFDM_index0[rf_path], get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); -+ } -+ } -+ } -+#endif -+ //4 Set new BB swing index -+ for (rf_path = 0; rf_path < max_rf_path; rf_path++) { -+ PHY_SetBBReg(priv, BBSwingReg[rf_path], 0xffe00000, OFDMSwingTable_8812[(unsigned int)OFDM_index[rf_path]]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Readback 0x%x[31:21] = 0x%x, OFDM_index:%d\n",BBSwingReg[rf_path], PHY_QueryBBReg(priv, BBSwingReg[rf_path], 0xffe00000), OFDM_index[rf_path])); -+ } -+ -+ } -+ if (delta_LCK > 8) { -+ RTL_W8(0x522, 0xff); -+ Reg0x18 = PHY_QueryRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, 1); -+ PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 1); -+ PHY_SetRFReg(priv, RF_PATH_A, 0x18, BIT(15), 1); -+ delay_ms(200); // frequency deviation -+ PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 0); -+ PHY_SetRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, Reg0x18); -+ #ifdef CONFIG_RTL_8812_SUPPORT -+ if (GET_CHIP_VER(priv)== VERSION_8812E) -+ UpdateBBRFVal8812(priv, priv->pmib->dot11RFEntry.dot11channel); -+ #endif -+ RTL_W8(0x522, 0x0); -+ priv->pshare->ThermalValue_LCK = ThermalValue; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** END:%s() ********\n", __FUNCTION__)); -+ -+ //update thermal meter value -+ priv->pshare->ThermalValue = ThermalValue; -+ for (rf_path = 0; rf_path < max_rf_path; rf_path++) -+ priv->pshare->OFDM_index[rf_path] = OFDM_index[rf_path]; -+ } -+} -+ -+#endif -+ -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+#if (RTL8814A_SUPPORT == 1) //use this function to do power tracking after 8814 by YuChen -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) { -+ ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries2(pDM_Odm); -+ return; -+ } -+#elif ODM_IC_11AC_SERIES_SUPPORT -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries(pDM_Odm); -+ return; -+ } -+#endif -+ -+#if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType==ODM_RTL8192E) { -+ ODM_TXPowerTrackingCallback_ThermalMeter_92E(pDM_Odm); -+ return; -+ } -+#endif -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ //PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+#endif -+ -+ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, offset; -+ u1Byte ThermalValue_AVG_count = 0; -+ u4Byte ThermalValue_AVG = 0; -+// s4Byte ele_A=0, ele_D, TempCCk, X, value32; -+// s4Byte Y, ele_C=0; -+// s1Byte OFDM_index[2], CCK_index=0, OFDM_index_old[2]={0,0}, CCK_index_old=0, index; -+// s1Byte deltaPowerIndex = 0; -+ u4Byte i = 0;//, j = 0; -+ BOOLEAN is2T = FALSE; -+// BOOLEAN bInteralPA = FALSE; -+ -+ u1Byte OFDM_max_index = 34, rf = (is2T) ? 2 : 1; //OFDM BB Swing should be less than +3.0dB, which is required by Arthur -+ u1Byte Indexforchannel = 0;/*GetRightChnlPlaceforIQK(pHalData->CurrentChannel)*/ -+ enum _POWER_DEC_INC { POWER_DEC, POWER_INC }; -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+ -+ TXPWRTRACK_CFG c; -+ -+ -+ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. -+ s1Byte deltaSwingTableIdx[2][index_mapping_NUM_88E] = { -+ // {{Power decreasing(lower temperature)}, {Power increasing(higher temperature)}} -+ {0,0,2,3,4,4,5,6,7,7,8,9,10,10,11}, {0,0,1,2,3,4,4,4,4,5,7,8,9,9,10} -+ }; -+ u1Byte thermalThreshold[2][index_mapping_NUM_88E]={ -+ // {{Power decreasing(lower temperature)}, {Power increasing(higher temperature)}} -+ {0,2,4,6,8,10,12,14,16,18,20,22,24,26,27}, {0,2,4,6,8,10,12,14,16,18,20,22,25,25,25} -+ }; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+#endif -+ -+ //4 2. Initilization ( 7 steps in total ) -+ -+ ConfigureTxpowerTrack(pDM_Odm, &c); -+ -+ pDM_Odm->RFCalibrateInfo.TXPowerTrackingCallbackCnt++; //cosa add for debug -+ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = TRUE; -+ -+#if (MP_DRIVER == 1) -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = pHalData->TxPowerTrackControl; // We should keep updating the control variable according to HalData. -+ // RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. -+ pDM_Odm->RFCalibrateInfo.RegA24 = 0x090e1317; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && defined(MP_TEST) -+ if ((OPMODE & WIFI_MP_STATE) || pDM_Odm->priv->pshare->rf_ft_var.mp_specific) { -+ if(pDM_Odm->priv->pshare->mp_txpwr_tracking == FALSE) -+ return; -+ } -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>odm_TXPowerTrackingCallback_ThermalMeter_8188E, pDM_Odm->BbSwingIdxCckBase: %d, pDM_Odm->BbSwingIdxOfdmBase: %d \n", pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->BbSwingIdxOfdmBase)); -+/* -+ if (!pDM_Odm->RFCalibrateInfo.TM_Trigger) { -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, c.ThermalRegAddr, BIT17 | BIT16, 0x3); -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; -+ return; -+ } -+*/ -+ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if( ! ThermalValue || ! pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) -+#else -+ if( ! pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) -+#endif -+ return; -+ -+ //4 3. Initialize ThermalValues of RFCalibrateInfo -+ -+ if( ! pDM_Odm->RFCalibrateInfo.ThermalValue) -+ { -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = ThermalValue; -+ } -+ -+ if(pDM_Odm->RFCalibrateInfo.bReloadtxpowerindex) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); -+ } -+ -+ //4 4. Calculate average thermal meter -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; -+ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; -+ -+ for(i = 0; i < c.AverageThermalNum; i++) -+ { -+ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) -+ { -+ ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if(ThermalValue_AVG_count) -+ { -+ // Give the new thermo value a weighting -+ ThermalValue_AVG += (ThermalValue*4); -+ -+ ThermalValue = (u1Byte)(ThermalValue_AVG / (ThermalValue_AVG_count+4)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("AVG Thermal Meter = 0x%x \n", ThermalValue)); -+ } -+ -+ //4 5. Calculate delta, delta_LCK, delta_IQK. -+ -+ delta = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue):(pDM_Odm->RFCalibrateInfo.ThermalValue - ThermalValue); -+ delta_LCK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_LCK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK):(pDM_Odm->RFCalibrateInfo.ThermalValue_LCK - ThermalValue); -+ delta_IQK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_IQK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK):(pDM_Odm->RFCalibrateInfo.ThermalValue_IQK - ThermalValue); -+ -+ //4 6. If necessary, do LCK. -+ if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { -+ /*if((delta_LCK > pHalData->Delta_LCK) && (pHalData->Delta_LCK != 0))*/ -+ if (delta_LCK >= c.Threshold_IQK) { -+ /*Delta temperature is equal to or larger than 20 centigrade.*/ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ } -+ } -+ -+ //3 7. If necessary, move the index of swing table to adjust Tx power. -+ -+ if (delta > 0 && pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) -+ { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); -+#else -+ delta = (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther)?(ThermalValue - pDM_Odm->priv->pmib->dot11RFEntry.ther):(pDM_Odm->priv->pmib->dot11RFEntry.ther - ThermalValue); -+#endif -+ -+ -+ //4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(ThermalValue > pHalData->EEPROMThermalMeter) { -+#else -+ if(ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { -+#endif -+ CALCULATE_SWINGTALBE_OFFSET(offset, POWER_INC, index_mapping_NUM_88E, delta); -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex = deltaSwingTableIdx[POWER_INC][offset]; -+ -+ } else { -+ -+ CALCULATE_SWINGTALBE_OFFSET(offset, POWER_DEC, index_mapping_NUM_88E, delta); -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex = (-1)*deltaSwingTableIdx[POWER_DEC][offset]; -+ } -+ -+ if (pDM_Odm->RFCalibrateInfo.DeltaPowerIndex == pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast) -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset = 0; -+ else -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex - pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast; -+ -+ for(i = 0; i < rf; i++) -+ pDM_Odm->RFCalibrateInfo.OFDM_index[i] = pRFCalibrateInfo->BbSwingIdxOfdmBase + pDM_Odm->RFCalibrateInfo.PowerIndexOffset; -+ pDM_Odm->RFCalibrateInfo.CCK_index = pRFCalibrateInfo->BbSwingIdxCckBase + pDM_Odm->RFCalibrateInfo.PowerIndexOffset; -+ -+ pRFCalibrateInfo->BbSwingIdxCck = pDM_Odm->RFCalibrateInfo.CCK_index; -+ pRFCalibrateInfo->BbSwingIdxOfdm[RF_PATH_A] = pDM_Odm->RFCalibrateInfo.OFDM_index[RF_PATH_A]; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxCck, pRFCalibrateInfo->BbSwingIdxCckBase, pDM_Odm->RFCalibrateInfo.PowerIndexOffset)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("The 'OFDM' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxOfdm[RF_PATH_A], pRFCalibrateInfo->BbSwingIdxOfdmBase, pDM_Odm->RFCalibrateInfo.PowerIndexOffset)); -+ -+ //4 7.1 Handle boundary conditions of index. -+ -+ -+ for(i = 0; i < rf; i++) -+ { -+ if(pDM_Odm->RFCalibrateInfo.OFDM_index[i] > OFDM_max_index) -+ { -+ pDM_Odm->RFCalibrateInfo.OFDM_index[i] = OFDM_max_index; -+ } -+ else if (pDM_Odm->RFCalibrateInfo.OFDM_index[i] < 0) -+ { -+ pDM_Odm->RFCalibrateInfo.OFDM_index[i] = 0; -+ } -+ } -+ -+ if(pDM_Odm->RFCalibrateInfo.CCK_index > c.SwingTableSize_CCK-1) -+ pDM_Odm->RFCalibrateInfo.CCK_index = c.SwingTableSize_CCK-1; -+ else if (pDM_Odm->RFCalibrateInfo.CCK_index < 0) -+ pDM_Odm->RFCalibrateInfo.CCK_index = 0; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The thermal meter is unchanged or TxPowerTracking OFF: ThermalValue: %d , pDM_Odm->RFCalibrateInfo.ThermalValue: %d)\n", ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset = 0; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", pDM_Odm->RFCalibrateInfo.CCK_index, pRFCalibrateInfo->BbSwingIdxCckBase)); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index: %d\n", pDM_Odm->RFCalibrateInfo.OFDM_index[RF_PATH_A], pRFCalibrateInfo->BbSwingIdxOfdmBase)); -+ -+ if (pDM_Odm->RFCalibrateInfo.PowerIndexOffset != 0 && pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) -+ { -+ //4 7.2 Configure the Swing Table to adjust Tx Power. -+ -+ pDM_Odm->RFCalibrateInfo.bTxPowerChanged = TRUE; // Always TRUE after Tx Power is adjusted by power tracking. -+ // -+ // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital -+ // to increase TX power. Otherwise, EVM will be bad. -+ // -+ // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. -+ if (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue) -+ { -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ // ("Temperature Increasing: delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ // pDM_Odm->RFCalibrateInfo.PowerIndexOffset, delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ } -+ else if (ThermalValue < pDM_Odm->RFCalibrateInfo.ThermalValue)// Low temperature -+ { -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ // ("Temperature Decreasing: delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ // pDM_Odm->RFCalibrateInfo.PowerIndexOffset, delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ } -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (ThermalValue > pHalData->EEPROMThermalMeter) -+#else -+ if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) -+#endif -+ { -+// ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Temperature(%d) hugher than PG value(%d), increases the power by TxAGC\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TXAGC, 0, 0); -+ } -+ else -+ { -+ // ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Temperature(%d) lower than PG value(%d), increases the power by TxAGC\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, RF_PATH_A, Indexforchannel); -+ if(is2T) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, RF_PATH_B, Indexforchannel); -+ } -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->BbSwingIdxCck; -+ pRFCalibrateInfo->BbSwingIdxOfdmBase = pRFCalibrateInfo->BbSwingIdxOfdm[RF_PATH_A]; -+ pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; -+ -+ } -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ // if((delta_IQK > pHalData->Delta_IQK) && (pHalData->Delta_IQK != 0)) -+ if ((delta_IQK >= 8)) // Delta temperature is equal to or larger than 20 centigrade. -+ (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("<===dm_TXPowerTrackingCallback_ThermalMeter_8188E\n")); -+ -+ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ -+VOID -+phy_PathAStandBy( -+ IN PADAPTER pAdapter -+ ) -+{ -+ RTPRINT(FINIT, INIT_IQK, ("Path-A standby mode!\n")); -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x0); -+ PHY_SetBBReg(pAdapter, 0x840, bMaskDWord, 0x00010000); -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x808000); -+} -+ -+//1 7. IQK -+//#define MAX_TOLERANCE 5 -+//#define IQK_DELAY_TIME 1 //ms -+ -+u1Byte //bit0 = 1 => Tx OK, bit1 = 1 => Rx OK -+phy_PathA_IQK_8192C( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN configPathB -+ ) -+{ -+ -+ u4Byte regEAC, regE94, regE9C, regEA4; -+ u1Byte result = 0x00; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ RTPRINT(FINIT, INIT_IQK, ("Path A IQK!\n")); -+ -+ //path-A IQK setting -+ RTPRINT(FINIT, INIT_IQK, ("Path-A IQK setting!\n")); -+ if(pAdapter->interfaceIndex == 0) -+ { -+ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x10008c1f); -+ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x10008c1f); -+ } -+ else -+ { -+ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x10008c22); -+ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x10008c22); -+ } -+ -+ PHY_SetBBReg(pAdapter, rTx_IQK_PI_A, bMaskDWord, 0x82140102); -+ -+ PHY_SetBBReg(pAdapter, rRx_IQK_PI_A, bMaskDWord, configPathB ? 0x28160202 : -+ IS_81xxC_VENDOR_UMC_B_CUT(pHalData->VersionID)?0x28160202:0x28160502); -+ -+ //path-B IQK setting -+ if(configPathB) -+ { -+ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_B, bMaskDWord, 0x10008c22); -+ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_B, bMaskDWord, 0x10008c22); -+ PHY_SetBBReg(pAdapter, rTx_IQK_PI_B, bMaskDWord, 0x82140102); -+ PHY_SetBBReg(pAdapter, rRx_IQK_PI_B, bMaskDWord, 0x28160202); -+ } -+ -+ //LO calibration setting -+ RTPRINT(FINIT, INIT_IQK, ("LO calibration setting!\n")); -+ PHY_SetBBReg(pAdapter, rIQK_AGC_Rsp, bMaskDWord, 0x001028d1); -+ -+ //One shot, path A LOK & IQK -+ RTPRINT(FINIT, INIT_IQK, ("One shot, path A LOK & IQK!\n")); -+ PHY_SetBBReg(pAdapter, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ PHY_SetBBReg(pAdapter, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ // delay x ms -+ RTPRINT(FINIT, INIT_IQK, ("Delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME)); -+ PlatformStallExecution(IQK_DELAY_TIME*1000); -+ -+ // Check failed -+ regEAC = PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_A_2, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xeac = 0x%x\n", regEAC)); -+ regE94 = PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_A, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xe94 = 0x%x\n", regE94)); -+ regE9C= PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_A, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xe9c = 0x%x\n", regE9C)); -+ regEA4= PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_A_2, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xea4 = 0x%x\n", regEA4)); -+ -+ if(!(regEAC & BIT28) && -+ (((regE94 & 0x03FF0000)>>16) != 0x142) && -+ (((regE9C & 0x03FF0000)>>16) != 0x42) ) -+ result |= 0x01; -+ else //if Tx not OK, ignore Rx -+ return result; -+ -+ if(!(regEAC & BIT27) && //if Tx is OK, check whether Rx is OK -+ (((regEA4 & 0x03FF0000)>>16) != 0x132) && -+ (((regEAC & 0x03FF0000)>>16) != 0x36)) -+ result |= 0x02; -+ else -+ RTPRINT(FINIT, INIT_IQK, ("Path A Rx IQK fail!!\n")); -+ -+ return result; -+ -+ -+} -+ -+u1Byte //bit0 = 1 => Tx OK, bit1 = 1 => Rx OK -+phy_PathB_IQK_8192C( -+ IN PADAPTER pAdapter -+ ) -+{ -+ u4Byte regEAC, regEB4, regEBC, regEC4, regECC; -+ u1Byte result = 0x00; -+ RTPRINT(FINIT, INIT_IQK, ("Path B IQK!\n")); -+ -+ //One shot, path B LOK & IQK -+ RTPRINT(FINIT, INIT_IQK, ("One shot, path A LOK & IQK!\n")); -+ PHY_SetBBReg(pAdapter, rIQK_AGC_Cont, bMaskDWord, 0x00000002); -+ PHY_SetBBReg(pAdapter, rIQK_AGC_Cont, bMaskDWord, 0x00000000); -+ -+ // delay x ms -+ RTPRINT(FINIT, INIT_IQK, ("Delay %d ms for One shot, path B LOK & IQK.\n", IQK_DELAY_TIME)); -+ PlatformStallExecution(IQK_DELAY_TIME*1000); -+ -+ // Check failed -+ regEAC = PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_A_2, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xeac = 0x%x\n", regEAC)); -+ regEB4 = PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_B, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xeb4 = 0x%x\n", regEB4)); -+ regEBC= PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_B, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xebc = 0x%x\n", regEBC)); -+ regEC4= PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_B_2, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xec4 = 0x%x\n", regEC4)); -+ regECC= PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_B_2, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xecc = 0x%x\n", regECC)); -+ -+ if(!(regEAC & BIT31) && -+ (((regEB4 & 0x03FF0000)>>16) != 0x142) && -+ (((regEBC & 0x03FF0000)>>16) != 0x42)) -+ result |= 0x01; -+ else -+ return result; -+ -+ if(!(regEAC & BIT30) && -+ (((regEC4 & 0x03FF0000)>>16) != 0x132) && -+ (((regECC & 0x03FF0000)>>16) != 0x36)) -+ result |= 0x02; -+ else -+ RTPRINT(FINIT, INIT_IQK, ("Path B Rx IQK fail!!\n")); -+ -+ -+ return result; -+ -+} -+ -+VOID -+phy_PathAFillIQKMatrix( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bIQKOK, -+ IN s4Byte result[][8], -+ IN u1Byte final_candidate, -+ IN BOOLEAN bTxOnly -+ ) -+{ -+ u4Byte Oldval_0, X, TX0_A, reg; -+ s4Byte Y, TX0_C; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ RTPRINT(FINIT, INIT_IQK, ("Path A IQ Calibration %s !\n",(bIQKOK)?"Success":"Failed")); -+ -+ if(final_candidate == 0xFF) -+ return; -+ -+ else if(bIQKOK) -+ { -+ Oldval_0 = (PHY_QueryBBReg(pAdapter, rOFDM0_XATxIQImbalance, bMaskDWord) >> 22) & 0x3FF; -+ -+ X = result[final_candidate][0]; -+ if ((X & 0x00000200) != 0) -+ X = X | 0xFFFFFC00; -+ TX0_A = (X * Oldval_0) >> 8; -+ RTPRINT(FINIT, INIT_IQK, ("X = 0x%x, TX0_A = 0x%x, Oldval_0 0x%x\n", X, TX0_A, Oldval_0)); -+ PHY_SetBBReg(pAdapter, rOFDM0_XATxIQImbalance, 0x3FF, TX0_A); -+ PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(31), ((X * Oldval_0>>7) & 0x1)); -+ -+ Y = result[final_candidate][1]; -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ -+ //path B IQK result + 3 -+ if(pAdapter->interfaceIndex == 1 && pHalData->CurrentBandType == BAND_ON_5G) -+ Y += 3; -+ -+ TX0_C = (Y * Oldval_0) >> 8; -+ RTPRINT(FINIT, INIT_IQK, ("Y = 0x%x, TX = 0x%x\n", Y, TX0_C)); -+ PHY_SetBBReg(pAdapter, rOFDM0_XCTxAFE, 0xF0000000, ((TX0_C&0x3C0)>>6)); -+ PHY_SetBBReg(pAdapter, rOFDM0_XATxIQImbalance, 0x003F0000, (TX0_C&0x3F)); -+ PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(29), ((Y * Oldval_0>>7) & 0x1)); -+ -+ if(bTxOnly) -+ { -+ RTPRINT(FINIT, INIT_IQK, ("phy_PathAFillIQKMatrix only Tx OK\n")); -+ return; -+ } -+ -+ reg = result[final_candidate][2]; -+ PHY_SetBBReg(pAdapter, rOFDM0_XARxIQImbalance, 0x3FF, reg); -+ -+ reg = result[final_candidate][3] & 0x3F; -+ PHY_SetBBReg(pAdapter, rOFDM0_XARxIQImbalance, 0xFC00, reg); -+ -+ reg = (result[final_candidate][3] >> 6) & 0xF; -+ PHY_SetBBReg(pAdapter, rOFDM0_RxIQExtAnta, 0xF0000000, reg); -+ } -+} -+ -+VOID -+phy_PathBFillIQKMatrix( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bIQKOK, -+ IN s4Byte result[][8], -+ IN u1Byte final_candidate, -+ IN BOOLEAN bTxOnly //do Tx only -+ ) -+{ -+ u4Byte Oldval_1, X, TX1_A, reg; -+ s4Byte Y, TX1_C; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ RTPRINT(FINIT, INIT_IQK, ("Path B IQ Calibration %s !\n",(bIQKOK)?"Success":"Failed")); -+ -+ if(final_candidate == 0xFF) -+ return; -+ -+ else if(bIQKOK) -+ { -+ Oldval_1 = (PHY_QueryBBReg(pAdapter, rOFDM0_XBTxIQImbalance, bMaskDWord) >> 22) & 0x3FF; -+ -+ X = result[final_candidate][4]; -+ if ((X & 0x00000200) != 0) -+ X = X | 0xFFFFFC00; -+ TX1_A = (X * Oldval_1) >> 8; -+ RTPRINT(FINIT, INIT_IQK, ("X = 0x%x, TX1_A = 0x%x\n", X, TX1_A)); -+ PHY_SetBBReg(pAdapter, rOFDM0_XBTxIQImbalance, 0x3FF, TX1_A); -+ PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(27), ((X * Oldval_1>>7) & 0x1)); -+ -+ Y = result[final_candidate][5]; -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ if(pHalData->CurrentBandType == BAND_ON_5G) -+ Y += 3; //temp modify for preformance -+ TX1_C = (Y * Oldval_1) >> 8; -+ RTPRINT(FINIT, INIT_IQK, ("Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C)); -+ PHY_SetBBReg(pAdapter, rOFDM0_XDTxAFE, 0xF0000000, ((TX1_C&0x3C0)>>6)); -+ PHY_SetBBReg(pAdapter, rOFDM0_XBTxIQImbalance, 0x003F0000, (TX1_C&0x3F)); -+ PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(25), ((Y * Oldval_1>>7) & 0x1)); -+ -+ if(bTxOnly) -+ return; -+ -+ reg = result[final_candidate][6]; -+ PHY_SetBBReg(pAdapter, rOFDM0_XBRxIQImbalance, 0x3FF, reg); -+ -+ reg = result[final_candidate][7] & 0x3F; -+ PHY_SetBBReg(pAdapter, rOFDM0_XBRxIQImbalance, 0xFC00, reg); -+ -+ reg = (result[final_candidate][7] >> 6) & 0xF; -+ PHY_SetBBReg(pAdapter, rOFDM0_AGCRSSITable, 0x0000F000, reg); -+ } -+} -+ -+ -+BOOLEAN -+phy_SimularityCompare_92C( -+ IN PADAPTER pAdapter, -+ IN s4Byte result[][8], -+ IN u1Byte c1, -+ IN u1Byte c2 -+ ) -+{ -+ u4Byte i, j, diff, SimularityBitMap, bound = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u1Byte final_candidate[2] = {0xFF, 0xFF}; //for path A and path B -+ BOOLEAN bResult = TRUE, is2T = IS_92C_SERIAL( pHalData->VersionID); -+ -+ if(is2T) -+ bound = 8; -+ else -+ bound = 4; -+ -+ SimularityBitMap = 0; -+ -+ for( i = 0; i < bound; i++ ) -+ { -+ diff = (result[c1][i] > result[c2][i]) ? (result[c1][i] - result[c2][i]) : (result[c2][i] - result[c1][i]); -+ if (diff > MAX_TOLERANCE) -+ { -+ if((i == 2 || i == 6) && !SimularityBitMap) -+ { -+ if(result[c1][i]+result[c1][i+1] == 0) -+ final_candidate[(i/4)] = c2; -+ else if (result[c2][i]+result[c2][i+1] == 0) -+ final_candidate[(i/4)] = c1; -+ else -+ SimularityBitMap = SimularityBitMap|(1< do IQK again -+*/ -+BOOLEAN -+phy_SimularityCompare( -+ IN PADAPTER pAdapter, -+ IN s4Byte result[][8], -+ IN u1Byte c1, -+ IN u1Byte c2 -+ ) -+{ -+ return phy_SimularityCompare_92C(pAdapter, result, c1, c2); -+ -+} -+ -+VOID -+phy_IQCalibrate_8192C( -+ IN PADAPTER pAdapter, -+ IN s4Byte result[][8], -+ IN u1Byte t, -+ IN BOOLEAN is2T -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u4Byte i; -+ u1Byte PathAOK, PathBOK; -+ u4Byte ADDA_REG[IQK_ADDA_REG_NUM] = { -+ rFPGA0_XCD_SwitchControl, rBlue_Tooth, -+ rRx_Wait_CCA, rTx_CCK_RFON, -+ rTx_CCK_BBON, rTx_OFDM_RFON, -+ rTx_OFDM_BBON, rTx_To_Rx, -+ rTx_To_Tx, rRx_CCK, -+ rRx_OFDM, rRx_Wait_RIFS, -+ rRx_TO_Rx, rStandby, -+ rSleep, rPMPD_ANAEN }; -+ u4Byte IQK_MAC_REG[IQK_MAC_REG_NUM] = { -+ REG_TXPAUSE, REG_BCN_CTRL, -+ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; -+ -+ //since 92C & 92D have the different define in IQK_BB_REG -+ u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { -+ rOFDM0_TRxPathEnable, rOFDM0_TRMuxPar, -+ rFPGA0_XCD_RFInterfaceSW, rConfig_AntA, rConfig_AntB, -+ rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, -+ rFPGA0_XB_RFInterfaceOE, /*rFPGA0_RFMOD*/ rCCK0_AFESetting -+ }; -+ -+ u4Byte IQK_BB_REG_92D[IQK_BB_REG_NUM_92D] = { //for normal -+ rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, -+ rFPGA0_XB_RFInterfaceOE, rOFDM0_TRMuxPar, -+ rFPGA0_XCD_RFInterfaceSW, rOFDM0_TRxPathEnable, -+ /*rFPGA0_RFMOD*/ rCCK0_AFESetting, rFPGA0_AnalogParameter4, -+ rOFDM0_XAAGCCore1, rOFDM0_XBAGCCore1 -+ }; -+#if MP_DRIVER -+ const u4Byte retryCount = 9; -+#else -+ const u4Byte retryCount = 2; -+#endif -+ //Neil Chen--2011--05--19-- -+ //3 Path Div -+ u1Byte rfPathSwitch=0x0; -+ -+ // Note: IQ calibration must be performed after loading -+ // PHY_REG.txt , and radio_a, radio_b.txt -+ -+ u4Byte bbvalue; -+ -+ if(t==0) -+ { -+ //bbvalue = PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bMaskDWord); -+ // RTPRINT(FINIT, INIT_IQK, ("phy_IQCalibrate_8192C()==>0x%08x\n",bbvalue)); -+ -+ RTPRINT(FINIT, INIT_IQK, ("IQ Calibration for %s\n", (is2T ? "2T2R" : "1T1R"))); -+ -+ // Save ADDA parameters, turn Path A ADDA on -+ phy_SaveADDARegisters(pAdapter, ADDA_REG, pHalData->ADDA_backup, IQK_ADDA_REG_NUM); -+ phy_SaveMACRegisters(pAdapter, IQK_MAC_REG, pHalData->IQK_MAC_backup); -+ phy_SaveADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup, IQK_BB_REG_NUM); -+ } -+ -+ phy_PathADDAOn(pAdapter, ADDA_REG, TRUE, is2T); -+ -+ if(t==0) -+ { -+ pHalData->bRfPiEnable = (u1Byte)PHY_QueryBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, BIT(8)); -+ } -+ -+ if(!pHalData->bRfPiEnable){ -+ // Switch BB to PI mode to do IQ Calibration. -+ phy_PIModeSwitch(pAdapter, TRUE); -+ } -+ -+ //MAC settings -+ phy_MACSettingCalibration(pAdapter, IQK_MAC_REG, pHalData->IQK_MAC_backup); -+ -+ //PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, BIT24, 0x00); -+ PHY_SetBBReg(pAdapter, rCCK0_AFESetting, bMaskDWord, (0x0f000000 | (PHY_QueryBBReg(pAdapter, rCCK0_AFESetting, bMaskDWord))) ); -+ PHY_SetBBReg(pAdapter, rOFDM0_TRxPathEnable, bMaskDWord, 0x03a05600); -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, bMaskDWord, 0x000800e4); -+ PHY_SetBBReg(pAdapter, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x22204000); -+ { -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0x01); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0x01); -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_RFInterfaceOE, BIT10, 0x00); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0x00); -+ } -+ -+ if(is2T) -+ { -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_LSSIParameter, bMaskDWord, 0x00010000); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_LSSIParameter, bMaskDWord, 0x00010000); -+ } -+ -+ { -+ //Page B init -+ PHY_SetBBReg(pAdapter, rConfig_AntA, bMaskDWord, 0x00080000); -+ -+ if(is2T) -+ { -+ PHY_SetBBReg(pAdapter, rConfig_AntB, bMaskDWord, 0x00080000); -+ } -+ } -+ // IQ calibration setting -+ RTPRINT(FINIT, INIT_IQK, ("IQK setting!\n")); -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x808000); -+ PHY_SetBBReg(pAdapter, rTx_IQK, bMaskDWord, 0x01007c00); -+ PHY_SetBBReg(pAdapter, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ for(i = 0 ; i < retryCount ; i++){ -+ PathAOK = phy_PathA_IQK_8192C(pAdapter, is2T); -+ if(PathAOK == 0x03){ -+ RTPRINT(FINIT, INIT_IQK, ("Path A IQK Success!!\n")); -+ result[t][0] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ result[t][1] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ result[t][2] = (PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; -+ result[t][3] = (PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; -+ break; -+ } -+ else if (i == (retryCount-1) && PathAOK == 0x01) //Tx IQK OK -+ { -+ RTPRINT(FINIT, INIT_IQK, ("Path A IQK Only Tx Success!!\n")); -+ -+ result[t][0] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ result[t][1] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ } -+ } -+ -+ if(0x00 == PathAOK){ -+ RTPRINT(FINIT, INIT_IQK, ("Path A IQK failed!!\n")); -+ } -+ -+ if(is2T){ -+ phy_PathAStandBy(pAdapter); -+ -+ // Turn Path B ADDA on -+ phy_PathADDAOn(pAdapter, ADDA_REG, FALSE, is2T); -+ -+ for(i = 0 ; i < retryCount ; i++){ -+ PathBOK = phy_PathB_IQK_8192C(pAdapter); -+ if(PathBOK == 0x03){ -+ RTPRINT(FINIT, INIT_IQK, ("Path B IQK Success!!\n")); -+ result[t][4] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_B, bMaskDWord)&0x3FF0000)>>16; -+ result[t][5] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_B, bMaskDWord)&0x3FF0000)>>16; -+ result[t][6] = (PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_B_2, bMaskDWord)&0x3FF0000)>>16; -+ result[t][7] = (PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_B_2, bMaskDWord)&0x3FF0000)>>16; -+ break; -+ } -+ else if (i == (retryCount - 1) && PathBOK == 0x01) //Tx IQK OK -+ { -+ RTPRINT(FINIT, INIT_IQK, ("Path B Only Tx IQK Success!!\n")); -+ result[t][4] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_B, bMaskDWord)&0x3FF0000)>>16; -+ result[t][5] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_B, bMaskDWord)&0x3FF0000)>>16; -+ } -+ } -+ -+ if(0x00 == PathBOK){ -+ RTPRINT(FINIT, INIT_IQK, ("Path B IQK failed!!\n")); -+ } -+ } -+ -+ //Back to BB mode, load original value -+ RTPRINT(FINIT, INIT_IQK, ("IQK:Back to BB mode, load original value!\n")); -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); -+ -+ if(t!=0) -+ { -+ if(!pHalData->bRfPiEnable){ -+ // Switch back BB to SI mode after finish IQ Calibration. -+ phy_PIModeSwitch(pAdapter, FALSE); -+ } -+ -+ // Reload ADDA power saving parameters -+ phy_ReloadADDARegisters(pAdapter, ADDA_REG, pHalData->ADDA_backup, IQK_ADDA_REG_NUM); -+ -+ // Reload MAC parameters -+ phy_ReloadMACRegisters(pAdapter, IQK_MAC_REG, pHalData->IQK_MAC_backup); -+ -+ // Reload BB parameters -+ phy_ReloadADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup, IQK_BB_REG_NUM); -+ -+ /*Restore RX initial gain*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_LSSIParameter, bMaskDWord, 0x00032ed3); -+ if (is2T) -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_LSSIParameter, bMaskDWord, 0x00032ed3); -+ //load 0xe30 IQC default value -+ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ -+ } -+ RTPRINT(FINIT, INIT_IQK, ("phy_IQCalibrate_8192C() <==\n")); -+ -+} -+ -+ -+VOID -+phy_LCCalibrate92C( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN is2T -+ ) -+{ -+ u1Byte tmpReg; -+ u4Byte RF_Amode=0, RF_Bmode=0, LC_Cal; -+// HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ //Check continuous TX and Packet TX -+ tmpReg = PlatformEFIORead1Byte(pAdapter, 0xd03); -+ -+ if((tmpReg&0x70) != 0) //Deal with contisuous TX case -+ PlatformEFIOWrite1Byte(pAdapter, 0xd03, tmpReg&0x8F); //disable all continuous TX -+ else // Deal with Packet TX case -+ PlatformEFIOWrite1Byte(pAdapter, REG_TXPAUSE, 0xFF); // block all queues -+ -+ if((tmpReg&0x70) != 0) -+ { -+ //1. Read original RF mode -+ //Path-A -+ RF_Amode = PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_AC, bMask12Bits); -+ -+ //Path-B -+ if(is2T) -+ RF_Bmode = PHY_QueryRFReg(pAdapter, RF_PATH_B, RF_AC, bMask12Bits); -+ -+ //2. Set RF mode = standby mode -+ //Path-A -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_AC, bMask12Bits, (RF_Amode&0x8FFFF)|0x10000); -+ -+ //Path-B -+ if(is2T) -+ PHY_SetRFReg(pAdapter, RF_PATH_B, RF_AC, bMask12Bits, (RF_Bmode&0x8FFFF)|0x10000); -+ } -+ -+ //3. Read RF reg18 -+ LC_Cal = PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_CHNLBW, bMask12Bits); -+ -+ //4. Set LC calibration begin bit15 -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_CHNLBW, bMask12Bits, LC_Cal|0x08000); -+ -+ delay_ms(100); -+ -+ -+ //Restore original situation -+ if((tmpReg&0x70) != 0) //Deal with contisuous TX case -+ { -+ //Path-A -+ PlatformEFIOWrite1Byte(pAdapter, 0xd03, tmpReg); -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_AC, bMask12Bits, RF_Amode); -+ -+ //Path-B -+ if(is2T) -+ PHY_SetRFReg(pAdapter, RF_PATH_B, RF_AC, bMask12Bits, RF_Bmode); -+ } -+ else // Deal with Packet TX case -+ { -+ PlatformEFIOWrite1Byte(pAdapter, REG_TXPAUSE, 0x00); -+ } -+} -+ -+ -+VOID -+phy_LCCalibrate( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN is2T -+ ) -+{ -+ phy_LCCalibrate92C(pAdapter, is2T); -+} -+ -+ -+ -+//Analog Pre-distortion calibration -+#define APK_BB_REG_NUM 8 -+#define APK_CURVE_REG_NUM 4 -+#define PATH_NUM 2 -+ -+VOID -+phy_APCalibrate_8192C( -+ IN PADAPTER pAdapter, -+ IN s1Byte delta, -+ IN BOOLEAN is2T -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ u4Byte regD[PATH_NUM]; -+ u4Byte tmpReg, index, offset, i, apkbound; -+ u1Byte path, pathbound = PATH_NUM; -+ u4Byte BB_backup[APK_BB_REG_NUM]; -+ u4Byte BB_REG[APK_BB_REG_NUM] = { -+ rFPGA1_TxBlock, rOFDM0_TRxPathEnable, -+ rFPGA0_RFMOD, rOFDM0_TRMuxPar, -+ rFPGA0_XCD_RFInterfaceSW, rFPGA0_XAB_RFInterfaceSW, -+ rFPGA0_XA_RFInterfaceOE, rFPGA0_XB_RFInterfaceOE }; -+ u4Byte BB_AP_MODE[APK_BB_REG_NUM] = { -+ 0x00000020, 0x00a05430, 0x02040000, -+ 0x000800e4, 0x00204000 }; -+ u4Byte BB_normal_AP_MODE[APK_BB_REG_NUM] = { -+ 0x00000020, 0x00a05430, 0x02040000, -+ 0x000800e4, 0x22204000 }; -+ -+ u4Byte AFE_backup[IQK_ADDA_REG_NUM]; -+ u4Byte AFE_REG[IQK_ADDA_REG_NUM] = { -+ rFPGA0_XCD_SwitchControl, rBlue_Tooth, -+ rRx_Wait_CCA, rTx_CCK_RFON, -+ rTx_CCK_BBON, rTx_OFDM_RFON, -+ rTx_OFDM_BBON, rTx_To_Rx, -+ rTx_To_Tx, rRx_CCK, -+ rRx_OFDM, rRx_Wait_RIFS, -+ rRx_TO_Rx, rStandby, -+ rSleep, rPMPD_ANAEN }; -+ -+ u4Byte MAC_backup[IQK_MAC_REG_NUM]; -+ u4Byte MAC_REG[IQK_MAC_REG_NUM] = { -+ REG_TXPAUSE, REG_BCN_CTRL, -+ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; -+ -+ u4Byte APK_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x0852c, 0x1852c, 0x5852c, 0x1852c, 0x5852c}, -+ {0x2852e, 0x0852e, 0x3852e, 0x0852e, 0x0852e} -+ }; -+ -+ u4Byte APK_normal_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x0852c, 0x0a52c, 0x3a52c, 0x5a52c, 0x5a52c}, //path settings equal to path b settings -+ {0x0852c, 0x0a52c, 0x5a52c, 0x5a52c, 0x5a52c} -+ }; -+ -+ u4Byte APK_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x52019, 0x52014, 0x52013, 0x5200f, 0x5208d}, -+ {0x5201a, 0x52019, 0x52016, 0x52033, 0x52050} -+ }; -+ -+ u4Byte APK_normal_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a}, //path settings equal to path b settings -+ {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a} -+ }; -+#if 0 -+ u4Byte APK_RF_value_A[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x1adb0, 0x1adb0, 0x1ada0, 0x1ad90, 0x1ad80}, -+ {0x00fb0, 0x00fb0, 0x00fa0, 0x00f90, 0x00f80} -+ }; -+#endif -+ u4Byte AFE_on_off[PATH_NUM] = { -+ 0x04db25a4, 0x0b1b25a4}; //path A on path B off / path A off path B on -+ -+ u4Byte APK_offset[PATH_NUM] = { -+ rConfig_AntA, rConfig_AntB}; -+ -+ u4Byte APK_normal_offset[PATH_NUM] = { -+ rConfig_Pmpd_AntA, rConfig_Pmpd_AntB}; -+ -+ u4Byte APK_value[PATH_NUM] = { -+ 0x92fc0000, 0x12fc0000}; -+ -+ u4Byte APK_normal_value[PATH_NUM] = { -+ 0x92680000, 0x12680000}; -+ -+ s1Byte APK_delta_mapping[APK_BB_REG_NUM][13] = { -+ {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-6, -4, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-1, -1, -1, -1, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-11, -9, -7, -5, -3, -1, 0, 0, 0, 0, 0, 0, 0} -+ }; -+ -+ u4Byte APK_normal_setting_value_1[13] = { -+ 0x01017018, 0xf7ed8f84, 0x1b1a1816, 0x2522201e, 0x322e2b28, -+ 0x433f3a36, 0x5b544e49, 0x7b726a62, 0xa69a8f84, 0xdfcfc0b3, -+ 0x12680000, 0x00880000, 0x00880000 -+ }; -+ -+ u4Byte APK_normal_setting_value_2[16] = { -+ 0x01c7021d, 0x01670183, 0x01000123, 0x00bf00e2, 0x008d00a3, -+ 0x0068007b, 0x004d0059, 0x003a0042, 0x002b0031, 0x001f0025, -+ 0x0017001b, 0x00110014, 0x000c000f, 0x0009000b, 0x00070008, -+ 0x00050006 -+ }; -+ -+ u4Byte APK_result[PATH_NUM][APK_BB_REG_NUM]; //val_1_1a, val_1_2a, val_2a, val_3a, val_4a -+// u4Byte AP_curve[PATH_NUM][APK_CURVE_REG_NUM]; -+ -+ s4Byte BB_offset, delta_V, delta_offset; -+ -+#if MP_DRIVER == 1 -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+ -+ pMptCtx->APK_bound[0] = 45; -+ pMptCtx->APK_bound[1] = 52; -+#endif -+ -+ RTPRINT(FINIT, INIT_IQK, ("==>phy_APCalibrate_8192C() delta %d\n", delta)); -+ RTPRINT(FINIT, INIT_IQK, ("AP Calibration for %s\n", (is2T ? "2T2R" : "1T1R"))); -+ if(!is2T) -+ pathbound = 1; -+ -+ //2 FOR NORMAL CHIP SETTINGS -+ -+// Temporarily do not allow normal driver to do the following settings because these offset -+// and value will cause RF internal PA to be unpredictably disabled by HW, such that RF Tx signal -+// will disappear after disable/enable card many times on 88CU. RF SD and DD have not find the -+// root cause, so we remove these actions temporarily. Added by tynli and SD3 Allen. 2010.05.31. -+#if MP_DRIVER != 1 -+ return; -+#endif -+ //settings adjust for normal chip -+ for(index = 0; index < PATH_NUM; index ++) -+ { -+ APK_offset[index] = APK_normal_offset[index]; -+ APK_value[index] = APK_normal_value[index]; -+ AFE_on_off[index] = 0x6fdb25a4; -+ } -+ -+ for(index = 0; index < APK_BB_REG_NUM; index ++) -+ { -+ for(path = 0; path < pathbound; path++) -+ { -+ APK_RF_init_value[path][index] = APK_normal_RF_init_value[path][index]; -+ APK_RF_value_0[path][index] = APK_normal_RF_value_0[path][index]; -+ } -+ BB_AP_MODE[index] = BB_normal_AP_MODE[index]; -+ } -+ -+ apkbound = 6; -+ -+ //save BB default value -+ for(index = 0; index < APK_BB_REG_NUM ; index++) -+ { -+ if(index == 0) //skip -+ continue; -+ BB_backup[index] = PHY_QueryBBReg(pAdapter, BB_REG[index], bMaskDWord); -+ } -+ -+ //save MAC default value -+ phy_SaveMACRegisters(pAdapter, MAC_REG, MAC_backup); -+ -+ //save AFE default value -+ phy_SaveADDARegisters(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+ -+ for(path = 0; path < pathbound; path++) -+ { -+ -+ -+ if(path == RF_PATH_A) -+ { -+ //path A APK -+ //load APK setting -+ //path-A -+ offset = rPdp_AntA; -+ for(index = 0; index < 11; index ++) -+ { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ -+ PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); -+ -+ offset = rConfig_AntA; -+ for(; index < 13; index ++) -+ { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ -+ //page-B1 -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x400000); -+ -+ //path A -+ offset = rPdp_AntA; -+ for(index = 0; index < 16; index++) -+ { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_2[index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); -+ } -+ else if(path == RF_PATH_B) -+ { -+ //path B APK -+ //load APK setting -+ //path-B -+ offset = rPdp_AntB; -+ for(index = 0; index < 10; index ++) -+ { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntA, bMaskDWord, 0x12680000); -+ -+ PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); -+ -+ offset = rConfig_AntA; -+ index = 11; -+ for(; index < 13; index ++) //offset 0xb68, 0xb6c -+ { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ -+ //page-B1 -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x400000); -+ -+ //path B -+ offset = 0xb60; -+ for(index = 0; index < 16; index++) -+ { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_2[index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); -+ } -+ -+ //save RF default value -+ regD[path] = PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask); -+ -+ //Path A AFE all on, path B AFE All off or vise versa -+ for(index = 0; index < IQK_ADDA_REG_NUM ; index++) -+ PHY_SetBBReg(pAdapter, AFE_REG[index], bMaskDWord, AFE_on_off[path]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xe70 %x\n", PHY_QueryBBReg(pAdapter, rRx_Wait_CCA, bMaskDWord))); -+ -+ //BB to AP mode -+ if(path == 0) -+ { -+ for(index = 0; index < APK_BB_REG_NUM ; index++) -+ { -+ -+ if(index == 0) //skip -+ continue; -+ else if (index < 5) -+ PHY_SetBBReg(pAdapter, BB_REG[index], bMaskDWord, BB_AP_MODE[index]); -+ else if (BB_REG[index] == 0x870) -+ PHY_SetBBReg(pAdapter, BB_REG[index], bMaskDWord, BB_backup[index]|BIT10|BIT26); -+ else -+ PHY_SetBBReg(pAdapter, BB_REG[index], BIT10, 0x0); -+ } -+ -+ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ } -+ else //path B -+ { -+ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_B, bMaskDWord, 0x01008c00); -+ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_B, bMaskDWord, 0x01008c00); -+ -+ } -+ -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x800 %x\n", PHY_QueryBBReg(pAdapter, 0x800, bMaskDWord))); -+ -+ //MAC settings -+ phy_MACSettingCalibration(pAdapter, MAC_REG, MAC_backup); -+ -+ if(path == RF_PATH_A) //Path B to standby mode -+ { -+ PHY_SetRFReg(pAdapter, RF_PATH_B, RF_AC, bRFRegOffsetMask, 0x10000); -+ } -+ else //Path A to standby mode -+ { -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_AC, bRFRegOffsetMask, 0x10000); -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE1, bRFRegOffsetMask, 0x1000f); -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE2, bRFRegOffsetMask, 0x20103); -+ } -+ -+ delta_offset = ((delta+14)/2); -+ if(delta_offset < 0) -+ delta_offset = 0; -+ else if (delta_offset > 12) -+ delta_offset = 12; -+ -+ //AP calibration -+ for(index = 0; index < APK_BB_REG_NUM; index++) -+ { -+ if(index != 1) //only DO PA11+PAD01001, AP RF setting -+ continue; -+ -+ tmpReg = APK_RF_init_value[path][index]; -+#if 1 -+ if(!pHalData->bAPKThermalMeterIgnore) -+ { -+ BB_offset = (tmpReg & 0xF0000) >> 16; -+ -+ if(!(tmpReg & BIT15)) //sign bit 0 -+ { -+ BB_offset = -BB_offset; -+ } -+ -+ delta_V = APK_delta_mapping[index][delta_offset]; -+ -+ BB_offset += delta_V; -+ -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() APK index %d tmpReg 0x%x delta_V %d delta_offset %d\n", index, tmpReg, delta_V, delta_offset)); -+ -+ if(BB_offset < 0) -+ { -+ tmpReg = tmpReg & (~BIT15); -+ BB_offset = -BB_offset; -+ } -+ else -+ { -+ tmpReg = tmpReg | BIT15; -+ } -+ tmpReg = (tmpReg & 0xFFF0FFFF) | (BB_offset << 16); -+ } -+#endif -+ -+#if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ if(IS_81xxC_VENDOR_UMC_B_CUT(pHalData->VersionID)) -+ PHY_SetRFReg(pAdapter, path, RF_IPA_A, bRFRegOffsetMask, 0x894ae); -+ else -+#endif -+ PHY_SetRFReg(pAdapter, path, RF_IPA_A, bRFRegOffsetMask, 0x8992e); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xc %x\n", PHY_QueryRFReg(pAdapter, path, RF_IPA_A, bRFRegOffsetMask))); -+ PHY_SetRFReg(pAdapter, path, RF_AC, bRFRegOffsetMask, APK_RF_value_0[path][index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x0 %x\n", PHY_QueryRFReg(pAdapter, path, RF_AC, bRFRegOffsetMask))); -+ PHY_SetRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask, tmpReg); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xd %x\n", PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask))); -+ -+ // PA11+PAD01111, one shot -+ i = 0; -+ do -+ { -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x800000); -+ { -+ PHY_SetBBReg(pAdapter, APK_offset[path], bMaskDWord, APK_value[0]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", APK_offset[path], PHY_QueryBBReg(pAdapter, APK_offset[path], bMaskDWord))); -+ delay_ms(3); -+ PHY_SetBBReg(pAdapter, APK_offset[path], bMaskDWord, APK_value[1]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", APK_offset[path], PHY_QueryBBReg(pAdapter, APK_offset[path], bMaskDWord))); -+ -+ delay_ms(20); -+ } -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); -+ -+ if(path == RF_PATH_A) -+ tmpReg = PHY_QueryBBReg(pAdapter, rAPK, 0x03E00000); -+ else -+ tmpReg = PHY_QueryBBReg(pAdapter, rAPK, 0xF8000000); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xbd8[25:21] %x\n", tmpReg)); -+ -+ -+ i++; -+ } -+ while(tmpReg > apkbound && i < 4); -+ -+ APK_result[path][index] = tmpReg; -+ } -+ } -+ -+ //reload MAC default value -+ phy_ReloadMACRegisters(pAdapter, MAC_REG, MAC_backup); -+ -+ //reload BB default value -+ for(index = 0; index < APK_BB_REG_NUM ; index++) -+ { -+ -+ if(index == 0) //skip -+ continue; -+ PHY_SetBBReg(pAdapter, BB_REG[index], bMaskDWord, BB_backup[index]); -+ } -+ -+ //reload AFE default value -+ phy_ReloadADDARegisters(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+ -+ //reload RF path default value -+ for(path = 0; path < pathbound; path++) -+ { -+ PHY_SetRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask, regD[path]); -+ if(path == RF_PATH_B) -+ { -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE1, bRFRegOffsetMask, 0x1000f); -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE2, bRFRegOffsetMask, 0x20101); -+ } -+ -+ //note no index == 0 -+ if (APK_result[path][1] > 6) -+ APK_result[path][1] = 6; -+ RTPRINT(FINIT, INIT_IQK, ("apk path %d result %d 0x%x \t", path, 1, APK_result[path][1])); -+ } -+ -+ RTPRINT(FINIT, INIT_IQK, ("\n")); -+ -+ -+ for(path = 0; path < pathbound; path++) -+ { -+ PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G1_G4, bRFRegOffsetMask, -+ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (APK_result[path][1] << 5) | APK_result[path][1])); -+ if(path == RF_PATH_A) -+ PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G5_G8, bRFRegOffsetMask, -+ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x00 << 5) | 0x05)); -+ else -+ PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G5_G8, bRFRegOffsetMask, -+ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x02 << 5) | 0x05)); -+ -+ PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G9_G11, bRFRegOffsetMask, ((0x08 << 15) | (0x08 << 10) | (0x08 << 5) | 0x08)); -+ } -+ -+ pHalData->bAPKdone = TRUE; -+ -+ RTPRINT(FINIT, INIT_IQK, ("<==phy_APCalibrate_8192C()\n")); -+} -+ -+ -+VOID -+PHY_IQCalibrate_8192C( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ s4Byte result[4][8]; //last is final result -+ u1Byte i, final_candidate, Indexforchannel; -+ BOOLEAN bPathAOK, bPathBOK; -+ s4Byte RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC, RegTmp = 0; -+ BOOLEAN is12simular, is13simular, is23simular; -+ BOOLEAN bStartContTx = FALSE, bSingleTone = FALSE, bCarrierSuppression = FALSE; -+ u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { -+ rOFDM0_XARxIQImbalance, rOFDM0_XBRxIQImbalance, -+ rOFDM0_ECCAThreshold, rOFDM0_AGCRSSITable, -+ rOFDM0_XATxIQImbalance, rOFDM0_XBTxIQImbalance, -+ rOFDM0_XCTxAFE, rOFDM0_XDTxAFE, -+ rOFDM0_RxIQExtAnta}; -+ -+ if (ODM_CheckPowerStatus(pAdapter) == FALSE) -+ return; -+ -+#if MP_DRIVER == 1 -+ bStartContTx = pAdapter->MptCtx.bStartContTx; -+ bSingleTone = pAdapter->MptCtx.bSingleTone; -+ bCarrierSuppression = pAdapter->MptCtx.bCarrierSuppression; -+#endif -+ -+ //ignore IQK when continuous Tx -+ if(bStartContTx || bSingleTone || bCarrierSuppression) -+ return; -+ -+#ifdef DISABLE_BB_RF -+ return; -+#endif -+ if(pAdapter->bSlaveOfDMSP) -+ return; -+ -+ if (bReCovery) -+ { -+ phy_ReloadADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup_recover, 9); -+ return; -+ -+ } -+ -+ RTPRINT(FINIT, INIT_IQK, ("IQK:Start!!!\n")); -+ -+ for(i = 0; i < 8; i++) -+ { -+ result[0][i] = 0; -+ result[1][i] = 0; -+ result[2][i] = 0; -+ result[3][i] = 0; -+ } -+ final_candidate = 0xff; -+ bPathAOK = FALSE; -+ bPathBOK = FALSE; -+ is12simular = FALSE; -+ is23simular = FALSE; -+ is13simular = FALSE; -+ -+ AcquireCCKAndRWPageAControl(pAdapter); -+ /*RT_TRACE(COMP_INIT,DBG_LOUD,("Acquire Mutex in IQCalibrate\n"));*/ -+ for (i=0; i<3; i++) -+ { -+ /*For 88C 1T1R*/ -+ phy_IQCalibrate_8192C(pAdapter, result, i, FALSE); -+ -+ if(i == 1) -+ { -+ is12simular = phy_SimularityCompare(pAdapter, result, 0, 1); -+ if(is12simular) -+ { -+ final_candidate = 0; -+ break; -+ } -+ } -+ -+ if(i == 2) -+ { -+ is13simular = phy_SimularityCompare(pAdapter, result, 0, 2); -+ if(is13simular) -+ { -+ final_candidate = 0; -+ break; -+ } -+ -+ is23simular = phy_SimularityCompare(pAdapter, result, 1, 2); -+ if(is23simular) -+ final_candidate = 1; -+ else -+ { -+ for(i = 0; i < 8; i++) -+ RegTmp += result[3][i]; -+ -+ if(RegTmp != 0) -+ final_candidate = 3; -+ else -+ final_candidate = 0xFF; -+ } -+ } -+ } -+// RT_TRACE(COMP_INIT,DBG_LOUD,("Release Mutex in IQCalibrate \n")); -+ ReleaseCCKAndRWPageAControl(pAdapter); -+ -+ for (i=0; i<4; i++) -+ { -+ RegE94 = result[i][0]; -+ RegE9C = result[i][1]; -+ RegEA4 = result[i][2]; -+ RegEAC = result[i][3]; -+ RegEB4 = result[i][4]; -+ RegEBC = result[i][5]; -+ RegEC4 = result[i][6]; -+ RegECC = result[i][7]; -+ RTPRINT(FINIT, INIT_IQK, ("IQK: RegE94=%x RegE9C=%x RegEA4=%x RegEAC=%x RegEB4=%x RegEBC=%x RegEC4=%x RegECC=%x\n ", RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC)); -+ } -+ -+ if(final_candidate != 0xff) -+ { -+ pHalData->RegE94 = RegE94 = result[final_candidate][0]; -+ pHalData->RegE9C = RegE9C = result[final_candidate][1]; -+ RegEA4 = result[final_candidate][2]; -+ RegEAC = result[final_candidate][3]; -+ pHalData->RegEB4 = RegEB4 = result[final_candidate][4]; -+ pHalData->RegEBC = RegEBC = result[final_candidate][5]; -+ RegEC4 = result[final_candidate][6]; -+ RegECC = result[final_candidate][7]; -+ RTPRINT(FINIT, INIT_IQK, ("IQK: final_candidate is %x\n",final_candidate)); -+ RTPRINT(FINIT, INIT_IQK, ("IQK: RegE94=%x RegE9C=%x RegEA4=%x RegEAC=%x RegEB4=%x RegEBC=%x RegEC4=%x RegECC=%x\n ", RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC)); -+ bPathAOK = bPathBOK = TRUE; -+ } -+ else -+ { -+ RegE94 = RegEB4 = pHalData->RegE94 = pHalData->RegEB4 = 0x100; //X default value -+ RegE9C = RegEBC = pHalData->RegE9C = pHalData->RegEBC = 0x0; //Y default value -+ } -+ -+ if((RegE94 != 0)/*&&(RegEA4 != 0)*/) -+ { -+ if(pHalData->CurrentBandType == BAND_ON_5G) -+ phy_PathAFillIQKMatrix_5G_Normal(pAdapter, bPathAOK, result, final_candidate, (RegEA4 == 0)); -+ else -+ phy_PathAFillIQKMatrix(pAdapter, bPathAOK, result, final_candidate, (RegEA4 == 0)); -+ -+ } -+ -+ if (IS_92C_SERIAL(pHalData->VersionID) || IS_92D_SINGLEPHY(pHalData->VersionID)) -+ { -+ if((RegEB4 != 0)/*&&(RegEC4 != 0)*/) -+ { -+ if(pHalData->CurrentBandType == BAND_ON_5G) -+ phy_PathBFillIQKMatrix_5G_Normal(pAdapter, bPathBOK, result, final_candidate, (RegEC4 == 0)); -+ else -+ phy_PathBFillIQKMatrix(pAdapter, bPathBOK, result, final_candidate, (RegEC4 == 0)); -+ } -+ } -+ -+ phy_SaveADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup_recover, 9); -+ -+} -+ -+ -+VOID -+PHY_LCCalibrate_8192C( -+ IN PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ BOOLEAN bStartContTx = FALSE, bSingleTone = FALSE, bCarrierSuppression = FALSE; -+ PMGNT_INFO pMgntInfo=&pAdapter->MgntInfo; -+ PMGNT_INFO pMgntInfoBuddyAdapter; -+ u4Byte timeout = 2000, timecount = 0; -+ PADAPTER BuddyAdapter = pAdapter->BuddyAdapter; -+ -+#if MP_DRIVER == 1 -+ bStartContTx = pAdapter->MptCtx.bStartContTx; -+ bSingleTone = pAdapter->MptCtx.bSingleTone; -+ bCarrierSuppression = pAdapter->MptCtx.bCarrierSuppression; -+#endif -+ -+#ifdef DISABLE_BB_RF -+ return; -+#endif -+ -+ //ignore LCK when continuous Tx -+ if(bStartContTx || bSingleTone || bCarrierSuppression) -+ return; -+ -+ if(BuddyAdapter != NULL && -+ ((pAdapter->interfaceIndex == 0 && pHalData->CurrentBandType == BAND_ON_2_4G) || -+ (pAdapter->interfaceIndex == 1 && pHalData->CurrentBandType == BAND_ON_5G))) -+ { -+ pMgntInfoBuddyAdapter=&BuddyAdapter->MgntInfo; -+ while(pMgntInfoBuddyAdapter->bScanInProgress && timecount < timeout) -+ { -+ delay_ms(50); -+ timecount += 50; -+ } -+ } -+ -+ while(pMgntInfo->bScanInProgress && timecount < timeout) -+ { -+ delay_ms(50); -+ timecount += 50; -+ } -+ -+ pHalData->bLCKInProgress = TRUE; -+ -+ RTPRINT(FINIT, INIT_IQK, ("LCK:Start!!!interface %d currentband %x delay %d ms\n", pAdapter->interfaceIndex, pHalData->CurrentBandType, timecount)); -+ -+ //if(IS_92C_SERIAL(pHalData->VersionID) || IS_92D_SINGLEPHY(pHalData->VersionID)) -+ if(IS_2T2R(pHalData->VersionID)) -+ { -+ phy_LCCalibrate(pAdapter, TRUE); -+ } -+ else{ -+ // For 88C 1T1R -+ phy_LCCalibrate(pAdapter, FALSE); -+ } -+ -+ pHalData->bLCKInProgress = FALSE; -+ -+ RTPRINT(FINIT, INIT_IQK, ("LCK:Finish!!!interface %d\n", pAdapter->interfaceIndex)); -+ -+ -+} -+ -+VOID -+PHY_APCalibrate_8192C( -+ IN PADAPTER pAdapter, -+ IN s1Byte delta -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ //default disable APK, because Tx NG issue, suggest by Jenyu, 2011.11.25 -+ return; -+ -+#ifdef DISABLE_BB_RF -+ return; -+#endif -+ -+#if FOR_BRAZIL_PRETEST != 1 -+ if(pHalData->bAPKdone) -+#endif -+ return; -+ -+ if(IS_92C_SERIAL( pHalData->VersionID)){ -+ phy_APCalibrate_8192C(pAdapter, delta, TRUE); -+ } -+ else{ -+ // For 88C 1T1R -+ phy_APCalibrate_8192C(pAdapter, delta, FALSE); -+ } -+} -+ -+ -+#endif -+ -+ -+//3============================================================ -+//3 IQ Calibration -+//3============================================================ -+ -+VOID -+ODM_ResetIQKResult( -+ IN PVOID pDM_VOID -+) -+{ -+ return; -+} -+#if 1//!(DM_ODM_SUPPORT_TYPE & ODM_AP) -+u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) -+{ -+ u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = -+ {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; -+ u1Byte place = chnl; -+ -+ -+ if(chnl > 14) -+ { -+ for(place = 14; placeAdapter; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (*pDM_Odm->pIsFcsModeEnable) -+ return; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if (!IS_HARDWARE_TYPE_JAGUAR(Adapter)) -+ return; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ else if (IS_HARDWARE_TYPE_8812AU(Adapter)) -+ return; -+#endif -+#endif -+ -+#if (RTL8821A_SUPPORT == 1) -+ if (pDM_Odm->bLinked) { -+ if ((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) { -+ pDM_Odm->preChannel = *pDM_Odm->pChannel; -+ pDM_Odm->LinkedInterval = 0; -+ } -+ -+ if (pDM_Odm->LinkedInterval < 3) -+ pDM_Odm->LinkedInterval++; -+ -+ if (pDM_Odm->LinkedInterval == 2) { -+ /*Mark out IQK flow to prevent tx stuck. by Maddest 20130306*/ -+ /*Open it verified by James 20130715*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PHY_IQCalibrate_8821A(pDM_Odm, FALSE); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHY_IQCalibrate(Adapter, FALSE); -+#else -+ PHY_IQCalibrate_8821A(Adapter, FALSE); -+#endif -+ } -+ } else -+ pDM_Odm->LinkedInterval = 0; -+#endif -+} -+ -+void phydm_rf_init(IN PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ odm_TXPowerTrackingInit(pDM_Odm); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ PHY_IQCalibrate_8814A_Init(pDM_Odm); -+#endif -+#endif -+ -+} -+ -+void phydm_rf_watchdog(IN PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ ODM_TXPowerTrackingCheck(pDM_Odm); -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ odm_IQCalibrate(pDM_Odm); -+#endif -+} -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/halphyrf_ap.h linux/3rdparty/rtl8812au/hal/phydm/halphyrf_ap.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/halphyrf_ap.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/halphyrf_ap.h 2017-06-07 23:07:21.015687940 +0300 -@@ -0,0 +1,162 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ #ifndef __HAL_PHY_RF_H__ -+ #define __HAL_PHY_RF_H__ -+ -+#include "phydm_powertracking_ap.h" -+#if (RTL8814A_SUPPORT == 1) -+#include "rtl8814a/phydm_iqk_8814a.h" -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+#include "rtl8822b/phydm_iqk_8822b.h" -+#endif -+ -+ -+typedef enum _PWRTRACK_CONTROL_METHOD { -+ BBSWING, -+ TXAGC, -+ MIX_MODE, -+ TSSI_MODE -+} PWRTRACK_METHOD; -+ -+typedef VOID (*FuncSetPwr)(PVOID, PWRTRACK_METHOD, u1Byte, u1Byte); -+typedef VOID(*FuncIQK)(PVOID, u1Byte, u1Byte, u1Byte); -+typedef VOID (*FuncLCK)(PVOID); -+ //refine by YuChen for 8814A -+typedef VOID (*FuncSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+typedef VOID (*FuncSwing8814only)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+ -+typedef struct _TXPWRTRACK_CFG { -+ u1Byte SwingTableSize_CCK; -+ u1Byte SwingTableSize_OFDM; -+ u1Byte Threshold_IQK; -+ u1Byte Threshold_DPK; -+ u1Byte AverageThermalNum; -+ u1Byte RfPathCount; -+ u4Byte ThermalRegAddr; -+ FuncSetPwr ODM_TxPwrTrackSetPwr; -+ FuncIQK DoIQK; -+ FuncLCK PHY_LCCalibrate; -+ FuncSwing GetDeltaSwingTable; -+ FuncSwing8814only GetDeltaSwingTable8814only; -+} TXPWRTRACK_CFG, *PTXPWRTRACK_CFG; -+ -+VOID -+ConfigureTxpowerTrack( -+ IN PVOID pDM_VOID, -+ OUT PTXPWRTRACK_CFG pConfig -+ ); -+ -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ); -+ -+#if (RTL8192E_SUPPORT==1) -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_92E( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ); -+#endif -+ -+#if (RTL8814A_SUPPORT == 1) -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries2( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ); -+ -+#elif ODM_IC_11AC_SERIES_SUPPORT -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ); -+#endif -+ -+#define IS_CCK_RATE(_rate) (ODM_MGN_1M == _rate || _rate == ODM_MGN_2M || _rate == ODM_MGN_5_5M || _rate == ODM_MGN_11M ) -+ -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#define MAX_TOLERANCE 5 -+#define IQK_DELAY_TIME 1 //ms -+ -+ // -+// BB/MAC/RF other monitor API -+// -+ -+void PHY_SetMonitorMode8192C(IN PADAPTER pAdapter, -+ IN BOOLEAN bEnableMonitorMode ); -+ -+// -+// IQ calibrate -+// -+void -+PHY_IQCalibrate_8192C( IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery); -+ -+// -+// LC calibrate -+// -+void -+PHY_LCCalibrate_8192C( IN PADAPTER pAdapter); -+ -+// -+// AP calibrate -+// -+void -+PHY_APCalibrate_8192C( IN PADAPTER pAdapter, -+ IN s1Byte delta); -+#endif -+ -+#define ODM_TARGET_CHNL_NUM_2G_5G 59 -+ -+ -+VOID -+ODM_ResetIQKResult( -+ IN PVOID pDM_VOID -+); -+u1Byte -+ODM_GetRightChnlPlaceforIQK( -+ IN u1Byte chnl -+); -+ -+void phydm_rf_init(IN PVOID pDM_VOID); -+void phydm_rf_watchdog(IN PVOID pDM_VOID); -+ -+#endif // #ifndef __HAL_PHY_RF_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/halphyrf_ce.c linux/3rdparty/rtl8812au/hal/phydm/halphyrf_ce.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/halphyrf_ce.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/halphyrf_ce.c 2017-06-07 23:07:21.015687940 +0300 -@@ -0,0 +1,710 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+ -+#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ -+ do {\ -+ for(_offset = 0; _offset < _size; _offset++)\ -+ {\ -+ if(_deltaThermal < thermalThreshold[_direction][_offset])\ -+ {\ -+ if(_offset != 0)\ -+ _offset--;\ -+ break;\ -+ }\ -+ } \ -+ if(_offset >= _size)\ -+ _offset = _size-1;\ -+ } while(0) -+ -+void ConfigureTxpowerTrack( -+ IN PVOID pDM_VOID, -+ OUT PTXPWRTRACK_CFG pConfig -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+#if RTL8192E_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8192E) -+ ConfigureTxpowerTrack_8192E(pConfig); -+#endif -+#if RTL8821A_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8821) -+ ConfigureTxpowerTrack_8821A(pConfig); -+#endif -+#if RTL8812A_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8812) -+ ConfigureTxpowerTrack_8812A(pConfig); -+#endif -+#if RTL8188E_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8188E) -+ ConfigureTxpowerTrack_8188E(pConfig); -+#endif -+ -+#if RTL8723B_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8723B) -+ ConfigureTxpowerTrack_8723B(pConfig); -+#endif -+ -+#if RTL8814A_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ ConfigureTxpowerTrack_8814A(pConfig); -+#endif -+ -+#if RTL8703B_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8703B) -+ ConfigureTxpowerTrack_8703B(pConfig); -+#endif -+ -+#if RTL8188F_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) -+ ConfigureTxpowerTrack_8188F(pConfig); -+#endif -+} -+ -+//====================================================================== -+// <20121113, Kordan> This function should be called when TxAGC changed. -+// Otherwise the previous compensation is gone, because we record the -+// delta of temperature between two TxPowerTracking watch dogs. -+// -+// NOTE: If Tx BB swing or Tx scaling is varified during run-time, still -+// need to call this function. -+//====================================================================== -+VOID -+ODM_ClearTxPowerTrackingState( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDM_Odm->Adapter); -+ u1Byte p = 0; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; -+ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->DefaultCckIndex; -+ pDM_Odm->RFCalibrateInfo.CCK_index = 0; -+ -+ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) -+ { -+ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ pRFCalibrateInfo->DeltaPowerIndex[p] = 0; -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = 0; /* Initial Mix mode power tracking*/ -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[p] = 0; -+ pRFCalibrateInfo->KfreeOffset[p] = 0; -+ } -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; /*Initial at Modify Tx Scaling Mode*/ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = FALSE; /*Initial at Modify Tx Scaling Mode*/ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathC = FALSE; /*Initial at Modify Tx Scaling Mode*/ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathD = FALSE; /*Initial at Modify Tx Scaling Mode*/ -+ pRFCalibrateInfo->Remnant_CCKSwingIdx = 0; -+ pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; -+ -+ pRFCalibrateInfo->Modify_TxAGC_Value_CCK=0; //modify by Mingzhi.Guo -+ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM=0; //modify by Mingzhi.Guo -+} -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER Adapter -+#endif -+ ) -+{ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+#endif -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; -+ s1Byte diff_DPK[4] = {0}; -+ u1Byte ThermalValue_AVG_count = 0; -+ u4Byte ThermalValue_AVG = 0; -+ -+ u1Byte OFDM_min_index = 0; // OFDM BB Swing should be less than +3.0dB, which is required by Arthur -+ u1Byte Indexforchannel = 0; // GetRightChnlPlaceforIQK(pHalData->CurrentChannel) -+ BOOLEAN bTSSIenable = FALSE; -+ -+ TXPWRTRACK_CFG c; -+ -+ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. -+ pu1Byte deltaSwingTableIdx_TUP_A; -+ pu1Byte deltaSwingTableIdx_TDOWN_A; -+ pu1Byte deltaSwingTableIdx_TUP_B; -+ pu1Byte deltaSwingTableIdx_TDOWN_B; -+ /*for 8814 add by Yu Chen*/ -+ pu1Byte deltaSwingTableIdx_TUP_C; -+ pu1Byte deltaSwingTableIdx_TDOWN_C; -+ pu1Byte deltaSwingTableIdx_TUP_D; -+ pu1Byte deltaSwingTableIdx_TDOWN_D; -+ -+ //4 2. Initilization ( 7 steps in total ) -+ -+ ConfigureTxpowerTrack(pDM_Odm, &c); -+ -+ (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte*)&deltaSwingTableIdx_TUP_A, (pu1Byte*)&deltaSwingTableIdx_TDOWN_A, -+ (pu1Byte*)&deltaSwingTableIdx_TUP_B, (pu1Byte*)&deltaSwingTableIdx_TDOWN_B); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) /*for 8814 path C & D*/ -+ (*c.GetDeltaSwingTable8814only)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_C, (pu1Byte *)&deltaSwingTableIdx_TDOWN_C, -+ (pu1Byte *)&deltaSwingTableIdx_TUP_D, (pu1Byte *)&deltaSwingTableIdx_TDOWN_D); -+ -+ -+ pDM_Odm->RFCalibrateInfo.TXPowerTrackingCallbackCnt++; //cosa add for debug -+ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = TRUE; -+ -+#if (MP_DRIVER == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = pHalData->TxPowerTrackControl; // We should keep updating the control variable according to HalData. -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (pDM_Odm->mp_mode == TRUE) -+#endif -+ // RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. -+ pDM_Odm->RFCalibrateInfo.RegA24 = 0x090e1317; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("===>ODM_TXPowerTrackingCallback_ThermalMeter Start\n pRFCalibrateInfo->BbSwingIdxCckBase: %d, pRFCalibrateInfo->BbSwingIdxOfdmBase[A]: %d, pRFCalibrateInfo->DefaultOfdmIndex: %d\n", -+ pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_A], pRFCalibrateInfo->DefaultOfdmIndex)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("pDM_Odm->RFCalibrateInfo.TxPowerTrackControl %d, pHalData->EEPROMThermalMeter %d\n", pDM_Odm->RFCalibrateInfo.TxPowerTrackControl, pHalData->EEPROMThermalMeter)); -+ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E -+ if( ! pDM_Odm->RFCalibrateInfo.TxPowerTrackControl || pHalData->EEPROMThermalMeter == 0 || -+ pHalData->EEPROMThermalMeter == 0xFF) -+ return; -+ -+ -+ //4 3. Initialize ThermalValues of RFCalibrateInfo -+ -+ if(pDM_Odm->RFCalibrateInfo.bReloadtxpowerindex) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); -+ } -+ -+ //4 4. Calculate average thermal meter -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; -+ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) //Average times = c.AverageThermalNum -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; -+ -+ for(i = 0; i < c.AverageThermalNum; i++) -+ { -+ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) -+ { -+ ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times -+ { -+ ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("AVG Thermal Meter = 0x%X, EFUSE Thermal Base = 0x%X\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ } -+ -+ //4 5. Calculate delta, delta_LCK, delta_IQK. -+ -+ //"delta" here is used to determine whether thermal value changes or not. -+ delta = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue):(pDM_Odm->RFCalibrateInfo.ThermalValue - ThermalValue); -+ delta_LCK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_LCK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK):(pDM_Odm->RFCalibrateInfo.ThermalValue_LCK - ThermalValue); -+ delta_IQK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_IQK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK):(pDM_Odm->RFCalibrateInfo.ThermalValue_IQK - ThermalValue); -+ -+ if (pDM_Odm->RFCalibrateInfo.ThermalValue_IQK == 0xff) { /*no PG, use thermal value for IQK*/ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = ThermalValue; -+ delta_IQK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_IQK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK):(pDM_Odm->RFCalibrateInfo.ThermalValue_IQK - ThermalValue); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, use ThermalValue for IQK\n")); -+ } -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ diff_DPK[p] = (s1Byte)ThermalValue - (s1Byte)pDM_Odm->RFCalibrateInfo.DpkThermal[p]; -+ -+ /*4 6. If necessary, do LCK.*/ -+ if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { -+ -+ if (pDM_Odm->RFCalibrateInfo.ThermalValue_LCK == 0xff) { -+ /*no PG , do LCK at initial status*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, do LCK\n")); -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; -+ if (c.PHY_LCCalibrate) -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ delta_LCK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_LCK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK):(pDM_Odm->RFCalibrateInfo.ThermalValue_LCK - ThermalValue); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK)); -+ /*DBG_871X("(delta, delta_LCK, delta_IQK) = (%d, %d, %d), %d\n", delta, delta_LCK, delta_IQK, c.Threshold_IQK);*/ -+ -+ /* 4 6. If necessary, do LCK.*/ -+ -+ if (delta_LCK >= c.Threshold_IQK) { -+ /* Delta temperature is equal to or larger than 20 centigrade.*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; -+ if (c.PHY_LCCalibrate) -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ } -+ } -+ //3 7. If necessary, move the index of swing table to adjust Tx power. -+ -+ if (delta > 0 && pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) -+ { -+ //"delta" here is used to record the absolute value of differrence. -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); -+#else -+ delta = (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther)?(ThermalValue - pDM_Odm->priv->pmib->dot11RFEntry.ther):(pDM_Odm->priv->pmib->dot11RFEntry.ther - ThermalValue); -+#endif -+ if (delta >= TXPWR_TRACK_TABLE_SIZE) -+ delta = TXPWR_TRACK_TABLE_SIZE - 1; -+ -+ //4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(ThermalValue > pHalData->EEPROMThermalMeter) { -+#else -+ if(ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { -+#endif -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p]; /* recording power index offset */ -+ switch (p) { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); -+ -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_B[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; /* Record delta swing for mix mode power tracking */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A])); -+ -+ -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta])); -+ -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_C[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; /* Record delta swing for mix mode power tracking */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta])); -+ -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_D[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; /* Record delta swing for mix mode power tracking */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); -+ -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_A[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; /* Record delta swing for mix mode power tracking */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ } -+ } -+ } else { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p]; /* recording poer index offset */ -+ switch (p) { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; /* Record delta swing for mix mode power tracking */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta])); -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; /* Record delta swing for mix mode power tracking */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta])); -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; /* Record delta swing for mix mode power tracking */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; /* Record delta swing for mix mode power tracking */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ } -+ } -+ } -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\n\n=========================== [Path-%d] Calculating PowerIndexOffset===========================\n", p)); -+ if (pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] == pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p]) /* If Thermal value changes but lookup table value still the same */ -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; -+ else -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] - pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p]; /* Power Index Diff between 2 times Power Tracking */ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("[Path-%d] PowerIndexOffset(%d) = DeltaPowerIndex(%d) - DeltaPowerIndexLast(%d)\n", p, pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p], pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p], pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p])); -+ -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pRFCalibrateInfo->BbSwingIdxOfdmBase[p] + pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p]; -+ pDM_Odm->RFCalibrateInfo.CCK_index = pRFCalibrateInfo->BbSwingIdxCckBase + pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p]; -+ -+ pRFCalibrateInfo->BbSwingIdxCck = pDM_Odm->RFCalibrateInfo.CCK_index; -+ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pDM_Odm->RFCalibrateInfo.OFDM_index[p]; -+ -+ -+ -+ /* *************Print BB Swing Base and Index Offset************* */ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxCck, pRFCalibrateInfo->BbSwingIdxCckBase, pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p])); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The 'OFDM' final index(%d) = BaseIndex[%d](%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxOfdm[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p], pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p])); -+ -+ //4 7.1 Handle boundary conditions of index. -+ -+ if(pDM_Odm->RFCalibrateInfo.OFDM_index[p] > c.SwingTableSize_OFDM-1) -+ { -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = c.SwingTableSize_OFDM-1; -+ } -+ else if (pDM_Odm->RFCalibrateInfo.OFDM_index[p] < OFDM_min_index) -+ { -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = OFDM_min_index; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\n\n========================================================================================================\n")); -+ if(pDM_Odm->RFCalibrateInfo.CCK_index > c.SwingTableSize_CCK-1) -+ pDM_Odm->RFCalibrateInfo.CCK_index = c.SwingTableSize_CCK-1; -+ else if (pDM_Odm->RFCalibrateInfo.CCK_index <= 0) -+ pDM_Odm->RFCalibrateInfo.CCK_index = 0; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The thermal meter is unchanged or TxPowerTracking OFF(%d): ThermalValue: %d , pDM_Odm->RFCalibrateInfo.ThermalValue: %d\n", -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl, ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", -+ pDM_Odm->RFCalibrateInfo.CCK_index, pRFCalibrateInfo->BbSwingIdxCckBase)); /*Print Swing base & current*/ -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index[%d]: %d\n", -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p])); -+ } -+ -+ if ((pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_A] != 0 || -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_B] != 0 || -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_C] != 0 || -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_D] != 0) && -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) -+ { -+ //4 7.2 Configure the Swing Table to adjust Tx Power. -+ -+ pDM_Odm->RFCalibrateInfo.bTxPowerChanged = TRUE; // Always TRUE after Tx Power is adjusted by power tracking. -+ // -+ // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital -+ // to increase TX power. Otherwise, EVM will be bad. -+ // -+ // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. -+ if (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue) -+ { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature Increasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ p, pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ } -+ } -+ else if (ThermalValue < pDM_Odm->RFCalibrateInfo.ThermalValue)// Low temperature -+ { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature Decreasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ p, pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ } -+ } -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (ThermalValue > pHalData->EEPROMThermalMeter) -+#else -+ if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) -+#endif -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || -+ pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || -+ pDM_Odm->SupportICType == ODM_RTL8822B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8703B) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || -+ pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || -+ pDM_Odm->SupportICType == ODM_RTL8822B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8703B) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); -+ } -+ -+ } -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->BbSwingIdxCck; /*Record last time Power Tracking result as base.*/ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->BbSwingIdxOfdm[p]; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("pDM_Odm->RFCalibrateInfo.ThermalValue = %d ThermalValue= %d\n", pDM_Odm->RFCalibrateInfo.ThermalValue, ThermalValue)); -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; /*Record last Power Tracking Thermal Value*/ -+ -+ } -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ if (!IS_HARDWARE_TYPE_8723B(Adapter) && !IS_HARDWARE_TYPE_8192E(Adapter) && !IS_HARDWARE_TYPE_8703B(Adapter)) { -+ /* Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ -+ if (delta_IQK >= c.Threshold_IQK) { -+ if (!pDM_Odm->RFCalibrateInfo.bIQKInProgress) -+ (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); -+ } -+ } -+ if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { -+ if (pDM_Odm->RFCalibrateInfo.DpkThermal[ODM_RF_PATH_A] != 0) { -+ if (diff_DPK[ODM_RF_PATH_A] >= c.Threshold_DPK) { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK)); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else if ((diff_DPK[ODM_RF_PATH_A] <= -1 * c.Threshold_DPK)) { -+ s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, value); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } -+ } -+ if (pDM_Odm->RFCalibrateInfo.DpkThermal[ODM_RF_PATH_B] != 0) { -+ if (diff_DPK[ODM_RF_PATH_B] >= c.Threshold_DPK) { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK)); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else if ((diff_DPK[ODM_RF_PATH_B] <= -1 * c.Threshold_DPK)) { -+ s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, value); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } -+ } -+ } -+ -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("<===ODM_TXPowerTrackingCallback_ThermalMeter End\n")); -+ -+ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; -+} -+ -+ -+//3============================================================ -+//3 IQ Calibration -+//3============================================================ -+ -+VOID -+ODM_ResetIQKResult( -+ IN PVOID pDM_VOID -+) -+{ -+ return; -+ -+} -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) -+{ -+ u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = -+ {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; -+ u1Byte place = chnl; -+ -+ -+ if(chnl > 14) -+ { -+ for(place = 14; placeAdapter; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (*pDM_Odm->pIsFcsModeEnable) -+ return; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if (!IS_HARDWARE_TYPE_JAGUAR(Adapter)) -+ return; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ else if (IS_HARDWARE_TYPE_8812AU(Adapter)) -+ return; -+#endif -+#endif -+ -+#if (RTL8821A_SUPPORT == 1) -+ if (pDM_Odm->bLinked) { -+ if ((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) { -+ pDM_Odm->preChannel = *pDM_Odm->pChannel; -+ pDM_Odm->LinkedInterval = 0; -+ } -+ -+ if (pDM_Odm->LinkedInterval < 3) -+ pDM_Odm->LinkedInterval++; -+ -+ if (pDM_Odm->LinkedInterval == 2) { -+ /*Mark out IQK flow to prevent tx stuck. by Maddest 20130306*/ -+ /*Open it verified by James 20130715*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PHY_IQCalibrate_8821A(pDM_Odm, FALSE); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHY_IQCalibrate(Adapter, FALSE); -+#else -+ PHY_IQCalibrate_8821A(Adapter, FALSE); -+#endif -+ } -+ } else -+ pDM_Odm->LinkedInterval = 0; -+#endif -+} -+ -+void phydm_rf_init(IN PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ odm_TXPowerTrackingInit(pDM_Odm); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ PHY_IQCalibrate_8814A_Init(pDM_Odm); -+#endif -+#endif -+ -+} -+ -+void phydm_rf_watchdog(IN PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ ODM_TXPowerTrackingCheck(pDM_Odm); -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ odm_IQCalibrate(pDM_Odm); -+#endif -+} -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/halphyrf_ce.h linux/3rdparty/rtl8812au/hal/phydm/halphyrf_ce.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/halphyrf_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/halphyrf_ce.h 2017-06-07 23:07:21.015687940 +0300 -@@ -0,0 +1,106 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ #ifndef __HAL_PHY_RF_H__ -+ #define __HAL_PHY_RF_H__ -+ -+/*#include "phydm_kfree.h"*/ -+#if (RTL8814A_SUPPORT == 1) -+#include "rtl8814a/phydm_iqk_8814a.h" -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+#include "rtl8822b/phydm_iqk_8822b.h" -+#endif -+#include "phydm_powertracking_ce.h" -+ -+ -+typedef enum _SPUR_CAL_METHOD { -+ PLL_RESET, -+ AFE_PHASE_SEL -+} SPUR_CAL_METHOD; -+ -+typedef enum _PWRTRACK_CONTROL_METHOD { -+ BBSWING, -+ TXAGC, -+ MIX_MODE, -+ TSSI_MODE -+} PWRTRACK_METHOD; -+ -+typedef VOID (*FuncSetPwr)(PVOID, PWRTRACK_METHOD, u1Byte, u1Byte); -+typedef VOID(*FuncIQK)(PVOID, u1Byte, u1Byte, u1Byte); -+typedef VOID (*FuncLCK)(PVOID); -+typedef VOID (*FuncSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+typedef VOID (*FuncSwing8814only)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+ -+typedef struct _TXPWRTRACK_CFG { -+ u1Byte SwingTableSize_CCK; -+ u1Byte SwingTableSize_OFDM; -+ u1Byte Threshold_IQK; -+ u1Byte Threshold_DPK; -+ u1Byte AverageThermalNum; -+ u1Byte RfPathCount; -+ u4Byte ThermalRegAddr; -+ FuncSetPwr ODM_TxPwrTrackSetPwr; -+ FuncIQK DoIQK; -+ FuncLCK PHY_LCCalibrate; -+ FuncSwing GetDeltaSwingTable; -+ FuncSwing8814only GetDeltaSwingTable8814only; -+} TXPWRTRACK_CFG, *PTXPWRTRACK_CFG; -+ -+void ConfigureTxpowerTrack( -+ IN PVOID pDM_VOID, -+ OUT PTXPWRTRACK_CFG pConfig -+ ); -+ -+ -+VOID -+ODM_ClearTxPowerTrackingState( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ); -+ -+ -+ -+#define ODM_TARGET_CHNL_NUM_2G_5G 59 -+ -+ -+VOID -+ODM_ResetIQKResult( -+ IN PVOID pDM_VOID -+); -+u1Byte -+ODM_GetRightChnlPlaceforIQK( -+ IN u1Byte chnl -+); -+ -+void phydm_rf_init( IN PVOID pDM_VOID); -+void phydm_rf_watchdog( IN PVOID pDM_VOID); -+ -+#endif // #ifndef __HAL_PHY_RF_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/halphyrf_win.c linux/3rdparty/rtl8812au/hal/phydm/halphyrf_win.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/halphyrf_win.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/halphyrf_win.c 2017-06-07 23:07:21.015687940 +0300 -@@ -0,0 +1,716 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ #include "mp_precomp.h" -+ #include "phydm_precomp.h" -+ -+//#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ -+ do {\ -+ for(_offset = 0; _offset < _size; _offset++)\ -+ {\ -+ if(_deltaThermal < thermalThreshold[_direction][_offset])\ -+ {\ -+ if(_offset != 0)\ -+ _offset--;\ -+ break;\ -+ }\ -+ } \ -+ if(_offset >= _size)\ -+ _offset = _size-1;\ -+ } while(0) -+ -+ -+void ConfigureTxpowerTrack( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PTXPWRTRACK_CFG pConfig -+ ) -+{ -+#if RTL8192E_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8192E) -+ ConfigureTxpowerTrack_8192E(pConfig); -+#endif -+#if RTL8821A_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8821) -+ ConfigureTxpowerTrack_8821A(pConfig); -+#endif -+#if RTL8812A_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8812) -+ ConfigureTxpowerTrack_8812A(pConfig); -+#endif -+#if RTL8188E_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8188E) -+ ConfigureTxpowerTrack_8188E(pConfig); -+#endif -+ -+#if RTL8188F_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8188F) -+ ConfigureTxpowerTrack_8188F(pConfig); -+#endif -+ -+#if RTL8723B_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8723B) -+ ConfigureTxpowerTrack_8723B(pConfig); -+#endif -+ -+#if RTL8814A_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8814A) -+ ConfigureTxpowerTrack_8814A(pConfig); -+#endif -+ -+#if RTL8821B_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8821B) -+ ConfigureTxpowerTrack_8821B(pConfig); -+#endif -+ -+#if RTL8703B_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8703B) -+ ConfigureTxpowerTrack_8703B(pConfig); -+#endif -+ -+} -+ -+//====================================================================== -+// <20121113, Kordan> This function should be called when TxAGC changed. -+// Otherwise the previous compensation is gone, because we record the -+// delta of temperature between two TxPowerTracking watch dogs. -+// -+// NOTE: If Tx BB swing or Tx scaling is varified during run-time, still -+// need to call this function. -+//====================================================================== -+VOID -+ODM_ClearTxPowerTrackingState( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDM_Odm->Adapter); -+ u1Byte p = 0; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; -+ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->DefaultCckIndex; -+ pRFCalibrateInfo->CCK_index = 0; -+ -+ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) -+ { -+ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ pRFCalibrateInfo->DeltaPowerIndex[p] = 0; -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; -+ -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = 0; // Initial Mix mode power tracking -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[p] = 0; -+ pRFCalibrateInfo->KfreeOffset[p] = 0; -+ } -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA= FALSE; //Initial at Modify Tx Scaling Mode -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB= FALSE; //Initial at Modify Tx Scaling Mode -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathC= FALSE; //Initial at Modify Tx Scaling Mode -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathD= FALSE; //Initial at Modify Tx Scaling Mode -+ pRFCalibrateInfo->Remnant_CCKSwingIdx= 0; -+ pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; -+ -+ pRFCalibrateInfo->Modify_TxAGC_Value_CCK=0; //modify by Mingzhi.Guo -+ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM=0; //modify by Mingzhi.Guo -+ -+} -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER Adapter -+#endif -+ ) -+{ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0, pathName = 0; -+ s1Byte diff_DPK[4] = {0}; -+ u1Byte ThermalValue_AVG_count = 0; -+ u4Byte ThermalValue_AVG = 0; -+ -+ u1Byte OFDM_min_index = 0; // OFDM BB Swing should be less than +3.0dB, which is required by Arthur -+ u1Byte Indexforchannel = 0; // GetRightChnlPlaceforIQK(pHalData->CurrentChannel) -+ BOOLEAN bTSSIenable = FALSE; -+ -+ TXPWRTRACK_CFG c; -+ -+ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. -+ pu1Byte deltaSwingTableIdx_TUP_A, deltaSwingTableIdx_TDOWN_A; -+ pu1Byte deltaSwingTableIdx_TUP_B, deltaSwingTableIdx_TDOWN_B; -+ //for 8814 add by Yu Chen -+ pu1Byte deltaSwingTableIdx_TUP_C = NULL, deltaSwingTableIdx_TDOWN_C = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_D= NULL, deltaSwingTableIdx_TDOWN_D = NULL; -+ -+ //4 2. Initilization ( 7 steps in total ) -+ -+ ConfigureTxpowerTrack(pDM_Odm, &c); -+ -+ (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte*)&deltaSwingTableIdx_TUP_A, (pu1Byte*)&deltaSwingTableIdx_TDOWN_A, -+ (pu1Byte*)&deltaSwingTableIdx_TUP_B, (pu1Byte*)&deltaSwingTableIdx_TDOWN_B); -+ -+ if(pDM_Odm->SupportICType & ODM_RTL8814A) // for 8814 path C & D -+ (*c.GetDeltaSwingTable8814only)(pDM_Odm, (pu1Byte*)&deltaSwingTableIdx_TUP_C, (pu1Byte*)&deltaSwingTableIdx_TDOWN_C, -+ (pu1Byte*)&deltaSwingTableIdx_TUP_D, (pu1Byte*)&deltaSwingTableIdx_TDOWN_D); -+ -+ -+ pRFCalibrateInfo->TXPowerTrackingCallbackCnt++; //cosa add for debug -+ pRFCalibrateInfo->bTXPowerTrackingInit = TRUE; -+ -+#if (MP_DRIVER == 1) -+ /*pRFCalibrateInfo->TxPowerTrackControl = pHalData->TxPowerTrackControl; -+ We should keep updating the control variable according to HalData. -+ RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. */ -+ pRFCalibrateInfo->RegA24 = 0x090e1317; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("===>ODM_TXPowerTrackingCallback_ThermalMeter, \ -+ \n pRFCalibrateInfo->BbSwingIdxCckBase: %d, pRFCalibrateInfo->BbSwingIdxOfdmBase[A]: %d, pRFCalibrateInfo->DefaultOfdmIndex: %d\n", -+ pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_A], pRFCalibrateInfo->DefaultOfdmIndex)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("pRFCalibrateInfo->TxPowerTrackControl %d, pHalData->EEPROMThermalMeter %d\n", pRFCalibrateInfo->TxPowerTrackControl, pHalData->EEPROMThermalMeter)); -+ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E -+ -+ -+ if( ! pRFCalibrateInfo->TxPowerTrackControl ) -+ return; -+ -+ -+ //4 3. Initialize ThermalValues of RFCalibrateInfo -+ -+ if(pRFCalibrateInfo->bReloadtxpowerindex) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); -+ } -+ -+ //4 4. Calculate average thermal meter -+ -+ pRFCalibrateInfo->ThermalValue_AVG[pRFCalibrateInfo->ThermalValue_AVG_index] = ThermalValue; -+ pRFCalibrateInfo->ThermalValue_AVG_index++; -+ if(pRFCalibrateInfo->ThermalValue_AVG_index == c.AverageThermalNum) //Average times = c.AverageThermalNum -+ pRFCalibrateInfo->ThermalValue_AVG_index = 0; -+ -+ for(i = 0; i < c.AverageThermalNum; i++) -+ { -+ if(pRFCalibrateInfo->ThermalValue_AVG[i]) -+ { -+ ThermalValue_AVG += pRFCalibrateInfo->ThermalValue_AVG[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times -+ { -+ ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("AVG Thermal Meter = 0x%X, EFUSE Thermal Base = 0x%X\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ } -+ -+ //4 5. Calculate delta, delta_LCK, delta_IQK. -+ -+ //"delta" here is used to determine whether thermal value changes or not. -+ delta = (ThermalValue > pRFCalibrateInfo->ThermalValue)?(ThermalValue - pRFCalibrateInfo->ThermalValue):(pRFCalibrateInfo->ThermalValue - ThermalValue); -+ delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); -+ delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); -+ -+ if(pRFCalibrateInfo->ThermalValue_IQK == 0xff) //no PG, use thermal value for IQK -+ { -+ pRFCalibrateInfo->ThermalValue_IQK = ThermalValue; -+ delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, use ThermalValue for IQK\n")); -+ } -+ -+ for(p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ diff_DPK[p] = (s1Byte)ThermalValue - (s1Byte)pRFCalibrateInfo->DpkThermal[p]; -+ } -+ -+ //4 6. If necessary, do LCK. -+ -+ if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { -+ /*no PG , do LCK at initial status*/ -+ if (pRFCalibrateInfo->ThermalValue_LCK == 0xff) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, do LCK\n")); -+ pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; -+ if(c.PHY_LCCalibrate) -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK)); -+ -+ /* Delta temperature is equal to or larger than 20 centigrade.*/ -+ if (delta_LCK >= c.Threshold_IQK) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); -+ pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; -+ if(c.PHY_LCCalibrate) -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ } -+ } -+ -+ //3 7. If necessary, move the index of swing table to adjust Tx power. -+ -+ if (delta > 0 && pRFCalibrateInfo->TxPowerTrackControl) -+ { -+ //"delta" here is used to record the absolute value of differrence. -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); -+#else -+ delta = (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther)?(ThermalValue - pDM_Odm->priv->pmib->dot11RFEntry.ther):(pDM_Odm->priv->pmib->dot11RFEntry.ther - ThermalValue); -+#endif -+ if (delta >= TXPWR_TRACK_TABLE_SIZE) -+ delta = TXPWR_TRACK_TABLE_SIZE - 1; -+ -+ //4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(ThermalValue > pHalData->EEPROMThermalMeter) { -+#else -+ if(ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { -+#endif -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; //recording poer index offset -+ switch(p) -+ { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); -+ -+ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_B[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta])); -+ -+ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_C[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta])); -+ -+ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_D[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); -+ -+ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_A[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ } -+ -+ } -+ -+ } -+ else { -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; //recording poer index offset -+ switch(p) -+ { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); -+ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta])); -+ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta])); -+ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); -+ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ } -+ -+ } -+ -+ } -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\n\n=========================== [Path-%d] Calculating PowerIndexOffset===========================\n", p)); -+ -+ if(pRFCalibrateInfo->DeltaPowerIndex[p] == pRFCalibrateInfo->DeltaPowerIndexLast[p]) // If Thermal value changes but lookup table value still the same -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ else -+ pRFCalibrateInfo->PowerIndexOffset[p] = pRFCalibrateInfo->DeltaPowerIndex[p] - pRFCalibrateInfo->DeltaPowerIndexLast[p]; // Power Index Diff between 2 times Power Tracking -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("[Path-%d] PowerIndexOffset(%d) = DeltaPowerIndex(%d) - DeltaPowerIndexLast(%d)\n", p, pRFCalibrateInfo->PowerIndexOffset[p], pRFCalibrateInfo->DeltaPowerIndex[p], pRFCalibrateInfo->DeltaPowerIndexLast[p])); -+ -+ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->BbSwingIdxOfdmBase[p] + pRFCalibrateInfo->PowerIndexOffset[p]; -+ pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->BbSwingIdxCckBase + pRFCalibrateInfo->PowerIndexOffset[p]; -+ -+ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->CCK_index; -+ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->OFDM_index[p]; -+ -+ // *************Print BB Swing Base and Index Offset************* -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxCck, pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->PowerIndexOffset[p])); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The 'OFDM' final index(%d) = BaseIndex[%d](%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxOfdm[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p], pRFCalibrateInfo->PowerIndexOffset[p])); -+ -+ //4 7.1 Handle boundary conditions of index. -+ -+ if(pRFCalibrateInfo->OFDM_index[p] > c.SwingTableSize_OFDM-1) -+ { -+ pRFCalibrateInfo->OFDM_index[p] = c.SwingTableSize_OFDM-1; -+ } -+ else if (pRFCalibrateInfo->OFDM_index[p] <= OFDM_min_index) -+ { -+ pRFCalibrateInfo->OFDM_index[p] = OFDM_min_index; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\n\n========================================================================================================\n")); -+ if(pRFCalibrateInfo->CCK_index > c.SwingTableSize_CCK-1) -+ pRFCalibrateInfo->CCK_index = c.SwingTableSize_CCK-1; -+ else if (pRFCalibrateInfo->CCK_index <= 0) -+ pRFCalibrateInfo->CCK_index = 0; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The thermal meter is unchanged or TxPowerTracking OFF(%d): ThermalValue: %d , pRFCalibrateInfo->ThermalValue: %d\n", -+ pRFCalibrateInfo->TxPowerTrackControl, ThermalValue, pRFCalibrateInfo->ThermalValue)); -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", -+ pRFCalibrateInfo->CCK_index, pRFCalibrateInfo->BbSwingIdxCckBase)); //Print Swing base & current -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index[%d]: %d\n", -+ pRFCalibrateInfo->OFDM_index[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p])); -+ } -+ -+ if ((pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_A] != 0 || -+ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_B] != 0 || -+ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_C] != 0 || -+ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_D] != 0) && -+ pRFCalibrateInfo->TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) -+ { -+ //4 7.2 Configure the Swing Table to adjust Tx Power. -+ -+ pRFCalibrateInfo->bTxPowerChanged = TRUE; // Always TRUE after Tx Power is adjusted by power tracking. -+ // -+ // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital -+ // to increase TX power. Otherwise, EVM will be bad. -+ // -+ // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. -+ if (ThermalValue > pRFCalibrateInfo->ThermalValue) -+ { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature Increasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); -+ } -+ } -+ -+ else if (ThermalValue < pRFCalibrateInfo->ThermalValue)// Low temperature -+ { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature Decreasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); -+ } -+ } -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (ThermalValue > pHalData->EEPROMThermalMeter) -+#else -+ if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) -+#endif -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E ||pDM_Odm->SupportICType == ODM_RTL8821 || -+ pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("**********Enter POWER Tracking MIX_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("**********Enter POWER Tracking BBSWING_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || -+ pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("**********Enter POWER Tracking MIX_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("**********Enter POWER Tracking BBSWING_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); -+ } -+ -+ } -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->BbSwingIdxCck; // Record last time Power Tracking result as base. -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->BbSwingIdxOfdm[p]; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("pRFCalibrateInfo->ThermalValue = %d ThermalValue= %d\n", pRFCalibrateInfo->ThermalValue, ThermalValue)); -+ -+ pRFCalibrateInfo->ThermalValue = ThermalValue; //Record last Power Tracking Thermal Value -+ -+ } -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ if(!IS_HARDWARE_TYPE_8723B(Adapter)) -+ { -+ // Delta temperature is equal to or larger than 20 centigrade (When threshold is 8). -+ if ((delta_IQK >= c.Threshold_IQK)) { -+ if ( ! pRFCalibrateInfo->bIQKInProgress) -+ (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); -+ } -+ } -+ if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_A] != 0) { -+ if ((diff_DPK[ODM_RF_PATH_A] >= c.Threshold_DPK)) { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK)); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else if ((diff_DPK[ODM_RF_PATH_A] <= -1 * c.Threshold_DPK)) { -+ s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, value); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } -+ } -+ if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_B] != 0) { -+ if ((diff_DPK[ODM_RF_PATH_B] >= c.Threshold_DPK)) { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK)); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else if ((diff_DPK[ODM_RF_PATH_B] <= -1 * c.Threshold_DPK)) { -+ s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, value); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } -+ } -+ -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("<===ODM_TXPowerTrackingCallback_ThermalMeter\n")); -+ -+ pRFCalibrateInfo->TXPowercount = 0; -+} -+ -+ -+ -+//3============================================================ -+//3 IQ Calibration -+//3============================================================ -+ -+VOID -+ODM_ResetIQKResult( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ return; -+} -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) -+{ -+ u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = -+ {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; -+ u1Byte place = chnl; -+ -+ -+ if(chnl > 14) -+ { -+ for(place = 14; placeAdapter; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (*pDM_Odm->pIsFcsModeEnable) -+ return; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if (!IS_HARDWARE_TYPE_JAGUAR(Adapter)) -+ return; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ else if (IS_HARDWARE_TYPE_8812AU(Adapter)) -+ return; -+#endif -+#endif -+ -+#if (RTL8821A_SUPPORT == 1) -+ if (pDM_Odm->bLinked) { -+ if ((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) { -+ pDM_Odm->preChannel = *pDM_Odm->pChannel; -+ pDM_Odm->LinkedInterval = 0; -+ } -+ -+ if (pDM_Odm->LinkedInterval < 3) -+ pDM_Odm->LinkedInterval++; -+ -+ if (pDM_Odm->LinkedInterval == 2) { -+ /*Mark out IQK flow to prevent tx stuck. by Maddest 20130306*/ -+ /*Open it verified by James 20130715*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PHY_IQCalibrate_8821A(pDM_Odm, FALSE); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHY_IQCalibrate(Adapter, FALSE); -+#else -+ PHY_IQCalibrate_8821A(Adapter, FALSE); -+#endif -+ } -+ } else -+ pDM_Odm->LinkedInterval = 0; -+#endif -+} -+ -+void phydm_rf_init(IN PDM_ODM_T pDM_Odm) -+{ -+ -+ odm_TXPowerTrackingInit(pDM_Odm); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ PHY_IQCalibrate_8814A_Init(pDM_Odm); -+#endif -+#endif -+ -+} -+ -+void phydm_rf_watchdog(IN PDM_ODM_T pDM_Odm) -+{ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ ODM_TXPowerTrackingCheck(pDM_Odm); -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ odm_IQCalibrate(pDM_Odm); -+#endif +} -\ Ingen nyrad vid filslut -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/halphyrf_win.h linux/3rdparty/rtl8812au/hal/phydm/halphyrf_win.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/halphyrf_win.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/halphyrf_win.h 2017-06-07 23:07:21.015687940 +0300 -@@ -0,0 +1,108 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ #ifndef __HAL_PHY_RF_H__ -+ #define __HAL_PHY_RF_H__ -+ -+#include "phydm_kfree.h" -+#if (RTL8814A_SUPPORT == 1) -+#include "rtl8814a/phydm_iqk_8814a.h" -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+#include "rtl8822b/phydm_iqk_8822b.h" -+#endif -+#include "phydm_powertracking_win.h" -+ -+typedef enum _SPUR_CAL_METHOD { -+ PLL_RESET, -+ AFE_PHASE_SEL -+} SPUR_CAL_METHOD; -+ -+typedef enum _PWRTRACK_CONTROL_METHOD { -+ BBSWING, -+ TXAGC, -+ MIX_MODE, -+ TSSI_MODE -+} PWRTRACK_METHOD; -+ -+typedef VOID (*FuncSetPwr)(PDM_ODM_T, PWRTRACK_METHOD, u1Byte, u1Byte); -+typedef VOID(*FuncIQK)(PVOID, u1Byte, u1Byte, u1Byte); -+typedef VOID (*FuncLCK)(PDM_ODM_T); -+ //refine by YuChen for 8814A -+typedef VOID (*FuncSwing)(PDM_ODM_T, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+typedef VOID (*FuncSwing8814only)(PDM_ODM_T, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+ -+typedef struct _TXPWRTRACK_CFG { -+ u1Byte SwingTableSize_CCK; -+ u1Byte SwingTableSize_OFDM; -+ u1Byte Threshold_IQK; -+ u1Byte Threshold_DPK; -+ u1Byte AverageThermalNum; -+ u1Byte RfPathCount; -+ u4Byte ThermalRegAddr; -+ FuncSetPwr ODM_TxPwrTrackSetPwr; -+ FuncIQK DoIQK; -+ FuncLCK PHY_LCCalibrate; -+ FuncSwing GetDeltaSwingTable; -+ FuncSwing8814only GetDeltaSwingTable8814only; -+} TXPWRTRACK_CFG, *PTXPWRTRACK_CFG; -+ -+VOID -+ConfigureTxpowerTrack( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PTXPWRTRACK_CFG pConfig -+ ); -+ -+ -+VOID -+ODM_ClearTxPowerTrackingState( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER Adapter -+#endif -+ ); -+ -+ -+ -+#define ODM_TARGET_CHNL_NUM_2G_5G 59 -+ -+ -+VOID -+ODM_ResetIQKResult( -+ IN PDM_ODM_T pDM_Odm -+); -+u1Byte -+ODM_GetRightChnlPlaceforIQK( -+ IN u1Byte chnl -+); -+ -+VOID odm_IQCalibrate(IN PDM_ODM_T pDM_Odm); -+VOID phydm_rf_init( IN PDM_ODM_T pDM_Odm); -+VOID phydm_rf_watchdog( IN PDM_ODM_T pDM_Odm); -+ -+#endif // #ifndef __HAL_PHY_RF_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/mp_precomp.h linux/3rdparty/rtl8812au/hal/phydm/mp_precomp.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/mp_precomp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/mp_precomp.h 2017-06-07 23:07:21.015687940 +0300 -@@ -0,0 +1,20 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_acs.c linux/3rdparty/rtl8812au/hal/phydm/phydm_acs.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_acs.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_acs.c 2017-06-07 23:07:21.016688031 +0300 -@@ -0,0 +1,1306 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+ -+u1Byte -+ODM_GetAutoChannelSelectResult( -+ IN PVOID pDM_VOID, -+ IN u1Byte Band -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(Band == ODM_BAND_2_4G) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("[ACS] ODM_GetAutoChannelSelectResult(): CleanChannel_2G(%d)\n", pACS->CleanChannel_2G)); -+ return (u1Byte)pACS->CleanChannel_2G; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("[ACS] ODM_GetAutoChannelSelectResult(): CleanChannel_5G(%d)\n", pACS->CleanChannel_5G)); -+ return (u1Byte)pACS->CleanChannel_5G; -+ } -+#else -+ return (u1Byte)pACS->CleanChannel_2G; -+#endif -+ -+} -+ -+VOID -+odm_AutoChannelSelectSetting( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN IsEnable -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte period = 0x2710;// 40ms in default -+ u2Byte NHMType = 0x7; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectSetting()=========> \n")); -+ -+ if(IsEnable) -+ {//20 ms -+ period = 0x1388; -+ NHMType = 0x1; -+ } -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ { -+ //PHY parameters initialize for ac series -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TIMER_11AC+2, period); //0x990[31:16]=0x2710 Time duration for NHM unit: 4us, 0x2710=40ms -+ //ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT8|BIT9|BIT10, NHMType); //0x994[9:8]=3 enable CCX -+ } -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ //PHY parameters initialize for n series -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TIMER_11N+2, period); //0x894[31:16]=0x2710 Time duration for NHM unit: 4us, 0x2710=40ms -+ //ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10|BIT9|BIT8, NHMType); //0x890[9:8]=3 enable CCX -+ } -+#endif -+} -+ -+VOID -+odm_AutoChannelSelectInit( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ u1Byte i; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) -+ return; -+ -+ if(pACS->bForceACSResult) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectInit()=========> \n")); -+ -+ pACS->CleanChannel_2G = 1; -+ pACS->CleanChannel_5G = 36; -+ -+ for (i = 0; i < ODM_MAX_CHANNEL_2G; ++i) -+ { -+ pACS->Channel_Info_2G[0][i] = 0; -+ pACS->Channel_Info_2G[1][i] = 0; -+ } -+ -+ if(pDM_Odm->SupportICType & (ODM_IC_11AC_SERIES|ODM_RTL8192D)) -+ { -+ for (i = 0; i < ODM_MAX_CHANNEL_5G; ++i) -+ { -+ pACS->Channel_Info_5G[0][i] = 0; -+ pACS->Channel_Info_5G[1][i] = 0; -+ } -+ } -+#endif -+} -+ -+VOID -+odm_AutoChannelSelectReset( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) -+ return; -+ -+ if(pACS->bForceACSResult) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectReset()=========> \n")); -+ -+ odm_AutoChannelSelectSetting(pDM_Odm,TRUE);// for 20ms measurement -+ Phydm_NHMCounterStatisticsReset(pDM_Odm); -+#endif -+} -+ -+VOID -+odm_AutoChannelSelect( -+ IN PVOID pDM_VOID, -+ IN u1Byte Channel -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ u1Byte ChannelIDX = 0, SearchIDX = 0; -+ u2Byte MaxScore=0; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Return: SupportAbility ODM_BB_NHM_CNT is disabled\n")); -+ return; -+ } -+ -+ if(pACS->bForceACSResult) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Force 2G clean channel = %d, 5G clean channel = %d\n", -+ pACS->CleanChannel_2G, pACS->CleanChannel_5G)); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Channel = %d=========> \n", Channel)); -+ -+ Phydm_GetNHMCounterStatistics(pDM_Odm); -+ odm_AutoChannelSelectSetting(pDM_Odm,FALSE); -+ -+ if(Channel >=1 && Channel <=14) -+ { -+ ChannelIDX = Channel - 1; -+ pACS->Channel_Info_2G[1][ChannelIDX]++; -+ -+ if(pACS->Channel_Info_2G[1][ChannelIDX] >= 2) -+ pACS->Channel_Info_2G[0][ChannelIDX] = (pACS->Channel_Info_2G[0][ChannelIDX] >> 1) + -+ (pACS->Channel_Info_2G[0][ChannelIDX] >> 2) + (pDM_Odm->NHM_cnt_0>>2); -+ else -+ pACS->Channel_Info_2G[0][ChannelIDX] = pDM_Odm->NHM_cnt_0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): NHM_cnt_0 = %d \n", pDM_Odm->NHM_cnt_0)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Channel_Info[0][%d] = %d, Channel_Info[1][%d] = %d\n", ChannelIDX, pACS->Channel_Info_2G[0][ChannelIDX], ChannelIDX, pACS->Channel_Info_2G[1][ChannelIDX])); -+ -+ for(SearchIDX = 0; SearchIDX < ODM_MAX_CHANNEL_2G; SearchIDX++) -+ { -+ if(pACS->Channel_Info_2G[1][SearchIDX] != 0) -+ { -+ if(pACS->Channel_Info_2G[0][SearchIDX] >= MaxScore) -+ { -+ MaxScore = pACS->Channel_Info_2G[0][SearchIDX]; -+ pACS->CleanChannel_2G = SearchIDX+1; -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("(1)odm_AutoChannelSelect(): 2G: CleanChannel_2G = %d, MaxScore = %d \n", -+ pACS->CleanChannel_2G, MaxScore)); -+ -+ } -+ else if(Channel >= 36) -+ { -+ // Need to do -+ pACS->CleanChannel_5G = Channel; -+ } -+#endif -+} -+ -+#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) -+ -+VOID -+phydm_AutoChannelSelectSettingAP( -+ IN PVOID pDM_VOID, -+ IN u4Byte setting, // 0: STORE_DEFAULT_NHM_SETTING; 1: RESTORE_DEFAULT_NHM_SETTING, 2: ACS_NHM_SETTING -+ IN u4Byte acs_step -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectSettingAP()=========> \n")); -+ -+ //3 Store Default Setting -+ if(setting == STORE_DEFAULT_NHM_SETTING) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("STORE_DEFAULT_NHM_SETTING\n")); -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) // store Reg0x990, Reg0x994, Reg0x998, Reg0x99C, Reg0x9a0 -+ { -+ pACS->Reg0x990 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TIMER_11AC); // Reg0x990 -+ pACS->Reg0x994 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC); // Reg0x994 -+ pACS->Reg0x998 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC); // Reg0x998 -+ pACS->Reg0x99C = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC); // Reg0x99c -+ pACS->Reg0x9A0 = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_TH8_11AC); // Reg0x9a0, u1Byte -+ } -+ else if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ pACS->Reg0x890 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N); // Reg0x890 -+ pACS->Reg0x894 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TIMER_11N); // Reg0x894 -+ pACS->Reg0x898 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N); // Reg0x898 -+ pACS->Reg0x89C = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N); // Reg0x89c -+ pACS->Reg0xE28 = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_TH8_11N); // Reg0xe28, u1Byte -+ } -+ } -+ -+ //3 Restore Default Setting -+ else if(setting == RESTORE_DEFAULT_NHM_SETTING) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("RESTORE_DEFAULT_NHM_SETTING\n")); -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) // store Reg0x990, Reg0x994, Reg0x998, Reg0x99C, Reg0x9a0 -+ { -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TIMER_11AC, pACS->Reg0x990); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, pACS->Reg0x994); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, pACS->Reg0x998); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, pACS->Reg0x99C); -+ ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11AC, pACS->Reg0x9A0); -+ } -+ else if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, pACS->Reg0x890); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TIMER_11N, pACS->Reg0x894); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, pACS->Reg0x898); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, pACS->Reg0x89C); -+ ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11N, pACS->Reg0xE28); -+ } -+ } -+ -+ //3 ACS Setting -+ else if(setting == ACS_NHM_SETTING) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("ACS_NHM_SETTING\n")); -+ u2Byte period; -+ period = 0x61a8; -+ pACS->ACS_Step = acs_step; -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ { -+ //4 Set NHM period, 0x990[31:16]=0x61a8, Time duration for NHM unit: 4us, 0x61a8=100ms -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TIMER_11AC+2, period); -+ //4 Set NHM ignore_cca=1, ignore_txon=1, ccx_en=0 -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC,BIT8|BIT9|BIT10, 3); -+ -+ if(pACS->ACS_Step == 0) -+ { -+ //4 Set IGI -+ ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); -+ if (get_rf_mimo_mode(priv) != MIMO_1T1R) -+ ODM_SetBBReg(pDM_Odm,0xe50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); -+ -+ //4 Set ACS NHM threshold -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0x82786e64); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffff8c); -+ ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11AC, 0xff); -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC+2, 0xffff); -+ -+ } -+ else if(pACS->ACS_Step == 1) -+ { -+ //4 Set IGI -+ ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); -+ if (get_rf_mimo_mode(priv) != MIMO_1T1R) -+ ODM_SetBBReg(pDM_Odm,0xe50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); -+ -+ //4 Set ACS NHM threshold -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0x5a50463c); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffff64); -+ -+ } -+ -+ } -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ //4 Set NHM period, 0x894[31:16]=0x61a8, Time duration for NHM unit: 4us, 0x61a8=100ms -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TIMER_11N+2, period); -+ //4 Set NHM ignore_cca=1, ignore_txon=1, ccx_en=0 -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N,BIT8|BIT9|BIT10, 3); -+ -+ if(pACS->ACS_Step == 0) -+ { -+ //4 Set IGI -+ ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); -+ if (get_rf_mimo_mode(priv) != MIMO_1T1R) -+ ODM_SetBBReg(pDM_Odm,0xc58,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); -+ -+ //4 Set ACS NHM threshold -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0x82786e64); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffff8c); -+ ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11N, 0xff); -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N+2, 0xffff); -+ -+ } -+ else if(pACS->ACS_Step == 1) -+ { -+ //4 Set IGI -+ ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); -+ if (get_rf_mimo_mode(priv) != MIMO_1T1R) -+ ODM_SetBBReg(pDM_Odm,0xc58,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); -+ -+ //4 Set ACS NHM threshold -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0x5a50463c); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffff64); -+ -+ } -+ } -+ } -+ -+} -+ -+VOID -+phydm_GetNHMStatisticsAP( -+ IN PVOID pDM_VOID, -+ IN u4Byte idx, // @ 2G, Real channel number = idx+1 -+ IN u4Byte acs_step -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ u4Byte value32 = 0; -+ u1Byte i; -+ -+ pACS->ACS_Step = acs_step; -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ //4 Check if NHM result is ready -+ for (i=0; i<20; i++) { -+ -+ ODM_delay_ms(1); -+ if ( ODM_GetBBReg(pDM_Odm,rFPGA0_PSDReport,BIT17) ) -+ break; -+ } -+ -+ //4 Get NHM Statistics -+ if ( pACS->ACS_Step==1 ) { -+ -+ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT7_TO_CNT4_11N); -+ -+ pACS->NHM_Cnt[idx][9] = (value32 & bMaskByte1) >> 8; -+ pACS->NHM_Cnt[idx][8] = (value32 & bMaskByte0); -+ -+ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11N); // ODM_REG_NHM_CNT3_TO_CNT0_11N -+ -+ pACS->NHM_Cnt[idx][7] = (value32 & bMaskByte3) >> 24; -+ pACS->NHM_Cnt[idx][6] = (value32 & bMaskByte2) >> 16; -+ pACS->NHM_Cnt[idx][5] = (value32 & bMaskByte1) >> 8; -+ -+ } else if (pACS->ACS_Step==2) { -+ -+ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11N); // ODM_REG_NHM_CNT3_TO_CNT0_11N -+ -+ pACS->NHM_Cnt[idx][4] = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11N); -+ pACS->NHM_Cnt[idx][3] = (value32 & bMaskByte3) >> 24; -+ pACS->NHM_Cnt[idx][2] = (value32 & bMaskByte2) >> 16; -+ pACS->NHM_Cnt[idx][1] = (value32 & bMaskByte1) >> 8; -+ pACS->NHM_Cnt[idx][0] = (value32 & bMaskByte0); -+ } -+ } -+ else if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ { -+ //4 Check if NHM result is ready -+ for (i=0; i<20; i++) { -+ -+ ODM_delay_ms(1); -+ if (ODM_GetBBReg(pDM_Odm,ODM_REG_NHM_DUR_READY_11AC,BIT17)) -+ break; -+ } -+ -+ if ( pACS->ACS_Step==1 ) { -+ -+ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT7_TO_CNT4_11AC); -+ -+ pACS->NHM_Cnt[idx][9] = (value32 & bMaskByte1) >> 8; -+ pACS->NHM_Cnt[idx][8] = (value32 & bMaskByte0); -+ -+ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11AC); // ODM_REG_NHM_CNT3_TO_CNT0_11AC -+ -+ pACS->NHM_Cnt[idx][7] = (value32 & bMaskByte3) >> 24; -+ pACS->NHM_Cnt[idx][6] = (value32 & bMaskByte2) >> 16; -+ pACS->NHM_Cnt[idx][5] = (value32 & bMaskByte1) >> 8; -+ -+ } else if (pACS->ACS_Step==2) { -+ -+ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11AC); // ODM_REG_NHM_CNT3_TO_CNT0_11AC -+ -+ pACS->NHM_Cnt[idx][4] = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11AC); -+ pACS->NHM_Cnt[idx][3] = (value32 & bMaskByte3) >> 24; -+ pACS->NHM_Cnt[idx][2] = (value32 & bMaskByte2) >> 16; -+ pACS->NHM_Cnt[idx][1] = (value32 & bMaskByte1) >> 8; -+ pACS->NHM_Cnt[idx][0] = (value32 & bMaskByte0); -+ } -+ } -+ -+} -+ -+ -+//#define ACS_DEBUG_INFO //acs debug default off -+/* -+int phydm_AutoChannelSelectAP( -+ IN PVOID pDM_VOID, -+ IN u4Byte ACS_Type, // 0: RXCount_Type, 1:NHM_Type -+ IN u4Byte available_chnl_num // amount of all channels -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ static u4Byte score2G[MAX_2G_CHANNEL_NUM], score5G[MAX_5G_CHANNEL_NUM]; -+ u4Byte score[MAX_BSS_NUM], use_nhm = 0; -+ u4Byte minScore=0xffffffff; -+ u4Byte tmpScore, tmpIdx=0; -+ u4Byte traffic_check = 0; -+ u4Byte fa_count_weighting = 1; -+ int i, j, idx=0, idx_2G_end=-1, idx_5G_begin=-1, minChan=0; -+ struct bss_desc *pBss=NULL; -+ -+#ifdef _DEBUG_RTL8192CD_ -+ char tmpbuf[400]; -+ int len=0; -+#endif -+ -+ memset(score2G, '\0', sizeof(score2G)); -+ memset(score5G, '\0', sizeof(score5G)); -+ -+ for (i=0; iavailable_chnl_num; i++) { -+ if (priv->available_chnl[i] <= 14) -+ idx_2G_end = i; -+ else -+ break; -+ } -+ -+ for (i=0; iavailable_chnl_num; i++) { -+ if (priv->available_chnl[i] > 14) { -+ idx_5G_begin = i; -+ break; -+ } -+ } -+ -+// DELETE -+#ifndef CONFIG_RTL_NEW_AUTOCH -+ for (i=0; isite_survey->count; i++) { -+ pBss = &priv->site_survey->bss[i]; -+ for (idx=0; idxavailable_chnl_num; idx++) { -+ if (pBss->channel == priv->available_chnl[idx]) { -+ if (pBss->channel <= 14) -+ setChannelScore(idx, score2G, 0, MAX_2G_CHANNEL_NUM-1); -+ else -+ score5G[idx - idx_5G_begin] += 5; -+ break; -+ } -+ } -+ } -+#endif -+ -+ if (idx_2G_end >= 0) -+ for (i=0; i<=idx_2G_end; i++) -+ score[i] = score2G[i]; -+ if (idx_5G_begin >= 0) -+ for (i=idx_5G_begin; iavailable_chnl_num; i++) -+ score[i] = score5G[i - idx_5G_begin]; -+ -+#ifdef CONFIG_RTL_NEW_AUTOCH -+ { -+ u4Byte y, ch_begin=0, ch_end= priv->available_chnl_num; -+ -+ u4Byte do_ap_check = 1, ap_ratio = 0; -+ -+ if (idx_2G_end >= 0) -+ ch_end = idx_2G_end+1; -+ if (idx_5G_begin >= 0) -+ ch_begin = idx_5G_begin; -+ -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("\n"); -+ for (y=ch_begin; yavailable_chnl[y], -+ priv->chnl_ss_mac_rx_count[y], -+ priv->chnl_ss_mac_rx_count_40M[y], -+ priv->chnl_ss_fa_count[y], -+ score[y]); -+ printk("\n"); -+#endif -+ -+#if defined(CONFIG_RTL_88E_SUPPORT) || defined(CONFIG_WLAN_HAL_8192EE) -+ if( pDM_Odm->SupportICType&(ODM_RTL8188E|ODM_RTL8192E)&& priv->pmib->dot11RFEntry.acs_type ) -+ { -+ u4Byte tmp_score[MAX_BSS_NUM]; -+ memcpy(tmp_score, score, sizeof(score)); -+ if (find_clean_channel(priv, ch_begin, ch_end, tmp_score)) { -+ //memcpy(score, tmp_score, sizeof(score)); -+#ifdef _DEBUG_RTL8192CD_ -+ printk("!! Found clean channel, select minimum FA channel\n"); -+#endif -+ goto USE_CLN_CH; -+ } -+#ifdef _DEBUG_RTL8192CD_ -+ printk("!! Not found clean channel, use NHM algorithm\n"); -+#endif -+ use_nhm = 1; -+USE_CLN_CH: -+ for (y=ch_begin; ynhm_cnt[y][i]; -+ for (j=0; jL, score: %d\n", -+ y+1, priv->nhm_cnt[y][9], priv->nhm_cnt[y][8], priv->nhm_cnt[y][7], -+ priv->nhm_cnt[y][6], priv->nhm_cnt[y][5], priv->nhm_cnt[y][4], -+ priv->nhm_cnt[y][3], priv->nhm_cnt[y][2], priv->nhm_cnt[y][1], -+ priv->nhm_cnt[y][0], score[y]); -+#endif -+ } -+ -+ if (!use_nhm) -+ memcpy(score, tmp_score, sizeof(score)); -+ -+ goto choose_ch; -+ } -+#endif -+ -+ // For each channel, weighting behind channels with MAC RX counter -+ //For each channel, weighting the channel with FA counter -+ -+ for (y=ch_begin; ychnl_ss_mac_rx_count[y]; -+ if (priv->chnl_ss_mac_rx_count[y] > 30) -+ do_ap_check = 0; -+ if( priv->chnl_ss_mac_rx_count[y] > MAC_RX_COUNT_THRESHOLD ) -+ traffic_check = 1; -+ -+#ifdef RTK_5G_SUPPORT -+ if (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G) -+#endif -+ { -+ if ((int)(y-4) >= (int)ch_begin) -+ score[y-4] += 2 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y-3) >= (int)ch_begin) -+ score[y-3] += 8 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y-2) >= (int)ch_begin) -+ score[y-2] += 8 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y-1) >= (int)ch_begin) -+ score[y-1] += 10 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y+1) < (int)ch_end) -+ score[y+1] += 10 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y+2) < (int)ch_end) -+ score[y+2] += 8 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y+3) < (int)ch_end) -+ score[y+3] += 8 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y+4) < (int)ch_end) -+ score[y+4] += 2 * priv->chnl_ss_mac_rx_count[y]; -+ } -+ -+ //this is for CH_LOAD caculation -+ if( priv->chnl_ss_cca_count[y] > priv->chnl_ss_fa_count[y]) -+ priv->chnl_ss_cca_count[y]-= priv->chnl_ss_fa_count[y]; -+ else -+ priv->chnl_ss_cca_count[y] = 0; -+ } -+ -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("\n"); -+ for (y=ch_begin; yavailable_chnl[y], score[y]); -+ printk("\n"); -+#endif -+ -+ for (y=ch_begin; ychnl_ss_mac_rx_count_40M[y]) { -+ score[y] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if (priv->chnl_ss_mac_rx_count_40M[y] > 30) -+ do_ap_check = 0; -+ if( priv->chnl_ss_mac_rx_count_40M[y] > MAC_RX_COUNT_THRESHOLD ) -+ traffic_check = 1; -+ -+#ifdef RTK_5G_SUPPORT -+ if (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G) -+#endif -+ { -+ if ((int)(y-6) >= (int)ch_begin) -+ score[y-6] += 1 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y-5) >= (int)ch_begin) -+ score[y-5] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y-4) >= (int)ch_begin) -+ score[y-4] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y-3) >= (int)ch_begin) -+ score[y-3] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y-2) >= (int)ch_begin) -+ score[y-2] += (5 * priv->chnl_ss_mac_rx_count_40M[y])/2; -+ if ((int)(y-1) >= (int)ch_begin) -+ score[y-1] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y+1) < (int)ch_end) -+ score[y+1] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y+2) < (int)ch_end) -+ score[y+2] += (5 * priv->chnl_ss_mac_rx_count_40M[y])/2; -+ if ((int)(y+3) < (int)ch_end) -+ score[y+3] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y+4) < (int)ch_end) -+ score[y+4] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y+5) < (int)ch_end) -+ score[y+5] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y+6) < (int)ch_end) -+ score[y+6] += 1 * priv->chnl_ss_mac_rx_count_40M[y]; -+ } -+ } -+ } -+ -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("\n"); -+ for (y=ch_begin; yavailable_chnl[y], score[y]); -+ printk("\n"); -+ printk("4. do_ap_check=%d traffic_check=%d\n", do_ap_check, traffic_check); -+ printk("\n"); -+#endif -+ -+ if( traffic_check == 0) -+ fa_count_weighting = 5; -+ else -+ fa_count_weighting = 1; -+ -+ for (y=ch_begin; ychnl_ss_fa_count[y]; -+ } -+ -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("\n"); -+ for (y=ch_begin; yavailable_chnl[y], score[y]); -+ printk("\n"); -+#endif -+ -+ if (do_ap_check) { -+ for (i=0; isite_survey->count; i++) { -+ pBss = &priv->site_survey->bss[i]; -+ for (y=ch_begin; ychannel == priv->available_chnl[y]) { -+ if (pBss->channel <= 14) { -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("\n"); -+ printk("chnl[%d] has ap rssi=%d bw[0x%02x]\n", -+ pBss->channel, pBss->rssi, pBss->t_stamp[1]); -+ printk("\n"); -+#endif -+ if (pBss->rssi > 60) -+ ap_ratio = 4; -+ else if (pBss->rssi > 35) -+ ap_ratio = 2; -+ else -+ ap_ratio = 1; -+ -+ if ((pBss->t_stamp[1] & 0x6) == 0) { -+ score[y] += 50 * ap_ratio; -+ if ((int)(y-4) >= (int)ch_begin) -+ score[y-4] += 10 * ap_ratio; -+ if ((int)(y-3) >= (int)ch_begin) -+ score[y-3] += 20 * ap_ratio; -+ if ((int)(y-2) >= (int)ch_begin) -+ score[y-2] += 30 * ap_ratio; -+ if ((int)(y-1) >= (int)ch_begin) -+ score[y-1] += 40 * ap_ratio; -+ if ((int)(y+1) < (int)ch_end) -+ score[y+1] += 40 * ap_ratio; -+ if ((int)(y+2) < (int)ch_end) -+ score[y+2] += 30 * ap_ratio; -+ if ((int)(y+3) < (int)ch_end) -+ score[y+3] += 20 * ap_ratio; -+ if ((int)(y+4) < (int)ch_end) -+ score[y+4] += 10 * ap_ratio; -+ } -+ else if ((pBss->t_stamp[1] & 0x4) == 0) { -+ score[y] += 50 * ap_ratio; -+ if ((int)(y-3) >= (int)ch_begin) -+ score[y-3] += 20 * ap_ratio; -+ if ((int)(y-2) >= (int)ch_begin) -+ score[y-2] += 30 * ap_ratio; -+ if ((int)(y-1) >= (int)ch_begin) -+ score[y-1] += 40 * ap_ratio; -+ if ((int)(y+1) < (int)ch_end) -+ score[y+1] += 50 * ap_ratio; -+ if ((int)(y+2) < (int)ch_end) -+ score[y+2] += 50 * ap_ratio; -+ if ((int)(y+3) < (int)ch_end) -+ score[y+3] += 50 * ap_ratio; -+ if ((int)(y+4) < (int)ch_end) -+ score[y+4] += 50 * ap_ratio; -+ if ((int)(y+5) < (int)ch_end) -+ score[y+5] += 40 * ap_ratio; -+ if ((int)(y+6) < (int)ch_end) -+ score[y+6] += 30 * ap_ratio; -+ if ((int)(y+7) < (int)ch_end) -+ score[y+7] += 20 * ap_ratio; -+ } -+ else { -+ score[y] += 50 * ap_ratio; -+ if ((int)(y-7) >= (int)ch_begin) -+ score[y-7] += 20 * ap_ratio; -+ if ((int)(y-6) >= (int)ch_begin) -+ score[y-6] += 30 * ap_ratio; -+ if ((int)(y-5) >= (int)ch_begin) -+ score[y-5] += 40 * ap_ratio; -+ if ((int)(y-4) >= (int)ch_begin) -+ score[y-4] += 50 * ap_ratio; -+ if ((int)(y-3) >= (int)ch_begin) -+ score[y-3] += 50 * ap_ratio; -+ if ((int)(y-2) >= (int)ch_begin) -+ score[y-2] += 50 * ap_ratio; -+ if ((int)(y-1) >= (int)ch_begin) -+ score[y-1] += 50 * ap_ratio; -+ if ((int)(y+1) < (int)ch_end) -+ score[y+1] += 40 * ap_ratio; -+ if ((int)(y+2) < (int)ch_end) -+ score[y+2] += 30 * ap_ratio; -+ if ((int)(y+3) < (int)ch_end) -+ score[y+3] += 20 * ap_ratio; -+ } -+ } -+ else { -+ if ((pBss->t_stamp[1] & 0x6) == 0) { -+ score[y] += 500; -+ } -+ else if ((pBss->t_stamp[1] & 0x4) == 0) { -+ score[y] += 500; -+ if ((int)(y+1) < (int)ch_end) -+ score[y+1] += 500; -+ } -+ else { -+ score[y] += 500; -+ if ((int)(y-1) >= (int)ch_begin) -+ score[y-1] += 500; -+ } -+ } -+ break; -+ } -+ } -+ } -+ } -+ -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("\n"); -+ for (y=ch_begin; yavailable_chnl[y],score[y]); -+ printk("\n"); -+#endif -+ -+#ifdef SS_CH_LOAD_PROC -+ -+ // caculate noise level -- suggested by wilson -+ for (y=ch_begin; ychnl_ss_fa_count[y]>1000) { -+ fa_lv = 100; -+ } else if (priv->chnl_ss_fa_count[y]>500) { -+ fa_lv = 34 * (priv->chnl_ss_fa_count[y]-500) / 500 + 66; -+ } else if (priv->chnl_ss_fa_count[y]>200) { -+ fa_lv = 33 * (priv->chnl_ss_fa_count[y] - 200) / 300 + 33; -+ } else if (priv->chnl_ss_fa_count[y]>100) { -+ fa_lv = 18 * (priv->chnl_ss_fa_count[y] - 100) / 100 + 15; -+ } else { -+ fa_lv = 15 * priv->chnl_ss_fa_count[y] / 100; -+ } -+ if (priv->chnl_ss_cca_count[y]>400) { -+ cca_lv = 100; -+ } else if (priv->chnl_ss_cca_count[y]>200) { -+ cca_lv = 34 * (priv->chnl_ss_cca_count[y] - 200) / 200 + 66; -+ } else if (priv->chnl_ss_cca_count[y]>80) { -+ cca_lv = 33 * (priv->chnl_ss_cca_count[y] - 80) / 120 + 33; -+ } else if (priv->chnl_ss_cca_count[y]>40) { -+ cca_lv = 18 * (priv->chnl_ss_cca_count[y] - 40) / 40 + 15; -+ } else { -+ cca_lv = 15 * priv->chnl_ss_cca_count[y] / 40; -+ } -+ -+ priv->chnl_ss_load[y] = (((fa_lv > cca_lv)? fa_lv : cca_lv)*75+((score[y]>100)?100:score[y])*25)/100; -+ -+ DEBUG_INFO("ch:%d f=%d (%d), c=%d (%d), fl=%d, cl=%d, sc=%d, cu=%d\n", -+ priv->available_chnl[y], -+ priv->chnl_ss_fa_count[y], fa_thd, -+ priv->chnl_ss_cca_count[y], cca_thd, -+ fa_lv, -+ cca_lv, -+ score[y], -+ priv->chnl_ss_load[y]); -+ -+ } -+#endif -+ } -+#endif -+ -+choose_ch: -+ -+#ifdef DFS -+ // heavy weighted DFS channel -+ if (idx_5G_begin >= 0){ -+ for (i=idx_5G_begin; iavailable_chnl_num; i++) { -+ if (!priv->pmib->dot11DFSEntry.disable_DFS && is_DFS_channel(priv->available_chnl[i]) -+ && (score[i]!= 0xffffffff)){ -+ score[i] += 1600; -+ } -+ } -+ } -+#endif -+ -+ -+//prevent Auto Channel selecting wrong channel in 40M mode----------------- -+ if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) -+ && priv->pshare->is_40m_bw) { -+#if 0 -+ if (GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset == 1) { -+ //Upper Primary Channel, cannot select the two lowest channels -+ if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) { -+ score[0] = 0xffffffff; -+ score[1] = 0xffffffff; -+ score[2] = 0xffffffff; -+ score[3] = 0xffffffff; -+ score[4] = 0xffffffff; -+ -+ score[13] = 0xffffffff; -+ score[12] = 0xffffffff; -+ score[11] = 0xffffffff; -+ } -+ -+// if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11A) { -+// score[idx_5G_begin] = 0xffffffff; -+// score[idx_5G_begin + 1] = 0xffffffff; -+// } -+ } -+ else if (GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset == 2) { -+ //Lower Primary Channel, cannot select the two highest channels -+ if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) { -+ score[0] = 0xffffffff; -+ score[1] = 0xffffffff; -+ score[2] = 0xffffffff; -+ -+ score[13] = 0xffffffff; -+ score[12] = 0xffffffff; -+ score[11] = 0xffffffff; -+ score[10] = 0xffffffff; -+ score[9] = 0xffffffff; -+ } -+ -+// if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11A) { -+// score[priv->available_chnl_num - 2] = 0xffffffff; -+// score[priv->available_chnl_num - 1] = 0xffffffff; -+// } -+ } -+#endif -+ for (i=0; i<=idx_2G_end; ++i) -+ if (priv->available_chnl[i] == 14) -+ score[i] = 0xffffffff; // mask chan14 -+ -+#ifdef RTK_5G_SUPPORT -+ if (idx_5G_begin >= 0) { -+ for (i=idx_5G_begin; iavailable_chnl_num; i++) { -+ int ch = priv->available_chnl[i]; -+ if(priv->available_chnl[i] > 144) -+ --ch; -+ if((ch%4) || ch==140 || ch == 164 ) //mask ch 140, ch 165, ch 184... -+ score[i] = 0xffffffff; -+ } -+ } -+#endif -+ -+ -+ } -+ -+ if (priv->pmib->dot11RFEntry.disable_ch1213) { -+ for (i=0; i<=idx_2G_end; ++i) { -+ int ch = priv->available_chnl[i]; -+ if ((ch == 12) || (ch == 13)) -+ score[i] = 0xffffffff; -+ } -+ } -+ -+ if (((priv->pmib->dot11StationConfigEntry.dot11RegDomain == DOMAIN_GLOBAL) || -+ (priv->pmib->dot11StationConfigEntry.dot11RegDomain == DOMAIN_WORLD_WIDE)) && -+ (idx_2G_end >= 11) && (idx_2G_end < 14)) { -+ score[13] = 0xffffffff; // mask chan14 -+ score[12] = 0xffffffff; // mask chan13 -+ score[11] = 0xffffffff; // mask chan12 -+ } -+ -+//------------------------------------------------------------------ -+ -+#ifdef _DEBUG_RTL8192CD_ -+ for (i=0; iavailable_chnl_num; i++) { -+ len += sprintf(tmpbuf+len, "ch%d:%u ", priv->available_chnl[i], score[i]); -+ } -+ strcat(tmpbuf, "\n"); -+ panic_printk("%s", tmpbuf); -+ -+#endif -+ -+ if ( (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) -+ && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_80)) -+ { -+ for (i=0; iavailable_chnl_num; i++) { -+ if (is80MChannel(priv->available_chnl, priv->available_chnl_num, priv->available_chnl[i])) { -+ tmpScore = 0; -+ for (j=0; j<4; j++) { -+ if ((tmpScore != 0xffffffff) && (score[i+j] != 0xffffffff)) -+ tmpScore += score[i+j]; -+ else -+ tmpScore = 0xffffffff; -+ } -+ tmpScore = tmpScore / 4; -+ if (minScore > tmpScore) { -+ minScore = tmpScore; -+ -+ tmpScore = 0xffffffff; -+ for (j=0; j<4; j++) { -+ if (score[i+j] < tmpScore) { -+ tmpScore = score[i+j]; -+ tmpIdx = i+j; -+ } -+ } -+ -+ idx = tmpIdx; -+ } -+ i += 3; -+ } -+ } -+ if (minScore == 0xffffffff) { -+ // there is no 80M channels -+ priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20; -+ for (i=0; iavailable_chnl_num; i++) { -+ if (score[i] < minScore) { -+ minScore = score[i]; -+ idx = i; -+ } -+ } -+ } -+ } -+ else if( (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) -+ && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_40)) -+ { -+ for (i=0; iavailable_chnl_num; i++) { -+ if(is40MChannel(priv->available_chnl,priv->available_chnl_num,priv->available_chnl[i])) { -+ tmpScore = 0; -+ for(j=0;j<2;j++) { -+ if ((tmpScore != 0xffffffff) && (score[i+j] != 0xffffffff)) -+ tmpScore += score[i+j]; -+ else -+ tmpScore = 0xffffffff; -+ } -+ tmpScore = tmpScore / 2; -+ if(minScore > tmpScore) { -+ minScore = tmpScore; -+ -+ tmpScore = 0xffffffff; -+ for (j=0; j<2; j++) { -+ if (score[i+j] < tmpScore) { -+ tmpScore = score[i+j]; -+ tmpIdx = i+j; -+ } -+ } -+ -+ idx = tmpIdx; -+ } -+ i += 1; -+ } -+ } -+ if (minScore == 0xffffffff) { -+ // there is no 40M channels -+ priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20; -+ for (i=0; iavailable_chnl_num; i++) { -+ if (score[i] < minScore) { -+ minScore = score[i]; -+ idx = i; -+ } -+ } -+ } -+ } -+ else if( (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G) -+ && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_40) -+ && (priv->available_chnl_num >= 8) ) -+ { -+ u4Byte groupScore[14]; -+ -+ memset(groupScore, 0xff , sizeof(groupScore)); -+ for (i=0; iavailable_chnl_num-4; i++) { -+ if (score[i] != 0xffffffff && score[i+4] != 0xffffffff) { -+ groupScore[i] = score[i] + score[i+4]; -+ DEBUG_INFO("groupScore, ch %d,%d: %d\n", i+1, i+5, groupScore[i]); -+ if (groupScore[i] < minScore) { -+#ifdef AUTOCH_SS_SPEEDUP -+ if(priv->pmib->miscEntry.autoch_1611_enable) -+ { -+ if(priv->available_chnl[i]==1 || priv->available_chnl[i]==6 || priv->available_chnl[i]==11) -+ { -+ minScore = groupScore[i]; -+ idx = i; -+ } -+ } -+ else -+#endif -+ { -+ minScore = groupScore[i]; -+ idx = i; -+ } -+ } -+ } -+ } -+ -+ if (score[idx] < score[idx+4]) { -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; -+ } else { -+ idx = idx + 4; -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; -+ } -+ } -+ else -+ { -+ for (i=0; iavailable_chnl_num; i++) { -+ if (score[i] < minScore) { -+#ifdef AUTOCH_SS_SPEEDUP -+ if(priv->pmib->miscEntry.autoch_1611_enable) -+ { -+ if(priv->available_chnl[i]==1 || priv->available_chnl[i]==6 || priv->available_chnl[i]==11) -+ { -+ minScore = score[i]; -+ idx = i; -+ } -+ } -+ else -+#endif -+ { -+ minScore = score[i]; -+ idx = i; -+ } -+ } -+ } -+ } -+ -+ if (IS_A_CUT_8881A(priv) && -+ (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_80)) { -+ if ((priv->available_chnl[idx] == 36) || -+ (priv->available_chnl[idx] == 52) || -+ (priv->available_chnl[idx] == 100) || -+ (priv->available_chnl[idx] == 116) || -+ (priv->available_chnl[idx] == 132) || -+ (priv->available_chnl[idx] == 149) || -+ (priv->available_chnl[idx] == 165)) -+ idx++; -+ else if ((priv->available_chnl[idx] == 48) || -+ (priv->available_chnl[idx] == 64) || -+ (priv->available_chnl[idx] == 112) || -+ (priv->available_chnl[idx] == 128) || -+ (priv->available_chnl[idx] == 144) || -+ (priv->available_chnl[idx] == 161) || -+ (priv->available_chnl[idx] == 177)) -+ idx--; -+ } -+ -+ minChan = priv->available_chnl[idx]; -+ -+ // skip channel 14 if don't support ofdm -+ if ((priv->pmib->dot11RFEntry.disable_ch14_ofdm) && -+ (minChan == 14)) { -+ score[idx] = 0xffffffff; -+ -+ minScore = 0xffffffff; -+ for (i=0; iavailable_chnl_num; i++) { -+ if (score[i] < minScore) { -+ minScore = score[i]; -+ idx = i; -+ } -+ } -+ minChan = priv->available_chnl[idx]; -+ } -+ -+#if 0 -+ //Check if selected channel available for 80M/40M BW or NOT ? -+ if(priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) -+ { -+ if(priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_80) -+ { -+ if(!is80MChannel(priv->available_chnl,priv->available_chnl_num,minChan)) -+ { -+ //printk("BW=80M, selected channel = %d is unavaliable! reduce to 40M\n", minChan); -+ //priv->pmib->dot11nConfigEntry.dot11nUse40M = HT_CHANNEL_WIDTH_20_40; -+ priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20_40; -+ } -+ } -+ -+ if(priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_40) -+ { -+ if(!is40MChannel(priv->available_chnl,priv->available_chnl_num,minChan)) -+ { -+ //printk("BW=40M, selected channel = %d is unavaliable! reduce to 20M\n", minChan); -+ //priv->pmib->dot11nConfigEntry.dot11nUse40M = HT_CHANNEL_WIDTH_20; -+ priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20; -+ } -+ } -+ } -+#endif -+ -+#ifdef CONFIG_RTL_NEW_AUTOCH -+ RTL_W32(RXERR_RPT, RXERR_RPT_RST); -+#endif -+ -+// auto adjust contro-sideband -+ if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) -+ && (priv->pshare->is_40m_bw ==1 || priv->pshare->is_40m_bw ==2)) { -+ -+#ifdef RTK_5G_SUPPORT -+ if (priv->pmib->dot11RFEntry.phyBandSelect & PHY_BAND_5G) { -+ if( (minChan>144) ? ((minChan-1)%8) : (minChan%8)) { -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; -+ } else { -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; -+ } -+ -+ } else -+#endif -+ { -+#if 0 -+#ifdef CONFIG_RTL_NEW_AUTOCH -+ unsigned int ch_max; -+ -+ if (priv->available_chnl[idx_2G_end] >= 13) -+ ch_max = 13; -+ else -+ ch_max = priv->available_chnl[idx_2G_end]; -+ -+ if ((minChan >= 5) && (minChan <= (ch_max-5))) { -+ if (score[minChan+4] > score[minChan-4]) { // what if some channels were cancelled? -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; -+ } else { -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; -+ } -+ } else -+#endif -+ { -+ if (minChan < 5) { -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; -+ } -+ else if (minChan > 7) { -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; -+ } -+ } -+#endif -+ } -+ } -+//----------------------- -+ -+#if defined(__ECOS) && defined(CONFIG_SDIO_HCI) -+ panic_printk("Auto channel choose ch:%d\n", minChan); -+#else -+#ifdef _DEBUG_RTL8192CD_ -+ panic_printk("Auto channel choose ch:%d\n", minChan); -+#endif -+#endif -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("7. minChan:%d 2nd_offset:%d\n", minChan, priv->pshare->offset_2nd_chan); -+#endif -+ -+ return minChan; -+} -+*/ -+ -+#endif -+ -+VOID -+phydm_CLMInit( -+ IN PVOID pDM_VOID, -+ IN u2Byte sampleNum /*unit : 4us*/ -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_TIME_PERIOD_11AC, bMaskLWord, sampleNum); /*4us sample 1 time*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11AC, BIT8, 0x1); /*Enable CCX for CLM*/ -+ } else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_TIME_PERIOD_11N, bMaskLWord, sampleNum); /*4us sample 1 time*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11N, BIT8, 0x1); /*Enable CCX for CLM*/ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("[%s] : CLM sampleNum = %d\n", __func__, sampleNum)); -+ -+} -+ -+VOID -+phydm_CLMtrigger( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11AC, BIT0, 0x0); /*Trigger CLM*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11AC, BIT0, 0x1); -+ } else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11N, BIT0, 0x0); /*Trigger CLM*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11N, BIT0, 0x1); -+ } -+} -+ -+BOOLEAN -+phydm_checkCLMready( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte value32 = 0; -+ BOOLEAN ret = FALSE; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11AC, bMaskDWord); /*make sure CLM calc is ready*/ -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_READY_11N, bMaskDWord); /*make sure CLM calc is ready*/ -+ -+ if (value32 & BIT16) -+ ret = TRUE; -+ else -+ ret = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("[%s] : CLM ready = %d\n", __func__, ret)); -+ -+ return ret; -+} -+ -+u2Byte -+phydm_getCLMresult( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte value32 = 0; -+ u2Byte results = 0; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11AC, bMaskDWord); /*read CLM calc result*/ -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11N, bMaskDWord); /*read CLM calc result*/ -+ -+ results = (u2Byte)(value32 & bMaskLWord); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("[%s] : CLM result = %d\n", __func__, results)); -+ -+ return results; -+/*results are number of CCA times in sampleNum*/ -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_acs.h linux/3rdparty/rtl8812au/hal/phydm/phydm_acs.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_acs.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_acs.h 2017-06-07 23:07:21.016688031 +0300 -@@ -0,0 +1,129 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMACS_H__ -+#define __PHYDMACS_H__ -+ -+#define ACS_VERSION "1.0" -+#define CLM_VERSION "1.0" -+ -+#define ODM_MAX_CHANNEL_2G 14 -+#define ODM_MAX_CHANNEL_5G 24 -+ -+// For phydm_AutoChannelSelectSettingAP() -+#define STORE_DEFAULT_NHM_SETTING 0 -+#define RESTORE_DEFAULT_NHM_SETTING 1 -+#define ACS_NHM_SETTING 2 -+ -+typedef struct _ACS_ -+{ -+ BOOLEAN bForceACSResult; -+ u1Byte CleanChannel_2G; -+ u1Byte CleanChannel_5G; -+ u2Byte Channel_Info_2G[2][ODM_MAX_CHANNEL_2G]; //Channel_Info[1]: Channel Score, Channel_Info[2]:Channel_Scan_Times -+ u2Byte Channel_Info_5G[2][ODM_MAX_CHANNEL_5G]; -+ -+#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) -+ u1Byte ACS_Step; -+ // NHM Count 0-11 -+ u1Byte NHM_Cnt[14][11]; -+ -+ // AC-Series, for storing previous setting -+ u4Byte Reg0x990; -+ u4Byte Reg0x994; -+ u4Byte Reg0x998; -+ u4Byte Reg0x99C; -+ u1Byte Reg0x9A0; // u1Byte -+ -+ // N-Series, for storing previous setting -+ u4Byte Reg0x890; -+ u4Byte Reg0x894; -+ u4Byte Reg0x898; -+ u4Byte Reg0x89C; -+ u1Byte Reg0xE28; // u1Byte -+#endif -+ -+}ACS, *PACS; -+ -+ -+VOID -+odm_AutoChannelSelectInit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_AutoChannelSelectReset( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_AutoChannelSelect( -+ IN PVOID pDM_VOID, -+ IN u1Byte Channel -+); -+ -+u1Byte -+ODM_GetAutoChannelSelectResult( -+ IN PVOID pDM_VOID, -+ IN u1Byte Band -+); -+ -+#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) -+ -+VOID -+phydm_AutoChannelSelectSettingAP( -+ IN PVOID pDM_VOID, -+ IN u4Byte Setting, // 0: STORE_DEFAULT_NHM_SETTING; 1: RESTORE_DEFAULT_NHM_SETTING, 2: ACS_NHM_SETTING -+ IN u4Byte acs_step -+); -+ -+VOID -+phydm_GetNHMStatisticsAP( -+ IN PVOID pDM_VOID, -+ IN u4Byte idx, // @ 2G, Real channel number = idx+1 -+ IN u4Byte acs_step -+); -+ -+#endif //#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) -+ -+ -+VOID -+phydm_CLMInit( -+ IN PVOID pDM_VOID, -+ IN u2Byte sampleNum -+); -+ -+VOID -+phydm_CLMtrigger( -+ IN PVOID pDM_VOID -+); -+ -+BOOLEAN -+phydm_checkCLMready( -+ IN PVOID pDM_VOID -+); -+ -+u2Byte -+phydm_getCLMresult( -+ IN PVOID pDM_VOID -+); -+ -+ -+#endif //#ifndef __PHYDMACS_H__ -\ Ingen nyrad vid filslut -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_adaptivity.c linux/3rdparty/rtl8812au/hal/phydm/phydm_adaptivity.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_adaptivity.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_adaptivity.c 2017-06-07 23:07:21.016688031 +0300 -@@ -0,0 +1,940 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if WPP_SOFTWARE_TRACE -+#include "PhyDM_Adaptivity.tmh" -+#endif -+#endif -+ -+ -+VOID -+Phydm_CheckAdaptivity( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+ -+ if (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) { -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (pDM_Odm->APTotalNum > Adaptivity->APNumTH) { -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("AP total num > %d!!, disable adaptivity\n", Adaptivity->APNumTH)); -+ } else -+#endif -+ { -+ if (Adaptivity->DynamicLinkAdaptivity == TRUE) { -+ if (pDM_Odm->bLinked && Adaptivity->bCheck == FALSE) { -+ Phydm_NHMCounterStatistics(pDM_Odm); -+ Phydm_CheckEnvironment(pDM_Odm); -+ } else if (!pDM_Odm->bLinked) -+ Adaptivity->bCheck = FALSE; -+ } else { -+ pDM_Odm->Adaptivity_enable = TRUE; -+ -+ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) -+ pDM_Odm->adaptivity_flag = FALSE; -+ else -+ pDM_Odm->adaptivity_flag = TRUE; -+ } -+ } -+ } else { -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ } -+ -+ -+ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+BOOLEAN -+Phydm_CheckChannelPlan( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); -+ -+ if (pMgntInfo->RegEnableAdaptivity == 2) { -+ if (pDM_Odm->Carrier_Sense_enable == FALSE) { /*check domain Code for Adaptivity or CarrierSense*/ -+ if ((*pDM_Odm->pBandType == ODM_BAND_5G) && -+ !(pDM_Odm->odm_Regulation5G == REGULATION_ETSI || pDM_Odm->odm_Regulation5G == REGULATION_WW)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity skip 5G domain code : %d\n", pDM_Odm->odm_Regulation5G)); -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ return TRUE; -+ } else if ((*pDM_Odm->pBandType == ODM_BAND_2_4G) && -+ !(pDM_Odm->odm_Regulation2_4G == REGULATION_ETSI || pDM_Odm->odm_Regulation2_4G == REGULATION_WW)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity skip 2.4G domain code : %d\n", pDM_Odm->odm_Regulation2_4G)); -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ return TRUE; -+ -+ } else if ((*pDM_Odm->pBandType != ODM_BAND_2_4G) && (*pDM_Odm->pBandType != ODM_BAND_5G)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity neither 2G nor 5G band, return\n")); -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ return TRUE; -+ } -+ } else { -+ if ((*pDM_Odm->pBandType == ODM_BAND_5G) && -+ !(pDM_Odm->odm_Regulation5G == REGULATION_MKK || pDM_Odm->odm_Regulation5G == REGULATION_WW)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense skip 5G domain code : %d\n", pDM_Odm->odm_Regulation5G)); -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ return TRUE; -+ } -+ -+ else if ((*pDM_Odm->pBandType == ODM_BAND_2_4G) && -+ !(pDM_Odm->odm_Regulation2_4G == REGULATION_MKK || pDM_Odm->odm_Regulation2_4G == REGULATION_WW)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense skip 2.4G domain code : %d\n", pDM_Odm->odm_Regulation2_4G)); -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ return TRUE; -+ -+ } else if ((*pDM_Odm->pBandType != ODM_BAND_2_4G) && (*pDM_Odm->pBandType != ODM_BAND_5G)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense neither 2G nor 5G band, return\n")); -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ return TRUE; -+ } -+ } -+ } -+ -+ return FALSE; -+ -+} -+#endif -+ -+VOID -+Phydm_NHMCounterStatisticsInit( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ /*PHY parameters initialize for n series*/ -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TIMER_11N + 2, 0xC350); /*0x894[31:16]=0x0xC350 Time duration for NHM unit: us, 0xc350=200ms*/ -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N + 2, 0xffff); /*0x890[31:16]=0xffff th_9, th_10*/ -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0xffffff50); /*0x898=0xffffff52 th_3, th_2, th_1, th_0*/ -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffffff); /*0x89c=0xffffffff th_7, th_6, th_5, th_4*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_FPGA0_IQK_11N, bMaskByte0, 0xff); /*0xe28[7:0]=0xff th_8*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10 | BIT9 | BIT8, 0x1); /*0x890[10:8]=1 ignoreCCA ignore PHYTXON enable CCX*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT7, 0x1); /*0xc0c[7]=1 max power among all RX ants*/ -+ } -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ /*PHY parameters initialize for ac series*/ -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TIMER_11AC + 2, 0xC350); /*0x990[31:16]=0xC350 Time duration for NHM unit: us, 0xc350=200ms*/ -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC + 2, 0xffff); /*0x994[31:16]=0xffff th_9, th_10*/ -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0xffffff50); /*0x998=0xffffff52 th_3, th_2, th_1, th_0*/ -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffffff); /*0x99c=0xffffffff th_7, th_6, th_5, th_4*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0, 0xff); /*0x9a0[7:0]=0xff th_8*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT8 | BIT9 | BIT10, 0x1); /*0x994[10:8]=1 ignoreCCA ignore PHYTXON enable CCX*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_9E8_11AC, BIT0, 0x1); /*0x9e8[7]=1 max power among all RX ants*/ -+ -+ } -+#endif -+} -+ -+VOID -+Phydm_NHMCounterStatistics( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) -+ return; -+ -+ /*Get NHM report*/ -+ Phydm_GetNHMCounterStatistics(pDM_Odm); -+ -+ /*Reset NHM counter*/ -+ Phydm_NHMCounterStatisticsReset(pDM_Odm); -+} -+ -+VOID -+Phydm_GetNHMCounterStatistics( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte value32 = 0; -+#if (RTL8195A_SUPPORT == 0) -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_CNT_11AC, bMaskDWord); -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+#endif -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_CNT_11N, bMaskDWord); -+ -+ pDM_Odm->NHM_cnt_0 = (u1Byte)(value32 & bMaskByte0); -+ pDM_Odm->NHM_cnt_1 = (u1Byte)((value32 & bMaskByte1) >> 8); -+ -+} -+ -+VOID -+Phydm_NHMCounterStatisticsReset( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 1); -+ } -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 1); -+ } -+ -+#endif -+ -+} -+ -+VOID -+Phydm_SetEDCCAThreshold( -+ IN PVOID pDM_VOID, -+ IN s1Byte H2L, -+ IN s1Byte L2H -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskByte2|bMaskByte0, (u4Byte)((u1Byte)L2H|(u1Byte)H2L<<16)); -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, bMaskLWord, (u2Byte)((u1Byte)L2H|(u1Byte)H2L<<8)); -+#endif -+ -+} -+ -+VOID -+Phydm_SetLNA( -+ IN PVOID pDM_VOID, -+ IN PhyDM_set_LNA type -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8188E | ODM_RTL8192E)) { -+ if (type == PhyDM_disable_LNA) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0000f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0x37f82); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x0000f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0x37f82); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); -+ } -+ } else if (type == PhyDM_enable_LNA) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0000f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0x77f82); /*back to normal*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x0000f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0x77f82); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); -+ } -+ } -+ } else if (pDM_Odm->SupportICType & ODM_RTL8723B) { -+ if (type == PhyDM_disable_LNA) { -+ /*S0*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0001f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xe6137); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ /*S1*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x43, 0xfffff, 0x3008d); /*select Rx mode and disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x0); -+ } else if (type == PhyDM_enable_LNA) { -+ /*S0*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0001f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xe6177); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ /*S1*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x43, 0xfffff, 0x300bd); /*select Rx mode and disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x0); -+ } -+ -+ } else if (pDM_Odm->SupportICType & ODM_RTL8812) { -+ if (type == PhyDM_disable_LNA) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xc22bf); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0xc22bf); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); -+ } -+ } else if (type == PhyDM_enable_LNA) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xc26bf); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0xc26bf); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); -+ } -+ } -+ } else if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8881A)) { -+ if (type == PhyDM_disable_LNA) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0002f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xfb09b); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ } else if (type == PhyDM_enable_LNA) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0002f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xfb0bb); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ } -+ } -+} -+ -+ -+ -+VOID -+Phydm_SetTRxMux( -+ IN PVOID pDM_VOID, -+ IN PhyDM_Trx_MUX_Type txMode, -+ IN PhyDM_Trx_MUX_Type rxMode -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N, BIT3 | BIT2 | BIT1, txMode); /*set TXmod to standby mode to remove outside noise affect*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N, BIT22 | BIT21 | BIT20, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT3 | BIT2 | BIT1, txMode); /*set TXmod to standby mode to remove outside noise affect*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT22 | BIT21 | BIT20, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ -+ } -+ } -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC, BIT11 | BIT10 | BIT9 | BIT8, txMode); /*set TXmod to standby mode to remove outside noise affect*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC, BIT7 | BIT6 | BIT5 | BIT4, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC_B, BIT11 | BIT10 | BIT9 | BIT8, txMode); /*set TXmod to standby mode to remove outside noise affect*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC_B, BIT7 | BIT6 | BIT5 | BIT4, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ -+ } -+ } -+#endif -+ -+} -+ -+VOID -+Phydm_MACEDCCAState( -+ IN PVOID pDM_VOID, -+ IN PhyDM_MACEDCCA_Type State -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if (State == PhyDM_IGNORE_EDCCA) { -+ ODM_SetMACReg(pDM_Odm, REG_TX_PTCL_CTRL, BIT15, 1); /*ignore EDCCA reg520[15]=1*/ -+ ODM_SetMACReg(pDM_Odm, REG_RD_CTRL, BIT11, 0); /*reg524[11]=0*/ -+ } else { /*don't set MAC ignore EDCCA signal*/ -+ ODM_SetMACReg(pDM_Odm, REG_TX_PTCL_CTRL, BIT15, 0); /*don't ignore EDCCA reg520[15]=0*/ -+ ODM_SetMACReg(pDM_Odm, REG_RD_CTRL, BIT11, 1); /*reg524[11]=1 */ -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("EDCCA enable State = %d\n", State)); -+ -+} -+ -+BOOLEAN -+Phydm_CalNHMcnt( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte Base = 0; -+ -+ Base = pDM_Odm->NHM_cnt_0 + pDM_Odm->NHM_cnt_1; -+ -+ if (Base != 0) { -+ pDM_Odm->NHM_cnt_0 = ((pDM_Odm->NHM_cnt_0) << 8) / Base; -+ pDM_Odm->NHM_cnt_1 = ((pDM_Odm->NHM_cnt_1) << 8) / Base; -+ } -+ if ((pDM_Odm->NHM_cnt_0 - pDM_Odm->NHM_cnt_1) >= 100) -+ return TRUE; /*clean environment*/ -+ else -+ return FALSE; /*noisy environment*/ -+ -+} -+ -+ -+VOID -+Phydm_CheckEnvironment( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+ BOOLEAN isCleanEnvironment = FALSE; -+ -+ if (Adaptivity->bFirstLink == TRUE) { -+ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) -+ pDM_Odm->adaptivity_flag = FALSE; -+ else -+ pDM_Odm->adaptivity_flag = TRUE; -+ -+ Adaptivity->bFirstLink = FALSE; -+ return; -+ } else { -+ if (Adaptivity->NHMWait < 3) { /*Start enter NHM after 4 NHMWait*/ -+ Adaptivity->NHMWait++; -+ Phydm_NHMCounterStatistics(pDM_Odm); -+ return; -+ } else { -+ Phydm_NHMCounterStatistics(pDM_Odm); -+ isCleanEnvironment = Phydm_CalNHMcnt(pDM_Odm); -+ if (isCleanEnvironment == TRUE) { -+ pDM_Odm->TH_L2H_ini = Adaptivity->TH_L2H_ini_backup; /*adaptivity mode*/ -+ pDM_Odm->TH_EDCCA_HL_diff = Adaptivity->TH_EDCCA_HL_diff_backup; -+ -+ pDM_Odm->Adaptivity_enable = TRUE; -+ -+ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) -+ pDM_Odm->adaptivity_flag = FALSE; -+ else -+ pDM_Odm->adaptivity_flag = TRUE; -+ } else { -+ pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2; /*mode2*/ -+ pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2; -+ -+ pDM_Odm->adaptivity_flag = FALSE; -+ pDM_Odm->Adaptivity_enable = FALSE; -+ } -+ Adaptivity->NHMWait = 0; -+ Adaptivity->bFirstLink = TRUE; -+ Adaptivity->bCheck = TRUE; -+ } -+ -+ } -+ -+ -+} -+ -+VOID -+Phydm_SearchPwdBLowerBound( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+ u4Byte value32 = 0; -+ u1Byte cnt, IGI = 0x45; /*IGI = 0x50 for cal EDCCA lower bound*/ -+ u1Byte txEdcca1 = 0, txEdcca0 = 0; -+ BOOLEAN bAdjust = TRUE; -+ s1Byte TH_L2H_dmc, TH_H2L_dmc, IGI_target = 0x32; -+ s1Byte Diff; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) -+ Phydm_SetLNA(pDM_Odm, PhyDM_disable_LNA); -+ else { -+ Phydm_SetTRxMux(pDM_Odm, PhyDM_STANDBY_MODE, PhyDM_STANDBY_MODE); -+ odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_0, 0x7e); -+ } -+ -+ Diff = IGI_target - (s1Byte)IGI; -+ TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; -+ if (TH_L2H_dmc > 10) -+ TH_L2H_dmc = 10; -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ -+ Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); -+ ODM_delay_ms(5); -+ -+ while (bAdjust) { -+ for (cnt = 0; cnt < 20; cnt++) { -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11N, bMaskDWord); -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC, bMaskDWord); -+#endif -+ if (value32 & BIT30 && (pDM_Odm->SupportICType & (ODM_RTL8723A | ODM_RTL8723B | ODM_RTL8188E))) -+ txEdcca1 = txEdcca1 + 1; -+ else if (value32 & BIT29) -+ txEdcca1 = txEdcca1 + 1; -+ else -+ txEdcca0 = txEdcca0 + 1; -+ } -+ -+ if (txEdcca1 > 1) { -+ IGI = IGI - 1; -+ TH_L2H_dmc = TH_L2H_dmc + 1; -+ if (TH_L2H_dmc > 10) -+ TH_L2H_dmc = 10; -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ -+ Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); -+ if (TH_L2H_dmc == 10) { -+ bAdjust = FALSE; -+ Adaptivity->H2L_lb = TH_H2L_dmc; -+ Adaptivity->L2H_lb = TH_L2H_dmc; -+ pDM_Odm->Adaptivity_IGI_upper = IGI; -+ } -+ -+ txEdcca1 = 0; -+ txEdcca0 = 0; -+ -+ } else { -+ bAdjust = FALSE; -+ Adaptivity->H2L_lb = TH_H2L_dmc; -+ Adaptivity->L2H_lb = TH_L2H_dmc; -+ pDM_Odm->Adaptivity_IGI_upper = IGI; -+ txEdcca1 = 0; -+ txEdcca0 = 0; -+ } -+ } -+ -+ pDM_Odm->Adaptivity_IGI_upper = pDM_Odm->Adaptivity_IGI_upper - pDM_Odm->DCbackoff; -+ Adaptivity->H2L_lb = Adaptivity->H2L_lb + pDM_Odm->DCbackoff; -+ Adaptivity->L2H_lb = Adaptivity->L2H_lb + pDM_Odm->DCbackoff; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) -+ Phydm_SetLNA(pDM_Odm, PhyDM_enable_LNA); -+ else { -+ Phydm_SetTRxMux(pDM_Odm, PhyDM_TX_MODE, PhyDM_RX_MODE); -+ odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_0, NONE); -+ } -+ -+ Phydm_SetEDCCAThreshold(pDM_Odm, 0x7f, 0x7f); /*resume to no link state*/ -+} -+ -+VOID -+Phydm_AdaptivityInit( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+ s1Byte IGItarget = 0x32; -+#if(DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); -+ pDM_Odm->Carrier_Sense_enable = (BOOLEAN)pMgntInfo->RegEnableCarrierSense; -+ pDM_Odm->DCbackoff = (u1Byte)pMgntInfo->RegDCbackoff; -+ Adaptivity->DynamicLinkAdaptivity = (BOOLEAN)pMgntInfo->RegDmLinkAdaptivity; -+ Adaptivity->APNumTH = (u1Byte)pMgntInfo->RegAPNumTH; -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ pDM_Odm->Carrier_Sense_enable = (pDM_Odm->Adapter->registrypriv.adaptivity_mode != 0) ? TRUE : FALSE; -+ pDM_Odm->DCbackoff = pDM_Odm->Adapter->registrypriv.adaptivity_dc_backoff; -+ Adaptivity->DynamicLinkAdaptivity = (pDM_Odm->Adapter->registrypriv.adaptivity_dml != 0) ? TRUE : FALSE; -+#endif -+ -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ -+ if (pDM_Odm->Carrier_Sense_enable == FALSE) { -+#if(DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (pMgntInfo->RegL2HForAdaptivity != 0) -+ pDM_Odm->TH_L2H_ini = pMgntInfo->RegL2HForAdaptivity; -+ else -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (pDM_Odm->Adapter->registrypriv.adaptivity_th_l2h_ini != 0) -+ pDM_Odm->TH_L2H_ini = pDM_Odm->Adapter->registrypriv.adaptivity_th_l2h_ini; -+ else -+#endif -+ pDM_Odm->TH_L2H_ini = 0xf5; -+ } else -+ pDM_Odm->TH_L2H_ini = 0xa; -+ -+#if(DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (pMgntInfo->RegHLDiffForAdaptivity != 0) -+ pDM_Odm->TH_EDCCA_HL_diff = pMgntInfo->RegHLDiffForAdaptivity; -+ else -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (pDM_Odm->Adapter->registrypriv.adaptivity_th_edcca_hl_diff != 0) -+ pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->Adapter->registrypriv.adaptivity_th_edcca_hl_diff; -+ else -+#endif -+ pDM_Odm->TH_EDCCA_HL_diff = 7; -+ -+ Adaptivity->TH_L2H_ini_backup = pDM_Odm->TH_L2H_ini; -+ Adaptivity->TH_EDCCA_HL_diff_backup = pDM_Odm->TH_EDCCA_HL_diff; -+ -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ if (pDM_Odm->Carrier_Sense_enable) { -+ pDM_Odm->TH_L2H_ini = 0xa; -+ pDM_Odm->TH_EDCCA_HL_diff = 7; -+ } else { -+ Adaptivity->TH_L2H_ini_backup = pDM_Odm->TH_L2H_ini; /*set by mib*/ -+ pDM_Odm->TH_EDCCA_HL_diff = 7; -+ } -+ -+ Adaptivity->TH_EDCCA_HL_diff_backup = pDM_Odm->TH_EDCCA_HL_diff; -+ if (priv->pshare->rf_ft_var.adaptivity_enable == 2) -+ Adaptivity->DynamicLinkAdaptivity = TRUE; -+ else -+ Adaptivity->DynamicLinkAdaptivity = FALSE; -+ -+#endif -+ -+ pDM_Odm->Adaptivity_IGI_upper = 0; -+ pDM_Odm->Adaptivity_enable = FALSE; /*use this flag to decide enable or disable*/ -+ -+ pDM_Odm->EDCCA_enable = TRUE; /*even no adaptivity, we still enable EDCCA*/ -+ -+ pDM_Odm->TH_L2H_ini_mode2 = 20; -+ pDM_Odm->TH_EDCCA_HL_diff_mode2 = 8; -+ -+ Adaptivity->IGI_Base = 0x32; -+ Adaptivity->IGI_target = 0x1c; -+ Adaptivity->H2L_lb = 0; -+ Adaptivity->L2H_lb = 0; -+ Adaptivity->NHMWait = 0; -+ Adaptivity->bCheck = FALSE; -+ Adaptivity->bFirstLink = TRUE; -+ Adaptivity->AdajustIGILevel = 0; -+ -+ Phydm_MACEDCCAState(pDM_Odm, PhyDM_DONT_IGNORE_EDCCA); -+ -+ /*Search pwdB lower bound*/ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11N, bMaskDWord, 0x208); -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC, bMaskDWord, 0x209); -+#endif -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_GAIN_IDX_EDCCA) { -+ /*ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DOWN_OPT_11N, BIT12 | BIT11 | BIT10, 0x7);*/ /*interfernce need > 2^x us, and then EDCCA will be 1*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DCNF_11N, BIT21 | BIT20, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ -+ } -+#if (RTL8195A_SUPPORT == 0) -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_GAIN_IDX_EDCCA) { /*8814a no need to find pwdB lower bound, maybe*/ -+ /*ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DOWN_OPT, BIT30 | BIT29 | BIT28, 0x7);*/ /*interfernce need > 2^x us, and then EDCCA will be 1*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_ACBB_EDCCA_ENHANCE, BIT29 | BIT28, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ -+ } -+ -+ if(!(pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA))) -+ Phydm_SearchPwdBLowerBound(pDM_Odm); -+#endif -+ -+/*we need to consider PwdB upper bound for 8814 later IC*/ -+ Adaptivity->AdajustIGILevel = (u1Byte)((pDM_Odm->TH_L2H_ini + IGItarget) - PwdBUpperBound + DFIRloss); /*IGI = L2H - PwdB - DFIRloss*/ -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("TH_L2H_ini = 0x%x, TH_EDCCA_HL_diff = 0x%x, Adaptivity->AdajustIGILevel = 0x%x\n", pDM_Odm->TH_L2H_ini, pDM_Odm->TH_EDCCA_HL_diff, Adaptivity->AdajustIGILevel)); -+ -+} -+ -+ -+VOID -+Phydm_Adaptivity( -+ IN PVOID pDM_VOID, -+ IN u1Byte IGI -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ s1Byte TH_L2H_dmc, TH_H2L_dmc; -+ s1Byte Diff = 0, IGI_target; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ BOOLEAN bFwCurrentInPSMode = FALSE; -+ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); -+ -+ pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_FW_PSMODE_STATUS, (pu1Byte)(&bFwCurrentInPSMode)); -+ -+ /*Disable EDCCA mode while under LPS mode, added by Roger, 2012.09.14.*/ -+ if (bFwCurrentInPSMode) -+ return; -+#endif -+ -+ if ((pDM_Odm->EDCCA_enable == FALSE) || (pDM_Odm->bWIFITest == TRUE)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Disable EDCCA!!!\n")); -+ return; -+ } -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("adaptivity disable, enable EDCCA mode!!!\n")); -+ pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2; -+ pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2; -+ } -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ else{ -+ if (Phydm_CheckChannelPlan(pDM_Odm) || (pDM_Odm->APTotalNum > Adaptivity->APNumTH)) { -+ pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2; -+ pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2; -+ } -+ } -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("odm_Adaptivity() =====>\n")); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("IGI_Base=0x%x, TH_L2H_ini = %d, TH_EDCCA_HL_diff = %d\n", -+ Adaptivity->IGI_Base, pDM_Odm->TH_L2H_ini, pDM_Odm->TH_EDCCA_HL_diff)); -+#if (RTL8195A_SUPPORT == 0) -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ /*fix AC series when enable EDCCA hang issue*/ -+ ODM_SetBBReg(pDM_Odm, 0x800, BIT10, 1); /*ADC_mask disable*/ -+ ODM_SetBBReg(pDM_Odm, 0x800, BIT10, 0); /*ADC_mask enable*/ -+ } -+#endif -+ if (*pDM_Odm->pBandWidth == ODM_BW20M) /*CHANNEL_WIDTH_20*/ -+ IGI_target = Adaptivity->IGI_Base; -+ else if (*pDM_Odm->pBandWidth == ODM_BW40M) -+ IGI_target = Adaptivity->IGI_Base + 2; -+#if (RTL8195A_SUPPORT == 0) -+ else if (*pDM_Odm->pBandWidth == ODM_BW80M) -+ IGI_target = Adaptivity->IGI_Base + 2; -+#endif -+ else -+ IGI_target = Adaptivity->IGI_Base; -+ Adaptivity->IGI_target = (u1Byte) IGI_target; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("BandWidth=%s, IGI_target=0x%x, DynamicLinkAdaptivity = %d\n", -+ (*pDM_Odm->pBandWidth == ODM_BW80M) ? "80M" : ((*pDM_Odm->pBandWidth == ODM_BW40M) ? "40M" : "20M"), IGI_target, Adaptivity->DynamicLinkAdaptivity)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("RSSI_min = %d, Adaptivity->AdajustIGILevel= 0x%x, adaptivity_flag = %d, Adaptivity_enable = %d\n", -+ pDM_Odm->RSSI_Min, Adaptivity->AdajustIGILevel, pDM_Odm->adaptivity_flag, pDM_Odm->Adaptivity_enable)); -+ -+ if ((Adaptivity->DynamicLinkAdaptivity == TRUE) && (!pDM_Odm->bLinked) && (pDM_Odm->Adaptivity_enable == FALSE)) { -+ Phydm_SetEDCCAThreshold(pDM_Odm, 0x7f, 0x7f); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("In DynamicLink mode(noisy) and No link, Turn off EDCCA!!\n")); -+ return; -+ } -+ -+ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { -+ if ((Adaptivity->AdajustIGILevel > IGI) && (pDM_Odm->Adaptivity_enable == TRUE)) -+ Diff = Adaptivity->AdajustIGILevel - IGI; -+ -+ TH_L2H_dmc = pDM_Odm->TH_L2H_ini - Diff + IGI_target; -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ } -+#if (RTL8195A_SUPPORT == 0) -+ else { -+ Diff = IGI_target - (s1Byte)IGI; -+ TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; -+ if (TH_L2H_dmc > 10 && (pDM_Odm->Adaptivity_enable == TRUE)) -+ TH_L2H_dmc = 10; -+ -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ -+ /*replace lower bound to prevent EDCCA always equal 1*/ -+ if (TH_H2L_dmc < Adaptivity->H2L_lb) -+ TH_H2L_dmc = Adaptivity->H2L_lb; -+ if (TH_L2H_dmc < Adaptivity->L2H_lb) -+ TH_L2H_dmc = Adaptivity->L2H_lb; -+ } -+#endif -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("IGI=0x%x, TH_L2H_dmc = %d, TH_H2L_dmc = %d\n", IGI, TH_L2H_dmc, TH_H2L_dmc)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity_IGI_upper=0x%x, H2L_lb = 0x%x, L2H_lb = 0x%x\n", pDM_Odm->Adaptivity_IGI_upper, Adaptivity->H2L_lb, Adaptivity->L2H_lb)); -+ -+ Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); -+ return; -+} -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+VOID -+Phydm_AdaptivityBSOD( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); -+ u1Byte count = 0; -+ u4Byte u4Value; -+ -+ /* -+ 1. turn off RF (TRX Mux in standby mode) -+ 2. H2C mac id drop -+ 3. ignore EDCCA -+ 4. wait for clear FIFO -+ 5. don't ignore EDCCA -+ 6. turn on RF (TRX Mux in TRx mdoe) -+ 7. H2C mac id resume -+ */ -+ -+ RT_TRACE(COMP_MLME, DBG_WARNING, ("MAC id drop packet!!!!!\n")); -+ -+ pAdapter->dropPktByMacIdCnt++; -+ pMgntInfo->bDropPktInProgress = TRUE; -+ -+ pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_MAX_Q_PAGE_NUM, (pu1Byte)(&u4Value)); -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("Queue Reserved Page Number = 0x%08x\n", u4Value)); -+ pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_AVBL_Q_PAGE_NUM, (pu1Byte)(&u4Value)); -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("Available Queue Page Number = 0x%08x\n", u4Value)); -+ -+#if 1 -+ -+ /*Standby mode*/ -+ Phydm_SetTRxMux(pDM_Odm, PhyDM_STANDBY_MODE, PhyDM_STANDBY_MODE); -+ ODM_Write_DIG(pDM_Odm, 0x20); -+ -+ /*H2C mac id drop*/ -+ MacIdIndicateDisconnect(pAdapter); -+ -+ /*Ignore EDCCA*/ -+ Phydm_MACEDCCAState(pDM_Odm, PhyDM_IGNORE_EDCCA); -+ -+ delay_ms(50); -+ count = 5; -+ -+#else -+ -+ do { -+ -+ u8Byte diffTime, curTime, oldestTime; -+ u1Byte queueIdx -+ -+ //3 Standby mode -+ Phydm_SetTRxMux(pDM_Odm, PhyDM_STANDBY_MODE, PhyDM_STANDBY_MODE); -+ ODM_Write_DIG(pDM_Odm, 0x20); -+ -+ //3 H2C mac id drop -+ MacIdIndicateDisconnect(pAdapter); -+ -+ //3 Ignore EDCCA -+ Phydm_MACEDCCAState(pDM_Odm, PhyDM_IGNORE_EDCCA); -+ -+ count++; -+ delay_ms(10); -+ -+ // Check latest packet -+ curTime = PlatformGetCurrentTime(); -+ oldestTime = 0xFFFFFFFFFFFFFFFF; -+ -+ for (queueIdx = 0; queueIdx < MAX_TX_QUEUE; queueIdx++) { -+ if (!IS_DATA_QUEUE(queueIdx)) -+ continue; -+ -+ if (!pAdapter->bTcbBusyQEmpty[queueIdx]) { -+ RT_TRACE(COMP_MLME, DBG_WARNING, ("oldestTime = %llu\n", oldestTime)); -+ RT_TRACE(COMP_MLME, DBG_WARNING, ("Q[%d] = %llu\n", queueIdx, pAdapter->firstTcbSysTime[queueIdx])); -+ if (pAdapter->firstTcbSysTime[queueIdx] < oldestTime) -+ oldestTime = pAdapter->firstTcbSysTime[queueIdx]; -+ } -+ } -+ -+ diffTime = curTime - oldestTime; -+ -+ RT_TRACE(COMP_MLME, DBG_WARNING, ("diff s = %llu\n", (diffTime / 1000000))); -+ -+ } while (((diffTime / 1000000) >= 4) && (oldestTime != 0xFFFFFFFFFFFFFFFF)); -+#endif -+ -+ /*Resume EDCCA*/ -+ Phydm_MACEDCCAState(pDM_Odm, PhyDM_DONT_IGNORE_EDCCA); -+ -+ /*Turn on TRx mode*/ -+ Phydm_SetTRxMux(pDM_Odm, PhyDM_TX_MODE, PhyDM_RX_MODE); -+ ODM_Write_DIG(pDM_Odm, 0x20); -+ -+ /*Resume H2C macid*/ -+ MacIdRecoverMediaStatus(pAdapter); -+ -+ pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_AVBL_Q_PAGE_NUM, (pu1Byte)(&u4Value)); -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("Available Queue Page Number = 0x%08x\n", u4Value)); -+ -+ pMgntInfo->bDropPktInProgress = FALSE; -+ RT_TRACE(COMP_MLME, DBG_WARNING, ("End of MAC id drop packet, spent %dms\n", count * 10)); -+ -+} -+ -+#endif -+ -+VOID -+phydm_setEDCCAThresholdAPI( -+ IN PVOID pDM_VOID, -+ IN u1Byte IGI -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+ s1Byte TH_L2H_dmc, TH_H2L_dmc; -+ s1Byte Diff = 0, IGI_target = 0x32; -+ -+ if (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) { -+ -+ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { -+ if (Adaptivity->AdajustIGILevel > IGI) -+ Diff = Adaptivity->AdajustIGILevel - IGI; -+ -+ TH_L2H_dmc = pDM_Odm->TH_L2H_ini - Diff + IGI_target; -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ } -+#if (RTL8195A_SUPPORT == 0) -+ else { -+ Diff = IGI_target - (s1Byte)IGI; -+ TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; -+ if (TH_L2H_dmc > 10) -+ TH_L2H_dmc = 10; -+ -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ -+ /*replace lower bound to prevent EDCCA always equal 1*/ -+ if (TH_H2L_dmc < Adaptivity->H2L_lb) -+ TH_H2L_dmc = Adaptivity->H2L_lb; -+ if (TH_L2H_dmc < Adaptivity->L2H_lb) -+ TH_L2H_dmc = Adaptivity->L2H_lb; -+ } -+#endif -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("API :IGI=0x%x, TH_L2H_dmc = %d, TH_H2L_dmc = %d\n", IGI, TH_L2H_dmc, TH_H2L_dmc)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("API :Adaptivity_IGI_upper=0x%x, H2L_lb = 0x%x, L2H_lb = 0x%x\n", pDM_Odm->Adaptivity_IGI_upper, Adaptivity->H2L_lb, Adaptivity->L2H_lb)); -+ -+ Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); -+ } -+ -+} -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_adaptivity.h linux/3rdparty/rtl8812au/hal/phydm/phydm_adaptivity.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_adaptivity.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_adaptivity.h 2017-06-07 23:07:21.016688031 +0300 -@@ -0,0 +1,172 @@ -+ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMADAPTIVITY_H__ -+#define __PHYDMADAPTIVITY_H__ -+ -+#define ADAPTIVITY_VERSION "9.0" -+ -+#define PwdBUpperBound 7 -+#define DFIRloss 5 -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+typedef enum _tag_PhyDM_REGULATION_Type { -+ REGULATION_FCC = 0, -+ REGULATION_MKK = 1, -+ REGULATION_ETSI = 2, -+ REGULATION_WW = 3, -+ -+ MAX_REGULATION_NUM = 4 -+} PhyDM_REGULATION_TYPE; -+#endif -+ -+typedef enum tag_PhyDM_set_LNA { -+ PhyDM_disable_LNA = 0, -+ PhyDM_enable_LNA = 1, -+} PhyDM_set_LNA; -+ -+ -+typedef enum tag_PhyDM_TRx_MUX_Type -+{ -+ PhyDM_SHUTDOWN = 0, -+ PhyDM_STANDBY_MODE = 1, -+ PhyDM_TX_MODE = 2, -+ PhyDM_RX_MODE = 3 -+}PhyDM_Trx_MUX_Type; -+ -+typedef enum tag_PhyDM_MACEDCCA_Type -+{ -+ PhyDM_IGNORE_EDCCA = 0, -+ PhyDM_DONT_IGNORE_EDCCA = 1 -+}PhyDM_MACEDCCA_Type; -+ -+typedef struct _ADAPTIVITY_STATISTICS { -+ s1Byte TH_L2H_ini_backup; -+ s1Byte TH_EDCCA_HL_diff_backup; -+ s1Byte IGI_Base; -+ u1Byte IGI_target; -+ u1Byte NHMWait; -+ s1Byte H2L_lb; -+ s1Byte L2H_lb; -+ BOOLEAN bFirstLink; -+ BOOLEAN bCheck; -+ BOOLEAN DynamicLinkAdaptivity; -+ u1Byte APNumTH; -+ u1Byte AdajustIGILevel; -+} ADAPTIVITY_STATISTICS, *PADAPTIVITY_STATISTICS; -+ -+VOID -+Phydm_CheckAdaptivity( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+Phydm_CheckEnvironment( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+Phydm_NHMCounterStatisticsInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+Phydm_NHMCounterStatistics( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+Phydm_NHMCounterStatisticsReset( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+Phydm_GetNHMCounterStatistics( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+Phydm_MACEDCCAState( -+ IN PVOID pDM_VOID, -+ IN PhyDM_MACEDCCA_Type State -+); -+ -+VOID -+Phydm_SetEDCCAThreshold( -+ IN PVOID pDM_VOID, -+ IN s1Byte H2L, -+ IN s1Byte L2H -+); -+ -+VOID -+Phydm_SetTRxMux( -+ IN PVOID pDM_VOID, -+ IN PhyDM_Trx_MUX_Type txMode, -+ IN PhyDM_Trx_MUX_Type rxMode -+); -+ -+BOOLEAN -+Phydm_CalNHMcnt( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+Phydm_SearchPwdBLowerBound( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+Phydm_AdaptivityInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+Phydm_Adaptivity( -+ IN PVOID pDM_VOID, -+ IN u1Byte IGI -+ ); -+ -+VOID -+phydm_setEDCCAThresholdAPI( -+ IN PVOID pDM_VOID, -+ IN u1Byte IGI -+); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+Phydm_DisableEDCCA( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+Phydm_DynamicEDCCA( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+Phydm_AdaptivityBSOD( -+ IN PVOID pDM_VOID -+); -+ -+#endif -+ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_antdect.c linux/3rdparty/rtl8812au/hal/phydm/phydm_antdect.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_antdect.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_antdect.c 2017-06-07 23:07:21.016688031 +0300 -@@ -0,0 +1,1215 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+//#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN |ODM_CE)) -+#if(defined(CONFIG_ANT_DETECTION)) -+ -+//IS_ANT_DETECT_SUPPORT_SINGLE_TONE(Adapter) -+//IS_ANT_DETECT_SUPPORT_RSSI(Adapter) -+//IS_ANT_DETECT_SUPPORT_PSD(Adapter) -+ -+//1 [1. Single Tone Method] =================================================== -+ -+ -+VOID -+odm_PHY_SaveAFERegisters( -+ IN PVOID pDM_VOID, -+ IN pu4Byte AFEReg, -+ IN pu4Byte AFEBackup, -+ IN u4Byte RegisterNum -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte i; -+ -+ //RT_DISP(FINIT, INIT_IQK, ("Save ADDA parameters.\n")); -+ for( i = 0 ; i < RegisterNum ; i++){ -+ AFEBackup[i] = ODM_GetBBReg(pDM_Odm, AFEReg[i], bMaskDWord); -+ } -+} -+ -+VOID -+odm_PHY_ReloadAFERegisters( -+ IN PVOID pDM_VOID, -+ IN pu4Byte AFEReg, -+ IN pu4Byte AFEBackup, -+ IN u4Byte RegiesterNum -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte i; -+ -+ //RT_DISP(FINIT, INIT_IQK, ("Reload ADDA power saving parameters !\n")); -+ for(i = 0 ; i < RegiesterNum; i++) -+ { -+ -+ ODM_SetBBReg(pDM_Odm, AFEReg[i], bMaskDWord, AFEBackup[i]); -+ } -+} -+ -+// -+// Description: -+// Set Single/Dual Antenna default setting for products that do not do detection in advance. -+// -+// Added by Joseph, 2012.03.22 -+// -+VOID -+ODM_SingleDualAntennaDefaultSetting( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ -+ u1Byte btAntNum=BT_GetPgAntNum(pAdapter); -+ // Set default antenna A and B status -+ if(btAntNum == 2) -+ { -+ pDM_SWAT_Table->ANTA_ON=TRUE; -+ pDM_SWAT_Table->ANTB_ON=TRUE; -+ -+ } -+ else if(btAntNum == 1) -+ {// Set antenna A as default -+ pDM_SWAT_Table->ANTA_ON=TRUE; -+ pDM_SWAT_Table->ANTB_ON=FALSE; -+ -+ } -+ else -+ { -+ RT_ASSERT(FALSE, ("Incorrect antenna number!!\n")); -+ } -+} -+ -+ -+//2 8723A ANT DETECT -+// -+// Description: -+// Implement IQK single tone for RF DPK loopback and BB PSD scanning. -+// This function is cooperated with BB team Neil. -+// -+// Added by Roger, 2011.12.15 -+// -+BOOLEAN -+ODM_SingleDualAntennaDetection( -+ IN PVOID pDM_VOID, -+ IN u1Byte mode -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ u4Byte CurrentChannel,RfLoopReg; -+ u1Byte n; -+ u4Byte Reg88c, Regc08, Reg874, Regc50, Reg948, Regb2c, Reg92c, Reg930, Reg064, AFE_rRx_Wait_CCA; -+ u1Byte initial_gain = 0x5a; -+ u4Byte PSD_report_tmp; -+ u4Byte AntA_report = 0x0, AntB_report = 0x0, AntO_report = 0x0; -+ BOOLEAN bResult = TRUE; -+ u4Byte AFE_Backup[16]; -+ u4Byte AFE_REG_8723A[16] = { -+ rRx_Wait_CCA, rTx_CCK_RFON, -+ rTx_CCK_BBON, rTx_OFDM_RFON, -+ rTx_OFDM_BBON, rTx_To_Rx, -+ rTx_To_Tx, rRx_CCK, -+ rRx_OFDM, rRx_Wait_RIFS, -+ rRx_TO_Rx, rStandby, -+ rSleep, rPMPD_ANAEN, -+ rFPGA0_XCD_SwitchControl, rBlue_Tooth}; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection()============> \n")); -+ -+ -+ if(!(pDM_Odm->SupportICType & (ODM_RTL8723A|ODM_RTL8192C|ODM_RTL8723B))) -+ return bResult; -+ -+ // Retrieve antenna detection registry info, added by Roger, 2012.11.27. -+ if(!IS_ANT_DETECT_SUPPORT_SINGLE_TONE(pAdapter)) -+ return bResult; -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8192C) -+ { -+ //Which path in ADC/DAC is turnned on for PSD: both I/Q -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT10|BIT11, 0x3); -+ //Ageraged number: 8 -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT12|BIT13, 0x1); -+ //pts = 128; -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x0); -+ } -+ -+ //1 Backup Current RF/BB Settings -+ -+ CurrentChannel = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask); -+ RfLoopReg = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask); -+ if(pDM_Odm->SupportICType & (ODM_RTL8723A|ODM_RTL8192C)) -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, ODM_DPDT, Antenna_A); // change to Antenna A -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ Reg92c = ODM_GetBBReg(pDM_Odm, rDPDT_control, bMaskDWord); -+ Reg930 = ODM_GetBBReg(pDM_Odm, rfe_ctrl_anta_src, bMaskDWord); -+ Reg948 = ODM_GetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord); -+ Regb2c = ODM_GetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord); -+ Reg064 = ODM_GetMACReg(pDM_Odm, rSYM_WLBT_PAPE_SEL, BIT29); -+ ODM_SetBBReg(pDM_Odm, rDPDT_control, 0x3, 0x1); -+ ODM_SetBBReg(pDM_Odm, rfe_ctrl_anta_src, 0xff, 0x77); -+ ODM_SetMACReg(pDM_Odm, rSYM_WLBT_PAPE_SEL, BIT29, 0x1); //dbg 7 -+ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0x3c0, 0x0);//dbg 8 -+ ODM_SetBBReg(pDM_Odm, rAGC_table_select, BIT31, 0x0); -+ } -+ -+ ODM_StallExecution(10); -+ -+ //Store A Path Register 88c, c08, 874, c50 -+ Reg88c = ODM_GetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord); -+ Regc08 = ODM_GetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord); -+ Reg874 = ODM_GetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord); -+ Regc50 = ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord); -+ -+ // Store AFE Registers -+ if(pDM_Odm->SupportICType & (ODM_RTL8723A|ODM_RTL8192C)) -+ odm_PHY_SaveAFERegisters(pDM_Odm, AFE_REG_8723A, AFE_Backup, 16); -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ AFE_rRx_Wait_CCA = ODM_GetBBReg(pDM_Odm, rRx_Wait_CCA,bMaskDWord); -+ -+ //Set PSD 128 pts -+ ODM_SetBBReg(pDM_Odm, rFPGA0_PSDFunction, BIT14|BIT15, 0x0); //128 pts -+ -+ // To SET CH1 to do -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask, 0x7401); //Channel 1 -+ -+ // AFE all on step -+ if(pDM_Odm->SupportICType & (ODM_RTL8723A|ODM_RTL8192C)) -+ { -+ ODM_SetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rTx_CCK_RFON, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rTx_CCK_BBON, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rTx_OFDM_RFON, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rTx_OFDM_BBON, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rTx_To_Rx, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rTx_To_Tx, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rRx_CCK, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rRx_OFDM, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rRx_Wait_RIFS, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rRx_TO_Rx, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rStandby, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rSleep, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rPMPD_ANAEN, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_SwitchControl, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rBlue_Tooth, bMaskDWord, 0x6FDB25A4); -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ ODM_SetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord, 0x01c00016); -+ } -+ -+ // 3 wire Disable -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord, 0xCCF000C0); -+ -+ //BB IQK Setting -+ ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, 0x000800E4); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x22208000); -+ -+ //IQK setting tone@ 4.34Mhz -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x10008C1C); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); -+ -+ //Page B init -+ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00080000); -+ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x0f600000); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x10008c1f); -+ if(pDM_Odm->SupportICType & (ODM_RTL8723A|ODM_RTL8192C)) -+ { -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82150008); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28150008); -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82150016); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28150016); -+ } -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x001028d0); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, 0x7f, initial_gain); -+ -+ //RF loop Setting -+ if(pDM_Odm->SupportICType & (ODM_RTL8723A|ODM_RTL8192C)) -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x0, 0xFFFFF, 0x50008); -+ -+ //IQK Single tone start -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ ODM_StallExecution(10000); -+ -+ // PSD report of antenna A -+ PSD_report_tmp=0x0; -+ for (n=0;n<2;n++) -+ { -+ PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); -+ if(PSD_report_tmp >AntA_report) -+ AntA_report=PSD_report_tmp; -+ } -+ -+ // change to Antenna B -+ if(pDM_Odm->SupportICType & (ODM_RTL8723A|ODM_RTL8192C)) -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, ODM_DPDT, Antenna_B); -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ //ODM_SetBBReg(pDM_Odm, rDPDT_control, 0x3, 0x2); -+ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0xfff, 0x280); -+ ODM_SetBBReg(pDM_Odm, rAGC_table_select, BIT31, 0x1); -+ } -+ -+ ODM_StallExecution(10); -+ -+ // PSD report of antenna B -+ PSD_report_tmp=0x0; -+ for (n=0;n<2;n++) -+ { -+ PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); -+ if(PSD_report_tmp > AntB_report) -+ AntB_report=PSD_report_tmp; -+ } -+ -+ // change to open case -+ if(pDM_Odm->SupportICType & (ODM_RTL8723A|ODM_RTL8192C)) -+ { -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, ODM_DPDT, 0); // change to Antenna A -+ -+ ODM_StallExecution(10); -+ -+ // PSD report of open case -+ PSD_report_tmp=0x0; -+ for (n=0;n<2;n++) -+ { -+ PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); -+ if(PSD_report_tmp > AntO_report) -+ AntO_report=PSD_report_tmp; -+ } -+ } -+ //Close IQK Single Tone function -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ -+ //1 Return to antanna A -+ if(pDM_Odm->SupportICType & (ODM_RTL8723A|ODM_RTL8192C)) -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, ODM_DPDT, Antenna_A); // change to Antenna A -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ // external DPDT -+ ODM_SetBBReg(pDM_Odm, rDPDT_control, bMaskDWord, Reg92c); -+ -+ //internal S0/S1 -+ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord, Reg948); -+ ODM_SetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord, Regb2c); -+ ODM_SetBBReg(pDM_Odm, rfe_ctrl_anta_src, bMaskDWord, Reg930); -+ ODM_SetMACReg(pDM_Odm, rSYM_WLBT_PAPE_SEL, BIT29, Reg064); -+ } -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord, Reg88c); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, Regc08); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, Reg874); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, 0x7F, 0x40); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord, Regc50); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask,CurrentChannel); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask,RfLoopReg); -+ -+ //Reload AFE Registers -+ if(pDM_Odm->SupportICType & (ODM_RTL8723A|ODM_RTL8192C)) -+ odm_PHY_ReloadAFERegisters(pDM_Odm, AFE_REG_8723A, AFE_Backup, 16); -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ ODM_SetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord, AFE_rRx_Wait_CCA); -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8723A) -+ { -+ //2 Test Ant B based on Ant A is ON -+ if(mode==ANTTESTB) -+ { -+ if(AntA_report >= 100) -+ { -+ if(AntB_report > (AntA_report+1)) -+ { -+ pDM_SWAT_Table->ANTB_ON=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Single Antenna A\n")); -+ } -+ else -+ { -+ pDM_SWAT_Table->ANTB_ON=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Dual Antenna is A and B\n")); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Need to check again\n")); -+ pDM_SWAT_Table->ANTB_ON=FALSE; // Set Antenna B off as default -+ bResult = FALSE; -+ } -+ } -+ //2 Test Ant A and B based on DPDT Open -+ else if(mode==ANTTESTALL) -+ { -+ if((AntO_report >=100) && (AntO_report <=118)) -+ { -+ if(AntA_report > (AntO_report+1)) -+ { -+ pDM_SWAT_Table->ANTA_ON=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Ant A is OFF\n")); -+ } -+ else -+ { -+ pDM_SWAT_Table->ANTA_ON=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Ant A is ON\n")); -+ } -+ -+ if(AntB_report > (AntO_report+2)) -+ { -+ pDM_SWAT_Table->ANTB_ON=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Ant B is OFF\n")); -+ } -+ else -+ { -+ pDM_SWAT_Table->ANTB_ON=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Ant B is ON\n")); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_A[%d]= %d \n", 2416, AntA_report)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_B[%d]= %d \n", 2416, AntB_report)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_O[%d]= %d \n", 2416, AntO_report)); -+ -+ pDM_Odm->AntDetectedInfo.bAntDetected= TRUE; -+ pDM_Odm->AntDetectedInfo.dBForAntA = AntA_report; -+ pDM_Odm->AntDetectedInfo.dBForAntB = AntB_report; -+ pDM_Odm->AntDetectedInfo.dBForAntO = AntO_report; -+ -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("return FALSE!!\n")); -+ bResult = FALSE; -+ } -+ } -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8192C) -+ { -+ if(AntA_report >= 100) -+ { -+ if(AntB_report > (AntA_report+2)) -+ { -+ pDM_SWAT_Table->ANTA_ON=FALSE; -+ pDM_SWAT_Table->ANTB_ON=TRUE; -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, 0x300, Antenna_B); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Single Antenna B\n")); -+ } -+ else if(AntA_report > (AntB_report+2)) -+ { -+ pDM_SWAT_Table->ANTA_ON=TRUE; -+ pDM_SWAT_Table->ANTB_ON=FALSE; -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, 0x300, Antenna_A); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Single Antenna A\n")); -+ } -+ else -+ { -+ pDM_SWAT_Table->ANTA_ON=TRUE; -+ pDM_SWAT_Table->ANTB_ON=TRUE; -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Need to check again\n")); -+ pDM_SWAT_Table->ANTA_ON=TRUE; // Set Antenna A on as default -+ pDM_SWAT_Table->ANTB_ON=FALSE; // Set Antenna B off as default -+ bResult = FALSE; -+ } -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_A[%d]= %d \n", 2416, AntA_report)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_B[%d]= %d \n", 2416, AntB_report)); -+ -+ //2 Test Ant B based on Ant A is ON -+ if((AntA_report >= 100) && (AntB_report >= 100) && (AntA_report <= 135) && (AntB_report <= 135)) -+ { -+ u1Byte TH1=2, TH2=6; -+ -+ if((AntA_report - AntB_report < TH1) || (AntB_report - AntA_report < TH1)) -+ { -+ pDM_SWAT_Table->ANTA_ON=TRUE; -+ pDM_SWAT_Table->ANTB_ON=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SingleDualAntennaDetection(): Dual Antenna\n")); -+ } -+ else if(((AntA_report - AntB_report >= TH1) && (AntA_report - AntB_report <= TH2)) || -+ ((AntB_report - AntA_report >= TH1) && (AntB_report - AntA_report <= TH2))) -+ { -+ pDM_SWAT_Table->ANTA_ON=FALSE; -+ pDM_SWAT_Table->ANTB_ON=FALSE; -+ bResult = FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Need to check again\n")); -+ } -+ else -+ { -+ pDM_SWAT_Table->ANTA_ON = TRUE; -+ pDM_SWAT_Table->ANTB_ON=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SingleDualAntennaDetection(): Single Antenna\n")); -+ } -+ pDM_Odm->AntDetectedInfo.bAntDetected= TRUE; -+ pDM_Odm->AntDetectedInfo.dBForAntA = AntA_report; -+ pDM_Odm->AntDetectedInfo.dBForAntB = AntB_report; -+ pDM_Odm->AntDetectedInfo.dBForAntO = AntO_report; -+ -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("return FALSE!!\n")); -+ bResult = FALSE; -+ } -+ } -+ return bResult; -+ -+} -+ -+ -+ -+//1 [2. Scan AP RSSI Method] ================================================== -+ -+ -+ -+ -+BOOLEAN -+ODM_SwAntDivCheckBeforeLink( -+ IN PVOID pDM_VOID -+ ) -+{ -+ -+#if (RT_MEM_SIZE_LEVEL != RT_MEM_SIZE_MINIMUM) -+ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE* pHalData = GET_HAL_DATA(Adapter); -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ s1Byte Score = 0; -+ PRT_WLAN_BSS pTmpBssDesc, pTestBssDesc; -+ u1Byte power_target = 10, power_target_L = 9, power_target_H = 16; -+ u1Byte tmp_power_diff = 0,power_diff = 0,avg_power_diff = 0,max_power_diff = 0,min_power_diff = 0xff; -+ u2Byte index, counter = 0; -+ static u1Byte ScanChannel; -+ u8Byte tStamp_diff = 0; -+ u4Byte tmp_SWAS_NoLink_BK_Reg948; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ANTA_ON = (( %d )) , ANTB_ON = (( %d )) \n",pDM_Odm->DM_SWAT_Table.ANTA_ON ,pDM_Odm->DM_SWAT_Table.ANTB_ON )); -+ -+ //if(HP id) -+ { -+ if(pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult==TRUE && pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("8723B RSSI-based Antenna Detection is done\n")); -+ return FALSE; -+ } -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ if(pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 == 0xff) -+ pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 = ODM_Read4Byte(pDM_Odm, rS0S1_PathSwitch ); -+ } -+ } -+ -+ if (pDM_Odm->Adapter == NULL) //For BSOD when plug/unplug fast. //By YJ,120413 -+ { // The ODM structure is not initialized. -+ return FALSE; -+ } -+ -+ // Retrieve antenna detection registry info, added by Roger, 2012.11.27. -+ if(!IS_ANT_DETECT_SUPPORT_RSSI(Adapter)) -+ { -+ return FALSE; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Antenna Detection: RSSI Method\n")); -+ } -+ -+ // Since driver is going to set BB register, it shall check if there is another thread controlling BB/RF. -+ PlatformAcquireSpinLock(Adapter, RT_RF_STATE_SPINLOCK); -+ if(pHalData->eRFPowerState!=eRfOn || pMgntInfo->RFChangeInProgress || pMgntInfo->bMediaConnect) -+ { -+ PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ ("ODM_SwAntDivCheckBeforeLink(): RFChangeInProgress(%x), eRFPowerState(%x)\n", -+ pMgntInfo->RFChangeInProgress, pHalData->eRFPowerState)); -+ -+ pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ -+ return FALSE; -+ } -+ else -+ { -+ PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("pDM_SWAT_Table->SWAS_NoLink_State = %d\n", pDM_SWAT_Table->SWAS_NoLink_State)); -+ //1 Run AntDiv mechanism "Before Link" part. -+ if(pDM_SWAT_Table->SWAS_NoLink_State == 0) -+ { -+ //1 Prepare to do Scan again to check current antenna state. -+ -+ // Set check state to next step. -+ pDM_SWAT_Table->SWAS_NoLink_State = 1; -+ -+ // Copy Current Scan list. -+ pMgntInfo->tmpNumBssDesc = pMgntInfo->NumBssDesc; -+ PlatformMoveMemory((PVOID)Adapter->MgntInfo.tmpbssDesc, (PVOID)pMgntInfo->bssDesc, sizeof(RT_WLAN_BSS)*MAX_BSS_DESC); -+ -+ // Go back to scan function again. -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Scan one more time\n")); -+ pMgntInfo->ScanStep=0; -+ pMgntInfo->bScanAntDetect = TRUE; -+ ScanChannel = odm_SwAntDivSelectScanChnl(Adapter); -+ -+ -+ if(pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8821)) -+ { -+ if(pDM_FatTable->RxIdleAnt == MAIN_ANT) -+ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); -+ else -+ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); -+ if(ScanChannel == 0) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ ("ODM_SwAntDivCheckBeforeLink(): No AP List Avaiable, Using Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"AUX_ANT":"MAIN_ANT")); -+ -+ if(IS_5G_WIRELESS_MODE(pMgntInfo->dot11CurrentWirelessMode)) -+ { -+ pDM_SWAT_Table->Ant5G = pDM_FatTable->RxIdleAnt; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant5G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ } -+ else -+ { -+ pDM_SWAT_Table->Ant2G = pDM_FatTable->RxIdleAnt; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant2G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ } -+ return FALSE; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ ("ODM_SwAntDivCheckBeforeLink: Change to %s for testing.\n", ((pDM_FatTable->RxIdleAnt == MAIN_ANT)?"MAIN_ANT":"AUX_ANT"))); -+ } -+ else if(pDM_Odm->SupportICType & (ODM_RTL8192C|ODM_RTL8723B)) -+ { -+ if(pDM_Odm->SupportICType == ODM_RTL8192C) -+ { -+ // Switch Antenna to another one. -+ pDM_SWAT_Table->PreAntenna = pDM_SWAT_Table->CurAntenna; -+ pDM_SWAT_Table->CurAntenna = (pDM_SWAT_Table->CurAntenna==MAIN_ANT)?AUX_ANT:MAIN_ANT; -+ -+ pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 = ((pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 & 0xfffffcff) | (pDM_SWAT_Table->CurAntenna<<8)); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, bMaskDWord, pDM_SWAT_Table->SWAS_NoLink_BK_Reg860); -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ // Switch Antenna to another one. -+ -+ tmp_SWAS_NoLink_BK_Reg948 = ODM_Read4Byte(pDM_Odm, rS0S1_PathSwitch ); -+ -+ if( (pDM_SWAT_Table->CurAntenna = MAIN_ANT) && (tmp_SWAS_NoLink_BK_Reg948==0x200)) -+ { -+ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0xfff, 0x280); -+ ODM_SetBBReg(pDM_Odm, rAGC_table_select, BIT31, 0x1); -+ pDM_SWAT_Table->CurAntenna = AUX_ANT; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Reg[948]= (( %x )) was in wrong state\n", tmp_SWAS_NoLink_BK_Reg948 )); -+ return FALSE; -+ } -+ ODM_StallExecution(10); -+ -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Change to (( %s-ant)) for testing.\n", (pDM_SWAT_Table->CurAntenna==MAIN_ANT)?"MAIN":"AUX")); -+ } -+ -+ odm_SwAntDivConstructScanChnl(Adapter, ScanChannel); -+ PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5); -+ -+ return TRUE; -+ } -+ else //pDM_SWAT_Table->SWAS_NoLink_State == 1 -+ { -+ //1 ScanComple() is called after antenna swiched. -+ //1 Check scan result and determine which antenna is going -+ //1 to be used. -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,(" tmpNumBssDesc= (( %d )) \n",pMgntInfo->tmpNumBssDesc));// debug for Dino -+ -+ for(index = 0; index < pMgntInfo->tmpNumBssDesc; index++) -+ { -+ pTmpBssDesc = &(pMgntInfo->tmpbssDesc[index]); // Antenna 1 -+ pTestBssDesc = &(pMgntInfo->bssDesc[index]); // Antenna 2 -+ -+ if(PlatformCompareMemory(pTestBssDesc->bdBssIdBuf, pTmpBssDesc->bdBssIdBuf, 6)!=0) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): ERROR!! This shall not happen.\n")); -+ continue; -+ } -+ -+ if(pDM_Odm->SupportICType != ODM_RTL8723B) -+ { -+ if(pTmpBssDesc->ChannelNumber == ScanChannel) -+ { -+ if(pTmpBssDesc->RecvSignalPower > pTestBssDesc->RecvSignalPower) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Compare scan entry: Score++\n")); -+ RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", pTmpBssDesc->bdSsIdBuf, pTmpBssDesc->bdSsIdLen); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n\n", pTmpBssDesc->ChannelNumber, pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ -+ Score++; -+ PlatformMoveMemory(pTestBssDesc, pTmpBssDesc, sizeof(RT_WLAN_BSS)); -+ } -+ else if(pTmpBssDesc->RecvSignalPower < pTestBssDesc->RecvSignalPower) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Compare scan entry: Score--\n")); -+ RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", pTmpBssDesc->bdSsIdBuf, pTmpBssDesc->bdSsIdLen); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n\n", pTmpBssDesc->ChannelNumber, pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ Score--; -+ } -+ else -+ { -+ if(pTestBssDesc->bdTstamp - pTmpBssDesc->bdTstamp < 5000) -+ { -+ RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", pTmpBssDesc->bdSsIdBuf, pTmpBssDesc->bdSsIdLen); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n", pTmpBssDesc->ChannelNumber, pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("The 2nd Antenna didn't get this AP\n\n")); -+ } -+ } -+ } -+ } -+ else // 8723B -+ { -+ if(pTmpBssDesc->ChannelNumber == ScanChannel) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ChannelNumber == ScanChannel -> (( %d )) \n", pTmpBssDesc->ChannelNumber )); -+ -+ if(pTmpBssDesc->RecvSignalPower > pTestBssDesc->RecvSignalPower) // Pow(Ant1) > Pow(Ant2) -+ { -+ counter++; -+ tmp_power_diff=(u1Byte)(pTmpBssDesc->RecvSignalPower - pTestBssDesc->RecvSignalPower); -+ power_diff = power_diff + tmp_power_diff; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), pTmpBssDesc->bdSsIdBuf); -+ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), pTmpBssDesc->bdBssIdBuf); -+ -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("tmp_power_diff: (( %d)),max_power_diff: (( %d)),min_power_diff: (( %d)) \n", tmp_power_diff,max_power_diff,min_power_diff)); -+ if(tmp_power_diff > max_power_diff) -+ max_power_diff=tmp_power_diff; -+ if(tmp_power_diff < min_power_diff) -+ min_power_diff=tmp_power_diff; -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("max_power_diff: (( %d)),min_power_diff: (( %d)) \n",max_power_diff,min_power_diff)); -+ -+ PlatformMoveMemory(pTestBssDesc, pTmpBssDesc, sizeof(RT_WLAN_BSS)); -+ } -+ else if(pTestBssDesc->RecvSignalPower > pTmpBssDesc->RecvSignalPower) // Pow(Ant1) < Pow(Ant2) -+ { -+ counter++; -+ tmp_power_diff=(u1Byte)(pTestBssDesc->RecvSignalPower - pTmpBssDesc->RecvSignalPower); -+ power_diff = power_diff + tmp_power_diff; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), pTmpBssDesc->bdSsIdBuf); -+ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), pTmpBssDesc->bdBssIdBuf); -+ if(tmp_power_diff > max_power_diff) -+ max_power_diff=tmp_power_diff; -+ if(tmp_power_diff < min_power_diff) -+ min_power_diff=tmp_power_diff; -+ } -+ else // Pow(Ant1) = Pow(Ant2) -+ { -+ if(pTestBssDesc->bdTstamp > pTmpBssDesc->bdTstamp) // Stamp(Ant1) < Stamp(Ant2) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("time_diff: %lld\n", (pTestBssDesc->bdTstamp-pTmpBssDesc->bdTstamp)/1000)); -+ if(pTestBssDesc->bdTstamp - pTmpBssDesc->bdTstamp > 5000) -+ { -+ counter++; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), pTmpBssDesc->bdSsIdBuf); -+ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), pTmpBssDesc->bdBssIdBuf); -+ min_power_diff = 0; -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Error !!!]: Time_diff: %lld\n", (pTestBssDesc->bdTstamp-pTmpBssDesc->bdTstamp)/1000)); -+ } -+ } -+ } -+ } -+ } -+ -+ if(pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8821)) -+ { -+ if(pMgntInfo->NumBssDesc!=0 && Score<0) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ ("ODM_SwAntDivCheckBeforeLink(): Using Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ ("ODM_SwAntDivCheckBeforeLink(): Remain Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"AUX_ANT":"MAIN_ANT")); -+ -+ if(pDM_FatTable->RxIdleAnt == MAIN_ANT) -+ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); -+ else -+ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); -+ } -+ -+ if(IS_5G_WIRELESS_MODE(pMgntInfo->dot11CurrentWirelessMode)) -+ { -+ pDM_SWAT_Table->Ant5G = pDM_FatTable->RxIdleAnt; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant5G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ } -+ else -+ { -+ pDM_SWAT_Table->Ant2G = pDM_FatTable->RxIdleAnt; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant2G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ } -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ if(counter == 0) -+ { -+ if(pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec == FALSE) -+ { -+ pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec = TRUE; -+ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Counter=(( 0 )) , [[ Cannot find any AP with Aux-ant ]] -> Scan Target-channel again \n")); -+ -+ //3 [ Scan again ] -+ odm_SwAntDivConstructScanChnl(Adapter, ScanChannel); -+ PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5); -+ return TRUE; -+ } -+ else// Pre_Aux_FailDetec == TRUE -+ { -+ //2 [ Single Antenna ] -+ pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec = FALSE; -+ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Counter=(( 0 )) , [[ Still cannot find any AP ]] \n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); -+ } -+ pDM_Odm->DM_SWAT_Table.Aux_FailDetec_Counter++; -+ } -+ else -+ { -+ pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec = FALSE; -+ -+ if(counter==3) -+ { -+ avg_power_diff = ((power_diff-max_power_diff - min_power_diff)>>1)+ ((max_power_diff + min_power_diff)>>2); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("counter: (( %d )) , power_diff: (( %d )) \n", counter, power_diff)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ counter==3 ] Modified avg_power_diff: (( %d )) , max_power_diff: (( %d )) , min_power_diff: (( %d )) \n", avg_power_diff,max_power_diff, min_power_diff)); -+ } -+ else if(counter>=4) -+ { -+ avg_power_diff=(power_diff-max_power_diff - min_power_diff) / (counter - 2); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("counter: (( %d )) , power_diff: (( %d )) \n", counter, power_diff)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ counter>=4 ] Modified avg_power_diff: (( %d )) , max_power_diff: (( %d )) , min_power_diff: (( %d )) \n", avg_power_diff,max_power_diff, min_power_diff)); -+ -+ } -+ else//counter==1,2 -+ { -+ avg_power_diff=power_diff/counter; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("avg_power_diff: (( %d )) , counter: (( %d )) , power_diff: (( %d )) \n", avg_power_diff,counter, power_diff)); -+ } -+ -+ //2 [ Retry ] -+ if( (avg_power_diff >=power_target_L) && (avg_power_diff <=power_target_H) ) -+ { -+ pDM_Odm->DM_SWAT_Table.Retry_Counter++; -+ -+ if(pDM_Odm->DM_SWAT_Table.Retry_Counter<=3) -+ { -+ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[[ Low confidence result ]] avg_power_diff= (( %d )) -> Scan Target-channel again ]] \n", avg_power_diff)); -+ -+ //3 [ Scan again ] -+ odm_SwAntDivConstructScanChnl(Adapter, ScanChannel); -+ PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5); -+ return TRUE; -+ } -+ else -+ { -+ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[[ Still Low confidence result ]] (( Retry_Counter > 3 )) \n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); -+ } -+ -+ } -+ //2 [ Dual Antenna ] -+ else if( (pMgntInfo->NumBssDesc != 0) && (avg_power_diff < power_target_L) ) -+ { -+ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; -+ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == FALSE) -+ { -+ pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; -+ pDM_Odm->DM_SWAT_Table.ANTB_ON = TRUE; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SwAntDivCheckBeforeLink(): Dual antenna\n")); -+ pDM_Odm->DM_SWAT_Table.Dual_Ant_Counter++; -+ -+ // set bt coexDM from 1ant coexDM to 2ant coexDM -+ BT_SetBtCoexAntNum(Adapter, BT_COEX_ANT_TYPE_DETECTED, 2); -+ -+ //3 [ Init antenna diversity ] -+ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; -+ ODM_AntDivInit(pDM_Odm); -+ } -+ //2 [ Single Antenna ] -+ else if(avg_power_diff > power_target_H) -+ { -+ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; -+ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == TRUE) -+ { -+ pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; -+ pDM_Odm->DM_SWAT_Table.ANTB_ON = FALSE; -+ //BT_SetBtCoexAntNum(Adapter, BT_COEX_ANT_TYPE_DETECTED, 1); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); -+ pDM_Odm->DM_SWAT_Table.Single_Ant_Counter++; -+ } -+ } -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("bResult=(( %d ))\n",pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Dual_Ant_Counter = (( %d )), Single_Ant_Counter = (( %d )) , Retry_Counter = (( %d )) , Aux_FailDetec_Counter = (( %d ))\n\n\n", -+ pDM_Odm->DM_SWAT_Table.Dual_Ant_Counter,pDM_Odm->DM_SWAT_Table.Single_Ant_Counter,pDM_Odm->DM_SWAT_Table.Retry_Counter,pDM_Odm->DM_SWAT_Table.Aux_FailDetec_Counter)); -+ -+ //2 recover the antenna setting -+ -+ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == FALSE) -+ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0xfff, (pDM_SWAT_Table->SWAS_NoLink_BK_Reg948)); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("bResult=(( %d )), Recover Reg[948]= (( %x )) \n\n",pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult, pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 )); -+ -+ -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8192C) -+ { -+ if(pMgntInfo->NumBssDesc!=0 && Score<=0) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ ("ODM_SwAntDivCheckBeforeLink(): Using Ant(%s)\n", (pDM_SWAT_Table->CurAntenna==MAIN_ANT)?"MAIN":"AUX")); -+ -+ pDM_SWAT_Table->PreAntenna = pDM_SWAT_Table->CurAntenna; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ ("ODM_SwAntDivCheckBeforeLink(): Remain Ant(%s)\n", (pDM_SWAT_Table->CurAntenna==MAIN_ANT)?"AUX":"MAIN")); -+ -+ pDM_SWAT_Table->CurAntenna = pDM_SWAT_Table->PreAntenna; -+ -+ //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300, DM_SWAT_Table.CurAntenna); -+ pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 = ((pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 & 0xfffffcff) | (pDM_SWAT_Table->CurAntenna<<8)); -+ PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, bMaskDWord, pDM_SWAT_Table->SWAS_NoLink_BK_Reg860); -+ } -+ } -+ -+ // Check state reset to default and wait for next time. -+ pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ pMgntInfo->bScanAntDetect = FALSE; -+ -+ return FALSE; -+ } -+ -+#else -+ return FALSE; -+#endif -+ -+return FALSE; -+} -+ -+ -+ -+ -+ -+ -+//1 [3. PSD Method] ========================================================== -+ -+ -+ -+ -+u4Byte -+odm_GetPSDData( -+ IN PVOID pDM_VOID, -+ IN u2Byte point, -+ IN u1Byte initial_gain) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte psd_report; -+ -+ ODM_SetBBReg(pDM_Odm, 0x808, 0x3FF, point); -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 1); //Start PSD calculation, Reg808[22]=0->1 -+ ODM_StallExecution(150);//Wait for HW PSD report -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 0);//Stop PSD calculation, Reg808[22]=1->0 -+ psd_report = ODM_GetBBReg(pDM_Odm,0x8B4, bMaskDWord) & 0x0000FFFF;//Read PSD report, Reg8B4[15:0] -+ -+ psd_report = (u4Byte) (odm_ConvertTo_dB(psd_report));//+(u4Byte)(initial_gain); -+ return psd_report; -+} -+ -+ -+ -+VOID -+ODM_SingleDualAntennaDetection_PSD( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ u4Byte Channel_ori; -+ u1Byte initial_gain = 0x36; -+ u1Byte tone_idx; -+ u1Byte Tone_lenth_1=7, Tone_lenth_2=4; -+ u2Byte Tone_idx_1[7]={88, 104, 120, 8, 24, 40, 56}; -+ u2Byte Tone_idx_2[4]={8, 24, 40, 56}; -+ u4Byte PSD_report_Main[11]={0}, PSD_report_Aux[11]={0}; -+ //u1Byte Tone_lenth_1=4, Tone_lenth_2=2; -+ //u2Byte Tone_idx_1[4]={88, 120, 24, 56}; -+ //u2Byte Tone_idx_2[2]={ 24, 56}; -+ //u4Byte PSD_report_Main[6]={0}, PSD_report_Aux[6]={0}; -+ -+ u4Byte PSD_report_temp,MAX_PSD_report_Main=0,MAX_PSD_report_Aux=0; -+ u4Byte PSD_power_threshold; -+ u4Byte Main_psd_result=0, Aux_psd_result=0; -+ u4Byte Regc50, Reg948, Regb2c,Regc14,Reg908; -+ u4Byte i=0,test_num=8; -+ -+ -+ if(pDM_Odm->SupportICType != ODM_RTL8723B) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection_PSD()============> \n")); -+ -+ //2 [ Backup Current RF/BB Settings ] -+ -+ Channel_ori = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask); -+ Reg948 = ODM_GetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord); -+ Regb2c = ODM_GetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord); -+ Regc50 = ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord); -+ Regc14 = ODM_GetBBReg(pDM_Odm, 0xc14, bMaskDWord); -+ Reg908 = ODM_GetBBReg(pDM_Odm, 0x908, bMaskDWord); -+ -+ //2 [ Setting for doing PSD function (CH4)] -+ ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 0); //disable whole CCK block -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0xFF); // Turn off TX -> Pause TX Queue -+ ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, 0x0); // [ Set IQK Matrix = 0 ] equivalent to [ Turn off CCA] -+ -+ // PHYTXON while loop -+ ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, 0x803); -+ while (ODM_GetBBReg(pDM_Odm, 0xdf4, BIT6)) -+ { -+ i++; -+ if (i > 1000000) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Wait in %s() more than %d times!\n", __FUNCTION__, i)); -+ break; -+ } -+ } -+ -+ ODM_SetBBReg(pDM_Odm, 0xc50, 0x7f, initial_gain); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); // Set RF to CH4 & 40M -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0xf); // 3 wire Disable 88c[23:20]=0xf -+ ODM_SetBBReg(pDM_Odm, rFPGA0_PSDFunction, BIT14|BIT15, 0x0); //128 pt //Set PSD 128 ptss -+ ODM_StallExecution(3000); -+ -+ -+ //2 [ Doing PSD Function in (CH4)] -+ -+ //Antenna A -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Main-ant (CH4)\n")); -+ ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x200); -+ ODM_StallExecution(10); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("dbg\n")); -+ for (i=0;iPSD_report_Main[tone_idx] ) -+ PSD_report_Main[tone_idx]+=PSD_report_temp; -+ } -+ } -+ //Antenna B -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Aux-ant (CH4)\n")); -+ ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x280); -+ ODM_StallExecution(10); -+ for (i=0;iPSD_report_Aux[tone_idx] ) -+ PSD_report_Aux[tone_idx]+=PSD_report_temp; -+ } -+ } -+ //2 [ Doing PSD Function in (CH8)] -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0x0); // 3 wire enable 88c[23:20]=0x0 -+ ODM_StallExecution(3000); -+ -+ ODM_SetBBReg(pDM_Odm, 0xc50, 0x7f, initial_gain); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); // Set RF to CH8 & 40M -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0xf); // 3 wire Disable 88c[23:20]=0xf -+ ODM_StallExecution(3000); -+ -+ //Antenna A -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Main-ant (CH8)\n")); -+ ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x200); -+ ODM_StallExecution(10); -+ -+ for (i=0;iPSD_report_Main[tone_idx] ) -+ PSD_report_Main[Tone_lenth_1+tone_idx]+=PSD_report_temp; -+ } -+ } -+ -+ //Antenna B -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Aux-ant (CH8)\n")); -+ ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x280); -+ ODM_StallExecution(10); -+ -+ for (i=0;iPSD_report_Aux[tone_idx] ) -+ PSD_report_Aux[Tone_lenth_1+tone_idx]+=PSD_report_temp; -+ } -+ } -+ -+ //2 [ Calculate Result ] -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\nMain PSD Result: (ALL) \n")); -+ for (tone_idx=0;tone_idx<(Tone_lenth_1+Tone_lenth_2);tone_idx++) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Tone-%d]: %d, \n",(tone_idx+1), PSD_report_Main[tone_idx] )); -+ Main_psd_result+= PSD_report_Main[tone_idx]; -+ if(PSD_report_Main[tone_idx]>MAX_PSD_report_Main) -+ MAX_PSD_report_Main=PSD_report_Main[tone_idx]; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("--------------------------- \nTotal_Main= (( %d ))\n", Main_psd_result)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("MAX_Main = (( %d ))\n", MAX_PSD_report_Main)); -+ -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\nAux PSD Result: (ALL) \n")); -+ for (tone_idx=0;tone_idx<(Tone_lenth_1+Tone_lenth_2);tone_idx++) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Tone-%d]: %d, \n",(tone_idx+1), PSD_report_Aux[tone_idx] )); -+ Aux_psd_result+= PSD_report_Aux[tone_idx]; -+ if(PSD_report_Aux[tone_idx]>MAX_PSD_report_Aux) -+ MAX_PSD_report_Aux=PSD_report_Aux[tone_idx]; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("--------------------------- \nTotal_Aux= (( %d ))\n", Aux_psd_result)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("MAX_Aux = (( %d ))\n\n", MAX_PSD_report_Aux)); -+ -+ //Main_psd_result=Main_psd_result-MAX_PSD_report_Main; -+ //Aux_psd_result=Aux_psd_result-MAX_PSD_report_Aux; -+ PSD_power_threshold=(Main_psd_result*7)>>3; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Main_result , Aux_result ] = [ %d , %d ], PSD_power_threshold=(( %d ))\n", Main_psd_result, Aux_psd_result,PSD_power_threshold)); -+ -+ //3 [ Dual Antenna ] -+ if(Aux_psd_result >= PSD_power_threshold ) -+ { -+ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == FALSE) -+ { -+ pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; -+ pDM_Odm->DM_SWAT_Table.ANTB_ON = TRUE; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SwAntDivCheckBeforeLink(): Dual antenna\n")); -+ -+ // set bt coexDM from 1ant coexDM to 2ant coexDM -+ //BT_SetBtCoexAntNum(pAdapter, BT_COEX_ANT_TYPE_DETECTED, 2); -+ -+ // Init antenna diversity -+ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; -+ ODM_AntDivInit(pDM_Odm); -+ } -+ //3 [ Single Antenna ] -+ else -+ { -+ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == TRUE) -+ { -+ pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; -+ pDM_Odm->DM_SWAT_Table.ANTB_ON = FALSE; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); -+ } -+ -+ //2 [ Recover all parameters ] -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask,Channel_ori); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0x0); // 3 wire enable 88c[23:20]=0x0 -+ ODM_SetBBReg(pDM_Odm, 0xc50, 0x7f, Regc50); -+ -+ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord, Reg948); -+ ODM_SetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord, Regb2c); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 1); //enable whole CCK block -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0x0); //Turn on TX // Resume TX Queue -+ ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, Regc14); // [ Set IQK Matrix = 0 ] equivalent to [ Turn on CCA] -+ ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, Reg908); -+ -+ return; -+ -+} -+ -+#endif -+void -+odm_SwAntDetectInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if(defined(CONFIG_ANT_DETECTION)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ //pDM_SWAT_Table->SWAS_NoLink_BK_Reg92c = ODM_Read4Byte(pDM_Odm, rDPDT_control); -+ //pDM_SWAT_Table->PreAntenna = MAIN_ANT; -+ //pDM_SWAT_Table->CurAntenna = MAIN_ANT; -+ pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ pDM_SWAT_Table->Pre_Aux_FailDetec = FALSE; -+ pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 = 0xff; -+#endif -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_antdect.h linux/3rdparty/rtl8812au/hal/phydm/phydm_antdect.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_antdect.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_antdect.h 2017-06-07 23:07:21.016688031 +0300 -@@ -0,0 +1,98 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMANTDECT_H__ -+#define __PHYDMANTDECT_H__ -+ -+#define ANTDECT_VERSION "2.0" //2014.11.04 -+ -+#if(defined(CONFIG_ANT_DETECTION)) -+//#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN |ODM_CE)) -+//ANT Test -+#define ANTTESTALL 0x00 /*Ant A or B will be Testing*/ -+#define ANTTESTA 0x01 /*Ant A will be Testing*/ -+#define ANTTESTB 0x02 /*Ant B will be testing*/ -+ -+#define MAX_ANTENNA_DETECTION_CNT 10 -+ -+ -+typedef struct _ANT_DETECTED_INFO{ -+ BOOLEAN bAntDetected; -+ u4Byte dBForAntA; -+ u4Byte dBForAntB; -+ u4Byte dBForAntO; -+}ANT_DETECTED_INFO, *PANT_DETECTED_INFO; -+ -+ -+typedef enum tag_SW_Antenna_Switch_Definition -+{ -+ Antenna_A = 1, -+ Antenna_B = 2, -+ Antenna_MAX = 3, -+}DM_SWAS_E; -+ -+ -+ -+//1 [1. Single Tone Method] =================================================== -+ -+ -+ -+VOID -+ODM_SingleDualAntennaDefaultSetting( -+ IN PVOID pDM_VOID -+ ); -+ -+BOOLEAN -+ODM_SingleDualAntennaDetection( -+ IN PVOID pDM_VOID, -+ IN u1Byte mode -+ ); -+ -+//1 [2. Scan AP RSSI Method] ================================================== -+ -+#define SwAntDivCheckBeforeLink ODM_SwAntDivCheckBeforeLink -+ -+BOOLEAN -+ODM_SwAntDivCheckBeforeLink( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+ -+ -+//1 [3. PSD Method] ========================================================== -+ -+ -+VOID -+ODM_SingleDualAntennaDetection_PSD( -+ IN PVOID pDM_VOID -+); -+ -+#endif -+ -+VOID -+odm_SwAntDetectInit( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+#endif -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_antdiv.c linux/3rdparty/rtl8812au/hal/phydm/phydm_antdiv.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_antdiv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_antdiv.c 2017-06-07 23:07:21.017688123 +0300 -@@ -0,0 +1,4771 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+//====================================================== -+// when antenna test utility is on or some testing need to disable antenna diversity -+// call this function to disable all ODM related mechanisms which will switch antenna. -+//====================================================== -+VOID -+ODM_StopAntennaSwitchDm( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ // disable ODM antenna diversity -+ pDM_Odm->SupportAbility &= ~ODM_BB_ANT_DIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("STOP Antenna Diversity \n")); -+} -+ -+VOID -+ODM_SetAntConfig( -+ IN PVOID pDM_VOID, -+ IN u1Byte antSetting // 0=A, 1=B, 2=C, .... -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ if(antSetting == 0) // ant A -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x00000000); -+ else if(antSetting == 1) -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x00000280); -+ } -+} -+ -+//====================================================== -+ -+ -+VOID -+ODM_SwAntDivRestAfterLink( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u4Byte i; -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8723A) -+ { -+ pDM_SWAT_Table->RSSI_cnt_A = 0; -+ pDM_SWAT_Table->RSSI_cnt_B = 0; -+ pDM_Odm->RSSI_test = FALSE; -+ pDM_SWAT_Table->try_flag = 0xff; -+ pDM_SWAT_Table->RSSI_Trying = 0; -+ pDM_SWAT_Table->SelectAntennaMap=0xAA; -+ -+ } -+ else if(pDM_Odm->SupportICType & (ODM_RTL8723B|ODM_RTL8821)) -+ { -+ pDM_Odm->RSSI_test = FALSE; -+ pDM_SWAT_Table->try_flag = 0xff; -+ pDM_SWAT_Table->RSSI_Trying = 0; -+ pDM_SWAT_Table->Double_chk_flag= 0; -+ -+ pDM_FatTable->RxIdleAnt=MAIN_ANT; -+ -+ for (i=0; iMainAnt_Sum[i] = 0; -+ pDM_FatTable->AuxAnt_Sum[i] = 0; -+ pDM_FatTable->MainAnt_Cnt[i] = 0; -+ pDM_FatTable->AuxAnt_Cnt[i] = 0; -+ } -+ -+ } -+} -+ -+ -+#if (defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+VOID -+odm_AntDiv_on_off( -+ IN PVOID pDM_VOID , -+ IN u1Byte swch -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ if(pDM_FatTable->AntDiv_OnOff != swch) -+ { -+ if(pDM_Odm->AntDivType==S0S1_SW_ANTDIV || pDM_Odm->AntDivType==CGCS_RX_SW_ANTDIV) -+ return; -+ -+ if(pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) N-Series HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT7, swch); //OFDM AntDiv function block enable -+ ODM_SetBBReg(pDM_Odm, 0xa00 , BIT15, swch); //CCK AntDiv function block enable -+ } -+ else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) AC-Series HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); -+ if (pDM_Odm->SupportICType == ODM_RTL8812) { -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT7, swch); //OFDM AntDiv function block enable -+ ODM_SetBBReg(pDM_Odm, 0xa00 , BIT15, swch); //CCK AntDiv function block enable -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , BIT24, swch); //OFDM AntDiv function block enable -+ -+ if( (pDM_Odm->CutVersion >= ODM_CUT_C) && (pDM_Odm->SupportICType == ODM_RTL8821) && ( pDM_Odm->AntDivType != S0S1_SW_ANTDIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) CCK HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); -+ ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, swch); -+ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, swch); //CCK AntDiv function block enable -+ } -+ } -+ } -+ } -+ pDM_FatTable->AntDiv_OnOff =swch; -+ -+} -+ -+VOID -+phydm_FastTraining_enable( -+ IN PVOID pDM_VOID, -+ IN u1Byte swch -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte enable; -+ -+ if (swch == FAT_ON) -+ enable=1; -+ else -+ enable=0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fast Ant Training_en = ((%d))\n", enable)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+ ODM_SetBBReg(pDM_Odm, 0xe08 , BIT16, enable); /*enable fast training*/ -+ /**/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { -+ ODM_SetBBReg(pDM_Odm, 0xB34 , BIT28, enable); /*enable fast training (path-A)*/ -+ /*ODM_SetBBReg(pDM_Odm, 0xB34 , BIT29, enable);*/ /*enable fast training (path-B)*/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8821) { -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT19, enable); /*enable fast training */ -+ /**/ -+ } -+} -+ -+VOID -+odm_Tx_By_TxDesc_or_Reg( -+ IN PVOID pDM_VOID, -+ IN u1Byte swch -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte enable; -+ -+ if( swch== TX_BY_DESC) -+ enable=1; -+ else -+ enable=0; -+ -+ if(pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) -+ { -+ if(pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x80c , BIT21, enable); -+ } -+ else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, enable); -+ } -+ } -+} -+ -+ -+u1Byte -+phydm_traffic_load_decision( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ u8Byte curTxOkCnt = 0, curRxOkCnt = 0; -+ u1Byte traffic; -+ -+ /*---trafic load decision---*/ -+ curTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast) - pDM_SWAT_Table->lastTxOkCnt; -+ curRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast) - pDM_SWAT_Table->lastRxOkCnt; -+ pDM_SWAT_Table->lastTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast); -+ pDM_SWAT_Table->lastRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("TxOkCnt=(( %llu )), RxOkCnt=(( %llu ))\n", -+ curTxOkCnt, curRxOkCnt)); -+ -+ if (curTxOkCnt > 1875000 || curRxOkCnt > 1875000) {/*if(PlatformDivision64(curTxOkCnt+curRxOkCnt, 2) > 1875000) ( 1.875M * 8bit ) / 2= 7.5M bits /sec )*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[HIGH Traffic]\n")); -+ traffic = TRAFFIC_HIGH; -+ } else if (curTxOkCnt > 125000 || curRxOkCnt > 125000) { /*( 0.125M * 8bit ) / 2 = 0.5M bits /sec )*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Low Traffic]\n")); -+ traffic = TRAFFIC_LOW; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Ultra-Low Traffic]\n")); -+ traffic = TRAFFIC_ULTRA_LOW; -+ } -+ return traffic; -+} -+ -+VOID -+ODM_UpdateRxIdleAnt( -+ IN PVOID pDM_VOID, -+ IN u1Byte Ant -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u4Byte DefaultAnt, OptionalAnt,value32; -+ -+ if(pDM_FatTable->RxIdleAnt != Ant) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] RxIdleAnt =%s\n",(Ant==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ -+ if(!(pDM_Odm->SupportICType & ODM_RTL8723B)) -+ pDM_FatTable->RxIdleAnt = Ant; -+ -+ if(Ant == MAIN_ANT) -+ { -+ DefaultAnt = ANT1_2G; -+ OptionalAnt = ANT2_2G; -+ } -+ else -+ { -+ DefaultAnt = ANT2_2G; -+ OptionalAnt = ANT1_2G; -+ } -+ -+ if(pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) -+ { -+ if(pDM_Odm->SupportICType==ODM_RTL8192E) -+ { -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT5|BIT4|BIT3, DefaultAnt); //Default RX -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT8|BIT7|BIT6, OptionalAnt);//Optional RX -+ ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, DefaultAnt);//Default TX -+ } -+ #if (RTL8723B_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType==ODM_RTL8723B) -+ { -+ value32 = ODM_GetBBReg(pDM_Odm, 0x948, 0xFFF); -+ -+ if(value32 !=0x280) -+ ODM_UpdateRxIdleAnt_8723B(pDM_Odm, Ant, DefaultAnt, OptionalAnt); -+ else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to 0x948 = 0x280\n")); -+ } -+ #endif -+ else //88E -+ { -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, DefaultAnt); //Default RX -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, OptionalAnt); //Optional RX -+ ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, DefaultAnt); //Default TX -+ } -+ } -+ else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) -+ { -+ u2Byte value16 = ODM_Read2Byte(pDM_Odm, ODM_REG_TRMUX_11AC+2); -+ // -+ // 2014/01/14 MH/Luke.Lee Add direct write for register 0xc0a to prevnt -+ // incorrect 0xc08 bit0-15 .We still not know why it is changed. -+ // -+ value16 &= ~(BIT11|BIT10|BIT9|BIT8|BIT7|BIT6|BIT5|BIT4|BIT3); -+ value16 |= ((u2Byte)DefaultAnt <<3); -+ value16 |= ((u2Byte)OptionalAnt <<6); -+ value16 |= ((u2Byte)DefaultAnt <<9); -+ ODM_Write2Byte(pDM_Odm, ODM_REG_TRMUX_11AC+2, value16); -+ /* -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC , BIT21|BIT20|BIT19, DefaultAnt); //Default RX -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC , BIT24|BIT23|BIT22, OptionalAnt);//Optional RX -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC , BIT27|BIT26|BIT25, DefaultAnt); //Default TX -+ */ -+ } -+ -+ if(pDM_Odm->SupportICType==ODM_RTL8188E) -+ { -+ ODM_SetMACReg(pDM_Odm, 0x6D8 , BIT7|BIT6, DefaultAnt); //PathA Resp Tx -+ } -+ else -+ { -+ ODM_SetMACReg(pDM_Odm, 0x6D8 , BIT10|BIT9|BIT8, DefaultAnt); //PathA Resp Tx -+ } -+ -+ } -+ else// pDM_FatTable->RxIdleAnt == Ant -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Stay in Ori-Ant ] RxIdleAnt =%s\n",(Ant==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ pDM_FatTable->RxIdleAnt = Ant; -+ } -+} -+ -+VOID -+odm_UpdateTxAnt( -+ IN PVOID pDM_VOID, -+ IN u1Byte Ant, -+ IN u4Byte MacId -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u1Byte TxAnt; -+ -+ if (pDM_Odm->AntDivType==CG_TRX_SMART_ANTDIV) -+ { -+ TxAnt=Ant; -+ } -+ else -+ { -+ if(Ant == MAIN_ANT) -+ TxAnt = ANT1_2G; -+ else -+ TxAnt = ANT2_2G; -+ } -+ -+ pDM_FatTable->antsel_a[MacId] = TxAnt&BIT0; -+ pDM_FatTable->antsel_b[MacId] = (TxAnt&BIT1)>>1; -+ pDM_FatTable->antsel_c[MacId] = (TxAnt&BIT2)>>2; -+ -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Tx from TxInfo]: MacID:(( %d )), TxAnt = (( %s ))\n", MacId,(Ant==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("antsel_tr_mux=(( 3'b%d%d%d ))\n",pDM_FatTable->antsel_c[MacId] , pDM_FatTable->antsel_b[MacId] , pDM_FatTable->antsel_a[MacId] )); -+ -+} -+ -+#ifdef BEAMFORMING_SUPPORT -+#if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+VOID -+odm_BDC_Init( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pBDC_T pDM_BdcTable=&pDM_Odm->DM_BdcTable; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n[ BDC Initialization......] \n")); -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ pDM_BdcTable->BDC_Mode=BDC_MODE_NULL; -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDCcoexType_wBfer=0; -+ pDM_Odm->bdc_holdstate=0xff; -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ ODM_SetBBReg(pDM_Odm, 0xd7c , 0x0FFFFFFF, 0x1081008); -+ ODM_SetBBReg(pDM_Odm, 0xd80 , 0x0FFFFFFF, 0); -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x9b0 , 0x0FFFFFFF, 0x1081008); //0x9b0[30:0] = 01081008 -+ ODM_SetBBReg(pDM_Odm, 0x9b4 , 0x0FFFFFFF, 0); //0x9b4[31:0] = 00000000 -+ } -+ -+} -+ -+ -+VOID -+odm_CSI_on_off( -+ IN PVOID pDM_VOID, -+ IN u1Byte CSI_en -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if(CSI_en==CSI_ON) -+ { -+ if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ ODM_SetMACReg(pDM_Odm, 0xd84 , BIT11, 1); //0xd84[11]=1 -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ ODM_SetMACReg(pDM_Odm, 0x9b0 , BIT31, 1); //0x9b0[31]=1 -+ } -+ -+ } -+ else if(CSI_en==CSI_OFF) -+ { -+ if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ ODM_SetMACReg(pDM_Odm, 0xd84 , BIT11, 0); //0xd84[11]=0 -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ ODM_SetMACReg(pDM_Odm, 0x9b0 , BIT31, 0); //0x9b0[31]=0 -+ } -+ } -+} -+ -+VOID -+odm_BDCcoexType_withBferClient( -+ IN PVOID pDM_VOID, -+ IN u1Byte swch -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; -+ u1Byte BDCcoexType_wBfer; -+ -+ if(swch==DIVON_CSIOFF) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BDCcoexType: 1] {DIV,CSI} ={1,0} \n")); -+ BDCcoexType_wBfer=1; -+ -+ if(BDCcoexType_wBfer != pDM_BdcTable->BDCcoexType_wBfer) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ odm_CSI_on_off(pDM_Odm,CSI_OFF); -+ pDM_BdcTable->BDCcoexType_wBfer=1; -+ } -+ } -+ else if(swch==DIVOFF_CSION) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BDCcoexType: 2] {DIV,CSI} ={0,1}\n")); -+ BDCcoexType_wBfer=2; -+ -+ if(BDCcoexType_wBfer != pDM_BdcTable->BDCcoexType_wBfer) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ odm_CSI_on_off(pDM_Odm,CSI_ON); -+ pDM_BdcTable->BDCcoexType_wBfer=2; -+ } -+ } -+} -+ -+VOID -+odm_BF_AntDiv_ModeArbitration( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; -+ u1Byte current_BDC_Mode; -+ -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n")); -+ -+ //2 Mode 1 -+ if((pDM_BdcTable->num_Txbfee_Client !=0) && (pDM_BdcTable->num_Txbfer_Client == 0)) -+ { -+ current_BDC_Mode=BDC_MODE_1; -+ -+ if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) -+ { -+ pDM_BdcTable->BDC_Mode=BDC_MODE_1; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ pDM_BdcTable->BDC_RxIdleUpdate_counter=1; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode1 ))\n")); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode1 ))\n")); -+ } -+ //2 Mode 2 -+ else if((pDM_BdcTable->num_Txbfee_Client ==0) && (pDM_BdcTable->num_Txbfer_Client != 0)) -+ { -+ current_BDC_Mode=BDC_MODE_2; -+ -+ if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) -+ { -+ pDM_BdcTable->BDC_Mode=BDC_MODE_2; -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ pDM_BdcTable->BDC_Try_flag=0; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode2 ))\n")); -+ -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode2 ))\n")); -+ } -+ //2 Mode 3 -+ else if((pDM_BdcTable->num_Txbfee_Client !=0) && (pDM_BdcTable->num_Txbfer_Client != 0)) -+ { -+ current_BDC_Mode=BDC_MODE_3; -+ -+ if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) -+ { -+ pDM_BdcTable->BDC_Mode=BDC_MODE_3; -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_RxIdleUpdate_counter=1; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode3 ))\n")); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode3 ))\n")); -+ } -+ //2 Mode 4 -+ else if((pDM_BdcTable->num_Txbfee_Client ==0) && (pDM_BdcTable->num_Txbfer_Client == 0)) -+ { -+ current_BDC_Mode=BDC_MODE_4; -+ -+ if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) -+ { -+ pDM_BdcTable->BDC_Mode=BDC_MODE_4; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode4 ))\n")); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode4 ))\n")); -+ } -+ #endif -+ -+} -+ -+VOID -+odm_DivTrainState_setting( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pBDC_T pDM_BdcTable=&pDM_Odm->DM_BdcTable; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n*****[S T A R T ]***** [2-0. DIV_TRAIN_STATE] \n")); -+ pDM_BdcTable->BDC_Try_counter =2; -+ pDM_BdcTable->BDC_Try_flag=1; -+ pDM_BdcTable->BDC_state=BDC_BFer_TRAIN_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+} -+ -+VOID -+odm_BDCcoex_BFeeRxDiv_Arbitration( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; -+ BOOLEAN StopBF_flag; -+ u1Byte BDC_active_Mode; -+ -+ -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{ num_BFee, num_BFer , num_Client} = (( %d , %d , %d)) \n",pDM_BdcTable->num_Txbfee_Client,pDM_BdcTable->num_Txbfer_Client,pDM_BdcTable->num_Client)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{ num_BF_tars, num_DIV_tars } = (( %d , %d )) \n",pDM_BdcTable->num_BfTar , pDM_BdcTable->num_DivTar )); -+ -+ //2 [ MIB control ] -+ if (pDM_Odm->bdc_holdstate==2) -+ { -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ pDM_BdcTable->BDC_state=BDC_BF_HOLD_STATE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ BF STATE] \n")); -+ return; -+ } -+ else if (pDM_Odm->bdc_holdstate==1) -+ { -+ pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ DIV STATE] \n")); -+ return; -+ } -+ -+ //------------------------------------------------------------ -+ -+ -+ -+ //2 Mode 2 & 3 -+ if(pDM_BdcTable->BDC_Mode==BDC_MODE_2 ||pDM_BdcTable->BDC_Mode==BDC_MODE_3) -+ { -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n{ Try_flag , Try_counter } = { %d , %d } \n",pDM_BdcTable->BDC_Try_flag,pDM_BdcTable->BDC_Try_counter)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BDCcoexType = (( %d )) \n\n", pDM_BdcTable->BDCcoexType_wBfer)); -+ -+ // All Client have Bfer-Cap------------------------------- -+ if(pDM_BdcTable->num_Txbfer_Client == pDM_BdcTable->num_Client) //BFer STA Only?: yes -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BFer STA only? (( Yes ))\n")); -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ return; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BFer STA only? (( No ))\n")); -+ } -+ // -+ if(pDM_BdcTable->bAll_BFSta_Idle==FALSE && pDM_BdcTable->bAll_DivSta_Idle==TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("All DIV-STA are idle, but BF-STA not\n")); -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_state=BDC_BFer_TRAIN_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ return; -+ } -+ else if(pDM_BdcTable->bAll_BFSta_Idle==TRUE && pDM_BdcTable->bAll_DivSta_Idle==FALSE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("All BF-STA are idle, but DIV-STA not\n")); -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ return; -+ } -+ -+ //Select active mode-------------------------------------- -+ if(pDM_BdcTable->num_BfTar ==0) // Selsect_1, Selsect_2 -+ { -+ if(pDM_BdcTable->num_DivTar ==0) // Selsect_3 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 1 )) \n")); -+ pDM_BdcTable->BDC_active_Mode=1; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 2 ))\n")); -+ pDM_BdcTable->BDC_active_Mode=2; -+ } -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ return; -+ } -+ else // num_BfTar > 0 -+ { -+ if(pDM_BdcTable->num_DivTar ==0) // Selsect_3 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 3 ))\n")); -+ pDM_BdcTable->BDC_active_Mode=3; -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_state=BDC_BFer_TRAIN_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ return; -+ } -+ else // Selsect_4 -+ { -+ BDC_active_Mode=4; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 4 ))\n")); -+ -+ if(BDC_active_Mode!=pDM_BdcTable->BDC_active_Mode) -+ { -+ pDM_BdcTable->BDC_active_Mode=4; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to active mode (( 4 )) & return!!! \n")); -+ return; -+ } -+ } -+ } -+ -+#if 1 -+ if (pDM_Odm->bdc_holdstate==0xff) -+ { -+ pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ DIV STATE] \n")); -+ return; -+ } -+#endif -+ -+ // Does Client number changed ? ------------------------------- -+ if(pDM_BdcTable->num_Client !=pDM_BdcTable->pre_num_Client) -+ { -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ The number of client has been changed !!!] return to (( BDC_DIV_TRAIN_STATE )) \n")); -+ } -+ pDM_BdcTable->pre_num_Client=pDM_BdcTable->num_Client; -+ -+ if( pDM_BdcTable->BDC_Try_flag==0) -+ { -+ //2 DIV_TRAIN_STATE (Mode 2-0) -+ if(pDM_BdcTable->BDC_state==BDC_DIV_TRAIN_STATE) -+ { -+ odm_DivTrainState_setting( pDM_Odm); -+ } -+ //2 BFer_TRAIN_STATE (Mode 2-1) -+ else if(pDM_BdcTable->BDC_state==BDC_BFer_TRAIN_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-1. BFer_TRAIN_STATE ]***** \n")); -+ -+ //if(pDM_BdcTable->num_BfTar==0) -+ //{ -+ // ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( No )), [ BDC_BFer_TRAIN_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); -+ // odm_DivTrainState_setting( pDM_Odm); -+ //} -+ //else //num_BfTar != 0 -+ //{ -+ pDM_BdcTable->BDC_Try_counter=2; -+ pDM_BdcTable->BDC_Try_flag=1; -+ pDM_BdcTable->BDC_state=BDC_DECISION_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes )), [ BDC_BFer_TRAIN_STATE ] >> [BDC_DECISION_STATE] \n")); -+ //} -+ } -+ //2 DECISION_STATE (Mode 2-2) -+ else if(pDM_BdcTable->BDC_state==BDC_DECISION_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-2. DECISION_STATE]***** \n")); -+ //if(pDM_BdcTable->num_BfTar==0) -+ //{ -+ // ODM_AntDiv_Printk(("BF_tars exist? : (( No )), [ DECISION_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); -+ // odm_DivTrainState_setting( pDM_Odm); -+ //} -+ //else //num_BfTar != 0 -+ //{ -+ if(pDM_BdcTable->BF_pass==FALSE || pDM_BdcTable->DIV_pass == FALSE) -+ StopBF_flag=TRUE; -+ else -+ StopBF_flag=FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes )), {BF_pass, DIV_pass, StopBF_flag } = { %d, %d, %d } \n" ,pDM_BdcTable->BF_pass,pDM_BdcTable->DIV_pass,StopBF_flag)); -+ -+ if(StopBF_flag==TRUE) //DIV_en -+ { -+ pDM_BdcTable->BDC_Hold_counter=10; //20 -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ StopBF_flag= ((TRUE)), BDC_DECISION_STATE ] >> [BDC_DIV_HOLD_STATE] \n")); -+ } -+ else //BF_en -+ { -+ pDM_BdcTable->BDC_Hold_counter=10; //20 -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ pDM_BdcTable->BDC_state=BDC_BF_HOLD_STATE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[StopBF_flag= ((FALSE)), BDC_DECISION_STATE ] >> [BDC_BF_HOLD_STATE] \n")); -+ } -+ //} -+ } -+ //2 BF-HOLD_STATE (Mode 2-3) -+ else if(pDM_BdcTable->BDC_state==BDC_BF_HOLD_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-3. BF_HOLD_STATE ]*****\n")); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BDC_Hold_counter = (( %d )) \n",pDM_BdcTable->BDC_Hold_counter )); -+ -+ if(pDM_BdcTable->BDC_Hold_counter==1) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); -+ odm_DivTrainState_setting( pDM_Odm); -+ } -+ else -+ { -+ pDM_BdcTable->BDC_Hold_counter--; -+ -+ //if(pDM_BdcTable->num_BfTar==0) -+ //{ -+ // ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( No )), [ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); -+ // odm_DivTrainState_setting( pDM_Odm); -+ //} -+ //else //num_BfTar != 0 -+ //{ -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes ))\n")); -+ pDM_BdcTable->BDC_state=BDC_BF_HOLD_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_BF_HOLD_STATE ] >> [BDC_BF_HOLD_STATE] \n")); -+ //} -+ } -+ -+ } -+ //2 DIV-HOLD_STATE (Mode 2-4) -+ else if(pDM_BdcTable->BDC_state==BDC_DIV_HOLD_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-4. DIV_HOLD_STATE ]*****\n")); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BDC_Hold_counter = (( %d )) \n",pDM_BdcTable->BDC_Hold_counter )); -+ -+ if(pDM_BdcTable->BDC_Hold_counter==1) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); -+ odm_DivTrainState_setting( pDM_Odm); -+ } -+ else -+ { -+ pDM_BdcTable->BDC_Hold_counter--; -+ pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_HOLD_STATE] \n")); -+ } -+ -+ } -+ -+ } -+ else if( pDM_BdcTable->BDC_Try_flag==1) -+ { -+ //2 Set Training Counter -+ if(pDM_BdcTable->BDC_Try_counter >1) -+ { -+ pDM_BdcTable->BDC_Try_counter--; -+ if(pDM_BdcTable->BDC_Try_counter ==1) -+ pDM_BdcTable->BDC_Try_flag=0; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training !!\n")); -+ //return ; -+ } -+ -+ } -+ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n[end]\n")); -+ -+ #endif //#if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ -+ -+ -+ -+ -+} -+ -+#endif -+#endif //#ifdef BEAMFORMING_SUPPORT -+ -+ -+#if (RTL8188E_SUPPORT == 1) -+ -+ -+VOID -+odm_RX_HWAntDiv_Init_88E( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte value32; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ -+ if(pDM_Odm->mp_mode == TRUE) -+ { -+ pDM_Odm->AntDivType = CGCS_RX_SW_ANTDIV; -+ ODM_SetBBReg(pDM_Odm, ODM_REG_IGI_A_11N , BIT7, 0); // disable HW AntDiv -+ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT31, 1); // 1:CG, 0:CS -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => AntDivType=[CGCS_RX_HW_ANTDIV]\n")); -+ -+ //MAC Setting -+ value32 = ODM_GetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord); -+ ODM_SetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord, value32|(BIT23|BIT25)); //Reg4C[25]=1, Reg4C[23]=1 for pin output -+ //Pin Settings -+ ODM_SetBBReg(pDM_Odm, ODM_REG_PIN_CTRL_11N , BIT9|BIT8, 0);//Reg870[8]=1'b0, Reg870[9]=1'b0 //antsel antselb by HW -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_ANT_CTRL_11N , BIT10, 0); //Reg864[10]=1'b0 //antsel2 by HW -+ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT22, 1); //Regb2c[22]=1'b0 //disable CS/CG switch -+ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT31, 1); //Regb2c[31]=1'b1 //output at CG only -+ //OFDM Settings -+ ODM_SetBBReg(pDM_Odm, ODM_REG_ANTDIV_PARA1_11N , bMaskDWord, 0x000000a0); -+ //CCK Settings -+ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_PWR_SAV4_11N , BIT7, 1); //Fix CCK PHY status report issue -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_ANTDIV_PARA2_11N , BIT4, 1); //CCK complete HW AntDiv within 64 samples -+ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_ANT_MAPPING1_11N , 0xFFFF, 0x0001); //antenna mapping table -+ -+ pDM_FatTable->enable_ctrl_frame_antdiv = 1; -+} -+ -+VOID -+odm_TRX_HWAntDiv_Init_88E( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte value32; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ if(pDM_Odm->mp_mode == TRUE) -+ { -+ pDM_Odm->AntDivType = CGCS_RX_SW_ANTDIV; -+ ODM_SetBBReg(pDM_Odm, ODM_REG_IGI_A_11N , BIT7, 0); // disable HW AntDiv -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_ANT_CTRL_11N , BIT5|BIT4|BIT3, 0); //Default RX (0/1) -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => AntDivType=[CG_TRX_HW_ANTDIV (SPDT)]\n")); -+ -+ //MAC Setting -+ value32 = ODM_GetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord); -+ ODM_SetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord, value32|(BIT23|BIT25)); //Reg4C[25]=1, Reg4C[23]=1 for pin output -+ //Pin Settings -+ ODM_SetBBReg(pDM_Odm, ODM_REG_PIN_CTRL_11N , BIT9|BIT8, 0);//Reg870[8]=1'b0, Reg870[9]=1'b0 //antsel antselb by HW -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_ANT_CTRL_11N , BIT10, 0); //Reg864[10]=1'b0 //antsel2 by HW -+ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT22, 0); //Regb2c[22]=1'b0 //disable CS/CG switch -+ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT31, 1); //Regb2c[31]=1'b1 //output at CG only -+ //OFDM Settings -+ ODM_SetBBReg(pDM_Odm, ODM_REG_ANTDIV_PARA1_11N , bMaskDWord, 0x000000a0); -+ //CCK Settings -+ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_PWR_SAV4_11N , BIT7, 1); //Fix CCK PHY status report issue -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_ANTDIV_PARA2_11N , BIT4, 1); //CCK complete HW AntDiv within 64 samples -+ -+ //antenna mapping table -+ if(!pDM_Odm->bIsMPChip) //testchip -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_DEFUALT_A_11N , BIT10|BIT9|BIT8, 1); //Reg858[10:8]=3'b001 -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_DEFUALT_A_11N , BIT13|BIT12|BIT11, 2); //Reg858[13:11]=3'b010 -+ } -+ else //MPchip -+ ODM_SetBBReg(pDM_Odm, ODM_REG_ANT_MAPPING1_11N , bMaskDWord, 0x0201); /*Reg914=3'b010, Reg915=3'b001*/ -+ -+ pDM_FatTable->enable_ctrl_frame_antdiv = 1; -+} -+ -+ -+#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+VOID -+odm_Smart_HWAntDiv_Init_88E( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte value32, i; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => AntDivType=[CG_TRX_SMART_ANTDIV]\n")); -+ -+ if(pDM_Odm->mp_mode == TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("pDM_Odm->AntDivType: %d\n", pDM_Odm->AntDivType)); -+ return; -+ } -+ -+ pDM_FatTable->TrainIdx = 0; -+ pDM_FatTable->FAT_State = FAT_PREPARE_STATE; -+ -+ pDM_Odm->fat_comb_a=5; -+ pDM_Odm->antdiv_intvl = 0x64; // 100ms -+ -+ for(i=0; i<6; i++) -+ { -+ pDM_FatTable->Bssid[i] = 0; -+ } -+ for(i=0; i< (pDM_Odm->fat_comb_a) ; i++) -+ { -+ pDM_FatTable->antSumRSSI[i] = 0; -+ pDM_FatTable->antRSSIcnt[i] = 0; -+ pDM_FatTable->antAveRSSI[i] = 0; -+ } -+ -+ //MAC Setting -+ value32 = ODM_GetMACReg(pDM_Odm, 0x4c, bMaskDWord); -+ ODM_SetMACReg(pDM_Odm, 0x4c, bMaskDWord, value32|(BIT23|BIT25)); //Reg4C[25]=1, Reg4C[23]=1 for pin output -+ value32 = ODM_GetMACReg(pDM_Odm, 0x7B4, bMaskDWord); -+ ODM_SetMACReg(pDM_Odm, 0x7b4, bMaskDWord, value32|(BIT16|BIT17)); //Reg7B4[16]=1 enable antenna training, Reg7B4[17]=1 enable A2 match -+ //value32 = PlatformEFIORead4Byte(Adapter, 0x7B4); -+ //PlatformEFIOWrite4Byte(Adapter, 0x7b4, value32|BIT18); //append MACID in reponse packet -+ -+ //Match MAC ADDR -+ ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, 0); -+ ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, 0); -+ -+ ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0);//Reg870[8]=1'b0, Reg870[9]=1'b0 //antsel antselb by HW -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT10, 0); //Reg864[10]=1'b0 //antsel2 by HW -+ ODM_SetBBReg(pDM_Odm, 0xb2c , BIT22, 0); //Regb2c[22]=1'b0 //disable CS/CG switch -+ ODM_SetBBReg(pDM_Odm, 0xb2c , BIT31, 0); //Regb2c[31]=1'b1 //output at CS only -+ ODM_SetBBReg(pDM_Odm, 0xca4 , bMaskDWord, 0x000000a0); -+ -+ //antenna mapping table -+ if(pDM_Odm->fat_comb_a == 2) -+ { -+ if(!pDM_Odm->bIsMPChip) //testchip -+ { -+ ODM_SetBBReg(pDM_Odm, 0x858 , BIT10|BIT9|BIT8, 1); //Reg858[10:8]=3'b001 -+ ODM_SetBBReg(pDM_Odm, 0x858 , BIT13|BIT12|BIT11, 2); //Reg858[13:11]=3'b010 -+ } -+ else //MPchip -+ { -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 1); -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 2); -+ } -+ } -+ else -+ { -+ if(!pDM_Odm->bIsMPChip) //testchip -+ { -+ ODM_SetBBReg(pDM_Odm, 0x858 , BIT10|BIT9|BIT8, 0); //Reg858[10:8]=3'b000 -+ ODM_SetBBReg(pDM_Odm, 0x858 , BIT13|BIT12|BIT11, 1); //Reg858[13:11]=3'b001 -+ ODM_SetBBReg(pDM_Odm, 0x878 , BIT16, 0); -+ ODM_SetBBReg(pDM_Odm, 0x858 , BIT15|BIT14, 2); //(Reg878[0],Reg858[14:15])=3'b010 -+ ODM_SetBBReg(pDM_Odm, 0x878 , BIT19|BIT18|BIT17, 3);//Reg878[3:1]=3b'011 -+ ODM_SetBBReg(pDM_Odm, 0x878 , BIT22|BIT21|BIT20, 4);//Reg878[6:4]=3b'100 -+ ODM_SetBBReg(pDM_Odm, 0x878 , BIT25|BIT24|BIT23, 5);//Reg878[9:7]=3b'101 -+ ODM_SetBBReg(pDM_Odm, 0x878 , BIT28|BIT27|BIT26, 6);//Reg878[12:10]=3b'110 -+ ODM_SetBBReg(pDM_Odm, 0x878 , BIT31|BIT30|BIT29, 7);//Reg878[15:13]=3b'111 -+ } -+ else //MPchip -+ { -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 4); // 0: 3b'000 -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 2); // 1: 3b'001 -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte2, 0); // 2: 3b'010 -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte3, 1); // 3: 3b'011 -+ ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte0, 3); // 4: 3b'100 -+ ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte1, 5); // 5: 3b'101 -+ ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte2, 6); // 6: 3b'110 -+ ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte3, 255); // 7: 3b'111 -+ } -+ } -+ -+ //Default Ant Setting when no fast training -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, 0); //Default RX -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, 1); //Optional RX -+ ODM_SetBBReg(pDM_Odm, 0x860 , BIT14|BIT13|BIT12, 0);//Default TX -+ -+ //Enter Traing state -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT2|BIT1|BIT0, (pDM_Odm->fat_comb_a-1)); //Reg864[2:0]=3'd6 //ant combination=reg864[2:0]+1 -+ -+ //SW Control -+ //PHY_SetBBReg(Adapter, 0x864 , BIT10, 1); -+ //PHY_SetBBReg(Adapter, 0x870 , BIT9, 1); -+ //PHY_SetBBReg(Adapter, 0x870 , BIT8, 1); -+ //PHY_SetBBReg(Adapter, 0x864 , BIT11, 1); -+ //PHY_SetBBReg(Adapter, 0x860 , BIT9, 0); -+ //PHY_SetBBReg(Adapter, 0x860 , BIT8, 0); -+} -+#endif -+ -+#endif //#if (RTL8188E_SUPPORT == 1) -+ -+ -+#if (RTL8192E_SUPPORT == 1) -+VOID -+odm_RX_HWAntDiv_Init_92E( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ if(pDM_Odm->mp_mode == TRUE) -+ { -+ //pDM_Odm->AntDivType = CGCS_RX_SW_ANTDIV; -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 0); //r_rxdiv_enable_anta Regc50[8]=1'b0 0: control by c50[9] -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT9, 1); // 1:CG, 0:CS -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => AntDivType=[CGCS_RX_HW_ANTDIV]\n")); -+ -+ //Pin Settings -+ ODM_SetBBReg(pDM_Odm, 0x870 , BIT8, 0);//Reg870[8]=1'b0, // "antsel" is controled by HWs -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 1); //Regc50[8]=1'b1 //" CS/CG switching" is controled by HWs -+ -+ //Mapping table -+ ODM_SetBBReg(pDM_Odm, 0x914 , 0xFFFF, 0x0100); //antenna mapping table -+ -+ //OFDM Settings -+ ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF, 0xA0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF000, 0x0); //bias -+ -+ //CCK Settings -+ ODM_SetBBReg(pDM_Odm, 0xa04 , 0xF000000, 0); //Select which path to receive for CCK_1 & CCK_2 -+ ODM_SetBBReg(pDM_Odm, 0xb34 , BIT30, 0); //(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 -+ ODM_SetBBReg(pDM_Odm, 0xa74 , BIT7, 1); //Fix CCK PHY status report issue -+ ODM_SetBBReg(pDM_Odm, 0xa0c , BIT4, 1); //CCK complete HW AntDiv within 64 samples -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ //EVM enhance AntDiv method init---------------------------------------------------------------------- -+ pDM_FatTable->EVM_method_enable=0; -+ pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; -+ pDM_Odm->antdiv_intvl = 0x64; -+ ODM_SetBBReg(pDM_Odm, 0x910 , 0x3f, 0xf ); -+ pDM_Odm->antdiv_evm_en=1; -+ //pDM_Odm->antdiv_period=1; -+ -+ #endif -+ -+} -+ -+VOID -+odm_TRX_HWAntDiv_Init_92E( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ if(pDM_Odm->mp_mode == TRUE) -+ { -+ //pDM_Odm->AntDivType = CGCS_RX_SW_ANTDIV; -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 0); //r_rxdiv_enable_anta Regc50[8]=1'b0 0: control by c50[9] -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT9, 1); // 1:CG, 0:CS -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => AntDivType=[ Only for DIR605, CG_TRX_HW_ANTDIV]\n")); -+ -+ //3 --RFE pin setting--------- -+ //[MAC] -+ ODM_SetMACReg(pDM_Odm, 0x38, BIT11, 1); //DBG PAD Driving control (GPIO 8) -+ ODM_SetMACReg(pDM_Odm, 0x4c, BIT23, 0); //path-A , RFE_CTRL_3 -+ ODM_SetMACReg(pDM_Odm, 0x4c, BIT29, 1); //path-A , RFE_CTRL_8 -+ //[BB] -+ ODM_SetBBReg(pDM_Odm, 0x944 , BIT3, 1); //RFE_buffer -+ ODM_SetBBReg(pDM_Odm, 0x944 , BIT8, 1); -+ ODM_SetBBReg(pDM_Odm, 0x940 , BIT7|BIT6, 0x0); // r_rfe_path_sel_ (RFE_CTRL_3) -+ ODM_SetBBReg(pDM_Odm, 0x940 , BIT17|BIT16, 0x0); // r_rfe_path_sel_ (RFE_CTRL_8) -+ ODM_SetBBReg(pDM_Odm, 0x944 , BIT31, 0); //RFE_buffer -+ ODM_SetBBReg(pDM_Odm, 0x92C , BIT3, 0); //rfe_inv (RFE_CTRL_3) -+ ODM_SetBBReg(pDM_Odm, 0x92C , BIT8, 1); //rfe_inv (RFE_CTRL_8) -+ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF000, 0x8); //path-A , RFE_CTRL_3 -+ ODM_SetBBReg(pDM_Odm, 0x934 , 0xF, 0x8); //path-A , RFE_CTRL_8 -+ //3 ------------------------- -+ -+ //Pin Settings -+ ODM_SetBBReg(pDM_Odm, 0xC50 , BIT8, 0); //path-A //disable CS/CG switch -+ -+/* Let it follows PHY_REG for bit9 setting -+ if(pDM_Odm->priv->pshare->rf_ft_var.use_ext_pa || pDM_Odm->priv->pshare->rf_ft_var.use_ext_lna) -+ ODM_SetBBReg(pDM_Odm, 0xC50 , BIT9, 1);//path-A //output at CS -+ else -+ ODM_SetBBReg(pDM_Odm, 0xC50 , BIT9, 0); //path-A //output at CG ->normal power -+*/ -+ -+ ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0); //path-A //antsel antselb by HW -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT10, 0); //path-A //antsel2 by HW -+ -+ //Mapping table -+ ODM_SetBBReg(pDM_Odm, 0x914 , 0xFFFF, 0x0100); //antenna mapping table -+ -+ //OFDM Settings -+ ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF, 0xA0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF000, 0x0); //bias -+ -+ //CCK Settings -+ ODM_SetBBReg(pDM_Odm, 0xa04 , 0xF000000, 0); //Select which path to receive for CCK_1 & CCK_2 -+ ODM_SetBBReg(pDM_Odm, 0xb34 , BIT30, 0); //(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 -+ ODM_SetBBReg(pDM_Odm, 0xa74 , BIT7, 1); //Fix CCK PHY status report issue -+ ODM_SetBBReg(pDM_Odm, 0xa0c , BIT4, 1); //CCK complete HW AntDiv within 64 samples -+ -+ //Timming issue -+ ODM_SetBBReg(pDM_Odm, 0xE20 , BIT23|BIT22|BIT21|BIT20, 8); //keep antidx after tx for ACK ( unit x 32 mu sec) -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ //EVM enhance AntDiv method init---------------------------------------------------------------------- -+ pDM_FatTable->EVM_method_enable=0; -+ pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; -+ pDM_Odm->antdiv_intvl = 0x64; -+ ODM_SetBBReg(pDM_Odm, 0x910 , 0x3f, 0xf ); -+ pDM_Odm->antdiv_evm_en=1; -+ //pDM_Odm->antdiv_period=1; -+ #endif -+} -+ -+#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+VOID -+odm_Smart_HWAntDiv_Init_92E( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => AntDivType=[CG_TRX_SMART_ANTDIV]\n")); -+} -+#endif -+ -+#endif //#if (RTL8192E_SUPPORT == 1) -+ -+ -+#if (RTL8723B_SUPPORT == 1) -+VOID -+odm_TRX_HWAntDiv_Init_8723B( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8723B AntDiv_Init => AntDivType=[CG_TRX_HW_ANTDIV(DPDT)]\n")); -+ -+ //Mapping Table -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 1); -+ -+ //OFDM HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF, 0xa0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF000, 0x00); //bias -+ -+ //CCK HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M -+ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples -+ -+ //BT Coexistence -+ ODM_SetBBReg(pDM_Odm, 0x864, BIT12, 0); //keep antsel_map when GNT_BT = 1 -+ ODM_SetBBReg(pDM_Odm, 0x874 , BIT23, 0); //Disable hw antsw & fast_train.antsw when GNT_BT=1 -+ -+ //Output Pin Settings -+ ODM_SetBBReg(pDM_Odm, 0x870 , BIT8, 0); // -+ -+ ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0); //WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL) -+ ODM_SetBBReg(pDM_Odm, 0x948 , BIT7, 0); -+ -+ ODM_SetMACReg(pDM_Odm, 0x40 , BIT3, 1); -+ ODM_SetMACReg(pDM_Odm, 0x38 , BIT11, 1); -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT24|BIT23, 2); //select DPDT_P and DPDT_N as output pin -+ -+ ODM_SetBBReg(pDM_Odm, 0x944 , BIT0|BIT1, 3); //in/out -+ ODM_SetBBReg(pDM_Odm, 0x944 , BIT31, 0); // -+ -+ ODM_SetBBReg(pDM_Odm, 0x92C , BIT1, 0); //DPDT_P non-inverse -+ ODM_SetBBReg(pDM_Odm, 0x92C , BIT0, 1); //DPDT_N inverse -+ -+ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF0, 8); // DPDT_P = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF, 8); // DPDT_N = ANTSEL[0] -+ -+ //Timming issue -+ ODM_SetBBReg(pDM_Odm, 0xE20 , BIT23|BIT22|BIT21|BIT20, 8); //keep antidx after tx for ACK ( unit x 32 mu sec) -+ -+ //2 [--For HW Bug Setting] -+ if(pDM_Odm->AntType == ODM_AUTO_ANT) -+ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable -+ -+} -+ -+ -+ -+VOID -+odm_S0S1_SWAntDiv_Init_8723B( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8723B AntDiv_Init => AntDivType=[ S0S1_SW_AntDiv] \n")); -+ -+ //Mapping Table -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 1); -+ -+ //Output Pin Settings -+ //ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0); -+ -+ pDM_FatTable->bBecomeLinked =FALSE; -+ pDM_SWAT_Table->try_flag = 0xff; -+ pDM_SWAT_Table->Double_chk_flag = 0; -+ pDM_SWAT_Table->TrafficLoad = TRAFFIC_LOW; -+ -+ //Timming issue -+ ODM_SetBBReg(pDM_Odm, 0xE20 , BIT23|BIT22|BIT21|BIT20, 8); //keep antidx after tx for ACK ( unit x 32 mu sec) -+ -+ //2 [--For HW Bug Setting] -+ ODM_SetBBReg(pDM_Odm, 0x80C , BIT21, 0); //TX Ant by Reg -+ -+} -+ -+VOID -+odm_S0S1_SWAntDiv_Reset_8723B( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ pDM_FatTable->bBecomeLinked =FALSE; -+ pDM_SWAT_Table->try_flag = 0xff; -+ pDM_SWAT_Table->Double_chk_flag = 0; -+ pDM_SWAT_Table->TrafficLoad = TRAFFIC_LOW; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_S0S1_SWAntDiv_Reset_8723B(): pDM_FatTable->bBecomeLinked = %d\n", pDM_FatTable->bBecomeLinked)); -+} -+ -+VOID -+ODM_UpdateRxIdleAnt_8723B( -+ IN PVOID pDM_VOID, -+ IN u1Byte Ant, -+ IN u4Byte DefaultAnt, -+ IN u4Byte OptionalAnt -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u1Byte count=0; -+ u1Byte u1Temp; -+ u1Byte H2C_Parameter; -+ -+ if(!pDM_Odm->bLinked) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to no link\n")); -+ return; -+ } -+ -+ // Send H2C command to FW -+ // Enable wifi calibration -+ H2C_Parameter = TRUE; -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_WIFI_CALIBRATION, 1, &H2C_Parameter); -+ -+ // Check if H2C command sucess or not (0x1e6) -+ u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e6); -+ while((u1Temp != 0x1) && (count < 100)) -+ { -+ ODM_delay_us(10); -+ u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e6); -+ count++; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: H2C command status = %d, count = %d\n", u1Temp, count)); -+ -+ if(u1Temp == 0x1) -+ { -+ // Check if BT is doing IQK (0x1e7) -+ count = 0; -+ u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e7); -+ while((!(u1Temp & BIT0)) && (count < 100)) -+ { -+ ODM_delay_us(50); -+ u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e7); -+ count++; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: BT IQK status = %d, count = %d\n", u1Temp, count)); -+ -+ if(u1Temp & BIT0) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x948 , BIT9, DefaultAnt); -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, DefaultAnt); //Default RX -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, OptionalAnt); //Optional RX -+ ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, DefaultAnt); //Default TX -+ pDM_FatTable->RxIdleAnt = Ant; -+ -+ // Set TX AGC by S0/S1 -+ // Need to consider Linux driver -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pAdapter->HalFunc.SetTxPowerLevelHandler(pAdapter, pHalData->CurrentChannel); -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ rtw_hal_set_tx_power_level(pAdapter, pHalData->CurrentChannel); -+#endif -+ -+ // Set IQC by S0/S1 -+ ODM_SetIQCbyRFpath(pDM_Odm,DefaultAnt); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Sucess to set RX antenna\n")); -+ } -+ else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to BT IQK\n")); -+ } -+ else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to H2C command fail\n")); -+ -+ // Send H2C command to FW -+ // Disable wifi calibration -+ H2C_Parameter = FALSE; -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_WIFI_CALIBRATION, 1, &H2C_Parameter); -+ -+} -+#else /*#if (RTL8723B_SUPPORT == 1)*/ -+VOID -+ODM_UpdateRxIdleAnt_8723B( -+ IN PVOID pDM_VOID, -+ IN u1Byte Ant, -+ IN u4Byte DefaultAnt, -+ IN u4Byte OptionalAnt -+ ){} -+ -+#endif //#if (RTL8723B_SUPPORT == 1) -+ -+#if (RTL8821A_SUPPORT == 1) -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+VOID -+phydm_hl_smart_ant_type1_init_8821a( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u4Byte value32; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A SmartAnt_Init => AntDivType=[Hong-Lin Smart Ant Type1]\n")); -+ -+ /*---------------------------------------- -+ GPIO 2-3 for Beam control -+ reg0x66[2]=0 -+ reg0x44[27:26] = 0 -+ reg0x44[23:16] //enable_output for P_GPIO[7:0] -+ reg0x44[15:8] //output_value for P_GPIO[7:0] -+ reg0x40[1:0] = 0 //GPIO function -+ ------------------------------------------*/ -+ -+ /*GPIO Setting*/ -+ ODM_SetMACReg(pDM_Odm, 0x64 , BIT18, 0); -+ ODM_SetMACReg(pDM_Odm, 0x44 , BIT27|BIT26, 0); -+ ODM_SetMACReg(pDM_Odm, 0x44 , BIT19|BIT18, 0x3); /*enable_output for P_GPIO[3:2]*/ -+ /*ODM_SetMACReg(pDM_Odm, 0x44 , BIT11|BIT10, 0);*/ /*output value*/ -+ ODM_SetMACReg(pDM_Odm, 0x40 , BIT1|BIT0, 0); /*GPIO function*/ -+ -+ /*Hong_lin smart antenna HW Setting*/ -+ pdm_sat_table->data_codeword_bit_num = 24;/*max=32*/ -+ pdm_sat_table->beam_patten_num_each_ant = 4; -+ -+ #if DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ pdm_sat_table->latch_time = 100; /*mu sec*/ -+ #elif DEV_BUS_TYPE == RT_USB_INTERFACE -+ pdm_sat_table->latch_time = 100; /*mu sec*/ -+ #endif -+ pdm_sat_table->pkt_skip_statistic_en = 0; -+ -+ pdm_sat_table->ant_num = 2;/*max=8*/ -+ -+ pdm_sat_table->fix_beam_pattern_en = 0; -+ -+ /*beam training setting*/ -+ pdm_sat_table->pkt_counter = 0; -+ pdm_sat_table->per_beam_training_pkt_num = 10; -+ -+ /*set default beam*/ -+ pdm_sat_table->fast_training_beam_num = 0; -+ pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; -+ phydm_set_all_ant_same_beam_num(pDM_Odm); -+ -+ pDM_FatTable->FAT_State = FAT_BEFORE_LINK_STATE; -+ -+ /*[BB] FAT Setting*/ -+ ODM_SetBBReg(pDM_Odm, 0xc08 , BIT18|BIT17|BIT16, pdm_sat_table->ant_num); -+ ODM_SetBBReg(pDM_Odm, 0xc08 , BIT31, 0); /*increase ant num every FAT period 0:+1, 1+2*/ -+ ODM_SetBBReg(pDM_Odm, 0x8c4 , BIT2|BIT1, 1); /*change cca antenna timming threshold if no CCA occurred: 0:200ms / 1:100ms / 2:no use / 3: 300*/ -+ ODM_SetBBReg(pDM_Odm, 0x8c4 , BIT0, 1); /*FAT_watchdog_en*/ -+ -+ value32 = ODM_GetMACReg(pDM_Odm, 0x7B4, bMaskDWord); -+ ODM_SetMACReg(pDM_Odm, 0x7b4, bMaskDWord, value32|(BIT16|BIT17)); /*Reg7B4[16]=1 enable antenna training */ -+ /*Reg7B4[17]=1 enable match MAC Addr*/ -+ ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, 0);/*Match MAC ADDR*/ -+ ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, 0); -+ -+} -+#endif -+ -+VOID -+odm_TRX_HWAntDiv_Init_8821A( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (DPDT)] \n")); -+ -+ //Output Pin Settings -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); -+ -+ ODM_SetMACReg(pDM_Odm, 0x64 , BIT29, 1); //PAPE by WLAN control -+ ODM_SetMACReg(pDM_Odm, 0x64 , BIT28, 1); //LNAON by WLAN control -+ -+ ODM_SetBBReg(pDM_Odm, 0xCB0 , bMaskDWord, 0x77775745); -+ ODM_SetBBReg(pDM_Odm, 0xCB8 , BIT16, 0); -+ -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT23, 0); //select DPDT_P and DPDT_N as output pin -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT24, 1); //by WLAN control -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF, 8); // DPDT_P = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF0, 8); // DPDT_N = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT29, 0); //DPDT_P non-inverse -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT28, 1); //DPDT_N inverse -+ -+ //Mapping Table -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); -+ -+ //OFDM HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x10); //bias -+ -+ //CCK HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M -+ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples -+ -+ ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //ANTSEL_CCK sent to the smart_antenna circuit -+ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable -+ -+ //BT Coexistence -+ ODM_SetBBReg(pDM_Odm, 0xCAC , BIT9, 1); //keep antsel_map when GNT_BT = 1 -+ ODM_SetBBReg(pDM_Odm, 0x804 , BIT4, 1); //Disable hw antsw & fast_train.antsw when GNT_BT=1 -+ -+ //Timming issue -+ ODM_SetBBReg(pDM_Odm, 0x818 , BIT23|BIT22|BIT21|BIT20, 8); //keep antidx after tx for ACK ( unit x 32 mu sec) -+ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns -+ -+ //response TX ant by RX ant -+ ODM_SetMACReg(pDM_Odm, 0x668 , BIT3, 1); -+ -+} -+ -+VOID -+odm_S0S1_SWAntDiv_Init_8821A( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A AntDiv_Init => AntDivType=[ S0S1_SW_AntDiv] \n")); -+ -+ //Output Pin Settings -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); -+ -+ ODM_SetMACReg(pDM_Odm, 0x64 , BIT29, 1); //PAPE by WLAN control -+ ODM_SetMACReg(pDM_Odm, 0x64 , BIT28, 1); //LNAON by WLAN control -+ -+ ODM_SetBBReg(pDM_Odm, 0xCB0 , bMaskDWord, 0x77775745); -+ ODM_SetBBReg(pDM_Odm, 0xCB8 , BIT16, 0); -+ -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT23, 0); //select DPDT_P and DPDT_N as output pin -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT24, 1); //by WLAN control -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF, 8); // DPDT_P = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF0, 8); // DPDT_N = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT29, 0); //DPDT_P non-inverse -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT28, 1); //DPDT_N inverse -+ -+ //Mapping Table -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); -+ -+ //OFDM HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x10); //bias -+ -+ //CCK HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M -+ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples -+ -+ ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //ANTSEL_CCK sent to the smart_antenna circuit -+ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable -+ -+ //BT Coexistence -+ ODM_SetBBReg(pDM_Odm, 0xCAC , BIT9, 1); //keep antsel_map when GNT_BT = 1 -+ ODM_SetBBReg(pDM_Odm, 0x804 , BIT4, 1); //Disable hw antsw & fast_train.antsw when GNT_BT=1 -+ -+ //Timming issue -+ ODM_SetBBReg(pDM_Odm, 0x818 , BIT23|BIT22|BIT21|BIT20, 8); //keep antidx after tx for ACK ( unit x 32 mu sec) -+ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns -+ -+ //response TX ant by RX ant -+ ODM_SetMACReg(pDM_Odm, 0x668 , BIT3, 1); -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, 0); -+ -+ pDM_SWAT_Table->try_flag = 0xff; -+ pDM_SWAT_Table->Double_chk_flag = 0; -+ pDM_SWAT_Table->TrafficLoad = TRAFFIC_LOW; -+ pDM_SWAT_Table->CurAntenna = MAIN_ANT; -+ pDM_SWAT_Table->PreAntenna = MAIN_ANT; -+ pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ -+} -+#endif //#if (RTL8821A_SUPPORT == 1) -+ -+#if (RTL8881A_SUPPORT == 1) -+VOID -+odm_RX_HWAntDiv_Init_8881A( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8881A AntDiv_Init => AntDivType=[ CGCS_RX_HW_ANTDIV] \n")); -+ -+} -+ -+VOID -+odm_TRX_HWAntDiv_Init_8881A( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8881A AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (SPDT)] \n")); -+ -+ //Output Pin Settings -+ // [SPDT related] -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT26, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT31, 0); //delay buffer -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT22, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT24, 1); -+ ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF00, 8); // DPDT_P = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF0000, 8); // DPDT_N = ANTSEL[0] -+ -+ //Mapping Table -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); -+ -+ //OFDM HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x0); //bias -+ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns -+ -+ //CCK HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M -+ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples -+ -+ //Timming issue -+ ODM_SetBBReg(pDM_Odm, 0x818 , BIT23|BIT22|BIT21|BIT20, 8); //keep antidx after tx for ACK ( unit x 32 mu sec) -+ -+ //2 [--For HW Bug Setting] -+ -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, 0); //TX Ant by Reg // A-cut bug -+} -+ -+#endif //#if (RTL8881A_SUPPORT == 1) -+ -+ -+#if (RTL8812A_SUPPORT == 1) -+VOID -+odm_TRX_HWAntDiv_Init_8812A( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8812A AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (SPDT)] \n")); -+ -+ //3 //3 --RFE pin setting--------- -+ //[BB] -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT10|BIT9|BIT8, 0x0); //disable SW switch -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT17|BIT16, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x974 , BIT7|BIT6, 0x3); // in/out -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT31, 0); //delay buffer -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT26, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT27, 1); -+ ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF000000, 8); // DPDT_P = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF0000000, 8); // DPDT_N = ANTSEL[0] -+ //3 ------------------------- -+ -+ //Mapping Table -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); -+ -+ //OFDM HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x0); //bias -+ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns -+ -+ //CCK HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M -+ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples -+ -+ //Timming issue -+ ODM_SetBBReg(pDM_Odm, 0x818 , BIT23|BIT22|BIT21|BIT20, 8); //keep antidx after tx for ACK ( unit x 32 mu sec) -+ -+ //2 [--For HW Bug Setting] -+ -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, 0); //TX Ant by Reg // A-cut bug -+ -+} -+ -+#endif //#if (RTL8812A_SUPPORT == 1) -+ -+ -+ -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ -+ -+ -+VOID -+odm_EVM_FastAnt_Reset( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ pDM_FatTable->EVM_method_enable=0; -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; -+ pDM_Odm->antdiv_period=0; -+ ODM_SetMACReg(pDM_Odm, 0x608, BIT8, 0); -+} -+ -+ -+VOID -+odm_EVM_Enhance_AntDiv( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte Main_RSSI, Aux_RSSI ; -+ u4Byte Main_CRC_utility=0,Aux_CRC_utility=0,utility_ratio=1; -+ u4Byte Main_EVM, Aux_EVM,Diff_RSSI=0,diff_EVM=0; -+ u1Byte score_EVM=0,score_CRC=0; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u4Byte value32, i; -+ BOOLEAN Main_above1=FALSE,Aux_above1=FALSE; -+ BOOLEAN Force_antenna=FALSE; -+ PSTA_INFO_T pEntry; -+ pDM_FatTable->TargetAnt_enhance=0xFF; -+ -+ -+ if((pDM_Odm->SupportICType & ODM_EVM_ENHANCE_ANTDIV_SUPPORT_IC)) -+ { -+ if(pDM_Odm->bOneEntryOnly) -+ { -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[One Client only] \n")); -+ i = pDM_Odm->OneEntry_MACID; -+ -+ Main_RSSI = (pDM_FatTable->MainAnt_Cnt[i]!=0)?(pDM_FatTable->MainAnt_Sum[i]/pDM_FatTable->MainAnt_Cnt[i]):0; -+ Aux_RSSI = (pDM_FatTable->AuxAnt_Cnt[i]!=0)?(pDM_FatTable->AuxAnt_Sum[i]/pDM_FatTable->AuxAnt_Cnt[i]):0; -+ -+ if((Main_RSSI==0 && Aux_RSSI !=0 && Aux_RSSI>=FORCE_RSSI_DIFF) || (Main_RSSI!=0 && Aux_RSSI==0 && Main_RSSI>=FORCE_RSSI_DIFF)) -+ { -+ Diff_RSSI=FORCE_RSSI_DIFF; -+ } -+ else if(Main_RSSI!=0 && Aux_RSSI !=0) -+ { -+ Diff_RSSI = (Main_RSSI>=Aux_RSSI)?(Main_RSSI-Aux_RSSI):(Aux_RSSI-Main_RSSI); -+ } -+ -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Main_Cnt = (( %d )) , Main_RSSI= (( %d )) \n", pDM_FatTable->MainAnt_Cnt[i], Main_RSSI)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Aux_Cnt = (( %d )) , Aux_RSSI = (( %d )) \n" , pDM_FatTable->AuxAnt_Cnt[i] , Aux_RSSI)); -+ -+ if( ((Main_RSSI>=Evm_RSSI_TH_High||Aux_RSSI>=Evm_RSSI_TH_High )|| (pDM_FatTable->EVM_method_enable==1) ) -+ //&& (Diff_RSSI <= FORCE_RSSI_DIFF + 1) -+ ) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[> TH_H || EVM_method_enable==1] && ")); -+ -+ if(((Main_RSSI>=Evm_RSSI_TH_Low)||(Aux_RSSI>=Evm_RSSI_TH_Low) )) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[> TH_L ] \n")); -+ -+ //2 [ Normal state Main] -+ if(pDM_FatTable->FAT_State == NORMAL_STATE_MIAN) -+ { -+ -+ pDM_FatTable->EVM_method_enable=1; -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ pDM_Odm->antdiv_period=3; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ start training: MIAN] \n")); -+ pDM_FatTable->MainAntEVM_Sum[i] = 0; -+ pDM_FatTable->AuxAntEVM_Sum[i] = 0; -+ pDM_FatTable->MainAntEVM_Cnt[i] = 0; -+ pDM_FatTable->AuxAntEVM_Cnt[i] = 0; -+ -+ pDM_FatTable->FAT_State = NORMAL_STATE_AUX; -+ ODM_SetMACReg(pDM_Odm, 0x608, BIT8, 1); //Accept CRC32 Error packets. -+ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); -+ -+ pDM_FatTable->CRC32_Ok_Cnt=0; -+ pDM_FatTable->CRC32_Fail_Cnt=0; -+ ODM_SetTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer, pDM_Odm->antdiv_intvl ); //m -+ } -+ //2 [ Normal state Aux ] -+ else if(pDM_FatTable->FAT_State == NORMAL_STATE_AUX) -+ { -+ pDM_FatTable->MainCRC32_Ok_Cnt=pDM_FatTable->CRC32_Ok_Cnt; -+ pDM_FatTable->MainCRC32_Fail_Cnt=pDM_FatTable->CRC32_Fail_Cnt; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ start training: AUX] \n")); -+ pDM_FatTable->FAT_State = TRAINING_STATE; -+ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); -+ -+ pDM_FatTable->CRC32_Ok_Cnt=0; -+ pDM_FatTable->CRC32_Fail_Cnt=0; -+ ODM_SetTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer, pDM_Odm->antdiv_intvl ); //ms -+ } -+ else if(pDM_FatTable->FAT_State == TRAINING_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Training state ] \n")); -+ pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; -+ -+ //3 [CRC32 statistic] -+ pDM_FatTable->AuxCRC32_Ok_Cnt=pDM_FatTable->CRC32_Ok_Cnt; -+ pDM_FatTable->AuxCRC32_Fail_Cnt=pDM_FatTable->CRC32_Fail_Cnt; -+ -+ if( (pDM_FatTable->MainCRC32_Ok_Cnt >= ((pDM_FatTable->AuxCRC32_Ok_Cnt)<<1)) || (Diff_RSSI>=18)) -+ { -+ pDM_FatTable->TargetAnt_CRC32=MAIN_ANT; -+ Force_antenna=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CRC32 Force Main \n")); -+ } -+ else if((pDM_FatTable->AuxCRC32_Ok_Cnt >= ((pDM_FatTable->MainCRC32_Ok_Cnt)<<1)) || (Diff_RSSI>=18)) -+ { -+ pDM_FatTable->TargetAnt_CRC32=AUX_ANT; -+ Force_antenna=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CRC32 Force Aux \n")); -+ } -+ else -+ { -+ if(pDM_FatTable->MainCRC32_Fail_Cnt<=5) -+ pDM_FatTable->MainCRC32_Fail_Cnt=5; -+ -+ if(pDM_FatTable->AuxCRC32_Fail_Cnt<=5) -+ pDM_FatTable->AuxCRC32_Fail_Cnt=5; -+ -+ if(pDM_FatTable->MainCRC32_Ok_Cnt >pDM_FatTable->MainCRC32_Fail_Cnt ) -+ Main_above1=TRUE; -+ -+ if(pDM_FatTable->AuxCRC32_Ok_Cnt >pDM_FatTable->AuxCRC32_Fail_Cnt ) -+ Aux_above1=TRUE; -+ -+ if(Main_above1==TRUE && Aux_above1==FALSE) -+ { -+ Force_antenna=TRUE; -+ pDM_FatTable->TargetAnt_CRC32=MAIN_ANT; -+ } -+ else if(Main_above1==FALSE && Aux_above1==TRUE) -+ { -+ Force_antenna=TRUE; -+ pDM_FatTable->TargetAnt_CRC32=AUX_ANT; -+ } -+ else if(Main_above1==TRUE && Aux_above1==TRUE) -+ { -+ Main_CRC_utility=((pDM_FatTable->MainCRC32_Ok_Cnt)<<7)/pDM_FatTable->MainCRC32_Fail_Cnt; -+ Aux_CRC_utility=((pDM_FatTable->AuxCRC32_Ok_Cnt)<<7)/pDM_FatTable->AuxCRC32_Fail_Cnt; -+ pDM_FatTable->TargetAnt_CRC32 = (Main_CRC_utility==Aux_CRC_utility)?(pDM_FatTable->pre_TargetAnt_enhance):((Main_CRC_utility>=Aux_CRC_utility)?MAIN_ANT:AUX_ANT); -+ -+ if(Main_CRC_utility!=0 && Aux_CRC_utility!=0) -+ { -+ if(Main_CRC_utility>=Aux_CRC_utility) -+ utility_ratio=(Main_CRC_utility<<1)/Aux_CRC_utility; -+ else -+ utility_ratio=(Aux_CRC_utility<<1)/Main_CRC_utility; -+ } -+ } -+ else if(Main_above1==FALSE && Aux_above1==FALSE) -+ { -+ if(pDM_FatTable->MainCRC32_Ok_Cnt==0) -+ pDM_FatTable->MainCRC32_Ok_Cnt=1; -+ if(pDM_FatTable->AuxCRC32_Ok_Cnt==0) -+ pDM_FatTable->AuxCRC32_Ok_Cnt=1; -+ -+ Main_CRC_utility=((pDM_FatTable->MainCRC32_Fail_Cnt)<<7)/pDM_FatTable->MainCRC32_Ok_Cnt; -+ Aux_CRC_utility=((pDM_FatTable->AuxCRC32_Fail_Cnt)<<7)/pDM_FatTable->AuxCRC32_Ok_Cnt; -+ pDM_FatTable->TargetAnt_CRC32 = (Main_CRC_utility==Aux_CRC_utility)?(pDM_FatTable->pre_TargetAnt_enhance):((Main_CRC_utility<=Aux_CRC_utility)?MAIN_ANT:AUX_ANT); -+ -+ if(Main_CRC_utility!=0 && Aux_CRC_utility!=0) -+ { -+ if(Main_CRC_utility>=Aux_CRC_utility) -+ utility_ratio=(Main_CRC_utility<<1)/(Aux_CRC_utility); -+ else -+ utility_ratio=(Aux_CRC_utility<<1)/(Main_CRC_utility); -+ } -+ } -+ } -+ ODM_SetMACReg(pDM_Odm, 0x608, BIT8, 0);//NOT Accept CRC32 Error packets. -+ -+ //3 [EVM statistic] -+ Main_EVM = (pDM_FatTable->MainAntEVM_Cnt[i]!=0)?(pDM_FatTable->MainAntEVM_Sum[i]/pDM_FatTable->MainAntEVM_Cnt[i]):0; -+ Aux_EVM = (pDM_FatTable->AuxAntEVM_Cnt[i]!=0)?(pDM_FatTable->AuxAntEVM_Sum[i]/pDM_FatTable->AuxAntEVM_Cnt[i]):0; -+ pDM_FatTable->TargetAnt_EVM = (Main_EVM==Aux_EVM)?(pDM_FatTable->pre_TargetAnt_enhance):((Main_EVM>=Aux_EVM)?MAIN_ANT:AUX_ANT); -+ -+ if((Main_EVM==0 || Aux_EVM==0)) -+ diff_EVM=0; -+ else if(Main_EVM>=Aux_EVM) -+ diff_EVM=Main_EVM-Aux_EVM; -+ else -+ diff_EVM=Aux_EVM-Main_EVM; -+ -+ //2 [ Decision state ] -+ if(pDM_FatTable->TargetAnt_EVM ==pDM_FatTable->TargetAnt_CRC32 ) -+ { -+ if( (utility_ratio<2 && Force_antenna==FALSE) && diff_EVM<=2) -+ pDM_FatTable->TargetAnt_enhance=pDM_FatTable->pre_TargetAnt_enhance; -+ else -+ pDM_FatTable->TargetAnt_enhance=pDM_FatTable->TargetAnt_EVM; -+ } -+ else if(diff_EVM<=2 && (utility_ratio > 4 && Force_antenna==FALSE)) -+ { -+ pDM_FatTable->TargetAnt_enhance=pDM_FatTable->TargetAnt_CRC32; -+ } -+ else if(diff_EVM>=20) // -+ { -+ pDM_FatTable->TargetAnt_enhance=pDM_FatTable->TargetAnt_EVM; -+ } -+ else if(utility_ratio>=6 && Force_antenna==FALSE) // utility_ratio>3 -+ { -+ pDM_FatTable->TargetAnt_enhance=pDM_FatTable->TargetAnt_CRC32; -+ } -+ else -+ { -+ if(Force_antenna==TRUE) -+ score_CRC=3; -+ else if(utility_ratio>=4) //>2 -+ score_CRC=2; -+ else if(utility_ratio>=3) //>1.5 -+ score_CRC=1; -+ else -+ score_CRC=0; -+ -+ if(diff_EVM>=10) -+ score_EVM=2; -+ else if(diff_EVM>=5) -+ score_EVM=1; -+ else -+ score_EVM=0; -+ -+ if(score_CRC>score_EVM) -+ pDM_FatTable->TargetAnt_enhance=pDM_FatTable->TargetAnt_CRC32; -+ else if(score_CRCTargetAnt_enhance=pDM_FatTable->TargetAnt_EVM; -+ else -+ pDM_FatTable->TargetAnt_enhance=pDM_FatTable->pre_TargetAnt_enhance; -+ } -+ pDM_FatTable->pre_TargetAnt_enhance=pDM_FatTable->TargetAnt_enhance; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MainEVM_Cnt = (( %d )) , Main_EVM= (( %d )) \n",i, pDM_FatTable->MainAntEVM_Cnt[i], Main_EVM)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : AuxEVM_Cnt = (( %d )) , Aux_EVM = (( %d )) \n" ,i, pDM_FatTable->AuxAntEVM_Cnt[i] , Aux_EVM)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** TargetAnt_EVM = (( %s ))\n", ( pDM_FatTable->TargetAnt_EVM ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("M_CRC_Ok = (( %d )) , M_CRC_Fail = (( %d )), Main_CRC_utility = (( %d )) \n" , pDM_FatTable->MainCRC32_Ok_Cnt, pDM_FatTable->MainCRC32_Fail_Cnt,Main_CRC_utility)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("A_CRC_Ok = (( %d )) , A_CRC_Fail = (( %d )), Aux_CRC_utility = (( %d )) \n" , pDM_FatTable->AuxCRC32_Ok_Cnt, pDM_FatTable->AuxCRC32_Fail_Cnt,Aux_CRC_utility)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** TargetAnt_CRC32 = (( %s ))\n", ( pDM_FatTable->TargetAnt_CRC32 ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("****** TargetAnt_enhance = (( %s ))******\n", ( pDM_FatTable->TargetAnt_enhance ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ -+ -+ } -+ } -+ else // RSSI< = Evm_RSSI_TH_Low -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ TH_L ] \n")); -+ odm_EVM_FastAnt_Reset(pDM_Odm); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[escape from> TH_H || EVM_method_enable==1] \n")); -+ odm_EVM_FastAnt_Reset(pDM_Odm); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[multi-Client] \n")); -+ odm_EVM_FastAnt_Reset(pDM_Odm); -+ } -+ } -+} -+ -+VOID -+odm_EVM_FastAntTrainingCallback( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_EVM_FastAntTrainingCallback****** \n")); -+ odm_HW_AntDiv(pDM_Odm); -+} -+#endif -+ -+VOID -+odm_HW_AntDiv( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte i,MinMaxRSSI=0xFF, AntDivMaxRSSI=0, MaxRSSI=0, LocalMaxRSSI; -+ u4Byte Main_RSSI, Aux_RSSI; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u1Byte RxIdleAnt = pDM_FatTable->RxIdleAnt, TargetAnt = 7; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ PSTA_INFO_T pEntry; -+ -+ #ifdef BEAMFORMING_SUPPORT -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; -+ u4Byte TH1=500000; -+ u4Byte TH2=10000000; -+ u4Byte MA_rx_Temp, degrade_TP_temp, improve_TP_temp; -+ u1Byte Monitor_RSSI_threshold=30; -+ -+ pDM_BdcTable->BF_pass=TRUE; -+ pDM_BdcTable->DIV_pass=TRUE; -+ pDM_BdcTable->bAll_DivSta_Idle=TRUE; -+ pDM_BdcTable->bAll_BFSta_Idle=TRUE; -+ pDM_BdcTable->num_BfTar=0 ; -+ pDM_BdcTable->num_DivTar=0; -+ pDM_BdcTable->num_Client=0; -+ #endif -+ #endif -+ -+ if(!pDM_Odm->bLinked) //bLinked==False -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); -+ -+ if(pDM_FatTable->bBecomeLinked == TRUE) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm , REG); -+ pDM_Odm->antdiv_period=0; -+ -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ return; -+ } -+ else -+ { -+ if(pDM_FatTable->bBecomeLinked ==FALSE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm , TX_BY_DESC); -+ -+ //if(pDM_Odm->SupportICType == ODM_RTL8821 ) -+ //ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //CCK AntDiv function disable -+ -+ //#if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ //else if(pDM_Odm->SupportICType == ODM_RTL8881A) -+ // ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //CCK AntDiv function disable -+ //#endif -+ -+ //else if(pDM_Odm->SupportICType == ODM_RTL8723B ||pDM_Odm->SupportICType == ODM_RTL8812) -+ //ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function disable -+ -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ -+ if(pDM_Odm->SupportICType==ODM_RTL8723B && pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF0, 8); // DPDT_P = ANTSEL[0] // for 8723B AntDiv function patch. BB Dino 130412 -+ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF, 8); // DPDT_N = ANTSEL[0] -+ } -+ -+ //2 BDC Init -+ #ifdef BEAMFORMING_SUPPORT -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ odm_BDC_Init(pDM_Odm); -+ #endif -+ #endif -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ odm_EVM_FastAnt_Reset(pDM_Odm); -+ #endif -+ } -+ } -+ -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n AntDiv Start =>\n")); -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ if(pDM_Odm->antdiv_evm_en==1) -+ { -+ odm_EVM_Enhance_AntDiv(pDM_Odm); -+ if(pDM_FatTable->FAT_State !=NORMAL_STATE_MIAN) -+ return; -+ } -+ else -+ { -+ odm_EVM_FastAnt_Reset(pDM_Odm); -+ } -+ #endif -+ -+ //2 BDC Mode Arbitration -+ #ifdef BEAMFORMING_SUPPORT -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if(pDM_Odm->antdiv_evm_en == 0 ||pDM_FatTable->EVM_method_enable==0) -+ { -+ odm_BF_AntDiv_ModeArbitration(pDM_Odm); -+ } -+ #endif -+ #endif -+ -+ for (i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pEntry)) -+ { -+ //2 Caculate RSSI per Antenna -+ Main_RSSI = (pDM_FatTable->MainAnt_Cnt[i]!=0)?(pDM_FatTable->MainAnt_Sum[i]/pDM_FatTable->MainAnt_Cnt[i]):0; -+ Aux_RSSI = (pDM_FatTable->AuxAnt_Cnt[i]!=0)?(pDM_FatTable->AuxAnt_Sum[i]/pDM_FatTable->AuxAnt_Cnt[i]):0; -+ TargetAnt = (Main_RSSI==Aux_RSSI)?pDM_FatTable->RxIdleAnt:((Main_RSSI>=Aux_RSSI)?MAIN_ANT:AUX_ANT); -+ -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("*** SupportICType=[%d] \n",pDM_Odm->SupportICType)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : Main_Cnt = (( %d )) , Main_RSSI= (( %d )) \n",i, pDM_FatTable->MainAnt_Cnt[i], Main_RSSI)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : Aux_Cnt = (( %d )) , Aux_RSSI = (( %d )) \n" ,i, pDM_FatTable->AuxAnt_Cnt[i] , Aux_RSSI)); -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** MAC ID:[ %d ] , TargetAnt = (( %s )) \n", i ,( TargetAnt ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("*** Phy_AntSel_A=[ %d, %d, %d] \n",((pDM_Odm->DM_FatTable.antsel_rx_keep_0)&BIT2)>>2, -+ // ((pDM_Odm->DM_FatTable.antsel_rx_keep_0)&BIT1) >>1, ((pDM_Odm->DM_FatTable.antsel_rx_keep_0)&BIT0))); -+ -+ LocalMaxRSSI = (Main_RSSI>Aux_RSSI)?Main_RSSI:Aux_RSSI; -+ //2 Select MaxRSSI for DIG -+ if((LocalMaxRSSI > AntDivMaxRSSI) && (LocalMaxRSSI < 40)) -+ AntDivMaxRSSI = LocalMaxRSSI; -+ if(LocalMaxRSSI > MaxRSSI) -+ MaxRSSI = LocalMaxRSSI; -+ -+ //2 Select RX Idle Antenna -+ if ( (LocalMaxRSSI != 0) && (LocalMaxRSSI < MinMaxRSSI) ) -+ { -+ RxIdleAnt = TargetAnt; -+ MinMaxRSSI = LocalMaxRSSI; -+ } -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ if(pDM_Odm->antdiv_evm_en==1) -+ { -+ if(pDM_FatTable->TargetAnt_enhance!=0xFF) -+ { -+ TargetAnt=pDM_FatTable->TargetAnt_enhance; -+ RxIdleAnt = pDM_FatTable->TargetAnt_enhance; -+ } -+ } -+ #endif -+ -+ //2 Select TX Antenna -+ if(pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) -+ { -+ #ifdef BEAMFORMING_SUPPORT -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if(pDM_BdcTable->w_BFee_Client[i]==0) -+ #endif -+ #endif -+ { -+ odm_UpdateTxAnt(pDM_Odm, TargetAnt, i); -+ } -+ } -+ -+ //------------------------------------------------------------ -+ -+ #ifdef BEAMFORMING_SUPPORT -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ pDM_BdcTable->num_Client++; -+ -+ if(pDM_BdcTable->BDC_Mode==BDC_MODE_2 ||pDM_BdcTable->BDC_Mode==BDC_MODE_3) -+ { -+ //2 Byte Counter -+ -+ MA_rx_Temp= (pEntry->rx_byte_cnt_LowMAW)<<3 ; // RX TP ( bit /sec) -+ -+ if(pDM_BdcTable->BDC_state==BDC_BFer_TRAIN_STATE) -+ { -+ pDM_BdcTable->MA_rx_TP_DIV[i]= MA_rx_Temp ; -+ } -+ else -+ { -+ pDM_BdcTable->MA_rx_TP[i] =MA_rx_Temp ; -+ } -+ -+ if( (MA_rx_Temp < TH2) && (MA_rx_Temp > TH1) && (LocalMaxRSSI<=Monitor_RSSI_threshold)) -+ { -+ if(pDM_BdcTable->w_BFer_Client[i]==1) // Bfer_Target -+ { -+ pDM_BdcTable->num_BfTar++; -+ -+ if(pDM_BdcTable->BDC_state==BDC_DECISION_STATE && pDM_BdcTable->BDC_Try_flag==0) -+ { -+ improve_TP_temp = (pDM_BdcTable->MA_rx_TP_DIV[i] * 9)>>3 ; //* 1.125 -+ pDM_BdcTable->BF_pass = (pDM_BdcTable->MA_rx_TP[i] > improve_TP_temp)?TRUE:FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : { MA_rx_TP,improve_TP_temp , MA_rx_TP_DIV, BF_pass}={ %d, %d, %d , %d } \n" ,i,pDM_BdcTable->MA_rx_TP[i],improve_TP_temp,pDM_BdcTable->MA_rx_TP_DIV[i], pDM_BdcTable->BF_pass )); -+ } -+ } -+ else// DIV_Target -+ { -+ pDM_BdcTable->num_DivTar++; -+ -+ if(pDM_BdcTable->BDC_state==BDC_DECISION_STATE && pDM_BdcTable->BDC_Try_flag==0) -+ { -+ degrade_TP_temp=(pDM_BdcTable->MA_rx_TP_DIV[i]*5)>>3;//* 0.625 -+ pDM_BdcTable->DIV_pass = (pDM_BdcTable->MA_rx_TP[i] >degrade_TP_temp)?TRUE:FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : { MA_rx_TP, degrade_TP_temp , MA_rx_TP_DIV, DIV_pass}=\n{ %d, %d, %d , %d } \n" ,i,pDM_BdcTable->MA_rx_TP[i],degrade_TP_temp,pDM_BdcTable->MA_rx_TP_DIV[i], pDM_BdcTable->DIV_pass )); -+ } -+ } -+ } -+ -+ if(MA_rx_Temp > TH1) -+ { -+ if(pDM_BdcTable->w_BFer_Client[i]==1) // Bfer_Target -+ { -+ pDM_BdcTable->bAll_BFSta_Idle=FALSE; -+ } -+ else// DIV_Target -+ { -+ pDM_BdcTable->bAll_DivSta_Idle=FALSE; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : { BFmeeCap , BFmerCap} = { %d , %d } \n" ,i, pDM_BdcTable->w_BFee_Client[i] , pDM_BdcTable->w_BFer_Client[i])); -+ -+ if(pDM_BdcTable->BDC_state==BDC_BFer_TRAIN_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MA_rx_TP_DIV = (( %d )) \n",i,pDM_BdcTable->MA_rx_TP_DIV[i] )); -+ -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MA_rx_TP = (( %d )) \n",i,pDM_BdcTable->MA_rx_TP[i] )); -+ } -+ -+ } -+ #endif -+ #endif -+ -+ } -+ -+ #ifdef BEAMFORMING_SUPPORT -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if(pDM_BdcTable->BDC_Try_flag==0) -+ #endif -+ #endif -+ { -+ pDM_FatTable->MainAnt_Sum[i] = 0; -+ pDM_FatTable->AuxAnt_Sum[i] = 0; -+ pDM_FatTable->MainAnt_Cnt[i] = 0; -+ pDM_FatTable->AuxAnt_Cnt[i] = 0; -+ } -+ } -+ -+ -+ -+ //2 Set RX Idle Antenna & TX Antenna(Because of HW Bug ) -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP ) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** RxIdleAnt = (( %s ))\n\n", ( RxIdleAnt ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ -+ #ifdef BEAMFORMING_SUPPORT -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if(pDM_BdcTable->BDC_Mode==BDC_MODE_1 ||pDM_BdcTable->BDC_Mode==BDC_MODE_3) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** BDC_RxIdleUpdate_counter = (( %d ))\n", pDM_BdcTable->BDC_RxIdleUpdate_counter)); -+ -+ if(pDM_BdcTable->BDC_RxIdleUpdate_counter==1) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***Update RxIdle Antenna!!! \n")); -+ pDM_BdcTable->BDC_RxIdleUpdate_counter=30; -+ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); -+ } -+ else -+ { -+ pDM_BdcTable->BDC_RxIdleUpdate_counter--; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***NOT update RxIdle Antenna because of BF ( need to fix TX-ant)\n")); -+ } -+ } -+ else -+ #endif -+ #endif -+ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); -+ #else -+ -+ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); -+ -+ #endif//#if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ -+ -+ //2 BDC Main Algorithm -+ #ifdef BEAMFORMING_SUPPORT -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if(pDM_Odm->antdiv_evm_en ==0 ||pDM_FatTable->EVM_method_enable==0) -+ { -+ odm_BDCcoex_BFeeRxDiv_Arbitration(pDM_Odm); -+ } -+ #endif -+ #endif -+ -+ if(AntDivMaxRSSI == 0) -+ pDM_DigTable->AntDiv_RSSI_max = pDM_Odm->RSSI_Min; -+ else -+ pDM_DigTable->AntDiv_RSSI_max = AntDivMaxRSSI; -+ -+ pDM_DigTable->RSSI_max = MaxRSSI; -+} -+ -+ -+ -+#if (RTL8723B_SUPPORT == 1)||(RTL8821A_SUPPORT == 1) -+VOID -+odm_S0S1_SwAntDiv( -+ IN PVOID pDM_VOID, -+ IN u1Byte Step -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte i,MinMaxRSSI=0xFF, LocalMaxRSSI,LocalMinRSSI; -+ u4Byte Main_RSSI, Aux_RSSI; -+ u1Byte reset_period=10, SWAntDiv_threshold=35; -+ u1Byte HighTraffic_TrainTime_U=0x32,HighTraffic_TrainTime_L=0,Train_time_temp; -+ u1Byte LowTraffic_TrainTime_U=200,LowTraffic_TrainTime_L=0; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u1Byte RxIdleAnt = pDM_SWAT_Table->PreAntenna, TargetAnt, nextAnt=0; -+ PSTA_INFO_T pEntry=NULL; -+ //static u1Byte reset_idx; -+ u4Byte value32; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ u8Byte curTxOkCnt=0, curRxOkCnt=0,TxCntOffset, RxCntOffset; -+ -+ if(!pDM_Odm->bLinked) //bLinked==False -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); -+ if(pDM_FatTable->bBecomeLinked == TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set REG 948[9:6]=0x0 \n")); -+ if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ ODM_SetBBReg(pDM_Odm, 0x948 , BIT9|BIT8|BIT7|BIT6, 0x0); -+ -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ return; -+ } -+ else -+ { -+ if(pDM_FatTable->bBecomeLinked ==FALSE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ value32 = ODM_GetBBReg(pDM_Odm, 0x864, BIT5|BIT4|BIT3); -+ -+ if (value32==0x0) -+ ODM_UpdateRxIdleAnt_8723B(pDM_Odm, MAIN_ANT, ANT1_2G, ANT2_2G); -+ else if (value32==0x1) -+ ODM_UpdateRxIdleAnt_8723B(pDM_Odm, AUX_ANT, ANT2_2G, ANT1_2G); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("8723B: First link! Force antenna to %s\n",(value32 == 0x0?"MAIN":"AUX") )); -+ } -+ -+ pDM_SWAT_Table->lastTxOkCnt = 0; -+ pDM_SWAT_Table->lastRxOkCnt =0; -+ TxCntOffset = *(pDM_Odm->pNumTxBytesUnicast); -+ RxCntOffset = *(pDM_Odm->pNumRxBytesUnicast); -+ -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ else -+ { -+ TxCntOffset = 0; -+ RxCntOffset = 0; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[%d] { try_flag=(( %d )), Step=(( %d )), Double_chk_flag = (( %d )) }\n", -+ __LINE__,pDM_SWAT_Table->try_flag,Step,pDM_SWAT_Table->Double_chk_flag)); -+ -+ // Handling step mismatch condition. -+ // Peak step is not finished at last time. Recover the variable and check again. -+ if( Step != pDM_SWAT_Table->try_flag ) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Step != try_flag] Need to Reset After Link\n")); -+ ODM_SwAntDivRestAfterLink(pDM_Odm); -+ } -+ -+ if(pDM_SWAT_Table->try_flag == 0xff) -+ { -+ pDM_SWAT_Table->try_flag = 0; -+ pDM_SWAT_Table->Train_time_flag=0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("[set try_flag = 0] Prepare for peak!\n\n")); -+ return; -+ } -+ else//if( try_flag != 0xff ) -+ { -+ //1 Normal State (Begin Trying) -+ if(pDM_SWAT_Table->try_flag == 0) -+ { -+ -+ //---trafic decision--- -+ curTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast) - pDM_SWAT_Table->lastTxOkCnt - TxCntOffset; -+ curRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast) - pDM_SWAT_Table->lastRxOkCnt - RxCntOffset; -+ pDM_SWAT_Table->lastTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast); -+ pDM_SWAT_Table->lastRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast); -+ -+ if (curTxOkCnt > 1875000 || curRxOkCnt > 1875000)//if(PlatformDivision64(curTxOkCnt+curRxOkCnt, 2) > 1875000) ( 1.875M * 8bit ) / 2= 7.5M bits /sec ) -+ { -+ pDM_SWAT_Table->TrafficLoad = TRAFFIC_HIGH; -+ Train_time_temp = pDM_SWAT_Table->Train_time ; -+ -+ if(pDM_SWAT_Table->Train_time_flag==3) -+ { -+ HighTraffic_TrainTime_L=0xa; -+ -+ if(Train_time_temp<=16) -+ Train_time_temp=HighTraffic_TrainTime_L; -+ else -+ Train_time_temp-=16; -+ -+ } -+ else if(pDM_SWAT_Table->Train_time_flag==2) -+ { -+ Train_time_temp-=8; -+ HighTraffic_TrainTime_L=0xf; -+ } -+ else if(pDM_SWAT_Table->Train_time_flag==1) -+ { -+ Train_time_temp-=4; -+ HighTraffic_TrainTime_L=0x1e; -+ } -+ else if(pDM_SWAT_Table->Train_time_flag==0) -+ { -+ Train_time_temp+=8; -+ HighTraffic_TrainTime_L=0x28; -+ } -+ -+ -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Train_time_temp = ((%d))\n",Train_time_temp)); -+ -+ //-- -+ if(Train_time_temp > HighTraffic_TrainTime_U) -+ Train_time_temp=HighTraffic_TrainTime_U; -+ -+ else if(Train_time_temp < HighTraffic_TrainTime_L) -+ Train_time_temp=HighTraffic_TrainTime_L; -+ -+ pDM_SWAT_Table->Train_time = Train_time_temp; //50ms~10ms -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,(" Train_time_flag=((%d)) , Train_time=((%d)) \n",pDM_SWAT_Table->Train_time_flag, pDM_SWAT_Table->Train_time)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [HIGH Traffic] \n" )); -+ } -+ else if (curTxOkCnt > 125000 || curRxOkCnt > 125000) // ( 0.125M * 8bit ) / 2 = 0.5M bits /sec ) -+ { -+ pDM_SWAT_Table->TrafficLoad = TRAFFIC_LOW; -+ Train_time_temp=pDM_SWAT_Table->Train_time ; -+ -+ if(pDM_SWAT_Table->Train_time_flag==3) -+ { -+ LowTraffic_TrainTime_L=10; -+ if(Train_time_temp<50) -+ Train_time_temp=LowTraffic_TrainTime_L; -+ else -+ Train_time_temp-=50; -+ } -+ else if(pDM_SWAT_Table->Train_time_flag==2) -+ { -+ Train_time_temp-=30; -+ LowTraffic_TrainTime_L=36; -+ } -+ else if(pDM_SWAT_Table->Train_time_flag==1) -+ { -+ Train_time_temp-=10; -+ LowTraffic_TrainTime_L=40; -+ } -+ else -+ Train_time_temp+=10; -+ -+ //-- -+ if(Train_time_temp >= LowTraffic_TrainTime_U) -+ Train_time_temp=LowTraffic_TrainTime_U; -+ -+ else if(Train_time_temp <= LowTraffic_TrainTime_L) -+ Train_time_temp=LowTraffic_TrainTime_L; -+ -+ pDM_SWAT_Table->Train_time = Train_time_temp; //50ms~20ms -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Train_time_flag=((%d)) , Train_time=((%d))\n", pDM_SWAT_Table->Train_time_flag, pDM_SWAT_Table->Train_time)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Low Traffic]\n")); -+ } -+ else -+ { -+ pDM_SWAT_Table->TrafficLoad = TRAFFIC_ULTRA_LOW; -+ pDM_SWAT_Table->Train_time = 0xc8; //200ms -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Ultra-Low Traffic]\n")); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("TxOkCnt=(( %llu )), RxOkCnt=(( %llu ))\n", -+ curTxOkCnt ,curRxOkCnt )); -+ -+ //----------------- -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,(" Current MinMaxRSSI is ((%d)) \n",pDM_FatTable->MinMaxRSSI)); -+ -+ //---reset index--- -+ if(pDM_SWAT_Table->reset_idx>=reset_period) -+ { -+ pDM_FatTable->MinMaxRSSI=0; // -+ pDM_SWAT_Table->reset_idx=0; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("reset_idx = (( %d )) \n",pDM_SWAT_Table->reset_idx )); -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("reset_idx=%d\n",pDM_SWAT_Table->reset_idx)); -+ pDM_SWAT_Table->reset_idx++; -+ -+ //---double check flag--- -+ if(pDM_FatTable->MinMaxRSSI > SWAntDiv_threshold && pDM_SWAT_Table->Double_chk_flag== 0) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,(" MinMaxRSSI is ((%d)), and > %d \n", -+ pDM_FatTable->MinMaxRSSI,SWAntDiv_threshold)); -+ -+ pDM_SWAT_Table->Double_chk_flag =1; -+ pDM_SWAT_Table->try_flag = 1; -+ pDM_SWAT_Table->RSSI_Trying = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Test the current Ant for (( %d )) ms again \n", pDM_SWAT_Table->Train_time)); -+ ODM_UpdateRxIdleAnt(pDM_Odm, pDM_FatTable->RxIdleAnt); -+ ODM_SetTimer(pDM_Odm,&pDM_SWAT_Table->SwAntennaSwitchTimer_8723B, pDM_SWAT_Table->Train_time ); //ms -+ return; -+ } -+ -+ nextAnt = (pDM_FatTable->RxIdleAnt == MAIN_ANT)? AUX_ANT : MAIN_ANT; -+ -+ pDM_SWAT_Table->try_flag = 1; -+ -+ if(pDM_SWAT_Table->reset_idx<=1) -+ pDM_SWAT_Table->RSSI_Trying = 2; -+ else -+ pDM_SWAT_Table->RSSI_Trying = 1; -+ -+ odm_S0S1_SwAntDivByCtrlFrame(pDM_Odm, SWAW_STEP_PEAK); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("[set try_flag=1] Normal State: Begin Trying!! \n")); -+ } -+ -+ else if(pDM_SWAT_Table->try_flag == 1 && pDM_SWAT_Table->Double_chk_flag== 0) -+ { -+ nextAnt = (pDM_FatTable->RxIdleAnt == MAIN_ANT)? AUX_ANT : MAIN_ANT; -+ pDM_SWAT_Table->RSSI_Trying--; -+ } -+ -+ //1 Decision State -+ if((pDM_SWAT_Table->try_flag == 1)&&(pDM_SWAT_Table->RSSI_Trying == 0) ) -+ { -+ BOOLEAN bByCtrlFrame = FALSE; -+ u8Byte pkt_cnt_total = 0; -+ -+ for (i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pEntry)) -+ { -+ //2 Caculate RSSI per Antenna -+ Main_RSSI = (pDM_FatTable->MainAnt_Cnt[i]!=0)?(pDM_FatTable->MainAnt_Sum[i]/pDM_FatTable->MainAnt_Cnt[i]):0; -+ Aux_RSSI = (pDM_FatTable->AuxAnt_Cnt[i]!=0)?(pDM_FatTable->AuxAnt_Sum[i]/pDM_FatTable->AuxAnt_Cnt[i]):0; -+ -+ if(pDM_FatTable->MainAnt_Cnt[i]<=1 && pDM_FatTable->CCK_counter_main>=1) -+ Main_RSSI=0; -+ -+ if(pDM_FatTable->AuxAnt_Cnt[i]<=1 && pDM_FatTable->CCK_counter_aux>=1) -+ Aux_RSSI=0; -+ -+ TargetAnt = (Main_RSSI==Aux_RSSI)?pDM_SWAT_Table->PreAntenna:((Main_RSSI>=Aux_RSSI)?MAIN_ANT:AUX_ANT); -+ LocalMaxRSSI = (Main_RSSI>=Aux_RSSI) ? Main_RSSI : Aux_RSSI; -+ LocalMinRSSI = (Main_RSSI>=Aux_RSSI) ? Aux_RSSI : Main_RSSI; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** CCK_counter_main = (( %d )) , CCK_counter_aux= (( %d )) \n", pDM_FatTable->CCK_counter_main, pDM_FatTable->CCK_counter_aux)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** OFDM_counter_main = (( %d )) , OFDM_counter_aux= (( %d )) \n", pDM_FatTable->OFDM_counter_main, pDM_FatTable->OFDM_counter_aux)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Main_Cnt = (( %d )) , Main_RSSI= (( %d )) \n", pDM_FatTable->MainAnt_Cnt[i], Main_RSSI)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Aux_Cnt = (( %d )) , Aux_RSSI = (( %d )) \n", pDM_FatTable->AuxAnt_Cnt[i] , Aux_RSSI )); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** MAC ID:[ %d ] , TargetAnt = (( %s )) \n", i ,( TargetAnt ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ -+ //2 Select RX Idle Antenna -+ -+ if (LocalMaxRSSI != 0 && LocalMaxRSSI < MinMaxRSSI) -+ { -+ RxIdleAnt = TargetAnt; -+ MinMaxRSSI = LocalMaxRSSI; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** LocalMaxRSSI-LocalMinRSSI = ((%d))\n",(LocalMaxRSSI-LocalMinRSSI))); -+ -+ if((LocalMaxRSSI-LocalMinRSSI)>8) -+ { -+ if(LocalMinRSSI != 0) -+ pDM_SWAT_Table->Train_time_flag=3; -+ else -+ { -+ if(MinMaxRSSI > SWAntDiv_threshold) -+ pDM_SWAT_Table->Train_time_flag=0; -+ else -+ pDM_SWAT_Table->Train_time_flag=3; -+ } -+ } -+ else if((LocalMaxRSSI-LocalMinRSSI)>5) -+ pDM_SWAT_Table->Train_time_flag=2; -+ else if((LocalMaxRSSI-LocalMinRSSI)>2) -+ pDM_SWAT_Table->Train_time_flag=1; -+ else -+ pDM_SWAT_Table->Train_time_flag=0; -+ -+ } -+ -+ //2 Select TX Antenna -+ if(TargetAnt == MAIN_ANT) -+ pDM_FatTable->antsel_a[i] = ANT1_2G; -+ else -+ pDM_FatTable->antsel_a[i] = ANT2_2G; -+ -+ } -+ pDM_FatTable->MainAnt_Sum[i] = 0; -+ pDM_FatTable->AuxAnt_Sum[i] = 0; -+ pDM_FatTable->MainAnt_Cnt[i] = 0; -+ pDM_FatTable->AuxAnt_Cnt[i] = 0; -+ } -+ -+ if(pDM_SWAT_Table->bSWAntDivByCtrlFrame) -+ { -+ odm_S0S1_SwAntDivByCtrlFrame(pDM_Odm, SWAW_STEP_DETERMINE); -+ bByCtrlFrame = TRUE; -+ } -+ -+ pkt_cnt_total = pDM_FatTable->CCK_counter_main + pDM_FatTable->CCK_counter_aux + -+ pDM_FatTable->OFDM_counter_main + pDM_FatTable->OFDM_counter_aux; -+ pDM_FatTable->CCK_counter_main=0; -+ pDM_FatTable->CCK_counter_aux=0; -+ pDM_FatTable->OFDM_counter_main=0; -+ pDM_FatTable->OFDM_counter_aux=0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Control frame packet counter = %d, Data frame packet counter = %llu\n", -+ pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame, pkt_cnt_total)); -+ -+ if(MinMaxRSSI == 0xff || ((pkt_cnt_total < (pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame >> 1)) && pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 2)) -+ { -+ MinMaxRSSI = 0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Check RSSI of control frame because MinMaxRSSI == 0xff\n")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("bByCtrlFrame = %d\n", bByCtrlFrame)); -+ -+ if(bByCtrlFrame) -+ { -+ Main_RSSI = (pDM_FatTable->MainAnt_CtrlFrame_Cnt!=0)?(pDM_FatTable->MainAnt_CtrlFrame_Sum/pDM_FatTable->MainAnt_CtrlFrame_Cnt):0; -+ Aux_RSSI = (pDM_FatTable->AuxAnt_CtrlFrame_Cnt!=0)?(pDM_FatTable->AuxAnt_CtrlFrame_Sum/pDM_FatTable->AuxAnt_CtrlFrame_Cnt):0; -+ -+ if(pDM_FatTable->MainAnt_CtrlFrame_Cnt<=1 && pDM_FatTable->CCK_CtrlFrame_Cnt_main>=1) -+ Main_RSSI=0; -+ -+ if(pDM_FatTable->AuxAnt_CtrlFrame_Cnt<=1 && pDM_FatTable->CCK_CtrlFrame_Cnt_aux>=1) -+ Aux_RSSI=0; -+ -+ if (Main_RSSI != 0 || Aux_RSSI != 0) -+ { -+ RxIdleAnt = (Main_RSSI==Aux_RSSI)?pDM_SWAT_Table->PreAntenna:((Main_RSSI>=Aux_RSSI)?MAIN_ANT:AUX_ANT); -+ LocalMaxRSSI = (Main_RSSI>=Aux_RSSI) ? Main_RSSI : Aux_RSSI; -+ LocalMinRSSI = (Main_RSSI>=Aux_RSSI) ? Aux_RSSI : Main_RSSI; -+ -+ if((LocalMaxRSSI-LocalMinRSSI)>8) -+ pDM_SWAT_Table->Train_time_flag=3; -+ else if((LocalMaxRSSI-LocalMinRSSI)>5) -+ pDM_SWAT_Table->Train_time_flag=2; -+ else if((LocalMaxRSSI-LocalMinRSSI)>2) -+ pDM_SWAT_Table->Train_time_flag=1; -+ else -+ pDM_SWAT_Table->Train_time_flag=0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Control frame: Main_RSSI = %d, Aux_RSSI = %d\n", Main_RSSI, Aux_RSSI)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("RxIdleAnt decided by control frame = %s\n", (RxIdleAnt == MAIN_ANT?"MAIN":"AUX"))); -+ } -+ } -+ } -+ -+ pDM_FatTable->MinMaxRSSI = MinMaxRSSI; -+ pDM_SWAT_Table->try_flag = 0; -+ -+ if( pDM_SWAT_Table->Double_chk_flag==1) -+ { -+ pDM_SWAT_Table->Double_chk_flag=0; -+ if(pDM_FatTable->MinMaxRSSI > SWAntDiv_threshold) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,(" [Double check] MinMaxRSSI ((%d)) > %d again!! \n", -+ pDM_FatTable->MinMaxRSSI,SWAntDiv_threshold)); -+ -+ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("[reset try_flag = 0] Training accomplished !!!] \n\n\n")); -+ return; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,(" [Double check] MinMaxRSSI ((%d)) <= %d !! \n", -+ pDM_FatTable->MinMaxRSSI,SWAntDiv_threshold)); -+ -+ nextAnt = (pDM_FatTable->RxIdleAnt == MAIN_ANT)? AUX_ANT : MAIN_ANT; -+ pDM_SWAT_Table->try_flag = 0; -+ pDM_SWAT_Table->reset_idx=reset_period; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("[set try_flag=0] Normal State: Need to tryg again!! \n\n\n")); -+ return; -+ } -+ } -+ else -+ { -+ if(pDM_FatTable->MinMaxRSSI < SWAntDiv_threshold) -+ pDM_SWAT_Table->reset_idx=reset_period; -+ -+ pDM_SWAT_Table->PreAntenna =RxIdleAnt; -+ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt ); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("[reset try_flag = 0] Training accomplished !!!] \n\n\n")); -+ return; -+ } -+ -+ } -+ -+ } -+ -+ //1 4.Change TRX antenna -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("RSSI_Trying = (( %d )), Ant: (( %s )) >>> (( %s )) \n", -+ pDM_SWAT_Table->RSSI_Trying, (pDM_FatTable->RxIdleAnt == MAIN_ANT?"MAIN":"AUX"),(nextAnt == MAIN_ANT?"MAIN":"AUX"))); -+ -+ ODM_UpdateRxIdleAnt(pDM_Odm, nextAnt); -+ -+ //1 5.Reset Statistics -+ -+ pDM_FatTable->RxIdleAnt = nextAnt; -+ -+ //1 6.Set next timer (Trying State) -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Test ((%s)) Ant for (( %d )) ms \n", (nextAnt == MAIN_ANT?"MAIN":"AUX"), pDM_SWAT_Table->Train_time)); -+ ODM_SetTimer(pDM_Odm,&pDM_SWAT_Table->SwAntennaSwitchTimer_8723B, pDM_SWAT_Table->Train_time ); //ms -+} -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+ODM_SW_AntDiv_Callback( -+ PRT_TIMER pTimer -+) -+{ -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ pSWAT_T pDM_SWAT_Table = &pHalData->DM_OutSrc.DM_SWAT_Table; -+ -+ #if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ #if USE_WORKITEM -+ ODM_ScheduleWorkItem(&pDM_SWAT_Table->SwAntennaSwitchWorkitem_8723B); -+ #else -+ { -+ //DbgPrint("SW_antdiv_Callback"); -+ odm_S0S1_SwAntDiv(&pHalData->DM_OutSrc, SWAW_STEP_DETERMINE); -+ } -+ #endif -+ #else -+ ODM_ScheduleWorkItem(&pDM_SWAT_Table->SwAntennaSwitchWorkitem_8723B); -+ #endif -+} -+VOID -+ODM_SW_AntDiv_WorkitemCallback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER pAdapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ //DbgPrint("SW_antdiv_Workitem_Callback"); -+ odm_S0S1_SwAntDiv(&pHalData->DM_OutSrc, SWAW_STEP_DETERMINE); -+} -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+VOID -+ODM_SW_AntDiv_WorkitemCallback( -+ IN PVOID pContext -+) -+{ -+ PADAPTER -+ pAdapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE -+ *pHalData = GET_HAL_DATA(pAdapter); -+ -+ /*DbgPrint("SW_antdiv_Workitem_Callback");*/ -+ odm_S0S1_SwAntDiv(&pHalData->odmpriv, SWAW_STEP_DETERMINE); -+} -+ -+VOID -+ODM_SW_AntDiv_Callback(void *FunctionContext) -+{ -+ PDM_ODM_T pDM_Odm= (PDM_ODM_T)FunctionContext; -+ PADAPTER padapter = pDM_Odm->Adapter; -+ if(padapter->net_closed == _TRUE) -+ return; -+ -+ #if 0 /* Can't do I/O in timer callback*/ -+ odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_DETERMINE); -+ #else -+ rtw_run_in_thread_cmd(padapter, ODM_SW_AntDiv_WorkitemCallback, padapter); -+ #endif -+} -+ -+ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+VOID -+odm_S0S1_SwAntDivByCtrlFrame( -+ IN PVOID pDM_VOID, -+ IN u1Byte Step -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ switch(Step) -+ { -+ case SWAW_STEP_PEAK: -+ pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame = 0; -+ pDM_SWAT_Table->bSWAntDivByCtrlFrame = TRUE; -+ pDM_FatTable->MainAnt_CtrlFrame_Cnt = 0; -+ pDM_FatTable->AuxAnt_CtrlFrame_Cnt = 0; -+ pDM_FatTable->MainAnt_CtrlFrame_Sum = 0; -+ pDM_FatTable->AuxAnt_CtrlFrame_Sum = 0; -+ pDM_FatTable->CCK_CtrlFrame_Cnt_main = 0; -+ pDM_FatTable->CCK_CtrlFrame_Cnt_aux = 0; -+ pDM_FatTable->OFDM_CtrlFrame_Cnt_main = 0; -+ pDM_FatTable->OFDM_CtrlFrame_Cnt_aux = 0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("odm_S0S1_SwAntDivForAPMode(): Start peak and reset counter\n")); -+ break; -+ case SWAW_STEP_DETERMINE: -+ pDM_SWAT_Table->bSWAntDivByCtrlFrame = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("odm_S0S1_SwAntDivForAPMode(): Stop peak\n")); -+ break; -+ default: -+ pDM_SWAT_Table->bSWAntDivByCtrlFrame = FALSE; -+ break; -+ } -+} -+ -+VOID -+odm_AntselStatisticsOfCtrlFrame( -+ IN PVOID pDM_VOID, -+ IN u1Byte antsel_tr_mux, -+ IN u4Byte RxPWDBAll -+ -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ if(antsel_tr_mux == ANT1_2G) -+ { -+ pDM_FatTable->MainAnt_CtrlFrame_Sum+=RxPWDBAll; -+ pDM_FatTable->MainAnt_CtrlFrame_Cnt++; -+ } -+ else -+ { -+ pDM_FatTable->AuxAnt_CtrlFrame_Sum+=RxPWDBAll; -+ pDM_FatTable->AuxAnt_CtrlFrame_Cnt++; -+ } -+} -+ -+VOID -+odm_S0S1_SwAntDivByCtrlFrame_ProcessRSSI( -+ IN PVOID pDM_VOID, -+ IN PVOID p_phy_info_void, -+ IN PVOID p_pkt_info_void -+ //IN PODM_PHY_INFO_T pPhyInfo, -+ //IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_PHY_INFO_T pPhyInfo=(PODM_PHY_INFO_T)p_phy_info_void; -+ PODM_PACKET_INFO_T pPktinfo=(PODM_PACKET_INFO_T)p_pkt_info_void; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ BOOLEAN isCCKrate; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ return; -+ -+ if(pDM_Odm->AntDivType != S0S1_SW_ANTDIV) -+ return; -+ -+ // In try state -+ if(!pDM_SWAT_Table->bSWAntDivByCtrlFrame) -+ return; -+ -+ // No HW error and match receiver address -+ if(!pPktinfo->bToSelf) -+ return; -+ -+ pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame++; -+ isCCKrate = ((pPktinfo->DataRate >= DESC_RATE1M ) && (pPktinfo->DataRate <= DESC_RATE11M ))?TRUE :FALSE; -+ -+ if(isCCKrate) -+ { -+ pDM_FatTable->antsel_rx_keep_0 = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? ANT1_2G : ANT2_2G; -+ -+ if(pDM_FatTable->antsel_rx_keep_0==ANT1_2G) -+ pDM_FatTable->CCK_CtrlFrame_Cnt_main++; -+ else -+ pDM_FatTable->CCK_CtrlFrame_Cnt_aux++; -+ -+ odm_AntselStatisticsOfCtrlFrame(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]); -+ } -+ else -+ { -+ if(pDM_FatTable->antsel_rx_keep_0==ANT1_2G) -+ pDM_FatTable->OFDM_CtrlFrame_Cnt_main++; -+ else -+ pDM_FatTable->OFDM_CtrlFrame_Cnt_aux++; -+ -+ odm_AntselStatisticsOfCtrlFrame(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPhyInfo->RxPWDBAll); -+ } -+} -+#endif //#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ -+#endif //#if (RTL8723B_SUPPORT == 1)||(RTL8821A_SUPPORT == 1) -+ -+ -+ -+ -+VOID -+odm_SetNextMACAddrTarget( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ PSTA_INFO_T pEntry; -+ u4Byte value32, i; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_SetNextMACAddrTarget() ==>\n")); -+ -+ if (pDM_Odm->bLinked) -+ { -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ -+ if ((pDM_FatTable->TrainIdx+1) == ODM_ASSOCIATE_ENTRY_NUM) -+ pDM_FatTable->TrainIdx = 0; -+ else -+ pDM_FatTable->TrainIdx++; -+ -+ pEntry = pDM_Odm->pODM_StaInfo[pDM_FatTable->TrainIdx]; -+ -+ if (IS_STA_VALID(pEntry)) { -+ -+ /*Match MAC ADDR*/ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ value32 = (pEntry->hwaddr[5]<<8)|pEntry->hwaddr[4]; -+ #else -+ value32 = (pEntry->MacAddr[5]<<8)|pEntry->MacAddr[4]; -+ #endif -+ -+ ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, value32);/*0x7b4~0x7b5*/ -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ value32 = (pEntry->hwaddr[3]<<24)|(pEntry->hwaddr[2]<<16) |(pEntry->hwaddr[1]<<8) |pEntry->hwaddr[0]; -+ #else -+ value32 = (pEntry->MacAddr[3]<<24)|(pEntry->MacAddr[2]<<16) |(pEntry->MacAddr[1]<<8) |pEntry->MacAddr[0]; -+ #endif -+ ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, value32);/*0x7b0~0x7b3*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_FatTable->TrainIdx=%d\n", pDM_FatTable->TrainIdx)); -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training MAC Addr = %x:%x:%x:%x:%x:%x\n", -+ pEntry->hwaddr[5], pEntry->hwaddr[4], pEntry->hwaddr[3], pEntry->hwaddr[2], pEntry->hwaddr[1], pEntry->hwaddr[0])); -+ #else -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training MAC Addr = %x:%x:%x:%x:%x:%x\n", -+ pEntry->MacAddr[5], pEntry->MacAddr[4], pEntry->MacAddr[3], pEntry->MacAddr[2], pEntry->MacAddr[1], pEntry->MacAddr[0])); -+ #endif -+ -+ break; -+ } -+ } -+ } -+ -+#if 0 -+ // -+ //2012.03.26 LukeLee: This should be removed later, the MAC address is changed according to MACID in turn -+ // -+ #if( DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ { -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ -+ for (i=0; i<6; i++) -+ { -+ Bssid[i] = pMgntInfo->Bssid[i]; -+ //DbgPrint("Bssid[%d]=%x\n", i, Bssid[i]); -+ } -+ } -+ #endif -+ -+ //odm_SetNextMACAddrTarget(pDM_Odm); -+ -+ //1 Select MAC Address Filter -+ for (i=0; i<6; i++) -+ { -+ if(Bssid[i] != pDM_FatTable->Bssid[i]) -+ { -+ bMatchBSSID = FALSE; -+ break; -+ } -+ } -+ if(bMatchBSSID == FALSE) -+ { -+ //Match MAC ADDR -+ value32 = (Bssid[5]<<8)|Bssid[4]; -+ ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, value32); -+ value32 = (Bssid[3]<<24)|(Bssid[2]<<16) |(Bssid[1]<<8) |Bssid[0]; -+ ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, value32); -+ } -+ -+ return bMatchBSSID; -+#endif -+ -+} -+ -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ -+VOID -+odm_FastAntTraining( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ u4Byte MaxRSSI_pathA=0, Pckcnt_pathA=0; -+ u1Byte i,TargetAnt_pathA=0; -+ BOOLEAN bPktFilterMacth_pathA = FALSE; -+ #if(RTL8192E_SUPPORT == 1) -+ u4Byte MaxRSSI_pathB=0, Pckcnt_pathB=0; -+ u1Byte TargetAnt_pathB=0; -+ BOOLEAN bPktFilterMacth_pathB = FALSE; -+ #endif -+ -+ -+ if(!pDM_Odm->bLinked) //bLinked==False -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); -+ -+ if(pDM_FatTable->bBecomeLinked == TRUE) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ phydm_FastTraining_enable(pDM_Odm , FAT_OFF); -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm , REG); -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ return; -+ } -+ else -+ { -+ if(pDM_FatTable->bBecomeLinked ==FALSE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked!!!]\n")); -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm , TX_BY_DESC); -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ } -+ -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT2|BIT1|BIT0, ((pDM_Odm->fat_comb_a)-1)); -+ } -+ #if(RTL8192E_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT2|BIT1|BIT0, ((pDM_Odm->fat_comb_a)-1) ); //path-A // ant combination=regB38[2:0]+1 -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT18|BIT17|BIT16, ((pDM_Odm->fat_comb_b)-1) ); //path-B // ant combination=regB38[18:16]+1 -+ } -+ #endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("==>odm_FastAntTraining()\n")); -+ -+ //1 TRAINING STATE -+ if(pDM_FatTable->FAT_State == FAT_TRAINING_STATE) -+ { -+ //2 Caculate RSSI per Antenna -+ -+ //3 [path-A]--------------------------- -+ for (i=0; i<(pDM_Odm->fat_comb_a); i++) // i : antenna index -+ { -+ if(pDM_FatTable->antRSSIcnt[i] == 0) -+ pDM_FatTable->antAveRSSI[i] = 0; -+ else -+ { -+ pDM_FatTable->antAveRSSI[i] = pDM_FatTable->antSumRSSI[i] /pDM_FatTable->antRSSIcnt[i]; -+ bPktFilterMacth_pathA = TRUE; -+ } -+ -+ if(pDM_FatTable->antAveRSSI[i] > MaxRSSI_pathA) -+ { -+ MaxRSSI_pathA = pDM_FatTable->antAveRSSI[i]; -+ Pckcnt_pathA = pDM_FatTable ->antRSSIcnt[i]; -+ TargetAnt_pathA = i ; -+ } -+ else if(pDM_FatTable->antAveRSSI[i] == MaxRSSI_pathA) -+ { -+ if( (pDM_FatTable->antRSSIcnt[i] ) > Pckcnt_pathA) -+ { -+ MaxRSSI_pathA = pDM_FatTable->antAveRSSI[i]; -+ Pckcnt_pathA = pDM_FatTable ->antRSSIcnt[i]; -+ TargetAnt_pathA = i ; -+ } -+ } -+ -+ ODM_RT_TRACE("*** Ant-Index : [ %d ], Counter = (( %d )), Avg RSSI = (( %d )) \n", i, pDM_FatTable->antRSSIcnt[i], pDM_FatTable->antAveRSSI[i] ); -+ } -+ -+ -+ /* -+ #if(RTL8192E_SUPPORT == 1) -+ //3 [path-B]--------------------------- -+ for (i=0; i<(pDM_Odm->fat_comb_b); i++) -+ { -+ if(pDM_FatTable->antRSSIcnt_pathB[i] == 0) -+ pDM_FatTable->antAveRSSI_pathB[i] = 0; -+ else // (antRSSIcnt[i] != 0) -+ { -+ pDM_FatTable->antAveRSSI_pathB[i] = pDM_FatTable->antSumRSSI_pathB[i] /pDM_FatTable->antRSSIcnt_pathB[i]; -+ bPktFilterMacth_pathB = TRUE; -+ } -+ if(pDM_FatTable->antAveRSSI_pathB[i] > MaxRSSI_pathB) -+ { -+ MaxRSSI_pathB = pDM_FatTable->antAveRSSI_pathB[i]; -+ Pckcnt_pathB = pDM_FatTable ->antRSSIcnt_pathB[i]; -+ TargetAnt_pathB = (u1Byte) i; -+ } -+ if(pDM_FatTable->antAveRSSI_pathB[i] == MaxRSSI_pathB) -+ { -+ if(pDM_FatTable ->antRSSIcnt_pathB > Pckcnt_pathB) -+ { -+ MaxRSSI_pathB = pDM_FatTable->antAveRSSI_pathB[i]; -+ TargetAnt_pathB = (u1Byte) i; -+ } -+ } -+ if (pDM_Odm->fat_print_rssi==1) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{Path-B}: Sum RSSI[%d] = (( %d )), cnt RSSI [%d] = (( %d )), Avg RSSI[%d] = (( %d )) \n", -+ i, pDM_FatTable->antSumRSSI_pathB[i], i, pDM_FatTable->antRSSIcnt_pathB[i], i, pDM_FatTable->antAveRSSI_pathB[i])); -+ } -+ } -+ #endif -+ */ -+ -+ //1 DECISION STATE -+ -+ //2 Select TRX Antenna -+ -+ phydm_FastTraining_enable(pDM_Odm, FAT_OFF); -+ -+ //3 [path-A]--------------------------- -+ if(bPktFilterMacth_pathA == FALSE) -+ { -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("{Path-A}: None Packet is matched\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("{Path-A}: None Packet is matched\n")); -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ } -+ else -+ { -+ ODM_RT_TRACE("TargetAnt_pathA = (( %d )) , MaxRSSI_pathA = (( %d )) \n",TargetAnt_pathA,MaxRSSI_pathA); -+ -+ //3 [ update RX-optional ant ] Default RX is Omni, Optional RX is the best decision by FAT -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, TargetAnt_pathA); -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT8|BIT7|BIT6, TargetAnt_pathA);//Optional RX [pth-A] -+ } -+ //3 [ update TX ant ] -+ odm_UpdateTxAnt(pDM_Odm, TargetAnt_pathA, (pDM_FatTable->TrainIdx)); -+ -+ if(TargetAnt_pathA == 0) -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ } -+ /* -+ #if(RTL8192E_SUPPORT == 1) -+ //3 [path-B]--------------------------- -+ if(bPktFilterMacth_pathB == FALSE) -+ { -+ if (pDM_Odm->fat_print_rssi==1) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***[%d]{Path-B}: None Packet is matched\n\n\n",__LINE__)); -+ } -+ } -+ else -+ { -+ if (pDM_Odm->fat_print_rssi==1) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ (" ***TargetAnt_pathB = (( %d )) *** MaxRSSI = (( %d ))***\n\n\n",TargetAnt_pathB,MaxRSSI_pathB)); -+ } -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT21|BIT20|BIT19, TargetAnt_pathB); //Default RX is Omni, Optional RX is the best decision by FAT -+ ODM_SetBBReg(pDM_Odm, 0x80c , BIT21, 1); //Reg80c[21]=1'b1 //from TX Info -+ -+ pDM_FatTable->antsel_pathB[pDM_FatTable->TrainIdx] = TargetAnt_pathB; -+ } -+ #endif -+ */ -+ -+ //2 Reset Counter -+ for(i=0; i<(pDM_Odm->fat_comb_a); i++) -+ { -+ pDM_FatTable->antSumRSSI[i] = 0; -+ pDM_FatTable->antRSSIcnt[i] = 0; -+ } -+ /* -+ #if(RTL8192E_SUPPORT == 1) -+ for(i=0; i<=(pDM_Odm->fat_comb_b); i++) -+ { -+ pDM_FatTable->antSumRSSI_pathB[i] = 0; -+ pDM_FatTable->antRSSIcnt_pathB[i] = 0; -+ } -+ #endif -+ */ -+ -+ pDM_FatTable->FAT_State = FAT_PREPARE_STATE; -+ return; -+ } -+ -+ //1 NORMAL STATE -+ if (pDM_FatTable->FAT_State == FAT_PREPARE_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Start Prepare State ]\n")); -+ -+ odm_SetNextMACAddrTarget(pDM_Odm); -+ -+ //2 Prepare Training -+ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; -+ phydm_FastTraining_enable(pDM_Odm , FAT_ON); -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); //enable HW AntDiv -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Start Training State]\n")); -+ -+ ODM_SetTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer, pDM_Odm->antdiv_intvl ); //ms -+ } -+ -+} -+ -+VOID -+odm_FastAntTrainingCallback( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PADAPTER padapter = pDM_Odm->Adapter; -+ if(padapter->net_closed == _TRUE) -+ return; -+ //if(*pDM_Odm->pbNet_closed == TRUE) -+ // return; -+#endif -+ -+#if USE_WORKITEM -+ ODM_ScheduleWorkItem(&pDM_Odm->FastAntTrainingWorkitem); -+#else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_FastAntTrainingCallback****** \n")); -+ odm_FastAntTraining(pDM_Odm); -+#endif -+} -+ -+VOID -+odm_FastAntTrainingWorkItemCallback( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_FastAntTrainingWorkItemCallback****** \n")); -+ odm_FastAntTraining(pDM_Odm); -+} -+ -+#endif -+ -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ -+u4Byte -+phydm_construct_hl_beam_codeword( -+ IN PVOID pDM_VOID, -+ IN u4Byte *beam_pattern_idx, -+ IN u4Byte ant_num -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte codeword = 0; -+ u4Byte data_tmp; -+ u1Byte i; -+ -+ if (ant_num < 8) { -+ for (i = 0; i < ant_num; i++) { -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("beam_pattern_num[%x] = %x\n",i,beam_pattern_num[i] ));*/ -+ if (beam_pattern_idx[i] == 0) { -+ data_tmp = 0x0; -+ /**/ -+ } else if (beam_pattern_idx[i] == 1) { -+ data_tmp = 0x1; -+ /**/ -+ } else if (beam_pattern_idx[i] == 2) { -+ data_tmp = 0x8; -+ /**/ -+ } else if (beam_pattern_idx[i] == 3) { -+ data_tmp = 0x9; -+ /**/ -+ } -+ codeword |= (data_tmp<<(i*4)); -+ } -+ } -+ -+ return codeword; -+} -+ -+VOID -+phydm_update_beam_pattern( -+ IN PVOID pDM_VOID, -+ IN u4Byte codeword, -+ IN u4Byte codeword_length -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ u1Byte i; -+ BOOLEAN beam_ctrl_signal; -+ u4Byte one = 0x1; -+ u4Byte reg44_tmp_p, reg44_tmp_n, reg44_ori; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Set Beam Pattern =0x%x\n", codeword)); -+ -+ reg44_ori = ODM_GetMACReg(pDM_Odm, 0x44, bMaskDWord); -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("reg44_ori =0x%x\n", reg44_ori));*/ -+ -+ for (i = 0; i <= (codeword_length-1); i++) { -+ beam_ctrl_signal = (BOOLEAN)((codeword&BIT(i)) >> i); -+ -+ if (pDM_Odm->DebugComponents & ODM_COMP_ANT_DIV) { -+ -+ if (i == (codeword_length-1)) { -+ DbgPrint("%d ]\n", beam_ctrl_signal); -+ /**/ -+ } else if (i == 0) { -+ DbgPrint("Send codeword[1:24] ---> [ %d ", beam_ctrl_signal); -+ /**/ -+ } else if ((i % 4) == 3) { -+ DbgPrint("%d | ", beam_ctrl_signal); -+ /**/ -+ } else { -+ DbgPrint("%d ", beam_ctrl_signal); -+ /**/ -+ } -+ } -+ -+ #if 1 -+ reg44_tmp_p = reg44_ori & (~(BIT11|BIT10)); /*clean bit 10 & 11*/ -+ reg44_tmp_p |= ((1<<11) | (beam_ctrl_signal<<10)); -+ reg44_tmp_n = reg44_tmp_p & (~BIT11); -+ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n));*/ -+ ODM_SetMACReg(pDM_Odm, 0x44 , bMaskDWord, reg44_tmp_p); -+ ODM_SetMACReg(pDM_Odm, 0x44 , bMaskDWord, reg44_tmp_n); -+ #else -+ ODM_SetMACReg(pDM_Odm, 0x44 , BIT11|BIT10, ((1<<1) | beam_ctrl_signal)); -+ ODM_SetMACReg(pDM_Odm, 0x44 , BIT11, 0); -+ #endif -+ -+ } -+} -+ -+VOID -+phydm_update_rx_idle_beam( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ u4Byte i; -+ -+ pdm_sat_table->update_beam_codeword = phydm_construct_hl_beam_codeword(pDM_Odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set target beam_pattern codeword = (( 0x%x ))\n", pdm_sat_table->update_beam_codeword)); -+ -+ if (pdm_sat_table->pre_codeword != pdm_sat_table->update_beam_codeword) { -+ for (i = 0; i < (pdm_sat_table->ant_num); i++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Beam ] RxIdleBeam[%d] =%d\n", i, pdm_sat_table->rx_idle_beam[i])); -+ /**/ -+ } -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); -+ #else -+ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_workitem); -+ /*ODM_StallExecution(1);*/ -+ #endif -+ -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Stay in Ori-Beam ]\n")); -+ /**/ -+ } -+ pdm_sat_table->pre_codeword = pdm_sat_table->update_beam_codeword; -+} -+ -+VOID -+phydm_hl_smart_ant_cmd( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ u4Byte one = 0x1; -+ u4Byte codeword_length = pdm_sat_table->data_codeword_bit_num; -+ u4Byte beam_ctrl_signal, i; -+ -+ if (dm_value[0] == 1) { /*fix beam pattern*/ -+ -+ pdm_sat_table->fix_beam_pattern_en = dm_value[1]; -+ -+ if (pdm_sat_table->fix_beam_pattern_en == 1) { -+ -+ pdm_sat_table->fix_beam_pattern_codeword = dm_value[2]; -+ -+ if (pdm_sat_table->fix_beam_pattern_codeword > (one<fix_beam_pattern_codeword, codeword_length)); -+ (pdm_sat_table->fix_beam_pattern_codeword) &= 0xffffff; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Auto modify to (0x%x)\n", pdm_sat_table->fix_beam_pattern_codeword)); -+ } -+ -+ pdm_sat_table->update_beam_codeword = pdm_sat_table->fix_beam_pattern_codeword; -+ -+ /*---------------------------------------------------------*/ -+ PHYDM_SNPRINTF((output+used, out_len-used, "Fix Beam Pattern\n")); -+ for (i = 0; i <= (codeword_length-1); i++) { -+ beam_ctrl_signal = (BOOLEAN)((pdm_sat_table->update_beam_codeword&BIT(i)) >> i); -+ -+ if (i == (codeword_length-1)) { -+ PHYDM_SNPRINTF((output+used, out_len-used, "%d]\n", beam_ctrl_signal)); -+ /**/ -+ } else if (i == 0) { -+ PHYDM_SNPRINTF((output+used, out_len-used, "Send Codeword[1:24] to RFU -> [%d", beam_ctrl_signal)); -+ /**/ -+ } else if ((i % 4) == 3) { -+ PHYDM_SNPRINTF((output+used, out_len-used, "%d|", beam_ctrl_signal)); -+ /**/ -+ } else { -+ PHYDM_SNPRINTF((output+used, out_len-used, "%d", beam_ctrl_signal)); -+ /**/ -+ } -+ } -+ /*---------------------------------------------------------*/ -+ -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); -+ #else -+ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_workitem); -+ /*ODM_StallExecution(1);*/ -+ #endif -+ } else if (pdm_sat_table->fix_beam_pattern_en == 0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Smart Antenna: Enable\n")); -+ } -+ -+ } else if (dm_value[0] == 2) { /*set latch time*/ -+ -+ pdm_sat_table->latch_time = dm_value[1]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] latch_time =0x%x\n", pdm_sat_table->latch_time)); -+ } else if (dm_value[0] == 3) { -+ -+ pdm_sat_table->fix_training_num_en = dm_value[1]; -+ -+ if (pdm_sat_table->fix_training_num_en == 1) { -+ pdm_sat_table->per_beam_training_pkt_num = dm_value[2]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Fix per_beam_training_pkt_num = (( 0x%x ))\n", pdm_sat_table->per_beam_training_pkt_num)); -+ } else if (pdm_sat_table->fix_training_num_en == 0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] AUTO per_beam_training_pkt_num\n")); -+ /**/ -+ } -+ } -+ -+} -+ -+ -+void -+phydm_set_all_ant_same_beam_num( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ -+ if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) { /*2Ant for 8821A*/ -+ -+ pdm_sat_table->rx_idle_beam[0] = pdm_sat_table->fast_training_beam_num; -+ pdm_sat_table->rx_idle_beam[1] = pdm_sat_table->fast_training_beam_num; -+ } -+ -+ pdm_sat_table->update_beam_codeword = phydm_construct_hl_beam_codeword(pDM_Odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Set all ant beam_pattern: codeword = (( 0x%x ))\n", pdm_sat_table->update_beam_codeword)); -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); -+ #else -+ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_workitem); -+ /*ODM_StallExecution(1);*/ -+ #endif -+} -+ -+#if 0 -+void -+phydm_hl_smart_antenna_test( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ pFAT_T pDM_FatTable = &(pDM_Odm->DM_FatTable); -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ -+ pdm_sat_table->rx_idle_beam[0] = 0; -+ pdm_sat_table->rx_idle_beam[1] = 0; -+ codeword = phydm_construct_hl_beam_codeword(pDM_Odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("1-beam_pattern = %x\n", codeword)); -+ phydm_update_beam_pattern(pDM_Odm, codeword, pdm_sat_table->data_codeword_bit_num); -+ -+ pdm_sat_table->rx_idle_beam[0] = 1; -+ pdm_sat_table->rx_idle_beam[1] = 1; -+ codeword = phydm_construct_hl_beam_codeword(pDM_Odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("2-beam_pattern = %x\n", codeword)); -+ phydm_update_beam_pattern(pDM_Odm, codeword, pdm_sat_table->data_codeword_bit_num); -+ -+ pdm_sat_table->rx_idle_beam[0] = 2; -+ pdm_sat_table->rx_idle_beam[1] = 2; -+ codeword = phydm_construct_hl_beam_codeword(pDM_Odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("3-beam_pattern = %x\n", codeword)); -+ phydm_update_beam_pattern(pDM_Odm, codeword, pdm_sat_table->data_codeword_bit_num); -+ -+ -+ pdm_sat_table->rx_idle_beam[0] = 3; -+ pdm_sat_table->rx_idle_beam[1] = 3; -+ codeword = phydm_construct_hl_beam_codeword(pDM_Odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("4-beam_pattern = %x\n", codeword)); -+ phydm_update_beam_pattern(pDM_Odm, codeword, pdm_sat_table->data_codeword_bit_num); -+} -+#endif -+ -+VOID -+odm_FastAntTraining_hl_smart_antenna_type1( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ pFAT_T pDM_FatTable = &(pDM_Odm->DM_FatTable); -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ u4Byte codeword = 0, i, j; -+ u4Byte TargetAnt; -+ u4Byte avg_rssi_tmp; -+ u4Byte target_ant_beam_max_rssi[SUPPORT_RF_PATH_NUM] = {0}; -+ u4Byte max_beam_ant_rssi = 0; -+ u4Byte target_ant_beam[SUPPORT_RF_PATH_NUM] = {0}; -+ u4Byte beam_tmp; -+ -+ -+ if (!pDM_Odm->bLinked) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); -+ -+ if (pDM_FatTable->bBecomeLinked == TRUE) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Link -> no Link\n")); -+ pDM_FatTable->FAT_State = FAT_BEFORE_LINK_STATE; -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm , REG); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("change to (( %d )) FAT_state\n", pDM_FatTable->FAT_State)); -+ -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ return; -+ -+ } else { -+ if (pDM_FatTable->bBecomeLinked == FALSE) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); -+ -+ pDM_FatTable->FAT_State = FAT_PREPARE_STATE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("change to (( %d )) FAT_state\n", pDM_FatTable->FAT_State)); -+ -+ /*pdm_sat_table->fast_training_beam_num = 0;*/ -+ /*phydm_set_all_ant_same_beam_num(pDM_Odm);*/ -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); -+ -+ pDM_SWAT_Table->lastTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast); -+ pDM_SWAT_Table->lastRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast); -+ -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ } -+ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("HL Smart Ant Training: State (( %d ))\n", pDM_FatTable->FAT_State));*/ -+ -+ /* [DECISION STATE] */ -+ /*=======================================================================================*/ -+ if (pDM_FatTable->FAT_State == FAT_DECISION_STATE) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 3. In Decision State]\n")); -+ phydm_FastTraining_enable(pDM_Odm , FAT_OFF); -+ -+ /*compute target beam in each antenna*/ -+ for (i = 0; i < (pdm_sat_table->ant_num); i++) { -+ for (j = 0; j < (pdm_sat_table->beam_patten_num_each_ant); j++) { -+ -+ if (pdm_sat_table->pkt_rssi_cnt[i][j] == 0) { -+ avg_rssi_tmp = 0; -+ /**/ -+ } else { -+ avg_rssi_tmp = (pdm_sat_table->pkt_rssi_sum[i][j]) / (pdm_sat_table->pkt_rssi_cnt[i][j]); -+ /**/ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Ant[%d], Beam[%d]: pkt_num=(( %d )), avg_rssi=(( %d ))\n", i, j, pdm_sat_table->pkt_rssi_cnt[i][j], avg_rssi_tmp)); -+ -+ if (avg_rssi_tmp > target_ant_beam_max_rssi[i]) { -+ target_ant_beam[i] = j; -+ target_ant_beam_max_rssi[i] = avg_rssi_tmp; -+ } -+ -+ /*reset counter value*/ -+ pdm_sat_table->pkt_rssi_sum[i][j] = 0; -+ pdm_sat_table->pkt_rssi_cnt[i][j] = 0; -+ -+ } -+ pdm_sat_table->rx_idle_beam[i] = target_ant_beam[i]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("---------> Target of Ant[%d]: Beam_num-(( %d )) RSSI= ((%d))\n", -+ i, target_ant_beam[i], target_ant_beam_max_rssi[i])); -+ -+ if (target_ant_beam_max_rssi[i] > max_beam_ant_rssi) { -+ TargetAnt = i; -+ max_beam_ant_rssi = target_ant_beam_max_rssi[i]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Target of Ant = (( %d )) max_beam_ant_rssi = (( %d ))\n", -+ TargetAnt, max_beam_ant_rssi)); -+ } -+ } -+ -+ if (TargetAnt == 0) -+ TargetAnt = MAIN_ANT; -+ else if (TargetAnt == 1) -+ TargetAnt = AUX_ANT; -+ -+ /* [ update RX ant ]*/ -+ ODM_UpdateRxIdleAnt(pDM_Odm, (u1Byte)TargetAnt); -+ -+ /* [ update TX ant ]*/ -+ odm_UpdateTxAnt(pDM_Odm, (u1Byte)TargetAnt, (pDM_FatTable->TrainIdx)); -+ -+ /*set beam in each antenna*/ -+ phydm_update_rx_idle_beam(pDM_Odm); -+ -+ phydm_FastTraining_enable(pDM_Odm , FAT_OFF); -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ pDM_FatTable->FAT_State = FAT_PREPARE_STATE; -+ -+ } -+ /* [TRAINING STATE] */ -+ else if (pDM_FatTable->FAT_State == FAT_TRAINING_STATE) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2. In Training State]\n")); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("fat_beam_n = (( %d )), pre_fat_beam_n = (( %d ))\n", -+ pdm_sat_table->fast_training_beam_num, pdm_sat_table->pre_fast_training_beam_num)); -+ -+ if (pdm_sat_table->fast_training_beam_num > pdm_sat_table->pre_fast_training_beam_num) { -+ -+ pdm_sat_table->force_update_beam_en = 0; -+ -+ } else { -+ -+ pdm_sat_table->force_update_beam_en = 1; -+ -+ pdm_sat_table->pkt_counter = 0; -+ beam_tmp = pdm_sat_table->fast_training_beam_num; -+ if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant-1)) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Timeout Update] Beam_num (( %d )) -> (( decision ))\n", pdm_sat_table->fast_training_beam_num)); -+ phydm_FastTraining_enable(pDM_Odm , FAT_OFF); -+ pDM_FatTable->FAT_State = FAT_DECISION_STATE; -+ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); -+ -+ } else { -+ pdm_sat_table->fast_training_beam_num++; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Timeout Update] Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); -+ phydm_set_all_ant_same_beam_num(pDM_Odm); -+ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; -+ -+ } -+ } -+ pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Update Pre_Beam =(( %d ))\n", pdm_sat_table->pre_fast_training_beam_num)); -+ } -+ /* [Prepare State] */ -+ /*=======================================================================================*/ -+ else if (pDM_FatTable->FAT_State == FAT_PREPARE_STATE) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n\n[ 1. In Prepare State]\n")); -+ -+ /* Set training packet number*/ -+ if (pdm_sat_table->fix_training_num_en == 0) { -+ -+ switch (phydm_traffic_load_decision(pDM_Odm)) { -+ -+ case TRAFFIC_HIGH: -+ pdm_sat_table->per_beam_training_pkt_num = 20; -+ break; -+ case TRAFFIC_LOW: -+ pdm_sat_table->per_beam_training_pkt_num = 10; -+ break; -+ case TRAFFIC_ULTRA_LOW: -+ pdm_sat_table->per_beam_training_pkt_num = 2; -+ break; -+ default: -+ break; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fix_training_num = (( %d )), per_beam_training_pkt_num = (( %d ))\n", -+ pdm_sat_table->fix_training_num_en , pdm_sat_table->per_beam_training_pkt_num)); -+ -+ /* Set training MAC Addr. of target */ -+ odm_SetNextMACAddrTarget(pDM_Odm); -+ -+ phydm_FastTraining_enable(pDM_Odm , FAT_ON); -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ pdm_sat_table->pkt_counter = 0; -+ pdm_sat_table->fast_training_beam_num = 0; -+ phydm_set_all_ant_same_beam_num(pDM_Odm); -+ pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; -+ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; -+ } -+ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+VOID -+phydm_beam_switch_workitem_callback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER pAdapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ -+ #if DEV_BUS_TYPE != RT_PCI_INTERFACE -+ pdm_sat_table->pkt_skip_statistic_en = 1; -+ #endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Beam Switch Workitem Callback, pkt_skip_statistic_en = (( %d ))\n", pdm_sat_table->pkt_skip_statistic_en)); -+ -+ phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); -+ -+ #if DEV_BUS_TYPE != RT_PCI_INTERFACE -+ ODM_StallExecution(pdm_sat_table->latch_time); -+ pdm_sat_table->pkt_skip_statistic_en = 0; -+ #endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pkt_skip_statistic_en = (( %d )), latch_time = (( %d ))\n", pdm_sat_table->pkt_skip_statistic_en, pdm_sat_table->latch_time)); -+} -+ -+VOID -+phydm_beam_decision_workitem_callback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER pAdapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Beam decision Workitem Callback\n")); -+ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); -+} -+#endif -+ -+#endif /*#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1*/ -+ -+VOID -+ODM_AntDivInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] Not Support Antenna Diversity Function\n")); -+ return; -+ } -+ //--- -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_2G) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[2G AntDiv Init]: Only Support 2G Antenna Diversity Function\n")); -+ if(!(pDM_Odm->SupportICType & ODM_ANTDIV_2G_SUPPORT_IC)) -+ return; -+ } -+ else if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_5G) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[5G AntDiv Init]: Only Support 5G Antenna Diversity Function\n")); -+ if(!(pDM_Odm->SupportICType & ODM_ANTDIV_5G_SUPPORT_IC)) -+ return; -+ } -+ else if(pDM_FatTable->AntDiv_2G_5G == (ODM_ANTDIV_2G|ODM_ANTDIV_5G)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[2G & 5G AntDiv Init]:Support Both 2G & 5G Antenna Diversity Function\n")); -+ } -+ -+#endif -+ //--- -+ -+ //2 [--General---] -+ pDM_Odm->antdiv_period=0; -+ -+ pDM_FatTable->bBecomeLinked =FALSE; -+ pDM_FatTable->AntDiv_OnOff =0xff; -+ -+ //3 - AP - -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ #ifdef BEAMFORMING_SUPPORT -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ odm_BDC_Init(pDM_Odm); -+ #endif -+ #endif -+ -+ //3 - WIN - -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pDM_SWAT_Table->Ant5G = MAIN_ANT; -+ pDM_SWAT_Table->Ant2G = MAIN_ANT; -+ pDM_FatTable->CCK_counter_main=0; -+ pDM_FatTable->CCK_counter_aux=0; -+ pDM_FatTable->OFDM_counter_main=0; -+ pDM_FatTable->OFDM_counter_aux=0; -+ #endif -+ -+ //2 [---Set MAIN_ANT as default antenna if Auto-Ant enable---] -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ -+ pDM_Odm->AntType = ODM_AUTO_ANT; -+ -+ pDM_FatTable->RxIdleAnt = ANTDIV_INIT; -+ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); -+ -+ //2 [---Set TX Antenna---] -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm , REG); -+ -+ -+ //2 [--88E---] -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ #if (RTL8188E_SUPPORT == 1) -+ //pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ //pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; -+ -+ if( (pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_SMART_ANTDIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 88E Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ -+ if(pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) -+ odm_RX_HWAntDiv_Init_88E(pDM_Odm); -+ else if(pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) -+ odm_TRX_HWAntDiv_Init_88E(pDM_Odm); -+ #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ else if(pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) -+ odm_Smart_HWAntDiv_Init_88E(pDM_Odm); -+ #endif -+ #endif -+ } -+ -+ //2 [--92E---] -+ #if (RTL8192E_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ //pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ //pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; -+ -+ if( (pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_SMART_ANTDIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8192E Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ -+ if(pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) -+ odm_RX_HWAntDiv_Init_92E(pDM_Odm); -+ else if(pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) -+ odm_TRX_HWAntDiv_Init_92E(pDM_Odm); -+ #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ else if(pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) -+ odm_Smart_HWAntDiv_Init_92E(pDM_Odm); -+ #endif -+ -+ } -+ #endif -+ -+ //2 [--8723B---] -+ #if (RTL8723B_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ //pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ -+ if(pDM_Odm->AntDivType != S0S1_SW_ANTDIV && pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8723B Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ -+ if( pDM_Odm->AntDivType==S0S1_SW_ANTDIV) -+ odm_S0S1_SWAntDiv_Init_8723B(pDM_Odm); -+ else if(pDM_Odm->AntDivType==CG_TRX_HW_ANTDIV) -+ odm_TRX_HWAntDiv_Init_8723B(pDM_Odm); -+ } -+ #endif -+ -+ //2 [--8811A 8821A---] -+ #if (RTL8821A_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ pDM_Odm->AntDivType = HL_SW_SMART_ANT_TYPE1; -+ -+ if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) { -+ -+ odm_TRX_HWAntDiv_Init_8821A(pDM_Odm); -+ phydm_hl_smart_ant_type1_init_8821a(pDM_Odm); -+ } else -+ #endif -+ { -+ /*pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV;*/ -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ -+ if (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV && pDM_Odm->AntDivType != S0S1_SW_ANTDIV) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8821A & 8811A Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) -+ odm_TRX_HWAntDiv_Init_8821A(pDM_Odm); -+ else if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) -+ odm_S0S1_SWAntDiv_Init_8821A(pDM_Odm); -+ } -+ } -+ #endif -+ -+ //2 [--8881A---] -+ #if (RTL8881A_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8881A) -+ { -+ //pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ -+ if(pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV && pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8881A Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ if(pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) -+ odm_RX_HWAntDiv_Init_8881A(pDM_Odm); -+ else if(pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) -+ odm_TRX_HWAntDiv_Init_8881A(pDM_Odm); -+ } -+ #endif -+ -+ //2 [--8812---] -+ #if (RTL8812A_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ -+ if( pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8812A Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ odm_TRX_HWAntDiv_Init_8812A(pDM_Odm); -+ } -+ #endif -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("*** SupportICType=[%lu] \n",pDM_Odm->SupportICType)); -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("*** AntDiv SupportAbility=[%lu] \n",(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)>>6)); -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("*** AntDiv Type=[%d] \n",pDM_Odm->AntDivType)); -+ -+} -+ -+VOID -+ODM_AntDiv( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ #endif -+ -+ if(*pDM_Odm->pBandType == ODM_BAND_5G ) -+ { -+ if(pDM_FatTable->idx_AntDiv_counter_5G < pDM_Odm->antdiv_period ) -+ { -+ pDM_FatTable->idx_AntDiv_counter_5G++; -+ return; -+ } -+ else -+ pDM_FatTable->idx_AntDiv_counter_5G=0; -+ } -+ else if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) -+ { -+ if(pDM_FatTable->idx_AntDiv_counter_2G < pDM_Odm->antdiv_period ) -+ { -+ pDM_FatTable->idx_AntDiv_counter_2G++; -+ return; -+ } -+ else -+ pDM_FatTable->idx_AntDiv_counter_2G=0; -+ } -+ -+ //---------- -+ if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] Not Support Antenna Diversity Function\n")); -+ return; -+ } -+ -+ //---------- -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ if (pDM_FatTable->enable_ctrl_frame_antdiv) { -+ -+ if ((pDM_Odm->data_frame_num <= 10) && (pDM_Odm->bLinked)) -+ pDM_FatTable->use_ctrl_frame_antdiv = 1; -+ else -+ pDM_FatTable->use_ctrl_frame_antdiv = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("use_ctrl_frame_antdiv = (( %d )), data_frame_num = (( %d ))\n", pDM_FatTable->use_ctrl_frame_antdiv, pDM_Odm->data_frame_num)); -+ pDM_Odm->data_frame_num = 0; -+ } -+ -+ if(pAdapter->MgntInfo.AntennaTest) -+ return; -+ -+ { -+ #if (BEAMFORMING_SUPPORT == 1) -+ BEAMFORMING_CAP BeamformCap = (pDM_Odm->BeamformingInfo.BeamformCap); -+ -+ if( BeamformCap & BEAMFORMEE_CAP ) // BFmee On && Div On -> Div Off -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ AntDiv : OFF ] BFmee ==1 \n")); -+ if(pDM_FatTable->fix_ant_bfee == 0) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ pDM_FatTable->fix_ant_bfee = 1; -+ } -+ return; -+ } -+ else // BFmee Off && Div Off -> Div On -+ { -+ if((pDM_FatTable->fix_ant_bfee == 1) && pDM_Odm->bLinked) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ AntDiv : ON ] BFmee ==0\n")); -+ if((pDM_Odm->AntDivType!=S0S1_SW_ANTDIV) ) -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ -+ pDM_FatTable->fix_ant_bfee = 0; -+ } -+ } -+ #endif -+ } -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ //----------just for fool proof -+ -+ if(pDM_Odm->antdiv_rssi) -+ pDM_Odm->DebugComponents |= ODM_COMP_ANT_DIV; -+ else -+ pDM_Odm->DebugComponents &= ~ODM_COMP_ANT_DIV; -+ -+ if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_2G) -+ { -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 2G AntDiv Running ]\n")); -+ if(!(pDM_Odm->SupportICType & ODM_ANTDIV_2G_SUPPORT_IC)) -+ return; -+ } -+ else if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_5G) -+ { -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 5G AntDiv Running ]\n")); -+ if(!(pDM_Odm->SupportICType & ODM_ANTDIV_5G_SUPPORT_IC)) -+ return; -+ } -+ //else if(pDM_FatTable->AntDiv_2G_5G == (ODM_ANTDIV_2G|ODM_ANTDIV_5G)) -+ //{ -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 2G & 5G AntDiv Running ]\n")); -+ //} -+#endif -+ -+ //---------- -+ -+ if (pDM_Odm->antdiv_select==1) -+ pDM_Odm->AntType = ODM_FIX_MAIN_ANT; -+ else if (pDM_Odm->antdiv_select==2) -+ pDM_Odm->AntType = ODM_FIX_AUX_ANT; -+ else //if (pDM_Odm->antdiv_select==0) -+ pDM_Odm->AntType = ODM_AUTO_ANT; -+ -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("AntType= (( %d )) , pre_AntType= (( %d )) \n",pDM_Odm->AntType,pDM_Odm->pre_AntType)); -+ -+ if(pDM_Odm->AntType != ODM_AUTO_ANT) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fix Antenna at (( %s ))\n",(pDM_Odm->AntType == ODM_FIX_MAIN_ANT)?"MAIN":"AUX")); -+ -+ if(pDM_Odm->AntType != pDM_Odm->pre_AntType) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm , REG); -+ -+ if(pDM_Odm->AntType == ODM_FIX_MAIN_ANT) -+ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); -+ else if(pDM_Odm->AntType == ODM_FIX_AUX_ANT) -+ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); -+ } -+ pDM_Odm->pre_AntType=pDM_Odm->AntType; -+ return; -+ } -+ else -+ { -+ if(pDM_Odm->AntType != pDM_Odm->pre_AntType) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm , TX_BY_DESC); -+ } -+ pDM_Odm->pre_AntType=pDM_Odm->AntType; -+ } -+ -+ -+ //3 ----------------------------------------------------------------------------------------------------------- -+ //2 [--88E---] -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ #if (RTL8188E_SUPPORT == 1) -+ if(pDM_Odm->AntDivType==CG_TRX_HW_ANTDIV ||pDM_Odm->AntDivType==CGCS_RX_HW_ANTDIV) -+ odm_HW_AntDiv(pDM_Odm); -+ -+ #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ else if (pDM_Odm->AntDivType==CG_TRX_SMART_ANTDIV) -+ odm_FastAntTraining(pDM_Odm); -+ #endif -+ -+ #endif -+ -+ } -+ //2 [--92E---] -+ #if (RTL8192E_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ if(pDM_Odm->AntDivType==CGCS_RX_HW_ANTDIV || pDM_Odm->AntDivType==CG_TRX_HW_ANTDIV) -+ odm_HW_AntDiv(pDM_Odm); -+ -+ #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ else if (pDM_Odm->AntDivType==CG_TRX_SMART_ANTDIV) -+ odm_FastAntTraining(pDM_Odm); -+ #endif -+ -+ } -+ #endif -+ -+ #if (RTL8723B_SUPPORT == 1) -+ //2 [--8723B---] -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ if (pDM_Odm->AntDivType==S0S1_SW_ANTDIV) -+ odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_PEAK); -+ else if (pDM_Odm->AntDivType==CG_TRX_HW_ANTDIV) -+ odm_HW_AntDiv(pDM_Odm); -+ } -+ #endif -+ -+ //2 [--8821A---] -+ #if (RTL8821A_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) { -+ -+ if (pdm_sat_table->fix_beam_pattern_en != 0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [ SmartAnt ] Fix SmartAnt Pattern = 0x%x\n", pdm_sat_table->fix_beam_pattern_codeword)); -+ /*return;*/ -+ } else { -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] AntDivType = HL_SW_SMART_ANT_TYPE1\n"));*/ -+ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); -+ } -+ -+ } else -+ #endif -+ { -+ if (!pDM_Odm->bBtEnabled) /*BT disabled*/ -+ { -+ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { -+ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [S0S1_SW_ANTDIV] -> [CG_TRX_HW_ANTDIV]\n")); -+ /*ODM_SetBBReg(pDM_Odm, 0x8D4 , BIT24, 1); */ -+ if (pDM_FatTable->bBecomeLinked == TRUE) -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ } -+ -+ } else { /*BT enabled*/ -+ -+ if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) { -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [CG_TRX_HW_ANTDIV] -> [S0S1_SW_ANTDIV]\n")); -+ /*ODM_SetBBReg(pDM_Odm, 0x8D4 , BIT24, 0);*/ -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ } -+ } -+ -+ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) -+ odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_PEAK); -+ else if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) -+ odm_HW_AntDiv(pDM_Odm); -+ } -+ } -+ #endif -+ -+ //2 [--8881A---] -+ #if (RTL8881A_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8881A) -+ odm_HW_AntDiv(pDM_Odm); -+ #endif -+ -+ //2 [--8812A---] -+ #if (RTL8812A_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8812) -+ odm_HW_AntDiv(pDM_Odm); -+ #endif -+} -+ -+ -+VOID -+odm_AntselStatistics( -+ IN PVOID pDM_VOID, -+ IN u1Byte antsel_tr_mux, -+ IN u4Byte MacId, -+ IN u4Byte utility, -+ IN u1Byte method -+ -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ if(method==RSSI_METHOD) -+ { -+ if(antsel_tr_mux == ANT1_2G) -+ { -+ pDM_FatTable->MainAnt_Sum[MacId]+=utility; -+ pDM_FatTable->MainAnt_Cnt[MacId]++; -+ } -+ else -+ { -+ pDM_FatTable->AuxAnt_Sum[MacId]+=utility; -+ pDM_FatTable->AuxAnt_Cnt[MacId]++; -+ } -+ } -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ else if(method==EVM_METHOD) -+ { -+ if(antsel_tr_mux == ANT1_2G) -+ { -+ pDM_FatTable->MainAntEVM_Sum[MacId]+=(utility<<5); -+ pDM_FatTable->MainAntEVM_Cnt[MacId]++; -+ } -+ else -+ { -+ pDM_FatTable->AuxAntEVM_Sum[MacId]+=(utility<<5); -+ pDM_FatTable->AuxAntEVM_Cnt[MacId]++; -+ } -+ } -+ else if(method==CRC32_METHOD) -+ { -+ if(utility==0) -+ pDM_FatTable->CRC32_Fail_Cnt++; -+ else -+ pDM_FatTable->CRC32_Ok_Cnt+=utility; -+ } -+ #endif -+} -+ -+ -+VOID -+ODM_Process_RSSIForAntDiv( -+ IN OUT PVOID pDM_VOID, -+ IN PVOID p_phy_info_void, -+ IN PVOID p_pkt_info_void -+ //IN PODM_PHY_INFO_T pPhyInfo, -+ //IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_PHY_INFO_T pPhyInfo=(PODM_PHY_INFO_T)p_phy_info_void; -+ PODM_PACKET_INFO_T pPktinfo=(PODM_PACKET_INFO_T)p_pkt_info_void; -+ u1Byte isCCKrate=0,CCKMaxRate=ODM_RATE11M; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ u4Byte beam_tmp; -+ #endif -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ u4Byte RxPower_Ant0, RxPower_Ant1; -+ u4Byte RxEVM_Ant0, RxEVM_Ant1; -+ #else -+ u1Byte RxPower_Ant0, RxPower_Ant1; -+ u1Byte RxEVM_Ant0, RxEVM_Ant1; -+ #endif -+ -+ CCKMaxRate=ODM_RATE11M; -+ isCCKrate = (pPktinfo->DataRate <= CCKMaxRate)?TRUE:FALSE; -+ -+ #if ((RTL8192C_SUPPORT == 1) || (RTL8192D_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType & ODM_RTL8192C|ODM_RTL8192D) { -+ if (pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon) { -+ ODM_AntselStatistics_88C(pDM_Odm, pPktinfo->StationID, pPhyInfo->RxPWDBAll, isCCKrate); -+ /**/ -+ } -+ } -+ #endif -+ -+ if ((pDM_Odm->SupportICType & (ODM_RTL8192E|ODM_RTL8812)) && (pPktinfo->DataRate > CCKMaxRate)) -+ { -+ RxPower_Ant0 = pPhyInfo->RxMIMOSignalStrength[0]; -+ RxPower_Ant1= pPhyInfo->RxMIMOSignalStrength[1]; -+ -+ RxEVM_Ant0 =pPhyInfo->RxMIMOSignalQuality[0]; -+ RxEVM_Ant1 =pPhyInfo->RxMIMOSignalQuality[1]; -+ } -+ else -+ RxPower_Ant0=pPhyInfo->RxPWDBAll; -+ -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) -+ { -+ if ((pDM_Odm->SupportICType & ODM_HL_SMART_ANT_TYPE1_SUPPORT) && -+ (pPktinfo->bPacketToSelf) && -+ (pDM_FatTable->FAT_State == FAT_TRAINING_STATE) -+ ) { -+ -+ if (pdm_sat_table->pkt_skip_statistic_en == 0) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("StaID[%d]: antsel_pathA = ((%d)), hw_antsw_occur = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", -+ pPktinfo->StationID, pDM_FatTable->antsel_rx_keep_0, pDM_FatTable->hw_antsw_occur, pdm_sat_table->fast_training_beam_num, RxPower_Ant0)); -+ -+ pdm_sat_table->pkt_rssi_sum[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num] += RxPower_Ant0; -+ pdm_sat_table->pkt_rssi_cnt[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num]++; -+ pdm_sat_table->pkt_counter++; -+ -+ /*swich beam every N pkt*/ -+ if ((pdm_sat_table->pkt_counter) >= (pdm_sat_table->per_beam_training_pkt_num)) { -+ -+ pdm_sat_table->pkt_counter = 0; -+ beam_tmp = pdm_sat_table->fast_training_beam_num; -+ -+ if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant-1)) { -+ -+ pDM_FatTable->FAT_State = FAT_DECISION_STATE; -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); -+ #else -+ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_decision_workitem); -+ #endif -+ -+ -+ } else { -+ pdm_sat_table->fast_training_beam_num++; -+ phydm_set_all_ant_same_beam_num(pDM_Odm); -+ -+ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Update Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); -+ } -+ } -+ } -+ } -+ } else -+ #endif -+ if (pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) { -+ if( (pDM_Odm->SupportICType & ODM_SMART_ANT_SUPPORT) && (pPktinfo->bPacketToSelf) && (pDM_FatTable->FAT_State == FAT_TRAINING_STATE) )//(pPktinfo->bPacketMatchBSSID && (!pPktinfo->bPacketBeacon)) -+ { -+ u1Byte antsel_tr_mux; -+ antsel_tr_mux = (pDM_FatTable->antsel_rx_keep_2<<2) |(pDM_FatTable->antsel_rx_keep_1 <<1) |pDM_FatTable->antsel_rx_keep_0; -+ pDM_FatTable->antSumRSSI[antsel_tr_mux] += RxPower_Ant0; -+ pDM_FatTable->antRSSIcnt[antsel_tr_mux]++; -+ } -+ } -+ else //AntDivType != CG_TRX_SMART_ANTDIV -+ { -+ if ((pDM_Odm->SupportICType & ODM_ANTDIV_SUPPORT) && (pPktinfo->bPacketToSelf || pDM_FatTable->use_ctrl_frame_antdiv)) -+ { -+ if(pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID,RxPower_Ant0,RSSI_METHOD); -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ if(!isCCKrate) -+ { -+ odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID,RxEVM_Ant0,EVM_METHOD); -+ } -+ #endif -+ } -+ else// SupportICType == ODM_RTL8821 and ODM_RTL8723B and ODM_RTL8812) -+ { -+ if(isCCKrate && (pDM_Odm->AntDivType == S0S1_SW_ANTDIV)) -+ { -+ pDM_FatTable->antsel_rx_keep_0 = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? ANT1_2G : ANT2_2G; -+ -+ -+ if(pDM_FatTable->antsel_rx_keep_0==ANT1_2G) -+ pDM_FatTable->CCK_counter_main++; -+ else// if(pDM_FatTable->antsel_rx_keep_0==ANT2_2G) -+ pDM_FatTable->CCK_counter_aux++; -+ -+ odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxPower_Ant0,RSSI_METHOD); -+ } -+ else -+ { -+ if(pDM_FatTable->antsel_rx_keep_0==ANT1_2G) -+ pDM_FatTable->OFDM_counter_main++; -+ else// if(pDM_FatTable->antsel_rx_keep_0==ANT2_2G) -+ pDM_FatTable->OFDM_counter_aux++; -+ odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxPower_Ant0,RSSI_METHOD); -+ } -+ } -+ } -+ } -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("isCCKrate=%d, PWDB_ALL=%d\n",isCCKrate, pPhyInfo->RxPWDBAll)); -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("antsel_tr_mux=3'b%d%d%d\n",pDM_FatTable->antsel_rx_keep_2, pDM_FatTable->antsel_rx_keep_1, pDM_FatTable->antsel_rx_keep_0)); -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+VOID -+ODM_SetTxAntByTxInfo( -+ IN PVOID pDM_VOID, -+ IN pu1Byte pDesc, -+ IN u1Byte macId -+ -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ return; -+ -+ if (pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) -+ return; -+ -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) { -+#if (RTL8723B_SUPPORT == 1) -+ SET_TX_DESC_ANTSEL_A_8723B(pDesc, pDM_FatTable->antsel_a[macId]); -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8723B] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", -+ macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ -+#endif -+ } else if (pDM_Odm->SupportICType == ODM_RTL8821) { -+#if (RTL8821A_SUPPORT == 1) -+ SET_TX_DESC_ANTSEL_A_8812(pDesc, pDM_FatTable->antsel_a[macId]); -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8821A] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", -+ macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ -+#endif -+ } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+#if (RTL8188E_SUPPORT == 1) -+ SET_TX_DESC_ANTSEL_A_88E(pDesc, pDM_FatTable->antsel_a[macId]); -+ SET_TX_DESC_ANTSEL_B_88E(pDesc, pDM_FatTable->antsel_b[macId]); -+ SET_TX_DESC_ANTSEL_C_88E(pDesc, pDM_FatTable->antsel_c[macId]); -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8188E] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", -+ macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ -+#endif -+ } -+} -+#elif(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+VOID -+ODM_SetTxAntByTxInfo( -+ struct rtl8192cd_priv *priv, -+ struct tx_desc *pdesc, -+ unsigned short aid -+) -+{ -+ pFAT_T pDM_FatTable = &priv->pshare->_dmODM.DM_FatTable; -+ u4Byte SupportICType = priv->pshare->_dmODM.SupportICType; -+ -+ if (SupportICType == ODM_RTL8881A) { -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8881E******\n",__FUNCTION__,__LINE__); */ -+ pdesc->Dword6 &= set_desc(~(BIT(18)|BIT(17)|BIT(16))); -+ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_a[aid]<<16); -+ } else if (SupportICType == ODM_RTL8192E) { -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8192E******\n",__FUNCTION__,__LINE__); */ -+ pdesc->Dword6 &= set_desc(~(BIT(18)|BIT(17)|BIT(16))); -+ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_a[aid]<<16); -+ } else if (SupportICType == ODM_RTL8188E) { -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8188E******\n",__FUNCTION__,__LINE__);*/ -+ pdesc->Dword2 &= set_desc(~BIT(24)); -+ pdesc->Dword2 &= set_desc(~BIT(25)); -+ pdesc->Dword7 &= set_desc(~BIT(29)); -+ -+ pdesc->Dword2 |= set_desc(pDM_FatTable->antsel_a[aid]<<24); -+ pdesc->Dword2 |= set_desc(pDM_FatTable->antsel_b[aid]<<25); -+ pdesc->Dword7 |= set_desc(pDM_FatTable->antsel_c[aid]<<29); -+ -+ -+ } else if (SupportICType == ODM_RTL8812) { -+ /*[path-A]*/ -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8881E******\n",__FUNCTION__,__LINE__);*/ -+ -+ pdesc->Dword6 &= set_desc(~BIT(16)); -+ pdesc->Dword6 &= set_desc(~BIT(17)); -+ pdesc->Dword6 &= set_desc(~BIT(18)); -+ -+ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_a[aid]<<16); -+ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_b[aid]<<17); -+ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_c[aid]<<18); -+ -+ } -+} -+#endif -+ -+ -+VOID -+ODM_AntDiv_Config( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("WIN Config Antenna Diversity\n")); -+ if(pDM_Odm->SupportICType==ODM_RTL8723B) -+ { -+ if((!pDM_Odm->DM_SWAT_Table.ANTA_ON || !pDM_Odm->DM_SWAT_Table.ANTB_ON)) -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ } -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CE Config Antenna Diversity\n")); -+ if(pDM_Odm->SupportICType & ODM_ANTDIV_SUPPORT) -+ { -+ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; -+ } -+ -+ if(pDM_Odm->SupportICType==ODM_RTL8723B) -+ { -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ } -+ -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("AP Config Antenna Diversity\n")); -+ -+ //2 [ NOT_SUPPORT_ANTDIV ] -+ #if(defined(CONFIG_NOT_SUPPORT_ANTDIV)) -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Disable AntDiv function] : Not Support 2.4G & 5G Antenna Diversity\n")); -+ -+ //2 [ 2G&5G_SUPPORT_ANTDIV ] -+ #elif(defined(CONFIG_2G5G_SUPPORT_ANTDIV)) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : 2.4G & 5G Support Antenna Diversity Simultaneously \n")); -+ pDM_FatTable->AntDiv_2G_5G = (ODM_ANTDIV_2G|ODM_ANTDIV_5G); -+ -+ if(pDM_Odm->SupportICType & ODM_ANTDIV_SUPPORT) -+ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; -+ if(*pDM_Odm->pBandType == ODM_BAND_5G ) -+ { -+ #if ( defined(CONFIG_5G_CGCS_RX_DIVERSITY) ) -+ pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); -+ panic_printk("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n"); -+ #elif( defined(CONFIG_5G_CG_TRX_DIVERSITY)||defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A)) -+ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); -+ panic_printk("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n"); -+ #elif( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_SMART_ANTDIV\n")); -+ #elif( defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = S0S1_SW_ANTDIV\n")); -+ #endif -+ } -+ else if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) -+ { -+ #if ( defined(CONFIG_2G_CGCS_RX_DIVERSITY) ) -+ pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); -+ #elif( defined(CONFIG_2G_CG_TRX_DIVERSITY) || defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A)) -+ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); -+ #elif( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_SMART_ANTDIV\n")); -+ #elif( defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = S0S1_SW_ANTDIV\n")); -+ #endif -+ } -+ -+ //2 [ 5G_SUPPORT_ANTDIV ] -+ #elif(defined(CONFIG_5G_SUPPORT_ANTDIV)) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : Only 5G Support Antenna Diversity\n")); -+ panic_printk("[ Enable AntDiv function] : Only 5G Support Antenna Diversity\n"); -+ pDM_FatTable->AntDiv_2G_5G = (ODM_ANTDIV_5G); -+ if(*pDM_Odm->pBandType == ODM_BAND_5G ) -+ { -+ if(pDM_Odm->SupportICType & ODM_ANTDIV_5G_SUPPORT_IC) -+ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; -+ #if ( defined(CONFIG_5G_CGCS_RX_DIVERSITY) ) -+ pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); -+ panic_printk("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n"); -+ #elif( defined(CONFIG_5G_CG_TRX_DIVERSITY) ) -+ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ panic_printk("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n"); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); -+ #elif( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_SMART_ANTDIV\n")); -+ #elif( defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = S0S1_SW_ANTDIV\n")); -+ #endif -+ } -+ else if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Not Support 2G AntDivType\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ } -+ -+ //2 [ 2G_SUPPORT_ANTDIV ] -+ #elif(defined(CONFIG_2G_SUPPORT_ANTDIV)) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : Only 2.4G Support Antenna Diversity\n")); -+ pDM_FatTable->AntDiv_2G_5G = (ODM_ANTDIV_2G); -+ if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) -+ { -+ if(pDM_Odm->SupportICType & ODM_ANTDIV_2G_SUPPORT_IC) -+ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; -+ #if ( defined(CONFIG_2G_CGCS_RX_DIVERSITY) ) -+ pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); -+ #elif( defined(CONFIG_2G_CG_TRX_DIVERSITY) ) -+ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); -+ #elif( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_SMART_ANTDIV\n")); -+ #elif( defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = S0S1_SW_ANTDIV\n")); -+ #endif -+ } -+ else if(*pDM_Odm->pBandType == ODM_BAND_5G ) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Not Support 5G AntDivType\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ } -+ #endif -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("SupportAbility = (( %x ))\n", pDM_Odm->SupportAbility )); -+ -+} -+ -+ -+VOID -+ODM_AntDivTimers( -+ IN PVOID pDM_VOID, -+ IN u1Byte state -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if(state==INIT_ANTDIV_TIMMER) -+ { -+ #if (RTL8723B_SUPPORT == 1)||(RTL8821A_SUPPORT == 1) -+ ODM_InitializeTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer_8723B, -+ (RT_TIMER_CALL_BACK)ODM_SW_AntDiv_Callback, NULL, "SwAntennaSwitchTimer_8723B"); -+ #elif ( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ ODM_InitializeTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer, -+ (RT_TIMER_CALL_BACK)odm_FastAntTrainingCallback, NULL, "FastAntTrainingTimer"); -+ #endif -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ ODM_InitializeTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer, -+ (RT_TIMER_CALL_BACK)odm_EVM_FastAntTrainingCallback, NULL, "EVM_FastAntTrainingTimer"); -+ #endif -+ } -+ else if(state==CANCEL_ANTDIV_TIMMER) -+ { -+ #if (RTL8723B_SUPPORT == 1)||(RTL8821A_SUPPORT == 1) -+ ODM_CancelTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer_8723B); -+ #elif ( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ ODM_CancelTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer); -+ #endif -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ ODM_CancelTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer); -+ #endif -+ } -+ else if(state==RELEASE_ANTDIV_TIMMER) -+ { -+ #if (RTL8723B_SUPPORT == 1)||(RTL8821A_SUPPORT == 1) -+ ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer_8723B); -+ #elif ( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer); -+ #endif -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer); -+ #endif -+ } -+ -+} -+ -+#endif //#if (defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ -+VOID -+ODM_AntDivReset( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ //2 [--8723B---] -+#if (RTL8723B_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ #if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ odm_S0S1_SWAntDiv_Reset_8723B(pDM_Odm); -+ #endif -+ } -+#endif -+} -+ -+VOID -+odm_AntennaDiversityInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if(pDM_Odm->mp_mode == TRUE) -+ return; -+ -+ if(pDM_Odm->SupportICType & (ODM_OLD_IC_ANTDIV_SUPPORT)) -+ { -+ #if (RTL8192C_SUPPORT==1) -+ #if (!(DM_ODM_SUPPORT_TYPE & (ODM_AP))) -+ ODM_OldIC_AntDiv_Init(pDM_Odm); -+ #endif -+ #endif -+ } -+ else -+ { -+ #if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ ODM_AntDiv_Config(pDM_Odm); -+ ODM_AntDivInit(pDM_Odm); -+ #endif -+ } -+} -+ -+VOID -+odm_AntennaDiversity( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if(pDM_Odm->mp_mode == TRUE) -+ return; -+ -+ if(pDM_Odm->SupportICType & (ODM_OLD_IC_ANTDIV_SUPPORT)) -+ { -+ #if (RTL8192C_SUPPORT==1) -+ #if (!(DM_ODM_SUPPORT_TYPE & (ODM_AP))) -+ ODM_OldIC_AntDiv(pDM_Odm); -+ #endif -+ #endif -+ } -+ else -+ { -+ #if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ ODM_AntDiv(pDM_Odm); -+ #endif -+ } -+} -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_antdiv.h linux/3rdparty/rtl8812au/hal/phydm/phydm_antdiv.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_antdiv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_antdiv.h 2017-06-07 23:07:21.017688123 +0300 -@@ -0,0 +1,607 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMANTDIV_H__ -+#define __PHYDMANTDIV_H__ -+ -+/*#define ANTDIV_VERSION "2.0" //2014.11.04*/ -+/*#define ANTDIV_VERSION "2.1" //2015.01.13 Dino*/ -+/*#define ANTDIV_VERSION "2.2" 2015.01.16 Dino*/ -+#define ANTDIV_VERSION "3.0" /*2015.06.10 Dino, add HL smart antenna*/ -+ -+//1 ============================================================ -+//1 Definition -+//1 ============================================================ -+ -+#define ANTDIV_INIT 0xff -+#define MAIN_ANT 1 //Ant A or Ant Main -+#define AUX_ANT 2 //AntB or Ant Aux -+#define MAX_ANT 3 // 3 for AP using -+ -+#define ANT1_2G 0 // = ANT2_5G -+#define ANT2_2G 1 // = ANT1_5G -+/*smart antenna*/ -+#define SUPPORT_RF_PATH_NUM 4 -+#define SUPPORT_BEAM_PATTERN_NUM 4 -+ -+ -+//Antenna Diversty Control Type -+#define ODM_AUTO_ANT 0 -+#define ODM_FIX_MAIN_ANT 1 -+#define ODM_FIX_AUX_ANT 2 -+ -+#define ODM_ANTDIV_SUPPORT (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8821|ODM_RTL8881A|ODM_RTL8812) -+#define ODM_N_ANTDIV_SUPPORT (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B) -+#define ODM_AC_ANTDIV_SUPPORT (ODM_RTL8821|ODM_RTL8881A|ODM_RTL8812) -+#define ODM_SMART_ANT_SUPPORT (ODM_RTL8188E|ODM_RTL8192E) -+#define ODM_HL_SMART_ANT_TYPE1_SUPPORT (ODM_RTL8821) -+ -+#define ODM_OLD_IC_ANTDIV_SUPPORT (ODM_RTL8723A|ODM_RTL8192C|ODM_RTL8192D) -+ -+#define ODM_ANTDIV_2G_SUPPORT_IC (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8881A) -+#define ODM_ANTDIV_5G_SUPPORT_IC (ODM_RTL8821|ODM_RTL8881A|ODM_RTL8812) -+ -+#define ODM_EVM_ENHANCE_ANTDIV_SUPPORT_IC (ODM_RTL8192E) -+ -+#define ODM_ANTDIV_2G BIT0 -+#define ODM_ANTDIV_5G BIT1 -+ -+#define ANTDIV_ON 1 -+#define ANTDIV_OFF 0 -+ -+#define FAT_ON 1 -+#define FAT_OFF 0 -+ -+#define TX_BY_DESC 1 -+#define REG 0 -+ -+#define RSSI_METHOD 0 -+#define EVM_METHOD 1 -+#define CRC32_METHOD 2 -+ -+#define INIT_ANTDIV_TIMMER 0 -+#define CANCEL_ANTDIV_TIMMER 1 -+#define RELEASE_ANTDIV_TIMMER 2 -+ -+#define CRC32_FAIL 1 -+#define CRC32_OK 0 -+ -+#define Evm_RSSI_TH_High 25 -+#define Evm_RSSI_TH_Low 20 -+ -+#define NORMAL_STATE_MIAN 1 -+#define NORMAL_STATE_AUX 2 -+#define TRAINING_STATE 3 -+ -+#define FORCE_RSSI_DIFF 10 -+ -+#define CSI_ON 1 -+#define CSI_OFF 0 -+ -+#define DIVON_CSIOFF 1 -+#define DIVOFF_CSION 2 -+ -+#define BDC_DIV_TRAIN_STATE 0 -+#define BDC_BFer_TRAIN_STATE 1 -+#define BDC_DECISION_STATE 2 -+#define BDC_BF_HOLD_STATE 3 -+#define BDC_DIV_HOLD_STATE 4 -+ -+#define BDC_MODE_1 1 -+#define BDC_MODE_2 2 -+#define BDC_MODE_3 3 -+#define BDC_MODE_4 4 -+#define BDC_MODE_NULL 0xff -+ -+#define SWAW_STEP_PEAK 0 -+#define SWAW_STEP_DETERMINE 1 -+ -+#define HL_SMTANT_2WIRE_DATA_LEN 24 -+ -+//1 ============================================================ -+//1 structure -+//1 ============================================================ -+ -+ -+typedef struct _SW_Antenna_Switch_ -+{ -+ u1Byte Double_chk_flag; -+ u1Byte try_flag; -+ s4Byte PreRSSI; -+ u1Byte CurAntenna; -+ u1Byte PreAntenna; -+ u1Byte RSSI_Trying; -+ u1Byte TestMode; -+ u1Byte bTriggerAntennaSwitch; -+ u1Byte SelectAntennaMap; -+ u1Byte RSSI_target; -+ u1Byte reset_idx; -+ u2Byte Single_Ant_Counter; -+ u2Byte Dual_Ant_Counter; -+ u2Byte Aux_FailDetec_Counter; -+ u2Byte Retry_Counter; -+ -+ // Before link Antenna Switch check -+ u1Byte SWAS_NoLink_State; -+ u4Byte SWAS_NoLink_BK_Reg860; -+ u4Byte SWAS_NoLink_BK_Reg92c; -+ u4Byte SWAS_NoLink_BK_Reg948; -+ BOOLEAN ANTA_ON; //To indicate Ant A is or not -+ BOOLEAN ANTB_ON; //To indicate Ant B is on or not -+ BOOLEAN Pre_Aux_FailDetec; -+ BOOLEAN RSSI_AntDect_bResult; -+ u1Byte Ant5G; -+ u1Byte Ant2G; -+ -+ s4Byte RSSI_sum_A; -+ s4Byte RSSI_sum_B; -+ s4Byte RSSI_cnt_A; -+ s4Byte RSSI_cnt_B; -+ -+ u8Byte lastTxOkCnt; -+ u8Byte lastRxOkCnt; -+ u8Byte TXByteCnt_A; -+ u8Byte TXByteCnt_B; -+ u8Byte RXByteCnt_A; -+ u8Byte RXByteCnt_B; -+ u1Byte TrafficLoad; -+ u1Byte Train_time; -+ u1Byte Train_time_flag; -+ RT_TIMER SwAntennaSwitchTimer; -+#if (RTL8723B_SUPPORT == 1)||(RTL8821A_SUPPORT == 1) -+ RT_TIMER SwAntennaSwitchTimer_8723B; -+ u4Byte PktCnt_SWAntDivByCtrlFrame; -+ BOOLEAN bSWAntDivByCtrlFrame; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #if USE_WORKITEM -+ RT_WORK_ITEM SwAntennaSwitchWorkitem; -+ #if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) -+ RT_WORK_ITEM SwAntennaSwitchWorkitem_8723B; -+ #endif -+ #endif -+#endif -+/* CE Platform use -+#ifdef CONFIG_SW_ANTENNA_DIVERSITY -+ _timer SwAntennaSwitchTimer; -+ u8Byte lastTxOkCnt; -+ u8Byte lastRxOkCnt; -+ u8Byte TXByteCnt_A; -+ u8Byte TXByteCnt_B; -+ u8Byte RXByteCnt_A; -+ u8Byte RXByteCnt_B; -+ u1Byte DoubleComfirm; -+ u1Byte TrafficLoad; -+ //SW Antenna Switch -+ -+ -+#endif -+*/ -+#ifdef CONFIG_HW_ANTENNA_DIVERSITY -+ //Hybrid Antenna Diversity -+ u4Byte CCK_Ant1_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte CCK_Ant2_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte OFDM_Ant1_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte OFDM_Ant2_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte RSSI_Ant1_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte RSSI_Ant2_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte TxAnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte TargetSTA; -+ u1Byte antsel; -+ u1Byte RxIdleAnt; -+ -+#endif -+ -+}SWAT_T, *pSWAT_T; -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#if (defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+typedef struct _BF_DIV_COEX_ -+{ -+ BOOLEAN w_BFer_Client[ODM_ASSOCIATE_ENTRY_NUM]; -+ BOOLEAN w_BFee_Client[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte MA_rx_TP[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte MA_rx_TP_DIV[ODM_ASSOCIATE_ENTRY_NUM]; -+ -+ u1Byte BDCcoexType_wBfer; -+ u1Byte num_Txbfee_Client; -+ u1Byte num_Txbfer_Client; -+ u1Byte BDC_Try_counter; -+ u1Byte BDC_Hold_counter; -+ u1Byte BDC_Mode; -+ u1Byte BDC_active_Mode; -+ u1Byte BDC_state; -+ u1Byte BDC_RxIdleUpdate_counter; -+ u1Byte num_Client; -+ u1Byte pre_num_Client; -+ u1Byte num_BfTar; -+ u1Byte num_DivTar; -+ -+ BOOLEAN bAll_DivSta_Idle; -+ BOOLEAN bAll_BFSta_Idle; -+ BOOLEAN BDC_Try_flag; -+ BOOLEAN BF_pass; -+ BOOLEAN DIV_pass; -+}BDC_T,*pBDC_T; -+#endif -+#endif -+ -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+typedef struct _SMART_ANTENNA_TRAINNING_ { -+ u4Byte latch_time; -+ BOOLEAN pkt_skip_statistic_en; -+ u4Byte fix_beam_pattern_en; -+ u4Byte fix_training_num_en; -+ u4Byte fix_beam_pattern_codeword; -+ u4Byte update_beam_codeword; -+ u4Byte ant_num; /*number of smart beam antenna*/ -+ u4Byte beam_patten_num_each_ant;/*number of beam can be switched in each antenna*/ -+ u4Byte data_codeword_bit_num; -+ u4Byte per_beam_training_pkt_num; -+ u4Byte pkt_counter; -+ u4Byte fast_training_beam_num; -+ u4Byte pre_fast_training_beam_num; -+ u4Byte pkt_rssi_sum[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; -+ u4Byte pkt_rssi_cnt[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; -+ u4Byte rx_idle_beam[SUPPORT_RF_PATH_NUM]; -+ u4Byte pre_codeword; -+ BOOLEAN force_update_beam_en; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_WORK_ITEM hl_smart_antenna_workitem; -+ RT_WORK_ITEM hl_smart_antenna_decision_workitem; -+ #endif -+ -+} SAT_T, *pSAT_T; -+#endif -+ -+typedef struct _FAST_ANTENNA_TRAINNING_ -+{ -+ u1Byte Bssid[6]; -+ u1Byte antsel_rx_keep_0; -+ u1Byte antsel_rx_keep_1; -+ u1Byte antsel_rx_keep_2; -+ u1Byte antsel_rx_keep_3; -+ u4Byte antSumRSSI[7]; -+ u4Byte antRSSIcnt[7]; -+ u4Byte antAveRSSI[7]; -+ u1Byte FAT_State; -+ u4Byte TrainIdx; -+ u1Byte antsel_a[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte antsel_b[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte antsel_c[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte MainAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte AuxAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte MainAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte AuxAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte RxIdleAnt; -+ u1Byte AntDiv_OnOff; -+ BOOLEAN bBecomeLinked; -+ u4Byte MinMaxRSSI; -+ u1Byte idx_AntDiv_counter_2G; -+ u1Byte idx_AntDiv_counter_5G; -+ u1Byte AntDiv_2G_5G; -+ u4Byte CCK_counter_main; -+ u4Byte CCK_counter_aux; -+ u4Byte OFDM_counter_main; -+ u4Byte OFDM_counter_aux; -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ u4Byte MainAntEVM_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte AuxAntEVM_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte MainAntEVM_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte AuxAntEVM_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ BOOLEAN EVM_method_enable; -+ u1Byte TargetAnt_EVM; -+ u1Byte TargetAnt_CRC32; -+ u1Byte TargetAnt_enhance; -+ u1Byte pre_TargetAnt_enhance; -+ u2Byte Main_MPDU_OK_cnt; -+ u2Byte Aux_MPDU_OK_cnt; -+ -+ u4Byte CRC32_Ok_Cnt; -+ u4Byte CRC32_Fail_Cnt; -+ u4Byte MainCRC32_Ok_Cnt; -+ u4Byte AuxCRC32_Ok_Cnt; -+ u4Byte MainCRC32_Fail_Cnt; -+ u4Byte AuxCRC32_Fail_Cnt; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ u4Byte CCK_CtrlFrame_Cnt_main; -+ u4Byte CCK_CtrlFrame_Cnt_aux; -+ u4Byte OFDM_CtrlFrame_Cnt_main; -+ u4Byte OFDM_CtrlFrame_Cnt_aux; -+ u4Byte MainAnt_CtrlFrame_Sum; -+ u4Byte AuxAnt_CtrlFrame_Sum; -+ u4Byte MainAnt_CtrlFrame_Cnt; -+ u4Byte AuxAnt_CtrlFrame_Cnt; -+ #endif -+ BOOLEAN fix_ant_bfee; -+ BOOLEAN enable_ctrl_frame_antdiv; -+ BOOLEAN use_ctrl_frame_antdiv; -+ u1Byte hw_antsw_occur; -+}FAT_T,*pFAT_T; -+ -+ -+//1 ============================================================ -+//1 enumeration -+//1 ============================================================ -+ -+ -+ -+typedef enum _FAT_STATE /*Fast antenna training*/ -+{ -+ FAT_BEFORE_LINK_STATE = 0, -+ FAT_PREPARE_STATE = 1, -+ FAT_TRAINING_STATE = 2, -+ FAT_DECISION_STATE = 3 -+}FAT_STATE_E, *PFAT_STATE_E; -+ -+typedef enum _ANT_DIV_TYPE -+{ -+ NO_ANTDIV = 0xFF, -+ CG_TRX_HW_ANTDIV = 0x01, -+ CGCS_RX_HW_ANTDIV = 0x02, -+ FIXED_HW_ANTDIV = 0x03, -+ CG_TRX_SMART_ANTDIV = 0x04, -+ CGCS_RX_SW_ANTDIV = 0x05, -+ S0S1_SW_ANTDIV = 0x06, /*8723B intrnal switch S0 S1*/ -+ HL_SW_SMART_ANT_TYPE1 = 0x10 /*Hong-Lin Smart antenna use for 8821AE which is a 2 Ant. entitys, and each Ant. is equipped with 4 antenna patterns*/ -+}ANT_DIV_TYPE_E, *PANT_DIV_TYPE_E; -+ -+ -+//1 ============================================================ -+//1 function prototype -+//1 ============================================================ -+ -+ -+VOID -+ODM_StopAntennaSwitchDm( -+ IN PVOID pDM_VOID -+ ); -+VOID -+ODM_SetAntConfig( -+ IN PVOID pDM_VOID, -+ IN u1Byte antSetting // 0=A, 1=B, 2=C, .... -+ ); -+ -+ -+#define SwAntDivRestAfterLink ODM_SwAntDivRestAfterLink -+VOID ODM_SwAntDivRestAfterLink( -+ IN PVOID pDM_VOID -+ ); -+ -+#if (defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ -+VOID -+ODM_UpdateRxIdleAnt( -+ IN PVOID pDM_VOID, -+ IN u1Byte Ant -+); -+ -+#if (RTL8723B_SUPPORT == 1)||(RTL8821A_SUPPORT == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+ODM_SW_AntDiv_Callback( -+ IN PRT_TIMER pTimer -+ ); -+ -+VOID -+ODM_SW_AntDiv_WorkitemCallback( -+ IN PVOID pContext -+ ); -+ -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+VOID -+ODM_SW_AntDiv_WorkitemCallback( -+ IN PVOID pContext -+); -+ -+VOID -+ODM_SW_AntDiv_Callback( -+ void *FunctionContext -+ ); -+ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+VOID -+odm_S0S1_SwAntDivByCtrlFrame( -+ IN PVOID pDM_VOID, -+ IN u1Byte Step -+); -+ -+VOID -+odm_AntselStatisticsOfCtrlFrame( -+ IN PVOID pDM_VOID, -+ IN u1Byte antsel_tr_mux, -+ IN u4Byte RxPWDBAll -+); -+ -+VOID -+odm_S0S1_SwAntDivByCtrlFrame_ProcessRSSI( -+ IN PVOID pDM_VOID, -+ IN PVOID p_phy_info_void, -+ IN PVOID p_pkt_info_void -+); -+ -+ -+#endif -+#endif -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+VOID -+odm_EVM_FastAntTrainingCallback( -+ IN PVOID pDM_VOID -+); -+#endif -+ -+VOID -+odm_HW_AntDiv( -+ IN PVOID pDM_VOID -+); -+ -+#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+VOID -+odm_FastAntTraining( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_FastAntTrainingCallback( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_FastAntTrainingWorkItemCallback( -+ IN PVOID pDM_VOID -+); -+#endif -+ -+ -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+phydm_beam_switch_workitem_callback( -+ IN PVOID pContext -+ ); -+ -+VOID -+phydm_beam_decision_workitem_callback( -+ IN PVOID pContext -+ ); -+ -+#endif -+ -+VOID -+phydm_update_beam_pattern( -+ IN PVOID pDM_VOID, -+ IN u4Byte codeword, -+ IN u4Byte codeword_length -+ ); -+ -+void -+phydm_set_all_ant_same_beam_num( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+phydm_hl_smart_ant_cmd( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+); -+ -+#endif/*#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1*/ -+ -+VOID -+ODM_AntDivInit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+ODM_AntDiv( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_AntselStatistics( -+ IN PVOID pDM_VOID, -+ IN u1Byte antsel_tr_mux, -+ IN u4Byte MacId, -+ IN u4Byte utility, -+ IN u1Byte method -+); -+ -+VOID -+ODM_Process_RSSIForAntDiv( -+ IN OUT PVOID pDM_VOID, -+ IN PVOID p_phy_info_void, -+ IN PVOID p_pkt_info_void -+); -+ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+VOID -+ODM_SetTxAntByTxInfo( -+ IN PVOID pDM_VOID, -+ IN pu1Byte pDesc, -+ IN u1Byte macId -+); -+ -+#elif(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+VOID -+ODM_SetTxAntByTxInfo( -+ struct rtl8192cd_priv *priv, -+ struct tx_desc *pdesc, -+ unsigned short aid -+); -+ -+#endif -+ -+ -+VOID -+ODM_AntDiv_Config( -+ IN PVOID pDM_VOID -+); -+ -+ -+VOID -+ODM_UpdateRxIdleAnt_8723B( -+ IN PVOID pDM_VOID, -+ IN u1Byte Ant, -+ IN u4Byte DefaultAnt, -+ IN u4Byte OptionalAnt -+); -+ -+VOID -+ODM_AntDivTimers( -+ IN PVOID pDM_VOID, -+ IN u1Byte state -+); -+ -+#endif //#if (defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ -+VOID -+ODM_AntDivReset( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_AntennaDiversityInit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_AntennaDiversity( -+ IN PVOID pDM_VOID -+); -+ -+ -+#endif //#ifndef __ODMANTDIV_H__ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_beamforming.c linux/3rdparty/rtl8812au/hal/phydm/phydm_beamforming.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_beamforming.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_beamforming.c 2017-06-07 23:07:21.017688123 +0300 -@@ -0,0 +1,1939 @@ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if WPP_SOFTWARE_TRACE -+#include "phydm_beamforming.tmh" -+#endif -+#endif -+ -+#if (BEAMFORMING_SUPPORT == 1) -+ -+PRT_BEAMFORM_STAINFO -+phydm_staInfoInit( -+ IN PDM_ODM_T pDM_Odm, -+ IN u2Byte staIdx -+ ) -+{ -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORM_STAINFO pEntry = &(pBeamInfo->BeamformSTAinfo); -+ PSTA_INFO_T pSTA = pDM_Odm->pODM_StaInfo[staIdx]; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ PRT_HIGH_THROUGHPUT pHTInfo = GET_HT_INFO(pMgntInfo); -+ PRT_VERY_HIGH_THROUGHPUT pVHTInfo = GET_VHT_INFO(pMgntInfo); -+ -+ ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, Adapter->CurrentAddress, 6); -+ -+ pEntry->HtBeamformCap = pHTInfo->HtBeamformCap; -+ pEntry->VhtBeamformCap = pVHTInfo->VhtBeamformCap; -+ -+ /*IBSS, AP mode*/ -+ if (staIdx != 0) { -+ pEntry->AID = pSTA->AID; -+ pEntry->RA = pSTA->MacAddr; -+ pEntry->MacID = pSTA->AssociatedMacId; -+ pEntry->WirelessMode = pSTA->WirelessMode; -+ pEntry->BW = pSTA->BandWidth; -+ pEntry->CurBeamform = pSTA->HTInfo.HtCurBeamform; -+ } else {/*client mode*/ -+ pEntry->AID = pMgntInfo->mAId; -+ pEntry->RA = pMgntInfo->Bssid; -+ pEntry->MacID = pMgntInfo->mMacId; -+ pEntry->WirelessMode = pMgntInfo->dot11CurrentWirelessMode; -+ pEntry->BW = pMgntInfo->dot11CurrentChannelBandWidth; -+ pEntry->CurBeamform = pHTInfo->HtCurBeamform; -+ } -+ -+ if ((pEntry->WirelessMode & WIRELESS_MODE_AC_5G) || (pEntry->WirelessMode & WIRELESS_MODE_AC_24G)) { -+ if (staIdx != 0) -+ pEntry->CurBeamformVHT = pSTA->VHTInfo.VhtCurBeamform; -+ else -+ pEntry->CurBeamformVHT = pVHTInfo->VhtCurBeamform; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("pSTA->wireless_mode = 0x%x, staidx = %d\n", pSTA->WirelessMode, staIdx)); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+ if (!IS_STA_VALID(pSTA)) { -+ rtw_warn_on(1); -+ DBG_871X("%s => sta_info(mac_id:%d) failed\n", __func__, staIdx); -+ return pEntry; -+ } -+ -+ ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, adapter_mac_addr(pSTA->padapter), 6); -+ pEntry->HtBeamformCap = pSTA->htpriv.beamform_cap; -+ -+ pEntry->AID = pSTA->aid; -+ pEntry->RA = pSTA->hwaddr; -+ pEntry->MacID = pSTA->mac_id; -+ pEntry->WirelessMode = pSTA->wireless_mode; -+ pEntry->BW = pSTA->bw_mode; -+ -+ pEntry->CurBeamform = pSTA->htpriv.beamform_cap; -+#if ODM_IC_11AC_SERIES_SUPPORT -+ if ((pEntry->WirelessMode & WIRELESS_MODE_AC_5G) || (pEntry->WirelessMode & WIRELESS_MODE_AC_24G)) { -+ pEntry->CurBeamformVHT = pSTA->vhtpriv.beamform_cap; -+ pEntry->VhtBeamformCap = pSTA->vhtpriv.beamform_cap; -+ } -+#endif -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("pSTA->wireless_mode = 0x%x, staidx = %d\n", pSTA->wireless_mode, staIdx)); -+#endif -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("pEntry->CurBeamform = 0x%x, pEntry->CurBeamformVHT = 0x%x\n", pEntry->CurBeamform, pEntry->CurBeamformVHT)); -+ return pEntry; -+ -+} -+void phydm_staInfoUpdate( -+ IN PDM_ODM_T pDM_Odm, -+ IN u2Byte staIdx, -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry -+ ) -+{ -+ PSTA_INFO_T pSTA = pDM_Odm->pODM_StaInfo[staIdx]; -+ -+ if (!IS_STA_VALID(pSTA)) -+ return; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ pSTA->txbf_paid = pBeamformEntry->P_AID; -+ pSTA->txbf_gid = pBeamformEntry->G_ID; -+#endif -+} -+ -+ -+u1Byte -+Beamforming_GetHTNDPTxRate( -+ IN PVOID pDM_VOID, -+ u1Byte CompSteeringNumofBFer -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Nr_index = 0; -+ u1Byte NDPTxRate; -+ /*Find Nr*/ -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), CompSteeringNumofBFer); -+ else -+ Nr_index = TxBF_Nr(1, CompSteeringNumofBFer); -+ -+ switch (Nr_index) { -+ case 1: -+ NDPTxRate = MGN_MCS8; -+ break; -+ -+ case 2: -+ NDPTxRate = MGN_MCS16; -+ break; -+ -+ case 3: -+ NDPTxRate = MGN_MCS24; -+ break; -+ -+ default: -+ NDPTxRate = MGN_MCS8; -+ break; -+ } -+ -+return NDPTxRate; -+ -+} -+ -+u1Byte -+Beamforming_GetVHTNDPTxRate( -+ IN PVOID pDM_VOID, -+ u1Byte CompSteeringNumofBFer -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Nr_index = 0; -+ u1Byte NDPTxRate; -+ /*Find Nr*/ -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), CompSteeringNumofBFer); -+ else -+ Nr_index = TxBF_Nr(1, CompSteeringNumofBFer); -+ -+ switch (Nr_index) { -+ case 1: -+ NDPTxRate = MGN_VHT2SS_MCS0; -+ break; -+ -+ case 2: -+ NDPTxRate = MGN_VHT3SS_MCS0; -+ break; -+ -+ case 3: -+ NDPTxRate = MGN_VHT4SS_MCS0; -+ break; -+ -+ default: -+ NDPTxRate = MGN_VHT2SS_MCS0; -+ break; -+ } -+ -+return NDPTxRate; -+ -+} -+ -+ -+PRT_BEAMFORMEE_ENTRY -+phydm_Beamforming_GetBFeeEntryByAddr( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformeeEntry[i].bUsed && (eqMacAddr(RA, pBeamInfo->BeamformeeEntry[i].MacAddr))) { -+ *Idx = i; -+ return &(pBeamInfo->BeamformeeEntry[i]); -+ } -+ } -+ -+ return NULL; -+} -+ -+PRT_BEAMFORMER_ENTRY -+phydm_Beamforming_GetBFerEntryByAddr( -+ IN PVOID pDM_VOID, -+ IN pu1Byte TA, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformerEntry[i].bUsed && (eqMacAddr(TA, pBeamInfo->BeamformerEntry[i].MacAddr))) { -+ *Idx = i; -+ return &(pBeamInfo->BeamformerEntry[i]); -+ } -+ } -+ -+ return NULL; -+} -+ -+ -+PRT_BEAMFORMEE_ENTRY -+phydm_Beamforming_GetEntryByMacId( -+ IN PVOID pDM_VOID, -+ IN u1Byte MacId, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformeeEntry[i].bUsed && (MacId == pBeamInfo->BeamformeeEntry[i].MacId)) { -+ *Idx = i; -+ return &(pBeamInfo->BeamformeeEntry[i]); -+ } -+ } -+ -+ return NULL; -+} -+ -+ -+BEAMFORMING_CAP -+phydm_Beamforming_GetEntryBeamCapByMacId( -+ IN PVOID pDM_VOID, -+ IN u1Byte MacId -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ BEAMFORMING_CAP BeamformEntryCap = BEAMFORMING_CAP_NONE; -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformeeEntry[i].bUsed && (MacId == pBeamInfo->BeamformeeEntry[i].MacId)) { -+ BeamformEntryCap = pBeamInfo->BeamformeeEntry[i].BeamformEntryCap; -+ i = BEAMFORMEE_ENTRY_NUM; -+ } -+ } -+ -+ return BeamformEntryCap; -+} -+ -+ -+PRT_BEAMFORMEE_ENTRY -+phydm_Beamforming_GetFreeBFeeEntry( -+ IN PVOID pDM_VOID, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformeeEntry[i].bUsed == FALSE) { -+ *Idx = i; -+ return &(pBeamInfo->BeamformeeEntry[i]); -+ } -+ } -+ return NULL; -+} -+ -+PRT_BEAMFORMER_ENTRY -+phydm_Beamforming_GetFreeBFerEntry( -+ IN PVOID pDM_VOID, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s ===>\n", __func__)); -+ -+ for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformerEntry[i].bUsed == FALSE) { -+ *Idx = i; -+ return &(pBeamInfo->BeamformerEntry[i]); -+ } -+ } -+ return NULL; -+} -+ -+/* -+// Description: Get the first entry index of MU Beamformee. -+// -+// Return Value: Index of the first MU sta. -+// -+// 2015.05.25. Created by tynli. -+// -+*/ -+u1Byte -+phydm_Beamforming_GetFirstMUBFeeEntryIdx( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte idx = 0xFF; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ BOOLEAN bFound = FALSE; -+ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ if (pBeamInfo->BeamformeeEntry[idx].bUsed && pBeamInfo->BeamformeeEntry[idx].is_mu_sta) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] idx=%d!\n", __func__, idx)); -+ bFound = TRUE; -+ break; -+ } -+ } -+ -+ if (!bFound) -+ idx = 0xFF; -+ -+ return idx; -+} -+ -+ -+/*Add SU BFee and MU BFee*/ -+PRT_BEAMFORMEE_ENTRY -+Beamforming_AddBFeeEntry( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORM_STAINFO pSTA, -+ IN BEAMFORMING_CAP BeamformCap, -+ IN u1Byte NumofSoundingDim, -+ IN u1Byte CompSteeringNumofBFer, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMEE_ENTRY pEntry = phydm_Beamforming_GetFreeBFeeEntry(pDM_Odm, Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (pEntry != NULL) { -+ pEntry->bUsed = TRUE; -+ pEntry->AID = pSTA->AID; -+ pEntry->MacId = pSTA->MacID; -+ pEntry->SoundBW = pSTA->BW; -+ ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, pSTA->MyMacAddr, 6); -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) { -+ /*BSSID[44:47] xor BSSID[40:43]*/ -+ u2Byte BSSID = ((pSTA->MyMacAddr[5] & 0xf0) >> 4) ^ (pSTA->MyMacAddr[5] & 0xf); -+ /*(dec(A) + dec(B)*32) mod 512*/ -+ pEntry->P_AID = (pSTA->AID + BSSID * 32) & 0x1ff; -+ pEntry->G_ID = 63; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID addressed to STA=%d\n", __func__, pEntry->P_AID)); -+ } else if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) { -+ /*ad hoc mode*/ -+ pEntry->P_AID = 0; -+ pEntry->G_ID = 63; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID as IBSS=%d\n", __func__, pEntry->P_AID)); -+ } else { -+ /*client mode*/ -+ pEntry->P_AID = pSTA->RA[5]; -+ /*BSSID[39:47]*/ -+ pEntry->P_AID = (pEntry->P_AID << 1) | (pSTA->RA[4] >> 7); -+ pEntry->G_ID = 0; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID addressed to AP=0x%X\n", __func__, pEntry->P_AID)); -+ } -+ cpMacAddr(pEntry->MacAddr, pSTA->RA); -+ pEntry->bTxBF = FALSE; -+ pEntry->bSound = FALSE; -+ pEntry->SoundPeriod = 400; -+ pEntry->BeamformEntryCap = BeamformCap; -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ -+/* pEntry->LogSeq = 0xff; Move to Beamforming_AddBFerEntry*/ -+/* pEntry->LogRetryCnt = 0; Move to Beamforming_AddBFerEntry*/ -+/* pEntry->LogSuccessCnt = 0; Move to Beamforming_AddBFerEntry*/ -+ -+ pEntry->LogStatusFailCnt = 0; -+ -+ pEntry->NumofSoundingDim = NumofSoundingDim; -+ pEntry->CompSteeringNumofBFer = CompSteeringNumofBFer; -+ -+ if (BeamformCap & BEAMFORMER_CAP_VHT_MU) { -+ pDM_Odm->BeamformingInfo.beamformee_mu_cnt += 1; -+ pEntry->is_mu_sta = TRUE; -+ pDM_Odm->BeamformingInfo.FirstMUBFeeIndex = phydm_Beamforming_GetFirstMUBFeeEntryIdx(pDM_Odm); -+ } else if (BeamformCap & BEAMFORMER_CAP_VHT_SU) { -+ pDM_Odm->BeamformingInfo.beamformee_su_cnt += 1; -+ pEntry->is_mu_sta = FALSE; -+ } -+ -+ return pEntry; -+ } -+ else -+ return NULL; -+} -+ -+/*Add SU BFee and MU BFer*/ -+PRT_BEAMFORMER_ENTRY -+Beamforming_AddBFerEntry( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORM_STAINFO pSTA, -+ IN BEAMFORMING_CAP BeamformCap, -+ IN u1Byte NumofSoundingDim, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMER_ENTRY pEntry = phydm_Beamforming_GetFreeBFerEntry(pDM_Odm, Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (pEntry != NULL) { -+ pEntry->bUsed = TRUE; -+ ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, pSTA->MyMacAddr, 6); -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) { -+ /*BSSID[44:47] xor BSSID[40:43]*/ -+ u2Byte BSSID = ((pSTA->MyMacAddr[5] & 0xf0) >> 4) ^ (pSTA->MyMacAddr[5] & 0xf); -+ -+ pEntry->P_AID = (pSTA->AID + BSSID * 32) & 0x1ff; -+ pEntry->G_ID = 63; -+ /*(dec(A) + dec(B)*32) mod 512*/ -+ } else if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) { -+ pEntry->P_AID = 0; -+ pEntry->G_ID = 63; -+ } else { -+ pEntry->P_AID = pSTA->RA[5]; -+ /*BSSID[39:47]*/ -+ pEntry->P_AID = (pEntry->P_AID << 1) | (pSTA->RA[4] >> 7); -+ pEntry->G_ID = 0; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: P_AID addressed to AP=0x%X\n", __func__, pEntry->P_AID)); -+ } -+ -+ cpMacAddr(pEntry->MacAddr, pSTA->RA); -+ pEntry->BeamformEntryCap = BeamformCap; -+ -+ pEntry->PreLogSeq = 0; /*Modified by Jeffery @2015-04-13*/ -+ pEntry->LogSeq = 0; /*Modified by Jeffery @2014-10-29*/ -+ pEntry->LogRetryCnt = 0; /*Modified by Jeffery @2014-10-29*/ -+ pEntry->LogSuccess = 0; /*LogSuccess is NOT needed to be accumulated, so LogSuccessCnt->LogSuccess, 2015-04-13, Jeffery*/ -+ pEntry->ClockResetTimes = 0; /*Modified by Jeffery @2015-04-13*/ -+ -+ pEntry->NumofSoundingDim = NumofSoundingDim; -+ -+ if (BeamformCap & BEAMFORMEE_CAP_VHT_MU) { -+ pDM_Odm->BeamformingInfo.beamformer_mu_cnt += 1; -+ pEntry->is_mu_ap = TRUE; -+ pEntry->AID = pSTA->AID; -+ } else if (BeamformCap & BEAMFORMEE_CAP_VHT_SU) { -+ pDM_Odm->BeamformingInfo.beamformer_su_cnt += 1; -+ pEntry->is_mu_ap = FALSE; -+ } -+ -+ return pEntry; -+ } -+ else -+ return NULL; -+} -+ -+#if 0 -+BOOLEAN -+Beamforming_RemoveEntry( -+ IN PADAPTER Adapter, -+ IN pu1Byte RA, -+ OUT pu1Byte Idx -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ PRT_BEAMFORMER_ENTRY pBFerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, RA, Idx); -+ PRT_BEAMFORMEE_ENTRY pEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, Idx); -+ BOOLEAN ret = FALSE; -+ -+ RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s Start!\n", __func__)); -+ RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s, pBFerEntry=0x%x\n", __func__, pBFerEntry)); -+ RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s, pEntry=0x%x\n", __func__, pEntry)); -+ -+ if (pEntry != NULL) { -+ pEntry->bUsed = FALSE; -+ pEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; -+ /*pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE;*/ -+ pEntry->bBeamformingInProgress = FALSE; -+ ret = TRUE; -+ } -+ if (pBFerEntry != NULL) { -+ pBFerEntry->bUsed = FALSE; -+ pBFerEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; -+ ret = TRUE; -+ } -+ return ret; -+ -+} -+#endif -+ -+/* Used for BeamformingStart_V1 */ -+VOID -+phydm_Beamforming_NDPARate( -+ IN PVOID pDM_VOID, -+ CHANNEL_WIDTH BW, -+ u1Byte Rate -+) -+{ -+ u2Byte NDPARate = Rate; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (NDPARate == 0) { -+ if(pDM_Odm->RSSI_Min > 30) // link RSSI > 30% -+ NDPARate = ODM_RATE24M; -+ else -+ NDPARate = ODM_RATE6M; -+ } -+ -+ if (NDPARate < ODM_RATEMCS0) -+ BW = (CHANNEL_WIDTH)ODM_BW20M; -+ -+ NDPARate = (NDPARate << 8) | BW; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_RATE, (pu1Byte)&NDPARate); -+ -+} -+ -+ -+/* Used for BeamformingStart_SW and BeamformingStart_FW */ -+VOID -+phydm_Beamforming_DymNDPARate( -+ IN PVOID pDM_VOID -+) -+{ -+ u2Byte NDPARate = ODM_RATE6M, BW; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (pDM_Odm->RSSI_Min > 30) /*link RSSI > 30%*/ -+ NDPARate = ODM_RATE24M; -+ else -+ NDPARate = ODM_RATE6M; -+ -+ BW = ODM_BW20M; -+ NDPARate = NDPARate << 8 | BW; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_RATE, (pu1Byte)&NDPARate); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, NDPA Rate = 0x%X\n", __func__, NDPARate)); -+} -+ -+/* -+* SW Sounding : SW Timer unit 1ms -+* HW Timer unit (1/32000) s 32k is clock. -+* FW Sounding : FW Timer unit 10ms -+*/ -+VOID -+Beamforming_DymPeriod( -+ IN PVOID pDM_VOID, -+ IN u8 status -+) -+{ -+ u1Byte Idx; -+ BOOLEAN bChangePeriod = FALSE; -+ u2Byte SoundPeriod_SW, SoundPeriod_FW; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); -+ -+ PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ //3 TODO per-client throughput caculation. -+ -+ if ((*(pDM_Odm->pCurrentTxTP) + *(pDM_Odm->pCurrentRxTP) > 2) && ((pEntry->LogStatusFailCnt <= 20) || status)) { -+ SoundPeriod_SW = 40; /* 40ms */ -+ SoundPeriod_FW = 40; /* From H2C cmd, unit = 10ms */ -+ } else { -+ SoundPeriod_SW = 4000;/* 4s */ -+ SoundPeriod_FW = 400; -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]SoundPeriod_SW=%d, SoundPeriod_FW=%d\n", __func__, SoundPeriod_SW, SoundPeriod_FW)); -+ -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ pBeamformEntry = pBeamInfo->BeamformeeEntry+Idx; -+ -+ if (pBeamformEntry->DefaultCSICnt > 20) { -+ /*Modified by David*/ -+ SoundPeriod_SW = 4000; -+ SoundPeriod_FW = 400; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Period = %d\n", __func__, SoundPeriod_SW)); -+ if (pBeamformEntry->BeamformEntryCap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { -+ if (pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER) { -+ if (pBeamformEntry->SoundPeriod != SoundPeriod_FW) { -+ pBeamformEntry->SoundPeriod = SoundPeriod_FW; -+ bChangePeriod = TRUE; /*Only FW sounding need to send H2C packet to change sound period. */ -+ } -+ } else if (pBeamformEntry->SoundPeriod != SoundPeriod_SW) { -+ pBeamformEntry->SoundPeriod = SoundPeriod_SW; -+ } -+ } -+ } -+ -+ if (bChangePeriod) -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_FW_NDPA, (pu1Byte)&Idx); -+} -+ -+ -+ -+ -+BOOLEAN -+Beamforming_SendHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW, -+ IN u1Byte QIdx -+ ) -+{ -+ BOOLEAN ret = TRUE; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (QIdx == BEACON_QUEUE) -+ ret = SendFWHTNDPAPacket(pDM_Odm, RA, BW); -+ else -+ ret = SendSWHTNDPAPacket(pDM_Odm, RA, BW); -+ -+ return ret; -+} -+ -+ -+ -+BOOLEAN -+Beamforming_SendVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW, -+ IN u1Byte QIdx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ BOOLEAN ret = TRUE; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_GET_TX_RATE, NULL); -+ -+ if ((pDM_Odm->TxBfDataRate >= ODM_RATEVHTSS3MCS7) && (pDM_Odm->TxBfDataRate <= ODM_RATEVHTSS3MCS9)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s: 3SS VHT 789 don't sounding\n", __func__)); -+ -+ } else { -+ if (QIdx == BEACON_QUEUE) /* Send to reserved page => FW NDPA */ -+ ret = SendFWVHTNDPAPacket(pDM_Odm, RA, AID, BW); -+ else { -+#ifdef SUPPORT_MU_BF -+ #if (SUPPORT_MU_BF == 1) -+ pBeamInfo->is_mu_sounding = TRUE; -+ ret = SendSWVHTMUNDPAPacket(pDM_Odm, BW); -+ #else -+ pBeamInfo->is_mu_sounding = FALSE; -+ ret = SendSWVHTNDPAPacket(pDM_Odm, RA, AID, BW); -+ #endif -+#else -+ pBeamInfo->is_mu_sounding = FALSE; -+ ret = SendSWVHTNDPAPacket(pDM_Odm, RA, AID, BW); -+#endif -+ } -+ } -+ return ret; -+} -+ -+ -+BEAMFORMING_NOTIFY_STATE -+phydm_beamfomring_bSounding( -+ IN PVOID pDM_VOID, -+ PRT_BEAMFORMING_INFO pBeamInfo, -+ pu1Byte Idx -+ ) -+{ -+ BEAMFORMING_NOTIFY_STATE bSounding = BEAMFORMING_NOTIFY_NONE; -+ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ /*if(( Beamforming_GetBeamCap(pBeamInfo) & BEAMFORMER_CAP) == 0)*/ -+ /*bSounding = BEAMFORMING_NOTIFY_RESET;*/ -+ if (BeamOidInfo.SoundOidMode == SOUNDING_STOP_All_TIMER) -+ bSounding = BEAMFORMING_NOTIFY_RESET; -+ else { -+ u1Byte i; -+ -+ for (i = 0 ; i < BEAMFORMEE_ENTRY_NUM ; i++) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s: BFee Entry %d bUsed=%d, bSound=%d\n", __func__, i, pBeamInfo->BeamformeeEntry[i].bUsed, pBeamInfo->BeamformeeEntry[i].bSound)); -+ if (pBeamInfo->BeamformeeEntry[i].bUsed && (!pBeamInfo->BeamformeeEntry[i].bSound)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Add BFee entry %d\n", __func__, i)); -+ *Idx = i; -+ if (pBeamInfo->BeamformeeEntry[i].is_mu_sta) -+ bSounding = BEAMFORMEE_NOTIFY_ADD_MU; -+ else -+ bSounding = BEAMFORMEE_NOTIFY_ADD_SU; -+ } -+ -+ if ((!pBeamInfo->BeamformeeEntry[i].bUsed) && pBeamInfo->BeamformeeEntry[i].bSound) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Delete BFee entry %d\n", __func__, i)); -+ *Idx = i; -+ if (pBeamInfo->BeamformeeEntry[i].is_mu_sta) -+ bSounding = BEAMFORMEE_NOTIFY_DELETE_MU; -+ else -+ bSounding = BEAMFORMEE_NOTIFY_DELETE_SU; -+ } -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, bSounding = %d\n", __func__, bSounding)); -+ return bSounding; -+} -+ -+ -+//This function is unused -+u1Byte -+phydm_beamforming_SoundingIdx( -+ IN PVOID pDM_VOID, -+ PRT_BEAMFORMING_INFO pBeamInfo -+ ) -+{ -+ u1Byte Idx = 0; -+ RT_BEAMFORMEE_ENTRY BeamEntry; -+ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (BeamOidInfo.SoundOidMode == SOUNDING_SW_HT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_SW_VHT_TIMER || -+ BeamOidInfo.SoundOidMode == SOUNDING_HW_HT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_HW_VHT_TIMER) -+ Idx = BeamOidInfo.SoundOidIdx; -+ else { -+ u1Byte i; -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformeeEntry[i].bUsed && (FALSE == pBeamInfo->BeamformeeEntry[i].bSound)) { -+ Idx = i; -+ break; -+ } -+ } -+ } -+ -+ return Idx; -+} -+ -+ -+SOUNDING_MODE -+phydm_beamforming_SoundingMode( -+ IN PVOID pDM_VOID, -+ PRT_BEAMFORMING_INFO pBeamInfo, -+ u1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte SupportInterface = pDM_Odm->SupportInterface; -+ -+ RT_BEAMFORMEE_ENTRY BeamEntry = pBeamInfo->BeamformeeEntry[Idx]; -+ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; -+ SOUNDING_MODE Mode = BeamOidInfo.SoundOidMode; -+ -+ if (BeamOidInfo.SoundOidMode == SOUNDING_SW_VHT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_HW_VHT_TIMER) { -+ if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) -+ Mode = BeamOidInfo.SoundOidMode; -+ else -+ Mode = SOUNDING_STOP_All_TIMER; -+ } else if (BeamOidInfo.SoundOidMode == SOUNDING_SW_HT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_HW_HT_TIMER) { -+ if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT) -+ Mode = BeamOidInfo.SoundOidMode; -+ else -+ Mode = SOUNDING_STOP_All_TIMER; -+ } else if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) { -+ if ((SupportInterface == ODM_ITRF_USB) && !(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B))) -+ Mode = SOUNDING_FW_VHT_TIMER; -+ else -+ Mode = SOUNDING_SW_VHT_TIMER; -+ } else if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT) { -+ if ((SupportInterface == ODM_ITRF_USB) && !(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B))) -+ Mode = SOUNDING_FW_HT_TIMER; -+ else -+ Mode = SOUNDING_SW_HT_TIMER; -+ } else -+ Mode = SOUNDING_STOP_All_TIMER; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SupportInterface=%d, Mode=%d\n", __func__, SupportInterface, Mode)); -+ -+ return Mode; -+} -+ -+ -+u2Byte -+phydm_beamforming_SoundingTime( -+ IN PVOID pDM_VOID, -+ PRT_BEAMFORMING_INFO pBeamInfo, -+ SOUNDING_MODE Mode, -+ u1Byte Idx -+ ) -+{ -+ u2Byte SoundingTime = 0xffff; -+ RT_BEAMFORMEE_ENTRY BeamEntry = pBeamInfo->BeamformeeEntry[Idx]; -+ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_HW_VHT_TIMER) -+ SoundingTime = BeamOidInfo.SoundOidPeriod * 32; -+ else if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_SW_VHT_TIMER) -+ /*Modified by David*/ -+ SoundingTime = BeamEntry.SoundPeriod; /*BeamOidInfo.SoundOidPeriod;*/ -+ else -+ SoundingTime = BeamEntry.SoundPeriod; -+ -+ return SoundingTime; -+} -+ -+ -+CHANNEL_WIDTH -+phydm_beamforming_SoundingBW( -+ IN PVOID pDM_VOID, -+ PRT_BEAMFORMING_INFO pBeamInfo, -+ SOUNDING_MODE Mode, -+ u1Byte Idx -+ ) -+{ -+ CHANNEL_WIDTH SoundingBW = CHANNEL_WIDTH_20; -+ RT_BEAMFORMEE_ENTRY BeamEntry = pBeamInfo->BeamformeeEntry[Idx]; -+ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_HW_VHT_TIMER) -+ SoundingBW = BeamOidInfo.SoundOidBW; -+ else if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_SW_VHT_TIMER) -+ /*Modified by David*/ -+ SoundingBW = BeamEntry.SoundBW; /*BeamOidInfo.SoundOidBW;*/ -+ else -+ SoundingBW = BeamEntry.SoundBW; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, SoundingBW=0x%X\n", __func__, SoundingBW)); -+ -+ return SoundingBW; -+} -+ -+ -+BOOLEAN -+phydm_Beamforming_SelectBeamEntry( -+ IN PVOID pDM_VOID, -+ PRT_BEAMFORMING_INFO pBeamInfo -+ ) -+{ -+ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /*pEntry.bSound is different between first and latter NDPA, and should not be used as BFee entry selection*/ -+ /*BTW, latter modification should sync to the selection mechanism of AP/ADSL instead of the fixed SoundIdx.*/ -+ pSoundInfo->SoundIdx = phydm_beamforming_SoundingIdx(pDM_Odm, pBeamInfo); -+ /*pSoundInfo->SoundIdx = 0;*/ -+ -+ if (pSoundInfo->SoundIdx < BEAMFORMEE_ENTRY_NUM) -+ pSoundInfo->SoundMode = phydm_beamforming_SoundingMode(pDM_Odm, pBeamInfo, pSoundInfo->SoundIdx); -+ else -+ pSoundInfo->SoundMode = SOUNDING_STOP_All_TIMER; -+ -+ if (SOUNDING_STOP_All_TIMER == pSoundInfo->SoundMode) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Return because of SOUNDING_STOP_All_TIMER\n", __func__)); -+ return FALSE; -+ } else { -+ pSoundInfo->SoundBW = phydm_beamforming_SoundingBW(pDM_Odm, pBeamInfo, pSoundInfo->SoundMode, pSoundInfo->SoundIdx ); -+ pSoundInfo->SoundPeriod = phydm_beamforming_SoundingTime(pDM_Odm, pBeamInfo, pSoundInfo->SoundMode, pSoundInfo->SoundIdx ); -+ return TRUE; -+ } -+} -+ -+/*SU BFee Entry Only*/ -+BOOLEAN -+phydm_beamforming_StartPeriod( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ BOOLEAN Ret = TRUE; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); -+ -+ phydm_Beamforming_DymNDPARate(pDM_Odm); -+ -+ phydm_Beamforming_SelectBeamEntry(pDM_Odm, pBeamInfo); // Modified -+ -+ if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) -+ ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, pSoundInfo->SoundPeriod); -+ else if (pSoundInfo->SoundMode == SOUNDING_HW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_HW_HT_TIMER || -+ pSoundInfo->SoundMode == SOUNDING_AUTO_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_AUTO_HT_TIMER) { -+ HAL_HW_TIMER_TYPE TimerType = HAL_TIMER_TXBF; -+ u4Byte val = (pSoundInfo->SoundPeriod | (TimerType<<16)); -+ -+ //HW timer stop: All IC has the same setting -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_STOP, (pu1Byte)(&TimerType)); -+ //ODM_Write1Byte(pDM_Odm, 0x15F, 0); -+ //HW timer init: All IC has the same setting, but 92E & 8812A only write 2 bytes -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_INIT, (pu1Byte)(&val)); -+ //ODM_Write1Byte(pDM_Odm, 0x164, 1); -+ //ODM_Write4Byte(pDM_Odm, 0x15C, val); -+ //HW timer start: All IC has the same setting -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_START, (pu1Byte)(&TimerType)); -+ //ODM_Write1Byte(pDM_Odm, 0x15F, 0x5); -+ } else if (pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER) -+ Ret = BeamformingStart_FW(pDM_Odm, pSoundInfo->SoundIdx); -+ else -+ Ret = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SoundIdx=%d, SoundMode=%d, SoundBW=%d, SoundPeriod=%d\n", __func__, -+ pSoundInfo->SoundIdx, pSoundInfo->SoundMode, pSoundInfo->SoundBW, pSoundInfo->SoundPeriod)); -+ -+ return Ret; -+} -+ -+// Used after Beamforming_Leave, and will clear the setting of the "already deleted" entry -+/*SU BFee Entry Only*/ -+VOID -+phydm_beamforming_EndPeriod_SW( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ u1Byte Idx = 0; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); -+ -+ HAL_HW_TIMER_TYPE TimerType = HAL_TIMER_TXBF; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) -+ ODM_CancelTimer(pDM_Odm, &pBeamInfo->BeamformingTimer); -+ else if (pSoundInfo->SoundMode == SOUNDING_HW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_HW_HT_TIMER || -+ pSoundInfo->SoundMode == SOUNDING_AUTO_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_AUTO_HT_TIMER) -+ /*HW timer stop: All IC has the same setting*/ -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_STOP, (pu1Byte)(&TimerType)); -+ /*ODM_Write1Byte(pDM_Odm, 0x15F, 0);*/ -+} -+ -+VOID -+phydm_beamforming_EndPeriod_FW( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx = 0; -+ -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_FW_NDPA, (pu1Byte)&Idx); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]\n", __func__)); -+} -+ -+ -+/*SU BFee Entry Only*/ -+VOID -+phydm_beamforming_ClearEntry_SW( -+ IN PVOID pDM_VOID, -+ BOOLEAN IsDelete, -+ u1Byte DeleteIdx -+ ) -+{ -+ u1Byte Idx = 0; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ if (IsDelete) { -+ if (DeleteIdx < BEAMFORMEE_ENTRY_NUM) { -+ pBeamformEntry = pBeamInfo->BeamformeeEntry + DeleteIdx; -+ if (!((!pBeamformEntry->bUsed) && pBeamformEntry->bSound)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW DeleteIdx is wrong!!!!!\n", __func__)); -+ return; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW delete BFee entry %d\n", __func__, DeleteIdx)); -+ if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) { -+ pBeamformEntry->bBeamformingInProgress = FALSE; -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ } else if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&DeleteIdx); -+ } -+ pBeamformEntry->bSound = FALSE; -+ } else { -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ pBeamformEntry = pBeamInfo->BeamformeeEntry+Idx; -+ -+ /*Used after bSounding=RESET, and will clear the setting of "ever sounded" entry, which is not necessarily be deleted.*/ -+ /*This function is mainly used in case "BeamOidInfo.SoundOidMode == SOUNDING_STOP_All_TIMER".*/ -+ /*However, setting oid doesn't delete entries (bUsed is still TRUE), new entries may fail to be added in.*/ -+ -+ if (pBeamformEntry->bSound) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW reset BFee entry %d\n", __func__, Idx)); -+ /* -+ * If End procedure is -+ * 1. Between (Send NDPA, C2H packet return), reset state to initialized. -+ * After C2H packet return , status bit will be set to zero. -+ * -+ * 2. After C2H packet, then reset state to initialized and clear status bit. -+ */ -+ -+ if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ phydm_Beamforming_End_SW(pDM_Odm, 0); -+ else if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&Idx); -+ } -+ -+ pBeamformEntry->bSound = FALSE; -+ } -+ } -+ } -+} -+ -+VOID -+phydm_beamforming_ClearEntry_FW( -+ IN PVOID pDM_VOID, -+ BOOLEAN IsDelete, -+ u1Byte DeleteIdx -+ ) -+{ -+ u1Byte Idx = 0; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ if (IsDelete) { -+ if (DeleteIdx < BEAMFORMEE_ENTRY_NUM) { -+ pBeamformEntry = pBeamInfo->BeamformeeEntry + DeleteIdx; -+ -+ if (!((!pBeamformEntry->bUsed) && pBeamformEntry->bSound)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] FW DeleteIdx is wrong!!!!!\n", __func__)); -+ return; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: FW delete BFee entry %d\n", __func__, DeleteIdx)); -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ pBeamformEntry->bSound = FALSE; -+ } else { -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ pBeamformEntry = pBeamInfo->BeamformeeEntry+Idx; -+ -+ /*Used after bSounding=RESET, and will clear the setting of "ever sounded" entry, which is not necessarily be deleted.*/ -+ /*This function is mainly used in case "BeamOidInfo.SoundOidMode == SOUNDING_STOP_All_TIMER".*/ -+ /*However, setting oid doesn't delete entries (bUsed is still TRUE), new entries may fail to be added in.*/ -+ -+ if (pBeamformEntry->bSound) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]FW reset BFee entry %d\n", __func__, Idx)); -+ /* -+ * If End procedure is -+ * 1. Between (Send NDPA, C2H packet return), reset state to initialized. -+ * After C2H packet return , status bit will be set to zero. -+ * -+ * 2. After C2H packet, then reset state to initialized and clear status bit. -+ */ -+ -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ pBeamformEntry->bSound = FALSE; -+ } -+ } -+ } -+} -+ -+/* -+* Called : -+* 1. Add and delete entry : Beamforming_Enter/Beamforming_Leave -+* 2. FW trigger : Beamforming_SetTxBFen -+* 3. Set OID_RT_BEAMFORMING_PERIOD : BeamformingControl_V2 -+*/ -+VOID -+phydm_Beamforming_Notify( -+ IN PVOID pDM_VOID -+ ) -+{ -+ u1Byte Idx=BEAMFORMEE_ENTRY_NUM; -+ BEAMFORMING_NOTIFY_STATE bSounding = BEAMFORMING_NOTIFY_NONE; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ bSounding = phydm_beamfomring_bSounding(pDM_Odm, pBeamInfo, &Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, Before notify, bSounding=%d, Idx=%d\n", __func__, bSounding, Idx)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: pBeamInfo->beamformee_su_cnt = %d\n", __func__, pBeamInfo->beamformee_su_cnt)); -+ -+ -+ switch (bSounding) { -+ case BEAMFORMEE_NOTIFY_ADD_SU: -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_ADD_SU\n", __func__)); -+ phydm_beamforming_StartPeriod(pDM_Odm); -+ break; -+ -+ case BEAMFORMEE_NOTIFY_DELETE_SU: -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_DELETE_SU\n", __func__)); -+ if (pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER) { -+ phydm_beamforming_ClearEntry_FW(pDM_Odm, TRUE, Idx); -+ if (pBeamInfo->beamformee_su_cnt == 0) { /* For 2->1 entry, we should not cancel SW timer */ -+ phydm_beamforming_EndPeriod_FW(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: No BFee left\n", __func__)); -+ } -+ } else { -+ phydm_beamforming_ClearEntry_SW(pDM_Odm, TRUE, Idx); -+ if (pBeamInfo->beamformee_su_cnt == 0) { /* For 2->1 entry, we should not cancel SW timer */ -+ phydm_beamforming_EndPeriod_SW(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: No BFee left\n", __func__)); -+ } -+ } -+ break; -+ -+ case BEAMFORMEE_NOTIFY_ADD_MU: -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_ADD_MU\n", __func__)); -+ if (pBeamInfo->beamformee_mu_cnt == 2) { -+ /*if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) -+ ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, pSoundInfo->SoundPeriod);*/ -+ ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, 1000); /*Do MU sounding every 1sec*/ -+ } else -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Less or larger than 2 MU STAs, not to set timer\n", __func__)); -+ break; -+ -+ case BEAMFORMEE_NOTIFY_DELETE_MU: -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_DELETE_MU\n", __func__)); -+ if (pBeamInfo->beamformee_mu_cnt == 1) { -+ /*if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER)*/{ -+ ODM_CancelTimer(pDM_Odm, &pBeamInfo->BeamformingTimer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Less than 2 MU STAs, stop sounding\n", __func__)); -+ } -+ } -+ break; -+ -+ case BEAMFORMING_NOTIFY_RESET: -+ if (pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER) { -+ phydm_beamforming_ClearEntry_FW(pDM_Odm, FALSE, Idx); -+ phydm_beamforming_EndPeriod_FW(pDM_Odm); -+ } else { -+ phydm_beamforming_ClearEntry_SW(pDM_Odm, FALSE, Idx); -+ phydm_beamforming_EndPeriod_SW(pDM_Odm); -+ } -+ -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+ -+ -+BOOLEAN -+Beamforming_InitEntry( -+ IN PVOID pDM_VOID, -+ IN u2Byte staIdx, -+ pu1Byte BFerBFeeIdx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; -+ PRT_BEAMFORMER_ENTRY pBeamformerEntry = NULL; -+ PRT_BEAMFORM_STAINFO pSTA = NULL; -+ BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; -+ u1Byte BFerIdx=0xF, BFeeIdx=0xF; -+ u1Byte NumofSoundingDim = 0, CompSteeringNumofBFer = 0; -+ -+ pSTA = phydm_staInfoInit(pDM_Odm, staIdx); -+ -+ /*The current setting does not support Beaforming*/ -+ if (BEAMFORMING_CAP_NONE == pSTA->HtBeamformCap && BEAMFORMING_CAP_NONE == pSTA->VhtBeamformCap) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("The configuration disabled Beamforming! Skip...\n")); -+ return FALSE; -+ } -+ -+ if (pSTA->WirelessMode < WIRELESS_MODE_N_24G) -+ return FALSE; -+ else { /*HT*/ -+ /*We are Beamformee because the STA is Beamformer*/ -+ if (TEST_FLAG(pSTA->CurBeamform, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { -+ BeamformCap =(BEAMFORMING_CAP)(BeamformCap |BEAMFORMEE_CAP_HT_EXPLICIT); -+ NumofSoundingDim = (pSTA->CurBeamform&BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP)>>6; -+ } -+ /*We are Beamformer because the STA is Beamformee*/ -+ if (TEST_FLAG(pSTA->CurBeamform, BEAMFORMING_HT_BEAMFORMEE_ENABLE) || -+ TEST_FLAG(pSTA->HtBeamformCap, BEAMFORMING_HT_BEAMFORMER_TEST)) { -+ BeamformCap =(BEAMFORMING_CAP)(BeamformCap | BEAMFORMER_CAP_HT_EXPLICIT); -+ CompSteeringNumofBFer = (pSTA->CurBeamform & BEAMFORMING_HT_BEAMFORMER_STEER_NUM)>>4; -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] HT CurBeamform=0x%X, BeamformCap=0x%X\n", __func__, pSTA->CurBeamform, BeamformCap)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] HT NumofSoundingDim=%d, CompSteeringNumofBFer=%d\n", __func__, NumofSoundingDim, CompSteeringNumofBFer)); -+#if (ODM_IC_11AC_SERIES_SUPPORT == 1) -+ if (pSTA->WirelessMode & WIRELESS_MODE_AC_5G || pSTA->WirelessMode & WIRELESS_MODE_AC_24G) { /*VHT*/ -+ -+ /* We are Beamformee because the STA is SU Beamformer*/ -+ if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { -+ BeamformCap =(BEAMFORMING_CAP)(BeamformCap |BEAMFORMEE_CAP_VHT_SU); -+ NumofSoundingDim = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM)>>12; -+ } -+ /* We are Beamformer because the STA is SU Beamformee*/ -+ if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) || -+ TEST_FLAG(pSTA->VhtBeamformCap, BEAMFORMING_VHT_BEAMFORMER_TEST)) { -+ BeamformCap =(BEAMFORMING_CAP)(BeamformCap |BEAMFORMER_CAP_VHT_SU); -+ CompSteeringNumofBFer = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMER_STS_CAP)>>8; -+ } -+ /* We are Beamformee because the STA is MU Beamformer*/ -+ if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) { -+ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMEE_CAP_VHT_MU); -+ NumofSoundingDim = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM)>>12; -+ } -+ /* We are Beamformer because the STA is MU Beamformee*/ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) { /* Only AP mode supports to act an MU beamformer */ -+ if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE) || -+ TEST_FLAG(pSTA->VhtBeamformCap, BEAMFORMING_VHT_BEAMFORMER_TEST)) { -+ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMER_CAP_VHT_MU); -+ CompSteeringNumofBFer = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMER_STS_CAP)>>8; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]VHT CurBeamformVHT=0x%X, BeamformCap=0x%X\n", __func__, pSTA->CurBeamformVHT, BeamformCap)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]VHT NumofSoundingDim=0x%X, CompSteeringNumofBFer=0x%X\n", __func__, NumofSoundingDim, CompSteeringNumofBFer)); -+ -+ } -+#endif -+ } -+ -+ -+ if(BeamformCap == BEAMFORMING_CAP_NONE) -+ return FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Self BF Entry Cap = 0x%02X\n", __func__, BeamformCap)); -+ -+ /*We are BFee, so the entry is BFer*/ -+ if (BeamformCap & (BEAMFORMEE_CAP_VHT_MU | BEAMFORMEE_CAP_VHT_SU | BEAMFORMEE_CAP_HT_EXPLICIT)) { -+ pBeamformerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, pSTA->RA, &BFerIdx); -+ -+ if (pBeamformerEntry == NULL) { -+ pBeamformerEntry = Beamforming_AddBFerEntry(pDM_Odm, pSTA, BeamformCap, NumofSoundingDim , &BFerIdx); -+ if (pBeamformerEntry == NULL) -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Not enough BFer entry!!!!!\n", __func__)); -+ } -+ } -+ -+ /*We are BFer, so the entry is BFee*/ -+ if (BeamformCap & (BEAMFORMER_CAP_VHT_MU | BEAMFORMER_CAP_VHT_SU | BEAMFORMER_CAP_HT_EXPLICIT)) { -+ pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, pSTA->RA, &BFeeIdx); -+ -+ /*pGBFeeIdx = 0xF hNثeentrySۦPMACIDb*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get BFee entry 0x%X by address\n", __func__, BFeeIdx)); -+ if (pBeamformEntry == NULL) { -+ pBeamformEntry = Beamforming_AddBFeeEntry(pDM_Odm, pSTA, BeamformCap, NumofSoundingDim, CompSteeringNumofBFer, &BFeeIdx); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: pSTA->AID=%d, pSTA->MacID=%d\n", __func__, pSTA->AID, pSTA->MacID)); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: Add BFee entry %d\n", __func__, BFeeIdx)); -+ -+ if (pBeamformEntry == NULL) -+ return FALSE; -+ else -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZEING; -+ } else { -+ /*Entry has been created. If entry is initialing or progressing then errors occur.*/ -+ if (pBeamformEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_INITIALIZED && -+ pBeamformEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ return FALSE; -+ } else -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZEING; -+ } -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ phydm_staInfoUpdate(pDM_Odm, staIdx, pBeamformEntry); -+ } -+ -+ *BFerBFeeIdx = (BFerIdx<<4) | BFeeIdx; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End: BFerIdx=0x%X, BFeeIdx=0x%X, BFerBFeeIdx=0x%X\n", __func__, BFerIdx, BFeeIdx, *BFerBFeeIdx)); -+ -+ return TRUE; -+} -+ -+ -+VOID -+Beamforming_DeInitEntry( -+ IN PVOID pDM_VOID, -+ pu1Byte RA -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx = 0; -+ -+ PRT_BEAMFORMER_ENTRY pBFerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, RA, &Idx); -+ PRT_BEAMFORMEE_ENTRY pBFeeEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ BOOLEAN ret = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (pBFeeEntry != NULL) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, pBFeeEntry\n", __func__)); -+ pBFeeEntry->bUsed = FALSE; -+ pBFeeEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; -+ pBFeeEntry->bBeamformingInProgress = FALSE; -+ if (pBFeeEntry->is_mu_sta) { -+ pDM_Odm->BeamformingInfo.beamformee_mu_cnt -= 1; -+ pDM_Odm->BeamformingInfo.FirstMUBFeeIndex = phydm_Beamforming_GetFirstMUBFeeEntryIdx(pDM_Odm); -+ } else { -+ pDM_Odm->BeamformingInfo.beamformee_su_cnt -= 1; -+ } -+ ret = TRUE; -+ } -+ -+ if (pBFerEntry != NULL) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, pBFerEntry\n", __func__)); -+ pBFerEntry->bUsed = FALSE; -+ pBFerEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; -+ if (pBFerEntry->is_mu_ap) -+ pDM_Odm->BeamformingInfo.beamformer_mu_cnt -= 1; -+ else -+ pDM_Odm->BeamformingInfo.beamformer_su_cnt -= 1; -+ ret = TRUE; -+ } -+ -+ if (ret == TRUE) -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_LEAVE, (pu1Byte)&Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, Idx = 0x%X\n", __func__, Idx)); -+} -+ -+ -+VOID -+Beamforming_Reset( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx = 0; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &(pDM_Odm->BeamformingInfo); -+ -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ if (pBeamformingInfo->BeamformeeEntry[Idx].bUsed == TRUE) { -+ pBeamformingInfo->BeamformeeEntry[Idx].bUsed = FALSE; -+ pBeamformingInfo->BeamformeeEntry[Idx].BeamformEntryCap = BEAMFORMING_CAP_NONE; -+ /*pBeamformingInfo->BeamformeeEntry[Idx].BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE;*/ -+ /*Modified by David*/ -+ pBeamformingInfo->BeamformeeEntry[Idx].bBeamformingInProgress = FALSE; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_LEAVE, (pu1Byte)&Idx); -+ } -+ } -+ -+ for (Idx = 0; Idx < BEAMFORMER_ENTRY_NUM; Idx++) { -+ pBeamformingInfo->BeamformerEntry[Idx].bUsed = FALSE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Idx=%d, bUsed=%d\n", __func__, Idx, pBeamformingInfo->BeamformerEntry[Idx].bUsed)); -+ } -+ -+} -+ -+ -+BOOLEAN -+BeamformingStart_V1( -+ IN PVOID pDM_VOID, -+ pu1Byte RA, -+ BOOLEAN Mode, -+ CHANNEL_WIDTH BW, -+ u1Byte Rate -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx = 0; -+ PRT_BEAMFORMEE_ENTRY pEntry; -+ BOOLEAN ret = TRUE; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ -+ pEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ if (pEntry->bUsed == FALSE) { -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } else { -+ if (pEntry->bBeamformingInProgress) -+ return FALSE; -+ -+ pEntry->bBeamformingInProgress = TRUE; -+ -+ if (Mode == 1) { -+ if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT)) { -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } -+ } else if (Mode == 0) { -+ if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU)) { -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } -+ } -+ -+ if (pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_INITIALIZED && pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } else { -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSING; -+ pEntry->bSound = TRUE; -+ } -+ } -+ -+ pEntry->SoundBW = BW; -+ pBeamInfo->BeamformeeCurIdx = Idx; -+ phydm_Beamforming_NDPARate(pDM_Odm, BW, Rate); -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&Idx); -+ -+ if (Mode == 1) -+ ret = Beamforming_SendHTNDPAPacket(pDM_Odm, RA, BW, NORMAL_QUEUE); -+ else -+ ret = Beamforming_SendVHTNDPAPacket(pDM_Odm, RA, pEntry->AID, BW, NORMAL_QUEUE); -+ -+ if (ret == FALSE) { -+ Beamforming_Leave(pDM_Odm, RA); -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Idx %d\n", __func__, Idx)); -+ return TRUE; -+} -+ -+ -+BOOLEAN -+BeamformingStart_SW( -+ IN PVOID pDM_VOID, -+ u1Byte Idx, -+ u1Byte Mode, -+ CHANNEL_WIDTH BW -+ ) -+{ -+ pu1Byte RA = NULL; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMEE_ENTRY pEntry; -+ BOOLEAN ret = TRUE; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ -+ pEntry = &(pBeamInfo->BeamformeeEntry[Idx]); -+ -+ if (pEntry->bUsed == FALSE) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Skip Beamforming, no entry for Idx =%d\n", Idx)); -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } else { -+ if (pEntry->bBeamformingInProgress) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("bBeamformingInProgress, skip...\n")); -+ return FALSE; -+ } -+ -+ pEntry->bBeamformingInProgress = TRUE; -+ RA = pEntry->MacAddr; -+ -+ if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_AUTO_HT_TIMER) { -+ if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT)) { -+ pEntry->bBeamformingInProgress = FALSE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Return by not support BEAMFORMER_CAP_HT_EXPLICIT <==\n", __func__)); -+ return FALSE; -+ } -+ } else if (Mode == SOUNDING_SW_VHT_TIMER || Mode == SOUNDING_HW_VHT_TIMER || Mode == SOUNDING_AUTO_VHT_TIMER) { -+ if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU)) { -+ pEntry->bBeamformingInProgress = FALSE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Return by not support BEAMFORMER_CAP_VHT_SU <==\n", __func__)); -+ return FALSE; -+ } -+ } -+ if (pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_INITIALIZED && pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ pEntry->bBeamformingInProgress = FALSE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Return by incorrect BeamformEntryState(%d) <==\n", __func__, pEntry->BeamformEntryState)); -+ return FALSE; -+ } else { -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSING; -+ pEntry->bSound = TRUE; -+ } -+ } -+ -+ pBeamInfo->BeamformeeCurIdx = Idx; -+ /*2014.12.22 Luke: Need to be checked*/ -+ /*GET_TXBF_INFO(Adapter)->fTxbfSet(Adapter, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&Idx);*/ -+ -+ if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_AUTO_HT_TIMER) -+ ret = Beamforming_SendHTNDPAPacket(pDM_Odm, RA , BW, NORMAL_QUEUE); -+ else -+ ret = Beamforming_SendVHTNDPAPacket(pDM_Odm, RA , pEntry->AID, BW, NORMAL_QUEUE); -+ -+ if (ret == FALSE) { -+ Beamforming_Leave(pDM_Odm, RA); -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } -+ -+ -+ /*-------------------------- -+ // Send BF Report Poll for MU BF -+ --------------------------*/ -+#ifdef SUPPORT_MU_BF -+#if (SUPPORT_MU_BF == 1) -+{ -+ u1Byte idx, PollSTACnt = 0; -+ BOOLEAN bGetFirstBFee = FALSE; -+ -+ if (pBeamInfo->beamformee_mu_cnt > 1) { /* More than 1 MU STA*/ -+ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ pEntry = &(pBeamInfo->BeamformeeEntry[idx]); -+ if (pEntry->is_mu_sta) { -+ if (bGetFirstBFee) { -+ PollSTACnt++; -+ if (PollSTACnt == (pBeamInfo->beamformee_mu_cnt - 1))/* The last STA*/ -+ SendSWVHTBFReportPoll(pDM_Odm, pEntry->MacAddr, TRUE); -+ else -+ SendSWVHTBFReportPoll(pDM_Odm, pEntry->MacAddr, FALSE); -+ } else { -+ bGetFirstBFee = TRUE; -+ } -+ } -+ } -+ } -+} -+#endif -+#endif -+ return TRUE; -+} -+ -+ -+BOOLEAN -+BeamformingStart_FW( -+ IN PVOID pDM_VOID, -+ u1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pu1Byte RA = NULL; -+ PRT_BEAMFORMEE_ENTRY pEntry; -+ BOOLEAN ret = TRUE; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ -+ pEntry = &(pBeamInfo->BeamformeeEntry[Idx]); -+ if (pEntry->bUsed == FALSE) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Skip Beamforming, no entry for Idx =%d\n", Idx)); -+ return FALSE; -+ } -+ -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSING; -+ pEntry->bSound = TRUE; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_FW_NDPA, (pu1Byte)&Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End, Idx=0x%X\n", __func__, Idx)); -+ return TRUE; -+} -+ -+VOID -+Beamforming_CheckSoundingSuccess( -+ IN PVOID pDM_VOID, -+ BOOLEAN Status -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[David]@%s Start!\n", __func__)); -+ -+ if (Status == 1) { -+ if (pEntry->LogStatusFailCnt == 21) -+ Beamforming_DymPeriod(pDM_Odm, Status); -+ pEntry->LogStatusFailCnt = 0; -+ } else if (pEntry->LogStatusFailCnt <= 20) { -+ pEntry->LogStatusFailCnt++; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s LogStatusFailCnt %d\n", __func__, pEntry->LogStatusFailCnt)); -+ } -+ if (pEntry->LogStatusFailCnt > 20) { -+ pEntry->LogStatusFailCnt = 21; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s LogStatusFailCnt > 20, Stop SOUNDING\n", __func__)); -+ Beamforming_DymPeriod(pDM_Odm, Status); -+ } -+} -+ -+VOID -+phydm_Beamforming_End_SW( -+ IN PVOID pDM_VOID, -+ BOOLEAN Status -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); -+ -+ if (pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSING) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BeamformStatus %d\n", __func__, pEntry->BeamformEntryState)); -+ return; -+ } -+ -+ if ((pDM_Odm->TxBfDataRate >= ODM_RATEVHTSS3MCS7) && (pDM_Odm->TxBfDataRate <= ODM_RATEVHTSS3MCS9)) { -+ ODM_RT_TRACE(pDM_Odm, BEAMFORMING_DEBUG, ODM_DBG_LOUD, ("[%s] VHT3SS 7,8,9, do not apply V matrix.\n", __func__)); -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); -+ } else if (Status == 1) { -+ pEntry->LogStatusFailCnt = 0; -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); -+ } else { -+ pEntry->LogStatusFailCnt++; -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_TX_PATH_RESET, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] LogStatusFailCnt %d\n", __func__, pEntry->LogStatusFailCnt)); -+ } -+ -+ if (pEntry->LogStatusFailCnt > 30) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s LogStatusFailCnt > 50, Stop SOUNDING\n", __func__)); -+ pEntry->bSound = FALSE; -+ Beamforming_DeInitEntry(pDM_Odm, pEntry->MacAddr); -+ -+ /*Modified by David - Every action of deleting entry should follow by Notify*/ -+ phydm_Beamforming_Notify(pDM_Odm); -+ } -+ pEntry->bBeamformingInProgress = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Status=%d\n", __func__, Status)); -+} -+ -+ -+VOID -+Beamforming_TimerCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PVOID pDM_VOID -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ IN PVOID pContext -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PADAPTER Adapter = (PADAPTER)pContext; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+ BOOLEAN ret = FALSE; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); -+ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (pEntry->bBeamformingInProgress) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("bBeamformingInProgress, reset it\n")); -+ phydm_Beamforming_End_SW(pDM_Odm, 0); -+ } -+ -+ ret = phydm_Beamforming_SelectBeamEntry(pDM_Odm, pBeamInfo); -+#if (SUPPORT_MU_BF == 1) -+ if (ret && pBeamInfo->beamformee_mu_cnt > 1) -+ ret = 1; -+ else -+ ret = 0; -+#endif -+ if (ret) -+ ret = BeamformingStart_SW(pDM_Odm, pSoundInfo->SoundIdx, pSoundInfo->SoundMode, pSoundInfo->SoundBW); -+ else -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, Error value return from BeamformingStart_V2\n", __func__)); -+ -+ if ((pBeamInfo->beamformee_su_cnt != 0) || (pBeamInfo->beamformee_mu_cnt > 1)) { -+ if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) -+ ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, pSoundInfo->SoundPeriod); -+ else { -+ u4Byte val = (pSoundInfo->SoundPeriod << 16) | HAL_TIMER_TXBF; -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_RESTART, (pu1Byte)(&val)); -+ } -+ } -+} -+ -+ -+VOID -+Beamforming_SWTimerCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PRT_TIMER pTimer -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ void *FunctionContext -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ Beamforming_TimerCallback(pDM_Odm); -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)FunctionContext; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ if (Adapter->net_closed == TRUE) -+ return; -+ rtw_run_in_thread_cmd(Adapter, Beamforming_TimerCallback, Adapter); -+#endif -+ -+} -+ -+ -+VOID -+phydm_Beamforming_Init( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PHAL_TXBF_INFO pTxbfInfo = &pBeamInfo->TxbfInfo; -+ PRT_BEAMFORMING_OID_INFO pBeamOidInfo = &(pBeamInfo->BeamformingOidInfo); -+ -+ pBeamOidInfo->SoundOidMode = SOUNDING_STOP_OID_TIMER; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Mode (%d)\n", __func__, pBeamOidInfo->SoundOidMode)); -+ -+ pBeamInfo->beamformee_su_cnt = 0; -+ pBeamInfo->beamformer_su_cnt = 0; -+ pBeamInfo->beamformee_mu_cnt = 0; -+ pBeamInfo->beamformer_mu_cnt = 0; -+ pBeamInfo->beamformee_mu_reg_maping = 0; -+ pBeamInfo->mu_ap_index = 0; -+ pBeamInfo->is_mu_sounding = FALSE; -+ pBeamInfo->FirstMUBFeeIndex = 0xFF; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pBeamInfo->SourceAdapter = pDM_Odm->Adapter; -+#endif -+ halComTxbf_beamformInit(pDM_Odm); -+} -+ -+ -+VOID -+Beamforming_Enter( -+ IN PVOID pDM_VOID, -+ IN u2Byte staIdx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte BFerBFeeIdx = 0xff; -+ -+ if (Beamforming_InitEntry(pDM_Odm, staIdx, &BFerBFeeIdx)) -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_ENTER, (pu1Byte)&BFerBFeeIdx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End!\n", __func__)); -+} -+ -+ -+VOID -+Beamforming_Leave( -+ IN PVOID pDM_VOID, -+ pu1Byte RA -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (RA == NULL) -+ Beamforming_Reset(pDM_Odm); -+ else -+ Beamforming_DeInitEntry(pDM_Odm, RA); -+ -+ phydm_Beamforming_Notify(pDM_Odm); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End!!\n", __func__)); -+} -+ -+#if 0 -+//Nobody calls this function -+VOID -+phydm_Beamforming_SetTxBFen( -+ IN PVOID pDM_VOID, -+ u1Byte MacId, -+ BOOLEAN bTxBF -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx = 0; -+ PRT_BEAMFORMEE_ENTRY pEntry; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ pEntry = phydm_Beamforming_GetEntryByMacId(pDM_Odm, MacId, &Idx); -+ -+ if(pEntry == NULL) -+ return; -+ else -+ pEntry->bTxBF = bTxBF; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s MacId %d TxBF %d\n", __func__, pEntry->MacId, pEntry->bTxBF)); -+ -+ phydm_Beamforming_Notify(pDM_Odm); -+} -+#endif -+ -+BEAMFORMING_CAP -+phydm_Beamforming_GetBeamCap( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORMING_INFO pBeamInfo -+ ) -+{ -+ u1Byte i; -+ BOOLEAN bSelfBeamformer = FALSE; -+ BOOLEAN bSelfBeamformee = FALSE; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ BeamformeeEntry = pBeamInfo->BeamformeeEntry[i]; -+ -+ if (BeamformeeEntry.bUsed) { -+ bSelfBeamformer = TRUE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BFee entry %d bUsed=TRUE\n", __func__, i)); -+ break; -+ } -+ } -+ -+ for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { -+ BeamformerEntry = pBeamInfo->BeamformerEntry[i]; -+ -+ if (BeamformerEntry.bUsed) { -+ bSelfBeamformee = TRUE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: BFer entry %d bUsed=TRUE\n", __func__, i)); -+ break; -+ } -+ } -+ -+ if (bSelfBeamformer) -+ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMER_CAP); -+ if (bSelfBeamformee) -+ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMEE_CAP); -+ -+ return BeamformCap; -+} -+ -+ -+BOOLEAN -+BeamformingControl_V1( -+ IN PVOID pDM_VOID, -+ pu1Byte RA, -+ u1Byte AID, -+ u1Byte Mode, -+ CHANNEL_WIDTH BW, -+ u1Byte Rate -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ BOOLEAN ret = TRUE; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("AID (%d), Mode (%d), BW (%d)\n", AID, Mode, BW)); -+ -+ switch (Mode) { -+ case 0: -+ ret = BeamformingStart_V1(pDM_Odm, RA, 0, BW, Rate); -+ break; -+ case 1: -+ ret = BeamformingStart_V1(pDM_Odm, RA, 1, BW, Rate); -+ break; -+ case 2: -+ phydm_Beamforming_NDPARate(pDM_Odm, BW, Rate); -+ ret = Beamforming_SendVHTNDPAPacket(pDM_Odm, RA, AID, BW, NORMAL_QUEUE); -+ break; -+ case 3: -+ phydm_Beamforming_NDPARate(pDM_Odm, BW, Rate); -+ ret = Beamforming_SendHTNDPAPacket(pDM_Odm, RA, BW, NORMAL_QUEUE); -+ break; -+ } -+ return ret; -+} -+ -+/*Only OID uses this function*/ -+BOOLEAN -+phydm_BeamformingControl_V2( -+ IN PVOID pDM_VOID, -+ u1Byte Idx, -+ u1Byte Mode, -+ CHANNEL_WIDTH BW, -+ u2Byte Period -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMING_OID_INFO pBeamOidInfo = &(pBeamInfo->BeamformingOidInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Idx (%d), Mode (%d), BW (%d), Period (%d)\n", Idx, Mode, BW, Period)); -+ -+ pBeamOidInfo->SoundOidIdx = Idx; -+ pBeamOidInfo->SoundOidMode = (SOUNDING_MODE) Mode; -+ pBeamOidInfo->SoundOidBW = BW; -+ pBeamOidInfo->SoundOidPeriod = Period; -+ -+ phydm_Beamforming_Notify(pDM_Odm); -+ -+ return TRUE; -+} -+ -+ -+VOID -+phydm_Beamforming_Watchdog( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("%s Start!\n", __func__)); -+ -+ if (pBeamInfo->beamformee_su_cnt == 0) -+ return; -+ -+ Beamforming_DymPeriod(pDM_Odm,0); -+ phydm_Beamforming_DymNDPARate(pDM_Odm); -+ -+} -+ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_beamforming.h linux/3rdparty/rtl8812au/hal/phydm/phydm_beamforming.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_beamforming.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_beamforming.h 2017-06-07 23:07:21.017688123 +0300 -@@ -0,0 +1,365 @@ -+#ifndef __INC_BEAMFORMING_H -+#define __INC_BEAMFORMING_H -+ -+#ifndef BEAMFORMING_SUPPORT -+#define BEAMFORMING_SUPPORT 0 -+#endif -+ -+/*Beamforming Related*/ -+#include "txbf/halcomtxbf.h" -+#include "txbf/haltxbfjaguar.h" -+#include "txbf/haltxbf8192e.h" -+#include "txbf/haltxbf8814a.h" -+#include "txbf/haltxbf8821b.h" -+#include "txbf/haltxbf8822b.h" -+#include "txbf/haltxbfinterface.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+ -+#define MAX_BEAMFORMEE_SU 2 -+#define MAX_BEAMFORMER_SU 2 -+#if (RTL8822B_SUPPORT == 1) -+#define MAX_BEAMFORMEE_MU 6 -+#define MAX_BEAMFORMER_MU 1 -+#else -+#define MAX_BEAMFORMEE_MU 0 -+#define MAX_BEAMFORMER_MU 0 -+#endif -+ -+#define BEAMFORMEE_ENTRY_NUM (MAX_BEAMFORMEE_SU + MAX_BEAMFORMEE_MU) -+#define BEAMFORMER_ENTRY_NUM (MAX_BEAMFORMER_SU + MAX_BEAMFORMER_MU) -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+/*for different naming between WIN and CE*/ -+#define BEACON_QUEUE BCN_QUEUE_INX -+#define NORMAL_QUEUE MGT_QUEUE_INX -+#define RT_DISABLE_FUNC RTW_DISABLE_FUNC -+#define RT_ENABLE_FUNC RTW_ENABLE_FUNC -+#endif -+ -+typedef enum _BEAMFORMING_ENTRY_STATE { -+ BEAMFORMING_ENTRY_STATE_UNINITIALIZE, -+ BEAMFORMING_ENTRY_STATE_INITIALIZEING, -+ BEAMFORMING_ENTRY_STATE_INITIALIZED, -+ BEAMFORMING_ENTRY_STATE_PROGRESSING, -+ BEAMFORMING_ENTRY_STATE_PROGRESSED -+} BEAMFORMING_ENTRY_STATE, *PBEAMFORMING_ENTRY_STATE; -+ -+ -+typedef enum _BEAMFORMING_NOTIFY_STATE { -+ BEAMFORMING_NOTIFY_NONE, -+ BEAMFORMING_NOTIFY_ADD, -+ BEAMFORMING_NOTIFY_DELETE, -+ BEAMFORMEE_NOTIFY_ADD_SU, -+ BEAMFORMEE_NOTIFY_DELETE_SU, -+ BEAMFORMEE_NOTIFY_ADD_MU, -+ BEAMFORMEE_NOTIFY_DELETE_MU, -+ BEAMFORMING_NOTIFY_RESET -+} BEAMFORMING_NOTIFY_STATE, *PBEAMFORMING_NOTIFY_STATE; -+ -+typedef enum _BEAMFORMING_CAP { -+ BEAMFORMING_CAP_NONE = 0x0, -+ BEAMFORMER_CAP_HT_EXPLICIT = BIT1, -+ BEAMFORMEE_CAP_HT_EXPLICIT = BIT2, -+ BEAMFORMER_CAP_VHT_SU = BIT5, /* Self has er Cap, because Reg er & peer ee */ -+ BEAMFORMEE_CAP_VHT_SU = BIT6, /* Self has ee Cap, because Reg ee & peer er */ -+ BEAMFORMER_CAP_VHT_MU = BIT7, /* Self has er Cap, because Reg er & peer ee */ -+ BEAMFORMEE_CAP_VHT_MU = BIT8, /* Self has ee Cap, because Reg ee & peer er */ -+ BEAMFORMER_CAP = BIT9, -+ BEAMFORMEE_CAP = BIT10, -+}BEAMFORMING_CAP, *PBEAMFORMING_CAP; -+ -+ -+typedef enum _SOUNDING_MODE { -+ SOUNDING_SW_VHT_TIMER = 0x0, -+ SOUNDING_SW_HT_TIMER = 0x1, -+ SOUNDING_STOP_All_TIMER = 0x2, -+ SOUNDING_HW_VHT_TIMER = 0x3, -+ SOUNDING_HW_HT_TIMER = 0x4, -+ SOUNDING_STOP_OID_TIMER = 0x5, -+ SOUNDING_AUTO_VHT_TIMER = 0x6, -+ SOUNDING_AUTO_HT_TIMER = 0x7, -+ SOUNDING_FW_VHT_TIMER = 0x8, -+ SOUNDING_FW_HT_TIMER = 0x9, -+}SOUNDING_MODE, *PSOUNDING_MODE; -+ -+typedef struct _RT_BEAMFORM_STAINFO { -+ pu1Byte RA; -+ u2Byte AID; -+ u2Byte MacID; -+ u1Byte MyMacAddr[6]; -+ WIRELESS_MODE WirelessMode; -+ CHANNEL_WIDTH BW; -+ BEAMFORMING_CAP BeamformCap; -+ u1Byte HtBeamformCap; -+ u2Byte VhtBeamformCap; -+ u1Byte CurBeamform; -+ u2Byte CurBeamformVHT; -+} RT_BEAMFORM_STAINFO, *PRT_BEAMFORM_STAINFO; -+ -+ -+typedef struct _RT_BEAMFORMEE_ENTRY { -+ BOOLEAN bUsed; -+ BOOLEAN bTxBF; -+ BOOLEAN bSound; -+ u2Byte AID; /*Used to construct AID field of NDPA packet.*/ -+ u2Byte MacId; /*Used to Set Reg42C in IBSS mode. */ -+ u2Byte P_AID; /*Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ -+ u2Byte G_ID; /*Used to fill Tx DESC*/ -+ u1Byte MyMacAddr[6]; -+ u1Byte MacAddr[6]; /*Used to fill Reg6E4 to fill Mac address of CSI report frame.*/ -+ CHANNEL_WIDTH SoundBW; /*Sounding BandWidth*/ -+ u2Byte SoundPeriod; -+ BEAMFORMING_CAP BeamformEntryCap; -+ BEAMFORMING_ENTRY_STATE BeamformEntryState; -+ BOOLEAN bBeamformingInProgress; -+ /*u1Byte LogSeq; // Move to _RT_BEAMFORMER_ENTRY*/ -+ /*u2Byte LogRetryCnt:3; // 0~4 // Move to _RT_BEAMFORMER_ENTRY*/ -+ /*u2Byte LogSuccessCnt:2; // 0~2 // Move to _RT_BEAMFORMER_ENTRY*/ -+ u2Byte LogStatusFailCnt:5; // 0~21 -+ u2Byte DefaultCSICnt:5; // 0~21 -+ u1Byte CSIMatrix[327]; -+ u2Byte CSIMatrixLen; -+ u1Byte NumofSoundingDim; -+ u1Byte CompSteeringNumofBFer; -+ u1Byte su_reg_index; -+ /*For MU-MIMO*/ -+ BOOLEAN is_mu_sta; -+ u1Byte mu_reg_index; -+ u1Byte gid_valid[8]; -+ u1Byte user_position[16]; -+} RT_BEAMFORMEE_ENTRY, *PRT_BEAMFORMEE_ENTRY; -+ -+typedef struct _RT_BEAMFORMER_ENTRY { -+ BOOLEAN bUsed; -+ /*P_AID of BFer entry is probably not used*/ -+ u2Byte P_AID; /*Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ -+ u2Byte G_ID; -+ u1Byte MyMacAddr[6]; -+ u1Byte MacAddr[6]; -+ BEAMFORMING_CAP BeamformEntryCap; -+ u1Byte NumofSoundingDim; -+ u1Byte ClockResetTimes; /*Modified by Jeffery @2015-04-10*/ -+ u1Byte PreLogSeq; /*Modified by Jeffery @2015-03-30*/ -+ u1Byte LogSeq; /*Modified by Jeffery @2014-10-29*/ -+ u2Byte LogRetryCnt:3; /*Modified by Jeffery @2014-10-29*/ -+ u2Byte LogSuccess:2; /*Modified by Jeffery @2014-10-29*/ -+ u1Byte su_reg_index; -+ /*For MU-MIMO*/ -+ BOOLEAN is_mu_ap; -+ u1Byte gid_valid[8]; -+ u1Byte user_position[16]; -+ u2Byte AID; -+} RT_BEAMFORMER_ENTRY, *PRT_BEAMFORMER_ENTRY; -+ -+typedef struct _RT_SOUNDING_INFO { -+ u1Byte SoundIdx; -+ CHANNEL_WIDTH SoundBW; -+ SOUNDING_MODE SoundMode; -+ u2Byte SoundPeriod; -+} RT_SOUNDING_INFO, *PRT_SOUNDING_INFO; -+ -+ -+ -+typedef struct _RT_BEAMFORMING_OID_INFO { -+ u1Byte SoundOidIdx; -+ CHANNEL_WIDTH SoundOidBW; -+ SOUNDING_MODE SoundOidMode; -+ u2Byte SoundOidPeriod; -+} RT_BEAMFORMING_OID_INFO, *PRT_BEAMFORMING_OID_INFO; -+ -+ -+typedef struct _RT_BEAMFORMING_INFO { -+ BEAMFORMING_CAP BeamformCap; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry[BEAMFORMEE_ENTRY_NUM]; -+ RT_BEAMFORMER_ENTRY BeamformerEntry[BEAMFORMER_ENTRY_NUM]; -+ RT_BEAMFORM_STAINFO BeamformSTAinfo; -+ u1Byte BeamformeeCurIdx; -+ RT_TIMER BeamformingTimer; -+ RT_TIMER mu_timer; -+ RT_SOUNDING_INFO SoundingInfo; -+ RT_BEAMFORMING_OID_INFO BeamformingOidInfo; -+ HAL_TXBF_INFO TxbfInfo; -+ u1Byte SoundingSequence; -+ u1Byte beamformee_su_cnt; -+ u1Byte beamformer_su_cnt; -+ u4Byte beamformee_su_reg_maping; -+ u4Byte beamformer_su_reg_maping; -+ /*For MU-MINO*/ -+ u1Byte beamformee_mu_cnt; -+ u1Byte beamformer_mu_cnt; -+ u4Byte beamformee_mu_reg_maping; -+ u1Byte mu_ap_index; -+ BOOLEAN is_mu_sounding; -+ u1Byte FirstMUBFeeIndex; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER SourceAdapter; -+#endif -+ /* Control register */ -+ u4Byte RegMUTxCtrl; /* For USB/SDIO interfaces aync I/O */ -+} RT_BEAMFORMING_INFO, *PRT_BEAMFORMING_INFO; -+ -+ -+typedef struct _RT_NDPA_STA_INFO { -+ u2Byte AID:12; -+ u2Byte FeedbackType:1; -+ u2Byte NcIndex:3; -+} RT_NDPA_STA_INFO, *PRT_NDPA_STA_INFO; -+ -+ -+BEAMFORMING_CAP -+phydm_Beamforming_GetEntryBeamCapByMacId( -+ IN PVOID pDM_VOID, -+ IN u1Byte MacId -+ ); -+ -+PRT_BEAMFORMEE_ENTRY -+phydm_Beamforming_GetBFeeEntryByAddr( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ OUT pu1Byte Idx -+ ); -+ -+PRT_BEAMFORMER_ENTRY -+phydm_Beamforming_GetBFerEntryByAddr( -+ IN PVOID pDM_VOID, -+ IN pu1Byte TA, -+ OUT pu1Byte Idx -+ ); -+ -+u1Byte -+Beamforming_GetHTNDPTxRate( -+ IN PVOID pDM_VOID, -+ u1Byte CompSteeringNumofBFer -+); -+ -+u1Byte -+Beamforming_GetVHTNDPTxRate( -+ IN PVOID pDM_VOID, -+ u1Byte CompSteeringNumofBFer -+); -+ -+VOID -+phydm_Beamforming_Notify( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+VOID -+Beamforming_Enter( -+ IN PVOID pDM_VOID, -+ IN u2Byte staIdx -+ ); -+ -+VOID -+Beamforming_Leave( -+ IN PVOID pDM_VOID, -+ pu1Byte RA -+ ); -+ -+BOOLEAN -+BeamformingStart_FW( -+ IN PVOID pDM_VOID, -+ u1Byte Idx -+ ); -+ -+VOID -+Beamforming_CheckSoundingSuccess( -+ IN PVOID pDM_VOID, -+ BOOLEAN Status -+); -+ -+VOID -+phydm_Beamforming_End_SW( -+ IN PVOID pDM_VOID, -+ BOOLEAN Status -+ ); -+ -+VOID -+Beamforming_TimerCallback( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+phydm_Beamforming_Init( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+ -+BEAMFORMING_CAP -+phydm_Beamforming_GetBeamCap( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORMING_INFO pBeamInfo -+ ); -+ -+ -+BOOLEAN -+BeamformingControl_V1( -+ IN PVOID pDM_VOID, -+ pu1Byte RA, -+ u1Byte AID, -+ u1Byte Mode, -+ CHANNEL_WIDTH BW, -+ u1Byte Rate -+ ); -+ -+ -+BOOLEAN -+phydm_BeamformingControl_V2( -+ IN PVOID pDM_VOID, -+ u1Byte Idx, -+ u1Byte Mode, -+ CHANNEL_WIDTH BW, -+ u2Byte Period -+ ); -+ -+VOID -+phydm_Beamforming_Watchdog( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+Beamforming_SWTimerCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PRT_TIMER pTimer -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ void *FunctionContext -+#endif -+ ); -+ -+BOOLEAN -+Beamforming_SendHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW, -+ IN u1Byte QIdx -+ ); -+ -+ -+BOOLEAN -+Beamforming_SendVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW, -+ IN u1Byte QIdx -+ ); -+ -+#else -+#define Beamforming_GidPAid(Adapter, pTcb) -+#define Beamforming_Enter(pDM_Odm, staIdx) -+#define Beamforming_Leave(pDM_Odm, RA) -+#define Beamforming_End_FW(pDMOdm) -+#define BeamformingControl_V1(pDM_Odm, RA, AID, Mode, BW, Rate) TRUE -+#define BeamformingControl_V2(pDM_Odm, Idx, Mode, BW, Period) TRUE -+#define phydm_Beamforming_End_SW(pDM_Odm, _Status) -+#define Beamforming_TimerCallback(pDM_Odm) -+#define phydm_Beamforming_Init(pDM_Odm) -+#define phydm_BeamformingControl_V2(pDM_Odm, _Idx, _Mode, _BW, _Period) FALSE -+#define Beamforming_Watchdog(pDM_Odm) -+#define phydm_Beamforming_Watchdog(pDM_Odm) -+ -+ -+#endif -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm.c linux/3rdparty/rtl8812au/hal/phydm/phydm.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm.c 2017-06-07 23:07:21.015687940 +0300 -@@ -0,0 +1,2241 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+const u2Byte dB_Invert_Table[12][8] = { -+ { 1, 1, 1, 2, 2, 2, 2, 3}, -+ { 3, 3, 4, 4, 4, 5, 6, 6}, -+ { 7, 8, 9, 10, 11, 13, 14, 16}, -+ { 18, 20, 22, 25, 28, 32, 35, 40}, -+ { 45, 50, 56, 63, 71, 79, 89, 100}, -+ { 112, 126, 141, 158, 178, 200, 224, 251}, -+ { 282, 316, 355, 398, 447, 501, 562, 631}, -+ { 708, 794, 891, 1000, 1122, 1259, 1413, 1585}, -+ { 1778, 1995, 2239, 2512, 2818, 3162, 3548, 3981}, -+ { 4467, 5012, 5623, 6310, 7079, 7943, 8913, 10000}, -+ { 11220, 12589, 14125, 15849, 17783, 19953, 22387, 25119}, -+ { 28184, 31623, 35481, 39811, 44668, 50119, 56234, 65535} -+}; -+ -+ -+//============================================================ -+// Local Function predefine. -+//============================================================ -+ -+/* START------------COMMON INFO RELATED--------------- */ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+ODM_UpdateInitRateWorkItemCallback( -+ IN PVOID pContext -+ ); -+#endif -+ -+VOID -+odm_GlobalAdapterCheck( -+ IN VOID -+ ); -+ -+//move to odm_PowerTacking.h by YuChen -+ -+ -+ -+VOID -+odm_UpdatePowerTrainingState( -+ IN PDM_ODM_T pDM_Odm -+); -+ -+//============================================================ -+//3 Export Interface -+//============================================================ -+ -+/*Y = 10*log(X)*/ -+s4Byte -+ODM_PWdB_Conversion( -+ IN s4Byte X, -+ IN u4Byte TotalBit, -+ IN u4Byte DecimalBit -+ ) -+{ -+ s4Byte Y, integer = 0, decimal = 0; -+ u4Byte i; -+ -+ if(X == 0) -+ X = 1; // log2(x), x can't be 0 -+ -+ for(i = (TotalBit-1); i > 0; i--) -+ { -+ if(X & BIT(i)) -+ { -+ integer = i; -+ if(i > 0) -+ decimal = (X & BIT(i-1))?2:0; //decimal is 0.5dB*3=1.5dB~=2dB -+ break; -+ } -+ } -+ -+ Y = 3*(integer-DecimalBit)+decimal; //10*log(x)=3*log2(x), -+ -+ return Y; -+} -+ -+s4Byte -+ODM_SignConversion( -+ IN s4Byte value, -+ IN u4Byte TotalBit -+ ) -+{ -+ if(value&BIT(TotalBit-1)) -+ value -= BIT(TotalBit); -+ return value; -+} -+ -+VOID -+ODM_InitMpDriverStatus( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ // Decide when compile time -+ #if(MP_DRIVER == 1) -+ pDM_Odm->mp_mode = TRUE; -+ #else -+ pDM_Odm->mp_mode = FALSE; -+ #endif -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ // Update information every period -+ pDM_Odm->mp_mode = (BOOLEAN)Adapter->registrypriv.mp_mode; -+ -+#else -+ -+ // MP mode is always false at AP side -+ pDM_Odm->mp_mode = FALSE; -+ -+#endif -+} -+ -+VOID -+ODM_UpdateMpDriverStatus( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ // Do nothing. -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ // Update information erery period -+ pDM_Odm->mp_mode = (BOOLEAN)Adapter->registrypriv.mp_mode; -+ -+#else -+ -+ // Do nothing. -+ -+#endif -+} -+ -+VOID -+PHYDM_InitTRXAntennaSetting( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if (RTL8814A_SUPPORT == 1) -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8814A)) { -+ u1Byte RxAnt = 0, TxAnt = 0; -+ -+ RxAnt = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG(BB_RX_PATH, pDM_Odm), ODM_BIT(BB_RX_PATH, pDM_Odm)); -+ TxAnt = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG(BB_TX_PATH, pDM_Odm), ODM_BIT(BB_TX_PATH, pDM_Odm)); -+ pDM_Odm->TXAntStatus = (TxAnt & 0xf); -+ pDM_Odm->RXAntStatus = (RxAnt & 0xf); -+ } -+#endif -+} -+ -+VOID -+phydm_Init_cck_setting( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte value_824,value_82c; -+ -+ pDM_Odm->bCckHighPower = (BOOLEAN) ODM_GetBBReg(pDM_Odm, ODM_REG(CCK_RPT_FORMAT,pDM_Odm), ODM_BIT(CCK_RPT_FORMAT,pDM_Odm)); -+ -+ #if (RTL8192E_SUPPORT == 1) -+ if(pDM_Odm->SupportICType & (ODM_RTL8192E)) -+ { -+ /* 0x824[9] = 0x82C[9] = 0xA80[7] these regiaters settinh should be equal or CCK RSSI report may inaccurate */ -+ value_824 = ODM_GetBBReg(pDM_Odm, 0x824, BIT9); -+ value_82c = ODM_GetBBReg(pDM_Odm, 0x82c, BIT9); -+ -+ if(value_824 != value_82c) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c , BIT9, value_824); -+ } -+ ODM_SetBBReg(pDM_Odm, 0xa80 , BIT7, value_824); -+ pDM_Odm->cck_agc_report_type = (BOOLEAN)value_824; -+ } -+ #endif -+ -+ #if (RTL8703B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & (ODM_RTL8703B)) { -+ -+ pDM_Odm->cck_agc_report_type = ODM_GetBBReg(pDM_Odm, 0x950, BIT11) ? 1 : 0; /*1: 4bit LNA , 0: 3bit LNA */ -+ -+ if (pDM_Odm->cck_agc_report_type != 1) { -+ DbgPrint("[Warning] 8703B CCK should be 4bit LNA, ie. 0x950[11] = 1\n"); -+ /**/ -+ } -+ } -+ #endif -+ -+} -+ -+ -+VOID -+phydm_print_parameter_package_ver( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte commit_ver = 0; -+ u4Byte date = 0; -+ char *commit_by = NULL; -+ u4Byte release_ver = 0; -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8192C) { -+ /**/ -+ /**/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8192D) { -+ /**/ -+ /**/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8723A) { -+ /**/ -+ /**/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+ /**/ -+ /**/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { -+ /**/ -+ /**/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8812) { -+ /**/ -+ /**/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8821) { -+ /**/ -+ /**/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8814A) { -+ /**/ -+ /**/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8703B) { -+ #if (RTL8703B_SUPPORT == 1) -+ commit_ver = SVN_COMMIT_VERSION_8703B; -+ date = RELEASE_DATE_8703B; -+ commit_by = COMMIT_BY_8703B; -+ release_ver = RELEASE_VERSION_8703B; -+ #endif -+ } else if (pDM_Odm->SupportICType == ODM_RTL8822B) { -+ /**/ -+ /**/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ /**/ -+ /**/ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("[Parameter Package Information] Commit_Ver: (( %d )), Date: ((%d)), Commit_By: ((%s)), Release_Ver: ((%d))\n", commit_ver, date, commit_by, release_ver)); -+ /*DbgPrint("[Parameter Package Information] Commit_Ver: (( %d )), Date: ((%d)), Commit_By: ((%s)), Release_Ver: ((%d))\n", commit_ver, date, commit_by, release_ver);*/ -+ -+} -+ -+u1Byte DummyHubUsbMode = 1;/* USB 2.0 */ -+void phydm_hook_dummy_member( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ if (pDM_Odm->HubUsbMode == NULL) -+ pDM_Odm->HubUsbMode = &DummyHubUsbMode; -+} -+ -+ -+VOID -+odm_CommonInfoSelfInit( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ phydm_print_parameter_package_ver(pDM_Odm); -+ phydm_Init_cck_setting(pDM_Odm); -+ pDM_Odm->RFPathRxEnable = (u1Byte) ODM_GetBBReg(pDM_Odm, ODM_REG(BB_RX_PATH,pDM_Odm), ODM_BIT(BB_RX_PATH,pDM_Odm)); -+#if (DM_ODM_SUPPORT_TYPE != ODM_CE) -+ pDM_Odm->pbNet_closed = &pDM_Odm->BOOLEAN_temp; -+#endif -+ -+ PHYDM_InitDebugSetting(pDM_Odm); -+ ODM_InitMpDriverStatus(pDM_Odm); -+ PHYDM_InitTRXAntennaSetting(pDM_Odm); -+ -+ pDM_Odm->TxRate = 0xFF; -+ -+ pDM_Odm->number_linked_client = 0; -+ pDM_Odm->pre_number_linked_client = 0; -+ pDM_Odm->number_active_client = 0; -+ pDM_Odm->pre_number_active_client = 0; -+ phydm_hook_dummy_member(pDM_Odm); -+ -+} -+ -+VOID -+odm_CommonInfoSelfUpdate( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u1Byte EntryCnt = 0, num_active_client = 0; -+ u4Byte i, OneEntry_MACID = 0, ma_rx_tp = 0; -+ PSTA_INFO_T pEntry; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ -+ pEntry = pDM_Odm->pODM_StaInfo[0]; -+ if(pMgntInfo->mAssoc) -+ { -+ pEntry->bUsed=TRUE; -+ for (i=0; i<6; i++) -+ pEntry->MacAddr[i] = pMgntInfo->Bssid[i]; -+ } -+ else -+ { -+ pEntry->bUsed=FALSE; -+ for (i=0; i<6; i++) -+ pEntry->MacAddr[i] = 0; -+ } -+ -+ //STA mode is linked to AP -+ if(IS_STA_VALID(pDM_Odm->pODM_StaInfo[0]) && !ACTING_AS_AP(Adapter)) -+ pDM_Odm->bsta_state = TRUE; -+ else -+ pDM_Odm->bsta_state = FALSE; -+#endif -+ -+/* THis variable cannot be used because it is wrong*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ { -+ if (*(pDM_Odm->pSecChOffset) == 1) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) + 2; -+ else if (*(pDM_Odm->pSecChOffset) == 2) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) - 2; -+ } else if (*(pDM_Odm->pBandWidth) == ODM_BW80M) { -+ if (*(pDM_Odm->pSecChOffset) == 1) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) + 6; -+ else if (*(pDM_Odm->pSecChOffset) == 2) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) - 6; -+ } else -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel); -+#else -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) { -+ if (*(pDM_Odm->pSecChOffset) == 1) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) - 2; -+ else if (*(pDM_Odm->pSecChOffset) == 2) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) + 2; -+ } else -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel); -+#endif -+ -+ for (i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pEntry)) -+ { -+ EntryCnt++; -+ if(EntryCnt==1) -+ { -+ OneEntry_MACID=i; -+ } -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ ma_rx_tp = (pEntry->rx_byte_cnt_LowMAW)<<3; /* low moving average RX TP ( bit /sec)*/ -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("ClientTP[%d]: ((%d )) bit/sec\n", i, ma_rx_tp)); -+ -+ if (ma_rx_tp > ACTIVE_TP_THRESHOLD) -+ num_active_client++; -+ #endif -+ } -+ } -+ -+ if(EntryCnt == 1) -+ { -+ pDM_Odm->bOneEntryOnly = TRUE; -+ pDM_Odm->OneEntry_MACID=OneEntry_MACID; -+ } -+ else -+ pDM_Odm->bOneEntryOnly = FALSE; -+ -+ pDM_Odm->pre_number_linked_client = pDM_Odm->number_linked_client; -+ pDM_Odm->pre_number_active_client = pDM_Odm->number_active_client; -+ -+ pDM_Odm->number_linked_client = EntryCnt; -+ pDM_Odm->number_active_client = num_active_client; -+ -+ /* Update MP driver status*/ -+ ODM_UpdateMpDriverStatus(pDM_Odm); -+} -+ -+VOID -+odm_CommonInfoSelfReset( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt = 0; -+#endif -+} -+ -+PVOID -+PhyDM_Get_Structure( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte Structure_Type -+) -+ -+{ -+ PVOID pStruct = NULL; -+#if RTL8195A_SUPPORT -+ switch (Structure_Type){ -+ case PHYDM_FALSEALMCNT: -+ pStruct = &FalseAlmCnt; -+ break; -+ -+ case PHYDM_CFOTRACK: -+ pStruct = &DM_CfoTrack; -+ break; -+ -+ case PHYDM_ADAPTIVITY: -+ pStruct = &(pDM_Odm->Adaptivity); -+ break; -+ -+ default: -+ break; -+ } -+ -+#else -+ switch (Structure_Type){ -+ case PHYDM_FALSEALMCNT: -+ pStruct = &(pDM_Odm->FalseAlmCnt); -+ break; -+ -+ case PHYDM_CFOTRACK: -+ pStruct = &(pDM_Odm->DM_CfoTrack); -+ break; -+ -+ case PHYDM_ADAPTIVITY: -+ pStruct = &(pDM_Odm->Adaptivity); -+ break; -+ -+ default: -+ break; -+ } -+ -+#endif -+ return pStruct; -+} -+ -+VOID -+odm_HWSetting( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (RTL8821A_SUPPORT == 1) -+ if(pDM_Odm->SupportICType & ODM_RTL8821) -+ odm_HWSetting_8821A(pDM_Odm); -+#endif -+ -+} -+ -+// -+// 2011/09/21 MH Add to describe different team necessary resource allocate?? -+// -+VOID -+ODM_DMInit( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ odm_CommonInfoSelfInit(pDM_Odm); -+ odm_DIGInit(pDM_Odm); -+ Phydm_NHMCounterStatisticsInit(pDM_Odm); -+ Phydm_AdaptivityInit(pDM_Odm); -+ phydm_ra_info_init(pDM_Odm); -+ odm_RateAdaptiveMaskInit(pDM_Odm); -+ odm_RA_ParaAdjust_init(pDM_Odm); -+ ODM_CfoTrackingInit(pDM_Odm); -+ ODM_EdcaTurboInit(pDM_Odm); -+ odm_RSSIMonitorInit(pDM_Odm); -+ phydm_rf_init(pDM_Odm); -+ odm_TXPowerTrackingInit(pDM_Odm); -+ odm_AntennaDiversityInit(pDM_Odm); -+ odm_AutoChannelSelectInit(pDM_Odm); -+ odm_PathDiversityInit(pDM_Odm); -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ phydm_Beamforming_Init(pDM_Odm); -+#endif -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ odm_DynamicBBPowerSavingInit(pDM_Odm); -+ odm_DynamicTxPowerInit(pDM_Odm); -+ -+#if (RTL8188E_SUPPORT == 1) -+ if(pDM_Odm->SupportICType==ODM_RTL8188E) -+ { -+ odm_PrimaryCCA_Init(pDM_Odm); -+ ODM_RAInfo_Init_all(pDM_Odm); -+ } -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ -+ #if (RTL8723B_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ odm_SwAntDetectInit(pDM_Odm); -+ #endif -+ -+ #if (RTL8192E_SUPPORT == 1) -+ if(pDM_Odm->SupportICType==ODM_RTL8192E) -+ odm_PrimaryCCA_Check_Init(pDM_Odm); -+ #endif -+ -+#endif -+ -+ } -+ -+} -+ -+VOID -+ODM_DMReset( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ ODM_AntDivReset(pDM_Odm); -+ phydm_setEDCCAThresholdAPI(pDM_Odm, pDM_DigTable->CurIGValue); -+} -+ -+ -+VOID -+phydm_support_ablity_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte pre_support_ability; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ pre_support_ability = pDM_Odm->SupportAbility ; -+ PHYDM_SNPRINTF((output+used, out_len-used,"\n%s\n", "================================")); -+ if(dm_value[0] == 100) -+ { -+ PHYDM_SNPRINTF((output+used, out_len-used, "[Supportablity] PhyDM Selection\n")); -+ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "================================")); -+ PHYDM_SNPRINTF((output+used, out_len-used, "00. (( %s ))DIG \n", ((pDM_Odm->SupportAbility & ODM_BB_DIG)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "01. (( %s ))RA_MASK \n", ((pDM_Odm->SupportAbility & ODM_BB_RA_MASK)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "02. (( %s ))DYNAMIC_TXPWR \n", ((pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "03. (( %s ))FA_CNT \n", ((pDM_Odm->SupportAbility & ODM_BB_FA_CNT)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "04. (( %s ))RSSI_MONITOR \n", ((pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "05. (( %s ))CCK_PD \n", ((pDM_Odm->SupportAbility & ODM_BB_CCK_PD)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "06. (( %s ))ANT_DIV \n", ((pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "07. (( %s ))PWR_SAVE \n", ((pDM_Odm->SupportAbility & ODM_BB_PWR_SAVE)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "08. (( %s ))PWR_TRAIN \n", ((pDM_Odm->SupportAbility & ODM_BB_PWR_TRAIN)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "09. (( %s ))RATE_ADAPTIVE \n", ((pDM_Odm->SupportAbility & ODM_BB_RATE_ADAPTIVE)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "10. (( %s ))PATH_DIV \n", ((pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "11. (( %s ))PSD \n", ((pDM_Odm->SupportAbility & ODM_BB_PSD)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "12. (( %s ))RXHP \n", ((pDM_Odm->SupportAbility & ODM_BB_RXHP)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "13. (( %s ))ADAPTIVITY \n", ((pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "14. (( %s ))CFO_TRACKING \n", ((pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "15. (( %s ))NHM_CNT \n", ((pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "16. (( %s ))PRIMARY_CCA \n", ((pDM_Odm->SupportAbility & ODM_BB_PRIMARY_CCA)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "20. (( %s ))EDCA_TURBO \n", ((pDM_Odm->SupportAbility & ODM_MAC_EDCA_TURBO)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "21. (( %s ))EARLY_MODE \n", ((pDM_Odm->SupportAbility & ODM_MAC_EARLY_MODE)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "24. (( %s ))TX_PWR_TRACK \n", ((pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "25. (( %s ))RX_GAIN_TRACK \n", ((pDM_Odm->SupportAbility & ODM_RF_RX_GAIN_TRACK)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used, "26. (( %s ))RF_CALIBRATION \n", ((pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)?("V"):(".")) )); -+ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "================================")); -+ } -+ /* -+ else if(dm_value[0] == 101) -+ { -+ pDM_Odm->SupportAbility = 0 ; -+ DbgPrint("Disable all SupportAbility components \n"); -+ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "Disable all SupportAbility components")); -+ } -+ */ -+ else -+ { -+ -+ if(dm_value[1] == 1) //enable -+ { -+ pDM_Odm->SupportAbility |= BIT(dm_value[0]) ; -+ if(BIT(dm_value[0]) & ODM_BB_PATH_DIV) -+ { -+ odm_PathDiversityInit(pDM_Odm); -+ } -+ } -+ else if(dm_value[1] == 2) //disable -+ { -+ pDM_Odm->SupportAbility &= ~(BIT(dm_value[0])) ; -+ } -+ else -+ { -+ //DbgPrint("\n[Warning!!!] 1:enable, 2:disable \n\n"); -+ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "[Warning!!!] 1:enable, 2:disable")); -+ } -+ } -+ PHYDM_SNPRINTF((output+used, out_len-used,"pre-SupportAbility = 0x%x\n", pre_support_ability )); -+ PHYDM_SNPRINTF((output+used, out_len-used,"Curr-SupportAbility = 0x%x\n", pDM_Odm->SupportAbility )); -+ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "================================")); -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+// -+//tmp modify for LC Only -+// -+VOID -+ODM_DMWatchdog_LPS( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ odm_CommonInfoSelfUpdate(pDM_Odm); -+ odm_FalseAlarmCounterStatistics(pDM_Odm); -+ odm_RSSIMonitorCheck(pDM_Odm); -+ odm_DIGbyRSSI_LPS(pDM_Odm); -+ odm_CCKPacketDetectionThresh(pDM_Odm); -+ odm_CommonInfoSelfReset(pDM_Odm); -+ -+ if(*(pDM_Odm->pbPowerSaving)==TRUE) -+ return; -+} -+#endif -+// -+// 2011/09/20 MH This is the entry pointer for all team to execute HW out source DM. -+// You can not add any dummy function here, be care, you can only use DM structure -+// to perform any new ODM_DM. -+// -+VOID -+ODM_DMWatchdog( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ odm_CommonInfoSelfUpdate(pDM_Odm); -+ phydm_BasicDbgMessage(pDM_Odm); -+ odm_HWSetting(pDM_Odm); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ { -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ if( (priv->auto_channel != 0) && (priv->auto_channel != 2) )//if ACS running, do not do FA/CCA counter read -+ return; -+ } -+#endif -+ odm_FalseAlarmCounterStatistics(pDM_Odm); -+ phydm_NoisyDetection(pDM_Odm); -+ -+ odm_RSSIMonitorCheck(pDM_Odm); -+ -+ if(*(pDM_Odm->pbPowerSaving) == TRUE) -+ { -+ odm_DIGbyRSSI_LPS(pDM_Odm); -+ { -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ Phydm_Adaptivity(pDM_Odm, pDM_DigTable->CurIGValue); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("DMWatchdog in power saving mode\n")); -+ return; -+ } -+ -+ Phydm_CheckAdaptivity(pDM_Odm); -+ odm_UpdatePowerTrainingState(pDM_Odm); -+ odm_DIG(pDM_Odm); -+ { -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ Phydm_Adaptivity(pDM_Odm, pDM_DigTable->CurIGValue); -+ } -+ odm_CCKPacketDetectionThresh(pDM_Odm); -+ phydm_ra_dynamic_retry_limit(pDM_Odm); -+ phydm_ra_dynamic_retry_count(pDM_Odm); -+ odm_RefreshRateAdaptiveMask(pDM_Odm); -+ odm_RefreshBasicRateMask(pDM_Odm); -+ odm_DynamicBBPowerSaving(pDM_Odm); -+ odm_EdcaTurboCheck(pDM_Odm); -+ odm_PathDiversity(pDM_Odm); -+ ODM_CfoTracking(pDM_Odm); -+ odm_DynamicTxPower(pDM_Odm); -+ odm_AntennaDiversity(pDM_Odm); -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ phydm_Beamforming_Watchdog(pDM_Odm); -+#endif -+ -+ phydm_rf_watchdog(pDM_Odm); -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ -+#if (RTL8188E_SUPPORT == 1) -+ if(pDM_Odm->SupportICType==ODM_RTL8188E) -+ odm_DynamicPrimaryCCA(pDM_Odm); -+#endif -+ -+#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ -+ #if (RTL8192E_SUPPORT == 1) -+ if(pDM_Odm->SupportICType==ODM_RTL8192E) -+ odm_DynamicPrimaryCCA_Check(pDM_Odm); -+ #endif -+#endif -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ odm_dtc(pDM_Odm); -+#endif -+ -+ odm_CommonInfoSelfReset(pDM_Odm); -+ -+} -+ -+ -+// -+// Init /.. Fixed HW value. Only init time. -+// -+VOID -+ODM_CmnInfoInit( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_CMNINFO_E CmnInfo, -+ IN u4Byte Value -+ ) -+{ -+ // -+ // This section is used for init value -+ // -+ switch (CmnInfo) -+ { -+ // -+ // Fixed ODM value. -+ // -+ case ODM_CMNINFO_ABILITY: -+ pDM_Odm->SupportAbility = (u4Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RF_TYPE: -+ pDM_Odm->RFType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_PLATFORM: -+ pDM_Odm->SupportPlatform = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_INTERFACE: -+ pDM_Odm->SupportInterface = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_MP_TEST_CHIP: -+ pDM_Odm->bIsMPChip= (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_IC_TYPE: -+ pDM_Odm->SupportICType = Value; -+ break; -+ -+ case ODM_CMNINFO_CUT_VER: -+ pDM_Odm->CutVersion = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_FAB_VER: -+ pDM_Odm->FabVersion = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RFE_TYPE: -+ pDM_Odm->RFEType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RF_ANTENNA_TYPE: -+ pDM_Odm->AntDivType= (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BOARD_TYPE: -+ pDM_Odm->BoardType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_PACKAGE_TYPE: -+ pDM_Odm->PackageType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_EXT_LNA: -+ pDM_Odm->ExtLNA = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_5G_EXT_LNA: -+ pDM_Odm->ExtLNA5G = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_EXT_PA: -+ pDM_Odm->ExtPA = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_5G_EXT_PA: -+ pDM_Odm->ExtPA5G = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_GPA: -+ pDM_Odm->TypeGPA = (u2Byte)Value; -+ break; -+ case ODM_CMNINFO_APA: -+ pDM_Odm->TypeAPA = (u2Byte)Value; -+ break; -+ case ODM_CMNINFO_GLNA: -+ pDM_Odm->TypeGLNA = (u2Byte)Value; -+ break; -+ case ODM_CMNINFO_ALNA: -+ pDM_Odm->TypeALNA = (u2Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_EXT_TRSW: -+ pDM_Odm->ExtTRSW = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_EXT_LNA_GAIN: -+ pDM_Odm->ExtLNAGain = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_PATCH_ID: -+ pDM_Odm->PatchID = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_BINHCT_TEST: -+ pDM_Odm->bInHctTest = (BOOLEAN)Value; -+ break; -+ case ODM_CMNINFO_BWIFI_TEST: -+ pDM_Odm->bWIFITest = (BOOLEAN)Value; -+ break; -+ case ODM_CMNINFO_SMART_CONCURRENT: -+ pDM_Odm->bDualMacSmartConcurrent = (BOOLEAN )Value; -+ break; -+ case ODM_CMNINFO_DOMAIN_CODE_2G: -+ pDM_Odm->odm_Regulation2_4G = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_DOMAIN_CODE_5G: -+ pDM_Odm->odm_Regulation5G = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_CONFIG_BB_RF: -+ pDM_Odm->ConfigBBRF = (BOOLEAN)Value; -+ break; -+ case ODM_CMNINFO_IQKFWOFFLOAD: -+ pDM_Odm->IQKFWOffload = (u1Byte)Value; -+ break; -+ //To remove the compiler warning, must add an empty default statement to handle the other values. -+ default: -+ //do nothing -+ break; -+ -+ } -+ -+} -+ -+ -+VOID -+ODM_CmnInfoHook( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_CMNINFO_E CmnInfo, -+ IN PVOID pValue -+ ) -+{ -+ // -+ // Hook call by reference pointer. -+ // -+ switch (CmnInfo) -+ { -+ // -+ // Dynamic call by reference pointer. -+ // -+ case ODM_CMNINFO_MAC_PHY_MODE: -+ pDM_Odm->pMacPhyMode = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_TX_UNI: -+ pDM_Odm->pNumTxBytesUnicast = (u8Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_RX_UNI: -+ pDM_Odm->pNumRxBytesUnicast = (u8Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_WM_MODE: -+ pDM_Odm->pWirelessMode = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_BAND: -+ pDM_Odm->pBandType = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_SEC_CHNL_OFFSET: -+ pDM_Odm->pSecChOffset = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_SEC_MODE: -+ pDM_Odm->pSecurity = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_BW: -+ pDM_Odm->pBandWidth = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_CHNL: -+ pDM_Odm->pChannel = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_DMSP_GET_VALUE: -+ pDM_Odm->pbGetValueFromOtherMac = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_BUDDY_ADAPTOR: -+ pDM_Odm->pBuddyAdapter = (PADAPTER *)pValue; -+ break; -+ -+ case ODM_CMNINFO_DMSP_IS_MASTER: -+ pDM_Odm->pbMasterOfDMSP = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_SCAN: -+ pDM_Odm->pbScanInProcess = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_POWER_SAVING: -+ pDM_Odm->pbPowerSaving = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_ONE_PATH_CCA: -+ pDM_Odm->pOnePathCCA = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_DRV_STOP: -+ pDM_Odm->pbDriverStopped = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_PNP_IN: -+ pDM_Odm->pbDriverIsGoingToPnpSetPowerSleep = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_INIT_ON: -+ pDM_Odm->pinit_adpt_in_progress = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_ANT_TEST: -+ pDM_Odm->pAntennaTest = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_NET_CLOSED: -+ pDM_Odm->pbNet_closed = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_FORCED_RATE: -+ pDM_Odm->pForcedDataRate = (pu2Byte)pValue; -+ break; -+ -+ case ODM_CMNINFO_FORCED_IGI_LB: -+ pDM_Odm->pu1ForcedIgiLb = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_P2P_LINK: -+ pDM_Odm->DM_DigTable.bP2PInProcess = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_IS1ANTENNA: -+ pDM_Odm->pIs1Antenna = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_RFDEFAULTPATH: -+ pDM_Odm->pRFDefaultPath= (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_FCS_MODE: -+ pDM_Odm->pIsFcsModeEnable = (BOOLEAN *)pValue; -+ break; -+ /*add by YuChen for beamforming PhyDM*/ -+ case ODM_CMNINFO_HUBUSBMODE: -+ pDM_Odm->HubUsbMode = (u1Byte *)pValue; -+ break; -+ case ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS: -+ pDM_Odm->pbFwDwRsvdPageInProgress = (BOOLEAN *)pValue; -+ break; -+ case ODM_CMNINFO_TX_TP: -+ pDM_Odm->pCurrentTxTP = (u4Byte *)pValue; -+ break; -+ case ODM_CMNINFO_RX_TP: -+ pDM_Odm->pCurrentRxTP = (u4Byte *)pValue; -+ break; -+ case ODM_CMNINFO_SOUNDING_SEQ: -+ pDM_Odm->pSoundingSeq = (u1Byte *)pValue; -+ break; -+ //case ODM_CMNINFO_RTSTA_AID: -+ // pDM_Odm->pAidMap = (u1Byte *)pValue; -+ // break; -+ -+ //case ODM_CMNINFO_BT_COEXIST: -+ // pDM_Odm->BTCoexist = (BOOLEAN *)pValue; -+ -+ //case ODM_CMNINFO_STA_STATUS: -+ //pDM_Odm->pODM_StaInfo[] = (PSTA_INFO_T)pValue; -+ //break; -+ -+ //case ODM_CMNINFO_PHY_STATUS: -+ // pDM_Odm->pPhyInfo = (ODM_PHY_INFO *)pValue; -+ // break; -+ -+ //case ODM_CMNINFO_MAC_STATUS: -+ // pDM_Odm->pMacInfo = (ODM_MAC_INFO *)pValue; -+ // break; -+ //To remove the compiler warning, must add an empty default statement to handle the other values. -+ default: -+ //do nothing -+ break; -+ -+ } -+ -+} -+ -+ -+VOID -+ODM_CmnInfoPtrArrayHook( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_CMNINFO_E CmnInfo, -+ IN u2Byte Index, -+ IN PVOID pValue -+ ) -+{ -+ // -+ // Hook call by reference pointer. -+ // -+ switch (CmnInfo) -+ { -+ // -+ // Dynamic call by reference pointer. -+ // -+ case ODM_CMNINFO_STA_STATUS: -+ pDM_Odm->pODM_StaInfo[Index] = (PSTA_INFO_T)pValue; -+ -+ if (IS_STA_VALID(pDM_Odm->pODM_StaInfo[Index])) -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pDM_Odm->platform2phydm_macid_table[((PSTA_INFO_T)pValue)->AssociatedMacId] = Index; /*AssociatedMacId are unique bttween different Adapter*/ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ pDM_Odm->platform2phydm_macid_table[((PSTA_INFO_T)pValue)->aid] = Index; -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ pDM_Odm->platform2phydm_macid_table[((PSTA_INFO_T)pValue)->mac_id] = Index; -+ #endif -+ -+ break; -+ //To remove the compiler warning, must add an empty default statement to handle the other values. -+ default: -+ //do nothing -+ break; -+ } -+ -+} -+ -+ -+// -+// Update Band/CHannel/.. The values are dynamic but non-per-packet. -+// -+VOID -+ODM_CmnInfoUpdate( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte CmnInfo, -+ IN u8Byte Value -+ ) -+{ -+ // -+ // This init variable may be changed in run time. -+ // -+ switch (CmnInfo) -+ { -+ case ODM_CMNINFO_LINK_IN_PROGRESS: -+ pDM_Odm->bLinkInProcess = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_ABILITY: -+ pDM_Odm->SupportAbility = (u4Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RF_TYPE: -+ pDM_Odm->RFType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_WIFI_DIRECT: -+ pDM_Odm->bWIFI_Direct = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_WIFI_DISPLAY: -+ pDM_Odm->bWIFI_Display = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_LINK: -+ pDM_Odm->bLinked = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_STATION_STATE: -+ pDM_Odm->bsta_state = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_RSSI_MIN: -+ pDM_Odm->RSSI_Min= (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_DBG_COMP: -+ pDM_Odm->DebugComponents = Value; -+ break; -+ -+ case ODM_CMNINFO_DBG_LEVEL: -+ pDM_Odm->DebugLevel = (u4Byte)Value; -+ break; -+ case ODM_CMNINFO_RA_THRESHOLD_HIGH: -+ pDM_Odm->RateAdaptive.HighRSSIThresh = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RA_THRESHOLD_LOW: -+ pDM_Odm->RateAdaptive.LowRSSIThresh = (u1Byte)Value; -+ break; -+#if defined(BT_30_SUPPORT) && (BT_30_SUPPORT == 1) -+ // The following is for BT HS mode and BT coexist mechanism. -+ case ODM_CMNINFO_BT_ENABLED: -+ pDM_Odm->bBtEnabled = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_HS_CONNECT_PROCESS: -+ pDM_Odm->bBtConnectProcess = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_HS_RSSI: -+ pDM_Odm->btHsRssi = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_OPERATION: -+ pDM_Odm->bBtHsOperation = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_LIMITED_DIG: -+ pDM_Odm->bBtLimitedDig = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_DIG: -+ pDM_Odm->btHsDigVal = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_BUSY: -+ pDM_Odm->bBtBusy = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_DISABLE_EDCA: -+ pDM_Odm->bBtDisableEdcaTurbo = (BOOLEAN)Value; -+ break; -+#endif -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_AP) // for repeater mode add by YuChen 2014.06.23 -+#ifdef UNIVERSAL_REPEATER -+ case ODM_CMNINFO_VXD_LINK: -+ pDM_Odm->VXD_bLinked= (BOOLEAN)Value; -+ break; -+#endif -+#endif -+ -+ case ODM_CMNINFO_AP_TOTAL_NUM: -+ pDM_Odm->APTotalNum = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_POWER_TRAINING: -+ pDM_Odm->bDisablePowerTraining = (BOOLEAN)Value; -+ break; -+ -+/* -+ case ODM_CMNINFO_OP_MODE: -+ pDM_Odm->OPMode = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_WM_MODE: -+ pDM_Odm->WirelessMode = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BAND: -+ pDM_Odm->BandType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_SEC_CHNL_OFFSET: -+ pDM_Odm->SecChOffset = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_SEC_MODE: -+ pDM_Odm->Security = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BW: -+ pDM_Odm->BandWidth = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_CHNL: -+ pDM_Odm->Channel = (u1Byte)Value; -+ break; -+*/ -+ default: -+ //do nothing -+ break; -+ } -+ -+ -+} -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+ODM_InitAllWorkItems(IN PDM_ODM_T pDM_Odm ) -+{ -+ -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+#if USE_WORKITEM -+ #if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) -+ ODM_InitializeWorkItem( pDM_Odm, -+ &pDM_Odm->DM_SWAT_Table.SwAntennaSwitchWorkitem_8723B, -+ (RT_WORKITEM_CALL_BACK)ODM_SW_AntDiv_WorkitemCallback, -+ (PVOID)pAdapter, -+ "AntennaSwitchWorkitem"); -+ #endif -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ ODM_InitializeWorkItem(pDM_Odm, -+ &pDM_Odm->dm_sat_table.hl_smart_antenna_workitem, -+ (RT_WORKITEM_CALL_BACK)phydm_beam_switch_workitem_callback, -+ (PVOID)pAdapter, -+ "hl_smart_ant_workitem"); -+ -+ ODM_InitializeWorkItem(pDM_Odm, -+ &pDM_Odm->dm_sat_table.hl_smart_antenna_decision_workitem, -+ (RT_WORKITEM_CALL_BACK)phydm_beam_decision_workitem_callback, -+ (PVOID)pAdapter, -+ "hl_smart_ant_decision_workitem"); -+ #endif -+ -+ #if ((RTL8192C_SUPPORT == 1) && (defined(CONFIG_SW_ANTENNA_DIVERSITY))) -+ ODM_InitializeWorkItem( pDM_Odm, -+ &pDM_Odm->DM_SWAT_Table.SwAntennaSwitchWorkitem, -+ (RT_WORKITEM_CALL_BACK)odm_SwAntDivChkAntSwitchWorkitemCallback, -+ (PVOID)pAdapter, -+ "AntennaSwitchWorkitem"); -+ #endif -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->PathDivSwitchWorkitem), -+ (RT_WORKITEM_CALL_BACK)odm_PathDivChkAntSwitchWorkitemCallback, -+ (PVOID)pAdapter, -+ "SWAS_WorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->CCKPathDiversityWorkitem), -+ (RT_WORKITEM_CALL_BACK)odm_CCKTXPathDiversityWorkItemCallback, -+ (PVOID)pAdapter, -+ "CCKTXPathDiversityWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->MPT_DIGWorkitem), -+ (RT_WORKITEM_CALL_BACK)odm_MPT_DIGWorkItemCallback, -+ (PVOID)pAdapter, -+ "MPT_DIGWorkitem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->RaRptWorkitem), -+ (RT_WORKITEM_CALL_BACK)ODM_UpdateInitRateWorkItemCallback, -+ (PVOID)pAdapter, -+ "RaRptWorkitem"); -+ -+#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->FastAntTrainingWorkitem), -+ (RT_WORKITEM_CALL_BACK)odm_FastAntTrainingWorkItemCallback, -+ (PVOID)pAdapter, -+ "FastAntTrainingWorkitem"); -+#endif -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->DM_RXHP_Table.PSDTimeWorkitem), -+ (RT_WORKITEM_CALL_BACK)odm_PSD_RXHPWorkitemCallback, -+ (PVOID)pAdapter, -+ "PSDRXHP_WorkItem"); -+ -+#endif /*#if USE_WORKITEM*/ -+ -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_EnterWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_EnterWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_EnterWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_LeaveWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_LeaveWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_LeaveWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_FwNdpaWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_FwNdpaWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ClkWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_ClkWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_ClkWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_RateWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_RateWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_RateWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_StatusWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_StatusWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_StatusWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ResetTxPathWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_ResetTxPathWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_ResetTxPathWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_GetTxRateWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_GetTxRateWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_GetTxRateWorkItem"); -+#endif -+} -+ -+VOID -+ODM_FreeAllWorkItems(IN PDM_ODM_T pDM_Odm ) -+{ -+#if USE_WORKITEM -+#if (RTL8723B_SUPPORT == 1)||(RTL8821A_SUPPORT == 1) -+ ODM_FreeWorkItem(&(pDM_Odm->DM_SWAT_Table.SwAntennaSwitchWorkitem_8723B)); -+#endif -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ ODM_FreeWorkItem(&(pDM_Odm->dm_sat_table.hl_smart_antenna_workitem)); -+ -+ ODM_FreeWorkItem(&(pDM_Odm->dm_sat_table.hl_smart_antenna_decision_workitem)); -+#endif -+ -+#if ((RTL8192C_SUPPORT == 1) && (defined(CONFIG_SW_ANTENNA_DIVERSITY))) -+ ODM_FreeWorkItem(&(pDM_Odm->DM_SWAT_Table.SwAntennaSwitchWorkitem)); -+#endif -+ ODM_FreeWorkItem(&(pDM_Odm->PathDivSwitchWorkitem)); -+ ODM_FreeWorkItem(&(pDM_Odm->CCKPathDiversityWorkitem)); -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ ODM_FreeWorkItem(&(pDM_Odm->FastAntTrainingWorkitem)); -+#endif -+ ODM_FreeWorkItem(&(pDM_Odm->MPT_DIGWorkitem)); -+ ODM_FreeWorkItem(&(pDM_Odm->RaRptWorkitem)); -+ ODM_FreeWorkItem((&pDM_Odm->DM_RXHP_Table.PSDTimeWorkitem)); -+ /*ODM_FreeWorkItem((&pDM_Odm->sbdcnt_workitem));*/ -+#endif -+ -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_EnterWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_LeaveWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ClkWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_RateWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_StatusWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ResetTxPathWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_GetTxRateWorkItem)); -+#endif -+ -+} -+#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+ -+/* -+VOID -+odm_FindMinimumRSSI( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte i; -+ u1Byte RSSI_Min = 0xFF; -+ -+ for(i=0; ipODM_StaInfo[i] != NULL) -+ if(IS_STA_VALID(pDM_Odm->pODM_StaInfo[i]) ) -+ { -+ if(pDM_Odm->pODM_StaInfo[i]->RSSI_Ave < RSSI_Min) -+ { -+ RSSI_Min = pDM_Odm->pODM_StaInfo[i]->RSSI_Ave; -+ } -+ } -+ } -+ -+ pDM_Odm->RSSI_Min = RSSI_Min; -+ -+} -+ -+VOID -+odm_IsLinked( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte i; -+ BOOLEAN Linked = FALSE; -+ -+ for(i=0; ipODM_StaInfo[i]) ) -+ { -+ Linked = TRUE; -+ break; -+ } -+ -+ } -+ -+ pDM_Odm->bLinked = Linked; -+} -+*/ -+ -+VOID -+ODM_InitAllTimers( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ ODM_AntDivTimers(pDM_Odm,INIT_ANTDIV_TIMMER); -+#elif(defined(CONFIG_SW_ANTENNA_DIVERSITY)) -+ ODM_InitializeTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer, -+ (RT_TIMER_CALL_BACK)odm_SwAntDivChkAntSwitchCallback, NULL, "SwAntennaSwitchTimer"); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+#ifdef MP_TEST -+ if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer, -+ (RT_TIMER_CALL_BACK)odm_MPT_DIGCallback, NULL, "MPT_DIGTimer"); -+#endif -+#elif(DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer, -+ (RT_TIMER_CALL_BACK)odm_MPT_DIGCallback, NULL, "MPT_DIGTimer"); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->PSDTimer, -+ (RT_TIMER_CALL_BACK)dm_PSDMonitorCallback, NULL, "PSDTimer"); -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer, -+ (RT_TIMER_CALL_BACK)odm_PathDivChkAntSwitchCallback, NULL, "PathDivTimer"); -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer, -+ (RT_TIMER_CALL_BACK)odm_CCKTXPathDiversityCallback, NULL, "CCKPathDiversityTimer"); -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->DM_RXHP_Table.PSDTimer, -+ (RT_TIMER_CALL_BACK)odm_PSD_RXHPCallback, NULL, "PSDRXHPTimer"); -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer, -+ (RT_TIMER_CALL_BACK)phydm_sbd_callback, NULL, "SbdTimer"); -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaTimer, -+ (RT_TIMER_CALL_BACK)halComTxbf_FwNdpaTimerCallback, NULL, "Txbf_FwNdpaTimer"); -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.BeamformingTimer, -+ (RT_TIMER_CALL_BACK)Beamforming_SWTimerCallback, NULL, "BeamformingTimer"); -+#endif -+#endif -+} -+ -+VOID -+ODM_CancelAllTimers( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ // -+ // 2012/01/12 MH Temp BSOD fix. We need to find NIC allocate mem fail reason in -+ // win7 platform. -+ // -+ HAL_ADAPTER_STS_CHK(pDM_Odm) -+#endif -+ -+#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ ODM_AntDivTimers(pDM_Odm,CANCEL_ANTDIV_TIMMER); -+#elif(defined(CONFIG_SW_ANTENNA_DIVERSITY)) -+ ODM_CancelTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+#ifdef MP_TEST -+ if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -+#endif -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->PSDTimer); -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer); -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer); -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->DM_RXHP_Table.PSDTimer); -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer); -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaTimer); -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.BeamformingTimer); -+#endif -+#endif -+ -+} -+ -+ -+VOID -+ODM_ReleaseAllTimers( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ ODM_AntDivTimers(pDM_Odm,RELEASE_ANTDIV_TIMMER); -+#elif(defined(CONFIG_SW_ANTENNA_DIVERSITY)) -+ ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #ifdef MP_TEST -+ if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -+ #endif -+#elif(DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->PSDTimer); -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer); -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer); -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->DM_RXHP_Table.PSDTimer); -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer); -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaTimer); -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.BeamformingTimer); -+#endif -+#endif -+} -+ -+ -+//3============================================================ -+//3 Tx Power Tracking -+//3============================================================ -+ -+ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+VOID -+ODM_InitAllThreads( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ #ifdef TPT_THREAD -+ kTPT_task_init(pDM_Odm->priv); -+ #endif -+} -+ -+VOID -+ODM_StopAllThreads( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ #ifdef TPT_THREAD -+ kTPT_task_stop(pDM_Odm->priv); -+ #endif -+} -+#endif -+ -+ -+#if( DM_ODM_SUPPORT_TYPE == ODM_WIN) -+// -+// 2011/07/26 MH Add an API for testing IQK fail case. -+// -+BOOLEAN -+ODM_CheckPowerStatus( -+ IN PADAPTER Adapter) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ RT_RF_POWER_STATE rtState; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ -+ // 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. -+ if (pMgntInfo->init_adpt_in_progress == TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return TRUE, due to initadapter\n")); -+ return TRUE; -+ } -+ -+ // -+ // 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. -+ // -+ Adapter->HalFunc.GetHwRegHandler(Adapter, HW_VAR_RF_STATE, (pu1Byte)(&rtState)); -+ if(Adapter->bDriverStopped || Adapter->bDriverIsGoingToPnpSetPowerSleep || rtState == eRfOff) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return FALSE, due to %d/%d/%d\n", -+ Adapter->bDriverStopped, Adapter->bDriverIsGoingToPnpSetPowerSleep, rtState)); -+ return FALSE; -+ } -+ return TRUE; -+} -+#elif( DM_ODM_SUPPORT_TYPE == ODM_AP) -+BOOLEAN -+ODM_CheckPowerStatus( -+ IN PADAPTER Adapter) -+{ -+ /* -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ RT_RF_POWER_STATE rtState; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ -+ // 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. -+ if (pMgntInfo->init_adpt_in_progress == TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm,COMP_INIT, DBG_LOUD, ("ODM_CheckPowerStatus Return TRUE, due to initadapter")); -+ return TRUE; -+ } -+ -+ // -+ // 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. -+ // -+ Adapter->HalFunc.GetHwRegHandler(Adapter, HW_VAR_RF_STATE, (pu1Byte)(&rtState)); -+ if(Adapter->bDriverStopped || Adapter->bDriverIsGoingToPnpSetPowerSleep || rtState == eRfOff) -+ { -+ ODM_RT_TRACE(pDM_Odm,COMP_INIT, DBG_LOUD, ("ODM_CheckPowerStatus Return FALSE, due to %d/%d/%d\n", -+ Adapter->bDriverStopped, Adapter->bDriverIsGoingToPnpSetPowerSleep, rtState)); -+ return FALSE; -+ } -+ */ -+ return TRUE; -+} -+#endif -+ -+// need to ODM CE Platform -+//move to here for ANT detection mechanism using -+ -+#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN)||(DM_ODM_SUPPORT_TYPE == ODM_CE)) -+u4Byte -+GetPSDData( -+ IN PDM_ODM_T pDM_Odm, -+ unsigned int point, -+ u1Byte initial_gain_psd) -+{ -+ //unsigned int val, rfval; -+ //int psd_report; -+ u4Byte psd_report; -+ -+ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ //Debug Message -+ //val = PHY_QueryBBReg(Adapter,0x908, bMaskDWord); -+ //DbgPrint("Reg908 = 0x%x\n",val); -+ //val = PHY_QueryBBReg(Adapter,0xDF4, bMaskDWord); -+ //rfval = PHY_QueryRFReg(Adapter, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask); -+ //DbgPrint("RegDF4 = 0x%x, RFReg00 = 0x%x\n",val, rfval); -+ //DbgPrint("PHYTXON = %x, OFDMCCA_PP = %x, CCKCCA_PP = %x, RFReg00 = %x\n", -+ //(val&BIT25)>>25, (val&BIT14)>>14, (val&BIT15)>>15, rfval); -+ -+ //Set DCO frequency index, offset=(40MHz/SamplePts)*point -+ ODM_SetBBReg(pDM_Odm, 0x808, 0x3FF, point); -+ -+ //Start PSD calculation, Reg808[22]=0->1 -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 1); -+ //Need to wait for HW PSD report -+ ODM_StallExecution(1000); -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 0); -+ //Read PSD report, Reg8B4[15:0] -+ psd_report = ODM_GetBBReg(pDM_Odm,0x8B4, bMaskDWord) & 0x0000FFFF; -+ -+#if 1//(DEV_BUS_TYPE == RT_PCI_INTERFACE) && ( (RT_PLATFORM == PLATFORM_LINUX) || (RT_PLATFORM == PLATFORM_MACOSX)) -+ psd_report = (u4Byte) (odm_ConvertTo_dB(psd_report))+(u4Byte)(initial_gain_psd-0x1c); -+#else -+ psd_report = (int) (20*log10((double)psd_report))+(int)(initial_gain_psd-0x1c); -+#endif -+ -+ return psd_report; -+ -+} -+#endif -+ -+u4Byte -+odm_ConvertTo_dB( -+ u4Byte Value) -+{ -+ u1Byte i; -+ u1Byte j; -+ u4Byte dB; -+ -+ Value = Value & 0xFFFF; -+ -+ for (i = 0; i < 12; i++) -+ { -+ if (Value <= dB_Invert_Table[i][7]) -+ { -+ break; -+ } -+ } -+ -+ if (i >= 12) -+ { -+ return (96); // maximum 96 dB -+ } -+ -+ for (j = 0; j < 8; j++) -+ { -+ if (Value <= dB_Invert_Table[i][j]) -+ { -+ break; -+ } -+ } -+ -+ dB = (i << 3) + j + 1; -+ -+ return (dB); -+} -+ -+u4Byte -+odm_ConvertTo_linear( -+ u4Byte Value) -+{ -+ u1Byte i; -+ u1Byte j; -+ u4Byte linear; -+ -+ /* 1dB~96dB */ -+ -+ Value = Value & 0xFF; -+ -+ i = (u1Byte)((Value - 1) >> 3); -+ j = (u1Byte)(Value - 1) - (i << 3); -+ -+ linear = dB_Invert_Table[i][j]; -+ -+ return (linear); -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+ODM_UpdateInitRateWorkItemCallback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER Adapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ u1Byte p = 0; -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ ODM_TxPwrTrackSetPwr8821A(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ for (p = ODM_RF_PATH_A; p < MAX_PATH_NUM_8812A; p++) //DOn't know how to include &c -+ { -+ ODM_TxPwrTrackSetPwr8812A(pDM_Odm, MIX_MODE, p, 0); -+ } -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ ODM_TxPwrTrackSetPwr_8723B(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ for (p = ODM_RF_PATH_A; p < MAX_PATH_NUM_8192E; p++) //DOn't know how to include &c -+ { -+ ODM_TxPwrTrackSetPwr92E(pDM_Odm, MIX_MODE, p, 0); -+ } -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ ODM_TxPwrTrackSetPwr88E(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); -+ } -+} -+#endif -+ -+// -+// ODM multi-port consideration, added by Roger, 2013.10.01. -+// -+VOID -+ODM_AsocEntry_Init( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER pLoopAdapter = GetDefaultAdapter(pDM_Odm->Adapter); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pLoopAdapter); -+ PDM_ODM_T pDM_OutSrc = &pHalData->DM_OutSrc; -+ u1Byte TotalAssocEntryNum = 0; -+ u1Byte index = 0; -+ -+ -+ ODM_CmnInfoPtrArrayHook(pDM_OutSrc, ODM_CMNINFO_STA_STATUS, 0, &pLoopAdapter->MgntInfo.DefaultPort[0]); -+ pLoopAdapter->MgntInfo.DefaultPort[0].MultiPortStationIdx = TotalAssocEntryNum; -+ -+ pLoopAdapter = GetNextExtAdapter(pLoopAdapter); -+ TotalAssocEntryNum +=1; -+ -+ while(pLoopAdapter) -+ { -+ for (index = 0; index MgntInfo.AsocEntry[index]); -+ pLoopAdapter->MgntInfo.AsocEntry[index].MultiPortStationIdx = TotalAssocEntryNum+index; -+ } -+ -+ TotalAssocEntryNum+= index; -+ if(IS_HARDWARE_TYPE_8188E((pDM_Odm->Adapter))) -+ pLoopAdapter->RASupport = TRUE; -+ pLoopAdapter = GetNextExtAdapter(pLoopAdapter); -+ } -+#endif -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+/* Justin: According to the current RRSI to adjust Response Frame TX power, 2012/11/05 */ -+void odm_dtc(PDM_ODM_T pDM_Odm) -+{ -+#ifdef CONFIG_DM_RESP_TXAGC -+ #define DTC_BASE 35 /* RSSI higher than this value, start to decade TX power */ -+ #define DTC_DWN_BASE (DTC_BASE-5) /* RSSI lower than this value, start to increase TX power */ -+ -+ /* RSSI vs TX power step mapping: decade TX power */ -+ static const u8 dtc_table_down[]={ -+ DTC_BASE, -+ (DTC_BASE+5), -+ (DTC_BASE+10), -+ (DTC_BASE+15), -+ (DTC_BASE+20), -+ (DTC_BASE+25) -+ }; -+ -+ /* RSSI vs TX power step mapping: increase TX power */ -+ static const u8 dtc_table_up[]={ -+ DTC_DWN_BASE, -+ (DTC_DWN_BASE-5), -+ (DTC_DWN_BASE-10), -+ (DTC_DWN_BASE-15), -+ (DTC_DWN_BASE-15), -+ (DTC_DWN_BASE-20), -+ (DTC_DWN_BASE-20), -+ (DTC_DWN_BASE-25), -+ (DTC_DWN_BASE-25), -+ (DTC_DWN_BASE-30), -+ (DTC_DWN_BASE-35) -+ }; -+ -+ u8 i; -+ u8 dtc_steps=0; -+ u8 sign; -+ u8 resp_txagc=0; -+ -+ #if 0 -+ /* As DIG is disabled, DTC is also disable */ -+ if(!(pDM_Odm->SupportAbility & ODM_XXXXXX)) -+ return; -+ #endif -+ -+ if (DTC_BASE < pDM_Odm->RSSI_Min) { -+ /* need to decade the CTS TX power */ -+ sign = 1; -+ for (i=0;i= pDM_Odm->RSSI_Min) || (dtc_steps >= 6)) -+ break; -+ else -+ dtc_steps++; -+ } -+ } -+#if 0 -+ else if (DTC_DWN_BASE > pDM_Odm->RSSI_Min) -+ { -+ /* needs to increase the CTS TX power */ -+ sign = 0; -+ dtc_steps = 1; -+ for (i=0;iRSSI_Min) || (dtc_steps>=10)) -+ break; -+ else -+ dtc_steps++; -+ } -+ } -+#endif -+ else -+ { -+ sign = 0; -+ dtc_steps = 0; -+ } -+ -+ resp_txagc = dtc_steps | (sign << 4); -+ resp_txagc = resp_txagc | (resp_txagc << 5); -+ ODM_Write1Byte(pDM_Odm, 0x06d9, resp_txagc); -+ -+ DBG_871X("%s RSSI_Min:%u, set RESP_TXAGC to %s %u\n", -+ __func__, pDM_Odm->RSSI_Min, sign?"minus":"plus", dtc_steps); -+#endif /* CONFIG_RESP_TXAGC_ADJUST */ -+} -+ -+#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ -+ -+VOID -+odm_UpdatePowerTrainingState( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm , PHYDM_FALSEALMCNT); -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ u4Byte score = 0; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_PWR_TRAIN)) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState()============>\n")); -+ pDM_Odm->bChangeState = FALSE; -+ -+ // Debug command -+ if(pDM_Odm->ForcePowerTrainingState) -+ { -+ if(pDM_Odm->ForcePowerTrainingState == 1 && !pDM_Odm->bDisablePowerTraining) -+ { -+ pDM_Odm->bChangeState = TRUE; -+ pDM_Odm->bDisablePowerTraining = TRUE; -+ } -+ else if(pDM_Odm->ForcePowerTrainingState == 2 && pDM_Odm->bDisablePowerTraining) -+ { -+ pDM_Odm->bChangeState = TRUE; -+ pDM_Odm->bDisablePowerTraining = FALSE; -+ } -+ -+ pDM_Odm->PT_score = 0; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): ForcePowerTrainingState = %d\n", -+ pDM_Odm->ForcePowerTrainingState)); -+ return; -+ } -+ -+ if(!pDM_Odm->bLinked) -+ return; -+ -+ // First connect -+ if((pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == FALSE)) -+ { -+ pDM_Odm->PT_score = 0; -+ pDM_Odm->bChangeState = TRUE; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): First Connect\n")); -+ return; -+ } -+ -+ // Compute score -+ if(pDM_Odm->NHM_cnt_0 >= 215) -+ score = 2; -+ else if(pDM_Odm->NHM_cnt_0 >= 190) -+ score = 1; // unknow state -+ else -+ { -+ u4Byte RX_Pkt_Cnt; -+ -+ RX_Pkt_Cnt = (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM) + (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK); -+ -+ if((FalseAlmCnt->Cnt_CCA_all > 31 && RX_Pkt_Cnt > 31) && (FalseAlmCnt->Cnt_CCA_all >= RX_Pkt_Cnt)) -+ { -+ if((RX_Pkt_Cnt + (RX_Pkt_Cnt >> 1)) <= FalseAlmCnt->Cnt_CCA_all) -+ score = 0; -+ else if((RX_Pkt_Cnt + (RX_Pkt_Cnt >> 2)) <= FalseAlmCnt->Cnt_CCA_all) -+ score = 1; -+ else -+ score = 2; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): RX_Pkt_Cnt = %d, Cnt_CCA_all = %d\n", -+ RX_Pkt_Cnt, FalseAlmCnt->Cnt_CCA_all)); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): NumQryPhyStatusOFDM = %d, NumQryPhyStatusCCK = %d\n", -+ (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM), (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): NHM_cnt_0 = %d, score = %d\n", -+ pDM_Odm->NHM_cnt_0, score)); -+ -+ // smoothing -+ pDM_Odm->PT_score = (score << 4) + (pDM_Odm->PT_score>>1) + (pDM_Odm->PT_score>>2); -+ score = (pDM_Odm->PT_score + 32) >> 6; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): PT_score = %d, score after smoothing = %d\n", -+ pDM_Odm->PT_score, score)); -+ -+ // Mode decision -+ if(score == 2) -+ { -+ if(pDM_Odm->bDisablePowerTraining) -+ { -+ pDM_Odm->bChangeState = TRUE; -+ pDM_Odm->bDisablePowerTraining = FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Change state\n")); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Enable Power Training\n")); -+ } -+ else if(score == 0) -+ { -+ if(!pDM_Odm->bDisablePowerTraining) -+ { -+ pDM_Odm->bChangeState = TRUE; -+ pDM_Odm->bDisablePowerTraining = TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Change state\n")); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Disable Power Training\n")); -+ } -+ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; -+#endif -+} -+ -+ -+ -+/*===========================================================*/ -+/* The following is for compile only*/ -+/*===========================================================*/ -+/*#define TARGET_CHNL_NUM_2G_5G 59*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+u1Byte GetRightChnlPlaceforIQK(u1Byte chnl) -+{ -+ u1Byte channel_all[TARGET_CHNL_NUM_2G_5G] = {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, 60, 62, 64, 100, -+ 102, 104, 106, 108, 110, 112, 114, 116, 118, 120, 122, 124, 126, 128, 130, 132, 134, 136, 138, 140, 149, 151, 153, 155, 157, 159, 161, 163, 165}; -+ u1Byte place = chnl; -+ -+ -+ if (chnl > 14) { -+ for (place = 14; place < sizeof(channel_all); place++) { -+ if (channel_all[place] == chnl) -+ return place-13; -+ } -+ } -+ -+ return 0; -+} -+ -+VOID -+FillH2CCmd92C( -+ IN PADAPTER Adapter, -+ IN u1Byte ElementID, -+ IN u4Byte CmdLen, -+ IN pu1Byte pCmdBuffer -+) -+{} -+VOID -+PHY_SetTxPowerLevel8192C( -+ IN PADAPTER Adapter, -+ IN u1Byte channel -+ ) -+{ -+} -+#endif -+/*===========================================================*/ -+ -+VOID -+phydm_NoisyDetection( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte Total_FA_Cnt, Total_CCA_Cnt; -+ u4Byte Score = 0, i, Score_Smooth; -+ -+ Total_CCA_Cnt = pDM_Odm->FalseAlmCnt.Cnt_CCA_all; -+ Total_FA_Cnt = pDM_Odm->FalseAlmCnt.Cnt_all; -+ -+/* -+ if( Total_FA_Cnt*16>=Total_CCA_Cnt*14 ) // 87.5 -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*12 ) // 75 -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*10 ) // 56.25 -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*8 ) // 50 -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*7 ) // 43.75 -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*6 ) // 37.5 -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*5 ) // 31.25% -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*4 ) // 25% -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*3 ) // 18.75% -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*2 ) // 12.5% -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*1 ) // 6.25% -+*/ -+ for(i=0;i<=16;i++) -+ { -+ if( Total_FA_Cnt*16>=Total_CCA_Cnt*(16-i) ) -+ { -+ Score = 16-i; -+ break; -+ } -+ } -+ -+ // NoisyDecision_Smooth = NoisyDecision_Smooth>>1 + (Score<<3)>>1; -+ pDM_Odm->NoisyDecision_Smooth = (pDM_Odm->NoisyDecision_Smooth>>1) + (Score<<2); -+ -+ // Round the NoisyDecision_Smooth: +"3" comes from (2^3)/2-1 -+ Score_Smooth = (Total_CCA_Cnt>=300)?((pDM_Odm->NoisyDecision_Smooth+3)>>3):0; -+ -+ pDM_Odm->NoisyDecision = (Score_Smooth>=3)?1:0; -+/* -+ switch(Score_Smooth) -+ { -+ case 0: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=0%%\n")); -+ break; -+ case 1: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=6.25%%\n")); -+ break; -+ case 2: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=12.5%%\n")); -+ break; -+ case 3: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=18.75%%\n")); -+ break; -+ case 4: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=25%%\n")); -+ break; -+ case 5: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=31.25%%\n")); -+ break; -+ case 6: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=37.5%%\n")); -+ break; -+ case 7: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=43.75%%\n")); -+ break; -+ case 8: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=50%%\n")); -+ break; -+ case 9: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=56.25%%\n")); -+ break; -+ case 10: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=62.5%%\n")); -+ break; -+ case 11: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=68.75%%\n")); -+ break; -+ case 12: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=75%%\n")); -+ break; -+ case 13: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=81.25%%\n")); -+ break; -+ case 14: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=87.5%%\n")); -+ break; -+ case 15: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=93.75%%\n")); -+ break; -+ case 16: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=100%%\n")); -+ break; -+ default: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Unknown Value!! Need Check!!\n")); -+ } -+*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_CCA_Cnt=%d, Total_FA_Cnt=%d, NoisyDecision_Smooth=%d, Score=%d, Score_Smooth=%d, pDM_Odm->NoisyDecision=%d\n", -+ Total_CCA_Cnt, Total_FA_Cnt, pDM_Odm->NoisyDecision_Smooth, Score, Score_Smooth, pDM_Odm->NoisyDecision)); -+ -+} -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_cfotracking.c linux/3rdparty/rtl8812au/hal/phydm/phydm_cfotracking.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_cfotracking.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_cfotracking.c 2017-06-07 23:07:21.017688123 +0300 -@@ -0,0 +1,347 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+VOID -+odm_SetCrystalCap( -+ IN PVOID pDM_VOID, -+ IN u1Byte CrystalCap -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); -+ BOOLEAN bEEPROMCheck; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ bEEPROMCheck = (pHalData->EEPROMVersion >= 0x01)?TRUE:FALSE; -+#else -+ bEEPROMCheck = TRUE; -+#endif -+ -+ if(pCfoTrack->CrystalCap == CrystalCap) -+ return; -+ -+ pCfoTrack->CrystalCap = CrystalCap; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8188E | ODM_RTL8188F)) { -+ /* write 0x24[22:17] = 0x24[16:11] = CrystalCap */ -+ CrystalCap = CrystalCap & 0x3F; -+ ODM_SetBBReg(pDM_Odm, REG_AFE_XTAL_CTRL, 0x007ff800, (CrystalCap|(CrystalCap << 6))); -+ } else if (pDM_Odm->SupportICType & ODM_RTL8812) { -+ /* write 0x2C[30:25] = 0x2C[24:19] = CrystalCap */ -+ CrystalCap = CrystalCap & 0x3F; -+ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0x7FF80000, (CrystalCap|(CrystalCap << 6))); -+ } else if (((pDM_Odm->SupportICType & ODM_RTL8723A) && bEEPROMCheck) || -+ (pDM_Odm->SupportICType & (ODM_RTL8703B|ODM_RTL8723B|ODM_RTL8192E|ODM_RTL8821))) { -+ /* 0x2C[23:18] = 0x2C[17:12] = CrystalCap */ -+ CrystalCap = CrystalCap & 0x3F; -+ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0x00FFF000, (CrystalCap|(CrystalCap << 6))); -+ } else if (pDM_Odm->SupportICType & ODM_RTL8821B) { -+ /* write 0x28[6:1] = 0x24[30:25] = CrystalCap */ -+ CrystalCap = CrystalCap & 0x3F; -+ ODM_SetBBReg(pDM_Odm, REG_AFE_XTAL_CTRL, 0x7E000000, CrystalCap); -+ ODM_SetBBReg(pDM_Odm, REG_AFE_PLL_CTRL, 0x7E, CrystalCap); -+ } else if (pDM_Odm->SupportICType & ODM_RTL8814A) { -+ /* write 0x2C[26:21] = 0x2C[20:15] = CrystalCap */ -+ CrystalCap = CrystalCap & 0x3F; -+ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0x07FF8000, (CrystalCap|(CrystalCap << 6))); -+ } else if (pDM_Odm->SupportICType & ODM_RTL8822B) { -+ /* write 0x24[30:25] = 0x28[6:1] = CrystalCap */ -+ CrystalCap = CrystalCap & 0x3F; -+ ODM_SetBBReg(pDM_Odm, REG_AFE_XTAL_CTRL, 0x7e000000, CrystalCap); -+ ODM_SetBBReg(pDM_Odm, REG_AFE_PLL_CTRL, 0x7e, CrystalCap); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_SetCrystalCap(): Use default setting.\n")); -+ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCap|(CrystalCap << 6))); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_SetCrystalCap(): CrystalCap = 0x%x\n", CrystalCap)); -+#endif -+} -+ -+u1Byte -+odm_GetDefaultCrytaltalCap( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte CrystalCap = 0x20; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ CrystalCap = pHalData->CrystalCap; -+#else -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ if(priv->pmib->dot11RFEntry.xcap > 0) -+ CrystalCap = priv->pmib->dot11RFEntry.xcap; -+#endif -+ -+ CrystalCap = CrystalCap & 0x3f; -+ -+ return CrystalCap; -+} -+ -+VOID -+odm_SetATCStatus( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN ATCStatus -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); -+ -+ if(pCfoTrack->bATCStatus == ATCStatus) -+ return; -+ -+ ODM_SetBBReg(pDM_Odm, ODM_REG(BB_ATC,pDM_Odm), ODM_BIT(BB_ATC,pDM_Odm), ATCStatus); -+ pCfoTrack->bATCStatus = ATCStatus; -+} -+ -+BOOLEAN -+odm_GetATCStatus( -+ IN PVOID pDM_VOID -+) -+{ -+ BOOLEAN ATCStatus; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ATCStatus = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG(BB_ATC,pDM_Odm), ODM_BIT(BB_ATC,pDM_Odm)); -+ return ATCStatus; -+} -+ -+VOID -+ODM_CfoTrackingReset( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); -+ -+ pCfoTrack->DefXCap = odm_GetDefaultCrytaltalCap(pDM_Odm); -+ pCfoTrack->bAdjust = TRUE; -+ -+ if(pCfoTrack->CrystalCap > pCfoTrack->DefXCap) -+ { -+ odm_SetCrystalCap(pDM_Odm, pCfoTrack->CrystalCap - 1); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, -+ ("ODM_CfoTrackingReset(): approch default value (0x%x)\n", pCfoTrack->CrystalCap)); -+ } else if (pCfoTrack->CrystalCap < pCfoTrack->DefXCap) -+ { -+ odm_SetCrystalCap(pDM_Odm, pCfoTrack->CrystalCap + 1); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, -+ ("ODM_CfoTrackingReset(): approch default value (0x%x)\n", pCfoTrack->CrystalCap)); -+ } -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ odm_SetATCStatus(pDM_Odm, TRUE); -+ #endif -+} -+ -+VOID -+ODM_CfoTrackingInit( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); -+ -+ pCfoTrack->DefXCap = pCfoTrack->CrystalCap = odm_GetDefaultCrytaltalCap(pDM_Odm); -+ pCfoTrack->bATCStatus = odm_GetATCStatus(pDM_Odm); -+ pCfoTrack->bAdjust = TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking_init()=========> \n")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking_init(): bATCStatus = %d, CrystalCap = 0x%x \n",pCfoTrack->bATCStatus, pCfoTrack->DefXCap)); -+} -+ -+VOID -+ODM_CfoTracking( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); -+ int CFO_kHz_A, CFO_kHz_B, CFO_ave = 0; -+ int CFO_ave_diff; -+ int CrystalCap = (int)pCfoTrack->CrystalCap; -+ u1Byte Adjust_Xtal = 1; -+ -+ //4 Support ability -+ if(!(pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Return: SupportAbility ODM_BB_CFO_TRACKING is disabled\n")); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking()=========> \n")); -+ -+ if(!pDM_Odm->bLinked || !pDM_Odm->bOneEntryOnly) -+ { -+ //4 No link or more than one entry -+ ODM_CfoTrackingReset(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Reset: bLinked = %d, bOneEntryOnly = %d\n", -+ pDM_Odm->bLinked, pDM_Odm->bOneEntryOnly)); -+ } -+ else -+ { -+ //3 1. CFO Tracking -+ //4 1.1 No new packet -+ if(pCfoTrack->packetCount == pCfoTrack->packetCount_pre) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): packet counter doesn't change\n")); -+ return; -+ } -+ pCfoTrack->packetCount_pre = pCfoTrack->packetCount; -+ -+ //4 1.2 Calculate CFO -+ CFO_kHz_A = (int)((pCfoTrack->CFO_tail[0] * 3125) / 10)>>7; /* CFO_tail[1:0] is S(8,7), (num_subcarrier>>7) x 312.5K = CFO value(K Hz) */ -+ CFO_kHz_B = (int)((pCfoTrack->CFO_tail[1] * 3125) / 10)>>7; -+ -+ if(pDM_Odm->RFType < ODM_2T2R) -+ CFO_ave = CFO_kHz_A; -+ else -+ CFO_ave = (int)(CFO_kHz_A + CFO_kHz_B) >> 1; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): CFO_kHz_A = %dkHz, CFO_kHz_B = %dkHz, CFO_ave = %dkHz\n", -+ CFO_kHz_A, CFO_kHz_B, CFO_ave)); -+ -+ //4 1.3 Avoid abnormal large CFO -+ CFO_ave_diff = (pCfoTrack->CFO_ave_pre >= CFO_ave)?(pCfoTrack->CFO_ave_pre - CFO_ave):(CFO_ave - pCfoTrack->CFO_ave_pre); -+ if(CFO_ave_diff > 20 && pCfoTrack->largeCFOHit == 0 && !pCfoTrack->bAdjust) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): first large CFO hit\n")); -+ pCfoTrack->largeCFOHit = 1; -+ return; -+ } -+ else -+ pCfoTrack->largeCFOHit = 0; -+ pCfoTrack->CFO_ave_pre = CFO_ave; -+ -+ //4 1.4 Dynamic Xtal threshold -+ if(pCfoTrack->bAdjust == FALSE) -+ { -+ if(CFO_ave > CFO_TH_XTAL_HIGH || CFO_ave < (-CFO_TH_XTAL_HIGH)) -+ pCfoTrack->bAdjust = TRUE; -+ } -+ else -+ { -+ if(CFO_ave < CFO_TH_XTAL_LOW && CFO_ave > (-CFO_TH_XTAL_LOW)) -+ pCfoTrack->bAdjust = FALSE; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ //4 1.5 BT case: Disable CFO tracking -+ if(pDM_Odm->bBtEnabled) -+ { -+ pCfoTrack->bAdjust = FALSE; -+ odm_SetCrystalCap(pDM_Odm, pCfoTrack->DefXCap); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Disable CFO tracking for BT!!\n")); -+ } -+/* -+ //4 1.6 Big jump -+ if(pCfoTrack->bAdjust) -+ { -+ if(CFO_ave > CFO_TH_XTAL_LOW) -+ Adjust_Xtal = Adjust_Xtal + ((CFO_ave - CFO_TH_XTAL_LOW) >> 2); -+ else if(CFO_ave < (-CFO_TH_XTAL_LOW)) -+ Adjust_Xtal = Adjust_Xtal + ((CFO_TH_XTAL_LOW - CFO_ave) >> 2); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Crystal cap offset = %d\n", Adjust_Xtal)); -+ } -+*/ -+#endif -+ -+ //4 1.7 Adjust Crystal Cap. -+ if(pCfoTrack->bAdjust) -+ { -+ if(CFO_ave > CFO_TH_XTAL_LOW) -+ CrystalCap = CrystalCap + Adjust_Xtal; -+ else if(CFO_ave < (-CFO_TH_XTAL_LOW)) -+ CrystalCap = CrystalCap - Adjust_Xtal; -+ -+ if(CrystalCap > 0x3f) -+ CrystalCap = 0x3f; -+ else if (CrystalCap < 0) -+ CrystalCap = 0; -+ -+ odm_SetCrystalCap(pDM_Odm, (u1Byte)CrystalCap); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Crystal cap = 0x%x, Default Crystal cap = 0x%x\n", -+ pCfoTrack->CrystalCap, pCfoTrack->DefXCap)); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ return; -+ -+ //3 2. Dynamic ATC switch -+ if(CFO_ave < CFO_TH_ATC && CFO_ave > -CFO_TH_ATC) -+ { -+ odm_SetATCStatus(pDM_Odm, FALSE); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Disable ATC!!\n")); -+ } -+ else -+ { -+ odm_SetATCStatus(pDM_Odm, TRUE); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Enable ATC!!\n")); -+ } -+#endif -+ } -+} -+ -+VOID -+ODM_ParsingCFO( -+ IN PVOID pDM_VOID, -+ IN PVOID pPktinfo_VOID, -+ IN s1Byte* pcfotail -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_PACKET_INFO_T pPktinfo = (PODM_PACKET_INFO_T)pPktinfo_VOID; -+ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); -+ u1Byte i; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)) -+ return; -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(pPktinfo->bPacketMatchBSSID) -+#else -+ if(pPktinfo->StationID != 0) -+#endif -+ { -+ //3 Update CFO report for path-A & path-B -+ // Only paht-A and path-B have CFO tail and short CFO -+ for(i = ODM_RF_PATH_A; i <= ODM_RF_PATH_B; i++) -+ { -+ pCfoTrack->CFO_tail[i] = (int)pcfotail[i]; -+ } -+ -+ //3 Update packet counter -+ if(pCfoTrack->packetCount == 0xffffffff) -+ pCfoTrack->packetCount = 0; -+ else -+ pCfoTrack->packetCount++; -+ } -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_cfotracking.h linux/3rdparty/rtl8812au/hal/phydm/phydm_cfotracking.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_cfotracking.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_cfotracking.h 2017-06-07 23:07:21.017688123 +0300 -@@ -0,0 +1,68 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMCFOTRACK_H__ -+#define __PHYDMCFOTRACK_H__ -+ -+#define CFO_TRACKING_VERSION "1.2" /*2015.06.17*/ -+ -+#define CFO_TH_XTAL_HIGH 20 // kHz -+#define CFO_TH_XTAL_LOW 10 // kHz -+#define CFO_TH_ATC 80 // kHz -+ -+typedef struct _CFO_TRACKING_ -+{ -+ BOOLEAN bATCStatus; -+ BOOLEAN largeCFOHit; -+ BOOLEAN bAdjust; -+ u1Byte CrystalCap; -+ u1Byte DefXCap; -+ int CFO_tail[2]; -+ int CFO_ave_pre; -+ u4Byte packetCount; -+ u4Byte packetCount_pre; -+ -+ BOOLEAN bForceXtalCap; -+ BOOLEAN bReset; -+}CFO_TRACKING, *PCFO_TRACKING; -+ -+VOID -+ODM_CfoTrackingReset( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+ODM_CfoTrackingInit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+ODM_CfoTracking( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+ODM_ParsingCFO( -+ IN PVOID pDM_VOID, -+ IN PVOID pPktinfo_VOID, -+ IN s1Byte* pcfotail -+); -+ ++ ++// Add new function to reset the state of antenna diversity before link. ++u8 AntDivBeforeLink8812(PADAPTER Adapter ) ++{ ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T pDM_Odm =&pHalData->odmpriv; ++ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; ++ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); ++ ++ // Condition that does not need to use antenna diversity. ++ if(pHalData->AntDivCfg==0) ++ { ++ //DBG_8192C("odm_AntDivBeforeLink8192C(): No AntDiv Mechanism.\n"); ++ return false; ++ } ++ ++ if(check_fwstate(pmlmepriv, _FW_LINKED) == true) ++ { ++ return false; ++ } ++ ++ ++ if(pDM_SWAT_Table->SWAS_NoLink_State == 0){ ++ //switch channel ++ pDM_SWAT_Table->SWAS_NoLink_State = 1; ++ pDM_SWAT_Table->CurAntenna = (pDM_SWAT_Table->CurAntenna==MAIN_ANT)?AUX_ANT:MAIN_ANT; ++ ++ //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300, pDM_SWAT_Table->CurAntenna); ++ rtw_antenna_select_cmd(Adapter, pDM_SWAT_Table->CurAntenna, false); ++ //DBG_8192C("%s change antenna to ANT_( %s ).....\n",__FUNCTION__, (pDM_SWAT_Table->CurAntenna==MAIN_ANT)?"MAIN":"AUX"); ++ return true; ++ } ++ else ++ { ++ pDM_SWAT_Table->SWAS_NoLink_State = 0; ++ return false; ++ } ++ ++} +#endif -\ Ingen nyrad vid filslut -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_debug.c linux/3rdparty/rtl8812au/hal/phydm/phydm_debug.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_debug.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_debug.c 2017-06-07 23:07:21.017688123 +0300 -@@ -0,0 +1,2003 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+ -+VOID -+PHYDM_InitDebugSetting( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ pDM_Odm->DebugLevel = ODM_DBG_TRACE; -+ -+ pDM_Odm->DebugComponents = -+ \ -+#if DBG -+//BB Functions -+// ODM_COMP_DIG | -+// ODM_COMP_RA_MASK | -+// ODM_COMP_DYNAMIC_TXPWR | -+// ODM_COMP_FA_CNT | -+// ODM_COMP_RSSI_MONITOR | -+// ODM_COMP_CCK_PD | -+/* ODM_COMP_ANT_DIV |*/ -+// ODM_COMP_PWR_SAVE | -+// ODM_COMP_PWR_TRAIN | -+// ODM_COMP_RATE_ADAPTIVE | -+// ODM_COMP_PATH_DIV | -+// ODM_COMP_DYNAMIC_PRICCA | -+// ODM_COMP_RXHP | -+// ODM_COMP_MP | -+// ODM_COMP_CFO_TRACKING | -+// ODM_COMP_ACS | -+// PHYDM_COMP_ADAPTIVITY | -+// PHYDM_COMP_RA_DBG | -+/* PHYDM_COMP_TXBF |*/ -+//MAC Functions -+// ODM_COMP_EDCA_TURBO | -+// ODM_COMP_EARLY_MODE | -+/* ODM_FW_DEBUG_TRACE |*/ -+//RF Functions -+// ODM_COMP_TX_PWR_TRACK | -+// ODM_COMP_RX_GAIN_TRACK | -+// ODM_COMP_CALIBRATION | -+//Common -+/* ODM_PHY_CONFIG |*/ -+// ODM_COMP_COMMON | -+// ODM_COMP_INIT | -+// ODM_COMP_PSD | -+/* ODM_COMP_NOISY_DETECT |*/ -+#endif -+ 0; -+ -+ pDM_Odm->fw_buff_is_enpty = TRUE; -+ pDM_Odm->pre_c2h_seq = 0; -+} -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+static u1Byte BbDbgBuf[BB_TMP_BUF_SIZE]; -+ -+VOID -+phydm_BB_RxHang_Info(IN PDM_ODM_T pDM_Odm) -+{ -+ u4Byte value32 = 0; -+ -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ return; -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF80 , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "rptreg of sc/bw/ht/...", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ /* dbg_port = state machine */ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x007); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "state machine", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ } -+ -+ /* dbg_port = CCA-related*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x204); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "CCA-related", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ } -+ -+ -+ /* dbg_port = edcca/rxd*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x278); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "edcca/rxd", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ } -+ -+ /* dbg_port = rx_state/mux_state/ADC_MASK_OFDM*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x290); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "rx_state/mux_state/ADC_MASK_OFDM", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ } -+ -+ /* dbg_port = bf-related*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x2B2); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "bf-related", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ } -+ -+ /* dbg_port = bf-related*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x2B8); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "bf-related", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ } -+ -+ /* dbg_port = txon/rxd*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xA03); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "txon/rxd", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ } -+ -+ /* dbg_port = l_rate/l_length*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xA0B); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "l_rate/l_length", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ } -+ -+ /* dbg_port = rxd/rxd_hit*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xA0D); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "rxd/rxd_hit", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ } -+ -+ /* dbg_port = dis_cca*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAA0); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "dis_cca", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ } -+ -+ -+ /* dbg_port = tx*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAB0); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "tx", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ } -+ -+ /* dbg_port = rx plcp*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD0); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "rx plcp", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD1); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "rx plcp", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD2); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "rx plcp", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD3); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8fc", value32); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "rx plcp", (value32)); -+ DCMD_Printf(BbDbgBuf); -+ } -+ -+} -+ -+VOID -+phydm_BB_Debug_Info(IN PDM_ODM_T pDM_Odm) -+{ -+ -+ u1Byte RX_HT_BW, RX_VHT_BW, RXSC, RX_HT, RX_BW; -+ static u1Byte vRX_BW ; -+ u4Byte value32, value32_1, value32_2, value32_3; -+ s4Byte SFO_A, SFO_B, SFO_C, SFO_D; -+ s4Byte LFO_A, LFO_B, LFO_C, LFO_D; -+ static u1Byte MCSS, Tail, Parity, rsv, vrsv, idx, smooth, htsound, agg, stbc, vstbc, fec, fecext, sgi, sgiext, htltf, vgid, vNsts, vtxops, vrsv2, vbrsv, bf, vbcrc; -+ static u2Byte HLength, htcrc8, Length; -+ static u2Byte vpaid; -+ static u2Byte vLength, vhtcrc8, vMCSS, vTail, vbTail; -+ static u1Byte HMCSS, HRX_BW; -+ -+ -+ u1Byte pwDB; -+ s1Byte RXEVM_0, RXEVM_1, RXEVM_2 ; -+ u1Byte RF_gain_pathA, RF_gain_pathB, RF_gain_pathC, RF_gain_pathD; -+ u1Byte RX_SNR_pathA, RX_SNR_pathB, RX_SNR_pathC, RX_SNR_pathD; -+ s4Byte sig_power; -+ const char *RXHT_table[3] = {"legacy", "HT", "VHT"}; -+ const char *BW_table[3] = {"20M", "40M", "80M"}; -+ const char *RXSC_table[7] = {"duplicate/full bw", "usc20-1", "lsc20-1", "usc20-2", "lsc20-2", "usc40", "lsc40"}; -+ -+ const char *L_rate[8] = {"6M", "9M", "12M", "18M", "24M", "36M", "48M", "54M"}; -+ -+ -+ /* -+ const double evm_comp_20M = 0.579919469776867; //10*log10(64.0/56.0) -+ const double evm_comp_40M = 0.503051183113957; //10*log10(128.0/114.0) -+ const double evm_comp_80M = 0.244245993314183; //10*log10(256.0/242.0) -+ const double evm_comp_160M = 0.244245993314183; //10*log10(512.0/484.0) -+ */ -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ return; -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s\n", "BB Report Info"); -+ DCMD_Printf(BbDbgBuf); -+ -+ /*BW & Mode Detection*/ -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf80 , bMaskDWord); -+ value32_2 = value32; -+ RX_HT_BW = (u1Byte)(value32 & 0x1); -+ RX_VHT_BW = (u1Byte)((value32 >> 1) & 0x3); -+ RXSC = (u1Byte)(value32 & 0x78); -+ value32_1 = (value32 & 0x180) >> 7; -+ RX_HT = (u1Byte)(value32_1); -+ /* -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "F80", value32_2); -+ DCMD_Printf(BbDbgBuf); -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "RX_HT_BW", RX_HT_BW); -+ DCMD_Printf(BbDbgBuf); -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "RX_VHT_BW", RX_VHT_BW); -+ DCMD_Printf(BbDbgBuf); -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "RX_SC", RXSC); -+ DCMD_Printf(BbDbgBuf); -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "RX_HT", RX_HT); -+ DCMD_Printf(BbDbgBuf); -+ */ -+ -+ /*rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n RX_HT:%s ", RXHT_table[RX_HT]);*/ -+ /*DCMD_Printf(BbDbgBuf);*/ -+ RX_BW = 0; -+ -+ if (RX_HT == 2) { -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n Mode: VHT Mode"); -+ DCMD_Printf(BbDbgBuf); -+ if (RX_VHT_BW == 0) { -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, " BW=20M"); -+ DCMD_Printf(BbDbgBuf); -+ } else if (RX_VHT_BW == 1) { -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, " BW=40M"); -+ DCMD_Printf(BbDbgBuf); -+ } else { -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, " BW=80M"); -+ DCMD_Printf(BbDbgBuf); -+ } -+ RX_BW = RX_VHT_BW; -+ } else if (RX_HT == 1) { -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n Mode: HT Mode"); -+ DCMD_Printf(BbDbgBuf); -+ if (RX_HT_BW == 0) { -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, " BW=20M"); -+ DCMD_Printf(BbDbgBuf); -+ } else if (RX_HT_BW == 1) { -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, " BW=40M"); -+ DCMD_Printf(BbDbgBuf); -+ } -+ RX_BW = RX_HT_BW; -+ } else { -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n Mode: Legeacy Mode"); -+ DCMD_Printf(BbDbgBuf); -+ } -+ -+ if (RX_HT != 0) { -+ if (RXSC == 0) -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n duplicate/full bw"); -+ else if (RXSC == 1) -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n usc20-1"); -+ else if (RXSC == 2) -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n lsc20-1"); -+ else if (RXSC == 3) -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n usc20-2"); -+ else if (RXSC == 4) -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n lsc20-2"); -+ else if (RXSC == 9) -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n usc40"); -+ else if (RXSC == 10) -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n lsc40"); -+ DCMD_Printf(BbDbgBuf); -+ } -+ /* -+ if(RX_HT == 2){ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, " BW:%s", BW_table[RX_VHT_BW]); -+ RX_BW = RX_VHT_BW; -+ } -+ else if(RX_HT == 1){ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, " BW:%s", BW_table[RX_HT_BW]); -+ RX_BW = RX_HT_BW; -+ } -+ else -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, ""); -+ -+ DCMD_Printf(BbDbgBuf); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, " RXSC:%s", RXSC_table[RXSC]); -+ DCMD_Printf(BbDbgBuf); -+ */ -+ -+ -+/* rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "dB Conversion: 10log(65)", ODM_PWdB_Conversion(65,10,0));*/ -+/* DCMD_Printf(BbDbgBuf);*/ -+ -+ /* RX signal power and AGC related info*/ -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF90 , bMaskDWord); -+ pwDB = (u1Byte)((value32 & bMaskByte1) >> 8); -+ pwDB = pwDB >> 1; -+ sig_power = -110 + pwDB; -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "OFDM RX Signal Power(dB)", sig_power); -+ DCMD_Printf(BbDbgBuf); -+ -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xd14 , bMaskDWord); -+ RX_SNR_pathA = (u1Byte)(value32 & 0xFF) >> 1; -+ RF_gain_pathA = (s1Byte)((value32 & bMaskByte1) >> 8); -+ RF_gain_pathA *= 2; -+ value32 = ODM_GetBBReg(pDM_Odm, 0xd54 , bMaskDWord); -+ RX_SNR_pathB = (u1Byte)(value32 & 0xFF) >> 1; -+ RF_gain_pathB = (s1Byte)((value32 & bMaskByte1) >> 8); -+ RF_gain_pathB *= 2; -+ value32 = ODM_GetBBReg(pDM_Odm, 0xd94 , bMaskDWord); -+ RX_SNR_pathC = (u1Byte)(value32 & 0xFF) >> 1; -+ RF_gain_pathC = (s1Byte)((value32 & bMaskByte1) >> 8); -+ RF_gain_pathC *= 2; -+ value32 = ODM_GetBBReg(pDM_Odm, 0xdd4 , bMaskDWord); -+ RX_SNR_pathD = (u1Byte)(value32 & 0xFF) >> 1; -+ RF_gain_pathD = (s1Byte)((value32 & bMaskByte1) >> 8); -+ RF_gain_pathD *= 2; -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "OFDM RX RF Gain(A/B/C/D)", RF_gain_pathA, RF_gain_pathA, RF_gain_pathC, RF_gain_pathD); -+ DCMD_Printf(BbDbgBuf); -+ -+ -+ /* RX Counter related info*/ -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF08, bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "OFDM CCA Counter", ((value32&0xFFFF0000)>>16)); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xFD0, bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "OFDM SBD Fail Counter", value32&0xFFFF); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xFC4, bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d", "VHT SIGA/SIGB CRC8 Fail Counter", value32&0xFFFF, ((value32&0xFFFF0000)>>16)); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xFCC, bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "CCK CCA Counter", value32&0xFFFF); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xFBC, bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d", "LSIG (\"Parity Fail\"/\"Rate Illegal\") Counter", value32&0xFFFF, ((value32&0xFFFF0000)>>16)); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32_1 = ODM_GetBBReg(pDM_Odm, 0xFC8, bMaskDWord); -+ value32_2 = ODM_GetBBReg(pDM_Odm, 0xFC0, bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d", "HT/VHT MCS NOT SUPPORT counter", ((value32_2&0xFFFF0000)>>16), value32_1&0xFFFF); -+ DCMD_Printf(BbDbgBuf); -+ -+ -+ /* PostFFT related info*/ -+ -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF8c , bMaskDWord); -+ RXEVM_0 = (s1Byte)((value32 & bMaskByte2) >> 16); -+ RXEVM_0 /= 2; -+ if (RXEVM_0 < -63) -+ RXEVM_0 = 0; -+ -+ DCMD_Printf(BbDbgBuf); -+ RXEVM_1 = (s1Byte)((value32 & bMaskByte3) >> 24); -+ RXEVM_1 /= 2; -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF88 , bMaskDWord); -+ RXEVM_2 = (s1Byte)((value32 & bMaskByte2) >> 16); -+ RXEVM_2 /= 2; -+ -+ if (RXEVM_1 < -63) -+ RXEVM_1 = 0; -+ if (RXEVM_2 < -63) -+ RXEVM_2 = 0; -+ -+ /* -+ if(RX_BW == 0){ -+ RXEVM_0 -= evm_comp_20M; -+ RXEVM_1 -= evm_comp_20M; -+ RXEVM_2 -= evm_comp_20M; -+ } -+ else if(RX_BW == 1){ -+ RXEVM_0 -= evm_comp_40M; -+ RXEVM_1 -= evm_comp_40M; -+ RXEVM_2 -= evm_comp_40M; -+ } -+ else if (RX_BW == 2){ -+ RXEVM_0 -= evm_comp_80M; -+ RXEVM_1 -= evm_comp_80M; -+ RXEVM_2 -= evm_comp_80M; -+ } -+ */ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d", "RXEVM (1ss/2ss/3ss)", RXEVM_0, RXEVM_1, RXEVM_2); -+ DCMD_Printf(BbDbgBuf); -+ -+/* value32 = ODM_GetBBReg(pDM_Odm, 0xD14 ,bMaskDWord);*/ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "RXSNR(A/B/C/D, dB)", RX_SNR_pathA, RX_SNR_pathB, RX_SNR_pathC, RX_SNR_pathD); -+ DCMD_Printf(BbDbgBuf); -+/* rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "B_RXSNR", (value32&0xFF00)>>9);*/ -+/* DCMD_Printf(BbDbgBuf);*/ -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF8C , bMaskDWord); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d", "CSI_1st /CSI_2nd", value32&0xFFFF, ((value32&0xFFFF0000)>>16)); -+ DCMD_Printf(BbDbgBuf); -+ -+ -+ //BW & Mode Detection -+ -+ //Reset Page F Counter -+ ODM_SetBBReg(pDM_Odm, 0xB58 , BIT0, 1); -+ ODM_SetBBReg(pDM_Odm, 0xB58 , BIT0, 0); -+ -+ //CFO Report Info -+ //Short CFO -+ value32 = ODM_GetBBReg(pDM_Odm, 0xd0c , bMaskDWord); -+ value32_1 = ODM_GetBBReg(pDM_Odm, 0xd4c , bMaskDWord); -+ value32_2 = ODM_GetBBReg(pDM_Odm, 0xd8c , bMaskDWord); -+ value32_3 = ODM_GetBBReg(pDM_Odm, 0xdcc , bMaskDWord); -+ -+ SFO_A = (s4Byte)(value32 & bMask12Bits); -+ SFO_B = (s4Byte)(value32_1 & bMask12Bits); -+ SFO_C = (s4Byte)(value32_2 & bMask12Bits); -+ SFO_D = (s4Byte)(value32_3 & bMask12Bits); -+ -+ LFO_A = (s4Byte)(value32 >> 16); -+ LFO_B = (s4Byte)(value32_1 >> 16); -+ LFO_C = (s4Byte)(value32_2 >> 16); -+ LFO_D = (s4Byte)(value32_3 >> 16); -+ -+ //SFO 2's to dec -+ if (SFO_A > 2047) -+ SFO_A = SFO_A - 4096; -+ SFO_A = (SFO_A * 312500) / 2048; -+ -+ if (SFO_B > 2047) -+ SFO_B = SFO_B - 4096; -+ SFO_B = (SFO_B * 312500) / 2048; -+ if (SFO_C > 2047) -+ SFO_C = SFO_C - 4096; -+ SFO_C = (SFO_C * 312500) / 2048; -+ if (SFO_D > 2047) -+ SFO_D = SFO_D - 4096; -+ SFO_D = (SFO_D * 312500) / 2048; -+ -+ //LFO 2's to dec -+ -+ if (LFO_A > 4095) -+ LFO_A = LFO_A - 8192; -+ -+ if (LFO_B > 4095) -+ LFO_B = LFO_B - 8192; -+ -+ if (LFO_C > 4095) -+ LFO_C = LFO_C - 8192; -+ -+ if (LFO_D > 4095) -+ LFO_D = LFO_D - 8192; -+ LFO_A = LFO_A * 312500 / 4096; -+ LFO_B = LFO_B * 312500 / 4096; -+ LFO_C = LFO_C * 312500 / 4096; -+ LFO_D = LFO_D * 312500 / 4096; -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "CFO Report Info"); -+ DCMD_Printf(BbDbgBuf); -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d/ %d/ %d", " Short CFO(Hz) ", SFO_A, SFO_B, SFO_C, SFO_D); -+ DCMD_Printf(BbDbgBuf); -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d/ %d/ %d", " Long CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D); -+ DCMD_Printf(BbDbgBuf); -+ -+ //SCFO -+ value32 = ODM_GetBBReg(pDM_Odm, 0xd10 , bMaskDWord); -+ value32_1 = ODM_GetBBReg(pDM_Odm, 0xd50 , bMaskDWord); -+ value32_2 = ODM_GetBBReg(pDM_Odm, 0xd90 , bMaskDWord); -+ value32_3 = ODM_GetBBReg(pDM_Odm, 0xdd0 , bMaskDWord); -+ -+ SFO_A = (s4Byte)(value32 & 0x7ff); -+ SFO_B = (s4Byte)(value32_1 & 0x7ff); -+ SFO_C = (s4Byte)(value32_2 & 0x7ff); -+ SFO_D = (s4Byte)(value32_3 & 0x7ff); -+ -+ if (SFO_A > 1023) -+ SFO_A = SFO_A - 2048; -+ -+ if (SFO_B > 2047) -+ SFO_B = SFO_B - 4096; -+ -+ if (SFO_C > 2047) -+ SFO_C = SFO_C - 4096; -+ -+ if (SFO_D > 2047) -+ SFO_D = SFO_D - 4096; -+ -+ SFO_A = SFO_A * 312500 / 1024; -+ SFO_B = SFO_B * 312500 / 1024; -+ SFO_C = SFO_C * 312500 / 1024; -+ SFO_D = SFO_D * 312500 / 1024; -+ -+ LFO_A = (s4Byte)(value32 >> 16); -+ LFO_B = (s4Byte)(value32_1 >> 16); -+ LFO_C = (s4Byte)(value32_2 >> 16); -+ LFO_D = (s4Byte)(value32_3 >> 16); -+ -+ if (LFO_A > 4095) -+ LFO_A = LFO_A - 8192; -+ -+ if (LFO_B > 4095) -+ LFO_B = LFO_B - 8192; -+ -+ if (LFO_C > 4095) -+ LFO_C = LFO_C - 8192; -+ -+ if (LFO_D > 4095) -+ LFO_D = LFO_D - 8192; -+ LFO_A = LFO_A * 312500 / 4096; -+ LFO_B = LFO_B * 312500 / 4096; -+ LFO_C = LFO_C * 312500 / 4096; -+ LFO_D = LFO_D * 312500 / 4096; -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d/ %d/ %d", " Value SCFO(Hz) ", SFO_A, SFO_B, SFO_C, SFO_D); -+ DCMD_Printf(BbDbgBuf); -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d/ %d/ %d", " ACQ CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xd14 , bMaskDWord); -+ value32_1 = ODM_GetBBReg(pDM_Odm, 0xd54 , bMaskDWord); -+ value32_2 = ODM_GetBBReg(pDM_Odm, 0xd94 , bMaskDWord); -+ value32_3 = ODM_GetBBReg(pDM_Odm, 0xdd4 , bMaskDWord); -+ -+ LFO_A = (s4Byte)(value32 >> 16); -+ LFO_B = (s4Byte)(value32_1 >> 16); -+ LFO_C = (s4Byte)(value32_2 >> 16); -+ LFO_D = (s4Byte)(value32_3 >> 16); -+ -+ if (LFO_A > 4095) -+ LFO_A = LFO_A - 8192; -+ -+ if (LFO_B > 4095) -+ LFO_B = LFO_B - 8192; -+ -+ if (LFO_C > 4095) -+ LFO_C = LFO_C - 8192; -+ -+ if (LFO_D > 4095) -+ LFO_D = LFO_D - 8192; -+ -+ LFO_A = LFO_A * 312500 / 4096; -+ LFO_B = LFO_B * 312500 / 4096; -+ LFO_C = LFO_C * 312500 / 4096; -+ LFO_D = LFO_D * 312500 / 4096; -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d/ %d/ %d", " End CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf20 , bMaskDWord); /*L SIG*/ -+ -+ Tail = (u1Byte)((value32 & 0xfc0000) >> 16); -+ Parity = (u1Byte)((value32 & 0x20000) >> 16); -+ Length = (u2Byte)((value32 & 0x1ffe00) >> 8); -+ rsv = (u1Byte)(value32 & 0x10); -+ MCSS = (u1Byte)(value32 & 0x0f); -+ -+ switch (MCSS) { -+ case 0x0b: -+ idx = 0; -+ break; -+ case 0x0f: -+ idx = 1; -+ break; -+ case 0x0a: -+ idx = 2; -+ break; -+ case 0x0e: -+ idx = 3; -+ break; -+ case 0x09: -+ idx = 4; -+ break; -+ case 0x08: -+ idx = 5; -+ break; -+ case 0x0c: -+ idx = 6; -+ break; -+ default: -+ idx = 6; -+ break; -+ -+ } -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "L-SIG"); -+ DCMD_Printf(BbDbgBuf); -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n Rate:%s", L_rate[idx]); -+ DCMD_Printf(BbDbgBuf); -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %x/ %x /%x", " Rsv/Length/Parity", rsv, RX_BW, Length); -+ DCMD_Printf(BbDbgBuf); -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "HT-SIG1"); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf2c , bMaskDWord); /*HT SIG*/ -+ if (RX_HT == 1) { -+ -+ HMCSS = (u1Byte)(value32 & 0x7F); -+ HRX_BW = (u1Byte)(value32 & 0x80); -+ HLength = (u2Byte)((value32 >> 8) & 0xffff); -+ } -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %x / %x/ %x", " MCS/BW/Length", HMCSS, HRX_BW, HLength); -+ DCMD_Printf(BbDbgBuf); -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "HT-SIG2"); -+ DCMD_Printf(BbDbgBuf); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf30 , bMaskDWord); /*HT SIG*/ -+ -+ if (RX_HT == 1) { -+ smooth = (u1Byte)(value32 & 0x01); -+ htsound = (u1Byte)(value32 & 0x02); -+ rsv = (u1Byte)(value32 & 0x04); -+ agg = (u1Byte)(value32 & 0x08); -+ stbc = (u1Byte)(value32 & 0x30); -+ fec = (u1Byte)(value32 & 0x40); -+ sgi = (u1Byte)(value32 & 0x80); -+ htltf = (u1Byte)((value32 & 0x300) >> 8); -+ htcrc8 = (u2Byte)((value32 & 0x3fc00) >> 8); -+ Tail = (u1Byte)((value32 & 0xfc0000) >> 16); -+ -+ -+ } -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %x / %x/ %x/ %x/ %x/ %x", " Smooth/NoSound/Rsv/Aggregate/STBC/LDPC", smooth, htsound, rsv, agg, stbc, fec); -+ DCMD_Printf(BbDbgBuf); -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %x / %x/ %x/ %x", " SGI/E-HT-LTFs/CRC/Tail", sgi, htltf, htcrc8, Tail); -+ DCMD_Printf(BbDbgBuf); -+ -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "VHT-SIG-A1"); -+ DCMD_Printf(BbDbgBuf); -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf2c , bMaskDWord); /*VHT SIG A1*/ -+ if (RX_HT == 2) { -+ /* value32 = ODM_GetBBReg(pDM_Odm, 0xf2c ,bMaskDWord);*/ -+ vRX_BW = (u1Byte)(value32 & 0x03); -+ vrsv = (u1Byte)(value32 & 0x04); -+ vstbc = (u1Byte)(value32 & 0x08); -+ vgid = (u1Byte)((value32 & 0x3f0) >> 4); -+ vNsts = (u1Byte)(((value32 & 0x1c00) >> 8) + 1); -+ vpaid = (u2Byte)(value32 & 0x3fe); -+ vtxops = (u1Byte)((value32 & 0x400000) >> 20); -+ vrsv2 = (u1Byte)((value32 & 0x800000) >> 20); -+ } -+ -+ /*rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %x", "F2C", value32);*/ -+ /*DCMD_Printf(BbDbgBuf);*/ -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %x / %x/ %x/ %x/ %x/ %x /%x /%x", " BW/Rsv1/STBC/GID/Nsts/PAID/TXOPPS/Rsv2", vRX_BW, vrsv, vstbc, vgid, vNsts, vpaid, vtxops, vrsv2); -+ DCMD_Printf(BbDbgBuf); -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "VHT-SIG-A2"); -+ DCMD_Printf(BbDbgBuf); -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf30 , bMaskDWord); /*VHT SIG*/ -+ -+ -+ if (RX_HT == 2) { -+ /*value32 = ODM_GetBBReg(pDM_Odm, 0xf30 ,bMaskDWord); */ /*VHT SIG*/ -+ -+ //sgi=(u1Byte)(value32&0x01); -+ sgiext = (u1Byte)(value32 & 0x03); -+ //fec = (u1Byte)(value32&0x04); -+ fecext = (u1Byte)(value32 & 0x0C); -+ -+ vMCSS = (u1Byte)(value32 & 0xf0); -+ bf = (u1Byte)((value32 & 0x100) >> 8); -+ vrsv = (u1Byte)((value32 & 0x200) >> 8); -+ vhtcrc8 = (u2Byte)((value32 & 0x3fc00) >> 8); -+ vTail = (u1Byte)((value32 & 0xfc0000) >> 16); -+ } -+ /*rsprintf(BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %x", "F30", value32);*/ -+ /*DCMD_Printf(BbDbgBuf);*/ -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %x / %x/ %x/ %x/ %x/ %x/ %x", " SGI/FEC/MCS/BF/Rsv/CRC/Tail", sgiext, fecext, vMCSS, bf, vrsv, vhtcrc8, vTail); -+ DCMD_Printf(BbDbgBuf); -+ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "VHT-SIG-B"); -+ DCMD_Printf(BbDbgBuf); -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf34 , bMaskDWord); /*VHT SIG*/ -+ { -+ vLength = (u2Byte)(value32 & 0x1fffff); -+ vbrsv = (u1Byte)((value32 & 0x600000) >> 20); -+ vbTail = (u2Byte)((value32 & 0x1f800000) >> 20); -+ vbcrc = (u1Byte)((value32 & 0x80000000) >> 28); -+ -+ } -+ /*rsprintf(BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %x", "F34", value32);*/ -+ /*DCMD_Printf(BbDbgBuf);*/ -+ rsprintf((char *)BbDbgBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %x / %x/ %x/ %x/", " Length/Rsv/Tail/CRC", vLength, vbrsv, vbTail, vbcrc); -+ DCMD_Printf(BbDbgBuf); -+ -+ -+} -+ -+void phydm_sbd_check( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ static u4Byte pkt_cnt = 0; -+ static BOOLEAN sbd_state = 0; -+ u4Byte sym_count, count, value32; -+ -+ if (sbd_state == 0) { -+ pkt_cnt++; -+ if (pkt_cnt % 5 == 0) { /*read SBD conter once every 5 packets*/ -+ ODM_SetTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer, 0); /*ms*/ -+ sbd_state = 1; -+ } -+ } else { /*read counter*/ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF98, bMaskDWord); -+ sym_count = (value32 & 0x7C000000) >> 26; -+ count = (value32 & 0x3F00000) >> 20; -+ DbgPrint("#SBD# sym_count %d count %d\n", sym_count, count); -+ sbd_state = 0; -+ } -+} -+ -+void phydm_sbd_callback( -+ PRT_TIMER pTimer -+) -+{ -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+#if USE_WORKITEM -+ ODM_ScheduleWorkItem(&pDM_Odm->sbdcnt_workitem); -+#else -+ phydm_sbd_check(pDM_Odm); -+#endif -+} -+ -+void phydm_sbd_workitem_callback( -+ IN PVOID pContext -+) -+{ -+ PADAPTER pAdapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ phydm_sbd_check(pDM_Odm); -+} -+#endif -+VOID -+phydm_BasicDbgMessage -+( -+ IN PVOID pDM_VOID -+) -+{ -+#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure(pDM_Odm , PHYDM_FALSEALMCNT); -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ u1Byte legacy_table[12] = {1, 2, 5, 11, 6, 9, 12, 18, 24, 36, 48, 54}; -+ u1Byte vht_en = ((pDM_Odm->RxRate) >= ODM_RATEVHTSS1MCS0) ? 1 : 0; -+ -+ if (pDM_Odm->RxRate <= ODM_RATE11M) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[CCK AGC Report] LNA_idx = 0x%x, VGA_idx = 0x%x\n", -+ pDM_Odm->cck_lna_idx, pDM_Odm->cck_vga_idx)); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[OFDM AGC Report] { 0x%x, 0x%x, 0x%x, 0x%x }\n", -+ pDM_Odm->ofdm_agc_idx[0], pDM_Odm->ofdm_agc_idx[1], pDM_Odm->ofdm_agc_idx[2], pDM_Odm->ofdm_agc_idx[3])); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("RSSI: { %d, %d, %d, %d }, RxRate: { %s%s%s%s%d%s}\n", -+ (pDM_Odm->RSSI_A == 0xff) ? 0 : pDM_Odm->RSSI_A , -+ (pDM_Odm->RSSI_B == 0xff) ? 0 : pDM_Odm->RSSI_B , -+ (pDM_Odm->RSSI_C == 0xff) ? 0 : pDM_Odm->RSSI_C, -+ (pDM_Odm->RSSI_D == 0xff) ? 0 : pDM_Odm->RSSI_D, -+ ((pDM_Odm->RxRate >= ODM_RATEVHTSS1MCS0) && (pDM_Odm->RxRate <= ODM_RATEVHTSS1MCS9)) ? "VHT 1ss " : "", -+ ((pDM_Odm->RxRate >= ODM_RATEVHTSS2MCS0) && (pDM_Odm->RxRate <= ODM_RATEVHTSS2MCS9)) ? "VHT 2ss " : "", -+ ((pDM_Odm->RxRate >= ODM_RATEVHTSS3MCS0) && (pDM_Odm->RxRate <= ODM_RATEVHTSS3MCS9)) ? "VHT 3ss " : "", -+ (pDM_Odm->RxRate >= ODM_RATEMCS0) ? "MCS " : "", -+ (vht_en) ? ((pDM_Odm->RxRate - ODM_RATEVHTSS1MCS0)%10) : ((pDM_Odm->RxRate >= ODM_RATEMCS0) ? (pDM_Odm->RxRate - ODM_RATEMCS0) : ((pDM_Odm->RxRate <= ODM_RATE54M)?legacy_table[pDM_Odm->RxRate]:0)), -+ (pDM_Odm->RxRate >= ODM_RATEMCS0) ? "" : "M")); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", -+ FalseAlmCnt->Cnt_CCK_CCA, FalseAlmCnt->Cnt_OFDM_CCA, FalseAlmCnt->Cnt_CCA_all)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", -+ FalseAlmCnt->Cnt_Cck_fail, FalseAlmCnt->Cnt_Ofdm_fail, FalseAlmCnt->Cnt_all)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[OFDM FA Detail] Parity_Fail = (( %d )), Rate_Illegal = (( %d )), CRC8_fail = (( %d )), Mcs_fail = (( %d )), Fast_Fsync = (( %d )), SB_Search_fail = (( %d ))\n", -+ FalseAlmCnt->Cnt_Parity_Fail, FalseAlmCnt->Cnt_Rate_Illegal, FalseAlmCnt->Cnt_Crc8_fail, FalseAlmCnt->Cnt_Mcs_fail, FalseAlmCnt->Cnt_Fast_Fsync, FalseAlmCnt->Cnt_SB_Search_fail)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("bLinked = %d, RSSI_Min = %d, CurrentIGI = 0x%x, bNoisy=%d\n\n", -+ pDM_Odm->bLinked, pDM_Odm->RSSI_Min, pDM_DigTable->CurIGValue, pDM_Odm->NoisyDecision)); -+/* -+ temp_reg = ODM_GetBBReg(pDM_Odm, 0xDD0, bMaskByte0); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xDD0 = 0x%x\n",temp_reg)); -+ -+ temp_reg = ODM_GetBBReg(pDM_Odm, 0xDDc, bMaskByte1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xDDD = 0x%x\n",temp_reg)); -+ -+ temp_reg = ODM_GetBBReg(pDM_Odm, 0xc50, bMaskByte0); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xC50 = 0x%x\n",temp_reg)); -+ -+ temp_reg = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x0, 0x3fe0); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("RF 0x0[13:5] = 0x%x\n\n",temp_reg)); -+*/ -+ -+#endif -+} -+ -+ -+VOID phydm_BasicProfile( -+ IN PVOID pDM_VOID, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ char *Cut = NULL; -+ char *ICType = NULL; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ u4Byte commit_ver = 0; -+ u4Byte date = 0; -+ char *commit_by = NULL; -+ u4Byte release_ver = 0; -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "% Basic Profile %")); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8192C) -+ ICType = "RTL8192C"; -+ else if (pDM_Odm->SupportICType == ODM_RTL8192D) -+ ICType = "RTL8192D"; -+ else if (pDM_Odm->SupportICType == ODM_RTL8723A) -+ ICType = "RTL8723A"; -+ else if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ ICType = "RTL8188E"; -+ else if (pDM_Odm->SupportICType == ODM_RTL8812) -+ ICType = "RTL8812A"; -+ else if (pDM_Odm->SupportICType == ODM_RTL8821) -+ ICType = "RTL8821A"; -+ else if (pDM_Odm->SupportICType == ODM_RTL8192E) -+ ICType = "RTL8192E"; -+ else if (pDM_Odm->SupportICType == ODM_RTL8723B) -+ ICType = "RTL8723B"; -+ else if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ ICType = "RTL8814A"; -+ else if (pDM_Odm->SupportICType == ODM_RTL8881A) -+ ICType = "RTL8881A"; -+ else if (pDM_Odm->SupportICType == ODM_RTL8821B) -+ ICType = "RTL8821B"; -+ else if (pDM_Odm->SupportICType == ODM_RTL8822B) -+ ICType = "RTL8822B"; -+ else if (pDM_Odm->SupportICType == ODM_RTL8703B) { -+ #if (RTL8703B_SUPPORT == 1) -+ ICType = "RTL8703B"; -+ commit_ver = SVN_COMMIT_VERSION_8703B; -+ date = RELEASE_DATE_8703B; -+ commit_by = COMMIT_BY_8703B; -+ release_ver = RELEASE_VERSION_8703B; -+ #endif -+ } else if (pDM_Odm->SupportICType == ODM_RTL8195A) -+ ICType = "RTL8195A"; -+ else if (pDM_Odm->SupportICType == ODM_RTL8188F) -+ ICType = "RTL8188F"; -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s (MP Chip: %s)\n", "IC Type", ICType, pDM_Odm->bIsMPChip ? "Yes" : "No")); -+ -+ if (pDM_Odm->CutVersion == ODM_CUT_A) -+ Cut = "A"; -+ else if (pDM_Odm->CutVersion == ODM_CUT_B) -+ Cut = "B"; -+ else if (pDM_Odm->CutVersion == ODM_CUT_C) -+ Cut = "C"; -+ else if (pDM_Odm->CutVersion == ODM_CUT_D) -+ Cut = "D"; -+ else if (pDM_Odm->CutVersion == ODM_CUT_E) -+ Cut = "E"; -+ else if (pDM_Odm->CutVersion == ODM_CUT_F) -+ Cut = "F"; -+ else if (pDM_Odm->CutVersion == ODM_CUT_I) -+ Cut = "I"; -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Cut Version", Cut)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Parameter Version", ODM_GetHWImgVersion(pDM_Odm))); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Parameter Commit Version", commit_ver)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Parameter Commit date", date)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY Parameter Commit by", commit_by)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Parameter Release Version", release_ver)); -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ { -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Version", Adapter->MgntInfo.FirmwareVersion, Adapter->MgntInfo.FirmwareSubVersion)); -+ } -+#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ { -+ struct rtl8192cd_priv *priv = pDM_Odm->priv; -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Version", priv->pshare->fw_version, priv->pshare->fw_sub_version)); -+ } -+#else -+ { -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Version", pHalData->FirmwareVersion, pHalData->FirmwareSubVersion)); -+ } -+#endif -+ //1 PHY DM Version List -+ PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "% PHYDM Version %")); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Adaptivity", ADAPTIVITY_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "DIG", DIG_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Dynamic BB PowerSaving", DYNAMIC_BBPWRSAV_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "CFO Tracking", CFO_TRACKING_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Antenna Diversity", ANTDIV_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Power Tracking", POWRTRACKING_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Dynamic TxPower", DYNAMIC_TXPWR_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "RA Info", RAINFO_VERSION)); -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Antenna Detection", ANTDECT_VERSION)); -+#endif -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Auto Channel Selection", ACS_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "EDCA Turbo", EDCATURBO_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Path Diversity", PATHDIV_VERSION)); -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "RxHP", RXHP_VERSION)); -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY config 8822B", PHY_CONFIG_VERSION_8822B)); -+ -+#endif -+ *_used = used; -+ *_out_len = out_len; -+ -+} -+ -+VOID -+phydm_fw_trace_en_h2c( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN enable, -+ IN u4Byte monitor_mode, -+ IN u4Byte macid -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte H2C_Parameter[3] = {0}; -+ -+ H2C_Parameter[0] = enable; -+ H2C_Parameter[1] = (u1Byte)monitor_mode; -+ H2C_Parameter[2] = (u1Byte)macid; -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("---->\n")); -+ if (monitor_mode == 0){ -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[H2C] FW_debug_en: (( %d ))\n", enable)); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[H2C] FW_debug_en: (( %d )), mode: (( %d )), macid: (( %d ))\n", enable, monitor_mode, macid)); -+ } -+ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_FW_TRACE_EN, 3, H2C_Parameter); -+} -+ -+VOID -+phydm_get_per_path_txagc( -+ IN PVOID pDM_VOID, -+ IN u1Byte path, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte rate_idx; -+ u1Byte txagc; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+#if (RTL8822B_SUPPORT == 1) -+ if ((pDM_Odm->SupportICType & ODM_RTL8822B) && (path <= ODM_RF_PATH_B)) { -+ for (rate_idx = 0; rate_idx <= 0x53; rate_idx++) { -+ if (rate_idx == ODM_RATE1M) -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s\n", "CCK====>")); -+ else if (rate_idx == ODM_RATE6M) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "OFDM====>")); -+ else if (rate_idx == ODM_RATEMCS0) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 1ss====>")); -+ else if (rate_idx == ODM_RATEMCS8) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 2ss====>")); -+ else if (rate_idx == ODM_RATEMCS16) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 3ss====>")); -+ else if (rate_idx == ODM_RATEMCS24) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 4ss====>")); -+ else if (rate_idx == ODM_RATEVHTSS1MCS0) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 1ss====>")); -+ else if (rate_idx == ODM_RATEVHTSS2MCS0) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 2ss====>")); -+ else if (rate_idx == ODM_RATEVHTSS3MCS0) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 3ss====>")); -+ else if (rate_idx == ODM_RATEVHTSS4MCS0) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 4ss====>")); -+ -+ txagc = config_phydm_read_txagc_8822b(pDM_Odm, path, rate_idx); -+ if (config_phydm_read_txagc_check_8822b(txagc)) -+ PHYDM_SNPRINTF((output + used, out_len - used, " 0x%02x ", txagc)); -+ else -+ PHYDM_SNPRINTF((output + used, out_len - used, " 0x%s ", "xx")); -+ } -+ } -+#endif -+} -+ -+ -+VOID -+phydm_get_txagc( -+ IN PVOID pDM_VOID, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ /* Path-A */ -+ PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "Path-A====================")); -+ phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_A, _used, output, _out_len); -+ -+ /* Path-B */ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "Path-B====================")); -+ phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_B, _used, output, _out_len); -+ -+ /* Path-C */ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "Path-C====================")); -+ phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_C, _used, output, _out_len); -+ -+ /* Path-D */ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "Path-D====================")); -+ phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_D, _used, output, _out_len); -+ -+} -+ -+VOID -+phydm_set_txagc( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) { -+ if (dm_value[0] <= 1) { -+ if (phydm_write_txagc_1byte_8822b(pDM_Odm, dm_value[2], dm_value[0], (u1Byte)dm_value[1])) -+ PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s%x\n", "Write path-", dm_value[0], "rate index-0x", dm_value[1], " = 0x", dm_value[2])); -+ else -+ PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s\n", "Write path-", (dm_value[0] & 0x1), "rate index-0x", (dm_value[1] & 0x7f), " fail")); -+ } else { -+ PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s\n", "Write path-", (dm_value[0] & 0x1), "rate index-0x", (dm_value[1] & 0x7f), " fail")); -+ } -+ } -+#endif -+} -+ -+VOID -+odm_debug_trace( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u8Byte pre_debug_components, one = 1; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ pre_debug_components = pDM_Odm->DebugComponents; -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n%s\n", "================================")); -+ if (dm_value[0] == 100) { -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Debug Message] PhyDM Selection")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "00. (( %s ))DIG\n", ((pDM_Odm->DebugComponents & ODM_COMP_DIG) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))RA_MASK\n", ((pDM_Odm->DebugComponents & ODM_COMP_RA_MASK) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))DYNAMIC_TXPWR\n", ((pDM_Odm->DebugComponents & ODM_COMP_DYNAMIC_TXPWR) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))FA_CNT\n", ((pDM_Odm->DebugComponents & ODM_COMP_FA_CNT) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "04. (( %s ))RSSI_MONITOR\n", ((pDM_Odm->DebugComponents & ODM_COMP_RSSI_MONITOR) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "05. (( %s ))CCK_PD\n", ((pDM_Odm->DebugComponents & ODM_COMP_CCK_PD) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "06. (( %s ))ANT_DIV\n", ((pDM_Odm->DebugComponents & ODM_COMP_ANT_DIV) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "07. (( %s ))PWR_SAVE\n", ((pDM_Odm->DebugComponents & ODM_COMP_PWR_SAVE) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "08. (( %s ))PWR_TRAIN\n", ((pDM_Odm->DebugComponents & ODM_COMP_PWR_TRAIN) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "09. (( %s ))RATE_ADAPTIVE\n", ((pDM_Odm->DebugComponents & ODM_COMP_RATE_ADAPTIVE) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "10. (( %s ))PATH_DIV\n", ((pDM_Odm->DebugComponents & ODM_COMP_PATH_DIV) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "11. (( %s ))PSD\n", ((pDM_Odm->DebugComponents & ODM_COMP_PSD) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "12. (( %s ))DYNAMIC_PRICCA\n", ((pDM_Odm->DebugComponents & ODM_COMP_DYNAMIC_PRICCA) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "13. (( %s ))RXHP\n", ((pDM_Odm->DebugComponents & ODM_COMP_RXHP) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "14. (( %s ))MP\n", ((pDM_Odm->DebugComponents & ODM_COMP_MP) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "15. (( %s ))CFO_TRACKING\n", ((pDM_Odm->DebugComponents & ODM_COMP_CFO_TRACKING) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "16. (( %s ))ACS\n", ((pDM_Odm->DebugComponents & ODM_COMP_ACS) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "17. (( %s ))ADAPTIVITY\n", ((pDM_Odm->DebugComponents & PHYDM_COMP_ADAPTIVITY) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "18. (( %s ))RA_DBG\n", ((pDM_Odm->DebugComponents & PHYDM_COMP_RA_DBG) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "20. (( %s ))EDCA_TURBO\n", ((pDM_Odm->DebugComponents & ODM_COMP_EDCA_TURBO) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "21. (( %s ))EARLY_MODE\n", ((pDM_Odm->DebugComponents & ODM_COMP_EARLY_MODE) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "22. (( %s ))FW_DEBUG_TRACE\n", ((pDM_Odm->DebugComponents & ODM_FW_DEBUG_TRACE) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "24. (( %s ))TX_PWR_TRACK\n", ((pDM_Odm->DebugComponents & ODM_COMP_TX_PWR_TRACK) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "25. (( %s ))RX_GAIN_TRACK\n", ((pDM_Odm->DebugComponents & ODM_COMP_RX_GAIN_TRACK) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "26. (( %s ))CALIBRATION\n", ((pDM_Odm->DebugComponents & ODM_COMP_CALIBRATION) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "28. (( %s ))PHY_CONFIG\n", ((pDM_Odm->DebugComponents & ODM_PHY_CONFIG) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "29. (( %s ))BEAMFORMING_DEBUG\n", ((pDM_Odm->DebugComponents & BEAMFORMING_DEBUG) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "30. (( %s ))COMMON\n", ((pDM_Odm->DebugComponents & ODM_COMP_COMMON) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "31. (( %s ))INIT\n", ((pDM_Odm->DebugComponents & ODM_COMP_INIT) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); -+ -+ } else if (dm_value[0] == 101) { -+ pDM_Odm->DebugComponents = 0; -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "Disable all debug components")); -+ } else { -+ if (dm_value[1] == 1) { /*enable*/ -+ pDM_Odm->DebugComponents |= (one << dm_value[0]); -+ -+ if (dm_value[0] == 22) { /*FW trace function*/ -+ phydm_fw_trace_en_h2c(pDM_Odm, 1, dm_value[2], dm_value[3]); /*H2C to enable C2H Msg*/ -+ } -+ } else if (dm_value[1] == 2) { /*disable*/ -+ pDM_Odm->DebugComponents &= ~(one << dm_value[0]); -+ -+ if (dm_value[0] == 22) { /*FW trace function*/ -+ phydm_fw_trace_en_h2c(pDM_Odm, 0, dm_value[2], dm_value[3]); /*H2C to disable C2H Msg*/ -+ } -+ } else -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Warning!!!] 1:enable, 2:disable")); -+ } -+ PHYDM_SNPRINTF((output + used, out_len - used, "pre-DbgComponents = 0x%x\n", (u4Byte)pre_debug_components)); -+ PHYDM_SNPRINTF((output + used, out_len - used, "Curr-DbgComponents = 0x%x\n", ((u4Byte)pDM_Odm->DebugComponents))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); -+} -+ -+VOID -+phydm_DumpBbReg( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte Addr = 0; -+ -+ /* BB Reg */ -+ for (Addr = 0x800; Addr < 0xfff; Addr += 4) -+ DbgPrint("%04x %08x\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord)); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8814A)) { -+ -+ if (pDM_Odm->RFType > ODM_2T2R) { -+ for (Addr = 0x1800; Addr < 0x18ff; Addr += 4) -+ DbgPrint("%04x %08x\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord)); -+ } -+ -+ if (pDM_Odm->RFType > ODM_3T3R) { -+ for (Addr = 0x1a00; Addr < 0x1aff; Addr += 4) -+ DbgPrint("%04x %08x\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord)); -+ } -+ -+ for (Addr = 0x1900; Addr < 0x19ff; Addr += 4) -+ DbgPrint("%04x %08x\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord)); -+ -+ for (Addr = 0x1c00; Addr < 0x1cff; Addr += 4) -+ DbgPrint("%04x %08x\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord)); -+ -+ for (Addr = 0x1f00; Addr < 0x1fff; Addr += 4) -+ DbgPrint("%04x %08x\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord)); -+ } -+} -+ -+VOID -+phydm_DumpAllReg( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte Addr = 0; -+ -+ /* dump MAC register */ -+ DbgPrint("MAC==========\n"); -+ for (Addr = 0; Addr < 0x7ff; Addr += 4) -+ DbgPrint("%04x %08x\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord)); -+ -+ for (Addr = 1000; Addr < 0x17ff; Addr += 4) -+ DbgPrint("%04x %08x\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord)); -+ -+ /* dump BB register */ -+ DbgPrint("BB==========\n"); -+ phydm_DumpBbReg(pDM_Odm); -+ -+ /* dump RF register */ -+ DbgPrint("RF-A==========\n"); -+ for (Addr = 0; Addr < 0xFF; Addr++) -+ DbgPrint("%02x %05x\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Addr, bRFRegOffsetMask)); -+ -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ DbgPrint("RF-B==========\n"); -+ for (Addr = 0; Addr < 0xFF; Addr++) -+ DbgPrint("%02x %05x\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, Addr, bRFRegOffsetMask)); -+ } -+ -+ if (pDM_Odm->RFType > ODM_2T2R) { -+ DbgPrint("RF-C==========\n"); -+ for (Addr = 0; Addr < 0xFF; Addr++) -+ DbgPrint("%02x %05x\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_C, Addr, bRFRegOffsetMask)); -+ } -+ -+ if (pDM_Odm->RFType > ODM_3T3R) { -+ DbgPrint("RF-D==========\n"); -+ for (Addr = 0; Addr < 0xFF; Addr++) -+ DbgPrint("%02x %05x\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_D, Addr, bRFRegOffsetMask)); -+ } -+} -+ -+struct _PHYDM_COMMAND { -+ char name[16]; -+ u1Byte id; -+}; -+ -+enum PHYDM_CMD_ID { -+ PHYDM_DEMO, -+ PHYDM_RA, -+ PHYDM_PROFILE, -+ PHYDM_PATHDIV, -+ PHYDM_DEBUG, -+ PHYDM_SUPPORT_ABILITY, -+ PHYDM_GET_TXAGC, -+ PHYDM_SET_TXAGC, -+ PHYDM_SMART_ANT, -+ PHYDM_API, -+ PHYDM_TRX_PATH, -+ PHYDM_LA_MODE, -+ PHYDM_DUMP_REG -+}; -+ -+struct _PHYDM_COMMAND phy_dm_ary[] = { -+ {"demo", PHYDM_DEMO}, -+ {"ra", PHYDM_RA}, -+ {"profile", PHYDM_PROFILE}, -+ {"pathdiv", PHYDM_PATHDIV}, -+ {"dbg", PHYDM_DEBUG}, -+ {"ability", PHYDM_SUPPORT_ABILITY}, -+ {"get_txagc", PHYDM_GET_TXAGC}, -+ {"set_txagc", PHYDM_SET_TXAGC}, -+ {"smtant", PHYDM_SMART_ANT}, -+ {"api", PHYDM_API}, -+ {"trxpath", PHYDM_TRX_PATH}, -+ {"lamode", PHYDM_LA_MODE}, -+ {"dumpreg", PHYDM_DUMP_REG} -+}; -+ -+VOID -+phydm_cmd_parser( -+ IN PDM_ODM_T pDM_Odm, -+ IN char input[][MAX_ARGV], -+ IN u4Byte input_num, -+ IN u1Byte flag, -+ OUT char *output, -+ IN u4Byte out_len -+) -+{ -+ u4Byte used = 0; -+ u1Byte id = 0; -+ int var1[5] = {0}; -+ int i, input_idx = 0; -+ -+ if (flag == 0) { -+ PHYDM_SNPRINTF((output + used, out_len - used, "GET, nothing to print\n")); -+ return; -+ } -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n")); -+ -+ //Parsing Cmd ID -+ if (input_num) { -+ int n, i; -+ -+ n = sizeof(phy_dm_ary) / sizeof(struct _PHYDM_COMMAND); -+ for (i = 0; i < n; i++) { -+ if (strcmp(phy_dm_ary[i].name, input[0]) == 0) { -+ id = phy_dm_ary[i].id; -+ break; -+ } -+ } -+ if (i == n) { -+ PHYDM_SNPRINTF((output + used, out_len - used, "SET, command not found!\n")); -+ return; -+ } -+ } -+ -+ switch (id) { -+ case PHYDM_DEMO: /*echo demo 10 0x3a z abcde >cmd*/ -+ { -+ u4Byte directory = 0; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) -+ char char_temp; -+#else -+ u4Byte char_temp = ' '; -+#endif -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &directory); -+ PHYDM_SNPRINTF((output + used, out_len - used, "Decimal Value = %d\n", directory)); -+ PHYDM_SSCANF(input[2], DCMD_HEX, &directory); -+ PHYDM_SNPRINTF((output + used, out_len - used, "Hex Value = 0x%x\n", directory)); -+ PHYDM_SSCANF(input[3], DCMD_CHAR, &char_temp); -+ PHYDM_SNPRINTF((output + used, out_len - used, "Char = %c\n", char_temp)); -+ PHYDM_SNPRINTF((output + used, out_len - used, "String = %s\n", input[4])); -+ } -+ break; -+ -+ case PHYDM_RA: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "new SET, RA_var[%d]= (( %d ))\n", i , var1[i])); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_RA_debug\n"));*/ -+#if (defined(CONFIG_RA_DBG_CMD)) -+ odm_RA_debug((PVOID)pDM_Odm, var1); -+#endif -+ } -+ -+ -+ break; -+ -+ case PHYDM_PATHDIV: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); -+ -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, PATHDIV_var[%d]= (( %d ))\n", i , var1[i]));*/ -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_PATHDIV_debug\n"));*/ -+#if (defined(CONFIG_PATH_DIVERSITY)) -+ odm_pathdiv_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+#endif -+ } -+ -+ break; -+ -+ case PHYDM_DEBUG: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, Debug_var[%d]= (( %d ))\n", i , var1[i]));*/ -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_debug_comp\n"));*/ -+ odm_debug_trace(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ } -+ -+ -+ break; -+ -+ case PHYDM_SUPPORT_ABILITY: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, support ablity_var[%d]= (( %d ))\n", i , var1[i]));*/ -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "support ablity\n"));*/ -+ phydm_support_ablity_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ } -+ -+ break; -+ -+ case PHYDM_SMART_ANT: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ #if (defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ phydm_hl_smart_ant_cmd(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ #endif -+ #endif -+ } -+ -+ break; -+ -+ case PHYDM_API: -+#if (RTL8822B_SUPPORT == 1) -+ { -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) { -+ BOOLEAN bEnableDbgMode; -+ u1Byte central_ch, primary_ch_idx, bandwidth; -+ -+ for (i = 0; i < 4; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ } -+ -+ bEnableDbgMode = (BOOLEAN)var1[0]; -+ central_ch = (u1Byte) var1[1]; -+ primary_ch_idx = (u1Byte) var1[2]; -+ bandwidth = (ODM_BW_E) var1[3]; -+ -+ if (bEnableDbgMode) { -+ pDM_Odm->bDisablePhyApi = FALSE; -+ config_phydm_switch_channel_bw_8822b(pDM_Odm, central_ch, primary_ch_idx, bandwidth); -+ pDM_Odm->bDisablePhyApi = TRUE; -+ PHYDM_SNPRINTF((output+used, out_len-used, "central_ch = %d, primary_ch_idx = %d, bandwidth = %d\n", central_ch, primary_ch_idx, bandwidth)); -+ } else { -+ pDM_Odm->bDisablePhyApi = FALSE; -+ PHYDM_SNPRINTF((output+used, out_len-used, "Disable API debug mode\n")); -+ } -+ } else -+ PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support PHYDM API function\n")); -+ } -+#else -+ PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support PHYDM API function\n")); -+#endif -+ break; -+ -+ case PHYDM_PROFILE: /*echo profile, >cmd*/ -+ phydm_BasicProfile(pDM_Odm, &used, output, &out_len); -+ break; -+ -+ case PHYDM_GET_TXAGC: -+ phydm_get_txagc(pDM_Odm, &used, output, &out_len); -+ break; -+ -+ case PHYDM_SET_TXAGC: -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, support ablity_var[%d]= (( %d ))\n", i , var1[i]));*/ -+ input_idx++; -+ } -+ } -+ -+ phydm_set_txagc(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ break; -+ -+ case PHYDM_TRX_PATH: -+#if (RTL8822B_SUPPORT == 1) -+ { -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) { -+ u1Byte TxPath, RxPath; -+ BOOLEAN bEnableDbgMode, bTx2Path; -+ -+ for (i = 0; i < 4; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ } -+ -+ bEnableDbgMode = (BOOLEAN)var1[0]; -+ TxPath = (u1Byte) var1[1]; -+ RxPath = (u1Byte) var1[2]; -+ bTx2Path = (BOOLEAN) var1[3]; -+ -+ if (bEnableDbgMode) { -+ pDM_Odm->bDisablePhyApi = FALSE; -+ config_phydm_trx_mode_8822b(pDM_Odm, TxPath, RxPath, bTx2Path); -+ pDM_Odm->bDisablePhyApi = TRUE; -+ PHYDM_SNPRINTF((output+used, out_len-used, "TxPath = 0x%x, RxPath = 0x%x, bTx2Path = %d\n", TxPath, RxPath, bTx2Path)); -+ } else { -+ pDM_Odm->bDisablePhyApi = FALSE; -+ PHYDM_SNPRINTF((output+used, out_len-used, "Disable API debug mode\n")); -+ } -+ } else -+ PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support PHYDM API function\n")); -+ } -+#else -+ PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support PHYDM API function\n")); -+#endif -+ break; -+ -+ case PHYDM_LA_MODE: -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if ((RTL8822B_SUPPORT == 1) || (RTL8814A_SUPPORT == 1)) -+ { -+ if (pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B)) { -+ u2Byte PollingTime; -+ u1Byte TrigSel, TrigSigSel, DmaDataSigSel, TriggerTime; -+ BOOLEAN bEnableLaMode; -+ -+ for (i = 0; i < 6; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ } -+ -+ bEnableLaMode = (BOOLEAN)var1[0]; -+ if (bEnableLaMode) { -+ TrigSel = (u1Byte)var1[1]; -+ TrigSigSel = (u1Byte)var1[2]; -+ DmaDataSigSel = (u1Byte)var1[3]; -+ TriggerTime = (u1Byte)var1[4]; -+ PollingTime = (((u1Byte)var1[5]) << 6); -+ -+ ADCSmp_Set(pDM_Odm->Adapter, TrigSel, TrigSigSel, DmaDataSigSel, TriggerTime, PollingTime); -+ PHYDM_SNPRINTF((output+used, out_len-used, "TrigSel = %d, TrigSigSel = %d, DmaDataSigSel = %d\n", TrigSel, TrigSigSel, DmaDataSigSel)); -+ PHYDM_SNPRINTF((output+used, out_len-used, "TriggerTime = %d, PollingTime = %d\n", TriggerTime, PollingTime)); -+ } else { -+ ADCSmp_Stop(pDM_Odm->Adapter); -+ PHYDM_SNPRINTF((output+used, out_len-used, "Disable LA mode\n")); -+ } -+ } else -+ PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support LA mode\n")); -+ } -+#else -+ PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support LA mode\n")); -+#endif -+#else -+ PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support LA mode\n")); -+#endif -+ break; -+ -+ case PHYDM_DUMP_REG: -+ { -+ u1Byte type = 0; -+ -+ if (input[1]) { -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ type = (u1Byte)var1[0]; -+ } -+ -+ if (type == 0) -+ phydm_DumpBbReg(pDM_Odm); -+ else if (type == 1) -+ phydm_DumpAllReg(pDM_Odm); -+ } -+ break; -+ default: -+ PHYDM_SNPRINTF((output + used, out_len - used, "SET, unknown command!\n")); -+ break; -+ -+ } -+} -+ -+#ifdef __ECOS -+char *strsep(char **s, const char *ct) -+{ -+ char *sbegin = *s; -+ char *end; -+ -+ if (sbegin == NULL) -+ return NULL; -+ -+ end = strpbrk(sbegin, ct); -+ if (end) -+ *end++ = '\0'; -+ *s = end; -+ return sbegin; -+} -+#endif -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) -+s4Byte -+phydm_cmd( -+ IN PDM_ODM_T pDM_Odm, -+ IN char *input, -+ IN u4Byte in_len, -+ IN u1Byte flag, -+ OUT char *output, -+ IN u4Byte out_len -+) -+{ -+ char *token; -+ u4Byte Argc = 0; -+ char Argv[MAX_ARGC][MAX_ARGV]; -+ -+ do { -+ token = strsep(&input, ", "); -+ if (token) { -+ strcpy(Argv[Argc], token); -+ Argc++; -+ } else -+ break; -+ } while (Argc < MAX_ARGC); -+ -+ if (Argc == 1) -+ Argv[0][strlen(Argv[0]) - 1] = '\0'; -+ -+ phydm_cmd_parser(pDM_Odm, Argv, Argc, flag, output, out_len); -+ -+ return 0; -+} -+#endif -+ -+ -+VOID -+phydm_fw_trace_handler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /*u1Byte debug_trace_11byte[60];*/ -+ u1Byte freg_num, c2h_seq, buf_0 = 0; -+ -+ if (CmdLen > 12) -+ return; -+ -+ buf_0 = CmdBuf[0]; -+ freg_num = (buf_0 & 0xf); -+ c2h_seq = (buf_0 & 0xf0) >> 4; -+ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] freg_num = (( %d )), c2h_seq = (( %d ))\n", freg_num,c2h_seq ));*/ -+ -+ /*strncpy(debug_trace_11byte,&CmdBuf[1],(CmdLen-1));*/ -+ /*debug_trace_11byte[CmdLen-1] = '\0';*/ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] %s\n", debug_trace_11byte));*/ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] CmdLen = (( %d ))\n", CmdLen));*/ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] c2h_cmd_start = (( %d ))\n", pDM_Odm->c2h_cmd_start));*/ -+ -+ -+ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("pre_seq = (( %d )), current_seq = (( %d ))\n", pDM_Odm->pre_c2h_seq, c2h_seq));*/ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("fw_buff_is_enpty = (( %d ))\n", pDM_Odm->fw_buff_is_enpty));*/ -+ -+ if ((c2h_seq != pDM_Odm->pre_c2h_seq) && pDM_Odm->fw_buff_is_enpty == FALSE) { -+ pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start] = '\0'; -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW Dbg Queue Overflow] %s\n", pDM_Odm->fw_debug_trace)); -+ pDM_Odm->c2h_cmd_start = 0; -+ } -+ -+ if ((CmdLen - 1) > (60 - pDM_Odm->c2h_cmd_start)) { -+ pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start] = '\0'; -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW Dbg Queue error: wrong C2H length] %s\n", pDM_Odm->fw_debug_trace)); -+ pDM_Odm->c2h_cmd_start = 0; -+ return; -+ } -+ -+ strncpy((char *)&(pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start]), (char *)&CmdBuf[1], (CmdLen-1)); -+ pDM_Odm->c2h_cmd_start += (CmdLen - 1); -+ pDM_Odm->fw_buff_is_enpty = FALSE; -+ -+ if (freg_num == 0 || pDM_Odm->c2h_cmd_start >= 60) { -+ if (pDM_Odm->c2h_cmd_start < 60) -+ pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start] = '\0'; -+ else -+ pDM_Odm->fw_debug_trace[59] = '\0'; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s\n", pDM_Odm->fw_debug_trace)); -+ /*DbgPrint("[FW DBG Msg] %s\n", pDM_Odm->fw_debug_trace);*/ -+ pDM_Odm->c2h_cmd_start = 0; -+ pDM_Odm->fw_buff_is_enpty = TRUE; -+ } -+ -+ pDM_Odm->pre_c2h_seq = c2h_seq; -+} -+ -+VOID -+phydm_fw_trace_handler_code( -+ IN PVOID pDM_VOID, -+ IN pu1Byte Buffer, -+ IN u1Byte CmdLen -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte function = Buffer[0]; -+ u1Byte dbg_num = Buffer[1]; -+ u2Byte content_0 = (((u2Byte)Buffer[3])<<8)|((u2Byte)Buffer[2]); -+ u2Byte content_1 = (((u2Byte)Buffer[5])<<8)|((u2Byte)Buffer[4]); -+ u2Byte content_2 = (((u2Byte)Buffer[7])<<8)|((u2Byte)Buffer[6]); -+ u2Byte content_3 = (((u2Byte)Buffer[9])<<8)|((u2Byte)Buffer[8]); -+ u2Byte content_4 = (((u2Byte)Buffer[11])<<8)|((u2Byte)Buffer[10]); -+ -+ if(CmdLen >12) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW Msg] Invalid cmd length (( %d )) >12 \n", CmdLen)); -+ } -+ -+ //ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW Msg] Func=((%d)), num=((%d)), ct_0=((%d)), ct_1=((%d)), ct_2=((%d)), ct_3=((%d)), ct_4=((%d))\n", -+ // function, dbg_num, content_0, content_1, content_2, content_3, content_4)); -+ -+ /*--------------------------------------------*/ -+ if(function == RATE_DECISION) { -+ if(dbg_num == 0) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW][RateDecisoin] RA_CNT=((%d)) Max_device=((%d))--------------------------->\n", content_1, content_2)); -+ } else if(content_0 == 2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW][RateDecisoin] Check RA macid= ((%d)), MediaStatus=((%d)), Dis_RA=((%d)), try_bit=((0x%x))\n", content_1, content_2, content_3, content_4)); -+ } else if(content_0 == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateDecisoin] Check RA total=((%d)), drop=((0x%x)), TXRPT_TRY_bit=((%x)), bNoisy=((%x))\n", content_1, content_2, content_3, content_4)); -+ } -+ } else if(dbg_num == 1) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW][RateDecisoin] RTY[0,1,2,3]=[ %d, %d, %d, %d ] \n", content_1, content_2, content_3, content_4)); -+ } else if(content_0 == 2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW][RateDecisoin] RTY[4]=[ %d ], drop=((%d)), total=((%d)), current_rate=((0x%x))\n", content_1, content_2, content_3, content_4)); -+ } else if(content_0 == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW][RateDecisoin] penality_idx=((%d ))\n", content_1)); -+ } -+ } -+ -+ else if(dbg_num == 3) { -+ if (content_0 == 1) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateDecisoin] Fast_RA (( DOWN )) total=((%d)), total>>1=((%d)), R4+R3+R2 = ((%d)), RateDownHold = ((%d))\n", content_1, content_2, content_3, content_4)); -+ else if (content_0 == 2) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateDecisoin] Fast_RA (( UP )) total_acc=((%d)), total_acc>>1=((%d)), R4+R3+R2 = ((%d)), RateDownHold = ((%d))\n", content_1, content_2, content_3, content_4)); -+ else if (content_0 == 3) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateDecisoin] Fast_RA (( UP )) ((Rate Down Hold)) RA_CNT=((%d))\n", content_1)); -+ else if (content_0 == 4) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateDecisoin] Fast_RA (( UP )) ((tota_accl<5 skip)) RA_CNT=((%d))\n", content_1)); -+ else if (content_0 == 8) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateDecisoin] Fast_RA (( Reset Tx Rpt )) RA_CNT=((%d))\n", content_1)); -+ } -+ -+ else if(dbg_num == 5) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW][RateDecisoin] (( UP)) Nsc=((%d)), N_High=((%d))\n", content_1, content_2)); -+ } else if(content_0 == 2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW][RateDecisoin] ((DOWN)) Nsc=((%d)), N_Low=((%d))\n", content_1, content_2)); -+ } else if(content_0 == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW][RateDecisoin] ((HOLD)) Nsc=((%d)), N_High=((%d)), N_Low=((%d)), Reset_CNT=((%d))\n", content_1, content_2, content_3, content_4)); -+ } -+ } -+ else if(dbg_num == 0x60) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW][RateDecisoin] ((AP RPT)) macid=((%d)), BUPDATE[macid]=((%d))\n", content_1, content_2)); -+ } else if(content_0 == 4) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW][RateDecisoin] ((AP RPT)) pass=((%d)), rty_num=((%d)), drop=((%d)), total=((%d))\n", content_1, content_2, content_3, content_4)); -+ } else if(content_0 == 5) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW][RateDecisoin] ((AP RPT)) PASS=((%d)), RTY_NUM=((%d)), DROP=((%d)), TOTAL=((%d))\n", content_1, content_2, content_3, content_4)); -+ } -+ } -+ else if(dbg_num == 0xff) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("\n\n")); -+ } -+ } -+ -+ } -+ /*--------------------------------------------*/ -+ else if (function == INIT_RA_TABLE){ -+ if(dbg_num == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][INIT_RA_INFO] Ra_init, RA_SKIP_CNT = (( %d ))\n", content_0)); -+ } -+ -+ } -+ /*--------------------------------------------*/ -+ else if (function == RATE_UP) { -+ if(dbg_num == 2) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateUp] ((Highest rate -> return)), macid=((%d)) Nsc=((%d))\n", content_1, content_2)); -+ } -+ } else if(dbg_num == 5) { -+ if (content_0 == 0) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateUp] ((Rate UP)), up_rate_tmp=((0x%x)), rate_idx=((0x%x)), SGI_en=((%d)), SGI=((%d))\n", content_1, content_2, content_3, content_4)); -+ else if (content_0 == 1) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateUp] ((Rate UP)), rate_1=((0x%x)), rate_2=((0x%x)), BW=((%d)), Try_Bit=((%d))\n", content_1, content_2, content_3, content_4)); -+ } -+ -+ } -+ /*--------------------------------------------*/ -+ else if (function == RATE_DOWN) { -+ if(dbg_num == 5) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateDownStep] ((Rate Down)), macid=((%d)), rate=((0x%x)), BW=((%d))\n", content_1, content_2, content_3)); -+ } -+ } -+ } else if (function == TRY_DONE) { -+ if (dbg_num == 1) { -+ if (content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][Try Done] ((try succsess )) macid=((%d)), Try_Done_cnt=((%d))\n", content_1, content_2)); -+ /**/ -+ } -+ } else if (dbg_num == 2) { -+ if (content_0 == 1) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][Try Done] ((try fail )) macid=((%d)), Try_Done_cnt=((%d)), multi_try_rate=((%d))\n", content_1, content_2, content_3)); -+ } -+ } -+ /*--------------------------------------------*/ -+ else if (function == F_RATE_AP_RPT) { -+ if(dbg_num == 1) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] ((1)), SPE_STATIS=((0x%x))---------->\n", content_3)); -+ } -+ } else if(dbg_num == 2) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] RTY_all=((%d))\n", content_1)); -+ } -+ } else if(dbg_num == 3) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID1[%d], TOTAL=((%d)), RTY=((%d))\n", content_3, content_1, content_2)); -+ } -+ } else if(dbg_num == 4) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID2[%d], TOTAL=((%d)), RTY=((%d))\n", content_3, content_1, content_2)); -+ } -+ } else if(dbg_num == 5) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID1[%d], PASS=((%d)), DROP=((%d))\n", content_3, content_1, content_2)); -+ } -+ } else if(dbg_num == 6) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID2[%d],, PASS=((%d)), DROP=((%d))\n", content_3, content_1, content_2)); -+ } -+ } -+ } -+ /*--------------------------------------------*/ -+ -+ -+} -+ -+VOID -+phydm_fw_trace_handler_8051( -+ IN PVOID pDM_VOID, -+ IN pu1Byte Buffer, -+ IN u1Byte CmdLen -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if 0 -+ if (CmdLen >= 3) -+ CmdBuf[CmdLen - 1] = '\0'; -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s\n", &(CmdBuf[3]))); -+#else -+ -+ int i = 0; -+ u1Byte Extend_c2hSubID = 0, Extend_c2hDbgLen = 0, Extend_c2hDbgSeq = 0; -+ u1Byte fw_debug_trace[100]; -+ pu1Byte Extend_c2hDbgContent = 0; -+ -+ Extend_c2hSubID = Buffer[0]; -+ Extend_c2hDbgLen = Buffer[1]; -+ Extend_c2hDbgContent = Buffer + 2; /*DbgSeq+DbgContent for show HEX*/ -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_DISP(FC2H, C2H_Summary, ("[Extend C2H packet], Extend_c2hSubId=0x%x, Extend_c2hDbgLen=%d\n", -+ Extend_c2hSubID, Extend_c2hDbgLen)); -+ -+ RT_DISP_DATA(FC2H, C2H_Summary, "[Extend C2H packet], Content Hex:", Extend_c2hDbgContent, CmdLen-2); -+ #endif -+ -+GoBackforAggreDbgPkt: -+ i = 0; -+ Extend_c2hDbgSeq = Buffer[2]; -+ Extend_c2hDbgContent = Buffer + 3; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_DISP(FC2H, C2H_Summary, ("[RTKFW, SEQ= %d] :", Extend_c2hDbgSeq)); -+ #endif -+ -+ for (; ; i++) { -+ fw_debug_trace[i] = Extend_c2hDbgContent[i]; -+ if (Extend_c2hDbgContent[i + 1] == '\0') { -+ fw_debug_trace[i + 1] = '\0'; -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s", &(fw_debug_trace[0]))); -+ break; -+ } else if (Extend_c2hDbgContent[i] == '\n') { -+ fw_debug_trace[i + 1] = '\0'; -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s", &(fw_debug_trace[0]))); -+ Buffer = Extend_c2hDbgContent + i + 3; -+ goto GoBackforAggreDbgPkt; -+ } -+ } -+ -+ -+#endif -+} -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_debug.h linux/3rdparty/rtl8812au/hal/phydm/phydm_debug.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_debug.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_debug.h 2017-06-07 23:07:21.017688123 +0300 -@@ -0,0 +1,330 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __ODM_DBG_H__ -+#define __ODM_DBG_H__ -+ -+#define DEBUG_VERSION "1.0" /*2015.01.13 Dino*/ -+//----------------------------------------------------------------------------- -+// Define the debug levels -+// -+// 1. DBG_TRACE and DBG_LOUD are used for normal cases. -+// So that, they can help SW engineer to develope or trace states changed -+// and also help HW enginner to trace every operation to and from HW, -+// e.g IO, Tx, Rx. -+// -+// 2. DBG_WARNNING and DBG_SERIOUS are used for unusual or error cases, -+// which help us to debug SW or HW. -+// -+//----------------------------------------------------------------------------- -+// -+// Never used in a call to ODM_RT_TRACE()! -+// -+#define ODM_DBG_OFF 1 -+ -+// -+// Fatal bug. -+// For example, Tx/Rx/IO locked up, OS hangs, memory access violation, -+// resource allocation failed, unexpected HW behavior, HW BUG and so on. -+// -+#define ODM_DBG_SERIOUS 2 -+ -+// -+// Abnormal, rare, or unexpeted cases. -+// For example, IRP/Packet/OID canceled, device suprisely unremoved and so on. -+// -+#define ODM_DBG_WARNING 3 -+ -+// -+// Normal case with useful information about current SW or HW state. -+// For example, Tx/Rx descriptor to fill, Tx/Rx descriptor completed status, -+// SW protocol state change, dynamic mechanism state change and so on. -+// -+#define ODM_DBG_LOUD 4 -+ -+// -+// Normal case with detail execution flow or information. -+// -+#define ODM_DBG_TRACE 5 -+ -+/*FW DBG MSG*/ -+#define RATE_DECISION BIT0 -+#define INIT_RA_TABLE BIT1 -+#define RATE_UP BIT2 -+#define RATE_DOWN BIT3 -+#define TRY_DONE BIT4 -+#define F_RATE_AP_RPT BIT7 -+ -+//----------------------------------------------------------------------------- -+// Define the tracing components -+// -+//----------------------------------------------------------------------------- -+//BB Functions -+#define ODM_COMP_DIG BIT0 -+#define ODM_COMP_RA_MASK BIT1 -+#define ODM_COMP_DYNAMIC_TXPWR BIT2 -+#define ODM_COMP_FA_CNT BIT3 -+#define ODM_COMP_RSSI_MONITOR BIT4 -+#define ODM_COMP_CCK_PD BIT5 -+#define ODM_COMP_ANT_DIV BIT6 -+#define ODM_COMP_PWR_SAVE BIT7 -+#define ODM_COMP_PWR_TRAIN BIT8 -+#define ODM_COMP_RATE_ADAPTIVE BIT9 -+#define ODM_COMP_PATH_DIV BIT10 -+#define ODM_COMP_PSD BIT11 -+#define ODM_COMP_DYNAMIC_PRICCA BIT12 -+#define ODM_COMP_RXHP BIT13 -+#define ODM_COMP_MP BIT14 -+#define ODM_COMP_CFO_TRACKING BIT15 -+#define ODM_COMP_ACS BIT16 -+#define PHYDM_COMP_ADAPTIVITY BIT17 -+#define PHYDM_COMP_RA_DBG BIT18 -+#define PHYDM_COMP_TXBF BIT19 -+//MAC Functions -+#define ODM_COMP_EDCA_TURBO BIT20 -+#define ODM_COMP_EARLY_MODE BIT21 -+#define ODM_FW_DEBUG_TRACE BIT22 -+//RF Functions -+#define ODM_COMP_TX_PWR_TRACK BIT24 -+#define ODM_COMP_RX_GAIN_TRACK BIT25 -+#define ODM_COMP_CALIBRATION BIT26 -+//Common Functions -+#define ODM_PHY_CONFIG BIT28 -+#define BEAMFORMING_DEBUG BIT29 -+#define ODM_COMP_COMMON BIT30 -+#define ODM_COMP_INIT BIT31 -+#define ODM_COMP_NOISY_DETECT BIT32 -+ -+/*------------------------Export Marco Definition---------------------------*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #define RT_PRINTK DbgPrint -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #define DbgPrint printk -+ #define RT_PRINTK(fmt, args...) DbgPrint( "%s(): " fmt, __FUNCTION__, ## args); -+ #define RT_DISP(dbgtype, dbgflag, printstr) -+#else -+ #define DbgPrint panic_printk -+ #define RT_PRINTK(fmt, args...) DbgPrint( "%s(): " fmt, __FUNCTION__, ## args); -+#endif -+ -+#ifndef ASSERT -+ #define ASSERT(expr) -+#endif -+ -+#if DBG -+#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt) \ -+ do { \ -+ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel || level == ODM_DBG_SERIOUS)) \ -+ { \ -+ if(pDM_Odm->SupportICType == ODM_RTL8192C) \ -+ DbgPrint("[ODM-92C] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8192D) \ -+ DbgPrint("[ODM-92D] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8723A) \ -+ DbgPrint("[ODM-8723A] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8188E) \ -+ DbgPrint("[ODM-8188E] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8192E) \ -+ DbgPrint("[ODM-8192E] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8812) \ -+ DbgPrint("[ODM-8812] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8821) \ -+ DbgPrint("[ODM-8821] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8814A) \ -+ DbgPrint("[ODM-8814] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8703B) \ -+ DbgPrint("[ODM-8703B] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8822B) \ -+ DbgPrint("[ODM-8822] "); \ -+ else if (pDM_Odm->SupportICType == ODM_RTL8188F) \ -+ DbgPrint("[ODM-8188F] "); \ -+ RT_PRINTK fmt; \ -+ } \ -+ } while (0) -+ -+#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt) \ -+ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel)) \ -+ { \ -+ RT_PRINTK fmt; \ -+ } -+ -+#define ODM_RT_ASSERT(pDM_Odm, expr, fmt) \ -+ if(!(expr)) { \ -+ DbgPrint( "Assertion failed! %s at ......\n", #expr); \ -+ DbgPrint( " ......%s,%s,line=%d\n",__FILE__,__FUNCTION__,__LINE__); \ -+ RT_PRINTK fmt; \ -+ ASSERT(FALSE); \ -+ } -+#define ODM_dbg_enter() { DbgPrint("==> %s\n", __FUNCTION__); } -+#define ODM_dbg_exit() { DbgPrint("<== %s\n", __FUNCTION__); } -+#define ODM_dbg_trace(str) { DbgPrint("%s:%s\n", __FUNCTION__, str); } -+ -+#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr) \ -+ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel)) \ -+ { \ -+ int __i; \ -+ pu1Byte __ptr = (pu1Byte)ptr; \ -+ DbgPrint("[ODM] "); \ -+ DbgPrint(title_str); \ -+ DbgPrint(" "); \ -+ for( __i=0; __i<6; __i++ ) \ -+ DbgPrint("%02X%s", __ptr[__i], (__i==5)?"":"-"); \ -+ DbgPrint("\n"); \ -+ } -+#else -+#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt) -+#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt) -+#define ODM_RT_ASSERT(pDM_Odm, expr, fmt) -+#define ODM_dbg_enter() -+#define ODM_dbg_exit() -+#define ODM_dbg_trace(str) -+#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr) -+#endif -+ -+ -+VOID -+PHYDM_InitDebugSetting(IN PDM_ODM_T pDM_Odm); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID phydm_BB_RxHang_Info(IN PDM_ODM_T pDM_Odm); -+#endif -+ -+#define BB_TMP_BUF_SIZE 100 -+VOID phydm_BB_Debug_Info(IN PDM_ODM_T pDM_Odm); -+VOID phydm_BasicDbgMessage( IN PVOID pDM_VOID); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define PHYDM_DBGPRINT 0 -+#define PHYDM_SSCANF(x, y, z) DCMD_Scanf(x, y, z) -+#if (PHYDM_DBGPRINT == 1) -+#define PHYDM_SNPRINTF(msg) \ -+ do {\ -+ rsprintf msg;\ -+ DbgPrint(output);\ -+ } while (0) -+#else -+#define PHYDM_SNPRINTF(msg) \ -+ do {\ -+ rsprintf msg;\ -+ DCMD_Printf(output);\ -+ } while (0) -+#endif -+#else -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#define PHYDM_DBGPRINT 0 -+#else -+#define PHYDM_DBGPRINT 1 -+#endif -+#define MAX_ARGC 20 -+#define MAX_ARGV 16 -+#define DCMD_DECIMAL "%d" -+#define DCMD_CHAR "%c" -+#define DCMD_HEX "%x" -+ -+#define PHYDM_SSCANF(x, y, z) sscanf(x, y, z) -+#if (PHYDM_DBGPRINT == 1) -+#define PHYDM_SNPRINTF(msg)\ -+ do {\ -+ snprintf msg;\ -+ DbgPrint(output);\ -+ } while (0) -+#else -+#define PHYDM_SNPRINTF(msg)\ -+ do {\ -+ if(out_len > used)\ -+ used+=snprintf msg;\ -+ } while (0) -+#endif -+#endif -+ -+ -+VOID phydm_BasicProfile( -+ IN PVOID pDM_VOID, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ); -+#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) -+s4Byte -+phydm_cmd( -+ IN PDM_ODM_T pDM_Odm, -+ IN char *input, -+ IN u4Byte in_len, -+ IN u1Byte flag, -+ OUT char *output, -+ IN u4Byte out_len -+); -+#endif -+VOID -+phydm_cmd_parser( -+ IN PDM_ODM_T pDM_Odm, -+ IN char input[][16], -+ IN u4Byte input_num, -+ IN u1Byte flag, -+ OUT char *output, -+ IN u4Byte out_len -+); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void phydm_sbd_check( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+void phydm_sbd_callback( -+ PRT_TIMER pTimer -+ ); -+ -+void phydm_sbd_workitem_callback( -+ IN PVOID pContext -+ ); -+#endif -+ -+VOID -+phydm_fw_trace_en_h2c( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN enable, -+ IN u4Byte monitor_mode, -+ IN u4Byte macid -+); -+ -+VOID -+phydm_fw_trace_handler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+); -+ -+VOID -+phydm_fw_trace_handler_code( -+ IN PVOID pDM_VOID, -+ IN pu1Byte Buffer, -+ IN u1Byte CmdLen -+); -+ -+VOID -+phydm_fw_trace_handler_8051( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+); -+ -+#endif // __ODM_DBG_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_dig.c linux/3rdparty/rtl8812au/hal/phydm/phydm_dig.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_dig.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_dig.c 2017-06-07 23:07:21.018688214 +0300 -@@ -0,0 +1,2086 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+ -+VOID -+ODM_ChangeDynamicInitGainThresh( -+ IN PVOID pDM_VOID, -+ IN u4Byte DM_Type, -+ IN u4Byte DM_Value -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ if (DM_Type == DIG_TYPE_THRESH_HIGH) -+ { -+ pDM_DigTable->RssiHighThresh = DM_Value; -+ } -+ else if (DM_Type == DIG_TYPE_THRESH_LOW) -+ { -+ pDM_DigTable->RssiLowThresh = DM_Value; -+ } -+ else if (DM_Type == DIG_TYPE_ENABLE) -+ { -+ pDM_DigTable->Dig_Enable_Flag = TRUE; -+ } -+ else if (DM_Type == DIG_TYPE_DISABLE) -+ { -+ pDM_DigTable->Dig_Enable_Flag = FALSE; -+ } -+ else if (DM_Type == DIG_TYPE_BACKOFF) -+ { -+ if(DM_Value > 30) -+ DM_Value = 30; -+ pDM_DigTable->BackoffVal = (u1Byte)DM_Value; -+ } -+ else if(DM_Type == DIG_TYPE_RX_GAIN_MIN) -+ { -+ if(DM_Value == 0) -+ DM_Value = 0x1; -+ pDM_DigTable->rx_gain_range_min = (u1Byte)DM_Value; -+ } -+ else if(DM_Type == DIG_TYPE_RX_GAIN_MAX) -+ { -+ if(DM_Value > 0x50) -+ DM_Value = 0x50; -+ pDM_DigTable->rx_gain_range_max = (u1Byte)DM_Value; -+ } -+} // DM_ChangeDynamicInitGainThresh // -+ -+int -+getIGIForDiff(int value_IGI) -+{ -+ #define ONERCCA_LOW_TH 0x30 -+ #define ONERCCA_LOW_DIFF 8 -+ -+ if (value_IGI < ONERCCA_LOW_TH) { -+ if ((ONERCCA_LOW_TH - value_IGI) < ONERCCA_LOW_DIFF) -+ return ONERCCA_LOW_TH; -+ else -+ return value_IGI + ONERCCA_LOW_DIFF; -+ } else { -+ return value_IGI; -+ } -+} -+ -+VOID -+odm_FAThresholdCheck( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN bDFSBand, -+ IN BOOLEAN bPerformance, -+ IN u4Byte RxTp, -+ IN u4Byte TxTp, -+ OUT u4Byte* dm_FA_thres -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if(pDM_Odm->bLinked && (bPerformance||bDFSBand)) -+ { -+ if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ { -+ // 8192D special case -+ dm_FA_thres[0] = DM_DIG_FA_TH0_92D; -+ dm_FA_thres[1] = DM_DIG_FA_TH1_92D; -+ dm_FA_thres[2] = DM_DIG_FA_TH2_92D; -+ } -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ else if(pDM_Odm->SupportPlatform & (ODM_AP|ODM_ADSL)) -+ { -+ // For AP -+ if((RxTp>>2) > TxTp && RxTp < 10000 && RxTp > 500) // 10Mbps & 0.5Mbps -+ { -+ dm_FA_thres[0] = 0x080; -+ dm_FA_thres[1] = 0x100; -+ dm_FA_thres[2] = 0x200; -+ } -+ else -+ { -+ dm_FA_thres[0] = 0x100; -+ dm_FA_thres[1] = 0x200; -+ dm_FA_thres[2] = 0x300; -+ } -+ } -+#else -+ else if(pDM_Odm->SupportICType == ODM_RTL8723A && pDM_Odm->bBtLimitedDig) -+ { -+ // 8723A BT special case -+ dm_FA_thres[0] = DM_DIG_FA_TH0; -+ dm_FA_thres[1] = 0x250; -+ dm_FA_thres[2] = 0x300; -+ } -+#endif -+ else -+ { -+ // For NIC -+ dm_FA_thres[0] = DM_DIG_FA_TH0; -+ dm_FA_thres[1] = DM_DIG_FA_TH1; -+ dm_FA_thres[2] = DM_DIG_FA_TH2; -+ } -+ } -+ else -+ { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ if(bDFSBand) -+ { -+ // For DFS band and no link -+ dm_FA_thres[0] = 250; -+ dm_FA_thres[1] = 1000; -+ dm_FA_thres[2] = 2000; -+ } -+ else -+#endif -+ { -+ dm_FA_thres[0] = 2000; -+ dm_FA_thres[1] = 4000; -+ dm_FA_thres[2] = 5000; -+ } -+ } -+ return; -+} -+ -+u1Byte -+odm_ForbiddenIGICheck( -+ IN PVOID pDM_VOID, -+ IN u1Byte DIG_Dynamic_MIN, -+ IN u1Byte CurrentIGI -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+ u1Byte rx_gain_range_min = pDM_DigTable->rx_gain_range_min; -+ -+ if(pFalseAlmCnt->Cnt_all > 10000) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormally false alarm case. \n")); -+ -+ if(pDM_DigTable->LargeFAHit != 3) -+ pDM_DigTable->LargeFAHit++; -+ -+ if(pDM_DigTable->ForbiddenIGI < CurrentIGI)//if(pDM_DigTable->ForbiddenIGI < pDM_DigTable->CurIGValue) -+ { -+ pDM_DigTable->ForbiddenIGI = CurrentIGI;//pDM_DigTable->ForbiddenIGI = pDM_DigTable->CurIGValue; -+ pDM_DigTable->LargeFAHit = 1; -+ } -+ -+ if(pDM_DigTable->LargeFAHit >= 3) -+ { -+ if((pDM_DigTable->ForbiddenIGI + 2) > pDM_DigTable->rx_gain_range_max) -+ rx_gain_range_min = pDM_DigTable->rx_gain_range_max; -+ else -+ rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 2); -+ pDM_DigTable->Recover_cnt = 1800; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormally false alarm case: Recover_cnt = %d \n", pDM_DigTable->Recover_cnt)); -+ } -+ } -+ else -+ { -+ if(pDM_DigTable->Recover_cnt != 0) -+ { -+ pDM_DigTable->Recover_cnt --; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: Recover_cnt = %d \n", pDM_DigTable->Recover_cnt)); -+ } -+ else -+ { -+ if(pDM_DigTable->LargeFAHit < 3) -+ { -+ if((pDM_DigTable->ForbiddenIGI - 2) < DIG_Dynamic_MIN) //DM_DIG_MIN) -+ { -+ pDM_DigTable->ForbiddenIGI = DIG_Dynamic_MIN; //DM_DIG_MIN; -+ rx_gain_range_min = DIG_Dynamic_MIN; //DM_DIG_MIN; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: At Lower Bound\n")); -+ } -+ else -+ { -+ pDM_DigTable->ForbiddenIGI -= 2; -+ rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 2); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: Approach Lower Bound\n")); -+ } -+ } -+ else -+ { -+ pDM_DigTable->LargeFAHit = 0; -+ } -+ } -+ } -+ -+ return rx_gain_range_min; -+ -+} -+ -+VOID -+odm_InbandNoiseCalculate ( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ u1Byte IGIBackup, TimeCnt = 0, ValidCnt = 0; -+ BOOLEAN bTimeout = TRUE; -+ s1Byte sNoise_A, sNoise_B; -+ s4Byte NoiseRpt_A = 0,NoiseRpt_B = 0; -+ u4Byte tmp = 0; -+ static u1Byte failCnt = 0; -+ -+ if(!(pDM_Odm->SupportICType & (ODM_RTL8192E))) -+ return; -+ -+ if(pDM_Odm->RFType == ODM_1T1R || *(pDM_Odm->pOnePathCCA) != ODM_CCA_2R) -+ return; -+ -+ if(!pDM_DigTable->bNoiseEst) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_InbandNoiseEstimate()========>\n")); -+ -+ //1 Set initial gain. -+ IGIBackup = pDM_DigTable->CurIGValue; -+ pDM_DigTable->IGIOffset_A = 0; -+ pDM_DigTable->IGIOffset_B = 0; -+ ODM_Write_DIG(pDM_Odm, 0x24); -+ -+ //1 Update idle time power report -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TX_ANT_CTRL_11N, BIT25, 0x0); -+ -+ delay_ms(2); -+ -+ //1 Get noise power level -+ while(1) -+ { -+ //2 Read Noise Floor Report -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ tmp = ODM_GetBBReg(pDM_Odm, 0x8f8, bMaskLWord); -+ -+ sNoise_A = (s1Byte)(tmp & 0xff); -+ sNoise_B = (s1Byte)((tmp & 0xff00)>>8); -+ -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("sNoise_A = %d, sNoise_B = %d\n",sNoise_A, sNoise_B)); -+ -+ if((sNoise_A < 20 && sNoise_A >= -70) && (sNoise_B < 20 && sNoise_B >= -70)) -+ { -+ ValidCnt++; -+ NoiseRpt_A += sNoise_A; -+ NoiseRpt_B += sNoise_B; -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("sNoise_A = %d, sNoise_B = %d\n",sNoise_A, sNoise_B)); -+ } -+ -+ TimeCnt++; -+ bTimeout = (TimeCnt >= 150)?TRUE:FALSE; -+ -+ if(ValidCnt == 20 || bTimeout) -+ break; -+ -+ delay_ms(2); -+ -+ } -+ -+ //1 Keep idle time power report -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TX_ANT_CTRL_11N, BIT25, 0x1); -+ -+ //1 Recover IGI -+ ODM_Write_DIG(pDM_Odm, IGIBackup); -+ -+ //1 Calculate Noise Floor -+ if(ValidCnt != 0) -+ { -+ NoiseRpt_A /= (ValidCnt<<1); -+ NoiseRpt_B /= (ValidCnt<<1); -+ } -+ -+ if(bTimeout) -+ { -+ NoiseRpt_A = 0; -+ NoiseRpt_B = 0; -+ -+ failCnt ++; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("Noise estimate fail time = %d\n", failCnt)); -+ -+ if(failCnt == 3) -+ { -+ failCnt = 0; -+ pDM_DigTable->bNoiseEst = FALSE; -+ } -+ } -+ else -+ { -+ NoiseRpt_A = -110 + 0x24 + NoiseRpt_A -6; -+ NoiseRpt_B = -110 + 0x24 + NoiseRpt_B -6; -+ pDM_DigTable->bNoiseEst = FALSE; -+ failCnt = 0; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("NoiseRpt_A = %d, NoiseRpt_B = %d\n", NoiseRpt_A, NoiseRpt_B)); -+ } -+ -+ //1 Calculate IGI Offset -+ if(NoiseRpt_A > NoiseRpt_B) -+ { -+ pDM_DigTable->IGIOffset_A = NoiseRpt_A - NoiseRpt_B; -+ pDM_DigTable->IGIOffset_B = 0; -+ } -+ else -+ { -+ pDM_DigTable->IGIOffset_A = 0; -+ pDM_DigTable->IGIOffset_B = NoiseRpt_B - NoiseRpt_A; -+ } -+ -+#endif -+ return; -+} -+ -+VOID -+odm_DigForBtHsMode( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable=&pDM_Odm->DM_DigTable; -+ u1Byte digForBtHs=0; -+ u1Byte digUpBound=0x5a; -+ -+ if(pDM_Odm->bBtConnectProcess) -+ { -+ if(pDM_Odm->SupportICType&(ODM_RTL8723A)) -+ digForBtHs = 0x28; -+ else -+ digForBtHs = 0x22; -+ } -+ else -+ { -+ // -+ // Decide DIG value by BT HS RSSI. -+ // -+ digForBtHs = pDM_Odm->btHsRssi+4; -+ -+ //DIG Bound -+ if(pDM_Odm->SupportICType&(ODM_RTL8723A)) -+ digUpBound = 0x3e; -+ -+ if(digForBtHs > digUpBound) -+ digForBtHs = digUpBound; -+ if(digForBtHs < 0x1c) -+ digForBtHs = 0x1c; -+ -+ // update Current IGI -+ pDM_DigTable->BT30_CurIGI = digForBtHs; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DigForBtHsMode() : set DigValue=0x%x\n", digForBtHs)); -+#endif -+} -+ -+VOID -+ODM_Write_DIG( -+ IN PVOID pDM_VOID, -+ IN u1Byte CurrentIGI -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ if (pDM_DigTable->bStopDIG) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("ODM_Write_DIG(): Stop Writing IGI\n")); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("ODM_Write_DIG(): ODM_REG(IGI_A,pDM_Odm)=0x%x, ODM_BIT(IGI,pDM_Odm)=0x%x\n", -+ ODM_REG(IGI_A,pDM_Odm),ODM_BIT(IGI,pDM_Odm))); -+ -+ //1 Check initial gain by upper bound -+ if ((!pDM_DigTable->bPSDInProgress) && pDM_Odm->bLinked) -+ { -+ if (CurrentIGI > pDM_DigTable->rx_gain_range_max) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("ODM_Write_DIG(): CurrentIGI(0x%02x) is larger than upper bound !!\n", CurrentIGI)); -+ CurrentIGI = pDM_DigTable->rx_gain_range_max; -+ } -+ if (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY && pDM_Odm->adaptivity_flag == TRUE) -+ { -+ if(CurrentIGI > pDM_Odm->Adaptivity_IGI_upper) -+ CurrentIGI = pDM_Odm->Adaptivity_IGI_upper; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("ODM_Write_DIG(): Adaptivity case: Force upper bound to 0x%x !!!!!!\n", CurrentIGI)); -+ } -+ } -+ -+ if(pDM_DigTable->CurIGValue != CurrentIGI) -+ { -+ -+ /*Add by YuChen for USB IO too slow issue*/ -+ if ((pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) && (CurrentIGI > pDM_DigTable->CurIGValue)) -+ Phydm_Adaptivity(pDM_Odm, CurrentIGI); -+ -+ //1 Set IGI value -+ if(pDM_Odm->SupportPlatform & (ODM_WIN|ODM_CE)) -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ -+ if(pDM_Odm->RFType > ODM_1T1R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ -+ if((pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) && (pDM_Odm->RFType > ODM_2T2R)) -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_C,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_D,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ } -+ } -+ else if(pDM_Odm->SupportPlatform & (ODM_AP|ODM_ADSL)) -+ { -+ switch(*(pDM_Odm->pOnePathCCA)) -+ { -+ case ODM_CCA_2R: -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ -+ if(pDM_Odm->RFType > ODM_1T1R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ -+ if((pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) && (pDM_Odm->RFType > ODM_2T2R)) -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_C,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_D,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ } -+ break; -+ case ODM_CCA_1R_A: -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ if(pDM_Odm->RFType != ODM_1T1R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), getIGIForDiff(CurrentIGI)); -+ break; -+ case ODM_CCA_1R_B: -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), getIGIForDiff(CurrentIGI)); -+ if(pDM_Odm->RFType != ODM_1T1R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ break; -+ } -+ } -+ pDM_DigTable->CurIGValue = CurrentIGI; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("ODM_Write_DIG(): CurrentIGI(0x%02x).\n", CurrentIGI)); -+ -+} -+ -+VOID -+odm_PauseDIG( -+ IN PVOID pDM_VOID, -+ IN PHYDM_PAUSE_TYPE PauseType, -+ IN PHYDM_PAUSE_LEVEL pause_level, -+ IN u1Byte IGIValue -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG()=========> level = %d\n", pause_level)); -+ -+ if ((pDM_DigTable->pause_dig_level == 0) && (!(pDM_Odm->SupportAbility & ODM_BB_DIG) || !(pDM_Odm->SupportAbility & ODM_BB_FA_CNT))) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, -+ ("odm_PauseDIG(): Return: SupportAbility DIG or FA is disabled !!\n")); -+ return; -+ } -+ -+ if (pause_level > DM_DIG_MAX_PAUSE_TYPE) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, -+ ("odm_PauseDIG(): Return: Wrong pause level !!\n")); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_dig_level, IGIValue)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", -+ pDM_DigTable->pause_dig_value[7], pDM_DigTable->pause_dig_value[6], pDM_DigTable->pause_dig_value[5], pDM_DigTable->pause_dig_value[4], -+ pDM_DigTable->pause_dig_value[3], pDM_DigTable->pause_dig_value[2], pDM_DigTable->pause_dig_value[1], pDM_DigTable->pause_dig_value[0])); -+ -+ switch (PauseType) { -+ /* Pause DIG */ -+ case PHYDM_PAUSE: -+ { -+ /* Disable DIG */ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility & (~ODM_BB_DIG)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Pause DIG !!\n")); -+ -+ /* Backup IGI value */ -+ if (pDM_DigTable->pause_dig_level == 0) { -+ pDM_DigTable->IGIBackup = pDM_DigTable->CurIGValue; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Backup IGI = 0x%x, new IGI = 0x%x\n", pDM_DigTable->IGIBackup, IGIValue)); -+ } -+ -+ /* Record IGI value */ -+ pDM_DigTable->pause_dig_value[pause_level] = IGIValue; -+ -+ /* Update pause level */ -+ pDM_DigTable->pause_dig_level = (pDM_DigTable->pause_dig_level | BIT(pause_level)); -+ -+ /* Write new IGI value */ -+ if (BIT(pause_level + 1) > pDM_DigTable->pause_dig_level) { -+ ODM_Write_DIG(pDM_Odm, IGIValue); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): IGI of higher level = 0x%x\n", IGIValue)); -+ } -+ break; -+ } -+ /* Resume DIG */ -+ case PHYDM_RESUME: -+ { -+ /* check if the level is illegal or not */ -+ if ((pDM_DigTable->pause_dig_level & (BIT(pause_level))) != 0) { -+ pDM_DigTable->pause_dig_level = pDM_DigTable->pause_dig_level & (~(BIT(pause_level))); -+ pDM_DigTable->pause_dig_value[pause_level] = 0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Resume DIG !!\n")); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Wrong resume level !!\n")); -+ break; -+ } -+ -+ /* Resume DIG */ -+ if (pDM_DigTable->pause_dig_level == 0) { -+ /* Write backup IGI value */ -+ ODM_Write_DIG(pDM_Odm, pDM_DigTable->IGIBackup); -+ pDM_DigTable->bIgnoreDIG = TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Write original IGI = 0x%x\n", pDM_DigTable->IGIBackup)); -+ -+ /* Enable DIG */ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility | ODM_BB_DIG); -+ break; -+ } -+ -+ if (BIT(pause_level) > pDM_DigTable->pause_dig_level) { -+ u1Byte max_level; -+ -+ /* Calculate the maximum level now */ -+ for (max_level = (pause_level - 1); max_level >= 0; max_level--) { -+ if ((pDM_DigTable->pause_dig_level & BIT(max_level)) > 0) -+ break; -+ } -+ -+ /* write IGI of lower level */ -+ ODM_Write_DIG(pDM_Odm, pDM_DigTable->pause_dig_value[max_level]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Write IGI (0x%x) of level (%d)\n", -+ pDM_DigTable->pause_dig_value[max_level], max_level)); -+ break; -+ } -+ break; -+ } -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Wrong type !!\n")); -+ break; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_dig_level, IGIValue)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", -+ pDM_DigTable->pause_dig_value[7], pDM_DigTable->pause_dig_value[6], pDM_DigTable->pause_dig_value[5], pDM_DigTable->pause_dig_value[4], -+ pDM_DigTable->pause_dig_value[3], pDM_DigTable->pause_dig_value[2], pDM_DigTable->pause_dig_value[1], pDM_DigTable->pause_dig_value[0])); -+ -+} -+ -+BOOLEAN -+odm_DigAbort( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ pRXHP_T pRX_HP_Table = &pDM_Odm->DM_RXHP_Table; -+#endif -+ -+ //SupportAbility -+ if(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: SupportAbility ODM_BB_FA_CNT is disabled\n")); -+ return TRUE; -+ } -+ -+ //SupportAbility -+ if(!(pDM_Odm->SupportAbility & ODM_BB_DIG)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: SupportAbility ODM_BB_DIG is disabled\n")); -+ return TRUE; -+ } -+ -+ //ScanInProcess -+ if(*(pDM_Odm->pbScanInProcess)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: In Scan Progress \n")); -+ return TRUE; -+ } -+ -+ if(pDM_DigTable->bIgnoreDIG) -+ { -+ pDM_DigTable->bIgnoreDIG = FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Ignore DIG \n")); -+ return TRUE; -+ } -+ -+ //add by Neil Chen to avoid PSD is processing -+ if(pDM_Odm->bDMInitialGainEnable == FALSE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: PSD is Processing \n")); -+ return TRUE; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #if OS_WIN_FROM_WIN7(OS_VERSION) -+ if(IsAPModeExist( pAdapter) && pAdapter->bInHctTest) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Is AP mode or In HCT Test \n")); -+ return TRUE; -+ } -+ #endif -+ -+ if(pDM_Odm->bBtHsOperation) -+ { -+ odm_DigForBtHsMode(pDM_Odm); -+ } -+ -+ if(!(pDM_Odm->SupportICType &(ODM_RTL8723A|ODM_RTL8188E))) -+ { -+ if(pRX_HP_Table->RXHP_flag == 1) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: In RXHP Operation \n")); -+ return TRUE; -+ } -+ } -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -+ if((pDM_Odm->bLinked) && (pDM_Odm->Adapter->registrypriv.force_igi !=0)) -+ { -+ printk("pDM_Odm->RSSI_Min=%d \n",pDM_Odm->RSSI_Min); -+ ODM_Write_DIG(pDM_Odm,pDM_Odm->Adapter->registrypriv.force_igi); -+ return TRUE; -+ } -+ #endif -+#else -+ if (!(priv->up_time > 5)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Not In DIG Operation Period \n")); -+ return TRUE; -+ } -+#endif -+ -+ return FALSE; -+} -+ -+VOID -+odm_DIGInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+#endif -+ -+ pDM_DigTable->bStopDIG = FALSE; -+ pDM_DigTable->bIgnoreDIG = FALSE; -+ pDM_DigTable->bPSDInProgress = FALSE; -+ pDM_DigTable->CurIGValue = (u1Byte) ODM_GetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm)); -+ pDM_DigTable->RssiLowThresh = DM_DIG_THRESH_LOW; -+ pDM_DigTable->RssiHighThresh = DM_DIG_THRESH_HIGH; -+ pDM_DigTable->FALowThresh = DM_FALSEALARM_THRESH_LOW; -+ pDM_DigTable->FAHighThresh = DM_FALSEALARM_THRESH_HIGH; -+ pDM_DigTable->BackoffVal = DM_DIG_BACKOFF_DEFAULT; -+ pDM_DigTable->BackoffVal_range_max = DM_DIG_BACKOFF_MAX; -+ pDM_DigTable->BackoffVal_range_min = DM_DIG_BACKOFF_MIN; -+ pDM_DigTable->PreCCK_CCAThres = 0xFF; -+ pDM_DigTable->CurCCK_CCAThres = 0x83; -+ pDM_DigTable->ForbiddenIGI = DM_DIG_MIN_NIC; -+ pDM_DigTable->LargeFAHit = 0; -+ pDM_DigTable->Recover_cnt = 0; -+ pDM_DigTable->bMediaConnect_0 = FALSE; -+ pDM_DigTable->bMediaConnect_1 = FALSE; -+ -+ //To Initialize pDM_Odm->bDMInitialGainEnable == FALSE to avoid DIG error -+ pDM_Odm->bDMInitialGainEnable = TRUE; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ pDM_DigTable->DIG_Dynamic_MIN_0 = 0x25; -+ pDM_DigTable->DIG_Dynamic_MIN_1 = 0x25; -+ -+ // For AP\ ADSL modified DIG -+ pDM_DigTable->bTpTarget = FALSE; -+ pDM_DigTable->bNoiseEst = TRUE; -+ pDM_DigTable->IGIOffset_A = 0; -+ pDM_DigTable->IGIOffset_B = 0; -+ pDM_DigTable->TpTrainTH_min = 0; -+ -+ // For RTL8881A -+ FalseAlmCnt->Cnt_Ofdm_fail_pre = 0; -+ -+ //Dyanmic EDCCA -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ { -+ ODM_SetBBReg(pDM_Odm, 0xC50, 0xFFFF0000, 0xfafd); -+ } -+#else -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DM_DIG_MIN_NIC; -+ pDM_DigTable->DIG_Dynamic_MIN_1 = DM_DIG_MIN_NIC; -+ -+ //To Initi BT30 IGI -+ pDM_DigTable->BT30_CurIGI=0x32; -+ -+ ODM_Memory_Set(pDM_Odm, pDM_DigTable->pause_dig_value, 0, (DM_DIG_MAX_PAUSE_TYPE + 1)); -+ pDM_DigTable->pause_dig_level = 0; -+ ODM_Memory_Set(pDM_Odm, pDM_DigTable->pause_cckpd_value, 0, (DM_DIG_MAX_PAUSE_TYPE + 1)); -+ pDM_DigTable->pause_cckpd_level = 0; -+#endif -+ -+ if(pDM_Odm->BoardType & (ODM_BOARD_EXT_PA|ODM_BOARD_EXT_LNA)) -+ { -+ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; -+ pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; -+ } -+ else -+ { -+ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; -+ pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; -+ } -+ -+} -+ -+ -+VOID -+odm_DIG( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pDM_Odm->Adapter); -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ PSTA_INFO_T pEntry; -+#endif -+ -+ // Common parameters -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+ BOOLEAN FirstConnect,FirstDisConnect; -+ u1Byte DIG_MaxOfMin, DIG_Dynamic_MIN; -+ u1Byte dm_dig_max, dm_dig_min; -+ u1Byte CurrentIGI = pDM_DigTable->CurIGValue; -+ u1Byte offset; -+ u4Byte dm_FA_thres[3]; -+ u4Byte TxTp = 0, RxTp = 0; -+ BOOLEAN bDFSBand = FALSE; -+ BOOLEAN bPerformance = TRUE, bFirstTpTarget = FALSE, bFirstCoverage = FALSE; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ u4Byte TpTrainTH_MIN = DM_DIG_TP_Target_TH0; -+ static u1Byte TimeCnt = 0; -+ u1Byte i; -+#endif -+ -+ if(odm_DigAbort(pDM_Odm) == TRUE) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG()===========================>\n\n")); -+ -+ -+ //1 Update status -+#if (RTL8192D_SUPPORT==1) -+ if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ { -+ if(*(pDM_Odm->pMacPhyMode) == ODM_DMSP) -+ { -+ if(*(pDM_Odm->pbMasterOfDMSP)) -+ { -+ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_0; -+ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == FALSE); -+ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == TRUE); -+ } -+ else -+ { -+ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_1; -+ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_1 == FALSE); -+ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_1 == TRUE); -+ } -+ } -+ else -+ { -+ if(*(pDM_Odm->pBandType) == ODM_BAND_5G) -+ { -+ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_0; -+ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == FALSE); -+ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == TRUE); -+ } -+ else -+ { -+ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_1; -+ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_1 == FALSE); -+ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_1 == TRUE); -+ } -+ } -+ } -+ else -+#endif -+ { -+ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_0; -+ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == FALSE); -+ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == TRUE); -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ //1 Noise Floor Estimate -+ //pDM_DigTable->bNoiseEst = (FirstConnect)?TRUE:pDM_DigTable->bNoiseEst; -+ //odm_InbandNoiseCalculate (pDM_Odm); -+ -+ //1 Mode decision -+ if(pDM_Odm->bLinked) -+ { -+ //2 Calculate total TP -+ for (i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pEntry)) -+ { -+ RxTp += (u4Byte)(pEntry->rx_byte_cnt_LowMAW>>7); -+ TxTp += (u4Byte)(pEntry->tx_byte_cnt_LowMAW>>7); //Kbps -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): TX TP = %dkbps, RX TP = %dkbps\n", TxTp, RxTp)); -+ } -+ -+ switch(pDM_Odm->priv->pshare->rf_ft_var.dig_cov_enable) -+ { -+ case 0: -+ { -+ bPerformance = TRUE; -+ break; -+ } -+ case 1: -+ { -+ bPerformance = FALSE; -+ break; -+ } -+ case 2: -+ { -+ if(pDM_Odm->bLinked) -+ { -+ if(pDM_DigTable->TpTrainTH_min > DM_DIG_TP_Target_TH0) -+ TpTrainTH_MIN = pDM_DigTable->TpTrainTH_min; -+ -+ if(pDM_DigTable->TpTrainTH_min > DM_DIG_TP_Target_TH1) -+ TpTrainTH_MIN = DM_DIG_TP_Target_TH1; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): TP training mode lower bound = %dkbps\n", TpTrainTH_MIN)); -+ -+ //2 Decide DIG mode by total TP -+ if((TxTp + RxTp) > DM_DIG_TP_Target_TH1) // change to performance mode -+ { -+ bFirstTpTarget = (!pDM_DigTable->bTpTarget)?TRUE:FALSE; -+ pDM_DigTable->bTpTarget = TRUE; -+ bPerformance = TRUE; -+ } -+ else if((TxTp + RxTp) < TpTrainTH_MIN) // change to coverage mode -+ { -+ bFirstCoverage = (pDM_DigTable->bTpTarget)?TRUE:FALSE; -+ -+ if(TimeCnt < DM_DIG_TP_Training_Period) -+ { -+ pDM_DigTable->bTpTarget = FALSE; -+ bPerformance = FALSE; -+ TimeCnt++; -+ } -+ else -+ { -+ pDM_DigTable->bTpTarget = TRUE; -+ bPerformance = TRUE; -+ bFirstTpTarget = TRUE; -+ TimeCnt = 0; -+ } -+ } -+ else // remain previous mode -+ { -+ bPerformance = pDM_DigTable->bTpTarget; -+ -+ if(!bPerformance) -+ { -+ if(TimeCnt < DM_DIG_TP_Training_Period) -+ TimeCnt++; -+ else -+ { -+ pDM_DigTable->bTpTarget = TRUE; -+ bPerformance = TRUE; -+ bFirstTpTarget = TRUE; -+ TimeCnt = 0; -+ } -+ } -+ } -+ -+ if(!bPerformance) -+ pDM_DigTable->TpTrainTH_min = RxTp + TxTp; -+ -+ } -+ else -+ { -+ bPerformance = FALSE; -+ pDM_DigTable->TpTrainTH_min = 0; -+ } -+ break; -+ } -+ default: -+ bPerformance = TRUE; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("====== DIG mode = %d ======\n", pDM_Odm->priv->pshare->rf_ft_var.dig_cov_enable)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("====== bPerformance = %d ======\n", bPerformance)); -+#endif -+ -+ //1 Boundary Decision -+#if (RTL8192C_SUPPORT==1) -+ if((pDM_Odm->SupportICType & ODM_RTL8192C) && (pDM_Odm->BoardType & (ODM_BOARD_EXT_LNA | ODM_BOARD_EXT_PA))) -+ { -+ //2 High power case -+ if(pDM_Odm->SupportPlatform & (ODM_AP|ODM_ADSL)) -+ { -+ dm_dig_max = DM_DIG_MAX_AP_HP; -+ dm_dig_min = DM_DIG_MIN_AP_HP; -+ } -+ else -+ { -+ dm_dig_max = DM_DIG_MAX_NIC_HP; -+ dm_dig_min = DM_DIG_MIN_NIC_HP; -+ } -+ DIG_MaxOfMin = DM_DIG_MAX_AP_HP; -+ } -+ else -+#endif -+ { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ //2 For AP\ADSL -+ if(!bPerformance) -+ { -+ dm_dig_max = DM_DIG_MAX_AP_COVERAGR; -+ dm_dig_min = DM_DIG_MIN_AP_COVERAGE; -+ DIG_MaxOfMin = DM_DIG_MAX_OF_MIN_COVERAGE; -+ } -+ else -+ { -+ dm_dig_max = DM_DIG_MAX_AP; -+ dm_dig_min = DM_DIG_MIN_AP; -+ DIG_MaxOfMin = DM_DIG_MAX_OF_MIN; -+ } -+ -+ //4 DFS band -+ if (((*pDM_Odm->pChannel>= 52) &&(*pDM_Odm->pChannel <= 64)) || -+ ((*pDM_Odm->pChannel >= 100) && (*pDM_Odm->pChannel <= 140))) -+ { -+ bDFSBand = TRUE; -+ if (*pDM_Odm->pBandWidth == ODM_BW20M){ -+ dm_dig_min = DM_DIG_MIN_AP_DFS+2; -+ } -+ else{ -+ dm_dig_min = DM_DIG_MIN_AP_DFS; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): ====== In DFS band ======\n")); -+ } -+ -+ //4 TX2path -+ if (priv->pmib->dot11RFEntry.tx2path && !bDFSBand && (*(pDM_Odm->pWirelessMode) == ODM_WM_B)) -+ dm_dig_max = 0x2A; -+ -+#if RTL8192E_SUPPORT -+#ifdef HIGH_POWER_EXT_LNA -+ if ((pDM_Odm->SupportICType & (ODM_RTL8192E)) && (pDM_Odm->ExtLNA)) -+ dm_dig_max = 0x42; -+#endif -+#endif -+ -+#else -+ //2 For WIN\CE -+ if(pDM_Odm->SupportICType >= ODM_RTL8188E) -+ dm_dig_max = 0x5A; -+ else -+ dm_dig_max = DM_DIG_MAX_NIC; -+ -+ if(pDM_Odm->SupportICType != ODM_RTL8821) -+ dm_dig_min = DM_DIG_MIN_NIC; -+ else -+ dm_dig_min = 0x1C; -+ -+ DIG_MaxOfMin = DM_DIG_MAX_AP; -+#endif -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Absolutly upper bound = 0x%x, lower bound = 0x%x\n",dm_dig_max, dm_dig_min)); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ // for P2P case -+ if(0 < *pDM_Odm->pu1ForcedIgiLb) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): P2P case: Force IGI lb to: %u !!!!!!\n", *pDM_Odm->pu1ForcedIgiLb)); -+ dm_dig_min = *pDM_Odm->pu1ForcedIgiLb; -+ dm_dig_max = (dm_dig_min <= dm_dig_max) ? (dm_dig_max) : (dm_dig_min + 1); -+ } -+#endif -+ -+ //1 Adjust boundary by RSSI -+ if(pDM_Odm->bLinked && bPerformance) -+ { -+ //2 Modify DIG upper bound -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ offset = 15; -+#else -+ //4 Modify DIG upper bound for 92E, 8723A\B, 8821 & 8812 BT -+ if((pDM_Odm->SupportICType & (ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8812|ODM_RTL8821|ODM_RTL8723A)) && (pDM_Odm->bBtLimitedDig==1)) -+ { -+ offset = 10; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Coex. case: Force upper bound to RSSI + %d !!!!!!\n", offset)); -+ } -+ else -+ offset = 15; -+#endif -+ -+ if((pDM_Odm->RSSI_Min + offset) > dm_dig_max ) -+ pDM_DigTable->rx_gain_range_max = dm_dig_max; -+ else if((pDM_Odm->RSSI_Min + offset) < dm_dig_min ) -+ pDM_DigTable->rx_gain_range_max = dm_dig_min; -+ else -+ pDM_DigTable->rx_gain_range_max = pDM_Odm->RSSI_Min + offset; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ //2 Modify DIG lower bound -+ //if(pDM_Odm->bOneEntryOnly) -+ { -+ if(pDM_Odm->RSSI_Min < dm_dig_min) -+ DIG_Dynamic_MIN = dm_dig_min; -+ else if (pDM_Odm->RSSI_Min > DIG_MaxOfMin) -+ DIG_Dynamic_MIN = DIG_MaxOfMin; -+ else -+ DIG_Dynamic_MIN = pDM_Odm->RSSI_Min; -+ } -+#else -+ { -+ //4 For AP -+#ifdef __ECOS -+ HAL_REORDER_BARRIER(); -+#else -+ rmb(); -+#endif -+ if (bDFSBand) -+ { -+ DIG_Dynamic_MIN = dm_dig_min; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: Force lower bound to 0x%x after link !!!!!!\n", dm_dig_min)); -+ } -+ else -+ { -+ if(pDM_Odm->RSSI_Min < dm_dig_min) -+ DIG_Dynamic_MIN = dm_dig_min; -+ else if (pDM_Odm->RSSI_Min > DIG_MaxOfMin) -+ DIG_Dynamic_MIN = DIG_MaxOfMin; -+ else -+ DIG_Dynamic_MIN = pDM_Odm->RSSI_Min; -+ } -+ } -+#endif -+ } -+ else -+ { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ if(bPerformance && bDFSBand) -+ { -+ pDM_DigTable->rx_gain_range_max = 0x28; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: Force upper bound to 0x%x before link !!!!!!\n", pDM_DigTable->rx_gain_range_max)); -+ } -+ else -+#endif -+ { -+ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_OF_MIN; -+ } -+ DIG_Dynamic_MIN = dm_dig_min; -+ } -+ -+ //1 Force Lower Bound for AntDiv -+ if(pDM_Odm->bLinked && !pDM_Odm->bOneEntryOnly) -+ { -+ if((pDM_Odm->SupportICType & ODM_ANTDIV_SUPPORT) && (pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ { -+ if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV || pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) { -+ if (pDM_DigTable->AntDiv_RSSI_max > DIG_MaxOfMin) -+ DIG_Dynamic_MIN = DIG_MaxOfMin; -+ else -+ DIG_Dynamic_MIN = (u1Byte) pDM_DigTable->AntDiv_RSSI_max; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Antenna diversity case: Force lower bound to 0x%x !!!!!!\n", DIG_Dynamic_MIN)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Antenna diversity case: RSSI_max = 0x%x !!!!!!\n", pDM_DigTable->AntDiv_RSSI_max)); -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust boundary by RSSI Upper bound = 0x%x, Lower bound = 0x%x\n", -+ pDM_DigTable->rx_gain_range_max, DIG_Dynamic_MIN)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Link status: bLinked = %d, RSSI = %d, bFirstConnect = %d, bFirsrDisConnect = %d\n\n", -+ pDM_Odm->bLinked, pDM_Odm->RSSI_Min, FirstConnect, FirstDisConnect)); -+ -+ //1 Modify DIG lower bound, deal with abnormal case -+ //2 Abnormal false alarm case -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ if(bDFSBand) -+ { -+ pDM_DigTable->rx_gain_range_min = DIG_Dynamic_MIN; -+ } -+ else -+#endif -+ { -+ if(!pDM_Odm->bLinked) -+ { -+ pDM_DigTable->rx_gain_range_min = DIG_Dynamic_MIN; -+ -+ if (FirstDisConnect) -+ pDM_DigTable->ForbiddenIGI = DIG_Dynamic_MIN; -+ } -+ else -+ pDM_DigTable->rx_gain_range_min = odm_ForbiddenIGICheck(pDM_Odm, DIG_Dynamic_MIN, CurrentIGI); -+ } -+ -+ //2 Abnormal # beacon case -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(pDM_Odm->bLinked && !FirstConnect) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Beacon Num (%d)\n", pDM_Odm->PhyDbgInfo.NumQryBeaconPkt)); -+ if((pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 5) && (pDM_Odm->bsta_state)) -+ { -+ pDM_DigTable->rx_gain_range_min = dm_dig_min; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnrormal #beacon (%d) case in STA mode: Force lower bound to 0x%x !!!!!!\n\n", -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt, pDM_DigTable->rx_gain_range_min)); -+ } -+ } -+#endif -+ -+ //2 Abnormal lower bound case -+ if(pDM_DigTable->rx_gain_range_min > pDM_DigTable->rx_gain_range_max) -+ { -+ pDM_DigTable->rx_gain_range_min = pDM_DigTable->rx_gain_range_max; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnrormal lower bound case: Force lower bound to 0x%x !!!!!!\n\n",pDM_DigTable->rx_gain_range_min)); -+ } -+ -+ -+ //1 False alarm threshold decision -+ odm_FAThresholdCheck(pDM_Odm, bDFSBand, bPerformance, RxTp, TxTp, dm_FA_thres); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): False alarm threshold = %d, %d, %d \n\n", dm_FA_thres[0], dm_FA_thres[1], dm_FA_thres[2])); -+ -+ //1 Adjust initial gain by false alarm -+ if(pDM_Odm->bLinked && bPerformance) -+ { -+ //2 After link -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust IGI after link\n")); -+ -+ if(bFirstTpTarget || (FirstConnect && bPerformance)) -+ { -+ pDM_DigTable->LargeFAHit = 0; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ if(bDFSBand) -+ { -+ if(pDM_Odm->RSSI_Min > 0x28) -+ CurrentIGI = 0x28; -+ else -+ CurrentIGI = pDM_Odm->RSSI_Min; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: One-shot to 0x28 upmost!!!!!!\n")); -+ } -+ else -+#endif -+ { -+ if(pDM_Odm->RSSI_Min < DIG_MaxOfMin) -+ { -+ if(CurrentIGI < pDM_Odm->RSSI_Min) -+ CurrentIGI = pDM_Odm->RSSI_Min; -+ } -+ else -+ { -+ if(CurrentIGI < DIG_MaxOfMin) -+ CurrentIGI = DIG_MaxOfMin; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+#if (RTL8812A_SUPPORT==1) -+ if(pDM_Odm->SupportICType == ODM_RTL8812) -+ ODM_ConfigBBWithHeaderFile(pDM_Odm, CONFIG_BB_AGC_TAB_DIFF); -+#endif -+#endif -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): First connect case: IGI does on-shot to 0x%x\n", CurrentIGI)); -+ -+ } -+ else -+ { -+ if(pFalseAlmCnt->Cnt_all > dm_FA_thres[2]) -+ CurrentIGI = CurrentIGI + 4; -+ else if (pFalseAlmCnt->Cnt_all > dm_FA_thres[1]) -+ CurrentIGI = CurrentIGI + 2; -+ else if(pFalseAlmCnt->Cnt_all < dm_FA_thres[0]) -+ CurrentIGI = CurrentIGI - 2; -+ -+ //4 Abnormal # beacon case -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if((pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 5) && (pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH1) && (pDM_Odm->bsta_state)) -+ { -+ CurrentIGI = pDM_DigTable->rx_gain_range_min; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormal #beacon (%d) case: IGI does one-shot to 0x%x\n", -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt, CurrentIGI)); -+ } -+#endif -+ } -+ } -+ else -+ { -+ //2 Before link -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust IGI before link\n")); -+ -+ if(FirstDisConnect || bFirstCoverage) -+ { -+ CurrentIGI = dm_dig_min; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): First disconnect case: IGI does on-shot to lower bound\n")); -+ } -+ else -+ { -+ if(pFalseAlmCnt->Cnt_all > dm_FA_thres[2]) -+ CurrentIGI = CurrentIGI + 4; -+ else if (pFalseAlmCnt->Cnt_all > dm_FA_thres[1]) -+ CurrentIGI = CurrentIGI + 2; -+ else if(pFalseAlmCnt->Cnt_all < dm_FA_thres[0]) -+ CurrentIGI = CurrentIGI - 2; -+ } -+ } -+ -+ //1 Check initial gain by upper/lower bound -+ if(CurrentIGI < pDM_DigTable->rx_gain_range_min) -+ CurrentIGI = pDM_DigTable->rx_gain_range_min; -+ -+ if(CurrentIGI > pDM_DigTable->rx_gain_range_max) -+ CurrentIGI = pDM_DigTable->rx_gain_range_max; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): CurIGValue=0x%x, TotalFA = %d\n\n", CurrentIGI, pFalseAlmCnt->Cnt_all)); -+ -+ //1 High power RSSI threshold -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if((pDM_Odm->SupportICType == ODM_RTL8723A)&& (pHalData->UndecoratedSmoothedPWDB > DM_DIG_HIGH_PWR_THRESHOLD)) -+ { -+ // High power IGI lower bound -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): UndecoratedSmoothedPWDB(%#x)\n", pHalData->UndecoratedSmoothedPWDB)); -+ if(CurrentIGI < DM_DIG_HIGH_PWR_IGI_LOWER_BOUND) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): CurIGValue(%#x)\n", pDM_DigTable->CurIGValue)); -+ //pDM_DigTable->CurIGValue = DM_DIG_HIGH_PWR_IGI_LOWER_BOUND; -+ CurrentIGI=DM_DIG_HIGH_PWR_IGI_LOWER_BOUND; -+ } -+ } -+ if((pDM_Odm->SupportICType & ODM_RTL8723A) && IS_WIRELESS_MODE_G(pAdapter)) -+ { -+ if(pHalData->UndecoratedSmoothedPWDB > 0x28) -+ { -+ if(CurrentIGI < DM_DIG_Gmode_HIGH_PWR_IGI_LOWER_BOUND) -+ { -+ //pDM_DigTable->CurIGValue = DM_DIG_Gmode_HIGH_PWR_IGI_LOWER_BOUND; -+ CurrentIGI = DM_DIG_Gmode_HIGH_PWR_IGI_LOWER_BOUND; -+ } -+ } -+ } -+#endif -+ -+ //1 Update status -+#if (RTL8192D_SUPPORT==1) -+ if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ { -+ //sherry delete DualMacSmartConncurrent 20110517 -+ if(*(pDM_Odm->pMacPhyMode) == ODM_DMSP) -+ { -+ ODM_Write_DIG_DMSP(pDM_Odm, CurrentIGI);//ODM_Write_DIG_DMSP(pDM_Odm, pDM_DigTable->CurIGValue); -+ if(*(pDM_Odm->pbMasterOfDMSP)) -+ { -+ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; -+ } -+ else -+ { -+ pDM_DigTable->bMediaConnect_1 = pDM_Odm->bLinked; -+ pDM_DigTable->DIG_Dynamic_MIN_1 = DIG_Dynamic_MIN; -+ } -+ } -+ else -+ { -+ ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); -+ if(*(pDM_Odm->pBandType) == ODM_BAND_5G) -+ { -+ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; -+ } -+ else -+ { -+ pDM_DigTable->bMediaConnect_1 = pDM_Odm->bLinked; -+ pDM_DigTable->DIG_Dynamic_MIN_1 = DIG_Dynamic_MIN; -+ } -+ } -+ } -+ else -+#endif -+ { -+#if ((DM_ODM_SUPPORT_TYPE & ODM_WIN) || ((DM_ODM_SUPPORT_TYPE & ODM_CE) && (ODM_CONFIG_BT_COEXIST == 1))) -+ if(pDM_Odm->bBtHsOperation) -+ { -+ if(pDM_Odm->bLinked) -+ { -+ if(pDM_DigTable->BT30_CurIGI > (CurrentIGI)) -+ ODM_Write_DIG(pDM_Odm, CurrentIGI); -+ else -+ ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI); -+ -+ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; -+ } -+ else -+ { -+ if(pDM_Odm->bLinkInProcess) -+ ODM_Write_DIG(pDM_Odm, 0x1c); -+ else if(pDM_Odm->bBtConnectProcess) -+ ODM_Write_DIG(pDM_Odm, 0x28); -+ else -+ ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); -+ } -+ } -+ else // BT is not using -+#endif -+ { -+ ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); -+ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; -+ } -+ } -+} -+ -+VOID -+odm_DIGbyRSSI_LPS( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+ -+ u1Byte RSSI_Lower=DM_DIG_MIN_NIC; //0x1E or 0x1C -+ u1Byte CurrentIGI=pDM_Odm->RSSI_Min; -+ -+ if(odm_DigAbort(pDM_Odm) == TRUE) -+ return; -+ -+ CurrentIGI=CurrentIGI+RSSI_OFFSET_DIG; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS()==>\n")); -+ -+ // Using FW PS mode to make IGI -+ //Adjust by FA in LPS MODE -+ if(pFalseAlmCnt->Cnt_all> DM_DIG_FA_TH2_LPS) -+ CurrentIGI = CurrentIGI+4; -+ else if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH1_LPS) -+ CurrentIGI = CurrentIGI+2; -+ else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0_LPS) -+ CurrentIGI = CurrentIGI-2; -+ -+ -+ //Lower bound checking -+ -+ //RSSI Lower bound check -+ if((pDM_Odm->RSSI_Min-10) > DM_DIG_MIN_NIC) -+ RSSI_Lower =(pDM_Odm->RSSI_Min-10); -+ else -+ RSSI_Lower =DM_DIG_MIN_NIC; -+ -+ //Upper and Lower Bound checking -+ if(CurrentIGI > DM_DIG_MAX_NIC) -+ CurrentIGI=DM_DIG_MAX_NIC; -+ else if(CurrentIGI < RSSI_Lower) -+ CurrentIGI =RSSI_Lower; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS(): pFalseAlmCnt->Cnt_all = %d\n",pFalseAlmCnt->Cnt_all)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS(): pDM_Odm->RSSI_Min = %d\n",pDM_Odm->RSSI_Min)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS(): CurrentIGI = 0x%x\n",CurrentIGI)); -+ -+ ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); -+#endif -+} -+ -+//3============================================================ -+//3 FASLE ALARM CHECK -+//3============================================================ -+ -+VOID -+odm_FalseAlarmCounterStatistics( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+ u4Byte ret_value; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+//Mark there, and check this in odm_DMWatchDog -+#if 0 //(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ if( (priv->auto_channel != 0) && (priv->auto_channel != 2) ) -+ return; -+#endif -+#endif -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT)) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics()======>\n")); -+ -+#if (ODM_IC_11N_SERIES_SUPPORT == 1) -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ -+ //hold ofdm counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT31, 1); //hold page C counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT31, 1); //hold page D counter -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE1_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_Fast_Fsync = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_SB_Search_fail = ((ret_value&0xffff0000)>>16); -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE2_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_OFDM_CCA = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_Parity_Fail = ((ret_value&0xffff0000)>>16); -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE3_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_Rate_Illegal = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_Crc8_fail = ((ret_value&0xffff0000)>>16); -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE4_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_Mcs_fail = (ret_value&0xffff); -+ -+ FalseAlmCnt->Cnt_Ofdm_fail = FalseAlmCnt->Cnt_Parity_Fail + FalseAlmCnt->Cnt_Rate_Illegal + -+ FalseAlmCnt->Cnt_Crc8_fail + FalseAlmCnt->Cnt_Mcs_fail + -+ FalseAlmCnt->Cnt_Fast_Fsync + FalseAlmCnt->Cnt_SB_Search_fail; -+ -+#if (RTL8188E_SUPPORT==1) -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_SC_CNT_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_BW_LSC = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_BW_USC = ((ret_value&0xffff0000)>>16); -+ } -+#endif -+ -+#if (RTL8192D_SUPPORT==1) -+ if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ { -+ odm_GetCCKFalseAlarm_92D(pDM_Odm); -+ } -+ else -+#endif -+ { -+ //hold cck counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT12, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT14, 1); -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_LSB_11N, bMaskByte0); -+ FalseAlmCnt->Cnt_Cck_fail = ret_value; -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_MSB_11N, bMaskByte3); -+ FalseAlmCnt->Cnt_Cck_fail += (ret_value& 0xff)<<8; -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CCA_CNT_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_CCK_CCA = ((ret_value&0xFF)<<8) |((ret_value&0xFF00)>>8); -+ } -+ -+ FalseAlmCnt->Cnt_all = ( FalseAlmCnt->Cnt_Fast_Fsync + -+ FalseAlmCnt->Cnt_SB_Search_fail + -+ FalseAlmCnt->Cnt_Parity_Fail + -+ FalseAlmCnt->Cnt_Rate_Illegal + -+ FalseAlmCnt->Cnt_Crc8_fail + -+ FalseAlmCnt->Cnt_Mcs_fail + -+ FalseAlmCnt->Cnt_Cck_fail); -+ -+ FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_OFDM_CCA + FalseAlmCnt->Cnt_CCK_CCA; -+ -+#if (RTL8192C_SUPPORT==1) -+ if(pDM_Odm->SupportICType == ODM_RTL8192C) -+ odm_ResetFACounter_92C(pDM_Odm); -+#endif -+ -+#if (RTL8192D_SUPPORT==1) -+ if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ odm_ResetFACounter_92D(pDM_Odm); -+#endif -+ -+ if(pDM_Odm->SupportICType >=ODM_RTL8723A) -+ { -+ //reset false alarm counter registers -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT31, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT31, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT27, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT27, 0); -+ -+ //update ofdm counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT31, 0); //update page C counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT31, 0); //update page D counter -+ -+ //reset CCK CCA counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT13|BIT12, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT13|BIT12, 2); -+ //reset CCK FA counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT15|BIT14, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT15|BIT14, 2); -+ } -+ -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Fast_Fsync=%d, Cnt_SB_Search_fail=%d\n", -+ FalseAlmCnt->Cnt_Fast_Fsync, FalseAlmCnt->Cnt_SB_Search_fail)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Parity_Fail=%d, Cnt_Rate_Illegal=%d\n", -+ FalseAlmCnt->Cnt_Parity_Fail, FalseAlmCnt->Cnt_Rate_Illegal)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Crc8_fail=%d, Cnt_Mcs_fail=%d\n", -+ FalseAlmCnt->Cnt_Crc8_fail, FalseAlmCnt->Cnt_Mcs_fail)); -+ } -+#endif -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT == 1) -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ { -+ u4Byte CCKenable; -+ -+ /* read OFDM FA counter */ -+ FalseAlmCnt->Cnt_Ofdm_fail = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_11AC, bMaskLWord); -+ -+ -+ /* Read CCK FA counter */ -+ FalseAlmCnt->Cnt_Cck_fail = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_11AC, bMaskLWord); -+ -+ /* read CCK/OFDM CCA counter */ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CCA_CNT_11AC, bMaskDWord); -+ FalseAlmCnt->Cnt_OFDM_CCA = (ret_value & 0xffff0000) >> 16; -+ FalseAlmCnt->Cnt_CCK_CCA = ret_value & 0xffff; -+ -+#if (RTL8881A_SUPPORT==1) -+ /* For 8881A */ -+ if(pDM_Odm->SupportICType == ODM_RTL8881A) -+ { -+ u4Byte Cnt_Ofdm_fail_temp = 0; -+ -+ if(FalseAlmCnt->Cnt_Ofdm_fail >= FalseAlmCnt->Cnt_Ofdm_fail_pre) -+ { -+ Cnt_Ofdm_fail_temp = FalseAlmCnt->Cnt_Ofdm_fail_pre; -+ FalseAlmCnt->Cnt_Ofdm_fail_pre = FalseAlmCnt->Cnt_Ofdm_fail; -+ FalseAlmCnt->Cnt_Ofdm_fail = FalseAlmCnt->Cnt_Ofdm_fail - Cnt_Ofdm_fail_temp; -+ } -+ else -+ FalseAlmCnt->Cnt_Ofdm_fail_pre = FalseAlmCnt->Cnt_Ofdm_fail; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail_pre)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail_pre=%d\n", Cnt_Ofdm_fail_temp)); -+ -+ /* Reset FA counter by enable/disable OFDM */ -+ if(FalseAlmCnt->Cnt_Ofdm_fail_pre >= 0x7fff) -+ { -+ // reset OFDM -+ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT29,0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT29,1); -+ FalseAlmCnt->Cnt_Ofdm_fail_pre = 0; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Reset false alarm counter\n")); -+ } -+ } -+#endif -+ -+ /* reset OFDM FA coutner */ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RST_11AC, BIT17, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RST_11AC, BIT17, 0); -+ -+ /* reset CCK FA counter */ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11AC, BIT15, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11AC, BIT15, 1); -+ -+ /* reset CCA counter */ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RST_RPT_11AC, BIT0, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RST_RPT_11AC, BIT0, 0); -+ -+ CCKenable = ODM_GetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT28); -+ if(CCKenable)//if(*pDM_Odm->pBandType == ODM_BAND_2_4G) -+ { -+ FalseAlmCnt->Cnt_all = FalseAlmCnt->Cnt_Ofdm_fail + FalseAlmCnt->Cnt_Cck_fail; -+ FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_CCK_CCA + FalseAlmCnt->Cnt_OFDM_CCA; -+ } -+ else -+ { -+ FalseAlmCnt->Cnt_all = FalseAlmCnt->Cnt_Ofdm_fail; -+ FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_OFDM_CCA; -+ } -+ -+ } -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_OFDM_CCA=%d\n", FalseAlmCnt->Cnt_OFDM_CCA)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_CCK_CCA=%d\n", FalseAlmCnt->Cnt_CCK_CCA)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_CCA_all=%d\n", FalseAlmCnt->Cnt_CCA_all)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Cck_fail=%d\n", FalseAlmCnt->Cnt_Cck_fail)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Total False Alarm=%d\n\n", FalseAlmCnt->Cnt_all)); -+} -+ -+//3============================================================ -+//3 CCK Packet Detect Threshold -+//3============================================================ -+ -+VOID -+odm_PauseCCKPacketDetection( -+ IN PVOID pDM_VOID, -+ IN PHYDM_PAUSE_TYPE PauseType, -+ IN PHYDM_PAUSE_LEVEL pause_level, -+ IN u1Byte CCKPDThreshold -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection()=========> level = %d\n", pause_level)); -+ -+ if ((pDM_DigTable->pause_cckpd_level == 0) && (!(pDM_Odm->SupportAbility & ODM_BB_CCK_PD) || !(pDM_Odm->SupportAbility & ODM_BB_FA_CNT))) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("Return: SupportAbility ODM_BB_CCK_PD or ODM_BB_FA_CNT is disabled\n")); -+ return; -+ } -+ -+ if (pause_level > DM_DIG_MAX_PAUSE_TYPE) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, -+ ("odm_PauseCCKPacketDetection(): Return: Wrong pause level !!\n")); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_cckpd_level, CCKPDThreshold)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", -+ pDM_DigTable->pause_cckpd_value[7], pDM_DigTable->pause_cckpd_value[6], pDM_DigTable->pause_cckpd_value[5], pDM_DigTable->pause_cckpd_value[4], -+ pDM_DigTable->pause_cckpd_value[3], pDM_DigTable->pause_cckpd_value[2], pDM_DigTable->pause_cckpd_value[1], pDM_DigTable->pause_cckpd_value[0])); -+ -+ switch (PauseType) { -+ /* Pause CCK Packet Detection Threshold */ -+ case PHYDM_PAUSE: -+ { -+ /* Disable CCK PD */ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility & (~ODM_BB_CCK_PD)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Pause CCK packet detection threshold !!\n")); -+ -+ /* Backup original CCK PD threshold decided by CCK PD mechanism */ -+ if (pDM_DigTable->pause_cckpd_level == 0) { -+ pDM_DigTable->CCKPDBackup = pDM_DigTable->CurCCK_CCAThres; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, -+ ("odm_PauseCCKPacketDetection(): Backup CCKPD = 0x%x, new CCKPD = 0x%x\n", pDM_DigTable->CCKPDBackup, CCKPDThreshold)); -+ } -+ -+ /* Update pause level */ -+ pDM_DigTable->pause_cckpd_level = (pDM_DigTable->pause_cckpd_level | BIT(pause_level)); -+ -+ /* Record CCK PD threshold */ -+ pDM_DigTable->pause_cckpd_value[pause_level] = CCKPDThreshold; -+ -+ /* Write new CCK PD threshold */ -+ if (BIT(pause_level + 1) > pDM_DigTable->pause_cckpd_level) { -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, CCKPDThreshold); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): CCKPD of higher level = 0x%x\n", CCKPDThreshold)); -+ } -+ break; -+ } -+ /* Resume CCK Packet Detection Threshold */ -+ case PHYDM_RESUME: -+ { -+ /* check if the level is illegal or not */ -+ if ((pDM_DigTable->pause_cckpd_level & (BIT(pause_level))) != 0) { -+ pDM_DigTable->pause_cckpd_level = pDM_DigTable->pause_cckpd_level & (~(BIT(pause_level))); -+ pDM_DigTable->pause_cckpd_value[pause_level] = 0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Resume CCK PD !!\n")); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Wrong resume level !!\n")); -+ break; -+ } -+ -+ /* Resume DIG */ -+ if (pDM_DigTable->pause_cckpd_level == 0) { -+ /* Write backup IGI value */ -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, pDM_DigTable->CCKPDBackup); -+ /* pDM_DigTable->bIgnoreDIG = TRUE; */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Write original CCKPD = 0x%x\n", pDM_DigTable->CCKPDBackup)); -+ -+ /* Enable DIG */ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility | ODM_BB_CCK_PD); -+ break; -+ } -+ -+ if (BIT(pause_level) > pDM_DigTable->pause_cckpd_level) { -+ u1Byte max_level; -+ -+ /* Calculate the maximum level now */ -+ for (max_level = (pause_level - 1); max_level >= 0; max_level--) { -+ if ((pDM_DigTable->pause_cckpd_level & BIT(max_level)) > 0) -+ break; -+ } -+ -+ /* write CCKPD of lower level */ -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, pDM_DigTable->pause_cckpd_value[max_level]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Write CCKPD (0x%x) of level (%d)\n", -+ pDM_DigTable->pause_cckpd_value[max_level], max_level)); -+ break; -+ } -+ break; -+ } -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Wrong type !!\n")); -+ break; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_cckpd_level, CCKPDThreshold)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", -+ pDM_DigTable->pause_cckpd_value[7], pDM_DigTable->pause_cckpd_value[6], pDM_DigTable->pause_cckpd_value[5], pDM_DigTable->pause_cckpd_value[4], -+ pDM_DigTable->pause_cckpd_value[3], pDM_DigTable->pause_cckpd_value[2], pDM_DigTable->pause_cckpd_value[1], pDM_DigTable->pause_cckpd_value[0])); -+} -+ -+ -+VOID -+odm_CCKPacketDetectionThresh( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+ u1Byte CurCCK_CCAThres, RSSI_thd = 55; -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+//modify by Guo.Mingzhi 2011-12-29 -+ if (pDM_Odm->bDualMacSmartConcurrent == TRUE) -+// if (pDM_Odm->bDualMacSmartConcurrent == FALSE) -+ return; -+ if(pDM_Odm->bBtHsOperation) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() write 0xcd for BT HS mode!!\n")); -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, 0xcd); -+ return; -+ } -+#endif -+ -+ if((!(pDM_Odm->SupportAbility & ODM_BB_CCK_PD)) ||(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT))) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() return==========\n")); -+#ifdef MCR_WIRELESS_EXTEND -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, 0x43); -+#endif -+ return; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(pDM_Odm->ExtLNA) -+ return; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() ==========>\n")); -+ -+ if (pDM_Odm->bLinked) -+ { -+ if (pDM_Odm->RSSI_Min > RSSI_thd) -+ CurCCK_CCAThres = 0xcd; -+ else if ((pDM_Odm->RSSI_Min <= RSSI_thd) && (pDM_Odm->RSSI_Min > 10)) -+ CurCCK_CCAThres = 0x83; -+ else -+ { -+ if(FalseAlmCnt->Cnt_Cck_fail > 1000) -+ CurCCK_CCAThres = 0x83; -+ else -+ CurCCK_CCAThres = 0x40; -+ } -+ } else { -+ if(FalseAlmCnt->Cnt_Cck_fail > 1000) -+ CurCCK_CCAThres = 0x83; -+ else -+ CurCCK_CCAThres = 0x40; -+ } -+ -+#if (RTL8192D_SUPPORT==1) -+ if((pDM_Odm->SupportICType == ODM_RTL8192D) && (*pDM_Odm->pBandType == ODM_BAND_2_4G)) -+ ODM_Write_CCK_CCA_Thres_92D(pDM_Odm, CurCCK_CCAThres); -+ else -+#endif -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, CurCCK_CCAThres); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CCK_PD, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() CurCCK_CCAThres = 0x%x\n",CurCCK_CCAThres)); -+} -+ -+VOID -+ODM_Write_CCK_CCA_Thres( -+ IN PVOID pDM_VOID, -+ IN u1Byte CurCCK_CCAThres -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ if(pDM_DigTable->CurCCK_CCAThres!=CurCCK_CCAThres) //modify by Guo.Mingzhi 2012-01-03 -+ { -+ ODM_Write1Byte(pDM_Odm, ODM_REG(CCK_CCA,pDM_Odm), CurCCK_CCAThres); -+ } -+ pDM_DigTable->PreCCK_CCAThres = pDM_DigTable->CurCCK_CCAThres; -+ pDM_DigTable->CurCCK_CCAThres = CurCCK_CCAThres; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+// <20130108, Kordan> E.g., With LNA used, we make the Rx power smaller to have a better EVM. (Asked by Willis) -+VOID -+odm_RFEControl( -+ IN PDM_ODM_T pDM_Odm, -+ IN u8Byte RSSIVal -+ ) -+{ -+ PADAPTER Adapter = (PADAPTER)pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ static u1Byte TRSW_HighPwr = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("===> odm_RFEControl, RSSI = %d, TRSW_HighPwr = 0x%X, pHalData->RFEType = %d\n", -+ RSSIVal, TRSW_HighPwr, pHalData->RFEType )); -+ -+ if (pHalData->RFEType == 3) { -+ -+ pDM_Odm->RSSI_TRSW = RSSIVal; -+ -+ if (pDM_Odm->RSSI_TRSW >= pDM_Odm->RSSI_TRSW_H) -+ { -+ TRSW_HighPwr = 1; // Switch to -+ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x1); // Set ANTSW=1/ANTSWB=0 for SW control -+ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); // Set ANTSW=1/ANTSWB=0 for SW control -+ -+ } -+ else if (pDM_Odm->RSSI_TRSW <= pDM_Odm->RSSI_TRSW_L) -+ { -+ TRSW_HighPwr = 0; // Switched back -+ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x1); // Set ANTSW=1/ANTSWB=0 for SW control -+ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x0); // Set ANTSW=1/ANTSWB=0 for SW control -+ -+ } -+ } -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("(pDM_Odm->RSSI_TRSW_H, pDM_Odm->RSSI_TRSW_L) = (%d, %d)\n", pDM_Odm->RSSI_TRSW_H, pDM_Odm->RSSI_TRSW_L)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("(RSSIVal, RSSIVal, pDM_Odm->RSSI_TRSW_iso) = (%d, %d, %d)\n", -+ RSSIVal, pDM_Odm->RSSI_TRSW_iso, pDM_Odm->RSSI_TRSW)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("<=== odm_RFEControl, RSSI = %d, TRSW_HighPwr = 0x%X\n", RSSIVal, TRSW_HighPwr)); -+} -+ -+VOID -+odm_MPT_DIGWorkItemCallback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER Adapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ ODM_MPT_DIG(pDM_Odm); -+} -+ -+VOID -+odm_MPT_DIGCallback( -+ PRT_TIMER pTimer -+) -+{ -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ -+ #if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ #if USE_WORKITEM -+ PlatformScheduleWorkItem(&pDM_Odm->MPT_DIGWorkitem); -+ #else -+ ODM_MPT_DIG(pDM_Odm); -+ #endif -+ #else -+ PlatformScheduleWorkItem(&pDM_Odm->MPT_DIGWorkitem); -+ #endif -+ -+} -+ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+VOID -+odm_MPT_DIGCallback( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if USE_WORKITEM -+ PlatformScheduleWorkItem(&pDM_Odm->MPT_DIGWorkitem); -+#else -+ ODM_MPT_DIG(pDM_Odm); -+#endif -+} -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE != ODM_CE) -+VOID -+odm_MPT_Write_DIG( -+ IN PVOID pDM_VOID, -+ IN u1Byte CurIGValue -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_A,pDM_Odm), CurIGValue); -+ -+ if(pDM_Odm->RFType > ODM_1T1R) -+ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_B,pDM_Odm), CurIGValue); -+ -+ if((pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) && (pDM_Odm->RFType > ODM_2T2R)) -+ { -+ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_C,pDM_Odm), CurIGValue); -+ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_D,pDM_Odm), CurIGValue); -+ } -+ -+ pDM_DigTable->CurIGValue = CurIGValue; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("CurIGValue = 0x%x\n", CurIGValue)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("pDM_Odm->RFType = 0x%x\n", pDM_Odm->RFType)); -+} -+ -+VOID -+ODM_MPT_DIG( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+ u1Byte CurrentIGI = pDM_DigTable->CurIGValue; -+ u1Byte DIG_Upper = 0x40, DIG_Lower = 0x20; -+ u4Byte RXOK_cal; -+ u4Byte RxPWDBAve_final; -+ u1Byte IGI_A = 0x20, IGI_B = 0x20; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ #if ODM_FIX_2G_DIG -+ IGI_A = 0x22; -+ IGI_B = 0x24; -+ #endif -+ -+#else -+ if (!(pDM_Odm->priv->pshare->rf_ft_var.mp_specific && pDM_Odm->priv->pshare->mp_dig_on)) -+ return; -+ -+ if (*pDM_Odm->pBandType == ODM_BAND_5G) -+ DIG_Lower = 0x22; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("===> ODM_MPT_DIG, pBandType = %d\n", *pDM_Odm->pBandType)); -+ -+#if (ODM_FIX_2G_DIG || (DM_ODM_SUPPORT_TYPE & ODM_AP)) -+ if (*pDM_Odm->pBandType == ODM_BAND_5G || (pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B))) // for 5G or 8814 -+#else -+ if (1) // for both 2G/5G -+#endif -+ { -+ odm_FalseAlarmCounterStatistics(pDM_Odm); -+ -+ RXOK_cal = pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK + pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM; -+ RxPWDBAve_final = (RXOK_cal != 0)?pDM_Odm->RxPWDBAve/RXOK_cal:0; -+ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; -+ pDM_Odm->RxPWDBAve = 0; -+ pDM_Odm->MPDIG_2G = FALSE; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pDM_Odm->Times_2G = 0; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("RX OK = %d\n", RXOK_cal)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("RSSI = %d\n", RxPWDBAve_final)); -+ -+ if (RXOK_cal >= 70 && RxPWDBAve_final <= 40) -+ { -+ if (CurrentIGI > 0x24) -+ odm_MPT_Write_DIG(pDM_Odm, 0x24); -+ } -+ else -+ { -+ if(pFalseAlmCnt->Cnt_all > 1000){ -+ CurrentIGI = CurrentIGI + 8; -+ } -+ else if(pFalseAlmCnt->Cnt_all > 200){ -+ CurrentIGI = CurrentIGI + 4; -+ } -+ else if (pFalseAlmCnt->Cnt_all > 50){ -+ CurrentIGI = CurrentIGI + 2; -+ } -+ else if (pFalseAlmCnt->Cnt_all < 2){ -+ CurrentIGI = CurrentIGI - 2; -+ } -+ -+ if (CurrentIGI < DIG_Lower ){ -+ CurrentIGI = DIG_Lower; -+ } -+ -+ if(CurrentIGI > DIG_Upper){ -+ CurrentIGI = DIG_Upper; -+ } -+ -+ odm_MPT_Write_DIG(pDM_Odm, CurrentIGI); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("DIG = 0x%x, Cnt_all = %d, Cnt_Ofdm_fail = %d, Cnt_Cck_fail = %d\n", -+ CurrentIGI, pFalseAlmCnt->Cnt_all, pFalseAlmCnt->Cnt_Ofdm_fail, pFalseAlmCnt->Cnt_Cck_fail)); -+ } -+ } -+ else -+ { -+ if(pDM_Odm->MPDIG_2G == FALSE) -+ { -+ if((pDM_Odm->SupportPlatform & ODM_WIN) && !(pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B))) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("===> Fix IGI\n")); -+ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_A,pDM_Odm), IGI_A); -+ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_B,pDM_Odm), IGI_B); -+ pDM_DigTable->CurIGValue = IGI_B; -+ } -+ else -+ odm_MPT_Write_DIG(pDM_Odm, IGI_A); -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pDM_Odm->Times_2G++; -+ -+ if (pDM_Odm->Times_2G == 3) -+#endif -+ { -+ pDM_Odm->MPDIG_2G = TRUE; -+ } -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ odm_RFEControl(pDM_Odm, RxPWDBAve_final); -+#endif -+ -+ ODM_SetTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer, 700); -+} -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_dig.h linux/3rdparty/rtl8812au/hal/phydm/phydm_dig.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_dig.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_dig.h 2017-06-07 23:07:21.018688214 +0300 -@@ -0,0 +1,327 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMDIG_H__ -+#define __PHYDMDIG_H__ -+ -+#define DIG_VERSION "1.8" /*2015.07.01*/ -+ -+/* Pause DIG & CCKPD */ -+#define DM_DIG_MAX_PAUSE_TYPE 0x7 -+ -+typedef struct _Dynamic_Initial_Gain_Threshold_ -+{ -+ BOOLEAN bStopDIG; // for debug -+ BOOLEAN bIgnoreDIG; -+ BOOLEAN bPSDInProgress; -+ -+ u1Byte Dig_Enable_Flag; -+ u1Byte Dig_Ext_Port_Stage; -+ -+ int RssiLowThresh; -+ int RssiHighThresh; -+ -+ u4Byte FALowThresh; -+ u4Byte FAHighThresh; -+ -+ u1Byte CurSTAConnectState; -+ u1Byte PreSTAConnectState; -+ u1Byte CurMultiSTAConnectState; -+ -+ u1Byte PreIGValue; -+ u1Byte CurIGValue; -+ u1Byte BackupIGValue; //MP DIG -+ u1Byte BT30_CurIGI; -+ u1Byte IGIBackup; -+ -+ s1Byte BackoffVal; -+ s1Byte BackoffVal_range_max; -+ s1Byte BackoffVal_range_min; -+ u1Byte rx_gain_range_max; -+ u1Byte rx_gain_range_min; -+ u1Byte Rssi_val_min; -+ -+ u1Byte PreCCK_CCAThres; -+ u1Byte CurCCK_CCAThres; -+ u1Byte PreCCKPDState; -+ u1Byte CurCCKPDState; -+ u1Byte CCKPDBackup; -+ u1Byte pause_cckpd_level; -+ u1Byte pause_cckpd_value[DM_DIG_MAX_PAUSE_TYPE + 1]; -+ -+ u1Byte LargeFAHit; -+ u1Byte ForbiddenIGI; -+ u4Byte Recover_cnt; -+ -+ u1Byte DIG_Dynamic_MIN_0; -+ u1Byte DIG_Dynamic_MIN_1; -+ BOOLEAN bMediaConnect_0; -+ BOOLEAN bMediaConnect_1; -+ -+ u4Byte AntDiv_RSSI_max; -+ u4Byte RSSI_max; -+ -+ u1Byte *bP2PInProcess; -+ -+ u1Byte pause_dig_level; -+ u1Byte pause_dig_value[DM_DIG_MAX_PAUSE_TYPE + 1]; -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ BOOLEAN bTpTarget; -+ BOOLEAN bNoiseEst; -+ u4Byte TpTrainTH_min; -+ u1Byte IGIOffset_A; -+ u1Byte IGIOffset_B; -+#endif -+}DIG_T,*pDIG_T; -+ -+typedef struct _FALSE_ALARM_STATISTICS{ -+ u4Byte Cnt_Parity_Fail; -+ u4Byte Cnt_Rate_Illegal; -+ u4Byte Cnt_Crc8_fail; -+ u4Byte Cnt_Mcs_fail; -+ u4Byte Cnt_Ofdm_fail; -+ u4Byte Cnt_Ofdm_fail_pre; //For RTL8881A -+ u4Byte Cnt_Cck_fail; -+ u4Byte Cnt_all; -+ u4Byte Cnt_Fast_Fsync; -+ u4Byte Cnt_SB_Search_fail; -+ u4Byte Cnt_OFDM_CCA; -+ u4Byte Cnt_CCK_CCA; -+ u4Byte Cnt_CCA_all; -+ u4Byte Cnt_BW_USC; //Gary -+ u4Byte Cnt_BW_LSC; //Gary -+}FALSE_ALARM_STATISTICS, *PFALSE_ALARM_STATISTICS; -+ -+typedef enum tag_Dynamic_Init_Gain_Operation_Type_Definition -+{ -+ DIG_TYPE_THRESH_HIGH = 0, -+ DIG_TYPE_THRESH_LOW = 1, -+ DIG_TYPE_BACKOFF = 2, -+ DIG_TYPE_RX_GAIN_MIN = 3, -+ DIG_TYPE_RX_GAIN_MAX = 4, -+ DIG_TYPE_ENABLE = 5, -+ DIG_TYPE_DISABLE = 6, -+ DIG_OP_TYPE_MAX -+}DM_DIG_OP_E; -+ -+/* -+typedef enum tag_CCK_Packet_Detection_Threshold_Type_Definition -+{ -+ CCK_PD_STAGE_LowRssi = 0, -+ CCK_PD_STAGE_HighRssi = 1, -+ CCK_PD_STAGE_MAX = 3, -+}DM_CCK_PDTH_E; -+ -+typedef enum tag_DIG_EXT_PORT_ALGO_Definition -+{ -+ DIG_EXT_PORT_STAGE_0 = 0, -+ DIG_EXT_PORT_STAGE_1 = 1, -+ DIG_EXT_PORT_STAGE_2 = 2, -+ DIG_EXT_PORT_STAGE_3 = 3, -+ DIG_EXT_PORT_STAGE_MAX = 4, -+}DM_DIG_EXT_PORT_ALG_E; -+ -+typedef enum tag_DIG_Connect_Definition -+{ -+ DIG_STA_DISCONNECT = 0, -+ DIG_STA_CONNECT = 1, -+ DIG_STA_BEFORE_CONNECT = 2, -+ DIG_MultiSTA_DISCONNECT = 3, -+ DIG_MultiSTA_CONNECT = 4, -+ DIG_CONNECT_MAX -+}DM_DIG_CONNECT_E; -+ -+ -+#define DM_MultiSTA_InitGainChangeNotify(Event) {DM_DigTable.CurMultiSTAConnectState = Event;} -+ -+#define DM_MultiSTA_InitGainChangeNotify_CONNECT(_ADAPTER) \ -+ DM_MultiSTA_InitGainChangeNotify(DIG_MultiSTA_CONNECT) -+ -+#define DM_MultiSTA_InitGainChangeNotify_DISCONNECT(_ADAPTER) \ -+ DM_MultiSTA_InitGainChangeNotify(DIG_MultiSTA_DISCONNECT) -+*/ -+ -+typedef enum tag_PHYDM_Pause_Type { -+ PHYDM_PAUSE = BIT0, -+ PHYDM_RESUME = BIT1 -+} PHYDM_PAUSE_TYPE; -+ -+typedef enum tag_PHYDM_Pause_Level { -+/* number of pause level can't exceed DM_DIG_MAX_PAUSE_TYPE */ -+ PHYDM_PAUSE_LEVEL_0 = 0, -+ PHYDM_PAUSE_LEVEL_1 = 1, -+ PHYDM_PAUSE_LEVEL_2 = 2, -+ PHYDM_PAUSE_LEVEL_3 = 3, -+ PHYDM_PAUSE_LEVEL_4 = 4, -+ PHYDM_PAUSE_LEVEL_5 = 5, -+ PHYDM_PAUSE_LEVEL_6 = 6, -+ PHYDM_PAUSE_LEVEL_7 = DM_DIG_MAX_PAUSE_TYPE /* maximum level */ -+} PHYDM_PAUSE_LEVEL; -+ -+ -+#define DM_DIG_THRESH_HIGH 40 -+#define DM_DIG_THRESH_LOW 35 -+ -+#define DM_FALSEALARM_THRESH_LOW 400 -+#define DM_FALSEALARM_THRESH_HIGH 1000 -+ -+#define DM_DIG_MAX_NIC 0x3e -+#define DM_DIG_MIN_NIC 0x1e //0x22//0x1c -+#define DM_DIG_MAX_OF_MIN_NIC 0x3e -+ -+#define DM_DIG_MAX_AP 0x3e -+#define DM_DIG_MIN_AP 0x1c -+#define DM_DIG_MAX_OF_MIN 0x2A //0x32 -+#define DM_DIG_MIN_AP_DFS 0x20 -+ -+#define DM_DIG_MAX_NIC_HP 0x46 -+#define DM_DIG_MIN_NIC_HP 0x2e -+ -+#define DM_DIG_MAX_AP_HP 0x42 -+#define DM_DIG_MIN_AP_HP 0x30 -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+#define DM_DIG_MAX_AP_COVERAGR 0x26 -+#define DM_DIG_MIN_AP_COVERAGE 0x1c -+#define DM_DIG_MAX_OF_MIN_COVERAGE 0x22 -+ -+#define DM_DIG_TP_Target_TH0 500 -+#define DM_DIG_TP_Target_TH1 1000 -+#define DM_DIG_TP_Training_Period 10 -+#endif -+ -+//vivi 92c&92d has different definition, 20110504 -+//this is for 92c -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ #ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -+ #define DM_DIG_FA_TH0 0x80//0x20 -+ #else -+ #define DM_DIG_FA_TH0 0x200//0x20 -+ #endif -+#else -+ #define DM_DIG_FA_TH0 0x200//0x20 -+#endif -+ -+#define DM_DIG_FA_TH1 0x300 -+#define DM_DIG_FA_TH2 0x400 -+//this is for 92d -+#define DM_DIG_FA_TH0_92D 0x100 -+#define DM_DIG_FA_TH1_92D 0x400 -+#define DM_DIG_FA_TH2_92D 0x600 -+ -+#define DM_DIG_BACKOFF_MAX 12 -+#define DM_DIG_BACKOFF_MIN -4 -+#define DM_DIG_BACKOFF_DEFAULT 10 -+ -+#define DM_DIG_FA_TH0_LPS 4 //-> 4 in lps -+#define DM_DIG_FA_TH1_LPS 15 //-> 15 lps -+#define DM_DIG_FA_TH2_LPS 30 //-> 30 lps -+#define RSSI_OFFSET_DIG 0x05 -+ -+VOID -+ODM_ChangeDynamicInitGainThresh( -+ IN PVOID pDM_VOID, -+ IN u4Byte DM_Type, -+ IN u4Byte DM_Value -+ ); -+ -+VOID -+ODM_Write_DIG( -+ IN PVOID pDM_VOID, -+ IN u1Byte CurrentIGI -+ ); -+ -+VOID -+odm_PauseDIG( -+ IN PVOID pDM_VOID, -+ IN PHYDM_PAUSE_TYPE PauseType, -+ IN PHYDM_PAUSE_LEVEL pause_level, -+ IN u1Byte IGIValue -+ ); -+ -+VOID -+odm_DIGInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DIG( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DIGbyRSSI_LPS( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_FalseAlarmCounterStatistics( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_PauseCCKPacketDetection( -+ IN PVOID pDM_VOID, -+ IN PHYDM_PAUSE_TYPE PauseType, -+ IN PHYDM_PAUSE_LEVEL pause_level, -+ IN u1Byte CCKPDThreshold -+ ); -+ -+VOID -+odm_CCKPacketDetectionThresh( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+ODM_Write_CCK_CCA_Thres( -+ IN PVOID pDM_VOID, -+ IN u1Byte CurCCK_CCAThres -+ ); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+odm_MPT_DIGCallback( -+ PRT_TIMER pTimer -+); -+ -+VOID -+odm_MPT_DIGWorkItemCallback( -+ IN PVOID pContext -+ ); -+ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+VOID -+odm_MPT_DIGCallback( -+ IN PVOID pDM_VOID -+); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE != ODM_CE) -+VOID -+ODM_MPT_DIG( -+ IN PVOID pDM_VOID -+); -+#endif -+ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_dynamicbbpowersaving.c linux/3rdparty/rtl8812au/hal/phydm/phydm_dynamicbbpowersaving.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_dynamicbbpowersaving.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_dynamicbbpowersaving.c 2017-06-07 23:07:21.018688214 +0300 -@@ -0,0 +1,219 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+VOID -+odm_DynamicBBPowerSavingInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; -+ -+ pDM_PSTable->PreCCAState = CCA_MAX; -+ pDM_PSTable->CurCCAState = CCA_MAX; -+ pDM_PSTable->PreRFState = RF_MAX; -+ pDM_PSTable->CurRFState = RF_MAX; -+ pDM_PSTable->Rssi_val_min = 0; -+ pDM_PSTable->initialize = 0; -+} -+ -+ -+VOID -+odm_DynamicBBPowerSaving( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ -+ if (pDM_Odm->SupportICType != ODM_RTL8723A) -+ return; -+ if(!(pDM_Odm->SupportAbility & ODM_BB_PWR_SAVE)) -+ return; -+ if(!(pDM_Odm->SupportPlatform & (ODM_WIN|ODM_CE))) -+ return; -+ -+ //1 2.Power Saving for 92C -+ if((pDM_Odm->SupportICType == ODM_RTL8192C) &&(pDM_Odm->RFType == ODM_2T2R)) -+ { -+ odm_1R_CCA(pDM_Odm); -+ } -+ -+ // 20100628 Joseph: Turn off BB power save for 88CE because it makesthroughput unstable. -+ // 20100831 Joseph: Turn ON BB power save again after modifying AGC delay from 900ns ot 600ns. -+ //1 3.Power Saving for 88C -+ else -+ { -+ ODM_RF_Saving(pDM_Odm, FALSE); -+ } -+#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+} -+ -+VOID -+odm_1R_CCA( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; -+ -+ if(pDM_Odm->RSSI_Min!= 0xFF) -+ { -+ -+ if(pDM_PSTable->PreCCAState == CCA_2R) -+ { -+ if(pDM_Odm->RSSI_Min >= 35) -+ pDM_PSTable->CurCCAState = CCA_1R; -+ else -+ pDM_PSTable->CurCCAState = CCA_2R; -+ -+ } -+ else{ -+ if(pDM_Odm->RSSI_Min <= 30) -+ pDM_PSTable->CurCCAState = CCA_2R; -+ else -+ pDM_PSTable->CurCCAState = CCA_1R; -+ } -+ } -+ else{ -+ pDM_PSTable->CurCCAState=CCA_MAX; -+ } -+ -+ if(pDM_PSTable->PreCCAState != pDM_PSTable->CurCCAState) -+ { -+ if(pDM_PSTable->CurCCAState == CCA_1R) -+ { -+ if( pDM_Odm->RFType ==ODM_2T2R ) -+ { -+ ODM_SetBBReg(pDM_Odm, 0xc04 , bMaskByte0, 0x13); -+ //PHY_SetBBReg(pAdapter, 0xe70, bMaskByte3, 0x20); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, 0xc04 , bMaskByte0, 0x23); -+ //PHY_SetBBReg(pAdapter, 0xe70, 0x7fc00000, 0x10c); // Set RegE70[30:22] = 9b'100001100 -+ } -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, 0xc04 , bMaskByte0, 0x33); -+ //PHY_SetBBReg(pAdapter,0xe70, bMaskByte3, 0x63); -+ } -+ pDM_PSTable->PreCCAState = pDM_PSTable->CurCCAState; -+ } -+} -+ -+void -+ODM_RF_Saving( -+ IN PVOID pDM_VOID, -+ IN u1Byte bForceInNormal -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; -+ u1Byte Rssi_Up_bound = 30 ; -+ u1Byte Rssi_Low_bound = 25; -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if(pDM_Odm->PatchID == 40 ) //RT_CID_819x_FUNAI_TV -+ { -+ Rssi_Up_bound = 50 ; -+ Rssi_Low_bound = 45; -+ } -+#endif -+ if(pDM_PSTable->initialize == 0){ -+ -+ pDM_PSTable->Reg874 = (ODM_GetBBReg(pDM_Odm, 0x874, bMaskDWord)&0x1CC000)>>14; -+ pDM_PSTable->RegC70 = (ODM_GetBBReg(pDM_Odm, 0xc70, bMaskDWord)&BIT3)>>3; -+ pDM_PSTable->Reg85C = (ODM_GetBBReg(pDM_Odm, 0x85c, bMaskDWord)&0xFF000000)>>24; -+ pDM_PSTable->RegA74 = (ODM_GetBBReg(pDM_Odm, 0xa74, bMaskDWord)&0xF000)>>12; -+ //Reg818 = PHY_QueryBBReg(pAdapter, 0x818, bMaskDWord); -+ pDM_PSTable->initialize = 1; -+ } -+ -+ if(!bForceInNormal) -+ { -+ if(pDM_Odm->RSSI_Min != 0xFF) -+ { -+ if(pDM_PSTable->PreRFState == RF_Normal) -+ { -+ if(pDM_Odm->RSSI_Min >= Rssi_Up_bound) -+ pDM_PSTable->CurRFState = RF_Save; -+ else -+ pDM_PSTable->CurRFState = RF_Normal; -+ } -+ else{ -+ if(pDM_Odm->RSSI_Min <= Rssi_Low_bound) -+ pDM_PSTable->CurRFState = RF_Normal; -+ else -+ pDM_PSTable->CurRFState = RF_Save; -+ } -+ } -+ else -+ pDM_PSTable->CurRFState=RF_MAX; -+ } -+ else -+ { -+ pDM_PSTable->CurRFState = RF_Normal; -+ } -+ -+ if(pDM_PSTable->PreRFState != pDM_PSTable->CurRFState) -+ { -+ if(pDM_PSTable->CurRFState == RF_Save) -+ { -+ // 8723 RSSI report will be wrong. Set 0x874[5]=1 when enter BB power saving mode. -+ // Suggested by SD3 Yu-Nan. 2011.01.20. -+ if(pDM_Odm->SupportICType == ODM_RTL8723A) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x874 , BIT5, 0x1); //Reg874[5]=1b'1 -+ } -+ ODM_SetBBReg(pDM_Odm, 0x874 , 0x1C0000, 0x2); //Reg874[20:18]=3'b010 -+ ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, 0); //RegC70[3]=1'b0 -+ ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, 0x63); //Reg85C[31:24]=0x63 -+ ODM_SetBBReg(pDM_Odm, 0x874, 0xC000, 0x2); //Reg874[15:14]=2'b10 -+ ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, 0x3); //RegA75[7:4]=0x3 -+ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x0); //Reg818[28]=1'b0 -+ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x1); //Reg818[28]=1'b1 -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, 0x874 , 0x1CC000, pDM_PSTable->Reg874); -+ ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, pDM_PSTable->RegC70); -+ ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, pDM_PSTable->Reg85C); -+ ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, pDM_PSTable->RegA74); -+ ODM_SetBBReg(pDM_Odm,0x818, BIT28, 0x0); -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8723A) -+ { -+ ODM_SetBBReg(pDM_Odm,0x874 , BIT5, 0x0); //Reg874[5]=1b'0 -+ } -+ } -+ pDM_PSTable->PreRFState =pDM_PSTable->CurRFState; -+ } -+#endif -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_dynamicbbpowersaving.h linux/3rdparty/rtl8812au/hal/phydm/phydm_dynamicbbpowersaving.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_dynamicbbpowersaving.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_dynamicbbpowersaving.h 2017-06-07 23:07:21.018688214 +0300 -@@ -0,0 +1,63 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMDYNAMICBBPOWERSAVING_H__ -+#define __PHYDMDYNAMICBBPOWERSAVING_H__ -+ -+#define DYNAMIC_BBPWRSAV_VERSION "1.0" -+ -+typedef struct _Dynamic_Power_Saving_ -+{ -+ u1Byte PreCCAState; -+ u1Byte CurCCAState; -+ -+ u1Byte PreRFState; -+ u1Byte CurRFState; -+ -+ int Rssi_val_min; -+ -+ u1Byte initialize; -+ u4Byte Reg874,RegC70,Reg85C,RegA74; -+ -+}PS_T,*pPS_T; -+ -+#define dm_RF_Saving ODM_RF_Saving -+ -+void ODM_RF_Saving( -+ IN PVOID pDM_VOID, -+ IN u1Byte bForceInNormal -+); -+ -+VOID -+odm_DynamicBBPowerSavingInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DynamicBBPowerSaving( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_1R_CCA( -+ IN PVOID pDM_VOID -+ ); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_dynamictxpower.c linux/3rdparty/rtl8812au/hal/phydm/phydm_dynamictxpower.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_dynamictxpower.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_dynamictxpower.c 2017-06-07 23:07:21.018688214 +0300 -@@ -0,0 +1,633 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+VOID -+odm_DynamicTxPowerInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ #if DEV_BUS_TYPE==RT_USB_INTERFACE -+ if(RT_GetInterfaceSelection(Adapter) == INTF_SEL1_USB_High_Power) -+ { -+ odm_DynamicTxPowerSavePowerIndex(pDM_Odm); -+ pMgntInfo->bDynamicTxPowerEnable = TRUE; -+ } -+ else -+ #else -+ //so 92c pci do not need dynamic tx power? vivi check it later -+ if(IS_HARDWARE_TYPE_8192D(Adapter)) -+ pMgntInfo->bDynamicTxPowerEnable = TRUE; -+ else -+ pMgntInfo->bDynamicTxPowerEnable = FALSE; -+ #endif -+ -+ -+ pHalData->LastDTPLvl = TxHighPwrLevel_Normal; -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ -+ -+#endif -+ -+} -+ -+VOID -+odm_DynamicTxPowerSavePowerIndex( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ u1Byte index; -+ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ for(index = 0; index< 6; index++) -+ pHalData->PowerIndex_backup[index] = PlatformEFIORead1Byte(Adapter, Power_Index_REG[index]); -+ -+ -+#endif -+#endif -+} -+ -+VOID -+odm_DynamicTxPowerRestorePowerIndex( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ u1Byte index; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ for(index = 0; index< 6; index++) -+ PlatformEFIOWrite1Byte(Adapter, Power_Index_REG[index], pHalData->PowerIndex_backup[index]); -+ -+ -+#endif -+#endif -+} -+ -+VOID -+odm_DynamicTxPowerWritePowerIndex( -+ IN PVOID pDM_VOID, -+ IN u1Byte Value) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte index; -+ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; -+ -+ for(index = 0; index< 6; index++) -+ //PlatformEFIOWrite1Byte(Adapter, Power_Index_REG[index], Value); -+ ODM_Write1Byte(pDM_Odm, Power_Index_REG[index], Value); -+ -+} -+ -+ -+VOID -+odm_DynamicTxPower( -+ IN PVOID pDM_VOID -+ ) -+{ -+ // -+ // For AP/ADSL use prtl8192cd_priv -+ // For CE/NIC use PADAPTER -+ // -+ //PADAPTER pAdapter = pDM_Odm->Adapter; -+// prtl8192cd_priv priv = pDM_Odm->priv; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) -+ return; -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ case ODM_CE: -+ odm_DynamicTxPowerNIC(pDM_Odm); -+ break; -+ case ODM_AP: -+ odm_DynamicTxPowerAP(pDM_Odm); -+ break; -+ -+ case ODM_ADSL: -+ //odm_DIGAP(pDM_Odm); -+ break; -+ } -+ -+ -+} -+ -+ -+VOID -+odm_DynamicTxPowerNIC( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) -+ return; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8192C) -+ { -+ odm_DynamicTxPower_92C(pDM_Odm); -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ { -+ odm_DynamicTxPower_92D(pDM_Odm); -+ } -+ else if (pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = GetDefaultMgntInfo(Adapter); -+ -+ if (pMgntInfo->RegRspPwr == 1) -+ { -+ if(pDM_Odm->RSSI_Min > 60) -+ { -+ ODM_SetMACReg(pDM_Odm, ODM_REG_RESP_TX_11AC, BIT20|BIT19|BIT18, 1); // Resp TXAGC offset = -3dB -+ -+ } -+ else if(pDM_Odm->RSSI_Min < 55) -+ { -+ ODM_SetMACReg(pDM_Odm, ODM_REG_RESP_TX_11AC, BIT20|BIT19|BIT18, 0); // Resp TXAGC offset = 0dB -+ } -+ } -+#endif -+ } -+#endif -+} -+ -+VOID -+odm_DynamicTxPowerAP( -+ IN PVOID pDM_VOID -+ -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+//#if ((RTL8192C_SUPPORT==1) || (RTL8192D_SUPPORT==1) || (RTL8188E_SUPPORT==1) || (RTL8812E_SUPPORT==1)) -+ -+ -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ s4Byte i; -+ s2Byte pwr_thd = TX_POWER_NEAR_FIELD_THRESH_AP; -+ -+ if(!priv->pshare->rf_ft_var.tx_pwr_ctrl) -+ return; -+ -+#if ((RTL8812E_SUPPORT==1) || (RTL8881A_SUPPORT==1) || (RTL8814A_SUPPORT==1)) -+ if (pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8881A | ODM_RTL8814A)) -+ pwr_thd = TX_POWER_NEAR_FIELD_THRESH_8812; -+#endif -+ -+#if defined(CONFIG_RTL_92D_SUPPORT) || defined(CONFIG_RTL_92C_SUPPORT) -+ if(CHIP_VER_92X_SERIES(priv)) -+ { -+#ifdef HIGH_POWER_EXT_PA -+ if(pDM_Odm->ExtPA) -+ tx_power_control(priv); -+#endif -+ } -+#endif -+ /* -+ * Check if station is near by to use lower tx power -+ */ -+ -+ if ((priv->up_time % 3) == 0 ) { -+ int disable_pwr_ctrl = ((pDM_Odm->FalseAlmCnt.Cnt_all > 1000 ) || ((pDM_Odm->FalseAlmCnt.Cnt_all > 300 ) && ((RTL_R8(0xc50) & 0x7f) >= 0x32))) ? 1 : 0; -+ -+ for(i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pstat) ) { -+ if(disable_pwr_ctrl) -+ pstat->hp_level = 0; -+ else if ((pstat->hp_level == 0) && (pstat->rssi > pwr_thd)) -+ pstat->hp_level = 1; -+ else if ((pstat->hp_level == 1) && (pstat->rssi < (pwr_thd-8))) -+ pstat->hp_level = 0; -+ } -+ } -+ -+#if defined(CONFIG_WLAN_HAL_8192EE) -+ if (GET_CHIP_VER(priv) == VERSION_8192E) { -+ if( !disable_pwr_ctrl && (pDM_Odm->RSSI_Min != 0xff) ) { -+ if(pDM_Odm->RSSI_Min > pwr_thd) -+ RRSR_power_control_11n(priv, 1 ); -+ else if(pDM_Odm->RSSI_Min < (pwr_thd-8)) -+ RRSR_power_control_11n(priv, 0 ); -+ } else { -+ RRSR_power_control_11n(priv, 0 ); -+ } -+ } -+#endif -+ -+#ifdef CONFIG_WLAN_HAL_8814AE -+ if (GET_CHIP_VER(priv) == VERSION_8814A) { -+ if (!disable_pwr_ctrl && (pDM_Odm->RSSI_Min != 0xff)) { -+ if (pDM_Odm->RSSI_Min > pwr_thd) -+ RRSR_power_control_14(priv, 1); -+ else if (pDM_Odm->RSSI_Min < (pwr_thd-8)) -+ RRSR_power_control_14(priv, 0); -+ } else { -+ RRSR_power_control_14(priv, 0); -+ } -+ } -+#endif -+ -+ } -+//#endif -+ -+#endif -+} -+ -+ -+VOID -+odm_DynamicTxPower_92C( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ s4Byte UndecoratedSmoothedPWDB; -+ -+ // 2012/01/12 MH According to Luke's suggestion, only high power will support the feature. -+ if (pDM_Odm->ExtPA == FALSE) -+ return; -+ -+ // STA not connected and AP not connected -+ if((!pMgntInfo->bMediaConnect) && -+ (pHalData->EntryMinUndecoratedSmoothedPWDB == 0)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("Not connected to any \n")); -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ -+ //the LastDTPlvl should reset when disconnect, -+ //otherwise the tx power level wouldn't change when disconnect and connect again. -+ // Maddest 20091220. -+ pHalData->LastDTPLvl=TxHighPwrLevel_Normal; -+ return; -+ } -+ -+#if (INTEL_PROXIMITY_SUPPORT == 1) -+ // Intel set fixed tx power -+ if(pMgntInfo->IntelProximityModeInfo.PowerOutput > 0) -+ { -+ switch(pMgntInfo->IntelProximityModeInfo.PowerOutput){ -+ case 1: -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_100; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_100\n")); -+ break; -+ case 2: -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_70; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_70\n")); -+ break; -+ case 3: -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_50; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_50\n")); -+ break; -+ case 4: -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_35; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_35\n")); -+ break; -+ case 5: -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_15; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_15\n")); -+ break; -+ default: -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_100; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_100\n")); -+ break; -+ } -+ } -+ else -+#endif -+ { -+ if( (pMgntInfo->bDynamicTxPowerEnable != TRUE) || -+ pMgntInfo->IOTAction & HT_IOT_ACT_DISABLE_HIGH_POWER) -+ { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ } -+ else -+ { -+ if(pMgntInfo->bMediaConnect) // Default port -+ { -+ if(ACTING_AS_AP(Adapter) || ACTING_AS_IBSS(Adapter)) -+ { -+ UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("AP Client PWDB = 0x%x \n", UndecoratedSmoothedPWDB)); -+ } -+ else -+ { -+ UndecoratedSmoothedPWDB = pHalData->UndecoratedSmoothedPWDB; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("STA Default Port PWDB = 0x%x \n", UndecoratedSmoothedPWDB)); -+ } -+ } -+ else // associated entry pwdb -+ { -+ UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("AP Ext Port PWDB = 0x%x \n", UndecoratedSmoothedPWDB)); -+ } -+ -+ if(UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL2) -+ { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level2; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x0)\n")); -+ } -+ else if((UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL2-3)) && -+ (UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL1) ) -+ { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x10)\n")); -+ } -+ else if(UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL1-5)) -+ { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Normal\n")); -+ } -+ } -+ } -+ if( pHalData->DynamicTxHighPowerLvl != pHalData->LastDTPLvl ) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("PHY_SetTxPowerLevel8192C() Channel = %d \n" , pHalData->CurrentChannel)); -+ PHY_SetTxPowerLevel8192C(Adapter, pHalData->CurrentChannel); -+ if( (pHalData->DynamicTxHighPowerLvl == TxHighPwrLevel_Normal) && -+ (pHalData->LastDTPLvl == TxHighPwrLevel_Level1 || pHalData->LastDTPLvl == TxHighPwrLevel_Level2)) //TxHighPwrLevel_Normal -+ odm_DynamicTxPowerRestorePowerIndex(pDM_Odm); -+ else if(pHalData->DynamicTxHighPowerLvl == TxHighPwrLevel_Level1) -+ odm_DynamicTxPowerWritePowerIndex(pDM_Odm, 0x14); -+ else if(pHalData->DynamicTxHighPowerLvl == TxHighPwrLevel_Level2) -+ odm_DynamicTxPowerWritePowerIndex(pDM_Odm, 0x10); -+ } -+ pHalData->LastDTPLvl = pHalData->DynamicTxHighPowerLvl; -+ -+ -+ -+ -+#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+} -+ -+ -+VOID -+odm_DynamicTxPower_92D( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if (RTL8192D_SUPPORT==1) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ s4Byte UndecoratedSmoothedPWDB; -+ -+ PADAPTER BuddyAdapter = Adapter->BuddyAdapter; -+ BOOLEAN bGetValueFromBuddyAdapter = dm_DualMacGetParameterFromBuddyAdapter(Adapter); -+ u1Byte HighPowerLvlBackForMac0 = TxHighPwrLevel_Level1; -+ -+ // 2012/01/12 MH According to Luke's suggestion, only high power will support the feature. -+ if (pDM_Odm->ExtPA == FALSE) -+ return; -+ -+ // If dynamic high power is disabled. -+ if( (pMgntInfo->bDynamicTxPowerEnable != TRUE) || -+ pMgntInfo->IOTAction & HT_IOT_ACT_DISABLE_HIGH_POWER) -+ { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ return; -+ } -+ -+ // STA not connected and AP not connected -+ if((!pMgntInfo->bMediaConnect) && -+ (pHalData->EntryMinUndecoratedSmoothedPWDB == 0)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("Not connected to any \n")); -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ -+ //the LastDTPlvl should reset when disconnect, -+ //otherwise the tx power level wouldn't change when disconnect and connect again. -+ // Maddest 20091220. -+ pHalData->LastDTPLvl=TxHighPwrLevel_Normal; -+ return; -+ } -+ -+ if(pMgntInfo->bMediaConnect) // Default port -+ { -+ if(ACTING_AS_AP(Adapter) || pMgntInfo->mIbss) -+ { -+ UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("AP Client PWDB = 0x%x \n", UndecoratedSmoothedPWDB)); -+ } -+ else -+ { -+ UndecoratedSmoothedPWDB = pHalData->UndecoratedSmoothedPWDB; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("STA Default Port PWDB = 0x%x \n", UndecoratedSmoothedPWDB)); -+ } -+ } -+ else // associated entry pwdb -+ { -+ UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("AP Ext Port PWDB = 0x%x \n", UndecoratedSmoothedPWDB)); -+ } -+ -+ if(IS_HARDWARE_TYPE_8192D(Adapter) && GET_HAL_DATA(Adapter)->CurrentBandType == 1){ -+ if(UndecoratedSmoothedPWDB >= 0x33) -+ { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level2; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("5G:TxHighPwrLevel_Level2 (TxPwr=0x0)\n")); -+ } -+ else if((UndecoratedSmoothedPWDB <0x33) && -+ (UndecoratedSmoothedPWDB >= 0x2b) ) -+ { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("5G:TxHighPwrLevel_Level1 (TxPwr=0x10)\n")); -+ } -+ else if(UndecoratedSmoothedPWDB < 0x2b) -+ { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("5G:TxHighPwrLevel_Normal\n")); -+ } -+ -+ } -+ else -+ -+ { -+ if(UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL2) -+ { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x0)\n")); -+ } -+ else if((UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL2-3)) && -+ (UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL1) ) -+ { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x10)\n")); -+ } -+ else if(UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL1-5)) -+ { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Normal\n")); -+ } -+ -+ } -+ -+//sherry delete flag 20110517 -+ if(bGetValueFromBuddyAdapter) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR,DBG_LOUD,("dm_DynamicTxPower() mac 0 for mac 1 \n")); -+ if(Adapter->DualMacDMSPControl.bChangeTxHighPowerLvlForAnotherMacOfDMSP) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR,DBG_LOUD,("dm_DynamicTxPower() change value \n")); -+ HighPowerLvlBackForMac0 = pHalData->DynamicTxHighPowerLvl; -+ pHalData->DynamicTxHighPowerLvl = Adapter->DualMacDMSPControl.CurTxHighLvlForAnotherMacOfDMSP; -+ PHY_SetTxPowerLevel8192C(Adapter, pHalData->CurrentChannel); -+ pHalData->DynamicTxHighPowerLvl = HighPowerLvlBackForMac0; -+ Adapter->DualMacDMSPControl.bChangeTxHighPowerLvlForAnotherMacOfDMSP = FALSE; -+ } -+ } -+ -+ if( (pHalData->DynamicTxHighPowerLvl != pHalData->LastDTPLvl) ) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("PHY_SetTxPowerLevel8192S() Channel = %d \n" , pHalData->CurrentChannel)); -+ if(Adapter->DualMacSmartConcurrent == TRUE) -+ { -+ if(BuddyAdapter == NULL) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR,DBG_LOUD,("dm_DynamicTxPower() BuddyAdapter == NULL case \n")); -+ if(!Adapter->bSlaveOfDMSP) -+ { -+ PHY_SetTxPowerLevel8192C(Adapter, pHalData->CurrentChannel); -+ } -+ } -+ else -+ { -+ if(pHalData->MacPhyMode92D == DUALMAC_SINGLEPHY) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR,DBG_LOUD,("dm_DynamicTxPower() BuddyAdapter DMSP \n")); -+ if(Adapter->bSlaveOfDMSP) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR,DBG_LOUD,("dm_DynamicTxPower() bslave case \n")); -+ BuddyAdapter->DualMacDMSPControl.bChangeTxHighPowerLvlForAnotherMacOfDMSP = TRUE; -+ BuddyAdapter->DualMacDMSPControl.CurTxHighLvlForAnotherMacOfDMSP = pHalData->DynamicTxHighPowerLvl; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR,DBG_LOUD,("dm_DynamicTxPower() master case \n")); -+ if(!bGetValueFromBuddyAdapter) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR,DBG_LOUD,("dm_DynamicTxPower() mac 0 for mac 0 \n")); -+ PHY_SetTxPowerLevel8192C(Adapter, pHalData->CurrentChannel); -+ } -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR,DBG_LOUD,("dm_DynamicTxPower() BuddyAdapter DMDP\n")); -+ PHY_SetTxPowerLevel8192C(Adapter, pHalData->CurrentChannel); -+ } -+ } -+ } -+ else -+ { -+ PHY_SetTxPowerLevel8192C(Adapter, pHalData->CurrentChannel); -+ } -+ -+ } -+ pHalData->LastDTPLvl = pHalData->DynamicTxHighPowerLvl; -+ -+ -+#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#endif -+} -+ -+VOID -+odm_DynamicTxPower_8821( -+ IN PVOID pDM_VOID, -+ IN pu1Byte pDesc, -+ IN u1Byte macId -+ ) -+{ -+#if (RTL8821A_SUPPORT == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PSTA_INFO_T pEntry; -+ u1Byte reg0xc56_byte; -+ u1Byte reg0xe56_byte; -+ u1Byte txpwr_offset = 0; -+ -+ pEntry = pDM_Odm->pODM_StaInfo[macId]; -+ -+ reg0xc56_byte = ODM_Read1Byte(pDM_Odm, 0xc56); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("reg0xc56_byte=%d\n", reg0xc56_byte)); -+ -+ if (pEntry[macId].rssi_stat.UndecoratedSmoothedPWDB > 85) { -+ -+ /* Avoid TXAGC error after TX power offset is applied. -+ For example: Reg0xc56=0x6, if txpwr_offset=3( reduce 11dB ) -+ Total power = 6-11= -5( overflow!! ), PA may be burned ! -+ so txpwr_offset should be adjusted by Reg0xc56*/ -+ -+ if (reg0xc56_byte < 7) -+ txpwr_offset = 1; -+ else if (reg0xc56_byte < 11) -+ txpwr_offset = 2; -+ else -+ txpwr_offset = 3; -+ -+ SET_TX_DESC_TX_POWER_OFFSET_8812(pDesc, txpwr_offset); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("odm_DynamicTxPower_8821: RSSI=%d, txpwr_offset=%d\n", pEntry[macId].rssi_stat.UndecoratedSmoothedPWDB, txpwr_offset)); -+ -+ } else{ -+ SET_TX_DESC_TX_POWER_OFFSET_8812(pDesc, txpwr_offset); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("odm_DynamicTxPower_8821: RSSI=%d, txpwr_offset=%d\n", pEntry[macId].rssi_stat.UndecoratedSmoothedPWDB, txpwr_offset)); -+ -+ } -+#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+#endif /*#if (RTL8821A_SUPPORT==1)*/ -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_dynamictxpower.h linux/3rdparty/rtl8812au/hal/phydm/phydm_dynamictxpower.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_dynamictxpower.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_dynamictxpower.h 2017-06-07 23:07:21.018688214 +0300 -@@ -0,0 +1,98 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMDYNAMICTXPOWER_H__ -+#define __PHYDMDYNAMICTXPOWER_H__ -+ -+/*#define DYNAMIC_TXPWR_VERSION "1.0"*/ -+#define DYNAMIC_TXPWR_VERSION "1.1" /*2015.01.13*/ -+ -+#define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 -+#define TX_POWER_NEAR_FIELD_THRESH_LVL1 67 -+#define TX_POWER_NEAR_FIELD_THRESH_AP 0x3F -+#define TX_POWER_NEAR_FIELD_THRESH_8812 60 -+ -+#define TxHighPwrLevel_Normal 0 -+#define TxHighPwrLevel_Level1 1 -+#define TxHighPwrLevel_Level2 2 -+#define TxHighPwrLevel_BT1 3 -+#define TxHighPwrLevel_BT2 4 -+#define TxHighPwrLevel_15 5 -+#define TxHighPwrLevel_35 6 -+#define TxHighPwrLevel_50 7 -+#define TxHighPwrLevel_70 8 -+#define TxHighPwrLevel_100 9 -+ -+VOID -+odm_DynamicTxPowerInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DynamicTxPowerRestorePowerIndex( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DynamicTxPowerNIC( -+ IN PVOID pDM_VOID -+ ); -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+VOID -+odm_DynamicTxPowerSavePowerIndex( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DynamicTxPowerWritePowerIndex( -+ IN PVOID pDM_VOID, -+ IN u1Byte Value); -+ -+VOID -+odm_DynamicTxPower_92C( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DynamicTxPower_92D( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DynamicTxPower_8821( -+ IN PVOID pDM_VOID, -+ IN pu1Byte pDesc, -+ IN u1Byte macId -+ ); -+ -+#endif -+ -+VOID -+odm_DynamicTxPower( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DynamicTxPowerAP( -+ IN PVOID pDM_VOID -+ ); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_edcaturbocheck.c linux/3rdparty/rtl8812au/hal/phydm/phydm_edcaturbocheck.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_edcaturbocheck.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_edcaturbocheck.c 2017-06-07 23:07:21.018688214 +0300 -@@ -0,0 +1,835 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+VOID -+ODM_EdcaTurboInit( -+ IN PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+#if (DM_ODM_SUPPORT_TYPE==ODM_WIN) -+ PADAPTER Adapter = NULL; -+ HAL_DATA_TYPE *pHalData = NULL; -+ -+ if(pDM_Odm->Adapter==NULL) { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EdcaTurboInit fail!!!\n")); -+ return; -+ } -+ -+ Adapter=pDM_Odm->Adapter; -+ pHalData=GET_HAL_DATA(Adapter); -+ -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE; -+ pDM_Odm->DM_EDCA_Table.bIsCurRDLState = FALSE; -+ pHalData->bIsAnyNonBEPkts = FALSE; -+ -+#elif(DM_ODM_SUPPORT_TYPE==ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE; -+ pDM_Odm->DM_EDCA_Table.bIsCurRDLState = FALSE; -+ Adapter->recvpriv.bIsAnyNonBEPkts =FALSE; -+ -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VO PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VO_PARAM))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VI PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VI_PARAM))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BE PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BE_PARAM))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BK PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BK_PARAM))); -+ -+ -+} // ODM_InitEdcaTurbo -+ -+VOID -+odm_EdcaTurboCheck( -+ IN PVOID pDM_VOID -+ ) -+{ -+ // -+ // For AP/ADSL use prtl8192cd_priv -+ // For CE/NIC use PADAPTER -+ // -+ -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("odm_EdcaTurboCheck========================>\n")); -+ -+ if(!(pDM_Odm->SupportAbility& ODM_MAC_EDCA_TURBO )) -+ return; -+ -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ -+#if(DM_ODM_SUPPORT_TYPE==ODM_WIN) -+ odm_EdcaTurboCheckMP(pDM_Odm); -+#endif -+ break; -+ -+ case ODM_CE: -+#if(DM_ODM_SUPPORT_TYPE==ODM_CE) -+ odm_EdcaTurboCheckCE(pDM_Odm); -+#endif -+ break; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("<========================odm_EdcaTurboCheck\n")); -+ -+} // odm_CheckEdcaTurbo -+ -+#if(DM_ODM_SUPPORT_TYPE==ODM_CE) -+ -+ -+VOID -+odm_EdcaTurboCheckCE( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ u32 EDCA_BE_UL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[pMgntInfo->IOTPeer]; -+ u32 EDCA_BE_DL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[pMgntInfo->IOTPeer]; -+ u32 ICType=pDM_Odm->SupportICType; -+ u32 IOTPeer=0; -+ u8 WirelessMode=0xFF; //invalid value -+ u32 trafficIndex; -+ u32 edca_param; -+ u64 cur_tx_bytes = 0; -+ u64 cur_rx_bytes = 0; -+ u8 bbtchange = _FALSE; -+ u8 bBiasOnRx = _FALSE; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct recv_priv *precvpriv = &(Adapter->recvpriv); -+ struct registry_priv *pregpriv = &Adapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &(Adapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if(pDM_Odm->bLinked != _TRUE) -+ { -+ precvpriv->bIsAnyNonBEPkts = _FALSE; -+ return; -+ } -+ -+ if ((pregpriv->wifi_spec == 1) )//|| (pmlmeinfo->HT_enable == 0)) -+ { -+ precvpriv->bIsAnyNonBEPkts = _FALSE; -+ return; -+ } -+ -+ if(pDM_Odm->pWirelessMode!=NULL) -+ WirelessMode=*(pDM_Odm->pWirelessMode); -+ -+ IOTPeer = pmlmeinfo->assoc_AP_vendor; -+ -+ if (IOTPeer >= HT_IOT_PEER_MAX) -+ { -+ precvpriv->bIsAnyNonBEPkts = _FALSE; -+ return; -+ } -+ -+ if( (pDM_Odm->SupportICType == ODM_RTL8192C) || -+ (pDM_Odm->SupportICType == ODM_RTL8723A) || -+ (pDM_Odm->SupportICType == ODM_RTL8188E)) -+ { -+ if((IOTPeer == HT_IOT_PEER_RALINK)||(IOTPeer == HT_IOT_PEER_ATHEROS)) -+ bBiasOnRx = _TRUE; -+ } -+ -+ // Check if the status needs to be changed. -+ if((bbtchange) || (!precvpriv->bIsAnyNonBEPkts) ) -+ { -+ cur_tx_bytes = pdvobjpriv->traffic_stat.cur_tx_bytes; -+ cur_rx_bytes = pdvobjpriv->traffic_stat.cur_rx_bytes; -+ -+ //traffic, TX or RX -+ if(bBiasOnRx) -+ { -+ if (cur_tx_bytes > (cur_rx_bytes << 2)) -+ { // Uplink TP is present. -+ trafficIndex = UP_LINK; -+ } -+ else -+ { // Balance TP is present. -+ trafficIndex = DOWN_LINK; -+ } -+ } -+ else -+ { -+ if (cur_rx_bytes > (cur_tx_bytes << 2)) -+ { // Downlink TP is present. -+ trafficIndex = DOWN_LINK; -+ } -+ else -+ { // Balance TP is present. -+ trafficIndex = UP_LINK; -+ } -+ } -+ -+ //if ((pDM_Odm->DM_EDCA_Table.prv_traffic_idx != trafficIndex) || (!pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA)) -+ { -+ if (ICType == ODM_RTL8192D) { -+ // Single PHY -+ if (pDM_Odm->RFType == ODM_2T2R) { -+ EDCA_BE_UL = 0x60a42b; //0x5ea42b; -+ EDCA_BE_DL = 0x60a42b; //0x5ea42b; -+ } else { -+ EDCA_BE_UL = 0x6ea42b; -+ EDCA_BE_DL = 0x6ea42b; -+ } -+ } -+ else -+ { -+ if(pDM_Odm->SupportInterface==ODM_ITRF_PCIE) { -+ if((ICType==ODM_RTL8192C)&&(pDM_Odm->RFType==ODM_2T2R)) { -+ EDCA_BE_UL = 0x60a42b; -+ EDCA_BE_DL = 0x60a42b; -+ } else { -+ EDCA_BE_UL = 0x6ea42b; -+ EDCA_BE_DL = 0x6ea42b; -+ } -+ } -+ } -+ -+ //92D txop can't be set to 0x3e for cisco1250 -+ if((ICType!=ODM_RTL8192D) && (IOTPeer== HT_IOT_PEER_CISCO) &&(WirelessMode==ODM_WM_N24G)) -+ { -+ EDCA_BE_DL = edca_setting_DL[IOTPeer]; -+ EDCA_BE_UL = edca_setting_UL[IOTPeer]; -+ } -+ //merge from 92s_92c_merge temp brunch v2445 20120215 -+ else if((IOTPeer == HT_IOT_PEER_CISCO) &&((WirelessMode==ODM_WM_G)||(WirelessMode==(ODM_WM_B|ODM_WM_G))||(WirelessMode==ODM_WM_A)||(WirelessMode==ODM_WM_B))) -+ { -+ EDCA_BE_DL = edca_setting_DL_GMode[IOTPeer]; -+ } -+ else if((IOTPeer== HT_IOT_PEER_AIRGO )&& ((WirelessMode==ODM_WM_G)||(WirelessMode==ODM_WM_A))) -+ { -+ EDCA_BE_DL = 0xa630; -+ } -+ else if(IOTPeer == HT_IOT_PEER_MARVELL) -+ { -+ EDCA_BE_DL = edca_setting_DL[IOTPeer]; -+ EDCA_BE_UL = edca_setting_UL[IOTPeer]; -+ } -+ else if(IOTPeer == HT_IOT_PEER_ATHEROS) -+ { -+ // Set DL EDCA for Atheros peer to 0x3ea42b. Suggested by SD3 Wilson for ASUS TP issue. -+ EDCA_BE_DL = edca_setting_DL[IOTPeer]; -+ } -+ -+ if((ICType==ODM_RTL8812)||(ICType==ODM_RTL8821)||(ICType==ODM_RTL8192E)) //add 8812AU/8812AE -+ { -+ EDCA_BE_UL = 0x5ea42b; -+ EDCA_BE_DL = 0x5ea42b; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8812A: EDCA_BE_UL=0x%x EDCA_BE_DL =0x%x",EDCA_BE_UL,EDCA_BE_DL)); -+ } -+ -+ if (trafficIndex == DOWN_LINK) -+ edca_param = EDCA_BE_DL; -+ else -+ edca_param = EDCA_BE_UL; -+ -+ rtw_write32(Adapter, REG_EDCA_BE_PARAM, edca_param); -+ -+ pDM_Odm->DM_EDCA_Table.prv_traffic_idx = trafficIndex; -+ } -+ -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = _TRUE; -+ } -+ else -+ { -+ // -+ // Turn Off EDCA turbo here. -+ // Restore original EDCA according to the declaration of AP. -+ // -+ if(pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA) -+ { -+ rtw_write32(Adapter, REG_EDCA_BE_PARAM, pHalData->AcParam_BE); -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = _FALSE; -+ } -+ } -+ -+} -+ -+ -+#elif(DM_ODM_SUPPORT_TYPE==ODM_WIN) -+VOID -+odm_EdcaTurboCheckMP( -+ IN PVOID pDM_VOID -+ ) -+{ -+ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PADAPTER pDefaultAdapter = GetDefaultAdapter(Adapter); -+ PADAPTER pExtAdapter = GetFirstExtAdapter(Adapter);//NULL; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ PSTA_QOS pStaQos = Adapter->MgntInfo.pStaQos; -+ //[Win7 Count Tx/Rx statistic for Extension Port] odm_CheckEdcaTurbo's Adapter is always Default. 2009.08.20, by Bohn -+ u8Byte Ext_curTxOkCnt = 0; -+ u8Byte Ext_curRxOkCnt = 0; -+ //For future Win7 Enable Default Port to modify AMPDU size dynamically, 2009.08.20, Bohn. -+ u1Byte TwoPortStatus = (u1Byte)TWO_PORT_STATUS__WITHOUT_ANY_ASSOCIATE; -+ -+ // Keep past Tx/Rx packet count for RT-to-RT EDCA turbo. -+ u8Byte curTxOkCnt = 0; -+ u8Byte curRxOkCnt = 0; -+ u4Byte EDCA_BE_UL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[pMgntInfo->IOTPeer]; -+ u4Byte EDCA_BE_DL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[pMgntInfo->IOTPeer]; -+ u4Byte EDCA_BE = 0x5ea42b; -+ u1Byte IOTPeer=0; -+ BOOLEAN *pbIsCurRDLState=NULL; -+ BOOLEAN bLastIsCurRDLState=FALSE; -+ BOOLEAN bBiasOnRx=FALSE; -+ BOOLEAN bEdcaTurboOn=FALSE; -+ u1Byte TxRate = 0xFF; -+ u8Byte value64; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("odm_EdcaTurboCheckMP========================>")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BE PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BE_PARAM))); -+ -+////=============================== -+////list paramter for different platform -+////=============================== -+ bLastIsCurRDLState=pDM_Odm->DM_EDCA_Table.bIsCurRDLState; -+ pbIsCurRDLState=&(pDM_Odm->DM_EDCA_Table.bIsCurRDLState); -+ -+ //2012/09/14 MH Add -+ if (pMgntInfo->NumNonBePkt > pMgntInfo->RegEdcaThresh && !Adapter->MgntInfo.bWiFiConfg) -+ pHalData->bIsAnyNonBEPkts = TRUE; -+ -+ pMgntInfo->NumNonBePkt = 0; -+ -+ // Caculate TX/RX TP: -+ //curTxOkCnt = Adapter->TxStats.NumTxBytesUnicast - pMgntInfo->lastTxOkCnt; -+ //curRxOkCnt = Adapter->RxStats.NumRxBytesUnicast - pMgntInfo->lastRxOkCnt; -+ curTxOkCnt = Adapter->TxStats.NumTxBytesUnicast - pDM_Odm->lastTxOkCnt; -+ curRxOkCnt = Adapter->RxStats.NumRxBytesUnicast - pDM_Odm->lastRxOkCnt; -+ pDM_Odm->lastTxOkCnt = Adapter->TxStats.NumTxBytesUnicast; -+ pDM_Odm->lastRxOkCnt = Adapter->RxStats.NumRxBytesUnicast; -+ -+ if(pExtAdapter == NULL) -+ pExtAdapter = pDefaultAdapter; -+ -+ Ext_curTxOkCnt = pExtAdapter->TxStats.NumTxBytesUnicast - pMgntInfo->Ext_lastTxOkCnt; -+ Ext_curRxOkCnt = pExtAdapter->RxStats.NumRxBytesUnicast - pMgntInfo->Ext_lastRxOkCnt; -+ GetTwoPortSharedResource(Adapter,TWO_PORT_SHARED_OBJECT__STATUS,NULL,&TwoPortStatus); -+ //For future Win7 Enable Default Port to modify AMPDU size dynamically, 2009.08.20, Bohn. -+ if(TwoPortStatus == TWO_PORT_STATUS__EXTENSION_ONLY) -+ { -+ curTxOkCnt = Ext_curTxOkCnt ; -+ curRxOkCnt = Ext_curRxOkCnt ; -+ } -+ // -+ IOTPeer=pMgntInfo->IOTPeer; -+ bBiasOnRx=(pMgntInfo->IOTAction & HT_IOT_ACT_EDCA_BIAS_ON_RX)?TRUE:FALSE; -+ bEdcaTurboOn=((!pHalData->bIsAnyNonBEPkts))?TRUE:FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("bIsAnyNonBEPkts : 0x%lx \n",pHalData->bIsAnyNonBEPkts)); -+ -+ -+////=============================== -+////check if edca turbo is disabled -+////=============================== -+ if(odm_IsEdcaTurboDisable(pDM_Odm)) -+ { -+ pHalData->bIsAnyNonBEPkts = FALSE; -+ pMgntInfo->lastTxOkCnt = Adapter->TxStats.NumTxBytesUnicast; -+ pMgntInfo->lastRxOkCnt = Adapter->RxStats.NumRxBytesUnicast; -+ pMgntInfo->Ext_lastTxOkCnt = pExtAdapter->TxStats.NumTxBytesUnicast; -+ pMgntInfo->Ext_lastRxOkCnt = pExtAdapter->RxStats.NumRxBytesUnicast; -+ -+ } -+ -+////=============================== -+////remove iot case out -+////=============================== -+ ODM_EdcaParaSelByIot(pDM_Odm, &EDCA_BE_UL, &EDCA_BE_DL); -+ -+ -+////=============================== -+////Check if the status needs to be changed. -+////=============================== -+ if(bEdcaTurboOn) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("bEdcaTurboOn : 0x%x bBiasOnRx : 0x%x\n",bEdcaTurboOn,bBiasOnRx)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("curTxOkCnt : 0x%lx \n",curTxOkCnt)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("curRxOkCnt : 0x%lx \n",curRxOkCnt)); -+ if(bBiasOnRx) -+ odm_EdcaChooseTrafficIdx(pDM_Odm,curTxOkCnt, curRxOkCnt, TRUE, pbIsCurRDLState); -+ else -+ odm_EdcaChooseTrafficIdx(pDM_Odm,curTxOkCnt, curRxOkCnt, FALSE, pbIsCurRDLState); -+ -+//modify by Guo.Mingzhi 2011-12-29 -+ EDCA_BE=((*pbIsCurRDLState)==TRUE)?EDCA_BE_DL:EDCA_BE_UL; -+ if(IS_HARDWARE_TYPE_8821U(Adapter)) -+ { -+ if(pMgntInfo->RegTxDutyEnable) -+ { -+ //2013.01.23 LukeLee: debug for 8811AU thermal issue (reduce Tx duty cycle) -+ if(!pMgntInfo->ForcedDataRate) //auto rate -+ { -+ if(pDM_Odm->TxRate != 0xFF) -+ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -+ } -+ else //force rate -+ { -+ TxRate = (u1Byte) pMgntInfo->ForcedDataRate; -+ } -+ -+ value64 = (curRxOkCnt<<2); -+ if(curTxOkCnt < value64) //Downlink -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ else //Uplink -+ { -+ /*DbgPrint("pRFCalibrateInfo->ThermalValue = 0x%X\n", pRFCalibrateInfo->ThermalValue);*/ -+ /*if(pRFCalibrateInfo->ThermalValue < pHalData->EEPROMThermalMeter)*/ -+ if((pDM_Odm->RFCalibrateInfo.ThermalValue < 0x2c) || (*pDM_Odm->pBandType == BAND_ON_2_4G)) -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ else -+ { -+ switch (TxRate) -+ { -+ case MGN_VHT1SS_MCS6: -+ case MGN_VHT1SS_MCS5: -+ case MGN_MCS6: -+ case MGN_MCS5: -+ case MGN_48M: -+ case MGN_54M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0x1ea42b); -+ break; -+ case MGN_VHT1SS_MCS4: -+ case MGN_MCS4: -+ case MGN_36M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa42b); -+ break; -+ case MGN_VHT1SS_MCS3: -+ case MGN_MCS3: -+ case MGN_24M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa47f); -+ break; -+ case MGN_VHT1SS_MCS2: -+ case MGN_MCS2: -+ case MGN_18M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa57f); -+ break; -+ case MGN_VHT1SS_MCS1: -+ case MGN_MCS1: -+ case MGN_9M: -+ case MGN_12M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa77f); -+ break; -+ case MGN_VHT1SS_MCS0: -+ case MGN_MCS0: -+ case MGN_6M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa87f); -+ break; -+ default: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ break; -+ } -+ } -+ } -+ } -+ else -+ { -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ } -+ -+ } -+ else if (IS_HARDWARE_TYPE_8812AU(Adapter)){ -+ if(pMgntInfo->RegTxDutyEnable) -+ { -+ //2013.07.26 Wilson: debug for 8812AU thermal issue (reduce Tx duty cycle) -+ // it;s the same issue as 8811AU -+ if(!pMgntInfo->ForcedDataRate) //auto rate -+ { -+ if(pDM_Odm->TxRate != 0xFF) -+ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -+ } -+ else //force rate -+ { -+ TxRate = (u1Byte) pMgntInfo->ForcedDataRate; -+ } -+ -+ value64 = (curRxOkCnt<<2); -+ if(curTxOkCnt < value64) //Downlink -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ else //Uplink -+ { -+ /*DbgPrint("pRFCalibrateInfo->ThermalValue = 0x%X\n", pRFCalibrateInfo->ThermalValue);*/ -+ /*if(pRFCalibrateInfo->ThermalValue < pHalData->EEPROMThermalMeter)*/ -+ if((pDM_Odm->RFCalibrateInfo.ThermalValue < 0x2c) || (*pDM_Odm->pBandType == BAND_ON_2_4G)) -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ else -+ { -+ switch (TxRate) -+ { -+ case MGN_VHT2SS_MCS9: -+ case MGN_VHT1SS_MCS9: -+ case MGN_VHT1SS_MCS8: -+ case MGN_MCS15: -+ case MGN_MCS7: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0x1ea44f); -+ case MGN_VHT2SS_MCS8: -+ case MGN_VHT1SS_MCS7: -+ case MGN_MCS14: -+ case MGN_MCS6: -+ case MGN_54M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa44f); -+ case MGN_VHT2SS_MCS7: -+ case MGN_VHT2SS_MCS6: -+ case MGN_VHT1SS_MCS6: -+ case MGN_VHT1SS_MCS5: -+ case MGN_MCS13: -+ case MGN_MCS5: -+ case MGN_48M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa630); -+ break; -+ case MGN_VHT2SS_MCS5: -+ case MGN_VHT2SS_MCS4: -+ case MGN_VHT1SS_MCS4: -+ case MGN_VHT1SS_MCS3: -+ case MGN_MCS12: -+ case MGN_MCS4: -+ case MGN_MCS3: -+ case MGN_36M: -+ case MGN_24M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa730); -+ break; -+ case MGN_VHT2SS_MCS3: -+ case MGN_VHT2SS_MCS2: -+ case MGN_VHT2SS_MCS1: -+ case MGN_VHT1SS_MCS2: -+ case MGN_VHT1SS_MCS1: -+ case MGN_MCS11: -+ case MGN_MCS10: -+ case MGN_MCS9: -+ case MGN_MCS2: -+ case MGN_MCS1: -+ case MGN_18M: -+ case MGN_12M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa830); -+ break; -+ case MGN_VHT2SS_MCS0: -+ case MGN_VHT1SS_MCS0: -+ case MGN_MCS0: -+ case MGN_MCS8: -+ case MGN_9M: -+ case MGN_6M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa87f); -+ break; -+ default: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ break; -+ } -+ } -+ } -+ } -+ else -+ { -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ } -+ } -+ else -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EDCA Turbo on: EDCA_BE:0x%lx\n",EDCA_BE)); -+ -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = TRUE; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EDCA_BE_DL : 0x%lx EDCA_BE_UL : 0x%lx EDCA_BE : 0x%lx \n",EDCA_BE_DL,EDCA_BE_UL,EDCA_BE)); -+ -+ } -+ else -+ { -+ // Turn Off EDCA turbo here. -+ // Restore original EDCA according to the declaration of AP. -+ if(pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA) -+ { -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_AC_PARAM, GET_WMM_PARAM_ELE_SINGLE_AC_PARAM(pStaQos->WMMParamEle, AC0_BE) ); -+ -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Restore EDCA BE: 0x%lx \n",pDM_Odm->WMMEDCA_BE)); -+ -+ } -+ } -+ -+} -+ -+ -+//check if edca turbo is disabled -+BOOLEAN -+odm_IsEdcaTurboDisable( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ u4Byte IOTPeer=pMgntInfo->IOTPeer; -+ -+ if(pDM_Odm->bBtDisableEdcaTurbo) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("EdcaTurboDisable for BT!!\n")); -+ return TRUE; -+ } -+ -+ if((!(pDM_Odm->SupportAbility& ODM_MAC_EDCA_TURBO ))|| -+ (pDM_Odm->bWIFITest)|| -+ (IOTPeer>= HT_IOT_PEER_MAX)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("EdcaTurboDisable\n")); -+ return TRUE; -+ } -+ -+ -+ // 1. We do not turn on EDCA turbo mode for some AP that has IOT issue -+ // 2. User may disable EDCA Turbo mode with OID settings. -+ if(pMgntInfo->IOTAction & HT_IOT_ACT_DISABLE_EDCA_TURBO){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("IOTAction:EdcaTurboDisable\n")); -+ return TRUE; -+ } -+ -+ return FALSE; -+ -+ -+} -+ -+//add iot case here: for MP/CE -+VOID -+ODM_EdcaParaSelByIot( -+ IN PVOID pDM_VOID, -+ OUT u4Byte *EDCA_BE_UL, -+ OUT u4Byte *EDCA_BE_DL -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u4Byte IOTPeer=0; -+ u4Byte ICType=pDM_Odm->SupportICType; -+ u1Byte WirelessMode=0xFF; //invalid value -+ u4Byte RFType=pDM_Odm->RFType; -+ u4Byte IOTPeerSubType = 0; -+ -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ u1Byte TwoPortStatus = (u1Byte)TWO_PORT_STATUS__WITHOUT_ANY_ASSOCIATE; -+ -+ if(pDM_Odm->pWirelessMode!=NULL) -+ WirelessMode=*(pDM_Odm->pWirelessMode); -+ -+/////////////////////////////////////////////////////////// -+////list paramter for different platform -+ -+ IOTPeer=pMgntInfo->IOTPeer; -+ IOTPeerSubType=pMgntInfo->IOTPeerSubtype; -+ GetTwoPortSharedResource(Adapter,TWO_PORT_SHARED_OBJECT__STATUS,NULL,&TwoPortStatus); -+ -+ -+ if(ICType==ODM_RTL8192D) -+ { -+ // Single PHY -+ if(pDM_Odm->RFType==ODM_2T2R) -+ { -+ (*EDCA_BE_UL) = 0x60a42b; //0x5ea42b; -+ (*EDCA_BE_DL) = 0x60a42b; //0x5ea42b; -+ -+ } -+ else -+ { -+ (*EDCA_BE_UL) = 0x6ea42b; -+ (*EDCA_BE_DL) = 0x6ea42b; -+ } -+ -+ } -+////============================ -+/// IOT case for MP -+////============================ -+ -+ else -+ { -+ -+ if(pDM_Odm->SupportInterface==ODM_ITRF_PCIE){ -+ if((ICType==ODM_RTL8192C)&&(pDM_Odm->RFType==ODM_2T2R)) { -+ (*EDCA_BE_UL) = 0x60a42b; -+ (*EDCA_BE_DL) = 0x60a42b; -+ } -+ else -+ { -+ (*EDCA_BE_UL) = 0x6ea42b; -+ (*EDCA_BE_DL) = 0x6ea42b; -+ } -+ } -+ } -+ -+ if(TwoPortStatus == TWO_PORT_STATUS__EXTENSION_ONLY) -+ { -+ (*EDCA_BE_UL) = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[ExtAdapter->MgntInfo.IOTPeer]; -+ (*EDCA_BE_DL) = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[ExtAdapter->MgntInfo.IOTPeer]; -+ } -+ -+ #if (INTEL_PROXIMITY_SUPPORT == 1) -+ if(pMgntInfo->IntelClassModeInfo.bEnableCA == TRUE) -+ { -+ (*EDCA_BE_UL) = (*EDCA_BE_DL) = 0xa44f; -+ } -+ else -+ #endif -+ { -+ if((pMgntInfo->IOTAction & (HT_IOT_ACT_FORCED_ENABLE_BE_TXOP|HT_IOT_ACT_AMSDU_ENABLE))) -+ {// To check whether we shall force turn on TXOP configuration. -+ if(!((*EDCA_BE_UL) & 0xffff0000)) -+ (*EDCA_BE_UL) |= 0x005e0000; // Force TxOP limit to 0x005e for UL. -+ if(!((*EDCA_BE_DL) & 0xffff0000)) -+ (*EDCA_BE_DL) |= 0x005e0000; // Force TxOP limit to 0x005e for DL. -+ } -+ -+ //92D txop can't be set to 0x3e for cisco1250 -+ if((ICType!=ODM_RTL8192D) && (IOTPeer== HT_IOT_PEER_CISCO) &&(WirelessMode==ODM_WM_N24G)) -+ { -+ (*EDCA_BE_DL) = edca_setting_DL[IOTPeer]; -+ (*EDCA_BE_UL) = edca_setting_UL[IOTPeer]; -+ } -+ //merge from 92s_92c_merge temp brunch v2445 20120215 -+ else if((IOTPeer == HT_IOT_PEER_CISCO) &&((WirelessMode==ODM_WM_G)||(WirelessMode==(ODM_WM_B|ODM_WM_G))||(WirelessMode==ODM_WM_A)||(WirelessMode==ODM_WM_B))) -+ { -+ (*EDCA_BE_DL) = edca_setting_DL_GMode[IOTPeer]; -+ } -+ else if((IOTPeer== HT_IOT_PEER_AIRGO )&& ((WirelessMode==ODM_WM_G)||(WirelessMode==ODM_WM_A))) -+ { -+ (*EDCA_BE_DL) = 0xa630; -+ } -+ -+ else if(IOTPeer == HT_IOT_PEER_MARVELL) -+ { -+ (*EDCA_BE_DL) = edca_setting_DL[IOTPeer]; -+ (*EDCA_BE_UL) = edca_setting_UL[IOTPeer]; -+ } -+ else if(IOTPeer == HT_IOT_PEER_ATHEROS && IOTPeerSubType != HT_IOT_PEER_TPLINK_AC1750) -+ { -+ // Set DL EDCA for Atheros peer to 0x3ea42b. Suggested by SD3 Wilson for ASUS TP issue. -+ if(WirelessMode==ODM_WM_G) -+ (*EDCA_BE_DL) = edca_setting_DL_GMode[IOTPeer]; -+ else -+ (*EDCA_BE_DL) = edca_setting_DL[IOTPeer]; -+ -+ if(ICType == ODM_RTL8821) -+ (*EDCA_BE_DL) = 0x5ea630; -+ -+ } -+ } -+ -+ if((ICType == ODM_RTL8192D)&&(IOTPeerSubType == HT_IOT_PEER_LINKSYS_E4200_V1)&&((WirelessMode==ODM_WM_N5G))) -+ { -+ (*EDCA_BE_DL) = 0x432b; -+ (*EDCA_BE_UL) = 0x432b; -+ } -+ -+ -+ -+ if((ICType==ODM_RTL8812)||(ICType==ODM_RTL8192E)) //add 8812AU/8812AE -+ { -+ (*EDCA_BE_UL) = 0x5ea42b; -+ (*EDCA_BE_DL) = 0x5ea42b; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8812A: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx\n",(*EDCA_BE_UL),(*EDCA_BE_DL))); -+ } -+ -+ if((ICType==ODM_RTL8814A) && (IOTPeer == HT_IOT_PEER_REALTEK)) /*8814AU and 8814AR*/ -+ { -+ (*EDCA_BE_UL) = 0x5ea42b; -+ (*EDCA_BE_DL) = 0xa42b; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8814A: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx\n",(*EDCA_BE_UL),(*EDCA_BE_DL))); -+ } -+ -+ -+ -+ // Revised for Atheros DIR-655 IOT issue to improve down link TP, added by Roger, 2013.03.22. -+ if((ICType == ODM_RTL8723A) && (IOTPeerSubType== HT_IOT_PEER_ATHEROS_DIR655) && -+ (pMgntInfo->dot11CurrentChannelNumber == 6)) -+ { -+ (*EDCA_BE_DL) = 0xa92b; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Special: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx, IOTPeer = %d\n",(*EDCA_BE_UL),(*EDCA_BE_DL), IOTPeer)); -+ -+} -+ -+ -+VOID -+odm_EdcaChooseTrafficIdx( -+ IN PVOID pDM_VOID, -+ IN u8Byte cur_tx_bytes, -+ IN u8Byte cur_rx_bytes, -+ IN BOOLEAN bBiasOnRx, -+ OUT BOOLEAN *pbIsCurRDLState -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if(bBiasOnRx) -+ { -+ -+ if(cur_tx_bytes>(cur_rx_bytes*4)) -+ { -+ *pbIsCurRDLState=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Uplink Traffic\n ")); -+ -+ } -+ else -+ { -+ *pbIsCurRDLState=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Balance Traffic\n")); -+ -+ } -+ } -+ else -+ { -+ if(cur_rx_bytes>(cur_tx_bytes*4)) -+ { -+ *pbIsCurRDLState=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Downlink Traffic\n")); -+ -+ } -+ else -+ { -+ *pbIsCurRDLState=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Balance Traffic\n")); -+ } -+ } -+ -+ return ; -+} -+ -+#endif -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_edcaturbocheck.h linux/3rdparty/rtl8812au/hal/phydm/phydm_edcaturbocheck.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_edcaturbocheck.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_edcaturbocheck.h 2017-06-07 23:07:21.018688214 +0300 -@@ -0,0 +1,100 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMEDCATURBOCHECK_H__ -+#define __PHYDMEDCATURBOCHECK_H__ -+ -+/*#define EDCATURBO_VERSION "2.1"*/ -+#define EDCATURBO_VERSION "2.2" /*2015.01.13*/ -+ -+typedef struct _EDCA_TURBO_ -+{ -+ BOOLEAN bCurrentTurboEDCA; -+ BOOLEAN bIsCurRDLState; -+ -+ #if(DM_ODM_SUPPORT_TYPE == ODM_CE ) -+ u4Byte prv_traffic_idx; // edca turbo -+ #endif -+ -+}EDCA_T,*pEDCA_T; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+static u4Byte edca_setting_UL[HT_IOT_PEER_MAX] = -+// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU MARVELL 92U_AP SELF_AP(DownLink/Tx) -+{ 0x5e4322, 0xa44f, 0x5e4322, 0x5ea32b, 0x5ea422, 0x5ea322, 0x3ea430, 0x5ea42b, 0x5ea44f, 0x5e4322, 0x5e4322}; -+ -+ -+static u4Byte edca_setting_DL[HT_IOT_PEER_MAX] = -+// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU, MARVELL 92U_AP SELF_AP(UpLink/Rx) -+{ 0xa44f, 0x5ea44f, 0x5e4322, 0x5ea42b, 0xa44f, 0xa630, 0x5ea630, 0x5ea42b, 0xa44f, 0xa42b, 0xa42b}; -+ -+static u4Byte edca_setting_DL_GMode[HT_IOT_PEER_MAX] = -+// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU, MARVELL 92U_AP SELF_AP -+{ 0x4322, 0xa44f, 0x5e4322, 0xa42b, 0x5e4322, 0x4322, 0xa42b, 0x5ea42b, 0xa44f, 0x5e4322, 0x5ea42b}; -+ -+#endif -+ -+ -+ -+VOID -+odm_EdcaTurboCheck( -+ IN PVOID pDM_VOID -+ ); -+VOID -+ODM_EdcaTurboInit( -+ IN PVOID pDM_VOID -+); -+ -+#if(DM_ODM_SUPPORT_TYPE==ODM_WIN) -+VOID -+odm_EdcaTurboCheckMP( -+ IN PVOID pDM_VOID -+ ); -+ -+//check if edca turbo is disabled -+BOOLEAN -+odm_IsEdcaTurboDisable( -+ IN PVOID pDM_VOID -+); -+//choose edca paramter for special IOT case -+VOID -+ODM_EdcaParaSelByIot( -+ IN PVOID pDM_VOID, -+ OUT u4Byte *EDCA_BE_UL, -+ OUT u4Byte *EDCA_BE_DL -+ ); -+//check if it is UL or DL -+VOID -+odm_EdcaChooseTrafficIdx( -+ IN PVOID pDM_VOID, -+ IN u8Byte cur_tx_bytes, -+ IN u8Byte cur_rx_bytes, -+ IN BOOLEAN bBiasOnRx, -+ OUT BOOLEAN *pbIsCurRDLState -+ ); -+ -+#elif (DM_ODM_SUPPORT_TYPE==ODM_CE) -+VOID -+odm_EdcaTurboCheckCE( -+ IN PVOID pDM_VOID -+ ); -+#endif -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm.h linux/3rdparty/rtl8812au/hal/phydm/phydm.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm.h 2017-06-07 23:07:21.015687940 +0300 -@@ -0,0 +1,1440 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __HALDMOUTSRC_H__ -+#define __HALDMOUTSRC_H__ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "phydm_pre_define.h" -+#include "phydm_dig.h" -+#include "phydm_edcaturbocheck.h" -+#include "phydm_pathdiv.h" -+#include "phydm_antdiv.h" -+#include "phydm_antdect.h" -+#include "phydm_dynamicbbpowersaving.h" -+#include "phydm_rainfo.h" -+#include "phydm_dynamictxpower.h" -+#include "phydm_cfotracking.h" -+#include "phydm_acs.h" -+#include "phydm_adaptivity.h" -+ -+ -+#if (RTL8814A_SUPPORT == 1) -+#include "rtl8814a/phydm_iqk_8814a.h" -+#endif -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#include "halphyrf_ap.h" -+#include "phydm_powertracking_ap.h" -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+#include "phydm_beamforming.h" -+#include "phydm_noisemonitor.h" -+#include "halphyrf_ce.h" -+#include "phydm_powertracking_ce.h" -+#endif -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+#include "phydm_beamforming.h" -+#include "phydm_rxhp.h" -+#include "halphyrf_win.h" -+#include "phydm_powertracking_win.h" -+#endif -+ -+//============================================================ -+// Definition -+//============================================================ -+// -+// 2011/09/22 MH Define all team supprt ability. -+// -+ -+// -+// 2011/09/22 MH Define for all teams. Please Define the constan in your precomp header. -+// -+//#define DM_ODM_SUPPORT_AP 0 -+//#define DM_ODM_SUPPORT_ADSL 0 -+//#define DM_ODM_SUPPORT_CE 0 -+//#define DM_ODM_SUPPORT_MP 1 -+ -+// -+// 2011/09/28 MH Define ODM SW team support flag. -+// -+ -+//For SW AntDiv, PathDiv, 8192C AntDiv joint use -+#define TP_MODE 0 -+#define RSSI_MODE 1 -+ -+#define TRAFFIC_LOW 0 -+#define TRAFFIC_HIGH 1 -+#define TRAFFIC_ULTRA_LOW 2 -+ -+#define NONE 0 -+ -+ -+ -+ -+//8723A High Power IGI Setting -+#define DM_DIG_HIGH_PWR_IGI_LOWER_BOUND 0x22 -+#define DM_DIG_Gmode_HIGH_PWR_IGI_LOWER_BOUND 0x28 -+#define DM_DIG_HIGH_PWR_THRESHOLD 0x3a -+#define DM_DIG_LOW_PWR_THRESHOLD 0x14 -+ -+ -+//============================================================ -+// structure and define -+//============================================================ -+ -+// -+// 2011/09/20 MH Add for AP/ADSLpseudo DM structuer requirement. -+// We need to remove to other position??? -+// -+#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+typedef struct rtl8192cd_priv { -+ u1Byte temp; -+ -+}rtl8192cd_priv, *prtl8192cd_priv; -+#endif -+ -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+typedef struct _ADAPTER{ -+ u1Byte temp; -+ #ifdef AP_BUILD_WORKAROUND -+ HAL_DATA_TYPE* temp2; -+ prtl8192cd_priv priv; -+ #endif -+}ADAPTER, *PADAPTER; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+typedef struct _WLAN_STA{ -+ u1Byte temp; -+} WLAN_STA, *PRT_WLAN_STA; -+ -+#endif -+ -+typedef struct _Dynamic_Primary_CCA{ -+ u1Byte PriCCA_flag; -+ u1Byte intf_flag; -+ u1Byte intf_type; -+ u1Byte DupRTS_flag; -+ u1Byte Monitor_flag; -+ u1Byte CH_offset; -+ u1Byte MF_state; -+}Pri_CCA_T, *pPri_CCA_T; -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ -+#ifdef ADSL_AP_BUILD_WORKAROUND -+#define MAX_TOLERANCE 5 -+#define IQK_DELAY_TIME 1 //ms -+#endif -+#if 0//defined in 8192cd.h -+// -+// Indicate different AP vendor for IOT issue. -+// -+typedef enum _HT_IOT_PEER -+{ -+ HT_IOT_PEER_UNKNOWN = 0, -+ HT_IOT_PEER_REALTEK = 1, -+ HT_IOT_PEER_REALTEK_92SE = 2, -+ HT_IOT_PEER_BROADCOM = 3, -+ HT_IOT_PEER_RALINK = 4, -+ HT_IOT_PEER_ATHEROS = 5, -+ HT_IOT_PEER_CISCO = 6, -+ HT_IOT_PEER_MERU = 7, -+ HT_IOT_PEER_MARVELL = 8, -+ HT_IOT_PEER_REALTEK_SOFTAP = 9,// peer is RealTek SOFT_AP, by Bohn, 2009.12.17 -+ HT_IOT_PEER_SELF_SOFTAP = 10, // Self is SoftAP -+ HT_IOT_PEER_AIRGO = 11, -+ HT_IOT_PEER_INTEL = 12, -+ HT_IOT_PEER_RTK_APCLIENT = 13, -+ HT_IOT_PEER_REALTEK_81XX = 14, -+ HT_IOT_PEER_REALTEK_WOW = 15, -+ HT_IOT_PEER_MAX = 16 -+}HT_IOT_PEER_E, *PHTIOT_PEER_E; -+#endif -+#endif//#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ -+#define DM_Type_ByFW 0 -+#define DM_Type_ByDriver 1 -+ -+// -+// Declare for common info -+// -+ -+#define IQK_THRESHOLD 8 -+#define DPK_THRESHOLD 4 -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+__PACK typedef struct _ODM_Phy_Status_Info_ -+{ -+ u1Byte RxPWDBAll; -+ u1Byte SignalQuality; /* in 0-100 index. */ -+ u1Byte RxMIMOSignalStrength[4]; /* in 0~100 index */ -+ s1Byte RxMIMOSignalQuality[4]; /* EVM */ -+ s1Byte RxSNR[4]; /* per-path's SNR */ -+#if (RTL8822B_SUPPORT == 1) -+ u1Byte RxCount; /* RX path counter---*/ -+#endif -+ u1Byte BandWidth; -+ -+} __WLAN_ATTRIB_PACK__ ODM_PHY_INFO_T, *PODM_PHY_INFO_T; -+ -+typedef struct _ODM_Phy_Status_Info_Append_ -+{ -+ u1Byte MAC_CRC32; -+ -+}ODM_PHY_INFO_Append_T,*PODM_PHY_INFO_Append_T; -+ -+#else -+ -+typedef struct _ODM_Phy_Status_Info_ -+{ -+ // -+ // Be care, if you want to add any element please insert between -+ // RxPWDBAll & SignalStrength. -+ // -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ u4Byte RxPWDBAll; -+#else -+ u1Byte RxPWDBAll; -+#endif -+ u1Byte SignalQuality; /* in 0-100 index. */ -+ s1Byte RxMIMOSignalQuality[4]; /* per-path's EVM */ -+ u1Byte RxMIMOEVMdbm[4]; /* per-path's EVM dbm */ -+ u1Byte RxMIMOSignalStrength[4]; /* in 0~100 index */ -+ s2Byte Cfo_short[4]; /* per-path's Cfo_short */ -+ s2Byte Cfo_tail[4]; /* per-path's Cfo_tail */ -+ s1Byte RxPower; /* in dBm Translate from PWdB */ -+ s1Byte RecvSignalPower; /* Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. */ -+ u1Byte BTRxRSSIPercentage; -+ u1Byte SignalStrength; /* in 0-100 index. */ -+ s1Byte RxPwr[4]; /* per-path's pwdb */ -+ s1Byte RxSNR[4]; /* per-path's SNR */ -+#if (RTL8822B_SUPPORT == 1) -+ u1Byte RxCount:2; /* RX path counter---*/ -+ u1Byte BandWidth:2; -+ u1Byte rxsc:4; /* sub-channel---*/ -+#else -+ u1Byte BandWidth; -+#endif -+ u1Byte btCoexPwrAdjust; -+#if (RTL8822B_SUPPORT == 1) -+ u1Byte channel; /* channel number---*/ -+ BOOLEAN bMuPacket; /* is MU packet or not---*/ -+ BOOLEAN bBeamformed; /* BF packet---*/ -+#endif -+}ODM_PHY_INFO_T,*PODM_PHY_INFO_T; -+#endif -+ -+typedef struct _ODM_Per_Pkt_Info_ -+{ -+ //u1Byte Rate; -+ u1Byte DataRate; -+ u1Byte StationID; -+ BOOLEAN bPacketMatchBSSID; -+ BOOLEAN bPacketToSelf; -+ BOOLEAN bPacketBeacon; -+ BOOLEAN bToSelf; -+}ODM_PACKET_INFO_T,*PODM_PACKET_INFO_T; -+ -+ -+typedef struct _ODM_Phy_Dbg_Info_ -+{ -+ //ODM Write,debug info -+ s1Byte RxSNRdB[4]; -+ u4Byte NumQryPhyStatus; -+ u4Byte NumQryPhyStatusCCK; -+ u4Byte NumQryPhyStatusOFDM; -+#if (RTL8822B_SUPPORT == 1) -+ u4Byte NumQryMuPkt; -+ u4Byte NumQryBfPkt; -+#endif -+ u1Byte NumQryBeaconPkt; -+ //Others -+ s4Byte RxEVM[4]; -+ -+}ODM_PHY_DBG_INFO_T; -+ -+ -+typedef struct _ODM_Mac_Status_Info_ -+{ -+ u1Byte test; -+ -+}ODM_MAC_INFO; -+ -+// -+// 2011/20/20 MH For MP driver RT_WLAN_STA = STA_INFO_T -+// Please declare below ODM relative info in your STA info structure. -+// -+#if 1 -+typedef struct _ODM_STA_INFO{ -+ // Driver Write -+ BOOLEAN bUsed; // record the sta status link or not? -+ //u1Byte WirelessMode; // -+ u1Byte IOTPeer; // Enum value. HT_IOT_PEER_E -+ -+ // ODM Write -+ //1 PHY_STATUS_INFO -+ u1Byte RSSI_Path[4]; // -+ u1Byte RSSI_Ave; -+ u1Byte RXEVM[4]; -+ u1Byte RXSNR[4]; -+ -+ // ODM Write -+ //1 TX_INFO (may changed by IC) -+ //TX_INFO_T pTxInfo; // Define in IC folder. Move lower layer. -+#if 0 -+ u1Byte ANTSEL_A; //in Jagar: 4bit; others: 2bit -+ u1Byte ANTSEL_B; //in Jagar: 4bit; others: 2bit -+ u1Byte ANTSEL_C; //only in Jagar: 4bit -+ u1Byte ANTSEL_D; //only in Jagar: 4bit -+ u1Byte TX_ANTL; //not in Jagar: 2bit -+ u1Byte TX_ANT_HT; //not in Jagar: 2bit -+ u1Byte TX_ANT_CCK; //not in Jagar: 2bit -+ u1Byte TXAGC_A; //not in Jagar: 4bit -+ u1Byte TXAGC_B; //not in Jagar: 4bit -+ u1Byte TXPWR_OFFSET; //only in Jagar: 3bit -+ u1Byte TX_ANT; //only in Jagar: 4bit for TX_ANTL/TX_ANTHT/TX_ANT_CCK -+#endif -+ -+ // -+ // Please use compile flag to disabe the strcutrue for other IC except 88E. -+ // Move To lower layer. -+ // -+ // ODM Write Wilson will handle this part(said by Luke.Lee) -+ //TX_RPT_T pTxRpt; // Define in IC folder. Move lower layer. -+#if 0 -+ //1 For 88E RA (don't redefine the naming) -+ u1Byte rate_id; -+ u1Byte rate_SGI; -+ u1Byte rssi_sta_ra; -+ u1Byte SGI_enable; -+ u1Byte Decision_rate; -+ u1Byte Pre_rate; -+ u1Byte Active; -+ -+ // Driver write Wilson handle. -+ //1 TX_RPT (don't redefine the naming) -+ u2Byte RTY[4]; // ??? -+ u2Byte TOTAL; // ??? -+ u2Byte DROP; // ??? -+ // -+ // Please use compile flag to disabe the strcutrue for other IC except 88E. -+ // -+#endif -+ -+}ODM_STA_INFO_T, *PODM_STA_INFO_T; -+#endif -+ -+// -+// 2011/10/20 MH Define Common info enum for all team. -+// -+typedef enum _ODM_Common_Info_Definition -+{ -+//-------------REMOVED CASE-----------// -+ //ODM_CMNINFO_CCK_HP, -+ //ODM_CMNINFO_RFPATH_ENABLE, // Define as ODM write??? -+ //ODM_CMNINFO_BT_COEXIST, // ODM_BT_COEXIST_E -+ //ODM_CMNINFO_OP_MODE, // ODM_OPERATION_MODE_E -+//-------------REMOVED CASE-----------// -+ -+ // -+ // Fixed value: -+ // -+ -+ //-----------HOOK BEFORE REG INIT-----------// -+ ODM_CMNINFO_PLATFORM = 0, -+ ODM_CMNINFO_ABILITY, // ODM_ABILITY_E -+ ODM_CMNINFO_INTERFACE, // ODM_INTERFACE_E -+ ODM_CMNINFO_MP_TEST_CHIP, -+ ODM_CMNINFO_IC_TYPE, // ODM_IC_TYPE_E -+ ODM_CMNINFO_CUT_VER, // ODM_CUT_VERSION_E -+ ODM_CMNINFO_FAB_VER, // ODM_FAB_E -+ ODM_CMNINFO_RF_TYPE, // ODM_RF_PATH_E or ODM_RF_TYPE_E? -+ ODM_CMNINFO_RFE_TYPE, -+ ODM_CMNINFO_BOARD_TYPE, // ODM_BOARD_TYPE_E -+ ODM_CMNINFO_PACKAGE_TYPE, -+ ODM_CMNINFO_EXT_LNA, // TRUE -+ ODM_CMNINFO_5G_EXT_LNA, -+ ODM_CMNINFO_EXT_PA, -+ ODM_CMNINFO_5G_EXT_PA, -+ ODM_CMNINFO_GPA, -+ ODM_CMNINFO_APA, -+ ODM_CMNINFO_GLNA, -+ ODM_CMNINFO_ALNA, -+ ODM_CMNINFO_EXT_TRSW, -+ ODM_CMNINFO_EXT_LNA_GAIN, -+ ODM_CMNINFO_PATCH_ID, //CUSTOMER ID -+ ODM_CMNINFO_BINHCT_TEST, -+ ODM_CMNINFO_BWIFI_TEST, -+ ODM_CMNINFO_SMART_CONCURRENT, -+ ODM_CMNINFO_CONFIG_BB_RF, -+ ODM_CMNINFO_DOMAIN_CODE_2G, -+ ODM_CMNINFO_DOMAIN_CODE_5G, -+ ODM_CMNINFO_IQKFWOFFLOAD, -+ ODM_CMNINFO_HUBUSBMODE, -+ ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS, -+ ODM_CMNINFO_TX_TP, -+ ODM_CMNINFO_RX_TP, -+ ODM_CMNINFO_SOUNDING_SEQ, -+ //-----------HOOK BEFORE REG INIT-----------// -+ -+ -+ // -+ // Dynamic value: -+ // -+//--------- POINTER REFERENCE-----------// -+ ODM_CMNINFO_MAC_PHY_MODE, // ODM_MAC_PHY_MODE_E -+ ODM_CMNINFO_TX_UNI, -+ ODM_CMNINFO_RX_UNI, -+ ODM_CMNINFO_WM_MODE, // ODM_WIRELESS_MODE_E -+ ODM_CMNINFO_BAND, // ODM_BAND_TYPE_E -+ ODM_CMNINFO_SEC_CHNL_OFFSET, // ODM_SEC_CHNL_OFFSET_E -+ ODM_CMNINFO_SEC_MODE, // ODM_SECURITY_E -+ ODM_CMNINFO_BW, // ODM_BW_E -+ ODM_CMNINFO_CHNL, -+ ODM_CMNINFO_FORCED_RATE, -+ -+ ODM_CMNINFO_DMSP_GET_VALUE, -+ ODM_CMNINFO_BUDDY_ADAPTOR, -+ ODM_CMNINFO_DMSP_IS_MASTER, -+ ODM_CMNINFO_SCAN, -+ ODM_CMNINFO_POWER_SAVING, -+ ODM_CMNINFO_ONE_PATH_CCA, // ODM_CCA_PATH_E -+ ODM_CMNINFO_DRV_STOP, -+ ODM_CMNINFO_PNP_IN, -+ ODM_CMNINFO_INIT_ON, -+ ODM_CMNINFO_ANT_TEST, -+ ODM_CMNINFO_NET_CLOSED, -+ //ODM_CMNINFO_RTSTA_AID, // For win driver only? -+ ODM_CMNINFO_FORCED_IGI_LB, -+ ODM_CMNINFO_P2P_LINK, -+ ODM_CMNINFO_FCS_MODE, -+ ODM_CMNINFO_IS1ANTENNA, -+ ODM_CMNINFO_RFDEFAULTPATH, -+//--------- POINTER REFERENCE-----------// -+ -+//------------CALL BY VALUE-------------// -+ ODM_CMNINFO_WIFI_DIRECT, -+ ODM_CMNINFO_WIFI_DISPLAY, -+ ODM_CMNINFO_LINK_IN_PROGRESS, -+ ODM_CMNINFO_LINK, -+ ODM_CMNINFO_STATION_STATE, -+ ODM_CMNINFO_RSSI_MIN, -+ ODM_CMNINFO_DBG_COMP, // u8Byte -+ ODM_CMNINFO_DBG_LEVEL, // u4Byte -+ ODM_CMNINFO_RA_THRESHOLD_HIGH, // u1Byte -+ ODM_CMNINFO_RA_THRESHOLD_LOW, // u1Byte -+ ODM_CMNINFO_RF_ANTENNA_TYPE, // u1Byte -+ ODM_CMNINFO_BT_ENABLED, -+ ODM_CMNINFO_BT_HS_CONNECT_PROCESS, -+ ODM_CMNINFO_BT_HS_RSSI, -+ ODM_CMNINFO_BT_OPERATION, -+ ODM_CMNINFO_BT_LIMITED_DIG, //Need to Limited Dig or not -+ ODM_CMNINFO_BT_DIG, -+ ODM_CMNINFO_BT_BUSY, //Check Bt is using or not//neil -+ ODM_CMNINFO_BT_DISABLE_EDCA, -+#if(DM_ODM_SUPPORT_TYPE & ODM_AP) // for repeater mode add by YuChen 2014.06.23 -+#ifdef UNIVERSAL_REPEATER -+ ODM_CMNINFO_VXD_LINK, -+#endif -+#endif -+ ODM_CMNINFO_AP_TOTAL_NUM, -+ ODM_CMNINFO_POWER_TRAINING, -+//------------CALL BY VALUE-------------// -+ -+ // -+ // Dynamic ptr array hook itms. -+ // -+ ODM_CMNINFO_STA_STATUS, -+ ODM_CMNINFO_PHY_STATUS, -+ ODM_CMNINFO_MAC_STATUS, -+ -+ ODM_CMNINFO_MAX, -+ -+ -+}ODM_CMNINFO_E; -+ -+// -+// 2011/10/20 MH Define ODM support ability. ODM_CMNINFO_ABILITY -+// -+typedef enum _ODM_Support_Ability_Definition -+{ -+ // -+ // BB ODM section BIT 0-19 -+ // -+ ODM_BB_DIG = BIT0, -+ ODM_BB_RA_MASK = BIT1, -+ ODM_BB_DYNAMIC_TXPWR = BIT2, -+ ODM_BB_FA_CNT = BIT3, -+ ODM_BB_RSSI_MONITOR = BIT4, -+ ODM_BB_CCK_PD = BIT5, -+ ODM_BB_ANT_DIV = BIT6, -+ ODM_BB_PWR_SAVE = BIT7, -+ ODM_BB_PWR_TRAIN = BIT8, -+ ODM_BB_RATE_ADAPTIVE = BIT9, -+ ODM_BB_PATH_DIV = BIT10, -+ ODM_BB_PSD = BIT11, -+ ODM_BB_RXHP = BIT12, -+ ODM_BB_ADAPTIVITY = BIT13, -+ ODM_BB_CFO_TRACKING = BIT14, -+ ODM_BB_NHM_CNT = BIT15, -+ ODM_BB_PRIMARY_CCA = BIT16, -+ ODM_BB_TXBF = BIT17, -+ -+ // -+ // MAC DM section BIT 20-23 -+ // -+ ODM_MAC_EDCA_TURBO = BIT20, -+ ODM_MAC_EARLY_MODE = BIT21, -+ -+ // -+ // RF ODM section BIT 24-31 -+ // -+ ODM_RF_TX_PWR_TRACK = BIT24, -+ ODM_RF_RX_GAIN_TRACK = BIT25, -+ ODM_RF_CALIBRATION = BIT26, -+ -+}ODM_ABILITY_E; -+ -+//Move some non-DM enum,define, struc. form phydm.h to phydm_types.h by Dino -+ -+// ODM_CMNINFO_ONE_PATH_CCA -+typedef enum tag_CCA_Path -+{ -+ ODM_CCA_2R = 0, -+ ODM_CCA_1R_A = 1, -+ ODM_CCA_1R_B = 2, -+}ODM_CCA_PATH_E; -+ -+//move RAInfo to Phydm_RaInfo.h -+ -+//Remove struct PATHDIV_PARA to odm_PathDiv.h -+ -+//Remove struct to odm_PowerTracking.h by YuChen -+// -+// ODM Dynamic common info value definition -+// -+//Move AntDiv form phydm.h to Phydm_AntDiv.h by Dino -+ -+//move PathDiv to Phydm_PathDiv.h -+ -+typedef enum _BASEBAND_CONFIG_PHY_REG_PG_VALUE_TYPE{ -+ PHY_REG_PG_RELATIVE_VALUE = 0, -+ PHY_REG_PG_EXACT_VALUE = 1 -+} PHY_REG_PG_TYPE; -+ -+// -+// 2011/09/22 MH Copy from SD4 defined structure. We use to support PHY DM integration. -+// -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if (RT_PLATFORM != PLATFORM_LINUX) -+typedef -+#endif -+ -+struct DM_Out_Source_Dynamic_Mechanism_Structure -+#else// for AP,ADSL,CE Team -+typedef struct DM_Out_Source_Dynamic_Mechanism_Structure -+#endif -+{ -+ //RT_TIMER FastAntTrainingTimer; -+ // -+ // Add for different team use temporarily -+ // -+ PADAPTER Adapter; // For CE/NIC team -+ prtl8192cd_priv priv; // For AP/ADSL team -+ // WHen you use Adapter or priv pointer, you must make sure the pointer is ready. -+ BOOLEAN odm_ready; -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ rtl8192cd_priv fake_priv; -+#endif -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ // ADSL_AP_BUILD_WORKAROUND -+ ADAPTER fake_adapter; -+#endif -+ -+ PHY_REG_PG_TYPE PhyRegPgValueType; -+ u1Byte PhyRegPgVersion; -+ -+ u8Byte DebugComponents; -+ u4Byte DebugLevel; -+ -+ u4Byte NumQryPhyStatusAll; //CCK + OFDM -+ u4Byte LastNumQryPhyStatusAll; -+ u4Byte RxPWDBAve; -+ BOOLEAN MPDIG_2G; //off MPDIG -+ u1Byte Times_2G; -+ -+//------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------// -+ BOOLEAN bCckHighPower; -+ u1Byte RFPathRxEnable; // ODM_CMNINFO_RFPATH_ENABLE -+ u1Byte ControlChannel; -+//------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------// -+ -+//--------REMOVED COMMON INFO----------// -+ //u1Byte PseudoMacPhyMode; -+ //BOOLEAN *BTCoexist; -+ //BOOLEAN PseudoBtCoexist; -+ //u1Byte OPMode; -+ //BOOLEAN bAPMode; -+ //BOOLEAN bClientMode; -+ //BOOLEAN bAdHocMode; -+ //BOOLEAN bSlaveOfDMSP; -+//--------REMOVED COMMON INFO----------// -+ -+ -+//1 COMMON INFORMATION -+ -+ // -+ // Init Value -+ // -+//-----------HOOK BEFORE REG INIT-----------// -+ // ODM Platform info AP/ADSL/CE/MP = 1/2/3/4 -+ u1Byte SupportPlatform; -+ // ODM Support Ability DIG/RATR/TX_PWR_TRACK/ KK = 1/2/3/K -+ u4Byte SupportAbility; -+ // ODM PCIE/USB/SDIO = 1/2/3 -+ u1Byte SupportInterface; -+ // ODM composite or independent. Bit oriented/ 92C+92D+ .... or any other type = 1/2/3/... -+ u4Byte SupportICType; -+ // Cut Version TestChip/A-cut/B-cut... = 0/1/2/3/... -+ u1Byte CutVersion; -+ // Fab Version TSMC/UMC = 0/1 -+ u1Byte FabVersion; -+ // RF Type 4T4R/3T3R/2T2R/1T2R/1T1R/... -+ u1Byte RFType; -+ u1Byte RFEType; -+ // Board Type Normal/HighPower/MiniCard/SLIM/Combo/... = 0/1/2/3/4/... -+ u1Byte BoardType; -+ u1Byte PackageType; -+ u2Byte TypeGLNA; -+ u2Byte TypeGPA; -+ u2Byte TypeALNA; -+ u2Byte TypeAPA; -+ // with external LNA NO/Yes = 0/1 -+ u1Byte ExtLNA; // 2G -+ u1Byte ExtLNA5G; //5G -+ // with external PA NO/Yes = 0/1 -+ u1Byte ExtPA; // 2G -+ u1Byte ExtPA5G; //5G -+ // with external TRSW NO/Yes = 0/1 -+ u1Byte ExtTRSW; -+ u1Byte ExtLNAGain; // 2G -+ u1Byte PatchID; //Customer ID -+ BOOLEAN bInHctTest; -+ BOOLEAN bWIFITest; -+ -+ BOOLEAN bDualMacSmartConcurrent; -+ u4Byte BK_SupportAbility; -+ u1Byte AntDivType; -+ BOOLEAN ConfigBBRF; -+ u1Byte odm_Regulation2_4G; -+ u1Byte odm_Regulation5G; -+ u1Byte IQKFWOffload; -+//-----------HOOK BEFORE REG INIT-----------// -+ -+ // -+ // Dynamic Value -+ // -+//--------- POINTER REFERENCE-----------// -+ -+ u1Byte u1Byte_temp; -+ BOOLEAN BOOLEAN_temp; -+ PADAPTER PADAPTER_temp; -+ -+ // MAC PHY Mode SMSP/DMSP/DMDP = 0/1/2 -+ u1Byte *pMacPhyMode; -+ //TX Unicast byte count -+ u8Byte *pNumTxBytesUnicast; -+ //RX Unicast byte count -+ u8Byte *pNumRxBytesUnicast; -+ // Wireless mode B/G/A/N = BIT0/BIT1/BIT2/BIT3 -+ u1Byte *pWirelessMode; //ODM_WIRELESS_MODE_E -+ // Frequence band 2.4G/5G = 0/1 -+ u1Byte *pBandType; -+ // Secondary channel offset don't_care/below/above = 0/1/2 -+ u1Byte *pSecChOffset; -+ // Security mode Open/WEP/AES/TKIP = 0/1/2/3 -+ u1Byte *pSecurity; -+ // BW info 20M/40M/80M = 0/1/2 -+ u1Byte *pBandWidth; -+ // Central channel location Ch1/Ch2/.... -+ u1Byte *pChannel; //central channel number -+ BOOLEAN DPK_Done; -+ // Common info for 92D DMSP -+ -+ BOOLEAN *pbGetValueFromOtherMac; -+ PADAPTER *pBuddyAdapter; -+ BOOLEAN *pbMasterOfDMSP; //MAC0: master, MAC1: slave -+ // Common info for Status -+ BOOLEAN *pbScanInProcess; -+ BOOLEAN *pbPowerSaving; -+ // CCA Path 2-path/path-A/path-B = 0/1/2; using ODM_CCA_PATH_E. -+ u1Byte *pOnePathCCA; -+ //pMgntInfo->AntennaTest -+ u1Byte *pAntennaTest; -+ BOOLEAN *pbNet_closed; -+ //u1Byte *pAidMap; -+ u1Byte *pu1ForcedIgiLb; -+ BOOLEAN *pIsFcsModeEnable; -+/*--------- For 8723B IQK-----------*/ -+ BOOLEAN *pIs1Antenna; -+ u1Byte *pRFDefaultPath; -+ // 0:S1, 1:S0 -+ -+//--------- POINTER REFERENCE-----------// -+ pu2Byte pForcedDataRate; -+ pu1Byte HubUsbMode; -+ BOOLEAN *pbFwDwRsvdPageInProgress; -+ u4Byte *pCurrentTxTP; -+ u4Byte *pCurrentRxTP; -+ u1Byte *pSoundingSeq; -+//------------CALL BY VALUE-------------// -+ BOOLEAN bLinkInProcess; -+ BOOLEAN bWIFI_Direct; -+ BOOLEAN bWIFI_Display; -+ BOOLEAN bLinked; -+ BOOLEAN bsta_state; -+#if(DM_ODM_SUPPORT_TYPE & ODM_AP) // for repeater mode add by YuChen 2014.06.23 -+#ifdef UNIVERSAL_REPEATER -+ BOOLEAN VXD_bLinked; -+#endif -+#endif // for repeater mode add by YuChen 2014.06.23 -+ u1Byte RSSI_Min; -+ u1Byte InterfaceIndex; /*Add for 92D dual MAC: 0--Mac0 1--Mac1*/ -+ BOOLEAN bIsMPChip; -+ BOOLEAN bOneEntryOnly; -+ BOOLEAN mp_mode; -+ u4Byte OneEntry_MACID; -+ u1Byte pre_number_linked_client; -+ u1Byte number_linked_client; -+ u1Byte pre_number_active_client; -+ u1Byte number_active_client; -+ // Common info for BTDM -+ BOOLEAN bBtEnabled; // BT is enabled -+ BOOLEAN bBtConnectProcess; // BT HS is under connection progress. -+ u1Byte btHsRssi; // BT HS mode wifi rssi value. -+ BOOLEAN bBtHsOperation; // BT HS mode is under progress -+ u1Byte btHsDigVal; // use BT rssi to decide the DIG value -+ BOOLEAN bBtDisableEdcaTurbo; // Under some condition, don't enable the EDCA Turbo -+ BOOLEAN bBtBusy; // BT is busy. -+ BOOLEAN bBtLimitedDig; // BT is busy. -+ BOOLEAN bDisablePhyApi; -+//------------CALL BY VALUE-------------// -+ u1Byte RSSI_A; -+ u1Byte RSSI_B; -+ u1Byte RSSI_C; -+ u1Byte RSSI_D; -+ u8Byte RSSI_TRSW; -+ u8Byte RSSI_TRSW_H; -+ u8Byte RSSI_TRSW_L; -+ u8Byte RSSI_TRSW_iso; -+ u1Byte TXAntStatus; -+ u1Byte RXAntStatus; -+ u1Byte cck_lna_idx; -+ u1Byte cck_vga_idx; -+ u1Byte ofdm_agc_idx[4]; -+ -+ u1Byte RxRate; -+ BOOLEAN bNoisyState; -+ u1Byte TxRate; -+ u1Byte LinkedInterval; -+ u1Byte preChannel; -+ u4Byte TxagcOffsetValueA; -+ BOOLEAN IsTxagcOffsetPositiveA; -+ u4Byte TxagcOffsetValueB; -+ BOOLEAN IsTxagcOffsetPositiveB; -+ u8Byte lastTxOkCnt; -+ u8Byte lastRxOkCnt; -+ u4Byte BbSwingOffsetA; -+ BOOLEAN IsBbSwingOffsetPositiveA; -+ u4Byte BbSwingOffsetB; -+ BOOLEAN IsBbSwingOffsetPositiveB; -+ u1Byte antdiv_rssi; -+ u1Byte fat_comb_a; -+ u1Byte fat_comb_b; -+ u1Byte antdiv_intvl; -+ u1Byte AntType; -+ u1Byte pre_AntType; -+ u1Byte antdiv_period; -+ u1Byte antdiv_select; -+ u1Byte path_select; -+ u1Byte antdiv_evm_en; -+ u1Byte bdc_holdstate; -+ u1Byte NdpaPeriod; -+ BOOLEAN H2C_RARpt_connect; -+ BOOLEAN cck_agc_report_type; -+ -+ u1Byte dm_dig_max_TH; -+ u1Byte dm_dig_min_TH; -+ u1Byte print_agc; -+ -+ //For Adaptivtiy -+ u2Byte NHM_cnt_0; -+ u2Byte NHM_cnt_1; -+ s1Byte TH_L2H_ini; -+ s1Byte TH_EDCCA_HL_diff; -+ s1Byte TH_L2H_ini_mode2; -+ s1Byte TH_EDCCA_HL_diff_mode2; -+ BOOLEAN Carrier_Sense_enable; -+ u1Byte Adaptivity_IGI_upper; -+ BOOLEAN adaptivity_flag; -+ u1Byte DCbackoff; -+ BOOLEAN Adaptivity_enable; -+ u1Byte APTotalNum; -+ BOOLEAN EDCCA_enable; -+ ADAPTIVITY_STATISTICS Adaptivity; -+ //For Adaptivtiy -+ u1Byte LastUSBHub; -+ u1Byte TxBfDataRate; -+ -+ u1Byte c2h_cmd_start; -+ u1Byte fw_debug_trace[60]; -+ u1Byte pre_c2h_seq; -+ BOOLEAN fw_buff_is_enpty; -+ u4Byte data_frame_num; -+ -+ /*for noise detection*/ -+ BOOLEAN NoisyDecision; /*b_noisy*/ -+ BOOLEAN pre_b_noisy; -+ u4Byte NoisyDecision_Smooth; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ ODM_NOISE_MONITOR noise_level;//[ODM_MAX_CHANNEL_NUM]; -+#endif -+ // -+ //2 Define STA info. -+ // _ODM_STA_INFO -+ // 2012/01/12 MH For MP, we need to reduce one array pointer for default port.?? -+ PSTA_INFO_T pODM_StaInfo[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte platform2phydm_macid_table[ODM_ASSOCIATE_ENTRY_NUM]; /* platform_macid_table[platform_macid] = phydm_macid */ -+ -+#if (RATE_ADAPTIVE_SUPPORT == 1) -+ u2Byte CurrminRptTime; -+ ODM_RA_INFO_T RAInfo[ODM_ASSOCIATE_ENTRY_NUM]; //Use MacID as array index. STA MacID=0, VWiFi Client MacID={1, ODM_ASSOCIATE_ENTRY_NUM-1} //YJ,add,120119 -+#endif -+ // -+ // 2012/02/14 MH Add to share 88E ra with other SW team. -+ // We need to colelct all support abilit to a proper area. -+ // -+ BOOLEAN RaSupport88E; -+ -+ // Define ........... -+ -+ // Latest packet phy info (ODM write) -+ ODM_PHY_DBG_INFO_T PhyDbgInfo; -+ //PHY_INFO_88E PhyInfo; -+ -+ // Latest packet phy info (ODM write) -+ ODM_MAC_INFO *pMacInfo; -+ //MAC_INFO_88E MacInfo; -+ -+ // Different Team independt structure?? -+ -+ // -+ //TX_RTP_CMN TX_retrpo; -+ //TX_RTP_88E TX_retrpo; -+ //TX_RTP_8195 TX_retrpo; -+ -+ // -+ //ODM Structure -+ // -+#if (defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ BDC_T DM_BdcTable; -+ #endif -+ -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ SAT_T dm_sat_table; -+ #endif -+ -+#endif -+ FAT_T DM_FatTable; -+ DIG_T DM_DigTable; -+ -+ PS_T DM_PSTable; -+ Pri_CCA_T DM_PriCCA; -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ RXHP_T DM_RXHP_Table; -+#endif -+ RA_T DM_RA_Table; -+ FALSE_ALARM_STATISTICS FalseAlmCnt; -+ FALSE_ALARM_STATISTICS FlaseAlmCntBuddyAdapter; -+ SWAT_T DM_SWAT_Table; -+ BOOLEAN RSSI_test; -+ CFO_TRACKING DM_CfoTrack; -+ ACS DM_ACS; -+ -+ -+#if (RTL8814A_SUPPORT == 1) -+ IQK_INFO IQK_info; -+#endif /* (RTL8814A_SUPPORT==1) */ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ //Path Div Struct -+ PATHDIV_PARA pathIQK; -+#endif -+#if(defined(CONFIG_PATH_DIVERSITY)) -+ PATHDIV_T DM_PathDiv; -+#endif -+ -+ EDCA_T DM_EDCA_Table; -+ u4Byte WMMEDCA_BE; -+ -+ // Copy from SD4 structure -+ // -+ // ================================================== -+ // -+ -+ //common -+ //u1Byte DM_Type; -+ //u1Byte PSD_Report_RXHP[80]; // Add By Gary -+ //u1Byte PSD_func_flag; // Add By Gary -+ //for DIG -+ //u1Byte bDMInitialGainEnable; -+ //u1Byte binitialized; // for dm_initial_gain_Multi_STA use. -+ //for Antenna diversity -+ //u8 AntDivCfg;// 0:OFF , 1:ON, 2:by efuse -+ //PSTA_INFO_T RSSI_target; -+ -+ BOOLEAN *pbDriverStopped; -+ BOOLEAN *pbDriverIsGoingToPnpSetPowerSleep; -+ BOOLEAN *pinit_adpt_in_progress; -+ -+ //PSD -+ BOOLEAN bUserAssignLevel; -+ RT_TIMER PSDTimer; -+ u1Byte RSSI_BT; //come from BT -+ BOOLEAN bPSDinProcess; -+ BOOLEAN bPSDactive; -+ BOOLEAN bDMInitialGainEnable; -+ -+ //MPT DIG -+ RT_TIMER MPT_DIGTimer; -+ -+ //for rate adaptive, in fact, 88c/92c fw will handle this -+ u1Byte bUseRAMask; -+ -+ ODM_RATE_ADAPTIVE RateAdaptive; -+//#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#if(defined(CONFIG_ANT_DETECTION)) -+ ANT_DETECTED_INFO AntDetectedInfo; // Antenna detected information for RSSI tool -+#endif -+ ODM_RF_CAL_T RFCalibrateInfo; -+ -+ -+ // -+ // Dynamic ATC switch -+ // -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ // -+ // Power Training -+ // -+ u1Byte ForcePowerTrainingState; -+ BOOLEAN bChangeState; -+ u4Byte PT_score; -+ u8Byte OFDM_RX_Cnt; -+ u8Byte CCK_RX_Cnt; -+#endif -+ BOOLEAN bDisablePowerTraining; -+ -+ // -+ // ODM system resource. -+ // -+ -+ // ODM relative time. -+ RT_TIMER PathDivSwitchTimer; -+ //2011.09.27 add for Path Diversity -+ RT_TIMER CCKPathDiversityTimer; -+ RT_TIMER FastAntTrainingTimer; -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ RT_TIMER EVM_FastAntTrainingTimer; -+#endif -+ RT_TIMER sbdcnt_timer; -+ -+ // ODM relative workitem. -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if USE_WORKITEM -+ RT_WORK_ITEM PathDivSwitchWorkitem; -+ RT_WORK_ITEM CCKPathDiversityWorkitem; -+ RT_WORK_ITEM FastAntTrainingWorkitem; -+ RT_WORK_ITEM MPT_DIGWorkitem; -+ RT_WORK_ITEM RaRptWorkitem; -+ RT_WORK_ITEM sbdcnt_workitem; -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#if (BEAMFORMING_SUPPORT == 1) -+ RT_BEAMFORMING_INFO BeamformingInfo; -+#endif -+#endif -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+#if (RT_PLATFORM != PLATFORM_LINUX) -+} DM_ODM_T, *PDM_ODM_T; // DM_Dynamic_Mechanism_Structure -+#else -+}; -+#endif -+ -+#else// for AP,ADSL,CE Team -+} DM_ODM_T, *PDM_ODM_T; // DM_Dynamic_Mechanism_Structure -+#endif -+ -+ -+typedef enum _PHYDM_STRUCTURE_TYPE{ -+ PHYDM_FALSEALMCNT, -+ PHYDM_CFOTRACK, -+ PHYDM_ADAPTIVITY, -+ PHYDM_ROMINFO, -+ -+}PHYDM_STRUCTURE_TYPE; -+ -+ -+ -+ typedef enum _ODM_RF_CONTENT{ -+ odm_radioa_txt = 0x1000, -+ odm_radiob_txt = 0x1001, -+ odm_radioc_txt = 0x1002, -+ odm_radiod_txt = 0x1003 -+} ODM_RF_CONTENT; -+ -+typedef enum _ODM_BB_Config_Type{ -+ CONFIG_BB_PHY_REG, -+ CONFIG_BB_AGC_TAB, -+ CONFIG_BB_AGC_TAB_2G, -+ CONFIG_BB_AGC_TAB_5G, -+ CONFIG_BB_PHY_REG_PG, -+ CONFIG_BB_PHY_REG_MP, -+ CONFIG_BB_AGC_TAB_DIFF, -+} ODM_BB_Config_Type, *PODM_BB_Config_Type; -+ -+typedef enum _ODM_RF_Config_Type{ -+ CONFIG_RF_RADIO, -+ CONFIG_RF_TXPWR_LMT, -+} ODM_RF_Config_Type, *PODM_RF_Config_Type; -+ -+typedef enum _ODM_FW_Config_Type{ -+ CONFIG_FW_NIC, -+ CONFIG_FW_NIC_2, -+ CONFIG_FW_AP, -+ CONFIG_FW_AP_2, -+ CONFIG_FW_MP, -+ CONFIG_FW_WoWLAN, -+ CONFIG_FW_WoWLAN_2, -+ CONFIG_FW_AP_WoWLAN, -+ CONFIG_FW_BT, -+} ODM_FW_Config_Type; -+ -+// Status code -+#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) -+typedef enum _RT_STATUS{ -+ RT_STATUS_SUCCESS, -+ RT_STATUS_FAILURE, -+ RT_STATUS_PENDING, -+ RT_STATUS_RESOURCE, -+ RT_STATUS_INVALID_CONTEXT, -+ RT_STATUS_INVALID_PARAMETER, -+ RT_STATUS_NOT_SUPPORT, -+ RT_STATUS_OS_API_FAILED, -+}RT_STATUS,*PRT_STATUS; -+#endif // end of RT_STATUS definition -+ -+#ifdef REMOVE_PACK -+#pragma pack() -+#endif -+ -+//#include "odm_function.h" -+ -+//3=========================================================== -+//3 DIG -+//3=========================================================== -+ -+//Remove DIG by Yuchen -+ -+//3=========================================================== -+//3 AGC RX High Power Mode -+//3=========================================================== -+#define LNA_Low_Gain_1 0x64 -+#define LNA_Low_Gain_2 0x5A -+#define LNA_Low_Gain_3 0x58 -+ -+#define FA_RXHP_TH1 5000 -+#define FA_RXHP_TH2 1500 -+#define FA_RXHP_TH3 800 -+#define FA_RXHP_TH4 600 -+#define FA_RXHP_TH5 500 -+ -+//3=========================================================== -+//3 EDCA -+//3=========================================================== -+ -+//3=========================================================== -+//3 Dynamic Tx Power -+//3=========================================================== -+//Dynamic Tx Power Control Threshold -+ -+//Remove By YuChen -+ -+//3=========================================================== -+//3 Tx Power Tracking -+//3=========================================================== -+ -+ -+ -+//3=========================================================== -+//3 Rate Adaptive -+//3=========================================================== -+//Remove to odm_RaInfo.h by RS_James -+ -+//3=========================================================== -+//3 BB Power Save -+//3=========================================================== -+ -+typedef enum tag_1R_CCA_Type_Definition -+{ -+ CCA_1R =0, -+ CCA_2R = 1, -+ CCA_MAX = 2, -+}DM_1R_CCA_E; -+ -+typedef enum tag_RF_Type_Definition -+{ -+ RF_Save =0, -+ RF_Normal = 1, -+ RF_MAX = 2, -+}DM_RF_E; -+ -+ -+// -+// Extern Global Variables. -+// -+//PowerTracking move to odm_powerTrakcing.h by YuChen -+// -+// check Sta pointer valid or not -+// -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+#define IS_STA_VALID(pSta) (pSta && pSta->expire_to) -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#define IS_STA_VALID(pSta) (pSta && pSta->bUsed) -+#else -+#define IS_STA_VALID(pSta) (pSta) -+#endif -+ -+//Remove DIG by yuchen -+ -+//Remove BB power saving by Yuchen -+ -+//remove PT by yuchen -+ -+//ODM_RAStateCheck() Remove by RS_James -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_AP|ODM_ADSL)) -+//============================================================ -+// function prototype -+//============================================================ -+//#define DM_ChangeDynamicInitGainThresh ODM_ChangeDynamicInitGainThresh -+//void ODM_ChangeDynamicInitGainThresh(IN PADAPTER pAdapter, -+// IN INT32 DM_Type, -+// IN INT32 DM_Value); -+ -+//Remove DIG by yuchen -+ -+ -+BOOLEAN -+ODM_CheckPowerStatus( -+ IN PADAPTER Adapter -+ ); -+ -+ -+//Remove ODM_RateAdaptiveStateApInit() by RS_James -+ -+//Remove Edca by YuChen -+ -+#endif -+ -+ -+ -+u4Byte odm_ConvertTo_dB(u4Byte Value); -+ -+u4Byte odm_ConvertTo_linear(u4Byte Value); -+ -+#if((DM_ODM_SUPPORT_TYPE==ODM_WIN)||(DM_ODM_SUPPORT_TYPE==ODM_CE)) -+ -+u4Byte -+GetPSDData( -+ PDM_ODM_T pDM_Odm, -+ unsigned int point, -+ u1Byte initial_gain_psd); -+ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+VOID -+ODM_DMWatchdog_LPS( -+ IN PDM_ODM_T pDM_Odm -+); -+#endif -+ -+ -+s4Byte -+ODM_PWdB_Conversion( -+ IN s4Byte X, -+ IN u4Byte TotalBit, -+ IN u4Byte DecimalBit -+ ); -+ -+s4Byte -+ODM_SignConversion( -+ IN s4Byte value, -+ IN u4Byte TotalBit -+ ); -+ -+VOID -+ODM_DMInit( -+ IN PDM_ODM_T pDM_Odm -+); -+ -+VOID -+ODM_DMReset( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+phydm_support_ablity_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ); -+ -+VOID -+ODM_DMWatchdog( -+ IN PDM_ODM_T pDM_Odm // For common use in the future -+ ); -+ -+VOID -+ODM_CmnInfoInit( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_CMNINFO_E CmnInfo, -+ IN u4Byte Value -+ ); -+ -+VOID -+ODM_CmnInfoHook( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_CMNINFO_E CmnInfo, -+ IN PVOID pValue -+ ); -+ -+VOID -+ODM_CmnInfoPtrArrayHook( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_CMNINFO_E CmnInfo, -+ IN u2Byte Index, -+ IN PVOID pValue -+ ); -+ -+VOID -+ODM_CmnInfoUpdate( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte CmnInfo, -+ IN u8Byte Value -+ ); -+ -+#if(DM_ODM_SUPPORT_TYPE==ODM_AP) -+VOID -+ODM_InitAllThreads( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_StopAllThreads( -+ IN PDM_ODM_T pDM_Odm -+ ); -+#endif -+ -+VOID -+ODM_InitAllTimers( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_CancelAllTimers( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_ReleaseAllTimers( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID ODM_InitAllWorkItems(IN PDM_ODM_T pDM_Odm ); -+VOID ODM_FreeAllWorkItems(IN PDM_ODM_T pDM_Odm ); -+ -+ -+ -+u8Byte -+PlatformDivision64( -+ IN u8Byte x, -+ IN u8Byte y -+); -+ -+//==================================================== -+//3 PathDiV End -+//==================================================== -+ -+ -+#define DM_ChangeDynamicInitGainThresh ODM_ChangeDynamicInitGainThresh -+//void ODM_ChangeDynamicInitGainThresh(IN PADAPTER pAdapter, -+// IN INT32 DM_Type, -+// IN INT32 DM_Value); -+// -+// PathDiveristy Remove by RS_James -+ -+typedef enum tag_DIG_Connect_Definition -+{ -+ DIG_STA_DISCONNECT = 0, -+ DIG_STA_CONNECT = 1, -+ DIG_STA_BEFORE_CONNECT = 2, -+ DIG_MultiSTA_DISCONNECT = 3, -+ DIG_MultiSTA_CONNECT = 4, -+ DIG_CONNECT_MAX -+}DM_DIG_CONNECT_E; -+ -+ -+// -+// 2012/01/12 MH Check afapter status. Temp fix BSOD. -+// -+#define HAL_ADAPTER_STS_CHK(pDM_Odm)\ -+ if (pDM_Odm->Adapter == NULL)\ -+ {\ -+ return;\ -+ }\ -+ -+ -+// -+// For new definition in MP temporarily fro power tracking, -+// -+/* -+#define odm_TXPowerTrackingDirectCall(_Adapter) \ -+ IS_HARDWARE_TYPE_8192D(_Adapter) ? odm_TXPowerTrackingCallback_ThermalMeter_92D(_Adapter) : \ -+ IS_HARDWARE_TYPE_8192C(_Adapter) ? odm_TXPowerTrackingCallback_ThermalMeter_92C(_Adapter) : \ -+ IS_HARDWARE_TYPE_8723A(_Adapter) ? odm_TXPowerTrackingCallback_ThermalMeter_8723A(_Adapter) :\ -+ ODM_TXPowerTrackingCallback_ThermalMeter(_Adapter) -+*/ -+ -+ -+#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+VOID -+ODM_AsocEntry_Init( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+//Remove ODM_DynamicARFBSelect() by RS_James -+ -+PVOID -+PhyDM_Get_Structure( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte Structure_Type -+); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ||(DM_ODM_SUPPORT_TYPE == ODM_CE) -+/*===========================================================*/ -+/* The following is for compile only*/ -+/*===========================================================*/ -+ -+#define IS_HARDWARE_TYPE_8723A(_Adapter) FALSE -+#define IS_HARDWARE_TYPE_8723AE(_Adapter) FALSE -+#define IS_HARDWARE_TYPE_8192C(_Adapter) FALSE -+#define IS_HARDWARE_TYPE_8192D(_Adapter) FALSE -+#define RF_T_METER_92D 0x42 -+ -+ -+#define SET_TX_DESC_ANTSEL_A_92C(__pTxDesc, __Value) SET_BITS_TO_LE_1BYTE(__pTxDesc+8+3, 0, 1, __Value) -+#define SET_TX_DESC_TX_ANTL_92C(__pTxDesc, __Value) SET_BITS_TO_LE_1BYTE(__pTxDesc+8+3, 4, 2, __Value) -+#define SET_TX_DESC_TX_ANT_HT_92C(__pTxDesc, __Value) SET_BITS_TO_LE_1BYTE(__pTxDesc+8+3, 6, 2, __Value) -+#define SET_TX_DESC_TX_ANT_CCK_92C(__pTxDesc, __Value) SET_BITS_TO_LE_1BYTE(__pTxDesc+8+3, 2, 2, __Value) -+ -+#define GET_RX_STATUS_DESC_RX_MCS(__pRxStatusDesc) LE_BITS_TO_1BYTE( __pRxStatusDesc+12, 0, 6) -+ -+#define RX_HAL_IS_CCK_RATE_92C(pDesc)\ -+ (GET_RX_STATUS_DESC_RX_MCS(pDesc) == DESC_RATE1M ||\ -+ GET_RX_STATUS_DESC_RX_MCS(pDesc) == DESC_RATE2M ||\ -+ GET_RX_STATUS_DESC_RX_MCS(pDesc) == DESC_RATE5_5M ||\ -+ GET_RX_STATUS_DESC_RX_MCS(pDesc) == DESC_RATE11M) -+ -+#define H2C_92C_PSD_RESULT 16 -+ -+#define rConfig_ram64x16 0xb2c -+ -+#define TARGET_CHNL_NUM_2G_5G 59 -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+VOID -+FillH2CCmd92C( -+ IN PADAPTER Adapter, -+ IN u1Byte ElementID, -+ IN u4Byte CmdLen, -+ IN pu1Byte pCmdBuffer -+); -+VOID -+PHY_SetTxPowerLevel8192C( -+ IN PADAPTER Adapter, -+ IN u1Byte channel -+ ); -+u1Byte GetRightChnlPlaceforIQK(u1Byte chnl); -+ -+#endif -+ -+//=========================================================== -+#endif //#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+void odm_dtc(PDM_ODM_T pDM_Odm); -+#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ -+ -+ -+VOID phydm_NoisyDetection(IN PDM_ODM_T pDM_Odm ); -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_hwconfig.c linux/3rdparty/rtl8812au/hal/phydm/phydm_hwconfig.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_hwconfig.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_hwconfig.c 2017-06-07 23:07:21.018688214 +0300 -@@ -0,0 +1,3358 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#define READ_AND_CONFIG_MP(ic, txt) (ODM_ReadAndConfig_MP_##ic##txt(pDM_Odm)) -+#define READ_AND_CONFIG_TC(ic, txt) (ODM_ReadAndConfig_TC_##ic##txt(pDM_Odm)) -+ -+ -+#if (PHYDM_TESTCHIP_SUPPORT == 1) -+#define READ_AND_CONFIG(ic, txt) do {\ -+ if (pDM_Odm->bIsMPChip)\ -+ READ_AND_CONFIG_MP(ic,txt);\ -+ else\ -+ READ_AND_CONFIG_TC(ic,txt);\ -+ } while(0) -+#else -+ #define READ_AND_CONFIG READ_AND_CONFIG_MP -+#endif -+ -+ -+#define READ_FIRMWARE_MP(ic, txt) (ODM_ReadFirmware_MP_##ic##txt(pDM_Odm, pFirmware, pSize)) -+#define READ_FIRMWARE_TC(ic, txt) (ODM_ReadFirmware_TC_##ic##txt(pDM_Odm, pFirmware, pSize)) -+ -+#if (PHYDM_TESTCHIP_SUPPORT == 1) -+#define READ_FIRMWARE(ic, txt) do {\ -+ if (pDM_Odm->bIsMPChip)\ -+ READ_FIRMWARE_MP(ic,txt);\ -+ else\ -+ READ_FIRMWARE_TC(ic,txt);\ -+ } while(0) -+#else -+#define READ_FIRMWARE READ_FIRMWARE_MP -+#endif -+ -+#define GET_VERSION_MP(ic, txt) (ODM_GetVersion_MP_##ic##txt()) -+#define GET_VERSION_TC(ic, txt) (ODM_GetVersion_TC_##ic##txt()) -+#define GET_VERSION(ic, txt) (pDM_Odm->bIsMPChip?GET_VERSION_MP(ic,txt):GET_VERSION_TC(ic,txt)) -+ -+u1Byte -+odm_QueryRxPwrPercentage( -+ IN s1Byte AntPower -+ ) -+{ -+ if ((AntPower <= -100) || (AntPower >= 20)) -+ { -+ return 0; -+ } -+ else if (AntPower >= 0) -+ { -+ return 100; -+ } -+ else -+ { -+ return (100+AntPower); -+ } -+ -+} -+ -+ -+// -+// 2012/01/12 MH MOve some signal strength smooth method to MP HAL layer. -+// IF other SW team do not support the feature, remove this section.?? -+// -+s4Byte -+odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Lenovo( -+ IN OUT PDM_ODM_T pDM_Odm, -+ s4Byte CurrSig -+) -+{ -+ s4Byte RetSig = 0; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ //if(pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ { -+ // Step 1. Scale mapping. -+ // 20100611 Joseph: Re-tunning RSSI presentation for Lenovo. -+ // 20100426 Joseph: Modify Signal strength mapping. -+ // This modification makes the RSSI indication similar to Intel solution. -+ // 20100414 Joseph: Tunning RSSI for Lenovo according to RTL8191SE. -+ if(CurrSig >= 54 && CurrSig <= 100) -+ { -+ RetSig = 100; -+ } -+ else if(CurrSig>=42 && CurrSig <= 53 ) -+ { -+ RetSig = 95; -+ } -+ else if(CurrSig>=36 && CurrSig <= 41 ) -+ { -+ RetSig = 74 + ((CurrSig - 36) *20)/6; -+ } -+ else if(CurrSig>=33 && CurrSig <= 35 ) -+ { -+ RetSig = 65 + ((CurrSig - 33) *8)/2; -+ } -+ else if(CurrSig>=18 && CurrSig <= 32 ) -+ { -+ RetSig = 62 + ((CurrSig - 18) *2)/15; -+ } -+ else if(CurrSig>=15 && CurrSig <= 17 ) -+ { -+ RetSig = 33 + ((CurrSig - 15) *28)/2; -+ } -+ else if(CurrSig>=10 && CurrSig <= 14 ) -+ { -+ RetSig = 39; -+ } -+ else if(CurrSig>=8 && CurrSig <= 9 ) -+ { -+ RetSig = 33; -+ } -+ else if(CurrSig <= 8 ) -+ { -+ RetSig = 19; -+ } -+ } -+#endif //ENDIF (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ return RetSig; -+} -+ -+s4Byte -+odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Netcore( -+ IN OUT PDM_ODM_T pDM_Odm, -+ s4Byte CurrSig -+) -+{ -+ s4Byte RetSig = 0; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ //if(pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ { -+ // Netcore request this modification because 2009.04.13 SU driver use it. -+ if(CurrSig >= 31 && CurrSig <= 100) -+ { -+ RetSig = 100; -+ } -+ else if(CurrSig >= 21 && CurrSig <= 30) -+ { -+ RetSig = 90 + ((CurrSig - 20) / 1); -+ } -+ else if(CurrSig >= 11 && CurrSig <= 20) -+ { -+ RetSig = 80 + ((CurrSig - 10) / 1); -+ } -+ else if(CurrSig >= 7 && CurrSig <= 10) -+ { -+ RetSig = 69 + (CurrSig - 7); -+ } -+ else if(CurrSig == 6) -+ { -+ RetSig = 54; -+ } -+ else if(CurrSig == 5) -+ { -+ RetSig = 45; -+ } -+ else if(CurrSig == 4) -+ { -+ RetSig = 36; -+ } -+ else if(CurrSig == 3) -+ { -+ RetSig = 27; -+ } -+ else if(CurrSig == 2) -+ { -+ RetSig = 18; -+ } -+ else if(CurrSig == 1) -+ { -+ RetSig = 9; -+ } -+ else -+ { -+ RetSig = CurrSig; -+ } -+ } -+#endif //ENDIF (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ return RetSig; -+} -+ -+ -+s4Byte -+odm_SignalScaleMapping_92CSeries( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN s4Byte CurrSig -+) -+{ -+ s4Byte RetSig = 0; -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ if(pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ { -+ // Step 1. Scale mapping. -+ if(CurrSig >= 61 && CurrSig <= 100) -+ { -+ RetSig = 90 + ((CurrSig - 60) / 4); -+ } -+ else if(CurrSig >= 41 && CurrSig <= 60) -+ { -+ RetSig = 78 + ((CurrSig - 40) / 2); -+ } -+ else if(CurrSig >= 31 && CurrSig <= 40) -+ { -+ RetSig = 66 + (CurrSig - 30); -+ } -+ else if(CurrSig >= 21 && CurrSig <= 30) -+ { -+ RetSig = 54 + (CurrSig - 20); -+ } -+ else if(CurrSig >= 5 && CurrSig <= 20) -+ { -+ RetSig = 42 + (((CurrSig - 5) * 2) / 3); -+ } -+ else if(CurrSig == 4) -+ { -+ RetSig = 36; -+ } -+ else if(CurrSig == 3) -+ { -+ RetSig = 27; -+ } -+ else if(CurrSig == 2) -+ { -+ RetSig = 18; -+ } -+ else if(CurrSig == 1) -+ { -+ RetSig = 9; -+ } -+ else -+ { -+ RetSig = CurrSig; -+ } -+ } -+#endif -+ -+#if ((DEV_BUS_TYPE == RT_USB_INTERFACE) ||(DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+ if((pDM_Odm->SupportInterface == ODM_ITRF_USB) || (pDM_Odm->SupportInterface == ODM_ITRF_SDIO)) -+ { -+ if(CurrSig >= 51 && CurrSig <= 100) -+ { -+ RetSig = 100; -+ } -+ else if(CurrSig >= 41 && CurrSig <= 50) -+ { -+ RetSig = 80 + ((CurrSig - 40)*2); -+ } -+ else if(CurrSig >= 31 && CurrSig <= 40) -+ { -+ RetSig = 66 + (CurrSig - 30); -+ } -+ else if(CurrSig >= 21 && CurrSig <= 30) -+ { -+ RetSig = 54 + (CurrSig - 20); -+ } -+ else if(CurrSig >= 10 && CurrSig <= 20) -+ { -+ RetSig = 42 + (((CurrSig - 10) * 2) / 3); -+ } -+ else if(CurrSig >= 5 && CurrSig <= 9) -+ { -+ RetSig = 22 + (((CurrSig - 5) * 3) / 2); -+ } -+ else if(CurrSig >= 1 && CurrSig <= 4) -+ { -+ RetSig = 6 + (((CurrSig - 1) * 3) / 2); -+ } -+ else -+ { -+ RetSig = CurrSig; -+ } -+ } -+ -+#endif -+ return RetSig; -+} -+s4Byte -+odm_SignalScaleMapping( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN s4Byte CurrSig -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if( (pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->SupportInterface != ODM_ITRF_PCIE) && //USB & SDIO -+ (pDM_Odm->PatchID==10))//pMgntInfo->CustomerID == RT_CID_819x_Netcore -+ { -+ return odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Netcore(pDM_Odm,CurrSig); -+ } -+ else if( (pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) && -+ (pDM_Odm->PatchID==19))//pMgntInfo->CustomerID == RT_CID_819x_Lenovo) -+ { -+ return odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Lenovo(pDM_Odm, CurrSig); -+ }else -+#endif -+ { -+ return odm_SignalScaleMapping_92CSeries(pDM_Odm,CurrSig); -+ } -+ -+} -+ -+ -+ -+static u1Byte odm_SQ_process_patch_RT_CID_819x_Lenovo( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte isCCKrate, -+ IN u1Byte PWDB_ALL, -+ IN u1Byte path, -+ IN u1Byte RSSI -+) -+{ -+ u1Byte SQ = 0; -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ if(isCCKrate){ -+ -+ if(IS_HARDWARE_TYPE_8723AE(pDM_Odm->Adapter)) -+ { -+ -+ // -+ // Expected signal strength and bars indication at Lenovo lab. 2013.04.11 -+ // 802.11n, 802.11b, 802.11g only at channel 6 -+ // -+ // Attenuation (dB) OS Signal Bars RSSI by Xirrus (dBm) -+ // 50 5 -52 -+ // 55 5 -54 -+ // 60 5 -55 -+ // 65 5 -59 -+ // 70 5 -63 -+ // 75 5 -66 -+ // 80 4 -72 -+ // 85 3 -75 -+ // 90 3 -80 -+ // 95 2 -85 -+ // 100 1 -89 -+ // 102 1 -90 -+ // 104 1 -91 -+ // -+ RT_TRACE(COMP_DBG, DBG_WARNING, ("odm_SQ_process_patch_RT_CID_819x_Lenovo\n")); -+ -+#if OS_WIN_FROM_WIN8(OS_VERSION) -+ if(PWDB_ALL >= 50) -+ SQ = 100; -+ else if(PWDB_ALL >= 23 && PWDB_ALL < 50) -+ SQ = 80; -+ else if(PWDB_ALL >= 18 && PWDB_ALL < 23) -+ SQ = 60; -+ else if(PWDB_ALL >= 8 && PWDB_ALL < 18) -+ SQ = 40; -+ else -+ SQ = 10; -+#else -+ if(PWDB_ALL >= 34) -+ SQ = 100; -+ else if(PWDB_ALL >= 23 && PWDB_ALL < 34) -+ SQ = 80; -+ else if(PWDB_ALL >= 18 && PWDB_ALL < 23) -+ SQ = 60; -+ else if(PWDB_ALL >= 8 && PWDB_ALL < 18) -+ SQ = 40; -+ else -+ SQ = 10; -+ -+ if(PWDB_ALL == 0)// Abnormal case, do not indicate the value above 20 on Win7 -+ SQ = 20; -+#endif -+ -+ } -+ else if(IS_HARDWARE_TYPE_8192E(pDM_Odm->Adapter)){ -+ -+ // -+ // Expected signal strength and bars indication at Lenovo lab. 2013.04.11 -+ // 802.11n, 802.11b, 802.11g only at channel 6 -+ // -+ // Attenuation (dB) OS Signal Bars RSSI by Xirrus (dBm) -+ // 50 5 -49 -+ // 55 5 -49 -+ // 60 5 -50 -+ // 65 5 -51 -+ // 70 5 -52 -+ // 75 5 -54 -+ // 80 5 -55 -+ // 85 4 -60 -+ // 90 3 -63 -+ // 95 3 -65 -+ // 100 2 -67 -+ // 102 2 -67 -+ // 104 1 -70 -+ // -+ -+ if(PWDB_ALL >= 50) -+ SQ = 100; -+ else if(PWDB_ALL >= 35 && PWDB_ALL < 50) -+ SQ = 80; -+ else if(PWDB_ALL >= 31 && PWDB_ALL < 35) -+ SQ = 60; -+ else if(PWDB_ALL >= 22 && PWDB_ALL < 31) -+ SQ = 40; -+ else if(PWDB_ALL >= 18 && PWDB_ALL < 22) -+ SQ = 20; -+ else -+ SQ = 10; -+ } else { -+ if (PWDB_ALL >= 50) -+ SQ = 100; -+ else if (PWDB_ALL >= 35 && PWDB_ALL < 50) -+ SQ = 80; -+ else if (PWDB_ALL >= 22 && PWDB_ALL < 35) -+ SQ = 60; -+ else if (PWDB_ALL >= 18 && PWDB_ALL < 22) -+ SQ = 40; -+ else -+ SQ = 10; -+ } -+ -+ } -+ else -+ {//OFDM rate -+ -+ if(IS_HARDWARE_TYPE_8723AE(pDM_Odm->Adapter) || -+ IS_HARDWARE_TYPE_8192E(pDM_Odm->Adapter)) -+ { -+ if(RSSI >= 45) -+ SQ = 100; -+ else if(RSSI >= 22 && RSSI < 45) -+ SQ = 80; -+ else if(RSSI >= 18 && RSSI < 22) -+ SQ = 40; -+ else -+ SQ = 20; -+ } else { -+ if(RSSI >= 45) -+ SQ = 100; -+ else if(RSSI >= 22 && RSSI < 45) -+ SQ = 80; -+ else if(RSSI >= 18 && RSSI < 22) -+ SQ = 40; -+ else -+ SQ = 20; -+ } -+ } -+ -+ RT_TRACE(COMP_DBG, DBG_TRACE, ("isCCKrate(%#d), PWDB_ALL(%#d), RSSI(%#d), SQ(%#d)\n", isCCKrate, PWDB_ALL, RSSI, SQ)); -+ -+#endif -+ return SQ; -+} -+ -+static u1Byte odm_SQ_process_patch_RT_CID_819x_Acer( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte isCCKrate, -+ IN u1Byte PWDB_ALL, -+ IN u1Byte path, -+ IN u1Byte RSSI -+) -+{ -+ u1Byte SQ = 0; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ if(isCCKrate){ -+ -+ RT_TRACE(COMP_DBG, DBG_WARNING, ("odm_SQ_process_patch_RT_Acer\n")); -+ -+#if OS_WIN_FROM_WIN8(OS_VERSION) -+ -+ if(PWDB_ALL >= 50) -+ SQ = 100; -+ else if(PWDB_ALL >= 35 && PWDB_ALL < 50) -+ SQ = 80; -+ else if(PWDB_ALL >= 30 && PWDB_ALL < 35) -+ SQ = 60; -+ else if(PWDB_ALL >= 25 && PWDB_ALL < 30) -+ SQ = 40; -+ else if(PWDB_ALL >= 20 && PWDB_ALL < 25) -+ SQ = 20; -+ else -+ SQ = 10; -+#else -+ if(PWDB_ALL >= 50) -+ SQ = 100; -+ else if(PWDB_ALL >= 35 && PWDB_ALL < 50) -+ SQ = 80; -+ else if(PWDB_ALL >= 30 && PWDB_ALL < 35) -+ SQ = 60; -+ else if(PWDB_ALL >= 25 && PWDB_ALL < 30) -+ SQ = 40; -+ else if(PWDB_ALL >= 20 && PWDB_ALL < 25) -+ SQ = 20; -+ else -+ SQ = 10; -+ -+ if(PWDB_ALL == 0)// Abnormal case, do not indicate the value above 20 on Win7 -+ SQ = 20; -+#endif -+ -+ -+ -+ } -+ else -+ {//OFDM rate -+ -+ if(IS_HARDWARE_TYPE_8723AE(pDM_Odm->Adapter) || -+ IS_HARDWARE_TYPE_8192E(pDM_Odm->Adapter)) -+ { -+ if(RSSI >= 45) -+ SQ = 100; -+ else if(RSSI >= 22 && RSSI < 45) -+ SQ = 80; -+ else if(RSSI >= 18 && RSSI < 22) -+ SQ = 40; -+ else -+ SQ = 20; -+ } -+ else -+ { -+ if(RSSI >= 35) -+ SQ = 100; -+ else if(RSSI >= 30 && RSSI < 35) -+ SQ = 80; -+ else if(RSSI >= 25 && RSSI < 30) -+ SQ = 40; -+ else -+ SQ = 20; -+ } -+ } -+ -+ RT_TRACE(COMP_DBG, DBG_LOUD, ("isCCKrate(%#d), PWDB_ALL(%#d), RSSI(%#d), SQ(%#d)\n", isCCKrate, PWDB_ALL, RSSI, SQ)); -+ -+#endif -+ return SQ; -+} -+ -+static u1Byte -+odm_EVMdbToPercentage( -+ IN s1Byte Value -+ ) -+{ -+ // -+ // -33dB~0dB to 0%~99% -+ // -+ s1Byte ret_val; -+ -+ ret_val = Value; -+ ret_val /= 2; -+ -+ /*DbgPrint("Value=%d\n", Value);*/ -+ /*ODM_RT_DISP(FRX, RX_PHY_SQ, ("EVMdbToPercentage92C Value=%d / %x\n", ret_val, ret_val));*/ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ if (ret_val >= 0) -+ ret_val = 0; -+ -+ if (ret_val <= -40) -+ ret_val = -40; -+ -+ ret_val = 0 - ret_val; -+ ret_val *= 3; -+#else -+ if (ret_val >= 0) -+ ret_val = 0; -+ -+ if (ret_val <= -33) -+ ret_val = -33; -+ -+ ret_val = 0 - ret_val; -+ ret_val *= 3; -+ -+ if (ret_val == 99) -+ ret_val = 100; -+#endif -+ -+ return (u1Byte)ret_val; -+} -+ -+static u1Byte -+odm_EVMdbm_JaguarSeries( -+ IN s1Byte Value -+ ) -+{ -+ s1Byte ret_val = Value; -+ -+ // -33dB~0dB to 33dB ~ 0dB -+ if(ret_val == -128) -+ ret_val = 127; -+ else if (ret_val < 0) -+ ret_val = 0 - ret_val; -+ -+ ret_val = ret_val >> 1; -+ return (u1Byte)ret_val; -+} -+ -+static s2Byte -+odm_Cfo( -+ IN s1Byte Value -+) -+{ -+ s2Byte ret_val; -+ -+ if (Value < 0) -+ { -+ ret_val = 0 - Value; -+ ret_val = (ret_val << 1) + (ret_val >> 1) ; // *2.5~=312.5/2^7 -+ ret_val = ret_val | BIT12; // set bit12 as 1 for negative cfo -+ } -+ else -+ { -+ ret_val = Value; -+ ret_val = (ret_val << 1) + (ret_val>>1) ; // *2.5~=312.5/2^7 -+ } -+ return ret_val; -+} -+ -+#if(ODM_IC_11N_SERIES_SUPPORT == 1) -+ -+s1Byte -+odm_CCKRSSI_8703B( -+ IN u2Byte LNA_idx, -+ IN u1Byte VGA_idx -+ ) -+{ -+ s1Byte rx_pwr_all = 0x00; -+ -+ switch (LNA_idx) { -+ case 0xf: -+ rx_pwr_all = -48 - (2 * VGA_idx); -+ break; -+ case 0xb: -+ rx_pwr_all = -42 - (2 * VGA_idx); /*TBD*/ -+ break; -+ case 0xa: -+ rx_pwr_all = -36 - (2 * VGA_idx); -+ break; -+ case 8: -+ rx_pwr_all = -32 - (2 * VGA_idx); -+ break; -+ case 7: -+ rx_pwr_all = -28 - (2 * VGA_idx); /*TBD*/ -+ break; -+ case 4: -+ rx_pwr_all = -16 - (2 * VGA_idx); -+ break; -+ case 0: -+ rx_pwr_all = -2 - (2 * VGA_idx); -+ break; -+ default: -+ /*rx_pwr_all = -53+(2*(31-VGA_idx));*/ -+ /*DbgPrint("wrong LNA index\n");*/ -+ break; -+ -+ } -+ return rx_pwr_all; -+} -+ -+VOID -+odm_RxPhyStatus92CSeries_Parsing( -+ IN OUT PDM_ODM_T pDM_Odm, -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ u1Byte i, Max_spatial_stream; -+ s1Byte rx_pwr[4], rx_pwr_all=0; -+ u1Byte EVM, PWDB_ALL = 0, PWDB_ALL_BT; -+ u1Byte RSSI, total_rssi=0; -+ BOOLEAN isCCKrate=FALSE; -+ u1Byte rf_rx_num = 0; -+ u1Byte cck_highpwr = 0; -+ u1Byte LNA_idx = 0; -+ u1Byte VGA_idx = 0; -+ PPHY_STATUS_RPT_8192CD_T pPhyStaRpt = (PPHY_STATUS_RPT_8192CD_T)pPhyStatus; -+ -+ isCCKrate = (pPktinfo->DataRate <= ODM_RATE11M) ? TRUE : FALSE; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = -1; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; -+ -+ -+ if(isCCKrate) -+ { -+ u1Byte report; -+ u1Byte cck_agc_rpt; -+ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; -+ // -+ // (1)Hardware does not provide RSSI for CCK -+ // (2)PWDB, Average PWDB cacluated by hardware (for rate adaptive) -+ // -+ -+ //if(pHalData->eRFPowerState == eRfOn) -+ cck_highpwr = pDM_Odm->bCckHighPower; -+ //else -+ // cck_highpwr = FALSE; -+ -+ cck_agc_rpt = pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a ; -+ -+ //2011.11.28 LukeLee: 88E use different LNA & VGA gain table -+ //The RSSI formula should be modified according to the gain table -+ //In 88E, cck_highpwr is always set to 1 -+ if (pDM_Odm->SupportICType & (ODM_RTL8703B)) { -+ -+ #if (RTL8703B_SUPPORT == 1) -+ if (pDM_Odm->cck_agc_report_type == 1) { /*4 bit LNA*/ -+ -+ u1Byte cck_agc_rpt_b = (pPhyStaRpt->cck_rpt_b_ofdm_cfosho_b & BIT7) ? 1 : 0; -+ -+ LNA_idx = (cck_agc_rpt_b << 3) | ((cck_agc_rpt & 0xE0) >> 5); -+ VGA_idx = (cck_agc_rpt & 0x1F); -+ -+ rx_pwr_all = odm_CCKRSSI_8703B(LNA_idx, VGA_idx); -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ if (PWDB_ALL > 100) -+ PWDB_ALL = 100; -+ -+ } -+ #endif -+ } else if (pDM_Odm->SupportICType & (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8723B | ODM_RTL8188F)) /*3 bit LNA*/ -+ { -+ LNA_idx = ((cck_agc_rpt & 0xE0) >>5); -+ VGA_idx = (cck_agc_rpt & 0x1F); -+ if(pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8192E)) -+ { -+ if(pDM_Odm->cck_agc_report_type == 0 && (pDM_Odm->SupportICType & ODM_RTL8192E) ) -+ { -+ switch(LNA_idx) -+ { -+ case 7: -+ rx_pwr_all = -45 - 2*(VGA_idx); -+ break; -+ case 6: -+ rx_pwr_all = -43 -2*(VGA_idx); -+ break; -+ case 5: -+ rx_pwr_all = -27 - 2*(VGA_idx); -+ break; -+ case 4: -+ rx_pwr_all = -21 - 2*(VGA_idx); -+ break; -+ case 3: -+ rx_pwr_all = -18 - 2*(VGA_idx); -+ break; -+ case 2: -+ rx_pwr_all = -6 - 2*(VGA_idx); -+ break; -+ case 1: -+ rx_pwr_all = 9 -2*(VGA_idx); -+ break; -+ case 0: -+ rx_pwr_all = 15 -2*(VGA_idx); -+ break; -+ default: -+ -+ break; -+ } -+ -+ if(pDM_Odm->BoardType & ODM_BOARD_EXT_LNA) -+ { -+ rx_pwr_all -= pDM_Odm->ExtLNAGain; -+ } -+ -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ } -+ else -+ { -+ switch(LNA_idx) -+ { -+ case 7: -+ if(VGA_idx <= 27) -+ rx_pwr_all = -100 + 2*(27-VGA_idx); //VGA_idx = 27~2 -+ else -+ rx_pwr_all = -100; -+ break; -+ case 6: -+ rx_pwr_all = -48 + 2*(2-VGA_idx); //VGA_idx = 2~0 -+ break; -+ case 5: -+ rx_pwr_all = -42 + 2*(7-VGA_idx); //VGA_idx = 7~5 -+ break; -+ case 4: -+ rx_pwr_all = -36 + 2*(7-VGA_idx); //VGA_idx = 7~4 -+ break; -+ case 3: -+ //rx_pwr_all = -28 + 2*(7-VGA_idx); //VGA_idx = 7~0 -+ rx_pwr_all = -24 + 2*(7-VGA_idx); //VGA_idx = 7~0 -+ break; -+ case 2: -+ if(cck_highpwr) -+ rx_pwr_all = -12 + 2*(5-VGA_idx); //VGA_idx = 5~0 -+ else -+ rx_pwr_all = -6+ 2*(5-VGA_idx); -+ break; -+ case 1: -+ rx_pwr_all = 8-2*VGA_idx; -+ break; -+ case 0: -+ rx_pwr_all = 14-2*VGA_idx; -+ break; -+ default: -+ //DbgPrint("CCK Exception default\n"); -+ break; -+ } -+ rx_pwr_all += 8; -+ -+ //2012.10.08 LukeLee: Modify for 92E CCK RSSI -+ if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ rx_pwr_all += 8; -+ -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ if(cck_highpwr == FALSE) -+ { -+ if(PWDB_ALL >= 80) -+ PWDB_ALL = ((PWDB_ALL-80)<<1)+((PWDB_ALL-80)>>1)+80; -+ else if((PWDB_ALL <= 78) && (PWDB_ALL >= 20)) -+ PWDB_ALL += 3; -+ if(PWDB_ALL>100) -+ PWDB_ALL = 100; -+ } -+ } -+ } -+ else if(pDM_Odm->SupportICType & (ODM_RTL8723B)) -+ { -+#if (RTL8723B_SUPPORT == 1) -+ rx_pwr_all = odm_CCKRSSI_8723B(LNA_idx,VGA_idx); -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ if(PWDB_ALL>100) -+ PWDB_ALL = 100; -+#endif -+ } else if (pDM_Odm->SupportICType & (ODM_RTL8188F)) { -+#if (RTL8188F_SUPPORT == 1) -+ rx_pwr_all = odm_CCKRSSI_8188F(LNA_idx, VGA_idx); -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ if (PWDB_ALL > 100) -+ PWDB_ALL = 100; -+#endif -+ } -+ } -+ else -+ { -+ if(!cck_highpwr) -+ { -+ report =( cck_agc_rpt & 0xc0 )>>6; -+ switch(report) -+ { -+ // 03312009 modified by cosa -+ // Modify the RF RNA gain value to -40, -20, -2, 14 by Jenyu's suggestion -+ // Note: different RF with the different RNA gain. -+ case 0x3: -+ rx_pwr_all = -46 - (cck_agc_rpt & 0x3e); -+ break; -+ case 0x2: -+ rx_pwr_all = -26 - (cck_agc_rpt & 0x3e); -+ break; -+ case 0x1: -+ rx_pwr_all = -12 - (cck_agc_rpt & 0x3e); -+ break; -+ case 0x0: -+ rx_pwr_all = 16 - (cck_agc_rpt & 0x3e); -+ break; -+ } -+ } -+ else -+ { -+ //report = pDrvInfo->cfosho[0] & 0x60; -+ //report = pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a& 0x60; -+ -+ report = (cck_agc_rpt & 0x60)>>5; -+ switch(report) -+ { -+ case 0x3: -+ rx_pwr_all = -46 - ((cck_agc_rpt & 0x1f)<<1) ; -+ break; -+ case 0x2: -+ rx_pwr_all = -26 - ((cck_agc_rpt & 0x1f)<<1); -+ break; -+ case 0x1: -+ rx_pwr_all = -12 - ((cck_agc_rpt & 0x1f)<<1) ; -+ break; -+ case 0x0: -+ rx_pwr_all = 16 - ((cck_agc_rpt & 0x1f)<<1) ; -+ break; -+ } -+ } -+ -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ -+ //Modification for ext-LNA board -+ if(pDM_Odm->BoardType & (ODM_BOARD_EXT_LNA | ODM_BOARD_EXT_PA)) -+ { -+ if((cck_agc_rpt>>7) == 0){ -+ PWDB_ALL = (PWDB_ALL>94)?100:(PWDB_ALL +6); -+ } -+ else -+ { -+ if(PWDB_ALL > 38) -+ PWDB_ALL -= 16; -+ else -+ PWDB_ALL = (PWDB_ALL<=16)?(PWDB_ALL>>2):(PWDB_ALL -12); -+ } -+ -+ //CCK modification -+ if(PWDB_ALL > 25 && PWDB_ALL <= 60) -+ PWDB_ALL += 6; -+ //else if (PWDB_ALL <= 25) -+ // PWDB_ALL += 8; -+ } -+ else//Modification for int-LNA board -+ { -+ if(PWDB_ALL > 99) -+ PWDB_ALL -= 8; -+ else if(PWDB_ALL > 50 && PWDB_ALL <= 68) -+ PWDB_ALL += 4; -+ } -+ } -+ -+ pDM_Odm->cck_lna_idx = LNA_idx; -+ pDM_Odm->cck_vga_idx = VGA_idx; -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+#endif -+ // -+ // (3) Get Signal Quality (EVM) -+ // -+ //if(pPktinfo->bPacketMatchBSSID) -+ { -+ u1Byte SQ,SQ_rpt; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)){ -+ SQ = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,0,0); -+ }else if((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID==RT_CID_819x_Acer)) -+ { -+ SQ = odm_SQ_process_patch_RT_CID_819x_Acer(pDM_Odm,isCCKrate,PWDB_ALL,0,0); -+ }else -+#endif -+ if(pPhyInfo->RxPWDBAll > 40 && !pDM_Odm->bInHctTest){ -+ SQ = 100; -+ } -+ else{ -+ SQ_rpt = pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all; -+ -+ if(SQ_rpt > 64) -+ SQ = 0; -+ else if (SQ_rpt < 20) -+ SQ = 100; -+ else -+ SQ = ((64-SQ_rpt) * 100) / 44; -+ -+ } -+ -+ //DbgPrint("cck SQ = %d\n", SQ); -+ pPhyInfo->SignalQuality = SQ; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = SQ; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; -+ } -+ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) { -+ if (i == 0) -+ pPhyInfo->RxMIMOSignalStrength[0] = PWDB_ALL; -+ else -+ pPhyInfo->RxMIMOSignalStrength[1] = 0; -+ } -+ } -+ else //2 is OFDM rate -+ { -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; -+ -+ // -+ // (1)Get RSSI for HT rate -+ // -+ -+ for(i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) -+ { -+ // 2008/01/30 MH we will judge RF RX path now. -+ if (pDM_Odm->RFPathRxEnable & BIT(i)) -+ rf_rx_num++; -+ //else -+ //continue; -+ -+ rx_pwr[i] = ((pPhyStaRpt->path_agc[i].gain& 0x3F)*2) - 110; -+ pDM_Odm->ofdm_agc_idx[i] = (pPhyStaRpt->path_agc[i].gain & 0x3F); -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->RxPwr[i] = rx_pwr[i]; -+ #endif -+ -+ /* Translate DBM to percentage. */ -+ RSSI = odm_QueryRxPwrPercentage(rx_pwr[i]); -+ total_rssi += RSSI; -+ //RT_DISP(FRX, RX_PHY_SS, ("RF-%d RXPWR=%x RSSI=%d\n", i, rx_pwr[i], RSSI)); -+ -+ -+ if(pDM_Odm->SupportICType&ODM_RTL8192C) -+ { -+ //Modification for ext-LNA board -+ if(pDM_Odm->BoardType & (ODM_BOARD_EXT_LNA | ODM_BOARD_EXT_PA)) -+ { -+ if((pPhyStaRpt->path_agc[i].trsw) == 1) -+ RSSI = (RSSI>94)?100:(RSSI +6); -+ else -+ RSSI = (RSSI<=16)?(RSSI>>3):(RSSI -16); -+ -+ if((RSSI <= 34) && (RSSI >=4)) -+ RSSI -= 4; -+ } -+ } -+ -+ pPhyInfo->RxMIMOSignalStrength[i] =(u1Byte) RSSI; -+ -+ #if (DM_ODM_SUPPORT_TYPE & (/*ODM_WIN|*/ODM_CE|ODM_AP)) -+ //Get Rx snr value in DB -+ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = (s4Byte)(pPhyStaRpt->path_rxsnr[i]/2); -+ #endif -+ -+ /* Record Signal Strength for next packet */ -+ //if(pPktinfo->bPacketMatchBSSID) -+ { -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)) -+ { -+ if(i==ODM_RF_PATH_A) -+ pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,i,RSSI); -+ -+ } -+ else if((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID==RT_CID_819x_Acer)) -+ { -+ pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Acer(pDM_Odm,isCCKrate,PWDB_ALL,0,RSSI); -+ } -+#endif -+ } -+ } -+ -+ -+ // -+ // (2)PWDB, Average PWDB cacluated by hardware (for rate adaptive) -+ // -+ rx_pwr_all = (((pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all) >> 1 )& 0x7f) -110; -+ -+ PWDB_ALL_BT = PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ -+ -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("ODM OFDM RSSI=%d\n",pPhyInfo->RxPWDBAll)); -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL_BT; -+ pPhyInfo->RxPower = rx_pwr_all; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+ #endif -+ -+ if((pDM_Odm->SupportPlatform == ODM_WIN) &&(pDM_Odm->PatchID==19)){ -+ //do nothing -+ }else if((pDM_Odm->SupportPlatform == ODM_WIN) &&(pDM_Odm->PatchID==25)){ -+ //do nothing -+ } -+ else{//pMgntInfo->CustomerID != RT_CID_819x_Lenovo -+ // -+ // (3)EVM of HT rate -+ // -+ if(pPktinfo->DataRate >=ODM_RATEMCS8 && pPktinfo->DataRate <=ODM_RATEMCS15) -+ Max_spatial_stream = 2; //both spatial stream make sense -+ else -+ Max_spatial_stream = 1; //only spatial stream 1 makes sense -+ -+ for(i=0; i>= 1" because the compilor of free build environment -+ // fill most significant bit to "zero" when doing shifting operation which may change a negative -+ // value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore. -+ EVM = odm_EVMdbToPercentage( (pPhyStaRpt->stream_rxevm[i] )); //dbm -+ -+ //GET_RX_STATUS_DESC_RX_MCS(pDesc), pDrvInfo->rxevm[i], "%", EVM)); -+ -+ //if(pPktinfo->bPacketMatchBSSID) -+ { -+ if(i==ODM_RF_PATH_A) // Fill value in RFD, Get the first spatial stream only -+ { -+ pPhyInfo->SignalQuality = (u1Byte)(EVM & 0xff); -+ } -+ pPhyInfo->RxMIMOSignalQuality[i] = (u1Byte)(EVM & 0xff); -+ } -+ } -+ } -+ -+ ODM_ParsingCFO(pDM_Odm, pPktinfo, pPhyStaRpt->path_cfotail); -+ -+ } -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ //UI BSS List signal strength(in percentage), make it good looking, from 0~100. -+ //It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp(). -+ if(isCCKrate) -+ { -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ // 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/ -+ pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, PWDB_ALL, TRUE, TRUE); -+#else -+ #ifdef CONFIG_SIGNAL_SCALE_MAPPING -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, PWDB_ALL));/*PWDB_ALL;*/ -+ #else -+ pPhyInfo->SignalStrength = (u1Byte)PWDB_ALL; -+ #endif -+#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+ } -+ else -+ { -+ if (rf_rx_num != 0) -+ { -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ // 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/ -+ pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, (total_rssi /= rf_rx_num), TRUE, FALSE); -+ #else -+ #ifdef CONFIG_SIGNAL_SCALE_MAPPING -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, total_rssi /= rf_rx_num)); -+ #else -+ total_rssi/=rf_rx_num; -+ pPhyInfo->SignalStrength = (u1Byte)total_rssi; -+ #endif -+ #endif -+ } -+ } -+#endif /*#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE))*/ -+ -+ //DbgPrint("isCCKrate = %d, pPhyInfo->RxPWDBAll = %d, pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a = 0x%x\n", -+ //isCCKrate, pPhyInfo->RxPWDBAll, pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a); -+ -+ //For 92C/92D HW (Hybrid) Antenna Diversity -+#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ pDM_SWAT_Table->antsel = pPhyStaRpt->ant_sel; -+ //For 88E HW Antenna Diversity -+ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->ant_sel; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->ant_sel_b; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antsel_rx_keep_2; -+#endif -+} -+#endif -+ -+#if ODM_IC_11AC_SERIES_SUPPORT -+ -+VOID -+odm_RxPhyBWJaguarSeries_Parsing( -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN PODM_PACKET_INFO_T pPktinfo, -+ IN PPHY_STATUS_RPT_8812_T pPhyStaRpt -+) -+{ -+ -+ if(pPktinfo->DataRate <= ODM_RATE54M) { -+ switch (pPhyStaRpt->r_RFMOD) { -+ case 1: -+ if (pPhyStaRpt->sub_chnl == 0) -+ pPhyInfo->BandWidth = 1; -+ else -+ pPhyInfo->BandWidth = 0; -+ break; -+ -+ case 2: -+ if (pPhyStaRpt->sub_chnl == 0) -+ pPhyInfo->BandWidth = 2; -+ else if (pPhyStaRpt->sub_chnl == 9 || pPhyStaRpt->sub_chnl == 10) -+ pPhyInfo->BandWidth = 1; -+ else -+ pPhyInfo->BandWidth = 0; -+ break; -+ -+ default: -+ case 0: -+ pPhyInfo->BandWidth = 0; -+ break; -+ } -+ } -+ -+} -+ -+VOID -+odm_RxPhyStatusJaguarSeries_Parsing( -+ IN OUT PDM_ODM_T pDM_Odm, -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo -+) -+{ -+ u1Byte i, Max_spatial_stream; -+ s1Byte rx_pwr[4], rx_pwr_all = 0; -+ u1Byte EVM = 0, EVMdbm, PWDB_ALL = 0, PWDB_ALL_BT; -+ u1Byte RSSI, avg_rssi = 0, best_rssi = 0, second_rssi = 0; -+ u1Byte isCCKrate = 0; -+ u1Byte rf_rx_num = 0; -+ u1Byte cck_highpwr = 0; -+ u1Byte LNA_idx, VGA_idx; -+ PPHY_STATUS_RPT_8812_T pPhyStaRpt = (PPHY_STATUS_RPT_8812_T)pPhyStatus; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ odm_RxPhyBWJaguarSeries_Parsing(pPhyInfo, pPktinfo, pPhyStaRpt); -+ -+ if (pPktinfo->DataRate <= ODM_RATE11M) -+ isCCKrate = TRUE; -+ else -+ isCCKrate = FALSE; -+ -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = -1; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_C] = -1; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_D] = -1; -+ -+ if (isCCKrate) { -+ u1Byte cck_agc_rpt; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; -+ -+ /*(1)Hardware does not provide RSSI for CCK*/ -+ /*(2)PWDB, Average PWDB calculated by hardware (for rate adaptive)*/ -+ -+ /*if(pHalData->eRFPowerState == eRfOn)*/ -+ cck_highpwr = pDM_Odm->bCckHighPower; -+ /*else*/ -+ /*cck_highpwr = FALSE;*/ -+ -+ cck_agc_rpt = pPhyStaRpt->cfosho[0] ; -+ LNA_idx = ((cck_agc_rpt & 0xE0) >> 5); -+ VGA_idx = (cck_agc_rpt & 0x1F); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8812) { -+ switch (LNA_idx) { -+ case 7: -+ if (VGA_idx <= 27) -+ rx_pwr_all = -100 + 2 * (27 - VGA_idx); /*VGA_idx = 27~2*/ -+ else -+ rx_pwr_all = -100; -+ break; -+ case 6: -+ rx_pwr_all = -48 + 2 * (2 - VGA_idx); /*VGA_idx = 2~0*/ -+ break; -+ case 5: -+ rx_pwr_all = -42 + 2 * (7 - VGA_idx); /*VGA_idx = 7~5*/ -+ break; -+ case 4: -+ rx_pwr_all = -36 + 2 * (7 - VGA_idx); /*VGA_idx = 7~4*/ -+ break; -+ case 3: -+ /*rx_pwr_all = -28 + 2*(7-VGA_idx); VGA_idx = 7~0*/ -+ rx_pwr_all = -24 + 2 * (7 - VGA_idx); /*VGA_idx = 7~0*/ -+ break; -+ case 2: -+ if (cck_highpwr) -+ rx_pwr_all = -12 + 2 * (5 - VGA_idx); /*VGA_idx = 5~0*/ -+ else -+ rx_pwr_all = -6 + 2 * (5 - VGA_idx); -+ break; -+ case 1: -+ rx_pwr_all = 8 - 2 * VGA_idx; -+ break; -+ case 0: -+ rx_pwr_all = 14 - 2 * VGA_idx; -+ break; -+ default: -+ /*DbgPrint("CCK Exception default\n");*/ -+ break; -+ } -+ rx_pwr_all += 6; -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ -+ if (cck_highpwr == FALSE) { -+ if (PWDB_ALL >= 80) -+ PWDB_ALL = ((PWDB_ALL - 80) << 1) + ((PWDB_ALL - 80) >> 1) + 80; -+ else if ((PWDB_ALL <= 78) && (PWDB_ALL >= 20)) -+ PWDB_ALL += 3; -+ if (PWDB_ALL > 100) -+ PWDB_ALL = 100; -+ } -+ } else if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8881A)) { -+ s1Byte Pout = -6; -+ -+ switch (LNA_idx) { -+ case 5: -+ rx_pwr_all = Pout - 32 - (2 * VGA_idx); -+ break; -+ case 4: -+ rx_pwr_all = Pout - 24 - (2 * VGA_idx); -+ break; -+ case 2: -+ rx_pwr_all = Pout - 11 - (2 * VGA_idx); -+ break; -+ case 1: -+ rx_pwr_all = Pout + 5 - (2 * VGA_idx); -+ break; -+ case 0: -+ rx_pwr_all = Pout + 21 - (2 * VGA_idx); -+ break; -+ } -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ } else if (pDM_Odm->SupportICType == ODM_RTL8814A || pDM_Odm->SupportICType == ODM_RTL8822B) { -+ s1Byte Pout = -6; -+ -+ switch (LNA_idx) { -+ /*CCK only use LNA: 2, 3, 5, 7*/ -+ case 7: -+ rx_pwr_all = Pout - 32 - (2 * VGA_idx); -+ break; -+ case 5: -+ rx_pwr_all = Pout - 22 - (2 * VGA_idx); -+ break; -+ case 3: -+ rx_pwr_all = Pout - 2 - (2 * VGA_idx); -+ break; -+ case 2: -+ rx_pwr_all = Pout + 5 - (2 * VGA_idx); -+ break; -+ /*case 6:*/ -+ /*rx_pwr_all = Pout -26 - (2*VGA_idx);*/ -+ /*break;*/ -+ /*case 4:*/ -+ /*rx_pwr_all = Pout - 8 - (2*VGA_idx);*/ -+ /*break;*/ -+ /*case 1:*/ -+ /*rx_pwr_all = Pout + 21 - (2*VGA_idx);*/ -+ /*break;*/ -+ /*case 0:*/ -+ /*rx_pwr_all = Pout + 10 - (2*VGA_idx);*/ -+/* // break;*/ -+ default: -+/* //DbgPrint("CCK Exception default\n");*/ -+ break; -+ } -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ } -+ -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+/* //if(pPktinfo->StationID == 0)*/ -+/* //{*/ -+/* // DbgPrint("CCK: LNA_idx = %d, VGA_idx = %d, pPhyInfo->RxPWDBAll = %d\n",*/ -+/* // LNA_idx, VGA_idx, pPhyInfo->RxPWDBAll);*/ -+/* //}*/ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+#endif -+ /*(3) Get Signal Quality (EVM)*/ -+ if (pPktinfo->bPacketMatchBSSID) { -+ u1Byte SQ, SQ_rpt; -+ -+ if ((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID == RT_CID_819x_Lenovo)) { -+ SQ = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm, isCCKrate, PWDB_ALL, 0, 0); -+ } else if (pPhyInfo->RxPWDBAll > 40 && !pDM_Odm->bInHctTest) { -+ SQ = 100; -+ } else { -+ SQ_rpt = pPhyStaRpt->pwdb_all; -+ -+ if (SQ_rpt > 64) -+ SQ = 0; -+ else if (SQ_rpt < 20) -+ SQ = 100; -+ else -+ SQ = ((64 - SQ_rpt) * 100) / 44; -+ } -+ -+/* //DbgPrint("cck SQ = %d\n", SQ);*/ -+ pPhyInfo->SignalQuality = SQ; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = SQ; -+ } -+ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { -+ if (i == 0) -+ pPhyInfo->RxMIMOSignalStrength[0] = PWDB_ALL; -+ else -+ pPhyInfo->RxMIMOSignalStrength[i] = 0; -+ } -+ } else { -+ /*is OFDM rate*/ -+ pDM_FatTable->hw_antsw_occur = pPhyStaRpt->hw_antsw_occur; -+ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; -+ -+ /*(1)Get RSSI for OFDM rate*/ -+ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { -+ /*2008/01/30 MH we will judge RF RX path now.*/ -+/* //DbgPrint("pDM_Odm->RFPathRxEnable = %x\n", pDM_Odm->RFPathRxEnable);*/ -+ if (pDM_Odm->RFPathRxEnable & BIT(i)) -+ rf_rx_num++; -+/* //else*/ -+/* //continue;*/ -+ /*2012.05.25 LukeLee: Testchip AGC report is wrong, it should be restored back to old formula in MP chip*/ -+/* //if((pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) && (!pDM_Odm->bIsMPChip))*/ -+ if (i < ODM_RF_PATH_C) -+ rx_pwr[i] = (pPhyStaRpt->gain_trsw[i] & 0x7F) - 110; -+ else -+ rx_pwr[i] = (pPhyStaRpt->gain_trsw_cd[i - 2] & 0x7F) - 110; -+/* //else*/ -+ /*rx_pwr[i] = ((pPhyStaRpt->gain_trsw[i]& 0x3F)*2) - 110; OLD FORMULA*/ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->RxPwr[i] = rx_pwr[i]; -+#endif -+ -+ /* Translate DBM to percentage. */ -+ RSSI = odm_QueryRxPwrPercentage(rx_pwr[i]); -+ -+ /*total_rssi += RSSI;*/ -+ /*Get the best two RSSI*/ -+ if (RSSI > best_rssi && RSSI > second_rssi) { -+ second_rssi = best_rssi; -+ best_rssi = RSSI; -+ } else if (RSSI > second_rssi && RSSI <= best_rssi) -+ second_rssi = RSSI; -+ -+ /*RT_DISP(FRX, RX_PHY_SS, ("RF-%d RXPWR=%x RSSI=%d\n", i, rx_pwr[i], RSSI));*/ -+ -+ pPhyInfo->RxMIMOSignalStrength[i] = (u1Byte) RSSI; -+ -+ -+ /*Get Rx snr value in DB*/ -+ if (i < ODM_RF_PATH_C) -+ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = pPhyStaRpt->rxsnr[i] / 2; -+ else if (pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B)) -+ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = pPhyStaRpt->csi_current[i - 2] / 2; -+ -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ /*(2) CFO_short & CFO_tail*/ -+ if (i < ODM_RF_PATH_C) { -+ pPhyInfo->Cfo_short[i] = odm_Cfo((pPhyStaRpt->cfosho[i])); -+ pPhyInfo->Cfo_tail[i] = odm_Cfo((pPhyStaRpt->cfotail[i])); -+ } -+#endif -+ /* Record Signal Strength for next packet */ -+ if (pPktinfo->bPacketMatchBSSID) { -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if ((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID == RT_CID_819x_Lenovo)) { -+ if (i == ODM_RF_PATH_A) -+ pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm, isCCKrate, PWDB_ALL, i, RSSI); -+ -+ } -+#endif -+ } -+ } -+ -+ /*(3)PWDB, Average PWDB calculated by hardware (for rate adaptive)*/ -+ -+ /*2012.05.25 LukeLee: Testchip AGC report is wrong, it should be restored back to old formula in MP chip*/ -+ if ((pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) && (!pDM_Odm->bIsMPChip)) -+ rx_pwr_all = (pPhyStaRpt->pwdb_all & 0x7f) - 110; -+ else -+ rx_pwr_all = (((pPhyStaRpt->pwdb_all) >> 1) & 0x7f) - 110; /*OLD FORMULA*/ -+ -+ PWDB_ALL_BT = PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("ODM OFDM RSSI=%d\n",pPhyInfo->RxPWDBAll));*/ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL_BT; -+ pPhyInfo->RxPower = rx_pwr_all; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+#endif -+ -+ if ((pDM_Odm->SupportPlatform == ODM_WIN) && (pDM_Odm->PatchID == 19)) { -+ /*do nothing*/ -+ } else { -+ /*pMgntInfo->CustomerID != RT_CID_819x_Lenovo*/ -+ -+ /*(4)EVM of OFDM rate*/ -+ -+ if ((pPktinfo->DataRate >= ODM_RATEMCS8) && -+ (pPktinfo->DataRate <= ODM_RATEMCS15)) -+ Max_spatial_stream = 2; -+ else if ((pPktinfo->DataRate >= ODM_RATEVHTSS2MCS0) && -+ (pPktinfo->DataRate <= ODM_RATEVHTSS2MCS9)) -+ Max_spatial_stream = 2; -+ else if ((pPktinfo->DataRate >= ODM_RATEMCS16) && -+ (pPktinfo->DataRate <= ODM_RATEMCS23)) -+ Max_spatial_stream = 3; -+ else if ((pPktinfo->DataRate >= ODM_RATEVHTSS3MCS0) && -+ (pPktinfo->DataRate <= ODM_RATEVHTSS3MCS9)) -+ Max_spatial_stream = 3; -+ else -+ Max_spatial_stream = 1; -+ -+ if (pPktinfo->bPacketMatchBSSID) { -+ /*DbgPrint("pPktinfo->DataRate = %d\n", pPktinfo->DataRate);*/ -+ -+ for (i = 0; i < Max_spatial_stream; i++) { -+ /*Do not use shift operation like "rx_evmX >>= 1" because the compilor of free build environment*/ -+ /*fill most significant bit to "zero" when doing shifting operation which may change a negative*/ -+ /*value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore.*/ -+ -+ if (pPktinfo->DataRate >= ODM_RATE6M && pPktinfo->DataRate <= ODM_RATE54M) { -+ if (i == ODM_RF_PATH_A) { -+ EVM = odm_EVMdbToPercentage((pPhyStaRpt->sigevm)); /*dbm*/ -+ EVM += 20; -+ if (EVM > 100) -+ EVM = 100; -+ } -+ } else { -+ if (i < ODM_RF_PATH_C) { -+ if (pPhyStaRpt->rxevm[i] == -128) -+ pPhyStaRpt->rxevm[i] = -25; -+ EVM = odm_EVMdbToPercentage((pPhyStaRpt->rxevm[i])); /*dbm*/ -+ } else { -+ if (pPhyStaRpt->rxevm_cd[i - 2] == -128){ -+ pPhyStaRpt->rxevm_cd[i - 2] = -25; -+ } -+ EVM = odm_EVMdbToPercentage((pPhyStaRpt->rxevm_cd[i - 2])); /*dbm*/ -+ } -+ } -+ -+ if (i < ODM_RF_PATH_C) -+ EVMdbm = odm_EVMdbm_JaguarSeries(pPhyStaRpt->rxevm[i]); -+ else -+ EVMdbm = odm_EVMdbm_JaguarSeries(pPhyStaRpt->rxevm_cd[i - 2]); -+ /*RT_DISP(FRX, RX_PHY_SQ, ("RXRATE=%x RXEVM=%x EVM=%s%d\n",*/ -+ /*pPktinfo->DataRate, pPhyStaRpt->rxevm[i], "%", EVM));*/ -+ -+ { -+ if (i == ODM_RF_PATH_A) { -+ /*Fill value in RFD, Get the first spatial stream only*/ -+ pPhyInfo->SignalQuality = EVM; -+ } -+ pPhyInfo->RxMIMOSignalQuality[i] = EVM; -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ pPhyInfo->RxMIMOEVMdbm[i] = EVMdbm; -+#endif -+ } -+ } -+ } -+ } -+ -+ ODM_ParsingCFO(pDM_Odm, pPktinfo, pPhyStaRpt->cfotail); -+ -+ } -+/* //DbgPrint("isCCKrate= %d, pPhyInfo->SignalStrength=%d % PWDB_AL=%d rf_rx_num=%d\n", isCCKrate, pPhyInfo->SignalStrength, PWDB_ALL, rf_rx_num);*/ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ /*UI BSS List signal strength(in percentage), make it good looking, from 0~100.*/ -+ /*It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp().*/ -+ if (isCCKrate) { -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ /*2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/*/ -+ pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, PWDB_ALL, FALSE, TRUE); -+#else -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, PWDB_ALL));/*PWDB_ALL;*/ -+#endif -+ } else { -+ if (rf_rx_num != 0) { -+ /* 2015/01 Sean, use the best two RSSI only, suggested by Ynlin and ChenYu.*/ -+ if (rf_rx_num == 1) -+ avg_rssi = best_rssi; -+ else -+ avg_rssi = (best_rssi + second_rssi)/2; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ /* 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/*/ -+ pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, avg_rssi, FALSE, FALSE); -+#else -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, avg_rssi)); -+#endif -+ } -+ } -+#endif -+ pDM_Odm->RxPWDBAve = pDM_Odm->RxPWDBAve + pPhyInfo->RxPWDBAll; -+ -+ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->antidx_anta; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->antidx_antb; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antidx_antc; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_3 = pPhyStaRpt->antidx_antd; -+ -+ -+/* DbgPrint("pPhyStaRpt->antidx_anta = %d, pPhyStaRpt->antidx_antb = %d\n",*/ -+/* pPhyStaRpt->antidx_anta, pPhyStaRpt->antidx_antb);*/ -+/* DbgPrint("----------------------------\n");*/ -+/* DbgPrint("pPktinfo->StationID=%d, pPktinfo->DataRate=0x%x\n",pPktinfo->StationID, pPktinfo->DataRate);*/ -+/* DbgPrint("pPhyStaRpt->r_RFMOD = %d\n", pPhyStaRpt->r_RFMOD);*/ -+/* DbgPrint("pPhyStaRpt->gain_trsw[0]=0x%x, pPhyStaRpt->gain_trsw[1]=0x%x\n",*/ -+/* pPhyStaRpt->gain_trsw[0],pPhyStaRpt->gain_trsw[1]);*/ -+/* DbgPrint("pPhyStaRpt->gain_trsw[2]=0x%x, pPhyStaRpt->gain_trsw[3]=0x%x\n",*/ -+/* pPhyStaRpt->gain_trsw_cd[0],pPhyStaRpt->gain_trsw_cd[1]);*/ -+/* DbgPrint("pPhyStaRpt->pwdb_all = 0x%x, pPhyInfo->RxPWDBAll = %d\n", pPhyStaRpt->pwdb_all, pPhyInfo->RxPWDBAll);*/ -+/* DbgPrint("pPhyStaRpt->cfotail[i] = 0x%x, pPhyStaRpt->CFO_tail[i] = 0x%x\n", pPhyStaRpt->cfotail[0], pPhyStaRpt->cfotail[1]);*/ -+/* DbgPrint("pPhyStaRpt->rxevm[0] = %d, pPhyStaRpt->rxevm[1] = %d\n", pPhyStaRpt->rxevm[0], pPhyStaRpt->rxevm[1]);*/ -+/* DbgPrint("pPhyStaRpt->rxevm[2] = %d, pPhyStaRpt->rxevm[3] = %d\n", pPhyStaRpt->rxevm_cd[0], pPhyStaRpt->rxevm_cd[1]);*/ -+/* DbgPrint("pPhyInfo->RxMIMOSignalStrength[0]=%d, pPhyInfo->RxMIMOSignalStrength[1]=%d, RxPWDBAll=%d\n",*/ -+/* pPhyInfo->RxMIMOSignalStrength[0], pPhyInfo->RxMIMOSignalStrength[1], pPhyInfo->RxPWDBAll);*/ -+/* DbgPrint("pPhyInfo->RxMIMOSignalStrength[2]=%d, pPhyInfo->RxMIMOSignalStrength[3]=%d\n",*/ -+/* pPhyInfo->RxMIMOSignalStrength[2], pPhyInfo->RxMIMOSignalStrength[3]);*/ -+/* DbgPrint("ppPhyInfo->RxMIMOSignalQuality[0]=%d, pPhyInfo->RxMIMOSignalQuality[1]=%d\n",*/ -+/* pPhyInfo->RxMIMOSignalQuality[0], pPhyInfo->RxMIMOSignalQuality[1]);*/ -+/* DbgPrint("ppPhyInfo->RxMIMOSignalQuality[2]=%d, pPhyInfo->RxMIMOSignalQuality[3]=%d\n",*/ -+/* pPhyInfo->RxMIMOSignalQuality[2], pPhyInfo->RxMIMOSignalQuality[3]);*/ -+ -+} -+ -+#endif -+ -+VOID -+odm_Init_RSSIForDM( -+ IN OUT PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+} -+ -+VOID -+odm_Process_RSSIForDM( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN PODM_PHY_INFO_T pPhyInfo, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ -+ s4Byte UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK, UndecoratedSmoothedOFDM, RSSI_Ave; -+ u1Byte i, isCCKrate=0; -+ u1Byte RSSI_max, RSSI_min; -+ u4Byte OFDM_pkt=0; -+ u4Byte Weighting=0; -+ PSTA_INFO_T pEntry; -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ #endif -+ -+ if (pPktinfo->StationID >= ODM_ASSOCIATE_ENTRY_NUM) -+ return; -+ -+#if (RTL8723B_SUPPORT == 1)||(RTL8821A_SUPPORT == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ odm_S0S1_SwAntDivByCtrlFrame_ProcessRSSI(pDM_Odm, pPhyInfo, pPktinfo); -+#endif -+#endif -+ -+ // -+ // 2012/05/30 MH/Luke.Lee Add some description -+ // In windows driver: AP/IBSS mode STA -+ // -+ //if (pDM_Odm->SupportPlatform == ODM_WIN) -+ //{ -+ // pEntry = pDM_Odm->pODM_StaInfo[pDM_Odm->pAidMap[pPktinfo->StationID-1]]; -+ //} -+ //else -+ pEntry = pDM_Odm->pODM_StaInfo[pPktinfo->StationID]; -+ -+ if(!IS_STA_VALID(pEntry) ) -+ { -+ return; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ if ((pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) && -+ (pDM_FatTable->enable_ctrl_frame_antdiv) -+ ) -+ { -+ if (pPktinfo->bPacketMatchBSSID) -+ pDM_Odm->data_frame_num++; -+ -+ if ((pDM_FatTable->use_ctrl_frame_antdiv)) { -+ if (!pPktinfo->bToSelf)/*data frame + CTRL frame*/ -+ return; -+ } else { -+ if ((!pPktinfo->bPacketMatchBSSID))/*data frame only*/ -+ return; -+ } -+ } else -+#endif -+ { -+ if ((!pPktinfo->bPacketMatchBSSID))/*data frame only*/ -+ return; -+ } -+ -+ if(pPktinfo->bPacketBeacon) -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt++; -+ -+ isCCKrate = (pPktinfo->DataRate <= ODM_RATE11M )?TRUE :FALSE; -+ pDM_Odm->RxRate = pPktinfo->DataRate; -+ -+ //--------------Statistic for antenna/path diversity------------------ -+ if(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) -+ { -+ #if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ ODM_Process_RSSIForAntDiv(pDM_Odm,pPhyInfo,pPktinfo); -+ #endif -+ } -+ #if(defined(CONFIG_PATH_DIVERSITY)) -+ else if(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV) -+ { -+ phydm_process_rssi_for_path_div(pDM_Odm,pPhyInfo,pPktinfo); -+ } -+ #endif -+ //-----------------Smart Antenna Debug Message------------------// -+ -+ UndecoratedSmoothedCCK = pEntry->rssi_stat.UndecoratedSmoothedCCK; -+ UndecoratedSmoothedOFDM = pEntry->rssi_stat.UndecoratedSmoothedOFDM; -+ UndecoratedSmoothedPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ if(pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon) -+ { -+ -+ if(!isCCKrate)//ofdm rate -+ { -+#if (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B)) { -+ u1Byte RX_count = 0; -+ u4Byte RSSI_linear = 0; -+ -+ if (pDM_Odm->RXAntStatus & ODM_RF_A) { -+ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ RX_count++; -+ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]); -+ } else -+ pDM_Odm->RSSI_A = 0; -+ -+ if (pDM_Odm->RXAntStatus & ODM_RF_B) { -+ pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ RX_count++; -+ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]); -+ } else -+ pDM_Odm->RSSI_B = 0; -+ -+ if (pDM_Odm->RXAntStatus & ODM_RF_C) { -+ pDM_Odm->RSSI_C = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_C]; -+ RX_count++; -+ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_C]); -+ } else -+ pDM_Odm->RSSI_C = 0; -+ -+ if (pDM_Odm->RXAntStatus & ODM_RF_D) { -+ pDM_Odm->RSSI_D = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_D]; -+ RX_count++; -+ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_D]); -+ } else -+ pDM_Odm->RSSI_D = 0; -+ -+ /* Calculate average RSSI */ -+ switch (RX_count) { -+ case 2: -+ RSSI_linear = (RSSI_linear >> 1); -+ break; -+ case 3: -+ RSSI_linear = ((RSSI_linear) + (RSSI_linear << 1) + (RSSI_linear << 3)) >> 5; /* RSSI_linear/3 ~ RSSI_linear*11/32 */ -+ break; -+ case 4: -+ RSSI_linear = (RSSI_linear >> 2); -+ break; -+ } -+ RSSI_Ave = odm_ConvertTo_dB(RSSI_linear); -+ } else -+#endif -+ { -+ if (pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B] == 0) { -+ RSSI_Ave = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_B = 0; -+ } else { -+ /*DbgPrint("pRfd->Status.RxMIMOSignalStrength[0] = %d, pRfd->Status.RxMIMOSignalStrength[1] = %d\n",*/ -+ /*pRfd->Status.RxMIMOSignalStrength[0], pRfd->Status.RxMIMOSignalStrength[1]);*/ -+ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ -+ if (pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A] > pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]) { -+ RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ } else { -+ RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ } -+ if ((RSSI_max - RSSI_min) < 3) -+ RSSI_Ave = RSSI_max; -+ else if ((RSSI_max - RSSI_min) < 6) -+ RSSI_Ave = RSSI_max - 1; -+ else if ((RSSI_max - RSSI_min) < 10) -+ RSSI_Ave = RSSI_max - 2; -+ else -+ RSSI_Ave = RSSI_max - 3; -+ } -+ } -+ -+ //1 Process OFDM RSSI -+ if(UndecoratedSmoothedOFDM <= 0) // initialize -+ { -+ UndecoratedSmoothedOFDM = pPhyInfo->RxPWDBAll; -+ } -+ else -+ { -+ if(pPhyInfo->RxPWDBAll > (u4Byte)UndecoratedSmoothedOFDM) -+ { -+ UndecoratedSmoothedOFDM = -+ ( ((UndecoratedSmoothedOFDM)*(Rx_Smooth_Factor-1)) + -+ (RSSI_Ave)) /(Rx_Smooth_Factor); -+ UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM + 1; -+ } -+ else -+ { -+ UndecoratedSmoothedOFDM = -+ ( ((UndecoratedSmoothedOFDM)*(Rx_Smooth_Factor-1)) + -+ (RSSI_Ave)) /(Rx_Smooth_Factor); -+ } -+ } -+ if (pEntry->rssi_stat.OFDM_pkt != 64) { -+ i = 63; -+ pEntry->rssi_stat.OFDM_pkt -= (u4Byte)(((pEntry->rssi_stat.PacketMap>>i)&BIT0)-1); -+ } -+ pEntry->rssi_stat.PacketMap = (pEntry->rssi_stat.PacketMap<<1) | BIT0; -+ -+ } -+ else -+ { -+ RSSI_Ave = pPhyInfo->RxPWDBAll; -+ pDM_Odm->RSSI_A = (u1Byte) pPhyInfo->RxPWDBAll; -+ pDM_Odm->RSSI_B = 0xFF; -+ pDM_Odm->RSSI_C = 0xFF; -+ pDM_Odm->RSSI_D = 0xFF; -+ -+ //1 Process CCK RSSI -+ if(UndecoratedSmoothedCCK <= 0) // initialize -+ { -+ UndecoratedSmoothedCCK = pPhyInfo->RxPWDBAll; -+ } -+ else -+ { -+ if(pPhyInfo->RxPWDBAll > (u4Byte)UndecoratedSmoothedCCK) -+ { -+ UndecoratedSmoothedCCK = -+ ( ((UndecoratedSmoothedCCK)*(Rx_Smooth_Factor-1)) + -+ (pPhyInfo->RxPWDBAll)) /(Rx_Smooth_Factor); -+ UndecoratedSmoothedCCK = UndecoratedSmoothedCCK + 1; -+ } -+ else -+ { -+ UndecoratedSmoothedCCK = -+ ( ((UndecoratedSmoothedCCK)*(Rx_Smooth_Factor-1)) + -+ (pPhyInfo->RxPWDBAll)) /(Rx_Smooth_Factor); -+ } -+ } -+ i = 63; -+ pEntry->rssi_stat.OFDM_pkt -= (u4Byte)((pEntry->rssi_stat.PacketMap>>i)&BIT0); -+ pEntry->rssi_stat.PacketMap = pEntry->rssi_stat.PacketMap<<1; -+ } -+ -+ //if(pEntry) -+ { -+ //2011.07.28 LukeLee: modified to prevent unstable CCK RSSI -+ if (pEntry->rssi_stat.OFDM_pkt == 64) { /* speed up when all packets are OFDM*/ -+ UndecoratedSmoothedPWDB = UndecoratedSmoothedOFDM; -+ } else { -+ if (pEntry->rssi_stat.ValidBit < 64) -+ pEntry->rssi_stat.ValidBit++; -+ -+ if (pEntry->rssi_stat.ValidBit == 64) { -+ Weighting = ((pEntry->rssi_stat.OFDM_pkt<<4) > 64)?64:(pEntry->rssi_stat.OFDM_pkt<<4); -+ UndecoratedSmoothedPWDB = (Weighting*UndecoratedSmoothedOFDM+(64-Weighting)*UndecoratedSmoothedCCK)>>6; -+ } else { -+ if (pEntry->rssi_stat.ValidBit != 0) -+ UndecoratedSmoothedPWDB = (pEntry->rssi_stat.OFDM_pkt*UndecoratedSmoothedOFDM+(pEntry->rssi_stat.ValidBit-pEntry->rssi_stat.OFDM_pkt)*UndecoratedSmoothedCCK)/pEntry->rssi_stat.ValidBit; -+ else -+ UndecoratedSmoothedPWDB = 0; -+ } -+ } -+ -+ pEntry->rssi_stat.UndecoratedSmoothedCCK = UndecoratedSmoothedCCK; -+ pEntry->rssi_stat.UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM; -+ pEntry->rssi_stat.UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; -+ -+ //DbgPrint("OFDM_pkt=%d, Weighting=%d\n", OFDM_pkt, Weighting); -+ //DbgPrint("UndecoratedSmoothedOFDM=%d, UndecoratedSmoothedPWDB=%d, UndecoratedSmoothedCCK=%d\n", -+ // UndecoratedSmoothedOFDM, UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK); -+ -+ } -+ -+ } -+} -+ -+ -+#if(ODM_IC_11N_SERIES_SUPPORT ==1) -+// -+// Endianness before calling this API -+// -+VOID -+ODM_PhyStatusQuery_92CSeries( -+ IN OUT PDM_ODM_T pDM_Odm, -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ -+ odm_RxPhyStatus92CSeries_Parsing( -+ pDM_Odm, -+ pPhyInfo, -+ pPhyStatus, -+ pPktinfo); -+ -+ if( pDM_Odm->RSSI_test == TRUE) -+ { -+ // Select the packets to do RSSI checking for antenna switching. -+ if(pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon ) -+ { -+ /* -+ #if 0//(DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ dm_SWAW_RSSI_Check( -+ Adapter, -+ (tmppAdapter!=NULL)?(tmppAdapter==Adapter):TRUE, -+ bPacketMatchBSSID, -+ pEntry, -+ pRfd); -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ // Select the packets to do RSSI checking for antenna switching. -+ //odm_SwAntDivRSSICheck8192C(padapter, precvframe->u.hdr.attrib.RxPWDBAll); -+ #endif -+ */ -+#if (RTL8192C_SUPPORT == 1) -+ ODM_SwAntDivChkPerPktRssi(pDM_Odm,pPktinfo->StationID,pPhyInfo); -+#endif -+ } -+ } -+ else -+ { -+ odm_Process_RSSIForDM(pDM_Odm,pPhyInfo,pPktinfo); -+ } -+ -+} -+#endif -+ -+ -+// -+// Endianness before calling this API -+// -+#if ODM_IC_11AC_SERIES_SUPPORT -+ -+VOID -+ODM_PhyStatusQuery_JaguarSeries( -+ IN OUT PDM_ODM_T pDM_Odm, -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ odm_RxPhyStatusJaguarSeries_Parsing( -+ pDM_Odm, -+ pPhyInfo, -+ pPhyStatus, -+ pPktinfo); -+ -+ odm_Process_RSSIForDM(pDM_Odm,pPhyInfo,pPktinfo); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ //phydm_sbd_check(pDM_Odm); -+#endif -+} -+#endif -+ -+VOID -+ODM_PhyStatusQuery( -+ IN OUT PDM_ODM_T pDM_Odm, -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) { -+ phydm_RxPhyStatusJaguarSeries2(pDM_Odm, pPhyStatus, pPktinfo, pPhyInfo); -+ return; -+ } -+#endif -+ -+#if ODM_IC_11AC_SERIES_SUPPORT -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ ODM_PhyStatusQuery_JaguarSeries(pDM_Odm, pPhyInfo, pPhyStatus, pPktinfo); -+#endif -+ -+#if ODM_IC_11N_SERIES_SUPPORT -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES ) -+ ODM_PhyStatusQuery_92CSeries(pDM_Odm,pPhyInfo,pPhyStatus,pPktinfo); -+#endif -+} -+ -+// For future use. -+VOID ODM_MacStatusQuery( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN pu1Byte pMacStatus, -+ IN u1Byte MacID, -+ IN BOOLEAN bPacketMatchBSSID, -+ IN BOOLEAN bPacketToSelf, -+ IN BOOLEAN bPacketBeacon -+ ) -+{ -+ // 2011/10/19 Driver team will handle in the future. -+ -+} -+ -+ -+// -+// If you want to add a new IC, Please follow below template and generate a new one. -+// -+// -+ -+HAL_STATUS -+ODM_ConfigRFWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_Config_Type ConfigType, -+ IN ODM_RF_RADIO_PATH_E eRFPath -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("===>ODM_ConfigRFWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); -+ -+//1 AP doesn't use PHYDM power tracking table in these ICs -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if (RTL8723A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723A) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8723A,_RadioA); -+ } -+ } -+#endif -+#if (RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A){ -+ READ_AND_CONFIG_MP(8812A,_RadioA); -+ } -+ else if(eRFPath == ODM_RF_PATH_B){ -+ READ_AND_CONFIG_MP(8812A,_RadioB); -+ } -+ } -+ else if(ConfigType == CONFIG_RF_TXPWR_LMT) { -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) && (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ if ((pHalData->EEPROMSVID == 0x17AA && pHalData->EEPROMSMID == 0xA811) || -+ (pHalData->EEPROMSVID == 0x10EC && pHalData->EEPROMSMID == 0xA812) || -+ (pHalData->EEPROMSVID == 0x10EC && pHalData->EEPROMSMID == 0x8812)) -+ READ_AND_CONFIG_MP(8812A,_TXPWR_LMT_HM812A03); -+ else -+ #endif -+ READ_AND_CONFIG_MP(8812A,_TXPWR_LMT); -+ } -+ } -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A){ -+ READ_AND_CONFIG_MP(8821A,_RadioA); -+ } -+ } -+ else if(ConfigType == CONFIG_RF_TXPWR_LMT) { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { -+ if (pDM_Odm->ExtPA5G || pDM_Odm->ExtLNA5G) -+ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8811AU_FEM); -+ else -+ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8811AU_IPA); -+ } -+ else { -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (pMgntInfo->CustomerID == RT_CID_8821AE_ASUS_MB) -+ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8821A_SAR_8mm); -+ else if (pMgntInfo->CustomerID == RT_CID_ASUS_NB) -+ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8821A_SAR_5mm); -+ else -+ #endif -+ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8821A); -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigRFWithHeaderFile\n")); -+ } -+#endif -+ -+#if (RTL8723B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) -+ READ_AND_CONFIG_MP(8723B,_RadioA); -+ else if(ConfigType == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8723B,_TXPWR_LMT); -+ } -+#endif -+ -+#if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8192E,_RadioA); -+ else if(eRFPath == ODM_RF_PATH_B) -+ READ_AND_CONFIG_MP(8192E,_RadioB); -+ } else if (ConfigType == CONFIG_RF_TXPWR_LMT) { -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) && (DEV_BUS_TYPE == RT_PCI_INTERFACE) /*Refine by Vincent Lan for 5mm SAR pwr limit*/ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if ((pHalData->EEPROMSVID == 0x11AD && pHalData->EEPROMSMID == 0x8192) || -+ (pHalData->EEPROMSVID == 0x11AD && pHalData->EEPROMSMID == 0x8193)) -+ READ_AND_CONFIG_MP(8192E, _TXPWR_LMT_8192E_SAR_5mm); -+ else -+#endif -+ READ_AND_CONFIG_MP(8192E,_TXPWR_LMT); -+ } -+ } -+#endif -+#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+//1 All platforms support -+#if (RTL8188E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8188E,_RadioA); -+ } -+ else if(ConfigType == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8188E,_TXPWR_LMT); -+ } -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8814A,_RadioA); -+ else if(eRFPath == ODM_RF_PATH_B) -+ READ_AND_CONFIG_MP(8814A,_RadioB); -+ else if(eRFPath == ODM_RF_PATH_C) -+ READ_AND_CONFIG_MP(8814A,_RadioC); -+ else if(eRFPath == ODM_RF_PATH_D) -+ READ_AND_CONFIG_MP(8814A,_RadioD); -+ } -+ else if(ConfigType == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8814A,_TXPWR_LMT); -+ } -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) { -+ if (ConfigType == CONFIG_RF_RADIO) { -+ if (eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8703B, _RadioA); -+ } -+ } -+#endif -+ -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ if (ConfigType == CONFIG_RF_RADIO) { -+ if (eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8188F, _RadioA); -+ } else if (ConfigType == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8188F, _TXPWR_LMT); -+ } -+#endif -+ -+//1 New ICs (WIN only) -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if (RTL8821B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821B) -+ { -+ if (ConfigType == CONFIG_RF_RADIO) { -+ if (eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG(8821B, _RadioA); -+ } else if (ConfigType == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG(8821B, _TXPWR_LMT); -+ } -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8822B, _RadioA); -+ else if(eRFPath == ODM_RF_PATH_B) -+ READ_AND_CONFIG_MP(8822B, _RadioB); -+ } -+ } -+#endif -+#if ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_TC(8188F,_RadioA); -+ } -+ } -+#endif -+#endif -+#endif//(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS -+ODM_ConfigRFWithTxPwrTrackHeaderFile( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("===>ODM_ConfigRFWithTxPwrTrackHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); -+ -+ -+//1 AP doesn't use PHYDM power tracking table in these ICs -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if RTL8821A_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8821A,_TxPowerTrack_PCIE); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8821A,_TxPowerTrack_USB); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8821A,_TxPowerTrack_SDIO); -+ } -+#endif -+#if RTL8812A_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8812A,_TxPowerTrack_PCIE); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { -+ if (pDM_Odm->RFEType == 3 && pDM_Odm->bIsMPChip) -+ READ_AND_CONFIG_MP(8812A,_TxPowerTrack_RFE3); -+ else -+ READ_AND_CONFIG_MP(8812A,_TxPowerTrack_USB); -+ } -+ -+ } -+#endif -+#if RTL8192E_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8192E,_TxPowerTrack_PCIE); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8192E,_TxPowerTrack_USB); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8192E,_TxPowerTrack_SDIO); -+ } -+#endif -+#if RTL8723B_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8723B,_TxPowerTrack_PCIE); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8723B,_TxPowerTrack_USB); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8723B,_TxPowerTrack_SDIO); -+ } -+#endif -+#if RTL8188E_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8188E,_TxPowerTrack_PCIE); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8188E,_TxPowerTrack_USB); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8188E,_TxPowerTrack_SDIO); -+ } -+#endif -+#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+//1 All platforms support -+#if RTL8814A_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ if(pDM_Odm->RFEType == 0) -+ READ_AND_CONFIG_MP(8814A,_TxPowerTrack_Type0); -+ else if(pDM_Odm->RFEType == 2) -+ READ_AND_CONFIG_MP(8814A,_TxPowerTrack_Type2); -+ else if (pDM_Odm->RFEType == 5) -+ READ_AND_CONFIG_MP(8814A, _TxPowerTrack_Type5); -+ else -+ READ_AND_CONFIG_MP(8814A,_TxPowerTrack); -+ } -+#endif -+#if RTL8703B_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8703B, _TxPowerTrack_USB); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8703B, _TxPowerTrack_SDIO); -+ } -+#endif -+ -+#if RTL8188F_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8188F, _TxPowerTrack_USB); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8188F, _TxPowerTrack_SDIO); -+ } -+#endif -+ -+//1 New ICs (WIN only) -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if RTL8821B_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8821B) -+ READ_AND_CONFIG(8821B,_TxPowerTrack); -+#endif -+#if RTL8822B_SUPPORT -+/* if(pDM_Odm->SupportICType == ODM_RTL8822B) -+ READ_AND_CONFIG_MP(8822B, _TxPowerTrack); */ -+#endif -+ -+#if ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+#if RTL8188F_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8188F) -+ READ_AND_CONFIG_TC(8188F,_TxPowerTrack_PCIE); -+#endif -+#endif -+#endif//(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS -+ODM_ConfigBBWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_BB_Config_Type ConfigType -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+#endif -+ -+//1 AP doesn't use PHYDM initialization in these ICs -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if (RTL8723A_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8723A) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG){ -+ READ_AND_CONFIG_MP(8723A,_PHY_REG); -+ }else if(ConfigType == CONFIG_BB_AGC_TAB){ -+ READ_AND_CONFIG_MP(8723A,_AGC_TAB); -+ } -+ } -+#endif -+#if (RTL8812A_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG){ -+ READ_AND_CONFIG_MP(8812A,_PHY_REG); -+ }else if(ConfigType == CONFIG_BB_AGC_TAB){ -+ READ_AND_CONFIG_MP(8812A,_AGC_TAB); -+ } -+ else if(ConfigType == CONFIG_BB_PHY_REG_PG) -+ { -+ if (pDM_Odm->RFEType == 3 && pDM_Odm->bIsMPChip) -+ READ_AND_CONFIG_MP(8812A,_PHY_REG_PG_ASUS); -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ else if (pMgntInfo->CustomerID == RT_CID_WNC_NEC && pDM_Odm->bIsMPChip) -+ READ_AND_CONFIG_MP(8812A,_PHY_REG_PG_NEC); -+ #endif -+ else -+ READ_AND_CONFIG_MP(8812A,_PHY_REG_PG); -+ } -+ else if(ConfigType == CONFIG_BB_PHY_REG_MP){ -+ READ_AND_CONFIG_MP(8812A,_PHY_REG_MP); -+ } -+ else if(ConfigType == CONFIG_BB_AGC_TAB_DIFF) -+ { -+ if ((36 <= *pDM_Odm->pChannel) && (*pDM_Odm->pChannel <= 64)) -+ AGC_DIFF_CONFIG_MP(8812A,LB); -+ else if (100 <= *pDM_Odm->pChannel) -+ AGC_DIFF_CONFIG_MP(8812A,HB); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8812AGCTABArray\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8812PHY_REGArray\n")); -+ } -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG){ -+ READ_AND_CONFIG_MP(8821A,_PHY_REG); -+ }else if(ConfigType == CONFIG_BB_AGC_TAB){ -+ READ_AND_CONFIG_MP(8821A,_AGC_TAB); -+ }else if(ConfigType == CONFIG_BB_PHY_REG_PG){ -+ READ_AND_CONFIG_MP(8821A,_PHY_REG_PG); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8821AGCTABArray\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8821PHY_REGArray\n")); -+ } -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG){ -+ READ_AND_CONFIG_MP(8723B,_PHY_REG); -+ }else if(ConfigType == CONFIG_BB_AGC_TAB){ -+ READ_AND_CONFIG_MP(8723B,_AGC_TAB); -+ }else if(ConfigType == CONFIG_BB_PHY_REG_PG){ -+ READ_AND_CONFIG_MP(8723B,_PHY_REG_PG); -+ } -+ } -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG){ -+ READ_AND_CONFIG_MP(8192E,_PHY_REG); -+ }else if(ConfigType == CONFIG_BB_AGC_TAB){ -+ READ_AND_CONFIG_MP(8192E,_AGC_TAB); -+ }else if(ConfigType == CONFIG_BB_PHY_REG_PG){ -+ READ_AND_CONFIG_MP(8192E,_PHY_REG_PG); -+ } -+ } -+#endif -+#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+ -+//1 All platforms support -+#if (RTL8188E_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8188E,_PHY_REG); -+ else if(ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8188E,_AGC_TAB); -+ else if(ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8188E,_PHY_REG_PG); -+ } -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG){ -+ READ_AND_CONFIG_MP(8814A,_PHY_REG); -+ }else if(ConfigType == CONFIG_BB_AGC_TAB){ -+ READ_AND_CONFIG_MP(8814A,_AGC_TAB); -+ }else if(ConfigType == CONFIG_BB_PHY_REG_PG){ -+ READ_AND_CONFIG_MP(8814A,_PHY_REG_PG); -+ }else if(ConfigType == CONFIG_BB_PHY_REG_MP){ -+ READ_AND_CONFIG_MP(8814A,_PHY_REG_MP); -+ } -+ } -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) { -+ if (ConfigType == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8703B, _PHY_REG); -+ else if (ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8703B, _AGC_TAB); -+ else if (ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8703B, _PHY_REG_PG); -+ } -+#endif -+ -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ if (ConfigType == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8188F, _PHY_REG); -+ else if (ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8188F, _AGC_TAB); -+ else if (ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8188F, _PHY_REG_PG); -+ } -+#endif -+ -+//1 New ICs (WIN only) -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if (RTL8821B_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8821B) -+ { -+ if (ConfigType == CONFIG_BB_PHY_REG) { -+ READ_AND_CONFIG(8821B,_PHY_REG); -+ } else if (ConfigType == CONFIG_BB_AGC_TAB) { -+ READ_AND_CONFIG(8821B,_AGC_TAB); -+ } else if (ConfigType == CONFIG_BB_PHY_REG_PG) { -+ READ_AND_CONFIG(8821B,_PHY_REG_PG); -+ } -+ } -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8822B) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8822B, _PHY_REG); -+ else if(ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8822B, _AGC_TAB); -+/* else if(ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8822B, _PHY_REG_PG); -+ else if(ConfigType == CONFIG_BB_PHY_REG_MP) -+ READ_AND_CONFIG_MP(8822B, _PHY_REG_MP); */ -+ } -+#endif -+#if ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+#if (RTL8188F_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8188F) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_TC(8188F,_PHY_REG); -+ else if(ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_TC(8188F,_AGC_TAB); -+ else if(ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_TC(8188F,_PHY_REG_PG); -+ } -+#endif -+#endif -+#if (RTL8195A_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8195A) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG(8195A,_PHY_REG); -+ else if(ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG(8195A,_AGC_TAB); -+ else if(ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG(8195A,_PHY_REG_PG); -+ } -+#endif -+#endif//(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS -+ODM_ConfigMACWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("===>ODM_ConfigMACWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); -+ -+//1 AP doesn't use PHYDM initialization in these ICs -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if (RTL8723A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723A){ -+ READ_AND_CONFIG_MP(8723A,_MAC_REG); -+ } -+#endif -+#if (RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8812){ -+ READ_AND_CONFIG_MP(8812A,_MAC_REG); -+ } -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821){ -+ READ_AND_CONFIG_MP(8821A,_MAC_REG); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigMACwithHeaderFile\n")); -+ } -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723B){ -+ READ_AND_CONFIG_MP(8723B,_MAC_REG); -+ } -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8192E){ -+ READ_AND_CONFIG_MP(8192E,_MAC_REG); -+ } -+#endif -+#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+//1 All platforms support -+#if (RTL8188E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E){ -+ READ_AND_CONFIG_MP(8188E,_MAC_REG); -+ } -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8814A){ -+ READ_AND_CONFIG_MP(8814A,_MAC_REG); -+ } -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) -+ READ_AND_CONFIG_MP(8703B, _MAC_REG); -+#endif -+ -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) -+ READ_AND_CONFIG_MP(8188F, _MAC_REG); -+#endif -+ -+//1 New ICs (WIN only) -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if (RTL8821B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821B){ -+ READ_AND_CONFIG(8821B,_MAC_REG); -+ } -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) -+ READ_AND_CONFIG_MP(8822B, _MAC_REG); -+#endif -+ -+#if ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) -+ READ_AND_CONFIG_TC(8188F,_MAC_REG); -+#endif -+#endif -+#if (RTL8195A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8195A) -+ READ_AND_CONFIG_MP(8195A,_MAC_REG); -+#endif -+#endif /*#if (DM_ODM_SUPPORT_TYPE & ODM_WIN)*/ -+ -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS -+ODM_ConfigFWWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_FW_Config_Type ConfigType, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pSize -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+#if (RTL8188E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ #ifdef CONFIG_SFW_SUPPORTED -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8188E_T,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8188E_T,_FW_WoWLAN); -+ else if(ConfigType == CONFIG_FW_NIC_2) -+ READ_FIRMWARE_MP(8188E_S,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN_2) -+ READ_FIRMWARE_MP(8188E_S,_FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ if (ConfigType == CONFIG_FW_AP) -+ READ_FIRMWARE_MP(8188E_T,_FW_AP); -+ else if (ConfigType == CONFIG_FW_AP_2) -+ READ_FIRMWARE_MP(8188E_S,_FW_AP); -+ #endif //CONFIG_AP_WOWLAN -+ #else -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8188E_T,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8188E_T,_FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP) -+ READ_FIRMWARE_MP(8188E_T,_FW_AP); -+ #endif //CONFIG_AP_WOWLAN -+ #endif -+ } -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8723B,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8723B,_FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE(8723B,_FW_AP_WoWLAN); -+ #endif -+ -+ } -+#endif //#if (RTL8723B_SUPPORT == 1) -+#if (RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8812A,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8812A,_FW_WoWLAN); -+ else if (ConfigType == CONFIG_FW_BT) -+ READ_FIRMWARE_MP(8812A,_FW_NIC_BT); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE(8812A,_FW_AP); -+ #endif -+ } -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821){ -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8821A,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8821A,_FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE_MP(8821A , _FW_AP); -+ #endif /*CONFIG_AP_WOWLAN*/ -+ else if (ConfigType == CONFIG_FW_BT) -+ READ_FIRMWARE_MP(8821A,_FW_NIC_BT); -+ } -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8192E,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8192E,_FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE_MP(8192E,_FW_AP); -+ #endif -+ } -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8814A,_FW_NIC); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE_MP(8814A,_FW_AP); -+ #endif -+ } -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8703B, _FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8703B, _FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE(8703B, _FW_AP_WoWLAN); -+ #endif -+ } -+#endif -+ -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8188F, _FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8188F, _FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP) -+ READ_FIRMWARE_MP(8188F,_FW_AP); -+ #endif -+ } -+#endif -+ -+//1 New ICs (WIN only) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if (RTL8821B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821B) -+ { -+ } -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) -+ { -+ /* -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8822B,_FW_NIC); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE(8822B,_FW_AP); -+ #endif */ -+ } -+#endif -+#if ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) -+ { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8188F,_FW_NIC); -+ } -+#endif -+#endif -+#endif//(DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) -+ return HAL_STATUS_SUCCESS; -+} -+ -+u4Byte -+ODM_GetHWImgVersion( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte Version=0; -+ -+//1 AP doesn't use PHYDM initialization in these ICs -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if (RTL8723A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723A) -+ Version = GET_VERSION_MP(8723A,_MAC_REG); -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) -+ Version = GET_VERSION_MP(8723B,_MAC_REG); -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821) -+ Version = GET_VERSION_MP(8821A,_MAC_REG); -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8192E) -+ Version = GET_VERSION_MP(8192E,_MAC_REG); -+#endif -+#if (RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ Version = GET_VERSION_MP(8812A,_MAC_REG); -+#endif -+#endif //(DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+/*1 All platforms support*/ -+#if (RTL8188E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ Version = GET_VERSION_MP(8188E,_MAC_REG); -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ Version = GET_VERSION_MP(8814A,_MAC_REG); -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) -+ Version = GET_VERSION_MP(8703B, _MAC_REG); -+#endif -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) -+ Version = GET_VERSION_MP(8188F, _MAC_REG); -+#endif -+ -+//1 New ICs (WIN only) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if (RTL8821B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821B) -+ Version = GET_VERSION(8821B,_MAC_REG); -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) -+ Version = GET_VERSION(8822B, _MAC_REG); -+#endif -+#if ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) -+ Version = GET_VERSION_TC(8188F, _MAC_REG); -+#endif -+#endif -+#endif //(DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ return Version; -+} -+ -+#if (RTL8822B_SUPPORT == 1) -+/* For 8822B only!! need to move to FW finally */ -+/*==============================================*/ -+ -+VOID -+phydm_ResetPhyInfo( -+ IN PDM_ODM_T pPhydm, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+ pPhyInfo->RxPWDBAll = 0; -+ pPhyInfo->SignalQuality = 0; -+ pPhyInfo->BandWidth = 0; -+#if (RTL8822B_SUPPORT == 1) -+ pPhyInfo->RxCount = 0; -+#endif -+ ODM_Memory_Set(pPhydm, pPhyInfo->RxMIMOSignalQuality, 0 , 4); -+ ODM_Memory_Set(pPhydm, pPhyInfo->RxMIMOSignalStrength, 0, 4); -+ ODM_Memory_Set(pPhydm, pPhyInfo->RxSNR, 0, 4); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->RxPower = -110; -+ pPhyInfo->RecvSignalPower = -110; -+ pPhyInfo->BTRxRSSIPercentage = 0; -+ pPhyInfo->SignalStrength = 0; -+ pPhyInfo->btCoexPwrAdjust = 0; -+#if (RTL8822B_SUPPORT == 1) -+ pPhyInfo->channel = 0; -+ pPhyInfo->bMuPacket = 0; -+ pPhyInfo->bBeamformed = 0; -+ pPhyInfo->rxsc = 0; -+#endif -+ ODM_Memory_Set(pPhydm, pPhyInfo->RxPwr, -110, 4); -+ ODM_Memory_Set(pPhydm, pPhyInfo->RxMIMOEVMdbm, 0, 4); -+ ODM_Memory_Set(pPhydm, pPhyInfo->Cfo_short, 0, 8); -+ ODM_Memory_Set(pPhydm, pPhyInfo->Cfo_tail, 0, 8); -+#endif -+} -+ -+VOID -+phydm_SetPerPathPhyInfo( -+ IN u1Byte RxPath, -+ IN s1Byte RxPwr, -+ IN s1Byte RxEVM, -+ IN s1Byte Cfo_tail, -+ IN s1Byte RxSNR, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+ u1Byte EVMdBm = 0; -+ u1Byte EVMPercentage = 0; -+ -+ /* SNR is S(8,1), EVM is S(8,1), CFO is S(8,7) */ -+ -+ if (RxEVM < 0) { -+ /* Calculate EVM in dBm */ -+ EVMdBm = ((u1Byte)(0 - RxEVM) >> 1); -+ -+ /* Calculate EVM in percentage */ -+ if (EVMdBm >= 33) -+ EVMPercentage = 100; -+ else -+ EVMPercentage = (EVMdBm << 1) + (EVMdBm); -+ } -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->RxPwr[RxPath] = RxPwr; -+ pPhyInfo->RxMIMOEVMdbm[RxPath] = EVMdBm; -+ -+ /* CFO = CFO_tail * 312.5 / 2^7 ~= CFO tail * 39/512 (kHz)*/ -+ pPhyInfo->Cfo_tail[RxPath] = Cfo_tail; -+ pPhyInfo->Cfo_tail[RxPath] = ((pPhyInfo->Cfo_tail[RxPath] << 5) + (pPhyInfo->Cfo_tail[RxPath] << 2) + -+ (pPhyInfo->Cfo_tail[RxPath] << 1) + (pPhyInfo->Cfo_tail[RxPath])) >> 9; -+#endif -+ -+ pPhyInfo->RxMIMOSignalStrength[RxPath] = odm_QueryRxPwrPercentage(RxPwr); -+ pPhyInfo->RxMIMOSignalQuality[RxPath] = EVMPercentage; -+ pPhyInfo->RxSNR[RxPath] = RxSNR >> 1; -+ -+/* -+ //if (pPktinfo->bPacketMatchBSSID) -+ { -+ DbgPrint("Path (%d)--------\n", RxPath); -+ DbgPrint("RxPwr = %d, Signal strength = %d\n", pPhyInfo->RxPwr[RxPath], pPhyInfo->RxMIMOSignalStrength[RxPath]); -+ DbgPrint("EVMdBm = %d, Signal quality = %d\n", pPhyInfo->RxMIMOEVMdbm[RxPath], pPhyInfo->RxMIMOSignalQuality[RxPath]); -+ DbgPrint("CFO = %d, SNR = %d\n", pPhyInfo->Cfo_tail[RxPath], pPhyInfo->RxSNR[RxPath]); -+ } -+*/ -+} -+ -+VOID -+phydm_SetCommonPhyInfo( -+ IN s1Byte RxPower, -+ IN u1Byte channel, -+ IN BOOLEAN bBeamformed, -+ IN BOOLEAN bMuPacket, -+ IN u1Byte bandwidth, -+ IN u1Byte signalQuality, -+ IN u1Byte rxsc, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->RxPower = RxPower; /* RSSI in dB */ -+ pPhyInfo->RecvSignalPower = RxPower; /* RSSI in dB */ -+ pPhyInfo->channel = channel; /* channel number */ -+ pPhyInfo->bBeamformed = bBeamformed; /* apply BF */ -+ pPhyInfo->bMuPacket = bMuPacket; /* MU packet */ -+ pPhyInfo->rxsc = rxsc; -+#endif -+ pPhyInfo->RxPWDBAll = odm_QueryRxPwrPercentage(RxPower); /* RSSI in percentage */ -+ pPhyInfo->SignalQuality = signalQuality; /* signal quality */ -+ pPhyInfo->BandWidth = bandwidth; /* bandwidth */ -+ -+/* -+ //if (pPktinfo->bPacketMatchBSSID) -+ { -+ DbgPrint("RxPWDBAll = %d, RxPower = %d, RecvSignalPower = %d\n", pPhyInfo->RxPWDBAll, pPhyInfo->RxPower, pPhyInfo->RecvSignalPower); -+ DbgPrint("SignalQuality = %d\n", pPhyInfo->SignalQuality); -+ DbgPrint("bBeamformed = %d, bMuPacket = %d, RxCount = %d\n", pPhyInfo->bBeamformed, pPhyInfo->bMuPacket, pPhyInfo->RxCount + 1); -+ DbgPrint("channel = %d, rxsc = %d, BandWidth = %d\n", channel, rxsc, bandwidth); -+ } -+*/ -+} -+ -+VOID -+phydm_GetRxPhyStatusType0( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+ /* Type 0 is used for cck packet */ -+ -+ PPHY_STATUS_RPT_JAGUAR2_TYPE0 pPhyStaRpt = (PPHY_STATUS_RPT_JAGUAR2_TYPE0)pPhyStatus; -+ u1Byte i, SQ = 0; -+ -+ /* Calculate Signal Quality*/ -+ if (pPktinfo->bPacketMatchBSSID) { -+ if (pPhyStaRpt->signal_quality >= 64) -+ SQ = 0; -+ else if (pPhyStaRpt->signal_quality <= 20) -+ SQ = 100; -+ else { -+ /* mapping to 2~99% */ -+ SQ = 64 - pPhyStaRpt->signal_quality; -+ SQ = ((SQ << 3) + SQ) >> 2; -+ } -+ } -+ -+ /* Update CCK packet counter */ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; -+ -+ /* Update Common information */ -+ phydm_SetCommonPhyInfo((pPhyStaRpt->pwdb - 110), pPhyStaRpt->channel, FALSE, -+ FALSE, ODM_BW20M, SQ, pPhyStaRpt->rxsc, pPhyInfo); -+ -+ /* Update CCK pwdb */ -+ phydm_SetPerPathPhyInfo(ODM_RF_PATH_A, (pPhyStaRpt->pwdb - 110), 0, 0, 0, pPhyInfo); /* Update per-path information */ -+ -+/* -+ //if (pPktinfo->bPacketMatchBSSID) -+ { -+ DbgPrint("pwdb = 0x%x, MP gain index = 0x%x, TRSW = 0x%x\n", pPhyStaRpt->pwdb, pPhyStaRpt->gain, pPhyStaRpt->trsw); -+ DbgPrint("channel = %d, band = %d, rxsc = %d\n", pPhyStaRpt->channel, pPhyStaRpt->band, pPhyStaRpt->rxsc); -+ DbgPrint("agc_table = 0x%x, agc_rpt 0x%x, bb_power = 0x%x\n", pPhyStaRpt->agc_table, pPhyStaRpt->agc_rpt, pPhyStaRpt->bb_power); -+ DbgPrint("length = %d, SQ = %d\n", pPhyStaRpt->length, pPhyStaRpt->signal_quality); -+ DbgPrint("antidx a = 0x%x, b = 0x%x, c = 0x%x, d = 0x%x\n", pPhyStaRpt->antidx_a, pPhyStaRpt->antidx_b, pPhyStaRpt->antidx_c, pPhyStaRpt->antidx_d); -+ DbgPrint("rsvd_0 = 0x%x, rsvd_1 = 0x%x, rsvd_2 = 0x%x\n", pPhyStaRpt->rsvd_0, pPhyStaRpt->rsvd_1, pPhyStaRpt->rsvd_2); -+ DbgPrint("rsvd_3 = 0x%x, rsvd_4 = 0x%x, rsvd_5 = 0x%x\n", pPhyStaRpt->rsvd_3, pPhyStaRpt->rsvd_4, pPhyStaRpt->rsvd_5); -+ DbgPrint("rsvd_6 = 0x%x, rsvd_7 = 0x%x, rsvd_8 = 0x%x\n", pPhyStaRpt->rsvd_6, pPhyStaRpt->rsvd_7, pPhyStaRpt->rsvd_8); -+ } -+*/ -+} -+ -+VOID -+phydm_GetRxPhyStatusType1( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+ /* Type 1 is used for ofdm packet */ -+ -+ PPHY_STATUS_RPT_JAGUAR2_TYPE1 pPhyStaRpt = (PPHY_STATUS_RPT_JAGUAR2_TYPE1)pPhyStatus; -+ s1Byte rx_pwr_db = -120; -+ u1Byte i, rxsc, bw, RxCount = 0; -+ BOOLEAN bMU; -+ -+ /* Update OFDM packet counter */ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; -+ -+ /* Update per-path information */ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { -+ if (pDM_Odm->RXAntStatus & BIT(i)) { -+ s1Byte rx_path_pwr_db; -+ -+ /* RX path counter */ -+ RxCount++; -+ -+ /* Update per-path information (RSSI_dB RSSI_percentage EVM SNR CFO SQ) */ -+ /* EVM report is reported by stream, not path */ -+ rx_path_pwr_db = pPhyStaRpt->pwdb[i] - 110; /* per-path pwdb in dB domain */ -+ phydm_SetPerPathPhyInfo(i, rx_path_pwr_db, pPhyStaRpt->rxevm[RxCount - 1], -+ pPhyStaRpt->cfo_tail[i], pPhyStaRpt->rxsnr[i], pPhyInfo); -+ -+ /* search maximum pwdb */ -+ if (rx_path_pwr_db > rx_pwr_db) -+ rx_pwr_db = rx_path_pwr_db; -+ } -+ } -+ -+ /* mapping RX counter from 1~4 to 0~3 */ -+ if (RxCount > 0) -+ pPhyInfo->RxCount = RxCount - 1; -+ -+ /* Check if MU packet or not */ -+ if ((pPhyStaRpt->gid != 0) && (pPhyStaRpt->gid != 63)) { -+ bMU = TRUE; -+ pDM_Odm->PhyDbgInfo.NumQryMuPkt++; -+ } else -+ bMU = FALSE; -+ -+ /* Count BF packet */ -+ pDM_Odm->PhyDbgInfo.NumQryBfPkt = pDM_Odm->PhyDbgInfo.NumQryBfPkt + pPhyStaRpt->beamformed; -+ -+ /* Check sub-channel */ -+ if ((pPktinfo->DataRate > ODM_RATE11M) && (pPktinfo->DataRate < ODM_RATEMCS0)) -+ rxsc = pPhyStaRpt->l_rxsc; -+ else -+ rxsc = pPhyStaRpt->ht_rxsc; -+ -+ /* Check RX bandwidth */ -+ if ((rxsc >= 1) && (rxsc <= 8)) -+ bw = ODM_BW20M; -+ else if ((rxsc >= 9) && (rxsc <= 12)) -+ bw = ODM_BW40M; -+ else if (rxsc >= 13) -+ bw = ODM_BW80M; -+ else -+ bw = pPhyStaRpt->rf_mode; -+ -+ /* Update packet information */ -+ phydm_SetCommonPhyInfo(rx_pwr_db, pPhyStaRpt->channel, (BOOLEAN)pPhyStaRpt->beamformed, -+ bMU, bw, odm_EVMdbToPercentage(pPhyStaRpt->rxevm[0]), rxsc, pPhyInfo); -+ -+/* -+ //if (pPktinfo->bPacketMatchBSSID) -+ { -+ DbgPrint("channel = %d, band = %d, l_rxsc = %d, ht_rxsc = %d, rf_mode = %d\n", pPhyStaRpt->channel, pPhyStaRpt->band, pPhyStaRpt->l_rxsc, pPhyStaRpt->ht_rxsc, pPhyStaRpt->rf_mode); -+ DbgPrint("Antidx A = %d, B = %d, C = %d, D = %d\n", pPhyStaRpt->antidx_a, pPhyStaRpt->antidx_b, pPhyStaRpt->antidx_c, pPhyStaRpt->antidx_d); -+ DbgPrint("pwdb A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->pwdb[0], pPhyStaRpt->pwdb[1], pPhyStaRpt->pwdb[2], pPhyStaRpt->pwdb[3]); -+ DbgPrint("EVM A: %d, B: %d, C: %d, D: %d\n", pPhyStaRpt->rxevm[0], pPhyStaRpt->rxevm[1], pPhyStaRpt->rxevm[2], pPhyStaRpt->rxevm[3]); -+ DbgPrint("SNR A: %d, B: %d, C: %d, D: %d\n", pPhyStaRpt->rxsnr[0], pPhyStaRpt->rxsnr[1], pPhyStaRpt->rxsnr[2], pPhyStaRpt->rxsnr[3]); -+ DbgPrint("CFO A: %d, B: %d, C: %d, D: %d\n", pPhyStaRpt->cfo_tail[0], pPhyStaRpt->cfo_tail[1], pPhyStaRpt->cfo_tail[2], pPhyStaRpt->cfo_tail[3]); -+ DbgPrint("paid = %d, gid = %d, length = %d\n", (pPhyStaRpt->paid + (pPhyStaRpt->paid_msb<<8)), pPhyStaRpt->gid, pPhyStaRpt->lsig_length); -+ DbgPrint("ldpc: %d, stbc: %d, bf: %d, gnt_bt: %d, antsw: %d\n", pPhyStaRpt->ldpc, pPhyStaRpt->stbc, pPhyStaRpt->beamformed, pPhyStaRpt->gnt_bt, pPhyStaRpt->hw_antsw_occu); -+ DbgPrint("NBI: %d, pos: %d\n", pPhyStaRpt->nb_intf_flag, (pPhyStaRpt->intf_pos + (pPhyStaRpt->intf_pos_msb<<8))); -+ DbgPrint("rsvd_0 = %d, rsvd_1 = %d, rsvd_2 = %d, rsvd_3 = %d, rsvd_4 = %d, rsvd_5 = %d\n", pPhyStaRpt->rsvd_0, pPhyStaRpt->rsvd_1, pPhyStaRpt->rsvd_2, pPhyStaRpt->rsvd_3, pPhyStaRpt->rsvd_4, pPhyStaRpt->rsvd_5); -+ } -+ DbgPrint("phydm_GetRxPhyStatusType1 pPktinfo->bPacketMatchBSSID = %d\n", pPktinfo->bPacketMatchBSSID); -+ DbgPrint("pPktinfo->DataRate = 0x%x\n", pPktinfo->DataRate); -+*/ -+} -+ -+VOID -+phydm_GetRxPhyStatusType2( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+ PPHY_STATUS_RPT_JAGUAR2_TYPE2 pPhyStaRpt = (PPHY_STATUS_RPT_JAGUAR2_TYPE2)pPhyStatus; -+ s1Byte rx_pwr_db = -120; -+ u1Byte i, rxsc, bw, RxCount = 0; -+ -+ /* Update OFDM packet counter */ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; -+ -+ /* Update per-path information */ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { -+ if (pDM_Odm->RXAntStatus & BIT(i)) { -+ s1Byte rx_path_pwr_db; -+ -+ /* RX path counter */ -+ RxCount++; -+ -+ /* Update per-path information (RSSI_dB RSSI_percentage EVM SNR CFO SQ) */ -+ rx_path_pwr_db = pPhyStaRpt->pwdb[i] - 110; /* per-path pwdb in dB domain */ -+ phydm_SetPerPathPhyInfo(i, rx_path_pwr_db, 0, 0, 0, pPhyInfo); -+ -+ /* search maximum pwdb */ -+ if (rx_path_pwr_db > rx_pwr_db) -+ rx_pwr_db = rx_path_pwr_db; -+ } -+ } -+ -+ /* mapping RX counter from 1~4 to 0~3 */ -+ if (RxCount > 0) -+ pPhyInfo->RxCount = RxCount - 1; -+ -+ /* Check RX sub-channel */ -+ if ((pPktinfo->DataRate > ODM_RATE11M) && (pPktinfo->DataRate < ODM_RATEMCS0)) -+ rxsc = pPhyStaRpt->l_rxsc; -+ else -+ rxsc = pPhyStaRpt->ht_rxsc; -+ -+ /* Check RX bandwidth */ -+ /* the BW information of sc=0 is useless, because there is no information of RF mode*/ -+ if ((rxsc >= 1) && (rxsc <= 8)) -+ bw = ODM_BW20M; -+ else if ((rxsc >= 9) && (rxsc <= 12)) -+ bw = ODM_BW40M; -+ else if (rxsc >= 13) -+ bw = ODM_BW80M; -+ else -+ bw = ODM_BW20M; -+ -+ /* Update packet information */ -+ phydm_SetCommonPhyInfo(rx_pwr_db, pPhyStaRpt->channel, (BOOLEAN)pPhyStaRpt->beamformed, -+ FALSE, bw, 0, rxsc, pPhyInfo); -+ -+/* -+ //if (pPktinfo->bPacketMatchBSSID) -+ { -+ DbgPrint("channel = %d, band = %d, l_rxsc = %d, ht_rxsc = %d\n", pPhyStaRpt->channel, pPhyStaRpt->band, pPhyStaRpt->l_rxsc, pPhyStaRpt->ht_rxsc); -+ DbgPrint("pwdb A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->pwdb[0], pPhyStaRpt->pwdb[1], pPhyStaRpt->pwdb[2], pPhyStaRpt->pwdb[3]); -+ DbgPrint("Agc table A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->agc_table_a, pPhyStaRpt->agc_table_b, pPhyStaRpt->agc_table_c, pPhyStaRpt->agc_table_d); -+ DbgPrint("Gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->gain_a, pPhyStaRpt->gain_b, pPhyStaRpt->gain_c, pPhyStaRpt->gain_d); -+ DbgPrint("TRSW A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->trsw_a, pPhyStaRpt->trsw_b, pPhyStaRpt->trsw_c, pPhyStaRpt->trsw_d); -+ DbgPrint("AAGC step A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->aagc_step_a, pPhyStaRpt->aagc_step_b, pPhyStaRpt->aagc_step_c, pPhyStaRpt->aagc_step_d); -+ DbgPrint("HT AAGC gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->ht_aagc_gain[0], pPhyStaRpt->ht_aagc_gain[1], pPhyStaRpt->ht_aagc_gain[2], pPhyStaRpt->ht_aagc_gain[3]); -+ DbgPrint("DAGC gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->dagc_gain[0], pPhyStaRpt->dagc_gain[1], pPhyStaRpt->dagc_gain[2], pPhyStaRpt->dagc_gain[3]); -+ DbgPrint("ldpc: %d, stbc: %d, bf: %d, gnt_bt: %d, antsw: %d\n", pPhyStaRpt->ldpc, pPhyStaRpt->stbc, pPhyStaRpt->beamformed, pPhyStaRpt->gnt_bt, pPhyStaRpt->hw_antsw_occu); -+ DbgPrint("counter: %d, syn_count: %d\n", pPhyStaRpt->counter, pPhyStaRpt->syn_count); -+ DbgPrint("cnt_cca2agc_rdy: %d, cnt_pw2cca: %d, shift_l_map\n", pPhyStaRpt->cnt_cca2agc_rdy, pPhyStaRpt->cnt_pw2cca, pPhyStaRpt->shift_l_map); -+ DbgPrint("rsvd_0 = %d, rsvd_1 = %d, rsvd_2 = %d, rsvd_3 = %d, rsvd_4 = %d, rsvd_5 = %d\n", pPhyStaRpt->rsvd_0, pPhyStaRpt->rsvd_1, pPhyStaRpt->rsvd_2, pPhyStaRpt->rsvd_3, pPhyStaRpt->rsvd_4); -+ DbgPrint("rsvd_5 = %d, rsvd_6 = %d, rsvd_6 = %d\n", pPhyStaRpt->rsvd_5, pPhyStaRpt->rsvd_6, pPhyStaRpt->rsvd_7); -+ } -+*/ -+} -+ -+VOID -+phydm_GetRxPhyStatusType5( -+ IN pu1Byte pPhyStatus -+) -+{ -+/* -+ DbgPrint("DW0: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 3), *(pPhyStatus + 2), *(pPhyStatus + 1), *(pPhyStatus + 0)); -+ DbgPrint("DW1: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 7), *(pPhyStatus + 6), *(pPhyStatus + 5), *(pPhyStatus + 4)); -+ DbgPrint("DW2: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 11), *(pPhyStatus + 10), *(pPhyStatus + 9), *(pPhyStatus + 8)); -+ DbgPrint("DW3: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 15), *(pPhyStatus + 14), *(pPhyStatus + 13), *(pPhyStatus + 12)); -+ DbgPrint("DW4: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 19), *(pPhyStatus + 18), *(pPhyStatus + 17), *(pPhyStatus + 16)); -+ DbgPrint("DW5: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 23), *(pPhyStatus + 22), *(pPhyStatus + 21), *(pPhyStatus + 20)); -+ DbgPrint("DW6: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 27), *(pPhyStatus + 26), *(pPhyStatus + 25), *(pPhyStatus + 24)); -+*/ -+} -+ -+VOID -+phydm_Process_RSSIForDM_Jaguar2( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN PODM_PHY_INFO_T pPhyInfo, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ u4Byte UndecoratedSmoothedPWDB, RSSI_Ave; -+ u1Byte i; -+ PSTA_INFO_T pEntry; -+ -+ if (pPktinfo->StationID >= ODM_ASSOCIATE_ENTRY_NUM) -+ return; -+ -+ pEntry = pDM_Odm->pODM_StaInfo[pPktinfo->StationID]; -+ -+ if (!IS_STA_VALID(pEntry)) -+ return; -+ -+ if ((!pPktinfo->bPacketMatchBSSID))/*data frame only*/ -+ return; -+ -+ if (pPktinfo->bPacketBeacon) -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt++; -+ -+ if (pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon) { -+ u4Byte RSSI_linear = 0; -+ -+ UndecoratedSmoothedPWDB = (u4Byte)pEntry->rssi_stat.UndecoratedSmoothedPWDB; -+ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ pDM_Odm->RSSI_C = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_C]; -+ pDM_Odm->RSSI_D = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_D]; -+ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { -+ if (pPhyInfo->RxMIMOSignalStrength[i] != 0) -+ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[i]); -+ } -+ -+ switch (pPhyInfo->RxCount + 1) { -+ case 2: -+ RSSI_linear = (RSSI_linear >> 1); -+ break; -+ case 3: -+ RSSI_linear = ((RSSI_linear) + (RSSI_linear << 1) + (RSSI_linear << 3)) >> 5; /* RSSI_linear/3 ~ RSSI_linear*11/32 */ -+ break; -+ case 4: -+ RSSI_linear = (RSSI_linear >> 2); -+ break; -+ } -+ RSSI_Ave = odm_ConvertTo_dB(RSSI_linear); -+ -+ if (UndecoratedSmoothedPWDB <= 0) -+ UndecoratedSmoothedPWDB = pPhyInfo->RxPWDBAll; -+ else -+ UndecoratedSmoothedPWDB = (RSSI_Ave + ((UndecoratedSmoothedPWDB<<4) - UndecoratedSmoothedPWDB))>>4; -+ -+ pEntry->rssi_stat.UndecoratedSmoothedPWDB = (s4Byte)UndecoratedSmoothedPWDB; -+ } -+} -+ -+VOID -+phydm_RxPhyStatusJaguarSeries2( -+ IN PDM_ODM_T pPhydm, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+ u1Byte phy_status_type = (*pPhyStatus & 0xf); -+ -+ /*DbgPrint("phydm_RxPhyStatusJaguarSeries2================> (page: %d)\n", phy_status_type);*/ -+ -+ /* Memory reset */ -+ phydm_ResetPhyInfo(pPhydm, pPhyInfo); -+ -+ /* Phy status parsing */ -+ switch (phy_status_type) { -+ case 0: -+ { -+ phydm_GetRxPhyStatusType0(pPhydm, pPhyStatus, pPktinfo, pPhyInfo); -+ break; -+ } -+ case 1: -+ { -+ phydm_GetRxPhyStatusType1(pPhydm, pPhyStatus, pPktinfo, pPhyInfo); -+ break; -+ } -+ case 2: -+ { -+ phydm_GetRxPhyStatusType2(pPhydm, pPhyStatus, pPktinfo, pPhyInfo); -+ break; -+ } -+ case 5: -+ { -+ phydm_GetRxPhyStatusType5(pPhyStatus); -+ return; -+ } -+ default: -+ return; -+ } -+ -+ /* Update signal strength to UI, and pPhyInfo->RxPWDBAll is the maximum RSSI of all path */ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pPhyInfo->SignalStrength = SignalScaleProc(pPhydm->Adapter, pPhyInfo->RxPWDBAll, FALSE, FALSE); -+#else -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pPhydm, pPhyInfo->RxPWDBAll)); -+#endif -+ -+ /* Calculate average RSSI and smoothed RSSI */ -+ phydm_Process_RSSIForDM_Jaguar2(pPhydm, pPhyInfo, pPktinfo); -+ -+} -+/*==============================================*/ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_hwconfig.h linux/3rdparty/rtl8812au/hal/phydm/phydm_hwconfig.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_hwconfig.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_hwconfig.h 2017-06-07 23:07:21.018688214 +0300 -@@ -0,0 +1,506 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __HALHWOUTSRC_H__ -+#define __HALHWOUTSRC_H__ -+ -+ -+/*--------------------------Define -------------------------------------------*/ -+ -+#define AGC_DIFF_CONFIG_MP(ic, band) (ODM_ReadAndConfig_MP_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_MP_##ic##_AGC_TAB_DIFF_##band, \ -+ sizeof(Array_MP_##ic##_AGC_TAB_DIFF_##band)/sizeof(u4Byte))) -+#define AGC_DIFF_CONFIG_TC(ic, band) (ODM_ReadAndConfig_TC_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_TC_##ic##_AGC_TAB_DIFF_##band, \ -+ sizeof(Array_TC_##ic##_AGC_TAB_DIFF_##band)/sizeof(u4Byte))) -+ -+#define AGC_DIFF_CONFIG(ic, band) do {\ -+ if (pDM_Odm->bIsMPChip)\ -+ AGC_DIFF_CONFIG_MP(ic,band);\ -+ else\ -+ AGC_DIFF_CONFIG_TC(ic,band);\ -+ } while(0) -+ -+ -+//============================================================ -+// structure and define -+//============================================================ -+ -+__PACK typedef struct _Phy_Rx_AGC_Info -+{ -+ #if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte gain:7,trsw:1; -+ #else -+ u1Byte trsw:1,gain:7; -+ #endif -+} __WLAN_ATTRIB_PACK__ PHY_RX_AGC_INFO_T, *pPHY_RX_AGC_INFO_T; -+ -+__PACK typedef struct _Phy_Status_Rpt_8192cd { -+ PHY_RX_AGC_INFO_T path_agc[2]; -+ u1Byte ch_corr[2]; -+ u1Byte cck_sig_qual_ofdm_pwdb_all; -+ u1Byte cck_agc_rpt_ofdm_cfosho_a; -+ u1Byte cck_rpt_b_ofdm_cfosho_b; -+ u1Byte rsvd_1;/*ch_corr_msb;*/ -+ u1Byte noise_power_db_msb; -+ s1Byte path_cfotail[2]; -+ u1Byte pcts_mask[2]; -+ s1Byte stream_rxevm[2]; -+ u1Byte path_rxsnr[2]; -+ u1Byte noise_power_db_lsb; -+ u1Byte rsvd_2[3]; -+ u1Byte stream_csi[2]; -+ u1Byte stream_target_csi[2]; -+ s1Byte sig_evm; -+ u1Byte rsvd_3; -+ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte antsel_rx_keep_2: 1; /*ex_intf_flg:1;*/ -+ u1Byte sgi_en: 1; -+ u1Byte rxsc: 2; -+ u1Byte idle_long: 1; -+ u1Byte r_ant_train_en: 1; -+ u1Byte ant_sel_b: 1; -+ u1Byte ant_sel: 1; -+#else /*_BIG_ENDIAN_ */ -+ u1Byte ant_sel: 1; -+ u1Byte ant_sel_b: 1; -+ u1Byte r_ant_train_en: 1; -+ u1Byte idle_long: 1; -+ u1Byte rxsc: 2; -+ u1Byte sgi_en: 1; -+ u1Byte antsel_rx_keep_2: 1;/*ex_intf_flg:1;*/ -+#endif -+} __WLAN_ATTRIB_PACK__ PHY_STATUS_RPT_8192CD_T, *PPHY_STATUS_RPT_8192CD_T; -+ -+ -+typedef struct _Phy_Status_Rpt_8812 { -+/* DWORD 0*/ -+ u1Byte gain_trsw[2]; /*path-A and path-B {TRSW, gain[6:0] }*/ -+ u1Byte chl_num_LSB; /*channel number[7:0]*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte chl_num_MSB: 2; /*channel number[9:8]*/ -+ u1Byte sub_chnl: 4; /*sub-channel location[3:0]*/ -+ u1Byte r_RFMOD: 2; /*RF mode[1:0]*/ -+#else /*_BIG_ENDIAN_ */ -+ u1Byte r_RFMOD: 2; -+ u1Byte sub_chnl: 4; -+ u1Byte chl_num_MSB: 2; -+#endif -+ -+/* DWORD 1*/ -+ u1Byte pwdb_all; /*CCK signal quality / OFDM pwdb all*/ -+ s1Byte cfosho[2]; /*DW1 byte 1 DW1 byte2 CCK AGC report and CCK_BB_Power / OFDM Path-A and Path-B short CFO*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ /*this should be checked again because the definition of 8812 and 8814 is different*/ -+/* u1Byte r_cck_rx_enable_pathc:2; cck rx enable pathc[1:0]*/ -+/* u1Byte cck_rx_path:4; cck rx path[3:0]*/ -+ u1Byte resvd_0: 6; -+ u1Byte bt_RF_ch_MSB: 2; /*8812A:2'b0 8814A: bt rf channel keep[7:6]*/ -+#else /*_BIG_ENDIAN_*/ -+ u1Byte bt_RF_ch_MSB: 2; -+ u1Byte resvd_0: 6; -+#endif -+ -+/* DWORD 2*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte ant_div_sw_a: 1; /*8812A: ant_div_sw_a 8814A: 1'b0*/ -+ u1Byte ant_div_sw_b: 1; /*8812A: ant_div_sw_b 8814A: 1'b0*/ -+ u1Byte bt_RF_ch_LSB: 6; /*8812A: 6'b0 8814A: bt rf channel keep[5:0]*/ -+#else /*_BIG_ENDIAN_ */ -+ u1Byte bt_RF_ch_LSB: 6; -+ u1Byte ant_div_sw_b: 1; -+ u1Byte ant_div_sw_a: 1; -+#endif -+ s1Byte cfotail[2]; /*DW2 byte 1 DW2 byte 2 path-A and path-B CFO tail*/ -+ u1Byte PCTS_MSK_RPT_0; /*PCTS mask report[7:0]*/ -+ u1Byte PCTS_MSK_RPT_1; /*PCTS mask report[15:8]*/ -+ -+/* DWORD 3*/ -+ s1Byte rxevm[2]; /*DW3 byte 1 DW3 byte 2 stream 1 and stream 2 RX EVM*/ -+ s1Byte rxsnr[2]; /*DW3 byte 3 DW4 byte 0 path-A and path-B RX SNR*/ -+ -+/* DWORD 4*/ -+ u1Byte PCTS_MSK_RPT_2; /*PCTS mask report[23:16]*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte PCTS_MSK_RPT_3: 6; /*PCTS mask report[29:24]*/ -+ u1Byte pcts_rpt_valid: 1; /*pcts_rpt_valid*/ -+ u1Byte resvd_1: 1; /*1'b0*/ -+#else /*_BIG_ENDIAN_*/ -+ u1Byte resvd_1: 1; -+ u1Byte pcts_rpt_valid: 1; -+ u1Byte PCTS_MSK_RPT_3: 6; -+#endif -+ s1Byte rxevm_cd[2]; /*DW 4 byte 3 DW5 byte 0 8812A: 16'b0 8814A: stream 3 and stream 4 RX EVM*/ -+ -+/* DWORD 5*/ -+ u1Byte csi_current[2]; /*DW5 byte 1 DW5 byte 2 8812A: stream 1 and 2 CSI 8814A: path-C and path-D RX SNR*/ -+ u1Byte gain_trsw_cd[2]; /*DW5 byte 3 DW6 byte 0 path-C and path-D {TRSW, gain[6:0] }*/ -+ -+/* DWORD 6*/ -+ s1Byte sigevm; /*signal field EVM*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte antidx_antc: 3; /*8812A: 3'b0 8814A: antidx_antc[2:0]*/ -+ u1Byte antidx_antd: 3; /*8812A: 3'b0 8814A: antidx_antd[2:0]*/ -+ u1Byte dpdt_ctrl_keep: 1; /*8812A: 1'b0 8814A: dpdt_ctrl_keep*/ -+ u1Byte GNT_BT_keep: 1; /*8812A: 1'b0 8814A: GNT_BT_keep*/ -+#else /*_BIG_ENDIAN_*/ -+ u1Byte GNT_BT_keep: 1; -+ u1Byte dpdt_ctrl_keep: 1; -+ u1Byte antidx_antd: 3; -+ u1Byte antidx_antc: 3; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte antidx_anta: 3; /*antidx_anta[2:0]*/ -+ u1Byte antidx_antb: 3; /*antidx_antb[2:0]*/ -+ u1Byte hw_antsw_occur: 2; /*1'b0*/ -+#else /*_BIG_ENDIAN_*/ -+ u1Byte hw_antsw_occur: 2; -+ u1Byte antidx_antb: 3; -+ u1Byte antidx_anta: 3; -+#endif -+} PHY_STATUS_RPT_8812_T, *PPHY_STATUS_RPT_8812_T; -+ -+VOID -+odm_Init_RSSIForDM( -+ IN OUT PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_PhyStatusQuery( -+ IN OUT PDM_ODM_T pDM_Odm, -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ); -+ -+VOID -+ODM_MacStatusQuery( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN pu1Byte pMacStatus, -+ IN u1Byte MacID, -+ IN BOOLEAN bPacketMatchBSSID, -+ IN BOOLEAN bPacketToSelf, -+ IN BOOLEAN bPacketBeacon -+ ); -+ -+HAL_STATUS -+ODM_ConfigRFWithTxPwrTrackHeaderFile( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+HAL_STATUS -+ODM_ConfigRFWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_Config_Type ConfigType, -+ IN ODM_RF_RADIO_PATH_E eRFPath -+ ); -+ -+HAL_STATUS -+ODM_ConfigBBWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_BB_Config_Type ConfigType -+ ); -+ -+HAL_STATUS -+ODM_ConfigMACWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+HAL_STATUS -+ODM_ConfigFWWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_FW_Config_Type ConfigType, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pSize -+ ); -+ -+u4Byte -+ODM_GetHWImgVersion( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+s4Byte -+odm_SignalScaleMapping( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN s4Byte CurrSig -+ ); -+ -+#if (RTL8822B_SUPPORT == 1) -+/*For 8822B only!! need to move to FW finally */ -+/*==============================================*/ -+VOID -+phydm_RxPhyStatusJaguarSeries2( -+ IN PDM_ODM_T pPhydm, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo, -+ OUT PODM_PHY_INFO_T pPhyInfo -+); -+ -+typedef struct _Phy_Status_Rpt_Jaguar2_Type0 { -+ /* DW0 */ -+ u1Byte page_num; -+ u1Byte pwdb; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte gain: 6; -+ u1Byte rsvd_0: 1; -+ u1Byte trsw: 1; -+#else -+ u1Byte trsw: 1; -+ u1Byte rsvd_0: 1; -+ u1Byte gain: 6; -+#endif -+ u1Byte rsvd_1; -+ -+ /* DW1 */ -+ u1Byte rsvd_2; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte rxsc: 4; -+ u1Byte agc_table: 4; -+#else -+ u1Byte agc_table: 4; -+ u1Byte rxsc: 4; -+#endif -+ u1Byte channel; -+ u1Byte band; -+ -+ /* DW2 */ -+ u2Byte length; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte antidx_a: 3; -+ u1Byte antidx_b: 3; -+ u1Byte rsvd_3: 2; -+ u1Byte antidx_c: 3; -+ u1Byte antidx_d: 3; -+ u1Byte rsvd_4:2; -+#else -+ u1Byte rsvd_3: 2; -+ u1Byte antidx_b: 3; -+ u1Byte antidx_a: 3; -+ u1Byte rsvd_4:2; -+ u1Byte antidx_d: 3; -+ u1Byte antidx_c: 3; -+#endif -+ -+ /* DW3 */ -+ u1Byte signal_quality; -+ u1Byte agc_rpt; -+ u1Byte bb_power; -+ u1Byte rsvd_5; -+ -+ /* DW4 */ -+ u4Byte rsvd_6; -+ -+ /* DW5 */ -+ u4Byte rsvd_7; -+ -+ /* DW6 */ -+ u4Byte rsvd_8; -+} PHY_STATUS_RPT_JAGUAR2_TYPE0, *PPHY_STATUS_RPT_JAGUAR2_TYPE0; -+ -+typedef struct _Phy_Status_Rpt_Jaguar2_Type1 { -+ /* DW0 and DW1 */ -+ u1Byte page_num; -+ u1Byte pwdb[4]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte l_rxsc: 4; -+ u1Byte ht_rxsc: 4; -+#else -+ u1Byte ht_rxsc: 4; -+ u1Byte l_rxsc: 4; -+#endif -+ u1Byte channel; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte band: 2; -+ u1Byte rsvd_0: 1; -+ u1Byte hw_antsw_occu: 1; -+ u1Byte gnt_bt: 1; -+ u1Byte ldpc: 1; -+ u1Byte stbc: 1; -+ u1Byte beamformed: 1; -+#else -+ u1Byte beamformed: 1; -+ u1Byte stbc: 1; -+ u1Byte ldpc: 1; -+ u1Byte gnt_bt: 1; -+ u1Byte hw_antsw_occu: 1; -+ u1Byte rsvd_0: 1; -+ u1Byte band: 2; -+#endif -+ -+ /* DW2 */ -+ u2Byte lsig_length; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte antidx_a: 3; -+ u1Byte antidx_b: 3; -+ u1Byte rsvd_1: 2; -+ u1Byte antidx_c: 3; -+ u1Byte antidx_d: 3; -+ u1Byte rsvd_2: 2; -+#else -+ u1Byte rsvd_1: 2; -+ u1Byte antidx_b: 3; -+ u1Byte antidx_a: 3; -+ u1Byte rsvd_2: 2; -+ u1Byte antidx_d: 3; -+ u1Byte antidx_c: 3; -+#endif -+ -+ /* DW3 */ -+ u1Byte paid; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte paid_msb: 1; -+ u1Byte gid: 6; -+ u1Byte rsvd_3: 1; -+#else -+ u1Byte rsvd_3: 1; -+ u1Byte gid: 6; -+ u1Byte paid_msb: 1; -+#endif -+ u1Byte intf_pos; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte intf_pos_msb: 1; -+ u1Byte rsvd_4: 2; -+ u1Byte nb_intf_flag: 1; -+ u1Byte rf_mode: 2; -+ u1Byte rsvd_5: 2; -+#else -+ u1Byte rsvd_5: 2; -+ u1Byte rf_mode: 2; -+ u1Byte nb_intf_flag: 1; -+ u1Byte rsvd_4: 2; -+ u1Byte intf_pos_msb: 1; -+#endif -+ -+ /* DW4 */ -+ s1Byte rxevm[4]; /* s(8,1) */ -+ -+ /* DW5 */ -+ s1Byte cfo_tail[4]; /* s(8,7) */ -+ -+ /* DW6 */ -+ s1Byte rxsnr[4]; /* s(8,1) */ -+} PHY_STATUS_RPT_JAGUAR2_TYPE1, *PPHY_STATUS_RPT_JAGUAR2_TYPE1; -+ -+typedef struct _Phy_Status_Rpt_Jaguar2_Type2 { -+ /* DW0 ane DW1 */ -+ u1Byte page_num; -+ u1Byte pwdb[4]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte l_rxsc: 4; -+ u1Byte ht_rxsc: 4; -+#else -+ u1Byte ht_rxsc: 4; -+ u1Byte l_rxsc: 4; -+#endif -+ u1Byte channel; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte band: 2; -+ u1Byte rsvd_0: 1; -+ u1Byte hw_antsw_occu: 1; -+ u1Byte gnt_bt: 1; -+ u1Byte ldpc: 1; -+ u1Byte stbc: 1; -+ u1Byte beamformed: 1; -+#else -+ u1Byte beamformed: 1; -+ u1Byte stbc: 1; -+ u1Byte ldpc: 1; -+ u1Byte gnt_bt: 1; -+ u1Byte hw_antsw_occu: 1; -+ u1Byte rsvd_0: 1; -+ u1Byte band: 2; -+#endif -+ -+ /* DW2 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte shift_l_map: 6; -+ u1Byte rsvd_1: 2; -+#else -+ u1Byte rsvd_1: 2; -+ u1Byte shift_l_map: 6; -+#endif -+ u1Byte cnt_pw2cca; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte agc_table_a: 4; -+ u1Byte agc_table_b: 4; -+ u1Byte agc_table_c: 4; -+ u1Byte agc_table_d: 4; -+#else -+ u1Byte agc_table_b: 4; -+ u1Byte agc_table_a: 4; -+ u1Byte agc_table_d: 4; -+ u1Byte agc_table_c: 4; -+#endif -+ -+ /* DW3 ~ DW6*/ -+ u1Byte cnt_cca2agc_rdy; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte gain_a: 6; -+ u1Byte rsvd_2: 1; -+ u1Byte trsw_a: 1; -+ u1Byte gain_b: 6; -+ u1Byte rsvd_3: 1; -+ u1Byte trsw_b: 1; -+ u1Byte gain_c: 6; -+ u1Byte rsvd_4: 1; -+ u1Byte trsw_c: 1; -+ u1Byte gain_d: 6; -+ u1Byte rsvd_5: 1; -+ u1Byte trsw_d: 1; -+ u1Byte aagc_step_a: 2; -+ u1Byte aagc_step_b: 2; -+ u1Byte aagc_step_c: 2; -+ u1Byte aagc_step_d: 2; -+#else -+ u1Byte trsw_a: 1; -+ u1Byte rsvd_2: 1; -+ u1Byte gain_a: 6; -+ u1Byte trsw_b: 1; -+ u1Byte rsvd_3: 1; -+ u1Byte gain_b: 6; -+ u1Byte trsw_c: 1; -+ u1Byte rsvd_4: 1; -+ u1Byte gain_c: 6; -+ u1Byte trsw_d: 1; -+ u1Byte rsvd_5: 1; -+ u1Byte gain_d: 6; -+ u1Byte aagc_step_d: 2; -+ u1Byte aagc_step_c: 2; -+ u1Byte aagc_step_b: 2; -+ u1Byte aagc_step_a: 2; -+#endif -+ u1Byte ht_aagc_gain[4]; -+ u1Byte dagc_gain[4]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte counter: 6; -+ u1Byte rsvd_6: 2; -+ u1Byte syn_count: 5; -+ u1Byte rsvd_7:3; -+#else -+ u1Byte rsvd_6: 2; -+ u1Byte counter: 6; -+ u1Byte rsvd_7:3; -+ u1Byte syn_count: 5; -+#endif -+} PHY_STATUS_RPT_JAGUAR2_TYPE2, *PPHY_STATUS_RPT_JAGUAR2_TYPE2; -+/*==============================================*/ -+#endif -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_interface.c linux/3rdparty/rtl8812au/hal/phydm/phydm_interface.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_interface.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_interface.c 2017-06-07 23:07:21.018688214 +0300 -@@ -0,0 +1,1029 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+// -+// ODM IO Relative API. -+// -+ -+u1Byte -+ODM_Read1Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ return RTL_R8(RegAddr); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return rtw_read8(Adapter,RegAddr); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return PlatformEFIORead1Byte(Adapter, RegAddr); -+#endif -+ -+} -+ -+ -+u2Byte -+ODM_Read2Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ return RTL_R16(RegAddr); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return rtw_read16(Adapter,RegAddr); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return PlatformEFIORead2Byte(Adapter, RegAddr); -+#endif -+ -+} -+ -+ -+u4Byte -+ODM_Read4Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ return RTL_R32(RegAddr); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return rtw_read32(Adapter,RegAddr); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return PlatformEFIORead4Byte(Adapter, RegAddr); -+#endif -+ -+} -+ -+ -+VOID -+ODM_Write1Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u1Byte Data -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ RTL_W8(RegAddr, Data); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ rtw_write8(Adapter,RegAddr, Data); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformEFIOWrite1Byte(Adapter, RegAddr, Data); -+#endif -+ -+} -+ -+ -+VOID -+ODM_Write2Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u2Byte Data -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ RTL_W16(RegAddr, Data); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ rtw_write16(Adapter,RegAddr, Data); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformEFIOWrite2Byte(Adapter, RegAddr, Data); -+#endif -+ -+} -+ -+ -+VOID -+ODM_Write4Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte Data -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ RTL_W32(RegAddr, Data); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ rtw_write32(Adapter,RegAddr, Data); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformEFIOWrite4Byte(Adapter, RegAddr, Data); -+#endif -+ -+} -+ -+ -+VOID -+ODM_SetMACReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ PHY_SetBBReg(pDM_Odm->priv, RegAddr, BitMask, Data); -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHY_SetBBReg(Adapter, RegAddr, BitMask, Data); -+#endif -+} -+ -+ -+u4Byte -+ODM_GetMACReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ return PHY_QueryBBReg(pDM_Odm->priv, RegAddr, BitMask); -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ return PHY_QueryMacReg(pDM_Odm->Adapter, RegAddr, BitMask); -+#endif -+} -+ -+ -+VOID -+ODM_SetBBReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ PHY_SetBBReg(pDM_Odm->priv, RegAddr, BitMask, Data); -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHY_SetBBReg(Adapter, RegAddr, BitMask, Data); -+#endif -+} -+ -+ -+u4Byte -+ODM_GetBBReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ return PHY_QueryBBReg(pDM_Odm->priv, RegAddr, BitMask); -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return PHY_QueryBBReg(Adapter, RegAddr, BitMask); -+#endif -+} -+ -+ -+VOID -+ODM_SetRFReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E eRFPath, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ PHY_SetRFReg(pDM_Odm->priv, eRFPath, RegAddr, BitMask, Data); -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHY_SetRFReg(Adapter, eRFPath, RegAddr, BitMask, Data); -+#ifdef CONFIG_PCI_HCI -+ ODM_delay_us(2); -+#endif -+#endif -+} -+ -+ -+u4Byte -+ODM_GetRFReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E eRFPath, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ return PHY_QueryRFReg(pDM_Odm->priv, eRFPath, RegAddr, BitMask, 1); -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return PHY_QueryRFReg(Adapter, eRFPath, RegAddr, BitMask); -+#endif -+} -+ -+ -+ -+ -+// -+// ODM Memory relative API. -+// -+VOID -+ODM_AllocateMemory( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PVOID *pPtr, -+ IN u4Byte length -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ *pPtr = kmalloc(length, GFP_ATOMIC); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) -+ *pPtr = rtw_zvmalloc(length); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformAllocateMemory(Adapter, pPtr, length); -+#endif -+} -+ -+// length could be ignored, used to detect memory leakage. -+VOID -+ODM_FreeMemory( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PVOID pPtr, -+ IN u4Byte length -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ kfree(pPtr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) -+ rtw_vmfree(pPtr, length); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ //PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformFreeMemory(pPtr, length); -+#endif -+} -+ -+VOID -+ODM_MoveMemory( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PVOID pDest, -+ IN PVOID pSrc, -+ IN u4Byte Length -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ memcpy(pDest, pSrc, Length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) -+ _rtw_memcpy(pDest, pSrc, Length); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformMoveMemory(pDest, pSrc, Length); -+#endif -+} -+ -+void ODM_Memory_Set( -+ IN PDM_ODM_T pDM_Odm, -+ IN PVOID pbuf, -+ IN s1Byte value, -+ IN u4Byte length -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ memset(pbuf, value, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) -+ _rtw_memset(pbuf,value, length); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformFillMemory(pbuf,length,value); -+#endif -+} -+s4Byte ODM_CompareMemory( -+ IN PDM_ODM_T pDM_Odm, -+ IN PVOID pBuf1, -+ IN PVOID pBuf2, -+ IN u4Byte length -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ return memcmp(pBuf1,pBuf2,length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) -+ return _rtw_memcmp(pBuf1,pBuf2,length); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return PlatformCompareMemory(pBuf1,pBuf2,length); -+#endif -+} -+ -+ -+ -+// -+// ODM MISC relative API. -+// -+VOID -+ODM_AcquireSpinLock( -+ IN PDM_ODM_T pDM_Odm, -+ IN RT_SPINLOCK_TYPE type -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ rtw_odm_acquirespinlock(Adapter, type); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformAcquireSpinLock(Adapter, type); -+#endif -+} -+VOID -+ODM_ReleaseSpinLock( -+ IN PDM_ODM_T pDM_Odm, -+ IN RT_SPINLOCK_TYPE type -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ rtw_odm_releasespinlock(Adapter, type); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformReleaseSpinLock(Adapter, type); -+#endif -+} -+ -+// -+// Work item relative API. FOr MP driver only~! -+// -+VOID -+ODM_InitializeWorkItem( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_WORK_ITEM pRtWorkItem, -+ IN RT_WORKITEM_CALL_BACK RtWorkItemCallback, -+ IN PVOID pContext, -+ IN const char* szID -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformInitializeWorkItem(Adapter, pRtWorkItem, RtWorkItemCallback, pContext, szID); -+#endif -+} -+ -+ -+VOID -+ODM_StartWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformStartWorkItem(pRtWorkItem); -+#endif -+} -+ -+ -+VOID -+ODM_StopWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformStopWorkItem(pRtWorkItem); -+#endif -+} -+ -+ -+VOID -+ODM_FreeWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformFreeWorkItem(pRtWorkItem); -+#endif -+} -+ -+ -+VOID -+ODM_ScheduleWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformScheduleWorkItem(pRtWorkItem); -+#endif -+} -+ -+ -+VOID -+ODM_IsWorkItemScheduled( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformIsWorkItemScheduled(pRtWorkItem); -+#endif -+} -+ -+ -+ -+// -+// ODM Timer relative API. -+// -+VOID -+ODM_StallExecution( -+ IN u4Byte usDelay -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_udelay_os(usDelay); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformStallExecution(usDelay); -+#endif -+} -+ -+VOID -+ODM_delay_ms(IN u4Byte ms) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ delay_ms(ms); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_mdelay_os(ms); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ delay_ms(ms); -+#endif -+} -+ -+VOID -+ODM_delay_us(IN u4Byte us) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ delay_us(us); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_udelay_os(us); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformStallExecution(us); -+#endif -+} -+ -+VOID -+ODM_sleep_ms(IN u4Byte ms) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_msleep_os(ms); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#endif -+} -+ -+VOID -+ODM_sleep_us(IN u4Byte us) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_usleep_os(us); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#endif -+} -+ -+VOID -+ODM_SetTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer, -+ IN u4Byte msDelay -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ mod_timer(pTimer, jiffies + RTL_MILISECONDS_TO_JIFFIES(msDelay)); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ _set_timer(pTimer,msDelay ); //ms -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformSetTimer(Adapter, pTimer, msDelay); -+#endif -+ -+} -+ -+VOID -+ODM_InitializeTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer, -+ IN RT_TIMER_CALL_BACK CallBackFunc, -+ IN PVOID pContext, -+ IN const char* szID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ init_timer(pTimer); -+ pTimer->function = CallBackFunc; -+ pTimer->data = (unsigned long)pDM_Odm; -+ mod_timer(pTimer, jiffies+RTL_MILISECONDS_TO_JIFFIES(10)); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ _init_timer(pTimer,Adapter->pnetdev,CallBackFunc,pDM_Odm); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformInitializeTimer(Adapter, pTimer, CallBackFunc,pContext,szID); -+#endif -+} -+ -+ -+VOID -+ODM_CancelTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ del_timer(pTimer); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ _cancel_timer_ex(pTimer); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformCancelTimer(Adapter, pTimer); -+#endif -+} -+ -+ -+VOID -+ODM_ReleaseTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ // <20120301, Kordan> If the initilization fails, InitializeAdapterXxx will return regardless of InitHalDm. -+ // Hence, uninitialized timers cause BSOD when the driver releases resources since the init fail. -+ if (pTimer == 0) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_SERIOUS, ("=====>ODM_ReleaseTimer(), The timer is NULL! Please check it!\n")); -+ return; -+ } -+ -+ PlatformReleaseTimer(Adapter, pTimer); -+#endif -+} -+ -+BOOLEAN -+phydm_actingDetermine( -+ IN PDM_ODM_T pDM_Odm, -+ IN PHYDM_ACTING_TYPE type -+ ) -+{ -+ BOOLEAN ret = FALSE; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->BeamformingInfo.SourceAdapter; -+#else -+ PADAPTER Adapter = pDM_Odm->Adapter; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (type == PhyDM_ACTING_AS_AP) -+ ret = ACTING_AS_AP(Adapter); -+ else if (type == PhyDM_ACTING_AS_IBSS) -+ ret = ACTING_AS_IBSS(Adapter); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ -+ if (type == PhyDM_ACTING_AS_AP) -+ ret = check_fwstate(pmlmepriv, WIFI_AP_STATE); -+ else if (type == PhyDM_ACTING_AS_IBSS) -+ ret = check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+#endif -+ -+ return ret; -+ -+} -+ -+ -+u1Byte -+phydm_trans_h2c_id( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte phydm_h2c_id -+) -+{ -+ u1Byte platform_h2c_id=0xff; -+ -+ -+ switch(phydm_h2c_id) -+ { -+ //1 [0] -+ case ODM_H2C_RSSI_REPORT: -+ -+ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ platform_h2c_id = H2C_88E_RSSI_REPORT; -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ platform_h2c_id =H2C_8814A_RSSI_REPORT; -+ } -+ else -+ { -+ platform_h2c_id = H2C_RSSI_REPORT; -+ } -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ #if((RTL8812A_SUPPORT==1) ||(RTL8821A_SUPPORT==1)) -+ platform_h2c_id = H2C_8812_RSSI_REPORT; -+ #elif((RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1)) -+ platform_h2c_id = H2C_RSSI_SETTING; -+ #elif(RTL8192E_SUPPORT==1) -+ platform_h2c_id =H2C_8192E_RSSI_REPORT; -+ #elif(RTL8723B_SUPPORT==1) -+ platform_h2c_id =H2C_8723B_RSSI_SETTING; -+ #elif(RTL8188E_SUPPORT==1) -+ platform_h2c_id =H2C_RSSI_REPORT; -+ #elif(RTL8723A_SUPPORT==1) -+ platform_h2c_id =RSSI_SETTING_EID; -+ #elif(RTL8192D_SUPPORT==1) -+ platform_h2c_id =H2C_RSSI_REPORT; -+ #elif(RTL8192C_SUPPORT==1) -+ platform_h2c_id =RSSI_SETTING_EID; -+ #endif -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ #if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8814A || (pDM_Odm->SupportICType == ODM_RTL8822B)) -+ { -+ platform_h2c_id =H2C_88XX_RSSI_REPORT; -+ /*ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] H2C_88XX_RSSI_REPORT CMD_ID = (( %d ))\n", platform_h2c_id));*/ -+ } else -+ #endif -+ #if(RTL8812A_SUPPORT==1) -+ if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ platform_h2c_id = H2C_8812_RSSI_REPORT; -+ } else -+ #endif -+ {} -+ #endif -+ -+ break; -+ -+ //1 [3] -+ case ODM_H2C_WIFI_CALIBRATION: -+ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ platform_h2c_id =H2C_WIFI_CALIBRATION; -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ #if(RTL8723B_SUPPORT==1) -+ platform_h2c_id = H2C_8723B_BT_WLAN_CALIBRATION; -+ #endif -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ -+ #endif -+ -+ break; -+ -+ -+ //1 [4] -+ case ODM_H2C_IQ_CALIBRATION: -+ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ platform_h2c_id =H2C_IQ_CALIBRATION; -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ #if((RTL8812A_SUPPORT==1) ||(RTL8821A_SUPPORT==1)) -+ platform_h2c_id = H2C_8812_IQ_CALIBRATION; -+ #endif -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ -+ #endif -+ -+ break; -+ //1 [5] -+ case ODM_H2C_RA_PARA_ADJUST: -+ -+ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B)) -+ platform_h2c_id = H2C_8814A_RA_PARA_ADJUST; -+ else -+ platform_h2c_id = H2C_RA_PARA_ADJUST; -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ #if((RTL8812A_SUPPORT==1) ||(RTL8821A_SUPPORT==1)) -+ platform_h2c_id = H2C_8812_RA_PARA_ADJUST; -+ #elif(RTL8814A_SUPPORT == 1) -+ platform_h2c_id = H2C_RA_PARA_ADJUST; -+ #elif(RTL8192E_SUPPORT==1) -+ platform_h2c_id =H2C_8192E_RA_PARA_ADJUST; -+ #elif(RTL8723B_SUPPORT==1) -+ platform_h2c_id =H2C_8723B_RA_PARA_ADJUST; -+ #endif -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ #if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8814A || (pDM_Odm->SupportICType == ODM_RTL8822B)) { -+ platform_h2c_id =H2C_88XX_RA_PARA_ADJUST; -+ /*ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] H2C_88XX_RA_PARA_ADJUST CMD_ID = (( %d ))\n", platform_h2c_id));*/ -+ } else -+ #endif -+ #if(RTL8812A_SUPPORT==1) -+ if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ platform_h2c_id = H2C_8812_RA_PARA_ADJUST; -+ } else -+ #endif -+ {} -+ #endif -+ -+ break; -+ -+ -+ //1 [6] -+ case PHYDM_H2C_DYNAMIC_TX_PATH: -+ -+ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if(pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ platform_h2c_id =H2C_8814A_DYNAMIC_TX_PATH; -+ } -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ #if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ platform_h2c_id = H2C_DYNAMIC_TX_PATH; -+ #endif -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ #if(RTL8814A_SUPPORT==1) -+ if( pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ platform_h2c_id = H2C_88XX_DYNAMIC_TX_PATH; -+ } -+ #endif -+ -+ #endif -+ -+ break; -+ -+ /* [7]*/ -+ case PHYDM_H2C_FW_TRACE_EN: -+ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B)) -+ platform_h2c_id = H2C_8814A_FW_TRACE_EN; -+ else -+ platform_h2c_id = H2C_FW_TRACE_EN; -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ #if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8814A || (pDM_Odm->SupportICType == ODM_RTL8822B)) -+ platform_h2c_id = H2C_88XX_FW_TRACE_EN; -+ else -+ #endif -+ #if (RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) { -+ platform_h2c_id = H2C_8812_FW_TRACE_EN; -+ } else -+ #endif -+ {} -+ -+ #endif -+ -+ break; -+ -+ case PHYDM_H2C_TXBF: -+#if ((RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1)) -+ platform_h2c_id = 0x41; /*H2C_TxBF*/ -+#endif -+ break; -+ -+ default: -+ platform_h2c_id=0xff; -+ break; -+ } -+ -+ return platform_h2c_id; -+ -+} -+ -+// -+// ODM FW relative API. -+// -+ -+VOID -+ODM_FillH2CCmd( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte phydm_h2c_id, -+ IN u4Byte CmdLen, -+ IN pu1Byte pCmdBuffer -+) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ u1Byte platform_h2c_id; -+ -+ platform_h2c_id=phydm_trans_h2c_id(pDM_Odm, phydm_h2c_id); -+ -+ if(platform_h2c_id==0xff) -+ { -+ ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] Wrong H2C CMD-ID !! platform_h2c_id==0xff , PHYDM_ElementID=((%d )) \n",phydm_h2c_id)); -+ return; -+ } -+ -+ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ if (!pDM_Odm->RaSupport88E) -+ FillH2CCmd88E(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); -+ else if (pDM_Odm->SupportICType == ODM_RTL8192C) -+ FillH2CCmd92C(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); -+ else if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ FillH2CCmd8814A(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); -+ else if (pDM_Odm->SupportICType == ODM_RTL8822B) -+#if (RTL8822B_SUPPORT == 1) -+ FillH2CCmd8822B(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); -+#endif -+ else -+ FillH2CCmd(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_hal_fill_h2c_cmd(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ #if((RTL8881A_SUPPORT==1)||(RTL8192E_SUPPORT==1)||(RTL8814A_SUPPORT==1)) -+ if(pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E|| pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ GET_HAL_INTERFACE(pDM_Odm->priv)->FillH2CCmdHandler(pDM_Odm->priv, platform_h2c_id, CmdLen, pCmdBuffer); -+ //FillH2CCmd88XX(pDM_Odm->priv, platform_h2c_id, CmdLen, pCmdBuffer); -+ } else -+ #endif -+ #if(RTL8812A_SUPPORT==1) -+ if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ FillH2CCmd8812(pDM_Odm->priv, platform_h2c_id, CmdLen, pCmdBuffer); -+ } else -+ #endif -+ {} -+ #endif -+} -+ -+u1Byte -+phydm_c2H_content_parsing( -+ IN PVOID pDM_VOID, -+ IN u1Byte c2hCmdId, -+ IN u1Byte c2hCmdLen, -+ IN pu1Byte tmpBuf -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ #endif -+ u1Byte Extend_c2hSubID = 0; -+ u1Byte find_c2h_cmd = TRUE; -+ -+ switch (c2hCmdId) { -+ case PHYDM_C2H_DBG: -+ if (pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B)) -+ phydm_fw_trace_handler(pDM_Odm, tmpBuf, c2hCmdLen); -+ -+ break; -+ -+ case PHYDM_C2H_RA_RPT: -+ phydm_c2h_ra_report_handler(pDM_Odm, tmpBuf, c2hCmdLen); -+ break; -+ -+ case PHYDM_C2H_RA_PARA_RPT: -+ ODM_C2HRaParaReportHandler(pDM_Odm, tmpBuf, c2hCmdLen); -+ break; -+ -+ case PHYDM_C2H_DYNAMIC_TX_PATH_RPT: -+ if (pDM_Odm->SupportICType & (ODM_RTL8814A)) -+ phydm_c2h_dtp_handler(pDM_Odm, tmpBuf, c2hCmdLen); -+ -+ break; -+ -+ case PHYDM_C2H_IQK_FINISH: -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8821)) { -+ -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK Finish ==\n")); -+ PlatformAcquireSpinLock(Adapter, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; -+ PlatformReleaseSpinLock(Adapter, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime = 0; -+ pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime = ODM_GetProgressingTime(pDM_Odm, pDM_Odm->RFCalibrateInfo.IQK_StartTime); -+ } -+ -+ #endif -+ break; -+ -+ case PHYDM_C2H_DBG_CODE: -+ phydm_fw_trace_handler_code(pDM_Odm, tmpBuf, c2hCmdLen); -+ break; -+ -+ case PHYDM_C2H_EXTEND: -+ Extend_c2hSubID = tmpBuf[0]; -+ if (Extend_c2hSubID == PHYDM_EXTEND_C2H_DBG_PRINT) -+ phydm_fw_trace_handler_8051(pDM_Odm, tmpBuf, c2hCmdLen); -+ -+ break; -+ -+ default: -+ find_c2h_cmd = FALSE; -+ break; -+ } -+ -+ return find_c2h_cmd; -+ -+} -+ -+u8Byte -+ODM_GetCurrentTime( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ return 0; -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ return (u8Byte)rtw_get_current_time(); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return PlatformGetCurrentTime(); -+#endif -+} -+ -+u8Byte -+ODM_GetProgressingTime( -+ IN PDM_ODM_T pDM_Odm, -+ IN u8Byte Start_Time -+ ) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ return 0; -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ return rtw_get_passing_time_ms((u4Byte)Start_Time); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return ((PlatformGetCurrentTime() - Start_Time)>>10); -+#endif -+} -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_interface.h linux/3rdparty/rtl8812au/hal/phydm/phydm_interface.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_interface.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_interface.h 2017-06-07 23:07:21.018688214 +0300 -@@ -0,0 +1,442 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __ODM_INTERFACE_H__ -+#define __ODM_INTERFACE_H__ -+ -+#define INTERFACE_VERSION "1.0" /*2015.01.13 Dino*/ -+ -+// -+// =========== Constant/Structure/Enum/... Define -+// -+ -+ -+ -+// -+// =========== Macro Define -+// -+ -+#define _reg_all(_name) ODM_##_name -+#define _reg_ic(_name, _ic) ODM_##_name##_ic -+#define _bit_all(_name) BIT_##_name -+#define _bit_ic(_name, _ic) BIT_##_name##_ic -+ -+// _cat: implemented by Token-Pasting Operator. -+#if 0 -+#define _cat(_name, _ic_type, _func) \ -+ ( \ -+ _func##_all(_name) \ -+ ) -+#endif -+ -+/*=================================== -+ -+#define ODM_REG_DIG_11N 0xC50 -+#define ODM_REG_DIG_11AC 0xDDD -+ -+ODM_REG(DIG,_pDM_Odm) -+=====================================*/ -+ -+#define _reg_11N(_name) ODM_REG_##_name##_11N -+#define _reg_11AC(_name) ODM_REG_##_name##_11AC -+#define _bit_11N(_name) ODM_BIT_##_name##_11N -+#define _bit_11AC(_name) ODM_BIT_##_name##_11AC -+ -+#ifdef __ECOS -+#define _rtk_cat(_name, _ic_type, _func) \ -+ ( \ -+ ((_ic_type) & ODM_IC_11N_SERIES)? _func##_11N(_name): \ -+ _func##_11AC(_name) \ -+ ) -+#else -+ -+#define _cat(_name, _ic_type, _func) \ -+ ( \ -+ ((_ic_type) & ODM_IC_11N_SERIES)? _func##_11N(_name): \ -+ _func##_11AC(_name) \ -+ ) -+#endif -+/* -+// only sample code -+//#define _cat(_name, _ic_type, _func) \ -+// ( \ -+// ((_ic_type) & ODM_RTL8192C)? _func##_ic(_name, _8192C): \ -+// ((_ic_type) & ODM_RTL8192D)? _func##_ic(_name, _8192D): \ -+// ((_ic_type) & ODM_RTL8192S)? _func##_ic(_name, _8192S): \ -+// ((_ic_type) & ODM_RTL8723A)? _func##_ic(_name, _8723A): \ -+// ((_ic_type) & ODM_RTL8188E)? _func##_ic(_name, _8188E): \ -+// _func##_ic(_name, _8195) \ -+// ) -+*/ -+ -+// _name: name of register or bit. -+// Example: "ODM_REG(R_A_AGC_CORE1, pDM_Odm)" -+// gets "ODM_R_A_AGC_CORE1" or "ODM_R_A_AGC_CORE1_8192C", depends on SupportICType. -+#ifdef __ECOS -+#define ODM_REG(_name, _pDM_Odm) _rtk_cat(_name, _pDM_Odm->SupportICType, _reg) -+#define ODM_BIT(_name, _pDM_Odm) _rtk_cat(_name, _pDM_Odm->SupportICType, _bit) -+#else -+#define ODM_REG(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _reg) -+#define ODM_BIT(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _bit) -+#endif -+typedef enum _PHYDM_H2C_CMD { -+ ODM_H2C_RSSI_REPORT = 0, -+ ODM_H2C_PSD_RESULT = 1, -+ ODM_H2C_PathDiv = 2, -+ ODM_H2C_WIFI_CALIBRATION = 3, -+ ODM_H2C_IQ_CALIBRATION = 4, -+ ODM_H2C_RA_PARA_ADJUST = 5, -+ PHYDM_H2C_DYNAMIC_TX_PATH = 6, -+ PHYDM_H2C_FW_TRACE_EN = 7, -+ PHYDM_H2C_TXBF = 8, -+ ODM_MAX_H2CCMD -+} PHYDM_H2C_CMD; -+ -+typedef enum _PHYDM_C2H_EVT { -+ PHYDM_C2H_DBG = 0, -+ PHYDM_C2H_LB = 1, -+ PHYDM_C2H_XBF = 2, -+ PHYDM_C2H_TX_REPORT = 3, -+ PHYDM_C2H_INFO = 9, -+ PHYDM_C2H_BT_MP = 11, -+ PHYDM_C2H_RA_RPT = 12, -+ PHYDM_C2H_RA_PARA_RPT = 14, -+ PHYDM_C2H_DYNAMIC_TX_PATH_RPT = 15, -+ PHYDM_C2H_IQK_FINISH = 17, /*0x11*/ -+ PHYDM_C2H_DBG_CODE = 0xFE, -+ PHYDM_C2H_EXTEND = 0xFF, -+} PHYDM_C2H_EVT; -+ -+typedef enum _PHYDM_EXTEND_C2H_EVT { -+ PHYDM_EXTEND_C2H_DBG_PRINT = 0 -+ -+} PHYDM_EXTEND_C2H_EVT; -+ -+typedef enum _PHYDM_ACTING_TYPE { -+ PhyDM_ACTING_AS_IBSS = 0, -+ PhyDM_ACTING_AS_AP = 1 -+} PHYDM_ACTING_TYPE; -+ -+ -+// -+// 2012/02/17 MH For non-MP compile pass only. Linux does not support workitem. -+// Suggest HW team to use thread instead of workitem. Windows also support the feature. -+// -+#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) -+typedef void *PRT_WORK_ITEM ; -+typedef void RT_WORKITEM_HANDLE,*PRT_WORKITEM_HANDLE; -+typedef VOID (*RT_WORKITEM_CALL_BACK)(PVOID pContext); -+ -+#if 0 -+typedef struct tasklet_struct RT_WORKITEM_HANDLE, *PRT_WORKITEM_HANDLE; -+ -+typedef struct _RT_WORK_ITEM -+{ -+ -+ RT_WORKITEM_HANDLE Handle; // Platform-dependent handle for this workitem, e.g. Ndis Workitem object. -+ PVOID Adapter; // Pointer to Adapter object. -+ PVOID pContext; // Parameter to passed to CallBackFunc(). -+ RT_WORKITEM_CALL_BACK CallbackFunc; // Callback function of the workitem. -+ u1Byte RefCount; // 0: driver is going to unload, 1: No such workitem scheduled, 2: one workitem is schedueled. -+ PVOID pPlatformExt; // Pointer to platform-dependent extension. -+ BOOLEAN bFree; -+ char szID[36]; // An identity string of this workitem. -+}RT_WORK_ITEM, *PRT_WORK_ITEM; -+ -+#endif -+ -+ -+#endif -+ -+// -+// =========== Extern Variable ??? It should be forbidden. -+// -+ -+ -+// -+// =========== EXtern Function Prototype -+// -+ -+ -+u1Byte -+ODM_Read1Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr -+ ); -+ -+u2Byte -+ODM_Read2Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr -+ ); -+ -+u4Byte -+ODM_Read4Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr -+ ); -+ -+VOID -+ODM_Write1Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u1Byte Data -+ ); -+ -+VOID -+ODM_Write2Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u2Byte Data -+ ); -+ -+VOID -+ODM_Write4Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte Data -+ ); -+ -+VOID -+ODM_SetMACReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ); -+ -+u4Byte -+ODM_GetMACReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ); -+ -+VOID -+ODM_SetBBReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ); -+ -+u4Byte -+ODM_GetBBReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ); -+ -+VOID -+ODM_SetRFReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E eRFPath, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ); -+ -+u4Byte -+ODM_GetRFReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E eRFPath, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ); -+ -+ -+// -+// Memory Relative Function. -+// -+VOID -+ODM_AllocateMemory( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PVOID *pPtr, -+ IN u4Byte length -+ ); -+VOID -+ODM_FreeMemory( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PVOID pPtr, -+ IN u4Byte length -+ ); -+ -+VOID -+ODM_MoveMemory( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PVOID pDest, -+ IN PVOID pSrc, -+ IN u4Byte Length -+ ); -+ -+s4Byte ODM_CompareMemory( -+ IN PDM_ODM_T pDM_Odm, -+ IN PVOID pBuf1, -+ IN PVOID pBuf2, -+ IN u4Byte length -+ ); -+ -+void ODM_Memory_Set -+ (IN PDM_ODM_T pDM_Odm, -+ IN PVOID pbuf, -+ IN s1Byte value, -+ IN u4Byte length); -+ -+// -+// ODM MISC-spin lock relative API. -+// -+VOID -+ODM_AcquireSpinLock( -+ IN PDM_ODM_T pDM_Odm, -+ IN RT_SPINLOCK_TYPE type -+ ); -+ -+VOID -+ODM_ReleaseSpinLock( -+ IN PDM_ODM_T pDM_Odm, -+ IN RT_SPINLOCK_TYPE type -+ ); -+ -+ -+// -+// ODM MISC-workitem relative API. -+// -+VOID -+ODM_InitializeWorkItem( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_WORK_ITEM pRtWorkItem, -+ IN RT_WORKITEM_CALL_BACK RtWorkItemCallback, -+ IN PVOID pContext, -+ IN const char* szID -+ ); -+ -+VOID -+ODM_StartWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+VOID -+ODM_StopWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+VOID -+ODM_FreeWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+VOID -+ODM_ScheduleWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+VOID -+ODM_IsWorkItemScheduled( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+// -+// ODM Timer relative API. -+// -+VOID -+ODM_StallExecution( -+ IN u4Byte usDelay -+ ); -+ -+VOID -+ODM_delay_ms(IN u4Byte ms); -+ -+ -+ -+VOID -+ODM_delay_us(IN u4Byte us); -+ -+VOID -+ODM_sleep_ms(IN u4Byte ms); -+ -+VOID -+ODM_sleep_us(IN u4Byte us); -+ -+VOID -+ODM_SetTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer, -+ IN u4Byte msDelay -+ ); -+ -+VOID -+ODM_InitializeTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer, -+ IN RT_TIMER_CALL_BACK CallBackFunc, -+ IN PVOID pContext, -+ IN const char* szID -+ ); -+ -+VOID -+ODM_CancelTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer -+ ); -+ -+VOID -+ODM_ReleaseTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer -+ ); -+ -+BOOLEAN -+phydm_actingDetermine( -+ IN PDM_ODM_T pDM_Odm, -+ IN PHYDM_ACTING_TYPE type -+ ); -+ -+// -+// ODM FW relative API. -+// -+VOID -+ODM_FillH2CCmd( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte ElementID, -+ IN u4Byte CmdLen, -+ IN pu1Byte pCmdBuffer -+); -+ -+u1Byte -+phydm_c2H_content_parsing( -+ IN PVOID pDM_VOID, -+ IN u1Byte c2hCmdId, -+ IN u1Byte c2hCmdLen, -+ IN pu1Byte tmpBuf -+); -+ -+u8Byte -+ODM_GetCurrentTime( -+ IN PDM_ODM_T pDM_Odm -+ ); -+u8Byte -+ODM_GetProgressingTime( -+ IN PDM_ODM_T pDM_Odm, -+ IN u8Byte Start_Time -+ ); -+ -+#endif // __ODM_INTERFACE_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_noisemonitor.c linux/3rdparty/rtl8812au/hal/phydm/phydm_noisemonitor.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_noisemonitor.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_noisemonitor.c 2017-06-07 23:07:21.019688305 +0300 -@@ -0,0 +1,299 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+//#include "mp_precomp.h" -+#include "phydm_precomp.h" -+#include "phydm_noisemonitor.h" -+ -+//================================================= -+// This function is for inband noise test utility only -+// To obtain the inband noise level(dbm), do the following. -+// 1. disable DIG and Power Saving -+// 2. Set initial gain = 0x1a -+// 3. Stop updating idle time pwer report (for driver read) -+// - 0x80c[25] -+// -+//================================================= -+ -+#define Valid_Min -35 -+#define Valid_Max 10 -+#define ValidCnt 5 -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ -+s2Byte odm_InbandNoise_Monitor_NSeries(PDM_ODM_T pDM_Odm,u8 bPauseDIG,u8 IGIValue,u32 max_time) -+{ -+ u4Byte tmp4b; -+ u1Byte max_rf_path=0,rf_path; -+ u1Byte reg_c50, reg_c58,valid_done=0; -+ struct noise_level noise_data; -+ u32 start = 0, func_start=0, func_end = 0; -+ -+ func_start = ODM_GetCurrentTime(pDM_Odm); -+ pDM_Odm->noise_level.noise_all = 0; -+ -+ if((pDM_Odm->RFType == ODM_1T2R) ||(pDM_Odm->RFType == ODM_2T2R)) -+ max_rf_path = 2; -+ else -+ max_rf_path = 1; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("odm_DebugControlInbandNoise_Nseries() ==> \n")); -+ -+ ODM_Memory_Set(pDM_Odm,&noise_data,0,sizeof(struct noise_level)); -+ -+ // -+ // Step 1. Disable DIG && Set initial gain. -+ // -+ -+ if(bPauseDIG) -+ { -+ odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, IGIValue); -+ } -+ // -+ // Step 2. Disable all power save for read registers -+ // -+ //dcmd_DebugControlPowerSave(pAdapter, PSDisable); -+ -+ // -+ // Step 3. Get noise power level -+ // -+ start = ODM_GetCurrentTime(pDM_Odm); -+ while(1) -+ { -+ -+ //Stop updating idle time pwer report (for driver read) -+ ODM_SetBBReg(pDM_Odm, rFPGA0_TxGainStage, BIT25, 1); -+ -+ //Read Noise Floor Report -+ tmp4b = ODM_GetBBReg(pDM_Odm, 0x8f8,bMaskDWord ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("Noise Floor Report (0x8f8) = 0x%08x\n", tmp4b)); -+ -+ //ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0, TestInitialGain); -+ //if(max_rf_path == 2) -+ // ODM_SetBBReg(pDM_Odm, rOFDM0_XBAGCCore1, bMaskByte0, TestInitialGain); -+ -+ //update idle time pwer report per 5us -+ ODM_SetBBReg(pDM_Odm, rFPGA0_TxGainStage, BIT25, 0); -+ -+ noise_data.value[ODM_RF_PATH_A] = (u1Byte)(tmp4b&0xff); -+ noise_data.value[ODM_RF_PATH_B] = (u1Byte)((tmp4b&0xff00)>>8); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("value_a = 0x%x(%d), value_b = 0x%x(%d)\n", -+ noise_data.value[ODM_RF_PATH_A], noise_data.value[ODM_RF_PATH_A], noise_data.value[ODM_RF_PATH_B], noise_data.value[ODM_RF_PATH_B])); -+ -+ for(rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) -+ { -+ noise_data.sval[rf_path] = (s1Byte)noise_data.value[rf_path]; -+ noise_data.sval[rf_path] /= 2; -+ } -+ -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("sval_a = %d, sval_b = %d\n", -+ noise_data.sval[ODM_RF_PATH_A], noise_data.sval[ODM_RF_PATH_B])); -+ //ODM_delay_ms(10); -+ //ODM_sleep_ms(10); -+ -+ for(rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) -+ { -+ if( (noise_data.valid_cnt[rf_path] < ValidCnt) && (noise_data.sval[rf_path] < Valid_Max && noise_data.sval[rf_path] >= Valid_Min)) -+ { -+ noise_data.valid_cnt[rf_path]++; -+ noise_data.sum[rf_path] += noise_data.sval[rf_path]; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("RF_Path:%d Valid sval = %d\n", rf_path,noise_data.sval[rf_path])); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("Sum of sval = %d, \n", noise_data.sum[rf_path])); -+ if(noise_data.valid_cnt[rf_path] == ValidCnt) -+ { -+ valid_done++; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("After divided, RF_Path:%d ,sum = %d \n", rf_path,noise_data.sum[rf_path])); -+ } -+ -+ } -+ -+ } -+ -+ //printk("####### valid_done:%d #############\n",valid_done); -+ if ((valid_done==max_rf_path) || (ODM_GetProgressingTime(pDM_Odm,start) > max_time)) -+ { -+ for(rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) -+ { -+ //printk("%s PATH_%d - sum = %d, valid_cnt = %d \n",__FUNCTION__,rf_path,noise_data.sum[rf_path], noise_data.valid_cnt[rf_path]); -+ if(noise_data.valid_cnt[rf_path]) -+ noise_data.sum[rf_path] /= noise_data.valid_cnt[rf_path]; -+ else -+ noise_data.sum[rf_path] = 0; -+ } -+ break; -+ } -+ } -+ reg_c50 = (s4Byte)ODM_GetBBReg(pDM_Odm,rOFDM0_XAAGCCore1,bMaskByte0); -+ reg_c50 &= ~BIT7; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("0x%x = 0x%02x(%d)\n", rOFDM0_XAAGCCore1, reg_c50, reg_c50)); -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_A] = -110 + reg_c50 + noise_data.sum[ODM_RF_PATH_A]; -+ pDM_Odm->noise_level.noise_all += pDM_Odm->noise_level.noise[ODM_RF_PATH_A]; -+ -+ if(max_rf_path == 2){ -+ reg_c58 = (s4Byte)ODM_GetBBReg(pDM_Odm,rOFDM0_XBAGCCore1,bMaskByte0); -+ reg_c58 &= ~BIT7; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("0x%x = 0x%02x(%d)\n", rOFDM0_XBAGCCore1, reg_c58, reg_c58)); -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_B] = -110 + reg_c58 + noise_data.sum[ODM_RF_PATH_B]; -+ pDM_Odm->noise_level.noise_all += pDM_Odm->noise_level.noise[ODM_RF_PATH_B]; -+ } -+ pDM_Odm->noise_level.noise_all /= max_rf_path; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("noise_a = %d, noise_b = %d\n", -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_A], -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_B])); -+ -+ // -+ // Step 4. Recover the Dig -+ // -+ if(bPauseDIG) -+ { -+ odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, IGIValue); -+ } -+ func_end = ODM_GetProgressingTime(pDM_Odm,func_start) ; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_DebugControlInbandNoise_Nseries() <==\n")); -+ return pDM_Odm->noise_level.noise_all; -+ -+} -+ -+s2Byte -+odm_InbandNoise_Monitor_ACSeries(PDM_ODM_T pDM_Odm, u8 bPauseDIG, u8 IGIValue, u32 max_time -+ ) -+{ -+ s4Byte rxi_buf_anta, rxq_buf_anta; /*rxi_buf_antb, rxq_buf_antb;*/ -+ s4Byte value32, pwdb_A = 0, sval, noise, sum; -+ BOOLEAN pd_flag; -+ u1Byte i, valid_cnt; -+ u32 start = 0, func_start = 0, func_end = 0; -+ -+ -+ if (!(pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8821))) -+ return 0; -+ -+ func_start = ODM_GetCurrentTime(pDM_Odm); -+ pDM_Odm->noise_level.noise_all = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_InbandNoise_Monitor_ACSeries() ==>\n")); -+ -+ /* Step 1. Disable DIG && Set initial gain. */ -+ if (bPauseDIG) -+ odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, IGIValue); -+ -+ /* Step 2. Disable all power save for read registers */ -+ /*dcmd_DebugControlPowerSave(pAdapter, PSDisable); */ -+ -+ /* Step 3. Get noise power level */ -+ start = ODM_GetCurrentTime(pDM_Odm); -+ -+ /* reset counters */ -+ sum = 0; -+ valid_cnt = 0; -+ -+ /* Step 3. Get noise power level */ -+ while (1) { -+ /*Set IGI=0x1C */ -+ ODM_Write_DIG(pDM_Odm, 0x1C); -+ /*stop CK320&CK88 */ -+ ODM_SetBBReg(pDM_Odm, 0x8B4, BIT6, 1); -+ /*Read Path-A */ -+ ODM_SetBBReg(pDM_Odm, 0x8FC, bMaskDWord, 0x200); /*set debug port*/ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xFA0, bMaskDWord); /*read debug port*/ -+ -+ rxi_buf_anta = (value32 & 0xFFC00) >> 10; /*rxi_buf_anta=RegFA0[19:10]*/ -+ rxq_buf_anta = value32 & 0x3FF; /*rxq_buf_anta=RegFA0[19:10]*/ -+ -+ pd_flag = (BOOLEAN) ((value32 & BIT31) >> 31); -+ -+ /*Not in packet detection period or Tx state */ -+ if ((!pd_flag) || (rxi_buf_anta != 0x200)) { -+ /*sign conversion*/ -+ rxi_buf_anta = ODM_SignConversion(rxi_buf_anta, 10); -+ rxq_buf_anta = ODM_SignConversion(rxq_buf_anta, 10); -+ -+ pwdb_A = ODM_PWdB_Conversion(rxi_buf_anta * rxi_buf_anta + rxq_buf_anta * rxq_buf_anta, 20, 18); /*S(10,9)*S(10,9)=S(20,18)*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("pwdb_A= %d dB, rxi_buf_anta= 0x%x, rxq_buf_anta= 0x%x\n", pwdb_A, rxi_buf_anta & 0x3FF, rxq_buf_anta & 0x3FF)); -+ } -+ -+ /*BB Reset*/ -+ ODM_Write1Byte(pDM_Odm, 0x02, ODM_Read1Byte(pDM_Odm, 0x02) & (~BIT0)); -+ ODM_Write1Byte(pDM_Odm, 0x02, ODM_Read1Byte(pDM_Odm, 0x02) | BIT0); -+ -+ /*Start CK320&CK88*/ -+ ODM_SetBBReg(pDM_Odm, 0x8B4, BIT6, 0); -+ -+ sval = pwdb_A; -+ -+ if (sval < 0 && sval >= -27) { -+ if (valid_cnt < ValidCnt) { -+ valid_cnt++; -+ sum += sval; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Valid sval = %d\n", sval)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Sum of sval = %d,\n", sum)); -+ if ((valid_cnt >= ValidCnt) || (ODM_GetProgressingTime(pDM_Odm, start) > max_time)) { -+ sum /= valid_cnt; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("After divided, sum = %d\n", sum)); -+ break; -+ } -+ } -+ } -+ } -+ -+ /*ADC backoff is 12dB,*/ -+ /*Ptarget=0x1C-110=-82dBm*/ -+ noise = sum + 12 + 0x1C - 110; -+ -+ /*Offset*/ -+ noise = noise - 3; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("noise = %d\n", noise)); -+ pDM_Odm->noise_level.noise_all = (s2Byte)noise; -+ -+ /* Step 4. Recover the Dig*/ -+ if (bPauseDIG) -+ odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, IGIValue); -+ -+ func_end = ODM_GetProgressingTime(pDM_Odm, func_start); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_InbandNoise_Monitor_ACSeries() <==\n")); -+ -+ return pDM_Odm->noise_level.noise_all; -+} -+ -+ -+ -+s2Byte -+ODM_InbandNoise_Monitor(PVOID pDM_VOID, u8 bPauseDIG, u8 IGIValue, u32 max_time) -+{ -+ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ return odm_InbandNoise_Monitor_ACSeries(pDM_Odm, bPauseDIG, IGIValue, max_time); -+ else -+ return odm_InbandNoise_Monitor_NSeries(pDM_Odm, bPauseDIG, IGIValue, max_time); -+} -+ -+#endif -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_noisemonitor.h linux/3rdparty/rtl8812au/hal/phydm/phydm_noisemonitor.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_noisemonitor.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_noisemonitor.h 2017-06-07 23:07:21.019688305 +0300 -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ *****************************************************************************/ -+#ifndef __ODMNOISEMONITOR_H__ -+#define __ODMNOISEMONITOR_H__ -+ -+#define ODM_MAX_CHANNEL_NUM 38//14+24 -+struct noise_level -+{ -+ //u1Byte value_a, value_b; -+ u1Byte value[MAX_RF_PATH]; -+ //s1Byte sval_a, sval_b; -+ s1Byte sval[MAX_RF_PATH]; -+ -+ //s4Byte noise_a=0, noise_b=0,sum_a=0, sum_b=0; -+ //s4Byte noise[ODM_RF_PATH_MAX]; -+ s4Byte sum[MAX_RF_PATH]; -+ //u1Byte valid_cnt_a=0, valid_cnt_b=0, -+ u1Byte valid[MAX_RF_PATH]; -+ u1Byte valid_cnt[MAX_RF_PATH]; -+ -+}; -+ -+ -+typedef struct _ODM_NOISE_MONITOR_ -+{ -+ s1Byte noise[MAX_RF_PATH]; -+ s2Byte noise_all; -+}ODM_NOISE_MONITOR; -+ -+s2Byte ODM_InbandNoise_Monitor(PVOID pDM_VOID,u8 bPauseDIG,u8 IGIValue,u32 max_time); -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_pathdiv.c linux/3rdparty/rtl8812au/hal/phydm/phydm_pathdiv.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_pathdiv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_pathdiv.c 2017-06-07 23:07:21.019688305 +0300 -@@ -0,0 +1,2316 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if(defined(CONFIG_PATH_DIVERSITY)) -+#if RTL8814A_SUPPORT -+ -+VOID -+phydm_dtp_fix_tx_path( -+ IN PVOID pDM_VOID, -+ IN u1Byte path -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; -+ u1Byte i,num_enable_path=0; -+ -+ if(path==pDM_PathDiv->pre_tx_path) -+ { -+ return; -+ } -+ else -+ { -+ pDM_PathDiv->pre_tx_path=path; -+ } -+ -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT18|BIT19, 3); -+ -+ for(i=0; i<4; i++) -+ { -+ if(path&BIT(i)) -+ num_enable_path++; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Number of trun-on path : (( %d ))\n", num_enable_path)); -+ -+ if(num_enable_path == 1) -+ { -+ ODM_SetBBReg( pDM_Odm, 0x93c, 0xf00000, path); -+ -+ if(path==PHYDM_A)//1-1 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A ))\n")); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ } -+ else if(path==PHYDM_B)//1-2 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B ))\n")); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); -+ } -+ else if(path==PHYDM_C)//1-3 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( C ))\n")); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 0); -+ -+ } -+ else if(path==PHYDM_D)//1-4 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( D ))\n")); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 0); -+ } -+ -+ } -+ else if(num_enable_path == 2) -+ { -+ ODM_SetBBReg( pDM_Odm, 0x93c, 0xf00000, path); -+ ODM_SetBBReg( pDM_Odm, 0x940, 0xf0, path); -+ -+ if(path==PHYDM_AB)//2-1 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 1); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 1); -+ } -+ else if(path==PHYDM_AC)//2-2 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A C ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); -+ } -+ else if(path==PHYDM_AD)//2-3 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A D ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 1); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 1); -+ } -+ else if(path==PHYDM_BC)//2-4 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B C ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); -+ } -+ else if(path==PHYDM_BD)//2-5 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B D ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 1); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 1); -+ } -+ else if(path==PHYDM_CD)//2-6 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( C D ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 1); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 1); -+ } -+ -+ } -+ else if(num_enable_path == 3) -+ { -+ ODM_SetBBReg( pDM_Odm, 0x93c, 0xf00000, path); -+ ODM_SetBBReg( pDM_Odm, 0x940, 0xf0, path); -+ ODM_SetBBReg( pDM_Odm, 0x940, 0xf0000, path); -+ -+ if(path==PHYDM_ABC)//3-1 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B C))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 1); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 2); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 2); -+ //set for 3ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT21|BIT20, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT23|BIT22, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT25|BIT24, 2); -+ } -+ else if(path==PHYDM_ABD)//3-2 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B D ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 1); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 2); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 2); -+ //set for 3ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT21|BIT20, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT23|BIT22, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT27|BIT26, 2); -+ -+ } -+ else if(path==PHYDM_ACD)//3-3 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A C D ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 2); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 2); -+ //set for 3ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT21|BIT20, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT25|BIT24, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT27|BIT26, 2); -+ } -+ else if(path==PHYDM_BCD)//3-4 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B C D))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 2); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 2); -+ //set for 3ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT23|BIT22, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT25|BIT24, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT27|BIT26, 2); -+ } -+ } -+ else if(num_enable_path == 4) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path ((A B C D))\n")); -+ } -+ -+} -+ -+VOID -+phydm_find_default_path( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; -+ u4Byte rssi_avg_a=0, rssi_avg_b=0, rssi_avg_c=0, rssi_avg_d=0, rssi_avg_bcd=0; -+ u4Byte rssi_total_a=0, rssi_total_b=0, rssi_total_c=0, rssi_total_d=0; -+ -+ //2 Default Path Selection By RSSI -+ -+ rssi_avg_a = (pDM_PathDiv->path_a_cnt_all > 0)? (pDM_PathDiv->path_a_sum_all / pDM_PathDiv->path_a_cnt_all) :0 ; -+ rssi_avg_b = (pDM_PathDiv->path_b_cnt_all > 0)? (pDM_PathDiv->path_b_sum_all / pDM_PathDiv->path_b_cnt_all) :0 ; -+ rssi_avg_c = (pDM_PathDiv->path_c_cnt_all > 0)? (pDM_PathDiv->path_c_sum_all / pDM_PathDiv->path_c_cnt_all) :0 ; -+ rssi_avg_d = (pDM_PathDiv->path_d_cnt_all > 0)? (pDM_PathDiv->path_d_sum_all / pDM_PathDiv->path_d_cnt_all) :0 ; -+ -+ -+ pDM_PathDiv->path_a_sum_all = 0; -+ pDM_PathDiv->path_a_cnt_all = 0; -+ pDM_PathDiv->path_b_sum_all = 0; -+ pDM_PathDiv->path_b_cnt_all = 0; -+ pDM_PathDiv->path_c_sum_all = 0; -+ pDM_PathDiv->path_c_cnt_all = 0; -+ pDM_PathDiv->path_d_sum_all = 0; -+ pDM_PathDiv->path_d_cnt_all = 0; -+ -+ if(pDM_PathDiv->use_path_a_as_default_ant == 1) -+ { -+ rssi_avg_bcd=(rssi_avg_b+rssi_avg_c+rssi_avg_d)/3; -+ -+ if( (rssi_avg_a + ANT_DECT_RSSI_TH) > rssi_avg_bcd ) -+ { -+ pDM_PathDiv->is_pathA_exist=TRUE; -+ pDM_PathDiv->default_path=PATH_A; -+ } -+ else -+ { -+ pDM_PathDiv->is_pathA_exist=FALSE; -+ } -+ } -+ else -+ { -+ if( (rssi_avg_a >=rssi_avg_b) && (rssi_avg_a >=rssi_avg_c)&&(rssi_avg_a >=rssi_avg_d)) -+ pDM_PathDiv->default_path=PATH_A; -+ else if( (rssi_avg_b >=rssi_avg_c)&&(rssi_avg_b >=rssi_avg_d)) -+ pDM_PathDiv->default_path=PATH_B; -+ else if( rssi_avg_c >=rssi_avg_d) -+ pDM_PathDiv->default_path=PATH_C; -+ else -+ pDM_PathDiv->default_path=PATH_D; -+ } -+ -+ -+} -+ -+ -+VOID -+phydm_candidate_dtp_update( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; -+ -+ pDM_PathDiv->num_candidate=3; -+ -+ if(pDM_PathDiv->use_path_a_as_default_ant == 1) -+ { -+ if(pDM_PathDiv->num_tx_path==3) -+ { -+ if(pDM_PathDiv->is_pathA_exist) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_ABD; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_ACD; -+ } -+ else // use path BCD -+ { -+ pDM_PathDiv->num_candidate=1; -+ phydm_dtp_fix_tx_path(pDM_Odm, PHYDM_BCD); -+ return; -+ } -+ } -+ else if(pDM_PathDiv->num_tx_path==2) -+ { -+ if(pDM_PathDiv->is_pathA_exist) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_AB; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_AC; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_AD; -+ } -+ else -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_BC; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_BD; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_CD; -+ } -+ } -+ } -+ else -+ { -+ //2 3 TX Mode -+ if(pDM_PathDiv->num_tx_path==3)//choose 3 ant form 4 -+ { -+ if(pDM_PathDiv->default_path == PATH_A) //choose 2 ant form 3 -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_ABD; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_ACD; -+ } -+ else if(pDM_PathDiv->default_path==PATH_B) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_ABD; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_BCD; -+ } -+ else if(pDM_PathDiv->default_path == PATH_C) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_ACD; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_BCD; -+ } -+ else if(pDM_PathDiv->default_path == PATH_D) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_ABD; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_ACD; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_BCD; -+ } -+ } -+ -+ //2 2 TX Mode -+ else if(pDM_PathDiv->num_tx_path==2)//choose 2 ant form 4 -+ { -+ if(pDM_PathDiv->default_path == PATH_A) //choose 2 ant form 3 -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_AB; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_AC; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_AD; -+ } -+ else if(pDM_PathDiv->default_path==PATH_B) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_AB; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_BC; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_BD; -+ } -+ else if(pDM_PathDiv->default_path == PATH_C) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_AC; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_BC; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_CD; -+ } -+ else if(pDM_PathDiv->default_path == PATH_D) -+ { -+ pDM_PathDiv->ant_candidate_1= PHYDM_AD; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_BD; -+ pDM_PathDiv->ant_candidate_3= PHYDM_CD; -+ } -+ } -+ } -+} -+ -+ -+VOID -+phydm_dynamic_tx_path( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; -+ -+ PSTA_INFO_T pEntry; -+ u4Byte i; -+ u1Byte num_client=0; -+ u1Byte H2C_Parameter[6] ={0}; -+ -+ -+ if(!pDM_Odm->bLinked) //bLinked==False -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("DTP_8814 [No Link!!!]\n")); -+ -+ if(pDM_PathDiv->bBecomeLinked == TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" [Be disconnected]----->\n")); -+ pDM_PathDiv->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ return; -+ } -+ else -+ { -+ if(pDM_PathDiv->bBecomeLinked ==FALSE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" [Be Linked !!!]----->\n")); -+ pDM_PathDiv->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ } -+ -+ //2 [Period CTRL] -+ if(pDM_PathDiv->dtp_period >=2) -+ { -+ pDM_PathDiv->dtp_period=0; -+ } -+ else -+ { -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Phydm_Dynamic_Tx_Path_8814A() Stay = (( %d ))\n",pDM_PathDiv->dtp_period)); -+ pDM_PathDiv->dtp_period++; -+ return; -+ } -+ -+ -+ //2 [Fix Path] -+ if (pDM_Odm->path_select != PHYDM_AUTO_PATH) -+ { -+ return; -+ } -+ -+ //2 [Check Bfer] -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #if (BEAMFORMING_SUPPORT == 1) -+ { -+ BEAMFORMING_CAP BeamformCap = (pDM_Odm->BeamformingInfo.BeamformCap); -+ -+ if( BeamformCap & BEAMFORMER_CAP ) // BFmer On && Div On -> Div Off -+ { -+ if( pDM_PathDiv->fix_path_bfer == 0) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("[ PathDiv : OFF ] BFmer ==1 \n")); -+ pDM_PathDiv->fix_path_bfer = 1 ; -+ } -+ return; -+ } -+ else // BFmer Off && Div Off -> Div On -+ { -+ if( pDM_PathDiv->fix_path_bfer == 1 ) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("[ PathDiv : ON ] BFmer ==0 \n")); -+ pDM_PathDiv->fix_path_bfer = 0; -+ } -+ } -+ } -+ #endif -+ #endif -+ -+ if(pDM_PathDiv->use_path_a_as_default_ant ==1) -+ { -+ phydm_find_default_path(pDM_Odm); -+ phydm_candidate_dtp_update(pDM_Odm); -+ } -+ else -+ { -+ if( pDM_PathDiv->dtp_state == PHYDM_DTP_INIT) -+ { -+ phydm_find_default_path(pDM_Odm); -+ phydm_candidate_dtp_update(pDM_Odm); -+ pDM_PathDiv->dtp_state = PHYDM_DTP_RUNNING_1; -+ } -+ -+ else if( pDM_PathDiv->dtp_state == PHYDM_DTP_RUNNING_1) -+ { -+ pDM_PathDiv->dtp_check_patha_counter++; -+ -+ if(pDM_PathDiv->dtp_check_patha_counter>=NUM_RESET_DTP_PERIOD) -+ { -+ pDM_PathDiv->dtp_check_patha_counter=0; -+ pDM_PathDiv->dtp_state = PHYDM_DTP_INIT; -+ } -+ //2 Search space update -+ else -+ { -+ // 1. find the worst candidate -+ -+ -+ // 2. repalce the worst candidate -+ } -+ } -+ } -+ -+ //2 Dynamic Path Selection H2C -+ -+ if(pDM_PathDiv->num_candidate == 1) -+ { -+ return; -+ } -+ else -+ { -+ H2C_Parameter[0] = pDM_PathDiv->num_candidate; -+ H2C_Parameter[1] = pDM_PathDiv->num_tx_path; -+ H2C_Parameter[2] = pDM_PathDiv->ant_candidate_1; -+ H2C_Parameter[3] = pDM_PathDiv->ant_candidate_2; -+ H2C_Parameter[4] = pDM_PathDiv->ant_candidate_3; -+ -+ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_DYNAMIC_TX_PATH, 6, H2C_Parameter); -+ } -+ -+} -+ -+ -+ -+VOID -+phydm_dynamic_tx_path_init( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ USB_MODE_MECH *pUsbModeMech = &pAdapter->UsbModeMechanism; -+ #endif -+ u1Byte search_space_2[NUM_CHOOSE2_FROM4]= {PHYDM_AB, PHYDM_AC, PHYDM_AD, PHYDM_BC, PHYDM_BD, PHYDM_CD }; -+ u1Byte search_space_3[NUM_CHOOSE3_FROM4]= {PHYDM_BCD, PHYDM_ACD, PHYDM_ABD, PHYDM_ABC}; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pDM_PathDiv->is_u3_mode = (pUsbModeMech->CurUsbMode==USB_MODE_U3)? 1 : 0 ; -+ #else -+ pDM_PathDiv->is_u3_mode = 1; -+ #endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Dynamic TX Path Init 8814\n")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("is_u3_mode = (( %d ))\n", pDM_PathDiv->is_u3_mode)); -+ -+ memcpy(&(pDM_PathDiv->search_space_2[0]), &(search_space_2[0]), NUM_CHOOSE2_FROM4); -+ memcpy(&(pDM_PathDiv->search_space_3[0]), &(search_space_3[0]), NUM_CHOOSE3_FROM4); -+ -+ pDM_PathDiv->use_path_a_as_default_ant= 1; -+ pDM_PathDiv->dtp_state = PHYDM_DTP_INIT; -+ pDM_Odm->path_select = PHYDM_AUTO_PATH; -+ pDM_PathDiv->path_div_type = PHYDM_4R_PATH_DIV; -+ -+ -+ if(pDM_PathDiv->is_u3_mode ) -+ { -+ pDM_PathDiv->num_tx_path=3; -+ phydm_dtp_fix_tx_path(pDM_Odm, PHYDM_BCD);/* 3TX Set Init TX Path*/ -+ -+ } -+ else -+ { -+ pDM_PathDiv->num_tx_path=2; -+ phydm_dtp_fix_tx_path(pDM_Odm, PHYDM_BC);/* 2TX // Set Init TX Path*/ -+ } -+ -+} -+ -+ -+VOID -+phydm_process_rssi_for_path_div( -+ IN OUT PVOID pDM_VOID, -+ IN PVOID p_phy_info_void, -+ IN PVOID p_pkt_info_void -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_PHY_INFO_T pPhyInfo=(PODM_PHY_INFO_T)p_phy_info_void; -+ PODM_PACKET_INFO_T pPktinfo=(PODM_PACKET_INFO_T)p_pkt_info_void; -+ pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); -+ -+ if(pPktinfo->bPacketToSelf || pPktinfo->bPacketMatchBSSID) -+ { -+ if(pPktinfo->DataRate > ODM_RATE11M) -+ { -+ if(pDM_PathDiv->path_div_type == PHYDM_4R_PATH_DIV) -+ { -+ #if RTL8814A_SUPPORT -+ if(pDM_Odm->SupportICType & ODM_RTL8814A) -+ { -+ pDM_PathDiv->path_a_sum_all+=pPhyInfo->RxMIMOSignalStrength[0]; -+ pDM_PathDiv->path_a_cnt_all++; -+ -+ pDM_PathDiv->path_b_sum_all+=pPhyInfo->RxMIMOSignalStrength[1]; -+ pDM_PathDiv->path_b_cnt_all++; -+ -+ pDM_PathDiv->path_c_sum_all+=pPhyInfo->RxMIMOSignalStrength[2]; -+ pDM_PathDiv->path_c_cnt_all++; -+ -+ pDM_PathDiv->path_d_sum_all+=pPhyInfo->RxMIMOSignalStrength[3]; -+ pDM_PathDiv->path_d_cnt_all++; -+ } -+ #endif -+ } -+ else -+ { -+ pDM_PathDiv->PathA_Sum[pPktinfo->StationID]+=pPhyInfo->RxMIMOSignalStrength[0]; -+ pDM_PathDiv->PathA_Cnt[pPktinfo->StationID]++; -+ -+ pDM_PathDiv->PathB_Sum[pPktinfo->StationID]+=pPhyInfo->RxMIMOSignalStrength[1]; -+ pDM_PathDiv->PathB_Cnt[pPktinfo->StationID]++; -+ } -+ } -+ } -+ -+ -+} -+ -+#endif //#if RTL8814A_SUPPORT -+ -+VOID -+odm_pathdiv_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ pDM_Odm->path_select = (dm_value[0] & 0xf); -+ PHYDM_SNPRINTF((output+used, out_len-used,"Path_select = (( 0x%x ))\n",pDM_Odm->path_select )); -+ -+ //2 [Fix Path] -+ if (pDM_Odm->path_select != PHYDM_AUTO_PATH) -+ { -+ PHYDM_SNPRINTF((output+used, out_len-used,"Trun on path [%s%s%s%s]\n", -+ ((pDM_Odm->path_select) & 0x1)?"A":"", -+ ((pDM_Odm->path_select) & 0x2)?"B":"", -+ ((pDM_Odm->path_select) & 0x4)?"C":"", -+ ((pDM_Odm->path_select) & 0x8)?"D":"" )); -+ -+ phydm_dtp_fix_tx_path( pDM_Odm, pDM_Odm->path_select ); -+ } -+ else -+ { -+ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n","Auto Path")); -+ } -+} -+ -+#endif // #if(defined(CONFIG_PATH_DIVERSITY)) -+ -+VOID -+phydm_c2h_dtp_handler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+) -+{ -+#if(defined(CONFIG_PATH_DIVERSITY)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); -+ -+ u1Byte macid = CmdBuf[0]; -+ u1Byte target = CmdBuf[1]; -+ u1Byte nsc_1 = CmdBuf[2]; -+ u1Byte nsc_2 = CmdBuf[3]; -+ u1Byte nsc_3 = CmdBuf[4]; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Target_candidate = (( %d ))\n", target)); -+ /* -+ if( (nsc_1 >= nsc_2) && (nsc_1 >= nsc_3)) -+ { -+ phydm_dtp_fix_tx_path(pDM_Odm, pDM_PathDiv->ant_candidate_1); -+ } -+ else if( nsc_2 >= nsc_3) -+ { -+ phydm_dtp_fix_tx_path(pDM_Odm, pDM_PathDiv->ant_candidate_2); -+ } -+ else -+ { -+ phydm_dtp_fix_tx_path(pDM_Odm, pDM_PathDiv->ant_candidate_3); -+ } -+ */ -+#endif -+} -+ -+VOID -+odm_PathDiversity( -+ IN PVOID pDM_VOID -+) -+{ -+#if(defined(CONFIG_PATH_DIVERSITY)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if(!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Return: Not Support PathDiv\n")); -+ return; -+ } -+ -+ #if RTL8812A_SUPPORT -+ -+ if(pDM_Odm->SupportICType & ODM_RTL8812) -+ ODM_PathDiversity_8812A(pDM_Odm); -+ else -+ #endif -+ -+ #if RTL8814A_SUPPORT -+ if(pDM_Odm->SupportICType & ODM_RTL8814A) -+ phydm_dynamic_tx_path(pDM_Odm); -+ else -+ #endif -+ {} -+#endif -+} -+ -+VOID -+odm_PathDiversityInit( -+ IN PVOID pDM_VOID -+) -+{ -+#if(defined(CONFIG_PATH_DIVERSITY)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /*pDM_Odm->SupportAbility |= ODM_BB_PATH_DIV;*/ -+ -+ if(pDM_Odm->mp_mode == TRUE) -+ return; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Return: Not Support PathDiv\n")); -+ return; -+ } -+ -+#if RTL8812A_SUPPORT -+ if(pDM_Odm->SupportICType & ODM_RTL8812) -+ ODM_PathDiversityInit_8812A(pDM_Odm); -+ else -+ #endif -+ -+ #if RTL8814A_SUPPORT -+ if(pDM_Odm->SupportICType & ODM_RTL8814A) -+ phydm_dynamic_tx_path_init(pDM_Odm); -+ else -+ #endif -+ {} -+#endif -+} -+ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+// -+// 2011/12/02 MH Copy from MP oursrc for temporarily test. -+// -+#if RTL8192C_SUPPORT -+BOOLEAN -+odm_IsConnected_92C( -+ IN PADAPTER Adapter -+) -+{ -+ PRT_WLAN_STA pEntry; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ u4Byte i; -+ BOOLEAN bConnected=FALSE; -+ -+ if(pMgntInfo->mAssoc) -+ { -+ bConnected = TRUE; -+ } -+ else -+ { -+ for(i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) -+ { -+ if(IsAPModeExist(Adapter) && GetFirstExtAdapter(Adapter) != NULL) -+ pEntry = AsocEntry_EnumStation(GetFirstExtAdapter(Adapter), i); -+ else -+ pEntry = AsocEntry_EnumStation(GetDefaultAdapter(Adapter), i); -+ -+ if(pEntry!=NULL) -+ { -+ if(pEntry->bAssociated) -+ { -+ bConnected = TRUE; -+ break; -+ } -+ } -+ else -+ { -+ break; -+ } -+ } -+ } -+ return bConnected; -+} -+ -+BOOLEAN -+ODM_PathDiversityBeforeLink92C( -+ //IN PADAPTER Adapter -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (RT_MEM_SIZE_LEVEL != RT_MEM_SIZE_MINIMUM) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE* pHalData = NULL; -+ PMGNT_INFO pMgntInfo = NULL; -+ //pSWAT_T pDM_SWAT_Table = &Adapter->DM_SWAT_Table; -+ pPD_T pDM_PDTable = NULL; -+ -+ s1Byte Score = 0; -+ PRT_WLAN_BSS pTmpBssDesc; -+ PRT_WLAN_BSS pTestBssDesc; -+ -+ u1Byte target_chnl = 0; -+ u2Byte index; -+ -+ if (pDM_Odm->Adapter == NULL) //For BSOD when plug/unplug fast. //By YJ,120413 -+ { // The ODM structure is not initialized. -+ return FALSE; -+ } -+ pHalData = GET_HAL_DATA(Adapter); -+ pMgntInfo = &Adapter->MgntInfo; -+ pDM_PDTable = &Adapter->DM_PDTable; -+ -+ // Condition that does not need to use path diversity. -+ if((!(pHalData->CVID_Version==VERSION_1_BEFORE_8703B && IS_92C_SERIAL(pHalData->VersionID))) || (pHalData->PathDivCfg!=1) || pMgntInfo->AntennaTest ) -+ { -+ RT_TRACE(COMP_INIT, DBG_LOUD, -+ ("ODM_PathDiversityBeforeLink92C(): No PathDiv Mechanism before link.\n")); -+ return FALSE; -+ } -+ -+ // Since driver is going to set BB register, it shall check if there is another thread controlling BB/RF. -+ PlatformAcquireSpinLock(Adapter, RT_RF_STATE_SPINLOCK); -+ if(pHalData->eRFPowerState!=eRfOn || pMgntInfo->RFChangeInProgress || pMgntInfo->bMediaConnect) -+ { -+ PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK); -+ -+ RT_TRACE(COMP_INIT, DBG_LOUD, -+ ("ODM_PathDiversityBeforeLink92C(): RFChangeInProgress(%x), eRFPowerState(%x)\n", -+ pMgntInfo->RFChangeInProgress, -+ pHalData->eRFPowerState)); -+ -+ //pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ pDM_PDTable->PathDiv_NoLink_State = 0; -+ -+ return FALSE; -+ } -+ else -+ { -+ PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK); -+ } -+ -+ //1 Run AntDiv mechanism "Before Link" part. -+ //if(pDM_SWAT_Table->SWAS_NoLink_State == 0) -+ if(pDM_PDTable->PathDiv_NoLink_State == 0) -+ { -+ //1 Prepare to do Scan again to check current antenna state. -+ -+ // Set check state to next step. -+ //pDM_SWAT_Table->SWAS_NoLink_State = 1; -+ pDM_PDTable->PathDiv_NoLink_State = 1; -+ -+ // Copy Current Scan list. -+ Adapter->MgntInfo.tmpNumBssDesc = pMgntInfo->NumBssDesc; -+ PlatformMoveMemory((PVOID)Adapter->MgntInfo.tmpbssDesc, (PVOID)pMgntInfo->bssDesc, sizeof(RT_WLAN_BSS)*MAX_BSS_DESC); -+ -+ // Switch Antenna to another one. -+ if(pDM_PDTable->DefaultRespPath == 0) -+ { -+ PHY_SetBBReg(Adapter, rCCK0_AFESetting , 0x0F000000, 0x05); // TRX path = PathB -+ odm_SetRespPath_92C(Adapter, 1); -+ pDM_PDTable->OFDMTXPath = 0xFFFFFFFF; -+ pDM_PDTable->CCKTXPath = 0xFFFFFFFF; -+ } -+ else -+ { -+ PHY_SetBBReg(Adapter, rCCK0_AFESetting , 0x0F000000, 0x00); // TRX path = PathA -+ odm_SetRespPath_92C(Adapter, 0); -+ pDM_PDTable->OFDMTXPath = 0x0; -+ pDM_PDTable->CCKTXPath = 0x0; -+ } -+#if 0 -+ -+ pDM_SWAT_Table->PreAntenna = pDM_SWAT_Table->CurAntenna; -+ pDM_SWAT_Table->CurAntenna = (pDM_SWAT_Table->CurAntenna==Antenna_A)?Antenna_B:Antenna_A; -+ -+ RT_TRACE(COMP_INIT, DBG_LOUD, -+ ("ODM_SwAntDivCheckBeforeLink: Change to Ant(%s) for testing.\n", (pDM_SWAT_Table->CurAntenna==Antenna_A)?"A":"B")); -+ //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300, DM_SWAT_Table.CurAntenna); -+ pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 = ((pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 & 0xfffffcff) | (pDM_SWAT_Table->CurAntenna<<8)); -+ PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, bMaskDWord, pDM_SWAT_Table->SWAS_NoLink_BK_Reg860); -+#endif -+ -+ // Go back to scan function again. -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("ODM_PathDiversityBeforeLink92C: Scan one more time\n")); -+ pMgntInfo->ScanStep=0; -+ target_chnl = odm_SwAntDivSelectScanChnl(Adapter); -+ odm_SwAntDivConstructScanChnl(Adapter, target_chnl); -+ PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5); -+ -+ return TRUE; -+ } -+ else -+ { -+ //1 ScanComple() is called after antenna swiched. -+ //1 Check scan result and determine which antenna is going -+ //1 to be used. -+ -+ for(index=0; indexMgntInfo.tmpNumBssDesc; index++) -+ { -+ pTmpBssDesc = &(Adapter->MgntInfo.tmpbssDesc[index]); -+ pTestBssDesc = &(pMgntInfo->bssDesc[index]); -+ -+ if(PlatformCompareMemory(pTestBssDesc->bdBssIdBuf, pTmpBssDesc->bdBssIdBuf, 6)!=0) -+ { -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("ODM_PathDiversityBeforeLink92C(): ERROR!! This shall not happen.\n")); -+ continue; -+ } -+ -+ if(pTmpBssDesc->RecvSignalPower > pTestBssDesc->RecvSignalPower) -+ { -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("ODM_PathDiversityBeforeLink92C: Compare scan entry: Score++\n")); -+ RT_PRINT_STR(COMP_INIT, DBG_LOUD, "SSID: ", pTestBssDesc->bdSsIdBuf, pTestBssDesc->bdSsIdLen); -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ -+ Score++; -+ PlatformMoveMemory(pTestBssDesc, pTmpBssDesc, sizeof(RT_WLAN_BSS)); -+ } -+ else if(pTmpBssDesc->RecvSignalPower < pTestBssDesc->RecvSignalPower) -+ { -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("ODM_PathDiversityBeforeLink92C: Compare scan entry: Score--\n")); -+ RT_PRINT_STR(COMP_INIT, DBG_LOUD, "SSID: ", pTestBssDesc->bdSsIdBuf, pTestBssDesc->bdSsIdLen); -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ Score--; -+ } -+ -+ } -+ -+ if(pMgntInfo->NumBssDesc!=0 && Score<=0) -+ { -+ RT_TRACE(COMP_INIT, DBG_LOUD, -+ ("ODM_PathDiversityBeforeLink92C(): DefaultRespPath=%d\n", pDM_PDTable->DefaultRespPath)); -+ -+ //pDM_SWAT_Table->PreAntenna = pDM_SWAT_Table->CurAntenna; -+ } -+ else -+ { -+ RT_TRACE(COMP_INIT, DBG_LOUD, -+ ("ODM_PathDiversityBeforeLink92C(): DefaultRespPath=%d\n", pDM_PDTable->DefaultRespPath)); -+ -+ if(pDM_PDTable->DefaultRespPath == 0) -+ { -+ pDM_PDTable->OFDMTXPath = 0xFFFFFFFF; -+ pDM_PDTable->CCKTXPath = 0xFFFFFFFF; -+ odm_SetRespPath_92C(Adapter, 1); -+ } -+ else -+ { -+ pDM_PDTable->OFDMTXPath = 0x0; -+ pDM_PDTable->CCKTXPath = 0x0; -+ odm_SetRespPath_92C(Adapter, 0); -+ } -+ PHY_SetBBReg(Adapter, rCCK0_AFESetting , 0x0F000000, 0x01); // RX path = PathAB -+ -+ //pDM_SWAT_Table->CurAntenna = pDM_SWAT_Table->PreAntenna; -+ -+ //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300, DM_SWAT_Table.CurAntenna); -+ //pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 = ((pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 & 0xfffffcff) | (pDM_SWAT_Table->CurAntenna<<8)); -+ //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, bMaskDWord, pDM_SWAT_Table->SWAS_NoLink_BK_Reg860); -+ } -+ -+ // Check state reset to default and wait for next time. -+ //pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ pDM_PDTable->PathDiv_NoLink_State = 0; -+ -+ return FALSE; -+ } -+#else -+ return FALSE; -+#endif -+ -+} -+ -+ -+ -+VOID -+odm_PathDiversityAfterLink_92C( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ pPD_T pDM_PDTable = &Adapter->DM_PDTable; -+ u1Byte DefaultRespPath=0; -+ -+ if((!(pHalData->CVID_Version==VERSION_1_BEFORE_8703B && IS_92C_SERIAL(pHalData->VersionID))) || (pHalData->PathDivCfg != 1) || (pHalData->eRFPowerState == eRfOff)) -+ { -+ if(pHalData->PathDivCfg == 0) -+ { -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("No ODM_TXPathDiversity()\n")); -+ } -+ else -+ { -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("2T ODM_TXPathDiversity()\n")); -+ } -+ return; -+ } -+ if(!odm_IsConnected_92C(Adapter)) -+ { -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("ODM_TXPathDiversity(): No Connections\n")); -+ return; -+ } -+ -+ -+ if(pDM_PDTable->TrainingState == 0) -+ { -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("ODM_TXPathDiversity() ==>\n")); -+ odm_OFDMTXPathDiversity_92C(Adapter); -+ -+ if((pDM_PDTable->CCKPathDivEnable == TRUE) && (pDM_PDTable->OFDM_Pkt_Cnt < 100)) -+ { -+ //RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: TrainingState=0\n")); -+ -+ if(pDM_PDTable->CCK_Pkt_Cnt > 300) -+ pDM_PDTable->Timer = 20; -+ else if(pDM_PDTable->CCK_Pkt_Cnt > 100) -+ pDM_PDTable->Timer = 60; -+ else -+ pDM_PDTable->Timer = 250; -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: timer=%d\n",pDM_PDTable->Timer)); -+ -+ PHY_SetBBReg(Adapter, rCCK0_AFESetting , 0x0F000000, 0x00); // RX path = PathA -+ pDM_PDTable->TrainingState = 1; -+ pHalData->RSSI_test = TRUE; -+ ODM_SetTimer( pDM_Odm, &pDM_Odm->CCKPathDiversityTimer, pDM_PDTable->Timer); //ms -+ } -+ else -+ { -+ pDM_PDTable->CCKTXPath = pDM_PDTable->OFDMTXPath; -+ DefaultRespPath = pDM_PDTable->OFDMDefaultRespPath; -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_SetRespPath_92C: Skip odm_CCKTXPathDiversity_92C, DefaultRespPath is OFDM\n")); -+ odm_SetRespPath_92C(Adapter, DefaultRespPath); -+ odm_ResetPathDiversity_92C(Adapter); -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("ODM_TXPathDiversity() <==\n")); -+ } -+ } -+ else if(pDM_PDTable->TrainingState == 1) -+ { -+ //RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: TrainingState=1\n")); -+ PHY_SetBBReg(Adapter, rCCK0_AFESetting , 0x0F000000, 0x05); // RX path = PathB -+ pDM_PDTable->TrainingState = 2; -+ ODM_SetTimer( pDM_Odm, &pDM_Odm->CCKPathDiversityTimer, pDM_PDTable->Timer); //ms -+ } -+ else -+ { -+ //RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: TrainingState=2\n")); -+ pDM_PDTable->TrainingState = 0; -+ odm_CCKTXPathDiversity_92C(Adapter); -+ if(pDM_PDTable->OFDM_Pkt_Cnt != 0) -+ { -+ DefaultRespPath = pDM_PDTable->OFDMDefaultRespPath; -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_SetRespPath_92C: DefaultRespPath is OFDM\n")); -+ } -+ else -+ { -+ DefaultRespPath = pDM_PDTable->CCKDefaultRespPath; -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_SetRespPath_92C: DefaultRespPath is CCK\n")); -+ } -+ odm_SetRespPath_92C(Adapter, DefaultRespPath); -+ odm_ResetPathDiversity_92C(Adapter); -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("ODM_TXPathDiversity() <==\n")); -+ } -+ -+} -+ -+VOID -+odm_SetRespPath_92C( -+ IN PADAPTER Adapter, -+ IN u1Byte DefaultRespPath -+ ) -+{ -+ pPD_T pDM_PDTable = &Adapter->DM_PDTable; -+ -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_SetRespPath_92C: Select Response Path=%d\n",DefaultRespPath)); -+ if(DefaultRespPath != pDM_PDTable->DefaultRespPath) -+ { -+ if(DefaultRespPath == 0) -+ { -+ PlatformEFIOWrite1Byte(Adapter, 0x6D8, (PlatformEFIORead1Byte(Adapter, 0x6D8)&0xc0)|0x15); -+ } -+ else -+ { -+ PlatformEFIOWrite1Byte(Adapter, 0x6D8, (PlatformEFIORead1Byte(Adapter, 0x6D8)&0xc0)|0x2A); -+ } -+ } -+ pDM_PDTable->DefaultRespPath = DefaultRespPath; -+} -+ -+VOID -+odm_OFDMTXPathDiversity_92C( -+ IN PADAPTER Adapter) -+{ -+// HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ PRT_WLAN_STA pEntry; -+ u1Byte i, DefaultRespPath = 0; -+ s4Byte MinRSSI = 0xFF; -+ pPD_T pDM_PDTable = &Adapter->DM_PDTable; -+ pDM_PDTable->OFDMTXPath = 0; -+ -+ //1 Default Port -+ if(pMgntInfo->mAssoc) -+ { -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_OFDMTXPathDiversity_92C: Default port RSSI[0]=%d, RSSI[1]=%d\n", -+ Adapter->RxStats.RxRSSIPercentage[0], Adapter->RxStats.RxRSSIPercentage[1])); -+ if(Adapter->RxStats.RxRSSIPercentage[0] > Adapter->RxStats.RxRSSIPercentage[1]) -+ { -+ pDM_PDTable->OFDMTXPath = pDM_PDTable->OFDMTXPath & (~BIT0); -+ MinRSSI = Adapter->RxStats.RxRSSIPercentage[1]; -+ DefaultRespPath = 0; -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_OFDMTXPathDiversity_92C: Default port Select Path-0\n")); -+ } -+ else -+ { -+ pDM_PDTable->OFDMTXPath = pDM_PDTable->OFDMTXPath | BIT0; -+ MinRSSI = Adapter->RxStats.RxRSSIPercentage[0]; -+ DefaultRespPath = 1; -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_OFDMTXPathDiversity_92C: Default port Select Path-1\n")); -+ } -+ //RT_TRACE( COMP_INIT, DBG_LOUD, ("pDM_PDTable->OFDMTXPath =0x%x\n",pDM_PDTable->OFDMTXPath)); -+ } -+ //1 Extension Port -+ for(i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) -+ { -+ if(IsAPModeExist(Adapter) && GetFirstExtAdapter(Adapter) != NULL) -+ pEntry = AsocEntry_EnumStation(GetFirstExtAdapter(Adapter), i); -+ else -+ pEntry = AsocEntry_EnumStation(GetDefaultAdapter(Adapter), i); -+ -+ if(pEntry!=NULL) -+ { -+ if(pEntry->bAssociated) -+ { -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_OFDMTXPathDiversity_92C: MACID=%d, RSSI_0=%d, RSSI_1=%d\n", -+ pEntry->AssociatedMacId, pEntry->rssi_stat.RxRSSIPercentage[0], pEntry->rssi_stat.RxRSSIPercentage[1])); -+ -+ if(pEntry->rssi_stat.RxRSSIPercentage[0] > pEntry->rssi_stat.RxRSSIPercentage[1]) -+ { -+ pDM_PDTable->OFDMTXPath = pDM_PDTable->OFDMTXPath & ~(BIT(pEntry->AssociatedMacId)); -+ //pHalData->TXPath = pHalData->TXPath & ~(1<<(pEntry->AssociatedMacId)); -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_OFDMTXPathDiversity_92C: MACID=%d Select Path-0\n", pEntry->AssociatedMacId)); -+ if(pEntry->rssi_stat.RxRSSIPercentage[1] < MinRSSI) -+ { -+ MinRSSI = pEntry->rssi_stat.RxRSSIPercentage[1]; -+ DefaultRespPath = 0; -+ } -+ } -+ else -+ { -+ pDM_PDTable->OFDMTXPath = pDM_PDTable->OFDMTXPath | BIT(pEntry->AssociatedMacId); -+ //pHalData->TXPath = pHalData->TXPath | (1 << (pEntry->AssociatedMacId)); -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_OFDMTXPathDiversity_92C: MACID=%d Select Path-1\n", pEntry->AssociatedMacId)); -+ if(pEntry->rssi_stat.RxRSSIPercentage[0] < MinRSSI) -+ { -+ MinRSSI = pEntry->rssi_stat.RxRSSIPercentage[0]; -+ DefaultRespPath = 1; -+ } -+ } -+ } -+ } -+ else -+ { -+ break; -+ } -+ } -+ -+ pDM_PDTable->OFDMDefaultRespPath = DefaultRespPath; -+} -+ -+ -+VOID -+odm_CCKTXPathDiversity_92C( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ PRT_WLAN_STA pEntry; -+ s4Byte MinRSSI = 0xFF; -+ u1Byte i, DefaultRespPath = 0; -+// BOOLEAN bBModePathDiv = FALSE; -+ pPD_T pDM_PDTable = &Adapter->DM_PDTable; -+ -+ //1 Default Port -+ if(pMgntInfo->mAssoc) -+ { -+ if(pHalData->OFDM_Pkt_Cnt == 0) -+ { -+ for(i=0; i<2; i++) -+ { -+ if(pDM_PDTable->RSSI_CCK_Path_cnt[i] > 1) //Because the first packet is discarded -+ pDM_PDTable->RSSI_CCK_Path[i] = pDM_PDTable->RSSI_CCK_Path[i] / (pDM_PDTable->RSSI_CCK_Path_cnt[i]-1); -+ else -+ pDM_PDTable->RSSI_CCK_Path[i] = 0; -+ } -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: pDM_PDTable->RSSI_CCK_Path[0]=%d, pDM_PDTable->RSSI_CCK_Path[1]=%d\n", -+ pDM_PDTable->RSSI_CCK_Path[0], pDM_PDTable->RSSI_CCK_Path[1])); -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: pDM_PDTable->RSSI_CCK_Path_cnt[0]=%d, pDM_PDTable->RSSI_CCK_Path_cnt[1]=%d\n", -+ pDM_PDTable->RSSI_CCK_Path_cnt[0], pDM_PDTable->RSSI_CCK_Path_cnt[1])); -+ -+ if(pDM_PDTable->RSSI_CCK_Path[0] > pDM_PDTable->RSSI_CCK_Path[1]) -+ { -+ pDM_PDTable->CCKTXPath = pDM_PDTable->CCKTXPath & (~BIT0); -+ MinRSSI = pDM_PDTable->RSSI_CCK_Path[1]; -+ DefaultRespPath = 0; -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: Default port Select CCK Path-0\n")); -+ } -+ else if(pDM_PDTable->RSSI_CCK_Path[0] < pDM_PDTable->RSSI_CCK_Path[1]) -+ { -+ pDM_PDTable->CCKTXPath = pDM_PDTable->CCKTXPath | BIT0; -+ MinRSSI = pDM_PDTable->RSSI_CCK_Path[0]; -+ DefaultRespPath = 1; -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: Default port Select CCK Path-1\n")); -+ } -+ else -+ { -+ if((pDM_PDTable->RSSI_CCK_Path[0] != 0) && (pDM_PDTable->RSSI_CCK_Path[0] < MinRSSI)) -+ { -+ pDM_PDTable->CCKTXPath = pDM_PDTable->CCKTXPath & (~BIT0); -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: Default port Select CCK Path-0\n")); -+ MinRSSI = pDM_PDTable->RSSI_CCK_Path[1]; -+ DefaultRespPath = 0; -+ } -+ else -+ { -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: Default port unchange CCK Path\n")); -+ } -+ } -+ } -+ else //Follow OFDM decision -+ { -+ pDM_PDTable->CCKTXPath = (pDM_PDTable->CCKTXPath & (~BIT0)) | (pDM_PDTable->OFDMTXPath &BIT0); -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: Follow OFDM decision, Default port Select CCK Path-%d\n", -+ pDM_PDTable->CCKTXPath &BIT0)); -+ } -+ } -+ //1 Extension Port -+ for(i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) -+ { -+ if(IsAPModeExist(Adapter) && GetFirstExtAdapter(Adapter) != NULL) -+ pEntry = AsocEntry_EnumStation(GetFirstExtAdapter(Adapter), i); -+ else -+ pEntry = AsocEntry_EnumStation(GetDefaultAdapter(Adapter), i); -+ -+ if(pEntry!=NULL) -+ { -+ if(pEntry->bAssociated) -+ { -+ if(pEntry->rssi_stat.OFDM_Pkt_Cnt == 0) -+ { -+ u1Byte j=0; -+ for(j=0; j<2; j++) -+ { -+ if(pEntry->rssi_stat.RSSI_CCK_Path_cnt[j] > 1) -+ pEntry->rssi_stat.RSSI_CCK_Path[j] = pEntry->rssi_stat.RSSI_CCK_Path[j] / (pEntry->rssi_stat.RSSI_CCK_Path_cnt[j]-1); -+ else -+ pEntry->rssi_stat.RSSI_CCK_Path[j] = 0; -+ } -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: MACID=%d, RSSI_CCK0=%d, RSSI_CCK1=%d\n", -+ pEntry->AssociatedMacId, pEntry->rssi_stat.RSSI_CCK_Path[0], pEntry->rssi_stat.RSSI_CCK_Path[1])); -+ -+ if(pEntry->rssi_stat.RSSI_CCK_Path[0] >pEntry->rssi_stat.RSSI_CCK_Path[1]) -+ { -+ pDM_PDTable->CCKTXPath = pDM_PDTable->CCKTXPath & ~(BIT(pEntry->AssociatedMacId)); -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: MACID=%d Select CCK Path-0\n", pEntry->AssociatedMacId)); -+ if(pEntry->rssi_stat.RSSI_CCK_Path[1] < MinRSSI) -+ { -+ MinRSSI = pEntry->rssi_stat.RSSI_CCK_Path[1]; -+ DefaultRespPath = 0; -+ } -+ } -+ else if(pEntry->rssi_stat.RSSI_CCK_Path[0] rssi_stat.RSSI_CCK_Path[1]) -+ { -+ pDM_PDTable->CCKTXPath = pDM_PDTable->CCKTXPath | BIT(pEntry->AssociatedMacId); -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: MACID=%d Select CCK Path-1\n", pEntry->AssociatedMacId)); -+ if(pEntry->rssi_stat.RSSI_CCK_Path[0] < MinRSSI) -+ { -+ MinRSSI = pEntry->rssi_stat.RSSI_CCK_Path[0]; -+ DefaultRespPath = 1; -+ } -+ } -+ else -+ { -+ if((pEntry->rssi_stat.RSSI_CCK_Path[0] != 0) && (pEntry->rssi_stat.RSSI_CCK_Path[0] < MinRSSI)) -+ { -+ pDM_PDTable->CCKTXPath = pDM_PDTable->CCKTXPath & ~(BIT(pEntry->AssociatedMacId)); -+ MinRSSI = pEntry->rssi_stat.RSSI_CCK_Path[1]; -+ DefaultRespPath = 0; -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: MACID=%d Select CCK Path-0\n", pEntry->AssociatedMacId)); -+ } -+ else -+ { -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: MACID=%d unchange CCK Path\n", pEntry->AssociatedMacId)); -+ } -+ } -+ } -+ else //Follow OFDM decision -+ { -+ pDM_PDTable->CCKTXPath = (pDM_PDTable->CCKTXPath & (~(BIT(pEntry->AssociatedMacId)))) | (pDM_PDTable->OFDMTXPath & BIT(pEntry->AssociatedMacId)); -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: Follow OFDM decision, MACID=%d Select CCK Path-%d\n", -+ pEntry->AssociatedMacId, (pDM_PDTable->CCKTXPath & BIT(pEntry->AssociatedMacId))>>(pEntry->AssociatedMacId))); -+ } -+ } -+ } -+ else -+ { -+ break; -+ } -+ } -+ -+ RT_TRACE( COMP_INIT, DBG_LOUD, ("odm_CCKTXPathDiversity_92C:MinRSSI=%d\n",MinRSSI)); -+ -+ if(MinRSSI == 0xFF) -+ DefaultRespPath = pDM_PDTable->CCKDefaultRespPath; -+ -+ pDM_PDTable->CCKDefaultRespPath = DefaultRespPath; -+} -+ -+ -+VOID -+odm_ResetPathDiversity_92C( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ pPD_T pDM_PDTable = &Adapter->DM_PDTable; -+ PRT_WLAN_STA pEntry; -+ u4Byte i,j; -+ -+ pHalData->RSSI_test = FALSE; -+ pDM_PDTable->CCK_Pkt_Cnt = 0; -+ pDM_PDTable->OFDM_Pkt_Cnt = 0; -+ pHalData->CCK_Pkt_Cnt =0; -+ pHalData->OFDM_Pkt_Cnt =0; -+ -+ if(pDM_PDTable->CCKPathDivEnable == TRUE) -+ PHY_SetBBReg(Adapter, rCCK0_AFESetting , 0x0F000000, 0x01); //RX path = PathAB -+ -+ for(i=0; i<2; i++) -+ { -+ pDM_PDTable->RSSI_CCK_Path_cnt[i]=0; -+ pDM_PDTable->RSSI_CCK_Path[i] = 0; -+ } -+ for(i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) -+ { -+ if(IsAPModeExist(Adapter) && GetFirstExtAdapter(Adapter) != NULL) -+ pEntry = AsocEntry_EnumStation(GetFirstExtAdapter(Adapter), i); -+ else -+ pEntry = AsocEntry_EnumStation(GetDefaultAdapter(Adapter), i); -+ -+ if(pEntry!=NULL) -+ { -+ pEntry->rssi_stat.CCK_Pkt_Cnt = 0; -+ pEntry->rssi_stat.OFDM_Pkt_Cnt = 0; -+ for(j=0; j<2; j++) -+ { -+ pEntry->rssi_stat.RSSI_CCK_Path_cnt[j] = 0; -+ pEntry->rssi_stat.RSSI_CCK_Path[j] = 0; -+ } -+ } -+ else -+ break; -+ } -+} -+ -+ -+ -+ -+ -+VOID -+odm_CCKTXPathDiversityCallback( -+ PRT_TIMER pTimer -+) -+{ -+#if USE_WORKITEM -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+#endif -+ -+#if DEV_BUS_TYPE==RT_PCI_INTERFACE -+#if USE_WORKITEM -+ PlatformScheduleWorkItem(&pDM_Odm->CCKPathDiversityWorkitem); -+#else -+ odm_PathDiversityAfterLink_92C(Adapter); -+#endif -+#else -+ PlatformScheduleWorkItem(&pDM_Odm->CCKPathDiversityWorkitem); -+#endif -+ -+} -+ -+ -+VOID -+odm_CCKTXPathDiversityWorkItemCallback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER Adapter = (PADAPTER)pContext; -+ -+ odm_CCKTXPathDiversity_92C(Adapter); -+} -+ -+// -+// 20100514 Luke/Joseph: -+// Callback function for 500ms antenna test trying. -+// -+VOID -+odm_PathDivChkAntSwitchCallback( -+ PRT_TIMER pTimer -+) -+{ -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+#if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ -+#if USE_WORKITEM -+ PlatformScheduleWorkItem(&pDM_Odm->PathDivSwitchWorkitem); -+#else -+ odm_PathDivChkAntSwitch(pDM_Odm); -+#endif -+#else -+ PlatformScheduleWorkItem(&pDM_Odm->PathDivSwitchWorkitem); -+#endif -+ -+//odm_SwAntDivChkAntSwitch(Adapter, SWAW_STEP_DETERMINE); -+ -+} -+ -+ -+VOID -+odm_PathDivChkAntSwitchWorkitemCallback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER pAdapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ odm_PathDivChkAntSwitch(pDM_Odm); -+} -+ -+ -+ //MAC0_ACCESS_PHY1 -+ -+// 2011-06-22 Neil Chen & Gary Hsin -+// Refer to Jr.Luke's SW ANT DIV -+// 92D Path Diversity Main function -+// refer to 88C software antenna diversity -+// -+VOID -+odm_PathDivChkAntSwitch( -+ PDM_ODM_T pDM_Odm -+ //PADAPTER Adapter, -+ //u1Byte Step -+) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ -+ -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ s4Byte curRSSI=100, RSSI_A, RSSI_B; -+ u1Byte nextAntenna=AUX_ANT; -+ static u8Byte lastTxOkCnt=0, lastRxOkCnt=0; -+ u8Byte curTxOkCnt, curRxOkCnt; -+ static u8Byte TXByteCnt_A=0, TXByteCnt_B=0, RXByteCnt_A=0, RXByteCnt_B=0; -+ u8Byte CurByteCnt=0, PreByteCnt=0; -+ static u1Byte TrafficLoad = TRAFFIC_LOW; -+ u1Byte Score_A=0, Score_B=0; -+ u1Byte i=0x0; -+ // Neil Chen -+ static u1Byte pathdiv_para=0x0; -+ static u1Byte switchfirsttime=0x00; -+ // u1Byte regB33 = (u1Byte) PHY_QueryBBReg(Adapter, 0xB30,BIT27); -+ u1Byte regB33 = (u1Byte)ODM_GetBBReg(pDM_Odm, PATHDIV_REG, BIT27); -+ -+ -+ //u1Byte reg637 =0x0; -+ static u1Byte fw_value=0x0; -+ //u8Byte curTxOkCnt_tmp, curRxOkCnt_tmp; -+ PADAPTER BuddyAdapter = Adapter->BuddyAdapter; // another adapter MAC -+ // Path Diversity //Neil Chen--2011--06--22 -+ -+ //u1Byte PathDiv_Trigger = (u1Byte) PHY_QueryBBReg(Adapter, 0xBA0,BIT31); -+ u1Byte PathDiv_Trigger = (u1Byte) ODM_GetBBReg(pDM_Odm, PATHDIV_TRI,BIT31); -+ u1Byte PathDiv_Enable = pHalData->bPathDiv_Enable; -+ -+ -+ //DbgPrint("Path Div PG Value:%x \n",PathDiv_Enable); -+ if((BuddyAdapter==NULL)||(!PathDiv_Enable)||(PathDiv_Trigger)||(pHalData->CurrentBandType == BAND_ON_2_4G)) -+ { -+ return; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD,("===================>odm_PathDivChkAntSwitch()\n")); -+ -+ // The first time to switch path excluding 2nd, 3rd, ....etc.... -+ if(switchfirsttime==0) -+ { -+ if(regB33==0) -+ { -+ pDM_SWAT_Table->CurAntenna = MAIN_ANT; // Default MAC0_5G-->Path A (current antenna) -+ } -+ } -+ -+ // Condition that does not need to use antenna diversity. -+ if(pDM_Odm->SupportICType != ODM_RTL8192D) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("odm_PathDiversityMechanims(): No PathDiv Mechanism.\n")); -+ return; -+ } -+ -+ // Radio off: Status reset to default and return. -+ if(pHalData->eRFPowerState==eRfOff) -+ { -+ //ODM_SwAntDivRestAfterLink(Adapter); -+ return; -+ } -+ -+ /* -+ // Handling step mismatch condition. -+ // Peak step is not finished at last time. Recover the variable and check again. -+ if( Step != pDM_SWAT_Table->try_flag ) -+ { -+ ODM_SwAntDivRestAfterLink(Adapter); -+ } */ -+ -+ if(pDM_SWAT_Table->try_flag == 0xff) -+ { -+ // Select RSSI checking target -+ if(pMgntInfo->mAssoc && !ACTING_AS_AP(Adapter)) -+ { -+ // Target: Infrastructure mode AP. -+ pHalData->RSSI_target = NULL; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("odm_PathDivMechanism(): RSSI_target is DEF AP!\n")); -+ } -+ else -+ { -+ u1Byte index = 0; -+ PRT_WLAN_STA pEntry = NULL; -+ PADAPTER pTargetAdapter = NULL; -+ -+ if( pMgntInfo->mIbss || ACTING_AS_AP(Adapter) ) -+ { -+ // Target: AP/IBSS peer. -+ pTargetAdapter = Adapter; -+ } -+ else if(IsAPModeExist(Adapter) && GetFirstExtAdapter(Adapter) != NULL) -+ { -+ // Target: VWIFI peer. -+ pTargetAdapter = GetFirstExtAdapter(Adapter); -+ } -+ -+ if(pTargetAdapter != NULL) -+ { -+ for(index=0; indexbAssociated) -+ break; -+ } -+ } -+ } -+ -+ if(pEntry == NULL) -+ { -+ ODM_PathDivRestAfterLink(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("odm_SwAntDivChkAntSwitch(): No Link.\n")); -+ return; -+ } -+ else -+ { -+ pHalData->RSSI_target = pEntry; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("odm_SwAntDivChkAntSwitch(): RSSI_target is PEER STA\n")); -+ } -+ } -+ -+ pHalData->RSSI_cnt_A = 0; -+ pHalData->RSSI_cnt_B = 0; -+ pDM_SWAT_Table->try_flag = 0; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("odm_SwAntDivChkAntSwitch(): Set try_flag to 0 prepare for peak!\n")); -+ return; -+ } -+ else -+ { -+ // 1st step -+ curTxOkCnt = Adapter->TxStats.NumTxBytesUnicast - lastTxOkCnt; -+ curRxOkCnt = Adapter->RxStats.NumRxBytesUnicast - lastRxOkCnt; -+ lastTxOkCnt = Adapter->TxStats.NumTxBytesUnicast; -+ lastRxOkCnt = Adapter->RxStats.NumRxBytesUnicast; -+ -+ if(pDM_SWAT_Table->try_flag == 1) // Training State -+ { -+ if(pDM_SWAT_Table->CurAntenna == MAIN_ANT) -+ { -+ TXByteCnt_A += curTxOkCnt; -+ RXByteCnt_A += curRxOkCnt; -+ } -+ else -+ { -+ TXByteCnt_B += curTxOkCnt; -+ RXByteCnt_B += curRxOkCnt; -+ } -+ -+ nextAntenna = (pDM_SWAT_Table->CurAntenna == MAIN_ANT)? AUX_ANT : MAIN_ANT; -+ pDM_SWAT_Table->RSSI_Trying--; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: RSSI_Trying = %d\n",pDM_SWAT_Table->RSSI_Trying)); -+ if(pDM_SWAT_Table->RSSI_Trying == 0) -+ { -+ CurByteCnt = (pDM_SWAT_Table->CurAntenna == MAIN_ANT)? (TXByteCnt_A+RXByteCnt_A) : (TXByteCnt_B+RXByteCnt_B); -+ PreByteCnt = (pDM_SWAT_Table->CurAntenna == MAIN_ANT)? (TXByteCnt_B+RXByteCnt_B) : (TXByteCnt_A+RXByteCnt_A); -+ -+ if(TrafficLoad == TRAFFIC_HIGH) -+ { -+ //CurByteCnt = PlatformDivision64(CurByteCnt, 9); -+ PreByteCnt =PreByteCnt*9; -+ } -+ else if(TrafficLoad == TRAFFIC_LOW) -+ { -+ //CurByteCnt = PlatformDivision64(CurByteCnt, 2); -+ PreByteCnt =PreByteCnt*2; -+ } -+ if(pHalData->RSSI_cnt_A > 0) -+ RSSI_A = pHalData->RSSI_sum_A/pHalData->RSSI_cnt_A; -+ else -+ RSSI_A = 0; -+ if(pHalData->RSSI_cnt_B > 0) -+ RSSI_B = pHalData->RSSI_sum_B/pHalData->RSSI_cnt_B; -+ else -+ RSSI_B = 0; -+ curRSSI = (pDM_SWAT_Table->CurAntenna == MAIN_ANT)? RSSI_A : RSSI_B; -+ pDM_SWAT_Table->PreRSSI = (pDM_SWAT_Table->CurAntenna == MAIN_ANT)? RSSI_B : RSSI_A; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: PreRSSI = %d, CurRSSI = %d\n",pDM_SWAT_Table->PreRSSI, curRSSI)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: preAntenna= %s, curAntenna= %s \n", -+ (pDM_SWAT_Table->PreAntenna == MAIN_ANT?"MAIN":"AUX"), (pDM_SWAT_Table->CurAntenna == MAIN_ANT?"MAIN":"AUX"))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: RSSI_A= %d, RSSI_cnt_A = %d, RSSI_B= %d, RSSI_cnt_B = %d\n", -+ RSSI_A, pHalData->RSSI_cnt_A, RSSI_B, pHalData->RSSI_cnt_B)); -+ } -+ -+ } -+ else // try_flag=0 -+ { -+ -+ if(pHalData->RSSI_cnt_A > 0) -+ RSSI_A = pHalData->RSSI_sum_A/pHalData->RSSI_cnt_A; -+ else -+ RSSI_A = 0; -+ if(pHalData->RSSI_cnt_B > 0) -+ RSSI_B = pHalData->RSSI_sum_B/pHalData->RSSI_cnt_B; -+ else -+ RSSI_B = 0; -+ curRSSI = (pDM_SWAT_Table->CurAntenna == MAIN_ANT)? RSSI_A : RSSI_B; -+ pDM_SWAT_Table->PreRSSI = (pDM_SWAT_Table->PreAntenna == MAIN_ANT)? RSSI_A : RSSI_B; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: PreRSSI = %d, CurRSSI = %d\n", pDM_SWAT_Table->PreRSSI, curRSSI)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: preAntenna= %s, curAntenna= %s \n", -+ (pDM_SWAT_Table->PreAntenna == MAIN_ANT?"MAIN":"AUX"), (pDM_SWAT_Table->CurAntenna == MAIN_ANT?"MAIN":"AUX"))); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: RSSI_A= %d, RSSI_cnt_A = %d, RSSI_B= %d, RSSI_cnt_B = %d\n", -+ RSSI_A, pHalData->RSSI_cnt_A, RSSI_B, pHalData->RSSI_cnt_B)); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("Ekul:curTxOkCnt = %d\n", curTxOkCnt)); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("Ekul:curRxOkCnt = %d\n", curRxOkCnt)); -+ } -+ -+ //1 Trying State -+ if((pDM_SWAT_Table->try_flag == 1)&&(pDM_SWAT_Table->RSSI_Trying == 0)) -+ { -+ -+ if(pDM_SWAT_Table->TestMode == TP_MODE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: TestMode = TP_MODE")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH= TRY:CurByteCnt = %"i64fmt"d,", CurByteCnt)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH= TRY:PreByteCnt = %"i64fmt"d\n",PreByteCnt)); -+ if(CurByteCnt < PreByteCnt) -+ { -+ if(pDM_SWAT_Table->CurAntenna == MAIN_ANT) -+ pDM_SWAT_Table->SelectAntennaMap=pDM_SWAT_Table->SelectAntennaMap<<1; -+ else -+ pDM_SWAT_Table->SelectAntennaMap=(pDM_SWAT_Table->SelectAntennaMap<<1)+1; -+ } -+ else -+ { -+ if(pDM_SWAT_Table->CurAntenna == MAIN_ANT) -+ pDM_SWAT_Table->SelectAntennaMap=(pDM_SWAT_Table->SelectAntennaMap<<1)+1; -+ else -+ pDM_SWAT_Table->SelectAntennaMap=pDM_SWAT_Table->SelectAntennaMap<<1; -+ } -+ for (i= 0; i<8; i++) -+ { -+ if(((pDM_SWAT_Table->SelectAntennaMap>>i)&BIT0) == 1) -+ Score_A++; -+ else -+ Score_B++; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("SelectAntennaMap=%x\n ",pDM_SWAT_Table->SelectAntennaMap)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Score_A=%d, Score_B=%d\n", Score_A, Score_B)); -+ -+ if(pDM_SWAT_Table->CurAntenna == MAIN_ANT) -+ { -+ nextAntenna = (Score_A >= Score_B)?MAIN_ANT:AUX_ANT; -+ } -+ else -+ { -+ nextAntenna = (Score_B >= Score_A)?AUX_ANT:MAIN_ANT; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: nextAntenna=%s\n",(nextAntenna==MAIN_ANT)?"MAIN":"AUX")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: preAntenna= %s, curAntenna= %s \n", -+ (pDM_SWAT_Table->PreAntenna == MAIN_ANT?"MAIN":"AUX"), (pDM_SWAT_Table->CurAntenna == MAIN_ANT?"MAIN":"AUX"))); -+ -+ if(nextAntenna != pDM_SWAT_Table->CurAntenna) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Switch back to another antenna")); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: current anntena is good\n")); -+ } -+ } -+ -+ -+ if(pDM_SWAT_Table->TestMode == RSSI_MODE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: TestMode = RSSI_MODE")); -+ pDM_SWAT_Table->SelectAntennaMap=0xAA; -+ if(curRSSI < pDM_SWAT_Table->PreRSSI) //Current antenna is worse than previous antenna -+ { -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("SWAS: Switch back to another antenna")); -+ nextAntenna = (pDM_SWAT_Table->CurAntenna == MAIN_ANT)?AUX_ANT : MAIN_ANT; -+ } -+ else // current anntena is good -+ { -+ nextAntenna =pDM_SWAT_Table->CurAntenna; -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("SWAS: current anntena is good\n")); -+ } -+ } -+ -+ pDM_SWAT_Table->try_flag = 0; -+ pHalData->RSSI_test = FALSE; -+ pHalData->RSSI_sum_A = 0; -+ pHalData->RSSI_cnt_A = 0; -+ pHalData->RSSI_sum_B = 0; -+ pHalData->RSSI_cnt_B = 0; -+ TXByteCnt_A = 0; -+ TXByteCnt_B = 0; -+ RXByteCnt_A = 0; -+ RXByteCnt_B = 0; -+ -+ } -+ -+ //1 Normal State -+ else if(pDM_SWAT_Table->try_flag == 0) -+ { -+ if(TrafficLoad == TRAFFIC_HIGH) -+ { -+ if ((curTxOkCnt+curRxOkCnt) > 3750000)//if(PlatformDivision64(curTxOkCnt+curRxOkCnt, 2) > 1875000) -+ TrafficLoad = TRAFFIC_HIGH; -+ else -+ TrafficLoad = TRAFFIC_LOW; -+ } -+ else if(TrafficLoad == TRAFFIC_LOW) -+ { -+ if ((curTxOkCnt+curRxOkCnt) > 3750000)//if(PlatformDivision64(curTxOkCnt+curRxOkCnt, 2) > 1875000) -+ TrafficLoad = TRAFFIC_HIGH; -+ else -+ TrafficLoad = TRAFFIC_LOW; -+ } -+ if(TrafficLoad == TRAFFIC_HIGH) -+ pDM_SWAT_Table->bTriggerAntennaSwitch = 0; -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("Normal:TrafficLoad = %llu\n", curTxOkCnt+curRxOkCnt)); -+ -+ //Prepare To Try Antenna -+ nextAntenna = (pDM_SWAT_Table->CurAntenna == MAIN_ANT)? AUX_ANT : MAIN_ANT; -+ pDM_SWAT_Table->try_flag = 1; -+ pHalData->RSSI_test = TRUE; -+ if((curRxOkCnt+curTxOkCnt) > 1000) -+ { -+#if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ pDM_SWAT_Table->RSSI_Trying = 4; -+#else -+ pDM_SWAT_Table->RSSI_Trying = 2; -+#endif -+ pDM_SWAT_Table->TestMode = TP_MODE; -+ } -+ else -+ { -+ pDM_SWAT_Table->RSSI_Trying = 2; -+ pDM_SWAT_Table->TestMode = RSSI_MODE; -+ -+ } -+ -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("SWAS: Normal State -> Begin Trying!\n")); -+ pHalData->RSSI_sum_A = 0; -+ pHalData->RSSI_cnt_A = 0; -+ pHalData->RSSI_sum_B = 0; -+ pHalData->RSSI_cnt_B = 0; -+ } // end of try_flag=0 -+ } -+ -+ //1 4.Change TRX antenna -+ if(nextAntenna != pDM_SWAT_Table->CurAntenna) -+ { -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Change TX Antenna!\n ")); -+ //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300, nextAntenna); for 88C -+ if(nextAntenna==MAIN_ANT) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Next Antenna is RF PATH A\n ")); -+ pathdiv_para = 0x02; //02 to switchback to RF path A -+ fw_value = 0x03; -+#if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ odm_PathDiversity_8192D(pDM_Odm, pathdiv_para); -+#else -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_PathDiv,1,(pu1Byte)(&fw_value)); -+#endif -+ } -+ else if(nextAntenna==AUX_ANT) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Next Antenna is RF PATH B\n ")); -+ if(switchfirsttime==0) // First Time To Enter Path Diversity -+ { -+ switchfirsttime=0x01; -+ pathdiv_para = 0x00; -+ fw_value=0x00; // to backup RF Path A Releated Registers -+ -+#if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ odm_PathDiversity_8192D(pDM_Odm, pathdiv_para); -+#else -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_PathDiv,1,(pu1Byte)(&fw_value)); -+ //for(u1Byte n=0; n<80,n++) -+ //{ -+ //delay_us(500); -+ ODM_delay_ms(500); -+ odm_PathDiversity_8192D(pDM_Odm, pathdiv_para); -+ -+ fw_value=0x01; // to backup RF Path A Releated Registers -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_PathDiv,1,(pu1Byte)(&fw_value)); -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: FIRST TIME To DO PATH SWITCH!\n ")); -+ } -+ else -+ { -+ pathdiv_para = 0x01; -+ fw_value = 0x02; -+#if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ odm_PathDiversity_8192D(pDM_Odm, pathdiv_para); -+#else -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_PathDiv,1,(pu1Byte)(&fw_value)); -+#endif -+ } -+ } -+ // odm_PathDiversity_8192D(Adapter, pathdiv_para); -+ } -+ -+ //1 5.Reset Statistics -+ pDM_SWAT_Table->PreAntenna = pDM_SWAT_Table->CurAntenna; -+ pDM_SWAT_Table->CurAntenna = nextAntenna; -+ pDM_SWAT_Table->PreRSSI = curRSSI; -+ -+ //1 6.Set next timer -+ -+ if(pDM_SWAT_Table->RSSI_Trying == 0) -+ return; -+ -+ if(pDM_SWAT_Table->RSSI_Trying%2 == 0) -+ { -+ if(pDM_SWAT_Table->TestMode == TP_MODE) -+ { -+ if(TrafficLoad == TRAFFIC_HIGH) -+ { -+#if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 10 ); //ms -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Test another antenna for 10 ms\n")); -+#else -+ ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 20 ); //ms -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Test another antenna for 20 ms\n")); -+#endif -+ } -+ else if(TrafficLoad == TRAFFIC_LOW) -+ { -+ ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 50 ); //ms -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Test another antenna for 50 ms\n")); -+ } -+ } -+ else // TestMode == RSSI_MODE -+ { -+ ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 500 ); //ms -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Test another antenna for 500 ms\n")); -+ } -+ } -+ else -+ { -+ if(pDM_SWAT_Table->TestMode == TP_MODE) -+ { -+ if(TrafficLoad == TRAFFIC_HIGH) -+ -+#if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 90 ); //ms -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Test another antenna for 90 ms\n")); -+#else -+ ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 180); //ms -+#endif -+ else if(TrafficLoad == TRAFFIC_LOW) -+ ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 100 ); //ms -+ } -+ else -+ ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 500 ); //ms -+ } -+} -+ -+ -+ -+VOID -+ODM_CCKPathDiversityChkPerPktRssi( -+ PADAPTER Adapter, -+ BOOLEAN bIsDefPort, -+ BOOLEAN bMatchBSSID, -+ PRT_WLAN_STA pEntry, -+ PRT_RFD pRfd, -+ pu1Byte pDesc -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ BOOLEAN bCount = FALSE; -+ pPD_T pDM_PDTable = &Adapter->DM_PDTable; -+ //BOOLEAN isCCKrate = RX_HAL_IS_CCK_RATE_92C(pDesc); -+#if DEV_BUS_TYPE != RT_SDIO_INTERFACE -+ BOOLEAN isCCKrate = RX_HAL_IS_CCK_RATE(Adapter, pDesc); -+#else //below code would be removed if we have verified SDIO -+ BOOLEAN isCCKrate = IS_HARDWARE_TYPE_8188E(Adapter) ? RX_HAL_IS_CCK_RATE_88E(pDesc) : RX_HAL_IS_CCK_RATE_92C(pDesc); -+#endif -+ -+ if((pHalData->PathDivCfg != 1) || (pHalData->RSSI_test == FALSE)) -+ return; -+ -+ if(pHalData->RSSI_target==NULL && bIsDefPort && bMatchBSSID) -+ bCount = TRUE; -+ else if(pHalData->RSSI_target!=NULL && pEntry!=NULL && pHalData->RSSI_target==pEntry) -+ bCount = TRUE; -+ -+ if(bCount && isCCKrate) -+ { -+ if(pDM_PDTable->TrainingState == 1 ) -+ { -+ if(pEntry) -+ { -+ if(pEntry->rssi_stat.RSSI_CCK_Path_cnt[0] != 0) -+ pEntry->rssi_stat.RSSI_CCK_Path[0] += pRfd->Status.RxPWDBAll; -+ pEntry->rssi_stat.RSSI_CCK_Path_cnt[0]++; -+ } -+ else -+ { -+ if(pDM_PDTable->RSSI_CCK_Path_cnt[0] != 0) -+ pDM_PDTable->RSSI_CCK_Path[0] += pRfd->Status.RxPWDBAll; -+ pDM_PDTable->RSSI_CCK_Path_cnt[0]++; -+ } -+ } -+ else if(pDM_PDTable->TrainingState == 2 ) -+ { -+ if(pEntry) -+ { -+ if(pEntry->rssi_stat.RSSI_CCK_Path_cnt[1] != 0) -+ pEntry->rssi_stat.RSSI_CCK_Path[1] += pRfd->Status.RxPWDBAll; -+ pEntry->rssi_stat.RSSI_CCK_Path_cnt[1]++; -+ } -+ else -+ { -+ if(pDM_PDTable->RSSI_CCK_Path_cnt[1] != 0) -+ pDM_PDTable->RSSI_CCK_Path[1] += pRfd->Status.RxPWDBAll; -+ pDM_PDTable->RSSI_CCK_Path_cnt[1]++; -+ } -+ } -+ } -+} -+ -+ -+ -+ -+//Neil Chen---2011--06--22 -+//----92D Path Diversity----// -+//#ifdef PathDiv92D -+//================================== -+//3 Path Diversity -+//================================== -+// -+// 20100514 Luke/Joseph: -+// Add new function for antenna diversity after link. -+// This is the main function of antenna diversity after link. -+// This function is called in HalDmWatchDog() and ODM_SwAntDivChkAntSwitchCallback(). -+// HalDmWatchDog() calls this function with SWAW_STEP_PEAK to initialize the antenna test. -+// In SWAW_STEP_PEAK, another antenna and a 500ms timer will be set for testing. -+// After 500ms, ODM_SwAntDivChkAntSwitchCallback() calls this function to compare the signal just -+// listened on the air with the RSSI of original antenna. -+// It chooses the antenna with better RSSI. -+// There is also a aged policy for error trying. Each error trying will cost more 5 seconds waiting -+// penalty to get next try. -+// -+// -+// 20100503 Joseph: -+// Add new function SwAntDivCheck8192C(). -+// This is the main function of Antenna diversity function before link. -+// Mainly, it just retains last scan result and scan again. -+// After that, it compares the scan result to see which one gets better RSSI. -+// It selects antenna with better receiving power and returns better scan result. -+// -+ -+ -+// -+// 20100514 Luke/Joseph: -+// This function is used to gather the RSSI information for antenna testing. -+// It selects the RSSI of the peer STA that we want to know. -+// -+VOID -+ODM_PathDivChkPerPktRssi( -+ PADAPTER Adapter, -+ BOOLEAN bIsDefPort, -+ BOOLEAN bMatchBSSID, -+ PRT_WLAN_STA pEntry, -+ PRT_RFD pRfd -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ BOOLEAN bCount = FALSE; -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ if(pHalData->RSSI_target==NULL && bIsDefPort && bMatchBSSID) -+ bCount = TRUE; -+ else if(pHalData->RSSI_target!=NULL && pEntry!=NULL && pHalData->RSSI_target==pEntry) -+ bCount = TRUE; -+ -+ if(bCount) -+ { -+ //1 RSSI for SW Antenna Switch -+ if(pDM_SWAT_Table->CurAntenna == MAIN_ANT) -+ { -+ pHalData->RSSI_sum_A += pRfd->Status.RxPWDBAll; -+ pHalData->RSSI_cnt_A++; -+ } -+ else -+ { -+ pHalData->RSSI_sum_B += pRfd->Status.RxPWDBAll; -+ pHalData->RSSI_cnt_B++; -+ -+ } -+ } -+} -+ -+ -+// -+// 20100514 Luke/Joseph: -+// Add new function to reset antenna diversity state after link. -+// -+VOID -+ODM_PathDivRestAfterLink( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PADAPTER Adapter=pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ pHalData->RSSI_cnt_A = 0; -+ pHalData->RSSI_cnt_B = 0; -+ pHalData->RSSI_test = FALSE; -+ pDM_SWAT_Table->try_flag = 0x0; // NOT 0xff -+ pDM_SWAT_Table->RSSI_Trying = 0; -+ pDM_SWAT_Table->SelectAntennaMap=0xAA; -+ pDM_SWAT_Table->CurAntenna = MAIN_ANT; -+} -+ -+ -+//================================================== -+//3 PathDiv End -+//================================================== -+ -+ -+VOID -+ODM_FillTXPathInTXDESC( -+ IN PADAPTER Adapter, -+ IN PRT_TCB pTcb, -+ IN pu1Byte pDesc -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u4Byte TXPath; -+ pPD_T pDM_PDTable = &Adapter->DM_PDTable; -+ -+ //2011.09.05 Add by Luke Lee for path diversity -+ if(pHalData->PathDivCfg == 1) -+ { -+ TXPath = (pDM_PDTable->OFDMTXPath >> pTcb->macId) & BIT0; -+ //RT_TRACE( COMP_INIT, DBG_LOUD, ("Fill TXDESC: macID=%d, TXPath=%d\n", pTcb->macId, TXPath)); -+ //SET_TX_DESC_TX_ANT_CCK(pDesc,TXPath); -+ if(TXPath == 0) -+ { -+ SET_TX_DESC_TX_ANTL_92C(pDesc,1); -+ SET_TX_DESC_TX_ANT_HT_92C(pDesc,1); -+ } -+ else -+ { -+ SET_TX_DESC_TX_ANTL_92C(pDesc,2); -+ SET_TX_DESC_TX_ANT_HT_92C(pDesc,2); -+ } -+ TXPath = (pDM_PDTable->CCKTXPath >> pTcb->macId) & BIT0; -+ if(TXPath == 0) -+ { -+ SET_TX_DESC_TX_ANT_CCK_92C(pDesc,1); -+ } -+ else -+ { -+ SET_TX_DESC_TX_ANT_CCK_92C(pDesc,2); -+ } -+ } -+} -+ -+//Only for MP //Neil Chen--2012--0502-- -+VOID -+odm_PathDivInit_92D( -+IN PDM_ODM_T pDM_Odm) -+{ -+ pPATHDIV_PARA pathIQK = &pDM_Odm->pathIQK; -+ -+ pathIQK->org_2g_RegC14=0x0; -+ pathIQK->org_2g_RegC4C=0x0; -+ pathIQK->org_2g_RegC80=0x0; -+ pathIQK->org_2g_RegC94=0x0; -+ pathIQK->org_2g_RegCA0=0x0; -+ pathIQK->org_5g_RegC14=0x0; -+ pathIQK->org_5g_RegCA0=0x0; -+ pathIQK->org_5g_RegE30=0x0; -+ pathIQK->swt_2g_RegC14=0x0; -+ pathIQK->swt_2g_RegC4C=0x0; -+ pathIQK->swt_2g_RegC80=0x0; -+ pathIQK->swt_2g_RegC94=0x0; -+ pathIQK->swt_2g_RegCA0=0x0; -+ pathIQK->swt_5g_RegC14=0x0; -+ pathIQK->swt_5g_RegCA0=0x0; -+ pathIQK->swt_5g_RegE30=0x0; -+ -+} -+ -+ -+u1Byte -+odm_SwAntDivSelectScanChnl( -+ IN PADAPTER Adapter -+ ) -+{ -+#if (RT_MEM_SIZE_LEVEL != RT_MEM_SIZE_MINIMUM) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ u2Byte i; -+ u1Byte j, ScanChannel = 0, ChannelNum = 0; -+ PRT_CHANNEL_LIST pChannelList = GET_RT_CHANNEL_LIST(pMgntInfo); -+ u1Byte EachChannelSTAs[MAX_SCAN_CHANNEL_NUM] = {0}; -+ -+ if(pMgntInfo->tmpNumBssDesc == 0) -+ return 0; -+ -+ for(i = 0; i < pMgntInfo->tmpNumBssDesc; i++) -+ { -+ ChannelNum = pMgntInfo->tmpbssDesc[i].ChannelNumber; -+ for(j = 0; j < pChannelList->ChannelLen; j++) -+ { -+ if(pChannelList->ChnlListEntry[j].ChannelNum == ChannelNum) -+ { -+ EachChannelSTAs[j]++; -+ break; -+ } -+ } -+ } -+ -+ for(i = 0; i < MAX_SCAN_CHANNEL_NUM; i++) -+ { -+ if(EachChannelSTAs[i] > EachChannelSTAs[ScanChannel]) -+ ScanChannel = (u1Byte)i; -+ } -+ -+ if(EachChannelSTAs[ScanChannel] == 0) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("odm_SwAntDivSelectScanChnl(): Scan List is empty.\n")); -+ return 0; -+ } -+ -+ ScanChannel = pChannelList->ChnlListEntry[ScanChannel].ChannelNum; -+ -+ -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, -+ ("odm_SwAntDivSelectScanChnl(): Channel (( %d )) is select as scan channel.\n", ScanChannel)); -+ -+ return ScanChannel; -+#else -+ return 0; -+#endif -+} -+ -+ -+VOID -+odm_SwAntDivConstructScanChnl( -+ IN PADAPTER Adapter, -+ IN u1Byte ScanChnl -+ ) -+{ -+ -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ -+ if(ScanChnl == 0) -+ { -+ u1Byte i; -+ PRT_CHANNEL_LIST pChannelList = GET_RT_CHANNEL_LIST(pMgntInfo); -+ -+ // 20100519 Joseph: Original antenna scanned nothing. -+ // Test antenna shall scan all channel with half period in this condition. -+ -+ RT_TRACE_F(COMP_SCAN, DBG_TRACE, (" RT_CHNL_LIST_ACTION_CONSTRUCT chnl %d \n", ScanChnl)); -+ -+ RtActChannelList(Adapter, RT_CHNL_LIST_ACTION_CONSTRUCT_SCAN_LIST, NULL, NULL); -+ for(i = 0; i < pChannelList->ChannelLen; i++) -+ pChannelList->ChnlListEntry[i].ScanPeriod /= 2; -+ } -+ else -+ { -+ // The using of this CustomizedScanRequest is a trick to rescan the two channels -+ // under the NORMAL scanning process. It will not affect MGNT_INFO.CustomizedScanRequest. -+ CUSTOMIZED_SCAN_REQUEST CustomScanReq; -+ -+ CustomScanReq.bEnabled = TRUE; -+ CustomScanReq.Channels[0] = ScanChnl; -+ CustomScanReq.Channels[1] = pMgntInfo->dot11CurrentChannelNumber; -+ CustomScanReq.nChannels = 2; -+ CustomScanReq.ScanType = SCAN_ACTIVE; -+ CustomScanReq.Duration = DEFAULT_PASSIVE_SCAN_PERIOD; -+ -+ RT_TRACE_F(COMP_SCAN, DBG_TRACE, (" RT_CHNL_LIST_ACTION_CONSTRUCT chnl %d \n", ScanChnl)); -+ -+ RtActChannelList(Adapter, RT_CHNL_LIST_ACTION_CONSTRUCT_SCAN_LIST, &CustomScanReq, NULL); -+ } -+ -+} -+#else -+ -+VOID -+odm_PathDivChkAntSwitchCallback( -+ PRT_TIMER pTimer -+) -+{ -+} -+ -+VOID -+odm_PathDivChkAntSwitchWorkitemCallback( -+ IN PVOID pContext -+ ) -+{ -+} -+ -+VOID -+odm_CCKTXPathDiversityCallback( -+ PRT_TIMER pTimer -+) -+{ -+} -+ -+VOID -+odm_CCKTXPathDiversityWorkItemCallback( -+ IN PVOID pContext -+ ) -+{ -+} -+u1Byte -+odm_SwAntDivSelectScanChnl( -+ IN PADAPTER Adapter -+ ) -+{ -+ return 0; -+} -+VOID -+odm_SwAntDivConstructScanChnl( -+ IN PADAPTER Adapter, -+ IN u1Byte ScanChnl -+ ) -+{ -+} -+ -+ -+#endif -+ -+#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_pathdiv.h linux/3rdparty/rtl8812au/hal/phydm/phydm_pathdiv.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_pathdiv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_pathdiv.h 2017-06-07 23:07:21.019688305 +0300 -@@ -0,0 +1,324 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMPATHDIV_H__ -+#define __PHYDMPATHDIV_H__ -+/*#define PATHDIV_VERSION "2.0" //2014.11.04*/ -+#define PATHDIV_VERSION "3.0" /*2015.01.13 Dino*/ -+ -+#if(defined(CONFIG_PATH_DIVERSITY)) -+#define USE_PATH_A_AS_DEFAULT_ANT //for 8814 dynamic TX path selection -+ -+#define NUM_RESET_DTP_PERIOD 5 -+#define ANT_DECT_RSSI_TH 3 -+ -+#define PATH_A 1 -+#define PATH_B 2 -+#define PATH_C 3 -+#define PATH_D 4 -+ -+#define PHYDM_AUTO_PATH 0 -+#define PHYDM_FIX_PATH 1 -+ -+#define NUM_CHOOSE2_FROM4 6 -+#define NUM_CHOOSE3_FROM4 4 -+ -+ -+#define PHYDM_A BIT0 -+#define PHYDM_B BIT1 -+#define PHYDM_C BIT2 -+#define PHYDM_D BIT3 -+#define PHYDM_AB (BIT0 | BIT1) // 0 -+#define PHYDM_AC (BIT0 | BIT2) // 1 -+#define PHYDM_AD (BIT0 | BIT3) // 2 -+#define PHYDM_BC (BIT1 | BIT2) // 3 -+#define PHYDM_BD (BIT1 | BIT3) // 4 -+#define PHYDM_CD (BIT2 | BIT3) // 5 -+ -+#define PHYDM_ABC (BIT0 | BIT1 | BIT2) /* 0*/ -+#define PHYDM_ABD (BIT0 | BIT1 | BIT3) /* 1*/ -+#define PHYDM_ACD (BIT0 | BIT2 | BIT3) /* 2*/ -+#define PHYDM_BCD (BIT1 | BIT2 | BIT3) /* 3*/ -+ -+#define PHYDM_ABCD (BIT0 | BIT1 | BIT2 | BIT3) -+ -+ -+typedef enum dtp_state -+{ -+ PHYDM_DTP_INIT=1, -+ PHYDM_DTP_RUNNING_1 -+ -+}PHYDM_DTP_STATE; -+ -+typedef enum path_div_type -+{ -+ PHYDM_2R_PATH_DIV = 1, -+ PHYDM_4R_PATH_DIV = 2 -+}PHYDM_PATH_DIV_TYPE; -+ -+VOID -+phydm_process_rssi_for_path_div( -+ IN OUT PVOID pDM_VOID, -+ IN PVOID p_phy_info_void, -+ IN PVOID p_pkt_info_void -+ ); -+ -+typedef struct _ODM_PATH_DIVERSITY_ -+{ -+ u1Byte RespTxPath; -+ u1Byte PathSel[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte PathA_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte PathB_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte PathA_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte PathB_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte path_div_type; -+ #if RTL8814A_SUPPORT -+ -+ u4Byte path_a_sum_all; -+ u4Byte path_b_sum_all; -+ u4Byte path_c_sum_all; -+ u4Byte path_d_sum_all; -+ -+ u4Byte path_a_cnt_all; -+ u4Byte path_b_cnt_all; -+ u4Byte path_c_cnt_all; -+ u4Byte path_d_cnt_all; -+ -+ u1Byte dtp_period; -+ BOOLEAN bBecomeLinked; -+ BOOLEAN is_u3_mode; -+ u1Byte num_tx_path; -+ u1Byte default_path; -+ u1Byte num_candidate; -+ u1Byte ant_candidate_1; -+ u1Byte ant_candidate_2; -+ u1Byte ant_candidate_3; -+ u1Byte dtp_state; -+ u1Byte dtp_check_patha_counter; -+ BOOLEAN fix_path_bfer; -+ u1Byte search_space_2[NUM_CHOOSE2_FROM4]; -+ u1Byte search_space_3[NUM_CHOOSE3_FROM4]; -+ -+ u1Byte pre_tx_path; -+ u1Byte use_path_a_as_default_ant; -+ BOOLEAN is_pathA_exist; -+ -+ #endif -+}PATHDIV_T, *pPATHDIV_T; -+ -+ -+#endif //#if(defined(CONFIG_PATH_DIVERSITY)) -+ -+VOID -+phydm_c2h_dtp_handler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+ ); -+ -+VOID -+odm_PathDiversityInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_PathDiversity( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_pathdiv_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ); -+ -+ -+ -+//1 [OLD IC]-------------------------------------------------------------------------------- -+ -+ -+ -+ -+ -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+//#define PATHDIV_ENABLE 1 -+#define dm_PathDiv_RSSI_Check ODM_PathDivChkPerPktRssi -+#define PathDivCheckBeforeLink8192C ODM_PathDiversityBeforeLink92C -+ -+ -+ -+ -+typedef struct _PathDiv_Parameter_define_ -+{ -+ u4Byte org_5g_RegE30; -+ u4Byte org_5g_RegC14; -+ u4Byte org_5g_RegCA0; -+ u4Byte swt_5g_RegE30; -+ u4Byte swt_5g_RegC14; -+ u4Byte swt_5g_RegCA0; -+ //for 2G IQK information -+ u4Byte org_2g_RegC80; -+ u4Byte org_2g_RegC4C; -+ u4Byte org_2g_RegC94; -+ u4Byte org_2g_RegC14; -+ u4Byte org_2g_RegCA0; -+ -+ u4Byte swt_2g_RegC80; -+ u4Byte swt_2g_RegC4C; -+ u4Byte swt_2g_RegC94; -+ u4Byte swt_2g_RegC14; -+ u4Byte swt_2g_RegCA0; -+}PATHDIV_PARA,*pPATHDIV_PARA; -+ -+VOID -+odm_PathDiversityInit_92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_2TPathDiversityInit_92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_1TPathDiversityInit_92C( -+ IN PADAPTER Adapter -+ ); -+ -+BOOLEAN -+odm_IsConnected_92C( -+ IN PADAPTER Adapter -+ ); -+ -+BOOLEAN -+ODM_PathDiversityBeforeLink92C( -+ //IN PADAPTER Adapter -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+odm_PathDiversityAfterLink_92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_SetRespPath_92C( -+ IN PADAPTER Adapter, -+ IN u1Byte DefaultRespPath -+ ); -+ -+VOID -+odm_OFDMTXPathDiversity_92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_CCKTXPathDiversity_92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_ResetPathDiversity_92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_CCKTXPathDiversityCallback( -+ PRT_TIMER pTimer -+ ); -+ -+VOID -+odm_CCKTXPathDiversityWorkItemCallback( -+ IN PVOID pContext -+ ); -+ -+VOID -+odm_PathDivChkAntSwitchCallback( -+ PRT_TIMER pTimer -+ ); -+ -+VOID -+odm_PathDivChkAntSwitchWorkitemCallback( -+ IN PVOID pContext -+ ); -+ -+ -+VOID -+odm_PathDivChkAntSwitch( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_CCKPathDiversityChkPerPktRssi( -+ PADAPTER Adapter, -+ BOOLEAN bIsDefPort, -+ BOOLEAN bMatchBSSID, -+ PRT_WLAN_STA pEntry, -+ PRT_RFD pRfd, -+ pu1Byte pDesc -+ ); -+ -+VOID -+ODM_PathDivChkPerPktRssi( -+ PADAPTER Adapter, -+ BOOLEAN bIsDefPort, -+ BOOLEAN bMatchBSSID, -+ PRT_WLAN_STA pEntry, -+ PRT_RFD pRfd -+ ); -+ -+VOID -+ODM_PathDivRestAfterLink( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_FillTXPathInTXDESC( -+ IN PADAPTER Adapter, -+ IN PRT_TCB pTcb, -+ IN pu1Byte pDesc -+ ); -+ -+VOID -+odm_PathDivInit_92D( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+u1Byte -+odm_SwAntDivSelectScanChnl( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_SwAntDivConstructScanChnl( -+ IN PADAPTER Adapter, -+ IN u1Byte ScanChnl -+ ); -+ -+ #endif //#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+ -+ #endif //#ifndef __ODMPATHDIV_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ap.c linux/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ap.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ap.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ap.c 2017-06-07 23:07:21.019688305 +0300 -@@ -0,0 +1,1050 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if !defined(_OUTSRC_COEXIST) -+//============================================================ -+// Global var -+//============================================================ -+ -+ -+u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE_92D] = { -+ 0x0b40002d, // 0, -15.0dB -+ 0x0c000030, // 1, -14.5dB -+ 0x0cc00033, // 2, -14.0dB -+ 0x0d800036, // 3, -13.5dB -+ 0x0e400039, // 4, -13.0dB -+ 0x0f00003c, // 5, -12.5dB -+ 0x10000040, // 6, -12.0dB -+ 0x11000044, // 7, -11.5dB -+ 0x12000048, // 8, -11.0dB -+ 0x1300004c, // 9, -10.5dB -+ 0x14400051, // 10, -10.0dB -+ 0x15800056, // 11, -9.5dB -+ 0x16c0005b, // 12, -9.0dB -+ 0x18000060, // 13, -8.5dB -+ 0x19800066, // 14, -8.0dB -+ 0x1b00006c, // 15, -7.5dB -+ 0x1c800072, // 16, -7.0dB -+ 0x1e400079, // 17, -6.5dB -+ 0x20000080, // 18, -6.0dB -+ 0x22000088, // 19, -5.5dB -+ 0x24000090, // 20, -5.0dB -+ 0x26000098, // 21, -4.5dB -+ 0x288000a2, // 22, -4.0dB -+ 0x2ac000ab, // 23, -3.5dB -+ 0x2d4000b5, // 24, -3.0dB -+ 0x300000c0, // 25, -2.5dB -+ 0x32c000cb, // 26, -2.0dB -+ 0x35c000d7, // 27, -1.5dB -+ 0x390000e4, // 28, -1.0dB -+ 0x3c8000f2, // 29, -0.5dB -+ 0x40000100, // 30, +0dB -+ 0x43c0010f, // 31, +0.5dB -+ 0x47c0011f, // 32, +1.0dB -+ 0x4c000130, // 33, +1.5dB -+ 0x50800142, // 34, +2.0dB -+ 0x55400155, // 35, +2.5dB -+ 0x5a400169, // 36, +3.0dB -+ 0x5fc0017f, // 37, +3.5dB -+ 0x65400195, // 38, +4.0dB -+ 0x6b8001ae, // 39, +4.5dB -+ 0x71c001c7, // 40, +5.0dB -+ 0x788001e2, // 41, +5.5dB -+ 0x7f8001fe // 42, +6.0dB -+}; -+ -+u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB -+ {0x1c, 0x1a, 0x18, 0x12, 0x0e, 0x08, 0x04, 0x02}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB -+ {0x1c, 0x1a, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB -+}; -+ -+u4Byte OFDMSwingTable[OFDM_TABLE_SIZE_92D] = { -+ 0x0b40002d, // 0, -15.0dB -+ 0x0c000030, // 1, -14.5dB -+ 0x0cc00033, // 2, -14.0dB -+ 0x0d800036, // 3, -13.5dB -+ 0x0e400039, // 4, -13.0dB -+ 0x0f00003c, // 5, -12.5dB -+ 0x10000040, // 6, -12.0dB -+ 0x11000044, // 7, -11.5dB -+ 0x12000048, // 8, -11.0dB -+ 0x1300004c, // 9, -10.5dB -+ 0x14400051, // 10, -10.0dB -+ 0x15800056, // 11, -9.5dB -+ 0x16c0005b, // 12, -9.0dB -+ 0x18000060, // 13, -8.5dB -+ 0x19800066, // 14, -8.0dB -+ 0x1b00006c, // 15, -7.5dB -+ 0x1c800072, // 16, -7.0dB -+ 0x1e400079, // 17, -6.5dB -+ 0x20000080, // 18, -6.0dB -+ 0x22000088, // 19, -5.5dB -+ 0x24000090, // 20, -5.0dB -+ 0x26000098, // 21, -4.5dB -+ 0x288000a2, // 22, -4.0dB -+ 0x2ac000ab, // 23, -3.5dB -+ 0x2d4000b5, // 24, -3.0dB -+ 0x300000c0, // 25, -2.5dB -+ 0x32c000cb, // 26, -2.0dB -+ 0x35c000d7, // 27, -1.5dB -+ 0x390000e4, // 28, -1.0dB -+ 0x3c8000f2, // 29, -0.5dB -+ 0x40000100, // 30, +0dB -+ 0x43c0010f, // 31, +0.5dB -+ 0x47c0011f, // 32, +1.0dB -+ 0x4c000130, // 33, +1.5dB -+ 0x50800142, // 34, +2.0dB -+ 0x55400155, // 35, +2.5dB -+ 0x5a400169, // 36, +3.0dB -+ 0x5fc0017f, // 37, +3.5dB -+ 0x65400195, // 38, +4.0dB -+ 0x6b8001ae, // 39, +4.5dB -+ 0x71c001c7, // 40, +5.0dB -+ 0x788001e2, // 41, +5.5dB -+ 0x7f8001fe // 42, +6.0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB -+ {0x1c, 0x1a, 0x18, 0x12, 0x0e, 0x08, 0x04, 0x02}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]= { -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB -+ {0x1c, 0x1a, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB -+}; -+ -+u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -+{0x16, 0x15, 0x13, 0x10, 0xD, 0x9, 0x6, 0x3, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 0 -16dB */ -+{0x18, 0x17, 0x15, 0x12, 0xE, 0xA, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 1 -15.5dB */ -+{0x1B, 0x1A, 0x18, 0x14, 0x10, 0xB, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 2 -15dB */ -+{0x1F, 0x1E, 0x1B, 0x17, 0x12, 0xD, 0x8, 0x5, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 3 -14.5dB */ -+{0x22, 0x21, 0x1E, 0x19, 0x14, 0xE, 0x9, 0x5, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 4 -14dB */ -+{0x26, 0x25, 0x22, 0x1C, 0x16, 0x10, 0xA, 0x6, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 5 -13.5dB */ -+{0x2B, 0x2A, 0x26, 0x20, 0x19, 0x12, 0xC, 0x7, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 6 -13dB */ -+{0x30, 0x2F, 0x2A, 0x24, 0x1C, 0x14, 0xD, 0x8, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 7 -12.5dB */ -+{0x36, 0x34, 0x2F, 0x28, 0x1F, 0x17, 0xF, 0x9, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 8 -12dB */ -+{0x3D, 0x3B, 0x35, 0x2D, 0x23, 0x19, 0x11, 0xA, 0x5, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 9 -11.5dB */ -+{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0xB, 0x5, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 10 -11dB */ -+{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0xC, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 11 -10.5dB */ -+{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0xE, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 12 -10dB */ -+{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0xF, 0x7, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 13 -9.5dB */ -+{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x8, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 14 -9dB */ -+{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x9, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 15 -8.5dB */ -+{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0xA, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 16 -8dB */ -+{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0xB, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 17 -7.5dB */ -+{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0xD, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 18 -7dB */ -+{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0xE, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 19 -6.5dB */ -+{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x5, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0} /* 20 -6dB */ -+}; -+ -+ -+#if 0 -+u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E] = { -+ /* Index0 6 dB */ 0x7fc001ff, -+ /* Index1 5.7dB */ 0x7b4001ed, -+ /* Index2 5.4dB */ 0x774001dd, -+ /* Index3 5.1dB */ 0x734001cd, -+ /* Index4 4.8dB */ 0x6f4001bd, -+ /* Index5 4.5dB */ 0x6b8001ae, -+ /* Index6 4.2dB */ 0x67c0019f, -+ /* Index7 3.9dB */ 0x64400191, -+ /* Index8 3.6dB */ 0x60c00183, -+ /* Index9 3.3dB */ 0x5d800176, -+ /* Index10 3 dB */ 0x5a80016a, -+ /* Index11 2.7dB */ 0x5740015d, -+ /* Index12 2.4dB */ 0x54400151, -+ /* Index13 2.1dB */ 0x51800146, -+ /* Index14 1.8dB */ 0x4ec0013b, -+ /* Index15 1.5dB */ 0x4c000130, -+ /* Index16 1.2dB */ 0x49800126, -+ /* Index17 0.9dB */ 0x4700011c, -+ /* Index18 0.6dB */ 0x44800112, -+ /* Index19 0.3dB */ 0x42000108, -+ /* Index20 0 dB */ 0x40000100, // 20 This is OFDM base index -+ /* Index21 -0.3dB */ 0x3dc000f7, -+ /* Index22 -0.6dB */ 0x3bc000ef, -+ /* Index23 -0.9dB */ 0x39c000e7, -+ /* Index24 -1.2dB */ 0x37c000df, -+ /* Index25 -1.5dB */ 0x35c000d7, -+ /* Index26 -1.8dB */ 0x340000d0, -+ /* Index27 -2.1dB */ 0x324000c9, -+ /* Index28 -2.4dB */ 0x308000c2, -+ /* Index29 -2.7dB */ 0x2f0000bc, -+ /* Index30 -3 dB */ 0x2d4000b5, -+ /* Index31 -3.3dB */ 0x2bc000af, -+ /* Index32 -3.6dB */ 0x2a4000a9, -+ /* Index33 -3.9dB */ 0x28c000a3, -+ /* Index34 -4.2dB */ 0x2780009e, -+ /* Index35 -4.5dB */ 0x26000098, -+ /* Index36 -4.8dB */ 0x24c00093, -+ /* Index37 -5.1dB */ 0x2380008e, -+ /* Index38 -5.4dB */ 0x22400089, -+ /* Index39 -5.7dB */ 0x21400085, -+ /* Index40 -6 dB */ 0x20000080, -+ /* Index41 -6.3dB */ 0x1f00007c, -+ /* Index42 -6.6dB */ 0x1e000078, -+ /* Index43 -6.9dB */ 0x1d000074, -+ /* Index44 -7.2dB */ 0x1c000070, -+ /* Index45 -7.5dB */ 0x1b00006c, -+ /* Index46 -7.8dB */ 0x1a000068, -+ /* Index47 -8.1dB */ 0x19400065, -+ /* Index48 -8.4dB */ 0x18400061, -+ /* Index49 -8.7dB */ 0x1780005e, -+ /* Index50 -9 dB */ 0x16c0005b, -+ /* Index51 -9.3dB */ 0x16000058, -+ /* Index52 -9.6dB */ 0x15400055, -+ /* Index53 -9.9dB */ 0x14800052 -+}; -+u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8] = { -+ /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x1C , 0x12 , 0x08 , 0x04}, -+ /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x1B , 0x11 , 0x08 , 0x04}, -+ /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x1A , 0x11 , 0x07 , 0x04}, -+ /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x19 , 0x10 , 0x07 , 0x04}, -+ /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x18 , 0x10 , 0x07 , 0x03}, -+ /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x18 , 0x0F , 0x07 , 0x03}, -+ /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x17 , 0x0F , 0x06 , 0x03}, -+ /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x16 , 0x0E , 0x06 , 0x03}, -+ /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x15 , 0x0E , 0x06 , 0x03}, -+ /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x14 , 0x0D , 0x06 , 0x03}, -+ /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x14 , 0x0D , 0x06 , 0x03}, -+ /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x13 , 0x0C , 0x05 , 0x03}, -+ /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x12 , 0x0C , 0x05 , 0x03}, -+ /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x12 , 0x0B , 0x05 , 0x03}, -+ /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, -+ /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, -+ /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x10 , 0x0A , 0x05 , 0x02}, -+ /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x10 , 0x0A , 0x04 , 0x02}, -+ /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x0F , 0x0A , 0x04 , 0x02}, -+ /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x0E , 0x09 , 0x04 , 0x02}, -+ /* Index20 -6.0dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x0E , 0x09 , 0x04 , 0x02}, // 20 This is CCK base index -+ /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x0E , 0x09 , 0x04 , 0x02}, -+ /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x0D , 0x08 , 0x04 , 0x02}, -+ /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x0D , 0x08 , 0x04 , 0x02}, -+ /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x0C , 0x08 , 0x03 , 0x02}, -+ /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x0C , 0x08 , 0x03 , 0x02}, -+ /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, -+ /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, -+ /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x0B , 0x07 , 0x03 , 0x02}, -+ /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x0A , 0x07 , 0x03 , 0x01}, -+ /* Index30 -9.0dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, // 30 This is hp CCK base index -+ /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, -+ /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x09 , 0x06 , 0x03 , 0x01}, -+ /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x09 , 0x06 , 0x03 , 0x01}, -+ /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x09 , 0x06 , 0x02 , 0x01}, -+ /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, -+ /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, -+ /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x08 , 0x05 , 0x02 , 0x01}, -+ /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, -+ /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, -+ /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, -+ /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, -+ /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, -+ /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x05 , 0x03 , 0x02 , 0x01}, -+ /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x04 , 0x03 , 0x01 , 0x01} -+}; -+u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8] = { -+ /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index20 -6 dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index30 -9 dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00} -+}; -+#endif -+ -+#ifdef AP_BUILD_WORKAROUND -+ -+unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { -+ /* +6.0dB */ 0x7f8001fe, -+ /* +5.5dB */ 0x788001e2, -+ /* +5.0dB */ 0x71c001c7, -+ /* +4.5dB */ 0x6b8001ae, -+ /* +4.0dB */ 0x65400195, -+ /* +3.5dB */ 0x5fc0017f, -+ /* +3.0dB */ 0x5a400169, -+ /* +2.5dB */ 0x55400155, -+ /* +2.0dB */ 0x50800142, -+ /* +1.5dB */ 0x4c000130, -+ /* +1.0dB */ 0x47c0011f, -+ /* +0.5dB */ 0x43c0010f, -+ /* 0.0dB */ 0x40000100, -+ /* -0.5dB */ 0x3c8000f2, -+ /* -1.0dB */ 0x390000e4, -+ /* -1.5dB */ 0x35c000d7, -+ /* -2.0dB */ 0x32c000cb, -+ /* -2.5dB */ 0x300000c0, -+ /* -3.0dB */ 0x2d4000b5, -+ /* -3.5dB */ 0x2ac000ab, -+ /* -4.0dB */ 0x288000a2, -+ /* -4.5dB */ 0x26000098, -+ /* -5.0dB */ 0x24000090, -+ /* -5.5dB */ 0x22000088, -+ /* -6.0dB */ 0x20000080, -+ /* -6.5dB */ 0x1a00006c, -+ /* -7.0dB */ 0x1c800072, -+ /* -7.5dB */ 0x18000060, -+ /* -8.0dB */ 0x19800066, -+ /* -8.5dB */ 0x15800056, -+ /* -9.0dB */ 0x26c0005b, -+ /* -9.5dB */ 0x14400051, -+ /* -10.0dB */ 0x24400051, -+ /* -10.5dB */ 0x1300004c, -+ /* -11.0dB */ 0x12000048, -+ /* -11.5dB */ 0x11000044, -+ /* -12.0dB */ 0x10000040 -+}; -+#endif -+ -+#endif -+ -+ -+u1Byte DeltaSwingTableIdx_2GA_P_DEFAULT[DELTA_SWINGIDX_SIZE] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3 -+, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; -+u1Byte DeltaSwingTableIdx_2GA_N_DEFAULT[DELTA_SWINGIDX_SIZE] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4 -+, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; -+ -+ -+#ifdef CONFIG_WLAN_HAL_8192EE -+u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E] = { -+ /* Index0 6 dB */ 0x7fc001ff, -+ /* Index1 5.7dB */ 0x7b4001ed, -+ /* Index2 5.4dB */ 0x774001dd, -+ /* Index3 5.1dB */ 0x734001cd, -+ /* Index4 4.8dB */ 0x6f4001bd, -+ /* Index5 4.5dB */ 0x6b8001ae, -+ /* Index6 4.2dB */ 0x67c0019f, -+ /* Index7 3.9dB */ 0x64400191, -+ /* Index8 3.6dB */ 0x60c00183, -+ /* Index9 3.3dB */ 0x5d800176, -+ /* Index10 3 dB */ 0x5a80016a, -+ /* Index11 2.7dB */ 0x5740015d, -+ /* Index12 2.4dB */ 0x54400151, -+ /* Index13 2.1dB */ 0x51800146, -+ /* Index14 1.8dB */ 0x4ec0013b, -+ /* Index15 1.5dB */ 0x4c000130, -+ /* Index16 1.2dB */ 0x49800126, -+ /* Index17 0.9dB */ 0x4700011c, -+ /* Index18 0.6dB */ 0x44800112, -+ /* Index19 0.3dB */ 0x42000108, -+ /* Index20 0 dB */ 0x40000100, // 20 This is OFDM base index -+ /* Index21 -0.3dB */ 0x3dc000f7, -+ /* Index22 -0.6dB */ 0x3bc000ef, -+ /* Index23 -0.9dB */ 0x39c000e7, -+ /* Index24 -1.2dB */ 0x37c000df, -+ /* Index25 -1.5dB */ 0x35c000d7, -+ /* Index26 -1.8dB */ 0x340000d0, -+ /* Index27 -2.1dB */ 0x324000c9, -+ /* Index28 -2.4dB */ 0x308000c2, -+ /* Index29 -2.7dB */ 0x2f0000bc, -+ /* Index30 -3 dB */ 0x2d4000b5, -+ /* Index31 -3.3dB */ 0x2bc000af, -+ /* Index32 -3.6dB */ 0x2a4000a9, -+ /* Index33 -3.9dB */ 0x28c000a3, -+ /* Index34 -4.2dB */ 0x2780009e, -+ /* Index35 -4.5dB */ 0x26000098, -+ /* Index36 -4.8dB */ 0x24c00093, -+ /* Index37 -5.1dB */ 0x2380008e, -+ /* Index38 -5.4dB */ 0x22400089, -+ /* Index39 -5.7dB */ 0x21400085, -+ /* Index40 -6 dB */ 0x20000080, -+ /* Index41 -6.3dB */ 0x1f00007c, -+ /* Index42 -6.6dB */ 0x1e000078, -+ /* Index43 -6.9dB */ 0x1d000074, -+ /* Index44 -7.2dB */ 0x1c000070, -+ /* Index45 -7.5dB */ 0x1b00006c, -+ /* Index46 -7.8dB */ 0x1a000068, -+ /* Index47 -8.1dB */ 0x19400065, -+ /* Index48 -8.4dB */ 0x18400061, -+ /* Index49 -8.7dB */ 0x1780005e, -+ /* Index50 -9 dB */ 0x16c0005b, -+ /* Index51 -9.3dB */ 0x16000058, -+ /* Index52 -9.6dB */ 0x15400055, -+ /* Index53 -9.9dB */ 0x14800052 -+}; -+u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8] = { -+ /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x1C , 0x12 , 0x08 , 0x04}, -+ /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x1B , 0x11 , 0x08 , 0x04}, -+ /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x1A , 0x11 , 0x07 , 0x04}, -+ /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x19 , 0x10 , 0x07 , 0x04}, -+ /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x18 , 0x10 , 0x07 , 0x03}, -+ /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x18 , 0x0F , 0x07 , 0x03}, -+ /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x17 , 0x0F , 0x06 , 0x03}, -+ /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x16 , 0x0E , 0x06 , 0x03}, -+ /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x15 , 0x0E , 0x06 , 0x03}, -+ /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x14 , 0x0D , 0x06 , 0x03}, -+ /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x14 , 0x0D , 0x06 , 0x03}, -+ /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x13 , 0x0C , 0x05 , 0x03}, -+ /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x12 , 0x0C , 0x05 , 0x03}, -+ /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x12 , 0x0B , 0x05 , 0x03}, -+ /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, -+ /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, -+ /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x10 , 0x0A , 0x05 , 0x02}, -+ /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x10 , 0x0A , 0x04 , 0x02}, -+ /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x0F , 0x0A , 0x04 , 0x02}, -+ /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x0E , 0x09 , 0x04 , 0x02}, -+ /* Index20 -6.0dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x0E , 0x09 , 0x04 , 0x02}, // 20 This is CCK base index -+ /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x0E , 0x09 , 0x04 , 0x02}, -+ /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x0D , 0x08 , 0x04 , 0x02}, -+ /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x0D , 0x08 , 0x04 , 0x02}, -+ /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x0C , 0x08 , 0x03 , 0x02}, -+ /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x0C , 0x08 , 0x03 , 0x02}, -+ /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, -+ /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, -+ /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x0B , 0x07 , 0x03 , 0x02}, -+ /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x0A , 0x07 , 0x03 , 0x01}, -+ /* Index30 -9.0dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, // 30 This is hp CCK base index -+ /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, -+ /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x09 , 0x06 , 0x03 , 0x01}, -+ /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x09 , 0x06 , 0x03 , 0x01}, -+ /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x09 , 0x06 , 0x02 , 0x01}, -+ /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, -+ /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, -+ /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x08 , 0x05 , 0x02 , 0x01}, -+ /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, -+ /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, -+ /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, -+ /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, -+ /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, -+ /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x05 , 0x03 , 0x02 , 0x01}, -+ /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x04 , 0x03 , 0x01 , 0x01} -+}; -+u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8] = { -+ /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index20 -6 dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index30 -9 dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00} -+}; -+#endif -+ -+#if(RTL8814A_SUPPORT == 1) -+u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = -+{ -+ 0x081, // 0, -12.0dB -+ 0x088, // 1, -11.5dB -+ 0x090, // 2, -11.0dB -+ 0x099, // 3, -10.5dB -+ 0x0A2, // 4, -10.0dB -+ 0x0AC, // 5, -9.5dB -+ 0x0B6, // 6, -9.0dB -+ 0x0C0, // 7, -8.5dB -+ 0x0CC, // 8, -8.0dB -+ 0x0D8, // 9, -7.5dB -+ 0x0E5, // 10, -7.0dB -+ 0x0F2, // 11, -6.5dB -+ 0x101, // 12, -6.0dB -+ 0x110, // 13, -5.5dB -+ 0x120, // 14, -5.0dB -+ 0x131, // 15, -4.5dB -+ 0x143, // 16, -4.0dB -+ 0x156, // 17, -3.5dB -+ 0x16A, // 18, -3.0dB -+ 0x180, // 19, -2.5dB -+ 0x197, // 20, -2.0dB -+ 0x1AF, // 21, -1.5dB -+ 0x1C8, // 22, -1.0dB -+ 0x1E3, // 23, -0.5dB -+ 0x200, // 24, +0 dB -+ 0x21E, // 25, +0.5dB -+ 0x23E, // 26, +1.0dB -+ 0x261, // 27, +1.5dB -+ 0x285, // 28, +2.0dB -+ 0x2AB, // 29, +2.5dB -+ 0x2D3, // 30, +3.0dB -+ 0x2FE, // 31, +3.5dB -+ 0x32B, // 32, +4.0dB -+ 0x35C, // 33, +4.5dB -+ 0x38E, // 34, +5.0dB -+ 0x3C4, // 35, +5.5dB -+ 0x3FE // 36, +6.0dB -+}; -+#elif(ODM_IC_11AC_SERIES_SUPPORT) -+u4Byte OFDMSwingTable_8812[OFDM_TABLE_SIZE_8812] = { -+ 0x3FE, // 0, (6dB) -+ 0x3C4, // 1, (5.5dB) -+ 0x38E, // 2, (5dB) -+ 0x35C, // 3, (4.5dB) -+ 0x32B, // 4, (4dB) -+ 0x2FE, // 5, (3.5dB) -+ 0x2D3, // 6, (3dB) -+ 0x2AB, // 7, (2.5dB) -+ 0x285, // 8, (2dB) -+ 0x261, // 9, (1.5dB -+ 0x23E, // 10, (1dB) -+ 0x21E, // 11, (0.5dB) -+ 0x200, // 12, (0dB) 8814 int PA 2G default -+ 0x1E3, // 13, (-0.5dB) -+ 0x1C8, // 14, (-1dB) -+ 0x1AF, // 15, (-1.5dB) -+ 0x197, // 16, (-2dB) -+ 0x180, // 17, (-2.5dB) -+ 0x16A, // 18, (-3dB) 8812 / 8814 int PA 5G / 8814 ext PA 2G5G default -+ 0x156, // 19, (-3.5dB) -+ 0x143, // 20, (-4dB) 8812 HP default -+ 0x131, // 21, (-4.5dB) -+ 0x120, // 22, (-5dB) -+ 0x110, // 23, (-5.5dB) -+ 0x101, // 24, (-6dB) -+ 0x0F2, // 25, (-6.5dB) -+ 0x0E5, // 26, (-7dB) -+ 0x0D8, // 27, (-7.5dB) -+ 0x0CC, // 28, (-8dB) -+ 0x0C0, // 29, (-8.5dB) -+ 0x0B6, // 30, (-9dB) -+ 0x0AC, // 31, (-9.5dB) -+ 0x0A2, // 32, (-10dB) -+ 0x099, // 33, (-10.5dB) -+ 0x090, // 34, (-11dB) -+ 0x088, // 35, (-11.5dB) -+ 0x081, // 36, (-12dB) -+ 0x079, // 37, (-12.5dB) -+ 0x072, // 38, (-13dB) -+ 0x06c, // 39, (-13.5dB) -+ 0x066, // 40, (-14dB) -+ 0x060, // 41, (-14.5dB) -+ 0x05B // 42, (-15dB) -+}; -+#endif -+ -+//#endif -+//3============================================================ -+//3 Tx Power Tracking -+//3============================================================ -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ if(!(pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_IC_11N_SERIES))) -+ return; -+#endif -+ -+ odm_TXPowerTrackingThermalMeterInit(pDM_Odm); -+} -+ -+ -+VOID -+odm_TXPowerTrackingThermalMeterInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ u1Byte p; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ pMgntInfo->bTXPowerTracking = TRUE; -+ pHalData->TXPowercount = 0; -+ pHalData->bTXPowerTrackingInit = FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pHalData->TxPowerTrackControl = TRUE; -+ ODM_RT_TRACE(pDM_Odm,COMP_POWER_TRACKING, DBG_LOUD, ("pMgntInfo->bTXPowerTracking = %d\n", pMgntInfo->bTXPowerTracking)); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #ifdef CONFIG_RTL8188E -+ { -+ pDM_Odm->RFCalibrateInfo.bTXPowerTracking = _TRUE; -+ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; -+ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = _FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; -+ -+ MSG_8192C("pDM_Odm TxPowerTrackControl = %d\n", pDM_Odm->RFCalibrateInfo.TxPowerTrackControl); -+ } -+ #else -+ { -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ -+ //if(IS_HARDWARE_TYPE_8192C(pHalData)) -+ { -+ pdmpriv->bTXPowerTracking = _TRUE; -+ pdmpriv->TXPowercount = 0; -+ pdmpriv->bTXPowerTrackingInit = _FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) //for mp driver, turn off txpwrtracking as default -+ pdmpriv->TxPowerTrackControl = _TRUE; -+ -+ } -+ MSG_8192C("pdmpriv->TxPowerTrackControl = %d\n", pdmpriv->TxPowerTrackControl); -+ -+ } -+ #endif//endif (CONFIG_RTL8188E==1) -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+ #ifdef RTL8188E_SUPPORT -+ { -+ pDM_Odm->RFCalibrateInfo.bTXPowerTracking = _TRUE; -+ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; -+ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = _FALSE; -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; -+ } -+ #endif -+#endif -+ -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = TRUE; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex = 0; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast = 0; -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset = 0; -+ pDM_Odm->RFCalibrateInfo.ThermalValue = 0; -+ pRFCalibrateInfo->DefaultOfdmIndex = 28; -+ -+ -+#if RTL8188E_SUPPORT -+ pRFCalibrateInfo->DefaultCckIndex = 20; // -6 dB -+#elif RTL8192E_SUPPORT -+ pRFCalibrateInfo->DefaultCckIndex = 8; // -12 dB -+#endif -+ pRFCalibrateInfo->BbSwingIdxOfdmBase = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; -+ pDM_Odm->RFCalibrateInfo.CCK_index = pRFCalibrateInfo->DefaultCckIndex; -+ for(p = 0; p < MAX_RF_PATH; p++) -+ { -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->KfreeOffset[p] = 0; // for 8814 kfree -+ } -+ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->DefaultCckIndex; -+ -+} -+ -+ -+VOID -+ODM_TXPowerTrackingCheck( -+ IN PVOID pDM_VOID -+ ) -+{ -+ // -+ // For AP/ADSL use prtl8192cd_priv -+ // For CE/NIC use PADAPTER -+ // -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ -+ -+ if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) -+ return; -+ -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ odm_TXPowerTrackingCheckMP(pDM_Odm); -+ break; -+ -+ case ODM_CE: -+ odm_TXPowerTrackingCheckCE(pDM_Odm); -+ break; -+ -+ case ODM_AP: -+ odm_TXPowerTrackingCheckAP(pDM_Odm); -+ break; -+ default: -+ break; -+ } -+ -+} -+ -+VOID -+odm_TXPowerTrackingCheckCE( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ #if(RTL8188E_SUPPORT==1) -+ -+ //if(!pMgntInfo->bTXPowerTracking /*|| (!pdmpriv->TxPowerTrackControl && pdmpriv->bAPKdone)*/) -+ if(!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) -+ { -+ return; -+ } -+ -+ if(!pDM_Odm->RFCalibrateInfo.TM_Trigger) //at least delay 1 sec -+ { -+ //pHalData->TxPowerCheckCnt++; //cosa add for debug -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); -+ //DBG_8192C("Trigger 92C Thermal Meter!!\n"); -+ -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; -+ return; -+ -+ } -+ else -+ { -+ //DBG_8192C("Schedule TxPowerTracking direct call!!\n"); -+ odm_TXPowerTrackingCallback_ThermalMeter_8188E(Adapter); -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; -+ } -+ #endif -+ -+#endif -+} -+ -+VOID -+odm_TXPowerTrackingCheckMP( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ if (ODM_CheckPowerStatus(Adapter) == FALSE) -+ return; -+ -+ if(!Adapter->bSlaveOfDMSP || Adapter->DualMacSmartConcurrent == FALSE) -+ odm_TXPowerTrackingThermalMeterCheck(Adapter); -+#endif -+ -+} -+ -+ -+VOID -+odm_TXPowerTrackingCheckAP( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+#if ((RTL8188E_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) || (RTL8814A_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8812|ODM_RTL8881A|ODM_RTL8814A)) -+ ODM_TXPowerTrackingCallback_ThermalMeter(pDM_Odm); -+ else -+#endif -+ { -+ } -+#endif -+ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+VOID -+odm_TXPowerTrackingThermalMeterCheck( -+ IN PADAPTER Adapter -+ ) -+{ -+#ifndef AP_BUILD_WORKAROUND -+#if (HAL_CODE_BASE==RTL8192_C) -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ static u1Byte TM_Trigger = 0; -+ //u1Byte TxPowerCheckCnt = 5; //10 sec -+ -+ if(!pMgntInfo->bTXPowerTracking /*|| (!pHalData->TxPowerTrackControl && pHalData->bAPKdone)*/) -+ { -+ return; -+ } -+ -+ if(!TM_Trigger) //at least delay 1 sec -+ { -+ if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_8812(Adapter)) -+ PHY_SetRFReg(Adapter, RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03); -+ else -+ PHY_SetRFReg(Adapter, RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger 92C Thermal Meter!!\n")); -+ -+ TM_Trigger = 1; -+ return; -+ } -+ else -+ { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n")); -+ odm_TXPowerTrackingDirectCall(Adapter); //Using direct call is instead, added by Roger, 2009.06.18. -+ TM_Trigger = 0; -+ } -+#endif -+#endif -+} -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ap.h linux/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ap.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ap.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ap.h 2017-06-07 23:07:21.019688305 +0300 -@@ -0,0 +1,314 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMPOWERTRACKING_H__ -+#define __PHYDMPOWERTRACKING_H__ -+ -+#define POWRTRACKING_VERSION "1.1" -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+#ifdef RTK_AC_SUPPORT -+#define ODM_IC_11AC_SERIES_SUPPORT 1 -+#else -+#define ODM_IC_11AC_SERIES_SUPPORT 0 -+#endif -+#else -+#define ODM_IC_11AC_SERIES_SUPPORT 1 -+#endif -+ -+#define DPK_DELTA_MAPPING_NUM 13 -+#define index_mapping_HP_NUM 15 -+#define DELTA_SWINGIDX_SIZE 30 -+#define BAND_NUM 3 -+#define MAX_RF_PATH 4 -+#define TXSCALE_TABLE_SIZE 37 -+#define IQK_MAC_REG_NUM 4 -+#define IQK_ADDA_REG_NUM 16 -+#define IQK_BB_REG_NUM_MAX 10 -+ -+#define IQK_BB_REG_NUM 9 -+ -+#define HP_THERMAL_NUM 8 -+ -+#define AVG_THERMAL_NUM 8 -+#define IQK_Matrix_REG_NUM 8 -+//#define IQK_Matrix_Settings_NUM 1+24+21 -+#define IQK_Matrix_Settings_NUM (14+24+21) // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G -+ -+#if !defined(_OUTSRC_COEXIST) -+#define OFDM_TABLE_SIZE_92D 43 -+#define OFDM_TABLE_SIZE 37 -+#define CCK_TABLE_SIZE 33 -+#define CCK_TABLE_SIZE_88F 21 -+ -+ -+ -+//#define OFDM_TABLE_SIZE_92E 54 -+//#define CCK_TABLE_SIZE_92E 54 -+extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE_92D]; -+extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; -+ -+ -+extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE_92D]; -+extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -+ -+#endif -+ -+#define ODM_OFDM_TABLE_SIZE 37 -+#define ODM_CCK_TABLE_SIZE 33 -+// <20140613, YuChen> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. -+extern u1Byte DeltaSwingTableIdx_2GA_P_DEFAULT[DELTA_SWINGIDX_SIZE]; -+extern u1Byte DeltaSwingTableIdx_2GA_N_DEFAULT[DELTA_SWINGIDX_SIZE]; -+ -+ -+//extern u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E]; -+//extern u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8]; -+//extern u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8]; -+ -+#ifdef CONFIG_WLAN_HAL_8192EE -+#define OFDM_TABLE_SIZE_92E 54 -+#define CCK_TABLE_SIZE_92E 54 -+extern u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E]; -+extern u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8]; -+extern u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8]; -+#endif -+ -+#define OFDM_TABLE_SIZE_8812 43 -+#define AVG_THERMAL_NUM_8812 4 -+ -+#if(RTL8814A_SUPPORT == 1) -+extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; -+#elif(ODM_IC_11AC_SERIES_SUPPORT) -+extern unsigned int OFDMSwingTable_8812[OFDM_TABLE_SIZE_8812]; -+#endif -+ -+#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck -+ -+typedef struct _IQK_MATRIX_REGS_SETTING{ -+ BOOLEAN bIQKDone; -+ s4Byte Value[1][IQK_Matrix_REG_NUM]; -+}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; -+ -+typedef struct ODM_RF_Calibration_Structure -+{ -+ //for tx power tracking -+ -+ u4Byte RegA24; // for TempCCK -+ s4Byte RegE94; -+ s4Byte RegE9C; -+ s4Byte RegEB4; -+ s4Byte RegEBC; -+ -+ //u1Byte bTXPowerTracking; -+ u1Byte TXPowercount; -+ BOOLEAN bTXPowerTrackingInit; -+ BOOLEAN bTXPowerTracking; -+ u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default -+ u1Byte TM_Trigger; -+ u1Byte InternalPA5G[2]; //pathA / pathB -+ -+ u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 -+ u1Byte ThermalValue; -+ u1Byte ThermalValue_LCK; -+ u1Byte ThermalValue_IQK; -+ u1Byte ThermalValue_DPK; -+ u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; -+ u1Byte ThermalValue_AVG_index; -+ u1Byte ThermalValue_RxGain; -+ u1Byte ThermalValue_Crystal; -+ u1Byte ThermalValue_DPKstore; -+ u1Byte ThermalValue_DPKtrack; -+ BOOLEAN TxPowerTrackingInProgress; -+ BOOLEAN bDPKenable; -+ -+ BOOLEAN bReloadtxpowerindex; -+ u1Byte bRfPiEnable; -+ u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug -+ -+ u1Byte bCCKinCH14; -+ u1Byte CCK_index; -+ u1Byte OFDM_index[MAX_RF_PATH]; -+ s1Byte PowerIndexOffset; -+ s1Byte DeltaPowerIndex; -+ s1Byte DeltaPowerIndexLast; -+ BOOLEAN bTxPowerChanged; -+ -+ u1Byte ThermalValue_HP[HP_THERMAL_NUM]; -+ u1Byte ThermalValue_HP_index; -+ IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; -+ BOOLEAN bNeedIQK; -+ u1Byte Delta_IQK; -+ u1Byte Delta_LCK; -+ u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKC_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKC_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKD_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKD_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GC_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GC_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GD_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GD_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GC_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GC_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GD_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GD_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; -+ -+ u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; -+ u1Byte BbSwingIdxOfdmCurrent; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; -+#else -+ u1Byte BbSwingIdxOfdmBase; -+#endif -+ BOOLEAN BbSwingFlagOfdm; -+ u1Byte BbSwingIdxCck; -+ u1Byte BbSwingIdxCckCurrent; -+ u1Byte BbSwingIdxCckBase; -+ u1Byte DefaultOfdmIndex; -+ u1Byte DefaultCckIndex; -+ BOOLEAN BbSwingFlagCck; -+ -+ s1Byte Absolute_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_CCKSwingIdx; -+ s1Byte Modify_TxAGC_Value; /*Remnat compensate value at TxAGC */ -+ BOOLEAN Modify_TxAGC_Flag_PathA; -+ BOOLEAN Modify_TxAGC_Flag_PathB; -+ BOOLEAN Modify_TxAGC_Flag_PathC; -+ BOOLEAN Modify_TxAGC_Flag_PathD; -+ BOOLEAN Modify_TxAGC_Flag_PathA_CCK; -+ -+ s1Byte KfreeOffset[MAX_RF_PATH]; -+ -+ //--------------------------------------------------------------------// -+ -+ //for IQK -+ u4Byte RegC04; -+ u4Byte Reg874; -+ u4Byte RegC08; -+ u4Byte RegB68; -+ u4Byte RegB6C; -+ u4Byte Reg870; -+ u4Byte Reg860; -+ u4Byte Reg864; -+ -+ BOOLEAN bIQKInitialized; -+ BOOLEAN bLCKInProgress; -+ BOOLEAN bAntennaDetected; -+ u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; -+ u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; -+ u4Byte IQK_BB_backup_recover[9]; -+ u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; -+ -+ //for APK -+ u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a -+ u1Byte bAPKdone; -+ u1Byte bAPKThermalMeterIgnore; -+ u1Byte bDPdone; -+ u1Byte bDPPathAOK; -+ u1Byte bDPPathBOK; -+ -+ /*Add by Yuchen for Kfree Phydm*/ -+ u1Byte RegRfKFreeEnable; /*for registry*/ -+ u1Byte RfKFreeEnable; /*for efuse enable check*/ -+ -+}ODM_RF_CAL_T,*PODM_RF_CAL_T; -+ -+VOID -+odm_TXPowerTrackingCheckAP( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+ODM_TXPowerTrackingCheck( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+VOID -+odm_TXPowerTrackingThermalMeterInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingCheckMP( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+VOID -+odm_TXPowerTrackingCheckCE( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+VOID -+odm_TXPowerTrackingCallbackThermalMeter92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingCallbackRXGainThermalMeter92D( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingCallbackThermalMeter92D( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingDirectCall92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingThermalMeterCheck( -+ IN PADAPTER Adapter -+ ); -+ -+#endif -+ -+ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ce.c linux/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ce.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ce.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ce.c 2017-06-07 23:07:21.019688305 +0300 -@@ -0,0 +1,670 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+/*============================================================ */ -+/* include files */ -+/*============================================================ */ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+//============================================================ -+// Global var -+//============================================================ -+ -+u4Byte OFDMSwingTable[OFDM_TABLE_SIZE] = { -+ 0x7f8001fe, // 0, +6.0dB -+ 0x788001e2, // 1, +5.5dB -+ 0x71c001c7, // 2, +5.0dB -+ 0x6b8001ae, // 3, +4.5dB -+ 0x65400195, // 4, +4.0dB -+ 0x5fc0017f, // 5, +3.5dB -+ 0x5a400169, // 6, +3.0dB -+ 0x55400155, // 7, +2.5dB -+ 0x50800142, // 8, +2.0dB -+ 0x4c000130, // 9, +1.5dB -+ 0x47c0011f, // 10, +1.0dB -+ 0x43c0010f, // 11, +0.5dB -+ 0x40000100, // 12, +0dB -+ 0x3c8000f2, // 13, -0.5dB -+ 0x390000e4, // 14, -1.0dB -+ 0x35c000d7, // 15, -1.5dB -+ 0x32c000cb, // 16, -2.0dB -+ 0x300000c0, // 17, -2.5dB -+ 0x2d4000b5, // 18, -3.0dB -+ 0x2ac000ab, // 19, -3.5dB -+ 0x288000a2, // 20, -4.0dB -+ 0x26000098, // 21, -4.5dB -+ 0x24000090, // 22, -5.0dB -+ 0x22000088, // 23, -5.5dB -+ 0x20000080, // 24, -6.0dB -+ 0x1e400079, // 25, -6.5dB -+ 0x1c800072, // 26, -7.0dB -+ 0x1b00006c, // 27. -7.5dB -+ 0x19800066, // 28, -8.0dB -+ 0x18000060, // 29, -8.5dB -+ 0x16c0005b, // 30, -9.0dB -+ 0x15800056, // 31, -9.5dB -+ 0x14400051, // 32, -10.0dB -+ 0x1300004c, // 33, -10.5dB -+ 0x12000048, // 34, -11.0dB -+ 0x11000044, // 35, -11.5dB -+ 0x10000040, // 36, -12.0dB -+}; -+ -+u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, // 0, +0dB -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 1, -0.5dB -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 2, -1.0dB -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 3, -1.5dB -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 4, -2.0dB -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 5, -2.5dB -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 6, -3.0dB -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 7, -3.5dB -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 8, -4.0dB -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 9, -4.5dB -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 10, -5.0dB -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 11, -5.5dB -+ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 12, -6.0dB <== default -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 13, -6.5dB -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 14, -7.0dB -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 15, -7.5dB -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 17, -8.5dB -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 18, -9.0dB -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 19, -9.5dB -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 20, -10.0dB -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 21, -10.5dB -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 22, -11.0dB -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 23, -11.5dB -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 24, -12.0dB -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 25, -12.5dB -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 26, -13.0dB -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 27, -13.5dB -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 28, -14.0dB -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 29, -14.5dB -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 30, -15.0dB -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 31, -15.5dB -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} // 32, -16.0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14[CCK_TABLE_SIZE][8] = { -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, // 0, +0dB -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 1, -0.5dB -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 2, -1.0dB -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 3, -1.5dB -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 4, -2.0dB -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 5, -2.5dB -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 6, -3.0dB -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 7, -3.5dB -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 8, -4.0dB -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 9, -4.5dB -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 10, -5.0dB -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 11, -5.5dB -+ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 12, -6.0dB <== default -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 13, -6.5dB -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 14, -7.0dB -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 15, -7.5dB -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 17, -8.5dB -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 18, -9.0dB -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 19, -9.5dB -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 20, -10.0dB -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 21, -10.5dB -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 22, -11.0dB -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 23, -11.5dB -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 24, -12.0dB -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 25, -12.5dB -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 26, -13.0dB -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 27, -13.5dB -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 28, -14.0dB -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 29, -14.5dB -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 30, -15.0dB -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 31, -15.5dB -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00} // 32, -16.0dB -+}; -+ -+ -+u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE] = { -+ 0x0b40002d, // 0, -15.0dB -+ 0x0c000030, // 1, -14.5dB -+ 0x0cc00033, // 2, -14.0dB -+ 0x0d800036, // 3, -13.5dB -+ 0x0e400039, // 4, -13.0dB -+ 0x0f00003c, // 5, -12.5dB -+ 0x10000040, // 6, -12.0dB -+ 0x11000044, // 7, -11.5dB -+ 0x12000048, // 8, -11.0dB -+ 0x1300004c, // 9, -10.5dB -+ 0x14400051, // 10, -10.0dB -+ 0x15800056, // 11, -9.5dB -+ 0x16c0005b, // 12, -9.0dB -+ 0x18000060, // 13, -8.5dB -+ 0x19800066, // 14, -8.0dB -+ 0x1b00006c, // 15, -7.5dB -+ 0x1c800072, // 16, -7.0dB -+ 0x1e400079, // 17, -6.5dB -+ 0x20000080, // 18, -6.0dB -+ 0x22000088, // 19, -5.5dB -+ 0x24000090, // 20, -5.0dB -+ 0x26000098, // 21, -4.5dB -+ 0x288000a2, // 22, -4.0dB -+ 0x2ac000ab, // 23, -3.5dB -+ 0x2d4000b5, // 24, -3.0dB -+ 0x300000c0, // 25, -2.5dB -+ 0x32c000cb, // 26, -2.0dB -+ 0x35c000d7, // 27, -1.5dB -+ 0x390000e4, // 28, -1.0dB -+ 0x3c8000f2, // 29, -0.5dB -+ 0x40000100, // 30, +0dB -+ 0x43c0010f, // 31, +0.5dB -+ 0x47c0011f, // 32, +1.0dB -+ 0x4c000130, // 33, +1.5dB -+ 0x50800142, // 34, +2.0dB -+ 0x55400155, // 35, +2.5dB -+ 0x5a400169, // 36, +3.0dB -+ 0x5fc0017f, // 37, +3.5dB -+ 0x65400195, // 38, +4.0dB -+ 0x6b8001ae, // 39, +4.5dB -+ 0x71c001c7, // 40, +5.0dB -+ 0x788001e2, // 41, +5.5dB -+ 0x7f8001fe // 42, +6.0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -+{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -+{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -+{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -+{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -+{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -+{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -+{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -+{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -+{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -+{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -+{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -+{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -+{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -+{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -+{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -+{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -+{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -+{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -+{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -+{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -+{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -+}; -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB -+ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB -+ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB -+}; -+ -+u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = -+{ -+ 0x081, // 0, -12.0dB -+ 0x088, // 1, -11.5dB -+ 0x090, // 2, -11.0dB -+ 0x099, // 3, -10.5dB -+ 0x0A2, // 4, -10.0dB -+ 0x0AC, // 5, -9.5dB -+ 0x0B6, // 6, -9.0dB -+ 0x0C0, // 7, -8.5dB -+ 0x0CC, // 8, -8.0dB -+ 0x0D8, // 9, -7.5dB -+ 0x0E5, // 10, -7.0dB -+ 0x0F2, // 11, -6.5dB -+ 0x101, // 12, -6.0dB -+ 0x110, // 13, -5.5dB -+ 0x120, // 14, -5.0dB -+ 0x131, // 15, -4.5dB -+ 0x143, // 16, -4.0dB -+ 0x156, // 17, -3.5dB -+ 0x16A, // 18, -3.0dB -+ 0x180, // 19, -2.5dB -+ 0x197, // 20, -2.0dB -+ 0x1AF, // 21, -1.5dB -+ 0x1C8, // 22, -1.0dB -+ 0x1E3, // 23, -0.5dB -+ 0x200, // 24, +0 dB -+ 0x21E, // 25, +0.5dB -+ 0x23E, // 26, +1.0dB -+ 0x261, // 27, +1.5dB -+ 0x285, // 28, +2.0dB -+ 0x2AB, // 29, +2.5dB -+ 0x2D3, // 30, +3.0dB -+ 0x2FE, // 31, +3.5dB -+ 0x32B, // 32, +4.0dB -+ 0x35C, // 33, +4.5dB -+ 0x38E, // 34, +5.0dB -+ 0x3C4, // 35, +5.5dB -+ 0x3FE // 36, +6.0dB -+}; -+ -+#ifdef AP_BUILD_WORKAROUND -+ -+unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { -+ /* +6.0dB */ 0x7f8001fe, -+ /* +5.5dB */ 0x788001e2, -+ /* +5.0dB */ 0x71c001c7, -+ /* +4.5dB */ 0x6b8001ae, -+ /* +4.0dB */ 0x65400195, -+ /* +3.5dB */ 0x5fc0017f, -+ /* +3.0dB */ 0x5a400169, -+ /* +2.5dB */ 0x55400155, -+ /* +2.0dB */ 0x50800142, -+ /* +1.5dB */ 0x4c000130, -+ /* +1.0dB */ 0x47c0011f, -+ /* +0.5dB */ 0x43c0010f, -+ /* 0.0dB */ 0x40000100, -+ /* -0.5dB */ 0x3c8000f2, -+ /* -1.0dB */ 0x390000e4, -+ /* -1.5dB */ 0x35c000d7, -+ /* -2.0dB */ 0x32c000cb, -+ /* -2.5dB */ 0x300000c0, -+ /* -3.0dB */ 0x2d4000b5, -+ /* -3.5dB */ 0x2ac000ab, -+ /* -4.0dB */ 0x288000a2, -+ /* -4.5dB */ 0x26000098, -+ /* -5.0dB */ 0x24000090, -+ /* -5.5dB */ 0x22000088, -+ /* -6.0dB */ 0x20000080, -+ /* -6.5dB */ 0x1a00006c, -+ /* -7.0dB */ 0x1c800072, -+ /* -7.5dB */ 0x18000060, -+ /* -8.0dB */ 0x19800066, -+ /* -8.5dB */ 0x15800056, -+ /* -9.0dB */ 0x26c0005b, -+ /* -9.5dB */ 0x14400051, -+ /* -10.0dB */ 0x24400051, -+ /* -10.5dB */ 0x1300004c, -+ /* -11.0dB */ 0x12000048, -+ /* -11.5dB */ 0x11000044, -+ /* -12.0dB */ 0x10000040 -+}; -+#endif -+ -+ -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ if(!(pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_IC_11N_SERIES))) -+ return; -+#endif -+ -+ odm_TXPowerTrackingThermalMeterInit(pDM_Odm); -+} -+ -+u1Byte -+getSwingIndex( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u1Byte i = 0; -+ u4Byte bbSwing; -+ u4Byte swingTableSize; -+ pu4Byte pSwingTable; -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B -+ || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8703B -+ ) { -+ bbSwing = PHY_QueryBBReg(Adapter, rOFDM0_XATxIQImbalance, 0xFFC00000); -+ -+ pSwingTable = OFDMSwingTable_New; -+ swingTableSize = OFDM_TABLE_SIZE; -+ } else { -+#if ((RTL8812A_SUPPORT==1)||(RTL8821A_SUPPORT==1)) -+ if (pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ bbSwing = PHY_GetTxBBSwing_8812A(Adapter, pHalData->CurrentBandType, ODM_RF_PATH_A); -+ pSwingTable = TxScalingTable_Jaguar; -+ swingTableSize = TXSCALE_TABLE_SIZE; -+ } -+ else -+#endif -+ { -+ bbSwing = 0; -+ pSwingTable = OFDMSwingTable; -+ swingTableSize = OFDM_TABLE_SIZE; -+ } -+ } -+ -+ for (i = 0; i < swingTableSize; ++i) { -+ u4Byte tableValue = pSwingTable[i]; -+ -+ if (tableValue >= 0x100000 ) -+ tableValue >>= 22; -+ if (bbSwing == tableValue) -+ break; -+ } -+ return i; -+} -+ -+VOID -+odm_TXPowerTrackingThermalMeterInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte defaultSwingIndex = getSwingIndex(pDM_Odm); -+ u1Byte p = 0; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pHalData->TxPowerTrackControl = TRUE; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ pRFCalibrateInfo->bTXPowerTracking = _TRUE; -+ pRFCalibrateInfo->TXPowercount = 0; -+ pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; -+ else -+ pRFCalibrateInfo->TxPowerTrackControl = _FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; -+ -+ -+ MSG_8192C("pDM_Odm TxPowerTrackControl = %d\n", pRFCalibrateInfo->TxPowerTrackControl); -+ -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ #ifdef RTL8188E_SUPPORT -+ { -+ pRFCalibrateInfo->bTXPowerTracking = _TRUE; -+ pRFCalibrateInfo->TXPowercount = 0; -+ pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; -+ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; -+ } -+ #endif -+#endif -+ -+ //pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = TRUE; -+ pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; -+ pRFCalibrateInfo->ThermalValue_IQK = pHalData->EEPROMThermalMeter; -+ pRFCalibrateInfo->ThermalValue_LCK = pHalData->EEPROMThermalMeter; -+ -+ // The index of "0 dB" in SwingTable. -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || -+ pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8703B) { -+ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= OFDM_TABLE_SIZE) ? 30 : defaultSwingIndex; -+ pRFCalibrateInfo->DefaultCckIndex = 20; -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8188F) //add by Mingzhi.Guo 2015-03-23 -+ { -+ pRFCalibrateInfo->DefaultOfdmIndex =28; //OFDM: -1dB -+ pRFCalibrateInfo->DefaultCckIndex =20; //CCK:-6dB -+ } -+ else -+ { -+ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= TXSCALE_TABLE_SIZE) ? 24 : defaultSwingIndex; -+ pRFCalibrateInfo->DefaultCckIndex = 24; -+ } -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; -+ pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->DefaultCckIndex; -+ -+ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) -+ { -+ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->DeltaPowerIndex[p] = 0; -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ } -+ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM=0; //add by Mingzhi.Guo -+ pRFCalibrateInfo->Modify_TxAGC_Value_CCK=0; //add by Mingzhi.Guo -+ -+} -+ -+ -+VOID -+ODM_TXPowerTrackingCheck( -+ IN PVOID pDM_VOID -+ ) -+{ -+ /* 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ at the same time. In the stage2/3, we need to prive universal interface and merge all -+ HW dynamic mechanism. */ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ odm_TXPowerTrackingCheckMP(pDM_Odm); -+ break; -+ -+ case ODM_CE: -+ odm_TXPowerTrackingCheckCE(pDM_Odm); -+ break; -+ -+ case ODM_AP: -+ odm_TXPowerTrackingCheckAP(pDM_Odm); -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+VOID -+odm_TXPowerTrackingCheckCE( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) -+ return; -+ -+ if(!pDM_Odm->RFCalibrateInfo.TM_Trigger) //at least delay 1 sec -+ { -+ //pHalData->TxPowerCheckCnt++; //cosa add for debug -+ if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_8188F(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) -+ || IS_HARDWARE_TYPE_8723B(Adapter) -+ || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter) -+ || IS_HARDWARE_TYPE_8703B(Adapter) -+ ) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_NEW, (BIT17 | BIT16), 0x03); -+ } else { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_OLD, bRFRegOffsetMask, 0x60); -+ } -+ -+ //DBG_871X("Trigger Thermal Meter!!\n"); -+ -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; -+ return; -+ } -+ else -+ { -+ //DBG_871X("Schedule TxPowerTracking direct call!!\n"); -+ ODM_TXPowerTrackingCallback_ThermalMeter(Adapter); -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; -+ } -+ -+#endif -+} -+ -+VOID -+odm_TXPowerTrackingCheckMP( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ if (ODM_CheckPowerStatus(Adapter) == FALSE) -+ { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("===>ODM_CheckPowerStatus() return FALSE\n")); -+ return; -+ } -+ -+ if(!Adapter->bSlaveOfDMSP || Adapter->DualMacSmartConcurrent == FALSE) -+ odm_TXPowerTrackingThermalMeterCheck(Adapter); -+ else { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("!Adapter->bSlaveOfDMSP || Adapter->DualMacSmartConcurrent == FALSE\n")); -+ } -+#endif -+ -+} -+ -+ -+VOID -+odm_TXPowerTrackingCheckAP( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ return; -+ -+#endif -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+odm_TXPowerTrackingThermalMeterCheck( -+ IN PADAPTER Adapter -+ ) -+{ -+#ifndef AP_BUILD_WORKAROUND -+ static u1Byte TM_Trigger = 0; -+ -+ if(!(GET_HAL_DATA(Adapter)->DM_OutSrc.SupportAbility & ODM_RF_TX_PWR_TRACK)) -+ { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, -+ ("===>odm_TXPowerTrackingThermalMeterCheck(),pMgntInfo->bTXPowerTracking is FALSE, return!!\n")); -+ return; -+ } -+ -+ if(!TM_Trigger) //at least delay 1 sec -+ { -+ if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) || -+ IS_HARDWARE_TYPE_8723B(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter) || IS_HARDWARE_TYPE_8188F(Adapter) -+ || IS_HARDWARE_TYPE_8703B(Adapter)) -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03); -+ else -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); -+ -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger Thermal Meter!!\n")); -+ -+ TM_Trigger = 1; -+ return; -+ } -+ else -+ { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n")); -+ odm_TXPowerTrackingDirectCall(Adapter); //Using direct call is instead, added by Roger, 2009.06.18. -+ TM_Trigger = 0; -+ } -+#endif -+} -+#endif -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ce.h linux/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ce.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_ce.h 2017-06-07 23:07:21.019688305 +0300 -@@ -0,0 +1,296 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMPOWERTRACKING_H__ -+#define __PHYDMPOWERTRACKING_H__ -+ -+#define POWRTRACKING_VERSION "1.1" -+ -+#define DPK_DELTA_MAPPING_NUM 13 -+#define index_mapping_HP_NUM 15 -+#define OFDM_TABLE_SIZE 43 -+#define CCK_TABLE_SIZE 33 -+#define CCK_TABLE_SIZE_88F 21 -+#define TXSCALE_TABLE_SIZE 37 -+#define TXPWR_TRACK_TABLE_SIZE 30 -+#define DELTA_SWINGIDX_SIZE 30 -+#define BAND_NUM 4 -+ -+#define AVG_THERMAL_NUM 8 -+#define HP_THERMAL_NUM 8 -+#define IQK_MAC_REG_NUM 4 -+#define IQK_ADDA_REG_NUM 16 -+#define IQK_BB_REG_NUM_MAX 10 -+ -+#define IQK_BB_REG_NUM 9 -+ -+ -+ -+#define IQK_Matrix_REG_NUM 8 -+#define IQK_Matrix_Settings_NUM 14+24+21 // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G -+ -+extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE]; -+extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; -+ -+extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE]; -+extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -+ -+ -+extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; -+ -+// <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. -+static u1Byte DeltaSwingTableIdx_2GA_P_8188E[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; -+static u1Byte DeltaSwingTableIdx_2GA_N_8188E[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; -+ -+#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck -+ -+typedef struct _IQK_MATRIX_REGS_SETTING{ -+ BOOLEAN bIQKDone; -+ s4Byte Value[3][IQK_Matrix_REG_NUM]; -+ BOOLEAN bBWIqkResultSaved[3]; -+}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; -+ -+typedef struct ODM_RF_Calibration_Structure -+{ -+ //for tx power tracking -+ -+ u4Byte RegA24; // for TempCCK -+ s4Byte RegE94; -+ s4Byte RegE9C; -+ s4Byte RegEB4; -+ s4Byte RegEBC; -+ -+ u1Byte TXPowercount; -+ BOOLEAN bTXPowerTrackingInit; -+ BOOLEAN bTXPowerTracking; -+ u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default -+ u1Byte TM_Trigger; -+ u1Byte InternalPA5G[2]; //pathA / pathB -+ -+ u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 -+ u1Byte ThermalValue; -+ u1Byte ThermalValue_LCK; -+ u1Byte ThermalValue_IQK; -+ u1Byte ThermalValue_DPK; -+ u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; -+ u1Byte ThermalValue_AVG_index; -+ u1Byte ThermalValue_RxGain; -+ u1Byte ThermalValue_Crystal; -+ u1Byte ThermalValue_DPKstore; -+ u1Byte ThermalValue_DPKtrack; -+ BOOLEAN TxPowerTrackingInProgress; -+ -+ BOOLEAN bReloadtxpowerindex; -+ u1Byte bRfPiEnable; -+ u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug -+ -+ -+ //------------------------- Tx power Tracking -------------------------// -+ u1Byte bCCKinCH14; -+ u1Byte CCK_index; -+ u1Byte OFDM_index[MAX_RF_PATH]; -+ s1Byte PowerIndexOffset[MAX_RF_PATH]; -+ s1Byte DeltaPowerIndex[MAX_RF_PATH]; -+ s1Byte DeltaPowerIndexLast[MAX_RF_PATH]; -+ BOOLEAN bTxPowerChanged; -+ -+ u1Byte ThermalValue_HP[HP_THERMAL_NUM]; -+ u1Byte ThermalValue_HP_index; -+ IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; -+ u1Byte Delta_LCK; -+ s1Byte BBSwingDiff2G, BBSwingDiff5G; // Unit: dB -+ u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKC_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKC_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKD_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKD_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GC_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GC_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GD_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GD_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GC_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GC_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GD_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GD_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; -+ -+ u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; -+ u1Byte BbSwingIdxOfdmCurrent; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; -+#else -+ u1Byte BbSwingIdxOfdmBase; -+#endif -+ BOOLEAN BbSwingFlagOfdm; -+ u1Byte BbSwingIdxCck; -+ u1Byte BbSwingIdxCckCurrent; -+ u1Byte BbSwingIdxCckBase; -+ u1Byte DefaultOfdmIndex; -+ u1Byte DefaultCckIndex; -+ BOOLEAN BbSwingFlagCck; -+ -+ s1Byte Absolute_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_CCKSwingIdx; -+ s1Byte Modify_TxAGC_Value; /*Remnat compensate value at TxAGC */ -+ BOOLEAN Modify_TxAGC_Flag_PathA; -+ BOOLEAN Modify_TxAGC_Flag_PathB; -+ BOOLEAN Modify_TxAGC_Flag_PathC; -+ BOOLEAN Modify_TxAGC_Flag_PathD; -+ BOOLEAN Modify_TxAGC_Flag_PathA_CCK; -+ -+ s1Byte KfreeOffset[MAX_RF_PATH]; -+ -+ //--------------------------------------------------------------------// -+ -+ //for IQK -+ u4Byte RegC04; -+ u4Byte Reg874; -+ u4Byte RegC08; -+ u4Byte RegB68; -+ u4Byte RegB6C; -+ u4Byte Reg870; -+ u4Byte Reg860; -+ u4Byte Reg864; -+ -+ BOOLEAN bIQKInitialized; -+ BOOLEAN bLCKInProgress; -+ BOOLEAN bAntennaDetected; -+ BOOLEAN bNeedIQK; -+ BOOLEAN bIQKInProgress; -+ u1Byte Delta_IQK; -+ u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; -+ u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; -+ u4Byte IQK_BB_backup_recover[9]; -+ u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; -+ u4Byte TxIQC_8723B[2][3][2]; // { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} -+ u4Byte RxIQC_8723B[2][2][2]; // { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} -+ u4Byte TxIQC_8703B[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u4Byte RxIQC_8703B[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+ -+ -+ -+ // IQK time measurement -+ u8Byte IQK_StartTime; -+ u8Byte IQK_ProgressingTime; -+ u4Byte LOK_Result; -+ -+ //for APK -+ u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a -+ u1Byte bAPKdone; -+ u1Byte bAPKThermalMeterIgnore; -+ -+ // DPK -+ BOOLEAN bDPKFail; -+ u1Byte bDPdone; -+ u1Byte bDPPathAOK; -+ u1Byte bDPPathBOK; -+ -+ u4Byte TxLOK[2]; -+ u4Byte DpkTxAGC; -+ s4Byte DpkGain; -+ u4Byte DpkThermal[4]; -+ s1Byte Modify_TxAGC_Value_OFDM; -+ s1Byte Modify_TxAGC_Value_CCK; -+}ODM_RF_CAL_T,*PODM_RF_CAL_T; -+ -+ -+VOID -+ODM_TXPowerTrackingCheck( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingCheckAP( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingThermalMeterInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingCheckMP( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+VOID -+odm_TXPowerTrackingCheckCE( -+ IN PVOID pDM_VOID -+ ); -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+VOID -+odm_TXPowerTrackingCallbackThermalMeter92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingCallbackRXGainThermalMeter92D( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingCallbackThermalMeter92D( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingDirectCall92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingThermalMeterCheck( -+ IN PADAPTER Adapter -+ ); -+ -+#endif -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_win.c linux/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_win.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_win.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_win.c 2017-06-07 23:07:21.019688305 +0300 -@@ -0,0 +1,687 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+//============================================================ -+// Global var -+//============================================================ -+ -+u4Byte OFDMSwingTable[OFDM_TABLE_SIZE] = { -+ 0x7f8001fe, // 0, +6.0dB -+ 0x788001e2, // 1, +5.5dB -+ 0x71c001c7, // 2, +5.0dB -+ 0x6b8001ae, // 3, +4.5dB -+ 0x65400195, // 4, +4.0dB -+ 0x5fc0017f, // 5, +3.5dB -+ 0x5a400169, // 6, +3.0dB -+ 0x55400155, // 7, +2.5dB -+ 0x50800142, // 8, +2.0dB -+ 0x4c000130, // 9, +1.5dB -+ 0x47c0011f, // 10, +1.0dB -+ 0x43c0010f, // 11, +0.5dB -+ 0x40000100, // 12, +0dB -+ 0x3c8000f2, // 13, -0.5dB -+ 0x390000e4, // 14, -1.0dB -+ 0x35c000d7, // 15, -1.5dB -+ 0x32c000cb, // 16, -2.0dB -+ 0x300000c0, // 17, -2.5dB -+ 0x2d4000b5, // 18, -3.0dB -+ 0x2ac000ab, // 19, -3.5dB -+ 0x288000a2, // 20, -4.0dB -+ 0x26000098, // 21, -4.5dB -+ 0x24000090, // 22, -5.0dB -+ 0x22000088, // 23, -5.5dB -+ 0x20000080, // 24, -6.0dB -+ 0x1e400079, // 25, -6.5dB -+ 0x1c800072, // 26, -7.0dB -+ 0x1b00006c, // 27. -7.5dB -+ 0x19800066, // 28, -8.0dB -+ 0x18000060, // 29, -8.5dB -+ 0x16c0005b, // 30, -9.0dB -+ 0x15800056, // 31, -9.5dB -+ 0x14400051, // 32, -10.0dB -+ 0x1300004c, // 33, -10.5dB -+ 0x12000048, // 34, -11.0dB -+ 0x11000044, // 35, -11.5dB -+ 0x10000040, // 36, -12.0dB -+}; -+ -+u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, // 0, +0dB -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 1, -0.5dB -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 2, -1.0dB -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 3, -1.5dB -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 4, -2.0dB -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 5, -2.5dB -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 6, -3.0dB -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 7, -3.5dB -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 8, -4.0dB -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 9, -4.5dB -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 10, -5.0dB -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 11, -5.5dB -+ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 12, -6.0dB <== default -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 13, -6.5dB -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 14, -7.0dB -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 15, -7.5dB -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 17, -8.5dB -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 18, -9.0dB -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 19, -9.5dB -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 20, -10.0dB -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 21, -10.5dB -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 22, -11.0dB -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 23, -11.5dB -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 24, -12.0dB -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 25, -12.5dB -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 26, -13.0dB -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 27, -13.5dB -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 28, -14.0dB -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 29, -14.5dB -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 30, -15.0dB -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 31, -15.5dB -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} // 32, -16.0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14[CCK_TABLE_SIZE][8] = { -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, // 0, +0dB -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 1, -0.5dB -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 2, -1.0dB -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 3, -1.5dB -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 4, -2.0dB -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 5, -2.5dB -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 6, -3.0dB -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 7, -3.5dB -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 8, -4.0dB -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 9, -4.5dB -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 10, -5.0dB -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 11, -5.5dB -+ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 12, -6.0dB <== default -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 13, -6.5dB -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 14, -7.0dB -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 15, -7.5dB -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 17, -8.5dB -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 18, -9.0dB -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 19, -9.5dB -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 20, -10.0dB -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 21, -10.5dB -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 22, -11.0dB -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 23, -11.5dB -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 24, -12.0dB -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 25, -12.5dB -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 26, -13.0dB -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 27, -13.5dB -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 28, -14.0dB -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 29, -14.5dB -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 30, -15.0dB -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 31, -15.5dB -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00} // 32, -16.0dB -+}; -+ -+ -+u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE] = { -+ 0x0b40002d, // 0, -15.0dB -+ 0x0c000030, // 1, -14.5dB -+ 0x0cc00033, // 2, -14.0dB -+ 0x0d800036, // 3, -13.5dB -+ 0x0e400039, // 4, -13.0dB -+ 0x0f00003c, // 5, -12.5dB -+ 0x10000040, // 6, -12.0dB -+ 0x11000044, // 7, -11.5dB -+ 0x12000048, // 8, -11.0dB -+ 0x1300004c, // 9, -10.5dB -+ 0x14400051, // 10, -10.0dB -+ 0x15800056, // 11, -9.5dB -+ 0x16c0005b, // 12, -9.0dB -+ 0x18000060, // 13, -8.5dB -+ 0x19800066, // 14, -8.0dB -+ 0x1b00006c, // 15, -7.5dB -+ 0x1c800072, // 16, -7.0dB -+ 0x1e400079, // 17, -6.5dB -+ 0x20000080, // 18, -6.0dB -+ 0x22000088, // 19, -5.5dB -+ 0x24000090, // 20, -5.0dB -+ 0x26000098, // 21, -4.5dB -+ 0x288000a2, // 22, -4.0dB -+ 0x2ac000ab, // 23, -3.5dB -+ 0x2d4000b5, // 24, -3.0dB -+ 0x300000c0, // 25, -2.5dB -+ 0x32c000cb, // 26, -2.0dB -+ 0x35c000d7, // 27, -1.5dB -+ 0x390000e4, // 28, -1.0dB -+ 0x3c8000f2, // 29, -0.5dB -+ 0x40000100, // 30, +0dB -+ 0x43c0010f, // 31, +0.5dB -+ 0x47c0011f, // 32, +1.0dB -+ 0x4c000130, // 33, +1.5dB -+ 0x50800142, // 34, +2.0dB -+ 0x55400155, // 35, +2.5dB -+ 0x5a400169, // 36, +3.0dB -+ 0x5fc0017f, // 37, +3.5dB -+ 0x65400195, // 38, +4.0dB -+ 0x6b8001ae, // 39, +4.5dB -+ 0x71c001c7, // 40, +5.0dB -+ 0x788001e2, // 41, +5.5dB -+ 0x7f8001fe // 42, +6.0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -+{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -+{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -+{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -+{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -+{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -+{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -+{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -+{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -+{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -+{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -+{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -+{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -+{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -+{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -+{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -+{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -+{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -+{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -+{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -+{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -+{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -+}; -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB -+ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB -+ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB -+}; -+ -+u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = -+{ -+ 0x081, // 0, -12.0dB -+ 0x088, // 1, -11.5dB -+ 0x090, // 2, -11.0dB -+ 0x099, // 3, -10.5dB -+ 0x0A2, // 4, -10.0dB -+ 0x0AC, // 5, -9.5dB -+ 0x0B6, // 6, -9.0dB -+ 0x0C0, // 7, -8.5dB -+ 0x0CC, // 8, -8.0dB -+ 0x0D8, // 9, -7.5dB -+ 0x0E5, // 10, -7.0dB -+ 0x0F2, // 11, -6.5dB -+ 0x101, // 12, -6.0dB -+ 0x110, // 13, -5.5dB -+ 0x120, // 14, -5.0dB -+ 0x131, // 15, -4.5dB -+ 0x143, // 16, -4.0dB -+ 0x156, // 17, -3.5dB -+ 0x16A, // 18, -3.0dB -+ 0x180, // 19, -2.5dB -+ 0x197, // 20, -2.0dB -+ 0x1AF, // 21, -1.5dB -+ 0x1C8, // 22, -1.0dB -+ 0x1E3, // 23, -0.5dB -+ 0x200, // 24, +0 dB -+ 0x21E, // 25, +0.5dB -+ 0x23E, // 26, +1.0dB -+ 0x261, // 27, +1.5dB -+ 0x285, // 28, +2.0dB -+ 0x2AB, // 29, +2.5dB -+ 0x2D3, // 30, +3.0dB -+ 0x2FE, // 31, +3.5dB -+ 0x32B, // 32, +4.0dB -+ 0x35C, // 33, +4.5dB -+ 0x38E, // 34, +5.0dB -+ 0x3C4, // 35, +5.5dB -+ 0x3FE // 36, +6.0dB -+}; -+ -+#ifdef AP_BUILD_WORKAROUND -+ -+unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { -+ /* +6.0dB */ 0x7f8001fe, -+ /* +5.5dB */ 0x788001e2, -+ /* +5.0dB */ 0x71c001c7, -+ /* +4.5dB */ 0x6b8001ae, -+ /* +4.0dB */ 0x65400195, -+ /* +3.5dB */ 0x5fc0017f, -+ /* +3.0dB */ 0x5a400169, -+ /* +2.5dB */ 0x55400155, -+ /* +2.0dB */ 0x50800142, -+ /* +1.5dB */ 0x4c000130, -+ /* +1.0dB */ 0x47c0011f, -+ /* +0.5dB */ 0x43c0010f, -+ /* 0.0dB */ 0x40000100, -+ /* -0.5dB */ 0x3c8000f2, -+ /* -1.0dB */ 0x390000e4, -+ /* -1.5dB */ 0x35c000d7, -+ /* -2.0dB */ 0x32c000cb, -+ /* -2.5dB */ 0x300000c0, -+ /* -3.0dB */ 0x2d4000b5, -+ /* -3.5dB */ 0x2ac000ab, -+ /* -4.0dB */ 0x288000a2, -+ /* -4.5dB */ 0x26000098, -+ /* -5.0dB */ 0x24000090, -+ /* -5.5dB */ 0x22000088, -+ /* -6.0dB */ 0x20000080, -+ /* -6.5dB */ 0x1a00006c, -+ /* -7.0dB */ 0x1c800072, -+ /* -7.5dB */ 0x18000060, -+ /* -8.0dB */ 0x19800066, -+ /* -8.5dB */ 0x15800056, -+ /* -9.0dB */ 0x26c0005b, -+ /* -9.5dB */ 0x14400051, -+ /* -10.0dB */ 0x24400051, -+ /* -10.5dB */ 0x1300004c, -+ /* -11.0dB */ 0x12000048, -+ /* -11.5dB */ 0x11000044, -+ /* -12.0dB */ 0x10000040 -+}; -+ -+#endif -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ if(!(pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_IC_11N_SERIES|ODM_RTL8822B))) -+ return; -+#endif -+ -+ odm_TXPowerTrackingThermalMeterInit(pDM_Odm); -+} -+ -+u1Byte -+getSwingIndex( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u1Byte i = 0; -+ u4Byte bbSwing; -+ u4Byte swingTableSize; -+ pu4Byte pSwingTable; -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || -+ pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8703B) -+ { -+ bbSwing = PHY_QueryBBReg(Adapter, rOFDM0_XATxIQImbalance, 0xFFC00000); -+ -+ pSwingTable = OFDMSwingTable_New; -+ swingTableSize = OFDM_TABLE_SIZE; -+ } else { -+ bbSwing = PHY_GetTxBBSwing_8812A(Adapter, pHalData->CurrentBandType, ODM_RF_PATH_A); -+ pSwingTable = TxScalingTable_Jaguar; -+ swingTableSize = TXSCALE_TABLE_SIZE; -+ } -+ -+ for (i = 0; i < swingTableSize; ++i) { -+ u4Byte tableValue = pSwingTable[i]; -+ -+ if (tableValue >= 0x100000 ) -+ tableValue >>= 22; -+ if (bbSwing == tableValue) -+ break; -+ } -+ return i; -+} -+ -+VOID -+odm_TXPowerTrackingThermalMeterInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte defaultSwingIndex = getSwingIndex(pDM_Odm); -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u1Byte p = 0; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pRFCalibrateInfo->TxPowerTrackControl = TRUE; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #ifdef CONFIG_RTL8188E -+ { -+ pRFCalibrateInfo->bTXPowerTracking = _TRUE; -+ pRFCalibrateInfo->TXPowercount = 0; -+ pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; -+ -+ MSG_8192C("pDM_Odm TxPowerTrackControl = %d\n", pRFCalibrateInfo->TxPowerTrackControl); -+ } -+ #else -+ { -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ -+ pdmpriv->bTXPowerTracking = _TRUE; -+ pdmpriv->TXPowercount = 0; -+ pdmpriv->bTXPowerTrackingInit = _FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pdmpriv->TxPowerTrackControl = _TRUE; -+ -+ MSG_8192C("pdmpriv->TxPowerTrackControl = %d\n", pdmpriv->TxPowerTrackControl); -+ -+ } -+ #endif//endif (CONFIG_RTL8188E==1) -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ #ifdef RTL8188E_SUPPORT -+ { -+ pRFCalibrateInfo->bTXPowerTracking = _TRUE; -+ pRFCalibrateInfo->TXPowercount = 0; -+ pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; -+ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; -+ } -+ #endif -+#endif -+ -+ pRFCalibrateInfo->TxPowerTrackControl = TRUE; -+ pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; -+ pRFCalibrateInfo->ThermalValue_IQK = pHalData->EEPROMThermalMeter; -+ pRFCalibrateInfo->ThermalValue_LCK = pHalData->EEPROMThermalMeter; -+ -+ // The index of "0 dB" in SwingTable. -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || -+ pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8703B) -+ { -+ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= OFDM_TABLE_SIZE) ? 30 : defaultSwingIndex; -+ pRFCalibrateInfo->DefaultCckIndex = 20; -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8188F) //add by Mingzhi.Guo 2015-03-23 -+ { -+ pRFCalibrateInfo->DefaultOfdmIndex =28; //OFDM: -1dB -+ pRFCalibrateInfo->DefaultCckIndex =20; //CCK:-6dB -+ } -+ else -+ { -+ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= TXSCALE_TABLE_SIZE) ? 24 : defaultSwingIndex; -+ pRFCalibrateInfo->DefaultCckIndex = 24; -+ } -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; -+ pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->DefaultCckIndex; -+ -+ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) -+ { -+ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->DeltaPowerIndex[p] = 0; -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ pRFCalibrateInfo->KfreeOffset[p] = 0; -+ } -+ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM=0; //add by Mingzhi.Guo -+ pRFCalibrateInfo->Modify_TxAGC_Value_CCK=0; //add by Mingzhi.Guo -+ -+} -+ -+ -+VOID -+ODM_TXPowerTrackingCheck( -+ IN PVOID pDM_VOID -+ ) -+{ -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ odm_TXPowerTrackingCheckMP(pDM_Odm); -+ break; -+ -+ case ODM_CE: -+ odm_TXPowerTrackingCheckCE(pDM_Odm); -+ break; -+ -+ case ODM_AP: -+ odm_TXPowerTrackingCheckAP(pDM_Odm); -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+VOID -+odm_TXPowerTrackingCheckCE( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ #if ((RTL8188F_SUPPORT == 1)) -+ rtl8192c_odm_CheckTXPowerTracking(Adapter); -+ #endif -+ -+ #if(RTL8188E_SUPPORT==1) -+ -+ if(!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) -+ { -+ return; -+ } -+ -+ if(!pRFCalibrateInfo->TM_Trigger) //at least delay 1 sec -+ { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); -+ //DBG_8192C("Trigger 92C Thermal Meter!!\n"); -+ -+ pRFCalibrateInfo->TM_Trigger = 1; -+ return; -+ -+ } -+ else -+ { -+ //DBG_8192C("Schedule TxPowerTracking direct call!!\n"); -+ odm_TXPowerTrackingCallback_ThermalMeter_8188E(Adapter); -+ pRFCalibrateInfo->TM_Trigger = 0; -+ } -+ #endif -+#endif -+} -+ -+VOID -+odm_TXPowerTrackingCheckMP( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ if(*pDM_Odm->pIsFcsModeEnable) -+ return; -+ -+ if (ODM_CheckPowerStatus(Adapter) == FALSE) -+ { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("===>ODM_CheckPowerStatus() return FALSE\n")); -+ return; -+ } -+ -+ if(IS_HARDWARE_TYPE_8821B(Adapter)) // TODO: Don't Do PowerTracking -+ return; -+ -+// #if(RTL8192D_SUPPORT==1) -+// if(!Adapter->bSlaveOfDMSP || Adapter->DualMacSmartConcurrent == FALSE) -+ if (IS_HARDWARE_TYPE_8814A(Adapter) || IS_HARDWARE_TYPE_8188F(Adapter)) -+ odm_TXPowerTrackingThermalMeterCheck(Adapter); -+ else { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("!Adapter->bSlaveOfDMSP || Adapter->DualMacSmartConcurrent == FALSE\n")); -+ } -+// #endif -+#endif -+ -+} -+ -+ -+VOID -+odm_TXPowerTrackingCheckAP( -+ IN PVOID pDM_VOID -+ ) -+{ -+return; -+ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+VOID -+odm_TXPowerTrackingDirectCall( -+ IN PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ ODM_TXPowerTrackingCallback_ThermalMeter(Adapter); -+} -+ -+VOID -+odm_TXPowerTrackingThermalMeterCheck( -+ IN PADAPTER Adapter -+ ) -+{ -+#ifndef AP_BUILD_WORKAROUND -+ static u1Byte TM_Trigger = 0; -+ -+ if(!(GET_HAL_DATA(Adapter)->DM_OutSrc.SupportAbility & ODM_RF_TX_PWR_TRACK)) -+ { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, -+ ("===>odm_TXPowerTrackingThermalMeterCheck(),pMgntInfo->bTXPowerTracking is FALSE, return!!\n")); -+ return; -+ } -+ -+ if(!TM_Trigger) //at least delay 1 sec -+ { -+ if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) || -+ IS_HARDWARE_TYPE_8723B(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter) || IS_HARDWARE_TYPE_8188F(Adapter) || IS_HARDWARE_TYPE_8703B(Adapter)) -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03); -+ else -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); -+ -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger Thermal Meter!!\n")); -+ -+ TM_Trigger = 1; -+ return; -+ } -+ else -+ { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n")); -+ odm_TXPowerTrackingDirectCall(Adapter); //Using direct call is instead, added by Roger, 2009.06.18. -+ TM_Trigger = 0; -+ } -+#endif -+} -+ -+#endif //end #ifMP -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_win.h linux/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_win.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_win.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_powertracking_win.h 2017-06-07 23:07:21.019688305 +0300 -@@ -0,0 +1,265 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMPOWERTRACKING_H__ -+#define __PHYDMPOWERTRACKING_H__ -+ -+#define POWRTRACKING_VERSION "1.1" -+ -+#define DPK_DELTA_MAPPING_NUM 13 -+#define index_mapping_HP_NUM 15 -+#define TXSCALE_TABLE_SIZE 37 -+#define TXPWR_TRACK_TABLE_SIZE 30 -+#define DELTA_SWINGIDX_SIZE 30 -+#define BAND_NUM 3 -+#define MAX_RF_PATH 4 -+#define CCK_TABLE_SIZE_88F 21 -+ -+ -+#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck -+ -+#define IQK_Matrix_Settings_NUM 14+24+21 // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G -+#define AVG_THERMAL_NUM 8 -+#define HP_THERMAL_NUM 8 -+#define IQK_Matrix_REG_NUM 8 -+#define IQK_MAC_REG_NUM 4 -+#define IQK_ADDA_REG_NUM 16 -+ -+#define IQK_BB_REG_NUM 9 -+ -+ -+extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE]; -+extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; -+ -+extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE]; -+extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -+ -+extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; -+ -+// <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. -+static u1Byte DeltaSwingTableIdx_2GA_P_8188E[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; -+static u1Byte DeltaSwingTableIdx_2GA_N_8188E[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; -+ -+VOID -+ODM_TXPowerTrackingCheck( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingCheckAP( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingThermalMeterInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingCheckMP( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+VOID -+odm_TXPowerTrackingCheckCE( -+ IN PVOID pDM_VOID -+ ); -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+ -+VOID -+odm_TXPowerTrackingThermalMeterCheck( -+ IN PADAPTER Adapter -+ ); -+ -+#endif -+ -+typedef struct _IQK_MATRIX_REGS_SETTING{ -+ BOOLEAN bIQKDone; -+ s4Byte Value[3][IQK_Matrix_REG_NUM]; -+ BOOLEAN bBWIqkResultSaved[3]; -+}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; -+ -+typedef struct ODM_RF_Calibration_Structure -+{ -+ //for tx power tracking -+ -+ u4Byte RegA24; // for TempCCK -+ s4Byte RegE94; -+ s4Byte RegE9C; -+ s4Byte RegEB4; -+ s4Byte RegEBC; -+ //u1Byte bTXPowerTracking; -+ u1Byte TXPowercount; -+ BOOLEAN bTXPowerTrackingInit; -+ BOOLEAN bTXPowerTracking; -+ u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default -+ u1Byte TM_Trigger; -+ u1Byte InternalPA5G[2]; //pathA / pathB -+ -+ u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 -+ u1Byte ThermalValue; -+ u1Byte ThermalValue_LCK; -+ u1Byte ThermalValue_IQK; -+ u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; -+ u1Byte ThermalValue_AVG_index; -+ u1Byte ThermalValue_RxGain; -+ -+ BOOLEAN bReloadtxpowerindex; -+ u1Byte bRfPiEnable; -+ u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug -+ -+ -+ //------------------------- Tx power Tracking -------------------------// -+ u1Byte bCCKinCH14; -+ u1Byte CCK_index; -+ u1Byte OFDM_index[MAX_RF_PATH]; -+ s1Byte PowerIndexOffset[MAX_RF_PATH]; -+ s1Byte DeltaPowerIndex[MAX_RF_PATH]; -+ s1Byte DeltaPowerIndexLast[MAX_RF_PATH]; -+ BOOLEAN bTxPowerChanged; -+ -+ u1Byte ThermalValue_HP[HP_THERMAL_NUM]; -+ u1Byte ThermalValue_HP_index; -+ IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; -+ u1Byte Delta_LCK; -+ s1Byte BBSwingDiff2G, BBSwingDiff5G; // Unit: dB -+ u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKC_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKC_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKD_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKD_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GC_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GC_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GD_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GD_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GC_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GC_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GD_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GD_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; -+ -+ u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; -+ u1Byte BbSwingIdxOfdmCurrent; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; -+#else -+ u1Byte BbSwingIdxOfdmBase; -+#endif -+ BOOLEAN BbSwingFlagOfdm; -+ u1Byte BbSwingIdxCck; -+ u1Byte BbSwingIdxCckCurrent; -+ u1Byte BbSwingIdxCckBase; -+ u1Byte DefaultOfdmIndex; -+ u1Byte DefaultCckIndex; -+ BOOLEAN BbSwingFlagCck; -+ -+ s1Byte Absolute_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_CCKSwingIdx; -+ s1Byte Modify_TxAGC_Value; /*Remnat compensate value at TxAGC */ -+ BOOLEAN Modify_TxAGC_Flag_PathA; -+ BOOLEAN Modify_TxAGC_Flag_PathB; -+ BOOLEAN Modify_TxAGC_Flag_PathC; -+ BOOLEAN Modify_TxAGC_Flag_PathD; -+ BOOLEAN Modify_TxAGC_Flag_PathA_CCK; -+ -+ s1Byte KfreeOffset[MAX_RF_PATH]; -+ -+ //--------------------------------------------------------------------// -+ -+ //for IQK -+ u4Byte RegC04; -+ u4Byte Reg874; -+ u4Byte RegC08; -+ u4Byte RegB68; -+ u4Byte RegB6C; -+ u4Byte Reg870; -+ u4Byte Reg860; -+ u4Byte Reg864; -+ -+ BOOLEAN bIQKInitialized; -+ BOOLEAN bLCKInProgress; -+ BOOLEAN bAntennaDetected; -+ BOOLEAN bNeedIQK; -+ BOOLEAN bIQKInProgress; -+ u1Byte Delta_IQK; -+ u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; -+ u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; -+ u4Byte IQK_BB_backup_recover[9]; -+ u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; -+ u4Byte TxIQC_8723B[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ -+ u4Byte RxIQC_8723B[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ -+ u4Byte TxIQC_8703B[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u4Byte RxIQC_8703B[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+ -+ -+ -+ // IQK time measurement -+ u8Byte IQK_StartTime; -+ u8Byte IQK_ProgressingTime; -+ u4Byte LOK_Result; -+ -+ //for APK -+ u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a -+ u1Byte bAPKdone; -+ u1Byte bAPKThermalMeterIgnore; -+ -+ // DPK -+ BOOLEAN bDPKFail; -+ u1Byte bDPdone; -+ u1Byte bDPPathAOK; -+ u1Byte bDPPathBOK; -+ -+ u4Byte TxLOK[2]; -+ u4Byte DpkTxAGC; -+ s4Byte DpkGain; -+ u4Byte DpkThermal[4]; -+ -+ s1Byte Modify_TxAGC_Value_OFDM; -+ s1Byte Modify_TxAGC_Value_CCK; -+}ODM_RF_CAL_T,*PODM_RF_CAL_T; -+ -+ -+ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_precomp.h linux/3rdparty/rtl8812au/hal/phydm/phydm_precomp.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_precomp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_precomp.h 2017-06-07 23:07:21.019688305 +0300 -@@ -0,0 +1,319 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODM_PRECOMP_H__ -+#define __ODM_PRECOMP_H__ -+ -+#include "phydm_types.h" -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#include "Precomp.h" // We need to include mp_precomp.h due to batch file setting. -+#else -+#define TEST_FALG___ 1 -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE ==ODM_CE) -+#define RTL8192CE_SUPPORT 0 -+#define RTL8192CU_SUPPORT 0 -+#define RTL8192C_SUPPORT 0 -+ -+#define RTL8192DE_SUPPORT 0 -+#define RTL8192DU_SUPPORT 0 -+#define RTL8192D_SUPPORT 0 -+ -+#define RTL8723AU_SUPPORT 0 -+#define RTL8723AS_SUPPORT 0 -+#define RTL8723AE_SUPPORT 0 -+#define RTL8723A_SUPPORT 0 -+#define RTL8723_FPGA_VERIFICATION 0 -+#endif -+ -+//2 Config Flags and Structs - defined by each ODM Type -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "../8192cd_cfg.h" -+ #include "../odm_inc.h" -+ -+ #include "../8192cd.h" -+ #include "../8192cd_util.h" -+ #ifdef _BIG_ENDIAN_ -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG -+ #else -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE -+ #endif -+ -+ #ifdef AP_BUILD_WORKAROUND -+ #include "../8192cd_headers.h" -+ #include "../8192cd_debug.h" -+ #endif -+ -+#elif (DM_ODM_SUPPORT_TYPE ==ODM_CE) -+ #define __PACK -+ #define __WLAN_ATTRIB_PACK__ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "mp_precomp.h" -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE -+ #define __PACK -+ #define __WLAN_ATTRIB_PACK__ -+#endif -+ -+//2 OutSrc Header Files -+ -+#include "phydm.h" -+#include "phydm_hwconfig.h" -+#include "phydm_debug.h" -+#include "phydm_regdefine11ac.h" -+#include "phydm_regdefine11n.h" -+#include "phydm_interface.h" -+#include "phydm_reg.h" -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+#define RTL8821B_SUPPORT 0 -+#define RTL8822B_SUPPORT 0 -+ -+VOID -+PHY_SetTxPowerLimit( -+ IN PDM_ODM_T pDM_Odm, -+ IN u8 *Regulation, -+ IN u8 *Band, -+ IN u8 *Bandwidth, -+ IN u8 *RateSection, -+ IN u8 *RfPath, -+ IN u8 *Channel, -+ IN u8 *PowerLimit -+); -+ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+#define RTL8821B_SUPPORT 0 -+#define RTL8822B_SUPPORT 0 -+#define RTL8703B_SUPPORT 0 -+#define RTL8188F_SUPPORT 0 -+#endif -+ -+#if RTL8188E_SUPPORT == 1 -+#define RTL8188E_T_SUPPORT 1 -+#ifdef CONFIG_SFW_SUPPORTED -+#define RTL8188E_S_SUPPORT 1 -+#else -+#define RTL8188E_S_SUPPORT 0 -+#endif -+#endif -+ -+#if (RTL8188E_SUPPORT==1) -+#include "rtl8188e/hal8188erateadaptive.h"//for RA,Power training -+#include "rtl8188e/halhwimg8188e_mac.h" -+#include "rtl8188e/halhwimg8188e_rf.h" -+#include "rtl8188e/halhwimg8188e_bb.h" -+#include "rtl8188e/halhwimg8188e_t_fw.h" -+#include "rtl8188e/halhwimg8188e_s_fw.h" -+#include "rtl8188e/phydm_regconfig8188e.h" -+#include "rtl8188e/phydm_rtl8188e.h" -+#include "rtl8188e/hal8188ereg.h" -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8188e_hal.h" -+ #include "rtl8188e/halphyrf_8188e_ce.h" -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "rtl8188e/halphyrf_8188e_win.h" -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "rtl8188e/halphyrf_8188e_ap.h" -+#endif -+#endif //88E END -+ -+#if (RTL8192E_SUPPORT==1) -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "rtl8192e/halphyrf_8192e_win.h" /*FOR_8192E_IQK*/ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "rtl8192e/halphyrf_8192e_ap.h" /*FOR_8192E_IQK*/ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8192e/halphyrf_8192e_ce.h" /*FOR_8192E_IQK*/ -+ #endif -+ -+#include "rtl8192e/phydm_rtl8192e.h" //FOR_8192E_IQK -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ #include "rtl8192e/halhwimg8192e_bb.h" -+ #include "rtl8192e/halhwimg8192e_mac.h" -+ #include "rtl8192e/halhwimg8192e_rf.h" -+ #include "rtl8192e/phydm_regconfig8192e.h" -+ #include "rtl8192e/halhwimg8192e_fw.h" -+ #include "rtl8192e/hal8192ereg.h" -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8192e_hal.h" -+#endif -+#endif //92E END -+ -+#if (RTL8812A_SUPPORT==1) -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "rtl8812a/halphyrf_8812a_win.h" -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "rtl8812a/halphyrf_8812a_ap.h" -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8812a/halphyrf_8812a_ce.h" -+ #endif -+ -+ //#include "rtl8812a/HalPhyRf_8812A.h" //FOR_8812_IQK -+ #if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ #include "rtl8812a/halhwimg8812a_bb.h" -+ #include "rtl8812a/halhwimg8812a_mac.h" -+ #include "rtl8812a/halhwimg8812a_rf.h" -+ #include "rtl8812a/phydm_regconfig8812a.h" -+ #include "rtl8812a/halhwimg8812a_fw.h" -+ #include "rtl8812a/phydm_rtl8812a.h" -+ #endif -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8812a_hal.h" -+ #endif -+ -+#endif //8812 END -+ -+#if (RTL8814A_SUPPORT==1) -+ -+#include "rtl8814a/halhwimg8814a_mac.h" -+#include "rtl8814a/halhwimg8814a_rf.h" -+#include "rtl8814a/halhwimg8814a_bb.h" -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ #include "rtl8814a/halhwimg8814a_fw.h" -+ #include "rtl8814a/phydm_rtl8814a.h" -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "rtl8814a/halphyrf_8814a_win.h" -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8814a/halphyrf_8814a_ce.h" -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "rtl8814a/halphyrf_8814a_ap.h" -+#endif -+ #include "rtl8814a/phydm_regconfig8814a.h" -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8814a_hal.h" -+ #include "rtl8814a/phydm_iqk_8814a.h" -+#endif -+#endif //8814 END -+ -+#if (RTL8881A_SUPPORT==1)//FOR_8881_IQK -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#include "rtl8821a/phydm_iqk_8821a_win.h" -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#include "rtl8821a/phydm_iqk_8821a_ce.h" -+#else -+#include "rtl8821a/phydm_iqk_8821a_ap.h" -+#endif -+//#include "rtl8881a/HalHWImg8881A_BB.h" -+//#include "rtl8881a/HalHWImg8881A_MAC.h" -+//#include "rtl8881a/HalHWImg8881A_RF.h" -+//#include "rtl8881a/odm_RegConfig8881A.h" -+#endif -+ -+#if (RTL8723B_SUPPORT==1) -+#include "rtl8723b/halhwimg8723b_mac.h" -+#include "rtl8723b/halhwimg8723b_rf.h" -+#include "rtl8723b/halhwimg8723b_bb.h" -+#include "rtl8723b/halhwimg8723b_fw.h" -+#include "rtl8723b/phydm_regconfig8723b.h" -+#include "rtl8723b/phydm_rtl8723b.h" -+#include "rtl8723b/hal8723breg.h" -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "rtl8723b/halphyrf_8723b_win.h" -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8723b/halphyrf_8723b_ce.h" -+ #include "rtl8723b/halhwimg8723b_mp.h" -+ #include "rtl8723b_hal.h" -+#endif -+#endif -+ -+#if (RTL8821A_SUPPORT==1) -+#include "rtl8821a/halhwimg8821a_mac.h" -+#include "rtl8821a/halhwimg8821a_rf.h" -+#include "rtl8821a/halhwimg8821a_bb.h" -+#include "rtl8821a/halhwimg8821a_fw.h" -+#include "rtl8821a/phydm_regconfig8821a.h" -+#include "rtl8821a/phydm_rtl8821a.h" -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "rtl8821a/halphyrf_8821a_win.h" -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8821a/halphyrf_8821a_ce.h" -+ #include "rtl8821a/phydm_iqk_8821a_ce.h"/*for IQK*/ -+ #include "rtl8812a/halphyrf_8812a_ce.h"/*for IQK,LCK,Power-tracking*/ -+ #include "rtl8812a_hal.h" -+#else -+#endif -+#endif -+ -+#if (RTL8821B_SUPPORT==1) -+#include "rtl8821b/halhwimg8821b_mac.h" -+#include "rtl8821b/halhwimg8821b_rf.h" -+#include "rtl8821b/halhwimg8821b_bb.h" -+#include "rtl8821b/halhwimg8821b_fw.h" -+#include "rtl8821b/phydm_regconfig8821b.h" -+#include "rtl8821b/halhwimg8821b_testchip_mac.h" -+#include "rtl8821b/halhwimg8821b_testchip_rf.h" -+#include "rtl8821b/halhwimg8821b_testchip_bb.h" -+#include "rtl8821b/halhwimg8821b_testchip_fw.h" -+#include "rtl8821b/halphyrf_8821b.h" -+#endif -+ -+#if (RTL8822B_SUPPORT==1) -+#include "rtl8822b/halhwimg8822b_mac.h" -+#include "rtl8822b/halhwimg8822b_rf.h" -+#include "rtl8822b/halhwimg8822b_bb.h" -+/*#include "rtl8822b/halhwimg8822b_fw.h"*/ -+#include "rtl8822b/phydm_regconfig8822b.h" -+#include "rtl8822b/halphyrf_8822b.h" -+#include "rtl8822b/phydm_rtl8822b.h" -+#include "rtl8822b/phydm_hal_api8822b.h" -+#include "rtl8822b/version_rtl8822b.h" -+#endif -+ -+#if (RTL8703B_SUPPORT==1) -+#include "rtl8703b/phydm_regconfig8703b.h" -+#include "rtl8703b/halhwimg8703b_mac.h" -+#include "rtl8703b/halhwimg8703b_rf.h" -+#include "rtl8703b/halhwimg8703b_bb.h" -+#include "rtl8703b/halhwimg8703b_fw.h" -+#include "rtl8703b/halphyrf_8703b.h" -+#include "rtl8703b/version_rtl8703b.h" -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#include "rtl8703b_hal.h" -+#endif -+#endif -+ -+#if (RTL8188F_SUPPORT == 1) -+#include "rtl8188f/halhwimg8188f_mac.h" -+#include "rtl8188f/halhwimg8188f_rf.h" -+#include "rtl8188f/halhwimg8188f_bb.h" -+#include "rtl8188f/halhwimg8188f_fw.h" -+#include "rtl8188f/hal8188freg.h" -+#include "rtl8188f/phydm_rtl8188f.h" -+#include "rtl8188f/phydm_regconfig8188f.h" -+#include "rtl8188f/halphyrf_8188f.h" /* for IQK,LCK,Power-tracking */ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#include "rtl8188f_hal.h" -+#endif -+#endif -+ -+#endif // __ODM_PRECOMP_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_pre_define.h linux/3rdparty/rtl8812au/hal/phydm/phydm_pre_define.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_pre_define.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_pre_define.h 2017-06-07 23:07:21.019688305 +0300 -@@ -0,0 +1,615 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __PHYDMPREDEFINE_H__ -+#define __PHYDMPREDEFINE_H__ -+ -+//1 ============================================================ -+//1 Definition -+//1 ============================================================ -+ -+//Max path of IC -+#define MAX_PATH_NUM_92CS 2 -+#define MAX_PATH_NUM_8188E 1 -+#define MAX_PATH_NUM_8192E 2 -+#define MAX_PATH_NUM_8723B 1 -+#define MAX_PATH_NUM_8812A 2 -+#define MAX_PATH_NUM_8821A 1 -+#define MAX_PATH_NUM_8814A 4 -+#define MAX_PATH_NUM_8822B 2 -+#define MAX_PATH_NUM_8821B 2 -+#define MAX_PATH_NUM_8703B 1 -+#define MAX_PATH_NUM_8188F 1 -+ -+//Max RF path -+#define ODM_RF_PATH_MAX 2 -+#define ODM_RF_PATH_MAX_JAGUAR 4 -+ -+//number of entry -+#if(DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ #define ASSOCIATE_ENTRY_NUM MACID_NUM_SW_LIMIT /* Max size of AsocEntry[].*/ -+ #define ODM_ASSOCIATE_ENTRY_NUM ASSOCIATE_ENTRY_NUM -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ #define ASSOCIATE_ENTRY_NUM NUM_STAT -+ #define ODM_ASSOCIATE_ENTRY_NUM (ASSOCIATE_ENTRY_NUM+1) -+#else -+ #define ODM_ASSOCIATE_ENTRY_NUM ((ASSOCIATE_ENTRY_NUM*3)+1) -+#endif -+ -+/* -----MGN rate--------------------------------- */ -+ -+#define ODM_MGN_1M 0x02 -+#define ODM_MGN_2M 0x04 -+#define ODM_MGN_5_5M 0x0b -+#define ODM_MGN_11M 0x16 -+ -+#define ODM_MGN_6M 0x0c -+#define ODM_MGN_9M 0x12 -+#define ODM_MGN_12M 0x18 -+#define ODM_MGN_18M 0x24 -+#define ODM_MGN_24M 0x30 -+#define ODM_MGN_36M 0x48 -+#define ODM_MGN_48M 0x60 -+#define ODM_MGN_54M 0x6c -+ -+/*TxHT = 1*/ -+#define ODM_MGN_MCS0 0x80 -+#define ODM_MGN_MCS1 0x81 -+#define ODM_MGN_MCS2 0x82 -+#define ODM_MGN_MCS3 0x83 -+#define ODM_MGN_MCS4 0x84 -+#define ODM_MGN_MCS5 0x85 -+#define ODM_MGN_MCS6 0x86 -+#define ODM_MGN_MCS7 0x87 -+#define ODM_MGN_MCS8 0x88 -+#define ODM_MGN_MCS9 0x89 -+#define ODM_MGN_MCS10 0x8a -+#define ODM_MGN_MCS11 0x8b -+#define ODM_MGN_MCS12 0x8c -+#define ODM_MGN_MCS13 0x8d -+#define ODM_MGN_MCS14 0x8e -+#define ODM_MGN_MCS15 0x8f -+#define ODM_MGN_VHT1SS_MCS0 0x90 -+#define ODM_MGN_VHT1SS_MCS1 0x91 -+#define ODM_MGN_VHT1SS_MCS2 0x92 -+#define ODM_MGN_VHT1SS_MCS3 0x93 -+#define ODM_MGN_VHT1SS_MCS4 0x94 -+#define ODM_MGN_VHT1SS_MCS5 0x95 -+#define ODM_MGN_VHT1SS_MCS6 0x96 -+#define ODM_MGN_VHT1SS_MCS7 0x97 -+#define ODM_MGN_VHT1SS_MCS8 0x98 -+#define ODM_MGN_VHT1SS_MCS9 0x99 -+#define ODM_MGN_VHT2SS_MCS0 0x9a -+#define ODM_MGN_VHT2SS_MCS1 0x9b -+#define ODM_MGN_VHT2SS_MCS2 0x9c -+#define ODM_MGN_VHT2SS_MCS3 0x9d -+#define ODM_MGN_VHT2SS_MCS4 0x9e -+#define ODM_MGN_VHT2SS_MCS5 0x9f -+#define ODM_MGN_VHT2SS_MCS6 0xa0 -+#define ODM_MGN_VHT2SS_MCS7 0xa1 -+#define ODM_MGN_VHT2SS_MCS8 0xa2 -+#define ODM_MGN_VHT2SS_MCS9 0xa3 -+ -+#define ODM_MGN_MCS0_SG 0xc0 -+#define ODM_MGN_MCS1_SG 0xc1 -+#define ODM_MGN_MCS2_SG 0xc2 -+#define ODM_MGN_MCS3_SG 0xc3 -+#define ODM_MGN_MCS4_SG 0xc4 -+#define ODM_MGN_MCS5_SG 0xc5 -+#define ODM_MGN_MCS6_SG 0xc6 -+#define ODM_MGN_MCS7_SG 0xc7 -+#define ODM_MGN_MCS8_SG 0xc8 -+#define ODM_MGN_MCS9_SG 0xc9 -+#define ODM_MGN_MCS10_SG 0xca -+#define ODM_MGN_MCS11_SG 0xcb -+#define ODM_MGN_MCS12_SG 0xcc -+#define ODM_MGN_MCS13_SG 0xcd -+#define ODM_MGN_MCS14_SG 0xce -+#define ODM_MGN_MCS15_SG 0xcf -+ -+/* -----DESC rate--------------------------------- */ -+ -+#define ODM_RATEMCS15_SG 0x1c -+#define ODM_RATEMCS32 0x20 -+ -+ -+// CCK Rates, TxHT = 0 -+#define ODM_RATE1M 0x00 -+#define ODM_RATE2M 0x01 -+#define ODM_RATE5_5M 0x02 -+#define ODM_RATE11M 0x03 -+// OFDM Rates, TxHT = 0 -+#define ODM_RATE6M 0x04 -+#define ODM_RATE9M 0x05 -+#define ODM_RATE12M 0x06 -+#define ODM_RATE18M 0x07 -+#define ODM_RATE24M 0x08 -+#define ODM_RATE36M 0x09 -+#define ODM_RATE48M 0x0A -+#define ODM_RATE54M 0x0B -+// MCS Rates, TxHT = 1 -+#define ODM_RATEMCS0 0x0C -+#define ODM_RATEMCS1 0x0D -+#define ODM_RATEMCS2 0x0E -+#define ODM_RATEMCS3 0x0F -+#define ODM_RATEMCS4 0x10 -+#define ODM_RATEMCS5 0x11 -+#define ODM_RATEMCS6 0x12 -+#define ODM_RATEMCS7 0x13 -+#define ODM_RATEMCS8 0x14 -+#define ODM_RATEMCS9 0x15 -+#define ODM_RATEMCS10 0x16 -+#define ODM_RATEMCS11 0x17 -+#define ODM_RATEMCS12 0x18 -+#define ODM_RATEMCS13 0x19 -+#define ODM_RATEMCS14 0x1A -+#define ODM_RATEMCS15 0x1B -+#define ODM_RATEMCS16 0x1C -+#define ODM_RATEMCS17 0x1D -+#define ODM_RATEMCS18 0x1E -+#define ODM_RATEMCS19 0x1F -+#define ODM_RATEMCS20 0x20 -+#define ODM_RATEMCS21 0x21 -+#define ODM_RATEMCS22 0x22 -+#define ODM_RATEMCS23 0x23 -+#define ODM_RATEMCS24 0x24 -+#define ODM_RATEMCS25 0x25 -+#define ODM_RATEMCS26 0x26 -+#define ODM_RATEMCS27 0x27 -+#define ODM_RATEMCS28 0x28 -+#define ODM_RATEMCS29 0x29 -+#define ODM_RATEMCS30 0x2A -+#define ODM_RATEMCS31 0x2B -+#define ODM_RATEVHTSS1MCS0 0x2C -+#define ODM_RATEVHTSS1MCS1 0x2D -+#define ODM_RATEVHTSS1MCS2 0x2E -+#define ODM_RATEVHTSS1MCS3 0x2F -+#define ODM_RATEVHTSS1MCS4 0x30 -+#define ODM_RATEVHTSS1MCS5 0x31 -+#define ODM_RATEVHTSS1MCS6 0x32 -+#define ODM_RATEVHTSS1MCS7 0x33 -+#define ODM_RATEVHTSS1MCS8 0x34 -+#define ODM_RATEVHTSS1MCS9 0x35 -+#define ODM_RATEVHTSS2MCS0 0x36 -+#define ODM_RATEVHTSS2MCS1 0x37 -+#define ODM_RATEVHTSS2MCS2 0x38 -+#define ODM_RATEVHTSS2MCS3 0x39 -+#define ODM_RATEVHTSS2MCS4 0x3A -+#define ODM_RATEVHTSS2MCS5 0x3B -+#define ODM_RATEVHTSS2MCS6 0x3C -+#define ODM_RATEVHTSS2MCS7 0x3D -+#define ODM_RATEVHTSS2MCS8 0x3E -+#define ODM_RATEVHTSS2MCS9 0x3F -+#define ODM_RATEVHTSS3MCS0 0x40 -+#define ODM_RATEVHTSS3MCS1 0x41 -+#define ODM_RATEVHTSS3MCS2 0x42 -+#define ODM_RATEVHTSS3MCS3 0x43 -+#define ODM_RATEVHTSS3MCS4 0x44 -+#define ODM_RATEVHTSS3MCS5 0x45 -+#define ODM_RATEVHTSS3MCS6 0x46 -+#define ODM_RATEVHTSS3MCS7 0x47 -+#define ODM_RATEVHTSS3MCS8 0x48 -+#define ODM_RATEVHTSS3MCS9 0x49 -+#define ODM_RATEVHTSS4MCS0 0x4A -+#define ODM_RATEVHTSS4MCS1 0x4B -+#define ODM_RATEVHTSS4MCS2 0x4C -+#define ODM_RATEVHTSS4MCS3 0x4D -+#define ODM_RATEVHTSS4MCS4 0x4E -+#define ODM_RATEVHTSS4MCS5 0x4F -+#define ODM_RATEVHTSS4MCS6 0x50 -+#define ODM_RATEVHTSS4MCS7 0x51 -+#define ODM_RATEVHTSS4MCS8 0x52 -+#define ODM_RATEVHTSS4MCS9 0x53 -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS4MCS9+1) -+#else -+ #if (RTL8192E_SUPPORT == 1) -+ #define ODM_NUM_RATE_IDX (ODM_RATEMCS15+1) -+ #elif (RTL8723B_SUPPORT == 1) || (RTL8188E_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) -+ #define ODM_NUM_RATE_IDX (ODM_RATEMCS7+1) -+ #elif (RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) -+ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS1MCS9+1) -+ #elif (RTL8812A_SUPPORT == 1) -+ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS2MCS9+1) -+ #elif(RTL8814A_SUPPORT == 1) -+ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS3MCS9+1) -+ #else -+ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS4MCS9+1) -+ #endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define CONFIG_SFW_SUPPORTED -+#endif -+ -+//1 ============================================================ -+//1 enumeration -+//1 ============================================================ -+ -+ -+// ODM_CMNINFO_INTERFACE -+typedef enum tag_ODM_Support_Interface_Definition -+{ -+ ODM_ITRF_PCIE = 0x1, -+ ODM_ITRF_USB = 0x2, -+ ODM_ITRF_SDIO = 0x4, -+ ODM_ITRF_ALL = 0x7, -+}ODM_INTERFACE_E; -+ -+// ODM_CMNINFO_IC_TYPE -+typedef enum tag_ODM_Support_IC_Type_Definition -+{ -+ ODM_RTL8192S = BIT0, -+ ODM_RTL8192C = BIT1, -+ ODM_RTL8192D = BIT2, -+ ODM_RTL8723A = BIT3, -+ ODM_RTL8188E = BIT4, -+ ODM_RTL8812 = BIT5, -+ ODM_RTL8821 = BIT6, -+ ODM_RTL8192E = BIT7, -+ ODM_RTL8723B = BIT8, -+ ODM_RTL8814A = BIT9, -+ ODM_RTL8881A = BIT10, -+ ODM_RTL8821B = BIT11, -+ ODM_RTL8822B = BIT12, -+ ODM_RTL8703B = BIT13, -+ ODM_RTL8195A = BIT14, -+ ODM_RTL8188F = BIT15 -+}ODM_IC_TYPE_E; -+ -+ -+ -+ -+#define ODM_IC_11N_SERIES (ODM_RTL8192S|ODM_RTL8192C|ODM_RTL8192D|ODM_RTL8723A|ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8703B|ODM_RTL8188F) -+#define ODM_IC_11AC_SERIES (ODM_RTL8812|ODM_RTL8821|ODM_RTL8814A|ODM_RTL8881A|ODM_RTL8821B|ODM_RTL8822B) -+#define ODM_IC_TXBF_SUPPORT (ODM_RTL8192E|ODM_RTL8812|ODM_RTL8821|ODM_RTL8814A|ODM_RTL8881A|ODM_RTL8822B) -+#define ODM_IC_11N_GAIN_IDX_EDCCA (ODM_RTL8195A|ODM_RTL8703B|ODM_RTL8188F) -+#define ODM_IC_11AC_GAIN_IDX_EDCCA (ODM_RTL8814A|ODM_RTL8822B) -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+#ifdef RTK_AC_SUPPORT -+#define ODM_IC_11AC_SERIES_SUPPORT 1 -+#else -+#define ODM_IC_11AC_SERIES_SUPPORT 0 -+#endif -+ -+#define ODM_IC_11N_SERIES_SUPPORT 1 -+#define ODM_CONFIG_BT_COEXIST 0 -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+#define ODM_IC_11AC_SERIES_SUPPORT 1 -+#define ODM_IC_11N_SERIES_SUPPORT 1 -+#define ODM_CONFIG_BT_COEXIST 1 -+ -+#else -+ -+#if((RTL8192C_SUPPORT == 1) || (RTL8192D_SUPPORT == 1) || (RTL8723A_SUPPORT == 1) || (RTL8188E_SUPPORT == 1) ||\ -+(RTL8723B_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8195A_SUPPORT == 1) || (RTL8703B_SUPPORT == 1) || \ -+(RTL8188F_SUPPORT == 1)) -+#define ODM_IC_11N_SERIES_SUPPORT 1 -+#define ODM_IC_11AC_SERIES_SUPPORT 0 -+#else -+#define ODM_IC_11N_SERIES_SUPPORT 0 -+#define ODM_IC_11AC_SERIES_SUPPORT 1 -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+#define ODM_CONFIG_BT_COEXIST 1 -+#else -+#define ODM_CONFIG_BT_COEXIST 0 -+#endif -+ -+#endif -+ -+ -+//ODM_CMNINFO_CUT_VER -+typedef enum tag_ODM_Cut_Version_Definition -+{ -+ ODM_CUT_A = 0, -+ ODM_CUT_B = 1, -+ ODM_CUT_C = 2, -+ ODM_CUT_D = 3, -+ ODM_CUT_E = 4, -+ ODM_CUT_F = 5, -+ -+ ODM_CUT_I = 8, -+ ODM_CUT_J = 9, -+ ODM_CUT_K = 10, -+ ODM_CUT_TEST = 15, -+}ODM_CUT_VERSION_E; -+ -+// ODM_CMNINFO_FAB_VER -+typedef enum tag_ODM_Fab_Version_Definition -+{ -+ ODM_TSMC = 0, -+ ODM_UMC = 1, -+}ODM_FAB_E; -+ -+// ODM_CMNINFO_RF_TYPE -+// -+// For example 1T2R (A+AB = BIT0|BIT4|BIT5) -+// -+typedef enum tag_ODM_RF_Path_Bit_Definition -+{ -+ ODM_RF_A = BIT0, -+ ODM_RF_B = BIT1, -+ ODM_RF_C = BIT2, -+ ODM_RF_D = BIT3, -+}ODM_RF_PATH_E; -+ -+typedef enum tag_PHYDM_RF_TX_NUM { -+ ODM_1T = 1, -+ ODM_2T = 2, -+ ODM_3T = 3, -+ ODM_4T = 4, -+} ODM_RF_TX_NUM_E; -+ -+typedef enum tag_ODM_RF_Type_Definition { -+ ODM_1T1R, -+ ODM_1T2R, -+ ODM_2T2R, -+ ODM_2T2R_GREEN, -+ ODM_2T3R, -+ ODM_2T4R, -+ ODM_3T3R, -+ ODM_3T4R, -+ ODM_4T4R, -+ ODM_XTXR -+}ODM_RF_TYPE_E; -+ -+ -+typedef enum tag_ODM_MAC_PHY_Mode_Definition -+{ -+ ODM_SMSP = 0, -+ ODM_DMSP = 1, -+ ODM_DMDP = 2, -+}ODM_MAC_PHY_MODE_E; -+ -+ -+typedef enum tag_BT_Coexist_Definition -+{ -+ ODM_BT_BUSY = 1, -+ ODM_BT_ON = 2, -+ ODM_BT_OFF = 3, -+ ODM_BT_NONE = 4, -+}ODM_BT_COEXIST_E; -+ -+// ODM_CMNINFO_OP_MODE -+typedef enum tag_Operation_Mode_Definition -+{ -+ ODM_NO_LINK = BIT0, -+ ODM_LINK = BIT1, -+ ODM_SCAN = BIT2, -+ ODM_POWERSAVE = BIT3, -+ ODM_AP_MODE = BIT4, -+ ODM_CLIENT_MODE = BIT5, -+ ODM_AD_HOC = BIT6, -+ ODM_WIFI_DIRECT = BIT7, -+ ODM_WIFI_DISPLAY = BIT8, -+}ODM_OPERATION_MODE_E; -+ -+// ODM_CMNINFO_WM_MODE -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+typedef enum tag_Wireless_Mode_Definition -+{ -+ ODM_WM_UNKNOW = 0x0, -+ ODM_WM_B = BIT0, -+ ODM_WM_G = BIT1, -+ ODM_WM_A = BIT2, -+ ODM_WM_N24G = BIT3, -+ ODM_WM_N5G = BIT4, -+ ODM_WM_AUTO = BIT5, -+ ODM_WM_AC = BIT6, -+}ODM_WIRELESS_MODE_E; -+#else -+typedef enum tag_Wireless_Mode_Definition -+{ -+ ODM_WM_UNKNOWN = 0x00,/*0x0*/ -+ ODM_WM_A = BIT0, /* 0x1*/ -+ ODM_WM_B = BIT1, /* 0x2*/ -+ ODM_WM_G = BIT2,/* 0x4*/ -+ ODM_WM_AUTO = BIT3,/* 0x8*/ -+ ODM_WM_N24G = BIT4,/* 0x10*/ -+ ODM_WM_N5G = BIT5,/* 0x20*/ -+ ODM_WM_AC_5G = BIT6,/* 0x40*/ -+ ODM_WM_AC_24G = BIT7,/* 0x80*/ -+ ODM_WM_AC_ONLY = BIT8,/* 0x100*/ -+ ODM_WM_MAX = BIT11/* 0x800*/ -+ -+}ODM_WIRELESS_MODE_E; -+#endif -+ -+// ODM_CMNINFO_BAND -+typedef enum tag_Band_Type_Definition -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ ODM_BAND_2_4G = BIT0, -+ ODM_BAND_5G = BIT1, -+#else -+ ODM_BAND_2_4G = 0, -+ ODM_BAND_5G, -+ ODM_BAND_ON_BOTH, -+ ODM_BANDMAX -+#endif -+}ODM_BAND_TYPE_E; -+ -+ -+// ODM_CMNINFO_SEC_CHNL_OFFSET -+typedef enum tag_Secondary_Channel_Offset_Definition -+{ -+ ODM_DONT_CARE = 0, -+ ODM_BELOW = 1, -+ ODM_ABOVE = 2 -+}ODM_SEC_CHNL_OFFSET_E; -+ -+// ODM_CMNINFO_SEC_MODE -+typedef enum tag_Security_Definition -+{ -+ ODM_SEC_OPEN = 0, -+ ODM_SEC_WEP40 = 1, -+ ODM_SEC_TKIP = 2, -+ ODM_SEC_RESERVE = 3, -+ ODM_SEC_AESCCMP = 4, -+ ODM_SEC_WEP104 = 5, -+ ODM_WEP_WPA_MIXED = 6, // WEP + WPA -+ ODM_SEC_SMS4 = 7, -+}ODM_SECURITY_E; -+ -+// ODM_CMNINFO_BW -+typedef enum tag_Bandwidth_Definition -+{ -+ ODM_BW20M = 0, -+ ODM_BW40M = 1, -+ ODM_BW80M = 2, -+ ODM_BW160M = 3, -+ ODM_BW5M = 4, -+ ODM_BW10M = 5, -+ ODM_BW_MAX = 6 -+}ODM_BW_E; -+ -+// ODM_CMNINFO_CHNL -+ -+// ODM_CMNINFO_BOARD_TYPE -+typedef enum tag_Board_Definition -+{ -+ ODM_BOARD_DEFAULT = 0, // The DEFAULT case. -+ ODM_BOARD_MINICARD = BIT(0), // 0 = non-mini card, 1= mini card. -+ ODM_BOARD_SLIM = BIT(1), // 0 = non-slim card, 1 = slim card -+ ODM_BOARD_BT = BIT(2), // 0 = without BT card, 1 = with BT -+ ODM_BOARD_EXT_PA = BIT(3), // 0 = no 2G ext-PA, 1 = existing 2G ext-PA -+ ODM_BOARD_EXT_LNA = BIT(4), // 0 = no 2G ext-LNA, 1 = existing 2G ext-LNA -+ ODM_BOARD_EXT_TRSW = BIT(5), // 0 = no ext-TRSW, 1 = existing ext-TRSW -+ ODM_BOARD_EXT_PA_5G = BIT(6), // 0 = no 5G ext-PA, 1 = existing 5G ext-PA -+ ODM_BOARD_EXT_LNA_5G= BIT(7), // 0 = no 5G ext-LNA, 1 = existing 5G ext-LNA -+}ODM_BOARD_TYPE_E; -+ -+typedef enum tag_ODM_Package_Definition -+{ -+ ODM_PACKAGE_DEFAULT = 0, -+ ODM_PACKAGE_QFN68 = BIT(0), -+ ODM_PACKAGE_TFBGA90 = BIT(1), -+ ODM_PACKAGE_TFBGA79 = BIT(2), -+}ODM_Package_TYPE_E; -+ -+typedef enum tag_ODM_TYPE_GPA_Definition { -+ TYPE_GPA0 = 0x0000, -+ TYPE_GPA1 = 0x0055, -+ TYPE_GPA2 = 0x00AA, -+ TYPE_GPA3 = 0x00FF, -+ TYPE_GPA4 = 0x5500, -+ TYPE_GPA5 = 0x5555, -+ TYPE_GPA6 = 0x55AA, -+ TYPE_GPA7 = 0x55FF, -+ TYPE_GPA8 = 0xAA00, -+ TYPE_GPA9 = 0xAA55, -+ TYPE_GPA10 = 0xAAAA, -+ TYPE_GPA11 = 0xAAFF, -+ TYPE_GPA12 = 0xFF00, -+ TYPE_GPA13 = 0xFF55, -+ TYPE_GPA14 = 0xFFAA, -+ TYPE_GPA15 = 0xFFFF, -+}ODM_TYPE_GPA_E; -+ -+typedef enum tag_ODM_TYPE_APA_Definition { -+ TYPE_APA0 = 0x0000, -+ TYPE_APA1 = 0x0055, -+ TYPE_APA2 = 0x00AA, -+ TYPE_APA3 = 0x00FF, -+ TYPE_APA4 = 0x5500, -+ TYPE_APA5 = 0x5555, -+ TYPE_APA6 = 0x55AA, -+ TYPE_APA7 = 0x55FF, -+ TYPE_APA8 = 0xAA00, -+ TYPE_APA9 = 0xAA55, -+ TYPE_APA10 = 0xAAAA, -+ TYPE_APA11 = 0xAAFF, -+ TYPE_APA12 = 0xFF00, -+ TYPE_APA13 = 0xFF55, -+ TYPE_APA14 = 0xFFAA, -+ TYPE_APA15 = 0xFFFF, -+}ODM_TYPE_APA_E; -+ -+typedef enum tag_ODM_TYPE_GLNA_Definition { -+ TYPE_GLNA0 = 0x0000, -+ TYPE_GLNA1 = 0x0055, -+ TYPE_GLNA2 = 0x00AA, -+ TYPE_GLNA3 = 0x00FF, -+ TYPE_GLNA4 = 0x5500, -+ TYPE_GLNA5 = 0x5555, -+ TYPE_GLNA6 = 0x55AA, -+ TYPE_GLNA7 = 0x55FF, -+ TYPE_GLNA8 = 0xAA00, -+ TYPE_GLNA9 = 0xAA55, -+ TYPE_GLNA10 = 0xAAAA, -+ TYPE_GLNA11 = 0xAAFF, -+ TYPE_GLNA12 = 0xFF00, -+ TYPE_GLNA13 = 0xFF55, -+ TYPE_GLNA14 = 0xFFAA, -+ TYPE_GLNA15 = 0xFFFF, -+}ODM_TYPE_GLNA_E; -+ -+typedef enum tag_ODM_TYPE_ALNA_Definition { -+ TYPE_ALNA0 = 0x0000, -+ TYPE_ALNA1 = 0x0055, -+ TYPE_ALNA2 = 0x00AA, -+ TYPE_ALNA3 = 0x00FF, -+ TYPE_ALNA4 = 0x5500, -+ TYPE_ALNA5 = 0x5555, -+ TYPE_ALNA6 = 0x55AA, -+ TYPE_ALNA7 = 0x55FF, -+ TYPE_ALNA8 = 0xAA00, -+ TYPE_ALNA9 = 0xAA55, -+ TYPE_ALNA10 = 0xAAAA, -+ TYPE_ALNA11 = 0xAAFF, -+ TYPE_ALNA12 = 0xFF00, -+ TYPE_ALNA13 = 0xFF55, -+ TYPE_ALNA14 = 0xFFAA, -+ TYPE_ALNA15 = 0xFFFF, -+}ODM_TYPE_ALNA_E; -+ -+ -+typedef enum _ODM_RF_RADIO_PATH { -+ ODM_RF_PATH_A = 0, //Radio Path A -+ ODM_RF_PATH_B = 1, //Radio Path B -+ ODM_RF_PATH_C = 2, //Radio Path C -+ ODM_RF_PATH_D = 3, //Radio Path D -+ ODM_RF_PATH_AB, -+ ODM_RF_PATH_AC, -+ ODM_RF_PATH_AD, -+ ODM_RF_PATH_BC, -+ ODM_RF_PATH_BD, -+ ODM_RF_PATH_CD, -+ ODM_RF_PATH_ABC, -+ ODM_RF_PATH_ACD, -+ ODM_RF_PATH_BCD, -+ ODM_RF_PATH_ABCD, -+ // ODM_RF_PATH_MAX, //Max RF number 90 support -+} ODM_RF_RADIO_PATH_E, *PODM_RF_RADIO_PATH_E; -+ -+typedef enum _ODM_PARAMETER_INIT { -+ ODM_PRE_SETTING = 0, -+ ODM_POST_SETTING = 1, -+} ODM_PARAMETER_INIT_E; -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_rainfo.c linux/3rdparty/rtl8812au/hal/phydm/phydm_rainfo.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_rainfo.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_rainfo.c 2017-06-07 23:07:21.020688396 +0300 -@@ -0,0 +1,2565 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if (defined(CONFIG_RA_DBG_CMD)) -+VOID -+ODM_C2HRaParaReportHandler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ u1Byte para_idx = CmdBuf[0]; //Retry Penalty, NH, NL -+ u1Byte RateTypeStart = CmdBuf[1]; -+ u1Byte RateTypeLength = CmdLen - 2; -+ u1Byte i; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[ From FW C2H RA Para ] CmdBuf[0]= (( %d ))\n", CmdBuf[0])); -+ -+ if (para_idx == RADBG_RTY_PENALTY) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |RTY Penality Index| \n")); -+ -+ for (i = 0 ; i < (RateTypeLength) ; i++) { -+ if (pRA_Table->is_ra_dbg_init) -+ pRA_Table->RTY_P_default[RateTypeStart + i] = CmdBuf[2 + i]; -+ -+ pRA_Table->RTY_P[RateTypeStart + i] = CmdBuf[2 + i]; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%8d %15d \n", (RateTypeStart + i), pRA_Table->RTY_P[RateTypeStart + i])); -+ } -+ -+ } else if (para_idx == RADBG_N_HIGH) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |N-High| \n")); -+ -+ -+ } else if (para_idx == RADBG_N_LOW){ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |N-Low| \n")); -+ -+ } -+ else if (para_idx == RADBG_RATE_UP_RTY_RATIO) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |Rate Up RTY Ratio| \n")); -+ -+ for (i = 0 ; i < (RateTypeLength) ; i++) { -+ if (pRA_Table->is_ra_dbg_init) -+ pRA_Table->RATE_UP_RTY_RATIO_default[RateTypeStart + i] = CmdBuf[2 + i]; -+ -+ pRA_Table->RATE_UP_RTY_RATIO[RateTypeStart + i] = CmdBuf[2 + i]; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%8d %15d \n", (RateTypeStart + i), pRA_Table->RATE_UP_RTY_RATIO[RateTypeStart + i])); -+ } -+ } else if (para_idx == RADBG_RATE_DOWN_RTY_RATIO) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |Rate Down RTY Ratio| \n")); -+ -+ for (i = 0 ; i < (RateTypeLength) ; i++) { -+ if (pRA_Table->is_ra_dbg_init) -+ pRA_Table->RATE_DOWN_RTY_RATIO_default[RateTypeStart + i] = CmdBuf[2 + i]; -+ -+ pRA_Table->RATE_DOWN_RTY_RATIO[RateTypeStart + i] = CmdBuf[2 + i]; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%8d %15d \n", (RateTypeStart + i), pRA_Table->RATE_DOWN_RTY_RATIO[RateTypeStart + i])); -+ } -+ } else if (para_idx == RADBG_DEBUG_MONITOR1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); -+ if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "RSSI =", CmdBuf[1])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x \n", "Rate =", CmdBuf[2] & 0x7f)); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "SGI =", (CmdBuf[2] & 0x80) >> 7)); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "BW =", CmdBuf[3])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "BW_max =", CmdBuf[4])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x \n", "multi_rate0 =", CmdBuf[5])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x \n", "multi_rate1 =", CmdBuf[6])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "DISRA =", CmdBuf[7])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "VHT_EN =", CmdBuf[8])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "SGI_support =", CmdBuf[9])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "try_ness =", CmdBuf[10])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x \n", "pre_rate =", CmdBuf[11])); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "RSSI =", CmdBuf[1])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %x \n", "BW =", CmdBuf[2])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "DISRA =", CmdBuf[3])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "VHT_EN =", CmdBuf[4])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "Hightest Rate =", CmdBuf[5])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x \n", "Lowest Rate =", CmdBuf[6])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x \n", "SGI_support =", CmdBuf[7])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "Rate_ID =", CmdBuf[8]));; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); -+ } else if (para_idx == RADBG_DEBUG_MONITOR2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); -+ if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d \n", "RateID =", CmdBuf[1])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x \n", "highest_rate =", CmdBuf[2])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x \n", "lowest_rate =", CmdBuf[3])); -+ -+ for (i = 4 ; i <= 11 ; i++) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("RAMASK = 0x%x \n", CmdBuf[i])); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %x%x %x%x %x%x %x%x \n", "RA Mask:", -+ CmdBuf[8], CmdBuf[7], CmdBuf[6], CmdBuf[5], CmdBuf[4], CmdBuf[3], CmdBuf[2], CmdBuf[1])); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); -+ } else if (para_idx == RADBG_DEBUG_MONITOR3) { -+ -+ for (i = 0 ; i < (CmdLen - 1) ; i++) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("content[%d] = %d \n", i, CmdBuf[1 + i])); -+ } else if (para_idx == RADBG_DEBUG_MONITOR4) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s {%d.%d} \n", "RA Version =", CmdBuf[1], CmdBuf[2])); -+ -+} -+ -+VOID -+odm_RA_ParaAdjust_Send_H2C( -+ IN PVOID pDM_VOID -+) -+{ -+ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte H2C_Parameter[6] = {0}; -+ -+ H2C_Parameter[0] = RA_FIRST_MACID; -+ -+ //ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("RA_Para_feedback_req= (( %d )) \n",pRA_Table->RA_Para_feedback_req )); -+ if (pRA_Table->RA_Para_feedback_req) { //H2C_Parameter[5]=1 ; ask FW for all RA parameters -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] Ask FW for RA parameter \n")); -+ H2C_Parameter[5] |= BIT1; //ask FW to report RA parameters -+ H2C_Parameter[1] = pRA_Table->para_idx; //pRA_Table->para_idx; -+ pRA_Table->RA_Para_feedback_req = 0; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] Send H2C to FW for modifying RA parameter \n")); -+ -+ H2C_Parameter[1] = pRA_Table->para_idx; -+ H2C_Parameter[2] = pRA_Table->rate_idx; -+ //1 [8 bit] -+ if (pRA_Table->para_idx == RADBG_RTY_PENALTY || pRA_Table->para_idx == RADBG_RATE_UP_RTY_RATIO || pRA_Table->para_idx == RADBG_RATE_DOWN_RTY_RATIO) { -+ H2C_Parameter[3] = pRA_Table->value; -+ H2C_Parameter[4] = 0; -+ } -+ //1 [16 bit] -+ else { //if ((pRA_Table->rate_idx==RADBG_N_HIGH)||(pRA_Table->rate_idx==RADBG_N_LOW)) -+ H2C_Parameter[3] = (u1Byte)(((pRA_Table->value_16) & 0xf0) >> 4); //byte1 -+ H2C_Parameter[4] = (u1Byte)((pRA_Table->value_16) & 0x0f); //byte0 -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[1] = 0x%x \n", H2C_Parameter[1])); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[2] = 0x%x \n", H2C_Parameter[2])); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[3] = 0x%x \n", H2C_Parameter[3])); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[4] = 0x%x \n", H2C_Parameter[4])); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[5] = 0x%x \n", H2C_Parameter[5])); -+ -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RA_PARA_ADJUST, 6, H2C_Parameter); -+ -+} -+ -+ -+VOID -+odm_RA_ParaAdjust( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte para_idx = pRA_Table->para_idx; -+ u1Byte rate_idx = pRA_Table->rate_idx; -+ u1Byte value = pRA_Table->value; -+ u1Byte Pre_value = 0xff; -+ -+ BOOLEAN sign = 0; -+ -+ if (pRA_Table->para_idx == RADBG_RTY_PENALTY) { -+ Pre_value = pRA_Table->RTY_P[rate_idx]; -+ pRA_Table->RTY_P[rate_idx] = value; -+ pRA_Table->RTY_P_modify_note[rate_idx] = 1; -+ } else if (pRA_Table->para_idx == RADBG_N_HIGH) { -+ -+ } else if (pRA_Table->para_idx == RADBG_N_LOW) { -+ -+ } else if (pRA_Table->para_idx == RADBG_RATE_UP_RTY_RATIO) { -+ Pre_value = pRA_Table->RATE_UP_RTY_RATIO[rate_idx]; -+ pRA_Table->RATE_UP_RTY_RATIO[rate_idx] = value; -+ pRA_Table->RATE_UP_RTY_RATIO_modify_note[rate_idx] = 1; -+ } else if (pRA_Table->para_idx == RADBG_RATE_DOWN_RTY_RATIO) { -+ Pre_value = pRA_Table->RATE_DOWN_RTY_RATIO[rate_idx]; -+ pRA_Table->RATE_DOWN_RTY_RATIO[rate_idx] = value; -+ pRA_Table->RATE_DOWN_RTY_RATIO_modify_note[rate_idx] = 1; -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" Change RA Papa[%d], Rate[ %d ], ((%d)) -> ((%d)) \n", pRA_Table->para_idx, rate_idx, Pre_value, value)); -+ odm_RA_ParaAdjust_Send_H2C(pDM_Odm); -+} -+ -+ -+VOID -+phydm_ra_print_msg( -+ IN PVOID pDM_VOID, -+ IN u1Byte *value, -+ IN u1Byte *value_default, -+ IN u1Byte *modify_note -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u4Byte i; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate index| |Current-value| |Default-value| |Modify?| \n")); -+ for (i = 0 ; i <= (pRA_Table->rate_length); i++) { -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [ %d ] %20d %25d %20s \n", i, value[i], value_default[i], ((modify_note[i] == 1) ? "V" : " . "))); -+#else -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [ %d ] %10d %14d %14s \n", i, value[i], value_default[i], ((modify_note[i] == 1) ? "V" : " . "))); -+#endif -+ } -+ -+} -+ -+VOID -+odm_RA_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ pRA_Table->is_ra_dbg_init = FALSE; -+ -+ if (dm_value[0] == 100) { /*1 Print RA Parameters*/ -+ u1Byte default_pointer_value; -+ u1Byte *pvalue; -+ u1Byte *pvalue_default; -+ u1Byte *pmodify_note; -+ -+ pvalue = pvalue_default = pmodify_note = &default_pointer_value; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("\n------------------------------------------------------------------------------------\n")); -+ -+ if (dm_value[1] == RADBG_RTY_PENALTY) { /* [1]*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [1] RTY_PENALTY\n")); -+ pvalue = &(pRA_Table->RTY_P[0]); -+ pvalue_default = &(pRA_Table->RTY_P_default[0]); -+ pmodify_note = (u1Byte *)&(pRA_Table->RTY_P_modify_note[0]); -+ } else if (dm_value[1] == RADBG_N_HIGH) { /* [2]*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [2] N_HIGH\n")); -+ -+ } else if (dm_value[1] == RADBG_N_LOW) { /*[3]*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [3] N_LOW\n")); -+ -+ } else if (dm_value[1] == RADBG_RATE_UP_RTY_RATIO) { /* [8]*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [8] RATE_UP_RTY_RATIO\n")); -+ pvalue = &(pRA_Table->RATE_UP_RTY_RATIO[0]); -+ pvalue_default = &(pRA_Table->RATE_UP_RTY_RATIO_default[0]); -+ pmodify_note = (u1Byte *)&(pRA_Table->RATE_UP_RTY_RATIO_modify_note[0]); -+ } else if (dm_value[1] == RADBG_RATE_DOWN_RTY_RATIO) { /* [9]*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [9] RATE_DOWN_RTY_RATIO\n")); -+ pvalue = &(pRA_Table->RATE_DOWN_RTY_RATIO[0]); -+ pvalue_default = &(pRA_Table->RATE_DOWN_RTY_RATIO_default[0]); -+ pmodify_note = (u1Byte *)&(pRA_Table->RATE_DOWN_RTY_RATIO_modify_note[0]); -+ } -+ -+ phydm_ra_print_msg(pDM_Odm, pvalue, pvalue_default, pmodify_note); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("\n------------------------------------------------------------------------------------\n\n")); -+ -+ } else if (dm_value[0] == 101) { -+ pRA_Table->para_idx = (u1Byte)dm_value[1]; -+ -+ pRA_Table->RA_Para_feedback_req = 1; -+ odm_RA_ParaAdjust_Send_H2C(pDM_Odm); -+ } else { -+ pRA_Table->para_idx = (u1Byte)dm_value[0]; -+ pRA_Table->rate_idx = (u1Byte)dm_value[1]; -+ pRA_Table->value = (u1Byte)dm_value[2]; -+ -+ odm_RA_ParaAdjust(pDM_Odm); -+ } -+ -+} -+ -+VOID -+odm_RA_ParaAdjust_init( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte i; -+ u1Byte ra_para_pool_u8[3] = { RADBG_RTY_PENALTY, RADBG_RATE_UP_RTY_RATIO, RADBG_RATE_DOWN_RTY_RATIO}; -+ /* -+ RTY_PENALTY = 1, //u8 -+ N_HIGH = 2, -+ N_LOW = 3, -+ RATE_UP_TABLE = 4, -+ RATE_DOWN_TABLE = 5, -+ TRYING_NECESSARY = 6, -+ DROPING_NECESSARY = 7, -+ RATE_UP_RTY_RATIO = 8, //u8 -+ RATE_DOWN_RTY_RATIO= 9, //u8 -+ ALL_PARA = 0xff -+ -+ */ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("odm_RA_ParaAdjust_init \n")); -+ -+ pRA_Table->is_ra_dbg_init = TRUE; -+ for (i = 0; i < 3; i++) { -+ pRA_Table->RA_Para_feedback_req = 1; -+ pRA_Table->para_idx = ra_para_pool_u8[i]; -+ odm_RA_ParaAdjust_Send_H2C(pDM_Odm); -+ } -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8192E) -+ pRA_Table->rate_length = ODM_RATEMCS15; -+ else if ((pDM_Odm->SupportICType == ODM_RTL8723B) || (pDM_Odm->SupportICType == ODM_RTL8188E)) -+ pRA_Table->rate_length = ODM_RATEMCS7; -+ else if ((pDM_Odm->SupportICType == ODM_RTL8821) || (pDM_Odm->SupportICType == ODM_RTL8881A)) -+ pRA_Table->rate_length = ODM_RATEVHTSS1MCS9; -+ else if (pDM_Odm->SupportICType == ODM_RTL8812) -+ pRA_Table->rate_length = ODM_RATEVHTSS2MCS9; -+ else if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ pRA_Table->rate_length = ODM_RATEVHTSS3MCS9; -+ else -+ pRA_Table->rate_length = ODM_RATEVHTSS4MCS9; -+ -+} -+ -+#else -+ -+VOID -+ODM_C2HRaParaReportHandler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+) -+{ -+} -+ -+VOID -+odm_RA_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value -+) -+{ -+} -+ -+VOID -+odm_RA_ParaAdjust_init( -+ IN PVOID pDM_VOID -+) -+ -+{ -+} -+ -+#endif //#if (defined(CONFIG_RA_DBG_CMD)) -+ -+VOID -+phydm_ra_dynamic_retry_count( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ PSTA_INFO_T pEntry; -+ u1Byte i, retry_offset; -+ u4Byte ma_rx_tp; -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("pDM_Odm->pre_b_noisy = %d\n", pDM_Odm->pre_b_noisy ));*/ -+ if (pDM_Odm->pre_b_noisy != pDM_Odm->NoisyDecision) { -+ -+ if (pDM_Odm->NoisyDecision) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("->Noisy Env. RA fallback value\n")); -+ ODM_SetMACReg(pDM_Odm, 0x430, bMaskDWord, 0x0); -+ ODM_SetMACReg(pDM_Odm, 0x434, bMaskDWord, 0x04030201); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("->Clean Env. RA fallback value\n")); -+ ODM_SetMACReg(pDM_Odm, 0x430, bMaskDWord, 0x02010000); -+ ODM_SetMACReg(pDM_Odm, 0x434, bMaskDWord, 0x06050403); -+ } -+ pDM_Odm->pre_b_noisy = pDM_Odm->NoisyDecision; -+ } -+} -+ -+#if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) -+ -+VOID -+phydm_retry_limit_table_bound( -+ IN PVOID pDM_VOID, -+ IN u1Byte *retry_limit, -+ IN u1Byte offset -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ if (*retry_limit > offset) { -+ -+ *retry_limit -= offset; -+ -+ if (*retry_limit < pRA_Table->retrylimit_low) -+ *retry_limit = pRA_Table->retrylimit_low; -+ else if (*retry_limit > pRA_Table->retrylimit_high) -+ *retry_limit = pRA_Table->retrylimit_high; -+ } else -+ *retry_limit = pRA_Table->retrylimit_low; -+} -+ -+VOID -+phydm_reset_retry_limit_table( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte i; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) /*support all IC platform*/ -+ -+ #else -+ #if ((RTL8192E_SUPPORT == 1) || (RTL8723B_SUPPORT == 1) || (RTL8188E_SUPPORT == 1)) -+ u1Byte per_rate_retrylimit_table_20M[ODM_RATEMCS15+1] = { -+ 1, 1, 2, 4, /*CCK*/ -+ 2, 2, 4, 6, 8, 12, 16, 18, /*OFDM*/ -+ 2, 4, 6, 8, 12, 18, 20, 22, /*20M HT-1SS*/ -+ 2, 4, 6, 8, 12, 18, 20, 22 /*20M HT-2SS*/ -+ }; -+ u1Byte per_rate_retrylimit_table_40M[ODM_RATEMCS15+1] = { -+ 1, 1, 2, 4, /*CCK*/ -+ 2, 2, 4, 6, 8, 12, 16, 18, /*OFDM*/ -+ 4, 8, 12, 16, 24, 32, 32, 32, /*40M HT-1SS*/ -+ 4, 8, 12, 16, 24, 32, 32, 32 /*40M HT-2SS*/ -+ }; -+ -+ #elif (RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) -+ -+ #elif (RTL8812A_SUPPORT == 1) -+ -+ #elif(RTL8814A_SUPPORT == 1) -+ -+ #else -+ -+ #endif -+ #endif -+ -+ memcpy(&(pRA_Table->per_rate_retrylimit_20M[0]), &(per_rate_retrylimit_table_20M[0]), ODM_NUM_RATE_IDX); -+ memcpy(&(pRA_Table->per_rate_retrylimit_40M[0]), &(per_rate_retrylimit_table_40M[0]), ODM_NUM_RATE_IDX); -+ -+ for (i = 0; i < ODM_NUM_RATE_IDX; i++) { -+ phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_20M[i]), 0); -+ phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_40M[i]), 0); -+ } -+} -+ -+VOID -+phydm_ra_dynamic_retry_limit( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ PSTA_INFO_T pEntry; -+ u1Byte i, retry_offset; -+ u4Byte ma_rx_tp; -+ -+ -+ if (pDM_Odm->pre_number_active_client == pDM_Odm->number_active_client) { -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" pre_number_active_client == number_active_client\n")); -+ return; -+ -+ } else { -+ if (pDM_Odm->number_active_client == 1) { -+ phydm_reset_retry_limit_table(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("one client only->reset to default value\n")); -+ } else { -+ -+ retry_offset = pDM_Odm->number_active_client * pRA_Table->retry_descend_num; -+ -+ for (i = 0; i < ODM_NUM_RATE_IDX; i++) { -+ -+ phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_20M[i]), retry_offset); -+ phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_40M[i]), retry_offset); -+ } -+ } -+ } -+} -+ -+VOID -+phydm_ra_dynamic_retry_limit_init( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ pRA_Table->retry_descend_num = RA_RETRY_DESCEND_NUM; -+ pRA_Table->retrylimit_low = RA_RETRY_LIMIT_LOW; -+ pRA_Table->retrylimit_high = RA_RETRY_LIMIT_HIGH; -+ -+ phydm_reset_retry_limit_table(pDM_Odm); -+ -+} -+#else -+VOID -+phydm_ra_dynamic_retry_limit( -+ IN PVOID pDM_VOID -+) -+{ -+} -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+VOID -+phydm_ra_dynamic_rate_id_on_assoc( -+ IN PVOID pDM_VOID, -+ IN u1Byte wireless_mode, -+ IN u1Byte init_rate_id -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] rf_mode = ((0x%x)), wireless_mode = ((0x%x)), init_rate_id = ((0x%x))\n", pDM_Odm->RFType, wireless_mode, init_rate_id)); -+ -+ if ((pDM_Odm->RFType == ODM_2T2R) | (pDM_Odm->RFType == ODM_2T2R_GREEN) | (pDM_Odm->RFType == ODM_2T3R) | (pDM_Odm->RFType == ODM_2T4R)) { -+ -+ if ((pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8192E)) && -+ (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G)) -+ ){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] set N-2SS ARFR5 table\n")); -+ ODM_SetMACReg(pDM_Odm, 0x4a4, bMaskDWord, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ -+ ODM_SetMACReg(pDM_Odm, 0x4a8, bMaskDWord, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ -+ } else if ((pDM_Odm->SupportICType & (ODM_RTL8812)) && -+ (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY)) -+ ){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] set AC-2SS ARFR0 table\n")); -+ ODM_SetMACReg(pDM_Odm, 0x444, bMaskDWord, 0x0fff); /*AC-2SS, ARFR0, rate_id = 0x9*/ -+ ODM_SetMACReg(pDM_Odm, 0x448, bMaskDWord, 0xff01f000); /*AC-2SS, ARFR0, rate_id = 0x9*/ -+ } -+ } -+ -+} -+ -+VOID -+phydm_ra_dynamic_rate_id_init( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8192E)) { -+ -+ ODM_SetMACReg(pDM_Odm, 0x4a4, bMaskDWord, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ -+ ODM_SetMACReg(pDM_Odm, 0x4a8, bMaskDWord, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ -+ -+ ODM_SetMACReg(pDM_Odm, 0x444, bMaskDWord, 0x0fff); /*AC-2SS, ARFR0, rate_id = 0x9*/ -+ ODM_SetMACReg(pDM_Odm, 0x448, bMaskDWord, 0xff01f000); /*AC-2SS, ARFR0, rate_id = 0x9*/ -+ } -+} -+ -+VOID -+phydm_update_rate_id( -+ IN PVOID pDM_VOID, -+ IN u1Byte rate, -+ IN u1Byte platform_macid -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte current_tx_ss; -+ u1Byte rate_idx = rate & 0x7f; /*remove bit7 SGI*/ -+ u1Byte wireless_mode; -+ u1Byte phydm_macid; -+ PSTA_INFO_T pEntry; -+ -+ if (rate_idx >= ODM_RATEVHTSS2MCS0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( VHT2SS-MCS%d ))\n", platform_macid, (rate_idx-ODM_RATEVHTSS2MCS0))); -+ /*dummy for SD4 check patch*/ -+ } else if (rate_idx >= ODM_RATEVHTSS1MCS0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( VHT1SS-MCS%d ))\n", platform_macid, (rate_idx-ODM_RATEVHTSS1MCS0))); -+ /*dummy for SD4 check patch*/ -+ } else if (rate_idx >= ODM_RATEMCS0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( HT-MCS%d ))\n", platform_macid, (rate_idx-ODM_RATEMCS0))); -+ /*dummy for SD4 check patch*/ -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( HT-MCS%d ))\n", platform_macid, rate_idx)); -+ /*dummy for SD4 check patch*/ -+ } -+ -+ phydm_macid = pDM_Odm->platform2phydm_macid_table[platform_macid]; -+ pEntry = pDM_Odm->pODM_StaInfo[phydm_macid]; -+ -+ if (IS_STA_VALID(pEntry)) { -+ wireless_mode = pEntry->WirelessMode; -+ -+ if ((pDM_Odm->RFType == ODM_2T2R) | (pDM_Odm->RFType == ODM_2T2R_GREEN) | (pDM_Odm->RFType == ODM_2T3R) | (pDM_Odm->RFType == ODM_2T4R)) { -+ -+ pEntry->ratr_idx = pEntry->ratr_idx_init; -+ if (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G)) { /*N mode*/ -+ if (rate_idx >= ODM_RATEMCS8 && rate_idx <= ODM_RATEMCS15) { /*2SS mode*/ -+ -+ pEntry->ratr_idx = ARFR_5_RATE_ID; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("ARFR_5\n")); -+ } -+ } else if (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY)) {/*AC mode*/ -+ if (rate_idx >= ODM_RATEVHTSS2MCS0 && rate_idx <= ODM_RATEVHTSS2MCS9) {/*2SS mode*/ -+ -+ pEntry->ratr_idx = ARFR_0_RATE_ID; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("ARFR_0\n")); -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("UPdate_RateID[%d]: (( 0x%x ))\n", platform_macid, pEntry->ratr_idx)); -+ } -+ } -+ -+} -+#endif -+ -+VOID -+phydm_c2h_ra_report_handler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte legacy_table[12] = {1,2,5,11,6,9,12,18,24,36,48,54}; -+ u1Byte macid = CmdBuf[1]; -+ -+ u1Byte rate = CmdBuf[0]; -+ u1Byte rate_idx = rate & 0x7f; /*remove bit7 SGI*/ -+ u1Byte vht_en=(rate_idx >= ODM_RATEVHTSS1MCS0)? 1 :0; -+ u1Byte b_sgi = (rate & 0x80)>>7; -+ -+ u1Byte pre_rate = pRA_Table->link_tx_rate[macid]; -+ u1Byte pre_rate_idx = pre_rate & 0x7f; /*remove bit7 SGI*/ -+ u1Byte pre_vht_en=(pre_rate_idx >= ODM_RATEVHTSS1MCS0)? 1 :0; -+ u1Byte pre_b_sgi = (pre_rate & 0x80)>>7; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ GET_HAL_DATA(Adapter)->CurrentRARate = HwRateToMRate(rate_idx); -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ ODM_UpdateInitRate(pDM_Odm, rate_idx); -+ #endif -+ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD,("RA: rate_idx=0x%x , sgi = %d\n", rate_idx, b_sgi));*/ -+ /*if (pDM_Odm->SupportICType & (ODM_RTL8703B))*/ -+ { -+ if (CmdLen >= 4) { -+ if (CmdBuf[3] == 0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("Init-Rate Update\n")); -+ /**/ -+ } else if (CmdBuf[3] == 0xff) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("FW Level: Fix rate\n")); -+ /**/ -+ } else if (CmdBuf[3] == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("Try Success\n")); -+ /**/ -+ } else if (CmdBuf[3] == 2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("Try Fail & Try Again\n")); -+ /**/ -+ } else if (CmdBuf[3] == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("Rate Back\n")); -+ /**/ -+ } else if (CmdBuf[3] == 4) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("start rate by RSSI\n")); -+ /**/ -+ } else if (CmdBuf[3] == 5) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("Try rate\n")); -+ /**/ -+ } -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Tx Rate Update, MACID[%d] ( %s%s%s%s%d%s%s ) -> ( %s%s%s%s%d%s%s)\n", -+ macid, -+ ((pre_rate_idx >= ODM_RATEVHTSS1MCS0) && (pre_rate_idx <= ODM_RATEVHTSS1MCS9)) ? "VHT 1ss " : "", -+ ((pre_rate_idx >= ODM_RATEVHTSS2MCS0) && (pre_rate_idx <= ODM_RATEVHTSS2MCS9)) ? "VHT 2ss " : "", -+ ((pre_rate_idx >= ODM_RATEVHTSS3MCS0) && (pre_rate_idx <= ODM_RATEVHTSS3MCS9)) ? "VHT 3ss " : "", -+ (pre_rate_idx >= ODM_RATEMCS0) ? "MCS " : "", -+ (pre_vht_en) ? ((pre_rate_idx - ODM_RATEVHTSS1MCS0)%10) : ((pre_rate_idx >= ODM_RATEMCS0)? (pre_rate_idx - ODM_RATEMCS0) : ((pre_rate_idx <= ODM_RATE54M)?legacy_table[pre_rate_idx]:0)), -+ (pre_b_sgi) ? "-S" : " ", -+ (pre_rate_idx >= ODM_RATEMCS0) ? "" : "M", -+ ((rate_idx >= ODM_RATEVHTSS1MCS0) && (rate_idx <= ODM_RATEVHTSS1MCS9)) ? "VHT 1ss " : "", -+ ((rate_idx >= ODM_RATEVHTSS2MCS0) && (rate_idx <= ODM_RATEVHTSS2MCS9)) ? "VHT 2ss " : "", -+ ((rate_idx >= ODM_RATEVHTSS3MCS0) && (rate_idx <= ODM_RATEVHTSS3MCS9)) ? "VHT 3ss " : "", -+ (rate_idx >= ODM_RATEMCS0) ? "MCS " : "", -+ (vht_en) ? ((rate_idx - ODM_RATEVHTSS1MCS0)%10) : ((rate_idx >= ODM_RATEMCS0)? (rate_idx - ODM_RATEMCS0) : ((rate_idx <= ODM_RATE54M)?legacy_table[rate_idx]:0)), -+ (b_sgi) ? "-S" : " ", -+ (rate_idx >= ODM_RATEMCS0) ? "" : "M" )); -+ -+ pRA_Table->link_tx_rate[macid] = rate; -+ -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8192E)) -+ phydm_update_rate_id(pDM_Odm, rate, macid); -+ #endif -+ -+} -+ -+VOID -+odm_RSSIMonitorInit( -+ IN PVOID pDM_VOID -+) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ pRA_Table->firstconnect = FALSE; -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ pRA_Table->PT_collision_pre = TRUE; //used in ODM_DynamicARFBSelect(WIN only) -+#endif -+#endif -+} -+ -+VOID -+ODM_RAPostActionOnAssoc( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ pDM_Odm->H2C_RARpt_connect = 1; -+ odm_RSSIMonitorCheck(pDM_Odm); -+ pDM_Odm->H2C_RARpt_connect = 0; -+} -+ -+VOID -+odm_RSSIMonitorCheck( -+ IN PVOID pDM_VOID -+) -+{ -+ // -+ // For AP/ADSL use prtl8192cd_priv -+ // For CE/NIC use PADAPTER -+ // -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)) -+ return; -+ -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ switch (pDM_Odm->SupportPlatform) { -+ case ODM_WIN: -+ odm_RSSIMonitorCheckMP(pDM_Odm); -+ break; -+ -+ case ODM_CE: -+ odm_RSSIMonitorCheckCE(pDM_Odm); -+ break; -+ -+ case ODM_AP: -+ odm_RSSIMonitorCheckAP(pDM_Odm); -+ break; -+ -+ case ODM_ADSL: -+ //odm_DIGAP(pDM_Odm); -+ break; -+ } -+ -+} // odm_RSSIMonitorCheck -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+s4Byte -+phydm_FindMinimumRSSI( -+IN PDM_ODM_T pDM_Odm, -+IN PADAPTER pAdapter, -+IN OUT BOOLEAN *pbLink_temp -+ -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); -+ BOOLEAN act_as_ap = ACTING_AS_AP(pAdapter); -+ -+ /*DbgPrint("bMediaConnect = %d, ACTING_AS_AP = %d , EntryMinUndecoratedSmoothedPWDB = %d\n", -+ pMgntInfo->bMediaConnect,act_as_ap,pHalData->EntryMinUndecoratedSmoothedPWDB);*/ -+ -+ -+ /* 1.Determine the minimum RSSI */ -+ if ((!pMgntInfo->bMediaConnect) || -+ (act_as_ap && (pHalData->EntryMinUndecoratedSmoothedPWDB == 0))) {/* We should check AP mode and Entry info.into consideration, revised by Roger, 2013.10.18*/ -+ -+ pHalData->MinUndecoratedPWDBForDM = 0; -+ *pbLink_temp = FALSE; -+ -+ } else -+ *pbLink_temp = TRUE; -+ -+ -+ if (pMgntInfo->bMediaConnect) { /* Default port*/ -+ -+ if (act_as_ap || pMgntInfo->mIbss) { -+ pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ /**/ -+ } else { -+ pHalData->MinUndecoratedPWDBForDM = pHalData->UndecoratedSmoothedPWDB; -+ /**/ -+ } -+ } else { /* associated entry pwdb*/ -+ pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ /**/ -+ } -+ -+ return pHalData->MinUndecoratedPWDBForDM; -+} -+ -+#endif -+ -+VOID -+odm_RSSIMonitorCheckMP( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte H2C_Parameter[4] = {0}; -+ u4Byte i; -+ BOOLEAN bExtRAInfo = FALSE; -+ u1Byte cmdlen = 3; -+ u1Byte TxBF_EN = 0, stbc_en = 0; -+ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PRT_WLAN_STA pEntry = NULL; -+ s4Byte tmpEntryMaxPWDB = 0, tmpEntryMinPWDB = 0xff; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ PMGNT_INFO pDefaultMgntInfo = &Adapter->MgntInfo; -+ u8Byte curTxOkCnt = 0, curRxOkCnt = 0; -+ //BOOLEAN FirstConnect = 0; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+#if (BEAMFORMING_SUPPORT == 1) -+ BEAMFORMING_CAP Beamform_cap = BEAMFORMING_CAP_NONE; -+#endif -+ -+ PADAPTER pLoopAdapter = GetDefaultAdapter(Adapter); -+ -+ if (pDM_Odm->SupportICType & EXT_RA_INFO_SUPPORT_IC) { -+ bExtRAInfo = TRUE; -+ cmdlen = 4; -+ } -+ -+ //FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == FALSE); -+ //pRA_Table->firstconnect = pHalData->bLinked; -+ -+ -+ /* -+ if(pDM_Odm->SupportICType == ODM_RTL8188E && (pDefaultMgntInfo->CustomerID==RT_CID_819x_HP)) -+ { -+ if(curRxOkCnt >(curTxOkCnt*6)) -+ PlatformEFIOWrite4Byte(Adapter, REG_ARFR0, 0x8f015); -+ else -+ PlatformEFIOWrite4Byte(Adapter, REG_ARFR0, 0xff015); -+ } -+ -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8821 || -+ pDM_Odm->SupportICType == ODM_RTL8814A|| pDM_Odm->SupportICType == ODM_RTL8822B) -+ { -+ if(curRxOkCnt >(curTxOkCnt*6)) -+ H2C_Parameter[3]|=RAINFO_BE_RX_STATE; -+ } -+ */ -+ -+ while (pLoopAdapter) { -+ -+ if (pLoopAdapter != NULL) { -+ pMgntInfo = &pLoopAdapter->MgntInfo; -+ curTxOkCnt = pLoopAdapter->TxStats.NumTxBytesUnicast - pMgntInfo->lastTxOkCnt; -+ curRxOkCnt = pLoopAdapter->RxStats.NumRxBytesUnicast - pMgntInfo->lastRxOkCnt; -+ pMgntInfo->lastTxOkCnt = curTxOkCnt; -+ pMgntInfo->lastRxOkCnt = curRxOkCnt; -+ } -+ -+ for (i = 0; i < ASSOCIATE_ENTRY_NUM; i++) { -+ -+ if (IsAPModeExist(pLoopAdapter)) { -+ if (GetFirstExtAdapter(pLoopAdapter) != NULL && -+ GetFirstExtAdapter(pLoopAdapter) == pLoopAdapter) -+ pEntry = AsocEntry_EnumStation(pLoopAdapter, i); -+ else if (GetFirstGOPort(pLoopAdapter) != NULL && -+ IsFirstGoAdapter(pLoopAdapter)) -+ pEntry = AsocEntry_EnumStation(pLoopAdapter, i); -+ } else { -+ if (GetDefaultAdapter(pLoopAdapter) == pLoopAdapter) -+ pEntry = AsocEntry_EnumStation(pLoopAdapter, i); -+ } -+ -+ if (pEntry != NULL) { -+ if (pEntry->bAssociated) { -+ -+ RT_DISP_ADDR(FDM, DM_PWDB, ("pEntry->MacAddr ="), pEntry->MacAddr); -+ RT_DISP(FDM, DM_PWDB, ("pEntry->rssi = 0x%x(%d)\n", -+ pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->rssi_stat.UndecoratedSmoothedPWDB)); -+ -+ //2 BF_en -+#if (BEAMFORMING_SUPPORT) -+ Beamform_cap = phydm_Beamforming_GetEntryBeamCapByMacId(pDM_Odm, pEntry->AssociatedMacId); -+ if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) -+ TxBF_EN = 1; -+#endif -+ //2 STBC_en -+ if ((IS_WIRELESS_MODE_AC(Adapter) && TEST_FLAG(pEntry->VHTInfo.STBC, STBC_VHT_ENABLE_TX)) || -+ TEST_FLAG(pEntry->HTInfo.STBC, STBC_HT_ENABLE_TX)) -+ stbc_en = 1; -+ -+ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB) -+ tmpEntryMinPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; -+ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB) -+ tmpEntryMaxPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ if (bExtRAInfo) { -+ if (curRxOkCnt > (curTxOkCnt * 6)) -+ H2C_Parameter[3] |= RAINFO_BE_RX_STATE; -+ -+ if (TxBF_EN) -+ H2C_Parameter[3] |= RAINFO_BF_STATE; -+ else { -+ if (stbc_en) -+ H2C_Parameter[3] |= RAINFO_STBC_STATE; -+ } -+ -+ if ( pDM_Odm->NoisyDecision ) -+ { -+ H2C_Parameter[3] |= RAINFO_NOISY_STATE; // BIT2 -+ } -+ else -+ H2C_Parameter[3] &= (~RAINFO_NOISY_STATE); -+ -+ if (pDM_Odm->H2C_RARpt_connect) -+ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; -+ } -+ -+ H2C_Parameter[2] = (u1Byte)(pEntry->rssi_stat.UndecoratedSmoothedPWDB & 0xFF); -+ //H2C_Parameter[1] = 0x20; // fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1 -+ H2C_Parameter[0] = (pEntry->AssociatedMacId); -+ -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); -+ } -+ } else -+ break; -+ } -+ -+ pLoopAdapter = GetNextExtAdapter(pLoopAdapter); -+ } -+ -+ if (tmpEntryMaxPWDB != 0) { // If associated entry is found -+ pHalData->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB; -+ RT_DISP(FDM, DM_PWDB, ("EntryMaxPWDB = 0x%x(%d)\n", tmpEntryMaxPWDB, tmpEntryMaxPWDB)); -+ } else -+ pHalData->EntryMaxUndecoratedSmoothedPWDB = 0; -+ -+ if (tmpEntryMinPWDB != 0xff) { // If associated entry is found -+ pHalData->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB; -+ RT_DISP(FDM, DM_PWDB, ("EntryMinPWDB = 0x%x(%d)\n", tmpEntryMinPWDB, tmpEntryMinPWDB)); -+ -+ } else -+ pHalData->EntryMinUndecoratedSmoothedPWDB = 0; -+ -+ // Indicate Rx signal strength to FW. -+ if (pHalData->bUseRAMask) { -+ PRT_HIGH_THROUGHPUT pHTInfo = GET_HT_INFO(pDefaultMgntInfo); -+ PRT_VERY_HIGH_THROUGHPUT pVHTInfo = GET_VHT_INFO(pDefaultMgntInfo); -+ -+ //2 BF_en -+#if (BEAMFORMING_SUPPORT == 1) -+ Beamform_cap = phydm_Beamforming_GetEntryBeamCapByMacId(pDM_Odm, pDefaultMgntInfo->mMacId); -+ -+ if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) -+ TxBF_EN = 1; -+#endif -+ -+ //2 STBC_en -+ if ((IS_WIRELESS_MODE_AC(Adapter) && TEST_FLAG(pVHTInfo->VhtCurStbc, STBC_VHT_ENABLE_TX)) || -+ TEST_FLAG(pHTInfo->HtCurStbc, STBC_HT_ENABLE_TX)) -+ stbc_en = 1; -+ -+ if (bExtRAInfo) { -+ if (TxBF_EN) -+ H2C_Parameter[3] |= RAINFO_BF_STATE; -+ else { -+ if (stbc_en) -+ H2C_Parameter[3] |= RAINFO_STBC_STATE; -+ } -+ -+ if (pDM_Odm->H2C_RARpt_connect) -+ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; -+ -+ if ( pDM_Odm->NoisyDecision==1 ) -+ { -+ H2C_Parameter[3] |= RAINFO_NOISY_STATE; // BIT2 -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, ("[RSSIMonitorCheckMP] Send H2C to FW\n")); -+ } -+ else -+ H2C_Parameter[3] &= (~RAINFO_NOISY_STATE); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, ("[RSSIMonitorCheckMP] H2C_Parameter=%x\n", H2C_Parameter[3])); -+ } -+ -+ H2C_Parameter[2] = (u1Byte)(pHalData->UndecoratedSmoothedPWDB & 0xFF); -+ //H2C_Parameter[1] = 0x20; // fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1 -+ H2C_Parameter[0] = 0; // fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1 -+ -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); -+ -+ // BT 3.0 HS mode Rssi -+ if (pDM_Odm->bBtHsOperation) { -+ H2C_Parameter[2] = pDM_Odm->btHsRssi; -+ //H2C_Parameter[1] = 0x0; -+ H2C_Parameter[0] = 2; -+ -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); -+ } -+ } else -+ PlatformEFIOWrite1Byte(Adapter, 0x4fe, (u1Byte)pHalData->UndecoratedSmoothedPWDB); -+ -+ if ((pDM_Odm->SupportICType == ODM_RTL8812) || (pDM_Odm->SupportICType == ODM_RTL8192E)) -+ odm_RSSIDumpToRegister(pDM_Odm); -+ -+ -+ { -+ PADAPTER pLoopAdapter = GetDefaultAdapter(Adapter); -+ BOOLEAN default_pointer_value, *pbLink_temp = &default_pointer_value; -+ s4Byte GlobalRSSI_min = 0xFF, LocalRSSI_Min; -+ BOOLEAN bLink = FALSE; -+ -+ while (pLoopAdapter) { -+ LocalRSSI_Min = phydm_FindMinimumRSSI(pDM_Odm, pLoopAdapter, pbLink_temp); -+ //DbgPrint("pHalData->bLinked=%d, LocalRSSI_Min=%d\n", pHalData->bLinked, LocalRSSI_Min); -+ if ((LocalRSSI_Min < GlobalRSSI_min) && (LocalRSSI_Min != 0)) -+ GlobalRSSI_min = LocalRSSI_Min; -+ -+ if (*pbLink_temp) -+ bLink = TRUE; -+ -+ pLoopAdapter = GetNextExtAdapter(pLoopAdapter); -+ } -+ -+ pHalData->bLinked = bLink; -+ ODM_CmnInfoUpdate(&pHalData->DM_OutSrc , ODM_CMNINFO_LINK, (u8Byte)bLink); -+ -+ if (bLink) -+ ODM_CmnInfoUpdate(&pHalData->DM_OutSrc, ODM_CMNINFO_RSSI_MIN, (u8Byte)GlobalRSSI_min); -+ else -+ ODM_CmnInfoUpdate(&pHalData->DM_OutSrc, ODM_CMNINFO_RSSI_MIN, 0); -+ -+ } -+ -+#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+} -+ -+VOID -+odm_RSSIMonitorCheckCE( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ int i; -+ int tmpEntryMaxPWDB = 0, tmpEntryMinPWDB = 0xff; -+ u8 sta_cnt = 0; -+ u32 UL_DL_STATE = 0, STBC_TX = 0, TxBF_EN = 0 ,NoiseState = 0; -+ u32 PWDB_rssi[NUM_STA] = {0}; //[0~15]:MACID, [16~31]:PWDB_rssi -+ BOOLEAN FirstConnect = FALSE; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ if (pDM_Odm->bLinked != _TRUE) -+ return; -+ -+#if((RTL8812A_SUPPORT==1)||(RTL8821A_SUPPORT==1)) -+ if ((pDM_Odm->SupportICType == ODM_RTL8812) || (pDM_Odm->SupportICType == ODM_RTL8821)) { -+ u64 curTxOkCnt = pdvobjpriv->traffic_stat.cur_tx_bytes; -+ u64 curRxOkCnt = pdvobjpriv->traffic_stat.cur_rx_bytes; -+ -+ if (curRxOkCnt > (curTxOkCnt * 6)) -+ UL_DL_STATE = 1; -+ else -+ UL_DL_STATE = 0; -+ } -+#endif -+ -+ FirstConnect = (pDM_Odm->bLinked) && (pRA_Table->firstconnect == FALSE); -+ pRA_Table->firstconnect = pDM_Odm->bLinked; -+ -+ if ( pDM_Odm->NoisyDecision ){ -+ NoiseState = 1; /* BIT2*/ -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,( "[RSSIMonitorCheckMP] Send H2C to FW\n")); -+ } -+ else -+ NoiseState = 0; -+ -+ -+ //if(check_fwstate(&Adapter->mlmepriv, WIFI_AP_STATE|WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE) == _TRUE) -+ { -+ struct sta_info *psta; -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ if (IS_STA_VALID(psta = pDM_Odm->pODM_StaInfo[i])) { -+ if (IS_MCAST(psta->hwaddr)) //if(psta->mac_id ==1) -+ continue; -+ -+ if (psta->rssi_stat.UndecoratedSmoothedPWDB == (-1)) -+ continue; -+ -+ if (psta->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB) -+ tmpEntryMinPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ if (psta->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB) -+ tmpEntryMaxPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB; -+ -+#if 0 -+ DBG_871X("%s mac_id:%u, mac:"MAC_FMT", rssi:%d\n", __func__, -+ psta->mac_id, MAC_ARG(psta->hwaddr), psta->rssi_stat.UndecoratedSmoothedPWDB); -+#endif -+ -+ if (psta->rssi_stat.UndecoratedSmoothedPWDB != (-1)) { -+ -+ /*if (pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8812) */ -+ { -+#ifdef CONFIG_BEAMFORMING -+ #if (BEAMFORMING_SUPPORT == 1) -+ BEAMFORMING_CAP Beamform_cap = phydm_Beamforming_GetEntryBeamCapByMacId(pDM_Odm, psta->mac_id); -+ #else/*for drv beamforming*/ -+ BEAMFORMING_CAP Beamform_cap = beamforming_get_entry_beam_cap_by_mac_id(&Adapter->mlmepriv, psta->mac_id); -+ #endif -+ if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) -+ TxBF_EN = 1; -+ else -+ TxBF_EN = 0; -+#endif /*#ifdef CONFIG_BEAMFORMING*/ -+ -+ if (TxBF_EN) -+ STBC_TX = 0; -+ else -+ { -+#ifdef CONFIG_80211AC_VHT -+ if (IsSupportedVHT(psta->wireless_mode)) -+ STBC_TX = TEST_FLAG(psta->vhtpriv.stbc_cap, STBC_VHT_ENABLE_TX); -+ else -+#endif -+ STBC_TX = TEST_FLAG(psta->htpriv.stbc_cap, STBC_HT_ENABLE_TX); -+ } -+ } -+ -+ -+ if ((pDM_Odm->SupportICType == ODM_RTL8192E) -+ || (pDM_Odm->SupportICType == ODM_RTL8812) || (pDM_Odm->SupportICType == ODM_RTL8821) -+ || (pDM_Odm->SupportICType == ODM_RTL8814A) -+ || (pDM_Odm->SupportICType == ODM_RTL8822B) -+ -+ ) { -+ PWDB_rssi[sta_cnt++] = (((u8)(psta->mac_id & 0xFF)) | ((psta->rssi_stat.UndecoratedSmoothedPWDB & 0x7F) << 16) | (STBC_TX << 25) | (NoiseState<<26) | (FirstConnect << 29) | (TxBF_EN << 30)); -+ } -+ else -+ PWDB_rssi[sta_cnt++] = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB << 16) | (NoiseState<<26)); -+ -+ } -+ } -+ } -+ -+ //printk("%s==> sta_cnt(%d)\n",__FUNCTION__,sta_cnt); -+ -+ for (i = 0; i < sta_cnt; i++) { -+ if (PWDB_rssi[i] != (0)) { -+ if (pHalData->fw_ractrl == _TRUE) { // Report every sta's RSSI to FW -+#if((RTL8812A_SUPPORT==1)||(RTL8821A_SUPPORT==1)) -+ if ((pDM_Odm->SupportICType == ODM_RTL8812) || (pDM_Odm->SupportICType == ODM_RTL8821)) { -+ PWDB_rssi[i] |= (UL_DL_STATE << 24); -+ rtl8812_set_rssi_cmd(Adapter, (u8 *)(&PWDB_rssi[i])); -+ } -+#endif -+#if(RTL8192E_SUPPORT==1) -+ if (pDM_Odm->SupportICType == ODM_RTL8192E) -+ rtl8192e_set_rssi_cmd(Adapter, (u8 *)(&PWDB_rssi[i])); -+#endif -+#if(RTL8723B_SUPPORT==1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) -+ rtl8723b_set_rssi_cmd(Adapter, (u8 *)(&PWDB_rssi[i])); -+#endif -+ -+#if(RTL8188E_SUPPORT==1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ rtl8188e_set_rssi_cmd(Adapter, (u8 *)(&PWDB_rssi[i])); -+#endif -+ -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ rtl8814_set_rssi_cmd(Adapter, (u8 *)(&PWDB_rssi[i])); -+#endif -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ rtl8188f_set_rssi_cmd(Adapter, (u8 *)(&PWDB_rssi[i])); -+ } -+#endif -+ } else { -+#if((RTL8188E_SUPPORT==1)&&(RATE_ADAPTIVE_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+ ODM_RA_SetRSSI_8188E( -+ &(pHalData->odmpriv), (PWDB_rssi[i] & 0xFF), (u8)((PWDB_rssi[i] >> 16) & 0xFF)); -+ } -+#endif -+ } -+ } -+ } -+ } -+ -+ -+ -+ if (tmpEntryMaxPWDB != 0) // If associated entry is found -+ pHalData->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB; -+ else -+ pHalData->EntryMaxUndecoratedSmoothedPWDB = 0; -+ -+ if (tmpEntryMinPWDB != 0xff) // If associated entry is found -+ pHalData->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB; -+ else -+ pHalData->EntryMinUndecoratedSmoothedPWDB = 0; -+ -+ FindMinimumRSSI(Adapter);//get pdmpriv->MinUndecoratedPWDBForDM -+ -+ pDM_Odm->RSSI_Min = pHalData->MinUndecoratedPWDBForDM; -+ //ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM); -+#endif//if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+} -+ -+ -+VOID -+odm_RSSIMonitorCheckAP( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+#if (RTL8812A_SUPPORT||RTL8881A_SUPPORT||RTL8192E_SUPPORT||RTL8814A_SUPPORT) -+ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte H2C_Parameter[4] = {0}; -+ u4Byte i; -+ BOOLEAN bExtRAInfo = FALSE; -+ u1Byte cmdlen = 3 ; -+ u1Byte TxBF_EN = 0, stbc_en = 0; -+ -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ PSTA_INFO_T pstat; -+ BOOLEAN act_bfer = FALSE; -+ -+#ifdef BEAMFORMING_SUPPORT -+#if (defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; -+ pDM_BdcTable->num_Txbfee_Client = 0; -+ pDM_BdcTable->num_Txbfer_Client = 0; -+#endif -+#endif -+ -+ if (pDM_Odm->H2C_RARpt_connect) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[RA Init] First Connected\n")); -+ /**/ -+ } else if (priv->up_time % 2) -+ return; -+ -+ if (pDM_Odm->SupportICType & EXT_RA_INFO_SUPPORT_IC) { -+ bExtRAInfo = TRUE; -+ cmdlen = 4; -+ } -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ pstat = pDM_Odm->pODM_StaInfo[i]; -+ -+ if (IS_STA_VALID(pstat)) { -+ if (pstat->sta_in_firmware != 1) -+ continue; -+ -+ //2 BF_en -+#ifdef BEAMFORMING_SUPPORT -+ BEAMFORMING_CAP Beamform_cap = Beamforming_GetEntryBeamCapByMacId(priv, pstat->aid); -+ -+ if (Beamform_cap == BEAMFORMER_CAP_HT_EXPLICIT || Beamform_cap == BEAMFORMER_CAP_VHT_SU || -+ Beamform_cap == (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMEE_CAP_HT_EXPLICIT) || -+ Beamform_cap == (BEAMFORMER_CAP_VHT_SU | BEAMFORMEE_CAP_VHT_SU)) { -+ TxBF_EN = 1; -+ act_bfer = TRUE; -+ } -+ -+#if (defined(CONFIG_HW_ANTENNA_DIVERSITY)) //BDC -+ -+ if (act_bfer == TRUE) { -+ pDM_BdcTable->w_BFee_Client[i] = 1; //AP act as BFer -+ pDM_BdcTable->num_Txbfee_Client++; -+ } else { -+ pDM_BdcTable->w_BFee_Client[i] = 0; //AP act as BFer -+ } -+ -+ if ((Beamform_cap & BEAMFORMEE_CAP_HT_EXPLICIT) || (Beamform_cap & BEAMFORMEE_CAP_VHT_SU)) { -+ pDM_BdcTable->w_BFer_Client[i] = 1; //AP act as BFee -+ pDM_BdcTable->num_Txbfer_Client++; -+ } else { -+ pDM_BdcTable->w_BFer_Client[i] = 0; //AP act as BFer -+ } -+#endif -+#endif -+ -+ //2 STBC_en -+ if ((priv->pmib->dot11nConfigEntry.dot11nSTBC) && -+ ((pstat->ht_cap_buf.ht_cap_info & cpu_to_le16(_HTCAP_RX_STBC_CAP_)) -+#ifdef RTK_AC_SUPPORT -+ || (pstat->vht_cap_buf.vht_cap_info & cpu_to_le32(_VHTCAP_RX_STBC_CAP_)) -+#endif -+ )) -+ stbc_en = 1; -+ -+ //2 RAINFO -+ -+ if (bExtRAInfo) { -+ if ((pstat->rx_avarage) > ((pstat->tx_avarage) * 6)) -+ H2C_Parameter[3] |= RAINFO_BE_RX_STATE; -+ -+ if (TxBF_EN) -+ H2C_Parameter[3] |= RAINFO_BF_STATE; -+ else { -+ if (stbc_en) -+ H2C_Parameter[3] |= RAINFO_STBC_STATE; -+ } -+ -+ if ( pDM_Odm->NoisyDecision ) -+ { -+ H2C_Parameter[3] |= RAINFO_NOISY_STATE; // BIT2 -+ } -+ else -+ H2C_Parameter[3] &= (~RAINFO_NOISY_STATE); -+ -+ if (pDM_Odm->H2C_RARpt_connect) { -+ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[RA Init] set Init rate by RSSI\n")); -+ } -+ -+ /*ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[RAINFO] H2C_Para[3] = %x\n",H2C_Parameter[3]));*/ -+ } -+ -+ H2C_Parameter[2] = (u1Byte)(pstat->rssi & 0xFF); -+ H2C_Parameter[0] = REMAP_AID(pstat); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("H2C_Parameter[3]=%d\n", H2C_Parameter[3])); -+ -+ //ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[RSSI] H2C_Para[2] = %x, \n",H2C_Parameter[2])); -+ //ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[MACID] H2C_Para[0] = %x, \n",H2C_Parameter[0])); -+ -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); -+ -+ } -+ } -+ -+#endif -+#endif -+ -+} -+ -+ -+VOID -+odm_RateAdaptiveMaskInit( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_RATE_ADAPTIVE pOdmRA = &pDM_Odm->RateAdaptive; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMGNT_INFO pMgntInfo = &pDM_Odm->Adapter->MgntInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pDM_Odm->Adapter); -+ -+ pMgntInfo->Ratr_State = DM_RATR_STA_INIT; -+ -+ if (pMgntInfo->DM_Type == DM_Type_ByDriver) -+ pHalData->bUseRAMask = TRUE; -+ else -+ pHalData->bUseRAMask = FALSE; -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ pOdmRA->Type = DM_Type_ByDriver; -+ if (pOdmRA->Type == DM_Type_ByDriver) -+ pDM_Odm->bUseRAMask = _TRUE; -+ else -+ pDM_Odm->bUseRAMask = _FALSE; -+#endif -+ -+ pOdmRA->RATRState = DM_RATR_STA_INIT; -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ pOdmRA->LdpcThres = 50; -+ else -+ pOdmRA->LdpcThres = 35; -+ -+ pOdmRA->RtsThres = 35; -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ pOdmRA->LdpcThres = 35; -+ pOdmRA->bUseLdpc = FALSE; -+ -+#else -+ pOdmRA->UltraLowRSSIThresh = 9; -+ -+#endif -+ -+ pOdmRA->HighRSSIThresh = 50; -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && \ -+ ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+ pOdmRA->LowRSSIThresh = 23; -+#else -+ pOdmRA->LowRSSIThresh = 20; -+#endif -+} -+/*----------------------------------------------------------------------------- -+ * Function: odm_RefreshRateAdaptiveMask() -+ * -+ * Overview: Update rate table mask according to rssi -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 05/27/2009 hpfan Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+VOID -+odm_RefreshRateAdaptiveMask( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("odm_RefreshRateAdaptiveMask()---------->\n")); -+ if (!(pDM_Odm->SupportAbility & ODM_BB_RA_MASK)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("odm_RefreshRateAdaptiveMask(): Return cos not supported\n")); -+ return; -+ } -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ switch (pDM_Odm->SupportPlatform) { -+ case ODM_WIN: -+ odm_RefreshRateAdaptiveMaskMP(pDM_Odm); -+ break; -+ -+ case ODM_CE: -+ odm_RefreshRateAdaptiveMaskCE(pDM_Odm); -+ break; -+ -+ case ODM_AP: -+ case ODM_ADSL: -+ odm_RefreshRateAdaptiveMaskAPADSL(pDM_Odm); -+ break; -+ } -+ -+} -+ -+VOID -+odm_RefreshRateAdaptiveMaskMP( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ PADAPTER pTargetAdapter = NULL; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMGNT_INFO pMgntInfo = GetDefaultMgntInfo(pAdapter); -+ -+ if (pAdapter->bDriverStopped) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_RefreshRateAdaptiveMask(): driver is going to unload\n")); -+ return; -+ } -+ -+ if (!pHalData->bUseRAMask) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_RefreshRateAdaptiveMask(): driver does not control rate adaptive mask\n")); -+ return; -+ } -+ -+ // if default port is connected, update RA table for default port (infrastructure mode only) -+ if (pMgntInfo->mAssoc && (!ACTING_AS_AP(pAdapter))) { -+ odm_RefreshLdpcRtsMP(pAdapter, pDM_Odm, pMgntInfo->mMacId, pMgntInfo->IOTPeer, pHalData->UndecoratedSmoothedPWDB); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_RefreshRateAdaptiveMask(): Infrasture Mode\n")); -+ if (ODM_RAStateCheck(pDM_Odm, pHalData->UndecoratedSmoothedPWDB, pMgntInfo->bSetTXPowerTrainingByOid, &pMgntInfo->Ratr_State)) { -+ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr : "), pMgntInfo->Bssid); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pHalData->UndecoratedSmoothedPWDB, pMgntInfo->Ratr_State)); -+ pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, pMgntInfo->Ratr_State); -+ } else if (pDM_Odm->bChangeState) { -+ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr : "), pMgntInfo->Bssid); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training State, bDisablePowerTraining = %d\n", pDM_Odm->bDisablePowerTraining)); -+ pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, pMgntInfo->Ratr_State); -+ } -+ } -+ -+ // -+ // The following part configure AP/VWifi/IBSS rate adaptive mask. -+ // -+ -+ if (pMgntInfo->mIbss) // Target: AP/IBSS peer. -+ pTargetAdapter = GetDefaultAdapter(pAdapter); -+ else -+ pTargetAdapter = GetFirstAPAdapter(pAdapter); -+ -+ // if extension port (softap) is started, updaet RA table for more than one clients associate -+ if (pTargetAdapter != NULL) { -+ int i; -+ PRT_WLAN_STA pEntry; -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ pEntry = AsocEntry_EnumStation(pTargetAdapter, i); -+ if (NULL != pEntry) { -+ if (pEntry->bAssociated) { -+ odm_RefreshLdpcRtsMP(pAdapter, pDM_Odm, pEntry->AssociatedMacId, pEntry->IOTPeer, pEntry->rssi_stat.UndecoratedSmoothedPWDB); -+ -+ if (ODM_RAStateCheck(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, pMgntInfo->bSetTXPowerTrainingByOid, &pEntry->Ratr_State)) { -+ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target STA addr : "), pEntry->MacAddr); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->Ratr_State)); -+ pAdapter->HalFunc.UpdateHalRAMaskHandler(pTargetAdapter, pEntry->AssociatedMacId, pEntry, pEntry->Ratr_State); -+ } else if (pDM_Odm->bChangeState) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training State, bDisablePowerTraining = %d\n", pDM_Odm->bDisablePowerTraining)); -+ pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, pMgntInfo->Ratr_State); -+ } -+ } -+ } -+ } -+ } -+ -+ if (pMgntInfo->bSetTXPowerTrainingByOid) -+ pMgntInfo->bSetTXPowerTrainingByOid = FALSE; -+#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+} -+ -+ -+VOID -+odm_RefreshRateAdaptiveMaskCE( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; -+ -+ if (RTW_CANNOT_RUN(pAdapter)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_RefreshRateAdaptiveMask(): driver is going to unload\n")); -+ return; -+ } -+ -+ if (!pDM_Odm->bUseRAMask) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_RefreshRateAdaptiveMask(): driver does not control rate adaptive mask\n")); -+ return; -+ } -+ -+ //printk("==> %s \n",__FUNCTION__); -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ PSTA_INFO_T pstat = pDM_Odm->pODM_StaInfo[i]; -+ if (IS_STA_VALID(pstat)) { -+ if (IS_MCAST(pstat->hwaddr)) //if(psta->mac_id ==1) -+ continue; -+ if (IS_MCAST(pstat->hwaddr)) -+ continue; -+ -+#if((RTL8812A_SUPPORT==1)||(RTL8821A_SUPPORT==1)) -+ if ((pDM_Odm->SupportICType == ODM_RTL8812) || (pDM_Odm->SupportICType == ODM_RTL8821)) { -+ if (pstat->rssi_stat.UndecoratedSmoothedPWDB < pRA->LdpcThres) { -+ pRA->bUseLdpc = TRUE; -+ pRA->bLowerRtsRate = TRUE; -+ if ((pDM_Odm->SupportICType == ODM_RTL8821) && (pDM_Odm->CutVersion == ODM_CUT_A)) -+ Set_RA_LDPC_8812(pstat, TRUE); -+ //DbgPrint("RSSI=%d, bUseLdpc = TRUE\n", pHalData->UndecoratedSmoothedPWDB); -+ } else if (pstat->rssi_stat.UndecoratedSmoothedPWDB > (pRA->LdpcThres - 5)) { -+ pRA->bUseLdpc = FALSE; -+ pRA->bLowerRtsRate = FALSE; -+ if ((pDM_Odm->SupportICType == ODM_RTL8821) && (pDM_Odm->CutVersion == ODM_CUT_A)) -+ Set_RA_LDPC_8812(pstat, FALSE); -+ //DbgPrint("RSSI=%d, bUseLdpc = FALSE\n", pHalData->UndecoratedSmoothedPWDB); -+ } -+ } -+#endif -+ -+ if (TRUE == ODM_RAStateCheck(pDM_Odm, pstat->rssi_stat.UndecoratedSmoothedPWDB, FALSE , &pstat->rssi_level)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pstat->rssi_stat.UndecoratedSmoothedPWDB, pstat->rssi_level)); -+ //printk("RSSI:%d, RSSI_LEVEL:%d\n", pstat->rssi_stat.UndecoratedSmoothedPWDB, pstat->rssi_level); -+ rtw_hal_update_ra_mask(pstat, pstat->rssi_level); -+ } else if (pDM_Odm->bChangeState) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training State, bDisablePowerTraining = %d\n", pDM_Odm->bDisablePowerTraining)); -+ rtw_hal_update_ra_mask(pstat, pstat->rssi_level); -+ } -+ -+ } -+ } -+ -+#endif -+} -+ -+VOID -+odm_RefreshRateAdaptiveMaskAPADSL( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ struct rtl8192cd_priv *priv = pDM_Odm->priv; -+ struct aid_obj *aidarray; -+ u4Byte i; -+ PSTA_INFO_T pstat; -+ -+ if (priv->up_time % 2) -+ return; -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ pstat = pDM_Odm->pODM_StaInfo[i]; -+ -+ if (IS_STA_VALID(pstat)) { -+#if defined(UNIVERSAL_REPEATER) || defined(MBSSID) -+ aidarray = container_of(pstat, struct aid_obj, station); -+ priv = aidarray->priv; -+#endif -+ -+ if (!priv->pmib->dot11StationConfigEntry.autoRate) -+ continue; -+ -+ if (ODM_RAStateCheck(pDM_Odm, (s4Byte)pstat->rssi, FALSE, &pstat->rssi_level)) { -+ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target STA addr : "), pstat->hwaddr); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pstat->rssi, pstat->rssi_level)); -+ -+#ifdef CONFIG_WLAN_HAL -+ if (IS_HAL_CHIP(priv)) { -+#ifdef WDS -+// if(!(pstat->state & WIFI_WDS))//if WDS donot setting -+#endif -+ GET_HAL_INTERFACE(priv)->UpdateHalRAMaskHandler(priv, pstat, pstat->rssi_level); -+ } else -+#endif -+#ifdef CONFIG_RTL_8812_SUPPORT -+ if (GET_CHIP_VER(priv) == VERSION_8812E) -+ UpdateHalRAMask8812(priv, pstat, 3); -+ else -+#endif -+#ifdef CONFIG_RTL_88E_SUPPORT -+ if (GET_CHIP_VER(priv) == VERSION_8188E) { -+#ifdef TXREPORT -+ add_RATid(priv, pstat); -+#endif -+ } else -+#endif -+ { -+#if defined(CONFIG_RTL_92D_SUPPORT) || defined(CONFIG_RTL_92C_SUPPORT) -+ add_update_RATid(priv, pstat); -+#endif -+ } -+ } -+ } -+ } -+#endif -+} -+ -+ -+// Return Value: BOOLEAN -+// - TRUE: RATRState is changed. -+BOOLEAN -+ODM_RAStateCheck( -+ IN PVOID pDM_VOID, -+ IN s4Byte RSSI, -+ IN BOOLEAN bForceUpdate, -+ OUT pu1Byte pRATRState -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; -+ const u1Byte GoUpGap = 5; -+ u1Byte HighRSSIThreshForRA = pRA->HighRSSIThresh; -+ u1Byte LowRSSIThreshForRA = pRA->LowRSSIThresh; -+ u1Byte RATRState; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI= (( %d )), Current_RSSI_level = (( %d ))\n", RSSI, *pRATRState)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[Ori RA RSSI Thresh] High= (( %d )), Low = (( %d ))\n", HighRSSIThreshForRA, LowRSSIThreshForRA)); -+ // Threshold Adjustment: -+ // when RSSI state trends to go up one or two levels, make sure RSSI is high enough. -+ // Here GoUpGap is added to solve the boundary's level alternation issue. -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ u1Byte UltraLowRSSIThreshForRA = pRA->UltraLowRSSIThresh; -+ if (pDM_Odm->SupportICType == ODM_RTL8881A) -+ LowRSSIThreshForRA = 30; // for LDPC / BCC switch -+#endif -+ -+ switch (*pRATRState) { -+ case DM_RATR_STA_INIT: -+ case DM_RATR_STA_HIGH: -+ break; -+ -+ case DM_RATR_STA_MIDDLE: -+ HighRSSIThreshForRA += GoUpGap; -+ break; -+ -+ case DM_RATR_STA_LOW: -+ HighRSSIThreshForRA += GoUpGap; -+ LowRSSIThreshForRA += GoUpGap; -+ break; -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ case DM_RATR_STA_ULTRA_LOW: -+ HighRSSIThreshForRA += GoUpGap; -+ LowRSSIThreshForRA += GoUpGap; -+ UltraLowRSSIThreshForRA += GoUpGap; -+ break; -+#endif -+ -+ default: -+ ODM_RT_ASSERT(pDM_Odm, FALSE, ("wrong rssi level setting %d !", *pRATRState)); -+ break; -+ } -+ -+ // Decide RATRState by RSSI. -+ if (RSSI > HighRSSIThreshForRA) -+ RATRState = DM_RATR_STA_HIGH; -+ else if (RSSI > LowRSSIThreshForRA) -+ RATRState = DM_RATR_STA_MIDDLE; -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ else if (RSSI > UltraLowRSSIThreshForRA) -+ RATRState = DM_RATR_STA_LOW; -+ else -+ RATRState = DM_RATR_STA_ULTRA_LOW; -+#else -+ else -+ RATRState = DM_RATR_STA_LOW; -+#endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[Mod RA RSSI Thresh] High= (( %d )), Low = (( %d ))\n", HighRSSIThreshForRA, LowRSSIThreshForRA)); -+ /*printk("==>%s,RATRState:0x%02x ,RSSI:%d\n",__FUNCTION__,RATRState,RSSI);*/ -+ -+ if (*pRATRState != RATRState || bForceUpdate) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[RSSI Level Update] %d -> %d\n", *pRATRState, RATRState)); -+ *pRATRState = RATRState; -+ return TRUE; -+ } -+ -+ return FALSE; -+} -+ -+VOID -+odm_RefreshBasicRateMask( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ static u1Byte Stage = 0; -+ u1Byte CurStage = 0; -+ OCTET_STRING osRateSet; -+ PMGNT_INFO pMgntInfo = GetDefaultMgntInfo(Adapter); -+ u1Byte RateSet[5] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M, MGN_6M}; -+ -+ if (pDM_Odm->SupportICType != ODM_RTL8812 && pDM_Odm->SupportICType != ODM_RTL8821) -+ return; -+ -+ if (pDM_Odm->bLinked == FALSE) // unlink Default port information -+ CurStage = 0; -+ else if (pDM_Odm->RSSI_Min < 40) // link RSSI < 40% -+ CurStage = 1; -+ else if (pDM_Odm->RSSI_Min > 45) // link RSSI > 45% -+ CurStage = 3; -+ else -+ CurStage = 2; // link 25% <= RSSI <= 30% -+ -+ if (CurStage != Stage) { -+ if (CurStage == 1) { -+ FillOctetString(osRateSet, RateSet, 5); -+ FilterSupportRate(pMgntInfo->mBrates, &osRateSet, FALSE); -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_BASIC_RATE, (pu1Byte)&osRateSet); -+ } else if (CurStage == 3 && (Stage == 1 || Stage == 2)) -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_BASIC_RATE, (pu1Byte)(&pMgntInfo->mBrates)); -+ } -+ -+ Stage = CurStage; -+#endif -+} -+ -+ -+VOID -+phydm_ra_info_init( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ #if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) -+ phydm_ra_dynamic_retry_limit_init(pDM_Odm); -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ phydm_ra_dynamic_rate_id_init(pDM_Odm); -+ #endif -+ -+ /*phydm_fw_trace_en_h2c(pDM_Odm, 1, 0, 0);*/ -+} -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+u1Byte -+odm_Find_RTS_Rate( -+ IN PVOID pDM_VOID, -+ IN u1Byte Tx_Rate, -+ IN BOOLEAN bErpProtect -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte RTS_Ini_Rate = ODM_RATE6M; -+ -+ if (bErpProtect) /* use CCK rate as RTS*/ -+ RTS_Ini_Rate = ODM_RATE1M; -+ else { -+ switch (Tx_Rate) { -+ case ODM_RATEVHTSS3MCS9: -+ case ODM_RATEVHTSS3MCS8: -+ case ODM_RATEVHTSS3MCS7: -+ case ODM_RATEVHTSS3MCS6: -+ case ODM_RATEVHTSS3MCS5: -+ case ODM_RATEVHTSS3MCS4: -+ case ODM_RATEVHTSS3MCS3: -+ case ODM_RATEVHTSS2MCS9: -+ case ODM_RATEVHTSS2MCS8: -+ case ODM_RATEVHTSS2MCS7: -+ case ODM_RATEVHTSS2MCS6: -+ case ODM_RATEVHTSS2MCS5: -+ case ODM_RATEVHTSS2MCS4: -+ case ODM_RATEVHTSS2MCS3: -+ case ODM_RATEVHTSS1MCS9: -+ case ODM_RATEVHTSS1MCS8: -+ case ODM_RATEVHTSS1MCS7: -+ case ODM_RATEVHTSS1MCS6: -+ case ODM_RATEVHTSS1MCS5: -+ case ODM_RATEVHTSS1MCS4: -+ case ODM_RATEVHTSS1MCS3: -+ case ODM_RATEMCS15: -+ case ODM_RATEMCS14: -+ case ODM_RATEMCS13: -+ case ODM_RATEMCS12: -+ case ODM_RATEMCS11: -+ case ODM_RATEMCS7: -+ case ODM_RATEMCS6: -+ case ODM_RATEMCS5: -+ case ODM_RATEMCS4: -+ case ODM_RATEMCS3: -+ case ODM_RATE54M: -+ case ODM_RATE48M: -+ case ODM_RATE36M: -+ case ODM_RATE24M: -+ RTS_Ini_Rate = ODM_RATE24M; -+ break; -+ case ODM_RATEVHTSS3MCS2: -+ case ODM_RATEVHTSS3MCS1: -+ case ODM_RATEVHTSS2MCS2: -+ case ODM_RATEVHTSS2MCS1: -+ case ODM_RATEVHTSS1MCS2: -+ case ODM_RATEVHTSS1MCS1: -+ case ODM_RATEMCS10: -+ case ODM_RATEMCS9: -+ case ODM_RATEMCS2: -+ case ODM_RATEMCS1: -+ case ODM_RATE18M: -+ case ODM_RATE12M: -+ RTS_Ini_Rate = ODM_RATE12M; -+ break; -+ case ODM_RATEVHTSS3MCS0: -+ case ODM_RATEVHTSS2MCS0: -+ case ODM_RATEVHTSS1MCS0: -+ case ODM_RATEMCS8: -+ case ODM_RATEMCS0: -+ case ODM_RATE9M: -+ case ODM_RATE6M: -+ RTS_Ini_Rate = ODM_RATE6M; -+ break; -+ case ODM_RATE11M: -+ case ODM_RATE5_5M: -+ case ODM_RATE2M: -+ case ODM_RATE1M: -+ RTS_Ini_Rate = ODM_RATE1M; -+ break; -+ default: -+ RTS_Ini_Rate = ODM_RATE6M; -+ break; -+ } -+ } -+ -+ if (*pDM_Odm->pBandType == 1) { -+ if (RTS_Ini_Rate < ODM_RATE6M) -+ RTS_Ini_Rate = ODM_RATE6M; -+ } -+ return RTS_Ini_Rate; -+ -+} -+ -+VOID -+odm_Set_RA_DM_ARFB_by_Noisy( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ /*DbgPrint("DM_ARFB ====>\n");*/ -+ if (pDM_Odm->bNoisyState) { -+ ODM_Write4Byte(pDM_Odm, 0x430, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0x434, 0x05040200); -+ /*DbgPrint("DM_ARFB ====> Noisy State\n");*/ -+ } else { -+ ODM_Write4Byte(pDM_Odm, 0x430, 0x02010000); -+ ODM_Write4Byte(pDM_Odm, 0x434, 0x07050403); -+ /*DbgPrint("DM_ARFB ====> Clean State\n");*/ -+ } -+ -+} -+ -+VOID -+ODM_UpdateNoisyState( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN bNoisyStateFromC2H -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /*DbgPrint("Get C2H Command! NoisyState=0x%x\n ", bNoisyStateFromC2H);*/ -+ if (pDM_Odm->SupportICType == ODM_RTL8821 || pDM_Odm->SupportICType == ODM_RTL8812 || -+ pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8188E) -+ pDM_Odm->bNoisyState = bNoisyStateFromC2H; -+ odm_Set_RA_DM_ARFB_by_Noisy(pDM_Odm); -+}; -+ -+u4Byte -+Set_RA_DM_Ratrbitmap_by_Noisy( -+ IN PVOID pDM_VOID, -+ IN WIRELESS_MODE WirelessMode, -+ IN u4Byte ratr_bitmap, -+ IN u1Byte rssi_level -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte ret_bitmap = ratr_bitmap; -+ -+ return ret_bitmap; -+ -+ switch (WirelessMode) { -+ case WIRELESS_MODE_AC_24G: -+ case WIRELESS_MODE_AC_5G: -+ case WIRELESS_MODE_AC_ONLY: -+ if (pDM_Odm->bNoisyState) { /*in Noisy State*/ -+ if (rssi_level == 1) -+ ret_bitmap &= 0xfc3e0c08; // Reserve MCS 5-9 -+ else if (rssi_level == 2) -+ ret_bitmap &= 0xfe3f8e08; // Reserve MCS 3-9 -+ else if (rssi_level == 3) -+ ret_bitmap &= 0xffffffff; -+ else -+ ret_bitmap &= 0xffffffff; -+ } else { /* in SNR State*/ -+ if (rssi_level == 1) -+ ret_bitmap &= 0xfe3f0e08; // Reserve MCS 4-9 -+ else if (rssi_level == 2) -+ ret_bitmap &= 0xff3fcf8c; // Reserve MCS 2-9 -+ else if (rssi_level == 3) -+ ret_bitmap &= 0xffffffff; -+ else -+ ret_bitmap &= 0xffffffff; -+ } -+ break; -+ case WIRELESS_MODE_B: -+ case WIRELESS_MODE_A: -+ case WIRELESS_MODE_G: -+ case WIRELESS_MODE_N_24G: -+ case WIRELESS_MODE_N_5G: -+ if (pDM_Odm->bNoisyState) { -+ if (rssi_level == 1) -+ ret_bitmap &= 0x0f0e0c08; // Reserve MCS 4-7; MCS12-15 -+ else if (rssi_level == 2) -+ ret_bitmap &= 0x0fcfce0c; // Reserve MCS 2-7; MCS10-15 -+ else if (rssi_level == 3) -+ ret_bitmap &= 0xffffffff; -+ else -+ ret_bitmap &= 0xffffffff; -+ } else { -+ if (rssi_level == 1) -+ ret_bitmap &= 0x0f8f8e08; // Reserve MCS 3-7; MCS11-15 -+ else if (rssi_level == 2) -+ ret_bitmap &= 0x0fefef8c; // Reserve MCS 1-7; MCS9-15 -+ else if (rssi_level == 3) -+ ret_bitmap &= 0xffffffff; -+ else -+ ret_bitmap &= 0xffffffff; -+ } -+ break; -+ default: -+ break; -+ } -+ /*DbgPrint("DM_RAMask ====> rssi_LV = %d, BITMAP = %x\n", rssi_level, ret_bitmap);*/ -+ return ret_bitmap; -+ -+} -+ -+VOID -+ODM_UpdateInitRate( -+ IN PVOID pDM_VOID, -+ IN u1Byte Rate -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte p = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Get C2H Command! Rate=0x%x\n", Rate)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8821 || pDM_Odm->SupportICType == ODM_RTL8812 || -+ pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8188E -+ || pDM_Odm->SupportICType == ODM_RTL8703B) { -+ pDM_Odm->TxRate = Rate; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+#if USE_WORKITEM -+ PlatformScheduleWorkItem(&pDM_Odm->RaRptWorkitem); -+#else -+ if (pDM_Odm->SupportICType == ODM_RTL8821) { -+#if (RTL8821A_SUPPORT == 1) -+ ODM_TxPwrTrackSetPwr8821A(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); -+#endif -+ } else if (pDM_Odm->SupportICType == ODM_RTL8812) { -+ for (p = ODM_RF_PATH_A; p < MAX_PATH_NUM_8812A; p++) { -+#if (RTL8812A_SUPPORT == 1) -+ ODM_TxPwrTrackSetPwr8812A(pDM_Odm, MIX_MODE, p, 0); -+#endif -+ } -+ } else if (pDM_Odm->SupportICType == ODM_RTL8723B) { -+#if (RTL8723B_SUPPORT == 1) -+ ODM_TxPwrTrackSetPwr_8723B(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); -+#endif -+ } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { -+ for (p = ODM_RF_PATH_A; p < MAX_PATH_NUM_8192E; p++) { -+#if (RTL8192E_SUPPORT == 1) -+ ODM_TxPwrTrackSetPwr92E(pDM_Odm, MIX_MODE, p, 0); -+#endif -+ } -+ } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+#if (RTL8188E_SUPPORT == 1) -+ ODM_TxPwrTrackSetPwr88E(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); -+#endif -+ } -+#endif -+#else -+ PlatformScheduleWorkItem(&pDM_Odm->RaRptWorkitem); -+#endif -+#endif -+ } else -+ return; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+VOID -+odm_RSSIDumpToRegister( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8812) { -+ PlatformEFIOWrite1Byte(Adapter, rA_RSSIDump_Jaguar, Adapter->RxStats.RxRSSIPercentage[0]); -+ PlatformEFIOWrite1Byte(Adapter, rB_RSSIDump_Jaguar, Adapter->RxStats.RxRSSIPercentage[1]); -+ -+ /* Rx EVM*/ -+ PlatformEFIOWrite1Byte(Adapter, rS1_RXevmDump_Jaguar, Adapter->RxStats.RxEVMdbm[0]); -+ PlatformEFIOWrite1Byte(Adapter, rS2_RXevmDump_Jaguar, Adapter->RxStats.RxEVMdbm[1]); -+ -+ /* Rx SNR*/ -+ PlatformEFIOWrite1Byte(Adapter, rA_RXsnrDump_Jaguar, (u1Byte)(Adapter->RxStats.RxSNRdB[0])); -+ PlatformEFIOWrite1Byte(Adapter, rB_RXsnrDump_Jaguar, (u1Byte)(Adapter->RxStats.RxSNRdB[1])); -+ -+ /* Rx Cfo_Short*/ -+ PlatformEFIOWrite2Byte(Adapter, rA_CfoShortDump_Jaguar, Adapter->RxStats.RxCfoShort[0]); -+ PlatformEFIOWrite2Byte(Adapter, rB_CfoShortDump_Jaguar, Adapter->RxStats.RxCfoShort[1]); -+ -+ /* Rx Cfo_Tail*/ -+ PlatformEFIOWrite2Byte(Adapter, rA_CfoLongDump_Jaguar, Adapter->RxStats.RxCfoTail[0]); -+ PlatformEFIOWrite2Byte(Adapter, rB_CfoLongDump_Jaguar, Adapter->RxStats.RxCfoTail[1]); -+ } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { -+ PlatformEFIOWrite1Byte(Adapter, rA_RSSIDump_92E, Adapter->RxStats.RxRSSIPercentage[0]); -+ PlatformEFIOWrite1Byte(Adapter, rB_RSSIDump_92E, Adapter->RxStats.RxRSSIPercentage[1]); -+ /* Rx EVM*/ -+ PlatformEFIOWrite1Byte(Adapter, rS1_RXevmDump_92E, Adapter->RxStats.RxEVMdbm[0]); -+ PlatformEFIOWrite1Byte(Adapter, rS2_RXevmDump_92E, Adapter->RxStats.RxEVMdbm[1]); -+ /* Rx SNR*/ -+ PlatformEFIOWrite1Byte(Adapter, rA_RXsnrDump_92E, (u1Byte)(Adapter->RxStats.RxSNRdB[0])); -+ PlatformEFIOWrite1Byte(Adapter, rB_RXsnrDump_92E, (u1Byte)(Adapter->RxStats.RxSNRdB[1])); -+ /* Rx Cfo_Short*/ -+ PlatformEFIOWrite2Byte(Adapter, rA_CfoShortDump_92E, Adapter->RxStats.RxCfoShort[0]); -+ PlatformEFIOWrite2Byte(Adapter, rB_CfoShortDump_92E, Adapter->RxStats.RxCfoShort[1]); -+ /* Rx Cfo_Tail*/ -+ PlatformEFIOWrite2Byte(Adapter, rA_CfoLongDump_92E, Adapter->RxStats.RxCfoTail[0]); -+ PlatformEFIOWrite2Byte(Adapter, rB_CfoLongDump_92E, Adapter->RxStats.RxCfoTail[1]); -+ } -+} -+ -+VOID -+odm_RefreshLdpcRtsMP( -+ IN PADAPTER pAdapter, -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte mMacId, -+ IN u1Byte IOTPeer, -+ IN s4Byte UndecoratedSmoothedPWDB -+) -+{ -+ BOOLEAN bCtlLdpc = FALSE; -+ PMGNT_INFO pMgntInfo = GetDefaultMgntInfo(pAdapter); -+ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; -+ -+ if (pDM_Odm->SupportICType != ODM_RTL8821 && pDM_Odm->SupportICType != ODM_RTL8812) -+ return; -+ -+ if ((pDM_Odm->SupportICType == ODM_RTL8821) && (pDM_Odm->CutVersion == ODM_CUT_A)) -+ bCtlLdpc = TRUE; -+ else if (pDM_Odm->SupportICType == ODM_RTL8812 && -+ IOTPeer == HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP) -+ bCtlLdpc = TRUE; -+ -+ if (bCtlLdpc) { -+ if (UndecoratedSmoothedPWDB < (pRA->LdpcThres - 5)) -+ MgntSet_TX_LDPC(pAdapter, mMacId, TRUE); -+ else if (UndecoratedSmoothedPWDB > pRA->LdpcThres) -+ MgntSet_TX_LDPC(pAdapter, mMacId, FALSE); -+ } -+ -+ if (UndecoratedSmoothedPWDB < (pRA->RtsThres - 5)) -+ pRA->bLowerRtsRate = TRUE; -+ else if (UndecoratedSmoothedPWDB > pRA->RtsThres) -+ pRA->bLowerRtsRate = FALSE; -+} -+ -+VOID -+ODM_DynamicARFBSelect( -+ IN PVOID pDM_VOID, -+ IN u1Byte rate, -+ IN BOOLEAN Collision_State -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ if (pDM_Odm->SupportICType != ODM_RTL8192E) -+ return; -+ -+ if (Collision_State == pRA_Table->PT_collision_pre) -+ return; -+ -+ if (rate >= DESC_RATEMCS8 && rate <= DESC_RATEMCS12) { -+ if (Collision_State == 1) { -+ if (rate == DESC_RATEMCS12) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07060501); -+ } else if (rate == DESC_RATEMCS11) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07070605); -+ } else if (rate == DESC_RATEMCS10) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08080706); -+ } else if (rate == DESC_RATEMCS9) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08080707); -+ } else { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09090808); -+ } -+ } else { /* Collision_State == 0*/ -+ if (rate == DESC_RATEMCS12) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x05010000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09080706); -+ } else if (rate == DESC_RATEMCS11) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x06050000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09080807); -+ } else if (rate == DESC_RATEMCS10) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x07060000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x0a090908); -+ } else if (rate == DESC_RATEMCS9) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x07070000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x0a090808); -+ } else { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x08080000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x0b0a0909); -+ } -+ } -+ } else { /* MCS13~MCS15, 1SS, G-mode*/ -+ if (Collision_State == 1) { -+ if (rate == DESC_RATEMCS15) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x05040302); -+ } else if (rate == DESC_RATEMCS14) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x06050302); -+ } else if (rate == DESC_RATEMCS13) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07060502); -+ } else { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x06050402); -+ } -+ } else { // Collision_State == 0 -+ if (rate == DESC_RATEMCS15) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x03020000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07060504); -+ } else if (rate == DESC_RATEMCS14) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x03020000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08070605); -+ } else if (rate == DESC_RATEMCS13) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x05020000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09080706); -+ } else { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x04020000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08070605); -+ } -+ -+ -+ } -+ -+ } -+ pRA_Table->PT_collision_pre = Collision_State; -+} -+ -+VOID -+ODM_RateAdaptiveStateApInit( -+ IN PVOID PADAPTER_VOID, -+ IN PRT_WLAN_STA pEntry -+) -+{ -+ PADAPTER Adapter = (PADAPTER)PADAPTER_VOID; -+ pEntry->Ratr_State = DM_RATR_STA_INIT; -+} -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+ -+static void -+FindMinimumRSSI( -+ IN PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ /*Determine the minimum RSSI*/ -+ -+ if ((pDM_Odm->bLinked != _TRUE) && -+ (pHalData->EntryMinUndecoratedSmoothedPWDB == 0)) { -+ pHalData->MinUndecoratedPWDBForDM = 0; -+ /*ODM_RT_TRACE(pDM_Odm,COMP_BB_POWERSAVING, DBG_LOUD, ("Not connected to any\n"));*/ -+ } else -+ pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ -+ /*DBG_8192C("%s=>MinUndecoratedPWDBForDM(%d)\n",__FUNCTION__,pdmpriv->MinUndecoratedPWDBForDM);*/ -+ /*ODM_RT_TRACE(pDM_Odm,COMP_DIG, DBG_LOUD, ("MinUndecoratedPWDBForDM =%d\n",pHalData->MinUndecoratedPWDBForDM));*/ -+} -+ -+u8Byte -+PhyDM_Get_Rate_Bitmap_Ex( -+ IN PVOID pDM_VOID, -+ IN u4Byte macid, -+ IN u8Byte ra_mask, -+ IN u1Byte rssi_level, -+ OUT u8Byte *dm_RA_Mask, -+ OUT u1Byte *dm_RteID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PSTA_INFO_T pEntry; -+ u8Byte rate_bitmap = 0; -+ u1Byte WirelessMode; -+ -+ pEntry = pDM_Odm->pODM_StaInfo[macid]; -+ if (!IS_STA_VALID(pEntry)) -+ return ra_mask; -+ WirelessMode = pEntry->wireless_mode; -+ switch (WirelessMode) { -+ case ODM_WM_B: -+ if (ra_mask & 0x000000000000000c) /* 11M or 5.5M enable */ -+ rate_bitmap = 0x000000000000000d; -+ else -+ rate_bitmap = 0x000000000000000f; -+ break; -+ -+ case (ODM_WM_G): -+ case (ODM_WM_A): -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x0000000000000f00; -+ else -+ rate_bitmap = 0x0000000000000ff0; -+ break; -+ -+ case (ODM_WM_B|ODM_WM_G): -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x0000000000000f00; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x0000000000000ff0; -+ else -+ rate_bitmap = 0x0000000000000ff5; -+ break; -+ -+ case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G): -+ case (ODM_WM_B|ODM_WM_N24G): -+ case (ODM_WM_G|ODM_WM_N24G): -+ case (ODM_WM_A|ODM_WM_N5G): { -+ if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) { -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x00000000000f0000; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x00000000000ff000; -+ else { -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x00000000000ff015; -+ else -+ rate_bitmap = 0x00000000000ff005; -+ } -+ } else if (pDM_Odm->RFType == ODM_2T2R || pDM_Odm->RFType == ODM_2T3R || pDM_Odm->RFType == ODM_2T4R) { -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x000000000f8f0000; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x000000000f8ff000; -+ else { -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x000000000f8ff015; -+ else -+ rate_bitmap = 0x000000000f8ff005; -+ } -+ } else { -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x0000000f0f0f0000; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x0000000fcfcfe000; -+ else { -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x0000000ffffff015; -+ else -+ rate_bitmap = 0x0000000ffffff005; -+ } -+ } -+ } -+ break; -+ -+ case (ODM_WM_AC|ODM_WM_G): -+ if (rssi_level == 1) -+ rate_bitmap = 0x00000000fc3f0000; -+ else if (rssi_level == 2) -+ rate_bitmap = 0x00000000fffff000; -+ else -+ rate_bitmap = 0x00000000ffffffff; -+ break; -+ -+ case (ODM_WM_AC|ODM_WM_A): -+ -+ if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) { -+ if (rssi_level == 1) /* add by Gary for ac-series */ -+ rate_bitmap = 0x00000000003f8000; -+ else if (rssi_level == 2) -+ rate_bitmap = 0x00000000003fe000; -+ else -+ rate_bitmap = 0x00000000003ff010; -+ } else if (pDM_Odm->RFType == ODM_2T2R || pDM_Odm->RFType == ODM_2T3R || pDM_Odm->RFType == ODM_2T4R) { -+ if (rssi_level == 1) /* add by Gary for ac-series */ -+ rate_bitmap = 0x00000000fe3f8000; /* VHT 2SS MCS3~9 */ -+ else if (rssi_level == 2) -+ rate_bitmap = 0x00000000fffff000; /* VHT 2SS MCS0~9 */ -+ else -+ rate_bitmap = 0x00000000fffff010; /* All */ -+ } else { -+ if (rssi_level == 1) /* add by Gary for ac-series */ -+ rate_bitmap = 0x000003f8fe3f8000ULL; /* VHT 3SS MCS3~9 */ -+ else if (rssi_level == 2) -+ rate_bitmap = 0x000003fffffff000ULL; /* VHT3SS MCS0~9 */ -+ else -+ rate_bitmap = 0x000003fffffff010ULL; /* All */ -+ } -+ break; -+ -+ default: -+ if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) -+ rate_bitmap = 0x00000000000fffff; -+ else if (pDM_Odm->RFType == ODM_2T2R || pDM_Odm->RFType == ODM_2T3R || pDM_Odm->RFType == ODM_2T4R) -+ rate_bitmap = 0x000000000fffffff; -+ else -+ rate_bitmap = 0x0000003fffffffffULL; -+ break; -+ -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, (" ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%016llx\n", rssi_level, WirelessMode, rate_bitmap)); -+ -+ return (ra_mask & rate_bitmap); -+} -+ -+ -+u4Byte -+ODM_Get_Rate_Bitmap( -+ IN PVOID pDM_VOID, -+ IN u4Byte macid, -+ IN u4Byte ra_mask, -+ IN u1Byte rssi_level -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PSTA_INFO_T pEntry; -+ u4Byte rate_bitmap = 0; -+ u1Byte WirelessMode; -+ //u1Byte WirelessMode =*(pDM_Odm->pWirelessMode); -+ -+ -+ pEntry = pDM_Odm->pODM_StaInfo[macid]; -+ if (!IS_STA_VALID(pEntry)) -+ return ra_mask; -+ -+ WirelessMode = pEntry->wireless_mode; -+ -+ switch (WirelessMode) { -+ case ODM_WM_B: -+ if (ra_mask & 0x0000000c) //11M or 5.5M enable -+ rate_bitmap = 0x0000000d; -+ else -+ rate_bitmap = 0x0000000f; -+ break; -+ -+ case (ODM_WM_G): -+ case (ODM_WM_A): -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x00000f00; -+ else -+ rate_bitmap = 0x00000ff0; -+ break; -+ -+ case (ODM_WM_B|ODM_WM_G): -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x00000f00; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x00000ff0; -+ else -+ rate_bitmap = 0x00000ff5; -+ break; -+ -+ case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G) : -+ case (ODM_WM_B|ODM_WM_N24G) : -+ case (ODM_WM_G|ODM_WM_N24G) : -+ case (ODM_WM_A|ODM_WM_N5G) : { -+ if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) { -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x000f0000; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x000ff000; -+ else { -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x000ff015; -+ else -+ rate_bitmap = 0x000ff005; -+ } -+ } else { -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x0f8f0000; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x0f8ff000; -+ else { -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x0f8ff015; -+ else -+ rate_bitmap = 0x0f8ff005; -+ } -+ } -+ } -+ break; -+ -+ case (ODM_WM_AC|ODM_WM_G): -+ if (rssi_level == 1) -+ rate_bitmap = 0xfc3f0000; -+ else if (rssi_level == 2) -+ rate_bitmap = 0xfffff000; -+ else -+ rate_bitmap = 0xffffffff; -+ break; -+ -+ case (ODM_WM_AC|ODM_WM_A): -+ -+ if (pDM_Odm->RFType == RF_1T1R) { -+ if (rssi_level == 1) // add by Gary for ac-series -+ rate_bitmap = 0x003f8000; -+ else if (rssi_level == 2) -+ rate_bitmap = 0x003ff000; -+ else -+ rate_bitmap = 0x003ff010; -+ } else { -+ if (rssi_level == 1) // add by Gary for ac-series -+ rate_bitmap = 0xfe3f8000; // VHT 2SS MCS3~9 -+ else if (rssi_level == 2) -+ rate_bitmap = 0xfffff000; // VHT 2SS MCS0~9 -+ else -+ rate_bitmap = 0xfffff010; // All -+ } -+ break; -+ -+ default: -+ if (pDM_Odm->RFType == RF_1T2R) -+ rate_bitmap = 0x000fffff; -+ else -+ rate_bitmap = 0x0fffffff; -+ break; -+ -+ } -+ -+ DBG_871X("%s ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x\n", __func__, rssi_level, WirelessMode, rate_bitmap); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, (" ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x\n", rssi_level, WirelessMode, rate_bitmap)); -+ -+ return (ra_mask & rate_bitmap); -+ -+} -+ -+#endif //#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+#endif /*#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN| ODM_CE))*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_rainfo.h linux/3rdparty/rtl8812au/hal/phydm/phydm_rainfo.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_rainfo.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_rainfo.h 2017-06-07 23:07:21.020688396 +0300 -@@ -0,0 +1,443 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMRAINFO_H__ -+#define __PHYDMRAINFO_H__ -+ -+/*#define RAINFO_VERSION "2.0" //2014.11.04*/ -+/*#define RAINFO_VERSION "3.0" //2015.01.13 Dino*/ -+/*#define RAINFO_VERSION "3.1" //2015.01.14 Dino*/ -+#define RAINFO_VERSION "3.2" /*2015.01.14 Dino*/ -+ -+#define HIGH_RSSI_THRESH 50 -+#define LOW_RSSI_THRESH 20 -+ -+#define ACTIVE_TP_THRESHOLD 150 -+#define RA_RETRY_DESCEND_NUM 2 -+#define RA_RETRY_LIMIT_LOW 4 -+#define RA_RETRY_LIMIT_HIGH 32 -+ -+#define PHYDM_IC_8051_SERIES (ODM_RTL8881A|ODM_RTL8812|ODM_RTL8821|ODM_RTL8192S|ODM_RTL8192C|ODM_RTL8192D|ODM_RTL8723A|ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8703B|ODM_RTL8188F) -+#define PHYDM_IC_3081_SERIES (ODM_RTL8814A|ODM_RTL8821B|ODM_RTL8822B) -+ -+#define RAINFO_BE_RX_STATE BIT0 // 1:RX //ULDL -+#define RAINFO_STBC_STATE BIT1 -+//#define RAINFO_LDPC_STATE BIT2 -+#define RAINFO_NOISY_STATE BIT2 // set by Noisy_Detection -+#define RAINFO_SHURTCUT_STATE BIT3 -+#define RAINFO_SHURTCUT_FLAG BIT4 -+#define RAINFO_INIT_RSSI_RATE_STATE BIT5 -+#define RAINFO_BF_STATE BIT6 -+#define RAINFO_BE_TX_STATE BIT7 // 1:TX -+ -+#define RA_MASK_CCK 0xf -+#define RA_MASK_OFDM 0xff0 -+#define RA_MASK_HT1SS 0xff000 -+#define RA_MASK_HT2SS 0xff00000 -+/*#define RA_MASK_MCS3SS */ -+#define RA_MASK_HT4SS 0xff0 -+#define RA_MASK_VHT1SS 0x3ff000 -+#define RA_MASK_VHT2SS 0xffc00000 -+ -+#if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+#define EXT_RA_INFO_SUPPORT_IC (ODM_RTL8881A |ODM_RTL8192E |ODM_RTL8812 |ODM_RTL8814A|ODM_RTL8822B) -+#define RA_FIRST_MACID 1 -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define EXT_RA_INFO_SUPPORT_IC (ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8723B | ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8703B) -+#define RA_FIRST_MACID 0 -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+/*#define EXT_RA_INFO_SUPPORT_IC (ODM_RTL8192E|ODM_RTL8812|ODM_RTL8821|ODM_RTL8723B|ODM_RTL8814A|ODM_RTL8822B|ODM_RTL8703B) */ -+#define RA_FIRST_MACID 0 -+#endif -+ -+ -+#define AP_InitRateAdaptiveState ODM_RateAdaptiveStateApInit -+ -+#define DM_RATR_STA_INIT 0 -+#define DM_RATR_STA_HIGH 1 -+#define DM_RATR_STA_MIDDLE 2 -+#define DM_RATR_STA_LOW 3 -+#if(DM_ODM_SUPPORT_TYPE & ODM_AP) -+#define DM_RATR_STA_ULTRA_LOW 4 -+#endif -+ -+#define DM_RA_RATE_UP 1 -+#define DM_RA_RATE_DOWN 2 -+ -+typedef enum _phydm_arfr_num { -+ ARFR_0_RATE_ID = 0x9, -+ ARFR_1_RATE_ID = 0xa, -+ ARFR_2_RATE_ID = 0xb, -+ ARFR_3_RATE_ID = 0xc, -+ ARFR_4_RATE_ID = 0xd, -+ ARFR_5_RATE_ID = 0xe -+} PHYDM_RA_ARFR_NUM_E; -+ -+typedef enum _Phydm_ra_dbg_para { -+ RADBG_RTY_PENALTY = 1, //u8 -+ RADBG_N_HIGH = 2, -+ RADBG_N_LOW = 3, -+ RADBG_TRATE_UP_TABLE = 4, -+ RADBG_TRATE_DOWN_TABLE = 5, -+ RADBG_TRYING_NECESSARY = 6, -+ RADBG_TDROPING_NECESSARY = 7, -+ RADBG_RATE_UP_RTY_RATIO = 8, //u8 -+ RADBG_RATE_DOWN_RTY_RATIO = 9, //u8 -+ -+ RADBG_DEBUG_MONITOR1 = 0xc, -+ RADBG_DEBUG_MONITOR2 = 0xd, -+ RADBG_DEBUG_MONITOR3 = 0xe, -+ RADBG_DEBUG_MONITOR4 = 0xf, -+ NUM_RA_PARA -+} PHYDM_RA_DBG_PARA_E; -+ -+ -+#if (RATE_ADAPTIVE_SUPPORT == 1)//88E RA -+typedef struct _ODM_RA_Info_ { -+ u1Byte RateID; -+ u4Byte RateMask; -+ u4Byte RAUseRate; -+ u1Byte RateSGI; -+ u1Byte RssiStaRA; -+ u1Byte PreRssiStaRA; -+ u1Byte SGIEnable; -+ u1Byte DecisionRate; -+ u1Byte PreRate; -+ u1Byte HighestRate; -+ u1Byte LowestRate; -+ u4Byte NscUp; -+ u4Byte NscDown; -+ u2Byte RTY[5]; -+ u4Byte TOTAL; -+ u2Byte DROP; -+ u1Byte Active; -+ u2Byte RptTime; -+ u1Byte RAWaitingCounter; -+ u1Byte RAPendingCounter; -+#if 1 //POWER_TRAINING_ACTIVE == 1 // For compile pass only~! -+ u1Byte PTActive; // on or off -+ u1Byte PTTryState; // 0 trying state, 1 for decision state -+ u1Byte PTStage; // 0~6 -+ u1Byte PTStopCount; //Stop PT counter -+ u1Byte PTPreRate; // if rate change do PT -+ u1Byte PTPreRssi; // if RSSI change 5% do PT -+ u1Byte PTModeSS; // decide whitch rate should do PT -+ u1Byte RAstage; // StageRA, decide how many times RA will be done between PT -+ u1Byte PTSmoothFactor; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+ u1Byte RateDownCounter; -+ u1Byte RateUpCounter; -+ u1Byte RateDirection; -+ u1Byte BoundingType; -+ u1Byte BoundingCounter; -+ u1Byte BoundingLearningTime; -+ u1Byte RateDownStartTime; -+#endif -+} ODM_RA_INFO_T, *PODM_RA_INFO_T; -+#endif -+ -+ -+typedef struct _Rate_Adaptive_Table_ { -+ u1Byte firstconnect; -+#if(DM_ODM_SUPPORT_TYPE==ODM_WIN) -+ BOOLEAN PT_collision_pre; -+#endif -+ -+#if (defined(CONFIG_RA_DBG_CMD)) -+ BOOLEAN is_ra_dbg_init; -+ -+ u1Byte RTY_P[ODM_NUM_RATE_IDX]; -+ u1Byte RTY_P_default[ODM_NUM_RATE_IDX]; -+ BOOLEAN RTY_P_modify_note[ODM_NUM_RATE_IDX]; -+ -+ u1Byte RATE_UP_RTY_RATIO[ODM_NUM_RATE_IDX]; -+ u1Byte RATE_UP_RTY_RATIO_default[ODM_NUM_RATE_IDX]; -+ BOOLEAN RATE_UP_RTY_RATIO_modify_note[ODM_NUM_RATE_IDX]; -+ -+ u1Byte RATE_DOWN_RTY_RATIO[ODM_NUM_RATE_IDX]; -+ u1Byte RATE_DOWN_RTY_RATIO_default[ODM_NUM_RATE_IDX]; -+ BOOLEAN RATE_DOWN_RTY_RATIO_modify_note[ODM_NUM_RATE_IDX]; -+ -+ BOOLEAN RA_Para_feedback_req; -+ -+ u1Byte para_idx; -+ u1Byte rate_idx; -+ u1Byte value; -+ u2Byte value_16; -+ u1Byte rate_length; -+#endif -+ u1Byte link_tx_rate[ODM_ASSOCIATE_ENTRY_NUM]; -+ -+ #if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) -+ u1Byte per_rate_retrylimit_20M[ODM_NUM_RATE_IDX]; -+ u1Byte per_rate_retrylimit_40M[ODM_NUM_RATE_IDX]; -+ u1Byte retry_descend_num; -+ u1Byte retrylimit_low; -+ u1Byte retrylimit_high; -+ #endif -+ -+ -+} RA_T, *pRA_T; -+ -+typedef struct _ODM_RATE_ADAPTIVE { -+ u1Byte Type; // DM_Type_ByFW/DM_Type_ByDriver -+ u1Byte HighRSSIThresh; // if RSSI > HighRSSIThresh => RATRState is DM_RATR_STA_HIGH -+ u1Byte LowRSSIThresh; // if RSSI <= LowRSSIThresh => RATRState is DM_RATR_STA_LOW -+ u1Byte RATRState; // Current RSSI level, DM_RATR_STA_HIGH/DM_RATR_STA_MIDDLE/DM_RATR_STA_LOW -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ u1Byte LdpcThres; // if RSSI > LdpcThres => switch from LPDC to BCC -+ BOOLEAN bLowerRtsRate; -+#endif -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ u1Byte RtsThres; -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ BOOLEAN bUseLdpc; -+#else -+ u1Byte UltraLowRSSIThresh; -+ u4Byte LastRATR; // RATR Register Content -+#endif -+ -+} ODM_RATE_ADAPTIVE, *PODM_RATE_ADAPTIVE; -+ -+VOID -+ODM_C2HRaParaReportHandler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+); -+ -+VOID -+odm_RA_ParaAdjust_Send_H2C( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RA_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value -+); -+ -+VOID -+odm_RA_ParaAdjust_init( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RA_ParaAdjust( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+phydm_ra_dynamic_retry_count( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+phydm_ra_dynamic_retry_limit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+phydm_ra_dynamic_rate_id_on_assoc( -+ IN PVOID pDM_VOID, -+ IN u1Byte wireless_mode, -+ IN u1Byte init_rate_id -+); -+ -+VOID -+phydm_c2h_ra_report_handler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+); -+ -+VOID -+phydm_ra_info_init( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RSSIMonitorInit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RSSIMonitorCheck( -+ IN PVOID pDM_VOID -+); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+s4Byte -+phydm_FindMinimumRSSI( -+IN PDM_ODM_T pDM_Odm, -+IN PADAPTER pAdapter, -+IN OUT BOOLEAN *pbLink_temp -+ -+ ); -+#endif -+ -+VOID -+odm_RSSIMonitorCheckMP( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RSSIMonitorCheckCE( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RSSIMonitorCheckAP( -+ IN PVOID pDM_VOID -+); -+ -+ -+VOID -+odm_RateAdaptiveMaskInit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RefreshRateAdaptiveMask( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RefreshRateAdaptiveMaskMP( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RefreshRateAdaptiveMaskCE( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RefreshRateAdaptiveMaskAPADSL( -+ IN PVOID pDM_VOID -+); -+ -+BOOLEAN -+ODM_RAStateCheck( -+ IN PVOID pDM_VOID, -+ IN s4Byte RSSI, -+ IN BOOLEAN bForceUpdate, -+ OUT pu1Byte pRATRState -+); -+ -+VOID -+odm_RefreshBasicRateMask( -+ IN PVOID pDM_VOID -+); -+VOID -+ODM_RAPostActionOnAssoc( -+ IN PVOID pDM_Odm -+); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ -+u1Byte -+odm_Find_RTS_Rate( -+ IN PVOID pDM_VOID, -+ IN u1Byte Tx_Rate, -+ IN BOOLEAN bErpProtect -+); -+ -+VOID -+ODM_UpdateNoisyState( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN bNoisyStateFromC2H -+); -+ -+u4Byte -+Set_RA_DM_Ratrbitmap_by_Noisy( -+ IN PVOID pDM_VOID, -+ IN WIRELESS_MODE WirelessMode, -+ IN u4Byte ratr_bitmap, -+ IN u1Byte rssi_level -+); -+ -+VOID -+ODM_UpdateInitRate( -+ IN PVOID pDM_VOID, -+ IN u1Byte Rate -+); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+VOID -+odm_RSSIDumpToRegister( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RefreshLdpcRtsMP( -+ IN PADAPTER pAdapter, -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte mMacId, -+ IN u1Byte IOTPeer, -+ IN s4Byte UndecoratedSmoothedPWDB -+); -+ -+VOID -+ODM_DynamicARFBSelect( -+ IN PVOID pDM_VOID, -+ IN u1Byte rate, -+ IN BOOLEAN Collision_State -+); -+ -+VOID -+ODM_RateAdaptiveStateApInit( -+ IN PVOID PADAPTER_VOID, -+ IN PRT_WLAN_STA pEntry -+); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+static void -+FindMinimumRSSI( -+ IN PADAPTER pAdapter -+); -+ -+u8Byte -+PhyDM_Get_Rate_Bitmap_Ex( -+ IN PVOID pDM_VOID, -+ IN u4Byte macid, -+ IN u8Byte ra_mask, -+ IN u1Byte rssi_level, -+ OUT u8Byte *dm_RA_Mask, -+ OUT u1Byte *dm_RteID -+); -+u4Byte -+ODM_Get_Rate_Bitmap( -+ IN PVOID pDM_VOID, -+ IN u4Byte macid, -+ IN u4Byte ra_mask, -+ IN u1Byte rssi_level -+); -+#endif/*#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)*/ -+ -+#endif/*#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN| ODM_CE))*/ -+ -+#endif /*#ifndef __ODMRAINFO_H__*/ -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_regdefine11ac.h linux/3rdparty/rtl8812au/hal/phydm/phydm_regdefine11ac.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_regdefine11ac.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_regdefine11ac.h 2017-06-07 23:07:21.020688396 +0300 -@@ -0,0 +1,90 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODM_REGDEFINE11AC_H__ -+#define __ODM_REGDEFINE11AC_H__ -+ -+//2 RF REG LIST -+ -+ -+ -+//2 BB REG LIST -+//PAGE 8 -+#define ODM_REG_CCK_RPT_FORMAT_11AC 0x804 -+#define ODM_REG_BB_RX_PATH_11AC 0x808 -+#define ODM_REG_BB_TX_PATH_11AC 0x80c -+#define ODM_REG_BB_ATC_11AC 0x860 -+#define ODM_REG_EDCCA_POWER_CAL 0x8dc -+#define ODM_REG_DBG_RPT_11AC 0x8fc -+//PAGE 9 -+#define ODM_REG_EDCCA_DOWN_OPT 0x900 -+#define ODM_REG_ACBB_EDCCA_ENHANCE 0x944 -+#define ODM_REG_OFDM_FA_RST_11AC 0x9A4 -+#define ODM_REG_NHM_TIMER_11AC 0x990 -+#define ODM_REG_CLM_TIME_PERIOD_11AC 0x990 -+#define ODM_REG_NHM_TH9_TH10_11AC 0x994 -+#define ODM_REG_CLM_11AC 0x994 -+#define ODM_REG_NHM_TH3_TO_TH0_11AC 0x998 -+#define ODM_REG_NHM_TH7_TO_TH4_11AC 0x99c -+#define ODM_REG_NHM_TH8_11AC 0x9a0 -+#define ODM_REG_NHM_9E8_11AC 0x9e8 -+#define ODM_REG_CSI_CONTENT_VALUE 0x9b4 -+//PAGE A -+#define ODM_REG_CCK_CCA_11AC 0xA0A -+#define ODM_REG_CCK_FA_RST_11AC 0xA2C -+#define ODM_REG_CCK_FA_11AC 0xA5C -+//PAGE B -+#define ODM_REG_RST_RPT_11AC 0xB58 -+//PAGE C -+#define ODM_REG_TRMUX_11AC 0xC08 -+#define ODM_REG_IGI_A_11AC 0xC50 -+//PAGE E -+#define ODM_REG_IGI_B_11AC 0xE50 -+#define ODM_REG_TRMUX_11AC_B 0xE08 -+//PAGE F -+#define ODM_REG_CCK_CCA_CNT_11AC 0xF08 -+#define ODM_REG_OFDM_FA_11AC 0xF48 -+#define ODM_REG_RPT_11AC 0xfa0 -+#define ODM_REG_CLM_RESULT_11AC 0xfa4 -+#define ODM_REG_NHM_CNT_11AC 0xfa8 -+#define ODM_REG_NHM_DUR_READY_11AC 0xfb4 -+ -+#define ODM_REG_NHM_CNT7_TO_CNT4_11AC 0xfac -+#define ODM_REG_NHM_CNT11_TO_CNT8_11AC 0xfb0 -+#define ODM_REG_OFDM_FA_TYPE2_11AC 0xFD0 -+//PAGE 18 -+#define ODM_REG_IGI_C_11AC 0x1850 -+//PAGE 1A -+#define ODM_REG_IGI_D_11AC 0x1A50 -+ -+//2 MAC REG LIST -+#define ODM_REG_RESP_TX_11AC 0x6D8 -+ -+ -+ -+//DIG Related -+#define ODM_BIT_IGI_11AC 0xFFFFFFFF -+#define ODM_BIT_CCK_RPT_FORMAT_11AC BIT16 -+#define ODM_BIT_BB_RX_PATH_11AC 0xF -+#define ODM_BIT_BB_TX_PATH_11AC 0xF -+#define ODM_BIT_BB_ATC_11AC BIT14 -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_regdefine11n.h linux/3rdparty/rtl8812au/hal/phydm/phydm_regdefine11n.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_regdefine11n.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_regdefine11n.h 2017-06-07 23:07:21.020688396 +0300 -@@ -0,0 +1,199 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODM_REGDEFINE11N_H__ -+#define __ODM_REGDEFINE11N_H__ -+ -+ -+//2 RF REG LIST -+#define ODM_REG_RF_MODE_11N 0x00 -+#define ODM_REG_RF_0B_11N 0x0B -+#define ODM_REG_CHNBW_11N 0x18 -+#define ODM_REG_T_METER_11N 0x24 -+#define ODM_REG_RF_25_11N 0x25 -+#define ODM_REG_RF_26_11N 0x26 -+#define ODM_REG_RF_27_11N 0x27 -+#define ODM_REG_RF_2B_11N 0x2B -+#define ODM_REG_RF_2C_11N 0x2C -+#define ODM_REG_RXRF_A3_11N 0x3C -+#define ODM_REG_T_METER_92D_11N 0x42 -+#define ODM_REG_T_METER_88E_11N 0x42 -+ -+ -+ -+//2 BB REG LIST -+//PAGE 8 -+#define ODM_REG_BB_CTRL_11N 0x800 -+#define ODM_REG_RF_PIN_11N 0x804 -+#define ODM_REG_PSD_CTRL_11N 0x808 -+#define ODM_REG_TX_ANT_CTRL_11N 0x80C -+#define ODM_REG_BB_PWR_SAV5_11N 0x818 -+#define ODM_REG_CCK_RPT_FORMAT_11N 0x824 -+#define ODM_REG_CCK_RPT_FORMAT_11N_B 0x82C -+#define ODM_REG_RX_DEFUALT_A_11N 0x858 -+#define ODM_REG_RX_DEFUALT_B_11N 0x85A -+#define ODM_REG_BB_PWR_SAV3_11N 0x85C -+#define ODM_REG_ANTSEL_CTRL_11N 0x860 -+#define ODM_REG_RX_ANT_CTRL_11N 0x864 -+#define ODM_REG_PIN_CTRL_11N 0x870 -+#define ODM_REG_BB_PWR_SAV1_11N 0x874 -+#define ODM_REG_ANTSEL_PATH_11N 0x878 -+#define ODM_REG_BB_3WIRE_11N 0x88C -+#define ODM_REG_SC_CNT_11N 0x8C4 -+#define ODM_REG_PSD_DATA_11N 0x8B4 -+#define ODM_REG_PSD_DATA_11N 0x8B4 -+#define ODM_REG_NHM_TIMER_11N 0x894 -+#define ODM_REG_CLM_TIME_PERIOD_11N 0x894 -+#define ODM_REG_NHM_TH9_TH10_11N 0x890 -+#define ODM_REG_CLM_11N 0x890 -+#define ODM_REG_NHM_TH3_TO_TH0_11N 0x898 -+#define ODM_REG_NHM_TH7_TO_TH4_11N 0x89c -+#define ODM_REG_NHM_TH8_11N 0xe28 -+#define ODM_REG_CLM_READY_11N 0x8b4 -+#define ODM_REG_CLM_RESULT_11N 0x8d0 -+#define ODM_REG_NHM_CNT_11N 0x8d8 -+ -+// For ACS, Jeffery, 2014-12-26 -+#define ODM_REG_NHM_CNT7_TO_CNT4_11N 0x8dc -+#define ODM_REG_NHM_CNT9_TO_CNT8_11N 0x8d0 -+#define ODM_REG_NHM_CNT10_11N 0x8d4 -+ -+ -+ -+//PAGE 9 -+#define ODM_REG_DBG_RPT_11N 0x908 -+#define ODM_REG_BB_TX_PATH_11N 0x90c -+#define ODM_REG_ANT_MAPPING1_11N 0x914 -+#define ODM_REG_ANT_MAPPING2_11N 0x918 -+#define ODM_REG_EDCCA_DOWN_OPT_11N 0x948 -+ -+//PAGE A -+#define ODM_REG_CCK_ANTDIV_PARA1_11N 0xA00 -+#define ODM_REG_CCK_CCA_11N 0xA0A -+#define ODM_REG_CCK_ANTDIV_PARA2_11N 0xA0C -+#define ODM_REG_CCK_ANTDIV_PARA3_11N 0xA10 -+#define ODM_REG_CCK_ANTDIV_PARA4_11N 0xA14 -+#define ODM_REG_CCK_FILTER_PARA1_11N 0xA22 -+#define ODM_REG_CCK_FILTER_PARA2_11N 0xA23 -+#define ODM_REG_CCK_FILTER_PARA3_11N 0xA24 -+#define ODM_REG_CCK_FILTER_PARA4_11N 0xA25 -+#define ODM_REG_CCK_FILTER_PARA5_11N 0xA26 -+#define ODM_REG_CCK_FILTER_PARA6_11N 0xA27 -+#define ODM_REG_CCK_FILTER_PARA7_11N 0xA28 -+#define ODM_REG_CCK_FILTER_PARA8_11N 0xA29 -+#define ODM_REG_CCK_FA_RST_11N 0xA2C -+#define ODM_REG_CCK_FA_MSB_11N 0xA58 -+#define ODM_REG_CCK_FA_LSB_11N 0xA5C -+#define ODM_REG_CCK_CCA_CNT_11N 0xA60 -+#define ODM_REG_BB_PWR_SAV4_11N 0xA74 -+//PAGE B -+#define ODM_REG_LNA_SWITCH_11N 0xB2C -+#define ODM_REG_PATH_SWITCH_11N 0xB30 -+#define ODM_REG_RSSI_CTRL_11N 0xB38 -+#define ODM_REG_CONFIG_ANTA_11N 0xB68 -+#define ODM_REG_RSSI_BT_11N 0xB9C -+//PAGE C -+#define ODM_REG_OFDM_FA_HOLDC_11N 0xC00 -+#define ODM_REG_BB_RX_PATH_11N 0xC04 -+#define ODM_REG_TRMUX_11N 0xC08 -+#define ODM_REG_OFDM_FA_RSTC_11N 0xC0C -+#define ODM_REG_RXIQI_MATRIX_11N 0xC14 -+#define ODM_REG_TXIQK_MATRIX_LSB1_11N 0xC4C -+#define ODM_REG_IGI_A_11N 0xC50 -+#define ODM_REG_ANTDIV_PARA2_11N 0xC54 -+#define ODM_REG_IGI_B_11N 0xC58 -+#define ODM_REG_ANTDIV_PARA3_11N 0xC5C -+#define ODM_REG_L1SBD_PD_CH_11N 0XC6C -+#define ODM_REG_BB_PWR_SAV2_11N 0xC70 -+#define ODM_REG_RX_OFF_11N 0xC7C -+#define ODM_REG_TXIQK_MATRIXA_11N 0xC80 -+#define ODM_REG_TXIQK_MATRIXB_11N 0xC88 -+#define ODM_REG_TXIQK_MATRIXA_LSB2_11N 0xC94 -+#define ODM_REG_TXIQK_MATRIXB_LSB2_11N 0xC9C -+#define ODM_REG_RXIQK_MATRIX_LSB_11N 0xCA0 -+#define ODM_REG_ANTDIV_PARA1_11N 0xCA4 -+#define ODM_REG_OFDM_FA_TYPE1_11N 0xCF0 -+//PAGE D -+#define ODM_REG_OFDM_FA_RSTD_11N 0xD00 -+#define ODM_REG_BB_ATC_11N 0xD2C -+#define ODM_REG_OFDM_FA_TYPE2_11N 0xDA0 -+#define ODM_REG_OFDM_FA_TYPE3_11N 0xDA4 -+#define ODM_REG_OFDM_FA_TYPE4_11N 0xDA8 -+#define ODM_REG_RPT_11N 0xDF4 -+//PAGE E -+#define ODM_REG_TXAGC_A_6_18_11N 0xE00 -+#define ODM_REG_TXAGC_A_24_54_11N 0xE04 -+#define ODM_REG_TXAGC_A_1_MCS32_11N 0xE08 -+#define ODM_REG_TXAGC_A_MCS0_3_11N 0xE10 -+#define ODM_REG_TXAGC_A_MCS4_7_11N 0xE14 -+#define ODM_REG_TXAGC_A_MCS8_11_11N 0xE18 -+#define ODM_REG_TXAGC_A_MCS12_15_11N 0xE1C -+#define ODM_REG_EDCCA_DCNF_11N 0xE24 -+#define ODM_REG_FPGA0_IQK_11N 0xE28 -+#define ODM_REG_TXIQK_TONE_A_11N 0xE30 -+#define ODM_REG_RXIQK_TONE_A_11N 0xE34 -+#define ODM_REG_TXIQK_PI_A_11N 0xE38 -+#define ODM_REG_RXIQK_PI_A_11N 0xE3C -+#define ODM_REG_TXIQK_11N 0xE40 -+#define ODM_REG_RXIQK_11N 0xE44 -+#define ODM_REG_IQK_AGC_PTS_11N 0xE48 -+#define ODM_REG_IQK_AGC_RSP_11N 0xE4C -+#define ODM_REG_BLUETOOTH_11N 0xE6C -+#define ODM_REG_RX_WAIT_CCA_11N 0xE70 -+#define ODM_REG_TX_CCK_RFON_11N 0xE74 -+#define ODM_REG_TX_CCK_BBON_11N 0xE78 -+#define ODM_REG_OFDM_RFON_11N 0xE7C -+#define ODM_REG_OFDM_BBON_11N 0xE80 -+#define ODM_REG_TX2RX_11N 0xE84 -+#define ODM_REG_TX2TX_11N 0xE88 -+#define ODM_REG_RX_CCK_11N 0xE8C -+#define ODM_REG_RX_OFDM_11N 0xED0 -+#define ODM_REG_RX_WAIT_RIFS_11N 0xED4 -+#define ODM_REG_RX2RX_11N 0xED8 -+#define ODM_REG_STANDBY_11N 0xEDC -+#define ODM_REG_SLEEP_11N 0xEE0 -+#define ODM_REG_PMPD_ANAEN_11N 0xEEC -+#define ODM_REG_IGI_C_11N 0xF84 -+#define ODM_REG_IGI_D_11N 0xF88 -+ -+//2 MAC REG LIST -+#define ODM_REG_BB_RST_11N 0x02 -+#define ODM_REG_ANTSEL_PIN_11N 0x4C -+#define ODM_REG_EARLY_MODE_11N 0x4D0 -+#define ODM_REG_RSSI_MONITOR_11N 0x4FE -+#define ODM_REG_EDCA_VO_11N 0x500 -+#define ODM_REG_EDCA_VI_11N 0x504 -+#define ODM_REG_EDCA_BE_11N 0x508 -+#define ODM_REG_EDCA_BK_11N 0x50C -+#define ODM_REG_TXPAUSE_11N 0x522 -+#define ODM_REG_RESP_TX_11N 0x6D8 -+#define ODM_REG_ANT_TRAIN_PARA1_11N 0x7b0 -+#define ODM_REG_ANT_TRAIN_PARA2_11N 0x7b4 -+ -+ -+//DIG Related -+#define ODM_BIT_IGI_11N 0x0000007F -+#define ODM_BIT_CCK_RPT_FORMAT_11N BIT9 -+#define ODM_BIT_BB_RX_PATH_11N 0xF -+#define ODM_BIT_BB_TX_PATH_11N 0xF -+#define ODM_BIT_BB_ATC_11N BIT11 -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_reg.h linux/3rdparty/rtl8812au/hal/phydm/phydm_reg.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_reg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_reg.h 2017-06-07 23:07:21.020688396 +0300 -@@ -0,0 +1,208 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+//============================================================ -+// File Name: odm_reg.h -+// -+// Description: -+// -+// This file is for general register definition. -+// -+// -+//============================================================ -+#ifndef __HAL_ODM_REG_H__ -+#define __HAL_ODM_REG_H__ -+ -+// -+// Register Definition -+// -+ -+//MAC REG -+#define ODM_BB_RESET 0x002 -+#define ODM_DUMMY 0x4fe -+#define RF_T_METER_OLD 0x24 -+#define RF_T_METER_NEW 0x42 -+ -+#define ODM_EDCA_VO_PARAM 0x500 -+#define ODM_EDCA_VI_PARAM 0x504 -+#define ODM_EDCA_BE_PARAM 0x508 -+#define ODM_EDCA_BK_PARAM 0x50C -+#define ODM_TXPAUSE 0x522 -+ -+//BB REG -+#define ODM_FPGA_PHY0_PAGE8 0x800 -+#define ODM_PSD_SETTING 0x808 -+#define ODM_AFE_SETTING 0x818 -+#define ODM_TXAGC_B_6_18 0x830 -+#define ODM_TXAGC_B_24_54 0x834 -+#define ODM_TXAGC_B_MCS32_5 0x838 -+#define ODM_TXAGC_B_MCS0_MCS3 0x83c -+#define ODM_TXAGC_B_MCS4_MCS7 0x848 -+#define ODM_TXAGC_B_MCS8_MCS11 0x84c -+#define ODM_ANALOG_REGISTER 0x85c -+#define ODM_RF_INTERFACE_OUTPUT 0x860 -+#define ODM_TXAGC_B_MCS12_MCS15 0x868 -+#define ODM_TXAGC_B_11_A_2_11 0x86c -+#define ODM_AD_DA_LSB_MASK 0x874 -+#define ODM_ENABLE_3_WIRE 0x88c -+#define ODM_PSD_REPORT 0x8b4 -+#define ODM_R_ANT_SELECT 0x90c -+#define ODM_CCK_ANT_SELECT 0xa07 -+#define ODM_CCK_PD_THRESH 0xa0a -+#define ODM_CCK_RF_REG1 0xa11 -+#define ODM_CCK_MATCH_FILTER 0xa20 -+#define ODM_CCK_RAKE_MAC 0xa2e -+#define ODM_CCK_CNT_RESET 0xa2d -+#define ODM_CCK_TX_DIVERSITY 0xa2f -+#define ODM_CCK_FA_CNT_MSB 0xa5b -+#define ODM_CCK_FA_CNT_LSB 0xa5c -+#define ODM_CCK_NEW_FUNCTION 0xa75 -+#define ODM_OFDM_PHY0_PAGE_C 0xc00 -+#define ODM_OFDM_RX_ANT 0xc04 -+#define ODM_R_A_RXIQI 0xc14 -+#define ODM_R_A_AGC_CORE1 0xc50 -+#define ODM_R_A_AGC_CORE2 0xc54 -+#define ODM_R_B_AGC_CORE1 0xc58 -+#define ODM_R_AGC_PAR 0xc70 -+#define ODM_R_HTSTF_AGC_PAR 0xc7c -+#define ODM_TX_PWR_TRAINING_A 0xc90 -+#define ODM_TX_PWR_TRAINING_B 0xc98 -+#define ODM_OFDM_FA_CNT1 0xcf0 -+#define ODM_OFDM_PHY0_PAGE_D 0xd00 -+#define ODM_OFDM_FA_CNT2 0xda0 -+#define ODM_OFDM_FA_CNT3 0xda4 -+#define ODM_OFDM_FA_CNT4 0xda8 -+#define ODM_TXAGC_A_6_18 0xe00 -+#define ODM_TXAGC_A_24_54 0xe04 -+#define ODM_TXAGC_A_1_MCS32 0xe08 -+#define ODM_TXAGC_A_MCS0_MCS3 0xe10 -+#define ODM_TXAGC_A_MCS4_MCS7 0xe14 -+#define ODM_TXAGC_A_MCS8_MCS11 0xe18 -+#define ODM_TXAGC_A_MCS12_MCS15 0xe1c -+ -+//RF REG -+#define ODM_GAIN_SETTING 0x00 -+#define ODM_CHANNEL 0x18 -+#define ODM_RF_T_METER 0x24 -+#define ODM_RF_T_METER_92D 0x42 -+#define ODM_RF_T_METER_88E 0x42 -+#define ODM_RF_T_METER_92E 0x42 -+#define ODM_RF_T_METER_8812 0x42 -+ -+//Ant Detect Reg -+#define ODM_DPDT 0x300 -+ -+//PSD Init -+#define ODM_PSDREG 0x808 -+ -+//92D Path Div -+#define PATHDIV_REG 0xB30 -+#define PATHDIV_TRI 0xBA0 -+ -+ -+// -+// Bitmap Definition -+// -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+// TX AGC -+#define rTxAGC_A_CCK11_CCK1_JAguar 0xc20 -+#define rTxAGC_A_Ofdm18_Ofdm6_JAguar 0xc24 -+#define rTxAGC_A_Ofdm54_Ofdm24_JAguar 0xc28 -+#define rTxAGC_A_MCS3_MCS0_JAguar 0xc2c -+#define rTxAGC_A_MCS7_MCS4_JAguar 0xc30 -+#define rTxAGC_A_MCS11_MCS8_JAguar 0xc34 -+#define rTxAGC_A_MCS15_MCS12_JAguar 0xc38 -+#define rTxAGC_A_Nss1Index3_Nss1Index0_JAguar 0xc3c -+#define rTxAGC_A_Nss1Index7_Nss1Index4_JAguar 0xc40 -+#define rTxAGC_A_Nss2Index1_Nss1Index8_JAguar 0xc44 -+#define rTxAGC_A_Nss2Index5_Nss2Index2_JAguar 0xc48 -+#define rTxAGC_A_Nss2Index9_Nss2Index6_JAguar 0xc4c -+#if defined(CONFIG_WLAN_HAL_8814AE) -+#define rTxAGC_A_MCS19_MCS16_JAguar 0xcd8 -+#define rTxAGC_A_MCS23_MCS20_JAguar 0xcdc -+#define rTxAGC_A_Nss3Index3_Nss3Index0_JAguar 0xce0 -+#define rTxAGC_A_Nss3Index7_Nss3Index4_JAguar 0xce4 -+#define rTxAGC_A_Nss3Index9_Nss3Index8_JAguar 0xce8 -+#endif -+#define rTxAGC_B_CCK11_CCK1_JAguar 0xe20 -+#define rTxAGC_B_Ofdm18_Ofdm6_JAguar 0xe24 -+#define rTxAGC_B_Ofdm54_Ofdm24_JAguar 0xe28 -+#define rTxAGC_B_MCS3_MCS0_JAguar 0xe2c -+#define rTxAGC_B_MCS7_MCS4_JAguar 0xe30 -+#define rTxAGC_B_MCS11_MCS8_JAguar 0xe34 -+#define rTxAGC_B_MCS15_MCS12_JAguar 0xe38 -+#define rTxAGC_B_Nss1Index3_Nss1Index0_JAguar 0xe3c -+#define rTxAGC_B_Nss1Index7_Nss1Index4_JAguar 0xe40 -+#define rTxAGC_B_Nss2Index1_Nss1Index8_JAguar 0xe44 -+#define rTxAGC_B_Nss2Index5_Nss2Index2_JAguar 0xe48 -+#define rTxAGC_B_Nss2Index9_Nss2Index6_JAguar 0xe4c -+#if defined(CONFIG_WLAN_HAL_8814AE) -+#define rTxAGC_B_MCS19_MCS16_JAguar 0xed8 -+#define rTxAGC_B_MCS23_MCS20_JAguar 0xedc -+#define rTxAGC_B_Nss3Index3_Nss3Index0_JAguar 0xee0 -+#define rTxAGC_B_Nss3Index7_Nss3Index4_JAguar 0xee4 -+#define rTxAGC_B_Nss3Index9_Nss3Index8_JAguar 0xee8 -+#define rTxAGC_C_CCK11_CCK1_JAguar 0x1820 -+#define rTxAGC_C_Ofdm18_Ofdm6_JAguar 0x1824 -+#define rTxAGC_C_Ofdm54_Ofdm24_JAguar 0x1828 -+#define rTxAGC_C_MCS3_MCS0_JAguar 0x182c -+#define rTxAGC_C_MCS7_MCS4_JAguar 0x1830 -+#define rTxAGC_C_MCS11_MCS8_JAguar 0x1834 -+#define rTxAGC_C_MCS15_MCS12_JAguar 0x1838 -+#define rTxAGC_C_Nss1Index3_Nss1Index0_JAguar 0x183c -+#define rTxAGC_C_Nss1Index7_Nss1Index4_JAguar 0x1840 -+#define rTxAGC_C_Nss2Index1_Nss1Index8_JAguar 0x1844 -+#define rTxAGC_C_Nss2Index5_Nss2Index2_JAguar 0x1848 -+#define rTxAGC_C_Nss2Index9_Nss2Index6_JAguar 0x184c -+#define rTxAGC_C_MCS19_MCS16_JAguar 0x18d8 -+#define rTxAGC_C_MCS23_MCS20_JAguar 0x18dc -+#define rTxAGC_C_Nss3Index3_Nss3Index0_JAguar 0x18e0 -+#define rTxAGC_C_Nss3Index7_Nss3Index4_JAguar 0x18e4 -+#define rTxAGC_C_Nss3Index9_Nss3Index8_JAguar 0x18e8 -+#define rTxAGC_D_CCK11_CCK1_JAguar 0x1a20 -+#define rTxAGC_D_Ofdm18_Ofdm6_JAguar 0x1a24 -+#define rTxAGC_D_Ofdm54_Ofdm24_JAguar 0x1a28 -+#define rTxAGC_D_MCS3_MCS0_JAguar 0x1a2c -+#define rTxAGC_D_MCS7_MCS4_JAguar 0x1a30 -+#define rTxAGC_D_MCS11_MCS8_JAguar 0x1a34 -+#define rTxAGC_D_MCS15_MCS12_JAguar 0x1a38 -+#define rTxAGC_D_Nss1Index3_Nss1Index0_JAguar 0x1a3c -+#define rTxAGC_D_Nss1Index7_Nss1Index4_JAguar 0x1a40 -+#define rTxAGC_D_Nss2Index1_Nss1Index8_JAguar 0x1a44 -+#define rTxAGC_D_Nss2Index5_Nss2Index2_JAguar 0x1a48 -+#define rTxAGC_D_Nss2Index9_Nss2Index6_JAguar 0x1a4c -+#define rTxAGC_D_MCS19_MCS16_JAguar 0x1ad8 -+#define rTxAGC_D_MCS23_MCS20_JAguar 0x1adc -+#define rTxAGC_D_Nss3Index3_Nss3Index0_JAguar 0x1ae0 -+#define rTxAGC_D_Nss3Index7_Nss3Index4_JAguar 0x1ae4 -+#define rTxAGC_D_Nss3Index9_Nss3Index8_JAguar 0x1ae8 -+#endif -+ -+#define bTxAGC_byte0_Jaguar 0xff -+#define bTxAGC_byte1_Jaguar 0xff00 -+#define bTxAGC_byte2_Jaguar 0xff0000 -+#define bTxAGC_byte3_Jaguar 0xff000000 -+#endif -+ -+#define BIT_FA_RESET BIT0 -+ -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_rxhp.c linux/3rdparty/rtl8812au/hal/phydm/phydm_rxhp.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_rxhp.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_rxhp.c 2017-06-07 23:07:21.020688396 +0300 -@@ -0,0 +1,1692 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+#define AFH_PSD 1 //0:normal PSD scan, 1: only do 20 pts PSD -+#define MODE_40M 0 //0:20M, 1:40M -+#define PSD_TH2 3 -+#define PSD_CHMIN 20 // Minimum channel number for BT AFH -+#define SIR_STEP_SIZE 3 -+#define Smooth_Size_1 5 -+#define Smooth_TH_1 3 -+#define Smooth_Size_2 10 -+#define Smooth_TH_2 4 -+#define Smooth_Size_3 20 -+#define Smooth_TH_3 4 -+#define Smooth_Step_Size 5 -+#define Adaptive_SIR 1 -+#define SCAN_INTERVAL 1500 //ms -+#define SYN_Length 5 // for 92D -+ -+#define LNA_Low_Gain_1 0x64 -+#define LNA_Low_Gain_2 0x5A -+#define LNA_Low_Gain_3 0x58 -+ -+#define pw_th_10dB 0x0 -+#define pw_th_16dB 0x3 -+ -+#define FA_RXHP_TH1 5000 -+#define FA_RXHP_TH2 1500 -+#define FA_RXHP_TH3 800 -+#define FA_RXHP_TH4 600 -+#define FA_RXHP_TH5 500 -+ -+#define Idle_Mode 0 -+#define High_TP_Mode 1 -+#define Low_TP_Mode 2 -+ -+ -+VOID -+odm_PSDMonitorInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE)|(DEV_BUS_TYPE == RT_USB_INTERFACE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ //PSD Monitor Setting -+ //Which path in ADC/DAC is turnned on for PSD: both I/Q -+ ODM_SetBBReg(pDM_Odm, ODM_PSDREG, BIT10|BIT11, 0x3); -+ //Ageraged number: 8 -+ ODM_SetBBReg(pDM_Odm, ODM_PSDREG, BIT12|BIT13, 0x1); -+ pDM_Odm->bPSDinProcess = FALSE; -+ pDM_Odm->bUserAssignLevel = FALSE; -+ pDM_Odm->bPSDactive = FALSE; -+ //pDM_Odm->bDMInitialGainEnable=TRUE; //change the initialization to DIGinit -+ //Set Debug Port -+ //PHY_SetBBReg(Adapter, 0x908, bMaskDWord, 0x803); -+ //PHY_SetBBReg(Adapter, 0xB34, bMaskByte0, 0x00); // pause PSD -+ //PHY_SetBBReg(Adapter, 0xB38, bMaskByte0, 10); //rescan -+ //PHY_SetBBReg(Adapter, 0xB38, bMaskByte2|bMaskByte3, 100); //interval -+ -+ //PlatformSetTimer( Adapter, &pHalData->PSDTriggerTimer, 0); //ms -+#endif -+} -+ -+VOID -+PatchDCTone( -+ IN PVOID pDM_VOID, -+ pu4Byte PSD_report, -+ u1Byte initial_gain_psd -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ //PADAPTER pAdapter; -+ -+ u4Byte psd_report; -+ -+ //2 Switch to CH11 to patch CH9 and CH13 DC tone -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, 0x3FF, 11); -+ -+ if(pDM_Odm->SupportICType== ODM_RTL8192D) -+ { -+ if((*(pDM_Odm->pMacPhyMode) == ODM_SMSP)||(*(pDM_Odm->pMacPhyMode) == ODM_DMSP)) -+ { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_CHNLBW, 0x3FF, 11); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x25, 0xfffff, 0x643BC); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x26, 0xfffff, 0xFC038); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x27, 0xfffff, 0x77C1A); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x2B, 0xfffff, 0x41289); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x2C, 0xfffff, 0x01840); -+ } -+ else -+ { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x25, 0xfffff, 0x643BC); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x26, 0xfffff, 0xFC038); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x27, 0xfffff, 0x77C1A); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2B, 0xfffff, 0x41289); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2C, 0xfffff, 0x01840); -+ } -+ } -+ -+ //Ch9 DC tone patch -+ psd_report = GetPSDData(pDM_Odm, 96, initial_gain_psd); -+ PSD_report[50] = psd_report; -+ //Ch13 DC tone patch -+ psd_report = GetPSDData(pDM_Odm, 32, initial_gain_psd); -+ PSD_report[70] = psd_report; -+ -+ //2 Switch to CH3 to patch CH1 and CH5 DC tone -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, 0x3FF, 3); -+ -+ -+ if(pDM_Odm->SupportICType==ODM_RTL8192D) -+ { -+ if((*(pDM_Odm->pMacPhyMode) == ODM_SMSP)||(*(pDM_Odm->pMacPhyMode) == ODM_DMSP)) -+ { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_CHNLBW, 0x3FF, 3); -+ //PHY_SetRFReg(Adapter, ODM_RF_PATH_B, 0x25, 0xfffff, 0x643BC); -+ //PHY_SetRFReg(Adapter, ODM_RF_PATH_B, 0x26, 0xfffff, 0xFC038); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x27, 0xfffff, 0x07C1A); -+ //PHY_SetRFReg(Adapter, ODM_RF_PATH_B, 0x2B, 0xfffff, 0x61289); -+ //PHY_SetRFReg(Adapter, ODM_RF_PATH_B, 0x2C, 0xfffff, 0x01C41); -+ } -+ else -+ { -+ //PHY_SetRFReg(Adapter, ODM_RF_PATH_A, 0x25, 0xfffff, 0x643BC); -+ //PHY_SetRFReg(Adapter, ODM_RF_PATH_A, 0x26, 0xfffff, 0xFC038); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x27, 0xfffff, 0x07C1A); -+ //PHY_SetRFReg(Adapter, ODM_RF_PATH_A, 0x2B, 0xfffff, 0x61289); -+ //PHY_SetRFReg(Adapter, ODM_RF_PATH_A, 0x2C, 0xfffff, 0x01C41); -+ } -+ } -+ -+ //Ch1 DC tone patch -+ psd_report = GetPSDData(pDM_Odm, 96, initial_gain_psd); -+ PSD_report[10] = psd_report; -+ //Ch5 DC tone patch -+ psd_report = GetPSDData(pDM_Odm, 32, initial_gain_psd); -+ PSD_report[30] = psd_report; -+ -+} -+ -+ -+VOID -+GoodChannelDecision( -+ IN PVOID pDM_VOID, -+ pu4Byte PSD_report, -+ pu1Byte PSD_bitmap, -+ u1Byte RSSI_BT, -+ pu1Byte PSD_bitmap_memory) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRXHP_T pRX_HP_Table = &pDM_Odm->DM_RXHP_Table; -+ //s4Byte TH1 = SSBT-0x15; // modify TH by Neil Chen -+ s4Byte TH1= RSSI_BT+0x14; -+ s4Byte TH2 = RSSI_BT+85; -+ //u2Byte TH3; -+// s4Byte RegB34; -+ u1Byte bitmap, Smooth_size[3], Smooth_TH[3]; -+ //u1Byte psd_bit; -+ u4Byte i,n,j, byte_idx, bit_idx, good_cnt, good_cnt_smoothing, Smooth_Interval[3]; -+ int start_byte_idx,start_bit_idx,cur_byte_idx, cur_bit_idx,NOW_byte_idx ; -+ -+// RegB34 = PHY_QueryBBReg(Adapter,0xB34, bMaskDWord)&0xFF; -+ -+ if((pDM_Odm->SupportICType == ODM_RTL8192C)||(pDM_Odm->SupportICType == ODM_RTL8192D)) -+ { -+ TH1 = RSSI_BT + 0x14; -+ } -+ -+ Smooth_size[0]=Smooth_Size_1; -+ Smooth_size[1]=Smooth_Size_2; -+ Smooth_size[2]=Smooth_Size_3; -+ Smooth_TH[0]=Smooth_TH_1; -+ Smooth_TH[1]=Smooth_TH_2; -+ Smooth_TH[2]=Smooth_TH_3; -+ Smooth_Interval[0]=16; -+ Smooth_Interval[1]=15; -+ Smooth_Interval[2]=13; -+ good_cnt = 0; -+ if(pDM_Odm->SupportICType==ODM_RTL8723A) -+ { -+ //2 Threshold -+ -+ if(RSSI_BT >=41) -+ TH1 = 113; -+ else if(RSSI_BT >=38) // >= -15dBm -+ TH1 = 105; //0x69 -+ else if((RSSI_BT >=33)&(RSSI_BT <38)) -+ TH1 = 99+(RSSI_BT-33); //0x63 -+ else if((RSSI_BT >=26)&(RSSI_BT<33)) -+ TH1 = 99-(33-RSSI_BT)+2; //0x5e -+ else if((RSSI_BT >=24)&(RSSI_BT<26)) -+ TH1 = 88-((RSSI_BT-24)*3); //0x58 -+ else if((RSSI_BT >=18)&(RSSI_BT<24)) -+ TH1 = 77+((RSSI_BT-18)*2); -+ else if((RSSI_BT >=14)&(RSSI_BT<18)) -+ TH1 = 63+((RSSI_BT-14)*2); -+ else if((RSSI_BT >=8)&(RSSI_BT<14)) -+ TH1 = 58+((RSSI_BT-8)*2); -+ else if((RSSI_BT >=3)&(RSSI_BT<8)) -+ TH1 = 52+(RSSI_BT-3); -+ else -+ TH1 = 51; -+ } -+ -+ for (i = 0; i< 10; i++) -+ PSD_bitmap[i] = 0; -+ -+ -+ // Add By Gary -+ for (i=0; i<80; i++) -+ pRX_HP_Table->PSD_bitmap_RXHP[i] = 0; -+ // End -+ -+ -+ -+ if(pDM_Odm->SupportICType==ODM_RTL8723A) -+ { -+ TH1 =TH1-SIR_STEP_SIZE; -+ } -+ while (good_cnt < PSD_CHMIN) -+ { -+ good_cnt = 0; -+ if(pDM_Odm->SupportICType==ODM_RTL8723A) -+ { -+ if(TH1 ==TH2) -+ break; -+ if((TH1+SIR_STEP_SIZE) < TH2) -+ TH1 += SIR_STEP_SIZE; -+ else -+ TH1 = TH2; -+ } -+ else -+ { -+ if(TH1==(RSSI_BT+0x1E)) -+ break; -+ if((TH1+2) < (RSSI_BT+0x1E)) -+ TH1+=3; -+ else -+ TH1 = RSSI_BT+0x1E; -+ -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD,DBG_LOUD,("PSD: decision threshold is: %d", TH1)); -+ -+ for (i = 0; i< 80; i++) -+ { -+ if((s4Byte)(PSD_report[i]) < TH1) -+ { -+ byte_idx = i / 8; -+ bit_idx = i -8*byte_idx; -+ bitmap = PSD_bitmap[byte_idx]; -+ PSD_bitmap[byte_idx] = bitmap | (u1Byte) (1 << bit_idx); -+ } -+ } -+ -+#if DBG -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("PSD: before smoothing\n")); -+ for(n=0;n<10;n++) -+ { -+ //DbgPrint("PSD_bitmap[%u]=%x\n", n, PSD_bitmap[n]); -+ for (i = 0; i<8; i++) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("PSD_bitmap[%u] = %d\n", 2402+n*8+i, (PSD_bitmap[n]&BIT(i))>>i)); -+ } -+#endif -+ -+ //1 Start of smoothing function -+ -+ for (j=0;j<3;j++) -+ { -+ start_byte_idx=0; -+ start_bit_idx=0; -+ for(n=0; n 7 ) -+ { -+ start_byte_idx= start_byte_idx+start_bit_idx/8; -+ start_bit_idx = start_bit_idx%8; -+ } -+ } -+ -+ ODM_RT_TRACE( pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("PSD: after %u smoothing", j+1)); -+ for(n=0;n<10;n++) -+ { -+ for (i = 0; i<8; i++) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("PSD_bitmap[%u] = %d\n", 2402+n*8+i, (PSD_bitmap[n]&BIT(i))>>i)); -+ -+ if ( ((PSD_bitmap[n]&BIT(i))>>i) ==1) //----- Add By Gary -+ { -+ pRX_HP_Table->PSD_bitmap_RXHP[8*n+i] = 1; -+ } // ------end by Gary -+ } -+ } -+ -+ } -+ -+ -+ good_cnt = 0; -+ for ( i = 0; i < 10; i++) -+ { -+ for (n = 0; n < 8; n++) -+ if((PSD_bitmap[i]& BIT(n)) != 0) -+ good_cnt++; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, ODM_COMP_PSD,("PSD: good channel cnt = %u",good_cnt)); -+ } -+ -+ //RT_TRACE(ODM_COMP_PSD, DBG_LOUD,("PSD: SSBT=%d, TH2=%d, TH1=%d",SSBT,TH2,TH1)); -+ for (i = 0; i <10; i++) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("PSD: PSD_bitmap[%u]=%x",i,PSD_bitmap[i])); -+/* -+ //Update bitmap memory -+ for(i = 0; i < 80; i++) -+ { -+ byte_idx = i / 8; -+ bit_idx = i -8*byte_idx; -+ psd_bit = (PSD_bitmap[byte_idx] & BIT(bit_idx)) >> bit_idx; -+ bitmap = PSD_bitmap_memory[i]; -+ PSD_bitmap_memory[i] = (bitmap << 1) |psd_bit; -+ } -+*/ -+} -+ -+ -+ -+VOID -+odm_PSD_Monitor( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ //PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ unsigned int pts, start_point, stop_point; -+ u1Byte initial_gain ; -+ static u1Byte PSD_bitmap_memory[80], init_memory = 0; -+ static u1Byte psd_cnt=0; -+ static u4Byte PSD_report[80], PSD_report_tmp; -+ static u8Byte lastTxOkCnt=0, lastRxOkCnt=0; -+ u1Byte H2C_PSD_DATA[5]={0,0,0,0,0}; -+ static u1Byte H2C_PSD_DATA_last[5] ={0,0,0,0,0}; -+ u1Byte idx[20]={96,99,102,106,109,112,115,118,122,125, -+ 0,3,6,10,13,16,19,22,26,29}; -+ u1Byte n, i, channel, BBReset,tone_idx; -+ u1Byte PSD_bitmap[10], SSBT=0,initial_gain_psd=0, RSSI_BT=0, initialGainUpper; -+ s4Byte PSD_skip_start, PSD_skip_stop; -+ u4Byte CurrentChannel, RXIQI, RxIdleLowPwr, wlan_channel; -+ u4Byte ReScan, Interval, Is40MHz; -+ u8Byte curTxOkCnt, curRxOkCnt; -+ int cur_byte_idx, cur_bit_idx; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ -+ -+ if(*pDM_Odm->pbDriverIsGoingToPnpSetPowerSleep) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("pbDriverIsGoingToPnpSetPowerSleep!!!!!!!!!!!!!!!\n")); -+ return; -+ } -+ -+ -+ if( (*(pDM_Odm->pbScanInProcess)) || -+ pDM_Odm->bLinkInProcess) -+ { -+ if((pDM_Odm->SupportICType==ODM_RTL8723A)&(pDM_Odm->SupportInterface==ODM_ITRF_PCIE)) -+ { -+ ODM_SetTimer( pDM_Odm, &pDM_Odm->PSDTimer, 1500); //ms -+ //psd_cnt=0; -+ } -+ return; -+ } -+ -+ if(pDM_Odm->bBtHsOperation) -+ { -+ ReScan = 1; -+ Interval = SCAN_INTERVAL; -+ } -+ else -+ { -+ ReScan = PSD_RESCAN; -+ Interval = SCAN_INTERVAL; -+ } -+ -+ //1 Initialization -+ if(init_memory == 0) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("Init memory\n")); -+ for(i = 0; i < 80; i++) -+ PSD_bitmap_memory[i] = 0xFF; // channel is always good -+ init_memory = 1; -+ } -+ if(psd_cnt == 0) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("Enter dm_PSD_Monitor\n")); -+ for(i = 0; i < 80; i++) -+ PSD_report[i] = 0; -+ } -+ -+ //1 Backup Current Settings -+ CurrentChannel = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); -+/* -+ if(pDM_Odm->SupportICType==ODM_RTL8192D) -+ { -+ //2 Record Current synthesizer parameters based on current channel -+ if((*pDM_Odm->MacPhyMode92D == SINGLEMAC_SINGLEPHY)||(*pDM_Odm->MacPhyMode92D == DUALMAC_SINGLEPHY)) -+ { -+ SYN_RF25 = ODM_GetRFReg(Adapter, ODM_RF_PATH_B, 0x25, bMaskDWord); -+ SYN_RF26 = ODM_GetRFReg(Adapter, ODM_RF_PATH_B, 0x26, bMaskDWord); -+ SYN_RF27 = ODM_GetRFReg(Adapter, ODM_RF_PATH_B, 0x27, bMaskDWord); -+ SYN_RF2B = ODM_GetRFReg(Adapter, ODM_RF_PATH_B, 0x2B, bMaskDWord); -+ SYN_RF2C = ODM_GetRFReg(Adapter, ODM_RF_PATH_B, 0x2C, bMaskDWord); -+ } -+ else // DualMAC_DualPHY 2G -+ { -+ SYN_RF25 = ODM_GetRFReg(Adapter, ODM_RF_PATH_A, 0x25, bMaskDWord); -+ SYN_RF26 = ODM_GetRFReg(Adapter, ODM_RF_PATH_A, 0x26, bMaskDWord); -+ SYN_RF27 = ODM_GetRFReg(Adapter, ODM_RF_PATH_A, 0x27, bMaskDWord); -+ SYN_RF2B = ODM_GetRFReg(Adapter, ODM_RF_PATH_A, 0x2B, bMaskDWord); -+ SYN_RF2C = ODM_GetRFReg(Adapter, ODM_RF_PATH_A, 0x2C, bMaskDWord); -+ } -+ } -+*/ -+ //RXIQI = PHY_QueryBBReg(Adapter, 0xC14, bMaskDWord); -+ RXIQI = ODM_GetBBReg(pDM_Odm, 0xC14, bMaskDWord); -+ -+ //RxIdleLowPwr = (PHY_QueryBBReg(Adapter, 0x818, bMaskDWord)&BIT28)>>28; -+ RxIdleLowPwr = (ODM_GetBBReg(pDM_Odm, 0x818, bMaskDWord)&BIT28)>>28; -+ -+ //2??? -+ if(CHNL_RUN_ABOVE_40MHZ(pMgntInfo)) -+ Is40MHz = TRUE; -+ else -+ Is40MHz = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PSD, DBG_LOUD,("PSD Scan Start\n")); -+ //1 Turn off CCK -+ //PHY_SetBBReg(Adapter, rFPGA0_RFMOD, BIT24, 0); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 0); -+ //1 Turn off TX -+ //Pause TX Queue -+ //PlatformEFIOWrite1Byte(Adapter, REG_TXPAUSE, 0xFF); -+ ODM_Write1Byte(pDM_Odm,REG_TXPAUSE, 0xFF); -+ -+ //Force RX to stop TX immediately -+ //PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask, 0x32E13); -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask, 0x32E13); -+ //1 Turn off RX -+ //Rx AGC off RegC70[0]=0, RegC7C[20]=0 -+ //PHY_SetBBReg(Adapter, 0xC70, BIT0, 0); -+ //PHY_SetBBReg(Adapter, 0xC7C, BIT20, 0); -+ -+ ODM_SetBBReg(pDM_Odm, 0xC70, BIT0, 0); -+ ODM_SetBBReg(pDM_Odm, 0xC7C, BIT20, 0); -+ -+ -+ //Turn off CCA -+ //PHY_SetBBReg(Adapter, 0xC14, bMaskDWord, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, 0x0); -+ -+ //BB Reset -+ //BBReset = PlatformEFIORead1Byte(Adapter, 0x02); -+ BBReset = ODM_Read1Byte(pDM_Odm, 0x02); -+ -+ //PlatformEFIOWrite1Byte(Adapter, 0x02, BBReset&(~BIT0)); -+ //PlatformEFIOWrite1Byte(Adapter, 0x02, BBReset|BIT0); -+ ODM_SetBBReg(pDM_Odm, 0x87C, BIT31, 1); //clock gated to prevent from AGC table mess -+ ODM_Write1Byte(pDM_Odm, 0x02, BBReset&(~BIT0)); -+ ODM_Write1Byte(pDM_Odm, 0x02, BBReset|BIT0); -+ ODM_SetBBReg(pDM_Odm, 0x87C, BIT31, 0); -+ -+ //1 Leave RX idle low power -+ //PHY_SetBBReg(Adapter, 0x818, BIT28, 0x0); -+ -+ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x0); -+ //1 Fix initial gain -+ //if (IS_HARDWARE_TYPE_8723AE(Adapter)) -+ //RSSI_BT = pHalData->RSSI_BT; -+ //else if((IS_HARDWARE_TYPE_8192C(Adapter))||(IS_HARDWARE_TYPE_8192D(Adapter))) // Add by Gary -+ // RSSI_BT = RSSI_BT_new; -+ -+ if((pDM_Odm->SupportICType==ODM_RTL8723A)&(pDM_Odm->SupportInterface==ODM_ITRF_PCIE)) -+ RSSI_BT=pDM_Odm->RSSI_BT; //need to check C2H to pDM_Odm RSSI BT -+ -+ if(RSSI_BT>=47) -+ RSSI_BT=47; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("PSD: RSSI_BT= %d\n", RSSI_BT)); -+ -+ if(pDM_Odm->SupportICType==ODM_RTL8723A) -+ { -+ //Neil add--2011--10--12 -+ //2 Initial Gain index -+ if(RSSI_BT >=35) // >= -15dBm -+ initial_gain_psd = RSSI_BT*2; -+ else if((RSSI_BT >=33)&(RSSI_BT<35)) -+ initial_gain_psd = RSSI_BT*2+6; -+ else if((RSSI_BT >=24)&(RSSI_BT<33)) -+ initial_gain_psd = 70-(33-RSSI_BT); -+ else if((RSSI_BT >=19)&(RSSI_BT<24)) -+ initial_gain_psd = 64-((24-RSSI_BT)*4); -+ else if((RSSI_BT >=14)&(RSSI_BT<19)) -+ initial_gain_psd = 44-((18-RSSI_BT)*2); -+ else if((RSSI_BT >=8)&(RSSI_BT<14)) -+ initial_gain_psd = 35-(14-RSSI_BT); -+ else -+ initial_gain_psd = 0x1B; -+ } -+ else -+ { -+ -+ //need to do -+ initial_gain_psd = pDM_Odm->RSSI_Min; // PSD report based on RSSI -+ //} -+ } -+ //if(RSSI_BT<0x17) -+ // RSSI_BT +=3; -+ //DbgPrint("PSD: RSSI_BT= %d\n", RSSI_BT); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("PSD: RSSI_BT= %d\n", RSSI_BT)); -+ -+ //initialGainUpper = 0x5E; //Modify by neil chen -+ -+ if(pDM_Odm->bUserAssignLevel) -+ { -+ pDM_Odm->bUserAssignLevel = FALSE; -+ initialGainUpper = 0x7f; -+ } -+ else -+ { -+ initialGainUpper = 0x5E; -+ } -+ -+ /* -+ if (initial_gain_psd < 0x1a) -+ initial_gain_psd = 0x1a; -+ if (initial_gain_psd > initialGainUpper) -+ initial_gain_psd = initialGainUpper; -+ */ -+ -+ //if(pDM_Odm->SupportICType==ODM_RTL8723A) -+ SSBT = RSSI_BT * 2 +0x3E; -+ -+ -+ //if(IS_HARDWARE_TYPE_8723AE(Adapter)) -+ // SSBT = RSSI_BT * 2 +0x3E; -+ //else if((IS_HARDWARE_TYPE_8192C(Adapter))||(IS_HARDWARE_TYPE_8192D(Adapter))) // Add by Gary -+ //{ -+ // RSSI_BT = initial_gain_psd; -+ // SSBT = RSSI_BT; -+ //} -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("PSD: SSBT= %d\n", SSBT)); -+ ODM_RT_TRACE( pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("PSD: initial gain= 0x%x\n", initial_gain_psd)); -+ //DbgPrint("PSD: SSBT= %d", SSBT); -+ //need to do -+ pDM_Odm->bDMInitialGainEnable = FALSE; -+ initial_gain =(u1Byte) (ODM_GetBBReg(pDM_Odm, 0xc50, bMaskDWord) & 0x7F); -+ -+ // make sure the initial gain is under the correct range. -+ //initial_gain_psd &= 0x7f; -+ ODM_Write_DIG(pDM_Odm, initial_gain_psd); -+ //1 Turn off 3-wire -+ ODM_SetBBReg(pDM_Odm, 0x88c, BIT20|BIT21|BIT22|BIT23, 0xF); -+ -+ //pts value = 128, 256, 512, 1024 -+ pts = 128; -+ -+ if(pts == 128) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x0); -+ start_point = 64; -+ stop_point = 192; -+ } -+ else if(pts == 256) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x1); -+ start_point = 128; -+ stop_point = 384; -+ } -+ else if(pts == 512) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x2); -+ start_point = 256; -+ stop_point = 768; -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x3); -+ start_point = 512; -+ stop_point = 1536; -+ } -+ -+ -+//3 Skip WLAN channels if WLAN busy -+ -+ curTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast) - lastTxOkCnt; -+ curRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast) - lastRxOkCnt; -+ lastTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast); -+ lastRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast); -+ -+ PSD_skip_start=80; -+ PSD_skip_stop = 0; -+ wlan_channel = CurrentChannel & 0x0f; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD,DBG_LOUD,("PSD: current channel: %x, BW:%d \n", wlan_channel, Is40MHz)); -+ if(pDM_Odm->SupportICType==ODM_RTL8723A) -+ { -+ if(pDM_Odm->bBtHsOperation) -+ { -+ if(pDM_Odm->bLinked) -+ { -+ if(Is40MHz) -+ { -+ PSD_skip_start = ((wlan_channel-1)*5 -Is40MHz*10)-2; // Modify by Neil to add 10 chs to mask -+ PSD_skip_stop = (PSD_skip_start + (1+Is40MHz)*20)+4; -+ } -+ else -+ { -+ PSD_skip_start = ((wlan_channel-1)*5 -Is40MHz*10)-10; // Modify by Neil to add 10 chs to mask -+ PSD_skip_stop = (PSD_skip_start + (1+Is40MHz)*20)+18; -+ } -+ } -+ else -+ { -+ // mask for 40MHz -+ PSD_skip_start = ((wlan_channel-1)*5 -Is40MHz*10)-2; // Modify by Neil to add 10 chs to mask -+ PSD_skip_stop = (PSD_skip_start + (1+Is40MHz)*20)+4; -+ } -+ if(PSD_skip_start < 0) -+ PSD_skip_start = 0; -+ if(PSD_skip_stop >80) -+ PSD_skip_stop = 80; -+ } -+ else -+ { -+ if((curRxOkCnt+curTxOkCnt) > 5) -+ { -+ if(Is40MHz) -+ { -+ PSD_skip_start = ((wlan_channel-1)*5 -Is40MHz*10)-2; // Modify by Neil to add 10 chs to mask -+ PSD_skip_stop = (PSD_skip_start + (1+Is40MHz)*20)+4; -+ } -+ else -+ { -+ PSD_skip_start = ((wlan_channel-1)*5 -Is40MHz*10)-10; // Modify by Neil to add 10 chs to mask -+ PSD_skip_stop = (PSD_skip_start + (1+Is40MHz)*20)+18; -+ } -+ -+ if(PSD_skip_start < 0) -+ PSD_skip_start = 0; -+ if(PSD_skip_stop >80) -+ PSD_skip_stop = 80; -+ } -+ } -+ } -+#if 0 -+ else -+ { -+ if((curRxOkCnt+curTxOkCnt) > 1000) -+ { -+ PSD_skip_start = (wlan_channel-1)*5 -Is40MHz*10; -+ PSD_skip_stop = PSD_skip_start + (1+Is40MHz)*20; -+ } -+ } -+#endif //Reove RXHP Issue -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD,DBG_LOUD,("PSD: Skip tone from %d to %d \n", PSD_skip_start, PSD_skip_stop)); -+ -+ for (n=0;n<80;n++) -+ { -+ if((n%20)==0) -+ { -+ channel = (n/20)*4 + 1; -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, 0x3FF, channel); -+ } -+ tone_idx = n%20; -+ if ((n>=PSD_skip_start) && (n PSD_report[n]) -+ PSD_report[n] = PSD_report_tmp; -+ -+ } -+ } -+ -+ PatchDCTone(pDM_Odm, PSD_report, initial_gain_psd); -+ -+ //----end -+ //1 Turn on RX -+ //Rx AGC on -+ ODM_SetBBReg(pDM_Odm, 0xC70, BIT0, 1); -+ ODM_SetBBReg(pDM_Odm, 0xC7C, BIT20, 1); -+ //CCK on -+ ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 1); -+ //1 Turn on TX -+ //Resume TX Queue -+ -+ ODM_Write1Byte(pDM_Odm,REG_TXPAUSE, 0x00); -+ //Turn on 3-wire -+ ODM_SetBBReg(pDM_Odm, 0x88c, BIT20|BIT21|BIT22|BIT23, 0x0); -+ //1 Restore Current Settings -+ //Resume DIG -+ pDM_Odm->bDMInitialGainEnable = TRUE; -+ -+ ODM_Write_DIG(pDM_Odm, initial_gain); -+ -+ // restore originl center frequency -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, CurrentChannel); -+ -+ //Turn on CCA -+ ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, RXIQI); -+ //Restore RX idle low power -+ if(RxIdleLowPwr == TRUE) -+ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 1); -+ -+ psd_cnt++; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("PSD:psd_cnt = %d \n",psd_cnt)); -+ if (psd_cnt < ReScan) -+ ODM_SetTimer(pDM_Odm, &pDM_Odm->PSDTimer, Interval); -+ else -+ { -+ psd_cnt = 0; -+ for(i=0;i<80;i++) -+ //DbgPrint("psd_report[%d]= %d \n", 2402+i, PSD_report[i]); -+ RT_TRACE( ODM_COMP_PSD, DBG_LOUD,("psd_report[%d]= %d \n", 2402+i, PSD_report[i])); -+ -+ -+ GoodChannelDecision(pDM_Odm, PSD_report, PSD_bitmap,RSSI_BT, PSD_bitmap_memory); -+ -+ if(pDM_Odm->SupportICType==ODM_RTL8723A) -+ { -+ cur_byte_idx=0; -+ cur_bit_idx=0; -+ -+ //2 Restore H2C PSD Data to Last Data -+ H2C_PSD_DATA_last[0] = H2C_PSD_DATA[0]; -+ H2C_PSD_DATA_last[1] = H2C_PSD_DATA[1]; -+ H2C_PSD_DATA_last[2] = H2C_PSD_DATA[2]; -+ H2C_PSD_DATA_last[3] = H2C_PSD_DATA[3]; -+ H2C_PSD_DATA_last[4] = H2C_PSD_DATA[4]; -+ -+ -+ //2 Translate 80bit channel map to 40bit channel -+ for ( i=0;i<5;i++) -+ { -+ for(n=0;n<8;n++) -+ { -+ cur_byte_idx = i*2 + n/4; -+ cur_bit_idx = (n%4)*2; -+ if ( ((PSD_bitmap[cur_byte_idx]& BIT(cur_bit_idx)) != 0) && ((PSD_bitmap[cur_byte_idx]& BIT(cur_bit_idx+1)) != 0)) -+ H2C_PSD_DATA[i] = H2C_PSD_DATA[i] | (u1Byte) (1 << n); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("H2C_PSD_DATA[%d]=0x%x\n" ,i, H2C_PSD_DATA[i])); -+ } -+ -+ //3 To Compare the difference -+ for ( i=0;i<5;i++) -+ { -+ if(H2C_PSD_DATA[i] !=H2C_PSD_DATA_last[i]) -+ { -+ FillH2CCmd92C(Adapter, H2C_92C_PSD_RESULT, 5, H2C_PSD_DATA); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PSD, DBG_LOUD,("Need to Update the AFH Map \n")); -+ break; -+ } -+ else -+ { -+ if(i==5) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("Not need to Update\n")); -+ } -+ } -+ if(pDM_Odm->bBtHsOperation) -+ { -+ ODM_SetTimer(pDM_Odm, &pDM_Odm->PSDTimer, 10000); -+ ODM_RT_TRACE( pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("Leave dm_PSD_Monitor\n")); -+ } -+ else -+ { -+ ODM_SetTimer(pDM_Odm, &pDM_Odm->PSDTimer, 1500); -+ ODM_RT_TRACE( pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("Leave dm_PSD_Monitor\n")); -+ } -+ } -+ } -+} -+/* -+//Neil for Get BT RSSI -+// Be Triggered by BT C2H CMD -+VOID -+ODM_PSDGetRSSI( -+ IN u1Byte RSSI_BT) -+{ -+ -+ -+} -+ -+*/ -+ -+VOID -+ODM_PSDMonitor( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ //if(IS_HARDWARE_TYPE_8723AE(Adapter)) -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8723A) //may need to add other IC type -+ { -+ if(pDM_Odm->SupportInterface==ODM_ITRF_PCIE) -+ { -+ if(!pDM_Odm->bBtEnabled) //need to check upper layer connection -+ { -+ pDM_Odm->bPSDactive=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD, ("odm_PSDMonitor, return for BT is disabled!!!\n")); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD, ("odm_PSDMonitor\n")); -+ //{ -+ pDM_Odm->bPSDinProcess = TRUE; -+ pDM_Odm->bPSDactive=TRUE; -+ odm_PSD_Monitor(pDM_Odm); -+ pDM_Odm->bPSDinProcess = FALSE; -+ } -+ } -+ -+} -+VOID -+odm_PSDMonitorCallback( -+ PRT_TIMER pTimer -+) -+{ -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformScheduleWorkItem(&pHalData->PSDMonitorWorkitem); -+} -+ -+VOID -+odm_PSDMonitorWorkItemCallback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER Adapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ ODM_PSDMonitor(pDM_Odm); -+} -+ -+ -+ //cosa debug tool need to modify -+ -+VOID -+ODM_PSDDbgControl( -+ IN PADAPTER Adapter, -+ IN u4Byte mode, -+ IN u4Byte btRssi -+ ) -+{ -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD, (" Monitor mode=%d, btRssi=%d\n", mode, btRssi)); -+ if(mode) -+ { -+ pDM_Odm->RSSI_BT = (u1Byte)btRssi; -+ pDM_Odm->bUserAssignLevel = TRUE; -+ ODM_SetTimer( pDM_Odm, &pDM_Odm->PSDTimer, 0); //ms -+ } -+ else -+ { -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->PSDTimer); -+ } -+#endif -+} -+ -+ -+//#if(DEV_BUS_TYPE == RT_PCI_INTERFACE)|(DEV_BUS_TYPE == RT_USB_INTERFACE) -+ -+void odm_RXHPInit( -+ IN PVOID pDM_VOID) -+{ -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE)|(DEV_BUS_TYPE == RT_USB_INTERFACE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRXHP_T pRX_HP_Table = &pDM_Odm->DM_RXHP_Table; -+ u1Byte index; -+ -+ pRX_HP_Table->RXHP_enable = TRUE; -+ pRX_HP_Table->RXHP_flag = 0; -+ pRX_HP_Table->PSD_func_trigger = 0; -+ pRX_HP_Table->Pre_IGI = 0x20; -+ pRX_HP_Table->Cur_IGI = 0x20; -+ pRX_HP_Table->Cur_pw_th = pw_th_10dB; -+ pRX_HP_Table->Pre_pw_th = pw_th_10dB; -+ for(index=0; index<80; index++) -+ pRX_HP_Table->PSD_bitmap_RXHP[index] = 1; -+ -+#if(DEV_BUS_TYPE == RT_USB_INTERFACE) -+ pRX_HP_Table->TP_Mode = Idle_Mode; -+#endif -+#endif -+} -+ -+VOID -+odm_PSD_RXHP( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRXHP_T pRX_HP_Table = &pDM_Odm->DM_RXHP_Table; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ unsigned int pts, start_point, stop_point, initial_gain ; -+ static u1Byte PSD_bitmap_memory[80], init_memory = 0; -+ static u1Byte psd_cnt=0; -+ static u4Byte PSD_report[80], PSD_report_tmp; -+ static u8Byte lastTxOkCnt=0, lastRxOkCnt=0; -+ u1Byte idx[20]={96,99,102,106,109,112,115,118,122,125, -+ 0,3,6,10,13,16,19,22,26,29}; -+ u1Byte n, i, channel, BBReset,tone_idx; -+ u1Byte PSD_bitmap[10]/*, SSBT=0*/,initial_gain_psd=0, RSSI_BT=0, initialGainUpper; -+ s4Byte PSD_skip_start, PSD_skip_stop; -+ u4Byte CurrentChannel, RXIQI, RxIdleLowPwr, wlan_channel; -+ u4Byte ReScan, Interval, Is40MHz; -+ u8Byte curTxOkCnt, curRxOkCnt; -+ //--------------2G band synthesizer for 92D switch RF channel using----------------- -+ u1Byte group_idx=0; -+ u4Byte SYN_RF25=0, SYN_RF26=0, SYN_RF27=0, SYN_RF2B=0, SYN_RF2C=0; -+ u4Byte SYN[5] = {0x25, 0x26, 0x27, 0x2B, 0x2C}; // synthesizer RF register for 2G channel -+ u4Byte SYN_group[3][5] = {{0x643BC, 0xFC038, 0x77C1A, 0x41289, 0x01840}, // For CH1,2,4,9,10.11.12 {0x643BC, 0xFC038, 0x77C1A, 0x41289, 0x01840} -+ {0x643BC, 0xFC038, 0x07C1A, 0x41289, 0x01840}, // For CH3,13,14 -+ {0x243BC, 0xFC438, 0x07C1A, 0x4128B, 0x0FC41}}; // For Ch5,6,7,8 -+ //--------------------- Add by Gary for Debug setting ---------------------- -+ u1Byte RSSI_BT_new = (u1Byte) ODM_GetBBReg(pDM_Odm, 0xB9C, 0xFF); -+ u1Byte rssi_ctrl = (u1Byte) ODM_GetBBReg(pDM_Odm, 0xB38, 0xFF); -+ //--------------------------------------------------------------------- -+ -+ if(pMgntInfo->bScanInProgress) -+ { -+ return; -+ } -+ -+ ReScan = PSD_RESCAN; -+ Interval = SCAN_INTERVAL; -+ -+ -+ //1 Initialization -+ if(init_memory == 0) -+ { -+ RT_TRACE( ODM_COMP_PSD, DBG_LOUD,("Init memory\n")); -+ for(i = 0; i < 80; i++) -+ PSD_bitmap_memory[i] = 0xFF; // channel is always good -+ init_memory = 1; -+ } -+ if(psd_cnt == 0) -+ { -+ RT_TRACE(ODM_COMP_PSD, DBG_LOUD,("Enter dm_PSD_Monitor\n")); -+ for(i = 0; i < 80; i++) -+ PSD_report[i] = 0; -+ } -+ -+ //1 Backup Current Settings -+ CurrentChannel = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); -+ if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ { -+ //2 Record Current synthesizer parameters based on current channel -+ if((*(pDM_Odm->pMacPhyMode)==ODM_SMSP)||(*(pDM_Odm->pMacPhyMode)==ODM_DMSP)) -+ { -+ SYN_RF25 = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x25, bMaskDWord); -+ SYN_RF26 = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x26, bMaskDWord); -+ SYN_RF27 = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x27, bMaskDWord); -+ SYN_RF2B = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x2B, bMaskDWord); -+ SYN_RF2C = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x2C, bMaskDWord); -+ } -+ else // DualMAC_DualPHY 2G -+ { -+ SYN_RF25 = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x25, bMaskDWord); -+ SYN_RF26 = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x26, bMaskDWord); -+ SYN_RF27 = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x27, bMaskDWord); -+ SYN_RF2B = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2B, bMaskDWord); -+ SYN_RF2C = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2C, bMaskDWord); -+ } -+ } -+ RXIQI = ODM_GetBBReg(pDM_Odm, 0xC14, bMaskDWord); -+ RxIdleLowPwr = (ODM_GetBBReg(pDM_Odm, 0x818, bMaskDWord)&BIT28)>>28; -+ Is40MHz = *(pDM_Odm->pBandWidth); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PSD, DBG_LOUD,("PSD Scan Start\n")); -+ //1 Turn off CCK -+ ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 0); -+ //1 Turn off TX -+ //Pause TX Queue -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0xFF); -+ //Force RX to stop TX immediately -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask, 0x32E13); -+ //1 Turn off RX -+ //Rx AGC off RegC70[0]=0, RegC7C[20]=0 -+ ODM_SetBBReg(pDM_Odm, 0xC70, BIT0, 0); -+ ODM_SetBBReg(pDM_Odm, 0xC7C, BIT20, 0); -+ //Turn off CCA -+ ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, 0x0); -+ //BB Reset -+ ODM_SetBBReg(pDM_Odm, 0x87C, BIT31, 1); //clock gated to prevent from AGC table mess -+ BBReset = ODM_Read1Byte(pDM_Odm, 0x02); -+ ODM_Write1Byte(pDM_Odm, 0x02, BBReset&(~BIT0)); -+ ODM_Write1Byte(pDM_Odm, 0x02, BBReset|BIT0); -+ ODM_SetBBReg(pDM_Odm, 0x87C, BIT31, 0); -+ //1 Leave RX idle low power -+ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x0); -+ //1 Fix initial gain -+ RSSI_BT = RSSI_BT_new; -+ RT_TRACE(ODM_COMP_PSD, DBG_LOUD,("PSD: RSSI_BT= %d\n", RSSI_BT)); -+ -+ if(rssi_ctrl == 1) // just for debug!! -+ initial_gain_psd = RSSI_BT_new; -+ else -+ initial_gain_psd = pDM_Odm->RSSI_Min; // PSD report based on RSSI -+ -+ RT_TRACE(ODM_COMP_PSD, DBG_LOUD,("PSD: RSSI_BT= %d\n", RSSI_BT)); -+ -+ initialGainUpper = 0x54; -+ -+ RSSI_BT = initial_gain_psd; -+ //SSBT = RSSI_BT; -+ -+ //RT_TRACE( ODM_COMP_PSD, DBG_LOUD,("PSD: SSBT= %d\n", SSBT)); -+ RT_TRACE( ODM_COMP_PSD, DBG_LOUD,("PSD: initial gain= 0x%x\n", initial_gain_psd)); -+ -+ pDM_Odm->bDMInitialGainEnable = FALSE; -+ initial_gain = ODM_GetBBReg(pDM_Odm, 0xc50, bMaskDWord) & 0x7F; -+ //ODM_SetBBReg(pDM_Odm, 0xc50, 0x7F, initial_gain_psd); -+ ODM_Write_DIG(pDM_Odm, initial_gain_psd); -+ //1 Turn off 3-wire -+ ODM_SetBBReg(pDM_Odm, 0x88c, BIT20|BIT21|BIT22|BIT23, 0xF); -+ -+ //pts value = 128, 256, 512, 1024 -+ pts = 128; -+ -+ if(pts == 128) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x0); -+ start_point = 64; -+ stop_point = 192; -+ } -+ else if(pts == 256) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x1); -+ start_point = 128; -+ stop_point = 384; -+ } -+ else if(pts == 512) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x2); -+ start_point = 256; -+ stop_point = 768; -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x3); -+ start_point = 512; -+ stop_point = 1536; -+ } -+ -+ -+//3 Skip WLAN channels if WLAN busy -+ curTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast) - lastTxOkCnt; -+ curRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast) - lastRxOkCnt; -+ lastTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast); -+ lastRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast); -+ -+ PSD_skip_start=80; -+ PSD_skip_stop = 0; -+ wlan_channel = CurrentChannel & 0x0f; -+ -+ RT_TRACE(ODM_COMP_PSD,DBG_LOUD,("PSD: current channel: %x, BW:%d \n", wlan_channel, Is40MHz)); -+ -+ if((curRxOkCnt+curTxOkCnt) > 1000) -+ { -+ PSD_skip_start = (wlan_channel-1)*5 -Is40MHz*10; -+ PSD_skip_stop = PSD_skip_start + (1+Is40MHz)*20; -+ } -+ -+ RT_TRACE(ODM_COMP_PSD,DBG_LOUD,("PSD: Skip tone from %d to %d \n", PSD_skip_start, PSD_skip_stop)); -+ -+ for (n=0;n<80;n++) -+ { -+ if((n%20)==0) -+ { -+ channel = (n/20)*4 + 1; -+ if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ { -+ switch(channel) -+ { -+ case 1: -+ case 9: -+ group_idx = 0; -+ break; -+ case 5: -+ group_idx = 2; -+ break; -+ case 13: -+ group_idx = 1; -+ break; -+ } -+ if((*(pDM_Odm->pMacPhyMode)==ODM_SMSP)||(*(pDM_Odm->pMacPhyMode)==ODM_DMSP)) -+ { -+ for(i = 0; i < SYN_Length; i++) -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, SYN[i], bMaskDWord, SYN_group[group_idx][i]); -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, 0x3FF, channel); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_CHNLBW, 0x3FF, channel); -+ } -+ else // DualMAC_DualPHY 2G -+ { -+ for(i = 0; i < SYN_Length; i++) -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, SYN[i], bMaskDWord, SYN_group[group_idx][i]); -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, 0x3FF, channel); -+ } -+ } -+ else -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, 0x3FF, channel); -+ } -+ tone_idx = n%20; -+ if ((n>=PSD_skip_start) && (n PSD_report[n]) -+ PSD_report[n] = PSD_report_tmp; -+ -+ } -+ } -+ -+ PatchDCTone(pDM_Odm, PSD_report, initial_gain_psd); -+ -+ //----end -+ //1 Turn on RX -+ //Rx AGC on -+ ODM_SetBBReg(pDM_Odm, 0xC70, BIT0, 1); -+ ODM_SetBBReg(pDM_Odm, 0xC7C, BIT20, 1); -+ //CCK on -+ ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 1); -+ //1 Turn on TX -+ //Resume TX Queue -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0x00); -+ //Turn on 3-wire -+ ODM_SetBBReg(pDM_Odm, 0x88c, BIT20|BIT21|BIT22|BIT23, 0x0); -+ //1 Restore Current Settings -+ //Resume DIG -+ pDM_Odm->bDMInitialGainEnable= TRUE; -+ //ODM_SetBBReg(pDM_Odm, 0xc50, 0x7F, initial_gain); -+ ODM_Write_DIG(pDM_Odm,(u1Byte) initial_gain); -+ // restore originl center frequency -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, CurrentChannel); -+ if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ { -+ if((*(pDM_Odm->pMacPhyMode)==ODM_SMSP)||(*(pDM_Odm->pMacPhyMode)==ODM_DMSP)) -+ { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_CHNLBW, bMaskDWord, CurrentChannel); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x25, bMaskDWord, SYN_RF25); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x26, bMaskDWord, SYN_RF26); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x27, bMaskDWord, SYN_RF27); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x2B, bMaskDWord, SYN_RF2B); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x2C, bMaskDWord, SYN_RF2C); -+ } -+ else // DualMAC_DualPHY -+ { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x25, bMaskDWord, SYN_RF25); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x26, bMaskDWord, SYN_RF26); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x27, bMaskDWord, SYN_RF27); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2B, bMaskDWord, SYN_RF2B); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2C, bMaskDWord, SYN_RF2C); -+ } -+ } -+ //Turn on CCA -+ ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, RXIQI); -+ //Restore RX idle low power -+ if(RxIdleLowPwr == TRUE) -+ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 1); -+ -+ psd_cnt++; -+ //gPrint("psd cnt=%d\n", psd_cnt); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PSD, DBG_LOUD,("PSD:psd_cnt = %d \n",psd_cnt)); -+ if (psd_cnt < ReScan) -+ { -+ ODM_SetTimer(pDM_Odm, &pRX_HP_Table->PSDTimer, Interval); //ms -+ } -+ else -+ { -+ psd_cnt = 0; -+ for(i=0;i<80;i++) -+ RT_TRACE( ODM_COMP_PSD, DBG_LOUD,("psd_report[%d]= %d \n", 2402+i, PSD_report[i])); -+ //DbgPrint("psd_report[%d]= %d \n", 2402+i, PSD_report[i]); -+ -+ GoodChannelDecision(pDM_Odm, PSD_report, PSD_bitmap,RSSI_BT, PSD_bitmap_memory); -+ -+ } -+} -+ -+void odm_Write_RXHP( -+ IN PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRXHP_T pRX_HP_Table = &pDM_Odm->DM_RXHP_Table; -+ u4Byte currentIGI; -+ -+ if(pRX_HP_Table->Cur_IGI != pRX_HP_Table->Pre_IGI) -+ { -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0, pRX_HP_Table->Cur_IGI); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XBAGCCore1, bMaskByte0, pRX_HP_Table->Cur_IGI); -+ } -+ -+ if(pRX_HP_Table->Cur_pw_th != pRX_HP_Table->Pre_pw_th) -+{ -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore2, BIT8|BIT9, pRX_HP_Table->Cur_pw_th); // RegC54[9:8]=2'b11: AGC Flow 3 -+ } -+ -+ if(pRX_HP_Table->RXHP_flag == 0) -+ { -+ pRX_HP_Table->Cur_IGI = 0x20; -+ } -+ else -+ { -+ currentIGI = ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0); -+ if(currentIGI<0x50) -+ { -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0, pRX_HP_Table->Cur_IGI); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XBAGCCore1, bMaskByte0, pRX_HP_Table->Cur_IGI); -+ } -+ } -+ pRX_HP_Table->Pre_IGI = pRX_HP_Table->Cur_IGI; -+ pRX_HP_Table->Pre_pw_th = pRX_HP_Table->Cur_pw_th; -+ -+} -+ -+ -+void odm_RXHP( -+ IN PVOID pDM_VOID) -+{ -+#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) | (DEV_BUS_TYPE == RT_USB_INTERFACE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ pRXHP_T pRX_HP_Table = &pDM_Odm->DM_RXHP_Table; -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_FALSEALMCNT); -+ -+ u1Byte i, j, sum; -+ u1Byte Is40MHz; -+ s1Byte Intf_diff_idx, MIN_Intf_diff_idx = 16; -+ s4Byte cur_channel; -+ u1Byte ch_map_intf_5M[17] = {0}; -+ static u4Byte FA_TH = 0; -+ static u1Byte psd_intf_flag = 0; -+ static s4Byte curRssi = 0; -+ static s4Byte preRssi = 0; -+ static u1Byte PSDTriggerCnt = 1; -+ -+ u1Byte RX_HP_enable = (u1Byte)(ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore2, bMaskDWord)>>31); // for debug!! -+ -+#if(DEV_BUS_TYPE == RT_USB_INTERFACE) -+ static s8Byte lastTxOkCnt = 0, lastRxOkCnt = 0; -+ s8Byte curTxOkCnt, curRxOkCnt; -+ s8Byte curTPOkCnt; -+ s8Byte TP_Acc3, TP_Acc5; -+ static s8Byte TP_Buff[5] = {0}; -+ static u1Byte pre_state = 0, pre_state_flag = 0; -+ static u1Byte Intf_HighTP_flag = 0, De_counter = 16; -+ static u1Byte TP_Degrade_flag = 0; -+#endif -+ static u1Byte LatchCnt = 0; -+ -+ if(pDM_Odm->SupportICType & (ODM_RTL8723A|ODM_RTL8188E)) -+ return; -+ //AGC RX High Power Mode is only applied on 2G band in 92D!!! -+ if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ { -+ if(*(pDM_Odm->pBandType) != ODM_BAND_2_4G) -+ return; -+ } -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_RXHP)) -+ return; -+ -+ -+ //RX HP ON/OFF -+ if(RX_HP_enable == 1) -+ pRX_HP_Table->RXHP_enable = FALSE; -+ else -+ pRX_HP_Table->RXHP_enable = TRUE; -+ -+ if(pRX_HP_Table->RXHP_enable == FALSE) -+ { -+ if(pRX_HP_Table->RXHP_flag == 1) -+ { -+ pRX_HP_Table->RXHP_flag = 0; -+ psd_intf_flag = 0; -+ } -+ return; -+ } -+ -+#if(DEV_BUS_TYPE == RT_USB_INTERFACE) -+ //2 Record current TP for USB interface -+ curTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast)-lastTxOkCnt; -+ curRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast)-lastRxOkCnt; -+ lastTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast); -+ lastRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast); -+ -+ curTPOkCnt = curTxOkCnt+curRxOkCnt; -+ TP_Buff[0] = curTPOkCnt; // current TP -+ TP_Acc3 = PlatformDivision64((TP_Buff[1]+TP_Buff[2]+TP_Buff[3]), 3); -+ TP_Acc5 = PlatformDivision64((TP_Buff[0]+TP_Buff[1]+TP_Buff[2]+TP_Buff[3]+TP_Buff[4]), 5); -+ -+ if(TP_Acc5 < 1000) -+ pRX_HP_Table->TP_Mode = Idle_Mode; -+ else if((1000 < TP_Acc5)&&(TP_Acc5 < 3750000)) -+ pRX_HP_Table->TP_Mode = Low_TP_Mode; -+ else -+ pRX_HP_Table->TP_Mode = High_TP_Mode; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RXHP, ODM_DBG_LOUD, ("RX HP TP Mode = %d\n", pRX_HP_Table->TP_Mode)); -+ // Since TP result would be sampled every 2 sec, it needs to delay 4sec to wait PSD processing. -+ // When LatchCnt = 0, we would Get PSD result. -+ if(TP_Degrade_flag == 1) -+ { -+ LatchCnt--; -+ if(LatchCnt == 0) -+ { -+ TP_Degrade_flag = 0; -+ } -+ } -+ // When PSD function triggered by TP degrade 20%, and Interference Flag = 1 -+ // Set a De_counter to wait IGI = upper bound. If time is UP, the Interference flag will be pull down. -+ if(Intf_HighTP_flag == 1) -+ { -+ De_counter--; -+ if(De_counter == 0) -+ { -+ Intf_HighTP_flag = 0; -+ psd_intf_flag = 0; -+ } -+ } -+#endif -+ -+ //2 AGC RX High Power Mode by PSD only applied to STA Mode -+ //3 NOT applied 1. Ad Hoc Mode. -+ //3 NOT applied 2. AP Mode -+ if ((pMgntInfo->mAssoc) && (!pMgntInfo->mIbss) && (!ACTING_AS_AP(Adapter))) -+ { -+ Is40MHz = *(pDM_Odm->pBandWidth); -+ curRssi = pDM_Odm->RSSI_Min; -+ cur_channel = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, 0x0fff) & 0x0f; -+ -+ /* check illegal channel and bandwidth */ -+ if (Is40MHz && ((cur_channel < 3) || (cur_channel > 12))) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RXHP, ODM_DBG_LOUD, ("illegal channel setting, 40MHz channel = %d\n", cur_channel)); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RXHP, ODM_DBG_LOUD, ("RXHP RX HP flag = %d\n", pRX_HP_Table->RXHP_flag)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RXHP, ODM_DBG_LOUD, ("RXHP FA = %d\n", FalseAlmCnt->Cnt_all)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RXHP, ODM_DBG_LOUD, ("RXHP cur RSSI = %d, pre RSSI=%d\n", curRssi, preRssi)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RXHP, ODM_DBG_LOUD, ("RXHP current CH = %d\n", cur_channel)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RXHP, ODM_DBG_LOUD, ("RXHP Is 40MHz = %d\n", Is40MHz)); -+ //2 PSD function would be triggered -+ //3 1. Every 4 sec for PCIE -+ //3 2. Before TP Mode (Idle TP<4kbps) for USB -+ //3 3. After TP Mode (High TP) for USB -+ if((curRssi > 68) && (pRX_HP_Table->RXHP_flag == 0)) // Only RSSI>TH and RX_HP_flag=0 will Do PSD process -+ { -+#if (DEV_BUS_TYPE == RT_USB_INTERFACE) -+ //2 Before TP Mode ==> PSD would be trigger every 4 sec -+ if(pRX_HP_Table->TP_Mode == Idle_Mode) //2.1 less wlan traffic <4kbps -+ { -+#endif -+ if(PSDTriggerCnt == 1) -+ { -+ odm_PSD_RXHP(pDM_Odm); -+ pRX_HP_Table->PSD_func_trigger = 1; -+ PSDTriggerCnt = 0; -+ } -+ else -+ { -+ PSDTriggerCnt++; -+ } -+#if(DEV_BUS_TYPE == RT_USB_INTERFACE) -+ } -+ //2 After TP Mode ==> Check if TP degrade larger than 20% would trigger PSD function -+ if(pRX_HP_Table->TP_Mode == High_TP_Mode) -+ { -+ if((pre_state_flag == 0)&&(LatchCnt == 0)) -+ { -+ // TP var < 5% -+ if((((curTPOkCnt-TP_Acc3)*20)<(TP_Acc3))&&(((curTPOkCnt-TP_Acc3)*20)>(-TP_Acc3))) -+ { -+ pre_state++; -+ if(pre_state == 3) // hit pre_state condition => consecutive 3 times -+ { -+ pre_state_flag = 1; -+ pre_state = 0; -+ } -+ -+ } -+ else -+ { -+ pre_state = 0; -+ } -+ } -+ //3 If pre_state_flag=1 ==> start to monitor TP degrade 20% -+ if(pre_state_flag == 1) -+ { -+ if(((TP_Acc3-curTPOkCnt)*5)>(TP_Acc3)) // degrade 20% -+ { -+ odm_PSD_RXHP(pDM_Odm); -+ pRX_HP_Table->PSD_func_trigger = 1; -+ TP_Degrade_flag = 1; -+ LatchCnt = 2; -+ pre_state_flag = 0; -+ } -+ else if(((TP_Buff[2]-curTPOkCnt)*5)>TP_Buff[2]) -+ { -+ odm_PSD_RXHP(pDM_Odm); -+ pRX_HP_Table->PSD_func_trigger = 1; -+ TP_Degrade_flag = 1; -+ LatchCnt = 2; -+ pre_state_flag = 0; -+ } -+ else if(((TP_Buff[3]-curTPOkCnt)*5)>TP_Buff[3]) -+ { -+ odm_PSD_RXHP(pDM_Odm); -+ pRX_HP_Table->PSD_func_trigger = 1; -+ TP_Degrade_flag = 1; -+ LatchCnt = 2; -+ pre_state_flag = 0; -+ } -+ } -+ } -+#endif -+} -+ -+#if (DEV_BUS_TYPE == RT_USB_INTERFACE) -+ for (i=0;i<4;i++) -+ { -+ TP_Buff[4-i] = TP_Buff[3-i]; -+ } -+#endif -+ //2 Update PSD bitmap according to PSD report -+ if((pRX_HP_Table->PSD_func_trigger == 1)&&(LatchCnt == 0)) -+ { -+ //2 Separate 80M bandwidth into 16 group with smaller 5M BW. -+ for (i = 0 ; i < 16 ; i++) -+ { -+ sum = 0; -+ for(j = 0; j < 5 ; j++) -+ sum += pRX_HP_Table->PSD_bitmap_RXHP[5*i + j]; -+ -+ if(sum < 5) -+ { -+ ch_map_intf_5M[i] = 1; // interference flag -+ } -+ } -+ //=============just for debug========================= -+ //for(i=0;i<16;i++) -+ //DbgPrint("RX HP: ch_map_intf_5M[%d] = %d\n", i, ch_map_intf_5M[i]); -+ //=============================================== -+ //2 Mask target channel 5M index -+ for(i = 0; i < (4+4*Is40MHz) ; i++) -+ { -+ ch_map_intf_5M[cur_channel - (1+2*Is40MHz) + i] = 0; -+ } -+ -+ psd_intf_flag = 0; -+ for(i = 0; i < 16; i++) -+ { -+ if(ch_map_intf_5M[i] == 1) -+ { -+ psd_intf_flag = 1; // interference is detected!!! -+ break; -+ } -+ } -+ -+#if (DEV_BUS_TYPE == RT_USB_INTERFACE) -+ if(pRX_HP_Table->TP_Mode!=Idle_Mode) -+ { -+ if(psd_intf_flag == 1) // to avoid psd_intf_flag always 1 -+ { -+ Intf_HighTP_flag = 1; -+ De_counter = 32; // 0x1E -> 0x3E needs 32 times by each IGI step =1 -+ } -+ } -+#endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RXHP, ODM_DBG_LOUD, ("RX HP psd_intf_flag = %d\n", psd_intf_flag)); -+ //2 Distance between target channel and interference -+ for(i = 0; i < 16; i++) -+ { -+ if(ch_map_intf_5M[i] == 1) -+ { -+ Intf_diff_idx = ((cur_channel+Is40MHz-(i+1))>0) ? (s1Byte)(cur_channel-2*Is40MHz-(i-2)) : (s1Byte)((i+1)-(cur_channel+2*Is40MHz)); -+ if(Intf_diff_idx < MIN_Intf_diff_idx) -+ MIN_Intf_diff_idx = Intf_diff_idx; // the min difference index between interference and target -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RXHP, ODM_DBG_LOUD, ("RX HP MIN_Intf_diff_idx = %d\n", MIN_Intf_diff_idx)); -+ //2 Choose False Alarm Threshold -+ switch (MIN_Intf_diff_idx){ -+ case 0: -+ case 1: -+ case 2: -+ case 3: -+ FA_TH = FA_RXHP_TH1; -+ break; -+ case 4: // CH5 -+ case 5: // CH6 -+ FA_TH = FA_RXHP_TH2; -+ break; -+ case 6: // CH7 -+ case 7: // CH8 -+ FA_TH = FA_RXHP_TH3; -+ break; -+ case 8: // CH9 -+ case 9: //CH10 -+ FA_TH = FA_RXHP_TH4; -+ break; -+ case 10: -+ case 11: -+ case 12: -+ case 13: -+ case 14: -+ case 15: -+ FA_TH = FA_RXHP_TH5; -+ break; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RXHP, ODM_DBG_LOUD, ("RX HP FA_TH = %d\n", FA_TH)); -+ pRX_HP_Table->PSD_func_trigger = 0; -+ } -+ //1 Monitor RSSI variation to choose the suitable IGI or Exit AGC RX High Power Mode -+ if(pRX_HP_Table->RXHP_flag == 1) -+ { -+ if ((curRssi > 80)&&(preRssi < 80)) -+ { -+ pRX_HP_Table->Cur_IGI = LNA_Low_Gain_1; -+ } -+ else if ((curRssi < 80)&&(preRssi > 80)) -+ { -+ pRX_HP_Table->Cur_IGI = LNA_Low_Gain_2; -+ } -+ else if ((curRssi > 72)&&(preRssi < 72)) -+ { -+ pRX_HP_Table->Cur_IGI = LNA_Low_Gain_2; -+ } -+ else if ((curRssi < 72)&&( preRssi > 72)) -+ { -+ pRX_HP_Table->Cur_IGI = LNA_Low_Gain_3; -+ } -+ else if (curRssi < 68) //RSSI is NOT large enough!!==> Exit AGC RX High Power Mode -+ { -+ pRX_HP_Table->Cur_pw_th = pw_th_10dB; -+ pRX_HP_Table->RXHP_flag = 0; // Back to Normal DIG Mode -+ psd_intf_flag = 0; -+ } -+ } -+ else // pRX_HP_Table->RXHP_flag == 0 -+ { -+ //1 Decide whether to enter AGC RX High Power Mode -+ if ((curRssi > 70) && (psd_intf_flag == 1) && (FalseAlmCnt->Cnt_all > FA_TH) && -+ (pDM_DigTable->CurIGValue == pDM_DigTable->rx_gain_range_max)) -+ { -+ if (curRssi > 80) -+ { -+ pRX_HP_Table->Cur_IGI = LNA_Low_Gain_1; -+ } -+ else if (curRssi > 72) -+ { -+ pRX_HP_Table->Cur_IGI = LNA_Low_Gain_2; -+ } -+ else -+ { -+ pRX_HP_Table->Cur_IGI = LNA_Low_Gain_3; -+ } -+ pRX_HP_Table->Cur_pw_th = pw_th_16dB; //RegC54[9:8]=2'b11: to enter AGC Flow 3 -+ pRX_HP_Table->First_time_enter = TRUE; -+ pRX_HP_Table->RXHP_flag = 1; // RXHP_flag=1: AGC RX High Power Mode, RXHP_flag=0: Normal DIG Mode -+ } -+ } -+ preRssi = curRssi; -+ odm_Write_RXHP(pDM_Odm); -+ } -+#endif //#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+#endif //#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) | (DEV_BUS_TYPE == RT_USB_INTERFACE) -+} -+ -+ -+VOID -+odm_PSD_RXHPCallback( -+ PRT_TIMER pTimer -+) -+{ -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ pRXHP_T pRX_HP_Table = &pDM_Odm->DM_RXHP_Table; -+ -+#if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ #if USE_WORKITEM -+ ODM_ScheduleWorkItem(&pRX_HP_Table->PSDTimeWorkitem); -+ #else -+ odm_PSD_RXHP(pDM_Odm); -+ #endif -+#else -+ ODM_ScheduleWorkItem(&pRX_HP_Table->PSDTimeWorkitem); -+#endif -+ -+ } -+ -+VOID -+odm_PSD_RXHPWorkitemCallback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER pAdapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ odm_PSD_RXHP(pDM_Odm); -+} -+ -+#endif //#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_rxhp.h linux/3rdparty/rtl8812au/hal/phydm/phydm_rxhp.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_rxhp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_rxhp.h 2017-06-07 23:07:21.020688396 +0300 -@@ -0,0 +1,105 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __PHYDMRXHP_H__ -+#define __PHYDMRXHP_H__ -+ -+#define RXHP_VERSION "1.0" -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+#define AFH_PSD 1 //0:normal PSD scan, 1: only do 20 pts PSD -+#define MODE_40M 0 //0:20M, 1:40M -+#define PSD_TH2 3 -+#define PSD_CHMIN 20 // Minimum channel number for BT AFH -+#define SIR_STEP_SIZE 3 -+#define Smooth_Size_1 5 -+#define Smooth_TH_1 3 -+#define Smooth_Size_2 10 -+#define Smooth_TH_2 4 -+#define Smooth_Size_3 20 -+#define Smooth_TH_3 4 -+#define Smooth_Step_Size 5 -+#define Adaptive_SIR 1 -+#define PSD_RESCAN 4 -+#define PSD_SCAN_INTERVAL 700 //ms -+ -+typedef struct _RX_High_Power_ -+{ -+ u1Byte RXHP_flag; -+ u1Byte PSD_func_trigger; -+ u1Byte PSD_bitmap_RXHP[80]; -+ u1Byte Pre_IGI; -+ u1Byte Cur_IGI; -+ u1Byte Pre_pw_th; -+ u1Byte Cur_pw_th; -+ BOOLEAN First_time_enter; -+ BOOLEAN RXHP_enable; -+ u1Byte TP_Mode; -+ RT_TIMER PSDTimer; -+ #if USE_WORKITEM -+ RT_WORK_ITEM PSDTimeWorkitem; -+ #endif -+}RXHP_T, *pRXHP_T; -+ -+#define dm_PSDMonitorCallback odm_PSDMonitorCallback -+VOID odm_PSDMonitorCallback(PRT_TIMER pTimer); -+ -+VOID -+odm_PSDMonitorInit( -+ IN PVOID pDM_VOID -+ ); -+ -+void odm_RXHPInit( -+ IN PVOID pDM_VOID); -+ -+void odm_RXHP( -+ IN PVOID pDM_VOID); -+ -+VOID -+odm_PSD_RXHPCallback( -+ PRT_TIMER pTimer -+); -+ -+ VOID -+ODM_PSDDbgControl( -+ IN PADAPTER Adapter, -+ IN u4Byte mode, -+ IN u4Byte btRssi -+ ); -+ -+ VOID -+odm_PSD_RXHPCallback( -+ PRT_TIMER pTimer -+); -+ -+VOID -+odm_PSD_RXHPWorkitemCallback( -+ IN PVOID pContext -+ ); -+ -+VOID -+odm_PSDMonitorWorkItemCallback( -+ IN PVOID pContext -+ ); -+ -+ #endif -+ -+ #endif -+ -\ Ingen nyrad vid filslut -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/phydm_types.h linux/3rdparty/rtl8812au/hal/phydm/phydm_types.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/phydm_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/phydm_types.h 2017-06-07 23:07:21.020688396 +0300 -@@ -0,0 +1,315 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __ODM_TYPES_H__ -+#define __ODM_TYPES_H__ -+ -+// -+// Define Different SW team support -+// -+#define ODM_AP 0x01 //BIT0 -+#define ODM_ADSL 0x02 //BIT1 -+#define ODM_CE 0x04 //BIT2 -+#define ODM_WIN 0x08 //BIT3 -+ -+// Deifne HW endian support -+#define ODM_ENDIAN_BIG 0 -+#define ODM_ENDIAN_LITTLE 1 -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define GET_PDM_ODM(__pAdapter) ((PDM_ODM_T)(&((GET_HAL_DATA(__pAdapter))->DM_OutSrc))) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#define GET_PDM_ODM(__pAdapter) ((PDM_ODM_T)(&((GET_HAL_DATA(__pAdapter))->odmpriv))) -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) -+#define RT_PCI_INTERFACE 1 -+#define RT_USB_INTERFACE 2 -+#define RT_SDIO_INTERFACE 3 -+#endif -+ -+typedef enum _HAL_STATUS{ -+ HAL_STATUS_SUCCESS, -+ HAL_STATUS_FAILURE, -+ /*RT_STATUS_PENDING, -+ RT_STATUS_RESOURCE, -+ RT_STATUS_INVALID_CONTEXT, -+ RT_STATUS_INVALID_PARAMETER, -+ RT_STATUS_NOT_SUPPORT, -+ RT_STATUS_OS_API_FAILED,*/ -+}HAL_STATUS,*PHAL_STATUS; -+ -+#if( DM_ODM_SUPPORT_TYPE == ODM_AP) -+#define MP_DRIVER 0 -+#endif -+#if(DM_ODM_SUPPORT_TYPE != ODM_WIN) -+ -+#define VISTA_USB_RX_REVISE 0 -+ -+// -+// Declare for ODM spin lock defintion temporarily fro compile pass. -+// -+typedef enum _RT_SPINLOCK_TYPE{ -+ RT_TX_SPINLOCK = 1, -+ RT_RX_SPINLOCK = 2, -+ RT_RM_SPINLOCK = 3, -+ RT_CAM_SPINLOCK = 4, -+ RT_SCAN_SPINLOCK = 5, -+ RT_LOG_SPINLOCK = 7, -+ RT_BW_SPINLOCK = 8, -+ RT_CHNLOP_SPINLOCK = 9, -+ RT_RF_OPERATE_SPINLOCK = 10, -+ RT_INITIAL_SPINLOCK = 11, -+ RT_RF_STATE_SPINLOCK = 12, // For RF state. Added by Bruce, 2007-10-30. -+#if VISTA_USB_RX_REVISE -+ RT_USBRX_CONTEXT_SPINLOCK = 13, -+ RT_USBRX_POSTPROC_SPINLOCK = 14, // protect data of Adapter->IndicateW/ IndicateR -+#endif -+ //Shall we define Ndis 6.2 SpinLock Here ? -+ RT_PORT_SPINLOCK=16, -+ RT_VNIC_SPINLOCK=17, -+ RT_HVL_SPINLOCK=18, -+ RT_H2C_SPINLOCK = 20, // For H2C cmd. Added by tynli. 2009.11.09. -+ -+ RT_BTData_SPINLOCK=25, -+ -+ RT_WAPI_OPTION_SPINLOCK=26, -+ RT_WAPI_RX_SPINLOCK=27, -+ -+ // add for 92D CCK control issue -+ RT_CCK_PAGEA_SPINLOCK = 28, -+ RT_BUFFER_SPINLOCK = 29, -+ RT_CHANNEL_AND_BANDWIDTH_SPINLOCK = 30, -+ RT_GEN_TEMP_BUF_SPINLOCK = 31, -+ RT_AWB_SPINLOCK = 32, -+ RT_FW_PS_SPINLOCK = 33, -+ RT_HW_TIMER_SPIN_LOCK = 34, -+ RT_MPT_WI_SPINLOCK = 35, -+ RT_P2P_SPIN_LOCK = 36, // Protect P2P context -+ RT_DBG_SPIN_LOCK = 37, -+ RT_IQK_SPINLOCK = 38, -+ RT_PENDED_OID_SPINLOCK = 39, -+ RT_CHNLLIST_SPINLOCK = 40, -+ RT_INDIC_SPINLOCK = 41, //protect indication -+ RT_RFD_SPINLOCK = 42, -+ RT_SYNC_IO_CNT_SPINLOCK = 43, -+ RT_LAST_SPINLOCK, -+}RT_SPINLOCK_TYPE; -+ -+#endif -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #define STA_INFO_T RT_WLAN_STA -+ #define PSTA_INFO_T PRT_WLAN_STA -+ -+ #define CONFIG_HW_ANTENNA_DIVERSITY -+ #define CONFIG_SW_ANTENNA_DIVERSITY -+ /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ -+ /*#define CONFIG_PATH_DIVERSITY*/ -+ /*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ -+ #define CONFIG_ANT_DETECTION -+ #define CONFIG_RA_DBG_CMD -+ -+ #define __func__ __FUNCTION__ -+ #define PHYDM_TESTCHIP_SUPPORT TESTCHIP_SUPPORT -+ #define bMaskH3Bytes 0xffffff00 -+ #define SUCCESS 0 -+ #define FAIL (-1) -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ // To let ADSL/AP project compile ok; it should be removed after all conflict are solved. Added by Annie, 2011-10-07. -+ #define ADSL_AP_BUILD_WORKAROUND -+ #define AP_BUILD_WORKAROUND -+ -+ //2 [ Configure RA Debug H2C CMD ] -+ #define CONFIG_RA_DBG_CMD -+ -+ /*#define CONFIG_PATH_DIVERSITY*/ -+ /*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ -+ -+ //2 [ Configure Antenna Diversity ] -+#if defined(CONFIG_RTL_8881A_ANT_SWITCH) || defined(CONFIG_SLOT_0_ANT_SWITCH) || defined(CONFIG_SLOT_1_ANT_SWITCH) -+ #define CONFIG_HW_ANTENNA_DIVERSITY -+ #define ODM_EVM_ENHANCE_ANTDIV -+ -+ //---------- -+ #if(!defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A) && !defined(CONFIG_2G_CGCS_RX_DIVERSITY) && !defined(CONFIG_2G_CG_TRX_DIVERSITY) && !defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ #define CONFIG_NO_2G_DIVERSITY -+ #endif -+ -+ #ifdef CONFIG_NO_5G_DIVERSITY_8881A -+ #define CONFIG_NO_5G_DIVERSITY -+ #elif defined(CONFIG_5G_CGCS_RX_DIVERSITY_8881A) -+ #define CONFIG_5G_CGCS_RX_DIVERSITY -+ #elif defined(CONFIG_5G_CG_TRX_DIVERSITY_8881A) -+ #define CONFIG_5G_CG_TRX_DIVERSITY -+ #elif defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A) -+ #define CONFIG_2G5G_CG_TRX_DIVERSITY -+ #endif -+ #if(!defined(CONFIG_NO_5G_DIVERSITY) && !defined(CONFIG_5G_CGCS_RX_DIVERSITY) && !defined(CONFIG_5G_CG_TRX_DIVERSITY) && !defined(CONFIG_2G5G_CG_TRX_DIVERSITY) && !defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) -+ #define CONFIG_NO_5G_DIVERSITY -+ #endif -+ //---------- -+ #if ( defined(CONFIG_NO_2G_DIVERSITY) && defined(CONFIG_NO_5G_DIVERSITY) ) -+ #define CONFIG_NOT_SUPPORT_ANTDIV -+ #elif( !defined(CONFIG_NO_2G_DIVERSITY) && defined(CONFIG_NO_5G_DIVERSITY) ) -+ #define CONFIG_2G_SUPPORT_ANTDIV -+ #elif( defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_NO_5G_DIVERSITY) ) -+ #define CONFIG_5G_SUPPORT_ANTDIV -+ #elif( (!defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_NO_5G_DIVERSITY)) || defined(CONFIG_2G5G_CG_TRX_DIVERSITY) ) -+ #define CONFIG_2G5G_SUPPORT_ANTDIV -+ #endif -+ //---------- -+#endif -+ #ifdef AP_BUILD_WORKAROUND -+ #include "../typedef.h" -+ #else -+ typedef void VOID,*PVOID; -+ typedef unsigned char BOOLEAN,*PBOOLEAN; -+ typedef unsigned char u1Byte,*pu1Byte; -+ typedef unsigned short u2Byte,*pu2Byte; -+ typedef unsigned int u4Byte,*pu4Byte; -+ typedef unsigned long long u8Byte,*pu8Byte; -+#if 1 -+/* In ARM platform, system would use the type -- "char" as "unsigned char" -+ * And we only use s1Byte/ps1Byte as INT8 now, so changes the type of s1Byte.*/ -+ typedef signed char s1Byte,*ps1Byte; -+#else -+ typedef char s1Byte,*ps1Byte; -+#endif -+ typedef short s2Byte,*ps2Byte; -+ typedef long s4Byte,*ps4Byte; -+ typedef long long s8Byte,*ps8Byte; -+ #endif -+ -+ typedef struct rtl8192cd_priv *prtl8192cd_priv; -+ typedef struct stat_info STA_INFO_T,*PSTA_INFO_T; -+ typedef struct timer_list RT_TIMER, *PRT_TIMER; -+ typedef void * RT_TIMER_CALL_BACK; -+ -+#ifdef CONFIG_PCI_HCI -+ #define DEV_BUS_TYPE RT_PCI_INTERFACE -+#endif -+ -+ #define _TRUE 1 -+ #define _FALSE 0 -+ -+ #if (defined(TESTCHIP_SUPPORT)) -+ #define PHYDM_TESTCHIP_SUPPORT 1 -+ #else -+ #define PHYDM_TESTCHIP_SUPPORT 0 -+ #endif -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include -+ -+ /*#define CONFIG_RA_DBG_CMD*/ -+ /*#define CONFIG_ANT_DETECTION*/ -+ /*#define CONFIG_PATH_DIVERSITY*/ -+ /*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ -+ -+#if 0 -+ typedef u8 u1Byte, *pu1Byte; -+ typedef u16 u2Byte,*pu2Byte; -+ typedef u32 u4Byte,*pu4Byte; -+ typedef u64 u8Byte,*pu8Byte; -+ typedef s8 s1Byte,*ps1Byte; -+ typedef s16 s2Byte,*ps2Byte; -+ typedef s32 s4Byte,*ps4Byte; -+ typedef s64 s8Byte,*ps8Byte; -+#else -+ #define u1Byte u8 -+ #define pu1Byte u8* -+ -+ #define u2Byte u16 -+ #define pu2Byte u16* -+ -+ #define u4Byte u32 -+ #define pu4Byte u32* -+ -+ #define u8Byte u64 -+ #define pu8Byte u64* -+ -+ #define s1Byte s8 -+ #define ps1Byte s8* -+ -+ #define s2Byte s16 -+ #define ps2Byte s16* -+ -+ #define s4Byte s32 -+ #define ps4Byte s32* -+ -+ #define s8Byte s64 -+ #define ps8Byte s64* -+ -+#endif -+ #ifdef CONFIG_USB_HCI -+ #define DEV_BUS_TYPE RT_USB_INTERFACE -+ #elif defined(CONFIG_PCI_HCI) -+ #define DEV_BUS_TYPE RT_PCI_INTERFACE -+ #elif defined(CONFIG_SDIO_HCI) -+ #define DEV_BUS_TYPE RT_SDIO_INTERFACE -+ #elif defined(CONFIG_GSPI_HCI) -+ #define DEV_BUS_TYPE RT_SDIO_INTERFACE -+ #endif -+ -+ -+ #if defined(CONFIG_LITTLE_ENDIAN) -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE -+ #elif defined (CONFIG_BIG_ENDIAN) -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG -+ #endif -+ -+ typedef struct timer_list RT_TIMER, *PRT_TIMER; -+ typedef void * RT_TIMER_CALL_BACK; -+ #define STA_INFO_T struct sta_info -+ #define PSTA_INFO_T struct sta_info * -+ -+ -+ -+ #define TRUE _TRUE -+ #define FALSE _FALSE -+ -+ -+ #define SET_TX_DESC_ANTSEL_A_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 1, __Value) -+ #define SET_TX_DESC_ANTSEL_B_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 25, 1, __Value) -+ #define SET_TX_DESC_ANTSEL_C_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 29, 1, __Value) -+ -+ //define useless flag to avoid compile warning -+ #define USE_WORKITEM 0 -+ #define FOR_BRAZIL_PRETEST 0 -+ /*#define BT_30_SUPPORT 0*/ -+ #define FPGA_TWO_MAC_VERIFICATION 0 -+ #define RTL8881A_SUPPORT 0 -+ -+ #if (defined(TESTCHIP_SUPPORT)) -+ #define PHYDM_TESTCHIP_SUPPORT 1 -+ #else -+ #define PHYDM_TESTCHIP_SUPPORT 0 -+ #endif -+#endif -+ -+#define READ_NEXT_PAIR(v1, v2, i) do { if (i+2 >= ArrayLen) break; i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+#define COND_ELSE 2 -+#define COND_ENDIF 3 -+ -+#endif // __ODM_TYPES_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtchnlplan.c linux/3rdparty/rtl8812au/hal/phydm/rtchnlplan.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtchnlplan.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtchnlplan.c 2017-06-07 23:07:21.020688396 +0300 -@@ -0,0 +1,480 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+/****************************************************************************** -+ -+ History: -+ Data Who Remark (Internal History) -+ -+ 05/14/2012 MH Collect RTK inernal infromation and generate channel plan draft. -+ -+******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "rtchnlplan.h" -+ -+ -+ -+// -+// Channel Plan Domain Code -+// -+ -+/* -+ Channel Plan Contents -+ Domain Code EEPROM Countries in Specific Domain -+ 2G RD 5G RD Bit[6:0] 2G 5G -+ Case Old Define 00h~1Fh Old Define Old Define -+ 1 2G_WORLD 5G_NULL 20h Worldwird 13 NA -+ 2 2G_ETSI1 5G_NULL 21h Europe 2G NA -+ 3 2G_FCC1 5G_NULL 22h US 2G NA -+ 4 2G_MKK1 5G_NULL 23h Japan 2G NA -+ 5 2G_ETSI2 5G_NULL 24h France 2G NA -+ 6 2G_FCC1 5G_FCC1 25h US 2G US 5G Kj{ -+ 7 2G_WORLD 5G_ETSI1 26h Worldwird 13 Europe Kj{ -+ 8 2G_MKK1 5G_MKK1 27h Japan 2G Japan 5G Kj{ -+ 9 2G_WORLD 5G_KCC1 28h Worldwird 13 Korea Kj{ -+ 10 2G_WORLD 5G_FCC2 29h Worldwird 13 US o/w DFS Channels -+ 11 2G_WORLD 5G_FCC3 30h Worldwird 13 India, Mexico -+ 12 2G_WORLD 5G_FCC4 31h Worldwird 13 Venezuela -+ 13 2G_WORLD 5G_FCC5 32h Worldwird 13 China -+ 14 2G_WORLD 5G_FCC6 33h Worldwird 13 Israel -+ 15 2G_FCC1 5G_FCC7 34h US 2G US/Canada Kj{ -+ 16 2G_WORLD 5G_ETSI2 35h Worldwird 13 Australia, New Zealand Kj{ -+ 17 2G_WORLD 5G_ETSI3 36h Worldwird 13 Russia -+ 18 2G_MKK1 5G_MKK2 37h Japan 2G Japan (W52, W53) -+ 19 2G_MKK1 5G_MKK3 38h Japan 2G Japan (W56) -+ 20 2G_FCC1 5G_NCC1 39h US 2G Taiwan Kj{ -+ -+ NA 2G_WORLD 5G_FCC1 7F FCC FCC DFS Channels Realtek Define -+ -+ -+ -+ -+ -+ 2.4G Regulatory Domains -+ Case 2G RD Regulation Channels Frequencyes Note Countries in Specific Domain -+ 1 2G_WORLD ETSI 1~13 2412~2472 Passive scan CH 12, 13 Worldwird 13 -+ 2 2G_ETSI1 ETSI 1~13 2412~2472 Europe -+ 3 2G_FCC1 FCC 1~11 2412~2462 US -+ 4 2G_MKK1 MKK 1~13, 14 2412~2472, 2484 Japan -+ 5 2G_ETSI2 ETSI 10~13 2457~2472 France -+ -+ -+ -+ -+ 5G Regulatory Domains -+ Case 5G RD Regulation Channels Frequencyes Note Countries in Specific Domain -+ 1 5G_NULL NA NA NA Do not support 5GHz -+ 2 5G_ETSI1 ETSI "36~48, 52~64, -+ 100~140" "5180~5240, 5260~5230 -+ 5500~5700" Band1, Ban2, Band3 Europe -+ 3 5G_ETSI2 ETSI "36~48, 52~64, -+ 100~140, 149~165" "5180~5240, 5260~5230 -+ 5500~5700, 5745~5825" Band1, Ban2, Band3, Band4 Australia, New Zealand -+ 4 5G_ETSI3 ETSI "36~48, 52~64, -+ 100~132, 149~165" -+ "5180~5240, 5260~5230 -+ 5500~5660, 5745~5825" Band1, Ban2, Band3(except CH 136, 140), Band4" Russia -+ 5 5G_FCC1 FCC "36~48, 52~64, -+ 100~140, 149~165" -+ "5180~5240, 5260~5230 -+ 5500~5700, 5745~5825" Band1(5150~5250MHz), -+ Band2(5250~5350MHz), -+ Band3(5470~5725MHz), -+ Band4(5725~5850MHz)" US -+ 6 5G_FCC2 FCC 36~48, 149~165 5180~5240, 5745~5825 Band1, Band4 FCC o/w DFS Channels -+ 7 5G_FCC3 FCC "36~48, 52~64, -+ 149~165" "5180~5240, 5260~5230 -+ 5745~5825" Band1, Ban2, Band4 India, Mexico -+ 8 5G_FCC4 FCC "36~48, 52~64, -+ 149~161" "5180~5240, 5260~5230 -+ 5745~5805" Band1, Ban2, -+ Band4(except CH 165)" Venezuela -+ 9 5G_FCC5 FCC 149~165 5745~5825 Band4 China -+ 10 5G_FCC6 FCC 36~48, 52~64 5180~5240, 5260~5230 Band1, Band2 Israel -+ 11 5G_FCC7 -+ 5G_IC1 FCC -+ IC" "36~48, 52~64, -+ 100~116, 136, 140, -+ 149~165" "5180~5240, 5260~5230 -+ 5500~5580, 5680, 5700, -+ 5745~5825" "Band1, Band2, -+ Band3(except 5600~5650MHz), -+ Band4" "US -+ Canada" -+ 12 5G_KCC1 KCC "36~48, 52~64, -+ 100~124, 149~165" "5180~5240, 5260~5230 -+ 5500~5620, 5745~5825" "Band1, Ban2, -+ Band3(5470~5650MHz), -+ Band4" Korea -+ 13 5G_MKK1 MKK "36~48, 52~64, -+ 100~140" "5180~5240, 5260~5230 -+ 5500~5700" W52, W53, W56 Japan -+ 14 5G_MKK2 MKK 36~48, 52~64 5180~5240, 5260~5230 W52, W53 Japan (W52, W53) -+ 15 5G_MKK3 MKK 100~140 5500~5700 W56 Japan (W56) -+ 16 5G_NCC1 NCC "56~64, -+ 100~116, 136, 140, -+ 149~165" "5260~5320 -+ 5500~5580, 5680, 5700, -+ 5745~5825" "Band2(except CH 52), -+ Band3(except 5600~5650MHz), -+ Band4" Taiwan -+ -+ -+*/ -+ -+// -+// 2.4G CHannel -+// -+/* -+ -+ 2.4G Band Regulatory Domains RTL8192D -+ Channel Number Channel Frequency US Canada Europe Spain France Japan Japan 20M 40M -+ (MHz) (FCC) (IC) (ETSI) (MPHPT) -+ 1 2412 v v v v v -+ 2 2417 v v v v v -+ 3 2422 v v v v v v -+ 4 2427 v v v v v v -+ 5 2432 v v v v v v -+ 6 2437 v v v v v v -+ 7 2442 v v v v v v -+ 8 2447 v v v v v v -+ 9 2452 v v v v v v -+ 10 2457 v v v v v v v v -+ 11 2462 v v v v v v v v -+ 12 2467 v v v v v -+ 13 2472 v v v v -+ 14 2484 v v -+ -+ -+*/ -+ -+ -+// -+// 5G Operating Channel -+// -+/* -+ -+ 5G Band RTL8192D RTL8195 (Jaguar) Jaguar 2 Regulatory Domains -+ Channel Number Channel Frequency Global Global Global "US -+(FCC 15.407)" "Canada -+(FCC, except 5.6~5.65GHz)" Argentina, Australia, New Zealand, Brazil, S. Africa (FCC/ETSI) "Europe -+(CE 301 893)" China India, Mexico, Singapore Israel, Turkey "Japan -+(MIC Item 19-3, 19-3-2)" Korea Russia, Ukraine "Taiwan -+(NCC)" Venezuela -+ (MHz) (20MHz) (20MHz) (40MHz) (80MHz) (160MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) -+"Band 1 -+5.15GHz -+~ -+5.25GHz" 36 5180 v v v v v Indoor Indoor v Indoor v Indoor Indoor v v v -+ 40 5200 v v v Indoor Indoor v Indoor v Indoor Indoor v v v -+ 44 5220 v v v v Indoor Indoor v Indoor v Indoor Indoor v v v -+ 48 5240 v v v Indoor Indoor v Indoor v Indoor Indoor v v v -+"Band 2 -+5.25GHz -+~ -+5.35GHz -+(DFS)" 52 5260 v v v v v v v v Indoor v Indoor Indoor v v v -+ 56 5280 v v v v v v Indoor v Indoor Indoor v v Indoor v -+ 60 5300 v v v v v v v Indoor v Indoor Indoor v v Indoor v -+ 64 5320 v v v v v v Indoor v Indoor Indoor v v Indoor v -+ -+"Band 3 -+5.47GHz -+~ -+5.725GHz -+(DFS)" 100 5500 v v v v v v v v v v v v v -+ 104 5520 v v v v v v v v v v v -+ 108 5540 v v v v v v v v v v v v -+ 112 5560 v v v v v v v v v v v -+ 116 5580 v v v v v v v v v v v v v -+ 120 5600 v v v Indoor v Indoor v v v -+ 124 5620 v v v v Indoor v Indoor v v v -+ 128 5640 v v v Indoor v Indoor v v -+ 132 5660 v v v E v Indoor v Indoor v v -+ 136 5680 v v v v v v v v v -+ 140 5700 v v E v v v v v v v -+ 144 5720 E E E -+"Band 4 -+5.725GHz -+~ -+5.85GHz -+(~5.9GHz)" 149 5745 v v v v v v v v v v v v v v -+ 153 5765 v v v v v v v v v v v v -+ 157 5785 v v v v v v v v v v v v v -+ 161 5805 v v v v v v v v v v v v -+ 165 5825 v v P P v v v v v v v v v -+ 169 5845 P P P -+ 173 5865 P P P P -+ 177 5885 P P P -+Channel Count 28 28 14 7 0 28 24 20 24 19 5 13 8 19 20 22 15 12 -+ E: FCC accepted the ask for CH144 from Accord. PS: 160MHz 80MHz+80MHz{H Argentina Belgium (Q) India Israel Russia -+ P: Customer's requirement from James. Australia The Netherlands () Mexico Turkey Ukraine -+ New Zealand UK (^) Singapore -+ Brazil Switzerland (h) -+ -+ -+*/ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+ -+// define Maximum Power v.s each band for each region -+// ISRAEL -+// Format: -+// RT_CHANNEL_DOMAIN_Region ={{{Chnl_Start, Chnl_end, Pwr_dB_Max}, {Chn2_Start, Chn2_end, Pwr_dB_Max}, {Chn3_Start, Chn3_end, Pwr_dB_Max}, {Chn4_Start, Chn4_end, Pwr_dB_Max}, {Chn5_Start, Chn5_end, Pwr_dB_Max}}, Limit_Num} */ -+// RT_CHANNEL_DOMAIN_FCC ={{{01,11,30}, {36,48,17}, {52,64,24}, {100,140,24}, {149,165,30}}, 5} -+// "NR" is non-release channle. -+// Issue--- Israel--Russia--New Zealand -+// DOMAIN_01= (2G_WORLD, 5G_NULL) -+// DOMAIN_02= (2G_ETSI1, 5G_NULL) -+// DOMAIN_03= (2G_FCC1, 5G_NULL) -+// DOMAIN_04= (2G_MKK1, 5G_NULL) -+// DOMAIN_05= (2G_ETSI2, 5G_NULL) -+// DOMAIN_06= (2G_FCC1, 5G_FCC1) -+// DOMAIN_07= (2G_WORLD, 5G_ETSI1) -+// DOMAIN_08= (2G_MKK1, 5G_MKK1) -+// DOMAIN_09= (2G_WORLD, 5G_KCC1) -+// DOMAIN_10= (2G_WORLD, 5G_FCC2) -+// DOMAIN_11= (2G_WORLD, 5G_FCC3)----india -+// DOMAIN_12= (2G_WORLD, 5G_FCC4)----Venezuela -+// DOMAIN_13= (2G_WORLD, 5G_FCC5)----China -+// DOMAIN_14= (2G_WORLD, 5G_FCC6)----Israel -+// DOMAIN_15= (2G_FCC1, 5G_FCC7)-----Canada -+// DOMAIN_16= (2G_WORLD, 5G_ETSI2)---Australia -+// DOMAIN_17= (2G_WORLD, 5G_ETSI3)---Russia -+// DOMAIN_18= (2G_MKK1, 5G_MKK2)-----Japan -+// DOMAIN_19= (2G_MKK1, 5G_MKK3)-----Japan -+// DOMAIN_20= (2G_FCC1, 5G_NCC1)-----Taiwan -+// DOMAIN_21= (2G_FCC1, 5G_NCC1)-----Taiwan -+ -+ -+static RT_CHANNEL_PLAN_MAXPWR ChnlPlanPwrMax_2G[] = { -+ -+ // 2G_WORLD, -+ {{1, 13, 20}, 1}, -+ -+ // 2G_ETSI1 -+ {{1, 13, 20}, 1}, -+ -+ /* RT_CHANNEL_DOMAIN_ETSI */ -+ {{{1, 11, 17}, {40, 56, 17}, {60, 128, 17}, {0, 0, 0}, {149, 165, 17}}, 4}, -+ -+ // RT_CHANNEL_DOMAIN_MKK -+ {{{1, 11, 17}, {0, 0, 0}, {0, 0, 0}, {0, 0, 0}, {0, 0, 0}}, 1}, -+ -+ // Add new channel plan mex power table. -+ // ...... -+ }; -+ -+ -+/* -+//===========================================1:(2G_WORLD, 5G_NULL) -+ -+RT_CHANNEL_PLAN_MAXPWR RT_DOMAIN_01 ={{{01,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} -+ -+//===========================================2:(2G_ETSI1, 5G_NULL) -+ -+RT_DOMAIN_02 ={{{01,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} -+ -+//===========================================3:(2G_FCC1, 5G_NULL) -+ -+RT_DOMAIN_03 ={{{01,11,30}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} -+ -+//===========================================4:(2G_MKK1, 5G_NULL) -+ -+RT_DOMAIN_04 ={{{01,14,23}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} -+ -+//===========================================5:(2G_ETSI2, 5G_NULL) -+ -+RT_DOMAIN_05 ={{{10,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} -+ -+//===========================================6:(2G_FCC1, 5G_FCC1) -+ -+RT_DOMAIN_06 ={{{01,13,30}, {36,48,17}, {52,64,24}, {100,140,24}, {149,165,30}}, 5} -+ -+//===========================================7:(2G_WORLD, 5G_ETSI1) -+ -+RT_DOMAIN_07 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,140,30}, {NR,NR,0}}, 4} -+ -+//===========================================8:(2G_MKK1, 5G_MKK1) -+ -+RT_DOMAIN_08 ={{{01,14,23}, {36,48,23}, {52,64,23}, {100,140,23}, {NR,NR,0}}, 4} -+ -+//===========================================9:(2G_WORLD, 5G_KCC1) -+ -+RT_DOMAIN_09 ={{{01,13,20}, {36,48,17}, {52,64,23}, {100,124,23}, {149,165,23}}, 5} -+ -+//===========================================10:(2G_WORLD, 5G_FCC2) -+ -+RT_DOMAIN_10 ={{{01,13,20}, {36,48,17}, {NR,NR,0}, {NR,NR,0}, {149,165,30}}, 3} -+ -+//===========================================11:(2G_WORLD, 5G_FCC3) -+RT_DOMAIN_11 ={{{01,13,20}, {36,48,23}, {52,64,23}, {NR,NR,0}, {149,165,23}}, 4} -+ -+//===========================================12:(2G_WORLD, 5G_FCC4) -+RT_DOMAIN_12 ={{{01,13,20}, {36,48,24}, {52,64,24}, {NR,NR,0}, {149,161,27}}, 4} -+ -+//===========================================13:(2G_WORLD, 5G_FCC5) -+RT_DOMAIN_13 ={{{01,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {149,165,27}}, 2} -+ -+//===========================================14:(2G_WORLD, 5G_FCC6) -+RT_DOMAIN_14 ={{{01,13,20}, {36,48,17}, {52,64,17}, {NR,NR,0}, {NR,NR,0}}, 3} -+ -+//===========================================15:(2G_FCC1, 5G_FCC7) -+RT_DOMAIN_15 ={{{01,11,30}, {36,48,23}, {52,64,24}, {100,140,24}, {149,165,30}}, 5} -+ -+//===========================================16:(2G_WORLD, 5G_ETSI2) -+RT_DOMAIN_16 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,140,30}, {149,165,30}}, 5} -+ -+//===========================================17:(2G_WORLD, 5G_ETSI3) -+RT_DOMAIN_17 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,132,30}, {149,165,20}}, 5} -+ -+//===========================================18:(2G_MKK1, 5G_MKK2) -+RT_DOMAIN_18 ={{{01,14,23}, {36,48,23}, {52,64,23}, {NR,NR,0}, {NR,NR,0}}, 3} -+ -+//===========================================19:(2G_MKK1, 5G_MKK3) -+RT_DOMAIN_19 ={{{01,14,23}, {NR,NR,0}, {NR,NR,0}, {100,140,23}, {NR,NR,0}}, 2} -+ -+//===========================================20:(2G_FCC1, 5G_NCC1) -+RT_DOMAIN_20 ={{{01,11,30}, {NR,NR,0}, {56,64,23}, {100,140,24}, {149,165,30}}, 4} -+ -+//===========================================21:(2G_FCC1, 5G_NCC2) -+RT_DOMAIN_21 ={{{01,11,30}, {NR,NR,0}, {56,64,23}, {NR,NR,0}, {149,165,30}}, 3} -+ -+//===========================================22:(2G_WORLD, 5G_FCC3) -+RT_DOMAIN_22 ={{{01,13,24}, {36,48,20}, {52,64,24}, {NR,NR,0}, {149,165,30}}, 4} -+ -+//===========================================23:(2G_WORLD, 5G_ETSI2) -+RT_DOMAIN_23 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,140,30}, {149,165,30}}, 5} -+ -+*/ -+ -+// -+// Counter & Realtek Channel plan transfer table. -+// -+RT_CHNL_CTRY_TBL RtCtryChnlTbl[] = -+{ -+ -+ { -+ RT_CTRY_AL, // "Albaniaڥ" -+ "AL", -+ RT_2G_WORLD, -+ RT_5G_WORLD, -+ RT_CHANNEL_DOMAIN_UNDEFINED // 2G/5G world. -+ }, -+#if 0 -+ { -+ RT_CTRY_BB, // "Barbadosڤڦh" -+ "BB", -+ RT_2G_WORLD, -+ RT_5G_NULL, -+ RT_CHANNEL_DOMAIN_EFUSE_0x20 // 2G world. 5G_NULL -+ }, -+ -+ { -+ RT_CTRY_DE, // "Germanyw" -+ "DE", -+ RT_2G_WORLD, -+ RT_5G_ETSI1, -+ RT_CHANNEL_DOMAIN_EFUSE_0x26 -+ }, -+ -+ { -+ RT_CTRY_US, // "Germanyw" -+ "US", -+ RT_2G_FCC1, -+ RT_5G_FCC7, -+ RT_CHANNEL_DOMAIN_EFUSE_0x34 -+ }, -+ -+ { -+ RT_CTRY_JP, // "Germanyw" -+ "JP", -+ RT_2G_MKK1, -+ RT_5G_MKK1, -+ RT_CHANNEL_DOMAIN_EFUSE_0x34 -+ }, -+ -+ { -+ RT_CTRY_TW, // "Germanyw" -+ "TW", -+ RT_2G_FCC1, -+ RT_5G_NCC1, -+ RT_CHANNEL_DOMAIN_EFUSE_0x39 -+ }, -+#endif -+ -+}; // RtCtryChnlTbl -+ -+// -+// Realtek Defined Channel plan. -+// -+#if 0 -+ -+static RT_CHANNEL_PLAN_NEW RtChnlPlan[] = -+{ -+ // Channel Plan 0x20. -+ { -+ &RtCtryChnlTbl[1], // RT_CHNL_CTRY_TBL Country & channel plan transfer table. -+ RT_CHANNEL_DOMAIN_EFUSE_0x20, // RT_CHANNEL_DOMAIN RT Channel Plan Define -+ RT_2G_WORLD, // RT_REGULATION_2G -+ RT_5G_NULL, // RT_REGULATION_5G -+ RT_WORLD, // RT_REGULATION_CMN RT Regulatory domain definition. -+ RT_SREQ_NA, // RT Channel plan special & customerize requirement. -+ -+ CHNL_RT_2G_WORLD, -+ CHNL_RT_2G_WORLD_SCAN_TYPE, -+ &ChnlPlanPwrMax_2G[0], -+ -+ CHNL_RT_5G_NULL, -+ CHNL_RT_5G_NULL_SCAN_TYPE, -+ -+ -+ }, -+ -+ // Channel Plan 0x26. -+ { -+ &RtCtryChnlTbl[1], // RT_CHNL_CTRY_TBL Country & channel plan transfer table. -+ RT_CHANNEL_DOMAIN_EFUSE_0x26, // RT_CHANNEL_DOMAIN RT Channel Plan Define -+ RT_2G_WORLD, // RT_REGULATION_2G -+ RT_5G_ETSI1, // RT_REGULATION_5G -+ RT_WORLD, // RT_REGULATION_CMN RT Regulatory domain definition. -+ RT_SREQ_NA, // RT Channel plan special & customerize requirement. -+ -+ CHNL_RT_2G_WORLD, // 2G workd cannel -+ CHNL_RT_2G_WORLD_SCAN_TYPE, -+ &ChnlPlanPwrMax_2G[1], -+ -+ CHNL_RT_5G_ETSI1, -+ CHNL_RT_5G_ETSI1_SCAN_TYPE, -+ -+ } -+ -+ -+}; -+#endif -+ -+ -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtchnlplan.h linux/3rdparty/rtl8812au/hal/phydm/rtchnlplan.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtchnlplan.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtchnlplan.h 2017-06-07 23:07:21.020688396 +0300 -@@ -0,0 +1,699 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __RT_CHANNELPLAN_H__ -+#define __RT_CHANNELPLAN_H__ -+ -+typedef enum _RT_CHANNEL_DOMAIN_NEW -+{ -+ -+ //===== Add new channel plan above this line ===============// -+ -+ // For new architecture we define different 2G/5G CH area for all country. -+ // 2.4 G only -+ RT_CHANNEL_DOMAIN_2G_WORLD_5G_NULL = 0x20, -+ RT_CHANNEL_DOMAIN_2G_ETSI1_5G_NULL = 0x21, -+ RT_CHANNEL_DOMAIN_2G_FCC1_5G_NULL = 0x22, -+ RT_CHANNEL_DOMAIN_2G_MKK1_5G_NULL = 0x23, -+ RT_CHANNEL_DOMAIN_2G_ETSI2_5G_NULL = 0x24, -+ // 2.4 G + 5G type 1 -+ RT_CHANNEL_DOMAIN_2G_FCC1_5G_FCC1 = 0x25, -+ RT_CHANNEL_DOMAIN_2G_WORLD_5G_ETSI1 = 0x26, -+ //RT_CHANNEL_DOMAIN_2G_WORLD_5G_ETSI1 = 0x27, -+ // ..... -+ -+ RT_CHANNEL_DOMAIN_MAX_NEW, -+ -+}RT_CHANNEL_DOMAIN_NEW, *PRT_CHANNEL_DOMAIN_NEW; -+ -+ -+#if 0 -+#define DOMAIN_CODE_2G_WORLD \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -+#define DOMAIN_CODE_2G_ETSI1 \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -+#define DOMAIN_CODE_2G_ETSI2 \ -+ {1,2,3,4,5,6,7,8,9,10,11}, 11 -+#define DOMAIN_CODE_2G_FCC1 \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13,14}, 14 -+#define DOMAIN_CODE_2G_MKK1 \ -+ {10,11,12,13}, 4 -+ -+#define DOMAIN_CODE_5G_ETSI1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -+#define DOMAIN_CODE_5G_ETSI2 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -+#define DOMAIN_CODE_5G_ETSI3 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165}, 22 -+#define DOMAIN_CODE_5G_FCC1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -+#define DOMAIN_CODE_5G_FCC2 \ -+ {36,40,44,48,149,153,157,161,165}, 9 -+#define DOMAIN_CODE_5G_FCC3 \ -+ {36,40,44,48,52,56,60,64,149,153,157,161,165}, 13 -+#define DOMAIN_CODE_5G_FCC4 \ -+ {36,40,44,48,52,56,60,64,149,153,157,161}, 12 -+#define DOMAIN_CODE_5G_FCC5 \ -+ {149,153,157,161,165}, 5 -+#define DOMAIN_CODE_5G_FCC6 \ -+ {36,40,44,48,52,56,60,64}, 8 -+#define DOMAIN_CODE_5G_FCC7 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -+#define DOMAIN_CODE_5G_IC1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -+#define DOMAIN_CODE_5G_KCC1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165}, 20 -+#define DOMAIN_CODE_5G_MKK1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -+#define DOMAIN_CODE_5G_MKK2 \ -+ {36,40,44,48,52,56,60,64}, 8 -+#define DOMAIN_CODE_5G_MKK3 \ -+ {100,104,108,112,116,120,124,128,132,136,140}, 11 -+#define DOMAIN_CODE_5G_NCC1 \ -+ {56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 24 -+#define DOMAIN_CODE_5G_NCC2 \ -+ {56,60,64,149,153,157,161,165}, 8 -+#define UNDEFINED \ -+ {0}, 0 -+#endif -+ -+// -+// -+// -+/* -+ -+Countries "Country Abbreviation" Domain Code SKU's Ch# of 20MHz -+ 2G 5G Ch# of 40MHz -+"Albaniaڥ" AL Local Test -+ -+"AlgeriaΧQ" DZ CE TCF -+ -+"Antigua & Barbudawʮq&ڥF" AG 2G_WORLD FCC TCF -+ -+"Argentinaڧ" AR 2G_WORLD Local Test -+ -+"ArmeniaȬ" AM 2G_WORLD ETSI -+ -+"Aruba|ڮq" AW 2G_WORLD FCC TCF -+ -+"AustraliaDw" AU 2G_WORLD 5G_ETSI2 -+ -+"AustriaaQ" AT 2G_WORLD 5G_ETSI1 CE -+ -+"Azerbaijan" AZ 2G_WORLD CE TCF -+ -+"Bahamasګ" BS 2G_WORLD -+ -+"Barbadosڤڦh" BB 2G_WORLD FCC TCF -+ -+"BelgiumQ" BE 2G_WORLD 5G_ETSI1 CE -+ -+"Bermudaʼ}F" BM 2G_WORLD FCC TCF -+ -+"Brazilڦ" BR 2G_WORLD Local Test -+ -+"BulgariaO[Q" BG 2G_WORLD 5G_ETSI1 CE -+ -+"Canada[j" CA 2G_FCC1 5G_FCC7 IC / FCC IC / FCC -+ -+"Cayman Islands}Ҹsq" KY 2G_WORLD 5G_ETSI1 CE -+ -+"ChileQ" CL 2G_WORLD FCC TCF -+ -+"China" CN 2G_WORLD 5G_FCC5 H?i2002j353? -+ -+"Columbiaۤ" CO 2G_WORLD Voluntary -+ -+"Costa RicaF[" CR 2G_WORLD FCC TCF -+ -+"Cyprus" CY 2G_WORLD 5G_ETSI1 CE -+ -+"Czech J" CZ 2G_WORLD 5G_ETSI1 CE -+ -+"Denmark" DK 2G_WORLD 5G_ETSI1 CE -+ -+"Dominican Republich[@M" DO 2G_WORLD FCC TCF -+ -+"EgyptJ" EG 2G_WORLD CE T CF -+ -+"El Salvadorĺ˦h" SV 2G_WORLD Voluntary -+ -+"EstoniaRF" EE 2G_WORLD 5G_ETSI1 CE -+ -+"Finland" FI 2G_WORLD 5G_ETSI1 CE -+ -+"Francek" FR 5G_E TSI1 CE -+ -+"Germanyw" DE 2G_WORLD 5G_ETSI1 CE -+ -+"Greece þ" GR 2G_WORLD 5G_ETSI1 CE -+ -+"Guamq" GU 2G_WORLD -+ -+"Guatemalaʦa" GT 2G_WORLD -+ -+"Haitia" HT 2G_WORLD FCC TCF -+ -+"HondurasԴ" HN 2G_WORLD FCC TCF -+ -+"HungaryIQ" HU 2G_WORLD 5G_ETSI1 CE -+ -+"IcelandBq" IS 2G_WORLD 5G_ETSI1 CE -+ -+"IndiaL" IN 2G_WORLD 5G_FCC3 FCC/CE TCF -+ -+"IrelandR" IE 2G_WORLD 5G_ETSI1 CE -+ -+"IsraelHC" IL 5G_F CC6 CE TCF -+ -+"ItalyqjQ" IT 2G_WORLD 5G_ETSI1 CE -+ -+"Japan饻" JP 2G_MKK1 5G_MKK1 MKK MKK -+ -+"Korea" KR 2G_WORLD 5G_KCC1 KCC KCC -+ -+"LatviaԲ" LV 2G_WORLD 5G_ETSI1 CE -+ -+"Lithuania߳{" LT 2G_WORLD 5G_ETSI1 CE -+ -+"Luxembourgc˳" LU 2G_WORLD 5G_ETSI1 CE -+ -+"MalaysiaӦ" MY 2G_WORLD Local Test -+ -+"MaltaL" MT 2G_WORLD 5G_ETSI1 CE -+ -+"Mexico" MX 2G_WORLD 5G_FCC3 Local Test -+ -+"Morocco" MA CE TCF -+ -+"Netherlands" NL 2G_WORLD 5G_ETSI1 CE -+ -+"New Zealandæ" NZ 2G_WORLD 5G_ETSI2 -+ -+"Norway" NO 2G_WORLD 5G_ETSI1 CE -+ -+"Panamaڮ " PA 2G_FCC1 Voluntary -+ -+"Philippines߻" PH 2G_WORLD FCC TCF -+ -+"Polandi" PL 2G_WORLD 5G_ETSI1 CE -+ -+"Portugal" PT 2G_WORLD 5G_ETSI1 CE -+ -+"Romaniaù" RO 2G_WORLD 5G_ETSI1 CE -+ -+"RussiaXù" RU 2G_WORLD 5G_ETSI3 CE TCF -+ -+"Saudi ArabiaFaԧB" SA 2G_WORLD CE TCF -+ -+"Singapores[Y" SG 2G_WORLD -+ -+"SlovakiaJ" SK 2G_WORLD 5G_ETSI1 CE -+ -+"Slovenia" SI 2G_WORLD 5G_ETSI1 CE -+ -+"South AfricanD" ZA 2G_WORLD CE TCF -+ -+"SpainZ" ES 5G_ETSI1 CE -+ -+"Sweden" SE 2G_WORLD 5G_ETSI1 CE -+ -+"Switzerlandh" CH 2G_WORLD 5G_ETSI1 CE -+ -+"TaiwanOW" TW 2G_FCC1 5G_NCC1 NCC -+ -+"Thailand" TH 2G_WORLD FCC/CE TCF -+ -+"Turkeygը" TR 2G_WORLD -+ -+"UkraineQJ" UA 2G_WORLD Local Test -+ -+"United Kingdom^" GB 2G_WORLD 5G_ETSI1 CE ETSI -+ -+"United States" US 2G_FCC1 5G_FCC7 FCC FCC -+ -+"Venezuelae" VE 2G_WORLD 5G_FCC4 FCC TCF -+ -+"VietnamVn" VN 2G_WORLD FCC/CE TCF -+ -+ -+ -+*/ -+ -+// Counter abbervation. -+typedef enum _RT_COUNTRY_DEFINE_NUM -+{ -+ RT_CTRY_AL, // "Albaniaڥ" -+ RT_CTRY_DZ, // "AlgeriaΧQ" -+ RT_CTRY_AG, // "Antigua & Barbudawʮq&ڥF" -+ RT_CTRY_AR, // "Argentinaڧ" -+ RT_CTRY_AM, // "ArmeniaȬ" -+ RT_CTRY_AW, // "Aruba|ڮq" -+ RT_CTRY_AU, // "AustraliaDw" -+ RT_CTRY_AT, // "AustriaaQ" -+ RT_CTRY_AZ, // "Azerbaijan" -+ RT_CTRY_BS, // "Bahamasګ" -+ RT_CTRY_BB, // "Barbadosڤڦh" -+ RT_CTRY_BE, // "BelgiumQ" -+ RT_CTRY_BM, // "Bermudaʼ}F" -+ RT_CTRY_BR, // "Brazilڦ" -+ RT_CTRY_BG, // "BulgariaO[Q" -+ RT_CTRY_CA, // "Canada[j" -+ RT_CTRY_KY, // "Cayman Islands}Ҹsq" -+ RT_CTRY_CL, // "ChileQ" -+ RT_CTRY_CN, // "China" -+ RT_CTRY_CO, // "Columbiaۤ" -+ RT_CTRY_CR, // "Costa RicaF[" -+ RT_CTRY_CY, // "Cyprus" -+ RT_CTRY_CZ, // "Czech J" -+ RT_CTRY_DK, // "Denmark" -+ RT_CTRY_DO, // "Dominican Republich[@M" -+ RT_CTRY_CE, // "EgyptJ" EG 2G_WORLD -+ RT_CTRY_SV, // "El Salvadorĺ˦h" -+ RT_CTRY_EE, // "EstoniaRF" -+ RT_CTRY_FI, // "Finland" -+ RT_CTRY_FR, // "Francek" -+ RT_CTRY_DE, // "Germanyw" -+ RT_CTRY_GR, // "Greece þ" -+ RT_CTRY_GU, // "Guamq" -+ RT_CTRY_GT, // "Guatemalaʦa" -+ RT_CTRY_HT, // "Haitia" -+ RT_CTRY_HN, // "HondurasԴ" -+ RT_CTRY_HU, // "HungaryIQ" -+ RT_CTRY_IS, // "IcelandBq" -+ RT_CTRY_IN, // "IndiaL" -+ RT_CTRY_IE, // "IrelandR" -+ RT_CTRY_IL, // "IsraelHC" -+ RT_CTRY_IT, // "ItalyqjQ" -+ RT_CTRY_JP, // "Japan饻" -+ RT_CTRY_KR, // "Korea" -+ RT_CTRY_LV, // "LatviaԲ" -+ RT_CTRY_LT, // "Lithuania߳{" -+ RT_CTRY_LU, // "Luxembourgc˳" -+ RT_CTRY_MY, // "MalaysiaӦ" -+ RT_CTRY_MT, // "MaltaL" -+ RT_CTRY_MX, // "Mexico" -+ RT_CTRY_MA, // "Morocco" -+ RT_CTRY_NL, // "Netherlands" -+ RT_CTRY_NZ, // "New Zealandæ" -+ RT_CTRY_NO, // "Norway" -+ RT_CTRY_PA, // "Panamaڮ " -+ RT_CTRY_PH, // "Philippines߻" -+ RT_CTRY_PL, // "Polandi" -+ RT_CTRY_PT, // "Portugal" -+ RT_CTRY_RO, // "Romaniaù" -+ RT_CTRY_RU, // "RussiaXù" -+ RT_CTRY_SA, // "Saudi ArabiaFaԧB" -+ RT_CTRY_SG, // "Singapores[Y" -+ RT_CTRY_SK, // "SlovakiaJ" -+ RT_CTRY_SI, // "Slovenia" -+ RT_CTRY_ZA, // "South AfricanD" -+ RT_CTRY_ES, // "SpainZ" -+ RT_CTRY_SE, // "Sweden" -+ RT_CTRY_CH, // "Switzerlandh" -+ RT_CTRY_TW, // "TaiwanOW" -+ RT_CTRY_TH, // "Thailand" -+ RT_CTRY_TR, // "Turkeygը" -+ RT_CTRY_UA, // "UkraineQJ" -+ RT_CTRY_GB, // "United Kingdom^" -+ RT_CTRY_US, // "United States" -+ RT_CTRY_VE, // "Venezuelae" -+ RT_CTRY_VN, // "VietnamVn" -+ RT_CTRY_MAX, // -+ -+}RT_COUNTRY_NAME, *PRT_COUNTRY_NAME; -+ -+// Scan type including active and passive scan. -+typedef enum _RT_SCAN_TYPE_NEW -+{ -+ SCAN_NULL, -+ SCAN_ACT, -+ SCAN_PAS, -+ SCAN_BOTH, -+}RT_SCAN_TYPE_NEW, *PRT_SCAN_TYPE_NEW; -+ -+ -+// Power table sample. -+ -+typedef struct _RT_CHNL_PLAN_LIMIT -+{ -+ u2Byte Chnl_Start; -+ u2Byte Chnl_end; -+ -+ u2Byte Freq_Start; -+ u2Byte Freq_end; -+}RT_CHNL_PLAN_LIMIT, *PRT_CHNL_PLAN_LIMIT; -+ -+ -+// -+// 2.4G Regulatory Domains -+// -+typedef enum _RT_REGULATION_DOMAIN_2G -+{ -+ RT_2G_NULL, -+ RT_2G_WORLD, -+ RT_2G_ETSI1, -+ RT_2G_FCC1, -+ RT_2G_MKK1, -+ RT_2G_ETSI2 -+ -+}RT_REGULATION_2G, *PRT_REGULATION_2G; -+ -+ -+//typedef struct _RT_CHANNEL_BEHAVIOR -+//{ -+// u1Byte Chnl; -+// RT_SCAN_TYPE_NEW -+// -+//}RT_CHANNEL_BEHAVIOR, *PRT_CHANNEL_BEHAVIOR; -+ -+//typedef struct _RT_CHANNEL_PLAN_TYPE -+//{ -+// RT_CHANNEL_BEHAVIOR -+// u1Byte Chnl_num; -+//}RT_CHNL_PLAN_TYPE, *PRT_CHNL_PLAN_TYPE; -+ -+// -+// 2.4G Channel Number -+// Channel definition & number -+// -+#define CHNL_RT_2G_NULL \ -+ {0}, 0 -+#define CHNL_RT_2G_WORLD \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -+#define CHNL_RT_2G_WORLD_TEST \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -+ -+#define CHNL_RT_2G_EFSI1 \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -+#define CHNL_RT_2G_FCC1 \ -+ {1,2,3,4,5,6,7,8,9,10,11}, 11 -+#define CHNL_RT_2G_MKK1 \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13,14}, 14 -+#define CHNL_RT_2G_ETSI2 \ -+ {10,11,12,13}, 4 -+ -+// -+// 2.4G Channel Active or passive scan. -+// -+#define CHNL_RT_2G_NULL_SCAN_TYPE \ -+ {SCAN_NULL} -+#define CHNL_RT_2G_WORLD_SCAN_TYPE \ -+ {1,1,1,1,1,1,1,1,1,1,1,0,0} -+#define CHNL_RT_2G_EFSI1_SCAN_TYPE \ -+ {1,1,1,1,1,1,1,1,1,1,1,1,1} -+#define CHNL_RT_2G_FCC1_SCAN_TYPE \ -+ {1,1,1,1,1,1,1,1,1,1,1} -+#define CHNL_RT_2G_MKK1_SCAN_TYPE \ -+ {1,1,1,1,1,1,1,1,1,1,1,1,1,1} -+#define CHNL_RT_2G_ETSI2_SCAN_TYPE \ -+ {1,1,1,1} -+ -+ -+// -+// 2.4G Band & Frequency Section -+// Freqency start & end / band number -+// -+#define FREQ_RT_2G_NULL \ -+ {0}, 0 -+ // Passive scan CH 12, 13 -+#define FREQ_RT_2G_WORLD \ -+ {2412, 2472}, 1 -+#define FREQ_RT_2G_EFSI1 \ -+ {2412, 2472}, 1 -+#define FREQ_RT_2G_FCC1 \ -+ {2412, 2462}, 1 -+#define FREQ_RT_2G_MKK1 \ -+ {2412, 2484}, 1 -+#define FREQ_RT_2G_ETSI2 \ -+ {2457, 2472}, 1 -+ -+ -+// -+// 5G Regulatory Domains -+// -+typedef enum _RT_REGULATION_DOMAIN_5G -+{ -+ RT_5G_NULL, -+ RT_5G_WORLD, -+ RT_5G_ETSI1, -+ RT_5G_ETSI2, -+ RT_5G_ETSI3, -+ RT_5G_FCC1, -+ RT_5G_FCC2, -+ RT_5G_FCC3, -+ RT_5G_FCC4, -+ RT_5G_FCC5, -+ RT_5G_FCC6, -+ RT_5G_FCC7, -+ RT_5G_IC1, -+ RT_5G_KCC1, -+ RT_5G_MKK1, -+ RT_5G_MKK2, -+ RT_5G_MKK3, -+ RT_5G_NCC1, -+ -+}RT_REGULATION_5G, *PRT_REGULATION_5G; -+ -+// -+// 5G Channel Number -+// -+#define CHNL_RT_5G_NULL \ -+ {0}, 0 -+#define CHNL_RT_5G_WORLD \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -+#define CHNL_RT_5G_ETSI1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -+#define CHNL_RT_5G_ETSI2 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165}, 22 -+#define CHNL_RT_5G_ETSI3 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -+#define CHNL_RT_5G_FCC1 \ -+ {36,40,44,48,149,153,157,161,165}, 9 -+#define CHNL_RT_5G_FCC2 \ -+ {36,40,44,48,52,56,60,64,149,153,157,161,165}, 13 -+#define CHNL_RT_5G_FCC3 \ -+ {36,40,44,48,52,56,60,64,149,153,157,161}, 12 -+#define CHNL_RT_5G_FCC4 \ -+ {149,153,157,161,165}, 5 -+#define CHNL_RT_5G_FCC5 \ -+ {36,40,44,48,52,56,60,64}, 8 -+#define CHNL_RT_5G_FCC6 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -+#define CHNL_RT_5G_FCC7 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -+#define CHNL_RT_5G_IC1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165}, 20 -+#define CHNL_RT_5G_KCC1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -+#define CHNL_RT_5G_MKK1 \ -+ {36,40,44,48,52,56,60,64}, 8 -+#define CHNL_RT_5G_MKK2 \ -+ {100,104,108,112,116,120,124,128,132,136,140}, 11 -+#define CHNL_RT_5G_MKK3 \ -+ {56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 24 -+#define CHNL_RT_5G_NCC1 \ -+ {56,60,64,149,153,157,161,165}, 8 -+ -+// -+// 5G Channel Active or passive scan. -+// -+#define CHNL_RT_5G_NULL_SCAN_TYPE \ -+ {SCAN_NULL} -+#define CHNL_RT_5G_WORLD_SCAN_TYPE \ -+ {1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1} -+#define CHNL_RT_5G_ETSI1_SCAN_TYPE \ -+ {1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1} -+#define CHNL_RT_5G_ETSI2_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165}, 22 -+#define CHNL_RT_5G_ETSI3_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -+#define CHNL_RT_5G_FCC1_SCAN_TYPE \ -+ {36,40,44,48,149,153,157,161,165}, 9 -+#define CHNL_RT_5G_FCC2_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,149,153,157,161,165}, 13 -+#define CHNL_RT_5G_FCC3_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,149,153,157,161}, 12 -+#define CHNL_RT_5G_FCC4_SCAN_TYPE \ -+ {149,153,157,161,165}, 5 -+#define CHNL_RT_5G_FCC5_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64}, 8 -+#define CHNL_RT_5G_FCC6_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -+#define CHNL_RT_5G_FCC7_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -+#define CHNL_RT_5G_IC1_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165}, 20 -+#define CHNL_RT_5G_KCC1_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -+#define CHNL_RT_5G_MKK1_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64}, 8 -+#define CHNL_RT_5G_MKK2_SCAN_TYPE \ -+ {100,104,108,112,116,120,124,128,132,136,140}, 11 -+#define CHNL_RT_5G_MKK3_SCAN_TYPE \ -+ {56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 24 -+#define CHNL_RT_5G_NCC1_SCAN_TYPE \ -+ {56,60,64,149,153,157,161,165}, 8 -+ -+// -+// Global Regulation -+// -+typedef enum _RT_REGULATION_COMMON -+{ -+ RT_WORLD, -+ RT_FCC, -+ RT_MKK, -+ RT_ETSI, -+ RT_IC, -+ RT_CE, -+ RT_NCC, -+ -+}RT_REGULATION_CMN, *PRT_REGULATION_CMN; -+ -+ -+ -+// -+// Special requirement for different regulation domain. -+// For internal test or customerize special request. -+// -+typedef enum _RT_CHNLPLAN_SREQ -+{ -+ RT_SREQ_NA = 0x0, -+ RT_SREQ_2G_ADHOC_11N = 0x00000001, -+ RT_SREQ_2G_ADHOC_11B = 0x00000002, -+ RT_SREQ_2G_ALL_PASS = 0x00000004, -+ RT_SREQ_2G_ALL_ACT = 0x00000008, -+ RT_SREQ_5G_ADHOC_11N = 0x00000010, -+ RT_SREQ_5G_ADHOC_11AC = 0x00000020, -+ RT_SREQ_5G_ALL_PASS = 0x00000040, -+ RT_SREQ_5G_ALL_ACT = 0x00000080, -+ RT_SREQ_C1_PLAN = 0x00000100, -+ RT_SREQ_C2_PLAN = 0x00000200, -+ RT_SREQ_C3_PLAN = 0x00000400, -+ RT_SREQ_C4_PLAN = 0x00000800, -+ RT_SREQ_NFC_ON = 0x00001000, -+ RT_SREQ_MASK = 0x0000FFFF, /* Requirements bit mask */ -+ -+}RT_CHNLPLAN_SREQ, *PRT_CHNLPLAN_SREQ; -+ -+ -+// -+// RT_COUNTRY_NAME & RT_REGULATION_2G & RT_REGULATION_5G transfer table -+// -+// -+typedef struct _RT_CHANNEL_PLAN_COUNTRY_TRANSFER_TABLE -+{ -+ // -+ // Define countery domain and corresponding -+ // -+ RT_COUNTRY_NAME Country_Enum; -+ char Country_Name[3]; -+ -+ //char Domain_Name[12]; -+ RT_REGULATION_2G Domain_2G; -+ -+ RT_REGULATION_5G Domain_5G; -+ -+ RT_CHANNEL_DOMAIN RtChDomain; -+ //u1Byte Country_Area; -+ -+}RT_CHNL_CTRY_TBL, *PRT_CHNL_CTRY_TBL; -+ -+ -+#define RT_MAX_CHNL_NUM_2G 13 -+#define RT_MAX_CHNL_NUM_5G 44 -+ -+// Power table sample. -+ -+typedef struct _RT_CHNL_PLAN_PWR_LIMIT -+{ -+ u2Byte Chnl_Start; -+ u2Byte Chnl_end; -+ u1Byte dB_Max; -+ u2Byte mW_Max; -+}RT_CHNL_PWR_LIMIT, *PRT_CHNL_PWR_LIMIT; -+ -+ -+#define RT_MAX_BAND_NUM 5 -+ -+typedef struct _RT_CHANNEL_PLAN_MAXPWR -+{ -+// STRING_T -+ RT_CHNL_PWR_LIMIT Chnl[RT_MAX_BAND_NUM]; -+ u1Byte Band_Useful_Num; -+ -+ -+}RT_CHANNEL_PLAN_MAXPWR, *PRT_CHANNEL_PLAN_MAXPWR; -+ -+ -+// -+// Power By Rate Table. -+// -+ -+ -+ -+typedef struct _RT_CHANNEL_PLAN_NEW -+{ -+ // -+ // Define countery domain and corresponding -+ // -+ //char Country_Name[36]; -+ //u1Byte Country_Enum; -+ -+ //char Domain_Name[12]; -+ -+ -+ PRT_CHNL_CTRY_TBL pCtryTransfer; -+ -+ RT_CHANNEL_DOMAIN RtChDomain; -+ -+ RT_REGULATION_2G Domain_2G; -+ -+ RT_REGULATION_5G Domain_5G; -+ -+ RT_REGULATION_CMN Regulator; -+ -+ RT_CHNLPLAN_SREQ ChnlSreq; -+ -+ //RT_CHNL_PLAN_LIMIT RtChnl; -+ -+ u1Byte Chnl2G[MAX_CHANNEL_NUM]; // CHNL_RT_2G_WORLD -+ u1Byte Len2G; -+ u1Byte Chnl2GScanTp[MAX_CHANNEL_NUM]; // CHNL_RT_2G_WORLD_SCAN_TYPE -+ //u1Byte Freq2G[2]; // FREQ_RT_2G_WORLD -+ -+ u1Byte Chnl5G[MAX_CHANNEL_NUM]; -+ u1Byte Len5G; -+ u1Byte Chnl5GScanTp[MAX_CHANNEL_NUM]; -+ //u1Byte Freq2G[2]; // FREQ_RT_2G_WORLD -+ -+ RT_CHANNEL_PLAN_MAXPWR ChnlMaxPwr; -+ -+ -+}RT_CHANNEL_PLAN_NEW, *PRT_CHANNEL_PLAN_NEW; -+ -+ -+#endif // __RT_CHANNELPLAN_H__ -+ -+ -+ -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_bb.c linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_bb.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_bb.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_bb.c 2017-06-07 23:07:21.021688487 +0300 -@@ -0,0 +1,1295 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.14*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8812A_SUPPORT == 1) -+static BOOLEAN -+CheckPositive( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2, -+ IN const u4Byte Condition3, -+ IN const u4Byte Condition4 -+) -+{ -+ u1Byte _BoardType = ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA*/ -+ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA*/ -+ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA*/ -+ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ -+ ((pDM_Odm->BoardType & BIT2) >> 2) << 4; /* _BT*/ -+ -+ u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; -+ u4Byte driver1 = pDM_Odm->CutVersion << 24 | -+ (pDM_Odm->SupportInterface & 0xF0) << 16 | -+ pDM_Odm->SupportPlatform << 16 | -+ pDM_Odm->PackageType << 12 | -+ (pDM_Odm->SupportInterface & 0x0F) << 8 | -+ _BoardType; -+ -+ u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | -+ (pDM_Odm->TypeGPA & 0xFF) << 8 | -+ (pDM_Odm->TypeALNA & 0xFF) << 16 | -+ (pDM_Odm->TypeAPA & 0xFF) << 24; -+ -+u4Byte driver3 = 0; -+ -+ u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | -+ (pDM_Odm->TypeGPA & 0xFF00) | -+ (pDM_Odm->TypeALNA & 0xFF00) << 8 | -+ (pDM_Odm->TypeAPA & 0xFF00) << 16; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Platform, Interface) = (0x%X, 0x%X)\n", pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Board, Package) = (0x%X, 0x%X)\n", pDM_Odm->BoardType, pDM_Odm->PackageType)); -+ -+ -+ /*============== Value Defined Check ===============*/ -+ /*QFN Type [15:12] and Cut Version [27:24] need to do value check*/ -+ -+ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return FALSE; -+ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return FALSE; -+ -+ /*=============== Bit Defined Check ================*/ -+ /* We don't care [31:28] */ -+ -+ cond1 &= 0x00FF0FFF; -+ driver1 &= 0x00FF0FFF; -+ -+ if ((cond1 & driver1) == cond1) { -+ u4Byte bitMask = 0; -+ -+ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE*/ -+ return TRUE; -+ -+ if ((cond1 & BIT0) != 0) /*GLNA*/ -+ bitMask |= 0x000000FF; -+ if ((cond1 & BIT1) != 0) /*GPA*/ -+ bitMask |= 0x0000FF00; -+ if ((cond1 & BIT2) != 0) /*ALNA*/ -+ bitMask |= 0x00FF0000; -+ if ((cond1 & BIT3) != 0) /*APA*/ -+ bitMask |= 0xFF000000; -+ -+ if (((cond2 & bitMask) == (driver2 & bitMask)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ -+ return TRUE; -+ else -+ return FALSE; -+ } else -+ return FALSE; -+} -+static BOOLEAN -+CheckNegative( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2 -+) -+{ -+ return TRUE; -+} -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_AGC_TAB[] = { -+ 0x80000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFC000001, -+ 0x81C, 0xFB020001, -+ 0x81C, 0xFA040001, -+ 0x81C, 0xF9060001, -+ 0x81C, 0xF8080001, -+ 0x81C, 0xF70A0001, -+ 0x81C, 0xF60C0001, -+ 0x81C, 0xF50E0001, -+ 0x81C, 0xF4100001, -+ 0x81C, 0xF3120001, -+ 0x81C, 0xF2140001, -+ 0x81C, 0xF1160001, -+ 0x81C, 0xF0180001, -+ 0x81C, 0xEF1A0001, -+ 0x81C, 0xEE1C0001, -+ 0x81C, 0xED1E0001, -+ 0x81C, 0xEC200001, -+ 0x81C, 0xEB220001, -+ 0x81C, 0xEA240001, -+ 0x81C, 0xCD260001, -+ 0x81C, 0xCC280001, -+ 0x81C, 0xCB2A0001, -+ 0x81C, 0xCA2C0001, -+ 0x81C, 0xC92E0001, -+ 0x81C, 0xC8300001, -+ 0x81C, 0xA6320001, -+ 0x81C, 0xA5340001, -+ 0x81C, 0xA4360001, -+ 0x81C, 0xA3380001, -+ 0x81C, 0xA23A0001, -+ 0x81C, 0x883C0001, -+ 0x81C, 0x873E0001, -+ 0x81C, 0x86400001, -+ 0x81C, 0x85420001, -+ 0x81C, 0x84440001, -+ 0x81C, 0x83460001, -+ 0x81C, 0x82480001, -+ 0x81C, 0x814A0001, -+ 0x81C, 0x484C0001, -+ 0x81C, 0x474E0001, -+ 0x81C, 0x46500001, -+ 0x81C, 0x45520001, -+ 0x81C, 0x44540001, -+ 0x81C, 0x43560001, -+ 0x81C, 0x42580001, -+ 0x81C, 0x415A0001, -+ 0x81C, 0x255C0001, -+ 0x81C, 0x245E0001, -+ 0x81C, 0x23600001, -+ 0x81C, 0x22620001, -+ 0x81C, 0x21640001, -+ 0x81C, 0x21660001, -+ 0x81C, 0x21680001, -+ 0x81C, 0x216A0001, -+ 0x81C, 0x216C0001, -+ 0x81C, 0x216E0001, -+ 0x81C, 0x21700001, -+ 0x81C, 0x21720001, -+ 0x81C, 0x21740001, -+ 0x81C, 0x21760001, -+ 0x81C, 0x21780001, -+ 0x81C, 0x217A0001, -+ 0x81C, 0x217C0001, -+ 0x81C, 0x217E0001, -+ 0x90000001, 0x00000005, 0x40000000, 0x00000000, -+ 0x81C, 0xF9000001, -+ 0x81C, 0xF8020001, -+ 0x81C, 0xF7040001, -+ 0x81C, 0xF6060001, -+ 0x81C, 0xF5080001, -+ 0x81C, 0xF40A0001, -+ 0x81C, 0xF30C0001, -+ 0x81C, 0xF20E0001, -+ 0x81C, 0xF1100001, -+ 0x81C, 0xF0120001, -+ 0x81C, 0xEF140001, -+ 0x81C, 0xEE160001, -+ 0x81C, 0xED180001, -+ 0x81C, 0xEC1A0001, -+ 0x81C, 0xEB1C0001, -+ 0x81C, 0xEA1E0001, -+ 0x81C, 0xCD200001, -+ 0x81C, 0xCC220001, -+ 0x81C, 0xCB240001, -+ 0x81C, 0xCA260001, -+ 0x81C, 0xC9280001, -+ 0x81C, 0xC82A0001, -+ 0x81C, 0xC72C0001, -+ 0x81C, 0xC62E0001, -+ 0x81C, 0xA5300001, -+ 0x81C, 0xA4320001, -+ 0x81C, 0xA3340001, -+ 0x81C, 0xA2360001, -+ 0x81C, 0x88380001, -+ 0x81C, 0x873A0001, -+ 0x81C, 0x863C0001, -+ 0x81C, 0x853E0001, -+ 0x81C, 0x84400001, -+ 0x81C, 0x83420001, -+ 0x81C, 0x82440001, -+ 0x81C, 0x81460001, -+ 0x81C, 0x48480001, -+ 0x81C, 0x474A0001, -+ 0x81C, 0x464C0001, -+ 0x81C, 0x454E0001, -+ 0x81C, 0x44500001, -+ 0x81C, 0x43520001, -+ 0x81C, 0x42540001, -+ 0x81C, 0x41560001, -+ 0x81C, 0x25580001, -+ 0x81C, 0x245A0001, -+ 0x81C, 0x235C0001, -+ 0x81C, 0x225E0001, -+ 0x81C, 0x21600001, -+ 0x81C, 0x21620001, -+ 0x81C, 0x21640001, -+ 0x81C, 0x21660001, -+ 0x81C, 0x21680001, -+ 0x81C, 0x216A0001, -+ 0x81C, 0x236C0001, -+ 0x81C, 0x226E0001, -+ 0x81C, 0x21700001, -+ 0x81C, 0x21720001, -+ 0x81C, 0x21740001, -+ 0x81C, 0x21760001, -+ 0x81C, 0x21780001, -+ 0x81C, 0x217A0001, -+ 0x81C, 0x217C0001, -+ 0x81C, 0x217E0001, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0xFF000001, -+ 0x81C, 0xFF020001, -+ 0x81C, 0xFF040001, -+ 0x81C, 0xFF060001, -+ 0x81C, 0xFF080001, -+ 0x81C, 0xFE0A0001, -+ 0x81C, 0xFD0C0001, -+ 0x81C, 0xFC0E0001, -+ 0x81C, 0xFB100001, -+ 0x81C, 0xFA120001, -+ 0x81C, 0xF9140001, -+ 0x81C, 0xF8160001, -+ 0x81C, 0xF7180001, -+ 0x81C, 0xF61A0001, -+ 0x81C, 0xF51C0001, -+ 0x81C, 0xF41E0001, -+ 0x81C, 0xF3200001, -+ 0x81C, 0xF2220001, -+ 0x81C, 0xF1240001, -+ 0x81C, 0xF0260001, -+ 0x81C, 0xEF280001, -+ 0x81C, 0xEE2A0001, -+ 0x81C, 0xED2C0001, -+ 0x81C, 0xEC2E0001, -+ 0x81C, 0xEB300001, -+ 0x81C, 0xEA320001, -+ 0x81C, 0xE9340001, -+ 0x81C, 0xE8360001, -+ 0x81C, 0xE7380001, -+ 0x81C, 0xE63A0001, -+ 0x81C, 0xE53C0001, -+ 0x81C, 0xC73E0001, -+ 0x81C, 0xC6400001, -+ 0x81C, 0xC5420001, -+ 0x81C, 0xC4440001, -+ 0x81C, 0xC3460001, -+ 0x81C, 0xC2480001, -+ 0x81C, 0xC14A0001, -+ 0x81C, 0xA74C0001, -+ 0x81C, 0xA64E0001, -+ 0x81C, 0xA5500001, -+ 0x81C, 0xA4520001, -+ 0x81C, 0xA3540001, -+ 0x81C, 0xA2560001, -+ 0x81C, 0xA1580001, -+ 0x81C, 0x675A0001, -+ 0x81C, 0x665C0001, -+ 0x81C, 0x655E0001, -+ 0x81C, 0x64600001, -+ 0x81C, 0x63620001, -+ 0x81C, 0x48640001, -+ 0x81C, 0x47660001, -+ 0x81C, 0x46680001, -+ 0x81C, 0x456A0001, -+ 0x81C, 0x446C0001, -+ 0x81C, 0x436E0001, -+ 0x81C, 0x42700001, -+ 0x81C, 0x41720001, -+ 0x81C, 0x41740001, -+ 0x81C, 0x41760001, -+ 0x81C, 0x41780001, -+ 0x81C, 0x417A0001, -+ 0x81C, 0x417C0001, -+ 0x81C, 0x417E0001, -+ 0xB0000000, 0x00000000, -+ 0x80000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFC800001, -+ 0x81C, 0xFB820001, -+ 0x81C, 0xFA840001, -+ 0x81C, 0xF9860001, -+ 0x81C, 0xF8880001, -+ 0x81C, 0xF78A0001, -+ 0x81C, 0xF68C0001, -+ 0x81C, 0xF58E0001, -+ 0x81C, 0xF4900001, -+ 0x81C, 0xF3920001, -+ 0x81C, 0xF2940001, -+ 0x81C, 0xF1960001, -+ 0x81C, 0xF0980001, -+ 0x81C, 0xEF9A0001, -+ 0x81C, 0xEE9C0001, -+ 0x81C, 0xED9E0001, -+ 0x81C, 0xECA00001, -+ 0x81C, 0xEBA20001, -+ 0x81C, 0xEAA40001, -+ 0x81C, 0xE9A60001, -+ 0x81C, 0xE8A80001, -+ 0x81C, 0xE7AA0001, -+ 0x81C, 0xE6AC0001, -+ 0x81C, 0xE5AE0001, -+ 0x81C, 0xE4B00001, -+ 0x81C, 0xE3B20001, -+ 0x81C, 0xA8B40001, -+ 0x81C, 0xA7B60001, -+ 0x81C, 0xA6B80001, -+ 0x81C, 0xA5BA0001, -+ 0x81C, 0xA4BC0001, -+ 0x81C, 0xA3BE0001, -+ 0x81C, 0xA2C00001, -+ 0x81C, 0xA1C20001, -+ 0x81C, 0x68C40001, -+ 0x81C, 0x67C60001, -+ 0x81C, 0x66C80001, -+ 0x81C, 0x65CA0001, -+ 0x81C, 0x64CC0001, -+ 0x81C, 0x47CE0001, -+ 0x81C, 0x46D00001, -+ 0x81C, 0x45D20001, -+ 0x81C, 0x44D40001, -+ 0x81C, 0x43D60001, -+ 0x81C, 0x42D80001, -+ 0x81C, 0x08DA0001, -+ 0x81C, 0x07DC0001, -+ 0x81C, 0x06DE0001, -+ 0x81C, 0x05E00001, -+ 0x81C, 0x04E20001, -+ 0x81C, 0x03E40001, -+ 0x81C, 0x02E60001, -+ 0x81C, 0x01E80001, -+ 0x81C, 0x01EA0001, -+ 0x81C, 0x01EC0001, -+ 0x81C, 0x01EE0001, -+ 0x81C, 0x01F00001, -+ 0x81C, 0x01F20001, -+ 0x81C, 0x01F40001, -+ 0x81C, 0x01F60001, -+ 0x81C, 0x01F80001, -+ 0x81C, 0x01FA0001, -+ 0x81C, 0x01FC0001, -+ 0x81C, 0x01FE0001, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0xFF800001, -+ 0x81C, 0xFF820001, -+ 0x81C, 0xFF840001, -+ 0x81C, 0xFE860001, -+ 0x81C, 0xFD880001, -+ 0x81C, 0xFC8A0001, -+ 0x81C, 0xFB8C0001, -+ 0x81C, 0xFA8E0001, -+ 0x81C, 0xF9900001, -+ 0x81C, 0xF8920001, -+ 0x81C, 0xF7940001, -+ 0x81C, 0xF6960001, -+ 0x81C, 0xF5980001, -+ 0x81C, 0xF49A0001, -+ 0x81C, 0xF39C0001, -+ 0x81C, 0xF29E0001, -+ 0x81C, 0xF1A00001, -+ 0x81C, 0xF0A20001, -+ 0x81C, 0xEFA40001, -+ 0x81C, 0xEEA60001, -+ 0x81C, 0xEDA80001, -+ 0x81C, 0xECAA0001, -+ 0x81C, 0xEBAC0001, -+ 0x81C, 0xEAAE0001, -+ 0x81C, 0xE9B00001, -+ 0x81C, 0xE8B20001, -+ 0x81C, 0xE7B40001, -+ 0x81C, 0xE6B60001, -+ 0x81C, 0xE5B80001, -+ 0x81C, 0xE4BA0001, -+ 0x81C, 0xE3BC0001, -+ 0x81C, 0xA8BE0001, -+ 0x81C, 0xA7C00001, -+ 0x81C, 0xA6C20001, -+ 0x81C, 0xA5C40001, -+ 0x81C, 0xA4C60001, -+ 0x81C, 0xA3C80001, -+ 0x81C, 0xA2CA0001, -+ 0x81C, 0xA1CC0001, -+ 0x81C, 0x68CE0001, -+ 0x81C, 0x67D00001, -+ 0x81C, 0x66D20001, -+ 0x81C, 0x65D40001, -+ 0x81C, 0x64D60001, -+ 0x81C, 0x47D80001, -+ 0x81C, 0x46DA0001, -+ 0x81C, 0x45DC0001, -+ 0x81C, 0x44DE0001, -+ 0x81C, 0x43E00001, -+ 0x81C, 0x42E20001, -+ 0x81C, 0x08E40001, -+ 0x81C, 0x07E60001, -+ 0x81C, 0x06E80001, -+ 0x81C, 0x05EA0001, -+ 0x81C, 0x04EC0001, -+ 0x81C, 0x03EE0001, -+ 0x81C, 0x02F00001, -+ 0x81C, 0x01F20001, -+ 0x81C, 0x01F40001, -+ 0x81C, 0x01F60001, -+ 0x81C, 0x01F80001, -+ 0x81C, 0x01FA0001, -+ 0x81C, 0x01FC0001, -+ 0x81C, 0x01FE0001, -+ 0xB0000000, 0x00000000, -+ 0xC50, 0x00000022, -+ 0xC50, 0x00000020, -+ 0xE50, 0x00000022, -+ 0xE50, 0x00000020, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_AGC_TAB( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_AGC_TAB)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_AGC_TAB; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8812A_AGC_TAB\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8812A_AGC_TAB(void) -+{ -+ return 55; -+} -+ -+/****************************************************************************** -+* AGC_TAB_DIFF.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_AGC_TAB_DIFF_LB[] = { -+ 0x80000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0x47CE0001, -+ 0x81C, 0x46D00001, -+ 0x81C, 0x45D20001, -+ 0x81C, 0x44D40001, -+ 0x81C, 0x43D60001, -+ 0x81C, 0x42D80001, -+ 0x81C, 0x08DA0001, -+ 0x81C, 0x07DC0001, -+ 0x81C, 0x06DE0001, -+ 0x81C, 0x05E00001, -+ 0x81C, 0x04E20001, -+ 0x81C, 0x03E40001, -+ 0x81C, 0x02E60001, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0x47D80001, -+ 0x81C, 0x46DA0001, -+ 0x81C, 0x45DC0001, -+ 0x81C, 0x44DE0001, -+ 0x81C, 0x43E00001, -+ 0x81C, 0x42E20001, -+ 0x81C, 0x08E40001, -+ 0x81C, 0x07E60001, -+ 0x81C, 0x06E80001, -+ 0x81C, 0x05EA0001, -+ 0x81C, 0x04EC0001, -+ 0x81C, 0x03EE0001, -+ 0x81C, 0x02F00001, -+ 0xB0000000, 0x00000000, -+}; -+ -+u4Byte Array_MP_8812A_AGC_TAB_DIFF_HB[] = { -+ 0x80000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0x45CE0001, -+ 0x81C, 0x44D00001, -+ 0x81C, 0x43D20001, -+ 0x81C, 0x42D40001, -+ 0x81C, 0x08D60001, -+ 0x81C, 0x07D80001, -+ 0x81C, 0x06DA0001, -+ 0x81C, 0x05DC0001, -+ 0x81C, 0x04DE0001, -+ 0x81C, 0x03E00001, -+ 0x81C, 0x02E20001, -+ 0x81C, 0x01E40001, -+ 0x81C, 0x01E60001, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0x45D80001, -+ 0x81C, 0x44DA0001, -+ 0x81C, 0x43DC0001, -+ 0x81C, 0x42DE0001, -+ 0x81C, 0x08E00001, -+ 0x81C, 0x07E20001, -+ 0x81C, 0x06E40001, -+ 0x81C, 0x05E60001, -+ 0x81C, 0x04E80001, -+ 0x81C, 0x03EA0001, -+ 0x81C, 0x02EC0001, -+ 0x81C, 0x01EE0001, -+ 0x81C, 0x01F00001, -+ 0xB0000000, 0x00000000, -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_AGC_TAB_DIFF( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Array[], -+ IN u4Byte ArrayLen -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8812A_AGC_TAB_DIFF\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8812A_AGC_TAB_DIFF(void) -+{ -+ return 55; -+} -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_PHY_REG[] = { -+ 0x800, 0x8020D010, -+ 0x804, 0x080112E0, -+ 0x808, 0x0E028233, -+ 0x80C, 0x12131113, -+ 0x810, 0x20101263, -+ 0x814, 0x020C3D10, -+ 0x818, 0x03A00385, -+ 0x820, 0x00000000, -+ 0x824, 0x00030FE0, -+ 0x828, 0x00000000, -+ 0x82C, 0x002083DD, -+ 0x830, 0x2EAAEEB8, -+ 0x834, 0x0037A706, -+ 0x838, 0x06C89B44, -+ 0x83C, 0x0000095B, -+ 0x840, 0xC0000001, -+ 0x844, 0x40003CDE, -+ 0x848, 0x6210FF8B, -+ 0x84C, 0x6CFDFFB8, -+ 0x850, 0x28874706, -+ 0x854, 0x0001520C, -+ 0x858, 0x8060E000, -+ 0x85C, 0x74210168, -+ 0x860, 0x6929C321, -+ 0x864, 0x79727432, -+ 0x868, 0x8CA7A314, -+ 0x86C, 0x338C2878, -+ 0x870, 0x03333333, -+ 0x874, 0x31602C2E, -+ 0x878, 0x00003152, -+ 0x87C, 0x000FC000, -+ 0x8A0, 0x00000013, -+ 0x8A4, 0x7F7F7F7F, -+ 0x8A8, 0xA202033E, -+ 0x8AC, 0x0FF0FA0A, -+ 0x8B0, 0x00000600, -+ 0x8B4, 0x000FC080, -+ 0x8B8, 0x6C0057FF, -+ 0x8BC, 0x4CA520A3, -+ 0x8C0, 0x27F00020, -+ 0x8C4, 0x00000000, -+ 0x8C8, 0x00012D69, -+ 0x8CC, 0x08248492, -+ 0x8D0, 0x0000B800, -+ 0x8DC, 0x00000000, -+ 0x8D4, 0x940008A0, -+ 0x8D8, 0x290B5612, -+ 0x8F8, 0x400002C0, -+ 0x8FC, 0x00000000, -+ 0x900, 0x00000701, -+ 0x90C, 0x00000000, -+ 0x910, 0x0000FC00, -+ 0x914, 0x00000404, -+ 0x918, 0x1C1028C0, -+ 0x91C, 0x64B11A1C, -+ 0x920, 0xE0767233, -+ 0x924, 0x055AA500, -+ 0x928, 0x00000004, -+ 0x92C, 0xFFFE0000, -+ 0x930, 0xFFFFFFFE, -+ 0x934, 0x001FFFFF, -+ 0x960, 0x00000000, -+ 0x964, 0x00000000, -+ 0x968, 0x00000000, -+ 0x96C, 0x00000000, -+ 0x970, 0x801FFFFF, -+ 0x978, 0x00000000, -+ 0x97C, 0x00000000, -+ 0x980, 0x00000000, -+ 0x984, 0x00000000, -+ 0x988, 0x00000000, -+ 0x990, 0x27100000, -+ 0x994, 0xFFFF0100, -+ 0x998, 0xFFFFFF5C, -+ 0x99C, 0xFFFFFFFF, -+ 0x9A0, 0x000000FF, -+ 0x9A4, 0x00080080, -+ 0x9A8, 0x00000000, -+ 0x9AC, 0x00000000, -+ 0x9B0, 0x81081008, -+ 0x9B4, 0x00000000, -+ 0x9B8, 0x01081008, -+ 0x9BC, 0x01081008, -+ 0x9D0, 0x00000000, -+ 0x9D4, 0x00000000, -+ 0x9D8, 0x00000000, -+ 0x9DC, 0x00000000, -+ 0x9E4, 0x00000003, -+ 0x9E8, 0x000002D5, -+ 0xA00, 0x00D047C8, -+ 0xA04, 0x01FF000C, -+ 0xA08, 0x8C838300, -+ 0xA0C, 0x2E7F000F, -+ 0xA10, 0x9500BB78, -+ 0xA14, 0x11144028, -+ 0xA18, 0x00881117, -+ 0xA1C, 0x89140F00, -+ 0xA20, 0x1A1B0000, -+ 0xA24, 0x090E1217, -+ 0xA28, 0x00000305, -+ 0xA2C, 0x00900000, -+ 0xA70, 0x101FFF00, -+ 0xA74, 0x00000008, -+ 0xA78, 0x00000900, -+ 0xA7C, 0x225B0606, -+ 0xA80, 0x218075B2, -+ 0xA84, 0x001F8C80, -+ 0xB00, 0x03100000, -+ 0xB04, 0x0000B000, -+ 0xB08, 0xAE0201EB, -+ 0xB0C, 0x01003207, -+ 0xB10, 0x00009807, -+ 0xB14, 0x01000000, -+ 0xB18, 0x00000002, -+ 0xB1C, 0x00000002, -+ 0xB20, 0x0000001F, -+ 0xB24, 0x03020100, -+ 0xB28, 0x07060504, -+ 0xB2C, 0x0B0A0908, -+ 0xB30, 0x0F0E0D0C, -+ 0xB34, 0x13121110, -+ 0xB38, 0x17161514, -+ 0xB3C, 0x0000003A, -+ 0xB40, 0x00000000, -+ 0xB44, 0x00000000, -+ 0xB48, 0x13000032, -+ 0xB4C, 0x48080000, -+ 0xB50, 0x00000000, -+ 0xB54, 0x00000000, -+ 0xB58, 0x00000000, -+ 0xB5C, 0x00000000, -+ 0xC00, 0x00000007, -+ 0xC04, 0x00042020, -+ 0xC08, 0x80410231, -+ 0xC0C, 0x00000000, -+ 0xC10, 0x00000100, -+ 0xC14, 0x01000000, -+ 0xC1C, 0x40000003, -+ 0xC20, 0x12121212, -+ 0xC24, 0x12121212, -+ 0xC28, 0x12121212, -+ 0xC2C, 0x12121212, -+ 0xC30, 0x12121212, -+ 0xC34, 0x12121212, -+ 0xC38, 0x12121212, -+ 0xC3C, 0x12121212, -+ 0xC40, 0x12121212, -+ 0xC44, 0x12121212, -+ 0xC48, 0x12121212, -+ 0xC4C, 0x12121212, -+ 0xC50, 0x00000020, -+ 0xC54, 0x0008121C, -+ 0xC58, 0x30000C1C, -+ 0xC5C, 0x00000058, -+ 0xC60, 0x34344443, -+ 0xC64, 0x07003333, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0xC68, 0x59791979, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0xC68, 0x59791979, -+ 0x90000002, 0x00000000, 0x40000000, 0x00000000, -+ 0xC68, 0x59791979, -+ 0x90000004, 0x00000000, 0x40000000, 0x00000000, -+ 0xC68, 0x59791979, -+ 0x90000001, 0x00000000, 0x40000000, 0x00000000, -+ 0xC68, 0x59791979, -+ 0x90000001, 0x00000005, 0x40000000, 0x00000000, -+ 0xC68, 0x59791979, -+ 0xA0000000, 0x00000000, -+ 0xC68, 0x59799979, -+ 0xB0000000, 0x00000000, -+ 0xC6C, 0x59795979, -+ 0xC70, 0x19795979, -+ 0xC74, 0x19795979, -+ 0xC78, 0x19791979, -+ 0xC7C, 0x19791979, -+ 0xC80, 0x19791979, -+ 0xC84, 0x19791979, -+ 0xC94, 0x0100005C, -+ 0xC98, 0x00000000, -+ 0xC9C, 0x00000000, -+ 0xCA0, 0x00000029, -+ 0xCA4, 0x08040201, -+ 0xCA8, 0x80402010, -+ 0xCB0, 0x77547777, -+ 0xCB4, 0x00000077, -+ 0xCB8, 0x00508242, -+ 0xE00, 0x00000007, -+ 0xE04, 0x00042020, -+ 0xE08, 0x80410231, -+ 0xE0C, 0x00000000, -+ 0xE10, 0x00000100, -+ 0xE14, 0x01000000, -+ 0xE1C, 0x40000003, -+ 0xE20, 0x12121212, -+ 0xE24, 0x12121212, -+ 0xE28, 0x12121212, -+ 0xE2C, 0x12121212, -+ 0xE30, 0x12121212, -+ 0xE34, 0x12121212, -+ 0xE38, 0x12121212, -+ 0xE3C, 0x12121212, -+ 0xE40, 0x12121212, -+ 0xE44, 0x12121212, -+ 0xE48, 0x12121212, -+ 0xE4C, 0x12121212, -+ 0xE50, 0x00000020, -+ 0xE54, 0x0008121C, -+ 0xE58, 0x30000C1C, -+ 0xE5C, 0x00000058, -+ 0xE60, 0x34344443, -+ 0xE64, 0x07003333, -+ 0xE68, 0x59791979, -+ 0xE6C, 0x59795979, -+ 0xE70, 0x19795979, -+ 0xE74, 0x19795979, -+ 0xE78, 0x19791979, -+ 0xE7C, 0x19791979, -+ 0xE80, 0x19791979, -+ 0xE84, 0x19791979, -+ 0xE94, 0x0100005C, -+ 0xE98, 0x00000000, -+ 0xE9C, 0x00000000, -+ 0xEA0, 0x00000029, -+ 0xEA4, 0x08040201, -+ 0xEA8, 0x80402010, -+ 0xEB0, 0x77547777, -+ 0xEB4, 0x00000077, -+ 0xEB8, 0x00508242, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_PHY_REG; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8812A_PHY_REG\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8812A_PHY_REG(void) -+{ -+ return 55; -+} -+ -+/****************************************************************************** -+* PHY_REG_MP.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_PHY_REG_MP[] = { -+ 0x800, 0x8020D410, -+ 0x830, 0x2EAA8EB8, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_MP( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG_MP)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_PHY_REG_MP; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8812A_PHY_REG_MP\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8812A_PHY_REG_MP(void) -+{ -+ return 55; -+} -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_PHY_REG_PG[] = { -+ 0, 0, 0, 0x00000c20, 0xffffffff, 0x34363840, -+ 0, 0, 0, 0x00000c24, 0xffffffff, 0x42424444, -+ 0, 0, 0, 0x00000c28, 0xffffffff, 0x30323638, -+ 0, 0, 0, 0x00000c2c, 0xffffffff, 0x40424444, -+ 0, 0, 0, 0x00000c30, 0xffffffff, 0x28303236, -+ 0, 0, 1, 0x00000c34, 0xffffffff, 0x38404242, -+ 0, 0, 1, 0x00000c38, 0xffffffff, 0x26283034, -+ 0, 0, 0, 0x00000c3c, 0xffffffff, 0x40424444, -+ 0, 0, 0, 0x00000c40, 0xffffffff, 0x28303236, -+ 0, 0, 0, 0x00000c44, 0xffffffff, 0x42422426, -+ 0, 0, 1, 0x00000c48, 0xffffffff, 0x30343840, -+ 0, 0, 1, 0x00000c4c, 0xffffffff, 0x22242628, -+ 0, 1, 0, 0x00000e20, 0xffffffff, 0x34363840, -+ 0, 1, 0, 0x00000e24, 0xffffffff, 0x42424444, -+ 0, 1, 0, 0x00000e28, 0xffffffff, 0x30323638, -+ 0, 1, 0, 0x00000e2c, 0xffffffff, 0x40424444, -+ 0, 1, 0, 0x00000e30, 0xffffffff, 0x28303236, -+ 0, 1, 1, 0x00000e34, 0xffffffff, 0x38404242, -+ 0, 1, 1, 0x00000e38, 0xffffffff, 0x26283034, -+ 0, 1, 0, 0x00000e3c, 0xffffffff, 0x40424444, -+ 0, 1, 0, 0x00000e40, 0xffffffff, 0x28303236, -+ 0, 1, 0, 0x00000e44, 0xffffffff, 0x42422426, -+ 0, 1, 1, 0x00000e48, 0xffffffff, 0x30343840, -+ 0, 1, 1, 0x00000e4c, 0xffffffff, 0x22242628, -+ 1, 0, 0, 0x00000c24, 0xffffffff, 0x42424444, -+ 1, 0, 0, 0x00000c28, 0xffffffff, 0x30323640, -+ 1, 0, 0, 0x00000c2c, 0xffffffff, 0x40424444, -+ 1, 0, 0, 0x00000c30, 0xffffffff, 0x28303236, -+ 1, 0, 1, 0x00000c34, 0xffffffff, 0x38404242, -+ 1, 0, 1, 0x00000c38, 0xffffffff, 0x26283034, -+ 1, 0, 0, 0x00000c3c, 0xffffffff, 0x40424444, -+ 1, 0, 0, 0x00000c40, 0xffffffff, 0x28303236, -+ 1, 0, 0, 0x00000c44, 0xffffffff, 0x42422426, -+ 1, 0, 1, 0x00000c48, 0xffffffff, 0x30343840, -+ 1, 0, 1, 0x00000c4c, 0xffffffff, 0x22242628, -+ 1, 1, 0, 0x00000e24, 0xffffffff, 0x42424444, -+ 1, 1, 0, 0x00000e28, 0xffffffff, 0x30323640, -+ 1, 1, 0, 0x00000e2c, 0xffffffff, 0x40424444, -+ 1, 1, 0, 0x00000e30, 0xffffffff, 0x28303236, -+ 1, 1, 1, 0x00000e34, 0xffffffff, 0x38404242, -+ 1, 1, 1, 0x00000e38, 0xffffffff, 0x26283034, -+ 1, 1, 0, 0x00000e3c, 0xffffffff, 0x40424444, -+ 1, 1, 0, 0x00000e40, 0xffffffff, 0x28303236, -+ 1, 1, 0, 0x00000e44, 0xffffffff, 0x42422426, -+ 1, 1, 1, 0x00000e48, 0xffffffff, 0x30343840, -+ 1, 1, 1, 0x00000e4c, 0xffffffff, 0x22242628 -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_PG( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG_PG)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_PHY_REG_PG; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrByRate, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrByRate = ArrayLen/6; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8812A_PHY_REG_PG\n")); -+ -+ pDM_Odm->PhyRegPgVersion = 1; -+ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; -+ -+ for (i = 0; i < ArrayLen; i += 6) { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ u4Byte v3 = Array[i+2]; -+ u4Byte v4 = Array[i+3]; -+ u4Byte v5 = Array[i+4]; -+ u4Byte v6 = Array[i+5]; -+ -+ odm_ConfigBB_PHY_REG_PG_8812A(pDM_Odm, v1, v2, v3, v4, v5, v6); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf(pHalData->BufOfLinesPwrByRate[i/6], 100, "%s, %s, %s, 0x%X, 0x%08X, 0x%08X,", -+ (v1 == 0?"2.4G":" 5G"), (v2 == 0?"A":"B"), (v3 == 0?"1Tx":"2Tx"), v4, v5, v6); -+#endif -+ } -+} -+ -+ -+ -+/****************************************************************************** -+* PHY_REG_PG_ASUS.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_PHY_REG_PG_ASUS[] = { -+ 0, 0, 0, 0x00000c20, 0xffffffff, 0x34343434, -+ 0, 0, 0, 0x00000c24, 0xffffffff, 0x32323232, -+ 0, 0, 0, 0x00000c28, 0xffffffff, 0x28303232, -+ 0, 0, 0, 0x00000c2c, 0xffffffff, 0x32323232, -+ 0, 0, 0, 0x00000c30, 0xffffffff, 0x28303232, -+ 0, 0, 1, 0x00000c34, 0xffffffff, 0x32323232, -+ 0, 0, 1, 0x00000c38, 0xffffffff, 0x26283032, -+ 0, 0, 0, 0x00000c3c, 0xffffffff, 0x32323232, -+ 0, 0, 0, 0x00000c40, 0xffffffff, 0x28303232, -+ 0, 0, 0, 0x00000c44, 0xffffffff, 0x32322426, -+ 0, 0, 1, 0x00000c48, 0xffffffff, 0x32323232, -+ 0, 0, 1, 0x00000c4c, 0xffffffff, 0x24262830, -+ 0, 1, 0, 0x00000e20, 0xffffffff, 0x34343434, -+ 0, 1, 0, 0x00000e24, 0xffffffff, 0x32323232, -+ 0, 1, 0, 0x00000e28, 0xffffffff, 0x28303232, -+ 0, 1, 0, 0x00000e2c, 0xffffffff, 0x32323232, -+ 0, 1, 0, 0x00000e30, 0xffffffff, 0x28303232, -+ 0, 1, 1, 0x00000e34, 0xffffffff, 0x32323232, -+ 0, 1, 1, 0x00000e38, 0xffffffff, 0x26283032, -+ 0, 1, 0, 0x00000e3c, 0xffffffff, 0x32323232, -+ 0, 1, 0, 0x00000e40, 0xffffffff, 0x28303232, -+ 0, 1, 0, 0x00000e44, 0xffffffff, 0x32322426, -+ 0, 1, 1, 0x00000e48, 0xffffffff, 0x32323232, -+ 0, 1, 1, 0x00000e4c, 0xffffffff, 0x24262830, -+ 1, 0, 0, 0x00000c24, 0xffffffff, 0x32323232, -+ 1, 0, 0, 0x00000c28, 0xffffffff, 0x28303232, -+ 1, 0, 0, 0x00000c2c, 0xffffffff, 0x32323232, -+ 1, 0, 0, 0x00000c30, 0xffffffff, 0x24262830, -+ 1, 0, 1, 0x00000c34, 0xffffffff, 0x32323232, -+ 1, 0, 1, 0x00000c38, 0xffffffff, 0x24262830, -+ 1, 0, 0, 0x00000c3c, 0xffffffff, 0x32323232, -+ 1, 0, 0, 0x00000c40, 0xffffffff, 0x24262830, -+ 1, 0, 0, 0x00000c44, 0xffffffff, 0x32322222, -+ 1, 0, 1, 0x00000c48, 0xffffffff, 0x28303232, -+ 1, 0, 1, 0x00000c4c, 0xffffffff, 0x22222426, -+ 1, 1, 0, 0x00000e24, 0xffffffff, 0x32323232, -+ 1, 1, 0, 0x00000e28, 0xffffffff, 0x28303232, -+ 1, 1, 0, 0x00000e2c, 0xffffffff, 0x32323232, -+ 1, 1, 0, 0x00000e30, 0xffffffff, 0x24262830, -+ 1, 1, 1, 0x00000e34, 0xffffffff, 0x32323232, -+ 1, 1, 1, 0x00000e38, 0xffffffff, 0x24262830, -+ 1, 1, 0, 0x00000e3c, 0xffffffff, 0x32323232, -+ 1, 1, 0, 0x00000e40, 0xffffffff, 0x24262830, -+ 1, 1, 0, 0x00000e44, 0xffffffff, 0x32322222, -+ 1, 1, 1, 0x00000e48, 0xffffffff, 0x28303232, -+ 1, 1, 1, 0x00000e4c, 0xffffffff, 0x22222426 -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_ASUS( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG_PG_ASUS)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_PHY_REG_PG_ASUS; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrByRate, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrByRate = ArrayLen/6; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_ASUS\n")); -+ -+ pDM_Odm->PhyRegPgVersion = 1; -+ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; -+ -+ for (i = 0; i < ArrayLen; i += 6) { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ u4Byte v3 = Array[i+2]; -+ u4Byte v4 = Array[i+3]; -+ u4Byte v5 = Array[i+4]; -+ u4Byte v6 = Array[i+5]; -+ -+ odm_ConfigBB_PHY_REG_PG_8812A(pDM_Odm, v1, v2, v3, v4, v5, v6); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf(pHalData->BufOfLinesPwrByRate[i/6], 100, "%s, %s, %s, 0x%X, 0x%08X, 0x%08X,", -+ (v1 == 0?"2.4G":" 5G"), (v2 == 0?"A":"B"), (v3 == 0?"1Tx":"2Tx"), v4, v5, v6); -+#endif -+ } -+} -+ -+ -+ -+/****************************************************************************** -+* PHY_REG_PG_NEC.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_PHY_REG_PG_NEC[] = { -+ 0, 0, 0, 0x00000c20, 0xffffffff, 0x32323232, -+ 0, 0, 0, 0x00000c24, 0xffffffff, 0x32343434, -+ 0, 0, 0, 0x00000c28, 0xffffffff, 0x24262830, -+ 0, 0, 0, 0x00000c2c, 0xffffffff, 0x32343434, -+ 0, 0, 0, 0x00000c30, 0xffffffff, 0x24262830, -+ 0, 0, 1, 0x00000c34, 0xffffffff, 0x32343434, -+ 0, 0, 1, 0x00000c38, 0xffffffff, 0x24262830, -+ 0, 0, 0, 0x00000c3c, 0xffffffff, 0x32343434, -+ 0, 0, 0, 0x00000c40, 0xffffffff, 0x24262830, -+ 0, 0, 0, 0x00000c44, 0xffffffff, 0x34342022, -+ 0, 0, 1, 0x00000c48, 0xffffffff, 0x28303234, -+ 0, 0, 1, 0x00000c4c, 0xffffffff, 0x20222426, -+ 0, 1, 0, 0x00000e20, 0xffffffff, 0x32323232, -+ 0, 1, 0, 0x00000e24, 0xffffffff, 0x32343434, -+ 0, 1, 0, 0x00000e28, 0xffffffff, 0x24262830, -+ 0, 1, 0, 0x00000e2c, 0xffffffff, 0x32343434, -+ 0, 1, 0, 0x00000e30, 0xffffffff, 0x24262830, -+ 0, 1, 1, 0x00000e34, 0xffffffff, 0x32343434, -+ 0, 1, 1, 0x00000e38, 0xffffffff, 0x24262830, -+ 0, 1, 0, 0x00000e3c, 0xffffffff, 0x32343434, -+ 0, 1, 0, 0x00000e40, 0xffffffff, 0x24262830, -+ 0, 1, 0, 0x00000e44, 0xffffffff, 0x34342022, -+ 0, 1, 1, 0x00000e48, 0xffffffff, 0x28303234, -+ 0, 1, 1, 0x00000e4c, 0xffffffff, 0x20222426, -+ 1, 0, 0, 0x00000c24, 0xffffffff, 0x32343434, -+ 1, 0, 0, 0x00000c28, 0xffffffff, 0x24262830, -+ 1, 0, 0, 0x00000c2c, 0xffffffff, 0x32343434, -+ 1, 0, 0, 0x00000c30, 0xffffffff, 0x24262830, -+ 1, 0, 1, 0x00000c34, 0xffffffff, 0x28282828, -+ 1, 0, 1, 0x00000c38, 0xffffffff, 0x24262828, -+ 1, 0, 0, 0x00000c3c, 0xffffffff, 0x32343434, -+ 1, 0, 0, 0x00000c40, 0xffffffff, 0x24262830, -+ 1, 0, 0, 0x00000c44, 0xffffffff, 0x28282022, -+ 1, 0, 1, 0x00000c48, 0xffffffff, 0x28282828, -+ 1, 0, 1, 0x00000c4c, 0xffffffff, 0x20222426, -+ 1, 1, 0, 0x00000e24, 0xffffffff, 0x32343434, -+ 1, 1, 0, 0x00000e28, 0xffffffff, 0x24262830, -+ 1, 1, 0, 0x00000e2c, 0xffffffff, 0x32343434, -+ 1, 1, 0, 0x00000e30, 0xffffffff, 0x24262830, -+ 1, 1, 1, 0x00000e34, 0xffffffff, 0x28282828, -+ 1, 1, 1, 0x00000e38, 0xffffffff, 0x24262828, -+ 1, 1, 0, 0x00000e3c, 0xffffffff, 0x32343434, -+ 1, 1, 0, 0x00000e40, 0xffffffff, 0x24262830, -+ 1, 1, 0, 0x00000e44, 0xffffffff, 0x28282022, -+ 1, 1, 1, 0x00000e48, 0xffffffff, 0x28282828, -+ 1, 1, 1, 0x00000e4c, 0xffffffff, 0x20222426 -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_NEC( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG_PG_NEC)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_PHY_REG_PG_NEC; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrByRate, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrByRate = ArrayLen/6; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_NEC\n")); -+ -+ pDM_Odm->PhyRegPgVersion = 1; -+ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; -+ -+ for (i = 0; i < ArrayLen; i += 6) { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ u4Byte v3 = Array[i+2]; -+ u4Byte v4 = Array[i+3]; -+ u4Byte v5 = Array[i+4]; -+ u4Byte v6 = Array[i+5]; -+ -+ odm_ConfigBB_PHY_REG_PG_8812A(pDM_Odm, v1, v2, v3, v4, v5, v6); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf(pHalData->BufOfLinesPwrByRate[i/6], 100, "%s, %s, %s, 0x%X, 0x%08X, 0x%08X,", -+ (v1 == 0?"2.4G":" 5G"), (v2 == 0?"A":"B"), (v3 == 0?"1Tx":"2Tx"), v4, v5, v6); -+#endif -+ } -+} -+ -+ -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_bb.h linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_bb.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_bb.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_bb.h 2017-06-07 23:07:21.021688487 +0300 -@@ -0,0 +1,103 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.14*/ -+#if (RTL8812A_SUPPORT == 1) -+#ifndef __INC_MP_BB_HW_IMG_8812A_H -+#define __INC_MP_BB_HW_IMG_8812A_H -+ -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_AGC_TAB(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_AGC_TAB(void); -+ -+/****************************************************************************** -+* AGC_TAB_DIFF.TXT -+******************************************************************************/ -+ -+extern u4Byte Array_MP_8812A_AGC_TAB_DIFF_LB[60]; -+extern u4Byte Array_MP_8812A_AGC_TAB_DIFF_HB[60]; -+void -+ODM_ReadAndConfig_MP_8812A_AGC_TAB_DIFF( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Array[], -+ IN u4Byte ArrayLen -+); -+u4Byte ODM_GetVersion_MP_8812A_AGC_TAB_DIFF(void); -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_PHY_REG(void); -+ -+/****************************************************************************** -+* PHY_REG_MP.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_MP(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_PHY_REG_MP(void); -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_PG(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_PHY_REG_PG(void); -+ -+/****************************************************************************** -+* PHY_REG_PG_ASUS.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_ASUS(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_PHY_REG_PG_ASUS(void); -+ -+/****************************************************************************** -+* PHY_REG_PG_NEC.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_NEC(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_PHY_REG_PG_NEC(void); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_fw.c linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_fw.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_fw.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_fw.c 2017-06-07 23:07:21.023688669 +0300 -@@ -0,0 +1,6559 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.11*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8812A_SUPPORT == 1) -+#if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) -+ -+ -+u1Byte Array_MP_8812A_FW_AP[] = { -+0x01, 0x95, 0x20, 0x00, 0x29, 0x00, 0x00, 0x00, 0x06, 0x17, 0x19, 0x26, 0x04, 0x46, 0x00, 0x00, -+0x65, 0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x4A, 0x7B, 0x02, 0x71, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x72, 0x1B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x78, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x71, 0x92, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x77, 0xC6, 0x00, 0x00, -+0x00, 0x04, 0x0C, 0x00, 0x00, 0x00, 0x04, 0x08, 0x08, 0x00, 0x00, 0x00, 0x0A, 0x08, 0x03, 0x03, -+0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, 0x04, 0x08, 0x05, -+0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, 0x04, 0x00, 0x08, -+0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, 0x0A, 0x03, 0x02, -+0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, 0x10, 0x24, 0x22, -+0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, 0x06, 0x00, 0x20, -+0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, 0x21, 0x0C, 0x04, -+0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, 0x20, 0x21, 0x1F, -+0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, 0x10, 0x00, 0x30, -+0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, 0x28, 0x14, 0x00, -+0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, 0x30, 0x15, 0xF0, -+0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, 0x00, 0x00, -+0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, -+0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, -+0xFF, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x3F, 0x00, 0x00, -+0x00, 0x00, 0x15, 0xF0, 0xCF, 0xFF, 0x00, 0x00, 0x00, 0x16, 0x0D, 0x17, 0x0E, 0x17, 0x0F, 0x18, -+0x10, 0x19, 0x11, 0x1A, 0x12, 0x1A, 0x13, 0x1A, 0x14, 0x1A, 0x15, 0x1B, 0xFF, 0x17, 0x0E, 0x18, -+0x10, 0x19, 0x11, 0x1A, 0x12, 0x1B, 0x15, 0x1C, 0xFF, 0x1D, 0xFF, 0x1E, 0xFF, 0x1F, 0xFF, 0xFF, -+0xFF, 0x14, 0x0D, 0x0E, 0x15, 0x15, 0x0F, 0x16, 0x10, 0x17, 0x11, 0x18, 0x12, 0x18, 0x13, 0x18, -+0xFF, 0x15, 0x0D, 0x16, 0x10, 0x10, 0x17, 0x18, 0x12, 0x19, 0xFF, 0x1A, 0xFF, 0x1B, 0xFF, 0xFF, -+0xFF, 0x00, 0x00, 0x00, 0x00, 0x04, 0x04, 0x0C, 0x0C, 0x0D, 0x0C, 0x0E, 0x0D, 0x0F, 0x17, 0x18, -+0x10, 0x19, 0x11, 0x19, 0x11, 0x19, 0x12, 0x1A, 0x14, 0x0C, 0x0C, 0x16, 0x0D, 0x17, 0x0F, 0x18, -+0x10, 0x19, 0x13, 0x1A, 0x14, 0x1B, 0x15, 0x1C, 0x1B, 0x1D, 0x1C, 0x1E, 0x1D, 0x04, 0x04, 0x0C, -+0x14, 0x0D, 0x14, 0x0E, 0x14, 0x0F, 0x15, 0x10, 0x16, 0x17, 0x11, 0x12, 0x17, 0x0C, 0x0C, 0x14, -+0x0E, 0x15, 0x0F, 0x16, 0x10, 0x17, 0x12, 0x18, 0x18, 0x19, 0x19, 0x1A, 0x19, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, 0x25, 0x27, -+0x28, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, -+0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, -+0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, -+0x00, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, 0x2A, 0x2A, -+0x2A, 0x00, 0x04, 0x00, 0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, -+0x48, 0x00, 0x60, 0x00, 0x90, 0x00, 0xC0, 0x00, 0xD8, 0x00, 0x3C, 0x00, 0x64, 0x00, 0x78, 0x00, -+0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, 0x90, 0x01, 0xE0, 0x00, 0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, -+0x90, 0x02, 0x58, 0x03, 0x20, 0x04, 0xB0, 0x06, 0x40, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, -+0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, -+0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x64, 0x00, -+0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, 0x90, 0x01, 0x90, 0x02, 0x58, 0x03, 0x20, 0x00, 0x78, 0x00, -+0xF0, 0x01, 0x90, 0x02, 0x58, 0x03, 0xE8, 0x07, 0xD0, 0x09, 0x60, 0x0F, 0xA0, 0x12, 0xC0, 0x15, -+0x18, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, -+0xD0, 0x07, 0xD0, 0x07, 0xD0, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, -+0xB0, 0x06, 0x40, 0x07, 0xD0, 0x07, 0xD0, 0x07, 0xD0, 0x00, 0x02, 0x00, 0x02, 0x00, 0x04, 0x00, -+0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x48, 0x00, 0x60, 0x00, -+0x6C, 0x00, 0x14, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x00, -+0xF0, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x01, 0x2C, 0x01, 0x90, 0x02, 0x58, 0x03, -+0x20, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, -+0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, -+0xE8, 0x00, 0x1E, 0x00, 0x28, 0x00, 0x32, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x00, -+0xF0, 0x01, 0x7C, 0x01, 0x90, 0x00, 0x3C, 0x00, 0x78, 0x00, 0xC8, 0x01, 0x2C, 0x01, 0xF4, 0x03, -+0xE8, 0x04, 0xB0, 0x07, 0xD0, 0x09, 0x60, 0x0A, 0xF0, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, -+0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x00, 0x64, 0x00, -+0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, -+0xE8, 0x02, 0x04, 0x06, 0x08, 0x0A, 0x0C, 0x10, 0x18, 0x20, 0x30, 0x40, 0x50, 0x01, 0x01, 0x01, -+0x02, 0x01, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, 0x05, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0B, 0x05, 0x06, 0x06, -+0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, -+0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x01, 0x02, 0x03, -+0x04, 0x05, 0x06, 0x07, 0x08, 0x02, 0x04, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x03, 0x05, 0x06, -+0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x02, 0x04, 0x06, -+0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x03, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, -+0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, -+0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, 0x04, 0x0C, 0x14, 0x2C, -+0x36, 0x04, 0x08, 0x08, 0x08, 0x0A, 0x0A, 0x04, 0x04, 0x04, 0x05, 0x04, 0x04, 0x05, 0x07, 0x07, -+0x07, 0x08, 0x0A, 0x04, 0x07, 0x0A, 0x0E, 0x11, 0x13, 0x14, 0x15, 0x03, 0x04, 0x07, 0x07, 0x08, -+0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, -+0x0B, 0x0D, 0x0F, 0x07, 0x08, 0x08, 0x0A, 0x0A, 0x0C, 0x0E, 0x10, 0x11, 0x11, 0x07, 0x09, 0x09, -+0x0B, 0x0B, 0x0D, 0x0F, 0x13, 0x13, 0x14, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, -+0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, -+0x07, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x05, 0x06, 0x07, 0x0D, 0x10, 0x11, 0x12, 0x12, 0x07, -+0x08, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, -+0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x05, 0x06, 0x08, 0x09, 0x0C, 0x0E, 0x12, 0x12, 0x13, -+0x14, 0x07, 0x08, 0x09, 0x0A, 0x0C, 0x0F, 0x12, 0x12, 0x14, 0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, -+0x0E, 0x11, 0x13, 0x13, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x45, 0xE4, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4B, 0x19, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x4B, 0x19, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x46, 0x2D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x46, 0x2C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, 0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x46, 0x2D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, -+0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, -+0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, 0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, -+0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, -+0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, -+0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, -+0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, 0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, -+0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, 0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, -+0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, -+0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, -+0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, 0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, -+0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, -+0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, 0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, -+0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, -+0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, -+0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x48, 0xD9, 0x73, 0xC5, -+0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, 0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, -+0x83, 0xE0, 0x38, 0xF0, 0x22, 0xBB, 0x01, 0x0A, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, -+0xE0, 0x22, 0x50, 0x06, 0x87, 0xF0, 0x09, 0xE7, 0x19, 0x22, 0xBB, 0xFE, 0x07, 0xE3, 0xF5, 0xF0, -+0x09, 0xE3, 0x19, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0x74, 0x01, 0x93, 0x22, -+0xBB, 0x01, 0x10, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0xE0, 0xF5, 0xF0, -+0xA3, 0xE0, 0x22, 0x50, 0x09, 0xE9, 0x25, 0x82, 0xF8, 0x86, 0xF0, 0x08, 0xE6, 0x22, 0xBB, 0xFE, -+0x0A, 0xE9, 0x25, 0x82, 0xF8, 0xE2, 0xF5, 0xF0, 0x08, 0xE2, 0x22, 0xE5, 0x83, 0x2A, 0xF5, 0x83, -+0xE9, 0x93, 0xF5, 0xF0, 0xA3, 0xE9, 0x93, 0x22, 0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, -+0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, -+0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, -+0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, -+0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, -+0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, -+0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, -+0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, -+0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x02, 0x4A, 0xB9, 0x02, 0x46, -+0xBD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, -+0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, -+0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, -+0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x4A, 0xFE, 0xE4, 0x7E, 0x01, 0x93, -+0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, -+0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, -+0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, -+0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0x41, 0xA8, -+0xB0, 0x00, 0x41, 0xA8, 0xB1, 0x00, 0x44, 0xA8, 0x7A, 0x41, 0x4E, 0x59, 0x00, 0x44, 0xA8, 0x76, -+0x61, 0x6E, 0x79, 0x00, 0x41, 0xA8, 0xBD, 0x00, 0x00, 0x57, 0xF7, 0x5F, 0xFE, 0x60, 0x25, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0xA7, 0x15, 0xF0, 0x90, 0xA7, 0x1A, 0xF0, 0x90, -+0xA7, 0x18, 0xF0, 0x91, 0x7F, 0x40, 0x02, 0x61, 0xC1, 0xC3, 0x74, 0xFD, 0x91, 0x88, 0x7A, 0xA7, -+0x79, 0x14, 0x12, 0x33, 0xC7, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x81, 0x1D, 0x90, 0xA7, 0x14, 0xE0, -+0xFF, 0x54, 0xC0, 0xFE, 0x60, 0x05, 0xEF, 0x54, 0x0C, 0x70, 0x1C, 0x90, 0xA7, 0x14, 0xE0, 0xFF, -+0x54, 0x30, 0x60, 0x05, 0xEF, 0x54, 0x03, 0x70, 0x08, 0x90, 0xA7, 0x18, 0xE0, 0x60, 0x4A, 0x80, -+0x00, 0x90, 0xA7, 0x15, 0x74, 0x01, 0xF0, 0x90, 0xA7, 0x15, 0xE0, 0x90, 0xA7, 0x14, 0x70, 0x17, -+0xE0, 0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA7, 0x16, 0xF0, 0xEF, 0x54, 0x0C, 0x13, -+0x13, 0x54, 0x3F, 0xA3, 0xF0, 0x80, 0x10, 0xE0, 0xFF, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0xA7, -+0x16, 0xF0, 0xEF, 0x54, 0x03, 0xA3, 0xF0, 0x90, 0xA7, 0x16, 0xE0, 0x90, 0xA7, 0x0B, 0xF0, 0x90, -+0xA7, 0x17, 0xE0, 0x90, 0xA7, 0x0C, 0xF0, 0x80, 0x08, 0x90, 0xA7, 0x18, 0xE0, 0x04, 0xF0, 0x61, -+0x33, 0xE4, 0x90, 0xA7, 0x18, 0xF0, 0x91, 0x7F, 0x50, 0x63, 0xC3, 0x74, 0xFB, 0x91, 0x88, 0x7A, -+0xA7, 0x79, 0x19, 0x12, 0x33, 0xC7, 0xEF, 0x64, 0x01, 0x70, 0x42, 0x90, 0xA7, 0x19, 0xE0, 0xFF, -+0x54, 0xE0, 0xFE, 0x70, 0x13, 0xEF, 0x54, 0x0E, 0x70, 0x08, 0x90, 0xA7, 0x18, 0xE0, 0x60, 0x35, -+0x80, 0x00, 0x90, 0xA7, 0x1A, 0x74, 0x01, 0xF0, 0x90, 0xA7, 0x1A, 0xE0, 0x70, 0x09, 0xEE, 0xC4, -+0x13, 0x54, 0x07, 0xA3, 0xF0, 0x80, 0x0C, 0x90, 0xA7, 0x19, 0xE0, 0x54, 0x0E, 0xC3, 0x13, 0x90, -+0xA7, 0x1B, 0xF0, 0x90, 0xA7, 0x1B, 0xE0, 0x90, 0xA7, 0x0D, 0xF0, 0x80, 0x10, 0x90, 0xA7, 0x1C, -+0x74, 0x01, 0xF0, 0x80, 0x40, 0x90, 0xA7, 0x18, 0xE0, 0x04, 0xF0, 0x80, 0x99, 0x90, 0xA7, 0x0C, -+0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x54, 0x0C, 0xFF, 0x90, 0xA7, 0x0B, 0xE0, 0x54, 0x03, 0x4F, 0xFF, -+0x90, 0xA7, 0x0D, 0xE0, 0xFE, 0xC4, 0x54, 0x70, 0x4F, 0x44, 0x80, 0xFD, 0x7F, 0x8B, 0x12, 0x3A, -+0x96, 0x90, 0xA7, 0x0B, 0xE0, 0x60, 0x08, 0xA3, 0xE0, 0x60, 0x04, 0xA3, 0xE0, 0x70, 0x1B, 0x90, -+0xA7, 0x1C, 0x74, 0x03, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0x1F, 0xF0, 0x74, 0x4B, 0xA3, 0xF0, 0x90, -+0xA7, 0x1C, 0xE0, 0x90, 0x01, 0xC8, 0x91, 0x92, 0x80, 0xEB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0xA7, 0x18, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x22, 0x9F, 0xFF, 0x74, 0x03, 0x94, 0x00, 0xFE, 0x7B, -+0x01, 0x22, 0xF0, 0xE4, 0xFD, 0x7F, 0x1F, 0x02, 0x3A, 0x96, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA7, 0x26, 0xEF, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0x9A, 0xF0, -+0x74, 0x4C, 0xA3, 0xF0, 0x90, 0xA7, 0x27, 0xE0, 0x90, 0x01, 0xC8, 0xF0, 0x90, 0xA7, 0x26, 0xE0, -+0x90, 0x01, 0xC9, 0x91, 0x92, 0x80, 0xE3, 0xF1, 0xFC, 0x12, 0x26, 0x1E, 0x54, 0x7F, 0xF5, 0x0E, -+0x12, 0x77, 0xA3, 0xFF, 0x54, 0x1F, 0xF5, 0x10, 0xF1, 0xAA, 0xF5, 0x0F, 0xF1, 0xA4, 0xFF, 0x54, -+0x03, 0xF5, 0x11, 0xEF, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0xF5, 0x14, 0xF1, 0xA4, 0xFF, 0x54, 0x40, -+0xC4, 0x13, 0x13, 0x54, 0x03, 0xF5, 0x12, 0xF1, 0xAA, 0xF5, 0x13, 0xF1, 0xA4, 0xFF, 0x54, 0x08, -+0xFE, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xF5, 0x16, 0xEF, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xF5, -+0x17, 0x90, 0xA7, 0x0C, 0xE0, 0xB4, 0x02, 0x08, 0xE5, 0x14, 0x60, 0x04, 0xE4, 0xFF, 0x91, 0x9A, -+0x90, 0xA7, 0x0D, 0xE0, 0xB4, 0x01, 0x15, 0xF1, 0xB9, 0x12, 0x78, 0x9C, 0x54, 0xF0, 0x70, 0x08, -+0x90, 0x00, 0x06, 0x12, 0x26, 0x37, 0x60, 0x04, 0x7F, 0x01, 0x91, 0x9A, 0xE5, 0x13, 0x54, 0x01, -+0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0xD1, 0x57, 0x54, 0x7F, 0x4F, 0xF0, 0xE5, 0x12, 0x54, 0x01, -+0xC4, 0x33, 0x33, 0x54, 0xC0, 0xD1, 0x57, 0x54, 0xBF, 0x4F, 0xF0, 0xE5, 0x16, 0x70, 0x6C, 0xE5, -+0x10, 0x54, 0x1F, 0xF1, 0x96, 0x54, 0xE0, 0x4F, 0xF0, 0xE5, 0x11, 0x54, 0x03, 0xD1, 0x57, 0x54, -+0xFC, 0x4F, 0xF0, 0xEF, 0x25, 0xE0, 0x25, 0xE0, 0xD1, 0x57, 0x54, 0xF3, 0x4F, 0xF0, 0xE5, 0x0F, -+0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0xF1, 0x96, 0x54, 0xDF, 0x4F, 0xF0, 0xE5, 0x14, 0x54, 0x03, -+0xC4, 0x54, 0xF0, 0xD1, 0x57, 0x54, 0xCF, 0x4F, 0xF0, 0xE4, 0xF5, 0x15, 0xE5, 0x15, 0x24, 0x03, -+0xFF, 0xE4, 0x33, 0xFE, 0xF1, 0xB9, 0x8F, 0x82, 0x8E, 0x83, 0x12, 0x26, 0x37, 0xFF, 0x75, 0xF0, -+0x08, 0xE5, 0x0E, 0x12, 0x66, 0xD2, 0xE5, 0x82, 0x25, 0x15, 0x12, 0x61, 0xA6, 0xEF, 0xF0, 0x05, -+0x15, 0xE5, 0x15, 0xB4, 0x04, 0xD6, 0xAF, 0x0E, 0x12, 0x61, 0xAE, 0x22, 0x90, 0xA7, 0x20, 0x51, -+0x4C, 0x90, 0xA7, 0x1F, 0xEF, 0xF0, 0x51, 0x55, 0x4E, 0x03, 0x00, 0x4E, 0x08, 0x01, 0x4E, 0x0D, -+0x08, 0x4E, 0x12, 0x09, 0x4E, 0x17, 0x0A, 0x4E, 0x1C, 0x12, 0x4E, 0x21, 0x13, 0x4E, 0x26, 0x40, -+0x4E, 0x2A, 0x42, 0x4E, 0x2F, 0x43, 0x4E, 0x34, 0x44, 0x4E, 0x39, 0x47, 0x4E, 0x3D, 0x49, 0x00, -+0x00, 0x4E, 0x42, 0xD1, 0x52, 0x02, 0x78, 0x58, 0xD1, 0x52, 0x02, 0x7E, 0x0D, 0xD1, 0x52, 0x02, -+0x7E, 0x84, 0xD1, 0x52, 0x02, 0x7F, 0xBD, 0xD1, 0x52, 0x02, 0x7F, 0xD5, 0xD1, 0x52, 0x02, 0x7F, -+0xE1, 0xD1, 0x52, 0x02, 0x76, 0xEC, 0xD1, 0x52, 0x81, 0xC7, 0xD1, 0x52, 0x02, 0x66, 0xE5, 0xD1, -+0x52, 0x02, 0x65, 0x25, 0xD1, 0x52, 0x02, 0x56, 0x5D, 0xD1, 0x52, 0xE1, 0xBE, 0xD1, 0x52, 0x02, -+0x77, 0xA9, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0xA7, 0x1F, 0xE0, 0x90, 0x01, 0xC2, -+0xF0, 0x22, 0x90, 0xA7, 0x20, 0x41, 0x43, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x90, 0x96, 0x18, -+0x51, 0x37, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x00, 0x8F, 0xE0, 0x20, -+0xE6, 0x02, 0xE1, 0x5D, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0xA8, 0xA7, 0xF0, 0x90, 0x00, 0x8D, 0xE0, -+0x90, 0xA8, 0xA8, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0xA8, 0xA9, 0xF0, 0x90, 0xA8, 0xA8, 0xE0, -+0x24, 0xFC, 0x60, 0x10, 0x24, 0x03, 0x60, 0x02, 0xE1, 0x53, 0x90, 0xA8, 0xA7, 0xE0, 0xFF, 0x12, -+0x84, 0x1A, 0xE1, 0x53, 0x90, 0xA8, 0xA7, 0xE0, 0x24, 0x15, 0x12, 0x5F, 0xBA, 0xE0, 0xFB, 0xE4, -+0xFD, 0xFF, 0xF1, 0x8F, 0x75, 0xF0, 0x04, 0xD1, 0x5D, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, -+0xFF, 0xF1, 0x8F, 0x75, 0xF0, 0x04, 0xD1, 0x5D, 0xF1, 0xAD, 0xFB, 0x0D, 0xE4, 0xFF, 0xF1, 0x8F, -+0x75, 0xF0, 0x04, 0xD1, 0x5D, 0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0xF1, 0x8F, 0x75, 0xF0, -+0x04, 0x12, 0x5F, 0xF8, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xF1, 0x8F, 0x75, 0xF0, 0x04, 0x90, 0x96, -+0x16, 0xF1, 0x8A, 0x75, 0xF0, 0x04, 0xF1, 0x9C, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, -+0xF1, 0x8F, 0x75, 0xF0, 0x04, 0xF1, 0x9C, 0x54, 0x1F, 0xF1, 0x8D, 0x12, 0x66, 0xCF, 0xE0, 0xFB, -+0xE4, 0xFD, 0x0F, 0xF1, 0x8F, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x01, 0xF1, 0x8A, 0x75, 0xF0, 0x08, -+0x90, 0x89, 0x02, 0xF1, 0x8A, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0xF1, 0x8A, 0x75, 0xF0, 0x08, -+0x12, 0x85, 0xEA, 0xFB, 0xE4, 0xFD, 0x0F, 0xF1, 0x8F, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x05, 0xF1, -+0x8A, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x06, 0xF1, 0x8A, 0x75, 0xF0, 0x08, 0x12, 0x85, 0xE2, 0xFB, -+0x0D, 0xF1, 0x62, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x03, 0x12, 0x84, 0x6F, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, -+0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0x51, 0x37, 0xE0, 0xFB, 0x0D, 0xF1, -+0x62, 0x90, 0xA8, 0xA7, 0xE0, 0x22, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x90, 0x96, 0x17, 0x51, -+0x37, 0xE0, 0x22, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x26, 0x37, 0xEF, 0x54, 0x80, 0xC4, 0x13, 0x13, -+0x13, 0x54, 0x01, 0x22, 0x90, 0xA7, 0x23, 0x51, 0x4C, 0x90, 0xA7, 0x23, 0x41, 0x43, 0xF1, 0xFC, -+0x12, 0x78, 0x9C, 0x30, 0xE1, 0x03, 0x02, 0x83, 0x1B, 0xF1, 0xB9, 0x12, 0x26, 0x1E, 0x90, 0xA7, -+0x26, 0x12, 0x77, 0xA2, 0x90, 0xA7, 0x27, 0xF1, 0xA3, 0x90, 0xA7, 0x28, 0x12, 0x7D, 0x08, 0x75, -+0xF0, 0x10, 0xA4, 0xFF, 0x12, 0x67, 0x86, 0xFD, 0xEF, 0x4D, 0xFF, 0x90, 0xA7, 0x27, 0xE0, 0xB4, -+0x01, 0x07, 0xA3, 0xE0, 0x12, 0x83, 0x99, 0xEF, 0xF0, 0x22, 0xC1, 0x64, 0x90, 0xA7, 0x23, 0x02, -+0x4A, 0x4C, 0x90, 0x00, 0xF0, 0xE0, 0x7F, 0x01, 0x20, 0xE2, 0x02, 0x7F, 0x03, 0x22, 0x11, 0x02, -+0x90, 0xA5, 0x2D, 0xEF, 0xF0, 0x11, 0x20, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x02, 0x35, 0x95, -+0x11, 0x45, 0xB1, 0xFB, 0x12, 0x80, 0x8B, 0x12, 0x80, 0xAA, 0x12, 0x80, 0x65, 0xE4, 0xF5, 0x51, -+0x75, 0x52, 0x58, 0xAB, 0x51, 0x7D, 0x02, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x52, 0x7D, 0x03, -+0x7F, 0x01, 0x02, 0x39, 0x04, 0x90, 0x01, 0x30, 0xE4, 0x11, 0x75, 0x90, 0x01, 0x38, 0x11, 0x75, -+0xFD, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, -+0x52, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x53, 0x02, 0x3A, 0x96, 0xE4, 0x90, 0xA7, 0x2B, 0xF0, -+0x90, 0xA7, 0x96, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0xA6, 0xF4, -+0xE0, 0x90, 0xA7, 0x82, 0xF0, 0x90, 0xA6, 0xF5, 0xE0, 0x90, 0xA7, 0x83, 0xF0, 0x90, 0xA6, 0xF6, -+0xE0, 0x90, 0xA7, 0x84, 0xF0, 0x90, 0xA6, 0xF7, 0xE0, 0x90, 0xA7, 0x85, 0xF0, 0x90, 0xA6, 0xF8, -+0xE0, 0x90, 0xA7, 0x86, 0xF0, 0x90, 0xA6, 0xE5, 0xE0, 0x90, 0xA7, 0x87, 0xF0, 0x90, 0xA6, 0xE6, -+0xE0, 0x90, 0xA7, 0x88, 0xF0, 0x90, 0xA6, 0xE7, 0xE0, 0x90, 0xA7, 0x89, 0xF0, 0x90, 0xA6, 0xE8, -+0xE0, 0x90, 0xA7, 0x8A, 0xF0, 0x90, 0xA6, 0xE9, 0xE0, 0x90, 0xA7, 0x8B, 0xF0, 0x90, 0xA6, 0xEA, -+0xE0, 0x90, 0xA7, 0x8C, 0xF0, 0x90, 0xA6, 0xEB, 0xE0, 0x90, 0xA7, 0x8D, 0xF0, 0x90, 0xA6, 0xEC, -+0xE0, 0x90, 0xA7, 0x8E, 0xF0, 0x90, 0xA6, 0xED, 0xE0, 0x90, 0xA7, 0x8F, 0xF0, 0x90, 0xA6, 0xEE, -+0xE0, 0x90, 0xA7, 0x90, 0xF0, 0x11, 0x6B, 0x90, 0xA7, 0x2A, 0xF0, 0xB1, 0x1D, 0x50, 0x04, 0xB1, -+0x2A, 0x80, 0xF8, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x12, 0x7F, 0xB4, 0x90, 0xA7, -+0x1F, 0xF0, 0xA3, 0xB1, 0x95, 0xB1, 0x1D, 0x50, 0x4A, 0xB1, 0x4C, 0x90, 0xA7, 0x2A, 0xE0, 0xFE, -+0x24, 0x91, 0xF5, 0x82, 0xE4, 0x34, 0xA7, 0xB1, 0xDC, 0xE0, 0x24, 0x4D, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x2C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xA7, 0xB1, 0xDC, 0xE0, -+0x24, 0x4E, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xEE, 0xF1, 0x17, 0x12, 0x4A, 0x4C, 0xB1, -+0xE0, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0xEE, 0xB1, 0x87, 0x12, 0x4A, 0x4C, 0xB1, -+0x37, 0x80, 0xB2, 0x90, 0x02, 0x87, 0xE0, 0x70, 0x02, 0x81, 0xD7, 0x90, 0xA6, 0xD7, 0xE0, 0x20, -+0xE0, 0x02, 0x81, 0xD7, 0xE4, 0x90, 0xA7, 0x9B, 0x11, 0x73, 0x90, 0xA7, 0x1F, 0xE0, 0xFF, 0xA3, -+0xE0, 0xA3, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA7, 0x21, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, -+0x90, 0xFD, 0x11, 0xF0, 0xD1, 0xFF, 0xE0, 0xFE, 0xB1, 0xD1, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, -+0xEA, 0x3E, 0x54, 0x3F, 0x90, 0xA7, 0x23, 0xF0, 0xA3, 0xF1, 0x25, 0x54, 0x0F, 0x33, 0x33, 0x33, -+0x54, 0xF8, 0x90, 0xA7, 0x26, 0xF0, 0xFC, 0x74, 0x07, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, -+0x83, 0xE0, 0x54, 0xC0, 0x90, 0xA7, 0x28, 0xF0, 0xEC, 0x24, 0x18, 0x90, 0xA7, 0x25, 0xF0, 0xFD, -+0x90, 0xA7, 0x21, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x91, 0xEE, 0xEF, 0x54, 0xFC, 0x90, 0xA7, 0x27, -+0xF0, 0x90, 0xA7, 0x26, 0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0x90, 0xA7, 0x23, 0x8F, 0xF0, 0x12, -+0x49, 0x7F, 0x90, 0xA7, 0x23, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x84, 0xEA, 0x90, 0xA7, 0x1F, -+0xF1, 0xD6, 0x90, 0xA6, 0xD5, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0xA7, 0x1F, 0xE0, 0xFC, 0xA3, -+0xE0, 0xFD, 0xD3, 0x9F, 0xEC, 0x9E, 0x40, 0x11, 0x90, 0xA6, 0xD6, 0xF1, 0x0A, 0xED, 0x9F, 0xFF, -+0xEC, 0x9E, 0x90, 0xA7, 0x1F, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA7, 0x27, 0xE0, 0x24, 0xC0, 0x60, -+0x02, 0x61, 0xFE, 0x91, 0xD8, 0x24, 0x18, 0xFD, 0x91, 0xEE, 0xEF, 0x60, 0x02, 0x61, 0xF4, 0x91, -+0xD8, 0x24, 0x19, 0xFD, 0x91, 0xEE, 0x90, 0xA7, 0x40, 0xD1, 0xD9, 0x90, 0xA7, 0x40, 0xE0, 0xFF, -+0x90, 0xA7, 0x29, 0xE0, 0xFD, 0xC3, 0x9F, 0x50, 0x15, 0x91, 0xD8, 0x24, 0x1A, 0xB1, 0x76, 0x90, -+0xA7, 0x29, 0xE0, 0x24, 0x41, 0xF5, 0x82, 0xE4, 0x34, 0xA7, 0xB1, 0x7C, 0x80, 0xDD, 0x90, 0xA7, -+0x40, 0xE0, 0x70, 0x02, 0x61, 0x35, 0xE4, 0x90, 0xA7, 0x2A, 0xF0, 0xB1, 0x1D, 0x40, 0x02, 0x61, -+0x1D, 0xB1, 0x4C, 0x90, 0xA7, 0x2A, 0xE0, 0xFF, 0x24, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xA7, 0xF5, -+0x83, 0xE0, 0xFE, 0x90, 0xA7, 0x40, 0xE0, 0xFD, 0xEE, 0x6D, 0x70, 0x1D, 0xEF, 0xF1, 0x17, 0x12, -+0x4A, 0x43, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xB1, 0xEB, 0xED, 0xF0, 0xD0, 0x01, 0xD0, 0x02, -+0xD0, 0x03, 0xB1, 0xA8, 0xEF, 0x60, 0x02, 0x80, 0x47, 0x90, 0xA7, 0x40, 0xE0, 0x64, 0x03, 0x70, -+0x4E, 0xB1, 0xEB, 0x74, 0x03, 0xF0, 0x7A, 0xA8, 0x79, 0x7A, 0xB1, 0xA8, 0xEF, 0x70, 0x0E, 0xB1, -+0xEB, 0x74, 0x03, 0xF0, 0x7A, 0xA8, 0x79, 0x76, 0xB1, 0xA8, 0xEF, 0x60, 0x2A, 0x90, 0xA7, 0x2A, -+0xE0, 0xFF, 0x24, 0x8C, 0xF5, 0x82, 0xE4, 0x34, 0xA7, 0xF5, 0x83, 0xE0, 0x60, 0x02, 0x80, 0x0B, -+0x90, 0xA7, 0x2A, 0xE0, 0xFF, 0x24, 0x87, 0xD1, 0xE1, 0x60, 0x05, 0x74, 0x9B, 0x2F, 0x80, 0x15, -+0xB1, 0x3E, 0x74, 0x01, 0xF0, 0x80, 0x12, 0x90, 0xA7, 0x2A, 0xE0, 0x24, 0x9B, 0x80, 0x06, 0x90, -+0xA7, 0x2A, 0xE0, 0x24, 0x9B, 0xB1, 0x44, 0xE4, 0xF0, 0xB1, 0x37, 0x41, 0x7B, 0x90, 0xA7, 0x9B, -+0xE0, 0x70, 0x4F, 0xA3, 0xE0, 0x70, 0x4B, 0xA3, 0xE0, 0x70, 0x47, 0xA3, 0xE0, 0x70, 0x43, 0xA3, -+0xE0, 0x70, 0x3F, 0x61, 0xF4, 0xE4, 0x90, 0xA7, 0x2A, 0xF0, 0xB1, 0x1D, 0x50, 0x1C, 0x74, 0x87, -+0x2E, 0xD1, 0xE1, 0x60, 0x09, 0x74, 0x9B, 0x2E, 0xB1, 0x44, 0xE4, 0xF0, 0x80, 0x08, 0x74, 0x9B, -+0x2E, 0xB1, 0x44, 0x74, 0x01, 0xF0, 0xB1, 0x37, 0x80, 0xE0, 0x90, 0xA7, 0x9B, 0xE0, 0x70, 0x12, -+0xA3, 0xE0, 0x70, 0x0E, 0xA3, 0xE0, 0x70, 0x0A, 0xA3, 0xE0, 0x70, 0x06, 0xA3, 0xE0, 0x70, 0x02, -+0x61, 0xF4, 0xE4, 0x90, 0xA7, 0x2A, 0xF0, 0xB1, 0x1D, 0x50, 0x79, 0xB1, 0x4C, 0xB1, 0x3E, 0xE0, -+0x60, 0x6E, 0xE4, 0xFF, 0xFE, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0B, 0xF1, 0xDC, 0x50, 0x07, 0x0F, -+0xBF, 0x00, 0x01, 0x0E, 0x80, 0xEF, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x54, 0x90, 0xA7, 0x2A, 0xE0, -+0x24, 0x82, 0xF5, 0x82, 0xE4, 0x34, 0xA7, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA8, 0xA6, 0x74, 0x06, -+0xF0, 0x7B, 0x08, 0x7D, 0x01, 0x12, 0x81, 0xA9, 0x90, 0xA7, 0x23, 0xEE, 0xF0, 0xA3, 0xD1, 0xD9, -+0x90, 0xA7, 0x29, 0xE0, 0xFD, 0xC3, 0x94, 0x06, 0x50, 0x1C, 0x91, 0xD8, 0x24, 0x0A, 0xB1, 0x76, -+0x90, 0xA7, 0x23, 0xA3, 0xE0, 0xFE, 0x90, 0xA7, 0x29, 0xE0, 0x2E, 0x24, 0x2C, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xB1, 0x7C, 0x80, 0xDA, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x90, 0x06, 0x35, 0xF0, -+0xB1, 0x37, 0x80, 0x83, 0xF1, 0xB1, 0x90, 0x06, 0x36, 0x74, 0xDD, 0xF0, 0x21, 0x63, 0x90, 0xA7, -+0x28, 0xE0, 0x60, 0x02, 0x81, 0xD3, 0x91, 0xD8, 0x24, 0x16, 0xFD, 0x91, 0xEE, 0x90, 0x06, 0x34, -+0xEF, 0xF0, 0x91, 0xD8, 0x24, 0x17, 0xFD, 0x91, 0xEE, 0x90, 0x06, 0x37, 0xB1, 0x95, 0xB1, 0x1D, -+0x50, 0x67, 0xB1, 0x4C, 0xE4, 0x90, 0xA7, 0x29, 0xF0, 0x90, 0xA7, 0x29, 0xE0, 0xFF, 0xC3, 0x94, -+0x06, 0x50, 0x52, 0xEF, 0x60, 0x04, 0x64, 0x01, 0x70, 0x20, 0x91, 0xD8, 0x91, 0xE5, 0x90, 0xA7, -+0x29, 0xE0, 0xFE, 0x24, 0xA0, 0xD1, 0xEA, 0x90, 0xA7, 0x2A, 0xE0, 0xB1, 0x87, 0x12, 0x4A, 0x43, -+0x8E, 0x82, 0xB1, 0xA2, 0xFF, 0x74, 0xA2, 0x2E, 0xD1, 0xEA, 0x91, 0xD8, 0x91, 0xE5, 0x90, 0xA7, -+0x2A, 0xE0, 0xFE, 0xB1, 0x87, 0x12, 0x4A, 0x43, 0x90, 0xA7, 0x29, 0xE0, 0xF5, 0x82, 0xB1, 0xA2, -+0x6F, 0x60, 0x0E, 0x74, 0x96, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xA7, 0xF5, 0x83, 0xE4, 0xF0, 0x80, -+0x04, 0xB1, 0x80, 0x80, 0xA4, 0xB1, 0x37, 0x80, 0x95, 0x90, 0xA7, 0x96, 0xE0, 0x64, 0x01, 0x60, -+0x17, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x11, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x0B, 0xA3, 0xE0, 0x64, -+0x01, 0x60, 0x05, 0xA3, 0xE0, 0xB4, 0x01, 0x06, 0x90, 0xA7, 0x2B, 0x74, 0x01, 0xF0, 0x90, 0xA7, -+0x2B, 0xE0, 0xB4, 0x01, 0x10, 0x12, 0x7F, 0x16, 0x90, 0x01, 0xC7, 0x74, 0x66, 0xF0, 0xE4, 0xFF, -+0x12, 0x84, 0x76, 0x21, 0x63, 0x11, 0x6B, 0x90, 0xA7, 0x2A, 0xF0, 0xB1, 0x1D, 0x50, 0x04, 0xB1, -+0x2A, 0x80, 0xF8, 0xF1, 0xB1, 0x21, 0x63, 0x22, 0x90, 0xA7, 0x21, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x90, 0xA7, 0x25, 0xE0, 0x22, 0x24, 0x04, 0xFD, 0x90, 0xA7, 0x29, 0xE0, 0x2D, 0xFD, 0xAB, 0x07, -+0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0xA6, 0xD6, 0xE0, 0x9B, 0x90, 0xA6, -+0xD5, 0xE0, 0x9A, 0x50, 0x09, 0xA3, 0xF1, 0x0A, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, -+0xFD, 0x11, 0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0xB1, 0xD4, 0xE0, 0xFF, 0x22, 0x90, 0xA6, 0xE2, -+0xE0, 0xFF, 0x90, 0xA7, 0x2A, 0xE0, 0xFE, 0xC3, 0x9F, 0x22, 0x74, 0x96, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0xA7, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x90, 0xA7, 0x2A, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA7, -+0x2A, 0xE0, 0x24, 0x9B, 0xF5, 0x82, 0xE4, 0x34, 0xA7, 0xF5, 0x83, 0x22, 0x74, 0x82, 0x2E, 0xF5, -+0x82, 0xE4, 0x34, 0xA7, 0xF5, 0x83, 0xE0, 0xFF, 0xE4, 0xFE, 0xEF, 0x25, 0xE0, 0xFD, 0xEF, 0xC3, -+0x94, 0x80, 0x90, 0xFD, 0x12, 0x50, 0x04, 0xE4, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x90, 0xFD, -+0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0xFC, 0xED, 0x2C, 0xFD, 0x81, 0xEE, 0xF5, 0x83, 0xEF, 0xF0, -+0x90, 0xA7, 0x29, 0xE0, 0x04, 0xF0, 0x22, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x73, 0xF5, 0x82, 0xE4, -+0x34, 0xA7, 0xF5, 0x83, 0x22, 0xEF, 0xF0, 0xE4, 0x90, 0xA7, 0x2A, 0xF0, 0x22, 0x12, 0x4A, 0x43, -+0x8F, 0x82, 0x75, 0x83, 0x00, 0x02, 0x26, 0x37, 0x90, 0xA7, 0xA0, 0x12, 0x4A, 0x4C, 0xE4, 0xFF, -+0x90, 0xA7, 0xA6, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x14, 0x90, 0xA7, 0xA3, 0xB1, 0x9D, 0xFE, -+0x90, 0xA7, 0xA0, 0xB1, 0x9D, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xE2, 0x7F, 0x01, -+0x22, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0x22, 0xF5, 0x83, 0xEF, 0xF0, -+0x74, 0x91, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xA7, 0xF5, 0x83, 0x22, 0x7B, 0x01, 0x7A, 0xA7, 0x79, -+0x41, 0x90, 0xA7, 0xA3, 0x12, 0x4A, 0x4C, 0x90, 0xA7, 0xA6, 0x22, 0x90, 0x01, 0x34, 0x74, 0xFF, -+0x11, 0x75, 0x90, 0x01, 0x3C, 0x11, 0x75, 0xFD, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, -+0x55, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x57, 0x02, -+0x3A, 0x96, 0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, 0xB1, 0xD4, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, -+0xF3, 0xB1, 0xD1, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0xD1, 0xFF, 0xF1, 0x25, 0x54, 0xF0, 0xF0, -+0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x12, 0x4F, 0xFC, -+0xE4, 0x90, 0xA7, 0x28, 0xF0, 0xFD, 0x12, 0x4F, 0xB9, 0x8D, 0x82, 0xB1, 0xA2, 0xF4, 0x60, 0x32, -+0x90, 0xA7, 0x28, 0xE0, 0xFF, 0x12, 0x4F, 0xB9, 0x8D, 0x82, 0xB1, 0xA2, 0xFE, 0x75, 0xF0, 0x10, -+0xD1, 0xD1, 0x12, 0x4F, 0xAD, 0xFC, 0xA8, 0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, -+0x90, 0xA7, 0x28, 0xF0, 0x75, 0xF0, 0x10, 0xEE, 0xD1, 0xF9, 0xE0, 0xFF, 0xD1, 0xC6, 0xEF, 0xF0, -+0x80, 0x05, 0xD1, 0xC6, 0x74, 0xFF, 0xF0, 0x0D, 0xED, 0xB4, 0x07, 0xBA, 0x90, 0xA7, 0x26, 0x74, -+0x05, 0xF0, 0x90, 0xA7, 0x34, 0x74, 0x08, 0xF0, 0x7B, 0x01, 0x7A, 0xA7, 0x79, 0x26, 0x12, 0x69, -+0xCB, 0x7F, 0x04, 0x02, 0x6B, 0xB5, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA7, 0xF5, 0x83, -+0x22, 0x90, 0x81, 0x01, 0x12, 0x4A, 0x37, 0xE0, 0x22, 0xEF, 0xF0, 0xE4, 0x90, 0xA7, 0x29, 0xF0, -+0x22, 0xF5, 0x82, 0xE4, 0x34, 0xA7, 0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x04, 0xF5, -+0x83, 0xEF, 0xF0, 0x22, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x00, 0x02, 0x4A, 0x37, 0x74, -+0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0x22, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0xA6, -+0xD5, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0x22, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x31, 0xF5, 0x82, 0xE4, -+0x34, 0xA7, 0xF5, 0x83, 0x22, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, -+0x83, 0xE0, 0x22, 0x90, 0xA6, 0xD7, 0xE0, 0x54, 0xFE, 0xF1, 0xCD, 0x90, 0xA6, 0xDE, 0x01, 0x75, -+0xF1, 0x67, 0x12, 0x80, 0x57, 0x12, 0x63, 0x88, 0xF1, 0x33, 0x90, 0xA7, 0x0E, 0xE0, 0x54, 0x7F, -+0xF0, 0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, 0xE4, 0x90, 0xA7, 0x10, 0xF0, 0x90, -+0xA7, 0x0E, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE4, 0xFD, 0xFF, 0xF1, 0xE4, 0xED, 0x70, 0x12, 0xF1, -+0xA6, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x9E, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0x80, -+0x0F, 0xF1, 0xA6, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x9E, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, -+0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x12, 0x7D, 0xB9, 0x90, 0xA7, 0x0A, 0xEF, 0xF0, 0x22, 0xE0, 0xFE, -+0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, 0x74, 0xFA, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xA6, 0xF5, 0x83, -+0x22, 0x90, 0xA7, 0x1F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, -+0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xE4, 0x90, 0xA5, 0x27, 0x01, 0x73, 0xF0, 0xE4, 0xA3, -+0xF0, 0xA3, 0xF0, 0x22, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x02, 0x49, 0x7F, 0xD3, 0xEF, 0x94, 0xE8, -+0xEE, 0x94, 0x03, 0x22, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFE, 0xEF, 0x54, 0x07, 0xFF, 0x22, -+0x75, 0xE8, 0x03, 0x75, 0xA8, 0x85, 0x22, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, -+0x12, 0x3A, 0x96, 0x12, 0x80, 0xC9, 0x12, 0x3A, 0xB8, 0x12, 0x80, 0xD6, 0x12, 0x57, 0xC7, 0x7F, -+0x01, 0x12, 0x46, 0xF5, 0x7F, 0x02, 0x12, 0x46, 0xF5, 0x12, 0x50, 0x0E, 0x12, 0x57, 0x40, 0x90, -+0x01, 0xCC, 0x74, 0x0F, 0xF0, 0x12, 0x4B, 0x1F, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, -+0x80, 0x12, 0x3A, 0x96, 0x75, 0x28, 0xFF, 0x12, 0x57, 0xF0, 0x11, 0x44, 0x12, 0x81, 0x06, 0xE4, -+0xFF, 0x02, 0x47, 0x7E, 0xE4, 0x90, 0xA7, 0x14, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x98, 0xE0, 0x7F, -+0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x3C, 0xC3, 0x90, 0xA7, 0x15, 0xE0, -+0x94, 0x88, 0x90, 0xA7, 0x14, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, -+0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1E, 0x90, 0xA7, 0x14, 0x11, 0x9E, 0x12, 0x70, -+0x66, 0xD3, 0x90, 0xA7, 0x15, 0xE0, 0x94, 0x32, 0x90, 0xA7, 0x14, 0xE0, 0x94, 0x00, 0x40, 0xBB, -+0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB4, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0xE4, 0x75, -+0xF0, 0x01, 0x02, 0x49, 0x7F, 0xE4, 0x90, 0xA8, 0xAA, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, -+0x90, 0xA8, 0xAC, 0xF0, 0x7D, 0x47, 0x7F, 0xFF, 0x31, 0x01, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x11, -+0xA3, 0xE0, 0x70, 0x0D, 0xA3, 0xE0, 0x70, 0x09, 0xA3, 0xE0, 0x70, 0x05, 0x11, 0xFA, 0x7F, 0x01, -+0x22, 0xD3, 0x90, 0xA8, 0xAB, 0xE0, 0x94, 0xE8, 0x90, 0xA8, 0xAA, 0xE0, 0x94, 0x03, 0x40, 0x0C, -+0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x11, 0xFA, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, -+0x12, 0x3A, 0xF7, 0x90, 0xA8, 0xAA, 0x11, 0x9E, 0x80, 0xC0, 0x90, 0xA8, 0xAC, 0xE0, 0xFF, 0x7D, -+0x48, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0xA5, 0x2B, 0xED, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA8, 0xB2, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x7D, 0x44, 0x7F, 0x6F, 0x31, -+0x01, 0x11, 0xA5, 0x90, 0xA8, 0xB3, 0xE0, 0x90, 0xA8, 0xB2, 0xB4, 0x01, 0x0C, 0xE0, 0x75, 0xF0, -+0x10, 0x31, 0x52, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x0A, 0xE0, 0x75, 0xF0, 0x10, 0x31, 0x52, 0xE0, -+0x54, 0xFB, 0xF0, 0xE4, 0xFD, 0xFF, 0x31, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x10, -+0xE5, 0x0E, 0x90, 0x81, 0x05, 0x02, 0x4A, 0x37, 0xE4, 0xF5, 0x0E, 0x90, 0xA7, 0x0A, 0xE0, 0xFF, -+0xE5, 0x0E, 0xC3, 0x9F, 0x40, 0x02, 0xA1, 0x62, 0xE5, 0x0E, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, -+0xA7, 0x2F, 0xF0, 0xE5, 0x0E, 0x54, 0x07, 0xA3, 0xF0, 0x90, 0x04, 0xA0, 0xE0, 0xFF, 0xA3, 0xE0, -+0xFE, 0xEF, 0x64, 0x01, 0x70, 0x28, 0xE5, 0x0E, 0x6E, 0x70, 0x23, 0xA3, 0xE0, 0xF5, 0x0F, 0xA3, -+0xE0, 0x12, 0x85, 0xA0, 0x12, 0x56, 0xF9, 0xE5, 0x0F, 0xF0, 0x31, 0x4D, 0xE0, 0x54, 0xFC, 0xFF, -+0x90, 0xA7, 0x2E, 0xE0, 0x54, 0x03, 0x4F, 0xFF, 0x31, 0x4D, 0xEF, 0xF0, 0xA1, 0x5E, 0xAF, 0x0E, -+0x12, 0x7E, 0x64, 0xEF, 0x70, 0x02, 0xA1, 0x5E, 0x12, 0x4E, 0x58, 0x12, 0x4F, 0xAD, 0x30, 0xE0, -+0x02, 0xA1, 0x5E, 0x90, 0xA7, 0x2F, 0x12, 0x6E, 0xC4, 0xE0, 0xF1, 0xDA, 0xF1, 0xC9, 0x80, 0x05, -+0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xF1, 0xD2, 0x60, 0x02, 0xA1, 0x5E, 0xE5, 0x0E, 0x12, -+0x84, 0x04, 0x12, 0x66, 0xA5, 0x4E, 0x70, 0x08, 0x12, 0x84, 0x0E, 0xE0, 0x70, 0x02, 0xA1, 0x5E, -+0xE5, 0x0E, 0x12, 0x7D, 0x30, 0x7B, 0x01, 0x90, 0xA7, 0x22, 0x12, 0x4A, 0x4C, 0xE5, 0x0E, 0x12, -+0x84, 0x04, 0xF5, 0x83, 0xE0, 0xF5, 0x13, 0xA3, 0xE0, 0xF5, 0x14, 0x12, 0x84, 0x0E, 0xE0, 0xFF, -+0x90, 0xA7, 0x25, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0xF1, 0xF8, 0xE0, -+0x90, 0xA7, 0x2D, 0xF0, 0x12, 0x4E, 0x58, 0x13, 0x13, 0x54, 0x03, 0x12, 0x85, 0xA0, 0x12, 0x56, -+0xF9, 0xE0, 0xF5, 0x0F, 0x54, 0x7F, 0xF5, 0x10, 0x90, 0xA7, 0x22, 0x12, 0x4A, 0x43, 0x90, 0x00, -+0x02, 0x12, 0x49, 0xC0, 0xFF, 0xAE, 0xF0, 0x12, 0x49, 0x95, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xFE, -+0xF1, 0xA4, 0x2F, 0xFF, 0xEE, 0x12, 0x85, 0x60, 0xB1, 0x69, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0x90, -+0xA7, 0x27, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x49, 0xC0, 0xFD, 0xAC, 0xF0, 0x25, -+0xE0, 0xFF, 0xEC, 0x33, 0xFE, 0xEF, 0x2D, 0xFD, 0xEE, 0x3C, 0xFC, 0xF1, 0xA4, 0x25, 0xE0, 0xFF, -+0xE5, 0xF0, 0x33, 0xFE, 0x90, 0x00, 0x02, 0x12, 0x49, 0xC0, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xCF, -+0x2D, 0xFD, 0xEF, 0x3C, 0xFC, 0xB1, 0x63, 0xAE, 0xF0, 0x78, 0x02, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -+0xD8, 0xF9, 0x2D, 0xFF, 0xEC, 0x3E, 0x90, 0xA7, 0x2B, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x49, 0x95, -+0xFF, 0x90, 0xA7, 0x27, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xC3, 0x9F, 0xFE, 0xEC, 0x95, 0xF0, 0xA3, -+0xF0, 0xA3, 0xCE, 0xF0, 0xE5, 0x0E, 0x12, 0x67, 0xB5, 0xF5, 0x83, 0xEC, 0x8D, 0xF0, 0x12, 0x49, -+0x7F, 0x90, 0xA7, 0x2B, 0xF1, 0xE2, 0x12, 0x66, 0xAD, 0x12, 0x57, 0xD4, 0x90, 0xA7, 0x25, 0xF1, -+0xE2, 0x25, 0xE0, 0x24, 0xA5, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0x12, 0x57, 0xD4, 0xE5, 0x0E, 0x12, -+0x66, 0xB9, 0xF5, 0x83, 0xE5, 0x13, 0x85, 0x14, 0xF0, 0x12, 0x49, 0x7F, 0x90, 0x94, 0x91, 0x12, -+0x4A, 0x2B, 0x90, 0xA7, 0x29, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0x12, 0x49, 0xF8, -+0x90, 0x94, 0x91, 0x12, 0x27, 0x48, 0x90, 0xA7, 0x2D, 0xE0, 0xFF, 0xE5, 0x10, 0xD3, 0x9F, 0x40, -+0x12, 0x8F, 0x10, 0xE5, 0x0F, 0x30, 0xE7, 0x07, 0xE5, 0x10, 0x44, 0x80, 0xFF, 0x80, 0x02, 0xAF, -+0x10, 0x8F, 0x0F, 0xE5, 0x10, 0x90, 0x41, 0xED, 0x93, 0xF1, 0xB5, 0xE0, 0xC3, 0x9F, 0x40, 0x0B, -+0x74, 0x3C, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0x80, 0x09, 0x74, 0x90, 0x25, 0x10, 0xF5, -+0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xE0, 0xFF, 0x12, 0x7C, 0xAE, 0x90, 0xA7, 0x1F, 0x12, 0x4A, -+0x4C, 0x74, 0xA6, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0xC3, 0x94, 0x05, -+0x40, 0x02, 0xA1, 0x54, 0xE5, 0x0F, 0x30, 0xE7, 0x04, 0x05, 0x15, 0x05, 0x15, 0xE5, 0x15, 0xD3, -+0x94, 0x1A, 0xAF, 0x15, 0x40, 0x02, 0x7F, 0x1A, 0x12, 0x7C, 0xAE, 0x90, 0xA7, 0x1F, 0x12, 0x4A, -+0x4C, 0xC3, 0xE5, 0x14, 0x94, 0x0F, 0xE5, 0x13, 0x94, 0x00, 0x50, 0x6B, 0xB1, 0x63, 0xFF, 0x90, -+0xA7, 0x26, 0xE0, 0x2F, 0xFF, 0x90, 0xA7, 0x25, 0xE0, 0x12, 0x85, 0x60, 0xF1, 0xA4, 0x2F, 0xFD, -+0xEE, 0x35, 0xF0, 0x12, 0x85, 0x95, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x06, 0xE4, 0xFB, 0xB1, -+0x7D, 0xA1, 0x4F, 0x90, 0xA7, 0x22, 0x12, 0x4A, 0x43, 0x12, 0x49, 0x95, 0x65, 0x14, 0x70, 0x04, -+0xE5, 0xF0, 0x65, 0x13, 0x75, 0xF0, 0x04, 0x70, 0x26, 0x12, 0x4F, 0x9A, 0xFF, 0xC4, 0x13, 0x13, -+0x54, 0x03, 0xFE, 0xEF, 0x54, 0x3F, 0xFF, 0xEE, 0x04, 0x54, 0x03, 0xFE, 0xC4, 0x33, 0x33, 0x54, -+0xC0, 0x4F, 0xF0, 0xE4, 0xFD, 0xAF, 0x0E, 0x12, 0x79, 0x7E, 0x75, 0xF0, 0x04, 0x80, 0x00, 0x12, -+0x4F, 0x9A, 0x54, 0x3F, 0xF0, 0xA1, 0x4F, 0xE5, 0x0E, 0x64, 0x01, 0x70, 0x48, 0xB1, 0x63, 0xFF, -+0xAE, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x49, 0xC0, 0x2F, 0xFD, 0xE5, 0xF0, 0x3E, 0x12, 0x85, 0x95, -+0xC3, 0xED, 0x9F, 0xEC, 0x9E, 0x50, 0x08, 0x90, 0xA5, 0x26, 0x74, 0x01, 0xF0, 0x80, 0x26, 0xB1, -+0x63, 0xFB, 0xAA, 0xF0, 0xE5, 0x14, 0xAE, 0x13, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, -+0xF9, 0xFF, 0x7C, 0x00, 0x7D, 0x05, 0x12, 0x26, 0x98, 0xD3, 0xEB, 0x9F, 0xEA, 0x9E, 0x40, 0x05, -+0xE4, 0x90, 0xA5, 0x26, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x12, 0x6E, 0xFC, 0xFF, 0x13, 0x13, -+0x13, 0x54, 0x1F, 0xFE, 0x60, 0x17, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x12, 0x85, 0xFA, 0x54, 0x07, -+0xFF, 0xC3, 0xEE, 0x94, 0x01, 0x54, 0x1F, 0x12, 0x85, 0xF2, 0xF0, 0xA1, 0x4F, 0x90, 0xA7, 0x2F, -+0xE0, 0x24, 0x15, 0x12, 0x6E, 0xB8, 0xF1, 0xDA, 0xF1, 0xC9, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0xF1, 0xD2, 0x60, 0x27, 0x74, 0xA6, 0x25, 0x0E, 0xB1, 0x75, 0xE0, 0xFF, 0xF4, -+0x60, 0x1C, 0x8F, 0x0F, 0x90, 0xA7, 0x2E, 0xE0, 0xF5, 0x77, 0x7B, 0x01, 0xAD, 0x0F, 0xAF, 0x0E, -+0x12, 0x6C, 0x07, 0x74, 0xA6, 0x25, 0x0E, 0xB1, 0x75, 0x74, 0xFF, 0xF0, 0xA1, 0x4F, 0xAB, 0x15, -+0xAD, 0x0E, 0xAF, 0x14, 0xAE, 0x13, 0x12, 0x78, 0xA2, 0x8E, 0x11, 0x8F, 0x12, 0xE5, 0x10, 0x12, -+0x7C, 0xA2, 0xC3, 0x12, 0x85, 0xB4, 0x50, 0x68, 0x12, 0x85, 0x7C, 0x54, 0x7F, 0xF1, 0xB5, 0xE0, -+0xFE, 0xC3, 0x9F, 0x40, 0x05, 0xEE, 0x9F, 0xFF, 0x80, 0x0C, 0xF1, 0xB6, 0xE0, 0xFF, 0x12, 0x85, -+0x7C, 0x54, 0x7F, 0xC3, 0x9F, 0xFF, 0xEF, 0xD3, 0x94, 0x04, 0x40, 0x0E, 0x75, 0xF0, 0x04, 0xE5, -+0x0E, 0x90, 0x9B, 0x16, 0x12, 0x67, 0x96, 0xF0, 0x80, 0x12, 0xF1, 0xAA, 0xE0, 0xFE, 0xA3, 0xE0, -+0x4E, 0x60, 0x09, 0xF1, 0xAA, 0x74, 0xFF, 0xF5, 0xF0, 0x12, 0x49, 0x7F, 0xE5, 0x10, 0x12, 0x7C, -+0xA2, 0x12, 0x7D, 0x1F, 0xE5, 0x0E, 0x12, 0x79, 0x72, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xF1, 0xAA, -+0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x70, 0x18, 0x7D, 0x01, 0xAF, 0x0E, 0x12, 0x79, 0x7E, 0x80, 0x0F, -+0xE5, 0x10, 0x12, 0x85, 0x70, 0xD3, 0x12, 0x85, 0xB4, 0x40, 0x04, 0x7B, 0x01, 0xB1, 0x7D, 0xE4, -+0xF5, 0x11, 0xF5, 0x12, 0x75, 0x17, 0x01, 0x7D, 0x01, 0xAF, 0x0E, 0x12, 0x83, 0xA3, 0x05, 0x0E, -+0x21, 0x5B, 0x22, 0x90, 0xA7, 0x22, 0x12, 0x4A, 0x43, 0x90, 0x00, 0x08, 0x02, 0x49, 0xC0, 0x90, -+0xA7, 0x31, 0xE0, 0x24, 0xA6, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0x22, 0x7D, 0x01, 0xAF, -+0x0E, 0x90, 0xA7, 0x32, 0xEB, 0xF0, 0x90, 0xA7, 0x31, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0x90, 0x9B, -+0x16, 0x12, 0x67, 0x96, 0x12, 0x56, 0xF4, 0xE0, 0xF5, 0x18, 0x54, 0x7F, 0xF5, 0x1A, 0xF1, 0xEA, -+0x12, 0x67, 0x9D, 0xE0, 0x90, 0xA7, 0x35, 0xF1, 0xF3, 0xE0, 0xFC, 0x90, 0xA7, 0x31, 0xE0, 0x75, -+0xF0, 0x04, 0x12, 0x4E, 0x5D, 0x13, 0x13, 0x54, 0x03, 0xF5, 0x19, 0xE5, 0x1A, 0x12, 0x85, 0x70, -+0xE4, 0x93, 0xFA, 0x74, 0x01, 0x93, 0xFB, 0xEF, 0x12, 0x79, 0x72, 0xEA, 0xF0, 0xA3, 0xEB, 0xF0, -+0xF1, 0xEA, 0x12, 0x4E, 0x5D, 0xFE, 0xC4, 0x54, 0x03, 0x90, 0xA7, 0x33, 0xF0, 0x74, 0x26, 0x2F, -+0xF1, 0x9C, 0xE5, 0x1A, 0xF0, 0x90, 0xA7, 0x31, 0xE0, 0xFF, 0x24, 0x26, 0x12, 0x7D, 0x17, 0xE5, -+0x19, 0xF0, 0xE5, 0x1A, 0xD3, 0x9C, 0x40, 0x0D, 0x8C, 0x1A, 0x8C, 0x18, 0xAE, 0x04, 0x74, 0xA6, -+0x2F, 0xB1, 0x75, 0xEE, 0xF0, 0xED, 0x70, 0x02, 0xE1, 0x8A, 0xAF, 0x05, 0x8F, 0x1B, 0xE5, 0x18, -+0x30, 0xE7, 0x0A, 0x85, 0x1A, 0x18, 0xB1, 0x6F, 0xE5, 0x1A, 0xF0, 0x15, 0x1B, 0xE5, 0x1B, 0x70, -+0x02, 0xE1, 0x8A, 0x90, 0xA7, 0x31, 0xE0, 0xFF, 0xAD, 0x18, 0x12, 0x82, 0x57, 0xEF, 0xF4, 0x60, -+0x17, 0x8F, 0x18, 0xD5, 0x1B, 0x12, 0x90, 0xA7, 0x31, 0xE0, 0xFF, 0xF1, 0x9A, 0xE0, 0xFE, 0x74, -+0xA6, 0x2F, 0xB1, 0x75, 0xEE, 0xF0, 0xE1, 0x8A, 0xE5, 0x18, 0x64, 0x2C, 0x70, 0x35, 0xE5, 0x19, -+0xD3, 0x94, 0x00, 0x40, 0x2E, 0xE5, 0x19, 0xD3, 0x94, 0x02, 0x50, 0x27, 0x15, 0x19, 0x75, 0x18, -+0x2D, 0xE5, 0x19, 0x12, 0x6F, 0xE5, 0xFF, 0x90, 0xA7, 0x31, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0x12, -+0x4E, 0x5D, 0x54, 0xF3, 0x4F, 0xF0, 0x74, 0xA6, 0x2E, 0xB1, 0x75, 0x74, 0xFF, 0xF0, 0xD5, 0x1B, -+0x1E, 0xE1, 0x8A, 0xE5, 0x18, 0xB4, 0x2D, 0x17, 0xE5, 0x19, 0xD3, 0x94, 0x02, 0x50, 0x10, 0x75, -+0x18, 0x2C, 0xB1, 0x6F, 0x74, 0xFF, 0xF0, 0x15, 0x1B, 0xE5, 0x1B, 0x70, 0x02, 0xE1, 0x8A, 0xE5, -+0x1B, 0x70, 0x02, 0xE1, 0x8A, 0x90, 0xA7, 0x35, 0xE0, 0xFF, 0xE5, 0x1A, 0xD3, 0x9F, 0x50, 0x02, -+0xE1, 0x84, 0xE4, 0x90, 0xA7, 0x34, 0xF0, 0x90, 0xA7, 0x33, 0xE0, 0xFF, 0xAD, 0x1A, 0x12, 0x7C, -+0x8E, 0x8F, 0x1A, 0x85, 0x1A, 0x18, 0xE0, 0xFF, 0x90, 0xA7, 0x35, 0xE0, 0xFD, 0x12, 0x7C, 0x8E, -+0xEF, 0xF0, 0xE5, 0x18, 0xD3, 0x94, 0x0B, 0x40, 0x1D, 0x90, 0xA7, 0x31, 0xE0, 0xFB, 0x90, 0xA7, -+0x33, 0xE0, 0x90, 0xA7, 0x39, 0xF0, 0x7D, 0x01, 0xAF, 0x1A, 0x12, 0x7B, 0x21, 0x8F, 0x18, 0xE5, -+0x18, 0xF4, 0x70, 0x57, 0xE1, 0x8A, 0xAD, 0x18, 0xE5, 0x1A, 0x14, 0xFC, 0x90, 0xA7, 0x35, 0xE0, -+0xFF, 0xEC, 0xC3, 0x9F, 0x40, 0x38, 0x12, 0x7D, 0x00, 0x90, 0xA7, 0x31, 0x12, 0x61, 0x99, 0xF1, -+0xC2, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x7D, 0x0F, 0x60, 0x1C, 0xE5, -+0x1A, 0xAD, 0x04, 0xB4, 0x14, 0x02, 0x7D, 0x0C, 0x90, 0xA7, 0x34, 0xE0, 0x04, 0xF0, 0xE0, 0x65, -+0x1B, 0x60, 0x0B, 0xA3, 0xE0, 0xFF, 0xED, 0xD3, 0x9F, 0x40, 0x03, 0x1C, 0x80, 0xBE, 0xB1, 0x6F, -+0xED, 0xF0, 0xE5, 0x18, 0xB4, 0xFF, 0x04, 0xAF, 0x05, 0x8F, 0x18, 0x90, 0xA7, 0x33, 0xE0, 0xFF, -+0xAD, 0x18, 0x12, 0x7C, 0x7B, 0x8F, 0x18, 0xB1, 0x6F, 0xE0, 0xFD, 0xF4, 0x60, 0x1B, 0x90, 0xA7, -+0x33, 0xE0, 0xFF, 0x12, 0x7C, 0x7B, 0x90, 0xA7, 0x31, 0xE0, 0xFE, 0xF1, 0x9A, 0xEF, 0xF0, 0x74, -+0xA6, 0x2E, 0xB1, 0x75, 0x74, 0xFF, 0xF0, 0x80, 0x11, 0x90, 0xA7, 0x31, 0xE0, 0xF1, 0x9A, 0xE5, -+0x18, 0xF0, 0x80, 0x06, 0x90, 0xA7, 0x35, 0xE0, 0xF5, 0x18, 0x90, 0xA7, 0x31, 0xE0, 0xFF, 0xA3, -+0xE0, 0xFB, 0x85, 0x19, 0x77, 0xAD, 0x18, 0x02, 0x6C, 0x07, 0x24, 0x26, 0xF5, 0x82, 0xE4, 0x34, -+0xA4, 0xF5, 0x83, 0x22, 0x90, 0x00, 0x04, 0x02, 0x49, 0xC0, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x90, -+0x9B, 0x16, 0x02, 0x4A, 0x37, 0xFF, 0x74, 0x15, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, -+0x83, 0x22, 0xE0, 0xFB, 0x7A, 0x00, 0xEC, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, -+0x08, 0x22, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x22, 0xFD, 0x7C, 0x00, 0x90, 0xA7, 0x30, -+0xE0, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xE5, 0x0E, 0x22, 0x90, 0xA7, 0x31, 0xE0, 0xFF, 0x75, -+0xF0, 0x04, 0x22, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x15, 0x02, 0x4A, 0x37, 0xE4, 0x90, -+0xA7, 0x1D, 0xF0, 0x90, 0xA7, 0x1D, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0xFE, 0x90, 0x01, 0xC4, 0xF0, -+0x74, 0x5F, 0xA3, 0xF0, 0x12, 0x3A, 0xEB, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x69, 0x12, 0x4F, 0xFA, -+0x12, 0x46, 0x2D, 0x80, 0xDE, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x48, 0x2E, 0x90, 0xA7, -+0x1E, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0xA5, 0x27, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, -+0xC2, 0xAF, 0xEF, 0x30, 0xE0, 0x0E, 0x90, 0xA5, 0x27, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x11, -+0x89, 0x12, 0x59, 0x58, 0x11, 0x7F, 0x30, 0xE1, 0x06, 0x54, 0xFD, 0xF0, 0x12, 0x7F, 0xF5, 0x11, -+0x7F, 0x30, 0xE2, 0x06, 0x54, 0xFB, 0xF0, 0x12, 0x68, 0xDF, 0x11, 0x7F, 0x30, 0xE5, 0x0C, 0x54, -+0xDF, 0xF0, 0x12, 0x84, 0xB1, 0xBF, 0x01, 0x03, 0x12, 0x50, 0x7D, 0xD2, 0xAF, 0x80, 0xB6, 0xD2, -+0xAF, 0xC2, 0xAF, 0x90, 0xA5, 0x27, 0xE0, 0xFF, 0x22, 0x90, 0xA7, 0xC6, 0xEF, 0xF0, 0x90, 0xA7, -+0x0A, 0xE0, 0x90, 0xA8, 0x48, 0xF0, 0xE4, 0x90, 0xA7, 0xC7, 0xF0, 0x90, 0xA8, 0x48, 0xE0, 0xFE, -+0x90, 0xA7, 0xC7, 0xE0, 0xFF, 0xC3, 0x9E, 0x50, 0x2C, 0xE0, 0xFE, 0x31, 0x8B, 0xE4, 0xF0, 0x75, -+0xF0, 0x10, 0xEE, 0xF1, 0xAE, 0xE0, 0x30, 0xE7, 0x09, 0x74, 0x81, 0x2F, 0xF1, 0xD4, 0xE4, 0xF0, -+0x80, 0x0B, 0xF1, 0xCD, 0x90, 0xA7, 0xC7, 0xE0, 0x31, 0x8B, 0x74, 0x01, 0xF0, 0x90, 0xA7, 0xC7, -+0xE0, 0x04, 0xF0, 0x80, 0xC6, 0x7F, 0x0C, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xE4, 0x90, 0xA7, 0xC7, -+0xF0, 0x90, 0xA8, 0x48, 0xE0, 0xFF, 0x90, 0xA7, 0xC7, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0x21, -+0x8A, 0x74, 0xC8, 0x2E, 0x31, 0x8D, 0xE0, 0x70, 0x02, 0x21, 0x82, 0x75, 0xF0, 0x10, 0xEE, 0x90, -+0x81, 0x06, 0xF1, 0xEC, 0xEE, 0x90, 0x81, 0x07, 0x12, 0x85, 0x89, 0xFC, 0x12, 0x84, 0x04, 0xF5, -+0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x0A, 0xF1, 0xEC, 0xEC, -+0x90, 0x81, 0x0B, 0x12, 0x85, 0x89, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x12, 0x4A, 0x37, 0xEE, -+0xF0, 0xA3, 0xEF, 0xF0, 0x7F, 0x01, 0x90, 0xA7, 0xC7, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x90, 0x81, -+0x0B, 0x31, 0xA0, 0xE0, 0xFD, 0x75, 0xF0, 0x0A, 0xEE, 0xF1, 0x8C, 0xED, 0xF0, 0x0F, 0xEF, 0xB4, -+0x05, 0xE4, 0x90, 0xA7, 0xC7, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x09, 0x12, 0x4A, 0x37, -+0xE0, 0xFE, 0x74, 0x95, 0x2F, 0x12, 0x84, 0x12, 0xEE, 0xF0, 0x90, 0xA7, 0xC7, 0xE0, 0xFF, 0x90, -+0xA7, 0xC6, 0xE0, 0xFD, 0x12, 0x83, 0xA3, 0x90, 0xA7, 0xC7, 0xE0, 0x24, 0x81, 0xF1, 0xD4, 0x74, -+0x01, 0xF0, 0x90, 0xA7, 0xC7, 0xE0, 0x04, 0xF0, 0x01, 0xE1, 0x22, 0x24, 0xC8, 0xF5, 0x82, 0xE4, -+0x34, 0xA7, 0xF5, 0x83, 0x22, 0xFF, 0x90, 0xA8, 0xAD, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, -+0x12, 0x4A, 0x37, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA8, 0xAD, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0x12, 0x4F, 0x9C, -+0x54, 0x1F, 0xF5, 0x73, 0x60, 0x15, 0x64, 0x02, 0x60, 0x11, 0xE5, 0x73, 0x64, 0x04, 0x60, 0x0B, -+0xE5, 0x73, 0x64, 0x09, 0x60, 0x05, 0xE5, 0x73, 0xB4, 0x0C, 0x07, 0xF1, 0xBF, 0x74, 0x02, 0xF0, -+0x80, 0x05, 0xF1, 0xBF, 0x74, 0x01, 0xF0, 0xE4, 0xF5, 0x6E, 0x90, 0xA8, 0xAD, 0xE0, 0xFE, 0xD1, -+0xCF, 0xE5, 0x82, 0x25, 0x6E, 0x31, 0xA6, 0xE0, 0xFF, 0xE5, 0x73, 0x75, 0xF0, 0x07, 0xA4, 0x24, -+0xFE, 0xF5, 0x82, 0xE4, 0x34, 0x40, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x6E, 0x31, 0xA6, 0xE4, 0x93, -+0xFD, 0xEF, 0x5D, 0x90, 0xA8, 0xAF, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x12, 0x4E, 0x5D, 0x54, 0x03, -+0xFF, 0xBF, 0x02, 0x0B, 0xE5, 0x6E, 0x70, 0x07, 0x90, 0xA8, 0xAF, 0xE0, 0x54, 0xF0, 0xF0, 0x90, -+0xA8, 0xAF, 0xE0, 0xFF, 0xD1, 0xCB, 0xE5, 0x82, 0x25, 0x6E, 0x31, 0xA6, 0xEF, 0xF0, 0x05, 0x6E, -+0xE5, 0x6E, 0x64, 0x07, 0x70, 0xA4, 0x90, 0xA8, 0xAD, 0xE0, 0x75, 0xF0, 0x04, 0x12, 0x4E, 0x5D, -+0xFF, 0xC4, 0x54, 0x03, 0xFD, 0xE4, 0xF5, 0x71, 0x75, 0x6F, 0x06, 0xE5, 0x6F, 0xB4, 0x06, 0x07, -+0x31, 0x95, 0xE0, 0x54, 0x0F, 0x80, 0x09, 0xD1, 0xCB, 0xE5, 0x82, 0x25, 0x6F, 0x31, 0xA6, 0xE0, -+0x90, 0xA8, 0xAE, 0xF0, 0x90, 0xA8, 0xAE, 0xE0, 0x60, 0x33, 0x75, 0x6E, 0x07, 0xF1, 0xE4, 0x80, -+0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x85, 0xD9, 0x60, 0x17, 0x12, 0x85, 0xD0, -+0xF5, 0x71, 0xED, 0x60, 0x25, 0xE5, 0x71, 0xD3, 0x94, 0x0B, 0x40, 0x1E, 0x74, 0x20, 0x25, 0x71, -+0xF5, 0x71, 0x80, 0x16, 0x15, 0x6E, 0xE5, 0x6E, 0xC3, 0x94, 0x00, 0x50, 0xD0, 0xE5, 0x6F, 0x60, -+0x09, 0x15, 0x6F, 0xE5, 0x6F, 0xC3, 0x94, 0x00, 0x50, 0xA1, 0xE4, 0xF5, 0x72, 0xF5, 0x6F, 0xE5, -+0x6F, 0xB4, 0x06, 0x07, 0x31, 0x95, 0xE0, 0x54, 0x0F, 0x80, 0x09, 0xD1, 0xCB, 0xE5, 0x82, 0x25, -+0x6F, 0x31, 0xA6, 0xE0, 0x90, 0xA8, 0xAE, 0xF0, 0x90, 0xA8, 0xAE, 0xE0, 0x60, 0x31, 0xE4, 0xF5, -+0x6E, 0xF1, 0xE4, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x85, 0xD9, 0x60, -+0x17, 0x12, 0x85, 0xD0, 0xF5, 0x72, 0xED, 0x60, 0x1E, 0xE5, 0x72, 0xD3, 0x94, 0x0B, 0x40, 0x17, -+0x74, 0x20, 0x25, 0x72, 0xF5, 0x72, 0x80, 0x0F, 0x05, 0x6E, 0xE5, 0x6E, 0xB4, 0x08, 0xD2, 0x05, -+0x6F, 0xE5, 0x6F, 0x64, 0x07, 0x70, 0xA8, 0x90, 0xA8, 0xAD, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x12, -+0x5F, 0xF8, 0xE5, 0x71, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0xF1, 0x9D, 0xE5, 0x72, 0x12, 0x56, 0xF4, -+0xE0, 0xFF, 0x54, 0x7F, 0xF5, 0x70, 0xEF, 0x54, 0x80, 0xFF, 0xE5, 0x70, 0xD3, 0x95, 0x71, 0x40, -+0x04, 0xE5, 0x71, 0x80, 0x09, 0xE5, 0x70, 0xC3, 0x95, 0x72, 0x50, 0x05, 0xE5, 0x72, 0x4F, 0xF5, -+0x70, 0x90, 0xA8, 0xAD, 0xE0, 0xFF, 0x24, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE5, -+0x70, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4E, 0x5D, 0x12, 0x6E, 0xCF, 0x90, 0xA8, 0xAD, 0xE0, -+0xFF, 0xE4, 0xFB, 0xAD, 0x70, 0x12, 0x6C, 0x07, 0x90, 0xA8, 0xAD, 0xE0, 0x75, 0xF0, 0x10, 0xF1, -+0xAE, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0x40, 0xFF, 0x75, 0x41, 0x44, 0x75, 0x42, -+0x4B, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x30, 0xF1, 0xA3, 0x75, 0x41, 0x44, 0x75, -+0x42, 0x51, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x36, 0xF1, 0xA3, 0x75, 0x41, 0x44, -+0x75, 0x42, 0x57, 0x75, 0x43, 0x54, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x3C, 0xF1, 0xA3, 0x75, 0x41, -+0x44, 0x75, 0x42, 0xAB, 0x75, 0x43, 0x54, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x90, 0x12, 0x34, 0x2C, -+0xE4, 0xF5, 0x0D, 0xE4, 0xFF, 0x74, 0x95, 0x25, 0x0D, 0xD1, 0xDD, 0xE0, 0x54, 0xFE, 0xF0, 0x75, -+0xF0, 0x10, 0xE5, 0x0D, 0x90, 0x81, 0x00, 0xBF, 0x03, 0x07, 0x31, 0xA0, 0x74, 0x80, 0xF0, 0x80, -+0x04, 0x31, 0xA0, 0xE4, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x0D, 0x31, 0x9D, 0xE4, 0xF0, 0x0F, 0xBF, -+0x10, 0xD3, 0x05, 0x0D, 0xE5, 0x0D, 0xB4, 0x80, 0xCA, 0xE4, 0x90, 0xAF, 0x7D, 0xF0, 0x90, 0x94, -+0x91, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xE4, 0xF5, 0x0D, 0xE4, 0xFF, 0x75, 0xF0, 0x0A, -+0xE5, 0x0D, 0xF1, 0x8C, 0xF0, 0x0F, 0xBF, 0x05, 0xF4, 0x75, 0xF0, 0x04, 0xE5, 0x0D, 0x12, 0x6E, -+0xFC, 0x54, 0x07, 0xF0, 0x74, 0xA6, 0x25, 0x0D, 0xF1, 0xC5, 0xE4, 0xF0, 0xE5, 0x0D, 0x12, 0x84, -+0x04, 0xB1, 0x1E, 0x74, 0x95, 0x25, 0x0D, 0x12, 0x84, 0x12, 0xE4, 0xF0, 0xE5, 0x0D, 0xB1, 0x15, -+0xE5, 0x0D, 0xF1, 0xB5, 0xB1, 0x1E, 0xE5, 0x0D, 0xD1, 0xAD, 0xB1, 0x1E, 0xE5, 0x0D, 0xD1, 0xB9, -+0xB1, 0x1E, 0x75, 0xF0, 0x04, 0xE5, 0x0D, 0x12, 0x5F, 0xF8, 0x74, 0x3F, 0x91, 0xFC, 0xF1, 0x9D, -+0xE4, 0x91, 0xFC, 0x12, 0x4F, 0x9C, 0x54, 0xE0, 0x44, 0x09, 0x91, 0xFC, 0x12, 0x4E, 0x5D, 0x54, -+0xF3, 0x91, 0xFC, 0x12, 0x4E, 0x5D, 0x54, 0xFC, 0x91, 0xFC, 0x12, 0x4F, 0x9C, 0x44, 0x20, 0x91, -+0xFC, 0x12, 0x4E, 0x5D, 0x54, 0xCF, 0x91, 0xFC, 0x12, 0x4E, 0x5D, 0x44, 0x40, 0x91, 0xFC, 0x12, -+0x4E, 0x5D, 0x54, 0x7F, 0x91, 0xFC, 0xF1, 0x9D, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x0D, 0x12, -+0x56, 0xF9, 0xEF, 0xF0, 0x74, 0x95, 0x25, 0x0D, 0xD1, 0xDD, 0xE4, 0xF0, 0x05, 0x0D, 0xE5, 0x0D, -+0x64, 0x80, 0x60, 0x02, 0x81, 0x1B, 0x90, 0x04, 0x49, 0x74, 0xF0, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, -+0x74, 0xFF, 0xF0, 0x90, 0xA7, 0x17, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0xA3, 0x04, 0xF0, -+0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xE4, 0xFB, 0xFD, 0xFF, 0x12, 0x7D, 0x80, 0x74, 0x15, 0x25, -+0x0D, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x22, 0xF0, 0x75, 0xF0, 0x04, -+0xE5, 0x0D, 0x22, 0xE0, 0xFF, 0x25, 0xE0, 0x24, 0xA5, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, -+0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0xA5, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, -+0xE4, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0xA7, 0x23, 0x12, 0x77, 0xA2, 0x90, 0xA7, -+0x24, 0x12, 0x4F, 0xA3, 0xFD, 0xE4, 0xFF, 0x74, 0x27, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA7, 0xF5, -+0x83, 0xE4, 0xF0, 0x0F, 0xEF, 0xB4, 0x0C, 0xEF, 0xED, 0x30, 0xE0, 0x47, 0xF1, 0xDC, 0x40, 0x43, -+0xA3, 0xE0, 0xD3, 0x94, 0x80, 0x40, 0x3C, 0x90, 0xA7, 0x27, 0x74, 0x01, 0xD1, 0xC4, 0x90, 0xA7, -+0x28, 0xD1, 0xC3, 0x78, 0x08, 0x12, 0x27, 0x22, 0x90, 0xA7, 0x29, 0xD1, 0xC3, 0x78, 0x10, 0x12, -+0x27, 0x22, 0x90, 0xA7, 0x2A, 0xD1, 0xC3, 0x78, 0x18, 0x12, 0x27, 0x22, 0x90, 0xA7, 0x2B, 0xEF, -+0xF0, 0x12, 0x85, 0xAA, 0x74, 0x05, 0xF0, 0x90, 0x94, 0x91, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x00, 0xC1, 0x89, 0xED, 0x30, 0xE1, 0x73, 0x90, 0xA7, 0x27, 0x74, 0x02, 0xF0, 0xF1, 0xDC, 0x50, -+0x26, 0xE0, 0xFC, 0xD1, 0xB9, 0xD1, 0xA5, 0x90, 0xA7, 0x28, 0xF0, 0xEE, 0xA3, 0xF0, 0xEC, 0xD1, -+0xAD, 0xD1, 0xA5, 0x90, 0xA7, 0x2A, 0xF0, 0xEE, 0xA3, 0xF0, 0x90, 0xA7, 0x23, 0xD1, 0xB7, 0xB1, -+0x1E, 0xD1, 0xAC, 0xB1, 0x1E, 0x80, 0x06, 0x90, 0xA7, 0x28, 0x74, 0xEA, 0xF0, 0x90, 0xA7, 0x24, -+0xE0, 0xD3, 0x94, 0x80, 0x50, 0x26, 0xE0, 0xFC, 0xD1, 0xB9, 0xD1, 0xA5, 0x90, 0xA7, 0x2C, 0xF0, -+0xEE, 0xA3, 0xF0, 0xEC, 0xD1, 0xAD, 0xD1, 0xA5, 0x90, 0xA7, 0x2E, 0xF0, 0xEE, 0xA3, 0xF0, 0x90, -+0xA7, 0x24, 0xD1, 0xB7, 0xB1, 0x1E, 0xD1, 0xAC, 0xB1, 0x1E, 0x80, 0x06, 0x90, 0xA7, 0x2C, 0x74, -+0xEA, 0xF0, 0x12, 0x85, 0xAA, 0x74, 0x09, 0xF0, 0x80, 0x7F, 0xED, 0x70, 0x71, 0x90, 0xA7, 0x23, -+0xE0, 0xFD, 0xD3, 0x94, 0x80, 0x50, 0x22, 0xE0, 0x90, 0xA7, 0x27, 0xF1, 0xB4, 0xD1, 0xA5, 0x90, -+0xA7, 0x28, 0xD1, 0x97, 0x90, 0xA7, 0x2A, 0x12, 0x85, 0xBE, 0x12, 0x56, 0xF9, 0xE0, 0x90, 0xA7, -+0x2C, 0xF0, 0x90, 0xA7, 0x23, 0xB1, 0x03, 0x80, 0x03, 0x12, 0x85, 0xC7, 0x90, 0xA7, 0x24, 0xE0, -+0xFD, 0xD3, 0x94, 0x80, 0x50, 0x22, 0xE0, 0x90, 0xA7, 0x2D, 0xF1, 0xB4, 0xD1, 0xA5, 0x90, 0xA7, -+0x2E, 0xD1, 0x97, 0x90, 0xA7, 0x30, 0x12, 0x85, 0xBE, 0x12, 0x56, 0xF9, 0xE0, 0x90, 0xA7, 0x32, -+0xF0, 0x90, 0xA7, 0x24, 0xB1, 0x03, 0x80, 0x08, 0x90, 0xA7, 0x24, 0xE0, 0x90, 0xA7, 0x2D, 0xF0, -+0x90, 0xA7, 0x25, 0x74, 0x04, 0xF0, 0x90, 0xA7, 0x33, 0x74, 0x0C, 0xF0, 0x80, 0x0B, 0x90, 0xA7, -+0x25, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA7, 0x33, 0xF0, 0x7B, 0x01, 0x7A, 0xA7, 0x79, 0x25, 0x12, -+0x69, 0xCB, 0x7F, 0x04, 0x02, 0x6B, 0xB5, 0xF0, 0xEE, 0xA3, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0xA5, -+0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0xEF, 0x25, 0xE0, 0x24, -+0xA6, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0x22, 0xE0, 0xFF, 0x25, 0xE0, 0x24, 0x26, 0xF5, 0x82, 0xE4, -+0x34, 0xA2, 0x22, 0xEF, 0xF0, 0x90, 0x94, 0x91, 0x02, 0x4A, 0x1F, 0x90, 0xA8, 0xAD, 0xE0, 0x75, -+0xF0, 0x08, 0x90, 0x89, 0x00, 0x02, 0x4A, 0x37, 0xF0, 0x74, 0x95, 0x25, 0x0E, 0xF5, 0x82, 0xE4, -+0x34, 0x99, 0xF5, 0x83, 0x22, 0x12, 0x4F, 0xFC, 0x12, 0x26, 0x1E, 0xF5, 0x0E, 0x24, 0x95, 0xD1, -+0xDD, 0xE0, 0x54, 0x98, 0xD1, 0xD8, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x7E, 0x54, 0x01, 0xFE, 0xEF, -+0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xD1, 0xD8, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x7E, 0x54, 0x02, 0xFE, -+0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xD1, 0xD8, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x7E, 0x54, 0x04, -+0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xD1, 0xD8, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x7E, 0x54, -+0x40, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xD1, 0xD8, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x7E, -+0x54, 0x20, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xE5, 0x0E, 0x70, 0x08, 0xF1, 0x86, -+0x54, 0x04, 0x90, 0x04, 0xAB, 0xF0, 0xE5, 0x0E, 0xC3, 0x94, 0x80, 0x50, 0x08, 0x12, 0x4F, 0xA4, -+0x12, 0x5F, 0xB5, 0xEF, 0xF0, 0xD1, 0xD9, 0xE0, 0x30, 0xE5, 0x12, 0x12, 0x4E, 0x58, 0x13, 0x13, -+0x54, 0x03, 0xFB, 0x12, 0x5F, 0xB6, 0xE0, 0xFD, 0xAF, 0x0E, 0x12, 0x82, 0x9E, 0x22, 0xE0, 0xFF, -+0x90, 0xA7, 0x23, 0x12, 0x4A, 0x43, 0x90, 0x00, 0x03, 0x02, 0x26, 0x37, 0x90, 0x8D, 0x01, 0x12, -+0x4A, 0x37, 0x75, 0xF0, 0x02, 0xEF, 0x12, 0x4A, 0x37, 0xE4, 0xF0, 0xA3, 0x22, 0x90, 0x96, 0x16, -+0x02, 0x4A, 0x37, 0x12, 0x34, 0x2C, 0x75, 0x40, 0xFF, 0x22, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, -+0x03, 0x02, 0x4A, 0x37, 0xF0, 0x25, 0xE0, 0x24, 0xA5, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0x22, 0x90, -+0xA8, 0xAD, 0xE0, 0x24, 0xA6, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0x22, 0xF1, 0xAA, 0xE0, -+0x44, 0x40, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0x90, 0xA7, 0x23, 0xE0, -+0xD3, 0x94, 0x80, 0x22, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x6E, 0x08, 0x22, 0x12, 0x4A, 0x37, 0xE0, -+0xFD, 0x75, 0xF0, 0x10, 0x22, 0xE0, 0x90, 0xA8, 0x8A, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, -+0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA8, 0x85, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0x90, 0xA8, 0x89, 0xE0, 0xF5, 0x3B, 0xA3, 0xE0, 0xF5, 0x3C, 0x12, 0x34, 0x8C, 0x90, 0xA8, 0x85, -+0x11, 0x2D, 0xA3, 0xA3, 0xA3, 0x74, 0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFE, 0xA3, -+0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA8, 0x97, -+0xEE, 0xF0, 0xA3, 0xEF, 0x12, 0x57, 0xCD, 0x90, 0xA8, 0x97, 0x11, 0x2D, 0xE0, 0x60, 0x29, 0xC3, -+0x90, 0xA8, 0x9A, 0xE0, 0x94, 0xE8, 0x90, 0xA8, 0x99, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, -+0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x11, 0x90, 0xA8, 0x99, 0x12, 0x58, 0x9E, 0x7F, -+0x0A, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x80, 0xCF, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA8, 0x9F, 0x12, 0x4A, 0x4C, 0x7F, 0x96, 0x7E, 0x02, -+0x11, 0x36, 0xEF, 0x60, 0x45, 0x12, 0x7F, 0xAC, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, 0xFE, -+0x90, 0xA8, 0xA2, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0xA8, 0xA2, 0xE0, 0xFD, -+0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA8, 0x9F, 0x31, 0xB6, 0x24, 0x02, 0xFF, 0xE4, -+0x33, 0xFE, 0x12, 0x56, 0x22, 0x90, 0xA8, 0xA2, 0xE0, 0x24, 0x18, 0xFF, 0x90, 0xA8, 0x9F, 0x12, -+0x4A, 0x43, 0x31, 0x44, 0x90, 0x02, 0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA6, 0xD4, 0xE0, 0xFE, 0x90, 0xA6, 0xD3, -+0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, 0x3F, -+0xED, 0x31, 0xBF, 0xFA, 0x7B, 0x01, 0x11, 0x7F, 0x7F, 0x01, 0xEF, 0x60, 0x32, 0x90, 0xA6, 0xD3, -+0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, -+0xA6, 0xD3, 0xF0, 0x90, 0xA6, 0xD4, 0xE0, 0xFF, 0x90, 0xA6, 0xD3, 0xE0, 0xB5, 0x07, 0x04, 0x7F, -+0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x07, 0x90, 0xA5, 0x27, 0xE0, 0x44, 0x04, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA8, 0x9B, 0xEF, 0xF0, 0xA3, 0x12, 0x4A, 0x4C, 0x90, 0xA8, 0xB1, -+0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, 0x76, 0x74, 0x00, 0x2F, 0xF9, 0xE4, -+0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0xA8, 0x9C, 0x12, 0x4A, -+0x43, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, -+0x12, 0x34, 0x2C, 0x90, 0xA8, 0x9B, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, -+0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x4A, 0x43, 0xE9, 0x24, 0x02, 0xF9, 0xE4, 0x3A, -+0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0xA8, 0x9C, 0x31, 0xB6, 0xF5, 0x43, 0xD0, 0x01, 0xD0, -+0x02, 0xD0, 0x03, 0x02, 0x34, 0x2C, 0x12, 0x4A, 0x43, 0x90, 0x00, 0x0E, 0x02, 0x26, 0x37, 0x75, -+0xF0, 0x0F, 0xA4, 0x24, 0x3D, 0xF9, 0x74, 0xA6, 0x35, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0xA6, 0xD3, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, -+0x14, 0xFF, 0x90, 0xA6, 0xD4, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, -+0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x28, 0xC0, 0x01, 0x90, 0xA6, 0xD4, -+0xE0, 0x31, 0xBF, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x49, -+0x59, 0x90, 0xA6, 0xD4, 0xF1, 0xEC, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, -+0xA6, 0xD4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x8F, 0x11, 0x90, 0xA7, 0x23, 0x74, 0x0E, 0xF0, -+0xED, 0x24, 0xFE, 0x60, 0x5A, 0x04, 0x60, 0x02, 0x41, 0xED, 0x71, 0xA7, 0x74, 0x0C, 0xF0, 0x74, -+0x15, 0x25, 0x11, 0x12, 0x5F, 0xBA, 0xE0, 0x90, 0xA7, 0x26, 0x51, 0xF5, 0x12, 0x4E, 0x5D, 0xFD, -+0x13, 0x13, 0x54, 0x03, 0x90, 0xA7, 0x27, 0xF0, 0xED, 0x12, 0x4F, 0xAD, 0xA3, 0x51, 0xF5, 0x12, -+0x4E, 0x5D, 0xFF, 0xC4, 0x54, 0x03, 0x90, 0xA7, 0x29, 0x51, 0xF5, 0x12, 0x5F, 0xF8, 0xE0, 0x90, -+0xA7, 0x2A, 0x51, 0xF5, 0x12, 0x67, 0x9D, 0xE0, 0x90, 0xA7, 0x2B, 0x51, 0xF5, 0x12, 0x4F, 0x9C, -+0xFD, 0xC4, 0x13, 0x54, 0x01, 0x90, 0xA7, 0x2C, 0xF0, 0xED, 0x54, 0x1F, 0xA3, 0x80, 0x59, 0x71, -+0xA7, 0x74, 0x0D, 0x51, 0xEE, 0x12, 0x66, 0xD2, 0xE0, 0x90, 0xA7, 0x26, 0x51, 0xEE, 0x90, 0x89, -+0x01, 0x12, 0x4A, 0x37, 0xE0, 0x90, 0xA7, 0x27, 0x51, 0xEE, 0x90, 0x89, 0x02, 0x12, 0x4A, 0x37, -+0xE0, 0x90, 0xA7, 0x28, 0x51, 0xEE, 0x90, 0x89, 0x03, 0x12, 0x4A, 0x37, 0xE0, 0x90, 0xA7, 0x29, -+0x51, 0xEE, 0x12, 0x85, 0xEA, 0x90, 0xA7, 0x2A, 0x51, 0xEE, 0x90, 0x89, 0x05, 0x12, 0x4A, 0x37, -+0xE0, 0x90, 0xA7, 0x2B, 0x51, 0xEE, 0x90, 0x89, 0x06, 0x12, 0x4A, 0x37, 0xE0, 0x90, 0xA7, 0x2C, -+0x51, 0xEE, 0x12, 0x85, 0xE2, 0x90, 0xA7, 0x2D, 0xF0, 0x51, 0xFC, 0x71, 0xB1, 0x22, 0xF0, 0x75, -+0xF0, 0x08, 0xE5, 0x11, 0x22, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x11, 0x22, 0x7B, 0x01, 0x7A, 0xA7, -+0x79, 0x23, 0x22, 0x51, 0xFC, 0x7F, 0xF5, 0x7E, 0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, 0x06, 0x90, -+0xA7, 0x23, 0xE0, 0xA3, 0xF0, 0x51, 0xFC, 0x7F, 0xF6, 0x7E, 0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, -+0x08, 0x90, 0xA7, 0x23, 0xE0, 0x90, 0xA7, 0x25, 0xF0, 0x51, 0xFC, 0x7F, 0xF4, 0x7E, 0x03, 0x12, -+0x33, 0xC7, 0xBF, 0x01, 0x08, 0x90, 0xA7, 0x23, 0xE0, 0x90, 0xA7, 0x26, 0xF0, 0x51, 0xFC, 0x7F, -+0xF3, 0x7E, 0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, 0x03, 0x12, 0x85, 0xC7, 0x51, 0xFC, 0x7F, 0xF2, -+0x7E, 0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, 0x08, 0x90, 0xA7, 0x23, 0xE0, 0x90, 0xA7, 0x28, 0xF0, -+0x90, 0xA7, 0x24, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0xA7, 0x2C, -+0xF0, 0x90, 0xA7, 0x28, 0xE0, 0x90, 0xA7, 0x2D, 0xF0, 0x90, 0xA7, 0x2E, 0x74, 0x12, 0xF0, 0x90, -+0xA7, 0x3C, 0x74, 0x05, 0xF0, 0x90, 0xA7, 0x30, 0x12, 0x7D, 0x27, 0x90, 0xA7, 0x2C, 0xE0, 0x90, -+0xA7, 0x33, 0xF0, 0x90, 0xA7, 0x2D, 0xE0, 0x90, 0xA7, 0x34, 0xF0, 0x7B, 0x01, 0x7A, 0xA7, 0x79, -+0x2E, 0x31, 0xCB, 0x7F, 0x04, 0x80, 0x0E, 0x90, 0xA7, 0x31, 0x74, 0x09, 0xF0, 0x90, 0xA7, 0x25, -+0x22, 0x31, 0xCB, 0x7F, 0x04, 0x90, 0xA8, 0xBA, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x48, 0x07, 0x90, -+0xA5, 0x27, 0xE0, 0xFF, 0x90, 0xA8, 0xBA, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0xA5, 0x27, 0xF0, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA8, 0x4F, 0xED, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, -+0xEB, 0xF0, 0x90, 0xA8, 0x4C, 0xE0, 0x90, 0xA8, 0x52, 0xF0, 0x90, 0xA8, 0x4D, 0x74, 0x0C, 0xF0, -+0x90, 0xA8, 0x5B, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0xA8, 0x79, 0x4D, 0x71, 0xB1, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xAD, 0x1A, 0xAF, 0x18, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x74, -+0x8D, 0x75, 0x8B, 0x76, 0xE4, 0x90, 0xA8, 0x73, 0xF0, 0xE5, 0x74, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0x90, 0xA8, 0x6E, 0xF0, 0xE5, 0x74, 0x54, 0x07, 0x90, 0xA8, 0x70, 0xF0, 0x75, 0xF0, 0x10, 0xEF, -+0x12, 0x56, 0xD1, 0x90, 0xA8, 0x71, 0x12, 0x5F, 0xF3, 0xE0, 0x54, 0x7F, 0x90, 0xA8, 0x74, 0xF0, -+0x75, 0xF0, 0x04, 0xE5, 0x74, 0x12, 0x67, 0x9D, 0xE0, 0x90, 0xA8, 0x75, 0xF0, 0xD1, 0xEE, 0xE5, -+0x76, 0x70, 0x36, 0x90, 0xA8, 0x4C, 0xF0, 0xFB, 0xAF, 0x74, 0x71, 0xD0, 0x90, 0xA8, 0x6F, 0xE0, -+0xFF, 0x12, 0x85, 0x70, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x93, 0xFD, 0xEF, 0x12, 0x7C, 0xA2, 0x74, -+0x01, 0x93, 0x2D, 0xFF, 0xE4, 0x93, 0x3C, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x74, 0x12, -+0x79, 0x72, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x80, 0x19, 0xE5, 0x76, 0xB4, 0x01, 0x14, 0x90, 0xA5, -+0x2E, 0xE0, 0x60, 0x0E, 0x90, 0xA8, 0x4C, 0x74, 0x05, 0xF0, 0xE4, 0xFB, 0xAD, 0x75, 0xAF, 0x74, -+0x71, 0xD0, 0x90, 0xA8, 0x74, 0xE0, 0xFF, 0x90, 0xA8, 0x6F, 0xE0, 0xFE, 0xD3, 0x9F, 0x40, 0x0B, -+0xE5, 0x75, 0x54, 0x80, 0xFD, 0xEF, 0x4D, 0xF5, 0x75, 0x80, 0x0C, 0x90, 0xA8, 0x75, 0xE0, 0xFF, -+0xEE, 0xC3, 0x9F, 0x50, 0x02, 0x8F, 0x75, 0xD1, 0xEE, 0xE5, 0x75, 0x54, 0x80, 0x90, 0xA8, 0x72, -+0xF0, 0xE5, 0x76, 0x70, 0x24, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0xD1, 0xC1, 0xC0, 0x83, 0xC0, -+0x82, 0xF1, 0xBA, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, -+0x90, 0xA8, 0x71, 0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x4B, 0x74, 0x95, 0x25, 0x74, 0x12, 0x66, 0xDD, -+0xE0, 0x90, 0x04, 0xCF, 0x30, 0xE0, 0x05, 0x74, 0x20, 0xF0, 0x80, 0x03, 0x74, 0x10, 0xF0, 0xD1, -+0xC1, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0xBA, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xD0, 0x82, -+0xD0, 0x83, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x74, 0x12, 0x56, 0xD1, 0x54, 0x07, 0xFF, 0x90, 0xA8, -+0x71, 0xF0, 0x90, 0xA8, 0x6F, 0xE0, 0x90, 0x43, 0x9D, 0x93, 0x12, 0x85, 0xF2, 0x90, 0xA8, 0x71, -+0xF0, 0x44, 0x80, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x74, 0x12, 0x56, 0xF9, 0xE5, 0x75, 0xF0, 0xE5, -+0x74, 0x70, 0x06, 0x90, 0x01, 0xC8, 0xE5, 0x75, 0xF0, 0x90, 0xA8, 0x71, 0xE0, 0xFF, 0x75, 0xF0, -+0x10, 0xE5, 0x74, 0x90, 0x81, 0x01, 0x12, 0x4A, 0x37, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x74, -+0x12, 0x59, 0x52, 0xE0, 0x54, 0xFC, 0xFF, 0xE5, 0x77, 0x54, 0x03, 0x4F, 0xFF, 0x75, 0xF0, 0x10, -+0xE5, 0x74, 0x12, 0x59, 0x52, 0xEF, 0xF0, 0x7D, 0x01, 0xAF, 0x74, 0x12, 0x83, 0xA3, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xE4, 0xF5, 0x22, 0x90, 0xA7, 0x0A, 0xE0, 0xFF, 0xE5, 0x22, 0xC3, 0x9F, 0x40, -+0x02, 0xC1, 0xA7, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0xAF, 0x22, 0x12, 0x7E, 0x64, 0xEF, 0x70, -+0x02, 0xC1, 0xA3, 0xE5, 0x22, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xF5, 0x23, 0xE5, 0x22, 0x54, 0x07, -+0xF5, 0x24, 0x74, 0x81, 0x25, 0x23, 0xD1, 0xC7, 0xE0, 0xFD, 0xD1, 0xE6, 0x80, 0x05, 0xC3, 0x33, -+0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0xC1, 0xA3, 0x75, 0xF0, 0x10, 0xE5, -+0x22, 0x12, 0x56, 0xD1, 0x20, 0xE7, 0x02, 0x80, 0x10, 0x75, 0xF0, 0x10, 0xE5, 0x22, 0x90, 0x81, -+0x02, 0x12, 0x4A, 0x37, 0xE0, 0xFF, 0x20, 0xE7, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x20, 0xF0, -+0xC1, 0xA3, 0xD1, 0xF7, 0x54, 0x07, 0x44, 0x50, 0xF0, 0xEF, 0x30, 0xE6, 0x2A, 0xD1, 0xB4, 0xD1, -+0xDE, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x22, -+0x12, 0x56, 0xF9, 0xD1, 0xD6, 0x12, 0x4E, 0x5D, 0xD1, 0xCF, 0xE4, 0xFB, 0xAF, 0x22, 0x91, 0x07, -+0xD1, 0xF7, 0x54, 0xF8, 0xF0, 0x80, 0x6C, 0xD1, 0xA8, 0xE0, 0x04, 0xF0, 0xD1, 0xA8, 0xE0, 0xD3, -+0x94, 0x01, 0x40, 0x4A, 0xAF, 0x22, 0xF1, 0x04, 0xD1, 0xA8, 0xE4, 0xF0, 0xD1, 0xB4, 0xFD, 0xFB, -+0x7A, 0x00, 0xD1, 0xE6, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x7D, 0x0F, -+0x70, 0x1C, 0x74, 0x15, 0x25, 0x23, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xAF, 0x24, 0x74, -+0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4D, 0xF0, 0x80, 0x25, 0xD1, 0xB4, -+0xD1, 0xDE, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xF0, 0x80, 0x15, 0x75, 0xF0, -+0x10, 0xE5, 0x22, 0x12, 0x56, 0xF9, 0xD1, 0xD6, 0x12, 0x4E, 0x5D, 0xD1, 0xCF, 0x7B, 0x01, 0xAF, -+0x22, 0x91, 0x07, 0x05, 0x22, 0xA1, 0x96, 0x22, 0x74, 0xA6, 0x25, 0x22, 0xF5, 0x82, 0xE4, 0x34, -+0xA3, 0xF5, 0x83, 0x22, 0x74, 0x15, 0x25, 0x23, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, -+0x22, 0x90, 0xA8, 0x6E, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0x13, -+0x13, 0x54, 0x03, 0xF5, 0x77, 0x22, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x22, 0x22, 0xFF, 0xAE, -+0x24, 0x74, 0x01, 0xA8, 0x06, 0x22, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x24, 0x08, 0x22, 0xE5, 0x75, -+0x54, 0x7F, 0x90, 0xA8, 0x6F, 0xF0, 0x22, 0x75, 0xF0, 0x04, 0xE5, 0x22, 0x90, 0x9B, 0x15, 0x12, -+0x4A, 0x37, 0xE0, 0x22, 0xAC, 0x07, 0x75, 0xF0, 0x04, 0xEC, 0x90, 0x96, 0x18, 0x12, 0x4A, 0x37, -+0x75, 0xF0, 0x04, 0xEC, 0x12, 0x5F, 0xF8, 0xE0, 0xFA, 0x74, 0x26, 0x2C, 0x12, 0x5F, 0x9C, 0xE0, -+0x54, 0x7F, 0xFD, 0x75, 0xF0, 0x04, 0xEC, 0xD1, 0xFC, 0xFF, 0x54, 0xF8, 0xFE, 0xEF, 0x04, 0x54, -+0x07, 0x4E, 0xF0, 0x75, 0xF0, 0x04, 0xEC, 0xD1, 0xFC, 0xFF, 0x54, 0x07, 0xD3, 0x94, 0x02, 0x40, -+0x49, 0x74, 0xA6, 0x2C, 0x12, 0x5D, 0x75, 0xE0, 0xF4, 0x70, 0x3F, 0x75, 0xF0, 0x04, 0xEC, 0x12, -+0x85, 0xFA, 0x54, 0xF8, 0xF0, 0x74, 0x15, 0x2C, 0x12, 0x5F, 0xBA, 0xE0, 0x54, 0x7F, 0xFF, 0x75, -+0xF0, 0x04, 0xEC, 0x12, 0x85, 0x81, 0x54, 0x80, 0x4F, 0xF0, 0x74, 0x15, 0x2C, 0x12, 0x5F, 0xBA, -+0xE0, 0x25, 0xE0, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x24, 0x32, 0xFF, 0xE4, 0x3E, 0xFE, 0x75, 0xF0, -+0x04, 0xEC, 0x12, 0x5F, 0xAF, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x26, 0x2C, 0x12, 0x7D, 0x17, -+0xE0, 0xFB, 0xF1, 0xE5, 0xFF, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0x4E, 0x5D, 0x54, 0xF3, 0x4F, 0xF0, -+0xED, 0xD3, 0x9A, 0x40, 0x02, 0xAD, 0x02, 0x74, 0x26, 0x2C, 0x12, 0x5F, 0x9C, 0xE0, 0x54, 0x80, -+0x42, 0x05, 0xAF, 0x04, 0x8B, 0x77, 0xE4, 0xFB, 0x81, 0x07, 0xE0, 0xFF, 0x90, 0xA8, 0x70, 0xE0, -+0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, 0xE4, 0x90, 0xA7, 0xB9, 0xF0, 0x90, 0xA7, 0xB7, 0x74, -+0x14, 0xF0, 0x90, 0xA7, 0xC5, 0x74, 0x01, 0xF0, 0xFB, 0x7A, 0xA7, 0x79, 0xB7, 0x31, 0xCB, 0x7F, -+0x04, 0x61, 0xB5, 0xA1, 0x93, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0x22, 0xE0, 0x04, 0xF0, 0xE0, -+0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA8, 0x7E, 0xEF, 0xF0, 0xA3, -+0xED, 0xF0, 0xFB, 0x7D, 0x00, 0x7C, 0x00, 0xE4, 0x90, 0xA8, 0x84, 0xF0, 0xEB, 0x90, 0xA8, 0x7F, -+0xF0, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xE4, 0xFF, 0xEC, 0x90, 0xA8, 0x80, 0x12, 0x27, -+0x48, 0x90, 0xA8, 0x80, 0x12, 0x4A, 0x2B, 0x90, 0xA8, 0x7F, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, -+0x12, 0x4A, 0x12, 0xA3, 0x12, 0x27, 0x48, 0x90, 0xA8, 0x80, 0x11, 0x6D, 0x7F, 0xB0, 0x7E, 0x08, -+0x12, 0x37, 0x5D, 0x11, 0x66, 0x90, 0xA8, 0x7E, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x73, 0xF5, -+0x82, 0xE4, 0x34, 0xAF, 0x12, 0x66, 0xA5, 0xFF, 0x12, 0x36, 0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, -+0xFC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3A, 0xF7, 0x12, 0x4A, 0x1F, -+0x90, 0xAC, 0xB9, 0x02, 0x27, 0x48, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA8, 0x5C, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x36, 0xCE, 0x90, 0xA8, 0x66, 0x12, 0x27, 0x48, 0x90, 0xA8, -+0x5E, 0x12, 0x4A, 0x1F, 0x12, 0x27, 0x15, 0x90, 0xA8, 0x66, 0x12, 0x4A, 0x2B, 0x12, 0x4A, 0x05, -+0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA8, 0x5E, 0x12, 0x4A, 0x1F, 0x90, 0xA8, -+0x62, 0x12, 0x4A, 0x2B, 0x12, 0x4A, 0x05, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -+0x4A, 0x12, 0x90, 0xA8, 0x6A, 0x12, 0x27, 0x48, 0x90, 0xA8, 0x6A, 0x11, 0x6D, 0x90, 0xA8, 0x5C, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x37, 0x5D, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x6F, 0xF3, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0xA8, 0x8D, 0x12, 0x4A, 0x1F, 0x90, 0xAC, 0x9C, -+0x12, 0x27, 0x48, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0x32, 0x65, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, -+0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, -+0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, -+0x0F, 0xF0, 0x74, 0x71, 0xA3, 0xF0, 0x31, 0x5E, 0x74, 0x0F, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -+0x71, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -+0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x7B, 0x00, -+0x7A, 0x00, 0x79, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x51, 0x52, 0x53, 0x7B, -+0x00, 0x7A, 0x00, 0x79, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x52, 0x52, 0x54, -+0xAB, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x02, -+0x39, 0x04, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, -+0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0x01, 0xC4, 0x74, 0x92, 0xF0, 0x74, 0x71, 0xA3, 0xF0, 0x31, 0xE1, 0x74, 0x92, 0x04, 0x90, 0x01, -+0xC4, 0xF0, 0x74, 0x71, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, -+0x32, 0x90, 0x00, 0x54, 0xE0, 0x55, 0x55, 0xF5, 0x59, 0xA3, 0xE0, 0x55, 0x56, 0xF5, 0x5A, 0xA3, -+0xE0, 0x55, 0x57, 0xF5, 0x5B, 0xA3, 0xE0, 0x55, 0x58, 0xF5, 0x5C, 0xAD, 0x59, 0x7F, 0x54, 0x12, -+0x3A, 0x96, 0xAD, 0x5A, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0xAD, 0x5B, 0x7F, 0x56, 0x12, 0x3A, 0x96, -+0xAD, 0x5C, 0x7F, 0x57, 0x12, 0x3A, 0x96, 0x53, 0x91, 0xEF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, -+0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, -+0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x1B, 0xF0, 0x74, 0x72, -+0xA3, 0xF0, 0x12, 0x81, 0x10, 0xE5, 0x61, 0x30, 0xE1, 0x02, 0x51, 0xE4, 0xE5, 0x61, 0x30, 0xE3, -+0x02, 0xF1, 0x69, 0xE5, 0x61, 0x30, 0xE4, 0x02, 0x71, 0x65, 0xE5, 0x61, 0x30, 0xE5, 0x03, 0x12, -+0x81, 0x6D, 0xE5, 0x63, 0x30, 0xE0, 0x02, 0x71, 0xB1, 0xE5, 0x63, 0x30, 0xE1, 0x02, 0x71, 0x78, -+0xE5, 0x63, 0x30, 0xE7, 0x02, 0x71, 0xDD, 0xE5, 0x64, 0x30, 0xE0, 0x02, 0x91, 0x0E, 0xE5, 0x64, -+0x30, 0xE4, 0x02, 0xF1, 0x9D, 0xE5, 0x64, 0x30, 0xE5, 0x03, 0x12, 0x6F, 0xE3, 0xE5, 0x64, 0x30, -+0xE6, 0x02, 0x51, 0xBA, 0x74, 0x1B, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x72, 0xA3, 0xF0, 0xD0, -+0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, -+0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x07, 0x1F, 0xE0, 0x54, 0x7F, -+0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0xFF, 0x90, 0xA7, 0xA9, 0xF0, 0x90, 0xA7, 0xA7, 0x74, -+0x02, 0xF0, 0x90, 0xA7, 0xB5, 0x14, 0xF0, 0xFB, 0x7A, 0xA7, 0x79, 0xA7, 0x12, 0x69, 0xCB, 0x7F, -+0x04, 0x02, 0x6B, 0xB5, 0xE4, 0xFF, 0x90, 0xA7, 0xA7, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, -+0x23, 0xA3, 0xE0, 0xF5, 0x24, 0x65, 0x23, 0x60, 0x6B, 0x90, 0xA7, 0xA8, 0x74, 0x03, 0xF0, 0x90, -+0xA7, 0xB6, 0x74, 0x08, 0xF0, 0xE5, 0x24, 0x04, 0x54, 0x0F, 0xF5, 0x25, 0xE4, 0xF5, 0x22, 0xE5, -+0x25, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, -+0x25, 0x22, 0x12, 0x61, 0xA6, 0xE0, 0xFF, 0x74, 0xAA, 0x25, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xA7, -+0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x22, 0xE5, 0x22, 0xB4, 0x08, 0xD4, 0x7B, 0x01, 0x7A, 0xA7, 0x79, -+0xA8, 0x12, 0x69, 0xCB, 0xE5, 0x24, 0x04, 0x54, 0x0F, 0xF5, 0x24, 0xB4, 0x0F, 0x03, 0xE4, 0xF5, -+0x24, 0x90, 0x04, 0x7F, 0xE5, 0x24, 0xF0, 0x90, 0xA7, 0xA7, 0xE0, 0x7F, 0x04, 0x70, 0x02, 0x80, -+0x08, 0x12, 0x6B, 0xB5, 0x22, 0x91, 0x2F, 0x7F, 0x02, 0x8F, 0x26, 0x7F, 0x02, 0x12, 0x48, 0x07, -+0x90, 0xA5, 0x27, 0xE0, 0x45, 0x26, 0xF0, 0x22, 0x91, 0x1F, 0xE0, 0xFF, 0xBF, 0xB0, 0x08, 0xBD, -+0x03, 0x05, 0xBE, 0x80, 0x02, 0x71, 0xA9, 0xBF, 0xB0, 0x08, 0xBD, 0x01, 0x05, 0xBE, 0x80, 0x02, -+0x71, 0xA9, 0x91, 0x18, 0xFF, 0xBF, 0x03, 0x0D, 0x90, 0x01, 0xB8, 0xE0, 0x04, 0xF0, 0x90, 0x05, -+0x21, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x01, 0x80, 0xC0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x01, 0xF0, -+0x22, 0x90, 0x04, 0x2F, 0xE0, 0x54, 0x7F, 0xF0, 0x91, 0x1F, 0xE0, 0xFF, 0xBF, 0xB0, 0x08, 0xBD, -+0x03, 0x05, 0xBE, 0x80, 0x02, 0x71, 0xA9, 0xBF, 0xB0, 0x08, 0xBD, 0x01, 0x05, 0xBE, 0x80, 0x02, -+0x71, 0xA9, 0x90, 0xA6, 0xD7, 0xE0, 0x30, 0xE0, 0x03, 0x12, 0x85, 0x12, 0x22, 0x90, 0x05, 0x50, -+0xE0, 0x44, 0x01, 0xF0, 0x91, 0x18, 0xFC, 0xBC, 0x03, 0x02, 0xF1, 0x61, 0x91, 0x1F, 0xE0, 0xFF, -+0xBF, 0xB0, 0x08, 0xBD, 0x03, 0x05, 0xBE, 0x80, 0x02, 0x71, 0xA9, 0xBF, 0xB0, 0x08, 0xBD, 0x01, -+0x05, 0xBE, 0x80, 0x02, 0x71, 0xA9, 0x90, 0x04, 0x2F, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x91, 0x18, -+0xFF, 0xBF, 0x03, 0x02, 0xF1, 0x61, 0x80, 0xEE, 0x90, 0x01, 0x02, 0xE0, 0x54, 0x03, 0x22, 0x90, -+0x00, 0x3A, 0x74, 0xB9, 0xF0, 0x90, 0x05, 0xF5, 0xE0, 0xFE, 0xA3, 0xE0, 0xFD, 0xA3, 0x22, 0x90, -+0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0xA8, 0xB4, 0xF0, 0x90, 0xA8, 0xB4, 0xE0, 0xFD, 0x70, 0x02, -+0xA1, 0x36, 0x90, 0xA6, 0x3B, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, -+0x14, 0xFF, 0x90, 0xA6, 0x3C, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, -+0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0xA8, 0xB0, 0xE0, 0x12, 0x5F, -+0xC9, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0xA1, -+0x19, 0xE4, 0x90, 0xA8, 0xB5, 0xF0, 0x90, 0xA8, 0xB5, 0xE0, 0xF9, 0xC3, 0x94, 0x04, 0x50, 0x42, -+0xD1, 0x11, 0xA4, 0xFF, 0xE9, 0xFD, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xD0, -+0xD1, 0xDA, 0x90, 0xA5, 0xEB, 0x12, 0x4A, 0x37, 0xE5, 0x82, 0x29, 0x12, 0x61, 0xA6, 0xEF, 0xD1, -+0x10, 0xA4, 0x2D, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xF0, 0xD1, 0xDA, 0x90, 0xA5, 0xEF, 0x12, -+0x4A, 0x37, 0xE5, 0x82, 0x29, 0x12, 0x61, 0xA6, 0xEF, 0xF0, 0x90, 0xA8, 0xB5, 0xE0, 0x04, 0xF0, -+0x80, 0xB4, 0x90, 0xA8, 0xB4, 0xE0, 0xFF, 0x90, 0xA8, 0xB0, 0x12, 0x6F, 0xBF, 0x80, 0x02, 0xC3, -+0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0xA8, 0xB4, 0xF0, 0x90, 0xA8, 0xB0, 0xB1, 0x3D, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0xA8, 0xB0, 0xE0, 0x04, 0xF0, 0xE0, 0x54, -+0x03, 0xF0, 0x90, 0xA6, 0x3C, 0x12, 0x6F, 0xEC, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, -+0x81, 0x39, 0xE4, 0x90, 0xA6, 0x3C, 0xF0, 0x81, 0x39, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, -+0x90, 0xA8, 0xB0, 0xE0, 0x44, 0x80, 0x90, 0x00, 0x8A, 0xD1, 0x10, 0x90, 0x01, 0xD0, 0x12, 0x4A, -+0x37, 0xE0, 0x90, 0x01, 0xC3, 0xF0, 0x22, 0x12, 0x3A, 0x96, 0x90, 0xA8, 0xB8, 0xE0, 0xFF, 0x74, -+0x01, 0xA8, 0x07, 0x08, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA8, 0xB9, 0xED, -+0xF0, 0x90, 0xA8, 0xB8, 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x4B, 0xB1, 0x3D, 0x80, 0x02, 0xC3, -+0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x47, 0xE0, 0x5F, 0xFD, 0x7F, 0x47, 0xB1, 0x37, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x46, 0xE0, 0x4F, 0xFD, 0x7F, 0x46, 0xD1, 0xC1, -+0x60, 0x10, 0xB1, 0x3A, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x45, 0xE0, 0x4F, -+0x80, 0x0F, 0xB1, 0x3A, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x45, 0xE0, -+0x5F, 0xFD, 0x7F, 0x45, 0x80, 0x62, 0x90, 0xA8, 0xB8, 0xE0, 0x24, 0xF8, 0xF0, 0xE0, 0x24, 0x04, -+0xB1, 0x3E, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x43, 0xE0, 0x5F, 0xFD, -+0x7F, 0x43, 0xB1, 0x37, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x43, 0xE0, 0x4F, -+0xFD, 0x7F, 0x43, 0xD1, 0xC1, 0x60, 0x19, 0x90, 0xA8, 0xB8, 0xE0, 0x24, 0x04, 0xB1, 0x3E, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x42, 0xE0, 0x4F, 0xFD, 0x7F, 0x42, 0x80, 0x18, -+0x90, 0xA8, 0xB8, 0xE0, 0x24, 0x04, 0xB1, 0x3E, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, -+0x90, 0x00, 0x42, 0xE0, 0x5F, 0xFD, 0x7F, 0x42, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xF0, 0x90, 0xA8, 0xB0, 0xE0, 0x75, 0xF0, 0x04, 0x22, 0xAD, 0x07, 0x90, 0xA7, 0x10, 0xE0, 0x75, -+0xF0, 0x20, 0xA4, 0xFF, 0x90, 0xA8, 0x91, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA7, 0x11, -+0xE0, 0x75, 0xF0, 0x08, 0xA4, 0xAE, 0xF0, 0x90, 0xA8, 0x93, 0xF0, 0xEE, 0xA3, 0xF0, 0xD1, 0xB9, -+0x90, 0xA8, 0x95, 0xF0, 0xEE, 0xA3, 0xF0, 0xED, 0x64, 0x01, 0x60, 0x65, 0x90, 0xA7, 0x0E, 0xE0, -+0xFE, 0x12, 0x4F, 0xAD, 0x30, 0xE0, 0x5A, 0xEE, 0xD1, 0xCE, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0xD1, -+0xB2, 0xFE, 0x54, 0x0F, 0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFD, 0xD1, 0xB2, 0xC4, 0x13, -+0x54, 0x07, 0x30, 0xE0, 0x24, 0xA3, 0xE0, 0x30, 0xE0, 0x10, 0x90, 0xA8, 0x96, 0xE0, 0x90, 0xA8, -+0x89, 0xF0, 0x90, 0xA8, 0x95, 0x12, 0x67, 0xF5, 0x80, 0x0F, 0xD1, 0xB9, 0xFF, 0x12, 0x3A, 0xF7, -+0xD1, 0xC9, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0xB1, 0x45, 0x90, 0xA7, 0x0E, 0xE0, 0xC4, 0x54, 0x0F, -+0x30, 0xE0, 0x0E, 0x90, 0xA8, 0x94, 0xE0, 0x90, 0xA8, 0x89, 0xF0, 0x90, 0xA8, 0x93, 0x12, 0x67, -+0xF5, 0x22, 0xB1, 0x45, 0x90, 0xA7, 0x0E, 0xE0, 0x22, 0x90, 0xA8, 0x91, 0xE0, 0xFE, 0xA3, 0xE0, -+0x22, 0x12, 0x3A, 0x96, 0x90, 0xA8, 0xB9, 0xE0, 0x22, 0x90, 0xA7, 0x0E, 0xE0, 0xFE, 0x54, 0x0F, -+0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x7D, 0x00, 0x22, 0x2F, 0xF5, 0x82, 0x74, 0x01, 0x3E, -+0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA6, 0x3C, 0xE0, 0x75, 0xF0, 0x08, 0x22, 0x12, 0x26, 0x1E, 0xFF, -+0x54, 0x80, 0xFE, 0x90, 0xA7, 0x0E, 0xE0, 0x54, 0x7F, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x40, 0xFF, -+0xEE, 0x54, 0xBF, 0x4F, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFE, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, -+0x4D, 0xFF, 0x90, 0xA7, 0x0E, 0xF0, 0xEE, 0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, -+0x12, 0x26, 0x1E, 0x54, 0x0F, 0xFE, 0xEF, 0x54, 0xF0, 0x4E, 0x90, 0xA7, 0x0E, 0xF1, 0xA2, 0xFF, -+0x54, 0x7F, 0x90, 0xA7, 0x10, 0xF0, 0x12, 0x4F, 0xAA, 0xFF, 0x90, 0xA7, 0x0F, 0xE0, 0x54, 0xFE, -+0x4F, 0x12, 0x4F, 0xA3, 0x90, 0xA7, 0x11, 0xF0, 0x12, 0x67, 0x86, 0x54, 0x01, 0x25, 0xE0, 0xFF, -+0x90, 0xA7, 0x0F, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xD1, 0xC9, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0xA1, -+0x45, 0x90, 0x05, 0x21, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0xA6, 0xD7, 0xE0, 0x30, 0xE0, 0x04, -+0x7F, 0x20, 0x71, 0x69, 0x22, 0x90, 0xA7, 0x0E, 0xE0, 0xFF, 0x12, 0x4F, 0xAD, 0x30, 0xE0, 0x1A, -+0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x12, 0x6F, 0xC7, 0x90, 0xA7, 0x0F, 0xE0, 0x30, 0xE0, -+0x09, 0xD1, 0xC9, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0xB1, 0x45, 0x22, 0x80, 0xD8, 0xE4, 0xFF, 0x02, -+0x60, 0x89, 0xF0, 0x90, 0x00, 0x01, 0x02, 0x26, 0x37, 0xF1, 0xA3, 0xF5, 0x0E, 0x12, 0x4F, 0xA4, -+0xF5, 0x0F, 0x12, 0x26, 0x1E, 0xF5, 0x10, 0x90, 0xA5, 0x2E, 0xF0, 0xE5, 0x0E, 0x60, 0x06, 0xFD, -+0xAF, 0x0F, 0x12, 0x6A, 0x28, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, -+0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xC6, 0xF0, 0x74, 0x77, 0xA3, 0xF0, 0x12, 0x81, 0x3D, -+0xE5, 0x69, 0x30, 0xE2, 0x02, 0xF1, 0x9B, 0xE5, 0x6C, 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, 0x73, -+0x69, 0x74, 0xC6, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x77, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, -+0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, -+0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -+0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x27, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x78, 0xFF, -+0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, -+0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x02, 0x09, 0xE0, 0xF5, 0x0E, 0x12, 0x26, -+0x1E, 0x25, 0x0E, 0x90, 0xA5, 0xE4, 0x12, 0x77, 0xA2, 0x25, 0x0E, 0x90, 0xA5, 0xE5, 0x12, 0x4F, -+0xA3, 0x25, 0x0E, 0x90, 0xA5, 0xE6, 0xF0, 0x12, 0x67, 0x86, 0x25, 0x0E, 0x90, 0xA5, 0xE7, 0xB1, -+0x08, 0x25, 0x0E, 0x90, 0xA5, 0xE8, 0xF0, 0x11, 0x9C, 0x25, 0x0E, 0x90, 0xA5, 0xE9, 0xF0, 0x90, -+0x00, 0x06, 0x12, 0x26, 0x37, 0x25, 0x0E, 0x90, 0xA5, 0xEA, 0xF0, 0x22, 0x90, 0x00, 0x05, 0x02, -+0x26, 0x37, 0x90, 0xA7, 0x31, 0xEE, 0xF0, 0xA3, 0xB1, 0x27, 0x90, 0xA7, 0x33, 0xE0, 0xB1, 0x30, -+0x7B, 0x01, 0x90, 0xA7, 0x38, 0x12, 0x4A, 0x4C, 0x90, 0xA7, 0x34, 0xE0, 0x91, 0xB1, 0xA3, 0x12, -+0x4A, 0x4C, 0x31, 0x69, 0xFF, 0xB1, 0x3D, 0x8F, 0x1C, 0xA3, 0x31, 0x71, 0xE0, 0xF5, 0x18, 0xA3, -+0xE0, 0xF5, 0x19, 0xE4, 0xF5, 0x1D, 0x90, 0xA7, 0x38, 0x12, 0x4A, 0x43, 0x75, 0xF0, 0x02, 0xE5, -+0x1D, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x49, 0xC0, 0xAE, 0xF0, 0xA8, 0x1C, 0x08, 0x80, -+0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xA7, 0x35, 0x12, 0x4A, 0x43, 0x85, -+0x1D, 0x82, 0x12, 0x55, 0xA2, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x19, 0xF5, 0x19, -+0xEE, 0x35, 0x18, 0xF5, 0x18, 0x05, 0x1D, 0xE5, 0x1D, 0xB4, 0x05, 0xBA, 0x90, 0xA7, 0x35, 0x12, -+0x4A, 0x43, 0x11, 0x9C, 0xFD, 0x7C, 0x00, 0x31, 0x69, 0xA8, 0x1C, 0x08, 0x80, 0x05, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x26, 0x98, 0x8E, 0x1A, 0x8F, 0x1B, 0xD3, 0xE5, 0x19, -+0x95, 0x1B, 0xE5, 0x18, 0x95, 0x1A, 0x40, 0x0C, 0xE5, 0x19, 0x95, 0x1B, 0xFF, 0xE5, 0x18, 0x95, -+0x1A, 0xFE, 0x80, 0x04, 0x7E, 0x00, 0x7F, 0x00, 0x8E, 0x18, 0x8F, 0x19, 0x90, 0xA7, 0x33, 0x31, -+0x71, 0xE5, 0x18, 0xF0, 0xA3, 0xE5, 0x19, 0xF0, 0x22, 0x90, 0xA7, 0x31, 0xE0, 0xFE, 0xA3, 0xE0, -+0x22, 0xE0, 0x25, 0xE0, 0x24, 0x95, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0x8F, 0x18, -+0x8D, 0x19, 0x74, 0xA6, 0x2F, 0x12, 0x5D, 0x75, 0x74, 0xFF, 0x12, 0x56, 0xF4, 0xE0, 0xF5, 0x1A, -+0x54, 0x7F, 0xF5, 0x1B, 0xE5, 0x1A, 0x54, 0x80, 0xF5, 0x1C, 0x12, 0x5F, 0xF4, 0xE0, 0xF5, 0x1E, -+0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4E, 0x5D, 0xC4, 0x54, 0x03, 0xF5, 0x1F, 0xE5, 0x1B, 0x91, 0xA2, -+0xB1, 0x1F, 0xE5, 0x18, 0x31, 0x72, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x26, 0x25, 0x18, 0x12, -+0x5F, 0x9C, 0xE5, 0x1A, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x18, 0x12, 0x4E, 0x5D, 0x13, 0x13, 0x54, -+0x03, 0xF5, 0x1D, 0x74, 0x26, 0x25, 0x18, 0xB1, 0x17, 0xE5, 0x1D, 0xF0, 0x74, 0x95, 0x25, 0x18, -+0x12, 0x66, 0xDD, 0xE0, 0x30, 0xE0, 0x1D, 0xE5, 0x1B, 0x64, 0x3F, 0x70, 0x17, 0x75, 0xF0, 0x04, -+0xE5, 0x18, 0x12, 0x4F, 0x9C, 0xC4, 0x13, 0x54, 0x07, 0x7F, 0x3E, 0x30, 0xE0, 0x02, 0x7F, 0xBE, -+0x91, 0x63, 0x61, 0x1D, 0xE5, 0x1B, 0x64, 0x2D, 0x70, 0x2F, 0x75, 0xF0, 0x04, 0xE5, 0x18, 0x12, -+0x4E, 0x5D, 0xFF, 0x54, 0x03, 0xFE, 0xE5, 0x1D, 0xC3, 0x9E, 0x50, 0x1D, 0x75, 0x1A, 0x2C, 0x05, -+0x1D, 0xE5, 0x1D, 0x12, 0x6F, 0xE5, 0xFE, 0x75, 0xF0, 0x04, 0xE5, 0x18, 0x90, 0x96, 0x18, 0x12, -+0x4A, 0x37, 0xEF, 0x54, 0xF3, 0x4E, 0xF0, 0x80, 0x08, 0xE5, 0x1B, 0xB4, 0x2C, 0x0F, 0x75, 0x1A, -+0x2D, 0x74, 0xA6, 0x25, 0x18, 0x12, 0x5D, 0x75, 0x74, 0xFF, 0xF0, 0x61, 0x18, 0xE5, 0x1B, 0xC3, -+0x95, 0x1E, 0x40, 0x02, 0x41, 0xEA, 0xAD, 0x1A, 0xAF, 0x18, 0xB1, 0x53, 0xEF, 0xF4, 0x60, 0x0B, -+0x8F, 0x1A, 0x8F, 0x1B, 0xE5, 0x1A, 0x30, 0xE7, 0x02, 0x61, 0x18, 0xAD, 0x1B, 0xAF, 0x1F, 0x91, -+0x8E, 0x8F, 0x1B, 0xAD, 0x1E, 0xAF, 0x1F, 0x91, 0x8E, 0x8F, 0x1E, 0xE5, 0x1B, 0xD3, 0x94, 0x0B, -+0x40, 0x12, 0x90, 0xA7, 0x39, 0xE5, 0x1F, 0xF0, 0xAB, 0x18, 0xE4, 0xFD, 0xAF, 0x1B, 0x71, 0x21, -+0x8F, 0x1A, 0x80, 0x0A, 0xAB, 0x18, 0xAD, 0x1E, 0xAF, 0x1B, 0x91, 0xC0, 0x8F, 0x1A, 0xAD, 0x1A, -+0xAF, 0x1F, 0x91, 0x7B, 0x8F, 0x1A, 0x74, 0xA6, 0x25, 0x18, 0x12, 0x5D, 0x75, 0xE0, 0xFD, 0xF4, -+0x60, 0x0D, 0xAF, 0x1F, 0x91, 0x7B, 0x74, 0xA6, 0x25, 0x18, 0x12, 0x5D, 0x75, 0xEF, 0xF0, 0x74, -+0x95, 0x25, 0x18, 0x12, 0x66, 0xDD, 0xE0, 0x30, 0xE0, 0x4E, 0xE5, 0x1B, 0x64, 0x3F, 0x70, 0x48, -+0x75, 0xF0, 0x04, 0xE5, 0x18, 0x12, 0x4F, 0x9C, 0xC4, 0x13, 0x54, 0x07, 0x7F, 0x3E, 0x30, 0xE0, -+0x02, 0x7F, 0xBE, 0x91, 0x63, 0x12, 0x6C, 0x03, 0x80, 0x2E, 0xE5, 0x1B, 0x65, 0x1E, 0x70, 0x1C, -+0x75, 0xF0, 0x04, 0xE5, 0x18, 0x12, 0x4F, 0x9C, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x21, 0xE5, -+0x1A, 0x20, 0xE7, 0x1C, 0xE5, 0x1B, 0x44, 0x80, 0xF5, 0x1A, 0x80, 0x0C, 0x74, 0x26, 0x25, 0x18, -+0x12, 0x5F, 0x9C, 0xE5, 0x1E, 0xF0, 0xF5, 0x1A, 0x85, 0x1D, 0x77, 0xAB, 0x19, 0x12, 0x6C, 0x03, -+0x22, 0x90, 0xA7, 0x38, 0xEB, 0xF0, 0xEF, 0x54, 0x7F, 0x24, 0xF4, 0x90, 0xA7, 0x3C, 0xF0, 0xED, -+0x70, 0x2E, 0x91, 0x73, 0x70, 0x15, 0xE0, 0x25, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x41, -+0x91, 0x4B, 0x24, 0x82, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x80, 0x41, 0xE0, 0x25, 0xE0, 0x24, 0x59, -+0xF5, 0x82, 0xE4, 0x34, 0x41, 0x91, 0x4B, 0x24, 0x5A, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x80, 0x2C, -+0x91, 0x73, 0x70, 0x15, 0xE0, 0x25, 0xE0, 0x24, 0xCD, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x91, 0x4B, -+0x24, 0xCE, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x80, 0x13, 0xE0, 0x25, 0xE0, 0x24, 0xA5, 0xF5, 0x82, -+0xE4, 0x34, 0x41, 0x91, 0x4B, 0x24, 0xA6, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0xF5, 0x83, 0xE4, 0x93, -+0xFF, 0x90, 0xA7, 0x38, 0xE0, 0xFD, 0x91, 0x2B, 0xA9, 0x07, 0x7F, 0x0C, 0x7E, 0x12, 0x7D, 0x10, -+0x90, 0xA7, 0x3A, 0xE0, 0xFC, 0xF4, 0x60, 0x2E, 0xE9, 0xF4, 0x60, 0x2A, 0xE9, 0xC3, 0x9F, 0x40, -+0x25, 0xE9, 0xD3, 0x9D, 0x50, 0x20, 0x91, 0x6B, 0x12, 0x66, 0xDD, 0xE0, 0x30, 0xE1, 0x17, 0x74, -+0xA6, 0x2D, 0x12, 0x67, 0xC5, 0xE0, 0xC3, 0x94, 0x02, 0x40, 0x0B, 0x90, 0xA7, 0x3B, 0xE9, 0xF0, -+0xA9, 0x04, 0x90, 0xA7, 0x3A, 0xF0, 0x91, 0x6B, 0x12, 0x66, 0xDD, 0xE0, 0x30, 0xE6, 0x2A, 0x74, -+0xA6, 0x2D, 0x12, 0x67, 0xC5, 0xE0, 0xC3, 0x94, 0x02, 0x40, 0x1E, 0x90, 0xA7, 0x3A, 0xE0, 0xFD, -+0xF4, 0x60, 0x16, 0xE9, 0xF4, 0x60, 0x12, 0xE9, 0x9F, 0x40, 0x0E, 0xE9, 0xD3, 0x9E, 0x50, 0x09, -+0xA3, 0xE9, 0xF0, 0xA9, 0x05, 0x90, 0xA7, 0x3A, 0xF0, 0x90, 0xA7, 0x3A, 0xE0, 0xB4, 0xFF, 0x0D, -+0xE9, 0xF0, 0x90, 0xA7, 0x38, 0x12, 0x5D, 0x72, 0x74, 0xFF, 0xF0, 0x80, 0x08, 0x90, 0xA7, 0x38, -+0x12, 0x5D, 0x72, 0xE9, 0xF0, 0x90, 0xA7, 0x3A, 0xE0, 0xFF, 0x22, 0xAC, 0x07, 0xB1, 0x00, 0x75, -+0xF0, 0x08, 0xED, 0x12, 0x61, 0x9D, 0x12, 0x5F, 0xC2, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -+0xD8, 0xF9, 0xB1, 0x0F, 0x7F, 0xFF, 0x60, 0x02, 0xAF, 0x04, 0x22, 0xF5, 0x83, 0xE4, 0x93, 0xFF, -+0x90, 0xA7, 0x38, 0xE0, 0xFD, 0x91, 0x2B, 0x90, 0xA7, 0x3A, 0xEF, 0xF0, 0x90, 0xA7, 0x3C, 0xE0, -+0x25, 0xE0, 0x22, 0x8F, 0x1A, 0x85, 0x1D, 0x77, 0xE4, 0xFB, 0x22, 0x90, 0xA7, 0x38, 0xE0, 0xFD, -+0x24, 0x95, 0x22, 0x90, 0xA7, 0x39, 0xE0, 0x90, 0xA7, 0x3C, 0x22, 0xEF, 0x60, 0x0A, 0xED, 0xD3, -+0x94, 0x0B, 0x40, 0x04, 0x7E, 0x20, 0x80, 0x02, 0xE4, 0xFE, 0xED, 0x2E, 0xFF, 0x22, 0xEF, 0x60, -+0x0A, 0xED, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0x7E, 0x20, 0x80, 0x02, 0xE4, 0xFE, 0xC3, 0xED, 0x9E, -+0xFF, 0x22, 0x25, 0xE0, 0x24, 0x41, 0xF5, 0x82, 0xE4, 0x34, 0x42, 0xF5, 0x83, 0x22, 0x8F, 0x15, -+0xEF, 0x75, 0xF0, 0x06, 0xA4, 0x24, 0x5C, 0xF9, 0x74, 0x40, 0x35, 0xF0, 0xFA, 0x7B, 0xFF, 0x22, -+0xEF, 0x04, 0xF5, 0x20, 0xE5, 0x20, 0xD3, 0x9D, 0x50, 0x33, 0xE5, 0x20, 0xB1, 0x01, 0x75, 0xF0, -+0x08, 0xEB, 0x12, 0x61, 0x9D, 0xE0, 0xF5, 0x82, 0x75, 0x83, 0x00, 0xE5, 0x20, 0x12, 0x5F, 0xC7, -+0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, -+0x82, 0x4E, 0x60, 0x05, 0x85, 0x20, 0x21, 0x80, 0x04, 0x05, 0x20, 0x80, 0xC7, 0xAF, 0x21, 0x22, -+0xEC, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x26, 0x37, 0xFF, -+0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0x22, 0xE4, -+0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x22, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x22, -+0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x01, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x22, 0x12, 0x57, 0xDC, -+0x40, 0x03, 0x7F, 0x05, 0x22, 0xD3, 0xEF, 0x94, 0xC8, 0xEE, 0x94, 0x00, 0x7F, 0x00, 0x40, 0x02, -+0x7F, 0x02, 0x22, 0x7E, 0xFF, 0xED, 0x54, 0x7F, 0xFC, 0xED, 0x54, 0x80, 0x60, 0x04, 0xAE, 0x04, -+0x80, 0x1B, 0xEC, 0x64, 0x3D, 0x60, 0x04, 0xEC, 0xB4, 0x3F, 0x12, 0x75, 0xF0, 0x04, 0xEF, 0x12, -+0x4F, 0x9C, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x04, 0xEC, 0x44, 0x80, 0xFE, 0xAF, 0x06, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x30, 0xB1, 0x27, 0x90, 0xA7, 0x17, 0xE0, -+0x90, 0x04, 0x33, 0xF0, 0x90, 0xA7, 0x18, 0xE0, 0x90, 0x04, 0x34, 0xF0, 0x90, 0xA7, 0x19, 0xE0, -+0x90, 0x04, 0x35, 0xF0, 0x90, 0xA7, 0x1A, 0xE0, 0x90, 0x04, 0x36, 0xF0, 0x90, 0xA7, 0x1B, 0xE0, -+0x90, 0x04, 0x37, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x7D, 0x10, 0xED, 0x14, 0xF9, 0x24, 0xFA, 0x12, 0x57, 0xA9, 0xE0, 0x60, 0x37, 0x7C, 0x08, 0xEC, -+0x14, 0x90, 0xA8, 0xBB, 0xF0, 0x74, 0xFA, 0x29, 0x12, 0x57, 0xA9, 0xE0, 0xFB, 0x7A, 0x00, 0x90, -+0xA8, 0xBB, 0xE0, 0x12, 0x5F, 0xC9, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xB1, -+0x0F, 0x60, 0x0F, 0xE9, 0x75, 0xF0, 0x08, 0xA4, 0xFF, 0x90, 0xA8, 0xBB, 0xE0, 0x2F, 0x04, 0xFF, -+0x80, 0x06, 0xDC, 0xCB, 0xDD, 0xBC, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x8B, 0x0E, 0x8A, -+0x0F, 0x89, 0x10, 0x12, 0x77, 0xA3, 0xFF, 0xF5, 0x12, 0x12, 0x26, 0x1E, 0xFE, 0xC3, 0x13, 0x30, -+0xE0, 0x07, 0x12, 0x4F, 0xA4, 0xF5, 0x13, 0x80, 0x02, 0x8F, 0x13, 0x85, 0x12, 0x11, 0xE5, 0x11, -+0xD3, 0x95, 0x13, 0x50, 0x24, 0xAB, 0x0E, 0xAA, 0x0F, 0xA9, 0x10, 0x12, 0x26, 0x1E, 0x54, 0x01, -+0xFD, 0xAF, 0x11, 0x12, 0x57, 0x6A, 0xAF, 0x11, 0xD1, 0x64, 0xEF, 0xAF, 0x11, 0x70, 0x04, 0xD1, -+0x5F, 0x80, 0x02, 0xD1, 0x5A, 0x05, 0x11, 0x80, 0xD5, 0x22, 0xE4, 0xFD, 0x02, 0x59, 0x0C, 0x7D, -+0x01, 0x02, 0x59, 0x0C, 0x12, 0x57, 0xE4, 0x12, 0x57, 0xA6, 0xE0, 0xFD, 0x7C, 0x00, 0x12, 0x5F, -+0xCA, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x5F, 0xD2, 0x7F, 0x00, 0x60, -+0x02, 0x7F, 0x01, 0x22, 0x12, 0x4F, 0xFC, 0x12, 0x26, 0x1E, 0x30, 0xE0, 0x12, 0xF1, 0x49, 0x90, -+0xA5, 0x2D, 0xE0, 0xB4, 0x01, 0x0B, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x02, 0xF1, -+0x16, 0x12, 0x4F, 0xB9, 0x12, 0x77, 0xA3, 0x90, 0xA6, 0xD8, 0x12, 0x4F, 0xA3, 0x90, 0xA6, 0xD9, -+0xF0, 0x90, 0xA6, 0xD8, 0xE0, 0x54, 0x01, 0x90, 0xA6, 0xE5, 0xF0, 0x90, 0xA6, 0xD8, 0xE0, 0x54, -+0x02, 0x90, 0xA6, 0xE6, 0xF0, 0x90, 0xA6, 0xD8, 0xE0, 0x54, 0x04, 0x90, 0xA6, 0xE7, 0xF0, 0x90, -+0xA6, 0xD8, 0xE0, 0x54, 0x08, 0x90, 0xA6, 0xE8, 0xF0, 0x90, 0xA6, 0xD8, 0xE0, 0x54, 0x10, 0x90, -+0xA6, 0xE9, 0xF0, 0x90, 0xA6, 0xD9, 0xE0, 0x54, 0x01, 0x90, 0xA6, 0xEA, 0xF0, 0x90, 0xA6, 0xD9, -+0xE0, 0x54, 0x02, 0x90, 0xA6, 0xEB, 0xF0, 0x90, 0xA6, 0xD9, 0xE0, 0x54, 0x04, 0x90, 0xA6, 0xEC, -+0xF0, 0x90, 0xA6, 0xD9, 0xE0, 0x54, 0x08, 0x90, 0xA6, 0xED, 0xF0, 0x90, 0xA6, 0xD9, 0xE0, 0x54, -+0x10, 0x90, 0xA6, 0xEE, 0xF0, 0x22, 0xC2, 0xAF, 0x90, 0xA6, 0xD7, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, -+0x08, 0xE4, 0xFF, 0xF1, 0x3F, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0x02, 0x09, -+0xE0, 0x90, 0x04, 0x25, 0xF0, 0xE4, 0x90, 0xA6, 0xE3, 0xF0, 0xA3, 0xF0, 0xD2, 0xAF, 0x22, 0x74, -+0x5D, 0xF1, 0x9C, 0xFE, 0xF6, 0x74, 0x30, 0x80, 0x42, 0xF1, 0xAC, 0x90, 0xA6, 0xD5, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0xA6, 0xD7, 0xE0, 0x44, 0x01, 0xF0, -+0x7D, 0x08, 0xE4, 0xFF, 0xF1, 0x7B, 0x90, 0x05, 0x52, 0xE0, 0x54, 0x07, 0x04, 0x90, 0xA6, 0xE2, -+0x12, 0x57, 0xCD, 0x90, 0x04, 0x22, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, -+0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x80, 0x04, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x74, 0x65, 0xF1, 0x9C, 0x80, 0xEB, 0x2F, 0xF8, 0xE6, 0xFE, -+0xED, 0xF4, 0x5E, 0x22, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0x4D, 0x80, 0xDB, 0x90, 0x01, 0x17, 0xE0, -+0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0x12, 0x4F, 0xB4, -+0xF1, 0xC9, 0x7A, 0xA6, 0x79, 0xEF, 0x02, 0x34, 0x2C, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, -+0x43, 0x05, 0x7B, 0x01, 0x22, 0x12, 0x4F, 0xB4, 0xF1, 0xC9, 0x7A, 0xA6, 0x79, 0xF4, 0x02, 0x34, -+0x2C, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0xA6, 0xF9, 0xF0, 0xBF, 0x01, 0x08, 0x12, 0x6B, 0x03, 0xE4, -+0x90, 0xA6, 0xF9, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x3C, 0xE0, -+0xFF, 0x90, 0xA6, 0x3B, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, -+0x41, 0x90, 0xA6, 0x3B, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0xA5, 0xEB, 0x12, 0x4A, 0x37, 0xE0, -+0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0xEC, 0xF9, 0x74, 0xA5, 0x35, 0xF0, 0xFA, 0x7B, 0x01, -+0xAF, 0x05, 0x12, 0x4D, 0xCC, 0x90, 0xA6, 0x3B, 0x12, 0x6F, 0xEC, 0xB4, 0x0A, 0x02, 0x7F, 0x01, -+0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA6, 0x3B, 0xF0, 0x12, 0x74, 0x2F, 0x90, 0xA5, 0x27, 0xE0, 0x44, -+0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0xA6, 0xD3, 0xF0, 0xA3, 0xF0, 0x90, 0xA6, -+0x3B, 0xF0, 0xA3, 0xF0, 0x22, 0xE4, 0xF5, 0x55, 0xF5, 0x56, 0xF5, 0x57, 0x75, 0x58, 0x80, 0xAD, -+0x55, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xAD, 0x56, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xAD, 0x57, 0x7F, -+0x52, 0x12, 0x3A, 0x96, 0xAD, 0x58, 0x7F, 0x53, 0x02, 0x3A, 0x96, 0x75, 0x5D, 0x12, 0xE4, 0xF5, -+0x5E, 0x75, 0x5F, 0x87, 0x75, 0x60, 0x73, 0x90, 0x01, 0x30, 0xE5, 0x5D, 0xF0, 0xA3, 0xE5, 0x5E, -+0xF0, 0xA3, 0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, 0xF0, 0x22, 0x75, 0x65, 0x06, 0x75, 0x66, 0x01, -+0x75, 0x67, 0x03, 0x75, 0x68, 0x62, 0x90, 0x01, 0x38, 0xE5, 0x65, 0xF0, 0xA3, 0xE5, 0x66, 0xF0, -+0xA3, 0xE5, 0x67, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, -+0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9C, -+0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, 0x90, -+0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, 0xF0, -+0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x29, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, -+0x90, 0x01, 0x34, 0xE0, 0x55, 0x5D, 0xF5, 0x61, 0xA3, 0xE0, 0x55, 0x5E, 0xF5, 0x62, 0xA3, 0xE0, -+0x55, 0x5F, 0xF5, 0x63, 0xA3, 0xE0, 0x55, 0x60, 0xF5, 0x64, 0x90, 0x01, 0x34, 0xE5, 0x61, 0xF0, -+0xA3, 0xE5, 0x62, 0xF0, 0xA3, 0xE5, 0x63, 0xF0, 0xA3, 0xE5, 0x64, 0xF0, 0x22, 0x90, 0x01, 0x3C, -+0xE0, 0x55, 0x65, 0xF5, 0x69, 0xA3, 0xE0, 0x55, 0x66, 0xF5, 0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, -+0x6B, 0xA3, 0xE0, 0x55, 0x68, 0xF5, 0x6C, 0x90, 0x01, 0x3C, 0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, -+0xF0, 0xA3, 0xE5, 0x6B, 0xF0, 0xA3, 0xE5, 0x6C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0x01, 0xCF, -+0xE0, 0x90, 0xA7, 0xA7, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, -+0xF0, 0xEF, 0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, -+0x20, 0xF0, 0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x50, 0x45, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, -+0xFD, 0x7F, 0x03, 0x12, 0x3A, 0x96, 0x80, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA8, 0xA4, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA8, 0xA3, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, -+0x12, 0x55, 0x58, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0xA8, 0xA3, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, -+0xA8, 0xA4, 0xE0, 0x60, 0x05, 0x51, 0x4B, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x51, 0x4B, 0x54, 0xC0, 0xF0, 0x90, -+0xA8, 0xA6, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xEF, 0xF0, 0x51, 0x40, 0xE0, 0x54, 0x01, 0xFF, 0x90, 0xA8, 0xA5, 0xE0, 0x25, 0xE0, 0x25, 0xE0, -+0xFE, 0xEF, 0x44, 0x02, 0x4E, 0xFF, 0xAE, 0x05, 0x51, 0x40, 0xEF, 0xF0, 0x74, 0x11, 0x2E, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x74, 0x29, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x74, 0x12, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x7E, 0xFF, 0x74, 0xA6, 0x2F, 0x12, 0x5D, 0x75, 0x74, -+0xFF, 0xF0, 0xED, 0xB4, 0x3E, 0x0D, 0x7E, 0xBD, 0x74, 0xA6, 0x2F, 0x12, 0x5D, 0x75, 0x74, 0x3D, -+0xF0, 0x80, 0x1D, 0xED, 0xB4, 0x3F, 0x19, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4F, 0x9C, 0xC4, 0x13, -+0x54, 0x07, 0x30, 0xE0, 0x0B, 0x7E, 0x3E, 0x74, 0xA6, 0x2F, 0x12, 0x5D, 0x75, 0x74, 0x3E, 0xF0, -+0xED, 0x14, 0xFD, 0x74, 0x26, 0x2F, 0x12, 0x5F, 0x9C, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x8F, 0x0F, -+0x8D, 0x10, 0x8B, 0x11, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4E, 0x5D, 0xC4, 0x54, 0x03, 0x90, 0xA7, -+0x28, 0xF0, 0x90, 0xA7, 0x26, 0x60, 0x09, 0x74, 0x32, 0xF0, 0xA3, 0x74, 0x2F, 0xF0, 0x80, 0x07, -+0x74, 0x11, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x12, 0x56, 0xF9, 0xE0, -+0xFD, 0x90, 0xA8, 0x4C, 0x74, 0x04, 0xF0, 0xE4, 0xFB, 0xAF, 0x0F, 0x12, 0x6B, 0xD0, 0xE5, 0x10, -+0xD3, 0x94, 0x2D, 0x40, 0x0A, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x12, 0x5F, 0xF8, 0x80, 0x20, 0xE5, -+0x10, 0xD3, 0x94, 0x1E, 0x40, 0x05, 0x90, 0xA7, 0x26, 0x80, 0x14, 0xE5, 0x10, 0xD3, 0x94, 0x14, -+0x40, 0x05, 0x90, 0xA7, 0x27, 0x80, 0x08, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x12, 0x67, 0x9D, 0xE0, -+0xFD, 0x85, 0x11, 0x77, 0xE4, 0xFB, 0xAF, 0x0F, 0x02, 0x6C, 0x07, 0xE4, 0x90, 0xA7, 0x38, 0xF0, -+0x90, 0xA7, 0x38, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x50, 0x60, 0x74, 0x36, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0xA5, 0xF5, 0x83, 0xE0, 0xFF, 0xD3, 0x94, 0x0A, 0x50, 0x02, 0x80, 0x02, 0x7F, 0x0A, 0xAE, -+0x07, 0xEF, 0x24, 0x02, 0x90, 0xA7, 0x37, 0xF0, 0x90, 0xA7, 0x29, 0x74, 0x0E, 0xF0, 0x90, 0xA7, -+0x2B, 0x74, 0x01, 0xF0, 0x71, 0x8B, 0xE0, 0x90, 0xA7, 0x2C, 0xF0, 0xE4, 0xFF, 0xEF, 0xC3, 0x9E, -+0x50, 0x17, 0x71, 0x8B, 0xE0, 0x2F, 0x71, 0x99, 0xE0, 0xFD, 0x74, 0x2D, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0xA7, 0xF5, 0x83, 0xED, 0xF0, 0x0F, 0x80, 0xE4, 0x7B, 0x01, 0x7A, 0xA7, 0x79, 0x29, 0x12, -+0x6B, 0xB1, 0x90, 0xA7, 0x38, 0xE0, 0x04, 0xF0, 0x80, 0x96, 0x22, 0x90, 0xA7, 0x38, 0xE0, 0x24, -+0x30, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0x22, 0x24, 0x90, 0xF5, 0x82, 0xE4, 0x34, 0xA5, -+0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x44, 0x75, 0xF0, 0x0A, -+0xEF, 0x90, 0x8D, 0x01, 0x12, 0x67, 0x96, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x03, 0x12, -+0x67, 0x96, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x05, 0x12, 0x67, 0x96, 0xF0, 0x75, 0xF0, -+0x0A, 0xEF, 0x90, 0x8D, 0x07, 0x12, 0x67, 0x96, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x09, -+0x12, 0x67, 0x96, 0xF0, 0xEF, 0x91, 0x04, 0x12, 0x65, 0x1E, 0x74, 0x95, 0x2F, 0x91, 0x12, 0xE4, -+0xF0, 0x12, 0x67, 0xAA, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0x12, 0x67, 0xAA, 0xEE, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0x22, 0x74, 0x95, -+0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA8, 0xB6, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x3D, 0x90, 0x00, 0x8D, -+0xE0, 0x64, 0x01, 0x70, 0x35, 0x90, 0xA8, 0xB7, 0xF0, 0x90, 0xA8, 0xB7, 0xE0, 0xFD, 0x90, 0xA8, -+0xB6, 0xE0, 0x75, 0xF0, 0x10, 0x12, 0x56, 0xF9, 0xE5, 0x82, 0x2D, 0x12, 0x61, 0xA6, 0xE0, 0xFB, -+0xE4, 0xFF, 0x12, 0x4F, 0x62, 0x90, 0xA8, 0xB7, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, -+0xD8, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x02, 0x91, 0x6F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, -+0xFD, 0x7F, 0x8D, 0x02, 0x3A, 0x96, 0x90, 0xA8, 0xBC, 0xEF, 0xF0, 0x90, 0xA5, 0x2D, 0xE0, 0xB4, -+0x02, 0x12, 0x90, 0xA8, 0xBC, 0xE0, 0xFF, 0x64, 0x01, 0x60, 0x25, 0x90, 0x01, 0x4D, 0xE0, 0x64, -+0x80, 0xF0, 0x80, 0x19, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x7F, 0x64, 0x7E, 0x00, 0x12, 0x3A, -+0xF7, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0xA8, 0xBC, 0xE0, 0xFF, 0x12, 0x76, 0x19, -+0x22, 0xE4, 0x90, 0xA7, 0x1F, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x28, 0xC3, -+0x90, 0xA7, 0x20, 0xE0, 0x94, 0xD0, 0x90, 0xA7, 0x1F, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, -+0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0xA7, 0x1F, 0x12, 0x58, 0x9E, 0x7F, 0x0A, -+0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x80, 0xD1, 0x7F, 0x01, 0x22, 0x7D, 0x07, 0xEF, 0x5D, 0xC3, 0x60, -+0x0A, 0x91, 0xFF, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x03, 0x91, 0xFF, 0xFF, 0x22, 0x74, -+0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, 0x22, 0x90, 0x04, 0x24, 0xEF, -+0xF0, 0x22, 0x90, 0xA6, 0xE2, 0xE0, 0xFD, 0x7C, 0x00, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, -+0x26, 0xAA, 0xED, 0x4C, 0x70, 0x05, 0x90, 0xA6, 0xEF, 0x80, 0x2A, 0xED, 0x64, 0x01, 0x4C, 0x70, -+0x05, 0x90, 0xA6, 0xF0, 0x80, 0x1F, 0xED, 0x64, 0x02, 0x4C, 0x70, 0x05, 0x90, 0xA6, 0xF1, 0x80, -+0x14, 0xED, 0x64, 0x03, 0x4C, 0x70, 0x05, 0x90, 0xA6, 0xF2, 0x80, 0x09, 0xED, 0x64, 0x04, 0x4C, -+0x70, 0x0D, 0x90, 0xA6, 0xF3, 0xE0, 0xFF, 0xB1, 0x0C, 0x90, 0xA6, 0xE3, 0x12, 0x58, 0x9E, 0x22, -+0x35, 0xF0, 0xFE, 0x90, 0x00, 0x06, 0x12, 0x49, 0xC0, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x22, -+0x25, 0xE0, 0x24, 0xE9, 0xF5, 0x82, 0xE4, 0x34, 0x42, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x04, 0xE5, -+0x0E, 0x90, 0x9B, 0x18, 0x12, 0x4A, 0x37, 0xE0, 0x22, 0x12, 0x4A, 0x37, 0xE0, 0xFE, 0xED, 0xFF, -+0x90, 0xA7, 0xC7, 0xE0, 0x22, 0xFC, 0xE5, 0x13, 0xC3, 0x13, 0xFE, 0xE5, 0x14, 0x13, 0xFF, 0x22, -+0x90, 0xA7, 0x2E, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0E, 0x22, 0x90, 0xA7, 0x25, 0x74, 0x0D, 0xF0, -+0x90, 0xA7, 0x33, 0x22, 0x74, 0x01, 0x93, 0x95, 0x12, 0xE4, 0x93, 0x95, 0x11, 0x22, 0xF0, 0xEE, -+0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x22, 0x90, 0xA7, 0x23, 0xE0, 0x90, 0xA7, 0x27, 0xF0, 0x22, -+0xE5, 0x6F, 0x75, 0xF0, 0x08, 0xA4, 0x25, 0x6E, 0x22, 0xFF, 0x90, 0xA8, 0xAE, 0xE0, 0xFB, 0xEF, -+0x5B, 0x22, 0x90, 0x89, 0x07, 0x12, 0x4A, 0x37, 0xE0, 0x22, 0x90, 0x89, 0x04, 0x12, 0x4A, 0x37, -+0xE0, 0x22, 0xFE, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x4F, 0x22, 0x90, 0x9B, 0x15, 0x12, 0x4A, 0x37, -+0xEF, 0x22, 0xCD, 0x85, -+}; -+u4Byte ArrayLength_MP_8812A_FW_AP = 17956; -+ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_AP( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8812A_FW_AP; -+#else -+ ODM_MoveMemory(pDM_Odm, pFirmware, Array_MP_8812A_FW_AP, ArrayLength_MP_8812A_FW_AP); -+#endif -+ *pFirmwareSize = ArrayLength_MP_8812A_FW_AP; -+} -+ -+ -+#endif /* #if (defined(CONFIG_AP_WOWLAN)||(DM_ODM_SUPPORT_TYPE & (ODM_AP)) */ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) || (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ -+ -+u1Byte Array_MP_8812A_FW_NIC[] = { -+0x01, 0x95, 0x10, 0x00, 0x29, 0x00, 0x00, 0x00, 0x06, 0x17, 0x19, 0x25, 0x38, 0x7D, 0x00, 0x00, -+0x65, 0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x4B, 0xBE, 0x02, 0x80, 0x07, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x81, 0x13, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x8F, 0xDB, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x80, 0x8A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x89, 0x01, 0x00, 0x00, -+0x00, 0x04, 0x0C, 0x00, 0x00, 0x00, 0x04, 0x08, 0x08, 0x00, 0x00, 0x00, 0x0A, 0x08, 0x03, 0x03, -+0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, 0x04, 0x08, 0x05, -+0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, 0x04, 0x00, 0x08, -+0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, 0x0A, 0x03, 0x02, -+0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, 0x10, 0x24, 0x22, -+0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, 0x06, 0x00, 0x20, -+0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, 0x21, 0x0C, 0x04, -+0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, 0x20, 0x21, 0x1F, -+0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, 0x10, 0x00, 0x30, -+0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, 0x28, 0x14, 0x00, -+0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, 0x30, 0x15, 0xF0, -+0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, 0x00, 0x00, -+0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, -+0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, -+0xFF, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x3F, 0x00, 0x00, -+0x00, 0x00, 0x15, 0xF0, 0xCF, 0xFF, 0x00, 0x00, 0x00, 0x16, 0x0D, 0x17, 0x0E, 0x17, 0x0F, 0x18, -+0x10, 0x19, 0x11, 0x1A, 0x12, 0x1A, 0x13, 0x1A, 0x14, 0x1A, 0x15, 0x1B, 0xFF, 0x17, 0x0E, 0x18, -+0x10, 0x19, 0x11, 0x1A, 0x12, 0x1B, 0x15, 0x1C, 0xFF, 0x1D, 0xFF, 0x1E, 0xFF, 0x1F, 0xFF, 0xFF, -+0xFF, 0x14, 0x0D, 0x0E, 0x15, 0x15, 0x0F, 0x16, 0x10, 0x17, 0x11, 0x18, 0x12, 0x18, 0x13, 0x18, -+0xFF, 0x15, 0x0D, 0x16, 0x10, 0x10, 0x17, 0x18, 0x12, 0x19, 0xFF, 0x1A, 0xFF, 0x1B, 0xFF, 0xFF, -+0xFF, 0x00, 0x00, 0x00, 0x00, 0x04, 0x04, 0x0C, 0x0C, 0x0D, 0x0C, 0x0E, 0x0D, 0x0F, 0x17, 0x18, -+0x10, 0x19, 0x11, 0x19, 0x11, 0x19, 0x12, 0x1A, 0x14, 0x0C, 0x0C, 0x16, 0x0D, 0x17, 0x0F, 0x18, -+0x10, 0x19, 0x13, 0x1A, 0x14, 0x1B, 0x15, 0x1C, 0x1B, 0x1D, 0x1C, 0x1E, 0x1D, 0x04, 0x04, 0x0C, -+0x14, 0x0D, 0x14, 0x0E, 0x14, 0x0F, 0x15, 0x10, 0x16, 0x17, 0x11, 0x12, 0x17, 0x0C, 0x0C, 0x14, -+0x0E, 0x15, 0x0F, 0x16, 0x10, 0x17, 0x12, 0x18, 0x18, 0x19, 0x19, 0x1A, 0x19, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, 0x25, 0x27, -+0x28, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, -+0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, -+0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, -+0x00, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, 0x2A, 0x2A, -+0x2A, 0x00, 0x04, 0x00, 0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, -+0x48, 0x00, 0x60, 0x00, 0x90, 0x00, 0xC0, 0x00, 0xD8, 0x00, 0x3C, 0x00, 0x64, 0x00, 0x78, 0x00, -+0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, 0x90, 0x01, 0xE0, 0x00, 0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, -+0x90, 0x02, 0x58, 0x03, 0x20, 0x04, 0xB0, 0x06, 0x40, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, -+0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, -+0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x64, 0x00, -+0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, 0x90, 0x01, 0x90, 0x02, 0x58, 0x03, 0x20, 0x00, 0x78, 0x00, -+0xF0, 0x01, 0x90, 0x02, 0x58, 0x03, 0xE8, 0x07, 0xD0, 0x09, 0x60, 0x0F, 0xA0, 0x12, 0xC0, 0x15, -+0x18, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, -+0xD0, 0x07, 0xD0, 0x07, 0xD0, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, -+0xB0, 0x06, 0x40, 0x07, 0xD0, 0x07, 0xD0, 0x07, 0xD0, 0x00, 0x02, 0x00, 0x02, 0x00, 0x04, 0x00, -+0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x48, 0x00, 0x60, 0x00, -+0x6C, 0x00, 0x14, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x00, -+0xF0, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x01, 0x2C, 0x01, 0x90, 0x02, 0x58, 0x03, -+0x20, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, -+0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, -+0xE8, 0x00, 0x1E, 0x00, 0x28, 0x00, 0x32, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x00, -+0xF0, 0x01, 0x7C, 0x01, 0x90, 0x00, 0x3C, 0x00, 0x78, 0x00, 0xC8, 0x01, 0x2C, 0x01, 0xF4, 0x03, -+0xE8, 0x04, 0xB0, 0x07, 0xD0, 0x09, 0x60, 0x0A, 0xF0, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, -+0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x00, 0x64, 0x00, -+0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, -+0xE8, 0x02, 0x04, 0x06, 0x08, 0x0A, 0x0C, 0x10, 0x18, 0x20, 0x30, 0x40, 0x50, 0x01, 0x01, 0x01, -+0x02, 0x01, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, 0x05, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0B, 0x05, 0x06, 0x06, -+0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, -+0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x01, 0x02, 0x03, -+0x04, 0x05, 0x06, 0x07, 0x08, 0x02, 0x04, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x03, 0x05, 0x06, -+0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x02, 0x04, 0x06, -+0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x03, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, -+0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, -+0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, 0x04, 0x0C, 0x14, 0x2C, -+0x36, 0x04, 0x08, 0x08, 0x08, 0x0A, 0x0A, 0x04, 0x04, 0x04, 0x05, 0x04, 0x04, 0x05, 0x07, 0x07, -+0x07, 0x08, 0x0A, 0x04, 0x07, 0x0A, 0x0E, 0x11, 0x13, 0x14, 0x15, 0x03, 0x04, 0x07, 0x07, 0x08, -+0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, -+0x0B, 0x0D, 0x0F, 0x07, 0x08, 0x08, 0x0A, 0x0A, 0x0C, 0x0E, 0x10, 0x11, 0x11, 0x07, 0x09, 0x09, -+0x0B, 0x0B, 0x0D, 0x0F, 0x13, 0x13, 0x14, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, -+0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, -+0x07, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x05, 0x06, 0x07, 0x0D, 0x10, 0x11, 0x12, 0x12, 0x07, -+0x08, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, -+0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x05, 0x06, 0x08, 0x09, 0x0C, 0x0E, 0x12, 0x12, 0x13, -+0x14, 0x07, 0x08, 0x09, 0x0A, 0x0C, 0x0F, 0x12, 0x12, 0x14, 0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, -+0x0E, 0x11, 0x13, 0x13, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x0C, -+0x00, 0x0C, 0x94, 0x0C, 0x88, 0x0C, 0x8C, 0x0C, 0xE8, 0x0C, 0x10, 0x0D, 0x00, 0x0C, 0x90, 0x0C, -+0xC4, 0x0C, 0xC8, 0x0C, 0xCC, 0x0C, 0xD4, 0x0C, 0x80, 0x0C, 0x84, 0x0C, 0xB8, 0x0E, 0x00, 0x0E, -+0x94, 0x0E, 0x88, 0x0E, 0x8C, 0x0E, 0xE8, 0x0E, 0x10, 0x0D, 0x40, 0x0E, 0x90, 0x0E, 0xC4, 0x0E, -+0xC8, 0x0E, 0xCC, 0x0E, 0xD4, 0x0E, 0x80, 0x0E, 0x84, 0x0E, 0xB8, 0x05, 0x22, 0x05, 0x50, 0x05, -+0x51, 0x08, 0x08, 0x0A, 0x04, 0x09, 0x0C, 0x0C, 0x00, 0x0E, 0x00, 0x08, 0x38, 0x08, 0x2C, 0x0C, -+0x5C, 0x0C, 0x60, 0x0C, 0x64, 0x0C, 0x68, 0x0C, 0xB0, 0x0C, 0xB4, 0x0E, 0x5C, 0x0E, 0x60, 0x0E, -+0x64, 0x0E, 0x68, 0x0E, 0xB0, 0x0E, 0xB4, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, -+0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, -+0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, -+0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, -+0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, -+0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, -+0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, -+0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, -+0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, -+0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, -+0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, -+0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, -+0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, -+0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, -+0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, -+0x82, 0x23, 0x90, 0x46, 0x30, 0x73, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, -+0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, 0x22, 0xBB, 0x01, 0x0A, 0x89, -+0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE0, 0x22, 0x50, 0x06, 0x87, 0xF0, 0x09, 0xE7, 0x19, -+0x22, 0xBB, 0xFE, 0x07, 0xE3, 0xF5, 0xF0, 0x09, 0xE3, 0x19, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xE4, -+0x93, 0xF5, 0xF0, 0x74, 0x01, 0x93, 0x22, 0xBB, 0x01, 0x10, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, -+0x83, 0x3A, 0xF5, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE0, 0x22, 0x50, 0x09, 0xE9, 0x25, 0x82, 0xF8, -+0x86, 0xF0, 0x08, 0xE6, 0x22, 0xBB, 0xFE, 0x0A, 0xE9, 0x25, 0x82, 0xF8, 0xE2, 0xF5, 0xF0, 0x08, -+0xE2, 0x22, 0xE5, 0x83, 0x2A, 0xF5, 0x83, 0xE9, 0x93, 0xF5, 0xF0, 0xA3, 0xE9, 0x93, 0x22, 0xEF, -+0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, 0xFF, -+0xEE, 0x9A, 0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, -+0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, -+0xEC, 0x48, 0xFC, 0x22, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, -+0xEC, 0x64, 0x80, 0xC8, 0x64, 0x80, 0x98, 0x45, 0xF0, 0x22, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, -+0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, 0xE8, 0x9C, 0x45, 0xF0, 0x22, 0xE8, 0x60, 0x10, 0xEC, 0xA2, -+0xE7, 0x13, 0xFC, 0xED, 0x13, 0xFD, 0xEE, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xD8, 0xF0, 0x22, 0xBB, -+0x01, 0x07, 0x89, 0x82, 0x8A, 0x83, 0x02, 0x48, 0x4D, 0x50, 0x05, 0xE9, 0xF8, 0x02, 0x48, 0xD5, -+0xBB, 0xFE, 0x05, 0xE9, 0xF8, 0x02, 0x48, 0xE1, 0x89, 0x82, 0x8A, 0x83, 0x02, 0x48, 0xED, 0xBB, -+0x01, 0x0D, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0x02, 0x48, 0x4D, 0x50, -+0x07, 0xE9, 0x25, 0x82, 0xF8, 0x02, 0x48, 0xD5, 0xBB, 0xFE, 0x07, 0xE9, 0x25, 0x82, 0xF8, 0x02, -+0x48, 0xE1, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0x02, 0x48, 0xED, 0xBB, -+0x01, 0x07, 0x89, 0x82, 0x8A, 0x83, 0x02, 0x27, 0x48, 0x50, 0x05, 0xE9, 0xF8, 0x02, 0x48, 0xFD, -+0xBB, 0xFE, 0x05, 0xE9, 0xF8, 0x02, 0x49, 0x09, 0x22, 0xBB, 0x01, 0x0D, 0xE5, 0x82, 0x29, 0xF5, -+0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0x02, 0x27, 0x48, 0x50, 0x07, 0xE9, 0x25, 0x82, 0xF8, 0x02, -+0x48, 0xFD, 0xBB, 0xFE, 0x07, 0xE9, 0x25, 0x82, 0xF8, 0x02, 0x49, 0x09, 0x22, 0xE0, 0xFC, 0xA3, -+0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, -+0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, -+0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, -+0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, -+0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, -+0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0xEF, 0x4E, 0x60, 0x12, 0xEF, 0x60, 0x01, -+0x0E, 0xED, 0xBB, 0x01, 0x0B, 0x89, 0x82, 0x8A, 0x83, 0xF0, 0xA3, 0xDF, 0xFC, 0xDE, 0xFA, 0x22, -+0x89, 0xF0, 0x50, 0x07, 0xF7, 0x09, 0xDF, 0xFC, 0xA9, 0xF0, 0x22, 0xBB, 0xFE, 0xFC, 0xF3, 0x09, -+0xDF, 0xFC, 0xA9, 0xF0, 0x22, 0xE6, 0xFC, 0x08, 0xE6, 0xFD, 0x08, 0xE6, 0xFE, 0x08, 0xE6, 0xFF, -+0x22, 0xE2, 0xFC, 0x08, 0xE2, 0xFD, 0x08, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x22, 0xE4, 0x93, 0xFC, -+0x74, 0x01, 0x93, 0xFD, 0x74, 0x02, 0x93, 0xFE, 0x74, 0x03, 0x93, 0xFF, 0x22, 0xEC, 0xF6, 0x08, -+0xED, 0xF6, 0x08, 0xEE, 0xF6, 0x08, 0xEF, 0xF6, 0x22, 0xEC, 0xF2, 0x08, 0xED, 0xF2, 0x08, 0xEE, -+0xF2, 0x08, 0xEF, 0xF2, 0x22, 0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x49, 0x19, 0x85, 0xD0, 0x0B, -+0x75, 0xD0, 0x08, 0xAA, 0xE0, 0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, -+0x79, 0xF5, 0x8C, 0xD2, 0x8C, 0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, -+0x95, 0x81, 0xB4, 0x40, 0x00, 0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, -+0xC2, 0xAF, 0xE6, 0x30, 0xE1, 0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, -+0xD0, 0x22, 0xE5, 0x0C, 0xFF, 0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, -+0x00, 0x78, 0x81, 0xE6, 0x30, 0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, -+0x74, 0x86, 0x25, 0x0C, 0xF8, 0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, -+0x74, 0xFF, 0xCD, 0xF8, 0xE8, 0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, -+0xD3, 0x9F, 0x40, 0x27, 0xE5, 0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, -+0xFF, 0xFD, 0x18, 0xE6, 0xCD, 0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, -+0xF5, 0xE5, 0x0C, 0x24, 0x86, 0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, -+0xF8, 0x7F, 0x04, 0xC2, 0xAF, 0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, -+0x07, 0x30, 0xE3, 0x04, 0x7F, 0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, -+0x07, 0x22, 0x78, 0x86, 0xA6, 0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, -+0x7F, 0x03, 0xE4, 0x78, 0x80, 0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, -+0x4C, 0x78, 0x74, 0x01, 0x93, 0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, -+0x60, 0x75, 0x8C, 0x79, 0xD2, 0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, -+0x7F, 0xFF, 0x22, 0x74, 0x81, 0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, -+0x30, 0xF6, 0xD2, 0xAF, 0xAE, 0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, -+0xE6, 0xF9, 0x08, 0xE6, 0x18, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, -+0xE7, 0x19, 0x19, 0xF7, 0x09, 0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, -+0x04, 0x05, 0x81, 0x05, 0x81, 0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, -+0xF9, 0xEE, 0xB5, 0x0C, 0x02, 0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, -+0x19, 0x19, 0xE7, 0x09, 0x09, 0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, -+0xE6, 0x04, 0xF8, 0xEF, 0x2F, 0x04, 0x90, 0x4C, 0x78, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, -+0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, -+0xF8, 0xE6, 0x30, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, -+0x07, 0x0A, 0x74, 0x86, 0x2F, 0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x49, 0x62, 0x50, 0x2E, 0x74, 0x87, -+0x2F, 0xF8, 0xE6, 0xBF, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, -+0xFB, 0xE6, 0xFC, 0xE9, 0x6C, 0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, -+0x03, 0xA6, 0x05, 0x1F, 0xE5, 0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, -+0xE6, 0xFD, 0x18, 0x86, 0x01, 0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, -+0x0C, 0xB5, 0x07, 0x02, 0xAC, 0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, -+0x80, 0xF4, 0xE5, 0x0C, 0xB5, 0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, -+0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, -+0x30, 0xE0, 0x02, 0xD2, 0xE4, 0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, -+0x02, 0x49, 0x61, 0x8F, 0xF0, 0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, -+0x30, 0xF7, 0x0D, 0x7F, 0x08, 0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, 0x2E, 0x80, 0x07, -+0x30, 0xF1, 0x06, 0xED, 0xF6, 0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, -+0x10, 0xE7, 0x23, 0x0E, 0x30, 0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, 0xC2, 0xAF, 0xE6, -+0x10, 0xE7, 0x13, 0x54, 0xEC, 0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x49, 0x62, 0x7F, 0x08, 0x08, 0xEF, -+0x44, 0x83, 0xF4, 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0x02, 0x4B, -+0xFC, 0x02, 0x49, 0xF2, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, -+0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, -+0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, -+0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x4C, 0x41, 0xE4, -+0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, -+0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, -+0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, -+0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, -+0xBE, 0x41, 0xA6, 0x79, 0x00, 0x41, 0xA6, 0x7A, 0x00, 0x60, 0x26, 0xA5, 0xB0, 0x01, 0x02, 0x03, -+0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x24, 0x28, 0x2C, 0x30, 0x34, -+0x38, 0x3C, 0x40, 0x64, 0x68, 0x6C, 0x70, 0x74, 0x78, 0x7C, 0x80, 0x84, 0x88, 0x8C, 0x95, 0x99, -+0x9D, 0xA1, 0xA5, 0x41, 0xA6, 0x90, 0x00, 0x00, 0x57, 0xFF, 0x5F, 0xF8, 0x67, 0xED, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0xA4, 0x3C, 0xF0, 0x90, 0xA4, 0x41, 0xF0, 0x90, 0xA4, -+0x3F, 0xF0, 0xB1, 0xDE, 0x40, 0x02, 0xA1, 0x20, 0xC3, 0x74, 0xFD, 0xB1, 0xE7, 0x7A, 0xA4, 0x79, -+0x3B, 0x12, 0x33, 0xC7, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xA1, 0x7C, 0x90, 0xA4, 0x3B, 0xE0, 0xFF, -+0x54, 0xC0, 0xFE, 0x60, 0x05, 0xEF, 0x54, 0x0C, 0x70, 0x1C, 0x90, 0xA4, 0x3B, 0xE0, 0xFF, 0x54, -+0x30, 0x60, 0x05, 0xEF, 0x54, 0x03, 0x70, 0x08, 0x90, 0xA4, 0x3F, 0xE0, 0x60, 0x4A, 0x80, 0x00, -+0x90, 0xA4, 0x3C, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x3C, 0xE0, 0x90, 0xA4, 0x3B, 0x70, 0x17, 0xE0, -+0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA4, 0x3D, 0xF0, 0xEF, 0x54, 0x0C, 0x13, 0x13, -+0x54, 0x3F, 0xA3, 0xF0, 0x80, 0x10, 0xE0, 0xFF, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0xA4, 0x3D, -+0xF0, 0xEF, 0x54, 0x03, 0xA3, 0xF0, 0x90, 0xA4, 0x3D, 0xE0, 0x90, 0xA4, 0x37, 0xF0, 0x90, 0xA4, -+0x3E, 0xE0, 0x90, 0xA4, 0x38, 0xF0, 0x80, 0x08, 0x90, 0xA4, 0x3F, 0xE0, 0x04, 0xF0, 0x81, 0x92, -+0xE4, 0x90, 0xA4, 0x3F, 0xF0, 0xB1, 0xDE, 0x50, 0x63, 0xC3, 0x74, 0xFB, 0xB1, 0xE7, 0x7A, 0xA4, -+0x79, 0x40, 0x12, 0x33, 0xC7, 0xEF, 0x64, 0x01, 0x70, 0x42, 0x90, 0xA4, 0x40, 0xE0, 0xFF, 0x54, -+0xE0, 0xFE, 0x70, 0x13, 0xEF, 0x54, 0x0E, 0x70, 0x08, 0x90, 0xA4, 0x3F, 0xE0, 0x60, 0x35, 0x80, -+0x00, 0x90, 0xA4, 0x41, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x41, 0xE0, 0x70, 0x09, 0xEE, 0xC4, 0x13, -+0x54, 0x07, 0xA3, 0xF0, 0x80, 0x0C, 0x90, 0xA4, 0x40, 0xE0, 0x54, 0x0E, 0xC3, 0x13, 0x90, 0xA4, -+0x42, 0xF0, 0x90, 0xA4, 0x42, 0xE0, 0x90, 0xA4, 0x39, 0xF0, 0x80, 0x10, 0x90, 0xA4, 0x43, 0x74, -+0x01, 0xF0, 0x80, 0x40, 0x90, 0xA4, 0x3F, 0xE0, 0x04, 0xF0, 0x80, 0x99, 0x90, 0xA4, 0x38, 0xE0, -+0x25, 0xE0, 0x25, 0xE0, 0x54, 0x0C, 0xFF, 0x90, 0xA4, 0x37, 0xE0, 0x54, 0x03, 0x4F, 0xFF, 0x90, -+0xA4, 0x39, 0xE0, 0xFE, 0xC4, 0x54, 0x70, 0x4F, 0x44, 0x80, 0xFD, 0x7F, 0x8B, 0x12, 0x3A, 0x96, -+0x90, 0xA4, 0x37, 0xE0, 0x60, 0x08, 0xA3, 0xE0, 0x60, 0x04, 0xA3, 0xE0, 0x70, 0x1B, 0x90, 0xA4, -+0x43, 0x74, 0x03, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0x7E, 0xF0, 0x74, 0x4C, 0xA3, 0xF0, 0x90, 0xA4, -+0x43, 0xE0, 0x90, 0x01, 0xC8, 0xB1, 0xF1, 0x80, 0xEB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA4, -+0x3F, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x22, 0x9F, 0xFF, 0x74, 0x03, 0x94, 0x00, 0xFE, 0x7B, 0x01, -+0x22, 0xF0, 0xE4, 0xFD, 0x7F, 0x1F, 0x02, 0x3A, 0x96, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA4, 0x4D, 0xEF, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0xF9, 0xF0, 0x74, -+0x4D, 0xA3, 0xF0, 0x90, 0xA4, 0x4E, 0xE0, 0x90, 0x01, 0xC8, 0xF0, 0x90, 0xA4, 0x4D, 0xE0, 0x90, -+0x01, 0xC9, 0xB1, 0xF1, 0x80, 0xE3, 0xF1, 0xA3, 0x54, 0x7F, 0xF5, 0x0E, 0xF1, 0xE8, 0xFF, 0x54, -+0x1F, 0xF5, 0x10, 0xF1, 0x6C, 0xF5, 0x0F, 0xF1, 0x2D, 0xFF, 0x54, 0x03, 0xF5, 0x11, 0xEF, 0x54, -+0x30, 0xC4, 0x54, 0x0F, 0xF5, 0x14, 0xF1, 0x2D, 0xFF, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0xF5, 0x12, 0xF1, 0x6C, 0xF5, 0x13, 0xF1, 0x2D, 0xFF, 0x54, 0x08, 0xFE, 0x13, 0x13, 0x13, 0x54, -+0x1F, 0xF5, 0x16, 0xEF, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xF5, 0x17, 0x90, 0xA4, 0x38, 0xE0, -+0xB4, 0x02, 0x08, 0xE5, 0x14, 0x60, 0x04, 0xE4, 0xFF, 0xB1, 0xF9, 0x90, 0xA4, 0x39, 0xE0, 0xB4, -+0x01, 0x11, 0xF1, 0x33, 0x12, 0x90, 0x54, 0x54, 0xF0, 0x70, 0x04, 0xF1, 0xEF, 0x60, 0x04, 0x7F, -+0x01, 0xB1, 0xF9, 0xE5, 0x13, 0x12, 0xBC, 0xB2, 0xF1, 0x1E, 0x54, 0x7F, 0x4F, 0xF0, 0xE5, 0x12, -+0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0xF1, 0x1E, 0x54, 0xBF, 0x4F, 0xF0, 0xE5, 0x16, 0x70, -+0x6C, 0xE5, 0x10, 0x54, 0x1F, 0xF1, 0xAB, 0x54, 0xE0, 0x4F, 0xF0, 0xE5, 0x11, 0x54, 0x03, 0xF1, -+0x1E, 0x54, 0xFC, 0x4F, 0xF0, 0xEF, 0x25, 0xE0, 0x25, 0xE0, 0xF1, 0x1E, 0x54, 0xF3, 0x4F, 0xF0, -+0xE5, 0x0F, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0xF1, 0xAB, 0x54, 0xDF, 0x4F, 0xF0, 0xE5, 0x14, -+0x54, 0x03, 0xC4, 0x54, 0xF0, 0xF1, 0x1E, 0x54, 0xCF, 0x4F, 0xF0, 0xE4, 0xF5, 0x15, 0xE5, 0x15, -+0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0xF1, 0x33, 0x8F, 0x82, 0x8E, 0x83, 0x12, 0x26, 0x37, 0xFF, -+0x75, 0xF0, 0x08, 0xE5, 0x0E, 0x12, 0x54, 0x7C, 0xE5, 0x82, 0x25, 0x15, 0x12, 0x52, 0x41, 0xEF, -+0xF0, 0x05, 0x15, 0xE5, 0x15, 0xB4, 0x04, 0xD6, 0xAF, 0x0E, 0x12, 0x52, 0x49, 0x22, 0xFF, 0x75, -+0xF0, 0x04, 0xE5, 0x0E, 0x90, 0x96, 0x14, 0x11, 0x65, 0xE0, 0x22, 0x4F, 0xF0, 0x90, 0x00, 0x02, -+0x02, 0x26, 0x37, 0x90, 0xA4, 0x4A, 0x01, 0x71, 0xF1, 0xA3, 0xFF, 0xF1, 0x33, 0xF1, 0x2D, 0x90, -+0xA6, 0x5A, 0xF0, 0xE4, 0xFB, 0xFD, 0x12, 0xA3, 0xF1, 0x90, 0xA4, 0x4D, 0x74, 0x10, 0xF0, 0x90, -+0xA4, 0x5B, 0x74, 0x07, 0xF0, 0xF1, 0x33, 0x12, 0x26, 0x1E, 0x90, 0xA4, 0x4F, 0xF0, 0x7B, 0x01, -+0x7A, 0xA4, 0x79, 0x4D, 0x12, 0x7B, 0xB9, 0x7F, 0x04, 0x02, 0x7D, 0xC3, 0xEF, 0x54, 0x80, 0xC4, -+0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0xF1, 0xB8, 0xF1, 0x2D, 0x30, 0xE0, 0x10, 0xF1, 0x33, 0xF1, -+0xF5, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x4C, 0x02, 0x34, 0x2C, 0x90, 0xA3, 0x4C, -+0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, -+0x07, 0xF0, 0x22, 0x90, 0xA4, 0x4A, 0x11, 0x7A, 0x02, 0x26, 0x1E, 0xFF, 0x75, 0xF0, 0x04, 0xE5, -+0x0E, 0x90, 0x96, 0x13, 0x11, 0x65, 0xE0, 0x22, 0x90, 0xA4, 0x4A, 0x01, 0x7A, 0xF1, 0xB8, 0x90, -+0x04, 0x24, 0xE0, 0xF5, 0x0E, 0xE4, 0xFF, 0xF1, 0x33, 0x8F, 0x82, 0xF1, 0xE1, 0x25, 0x0E, 0xFE, -+0x75, 0xF0, 0x0E, 0xEF, 0x90, 0xA3, 0x64, 0x11, 0x65, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x03, 0xE7, -+0x22, 0x75, 0x83, 0x00, 0x02, 0x26, 0x37, 0xF0, 0x90, 0x00, 0x01, 0x02, 0x26, 0x37, 0xF0, 0x90, -+0x00, 0x06, 0x02, 0x26, 0x37, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x22, 0x90, 0x00, 0xF0, 0xE0, -+0x7F, 0x01, 0x20, 0xE2, 0x02, 0x7F, 0x03, 0x22, 0x12, 0x4F, 0xFC, 0x90, 0xA1, 0x29, 0xEF, 0xF0, -+0x11, 0x1B, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x02, 0x35, 0x95, 0x11, 0x40, 0x11, 0x70, 0x12, -+0x98, 0xF0, 0x12, 0x99, 0x0F, 0x12, 0x98, 0xCA, 0xE4, 0xF5, 0x51, 0x75, 0x52, 0x58, 0xAB, 0x51, -+0x7D, 0x02, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x52, 0x7D, 0x03, 0x7F, 0x01, 0x02, 0x39, 0x04, -+0x90, 0x01, 0x30, 0xE4, 0x11, 0x68, 0x90, 0x01, 0x38, 0x11, 0x68, 0xFD, 0x7F, 0x50, 0x12, 0x3A, -+0x96, 0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xE4, -+0xFD, 0x7F, 0x53, 0x02, 0x3A, 0x96, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, -+0x90, 0x01, 0x34, 0x74, 0xFF, 0x11, 0x68, 0x90, 0x01, 0x3C, 0x11, 0x68, 0xFD, 0x7F, 0x54, 0x12, -+0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x3A, 0x96, -+0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x3A, 0x96, 0x90, 0xA4, 0x2F, 0x74, 0xFF, 0xF0, 0xE4, 0x11, 0x69, -+0xA3, 0xE0, 0x54, 0xFC, 0x44, 0x02, 0xF0, 0xE4, 0x80, 0xBF, 0xF1, 0xA3, 0x12, 0x98, 0xBC, 0x11, -+0xBC, 0x12, 0xB7, 0xFF, 0x12, 0x65, 0x33, 0x12, 0xA3, 0x6A, 0x80, 0xDB, 0x75, 0x40, 0xFF, 0x75, -+0x41, 0x44, 0x75, 0x42, 0x4B, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x2C, 0xF1, 0x72, -+0x75, 0x41, 0x44, 0x75, 0x42, 0x51, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x32, 0xF1, -+0x72, 0x75, 0x41, 0x44, 0x75, 0x42, 0x57, 0x75, 0x43, 0x54, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x38, -+0xF1, 0x72, 0x75, 0x41, 0x44, 0x75, 0x42, 0xAB, 0x75, 0x43, 0x54, 0x7B, 0x01, 0x7A, 0xA1, 0x79, -+0x8C, 0x12, 0x34, 0x2C, 0xE4, 0xF5, 0x0D, 0xE4, 0xFF, 0x74, 0x91, 0x25, 0x0D, 0xD1, 0x01, 0xE0, -+0x54, 0xFE, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0D, 0x90, 0x81, 0x00, 0xBF, 0x03, 0x07, 0x51, 0x3B, -+0x74, 0x80, 0xF0, 0x80, 0x04, 0x51, 0x3B, 0xE4, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x0D, 0x51, 0x38, -+0xE4, 0xF0, 0x0F, 0xBF, 0x10, 0xD3, 0x05, 0x0D, 0xE5, 0x0D, 0xB4, 0x80, 0xCA, 0xE4, 0x90, 0xAF, -+0x7D, 0xF0, 0xF5, 0x0D, 0xE4, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x0D, 0xF1, 0x92, 0xF0, 0x0F, 0xBF, -+0x05, 0xF4, 0x75, 0xF0, 0x04, 0xE5, 0x0D, 0x12, 0x6F, 0x47, 0xE0, 0x54, 0x07, 0xF0, 0x74, 0x22, -+0x25, 0x0D, 0x12, 0xBB, 0xD1, 0x74, 0x3F, 0xF0, 0x74, 0x21, 0x25, 0x0D, 0x12, 0x6F, 0x52, 0xE4, -+0xF0, 0x74, 0x01, 0x25, 0x0D, 0x12, 0x6F, 0x2F, 0x74, 0xC0, 0xF0, 0x74, 0xA2, 0x25, 0x0D, 0xF1, -+0x8A, 0xE4, 0xF0, 0xE5, 0x0D, 0x12, 0x88, 0xEE, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x91, 0x25, 0x0D, -+0x12, 0x88, 0x6E, 0x51, 0x28, 0xF1, 0x7E, 0x74, 0x3F, 0x51, 0x29, 0xF1, 0x6C, 0x51, 0x28, 0x12, -+0x4F, 0xB1, 0x54, 0xE0, 0x44, 0x09, 0x51, 0x29, 0x12, 0x4F, 0x24, 0x54, 0xF3, 0x51, 0x29, 0x12, -+0x4F, 0x24, 0x54, 0xFC, 0x51, 0x29, 0x12, 0x4F, 0xB1, 0x44, 0x20, 0x51, 0x29, 0x12, 0x4F, 0x24, -+0x54, 0xCF, 0x51, 0x29, 0x12, 0x4F, 0x24, 0x44, 0x40, 0x51, 0x29, 0x12, 0x4F, 0x24, 0x54, 0x7F, -+0x51, 0x29, 0xF1, 0x6C, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x0D, 0x12, 0x6F, 0x69, 0xEF, 0xF0, -+0x74, 0x91, 0x25, 0x0D, 0xD1, 0x01, 0xE4, 0xF0, 0x05, 0x0D, 0xE5, 0x0D, 0x64, 0x80, 0x60, 0x02, -+0x21, 0x44, 0x90, 0x04, 0x49, 0x74, 0xF0, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, -+0xA4, 0x3E, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, -+0x04, 0xF0, 0xE4, 0xFB, 0xFD, 0xFF, 0x12, 0xA2, 0x59, 0x74, 0x11, 0x25, 0x0D, 0xF5, 0x82, 0xE4, -+0x34, 0x99, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x22, 0xE4, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0D, 0x22, -+0xFF, 0x90, 0xA6, 0x70, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x48, 0x65, 0xE5, 0x82, -+0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA6, 0x70, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0x12, 0x4F, 0xB1, 0x54, 0x1F, 0xF5, 0x73, 0x60, -+0x15, 0x64, 0x02, 0x60, 0x11, 0xE5, 0x73, 0x64, 0x04, 0x60, 0x0B, 0xE5, 0x73, 0x64, 0x09, 0x60, -+0x05, 0xE5, 0x73, 0xB4, 0x0C, 0x07, 0xF1, 0x84, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xF1, 0x84, 0x74, -+0x01, 0xF0, 0xE4, 0xF5, 0x6E, 0x90, 0xA6, 0x70, 0xE0, 0xFE, 0x91, 0x79, 0xE5, 0x82, 0x25, 0x6E, -+0x51, 0x41, 0xE0, 0xFF, 0xE5, 0x73, 0x75, 0xF0, 0x07, 0xA4, 0x24, 0xFE, 0xF5, 0x82, 0xE4, 0x34, -+0x40, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x6E, 0x51, 0x41, 0xE4, 0x93, 0xFD, 0xEF, 0x5D, 0x90, 0xA6, -+0x72, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x12, 0x4F, 0x24, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0B, 0xE5, -+0x6E, 0x70, 0x07, 0x90, 0xA6, 0x72, 0xE0, 0x54, 0xF0, 0xF0, 0x90, 0xA6, 0x72, 0xE0, 0xFF, 0x91, -+0x75, 0xE5, 0x82, 0x25, 0x6E, 0x51, 0x41, 0xEF, 0xF0, 0x05, 0x6E, 0xE5, 0x6E, 0x64, 0x07, 0x70, -+0xA4, 0x90, 0xA6, 0x70, 0xE0, 0x75, 0xF0, 0x04, 0x12, 0x4F, 0x24, 0xFF, 0xC4, 0x54, 0x03, 0xFD, -+0xE4, 0xF5, 0x71, 0x75, 0x6F, 0x06, 0xE5, 0x6F, 0xB4, 0x06, 0x07, 0x51, 0x30, 0xE0, 0x54, 0x0F, -+0x80, 0x09, 0x91, 0x75, 0xE5, 0x82, 0x25, 0x6F, 0x51, 0x41, 0xE0, 0x90, 0xA6, 0x71, 0xF0, 0x90, -+0xA6, 0x71, 0xE0, 0x60, 0x32, 0x75, 0x6E, 0x07, 0xF1, 0xDD, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0x12, 0xBC, 0xC4, 0x60, 0x16, 0xF1, 0xED, 0xF5, 0x71, 0xED, 0x60, 0x25, 0xE5, -+0x71, 0xD3, 0x94, 0x0B, 0x40, 0x1E, 0x74, 0x20, 0x25, 0x71, 0xF5, 0x71, 0x80, 0x16, 0x15, 0x6E, -+0xE5, 0x6E, 0xC3, 0x94, 0x00, 0x50, 0xD1, 0xE5, 0x6F, 0x60, 0x09, 0x15, 0x6F, 0xE5, 0x6F, 0xC3, -+0x94, 0x00, 0x50, 0xA2, 0xE4, 0xF5, 0x72, 0xF5, 0x6F, 0xE5, 0x6F, 0xB4, 0x06, 0x07, 0x51, 0x30, -+0xE0, 0x54, 0x0F, 0x80, 0x09, 0x91, 0x75, 0xE5, 0x82, 0x25, 0x6F, 0x51, 0x41, 0xE0, 0x90, 0xA6, -+0x71, 0xF0, 0x90, 0xA6, 0x71, 0xE0, 0x60, 0x30, 0xE4, 0xF5, 0x6E, 0xF1, 0xDD, 0x80, 0x05, 0xC3, -+0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0xBC, 0xC4, 0x60, 0x16, 0xF1, 0xED, 0xF5, 0x72, 0xED, -+0x60, 0x1E, 0xE5, 0x72, 0xD3, 0x94, 0x0B, 0x40, 0x17, 0x74, 0x20, 0x25, 0x72, 0xF5, 0x72, 0x80, -+0x0F, 0x05, 0x6E, 0xE5, 0x6E, 0xB4, 0x08, 0xD3, 0x05, 0x6F, 0xE5, 0x6F, 0x64, 0x07, 0x70, 0xA9, -+0x90, 0xA6, 0x70, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xF1, 0x7E, 0xE5, 0x71, 0xF0, 0x75, 0xF0, 0x04, -+0xEF, 0xF1, 0x6C, 0xE5, 0x72, 0x12, 0x6F, 0x64, 0xE0, 0xFF, 0x54, 0x7F, 0xF5, 0x70, 0xEF, 0x54, -+0x80, 0xFF, 0xE5, 0x70, 0xD3, 0x95, 0x71, 0x40, 0x04, 0xE5, 0x71, 0x80, 0x09, 0xE5, 0x70, 0xC3, -+0x95, 0x72, 0x50, 0x05, 0xE5, 0x72, 0x4F, 0xF5, 0x70, 0x90, 0xA6, 0x70, 0xE0, 0xFF, 0x24, 0x22, -+0x12, 0xBB, 0xD1, 0xE5, 0x70, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4F, 0x24, 0x12, 0x84, 0xBF, -+0x90, 0xA6, 0x70, 0xE0, 0xFF, 0xE4, 0xFB, 0xAD, 0x70, 0x12, 0x83, 0x1D, 0x90, 0xA6, 0x70, 0xE0, -+0xFF, 0x75, 0xF0, 0x10, 0x12, 0x88, 0xDA, 0xE4, 0xF0, 0xE5, 0x71, 0xC3, 0x94, 0x36, 0x40, 0x07, -+0x91, 0x6A, 0x74, 0x05, 0xF0, 0x80, 0x3E, 0xE5, 0x71, 0xC3, 0x94, 0x2C, 0x40, 0x07, 0x91, 0x6A, -+0x74, 0x04, 0xF0, 0x80, 0x30, 0xE5, 0x71, 0xC3, 0x94, 0x14, 0x40, 0x07, 0x91, 0x6A, 0x74, 0x03, -+0xF0, 0x80, 0x22, 0xE5, 0x71, 0xC3, 0x94, 0x0C, 0x40, 0x07, 0x91, 0x6A, 0x74, 0x02, 0xF0, 0x80, -+0x14, 0xE5, 0x71, 0xC3, 0x94, 0x04, 0x74, 0x91, 0x40, 0x07, 0x91, 0x6C, 0x74, 0x01, 0xF0, 0x80, -+0x04, 0x91, 0x6C, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x91, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x95, 0xF5, 0x83, 0x22, 0x90, 0xA6, 0x70, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x02, -+0x48, 0x65, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x00, 0x8F, 0xE0, 0x20, 0xE6, 0x02, -+0xA1, 0xBF, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0xA6, 0x67, 0xF0, 0x90, 0x00, 0x8D, 0xE0, 0x90, 0xA6, -+0x68, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0xA6, 0x69, 0xF0, 0x90, 0xA6, 0x68, 0xE0, 0x24, 0xFC, -+0x60, 0x16, 0x24, 0xEE, 0x70, 0x02, 0xA1, 0x7A, 0x24, 0x15, 0x60, 0x02, 0xA1, 0xB5, 0x90, 0xA6, -+0x67, 0xE0, 0xFF, 0x12, 0xA3, 0x0E, 0xA1, 0xB5, 0x90, 0xA6, 0x67, 0xE0, 0x24, 0x11, 0x12, 0x6D, -+0x68, 0xFB, 0xE4, 0xFD, 0xFF, 0xB1, 0xF5, 0x75, 0xF0, 0x04, 0x12, 0x4F, 0x24, 0x13, 0x13, 0x54, -+0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0xB1, 0xF5, 0x75, 0xF0, 0x04, 0x12, 0x4F, 0x24, 0x12, 0x4F, 0x6F, -+0xFB, 0x0D, 0xE4, 0xFF, 0xB1, 0xF5, 0x75, 0xF0, 0x04, 0x12, 0x4F, 0x24, 0xC4, 0x54, 0x03, 0xFB, -+0x0D, 0xE4, 0xFF, 0xB1, 0xF5, 0x75, 0xF0, 0x04, 0xF1, 0x7E, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xB1, -+0xF5, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x12, 0xB1, 0xEF, 0x75, 0xF0, 0x04, 0x12, 0x4F, 0xB1, 0xC4, -+0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0xB1, 0xF5, 0x75, 0xF0, 0x04, 0x12, 0x4F, 0xB1, 0x54, -+0x1F, 0xB1, 0xF3, 0x91, 0x79, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xB1, 0xF5, 0x75, 0xF0, 0x08, 0x90, -+0x89, 0x01, 0xB1, 0xEF, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0xB1, 0xEF, 0x75, 0xF0, 0x08, 0x90, -+0x89, 0x03, 0xB1, 0xEF, 0x75, 0xF0, 0x08, 0x12, 0x7F, 0xB0, 0xFB, 0xE4, 0xFD, 0x0F, 0xB1, 0xF5, -+0x75, 0xF0, 0x08, 0x90, 0x89, 0x05, 0xB1, 0xEF, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x06, 0xB1, 0xEF, -+0x75, 0xF0, 0x08, 0x12, 0x7F, 0xA8, 0xFB, 0x0D, 0x80, 0x39, 0x90, 0xA4, 0x2F, 0xE0, 0xFB, 0xE4, -+0xFD, 0xFF, 0xB1, 0xC7, 0x90, 0xA4, 0x30, 0xA3, 0xB1, 0xC4, 0x90, 0xA4, 0x32, 0xB1, 0xC4, 0x90, -+0xA4, 0x33, 0xE0, 0x54, 0x03, 0xFB, 0x0D, 0xB1, 0xC7, 0x90, 0xA4, 0x34, 0xA3, 0xE0, 0xFB, 0xE4, -+0xFD, 0x0F, 0xB1, 0xC7, 0x90, 0xA4, 0x34, 0xE0, 0xFB, 0x0D, 0xB1, 0xC7, 0x90, 0xA4, 0x36, 0xE0, -+0xFB, 0x1D, 0x0F, 0xB1, 0xC7, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x03, 0x12, 0xA3, 0x63, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFB, 0x0D, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, -+0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, -+0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0x12, -+0x48, 0x65, 0xE0, 0xFB, 0x0D, 0xB1, 0xC7, 0x90, 0xA6, 0x67, 0xE0, 0x22, 0xF0, 0x74, 0x91, 0x25, -+0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x22, 0x12, 0x4F, 0xA3, 0xF5, 0x0E, 0x24, 0x91, -+0xD1, 0x01, 0xE0, 0x54, 0x98, 0xB1, 0xFC, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x5E, 0x54, 0x01, 0xFE, -+0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xB1, 0xFC, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x5E, 0x54, 0x02, -+0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xB1, 0xFC, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x5E, 0x54, -+0x04, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xB1, 0xFC, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x5E, -+0x54, 0x40, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xB1, 0xFC, 0xC0, 0x83, 0xC0, 0x82, 0xF1, -+0x5E, 0x54, 0x20, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xE5, 0x0E, 0x70, 0x08, 0xF1, -+0x66, 0x54, 0x04, 0x90, 0x04, 0xAB, 0xF0, 0xE5, 0x0E, 0xC3, 0x94, 0x80, 0x50, 0x11, 0x12, 0x4F, -+0x2D, 0xFF, 0x74, 0x11, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEF, 0xF0, 0xB1, -+0xFD, 0xE0, 0x30, 0xE5, 0x11, 0x12, 0x4F, 0x1F, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x12, 0x6D, 0x64, -+0xFD, 0xAF, 0x0E, 0x12, 0xA1, 0x99, 0x22, 0x90, 0xA4, 0x47, 0x12, 0x48, 0x7A, 0x90, 0xA4, 0x46, -+0xEF, 0xF0, 0x12, 0x48, 0x83, 0x56, 0xEF, 0x00, 0x56, 0xF4, 0x01, 0x56, 0xF9, 0x10, 0x56, 0xFE, -+0x11, 0x57, 0x03, 0x12, 0x57, 0x08, 0x14, 0x57, 0x0D, 0x20, 0x57, 0x12, 0x21, 0x57, 0x17, 0x23, -+0x57, 0x1C, 0x24, 0x57, 0x21, 0x25, 0x57, 0x26, 0x40, 0x57, 0x39, 0x41, 0x57, 0x2B, 0x42, 0x57, -+0x3E, 0x45, 0x57, 0x2F, 0x47, 0x57, 0x34, 0x49, 0x57, 0x43, 0x87, 0x00, 0x00, 0x57, 0x48, 0xF1, -+0x58, 0x02, 0x90, 0x0C, 0xF1, 0x58, 0x02, 0x8C, 0xF9, 0xF1, 0x58, 0x02, 0x4F, 0xBD, 0xF1, 0x58, -+0x02, 0x5B, 0xFA, 0xF1, 0x58, 0x02, 0x97, 0xD1, 0xF1, 0x58, 0x02, 0x97, 0xE5, 0xF1, 0x58, 0x02, -+0x97, 0xF4, 0xF1, 0x58, 0x02, 0x4F, 0x76, 0xF1, 0x58, 0x02, 0x98, 0x48, 0xF1, 0x58, 0x02, 0x62, -+0xC8, 0xF1, 0x58, 0x02, 0x98, 0x50, 0xF1, 0x58, 0x02, 0x4E, 0x26, 0xF1, 0x58, 0xC1, 0x09, 0xF1, -+0x58, 0x02, 0xA2, 0xAD, 0xF1, 0x58, 0x02, 0xA2, 0xF0, 0xF1, 0x58, 0x02, 0x79, 0x8B, 0xF1, 0x58, -+0x02, 0x7F, 0x10, 0xF1, 0x58, 0x02, 0x4F, 0x38, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, -+0xA4, 0x46, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, 0xA4, 0x47, 0x02, 0x48, 0x71, 0xE0, 0xFF, -+0x90, 0xA4, 0x4A, 0x12, 0x48, 0x71, 0x90, 0x00, 0x03, 0x02, 0x26, 0x37, 0x90, 0x96, 0x12, 0x02, -+0x48, 0x65, 0x12, 0x34, 0x2C, 0x75, 0x40, 0xFF, 0x22, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, -+0x11, 0x02, 0x48, 0x65, 0x90, 0xA6, 0x70, 0xE0, 0x24, 0xA2, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, -+0x83, 0x22, 0x90, 0x8D, 0x01, 0x12, 0x48, 0x65, 0x75, 0xF0, 0x02, 0xEF, 0x12, 0x48, 0x65, 0xE4, -+0xF0, 0xA3, 0x22, 0xE4, 0xFD, 0xFF, 0x12, 0xBC, 0x4E, 0xED, 0x70, 0x13, 0x12, 0x8F, 0x20, 0xC0, -+0x83, 0xC0, 0x82, 0xF1, 0xE5, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0x80, 0x10, 0x12, -+0x8F, 0x20, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0xE5, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0xD0, -+0x82, 0xD0, 0x83, 0xF0, 0x12, 0x8F, 0x2B, 0x90, 0xA2, 0xE4, 0xEF, 0xF0, 0x22, 0x74, 0x01, 0x7E, -+0x00, 0xA8, 0x6E, 0x08, 0x22, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, 0xE5, 0x6F, 0x75, -+0xF0, 0x08, 0xA4, 0x25, 0x6E, 0x22, 0x81, 0x82, 0x75, 0xE8, 0x03, 0x75, 0xA8, 0x85, 0x22, 0x90, -+0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, 0x12, 0x99, 0x2E, 0x12, 0x3A, -+0xB8, 0x12, 0x99, 0x3B, 0x12, 0x99, 0x8A, 0x7F, 0x01, 0x12, 0x4A, 0x2A, 0x90, 0xA3, 0x53, 0x74, -+0x02, 0xF0, 0xFF, 0x12, 0x4A, 0x2A, 0x90, 0xA3, 0x53, 0xE0, 0x04, 0xF0, 0x12, 0x50, 0x08, 0x12, -+0x50, 0xAA, 0x90, 0x01, 0xCC, 0x74, 0x0F, 0xF0, 0x12, 0x4C, 0x7E, 0x90, 0x00, 0x80, 0xE0, 0x44, -+0x40, 0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, 0x75, 0x28, 0xFF, 0x12, 0x57, 0xF8, 0x11, 0x57, 0x12, -+0x99, 0x91, 0xE4, 0xFF, 0x02, 0x4A, 0xB3, 0xE4, 0x90, 0xA4, 0x3B, 0xF0, 0xA3, 0xF0, 0x90, 0x01, -+0x98, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x3C, 0xC3, 0x90, -+0xA4, 0x3C, 0xE0, 0x94, 0x88, 0x90, 0xA4, 0x3B, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, -+0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1E, 0x90, 0xA4, 0x3B, 0x11, -+0xB1, 0x12, 0x78, 0x5F, 0xD3, 0x90, 0xA4, 0x3C, 0xE0, 0x94, 0x32, 0x90, 0xA4, 0x3B, 0xE0, 0x94, -+0x00, 0x40, 0xBB, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB4, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, -+0x22, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x46, 0xD6, 0xE4, 0x90, 0xA6, 0x76, 0xF1, 0xF0, 0x90, 0xA6, -+0x78, 0xF0, 0x90, 0x04, 0x2D, 0xE0, 0x54, 0x01, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x36, 0xC3, -+0x90, 0xA6, 0x77, 0xE0, 0x94, 0xD0, 0x90, 0xA6, 0x76, 0xE0, 0x94, 0x07, 0x50, 0x27, 0x90, 0xA4, -+0x2F, 0xE0, 0xB4, 0xFF, 0x0C, 0x7D, 0x18, 0x7F, 0xFF, 0x31, 0x6E, 0xE4, 0x90, 0xA4, 0x36, 0xF0, -+0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA6, -+0x76, 0x11, 0xB1, 0x80, 0xC4, 0x90, 0xA4, 0x2F, 0xE0, 0xFF, 0x90, 0xA6, 0x4E, 0x74, 0x05, 0xF0, -+0x7B, 0x18, 0x7D, 0x01, 0xB1, 0xBF, 0xAB, 0x07, 0xAA, 0x06, 0x74, 0x28, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xB4, 0x54, 0x03, 0x12, 0xB7, 0xDC, 0x74, 0x14, 0x2B, 0x12, 0xBA, -+0xE4, 0xE0, 0xC4, 0x13, 0x54, 0x03, 0xFF, 0x90, 0xA4, 0x33, 0xE0, 0x54, 0xFC, 0x4F, 0xF0, 0x90, -+0xA6, 0x78, 0xE0, 0x54, 0x6F, 0xFF, 0x7D, 0x19, 0x31, 0x6E, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, -+0x90, 0xA4, 0x34, 0x11, 0xB1, 0x90, 0xA4, 0x36, 0x74, 0x01, 0xF0, 0x22, 0x90, 0xA3, 0x64, 0x12, -+0x48, 0x65, 0xE0, 0xFF, 0x7E, 0x00, 0xE4, 0xFB, 0xFD, 0x31, 0x79, 0xE4, 0xFD, 0xFF, 0x90, 0x05, -+0x22, 0xEF, 0xF0, 0x90, 0xA1, 0x27, 0xED, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA6, 0x1D, 0x12, 0x7F, 0xCB, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x24, 0x90, 0x05, 0x22, 0xE0, -+0x90, 0xA6, 0x23, 0xF0, 0x7D, 0x14, 0x31, 0xBA, 0xEF, 0x64, 0x01, 0x70, 0x04, 0xD1, 0x8F, 0x80, -+0x04, 0x7F, 0x00, 0x80, 0x10, 0x90, 0xA6, 0x23, 0xE0, 0xFF, 0x7D, 0x15, 0x31, 0x6E, 0x80, 0x02, -+0xD1, 0x8F, 0x12, 0xBC, 0xA9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0xFF, 0x31, 0x6E, 0xE4, 0x90, -+0xA6, 0x6D, 0xF1, 0xF0, 0x90, 0xA6, 0x6F, 0xF0, 0x7D, 0x47, 0x7F, 0xFF, 0x31, 0x6E, 0x90, 0x05, -+0xF8, 0xE0, 0x70, 0x11, 0xA3, 0xE0, 0x70, 0x0D, 0xA3, 0xE0, 0x70, 0x09, 0xA3, 0xE0, 0x70, 0x05, -+0xF1, 0x77, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0xA6, 0x6E, 0xE0, 0x94, 0xE8, 0x90, 0xA6, 0x6D, 0xE0, -+0x94, 0x03, 0x40, 0x0C, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0xF1, 0x77, 0x7F, 0x00, 0x22, -+0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA6, 0x6D, 0x11, 0xB1, 0x80, 0xC0, 0x8F, 0x11, -+0x7D, 0x17, 0x31, 0xBA, 0x75, 0xF0, 0x0E, 0xE5, 0x11, 0xF1, 0xC4, 0xE0, 0xFC, 0x75, 0xF0, 0x0E, -+0xE5, 0x11, 0x71, 0x8C, 0xFE, 0x54, 0x03, 0xFD, 0xEE, 0x13, 0x13, 0x54, 0x07, 0xFB, 0x90, 0xA3, -+0x55, 0xE0, 0xFE, 0x12, 0xBD, 0x1E, 0xAF, 0x04, 0x12, 0xA3, 0xF1, 0x75, 0xF0, 0x0E, 0xE5, 0x11, -+0x71, 0x8C, 0xFE, 0x54, 0x03, 0xFF, 0xEE, 0xC4, 0x13, 0x54, 0x07, 0xFD, 0x75, 0xF0, 0x0E, 0xE5, -+0x11, 0x71, 0x8C, 0x12, 0xA7, 0x09, 0x75, 0xF0, 0x0E, 0xE5, 0x11, 0x31, 0x5C, 0xAD, 0x11, 0x7F, -+0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x53, 0x12, 0xAD, 0x7A, 0x90, 0xA6, -+0x55, 0xE0, 0xFF, 0xC3, 0x94, 0x03, 0x40, 0x02, 0x61, 0x00, 0x90, 0xA6, 0x54, 0xE0, 0xFE, 0xF1, -+0x6E, 0x75, 0xF0, 0x03, 0xEF, 0x12, 0xBC, 0x36, 0xE0, 0x90, 0xA6, 0x56, 0xF0, 0x90, 0xA6, 0x53, -+0xE0, 0xFC, 0xB4, 0x02, 0x23, 0x90, 0xA6, 0x56, 0xE0, 0xFD, 0x75, 0xF0, 0x0E, 0xEE, 0xB1, 0xB9, -+0xC0, 0x83, 0xC0, 0x82, 0x90, 0xA6, 0x55, 0xE0, 0xD0, 0x82, 0xD0, 0x83, 0x12, 0x84, 0xED, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4D, 0x80, 0x23, 0xEC, 0xB4, 0x01, 0x23, 0x12, 0xBC, 0x84, 0x75, -+0xF0, 0x0E, 0xB1, 0xB9, 0xC0, 0x83, 0xC0, 0x82, 0x90, 0xA6, 0x55, 0xE0, 0xD0, 0x82, 0xD0, 0x83, -+0x12, 0x84, 0xED, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0xA6, 0x56, 0xF0, 0x12, -+0xBC, 0x84, 0xF1, 0x6E, 0xC0, 0x83, 0xC0, 0x82, 0x90, 0xA6, 0x55, 0xE0, 0xD0, 0x82, 0xD0, 0x83, -+0x75, 0xF0, 0x03, 0x12, 0xBC, 0x36, 0xEF, 0xF0, 0x90, 0xA6, 0x55, 0xE0, 0x04, 0xF0, 0x41, 0x6E, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA3, 0x55, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, 0xEF, 0x54, 0xF1, -+0xFF, 0xEE, 0x04, 0x54, 0x07, 0x25, 0xE0, 0x4F, 0xF0, 0xA3, 0xE0, 0xFF, 0x12, 0xBC, 0x7A, 0xB5, -+0x07, 0x04, 0xEE, 0x54, 0xF1, 0xF0, 0x71, 0x95, 0x12, 0xBB, 0x94, 0x12, 0x6F, 0xF8, 0xE4, 0x90, -+0xA3, 0x57, 0xF0, 0x31, 0xBE, 0x12, 0xBC, 0x7A, 0xF1, 0xC0, 0xE0, 0xFA, 0x75, 0xF0, 0x0E, 0xED, -+0x71, 0x8C, 0xFC, 0x54, 0x03, 0xFD, 0xEC, 0x13, 0x13, 0x54, 0x07, 0xFB, 0xEE, 0x12, 0xBD, 0x1E, -+0xAF, 0x02, 0x12, 0xA3, 0xF1, 0x71, 0x95, 0xFE, 0x75, 0xF0, 0x0E, 0x71, 0x8C, 0xFD, 0x54, 0x03, -+0xFF, 0xED, 0xC4, 0x13, 0x54, 0x07, 0xFD, 0x71, 0x88, 0x12, 0xA7, 0x09, 0x71, 0x95, 0xFF, 0x75, -+0xF0, 0x0E, 0x90, 0xA3, 0x63, 0x12, 0x48, 0x65, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x0E, 0xEF, 0x31, -+0x5C, 0x71, 0x95, 0xFD, 0x7F, 0x01, 0x41, 0x61, 0x75, 0xF0, 0x0E, 0xEE, 0x90, 0xA3, 0x59, 0x12, -+0x48, 0x65, 0xE0, 0x22, 0xF0, 0x90, 0xA3, 0x55, 0xE0, 0xC3, 0x13, 0x54, 0x07, 0x22, 0x90, 0xA3, -+0x54, 0xE0, 0x30, 0xE0, 0x54, 0x90, 0xA3, 0x57, 0xE0, 0x70, 0x24, 0x7D, 0x16, 0xF1, 0xBA, 0x71, -+0x95, 0x75, 0xF0, 0x0E, 0x12, 0xBB, 0xF7, 0x31, 0x79, 0x71, 0x95, 0x12, 0x9B, 0xC6, 0xE0, 0x44, -+0x01, 0xF0, 0x12, 0xBC, 0xBB, 0x12, 0x6F, 0xF8, 0x90, 0xA3, 0x57, 0x74, 0x01, 0xF0, 0x22, 0x90, -+0xA3, 0x57, 0xE0, 0x64, 0x01, 0x70, 0x20, 0x71, 0x95, 0x12, 0x9B, 0xC5, 0xE0, 0x30, 0xE0, 0x17, -+0x75, 0xF0, 0x0E, 0xEF, 0x12, 0xBB, 0xF7, 0x31, 0x79, 0x12, 0xBC, 0xBB, 0xF0, 0xE4, 0xFB, 0xFD, -+0x7F, 0x54, 0x7E, 0x01, 0x02, 0x70, 0x00, 0x71, 0x05, 0x22, 0x12, 0xBC, 0xA2, 0x12, 0x26, 0x1E, -+0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x0F, 0x17, 0x90, 0xA3, 0x54, 0xE0, 0x54, 0xFE, 0xF0, 0x12, 0x8A, -+0x05, 0x91, 0xC8, 0x12, 0x26, 0x1E, 0x54, 0x0F, 0xFF, 0x51, 0x0E, 0x02, 0xA3, 0x6A, 0x91, 0xC8, -+0x12, 0x4F, 0xE8, 0x12, 0xBD, 0x2E, 0xF1, 0xC0, 0xEF, 0x12, 0x4F, 0x2C, 0x54, 0x03, 0xFF, 0x75, -+0xF0, 0x0E, 0xED, 0x71, 0x8C, 0x54, 0xFC, 0x12, 0x4F, 0x2B, 0x54, 0x1C, 0xFF, 0xEE, 0x54, 0x0F, -+0xFE, 0x75, 0xF0, 0x0E, 0x71, 0x8C, 0x54, 0xE3, 0x12, 0x4F, 0x2B, 0x54, 0xE0, 0xFF, 0x71, 0x88, -+0x54, 0x1F, 0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0x12, 0xBC, 0xE7, 0xE4, 0xFB, 0x91, -+0xC6, 0x12, 0x90, 0x54, 0x12, 0xBC, 0xE7, 0x7B, 0x01, 0x91, 0xC6, 0x12, 0x57, 0x66, 0x33, 0x33, -+0x33, 0x54, 0xF8, 0x12, 0xBD, 0x2E, 0xFD, 0x75, 0xF0, 0x0E, 0x90, 0xA3, 0x61, 0x12, 0x48, 0x65, -+0xEF, 0xF0, 0x12, 0x57, 0x66, 0xC4, 0x13, 0x54, 0x07, 0xFF, 0x75, 0xF0, 0x0E, 0xED, 0x90, 0xA3, -+0x62, 0x12, 0x48, 0x65, 0xEF, 0xF0, 0xEE, 0xC4, 0x54, 0x0F, 0xFF, 0x14, 0x6D, 0x70, 0x26, 0x90, -+0xA3, 0x56, 0xEF, 0x12, 0x4F, 0xEE, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0x90, 0xA3, 0x55, 0xE0, -+0x54, 0x0F, 0x4F, 0xF0, 0x54, 0xF1, 0xF0, 0x90, 0xA3, 0x54, 0xE0, 0x44, 0x01, 0xF0, 0x7D, 0x20, -+0xE4, 0xFF, 0x12, 0x8B, 0x75, 0x22, 0x91, 0xCF, 0xAB, 0x0E, 0xAA, 0x0F, 0xA9, 0x10, 0x22, 0x8F, -+0x11, 0x8D, 0x12, 0xAE, 0x03, 0x74, 0x1F, 0xC3, 0x95, 0x11, 0x40, 0x0F, 0x90, 0xA4, 0x4E, 0xEE, -+0xF0, 0xAB, 0x12, 0xE4, 0xFD, 0xB1, 0xAD, 0x24, 0xD4, 0x80, 0x40, 0x74, 0x3F, 0xC3, 0x95, 0x11, -+0x40, 0x0F, 0x90, 0xA4, 0x4E, 0xEE, 0xF0, 0xAB, 0x12, 0x7D, 0x20, 0xB1, 0xAB, 0x24, 0x88, 0x80, -+0x2A, 0x74, 0x5F, 0xC3, 0x95, 0x11, 0x40, 0x0F, 0x90, 0xA4, 0x4E, 0xEE, 0xF0, 0xAB, 0x12, 0x7D, -+0x40, 0xB1, 0xAB, 0x24, 0xD0, 0x80, 0x14, 0x74, 0x7F, 0xC3, 0x95, 0x11, 0x40, 0x25, 0x90, 0xA4, -+0x4E, 0xEE, 0xF0, 0xAB, 0x12, 0x7D, 0x60, 0xB1, 0xAB, 0x24, 0x84, 0xFD, 0xE4, 0x34, 0x04, 0xFC, -+0x75, 0xF0, 0x0E, 0xE5, 0x12, 0xF1, 0x71, 0x75, 0xF0, 0x03, 0xEE, 0x12, 0x48, 0x65, 0xEC, 0xF0, -+0xA3, 0xED, 0xF0, 0x22, 0xC3, 0xEF, 0x9D, 0xF5, 0x13, 0xC3, 0x94, 0x08, 0x50, 0x1C, 0xE4, 0xF5, -+0x14, 0xB1, 0xB5, 0xC0, 0x83, 0xC0, 0x82, 0x90, 0xA4, 0x4E, 0xE0, 0xD0, 0x82, 0xD0, 0x83, 0x75, -+0xF0, 0x03, 0x12, 0x48, 0x65, 0xE5, 0x13, 0xF0, 0x80, 0x3E, 0xE5, 0x13, 0xC3, 0x94, 0x10, 0x50, -+0x09, 0x75, 0x14, 0x01, 0xE5, 0x13, 0x24, 0xF8, 0x80, 0x17, 0xE5, 0x13, 0xC3, 0x94, 0x18, 0x50, -+0x09, 0x75, 0x14, 0x02, 0xE5, 0x13, 0x24, 0xF0, 0x80, 0x07, 0x75, 0x14, 0x03, 0xE5, 0x13, 0x24, -+0xE8, 0xFF, 0xB1, 0xB5, 0xC0, 0x83, 0xC0, 0x82, 0x90, 0xA4, 0x4E, 0xE0, 0xD0, 0x82, 0xD0, 0x83, -+0x75, 0xF0, 0x03, 0x12, 0x48, 0x65, 0xEF, 0xF0, 0xAF, 0x14, 0x22, 0xAF, 0x11, 0xB1, 0x44, 0x90, -+0xA4, 0x4A, 0xEF, 0xF0, 0x22, 0x75, 0xF0, 0x0E, 0xEB, 0x90, 0xA3, 0x5C, 0x02, 0x48, 0x65, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x4C, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA6, -+0x4B, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xBB, 0x76, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0xA6, 0x4B, -+0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0xA6, 0x4C, 0xE0, 0x60, 0x06, 0x12, 0xBC, 0x42, 0x44, 0x80, -+0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, -+0xF0, 0x12, 0xBC, 0x42, 0x54, 0xC0, 0xF0, 0x90, 0xA6, 0x4E, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x18, -+0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x12, 0xBA, 0xF8, 0xE0, 0x54, 0x01, -+0xFF, 0x90, 0xA6, 0x4D, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x44, 0x02, 0x4E, 0xFF, 0xAE, -+0x05, 0x12, 0xBA, 0xF8, 0xEF, 0xF0, 0x74, 0x11, 0x2E, 0x12, 0xBB, 0x03, 0x74, 0xFF, 0xF0, 0x74, -+0x29, 0x2E, 0xF1, 0x83, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x63, 0xEF, 0xF0, 0x90, 0x04, 0x1D, 0xE0, -+0x60, 0x1E, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA6, 0x66, 0xF0, 0x7D, 0x29, 0x31, 0xBA, 0xBF, 0x01, -+0x04, 0xF1, 0x99, 0xD1, 0xC1, 0x90, 0xA6, 0x66, 0xE0, 0xFF, 0x7D, 0x2A, 0x31, 0x6E, 0x80, 0x04, -+0xF1, 0x99, 0xD1, 0xC1, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0xA6, 0x1D, 0xA3, 0xE0, 0xFF, 0x90, 0xA6, 0x4E, 0x74, 0x03, 0xF0, 0x7B, 0x06, 0x7D, 0x01, 0xB1, -+0xBF, 0x90, 0xA6, 0x21, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA6, 0x20, 0xE0, 0xFF, -+0x74, 0x10, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0xA6, 0x1F, 0xE0, -+0xFF, 0xF1, 0x8D, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x0A, 0xF1, 0x80, 0x44, 0x10, 0xF1, 0x8C, 0x44, -+0x80, 0xF0, 0x22, 0xF1, 0x80, 0x54, 0xEF, 0xF1, 0x8C, 0x44, 0x40, 0xF0, 0x22, 0x7D, 0x08, 0xE4, -+0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x3A, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, -+0x90, 0xA1, 0x25, 0xE0, 0x04, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x2E, 0x90, 0x05, 0x22, 0xE0, -+0x90, 0xA6, 0x3E, 0xF0, 0x7D, 0x26, 0x31, 0xBA, 0xEF, 0x64, 0x01, 0x70, 0x0F, 0xF1, 0x44, 0x20, -+0xE0, 0x0A, 0x90, 0xA3, 0x54, 0xE0, 0x20, 0xE0, 0x03, 0x12, 0xBA, 0x7E, 0x90, 0xA6, 0x3E, 0xE0, -+0xFF, 0x7D, 0x27, 0x31, 0x6E, 0x12, 0xBB, 0x0B, 0x80, 0x12, 0x12, 0xBB, 0x0B, 0xF1, 0x44, 0x20, -+0xE0, 0x0A, 0x90, 0xA3, 0x54, 0xE0, 0x20, 0xE0, 0x03, 0x12, 0xBA, 0x7E, 0x12, 0xBC, 0xA9, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0xE2, 0xE0, 0xFF, 0x90, 0xA6, 0x3B, 0xE0, 0xFB, 0x90, 0xA6, -+0x4E, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0xB1, 0xBF, 0x90, 0xA6, 0x3C, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, -+0xF0, 0xFD, 0x90, 0xA6, 0x3A, 0xE0, 0xFF, 0xD1, 0xC1, 0x90, 0xA3, 0x55, 0xE0, 0x22, 0x75, 0xF0, -+0x0E, 0x90, 0xA3, 0x5A, 0x02, 0x48, 0x65, 0x90, 0xA6, 0x6F, 0xE0, 0xFF, 0x7D, 0x48, 0x21, 0x6E, -+0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF0, 0x74, 0x09, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0xA1, 0xE3, 0xE0, 0xFF, 0x90, 0xA6, -+0x4E, 0x74, 0x0B, 0xF0, 0x7B, 0x08, 0x7D, 0x01, 0xB1, 0xBF, 0x90, 0xA6, 0x64, 0xEE, 0xF0, 0xFC, -+0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA6, 0x63, 0xE0, 0xFF, 0x22, 0x7F, 0x6F, 0x31, 0x6E, 0x21, 0xBE, -+0xFD, 0x75, 0xF0, 0x0E, 0x90, 0xA3, 0x58, 0x02, 0x48, 0x65, 0x7D, 0x1F, 0x7F, 0x6F, 0x31, 0x6E, -+0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0xA2, 0xE8, 0x74, 0x04, 0xF0, 0x22, 0x7D, 0x20, -+0x7F, 0xFF, 0x31, 0x6E, 0x12, 0x66, 0x9A, 0x90, 0xA2, 0xE8, 0x74, 0x02, 0xF0, 0x22, 0x80, 0xF4, -+0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x22, 0xE4, 0x90, 0xA4, 0x44, 0xF0, 0x90, 0xA4, 0x44, -+0xE0, 0x64, 0x01, 0xF0, 0x24, 0xF8, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x5F, 0xA3, 0xF0, 0x12, 0x3A, -+0xEB, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x69, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x0E, 0x90, 0xA2, 0xF2, -+0xE0, 0xFF, 0x90, 0xA2, 0xF1, 0xE0, 0x6F, 0x60, 0x02, 0x11, 0x40, 0xC2, 0xAF, 0x12, 0x99, 0x6B, -+0xBF, 0x01, 0x03, 0x12, 0x79, 0x04, 0xD2, 0xAF, 0x12, 0x57, 0xF6, 0x12, 0x49, 0x62, 0x80, 0xBD, -+0x90, 0xA2, 0xE5, 0xE0, 0x90, 0xA2, 0xF1, 0x30, 0xE0, 0x05, 0xE0, 0xFF, 0x02, 0x9A, 0x81, 0xE0, -+0xFF, 0x7D, 0x01, 0x80, 0x04, 0x7D, 0x01, 0x7F, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA6, 0x8E, 0xED, 0xF0, 0x90, 0xA2, 0xEA, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, -+0xE0, 0x02, 0x21, 0xA1, 0xEE, 0x12, 0x4F, 0x6F, 0x30, 0xE0, 0x02, 0x21, 0xA1, 0x90, 0xA2, 0xF2, -+0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x21, 0xA1, 0xEF, 0x70, 0x02, 0x21, 0x16, 0x24, 0xFE, 0x70, 0x02, -+0x21, 0x50, 0x24, 0xFE, 0x60, 0x48, 0x24, 0xFC, 0x70, 0x02, 0x21, 0x8B, 0x24, 0xFC, 0x60, 0x02, -+0x21, 0xA1, 0xEE, 0xB4, 0x0E, 0x02, 0x31, 0xCD, 0x90, 0xA2, 0xF2, 0xE0, 0x70, 0x04, 0x7F, 0x01, -+0x51, 0x14, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x06, 0x02, 0x31, 0xEE, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, -+0x04, 0x0E, 0x90, 0xA6, 0x8E, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0xB9, 0xF6, 0x80, 0x02, 0xB1, 0xD4, -+0x90, 0xA2, 0xF2, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x21, 0xA1, 0xB1, 0xDF, 0x21, 0xA1, 0x90, 0xA2, -+0xF2, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x51, 0x14, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x06, 0x02, 0x31, -+0xEE, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x0E, 0x07, 0x31, 0xA6, 0xBF, 0x01, 0x02, 0x31, 0xCD, 0x90, -+0xA2, 0xF2, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x21, 0xA1, 0x31, 0xA6, 0xEF, 0x64, 0x01, 0x60, 0x02, -+0x21, 0xA1, 0x51, 0x2C, 0x21, 0xA1, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x0E, 0x07, 0x31, 0xA6, 0xBF, -+0x01, 0x02, 0x31, 0xCD, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x06, 0x02, 0x31, 0xEE, 0x90, 0xA2, 0xF2, -+0xE0, 0xB4, 0x0C, 0x07, 0x31, 0xA6, 0xBF, 0x01, 0x02, 0x51, 0x2C, 0x90, 0xA2, 0xF2, 0xE0, 0x64, -+0x04, 0x70, 0x5E, 0x12, 0x9C, 0x1D, 0xEF, 0x64, 0x01, 0x70, 0x56, 0x12, 0xBA, 0x2E, 0x80, 0x51, -+0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x0E, 0x07, 0x31, 0xA6, 0xBF, 0x01, 0x02, 0x31, 0xCD, 0x90, 0xA2, -+0xF2, 0xE0, 0xB4, 0x06, 0x02, 0x31, 0xEE, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x0C, 0x07, 0x31, 0xA6, -+0xBF, 0x01, 0x02, 0x51, 0x2C, 0x90, 0xA2, 0xF2, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x51, 0x14, 0x90, -+0xA2, 0xF2, 0xE0, 0xB4, 0x04, 0x1B, 0x12, 0xB8, 0x3D, 0x80, 0x16, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, -+0x0C, 0x0F, 0x90, 0xA2, 0xEB, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0xBA, -+0x66, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x9B, 0xD9, -+0xBF, 0x01, 0x13, 0x12, 0x9F, 0xB2, 0x20, 0xE0, 0x0D, 0x90, 0xA2, 0xF1, 0xE0, 0xD3, 0x94, 0x04, -+0x50, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0xEB, -+0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x04, 0x51, 0x61, 0x80, 0x0E, 0x12, 0xBB, 0x6B, 0xB1, 0x24, 0x90, -+0x05, 0x27, 0xE0, 0x44, 0x80, 0xF0, 0x51, 0x25, 0xE4, 0xFD, 0xFF, 0x02, 0x59, 0x6E, 0x90, 0xA2, -+0xEB, 0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x07, 0xE0, 0x44, 0x40, 0xB1, 0x24, 0x80, 0x0F, 0x51, -+0x5D, 0x90, 0x05, 0x27, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA2, 0xE9, 0x74, 0x0C, 0xF0, 0xE4, 0xFD, -+0xFF, 0x02, 0x59, 0x6E, 0x90, 0xA6, 0x8D, 0xEF, 0xF0, 0xB1, 0xEC, 0x90, 0xA6, 0x8D, 0xE0, 0x60, -+0x02, 0xB1, 0xCE, 0xB1, 0x25, 0x90, 0xA2, 0xE9, 0x74, 0x04, 0xF0, 0x22, 0x12, 0x8C, 0x3C, 0x70, -+0x2B, 0x90, 0xA2, 0xEB, 0xE0, 0x54, 0xFD, 0xF0, 0x7D, 0x2C, 0x7F, 0x6F, 0x12, 0x59, 0x6E, 0x7D, -+0x08, 0x7F, 0x01, 0x12, 0x5E, 0xE1, 0xBF, 0x01, 0x13, 0x90, 0xA2, 0xEA, 0xE0, 0x44, 0x80, 0xF0, -+0x7D, 0x0E, 0x7F, 0x01, 0x51, 0x65, 0x90, 0xA2, 0xE9, 0x74, 0x0E, 0xF0, 0x22, 0xE0, 0x54, 0x7F, -+0xF0, 0x7D, 0x0C, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0xEF, 0x14, -+0x60, 0x15, 0x14, 0x60, 0x19, 0x24, 0x02, 0x70, 0x1A, 0xED, 0x54, 0x01, 0xFE, 0x90, 0xA2, 0xEA, -+0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0x80, 0x0C, 0x90, 0xA2, 0xF2, 0xED, 0xF0, 0x80, 0x05, 0x90, 0xA2, -+0xF1, 0xED, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE4, 0x29, 0xEC, 0x14, 0x60, 0x07, 0x14, 0x60, -+0x18, 0x24, 0x02, 0x70, 0x1E, 0x90, 0xA2, 0xEA, 0xE0, 0x12, 0xBC, 0xB2, 0xFF, 0x90, 0xA2, 0xF2, -+0xE0, 0x54, 0x7F, 0x4F, 0xFD, 0x7F, 0x88, 0x80, 0x07, 0x90, 0xA2, 0xF1, 0xE0, 0xFD, 0x7F, 0x89, -+0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, -+0xBC, 0xA2, 0x90, 0x05, 0x27, 0xE0, 0xF5, 0x11, 0x12, 0x4F, 0xF5, 0x75, 0x43, 0x01, 0x7B, 0x01, -+0x7A, 0xA2, 0x79, 0xE5, 0x12, 0x34, 0x2C, 0x12, 0x5C, 0xC8, 0x12, 0x26, 0x1E, 0xFF, 0xC3, 0x13, -+0x20, 0xE0, 0x02, 0x61, 0x84, 0x90, 0xA2, 0xE5, 0xE0, 0x30, 0xE0, 0x74, 0x12, 0x8B, 0x71, 0x75, -+0x11, 0x21, 0x12, 0xBC, 0xD6, 0x30, 0xE0, 0x08, 0x12, 0xBC, 0x1E, 0x43, 0x11, 0x08, 0x80, 0x0D, -+0xE4, 0x90, 0xA2, 0xE6, 0xF0, 0xA3, 0xF0, 0x7D, 0x40, 0xFF, 0x12, 0x8B, 0x81, 0x90, 0xA2, 0xE5, -+0x12, 0x8C, 0xE3, 0x30, 0xE0, 0x03, 0x43, 0x11, 0x12, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, -+0x43, 0x11, 0x14, 0x90, 0xA2, 0xE5, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x03, 0x43, 0x11, -+0x80, 0x12, 0x9B, 0xCF, 0x20, 0xE0, 0x03, 0x43, 0x11, 0x40, 0x91, 0x2F, 0x90, 0xA2, 0xE8, 0xE0, -+0x70, 0x04, 0x7F, 0x01, 0x91, 0x36, 0x12, 0x9A, 0xF0, 0x30, 0xE0, 0x04, 0x7F, 0x04, 0x80, 0x0C, -+0x12, 0x9A, 0x75, 0xEF, 0x60, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x91, 0x36, 0x61, 0xF8, -+0x75, 0x11, 0x01, 0x91, 0x2F, 0x90, 0xA2, 0xE8, 0xE0, 0x64, 0x04, 0x60, 0x02, 0x81, 0x2A, 0xFF, -+0x91, 0x36, 0x81, 0x2A, 0x90, 0xA2, 0xE5, 0xE0, 0x30, 0xE0, 0x75, 0x12, 0x8B, 0x71, 0x43, 0x11, -+0x31, 0x12, 0xBC, 0xD6, 0x30, 0xE0, 0x08, 0x12, 0xBC, 0x1E, 0x43, 0x11, 0x08, 0x80, 0x07, 0x7D, -+0x40, 0xE4, 0xFF, 0x12, 0x8B, 0x81, 0x90, 0xA2, 0xE5, 0x12, 0x8C, 0xE3, 0x30, 0xE0, 0x03, 0x43, -+0x11, 0x02, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x43, 0x11, 0x04, 0x91, 0x2F, 0x12, 0x9A, -+0xF0, 0x30, 0xE0, 0x0B, 0x12, 0x9A, 0xE9, 0x60, 0x2F, 0xE4, 0xFD, 0x7F, 0x02, 0x80, 0x1D, 0xF1, -+0xB0, 0x90, 0xA2, 0xE9, 0xE0, 0xB4, 0x02, 0x18, 0xB1, 0x2B, 0x12, 0x9A, 0x75, 0xBF, 0x01, 0x09, -+0x90, 0xA2, 0xF1, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x03, 0xE4, 0xFD, 0xFF, 0x11, 0x59, 0x80, 0x08, -+0x90, 0xA2, 0xF2, 0xE0, 0x90, 0xA2, 0xE9, 0xF0, 0x90, 0x05, 0x40, 0x74, 0x22, 0xF0, 0x80, 0x2A, -+0x75, 0x11, 0x01, 0x91, 0x2F, 0x90, 0xA2, 0xE9, 0xE0, 0xB4, 0x02, 0x06, 0x7D, 0x01, 0x7F, 0x04, -+0x80, 0x0B, 0x90, 0xA2, 0xE9, 0xE0, 0xB4, 0x08, 0x06, 0x7D, 0x01, 0x7F, 0x0C, 0x11, 0x59, 0x12, -+0x9B, 0xF2, 0x90, 0xA2, 0xF1, 0x11, 0x4F, 0x12, 0xB7, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0x05, 0x27, 0xE5, 0x11, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0xE8, -+0xE0, 0xF5, 0x7A, 0xE5, 0x7A, 0x6F, 0x70, 0x02, 0xA1, 0x1F, 0xEF, 0x14, 0x60, 0x3E, 0x14, 0x60, -+0x5E, 0x14, 0x70, 0x02, 0x81, 0xD4, 0x14, 0x70, 0x02, 0x81, 0xFB, 0x24, 0x04, 0x60, 0x02, 0xA1, -+0x1F, 0xE5, 0x7A, 0xB4, 0x04, 0x05, 0x12, 0xB8, 0x26, 0xA1, 0x1F, 0xE5, 0x7A, 0xB4, 0x02, 0x05, -+0x12, 0xB8, 0x2B, 0xA1, 0x1F, 0xE5, 0x7A, 0xB4, 0x03, 0x05, 0x12, 0xB8, 0x30, 0xA1, 0x1F, 0xE5, -+0x7A, 0x64, 0x01, 0x60, 0x02, 0xA1, 0x1F, 0x12, 0xB8, 0x1E, 0xA1, 0x1F, 0xE5, 0x7A, 0xB4, 0x04, -+0x04, 0xF1, 0x84, 0xA1, 0x1F, 0xE5, 0x7A, 0xB4, 0x02, 0x04, 0xF1, 0x79, 0xA1, 0x1F, 0xE5, 0x7A, -+0xB4, 0x03, 0x04, 0xF1, 0xA5, 0x80, 0x78, 0xE5, 0x7A, 0x70, 0x74, 0xF1, 0xE1, 0x80, 0x70, 0xE5, -+0x7A, 0xB4, 0x04, 0x04, 0xF1, 0xB8, 0x80, 0x67, 0xE5, 0x7A, 0xB4, 0x01, 0x05, 0x12, 0x5F, 0xDE, -+0x80, 0x5D, 0xE5, 0x7A, 0xB4, 0x03, 0x05, 0x12, 0x5F, 0xEE, 0x80, 0x53, 0xE5, 0x7A, 0x70, 0x4F, -+0xF1, 0xE8, 0x80, 0x4B, 0xE5, 0x7A, 0xB4, 0x04, 0x05, 0x12, 0xB8, 0x6C, 0x80, 0x41, 0xE5, 0x7A, -+0xB4, 0x01, 0x05, 0x12, 0xB8, 0x54, 0x80, 0x37, 0xE5, 0x7A, 0xB4, 0x02, 0x05, 0x12, 0xB8, 0x67, -+0x80, 0x2D, 0xE5, 0x7A, 0x70, 0x29, 0x12, 0xB8, 0x62, 0x80, 0x24, 0xE5, 0x7A, 0xB4, 0x03, 0x05, -+0x12, 0xB8, 0x80, 0x80, 0x1A, 0xE5, 0x7A, 0xB4, 0x01, 0x05, 0x12, 0x5F, 0xCA, 0x80, 0x10, 0xE5, -+0x7A, 0xB4, 0x02, 0x05, 0x12, 0xB8, 0x78, 0x80, 0x06, 0xE5, 0x7A, 0x70, 0x02, 0xF1, 0xE3, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x7D, 0x04, 0x7F, 0x01, 0x41, 0x65, 0xB1, 0xCE, 0xB1, 0x25, 0xF1, -+0xB0, 0x41, 0x25, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0xEA, 0x12, -+0x48, 0xA9, 0x90, 0xA2, 0xEE, 0x74, 0x02, 0xF0, 0x90, 0xA2, 0xF5, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, -+0x74, 0x0A, 0xF0, 0x90, 0xA2, 0xFB, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x12, 0xBC, 0x06, 0xF0, -+0x12, 0xBA, 0x4F, 0xE4, 0xFD, 0xFF, 0x51, 0x65, 0x7D, 0x0C, 0x7F, 0x02, 0x51, 0x65, 0x51, 0x61, -+0x90, 0xA1, 0x29, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0xA2, 0xFA, 0x74, 0xFF, 0xF0, 0x80, 0x0F, -+0xEF, 0x90, 0xA2, 0xFA, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x40, 0xF0, 0x12, -+0x4F, 0x8D, 0x12, 0xBC, 0x06, 0xF0, 0x7F, 0x01, 0x12, 0x9F, 0x8E, 0x90, 0x05, 0x58, 0x74, 0x02, -+0xF0, 0x90, 0xA2, 0xFD, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0x7E, 0x00, 0x7F, 0x02, 0x7D, -+0x00, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x50, 0x12, 0x48, 0xA9, 0x12, 0xBC, 0xEF, 0x12, 0xBC, 0xDF, -+0xB1, 0xCE, 0xE4, 0x90, 0xA3, 0x52, 0xF0, 0x22, 0xE4, 0xFD, 0x7F, 0x0C, 0x11, 0x59, 0xE4, 0xFD, -+0xFF, 0x02, 0x59, 0x6E, 0x12, 0xBC, 0xEF, 0xB1, 0xCE, 0x7D, 0x0C, 0x7F, 0x01, 0x41, 0x65, 0xB1, -+0xEC, 0xB1, 0xCE, 0x51, 0x61, 0x90, 0xA2, 0xE9, 0x74, 0x0C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0xFD, 0xD1, 0x91, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, -+0xA2, 0xFD, 0xD1, 0x91, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x10, 0xE0, 0x44, -+0x0C, 0xFD, 0x7F, 0x10, 0x12, 0x3A, 0x96, 0x90, 0x00, 0x72, 0xE0, 0x54, 0xF3, 0xFD, 0x7F, 0x72, -+0x12, 0x3A, 0x96, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, -+0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x12, 0xBC, 0xCD, 0x54, -+0xBF, 0xF1, 0xD5, 0xD1, 0x91, 0x12, 0xBC, 0xF7, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x01, 0xF1, 0x2F, -+0x7F, 0x00, 0x7E, 0x0C, 0xF1, 0xCF, 0xD1, 0x91, 0x12, 0xBC, 0x2A, 0xF1, 0xCF, 0xD1, 0x91, 0x7F, -+0x00, 0x12, 0xBC, 0x98, 0x70, 0x15, 0xF1, 0xBF, 0xE0, 0x54, 0xE7, 0x12, 0xA0, 0x13, 0xF1, 0xBF, -+0xE0, 0x54, 0x18, 0x70, 0x06, 0x90, 0x01, 0xBF, 0xE0, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA6, 0x36, 0x12, 0x27, 0x48, 0x90, 0xA6, -+0x36, 0x12, 0x48, 0x4D, 0x90, 0xAC, 0xB9, 0x02, 0x27, 0x48, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x12, 0x59, 0xBE, 0x7F, 0x00, 0x7E, 0x0C, 0xD1, 0x80, 0x12, 0xBC, 0x2A, 0xD1, 0x80, 0x7F, -+0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0xF1, 0x29, 0xF1, 0x1D, 0xF1, 0x1D, 0x12, 0xBC, 0xCD, 0x44, -+0x40, 0xD1, 0x86, 0x12, 0xBC, 0xF7, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, -+0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0xBC, 0x65, 0x12, 0x27, 0x48, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0xF1, 0x12, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, -+0x77, 0x7F, 0xB0, 0x12, 0xBC, 0x98, 0x70, 0x15, 0x7B, 0x01, 0x7A, 0xA6, 0x79, 0x35, 0x7D, 0x08, -+0x7F, 0x01, 0xF1, 0x35, 0x90, 0xA6, 0x35, 0xE0, 0x44, 0x18, 0x12, 0xA0, 0x13, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x22, 0x90, 0x00, 0x02, -+0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x12, 0x3A, 0x96, 0x90, 0x00, 0x02, 0xE0, 0x54, 0xFE, 0xFD, -+0x7F, 0x02, 0x02, 0x3A, 0x96, 0x90, 0xA6, 0x4F, 0x12, 0x48, 0x7A, 0xEF, 0x70, 0x07, 0x90, 0xA6, -+0x52, 0x04, 0xF0, 0x80, 0x0B, 0xEF, 0x64, 0x01, 0x70, 0x25, 0x90, 0xA6, 0x52, 0x74, 0x40, 0xF0, -+0x7F, 0xE2, 0x12, 0x3A, 0x96, 0x90, 0xA6, 0x52, 0xE0, 0xF1, 0xAA, 0x90, 0x00, 0xE1, 0xE0, 0xFF, -+0x90, 0xA6, 0x4F, 0x12, 0x48, 0x71, 0xEF, 0x12, 0x26, 0x64, 0xF1, 0xA9, 0x7F, 0x01, 0x22, 0x90, -+0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0xB1, 0xEC, 0xB1, 0xCE, 0x90, 0xA2, 0xE8, -+0x74, 0x01, 0xF0, 0x22, 0xB1, 0xCE, 0xF1, 0xB0, 0x80, 0xF3, 0x90, 0xA2, 0xEF, 0xE0, 0x64, 0x01, -+0x70, 0x12, 0x12, 0x8F, 0x8E, 0x60, 0x05, 0xB1, 0xC8, 0x02, 0xB9, 0x67, 0x90, 0xA2, 0xF2, 0xE0, -+0x70, 0x02, 0x11, 0x55, 0x22, 0xB1, 0xCE, 0x80, 0xD4, 0xE4, 0xFD, 0x7F, 0xE3, 0x02, 0x3A, 0x96, -+0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0xF1, 0xB0, 0x7D, 0x23, 0x02, 0x5F, 0xE0, 0x7B, -+0x01, 0x7A, 0xA6, 0x79, 0x34, 0x7D, 0x08, 0x7F, 0x01, 0xF1, 0x35, 0x90, 0xA6, 0x34, 0x22, 0x12, -+0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0xA6, 0x30, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x30, -+0x22, 0x80, 0x9A, 0xF1, 0xE1, 0x02, 0x5F, 0xCA, 0xF1, 0xE1, 0x02, 0x5F, 0xDE, 0xE4, 0xFB, 0xFA, -+0xFD, 0x7F, 0x01, 0x12, 0x4B, 0x63, 0x90, 0xA4, 0x45, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0xA1, 0x23, -+0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE0, 0x0E, 0x90, 0xA1, -+0x23, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x87, 0x4E, 0x11, 0x36, 0xF1, 0x5A, 0x30, 0xE1, -+0x06, 0x54, 0xFD, 0xF0, 0x12, 0x98, 0x58, 0xF1, 0x5A, 0x30, 0xE2, 0x06, 0x54, 0xFB, 0xF0, 0x12, -+0x7A, 0xC7, 0xD2, 0xAF, 0x80, 0xC7, 0xE4, 0xF5, 0x0E, 0x90, 0xA2, 0xE4, 0xE0, 0xFF, 0xE5, 0x0E, -+0xC3, 0x9F, 0x40, 0x02, 0xA1, 0x62, 0xE5, 0x0E, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA4, 0x53, -+0xF0, 0xE5, 0x0E, 0x54, 0x07, 0xA3, 0xF0, 0x90, 0x04, 0xA0, 0xE0, 0xFF, 0xA3, 0xE0, 0xFE, 0xEF, -+0x64, 0x01, 0x70, 0x28, 0xE5, 0x0E, 0x6E, 0x70, 0x23, 0xA3, 0xE0, 0xF5, 0x0F, 0xA3, 0xE0, 0xF1, -+0xC5, 0xE5, 0x0E, 0xF1, 0x69, 0xE5, 0x0F, 0xF0, 0xF1, 0x6F, 0xE0, 0x54, 0xFC, 0xFF, 0x90, 0xA4, -+0x4F, 0xE0, 0x54, 0x03, 0x4F, 0xFF, 0xF1, 0x6F, 0xEF, 0xF0, 0xA1, 0x5E, 0xAF, 0x0E, 0x12, 0x8B, -+0xC2, 0xEF, 0x70, 0x02, 0xA1, 0x5E, 0x12, 0x4F, 0x1F, 0x12, 0x4F, 0x6F, 0x30, 0xE0, 0x02, 0xA1, -+0x5E, 0x90, 0xA4, 0x53, 0x12, 0x84, 0xE4, 0x12, 0x8F, 0xC0, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0xF1, 0xB5, 0x60, 0x02, 0xA1, 0x5E, 0x12, 0x88, 0xEC, 0xE0, 0xFE, 0xA3, 0xE0, -+0x4E, 0x70, 0x08, 0x12, 0x88, 0x6A, 0xE0, 0x70, 0x02, 0xA1, 0x5E, 0xE5, 0x0E, 0x12, 0x97, 0xC2, -+0x90, 0xA4, 0x49, 0x12, 0x48, 0x7A, 0x12, 0x88, 0xEC, 0xE0, 0xF5, 0x13, 0xA3, 0xE0, 0xF5, 0x14, -+0x12, 0x88, 0x6A, 0xE0, 0xFF, 0x90, 0xA4, 0x4C, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x04, -+0xE5, 0x0E, 0x12, 0x57, 0x7E, 0xE0, 0x90, 0xA4, 0x4E, 0xF0, 0xFD, 0x12, 0x4F, 0x1F, 0xFE, 0x13, -+0x13, 0x54, 0x03, 0xF1, 0xC5, 0xE5, 0x0E, 0xF1, 0x69, 0xE0, 0xF5, 0x0F, 0x54, 0x7F, 0xF5, 0x10, -+0xD3, 0x9D, 0x40, 0x16, 0x90, 0xA4, 0x4E, 0xE0, 0xF5, 0x10, 0xE5, 0x0F, 0x30, 0xE7, 0x07, 0xE5, -+0x10, 0x44, 0x80, 0xFF, 0x80, 0x02, 0xAF, 0x10, 0x8F, 0x0F, 0xE5, 0x10, 0x90, 0x41, 0xED, 0x93, -+0xB1, 0x63, 0xC3, 0x9F, 0x40, 0x0B, 0x74, 0x38, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0x80, -+0x09, 0x74, 0x8C, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0xFF, 0x12, 0x94, -+0xF6, 0x90, 0xA4, 0x46, 0x12, 0x48, 0x7A, 0xB1, 0x71, 0xE0, 0xC3, 0x94, 0x05, 0x40, 0x02, 0x61, -+0x31, 0xE5, 0x0F, 0x30, 0xE7, 0x04, 0x05, 0x15, 0x05, 0x15, 0xE5, 0x15, 0xD3, 0x94, 0x1A, 0xAF, -+0x15, 0x40, 0x02, 0x7F, 0x1A, 0x12, 0x94, 0xF6, 0x90, 0xA4, 0x46, 0x12, 0x48, 0x7A, 0xC3, 0xE5, -+0x14, 0x94, 0x0F, 0xE5, 0x13, 0x94, 0x00, 0x50, 0x73, 0xF1, 0x91, 0xFF, 0x90, 0xA4, 0x4D, 0xE0, -+0x2F, 0xFF, 0x90, 0xA4, 0x4C, 0xE0, 0x35, 0xF0, 0xFE, 0xF1, 0xBD, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, -+0x90, 0x00, 0x04, 0x12, 0x47, 0x17, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0x12, 0xBC, 0x5A, 0xD3, 0xED, -+0x9F, 0xEC, 0x9E, 0x40, 0x07, 0xE4, 0xFB, 0x12, 0x91, 0x23, 0x61, 0x2A, 0x90, 0xA4, 0x49, 0x12, -+0x48, 0x71, 0x12, 0x46, 0xEC, 0x65, 0x14, 0x70, 0x04, 0xE5, 0xF0, 0x65, 0x13, 0x75, 0xF0, 0x04, -+0x70, 0x22, 0x12, 0x4F, 0xAF, 0x12, 0x9A, 0xF4, 0xFE, 0xEF, 0x54, 0x3F, 0xFF, 0xEE, 0x04, 0x54, -+0x03, 0xFE, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0x4F, 0xF0, 0xE4, 0xFD, 0xAF, 0x0E, 0xB1, 0x88, 0x75, -+0xF0, 0x04, 0x80, 0x00, 0x12, 0x4F, 0xAF, 0x54, 0x3F, 0xF0, 0x61, 0x2A, 0xE5, 0x0E, 0x70, 0x43, -+0xF1, 0x91, 0xFF, 0xAE, 0xF0, 0xF1, 0xBD, 0xFD, 0xE5, 0xF0, 0x3E, 0x12, 0xBC, 0x5A, 0xC3, 0xED, -+0x9F, 0xEC, 0x9E, 0x50, 0x08, 0x90, 0xA1, 0x22, 0x74, 0x01, 0xF0, 0x80, 0x26, 0xF1, 0x91, 0xFB, -+0xAA, 0xF0, 0xE5, 0x14, 0xAE, 0x13, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, -+0x7C, 0x00, 0x7D, 0x05, 0x12, 0x26, 0x98, 0xD3, 0xEB, 0x9F, 0xEA, 0x9E, 0x40, 0x05, 0xE4, 0x90, -+0xA1, 0x22, 0xF0, 0xF1, 0x42, 0x12, 0x8C, 0xE3, 0xFE, 0x60, 0x12, 0xF1, 0x42, 0xEF, 0x54, 0x07, -+0xFF, 0xC3, 0xEE, 0x94, 0x01, 0x54, 0x1F, 0x12, 0xBD, 0x26, 0xF0, 0x61, 0x2A, 0x90, 0xA4, 0x53, -+0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0x12, 0x8F, 0xC0, 0x80, 0x05, 0xC3, 0x33, 0xCE, -+0x33, 0xCE, 0xD8, 0xF9, 0xF1, 0xB5, 0x60, 0x27, 0x74, 0xA2, 0x25, 0x0E, 0xB1, 0x80, 0xE0, 0xFF, -+0xF4, 0x60, 0x1C, 0x8F, 0x0F, 0x90, 0xA4, 0x4F, 0xE0, 0xF5, 0x77, 0x7B, 0x01, 0xAD, 0x0F, 0xAF, -+0x0E, 0x12, 0x83, 0x1D, 0x74, 0xA2, 0x25, 0x0E, 0xB1, 0x80, 0x74, 0xFF, 0xF0, 0x61, 0x2A, 0xAB, -+0x15, 0xAD, 0x0E, 0xAF, 0x14, 0xAE, 0x13, 0x12, 0x90, 0x5A, 0x8E, 0x11, 0x8F, 0x12, 0xF1, 0x85, -+0xF5, 0x83, 0xC3, 0x12, 0xBC, 0x8E, 0x50, 0x62, 0x12, 0xBB, 0xEA, 0x54, 0x7F, 0xB1, 0x63, 0xFE, -+0xC3, 0x9F, 0x40, 0x05, 0xEE, 0x9F, 0xFF, 0x80, 0x0B, 0xB1, 0x64, 0xFF, 0x12, 0xBB, 0xEA, 0x54, -+0x7F, 0xC3, 0x9F, 0xFF, 0xEF, 0xD3, 0x94, 0x04, 0x40, 0x0E, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x90, -+0x9B, 0x12, 0x12, 0x57, 0x9C, 0xF0, 0x80, 0x12, 0xF1, 0x7A, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x60, -+0x09, 0xF1, 0x7A, 0x74, 0xFF, 0xF5, 0xF0, 0x12, 0x46, 0xD6, 0xF1, 0x85, 0x12, 0x97, 0x0A, 0xE5, -+0x0E, 0x12, 0x91, 0x17, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xF1, 0x7A, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, -+0x70, 0x18, 0x7D, 0x01, 0xAF, 0x0E, 0xB1, 0x88, 0x80, 0x10, 0xE5, 0x10, 0x12, 0x97, 0xB6, 0xD3, -+0x12, 0xBC, 0x8E, 0x40, 0x05, 0x7B, 0x01, 0x12, 0x91, 0x23, 0xE4, 0xF5, 0x11, 0xF5, 0x12, 0xA1, -+0x3B, 0xB1, 0x71, 0xE0, 0xF9, 0x64, 0x05, 0x60, 0x02, 0x61, 0xE7, 0xF1, 0x37, 0xE0, 0x54, 0x07, -+0xF5, 0x18, 0xB1, 0x64, 0xC3, 0x94, 0x30, 0x40, 0x12, 0x12, 0x55, 0xFD, 0xE0, 0x20, 0xE2, 0x0B, -+0x12, 0x4F, 0x1F, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x10, 0xE4, 0xF5, 0x18, 0xB1, 0x71, -+0xE4, 0xF1, 0x4D, 0xE4, 0xF0, 0xF1, 0xA9, 0xE4, 0xF0, 0x80, 0x0B, 0xAD, 0x10, 0xAF, 0x0E, 0x12, -+0xA1, 0x22, 0xF1, 0xA9, 0xEF, 0xF0, 0xF1, 0xA9, 0xE0, 0x64, 0x01, 0x70, 0x62, 0xF1, 0x9D, 0xE0, -+0xFF, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xB1, 0x64, 0xFE, 0xC3, 0x12, 0x9F, 0x57, 0x50, 0x0B, -+0x12, 0xBB, 0xCD, 0xE0, 0xFD, 0xE5, 0x10, 0xC3, 0x9D, 0x40, 0x1B, 0xE5, 0x18, 0x70, 0x05, 0x75, -+0x18, 0x01, 0x80, 0x0D, 0xE5, 0x18, 0xB4, 0x01, 0x05, 0x75, 0x18, 0x03, 0x80, 0x03, 0x75, 0x18, -+0x05, 0xF1, 0x9D, 0xEE, 0x80, 0x1B, 0xB1, 0x64, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xC3, 0xEF, -+0x12, 0x9F, 0x57, 0x50, 0x06, 0xF1, 0x4E, 0xE0, 0xB4, 0x0A, 0x0C, 0xB1, 0x64, 0xFF, 0xF1, 0x9D, -+0xEF, 0xF1, 0x4D, 0xE4, 0xF0, 0x80, 0x08, 0xB1, 0x71, 0xE4, 0xF1, 0x4D, 0xE0, 0x04, 0xF0, 0x12, -+0xBB, 0xCD, 0xE5, 0x10, 0xF0, 0xA1, 0x2A, 0xE9, 0x64, 0x06, 0x60, 0x02, 0xA1, 0x3B, 0xF5, 0x11, -+0xF5, 0x12, 0xF1, 0x37, 0xE0, 0x54, 0x07, 0xF5, 0x18, 0xAF, 0x14, 0xAE, 0x13, 0x12, 0xA2, 0x93, -+0x8F, 0x16, 0xE5, 0x15, 0xD3, 0x94, 0x13, 0x40, 0x1C, 0x90, 0xA4, 0x46, 0x12, 0x90, 0x51, 0xFD, -+0x7C, 0x00, 0xE5, 0x14, 0xAE, 0x13, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, -+0xD8, 0xF9, 0xFF, 0x80, 0x19, 0xE5, 0x14, 0xAE, 0x13, 0xA8, 0x16, 0x08, 0x80, 0x05, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x44, 0x4A, 0xE4, 0x93, 0xFD, 0x7C, 0x00, 0x12, 0x26, -+0x98, 0x90, 0xA4, 0x50, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xF5, 0x17, 0xE5, 0x15, 0xD3, 0x94, -+0x13, 0x40, 0x22, 0x12, 0x94, 0xEC, 0xE5, 0x17, 0x12, 0x95, 0x18, 0xF1, 0xD5, 0x80, 0x05, 0xCE, -+0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xA4, 0x46, 0x12, 0x48, 0x71, 0x85, 0x17, 0x82, -+0x12, 0x4F, 0xE1, 0x80, 0x1A, 0x12, 0x94, 0xEC, 0xE5, 0x17, 0x12, 0x95, 0x18, 0xF1, 0xD5, 0x80, -+0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xE5, 0x17, 0x90, 0x44, 0x45, 0x93, 0x12, -+0x97, 0xA4, 0x25, 0x12, 0xF5, 0x12, 0xEE, 0x35, 0x11, 0xF5, 0x11, 0xC3, 0x90, 0xA4, 0x51, 0xE0, -+0x95, 0x12, 0x90, 0xA4, 0x50, 0xE0, 0x95, 0x11, 0x40, 0x08, 0x05, 0x17, 0xE5, 0x17, 0x64, 0x05, -+0x70, 0x9A, 0xE5, 0x17, 0xC3, 0x13, 0xF5, 0x17, 0xE5, 0x18, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, -+0xE7, 0x13, 0xEF, 0x13, 0xFF, 0xD3, 0x95, 0x17, 0x40, 0x06, 0xEF, 0x95, 0x17, 0xFF, 0x80, 0x02, -+0xE4, 0xFF, 0xF1, 0x2B, 0xE0, 0xC3, 0x13, 0xFE, 0xEF, 0xC4, 0x33, 0x54, 0xE0, 0x2E, 0xFE, 0xF1, -+0x2B, 0xEE, 0xF0, 0xF1, 0x2B, 0xE0, 0xC3, 0x94, 0xC0, 0x40, 0x05, 0xF1, 0x2B, 0x74, 0xC0, 0xF0, -+0xF1, 0x2B, 0xE0, 0x24, 0x1F, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x06, 0xCE, 0xA2, 0xE7, 0x13, -+0xCE, 0x13, 0xD8, 0xF8, 0x25, 0xE0, 0xFF, 0x70, 0x04, 0xF5, 0x18, 0x80, 0x04, 0xEF, 0x14, 0xF5, -+0x18, 0xD3, 0x90, 0xA4, 0x4D, 0xE0, 0x94, 0x03, 0x90, 0xA4, 0x4C, 0xE0, 0x94, 0x00, 0x50, 0x07, -+0xB1, 0x64, 0xC3, 0x94, 0x30, 0x50, 0x03, 0xE4, 0xF5, 0x18, 0xF1, 0x37, 0xE0, 0x54, 0xF8, 0x90, -+0xA4, 0x52, 0xF0, 0x45, 0x18, 0xFF, 0xF0, 0xF1, 0x37, 0xEF, 0xF0, 0xB1, 0x71, 0xE0, 0xD3, 0x94, -+0x05, 0x50, 0x07, 0xB1, 0x71, 0xE0, 0x04, 0xF0, 0x80, 0x0A, 0xF1, 0x42, 0xE0, 0x54, 0xF8, 0xF0, -+0xB1, 0x71, 0xE4, 0xF0, 0x75, 0x19, 0x01, 0x7D, 0x01, 0xAF, 0x0E, 0x12, 0x88, 0x76, 0x05, 0x0E, -+0x01, 0x39, 0x22, 0xFF, 0x74, 0x11, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, -+0x22, 0x74, 0xA2, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0x22, 0x74, 0xA2, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0x22, 0x8F, 0x1A, 0x8D, 0x1B, 0xB1, 0x7D, 0x74, 0xFF, -+0xF1, 0x64, 0xE0, 0xF5, 0x1C, 0x54, 0x7F, 0xF5, 0x1D, 0xE5, 0x1C, 0x54, 0x80, 0xF5, 0x1E, 0x12, -+0x57, 0x7A, 0xE0, 0xF5, 0x20, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4F, 0x24, 0xC4, 0x54, 0x03, 0xF5, -+0x21, 0xE5, 0x1D, 0xF1, 0x87, 0x12, 0x97, 0x0A, 0xE5, 0x1A, 0x12, 0x91, 0x17, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x74, 0x22, 0x25, 0x1A, 0xF1, 0xE0, 0xE5, 0x1C, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x1A, -+0x12, 0x4F, 0x24, 0x13, 0x13, 0x54, 0x03, 0xF5, 0x1F, 0x74, 0x22, 0x25, 0x1A, 0x12, 0x97, 0x9C, -+0xE5, 0x1F, 0xF0, 0x74, 0x91, 0x25, 0x1A, 0x12, 0x56, 0x01, 0xE0, 0x30, 0xE0, 0x1D, 0xE5, 0x1D, -+0x64, 0x3F, 0x70, 0x17, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x12, 0x4F, 0xB1, 0xC4, 0x13, 0x54, 0x07, -+0x7F, 0x3E, 0x30, 0xE0, 0x02, 0x7F, 0xBE, 0xF1, 0xCD, 0xE1, 0x27, 0xE5, 0x1D, 0x64, 0x2D, 0x70, -+0x2F, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x12, 0x4F, 0x24, 0xFF, 0x54, 0x03, 0xFE, 0xE5, 0x1F, 0xC3, -+0x9E, 0x50, 0x1D, 0x75, 0x1C, 0x2C, 0x05, 0x1F, 0xE5, 0x1F, 0x12, 0x97, 0x95, 0xFE, 0x75, 0xF0, -+0x04, 0xE5, 0x1A, 0x90, 0x96, 0x14, 0x12, 0x48, 0x65, 0xEF, 0x54, 0xF3, 0x4E, 0xF0, 0x80, 0x08, -+0xE5, 0x1D, 0xB4, 0x2C, 0x0E, 0x75, 0x1C, 0x2D, 0x74, 0xA2, 0x25, 0x1A, 0xB1, 0x80, 0x74, 0xFF, -+0xF0, 0xE1, 0x22, 0xE5, 0x1D, 0xC3, 0x95, 0x20, 0x40, 0x02, 0xC1, 0xF5, 0xAD, 0x1C, 0xAF, 0x1A, -+0x12, 0xA0, 0xF5, 0xEF, 0xF4, 0x60, 0x0B, 0x8F, 0x1C, 0x8F, 0x1D, 0xE5, 0x1C, 0x30, 0xE7, 0x02, -+0xE1, 0x22, 0xAD, 0x1D, 0xAF, 0x21, 0x12, 0x94, 0xC8, 0x8F, 0x1D, 0xAD, 0x20, 0xAF, 0x21, 0x12, -+0x94, 0xC8, 0x8F, 0x20, 0xE5, 0x1D, 0xD3, 0x94, 0x0B, 0x40, 0x13, 0x90, 0xA4, 0x5D, 0xE5, 0x21, -+0xF0, 0xAB, 0x1A, 0xE4, 0xFD, 0xAF, 0x1D, 0x12, 0x93, 0x50, 0x8F, 0x1C, 0x80, 0x0B, 0xAB, 0x1A, -+0xAD, 0x20, 0xAF, 0x1D, 0x12, 0xA2, 0x16, 0x8F, 0x1C, 0xAD, 0x1C, 0xAF, 0x21, 0x12, 0x94, 0xB5, -+0x8F, 0x1C, 0x74, 0xA2, 0x25, 0x1A, 0xB1, 0x80, 0xE0, 0xFD, 0xF4, 0x60, 0x0D, 0xAF, 0x21, 0x12, -+0x94, 0xB5, 0x74, 0xA2, 0x25, 0x1A, 0xB1, 0x80, 0xEF, 0xF0, 0x74, 0x91, 0x25, 0x1A, 0x12, 0x56, -+0x01, 0xE0, 0x30, 0xE0, 0x4D, 0xE5, 0x1D, 0x64, 0x3F, 0x70, 0x47, 0x75, 0xF0, 0x04, 0xE5, 0x1A, -+0x12, 0x4F, 0xB1, 0xC4, 0x13, 0x54, 0x07, 0x7F, 0x3E, 0x30, 0xE0, 0x02, 0x7F, 0xBE, 0xF1, 0xCD, -+0x12, 0x83, 0x19, 0x80, 0x2D, 0xE5, 0x1D, 0x65, 0x20, 0x70, 0x1C, 0x75, 0xF0, 0x04, 0xE5, 0x1A, -+0x12, 0x4F, 0xB1, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x20, 0xE5, 0x1C, 0x20, 0xE7, 0x1B, 0xE5, -+0x1D, 0x44, 0x80, 0xF5, 0x1C, 0x80, 0x0B, 0x74, 0x22, 0x25, 0x1A, 0xF1, 0xE0, 0xE5, 0x20, 0xF0, -+0xF5, 0x1C, 0x85, 0x1F, 0x77, 0xAB, 0x1B, 0x12, 0x83, 0x19, 0x22, 0x74, 0x01, 0x25, 0x0E, 0xF5, -+0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x10, 0xE5, 0x0E, 0x90, 0x81, 0x01, 0x02, -+0x48, 0x65, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x90, 0x9B, 0x11, 0x02, 0x48, 0x65, 0xF0, 0x74, 0x21, -+0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0x22, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0xA1, -+0x23, 0xE0, 0xFF, 0x22, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x00, 0x02, 0x48, 0x65, 0x75, -+0xF0, 0x10, 0xE5, 0x0E, 0x90, 0x81, 0x05, 0x02, 0x48, 0x65, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x90, -+0x9B, 0x12, 0x02, 0x48, 0x65, 0xE5, 0x10, 0x25, 0xE0, 0x24, 0x41, 0xF5, 0x82, 0xE4, 0x34, 0x42, -+0x22, 0x90, 0xA4, 0x49, 0x12, 0x48, 0x71, 0x90, 0x00, 0x08, 0x02, 0x47, 0x17, 0x74, 0x01, 0x25, -+0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0x74, 0x91, 0x25, 0x0E, 0xF5, 0x82, 0xE4, -+0x34, 0x9A, 0xF5, 0x83, 0x22, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x22, 0x90, 0x00, 0x06, -+0x12, 0x47, 0x17, 0x2F, 0x22, 0x90, 0xA4, 0x4F, 0xF0, 0x75, 0xF0, 0x10, 0x22, 0x8F, 0x1C, 0x85, -+0x1F, 0x77, 0xE4, 0xFB, 0x22, 0x12, 0x47, 0x17, 0xAE, 0xF0, 0xA8, 0x16, 0x08, 0x22, 0x24, 0x22, -+0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0x22, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0x90, 0xA6, 0x28, -+0xF0, 0x90, 0xA3, 0x4D, 0xE0, 0x90, 0xA6, 0x29, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x24, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -+0xA6, 0x28, 0xE0, 0xF5, 0x3B, 0xA3, 0xE0, 0xF5, 0x3C, 0x12, 0x34, 0x8C, 0x90, 0xA6, 0x24, 0x12, -+0x7B, 0xA4, 0xA3, 0xA3, 0xA3, 0x74, 0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xF5, 0x24, -+0x90, 0xA2, 0xEF, 0xE0, 0x70, 0x02, 0x21, 0x07, 0x12, 0x8C, 0x3C, 0x60, 0x02, 0x21, 0x07, 0x31, -+0x1B, 0x12, 0x47, 0x77, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x31, -+0x34, 0x78, 0x10, 0x12, 0x27, 0x35, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, -+0x77, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x31, 0x34, 0x78, 0x18, 0x12, 0x27, -+0x35, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0xBB, 0xD9, 0x12, 0x8B, 0x5D, 0x60, -+0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0xA2, 0xF6, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, -+0x60, 0x06, 0x90, 0xA2, 0xF8, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0xA2, 0xF5, 0xE0, 0xA3, -+0xF0, 0x80, 0x00, 0x75, 0x24, 0x01, 0x90, 0xA2, 0xE5, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0xA2, 0xE9, -+0xE0, 0xB4, 0x02, 0x03, 0xE4, 0xF5, 0x24, 0x12, 0x9A, 0x75, 0xEF, 0x70, 0x02, 0xF5, 0x24, 0xE5, -+0x24, 0x60, 0x44, 0x12, 0xBC, 0xFE, 0x90, 0xA2, 0xF8, 0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x14, -+0xE4, 0x90, 0xA6, 0x28, 0xF0, 0x90, 0xA2, 0xF8, 0xE0, 0x31, 0x13, 0x12, 0x6F, 0xF5, 0x90, 0xA2, -+0xF8, 0xE0, 0x80, 0x13, 0xE4, 0x90, 0xA6, 0x28, 0x31, 0x08, 0x12, 0x6F, 0xF5, 0x90, 0xA2, 0xF8, -+0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x31, 0x13, 0x90, 0xA3, 0x08, 0xF0, 0x90, 0xA2, 0xF2, -+0xE0, 0x20, 0xE2, 0x03, 0x12, 0x60, 0x55, 0x22, 0xF0, 0x90, 0xA2, 0xF8, 0xE0, 0x75, 0xF0, 0x03, -+0xA4, 0x24, 0xFE, 0xFF, 0x90, 0xA2, 0xF7, 0xE0, 0x2F, 0x22, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0xFF, -+0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x08, 0x12, 0x27, 0x35, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, -+0x07, 0x90, 0x05, 0x60, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0x90, 0xA6, 0x2A, 0xEF, 0xF0, -+0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x34, 0x7E, 0x08, 0x12, -+0x36, 0xCE, 0x90, 0xA6, 0x2C, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x2A, 0xE0, 0x14, 0x60, 0x5E, 0x14, -+0x70, 0x02, 0x41, 0x78, 0x24, 0x02, 0x60, 0x02, 0x61, 0x03, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, -+0x00, 0x30, 0x03, 0xC3, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x00, 0x71, 0x18, -+0x12, 0x27, 0x54, 0x40, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x00, 0x7F, 0xC4, 0x71, 0x1A, 0x12, 0x27, 0x54, 0x00, 0x1C, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, -+0x27, 0x54, 0x00, 0x10, 0x00, 0x00, 0x7F, 0x64, 0x71, 0x1A, 0x12, 0x27, 0x54, 0x03, 0xC0, 0x00, -+0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x01, 0xC0, 0x00, 0x00, 0x41, 0xE6, 0x90, 0xA5, 0xFE, -+0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, -+0x01, 0x71, 0x18, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x00, 0x00, 0x7F, 0xC4, 0x71, 0x1A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, 0x71, -+0x04, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x2B, 0x31, 0x34, 0x12, 0xAB, 0x54, -+0x7F, 0x38, 0x71, 0x1A, 0x12, 0x27, 0x54, 0x00, 0x1C, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, -+0x54, 0x00, 0x08, 0x00, 0x00, 0x12, 0xBB, 0xB4, 0x60, 0x13, 0x12, 0x27, 0x54, 0x03, 0xC0, 0x00, -+0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x01, 0x80, 0x00, 0x00, 0x80, 0x11, 0x12, 0x27, 0x54, -+0x03, 0xC0, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x01, 0xC0, 0x00, 0x00, 0x7F, 0x48, -+0x7E, 0x08, 0x71, 0x26, 0x90, 0xA6, 0x2B, 0xE0, 0x90, 0xA5, 0xFE, 0xB4, 0x01, 0x13, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x80, -+0x11, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0x7F, 0x00, 0x7E, 0x0A, 0x61, 0x01, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x00, 0x30, -+0x03, 0xC3, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x02, 0x71, 0x18, 0x12, 0x27, -+0x54, 0x40, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, 0x00, 0x7F, -+0xC4, 0x71, 0x1A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, 0x71, 0x04, 0x12, 0x27, 0x54, 0xF0, -+0x00, 0x00, 0x00, 0x90, 0xA6, 0x2B, 0x31, 0x34, 0x12, 0xAB, 0x54, 0x7F, 0x38, 0x71, 0x1A, 0x12, -+0x27, 0x54, 0x00, 0x1C, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x08, 0x00, 0x00, -+0x12, 0xBB, 0xB4, 0x60, 0x17, 0x12, 0x27, 0x54, 0x03, 0xC0, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, -+0x27, 0x54, 0x01, 0x40, 0x00, 0x00, 0x7F, 0x48, 0x7E, 0x08, 0x80, 0x15, 0x12, 0x27, 0x54, 0x03, -+0xC0, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x01, 0x80, 0x00, 0x00, 0x7F, 0x48, 0x7E, -+0x08, 0x71, 0x26, 0x22, 0x90, 0xA6, 0x2B, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x02, 0x12, -+0x27, 0x35, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x48, 0x7F, 0xAC, 0x7E, 0x08, 0x71, 0x26, 0x90, 0xA5, -+0xFE, 0x22, 0x7F, 0x2C, 0x7E, 0x08, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0xFC, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x36, 0xCE, 0x90, 0xA6, 0x06, 0x12, 0x27, 0x48, 0x90, 0xA5, -+0xFE, 0x12, 0x48, 0x4D, 0x12, 0x27, 0x15, 0x90, 0xA6, 0x06, 0xF1, 0xD6, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA5, 0xFE, 0x12, 0x48, 0x4D, 0x90, 0xA6, 0x02, 0xF1, 0xD6, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x77, 0x90, 0xA6, 0x0A, 0x12, 0x27, 0x48, -+0x90, 0xA6, 0x0A, 0x12, 0x66, 0x91, 0x90, 0xA5, 0xFC, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x37, -+0x5D, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA6, 0x8C, 0xED, 0xF0, 0xEF, 0x60, 0x02, 0x81, 0x54, -+0xE0, 0x24, 0xFD, 0x50, 0x0A, 0x60, 0x1E, 0x14, 0x60, 0x31, 0x14, 0x60, 0x6E, 0xA1, 0xDD, 0x90, -+0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x12, 0x67, 0x12, 0x12, 0x27, 0x54, 0x77, -+0x77, 0x77, 0x77, 0x81, 0xC9, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0x12, -+0x67, 0x12, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0xA1, 0x49, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x54, 0x77, 0x77, 0x77, 0x77, 0x12, 0x67, 0x12, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0xD1, -+0xDD, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x10, -+0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x71, 0x1C, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, -+0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x10, 0x00, 0x00, 0xA1, 0xD7, 0x90, 0xA5, 0xFE, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x77, 0xF1, -+0xBE, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0xD1, 0xDD, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, -+0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x71, -+0x1C, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0xA1, 0xD7, 0x90, 0xA6, 0x8C, 0xE0, 0x14, 0x60, 0x5A, 0x14, 0x70, 0x02, 0x81, 0xF5, -+0x14, 0x70, 0x02, 0xA1, 0x35, 0x14, 0x70, 0x02, 0x81, 0xF5, 0x14, 0x70, 0x02, 0xA1, 0x90, 0x24, -+0x05, 0x60, 0x02, 0xA1, 0xDD, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x12, -+0x67, 0x12, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0xD1, 0xDD, 0x12, 0x27, 0x54, 0x3F, 0xF0, -+0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, -+0x71, 0x1C, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x01, -+0x00, 0x00, 0x00, 0xA1, 0xD7, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x12, -+0x67, 0x12, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0xD1, 0xDD, 0x12, 0x27, 0x54, 0x3F, 0xF0, -+0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, -+0x71, 0x1C, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x00, 0xA1, 0xD7, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x77, 0x12, -+0x67, 0x12, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x77, 0xD1, 0xDD, 0x12, 0x27, 0x54, 0x3F, 0xF0, -+0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, -+0x71, 0x1C, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x01, -+0x00, 0x00, 0x00, 0xA1, 0xD7, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x17, 0x12, -+0x67, 0x12, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x17, 0xD1, 0xDD, 0x12, 0x27, 0x54, 0x3F, 0xF0, -+0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, -+0x71, 0x1C, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x01, -+0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0E, 0x71, 0x1C, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0x03, -+0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x09, 0x80, 0x4B, -+0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, -+0x00, 0x33, 0x00, 0x00, 0xF1, 0xBE, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x77, 0xD1, 0xDD, 0x12, -+0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, -+0x7F, 0xB4, 0x7E, 0x0C, 0x71, 0x1C, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA6, 0x02, -+0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0E, 0x71, 0x26, 0x22, 0x90, 0xA6, -+0x74, 0xED, 0xF0, 0x90, 0xA6, 0x73, 0xEF, 0xF0, 0x70, 0x75, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, -+0x30, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, -+0xFF, 0xFE, 0x71, 0x1C, 0x12, 0x27, 0x54, 0x00, 0x03, 0xE0, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, -+0x54, 0x00, 0x02, 0xE0, 0x00, 0x7F, 0x30, 0x71, 0x1A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, -+0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x34, 0x71, 0x1A, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x71, -+0x22, 0xF1, 0xC8, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, -+0x30, 0x00, 0x00, 0x00, 0xF1, 0x56, 0x90, 0x04, 0x54, 0xE0, 0x54, 0x7F, 0x02, 0xBC, 0x70, 0x90, -+0xA6, 0x73, 0xE0, 0x64, 0x01, 0x70, 0x75, 0x90, 0x04, 0x54, 0xE0, 0x44, 0x80, 0x12, 0xBC, 0x70, -+0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x71, 0x1C, 0x12, 0x27, 0x54, 0x00, 0x03, 0xE0, -+0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x02, 0xA0, 0x00, 0x7F, 0x30, 0x71, 0x1A, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x02, -+0x7F, 0x34, 0x71, 0x1A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0xA6, 0x02, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x01, 0x71, 0x22, 0xF1, 0xC8, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, -+0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0xF1, 0x56, 0x22, 0x7F, 0xB0, 0x7E, -+0x0E, 0x12, 0x37, 0x5D, 0x90, 0xA5, 0xFE, 0x22, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x80, 0x00, -+0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x71, 0x22, 0x90, 0x05, -+0x22, 0x74, 0x3F, 0xF0, 0x90, 0x05, 0x50, 0xE0, 0x54, 0xF7, 0xF0, 0xA3, 0xE0, 0x54, 0xF7, 0xF0, -+0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x71, 0x1C, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x0F, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x0C, 0x7F, 0x38, 0x71, 0x1A, 0x12, -+0x27, 0x54, 0xFF, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x0F, -+0x7F, 0x04, 0x7E, 0x0A, 0x61, 0x26, 0x74, 0x08, 0xFF, 0xFE, 0x61, 0x26, 0x12, 0x97, 0x77, 0x12, -+0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, -+0x71, 0x22, 0x7D, 0x65, 0xF1, 0xAA, 0x12, 0x48, 0x0F, 0x7D, 0x8F, 0xF1, 0xAA, 0xF1, 0xDC, 0xF1, -+0xAB, 0x90, 0x00, 0x08, 0x12, 0x48, 0x29, 0x7D, 0x65, 0xF1, 0xB4, 0x12, 0x48, 0x0F, 0x7D, 0x8F, -+0xF1, 0xB4, 0xF1, 0xDC, 0xF1, 0xB4, 0x90, 0x00, 0x08, 0x02, 0x48, 0x29, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0xF1, 0xEB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFF, 0xF1, 0x9C, 0x90, 0xA4, -+0xB1, 0x02, 0x48, 0x71, 0x7F, 0x01, 0xF1, 0x9C, 0x90, 0xA4, 0xB4, 0x02, 0x48, 0x71, 0x7F, 0xB0, -+0x7E, 0x0C, 0x71, 0x26, 0x90, 0xAC, 0xB9, 0x22, 0x90, 0xA6, 0x73, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, -+0x71, 0x86, 0x90, 0xA5, 0xFE, 0x22, 0x12, 0x48, 0x59, 0x02, 0x47, 0x6A, 0x90, 0x00, 0x04, 0x12, -+0x48, 0x29, 0xE4, 0xFD, 0x22, 0x7F, 0xAC, 0x7E, 0x08, 0x61, 0x26, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0xA6, 0x16, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xFB, 0x7D, 0x00, 0x7C, 0x00, 0xE4, -+0x90, 0xA6, 0x1C, 0xF0, 0xEB, 0x90, 0xA6, 0x17, 0xF0, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x36, 0xCE, -+0xE4, 0xFF, 0xEC, 0x90, 0xA6, 0x18, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x18, 0x12, 0x48, 0x59, 0x90, -+0xA6, 0x17, 0x12, 0x71, 0x34, 0x12, 0x47, 0x77, 0xA3, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x18, 0x12, -+0x66, 0x91, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x11, 0x5F, 0x90, 0xA6, 0x16, 0xE0, 0x75, -+0xF0, 0x08, 0xA4, 0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0xAF, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, -+0xFF, 0x12, 0x36, 0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, -+0x14, 0x7E, 0x00, 0x02, 0x3A, 0xF7, 0x90, 0xA6, 0x6A, 0x31, 0x83, 0x90, 0x01, 0x09, 0xE0, 0x7F, -+0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0xA6, 0x6A, 0xE0, 0x6F, 0x60, 0x35, 0xC3, 0x90, 0xA6, -+0x6C, 0xE0, 0x94, 0x88, 0x90, 0xA6, 0x6B, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, -+0x44, 0x10, 0xF0, 0x22, 0x90, 0xA6, 0x6B, 0x12, 0x58, 0xB1, 0x11, 0x5F, 0xD3, 0x90, 0xA6, 0x6C, -+0xE0, 0x94, 0x32, 0x90, 0xA6, 0x6B, 0xE0, 0x94, 0x00, 0x40, 0xC0, 0x90, 0x01, 0xC6, 0xE0, 0x30, -+0xE0, 0xB9, 0x22, 0x12, 0xA0, 0x9A, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, -+0x3A, 0x96, 0xE4, 0xFF, 0x11, 0x66, 0x90, 0xA1, 0x29, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, -+0xE0, 0x54, 0x7F, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0xA2, 0xEB, 0xE0, 0x54, 0xEF, 0xF0, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0x24, 0x11, 0xB3, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0xA2, 0xF2, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x08, 0x12, 0xB9, 0xCE, 0xBF, 0x01, -+0x02, 0x11, 0xE1, 0x22, 0x90, 0xA2, 0xEA, 0xE0, 0x30, 0xE0, 0x18, 0x90, 0xA2, 0xE5, 0xE0, 0xFF, -+0x30, 0xE0, 0x0E, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xF1, 0xD7, 0xBF, 0x01, 0x06, 0x80, 0x02, 0x80, -+0x00, 0x11, 0xF1, 0x22, 0x90, 0xA2, 0xEB, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA1, 0x29, 0xE0, 0xB4, -+0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0xA2, -+0xFA, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x3A, 0x96, 0x90, 0xA2, 0xF0, 0xE0, 0x60, 0x12, 0x90, 0x01, -+0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, -+0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0x7F, 0x01, 0x11, 0x66, -+0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x3A, 0x96, 0x7F, 0x14, 0x7E, 0x00, -+0x02, 0x3A, 0xF7, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0xA4, -+0x4A, 0xF0, 0xF4, 0x60, 0x18, 0xE0, 0x90, 0xA4, 0x2F, 0x12, 0x4F, 0x2C, 0x75, 0xF0, 0x0A, 0xA4, -+0xFF, 0x90, 0xA4, 0x30, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0x02, 0x89, 0xAC, 0x90, 0xA4, 0x4A, -+0xE0, 0x90, 0xA4, 0x2F, 0x31, 0x84, 0x90, 0x01, 0x5F, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0xA6, 0x3F, 0xEE, 0xF0, 0xA3, 0x31, 0x83, 0x90, 0xA6, 0x3F, 0x71, 0xA4, 0xE0, -+0x60, 0x29, 0xC3, 0x90, 0xA6, 0x42, 0xE0, 0x94, 0xE8, 0x90, 0xA6, 0x41, 0xE0, 0x94, 0x03, 0x40, -+0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x11, 0x90, 0xA6, 0x41, 0x12, -+0x58, 0xB1, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x80, 0xCF, 0x7F, 0x01, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x47, 0x12, 0x48, 0x7A, 0x7F, -+0x96, 0x7E, 0x02, 0x31, 0xBB, 0xEF, 0x60, 0x51, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, -+0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, 0xFE, -+0x90, 0xA6, 0x4A, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0xA6, 0x4A, 0xE0, 0xFD, -+0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA6, 0x47, 0x71, 0x9B, 0x24, 0x02, 0xFF, 0xE4, -+0x33, 0xFE, 0x51, 0x6E, 0x90, 0xA6, 0x4A, 0xE0, 0x24, 0x18, 0xFF, 0x90, 0xA6, 0x47, 0x12, 0x48, -+0x71, 0x71, 0x2C, 0x90, 0x02, 0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFC, -+0xED, 0x2C, 0x24, 0x00, 0x51, 0xBF, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xF3, 0x74, 0x00, 0x2D, -+0x51, 0xBF, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, -+0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, -+0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, -+0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xF5, -+0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, -+0x90, 0xA2, 0xD0, 0xE0, 0xFE, 0x90, 0xA2, 0xCF, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, -+0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, 0x3F, 0xED, 0x71, 0xAD, 0xFA, 0x7B, 0x01, 0x51, 0x02, -+0x7F, 0x01, 0xEF, 0x60, 0x32, 0x90, 0xA2, 0xCF, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, -+0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA2, 0xCF, 0xF0, 0x90, 0xA2, 0xD0, 0xE0, 0xFF, -+0x90, 0xA2, 0xCF, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x07, -+0x90, 0xA1, 0x23, 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA6, 0x43, 0xEF, -+0xF0, 0xA3, 0x12, 0x48, 0x7A, 0x90, 0xA6, 0x7A, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, -+0x12, 0x26, 0x76, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, -+0x02, 0xC0, 0x01, 0x90, 0xA6, 0x44, 0x12, 0x48, 0x71, 0x12, 0x4F, 0xF5, 0x75, 0x43, 0x02, 0xD0, -+0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0xA6, 0x43, 0xE0, 0x24, 0x02, 0xF9, 0xE4, -+0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x48, 0x71, 0xE9, -+0x24, 0x02, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0xA6, 0x44, 0x71, 0x9B, -+0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x2C, 0x12, 0x48, 0x71, 0x90, 0x00, -+0x0E, 0x02, 0x26, 0x37, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x75, 0xF0, 0x0F, -+0xA4, 0x24, 0x39, 0xF9, 0x74, 0xA2, 0x35, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA2, 0xCF, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, -+0x90, 0xA2, 0xD0, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, -+0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x28, 0xC0, 0x01, 0x90, 0xA2, 0xD0, 0xE0, 0x71, -+0xAD, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x46, 0xB0, 0x90, -+0xA2, 0xD0, 0xF1, 0xA1, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA2, 0xD0, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x8F, 0x11, 0x90, 0xA4, 0x4A, 0x74, 0x0E, 0xF0, 0xED, 0x24, -+0xFE, 0x60, 0x6D, 0x04, 0x60, 0x02, 0x81, 0xEB, 0xB1, 0x9D, 0x74, 0x0C, 0xF0, 0x74, 0x11, 0x25, -+0x11, 0x12, 0x6D, 0x68, 0x90, 0xA4, 0x4D, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x11, 0x12, 0x4F, 0x24, -+0xFD, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA4, 0x4E, 0xF0, 0xED, 0x12, 0x4F, 0x6F, 0xA3, 0xF0, 0x75, -+0xF0, 0x04, 0xE5, 0x11, 0x12, 0x4F, 0x24, 0xFF, 0xC4, 0x54, 0x03, 0x90, 0xA4, 0x50, 0xF0, 0x75, -+0xF0, 0x04, 0xE5, 0x11, 0x12, 0x57, 0x7E, 0xE0, 0x90, 0xA4, 0x51, 0xF0, 0x75, 0xF0, 0x04, 0xE5, -+0x11, 0x12, 0x57, 0x6C, 0xE0, 0x90, 0xA4, 0x52, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x11, 0x12, 0x4F, -+0xB1, 0xFD, 0xC4, 0x13, 0x54, 0x01, 0x90, 0xA4, 0x53, 0xF0, 0xED, 0x54, 0x1F, 0xA3, 0x80, 0x57, -+0xB1, 0x9D, 0x74, 0x0D, 0x91, 0xEC, 0x12, 0x54, 0x7C, 0xE0, 0x90, 0xA4, 0x4D, 0x91, 0xEC, 0x90, -+0x89, 0x01, 0x12, 0x48, 0x65, 0xE0, 0x90, 0xA4, 0x4E, 0x91, 0xEC, 0x90, 0x89, 0x02, 0x12, 0x48, -+0x65, 0xE0, 0x90, 0xA4, 0x4F, 0x91, 0xEC, 0x90, 0x89, 0x03, 0x12, 0x48, 0x65, 0xE0, 0x90, 0xA4, -+0x50, 0x91, 0xEC, 0xF1, 0xB0, 0x90, 0xA4, 0x51, 0x91, 0xEC, 0x90, 0x89, 0x05, 0x12, 0x48, 0x65, -+0xE0, 0x90, 0xA4, 0x52, 0x91, 0xEC, 0x90, 0x89, 0x06, 0x12, 0x48, 0x65, 0xE0, 0x90, 0xA4, 0x53, -+0x91, 0xEC, 0xF1, 0xA8, 0x90, 0xA4, 0x54, 0x91, 0xF3, 0xB1, 0xBF, 0x22, 0xF0, 0x75, 0xF0, 0x08, -+0xE5, 0x11, 0x22, 0xF0, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x4A, 0x22, 0x91, 0xF4, 0x7F, 0xF5, 0x7E, -+0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, 0x06, 0x90, 0xA4, 0x4A, 0xE0, 0xA3, 0xF0, 0x91, 0xF4, 0x7F, -+0xF6, 0x7E, 0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, 0x08, 0x90, 0xA4, 0x4A, 0xE0, 0x90, 0xA4, 0x4C, -+0xF0, 0x91, 0xF4, 0x7F, 0xF4, 0x7E, 0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, 0x08, 0x90, 0xA4, 0x4A, -+0xE0, 0x90, 0xA4, 0x4D, 0xF0, 0x91, 0xF4, 0x7F, 0xF3, 0x7E, 0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, -+0x08, 0x90, 0xA4, 0x4A, 0xE0, 0x90, 0xA4, 0x4E, 0xF0, 0x91, 0xF4, 0x7F, 0xF2, 0x7E, 0x03, 0x12, -+0x33, 0xC7, 0xBF, 0x01, 0x08, 0x90, 0xA4, 0x4A, 0xE0, 0x90, 0xA4, 0x4F, 0xF0, 0x90, 0xA4, 0x4B, -+0xF1, 0xB8, 0xA3, 0xE0, 0x90, 0xA4, 0x53, 0xF0, 0x90, 0xA4, 0x4F, 0xE0, 0x90, 0xA4, 0x54, 0xF0, -+0x90, 0xA4, 0x55, 0x74, 0x12, 0xF0, 0x90, 0xA4, 0x63, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x57, 0xF1, -+0xCE, 0x90, 0xA4, 0x53, 0xE0, 0x90, 0xA4, 0x5A, 0xF0, 0x90, 0xA4, 0x54, 0xE0, 0x90, 0xA4, 0x5B, -+0xF0, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x55, 0x71, 0xB9, 0x7F, 0x04, 0x80, 0x26, 0x90, 0xA4, 0x58, -+0x74, 0x09, 0xF0, 0x90, 0xA4, 0x4C, 0x22, 0x90, 0xA4, 0x4A, 0x74, 0x11, 0xF0, 0x90, 0xA4, 0x58, -+0x74, 0x01, 0xF0, 0x90, 0xA4, 0x4C, 0xEF, 0x91, 0xF3, 0x71, 0xB9, 0x7F, 0x04, 0x80, 0x04, 0x71, -+0xB9, 0x7F, 0x04, 0x90, 0xA6, 0x89, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x4B, 0x3C, 0x90, 0xA1, 0x23, -+0xE0, 0xFF, 0x90, 0xA6, 0x89, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0xA1, 0x23, 0xF0, 0x22, 0xFB, 0xAD, -+0x75, 0xAF, 0x74, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0xDC, 0xED, 0xF0, 0xA3, -+0xEF, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA5, 0xD9, 0xE0, 0x90, 0xA5, 0xDF, 0xF0, 0x90, 0xA5, 0xDA, -+0x74, 0x0C, 0xF0, 0x90, 0xA5, 0xE8, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0xDA, 0xB1, -+0xBF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0xA4, 0x5F, 0xF0, 0x90, 0xA4, 0x5F, 0xE0, 0xFF, -+0xC3, 0x94, 0x06, 0x50, 0x5D, 0x74, 0x32, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, -+0xFF, 0xD3, 0x94, 0x0A, 0x50, 0x02, 0x80, 0x02, 0x7F, 0x0A, 0xAE, 0x07, 0xEF, 0x24, 0x02, 0x90, -+0xA4, 0x5E, 0xF0, 0x90, 0xA4, 0x50, 0x74, 0x0E, 0xF0, 0x90, 0xA4, 0x52, 0x74, 0x01, 0xF0, 0xD1, -+0x83, 0x90, 0xA4, 0x53, 0xF0, 0xE4, 0xFF, 0xEF, 0xC3, 0x9E, 0x50, 0x16, 0xD1, 0x83, 0x2F, 0xF1, -+0xC1, 0xE0, 0xFD, 0x74, 0x54, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xED, 0xF0, 0x0F, -+0x80, 0xE5, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x50, 0xB1, 0xBF, 0x90, 0xA4, 0x5F, 0xE0, 0x04, 0xF0, -+0x80, 0x99, 0x22, 0x90, 0xA4, 0x5F, 0xE0, 0x24, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, -+0xE0, 0x22, 0x90, 0xA5, 0x11, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, 0x25, 0xA3, 0xE0, 0xF5, -+0x26, 0x65, 0x25, 0x60, 0x6A, 0x90, 0xA5, 0x12, 0x74, 0x03, 0xF0, 0x90, 0xA5, 0x20, 0x74, 0x08, -+0xF0, 0xE5, 0x26, 0x04, 0x54, 0x0F, 0xF5, 0x27, 0xE4, 0xF5, 0x24, 0xE5, 0x27, 0x75, 0xF0, 0x08, -+0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x24, 0x12, 0x52, -+0x41, 0xE0, 0xFF, 0x74, 0x14, 0x25, 0x24, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xEF, 0xF0, -+0x05, 0x24, 0xE5, 0x24, 0xB4, 0x08, 0xD4, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x12, 0x71, 0xB9, 0xE5, -+0x26, 0x04, 0x54, 0x0F, 0xF5, 0x26, 0xB4, 0x0F, 0x03, 0xE4, 0xF5, 0x26, 0x90, 0x04, 0x7F, 0xE5, -+0x26, 0xF0, 0x90, 0xA5, 0x11, 0xE0, 0x7F, 0x04, 0x70, 0x03, 0x02, 0x86, 0xCD, 0xB1, 0xC3, 0x22, -+0x12, 0x4F, 0xE8, 0x90, 0xA3, 0x82, 0x12, 0x4F, 0x2C, 0x90, 0xA3, 0x83, 0xF0, 0xF1, 0x23, 0x7F, -+0x01, 0xA1, 0xA7, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0x91, 0x7A, 0xA4, 0x79, 0x4A, -+0x12, 0x97, 0x1E, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x81, 0xF1, 0x97, 0x7A, 0xA4, 0x79, 0x69, 0x12, -+0x95, 0x1F, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0xA5, 0xF1, 0x97, 0x7A, 0xA4, 0x79, 0x99, 0x12, 0x77, -+0x5C, 0x12, 0x76, 0xE8, 0xE4, 0xFF, 0x12, 0xAE, 0x72, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x99, 0xE4, -+0xFF, 0x12, 0xAE, 0x01, 0x7F, 0x01, 0x12, 0xAE, 0x72, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0xA5, 0x7F, -+0x01, 0x12, 0xAE, 0x01, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x81, 0xF1, 0x97, 0x7A, 0xA4, 0x79, 0x69, -+0x12, 0x95, 0x66, 0xF1, 0x91, 0x7A, 0xA4, 0x79, 0x4A, 0x12, 0xAD, 0x83, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x4D, 0x90, 0xA4, 0xB4, 0x02, 0x48, 0x7A, 0xE4, 0xFF, 0xC1, -+0x92, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0x22, 0x90, 0x89, 0x07, 0x12, 0x48, 0x65, 0xE0, 0x22, -+0x90, 0x89, 0x04, 0x12, 0x48, 0x65, 0xE0, 0x22, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, -+0x22, 0x24, 0x8C, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x22, 0x90, 0xA2, 0xE8, 0xE0, 0x64, 0x02, 0x7F, 0x01, 0x60, -+0x02, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, -+0xA5, 0x05, 0x12, 0x48, 0x4D, 0x90, 0xAC, 0x9C, 0x12, 0x27, 0x48, 0xD0, 0x05, 0xD0, 0x07, 0x12, -+0x32, 0x65, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, -+0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, 0x74, 0x80, 0xA3, 0xF0, 0x11, 0x56, -+0x74, 0x07, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x80, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, -+0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, -+0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x53, 0xE4, 0xFD, 0x7F, 0x01, -+0x12, 0x39, 0x33, 0xE5, 0x51, 0x52, 0x53, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x54, 0x7D, 0x01, 0x7F, -+0x01, 0x12, 0x39, 0x33, 0xE5, 0x52, 0x52, 0x54, 0xAB, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, -+0x04, 0xAB, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x02, 0x39, 0x04, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, -+0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x8A, 0xF0, 0x74, 0x80, 0xA3, -+0xF0, 0x11, 0xD9, 0x74, 0x8A, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x80, 0xA3, 0xF0, 0xD0, 0x07, -+0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, -+0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x00, 0x54, 0xE0, 0x55, 0x55, 0xF5, -+0x59, 0xA3, 0xE0, 0x55, 0x56, 0xF5, 0x5A, 0xA3, 0xE0, 0x55, 0x57, 0xF5, 0x5B, 0xA3, 0xE0, 0x55, -+0x58, 0xF5, 0x5C, 0xAD, 0x59, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0xAD, 0x5A, 0x7F, 0x55, 0x12, 0x3A, -+0x96, 0xAD, 0x5B, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0xAD, 0x5C, 0x7F, 0x57, 0x12, 0x3A, 0x96, 0x53, -+0x91, 0xEF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, -+0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0x01, 0xC4, 0x74, 0x13, 0xF0, 0x74, 0x81, 0xA3, 0xF0, 0x12, 0x99, 0x9B, 0xE5, 0x61, 0x30, -+0xE1, 0x03, 0x12, 0x7F, 0x9D, 0xE5, 0x61, 0x30, 0xE4, 0x02, 0xD1, 0xC9, 0xE5, 0x61, 0x30, 0xE5, -+0x03, 0x12, 0x99, 0xF8, 0xE5, 0x61, 0x30, 0xE6, 0x03, 0x12, 0x9A, 0x34, 0xE5, 0x63, 0x30, 0xE0, -+0x03, 0x12, 0x9A, 0x41, 0xE5, 0x63, 0x30, 0xE1, 0x03, 0x12, 0x9C, 0x65, 0xE5, 0x63, 0x30, 0xE2, -+0x03, 0x12, 0x9B, 0xFB, 0xE5, 0x63, 0x30, 0xE3, 0x03, 0x12, 0x8D, 0x52, 0xE5, 0x63, 0x30, 0xE4, -+0x03, 0x12, 0x8D, 0x6D, 0xE5, 0x63, 0x30, 0xE5, 0x03, 0x12, 0x8F, 0xA7, 0xE5, 0x63, 0x30, 0xE6, -+0x03, 0x12, 0x9F, 0xBC, 0xE5, 0x64, 0x30, 0xE1, 0x03, 0x12, 0x9A, 0x9A, 0xE5, 0x64, 0x30, 0xE4, -+0x02, 0xF1, 0x4C, 0xE5, 0x64, 0x30, 0xE5, 0x02, 0x31, 0xD7, 0xE5, 0x64, 0x30, 0xE6, 0x02, 0xD1, -+0xEB, 0x74, 0x13, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x81, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, -+0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, -+0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, 0xF5, 0x24, 0x90, 0xA2, 0xE4, 0xE0, 0xFF, 0xE5, -+0x24, 0xC3, 0x9F, 0x40, 0x02, 0x61, 0x00, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0xAF, 0x24, 0x12, -+0x8B, 0xC2, 0xEF, 0x70, 0x02, 0x41, 0xFC, 0xE5, 0x24, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xF5, 0x25, -+0xE5, 0x24, 0x54, 0x07, 0xF5, 0x26, 0x74, 0x81, 0x25, 0x25, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, -+0x83, 0xE0, 0xFD, 0x91, 0xC6, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, -+0x5D, 0x70, 0x02, 0x41, 0xFC, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x12, 0x6F, 0x3C, 0xE0, 0x20, 0xE7, -+0x02, 0x80, 0x10, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, 0x02, 0x12, 0x48, 0x65, 0xE0, 0xFF, -+0x20, 0xE7, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x20, 0xF0, 0x41, 0xFC, 0x75, 0xF0, 0x04, 0xE5, -+0x24, 0x12, 0x6F, 0x47, 0xE0, 0x54, 0x07, 0x44, 0x50, 0xF0, 0xEF, 0x30, 0xE6, 0x35, 0x71, 0x01, -+0x91, 0xD7, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, -+0x12, 0x6F, 0x69, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x24, 0x12, 0x4F, 0x24, 0x91, 0xBF, 0xE4, -+0xFB, 0xAF, 0x24, 0x71, 0x1D, 0x75, 0xF0, 0x04, 0xE5, 0x24, 0x12, 0x6F, 0x47, 0xE0, 0x54, 0xF8, -+0xF0, 0x80, 0x69, 0x71, 0x0D, 0xE0, 0x04, 0xF0, 0x71, 0x0D, 0xE0, 0xD3, 0x94, 0x01, 0x40, 0x42, -+0xAF, 0x24, 0x91, 0xFB, 0x71, 0x0D, 0xE4, 0xF0, 0x71, 0x01, 0xE0, 0xFD, 0xFB, 0x7A, 0x00, 0x91, -+0xC6, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x8F, 0xD4, 0x4E, 0x70, 0x13, -+0x71, 0x01, 0xAF, 0x26, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4D, -+0xF0, 0x80, 0x29, 0x71, 0x01, 0x91, 0xD7, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xF0, -+0x80, 0x1A, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x12, 0x6F, 0x69, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, -+0x24, 0x12, 0x4F, 0x24, 0x91, 0xBF, 0x7B, 0x01, 0xAF, 0x24, 0x71, 0x1D, 0x05, 0x24, 0x21, 0xDA, -+0x22, 0x74, 0x11, 0x25, 0x25, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0x22, 0x74, 0xA2, 0x25, -+0x24, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0x22, 0xAD, 0x1C, 0xAF, 0x1A, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x74, 0x8D, 0x75, 0x8B, 0x76, 0xE4, 0x90, 0xA6, 0x13, 0xF0, 0xE5, -+0x74, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA6, 0x0E, 0xF0, 0xE5, 0x74, 0x54, 0x07, 0x90, 0xA6, -+0x10, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x12, 0x6F, 0x3C, 0xE0, 0x90, 0xA6, 0x11, 0x12, 0x57, 0x79, -+0xE0, 0x54, 0x7F, 0x90, 0xA6, 0x14, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x74, 0x12, 0x57, 0x6C, 0xE0, -+0x90, 0xA6, 0x15, 0xF0, 0x91, 0xCE, 0xE5, 0x76, 0x70, 0x43, 0xE5, 0x74, 0x60, 0x05, 0xC3, 0x94, -+0x04, 0x40, 0x08, 0xE4, 0x90, 0xA5, 0xD9, 0xF0, 0x12, 0x7D, 0xDE, 0x90, 0xA6, 0x0F, 0xE0, 0xFF, -+0x25, 0xE0, 0x24, 0xE9, 0xF5, 0x82, 0xE4, 0x34, 0x42, 0x12, 0xAD, 0xF8, 0xFD, 0xEF, 0x12, 0x6F, -+0x87, 0xF5, 0x83, 0x74, 0x01, 0x93, 0x2D, 0xFF, 0xE4, 0x93, 0x3C, 0xC3, 0x13, 0xFE, 0xEF, 0x13, -+0xFF, 0xE5, 0x74, 0x12, 0x91, 0x17, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x80, 0x15, 0xE5, 0x76, 0xB4, -+0x01, 0x10, 0x90, 0xA1, 0x2A, 0xE0, 0x60, 0x0A, 0x90, 0xA5, 0xD9, 0x74, 0x05, 0xF0, 0xE4, 0x12, -+0x7D, 0xDE, 0x90, 0xA6, 0x14, 0xE0, 0xFF, 0x90, 0xA6, 0x0F, 0xE0, 0xFE, 0xD3, 0x9F, 0x40, 0x0B, -+0xE5, 0x75, 0x54, 0x80, 0xFD, 0xEF, 0x4D, 0xF5, 0x75, 0x80, 0x0C, 0x90, 0xA6, 0x15, 0xE0, 0xFF, -+0xEE, 0xC3, 0x9F, 0x50, 0x02, 0x8F, 0x75, 0x91, 0xCE, 0xE5, 0x75, 0x54, 0x80, 0x90, 0xA6, 0x12, -+0xF0, 0xE5, 0x76, 0x70, 0x2B, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0x91, 0xE1, 0xF5, 0x83, 0xC0, -+0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA6, 0x10, 0x91, 0xF3, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -+0xF4, 0x5F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA6, 0x11, 0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x53, -+0x74, 0x91, 0x25, 0x74, 0x12, 0x56, 0x01, 0xE0, 0x90, 0x04, 0xCF, 0x30, 0xE0, 0x05, 0x74, 0x20, -+0xF0, 0x80, 0x03, 0x74, 0x10, 0xF0, 0x91, 0xE1, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, -+0x90, 0xA6, 0x10, 0x91, 0xF3, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xD0, 0x82, 0xD0, 0x83, -+0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x74, 0x12, 0x6F, 0x3C, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0xA6, 0x11, -+0xF0, 0x90, 0xA6, 0x0F, 0xE0, 0x90, 0x43, 0x9D, 0x93, 0x12, 0xBD, 0x26, 0x90, 0xA6, 0x11, 0xF0, -+0x44, 0x80, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x74, 0x12, 0x6F, 0x69, 0xE5, 0x75, 0xF0, 0xE5, 0x74, -+0x70, 0x06, 0x90, 0x01, 0xC8, 0xE5, 0x75, 0xF0, 0x90, 0xA6, 0x11, 0xE0, 0xFF, 0x75, 0xF0, 0x10, -+0xE5, 0x74, 0x12, 0x6F, 0x3C, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x74, 0x12, 0x6F, 0x74, 0xE0, -+0x54, 0xFC, 0xFF, 0xE5, 0x77, 0x54, 0x03, 0x4F, 0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x74, 0x12, 0x6F, -+0x74, 0xEF, 0xF0, 0x7D, 0x01, 0xAF, 0x74, 0x12, 0x88, 0x76, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x13, -+0x13, 0x54, 0x03, 0xF5, 0x77, 0x22, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x26, 0x08, 0x22, 0xE5, 0x75, -+0x54, 0x7F, 0x90, 0xA6, 0x0F, 0xF0, 0x22, 0xE0, 0xFF, 0xAE, 0x26, 0x74, 0x01, 0xA8, 0x06, 0x08, -+0x22, 0x90, 0xA6, 0x0E, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0x22, 0x75, 0xF0, 0x03, -+0x12, 0x48, 0x65, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, 0xAC, 0x07, 0x75, 0xF0, 0x04, -+0xEC, 0x90, 0x96, 0x14, 0x12, 0x48, 0x65, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0x57, 0x7E, 0xE0, 0xFA, -+0x74, 0x22, 0x2C, 0x12, 0x6F, 0xE0, 0xE0, 0x54, 0x7F, 0xFD, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0x6F, -+0x47, 0xE0, 0xFF, 0x54, 0xF8, 0xFE, 0xEF, 0x04, 0x54, 0x07, 0x4E, 0xF0, 0x75, 0xF0, 0x04, 0xEC, -+0x12, 0x6F, 0x47, 0xE0, 0xFF, 0x54, 0x07, 0xD3, 0x94, 0x02, 0x40, 0x48, 0x74, 0xA2, 0x2C, 0x12, -+0x6D, 0x80, 0xE0, 0xF4, 0x70, 0x3E, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0x6F, 0x47, 0xEF, 0x54, 0xF8, -+0xF0, 0x74, 0x11, 0x2C, 0x12, 0x6D, 0x68, 0x54, 0x7F, 0xFF, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0xBB, -+0xEF, 0x54, 0x80, 0x4F, 0xF0, 0x74, 0x11, 0x2C, 0x12, 0x6D, 0x68, 0x25, 0xE0, 0xFF, 0xE4, 0x33, -+0xFE, 0xEF, 0x24, 0x32, 0xFF, 0xE4, 0x3E, 0xFE, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0x6F, 0x7F, 0xEE, -+0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x22, 0x2C, 0x12, 0x97, 0x9C, 0xE0, 0xFB, 0x12, 0x97, 0x95, 0xFF, -+0x75, 0xF0, 0x04, 0xEC, 0x12, 0x4F, 0x24, 0x54, 0xF3, 0x4F, 0xF0, 0xED, 0xD3, 0x9A, 0x40, 0x02, -+0xAD, 0x02, 0x74, 0x22, 0x2C, 0x12, 0x6F, 0xE0, 0xE0, 0x54, 0x80, 0x42, 0x05, 0xAF, 0x04, 0x8B, -+0x77, 0xE4, 0xFB, 0x61, 0x1D, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0xA6, 0x7D, 0xF0, 0x90, -+0xA6, 0x7D, 0xE0, 0xFD, 0x70, 0x02, 0xC1, 0xBF, 0x90, 0xA2, 0x37, 0xE0, 0xFF, 0x70, 0x06, 0xA3, -+0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA2, 0x38, 0xE0, 0xB5, 0x07, 0x04, 0x7F, -+0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, -+0x90, 0xA6, 0x79, 0x12, 0x8F, 0xC9, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -+0xEF, 0x5D, 0x70, 0x02, 0xC1, 0xA2, 0xE4, 0x90, 0xA6, 0x7E, 0xF0, 0x90, 0xA6, 0x7E, 0xE0, 0xF9, -+0xC3, 0x94, 0x04, 0x50, 0x42, 0xD1, 0xC1, 0xA4, 0xFF, 0xE9, 0xFD, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, -+0x35, 0xF0, 0xFE, 0x74, 0xD0, 0xD1, 0xDC, 0x12, 0x98, 0xB3, 0xE5, 0x82, 0x29, 0x12, 0x52, 0x41, -+0xEF, 0xD1, 0xC0, 0xA4, 0x2D, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xF0, 0xD1, 0xDC, 0x75, 0xF0, -+0x08, 0x90, 0xA1, 0xEB, 0x12, 0x48, 0x65, 0xE5, 0x82, 0x29, 0x12, 0x52, 0x41, 0xEF, 0xF0, 0x90, -+0xA6, 0x7E, 0xE0, 0x04, 0xF0, 0x80, 0xB4, 0x90, 0xA6, 0x7D, 0xE0, 0xFF, 0x90, 0xA6, 0x79, 0x91, -+0xF3, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0xA6, 0x7D, 0xF0, 0x90, 0xA6, 0x79, -+0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, -+0xF0, 0x90, 0xA6, 0x79, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0xA2, 0x38, 0x12, 0x7F, -+0xA1, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0xA1, 0xBF, 0xE4, 0x90, 0xA2, 0x38, 0xF0, -+0xA1, 0xBF, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0xA6, 0x79, 0xE0, 0x44, 0x80, 0x90, -+0x00, 0x8A, 0xD1, 0xC0, 0x90, 0x01, 0xD0, 0x12, 0x48, 0x65, 0xE0, 0x90, 0x01, 0xC3, 0xF0, 0x22, -+0xF0, 0x90, 0xA6, 0x79, 0xE0, 0x75, 0xF0, 0x04, 0x22, 0xB1, 0xB5, 0x7F, 0x02, 0x8F, 0x78, 0x7F, -+0x02, 0x12, 0x4B, 0x3C, 0x90, 0xA1, 0x23, 0xE0, 0x45, 0x78, 0xF0, 0x22, 0x2F, 0xF5, 0x82, 0x74, -+0x01, 0x3E, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA2, 0x38, 0xE0, 0x22, 0x90, 0x07, 0x1F, 0xE0, 0x54, -+0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0xFF, 0x60, 0x2F, 0x90, 0xA4, 0x36, 0xE0, 0x60, -+0x29, 0x90, 0xA4, 0x33, 0xE0, 0x54, 0x03, 0x14, 0x60, 0x10, 0x14, 0x60, 0x16, 0x24, 0x02, 0x70, -+0x19, 0x90, 0x04, 0x2D, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x10, 0x90, 0x04, 0x2D, 0xE0, 0x44, 0x06, -+0xF0, 0x80, 0x07, 0x90, 0x04, 0x2D, 0xE0, 0x44, 0x0E, 0xF0, 0xE4, 0x90, 0xA4, 0x36, 0xF0, 0x90, -+0xA5, 0x13, 0xEF, 0xF0, 0x90, 0xA5, 0x11, 0x74, 0x02, 0xF0, 0x90, 0xA5, 0x1F, 0x14, 0xF0, 0xFB, -+0x7A, 0xA5, 0x79, 0x11, 0x12, 0x7B, 0xB9, 0x7F, 0x04, 0x02, 0x7D, 0xC3, 0xE4, 0xFF, 0x90, 0xA5, -+0x25, 0xEF, 0xF0, 0x90, 0xA2, 0xE4, 0xE0, 0x90, 0xA5, 0xA7, 0xF0, 0xE4, 0x90, 0xA5, 0x26, 0xF0, -+0x90, 0xA5, 0xA7, 0xE0, 0xFE, 0x90, 0xA5, 0x26, 0xE0, 0xFF, 0xC3, 0x9E, 0x50, 0x31, 0xE0, 0xFE, -+0x12, 0xBC, 0x14, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xEE, 0x12, 0x88, 0xDA, 0xE0, 0x30, 0xE7, 0x0A, -+0x74, 0x81, 0x2F, 0x12, 0x88, 0x59, 0xE4, 0xF0, 0x80, 0x0D, 0x12, 0x88, 0xFA, 0x90, 0xA5, 0x26, -+0xE0, 0x12, 0xBC, 0x14, 0x74, 0x01, 0xF0, 0x90, 0xA5, 0x26, 0xE0, 0x04, 0xF0, 0x80, 0xC1, 0x7F, -+0x0C, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xE4, 0x90, 0xA5, 0x26, 0xF0, 0x90, 0xA5, 0xA7, 0xE0, 0xFF, -+0x90, 0xA5, 0x26, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x03, 0x02, 0x88, 0x58, 0x74, 0x27, 0x2E, 0x12, -+0xBC, 0x16, 0xE0, 0x70, 0x03, 0x02, 0x88, 0x4F, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x06, 0x12, -+0x88, 0x61, 0xEE, 0x90, 0x81, 0x07, 0x12, 0x88, 0xE0, 0xFC, 0x12, 0x88, 0xEE, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x0A, 0x12, 0x88, 0x61, 0xEC, 0x90, 0x81, 0x0B, -+0x12, 0x88, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x12, 0x48, 0x65, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0x7F, 0x01, 0x90, 0xA5, 0x26, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x0B, 0x12, 0x52, -+0x3B, 0xE0, 0xFD, 0x75, 0xF0, 0x0A, 0xEE, 0x12, 0x57, 0x92, 0xED, 0xF0, 0x0F, 0xEF, 0xB4, 0x05, -+0xE2, 0x90, 0xA5, 0x26, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x09, 0x12, 0x48, 0x65, 0xE0, -+0xFE, 0x74, 0x91, 0x2F, 0x11, 0x6E, 0xEE, 0xF0, 0x90, 0xA5, 0x26, 0xE0, 0xFF, 0x90, 0xA5, 0x25, -+0xE0, 0xFD, 0x11, 0x76, 0x90, 0xA5, 0x26, 0xE0, 0x24, 0x81, 0x11, 0x59, 0x74, 0x01, 0xF0, 0x90, -+0xA5, 0x26, 0xE0, 0x04, 0xF0, 0x02, 0x87, 0xAB, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0x22, 0x12, 0x48, 0x65, 0xE0, 0xFD, 0x75, 0xF0, 0x10, 0x22, 0x74, 0x91, 0x25, 0x0E, 0xF5, 0x82, -+0xE4, 0x34, 0x98, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x45, -+0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x01, 0x12, 0x57, 0x9C, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, -+0x8D, 0x03, 0x12, 0x57, 0x9C, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x05, 0x12, 0x57, 0x9C, -+0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x07, 0x12, 0x57, 0x9C, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, -+0x90, 0x8D, 0x09, 0x12, 0x57, 0x9C, 0xF0, 0xEF, 0x11, 0xEE, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x91, -+0x2F, 0x11, 0x6E, 0xE4, 0xF0, 0x11, 0xD6, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0x11, 0xD6, 0xEE, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x03, 0x02, 0x48, 0x65, -+0x12, 0x48, 0x65, 0xE0, 0xFE, 0xED, 0xFF, 0x90, 0xA5, 0x26, 0xE0, 0x22, 0xE5, 0x0E, 0x25, 0xE0, -+0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0x22, 0x11, 0xD6, 0xE0, 0x44, 0x40, 0xF0, -+0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, -+0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, -+0xC4, 0x74, 0x01, 0xF0, 0x74, 0x89, 0xA3, 0xF0, 0x12, 0x99, 0xC8, 0xE5, 0x69, 0x30, 0xE1, 0x02, -+0x31, 0xFA, 0xE5, 0x69, 0x30, 0xE2, 0x02, 0xB1, 0xB5, 0xE5, 0x69, 0x30, 0xE3, 0x02, 0x31, 0xAC, -+0xE5, 0x69, 0x30, 0xE5, 0x02, 0x31, 0xDB, 0xE5, 0x6A, 0x30, 0xE0, 0x03, 0x12, 0x9F, 0xDC, 0xE5, -+0x6B, 0x30, 0xE1, 0x02, 0xD1, 0x70, 0xE5, 0x6B, 0x30, 0xE0, 0x03, 0x12, 0x9B, 0x19, 0xE5, 0x6B, -+0x30, 0xE4, 0x02, 0xF1, 0xD3, 0xE5, 0x6C, 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, 0x86, 0xCD, 0xE5, -+0x6C, 0x30, 0xE4, 0x02, 0x31, 0xF2, 0xE5, 0x6C, 0x30, 0xE5, 0x03, 0x12, 0x9A, 0xFB, 0xE5, 0x6C, -+0x30, 0xE6, 0x03, 0x12, 0x9B, 0x68, 0x74, 0x01, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x89, 0xA3, -+0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x12, 0x58, 0xB8, 0xD3, -+0x90, 0xA4, 0x31, 0xE0, 0x94, 0x00, 0x90, 0xA4, 0x30, 0xE0, 0x94, 0x00, 0x40, 0x17, 0xE0, 0xFC, -+0xA3, 0xE0, 0xFD, 0xEC, 0x90, 0xA6, 0x28, 0xF0, 0xA3, 0xED, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x5C, -+0x7E, 0x01, 0x02, 0x70, 0x00, 0x90, 0x01, 0x5F, 0xE4, 0xF0, 0x22, 0x90, 0xA3, 0x54, 0xE0, 0x30, -+0xE0, 0x0F, 0x51, 0x05, 0xE4, 0x90, 0xA3, 0x57, 0x12, 0x5B, 0x94, 0x12, 0xBB, 0x94, 0x12, 0x6F, -+0xF8, 0x22, 0x91, 0x44, 0x7D, 0x02, 0x7F, 0x02, 0x80, 0x2C, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x02, -+0x71, 0xE0, 0x02, 0x5B, 0x9E, 0x7D, 0x20, 0xE4, 0xFF, 0x74, 0x65, 0xF1, 0x18, 0xFE, 0xF6, 0x74, -+0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x7D, 0x01, 0x7F, 0x02, -+0x51, 0x26, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, -+0x80, 0xDF, 0x90, 0x05, 0x62, 0xE0, 0xFE, 0x90, 0x05, 0x61, 0xE0, 0xFD, 0xED, 0x78, 0x02, 0xCE, -+0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xA5, 0x11, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x91, -+0x3C, 0x60, 0x02, 0x61, 0x09, 0x90, 0xA2, 0xEF, 0xE0, 0x70, 0x02, 0x61, 0x09, 0x71, 0x5D, 0x64, -+0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0xA2, 0xF6, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, -+0xA2, 0xF5, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0xA2, 0xF5, 0xE0, 0xFE, 0xFF, 0x80, 0x00, -+0x90, 0xA2, 0xF6, 0xEF, 0xF0, 0x12, 0x9D, 0xD2, 0xE4, 0x90, 0xA2, 0xF8, 0xF1, 0x7C, 0xB1, 0x62, -+0xB1, 0xAC, 0x54, 0xEF, 0xF0, 0x71, 0x5D, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x0F, 0x90, 0xA2, 0xE5, -+0xE0, 0x30, 0xE0, 0x05, 0x12, 0xB8, 0x85, 0x80, 0x03, 0x12, 0xB8, 0xFB, 0x91, 0xE0, 0x30, 0xE0, -+0x56, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x1E, 0x71, 0x55, 0x6F, 0x70, 0x48, 0x90, -+0xA2, 0xEB, 0xE0, 0x44, 0x40, 0xF0, 0xF1, 0x10, 0x71, 0x66, 0x71, 0x75, 0xF1, 0x02, 0x71, 0x7D, -+0x90, 0xA2, 0xF6, 0xE0, 0x14, 0xF0, 0x80, 0x2F, 0x90, 0xA2, 0xED, 0xE0, 0xC4, 0x54, 0x0F, 0x64, -+0x01, 0x70, 0x24, 0x71, 0x55, 0xFE, 0x6F, 0x60, 0x1E, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, -+0x60, 0x15, 0x90, 0xA2, 0xEB, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x09, 0xEF, 0x54, -+0xBF, 0x71, 0x66, 0x51, 0x09, 0x51, 0x1C, 0x71, 0x15, 0x90, 0xA2, 0xE5, 0xE0, 0xC3, 0x13, 0x20, -+0xE0, 0x02, 0x71, 0x15, 0x22, 0x90, 0xA2, 0xEB, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x01, 0x36, -+0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, 0x51, 0x26, 0x7D, 0x02, 0x7F, 0x03, -+0x51, 0x26, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0xF1, 0x7C, 0xE4, 0xFF, 0x71, 0xC2, 0xBF, 0x01, -+0x11, 0x91, 0x35, 0xF0, 0x90, 0xA2, 0xF2, 0xE0, 0x20, 0xE2, 0x09, 0x7D, 0x01, 0x7F, 0x04, 0x02, -+0x60, 0x59, 0x71, 0x15, 0x22, 0x90, 0xA2, 0xF5, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0x90, 0xA2, 0xED, -+0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, -+0x22, 0x7D, 0x03, 0x7F, 0x02, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0x4D, 0x41, 0x0D, 0x7D, 0x02, 0x7F, -+0x02, 0x74, 0x5D, 0xF1, 0x18, 0xFE, 0xF6, 0x74, 0x30, 0x41, 0x11, 0xEF, 0x70, 0x32, 0x7D, 0x78, -+0x7F, 0x02, 0x71, 0x81, 0x7D, 0x02, 0x7F, 0x03, 0x71, 0x81, 0x7D, 0xC8, 0x7F, 0x02, 0x51, 0x09, -+0xB1, 0x62, 0xF0, 0xE4, 0xFF, 0x71, 0xC2, 0xEF, 0x70, 0x0A, 0x91, 0xEB, 0x54, 0xBF, 0xF0, 0x54, -+0x7F, 0xF0, 0x80, 0x07, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x60, 0x59, 0x91, 0xF1, 0x02, 0xBC, 0xDF, -+0x61, 0x1D, 0x12, 0xBC, 0x4E, 0xF1, 0x20, 0xE0, 0xFD, 0x7C, 0x00, 0xF1, 0xCB, 0x80, 0x05, 0xC3, -+0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x6F, 0xB5, 0x7F, 0x00, 0x60, 0x02, 0x7F, 0x01, 0x22, -+0x91, 0xE0, 0x30, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x71, 0x7D, -+0xF1, 0x08, 0x54, 0x3F, 0x30, 0xE0, 0x08, 0xB1, 0xA9, 0x54, 0x07, 0x70, 0x37, 0x80, 0x32, 0xD1, -+0x57, 0x40, 0x2E, 0x91, 0x3C, 0x70, 0x2D, 0xF1, 0x8E, 0x70, 0x06, 0xD1, 0x21, 0x91, 0x35, 0xF0, -+0x22, 0xD1, 0x21, 0x90, 0xA2, 0xF9, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x0A, 0x91, -+0x35, 0xF0, 0xE4, 0x90, 0xA2, 0xF9, 0xF0, 0x80, 0x02, 0xF1, 0x95, 0xE4, 0x90, 0xA2, 0xF8, 0xF0, -+0x22, 0x12, 0x60, 0x40, 0x22, 0x90, 0xA2, 0xEB, 0xE0, 0x54, 0xFB, 0x22, 0xE4, 0xFF, 0x71, 0xC2, -+0xEF, 0x64, 0x01, 0x22, 0xE4, 0x90, 0xA5, 0x21, 0xF0, 0x90, 0xA2, 0xEF, 0xE0, 0x70, 0x02, 0x81, -+0xDF, 0x91, 0x3C, 0x60, 0x02, 0x81, 0xDF, 0xF1, 0x10, 0x12, 0x71, 0x1A, 0x12, 0x47, 0x77, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0x71, 0x34, 0x78, 0x10, 0x12, -+0x27, 0x35, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x77, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x71, 0x34, 0x78, 0x18, 0x12, 0x27, 0x35, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0xBB, 0xD9, 0x90, 0xA5, 0x21, 0x74, 0x01, 0xF0, 0xE4, -+0x90, 0xA2, 0xF6, 0xF0, 0x90, 0xA2, 0xE5, 0xE0, 0x30, 0xE0, 0x16, 0x90, 0xA2, 0xE9, 0xE0, 0xB4, -+0x02, 0x05, 0xE4, 0x90, 0xA5, 0x21, 0xF0, 0x12, 0x9A, 0x75, 0xEF, 0x70, 0x04, 0x90, 0xA5, 0x21, -+0xF0, 0x90, 0xA5, 0x21, 0xE0, 0x60, 0x18, 0x12, 0xBC, 0xFE, 0xE4, 0x90, 0xA6, 0x28, 0xF0, 0x90, -+0xA2, 0xF7, 0x12, 0x6F, 0xF4, 0x90, 0xA2, 0xF2, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x60, 0x55, 0x22, -+0x90, 0xA2, 0xEB, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x12, 0x65, 0xEC, 0x12, 0x65, -+0xD4, 0x90, 0xA2, 0xEA, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x12, 0xBC, 0xA2, 0x12, 0x4F, 0xE8, 0xFF, -+0xF5, 0x12, 0x12, 0x26, 0x1E, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0x12, 0x4F, 0x2D, 0xF5, 0x13, -+0x80, 0x02, 0x8F, 0x13, 0x85, 0x12, 0x11, 0xE5, 0x11, 0xD3, 0x95, 0x13, 0x50, 0x21, 0x12, 0x5C, -+0xC8, 0x12, 0x26, 0x1E, 0x54, 0x01, 0xFD, 0xAF, 0x11, 0x12, 0x57, 0xA6, 0xAF, 0x11, 0x71, 0xC2, -+0xEF, 0xAF, 0x11, 0x70, 0x04, 0xD1, 0xB8, 0x80, 0x02, 0xD1, 0xF8, 0x05, 0x11, 0x80, 0xD8, 0xE5, -+0x12, 0x70, 0x0E, 0xFF, 0x71, 0xC2, 0xEF, 0x70, 0x08, 0x91, 0xEB, 0x54, 0xBF, 0xF0, 0x54, 0x7F, -+0xF0, 0x22, 0x91, 0x3C, 0x70, 0x0B, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x05, 0xB1, 0x62, 0x12, 0x6F, -+0xEB, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0x91, 0x3C, 0x70, -+0x16, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x10, 0xB1, 0x62, 0xF0, 0x90, 0xA2, 0xEA, 0xE0, 0xB1, 0xAA, -+0x54, 0x07, 0x70, 0x03, 0x12, 0x60, 0x40, 0x22, 0x90, 0x01, 0x57, 0xE0, 0x60, 0x1A, 0xB1, 0x65, -+0xF0, 0xF1, 0x08, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0x80, 0x0F, 0xD1, 0x57, 0x40, 0x0A, 0xE4, 0xFF, -+0x71, 0xC2, 0xBF, 0x01, 0x03, 0x91, 0x35, 0xF0, 0x22, 0xEF, 0x54, 0xFB, 0xF0, 0x90, 0xA2, 0xF3, -+0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x0F, 0x90, 0x06, 0x92, 0xE0, 0x30, -+0xE1, 0x03, 0x02, 0xB9, 0x67, 0x91, 0xF1, 0x12, 0x60, 0x40, 0x22, 0x90, 0xA2, 0xEA, 0xE0, 0x54, -+0xFB, 0xF0, 0xE4, 0x90, 0xA2, 0xF8, 0xF0, 0xA3, 0xF0, 0x90, 0xA2, 0xF3, 0xF0, 0x90, 0xA2, 0xEB, -+0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, 0xF0, 0x51, 0x1C, 0x7D, 0x10, 0x7F, 0x03, 0x41, 0x09, 0x90, -+0xA4, 0x4D, 0x12, 0x48, 0x7A, 0xB1, 0xCB, 0x90, 0xA2, 0xEF, 0xE0, 0xFF, 0x71, 0x8B, 0x90, 0xA2, -+0xEF, 0xE0, 0x60, 0x1C, 0x90, 0xA4, 0x4D, 0x12, 0x48, 0x71, 0x12, 0x4F, 0xE8, 0x54, 0x0F, 0xFF, -+0x12, 0x4F, 0x2D, 0xFD, 0x12, 0xB9, 0xA1, 0x12, 0x9F, 0x60, 0x74, 0x01, 0xF0, 0x12, 0x9D, 0x0B, -+0x22, 0xD1, 0x64, 0x40, 0x31, 0x90, 0xA3, 0x09, 0xE0, 0x04, 0xF0, 0x90, 0xA3, 0x4B, 0xE0, 0xFF, -+0x90, 0xA3, 0x09, 0xE0, 0xD3, 0x9F, 0x50, 0x1E, 0x90, 0xA3, 0x01, 0xE0, 0x04, 0x12, 0x71, 0x08, -+0x90, 0xA3, 0x08, 0xF0, 0xFB, 0x90, 0xA3, 0x01, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA6, 0x62, -+0x74, 0x04, 0xF0, 0x12, 0x9D, 0x0B, 0x22, 0x90, 0xA2, 0xF8, 0xE0, 0x04, 0xF0, 0x90, 0xA2, 0xF3, -+0xE0, 0x54, 0xEF, 0xF0, 0x90, 0xA3, 0x4C, 0xE0, 0xFF, 0x90, 0xA2, 0xF8, 0xE0, 0xD3, 0x9F, 0x22, -+0x90, 0xA2, 0xE5, 0xE0, 0xFF, 0x30, 0xE0, 0x3F, 0x90, 0xA2, 0xE9, 0xE0, 0x7E, 0x00, 0xB4, 0x02, -+0x02, 0x7E, 0x01, 0x90, 0xA2, 0xE8, 0xE0, 0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, -+0x70, 0x25, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x03, 0x02, 0x9A, 0x5B, 0xB1, 0x88, 0x90, 0xA2, 0xE9, -+0xE0, 0xB4, 0x0C, 0x06, 0xE4, 0xFD, 0x7F, 0x08, 0x80, 0x0A, 0x90, 0xA2, 0xE9, 0xE0, 0xB4, 0x04, -+0x06, 0xE4, 0xFD, 0xFF, 0x12, 0x60, 0x59, 0x22, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA6, 0x7B, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x7D, 0x44, 0x12, 0x5F, 0xBA, 0x90, 0xA6, -+0x7C, 0xE0, 0x90, 0xA6, 0x7B, 0xB4, 0x01, 0x0D, 0xE0, 0x75, 0xF0, 0x10, 0x12, 0x6F, 0x74, 0xE0, -+0x44, 0x04, 0xF0, 0x80, 0x0B, 0xE0, 0x75, 0xF0, 0x10, 0x12, 0x6F, 0x74, 0xE0, 0x54, 0xFB, 0xF0, -+0x12, 0x65, 0xCE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFD, 0xD1, 0xBA, 0x12, 0xBC, 0x65, 0x02, -+0x27, 0x48, 0x7D, 0x01, 0x7F, 0x02, 0x61, 0x81, 0x90, 0xA2, 0xEA, 0xE0, 0xFF, 0x13, 0x13, 0x22, -+0x90, 0xA2, 0xF5, 0xE0, 0x90, 0x05, 0x73, 0x22, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0x22, -+0x74, 0xD4, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x7D, 0x10, 0xED, 0x14, 0xF9, 0x24, 0xD4, 0xF1, 0x23, 0xE0, 0x60, 0x35, 0x7C, 0x08, -+0xEC, 0x14, 0x90, 0xA6, 0x8A, 0xF0, 0x74, 0xD4, 0x29, 0xF1, 0x23, 0xE0, 0xFB, 0x7A, 0x00, 0x90, -+0xA6, 0x8A, 0xF1, 0xC9, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xF1, 0xD4, 0x4E, -+0x60, 0x0F, 0xE9, 0x75, 0xF0, 0x08, 0xA4, 0xFF, 0x90, 0xA6, 0x8A, 0xE0, 0x2F, 0x04, 0xFF, 0x80, -+0x06, 0xDC, 0xCD, 0xDD, 0xBF, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0xA2, 0xFB, -+0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0x90, 0xA2, 0xF3, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0xA2, -+0xED, 0xE0, 0x54, 0x0F, 0x22, 0x12, 0xB9, 0x67, 0x90, 0xA2, 0xF2, 0xE0, 0x64, 0x0C, 0x60, 0x06, -+0x12, 0x65, 0xC8, 0x12, 0x5E, 0xDD, 0x22, 0xE4, 0xFF, 0x71, 0xC2, 0xBF, 0x01, 0x11, 0x90, 0xA2, -+0xEF, 0xE0, 0x60, 0x0B, 0xF1, 0x8E, 0x64, 0x02, 0x60, 0x03, 0x02, 0xB9, 0x40, 0xF1, 0x95, 0x22, -+0xF5, 0x83, 0xE0, 0xFD, 0x7C, 0x00, 0x90, 0xA4, 0x54, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, -+0x07, 0x08, 0x22, 0x22, 0xFF, 0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x22, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, -+0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0xDB, 0x90, 0x01, 0xC4, 0xED, -+0xF0, 0x74, 0x8F, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, -+0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x02, 0x09, 0xE0, -+0xF5, 0x0E, 0x12, 0x26, 0x1E, 0x25, 0x0E, 0x90, 0xA1, 0xE0, 0x12, 0x4F, 0xE7, 0x25, 0x0E, 0x90, -+0xA1, 0xE1, 0x12, 0x4F, 0x2C, 0x25, 0x0E, 0x90, 0xA1, 0xE2, 0xF0, 0x12, 0x57, 0x66, 0x25, 0x0E, -+0x90, 0xA1, 0xE3, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0x25, 0x0E, 0x90, 0xA1, 0xE4, 0xF0, -+0x11, 0x54, 0x25, 0x0E, 0x90, 0xA1, 0xE5, 0x12, 0x4F, 0xEE, 0x25, 0x0E, 0x90, 0xA1, 0xE6, 0xF0, -+0x22, 0x12, 0x48, 0x71, 0x90, 0x00, 0x05, 0x02, 0x26, 0x37, 0x90, 0xA4, 0x55, 0x12, 0x7F, 0xCB, -+0x90, 0xA4, 0x57, 0xE0, 0xF1, 0xC2, 0x90, 0xA4, 0x5C, 0x12, 0x48, 0x7A, 0x90, 0xA4, 0x58, 0xE0, -+0x91, 0xF9, 0xA3, 0x12, 0x48, 0x7A, 0x31, 0x0E, 0xFF, 0x12, 0xA2, 0x93, 0x8F, 0x1E, 0xA3, 0x31, -+0x16, 0xE0, 0xF5, 0x1A, 0xA3, 0xE0, 0xF5, 0x1B, 0xE4, 0xF5, 0x1F, 0x90, 0xA4, 0x5C, 0x91, 0xEF, -+0xE5, 0x1F, 0xB1, 0x18, 0x12, 0x47, 0x17, 0xAE, 0xF0, 0xA8, 0x1E, 0x08, 0x80, 0x05, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xA4, 0x59, 0x12, 0x48, 0x71, 0x85, 0x1F, 0x82, 0x12, -+0x4F, 0xE1, 0xF1, 0xA4, 0x25, 0x1B, 0xF5, 0x1B, 0xEE, 0x35, 0x1A, 0xF5, 0x1A, 0x05, 0x1F, 0xE5, -+0x1F, 0xB4, 0x05, 0xC7, 0x90, 0xA4, 0x59, 0x11, 0x51, 0xFD, 0x7C, 0x00, 0x31, 0x0E, 0xA8, 0x1E, -+0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x26, 0x98, 0x8E, 0x1C, -+0x8F, 0x1D, 0xD3, 0xE5, 0x1B, 0x95, 0x1D, 0xE5, 0x1A, 0x95, 0x1C, 0x40, 0x0C, 0xE5, 0x1B, 0x95, -+0x1D, 0xFF, 0xE5, 0x1A, 0x95, 0x1C, 0xFE, 0x80, 0x04, 0x7E, 0x00, 0x7F, 0x00, 0x8E, 0x1A, 0x8F, -+0x1B, 0x90, 0xA4, 0x57, 0x31, 0x16, 0xE5, 0x1A, 0xF0, 0xA3, 0xE5, 0x1B, 0xF0, 0x22, 0x90, 0xA4, -+0x55, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0xE0, 0x25, 0xE0, 0x24, 0x91, 0xF5, 0x82, 0xE4, 0x34, 0x94, -+0xF5, 0x83, 0x22, 0x7D, 0x01, 0xAF, 0x0E, 0x90, 0xA4, 0x56, 0xEB, 0xF0, 0x90, 0xA4, 0x55, 0xEF, -+0xF0, 0x75, 0xF0, 0x04, 0x90, 0x9B, 0x12, 0x12, 0x57, 0x9C, 0x12, 0x6F, 0x64, 0xE0, 0xF5, 0x1A, -+0x54, 0x7F, 0xF5, 0x1C, 0x91, 0xAC, 0x12, 0x57, 0x6C, 0xE0, 0x90, 0xA4, 0x59, 0x12, 0x57, 0x79, -+0xE0, 0xFC, 0x90, 0xA4, 0x55, 0xE0, 0x75, 0xF0, 0x04, 0x12, 0x4F, 0x24, 0x13, 0x13, 0x54, 0x03, -+0xF5, 0x1B, 0xE5, 0x1C, 0xF1, 0xB6, 0xE4, 0x93, 0xFA, 0x74, 0x01, 0x93, 0xFB, 0xEF, 0x31, 0x17, -+0xEA, 0xF0, 0xA3, 0xEB, 0xF0, 0x91, 0xAC, 0x12, 0x4F, 0x24, 0xFE, 0xC4, 0x54, 0x03, 0x90, 0xA4, -+0x57, 0xF0, 0x74, 0x22, 0x2F, 0x12, 0x6F, 0xE0, 0xE5, 0x1C, 0xF0, 0x90, 0xA4, 0x55, 0xE0, 0xFF, -+0x24, 0x22, 0xF1, 0x9C, 0xE5, 0x1B, 0xF0, 0xE5, 0x1C, 0xD3, 0x9C, 0x40, 0x0B, 0x8C, 0x1C, 0x8C, -+0x1A, 0xAE, 0x04, 0x12, 0x6D, 0x7D, 0xEE, 0xF0, 0xED, 0x70, 0x02, 0x61, 0x39, 0xAF, 0x05, 0x8F, -+0x1D, 0xE5, 0x1A, 0x30, 0xE7, 0x0D, 0x85, 0x1C, 0x1A, 0x71, 0x49, 0x12, 0x6D, 0x80, 0xE5, 0x1C, -+0xF0, 0x15, 0x1D, 0xE5, 0x1D, 0x70, 0x02, 0x61, 0x39, 0x90, 0xA4, 0x55, 0xE0, 0xFF, 0xAD, 0x1A, -+0x12, 0xA0, 0xB7, 0xEF, 0xF4, 0x60, 0x16, 0x8F, 0x1A, 0xD5, 0x1D, 0x11, 0x90, 0xA4, 0x55, 0xE0, -+0xFF, 0x12, 0x6F, 0xDE, 0xE0, 0xFE, 0x12, 0x6D, 0x7D, 0xEE, 0xF0, 0x61, 0x39, 0xE5, 0x1A, 0x64, -+0x2C, 0x70, 0x35, 0xE5, 0x1B, 0xD3, 0x94, 0x00, 0x40, 0x2E, 0xE5, 0x1B, 0xD3, 0x94, 0x02, 0x50, -+0x27, 0x15, 0x1B, 0x75, 0x1A, 0x2D, 0xE5, 0x1B, 0xF1, 0x95, 0xFF, 0x90, 0xA4, 0x55, 0xE0, 0xFE, -+0x75, 0xF0, 0x04, 0x12, 0x4F, 0x24, 0x54, 0xF3, 0x4F, 0xF0, 0x74, 0xA2, 0x2E, 0x12, 0x6D, 0x80, -+0x74, 0xFF, 0xF0, 0xD5, 0x1D, 0x21, 0x61, 0x39, 0xE5, 0x1A, 0xB4, 0x2D, 0x1A, 0xE5, 0x1B, 0xD3, -+0x94, 0x02, 0x50, 0x13, 0x75, 0x1A, 0x2C, 0x71, 0x49, 0x12, 0x6D, 0x80, 0x74, 0xFF, 0xF0, 0x15, -+0x1D, 0xE5, 0x1D, 0x70, 0x02, 0x61, 0x39, 0xE5, 0x1D, 0x70, 0x02, 0x61, 0x39, 0x90, 0xA4, 0x59, -+0xE0, 0xFF, 0xE5, 0x1C, 0xD3, 0x9F, 0x50, 0x02, 0x61, 0x33, 0xE4, 0x90, 0xA4, 0x58, 0xF0, 0x90, -+0xA4, 0x57, 0xE0, 0xFF, 0xAD, 0x1C, 0x91, 0xC8, 0x8F, 0x1C, 0x85, 0x1C, 0x1A, 0xE0, 0xFF, 0x90, -+0xA4, 0x59, 0xE0, 0xFD, 0x91, 0xC8, 0xEF, 0xF0, 0xE5, 0x1A, 0xD3, 0x94, 0x0B, 0x40, 0x1C, 0x90, -+0xA4, 0x55, 0xE0, 0xFB, 0x90, 0xA4, 0x57, 0xE0, 0x90, 0xA4, 0x5D, 0xF0, 0x7D, 0x01, 0xAF, 0x1C, -+0x71, 0x50, 0x8F, 0x1A, 0xE5, 0x1A, 0xF4, 0x70, 0x5D, 0x61, 0x39, 0xAD, 0x1A, 0xE5, 0x1C, 0x14, -+0xFC, 0x90, 0xA4, 0x59, 0xE0, 0xFF, 0xEC, 0xC3, 0x9F, 0x40, 0x3B, 0x91, 0xDC, 0x90, 0xA4, 0x55, -+0x12, 0x52, 0x34, 0x91, 0xE4, 0x12, 0x8F, 0xCA, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0x12, 0x8F, 0xD4, 0x4E, 0x60, 0x1C, 0xE5, 0x1C, 0xAD, 0x04, 0xB4, 0x14, 0x02, 0x7D, 0x0C, -+0x90, 0xA4, 0x58, 0xE0, 0x04, 0xF0, 0xE0, 0x65, 0x1D, 0x60, 0x0B, 0xA3, 0xE0, 0xFF, 0xED, 0xD3, -+0x9F, 0x40, 0x03, 0x1C, 0x80, 0xBB, 0x71, 0x49, 0x12, 0x6D, 0x80, 0xED, 0xF0, 0xE5, 0x1A, 0xB4, -+0xFF, 0x04, 0xAF, 0x05, 0x8F, 0x1A, 0x90, 0xA4, 0x57, 0xE0, 0xFF, 0xAD, 0x1A, 0x91, 0xB5, 0x8F, -+0x1A, 0x71, 0x49, 0x12, 0x6D, 0x80, 0xE0, 0xFD, 0xF4, 0x60, 0x1C, 0x90, 0xA4, 0x57, 0xE0, 0xFF, -+0x91, 0xB5, 0x90, 0xA4, 0x55, 0xE0, 0xFE, 0x12, 0x6F, 0xDE, 0xEF, 0xF0, 0x74, 0xA2, 0x2E, 0x12, -+0x6D, 0x80, 0x74, 0xFF, 0xF0, 0x80, 0x12, 0x90, 0xA4, 0x55, 0xE0, 0x12, 0x6F, 0xDE, 0xE5, 0x1A, -+0xF0, 0x80, 0x06, 0x90, 0xA4, 0x59, 0xE0, 0xF5, 0x1A, 0x90, 0xA4, 0x55, 0xE0, 0xFF, 0xA3, 0xE0, -+0xFB, 0x85, 0x1B, 0x77, 0xAD, 0x1A, 0x02, 0x83, 0x1D, 0x90, 0xA4, 0x55, 0xE0, 0x24, 0xA2, 0x22, -+0x90, 0xA4, 0x5C, 0xEB, 0xF0, 0xEF, 0x54, 0x7F, 0x24, 0xF4, 0x90, 0xA4, 0x60, 0xF0, 0xED, 0x70, -+0x2E, 0x91, 0xA4, 0x70, 0x15, 0xE0, 0x25, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x91, -+0x84, 0x24, 0x82, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x80, 0x41, 0xE0, 0x25, 0xE0, 0x24, 0x59, 0xF5, -+0x82, 0xE4, 0x34, 0x41, 0x91, 0x84, 0x24, 0x5A, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x80, 0x2C, 0x91, -+0xA4, 0x70, 0x15, 0xE0, 0x25, 0xE0, 0x24, 0xCD, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x91, 0x84, 0x24, -+0xCE, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x80, 0x13, 0xE0, 0x25, 0xE0, 0x24, 0xA5, 0xF5, 0x82, 0xE4, -+0x34, 0x41, 0x91, 0x84, 0x24, 0xA6, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0xF5, 0x83, 0xE4, 0x93, 0xFF, -+0x90, 0xA4, 0x5C, 0xE0, 0xFD, 0x91, 0x60, 0xA9, 0x07, 0x7F, 0x0C, 0x7E, 0x12, 0x7D, 0x10, 0x90, -+0xA4, 0x5E, 0xE0, 0xFC, 0xF4, 0x60, 0x2E, 0xE9, 0xF4, 0x60, 0x2A, 0xE9, 0xC3, 0x9F, 0x40, 0x25, -+0xE9, 0xD3, 0x9D, 0x50, 0x20, 0x91, 0x9C, 0x12, 0x56, 0x01, 0xE0, 0x30, 0xE1, 0x17, 0x74, 0xA2, -+0x2D, 0x12, 0x57, 0x8A, 0xE0, 0xC3, 0x94, 0x02, 0x40, 0x0B, 0x90, 0xA4, 0x5F, 0xE9, 0xF0, 0xA9, -+0x04, 0x90, 0xA4, 0x5E, 0xF0, 0x91, 0x9C, 0x12, 0x56, 0x01, 0xE0, 0x30, 0xE6, 0x2A, 0x74, 0xA2, -+0x2D, 0x12, 0x57, 0x8A, 0xE0, 0xC3, 0x94, 0x02, 0x40, 0x1E, 0x90, 0xA4, 0x5E, 0xE0, 0xFD, 0xF4, -+0x60, 0x16, 0xE9, 0xF4, 0x60, 0x12, 0xE9, 0x9F, 0x40, 0x0E, 0xE9, 0xD3, 0x9E, 0x50, 0x09, 0xA3, -+0xE9, 0xF0, 0xA9, 0x05, 0x90, 0xA4, 0x5E, 0xF0, 0x90, 0xA4, 0x5E, 0xE0, 0xB4, 0xFF, 0x10, 0xE9, -+0xF0, 0x90, 0xA4, 0x5C, 0xE0, 0x24, 0xA2, 0x12, 0x6D, 0x80, 0x74, 0xFF, 0xF0, 0x80, 0x0B, 0x90, -+0xA4, 0x5C, 0xE0, 0x24, 0xA2, 0x12, 0x6D, 0x80, 0xE9, 0xF0, 0x90, 0xA4, 0x5E, 0xE0, 0xFF, 0x22, -+0xAC, 0x07, 0x91, 0xDC, 0x75, 0xF0, 0x08, 0xED, 0x12, 0x52, 0x38, 0x91, 0xE4, 0x12, 0x8F, 0xCA, -+0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x8F, 0xD4, 0x4E, 0x7F, 0xFF, 0x60, -+0x02, 0xAF, 0x04, 0x22, 0xF5, 0x83, 0xE4, 0x93, 0xFF, 0x90, 0xA4, 0x5C, 0xE0, 0xFD, 0x91, 0x60, -+0x90, 0xA4, 0x5E, 0xEF, 0xF0, 0x90, 0xA4, 0x60, 0xE0, 0x25, 0xE0, 0x22, 0x90, 0xA4, 0x5C, 0xE0, -+0xFD, 0x24, 0x91, 0x22, 0x90, 0xA4, 0x5D, 0xE0, 0x90, 0xA4, 0x60, 0x22, 0x90, 0xA4, 0x55, 0xE0, -+0xFF, 0x75, 0xF0, 0x04, 0x22, 0xEF, 0x60, 0x0A, 0xED, 0xD3, 0x94, 0x0B, 0x40, 0x04, 0x7E, 0x20, -+0x80, 0x02, 0xE4, 0xFE, 0xED, 0x2E, 0xFF, 0x22, 0xEF, 0x60, 0x0A, 0xED, 0xC3, 0x94, 0x2C, 0x40, -+0x04, 0x7E, 0x20, 0x80, 0x02, 0xE4, 0xFE, 0xC3, 0xED, 0x9E, 0xFF, 0x22, 0xEC, 0x13, 0x13, 0x13, -+0x54, 0x1F, 0xFF, 0x22, 0xE0, 0xFB, 0x7A, 0x00, 0xEC, 0x54, 0x07, 0x22, 0x90, 0xA4, 0x49, 0x12, -+0x48, 0x71, 0x75, 0xF0, 0x02, 0x22, 0x8F, 0x15, 0xEF, 0x75, 0xF0, 0x06, 0xA4, 0x24, 0x5C, 0xF9, -+0x74, 0x40, 0x35, 0xF0, 0xFA, 0x7B, 0xFF, 0x22, 0x12, 0x36, 0xCE, 0x90, 0xA4, 0xB4, 0x12, 0x48, -+0x71, 0x90, 0xA4, 0xB7, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x22, 0xF1, -+0x77, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0x12, 0x73, 0x22, 0xE4, 0x90, 0xA4, 0xB7, 0xF0, 0x90, 0xA4, 0xB7, 0xE0, 0xFF, 0xC3, -+0x94, 0x06, 0x50, 0x21, 0xEF, 0xF1, 0x81, 0xF1, 0x0A, 0x12, 0x36, 0xCE, 0x90, 0xA4, 0xB1, 0xB1, -+0x0E, 0x12, 0x48, 0x29, 0x90, 0xA4, 0xB7, 0xE0, 0xF1, 0x8B, 0xF1, 0x0A, 0xB1, 0x08, 0x12, 0x48, -+0x29, 0xF1, 0x17, 0x80, 0xD5, 0x22, 0xF1, 0x77, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, -+0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x73, 0x22, 0xE4, 0x90, 0xA4, 0xB7, -+0xF0, 0x90, 0xA4, 0xB7, 0xE0, 0xFD, 0xF1, 0x81, 0xF1, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x12, 0x77, -+0xAE, 0x75, 0xF0, 0x04, 0xED, 0xB1, 0x18, 0x12, 0x47, 0xDF, 0x12, 0x66, 0x94, 0xD0, 0x07, 0xD0, -+0x06, 0x12, 0x37, 0x5D, 0x90, 0xA4, 0xB7, 0xE0, 0xFD, 0xF1, 0x8B, 0xF1, 0x0A, 0xC0, 0x06, 0xC0, -+0x07, 0x12, 0x77, 0xB8, 0x75, 0xF0, 0x04, 0xED, 0xB1, 0x18, 0x12, 0x47, 0xDF, 0x12, 0x66, 0x94, -+0xD0, 0x07, 0xD0, 0x06, 0xF1, 0x14, 0xE0, 0xC3, 0x94, 0x06, 0x40, 0xB5, 0x90, 0xA5, 0xFE, 0x12, -+0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, -+0x12, 0x73, 0x22, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x80, 0x12, -+0x67, 0x14, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x84, 0x12, 0x67, 0x14, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x88, 0x12, 0x67, 0x14, 0x12, 0x27, 0x54, 0x3C, 0x00, 0x00, -+0x00, 0x7F, 0x8C, 0x12, 0x67, 0x14, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB8, 0x12, -+0x67, 0x14, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x80, 0x7F, 0x90, 0x12, 0x67, 0x14, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x94, 0x12, 0x67, 0x14, 0x12, 0x27, 0x54, 0x20, 0x04, 0x00, -+0x00, 0x7F, 0xC4, 0x12, 0x67, 0x14, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0x7F, 0xC8, 0x12, -+0x67, 0x14, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x80, 0x7E, 0x0E, 0x12, 0x67, 0x16, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x84, 0x7E, 0x0E, 0x12, 0x67, 0x16, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x88, 0x7E, 0x0E, 0x12, 0x67, 0x16, 0x12, 0x27, 0x54, 0x3C, -+0x00, 0x00, 0x00, 0x7F, 0x8C, 0x7E, 0x0E, 0x12, 0x67, 0x16, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x00, 0x7F, 0xB8, 0x7E, 0x0E, 0x12, 0x67, 0x16, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x80, 0x7F, -+0x90, 0x7E, 0x0E, 0x12, 0x67, 0x16, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x94, 0x7E, -+0x0E, 0x12, 0x67, 0x16, 0x12, 0x27, 0x54, 0x20, 0x04, 0x00, 0x00, 0x7F, 0xC4, 0x7E, 0x0E, 0x12, -+0x67, 0x16, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0x7F, 0xC8, 0x7E, 0x0E, 0x02, 0x37, 0x5D, -+0x12, 0x37, 0x5D, 0x90, 0xA5, 0x03, 0xE0, 0x75, 0xF0, 0x1E, 0xA4, 0x24, 0x0B, 0xF5, 0x82, 0xE4, -+0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x36, 0xCE, 0xE4, 0xFF, -+0xFE, 0xEC, 0x54, 0x07, 0xFC, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x03, 0xE0, 0x75, -+0xF0, 0x1E, 0xA4, 0x24, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, -+0x01, 0x93, 0xFF, 0x22, 0x12, 0x37, 0x5D, 0x90, 0xA4, 0xB7, 0xE0, 0x04, 0xF0, 0x22, 0xF1, 0x77, -+0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x00, 0x12, 0x73, 0x22, 0xE4, 0x90, 0xA4, 0xB7, 0xF0, 0x90, 0xA4, 0xB7, 0xE0, 0xFF, 0x12, 0xAD, -+0xEF, 0xF5, 0x82, 0x8C, 0x83, 0xE0, 0xFE, 0x12, 0x77, 0xAE, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xEE, -+0x12, 0x26, 0x76, 0xF1, 0x17, 0xE0, 0xB4, 0x03, 0xE0, 0xE4, 0x90, 0xA4, 0xB7, 0xF0, 0x90, 0xA4, -+0xB7, 0xE0, 0xFF, 0xC3, 0x94, 0x07, 0x50, 0x0E, 0xEF, 0xF1, 0xAC, 0xF1, 0x0A, 0xB1, 0x08, 0x12, -+0x48, 0x29, 0xF1, 0x17, 0x80, 0xE8, 0x22, 0x90, 0xA4, 0xB1, 0x12, 0x48, 0x7A, 0x90, 0xA5, 0xFE, -+0x22, 0x25, 0xE0, 0x24, 0x4F, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x22, 0x25, 0xE0, 0x24, 0x5B, 0xF5, -+0x82, 0xE4, 0x34, 0x45, 0x22, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, -+0x9E, 0xF5, 0x83, 0x22, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x22, 0x25, 0xE0, 0x24, 0x41, -+0xF5, 0x82, 0xE4, 0x34, 0x45, 0x22, 0x25, 0xE0, 0x24, 0xE9, 0xF5, 0x82, 0xE4, 0x34, 0x42, 0xF5, -+0x83, 0x22, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x01, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, -+0x22, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0xA2, 0xD3, 0xF0, 0xBF, 0x01, 0x08, 0x12, 0x7C, 0xFB, 0xE4, -+0x90, 0xA2, 0xD3, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x54, 0x01, 0xFF, 0x90, 0xA4, 0x3A, 0xE0, 0x54, -+0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x4F, 0xA3, 0xFF, 0x54, 0x7F, 0x90, 0xA2, 0xEF, 0xF0, 0xEF, 0x12, -+0x4F, 0x6F, 0xA3, 0x12, 0x4F, 0xE7, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0xA2, 0xED, -+0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x12, 0x57, 0x66, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0xA2, 0xEA, -+0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0x12, 0x8F, 0x8E, 0x12, -+0x4F, 0x2B, 0x90, 0xA2, 0xEE, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFD, 0x7F, 0x02, 0x12, -+0x62, 0x65, 0x12, 0x4F, 0x33, 0x02, 0x8D, 0xEF, 0x12, 0x26, 0x1E, 0x90, 0xA2, 0xFA, 0xF0, 0x22, -+0x12, 0x26, 0x1E, 0x90, 0xA3, 0x52, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0xA2, 0x38, 0xE0, 0xFF, 0x90, 0xA2, 0x37, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, -+0x00, 0xEF, 0x70, 0x3A, 0x90, 0xA2, 0x37, 0xE0, 0xFE, 0x11, 0xB3, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, -+0x08, 0xA4, 0x24, 0xE8, 0xF9, 0x74, 0xA1, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x12, 0x56, -+0xA7, 0x90, 0xA2, 0x37, 0x12, 0x7F, 0xA1, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, -+0x90, 0xA2, 0x37, 0xF0, 0x12, 0x85, 0xB5, 0x90, 0xA1, 0x23, 0xE0, 0x44, 0x02, 0xF0, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x75, 0xF0, 0x08, 0x90, 0xA1, 0xE7, 0x02, 0x48, 0x65, 0xE4, 0x90, 0xA2, 0xCF, -+0xF0, 0xA3, 0xF0, 0x90, 0xA2, 0x37, 0xF0, 0xA3, 0xF0, 0x22, 0xE4, 0xF5, 0x55, 0xF5, 0x56, 0xF5, -+0x57, 0x75, 0x58, 0x80, 0xAD, 0x55, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xAD, 0x56, 0x7F, 0x51, 0x12, -+0x3A, 0x96, 0xAD, 0x57, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xAD, 0x58, 0x7F, 0x53, 0x02, 0x3A, 0x96, -+0x75, 0x5D, 0x12, 0xE4, 0xF5, 0x5E, 0x75, 0x5F, 0x07, 0x75, 0x60, 0x72, 0x90, 0x01, 0x30, 0xE5, -+0x5D, 0xF0, 0xA3, 0xE5, 0x5E, 0xF0, 0xA3, 0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, 0xF0, 0x22, 0x75, -+0x65, 0x0E, 0x75, 0x66, 0x01, 0x75, 0x67, 0x03, 0x75, 0x68, 0x62, 0x90, 0x01, 0x38, 0xE5, 0x65, -+0xF0, 0xA3, 0xE5, 0x66, 0xF0, 0xA3, 0xE5, 0x67, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x22, 0x90, 0x01, -+0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, -+0x04, 0xF0, 0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, -+0xA3, 0x74, 0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, -+0x90, 0x01, 0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0x7F, 0x02, 0x90, 0xA3, 0x53, -+0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x10, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, -+0x03, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xE6, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0xA1, 0x23, 0x02, 0x50, -+0x66, 0x90, 0x01, 0xE4, 0x74, 0x29, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, -+0x5D, 0xF5, 0x61, 0xA3, 0xE0, 0x55, 0x5E, 0xF5, 0x62, 0xA3, 0xE0, 0x55, 0x5F, 0xF5, 0x63, 0xA3, -+0xE0, 0x55, 0x60, 0xF5, 0x64, 0x90, 0x01, 0x34, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, 0x62, 0xF0, 0xA3, -+0xE5, 0x63, 0xF0, 0xA3, 0xE5, 0x64, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x65, 0xF5, 0x69, -+0xA3, 0xE0, 0x55, 0x66, 0xF5, 0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, 0x6B, 0xA3, 0xE0, 0x55, 0x68, -+0xF5, 0x6C, 0x90, 0x01, 0x3C, 0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, 0x6B, 0xF0, -+0xA3, 0xE5, 0x6C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0xA5, 0x11, 0xF0, -+0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, 0x23, -+0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, 0xA8, -+0xF5, 0xE8, 0x12, 0x50, 0x40, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x3A, -+0x96, 0x80, 0xFE, 0x22, 0x90, 0xA2, 0xE5, 0xE0, 0x30, 0xE0, 0x05, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, -+0x22, 0x90, 0xA2, 0xE5, 0xE0, 0x30, 0xE0, 0x10, 0xA3, 0x74, 0x01, 0xF0, 0x90, 0xA2, 0xE5, 0xE0, -+0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x51, 0x5B, 0x02, 0x70, 0x2D, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x51, 0x75, 0xBF, 0x01, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x12, 0x64, 0x36, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, 0x43, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, -+0x22, 0xAE, 0x07, 0x51, 0x75, 0xBF, 0x01, 0x0F, 0x71, 0xCF, 0x20, 0xE0, 0x0A, 0xAF, 0x06, 0x7D, -+0x01, 0x12, 0x60, 0x59, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0xA2, 0xEF, 0xE0, 0x70, 0x07, -+0x90, 0xA2, 0xE5, 0xE0, 0x30, 0xE0, 0x11, 0x90, 0xA2, 0xE5, 0xE0, 0x30, 0xE0, 0x07, 0x51, 0x75, -+0xBF, 0x01, 0x05, 0x80, 0x04, 0x12, 0x67, 0x8A, 0x22, 0x90, 0xA2, 0xEF, 0xE0, 0x64, 0x02, 0x60, -+0x10, 0x12, 0x8F, 0x8E, 0x60, 0x0B, 0x71, 0xD9, 0xEF, 0x70, 0x06, 0xFD, 0x7F, 0x0C, 0x12, 0x60, -+0x59, 0x22, 0x51, 0xF0, 0x30, 0xE0, 0x0B, 0x51, 0xE9, 0x60, 0x07, 0x7D, 0x01, 0x7F, 0x02, 0x12, -+0x60, 0x59, 0x51, 0xE9, 0x60, 0x02, 0x51, 0xB9, 0x22, 0x90, 0xA2, 0xE9, 0xE0, 0x64, 0x02, 0x22, -+0x90, 0xA2, 0xE5, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0xA2, 0xEA, 0x51, 0xF3, -+0x30, 0xE0, 0x15, 0xEF, 0x54, 0xBF, 0x71, 0x5F, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, -+0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x12, 0x60, 0x40, 0x22, 0x90, 0xA2, 0xE5, 0xE0, 0xFF, 0x30, 0xE0, -+0x3D, 0x90, 0xA2, 0xE9, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0xA2, 0xE8, 0xE0, -+0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x23, 0xEF, 0xC3, 0x13, 0x30, 0xE0, -+0x02, 0x41, 0x5B, 0x51, 0xD2, 0x90, 0xA2, 0xE9, 0xE0, 0xB4, 0x08, 0x06, 0xE4, 0xFD, 0x7F, 0x0C, -+0x80, 0x09, 0x90, 0xA2, 0xE9, 0xE0, 0x70, 0x06, 0xFD, 0x7F, 0x04, 0x12, 0x60, 0x59, 0x22, 0xF0, -+0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA2, 0xEB, 0x22, 0x90, 0xA2, 0xEA, 0xE0, 0xFF, 0x12, 0x4F, 0x6F, -+0x30, 0xE0, 0x1B, 0xEF, 0x54, 0x7F, 0x71, 0x5F, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, -+0x04, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x03, 0x12, 0x60, 0x40, 0x90, 0x04, -+0xE0, 0xE0, 0x30, 0xE1, 0x02, 0x71, 0x98, 0x22, 0x90, 0xA3, 0x54, 0xE0, 0x30, 0xE0, 0x25, 0xA3, -+0xE0, 0xC3, 0x13, 0x54, 0x07, 0x71, 0xC5, 0xE0, 0xFE, 0x30, 0xE0, 0x18, 0x75, 0xF0, 0x0E, 0xEF, -+0x71, 0xC9, 0xEE, 0x54, 0xFE, 0xF0, 0x90, 0xA3, 0x57, 0x74, 0x05, 0x12, 0x5B, 0x94, 0xFD, 0x7F, -+0x02, 0x12, 0x5A, 0x61, 0x22, 0xFF, 0x75, 0xF0, 0x0E, 0x90, 0xA3, 0x60, 0x02, 0x48, 0x65, 0x90, -+0xA2, 0xE5, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, -+0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, -+0x00, 0x22, 0x71, 0xD9, 0xEF, 0x70, 0x03, 0x12, 0x67, 0x8A, 0x22, 0x90, 0xA2, 0xE5, 0xE0, 0xFF, -+0x30, 0xE0, 0x04, 0x51, 0xE9, 0x60, 0x15, 0x90, 0xA2, 0xEF, 0xE0, 0x70, 0x04, 0xEF, 0x30, 0xE0, -+0x0B, 0x90, 0xA2, 0xF2, 0xE0, 0x64, 0x02, 0x60, 0x03, 0x12, 0x8A, 0x32, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x71, 0xD9, 0xEF, 0x64, 0x01, 0x70, 0x33, 0x90, 0xA2, 0xF3, 0xE0, 0xFF, -+0x54, 0x03, 0x70, 0x2A, 0x90, 0xA2, 0xF1, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x40, 0x20, 0xEF, 0x20, -+0xE2, 0x1C, 0x90, 0xA2, 0xF3, 0xE0, 0x20, 0xE4, 0x15, 0x90, 0xA2, 0xEB, 0xE0, 0x13, 0x13, 0x54, -+0x3F, 0x30, 0xE0, 0x0A, 0x90, 0xA3, 0x52, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0xE5, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0xA2, 0xE7, 0x74, -+0x01, 0xF0, 0x90, 0xA2, 0xEF, 0xE0, 0x70, 0x02, 0xA1, 0x06, 0x90, 0xA3, 0x06, 0xE0, 0x04, 0x12, -+0x71, 0x1A, 0x12, 0x47, 0x77, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, -+0x12, 0x71, 0x34, 0x78, 0x10, 0x12, 0x27, 0x35, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0x12, 0x47, 0x77, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x71, 0x34, 0x78, -+0x18, 0x12, 0x27, 0x35, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x77, 0x90, -+0xA3, 0x3A, 0x12, 0x27, 0x48, 0x90, 0xA2, 0xEB, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, -+0x09, 0xF1, 0x60, 0x74, 0x05, 0xF0, 0xB1, 0x0B, 0xF1, 0x4D, 0x90, 0xA2, 0xEB, 0xF1, 0xB5, 0x30, -+0xE0, 0x0D, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x06, 0x12, 0x8B, 0x7D, 0x12, 0x8F, 0x02, 0x90, -+0xA6, 0x8B, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, -+0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x01, 0x02, 0x86, 0xCD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0xAC, 0x07, 0x90, 0xA2, 0xEB, 0xE0, 0x12, 0x4F, 0x6F, 0x30, 0xE0, 0x02, 0xA1, 0xC6, -+0x90, 0xA2, 0xEA, 0xE0, 0x30, 0xE0, 0x16, 0x90, 0xA3, 0x0C, 0xE0, 0x24, 0x04, 0x90, 0xA3, 0x04, -+0xF0, 0x90, 0xA3, 0x0C, 0xE0, 0x24, 0x03, 0x90, 0xA3, 0x03, 0xF0, 0x80, 0x0D, 0x90, 0xA3, 0x04, -+0x74, 0x02, 0xF0, 0x90, 0xA3, 0x03, 0x14, 0xF0, 0x0B, 0x0B, 0x90, 0xA3, 0x03, 0xE0, 0xFA, 0x90, -+0xA3, 0x02, 0xE0, 0xD3, 0x9A, 0x50, 0x0E, 0x90, 0xA2, 0xF7, 0xEB, 0xF0, 0x90, 0xA3, 0x04, 0xE0, -+0xC3, 0x9D, 0x2C, 0x80, 0x11, 0xC3, 0xED, 0x9A, 0x2B, 0x90, 0xA2, 0xF7, 0xF0, 0x90, 0xA3, 0x03, -+0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0xA3, 0x07, 0xF0, 0x90, 0xA3, 0x04, 0xE0, 0xFF, 0x24, -+0x0A, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0xA3, 0x07, 0xF1, 0x55, 0x40, 0x04, 0xEF, 0x24, 0x0A, 0xF0, -+0x90, 0xA3, 0x07, 0xE0, 0xFF, 0x24, 0x23, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0xA2, 0xF7, 0xF1, 0x55, -+0x40, 0x04, 0xEF, 0x24, 0x23, 0xF0, 0x90, 0xA3, 0x07, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0xA2, 0xFB, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, 0xE0, 0x6F, 0x70, 0x01, 0xE4, 0x60, 0x03, 0x12, -+0x8F, 0x7D, 0xF1, 0x4D, 0x80, 0x07, 0x90, 0xA2, 0xEC, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x12, 0x71, 0x1B, 0x12, 0x47, 0x77, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0x05, 0x62, 0x12, 0x71, 0x34, 0x78, 0x10, 0x12, 0x27, 0x35, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -+0x01, 0xD0, 0x00, 0x12, 0x47, 0x77, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, -+0x71, 0x34, 0x78, 0x18, 0x12, 0x27, 0x35, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -+0x47, 0x77, 0x90, 0xA3, 0x3E, 0x12, 0x27, 0x48, 0x90, 0xA3, 0x42, 0x12, 0x48, 0x4D, 0x90, 0xA3, -+0x3E, 0x12, 0x48, 0x59, 0xC3, 0x12, 0x47, 0x9A, 0x40, 0x3F, 0x90, 0xA2, 0xEA, 0xE0, 0x90, 0xA3, -+0x42, 0x30, 0xE0, 0x0F, 0xF1, 0x71, 0x90, 0xA3, 0x0C, 0xE0, 0x24, 0x04, 0x2F, 0xFF, 0x90, 0xA3, -+0x46, 0x80, 0x05, 0xF1, 0x71, 0x90, 0xA3, 0x47, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, 0x90, 0xA5, 0x13, -+0xF0, 0x90, 0xA5, 0x13, 0xE0, 0xFF, 0xC3, 0x94, 0x2D, 0x50, 0x0E, 0x74, 0x0D, 0x2F, 0xF1, 0x3D, -+0xE0, 0x04, 0xF0, 0x90, 0xA3, 0x05, 0xE0, 0x04, 0xF0, 0x90, 0xA3, 0x05, 0xE0, 0xFF, 0xD3, 0x90, -+0xA3, 0x49, 0xE0, 0x9F, 0x90, 0xA3, 0x48, 0xE0, 0x94, 0x00, 0x40, 0x02, 0xE1, 0x39, 0xE4, 0xFF, -+0xFE, 0xF1, 0x3A, 0xE0, 0x2F, 0xFF, 0x90, 0xA3, 0x4A, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, 0x40, 0x07, -+0x90, 0xA5, 0x14, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xE5, 0xE4, 0xFF, 0xFE, 0xF1, -+0x3A, 0xE0, 0x2F, 0xFF, 0x90, 0xA3, 0x4A, 0xE0, 0xFD, 0xC3, 0x90, 0xA3, 0x49, 0xE0, 0x9D, 0xFD, -+0x90, 0xA3, 0x48, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, 0x40, 0x07, 0x90, 0xA5, -+0x15, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xD5, 0x90, 0xA5, 0x14, 0xE0, 0x90, 0xA3, -+0x0A, 0xF0, 0x90, 0xA5, 0x15, 0xE0, 0x90, 0xA3, 0x0B, 0xF1, 0x45, 0x94, 0x0A, 0x40, 0x0A, 0xEF, -+0x24, 0xF6, 0x90, 0xA3, 0x02, 0xF0, 0xE4, 0x80, 0x09, 0xE4, 0x90, 0xA3, 0x02, 0xF1, 0x45, 0x74, -+0x0A, 0x9F, 0x90, 0xA3, 0x01, 0xF0, 0x90, 0xA3, 0x0A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, -+0xA3, 0x08, 0xF0, 0x90, 0xA2, 0xEA, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0xA3, 0x46, 0x80, 0x03, 0x90, -+0xA3, 0x47, 0xE0, 0x04, 0xFF, 0x90, 0xA3, 0x08, 0xE0, 0x2F, 0xF0, 0x90, 0xA3, 0x08, 0xE0, 0xC3, -+0x94, 0x0A, 0x50, 0x03, 0x74, 0x0A, 0xF0, 0x90, 0xA3, 0x08, 0xE0, 0x24, 0x02, 0xF0, 0xF1, 0x60, -+0x74, 0x03, 0xF0, 0xB1, 0x0B, 0xE4, 0xFF, 0xF1, 0x8E, 0x22, 0x74, 0x0D, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0xA3, 0xF5, 0x83, 0x22, 0xF0, 0x90, 0xA3, 0x0A, 0xE0, 0xFF, 0xC3, 0x22, 0x90, 0xA2, 0xEC, -+0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, -+0x90, 0xA3, 0x01, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA3, 0x08, 0xE0, 0xFB, 0x90, 0xA6, 0x62, -+0x22, 0x12, 0x48, 0x59, 0x90, 0xA3, 0x3E, 0x12, 0x48, 0x4D, 0x12, 0x47, 0x5C, 0x78, 0x0A, 0x12, -+0x27, 0x22, 0x90, 0xA3, 0x07, 0xE0, 0xFE, 0xC3, 0x74, 0x0A, 0x9E, 0x2F, 0xFF, 0x22, 0xE4, 0xFE, -+0xF1, 0x3A, 0xE4, 0xF0, 0x0E, 0xEE, 0xB4, 0x2D, 0xF7, 0xE4, 0x90, 0xA3, 0x06, 0xF0, 0x90, 0xA3, -+0x05, 0xF0, 0x90, 0xA3, 0x09, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0x2D, 0xF0, 0xE4, 0xA3, -+0xF0, 0x22, 0x90, 0xA2, 0xEA, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xE4, 0xFF, 0x12, 0x8B, -+0xC2, 0xBF, 0x01, 0x0F, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x09, 0xF1, 0xD4, 0x54, 0x07, 0x70, 0x03, -+0x12, 0x60, 0x40, 0x22, 0x90, 0xA2, 0xF3, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x12, 0xA0, 0x59, 0x90, -+0xA5, 0x21, 0xEF, 0xF0, 0x30, 0xE0, 0x05, 0x7D, 0x01, 0xE4, 0x80, 0x02, 0xE4, 0xFD, 0xFF, 0x12, -+0x62, 0x65, 0x90, 0xA5, 0x21, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, -+0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x12, 0x9F, 0x60, 0x74, 0x02, 0xF0, -+0x02, 0x9D, 0x0B, 0xFB, 0x7D, 0x08, 0x7F, 0x01, 0x90, 0xA6, 0x7F, 0xEB, 0xF0, 0xEF, 0x70, 0x06, -+0xA3, 0x74, 0x03, 0xF0, 0x80, 0x0B, 0xEF, 0x64, 0x01, 0x70, 0x2B, 0x90, 0xA6, 0x80, 0x74, 0x42, -+0xF0, 0x7F, 0xE2, 0x12, 0x3A, 0x96, 0x90, 0xA6, 0x7F, 0xE0, 0xFD, 0x7F, 0xE0, 0x12, 0x3A, 0x96, -+0x90, 0xA6, 0x80, 0xE0, 0x12, 0x67, 0xAA, 0x90, 0xA6, 0x80, 0xE0, 0x54, 0xFD, 0x12, 0x67, 0xAA, -+0x12, 0x67, 0xA9, 0x7F, 0x01, 0x22, 0x02, 0x67, 0x6F, 0xE4, 0x90, 0xA5, 0x23, 0xF0, 0xA3, 0xF0, -+0x90, 0x00, 0x83, 0xE0, 0x90, 0xA5, 0x22, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, 0xA5, 0x22, -+0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0xA5, 0x24, 0xE0, 0x94, 0x64, 0x90, 0xA5, 0x23, -+0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA5, 0x22, 0xE0, -+0xFF, 0x22, 0x90, 0xA5, 0x23, 0x12, 0x58, 0xB1, 0x80, 0xC6, 0x90, 0x01, 0xC4, 0x74, 0x9A, 0xF0, -+0x74, 0xA0, 0xA3, 0xF0, 0x90, 0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x74, 0x9A, 0x04, 0x90, 0x01, -+0xC4, 0xF0, 0x74, 0xA0, 0xA3, 0xF0, 0x22, 0x7E, 0xFF, 0x12, 0x6D, 0x7D, 0x74, 0xFF, 0xF0, 0xED, -+0xB4, 0x3E, 0x0A, 0x7E, 0xBD, 0x12, 0x6D, 0x7D, 0x74, 0x3D, 0xF0, 0x80, 0x1A, 0xED, 0xB4, 0x3F, -+0x16, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4F, 0xB1, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x7E, -+0x3E, 0x12, 0x6D, 0x7D, 0x74, 0x3E, 0xF0, 0xED, 0x14, 0xFD, 0x74, 0x22, 0x2F, 0x12, 0x6F, 0xE0, -+0xED, 0xF0, 0xAF, 0x06, 0x22, 0x7E, 0xFF, 0xED, 0x54, 0x7F, 0xFC, 0xED, 0x54, 0x80, 0x60, 0x04, -+0xAE, 0x04, 0x80, 0x1B, 0xEC, 0x64, 0x3D, 0x60, 0x04, 0xEC, 0xB4, 0x3F, 0x12, 0x75, 0xF0, 0x04, -+0xEF, 0x12, 0x4F, 0xB1, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x04, 0xEC, 0x44, 0x80, 0xFE, 0xAF, -+0x06, 0x22, 0xE4, 0xF5, 0x1A, 0x12, 0x54, 0x6A, 0xE0, 0xFE, 0xB4, 0x05, 0x14, 0xED, 0xC3, 0x94, -+0x3B, 0x50, 0x5B, 0xED, 0xC3, 0x94, 0x31, 0x40, 0x5D, 0xED, 0xD3, 0x94, 0x35, 0x50, 0x57, 0x80, -+0x4D, 0xEE, 0xB4, 0x04, 0x08, 0xED, 0xC3, 0x94, 0x31, 0x40, 0x4B, 0x80, 0x41, 0x12, 0x54, 0x6A, -+0xE0, 0xFE, 0xB4, 0x03, 0x14, 0xED, 0xC3, 0x94, 0x19, 0x50, 0x0C, 0xED, 0xC3, 0x94, 0x11, 0x40, -+0x35, 0xED, 0xD3, 0x94, 0x13, 0x50, 0x2F, 0x80, 0x25, 0xEE, 0xB4, 0x02, 0x08, 0xED, 0xC3, 0x94, -+0x11, 0x40, 0x23, 0x80, 0x19, 0x12, 0x54, 0x6A, 0xE0, 0xFE, 0xB4, 0x01, 0x08, 0xED, 0xC3, 0x94, -+0x0A, 0x40, 0x13, 0x80, 0x09, 0xEE, 0x70, 0x0B, 0xED, 0xC3, 0x94, 0x03, 0x40, 0x08, 0x75, 0x1A, -+0x01, 0x80, 0x03, 0xE4, 0xF5, 0x1A, 0xAF, 0x1A, 0x22, 0x8F, 0x0F, 0x8D, 0x10, 0x8B, 0x11, 0x75, -+0xF0, 0x04, 0xEF, 0x12, 0x4F, 0x24, 0xC4, 0x54, 0x03, 0x90, 0xA4, 0x4F, 0xF0, 0x90, 0xA4, 0x4D, -+0x60, 0x09, 0x74, 0x32, 0xF0, 0xA3, 0x74, 0x2F, 0xF0, 0x80, 0x07, 0x74, 0x11, 0xF0, 0xA3, 0x74, -+0x0F, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x12, 0x6F, 0x69, 0xE0, 0xFD, 0x90, 0xA5, 0xD9, 0x74, -+0x04, 0xF0, 0xE4, 0xFB, 0xAF, 0x0F, 0x12, 0x7D, 0xE3, 0xE5, 0x10, 0xD3, 0x94, 0x2D, 0x40, 0x0A, -+0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x12, 0x57, 0x7E, 0x80, 0x20, 0xE5, 0x10, 0xD3, 0x94, 0x1E, 0x40, -+0x05, 0x90, 0xA4, 0x4D, 0x80, 0x14, 0xE5, 0x10, 0xD3, 0x94, 0x14, 0x40, 0x05, 0x90, 0xA4, 0x4E, -+0x80, 0x08, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x12, 0x57, 0x6C, 0xE0, 0xFD, 0x85, 0x11, 0x77, 0xE4, -+0xFB, 0xAF, 0x0F, 0x02, 0x83, 0x1D, 0xEF, 0x04, 0xF5, 0x22, 0xE5, 0x22, 0xD3, 0x9D, 0x50, 0x36, -+0xE5, 0x22, 0x12, 0x94, 0xDD, 0x75, 0xF0, 0x08, 0xEB, 0x12, 0x52, 0x38, 0xE0, 0xF5, 0x82, 0x75, -+0x83, 0x00, 0xE5, 0x22, 0x54, 0x07, 0x12, 0x8F, 0xCA, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -+0xD8, 0xF9, 0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, 0x60, 0x05, 0x85, 0x22, 0x23, -+0x80, 0x04, 0x05, 0x22, 0x80, 0xC4, 0xAF, 0x23, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x04, 0x30, 0x12, 0x7F, 0xCE, 0x90, 0xA4, 0x3E, 0xE0, 0x90, 0x04, 0x33, 0xF0, 0x90, 0xA4, -+0x3F, 0xE0, 0x90, 0x04, 0x34, 0xF0, 0x90, 0xA4, 0x40, 0xE0, 0x90, 0x04, 0x35, 0xF0, 0x90, 0xA4, -+0x41, 0xE0, 0x90, 0x04, 0x36, 0xF0, 0x90, 0xA4, 0x42, 0xE0, 0x90, 0x04, 0x37, 0xF0, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xD3, 0xEF, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x03, 0x7F, 0x05, 0x22, 0xD3, -+0xEF, 0x94, 0xC8, 0xEE, 0x94, 0x00, 0x7F, 0x00, 0x40, 0x02, 0x7F, 0x02, 0x22, 0x12, 0x4F, 0xB8, -+0x12, 0x90, 0x54, 0x30, 0xE1, 0x03, 0x02, 0x7E, 0x16, 0x12, 0x4F, 0x33, 0x12, 0x26, 0x1E, 0x90, -+0xA4, 0x4D, 0x12, 0x4F, 0xE7, 0x90, 0xA4, 0x4E, 0x12, 0x4F, 0x2C, 0x90, 0xA4, 0x4F, 0xF0, 0x90, -+0x00, 0x04, 0x12, 0x26, 0x37, 0x75, 0xF0, 0x10, 0xA4, 0xFF, 0x12, 0x57, 0x66, 0xFD, 0xEF, 0x4D, -+0xFF, 0x90, 0xA4, 0x4E, 0xE0, 0xB4, 0x01, 0x07, 0xA3, 0xE0, 0x12, 0x7F, 0xC1, 0xEF, 0xF0, 0x22, -+0x12, 0x4F, 0xE8, 0xF5, 0x0E, 0x12, 0x4F, 0x2D, 0xF5, 0x0F, 0x12, 0x26, 0x1E, 0xF5, 0x10, 0x90, -+0xA1, 0x2A, 0xF0, 0xE5, 0x0E, 0x60, 0x06, 0xFD, 0xAF, 0x0F, 0x12, 0x7C, 0x16, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x81, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, -+0x3D, 0x90, 0x00, 0x8D, 0xE0, 0x64, 0x01, 0x70, 0x35, 0x90, 0xA6, 0x82, 0xF0, 0x90, 0xA6, 0x82, -+0xE0, 0xFD, 0x90, 0xA6, 0x81, 0xE0, 0x75, 0xF0, 0x10, 0x12, 0x6F, 0x69, 0xE5, 0x82, 0x2D, 0x12, -+0x52, 0x41, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x55, 0xC7, 0x90, 0xA6, 0x82, 0xE0, 0x04, 0xF0, 0xE0, -+0xC3, 0x94, 0x10, 0x40, 0xD8, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x02, 0x71, 0x63, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xE4, 0xFD, 0x7F, 0x8D, 0x02, 0x3A, 0x96, 0x7E, 0x00, 0x7F, 0x2E, 0x7D, 0x00, -+0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x54, 0x02, 0x48, 0xA9, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA5, 0xEA, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA5, 0xE9, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, -+0xFD, 0x12, 0x77, 0x9C, 0x90, 0xA5, 0xF4, 0x12, 0x27, 0x48, 0x90, 0xA5, 0xEC, 0x12, 0x48, 0x4D, -+0x12, 0x27, 0x15, 0x90, 0xA5, 0xF4, 0x12, 0x77, 0xD6, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0x90, 0xA5, 0xEC, 0x12, 0x48, 0x4D, 0x90, 0xA5, 0xF0, 0x12, 0x77, 0xD6, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x77, 0x90, 0xA5, 0xF8, 0x12, 0x27, 0x48, 0x90, 0xA5, -+0xEA, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0xA5, 0xF8, 0x12, 0x48, 0x4D, 0x90, 0xAC, 0x96, 0x12, -+0x27, 0x48, 0x90, 0xA5, 0xE9, 0xE0, 0xFF, 0xD0, 0x05, 0x12, 0x39, 0xBA, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x58, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, -+0x90, 0xA6, 0x57, 0xEF, 0xF0, 0x90, 0xA6, 0x5A, 0xE0, 0xFD, 0x12, 0xA9, 0x49, 0x90, 0xA6, 0x57, -+0xE0, 0xC3, 0x94, 0x0E, 0x50, 0x3F, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, -+0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x12, 0xD4, 0x00, 0x00, 0xD1, 0xEE, 0x90, 0xA5, 0xEC, 0x12, -+0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0xF0, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, -+0xD1, 0x47, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0xF0, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x00, 0xA1, 0x70, 0xD1, 0xFF, 0x50, 0x1B, 0xEF, 0x94, 0x30, 0x50, 0x16, 0x90, 0xA5, -+0xFE, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x09, 0x28, -+0x00, 0x00, 0x80, 0x64, 0x90, 0xA6, 0x57, 0xE0, 0xFF, 0x74, 0x32, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, -+0x94, 0x40, 0x50, 0x16, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA6, -+0x02, 0x12, 0x27, 0x54, 0x08, 0xA6, 0x00, 0x00, 0x80, 0x3E, 0xD1, 0xF5, 0x50, 0x1B, 0xEF, 0x94, -+0x74, 0x50, 0x16, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA6, 0x02, -+0x12, 0x27, 0x54, 0x08, 0xA4, 0x00, 0x00, 0x80, 0x1F, 0x90, 0xA6, 0x57, 0xE0, 0xFF, 0x74, 0x76, -+0xD3, 0x9F, 0x50, 0x16, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA6, -+0x02, 0x12, 0x27, 0x54, 0x08, 0x24, 0x00, 0x00, 0xD1, 0xEE, 0xD1, 0xFF, 0x50, 0x2E, 0xEF, 0x94, -+0x40, 0x50, 0x29, 0x90, 0xA5, 0xEC, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0xF0, -+0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0xD1, 0x47, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, -+0x90, 0xA5, 0xF0, 0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0x80, 0x64, 0xD1, 0xF5, 0x50, 0x2E, -+0xEF, 0x94, 0x8C, 0x50, 0x29, 0x90, 0xA5, 0xEC, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, -+0xA5, 0xF0, 0x12, 0x27, 0x54, 0x00, 0x03, 0x01, 0x00, 0xD1, 0x47, 0x12, 0x27, 0x54, 0x00, 0x07, -+0x03, 0x00, 0x90, 0xA5, 0xF0, 0x12, 0x27, 0x54, 0x00, 0x03, 0x01, 0x00, 0x80, 0x32, 0x90, 0xA6, -+0x57, 0xE0, 0xFF, 0x74, 0x8C, 0xC3, 0x9F, 0x50, 0x2B, 0x90, 0xA5, 0xEC, 0x12, 0x27, 0x54, 0x00, -+0x07, 0x03, 0x00, 0x90, 0xA5, 0xF0, 0x12, 0x27, 0x54, 0x00, 0x05, 0x01, 0x00, 0xD1, 0x47, 0x12, -+0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0xF0, 0x12, 0x27, 0x54, 0x00, 0x05, 0x01, 0x00, -+0xD1, 0xE7, 0x71, 0x79, 0x90, 0xA6, 0x57, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xF1, 0xAD, 0x90, 0xA6, -+0x58, 0xE0, 0x64, 0x02, 0x70, 0x51, 0x90, 0xA6, 0x57, 0xE0, 0xFF, 0xD3, 0x94, 0x30, 0x50, 0x05, -+0x75, 0x79, 0x2A, 0x80, 0x5E, 0xEF, 0xD3, 0x94, 0x40, 0x50, 0x05, 0x75, 0x79, 0x3A, 0x80, 0x53, -+0xEF, 0xD3, 0x94, 0x70, 0x50, 0x05, 0x75, 0x79, 0x6A, 0x80, 0x48, 0xEF, 0xD3, 0x94, 0x80, 0x50, -+0x05, 0x75, 0x79, 0x7A, 0x80, 0x3D, 0xEF, 0xD3, 0x94, 0x90, 0x50, 0x05, 0x75, 0x79, 0x8A, 0x80, -+0x32, 0xEF, 0xD3, 0x94, 0xA1, 0x50, 0x05, 0x75, 0x79, 0x9B, 0x80, 0x27, 0xEF, 0xD3, 0x94, 0xB1, -+0x50, 0x21, 0x75, 0x79, 0xAB, 0x80, 0x1C, 0x90, 0xA6, 0x58, 0xE0, 0x64, 0x01, 0x70, 0x31, 0xA3, -+0xE0, 0x90, 0xA6, 0x57, 0xB4, 0x01, 0x07, 0xE0, 0x24, 0x02, 0xF5, 0x79, 0x80, 0x05, 0xE0, 0x24, -+0xFE, 0xF5, 0x79, 0x90, 0xA5, 0xEC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x79, 0xE4, -+0xFC, 0xFD, 0xFE, 0xD1, 0x41, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x79, 0x80, 0x1E, -+0x90, 0xA5, 0xEC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA6, 0x57, 0x12, 0x71, 0x34, -+0xD1, 0x41, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA6, 0x57, 0xE0, 0xFF, 0xE4, 0xFC, -+0xFD, 0xFE, 0x90, 0xA5, 0xF0, 0x12, 0x27, 0x48, 0xD1, 0xE7, 0x71, 0x79, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0xA5, 0xF0, 0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x71, 0x79, 0x90, -+0xA5, 0xEC, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x14, 0x60, 0x30, 0x14, 0x60, -+0x56, 0x24, 0x02, 0x70, 0x7D, 0x90, 0xA5, 0xEC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, -+0xA5, 0xF0, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0xD1, 0x47, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x0C, 0x00, 0x90, 0xA5, 0xF0, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x80, 0x50, 0x90, 0xA5, -+0xEC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA5, 0xF0, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x04, 0x00, 0xD1, 0x47, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA5, 0xF0, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x04, 0x00, 0x80, 0x27, 0x90, 0xA5, 0xEC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, -+0x00, 0x90, 0xA5, 0xF0, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xD1, 0x47, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x0C, 0x00, 0x90, 0xA5, 0xF0, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xD1, 0xE7, -+0x71, 0x79, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0x22, 0x7F, 0x60, -+0x7E, 0x08, 0x02, 0x73, 0x26, 0x90, 0xA6, 0x57, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x22, 0x90, -+0xA6, 0x57, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x22, 0xFE, 0x13, 0x13, 0x54, 0x07, 0xFB, 0x90, -+0xA6, 0x5B, 0x12, 0x7F, 0xCE, 0xE4, 0xFE, 0x7D, 0x18, 0xFF, 0x12, 0x3A, 0xA9, 0x90, 0xA6, 0x5E, -+0xEF, 0xF0, 0x90, 0xA6, 0x5B, 0xE0, 0xFF, 0xF1, 0x56, 0x90, 0xA6, 0x5B, 0x12, 0x7F, 0xB8, 0x12, -+0xA8, 0xCF, 0xAE, 0x07, 0x90, 0x04, 0x83, 0xEE, 0xF0, 0x90, 0xA6, 0x5B, 0xE0, 0xFF, 0xAD, 0x06, -+0x12, 0x71, 0x3B, 0x90, 0xA6, 0x5E, 0xE0, 0xFF, 0x90, 0xA6, 0x5B, 0xE0, 0xFD, 0xF1, 0xAD, 0x90, -+0xA6, 0x5B, 0xE0, 0xFF, 0xC1, 0x53, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xA9, 0x07, 0x90, -+0x06, 0x69, 0xE0, 0xFE, 0x90, 0x06, 0x68, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0xFE, -+0xE9, 0x14, 0x60, 0x0F, 0x14, 0x60, 0x1E, 0x24, 0x02, 0x70, 0x25, 0xEE, 0x54, 0xFE, 0xFE, 0xF1, -+0xA5, 0x80, 0x1A, 0xEF, 0x44, 0x80, 0xFF, 0xEE, 0x54, 0xFE, 0xFC, 0x90, 0x06, 0x68, 0xEF, 0xF0, -+0xEC, 0xA3, 0xF0, 0x80, 0x0B, 0xEE, 0x44, 0x01, 0xFC, 0xF1, 0xA5, 0xAE, 0x04, 0xEE, 0xA3, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x54, 0x7F, 0x90, 0x06, 0x68, 0xF0, 0x22, 0x90, 0xA6, 0x83, -+0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x00, 0xF1, 0xE0, 0x54, 0xF0, 0x64, 0x20, 0x60, 0x03, 0x02, -+0xA8, 0x7C, 0x90, 0xA6, 0x84, 0xE0, 0xB4, 0x01, 0x1D, 0x90, 0xA6, 0x83, 0xE0, 0xB4, 0x0B, 0x16, -+0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x0C, 0x00, 0x80, 0x14, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, -+0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x08, 0x00, 0x12, 0x77, 0xE5, 0x90, 0xA6, 0x84, -+0xE0, 0x70, 0x21, 0x11, 0xC7, 0x60, 0x04, 0xEF, 0xB4, 0x0E, 0x19, 0x90, 0xA5, 0xFE, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x03, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0x00, 0x12, -+0x77, 0xE5, 0x80, 0x0E, 0x90, 0xA6, 0x84, 0xE0, 0xB4, 0x01, 0x1D, 0x90, 0xA6, 0x83, 0xE0, 0xB4, -+0x0B, 0x16, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, -+0x27, 0x54, 0x40, 0x00, 0x00, 0x00, 0x80, 0x30, 0x90, 0xA6, 0x84, 0xE0, 0x64, 0x02, 0x60, 0x76, -+0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x02, 0x00, 0x12, 0x73, 0x18, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, 0x00, 0x90, 0xA6, -+0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xC4, 0x80, 0x45, 0x90, 0xA6, 0x84, 0xE0, -+0x70, 0x20, 0x11, 0xC7, 0x60, 0x04, 0xEF, 0xB4, 0x0E, 0x18, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x03, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0x00, 0x7F, 0xAC, -+0x80, 0x1F, 0x90, 0xA6, 0x83, 0xE0, 0xD3, 0x94, 0x0E, 0x50, 0x1B, 0x90, 0xA5, 0xFE, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x03, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x02, 0x00, 0x7F, -+0xAC, 0x7E, 0x08, 0x12, 0x73, 0x26, 0x22, 0x90, 0xA6, 0x83, 0xE0, 0xFF, 0x64, 0x0D, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFE, 0xFC, 0xEF, 0x64, 0x02, 0x70, 0x40, 0xED, 0xB4, -+0x01, 0x04, 0x7E, 0x0A, 0x80, 0x06, 0xED, 0xB4, 0x02, 0x02, 0x7E, 0x09, 0xEB, 0xB4, 0x01, 0x08, -+0xED, 0xB4, 0x01, 0x04, 0x7C, 0x04, 0x80, 0x38, 0xEB, 0xB4, 0x02, 0x08, 0xED, 0xB4, 0x01, 0x04, -+0x7C, 0x02, 0x80, 0x2C, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x20, -+0xEB, 0x64, 0x02, 0x70, 0x1B, 0xED, 0x64, 0x02, 0x70, 0x16, 0x7C, 0x03, 0x80, 0x12, 0xEF, 0xB4, -+0x01, 0x0E, 0xEB, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7C, 0x02, -+0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4C, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x04, 0x54, -+0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x90, 0xA6, 0x86, 0xED, 0xF0, 0x90, 0xA6, -+0x85, 0xEF, 0xF0, 0xD3, 0x94, 0x0E, 0x50, 0x15, 0x31, 0x3D, 0xEF, 0x60, 0x2A, 0x31, 0x3D, 0xEF, -+0x64, 0x01, 0x70, 0x23, 0x90, 0xA6, 0x86, 0xE0, 0xFD, 0xE4, 0xFF, 0x80, 0x15, 0x90, 0xA6, 0x85, -+0xE0, 0xD3, 0x94, 0x0E, 0x40, 0x11, 0x31, 0x3D, 0xEF, 0x70, 0x0A, 0x90, 0xA6, 0x86, 0xE0, 0xFD, -+0x7F, 0x01, 0x02, 0x75, 0xDE, 0x31, 0x3D, 0x22, 0x71, 0x5F, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, -+0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x73, 0x22, 0x51, 0x75, -+0xE4, 0x7B, 0x12, 0x7A, 0x01, 0xF9, 0xF8, 0xD3, 0x12, 0x47, 0x9A, 0x40, 0x2D, 0x51, 0x75, 0xE4, -+0x7B, 0xEE, 0x1A, 0xF8, 0xC3, 0x12, 0x47, 0x9A, 0x50, 0x20, 0x90, 0xA5, 0x08, 0x51, 0x78, 0xE4, -+0x7B, 0x12, 0xF8, 0xD3, 0x12, 0x47, 0x9A, 0x50, 0x5F, 0x90, 0xA5, 0x08, 0x51, 0x78, 0xE4, 0x7B, -+0xEE, 0x7A, 0x03, 0xF8, 0xC3, 0x12, 0x47, 0x9A, 0x40, 0x4E, 0x51, 0x83, 0x24, 0x09, 0xF5, 0x82, -+0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x03, 0xFF, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, 0x00, 0xD0, 0x07, -+0xD0, 0x06, 0x51, 0x80, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x03, 0xFF, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x80, 0x46, 0x51, 0x83, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, -+0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x03, 0xFF, 0x51, 0x75, 0x71, 0x59, 0xD0, 0x07, 0xD0, 0x06, 0x51, 0x80, 0x24, 0x09, 0xF5, 0x82, -+0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, -+0x03, 0xFF, 0x00, 0x00, 0x90, 0xA5, 0x08, 0x12, 0x48, 0x4D, 0x78, 0x0F, 0x71, 0x56, 0xD0, 0x07, -+0xD0, 0x06, 0x02, 0x73, 0x26, 0x90, 0xA5, 0x04, 0x12, 0x48, 0x4D, 0x78, 0x01, 0x02, 0x27, 0x22, -+0x12, 0x73, 0x26, 0x90, 0xA5, 0x03, 0xE0, 0x75, 0xF0, 0x1E, 0xA4, 0x22, 0x71, 0x5F, 0x12, 0x27, -+0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x12, -+0x73, 0x22, 0x51, 0x83, 0x24, 0x0D, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x80, 0xD0, 0x07, 0xD0, 0x06, -+0x12, 0x37, 0x5D, 0x51, 0x83, 0x24, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x20, 0x04, 0x00, 0x00, 0xD0, 0x07, 0xD0, -+0x06, 0x12, 0x37, 0x5D, 0x51, 0x83, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0xD0, 0x07, -+0xD0, 0x06, 0x12, 0x37, 0x5D, 0x51, 0x83, 0x24, 0x13, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, -+0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x00, 0x00, 0x07, 0xFF, 0x90, -+0xA5, 0x08, 0x12, 0x48, 0x4D, 0x71, 0x59, 0xD0, 0x07, 0xD0, 0x06, 0x51, 0x80, 0x24, 0x15, 0xF5, -+0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA5, 0xFE, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x07, 0xFF, 0x90, 0xA5, 0x04, 0x12, 0x48, 0x4D, 0x71, 0x59, 0xD0, 0x07, 0xD0, -+0x06, 0x02, 0x73, 0x26, 0x78, 0x1C, 0x12, 0x27, 0x35, 0x90, 0xA6, 0x02, 0x02, 0x27, 0x48, 0x90, -+0xA5, 0x03, 0xEF, 0xF0, 0x90, 0xA5, 0xFE, 0x22, 0x90, 0xA5, 0x03, 0xB1, 0x7A, 0x12, 0x96, 0xFB, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x10, 0x00, 0x00, 0xD0, 0x07, -+0xD0, 0x06, 0x12, 0x67, 0x16, 0x12, 0x27, 0x54, 0xFA, 0x00, 0x00, 0x00, 0x7F, 0x80, 0x7E, 0x09, -+0x12, 0x67, 0x16, 0x12, 0x27, 0x54, 0xF8, 0x00, 0x00, 0x00, 0x7F, 0x80, 0x7E, 0x09, 0x12, 0x37, -+0x5D, 0x7F, 0x03, 0x7E, 0x00, 0x12, 0x3A, 0x69, 0x90, 0xA5, 0x03, 0xE0, 0x60, 0x04, 0xA3, 0xE0, -+0x70, 0x07, 0x7F, 0x04, 0x7E, 0x00, 0x12, 0x3A, 0x69, 0x12, 0x96, 0xFB, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, -+0x5D, 0xE4, 0x90, 0xA5, 0x06, 0xF0, 0xB1, 0x2C, 0x12, 0x97, 0x0A, 0x12, 0x36, 0xCE, 0xE4, 0xFF, -+0xEE, 0x54, 0x04, 0xFE, 0xE4, 0xFD, 0xFC, 0x78, 0x0A, 0x12, 0x27, 0x22, 0xEF, 0x70, 0x18, 0x90, -+0xA5, 0x06, 0xE0, 0xD3, 0x94, 0x14, 0x50, 0x0F, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0x69, 0x90, -+0xA5, 0x06, 0xE0, 0x04, 0xF0, 0x80, 0xCF, 0x90, 0xA5, 0x06, 0xE0, 0xC3, 0x94, 0x14, 0x40, 0x02, -+0xA1, 0x1D, 0x90, 0xA5, 0x04, 0xE0, 0x70, 0x44, 0xB1, 0x2C, 0x12, 0x97, 0x0A, 0xB1, 0x4B, 0x70, -+0x33, 0x12, 0x96, 0xFB, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x02, 0x00, -+0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x96, 0xD0, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, -+0x12, 0x27, 0x54, 0x04, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0xB1, 0x29, 0x12, 0x97, 0x0A, -+0xB1, 0x63, 0xA1, 0x23, 0xB1, 0x3C, 0x60, 0x02, 0x61, 0x6D, 0xA1, 0x23, 0xB1, 0x2C, 0x12, 0x97, -+0x0A, 0xB1, 0x4B, 0x60, 0x02, 0xA1, 0x15, 0x12, 0x96, 0xFB, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x54, 0x06, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x96, 0xD0, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x08, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, -+0x06, 0xB1, 0x29, 0x12, 0x97, 0x0A, 0xB1, 0x63, 0x12, 0x96, 0xFB, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0xAC, 0xB9, 0x12, 0x27, 0x54, 0x05, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0xB1, 0x29, 0x12, -+0x97, 0x0A, 0x12, 0x36, 0xCE, 0x90, 0xA5, 0x09, 0x12, 0x96, 0xF8, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0xAC, 0xB9, 0x12, 0x27, 0x54, 0x06, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0xB1, 0x29, 0x12, -+0x97, 0x0A, 0xB1, 0x54, 0x12, 0x96, 0xF8, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x54, 0x07, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0xB1, 0x29, 0x12, 0x97, 0x0A, 0x12, 0x36, -+0xCE, 0x90, 0xA5, 0x09, 0x12, 0x96, 0xF8, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x54, 0x08, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0xB1, 0x29, 0x12, 0x97, 0x0A, 0xB1, 0x54, -+0x12, 0x27, 0x48, 0x80, 0x0E, 0xB1, 0x3C, 0x60, 0x02, 0x61, 0x6D, 0x80, 0x06, 0xB1, 0x3C, 0x60, -+0x02, 0x61, 0x6D, 0x90, 0xA5, 0x08, 0xE0, 0xFF, 0x22, 0x12, 0x37, 0x5D, 0x90, 0xA5, 0x03, 0xE0, -+0x75, 0xF0, 0x1E, 0xA4, 0x24, 0x0B, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x22, 0xE4, 0x90, 0xA5, 0x08, -+0xF0, 0x90, 0xA5, 0x05, 0xE0, 0x04, 0xF0, 0xE0, 0x64, 0x0A, 0x22, 0x12, 0x36, 0xCE, 0xE4, 0x90, -+0xA5, 0x07, 0xF0, 0x22, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0x1F, 0xFF, 0xE4, 0xFE, 0xFD, 0xFC, 0x90, -+0xA5, 0x0D, 0x22, 0x12, 0x36, 0xCE, 0xE4, 0xFF, 0xFE, 0xEC, 0x54, 0x07, 0xFC, 0x90, 0xA5, 0xAC, -+0x12, 0x27, 0x48, 0x90, 0xA5, 0x08, 0x74, 0x01, 0xF0, 0x22, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xE4, -+0xA3, 0xF0, 0x22, 0x12, 0x97, 0x77, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x73, 0x22, 0xE4, 0x90, 0xA4, 0xB7, 0xF0, 0x12, -+0x77, 0xAE, 0x90, 0xA4, 0xB7, 0xE0, 0xFF, 0xF5, 0x82, 0x12, 0x4F, 0xE1, 0xFE, 0xEF, 0xB1, 0xEF, -+0xF5, 0x82, 0x8C, 0x83, 0xEE, 0xF0, 0x12, 0x97, 0x17, 0xE0, 0xB4, 0x03, 0xE2, 0xE4, 0x90, 0xA4, -+0xB7, 0xF0, 0x90, 0xA4, 0xB7, 0xE0, 0xFD, 0x12, 0x97, 0xAC, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, -+0x07, 0x12, 0x77, 0xB8, 0x75, 0xF0, 0x04, 0xED, 0x12, 0x95, 0x18, 0x12, 0x47, 0xDF, 0x12, 0x66, -+0x94, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x97, 0x14, 0xE0, 0xC3, 0x94, 0x07, 0x40, 0xD4, 0x22, 0x25, -+0xE0, 0x24, 0x3B, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x93, -+0x22, 0x90, 0xA4, 0xB1, 0xEF, 0xF0, 0xA3, 0x12, 0x97, 0x7A, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, -+0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x73, 0x22, 0xD1, 0x4F, -+0x12, 0x47, 0xBF, 0xD1, 0x58, 0x7D, 0x65, 0xD1, 0x4C, 0x90, 0x00, 0x04, 0xD1, 0x55, 0x7D, 0x8F, -+0xD1, 0x4C, 0x90, 0x00, 0x08, 0xD1, 0x55, 0xE4, 0xFD, 0xD1, 0x6B, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0x90, 0xA4, 0xB1, 0xE0, 0xFF, 0x7D, 0xEF, 0x02, 0x7F, 0xE4, 0x12, 0x7F, 0xE4, 0x90, -+0xA4, 0xB2, 0x02, 0x48, 0x71, 0x12, 0x47, 0xDF, 0x90, 0xA5, 0x05, 0x12, 0x27, 0x48, 0x90, 0xA4, -+0xB1, 0xE0, 0xFF, 0x22, 0x90, 0xA4, 0xB1, 0xE0, 0xFF, 0x7D, 0x65, 0x12, 0x7F, 0xE4, 0x90, 0xA5, -+0x05, 0x22, 0x90, 0xA4, 0xB1, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0xA4, 0xFD, 0x12, 0x50, 0x66, -+0xA3, 0xF0, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x73, 0x22, 0x90, 0xA4, 0xB1, 0xE0, 0x90, 0xAC, 0xB9, -+0x70, 0x39, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x90, 0x45, 0x51, 0x12, 0x97, 0x0C, 0x12, -+0x67, 0x16, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x90, 0x45, 0x53, 0x12, 0x97, 0x0C, 0x12, -+0x67, 0x16, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x90, 0x45, 0x5D, 0x12, 0x97, 0x0C, 0x12, -+0x67, 0x16, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x80, 0x37, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0x90, 0x45, 0x51, 0x12, 0x97, 0x0C, 0x12, 0x67, 0x16, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0x90, 0x45, 0x53, 0x12, 0x97, 0x0C, 0x12, 0x67, 0x16, 0x12, 0x27, 0x54, 0x77, 0x77, -+0x77, 0x77, 0x90, 0x45, 0x5D, 0x12, 0x97, 0x0C, 0x12, 0x67, 0x16, 0x12, 0x27, 0x54, 0x77, 0x77, -+0x77, 0x77, 0x90, 0x45, 0x5F, 0x12, 0x97, 0x0C, 0x12, 0x37, 0x5D, 0x12, 0xB7, 0xC6, 0x24, 0x55, -+0xF5, 0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, -+0x27, 0x54, 0x19, 0x79, 0x19, 0x79, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0xB6, 0x9F, 0x24, 0xFF, 0xF5, -+0x82, 0xE4, 0x34, 0x44, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA5, 0xFE, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x0F, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x04, 0xD0, -+0x07, 0xD0, 0x06, 0x12, 0x73, 0x26, 0x12, 0xB7, 0xC6, 0x12, 0x97, 0x83, 0x12, 0x97, 0x0A, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x07, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, -+0x12, 0x27, 0x54, 0x07, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x73, 0x1C, 0x12, 0x27, -+0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, -+0x73, 0x22, 0x90, 0xA5, 0x05, 0x12, 0x27, 0x54, 0x00, 0x08, 0x00, 0x02, 0x90, 0xA4, 0xB1, 0xE0, -+0xFF, 0x7D, 0xEF, 0xD1, 0x6B, 0x12, 0x27, 0x54, 0x00, 0x02, 0x00, 0x00, 0x12, 0xBD, 0x16, 0xD1, -+0x6B, 0x12, 0x27, 0x54, 0x00, 0x03, 0xFF, 0xFD, 0x12, 0xBD, 0x0E, 0xD1, 0x6B, 0x12, 0x27, 0x54, -+0x00, 0x0F, 0xE8, 0x3F, 0x12, 0xBD, 0x06, 0xD1, 0x6B, 0x12, 0x27, 0x54, 0x00, 0x09, 0x31, 0xD5, -+0xD1, 0x64, 0x12, 0x27, 0x54, 0x00, 0x08, 0xA0, 0x01, 0x12, 0xB7, 0x7F, 0x12, 0x7F, 0xE4, 0x90, -+0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x80, 0x00, 0x7F, 0x0C, 0x7E, 0x09, 0x12, 0xB6, 0x9F, -+0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA5, -+0xFE, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x01, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x77, 0xC2, 0x12, 0x27, 0x54, 0x29, 0x00, 0x20, 0x00, -+0x7F, 0x78, 0x7E, 0x09, 0x12, 0x67, 0x16, 0x12, 0x27, 0x54, 0xA9, 0x00, 0x20, 0x00, 0x7F, 0x7C, -+0x7E, 0x09, 0x12, 0x67, 0x16, 0x12, 0x27, 0x54, 0x00, 0x46, 0x29, 0x10, 0x7F, 0x84, 0x7E, 0x09, -+0x12, 0x76, 0xE1, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, -+0x80, 0x00, 0x00, 0x00, 0x12, 0x73, 0x22, 0x90, 0xA3, 0x83, 0xE0, 0x30, 0xE0, 0x31, 0xD1, 0xE7, -+0xF1, 0x90, 0xBF, 0x01, 0x15, 0xD1, 0xCF, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x54, 0x82, 0x14, 0x03, 0xE3, 0x80, 0x2A, 0xD1, 0xCF, 0x12, 0x97, 0x0A, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x82, 0x14, 0x03, 0xF7, 0x80, 0x15, 0xD1, -+0xA2, 0xD1, 0xD0, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, -+0x82, 0x14, 0x03, 0xF1, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x82, 0xE0, 0x30, -+0xE5, 0x1C, 0xD1, 0xA2, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x68, 0x16, 0x3E, 0x96, 0x80, 0x57, 0x90, 0xA3, -+0x82, 0xE0, 0x30, 0xE4, 0x57, 0xD1, 0xA2, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, -+0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x28, 0x16, 0x3E, 0x96, 0xD0, -+0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0xD1, 0xE3, 0xF1, 0x90, 0xBF, 0x03, 0x15, 0xD1, 0xCF, 0x12, -+0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x82, 0x14, 0x03, 0xE3, -+0x80, 0x13, 0xD1, 0xCF, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x54, 0x82, 0x14, 0x03, 0xF7, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0xD1, 0xA2, 0x24, 0x17, -+0xF5, 0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, -+0x27, 0x54, 0x18, 0x00, 0x8C, 0x10, 0xD0, 0x07, 0xD0, 0x06, 0xD1, 0x9F, 0x24, 0x19, 0xF5, 0x82, -+0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, -+0x38, 0x00, 0x8C, 0x10, 0xD0, 0x07, 0xD0, 0x06, 0xD1, 0x9F, 0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, -+0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0xE4, 0x90, 0xA4, 0xB2, 0xF0, 0x90, 0xA4, -+0xB1, 0xE0, 0xFF, 0xE4, 0xFD, 0x12, 0xAB, 0x68, 0x90, 0xA5, 0x01, 0xEF, 0xF0, 0x90, 0xA5, 0xA8, -+0xF1, 0x1E, 0x90, 0xA4, 0xFD, 0xE0, 0xFB, 0xD1, 0xEE, 0xF1, 0x16, 0xEB, 0xF1, 0x0A, 0xF1, 0xB8, -+0x90, 0xA4, 0xFD, 0xF1, 0xA3, 0x40, 0x02, 0x41, 0x59, 0xEE, 0x04, 0xA3, 0xF0, 0x90, 0xA4, 0xFD, -+0xF1, 0x99, 0x50, 0x7D, 0xEE, 0xD1, 0xEE, 0xD1, 0xC1, 0xD1, 0xF2, 0xF1, 0x37, 0xF1, 0x70, 0x50, -+0x68, 0x74, 0xFF, 0x7F, 0xFC, 0xF1, 0x4D, 0xF1, 0x30, 0x40, 0x5E, 0xF1, 0x06, 0xD1, 0xC1, 0xF1, -+0x0E, 0xF1, 0x54, 0x50, 0x54, 0xF1, 0x26, 0x40, 0x50, 0x90, 0xA4, 0xB4, 0xE0, 0xD1, 0xEE, 0xD1, -+0xB7, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xD1, 0xC6, 0xD1, 0xF2, 0xD1, 0xB7, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD1, 0xD8, 0x90, 0xA4, 0xCD, 0x12, 0x27, 0x48, 0xF1, -+0x06, 0xD1, 0xB7, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xD1, 0xC6, 0xF1, 0x0E, 0xD1, -+0xB7, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD1, 0xD8, 0x90, 0xA4, 0xD1, 0x12, 0x27, -+0x48, 0x90, 0xA4, 0xFF, 0x74, 0x01, 0xF0, 0x80, 0x08, 0x90, 0xA4, 0xB4, 0xE0, 0x04, 0xF0, 0x21, -+0xCD, 0x90, 0xA4, 0xB3, 0xE0, 0x04, 0xF0, 0x21, 0xC0, 0x90, 0xA5, 0x01, 0xE0, 0x60, 0x06, 0x90, -+0xA4, 0xFD, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0xFF, 0xE0, 0x64, 0x01, 0x60, 0x06, 0xF1, 0xAD, 0x50, -+0x02, 0x21, 0x9E, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x73, 0x22, 0x90, 0xA4, 0xB1, 0xE0, 0xFF, 0x7D, -+0x08, 0x12, 0x77, 0x9C, 0xE4, 0xFF, 0xEE, 0x54, 0xFC, 0xFE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, -+0x90, 0xA5, 0xF0, 0x12, 0x27, 0x48, 0x90, 0xA5, 0xEC, 0x12, 0x27, 0x54, 0x00, 0x07, 0xFE, 0x00, -+0x90, 0xA4, 0xB1, 0xE0, 0xFF, 0x7D, 0x58, 0x7C, 0x00, 0x12, 0xA3, 0x79, 0x90, 0xA5, 0xFE, 0x12, -+0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, -+0x12, 0x73, 0x22, 0x90, 0xA4, 0xFF, 0xE0, 0xB4, 0x01, 0x16, 0x90, 0xA4, 0xCD, 0xF1, 0x87, 0x90, -+0xA4, 0xD1, 0x12, 0x48, 0x4D, 0x90, 0xA5, 0x08, 0x12, 0xAE, 0x5B, 0x12, 0xAA, 0x8C, 0x80, 0x1E, -+0x90, 0xA5, 0x04, 0x12, 0x27, 0x54, 0x00, 0x00, 0x02, 0x00, 0x90, 0xA5, 0x08, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xB1, 0xE0, 0xFF, 0x12, 0xAA, 0x8C, 0xC1, 0x69, 0x90, 0xA5, -+0xFE, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0x12, 0x73, 0x22, 0x90, 0xA5, 0x05, 0x12, 0x27, 0x54, 0x00, 0x08, 0x00, 0x00, 0x90, -+0xA4, 0xB1, 0xE0, 0xFF, 0x7D, 0xEF, 0x12, 0xAE, 0x6B, 0x12, 0x27, 0x54, 0x00, 0x03, 0x00, 0x00, -+0x12, 0xBD, 0x16, 0x12, 0xAE, 0x6B, 0x12, 0x27, 0x54, 0x00, 0x03, 0xF7, 0xFF, 0x12, 0xBD, 0x0E, -+0x12, 0xAE, 0x6B, 0x12, 0x27, 0x54, 0x00, 0x0F, 0xE7, 0xBF, 0x12, 0xBD, 0x06, 0x12, 0xAE, 0x6B, -+0x12, 0x27, 0x54, 0x00, 0x08, 0x80, 0x01, 0xF1, 0x7F, 0x12, 0xAE, 0x6B, 0x12, 0x27, 0x54, 0x00, -+0x09, 0x31, 0xD1, 0x12, 0xAE, 0x64, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xB1, -+0xE0, 0xFF, 0x7D, 0xEF, 0x12, 0x7F, 0xE4, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, -+0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x7F, 0x78, 0x7E, 0x09, 0x12, -+0x73, 0x1C, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x00, 0x7F, 0x7C, 0x7E, 0x09, 0x12, 0x77, 0xC2, 0x12, 0x27, 0x54, 0x00, 0x00, 0x80, -+0x00, 0x7F, 0x0C, 0x7E, 0x09, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x82, 0xE0, 0x90, 0xAC, 0xB9, 0x30, -+0xE5, 0x09, 0x12, 0x27, 0x54, 0x00, 0x46, 0xA8, 0x91, 0x80, 0x07, 0x12, 0x27, 0x54, 0x00, 0x46, -+0xA8, 0x90, 0x7F, 0x84, 0x7E, 0x09, 0x12, 0x37, 0x5D, 0xD1, 0xE3, 0x64, 0x01, 0x90, 0xA4, 0xB1, -+0x70, 0x33, 0xF1, 0xCF, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x54, 0x77, 0x77, 0x77, 0x17, 0xD0, 0x07, 0xD0, 0x06, 0xF1, 0xC3, 0x24, 0x59, 0xF5, 0x82, 0xE4, -+0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x77, 0x80, 0x31, 0xF1, 0xCF, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x17, 0xD0, 0x07, 0xD0, 0x06, 0xF1, 0xC3, 0x24, 0x59, -+0xF5, 0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, -+0x27, 0x54, 0x02, 0x00, 0x00, 0x77, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA5, 0xFE, -+0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, -+0x00, 0x12, 0x73, 0x22, 0xD1, 0xA2, 0x24, 0x17, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x38, 0x00, 0x8C, 0x10, 0xD0, 0x07, -+0xD0, 0x06, 0xD1, 0x9F, 0x24, 0x19, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x12, 0x97, 0x0A, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x18, 0x00, 0x8C, 0x10, 0xD0, 0x07, 0xD0, 0x06, -+0xD1, 0x9F, 0xD1, 0xD0, 0x12, 0x97, 0x0A, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x54, 0x82, 0x14, 0x01, 0x19, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA4, 0xB1, 0xE0, -+0x70, 0x1E, 0xD1, 0xE3, 0xFF, 0x90, 0xAC, 0xB9, 0xBF, 0x01, 0x09, 0x12, 0x27, 0x54, 0x28, 0x16, -+0x15, 0x00, 0x80, 0x07, 0x12, 0x27, 0x54, 0x28, 0x16, 0x0C, 0xC0, 0x90, 0x45, 0x05, 0x80, 0x1F, -+0xD1, 0xE3, 0xFF, 0x90, 0xAC, 0xB9, 0xBF, 0x01, 0x0C, 0x12, 0x27, 0x54, 0x28, 0x16, 0x15, 0x00, -+0x90, 0x45, 0x23, 0x80, 0x0A, 0x12, 0x27, 0x54, 0x28, 0x16, 0x0C, 0xA0, 0x90, 0x45, 0x23, 0x12, -+0x97, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xA5, 0xFE, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, -+0xA6, 0x02, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x2C, 0x12, 0x73, 0x1A, 0x12, 0x27, -+0x54, 0x03, 0xFF, 0x80, 0x00, 0x90, 0xA4, 0xCD, 0x12, 0x48, 0x4D, 0x78, 0x0F, 0x12, 0x27, 0x35, -+0xE4, 0xFF, 0xEE, 0x54, 0x80, 0xFE, 0xEC, 0x54, 0x03, 0xFC, 0x12, 0xAB, 0x59, 0x7F, 0x78, 0x7E, -+0x09, 0x12, 0x73, 0x1C, 0x12, 0x27, 0x54, 0x00, 0x00, 0x07, 0xFF, 0x90, 0xA4, 0xD1, 0x12, 0x48, -+0x4D, 0xD1, 0xDB, 0x12, 0xAB, 0x59, 0x7F, 0x78, 0x7E, 0x09, 0x12, 0x73, 0x1C, 0x12, 0x27, 0x54, -+0x80, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x02, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x12, 0x73, -+0x22, 0xE4, 0x90, 0xA4, 0xB2, 0xF0, 0x90, 0xA4, 0xB1, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0xAB, 0x68, -+0x90, 0xA5, 0x02, 0xEF, 0xF0, 0x90, 0xA5, 0xA8, 0xF1, 0x1E, 0x90, 0xA4, 0xFE, 0xE0, 0xFB, 0xD1, -+0xFA, 0xF1, 0x16, 0xEB, 0x75, 0xF0, 0x08, 0xA4, 0xF1, 0x77, 0xF1, 0xB8, 0x90, 0xA4, 0xFE, 0xF1, -+0xA3, 0x40, 0x02, 0xC1, 0x4F, 0xEE, 0x04, 0xA3, 0xF0, 0x90, 0xA4, 0xFE, 0xF1, 0x99, 0x40, 0x02, -+0xC1, 0x47, 0xEE, 0xD1, 0xFA, 0xD1, 0xC1, 0xD1, 0xFE, 0xF1, 0x37, 0xF1, 0x70, 0x50, 0x70, 0x74, -+0xFF, 0x7F, 0xFC, 0xF1, 0x4D, 0xF1, 0x30, 0x40, 0x66, 0x90, 0xA4, 0xB4, 0xE0, 0x75, 0xF0, 0x08, -+0xA4, 0xF1, 0x77, 0xD1, 0xC1, 0xF1, 0x77, 0xF1, 0x54, 0x50, 0x54, 0xF1, 0x26, 0x40, 0x50, 0x90, -+0xA4, 0xB4, 0xE0, 0xD1, 0xFA, 0xD1, 0xB7, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xD1, -+0xC6, 0xD1, 0xFE, 0xD1, 0xB7, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD1, 0xD8, 0x90, -+0xA4, 0xF5, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xB4, 0xD1, 0xAB, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0xA4, 0xB3, 0xD1, 0xAB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD1, -+0xD8, 0x90, 0xA4, 0xF9, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x00, 0x74, 0x01, 0xF0, 0x80, 0x08, 0x90, -+0xA4, 0xB4, 0xE0, 0x04, 0xF0, 0xA1, 0xB9, 0x90, 0xA4, 0xB3, 0xE0, 0x04, 0xF0, 0xA1, 0xAC, 0x90, -+0xA5, 0x02, 0xE0, 0x60, 0x06, 0x90, 0xA4, 0xFE, 0xE0, 0x04, 0xF0, 0x90, 0xA5, 0x00, 0xE0, 0x64, -+0x01, 0x60, 0x06, 0xF1, 0xAD, 0x50, 0x02, 0xA1, 0x86, 0x90, 0xA5, 0x00, 0xE0, 0xB4, 0x01, 0x13, -+0x90, 0xA4, 0xF5, 0xF1, 0x87, 0x90, 0xA4, 0xF9, 0x12, 0x48, 0x4D, 0x90, 0xA5, 0x08, 0x12, 0x27, -+0x48, 0x80, 0x14, 0x90, 0xA5, 0x04, 0x12, 0x27, 0x54, 0x00, 0x00, 0x02, 0x00, 0x90, 0xA5, 0x08, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xB1, 0xE0, 0xFF, 0x02, 0xA9, 0x88, 0x12, -+0x37, 0x5D, 0x90, 0xA4, 0xB1, 0xE0, 0x75, 0xF0, 0x1E, 0xA4, 0x22, 0xE0, 0x75, 0xF0, 0x08, 0xA4, -+0x24, 0xE1, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0x12, 0x48, 0x4D, 0x78, 0x16, 0x02, 0x47, -+0xAB, 0xF5, 0x83, 0x12, 0x48, 0x59, 0x90, 0xA4, 0xB3, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x22, 0xA4, -+0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x22, 0x12, 0x47, 0x4F, 0xEE, 0x54, 0x07, 0xFE, 0xE4, -+0xFD, 0xFC, 0x22, 0x90, 0xA3, 0x83, 0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x22, 0x75, 0xF0, -+0x08, 0xA4, 0x24, 0xB5, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0x22, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0xDD, -+0xF5, 0x82, 0xE4, 0x34, 0xA4, 0x22, 0x90, 0xA4, 0xB4, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0xB9, -+0xF5, 0x82, 0xE4, 0x34, 0xA4, 0x22, 0xF5, 0x83, 0x12, 0x27, 0x48, 0x90, 0xA5, 0xAC, 0x12, 0x48, -+0x4D, 0x78, 0x05, 0x02, 0x27, 0x35, 0x74, 0xFF, 0x7F, 0xFC, 0xFE, 0xFD, 0xFC, 0x90, 0xA4, 0xD9, -+0x12, 0x48, 0x59, 0xD3, 0x02, 0x47, 0x84, 0xF5, 0x83, 0x12, 0x48, 0x4D, 0x12, 0x47, 0x5C, 0x78, -+0x15, 0x12, 0x47, 0xAB, 0x90, 0xA4, 0xD5, 0x12, 0x27, 0x48, 0xE4, 0x7F, 0x04, 0xFE, 0xFD, 0xFC, -+0x90, 0xA4, 0xD5, 0x22, 0xF5, 0x83, 0x12, 0x48, 0x4D, 0x12, 0x47, 0x5C, 0x78, 0x15, 0x12, 0x47, -+0xAB, 0x90, 0xA4, 0xD9, 0x12, 0x27, 0x48, 0xE4, 0x7F, 0x04, 0xFE, 0xFD, 0xFC, 0x90, 0xA4, 0xD9, -+0x12, 0x48, 0x59, 0xC3, 0x02, 0x47, 0x84, 0x24, 0xE1, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0x22, 0x90, -+0xA4, 0xB1, 0xE0, 0xFF, 0x7D, 0x8F, 0x22, 0x12, 0x48, 0x4D, 0x90, 0xA5, 0x04, 0x02, 0x27, 0x48, -+0xFF, 0x90, 0xA4, 0xB1, 0xE0, 0x75, 0xF0, 0x1E, 0x22, 0xE0, 0xFF, 0x90, 0xA4, 0xB4, 0xE0, 0xFE, -+0xD3, 0x9F, 0x22, 0xE0, 0xFF, 0x90, 0xA4, 0xB3, 0xE0, 0xFE, 0xD3, 0x9F, 0x22, 0x90, 0xA4, 0xB2, -+0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x03, 0x22, 0xF5, 0x83, 0x12, 0x27, 0x48, 0xE4, 0x90, 0xA4, -+0xB3, 0xF0, 0x22, 0x12, 0x37, 0x5D, 0x90, 0xA4, 0xB1, 0xE0, 0x75, 0xF0, 0x0C, 0xA4, 0x22, 0xE0, -+0x75, 0xF0, 0x0C, 0xA4, 0x24, 0x57, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0x22, 0x90, 0xA4, 0x32, 0xE0, -+0x75, 0xF0, 0x3F, 0x84, 0xAD, 0xF0, 0xED, 0x25, 0xE0, 0x25, 0xE0, 0xFD, 0x74, 0x38, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xED, 0xF0, 0x90, 0xA4, 0x32, 0xE0, 0x04, 0xF0, 0x22, 0x7E, -+0x00, 0x7F, 0x01, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0xE5, 0x12, 0x48, 0xA9, 0x90, 0xA2, -+0xE5, 0xE0, 0x54, 0xFD, 0xF0, 0xE4, 0x12, 0x50, 0x69, 0xA3, 0x74, 0x0C, 0xF0, 0x22, 0x11, 0x35, -+0xE4, 0x90, 0xA2, 0xE8, 0xF0, 0x22, 0x12, 0x67, 0x84, 0x80, 0xF3, 0x12, 0x67, 0x79, 0x80, 0xEE, -+0x12, 0x67, 0xA5, 0x80, 0xE9, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x22, 0x7D, 0x2E, 0x7F, -+0x6F, 0x12, 0x59, 0x6E, 0x7D, 0x02, 0x7F, 0x01, 0x12, 0x62, 0x65, 0x11, 0x35, 0x90, 0xA2, 0xE9, -+0x74, 0x02, 0xF0, 0x22, 0x7D, 0x21, 0x7F, 0xFF, 0x12, 0x59, 0x6E, 0x90, 0xA2, 0xE8, 0x74, 0x03, -+0xF0, 0x22, 0x12, 0x67, 0xE1, 0x80, 0xED, 0x12, 0x65, 0xEC, 0x80, 0xEF, 0x7D, 0x22, 0x7F, 0xFF, -+0x12, 0x59, 0x6E, 0x12, 0x67, 0xB0, 0x80, 0xE3, 0x12, 0x65, 0xEC, 0x7D, 0x24, 0x02, 0x5F, 0xCC, -+0x7D, 0x25, 0x02, 0x5F, 0xCC, 0x90, 0x06, 0xA9, 0xE0, 0x90, 0xA5, 0x13, 0xF0, 0xE0, 0xFD, 0x54, -+0xC0, 0x70, 0x05, 0x12, 0x9F, 0xD4, 0x80, 0x57, 0xED, 0x30, 0xE6, 0x40, 0x90, 0xA2, 0xEF, 0xE0, -+0x64, 0x02, 0x70, 0x28, 0x90, 0xA2, 0xEA, 0xE0, 0xFF, 0xC3, 0x13, 0x20, 0xE0, 0x09, 0x90, 0xA2, -+0xF3, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x1C, 0x12, 0x8F, 0x8E, 0x64, 0x01, 0x70, 0x21, 0x90, 0xA2, -+0xF3, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x01, 0x12, 0x5E, 0x50, 0x80, 0x13, 0x12, 0x8F, 0x87, 0x64, -+0x02, 0x60, 0x04, 0x31, 0x40, 0x80, 0x08, 0x12, 0x8F, 0x95, 0x80, 0x03, 0x12, 0x9F, 0xD4, 0x90, -+0xA5, 0x13, 0xE0, 0x90, 0xA2, 0xF3, 0x30, 0xE7, 0x05, 0x12, 0x6F, 0xE8, 0x80, 0x05, 0xE0, 0x54, -+0xFD, 0xF0, 0x22, 0x90, 0xA2, 0xEA, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x06, 0xA9, 0xE0, 0xF5, -+0x24, 0x54, 0xC0, 0x70, 0x09, 0x12, 0x9F, 0xD4, 0x54, 0xFD, 0xF0, 0x02, 0x60, 0x40, 0xE5, 0x24, -+0x30, 0xE6, 0x18, 0x90, 0xA2, 0xEF, 0xE0, 0x64, 0x01, 0x70, 0x13, 0x12, 0x8F, 0x87, 0x64, 0x02, -+0x60, 0x04, 0x31, 0x40, 0x80, 0x08, 0x12, 0x8F, 0x95, 0x80, 0x03, 0x12, 0x9F, 0xD4, 0xE5, 0x24, -+0x90, 0xA2, 0xF3, 0x30, 0xE7, 0x05, 0x12, 0x6F, 0xE8, 0x80, 0xB8, 0xE0, 0x54, 0xFD, 0xF0, 0x22, -+0x90, 0x04, 0x1D, 0xE0, 0x70, 0x20, 0x90, 0xA1, 0xE1, 0xE0, 0xFF, 0x90, 0xA6, 0x4E, 0x74, 0x09, -+0xF0, 0x7B, 0x18, 0xE4, 0xFD, 0x12, 0x5D, 0xBF, 0x90, 0xA6, 0x87, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x12, 0x9F, 0xB2, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, -+0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0x90, -+0xA6, 0x28, 0xF0, 0x90, 0xA3, 0x4E, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0x90, 0xA6, 0x29, 0xF0, 0xE4, -+0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x70, 0x00, 0x90, 0xA2, 0xEA, 0xE0, 0x44, 0x08, 0xF0, -+0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0B, 0x04, 0x70, 0x24, 0x90, 0xA2, 0xF5, 0x74, 0x02, 0xF0, 0x80, -+0x13, 0xED, 0x70, 0x06, 0x90, 0xA3, 0x4F, 0xE0, 0x80, 0x02, 0xED, 0x14, 0x90, 0xA2, 0xF5, 0xF0, -+0x90, 0xA2, 0xF5, 0xE0, 0xA3, 0xF0, 0x90, 0xA2, 0xEB, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x02, -+0x87, 0xE0, 0x70, 0x1F, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x70, 0x17, 0x90, 0x02, 0x96, 0xE0, -+0x70, 0x11, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE1, 0x0A, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE3, 0x03, -+0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0xEF, 0x60, 0x34, 0x12, 0x8C, 0x3C, 0x70, 0x2F, 0x90, 0xA2, -+0xEB, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, 0x2B, 0x7F, 0x0F, 0x12, 0x59, 0x6E, 0x90, 0x06, 0x04, 0xE0, -+0x54, 0xBF, 0xF0, 0x12, 0x5E, 0xDD, 0xBF, 0x01, 0x14, 0x90, 0xA2, 0xEA, 0xE0, 0x44, 0x40, 0xF0, -+0x7D, 0x06, 0x7F, 0x01, 0x12, 0x62, 0x65, 0x90, 0xA2, 0xE9, 0x74, 0x06, 0xF0, 0x22, 0x7D, 0x2D, -+0x12, 0x59, 0xBA, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, 0x03, 0x12, 0x8A, 0x26, 0x12, -+0x66, 0x9A, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x62, 0x65, 0xE4, 0x90, 0xA2, 0xE9, 0xF0, 0x22, 0x90, -+0xA3, 0x46, 0x74, 0x04, 0xF0, 0xA3, 0x14, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, -+0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x7D, 0x2F, 0x7F, 0xFF, 0x12, 0x59, 0x6E, 0x12, 0x66, 0x9A, -+0x7D, 0x08, 0x7F, 0x01, 0x12, 0x62, 0x65, 0x90, 0xA2, 0xE9, 0x74, 0x08, 0xF0, 0x22, 0x90, 0xA6, -+0x3C, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x51, -+0xEC, 0x44, 0x01, 0xF0, 0x51, 0xEC, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0x51, 0xFB, -+0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x11, 0x2C, 0x71, 0x03, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, -+0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, 0xA7, -+0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, 0x74, -+0xFD, 0xF0, 0x74, 0x14, 0x2C, 0x51, 0xE4, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0x51, -+0xE4, 0xED, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x0D, 0x2C, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x74, 0x12, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0xA6, 0x3A, 0xE0, 0xFF, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x8F, 0xEF, 0xF0, 0x90, 0xA1, 0xE2, 0xE0, -+0xFF, 0x90, 0x04, 0x1C, 0xE0, 0x6F, 0x70, 0x3E, 0x90, 0xA2, 0xF2, 0xE0, 0x64, 0x0E, 0x70, 0x15, -+0x90, 0xA6, 0x8F, 0xE0, 0x70, 0x30, 0x90, 0xA2, 0xEA, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, -+0x12, 0x62, 0x5D, 0x80, 0x1E, 0x90, 0xA2, 0xF2, 0xE0, 0x64, 0x06, 0x70, 0x19, 0x90, 0xA6, 0x8F, -+0xE0, 0x60, 0x13, 0x90, 0xA2, 0xEA, 0xE0, 0x54, 0xBF, 0xF0, 0x71, 0x6B, 0xF0, 0x90, 0xA2, 0xF2, -+0x74, 0x04, 0xF0, 0x12, 0x65, 0xCE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x44, -+0x40, 0xF0, 0xE0, 0x44, 0x80, 0x22, 0xE4, 0xFE, 0xEF, 0x25, 0xE0, 0xFD, 0xEF, 0xC3, 0x94, 0x80, -+0x90, 0xFD, 0x12, 0x50, 0x04, 0xE4, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x90, 0xFD, 0x10, 0xED, -+0xF0, 0xAF, 0x06, 0x22, 0xFF, 0x75, 0xF0, 0x0E, 0x90, 0xA3, 0x62, 0x12, 0x48, 0x65, 0xE0, 0xFE, -+0x75, 0xF0, 0x0E, 0xEF, 0x90, 0xA3, 0x61, 0x12, 0x48, 0x65, 0xE0, 0x90, 0xA6, 0x29, 0xF0, 0x90, -+0xA6, 0x28, 0xEE, 0x22, 0x7F, 0x64, 0x7E, 0x08, 0x12, 0x73, 0x26, 0x90, 0xA6, 0x2C, 0x12, 0x48, -+0x4D, 0xE4, 0xFF, 0xFE, 0xFD, 0xEC, 0x54, 0x04, 0xFC, 0x90, 0xA5, 0xFE, 0x22, 0x74, 0x22, 0x25, -+0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0x22, 0x12, 0x47, 0x77, 0x90, 0xA3, 0x42, 0x12, -+0x27, 0x48, 0x90, 0xA2, 0xEB, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x90, -+0x9B, 0x14, 0x12, 0x48, 0x65, 0xE0, 0x22, 0x90, 0xA3, 0x64, 0x12, 0x48, 0x65, 0xE0, 0xFF, 0x7E, -+0x00, 0xE4, 0xFB, 0x7D, 0x01, 0x22, 0x90, 0xA3, 0x0C, 0xE0, 0x24, 0x04, 0x90, 0xA3, 0x07, 0xF0, -+0xA3, 0x74, 0x0A, 0x22, 0x24, 0x27, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0x22, 0x90, 0x01, -+0x34, 0x74, 0x40, 0xF0, 0xFD, 0xE4, 0xFF, 0x02, 0x8A, 0x26, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, -+0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x22, 0x12, 0x48, 0x65, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, 0x82, 0x8C, -+0x83, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xEF, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0xFE, 0xEF, 0x54, 0x07, 0xFF, 0x22, 0xFC, 0xE5, 0x13, 0xC3, 0x13, 0xFE, -+0xE5, 0x14, 0x13, 0xFF, 0x22, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0x90, 0xA2, 0xFD, 0x22, -+0x90, 0xA6, 0x75, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x22, 0x90, 0xA3, 0x55, 0xE0, 0xFE, 0xC3, -+0x13, 0x54, 0x07, 0x22, 0x90, 0xA6, 0x56, 0xE0, 0xFF, 0x90, 0xA6, 0x54, 0xE0, 0x22, 0x74, 0x01, -+0x93, 0x95, 0x12, 0xE4, 0x93, 0x95, 0x11, 0x22, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0xFF, -+0xE0, 0x22, 0x8B, 0x0E, 0x8A, 0x0F, 0x89, 0x10, 0x22, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, -+0x01, 0x22, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0x22, 0xE4, 0x90, 0xA6, 0x28, 0xF0, -+0xA3, 0x74, 0x03, 0x22, 0xFF, 0x90, 0xA6, 0x71, 0xE0, 0xFB, 0xEF, 0x5B, 0x22, 0x7F, 0xB4, 0x7E, -+0x08, 0x12, 0x36, 0xCE, 0xEF, 0x22, 0x90, 0xA2, 0xE5, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x90, -+0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0xFF, 0x12, 0x26, 0x1E, 0x54, 0x0F, 0xFD, 0x22, 0x90, -+0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0x7F, 0xB4, 0x7E, 0x08, 0x02, 0x37, 0x5D, 0x90, 0xA2, -+0xF3, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA4, 0xB1, 0xE0, 0xFF, 0x7D, 0x32, 0x22, 0x90, 0xA4, -+0xB1, 0xE0, 0xFF, 0x7D, 0x31, 0x22, 0x90, 0xA4, 0xB1, 0xE0, 0xFF, 0x7D, 0x30, 0x22, 0xC4, 0x54, -+0x0F, 0x90, 0xA6, 0x5A, 0xF0, 0x22, 0xFE, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x4F, 0x22, 0xFF, 0x12, -+0x26, 0x1E, 0xFE, 0x54, 0x0F, 0x22, 0x00, 0xC7, -+}; -+u4Byte ArrayLength_MP_8812A_FW_NIC = 32088; -+ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_NIC( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8812A_FW_NIC; -+#else -+ ODM_MoveMemory(pDM_Odm, pFirmware, Array_MP_8812A_FW_NIC, ArrayLength_MP_8812A_FW_NIC); -+#endif -+ *pFirmwareSize = ArrayLength_MP_8812A_FW_NIC; -+} -+ -+ -+u1Byte Array_MP_8812A_FW_NIC_BT[] = { -+0x01, 0x95, 0x13, 0x00, 0x29, 0x00, 0x00, 0x00, 0x06, 0x17, 0x19, 0x26, 0x8C, 0x76, 0x00, 0x00, -+0x65, 0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x4A, 0x9A, 0x02, 0x86, 0x49, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x87, 0x55, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x90, 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x86, 0xCC, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x88, 0x15, 0x00, 0x00, -+0x00, 0x04, 0x0C, 0x00, 0x00, 0x00, 0x04, 0x08, 0x08, 0x00, 0x00, 0x00, 0x0A, 0x08, 0x03, 0x03, -+0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, 0x04, 0x08, 0x05, -+0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, 0x04, 0x00, 0x08, -+0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, 0x0A, 0x03, 0x02, -+0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, 0x10, 0x24, 0x22, -+0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, 0x06, 0x00, 0x20, -+0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, 0x21, 0x0C, 0x04, -+0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, 0x20, 0x21, 0x1F, -+0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, 0x10, 0x00, 0x30, -+0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, 0x28, 0x14, 0x00, -+0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, 0x30, 0x15, 0xF0, -+0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, 0x00, 0x00, -+0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, -+0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, -+0xFF, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x3F, 0x00, 0x00, -+0x00, 0x00, 0x15, 0xF0, 0xCF, 0xFF, 0x00, 0x00, 0x00, 0x16, 0x0D, 0x17, 0x0E, 0x17, 0x0F, 0x18, -+0x10, 0x19, 0x11, 0x1A, 0x12, 0x1A, 0x13, 0x1A, 0x14, 0x1A, 0x15, 0x1B, 0xFF, 0x17, 0x0E, 0x18, -+0x10, 0x19, 0x11, 0x1A, 0x12, 0x1B, 0x15, 0x1C, 0xFF, 0x1D, 0xFF, 0x1E, 0xFF, 0x1F, 0xFF, 0xFF, -+0xFF, 0x14, 0x0D, 0x0E, 0x15, 0x15, 0x0F, 0x16, 0x10, 0x17, 0x11, 0x18, 0x12, 0x18, 0x13, 0x18, -+0xFF, 0x15, 0x0D, 0x16, 0x10, 0x10, 0x17, 0x18, 0x12, 0x19, 0xFF, 0x1A, 0xFF, 0x1B, 0xFF, 0xFF, -+0xFF, 0x00, 0x00, 0x00, 0x00, 0x04, 0x04, 0x0C, 0x0C, 0x0D, 0x0C, 0x0E, 0x0D, 0x0F, 0x17, 0x18, -+0x10, 0x19, 0x11, 0x19, 0x11, 0x19, 0x12, 0x1A, 0x14, 0x0C, 0x0C, 0x16, 0x0D, 0x17, 0x0F, 0x18, -+0x10, 0x19, 0x13, 0x1A, 0x14, 0x1B, 0x15, 0x1C, 0x1B, 0x1D, 0x1C, 0x1E, 0x1D, 0x04, 0x04, 0x0C, -+0x14, 0x0D, 0x14, 0x0E, 0x14, 0x0F, 0x15, 0x10, 0x16, 0x17, 0x11, 0x12, 0x17, 0x0C, 0x0C, 0x14, -+0x0E, 0x15, 0x0F, 0x16, 0x10, 0x17, 0x12, 0x18, 0x18, 0x19, 0x19, 0x1A, 0x19, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, 0x25, 0x27, -+0x28, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, -+0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, -+0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, -+0x00, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, 0x2A, 0x2A, -+0x2A, 0x00, 0x04, 0x00, 0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, -+0x48, 0x00, 0x60, 0x00, 0x90, 0x00, 0xC0, 0x00, 0xD8, 0x00, 0x3C, 0x00, 0x64, 0x00, 0x78, 0x00, -+0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, 0x90, 0x01, 0xE0, 0x00, 0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, -+0x90, 0x02, 0x58, 0x03, 0x20, 0x04, 0xB0, 0x06, 0x40, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, -+0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, -+0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x64, 0x00, -+0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, 0x90, 0x01, 0x90, 0x02, 0x58, 0x03, 0x20, 0x00, 0x78, 0x00, -+0xF0, 0x01, 0x90, 0x02, 0x58, 0x03, 0xE8, 0x07, 0xD0, 0x09, 0x60, 0x0F, 0xA0, 0x12, 0xC0, 0x15, -+0x18, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, -+0xD0, 0x07, 0xD0, 0x07, 0xD0, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, -+0xB0, 0x06, 0x40, 0x07, 0xD0, 0x07, 0xD0, 0x07, 0xD0, 0x00, 0x02, 0x00, 0x02, 0x00, 0x04, 0x00, -+0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x48, 0x00, 0x60, 0x00, -+0x6C, 0x00, 0x14, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x00, -+0xF0, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x01, 0x2C, 0x01, 0x90, 0x02, 0x58, 0x03, -+0x20, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, -+0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, -+0xE8, 0x00, 0x1E, 0x00, 0x28, 0x00, 0x32, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x00, -+0xF0, 0x01, 0x7C, 0x01, 0x90, 0x00, 0x3C, 0x00, 0x78, 0x00, 0xC8, 0x01, 0x2C, 0x01, 0xF4, 0x03, -+0xE8, 0x04, 0xB0, 0x07, 0xD0, 0x09, 0x60, 0x0A, 0xF0, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, -+0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x00, 0x64, 0x00, -+0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, -+0xE8, 0x02, 0x04, 0x06, 0x08, 0x0A, 0x0C, 0x10, 0x18, 0x20, 0x30, 0x40, 0x50, 0x01, 0x01, 0x01, -+0x02, 0x01, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, 0x05, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0B, 0x05, 0x06, 0x06, -+0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, -+0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x01, 0x02, 0x03, -+0x04, 0x05, 0x06, 0x07, 0x08, 0x02, 0x04, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x03, 0x05, 0x06, -+0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x02, 0x04, 0x06, -+0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x03, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, -+0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, -+0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, 0x04, 0x0C, 0x14, 0x2C, -+0x36, 0x04, 0x08, 0x08, 0x08, 0x0A, 0x0A, 0x04, 0x04, 0x04, 0x05, 0x04, 0x04, 0x05, 0x07, 0x07, -+0x07, 0x08, 0x0A, 0x04, 0x07, 0x0A, 0x0E, 0x11, 0x13, 0x14, 0x15, 0x03, 0x04, 0x07, 0x07, 0x08, -+0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, -+0x0B, 0x0D, 0x0F, 0x07, 0x08, 0x08, 0x0A, 0x0A, 0x0C, 0x0E, 0x10, 0x11, 0x11, 0x07, 0x09, 0x09, -+0x0B, 0x0B, 0x0D, 0x0F, 0x13, 0x13, 0x14, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, -+0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, -+0x07, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x05, 0x06, 0x07, 0x0D, 0x10, 0x11, 0x12, 0x12, 0x07, -+0x08, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, -+0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x05, 0x06, 0x08, 0x09, 0x0C, 0x0E, 0x12, 0x12, 0x13, -+0x14, 0x07, 0x08, 0x09, 0x0A, 0x0C, 0x0F, 0x12, 0x12, 0x14, 0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, -+0x0E, 0x11, 0x13, 0x13, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x45, 0xE4, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4B, 0x32, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x4B, 0x32, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x46, 0x2D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x46, 0x2C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, 0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x46, 0x2D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, -+0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, -+0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, 0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, -+0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, -+0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, -+0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, -+0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, 0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, -+0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, 0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, -+0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, -+0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, -+0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, 0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, -+0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, -+0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, 0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, -+0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, -+0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, -+0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x48, 0xD9, 0x73, 0xC5, -+0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, 0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, -+0x83, 0xE0, 0x38, 0xF0, 0x22, 0xBB, 0x01, 0x0A, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, -+0xE0, 0x22, 0x50, 0x06, 0x87, 0xF0, 0x09, 0xE7, 0x19, 0x22, 0xBB, 0xFE, 0x07, 0xE3, 0xF5, 0xF0, -+0x09, 0xE3, 0x19, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0x74, 0x01, 0x93, 0x22, -+0xBB, 0x01, 0x10, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0xE0, 0xF5, 0xF0, -+0xA3, 0xE0, 0x22, 0x50, 0x09, 0xE9, 0x25, 0x82, 0xF8, 0x86, 0xF0, 0x08, 0xE6, 0x22, 0xBB, 0xFE, -+0x0A, 0xE9, 0x25, 0x82, 0xF8, 0xE2, 0xF5, 0xF0, 0x08, 0xE2, 0x22, 0xE5, 0x83, 0x2A, 0xF5, 0x83, -+0xE9, 0x93, 0xF5, 0xF0, 0xA3, 0xE9, 0x93, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, -+0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, -+0xFC, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE0, 0xF8, -+0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, -+0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, -+0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, -+0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, -+0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0xEF, 0x4E, -+0x60, 0x12, 0xEF, 0x60, 0x01, 0x0E, 0xED, 0xBB, 0x01, 0x0B, 0x89, 0x82, 0x8A, 0x83, 0xF0, 0xA3, -+0xDF, 0xFC, 0xDE, 0xFA, 0x22, 0x89, 0xF0, 0x50, 0x07, 0xF7, 0x09, 0xDF, 0xFC, 0xA9, 0xF0, 0x22, -+0xBB, 0xFE, 0xFC, 0xF3, 0x09, 0xDF, 0xFC, 0xA9, 0xF0, 0x22, 0x02, 0x4A, 0xD8, 0x02, 0x46, 0xBD, -+0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, -+0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, -+0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, -+0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x4B, 0x1D, 0xE4, 0x7E, 0x01, 0x93, 0x60, -+0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, -+0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, -+0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, -+0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0x41, 0xA5, 0x5F, -+0x00, 0x41, 0xA5, 0x60, 0x00, 0x41, 0xA5, 0x61, 0x00, 0x41, 0xA5, 0x86, 0x00, 0x41, 0xA5, 0x8A, -+0x00, 0x00, 0x57, 0xF9, 0x5F, 0xF9, 0x67, 0xF3, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, -+0x90, 0xA4, 0x74, 0xF0, 0x90, 0xA4, 0x79, 0xF0, 0x90, 0xA4, 0x77, 0xF0, 0x91, 0x98, 0x40, 0x02, -+0x61, 0xDA, 0xC3, 0x74, 0xFD, 0x91, 0xA1, 0x7A, 0xA4, 0x79, 0x73, 0x12, 0x33, 0xC7, 0xEF, 0x64, -+0x01, 0x60, 0x02, 0x81, 0x36, 0x90, 0xA4, 0x73, 0xE0, 0xFF, 0x54, 0xC0, 0xFE, 0x60, 0x05, 0xEF, -+0x54, 0x0C, 0x70, 0x1C, 0x90, 0xA4, 0x73, 0xE0, 0xFF, 0x54, 0x30, 0x60, 0x05, 0xEF, 0x54, 0x03, -+0x70, 0x08, 0x90, 0xA4, 0x77, 0xE0, 0x60, 0x4A, 0x80, 0x00, 0x90, 0xA4, 0x74, 0x74, 0x01, 0xF0, -+0x90, 0xA4, 0x74, 0xE0, 0x90, 0xA4, 0x73, 0x70, 0x17, 0xE0, 0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, -+0x03, 0x90, 0xA4, 0x75, 0xF0, 0xEF, 0x54, 0x0C, 0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0x80, 0x10, -+0xE0, 0xFF, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0xA4, 0x75, 0xF0, 0xEF, 0x54, 0x03, 0xA3, 0xF0, -+0x90, 0xA4, 0x75, 0xE0, 0x90, 0xA3, 0xEC, 0xF0, 0x90, 0xA4, 0x76, 0xE0, 0x90, 0xA3, 0xED, 0xF0, -+0x80, 0x08, 0x90, 0xA4, 0x77, 0xE0, 0x04, 0xF0, 0x61, 0x4C, 0xE4, 0x90, 0xA4, 0x77, 0xF0, 0x91, -+0x98, 0x50, 0x63, 0xC3, 0x74, 0xFB, 0x91, 0xA1, 0x7A, 0xA4, 0x79, 0x78, 0x12, 0x33, 0xC7, 0xEF, -+0x64, 0x01, 0x70, 0x42, 0x90, 0xA4, 0x78, 0xE0, 0xFF, 0x54, 0xE0, 0xFE, 0x70, 0x13, 0xEF, 0x54, -+0x0E, 0x70, 0x08, 0x90, 0xA4, 0x77, 0xE0, 0x60, 0x35, 0x80, 0x00, 0x90, 0xA4, 0x79, 0x74, 0x01, -+0xF0, 0x90, 0xA4, 0x79, 0xE0, 0x70, 0x09, 0xEE, 0xC4, 0x13, 0x54, 0x07, 0xA3, 0xF0, 0x80, 0x0C, -+0x90, 0xA4, 0x78, 0xE0, 0x54, 0x0E, 0xC3, 0x13, 0x90, 0xA4, 0x7A, 0xF0, 0x90, 0xA4, 0x7A, 0xE0, -+0x90, 0xA3, 0xEE, 0xF0, 0x80, 0x10, 0x90, 0xA4, 0x7B, 0x74, 0x01, 0xF0, 0x80, 0x40, 0x90, 0xA4, -+0x77, 0xE0, 0x04, 0xF0, 0x80, 0x99, 0x90, 0xA3, 0xED, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x54, 0x0C, -+0xFF, 0x90, 0xA3, 0xEC, 0xE0, 0x54, 0x03, 0x4F, 0xFF, 0x90, 0xA3, 0xEE, 0xE0, 0xFE, 0xC4, 0x54, -+0x70, 0x4F, 0x44, 0x80, 0xFD, 0x7F, 0x8B, 0x12, 0x3A, 0x96, 0x90, 0xA3, 0xEC, 0xE0, 0x60, 0x08, -+0xA3, 0xE0, 0x60, 0x04, 0xA3, 0xE0, 0x70, 0x1B, 0x90, 0xA4, 0x7B, 0x74, 0x03, 0xF0, 0x90, 0x01, -+0xC4, 0x74, 0x38, 0xF0, 0x74, 0x4B, 0xA3, 0xF0, 0x90, 0xA4, 0x7B, 0xE0, 0x90, 0x01, 0xC8, 0x91, -+0xAB, 0x80, 0xEB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA4, 0x77, 0xE0, 0xFF, 0xC3, 0x94, 0x02, -+0x22, 0x9F, 0xFF, 0x74, 0x03, 0x94, 0x00, 0xFE, 0x7B, 0x01, 0x22, 0xF0, 0xE4, 0xFD, 0x7F, 0x1F, -+0x02, 0x3A, 0x96, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x85, 0xEF, 0xF0, 0xA3, -+0x74, 0x02, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0xB3, 0xF0, 0x74, 0x4C, 0xA3, 0xF0, 0x90, 0xA4, 0x86, -+0xE0, 0x90, 0x01, 0xC8, 0xF0, 0x90, 0xA4, 0x85, 0xE0, 0x90, 0x01, 0xC9, 0x91, 0xAB, 0x80, 0xE3, -+0xF1, 0xD0, 0x12, 0x26, 0x1E, 0x54, 0x7F, 0xF5, 0x0E, 0x12, 0x7F, 0x57, 0xFF, 0x54, 0x1F, 0xF5, -+0x10, 0xEF, 0x54, 0x80, 0xF1, 0x80, 0xF5, 0x0F, 0xF1, 0x61, 0xFF, 0x54, 0x03, 0xF5, 0x11, 0xEF, -+0x54, 0x30, 0xC4, 0x54, 0x0F, 0xF5, 0x14, 0xF1, 0x61, 0xFF, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, -+0x03, 0xF5, 0x12, 0xEF, 0x54, 0x80, 0xF1, 0x80, 0xF5, 0x13, 0xF1, 0x61, 0xFF, 0x54, 0x08, 0xFE, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0xF5, 0x16, 0xEF, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xF5, 0x17, -+0x90, 0xA3, 0xED, 0xE0, 0xB4, 0x02, 0x08, 0xE5, 0x14, 0x60, 0x04, 0xE4, 0xFF, 0x91, 0xB3, 0x90, -+0xA3, 0xEE, 0xE0, 0xB4, 0x01, 0x11, 0xF1, 0x94, 0xF1, 0x76, 0x54, 0xF0, 0x70, 0x05, 0x12, 0x7F, -+0xE4, 0x60, 0x04, 0x7F, 0x01, 0x91, 0xB3, 0xE5, 0x13, 0x12, 0xB5, 0xEF, 0xB1, 0xDD, 0x54, 0x7F, -+0x4F, 0xF0, 0xE5, 0x12, 0xF1, 0x87, 0xB1, 0xDD, 0x54, 0xBF, 0x4F, 0xF0, 0xE5, 0x16, 0x70, 0x6C, -+0xE5, 0x10, 0x54, 0x1F, 0xF1, 0x67, 0x54, 0xE0, 0x4F, 0xF0, 0xE5, 0x11, 0x54, 0x03, 0xB1, 0xDD, -+0x54, 0xFC, 0x4F, 0xF0, 0xEF, 0x25, 0xE0, 0x25, 0xE0, 0xB1, 0xDD, 0x54, 0xF3, 0x4F, 0xF0, 0xE5, -+0x0F, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0xF1, 0x67, 0x54, 0xDF, 0x4F, 0xF0, 0xE5, 0x14, 0x54, -+0x03, 0xC4, 0x54, 0xF0, 0xB1, 0xDD, 0x54, 0xCF, 0x4F, 0xF0, 0xE4, 0xF5, 0x15, 0xE5, 0x15, 0x24, -+0x03, 0xFF, 0xE4, 0x33, 0xFE, 0xF1, 0x94, 0x8F, 0x82, 0x8E, 0x83, 0x12, 0x26, 0x37, 0xFF, 0x75, -+0xF0, 0x08, 0xE5, 0x0E, 0x12, 0x55, 0x0C, 0xE5, 0x82, 0x25, 0x15, 0x12, 0x52, 0xCA, 0xEF, 0xF0, -+0x05, 0x15, 0xE5, 0x15, 0xB4, 0x04, 0xD6, 0xAF, 0x0E, 0x12, 0x52, 0xD2, 0x22, 0xFF, 0x75, 0xF0, -+0x04, 0xE5, 0x0E, 0x90, 0x96, 0x14, 0x51, 0x2A, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x00, 0x8F, 0xE0, 0x20, 0xE6, 0x02, 0xE1, 0x23, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0xA5, -+0x62, 0xF0, 0x90, 0x00, 0x8D, 0xE0, 0x90, 0xA5, 0x63, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0xA5, -+0x64, 0xF0, 0x90, 0xA5, 0x63, 0xE0, 0x24, 0xFC, 0x60, 0x16, 0x24, 0xEE, 0x70, 0x02, 0xC1, 0xDE, -+0x24, 0x15, 0x60, 0x02, 0xE1, 0x19, 0x90, 0xA5, 0x62, 0xE0, 0xFF, 0x12, 0xAE, 0x6F, 0xE1, 0x19, -+0x90, 0xA5, 0x62, 0xE0, 0x24, 0x11, 0x12, 0x6D, 0x66, 0xFB, 0xE4, 0xFD, 0xFF, 0xF1, 0x58, 0x75, -+0xF0, 0x04, 0xB1, 0xE3, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0xF1, 0x58, 0x75, 0xF0, -+0x04, 0xB1, 0xE3, 0xF1, 0x80, 0xFB, 0x0D, 0xE4, 0xFF, 0xF1, 0x58, 0x75, 0xF0, 0x04, 0xB1, 0xE3, -+0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0xF1, 0x58, 0x75, 0xF0, 0x04, 0x12, 0x57, 0x92, 0xE0, -+0xFB, 0xE4, 0xFD, 0x0F, 0xF1, 0x58, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x12, 0xF1, 0x53, 0x75, 0xF0, -+0x04, 0xF1, 0x6D, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0xF1, 0x58, 0x75, 0xF0, 0x04, -+0xF1, 0x6D, 0x54, 0x1F, 0xF1, 0x56, 0x12, 0x55, 0x09, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xF1, 0x58, -+0x75, 0xF0, 0x08, 0x90, 0x89, 0x01, 0xF1, 0x53, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0xF1, 0x53, -+0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0xF1, 0x53, 0x75, 0xF0, 0x08, 0x12, 0xB6, 0x79, 0xFB, 0xE4, -+0xFD, 0x0F, 0xF1, 0x58, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x05, 0xF1, 0x53, 0x75, 0xF0, 0x08, 0x90, -+0x89, 0x06, 0xF1, 0x53, 0x75, 0xF0, 0x08, 0x12, 0xB6, 0x71, 0xFB, 0x0D, 0x80, 0x39, 0x90, 0xA3, -+0xE4, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0xF1, 0x2B, 0x90, 0xA3, 0xE5, 0xA3, 0xF1, 0x28, 0x90, 0xA3, -+0xE7, 0xF1, 0x28, 0x90, 0xA3, 0xE8, 0xE0, 0x54, 0x03, 0xFB, 0x0D, 0xF1, 0x2B, 0x90, 0xA3, 0xE9, -+0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xF1, 0x2B, 0x90, 0xA3, 0xE9, 0xE0, 0xFB, 0x0D, 0xF1, 0x2B, -+0x90, 0xA3, 0xEB, 0xE0, 0xFB, 0x1D, 0x0F, 0xF1, 0x2B, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x03, -+0x12, 0xAE, 0xC4, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFB, 0x0D, 0xEF, 0x70, 0x04, 0x74, 0xF0, -+0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, -+0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, -+0xEB, 0xF0, 0x22, 0x51, 0x2A, 0xE0, 0xFB, 0x0D, 0xF1, 0x2B, 0x90, 0xA5, 0x62, 0xE0, 0x22, 0x4F, -+0xF0, 0x90, 0x00, 0x02, 0x02, 0x26, 0x37, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x90, 0x96, 0x13, -+0x51, 0x2A, 0xE0, 0x22, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, 0x26, 0x37, 0x90, 0xA3, 0x56, 0xE0, -+0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0x22, 0x90, -+0xA4, 0x82, 0x51, 0x3F, 0x90, 0xA4, 0x82, 0x41, 0x36, 0xF1, 0xD0, 0x12, 0x26, 0x1E, 0xFF, 0xF1, -+0x94, 0xF1, 0x61, 0x90, 0xA5, 0x4E, 0xF0, 0xE4, 0xFB, 0xFD, 0x12, 0x80, 0x93, 0x90, 0xA4, 0x85, -+0x74, 0x10, 0xF0, 0x90, 0xA4, 0x93, 0x74, 0x07, 0xF0, 0xF1, 0x94, 0x12, 0x26, 0x1E, 0x90, 0xA4, -+0x87, 0xF0, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x85, 0x12, 0x93, 0xEE, 0x7F, 0x04, 0x02, 0x90, 0x8D, -+0x90, 0xA4, 0x82, 0x41, 0x3F, 0xF1, 0xD0, 0xF1, 0x61, 0x30, 0xE0, 0x11, 0xF1, 0x94, 0x12, 0x7F, -+0xDC, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x4C, 0x02, 0x34, 0x2C, 0x90, 0xA3, 0x4C, -+0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, -+0x07, 0xF0, 0x22, 0x90, 0x00, 0xF0, 0xE0, 0x7F, 0x01, 0x20, 0xE2, 0x02, 0x7F, 0x03, 0x22, 0x11, -+0x03, 0x90, 0xA1, 0x29, 0xEF, 0xF0, 0x11, 0x21, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x02, 0x35, -+0x95, 0x11, 0x46, 0x11, 0x74, 0x12, 0xA6, 0xC2, 0x12, 0xA6, 0xE1, 0x12, 0xA6, 0x9C, 0xE4, 0xF5, -+0x51, 0x75, 0x52, 0x58, 0xAB, 0x51, 0x7D, 0x02, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x52, 0x7D, -+0x03, 0x7F, 0x01, 0x02, 0x39, 0x04, 0x90, 0x01, 0x30, 0xE4, 0x11, 0x6C, 0x90, 0x01, 0x38, 0x11, -+0x6C, 0xFD, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xE4, 0xFD, -+0x7F, 0x52, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x53, 0x02, 0x3A, 0x96, 0xF0, 0xA3, 0xF0, 0xA3, -+0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0x34, 0x74, 0xFF, 0x11, 0x6C, 0x90, 0x01, 0x3C, 0x11, 0x6C, -+0xFD, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, -+0x56, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x3A, 0x96, 0x12, 0x4F, 0x8F, 0x12, 0x7F, -+0xDC, 0x75, 0x43, 0x05, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0xA2, 0x12, 0x34, 0x2C, 0x90, 0xA3, 0xA4, -+0x31, 0x15, 0xEF, 0x78, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xA3, 0xAC, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA3, 0xA5, 0x31, 0x15, 0xEF, 0x78, 0x05, 0xCE, 0xC3, 0x13, -+0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xA3, 0xAE, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA3, 0xA6, -+0x31, 0x15, 0x90, 0xA3, 0xB0, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA3, 0xA2, 0xE0, 0x30, 0xE0, -+0x14, 0x90, 0xA3, 0xA7, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0xA3, 0x12, 0x79, 0x73, 0x90, 0x07, 0x83, -+0xE0, 0x44, 0x20, 0xF0, 0x22, 0xE4, 0x90, 0xA3, 0xA7, 0x11, 0x6C, 0xA3, 0xF0, 0x90, 0x07, 0x83, -+0xE0, 0x54, 0xDF, 0xF0, 0x22, 0xE0, 0xFF, 0x7E, 0x00, 0x7C, 0x01, 0x7D, 0x40, 0x02, 0x26, 0x98, -+0x90, 0xA3, 0xE4, 0x74, 0xFF, 0xF0, 0xE4, 0x11, 0x6D, 0xA3, 0xE0, 0x54, 0xFC, 0x44, 0x02, 0xF0, -+0xE4, 0x01, 0x6D, 0xF1, 0xA9, 0x12, 0xA1, 0xF5, 0x31, 0x45, 0x12, 0x62, 0xB2, 0x12, 0xAE, 0xCB, -+0x12, 0x9E, 0x4C, 0x80, 0xDB, 0x75, 0x40, 0xFF, 0x75, 0x41, 0x44, 0x75, 0x42, 0x4B, 0x75, 0x43, -+0x06, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x2C, 0xD1, 0xA7, 0x75, 0x41, 0x44, 0x75, 0x42, 0x51, 0x75, -+0x43, 0x06, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x32, 0xD1, 0xA7, 0x75, 0x41, 0x44, 0x75, 0x42, 0x57, -+0x75, 0x43, 0x54, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x38, 0xD1, 0xA7, 0x75, 0x41, 0x44, 0x75, 0x42, -+0xAB, 0x75, 0x43, 0x54, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x8C, 0x12, 0x34, 0x2C, 0xE4, 0xF5, 0x0D, -+0xE4, 0xFF, 0x74, 0x91, 0x25, 0x0D, 0xB1, 0x17, 0xE0, 0x54, 0xFE, 0xF0, 0x75, 0xF0, 0x10, 0xE5, -+0x0D, 0x90, 0x81, 0x00, 0xBF, 0x03, 0x07, 0x51, 0xC4, 0x74, 0x80, 0xF0, 0x80, 0x04, 0x51, 0xC4, -+0xE4, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x0D, 0x51, 0xC1, 0xE4, 0xF0, 0x0F, 0xBF, 0x10, 0xD3, 0x05, -+0x0D, 0xE5, 0x0D, 0xB4, 0x80, 0xCA, 0xE4, 0x90, 0xAF, 0x7D, 0xF0, 0xF5, 0x0D, 0xE4, 0xFF, 0x75, -+0xF0, 0x0A, 0xE5, 0x0D, 0xF1, 0x98, 0xF0, 0x0F, 0xBF, 0x05, 0xF4, 0x75, 0xF0, 0x04, 0xE5, 0x0D, -+0x12, 0x6F, 0x4E, 0xE0, 0x54, 0x07, 0xF0, 0x74, 0x22, 0x25, 0x0D, 0x12, 0xB4, 0xFF, 0x74, 0x3F, -+0xF0, 0x74, 0x21, 0x25, 0x0D, 0x12, 0x6F, 0x5A, 0xE4, 0xF0, 0x74, 0x01, 0x25, 0x0D, 0x12, 0x6F, -+0x36, 0x74, 0xC0, 0xF0, 0x74, 0xA2, 0x25, 0x0D, 0xD1, 0xB4, 0xE4, 0xF0, 0xE5, 0x0D, 0x12, 0xAA, -+0x24, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x91, 0x25, 0x0D, 0x12, 0xAA, 0x1A, 0x51, 0xB1, 0xF1, 0x92, -+0x74, 0x3F, 0x51, 0xB2, 0xD1, 0xA1, 0x51, 0xB1, 0x12, 0x4F, 0x6D, 0x54, 0xE0, 0x44, 0x09, 0x51, -+0xB2, 0x12, 0x4D, 0xE3, 0x54, 0xF3, 0x51, 0xB2, 0x12, 0x4D, 0xE3, 0x54, 0xFC, 0x51, 0xB2, 0x12, -+0x4F, 0x6D, 0x44, 0x20, 0x51, 0xB2, 0x12, 0x4D, 0xE3, 0x54, 0xCF, 0x51, 0xB2, 0x12, 0x4D, 0xE3, -+0x44, 0x40, 0x51, 0xB2, 0x12, 0x4D, 0xE3, 0x54, 0x7F, 0x51, 0xB2, 0xD1, 0xA1, 0xE0, 0xFF, 0x75, -+0xF0, 0x10, 0xE5, 0x0D, 0x12, 0x6F, 0xBD, 0xEF, 0xF0, 0x74, 0x91, 0x25, 0x0D, 0xB1, 0x17, 0xE4, -+0xF0, 0x05, 0x0D, 0xE5, 0x0D, 0x64, 0x80, 0x60, 0x02, 0x21, 0xCD, 0x90, 0x04, 0x49, 0x74, 0xF0, -+0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0xA4, 0x76, 0x74, 0x02, 0xF0, 0xA3, 0x74, -+0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xE4, 0xFB, 0xFD, 0xFF, 0x12, -+0xAC, 0xD5, 0x74, 0x11, 0x25, 0x0D, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0xFF, 0xF0, -+0x22, 0xE4, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0D, 0x22, 0xFF, 0x90, 0xA5, 0x6B, 0xE0, 0x75, 0xF0, -+0x08, 0x90, 0x89, 0x00, 0x12, 0x4A, 0x2A, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, -+0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x6B, 0xEF, 0xF0, 0x75, 0xF0, -+0x04, 0x12, 0x4F, 0x6D, 0x54, 0x1F, 0xF5, 0x73, 0x60, 0x15, 0x64, 0x02, 0x60, 0x11, 0xE5, 0x73, -+0x64, 0x04, 0x60, 0x0B, 0xE5, 0x73, 0x64, 0x09, 0x60, 0x05, 0xE5, 0x73, 0xB4, 0x0C, 0x07, 0xD1, -+0xAE, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xD1, 0xAE, 0x74, 0x01, 0xF0, 0xE4, 0xF5, 0x6E, 0x90, 0xA5, -+0x6B, 0xE0, 0xFE, 0xB1, 0x09, 0xE5, 0x82, 0x25, 0x6E, 0x51, 0xCA, 0xE0, 0xFF, 0xE5, 0x73, 0x75, -+0xF0, 0x07, 0xA4, 0x24, 0xFE, 0xF5, 0x82, 0xE4, 0x34, 0x40, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x6E, -+0x51, 0xCA, 0xE4, 0x93, 0xFD, 0xEF, 0x5D, 0x90, 0xA5, 0x6D, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x12, -+0x4D, 0xE3, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0B, 0xE5, 0x6E, 0x70, 0x07, 0x90, 0xA5, 0x6D, 0xE0, -+0x54, 0xF0, 0xF0, 0x90, 0xA5, 0x6D, 0xE0, 0xFF, 0xB1, 0x05, 0xE5, 0x82, 0x25, 0x6E, 0x51, 0xCA, -+0xEF, 0xF0, 0x05, 0x6E, 0xE5, 0x6E, 0x64, 0x07, 0x70, 0xA4, 0x90, 0xA5, 0x6B, 0xE0, 0x75, 0xF0, -+0x04, 0x12, 0x4D, 0xE3, 0xFF, 0xC4, 0x54, 0x03, 0xFD, 0xE4, 0xF5, 0x71, 0x75, 0x6F, 0x06, 0xE5, -+0x6F, 0xB4, 0x06, 0x07, 0x51, 0xB9, 0xE0, 0x54, 0x0F, 0x80, 0x09, 0xB1, 0x05, 0xE5, 0x82, 0x25, -+0x6F, 0x51, 0xCA, 0xE0, 0x90, 0xA5, 0x6C, 0xF0, 0x90, 0xA5, 0x6C, 0xE0, 0x60, 0x33, 0x75, 0x6E, -+0x07, 0xF1, 0xEA, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0xB6, 0x13, 0x60, -+0x17, 0x12, 0xB6, 0x0A, 0xF5, 0x71, 0xED, 0x60, 0x25, 0xE5, 0x71, 0xD3, 0x94, 0x0B, 0x40, 0x1E, -+0x74, 0x20, 0x25, 0x71, 0xF5, 0x71, 0x80, 0x16, 0x15, 0x6E, 0xE5, 0x6E, 0xC3, 0x94, 0x00, 0x50, -+0xD0, 0xE5, 0x6F, 0x60, 0x09, 0x15, 0x6F, 0xE5, 0x6F, 0xC3, 0x94, 0x00, 0x50, 0xA1, 0xE4, 0xF5, -+0x72, 0xF5, 0x6F, 0xE5, 0x6F, 0xB4, 0x06, 0x07, 0x51, 0xB9, 0xE0, 0x54, 0x0F, 0x80, 0x09, 0xB1, -+0x05, 0xE5, 0x82, 0x25, 0x6F, 0x51, 0xCA, 0xE0, 0x90, 0xA5, 0x6C, 0xF0, 0x90, 0xA5, 0x6C, 0xE0, -+0x60, 0x31, 0xE4, 0xF5, 0x6E, 0xF1, 0xEA, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0x12, 0xB6, 0x13, 0x60, 0x17, 0x12, 0xB6, 0x0A, 0xF5, 0x72, 0xED, 0x60, 0x1E, 0xE5, 0x72, 0xD3, -+0x94, 0x0B, 0x40, 0x17, 0x74, 0x20, 0x25, 0x72, 0xF5, 0x72, 0x80, 0x0F, 0x05, 0x6E, 0xE5, 0x6E, -+0xB4, 0x08, 0xD2, 0x05, 0x6F, 0xE5, 0x6F, 0x64, 0x07, 0x70, 0xA8, 0x90, 0xA5, 0x6B, 0xE0, 0xFF, -+0x75, 0xF0, 0x04, 0xF1, 0x92, 0xE5, 0x71, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0xD1, 0xA1, 0xE5, 0x72, -+0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x12, 0x6F, 0xBD, 0xE0, 0xFF, 0x54, 0x7F, 0xF5, 0x70, 0xEF, 0x54, -+0x80, 0xFF, 0xE5, 0x70, 0xD3, 0x95, 0x71, 0x40, 0x04, 0xE5, 0x71, 0x80, 0x09, 0xE5, 0x70, 0xC3, -+0x95, 0x72, 0x50, 0x05, 0xE5, 0x72, 0x4F, 0xF5, 0x70, 0x90, 0xA5, 0x6B, 0xE0, 0xFF, 0x24, 0x22, -+0x12, 0xB4, 0xFF, 0xE5, 0x70, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4D, 0xE3, 0x12, 0x93, 0xB6, -+0x90, 0xA5, 0x6B, 0xE0, 0xFF, 0xE4, 0xFB, 0xAD, 0x70, 0x12, 0x90, 0xE4, 0x90, 0xA5, 0x6B, 0xE0, -+0xFF, 0x75, 0xF0, 0x10, 0x12, 0xA9, 0xB0, 0xE4, 0xF0, 0xE5, 0x71, 0xC3, 0x94, 0x36, 0x40, 0x07, -+0x91, 0xFA, 0x74, 0x05, 0xF0, 0x80, 0x3E, 0xE5, 0x71, 0xC3, 0x94, 0x2C, 0x40, 0x07, 0x91, 0xFA, -+0x74, 0x04, 0xF0, 0x80, 0x30, 0xE5, 0x71, 0xC3, 0x94, 0x14, 0x40, 0x07, 0x91, 0xFA, 0x74, 0x03, -+0xF0, 0x80, 0x22, 0xE5, 0x71, 0xC3, 0x94, 0x0C, 0x40, 0x07, 0x91, 0xFA, 0x74, 0x02, 0xF0, 0x80, -+0x14, 0xE5, 0x71, 0xC3, 0x94, 0x04, 0x74, 0x91, 0x40, 0x07, 0x91, 0xFC, 0x74, 0x01, 0xF0, 0x80, -+0x04, 0x91, 0xFC, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x91, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x95, 0xF5, 0x83, 0x22, 0x90, 0xA5, 0x6B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x02, -+0x4A, 0x2A, 0xF0, 0x74, 0x91, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x22, 0x12, -+0x4F, 0xD0, 0x12, 0x26, 0x1E, 0xF5, 0x0E, 0x24, 0x91, 0xB1, 0x17, 0xE0, 0x54, 0x98, 0xB1, 0x12, -+0xC0, 0x83, 0xC0, 0x82, 0xB1, 0xC0, 0x54, 0x01, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xB1, -+0x12, 0xC0, 0x83, 0xC0, 0x82, 0xB1, 0xC0, 0x54, 0x02, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, -+0xB1, 0x12, 0xC0, 0x83, 0xC0, 0x82, 0xB1, 0xC0, 0x54, 0x04, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, -+0x83, 0xB1, 0x12, 0xC0, 0x83, 0xC0, 0x82, 0xB1, 0xC0, 0x54, 0x40, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, -+0xD0, 0x83, 0xB1, 0x12, 0xC0, 0x83, 0xC0, 0x82, 0xB1, 0xC0, 0x54, 0x20, 0xFE, 0xEF, 0x4E, 0xD0, -+0x82, 0xD0, 0x83, 0xF0, 0xE5, 0x0E, 0x70, 0x08, 0xB1, 0xC8, 0x54, 0x04, 0x90, 0x04, 0xAB, 0xF0, -+0xE5, 0x0E, 0xC3, 0x94, 0x80, 0x50, 0x11, 0x12, 0x4F, 0x61, 0xFF, 0x74, 0x11, 0x25, 0x0E, 0xF5, -+0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEF, 0xF0, 0xB1, 0x13, 0xE0, 0x30, 0xE5, 0x11, 0x12, 0x4D, -+0xDE, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x12, 0x6D, 0x62, 0xFD, 0xAF, 0x0E, 0x12, 0xAB, 0xD6, 0x22, -+0xE0, 0xFF, 0x90, 0xA4, 0x82, 0x12, 0x4A, 0x36, 0x90, 0x00, 0x03, 0x02, 0x26, 0x37, 0x8F, 0x11, -+0x90, 0xA4, 0x82, 0x74, 0x0E, 0xF0, 0xED, 0x24, 0xFE, 0x60, 0x58, 0x04, 0x60, 0x02, 0xC1, 0x92, -+0x12, 0xB5, 0xD2, 0x74, 0x0C, 0xF0, 0x74, 0x11, 0x25, 0x11, 0x12, 0x6D, 0x66, 0x90, 0xA4, 0x85, -+0xD1, 0x9A, 0x12, 0x4D, 0xE3, 0xFD, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA4, 0x86, 0xF0, 0xED, 0x12, -+0x4F, 0x80, 0xA3, 0xD1, 0x9A, 0x12, 0x4D, 0xE3, 0xFF, 0xC4, 0x54, 0x03, 0x90, 0xA4, 0x88, 0xD1, -+0x9A, 0xF1, 0x92, 0xE0, 0x90, 0xA4, 0x89, 0xD1, 0x9A, 0xD1, 0xA1, 0xE0, 0x90, 0xA4, 0x8A, 0xD1, -+0x9A, 0x12, 0x4F, 0x6D, 0xFD, 0xC4, 0x13, 0x54, 0x01, 0x90, 0xA4, 0x8B, 0xF0, 0xED, 0x54, 0x1F, -+0xA3, 0x80, 0x59, 0x12, 0xB5, 0xD2, 0x74, 0x0D, 0xD1, 0x93, 0xB1, 0x0C, 0xE0, 0x90, 0xA4, 0x85, -+0xD1, 0x93, 0x90, 0x89, 0x01, 0x12, 0x4A, 0x2A, 0xE0, 0x90, 0xA4, 0x86, 0xD1, 0x93, 0x90, 0x89, -+0x02, 0x12, 0x4A, 0x2A, 0xE0, 0x90, 0xA4, 0x87, 0xD1, 0x93, 0x90, 0x89, 0x03, 0x12, 0x4A, 0x2A, -+0xE0, 0x90, 0xA4, 0x88, 0xD1, 0x93, 0x12, 0xB6, 0x79, 0x90, 0xA4, 0x89, 0xD1, 0x93, 0x90, 0x89, -+0x05, 0x12, 0x4A, 0x2A, 0xE0, 0x90, 0xA4, 0x8A, 0xD1, 0x93, 0x90, 0x89, 0x06, 0x12, 0x4A, 0x2A, -+0xE0, 0x90, 0xA4, 0x8B, 0xD1, 0x93, 0x12, 0xB6, 0x71, 0x90, 0xA4, 0x8C, 0xF0, 0xD1, 0xE0, 0x12, -+0x90, 0x89, 0x22, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x11, 0x22, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x11, -+0x22, 0x90, 0x96, 0x12, 0x02, 0x4A, 0x2A, 0x12, 0x34, 0x2C, 0x75, 0x40, 0xFF, 0x22, 0x90, 0xA5, -+0x6B, 0xE0, 0x24, 0xA2, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0x22, 0xAC, 0x07, 0x12, 0xA6, -+0x39, 0x75, 0xF0, 0x08, 0xED, 0x51, 0xC1, 0x12, 0xA6, 0x41, 0x12, 0xA2, 0x60, 0x80, 0x05, 0xC3, -+0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x97, 0xBD, 0x7F, 0xFF, 0x60, 0x02, 0xAF, 0x04, 0x22, -+0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x82, 0x22, 0xD1, 0xE0, 0x7F, 0xF5, 0x7E, 0x03, 0x12, 0x33, 0xC7, -+0xBF, 0x01, 0x06, 0x90, 0xA4, 0x82, 0xE0, 0xA3, 0xF0, 0xD1, 0xE0, 0x7F, 0xF6, 0x7E, 0x03, 0x12, -+0x33, 0xC7, 0xBF, 0x01, 0x08, 0x90, 0xA4, 0x82, 0xE0, 0x90, 0xA4, 0x84, 0xF0, 0xD1, 0xE0, 0x7F, -+0xF4, 0x7E, 0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, 0x08, 0x90, 0xA4, 0x82, 0xE0, 0x90, 0xA4, 0x85, -+0xF0, 0xD1, 0xE0, 0x7F, 0xF3, 0x7E, 0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, 0x08, 0x90, 0xA4, 0x82, -+0xE0, 0x90, 0xA4, 0x86, 0xF0, 0xD1, 0xE0, 0x7F, 0xF2, 0x7E, 0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, -+0x08, 0x90, 0xA4, 0x82, 0xE0, 0x90, 0xA4, 0x87, 0xF0, 0x90, 0xA4, 0x83, 0x12, 0x85, 0xAF, 0xA3, -+0xE0, 0x90, 0xA4, 0x8B, 0xF0, 0x90, 0xA4, 0x87, 0xE0, 0x90, 0xA4, 0x8C, 0xF0, 0x90, 0xA4, 0x8D, -+0x74, 0x12, 0xF0, 0x90, 0xA4, 0x9B, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x8F, 0x12, 0x5F, 0x8F, 0x90, -+0xA4, 0x8B, 0xE0, 0x90, 0xA4, 0x92, 0xF0, 0x90, 0xA4, 0x8C, 0xE0, 0x90, 0xA4, 0x93, 0xF0, 0x7B, -+0x01, 0x7A, 0xA4, 0x79, 0x8D, 0x12, 0x93, 0xEE, 0x7F, 0x04, 0x02, 0x90, 0x8D, 0xF0, 0x75, 0xF0, -+0x04, 0xEF, 0x90, 0x96, 0x11, 0x02, 0x4A, 0x2A, 0x90, 0x8D, 0x01, 0x12, 0x4A, 0x2A, 0x75, 0xF0, -+0x02, 0xEF, 0x12, 0x4A, 0x2A, 0xE4, 0xF0, 0xA3, 0x22, 0xE4, 0xFD, 0xFF, 0x12, 0x7F, 0xCE, 0xFE, -+0xEF, 0x54, 0x07, 0xFF, 0xED, 0x70, 0x14, 0x12, 0x7F, 0x7B, 0xC0, 0x83, 0xC0, 0x82, 0x12, 0xB6, -+0x81, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0x80, 0x11, 0x12, 0x7F, 0x7B, 0xC0, 0x83, -+0xC0, 0x82, 0x12, 0xB6, 0x81, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0xD0, 0x82, 0xD0, 0x83, -+0xF0, 0x12, 0xA2, 0x03, 0x90, 0xA2, 0xE4, 0xEF, 0xF0, 0x22, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x6E, -+0x08, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, 0x85, 0x22, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, -+0x7F, 0x80, 0x12, 0x3A, 0x96, 0x12, 0xA7, 0x06, 0x12, 0x3A, 0xB8, 0x12, 0xA7, 0x13, 0x12, 0xA7, -+0x62, 0x7F, 0x01, 0x12, 0x46, 0xF5, 0x90, 0xA3, 0xB5, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x46, 0xF5, -+0x90, 0xA3, 0xB5, 0xE0, 0x04, 0xF0, 0x12, 0x50, 0x0F, 0x12, 0x51, 0x33, 0x90, 0x01, 0xCC, 0x74, -+0x0F, 0xF0, 0x12, 0x4B, 0x38, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x3A, -+0x96, 0x75, 0x28, 0xFF, 0x12, 0x57, 0xF2, 0x11, 0x51, 0x12, 0xA7, 0x6C, 0xE4, 0xFF, 0x02, 0x47, -+0x7E, 0xE4, 0x90, 0xA4, 0x73, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, 0xE4, -+0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x3C, 0xC3, 0x90, 0xA4, 0x74, 0xE0, 0x94, 0x88, 0x90, -+0xA4, 0x73, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, -+0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1E, 0x90, 0xA4, 0x73, 0x11, 0xAB, 0x12, 0x78, 0x6E, 0xD3, 0x90, -+0xA4, 0x74, 0xE0, 0x94, 0x32, 0x90, 0xA4, 0x73, 0xE0, 0x94, 0x00, 0x40, 0xBB, 0x90, 0x01, 0xC6, -+0xE0, 0x30, 0xE3, 0xB4, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0xE4, 0x75, 0xF0, 0x01, 0x02, -+0x49, 0x7F, 0xE4, 0x90, 0xA5, 0x71, 0xF1, 0xF1, 0x90, 0xA5, 0x73, 0xF0, 0x90, 0x04, 0x2D, 0xE0, -+0x54, 0x01, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x36, 0xC3, 0x90, 0xA5, 0x72, 0xE0, 0x94, 0xD0, -+0x90, 0xA5, 0x71, 0xE0, 0x94, 0x07, 0x50, 0x27, 0x90, 0xA3, 0xE4, 0xE0, 0xB4, 0xFF, 0x0C, 0x7D, -+0x18, 0x7F, 0xFF, 0x31, 0x62, 0xE4, 0x90, 0xA3, 0xEB, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, -+0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA5, 0x71, 0x11, 0xAB, 0x80, 0xC4, 0x90, -+0xA3, 0xE4, 0xE0, 0xFF, 0x90, 0xA5, 0x42, 0x74, 0x05, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0x91, 0xC2, -+0xAB, 0x07, 0xAA, 0x06, 0x74, 0x28, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xB4, -+0x54, 0x03, 0x12, 0xB1, 0x67, 0x74, 0x14, 0x2B, 0x12, 0xB3, 0x7F, 0xE0, 0xC4, 0x13, 0x54, 0x03, -+0xFF, 0x90, 0xA3, 0xE8, 0xE0, 0x54, 0xFC, 0x4F, 0xF0, 0x90, 0xA5, 0x73, 0xE0, 0x54, 0x6F, 0xFF, -+0x7D, 0x19, 0xD1, 0x5A, 0x90, 0xA3, 0xE9, 0x11, 0xAB, 0x90, 0xA3, 0xEB, 0x74, 0x01, 0xF0, 0x22, -+0x90, 0xA3, 0xC6, 0x12, 0x4A, 0x2A, 0xE0, 0xFF, 0x7E, 0x00, 0xE4, 0xFB, 0xFD, 0x31, 0x7B, 0xE4, -+0xFD, 0xFF, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0xA1, 0x27, 0xED, 0xF0, 0x22, 0x90, 0xA3, 0xC6, -+0x12, 0x4A, 0x2A, 0xE0, 0xFF, 0x7E, 0x00, 0xE4, 0xFB, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0xA5, 0x15, 0xEE, 0xF0, 0xA3, 0xF1, 0x8F, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x24, -+0x90, 0x05, 0x22, 0xE0, 0x90, 0xA5, 0x1B, 0xF0, 0x7D, 0x14, 0x51, 0xB1, 0xEF, 0x64, 0x01, 0x70, -+0x04, 0x91, 0x50, 0x80, 0x04, 0x7F, 0x00, 0x80, 0x11, 0x90, 0xA5, 0x1B, 0xE0, 0xFF, 0x7D, 0x15, -+0x31, 0x62, 0x80, 0x02, 0x91, 0x50, 0xD1, 0x5C, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x8F, -+0x11, 0x7D, 0x17, 0x51, 0xB1, 0x75, 0xF0, 0x0E, 0xE5, 0x11, 0x12, 0xB5, 0x50, 0xE0, 0xFC, 0x71, -+0xA8, 0xFE, 0x54, 0x03, 0xFD, 0xEE, 0x13, 0x13, 0x54, 0x07, 0xFB, 0x90, 0xA3, 0xB7, 0xE0, 0xFE, -+0x12, 0xB6, 0x69, 0xAF, 0x04, 0x12, 0x80, 0x93, 0x71, 0xA8, 0xFE, 0x54, 0x03, 0xFF, 0xEE, 0xC4, -+0x13, 0x54, 0x07, 0xFD, 0x71, 0xA8, 0x12, 0x83, 0xE7, 0x75, 0xF0, 0x0E, 0xE5, 0x11, 0x31, 0x50, -+0xAD, 0x11, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x47, 0xEF, 0xF0, -+0xA3, 0xED, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0xA5, 0x49, 0xE0, 0xFF, 0xC3, 0x94, 0x03, 0x40, 0x02, -+0x41, 0xAC, 0x90, 0xA5, 0x48, 0xE0, 0xFE, 0x12, 0x7F, 0x72, 0x75, 0xF0, 0x03, 0xEF, 0x12, 0xB5, -+0x6E, 0xE0, 0x90, 0xA5, 0x4A, 0xF0, 0x90, 0xA5, 0x47, 0xE0, 0xFC, 0xB4, 0x02, 0x24, 0x90, 0xA5, -+0x4A, 0xE0, 0xFD, 0x75, 0xF0, 0x0E, 0xEE, 0x12, 0x7E, 0x93, 0xC0, 0x83, 0xC0, 0x82, 0x90, 0xA5, -+0x49, 0xE0, 0xD0, 0x82, 0xD0, 0x83, 0x12, 0x93, 0xE0, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4D, -+0x80, 0x24, 0xEC, 0xB4, 0x01, 0x24, 0x12, 0xB5, 0xC8, 0x75, 0xF0, 0x0E, 0x12, 0x7E, 0x93, 0xC0, -+0x83, 0xC0, 0x82, 0x90, 0xA5, 0x49, 0xE0, 0xD0, 0x82, 0xD0, 0x83, 0x12, 0x93, 0xE0, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0xA5, 0x4A, 0xF0, 0x12, 0xB5, 0xC8, 0x12, 0x7F, 0x72, -+0xC0, 0x83, 0xC0, 0x82, 0x90, 0xA5, 0x49, 0xE0, 0xD0, 0x82, 0xD0, 0x83, 0x75, 0xF0, 0x03, 0x12, -+0xB5, 0x6E, 0xEF, 0xF0, 0x90, 0xA5, 0x49, 0xE0, 0x04, 0xF0, 0x41, 0x16, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x7F, 0xFF, 0x31, 0x62, 0xE4, 0x90, 0xA5, 0x68, 0xF1, 0xF1, 0x90, 0xA5, 0x6A, 0xF0, 0x7D, -+0x47, 0x7F, 0xFF, 0x31, 0x62, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x11, 0xA3, 0xE0, 0x70, 0x0D, 0xA3, -+0xE0, 0x70, 0x09, 0xA3, 0xE0, 0x70, 0x05, 0xF1, 0x98, 0x7F, 0x01, 0x22, 0xF1, 0xC8, 0x30, 0xE0, -+0x15, 0xD3, 0x90, 0xA5, 0x69, 0xE0, 0x94, 0x03, 0x90, 0xA5, 0x68, 0xE0, 0x94, 0x00, 0x40, 0x02, -+0x80, 0x13, 0x7F, 0x01, 0x80, 0x1D, 0xD3, 0x90, 0xA5, 0x69, 0xE0, 0x94, 0xE8, 0x90, 0xA5, 0x68, -+0xE0, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0xF1, 0x98, 0x7F, 0x00, -+0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA5, 0x68, 0x11, 0xAB, 0x80, 0xA6, 0x90, -+0xA3, 0xB7, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, 0xEF, 0x54, 0xF1, 0xFF, 0xEE, 0x04, 0x54, 0x07, 0x25, -+0xE0, 0x4F, 0xF0, 0xA3, 0xE0, 0xFF, 0x12, 0xB5, 0xBE, 0xB5, 0x07, 0x04, 0xEE, 0x54, 0xF1, 0xF0, -+0x12, 0x6F, 0xF1, 0xE4, 0x90, 0xA3, 0xB9, 0xF0, 0x51, 0xB5, 0x12, 0xB5, 0xBE, 0x12, 0xB5, 0x4C, -+0xE0, 0xFA, 0x75, 0xF0, 0x0E, 0xED, 0x71, 0xAD, 0xFC, 0x54, 0x03, 0xFD, 0xEC, 0x13, 0x13, 0x54, -+0x07, 0xFB, 0xEE, 0x12, 0xB6, 0x69, 0xAF, 0x02, 0x12, 0x80, 0x93, 0xF1, 0x88, 0x54, 0x07, 0xFE, -+0x75, 0xF0, 0x0E, 0x71, 0xAD, 0xFD, 0x54, 0x03, 0xFF, 0xED, 0xC4, 0x13, 0x54, 0x07, 0xFD, 0x75, -+0xF0, 0x0E, 0xEE, 0x71, 0xAD, 0x12, 0x83, 0xE7, 0xF1, 0x88, 0x54, 0x07, 0xFF, 0x75, 0xF0, 0x0E, -+0x90, 0xA3, 0xC5, 0x12, 0x4A, 0x2A, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x0E, 0xEF, 0x31, 0x50, 0xF1, -+0x88, 0x54, 0x07, 0xFD, 0x7F, 0x01, 0x41, 0x04, 0x75, 0xF0, 0x0E, 0xE5, 0x11, 0x90, 0xA3, 0xBB, -+0x12, 0x4A, 0x2A, 0xE0, 0x22, 0x7D, 0x08, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA5, 0x2E, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA1, 0x25, 0xE0, 0x04, 0xF0, 0x90, 0xA3, -+0x53, 0xE0, 0x30, 0xE0, 0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, -+0x60, 0x41, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA5, 0x32, 0xF0, 0x7D, 0x26, 0x51, 0xB1, 0xEF, 0x64, -+0x01, 0x70, 0x0E, 0xD1, 0x96, 0x20, 0xE0, 0x1D, 0x90, 0xA3, 0xB6, 0xE0, 0x20, 0xE0, 0x16, 0x80, -+0x11, 0xF1, 0xC8, 0x30, 0xE0, 0x0F, 0xD1, 0x96, 0x20, 0xE0, 0x0A, 0x90, 0xA3, 0xB6, 0xE0, 0x20, -+0xE0, 0x03, 0x12, 0xB3, 0x18, 0x90, 0xA5, 0x32, 0xE0, 0xFF, 0x7D, 0x27, 0x31, 0x62, 0x12, 0xB3, -+0xF2, 0x80, 0x12, 0x12, 0xB3, 0xF2, 0xD1, 0x96, 0x20, 0xE0, 0x0A, 0x90, 0xA3, 0xB6, 0xE0, 0x20, -+0xE0, 0x03, 0x12, 0xB3, 0x18, 0x90, 0xA3, 0x53, 0xE0, 0x30, 0xE0, 0x0B, 0xF1, 0xC8, 0x30, 0xE0, -+0x06, 0xF1, 0xE9, 0x7D, 0x28, 0x31, 0x62, 0xD1, 0x5C, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0xA5, 0x15, 0xA3, 0xE0, 0xFF, 0x90, 0xA5, 0x42, 0x74, 0x03, 0xF0, 0x7B, 0x06, 0x7D, 0x01, -+0x91, 0xC2, 0x90, 0xA5, 0x19, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA5, 0x18, 0xE0, -+0xFF, 0x74, 0x10, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0xA5, 0x17, -+0xE0, 0xFF, 0x12, 0xB4, 0xEF, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x2C, 0xF1, 0xDD, 0x44, 0x10, 0x12, -+0xB4, 0xEE, 0x44, 0x80, 0xF0, 0x12, 0x9C, 0xD4, 0x30, 0xE0, 0x26, 0x12, 0x9E, 0x17, 0x50, 0x0E, -+0xEF, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x74, 0x2B, 0x2D, 0xF1, 0xD5, 0xEF, 0xF0, 0x22, 0x74, 0x2B, -+0x2D, 0xF1, 0xD5, 0x74, 0x7F, 0xF0, 0x22, 0xF1, 0xDD, 0x54, 0xEF, 0x12, 0xB4, 0xEE, 0x44, 0x40, -+0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x40, 0xED, 0xF0, 0xA3, 0xEB, -+0xF0, 0x90, 0xA5, 0x3F, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xB4, 0x60, 0x7C, 0x00, 0xAD, 0x07, -+0x90, 0xA5, 0x3F, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0xA5, 0x40, 0xE0, 0x60, 0x06, 0x12, 0xB5, -+0x86, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x54, 0xC0, 0xF0, 0x12, 0xB5, 0x86, 0x54, 0xC0, 0xF0, 0x90, 0xA5, 0x42, 0xE0, 0xFF, 0xAE, -+0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x12, 0x2E, -+0xF1, 0x1E, 0xE0, 0x54, 0x01, 0xFF, 0x90, 0xA5, 0x41, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, -+0x44, 0x02, 0x4E, 0xFF, 0xAE, 0x05, 0x74, 0x12, 0x2E, 0xF1, 0x1E, 0xEF, 0xF0, 0x74, 0x11, 0x2E, -+0x12, 0xB3, 0xE0, 0x74, 0xFF, 0xF0, 0x74, 0x29, 0x2E, 0xF1, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0xA3, -+0x53, 0xE0, 0x30, 0xE0, 0x0D, 0x12, 0xB5, 0x7A, 0x44, 0x80, 0xF0, 0x90, 0x05, 0x12, 0xE4, 0xF0, -+0x80, 0x06, 0x12, 0xB5, 0x7A, 0x54, 0x7F, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x5B, 0xEF, 0xF0, 0x90, 0x04, 0x1D, -+0xE0, 0x60, 0x1E, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA5, 0x5E, 0xF0, 0x7D, 0x29, 0x51, 0xB1, 0xBF, -+0x01, 0x04, 0xF1, 0xA1, 0x91, 0x82, 0x90, 0xA5, 0x5E, 0xE0, 0xFF, 0x7D, 0x2A, 0x31, 0x62, 0x80, -+0x04, 0xF1, 0xA1, 0x91, 0x82, 0xD1, 0x5C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xAF, 0xEF, 0xF0, 0xA3, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x04, -+0x1D, 0xE0, 0x60, 0x1D, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA4, 0xB4, 0xF0, 0x7D, 0x36, 0x51, 0xB1, -+0xBF, 0x01, 0x03, 0x12, 0xB3, 0x93, 0x90, 0xA4, 0xB4, 0xE0, 0xFF, 0x7D, 0x37, 0x31, 0x62, 0x80, -+0x03, 0x12, 0xB3, 0x93, 0xF1, 0xE9, 0x7D, 0x38, 0xD1, 0x5A, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0xA4, 0xAC, 0xF1, 0x8F, 0x90, 0xA3, 0xA2, 0x12, 0x67, 0x81, 0x20, 0xE0, 0x0D, 0x90, 0xA4, 0xAD, -+0xE0, 0xB4, 0x01, 0x06, 0x7D, 0x36, 0x7F, 0x6F, 0x31, 0x62, 0x90, 0xA4, 0xAC, 0xE0, 0x70, 0x0B, -+0x90, 0xA4, 0xAE, 0xE0, 0xFF, 0x7D, 0x05, 0x71, 0xB9, 0x80, 0x2B, 0x90, 0xA4, 0xAC, 0xE0, 0xB4, -+0x01, 0x09, 0x90, 0xA4, 0xAE, 0xE0, 0xFF, 0xB1, 0x71, 0x80, 0x1B, 0x90, 0xA4, 0xAC, 0xE0, 0xB4, -+0x02, 0x14, 0xA3, 0xE0, 0xB4, 0x01, 0x0F, 0x90, 0xA1, 0xE5, 0xE0, 0xFF, 0x90, 0xA3, 0xB0, 0xE0, -+0xFC, 0xA3, 0xE0, 0xFD, 0xB1, 0xAC, 0x90, 0xA3, 0xA2, 0x12, 0x67, 0x81, 0x20, 0xE0, 0x0A, 0x90, -+0xA4, 0xAD, 0xE0, 0x70, 0x04, 0xFD, 0xFF, 0x31, 0x62, 0x22, 0x31, 0x62, 0x90, 0x04, 0x1F, 0x74, -+0x20, 0xF0, 0x22, 0x90, 0xA4, 0xAD, 0xF1, 0x8F, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x21, 0x90, 0x05, -+0x22, 0xE0, 0x90, 0xA4, 0xB2, 0xF0, 0x7D, 0x01, 0x51, 0xB1, 0xEF, 0x64, 0x01, 0x70, 0x05, 0x12, -+0xB4, 0x7E, 0xD1, 0xC0, 0x90, 0xA4, 0xB2, 0xE0, 0xFF, 0x7D, 0x02, 0x31, 0x62, 0x80, 0x05, 0x12, -+0xB4, 0x7E, 0xD1, 0xC0, 0x80, 0xC6, 0x90, 0xA1, 0xE2, 0xE0, 0xFF, 0x90, 0xA5, 0x2F, 0xE0, 0xFB, -+0x90, 0xA5, 0x42, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x91, 0xC2, 0x90, 0xA5, 0x30, 0xEE, 0xF0, 0xFC, -+0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA5, 0x2E, 0xE0, 0xFF, 0x91, 0x82, 0x90, 0xA3, 0xB7, 0xE0, 0x22, -+0x90, 0xA4, 0xB4, 0xEC, 0xF1, 0x90, 0x90, 0xA4, 0xB4, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x91, 0x82, -+0x90, 0xA4, 0xB4, 0xA3, 0xE0, 0xFF, 0xFD, 0x24, 0x0D, 0x12, 0xB3, 0x8A, 0x44, 0x80, 0xF0, 0x74, -+0x0D, 0x2D, 0x12, 0xB3, 0x8A, 0x54, 0xEF, 0xF1, 0x1A, 0xE0, 0x44, 0x02, 0xF1, 0x1A, 0xE0, 0x54, -+0x03, 0xF0, 0x90, 0xA4, 0xB6, 0xE0, 0xFF, 0x90, 0xA4, 0xB4, 0xA3, 0xE0, 0xFE, 0x24, 0x2A, 0x12, -+0xB3, 0xE8, 0x90, 0xA4, 0xB7, 0xE0, 0xFF, 0xF1, 0xD2, 0xEF, 0xF0, 0x74, 0x2C, 0x2E, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x24, 0x02, 0xF0, 0x22, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0xA3, 0xB6, 0xE0, 0x30, 0xE0, 0x5A, 0x90, 0xA3, 0xB9, -+0xE0, 0x70, 0x27, 0x7D, 0x16, 0xF1, 0xC2, 0xF1, 0x88, 0x54, 0x07, 0x75, 0xF0, 0x0E, 0x31, 0x6D, -+0xF1, 0x88, 0x54, 0x07, 0x12, 0x9A, 0x81, 0xE0, 0x44, 0x01, 0x12, 0xB1, 0xC0, 0xA3, 0x74, 0x03, -+0x12, 0x70, 0x18, 0x90, 0xA3, 0xB9, 0x74, 0x01, 0xF0, 0x22, 0x90, 0xA3, 0xB9, 0xE0, 0x64, 0x01, -+0x70, 0x23, 0x90, 0xA3, 0xB7, 0x12, 0x9A, 0x7B, 0xE0, 0x30, 0xE0, 0x19, 0x75, 0xF0, 0x0E, 0xEF, -+0x31, 0x6D, 0xE4, 0x90, 0xA5, 0x20, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, -+0x7E, 0x01, 0x02, 0x70, 0x20, 0x71, 0x1F, 0x22, 0x90, 0xA3, 0xB7, 0xE0, 0xC3, 0x13, 0x22, 0xEF, -+0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x22, 0x90, 0xA5, 0x6A, 0xE0, 0xFF, 0x7D, 0x48, 0x21, -+0x62, 0x90, 0xA1, 0xE3, 0xE0, 0xFF, 0x90, 0xA5, 0x42, 0x74, 0x0B, 0xF0, 0x7B, 0x08, 0x7D, 0x01, -+0x91, 0xC2, 0x90, 0xA5, 0x5C, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA5, 0x5B, 0xE0, -+0xFF, 0x22, 0x7F, 0x6F, 0x31, 0x62, 0x41, 0xB5, 0x90, 0xA3, 0x57, 0xE0, 0xC4, 0x13, 0x13, 0x54, -+0x03, 0x22, 0x74, 0x2B, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x29, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x6F, 0xFF, -+0x22, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x22, 0xE4, 0x90, 0xA4, 0x7C, 0xF0, 0x90, 0xA4, -+0x7C, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0xF9, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x5F, 0xA3, 0xF0, 0x12, -+0x3A, 0xEB, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x69, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x0E, 0x90, 0xA2, -+0xF2, 0xE0, 0xFF, 0x90, 0xA2, 0xF1, 0xE0, 0x6F, 0x60, 0x02, 0x11, 0x40, 0xC2, 0xAF, 0x12, 0xA7, -+0x43, 0xBF, 0x01, 0x03, 0x12, 0xB2, 0xFC, 0xD2, 0xAF, 0xF1, 0xF0, 0x12, 0x46, 0x2D, 0x80, 0xBE, -+0x90, 0xA2, 0xF1, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x04, 0x7D, 0x01, 0x7F, 0x04, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x88, 0xED, 0xF0, 0x90, 0xA2, 0xEA, 0xE0, 0xFE, 0xC4, 0x13, -+0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x21, 0x8F, 0xEE, 0x12, 0x4F, 0x80, 0x30, 0xE0, 0x02, 0x21, -+0x8F, 0x90, 0xA2, 0xF2, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x21, 0x8F, 0xEF, 0x70, 0x02, 0x21, 0x0A, -+0x24, 0xFE, 0x70, 0x02, 0x21, 0x44, 0x24, 0xFE, 0x60, 0x48, 0x24, 0xFC, 0x70, 0x02, 0x21, 0x7F, -+0x24, 0xFC, 0x60, 0x02, 0x21, 0x8F, 0xEE, 0xB4, 0x0E, 0x02, 0x31, 0xCE, 0x90, 0xA2, 0xF2, 0xE0, -+0x70, 0x04, 0x7F, 0x01, 0x51, 0x0C, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x06, 0x02, 0x31, 0xEA, 0x90, -+0xA2, 0xF2, 0xE0, 0xB4, 0x04, 0x0E, 0x90, 0xA5, 0x88, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0xB2, 0x9B, -+0x80, 0x02, 0xF1, 0x88, 0x90, 0xA2, 0xF2, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x21, 0x8F, 0xF1, 0x9E, -+0x21, 0x8F, 0x90, 0xA2, 0xF2, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x51, 0x0C, 0x90, 0xA2, 0xF2, 0xE0, -+0xB4, 0x06, 0x02, 0x31, 0xEA, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x0E, 0x07, 0x31, 0x94, 0xBF, 0x01, -+0x02, 0x31, 0xCE, 0x90, 0xA2, 0xF2, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x21, 0x8F, 0x31, 0x94, 0xEF, -+0x64, 0x01, 0x60, 0x02, 0x21, 0x8F, 0x51, 0x21, 0x21, 0x8F, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x0E, -+0x07, 0x31, 0x94, 0xBF, 0x01, 0x02, 0x31, 0xCE, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x06, 0x02, 0x31, -+0xEA, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x0C, 0x07, 0x31, 0x94, 0xBF, 0x01, 0x02, 0x51, 0x21, 0x90, -+0xA2, 0xF2, 0xE0, 0x64, 0x04, 0x70, 0x58, 0x12, 0xB1, 0xE0, 0xEF, 0x64, 0x01, 0x70, 0x50, 0x12, -+0xB2, 0xD3, 0x80, 0x4B, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x0E, 0x07, 0x31, 0x94, 0xBF, 0x01, 0x02, -+0x31, 0xCE, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x06, 0x02, 0x31, 0xEA, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, -+0x0C, 0x07, 0x31, 0x94, 0xBF, 0x01, 0x02, 0x51, 0x21, 0x90, 0xA2, 0xF2, 0xE0, 0x70, 0x04, 0x7F, -+0x01, 0x51, 0x0C, 0x90, 0xA2, 0xF2, 0xE0, 0xB4, 0x04, 0x15, 0x12, 0xB2, 0xEE, 0x80, 0x10, 0x90, -+0xA2, 0xF2, 0xE0, 0xB4, 0x0C, 0x09, 0x12, 0x8E, 0x18, 0x30, 0xE0, 0x03, 0x12, 0xB3, 0x07, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x53, 0xE0, 0x30, -+0xE0, 0x0D, 0x90, 0xA3, 0x59, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x80, 0x18, 0x12, -+0xB1, 0xC7, 0xBF, 0x01, 0x12, 0xF1, 0x7E, 0x20, 0xE0, 0x0D, 0x90, 0xA2, 0xF1, 0xE0, 0xD3, 0x94, -+0x04, 0x50, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, -+0xEB, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x04, 0x7D, 0x0C, 0x80, 0x05, 0x12, 0xB4, 0x54, 0x7D, 0x04, -+0x7F, 0x01, 0x51, 0x4F, 0xE4, 0xFD, 0xFF, 0x02, 0x59, 0x62, 0x90, 0xA2, 0xEB, 0xE0, 0x90, 0x06, -+0x04, 0x20, 0xE0, 0x08, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x04, 0x80, 0x06, 0xE0, 0x54, 0x7F, 0xF0, -+0x7D, 0x0C, 0x7F, 0x01, 0x51, 0x4F, 0xE4, 0xFD, 0xFF, 0x02, 0x59, 0x62, 0x90, 0xA5, 0x87, 0xEF, -+0xF0, 0x71, 0x3C, 0x90, 0xA5, 0x87, 0xE0, 0x60, 0x02, 0xF1, 0x98, 0x7D, 0x04, 0x7F, 0x01, 0x80, -+0x2E, 0x12, 0x8E, 0x0F, 0x70, 0x24, 0x90, 0xA2, 0xEB, 0xE0, 0x54, 0xFD, 0xF0, 0x7D, 0x2C, 0x7F, -+0x6F, 0x12, 0x59, 0x62, 0x12, 0x9D, 0xFD, 0x12, 0x5B, 0xB5, 0xBF, 0x01, 0x0D, 0x90, 0xA2, 0xEA, -+0xE0, 0x44, 0x80, 0xF0, 0x7D, 0x0E, 0x7F, 0x01, 0x51, 0x4F, 0x22, 0x7D, 0x0C, 0x7F, 0x01, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0xEF, 0x14, 0x60, 0x15, 0x14, 0x60, 0x19, 0x24, -+0x02, 0x70, 0x1A, 0xED, 0x54, 0x01, 0xFE, 0x90, 0xA2, 0xEA, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0x80, -+0x0C, 0x90, 0xA2, 0xF2, 0xED, 0xF0, 0x80, 0x05, 0x90, 0xA2, 0xF1, 0xED, 0xF0, 0x90, 0x00, 0x8F, -+0xE0, 0x30, 0xE4, 0x29, 0xEC, 0x14, 0x60, 0x07, 0x14, 0x60, 0x18, 0x24, 0x02, 0x70, 0x1E, 0x90, -+0xA2, 0xEA, 0xE0, 0x12, 0xB5, 0xEF, 0xFF, 0x90, 0xA2, 0xF2, 0xE0, 0x54, 0x7F, 0x4F, 0xFD, 0x7F, -+0x88, 0x80, 0x07, 0x90, 0xA2, 0xF1, 0xE0, 0xFD, 0x7F, 0x89, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0xEA, 0x12, 0x4A, -+0x6E, 0x90, 0xA2, 0xEE, 0x74, 0x02, 0xF0, 0x90, 0xA2, 0xF5, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, -+0x0A, 0xF0, 0x90, 0xA2, 0xFB, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x12, 0xB5, 0x25, 0xE4, 0xFD, -+0xFF, 0x51, 0x4F, 0x7D, 0x0C, 0x7F, 0x02, 0x51, 0x4F, 0x51, 0x4B, 0x90, 0xA1, 0x29, 0xE0, 0xFF, -+0xB4, 0x01, 0x08, 0x90, 0xA2, 0xFA, 0x74, 0xFF, 0xF0, 0x80, 0x0F, 0xEF, 0x90, 0xA2, 0xFA, 0xB4, -+0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x40, 0xF0, 0x12, 0x4F, 0xED, 0x12, 0xB5, 0x25, -+0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, 0xA2, 0xFD, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, -+0x7E, 0x00, 0x7F, 0x02, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x50, 0x12, 0x4A, 0x6E, 0xF1, -+0xDE, 0x12, 0xB6, 0x2E, 0xF1, 0x98, 0xE4, 0x90, 0xA3, 0x52, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0xFD, 0x91, 0x26, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, -+0xA2, 0xFD, 0x91, 0x26, 0x12, 0xB6, 0x4B, 0x90, 0x00, 0x10, 0xE0, 0x44, 0x0C, 0xFD, 0x7F, 0x10, -+0x12, 0x3A, 0x96, 0x90, 0x00, 0x72, 0xE0, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x3A, 0x96, 0x90, -+0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0xA3, 0x51, 0xF1, -+0x81, 0x30, 0xE0, 0x05, 0x7F, 0x03, 0x12, 0x76, 0x89, 0x90, 0xA3, 0x6E, 0xE0, 0x20, 0xE0, 0x32, -+0x12, 0xA0, 0x0C, 0x30, 0xE0, 0x2C, 0x90, 0xA3, 0x95, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0xA5, 0x0B, -+0xF0, 0x80, 0x06, 0x90, 0xA5, 0x0B, 0x74, 0x01, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x90, 0xA5, -+0x0C, 0x30, 0xE0, 0x05, 0x74, 0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0xA5, 0x0B, 0x12, -+0x72, 0xB0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x12, 0xB6, -+0x1C, 0x54, 0xBF, 0xF1, 0x6C, 0x91, 0x26, 0x12, 0xB6, 0x36, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x01, -+0x12, 0x77, 0xDB, 0x7F, 0x00, 0x7E, 0x0C, 0xF1, 0x66, 0x91, 0x26, 0x12, 0xB5, 0x56, 0xF1, 0x66, -+0x91, 0x26, 0x12, 0xB6, 0x3D, 0x90, 0x00, 0xFF, 0xE0, 0x70, 0x15, 0x12, 0xAA, 0xC3, 0x54, 0xE7, -+0x12, 0xAA, 0x36, 0x12, 0xAA, 0xC3, 0x54, 0x18, 0x70, 0x06, 0x90, 0x01, 0xBF, 0xE0, 0x04, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA5, 0x0F, -+0x12, 0x27, 0x48, 0x90, 0xA5, 0x0F, 0x12, 0x4A, 0x12, 0x90, 0xAC, 0xB9, 0x02, 0x27, 0x48, 0x74, -+0x08, 0xFF, 0xFE, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xDE, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x12, 0x36, 0xCE, 0x90, 0xA4, 0xE8, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xE0, 0x12, 0x4A, -+0x12, 0x12, 0x27, 0x15, 0x90, 0xA4, 0xE8, 0xF1, 0x78, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0x90, 0xA4, 0xE0, 0x12, 0x4A, 0x12, 0x90, 0xA4, 0xE4, 0xF1, 0x78, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0x12, 0x4A, 0x05, 0x90, 0xA4, 0xEC, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xEC, -+0x91, 0x26, 0x90, 0xA4, 0xDE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x37, 0x5D, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0xA5, 0x28, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0x7F, 0x34, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0x90, 0xA5, 0x2A, 0x12, 0x27, 0x48, 0x90, -+0xA5, 0x28, 0xE0, 0x14, 0x60, 0x5E, 0x14, 0x70, 0x02, 0xA1, 0xC8, 0x24, 0x02, 0x60, 0x02, 0xC1, -+0x4C, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA4, 0xE4, 0x12, 0x27, -+0x54, 0x00, 0x30, 0x02, 0x00, 0xD1, 0x61, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, 0x00, 0x90, 0xA4, -+0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xC4, 0xD1, 0x63, 0x12, 0x27, 0x54, 0x00, -+0x1C, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x10, 0x00, 0x00, 0x7F, 0x64, 0xD1, -+0x63, 0x12, 0x27, 0x54, 0x03, 0xC0, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x01, 0xC0, -+0x00, 0x00, 0xC1, 0x2F, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA4, -+0xE4, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x01, 0xD1, 0x61, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, -+0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xC4, 0xD1, 0x63, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, 0xD1, 0x4D, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x12, -+0xB4, 0xC1, 0xD1, 0x63, 0x12, 0x27, 0x54, 0x00, 0x1C, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, -+0x54, 0x00, 0x08, 0x00, 0x00, 0x12, 0xB4, 0xA8, 0x60, 0x13, 0x12, 0x27, 0x54, 0x03, 0xC0, 0x00, -+0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x01, 0x80, 0x00, 0x00, 0x80, 0x11, 0x12, 0x27, 0x54, -+0x03, 0xC0, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x01, 0xC0, 0x00, 0x00, 0x7F, 0x48, -+0x7E, 0x08, 0x91, 0x33, 0x90, 0xA5, 0x29, 0xE0, 0x90, 0xA4, 0xE0, 0xB4, 0x01, 0x13, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x80, -+0x11, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0x7F, 0x00, 0x7E, 0x0A, 0xC1, 0x4A, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, 0x00, 0x30, -+0x03, 0xC3, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x02, 0xD1, 0x61, 0x12, 0x27, -+0x54, 0x40, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, 0x00, 0x7F, -+0xC4, 0xD1, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, 0xD1, 0x4D, 0x12, 0x27, 0x54, 0xF0, -+0x00, 0x00, 0x00, 0x12, 0xB4, 0xC1, 0xD1, 0x63, 0x12, 0x27, 0x54, 0x00, 0x1C, 0x00, 0x00, 0x90, -+0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x08, 0x00, 0x00, 0x12, 0xB4, 0xA8, 0x60, 0x17, 0x12, 0x27, -+0x54, 0x03, 0xC0, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x01, 0x40, 0x00, 0x00, 0x7F, -+0x48, 0x7E, 0x08, 0x80, 0x15, 0x12, 0x27, 0x54, 0x03, 0xC0, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, -+0x27, 0x54, 0x01, 0x80, 0x00, 0x00, 0x7F, 0x48, 0x7E, 0x08, 0x91, 0x33, 0x22, 0x90, 0xA5, 0x29, -+0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x02, 0x12, 0x27, 0x35, 0x90, 0xA4, 0xE4, 0x12, 0x27, -+0x48, 0x7F, 0xAC, 0x7E, 0x08, 0x91, 0x33, 0x90, 0xA4, 0xE0, 0x22, 0x90, 0xA5, 0x6F, 0xED, 0xF0, -+0x90, 0xA5, 0x6E, 0xEF, 0xF0, 0x70, 0x73, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, -+0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0xD1, -+0x65, 0x12, 0x27, 0x54, 0x00, 0x03, 0xE0, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x02, -+0xE0, 0x00, 0x7F, 0x30, 0xD1, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0xA4, 0xE4, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x34, 0xD1, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x03, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0xB4, 0xD8, 0x12, -+0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, -+0x91, 0x2F, 0x90, 0x04, 0x54, 0xE0, 0x54, 0x7F, 0xE1, 0xE6, 0x90, 0xA5, 0x6E, 0xE0, 0x64, 0x01, -+0x70, 0x73, 0x90, 0x04, 0x54, 0xE0, 0x44, 0x80, 0xF1, 0xE6, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, -+0x30, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x74, 0x08, -+0xFF, 0xFE, 0xD1, 0x65, 0x12, 0x27, 0x54, 0x00, 0x03, 0xE0, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, -+0x54, 0x00, 0x02, 0xA0, 0x00, 0x7F, 0x30, 0xD1, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, -+0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x02, 0x7F, 0x34, 0xD1, 0x63, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x12, -+0xB4, 0xD8, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x20, -+0x00, 0x00, 0x00, 0x91, 0x2F, 0x22, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0xA5, -+0x07, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x07, 0x22, 0x12, 0x4A, 0x1E, 0x02, 0x49, 0xF8, 0x90, 0xA2, -+0xEA, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xF1, 0xDE, 0xF1, 0x98, 0x7D, 0x0C, 0x7F, 0x01, -+0x41, 0x4F, 0xE4, 0xFD, 0x7F, 0x0C, 0x11, 0x4D, 0xE4, 0xFD, 0xFF, 0x02, 0x59, 0x62, 0x71, 0x3C, -+0xF1, 0x98, 0x7D, 0x0C, 0x7F, 0x01, 0x41, 0x4F, 0x90, 0xA3, 0x53, 0xE0, 0x20, 0xE0, 0x1D, 0x90, -+0xA2, 0xEF, 0xE0, 0x64, 0x01, 0x70, 0x15, 0x12, 0x8E, 0xC8, 0x12, 0x99, 0x42, 0x60, 0x05, 0xF1, -+0x92, 0x02, 0xB1, 0x8A, 0x90, 0xA2, 0xF2, 0xE0, 0x70, 0x02, 0x11, 0x49, 0x22, 0x12, 0xB1, 0x8A, -+0x90, 0xA2, 0xF2, 0xE0, 0x64, 0x0C, 0x60, 0x05, 0xF1, 0x92, 0x12, 0xB2, 0xCC, 0x22, 0x90, 0x06, -+0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0xA5, 0x70, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x22, -+0x02, 0x4D, 0xEA, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x48, 0x2E, 0x90, 0xA4, 0x7D, 0xEF, -+0xF0, 0x60, 0xF0, 0x90, 0xA1, 0x23, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, -+0xEF, 0x30, 0xE0, 0x0E, 0x90, 0xA1, 0x23, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0xA8, 0x81, -+0x11, 0x3C, 0xF1, 0x62, 0x30, 0xE1, 0x06, 0x54, 0xFD, 0xF0, 0x12, 0xA1, 0x93, 0xF1, 0x62, 0x30, -+0xE2, 0x06, 0x54, 0xFB, 0xF0, 0x12, 0x7A, 0xB7, 0xD2, 0xAF, 0x80, 0xC7, 0xE4, 0xF5, 0x0E, 0x90, -+0xA2, 0xE4, 0xE0, 0xFF, 0xE5, 0x0E, 0xC3, 0x9F, 0x40, 0x02, 0xA1, 0x60, 0xE5, 0x0E, 0x13, 0x13, -+0x13, 0x54, 0x1F, 0x90, 0xA4, 0x8B, 0xF0, 0xE5, 0x0E, 0x54, 0x07, 0xA3, 0xF0, 0x90, 0x04, 0xA0, -+0xE0, 0xFF, 0xA3, 0xE0, 0xFE, 0xEF, 0x64, 0x01, 0x70, 0x24, 0xE5, 0x0E, 0x6E, 0x70, 0x1F, 0xA3, -+0xE0, 0xF5, 0x0F, 0xA3, 0xE0, 0xF1, 0xB4, 0xE5, 0x0F, 0xF0, 0xF1, 0x6C, 0xE0, 0x54, 0xFC, 0xFF, -+0x90, 0xA4, 0x87, 0xE0, 0x54, 0x03, 0x4F, 0xFF, 0xF1, 0x6C, 0xEF, 0xF0, 0xA1, 0x5C, 0xAF, 0x0E, -+0x12, 0x7E, 0xF3, 0xEF, 0x70, 0x02, 0xA1, 0x5C, 0x12, 0x4D, 0xDE, 0x12, 0x4F, 0x80, 0x30, 0xE0, -+0x02, 0xA1, 0x5C, 0x90, 0xA4, 0x8B, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0x12, 0xA2, -+0x56, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xF1, 0xCB, 0x60, 0x02, 0xA1, 0x5C, -+0x12, 0xAA, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x70, 0x08, 0x12, 0xAA, 0x16, 0xE0, 0x70, 0x02, -+0xA1, 0x5C, 0xE5, 0x0E, 0x12, 0xAD, 0xF8, 0x90, 0xA4, 0x81, 0x12, 0x4A, 0x3F, 0x12, 0xAA, 0x22, -+0xE0, 0xF5, 0x13, 0xA3, 0xE0, 0xF5, 0x14, 0x12, 0xAA, 0x16, 0xE0, 0xFF, 0x90, 0xA4, 0x84, 0xE4, -+0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x12, 0x57, 0x92, 0xE0, 0x90, 0xA4, 0x86, -+0xF0, 0xFD, 0x12, 0x4D, 0xDE, 0xFE, 0x13, 0x13, 0x54, 0x03, 0xF1, 0xB4, 0xE0, 0xF5, 0x0F, 0x54, -+0x7F, 0xF5, 0x10, 0xD3, 0x9D, 0x40, 0x16, 0x90, 0xA4, 0x86, 0xE0, 0xF5, 0x10, 0xE5, 0x0F, 0x30, -+0xE7, 0x07, 0xE5, 0x10, 0x44, 0x80, 0xFF, 0x80, 0x02, 0xAF, 0x10, 0x8F, 0x0F, 0xE5, 0x10, 0x90, -+0x41, 0xED, 0x93, 0xB1, 0x61, 0xC3, 0x9F, 0x40, 0x0B, 0x74, 0x38, 0x25, 0x10, 0xF5, 0x82, 0xE4, -+0x34, 0xA1, 0x80, 0x09, 0x74, 0x8C, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, -+0xFF, 0x12, 0xAE, 0x07, 0x90, 0xA4, 0x7E, 0x12, 0x4A, 0x3F, 0xB1, 0x6F, 0xE0, 0xC3, 0x94, 0x05, -+0x40, 0x02, 0x61, 0x37, 0xAD, 0x15, 0xAF, 0x10, 0x12, 0xAC, 0x86, 0x8F, 0x15, 0xE5, 0x0F, 0x30, -+0xE7, 0x04, 0x05, 0x15, 0x05, 0x15, 0xE5, 0x15, 0xD3, 0x94, 0x1A, 0xAF, 0x15, 0x40, 0x02, 0x7F, -+0x1A, 0x12, 0xAE, 0x07, 0x90, 0xA4, 0x7E, 0x12, 0x4A, 0x3F, 0xC3, 0xE5, 0x14, 0x94, 0x0F, 0xE5, -+0x13, 0x94, 0x00, 0x50, 0x73, 0xF1, 0x82, 0xFF, 0x90, 0xA4, 0x85, 0xE0, 0x2F, 0xFF, 0x90, 0xA4, -+0x84, 0xE0, 0x35, 0xF0, 0xFE, 0xF1, 0xDB, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x04, 0x12, -+0x49, 0xC0, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0x12, 0xB5, 0xB3, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, -+0x07, 0xE4, 0xFB, 0x12, 0xA2, 0x69, 0x61, 0x30, 0x90, 0xA4, 0x81, 0x12, 0x4A, 0x36, 0x12, 0x49, -+0x95, 0x65, 0x14, 0x70, 0x04, 0xE5, 0xF0, 0x65, 0x13, 0x75, 0xF0, 0x04, 0x70, 0x22, 0x12, 0x4F, -+0x6B, 0x12, 0x99, 0xEF, 0xFE, 0xEF, 0x54, 0x3F, 0xFF, 0xEE, 0x04, 0x54, 0x03, 0xFE, 0xC4, 0x33, -+0x33, 0x54, 0xC0, 0x4F, 0xF0, 0xE4, 0xFD, 0xAF, 0x0E, 0xB1, 0x89, 0x75, 0xF0, 0x04, 0x80, 0x00, -+0x12, 0x4F, 0x6B, 0x54, 0x3F, 0xF0, 0x61, 0x30, 0xE5, 0x0E, 0x70, 0x43, 0xF1, 0x82, 0xFF, 0xAE, -+0xF0, 0xF1, 0xDB, 0xFD, 0xE5, 0xF0, 0x3E, 0x12, 0xB5, 0xB3, 0xC3, 0xED, 0x9F, 0xEC, 0x9E, 0x50, -+0x08, 0x90, 0xA1, 0x22, 0x74, 0x01, 0xF0, 0x80, 0x26, 0xF1, 0x82, 0xFB, 0xAA, 0xF0, 0xE5, 0x14, -+0xAE, 0x13, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x7C, 0x00, 0x7D, 0x05, -+0x12, 0x26, 0x98, 0xD3, 0xEB, 0x9F, 0xEA, 0x9E, 0x40, 0x05, 0xE4, 0x90, 0xA1, 0x22, 0xF0, 0xF1, -+0x49, 0x12, 0x8E, 0x35, 0xFE, 0x60, 0x12, 0xF1, 0x49, 0xEF, 0x54, 0x07, 0xFF, 0xC3, 0xEE, 0x94, -+0x01, 0x54, 0x1F, 0x12, 0x97, 0xCD, 0xF0, 0x61, 0x30, 0x90, 0xA4, 0x8B, 0xE0, 0x24, 0x11, 0xF5, -+0x82, 0xE4, 0x34, 0x9D, 0x12, 0xA2, 0x56, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0xF1, 0xCB, 0x60, 0x27, 0x74, 0xA2, 0x25, 0x0E, 0xB1, 0x81, 0xE0, 0xFF, 0xF4, 0x60, 0x1C, 0x8F, -+0x0F, 0x90, 0xA4, 0x87, 0xE0, 0xF5, 0x77, 0x7B, 0x01, 0xAD, 0x0F, 0xAF, 0x0E, 0x12, 0x90, 0xE4, -+0x74, 0xA2, 0x25, 0x0E, 0xB1, 0x81, 0x74, 0xFF, 0xF0, 0x61, 0x30, 0xAB, 0x15, 0xAD, 0x0E, 0xAF, -+0x14, 0xAE, 0x13, 0x12, 0xAD, 0x29, 0x8E, 0x11, 0x8F, 0x12, 0xF1, 0xA6, 0xC3, 0x12, 0xB5, 0xDC, -+0x50, 0x5E, 0x12, 0xB5, 0x18, 0x54, 0x7F, 0xB1, 0x61, 0xFE, 0xC3, 0x9F, 0x40, 0x05, 0xEE, 0x9F, -+0xFF, 0x80, 0x0B, 0xB1, 0x62, 0xFF, 0x12, 0xB5, 0x18, 0x54, 0x7F, 0xC3, 0x9F, 0xFF, 0xEF, 0xD3, -+0x94, 0x04, 0x40, 0x0E, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x90, 0x9B, 0x12, 0x12, 0x57, 0xA2, 0xF0, -+0x80, 0x12, 0xF1, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x60, 0x09, 0xF1, 0x77, 0x74, 0xFF, 0xF5, -+0xF0, 0x12, 0x49, 0x7F, 0xF1, 0xA6, 0xF1, 0xD3, 0xE5, 0x0E, 0x12, 0x97, 0x45, 0xF1, 0xC3, 0xF1, -+0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x70, 0x18, 0x7D, 0x01, 0xAF, 0x0E, 0xB1, 0x89, 0x80, 0x10, -+0xE5, 0x10, 0x12, 0xA6, 0x49, 0xD3, 0x12, 0xB5, 0xDC, 0x40, 0x05, 0x7B, 0x01, 0x12, 0xA2, 0x69, -+0xE4, 0xF5, 0x11, 0xF5, 0x12, 0xA1, 0x39, 0xB1, 0x6F, 0xE0, 0xF9, 0x64, 0x05, 0x60, 0x02, 0x61, -+0xEB, 0xF1, 0x3E, 0xE0, 0x54, 0x07, 0xF5, 0x18, 0xB1, 0x62, 0xC3, 0x94, 0x30, 0x40, 0x12, 0x12, -+0x55, 0x13, 0xE0, 0x20, 0xE2, 0x0B, 0x12, 0x4D, 0xDE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, -+0x0F, 0xE4, 0xF5, 0x18, 0xB1, 0x6F, 0xF1, 0x54, 0xE4, 0xF0, 0xF1, 0x9A, 0xE4, 0xF0, 0x80, 0x0B, -+0xAD, 0x10, 0xAF, 0x0E, 0x12, 0xAB, 0x5F, 0xF1, 0x9A, 0xEF, 0xF0, 0xF1, 0x9A, 0xE0, 0x64, 0x01, -+0x70, 0x61, 0xF1, 0x8E, 0xE0, 0xFF, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xB1, 0x62, 0xFE, 0xC3, -+0x12, 0x90, 0x4F, 0x50, 0x0B, 0x12, 0xB4, 0xFB, 0xE0, 0xFD, 0xE5, 0x10, 0xC3, 0x9D, 0x40, 0x1B, -+0xE5, 0x18, 0x70, 0x05, 0x75, 0x18, 0x01, 0x80, 0x0D, 0xE5, 0x18, 0xB4, 0x01, 0x05, 0x75, 0x18, -+0x03, 0x80, 0x03, 0x75, 0x18, 0x05, 0xF1, 0x8E, 0xEE, 0x80, 0x1B, 0xB1, 0x62, 0x24, 0x05, 0xFD, -+0xE4, 0x33, 0xFC, 0xC3, 0xEF, 0x12, 0x90, 0x4F, 0x50, 0x06, 0xF1, 0x56, 0xE0, 0xB4, 0x0A, 0x0C, -+0xB1, 0x62, 0xFF, 0xF1, 0x8E, 0xEF, 0xF1, 0x55, 0xE4, 0xF0, 0x80, 0x07, 0xB1, 0x6F, 0xF1, 0x54, -+0xE0, 0x04, 0xF0, 0x12, 0xB4, 0xFB, 0xE5, 0x10, 0xF0, 0xA1, 0x28, 0xE9, 0x64, 0x06, 0x60, 0x02, -+0xA1, 0x39, 0xF5, 0x11, 0xF5, 0x12, 0xF1, 0x3E, 0xE0, 0x54, 0x07, 0xF5, 0x18, 0xAF, 0x14, 0xAE, -+0x13, 0x12, 0xAD, 0x0F, 0x8F, 0x16, 0xE5, 0x15, 0xD3, 0x94, 0x13, 0x40, 0x1F, 0x90, 0xA4, 0x7E, -+0x12, 0x4A, 0x36, 0x12, 0x4F, 0x76, 0xFD, 0x7C, 0x00, 0xE5, 0x14, 0xAE, 0x13, 0xA8, 0x07, 0x08, -+0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x80, 0x19, 0xE5, 0x14, 0xAE, 0x13, -+0xA8, 0x16, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x44, 0x4A, -+0xE4, 0x93, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0x90, 0xA4, 0x88, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0xE4, 0xF5, 0x17, 0xE5, 0x15, 0xD3, 0x94, 0x13, 0x40, 0x1D, 0x12, 0xAE, 0x19, 0xA8, 0x16, 0x08, -+0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xA4, 0x7E, 0x12, 0x4A, 0x36, -+0x85, 0x17, 0x82, 0xF1, 0xEB, 0x80, 0x16, 0x12, 0xAE, 0x19, 0xA8, 0x16, 0x08, 0x80, 0x05, 0xCE, -+0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xE5, 0x17, 0x90, 0x44, 0x45, 0x93, 0x12, 0xAD, 0xF0, -+0x25, 0x12, 0xF5, 0x12, 0xEE, 0x35, 0x11, 0xF5, 0x11, 0xC3, 0x90, 0xA4, 0x89, 0xE0, 0x95, 0x12, -+0x90, 0xA4, 0x88, 0xE0, 0x95, 0x11, 0x40, 0x08, 0x05, 0x17, 0xE5, 0x17, 0x64, 0x05, 0x70, 0xA3, -+0xE5, 0x17, 0xC3, 0x13, 0xF5, 0x17, 0xE5, 0x18, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, -+0xEF, 0x13, 0xFF, 0xD3, 0x95, 0x17, 0x40, 0x06, 0xEF, 0x95, 0x17, 0xFF, 0x80, 0x02, 0xE4, 0xFF, -+0xF1, 0x32, 0xE0, 0xC3, 0x13, 0xFE, 0xEF, 0xC4, 0x33, 0x54, 0xE0, 0x2E, 0xFE, 0xF1, 0x32, 0xEE, -+0xF0, 0xF1, 0x32, 0xE0, 0xC3, 0x94, 0xC0, 0x40, 0x05, 0xF1, 0x32, 0x74, 0xC0, 0xF0, 0xF1, 0x32, -+0xE0, 0x24, 0x1F, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x06, 0xCE, 0xA2, 0xE7, 0x13, 0xCE, 0x13, -+0xD8, 0xF8, 0x25, 0xE0, 0xFF, 0x70, 0x04, 0xF5, 0x18, 0x80, 0x04, 0xEF, 0x14, 0xF5, 0x18, 0xD3, -+0x90, 0xA4, 0x85, 0xE0, 0x94, 0x03, 0x90, 0xA4, 0x84, 0xE0, 0x94, 0x00, 0x50, 0x07, 0xB1, 0x62, -+0xC3, 0x94, 0x30, 0x50, 0x03, 0xE4, 0xF5, 0x18, 0xF1, 0x3E, 0xE0, 0x54, 0xF8, 0x90, 0xA4, 0x8A, -+0xF0, 0x45, 0x18, 0xFF, 0xF0, 0xF1, 0x3E, 0xEF, 0xF0, 0xB1, 0x6F, 0xE0, 0xD3, 0x94, 0x05, 0x50, -+0x07, 0xB1, 0x6F, 0xE0, 0x04, 0xF0, 0x80, 0x0A, 0xF1, 0x49, 0xE0, 0x54, 0xF8, 0xF0, 0xB1, 0x6F, -+0xE4, 0xF0, 0x75, 0x19, 0x01, 0x7D, 0x01, 0xAF, 0x0E, 0x12, 0xA9, 0xB6, 0x05, 0x0E, 0x01, 0x3F, -+0x22, 0xFF, 0x74, 0x11, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x22, 0x74, -+0xA2, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0x22, 0x90, 0xA4, 0x8D, 0xE0, 0x24, -+0xA2, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0x22, 0x8F, 0x1A, 0x8D, 0x1B, 0x74, 0xA2, 0x2F, -+0xB1, 0x81, 0x74, 0xFF, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0xF1, 0xBD, 0xE0, 0xF5, 0x1C, 0x54, 0x7F, -+0xF5, 0x1D, 0xE5, 0x1C, 0x54, 0x80, 0xF5, 0x1E, 0x12, 0x57, 0x8E, 0xE0, 0xF5, 0x20, 0x75, 0xF0, -+0x04, 0xEF, 0x12, 0x4D, 0xE3, 0xC4, 0x54, 0x03, 0xF5, 0x21, 0xE5, 0x1D, 0xF1, 0xA8, 0xF1, 0xD3, -+0xE5, 0x1A, 0x12, 0x97, 0x45, 0xF1, 0xC3, 0x74, 0x22, 0x25, 0x1A, 0x12, 0x95, 0xFD, 0xE5, 0x1C, -+0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x12, 0x4D, 0xE3, 0x13, 0x13, 0x54, 0x03, 0xF5, 0x1F, 0x74, -+0x22, 0x25, 0x1A, 0x12, 0x97, 0xC5, 0xE5, 0x1F, 0xF0, 0x74, 0x91, 0x25, 0x1A, 0x12, 0x55, 0x17, -+0xE0, 0x30, 0xE0, 0x1D, 0xE5, 0x1D, 0x64, 0x3F, 0x70, 0x17, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x12, -+0x4F, 0x6D, 0xC4, 0x13, 0x54, 0x07, 0x7F, 0x3E, 0x30, 0xE0, 0x02, 0x7F, 0xBE, 0xF1, 0xE3, 0xE1, -+0x2E, 0xE5, 0x1D, 0x64, 0x2D, 0x70, 0x2F, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x12, 0x4D, 0xE3, 0xFF, -+0x54, 0x03, 0xFE, 0xE5, 0x1F, 0xC3, 0x9E, 0x50, 0x1D, 0x75, 0x1C, 0x2C, 0x05, 0x1F, 0xE5, 0x1F, -+0x12, 0x97, 0xB6, 0xFE, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x90, 0x96, 0x14, 0x12, 0x4A, 0x2A, 0xEF, -+0x54, 0xF3, 0x4E, 0xF0, 0x80, 0x08, 0xE5, 0x1D, 0xB4, 0x2C, 0x0E, 0x75, 0x1C, 0x2D, 0x74, 0xA2, -+0x25, 0x1A, 0xB1, 0x81, 0x74, 0xFF, 0xF0, 0xE1, 0x29, 0xE5, 0x1D, 0xC3, 0x95, 0x20, 0x40, 0x02, -+0xC1, 0xFB, 0xAD, 0x1C, 0xAF, 0x1A, 0x12, 0xAB, 0x32, 0xEF, 0xF4, 0x60, 0x0B, 0x8F, 0x1C, 0x8F, -+0x1D, 0xE5, 0x1C, 0x30, 0xE7, 0x02, 0xE1, 0x29, 0xAD, 0x1D, 0xAF, 0x21, 0x12, 0xA4, 0xB0, 0x8F, -+0x1D, 0xAD, 0x20, 0xAF, 0x21, 0x12, 0xA4, 0xB0, 0x8F, 0x20, 0xE5, 0x1D, 0xD3, 0x94, 0x0B, 0x40, -+0x13, 0x90, 0xA4, 0x95, 0xE5, 0x21, 0xF0, 0xAB, 0x1A, 0xE4, 0xFD, 0xAF, 0x1D, 0x12, 0xA4, 0xC4, -+0x8F, 0x1C, 0x80, 0x0B, 0xAB, 0x1A, 0xAD, 0x20, 0xAF, 0x1D, 0x12, 0xA5, 0xF8, 0x8F, 0x1C, 0xAD, -+0x1C, 0xAF, 0x21, 0x12, 0xA4, 0x9D, 0x8F, 0x1C, 0x74, 0xA2, 0x25, 0x1A, 0xB1, 0x81, 0xE0, 0xFD, -+0xF4, 0x60, 0x0D, 0xAF, 0x21, 0x12, 0xA4, 0x9D, 0x74, 0xA2, 0x25, 0x1A, 0xB1, 0x81, 0xEF, 0xF0, -+0x74, 0x91, 0x25, 0x1A, 0x12, 0x55, 0x17, 0xE0, 0x30, 0xE0, 0x4E, 0xE5, 0x1D, 0x64, 0x3F, 0x70, -+0x48, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x12, 0x4F, 0x6D, 0xC4, 0x13, 0x54, 0x07, 0x7F, 0x3E, 0x30, -+0xE0, 0x02, 0x7F, 0xBE, 0xF1, 0xE3, 0x12, 0x90, 0xE0, 0x80, 0x2E, 0xE5, 0x1D, 0x65, 0x20, 0x70, -+0x1C, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x12, 0x4F, 0x6D, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x21, -+0xE5, 0x1C, 0x20, 0xE7, 0x1C, 0xE5, 0x1D, 0x44, 0x80, 0xF5, 0x1C, 0x80, 0x0C, 0x74, 0x22, 0x25, -+0x1A, 0x12, 0x95, 0xFD, 0xE5, 0x20, 0xF0, 0xF5, 0x1C, 0x85, 0x1F, 0x77, 0xAB, 0x1B, 0x12, 0x90, -+0xE0, 0x22, 0x74, 0x01, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0x75, 0xF0, -+0x10, 0xE5, 0x0E, 0x90, 0x81, 0x01, 0x02, 0x4A, 0x2A, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x90, 0x9B, -+0x11, 0x02, 0x4A, 0x2A, 0xE4, 0xF0, 0x74, 0x21, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, -+0x83, 0x22, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0xA1, 0x23, 0xE0, 0xFF, 0x22, 0x75, 0xF0, 0x10, 0xE5, -+0x0E, 0x90, 0x81, 0x05, 0x02, 0x4A, 0x2A, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x90, 0x9B, 0x12, 0x02, -+0x4A, 0x2A, 0x90, 0xA4, 0x81, 0x12, 0x4A, 0x36, 0x90, 0x00, 0x08, 0x02, 0x49, 0xC0, 0x74, 0x01, -+0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0x74, 0x91, 0x25, 0x0E, 0xF5, 0x82, -+0xE4, 0x34, 0x9A, 0xF5, 0x83, 0x22, 0xE5, 0x10, 0x25, 0xE0, 0x24, 0x41, 0xF5, 0x82, 0xE4, 0x34, -+0x42, 0xF5, 0x83, 0x22, 0x90, 0xA4, 0x87, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0E, 0x90, 0x81, 0x00, -+0x02, 0x4A, 0x2A, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, -+0x5D, 0x4E, 0x22, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x22, 0x90, 0x00, 0x06, 0x12, 0x49, -+0xC0, 0x2F, 0x22, 0x8F, 0x1C, 0x85, 0x1F, 0x77, 0xE4, 0xFB, 0x22, 0x75, 0x83, 0x00, 0x02, 0x26, -+0x37, 0x90, 0xA3, 0xB7, 0xE0, 0xC3, 0x13, 0x54, 0x07, 0xFF, 0x75, 0xF0, 0x0E, 0x90, 0xA3, 0xC4, -+0x12, 0x4A, 0x2A, 0xE0, 0xFE, 0x75, 0xF0, 0x0E, 0xEF, 0x90, 0xA3, 0xC3, 0x12, 0x4A, 0x2A, 0xE0, -+0x90, 0xA5, 0x21, 0xF0, 0x90, 0xA5, 0x20, 0xEE, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x1C, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -+0xA5, 0x20, 0xE0, 0xF5, 0x3B, 0xA3, 0xE0, 0xF5, 0x3C, 0x12, 0x34, 0x8C, 0x90, 0xA5, 0x1C, 0x12, -+0xB6, 0x25, 0xA3, 0xA3, 0xA3, 0x74, 0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xF5, 0x24, -+0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x7D, 0x12, 0x8E, 0x0F, 0x70, 0x78, 0x12, 0x8D, 0x83, 0x60, 0x22, -+0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0xA2, 0xF6, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, -+0x06, 0x90, 0xA2, 0xF8, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0xA2, 0xF5, 0xE0, 0xA3, 0xF0, -+0x80, 0x00, 0x75, 0x24, 0x01, 0xE5, 0x24, 0x60, 0x4A, 0x90, 0xA2, 0xF3, 0xE0, 0x44, 0x10, 0xF0, -+0x90, 0xA2, 0xF8, 0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x16, 0xE4, 0x90, 0xA5, 0x20, 0xF0, 0x90, -+0xA2, 0xF8, 0xE0, 0x11, 0xD4, 0x90, 0xA5, 0x21, 0x11, 0x18, 0x90, 0xA2, 0xF8, 0xE0, 0x80, 0x10, -+0xE4, 0x90, 0xA5, 0x20, 0xF0, 0x11, 0xDB, 0x11, 0xD4, 0x90, 0xA5, 0x21, 0x11, 0x18, 0x11, 0xDB, -+0x11, 0xD4, 0x90, 0xA3, 0x08, 0xF0, 0x90, 0xA2, 0xF2, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x60, 0x49, -+0x12, 0x8E, 0xC8, 0x22, 0xFF, 0x90, 0xA2, 0xF7, 0xE0, 0x2F, 0x22, 0x90, 0xA2, 0xF8, 0xE0, 0x75, -+0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, 0x11, 0x4D, 0x90, 0xA3, 0x53, 0xE0, 0x30, 0xE0, 0x04, 0xE4, -+0xFF, 0x11, 0xF4, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x53, 0xEF, 0xF0, -+0xA3, 0x74, 0x02, 0xF0, 0xE4, 0xFF, 0x12, 0x8B, 0x4A, 0x90, 0xA3, 0x78, 0xE0, 0x44, 0x10, 0xF0, -+0x90, 0xA3, 0x57, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x01, 0x80, 0x32, 0x90, 0xA3, 0x53, 0x12, 0x5F, -+0xCB, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x25, 0x12, 0xB5, 0xF8, 0x30, 0xE0, 0x10, 0xEF, 0x13, -+0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x09, 0x80, 0x13, 0x7F, 0x03, 0x80, 0x0F, 0x90, 0xA3, -+0x56, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x09, 0xD1, 0x89, 0x90, -+0xA5, 0x53, 0xE0, 0x64, 0x03, 0x70, 0x67, 0x12, 0x5F, 0xC8, 0x30, 0xE0, 0x5C, 0x90, 0xA3, 0x5D, -+0xE0, 0xFF, 0x90, 0xA3, 0x68, 0xE0, 0xFE, 0xD3, 0x9F, 0x40, 0x34, 0xEE, 0x75, 0xF0, 0x03, 0xA4, -+0xFF, 0x90, 0xA3, 0x5F, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, 0xFF, 0x24, 0x03, 0xFD, 0xE4, 0x33, 0xFC, -+0x90, 0xA3, 0x55, 0xE0, 0xFE, 0x12, 0x90, 0x4E, 0x40, 0x08, 0xEE, 0x9F, 0x90, 0xA5, 0x56, 0xF0, -+0x80, 0x06, 0x90, 0xA5, 0x56, 0x74, 0x03, 0xF0, 0x90, 0xA5, 0x56, 0x51, 0xA5, 0x80, 0x13, 0x90, -+0xA3, 0x60, 0xE0, 0xFF, 0x51, 0x94, 0x90, 0xA3, 0x5B, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA3, 0x66, -+0xD1, 0x47, 0xE4, 0x90, 0xA3, 0x68, 0xF0, 0x80, 0x05, 0x90, 0xA3, 0x55, 0x51, 0xA5, 0x90, 0xA3, -+0x53, 0x12, 0x4F, 0x7F, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA5, 0x55, 0xF0, 0x80, 0x06, 0x90, 0xA5, -+0x55, 0x74, 0x01, 0xF0, 0x12, 0xB5, 0x43, 0x20, 0xE0, 0x13, 0x90, 0xA3, 0x95, 0xE0, 0x60, 0x07, -+0xE4, 0x90, 0xA5, 0x54, 0xF0, 0x80, 0x06, 0x90, 0xA5, 0x54, 0x74, 0x01, 0xF0, 0x90, 0xA5, 0x54, -+0x51, 0xB0, 0x90, 0xA3, 0x65, 0x74, 0x01, 0xF0, 0x12, 0x9E, 0x0E, 0x30, 0xE0, 0x0D, 0x90, 0xA5, -+0x53, 0xE0, 0x70, 0x32, 0xFD, 0xFF, 0x12, 0x59, 0x62, 0x80, 0x2B, 0xF1, 0xEF, 0x30, 0xE0, 0x12, -+0x12, 0xB5, 0x62, 0x60, 0x04, 0x7D, 0x01, 0x80, 0x18, 0x12, 0x67, 0x98, 0x7D, 0x01, 0x7F, 0x0C, -+0x80, 0x11, 0x90, 0xA5, 0x53, 0xE0, 0xB4, 0x03, 0x0D, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x07, 0xE4, -+0xFD, 0x7F, 0x04, 0x12, 0x60, 0x4D, 0x90, 0xA3, 0x52, 0xE0, 0x60, 0x18, 0x90, 0xA5, 0x53, 0xE0, -+0x70, 0x04, 0x7D, 0x04, 0x80, 0x0A, 0x90, 0xA5, 0x53, 0xE0, 0x64, 0x03, 0x70, 0x2E, 0x7D, 0x0B, -+0x7F, 0x6F, 0x80, 0x25, 0x90, 0xA5, 0x53, 0xE0, 0x70, 0x04, 0xFD, 0xFF, 0x80, 0x1B, 0x90, 0xA5, -+0x53, 0xE0, 0xB4, 0x03, 0x17, 0x12, 0x89, 0xF9, 0x20, 0xE0, 0x0B, 0xEF, 0x13, 0x13, 0x54, 0x3F, -+0x30, 0xE0, 0x03, 0x12, 0x99, 0xC0, 0xE4, 0xFD, 0xFF, 0x12, 0x59, 0x62, 0x12, 0x4F, 0x7C, 0x30, -+0xE0, 0x05, 0x7F, 0x01, 0x12, 0x9C, 0x9C, 0xF1, 0xE8, 0x30, 0xE0, 0x03, 0x12, 0xB5, 0x34, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0xA5, 0x20, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, -+0x50, 0x7E, 0x01, 0x01, 0x20, 0xE0, 0xFF, 0x51, 0x94, 0x90, 0xA3, 0x66, 0xE0, 0x04, 0xF0, 0x22, -+0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x78, 0x8D, 0x79, -+0xE5, 0x78, 0x64, 0x02, 0x60, 0x26, 0x12, 0xB5, 0x9E, 0x71, 0x46, 0xE5, 0x78, 0x90, 0xA4, 0xF8, -+0xB4, 0x01, 0x08, 0x12, 0x4A, 0x12, 0xEC, 0x44, 0x08, 0x80, 0x06, 0x12, 0x4A, 0x12, 0xEC, 0x44, -+0x04, 0x71, 0x46, 0x90, 0xA4, 0xF8, 0x12, 0x64, 0x26, 0x12, 0xB6, 0x44, 0xE5, 0x79, 0x64, 0x02, -+0x60, 0x4F, 0xF1, 0xE1, 0xE4, 0x71, 0x46, 0xE5, 0x79, 0x70, 0x09, 0x12, 0xB6, 0x59, 0x44, 0x77, -+0x71, 0x46, 0x80, 0x30, 0x12, 0xB6, 0x59, 0x44, 0x66, 0x71, 0x46, 0x12, 0xB5, 0x9E, 0x12, 0xB6, -+0x52, 0x90, 0xA3, 0x95, 0xE0, 0x90, 0xA4, 0xFC, 0x60, 0x08, 0x12, 0x4A, 0x12, 0xEC, 0x44, 0x04, -+0x80, 0x06, 0x12, 0x4A, 0x12, 0xEC, 0x44, 0x08, 0x12, 0xB6, 0x52, 0x90, 0xA4, 0xFC, 0x12, 0x64, -+0x26, 0x12, 0xB6, 0x44, 0x90, 0xA4, 0xF8, 0x12, 0x64, 0x26, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, -+0x5D, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFC, 0x90, 0xA4, 0xF8, 0x02, 0x27, 0x48, 0x90, 0xA4, 0xAC, -+0xEF, 0xF0, 0x90, 0xA4, 0xAE, 0x74, 0x02, 0xF0, 0x7F, 0x01, 0x12, 0x8B, 0x4A, 0x90, 0xA3, 0x57, -+0x12, 0x4F, 0x7F, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0xD1, 0x89, 0x90, 0xA4, -+0xAC, 0xE0, 0xB4, 0x02, 0x10, 0x90, 0xA3, 0x54, 0xE0, 0x24, 0x03, 0xFF, 0x90, 0xA3, 0x63, 0xE0, -+0xC3, 0x9F, 0xFF, 0x51, 0x94, 0x90, 0xA3, 0x53, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xE4, 0x90, -+0xA4, 0xAD, 0xF0, 0x80, 0x06, 0x90, 0xA4, 0xAD, 0x74, 0x01, 0xF0, 0x12, 0xB5, 0x43, 0x20, 0xE0, -+0x13, 0x90, 0xA3, 0x95, 0xE0, 0x60, 0x08, 0x90, 0xA4, 0xAE, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, -+0x90, 0xA4, 0xAE, 0xF0, 0x90, 0xA4, 0xAE, 0xE0, 0xFF, 0x90, 0xA4, 0xAD, 0xE0, 0xFD, 0x51, 0xB5, -+0xE4, 0x90, 0xA3, 0x65, 0xF0, 0x90, 0xA4, 0xAC, 0xE0, 0xFF, 0xB4, 0x02, 0x04, 0x51, 0xA9, 0x80, -+0x09, 0xEF, 0xB4, 0x05, 0x05, 0xE4, 0x90, 0xA3, 0x66, 0xF0, 0x12, 0x9E, 0x0E, 0x30, 0xE0, 0x17, -+0x90, 0xA4, 0xAC, 0xE0, 0xB4, 0x02, 0x04, 0x7D, 0x08, 0x80, 0x4E, 0x90, 0xA4, 0xAC, 0xE0, 0x64, -+0x05, 0x70, 0x4B, 0x7D, 0x0E, 0x80, 0x42, 0xF1, 0xEF, 0x30, 0xE0, 0x20, 0x12, 0x9C, 0xD4, 0x20, -+0xE0, 0x03, 0x12, 0xB5, 0xA9, 0x90, 0xA4, 0xAC, 0xE0, 0xB4, 0x02, 0x04, 0x7D, 0x09, 0x80, 0x29, -+0x90, 0xA4, 0xAC, 0xE0, 0x64, 0x05, 0x70, 0x26, 0x7D, 0x0F, 0x80, 0x1D, 0x90, 0xA2, 0xEF, 0xE0, -+0x60, 0x1C, 0x12, 0xB5, 0xA9, 0x90, 0xA4, 0xAC, 0xE0, 0xB4, 0x02, 0x04, 0x7D, 0x0A, 0x80, 0x09, -+0x90, 0xA4, 0xAC, 0xE0, 0xB4, 0x05, 0x07, 0x7D, 0x10, 0x7F, 0x6F, 0x12, 0x59, 0x62, 0x90, 0xA3, -+0x56, 0xE0, 0x30, 0xE0, 0x03, 0x12, 0x67, 0x98, 0x12, 0x4F, 0x7C, 0x30, 0xE0, 0x05, 0xE4, 0xFF, -+0x12, 0x9C, 0x9C, 0xF1, 0xE8, 0x30, 0xE0, 0x0E, 0x90, 0x06, 0xCD, 0xE0, 0x54, 0xEF, 0xF0, 0x90, -+0x06, 0xCF, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x12, 0x5F, 0xC8, 0x20, 0xE0, 0x02, 0xC1, 0x41, 0x90, -+0xA3, 0x5B, 0xE0, 0x64, 0x01, 0x70, 0x2B, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x06, 0x90, 0x04, -+0xE3, 0xE0, 0x60, 0x18, 0xD1, 0x48, 0xD1, 0x56, 0x90, 0xA3, 0x5F, 0xE0, 0x75, 0xF0, 0x03, 0x84, -+0xFF, 0x90, 0xA3, 0x68, 0xE0, 0xB5, 0x07, 0x02, 0x80, 0x02, 0xC1, 0x2B, 0x12, 0xB6, 0x01, 0x04, -+0xF0, 0x22, 0x90, 0xA3, 0x5B, 0xE0, 0x64, 0x04, 0x70, 0x28, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, -+0x06, 0x90, 0x04, 0xE3, 0xE0, 0x60, 0x14, 0xD1, 0x48, 0xD1, 0x56, 0x90, 0xA3, 0x5E, 0xE0, 0xFF, -+0x90, 0xA3, 0x68, 0xE0, 0xB5, 0x07, 0x02, 0x80, 0x02, 0xC1, 0x2B, 0x12, 0xB6, 0x01, 0x74, 0x04, -+0xF0, 0x22, 0x90, 0xA3, 0x5B, 0xE0, 0x64, 0x06, 0x60, 0x02, 0xA1, 0xAD, 0xD1, 0x5D, 0x50, 0x08, -+0x90, 0xA3, 0x69, 0xE0, 0x94, 0x03, 0x40, 0x1B, 0x12, 0x8E, 0xEE, 0x90, 0xA3, 0x66, 0x30, 0xE0, -+0x05, 0x74, 0x05, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0xE4, 0x90, 0xA3, 0x5B, 0xF0, 0x90, 0xA3, -+0x69, 0xF0, 0x22, 0x90, 0xA3, 0x5A, 0x12, 0x8E, 0x1B, 0x30, 0xE0, 0x3B, 0xEF, 0x54, 0xFB, 0xF0, -+0xE4, 0xA3, 0x12, 0x8E, 0xED, 0x30, 0xE0, 0x0B, 0x90, 0xA3, 0x78, 0xE0, 0x20, 0xE0, 0x02, 0xA1, -+0xDF, 0xA1, 0xD7, 0xD1, 0x5D, 0x40, 0x0B, 0x90, 0xA3, 0x78, 0xE0, 0x30, 0xE0, 0x02, 0xA1, 0xD7, -+0xA1, 0xDF, 0x90, 0xA3, 0x78, 0xE0, 0x30, 0xE0, 0x07, 0xD1, 0x42, 0x12, 0xB5, 0xE6, 0xA1, 0xEC, -+0x90, 0xA3, 0x66, 0x74, 0x02, 0xF0, 0x22, 0x12, 0x9D, 0xFD, 0x90, 0xA3, 0x69, 0xE0, 0x04, 0xF0, -+0x7F, 0x03, 0x51, 0x94, 0xD1, 0x5D, 0x50, 0x0A, 0x90, 0xA3, 0x69, 0xE0, 0x94, 0x03, 0x50, 0x02, -+0xC1, 0x41, 0x90, 0xA1, 0xE2, 0xE0, 0xFF, 0x90, 0xA5, 0x42, 0x74, 0x0A, 0xF0, 0x7B, 0x01, 0x7D, -+0x01, 0x12, 0x5C, 0xC2, 0xAD, 0x07, 0xAC, 0x06, 0xE4, 0xFF, 0x12, 0x5C, 0x82, 0x12, 0xB4, 0x4C, -+0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0xA3, 0x5A, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x7D, -+0x04, 0x7F, 0x01, 0x12, 0x62, 0x4F, 0x7F, 0x03, 0xD1, 0x89, 0x90, 0x05, 0x22, 0xE0, 0x44, 0x10, -+0xFF, 0x7D, 0x03, 0x12, 0x59, 0x62, 0x90, 0x04, 0x9C, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA3, 0x5B, -+0xE0, 0x64, 0x07, 0x70, 0x3A, 0x90, 0xA3, 0x69, 0xE0, 0xB4, 0x04, 0x04, 0xD1, 0x4F, 0x80, 0x65, -+0x90, 0xA3, 0x5A, 0x12, 0x8E, 0x1B, 0x30, 0xE0, 0x18, 0xEF, 0x54, 0xFB, 0xF0, 0xE4, 0xA3, 0xF0, -+0x90, 0xA3, 0x78, 0xE0, 0x30, 0xE0, 0x08, 0xD1, 0x42, 0x12, 0xB5, 0xE6, 0x04, 0x80, 0x0D, 0x80, -+0x6E, 0x12, 0x9D, 0xFD, 0x12, 0x5B, 0xB5, 0x90, 0xA3, 0x69, 0xE0, 0x04, 0xF0, 0x80, 0x3C, 0x90, -+0xA3, 0x5B, 0xE0, 0x64, 0x09, 0x70, 0x4A, 0x90, 0xA3, 0x5A, 0xE0, 0x30, 0xE0, 0x0A, 0xD1, 0x4F, -+0x90, 0xA3, 0x5A, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE2, 0x20, 0x74, -+0x04, 0xF0, 0xD1, 0x56, 0xE0, 0xB4, 0x02, 0x13, 0x12, 0xB6, 0x61, 0x60, 0x05, 0x74, 0x05, 0xF0, -+0x80, 0x03, 0x74, 0x02, 0xF0, 0xE4, 0x90, 0xA3, 0x5B, 0xF0, 0x22, 0x7F, 0x03, 0x41, 0x94, 0x12, -+0xB6, 0x61, 0x60, 0x05, 0x74, 0x05, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0xE4, 0x90, 0xA3, 0x5B, -+0xF0, 0x22, 0x90, 0xA3, 0x5B, 0x74, 0x09, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0x22, 0x90, -+0xA3, 0x66, 0x74, 0x05, 0xF0, 0x22, 0x90, 0xA3, 0x68, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA3, 0x69, -+0xE0, 0xFF, 0x90, 0xA3, 0x68, 0xE0, 0x2F, 0xFF, 0xE4, 0x33, 0xFE, 0x7C, 0x00, 0x7D, 0x03, 0x12, -+0x26, 0x98, 0x90, 0xA3, 0x54, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0x90, 0xA3, 0x85, 0xE0, 0xFD, -+0xC3, 0xEF, 0x9D, 0x74, 0x80, 0xF8, 0x6E, 0x98, 0x22, 0x90, 0xA3, 0x78, 0x12, 0x67, 0x81, 0x30, -+0xE0, 0x07, 0x90, 0x07, 0x78, 0x74, 0x09, 0xF0, 0x22, 0x90, 0xA3, 0xB4, 0xE0, 0x30, 0xE0, 0x1D, -+0xEF, 0x24, 0xFD, 0x60, 0x0E, 0x24, 0xFA, 0x60, 0x0E, 0x24, 0xFC, 0x60, 0x0E, 0x24, 0x0C, 0x7F, -+0x02, 0x80, 0x0A, 0x7F, 0x03, 0x80, 0x06, 0x7F, 0x0B, 0x80, 0x02, 0x7F, 0x0E, 0x90, 0x07, 0x78, -+0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x5A, 0xB5, 0x7F, 0x00, 0x7E, -+0x0C, 0x12, 0x64, 0x15, 0x12, 0xB5, 0x56, 0x12, 0x64, 0x15, 0x12, 0xB6, 0x3D, 0xF1, 0xD5, 0xF1, -+0xC9, 0xF1, 0xC9, 0x12, 0xB6, 0x1C, 0x44, 0x40, 0x12, 0x64, 0x1B, 0x12, 0xB6, 0x36, 0x90, 0x01, -+0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, -+0xF1, 0xE1, 0x90, 0xA2, 0xFD, 0x12, 0x27, 0x48, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, -+0x77, 0x77, 0x12, 0xB1, 0x51, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x12, 0xB6, 0x4B, 0x90, -+0xA3, 0x51, 0x12, 0x67, 0x81, 0x30, 0xE0, 0x04, 0x7F, 0x01, 0xD1, 0x89, 0x12, 0xA0, 0x0C, 0x30, -+0xE0, 0x31, 0x90, 0xA3, 0x95, 0xE0, 0x60, 0x08, 0x90, 0xA5, 0x13, 0x74, 0x01, 0xF0, 0x80, 0x05, -+0xE4, 0x90, 0xA5, 0x13, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA5, -+0x14, 0xF0, 0x80, 0x06, 0x90, 0xA5, 0x14, 0x74, 0x02, 0xF0, 0x90, 0xA5, 0x13, 0x51, 0xB0, 0x7F, -+0x01, 0xD1, 0x89, 0x90, 0xA3, 0x50, 0xE0, 0x60, 0x02, 0xE4, 0xF0, 0x90, 0x00, 0xFF, 0xE0, 0x70, -+0x16, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x0E, 0x7D, 0x08, 0x7F, 0x01, 0x12, 0xAA, 0x87, 0x90, 0xA5, -+0x0E, 0xE0, 0x44, 0x18, 0x12, 0xAA, 0x36, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA3, 0x53, 0xE0, -+0x30, 0xE0, 0x35, 0x91, 0x67, 0x90, 0xA3, 0x66, 0xE0, 0xFF, 0xB4, 0x01, 0x02, 0x80, 0x1C, 0x90, -+0xA3, 0x66, 0xE0, 0xFF, 0xB4, 0x02, 0x02, 0x80, 0x1D, 0x90, 0xA3, 0x66, 0xE0, 0xFF, 0xB4, 0x03, -+0x02, 0x01, 0xF4, 0x90, 0xA3, 0x66, 0xE0, 0xFF, 0xB4, 0x04, 0x03, 0x02, 0x9C, 0xDD, 0x90, 0xA3, -+0x66, 0xE0, 0xFF, 0xB4, 0x05, 0x02, 0x71, 0x4D, 0x22, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x01, 0xFD, -+0x7F, 0x02, 0x12, 0x3A, 0x96, 0x90, 0x00, 0x02, 0xE0, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x02, 0x3A, -+0x96, 0x7F, 0xB0, 0x7E, 0x0C, 0x02, 0x36, 0xCE, 0x90, 0xA3, 0x57, 0xE0, 0xC3, 0x13, 0x22, 0x90, -+0xA3, 0x53, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, -+0x00, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xFB, 0x7D, 0x00, 0x7C, 0x00, 0xE4, 0x90, 0xA5, 0x06, 0xF0, -+0xEB, 0x90, 0xA5, 0x01, 0xF0, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xE4, 0xFF, 0xEC, 0x90, -+0xA5, 0x02, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x02, 0x12, 0x4A, 0x1E, 0x90, 0xA5, 0x01, 0xE0, 0xFF, -+0xE4, 0xFC, 0xFD, 0xFE, 0x12, 0x4A, 0x05, 0xA3, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x02, 0x12, 0x64, -+0x26, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x11, 0x6E, 0x90, 0xA5, 0x00, 0xE0, 0x75, 0xF0, -+0x08, 0xA4, 0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0xAF, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x12, 0x36, 0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x14, -+0x7E, 0x00, 0x02, 0x3A, 0xF7, 0x90, 0xA5, 0x65, 0x31, 0x72, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, -+0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0xA5, 0x65, 0xE0, 0x6F, 0x60, 0x35, 0xC3, 0x90, 0xA5, 0x67, -+0xE0, 0x94, 0x88, 0x90, 0xA5, 0x66, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, -+0x10, 0xF0, 0x22, 0x90, 0xA5, 0x66, 0x12, 0x58, 0xAB, 0x11, 0x6E, 0xD3, 0x90, 0xA5, 0x67, 0xE0, -+0x94, 0x32, 0x90, 0xA5, 0x66, 0xE0, 0x94, 0x00, 0x40, 0xC0, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, -+0xB9, 0x22, 0x12, 0xAB, 0x15, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x3A, -+0x96, 0xE4, 0xFF, 0x11, 0x75, 0x90, 0xA1, 0x29, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, -+0x54, 0x7F, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0xA2, 0xEB, 0xE0, 0x54, 0xEF, 0xF0, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0x13, 0x11, 0xC2, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0xA2, 0xF2, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x08, 0x12, 0xB2, 0x73, 0xBF, 0x01, 0x02, -+0x11, 0xF0, 0x22, 0x90, 0xA2, 0xEB, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA1, 0x29, 0xE0, 0xB4, 0x03, -+0x0C, 0x90, 0x00, 0x70, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0xA2, 0xFA, -+0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x3A, 0x96, 0x90, 0xA2, 0xF0, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, -+0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, -+0x00, 0x08, 0xE0, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0x7F, 0x01, 0x11, 0x75, 0x90, -+0x00, 0x90, 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x3A, 0x96, 0x7F, 0x14, 0x7E, 0x00, 0x02, -+0x3A, 0xF7, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0xA4, 0x82, -+0xF0, 0xF4, 0x60, 0x18, 0xE0, 0x90, 0xA3, 0xE4, 0x12, 0x4F, 0x60, 0x75, 0xF0, 0x0A, 0xA4, 0xFF, -+0x90, 0xA3, 0xE5, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0x02, 0x88, 0xCD, 0x90, 0xA4, 0x82, 0xE0, -+0x90, 0xA3, 0xE4, 0x31, 0x73, 0x90, 0x01, 0x5F, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA5, 0x33, 0xEE, 0xF0, 0xA3, 0x31, 0x72, 0x90, 0xA5, 0x33, 0x12, 0xB6, 0x25, 0xE0, -+0x60, 0x29, 0xC3, 0x90, 0xA5, 0x36, 0xE0, 0x94, 0xE8, 0x90, 0xA5, 0x35, 0xE0, 0x94, 0x03, 0x40, -+0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x11, 0x90, 0xA5, 0x35, 0x12, -+0x58, 0xAB, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x80, 0xCE, 0x7F, 0x01, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x3B, 0x12, 0x4A, 0x3F, 0x7F, -+0x96, 0x7E, 0x02, 0x31, 0xAA, 0xEF, 0x60, 0x51, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, -+0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, 0xFE, -+0x90, 0xA5, 0x3E, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0xA5, 0x3E, 0xE0, 0xFD, -+0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA5, 0x3B, 0x71, 0x8B, 0x24, 0x02, 0xFF, 0xE4, -+0x33, 0xFE, 0x51, 0x5E, 0x90, 0xA5, 0x3E, 0xE0, 0x24, 0x18, 0xFF, 0x90, 0xA5, 0x3B, 0x12, 0x4A, -+0x36, 0x71, 0x1D, 0x90, 0x02, 0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFC, -+0xED, 0x2C, 0x24, 0x00, 0x51, 0xAF, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xF3, 0x74, 0x00, 0x2D, -+0x51, 0xAF, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, -+0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, -+0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, -+0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xF5, -+0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, -+0x90, 0xA2, 0xD0, 0xE0, 0xFE, 0x90, 0xA2, 0xCF, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, -+0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, 0x40, 0xED, 0x12, 0xB5, 0x92, 0xFA, 0x7B, 0x01, 0x31, -+0xF2, 0x7F, 0x01, 0xEF, 0x60, 0x32, 0x90, 0xA2, 0xCF, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, -+0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA2, 0xCF, 0xF0, 0x90, 0xA2, 0xD0, 0xE0, -+0xFF, 0x90, 0xA2, 0xCF, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, -+0x07, 0x90, 0xA1, 0x23, 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA5, 0x37, -+0xEF, 0xF0, 0xA3, 0x12, 0x4A, 0x3F, 0x90, 0xA5, 0x61, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, -+0xEE, 0x12, 0x26, 0x76, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, -+0xC0, 0x02, 0xC0, 0x01, 0x90, 0xA5, 0x38, 0x12, 0x4A, 0x36, 0xF1, 0xDC, 0x75, 0x43, 0x02, 0xD0, -+0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0xA5, 0x37, 0xE0, 0x24, 0x02, 0xF9, 0xE4, -+0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x4A, 0x36, 0xE9, -+0x24, 0x02, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0xA5, 0x38, 0x71, 0x8B, -+0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x2C, 0x12, 0x4A, 0x36, 0x90, 0x00, -+0x0E, 0x02, 0x26, 0x37, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x3F, 0x90, 0xA4, 0x7E, 0xEF, 0xF0, 0x12, -+0x4A, 0x48, 0x7B, 0xEE, 0x00, 0x7B, 0xF7, 0x01, 0x7B, 0xFF, 0x10, 0x7C, 0x08, 0x11, 0x7C, 0x10, -+0x12, 0x7C, 0x19, 0x14, 0x7C, 0x22, 0x20, 0x7C, 0x2B, 0x21, 0x7C, 0x34, 0x23, 0x7C, 0x3D, 0x25, -+0x7C, 0x46, 0x40, 0x7C, 0x69, 0x41, 0x7C, 0x4F, 0x42, 0x7C, 0x58, 0x47, 0x7C, 0x61, 0x49, 0x7C, -+0x71, 0x60, 0x7C, 0x7A, 0x64, 0x7C, 0x83, 0x65, 0x7C, 0x8B, 0x6B, 0x7C, 0x94, 0x6D, 0x7C, 0x9D, -+0x6E, 0x7C, 0xA6, 0x6F, 0x7C, 0xAF, 0x70, 0x7C, 0xB8, 0x87, 0x00, 0x00, 0x7C, 0xC1, 0x90, 0xA4, -+0x7F, 0x12, 0x4A, 0x36, 0x02, 0x97, 0xDF, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0xC1, 0x99, 0x90, -+0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x02, 0x98, 0x20, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x81, 0xD1, -+0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x02, 0x98, 0x48, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x02, -+0x98, 0x5C, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x02, 0x98, 0x6B, 0x90, 0xA4, 0x7F, 0x12, 0x4A, -+0x36, 0x02, 0x4F, 0xD5, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x02, 0x9F, 0xD3, 0x90, 0xA4, 0x7F, -+0x12, 0x4A, 0x36, 0x02, 0x9F, 0xDB, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x02, 0x4C, 0xE0, 0x90, -+0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x02, 0x55, 0x1F, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x02, 0xAE, -+0x30, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0xE1, 0xEA, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x21, -+0x7A, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x02, 0x9A, 0x8A, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, -+0x02, 0xA0, 0x1D, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0xE1, 0x90, 0x90, 0xA4, 0x7F, 0x12, 0x4A, -+0x36, 0x02, 0x50, 0x9B, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x02, 0xA0, 0x6F, 0x90, 0xA4, 0x7F, -+0x12, 0x4A, 0x36, 0x02, 0xA0, 0xDD, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x02, 0xA1, 0x09, 0x90, -+0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x02, 0xA1, 0x2C, 0x90, 0xA4, 0x7F, 0x12, 0x4A, 0x36, 0x02, 0x4F, -+0x99, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0xA4, 0x7E, 0xE0, 0x90, 0x01, 0xC2, 0xF0, -+0x22, 0x8B, 0x0E, 0x8A, 0x0F, 0x89, 0x10, 0x12, 0x26, 0x1E, 0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x0F, -+0x17, 0x90, 0xA3, 0xB6, 0xE0, 0x54, 0xFE, 0xF0, 0xF1, 0x86, 0xB1, 0x9E, 0x12, 0x26, 0x1E, 0x54, -+0x0F, 0xFF, 0x12, 0x59, 0xBF, 0x02, 0xAE, 0xCB, 0xB1, 0x9E, 0xF1, 0x57, 0xD1, 0x87, 0x12, 0xB5, -+0x4C, 0xEF, 0x12, 0x4F, 0x60, 0x54, 0x03, 0xFF, 0x75, 0xF0, 0x0E, 0xED, 0x12, 0x5B, 0xAD, 0x54, -+0xFC, 0x12, 0x4F, 0x5F, 0x54, 0x1C, 0xFF, 0xEE, 0x54, 0x0F, 0xFE, 0x75, 0xF0, 0x0E, 0x12, 0x5B, -+0xAD, 0x54, 0xE3, 0x12, 0x4F, 0x5F, 0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x0E, 0xEE, 0x12, 0x5B, 0xAD, -+0x54, 0x1F, 0x4F, 0xF1, 0xD5, 0xD1, 0x7F, 0xE4, 0xFB, 0xB1, 0x9C, 0x12, 0x4F, 0x76, 0xD1, 0x7F, -+0x7B, 0x01, 0xB1, 0x9C, 0x12, 0x55, 0xC8, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xD1, 0x87, 0xFD, 0x75, -+0xF0, 0x0E, 0x90, 0xA3, 0xC3, 0x12, 0x4A, 0x2A, 0xEF, 0xF0, 0x12, 0x55, 0xC8, 0xC4, 0x13, 0x54, -+0x07, 0xFF, 0x75, 0xF0, 0x0E, 0xED, 0x90, 0xA3, 0xC4, 0x12, 0x4A, 0x2A, 0xEF, 0xF0, 0xEE, 0xC4, -+0x54, 0x0F, 0xFF, 0x14, 0x6D, 0x70, 0x24, 0x90, 0xA3, 0xB8, 0xEF, 0xF1, 0xE3, 0x54, 0x0F, 0xC4, -+0x54, 0xF0, 0xFF, 0x90, 0xA3, 0xB7, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, 0x54, 0xF1, 0xF0, 0x90, 0xA3, -+0xB6, 0xE0, 0x44, 0x01, 0xF0, 0x7D, 0x20, 0xE4, 0xFF, 0xF1, 0x5D, 0x22, 0xB1, 0xA5, 0xAB, 0x0E, -+0xAA, 0x0F, 0xA9, 0x10, 0x22, 0x8F, 0x11, 0x8D, 0x12, 0xAE, 0x03, 0x74, 0x1F, 0xC3, 0x95, 0x11, -+0x40, 0x0A, 0xD1, 0x77, 0xE4, 0xFD, 0xD1, 0x6F, 0x24, 0xD4, 0x80, 0x31, 0x74, 0x3F, 0xC3, 0x95, -+0x11, 0x40, 0x0A, 0xD1, 0x77, 0x7D, 0x20, 0xD1, 0x6D, 0x24, 0x88, 0x80, 0x20, 0x74, 0x5F, 0xC3, -+0x95, 0x11, 0x40, 0x0A, 0xD1, 0x77, 0x7D, 0x40, 0xD1, 0x6D, 0x24, 0xD0, 0x80, 0x0F, 0x74, 0x7F, -+0xC3, 0x95, 0x11, 0x40, 0x20, 0xD1, 0x77, 0x7D, 0x60, 0xD1, 0x6D, 0x24, 0x84, 0xFD, 0xE4, 0x34, -+0x04, 0xFC, 0x75, 0xF0, 0x0E, 0xE5, 0x12, 0xF1, 0x75, 0x75, 0xF0, 0x03, 0xEE, 0x12, 0x4A, 0x2A, -+0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x22, 0xC3, 0xEF, 0x9D, 0xF5, 0x13, 0xC3, 0x94, 0x08, 0x50, 0x1C, -+0xE4, 0xF5, 0x14, 0xD1, 0x8F, 0xC0, 0x83, 0xC0, 0x82, 0x90, 0xA4, 0x86, 0xE0, 0xD0, 0x82, 0xD0, -+0x83, 0x75, 0xF0, 0x03, 0x12, 0x4A, 0x2A, 0xE5, 0x13, 0xF0, 0x80, 0x3E, 0xE5, 0x13, 0xC3, 0x94, -+0x10, 0x50, 0x09, 0x75, 0x14, 0x01, 0xE5, 0x13, 0x24, 0xF8, 0x80, 0x17, 0xE5, 0x13, 0xC3, 0x94, -+0x18, 0x50, 0x09, 0x75, 0x14, 0x02, 0xE5, 0x13, 0x24, 0xF0, 0x80, 0x07, 0x75, 0x14, 0x03, 0xE5, -+0x13, 0x24, 0xE8, 0xFF, 0xD1, 0x8F, 0xC0, 0x83, 0xC0, 0x82, 0x90, 0xA4, 0x86, 0xE0, 0xD0, 0x82, -+0xD0, 0x83, 0x75, 0xF0, 0x03, 0x12, 0x4A, 0x2A, 0xEF, 0xF0, 0xAF, 0x14, 0x22, 0xAF, 0x11, 0xD1, -+0x06, 0x90, 0xA4, 0x82, 0xEF, 0xF0, 0x22, 0x90, 0xA4, 0x86, 0xEE, 0xF0, 0xAB, 0x12, 0x22, 0xFF, -+0x12, 0x26, 0x1E, 0x54, 0x0F, 0xFD, 0x22, 0xFF, 0x12, 0x26, 0x1E, 0xFE, 0x54, 0x0F, 0x22, 0x75, -+0xF0, 0x0E, 0xEB, 0x90, 0xA3, 0xBE, 0x02, 0x4A, 0x2A, 0x8B, 0x0E, 0x8A, 0x0F, 0x89, 0x10, 0xF1, -+0x57, 0xFF, 0xF5, 0x12, 0x12, 0x26, 0x1E, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0x12, 0x4F, 0x61, -+0xF5, 0x13, 0x80, 0x02, 0x8F, 0x13, 0x85, 0x12, 0x11, 0xE5, 0x11, 0xD3, 0x95, 0x13, 0x50, 0x20, -+0xB1, 0x9E, 0x12, 0x26, 0x1E, 0x54, 0x01, 0xFD, 0xAF, 0x11, 0x12, 0x57, 0xAC, 0xAF, 0x11, 0xD1, -+0xF3, 0xEF, 0xAF, 0x11, 0x70, 0x04, 0xF1, 0x16, 0x80, 0x02, 0xF1, 0x9D, 0x05, 0x11, 0x80, 0xD9, -+0xE5, 0x12, 0x70, 0x0E, 0xFF, 0xD1, 0xF3, 0xEF, 0x70, 0x08, 0xF1, 0xAA, 0x54, 0xBF, 0xF0, 0x54, -+0x7F, 0xF0, 0x22, 0xF1, 0xCE, 0xFE, 0xEF, 0x54, 0x07, 0xFF, 0xF1, 0x7B, 0xE0, 0xFD, 0x7C, 0x00, -+0x12, 0xA2, 0x61, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x6F, 0xCB, 0x7F, -+0x00, 0x60, 0x02, 0x7F, 0x01, 0x22, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0xA5, 0x74, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x7D, 0x44, 0x12, 0x5F, 0xC2, 0x90, 0xA5, 0x75, 0xE0, -+0x90, 0xA5, 0x74, 0xB4, 0x01, 0x0D, 0xE0, 0x75, 0xF0, 0x10, 0x12, 0x6F, 0x71, 0xE0, 0x44, 0x04, -+0xF0, 0x80, 0x0B, 0xE0, 0x75, 0xF0, 0x10, 0x12, 0x6F, 0x71, 0xE0, 0x54, 0xFB, 0xF0, 0x12, 0x67, -+0x98, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0x00, 0x01, 0x02, 0x26, 0x37, 0x74, 0x65, 0x2F, -+0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, -+0xF0, 0x22, 0x75, 0xF0, 0x0E, 0x90, 0xA3, 0xBC, 0x02, 0x4A, 0x2A, 0x74, 0xD4, 0x2E, 0xF5, 0x82, -+0xE4, 0x34, 0xA2, 0xF5, 0x83, 0x22, 0x7D, 0x20, 0xE4, 0xFF, 0x74, 0x65, 0xF1, 0xC6, 0x80, 0xD3, -+0x12, 0x26, 0x1E, 0x90, 0xA3, 0x95, 0xF1, 0x56, 0x90, 0xA3, 0x96, 0xF0, 0x22, 0xE4, 0xFD, 0xF1, -+0x18, 0x12, 0x77, 0xE1, 0x90, 0xA2, 0xFD, 0x02, 0x27, 0x48, 0x12, 0x63, 0x3C, 0x12, 0x67, 0x88, -+0x90, 0xA2, 0xEA, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x5D, 0xF1, 0xC6, -+0xFE, 0xF6, 0x74, 0x30, 0x80, 0xA1, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0x22, 0xEF, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x26, 0x37, 0x8B, 0x40, 0x8A, 0x41, -+0x89, 0x42, 0x22, 0xF0, 0x90, 0x00, 0x06, 0x02, 0x26, 0x37, 0xF1, 0x57, 0xF5, 0x0E, 0x12, 0x4F, -+0x61, 0xF5, 0x0F, 0x12, 0x26, 0x1E, 0xF5, 0x10, 0x90, 0xA1, 0x2A, 0xF0, 0xE5, 0x0E, 0x60, 0x06, -+0xFD, 0xAF, 0x0F, 0x12, 0x55, 0xCE, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x77, -+0xF7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xCC, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA4, 0xCB, 0xEF, 0xF0, -+0xA3, 0xA3, 0xE0, 0xFD, 0x11, 0x07, 0x90, 0xA4, 0xD6, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xCE, 0x12, -+0x4A, 0x12, 0x12, 0x27, 0x15, 0x90, 0xA4, 0xD6, 0x12, 0x67, 0x78, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0xA4, 0xCE, 0x12, 0x4A, 0x12, 0x90, 0xA4, 0xD2, 0x12, 0x67, 0x78, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x4A, 0x05, 0x90, 0xA4, 0xDA, 0x12, 0x27, 0x48, -+0x90, 0xA4, 0xCC, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0xA4, 0xDA, 0x12, 0x4A, 0x12, 0x90, 0xAC, -+0x96, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xCB, 0xE0, 0xFF, 0xD0, 0x05, 0x12, 0x39, 0xBA, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x4C, 0xED, 0xF0, 0xA3, -+0xEB, 0xF0, 0x90, 0xA5, 0x4B, 0xEF, 0xF0, 0x90, 0xA5, 0x4E, 0xE0, 0xFD, 0x71, 0x9C, 0x90, 0xA5, -+0x4B, 0xE0, 0xC3, 0x94, 0x0E, 0x50, 0x3F, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, -+0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x12, 0xD4, 0x00, 0x00, 0x71, 0x81, 0x90, 0xA4, 0xCE, -+0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA4, 0xD2, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x00, 0x51, 0xE3, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA4, 0xD2, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x00, 0x00, 0x41, 0x11, 0x71, 0x92, 0x50, 0x1B, 0xEF, 0x94, 0x30, 0x50, 0x16, 0x90, -+0xA4, 0xE0, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x09, -+0x28, 0x00, 0x00, 0x80, 0x64, 0x90, 0xA5, 0x4B, 0xE0, 0xFF, 0x74, 0x32, 0xD3, 0x9F, 0x50, 0x1B, -+0xEF, 0x94, 0x40, 0x50, 0x16, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, -+0xA4, 0xE4, 0x12, 0x27, 0x54, 0x08, 0xA6, 0x00, 0x00, 0x80, 0x3E, 0x71, 0x88, 0x50, 0x1B, 0xEF, -+0x94, 0x74, 0x50, 0x16, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA4, -+0xE4, 0x12, 0x27, 0x54, 0x08, 0xA4, 0x00, 0x00, 0x80, 0x1F, 0x90, 0xA5, 0x4B, 0xE0, 0xFF, 0x74, -+0x76, 0xD3, 0x9F, 0x50, 0x16, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, -+0xA4, 0xE4, 0x12, 0x27, 0x54, 0x08, 0x24, 0x00, 0x00, 0x71, 0x81, 0x71, 0x92, 0x50, 0x2E, 0xEF, -+0x94, 0x40, 0x50, 0x29, 0x90, 0xA4, 0xCE, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA4, -+0xD2, 0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0x51, 0xE3, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, -+0x00, 0x90, 0xA4, 0xD2, 0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0x80, 0x64, 0x71, 0x88, 0x50, -+0x2E, 0xEF, 0x94, 0x8C, 0x50, 0x29, 0x90, 0xA4, 0xCE, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, -+0x90, 0xA4, 0xD2, 0x12, 0x27, 0x54, 0x00, 0x03, 0x01, 0x00, 0x51, 0xE3, 0x12, 0x27, 0x54, 0x00, -+0x07, 0x03, 0x00, 0x90, 0xA4, 0xD2, 0x12, 0x27, 0x54, 0x00, 0x03, 0x01, 0x00, 0x80, 0x32, 0x90, -+0xA5, 0x4B, 0xE0, 0xFF, 0x74, 0x8C, 0xC3, 0x9F, 0x50, 0x29, 0x90, 0xA4, 0xCE, 0x12, 0x27, 0x54, -+0x00, 0x07, 0x03, 0x00, 0x90, 0xA4, 0xD2, 0x12, 0x27, 0x54, 0x00, 0x05, 0x01, 0x00, 0x51, 0xE3, -+0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA4, 0xD2, 0x12, 0x27, 0x54, 0x00, 0x05, 0x01, -+0x00, 0x11, 0x16, 0x90, 0xA5, 0x4B, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x91, 0x32, 0x90, 0xA5, 0x4C, -+0xE0, 0x64, 0x02, 0x70, 0x51, 0x90, 0xA5, 0x4B, 0xE0, 0xFF, 0xD3, 0x94, 0x30, 0x50, 0x05, 0x75, -+0x7B, 0x2A, 0x80, 0x5E, 0xEF, 0xD3, 0x94, 0x40, 0x50, 0x05, 0x75, 0x7B, 0x3A, 0x80, 0x53, 0xEF, -+0xD3, 0x94, 0x70, 0x50, 0x05, 0x75, 0x7B, 0x6A, 0x80, 0x48, 0xEF, 0xD3, 0x94, 0x80, 0x50, 0x05, -+0x75, 0x7B, 0x7A, 0x80, 0x3D, 0xEF, 0xD3, 0x94, 0x90, 0x50, 0x05, 0x75, 0x7B, 0x8A, 0x80, 0x32, -+0xEF, 0xD3, 0x94, 0xA1, 0x50, 0x05, 0x75, 0x7B, 0x9B, 0x80, 0x27, 0xEF, 0xD3, 0x94, 0xB1, 0x50, -+0x21, 0x75, 0x7B, 0xAB, 0x80, 0x1C, 0x90, 0xA5, 0x4C, 0xE0, 0x64, 0x01, 0x70, 0x2D, 0xA3, 0xE0, -+0x90, 0xA5, 0x4B, 0xB4, 0x01, 0x07, 0xE0, 0x24, 0x02, 0xF5, 0x7B, 0x80, 0x05, 0xE0, 0x24, 0xFE, -+0xF5, 0x7B, 0x90, 0xA4, 0xCE, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x7B, 0x51, 0xD9, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x7B, 0x80, 0x1D, 0x90, 0xA4, 0xCE, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA5, 0x4B, 0xE0, 0xFF, 0x51, 0xD9, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0xFF, 0x90, 0xA5, 0x4B, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA4, 0xD2, 0x12, -+0x27, 0x48, 0x11, 0x16, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA4, 0xD2, -+0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x11, 0x1C, 0x90, 0xA4, 0xCE, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x14, 0x60, 0x30, 0x14, 0x60, 0x56, 0x24, 0x02, 0x70, -+0x7B, 0x90, 0xA4, 0xCE, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, 0xD2, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x0C, 0x00, 0x51, 0xE3, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, -+0xD2, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x80, 0x50, 0x90, 0xA4, 0xCE, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, 0xD2, 0x12, 0x27, 0x54, 0x00, 0x00, 0x04, 0x00, 0x51, 0xE3, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, 0xD2, 0x12, 0x27, 0x54, 0x00, 0x00, 0x04, -+0x00, 0x80, 0x27, 0x90, 0xA4, 0xCE, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, 0xD2, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x51, 0xE3, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, -+0x90, 0xA4, 0xD2, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x11, 0x16, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x7F, 0x60, 0x7E, 0x08, 0x02, 0x64, 0x33, 0x90, 0xA5, 0x4B, 0xE0, 0xFF, 0x74, 0x64, 0xD3, -+0x9F, 0x22, 0x90, 0xA5, 0x4B, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x22, 0x90, 0xA5, 0x7F, 0xED, -+0xF0, 0x90, 0xA5, 0x7E, 0xEF, 0xF0, 0xD3, 0x94, 0x0E, 0x50, 0x15, 0x71, 0xDB, 0xEF, 0x60, 0x2A, -+0x71, 0xDB, 0xEF, 0x64, 0x01, 0x70, 0x23, 0x90, 0xA5, 0x7F, 0xE0, 0xFD, 0xE4, 0xFF, 0x80, 0x15, -+0x90, 0xA5, 0x7E, 0xE0, 0xD3, 0x94, 0x0E, 0x40, 0x11, 0x71, 0xDB, 0xEF, 0x70, 0x0A, 0x90, 0xA5, -+0x7F, 0xE0, 0xFD, 0x7F, 0x01, 0x02, 0x66, 0x6B, 0x71, 0xDB, 0x22, 0x90, 0x04, 0x54, 0xE0, 0x7F, -+0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0xFE, 0x13, 0x13, 0x54, 0x07, 0xFB, 0x90, 0xA5, 0x4F, -+0x12, 0x5F, 0x8F, 0xE4, 0xFE, 0x7D, 0x18, 0xFF, 0x12, 0x3A, 0xA9, 0x90, 0xA5, 0x52, 0xEF, 0xF0, -+0x90, 0xA5, 0x4F, 0xE0, 0xFF, 0xB1, 0x58, 0x90, 0xA5, 0x4F, 0xB1, 0xAF, 0xB1, 0xB8, 0xAE, 0x07, -+0x90, 0x04, 0x83, 0xEE, 0xF0, 0x90, 0xA5, 0x4F, 0xE0, 0xFF, 0xAD, 0x06, 0x12, 0x64, 0x92, 0x90, -+0xA5, 0x52, 0xE0, 0xFF, 0x90, 0xA5, 0x4F, 0xE0, 0xFD, 0x91, 0x32, 0x90, 0xA5, 0x4F, 0xE0, 0xFF, -+0x41, 0xEF, 0x90, 0xA5, 0x7C, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x00, 0xF1, 0xE0, 0x54, 0xF0, -+0x64, 0x20, 0x60, 0x02, 0x81, 0xFE, 0x90, 0xA5, 0x7D, 0xE0, 0xB4, 0x01, 0x1D, 0x90, 0xA5, 0x7C, -+0xE0, 0xB4, 0x0B, 0x16, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, -+0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x80, 0x14, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x08, 0x00, 0xB1, 0x49, -+0x90, 0xA5, 0x7D, 0xE0, 0x70, 0x20, 0xB1, 0x50, 0x60, 0x04, 0xEF, 0xB4, 0x0E, 0x18, 0x90, 0xA4, -+0xE0, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x03, 0x00, 0xB1, 0x49, 0x80, 0x0E, 0x90, 0xA5, 0x7D, 0xE0, 0xB4, 0x01, 0x1D, 0x90, 0xA5, 0x7C, -+0xE0, 0xB4, 0x0B, 0x16, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, 0x00, 0x90, 0xA4, -+0xE4, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, 0x00, 0x80, 0x30, 0x90, 0xA5, 0x7D, 0xE0, 0x64, 0x02, -+0x60, 0x76, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0x00, 0x90, 0xA4, 0xE4, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x02, 0x00, 0x12, 0x66, 0x61, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, 0x00, -+0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xC4, 0x80, 0x45, 0x90, 0xA5, -+0x7D, 0xE0, 0x70, 0x20, 0xB1, 0x50, 0x60, 0x04, 0xEF, 0xB4, 0x0E, 0x18, 0x90, 0xA4, 0xE0, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x03, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0x00, -+0x7F, 0xAC, 0x80, 0x1F, 0x90, 0xA5, 0x7C, 0xE0, 0xD3, 0x94, 0x0E, 0x50, 0x1B, 0x90, 0xA4, 0xE0, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x02, -+0x00, 0x7F, 0xAC, 0x7E, 0x08, 0x12, 0x64, 0x33, 0x22, 0x7F, 0xAC, 0x7E, 0x08, 0x02, 0x64, 0x33, -+0x90, 0xA5, 0x7C, 0xE0, 0xFF, 0x64, 0x0D, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xA9, -+0x07, 0x90, 0x06, 0x69, 0xE0, 0xFE, 0x90, 0x06, 0x68, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, -+0x3E, 0xFE, 0xE9, 0x14, 0x60, 0x0F, 0x14, 0x60, 0x1E, 0x24, 0x02, 0x70, 0x25, 0xEE, 0x54, 0xFE, -+0xFE, 0xB1, 0xA7, 0x80, 0x1A, 0xEF, 0x44, 0x80, 0xFF, 0xEE, 0x54, 0xFE, 0xFC, 0x90, 0x06, 0x68, -+0xEF, 0xF0, 0xEC, 0xA3, 0xF0, 0x80, 0x0B, 0xEE, 0x44, 0x01, 0xFC, 0xB1, 0xA7, 0xAE, 0x04, 0xEE, -+0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x54, 0x7F, 0x90, 0x06, 0x68, 0xF0, 0x22, 0xE0, -+0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, -+0xFE, 0xFC, 0xEF, 0x64, 0x02, 0x70, 0x40, 0xED, 0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, 0x06, 0xED, -+0xB4, 0x02, 0x02, 0x7E, 0x09, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x04, 0x80, -+0x38, 0xEB, 0xB4, 0x02, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, 0xB4, 0x01, -+0x08, 0xED, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, 0xED, 0x64, -+0x02, 0x70, 0x16, 0x7C, 0x03, 0x80, 0x12, 0xEF, 0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, 0x04, 0x7C, -+0x01, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7C, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4C, -+0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, -+0x05, 0x90, 0xA5, 0x24, 0x12, 0x4A, 0x12, 0x90, 0xAC, 0x9C, 0x12, 0x27, 0x48, 0xD0, 0x05, 0xD0, -+0x07, 0x12, 0x32, 0x65, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, -+0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x49, 0xF0, 0x74, 0x86, 0xA3, 0xF0, -+0xD1, 0x98, 0x74, 0x49, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x86, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, -+0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, -+0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x53, 0xE4, 0xFD, -+0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x51, 0x52, 0x53, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x54, 0x7D, -+0x01, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x52, 0x52, 0x54, 0xAB, 0x53, 0xE4, 0xFD, 0x7F, 0x01, -+0x12, 0x39, 0x04, 0xAB, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x02, 0x39, 0x04, 0xC0, 0xE0, 0xC0, 0xF0, -+0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, -+0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xCC, 0xF0, 0x74, -+0x86, 0xA3, 0xF0, 0xF1, 0x1B, 0x74, 0xCC, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x86, 0xA3, 0xF0, -+0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x00, 0x54, 0xE0, 0x55, -+0x55, 0xF5, 0x59, 0xA3, 0xE0, 0x55, 0x56, 0xF5, 0x5A, 0xA3, 0xE0, 0x55, 0x57, 0xF5, 0x5B, 0xA3, -+0xE0, 0x55, 0x58, 0xF5, 0x5C, 0xAD, 0x59, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0xAD, 0x5A, 0x7F, 0x55, -+0x12, 0x3A, 0x96, 0xAD, 0x5B, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0xAD, 0x5C, 0x7F, 0x57, 0x12, 0x3A, -+0x96, 0x53, 0x91, 0xEF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -+0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x55, 0xF0, 0x74, 0x87, 0xA3, 0xF0, 0x12, 0xA7, 0x76, 0xE5, -+0x61, 0x30, 0xE1, 0x03, 0x12, 0x97, 0xB2, 0xE5, 0x61, 0x30, 0xE4, 0x03, 0x12, 0x97, 0x31, 0xE5, -+0x61, 0x30, 0xE5, 0x03, 0x12, 0xA7, 0xD3, 0xE5, 0x63, 0x30, 0xE0, 0x03, 0x12, 0x70, 0xE6, 0xE5, -+0x63, 0x30, 0xE1, 0x03, 0x12, 0xA8, 0x0F, 0xE5, 0x63, 0x30, 0xE2, 0x03, 0x12, 0xA8, 0x69, 0xE5, -+0x63, 0x30, 0xE3, 0x03, 0x12, 0x8E, 0x79, 0xE5, 0x63, 0x30, 0xE4, 0x03, 0x12, 0x8E, 0x53, 0xE5, -+0x63, 0x30, 0xE5, 0x03, 0x12, 0x99, 0x49, 0xE5, 0x63, 0x30, 0xE6, 0x03, 0x12, 0x9F, 0x77, 0xE5, -+0x64, 0x30, 0xE1, 0x03, 0x12, 0xA8, 0x75, 0xE5, 0x64, 0x30, 0xE4, 0x03, 0x12, 0xA8, 0x7F, 0xE5, -+0x64, 0x30, 0xE5, 0x03, 0x12, 0x97, 0xAE, 0xE5, 0x64, 0x30, 0xE6, 0x03, 0x12, 0x97, 0xB0, 0x74, -+0x55, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x87, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, -+0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, -+0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -+0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x15, 0xF0, 0x74, 0x88, 0xA3, 0xF0, 0x12, 0xA7, 0xA3, 0xE5, -+0x69, 0x30, 0xE0, 0x11, 0x12, 0xAA, 0x30, 0xE5, 0x6B, 0x30, 0xE2, 0x09, 0x71, 0xD6, 0x90, 0x07, -+0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, 0x69, 0x30, 0xE1, 0x02, 0x91, 0x4B, 0xE5, 0x69, 0x30, 0xE2, -+0x02, 0x91, 0x56, 0xE5, 0x69, 0x30, 0xE3, 0x02, 0x11, 0xCD, 0xE5, 0x69, 0x30, 0xE4, 0x02, 0x11, -+0xFC, 0xE5, 0x69, 0x30, 0xE5, 0x02, 0x51, 0x32, 0xE5, 0x6A, 0x30, 0xE0, 0x02, 0xF1, 0x4C, 0xE5, -+0x6B, 0x30, 0xE4, 0x03, 0x12, 0xAA, 0x35, 0xE5, 0x6C, 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, 0x97, -+0x35, 0xE5, 0x6C, 0x30, 0xE4, 0x02, 0x91, 0x08, 0xE5, 0x6C, 0x30, 0xE5, 0x02, 0x51, 0x03, 0xE5, -+0x6C, 0x30, 0xE6, 0x03, 0x12, 0x99, 0xF6, 0x74, 0x15, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x88, -+0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x12, 0x58, 0xB2, -+0xD3, 0x90, 0xA3, 0xE6, 0xE0, 0x94, 0x00, 0x90, 0xA3, 0xE5, 0xE0, 0x94, 0x00, 0x40, 0x17, 0xE0, -+0xFC, 0xA3, 0xE0, 0xFD, 0xEC, 0x90, 0xA5, 0x20, 0xF0, 0xA3, 0xED, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, -+0x5C, 0x7E, 0x01, 0x02, 0x70, 0x20, 0x90, 0x01, 0x5F, 0xE4, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x7D, 0x02, 0x90, 0xA3, 0x53, 0xE0, 0x20, 0xE0, 0x02, 0x21, 0xF4, 0x90, 0xA3, -+0x57, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x02, 0x21, 0xF4, 0xE4, 0xFF, 0x71, 0x4A, 0x90, -+0xA3, 0x57, 0xE0, 0x30, 0xE0, 0x03, 0x0F, 0x80, 0x32, 0x90, 0xA3, 0x53, 0x12, 0x5F, 0xCB, 0x30, -+0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x25, 0x12, 0xB5, 0xF8, 0x30, 0xE0, 0x10, 0xEF, 0x13, 0x13, 0x54, -+0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x09, 0x80, 0x13, 0x7F, 0x03, 0x80, 0x0F, 0x90, 0xA3, 0x56, 0xE0, -+0xC3, 0x13, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x09, 0x12, 0x76, 0x89, 0x90, 0xA3, -+0x53, 0x12, 0x4F, 0x7F, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA4, 0xAC, 0xF0, 0x80, 0x02, 0x51, 0x45, -+0x12, 0xB5, 0x43, 0x20, 0xE0, 0x0C, 0x90, 0xA3, 0x95, 0xE0, 0x60, 0x04, 0xE4, 0xFD, 0x80, 0x02, -+0x7D, 0x01, 0xAF, 0x05, 0x90, 0xA4, 0xAC, 0xE0, 0xFD, 0x12, 0x72, 0xB5, 0x90, 0xA3, 0x78, 0xE0, -+0x54, 0xEF, 0xF0, 0x31, 0xF9, 0x20, 0xE0, 0x26, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x12, 0x12, -+0xB5, 0x62, 0x60, 0x04, 0x7D, 0x01, 0x80, 0x11, 0x12, 0x67, 0x98, 0x7D, 0x01, 0x7F, 0x0C, 0x80, -+0x0A, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x07, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x60, 0x4D, 0x90, 0xA3, -+0x52, 0xE0, 0x60, 0x06, 0x7D, 0x04, 0x7F, 0x6F, 0x80, 0x13, 0x31, 0xF9, 0x20, 0xE0, 0x0B, 0xEF, -+0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x99, 0xC0, 0xE4, 0xFD, 0xFF, 0x12, 0x59, 0x62, -+0x12, 0x4F, 0x7C, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0x9C, 0x9C, 0x12, 0x77, 0xE8, 0x30, 0xE0, -+0x03, 0x12, 0xB5, 0x34, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA3, 0x53, 0xE0, 0xFF, 0xC4, 0x13, -+0x54, 0x07, 0x22, 0x90, 0xA2, 0xEA, 0x12, 0x99, 0xEE, 0x30, 0xE0, 0x25, 0xEF, 0x54, 0xBF, 0x12, -+0x9E, 0x20, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x90, -+0xA3, 0x59, 0x31, 0xFC, 0x30, 0xE0, 0x07, 0x7D, 0x01, 0x7F, 0x0C, 0x02, 0x60, 0x4D, 0x12, 0x60, -+0x40, 0x22, 0x90, 0xA3, 0xB6, 0xE0, 0x30, 0xE0, 0x0B, 0x12, 0x7F, 0x86, 0xE4, 0x90, 0xA3, 0xB9, -+0xF0, 0x12, 0x6F, 0xF1, 0x22, 0x90, 0xA4, 0xAC, 0x74, 0x01, 0xF0, 0x22, 0xAD, 0x07, 0xED, 0x70, -+0x19, 0x51, 0xD0, 0x70, 0x02, 0x80, 0x17, 0xBC, 0x01, 0x02, 0x80, 0x19, 0x51, 0xD0, 0xBC, 0x02, -+0x02, 0x80, 0x1B, 0xEC, 0x64, 0x03, 0x70, 0x22, 0x80, 0x1B, 0x51, 0xD8, 0x70, 0x04, 0x7F, 0x01, -+0x80, 0x15, 0xBC, 0x01, 0x04, 0x7F, 0x03, 0x80, 0x0E, 0x51, 0xD8, 0xBC, 0x02, 0x04, 0x7F, 0x09, -+0x80, 0x05, 0xBC, 0x03, 0x05, 0x7F, 0x0D, 0x12, 0x76, 0x89, 0x90, 0xA3, 0xA2, 0xE0, 0xC4, 0x13, -+0x54, 0x07, 0x30, 0xE0, 0x3A, 0xED, 0x70, 0x1B, 0xA3, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, -+0x07, 0xE4, 0x90, 0xA4, 0xAC, 0xF0, 0x80, 0x02, 0x51, 0x45, 0x90, 0xA4, 0xAC, 0xE0, 0xFD, 0xE4, -+0xFF, 0x80, 0x19, 0x90, 0xA3, 0xA3, 0x12, 0x5F, 0xCB, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA4, 0xAC, -+0xF0, 0x80, 0x02, 0x51, 0x45, 0x90, 0xA4, 0xAC, 0xE0, 0xFD, 0x7F, 0x01, 0x12, 0x72, 0xB5, 0x22, -+0x90, 0xA3, 0xA3, 0xE0, 0x54, 0x03, 0xFC, 0x22, 0x90, 0xA3, 0xA3, 0xE0, 0xC4, 0x54, 0x03, 0xFC, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0xA9, 0xE0, 0xB4, 0x01, 0x02, 0x80, -+0x41, 0x90, 0xA3, 0xA9, 0xE0, 0xB4, 0x02, 0x10, 0x71, 0xAF, 0x7F, 0x01, 0x71, 0x4A, 0x51, 0x4C, -+0x90, 0xA3, 0xA9, 0x74, 0x03, 0xF0, 0x80, 0x3D, 0x90, 0xA3, 0xA9, 0xE0, 0x64, 0x03, 0x70, 0x1B, -+0x90, 0xA3, 0xAC, 0x71, 0xB2, 0xE4, 0xFF, 0x71, 0x4A, 0x51, 0x4C, 0x71, 0xA5, 0xE4, 0xFB, 0xFD, -+0x12, 0x5D, 0xEF, 0x90, 0xA3, 0xA9, 0x74, 0x04, 0xF0, 0x80, 0x1A, 0x90, 0xA3, 0xA9, 0xE0, 0xB4, -+0x04, 0x13, 0x71, 0xA5, 0x7B, 0x01, 0x7D, 0x01, 0x12, 0x5D, 0xEF, 0x90, 0xA3, 0xA9, 0x74, 0x02, -+0xF0, 0x90, 0xA3, 0xA7, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0xEF, 0x64, 0x03, 0x70, 0x0E, 0x90, 0xA3, 0x56, 0x12, 0x5F, 0xCB, 0x90, 0x06, 0xCC, 0x30, -+0xE0, 0x3A, 0x80, 0x2D, 0x90, 0xA3, 0x57, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x10, 0xEF, 0x90, -+0x06, 0xCC, 0x70, 0x06, 0xE0, 0x54, 0xFC, 0xF0, 0x80, 0x04, 0xE0, 0x44, 0x03, 0xF0, 0x90, 0xA3, -+0xA2, 0xE0, 0x30, 0xE0, 0x1B, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x0E, 0xEF, 0x90, 0x06, 0xCC, 0x70, -+0x06, 0xE0, 0x54, 0xFC, 0xF0, 0x80, 0x09, 0x80, 0x03, 0x90, 0x06, 0xCC, 0xE0, 0x44, 0x03, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA3, 0xA2, 0xE0, 0xC3, 0x13, 0x54, 0x03, 0xFF, 0x22, 0x90, -+0xA3, 0xAE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xAD, 0x07, 0xEE, 0xFF, 0x90, 0x01, 0x53, 0xE4, 0xF0, -+0x8F, 0x35, 0xAF, 0x05, 0x8F, 0x36, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x39, 0x62, 0x90, -+0x01, 0x53, 0x74, 0x05, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0xA2, -+0xE0, 0x30, 0xE0, 0x1F, 0x90, 0xA3, 0xA7, 0xE0, 0xB4, 0x01, 0x0C, 0xA3, 0xE0, 0xB4, 0x01, 0x13, -+0x74, 0x02, 0xF0, 0x71, 0xAF, 0x80, 0x0C, 0x90, 0xA3, 0xA7, 0xE0, 0xB4, 0x02, 0x05, 0x74, 0x03, -+0xF0, 0x51, 0xE1, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x91, 0x0F, 0x91, 0x73, 0x02, 0x70, 0xE8, 0xE4, -+0x90, 0xA4, 0xAC, 0xF0, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x30, 0xD1, 0x0F, 0x70, 0x2C, 0xD1, 0x2A, -+0xF0, 0x51, 0x45, 0xE4, 0x90, 0xA2, 0xF6, 0xF0, 0x04, 0x60, 0x1F, 0x90, 0xA2, 0xF3, 0xE0, 0x44, -+0x10, 0x12, 0xB1, 0xC0, 0x90, 0xA2, 0xF7, 0xE0, 0x90, 0xA5, 0x21, 0x12, 0x70, 0x18, 0x90, 0xA2, -+0xF2, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x60, 0x49, 0xD1, 0xC8, 0x22, 0x90, 0xA2, 0xEF, 0xE0, 0x60, -+0x02, 0xB1, 0xA6, 0x02, 0x5F, 0x26, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x10, 0x90, 0x06, 0x92, 0xE0, -+0x30, 0xE1, 0x03, 0x02, 0xB1, 0x8A, 0x12, 0x7F, 0xB0, 0x12, 0x60, 0x40, 0x22, 0x7D, 0x01, 0x7F, -+0x02, 0x91, 0x77, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, -+0x30, 0x02, 0x7F, 0x67, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, -+0xFF, 0x91, 0x77, 0x7D, 0x02, 0x7F, 0x03, 0x91, 0x77, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0xD1, -+0x3D, 0xE4, 0xFF, 0x12, 0x7E, 0xF3, 0xBF, 0x01, 0x10, 0xB1, 0x9E, 0x90, 0xA2, 0xF2, 0xE0, 0x20, -+0xE2, 0x09, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x60, 0x4D, 0xD1, 0x22, 0x22, 0x90, 0x05, 0x62, 0xE0, -+0xFE, 0x90, 0x05, 0x61, 0xE0, 0xFD, 0xED, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, -+0xFF, 0x90, 0xA4, 0x9C, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xD1, 0x0F, 0x60, 0x02, 0xA1, 0x82, 0x90, -+0xA2, 0xEF, 0xE0, 0x70, 0x02, 0xA1, 0x82, 0xB1, 0x83, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, -+0xE0, 0x90, 0xA2, 0xF6, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0xA2, 0xF5, 0xF0, 0xA3, 0xE0, 0xFF, -+0x70, 0x08, 0x90, 0xA2, 0xF5, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0xA2, 0xF6, 0xEF, 0xF0, 0xE4, -+0x90, 0xA2, 0xF8, 0xD1, 0x3D, 0xD1, 0x6D, 0xD1, 0x4B, 0x54, 0xEF, 0xF0, 0x90, 0xA2, 0xED, 0xE0, -+0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x03, 0x12, 0x99, 0x63, 0xD1, 0x32, 0x30, -+0xE0, 0x4E, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x21, 0xB1, 0x8B, 0x6F, 0x70, 0x40, -+0x90, 0xA2, 0xEB, 0xE0, 0x44, 0x40, 0xF0, 0xD1, 0x2A, 0xB1, 0x93, 0x12, 0x7F, 0x5D, 0x12, 0xA8, -+0x62, 0x12, 0x7F, 0xB8, 0x90, 0xA2, 0xF6, 0xE0, 0x14, 0xF0, 0x80, 0x24, 0xB1, 0x83, 0x64, 0x01, -+0x70, 0x1E, 0xB1, 0x8B, 0xFE, 0x6F, 0x60, 0x18, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, -+0x0F, 0xD1, 0x18, 0x30, 0xE0, 0x0A, 0xEF, 0x54, 0xBF, 0xB1, 0x93, 0x12, 0x7F, 0x8A, 0x91, 0x6D, -+0xD1, 0x22, 0x22, 0x90, 0xA2, 0xED, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0xA2, 0xF5, 0xE0, 0xFF, -+0xA3, 0xE0, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x90, 0xA2, -+0xEB, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0xD1, 0x32, 0x30, 0xE0, 0x0C, 0xEF, 0xC4, 0x13, 0x13, 0x54, -+0x03, 0x30, 0xE0, 0x03, 0x12, 0x7F, 0xB8, 0x90, 0xA2, 0xEA, 0xD1, 0x1B, 0x30, 0xE0, 0x09, 0xEF, -+0xD1, 0x48, 0x54, 0x07, 0x70, 0x48, 0x80, 0x43, 0x90, 0xA2, 0xF8, 0xE0, 0x04, 0xF0, 0x90, 0xA2, -+0xF3, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0xA3, 0x4C, 0xE0, 0xFF, 0x90, 0xA2, 0xF8, 0xE0, 0xD3, 0x9F, -+0x40, 0x29, 0xD1, 0x0F, 0x70, 0x28, 0x12, 0x99, 0x42, 0x70, 0x02, 0x80, 0xB1, 0x90, 0xA2, 0xF9, -+0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x09, 0xB1, 0x9E, 0xE4, 0x90, 0xA2, 0xF9, 0xF0, -+0x80, 0x03, 0x12, 0x67, 0xCD, 0xE4, 0x90, 0xA2, 0xF8, 0xF0, 0x22, 0x12, 0x60, 0x40, 0x22, 0xE4, -+0xFF, 0x12, 0x7E, 0xF3, 0xEF, 0x64, 0x01, 0x22, 0x90, 0xA2, 0xEB, 0xE0, 0xFF, 0x13, 0x13, 0x54, -+0x3F, 0x22, 0x90, 0xA2, 0xEB, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0xA2, 0xF5, 0xE0, 0x90, 0x05, -+0x73, 0x22, 0x90, 0xA2, 0xEB, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xF0, 0x90, 0xA2, -+0xFB, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0xA2, 0xF3, 0xE0, 0x54, -+0xFD, 0xF0, 0x22, 0xD1, 0x0F, 0x70, 0x15, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x0F, 0xD1, 0x6D, 0x90, -+0xA2, 0xEA, 0xE0, 0xD1, 0x48, 0x54, 0x07, 0x70, 0x03, 0x12, 0x60, 0x40, 0x22, 0x90, 0x01, 0x57, -+0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x22, 0xD1, 0x0F, 0x70, 0x0E, 0x90, 0xA2, 0xEF, -+0xE0, 0x60, 0x08, 0xD1, 0x6D, 0x12, 0x9E, 0x29, 0x12, 0x70, 0x18, 0x22, 0xEF, 0x70, 0x37, 0x7D, -+0x78, 0x7F, 0x02, 0x12, 0x7F, 0xBC, 0x7D, 0x02, 0x7F, 0x03, 0x12, 0x7F, 0xBC, 0x7D, 0xC8, 0x7F, -+0x02, 0x12, 0x7F, 0x8A, 0xD1, 0x6D, 0xE4, 0xFF, 0x12, 0x7E, 0xF3, 0xEF, 0x70, 0x0B, 0x12, 0x7F, -+0xAA, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x80, 0x07, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x60, 0x4D, -+0x12, 0x7F, 0xB0, 0x02, 0xB6, 0x2E, 0x81, 0x84, 0x12, 0xA0, 0x0C, 0x30, 0xE0, 0x1E, 0x12, 0x7F, -+0xCE, 0x20, 0xE0, 0x18, 0xD1, 0xEE, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x0C, 0x12, 0xA0, 0x14, -+0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, 0x7F, 0x09, 0x12, 0x76, 0x89, 0x22, 0xF0, 0x90, 0xA3, -+0x56, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0xA2, 0xEA, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA2, -+0xF8, 0xF0, 0xA3, 0xF0, 0x90, 0xA2, 0xF3, 0xF0, 0x90, 0xA2, 0xEB, 0xE0, 0x54, 0xF7, 0xF0, 0x54, -+0xBF, 0xF0, 0x91, 0x6D, 0x7D, 0x10, 0x7F, 0x03, 0x02, 0x7F, 0x8A, 0x90, 0xA4, 0x85, 0x12, 0x4A, -+0x3F, 0xD1, 0xF6, 0x90, 0xA2, 0xEF, 0xE0, 0xFF, 0xD1, 0x8C, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x1B, -+0x90, 0xA4, 0x85, 0x12, 0x4A, 0x36, 0x12, 0x7F, 0x57, 0x54, 0x0F, 0xFF, 0x12, 0x4F, 0x61, 0xFD, -+0x12, 0xB2, 0x46, 0x12, 0xB5, 0x07, 0x74, 0x01, 0xF0, 0xF1, 0x80, 0x22, 0x12, 0xAA, 0xD4, 0x90, -+0xA4, 0xAC, 0xEF, 0xF0, 0x30, 0xE0, 0x05, 0x7D, 0x01, 0xE4, 0x80, 0x02, 0xE4, 0xFD, 0xFF, 0x12, -+0x62, 0x4F, 0x90, 0xA4, 0xAC, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, -+0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x12, 0xB5, 0x07, 0x74, 0x02, 0xF0, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0x90, 0xA2, 0xEB, 0x12, 0x4F, 0x7F, 0x30, -+0xE0, 0x03, 0x02, 0x90, 0x41, 0x90, 0xA2, 0xEA, 0xE0, 0x30, 0xE0, 0x16, 0x90, 0xA3, 0x0C, 0xE0, -+0x24, 0x04, 0x90, 0xA3, 0x04, 0xF0, 0x90, 0xA3, 0x0C, 0xE0, 0x24, 0x03, 0x90, 0xA3, 0x03, 0xF0, -+0x80, 0x0D, 0x90, 0xA3, 0x04, 0x74, 0x02, 0xF0, 0x90, 0xA3, 0x03, 0x14, 0xF0, 0x0B, 0x0B, 0x90, -+0xA3, 0x03, 0xE0, 0xFA, 0x90, 0xA3, 0x02, 0xE0, 0xD3, 0x9A, 0x50, 0x0E, 0x90, 0xA2, 0xF7, 0xEB, -+0xF0, 0x90, 0xA3, 0x04, 0xE0, 0xC3, 0x9D, 0x2C, 0x80, 0x11, 0xC3, 0xED, 0x9A, 0x2B, 0x90, 0xA2, -+0xF7, 0xF0, 0x90, 0xA3, 0x03, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0xA3, 0x07, 0xF0, 0x90, -+0xA3, 0x04, 0xE0, 0xFF, 0x24, 0x0A, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0xA3, 0x07, 0x12, 0x90, 0x4D, -+0x40, 0x04, 0xEF, 0x24, 0x0A, 0xF0, 0x90, 0xA3, 0x07, 0xE0, 0xFF, 0x24, 0x23, 0xFD, 0xE4, 0x33, -+0xFC, 0x90, 0xA2, 0xF7, 0x11, 0x4D, 0x40, 0x04, 0xEF, 0x24, 0x23, 0xF0, 0x90, 0xA3, 0x07, 0xE0, -+0xFF, 0x7E, 0x00, 0x90, 0xA2, 0xFB, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, 0xE0, 0x6F, -+0x70, 0x01, 0xE4, 0x60, 0x03, 0x12, 0x8E, 0x3E, 0x90, 0xA2, 0xEC, 0xE0, 0x54, 0xFE, 0xF0, 0x80, -+0x07, 0x90, 0xA2, 0xEC, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xD3, 0x9D, -+0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, -+0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x58, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x90, -+0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, -+0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x71, 0xEE, 0x7F, 0x04, 0x90, 0xA5, 0x82, -+0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x48, 0x07, 0x90, 0xA1, 0x23, 0xE0, 0xFF, 0x90, 0xA5, 0x82, 0xE0, -+0xFE, 0xEF, 0x4E, 0x90, 0xA1, 0x23, 0xF0, 0x22, 0xFB, 0xAD, 0x75, 0xAF, 0x74, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xBE, 0xED, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, -+0xA4, 0xBB, 0xE0, 0x90, 0xA4, 0xC1, 0xF0, 0x90, 0xA4, 0xBC, 0x74, 0x0C, 0xF0, 0x90, 0xA4, 0xCA, -+0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0xBC, 0x11, 0x89, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xAD, 0x1C, 0xAF, 0x1A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x74, 0x8D, 0x75, 0x8B, -+0x76, 0xE4, 0x90, 0xA4, 0xF5, 0xF0, 0xE5, 0x74, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA4, 0xF0, -+0xF0, 0xE5, 0x74, 0x54, 0x07, 0x90, 0xA4, 0xF2, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x12, 0x6F, 0x43, -+0xE0, 0x90, 0xA4, 0xF3, 0x12, 0x57, 0x8D, 0xE0, 0x54, 0x7F, 0x90, 0xA4, 0xF6, 0xF0, 0x75, 0xF0, -+0x04, 0xE5, 0x74, 0x12, 0x56, 0xA1, 0xE0, 0x90, 0xA4, 0xF7, 0xF0, 0x71, 0xCD, 0xE5, 0x76, 0x70, -+0x3A, 0xE5, 0x74, 0x60, 0x05, 0xC3, 0x94, 0x04, 0x40, 0x07, 0xE4, 0x90, 0xA4, 0xBB, 0xF0, 0x11, -+0xA8, 0x90, 0xA4, 0xF1, 0xE0, 0xFF, 0x12, 0xA6, 0x49, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x93, 0xFD, -+0xEF, 0x12, 0x6F, 0xA8, 0x74, 0x01, 0x93, 0x2D, 0xFF, 0xE4, 0x93, 0x3C, 0xC3, 0x13, 0xFE, 0xEF, -+0x13, 0xFF, 0xE5, 0x74, 0xF1, 0x45, 0x12, 0x6F, 0xC3, 0x80, 0x14, 0xE5, 0x76, 0xB4, 0x01, 0x0F, -+0x90, 0xA1, 0x2A, 0xE0, 0x60, 0x09, 0x90, 0xA4, 0xBB, 0x74, 0x05, 0xF0, 0xE4, 0x11, 0xA8, 0x90, -+0xA4, 0xF6, 0xE0, 0xFF, 0x90, 0xA4, 0xF1, 0xE0, 0xFE, 0xD3, 0x9F, 0x40, 0x0B, 0xE5, 0x75, 0x54, -+0x80, 0xFD, 0xEF, 0x4D, 0xF5, 0x75, 0x80, 0x0C, 0x90, 0xA4, 0xF7, 0xE0, 0xFF, 0xEE, 0xC3, 0x9F, -+0x50, 0x02, 0x8F, 0x75, 0x71, 0xCD, 0xE5, 0x75, 0x54, 0x80, 0x90, 0xA4, 0xF4, 0xF0, 0xE5, 0x76, -+0x70, 0x29, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0x71, 0xA8, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, -+0x90, 0xA4, 0xF2, 0x71, 0xE6, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xD0, 0x82, 0xD0, -+0x83, 0xF0, 0x90, 0xA4, 0xF3, 0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x50, 0x74, 0x91, 0x25, 0x74, 0x12, -+0x55, 0x17, 0xE0, 0x90, 0x04, 0xCF, 0x30, 0xE0, 0x05, 0x74, 0x20, 0xF0, 0x80, 0x03, 0x74, 0x10, -+0xF0, 0x71, 0xA8, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA4, 0xF2, 0x71, 0xE6, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x74, 0x12, -+0x6F, 0x43, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0xA4, 0xF3, 0xF0, 0x90, 0xA4, 0xF1, 0xE0, 0x90, 0x43, -+0x9D, 0x93, 0xF1, 0xCD, 0x90, 0xA4, 0xF3, 0xF0, 0x44, 0x80, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x74, -+0x12, 0x6F, 0xBD, 0xE5, 0x75, 0xF0, 0xE5, 0x74, 0x70, 0x06, 0x90, 0x01, 0xC8, 0xE5, 0x75, 0xF0, -+0x90, 0xA4, 0xF3, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x74, 0x12, 0x6F, 0x43, 0xEF, 0xF0, 0x75, -+0xF0, 0x10, 0xE5, 0x74, 0x12, 0x6F, 0x71, 0xE0, 0x54, 0xFC, 0xFF, 0xE5, 0x77, 0x54, 0x03, 0x4F, -+0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x74, 0x12, 0x6F, 0x71, 0xEF, 0xF0, 0x7D, 0x01, 0xAF, 0x74, 0x12, -+0xA9, 0xB6, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xF5, 0x24, 0x90, 0xA2, 0xE4, 0xE0, 0xFF, 0xE5, -+0x24, 0xC3, 0x9F, 0x40, 0x02, 0x61, 0x8F, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0xAF, 0x24, 0x12, -+0x7E, 0xF3, 0xEF, 0x70, 0x02, 0x61, 0x8B, 0xE5, 0x24, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xF5, 0x25, -+0xE5, 0x24, 0x54, 0x07, 0xF5, 0x26, 0x74, 0x81, 0x25, 0x25, 0x71, 0xAE, 0xE0, 0xFD, 0x71, 0xC5, -+0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x61, 0x8B, -+0x75, 0xF0, 0x10, 0xE5, 0x24, 0x12, 0x6F, 0x43, 0xE0, 0x20, 0xE7, 0x02, 0x80, 0x10, 0x75, 0xF0, -+0x10, 0xE5, 0x24, 0x90, 0x81, 0x02, 0x12, 0x4A, 0x2A, 0xE0, 0xFF, 0x20, 0xE7, 0x09, 0x90, 0x01, -+0xC1, 0xE0, 0x44, 0x20, 0xF0, 0x61, 0x8B, 0x75, 0xF0, 0x04, 0xE5, 0x24, 0x12, 0x6F, 0x4E, 0xE0, -+0x54, 0x07, 0x44, 0x50, 0xF0, 0xEF, 0x30, 0xE6, 0x30, 0x71, 0x90, 0x71, 0xD6, 0x80, 0x02, 0xC3, -+0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x12, 0x6F, 0xBD, 0x71, 0xBD, -+0x12, 0x4D, 0xE3, 0x71, 0xB6, 0xE4, 0xFB, 0xAF, 0x24, 0x11, 0xE4, 0x75, 0xF0, 0x04, 0xE5, 0x24, -+0x12, 0x6F, 0x4E, 0xE0, 0x54, 0xF8, 0xF0, 0x80, 0x62, 0x71, 0x9C, 0xE0, 0x04, 0xF0, 0x71, 0x9C, -+0xE0, 0xD3, 0x94, 0x01, 0x40, 0x40, 0xAF, 0x24, 0xB1, 0x45, 0x71, 0x9C, 0xE4, 0xF0, 0x71, 0x90, -+0xE0, 0xFD, 0xFB, 0x7A, 0x00, 0x71, 0xC5, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0xF1, 0xBD, 0x70, 0x13, 0x71, 0x90, 0xAF, 0x26, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, -+0x33, 0xD8, 0xFC, 0x4D, 0xF0, 0x80, 0x24, 0x71, 0x90, 0x71, 0xD6, 0x80, 0x02, 0xC3, 0x33, 0xD8, -+0xFC, 0xF4, 0x5F, 0xF0, 0x80, 0x15, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x12, 0x6F, 0xBD, 0x71, 0xBD, -+0x12, 0x4D, 0xE3, 0x71, 0xB6, 0x7B, 0x01, 0xAF, 0x24, 0x11, 0xE4, 0x05, 0x24, 0x41, 0x7A, 0x22, -+0x74, 0x11, 0x25, 0x25, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0x22, 0x74, 0xA2, 0x25, 0x24, -+0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0x22, 0x90, 0xA4, 0xF0, 0xE0, 0x24, 0x81, 0xF5, 0x82, -+0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0x13, 0x13, 0x54, 0x03, 0xF5, 0x77, 0x22, 0xE0, 0xFD, 0x75, -+0xF0, 0x04, 0xE5, 0x24, 0x22, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x26, 0x08, 0x22, 0xE5, 0x75, 0x54, -+0x7F, 0x90, 0xA4, 0xF1, 0xF0, 0x22, 0xE0, 0xFF, 0xAE, 0x26, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, -+0x75, 0xF0, 0x03, 0x12, 0x4A, 0x2A, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0xCF, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, -+0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA2, 0xD0, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, -+0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x29, 0xC0, 0x01, -+0x90, 0xA2, 0xD0, 0xE0, 0x12, 0xB5, 0x92, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, -+0x7F, 0x0F, 0x12, 0x49, 0x59, 0x90, 0xA2, 0xD0, 0xF1, 0x2A, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, -+0x60, 0x05, 0xE4, 0x90, 0xA2, 0xD0, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0xA4, 0x97, -+0xF0, 0x90, 0xA4, 0x97, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x50, 0x5D, 0x74, 0x32, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0xFF, 0xD3, 0x94, 0x0A, 0x50, 0x02, 0x80, 0x02, 0x7F, 0x0A, -+0xAE, 0x07, 0xEF, 0x24, 0x02, 0x90, 0xA4, 0x96, 0xF0, 0x90, 0xA4, 0x88, 0x74, 0x0E, 0xF0, 0x90, -+0xA4, 0x8A, 0x74, 0x01, 0xF0, 0x91, 0xB9, 0x90, 0xA4, 0x8B, 0xF0, 0xE4, 0xFF, 0xEF, 0xC3, 0x9E, -+0x50, 0x16, 0x91, 0xB9, 0x2F, 0xF1, 0xD5, 0xE0, 0xFD, 0x74, 0x8C, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0xA4, 0xF5, 0x83, 0xED, 0xF0, 0x0F, 0x80, 0xE5, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x88, 0x11, 0x89, -+0x90, 0xA4, 0x97, 0xE0, 0x04, 0xF0, 0x80, 0x99, 0x22, 0x90, 0xA4, 0x97, 0xE0, 0x24, 0x2C, 0xF5, -+0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0xA4, 0x9C, 0xEF, 0xF0, 0x90, 0x04, 0x7E, -+0xE0, 0xF5, 0x25, 0xA3, 0xE0, 0xF5, 0x26, 0x65, 0x25, 0x60, 0x69, 0x90, 0xA4, 0x9D, 0x74, 0x03, -+0xF0, 0x90, 0xA4, 0xAB, 0x74, 0x08, 0xF0, 0xE5, 0x26, 0x04, 0x54, 0x0F, 0xF5, 0x27, 0xE4, 0xF5, -+0x24, 0xE5, 0x27, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, -+0xE5, 0x82, 0x25, 0x24, 0x12, 0x52, 0xCA, 0xE0, 0xFF, 0x74, 0x9F, 0x25, 0x24, 0xF5, 0x82, 0xE4, -+0x34, 0xA4, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x24, 0xE5, 0x24, 0xB4, 0x08, 0xD4, 0x7B, 0x01, 0x7A, -+0xA4, 0x79, 0x9D, 0x71, 0xEE, 0xE5, 0x26, 0x04, 0x54, 0x0F, 0xF5, 0x26, 0xB4, 0x0F, 0x03, 0xE4, -+0xF5, 0x26, 0x90, 0x04, 0x7F, 0xE5, 0x26, 0xF0, 0x90, 0xA4, 0x9C, 0xE0, 0x7F, 0x04, 0x70, 0x02, -+0xE1, 0x35, 0x11, 0x8D, 0x22, 0xAC, 0x07, 0x75, 0xF0, 0x04, 0xEC, 0x90, 0x96, 0x14, 0x12, 0x4A, -+0x2A, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0x57, 0x92, 0xE0, 0xFA, 0x74, 0x22, 0x2C, 0xB1, 0xFD, 0xE0, -+0x54, 0x7F, 0xFD, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0x6F, 0x4E, 0xE0, 0xFF, 0x54, 0xF8, 0xFE, 0xEF, -+0x04, 0x54, 0x07, 0x4E, 0xF0, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0x6F, 0x4E, 0xE0, 0xFF, 0x54, 0x07, -+0xD3, 0x94, 0x02, 0x40, 0x48, 0x74, 0xA2, 0x2C, 0x12, 0x6D, 0x81, 0xE0, 0xF4, 0x70, 0x3E, 0x75, -+0xF0, 0x04, 0xEC, 0x12, 0x6F, 0x4E, 0xEF, 0x54, 0xF8, 0xF0, 0x74, 0x11, 0x2C, 0x12, 0x6D, 0x66, -+0x54, 0x7F, 0xFF, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0xB5, 0x1D, 0x54, 0x80, 0x4F, 0xF0, 0x74, 0x11, -+0x2C, 0x12, 0x6D, 0x66, 0x25, 0xE0, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x24, 0x32, 0xFF, 0xE4, 0x3E, -+0xFE, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0x6F, 0x7C, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x22, 0x2C, -+0xF1, 0xC5, 0xE0, 0xFB, 0xF1, 0xB6, 0xFF, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0x4D, 0xE3, 0x54, 0xF3, -+0x4F, 0xF0, 0xED, 0xD3, 0x9A, 0x40, 0x02, 0xAD, 0x02, 0x74, 0x22, 0x2C, 0xB1, 0xFD, 0xE0, 0x54, -+0x80, 0x42, 0x05, 0xAF, 0x04, 0x8B, 0x77, 0xE4, 0xFB, 0x01, 0xE4, 0x24, 0x22, 0xF5, 0x82, 0xE4, -+0x34, 0xA0, 0xF5, 0x83, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0xA5, 0x76, 0xF0, 0x90, -+0xA5, 0x76, 0xE0, 0xFD, 0x70, 0x02, 0xE1, 0x0E, 0x90, 0xA2, 0x37, 0xE0, 0xFF, 0x70, 0x06, 0xA3, -+0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA2, 0x38, 0xE0, 0xB5, 0x07, 0x04, 0x7F, -+0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, -+0x90, 0xA5, 0x60, 0x12, 0xA2, 0x5F, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -+0xEF, 0x5D, 0x70, 0x02, 0xC1, 0xF1, 0xE4, 0x90, 0xA5, 0x77, 0xF0, 0x90, 0xA5, 0x77, 0xE0, 0xF9, -+0xC3, 0x94, 0x04, 0x50, 0x42, 0xF1, 0x10, 0xA4, 0xFF, 0xE9, 0xFD, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, -+0x35, 0xF0, 0xFE, 0x74, 0xD0, 0xF1, 0x18, 0x90, 0xA1, 0xE7, 0x12, 0x4A, 0x2A, 0xE5, 0x82, 0x29, -+0x12, 0x52, 0xCA, 0xEF, 0xF1, 0x0F, 0xA4, 0x2D, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xF0, 0xF1, -+0x18, 0x90, 0xA1, 0xEB, 0x12, 0x4A, 0x2A, 0xE5, 0x82, 0x29, 0x12, 0x52, 0xCA, 0xEF, 0xF0, 0x90, -+0xA5, 0x77, 0xE0, 0x04, 0xF0, 0x80, 0xB4, 0x90, 0xA5, 0x76, 0xE0, 0xFF, 0x90, 0xA5, 0x60, 0x71, -+0xE6, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0xA5, 0x76, 0xF0, 0x90, 0xA5, 0x60, -+0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, -+0xF0, 0x90, 0xA5, 0x60, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0xA2, 0x38, 0xF1, 0x2A, -+0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0xC1, 0x0F, 0xE4, 0x90, 0xA2, 0x38, 0xF0, 0xC1, -+0x0F, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0xA5, 0x60, 0xE0, 0x44, 0x80, 0x90, 0x00, -+0x8A, 0xF1, 0x0F, 0x90, 0x01, 0xD0, 0x12, 0x4A, 0x2A, 0xE0, 0x90, 0x01, 0xC3, 0xF0, 0x22, 0xF0, -+0x90, 0xA5, 0x60, 0xE0, 0x75, 0xF0, 0x04, 0x22, 0x2F, 0xF5, 0x82, 0x74, 0x01, 0x3E, 0xF5, 0x83, -+0xE0, 0xFF, 0x90, 0xA2, 0x38, 0xE0, 0x75, 0xF0, 0x08, 0x22, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, -+0x22, 0xD1, 0x05, 0x7F, 0x02, 0x8F, 0x7A, 0x7F, 0x02, 0x12, 0x48, 0x07, 0x90, 0xA1, 0x23, 0xE0, -+0x45, 0x7A, 0xF0, 0x22, 0xE0, 0x25, 0xE0, 0x24, 0x91, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0x22, 0x90, -+0x07, 0x1F, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0xFF, 0x60, 0x2F, 0x90, -+0xA3, 0xEB, 0xE0, 0x60, 0x29, 0x90, 0xA3, 0xE8, 0xE0, 0x54, 0x03, 0x14, 0x60, 0x10, 0x14, 0x60, -+0x16, 0x24, 0x02, 0x70, 0x19, 0x90, 0x04, 0x2D, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x10, 0x90, 0x04, -+0x2D, 0xE0, 0x44, 0x06, 0xF0, 0x80, 0x07, 0x90, 0x04, 0x2D, 0xE0, 0x44, 0x0E, 0xF0, 0xE4, 0x90, -+0xA3, 0xEB, 0xF0, 0x90, 0xA4, 0x9E, 0xEF, 0xF0, 0x90, 0xA4, 0x9C, 0x74, 0x02, 0xF0, 0x90, 0xA4, -+0xAA, 0x14, 0xF0, 0xFB, 0x7A, 0xA4, 0x79, 0x9C, 0x71, 0xEE, 0x7F, 0x04, 0x01, 0x8D, 0x41, 0x77, -+0x80, 0x9D, 0xE4, 0xFF, 0x81, 0xC8, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0x22, 0xFF, 0xEE, 0x5A, -+0xFE, 0xEF, 0x5B, 0x4E, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0x22, 0xFE, 0x33, 0x33, -+0x33, 0x54, 0xF8, 0x4F, 0x22, 0x24, 0x8C, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0x22, 0x90, -+0x02, 0x09, 0xE0, 0xF5, 0x0E, 0x12, 0x26, 0x1E, 0x25, 0x0E, 0x90, 0xA1, 0xE0, 0x12, 0x7F, 0x56, -+0x25, 0x0E, 0x90, 0xA1, 0xE1, 0x12, 0x4F, 0x60, 0x25, 0x0E, 0x90, 0xA1, 0xE2, 0xF0, 0x12, 0x55, -+0xC8, 0x25, 0x0E, 0x90, 0xA1, 0xE3, 0x12, 0x7F, 0xD5, 0x25, 0x0E, 0x90, 0xA1, 0xE4, 0x12, 0x4F, -+0x75, 0x25, 0x0E, 0x90, 0xA1, 0xE5, 0x12, 0x7F, 0xE3, 0x25, 0x0E, 0x90, 0xA1, 0xE6, 0xF0, 0x22, -+0x12, 0x4F, 0xD0, 0x90, 0x04, 0x24, 0xE0, 0xF5, 0x0E, 0xE4, 0xFF, 0x12, 0x4F, 0x94, 0x8F, 0x82, -+0x12, 0x6F, 0xEB, 0x25, 0x0E, 0xFE, 0x75, 0xF0, 0x0E, 0xEF, 0x90, 0xA3, 0xC6, 0x12, 0x4A, 0x2A, -+0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x03, 0xE4, 0x22, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0xA2, 0xD3, 0xF0, -+0xBF, 0x01, 0x08, 0x12, 0x56, 0xE7, 0xE4, 0x90, 0xA2, 0xD3, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x54, -+0x01, 0xFF, 0x90, 0xA3, 0xEF, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x4F, 0x8F, 0x12, 0x26, -+0x1E, 0xFF, 0x54, 0x7F, 0x90, 0xA2, 0xEF, 0xF0, 0xEF, 0x12, 0x4F, 0x80, 0xA3, 0x12, 0x7F, 0x56, -+0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0xA2, 0xED, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x12, -+0x55, 0xC8, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0xA2, 0xEA, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, -+0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0x31, 0x42, 0x12, 0x4F, 0x5F, 0x90, 0xA2, 0xEE, 0x12, 0x7F, -+0xD5, 0xFD, 0x7F, 0x02, 0x12, 0x62, 0x4F, 0x12, 0x4F, 0x94, 0x12, 0x4F, 0x76, 0xFF, 0x54, 0x01, -+0xFE, 0x90, 0xA3, 0x51, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, -+0xFD, 0x4F, 0x12, 0x4F, 0x74, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x31, 0x3A, 0x54, 0x08, -+0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0x12, 0x4F, 0x74, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x31, -+0x3A, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0x12, 0x4F, 0x74, 0x54, 0x40, 0xFE, 0xEF, 0x54, -+0xBF, 0x4E, 0x90, 0xA3, 0x51, 0xF0, 0x31, 0xEE, 0x20, 0xE0, 0x29, 0xEF, 0xC3, 0x13, 0x20, 0xE0, -+0x0B, 0x75, 0x0F, 0x01, 0x90, 0xA3, 0x95, 0xE0, 0x60, 0x0B, 0x80, 0x0E, 0xE4, 0xF5, 0x0F, 0x90, -+0xA3, 0x95, 0xE0, 0x60, 0x05, 0xE4, 0xF5, 0x0E, 0x80, 0x03, 0x75, 0x0E, 0x01, 0xAD, 0x0F, 0xAF, -+0x0E, 0x12, 0x72, 0xB5, 0x12, 0x4F, 0x94, 0x02, 0x8F, 0x1B, 0x4D, 0xFF, 0x90, 0xA3, 0x51, 0xF0, -+0xEE, 0x22, 0x90, 0xA2, 0xED, 0xE0, 0x54, 0x0F, 0x22, 0xE4, 0xFF, 0x12, 0x7E, 0xF3, 0xBF, 0x01, -+0x11, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x0B, 0x31, 0x42, 0x64, 0x02, 0x60, 0x02, 0x80, 0x61, 0x12, -+0x67, 0xCD, 0x22, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x24, 0x54, 0xC0, 0x70, 0x08, 0x31, 0xB8, 0x54, -+0xFD, 0xF0, 0x02, 0x60, 0x40, 0xE5, 0x24, 0x30, 0xE6, 0x1E, 0x90, 0xA2, 0xEF, 0xE0, 0x64, 0x01, -+0x70, 0x18, 0x90, 0xA2, 0xF3, 0xE0, 0x44, 0x01, 0xF0, 0x31, 0x42, 0x64, 0x02, 0x60, 0x04, 0x31, -+0xC0, 0x80, 0x07, 0x12, 0x67, 0xCD, 0x80, 0x02, 0x31, 0xB8, 0xE5, 0x24, 0x90, 0xA2, 0xF3, 0x30, -+0xE7, 0x11, 0xE0, 0x44, 0x02, 0xF0, 0xD1, 0x29, 0x12, 0x70, 0x18, 0x90, 0xA2, 0xEA, 0xE0, 0x44, -+0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0xA2, 0xF3, 0xE0, 0x54, 0xFE, 0xF0, 0x22, -+0x90, 0xA3, 0x51, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x23, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x1D, -+0x90, 0xA1, 0xE1, 0xE0, 0xFF, 0x90, 0xA5, 0x42, 0x74, 0x09, 0xF0, 0x7B, 0x18, 0xE4, 0xFD, 0x12, -+0x5C, 0xC2, 0x90, 0xA5, 0x80, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x5E, 0x5C, 0x22, 0xE0, 0xFF, -+0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0xA2, 0xEA, 0xE0, 0xFF, 0x12, 0x4F, 0x80, 0x30, 0xE0, -+0x1B, 0xEF, 0x54, 0x7F, 0xD1, 0x20, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x04, 0xE0, -+0x54, 0xFD, 0xF0, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x03, 0x12, 0x60, 0x40, 0x90, 0xA3, 0x57, 0x31, -+0xEE, 0x30, 0xE0, 0x22, 0x90, 0xA3, 0x5A, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x18, 0xEF, 0x54, -+0xFD, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA3, 0x5A, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x04, 0xF0, -+0x80, 0x04, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, 0x02, 0x51, 0x50, 0x22, -+0x90, 0xA3, 0xB6, 0xE0, 0x30, 0xE0, 0x23, 0xA3, 0x51, 0x7B, 0xE0, 0xFE, 0x30, 0xE0, 0x1B, 0x75, -+0xF0, 0x0E, 0xEF, 0x51, 0x84, 0xEE, 0x54, 0xFE, 0xF0, 0x90, 0xA3, 0xB9, 0x74, 0x05, 0xF0, 0x12, -+0x5F, 0x88, 0x54, 0x07, 0xFD, 0x7F, 0x02, 0x12, 0x5A, 0x04, 0x22, 0xE0, 0xC3, 0x13, 0x54, 0x07, -+0xFF, 0x75, 0xF0, 0x0E, 0x90, 0xA3, 0xC2, 0x02, 0x4A, 0x2A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x12, 0x4F, 0x8F, 0x12, 0x7F, 0xDC, 0x75, 0x43, 0x05, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x53, -+0x12, 0x34, 0x2C, 0x12, 0x4F, 0x94, 0x12, 0x26, 0x1E, 0x20, 0xE0, 0x02, 0x81, 0x07, 0x90, 0x05, -+0x54, 0xE0, 0x90, 0xA3, 0x64, 0xF0, 0xE0, 0xC3, 0x13, 0x90, 0xA3, 0x63, 0x12, 0x8E, 0xED, 0x30, -+0xE0, 0x15, 0x12, 0x7F, 0x57, 0x90, 0xA3, 0x54, 0xF0, 0x24, 0x0A, 0x90, 0xA3, 0x85, 0x12, 0x4F, -+0x60, 0x90, 0xA3, 0x55, 0xF0, 0x80, 0x4B, 0x12, 0x7F, 0x57, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x15, -+0xEF, 0xC3, 0x94, 0x03, 0x50, 0x07, 0x90, 0xA3, 0x54, 0x74, 0x03, 0x80, 0x0D, 0x12, 0x7F, 0x57, -+0x90, 0xA3, 0x54, 0x80, 0x05, 0x90, 0xA3, 0x54, 0x74, 0x2A, 0xF0, 0x24, 0x0A, 0x90, 0xA3, 0x85, -+0xF0, 0x12, 0x4F, 0x61, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, 0x94, 0x03, 0x90, 0xA3, -+0x55, 0x50, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, 0x90, 0xA3, 0x55, 0x74, -+0x2A, 0xF0, 0x12, 0x5F, 0xC8, 0x30, 0xE0, 0x3D, 0x90, 0xA3, 0x54, 0xE0, 0x75, 0xF0, 0x03, 0x84, -+0x90, 0xA3, 0x5C, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0xA3, 0x55, 0xE0, 0x75, 0xF0, 0x03, -+0x84, 0x90, 0xA3, 0x5E, 0xF0, 0x90, 0xA3, 0x54, 0xE0, 0xC3, 0x13, 0x90, 0xA3, 0x5F, 0xF0, 0x90, -+0xA3, 0x55, 0xE0, 0xC3, 0x13, 0x90, 0xA3, 0x60, 0xF0, 0x90, 0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, -+0x7F, 0x02, 0x12, 0x7F, 0x5D, 0xE4, 0x90, 0xA3, 0x93, 0xF0, 0x12, 0x55, 0xC2, 0xC4, 0x13, 0x13, -+0x54, 0x03, 0x20, 0xE0, 0x37, 0x90, 0xA3, 0x53, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x06, 0x12, 0x4F, -+0x7F, 0x30, 0xE0, 0x28, 0x12, 0x26, 0x1E, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x08, 0x90, -+0xA3, 0x95, 0xE0, 0x60, 0x08, 0x80, 0x0B, 0x90, 0xA3, 0x95, 0xE0, 0x60, 0x05, 0x75, 0x0E, 0x01, -+0x80, 0x03, 0xE4, 0xF5, 0x0E, 0x7D, 0x02, 0xAF, 0x0E, 0x12, 0x72, 0xB5, 0x12, 0x77, 0xEF, 0x30, -+0xE0, 0x11, 0x91, 0xD4, 0x30, 0xE0, 0x07, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x62, 0x4F, 0x91, 0x94, -+0x74, 0x11, 0xF0, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, 0xA3, 0x5B, 0xE0, 0xB4, 0x01, 0x08, -+0x90, 0xA3, 0x66, 0x74, 0x01, 0xF0, 0x80, 0x28, 0x90, 0xA3, 0x5B, 0xE0, 0xB4, 0x04, 0x08, 0x90, -+0xA3, 0x66, 0x74, 0x04, 0xF0, 0x80, 0x19, 0x90, 0xA3, 0x5B, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0xA3, -+0x66, 0x74, 0x02, 0xF0, 0x80, 0x0A, 0x90, 0xA3, 0x5B, 0xE0, 0xB4, 0x07, 0x03, 0x12, 0x76, 0x4F, -+0xE4, 0x90, 0xA3, 0x5B, 0xF0, 0x80, 0x55, 0x12, 0x55, 0xC2, 0x31, 0xEF, 0x30, 0xE0, 0x05, 0x75, -+0x0F, 0x02, 0x80, 0x11, 0x12, 0x26, 0x1E, 0x12, 0x8E, 0x36, 0x30, 0xE0, 0x05, 0x75, 0x0F, 0x01, -+0x80, 0x03, 0xE4, 0xF5, 0x0F, 0xD1, 0x36, 0x90, 0xA3, 0xB4, 0xE0, 0x30, 0xE0, 0x04, 0x7D, 0xA0, -+0x80, 0x02, 0x7D, 0x20, 0x7F, 0x40, 0x12, 0x3A, 0x96, 0x12, 0x55, 0xC2, 0x13, 0x13, 0x13, 0x54, -+0x1F, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x76, 0x89, 0xAD, 0x0F, 0x7F, -+0x02, 0x12, 0x72, 0xB5, 0x12, 0x67, 0x98, 0x91, 0x94, 0x74, 0x43, 0xF0, 0xD1, 0x05, 0x90, 0xA3, -+0x65, 0xF0, 0x12, 0x4F, 0x7C, 0x30, 0xE0, 0x09, 0x90, 0xA3, 0x86, 0xE0, 0x44, 0x02, 0xF0, 0x80, -+0x0B, 0x7F, 0x01, 0x91, 0x9C, 0x90, 0xA3, 0x86, 0xE0, 0x54, 0xFD, 0xF0, 0x7F, 0x03, 0x12, 0x8B, -+0x4A, 0x90, 0xA3, 0x53, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0xA3, 0x57, 0xE0, 0x54, 0xBF, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0x90, 0xA3, 0x86, 0xE0, -+0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x26, 0xEF, 0xB4, 0x01, 0x0D, 0x90, 0xA3, 0x8D, 0x12, 0x64, 0x26, -+0x91, 0xCD, 0x90, 0xA3, 0x8D, 0x80, 0x0B, 0x90, 0xA3, 0x89, 0x12, 0x64, 0x26, 0x91, 0xCD, 0x90, -+0xA3, 0x89, 0x12, 0x64, 0x26, 0x7F, 0x58, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x22, 0x7F, 0x58, 0x7E, -+0x0C, 0x02, 0x37, 0x5D, 0x90, 0xA3, 0x57, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x22, 0x90, 0xA4, 0xAC, -+0xEF, 0xF0, 0x7F, 0x03, 0x12, 0x72, 0x94, 0x12, 0x8E, 0xEE, 0x90, 0xA3, 0x66, 0x30, 0xE0, 0x05, -+0x74, 0x05, 0xF0, 0x80, 0x03, 0xE0, 0x04, 0xF0, 0x90, 0xA3, 0x57, 0x12, 0x89, 0xFC, 0x20, 0xE0, -+0x06, 0x12, 0x7F, 0xCE, 0x30, 0xE0, 0x38, 0x12, 0x8E, 0xEE, 0x30, 0xE0, 0x0A, 0x90, 0xA3, 0x54, -+0xE0, 0xFF, 0x90, 0xA3, 0x64, 0x80, 0x21, 0x90, 0xA4, 0xAC, 0xE0, 0xFC, 0xB4, 0x01, 0x0D, 0x90, -+0xA3, 0x54, 0xE0, 0xFE, 0x90, 0xA3, 0x63, 0xE0, 0xC3, 0x9E, 0x80, 0x0F, 0xEC, 0xB4, 0x04, 0x0F, -+0x90, 0xA3, 0x55, 0xE0, 0xFF, 0x90, 0xA3, 0x63, 0xE0, 0xC3, 0x9F, 0x90, 0xA3, 0x6A, 0xF0, 0xD1, -+0x0E, 0x30, 0xE0, 0x1E, 0x91, 0xD4, 0x30, 0xE0, 0x7B, 0xD1, 0x17, 0x50, 0x0A, 0xEF, 0x25, 0xE0, -+0x25, 0xE0, 0xFB, 0xE4, 0xFD, 0x80, 0x05, 0x7B, 0x7F, 0x7D, 0xFF, 0xE4, 0xFF, 0x12, 0x5E, 0x63, -+0x80, 0x62, 0x12, 0x77, 0xEF, 0x30, 0xE0, 0x43, 0xD1, 0x05, 0xFD, 0x7F, 0x04, 0x12, 0x60, 0x4D, -+0x12, 0x5F, 0xC8, 0x30, 0xE0, 0x35, 0xB1, 0xFD, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA3, 0x69, 0xF0, -+0x90, 0xA3, 0x66, 0xF0, 0x90, 0xA4, 0xAC, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0xA3, 0x5B, 0x74, -+0x06, 0xF0, 0x80, 0x0A, 0xEF, 0xB4, 0x04, 0x06, 0x90, 0xA3, 0x5B, 0x74, 0x07, 0xF0, 0x90, 0xA3, -+0x52, 0xE0, 0x60, 0x07, 0x90, 0xA3, 0x5A, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0xA4, 0xAC, 0xE0, 0xB4, -+0x01, 0x04, 0x7D, 0x06, 0x80, 0x09, 0x90, 0xA4, 0xAC, 0xE0, 0xB4, 0x04, 0x07, 0x7D, 0x0C, 0x7F, -+0x6F, 0x12, 0x59, 0x62, 0x90, 0xA3, 0x57, 0x12, 0x67, 0x81, 0x30, 0xE0, 0x25, 0x90, 0xA3, 0x6A, -+0xE0, 0xFE, 0xC3, 0x94, 0x20, 0x50, 0x0F, 0xEE, 0x7D, 0x00, 0x25, 0xE0, 0x25, 0xE0, 0xFC, 0x90, -+0xA1, 0xE5, 0xE0, 0xFF, 0x80, 0x09, 0x90, 0xA1, 0xE5, 0xE0, 0xFF, 0x7D, 0xFF, 0x7C, 0x7F, 0x12, -+0x5D, 0xAC, 0x90, 0xA3, 0x56, 0xE0, 0x30, 0xE0, 0x03, 0x12, 0x67, 0x98, 0x22, 0x90, 0xA3, 0x5A, -+0xE0, 0x44, 0x02, 0xF0, 0x22, 0x90, 0xA3, 0x59, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x22, 0x90, 0xA3, -+0x53, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x22, 0x90, 0xA3, 0x6A, 0xE0, 0xFF, 0xC3, 0x94, 0x20, 0x22, -+0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA2, 0xEB, 0x22, 0xE4, 0x90, 0xA5, 0x20, 0xF0, 0x90, 0xA3, -+0x4D, 0xE0, 0x90, 0xA5, 0x21, 0x22, 0x7E, 0x00, 0x7F, 0x0A, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA3, -+0x79, 0x7B, 0x12, 0x4A, 0x6E, 0x90, 0xA3, 0x67, 0x74, 0x02, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x19, -+0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x86, 0x12, 0x4A, 0x6E, 0xF1, 0x6A, 0x90, 0xA3, 0x8D, -+0x12, 0x4A, 0x12, 0x90, 0xA3, 0x89, 0x12, 0x27, 0x48, 0x90, 0xA1, 0x29, 0xE0, 0xFF, 0x64, 0x02, -+0x70, 0x1A, 0xF1, 0x63, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, 0xA3, 0x95, 0xEE, 0xF0, 0xF1, 0x63, -+0x30, 0xE1, 0x02, 0x7E, 0x01, 0x90, 0xA3, 0x96, 0xEE, 0xF0, 0x80, 0x3A, 0xEF, 0x64, 0x01, 0x70, -+0x15, 0xD1, 0xFA, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0xA3, 0x95, 0xEF, 0xF0, 0xD1, 0xFA, 0x30, -+0xE1, 0x02, 0x7F, 0x01, 0x80, 0x1B, 0x90, 0xA1, 0x29, 0xE0, 0x64, 0x03, 0x70, 0x18, 0xD1, 0xF3, -+0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0xA3, 0x95, 0xEF, 0xF0, 0xD1, 0xF3, 0x30, 0xE1, 0x02, 0x7F, -+0x01, 0x90, 0xA3, 0x96, 0xEF, 0xF0, 0x90, 0xFD, 0x68, 0xE0, 0x44, 0x02, 0xF0, 0x7F, 0x01, 0x12, -+0x76, 0x89, 0xF1, 0x01, 0xD1, 0x36, 0x90, 0xA3, 0x6C, 0x74, 0x01, 0xF0, 0x90, 0xA3, 0xA2, 0xE0, -+0x54, 0xFE, 0xF0, 0x90, 0x04, 0x8F, 0xE4, 0xF0, 0x90, 0xA3, 0xB4, 0xE0, 0x54, 0xFE, 0xF0, 0x54, -+0xFD, 0xF0, 0x22, 0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, 0x22, 0x90, 0xFD, 0x70, 0xE0, 0x7F, 0x00, -+0x22, 0x7E, 0x00, 0x7F, 0x33, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x53, 0x12, 0x4A, 0x6E, -+0x90, 0xA3, 0x54, 0x74, 0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0x90, 0xA1, 0x29, 0xE0, 0xFC, 0x64, -+0x02, 0x70, 0x15, 0xF1, 0x63, 0x30, 0xE2, 0x02, 0x7E, 0x01, 0xEE, 0x12, 0x4F, 0x87, 0xFE, 0x90, -+0xA3, 0x56, 0xE0, 0x54, 0xBF, 0x4E, 0xF0, 0x22, 0xEC, 0x64, 0x01, 0x70, 0x09, 0xD1, 0xFA, 0x30, -+0xE2, 0x02, 0x7F, 0x01, 0x80, 0x0F, 0x90, 0xA1, 0x29, 0xE0, 0x64, 0x03, 0x70, 0x14, 0xD1, 0xF3, -+0x30, 0xE2, 0x02, 0x7F, 0x01, 0xEF, 0x12, 0x4F, 0x87, 0xFF, 0x90, 0xA3, 0x56, 0xE0, 0x54, 0xBF, -+0x4F, 0xF0, 0x22, 0x90, 0xFD, 0x80, 0xE0, 0x7E, 0x00, 0x22, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x36, -+0xCE, 0x90, 0xA3, 0x8D, 0x02, 0x27, 0x48, 0xE4, 0xFF, 0x12, 0x7E, 0xF3, 0xBF, 0x01, 0x0F, 0x90, -+0xA2, 0xEF, 0xE0, 0x60, 0x09, 0x31, 0xB8, 0x54, 0x07, 0x70, 0x03, 0x12, 0x60, 0x40, 0x22, 0x90, -+0xA3, 0x53, 0xE0, 0x30, 0xE0, 0x3C, 0xA3, 0xE0, 0xFF, 0x12, 0x72, 0x94, 0x90, 0xA3, 0x66, 0x74, -+0x01, 0xF0, 0xE4, 0x90, 0xA3, 0x5B, 0xF0, 0x90, 0xA3, 0x68, 0xF0, 0xA3, 0xF0, 0x90, 0xA3, 0x65, -+0x04, 0xF0, 0x90, 0xA3, 0x52, 0xE0, 0x60, 0x07, 0x7D, 0x05, 0x7F, 0x6F, 0x02, 0x59, 0x62, 0x12, -+0x67, 0x98, 0x12, 0x89, 0xF9, 0x20, 0xE0, 0x0A, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x02, -+0x31, 0xC0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0xA2, 0xFA, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0xA3, -+0x52, 0xF0, 0x60, 0x27, 0xA3, 0xE0, 0x20, 0xE0, 0x22, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x60, 0x4D, -+0x12, 0xA0, 0x0C, 0x30, 0xE0, 0x15, 0x12, 0x7F, 0xCE, 0x20, 0xE0, 0x0F, 0x12, 0xA0, 0x14, 0x30, -+0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, 0x7F, 0x09, 0x12, 0x76, 0x89, 0x22, 0x90, 0xA3, 0x51, 0xE0, -+0xFF, 0xC3, 0x13, 0x22, 0x90, 0xA3, 0x51, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x12, 0x4F, 0xD0, -+0x90, 0xA5, 0x5F, 0xE0, 0x70, 0x09, 0x12, 0x9F, 0x6A, 0x90, 0xA5, 0x5F, 0x74, 0x01, 0xF0, 0x12, -+0x4F, 0x94, 0x12, 0x26, 0x1E, 0xFF, 0xE4, 0x8F, 0x11, 0xF5, 0x10, 0xF5, 0x0F, 0xF5, 0x0E, 0x90, -+0xA3, 0x8D, 0x12, 0x4A, 0x12, 0xEC, 0x54, 0xC1, 0xFC, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0xAF, 0x11, 0xAE, 0x10, 0xAD, 0x0F, 0xAC, 0x0E, 0x78, 0x19, 0x12, 0x27, 0x35, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x4A, 0x05, 0x90, 0xA3, 0x89, 0x02, 0x27, 0x48, 0x12, -+0x26, 0x1E, 0x54, 0x01, 0x11, 0xD5, 0x54, 0xFD, 0x4F, 0xF0, 0xE0, 0xC3, 0x13, 0xFF, 0x54, 0x01, -+0x90, 0x01, 0xE6, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE0, 0x40, 0x90, 0x00, 0xA3, -+0xE0, 0x54, 0xF8, 0x44, 0x05, 0xFD, 0x7F, 0xA3, 0x12, 0x3A, 0x96, 0x90, 0x00, 0xA0, 0xE0, 0x54, -+0x0F, 0x64, 0x04, 0x70, 0x20, 0x90, 0xA3, 0x9C, 0xE0, 0x30, 0xE0, 0x02, 0x80, 0x1F, 0x90, 0xFD, -+0x62, 0xE0, 0xB4, 0xAD, 0x0E, 0xA3, 0xE0, 0xB4, 0x35, 0x09, 0x11, 0xCD, 0x90, 0x01, 0xE5, 0x74, -+0xDF, 0xF0, 0x22, 0x80, 0x00, 0x90, 0x01, 0xE7, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x01, 0xE7, -+0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x25, 0xE0, 0xFF, 0x90, 0xA3, 0x78, 0xE0, 0x22, 0x12, 0x26, 0x1E, -+0x54, 0x01, 0x25, 0xE0, 0x11, 0xD5, 0x54, 0xFB, 0x4F, 0xF0, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, -+0xE0, 0x08, 0x90, 0x07, 0x65, 0xE0, 0x44, 0x18, 0xF0, 0x22, 0x90, 0xA3, 0x9C, 0xE0, 0x20, 0xE0, -+0x07, 0x90, 0x07, 0x65, 0xE0, 0x54, 0xE7, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x54, 0x01, 0x33, 0x33, -+0x33, 0x54, 0xF8, 0xFF, 0x90, 0xA3, 0x78, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x12, 0x67, 0x81, 0x90, -+0x07, 0x65, 0x30, 0xE0, 0x04, 0x74, 0x18, 0xF0, 0x22, 0xE4, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x54, -+0x01, 0xFF, 0x90, 0xA3, 0xB4, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x30, 0xE0, 0x55, 0x90, 0x00, 0x40, -+0xE0, 0x54, 0xBF, 0x44, 0xA0, 0xFD, 0x7F, 0x40, 0x12, 0x3A, 0x96, 0x90, 0x00, 0x41, 0xE0, 0x44, -+0x04, 0xFD, 0x7F, 0x41, 0x12, 0x3A, 0x96, 0x90, 0x00, 0x6A, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x6A, -+0x12, 0x3A, 0x96, 0x90, 0x07, 0x6E, 0x74, 0x55, 0xF0, 0xA3, 0x74, 0x12, 0xF0, 0x90, 0x07, 0x78, -+0xE0, 0x54, 0xF2, 0x44, 0x02, 0xF0, 0x90, 0x06, 0xCC, 0xE0, 0x44, 0x03, 0xF0, 0x90, 0x07, 0x65, -+0xE0, 0x54, 0xF5, 0xF0, 0x90, 0x05, 0x23, 0xE0, 0x54, 0x7F, 0xF0, 0xE4, 0xFD, 0x7F, 0x66, 0x12, -+0x3A, 0x96, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0x38, 0xE0, 0xFF, 0x90, -+0xA2, 0x37, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x41, 0x90, -+0xA2, 0x37, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0xA1, 0xE7, 0x12, 0x4A, 0x2A, 0xE0, 0xFD, 0xEE, -+0x75, 0xF0, 0x08, 0xA4, 0x24, 0xE8, 0xF9, 0x74, 0xA1, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, -+0x12, 0x7B, 0x94, 0x90, 0xA2, 0x37, 0x12, 0x97, 0x2A, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, -+0x05, 0xE4, 0x90, 0xA2, 0x37, 0xF0, 0x12, 0x96, 0x05, 0x90, 0xA1, 0x23, 0xE0, 0x44, 0x02, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0xA2, 0xCF, 0xF0, 0xA3, 0xF0, 0x90, 0xA2, 0x37, 0xF0, -+0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7D, 0x10, 0xED, 0x14, 0xF9, 0x24, -+0xD4, 0x12, 0x7F, 0x7E, 0xE0, 0x60, 0x36, 0x7C, 0x08, 0xEC, 0x14, 0x90, 0xA5, 0x83, 0xF0, 0x74, -+0xD4, 0x29, 0x12, 0x7F, 0x7E, 0xE0, 0xFB, 0x7A, 0x00, 0x90, 0xA5, 0x83, 0x51, 0x5F, 0x80, 0x05, -+0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x97, 0xBD, 0x60, 0x0F, 0xE9, 0x75, 0xF0, 0x08, -+0xA4, 0xFF, 0x90, 0xA5, 0x83, 0xE0, 0x2F, 0x04, 0xFF, 0x80, 0x06, 0xDC, 0xCC, 0xDD, 0xBD, 0x7F, -+0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF5, 0x83, 0xE0, 0xFD, 0x7C, 0x00, 0x90, 0xA4, 0x8C, 0xE0, -+0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x22, 0x7D, 0x01, 0xAF, 0x0E, 0x90, 0xA4, 0x8E, -+0xEB, 0xF0, 0x90, 0xA4, 0x8D, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0x90, 0x9B, 0x12, 0x12, 0x57, 0xA2, -+0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x12, 0x6F, 0xBD, 0xE0, 0xF5, 0x1A, 0x54, 0x7F, 0xF5, 0x1C, 0x91, -+0x94, 0x12, 0x56, 0xA1, 0xE0, 0x90, 0xA4, 0x91, 0x12, 0x57, 0x8D, 0xE0, 0xFC, 0x90, 0xA4, 0x8D, -+0xE0, 0x75, 0xF0, 0x04, 0x12, 0x4D, 0xE3, 0x13, 0x13, 0x54, 0x03, 0xF5, 0x1B, 0xE5, 0x1C, 0xD1, -+0x49, 0xE4, 0x93, 0xFA, 0x74, 0x01, 0x93, 0xFB, 0xEF, 0x12, 0x97, 0x45, 0xF5, 0x83, 0xEA, 0xF0, -+0xA3, 0xEB, 0xF0, 0x91, 0x94, 0x12, 0x4D, 0xE3, 0xFE, 0xC4, 0x54, 0x03, 0x90, 0xA4, 0x8F, 0xF0, -+0x74, 0x22, 0x2F, 0x12, 0x95, 0xFD, 0xE5, 0x1C, 0xF0, 0x90, 0xA4, 0x8D, 0xE0, 0xFF, 0x24, 0x22, -+0x12, 0x97, 0xC5, 0xE5, 0x1B, 0xF0, 0xE5, 0x1C, 0xD3, 0x9C, 0x40, 0x0E, 0x8C, 0x1C, 0x8C, 0x1A, -+0xAE, 0x04, 0x74, 0xA2, 0x2F, 0x12, 0x6D, 0x81, 0xEE, 0xF0, 0xED, 0x70, 0x02, 0x81, 0x84, 0xAF, -+0x05, 0x8F, 0x1D, 0xE5, 0x1A, 0x30, 0xE7, 0x0B, 0x85, 0x1C, 0x1A, 0x12, 0x6D, 0x7B, 0xE5, 0x1C, -+0xF0, 0x15, 0x1D, 0xE5, 0x1D, 0x70, 0x02, 0x81, 0x84, 0x90, 0xA4, 0x8D, 0xE0, 0xFF, 0xAD, 0x1A, -+0xD1, 0x55, 0xEF, 0xF4, 0x60, 0x19, 0x8F, 0x1A, 0xD5, 0x1D, 0x14, 0x90, 0xA4, 0x8D, 0xE0, 0xFF, -+0x12, 0x95, 0xFB, 0xE0, 0xFE, 0x74, 0xA2, 0x2F, 0x12, 0x6D, 0x81, 0xEE, 0xF0, 0x81, 0x84, 0xE5, -+0x1A, 0x64, 0x2C, 0x70, 0x36, 0xE5, 0x1B, 0xD3, 0x94, 0x00, 0x40, 0x2F, 0xE5, 0x1B, 0xD3, 0x94, -+0x02, 0x50, 0x28, 0x15, 0x1B, 0x75, 0x1A, 0x2D, 0xE5, 0x1B, 0x12, 0x97, 0xB6, 0xFF, 0x90, 0xA4, -+0x8D, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0x12, 0x4D, 0xE3, 0x54, 0xF3, 0x4F, 0xF0, 0x74, 0xA2, 0x2E, -+0x12, 0x6D, 0x81, 0x74, 0xFF, 0xF0, 0xD5, 0x1D, 0x1F, 0x81, 0x84, 0xE5, 0x1A, 0xB4, 0x2D, 0x18, -+0xE5, 0x1B, 0xD3, 0x94, 0x02, 0x50, 0x11, 0x75, 0x1A, 0x2C, 0x12, 0x6D, 0x7B, 0x74, 0xFF, 0xF0, -+0x15, 0x1D, 0xE5, 0x1D, 0x70, 0x02, 0x81, 0x84, 0xE5, 0x1D, 0x70, 0x02, 0x81, 0x84, 0x90, 0xA4, -+0x91, 0xE0, 0xFF, 0xE5, 0x1C, 0xD3, 0x9F, 0x50, 0x02, 0x81, 0x7E, 0xE4, 0x90, 0xA4, 0x90, 0xF0, -+0x90, 0xA4, 0x8F, 0xE0, 0xFF, 0xAD, 0x1C, 0x91, 0xB0, 0x8F, 0x1C, 0x85, 0x1C, 0x1A, 0xE0, 0xFF, -+0x90, 0xA4, 0x91, 0xE0, 0xFD, 0x91, 0xB0, 0xEF, 0xF0, 0xE5, 0x1A, 0xD3, 0x94, 0x0B, 0x40, 0x1C, -+0x90, 0xA4, 0x8D, 0xE0, 0xFB, 0x90, 0xA4, 0x8F, 0xE0, 0x90, 0xA4, 0x95, 0xF0, 0x7D, 0x01, 0xAF, -+0x1C, 0x91, 0xC4, 0x8F, 0x1A, 0xE5, 0x1A, 0xF4, 0x70, 0x59, 0x81, 0x84, 0xAD, 0x1A, 0xE5, 0x1C, -+0x14, 0xFC, 0x90, 0xA4, 0x91, 0xE0, 0xFF, 0xEC, 0xC3, 0x9F, 0x40, 0x39, 0xD1, 0x39, 0x90, 0xA4, -+0x8D, 0x12, 0x52, 0xBD, 0xD1, 0x41, 0x51, 0x60, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0x12, 0x97, 0xBD, 0x60, 0x1C, 0xE5, 0x1C, 0xAD, 0x04, 0xB4, 0x14, 0x02, 0x7D, 0x0C, 0x90, -+0xA4, 0x90, 0xE0, 0x04, 0xF0, 0xE0, 0x65, 0x1D, 0x60, 0x0B, 0xA3, 0xE0, 0xFF, 0xED, 0xD3, 0x9F, -+0x40, 0x03, 0x1C, 0x80, 0xBD, 0x12, 0x6D, 0x7B, 0xED, 0xF0, 0xE5, 0x1A, 0xB4, 0xFF, 0x04, 0xAF, -+0x05, 0x8F, 0x1A, 0x90, 0xA4, 0x8F, 0xE0, 0xFF, 0xAD, 0x1A, 0x91, 0x9D, 0x8F, 0x1A, 0x12, 0x6D, -+0x7B, 0xE0, 0xFD, 0xF4, 0x60, 0x1C, 0x90, 0xA4, 0x8F, 0xE0, 0xFF, 0x91, 0x9D, 0x90, 0xA4, 0x8D, -+0xE0, 0xFE, 0x12, 0x95, 0xFB, 0xEF, 0xF0, 0x74, 0xA2, 0x2E, 0x12, 0x6D, 0x81, 0x74, 0xFF, 0xF0, -+0x80, 0x12, 0x90, 0xA4, 0x8D, 0xE0, 0x12, 0x95, 0xFB, 0xE5, 0x1A, 0xF0, 0x80, 0x06, 0x90, 0xA4, -+0x91, 0xE0, 0xF5, 0x1A, 0x90, 0xA4, 0x8D, 0xE0, 0xFF, 0xA3, 0xE0, 0xFB, 0x85, 0x1B, 0x77, 0xAD, -+0x1A, 0x02, 0x90, 0xE4, 0x90, 0xA4, 0x8D, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x22, 0xEF, 0x60, 0x0A, -+0xED, 0xD3, 0x94, 0x0B, 0x40, 0x04, 0x7E, 0x20, 0x80, 0x02, 0xE4, 0xFE, 0xED, 0x2E, 0xFF, 0x22, -+0xEF, 0x60, 0x0A, 0xED, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0x7E, 0x20, 0x80, 0x02, 0xE4, 0xFE, 0xC3, -+0xED, 0x9E, 0xFF, 0x22, 0x90, 0xA4, 0x94, 0xEB, 0xF0, 0xEF, 0x54, 0x7F, 0x24, 0xF4, 0x90, 0xA4, -+0x98, 0xF0, 0xED, 0x70, 0x2E, 0xB1, 0xF0, 0x70, 0x15, 0xE0, 0x25, 0xE0, 0x24, 0x81, 0xF5, 0x82, -+0xE4, 0x34, 0x41, 0xB1, 0xCF, 0x24, 0x82, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x80, 0x41, 0xE0, 0x25, -+0xE0, 0x24, 0x59, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0xB1, 0xCF, 0x24, 0x5A, 0xF5, 0x82, 0xE4, 0x34, -+0x41, 0x80, 0x2C, 0xB1, 0xF0, 0x70, 0x15, 0xE0, 0x25, 0xE0, 0x24, 0xCD, 0xF5, 0x82, 0xE4, 0x34, -+0x41, 0xB1, 0xCF, 0x24, 0xCE, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x80, 0x13, 0xE0, 0x25, 0xE0, 0x24, -+0xA5, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0xB1, 0xCF, 0x24, 0xA6, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0xF5, -+0x83, 0xE4, 0x93, 0xFF, 0x90, 0xA4, 0x94, 0xE0, 0xFD, 0x12, 0x56, 0xBC, 0xA9, 0x07, 0x7F, 0x0C, -+0x7E, 0x12, 0x7D, 0x10, 0x90, 0xA4, 0x96, 0xE0, 0xFC, 0xF4, 0x60, 0x2E, 0xE9, 0xF4, 0x60, 0x2A, -+0xE9, 0xC3, 0x9F, 0x40, 0x25, 0xE9, 0xD3, 0x9D, 0x50, 0x20, 0xB1, 0xE8, 0x12, 0x55, 0x17, 0xE0, -+0x30, 0xE1, 0x17, 0x74, 0xA2, 0x2D, 0x12, 0x56, 0xB4, 0xE0, 0xC3, 0x94, 0x02, 0x40, 0x0B, 0x90, -+0xA4, 0x97, 0xE9, 0xF0, 0xA9, 0x04, 0x90, 0xA4, 0x96, 0xF0, 0xB1, 0xE8, 0x12, 0x55, 0x17, 0xE0, -+0x30, 0xE6, 0x2A, 0x74, 0xA2, 0x2D, 0x12, 0x56, 0xB4, 0xE0, 0xC3, 0x94, 0x02, 0x40, 0x1E, 0x90, -+0xA4, 0x96, 0xE0, 0xFD, 0xF4, 0x60, 0x16, 0xE9, 0xF4, 0x60, 0x12, 0xE9, 0x9F, 0x40, 0x0E, 0xE9, -+0xD3, 0x9E, 0x50, 0x09, 0xA3, 0xE9, 0xF0, 0xA9, 0x05, 0x90, 0xA4, 0x96, 0xF0, 0x90, 0xA4, 0x96, -+0xE0, 0xB4, 0xFF, 0x0D, 0xE9, 0xF0, 0x90, 0xA4, 0x94, 0x12, 0x6D, 0x7E, 0x74, 0xFF, 0xF0, 0x80, -+0x08, 0x90, 0xA4, 0x94, 0x12, 0x6D, 0x7E, 0xE9, 0xF0, 0x90, 0xA4, 0x96, 0xE0, 0xFF, 0x22, 0xF5, -+0x83, 0xE4, 0x93, 0xFF, 0x90, 0xA4, 0x94, 0xE0, 0xFD, 0x12, 0x56, 0xBC, 0x90, 0xA4, 0x96, 0xEF, -+0xF0, 0x90, 0xA4, 0x98, 0xE0, 0x25, 0xE0, 0x22, 0x90, 0xA4, 0x94, 0xE0, 0xFD, 0x24, 0x91, 0x22, -+0x90, 0xA4, 0x95, 0xE0, 0x90, 0xA4, 0x98, 0x22, 0xEF, 0x04, 0xF5, 0x22, 0xE5, 0x22, 0xD3, 0x9D, -+0x50, 0x34, 0xE5, 0x22, 0xD1, 0x3A, 0x75, 0xF0, 0x08, 0xEB, 0x12, 0x52, 0xC1, 0xE0, 0xF5, 0x82, -+0x75, 0x83, 0x00, 0xE5, 0x22, 0x54, 0x07, 0x51, 0x60, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -+0xD8, 0xF9, 0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, 0x60, 0x05, 0x85, 0x22, 0x23, -+0x80, 0x04, 0x05, 0x22, 0x80, 0xC6, 0xAF, 0x23, 0x22, 0xEC, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, -+0x22, 0xE0, 0xFB, 0x7A, 0x00, 0xEC, 0x54, 0x07, 0x22, 0x25, 0xE0, 0x24, 0xE9, 0xF5, 0x82, 0xE4, -+0x34, 0x42, 0xF5, 0x83, 0x22, 0x7E, 0xFF, 0x74, 0xA2, 0x2F, 0x12, 0x6D, 0x81, 0x74, 0xFF, 0xF0, -+0xED, 0xB4, 0x3E, 0x0D, 0x7E, 0xBD, 0x74, 0xA2, 0x2F, 0x12, 0x6D, 0x81, 0x74, 0x3D, 0xF0, 0x80, -+0x1D, 0xED, 0xB4, 0x3F, 0x19, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4F, 0x6D, 0xC4, 0x13, 0x54, 0x07, -+0x30, 0xE0, 0x0B, 0x7E, 0x3E, 0x74, 0xA2, 0x2F, 0x12, 0x6D, 0x81, 0x74, 0x3E, 0xF0, 0xED, 0x14, -+0xFD, 0x74, 0x22, 0x2F, 0x12, 0x95, 0xFD, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0xE4, 0xF5, 0x55, 0xF5, -+0x56, 0xF5, 0x57, 0x75, 0x58, 0x80, 0xAD, 0x55, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xAD, 0x56, 0x7F, -+0x51, 0x12, 0x3A, 0x96, 0xAD, 0x57, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xAD, 0x58, 0x7F, 0x53, 0x02, -+0x3A, 0x96, 0x75, 0x5D, 0x12, 0xE4, 0xF5, 0x5E, 0x75, 0x5F, 0x07, 0x75, 0x60, 0x72, 0x90, 0x01, -+0x30, 0xE5, 0x5D, 0xF0, 0xA3, 0xE5, 0x5E, 0xF0, 0xA3, 0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, 0xF0, -+0x22, 0x75, 0x65, 0x0E, 0x43, 0x65, 0x10, 0x75, 0x66, 0x01, 0x75, 0x67, 0x03, 0x75, 0x68, 0x62, -+0x43, 0x65, 0x01, 0x90, 0x01, 0x38, 0xE5, 0x65, 0xF0, 0xA3, 0xE5, 0x66, 0xF0, 0xA3, 0xE5, 0x67, -+0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, -+0xE4, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, -+0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, -+0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, -+0x04, 0xF0, 0x22, 0x7F, 0x02, 0x90, 0xA3, 0xB5, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x10, 0xEF, -+0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x03, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xE6, 0x7F, -+0x01, 0x22, 0xE4, 0x90, 0xA1, 0x23, 0x12, 0x50, 0x6C, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, -+0x29, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x5D, 0xF5, 0x61, 0xA3, 0xE0, -+0x55, 0x5E, 0xF5, 0x62, 0xA3, 0xE0, 0x55, 0x5F, 0xF5, 0x63, 0xA3, 0xE0, 0x55, 0x60, 0xF5, 0x64, -+0x90, 0x01, 0x34, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, 0x62, 0xF0, 0xA3, 0xE5, 0x63, 0xF0, 0xA3, 0xE5, -+0x64, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x65, 0xF5, 0x69, 0xA3, 0xE0, 0x55, 0x66, 0xF5, -+0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, 0x6B, 0xA3, 0xE0, 0x55, 0x68, 0xF5, 0x6C, 0x90, 0x01, 0x3C, -+0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, 0x6B, 0xF0, 0xA3, 0xE5, 0x6C, 0xF0, 0x53, -+0x91, 0xDF, 0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0xA4, 0x9C, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, -+0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, -+0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x50, 0x46, -+0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x3A, 0x96, 0x80, 0xFE, 0x22, 0x12, -+0x9F, 0x8F, 0x12, 0x5F, 0xC8, 0x30, 0xE0, 0x13, 0x90, 0xA3, 0x9E, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, -+0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, 0xF0, 0x90, 0xA3, 0x9E, 0xF0, 0x90, 0xA2, 0xEF, 0xE0, 0x60, -+0x2C, 0x90, 0xA2, 0xEB, 0x12, 0x67, 0x81, 0x30, 0xE0, 0x0C, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, -+0x05, 0x12, 0x7F, 0xB8, 0x11, 0x62, 0x90, 0xA5, 0x84, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x80, -+0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x01, 0x02, -+0x97, 0x35, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7F, 0xBC, 0x90, 0xA2, 0xF2, 0xE0, 0x64, 0x02, 0x60, -+0x03, 0x12, 0x8C, 0xBC, 0x22, 0x90, 0xA2, 0xEF, 0xE0, 0x60, 0x03, 0x12, 0x67, 0xA8, 0x22, 0xE4, -+0xFF, 0x90, 0xA3, 0xF0, 0xEF, 0xF0, 0x90, 0xA2, 0xE4, 0xE0, 0x90, 0xA4, 0x72, 0xF0, 0xE4, 0x90, -+0xA3, 0xF1, 0xF0, 0x90, 0xA4, 0x72, 0xE0, 0xFE, 0x90, 0xA3, 0xF1, 0xE0, 0xFF, 0xC3, 0x9E, 0x50, -+0x2C, 0xE0, 0xFE, 0x31, 0x7E, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xEE, 0x31, 0xB0, 0xE0, 0x30, 0xE7, -+0x09, 0x74, 0x81, 0x2F, 0x31, 0x88, 0xE4, 0xF0, 0x80, 0x0B, 0x31, 0xA5, 0x90, 0xA3, 0xF1, 0xE0, -+0x31, 0x7E, 0x74, 0x01, 0xF0, 0x90, 0xA3, 0xF1, 0xE0, 0x04, 0xF0, 0x80, 0xC6, 0x7F, 0x0C, 0x7E, -+0x00, 0x12, 0x3A, 0xF7, 0xE4, 0x90, 0xA3, 0xF1, 0xF0, 0x90, 0xA4, 0x72, 0xE0, 0xFF, 0x90, 0xA3, -+0xF1, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0x21, 0x7D, 0x74, 0xF2, 0x2E, 0x31, 0x80, 0xE0, 0x70, -+0x02, 0x21, 0x75, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x06, 0x31, 0x90, 0xEE, 0x90, 0x81, 0x07, -+0x31, 0x99, 0xFC, 0x51, 0x24, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, -+0x0A, 0x31, 0x90, 0xEC, 0x90, 0x81, 0x0B, 0x31, 0x99, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x12, -+0x4A, 0x2A, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x7F, 0x01, 0x90, 0xA3, 0xF1, 0xE0, 0xFE, 0x75, 0xF0, -+0x10, 0x90, 0x81, 0x0B, 0x12, 0x52, 0xC4, 0xE0, 0xFD, 0x75, 0xF0, 0x0A, 0xEE, 0x12, 0x57, 0x98, -+0xED, 0xF0, 0x0F, 0xEF, 0xB4, 0x05, 0xE2, 0x90, 0xA3, 0xF1, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0x90, -+0x81, 0x09, 0x12, 0x4A, 0x2A, 0xE0, 0xFE, 0x74, 0x91, 0x2F, 0x51, 0x1A, 0xEE, 0xF0, 0x90, 0xA3, -+0xF1, 0xE0, 0xFF, 0x90, 0xA3, 0xF0, 0xE0, 0xFD, 0x31, 0xB6, 0x90, 0xA3, 0xF1, 0xE0, 0x24, 0x81, -+0x31, 0x88, 0x74, 0x01, 0xF0, 0x90, 0xA3, 0xF1, 0xE0, 0x04, 0xF0, 0x01, 0xD9, 0x22, 0x24, 0xF2, -+0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, -+0x12, 0x4A, 0x2A, 0xE0, 0xFD, 0x75, 0xF0, 0x10, 0x22, 0x12, 0x4A, 0x2A, 0xE0, 0xFE, 0xED, 0xFF, -+0x90, 0xA3, 0xF1, 0xE0, 0x22, 0x31, 0xAC, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0x75, 0xF0, 0x10, 0xEF, -+0x90, 0x81, 0x03, 0x02, 0x4A, 0x2A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x45, -+0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x01, 0x12, 0x57, 0xA2, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, -+0x8D, 0x03, 0x12, 0x57, 0xA2, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x05, 0x12, 0x57, 0xA2, -+0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x07, 0x12, 0x57, 0xA2, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, -+0x90, 0x8D, 0x09, 0x12, 0x57, 0xA2, 0xF0, 0xEF, 0x51, 0x24, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x91, -+0x2F, 0x51, 0x1A, 0xE4, 0xF0, 0x31, 0xAC, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0x31, 0xAC, 0xEE, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x91, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, -+0x83, 0x22, 0xE5, 0x0E, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0x22, -+0x02, 0x77, 0x8C, 0x22, 0x22, 0x22, 0xFB, 0x7D, 0x08, 0x7F, 0x01, 0x90, 0xA5, 0x78, 0xEB, 0xF0, -+0xEF, 0x70, 0x06, 0xA3, 0x74, 0x03, 0xF0, 0x80, 0x0B, 0xEF, 0x64, 0x01, 0x70, 0x28, 0x90, 0xA5, -+0x79, 0x74, 0x42, 0xF0, 0x7F, 0xE2, 0x12, 0x3A, 0x96, 0x90, 0xA5, 0x78, 0xE0, 0xFD, 0x7F, 0xE0, -+0x12, 0x3A, 0x96, 0x90, 0xA5, 0x79, 0xE0, 0x51, 0x81, 0x90, 0xA5, 0x79, 0xE0, 0x54, 0xFD, 0x51, -+0x81, 0x51, 0x80, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, -+0xE4, 0xFD, 0x7F, 0xE3, 0x02, 0x3A, 0x96, 0x90, 0xA5, 0x43, 0x12, 0x4A, 0x3F, 0xEF, 0x70, 0x07, -+0x90, 0xA5, 0x46, 0x04, 0xF0, 0x80, 0x0B, 0xEF, 0x64, 0x01, 0x70, 0x25, 0x90, 0xA5, 0x46, 0x74, -+0x40, 0xF0, 0x7F, 0xE2, 0x12, 0x3A, 0x96, 0x90, 0xA5, 0x46, 0xE0, 0x51, 0x81, 0x90, 0x00, 0xE1, -+0xE0, 0xFF, 0x90, 0xA5, 0x43, 0x12, 0x4A, 0x36, 0xEF, 0x12, 0x26, 0x64, 0x51, 0x80, 0x7F, 0x01, -+0x22, 0x80, 0xB3, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x0D, 0x7D, 0x08, 0x7F, 0x01, 0x51, 0x87, 0x90, -+0xA5, 0x0D, 0xE0, 0x22, 0xE4, 0x90, 0xA4, 0xAE, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, -+0xA4, 0xAD, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, 0xA4, 0xAD, 0xE0, 0xFF, 0xB5, 0x06, 0x01, -+0x22, 0xC3, 0x90, 0xA4, 0xAF, 0xE0, 0x94, 0x64, 0x90, 0xA4, 0xAE, 0xE0, 0x94, 0x00, 0x40, 0x0D, -+0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA4, 0xAD, 0xE0, 0xFF, 0x22, 0x90, 0xA4, 0xAE, -+0x12, 0x58, 0xAB, 0x80, 0xC6, 0x90, 0x01, 0xC4, 0x74, 0x15, 0xF0, 0x74, 0xAB, 0xA3, 0xF0, 0x90, -+0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x74, 0x15, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xAB, 0xA3, -+0xF0, 0x22, 0x7E, 0xFF, 0xED, 0x54, 0x7F, 0xFC, 0xED, 0x54, 0x80, 0x60, 0x04, 0xAE, 0x04, 0x80, -+0x1B, 0xEC, 0x64, 0x3D, 0x60, 0x04, 0xEC, 0xB4, 0x3F, 0x12, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4F, -+0x6D, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x04, 0xEC, 0x44, 0x80, 0xFE, 0xAF, 0x06, 0x22, 0xE4, -+0xF5, 0x1A, 0x12, 0x54, 0xFA, 0xE0, 0xFE, 0xB4, 0x05, 0x14, 0xED, 0xC3, 0x94, 0x3B, 0x50, 0x5B, -+0xED, 0xC3, 0x94, 0x31, 0x40, 0x5D, 0xED, 0xD3, 0x94, 0x35, 0x50, 0x57, 0x80, 0x4D, 0xEE, 0xB4, -+0x04, 0x08, 0xED, 0xC3, 0x94, 0x31, 0x40, 0x4B, 0x80, 0x41, 0x12, 0x54, 0xFA, 0xE0, 0xFE, 0xB4, -+0x03, 0x14, 0xED, 0xC3, 0x94, 0x19, 0x50, 0x0C, 0xED, 0xC3, 0x94, 0x11, 0x40, 0x35, 0xED, 0xD3, -+0x94, 0x13, 0x50, 0x2F, 0x80, 0x25, 0xEE, 0xB4, 0x02, 0x08, 0xED, 0xC3, 0x94, 0x11, 0x40, 0x23, -+0x80, 0x19, 0x12, 0x54, 0xFA, 0xE0, 0xFE, 0xB4, 0x01, 0x08, 0xED, 0xC3, 0x94, 0x0A, 0x40, 0x13, -+0x80, 0x09, 0xEE, 0x70, 0x0B, 0xED, 0xC3, 0x94, 0x03, 0x40, 0x08, 0x75, 0x1A, 0x01, 0x80, 0x03, -+0xE4, 0xF5, 0x1A, 0xAF, 0x1A, 0x22, 0x8F, 0x0F, 0x8D, 0x10, 0x8B, 0x11, 0x75, 0xF0, 0x04, 0xEF, -+0x12, 0x4D, 0xE3, 0xC4, 0x54, 0x03, 0x90, 0xA4, 0x87, 0xF0, 0x90, 0xA4, 0x85, 0x60, 0x09, 0x74, -+0x32, 0xF0, 0xA3, 0x74, 0x2F, 0xF0, 0x80, 0x07, 0x74, 0x11, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0x75, -+0xF0, 0x10, 0xE5, 0x0F, 0x12, 0x6F, 0xBD, 0xE0, 0xFD, 0x90, 0xA4, 0xBB, 0x74, 0x04, 0xF0, 0xE4, -+0xFB, 0xAF, 0x0F, 0x12, 0x90, 0xAD, 0xE5, 0x10, 0xD3, 0x94, 0x2D, 0x40, 0x0A, 0x75, 0xF0, 0x04, -+0xE5, 0x0F, 0x12, 0x57, 0x92, 0x80, 0x20, 0xE5, 0x10, 0xD3, 0x94, 0x1E, 0x40, 0x05, 0x90, 0xA4, -+0x85, 0x80, 0x14, 0xE5, 0x10, 0xD3, 0x94, 0x14, 0x40, 0x05, 0x90, 0xA4, 0x86, 0x80, 0x08, 0x75, -+0xF0, 0x04, 0xE5, 0x0F, 0x12, 0x56, 0xA1, 0xE0, 0xFD, 0x85, 0x11, 0x77, 0xE4, 0xFB, 0xAF, 0x0F, -+0x02, 0x90, 0xE4, 0xEF, 0x64, 0x13, 0x60, 0x04, 0xEF, 0xB4, 0x0B, 0x05, 0x90, 0xA3, 0x99, 0x80, -+0x1F, 0xEF, 0x64, 0x12, 0x60, 0x04, 0xEF, 0xB4, 0x0A, 0x05, 0x90, 0xA3, 0x9A, 0x80, 0x11, 0xEF, -+0x64, 0x11, 0x60, 0x04, 0xEF, 0xB4, 0x09, 0x05, 0x90, 0xA3, 0x9B, 0x80, 0x03, 0x90, 0xA3, 0x98, -+0xE0, 0xF5, 0x1C, 0xAF, 0x1C, 0x22, 0x8D, 0x1A, 0x90, 0xA3, 0x97, 0xE0, 0x60, 0x44, 0x91, 0x53, -+0x8F, 0x1B, 0xE5, 0x1B, 0xC3, 0x94, 0x80, 0x50, 0x27, 0xE5, 0x1B, 0x94, 0x1B, 0x40, 0x02, 0x80, -+0x12, 0xED, 0x25, 0x1B, 0xFF, 0xE4, 0x33, 0xFE, 0xD3, 0xEF, 0x94, 0x1B, 0xEE, 0x64, 0x80, 0x94, -+0x80, 0x40, 0x05, 0x75, 0x1A, 0x1B, 0x80, 0x1A, 0xE5, 0x1B, 0x25, 0x1A, 0xF5, 0x1A, 0x80, 0x12, -+0xC3, 0xE4, 0x95, 0x1B, 0xF5, 0x1B, 0xED, 0xD3, 0x95, 0x1B, 0x40, 0x06, 0xE5, 0x1A, 0x95, 0x1B, -+0xF5, 0x1A, 0xAF, 0x1A, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x30, 0x12, -+0x5F, 0x8F, 0x90, 0xA4, 0x76, 0xE0, 0x90, 0x04, 0x33, 0xF0, 0x90, 0xA4, 0x77, 0xE0, 0x90, 0x04, -+0x34, 0xF0, 0x90, 0xA4, 0x78, 0xE0, 0x90, 0x04, 0x35, 0xF0, 0x90, 0xA4, 0x79, 0xE0, 0x90, 0x04, -+0x36, 0xF0, 0x90, 0xA4, 0x7A, 0xE0, 0x90, 0x04, 0x37, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -+0xEF, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x03, 0x7F, 0x05, 0x22, 0xD3, 0xEF, 0x94, 0xC8, 0xEE, -+0x94, 0x00, 0x7F, 0x00, 0x40, 0x02, 0x7F, 0x02, 0x22, 0x90, 0xA4, 0x8D, 0xEE, 0xF0, 0xA3, 0x12, -+0x5F, 0x8F, 0x90, 0xA4, 0x8F, 0xE0, 0xB1, 0xF8, 0x90, 0xA4, 0x94, 0x12, 0x4A, 0x3F, 0x90, 0xA4, -+0x90, 0xE0, 0xD1, 0x0A, 0xA3, 0x12, 0x4A, 0x3F, 0xB1, 0xE8, 0xFF, 0xB1, 0x0F, 0x8F, 0x1E, 0xA3, -+0x12, 0x97, 0x44, 0xF5, 0x83, 0xE0, 0xF5, 0x1A, 0xA3, 0xE0, 0xF5, 0x1B, 0xE4, 0xF5, 0x1F, 0x90, -+0xA4, 0x94, 0x12, 0x4A, 0x36, 0x75, 0xF0, 0x02, 0xE5, 0x1F, 0xD1, 0x24, 0xA8, 0x1E, 0x08, 0x80, -+0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xA4, 0x91, 0x12, 0x4A, 0x36, 0x85, -+0x1F, 0x82, 0x12, 0x6F, 0xEB, 0xB1, 0xF0, 0x25, 0x1B, 0xF5, 0x1B, 0xEE, 0x35, 0x1A, 0xF5, 0x1A, -+0x05, 0x1F, 0xE5, 0x1F, 0xB4, 0x05, 0xC8, 0x90, 0xA4, 0x91, 0x12, 0x4A, 0x36, 0x12, 0x4F, 0x76, -+0xFD, 0x7C, 0x00, 0xB1, 0xE8, 0xA8, 0x1E, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, -+0xF9, 0xFF, 0x12, 0x26, 0x98, 0x8E, 0x1C, 0x8F, 0x1D, 0xD3, 0xE5, 0x1B, 0x95, 0x1D, 0xE5, 0x1A, -+0x95, 0x1C, 0x40, 0x0C, 0xE5, 0x1B, 0x95, 0x1D, 0xFF, 0xE5, 0x1A, 0x95, 0x1C, 0xFE, 0x80, 0x04, -+0x7E, 0x00, 0x7F, 0x00, 0x8E, 0x1A, 0x8F, 0x1B, 0x90, 0xA4, 0x8F, 0x12, 0x97, 0x44, 0xF5, 0x83, -+0xE5, 0x1A, 0xF0, 0xA3, 0xE5, 0x1B, 0xF0, 0x22, 0x90, 0xA4, 0x8D, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, -+0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x22, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x01, 0xF9, 0x74, -+0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x22, 0x8F, 0x15, 0xEF, 0x75, 0xF0, 0x06, 0xA4, 0x24, 0x5C, -+0xF9, 0x74, 0x40, 0x35, 0xF0, 0xFA, 0x7B, 0xFF, 0x22, 0x90, 0xA4, 0x81, 0x12, 0x4A, 0x36, 0x75, -+0xF0, 0x02, 0xE5, 0x17, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x49, 0xC0, 0xAE, 0xF0, 0x22, -+0x12, 0x4F, 0xD0, 0x12, 0x4F, 0x76, 0x30, 0xE1, 0x03, 0x02, 0x94, 0x4C, 0x12, 0x4F, 0x94, 0x12, -+0x26, 0x1E, 0x90, 0xA4, 0x85, 0x12, 0x7F, 0x56, 0x90, 0xA4, 0x86, 0x12, 0x4F, 0x60, 0x90, 0xA4, -+0x87, 0x12, 0x7F, 0xD5, 0x75, 0xF0, 0x10, 0xA4, 0xFF, 0x12, 0x55, 0xC8, 0xFD, 0xEF, 0x4D, 0xFF, -+0x90, 0xA4, 0x86, 0xE0, 0xB4, 0x01, 0x07, 0xA3, 0xE0, 0x12, 0x97, 0xD5, 0xEF, 0xF0, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x7A, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, -+0xE6, 0x3D, 0x90, 0x00, 0x8D, 0xE0, 0x64, 0x01, 0x70, 0x35, 0x90, 0xA5, 0x7B, 0xF0, 0x90, 0xA5, -+0x7B, 0xE0, 0xFD, 0x90, 0xA5, 0x7A, 0xE0, 0x75, 0xF0, 0x10, 0x12, 0x6F, 0xBD, 0xE5, 0x82, 0x2D, -+0x12, 0x52, 0xCA, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x4F, 0x2B, 0x90, 0xA5, 0x7B, 0xE0, 0x04, 0xF0, -+0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD8, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x02, 0xD1, 0xC4, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFD, 0x7F, 0x8D, 0x02, 0x3A, 0x96, 0x7E, 0x00, 0x7F, 0x2E, 0x7D, -+0x00, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0xB6, 0x02, 0x4A, 0x6E, 0x90, 0xA5, 0x85, 0xED, 0xF0, 0xEF, -+0x60, 0x02, 0xE1, 0xB2, 0xE0, 0x24, 0xFD, 0x50, 0x0B, 0x60, 0x20, 0x14, 0x60, 0x34, 0x14, 0x60, -+0x74, 0x02, 0xB1, 0x45, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x12, 0xB1, -+0x51, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x02, 0xB0, 0x2D, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x54, 0x54, 0x33, 0x77, 0x70, 0x12, 0xB1, 0x51, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0x02, -+0xB0, 0xAD, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x12, 0xB1, 0x51, 0x12, -+0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x12, 0xB1, 0x46, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, -+0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x10, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x66, -+0x65, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x10, -+0x00, 0x00, 0x02, 0xB1, 0x3E, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, -+0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x77, 0x12, 0xB1, 0x5C, 0x12, 0x27, 0x54, 0x77, -+0x77, 0x77, 0x77, 0x12, 0xB1, 0x46, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xE4, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x66, 0x65, 0x12, 0x27, -+0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x02, -+0xB1, 0x3E, 0x90, 0xA5, 0x85, 0xE0, 0x14, 0x60, 0x61, 0x14, 0x70, 0x03, 0x02, 0xB0, 0x5A, 0x14, -+0x70, 0x03, 0x02, 0xB0, 0x9A, 0x14, 0x70, 0x03, 0x02, 0xB0, 0x5A, 0x14, 0x70, 0x03, 0x02, 0xB0, -+0xF6, 0x24, 0x05, 0x60, 0x03, 0x02, 0xB1, 0x45, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x33, -+0x77, 0x17, 0x12, 0xB1, 0x51, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x12, 0xB1, 0x46, 0x12, -+0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, -+0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x66, 0x65, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA4, -+0xE4, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x21, 0x3E, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, -+0x77, 0x33, 0x77, 0x17, 0x31, 0x51, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x31, 0x46, 0x12, -+0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, -+0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x66, 0x65, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA4, -+0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x21, 0x3E, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, -+0x77, 0x33, 0x77, 0x77, 0x31, 0x51, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x77, 0x31, 0x46, 0x12, -+0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, -+0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x66, 0x65, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA4, -+0xE4, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x21, 0x3E, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, -+0x54, 0x33, 0x77, 0x17, 0x31, 0x51, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x17, 0x31, 0x46, 0x12, -+0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, -+0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x66, 0x65, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA4, -+0xE4, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0E, 0x12, 0x66, 0x65, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x03, 0x03, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, -+0x7F, 0x00, 0x7E, 0x09, 0x80, 0x4C, 0x90, 0xA4, 0xE0, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, 0x00, -+0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x00, 0x33, 0x00, 0x00, 0x31, 0x5C, 0x12, 0x27, 0x54, 0x77, -+0x33, 0x77, 0x77, 0x31, 0x46, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, -+0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x66, 0x65, 0x12, 0x27, 0x54, -+0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA4, 0xE4, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, -+0x7E, 0x0E, 0x12, 0x64, 0x33, 0x22, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0xA4, 0xE0, -+0x22, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x22, 0x7F, 0xB0, 0x7E, 0x0C, -+0x12, 0x64, 0x33, 0x90, 0xAC, 0xB9, 0x22, 0x90, 0xA3, 0xE7, 0xE0, 0x75, 0xF0, 0x3F, 0x84, 0xAD, -+0xF0, 0xED, 0x25, 0xE0, 0x25, 0xE0, 0xFD, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xED, 0xF0, 0x90, 0xA3, 0xE7, 0xE0, 0x04, 0xF0, 0x22, 0x12, 0x67, 0x7E, 0x30, 0xE0, 0x05, -+0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, -+0x31, 0xC0, 0x90, 0xA3, 0x4E, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0x90, 0xA5, 0x21, 0xF0, 0xE4, 0xFB, -+0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x70, 0x20, 0x90, 0xA2, 0xEA, 0xE0, 0x44, 0x08, 0xF0, 0x22, -+0xF0, 0xE4, 0x90, 0xA5, 0x20, 0xF0, 0x22, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, -+0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x53, 0xE0, 0x30, 0xE0, 0x17, 0x90, 0xA3, -+0x65, 0xE0, 0x70, 0x4B, 0x90, 0xA2, 0xF1, 0xE0, 0xD3, 0x94, 0x00, 0x50, 0x42, 0x90, 0xA3, 0x52, -+0xE0, 0x60, 0x38, 0x80, 0x3A, 0x31, 0xC7, 0xEF, 0x64, 0x01, 0x70, 0x33, 0x90, 0xA2, 0xF3, 0xE0, -+0xFF, 0x54, 0x03, 0x70, 0x2A, 0x90, 0xA2, 0xF1, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x40, 0x20, 0xEF, -+0x20, 0xE2, 0x1C, 0x90, 0xA2, 0xF3, 0xE0, 0x20, 0xE4, 0x15, 0x90, 0xA2, 0xEB, 0xE0, 0x13, 0x13, -+0x54, 0x3F, 0x30, 0xE0, 0x0A, 0x90, 0xA3, 0x52, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, -+0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0B, 0x04, 0x70, 0x24, 0x90, 0xA2, -+0xF5, 0x74, 0x02, 0xF0, 0x80, 0x13, 0xED, 0x70, 0x06, 0x90, 0xA3, 0x4F, 0xE0, 0x80, 0x02, 0xED, -+0x14, 0x90, 0xA2, 0xF5, 0xF0, 0x90, 0xA2, 0xF5, 0xE0, 0xA3, 0xF0, 0x90, 0xA2, 0xEB, 0xE0, 0x44, -+0x08, 0xF0, 0x22, 0x90, 0x02, 0x87, 0xE0, 0x70, 0x1F, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x70, -+0x17, 0x90, 0x02, 0x96, 0xE0, 0x70, 0x11, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE1, 0x0A, 0x90, 0x02, -+0x86, 0xE0, 0x20, 0xE3, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0xEF, 0x60, 0x2D, 0x12, 0x8E, -+0x0F, 0x70, 0x28, 0x90, 0xA2, 0xEB, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, 0x2B, 0x7F, 0x0F, 0x12, 0x59, -+0x62, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0x51, 0xCC, 0xBF, 0x01, 0x0E, 0x90, 0xA2, 0xEA, -+0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x06, 0x7F, 0x01, 0x12, 0x62, 0x4F, 0x22, 0x7D, 0x08, 0xE4, 0xFF, -+0x02, 0x5B, 0xB9, 0x7D, 0x2D, 0x12, 0x5A, 0xB1, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, -+0x03, 0x12, 0x8C, 0x77, 0x12, 0x76, 0xC3, 0xE4, 0xFD, 0x7F, 0x01, 0x02, 0x62, 0x4F, 0x7D, 0x2E, -+0x7F, 0x6F, 0x12, 0x59, 0x62, 0x7D, 0x02, 0x7F, 0x01, 0x02, 0x62, 0x4F, 0x90, 0xA2, 0xEA, 0xE0, -+0x30, 0xE0, 0x03, 0x12, 0x79, 0x00, 0x22, 0x7D, 0x2F, 0x7F, 0xFF, 0x12, 0x59, 0x62, 0x12, 0x76, -+0xC3, 0x7D, 0x08, 0x7F, 0x01, 0x02, 0x62, 0x4F, 0x90, 0xA5, 0x30, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x71, 0x87, 0x44, 0x01, 0xF0, 0x71, 0x87, -+0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0x12, 0x5F, 0x1E, 0xE0, 0x44, 0xFA, 0xF0, 0x74, -+0x11, 0x2C, 0x71, 0xE0, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, 0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, -+0xF0, 0x90, 0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, -+0x71, 0x7F, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0x71, 0x7F, 0xED, 0xF0, 0x22, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x22, 0x90, 0xA4, 0xAF, 0xE0, 0xFF, 0x90, 0xA5, 0x42, 0x74, 0x0C, 0xF0, 0xE4, 0xFB, -+0x7D, 0x01, 0x12, 0x5C, 0xC2, 0x90, 0xA4, 0xB2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA4, 0xB0, -+0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAB, 0x07, 0x90, 0xA4, -+0xB5, 0xED, 0xF0, 0xEC, 0xF9, 0xE0, 0xFF, 0xAE, 0x03, 0x74, 0x2A, 0x2E, 0x71, 0xE8, 0x12, 0x5F, -+0xD2, 0xE9, 0xF0, 0x74, 0x0D, 0x2E, 0x71, 0x8A, 0x44, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, -+0xF0, 0x22, 0x90, 0xA5, 0x2E, 0xE0, 0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, -+0x89, 0xEF, 0xF0, 0x90, 0xA1, 0xE2, 0xE0, 0xFF, 0x90, 0x04, 0x1C, 0xE0, 0x6F, 0x70, 0x38, 0x90, -+0xA2, 0xF2, 0xE0, 0x64, 0x0E, 0x70, 0x10, 0x90, 0xA5, 0x89, 0xE0, 0x70, 0x2A, 0x91, 0x4C, 0x12, -+0x67, 0xDE, 0x12, 0x62, 0x4B, 0x80, 0x1D, 0x90, 0xA2, 0xF2, 0xE0, 0x64, 0x06, 0x70, 0x18, 0x90, -+0xA5, 0x89, 0xE0, 0x60, 0x12, 0x90, 0xA2, 0xEA, 0xE0, 0x54, 0xBF, 0xF0, 0x91, 0x54, 0x90, 0xA2, -+0xF2, 0x74, 0x04, 0xF0, 0x12, 0x67, 0x98, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0xEA, 0xE0, -+0x54, 0x7F, 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x22, -+0xE4, 0xFE, 0xEF, 0x25, 0xE0, 0xFD, 0xEF, 0xC3, 0x94, 0x80, 0x90, 0xFD, 0x12, 0x50, 0x04, 0xE4, -+0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x90, 0xA1, -+0xE4, 0xE0, 0xFF, 0x90, 0xA5, 0x42, 0x74, 0x01, 0xF0, 0x7B, 0x08, 0xFD, 0x12, 0x5C, 0xC2, 0x90, -+0xA4, 0xB0, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA4, 0xAD, 0xE0, 0xFF, 0xA3, 0xE0, -+0xFB, 0xA3, 0xE0, 0x90, 0xA4, 0xB7, 0xF0, 0x22, 0x7F, 0x64, 0x7E, 0x08, 0x12, 0x64, 0x33, 0x90, -+0xA5, 0x2A, 0x12, 0x4A, 0x12, 0xE4, 0xFF, 0xFE, 0xFD, 0xEC, 0x54, 0x04, 0xFC, 0x90, 0xA4, 0xE0, -+0x22, 0x90, 0xA5, 0x29, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x1C, 0x12, 0x27, 0x35, 0x90, -+0xA4, 0xE4, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x22, 0x7F, 0x2C, 0x7E, 0x08, 0x12, 0x64, 0x33, 0x90, -+0xA5, 0x6E, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0xAE, 0xDA, 0x90, 0xA4, 0xE0, 0x22, 0xF0, 0x74, -+0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x74, 0x22, 0x25, 0x0E, 0xF5, -+0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0x22, 0x90, 0xA3, 0x01, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, -+0xA3, 0x08, 0xE0, 0xFB, 0x90, 0xA5, 0x5A, 0x22, 0x75, 0xF0, 0x04, 0xE5, 0x0E, 0x90, 0x9B, 0x14, -+0x12, 0x4A, 0x2A, 0xE0, 0x22, 0x90, 0xA3, 0x0C, 0xE0, 0x24, 0x04, 0x90, 0xA3, 0x07, 0xF0, 0xA3, -+0x74, 0x0A, 0xF0, 0x22, 0x90, 0x06, 0xCD, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x06, 0xCF, 0xE0, 0x44, -+0x10, 0xF0, 0x22, 0x90, 0xA3, 0x56, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x22, 0xFD, 0x75, 0xF0, 0x0E, -+0x90, 0xA3, 0xBA, 0x02, 0x4A, 0x2A, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, -+0x0E, 0x22, 0x90, 0xA3, 0x59, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0xA3, 0x52, 0xE0, 0x22, 0x12, 0x4A, -+0x2A, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, 0x82, 0x8C, 0x83, 0x22, 0x74, 0x05, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x22, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x39, 0xF9, 0x74, 0xA2, 0x35, 0xF0, 0x22, 0x7F, 0xB4, -+0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEC, 0x54, 0xF3, 0x22, 0x90, 0xA2, 0xF1, 0xE0, 0xFF, 0xE4, 0xFD, -+0x02, 0x60, 0x4D, 0xFC, 0xE5, 0x13, 0xC3, 0x13, 0xFE, 0xE5, 0x14, 0x13, 0xFF, 0x22, 0x90, 0xA3, -+0xB7, 0xE0, 0xFE, 0xC3, 0x13, 0x54, 0x07, 0x22, 0x90, 0xA5, 0x4A, 0xE0, 0xFF, 0x90, 0xA5, 0x48, -+0xE0, 0x22, 0x90, 0xA4, 0x90, 0x74, 0x09, 0xF0, 0x90, 0xA4, 0x84, 0x22, 0x74, 0x01, 0x93, 0x95, -+0x12, 0xE4, 0x93, 0x95, 0x11, 0x22, 0xE4, 0x90, 0xA3, 0x68, 0xF0, 0x90, 0xA5, 0x86, 0x22, 0x54, -+0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0x22, 0x90, 0xA3, 0x56, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, -+0x22, 0xE4, 0x90, 0xA3, 0x5B, 0xF0, 0x90, 0xA3, 0x66, 0x22, 0xE5, 0x6F, 0x75, 0xF0, 0x08, 0xA4, -+0x25, 0x6E, 0x22, 0xFF, 0x90, 0xA5, 0x6C, 0xE0, 0xFB, 0xEF, 0x5B, 0x22, 0x7F, 0xB4, 0x7E, 0x08, -+0x12, 0x36, 0xCE, 0xEF, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x90, 0x06, -+0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x7F, 0xB4, 0x7E, 0x08, 0x02, 0x37, 0x5D, 0x7F, 0x00, 0x7E, -+0x0E, 0x02, 0x37, 0x5D, 0x7F, 0xB4, 0x7E, 0x0C, 0x02, 0x37, 0x5D, 0x7F, 0xB0, 0x7E, 0x0E, 0x02, -+0x37, 0x5D, 0xFC, 0x90, 0xA4, 0xFC, 0x02, 0x27, 0x48, 0x90, 0xA4, 0xF8, 0x12, 0x4A, 0x12, 0xEC, -+0x22, 0x90, 0xA5, 0x86, 0xE0, 0x90, 0xA3, 0x66, 0x22, 0xC4, 0x54, 0x0F, 0x90, 0xA5, 0x4E, 0xF0, -+0x22, 0x90, 0x89, 0x07, 0x12, 0x4A, 0x2A, 0xE0, 0x22, 0x90, 0x89, 0x04, 0x12, 0x4A, 0x2A, 0xE0, -+0x22, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, 0x00, 0x74, 0xBE, -+}; -+u4Byte ArrayLength_MP_8812A_FW_NIC_BT = 30380; -+ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_NIC_BT( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8812A_FW_NIC_BT; -+#else -+ ODM_MoveMemory(pDM_Odm, pFirmware, Array_MP_8812A_FW_NIC_BT, ArrayLength_MP_8812A_FW_NIC_BT); -+#endif -+ *pFirmwareSize = ArrayLength_MP_8812A_FW_NIC_BT; -+} -+ -+ -+u1Byte Array_MP_8812A_FW_WoWLAN[] = { -+0x01, 0x95, 0x30, 0x00, 0x29, 0x00, 0x00, 0x00, 0x06, 0x17, 0x19, 0x26, 0xC8, 0x57, 0x00, 0x00, -+0x65, 0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x4C, 0x0D, 0x02, 0x78, 0x1D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x79, 0x29, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x7F, 0xDC, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x78, 0xA0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x7C, 0xA6, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, -+0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, -+0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, -+0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, -+0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, -+0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, -+0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, -+0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, -+0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, -+0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, -+0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, -+0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, -+0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, -+0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, -+0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, -+0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, -+0x82, 0x23, 0x90, 0x46, 0x30, 0x73, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, -+0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, 0x22, 0xEF, 0x2B, 0xFF, 0xEE, -+0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, 0xFE, -+0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, -+0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, -+0x22, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, 0xE8, 0x9C, 0x45, -+0xF0, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE0, 0xF8, -+0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, -+0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, -+0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, -+0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, -+0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0xE3, 0xF5, -+0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x6B, 0xDF, 0xF5, 0x80, 0x67, 0xE3, 0xF5, 0xF0, 0x09, 0xE6, -+0x08, 0xB5, 0xF0, 0x5E, 0xDF, 0xF5, 0x80, 0x5A, 0x87, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x52, -+0xDF, 0xF6, 0x80, 0x4E, 0x87, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x46, 0xDF, 0xF6, 0x80, 0x42, -+0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x36, 0xDF, 0xF6, 0x80, 0x32, -+0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x25, 0xDF, 0xF5, 0x80, -+0x21, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, 0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x14, 0xDF, 0xF5, -+0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x02, -+0xDF, 0xF4, 0x02, 0x48, 0xBD, 0x80, 0x87, 0x80, 0xE9, 0x80, 0x90, 0x80, 0xD4, 0x80, 0x3E, 0x80, -+0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, 0x80, 0xB7, 0x80, 0x8D, 0x80, 0xA3, 0x80, 0x51, 0x80, -+0x74, 0x80, 0x3C, 0x02, 0x48, 0xC9, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, -+0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x76, 0xDF, 0xE3, 0xDE, 0xE1, 0x80, 0x70, 0x89, 0x82, 0x8A, -+0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, 0xB5, 0xF0, 0x62, 0xDF, 0xF4, 0x80, 0x5E, 0x89, -+0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, 0x51, 0xDF, 0xF5, 0x80, 0x4D, -+0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, 0xB5, 0xF0, 0x40, 0xDF, 0xF5, 0x80, -+0x3C, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, 0x2E, 0xDF, -+0xF4, 0x80, 0x2A, 0x80, 0x02, 0x80, 0x57, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, -+0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x06, 0xDF, 0xE4, 0xDE, 0xE2, 0x80, 0x00, 0x7F, 0xFF, 0xB5, -+0xF0, 0x02, 0x0F, 0x22, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, -+0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, -+0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xD5, 0xDF, 0xE5, 0xDE, 0xE3, 0x80, 0xCF, 0x89, 0x82, -+0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, -+0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xAF, 0xDF, 0xE4, -+0xDE, 0xE2, 0x80, 0xA9, 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xAB, 0xED, 0x24, 0x02, -+0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x8E, 0x23, -+0x23, 0x45, 0x82, 0x23, 0x90, 0x48, 0x05, 0x73, 0xEF, 0x4E, 0x60, 0x12, 0xEF, 0x60, 0x01, 0x0E, -+0xED, 0xBB, 0x01, 0x0B, 0x89, 0x82, 0x8A, 0x83, 0xF0, 0xA3, 0xDF, 0xFC, 0xDE, 0xFA, 0x22, 0x89, -+0xF0, 0x50, 0x07, 0xF7, 0x09, 0xDF, 0xFC, 0xA9, 0xF0, 0x22, 0xBB, 0xFE, 0xFC, 0xF3, 0x09, 0xDF, -+0xFC, 0xA9, 0xF0, 0x22, 0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x49, 0x68, 0x85, 0xD0, 0x0B, 0x75, -+0xD0, 0x08, 0xAA, 0xE0, 0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, -+0xF5, 0x8C, 0xD2, 0x8C, 0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, -+0x81, 0xB4, 0x40, 0x00, 0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, -+0xAF, 0xE6, 0x30, 0xE1, 0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, -+0x22, 0xE5, 0x0C, 0xFF, 0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, -+0x78, 0x81, 0xE6, 0x30, 0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, -+0x86, 0x25, 0x0C, 0xF8, 0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, -+0xFF, 0xCD, 0xF8, 0xE8, 0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, -+0x9F, 0x40, 0x27, 0xE5, 0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, -+0xFD, 0x18, 0xE6, 0xCD, 0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, -+0xE5, 0x0C, 0x24, 0x86, 0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, -+0x7F, 0x04, 0xC2, 0xAF, 0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, -+0x30, 0xE3, 0x04, 0x7F, 0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, -+0x22, 0x78, 0x86, 0xA6, 0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, -+0x03, 0xE4, 0x78, 0x80, 0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4C, -+0xA1, 0x74, 0x01, 0x93, 0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, -+0x75, 0x8C, 0x79, 0xD2, 0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, -+0xFF, 0x22, 0x74, 0x81, 0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, -+0xF6, 0xD2, 0xAF, 0xAE, 0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, -+0xF9, 0x08, 0xE6, 0x18, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, -+0x19, 0x19, 0xF7, 0x09, 0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, -+0x05, 0x81, 0x05, 0x81, 0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, -+0xEE, 0xB5, 0x0C, 0x02, 0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, -+0x19, 0xE7, 0x09, 0x09, 0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, -+0x04, 0xF8, 0xEF, 0x2F, 0x04, 0x90, 0x4C, 0xA1, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, -+0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, -+0xE6, 0x30, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, -+0x0A, 0x74, 0x86, 0x2F, 0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x49, 0xB1, 0x50, 0x2E, 0x74, 0x87, 0x2F, -+0xF8, 0xE6, 0xBF, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, -+0xE6, 0xFC, 0xE9, 0x6C, 0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, -+0xA6, 0x05, 0x1F, 0xE5, 0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, -+0xFD, 0x18, 0x86, 0x01, 0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, -+0xB5, 0x07, 0x02, 0xAC, 0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, -+0xF4, 0xE5, 0x0C, 0xB5, 0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, -+0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, -+0xE0, 0x02, 0xD2, 0xE4, 0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, -+0x49, 0xB0, 0x8F, 0xF0, 0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, -+0xF7, 0x0D, 0x7F, 0x08, 0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, 0x2E, 0x80, 0x07, 0x30, -+0xF1, 0x06, 0xED, 0xF6, 0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, -+0xE7, 0x23, 0x0E, 0x30, 0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, 0xC2, 0xAF, 0xE6, 0x10, -+0xE7, 0x13, 0x54, 0xEC, 0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x49, 0xB1, 0x7F, 0x08, 0x08, 0xEF, 0x44, -+0x83, 0xF4, 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0x02, 0x4C, 0x4B, -+0x02, 0x4A, 0x41, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, -+0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, -+0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, -+0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x4C, 0x90, 0xE4, 0x7E, -+0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, -+0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, -+0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, -+0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, -+0x41, 0x93, 0x42, 0x00, 0x41, 0x93, 0x43, 0x00, 0x41, 0x93, 0x52, 0x00, 0x41, 0x93, 0x56, 0x00, -+0x00, 0x50, 0x02, 0x58, 0x01, 0x5F, 0xF7, 0x90, 0x00, 0xF0, 0xE0, 0x7F, 0x01, 0x20, 0xE2, 0x02, -+0x7F, 0x03, 0x22, 0x91, 0xA7, 0x90, 0x8D, 0x07, 0xEF, 0xF0, 0x91, 0xC5, 0x90, 0x01, 0x64, 0x74, -+0x01, 0xF0, 0x02, 0x35, 0x95, 0x91, 0xEA, 0xB1, 0xF3, 0x12, 0x8B, 0x37, 0x12, 0x8B, 0x56, 0x12, -+0x8B, 0x11, 0xE4, 0xF5, 0x51, 0x75, 0x52, 0x58, 0xAB, 0x51, 0x7D, 0x02, 0x7F, 0x01, 0x12, 0x39, -+0x04, 0xAB, 0x52, 0x7D, 0x03, 0x7F, 0x01, 0x02, 0x39, 0x04, 0x90, 0x01, 0x30, 0xE4, 0xB1, 0x12, -+0x90, 0x01, 0x38, 0xB1, 0x12, 0xFD, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x51, 0x12, -+0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x53, 0x02, 0x3A, 0x96, -+0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x74, 0x5A, 0xE4, 0x90, 0x91, -+0x71, 0xB1, 0x12, 0x90, 0x91, 0x0F, 0xB1, 0x10, 0xA3, 0xB1, 0x10, 0x90, 0x91, 0x21, 0xF0, 0xA3, -+0xF0, 0x90, 0x91, 0x63, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x91, 0xE5, 0xEF, 0xF0, 0xA3, 0x12, 0x47, -+0x5F, 0xB1, 0xED, 0x8B, 0x40, 0x8A, 0x41, 0xB1, 0xD6, 0x24, 0x02, 0xB1, 0x9C, 0xB1, 0xED, 0xE9, -+0x24, 0x04, 0xB1, 0xCF, 0x24, 0x03, 0xB1, 0x9C, 0xB1, 0xED, 0xE9, 0x24, 0x08, 0xB1, 0xCF, 0x24, -+0x04, 0xB1, 0x9C, 0xB1, 0xED, 0xE9, 0x24, 0x0C, 0xB1, 0xCF, 0x24, 0x05, 0xB1, 0x9C, 0x90, 0x91, -+0xE5, 0xE0, 0xFE, 0x44, 0x50, 0x90, 0x91, 0xE9, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0xA3, 0x74, 0xFF, -+0xF0, 0xA3, 0xF0, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0xB1, 0x9C, 0x90, 0x91, 0xE9, 0x74, 0xFF, 0xB1, -+0x12, 0xB1, 0xE4, 0x04, 0xB1, 0x9C, 0x90, 0x06, 0x72, 0xE4, 0xF0, 0x22, 0xFF, 0x7B, 0x01, 0x7A, -+0x91, 0x79, 0xE9, 0x12, 0x26, 0x1E, 0x90, 0x06, 0x74, 0xD1, 0xCD, 0x90, 0x06, 0x75, 0xF1, 0xEC, -+0x90, 0x06, 0x76, 0xF1, 0xAD, 0x90, 0x06, 0x77, 0xF0, 0x90, 0x06, 0x70, 0xEF, 0xF0, 0xA3, 0xE4, -+0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x02, 0x3A, 0xF7, 0xF9, -+0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x91, 0x79, -+0xE9, 0x12, 0x34, 0x2C, 0x90, 0x91, 0xE5, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x22, 0x90, 0x91, 0xE6, -+0x02, 0x47, 0x56, 0x90, 0x01, 0x34, 0x74, 0xFF, 0xB1, 0x12, 0x90, 0x01, 0x3C, 0xB1, 0x12, 0xFD, -+0x7F, 0x54, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x56, -+0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x3A, 0x96, 0x7E, 0x00, 0x7F, 0x25, 0x7D, 0x00, -+0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x30, 0x31, 0x38, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x20, 0xF0, 0x12, -+0x8E, 0xD1, 0xB1, 0x1A, 0x90, 0x8D, 0x07, 0xE0, 0xFF, 0x64, 0x02, 0x70, 0x29, 0xD1, 0xC5, 0x30, -+0xE0, 0x02, 0x7E, 0x01, 0x90, 0x8F, 0x4F, 0xD1, 0xC3, 0x30, 0xE1, 0x02, 0x7E, 0x01, 0x90, 0x8F, -+0x4D, 0xD1, 0xC3, 0x30, 0xE2, 0x02, 0x7E, 0x01, 0x90, 0x8F, 0x4E, 0xEE, 0xF0, 0x90, 0xFD, 0x80, -+0xE0, 0x90, 0x02, 0xFB, 0xF0, 0x22, 0xEF, 0x64, 0x01, 0x70, 0x1D, 0xD1, 0xBC, 0x30, 0xE0, 0x02, -+0x7F, 0x01, 0x90, 0x8F, 0x4F, 0xD1, 0xBA, 0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x8F, 0x4D, 0xD1, -+0xBA, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, 0x23, 0x90, 0x8D, 0x07, 0xE0, 0x64, 0x03, 0x70, 0x20, -+0xD1, 0xB3, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x8F, 0x4F, 0xD1, 0xB1, 0x30, 0xE1, 0x02, 0x7F, -+0x01, 0x90, 0x8F, 0x4D, 0xD1, 0xB1, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x90, 0x8F, 0x4E, 0xEF, 0xF0, -+0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x70, 0xE0, -+0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, 0x7E, 0x00, 0x22, 0x4E, 0xF0, 0x90, 0x00, -+0x01, 0x02, 0x26, 0x37, 0x90, 0x92, 0xDE, 0x12, 0x47, 0x5F, 0x12, 0x26, 0x1E, 0x90, 0x92, 0xE3, -+0xD1, 0xCD, 0x90, 0x92, 0xE4, 0xF1, 0xCF, 0x90, 0x92, 0xE5, 0xF1, 0xDD, 0x90, 0x92, 0xE6, 0xF1, -+0xD6, 0x90, 0x92, 0xE7, 0xF0, 0x90, 0x00, 0x07, 0x12, 0x26, 0x37, 0x90, 0x92, 0xE8, 0xF1, 0xAD, -+0x90, 0x92, 0xEB, 0xF0, 0xED, 0x70, 0x19, 0xFF, 0xF1, 0xA1, 0xE0, 0xB4, 0xFF, 0x06, 0xF1, 0xA1, -+0xE4, 0xF0, 0x80, 0x07, 0xF1, 0xA1, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x06, 0xE8, -+0x90, 0x92, 0xE2, 0xE0, 0xFF, 0xB4, 0x04, 0x13, 0xA3, 0xE0, 0xFE, 0xF1, 0x9B, 0xEE, 0xF1, 0xB4, -+0xFE, 0xF1, 0x9B, 0xF1, 0xE4, 0x90, 0x00, 0x02, 0xE4, 0x80, 0x20, 0xEF, 0xB4, 0x02, 0x1F, 0x90, -+0x92, 0xE4, 0xF1, 0x99, 0xEF, 0xF1, 0xB4, 0x44, 0x20, 0x54, 0x7F, 0xF1, 0x9A, 0x90, 0x00, 0x01, -+0xEF, 0x12, 0x26, 0x76, 0x90, 0x92, 0xE3, 0xE0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x76, 0xF1, 0x9B, -+0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x26, 0x1E, 0x44, 0x20, 0x12, 0x26, 0x64, 0x90, -+0x92, 0xE5, 0xF1, 0x99, 0x90, 0x00, 0x04, 0xEF, 0x12, 0x26, 0x76, 0x90, 0x92, 0xE6, 0xE0, 0x90, -+0x00, 0x05, 0x12, 0x26, 0x76, 0x90, 0x92, 0xE7, 0xE0, 0x90, 0x00, 0x06, 0x12, 0x26, 0x76, 0x90, -+0x92, 0xE8, 0xE0, 0x90, 0x00, 0x07, 0x02, 0x26, 0x76, 0xE0, 0xFF, 0x90, 0x92, 0xDE, 0x02, 0x47, -+0x56, 0x74, 0xE3, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0x22, 0x4E, 0xF0, 0x90, 0x00, -+0x03, 0x02, 0x26, 0x37, 0x12, 0x26, 0x64, 0x90, 0x92, 0xE4, 0xE0, 0x22, 0x90, 0x8F, 0x30, 0xF1, -+0xF3, 0x30, 0xE0, 0x02, 0xB1, 0x1A, 0x22, 0x80, 0xF3, 0xE4, 0x90, 0x8D, 0x01, 0xA1, 0x10, 0xF0, -+0x90, 0x00, 0x04, 0x02, 0x26, 0x37, 0xF0, 0x90, 0x00, 0x06, 0x02, 0x26, 0x37, 0xF0, 0x90, 0x00, -+0x05, 0x02, 0x26, 0x37, 0x90, 0x00, 0x01, 0xEE, 0x02, 0x26, 0x76, 0x4F, 0xF0, 0x90, 0x00, 0x02, -+0x02, 0x26, 0x37, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, -+0x85, 0x22, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, 0x12, 0x8B, -+0x75, 0x12, 0x3A, 0xB8, 0x12, 0x8B, 0x82, 0x12, 0x4F, 0xC9, 0x7F, 0x01, 0x12, 0x4A, 0x79, 0x90, -+0x91, 0x77, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x4A, 0x79, 0x90, 0x91, 0x77, 0xE0, 0x04, 0xF0, 0x12, -+0x4C, 0xB3, 0x11, 0x57, 0x90, 0x01, 0xCC, 0x74, 0x0F, 0xF0, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, -+0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, 0x75, 0x28, 0xFF, 0x12, 0x4F, 0xFB, 0x12, 0x8B, 0xB2, 0x12, -+0x8C, 0x2C, 0xE4, 0xFF, 0x02, 0x4B, 0x02, 0x12, 0x7F, 0xD0, 0x12, 0x88, 0x21, 0x11, 0x88, 0x12, -+0x92, 0x20, 0x12, 0x4E, 0x1A, 0x12, 0x8E, 0xBA, 0x12, 0x82, 0xBF, 0x90, 0x91, 0x84, 0xE0, 0x54, -+0x7F, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, 0xE4, 0x90, 0x91, 0x86, 0xF0, -+0x90, 0x91, 0x84, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, -+0x7A, 0x8E, 0x79, 0xC3, 0x12, 0x49, 0x38, 0x12, 0x92, 0x25, 0x12, 0x49, 0x38, 0x90, 0x8E, 0xC7, -+0x74, 0x02, 0xF0, 0x90, 0x8E, 0xCE, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x90, 0x8E, -+0xD4, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x31, 0x8A, 0x12, 0x91, 0xB1, 0xE4, 0xFD, 0xFF, 0x31, -+0x22, 0x7D, 0x0C, 0x7F, 0x02, 0x31, 0x22, 0x31, 0x1E, 0x90, 0x8D, 0x07, 0xE0, 0xFF, 0xB4, 0x01, -+0x08, 0x90, 0x8E, 0xD3, 0x74, 0xFF, 0xF0, 0x80, 0x0F, 0xEF, 0x90, 0x8E, 0xD3, 0xB4, 0x03, 0x05, -+0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x40, 0xF0, 0x12, 0x81, 0x3D, 0x31, 0x8A, 0x7F, 0x01, 0x12, -+0x72, 0x23, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0xD6, 0x12, 0x27, 0x54, 0x54, 0x33, -+0x77, 0x70, 0x7E, 0x00, 0x7F, 0x02, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x29, 0x12, 0x49, -+0x38, 0xF1, 0xF9, 0x12, 0x97, 0x58, 0xF1, 0x89, 0xE4, 0x90, 0x8F, 0x2B, 0xF0, 0x22, 0x7D, 0x0C, -+0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0xEF, 0x14, 0x60, 0x15, 0x14, -+0x60, 0x19, 0x24, 0x02, 0x70, 0x1A, 0xED, 0x54, 0x01, 0xFE, 0x90, 0x8E, 0xC3, 0xE0, 0x54, 0xFE, -+0x4E, 0xF0, 0x80, 0x0C, 0x90, 0x8E, 0xCB, 0xED, 0xF0, 0x80, 0x05, 0x90, 0x8E, 0xCA, 0xED, 0xF0, -+0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE4, 0x2E, 0xEC, 0x14, 0x60, 0x07, 0x14, 0x60, 0x1D, 0x24, 0x02, -+0x70, 0x23, 0x90, 0x8E, 0xC3, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0xFF, 0x90, -+0x8E, 0xCB, 0xE0, 0x54, 0x7F, 0x4F, 0xFD, 0x7F, 0x88, 0x80, 0x07, 0x90, 0x8E, 0xCA, 0xE0, 0xFD, -+0x7F, 0x89, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8E, 0xE5, 0xE0, 0x24, 0x04, -+0x90, 0x8E, 0xE0, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x22, 0x90, 0x93, 0x53, 0xEF, 0xF0, 0x12, 0x6B, -+0x15, 0x90, 0x93, 0x53, 0xE0, 0x60, 0x02, 0xF1, 0x89, 0x7D, 0x04, 0x7F, 0x01, 0x21, 0x22, 0x7D, -+0x01, 0x7F, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x54, 0xED, 0xF0, 0x90, -+0x8E, 0xC3, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x41, 0xF7, 0xEE, 0x12, -+0x74, 0x02, 0x30, 0xE0, 0x02, 0x41, 0xF7, 0x90, 0x8E, 0xCB, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x41, -+0xF7, 0xEF, 0x70, 0x02, 0x41, 0x70, 0x24, 0xFE, 0x70, 0x02, 0x41, 0xA9, 0x24, 0xFE, 0x60, 0x48, -+0x24, 0xFC, 0x70, 0x02, 0x41, 0xE4, 0x24, 0xFC, 0x60, 0x02, 0x41, 0xF7, 0xEE, 0xB4, 0x0E, 0x02, -+0x71, 0x23, 0x90, 0x8E, 0xCB, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x31, 0x99, 0x90, 0x8E, 0xCB, 0xE0, -+0xB4, 0x06, 0x02, 0x71, 0x3E, 0x90, 0x8E, 0xCB, 0xE0, 0xB4, 0x04, 0x0D, 0x90, 0x93, 0x54, 0xE0, -+0xFF, 0x60, 0x04, 0xF1, 0xC3, 0x80, 0x02, 0xF1, 0x8E, 0x90, 0x8E, 0xCB, 0xE0, 0x64, 0x08, 0x60, -+0x02, 0x41, 0xF7, 0x12, 0x92, 0x16, 0x41, 0xF7, 0x90, 0x8E, 0xCB, 0xE0, 0x70, 0x04, 0x7F, 0x01, -+0x31, 0x99, 0x90, 0x8E, 0xCB, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x3E, 0x90, 0x8E, 0xCB, 0xE0, 0xB4, -+0x0E, 0x07, 0x51, 0xFC, 0xBF, 0x01, 0x02, 0x71, 0x23, 0x90, 0x8E, 0xCB, 0xE0, 0x64, 0x0C, 0x60, -+0x02, 0x41, 0xF7, 0x51, 0xFC, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x41, 0xF7, 0x71, 0x5F, 0x41, 0xF7, -+0x90, 0x8E, 0xCB, 0xE0, 0xB4, 0x0E, 0x07, 0x51, 0xFC, 0xBF, 0x01, 0x02, 0x71, 0x23, 0x90, 0x8E, -+0xCB, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x3E, 0x90, 0x8E, 0xCB, 0xE0, 0xB4, 0x0C, 0x07, 0x51, 0xFC, -+0xBF, 0x01, 0x02, 0x71, 0x5F, 0x90, 0x8E, 0xCB, 0xE0, 0x64, 0x04, 0x70, 0x5A, 0x12, 0x91, 0x16, -+0xEF, 0x64, 0x01, 0x70, 0x52, 0xD1, 0x76, 0x80, 0x4E, 0x90, 0x8E, 0xCB, 0xE0, 0xB4, 0x0E, 0x07, -+0x51, 0xFC, 0xBF, 0x01, 0x02, 0x71, 0x23, 0x90, 0x8E, 0xCB, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x3E, -+0x90, 0x8E, 0xCB, 0xE0, 0xB4, 0x0C, 0x07, 0x51, 0xFC, 0xBF, 0x01, 0x02, 0x71, 0x5F, 0x90, 0x8E, -+0xCB, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x31, 0x99, 0x90, 0x8E, 0xCB, 0xE0, 0xB4, 0x04, 0x18, 0x12, -+0x91, 0xA3, 0x80, 0x13, 0x90, 0x8E, 0xCB, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, 0x8E, 0xC4, 0x12, 0x6F, -+0xED, 0x30, 0xE0, 0x03, 0x12, 0x92, 0x0A, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x12, 0x90, 0xFD, 0xBF, 0x01, 0x13, 0x12, 0x96, 0xC3, 0x20, 0xE0, 0x0D, 0x90, -+0x8E, 0xCA, 0xE0, 0xD3, 0x94, 0x04, 0x50, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0x8E, 0xC4, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x04, 0x7D, 0x0C, 0x80, 0x05, -+0x12, 0x93, 0x8C, 0x7D, 0x04, 0x7F, 0x01, 0x31, 0x22, 0xE4, 0xFD, 0xFF, 0x80, 0x53, 0x90, 0x8E, -+0xC4, 0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x08, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x04, 0x80, 0x06, -+0xE0, 0x54, 0x7F, 0xF0, 0x7D, 0x0C, 0x7F, 0x01, 0x31, 0x22, 0xE4, 0xFD, 0xFF, 0x80, 0x32, 0x12, -+0x69, 0x09, 0x70, 0x23, 0x90, 0x8E, 0xC4, 0xE0, 0x54, 0xFD, 0xF0, 0x7D, 0x2C, 0x7F, 0x6F, 0x71, -+0x91, 0x7D, 0x08, 0x7F, 0x01, 0xD1, 0x93, 0xBF, 0x01, 0x0D, 0x90, 0x8E, 0xC3, 0xE0, 0x44, 0x80, -+0xF0, 0x7D, 0x0E, 0x7F, 0x01, 0x31, 0x22, 0x22, 0xE4, 0xFD, 0x7F, 0x0C, 0x31, 0xB3, 0xE4, 0xFD, -+0xFF, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x8D, 0x05, 0xED, 0xF0, 0x22, 0x7F, 0xFF, 0x71, 0x91, -+0xE4, 0x90, 0x93, 0x3F, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x93, 0x41, 0xF0, 0x7D, -+0x47, 0x7F, 0xFF, 0x71, 0x91, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x14, 0xA3, 0xE0, 0x70, 0x10, 0xA3, -+0xE0, 0x70, 0x0C, 0xA3, 0xE0, 0x70, 0x08, 0x12, 0x97, 0xB7, 0x71, 0x91, 0x7F, 0x01, 0x22, 0xD3, -+0x90, 0x93, 0x40, 0xE0, 0x94, 0xE8, 0x90, 0x93, 0x3F, 0xE0, 0x94, 0x03, 0x40, 0x0F, 0x90, 0x01, -+0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0x97, 0xB7, 0x71, 0x91, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, -+0x00, 0x12, 0x3A, 0xF7, 0x90, 0x93, 0x3F, 0x12, 0x59, 0x36, 0x80, 0xB9, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x91, 0xB0, 0x12, 0x95, 0x33, 0x90, 0x91, 0xC8, 0x74, 0x18, 0xF0, 0x7E, -+0x00, 0x7F, 0x80, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x91, 0x79, 0xD0, 0x12, 0x49, 0x38, 0x90, 0x01, -+0xC4, 0x74, 0xFC, 0xF0, 0x74, 0x53, 0xA3, 0xF0, 0x90, 0x91, 0x6A, 0xE0, 0xFF, 0x12, 0x5E, 0x5E, -+0x90, 0x91, 0xC7, 0xEF, 0xF0, 0xF9, 0xE0, 0xFE, 0x24, 0x29, 0x12, 0x93, 0x12, 0x74, 0x41, 0xF0, -+0xEE, 0x24, 0x28, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x91, 0xC8, 0xE0, 0x7A, 0x00, 0x2D, 0xFE, 0xEA, -+0x3C, 0x90, 0x91, 0xCC, 0xF0, 0xA3, 0xCE, 0xF0, 0x74, 0x28, 0x29, 0x12, 0x86, 0x0D, 0x90, 0x91, -+0xB2, 0xE0, 0xFD, 0x12, 0x84, 0xEC, 0x12, 0x96, 0x27, 0x90, 0x91, 0xCC, 0xE0, 0xFF, 0xA3, 0xE0, -+0x90, 0x91, 0xCA, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x91, 0xD0, 0x74, 0x01, 0xF0, 0xA3, 0x74, -+0x03, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0x74, 0x5F, 0xF0, 0x90, 0x91, 0xCC, 0xE4, 0x75, 0xF0, 0x04, -+0x12, 0x46, 0xD6, 0x90, 0x90, 0x47, 0xE0, 0xFF, 0x7E, 0x02, 0xB4, 0xFE, 0x02, 0x7E, 0xFE, 0x90, -+0x91, 0xCC, 0xA3, 0xE0, 0xFD, 0xD1, 0x6C, 0xEE, 0xF0, 0x74, 0x00, 0x2D, 0xD1, 0x6E, 0xE0, 0x90, -+0x91, 0xD4, 0xF0, 0x90, 0x91, 0xCC, 0x12, 0x59, 0x36, 0x90, 0x90, 0xDC, 0xE0, 0x90, 0x91, 0xB0, -+0xB4, 0x01, 0x0B, 0xE0, 0x44, 0x03, 0xFC, 0xA3, 0xE0, 0x44, 0x10, 0xFD, 0x80, 0x09, 0xE0, 0x44, -+0x03, 0xFC, 0xA3, 0xE0, 0x44, 0x20, 0xFD, 0x90, 0x91, 0xCE, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, -+0x91, 0xD5, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x12, 0xF0, 0x12, 0x97, 0x77, 0x12, 0x46, 0xD6, 0xEF, -+0x64, 0xFE, 0x70, 0x27, 0x90, 0x91, 0xCC, 0xA3, 0xE0, 0x24, 0x00, 0x12, 0x82, 0xEF, 0xC0, 0x03, -+0x8B, 0x40, 0x12, 0x96, 0xFB, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x75, 0x40, 0x01, 0x12, 0x96, 0xFB, -+0x7B, 0x01, 0x7A, 0x91, 0x79, 0xD7, 0x12, 0x34, 0x2C, 0x80, 0x58, 0x90, 0x91, 0x65, 0xE0, 0xFF, -+0xB4, 0x02, 0x27, 0x90, 0x91, 0xCC, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x24, 0x00, 0xF5, 0x82, 0x74, -+0xFC, 0x3C, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0x74, 0xFC, 0x3C, 0xF5, 0x83, -+0x74, 0x20, 0x12, 0x97, 0x7F, 0x74, 0x20, 0xF0, 0x80, 0x29, 0xEF, 0xB4, 0x04, 0x25, 0x90, 0x91, -+0xCC, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x24, 0x00, 0xF5, 0x82, 0x74, 0xFC, 0x3E, 0xF5, 0x83, 0xE4, -+0xF0, 0x74, 0x01, 0x2F, 0xF5, 0x82, 0x74, 0xFC, 0x3E, 0xF5, 0x83, 0x74, 0x10, 0x12, 0x97, 0x7F, -+0x74, 0x10, 0xF0, 0x12, 0x97, 0x77, 0x12, 0x46, 0xD6, 0xE4, 0x90, 0x91, 0xC9, 0xF0, 0x12, 0x96, -+0x74, 0xE0, 0xFE, 0x90, 0x91, 0xCC, 0xA3, 0xE0, 0xFD, 0xEF, 0x2D, 0xD1, 0x6C, 0xEE, 0xF0, 0x12, -+0x96, 0x74, 0xE0, 0xFE, 0x74, 0xD9, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x91, 0xF5, 0x83, 0xEE, 0x12, -+0x97, 0x6F, 0xE0, 0xB4, 0x08, 0xD8, 0x12, 0x96, 0x31, 0x90, 0x91, 0xCC, 0xE4, 0x75, 0xF0, 0x20, -+0x12, 0x46, 0xD6, 0x90, 0x91, 0xCC, 0x12, 0x5B, 0xA9, 0x12, 0x96, 0x27, 0x7B, 0x01, 0x7A, 0x91, -+0x79, 0xD0, 0x90, 0x92, 0x57, 0x12, 0x47, 0x5F, 0x90, 0x92, 0x5A, 0x74, 0x63, 0xF0, 0x7A, 0x91, -+0x79, 0xB3, 0xA3, 0x12, 0x47, 0x5F, 0x7A, 0x90, 0x79, 0x03, 0x7D, 0x10, 0x12, 0x59, 0x3D, 0xE4, -+0x90, 0x91, 0xC9, 0xF0, 0x90, 0x91, 0xC9, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x50, 0x3C, 0x90, 0x91, -+0xCD, 0xE0, 0x2F, 0xFF, 0x90, 0x91, 0xCC, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x92, 0x50, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x91, 0x6A, 0xE0, 0xFD, 0x12, 0x8D, 0x9E, 0x90, 0x91, 0xC7, 0xEF, 0xF0, 0x90, -+0x91, 0xC9, 0xE0, 0x24, 0xB3, 0xF5, 0x82, 0xE4, 0x34, 0x91, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x91, -+0xC7, 0xE0, 0xD1, 0x6C, 0xEF, 0x12, 0x97, 0x6F, 0x80, 0xBA, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1D, -+0x90, 0x05, 0x22, 0xE0, 0x90, 0x92, 0x52, 0xF0, 0x7D, 0x1D, 0x71, 0x9C, 0xBF, 0x01, 0x03, 0x12, -+0x96, 0x54, 0x90, 0x92, 0x52, 0xE0, 0xFF, 0x7D, 0x1E, 0x71, 0x91, 0x80, 0x03, 0x12, 0x96, 0x54, -+0xF1, 0xF2, 0x90, 0x8E, 0xCB, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x31, 0x99, 0x74, 0xFC, 0x04, 0x90, -+0x01, 0xC4, 0xF0, 0x74, 0x53, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x24, 0x00, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x7D, 0x2D, 0x71, 0x9C, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, -+0xFD, 0x7F, 0x03, 0x12, 0x6E, 0x6F, 0x12, 0x6C, 0x1B, 0xE4, 0xFD, 0x7F, 0x01, 0x21, 0x22, 0x7D, -+0x08, 0xE4, 0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x1C, 0xEF, 0xF0, 0xA3, -+0xED, 0xF0, 0x90, 0x8D, 0x03, 0xE0, 0x04, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x22, 0x90, 0x05, -+0x22, 0xE0, 0x90, 0x93, 0x20, 0xF0, 0x7D, 0x26, 0x71, 0x9C, 0xEF, 0x64, 0x01, 0x70, 0x03, 0x12, -+0x92, 0x44, 0x90, 0x93, 0x20, 0xE0, 0xFF, 0x7D, 0x27, 0x71, 0x91, 0x12, 0x93, 0x2D, 0x80, 0x06, -+0x12, 0x93, 0x2D, 0x12, 0x92, 0x44, 0xF1, 0xF2, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x2E, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x93, -+0x2D, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0x5F, 0xD3, 0x90, 0x93, 0x2D, 0xE0, 0x90, 0x04, 0x25, -+0xF0, 0x90, 0x93, 0x2E, 0xE0, 0x60, 0x06, 0x12, 0x96, 0xD9, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, -+0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x12, 0x96, 0xD9, -+0x54, 0xC0, 0xF0, 0x90, 0x93, 0x30, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x8B, 0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, 0x40, -+0x08, 0x12, 0x97, 0x4F, 0x74, 0x04, 0xF0, 0x80, 0x05, 0x12, 0x97, 0x4F, 0xE4, 0xF0, 0xAF, 0x05, -+0x12, 0x93, 0x1A, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x2F, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, -+0xEE, 0x44, 0x02, 0x4B, 0xFE, 0x12, 0x93, 0x1A, 0xEE, 0xF0, 0x74, 0x11, 0x2F, 0x12, 0x93, 0x25, -+0x74, 0xFF, 0xF0, 0x74, 0x29, 0x2F, 0x12, 0x93, 0x12, 0xE0, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, -+0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x6B, 0x15, 0xE4, 0xFD, 0xFF, 0x61, 0x91, 0xF1, 0xF9, -+0xF1, 0x89, 0x7D, 0x0C, 0x7F, 0x01, 0x21, 0x22, 0x12, 0x7F, 0x96, 0x90, 0x8E, 0xCB, 0xE0, 0x64, -+0x0C, 0x60, 0x04, 0x71, 0x88, 0xD1, 0x8F, 0x22, 0x90, 0x8E, 0xC8, 0xE0, 0x64, 0x01, 0x70, 0x12, -+0x12, 0x7C, 0x01, 0x60, 0x05, 0x71, 0x88, 0x02, 0x7F, 0x96, 0x90, 0x8E, 0xCB, 0xE0, 0x70, 0x02, -+0x31, 0xAF, 0x22, 0xEF, 0x60, 0x2B, 0x12, 0x69, 0x09, 0x70, 0x26, 0x90, 0x8E, 0xC4, 0xE0, 0x54, -+0xFE, 0xF0, 0x7D, 0x2B, 0x7F, 0x0F, 0x71, 0x91, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xD1, -+0x8F, 0xBF, 0x01, 0x0D, 0x90, 0x8E, 0xC3, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x06, 0x7F, 0x01, 0x31, -+0x22, 0x22, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, -+0x22, 0xE4, 0x90, 0x91, 0x8C, 0xF0, 0x90, 0x91, 0x8C, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0x01, 0x90, -+0x01, 0xC4, 0xF0, 0x74, 0x58, 0xA3, 0xF0, 0x12, 0x3A, 0xEB, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x69, -+0x90, 0x8E, 0xC8, 0xE0, 0x60, 0x0F, 0x90, 0x8E, 0xCB, 0xE0, 0xFF, 0x90, 0x8E, 0xCA, 0xE0, 0x6F, -+0x60, 0x03, 0x12, 0x7B, 0xC8, 0xC2, 0xAF, 0x12, 0x8C, 0x0D, 0xBF, 0x01, 0x02, 0x11, 0x81, 0xD2, -+0xAF, 0x11, 0x48, 0x12, 0x49, 0xB1, 0x80, 0xBE, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x26, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x93, 0x39, 0xF0, 0x90, 0x00, -+0x8D, 0xE0, 0x90, 0x93, 0x3A, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0x93, 0x3B, 0xF0, 0x90, 0x00, -+0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0x8E, 0xC3, 0xE0, 0x30, 0xE0, 0x02, 0x11, 0x8B, 0x22, 0x90, 0x8E, 0xCB, 0xE0, 0xFF, -+0x60, 0x03, 0xB4, 0x08, 0x08, 0x12, 0x91, 0x5E, 0xBF, 0x01, 0x02, 0x11, 0x9E, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x8D, 0xCC, 0x11, 0xAF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, -+0x8D, 0xAF, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0xE4, 0xFF, -+0x11, 0xDD, 0x90, 0x8D, 0x07, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x54, 0x7F, 0xFD, -+0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0x8E, 0xC4, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x90, 0x93, 0x3C, -+0xEF, 0x12, 0x8E, 0xCA, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, -+0x93, 0x3C, 0xE0, 0x6F, 0x60, 0x35, 0xC3, 0x90, 0x93, 0x3E, 0xE0, 0x94, 0x88, 0x90, 0x93, 0x3D, -+0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x93, 0x3D, -+0x31, 0x36, 0x12, 0x70, 0x64, 0xD3, 0x90, 0x93, 0x3E, 0xE0, 0x94, 0x32, 0x90, 0x93, 0x3D, 0xE0, -+0x94, 0x00, 0x40, 0xC0, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB9, 0x22, 0x7F, 0x01, 0x7E, 0x00, -+0x12, 0x3A, 0xF7, 0x90, 0x92, 0xA3, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x46, 0xD6, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x92, 0x53, 0x12, 0x47, 0x5F, 0x90, 0x92, 0x56, 0xED, 0xF0, 0xE4, -+0x90, 0x92, 0xA2, 0xF0, 0x71, 0x9D, 0x50, 0x07, 0x51, 0xF1, 0x71, 0x6C, 0xF0, 0x80, 0xF5, 0x90, -+0x92, 0x53, 0x71, 0xEB, 0xD1, 0xEF, 0x71, 0x17, 0x94, 0x40, 0x50, 0x0A, 0x51, 0xF1, 0xE0, 0x64, -+0x36, 0xF0, 0x51, 0xEA, 0x80, 0xF0, 0x90, 0x92, 0x57, 0x12, 0x47, 0x56, 0x90, 0x92, 0x5A, 0x71, -+0x8C, 0x74, 0x80, 0x12, 0x26, 0x76, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xFF, 0xE5, 0xF0, -+0x34, 0x02, 0xFC, 0x90, 0x00, 0x7E, 0x12, 0x26, 0x76, 0xEF, 0x90, 0x00, 0x7F, 0x71, 0xBA, 0xF0, -+0x71, 0xB0, 0x94, 0xC0, 0xEE, 0x94, 0x00, 0x50, 0x52, 0x71, 0x84, 0x50, 0x09, 0x12, 0x95, 0xDF, -+0x71, 0x74, 0x7B, 0x01, 0x80, 0x05, 0x12, 0x95, 0x62, 0x71, 0x7C, 0xB1, 0x18, 0xF0, 0xE4, 0x51, -+0xE0, 0x90, 0x01, 0x8C, 0xE0, 0x30, 0xE4, 0x0A, 0x51, 0xFC, 0x94, 0x03, 0x50, 0x04, 0x31, 0x2C, -+0x80, 0xEF, 0x71, 0x08, 0x40, 0x03, 0x71, 0xD0, 0xF0, 0x71, 0x94, 0x70, 0x1A, 0x51, 0xE0, 0x90, -+0x01, 0x8C, 0xE0, 0x20, 0xE5, 0x0A, 0x51, 0xFC, 0x94, 0x03, 0x50, 0x04, 0x31, 0x2C, 0x80, 0xEF, -+0x71, 0x08, 0x40, 0x03, 0x71, 0xC4, 0xF0, 0x71, 0xA6, 0x80, 0xA5, 0x71, 0x1E, 0x7D, 0x84, 0x12, -+0x33, 0x2F, 0xE4, 0x90, 0x92, 0xA2, 0xF0, 0x71, 0x9D, 0x50, 0x07, 0x51, 0xF1, 0x71, 0x6C, 0xF0, -+0x80, 0xF5, 0x90, 0x92, 0x53, 0x71, 0xEB, 0xD1, 0xEF, 0x71, 0x17, 0x94, 0x40, 0x50, 0x0A, 0x51, -+0xF1, 0xE0, 0x64, 0x5C, 0xF0, 0x51, 0xEA, 0x80, 0xF0, 0xE4, 0x90, 0x92, 0x5E, 0xF0, 0x71, 0x66, -+0x90, 0x92, 0x5E, 0x71, 0x8C, 0x12, 0x26, 0x37, 0xFE, 0x71, 0xDC, 0xEE, 0x51, 0xE7, 0xE0, 0xB4, -+0x14, 0xEC, 0x90, 0x92, 0x57, 0x12, 0x47, 0x56, 0x90, 0x00, 0x14, 0x74, 0x80, 0x12, 0x26, 0x76, -+0x90, 0x92, 0x5E, 0x74, 0x15, 0xF0, 0x71, 0x17, 0x94, 0x3E, 0x50, 0x07, 0x71, 0xDC, 0xE4, 0x51, -+0xE7, 0x80, 0xF3, 0x90, 0x92, 0x57, 0x12, 0x47, 0x56, 0x90, 0x00, 0x3E, 0x74, 0x02, 0x12, 0x26, -+0x76, 0x90, 0x00, 0x3F, 0x74, 0xA0, 0x71, 0xBA, 0xF0, 0x71, 0xB0, 0x94, 0x80, 0xEE, 0x94, 0x00, -+0x50, 0x52, 0x71, 0x84, 0x50, 0x09, 0x12, 0x95, 0xDF, 0x71, 0x74, 0x7B, 0x01, 0x80, 0x05, 0x12, -+0x95, 0x62, 0x71, 0x7C, 0xB1, 0x18, 0xF0, 0xE4, 0x51, 0xE0, 0x90, 0x01, 0x8C, 0xE0, 0x30, 0xE4, -+0x0A, 0x51, 0xFC, 0x94, 0x03, 0x50, 0x04, 0x31, 0x2C, 0x80, 0xEF, 0x71, 0x08, 0x40, 0x03, 0x71, -+0xD0, 0xF0, 0x71, 0x94, 0x70, 0x1A, 0x51, 0xE0, 0x90, 0x01, 0x8C, 0xE0, 0x20, 0xE5, 0x0A, 0x51, -+0xFC, 0x94, 0x03, 0x50, 0x04, 0x31, 0x2C, 0x80, 0xEF, 0x71, 0x08, 0x40, 0x03, 0x71, 0xC4, 0xF0, -+0x71, 0xA6, 0x80, 0xA5, 0x71, 0x1E, 0x7D, 0x84, 0x12, 0x33, 0x2F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0x92, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x26, 0x76, 0x90, 0x92, 0x5E, 0xE0, 0x04, 0xF0, -+0x22, 0x74, 0x5F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0x22, 0xC3, 0x90, 0x92, 0xA4, -+0xE0, 0x94, 0xE8, 0x90, 0x92, 0xA3, 0xE0, 0x22, 0x90, 0x92, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0xC3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x22, 0x90, 0x92, 0x5E, 0xE0, 0xFF, 0xC3, 0x22, 0x90, 0x92, -+0x5B, 0x12, 0x47, 0x56, 0xE9, 0x24, 0x10, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x80, 0x12, 0x33, 0x2F, -+0x90, 0x92, 0x5B, 0x12, 0x47, 0x56, 0xE9, 0x24, 0x0C, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x81, 0x12, -+0x33, 0x2F, 0x90, 0x92, 0x5B, 0x12, 0x47, 0x56, 0xE9, 0x24, 0x08, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, -+0x82, 0x12, 0x33, 0x2F, 0x90, 0x92, 0x5B, 0x12, 0x47, 0x56, 0xE9, 0x24, 0x04, 0xF9, 0xE4, 0x3A, -+0xFA, 0x7D, 0x83, 0x12, 0x33, 0x2F, 0x90, 0x92, 0x5B, 0x02, 0x47, 0x56, 0xE4, 0xF0, 0x90, 0x92, -+0xA2, 0xE0, 0x04, 0x22, 0x24, 0x6B, 0xF9, 0xE4, 0x34, 0x92, 0xFA, 0x22, 0x24, 0xCC, 0xF9, 0xEA, -+0x34, 0xFF, 0xFA, 0x22, 0xC3, 0xEF, 0x94, 0x40, 0xEE, 0x94, 0x00, 0x22, 0xE0, 0xFF, 0xF5, 0x82, -+0x75, 0x83, 0x00, 0x22, 0x90, 0x92, 0xA0, 0xE0, 0x54, 0x3F, 0x64, 0x30, 0x22, 0x90, 0x92, 0xA2, -+0xE0, 0xFF, 0xC3, 0x94, 0x40, 0x22, 0x90, 0x92, 0x9F, 0xE4, 0x75, 0xF0, 0x10, 0x02, 0x46, 0xD6, -+0x90, 0x92, 0x9F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x22, 0x12, 0x26, 0x76, 0xE4, 0x90, 0x92, -+0x9F, 0xF0, 0xA3, 0x22, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x02, 0xF0, 0xEE, 0x90, 0x06, 0x36, 0x22, -+0x90, 0x06, 0x31, 0xE0, 0x44, 0x01, 0xF0, 0xEE, 0x90, 0x06, 0x36, 0x22, 0x90, 0x92, 0x57, 0x12, -+0x47, 0x56, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x22, 0x90, 0x91, 0x92, 0x12, 0x47, 0x56, 0x8B, 0x40, -+0x8A, 0x41, 0x89, 0x42, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x92, 0xCC, 0x12, -+0x47, 0x5F, 0x78, 0xD8, 0x7C, 0x92, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x5E, 0x12, 0x67, -+0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x92, 0xD7, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0C, 0x7D, -+0x33, 0x12, 0x53, 0x9C, 0xEF, 0x64, 0x01, 0x70, 0x1C, 0x80, 0x00, 0x90, 0x91, 0x68, 0xE0, 0xFF, -+0x90, 0x93, 0x30, 0x74, 0x10, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0x12, 0x56, 0xDF, 0x90, 0x92, 0xD4, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x92, 0xD4, 0xD1, 0x96, 0x90, 0x92, 0xD6, 0xEF, 0xF0, 0x90, -+0x92, 0xD4, 0x12, 0x86, 0x09, 0x90, 0x92, 0xD2, 0xE0, 0xFD, 0x12, 0x84, 0xEC, 0x90, 0x92, 0xD3, -+0xE0, 0x70, 0x4B, 0xB1, 0x0E, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x92, -+0xCF, 0x71, 0xEB, 0x75, 0x43, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0xD1, 0x83, 0xFA, 0x7B, -+0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x92, 0xCF, 0x71, 0xEB, 0x75, 0x43, 0x06, 0xD0, -+0x01, 0xD0, 0x02, 0xD0, 0x03, 0xB1, 0x2A, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, -+0x90, 0x92, 0xCC, 0x71, 0xEB, 0x75, 0x43, 0x04, 0xD0, 0x01, 0xD0, 0x02, 0x80, 0x42, 0x90, 0x92, -+0xD3, 0xE0, 0x64, 0x01, 0x70, 0x3F, 0xB1, 0x0E, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x40, 0x75, -+0x41, 0x8F, 0x75, 0x42, 0x55, 0x75, 0x43, 0x06, 0xD0, 0x03, 0xD1, 0x83, 0xFA, 0x7B, 0x01, 0xC0, -+0x03, 0x8B, 0x40, 0x75, 0x41, 0x8F, 0x75, 0x42, 0x5F, 0x75, 0x43, 0x06, 0xD0, 0x03, 0xB1, 0x2A, -+0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x40, 0x75, 0x41, 0x8F, 0x75, 0x42, 0x65, 0x75, 0x43, 0x04, -+0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x92, 0xD7, 0xE0, -+0xFF, 0x7D, 0x34, 0x12, 0x53, 0x91, 0x12, 0x57, 0xF2, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xA3, 0xA3, -+0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0xA3, 0xE0, 0x44, 0x8B, 0xFD, 0x12, 0x30, 0xA4, -+0x90, 0x92, 0xA1, 0xE0, 0x44, 0x90, 0x90, 0x01, 0x8C, 0x22, 0x12, 0x34, 0x2C, 0x90, 0x92, 0xD4, -+0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, 0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0xD1, 0x5E, 0x90, -+0x91, 0x92, 0xE4, 0x12, 0x87, 0x3A, 0xD1, 0x96, 0x90, 0x91, 0x94, 0xEF, 0xF0, 0x90, 0x91, 0x92, -+0xB1, 0x0F, 0xB1, 0x9D, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x55, 0xD1, 0x7C, 0xA3, -+0xE0, 0xFF, 0xA3, 0xE0, 0x2F, 0x24, 0x3E, 0xF9, 0xE4, 0x34, 0xFC, 0xB1, 0x9D, 0x75, 0x43, 0x04, -+0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x5B, 0xD1, 0x7C, 0xD1, 0x89, 0xB1, 0x9D, 0x75, 0x43, 0x06, 0x7B, -+0x01, 0x7A, 0x8F, 0x79, 0x5F, 0xD1, 0x7C, 0xB1, 0x30, 0xB1, 0x9D, 0x75, 0x43, 0x04, 0x7B, 0x01, -+0x7A, 0x8F, 0x79, 0x65, 0x02, 0x34, 0x2C, 0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, -+0xF5, 0x41, 0x89, 0x42, 0x22, 0x90, 0x91, 0x72, 0xD1, 0x54, 0xE0, 0xFE, 0x24, 0x28, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x29, 0x2E, 0x12, 0x93, 0x12, 0xE0, 0xFD, 0x90, -+0x91, 0x92, 0xE0, 0x24, 0x2C, 0xD1, 0xB3, 0x90, 0x91, 0x92, 0xE0, 0x2F, 0x24, 0x30, 0xA3, 0xF0, -+0xE0, 0xFD, 0x24, 0x04, 0xF1, 0xC3, 0xE0, 0xFE, 0x74, 0x05, 0x2D, 0xF1, 0xCB, 0xD1, 0xE6, 0x90, -+0x91, 0x19, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x91, 0x93, 0xE0, 0x24, 0x0C, 0xF9, 0xE4, 0x34, 0xFC, -+0xB1, 0x9D, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x91, 0x79, 0x1B, 0x12, 0x34, 0x2C, 0x90, 0x91, -+0x93, 0xE0, 0x24, 0x14, 0xF0, 0xE0, 0xFD, 0x24, 0x01, 0xF1, 0x1D, 0xE0, 0xFE, 0x74, 0x00, 0x2D, -+0x12, 0x56, 0x6E, 0xD1, 0xE6, 0x90, 0x91, 0x1F, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x91, 0x73, 0xD1, -+0x54, 0x90, 0x91, 0x15, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x4E, 0x60, 0x11, 0x90, 0x91, 0x92, 0xE0, -+0xB1, 0x97, 0x8F, 0x43, 0x7B, 0x01, 0x7A, 0x91, 0x79, 0x23, 0x12, 0x34, 0x2C, 0x90, 0x91, 0x74, -+0xD1, 0x54, 0xB1, 0x97, 0x90, 0x91, 0x17, 0xA3, 0xE0, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x91, 0x79, -+0x43, 0x02, 0x34, 0x2C, 0xE0, 0xFF, 0xD1, 0x5E, 0x90, 0x91, 0x92, 0xEF, 0xF0, 0x22, 0xE4, 0xFE, -+0xEF, 0x25, 0xE0, 0xFD, 0xEF, 0xC3, 0x94, 0x80, 0x90, 0xFD, 0x12, 0x50, 0x04, 0xE4, 0xF0, 0x80, -+0x03, 0x74, 0x01, 0xF0, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x12, 0x34, 0x2C, 0x90, -+0x91, 0x92, 0x22, 0x12, 0x34, 0x2C, 0x90, 0x92, 0xD4, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, 0x24, -+0x42, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0xA3, 0xE0, 0xFE, 0x24, 0x28, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x29, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFD, -+0x74, 0x2C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFE, 0xEF, 0x30, -+0xE7, 0x04, 0x7C, 0x02, 0x80, 0x02, 0xE4, 0xFC, 0xED, 0x30, 0xE6, 0x09, 0xAF, 0x03, 0x12, 0x8F, -+0xB2, 0xAE, 0x07, 0x80, 0x02, 0xE4, 0xFE, 0xEC, 0x24, 0x18, 0x2E, 0xFF, 0x22, 0xF0, 0x90, 0x01, -+0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0x90, -+0x92, 0x56, 0xE0, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x92, 0x79, 0x5F, 0x12, 0x34, 0x2C, 0xE4, 0x90, -+0x92, 0x5E, 0xF0, 0x22, 0xFD, 0xE4, 0x33, 0x90, 0x92, 0xB4, 0xF0, 0xA3, 0xED, 0xF0, 0xFE, 0x24, -+0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0x22, 0xE4, 0xFD, 0xFC, 0x90, 0x91, 0x71, 0xE0, 0xFF, 0xF1, 0xD3, 0xAB, -+0x05, 0x74, 0x01, 0x2B, 0xF1, 0x1D, 0xE0, 0xFE, 0x74, 0x00, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0x12, 0x86, 0x29, 0x90, 0x91, 0x0F, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x03, 0x2B, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x02, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF1, 0xBC, -+0xEA, 0x3E, 0x90, 0x91, 0x11, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x05, 0x2B, 0xF1, 0xCB, 0xE0, 0xFE, -+0x74, 0x04, 0x2B, 0xF1, 0xC3, 0xE0, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x91, 0x13, 0xF0, 0xA3, -+0xEF, 0xF0, 0x74, 0x07, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x06, -+0x2B, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF1, 0xBC, 0xEA, 0x3E, 0x90, 0x91, 0x15, 0xF0, 0xA3, 0xEF, -+0xF0, 0x74, 0x09, 0x2B, 0x12, 0x93, 0x06, 0xFE, 0x74, 0x08, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF1, 0xBC, 0xEC, 0x3E, 0x90, 0x91, 0x17, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xF5, 0x83, 0xE0, 0x24, -+0x00, 0xFF, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0x22, 0xD1, 0x5E, 0x7C, 0x00, 0xAD, 0x07, 0x22, 0xEF, 0x60, 0x04, 0xF1, 0x25, 0xB1, -+0xA5, 0x22, 0xD1, 0x5E, 0x7E, 0x00, 0x74, 0x00, 0x2F, 0xB1, 0x99, 0x75, 0x43, 0x08, 0x7B, 0x01, -+0x7A, 0x90, 0x79, 0xDD, 0x02, 0x34, 0x2C, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x4B, 0xB2, -+0x90, 0x91, 0x8D, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x8D, 0x01, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, -+0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE1, 0x0A, 0x90, 0x8D, 0x01, 0xE0, 0x54, 0xFD, 0xF0, 0x12, -+0x87, 0xBF, 0x12, 0x97, 0x18, 0x30, 0xE2, 0x06, 0x54, 0xFB, 0xF0, 0x12, 0x89, 0x23, 0x12, 0x97, -+0x18, 0x30, 0xE4, 0x0B, 0x54, 0xEF, 0xF0, 0x12, 0x8A, 0x78, 0xBF, 0x01, 0x02, 0x11, 0x43, 0xD2, -+0xAF, 0x80, 0xC4, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x91, 0x97, 0xF0, 0xA3, -+0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, 0x12, 0x8E, 0xCA, 0x90, 0x91, 0x9F, 0xF0, 0xA3, 0xF0, 0xA3, -+0xF0, 0x90, 0x01, 0xC4, 0x74, 0x43, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0x12, 0x87, 0x42, 0x12, 0x5E, -+0xE6, 0x90, 0x91, 0x8E, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x82, 0xE0, 0x90, 0x91, 0x96, 0xF0, -+0x90, 0x8F, 0x30, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0xF5, 0xE4, 0x90, 0x91, 0x95, 0xF0, 0x90, 0x91, -+0x96, 0xE0, 0xFF, 0x90, 0x91, 0x95, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0x41, 0xF5, 0x90, 0x91, 0x8E, -+0x12, 0x85, 0xEC, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x91, 0x9F, 0xEF, 0xF0, 0x12, 0x86, 0x15, 0x54, -+0x3F, 0xFE, 0x90, 0x91, 0x90, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x91, 0x9B, 0xEE, 0x12, 0x87, 0x9D, -+0xE0, 0x54, 0x03, 0xFE, 0xEF, 0x24, 0x18, 0x2E, 0xFF, 0x90, 0x91, 0xA0, 0xF0, 0x90, 0x91, 0x8F, -+0xE0, 0x2F, 0xFF, 0x90, 0x91, 0x8E, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x91, 0x92, 0x12, 0x97, 0x05, -+0xC0, 0x07, 0x71, 0x06, 0x7D, 0x01, 0x71, 0x21, 0xC0, 0x07, 0x71, 0x06, 0x7D, 0x04, 0x71, 0x21, -+0xAB, 0x07, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0x5E, 0xBC, 0x90, 0x91, 0x97, 0xEF, 0x71, 0x05, 0xE4, -+0xFD, 0x71, 0x21, 0xEF, 0x54, 0xFC, 0x90, 0x91, 0x94, 0xF0, 0x90, 0x91, 0xA0, 0xE0, 0xFF, 0x90, -+0x91, 0x90, 0xE4, 0x8F, 0xF0, 0x12, 0x46, 0xD6, 0x90, 0x91, 0x90, 0x12, 0x86, 0xB7, 0x90, 0x91, -+0x90, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x97, 0x3D, 0x7D, 0x0F, 0x71, 0x21, 0x90, 0x91, 0x90, -+0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x90, 0x91, 0x8E, 0xEC, 0x8D, 0xF0, 0x12, 0x87, 0x32, 0xFC, 0xA3, -+0xE0, 0xFD, 0xD3, 0x90, 0x91, 0x8F, 0xE0, 0x9D, 0x90, 0x91, 0x8E, 0xE0, 0x9C, 0x40, 0x1B, 0x90, -+0x8E, 0xB0, 0xE0, 0x24, 0x01, 0xFD, 0x90, 0x8E, 0xAF, 0xE0, 0x34, 0x00, 0xFC, 0xC3, 0x90, 0x91, -+0x8F, 0xE0, 0x9D, 0xF0, 0x90, 0x91, 0x8E, 0xE0, 0x9C, 0xF0, 0xEF, 0x30, 0xE6, 0x06, 0x90, 0x01, -+0xC7, 0x74, 0x22, 0xF0, 0xEF, 0x30, 0xE7, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x21, 0xF0, 0xEF, 0x30, -+0xE5, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x23, 0xF0, 0x90, 0x91, 0x94, 0xE0, 0x24, 0x40, 0x60, 0x04, -+0x24, 0x20, 0x70, 0x2C, 0x90, 0x8F, 0x33, 0xE0, 0xFF, 0x12, 0x74, 0x02, 0x20, 0xE0, 0x02, 0x41, -+0x7F, 0x90, 0x8F, 0x46, 0xE0, 0x04, 0x71, 0x05, 0x12, 0x8A, 0x00, 0xEF, 0x70, 0x02, 0x41, 0x7F, -+0x90, 0x91, 0x94, 0xE0, 0xFF, 0x12, 0x8F, 0xA0, 0x90, 0x8F, 0x47, 0xE0, 0x04, 0xF0, 0x41, 0x7F, -+0xF1, 0xF7, 0x30, 0xE0, 0x5E, 0x90, 0x91, 0x97, 0xE0, 0xFF, 0x90, 0x91, 0x93, 0xE0, 0x2F, 0xFF, -+0x90, 0x91, 0x92, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, 0xFE, 0x90, 0x91, 0x9D, -+0x12, 0x97, 0x05, 0xEF, 0x64, 0x45, 0x70, 0x3B, 0xB1, 0xBA, 0xFF, 0x12, 0x8A, 0xAC, 0xEF, 0x64, -+0x01, 0x70, 0x30, 0xB1, 0xBA, 0xFF, 0xF1, 0xAC, 0xEF, 0x64, 0x01, 0x70, 0x26, 0x90, 0x91, 0xA1, -+0x04, 0xB1, 0xB9, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x94, 0x97, 0xEF, 0x70, 0x0E, 0x90, 0x91, 0x9F, -+0xE0, 0xFD, 0x90, 0xFD, 0x11, 0xB1, 0xB9, 0xFF, 0x12, 0x94, 0xE8, 0x90, 0x91, 0x9F, 0xE0, 0x90, -+0xFD, 0x11, 0xF0, 0x71, 0x06, 0x12, 0x8A, 0x00, 0xEF, 0x60, 0x1F, 0x71, 0x06, 0x90, 0x91, 0x97, -+0xE0, 0xFD, 0x90, 0x91, 0x9A, 0xE0, 0xFB, 0x90, 0x91, 0x9F, 0xE0, 0x90, 0x91, 0xA6, 0xF0, 0x71, -+0xC9, 0xEF, 0x60, 0x06, 0x90, 0x91, 0xA1, 0x74, 0x01, 0xF0, 0x90, 0x8F, 0x30, 0xE0, 0xC3, 0x13, -+0x30, 0xE0, 0x12, 0x71, 0x06, 0x90, 0x91, 0x97, 0xE0, 0xFD, 0x91, 0x4B, 0xEF, 0x60, 0x06, 0x90, -+0x91, 0xA1, 0x74, 0x01, 0xF0, 0x90, 0x8F, 0x30, 0xE0, 0xFF, 0x12, 0x74, 0x02, 0x30, 0xE0, 0x0F, -+0x90, 0x91, 0xA1, 0xE0, 0x70, 0x09, 0x71, 0x06, 0x90, 0x91, 0x97, 0xE0, 0xFD, 0xF1, 0x00, 0x12, -+0x8F, 0xF1, 0xEF, 0x64, 0x01, 0x60, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x11, 0x12, 0x97, -+0x34, 0x30, 0xE0, 0x06, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x7F, 0x01, 0x12, 0x74, 0x11, 0x12, -+0x8F, 0x75, 0xEF, 0x64, 0x01, 0x70, 0x37, 0x90, 0x8F, 0x48, 0xE0, 0x04, 0xF0, 0x12, 0x87, 0x66, -+0xAD, 0x07, 0xEF, 0x64, 0x01, 0x60, 0x1F, 0xF1, 0xA4, 0xED, 0xB4, 0x02, 0x08, 0x90, 0x01, 0xC7, -+0x74, 0x42, 0xF0, 0x80, 0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x43, 0xF0, 0x7F, -+0x01, 0x12, 0x74, 0x11, 0x80, 0x1F, 0x12, 0x97, 0x3D, 0x12, 0x87, 0x58, 0x80, 0x0F, 0x12, 0x97, -+0x34, 0x20, 0xE0, 0x11, 0x90, 0x8F, 0x30, 0xE0, 0x54, 0xFE, 0xF0, 0x80, 0x08, 0x90, 0x91, 0x95, -+0xE0, 0x04, 0xF0, 0x01, 0x8E, 0x74, 0x43, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x60, 0xA3, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0x91, 0x92, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xFD, -+0x90, 0x91, 0xAB, 0xE0, 0x34, 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0xE4, -+0xFD, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0x8E, 0xB0, 0xE0, -+0x9B, 0x90, 0x8E, 0xAF, 0xE0, 0x9A, 0x50, 0x0A, 0xA3, 0x12, 0x87, 0x4B, 0xEB, 0x9F, 0xFB, 0xEA, -+0x9E, 0xFA, 0x12, 0x87, 0x2A, 0x74, 0x00, 0x2F, 0x12, 0x89, 0x1B, 0xE0, 0xFF, 0x22, 0x90, 0x91, -+0xB2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x7D, 0x09, 0x71, 0x21, 0xEF, 0x64, 0x06, 0x70, 0x27, 0xB1, -+0xB1, 0xFF, 0x7D, 0x14, 0x71, 0x21, 0xEF, 0x70, 0x1D, 0xB1, 0xB1, 0xFF, 0x7D, 0x15, 0x71, 0x21, -+0xEF, 0x64, 0x50, 0x70, 0x11, 0xB1, 0xB1, 0xFF, 0x7D, 0x21, 0x71, 0x21, 0xEF, 0x20, 0xE0, 0x03, -+0x30, 0xE2, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x8F, 0x31, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, -+0x35, 0xB1, 0xB1, 0xFF, 0x7D, 0x09, 0x71, 0x21, 0xEF, 0x64, 0x11, 0x70, 0x29, 0x90, 0x91, 0xB3, -+0xE0, 0x24, 0x14, 0x12, 0x8A, 0x51, 0x90, 0x91, 0xB4, 0xF0, 0xA3, 0xEF, 0xF0, 0x7D, 0x02, 0x71, -+0x21, 0xEF, 0x70, 0x12, 0x90, 0x91, 0xB4, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7D, 0x03, 0x71, 0x21, -+0xBF, 0x89, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x91, 0xA4, 0xED, 0xF0, 0xA3, 0xEB, -+0xF0, 0x90, 0x91, 0xA2, 0x12, 0x89, 0xF9, 0x90, 0x91, 0xA7, 0xF0, 0xFD, 0x71, 0x21, 0xEF, 0x54, -+0x0C, 0x64, 0x08, 0x70, 0x60, 0xB1, 0x8F, 0xA3, 0xE0, 0xF1, 0xE9, 0x64, 0x88, 0x70, 0x56, 0xB1, -+0x8F, 0xA3, 0xE0, 0x24, 0x07, 0xFD, 0x71, 0x21, 0xEF, 0x64, 0x8E, 0x70, 0x48, 0x90, 0x91, 0xA7, -+0x04, 0xF0, 0xB1, 0x8F, 0x12, 0x96, 0xF1, 0x2D, 0x04, 0xFD, 0x71, 0x21, 0xEF, 0x64, 0x03, 0x70, -+0x34, 0xB1, 0x8F, 0x12, 0x96, 0xF1, 0x2D, 0xF1, 0xE9, 0x30, 0xE3, 0x07, 0x90, 0x01, 0xC7, 0x74, -+0x01, 0x80, 0x1F, 0x90, 0x8F, 0x30, 0x12, 0x96, 0xC6, 0x30, 0xE0, 0x09, 0xB1, 0x8F, 0xA3, 0xE0, -+0xFD, 0xB1, 0xD9, 0x80, 0x10, 0x90, 0x8F, 0x33, 0xF1, 0xFA, 0x30, 0xE0, 0x08, 0x90, 0x01, 0xC7, -+0x74, 0x02, 0xF0, 0xF1, 0xA4, 0x90, 0x91, 0xA7, 0xE0, 0xFF, 0x22, 0x12, 0x95, 0x30, 0x78, 0xAB, -+0x7C, 0x91, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x50, 0xF1, 0xF0, 0x78, 0xB1, 0x7C, 0x91, -+0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x56, 0xF1, 0xE2, 0x78, 0xB5, 0x7C, 0x91, 0x7D, 0x01, -+0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x5A, 0xF1, 0xE2, 0xE4, 0x90, 0x91, 0xBA, 0xF0, 0xB1, 0x98, 0xCF, -+0x24, 0x06, 0xCF, 0xB1, 0xD2, 0xEF, 0x64, 0x08, 0x60, 0x02, 0xA1, 0x89, 0xB1, 0x98, 0xCF, 0x24, -+0x07, 0xCF, 0xB1, 0xD2, 0xEF, 0x64, 0x06, 0x60, 0x02, 0xA1, 0x89, 0x90, 0x91, 0xBA, 0x04, 0xF0, -+0xE4, 0x90, 0x91, 0xB9, 0xF0, 0xB1, 0xAA, 0x94, 0x06, 0x50, 0x1B, 0x90, 0x91, 0xA3, 0xE0, 0x24, -+0x0A, 0xFD, 0x90, 0x91, 0xA2, 0x71, 0x13, 0x90, 0x91, 0xB9, 0xE0, 0x24, 0xA5, 0xF5, 0x82, 0xE4, -+0x34, 0x91, 0xB1, 0xC2, 0x80, 0xDF, 0x78, 0xA5, 0x7C, 0x91, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x8F, -+0x79, 0x40, 0x12, 0x8A, 0x5A, 0x60, 0x02, 0xA1, 0x89, 0x90, 0x91, 0xB9, 0xF0, 0xB1, 0xAA, 0x94, -+0x04, 0x50, 0x1B, 0x12, 0x96, 0x9C, 0xFD, 0xB1, 0xA3, 0xCD, 0x24, 0x20, 0xCD, 0x71, 0x14, 0x90, -+0x91, 0xB9, 0xE0, 0x24, 0xB5, 0xF5, 0x82, 0xE4, 0x34, 0x91, 0xB1, 0xC2, 0x80, 0xDF, 0x78, 0xB5, -+0x7C, 0x91, 0x12, 0x96, 0xB2, 0x70, 0x79, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x01, 0x54, 0xDF, 0xF0, -+0x90, 0x8F, 0x32, 0xE0, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0xC7, 0x74, 0x09, 0xF0, 0xF1, 0xA4, 0x80, -+0x68, 0xE4, 0x90, 0x91, 0xB9, 0xF0, 0xB1, 0xAA, 0x94, 0x06, 0x50, 0x1B, 0x12, 0x96, 0x9C, 0xFD, -+0xB1, 0xA3, 0xCD, 0x24, 0x10, 0xCD, 0x71, 0x14, 0x90, 0x91, 0xB9, 0xE0, 0x24, 0xAB, 0xF5, 0x82, -+0xE4, 0x34, 0x91, 0xB1, 0xC2, 0x80, 0xDF, 0xE4, 0x90, 0x91, 0xB9, 0xF0, 0xB1, 0xAA, 0x94, 0x04, -+0x50, 0x1B, 0x12, 0x96, 0x9C, 0xFD, 0xB1, 0xA3, 0xCD, 0x24, 0x16, 0xCD, 0x71, 0x14, 0x90, 0x91, -+0xB9, 0xE0, 0x24, 0xB1, 0xF5, 0x82, 0xE4, 0x34, 0x91, 0xB1, 0xC2, 0x80, 0xDF, 0x7B, 0x01, 0x7A, -+0x91, 0x79, 0xAB, 0x12, 0x8E, 0xAD, 0xF0, 0x7A, 0x91, 0x79, 0xB1, 0x12, 0x5B, 0xF5, 0x80, 0x09, -+0x90, 0x06, 0x30, 0xE0, 0x44, 0x21, 0x54, 0xEF, 0xF0, 0x90, 0x91, 0xBA, 0xE0, 0xFF, 0x22, 0x90, -+0x91, 0xA2, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x91, 0xA4, 0xE0, 0xFF, 0x90, 0x91, 0xA3, -+0xE0, 0x2F, 0xFF, 0x90, 0x91, 0xA2, 0xE0, 0x34, 0x00, 0x22, 0x90, 0x91, 0xB9, 0xE0, 0xFF, 0xC3, -+0x22, 0x90, 0x91, 0xB2, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0xF0, 0x90, 0x91, 0x9D, 0xE0, 0xFE, 0xA3, -+0xE0, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x91, 0xB9, 0xE0, 0x04, 0xF0, 0x22, 0xFF, 0x90, 0x91, -+0xAB, 0xE0, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x61, 0x21, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x06, 0x31, 0xE0, 0x54, 0xEF, 0x44, 0x08, 0xF0, 0xED, 0x2F, 0xFF, 0xE4, 0x3E, 0xFE, 0x7C, -+0x00, 0xEF, 0x24, 0x08, 0xFF, 0xEC, 0x3E, 0x90, 0x91, 0xAB, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, 0x00, -+0x7F, 0x83, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x43, 0x12, 0x49, 0x38, 0x90, 0x91, 0xAC, -+0xE0, 0x24, 0x01, 0xB1, 0xCD, 0x90, 0x90, 0x44, 0xD1, 0xF9, 0x24, 0x04, 0xB1, 0xCD, 0x90, 0x90, -+0x47, 0xD1, 0xF9, 0x24, 0x05, 0xB1, 0xCD, 0x90, 0x90, 0x48, 0xD1, 0xF9, 0x24, 0x06, 0xB1, 0xCD, -+0x90, 0x90, 0x49, 0xD1, 0xF9, 0x24, 0x07, 0xB1, 0xCD, 0x90, 0x90, 0x4A, 0xD1, 0xF9, 0x24, 0x08, -+0xB1, 0xCD, 0x90, 0x90, 0x4B, 0xEF, 0xF0, 0xE4, 0x90, 0x91, 0xAA, 0xF0, 0x90, 0x91, 0xAA, 0xE0, -+0xFF, 0xC3, 0x94, 0x08, 0x50, 0x15, 0x90, 0x91, 0xAC, 0xE0, 0x24, 0x09, 0x71, 0x0F, 0x90, 0x91, -+0xAA, 0xE0, 0x12, 0x96, 0x79, 0x12, 0x97, 0x60, 0xF0, 0x80, 0xE1, 0xE4, 0x90, 0x91, 0xAA, 0xF0, -+0x90, 0x91, 0xAA, 0xE0, 0xFF, 0xC3, 0x94, 0x20, 0x50, 0x1B, 0x90, 0x91, 0xAC, 0xE0, 0x24, 0x63, -+0x71, 0x0F, 0x90, 0x91, 0xAA, 0xE0, 0x24, 0xA6, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0x12, -+0x97, 0x60, 0xF0, 0x80, 0xDB, 0x90, 0x90, 0x48, 0x12, 0x94, 0x8F, 0x90, 0x91, 0xA8, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0x30, 0xE3, 0x0D, 0x7F, 0x01, 0x12, 0x74, 0x11, 0x90, 0x01, 0xC7, 0x74, 0x03, -+0xF0, 0x80, 0x3F, 0x90, 0x91, 0xA8, 0xA3, 0xE0, 0xFF, 0x7C, 0x00, 0x54, 0x07, 0xFD, 0x64, 0x01, -+0x60, 0x05, 0xED, 0x64, 0x02, 0x70, 0x2B, 0xED, 0x64, 0x02, 0x4C, 0x70, 0x25, 0xEF, 0x54, 0x30, -+0xFF, 0xE4, 0xC4, 0xF8, 0x54, 0xF0, 0xC8, 0xEF, 0xC4, 0x54, 0x0F, 0x48, 0x90, 0x90, 0xDC, 0xF0, -+0xAE, 0x04, 0xAF, 0x05, 0xE4, 0xFD, 0x12, 0x93, 0x98, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xF7, 0x44, -+0x10, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0xF0, 0x90, 0x91, 0xAC, 0xE0, 0x22, -+0x12, 0x95, 0x30, 0x78, 0xA5, 0x7C, 0x91, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x64, 0xF1, -+0xF0, 0x78, 0xAC, 0x7C, 0x91, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x6A, 0xF1, 0xE2, 0xB1, -+0x8F, 0x12, 0x8A, 0x00, 0xEF, 0x60, 0x7C, 0xB1, 0x98, 0xFE, 0x90, 0x91, 0xB0, 0xF0, 0xA3, 0xEF, -+0xF0, 0x24, 0x06, 0xFF, 0xE4, 0x3E, 0xB1, 0xD4, 0xEF, 0x64, 0x08, 0x70, 0x66, 0x90, 0x91, 0xB1, -+0xE0, 0x24, 0x07, 0xFF, 0x90, 0x91, 0xB0, 0xB1, 0xD1, 0xEF, 0x70, 0x57, 0x90, 0x91, 0xAB, 0xF0, -+0x90, 0x91, 0xAB, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x23, 0x90, 0x91, 0xB1, 0xE0, 0x24, 0x18, -+0xFD, 0x90, 0x91, 0xB0, 0x71, 0x13, 0x90, 0x91, 0xAB, 0xE0, 0x24, 0xAC, 0xF5, 0x82, 0xE4, 0x34, -+0x91, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x91, 0xAB, 0xE0, 0x04, 0xF0, 0x80, 0xD3, 0x78, 0xAC, 0x7C, -+0x91, 0x12, 0x96, 0xB2, 0x70, 0x1D, 0x90, 0x91, 0xB1, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x91, 0xB0, -+0xE0, 0x34, 0x00, 0xFE, 0x71, 0x4E, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x22, -+0xF0, 0xF1, 0xA4, 0x22, 0x90, 0x8F, 0x39, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x91, 0xA2, 0xEE, -+0xF0, 0xA3, 0xEF, 0xF0, 0x24, 0x16, 0xFF, 0xE4, 0x3E, 0xB1, 0xD4, 0x90, 0x91, 0x1F, 0xA3, 0xE0, -+0xB5, 0x07, 0x19, 0x90, 0x91, 0xA3, 0xE0, 0x24, 0x16, 0xB1, 0xA2, 0xFE, 0x7D, 0x01, 0x71, 0x21, -+0xEF, 0xFD, 0x90, 0x91, 0x1F, 0xE0, 0x6D, 0x70, 0x01, 0xE4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x7F, -+0x01, 0x22, 0x7E, 0x00, 0x7F, 0x04, 0x02, 0x46, 0xB0, 0x24, 0x06, 0xFD, 0x71, 0x21, 0xEF, 0x22, -+0x7E, 0x00, 0x7F, 0x06, 0x02, 0x46, 0xB0, 0x90, 0x8F, 0x30, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x22, 0xF0, 0xE4, 0x90, 0x92, 0xFF, 0xF0, 0x90, 0x8F, 0x26, 0xE0, 0x90, 0x93, 0x00, 0xF0, 0xE4, -+0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x92, 0xFB, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x92, 0xFF, 0xE0, 0xF5, 0x3B, 0xA3, 0xE0, 0xF5, 0x3C, 0x12, -+0x34, 0x8C, 0x90, 0x92, 0xFB, 0x12, 0x8A, 0x63, 0xA3, 0xA3, 0xA3, 0x74, 0x05, 0xF0, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xE4, 0xF5, 0x13, 0x90, 0x8E, 0xC8, 0xE0, 0x70, 0x02, 0x01, 0xF6, 0x31, 0x09, -+0x60, 0x02, 0x01, 0xF6, 0x12, 0x70, 0x7B, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x12, -+0x77, 0xEC, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x14, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x12, 0x77, 0xC6, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0x12, 0x96, 0x8E, 0x44, 0x80, 0xF0, 0x12, 0x97, 0x97, 0x60, 0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, -+0x70, 0x1E, 0x90, 0x8E, 0xCF, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, 0x8E, 0xD1, 0xE0, -+0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x8E, 0xCE, 0xE0, 0xA3, 0xF0, 0x80, 0x00, 0x75, 0x13, 0x01, -+0xE5, 0x13, 0x60, 0x42, 0x12, 0x97, 0xA7, 0x90, 0x8E, 0xD1, 0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, -+0x13, 0xE4, 0x90, 0x92, 0xFF, 0xF0, 0x90, 0x8E, 0xD1, 0xE0, 0x31, 0x02, 0x11, 0x0B, 0x90, 0x8E, -+0xD1, 0xE0, 0x80, 0x12, 0xE4, 0x90, 0x92, 0xFF, 0x11, 0xF7, 0x11, 0x0B, 0x90, 0x8E, 0xD1, 0xE0, -+0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x31, 0x02, 0x90, 0x8E, 0xE1, 0xF0, 0x90, 0x8E, 0xCB, 0xE0, -+0x20, 0xE2, 0x03, 0x12, 0x51, 0xAF, 0x22, 0xF0, 0x90, 0x8E, 0xD1, 0xE0, 0x75, 0xF0, 0x03, 0xA4, -+0x24, 0xFE, 0xFF, 0x90, 0x8E, 0xD0, 0xE0, 0x2F, 0x22, 0xE4, 0xFF, 0x31, 0x20, 0xEF, 0x64, 0x01, -+0x22, 0x31, 0x09, 0x70, 0x0A, 0x90, 0x8E, 0xC8, 0xE0, 0x60, 0x04, 0xB1, 0x7A, 0x11, 0x01, 0x22, -+0x12, 0x96, 0xE5, 0x12, 0x7D, 0xEA, 0xE0, 0xFD, 0x7C, 0x00, 0x12, 0x7D, 0x5A, 0x80, 0x05, 0xC3, -+0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x7F, 0x00, 0x60, -+0x02, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x92, 0xB6, 0xF0, 0x90, 0x8E, 0xC8, 0xE0, 0x60, 0x5E, 0x31, -+0x09, 0x70, 0x5A, 0x12, 0x97, 0x9F, 0x12, 0x70, 0x7A, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0x12, 0x77, 0xEC, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x14, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x12, 0x77, 0xC6, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x12, 0x96, 0x8E, 0x44, 0x80, 0xF0, 0x90, 0x92, 0xB6, 0x74, 0x01, 0xF0, 0xE4, 0x90, -+0x8E, 0xCF, 0xF0, 0x04, 0x60, 0x17, 0x12, 0x97, 0xA7, 0xE4, 0x90, 0x92, 0xFF, 0xF0, 0x90, 0x8E, -+0xD0, 0x11, 0x0A, 0x90, 0x8E, 0xCB, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x51, 0xAF, 0x22, 0x31, 0x09, -+0x70, 0x16, 0x90, 0x8E, 0xC8, 0xE0, 0x60, 0x10, 0xB1, 0x7A, 0xF0, 0x90, 0x8E, 0xC3, 0xE0, 0xF1, -+0xBB, 0x54, 0x07, 0x70, 0x03, 0x12, 0x7B, 0xC8, 0x22, 0x90, 0x91, 0x78, 0xE0, 0x30, 0xE0, 0x34, -+0x31, 0x09, 0x70, 0x30, 0x90, 0x93, 0x52, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0x91, -+0x7A, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x93, 0x52, 0xF0, 0x90, 0x91, 0x7A, 0xE0, 0xFF, 0x90, 0x91, -+0x79, 0xE0, 0xD3, 0x9F, 0x50, 0x0E, 0x90, 0x91, 0x7B, 0xE0, 0x70, 0x08, 0xE4, 0x90, 0x91, 0x7A, -+0xF0, 0x12, 0x8E, 0x94, 0x22, 0x8B, 0x0D, 0x8A, 0x0E, 0x89, 0x0F, 0x12, 0x4E, 0xCE, 0xFF, 0xF5, -+0x11, 0x12, 0x26, 0x1E, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0x12, 0x4F, 0xED, 0xF5, 0x12, 0x80, -+0x02, 0x8F, 0x12, 0x85, 0x11, 0x10, 0xE5, 0x10, 0xD3, 0x95, 0x12, 0x50, 0x26, 0xAB, 0x0D, 0xAA, -+0x0E, 0xA9, 0x0F, 0x12, 0x26, 0x1E, 0x54, 0x01, 0xFD, 0xAF, 0x10, 0x12, 0x7D, 0xAE, 0xAF, 0x10, -+0x31, 0x20, 0xEF, 0xAF, 0x10, 0x70, 0x05, 0x12, 0x7D, 0x69, 0x80, 0x03, 0x12, 0x7E, 0x4A, 0x05, -+0x10, 0x80, 0xD3, 0xE5, 0x11, 0x70, 0x0E, 0xFF, 0x31, 0x20, 0xEF, 0x70, 0x08, 0x91, 0xFF, 0x54, -+0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x91, 0x8F, 0x12, 0x47, 0x5F, 0x90, 0x91, 0x8E, 0xEF, -+0xF0, 0x12, 0x47, 0x68, 0x6A, 0xAB, 0x00, 0x6A, 0xB0, 0x01, 0x6A, 0xB4, 0x03, 0x6A, 0xB9, 0x04, -+0x6A, 0xBE, 0x12, 0x6A, 0xC3, 0x14, 0x6A, 0xC8, 0x20, 0x6A, 0xCD, 0x21, 0x6A, 0xD2, 0x23, 0x6A, -+0xD7, 0x25, 0x6A, 0xDC, 0x27, 0x6A, 0xE6, 0x80, 0x6A, 0xE1, 0x81, 0x6A, 0xEB, 0x82, 0x6A, 0xF0, -+0x83, 0x6A, 0xF5, 0x84, 0x6A, 0xFA, 0x88, 0x00, 0x00, 0x6A, 0xFF, 0x71, 0x0F, 0x02, 0x80, 0x0D, -+0x71, 0x0F, 0x41, 0x05, 0x71, 0x0F, 0x02, 0x87, 0x7C, 0x71, 0x0F, 0x02, 0x82, 0x7F, 0x71, 0x0F, -+0x02, 0x80, 0x4D, 0x71, 0x0F, 0x02, 0x80, 0x61, 0x71, 0x0F, 0x02, 0x80, 0x70, 0x71, 0x0F, 0x02, -+0x81, 0x25, 0x71, 0x0F, 0x02, 0x81, 0x53, 0x71, 0x0F, 0x02, 0x81, 0x5B, 0x71, 0x0F, 0x02, 0x81, -+0x63, 0x71, 0x0F, 0x02, 0x81, 0xA4, 0x71, 0x0F, 0x02, 0x76, 0x2B, 0x71, 0x0F, 0x02, 0x90, 0x15, -+0x71, 0x0F, 0x02, 0x90, 0x2B, 0x71, 0x0F, 0x02, 0x90, 0x8A, 0x71, 0x0F, 0x02, 0x90, 0x78, 0x90, -+0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x91, 0x8E, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, -+0x91, 0x8F, 0x02, 0x47, 0x56, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8E, 0xD6, 0x71, -+0xB7, 0x12, 0x97, 0xBF, 0x90, 0x8E, 0xD6, 0x71, 0xB7, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, -+0x90, 0x00, 0x10, 0xE0, 0x44, 0x0C, 0xFD, 0x7F, 0x10, 0x12, 0x3A, 0x96, 0x90, 0x00, 0x72, 0xE0, -+0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x3A, 0x96, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, -+0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, -+0xF0, 0x12, 0x97, 0x46, 0x54, 0xBF, 0x71, 0xC6, 0x71, 0xB7, 0x12, 0x97, 0x68, 0x90, 0x00, 0x02, -+0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x12, 0x3A, 0x96, 0x7F, 0x00, 0x7E, 0x0C, 0x71, 0xC0, 0x71, -+0xB7, 0x12, 0x96, 0xCD, 0x71, 0xC0, 0x71, 0xB7, 0x7F, 0x00, 0x12, 0x97, 0x0E, 0x70, 0x12, 0x91, -+0xEE, 0x54, 0xE7, 0x91, 0xA5, 0x91, 0xEE, 0x54, 0x18, 0x70, 0x06, 0x90, 0x01, 0xBF, 0xE0, 0x04, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0x93, -+0x13, 0x12, 0x27, 0x48, 0x90, 0x93, 0x13, 0x12, 0x47, 0x32, 0x90, 0xAC, 0xB9, 0x02, 0x27, 0x48, -+0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0x93, 0x0D, 0x12, 0x27, 0x48, 0x90, 0x93, -+0x0D, 0x22, 0x90, 0x93, 0x31, 0x12, 0x47, 0x5F, 0xEF, 0x70, 0x07, 0x90, 0x93, 0x34, 0x04, 0xF0, -+0x80, 0x0B, 0xEF, 0x64, 0x01, 0x70, 0x25, 0x90, 0x93, 0x34, 0x74, 0x40, 0xF0, 0x7F, 0xE2, 0x12, -+0x3A, 0x96, 0x90, 0x93, 0x34, 0xE0, 0x91, 0xE8, 0x90, 0x00, 0xE1, 0xE0, 0xFF, 0x90, 0x93, 0x31, -+0x12, 0x47, 0x56, 0xEF, 0x12, 0x26, 0x64, 0x91, 0xE7, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, -+0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0xFF, 0x12, 0x53, 0x91, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x12, 0x53, 0xA0, 0x7F, 0x00, 0x7E, 0x0C, 0x71, 0xA6, 0x12, 0x96, 0xCD, 0x71, 0xA6, -+0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x12, 0x96, 0x3B, 0x12, 0x96, -+0x3B, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x12, 0x3A, 0x96, 0x12, 0x97, 0x46, 0x44, 0x40, 0x71, 0xAC, -+0x12, 0x97, 0x68, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, -+0x53, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0x7F, 0xD5, 0x90, 0x8E, 0xD6, 0x12, 0x27, 0x48, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x12, 0x97, 0xBF, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x12, 0x97, 0x0E, 0x70, 0x14, 0x7B, 0x01, 0x7A, 0x93, -+0x79, 0x12, 0x7D, 0x08, 0x7F, 0x01, 0x71, 0xD2, 0x90, 0x93, 0x12, 0xE0, 0x44, 0x18, 0x91, 0xA5, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFB, 0x7D, 0x08, 0x7F, 0x01, 0x90, 0x93, 0x48, 0xEB, 0xF0, 0xEF, -+0x70, 0x06, 0xA3, 0x74, 0x03, 0xF0, 0x80, 0x0B, 0xEF, 0x64, 0x01, 0x70, 0x28, 0x90, 0x93, 0x49, -+0x74, 0x42, 0xF0, 0x7F, 0xE2, 0x12, 0x3A, 0x96, 0x90, 0x93, 0x48, 0xE0, 0xFD, 0x7F, 0xE0, 0x12, -+0x3A, 0x96, 0x90, 0x93, 0x49, 0xE0, 0x91, 0xE8, 0x90, 0x93, 0x49, 0xE0, 0x54, 0xFD, 0x91, 0xE8, -+0x91, 0xE7, 0x7F, 0x01, 0x22, 0x81, 0x0C, 0xE4, 0xFD, 0x7F, 0xE3, 0x02, 0x3A, 0x96, 0x7B, 0x01, -+0x7A, 0x93, 0x79, 0x11, 0x7D, 0x08, 0x7F, 0x01, 0x71, 0xD2, 0x90, 0x93, 0x11, 0xE0, 0x22, 0x71, -+0x15, 0x12, 0x57, 0x8E, 0x90, 0x8E, 0xC3, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0xEF, 0x70, 0x32, 0x7D, -+0x78, 0x7F, 0x02, 0xD1, 0x5A, 0x7D, 0x02, 0x7F, 0x03, 0xD1, 0x5A, 0x7D, 0xC8, 0x7F, 0x02, 0xD1, -+0xC8, 0xB1, 0x7A, 0xF0, 0xE4, 0xFF, 0x31, 0x20, 0xEF, 0x70, 0x0A, 0x91, 0xFF, 0x54, 0xBF, 0xF0, -+0x54, 0x7F, 0xF0, 0x80, 0x07, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x51, 0xB3, 0xB1, 0x04, 0x02, 0x97, -+0x58, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, 0xD1, 0x6F, -+0x7D, 0x02, 0x7F, 0x03, 0xD1, 0x6F, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0x12, 0x96, 0xA7, 0xE4, -+0xFF, 0x31, 0x20, 0xBF, 0x01, 0x10, 0xF1, 0xAB, 0x90, 0x8E, 0xCB, 0xE0, 0x20, 0xE2, 0x0A, 0x7D, -+0x01, 0x7F, 0x04, 0x02, 0x51, 0xB3, 0x12, 0x97, 0x87, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, -+0x01, 0x3C, 0x74, 0x02, 0x22, 0x90, 0x05, 0x62, 0xE0, 0xFE, 0x90, 0x05, 0x61, 0xE0, 0xFD, 0xED, -+0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x85, 0xF4, 0x31, 0x09, 0x60, -+0x02, 0xC1, 0x4F, 0x90, 0x8E, 0xC8, 0xE0, 0x70, 0x02, 0xC1, 0x4F, 0x12, 0x97, 0x2B, 0x64, 0x01, -+0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x8E, 0xCF, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0x8E, -+0xCE, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x8E, 0xCE, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, -+0x8E, 0xCF, 0xEF, 0xF0, 0x12, 0x70, 0x9D, 0xE4, 0x90, 0x8E, 0xD1, 0x12, 0x96, 0xA7, 0xB1, 0x7A, -+0xF1, 0xBD, 0x54, 0xEF, 0xF0, 0x12, 0x97, 0x2B, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x03, 0x12, 0x7B, -+0x77, 0x12, 0x96, 0x83, 0x30, 0xE0, 0x55, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x24, -+0x12, 0x97, 0x8F, 0x6F, 0x70, 0x46, 0x90, 0x8E, 0xC4, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0x97, 0x9F, -+0xD1, 0xBD, 0xD1, 0xDC, 0xD1, 0x56, 0x7D, 0x02, 0x7F, 0x02, 0xD1, 0x5A, 0x90, 0x8E, 0xCF, 0xE0, -+0x14, 0xF0, 0x80, 0x28, 0x12, 0x97, 0x97, 0x64, 0x01, 0x70, 0x21, 0x12, 0x97, 0x8F, 0xFE, 0x6F, -+0x60, 0x1A, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x11, 0x90, 0x8E, 0xC4, 0xF1, 0xED, -+0x30, 0xE0, 0x09, 0xEF, 0x54, 0xBF, 0xD1, 0xBD, 0xD1, 0xC8, 0xD1, 0x65, 0x12, 0x97, 0x87, 0x22, -+0x7D, 0x02, 0x7F, 0x02, 0xD1, 0x5A, 0x7D, 0x01, 0x7F, 0x02, 0x74, 0x5D, 0x12, 0x97, 0xAF, 0xFE, -+0xF6, 0x74, 0x30, 0x80, 0x6C, 0x7D, 0x01, 0x7F, 0x02, 0xD1, 0x6F, 0x7D, 0x02, 0x7F, 0x02, 0x74, -+0x5D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x80, 0x56, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x18, 0xF1, 0xB3, 0x60, 0x09, 0xD1, 0xC1, 0xD1, 0xDC, 0x12, -+0x97, 0x22, 0x80, 0x06, 0xD1, 0xC1, 0xD1, 0xC8, 0xD1, 0x50, 0x12, 0x92, 0x0A, 0x80, 0x19, 0xF1, -+0xB3, 0x60, 0x06, 0xD1, 0xC1, 0xD1, 0xDC, 0x80, 0x04, 0xD1, 0xC1, 0xD1, 0xC8, 0xD1, 0x6B, 0x7D, -+0x01, 0x7F, 0x02, 0xD1, 0x6F, 0x12, 0x92, 0x16, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0x01, -+0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x74, 0x65, 0x12, 0x97, 0xAF, 0xFE, 0xF6, 0x74, -+0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x74, 0x65, 0x2F, 0xF8, -+0xE6, 0x4D, 0x80, 0xE9, 0xEF, 0x60, 0x3C, 0x90, 0x91, 0x67, 0xE0, 0xFF, 0x60, 0x03, 0x12, 0x5F, -+0xE2, 0x90, 0x01, 0xC7, 0xE4, 0x12, 0x5E, 0xDD, 0x12, 0x82, 0xDB, 0x90, 0x06, 0x09, 0xE0, 0x54, -+0xFE, 0xF0, 0x7D, 0x35, 0x91, 0x16, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0x12, 0x86, 0xDE, -+0xF1, 0xEC, 0x12, 0x57, 0x86, 0x12, 0x90, 0xC9, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, -+0xFF, 0xC1, 0x6F, 0x7D, 0x08, 0xE4, 0xFF, 0xD1, 0x5A, 0x90, 0x06, 0x90, 0xE0, 0x54, 0xF0, 0xF0, -+0x90, 0x02, 0x86, 0xE0, 0x54, 0xFB, 0xF0, 0x12, 0x8E, 0xE4, 0x12, 0x4F, 0xC7, 0x02, 0x4E, 0x1A, -+0x12, 0x96, 0x83, 0x30, 0xE0, 0x0F, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x06, 0x7D, -+0x02, 0x7F, 0x02, 0xD1, 0x5A, 0x90, 0x8E, 0xC3, 0xF1, 0xED, 0x30, 0xE0, 0x09, 0xEF, 0xF1, 0xBB, -+0x54, 0x07, 0x70, 0x46, 0x80, 0x41, 0x90, 0x8E, 0xD1, 0xE0, 0x04, 0xF0, 0x90, 0x8E, 0xCC, 0xE0, -+0x54, 0xEF, 0xF0, 0x12, 0x91, 0xFE, 0x40, 0x2F, 0x31, 0x09, 0x70, 0x2E, 0x12, 0x7C, 0x01, 0x70, -+0x05, 0x12, 0x91, 0xC8, 0x80, 0x25, 0x12, 0x91, 0xC8, 0x90, 0x8E, 0xD2, 0xE0, 0x04, 0xF0, 0xE0, -+0xD3, 0x94, 0x02, 0x40, 0x09, 0xF1, 0xAB, 0xE4, 0x90, 0x8E, 0xD2, 0xF0, 0x80, 0x03, 0x12, 0x57, -+0x98, 0xE4, 0x90, 0x8E, 0xD1, 0xF0, 0x22, 0x12, 0x7B, 0xC8, 0x22, 0x90, 0x8E, 0xC4, 0xE0, 0x54, -+0xFB, 0xF0, 0x22, 0x90, 0x8F, 0x2E, 0xE0, 0x90, 0x01, 0x3F, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0x8E, -+0xCC, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x8E, 0xC3, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x8E, -+0xD1, 0xF0, 0xA3, 0xF0, 0x90, 0x8E, 0xCC, 0xF0, 0x90, 0x8E, 0xC4, 0xE0, 0x54, 0xF7, 0xF0, 0x54, -+0xBF, 0xF0, 0xD1, 0x65, 0x7D, 0x10, 0x7F, 0x03, 0xC1, 0xC8, 0x01, 0x43, 0x22, 0xE0, 0xFF, 0x13, -+0x13, 0x54, 0x3F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x92, 0xF4, 0xEF, 0xF0, -+0xA3, 0xED, 0xF0, 0xFB, 0x7D, 0x00, 0x7C, 0x00, 0xE4, 0x90, 0x92, 0xFA, 0xF0, 0xEB, 0x90, 0x92, -+0xF5, 0xF0, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xE4, 0xFF, 0xEC, 0x90, 0x92, 0xF6, 0x12, -+0x27, 0x48, 0x90, 0x92, 0xF6, 0x12, 0x47, 0x3E, 0x90, 0x92, 0xF5, 0x11, 0x94, 0xA3, 0x12, 0x27, -+0x48, 0x90, 0x92, 0xF6, 0x12, 0x6B, 0xB7, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x11, 0x64, -+0x90, 0x92, 0xF4, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0xAF, 0xF5, -+0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x36, 0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3A, 0xF7, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x12, 0x6F, 0xF4, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0xFF, -+0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x08, 0x12, 0x27, 0x35, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, -+0x07, 0x90, 0x05, 0x60, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x02, 0x47, 0x14, 0x11, 0x7B, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xF1, 0xEC, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0x12, 0x47, 0x14, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xF1, 0xC6, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x14, 0x90, 0x8F, 0x17, 0x12, 0x27, 0x48, 0x90, -+0x8F, 0x1B, 0x12, 0x47, 0x32, 0x90, 0x8F, 0x17, 0x12, 0x47, 0x3E, 0xC3, 0x12, 0x47, 0x21, 0x40, -+0x3F, 0x90, 0x8E, 0xC3, 0xE0, 0x90, 0x8F, 0x1B, 0x30, 0xE0, 0x0F, 0x51, 0x06, 0x90, 0x8E, 0xE5, -+0xE0, 0x24, 0x04, 0x2F, 0xFF, 0x90, 0x8F, 0x1F, 0x80, 0x05, 0x51, 0x06, 0x90, 0x8F, 0x20, 0xE0, -+0xFE, 0xC3, 0xEF, 0x9E, 0x90, 0x92, 0xA7, 0xF0, 0x90, 0x92, 0xA7, 0xE0, 0xFF, 0xC3, 0x94, 0x2D, -+0x50, 0x0E, 0x74, 0xE6, 0x2F, 0x31, 0xEE, 0xE0, 0x04, 0xF0, 0x90, 0x8E, 0xDE, 0xE0, 0x04, 0xF0, -+0x90, 0x8E, 0xDE, 0xE0, 0xFF, 0xD3, 0x90, 0x8F, 0x22, 0xE0, 0x9F, 0x90, 0x8F, 0x21, 0xE0, 0x94, -+0x00, 0x40, 0x02, 0x21, 0xEA, 0xE4, 0xFF, 0xFE, 0x31, 0xEB, 0x31, 0xF6, 0xFD, 0xEF, 0xD3, 0x9D, -+0x40, 0x07, 0x90, 0x92, 0xA8, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xEA, 0xE4, 0xFF, -+0xFE, 0x31, 0xEB, 0x31, 0xF6, 0xFD, 0xC3, 0x90, 0x8F, 0x22, 0xE0, 0x9D, 0xFD, 0x90, 0x8F, 0x21, -+0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, 0x40, 0x07, 0x90, 0x92, 0xA9, 0xEE, 0xF0, -+0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xDA, 0x90, 0x92, 0xA8, 0xE0, 0x90, 0x8E, 0xE3, 0xF0, 0x90, -+0x92, 0xA9, 0xE0, 0x90, 0x8E, 0xE4, 0x31, 0xFE, 0x94, 0x0A, 0x40, 0x0A, 0xEF, 0x24, 0xF6, 0x90, -+0x8E, 0xDB, 0xF0, 0xE4, 0x80, 0x09, 0xE4, 0x90, 0x8E, 0xDB, 0x31, 0xFE, 0x74, 0x0A, 0x9F, 0x90, -+0x8E, 0xDA, 0xF0, 0x90, 0x8E, 0xE3, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x8E, 0xE1, 0xF0, -+0x90, 0x8E, 0xC3, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8F, 0x1F, 0x80, 0x03, 0x90, 0x8F, 0x20, 0xE0, -+0x04, 0xFF, 0x90, 0x8E, 0xE1, 0xE0, 0x2F, 0xF0, 0x90, 0x8E, 0xE1, 0xE0, 0xC3, 0x94, 0x0A, 0x50, -+0x03, 0x74, 0x0A, 0xF0, 0x90, 0x8E, 0xE1, 0xE0, 0x24, 0x02, 0xF0, 0xF1, 0xD2, 0xFB, 0x90, 0x93, -+0x38, 0x74, 0x03, 0xF0, 0x51, 0x47, 0xE4, 0xFF, 0x51, 0x23, 0x22, 0x74, 0xE6, 0x2E, 0xF5, 0x82, -+0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0xE0, 0x2F, 0xFF, 0x90, 0x8F, 0x23, 0xE0, 0x22, 0xF0, 0x90, -+0x8E, 0xE3, 0xE0, 0xFF, 0xC3, 0x22, 0x12, 0x47, 0x3E, 0x90, 0x8F, 0x17, 0x12, 0x47, 0x32, 0x12, -+0x46, 0xF9, 0x78, 0x0A, 0x12, 0x27, 0x22, 0x90, 0x8E, 0xE0, 0xE0, 0xFE, 0xC3, 0x74, 0x0A, 0x9E, -+0x2F, 0xFF, 0x22, 0xE4, 0xFE, 0x31, 0xEB, 0xE4, 0xF0, 0x0E, 0xEE, 0xB4, 0x2D, 0xF7, 0xE4, 0x90, -+0x8E, 0xDF, 0xF0, 0x90, 0x8E, 0xDE, 0xF0, 0x90, 0x8E, 0xE2, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, -+0x74, 0x2D, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, -+0x90, 0x8E, 0xC4, 0x91, 0x01, 0x30, 0xE0, 0x02, 0x61, 0x02, 0x90, 0x8E, 0xC3, 0xE0, 0x30, 0xE0, -+0x16, 0x90, 0x8E, 0xE5, 0xE0, 0x24, 0x04, 0x90, 0x8E, 0xDD, 0xF0, 0x90, 0x8E, 0xE5, 0xE0, 0x24, -+0x03, 0x90, 0x8E, 0xDC, 0xF0, 0x80, 0x0D, 0x90, 0x8E, 0xDD, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0xDC, -+0x14, 0xF0, 0x0B, 0x0B, 0x90, 0x8E, 0xDC, 0xE0, 0xFA, 0x90, 0x8E, 0xDB, 0xE0, 0xD3, 0x9A, 0x50, -+0x0E, 0x90, 0x8E, 0xD0, 0xEB, 0xF0, 0x90, 0x8E, 0xDD, 0xE0, 0xC3, 0x9D, 0x2C, 0x80, 0x11, 0xC3, -+0xED, 0x9A, 0x2B, 0x90, 0x8E, 0xD0, 0xF0, 0x90, 0x8E, 0xDC, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, -+0x90, 0x8E, 0xE0, 0xF0, 0x90, 0x8E, 0xDD, 0xE0, 0xFF, 0x24, 0x0A, 0xFD, 0xE4, 0x33, 0xFC, 0x90, -+0x8E, 0xE0, 0x71, 0x0E, 0x98, 0x40, 0x04, 0xEF, 0x24, 0x0A, 0xF0, 0x90, 0x8E, 0xE0, 0xE0, 0xFF, -+0x24, 0x23, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x8E, 0xD0, 0x71, 0x0E, 0x98, 0x40, 0x04, 0xEF, 0x24, -+0x23, 0xF0, 0x90, 0x8E, 0xE0, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0x8E, 0xD4, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0x05, 0x58, 0xE0, 0x6F, 0x70, 0x01, 0xE4, 0x60, 0x03, 0x12, 0x96, 0xA8, 0x71, 0xF6, -+0x80, 0x07, 0x90, 0x8E, 0xC5, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xD3, -+0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x22, 0x90, 0x8E, 0xC8, 0xE0, 0x60, 0x73, 0x90, 0x8E, -+0xDF, 0xE0, 0x04, 0x11, 0x7A, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xF1, 0xEC, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x14, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0xF1, 0xC6, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x14, 0x90, -+0x8F, 0x13, 0x12, 0x96, 0x94, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0D, 0xF1, 0xD2, 0xFB, -+0x90, 0x93, 0x38, 0x74, 0x05, 0xF0, 0x51, 0x47, 0x71, 0xF6, 0x12, 0x96, 0x83, 0x30, 0xE0, 0x0A, -+0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0x6E, 0x50, 0x90, 0x93, 0x50, 0xE0, 0x04, 0xF0, -+0xE0, 0xC3, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, -+0xF0, 0xF1, 0x42, 0x12, 0x69, 0xC9, 0xE4, 0x90, 0x91, 0x7B, 0xF0, 0x12, 0x92, 0x32, 0x12, 0x67, -+0xF7, 0x30, 0xE0, 0x51, 0x90, 0x91, 0x0F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7C, 0x00, 0x7D, 0x64, -+0x12, 0x26, 0xAA, 0x90, 0x91, 0x63, 0xE0, 0x6E, 0x70, 0x03, 0xA3, 0xE0, 0x6F, 0x60, 0x0A, 0x90, -+0x91, 0x63, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x46, 0xD6, 0x90, 0x91, 0x13, 0xE0, 0xFE, 0xA3, 0xE0, -+0xFF, 0x90, 0x91, 0x21, 0xE0, 0xB5, 0x06, 0x13, 0xA3, 0xE0, 0xB5, 0x07, 0x0E, 0xEF, 0x4E, 0x60, -+0x0A, 0x90, 0x01, 0xC7, 0x74, 0x31, 0xF0, 0x7F, 0x01, 0x80, 0x26, 0x12, 0x84, 0x63, 0xE4, 0x90, -+0x91, 0x63, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x8E, 0xC5, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x8F, -+0x34, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0x7F, -+0x01, 0x90, 0x93, 0x51, 0xEF, 0xF0, 0x90, 0x8D, 0x07, 0xE0, 0x64, 0x02, 0x70, 0x1E, 0x90, 0x93, -+0x51, 0xE0, 0xFD, 0x64, 0x01, 0x70, 0x30, 0x12, 0x67, 0xA4, 0x71, 0xFE, 0x30, 0xE0, 0x09, 0x90, -+0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, 0x1F, 0xAF, 0x05, 0x80, 0x19, 0x90, 0x01, 0x00, 0x74, -+0xFF, 0xF0, 0x7F, 0x64, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, -+0x90, 0x93, 0x51, 0xE0, 0xFF, 0x91, 0x62, 0xF1, 0x3B, 0xF0, 0x90, 0x8F, 0x30, 0xE0, 0x54, 0xBF, -+0xF0, 0x22, 0xAD, 0x07, 0x90, 0x8F, 0x35, 0xE0, 0x75, 0xF0, 0x40, 0xA4, 0xFF, 0x90, 0x93, 0x17, -+0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x8F, 0x36, 0xE0, 0xC3, 0x13, 0x54, -+0x7F, 0x90, 0x93, 0x1A, 0xF0, 0x90, 0x8F, 0x37, 0xE0, 0x13, 0x13, 0x54, 0x01, 0x90, 0x93, 0x1B, -+0xF0, 0xED, 0x64, 0x01, 0x70, 0x6E, 0xE0, 0x70, 0x15, 0x90, 0x93, 0x17, 0xE0, 0x70, 0x02, 0xA3, -+0xE0, 0x60, 0x0B, 0x90, 0x93, 0x17, 0x74, 0xFF, 0x75, 0xF0, 0xD0, 0x12, 0x46, 0xD6, 0xB1, 0xED, -+0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0xB1, 0x05, 0xB1, 0xED, 0x54, 0x01, 0xFD, -+0xB1, 0x05, 0x90, 0x8F, 0x36, 0xE0, 0x30, 0xE0, 0x3B, 0xB1, 0xDE, 0x54, 0x07, 0x7D, 0x00, 0x20, -+0xE0, 0x02, 0x7D, 0x01, 0xB1, 0x05, 0xE4, 0x90, 0x93, 0x19, 0xF0, 0x90, 0x93, 0x1A, 0xE0, 0xFF, -+0x90, 0x93, 0x19, 0xE0, 0xC3, 0x9F, 0x50, 0x1C, 0xB1, 0xDE, 0x54, 0x01, 0xFD, 0xB1, 0x05, 0xB1, -+0xDE, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0xB1, 0x05, 0x90, 0x93, 0x19, 0xE0, -+0x04, 0xF0, 0x80, 0xD7, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x4B, 0xED, -+0xF0, 0x90, 0x93, 0x4A, 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x4B, 0xB1, 0xD6, 0x80, 0x02, 0xC3, -+0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x47, 0xE0, 0x5F, 0xFD, 0x7F, 0x47, 0xB1, 0xD0, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x46, 0xE0, 0x4F, 0xFD, 0x7F, 0x46, 0xF1, 0x33, -+0x60, 0x10, 0xB1, 0xD3, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x45, 0xE0, 0x4F, -+0x80, 0x0F, 0xB1, 0xD3, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x45, 0xE0, -+0x5F, 0xFD, 0x7F, 0x45, 0x80, 0x62, 0x90, 0x93, 0x4A, 0xE0, 0x24, 0xF8, 0xF0, 0xE0, 0x24, 0x04, -+0xB1, 0xD7, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x43, 0xE0, 0x5F, 0xFD, -+0x7F, 0x43, 0xB1, 0xD0, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x43, 0xE0, 0x4F, -+0xFD, 0x7F, 0x43, 0xF1, 0x33, 0x60, 0x19, 0x90, 0x93, 0x4A, 0xE0, 0x24, 0x04, 0xB1, 0xD7, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x42, 0xE0, 0x4F, 0xFD, 0x7F, 0x42, 0x80, 0x18, -+0x90, 0x93, 0x4A, 0xE0, 0x24, 0x04, 0xB1, 0xD7, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, -+0x90, 0x00, 0x42, 0xE0, 0x5F, 0xFD, 0x7F, 0x42, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x12, 0x3A, 0x96, 0x90, 0x93, 0x4A, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, 0x90, 0x93, -+0x17, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x93, 0x1B, 0xE0, 0xFD, 0xB1, 0xFC, 0x90, 0x8F, 0x34, -+0xE0, 0x54, 0x7F, 0xFF, 0x90, 0x8F, 0x33, 0xE0, 0xFE, 0xC4, 0x13, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x8E, 0x14, 0x8F, 0x15, 0xBD, 0x01, 0x15, 0xE5, 0x15, 0x78, 0x03, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xEE, 0x54, 0x1F, 0xFE, 0x12, 0x3A, 0x69, 0x80, 0x07, 0xAF, -+0x15, 0xAE, 0x14, 0x12, 0x3A, 0xF7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0xF1, 0xDF, 0x12, 0x26, 0x1E, 0x20, 0xE0, 0x05, 0x12, 0x8E, 0xE4, 0xE1, 0x11, 0x12, -+0x81, 0x96, 0x90, 0x8F, 0x33, 0xF1, 0x1E, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0xF1, 0x16, 0x12, -+0x82, 0xD3, 0xF1, 0x2C, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0xF1, 0x16, 0x12, 0x82, 0x54, 0xF1, -+0x2C, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, 0xF1, 0x16, 0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, 0x12, -+0x4E, 0xCC, 0x54, 0x80, 0xFF, 0x90, 0x8F, 0x34, 0xE0, 0x54, 0x7F, 0x4F, 0xF0, 0x12, 0x26, 0x1E, -+0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x91, -+0x92, 0x12, 0x47, 0x56, 0x12, 0x26, 0x1E, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, -+0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x8D, 0x07, 0xE0, 0xB4, 0x02, 0x05, 0x71, 0xFE, 0x20, -+0xE0, 0x41, 0x12, 0x4E, 0xCE, 0x54, 0x7F, 0xFF, 0x90, 0x8F, 0x34, 0xE0, 0x54, 0x80, 0x12, 0x4F, -+0xEB, 0x90, 0x8F, 0x35, 0x12, 0x4F, 0xAD, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8F, 0x36, 0xF1, 0xE5, -+0xEF, 0x54, 0xFE, 0xFF, 0xEE, 0x54, 0x01, 0x4F, 0x12, 0x4F, 0xCF, 0x54, 0x04, 0xFF, 0x90, 0x8F, -+0x37, 0xE0, 0x54, 0xFB, 0x4F, 0xF0, 0xB1, 0xED, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, -+0x01, 0xB1, 0x05, 0x90, 0x8D, 0x07, 0xE0, 0xB4, 0x01, 0x17, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, -+0xF0, 0x90, 0x91, 0x0D, 0x74, 0x05, 0xF0, 0x12, 0x82, 0xE3, 0x7A, 0x90, 0x79, 0x4C, 0x12, 0x49, -+0x38, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x4D, 0xFF, 0x90, 0x8F, 0x33, 0xF0, 0xEE, 0x22, 0xE0, 0x54, -+0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x26, -+0x1E, 0xFE, 0x22, 0x12, 0x3A, 0x96, 0x90, 0x93, 0x4B, 0xE0, 0x22, 0x90, 0x91, 0x7C, 0xE0, 0x54, -+0xFE, 0x22, 0x90, 0x91, 0x7C, 0xE0, 0x30, 0xE0, 0x7C, 0x90, 0x91, 0x80, 0xE0, 0x04, 0xF0, 0x90, -+0x91, 0x83, 0xE0, 0x64, 0x01, 0x70, 0x31, 0x90, 0x91, 0x7C, 0x12, 0x6F, 0xED, 0x30, 0xE0, 0x28, -+0x90, 0x91, 0x82, 0xE0, 0x70, 0x22, 0x90, 0x91, 0x7F, 0xE0, 0xFE, 0xA3, 0xE0, 0xC3, 0x9E, 0x40, -+0x17, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x08, 0x12, 0x7D, 0x62, 0xF1, 0x3B, 0xF0, -+0x80, 0x06, 0x91, 0x09, 0xF1, 0x3B, 0xF0, 0x22, 0x90, 0x91, 0x80, 0xE0, 0xFF, 0x90, 0x91, 0x7D, -+0xE0, 0xD3, 0x9F, 0x50, 0x30, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x1A, 0x90, 0x91, 0x82, 0xE0, -+0x70, 0x14, 0x7D, 0x08, 0xFF, 0x12, 0x56, 0x93, 0x90, 0x91, 0x81, 0xE0, 0x04, 0xF0, 0x90, 0x91, -+0x7B, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0x91, 0x80, -+0xF0, 0x90, 0x91, 0x82, 0xF0, 0x22, 0xA3, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x18, 0x02, -+0x27, 0x35, 0x90, 0x8E, 0xDA, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8E, 0xE1, 0xE0, 0x22, 0x90, -+0x91, 0x92, 0x02, 0x47, 0x5F, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0x22, 0x90, 0x05, 0x62, 0xE0, -+0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x10, 0x02, 0x27, 0x35, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0x93, 0x03, 0x12, 0x47, 0x32, 0x90, 0xAC, 0x9C, 0x12, 0x27, -+0x48, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0x32, 0x65, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, -+0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, -+0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x1D, 0xF0, -+0x74, 0x78, 0xA3, 0xF0, 0x11, 0x6C, 0x74, 0x1D, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x78, 0xA3, -+0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x7B, 0x00, 0x7A, 0x00, -+0x79, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x51, 0x52, 0x53, 0x7B, 0x00, 0x7A, -+0x00, 0x79, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x52, 0x52, 0x54, 0xAB, 0x53, -+0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x02, 0x39, 0x04, -+0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, -+0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, -+0x74, 0xA0, 0xF0, 0x74, 0x78, 0xA3, 0xF0, 0x11, 0xEF, 0x74, 0xA0, 0x04, 0x90, 0x01, 0xC4, 0xF0, -+0x74, 0x78, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, -+0x00, 0x54, 0xE0, 0x55, 0x55, 0xF5, 0x59, 0xA3, 0xE0, 0x55, 0x56, 0xF5, 0x5A, 0xA3, 0xE0, 0x55, -+0x57, 0xF5, 0x5B, 0xA3, 0xE0, 0x55, 0x58, 0xF5, 0x5C, 0xAD, 0x59, 0x7F, 0x54, 0x12, 0x3A, 0x96, -+0xAD, 0x5A, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0xAD, 0x5B, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0xAD, 0x5C, -+0x7F, 0x57, 0x12, 0x3A, 0x96, 0x53, 0x91, 0xEF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, -+0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x29, 0xF0, 0x74, 0x79, 0xA3, 0xF0, -+0x12, 0x8C, 0x36, 0xE5, 0x61, 0x30, 0xE3, 0x02, 0x71, 0x4C, 0xE5, 0x61, 0x30, 0xE4, 0x02, 0x51, -+0x15, 0xE5, 0x61, 0x30, 0xE5, 0x03, 0x12, 0x8C, 0x93, 0xE5, 0x63, 0x30, 0xE0, 0x03, 0x12, 0x6F, -+0xEA, 0xE5, 0x63, 0x30, 0xE1, 0x03, 0x12, 0x73, 0x18, 0xE5, 0x63, 0x30, 0xE2, 0x03, 0x12, 0x8C, -+0xCF, 0xE5, 0x63, 0x30, 0xE3, 0x03, 0x12, 0x69, 0x11, 0xE5, 0x63, 0x30, 0xE4, 0x03, 0x12, 0x69, -+0xAE, 0xE5, 0x63, 0x30, 0xE5, 0x02, 0x71, 0xE7, 0xE5, 0x63, 0x30, 0xE6, 0x02, 0x71, 0x58, 0xE5, -+0x64, 0x30, 0xE1, 0x03, 0x12, 0x8C, 0xE1, 0xE5, 0x64, 0x30, 0xE6, 0x02, 0x31, 0xD4, 0x74, 0x29, -+0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x79, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, -+0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, -+0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x07, 0x1F, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, -+0x01, 0xFF, 0x90, 0x92, 0xA7, 0xF0, 0x90, 0x92, 0xA5, 0x74, 0x02, 0xF0, 0x90, 0x92, 0xB3, 0x14, -+0xF0, 0xFB, 0x7A, 0x92, 0x79, 0xA5, 0xF1, 0x31, 0x7F, 0x04, 0x90, 0x93, 0x4E, 0xEF, 0xF0, 0x7F, -+0x02, 0x12, 0x4B, 0x8B, 0x90, 0x8D, 0x01, 0xE0, 0xFF, 0x90, 0x93, 0x4E, 0xE0, 0xFE, 0xEF, 0x4E, -+0x90, 0x8D, 0x01, 0xF0, 0x22, 0x51, 0x28, 0x7F, 0x02, 0x8F, 0x16, 0x7F, 0x02, 0x12, 0x4B, 0x8B, -+0x90, 0x8D, 0x01, 0xE0, 0x45, 0x16, 0xF0, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0x93, -+0x46, 0xF0, 0x90, 0x93, 0x46, 0xE0, 0xFD, 0x70, 0x02, 0x61, 0x21, 0x90, 0x8E, 0x15, 0xE0, 0xFF, -+0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x8E, 0x16, 0xE0, 0xB5, -+0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, -+0x01, 0xF0, 0x22, 0x90, 0x93, 0x42, 0xB1, 0x58, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x61, 0x03, 0xE4, 0x90, 0x93, 0x47, 0xF0, 0x90, 0x93, 0x47, -+0xE0, 0xF9, 0xC3, 0x94, 0x04, 0x50, 0x31, 0x71, 0x22, 0xA4, 0xFF, 0xE9, 0xFD, 0x7C, 0x00, 0x2F, -+0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xD0, 0x71, 0x3A, 0x90, 0x8D, 0xC5, 0x71, 0x2A, 0x71, 0x22, -+0xA4, 0x2D, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xF0, 0x71, 0x3A, 0x90, 0x8D, 0xC9, 0x71, 0x2A, -+0x90, 0x93, 0x47, 0xE0, 0x04, 0xF0, 0x80, 0xC5, 0x90, 0x93, 0x46, 0xE0, 0xFF, 0x90, 0x93, 0x42, -+0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, -+0x93, 0x46, 0xF0, 0x90, 0x93, 0x42, 0x12, 0x75, 0xD6, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, -+0x01, 0xCC, 0xF0, 0x90, 0x93, 0x42, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0x8E, 0x16, -+0xF1, 0x8F, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x41, 0x32, 0xE4, 0x90, 0x8E, 0x16, -+0xF0, 0x41, 0x32, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x93, 0x42, 0xE0, 0x44, 0x80, -+0x90, 0x00, 0x8A, 0xF0, 0x71, 0x22, 0x90, 0x01, 0xD0, 0x12, 0x47, 0x4A, 0xE0, 0x90, 0x01, 0xC3, -+0xF0, 0x22, 0x90, 0x93, 0x42, 0xE0, 0x75, 0xF0, 0x04, 0x22, 0x12, 0x47, 0x4A, 0xE5, 0x82, 0x29, -+0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0x2F, 0xF5, 0x82, 0x74, 0x01, 0x3E, -+0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x8E, 0x16, 0xE0, 0x75, 0xF0, 0x08, 0x22, 0x90, 0x8F, 0x30, 0xE0, -+0x30, 0xE0, 0x04, 0x7F, 0x10, 0x51, 0x19, 0x22, 0xE4, 0xFF, 0x12, 0x69, 0x20, 0xBF, 0x01, 0x0E, -+0x90, 0x8E, 0xC8, 0xE0, 0x60, 0x08, 0x71, 0x6F, 0x54, 0x07, 0x70, 0x02, 0x71, 0xC8, 0x22, 0x90, -+0x8E, 0xCC, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x13, 0x54, 0xC0, 0x70, -+0x07, 0x71, 0x6F, 0x54, 0xFD, 0xF0, 0x80, 0x40, 0xE5, 0x13, 0x30, 0xE6, 0x1E, 0x90, 0x8E, 0xC8, -+0xE0, 0x64, 0x01, 0x70, 0x18, 0x90, 0x8E, 0xCC, 0xE0, 0x44, 0x01, 0xF0, 0x91, 0x01, 0x64, 0x02, -+0x60, 0x04, 0xD1, 0x56, 0x80, 0x07, 0x12, 0x57, 0x98, 0x80, 0x02, 0x71, 0x6F, 0xE5, 0x13, 0x90, -+0x8E, 0xCC, 0x30, 0xE7, 0x0E, 0xE0, 0x44, 0x02, 0x12, 0x68, 0x01, 0x90, 0x8E, 0xC3, 0xE0, 0x44, -+0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x8E, 0xCA, 0xE0, 0xFF, 0x7D, 0x01, 0x02, -+0x51, 0xB3, 0x90, 0x8E, 0xC8, 0xE0, 0x60, 0x0E, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x02, 0xE1, -+0x96, 0x12, 0x6D, 0x04, 0x71, 0xC8, 0x22, 0xE4, 0xFF, 0x12, 0x69, 0x20, 0xBF, 0x01, 0x11, 0x90, -+0x8E, 0xC8, 0xE0, 0x60, 0x0B, 0x91, 0x01, 0x64, 0x02, 0x60, 0x02, 0xC1, 0x56, 0x12, 0x57, 0x98, -+0x22, 0x90, 0x8E, 0xC6, 0xE0, 0x54, 0x0F, 0x22, 0x90, 0x8E, 0xC3, 0x12, 0x4F, 0xF3, 0x30, 0xE0, -+0x14, 0xEF, 0x54, 0xBF, 0xB1, 0x4F, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x04, 0xE0, -+0x54, 0xFE, 0xF0, 0x71, 0xC8, 0xE4, 0xFF, 0x90, 0x91, 0x7C, 0xE0, 0xFD, 0x30, 0xE0, 0x4D, 0x90, -+0x91, 0x81, 0xE0, 0xFC, 0x60, 0x46, 0xB1, 0x5A, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x0B, 0xE4, 0x90, 0x91, 0x81, 0xF0, -+0x90, 0x91, 0x83, 0x04, 0xF0, 0x22, 0x90, 0x91, 0x7E, 0xE0, 0xD3, 0x9C, 0x50, 0x15, 0xED, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0xB1, 0x62, 0x80, 0x03, 0x12, 0x74, 0x09, 0x12, 0x77, -+0x3B, 0xF0, 0x22, 0x12, 0x56, 0x8F, 0x90, 0x91, 0x81, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x8E, 0xC3, -+0xE0, 0xFF, 0x12, 0x74, 0x02, 0x30, 0xE0, 0x1A, 0xEF, 0x54, 0x7F, 0xB1, 0x4F, 0x30, 0xE1, 0x06, -+0xE0, 0x44, 0x02, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x8E, 0xC8, 0xE0, 0x60, 0x02, -+0x71, 0xC8, 0x7F, 0x01, 0x80, 0x81, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, -+0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xA6, 0xF0, 0x74, 0x7C, 0xA3, 0xF0, 0x12, 0x8C, 0x63, -+0xE5, 0x69, 0x30, 0xE1, 0x03, 0x12, 0x8C, 0xEB, 0xE5, 0x69, 0x30, 0xE2, 0x02, 0x71, 0xD2, 0xE5, -+0x6A, 0x30, 0xE0, 0x03, 0x12, 0x8C, 0xF5, 0xE5, 0x6C, 0x30, 0xE1, 0x04, 0x7F, 0x04, 0x51, 0x19, -+0xE5, 0x6C, 0x30, 0xE4, 0x02, 0xB1, 0x2B, 0xE5, 0x6C, 0x30, 0xE5, 0x02, 0x91, 0x08, 0xE5, 0x6C, -+0x30, 0xE6, 0x02, 0x91, 0x7D, 0x74, 0xA6, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x7C, 0xA3, 0xF0, -+0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x12, 0x69, 0x44, 0x12, 0x6E, -+0x6B, 0x90, 0x8F, 0x2C, 0xE0, 0x30, 0xE0, 0x16, 0x12, 0x97, 0x22, 0x90, 0x8F, 0x2F, 0xE0, 0x60, -+0x05, 0x14, 0xF0, 0x02, 0x92, 0x0A, 0x12, 0x81, 0x8C, 0xE4, 0xFF, 0x12, 0x6E, 0x7B, 0x22, 0xF0, -+0x90, 0x04, 0xE0, 0xE0, 0x90, 0x8E, 0xC4, 0x22, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, -+0x08, 0x22, 0xE4, 0xFD, 0xFF, 0xB1, 0xAE, 0xE4, 0xFF, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x93, 0x44, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x7D, 0x44, 0x7F, 0x6F, 0x12, 0x53, -+0x91, 0x12, 0x53, 0xA0, 0x90, 0x93, 0x45, 0xE0, 0x90, 0x93, 0x44, 0xB4, 0x01, 0x07, 0xB1, 0xA2, -+0x44, 0x04, 0xF0, 0x80, 0x05, 0xB1, 0xA2, 0x54, 0xFB, 0xF0, 0x12, 0x57, 0x89, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x05, 0x12, 0x47, 0x4A, 0xE0, 0x22, 0x12, 0x96, -+0xE5, 0xED, 0x70, 0x12, 0xB1, 0xEA, 0xC0, 0x83, 0xC0, 0x82, 0xB1, 0xE2, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0xF4, 0x5E, 0x80, 0x0F, 0xB1, 0xEA, 0xC0, 0x83, 0xC0, 0x82, 0xB1, 0xE2, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xB1, 0xF5, 0x90, 0x8E, 0xC2, 0xEF, -+0xF0, 0x22, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, 0x74, 0xB2, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0x8E, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7D, 0x10, 0xED, 0x14, -+0xF9, 0x24, 0xB2, 0xB1, 0xED, 0xE0, 0x60, 0x39, 0x7C, 0x08, 0xEC, 0x14, 0x90, 0x93, 0x4F, 0xF0, -+0x74, 0xB2, 0x29, 0xB1, 0xED, 0xE0, 0xFB, 0x7A, 0x00, 0x90, 0x93, 0x4F, 0xB1, 0x58, 0x80, 0x05, -+0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x0F, -+0xE9, 0x75, 0xF0, 0x08, 0xA4, 0xFF, 0x90, 0x93, 0x4F, 0xE0, 0x2F, 0x04, 0xFF, 0x80, 0x06, 0xDC, -+0xC9, 0xDD, 0xBB, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFD, 0xB1, 0x6B, 0xF1, 0xD5, -+0x90, 0x8E, 0xD6, 0x02, 0x27, 0x48, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x1D, 0x90, 0x8D, 0xBF, 0xE0, -+0xFF, 0x90, 0x93, 0x30, 0x74, 0x09, 0xF0, 0x7B, 0x18, 0xE4, 0xFD, 0x12, 0x56, 0xDF, 0x90, 0x93, -+0x4C, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x57, 0xF2, 0x22, 0x90, 0x91, 0x9D, 0x74, 0x12, 0xF0, -+0x90, 0x91, 0xAB, 0x74, 0x05, 0xF0, 0x90, 0x91, 0x9F, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, -+0xF0, 0x90, 0x91, 0x9B, 0xE0, 0x90, 0x91, 0xA2, 0xF0, 0x90, 0x91, 0x9C, 0xE0, 0x90, 0x91, 0xA3, -+0xF0, 0x7B, 0x01, 0x7A, 0x91, 0x79, 0x9D, 0xF1, 0x31, 0x7F, 0x04, 0x21, 0xFA, 0xF1, 0x2A, 0x7F, -+0xF5, 0x7E, 0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, 0x06, 0x90, 0x91, 0x92, 0xE0, 0xA3, 0xF0, 0xF1, -+0x2A, 0x7F, 0xF6, 0x7E, 0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, 0x08, 0x90, 0x91, 0x92, 0xE0, 0x90, -+0x91, 0x94, 0xF0, 0xF1, 0x2A, 0x7F, 0xF4, 0x7E, 0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, 0x08, 0x90, -+0x91, 0x92, 0xE0, 0x90, 0x91, 0x95, 0xF0, 0xF1, 0x2A, 0x7F, 0xF3, 0x7E, 0x03, 0x12, 0x33, 0xC7, -+0xBF, 0x01, 0x08, 0x90, 0x91, 0x92, 0xE0, 0x90, 0x91, 0x96, 0xF0, 0xF1, 0x2A, 0x7F, 0xF2, 0x7E, -+0x03, 0x12, 0x33, 0xC7, 0xBF, 0x01, 0x08, 0x90, 0x91, 0x92, 0xE0, 0x90, 0x91, 0x97, 0xF0, 0x90, -+0x91, 0x93, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x91, 0x9B, 0xF0, -+0x90, 0x91, 0x97, 0xE0, 0x90, 0x91, 0x9C, 0xF0, 0xC1, 0x7A, 0x7B, 0x01, 0x7A, 0x91, 0x79, 0x92, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8E, 0xAD, 0xE0, 0xFF, 0x70, 0x06, 0xA3, -+0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x8E, 0xAE, 0xE0, 0xB5, 0x07, 0x04, 0x7F, -+0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, -+0x29, 0xC0, 0x01, 0x90, 0x8E, 0xAE, 0xE0, 0x12, 0x8A, 0x6C, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, -+0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x46, 0xB0, 0x90, 0x8E, 0xAE, 0xF1, 0x8F, 0xB4, 0x0A, 0x02, -+0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x8E, 0xAE, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, -+0x04, 0xF0, 0xE0, 0x7F, 0x00, 0x22, 0x12, 0x96, 0xC3, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, -+0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0x92, -+0xFF, 0xF0, 0x90, 0x8F, 0x27, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0x90, 0x93, 0x00, 0xF0, 0xE4, 0xFB, -+0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x68, 0x16, 0x90, 0x8E, 0xC3, 0xE0, 0x44, 0x08, 0xF0, 0x22, -+0xE4, 0xFD, 0xFF, 0xA1, 0xAE, 0x7F, 0xB0, 0x7E, 0x0C, 0x02, 0x36, 0xCE, 0xC0, 0xE0, 0xC0, 0x83, -+0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0xDC, 0x90, 0x01, 0xC4, -+0xED, 0xF0, 0x74, 0x7F, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, -+0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x02, 0x09, -+0xE0, 0xF5, 0x0D, 0x12, 0x26, 0x1E, 0x25, 0x0D, 0x90, 0x8D, 0xBE, 0x12, 0x4E, 0xCD, 0x25, 0x0D, -+0x90, 0x8D, 0xBF, 0x12, 0x4F, 0xEC, 0x25, 0x0D, 0x90, 0x8D, 0xC0, 0x12, 0x4F, 0xAD, 0x25, 0x0D, -+0x90, 0x8D, 0xC1, 0x12, 0x4F, 0xCF, 0x25, 0x0D, 0x90, 0x8D, 0xC2, 0x12, 0x4F, 0xDD, 0x25, 0x0D, -+0x90, 0x8D, 0xC3, 0x12, 0x4F, 0xD6, 0x25, 0x0D, 0x90, 0x8D, 0xC4, 0xF0, 0x22, 0x12, 0x26, 0x1E, -+0xFF, 0x90, 0x8E, 0xB1, 0xF0, 0xBF, 0x01, 0x08, 0x12, 0x7E, 0xAD, 0xE4, 0x90, 0x8E, 0xB1, 0xF0, -+0x22, 0x12, 0x26, 0x1E, 0x54, 0x01, 0xFF, 0x90, 0x91, 0x89, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, -+0x12, 0x77, 0xDF, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x7F, 0x90, 0x8E, 0xC8, 0xF0, 0xEF, 0x12, 0x74, -+0x02, 0xA3, 0x12, 0x4E, 0xCD, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0x8E, 0xC6, 0xE0, -+0x54, 0xF0, 0x12, 0x4F, 0xAC, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0x8E, 0xC3, 0xE0, 0x54, 0xFD, -+0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0x12, 0x7C, 0x01, 0x12, 0x4F, 0xEB, 0x90, -+0x8E, 0xC7, 0x12, 0x4F, 0xCF, 0xFD, 0x7F, 0x02, 0x12, 0x51, 0x22, 0x90, 0x91, 0x92, 0x12, 0x47, -+0x56, 0x90, 0x91, 0x95, 0x12, 0x47, 0x5F, 0x12, 0x6F, 0xC6, 0x90, 0x8E, 0xC8, 0xE0, 0xFF, 0x12, -+0x6D, 0x0C, 0x90, 0x8E, 0xC8, 0xE0, 0x60, 0x1F, 0x90, 0x91, 0x95, 0x12, 0x47, 0x56, 0x12, 0x4E, -+0xCE, 0x54, 0x0F, 0xFF, 0x12, 0x4F, 0xED, 0xFD, 0x11, 0xF8, 0x12, 0x77, 0xD2, 0xFB, 0x90, 0x93, -+0x38, 0x74, 0x01, 0xF0, 0x12, 0x72, 0x47, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0B, 0x04, 0x70, 0x24, -+0x90, 0x8E, 0xCE, 0x74, 0x02, 0xF0, 0x80, 0x13, 0xED, 0x70, 0x06, 0x90, 0x8F, 0x28, 0xE0, 0x80, -+0x02, 0xED, 0x14, 0x90, 0x8E, 0xCE, 0xF0, 0x90, 0x8E, 0xCE, 0xE0, 0xA3, 0xF0, 0x90, 0x8E, 0xC4, -+0xE0, 0x44, 0x08, 0xF0, 0x22, 0x12, 0x77, 0xDF, 0x12, 0x4F, 0xED, 0x30, 0xE0, 0x0F, 0x12, 0x5B, -+0xE8, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x25, 0x02, 0x34, 0x2C, 0x90, 0x8F, 0x25, -+0x74, 0x03, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, -+0x07, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0x8E, 0xD3, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0x8F, -+0x2B, 0xF0, 0x22, 0x31, 0x9C, 0x90, 0x8F, 0x2C, 0x12, 0x77, 0xE5, 0xEF, 0x54, 0x02, 0xFF, 0xEE, -+0x54, 0xFD, 0x4F, 0x12, 0x4E, 0xCD, 0x90, 0x8F, 0x2D, 0x12, 0x4F, 0xEC, 0x90, 0x8F, 0x2E, 0xF0, -+0x31, 0x8C, 0x90, 0x8F, 0x2C, 0xE0, 0x54, 0x01, 0xFF, 0x02, 0x6E, 0x7B, 0x90, 0x8F, 0x2D, 0xE0, -+0x14, 0x90, 0x8F, 0x2F, 0xF0, 0x22, 0x90, 0x91, 0x92, 0x12, 0x47, 0x56, 0x12, 0x26, 0x1E, 0xFF, -+0x54, 0x01, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0x9C, 0x90, 0x8F, 0x30, -+0x12, 0x77, 0x1E, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x51, 0x4C, 0x51, 0xD3, 0x12, 0x77, 0x2C, -+0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x51, 0x4C, 0x51, 0x54, 0x12, 0x77, 0x2C, 0x54, 0x40, 0xFD, -+0xEF, 0x54, 0xBF, 0x51, 0x4C, 0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, 0x4E, 0x12, 0x4F, 0xEC, 0xFF, -+0x54, 0x01, 0xFE, 0x90, 0x8F, 0x32, 0xE0, 0x54, 0xFE, 0x12, 0x4E, 0xCC, 0xFE, 0x54, 0x01, 0xFD, -+0x90, 0x8F, 0x31, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEE, 0x54, 0x04, 0xFE, 0xED, 0x54, 0xFB, -+0x4E, 0xF0, 0xEF, 0x54, 0x10, 0xFF, 0xA3, 0xE0, 0x54, 0xEF, 0x4F, 0xFF, 0x12, 0x4F, 0xEC, 0x51, -+0x54, 0x90, 0x8F, 0x32, 0x12, 0x5E, 0xDD, 0x51, 0xDB, 0x90, 0x8F, 0x30, 0xE0, 0xC3, 0x13, 0x54, -+0x01, 0xFF, 0xB1, 0xFD, 0x90, 0x8F, 0x30, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x51, 0x5C, -+0x90, 0x8F, 0x30, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x12, 0x5F, 0xDA, 0x90, 0x8F, 0x30, -+0xE0, 0x54, 0x01, 0xFF, 0x12, 0x6E, 0xE4, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x4D, 0xFF, 0x90, 0x8F, -+0x30, 0xF0, 0xEE, 0x22, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0x22, 0xE4, 0xFD, 0xFC, 0xEF, -+0x60, 0x1C, 0x90, 0x91, 0x6B, 0xE0, 0xFF, 0x12, 0x5F, 0xD3, 0x51, 0xEC, 0x12, 0x77, 0xDF, 0x12, -+0x5B, 0xE8, 0x75, 0x43, 0x42, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x01, 0x12, 0x34, 0x2C, 0x22, 0x12, -+0x77, 0xDF, 0x51, 0xBF, 0x31, 0x96, 0x12, 0x77, 0x3B, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, -+0x2D, 0x12, 0x4E, 0xCE, 0x90, 0x91, 0x7D, 0x12, 0x4F, 0xEC, 0x90, 0x91, 0x7E, 0xF0, 0x12, 0x26, -+0x1E, 0xFF, 0x54, 0x04, 0xFE, 0x90, 0x91, 0x7C, 0xE0, 0x54, 0xFB, 0x12, 0x4F, 0xAC, 0x90, 0x91, -+0x7F, 0xF0, 0xEF, 0x54, 0x08, 0xFF, 0x90, 0x91, 0x7C, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x22, 0x51, -+0xE3, 0x7A, 0x91, 0x79, 0x7C, 0x12, 0x49, 0x38, 0x90, 0x91, 0x7D, 0x74, 0x08, 0xF0, 0xA3, 0x74, -+0x03, 0xF0, 0x22, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0x22, 0x90, 0x8E, 0xAF, 0xF0, 0xA3, -+0xEF, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x08, 0x7D, 0x00, 0x7B, 0x01, 0x22, 0x74, 0x00, 0x2F, 0xF9, -+0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x92, -+0xAA, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0xAA, 0x07, 0x90, 0x92, 0xB0, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0x90, 0xFD, 0x10, 0xEB, 0xF0, 0xEA, 0x24, 0xEF, 0x60, 0x3D, 0x24, 0xD7, 0x70, 0x02, -+0x61, 0xE5, 0x24, 0x3A, 0x60, 0x02, 0x81, 0x0F, 0x91, 0x34, 0x24, 0x0A, 0x12, 0x5F, 0x04, 0xE4, -+0xF0, 0xFE, 0x74, 0x00, 0x2F, 0x91, 0x3B, 0x7D, 0x14, 0x7C, 0x00, 0x91, 0x43, 0x7B, 0x00, 0x7A, -+0x00, 0x79, 0x00, 0x90, 0xAE, 0x61, 0x12, 0x47, 0x5F, 0x91, 0x2E, 0x90, 0xAE, 0x64, 0x12, 0x27, -+0x48, 0x7D, 0x14, 0x7C, 0x00, 0xE4, 0xFF, 0x61, 0xE0, 0x90, 0x92, 0xAA, 0xE4, 0x75, 0xF0, 0x14, -+0x12, 0x46, 0xD6, 0x90, 0x92, 0xAA, 0xA3, 0xE0, 0xFB, 0xFF, 0x24, 0x06, 0xFC, 0xE4, 0x33, 0x90, -+0x92, 0xB4, 0xF0, 0xA3, 0xCC, 0xF0, 0x90, 0x92, 0xB4, 0xA3, 0xE0, 0x12, 0x5F, 0x0E, 0xE4, 0xF0, -+0x74, 0x04, 0x2F, 0x12, 0x5F, 0xC3, 0xE0, 0xFE, 0xAD, 0x03, 0x74, 0x05, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xD1, 0x29, 0x90, 0x92, 0xAE, 0xF0, 0xA3, 0xEF, 0xF0, 0xED, 0x7E, 0x00, 0x24, 0x00, -+0x91, 0x3B, 0x91, 0x4C, 0x91, 0x43, 0x90, 0x92, 0xAA, 0x74, 0xFF, 0x75, 0xF0, 0xEC, 0x12, 0x46, -+0xD6, 0x91, 0x34, 0x7E, 0x00, 0x24, 0x0C, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x02, -+0xC0, 0x01, 0x74, 0x10, 0x2F, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x90, 0xAE, 0x61, 0x12, 0x47, 0x5F, -+0x91, 0x2E, 0x90, 0xAE, 0x64, 0x12, 0x27, 0x48, 0x91, 0x4C, 0xD0, 0x01, 0xD0, 0x02, 0x7F, 0x11, -+0x12, 0x1F, 0x66, 0x80, 0x22, 0x91, 0x34, 0x24, 0x2A, 0x12, 0x5F, 0x04, 0xE4, 0xF0, 0x51, 0xEC, -+0x7D, 0x48, 0x7C, 0x00, 0x12, 0x28, 0xE6, 0x91, 0x28, 0x91, 0x55, 0xE4, 0xFD, 0xFC, 0x91, 0x28, -+0x91, 0x55, 0x91, 0x28, 0x12, 0x27, 0x15, 0x90, 0x92, 0xAC, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -+0x92, 0xAC, 0xB1, 0xEC, 0x90, 0x92, 0xB4, 0xA3, 0xE0, 0xFE, 0x12, 0x56, 0x6C, 0xEF, 0x12, 0x5F, -+0x19, 0xED, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x92, 0xB0, 0x12, 0x27, 0x48, 0x90, 0x92, -+0xB0, 0x02, 0x47, 0x32, 0x90, 0x92, 0xAA, 0xA3, 0xE0, 0xFF, 0x22, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, -+0x7B, 0x01, 0x22, 0x12, 0x28, 0xE6, 0x90, 0x92, 0xB0, 0x02, 0x27, 0x48, 0x90, 0x92, 0xAE, 0xE0, -+0xFC, 0xA3, 0xE0, 0xFD, 0x22, 0x78, 0x10, 0x12, 0x27, 0x22, 0x90, 0x92, 0xB0, 0x12, 0x47, 0x3E, -+0x02, 0x46, 0xEC, 0xE4, 0x90, 0x92, 0xA8, 0xF0, 0xA3, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x20, -+0xF0, 0x12, 0x8D, 0x70, 0xEF, 0x64, 0x01, 0x70, 0x69, 0x90, 0x91, 0x72, 0xE0, 0xFF, 0x90, 0x93, -+0x30, 0x74, 0x0D, 0xF0, 0x7B, 0x08, 0x7D, 0x01, 0x12, 0x56, 0xDF, 0xB1, 0xF4, 0x90, 0x92, 0xA5, -+0x12, 0x5E, 0x96, 0x90, 0x92, 0xA7, 0xEF, 0xF0, 0x90, 0x92, 0xA5, 0xD1, 0x09, 0xE4, 0xFD, 0x91, -+0xEC, 0x90, 0x92, 0xA7, 0xE0, 0xFF, 0x90, 0x92, 0xA6, 0xE0, 0x2F, 0xFF, 0x90, 0x92, 0xA5, 0xE0, -+0x34, 0x00, 0xCF, 0x24, 0x30, 0xCF, 0x34, 0x00, 0xFE, 0x90, 0x92, 0xA8, 0xF0, 0xA3, 0xEF, 0xF0, -+0x12, 0x95, 0x3C, 0x91, 0xE3, 0x90, 0x91, 0x72, 0xE0, 0xFB, 0xE4, 0xFF, 0x51, 0xF7, 0x91, 0xE3, -+0x90, 0x91, 0x6E, 0xE0, 0xFB, 0x7F, 0x11, 0x51, 0xF7, 0x12, 0x57, 0xF2, 0x90, 0x91, 0x21, 0x12, -+0x59, 0x36, 0x22, 0x90, 0x92, 0xA8, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x22, 0x90, 0x93, 0x0A, 0xED, -+0xF0, 0x90, 0x93, 0x07, 0x12, 0x47, 0x5F, 0xE4, 0x90, 0x93, 0x0B, 0xF0, 0xA3, 0xF0, 0x12, 0x26, -+0x1E, 0xFF, 0x12, 0x4E, 0xCE, 0xFD, 0x12, 0x4F, 0xD0, 0xFB, 0x12, 0x5E, 0xBC, 0x90, 0x93, 0x0B, -+0xEF, 0xF0, 0x90, 0x93, 0x07, 0x12, 0x47, 0x56, 0x12, 0x4F, 0xD0, 0xFF, 0x12, 0x8F, 0xB2, 0x90, -+0x93, 0x0C, 0xEF, 0xF0, 0x90, 0x91, 0x0E, 0xE0, 0x24, 0xFE, 0x60, 0x14, 0x24, 0xFE, 0x60, 0x10, -+0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x05, 0x70, 0x41, 0xB1, 0x7C, 0xB1, 0x88, 0x80, 0x0D, -+0xB1, 0x7C, 0x90, 0x91, 0x0E, 0xE0, 0x90, 0x92, 0xE2, 0xF0, 0x12, 0x4E, 0xD4, 0x90, 0x93, 0x0C, -+0xE0, 0xFF, 0x90, 0x93, 0x07, 0x12, 0x47, 0x56, 0x90, 0x93, 0x0B, 0xE0, 0x7C, 0x00, 0x29, 0xF9, -+0xEC, 0x3A, 0xFA, 0xC3, 0xE9, 0x9F, 0xF9, 0xEA, 0x94, 0x00, 0xFA, 0x75, 0x40, 0x01, 0x75, 0x41, -+0x90, 0x75, 0x42, 0xDD, 0xA3, 0xE0, 0xF5, 0x43, 0x12, 0x34, 0x2C, 0x22, 0x7B, 0x01, 0x7A, 0x90, -+0x79, 0xDD, 0x90, 0x93, 0x0A, 0xE0, 0xFD, 0x22, 0x90, 0x92, 0xEF, 0xED, 0xF0, 0x90, 0x92, 0xEC, -+0x12, 0x47, 0x5F, 0x12, 0x4F, 0xAE, 0x90, 0x92, 0xF3, 0xF0, 0x90, 0x92, 0xEC, 0x12, 0x5B, 0xEB, -+0x75, 0x43, 0x03, 0x7B, 0x01, 0x7A, 0x92, 0x79, 0xF0, 0x12, 0x34, 0x2C, 0x90, 0x92, 0xEF, 0xE0, -+0x70, 0x2E, 0xFF, 0xB1, 0xE1, 0xE0, 0xB4, 0xFF, 0x06, 0xB1, 0xE1, 0xE4, 0xF0, 0x80, 0x07, 0xB1, -+0xE1, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x03, 0xE8, 0x75, 0x40, 0x01, 0x75, 0x41, -+0x92, 0x75, 0x42, 0xF0, 0x75, 0x43, 0x03, 0x90, 0x92, 0xEC, 0x12, 0x47, 0x56, 0x12, 0x34, 0x2C, -+0x22, 0x74, 0xF0, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, -+0xFD, 0xEC, 0xFF, 0x22, 0x90, 0x92, 0xA5, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xEF, 0x60, 0x08, -+0x90, 0x91, 0x68, 0xE0, 0xFF, 0x12, 0x5D, 0x3D, 0x22, 0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, 0x34, -+0xFC, 0xFA, 0x7B, 0x01, 0x22, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, -+0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, 0x24, 0x00, -+0xFF, 0xEA, 0x3E, 0x22, 0xF1, 0x42, 0x12, 0x5E, 0xE6, 0x90, 0x91, 0x92, 0xF0, 0xA3, 0xEF, 0xF0, -+0x90, 0x02, 0x87, 0xE0, 0xF9, 0x90, 0x8F, 0x30, 0xE0, 0x30, 0xE0, 0x6A, 0xEC, 0xC3, 0x99, 0x50, -+0x65, 0x90, 0x91, 0x92, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xF1, 0x2A, 0xAD, 0x07, 0xD1, 0x15, 0x54, -+0x3F, 0x90, 0x91, 0x94, 0xF1, 0x9D, 0xE0, 0x54, 0x03, 0xFB, 0xEF, 0x24, 0x18, 0xFF, 0xE4, 0x33, -+0xCF, 0x2B, 0xCF, 0x3A, 0x90, 0x91, 0x94, 0x8F, 0xF0, 0x12, 0x46, 0xD6, 0x90, 0x91, 0x94, 0xD1, -+0xB7, 0x90, 0x91, 0x94, 0xEE, 0xF1, 0x3A, 0xEE, 0x8F, 0xF0, 0xF1, 0x32, 0xFE, 0xA3, 0xE0, 0xFF, -+0xD3, 0x90, 0x91, 0x93, 0xE0, 0x9F, 0x90, 0x91, 0x92, 0xE0, 0x9E, 0x40, 0x11, 0x90, 0x8E, 0xB0, -+0xF1, 0x4B, 0x90, 0x91, 0x93, 0xE0, 0x9F, 0xF0, 0x90, 0x91, 0x92, 0xE0, 0x9E, 0xF0, 0x12, 0x63, -+0x06, 0xF1, 0x58, 0x0C, 0x80, 0x96, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7D, 0x07, 0xEF, 0x5D, -+0xC3, 0x60, 0x0A, 0xD1, 0xD1, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x03, 0xD1, 0xD1, 0xFF, -+0x22, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, 0x22, 0xF1, 0x66, -+0xAD, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xDE, 0xF0, 0x74, 0x86, 0xA3, 0xF0, 0xED, 0x64, 0x01, 0x60, -+0x1E, 0x12, 0x67, 0xA4, 0xED, 0xB4, 0x02, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x40, 0xF0, 0x80, 0x0A, -+0xED, 0xB4, 0x04, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x41, 0xF0, 0x7F, 0x01, 0x02, 0x74, 0x11, 0xD1, -+0x34, 0x90, 0x02, 0x87, 0xE0, 0x70, 0xF8, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x02, 0xF0, 0x74, 0xDE, -+0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x86, 0xA3, 0xF0, 0x22, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, -+0x03, 0x22, 0x12, 0x46, 0xD6, 0x90, 0x8E, 0xAF, 0xE0, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x91, -+0x92, 0x22, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x22, 0xE0, 0x24, 0x01, 0xFF, 0x90, -+0x8E, 0xAF, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0x22, 0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, -+0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE2, 0x03, 0x7F, 0x04, 0x22, -+0x90, 0x02, 0x86, 0xE0, 0x7F, 0x01, 0x20, 0xE1, 0x02, 0x7F, 0x02, 0x22, 0x31, 0x9C, 0x90, 0x91, -+0x78, 0x12, 0x77, 0xE5, 0xEF, 0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x12, 0x26, 0x1E, -+0xC3, 0x13, 0x30, 0xE0, 0x07, 0x12, 0x4E, 0xCE, 0x90, 0x91, 0x79, 0xF0, 0x22, 0xF0, 0xA3, 0xEF, -+0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, -+0x33, 0x54, 0xF8, 0xFF, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8E, 0x16, 0xE0, 0xFF, 0x90, 0x8E, 0x15, 0xE0, 0xB5, -+0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x41, 0x90, 0x8E, 0x15, 0xE0, 0xFE, -+0x75, 0xF0, 0x08, 0x90, 0x8D, 0xC5, 0x12, 0x47, 0x4A, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, -+0x24, 0xC6, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x12, 0x6A, 0x66, 0x90, -+0x8E, 0x15, 0x12, 0x7F, 0x8F, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x8E, -+0x15, 0xF0, 0x12, 0x7A, 0x28, 0x90, 0x8D, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xE4, 0x90, 0x8E, 0xAD, 0xF0, 0xA3, 0xF0, 0x90, 0x8E, 0x15, 0xF0, 0xA3, 0xF0, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x21, 0x31, 0xF9, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, -+0x93, 0x21, 0x51, 0x63, 0xE0, 0x60, 0x24, 0xC3, 0x90, 0x93, 0x24, 0xE0, 0x94, 0xE8, 0x90, 0x93, -+0x23, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, -+0x0C, 0x90, 0x93, 0x23, 0x12, 0x59, 0x36, 0x51, 0x4A, 0x80, 0xD4, 0x7F, 0x01, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x29, 0x12, 0x47, 0x5F, 0x7F, -+0x96, 0x7E, 0x02, 0x11, 0x2F, 0xEF, 0x60, 0x44, 0x12, 0x5E, 0xDE, 0xFE, 0xEF, 0x24, 0x01, 0xFF, -+0xE4, 0x3E, 0xFE, 0x90, 0x93, 0x2C, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x93, -+0x2C, 0xE0, 0xFD, 0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x93, 0x29, 0x31, 0xF0, 0x24, -+0x02, 0xFF, 0xE4, 0x33, 0xFE, 0x11, 0xD1, 0x90, 0x93, 0x2C, 0xE0, 0x24, 0x18, 0xFF, 0x90, 0x93, -+0x29, 0x12, 0x47, 0x56, 0x31, 0x88, 0x90, 0x02, 0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, 0x31, 0x1B, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xF3, -+0x74, 0x00, 0x2D, 0x31, 0x1B, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, -+0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x12, 0x87, 0xB4, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, -+0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFB, -+0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x8E, 0xAE, 0xE0, -+0xFE, 0x90, 0x8E, 0xAD, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, -+0x64, 0x01, 0x60, 0x3F, 0xED, 0x51, 0x6C, 0xFA, 0x7B, 0x01, 0x11, 0x72, 0x7F, 0x01, 0xEF, 0x60, -+0x32, 0x90, 0x8E, 0xAD, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, 0x02, 0x7F, 0x00, 0xEF, -+0x60, 0x05, 0xE4, 0x90, 0x8E, 0xAD, 0xF0, 0x90, 0x8E, 0xAE, 0xE0, 0xFF, 0x90, 0x8E, 0xAD, 0xE0, -+0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x07, 0x90, 0x8D, 0x01, 0xE0, -+0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0x25, 0xEF, 0xF0, 0xA3, 0x12, 0x47, -+0x5F, 0x90, 0x93, 0x43, 0xE0, 0xFE, 0x04, 0xF0, 0x12, 0x4F, 0xE4, 0x74, 0x00, 0x2F, 0xF9, 0xE4, -+0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x93, 0x26, 0x12, 0x5B, -+0xEB, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x93, 0x25, -+0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, -+0xA3, 0x12, 0x47, 0x56, 0xE9, 0x24, 0x02, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, -+0x90, 0x93, 0x26, 0x31, 0xF0, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x2C, -+0x12, 0x47, 0x56, 0x90, 0x00, 0x0E, 0x02, 0x26, 0x37, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x22, -+0x90, 0x91, 0xB2, 0x31, 0xF9, 0x90, 0x91, 0xBA, 0xF0, 0x90, 0x91, 0xBA, 0xE0, 0xFD, 0xC3, 0x94, -+0x06, 0x50, 0x22, 0x90, 0x91, 0xB3, 0xE0, 0x24, 0x04, 0x51, 0x51, 0x12, 0x63, 0x21, 0x90, 0x91, -+0xBA, 0xE0, 0x24, 0xB4, 0xF5, 0x82, 0xE4, 0x34, 0x91, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x91, 0xBA, -+0xE0, 0x04, 0xF0, 0x80, 0xD4, 0x78, 0x3A, 0x7C, 0x8F, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x91, 0x79, -+0xB4, 0x51, 0x5A, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, 0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x3A, -+0xF7, 0xFF, 0x90, 0x91, 0xB2, 0xE0, 0x34, 0x00, 0xFE, 0x22, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x49, -+0x14, 0xEF, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x75, 0xF0, 0x0F, 0xA4, -+0x24, 0x17, 0xF9, 0x74, 0x8E, 0x35, 0xF0, 0x22, 0xE4, 0x90, 0x91, 0x8E, 0xF0, 0xA3, 0xF0, 0x90, -+0x02, 0x86, 0xE0, 0x20, 0xE1, 0x23, 0xC3, 0x90, 0x91, 0x8F, 0xE0, 0x94, 0xD0, 0x90, 0x91, 0x8E, -+0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, -+0x91, 0x8E, 0x12, 0x59, 0x36, 0x51, 0x4A, 0x80, 0xD6, 0x7F, 0x01, 0x22, 0x90, 0x91, 0xA2, 0x31, -+0xF9, 0xA3, 0xF0, 0x90, 0x91, 0xA4, 0xE0, 0xFD, 0xC3, 0x94, 0x04, 0x50, 0x29, 0x90, 0x91, 0xA3, -+0xE0, 0x24, 0x10, 0x12, 0x65, 0xA2, 0xFE, 0x12, 0x63, 0x21, 0x90, 0x91, 0xA4, 0xE0, 0x24, 0x1B, -+0xF5, 0x82, 0xE4, 0x34, 0x91, 0xF5, 0x83, 0xE0, 0x6F, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x91, -+0xA4, 0xE0, 0x04, 0xF0, 0x80, 0xCD, 0x7F, 0x01, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, -+0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, -+0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, -+0x22, 0xE4, 0xF5, 0x55, 0xF5, 0x56, 0xF5, 0x57, 0x75, 0x58, 0x80, 0xAD, 0x55, 0x7F, 0x50, 0x12, -+0x3A, 0x96, 0xAD, 0x56, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xAD, 0x57, 0x7F, 0x52, 0x12, 0x3A, 0x96, -+0xAD, 0x58, 0x7F, 0x53, 0x02, 0x3A, 0x96, 0x75, 0x5D, 0x10, 0xE4, 0xF5, 0x5E, 0x75, 0x5F, 0x07, -+0x75, 0x60, 0x42, 0x90, 0x01, 0x30, 0xE5, 0x5D, 0xF0, 0xA3, 0xE5, 0x5E, 0xF0, 0xA3, 0xE5, 0x5F, -+0xF0, 0xA3, 0xE5, 0x60, 0xF0, 0x22, 0x75, 0x65, 0x06, 0x75, 0x66, 0x01, 0x75, 0x67, 0x03, 0x75, -+0x68, 0x62, 0x90, 0x01, 0x38, 0xE5, 0x65, 0xF0, 0xA3, 0xE5, 0x66, 0xF0, 0xA3, 0xE5, 0x67, 0xF0, -+0xA3, 0xE5, 0x68, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, -+0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, -+0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, -+0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, -+0xF0, 0x22, 0xE4, 0x90, 0x91, 0x8A, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, -+0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x3D, 0xC3, 0x90, 0x91, 0x8B, 0xE0, 0x94, 0x88, -+0x90, 0x91, 0x8A, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, -+0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1F, 0x90, 0x91, 0x8A, 0x12, 0x59, 0x36, 0x12, 0x70, 0x64, -+0xD3, 0x90, 0x91, 0x8B, 0xE0, 0x94, 0x32, 0x90, 0x91, 0x8A, 0xE0, 0x94, 0x00, 0x40, 0xBA, 0x90, -+0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB3, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0x7F, 0x02, 0x90, -+0x91, 0x77, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x10, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, -+0x30, 0xE4, 0x03, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xE6, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xE4, 0x74, -+0x29, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x5D, 0xF5, 0x61, 0xA3, 0xE0, -+0x55, 0x5E, 0xF5, 0x62, 0xA3, 0xE0, 0x55, 0x5F, 0xF5, 0x63, 0xA3, 0xE0, 0x55, 0x60, 0xF5, 0x64, -+0x90, 0x01, 0x34, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, 0x62, 0xF0, 0xA3, 0xE5, 0x63, 0xF0, 0xA3, 0xE5, -+0x64, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x65, 0xF5, 0x69, 0xA3, 0xE0, 0x55, 0x66, 0xF5, -+0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, 0x6B, 0xA3, 0xE0, 0x55, 0x68, 0xF5, 0x6C, 0x90, 0x01, 0x3C, -+0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, 0x6B, 0xF0, 0xA3, 0xE5, 0x6C, 0xF0, 0x53, -+0x91, 0xDF, 0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x92, 0xA5, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, -+0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, -+0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x4C, 0xEA, -+0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x3A, 0x96, 0x80, 0xFE, 0x22, 0x90, -+0x91, 0x82, 0xE0, 0x04, 0xF0, 0x90, 0x8E, 0xCB, 0xE0, 0x64, 0x02, 0x60, 0x03, 0x12, 0x6D, 0x85, -+0x22, 0x90, 0x8E, 0xC8, 0xE0, 0x60, 0x03, 0x12, 0x57, 0xA8, 0x22, 0x90, 0x8E, 0xC8, 0xE0, 0x60, -+0x03, 0x12, 0x6F, 0x40, 0x22, 0xB1, 0x2F, 0x90, 0x92, 0xB6, 0xEF, 0xF0, 0x30, 0xE0, 0x05, 0x7D, -+0x01, 0xE4, 0x80, 0x02, 0xE4, 0xFD, 0xFF, 0x12, 0x51, 0x22, 0x90, 0x92, 0xB6, 0xE0, 0x30, 0xE6, -+0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, -+0x80, 0xF0, 0x12, 0x77, 0xD2, 0xFB, 0x90, 0x93, 0x38, 0x74, 0x02, 0xF0, 0x02, 0x72, 0x47, 0xE4, -+0x90, 0x92, 0xB8, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, 0x92, 0xB7, 0xF0, 0x90, 0x00, -+0x83, 0xE0, 0xFE, 0x90, 0x92, 0xB7, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x92, 0xB9, -+0xE0, 0x94, 0x64, 0x90, 0x92, 0xB8, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, -+0x40, 0xF0, 0x90, 0x92, 0xB7, 0xE0, 0xFF, 0x22, 0x90, 0x92, 0xB8, 0x12, 0x59, 0x36, 0x80, 0xC6, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, -+0xE0, 0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, 0xC6, 0xE0, -+0x30, 0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC3, 0xEE, -+0x94, 0x01, 0x40, 0x0A, 0x0D, 0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0x90, -+0x01, 0xC4, 0x74, 0xAF, 0xF0, 0x74, 0x8D, 0xA3, 0xF0, 0x90, 0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, -+0x74, 0xAF, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x8D, 0xA3, 0xF0, 0x22, 0x90, 0x8E, 0xC4, 0xE0, -+0x44, 0x10, 0xF0, 0x90, 0x8D, 0x07, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x44, 0x80, -+0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0x8E, 0xD3, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x3A, 0x96, -+0x90, 0x8E, 0xC9, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, -+0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, 0xFD, 0x7F, -+0x08, 0x12, 0x3A, 0x96, 0x7F, 0x01, 0x12, 0x58, 0xDD, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xFD, -+0x7F, 0x90, 0x12, 0x3A, 0x96, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3A, 0xF7, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x92, 0xBA, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x36, 0xCE, 0x90, 0x92, -+0xC4, 0x12, 0x27, 0x48, 0x90, 0x92, 0xBC, 0x12, 0x47, 0x32, 0x12, 0x27, 0x15, 0x90, 0x92, 0xC4, -+0x12, 0x47, 0x3E, 0x12, 0x47, 0x07, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x92, -+0xBC, 0x12, 0x47, 0x32, 0x90, 0x92, 0xC0, 0x12, 0x47, 0x3E, 0x12, 0x47, 0x07, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x14, 0x90, 0x92, 0xC8, 0x12, 0x27, 0x48, 0x90, 0x92, -+0xC8, 0x12, 0x6B, 0xB7, 0x90, 0x92, 0xBA, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x37, 0x5D, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0x91, 0x78, 0x12, 0x6F, 0xED, 0x30, 0xE0, 0x0D, 0x7B, 0x00, 0x7A, -+0x00, 0x79, 0x00, 0xD1, 0xAD, 0x04, 0xF0, 0x02, 0x5B, 0xF5, 0x02, 0x56, 0x8F, 0x90, 0x92, 0xCF, -+0x12, 0x47, 0x5F, 0xE4, 0x90, 0x92, 0xD2, 0xF0, 0xA3, 0x22, 0x90, 0x91, 0x78, 0xE0, 0x54, 0xFE, -+0xF0, 0x54, 0x7F, 0xF0, 0x54, 0xFB, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFD, 0x7F, 0x8F, 0x12, 0x3A, 0x96, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xD1, 0xD1, 0x90, 0x91, 0x76, 0xE0, 0xFF, 0xF1, 0x0E, 0x90, 0x01, 0x3F, -+0x74, 0x04, 0xF0, 0x90, 0x8D, 0x07, 0xE0, 0xFF, 0xB4, 0x01, 0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, -+0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x91, -+0x95, 0xEF, 0xF0, 0xE4, 0xFF, 0x74, 0xDD, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, -+0xFE, 0x74, 0x84, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x04, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, -+0x08, 0xE3, 0x90, 0x91, 0x0D, 0xE0, 0x90, 0x04, 0x8C, 0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, 0x90, -+0x75, 0x42, 0x4C, 0x75, 0x43, 0x08, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xE5, 0x12, 0x34, 0x2C, 0x90, -+0x91, 0x76, 0xE0, 0x60, 0x1F, 0x90, 0x91, 0x95, 0xE0, 0xFF, 0x12, 0x5E, 0x5E, 0x7E, 0x00, 0x12, -+0x82, 0xEC, 0xC0, 0x03, 0x8B, 0x40, 0x75, 0x41, 0x90, 0x75, 0x42, 0xDD, 0x75, 0x43, 0x32, 0xD0, -+0x03, 0x12, 0x34, 0x2C, 0x22, 0x90, 0x8F, 0x32, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x0A, 0x90, -+0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x03, 0x12, 0x67, 0xA4, 0x90, 0x8F, 0x39, 0xE0, 0x30, 0xE0, 0x0D, -+0x90, 0x8F, 0x33, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x03, 0x7F, 0x00, 0x22, 0x7F, 0x01, 0x22, -+0xEF, 0x90, 0x01, 0xC7, 0xB4, 0xA0, 0x05, 0x74, 0x04, 0xF0, 0x80, 0x03, 0x74, 0x08, 0xF0, 0x02, -+0x67, 0xA4, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x20, 0xE0, 0x05, 0x90, 0x91, 0x65, -+0x80, 0x03, 0x90, 0x91, 0x66, 0xE0, 0x90, 0x91, 0x0E, 0xF0, 0x90, 0x91, 0x0E, 0xE0, 0x14, 0x60, -+0x13, 0x14, 0x60, 0x14, 0x24, 0xFE, 0x60, 0x10, 0x14, 0x60, 0x09, 0x14, 0x60, 0x06, 0x24, 0x06, -+0xE4, 0xFE, 0x80, 0x06, 0x7E, 0x04, 0x80, 0x02, 0x7E, 0x08, 0xAF, 0x06, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0x8F, 0x39, 0xE0, 0x30, 0xE0, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x06, 0x90, 0xE0, 0x20, -+0xE5, 0x10, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x09, 0x90, 0x01, 0xC7, 0x74, 0x25, 0xF0, 0x7F, -+0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x91, 0x92, 0xF0, 0x12, 0x26, 0x1E, -+0x90, 0x91, 0x65, 0x12, 0x4E, 0xCD, 0x90, 0x91, 0x66, 0xF0, 0x22, 0x11, 0x6A, 0x90, 0x91, 0x67, -+0x12, 0x4E, 0xCD, 0xFF, 0xED, 0x2F, 0x90, 0x91, 0x68, 0x12, 0x4F, 0xEC, 0xFF, 0xED, 0x2F, 0x90, -+0x91, 0x69, 0x12, 0x4F, 0xAD, 0xFF, 0xED, 0x2F, 0x90, 0x91, 0x6A, 0x12, 0x4F, 0xCF, 0xFF, 0xED, -+0x2F, 0x90, 0x91, 0x6B, 0x12, 0x4F, 0xDD, 0xFF, 0xED, 0x2F, 0x90, 0x91, 0x6C, 0x12, 0x4F, 0xD6, -+0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x91, 0x6D, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, -+0x26, 0x1E, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x22, 0x11, 0x6A, 0x90, 0x91, 0x75, 0x12, 0x4E, 0xCD, -+0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x91, 0x76, 0xF0, 0x22, 0x11, 0x6A, 0x90, 0x91, 0x6E, 0x12, -+0x4E, 0xCD, 0xFF, 0xED, 0x2F, 0x90, 0x91, 0x6F, 0x12, 0x4F, 0xEC, 0xFF, 0xED, 0x2F, 0x90, 0x91, -+0x70, 0x12, 0x4F, 0xAD, 0xFF, 0xED, 0x2F, 0x90, 0x91, 0x71, 0x12, 0x4F, 0xCF, 0xFF, 0xED, 0x2F, -+0x90, 0x91, 0x72, 0x12, 0x4F, 0xDD, 0xFF, 0xED, 0x2F, 0x90, 0x91, 0x73, 0x12, 0x4F, 0xD6, 0xFF, -+0xAE, 0x05, 0xED, 0x2F, 0x90, 0x91, 0x74, 0xF0, 0x22, 0xE4, 0xFF, 0x74, 0x18, 0x11, 0xF3, 0xFE, -+0x74, 0x40, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x10, 0x11, 0xF3, -+0xFE, 0x74, 0x3A, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, -+0x06, 0xD9, 0x22, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x04, 0x1A, -+0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x7F, -+0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, 0xFD, 0xEF, -+0x64, 0x01, 0x70, 0x33, 0x90, 0x8E, 0xCC, 0xE0, 0xFF, 0x54, 0x03, 0x70, 0x2A, 0x90, 0x8E, 0xCA, -+0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x40, 0x20, 0xEF, 0x20, 0xE2, 0x1C, 0x90, 0x8E, 0xCC, 0xE0, 0x20, -+0xE4, 0x15, 0x90, 0x8E, 0xC4, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0A, 0x90, 0x8F, 0x2B, -+0xE0, 0x70, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8F, -+0x2C, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x30, 0x90, 0x02, 0x87, 0xE0, 0x70, 0x33, 0x90, 0x01, 0x00, -+0xE0, 0x64, 0x3F, 0x70, 0x2B, 0x90, 0x8F, 0x30, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x02, 0x82, 0xE0, -+0x70, 0x1E, 0x90, 0x8F, 0x39, 0xE0, 0x20, 0xE0, 0x17, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE1, 0x10, -+0x90, 0x02, 0x86, 0xE0, 0x20, 0xE3, 0x09, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, -+0x7F, 0x00, 0x22, 0x7D, 0x2E, 0x7F, 0x6F, 0x12, 0x53, 0x91, 0x7D, 0x02, 0x7F, 0x01, 0x02, 0x51, -+0x22, 0x90, 0x8F, 0x1F, 0x74, 0x04, 0xF0, 0xA3, 0x14, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, -+0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x31, 0xFE, 0x40, 0x31, 0x90, 0x8E, 0xE2, 0xE0, -+0x04, 0xF0, 0x90, 0x8F, 0x24, 0xE0, 0xFF, 0x90, 0x8E, 0xE2, 0xE0, 0xD3, 0x9F, 0x50, 0x1E, 0x90, -+0x8E, 0xDA, 0xE0, 0x04, 0x12, 0x68, 0xF7, 0x90, 0x8E, 0xE1, 0xF0, 0xFB, 0x90, 0x8E, 0xDA, 0xE0, -+0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x93, 0x38, 0x74, 0x04, 0xF0, 0x12, 0x72, 0x47, 0x22, 0x90, 0x8F, -+0x25, 0xE0, 0xFF, 0x90, 0x8E, 0xD1, 0xE0, 0xD3, 0x9F, 0x22, 0x7D, 0x2F, 0x12, 0x6C, 0x16, 0x7D, -+0x08, 0x7F, 0x01, 0x02, 0x51, 0x22, 0x12, 0x57, 0x86, 0x7D, 0x0C, 0x7F, 0x01, 0x02, 0x51, 0x22, -+0x51, 0x25, 0x02, 0x49, 0x38, 0x7E, 0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x8F, 0x79, -+0x2C, 0x22, 0x90, 0x8F, 0x2C, 0xE0, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, -+0x12, 0x6E, 0x50, 0x22, 0x90, 0x8D, 0xC0, 0xE0, 0xFF, 0x90, 0x93, 0x1D, 0xE0, 0xFB, 0x90, 0x93, -+0x30, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x56, 0xDF, 0x90, 0x93, 0x1E, 0xEE, 0xF0, 0xFC, 0xA3, -+0xEF, 0xF0, 0xFD, 0x90, 0x93, 0x1C, 0xE0, 0xFF, 0x51, 0xE4, 0x90, 0x93, 0x1E, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x51, 0xD8, 0x44, 0x01, 0xF0, -+0x51, 0xD8, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0x71, 0x1D, 0xE0, 0x44, 0xFA, 0xF0, -+0x74, 0x11, 0x2C, 0x71, 0x25, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, 0xA7, 0xE4, 0xF0, 0x90, 0x04, -+0xA6, 0xF0, 0x90, 0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, 0x74, 0xFD, 0xF0, 0x74, 0x14, -+0x2C, 0x51, 0xD0, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0x51, 0xD0, 0xED, 0xF0, 0x22, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x22, 0x71, 0x03, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x0B, 0x71, 0x0F, 0xE0, 0x44, -+0x10, 0x71, 0x02, 0x44, 0x80, 0xF0, 0x22, 0x71, 0x0F, 0xE0, 0x54, 0xEF, 0x71, 0x02, 0x44, 0x40, -+0xF0, 0x22, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x74, -+0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x93, 0x1C, -+0xE0, 0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x55, 0xEF, 0xF0, 0x90, 0x8D, -+0xC0, 0xE0, 0xFF, 0x90, 0x04, 0x1C, 0xE0, 0x6F, 0x70, 0x3D, 0x90, 0x8E, 0xCB, 0xE0, 0x64, 0x0E, -+0x70, 0x15, 0x90, 0x93, 0x55, 0xE0, 0x70, 0x2F, 0x90, 0x8E, 0xC3, 0xE0, 0x54, 0x7F, 0xF0, 0x12, -+0x57, 0xF9, 0x12, 0x51, 0x1E, 0x80, 0x1D, 0x90, 0x8E, 0xCB, 0xE0, 0x64, 0x06, 0x70, 0x18, 0x90, -+0x93, 0x55, 0xE0, 0x60, 0x12, 0x90, 0x8E, 0xC3, 0xE0, 0x54, 0xBF, 0xF0, 0x71, 0x8C, 0x90, 0x8E, -+0xCB, 0x74, 0x04, 0xF0, 0x12, 0x57, 0x89, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x06, 0x04, 0xE0, -+0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x90, 0x91, 0xAF, 0xED, 0xF0, 0x90, 0x91, 0xAD, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x71, 0xB5, 0x90, 0x91, 0xAD, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, -+0xE0, 0xFD, 0x02, 0x53, 0xFC, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x91, 0x66, 0xE0, -+0xFD, 0xB4, 0x02, 0x07, 0x91, 0x87, 0x74, 0x08, 0xF0, 0x80, 0x09, 0xED, 0xB4, 0x04, 0x05, 0x91, -+0x87, 0x74, 0x10, 0xF0, 0xEF, 0x64, 0x02, 0x4E, 0x60, 0x02, 0x81, 0x82, 0x90, 0x90, 0x44, 0xE0, -+0xFF, 0x64, 0xFE, 0x70, 0x02, 0x81, 0x82, 0xEF, 0x64, 0x02, 0x60, 0x07, 0xEF, 0x64, 0x03, 0x60, -+0x02, 0x81, 0x82, 0x90, 0x90, 0xA4, 0x91, 0x8F, 0x90, 0x91, 0xE3, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0x7E, 0x00, 0x7F, 0x20, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x91, 0x79, 0xC1, 0x12, 0x49, 0x38, 0x7B, -+0x01, 0x7A, 0x90, 0x79, 0xA6, 0x90, 0xAE, 0x73, 0x12, 0x47, 0x5F, 0x7A, 0x91, 0x79, 0xC1, 0x90, -+0xAE, 0x76, 0x12, 0x47, 0x5F, 0x7A, 0x90, 0x79, 0x13, 0x7D, 0x03, 0x12, 0x02, 0x00, 0x75, 0x40, -+0x01, 0x75, 0x41, 0x91, 0x75, 0x42, 0xC9, 0x75, 0x43, 0x10, 0x7B, 0x01, 0x7A, 0x91, 0x79, 0xB0, -+0x12, 0x34, 0x2C, 0x90, 0x91, 0xC7, 0xE0, 0x54, 0x03, 0x90, 0x91, 0xC0, 0xF0, 0xC3, 0x94, 0x04, -+0x50, 0x1C, 0xE0, 0x90, 0x91, 0x0D, 0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, 0x91, 0x75, 0x42, 0xB0, -+0x75, 0x43, 0x10, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xED, 0x12, 0x34, 0x2C, 0x80, 0x06, 0x90, 0x91, -+0x0D, 0x74, 0x05, 0xF0, 0x90, 0x91, 0xC0, 0xE0, 0xFF, 0x7B, 0x01, 0x7A, 0x91, 0x79, 0xB0, 0x12, -+0x4D, 0x38, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x91, 0xE1, 0x74, 0x80, 0xF0, 0xA3, 0x22, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFD, 0xED, 0xFF, 0x22, 0xB1, 0x30, 0x90, 0x91, 0x15, 0xE0, 0x70, 0x02, 0xA3, -+0xE0, 0x60, 0x2A, 0xE4, 0x90, 0x91, 0xA5, 0xF0, 0xB1, 0x27, 0x50, 0x24, 0x12, 0x65, 0x8F, 0x91, -+0xE1, 0x90, 0x91, 0xA5, 0xE0, 0x24, 0x23, 0xF5, 0x82, 0xE4, 0x34, 0x91, 0xF5, 0x83, 0xE0, 0x6F, -+0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x91, 0xA5, 0xE0, 0x04, 0xF0, 0x80, 0xDB, 0x7F, 0x00, 0x22, -+0x90, 0x06, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0xE4, 0x90, 0x91, 0x21, 0xF0, 0xA3, 0xF0, 0x7F, 0x01, -+0x22, 0xED, 0x24, 0x1C, 0xFD, 0x02, 0x63, 0x21, 0xB1, 0x30, 0xE4, 0xA3, 0xF0, 0xB1, 0x27, 0x50, -+0x1E, 0x12, 0x65, 0x8F, 0x91, 0xE1, 0x90, 0x91, 0xA5, 0xE0, 0x24, 0x43, 0xF5, 0x82, 0xE4, 0x34, -+0x91, 0xF5, 0x83, 0xE0, 0xB5, 0x07, 0x1D, 0x90, 0x91, 0xA5, 0xE0, 0x04, 0xF0, 0x80, 0xDE, 0x90, -+0x06, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x30, 0xF0, 0x7F, 0x01, 0x12, 0x74, -+0x11, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x91, 0xA5, 0xE0, 0xFD, 0xC3, 0x94, 0x02, 0x22, -+0x90, 0x91, 0xA2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x22, 0xAD, 0x07, 0x90, 0x91, -+0x19, 0x12, 0x59, 0x36, 0x90, 0x91, 0x19, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x04, 0x2E, 0x12, 0x5F, -+0xC3, 0xEF, 0xF0, 0x90, 0x91, 0x19, 0xA3, 0xE0, 0xFF, 0x74, 0x05, 0x2E, 0x12, 0x5F, 0xCB, 0xEF, -+0xF0, 0x22, 0xE4, 0x90, 0x92, 0xA1, 0xF0, 0x90, 0x92, 0x57, 0x12, 0x47, 0x56, 0x90, 0x92, 0x9F, -+0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC0, 0xF9, 0xEA, 0x34, 0xFF, -+0xFA, 0x74, 0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x92, 0x57, 0x12, 0x47, 0x56, 0x90, 0x92, 0x9F, -+0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC4, 0xF9, 0xEA, 0x34, 0xFF, -+0xFA, 0xA3, 0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x92, 0x57, 0x12, 0x47, 0x56, 0x90, -+0x92, 0x9F, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC8, 0xF9, 0xEA, -+0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x92, 0x57, 0x12, 0x47, -+0x56, 0x90, 0x92, 0x9F, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x22, 0xA3, -+0x74, 0x40, 0xF0, 0x74, 0x5F, 0x2F, 0xF9, 0xE4, 0x34, 0x92, 0xFA, 0x7B, 0x01, 0x74, 0x40, 0x44, -+0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x92, 0x9F, 0xA3, 0xE0, 0x24, 0x63, 0xF9, 0xE4, 0x34, 0x92, -+0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x92, 0x9F, 0xA3, 0xE0, -+0x24, 0x67, 0xF9, 0xE4, 0x34, 0x92, 0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, 0x30, -+0xA4, 0x90, 0x92, 0x9F, 0xA3, 0xE0, 0x22, 0x90, 0x91, 0xCC, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x46, -+0xD6, 0x90, 0x91, 0xCC, 0xE4, 0x75, 0xF0, 0x08, 0x02, 0x46, 0xD6, 0x54, 0xFE, 0xFD, 0x7F, 0x02, -+0x12, 0x3A, 0x96, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x12, 0x3A, 0x96, 0x90, -+0x00, 0x02, 0xE0, 0x22, 0x90, 0x91, 0x6A, 0xE0, 0xFF, 0x90, 0x93, 0x30, 0x74, 0x08, 0xF0, 0x7B, -+0x18, 0x7D, 0x01, 0x12, 0x56, 0xDF, 0x90, 0x91, 0xC7, 0xEF, 0xF0, 0x90, 0x91, 0x6A, 0xE0, 0x90, -+0x04, 0x25, 0xF0, 0x22, 0x90, 0x91, 0xC9, 0xE0, 0xFF, 0x24, 0x4C, 0xF5, 0x82, 0xE4, 0x34, 0x90, -+0xF5, 0x83, 0x22, 0x90, 0x8E, 0xC4, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x12, 0x47, -+0x14, 0x90, 0x8F, 0x1B, 0x12, 0x27, 0x48, 0x90, 0x8E, 0xC4, 0xE0, 0x22, 0x90, 0x91, 0xA4, 0xE0, -+0xFD, 0x90, 0x91, 0xA3, 0xE0, 0x2D, 0x22, 0xF0, 0x90, 0x8E, 0xD4, 0xA3, 0xE0, 0x90, 0x05, 0x58, -+0xF0, 0x22, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x5B, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x49, -+0x14, 0xEF, 0x22, 0x90, 0x8E, 0xC3, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x7F, 0x00, 0x7E, -+0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFE, 0xEF, 0x54, 0x07, 0xFF, -+0x22, 0x90, 0x91, 0xA5, 0xE0, 0xFD, 0x90, 0x91, 0xA4, 0xE0, 0x22, 0x75, 0x41, 0x90, 0x75, 0x42, -+0x4A, 0x75, 0x43, 0x02, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xFD, 0x02, 0x63, 0x21, 0x7E, 0x0E, -+0x12, 0x37, 0x5D, 0x90, 0x00, 0xFF, 0xE0, 0x22, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x8D, 0x01, 0xE0, -+0xFF, 0x22, 0x90, 0x8F, 0x2E, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x90, 0x8E, 0xC6, 0xE0, 0xFF, -+0xC4, 0x54, 0x0F, 0x22, 0x90, 0x8F, 0x32, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x22, 0x90, 0x91, 0x8E, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, 0x22, 0x2E, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, -+0xEF, 0xF0, 0x90, 0x91, 0xAA, 0xE0, 0x04, 0x22, 0x7F, 0xB4, 0x7E, 0x08, 0x02, 0x37, 0x5D, 0xF0, -+0x90, 0x91, 0xC9, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x91, 0xCC, 0xE4, 0x75, 0xF0, 0x02, 0x22, 0xF0, -+0xE4, 0x90, 0x91, 0xD7, 0xF0, 0xA3, 0x22, 0x90, 0x8E, 0xC4, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, -+0x8E, 0xCE, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0x90, 0x8E, 0xC6, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0x90, -+0x8E, 0xCE, 0xE0, 0x90, 0x05, 0x73, 0x22, 0x90, 0x8E, 0xCC, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x2F, -+0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0x22, 0x90, 0x93, 0x41, 0xE0, 0xFF, 0x7D, 0x48, 0x22, 0x7F, -+0xB0, 0x7E, 0x0C, 0x02, 0x37, 0x5D, 0xA8, 0x83, -+}; -+u4Byte ArrayLength_MP_8812A_FW_WoWLAN = 22504; -+ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_WoWLAN( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8812A_FW_WoWLAN; -+#else -+ ODM_MoveMemory(pDM_Odm, pFirmware, Array_MP_8812A_FW_WoWLAN, ArrayLength_MP_8812A_FW_WoWLAN); -+#endif -+ *pFirmwareSize = ArrayLength_MP_8812A_FW_WoWLAN; -+} -+ -+ -+ -+#endif /* end of (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP)))*/ -+ -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_fw.h linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_fw.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_fw.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_fw.h 2017-06-07 23:07:21.023688669 +0300 -@@ -0,0 +1,73 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.11*/ -+#if (RTL8812A_SUPPORT == 1) -+#ifndef __INC_MP_FW_HW_IMG_8812A_H -+#define __INC_MP_FW_HW_IMG_8812A_H -+ -+ -+/****************************************************************************** -+* FW_AP.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_AP( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_NIC.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_NIC( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_NIC_BT.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_NIC_BT( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_WoWLAN.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_WoWLAN( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_mac.c linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_mac.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_mac.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_mac.c 2017-06-07 23:07:21.023688669 +0300 -@@ -0,0 +1,294 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.14*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8812A_SUPPORT == 1) -+static BOOLEAN -+CheckPositive( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2, -+ IN const u4Byte Condition3, -+ IN const u4Byte Condition4 -+) -+{ -+ u1Byte _BoardType = ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA*/ -+ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA*/ -+ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA*/ -+ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ -+ ((pDM_Odm->BoardType & BIT2) >> 2) << 4; /* _BT*/ -+ -+ u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; -+ u4Byte driver1 = pDM_Odm->CutVersion << 24 | -+ (pDM_Odm->SupportInterface & 0xF0) << 16 | -+ pDM_Odm->SupportPlatform << 16 | -+ pDM_Odm->PackageType << 12 | -+ (pDM_Odm->SupportInterface & 0x0F) << 8 | -+ _BoardType; -+ -+ u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | -+ (pDM_Odm->TypeGPA & 0xFF) << 8 | -+ (pDM_Odm->TypeALNA & 0xFF) << 16 | -+ (pDM_Odm->TypeAPA & 0xFF) << 24; -+ -+u4Byte driver3 = 0; -+ -+ u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | -+ (pDM_Odm->TypeGPA & 0xFF00) | -+ (pDM_Odm->TypeALNA & 0xFF00) << 8 | -+ (pDM_Odm->TypeAPA & 0xFF00) << 16; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Platform, Interface) = (0x%X, 0x%X)\n", pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Board, Package) = (0x%X, 0x%X)\n", pDM_Odm->BoardType, pDM_Odm->PackageType)); -+ -+ -+ /*============== Value Defined Check ===============*/ -+ /*QFN Type [15:12] and Cut Version [27:24] need to do value check*/ -+ -+ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return FALSE; -+ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return FALSE; -+ -+ /*=============== Bit Defined Check ================*/ -+ /* We don't care [31:28] */ -+ -+ cond1 &= 0x00FF0FFF; -+ driver1 &= 0x00FF0FFF; -+ -+ if ((cond1 & driver1) == cond1) { -+ u4Byte bitMask = 0; -+ -+ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE*/ -+ return TRUE; -+ -+ if ((cond1 & BIT0) != 0) /*GLNA*/ -+ bitMask |= 0x000000FF; -+ if ((cond1 & BIT1) != 0) /*GPA*/ -+ bitMask |= 0x0000FF00; -+ if ((cond1 & BIT2) != 0) /*ALNA*/ -+ bitMask |= 0x00FF0000; -+ if ((cond1 & BIT3) != 0) /*APA*/ -+ bitMask |= 0xFF000000; -+ -+ if (((cond2 & bitMask) == (driver2 & bitMask)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ -+ return TRUE; -+ else -+ return FALSE; -+ } else -+ return FALSE; -+} -+static BOOLEAN -+CheckNegative( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2 -+) -+{ -+ return TRUE; -+} -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_MAC_REG[] = { -+ 0x010, 0x0000000C, -+ 0x80000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x011, 0x00000066, -+ 0xA0000000, 0x00000000, -+ 0x011, 0x0000005A, -+ 0xB0000000, 0x00000000, -+ 0x025, 0x0000000F, -+ 0x072, 0x00000000, -+ 0x420, 0x00000080, -+ 0x428, 0x0000000A, -+ 0x429, 0x00000010, -+ 0x430, 0x00000000, -+ 0x431, 0x00000000, -+ 0x432, 0x00000000, -+ 0x433, 0x00000001, -+ 0x434, 0x00000004, -+ 0x435, 0x00000005, -+ 0x436, 0x00000007, -+ 0x437, 0x00000008, -+ 0x43C, 0x00000004, -+ 0x43D, 0x00000005, -+ 0x43E, 0x00000007, -+ 0x43F, 0x00000008, -+ 0x440, 0x0000005D, -+ 0x441, 0x00000001, -+ 0x442, 0x00000000, -+ 0x444, 0x00000010, -+ 0x445, 0x00000000, -+ 0x446, 0x00000000, -+ 0x447, 0x00000000, -+ 0x448, 0x00000000, -+ 0x449, 0x000000F0, -+ 0x44A, 0x0000000F, -+ 0x44B, 0x0000003E, -+ 0x44C, 0x00000010, -+ 0x44D, 0x00000000, -+ 0x44E, 0x00000000, -+ 0x44F, 0x00000000, -+ 0x450, 0x00000000, -+ 0x451, 0x000000F0, -+ 0x452, 0x0000000F, -+ 0x453, 0x00000000, -+ 0x45B, 0x00000080, -+ 0x460, 0x00000066, -+ 0x461, 0x00000066, -+ 0x4C8, 0x000000FF, -+ 0x4C9, 0x00000008, -+ 0x4CC, 0x000000FF, -+ 0x4CD, 0x000000FF, -+ 0x4CE, 0x00000001, -+ 0x500, 0x00000026, -+ 0x501, 0x000000A2, -+ 0x502, 0x0000002F, -+ 0x503, 0x00000000, -+ 0x504, 0x00000028, -+ 0x505, 0x000000A3, -+ 0x506, 0x0000005E, -+ 0x507, 0x00000000, -+ 0x508, 0x0000002B, -+ 0x509, 0x000000A4, -+ 0x50A, 0x0000005E, -+ 0x50B, 0x00000000, -+ 0x50C, 0x0000004F, -+ 0x50D, 0x000000A4, -+ 0x50E, 0x00000000, -+ 0x50F, 0x00000000, -+ 0x512, 0x0000001C, -+ 0x514, 0x0000000A, -+ 0x516, 0x0000000A, -+ 0x525, 0x0000004F, -+ 0x550, 0x00000010, -+ 0x551, 0x00000010, -+ 0x559, 0x00000002, -+ 0x55C, 0x00000050, -+ 0x55D, 0x000000FF, -+ 0x604, 0x00000009, -+ 0x605, 0x00000030, -+ 0x607, 0x00000003, -+ 0x608, 0x0000000E, -+ 0x609, 0x0000002A, -+ 0x620, 0x000000FF, -+ 0x621, 0x000000FF, -+ 0x622, 0x000000FF, -+ 0x623, 0x000000FF, -+ 0x624, 0x000000FF, -+ 0x625, 0x000000FF, -+ 0x626, 0x000000FF, -+ 0x627, 0x000000FF, -+ 0x638, 0x00000050, -+ 0x63C, 0x0000000A, -+ 0x63D, 0x0000000A, -+ 0x63E, 0x0000000E, -+ 0x63F, 0x0000000E, -+ 0x640, 0x00000080, -+ 0x642, 0x00000040, -+ 0x643, 0x00000000, -+ 0x652, 0x000000C8, -+ 0x66E, 0x00000005, -+ 0x700, 0x00000021, -+ 0x701, 0x00000043, -+ 0x702, 0x00000065, -+ 0x703, 0x00000087, -+ 0x708, 0x00000021, -+ 0x709, 0x00000043, -+ 0x70A, 0x00000065, -+ 0x70B, 0x00000087, -+ 0x718, 0x00000040, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_MAC_REG( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_MAC_REG)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_MAC_REG; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8812A_MAC_REG\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigMAC_8812A(pDM_Odm, v1, (u1Byte)v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8812A_MAC_REG(void) -+{ -+ return 55; -+} -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_mac.h linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_mac.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_mac.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_mac.h 2017-06-07 23:07:21.023688669 +0300 -@@ -0,0 +1,39 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.14*/ -+#if (RTL8812A_SUPPORT == 1) -+#ifndef __INC_MP_MAC_HW_IMG_8812A_H -+#define __INC_MP_MAC_HW_IMG_8812A_H -+ -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_MAC_REG(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_MAC_REG(void); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_rf.c linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_rf.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_rf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_rf.c 2017-06-07 23:07:21.023688669 +0300 -@@ -0,0 +1,3201 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.14*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8812A_SUPPORT == 1) -+static BOOLEAN -+CheckPositive( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2, -+ IN const u4Byte Condition3, -+ IN const u4Byte Condition4 -+) -+{ -+ u1Byte _BoardType = ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA*/ -+ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA*/ -+ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA*/ -+ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ -+ ((pDM_Odm->BoardType & BIT2) >> 2) << 4; /* _BT*/ -+ -+ u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; -+ u4Byte driver1 = pDM_Odm->CutVersion << 24 | -+ (pDM_Odm->SupportInterface & 0xF0) << 16 | -+ pDM_Odm->SupportPlatform << 16 | -+ pDM_Odm->PackageType << 12 | -+ (pDM_Odm->SupportInterface & 0x0F) << 8 | -+ _BoardType; -+ -+ u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | -+ (pDM_Odm->TypeGPA & 0xFF) << 8 | -+ (pDM_Odm->TypeALNA & 0xFF) << 16 | -+ (pDM_Odm->TypeAPA & 0xFF) << 24; -+ -+u4Byte driver3 = 0; -+ -+ u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | -+ (pDM_Odm->TypeGPA & 0xFF00) | -+ (pDM_Odm->TypeALNA & 0xFF00) << 8 | -+ (pDM_Odm->TypeAPA & 0xFF00) << 16; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Platform, Interface) = (0x%X, 0x%X)\n", pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Board, Package) = (0x%X, 0x%X)\n", pDM_Odm->BoardType, pDM_Odm->PackageType)); -+ -+ -+ /*============== Value Defined Check ===============*/ -+ /*QFN Type [15:12] and Cut Version [27:24] need to do value check*/ -+ -+ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return FALSE; -+ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return FALSE; -+ -+ /*=============== Bit Defined Check ================*/ -+ /* We don't care [31:28] */ -+ -+ cond1 &= 0x00FF0FFF; -+ driver1 &= 0x00FF0FFF; -+ -+ if ((cond1 & driver1) == cond1) { -+ u4Byte bitMask = 0; -+ -+ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE*/ -+ return TRUE; -+ -+ if ((cond1 & BIT0) != 0) /*GLNA*/ -+ bitMask |= 0x000000FF; -+ if ((cond1 & BIT1) != 0) /*GPA*/ -+ bitMask |= 0x0000FF00; -+ if ((cond1 & BIT2) != 0) /*ALNA*/ -+ bitMask |= 0x00FF0000; -+ if ((cond1 & BIT3) != 0) /*APA*/ -+ bitMask |= 0xFF000000; -+ -+ if (((cond2 & bitMask) == (driver2 & bitMask)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ -+ return TRUE; -+ else -+ return FALSE; -+ } else -+ return FALSE; -+} -+static BOOLEAN -+CheckNegative( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2 -+) -+{ -+ return TRUE; -+} -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_RadioA[] = { -+ 0x000, 0x00010000, -+ 0x018, 0x0001712A, -+ 0x056, 0x00051CF2, -+ 0x066, 0x00040000, -+ 0x01E, 0x00080000, -+ 0x089, 0x00000080, -+ 0x80000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x086, 0x00014B3A, -+ 0x90000001, 0x00000005, 0x40000000, 0x00000000, -+ 0x086, 0x00014B3A, -+ 0xA0000000, 0x00000000, -+ 0x086, 0x00014B38, -+ 0xB0000000, 0x00000000, -+ 0x80000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x08B, 0x00080180, -+ 0xA0000000, 0x00000000, -+ 0x08B, 0x00087180, -+ 0xB0000000, 0x00000000, -+ 0x0B1, 0x0001FC1A, -+ 0x0B3, 0x000F0810, -+ 0x0B4, 0x0001A78D, -+ 0x0BA, 0x00086180, -+ 0x018, 0x00000006, -+ 0x0EF, 0x00002000, -+ 0x80000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03B, 0x0003F218, -+ 0x03B, 0x00030A58, -+ 0x03B, 0x0002FA58, -+ 0x03B, 0x00022590, -+ 0x03B, 0x0001FA50, -+ 0x03B, 0x00010248, -+ 0x03B, 0x00008240, -+ 0x90000001, 0x00000005, 0x40000000, 0x00000000, -+ 0x03B, 0x0003F218, -+ 0x03B, 0x00030A58, -+ 0x03B, 0x0002FA58, -+ 0x03B, 0x00022590, -+ 0x03B, 0x0001FA50, -+ 0x03B, 0x00010248, -+ 0x03B, 0x00008240, -+ 0xA0000000, 0x00000000, -+ 0x03B, 0x00038A58, -+ 0x03B, 0x00037A58, -+ 0x03B, 0x0002A590, -+ 0x03B, 0x00027A50, -+ 0x03B, 0x00018248, -+ 0x03B, 0x00010240, -+ 0x03B, 0x00008240, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000100, -+ 0x80000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0000A4EE, -+ 0x034, 0x00009076, -+ 0x034, 0x00008073, -+ 0x034, 0x00007070, -+ 0x034, 0x0000606D, -+ 0x034, 0x0000506A, -+ 0x034, 0x00004049, -+ 0x034, 0x00003046, -+ 0x034, 0x00002028, -+ 0x034, 0x00001025, -+ 0x034, 0x00000022, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x0000ADF4, -+ 0x034, 0x00009DF1, -+ 0x034, 0x00008DEE, -+ 0x034, 0x00007DEB, -+ 0x034, 0x00006DE8, -+ 0x034, 0x00005DE5, -+ 0x034, 0x00004DE2, -+ 0x034, 0x00003CE6, -+ 0x034, 0x000024E7, -+ 0x034, 0x000014E4, -+ 0x034, 0x000004E1, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x000020A2, -+ 0x0DF, 0x00000080, -+ 0x035, 0x00000192, -+ 0x035, 0x00008192, -+ 0x035, 0x00010192, -+ 0x036, 0x00000024, -+ 0x036, 0x00008024, -+ 0x036, 0x00010024, -+ 0x036, 0x00018024, -+ 0x0EF, 0x00000000, -+ 0x051, 0x00000C21, -+ 0x052, 0x000006D9, -+ 0x053, 0x000FC649, -+ 0x054, 0x0000017E, -+ 0x0EF, 0x00000002, -+ 0x008, 0x00008400, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00001000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x0003A02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x0003202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x0002B064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x00023070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0001B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00012085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0000A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00002080, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x0007A02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x0007202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x0006B064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x00063070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0005B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00052085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0004A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00042080, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x000BA02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x000B202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x000AB064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x000A3070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0009B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00092085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0008A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00082080, -+ 0x03C, 0x00010000, -+ 0x0EF, 0x00001100, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x0004604D, -+ 0x034, 0x0004504A, -+ 0x034, 0x00044047, -+ 0x034, 0x00043044, -+ 0x034, 0x00042007, -+ 0x034, 0x00041004, -+ 0x034, 0x00040001, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x0004ADF5, -+ 0x034, 0x00049DF2, -+ 0x034, 0x00048DEF, -+ 0x034, 0x00047DEC, -+ 0x034, 0x00046DE9, -+ 0x034, 0x00045DE6, -+ 0x034, 0x00044DE3, -+ 0x034, 0x000438C8, -+ 0x034, 0x000428C5, -+ 0x034, 0x000418C2, -+ 0x034, 0x000408C0, -+ 0xB0000000, 0x00000000, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x034, 0x0002A0B4, -+ 0x034, 0x000290B1, -+ 0x034, 0x00028072, -+ 0x034, 0x0002706F, -+ 0x034, 0x0002604F, -+ 0x034, 0x0002504C, -+ 0x034, 0x00024049, -+ 0x034, 0x00023046, -+ 0x034, 0x00022009, -+ 0x034, 0x00021006, -+ 0x034, 0x00020003, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x0002ADF5, -+ 0x034, 0x00029DF2, -+ 0x034, 0x00028DEF, -+ 0x034, 0x00027DEC, -+ 0x034, 0x00026DE9, -+ 0x034, 0x00025DE6, -+ 0x034, 0x00024DE3, -+ 0x034, 0x000238C8, -+ 0x034, 0x000228C5, -+ 0x034, 0x000218C2, -+ 0x034, 0x000208C0, -+ 0xB0000000, 0x00000000, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x0000604D, -+ 0x034, 0x0000504A, -+ 0x034, 0x00004047, -+ 0x034, 0x00003044, -+ 0x034, 0x00002007, -+ 0x034, 0x00001004, -+ 0x034, 0x00000001, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x0000AFF7, -+ 0x034, 0x00009DF7, -+ 0x034, 0x00008DF4, -+ 0x034, 0x00007DF1, -+ 0x034, 0x00006DEE, -+ 0x034, 0x00005DEB, -+ 0x034, 0x00004DE8, -+ 0x034, 0x000038CC, -+ 0x034, 0x000028C9, -+ 0x034, 0x000018C6, -+ 0x034, 0x000008C3, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001D4, -+ 0x035, 0x000081D4, -+ 0x035, 0x000101D4, -+ 0x035, 0x000201B4, -+ 0x035, 0x000281B4, -+ 0x035, 0x000301B4, -+ 0x035, 0x000401B4, -+ 0x035, 0x000481B4, -+ 0x035, 0x000501B4, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001D4, -+ 0x035, 0x000081D4, -+ 0x035, 0x000101D4, -+ 0x035, 0x000201B4, -+ 0x035, 0x000281B4, -+ 0x035, 0x000301B4, -+ 0x035, 0x000401B4, -+ 0x035, 0x000481B4, -+ 0x035, 0x000501B4, -+ 0xA0000000, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x00000188, -+ 0x035, 0x00008147, -+ 0x035, 0x00010147, -+ 0x035, 0x000201D7, -+ 0x035, 0x000281D7, -+ 0x035, 0x000301D7, -+ 0x035, 0x000401D8, -+ 0x035, 0x000481D8, -+ 0x035, 0x000501D8, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00004BFB, -+ 0x036, 0x0000CBFB, -+ 0x036, 0x00014BFB, -+ 0x036, 0x0001CBFB, -+ 0x036, 0x00024F4B, -+ 0x036, 0x0002CF4B, -+ 0x036, 0x00034F4B, -+ 0x036, 0x0003CF4B, -+ 0x036, 0x00044F4B, -+ 0x036, 0x0004CF4B, -+ 0x036, 0x00054F4B, -+ 0x036, 0x0005CF4B, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00004BFB, -+ 0x036, 0x0000CBFB, -+ 0x036, 0x00014BFB, -+ 0x036, 0x0001CBFB, -+ 0x036, 0x00024F4B, -+ 0x036, 0x0002CF4B, -+ 0x036, 0x00034F4B, -+ 0x036, 0x0003CF4B, -+ 0x036, 0x00044F4B, -+ 0x036, 0x0004CF4B, -+ 0x036, 0x00054F4B, -+ 0x036, 0x0005CF4B, -+ 0xA0000000, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00084EB4, -+ 0x036, 0x0008CC35, -+ 0x036, 0x00094C35, -+ 0x036, 0x0009CC35, -+ 0x036, 0x000A4C35, -+ 0x036, 0x000ACC35, -+ 0x036, 0x000B4C35, -+ 0x036, 0x000BCC35, -+ 0x036, 0x000C4C34, -+ 0x036, 0x000CCC35, -+ 0x036, 0x000D4C35, -+ 0x036, 0x000DCC35, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000008, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x000002CC, -+ 0x03C, 0x00000522, -+ 0x03C, 0x00000902, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x03C, 0x000002CC, -+ 0x03C, 0x00000522, -+ 0x03C, 0x00000902, -+ 0xA0000000, 0x00000000, -+ 0x03C, 0x000002A8, -+ 0x03C, 0x000005A2, -+ 0x03C, 0x00000880, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000002, -+ 0x0DF, 0x00000080, -+ 0x01F, 0x00000064, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x061, 0x000FDD43, -+ 0x062, 0x00038F4B, -+ 0x063, 0x00032117, -+ 0x064, 0x000194AC, -+ 0x065, 0x000931D1, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x061, 0x000FDD43, -+ 0x062, 0x00038F4B, -+ 0x063, 0x00032117, -+ 0x064, 0x000194AC, -+ 0x065, 0x000931D2, -+ 0xA0000000, 0x00000000, -+ 0x061, 0x000E5D53, -+ 0x062, 0x00038FCD, -+ 0x063, 0x000114EB, -+ 0x064, 0x000196AC, -+ 0x065, 0x000911D7, -+ 0xB0000000, 0x00000000, -+ 0x008, 0x00008400, -+ 0x01C, 0x000739D2, -+ 0x0B4, 0x0001E78D, -+ 0x018, 0x0001F12A, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0B4, 0x0001A78D, -+ 0x018, 0x0001712A, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_RadioA( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_RadioA)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_RadioA; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8812A_RadioA\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigRF_RadioA_8812A(pDM_Odm, v1, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8812A_RadioA(void) -+{ -+ return 55; -+} -+ -+/****************************************************************************** -+* RadioB.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_RadioB[] = { -+ 0x056, 0x00051CF2, -+ 0x066, 0x00040000, -+ 0x089, 0x00000080, -+ 0x80000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x086, 0x00014B3A, -+ 0x90000001, 0x00000005, 0x40000000, 0x00000000, -+ 0x086, 0x00014B3A, -+ 0xA0000000, 0x00000000, -+ 0x086, 0x00014B38, -+ 0xB0000000, 0x00000000, -+ 0x80000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x08B, 0x00080180, -+ 0xA0000000, 0x00000000, -+ 0x08B, 0x00087180, -+ 0xB0000000, 0x00000000, -+ 0x018, 0x00000006, -+ 0x0EF, 0x00002000, -+ 0x80000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03B, 0x0003F218, -+ 0x03B, 0x00030A58, -+ 0x03B, 0x0002FA58, -+ 0x03B, 0x00022590, -+ 0x03B, 0x0001FA50, -+ 0x03B, 0x00010248, -+ 0x03B, 0x00008240, -+ 0x90000001, 0x00000005, 0x40000000, 0x00000000, -+ 0x03B, 0x0003F218, -+ 0x03B, 0x00030A58, -+ 0x03B, 0x0002FA58, -+ 0x03B, 0x00022590, -+ 0x03B, 0x0001FA50, -+ 0x03B, 0x00010248, -+ 0x03B, 0x00008240, -+ 0xA0000000, 0x00000000, -+ 0x03B, 0x00038A58, -+ 0x03B, 0x00037A58, -+ 0x03B, 0x0002A590, -+ 0x03B, 0x00027A50, -+ 0x03B, 0x00018248, -+ 0x03B, 0x00010240, -+ 0x03B, 0x00008240, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000100, -+ 0x80000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0000A4EE, -+ 0x034, 0x00009076, -+ 0x034, 0x00008073, -+ 0x034, 0x00007070, -+ 0x034, 0x0000606D, -+ 0x034, 0x0000506A, -+ 0x034, 0x00004049, -+ 0x034, 0x00003046, -+ 0x034, 0x00002028, -+ 0x034, 0x00001025, -+ 0x034, 0x00000022, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x0000ADF4, -+ 0x034, 0x00009DF1, -+ 0x034, 0x00008DEE, -+ 0x034, 0x00007DEB, -+ 0x034, 0x00006DE8, -+ 0x034, 0x00005DE5, -+ 0x034, 0x00004DE2, -+ 0x034, 0x00003CE6, -+ 0x034, 0x000024E7, -+ 0x034, 0x000014E4, -+ 0x034, 0x000004E1, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x000020A2, -+ 0x0DF, 0x00000080, -+ 0x035, 0x00000192, -+ 0x035, 0x00008192, -+ 0x035, 0x00010192, -+ 0x036, 0x00000024, -+ 0x036, 0x00008024, -+ 0x036, 0x00010024, -+ 0x036, 0x00018024, -+ 0x0EF, 0x00000000, -+ 0x051, 0x00000C21, -+ 0x052, 0x000006D9, -+ 0x053, 0x000FC649, -+ 0x054, 0x0000017E, -+ 0x0EF, 0x00000002, -+ 0x008, 0x00008400, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00001000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x0003A02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x0003202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x0002B064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x00023070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0001B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00012085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0000A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00002080, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x0007A02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x0007202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x0006B064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x00063070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0005B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00052085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0004A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00042080, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x000BA02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x000B202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x000AB064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x000A3070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0009B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00092085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0008A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00082080, -+ 0x03C, 0x00010000, -+ 0x0EF, 0x00001100, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x034, 0x0004A0B1, -+ 0x034, 0x000490AE, -+ 0x034, 0x0004806F, -+ 0x034, 0x0004706C, -+ 0x034, 0x0004604C, -+ 0x034, 0x00045049, -+ 0x034, 0x00044046, -+ 0x034, 0x00043043, -+ 0x034, 0x00042006, -+ 0x034, 0x00041003, -+ 0x034, 0x00040000, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x0004ADF5, -+ 0x034, 0x00049DF2, -+ 0x034, 0x00048DEF, -+ 0x034, 0x00047DEC, -+ 0x034, 0x00046DE9, -+ 0x034, 0x00045DE6, -+ 0x034, 0x00044DE3, -+ 0x034, 0x000438C8, -+ 0x034, 0x000428C5, -+ 0x034, 0x000418C2, -+ 0x034, 0x000408C0, -+ 0xB0000000, 0x00000000, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x034, 0x0002A0B3, -+ 0x034, 0x000290B0, -+ 0x034, 0x00028071, -+ 0x034, 0x0002706E, -+ 0x034, 0x0002604E, -+ 0x034, 0x0002504B, -+ 0x034, 0x00024048, -+ 0x034, 0x00023045, -+ 0x034, 0x00022008, -+ 0x034, 0x00021005, -+ 0x034, 0x00020002, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x0002ADF5, -+ 0x034, 0x00029DF2, -+ 0x034, 0x00028DEF, -+ 0x034, 0x00027DEC, -+ 0x034, 0x00026DE9, -+ 0x034, 0x00025DE6, -+ 0x034, 0x00024DE3, -+ 0x034, 0x000238C8, -+ 0x034, 0x000228C5, -+ 0x034, 0x000218C2, -+ 0x034, 0x000208C0, -+ 0xB0000000, 0x00000000, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x034, 0x0000A0B3, -+ 0x034, 0x000090B0, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x0000604D, -+ 0x034, 0x0000504A, -+ 0x034, 0x00004047, -+ 0x034, 0x00003044, -+ 0x034, 0x00002007, -+ 0x034, 0x00001004, -+ 0x034, 0x00000001, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x0000AFF7, -+ 0x034, 0x00009DF7, -+ 0x034, 0x00008DF4, -+ 0x034, 0x00007DF1, -+ 0x034, 0x00006DEE, -+ 0x034, 0x00005DEB, -+ 0x034, 0x00004DE8, -+ 0x034, 0x000038CC, -+ 0x034, 0x000028C9, -+ 0x034, 0x000018C6, -+ 0x034, 0x000008C3, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001C5, -+ 0x035, 0x000081C5, -+ 0x035, 0x000101C5, -+ 0x035, 0x00020174, -+ 0x035, 0x00028174, -+ 0x035, 0x00030174, -+ 0x035, 0x00040185, -+ 0x035, 0x00048185, -+ 0x035, 0x00050185, -+ 0x0EF, 0x00000000, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001C5, -+ 0x035, 0x000081C5, -+ 0x035, 0x000101C5, -+ 0x035, 0x00020174, -+ 0x035, 0x00028174, -+ 0x035, 0x00030174, -+ 0x035, 0x00040185, -+ 0x035, 0x00048185, -+ 0x035, 0x00050185, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x00000188, -+ 0x035, 0x00008147, -+ 0x035, 0x00010147, -+ 0x035, 0x000201D7, -+ 0x035, 0x000281D7, -+ 0x035, 0x000301D7, -+ 0x035, 0x000401D8, -+ 0x035, 0x000481D8, -+ 0x035, 0x000501D8, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00005B8B, -+ 0x036, 0x0000DB8B, -+ 0x036, 0x00015B8B, -+ 0x036, 0x0001DB8B, -+ 0x036, 0x000262DB, -+ 0x036, 0x0002E2DB, -+ 0x036, 0x000362DB, -+ 0x036, 0x0003E2DB, -+ 0x036, 0x0004553B, -+ 0x036, 0x0004D53B, -+ 0x036, 0x0005553B, -+ 0x036, 0x0005D53B, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00005B8B, -+ 0x036, 0x0000DB8B, -+ 0x036, 0x00015B8B, -+ 0x036, 0x0001DB8B, -+ 0x036, 0x000262DB, -+ 0x036, 0x0002E2DB, -+ 0x036, 0x000362DB, -+ 0x036, 0x0003E2DB, -+ 0x036, 0x0004553B, -+ 0x036, 0x0004D53B, -+ 0x036, 0x0005553B, -+ 0x036, 0x0005D53B, -+ 0xA0000000, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00084EB4, -+ 0x036, 0x0008CC35, -+ 0x036, 0x00094C35, -+ 0x036, 0x0009CC35, -+ 0x036, 0x000A4C35, -+ 0x036, 0x000ACC35, -+ 0x036, 0x000B4C35, -+ 0x036, 0x000BCC35, -+ 0x036, 0x000C4C34, -+ 0x036, 0x000CCC35, -+ 0x036, 0x000D4C35, -+ 0x036, 0x000DCC35, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000008, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x000002DC, -+ 0x03C, 0x00000524, -+ 0x03C, 0x00000902, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x03C, 0x000002DC, -+ 0x03C, 0x00000524, -+ 0x03C, 0x00000902, -+ 0xA0000000, 0x00000000, -+ 0x03C, 0x000002A8, -+ 0x03C, 0x000005A2, -+ 0x03C, 0x00000880, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000002, -+ 0x0DF, 0x00000080, -+ 0x80000008, 0x00000000, 0x40000000, 0x00000000, -+ 0x061, 0x000EAC43, -+ 0x062, 0x00038F47, -+ 0x063, 0x00031157, -+ 0x064, 0x0001C4AC, -+ 0x065, 0x000931D1, -+ 0x90000008, 0x05000000, 0x40000000, 0x00000000, -+ 0x061, 0x000EAC43, -+ 0x062, 0x00038F47, -+ 0x063, 0x00031157, -+ 0x064, 0x0001C4AC, -+ 0x065, 0x000931D2, -+ 0x90000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x061, 0x000EAC43, -+ 0x062, 0x00038F47, -+ 0x063, 0x00031157, -+ 0x064, 0x0001C4AC, -+ 0x065, 0x000931D1, -+ 0xA0000000, 0x00000000, -+ 0x061, 0x000E5D53, -+ 0x062, 0x00038FCD, -+ 0x063, 0x000114EB, -+ 0x064, 0x000196AC, -+ 0x065, 0x000911D7, -+ 0xB0000000, 0x00000000, -+ 0x008, 0x00008400, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_RadioB( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_RadioB)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_RadioB; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8812A_RadioB\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigRF_RadioB_8812A(pDM_Odm, v1, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8812A_RadioB(void) -+{ -+ return 55; -+} -+ -+/****************************************************************************** -+* TxPowerTrack_AP.TXT -+******************************************************************************/ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_AP_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_AP_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 17, 17, 18, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_AP_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 4, 4, 5, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 13, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_AP_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 7, 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 18, 19, 19, 19}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_AP_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_AP_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_AP_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_AP_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_AP_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_AP_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_AP_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_AP_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+#endif -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_AP( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8812A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE*3); -+#endif -+} -+ -+/****************************************************************************** -+* TxPowerTrack_PCIE.TXT -+******************************************************************************/ -+ -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13}, -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 13, 13}, -+ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 8, 9, 10, 11, 12, 12, 13, 14, 14, 14, 15, 16, 17, 17, 17, 18, 18, 18}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 13, 13, 13}, -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 11, 12, 12, 12, 12, 12, 13, 13}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 8, 8, 9, 10, 11, 12, 13, 14, 14, 15, 15, 15, 16, 16, 16, 17, 17, 18, 18}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+#endif -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_PCIE( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8812A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); -+#endif -+} -+ -+/****************************************************************************** -+* TxPowerTrack_RFE3.TXT -+******************************************************************************/ -+ -+u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_RFE3_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 12, 13, 13, 14, 15, 16, 16, 17, 17, 18, 18}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 12, 14, 13, 13, 14, 14, 14, 15, 15}, -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 15, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_RFE3_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_RFE3_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 13, 14, 15, 16, 16, 17, 17, 18, 18}, -+ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 16, 16, 17, 17}, -+ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 12, 13, 13, 14, 14, 15, 15, 16, 17, 18, 18}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_RFE3_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 2, 3, 4, 4, 5, 5, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 2, 3, 4, 4, 5, 5, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_RFE3_8812A[] = {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_RFE3_8812A[] = {0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 9, 10, 10, 10, 10, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_RFE3_8812A[] = {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 10, 11, 11, 12, 12, 13, 13, 13, 13, 14, 14, 15, 15}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_RFE3_8812A[] = {0, 0, 1, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_RFE3_8812A[] = {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_RFE3_8812A[] = {0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 9, 10, 10, 10, 10, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_RFE3_8812A[] = {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 10, 11, 11, 12, 12, 13, 13, 13, 13, 14, 14, 15, 15}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_RFE3_8812A[] = {0, 0, 1, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_RFE3( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8812A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_RFE3_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_RFE3_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_RFE3_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_RFE3_8812A, DELTA_SWINGIDX_SIZE*3); -+} -+ -+/****************************************************************************** -+* TxPowerTrack_RFE4.TXT -+******************************************************************************/ -+ -+u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_RFE4_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13}, -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 13, 13}, -+ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 8, 9, 10, 11, 12, 12, 13, 14, 14, 14, 15, 16, 17, 17, 17, 18, 18, 18}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_RFE4_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_RFE4_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 13, 13, 13}, -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 11, 12, 12, 12, 12, 12, 13, 13}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 8, 8, 9, 10, 11, 12, 13, 14, 14, 15, 15, 15, 16, 16, 16, 17, 17, 18, 18}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_RFE4_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_RFE4_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_RFE4_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_RFE4_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_RFE4_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_RFE4_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_RFE4_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_RFE4_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_RFE4_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_RFE4( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8812A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_RFE4_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_RFE4_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_RFE4_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_RFE4_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_RFE4_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_RFE4_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_RFE4_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_RFE4_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_RFE4_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_RFE4_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_RFE4_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_RFE4_8812A, DELTA_SWINGIDX_SIZE*3); -+} -+ -+/****************************************************************************** -+* TxPowerTrack_USB.TXT -+******************************************************************************/ -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 1, 2, 2, 3, 4, 4, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 8, 8, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 12, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+#endif -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_USB( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8812A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE*3); -+#endif -+} -+ -+/****************************************************************************** -+* TXPWR_LMT.TXT -+******************************************************************************/ -+ -+const char *Array_MP_8812A_TXPWR_LMT[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "104", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "104", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "104", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "32", -+ "MKK", "5G", "20M", "HT", "1T", "36", "32", -+ "FCC", "5G", "20M", "HT", "1T", "40", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "32", -+ "MKK", "5G", "20M", "HT", "1T", "40", "32", -+ "FCC", "5G", "20M", "HT", "1T", "44", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "32", -+ "MKK", "5G", "20M", "HT", "1T", "44", "32", -+ "FCC", "5G", "20M", "HT", "1T", "48", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "32", -+ "MKK", "5G", "20M", "HT", "1T", "48", "32", -+ "FCC", "5G", "20M", "HT", "1T", "52", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "32", -+ "MKK", "5G", "20M", "HT", "1T", "52", "32", -+ "FCC", "5G", "20M", "HT", "1T", "56", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "32", -+ "MKK", "5G", "20M", "HT", "1T", "56", "32", -+ "FCC", "5G", "20M", "HT", "1T", "60", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "32", -+ "MKK", "5G", "20M", "HT", "1T", "60", "32", -+ "FCC", "5G", "20M", "HT", "1T", "64", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "32", -+ "MKK", "5G", "20M", "HT", "1T", "64", "32", -+ "FCC", "5G", "20M", "HT", "1T", "100", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "32", -+ "MKK", "5G", "20M", "HT", "1T", "100", "32", -+ "FCC", "5G", "20M", "HT", "1T", "104", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "104", "32", -+ "MKK", "5G", "20M", "HT", "1T", "104", "32", -+ "FCC", "5G", "20M", "HT", "1T", "108", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "32", -+ "MKK", "5G", "20M", "HT", "1T", "108", "32", -+ "FCC", "5G", "20M", "HT", "1T", "112", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "32", -+ "MKK", "5G", "20M", "HT", "1T", "112", "32", -+ "FCC", "5G", "20M", "HT", "1T", "116", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "32", -+ "MKK", "5G", "20M", "HT", "1T", "116", "32", -+ "FCC", "5G", "20M", "HT", "1T", "120", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "32", -+ "MKK", "5G", "20M", "HT", "1T", "120", "32", -+ "FCC", "5G", "20M", "HT", "1T", "124", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "32", -+ "MKK", "5G", "20M", "HT", "1T", "124", "32", -+ "FCC", "5G", "20M", "HT", "1T", "128", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "32", -+ "MKK", "5G", "20M", "HT", "1T", "128", "32", -+ "FCC", "5G", "20M", "HT", "1T", "132", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "32", -+ "MKK", "5G", "20M", "HT", "1T", "132", "32", -+ "FCC", "5G", "20M", "HT", "1T", "136", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "32", -+ "MKK", "5G", "20M", "HT", "1T", "136", "32", -+ "FCC", "5G", "20M", "HT", "1T", "140", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "32", -+ "MKK", "5G", "20M", "HT", "1T", "140", "32", -+ "FCC", "5G", "20M", "HT", "1T", "149", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "32", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "32", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "32", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "32", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "32", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "30", -+ "MKK", "5G", "20M", "HT", "2T", "36", "30", -+ "FCC", "5G", "20M", "HT", "2T", "40", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "30", -+ "MKK", "5G", "20M", "HT", "2T", "40", "30", -+ "FCC", "5G", "20M", "HT", "2T", "44", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "30", -+ "MKK", "5G", "20M", "HT", "2T", "44", "30", -+ "FCC", "5G", "20M", "HT", "2T", "48", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "30", -+ "MKK", "5G", "20M", "HT", "2T", "48", "30", -+ "FCC", "5G", "20M", "HT", "2T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "30", -+ "MKK", "5G", "20M", "HT", "2T", "52", "30", -+ "FCC", "5G", "20M", "HT", "2T", "56", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "30", -+ "MKK", "5G", "20M", "HT", "2T", "56", "30", -+ "FCC", "5G", "20M", "HT", "2T", "60", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "30", -+ "MKK", "5G", "20M", "HT", "2T", "60", "30", -+ "FCC", "5G", "20M", "HT", "2T", "64", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "30", -+ "MKK", "5G", "20M", "HT", "2T", "64", "30", -+ "FCC", "5G", "20M", "HT", "2T", "100", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "30", -+ "MKK", "5G", "20M", "HT", "2T", "100", "30", -+ "FCC", "5G", "20M", "HT", "2T", "104", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "104", "30", -+ "MKK", "5G", "20M", "HT", "2T", "104", "30", -+ "FCC", "5G", "20M", "HT", "2T", "108", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "30", -+ "MKK", "5G", "20M", "HT", "2T", "108", "30", -+ "FCC", "5G", "20M", "HT", "2T", "112", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "30", -+ "MKK", "5G", "20M", "HT", "2T", "112", "30", -+ "FCC", "5G", "20M", "HT", "2T", "116", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "30", -+ "MKK", "5G", "20M", "HT", "2T", "116", "30", -+ "FCC", "5G", "20M", "HT", "2T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "30", -+ "MKK", "5G", "20M", "HT", "2T", "120", "30", -+ "FCC", "5G", "20M", "HT", "2T", "124", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "30", -+ "MKK", "5G", "20M", "HT", "2T", "124", "30", -+ "FCC", "5G", "20M", "HT", "2T", "128", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "30", -+ "MKK", "5G", "20M", "HT", "2T", "128", "30", -+ "FCC", "5G", "20M", "HT", "2T", "132", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "30", -+ "MKK", "5G", "20M", "HT", "2T", "132", "30", -+ "FCC", "5G", "20M", "HT", "2T", "136", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "30", -+ "MKK", "5G", "20M", "HT", "2T", "136", "30", -+ "FCC", "5G", "20M", "HT", "2T", "140", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "30", -+ "MKK", "5G", "20M", "HT", "2T", "140", "30", -+ "FCC", "5G", "20M", "HT", "2T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "30", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "30", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "30", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "30", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "30", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "32", -+ "MKK", "5G", "40M", "HT", "1T", "38", "32", -+ "FCC", "5G", "40M", "HT", "1T", "46", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "32", -+ "MKK", "5G", "40M", "HT", "1T", "46", "32", -+ "FCC", "5G", "40M", "HT", "1T", "54", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "32", -+ "MKK", "5G", "40M", "HT", "1T", "54", "32", -+ "FCC", "5G", "40M", "HT", "1T", "62", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "32", -+ "MKK", "5G", "40M", "HT", "1T", "62", "32", -+ "FCC", "5G", "40M", "HT", "1T", "102", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "32", -+ "MKK", "5G", "40M", "HT", "1T", "102", "32", -+ "FCC", "5G", "40M", "HT", "1T", "110", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "32", -+ "MKK", "5G", "40M", "HT", "1T", "110", "32", -+ "FCC", "5G", "40M", "HT", "1T", "118", "36", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "32", -+ "MKK", "5G", "40M", "HT", "1T", "118", "32", -+ "FCC", "5G", "40M", "HT", "1T", "126", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "32", -+ "MKK", "5G", "40M", "HT", "1T", "126", "32", -+ "FCC", "5G", "40M", "HT", "1T", "134", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "32", -+ "MKK", "5G", "40M", "HT", "1T", "134", "32", -+ "FCC", "5G", "40M", "HT", "1T", "151", "36", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "32", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "36", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "32", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "30", -+ "MKK", "5G", "40M", "HT", "2T", "38", "30", -+ "FCC", "5G", "40M", "HT", "2T", "46", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "30", -+ "MKK", "5G", "40M", "HT", "2T", "46", "30", -+ "FCC", "5G", "40M", "HT", "2T", "54", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "30", -+ "MKK", "5G", "40M", "HT", "2T", "54", "30", -+ "FCC", "5G", "40M", "HT", "2T", "62", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "30", -+ "MKK", "5G", "40M", "HT", "2T", "62", "30", -+ "FCC", "5G", "40M", "HT", "2T", "102", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "30", -+ "MKK", "5G", "40M", "HT", "2T", "102", "30", -+ "FCC", "5G", "40M", "HT", "2T", "110", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "30", -+ "MKK", "5G", "40M", "HT", "2T", "110", "30", -+ "FCC", "5G", "40M", "HT", "2T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "30", -+ "MKK", "5G", "40M", "HT", "2T", "118", "30", -+ "FCC", "5G", "40M", "HT", "2T", "126", "32", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "30", -+ "MKK", "5G", "40M", "HT", "2T", "126", "30", -+ "FCC", "5G", "40M", "HT", "2T", "134", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "30", -+ "MKK", "5G", "40M", "HT", "2T", "134", "30", -+ "FCC", "5G", "40M", "HT", "2T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "30", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "30", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "28", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "36", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "32", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_TXPWR_LMT( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_TXPWR_LMT)/sizeof(pu1Byte); -+ pu1Byte *Array = (pu1Byte *)Array_MP_8812A_TXPWR_LMT; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrLmt = ArrayLen/7; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8812A_TXPWR_LMT\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7) { -+ pu1Byte regulation = Array[i]; -+ pu1Byte band = Array[i+1]; -+ pu1Byte bandwidth = Array[i+2]; -+ pu1Byte rate = Array[i+3]; -+ pu1Byte rfPath = Array[i+4]; -+ pu1Byte chnl = Array[i+5]; -+ pu1Byte val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8812A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf(pHalData->BufOfLinesPwrLmt[i/7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", -+ regulation, band, bandwidth, rate, rfPath, chnl, val); -+#endif -+ } -+ -+} -+ -+/****************************************************************************** -+* TXPWR_LMT_HM812A03.TXT -+******************************************************************************/ -+ -+const char *Array_MP_8812A_TXPWR_LMT_HM812A03[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "30", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "36", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "36", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "36", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "36", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "36", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "36", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "36", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "36", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "36", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "36", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "36", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "36", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "36", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "28", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "36", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "36", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "36", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "36", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "36", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "36", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "36", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "36", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "36", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "28", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "30", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "30", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "30", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "30", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "30", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "24", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "26", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "36", -+ "FCC", "5G", "20M", "OFDM", "1T", "104", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "104", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "104", "36", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "36", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "36", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "36", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "63", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "36", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "63", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "36", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "63", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "36", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "36", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "36", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "63", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "63", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "63", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "63", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "63", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "32", -+ "MKK", "5G", "20M", "HT", "1T", "36", "32", -+ "FCC", "5G", "20M", "HT", "1T", "40", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "32", -+ "MKK", "5G", "20M", "HT", "1T", "40", "32", -+ "FCC", "5G", "20M", "HT", "1T", "44", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "32", -+ "MKK", "5G", "20M", "HT", "1T", "44", "32", -+ "FCC", "5G", "20M", "HT", "1T", "48", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "32", -+ "MKK", "5G", "20M", "HT", "1T", "48", "32", -+ "FCC", "5G", "20M", "HT", "1T", "52", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "32", -+ "MKK", "5G", "20M", "HT", "1T", "52", "32", -+ "FCC", "5G", "20M", "HT", "1T", "56", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "32", -+ "MKK", "5G", "20M", "HT", "1T", "56", "32", -+ "FCC", "5G", "20M", "HT", "1T", "60", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "32", -+ "MKK", "5G", "20M", "HT", "1T", "60", "32", -+ "FCC", "5G", "20M", "HT", "1T", "64", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "32", -+ "MKK", "5G", "20M", "HT", "1T", "64", "32", -+ "FCC", "5G", "20M", "HT", "1T", "100", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "32", -+ "MKK", "5G", "20M", "HT", "1T", "100", "36", -+ "FCC", "5G", "20M", "HT", "1T", "104", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "104", "32", -+ "MKK", "5G", "20M", "HT", "1T", "104", "36", -+ "FCC", "5G", "20M", "HT", "1T", "108", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "32", -+ "MKK", "5G", "20M", "HT", "1T", "108", "36", -+ "FCC", "5G", "20M", "HT", "1T", "112", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "32", -+ "MKK", "5G", "20M", "HT", "1T", "112", "36", -+ "FCC", "5G", "20M", "HT", "1T", "116", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "32", -+ "MKK", "5G", "20M", "HT", "1T", "116", "36", -+ "FCC", "5G", "20M", "HT", "1T", "120", "63", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "32", -+ "MKK", "5G", "20M", "HT", "1T", "120", "36", -+ "FCC", "5G", "20M", "HT", "1T", "124", "63", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "32", -+ "MKK", "5G", "20M", "HT", "1T", "124", "36", -+ "FCC", "5G", "20M", "HT", "1T", "128", "63", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "32", -+ "MKK", "5G", "20M", "HT", "1T", "128", "36", -+ "FCC", "5G", "20M", "HT", "1T", "132", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "32", -+ "MKK", "5G", "20M", "HT", "1T", "132", "36", -+ "FCC", "5G", "20M", "HT", "1T", "136", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "32", -+ "MKK", "5G", "20M", "HT", "1T", "136", "36", -+ "FCC", "5G", "20M", "HT", "1T", "140", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "32", -+ "MKK", "5G", "20M", "HT", "1T", "140", "32", -+ "FCC", "5G", "20M", "HT", "1T", "149", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "63", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "63", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "63", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "63", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "63", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "22", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "26", -+ "MKK", "5G", "20M", "HT", "2T", "36", "26", -+ "FCC", "5G", "20M", "HT", "2T", "40", "22", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "26", -+ "MKK", "5G", "20M", "HT", "2T", "40", "26", -+ "FCC", "5G", "20M", "HT", "2T", "44", "22", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "26", -+ "MKK", "5G", "20M", "HT", "2T", "44", "26", -+ "FCC", "5G", "20M", "HT", "2T", "48", "22", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "26", -+ "MKK", "5G", "20M", "HT", "2T", "48", "26", -+ "FCC", "5G", "20M", "HT", "2T", "52", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "26", -+ "MKK", "5G", "20M", "HT", "2T", "52", "26", -+ "FCC", "5G", "20M", "HT", "2T", "56", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "26", -+ "MKK", "5G", "20M", "HT", "2T", "56", "26", -+ "FCC", "5G", "20M", "HT", "2T", "60", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "26", -+ "MKK", "5G", "20M", "HT", "2T", "60", "26", -+ "FCC", "5G", "20M", "HT", "2T", "64", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "26", -+ "MKK", "5G", "20M", "HT", "2T", "64", "26", -+ "FCC", "5G", "20M", "HT", "2T", "100", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "26", -+ "MKK", "5G", "20M", "HT", "2T", "100", "34", -+ "FCC", "5G", "20M", "HT", "2T", "104", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "104", "26", -+ "MKK", "5G", "20M", "HT", "2T", "104", "34", -+ "FCC", "5G", "20M", "HT", "2T", "108", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "26", -+ "MKK", "5G", "20M", "HT", "2T", "108", "34", -+ "FCC", "5G", "20M", "HT", "2T", "112", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "26", -+ "MKK", "5G", "20M", "HT", "2T", "112", "34", -+ "FCC", "5G", "20M", "HT", "2T", "116", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "26", -+ "MKK", "5G", "20M", "HT", "2T", "116", "34", -+ "FCC", "5G", "20M", "HT", "2T", "120", "63", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "26", -+ "MKK", "5G", "20M", "HT", "2T", "120", "34", -+ "FCC", "5G", "20M", "HT", "2T", "124", "63", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "26", -+ "MKK", "5G", "20M", "HT", "2T", "124", "34", -+ "FCC", "5G", "20M", "HT", "2T", "128", "63", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "26", -+ "MKK", "5G", "20M", "HT", "2T", "128", "34", -+ "FCC", "5G", "20M", "HT", "2T", "132", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "26", -+ "MKK", "5G", "20M", "HT", "2T", "132", "34", -+ "FCC", "5G", "20M", "HT", "2T", "136", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "26", -+ "MKK", "5G", "20M", "HT", "2T", "136", "34", -+ "FCC", "5G", "20M", "HT", "2T", "140", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "26", -+ "MKK", "5G", "20M", "HT", "2T", "140", "34", -+ "FCC", "5G", "20M", "HT", "2T", "149", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "63", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "63", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "63", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "63", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "36", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "63", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "20", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "32", -+ "MKK", "5G", "40M", "HT", "1T", "38", "34", -+ "FCC", "5G", "40M", "HT", "1T", "46", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "32", -+ "MKK", "5G", "40M", "HT", "1T", "46", "34", -+ "FCC", "5G", "40M", "HT", "1T", "54", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "32", -+ "MKK", "5G", "40M", "HT", "1T", "54", "34", -+ "FCC", "5G", "40M", "HT", "1T", "62", "20", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "32", -+ "MKK", "5G", "40M", "HT", "1T", "62", "34", -+ "FCC", "5G", "40M", "HT", "1T", "102", "22", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "32", -+ "MKK", "5G", "40M", "HT", "1T", "102", "36", -+ "FCC", "5G", "40M", "HT", "1T", "110", "36", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "32", -+ "MKK", "5G", "40M", "HT", "1T", "110", "34", -+ "FCC", "5G", "40M", "HT", "1T", "118", "36", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "32", -+ "MKK", "5G", "40M", "HT", "1T", "118", "34", -+ "FCC", "5G", "40M", "HT", "1T", "126", "63", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "32", -+ "MKK", "5G", "40M", "HT", "1T", "126", "34", -+ "FCC", "5G", "40M", "HT", "1T", "134", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "32", -+ "MKK", "5G", "40M", "HT", "1T", "134", "34", -+ "FCC", "5G", "40M", "HT", "1T", "151", "36", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "63", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "36", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "63", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "20", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "26", -+ "MKK", "5G", "40M", "HT", "2T", "38", "26", -+ "FCC", "5G", "40M", "HT", "2T", "46", "22", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "26", -+ "MKK", "5G", "40M", "HT", "2T", "46", "26", -+ "FCC", "5G", "40M", "HT", "2T", "54", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "26", -+ "MKK", "5G", "40M", "HT", "2T", "54", "26", -+ "FCC", "5G", "40M", "HT", "2T", "62", "20", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "26", -+ "MKK", "5G", "40M", "HT", "2T", "62", "26", -+ "FCC", "5G", "40M", "HT", "2T", "102", "22", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "26", -+ "MKK", "5G", "40M", "HT", "2T", "102", "36", -+ "FCC", "5G", "40M", "HT", "2T", "110", "36", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "26", -+ "MKK", "5G", "40M", "HT", "2T", "110", "34", -+ "FCC", "5G", "40M", "HT", "2T", "118", "36", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "26", -+ "MKK", "5G", "40M", "HT", "2T", "118", "34", -+ "FCC", "5G", "40M", "HT", "2T", "126", "63", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "26", -+ "MKK", "5G", "40M", "HT", "2T", "126", "34", -+ "FCC", "5G", "40M", "HT", "2T", "134", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "26", -+ "MKK", "5G", "40M", "HT", "2T", "134", "34", -+ "FCC", "5G", "40M", "HT", "2T", "151", "36", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "63", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "36", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "63", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "20", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "16", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "22", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "63", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "36", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "63", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "18", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "26", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "28", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "16", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "26", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "28", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "22", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "26", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "32", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "63", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "26", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "32", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "36", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "63", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_TXPWR_LMT_HM812A03( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_TXPWR_LMT_HM812A03)/sizeof(pu1Byte); -+ pu1Byte *Array = (pu1Byte *)Array_MP_8812A_TXPWR_LMT_HM812A03; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrLmt = ArrayLen/7; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8812A_TXPWR_LMT_HM812A03\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7) { -+ pu1Byte regulation = Array[i]; -+ pu1Byte band = Array[i+1]; -+ pu1Byte bandwidth = Array[i+2]; -+ pu1Byte rate = Array[i+3]; -+ pu1Byte rfPath = Array[i+4]; -+ pu1Byte chnl = Array[i+5]; -+ pu1Byte val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8812A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf(pHalData->BufOfLinesPwrLmt[i/7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", -+ regulation, band, bandwidth, rate, rfPath, chnl, val); -+#endif -+ } -+ -+} -+ -+/****************************************************************************** -+* TXPWR_LMT_NFA812A00.TXT -+******************************************************************************/ -+ -+const char *Array_MP_8812A_TXPWR_LMT_NFA812A00[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "36", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "36", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "34", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "34", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "34", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "34", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "34", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "34", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "34", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "34", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "34", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "34", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "34", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "34", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "34", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "30", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "34", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "34", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "34", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "34", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "34", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "34", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "34", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "34", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "34", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "34", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "34", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "34", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "30", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "34", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "28", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "24", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "34", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "28", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "28", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "28", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "28", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "28", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "34", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "24", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "26", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "24", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "34", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "34", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "34", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "34", -+ "FCC", "5G", "20M", "OFDM", "1T", "114", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "114", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "114", "34", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "34", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "34", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "34", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "63", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "34", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "63", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "34", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "63", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "34", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "34", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "34", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "34", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "63", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "63", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "63", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "63", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "63", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "32", -+ "MKK", "5G", "20M", "HT", "1T", "36", "34", -+ "FCC", "5G", "20M", "HT", "1T", "40", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "32", -+ "MKK", "5G", "20M", "HT", "1T", "40", "34", -+ "FCC", "5G", "20M", "HT", "1T", "44", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "32", -+ "MKK", "5G", "20M", "HT", "1T", "44", "32", -+ "FCC", "5G", "20M", "HT", "1T", "48", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "32", -+ "MKK", "5G", "20M", "HT", "1T", "48", "32", -+ "FCC", "5G", "20M", "HT", "1T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "32", -+ "MKK", "5G", "20M", "HT", "1T", "52", "32", -+ "FCC", "5G", "20M", "HT", "1T", "56", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "32", -+ "MKK", "5G", "20M", "HT", "1T", "56", "32", -+ "FCC", "5G", "20M", "HT", "1T", "60", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "32", -+ "MKK", "5G", "20M", "HT", "1T", "60", "32", -+ "FCC", "5G", "20M", "HT", "1T", "64", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "32", -+ "MKK", "5G", "20M", "HT", "1T", "64", "32", -+ "FCC", "5G", "20M", "HT", "1T", "100", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "32", -+ "MKK", "5G", "20M", "HT", "1T", "100", "34", -+ "FCC", "5G", "20M", "HT", "1T", "114", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "114", "32", -+ "MKK", "5G", "20M", "HT", "1T", "114", "34", -+ "FCC", "5G", "20M", "HT", "1T", "108", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "32", -+ "MKK", "5G", "20M", "HT", "1T", "108", "34", -+ "FCC", "5G", "20M", "HT", "1T", "112", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "32", -+ "MKK", "5G", "20M", "HT", "1T", "112", "34", -+ "FCC", "5G", "20M", "HT", "1T", "116", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "32", -+ "MKK", "5G", "20M", "HT", "1T", "116", "34", -+ "FCC", "5G", "20M", "HT", "1T", "120", "63", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "32", -+ "MKK", "5G", "20M", "HT", "1T", "120", "34", -+ "FCC", "5G", "20M", "HT", "1T", "124", "63", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "32", -+ "MKK", "5G", "20M", "HT", "1T", "124", "34", -+ "FCC", "5G", "20M", "HT", "1T", "128", "63", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "32", -+ "MKK", "5G", "20M", "HT", "1T", "128", "34", -+ "FCC", "5G", "20M", "HT", "1T", "132", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "32", -+ "MKK", "5G", "20M", "HT", "1T", "132", "34", -+ "FCC", "5G", "20M", "HT", "1T", "136", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "32", -+ "MKK", "5G", "20M", "HT", "1T", "136", "34", -+ "FCC", "5G", "20M", "HT", "1T", "140", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "32", -+ "MKK", "5G", "20M", "HT", "1T", "140", "34", -+ "FCC", "5G", "20M", "HT", "1T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "63", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "63", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "63", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "63", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "63", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "26", -+ "MKK", "5G", "20M", "HT", "2T", "36", "28", -+ "FCC", "5G", "20M", "HT", "2T", "40", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "26", -+ "MKK", "5G", "20M", "HT", "2T", "40", "28", -+ "FCC", "5G", "20M", "HT", "2T", "44", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "26", -+ "MKK", "5G", "20M", "HT", "2T", "44", "28", -+ "FCC", "5G", "20M", "HT", "2T", "48", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "26", -+ "MKK", "5G", "20M", "HT", "2T", "48", "28", -+ "FCC", "5G", "20M", "HT", "2T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "26", -+ "MKK", "5G", "20M", "HT", "2T", "52", "28", -+ "FCC", "5G", "20M", "HT", "2T", "56", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "26", -+ "MKK", "5G", "20M", "HT", "2T", "56", "28", -+ "FCC", "5G", "20M", "HT", "2T", "60", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "26", -+ "MKK", "5G", "20M", "HT", "2T", "60", "28", -+ "FCC", "5G", "20M", "HT", "2T", "64", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "26", -+ "MKK", "5G", "20M", "HT", "2T", "64", "28", -+ "FCC", "5G", "20M", "HT", "2T", "100", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "26", -+ "MKK", "5G", "20M", "HT", "2T", "100", "34", -+ "FCC", "5G", "20M", "HT", "2T", "114", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "114", "26", -+ "MKK", "5G", "20M", "HT", "2T", "114", "34", -+ "FCC", "5G", "20M", "HT", "2T", "108", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "26", -+ "MKK", "5G", "20M", "HT", "2T", "108", "34", -+ "FCC", "5G", "20M", "HT", "2T", "112", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "26", -+ "MKK", "5G", "20M", "HT", "2T", "112", "34", -+ "FCC", "5G", "20M", "HT", "2T", "116", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "26", -+ "MKK", "5G", "20M", "HT", "2T", "116", "34", -+ "FCC", "5G", "20M", "HT", "2T", "120", "63", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "26", -+ "MKK", "5G", "20M", "HT", "2T", "120", "34", -+ "FCC", "5G", "20M", "HT", "2T", "124", "63", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "26", -+ "MKK", "5G", "20M", "HT", "2T", "124", "34", -+ "FCC", "5G", "20M", "HT", "2T", "128", "63", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "26", -+ "MKK", "5G", "20M", "HT", "2T", "128", "34", -+ "FCC", "5G", "20M", "HT", "2T", "132", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "26", -+ "MKK", "5G", "20M", "HT", "2T", "132", "34", -+ "FCC", "5G", "20M", "HT", "2T", "136", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "26", -+ "MKK", "5G", "20M", "HT", "2T", "136", "34", -+ "FCC", "5G", "20M", "HT", "2T", "140", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "26", -+ "MKK", "5G", "20M", "HT", "2T", "140", "34", -+ "FCC", "5G", "20M", "HT", "2T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "63", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "63", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "63", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "63", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "63", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "32", -+ "MKK", "5G", "40M", "HT", "1T", "38", "34", -+ "FCC", "5G", "40M", "HT", "1T", "46", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "32", -+ "MKK", "5G", "40M", "HT", "1T", "46", "34", -+ "FCC", "5G", "40M", "HT", "1T", "54", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "32", -+ "MKK", "5G", "40M", "HT", "1T", "54", "34", -+ "FCC", "5G", "40M", "HT", "1T", "62", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "32", -+ "MKK", "5G", "40M", "HT", "1T", "62", "34", -+ "FCC", "5G", "40M", "HT", "1T", "102", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "32", -+ "MKK", "5G", "40M", "HT", "1T", "102", "34", -+ "FCC", "5G", "40M", "HT", "1T", "110", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "32", -+ "MKK", "5G", "40M", "HT", "1T", "110", "34", -+ "FCC", "5G", "40M", "HT", "1T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "32", -+ "MKK", "5G", "40M", "HT", "1T", "118", "34", -+ "FCC", "5G", "40M", "HT", "1T", "126", "63", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "32", -+ "MKK", "5G", "40M", "HT", "1T", "126", "34", -+ "FCC", "5G", "40M", "HT", "1T", "134", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "32", -+ "MKK", "5G", "40M", "HT", "1T", "134", "34", -+ "FCC", "5G", "40M", "HT", "1T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "63", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "63", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "26", -+ "MKK", "5G", "40M", "HT", "2T", "38", "28", -+ "FCC", "5G", "40M", "HT", "2T", "46", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "26", -+ "MKK", "5G", "40M", "HT", "2T", "46", "28", -+ "FCC", "5G", "40M", "HT", "2T", "54", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "26", -+ "MKK", "5G", "40M", "HT", "2T", "54", "28", -+ "FCC", "5G", "40M", "HT", "2T", "62", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "26", -+ "MKK", "5G", "40M", "HT", "2T", "62", "28", -+ "FCC", "5G", "40M", "HT", "2T", "102", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "26", -+ "MKK", "5G", "40M", "HT", "2T", "102", "34", -+ "FCC", "5G", "40M", "HT", "2T", "110", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "26", -+ "MKK", "5G", "40M", "HT", "2T", "110", "34", -+ "FCC", "5G", "40M", "HT", "2T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "26", -+ "MKK", "5G", "40M", "HT", "2T", "118", "34", -+ "FCC", "5G", "40M", "HT", "2T", "126", "63", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "26", -+ "MKK", "5G", "40M", "HT", "2T", "126", "34", -+ "FCC", "5G", "40M", "HT", "2T", "134", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "26", -+ "MKK", "5G", "40M", "HT", "2T", "134", "34", -+ "FCC", "5G", "40M", "HT", "2T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "63", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "63", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "24", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "32", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "26", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "34", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "63", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "34", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "63", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "24", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "26", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "24", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "30", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "26", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "26", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "26", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "34", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "63", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "26", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "34", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "63", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_TXPWR_LMT_NFA812A00( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_TXPWR_LMT_NFA812A00)/sizeof(pu1Byte); -+ pu1Byte *Array = (pu1Byte *)Array_MP_8812A_TXPWR_LMT_NFA812A00; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrLmt = ArrayLen/7; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8812A_TXPWR_LMT_NFA812A00\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7) { -+ pu1Byte regulation = Array[i]; -+ pu1Byte band = Array[i+1]; -+ pu1Byte bandwidth = Array[i+2]; -+ pu1Byte rate = Array[i+3]; -+ pu1Byte rfPath = Array[i+4]; -+ pu1Byte chnl = Array[i+5]; -+ pu1Byte val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8812A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf(pHalData->BufOfLinesPwrLmt[i/7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", -+ regulation, band, bandwidth, rate, rfPath, chnl, val); -+#endif -+ } -+ -+} -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_rf.h linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_rf.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halhwimg8812a_rf.h 2017-06-07 23:07:21.023688669 +0300 -@@ -0,0 +1,129 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.14*/ -+#if (RTL8812A_SUPPORT == 1) -+#ifndef __INC_MP_RF_HW_IMG_8812A_H -+#define __INC_MP_RF_HW_IMG_8812A_H -+ -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_RadioA(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_RadioA(void); -+ -+/****************************************************************************** -+* RadioB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_RadioB(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_RadioB(void); -+ -+/****************************************************************************** -+* TxPowerTrack_AP.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_AP(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_TxPowerTrack_AP(void); -+ -+/****************************************************************************** -+* TxPowerTrack_PCIE.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_PCIE(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_TxPowerTrack_PCIE(void); -+ -+/****************************************************************************** -+* TxPowerTrack_RFE3.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_RFE3(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_TxPowerTrack_RFE3(void); -+ -+/****************************************************************************** -+* TxPowerTrack_RFE4.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_RFE4(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_TxPowerTrack_RFE4(void); -+ -+/****************************************************************************** -+* TxPowerTrack_USB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_USB(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_TxPowerTrack_USB(void); -+ -+/****************************************************************************** -+* TXPWR_LMT.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_TXPWR_LMT(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_TXPWR_LMT(void); -+ -+/****************************************************************************** -+* TXPWR_LMT_HM812A03.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_TXPWR_LMT_HM812A03(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_TXPWR_LMT_HM812A03(void); -+ -+/****************************************************************************** -+* TXPWR_LMT_NFA812A00.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_TXPWR_LMT_NFA812A00(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8812A_TXPWR_LMT_NFA812A00(void); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ap.c linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ap.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ap.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ap.c 2017-06-07 23:07:21.024688761 +0300 -@@ -0,0 +1,3710 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "../mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+// 2010/04/25 MH Define the max tx power tracking tx agc power. -+#define ODM_TXPWRTRACK_MAX_IDX8812A 6 -+ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+ -+//3============================================================ -+//3 Tx Power Tracking -+//3============================================================ -+ -+#if 0 -+ -+ -+ -+ //new element A = element D x X -+ -+ //new element C = element D x Y -+ -+ -+void DoIQK_8812A( -+ PVOID pDM_VOID, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+#endif -+ -+ ODM_ResetIQKResult(pDM_Odm); -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+#if USE_WORKITEM -+ PlatformAcquireMutex(&pHalData->mxChnlBwControl); -+#else -+ PlatformAcquireSpinLock(Adapter, RT_CHANNEL_AND_BANDWIDTH_SPINLOCK); -+#endif -+#elif((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+ PlatformAcquireMutex(&pHalData->mxChnlBwControl); -+#endif -+#endif -+ -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; -+ PHY_IQCalibrate_8812A(Adapter, FALSE); -+ -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+#if USE_WORKITEM -+ PlatformReleaseMutex(&pHalData->mxChnlBwControl); -+#else -+ PlatformReleaseSpinLock(Adapter, RT_CHANNEL_AND_BANDWIDTH_SPINLOCK); -+#endif -+#elif((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+ PlatformReleaseMutex(&pHalData->mxChnlBwControl); -+#endif -+#endif -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: odm_TxPwrTrackSetPwr88E() -+ * -+ * Overview: 88E change all channel tx power accordign to flag. -+ * OFDM & CCK are all different. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 04/23/2012 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+VOID -+ODM_TxPwrTrackSetPwr8812A( -+ PDM_ODM_T pDM_Odm, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ) -+{ -+ if (Method == TXAGC) -+ { -+ u1Byte cckPowerLevel[MAX_TX_COUNT], ofdmPowerLevel[MAX_TX_COUNT]; -+ u1Byte BW20PowerLevel[MAX_TX_COUNT], BW40PowerLevel[MAX_TX_COUNT]; -+ u1Byte rf = 0; -+ u4Byte pwr = 0, TxAGC = 0; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("odm_TxPwrTrackSetPwr88E CH=%d\n", *(pDM_Odm->pChannel))); -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE )) -+ -+ pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); -+ pwr += (pDM_Odm->BbSwingIdxCck - pDM_Odm->BbSwingIdxCckBase); -+ TxAGC = (pwr<<16)|(pwr<<8)|(pwr); -+ PHY_SetBBReg(Adapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, 0xffffff00, TxAGC); -+ RTPRINT(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr88E: CCK Tx-rf(A) Power = 0x%x\n", TxAGC)); -+ -+ pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); -+ pwr += (pDM_Odm->BbSwingIdxOfdm[RF_PATH_A] - pDM_Odm->BbSwingIdxOfdmBase); -+ TxAGC |= ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs11_Mcs08, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs15_Mcs12, bMaskDWord, TxAGC); -+ RTPRINT(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr88E: OFDM Tx-rf(A) Power = 0x%x\n", TxAGC)); -+#endif -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PHY_RF6052SetCCKTxPower(pDM_Odm->priv, *(pDM_Odm->pChannel)); -+ PHY_RF6052SetOFDMTxPower(pDM_Odm->priv, *(pDM_Odm->pChannel)); -+#endif -+ -+ } -+ else if (Method == BBSWING) -+ { -+ // Adjust BB swing by OFDM IQ matrix -+ if (RFPath == RF_PATH_A) -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, bMaskDWord, pDM_Odm->BbSwingIdxOfdm[RF_PATH_A]); -+ else if (RFPath == RF_PATH_B) -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, bMaskDWord, pDM_Odm->BbSwingIdxOfdm[RF_PATH_B]); -+ } -+ else -+ { -+ return; -+ } -+} // odm_TxPwrTrackSetPwr88E -+ -+void ConfigureTxpowerTrack_8812A( -+ PTXPWRTRACK_CFG pConfig -+ ) -+{ -+ pConfig->SwingTableSize_CCK = CCK_TABLE_SIZE; -+ pConfig->SwingTableSize_OFDM = OFDM_TABLE_SIZE; -+ pConfig->Threshold_IQK = 8; -+ pConfig->AverageThermalNum = AVG_THERMAL_NUM_8812A; -+ pConfig->RfPathCount = 2; -+ pConfig->ThermalRegAddr = RF_T_METER_8812A; -+ -+ pConfig->ODM_TxPwrTrackSetPwr = ODM_TxPwrTrackSetPwr8812A; -+ pConfig->DoIQK = DoIQK_8812A; -+ pConfig->PHY_LCCalibrate = PHY_LCCalibrate_8812A; -+} -+ -+#endif -+ -+//1 7. IQK -+#define MAX_TOLERANCE 5 -+#define IQK_DELAY_TIME 1 //ms -+ -+u1Byte //bit0 = 1 => Tx OK, bit1 = 1 => Rx OK -+ phy_PathA_IQK_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN configPathB -+ ) -+{ -+ u4Byte regEAC, regE94, regE9C, regEA4; -+ u1Byte result = 0x00; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A IQK!\n")); -+ -+ //1 Tx IQK -+ //path-A IQK setting -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-A IQK setting!\n")); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x10008c1c); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x30008c1c); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x8214032a); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28160000); -+ -+ //LO calibration setting -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x00462911); -+ -+ //One shot, path A LOK & IQK -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ // delay x ms -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_8812A)); -+ //PlatformStallExecution(IQK_DELAY_TIME_8812A*1000); -+ ODM_delay_ms(IQK_DELAY_TIME_8812A); -+ -+ // Check failed -+ regEAC = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", regEAC)); -+ regE94 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x\n", regE94)); -+ regE9C= ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe9c = 0x%x\n", regE9C)); -+ regEA4= ODM_GetBBReg(pDM_Odm, rRx_Power_Before_IQK_A_2, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xea4 = 0x%x\n", regEA4)); -+ -+ if(!(regEAC & BIT28) && -+ (((regE94 & 0x03FF0000)>>16) != 0x142) && -+ (((regE9C & 0x03FF0000)>>16) != 0x42) ) -+ result |= 0x01; -+ else //if Tx not OK, ignore Rx -+ return result; -+ -+#if 0 -+ if(!(regEAC & BIT27) && //if Tx is OK, check whether Rx is OK -+ (((regEA4 & 0x03FF0000)>>16) != 0x132) && -+ (((regEAC & 0x03FF0000)>>16) != 0x36)) -+ result |= 0x02; -+ else -+ RTPRINT(FINIT, INIT_IQK, ("Path A Rx IQK fail!!\n")); -+#endif -+ -+ return result; -+ -+ -+} -+ -+u1Byte //bit0 = 1 => Tx OK, bit1 = 1 => Rx OK -+ phy_PathA_RxIQK_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN configPathB -+ ) -+{ -+ u4Byte regEAC, regE94, regE9C, regEA4, u4tmp; -+ u1Byte result = 0x00; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A Rx IQK!\n")); -+ -+ //1 Get TXIMR setting -+ //modify RXIQK mode table -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-A Rx IQK modify RXIQK mode table!\n")); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_WE_LUT, bRFRegOffsetMask, 0x800a0 ); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_RCK_OS, bRFRegOffsetMask, 0x30000 ); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_TXPA_G1, bRFRegOffsetMask, 0x0000f ); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_TXPA_G2, bRFRegOffsetMask, 0xf117B ); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+ -+ //IQK setting -+ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x81004800); -+ -+ //path-A IQK setting -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x10008c1c); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x30008c1c); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82160804); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28160000); -+ -+ //LO calibration setting -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a911); -+ -+ //One shot, path A LOK & IQK -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ // delay x ms -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_8812A)); -+ //PlatformStallExecution(IQK_DELAY_TIME_8812A*1000); -+ ODM_delay_ms(IQK_DELAY_TIME_8812A); -+ -+ -+ // Check failed -+ regEAC = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", regEAC)); -+ regE94 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x\n", regE94)); -+ regE9C= ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe9c = 0x%x\n", regE9C)); -+ -+ if(!(regEAC & BIT28) && -+ (((regE94 & 0x03FF0000)>>16) != 0x142) && -+ (((regE9C & 0x03FF0000)>>16) != 0x42) ) -+ result |= 0x01; -+ else //if Tx not OK, ignore Rx -+ return result; -+ -+ u4tmp = 0x80007C00 | (regE94&0x3FF0000) | ((regE9C&0x3FF0000) >> 16); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, u4tmp); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe40 = 0x%x u4tmp = 0x%x \n", ODM_GetBBReg(pDM_Odm, rTx_IQK, bMaskDWord), u4tmp)); -+ -+ -+ //1 RX IQK -+ //modify RXIQK mode table -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-A Rx IQK modify RXIQK mode table 2!\n")); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_WE_LUT, bRFRegOffsetMask, 0x800a0 ); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_RCK_OS, bRFRegOffsetMask, 0x30000 ); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_TXPA_G1, bRFRegOffsetMask, 0x0000f ); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_TXPA_G2, bRFRegOffsetMask, 0xf7ffa ); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+ -+ //IQK setting -+ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ //path-A IQK setting -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x30008c1c); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x10008c1c); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82160c05); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28160c05); -+ -+ //LO calibration setting -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a911); -+ -+ //One shot, path A LOK & IQK -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ // delay x ms -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_8812A)); -+ //PlatformStallExecution(IQK_DELAY_TIME_8812A*1000); -+ ODM_delay_ms(IQK_DELAY_TIME_8812A); -+ -+ // Check failed -+ regEAC = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", regEAC)); -+ regE94 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x\n", regE94)); -+ regE9C= ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe9c = 0x%x\n", regE9C)); -+ regEA4= ODM_GetBBReg(pDM_Odm, rRx_Power_Before_IQK_A_2, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xea4 = 0x%x\n", regEA4)); -+ -+#if 0 -+ if(!(regEAC & BIT28) && -+ (((regE94 & 0x03FF0000)>>16) != 0x142) && -+ (((regE9C & 0x03FF0000)>>16) != 0x42) ) -+ result |= 0x01; -+ else //if Tx not OK, ignore Rx -+ return result; -+#endif -+ -+ if(!(regEAC & BIT27) && //if Tx is OK, check whether Rx is OK -+ (((regEA4 & 0x03FF0000)>>16) != 0x132) && -+ (((regEAC & 0x03FF0000)>>16) != 0x36)) -+ result |= 0x02; -+ else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A Rx IQK fail!!\n")); -+ -+ return result; -+ -+ -+} -+ -+u1Byte //bit0 = 1 => Tx OK, bit1 = 1 => Rx OK -+ phy_PathB_IQK_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER pAdapter -+#endif -+ ) -+{ -+ u4Byte regEAC, regEB4, regEBC, regEC4, regECC; -+ u1Byte result = 0x00; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path B IQK!\n")); -+ -+ //One shot, path B LOK & IQK -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Cont, bMaskDWord, 0x00000002); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Cont, bMaskDWord, 0x00000000); -+ -+ // delay x ms -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay %d ms for One shot, path B LOK & IQK.\n", IQK_DELAY_TIME_8812A)); -+ //PlatformStallExecution(IQK_DELAY_TIME_8812A*1000); -+ ODM_delay_ms(IQK_DELAY_TIME_8812A); -+ -+ // Check failed -+ regEAC = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", regEAC)); -+ regEB4 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_B, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeb4 = 0x%x\n", regEB4)); -+ regEBC= ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_B, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xebc = 0x%x\n", regEBC)); -+ regEC4= ODM_GetBBReg(pDM_Odm, rRx_Power_Before_IQK_B_2, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xec4 = 0x%x\n", regEC4)); -+ regECC= ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_B_2, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xecc = 0x%x\n", regECC)); -+ -+ if(!(regEAC & BIT31) && -+ (((regEB4 & 0x03FF0000)>>16) != 0x142) && -+ (((regEBC & 0x03FF0000)>>16) != 0x42)) -+ result |= 0x01; -+ else -+ return result; -+ -+ if(!(regEAC & BIT30) && -+ (((regEC4 & 0x03FF0000)>>16) != 0x132) && -+ (((regECC & 0x03FF0000)>>16) != 0x36)) -+ result |= 0x02; -+ else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path B Rx IQK fail!!\n")); -+ -+ -+ return result; -+ -+} -+ -+VOID -+ _PHY_PathAFillIQKMatrix_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bIQKOK, -+ IN s4Byte result[][8], -+ IN u1Byte final_candidate, -+ IN BOOLEAN bTxOnly -+ ) -+{ -+ u4Byte Oldval_0, X, TX0_A, reg; -+ s4Byte Y, TX0_C; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path A IQ Calibration %s !\n",(bIQKOK)?"Success":"Failed")); -+ -+ if(final_candidate == 0xFF) -+ return; -+ -+ else if(bIQKOK) -+ { -+ Oldval_0 = (ODM_GetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord) >> 22) & 0x3FF; -+ -+ X = result[final_candidate][0]; -+ if ((X & 0x00000200) != 0) -+ X = X | 0xFFFFFC00; -+ TX0_A = (X * Oldval_0) >> 8; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX0_A = 0x%x, Oldval_0 0x%x\n", X, TX0_A, Oldval_0)); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, 0x3FF, TX0_A); -+ -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT(31), ((X* Oldval_0>>7) & 0x1)); -+ -+ Y = result[final_candidate][1]; -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ -+ -+ TX0_C = (Y * Oldval_0) >> 8; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX = 0x%x\n", (u4Byte)Y, (u4Byte)TX0_C)); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, 0xF0000000, ((TX0_C&0x3C0)>>6)); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, 0x003F0000, (TX0_C&0x3F)); -+ -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT(29), ((Y* Oldval_0>>7) & 0x1)); -+ -+ if(bTxOnly) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_PHY_PathAFillIQKMatrix_8812A only Tx OK\n")); -+ return; -+ } -+ -+ reg = result[final_candidate][2]; -+#if (DM_ODM_SUPPORT_TYPE==ODM_AP) -+ if( RTL_ABS(reg ,0x100) >= 16) -+ reg = 0x100; -+#endif -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XARxIQImbalance, 0x3FF, reg); -+ -+ reg = result[final_candidate][3] & 0x3F; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XARxIQImbalance, 0xFC00, reg); -+ -+ reg = (result[final_candidate][3] >> 6) & 0xF; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_RxIQExtAnta, 0xF0000000, reg); -+ } -+} -+ -+VOID -+ _PHY_PathBFillIQKMatrix_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bIQKOK, -+ IN s4Byte result[][8], -+ IN u1Byte final_candidate, -+ IN BOOLEAN bTxOnly //do Tx only -+ ) -+{ -+ u4Byte Oldval_1, X, TX1_A, reg; -+ s4Byte Y, TX1_C; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path B IQ Calibration %s !\n",(bIQKOK)?"Success":"Failed")); -+ -+ if(final_candidate == 0xFF) -+ return; -+ -+ else if(bIQKOK) -+ { -+ Oldval_1 = (ODM_GetBBReg(pDM_Odm, rOFDM0_XBTxIQImbalance, bMaskDWord) >> 22) & 0x3FF; -+ -+ X = result[final_candidate][4]; -+ if ((X & 0x00000200) != 0) -+ X = X | 0xFFFFFC00; -+ TX1_A = (X * Oldval_1) >> 8; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX1_A = 0x%x\n", X, TX1_A)); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XBTxIQImbalance, 0x3FF, TX1_A); -+ -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT(27), ((X* Oldval_1>>7) & 0x1)); -+ -+ Y = result[final_candidate][5]; -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ -+ TX1_C = (Y * Oldval_1) >> 8; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX1_C = 0x%x\n", (u4Byte)Y, (u4Byte)TX1_C)); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XDTxAFE, 0xF0000000, ((TX1_C&0x3C0)>>6)); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XBTxIQImbalance, 0x003F0000, (TX1_C&0x3F)); -+ -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT(25), ((Y* Oldval_1>>7) & 0x1)); -+ -+ if(bTxOnly) -+ return; -+ -+ reg = result[final_candidate][6]; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XBRxIQImbalance, 0x3FF, reg); -+ -+ reg = result[final_candidate][7] & 0x3F; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XBRxIQImbalance, 0xFC00, reg); -+ -+ reg = (result[final_candidate][7] >> 6) & 0xF; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_AGCRSSITable, 0x0000F000, reg); -+ } -+} -+ -+// -+// 2011/07/26 MH Add an API for testing IQK fail case. -+// -+// MP Already declare in odm.c -+#if 0 //!(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+BOOLEAN -+ODM_CheckPowerStatus( -+ IN PADAPTER Adapter) -+{ -+ /* -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ RT_RF_POWER_STATE rtState; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ -+ // 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. -+ if (pMgntInfo->init_adpt_in_progress == TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm,COMP_INIT, DBG_LOUD, ("ODM_CheckPowerStatus Return TRUE, due to initadapter")); -+ return TRUE; -+ } -+ -+ // -+ // 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. -+ // -+ Adapter->HalFunc.GetHwRegHandler(Adapter, HW_VAR_RF_STATE, (pu1Byte)(&rtState)); -+ if(Adapter->bDriverStopped || Adapter->bDriverIsGoingToPnpSetPowerSleep || rtState == eRfOff) -+ { -+ ODM_RT_TRACE(pDM_Odm,COMP_INIT, DBG_LOUD, ("ODM_CheckPowerStatus Return FALSE, due to %d/%d/%d\n", -+ Adapter->bDriverStopped, Adapter->bDriverIsGoingToPnpSetPowerSleep, rtState)); -+ return FALSE; -+ } -+ */ -+ return TRUE; -+} -+#endif -+ -+VOID -+ _PHY_SaveADDARegisters_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte ADDAReg, -+ IN pu4Byte ADDABackup, -+ IN u4Byte RegisterNum -+ ) -+{ -+ u4Byte i; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+ -+ if (ODM_CheckPowerStatus(pAdapter) == FALSE) -+ return; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Save ADDA parameters.\n")); -+ for( i = 0 ; i < RegisterNum ; i++){ -+ ADDABackup[i] = ODM_GetBBReg(pDM_Odm, ADDAReg[i], bMaskDWord); -+ } -+} -+ -+ -+VOID -+ _PHY_SaveMACRegisters_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte MACReg, -+ IN pu4Byte MACBackup -+ ) -+{ -+ u4Byte i; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Save MAC parameters.\n")); -+ for( i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++){ -+ MACBackup[i] = ODM_Read1Byte(pDM_Odm, MACReg[i]); -+ } -+ MACBackup[i] = ODM_Read4Byte(pDM_Odm, MACReg[i]); -+ -+} -+ -+ -+VOID -+ _PHY_ReloadADDARegisters_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte ADDAReg, -+ IN pu4Byte ADDABackup, -+ IN u4Byte RegiesterNum -+ ) -+{ -+ u4Byte i; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Reload ADDA power saving parameters !\n")); -+ for(i = 0 ; i < RegiesterNum; i++) -+ { -+ ODM_SetBBReg(pDM_Odm, ADDAReg[i], bMaskDWord, ADDABackup[i]); -+ } -+} -+ -+VOID -+ _PHY_ReloadMACRegisters_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte MACReg, -+ IN pu4Byte MACBackup -+ ) -+{ -+ u4Byte i; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Reload MAC parameters !\n")); -+ for(i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++){ -+ ODM_Write1Byte(pDM_Odm, MACReg[i], (u1Byte)MACBackup[i]); -+ } -+ ODM_Write4Byte(pDM_Odm, MACReg[i], MACBackup[i]); -+} -+ -+ -+VOID -+ _PHY_PathADDAOn_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte ADDAReg, -+ IN BOOLEAN isPathAOn, -+ IN BOOLEAN is2T -+ ) -+{ -+ u4Byte pathOn; -+ u4Byte i; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("ADDA ON.\n")); -+ -+ pathOn = isPathAOn ? 0x04db25a4 : 0x0b1b25a4; -+ if(FALSE == is2T){ -+ pathOn = 0x0bdb25a0; -+ ODM_SetBBReg(pDM_Odm, ADDAReg[0], bMaskDWord, 0x0b1b25a0); -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm,ADDAReg[0], bMaskDWord, pathOn); -+ } -+ -+ for( i = 1 ; i < IQK_ADDA_REG_NUM ; i++){ -+ ODM_SetBBReg(pDM_Odm,ADDAReg[i], bMaskDWord, pathOn); -+ } -+ -+} -+ -+VOID -+ _PHY_MACSettingCalibration_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte MACReg, -+ IN pu4Byte MACBackup -+ ) -+{ -+ u4Byte i = 0; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("MAC settings for Calibration.\n")); -+ -+ ODM_Write1Byte(pDM_Odm, MACReg[i], 0x3F); -+ -+ for(i = 1 ; i < (IQK_MAC_REG_NUM - 1); i++){ -+ ODM_Write1Byte(pDM_Odm, MACReg[i], (u1Byte)(MACBackup[i]&(~BIT3))); -+ } -+ ODM_Write1Byte(pDM_Odm, MACReg[i], (u1Byte)(MACBackup[i]&(~BIT5))); -+ -+} -+ -+VOID -+ _PHY_PathAStandBy_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER pAdapter -+#endif -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-A standby mode!\n")); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x840, bMaskDWord, 0x00010000); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+} -+ -+VOID -+ _PHY_PIModeSwitch_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN PIMode -+ ) -+{ -+ u4Byte mode; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BB Switch to %s mode!\n", (PIMode ? "PI" : "SI"))); -+ -+ mode = PIMode ? 0x01000100 : 0x01000000; -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_HSSIParameter1, bMaskDWord, mode); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_HSSIParameter1, bMaskDWord, mode); -+} -+ -+BOOLEAN -+ phy_SimularityCompare_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN s4Byte result[][8], -+ IN u1Byte c1, -+ IN u1Byte c2 -+ ) -+{ -+ u4Byte i, j, diff, SimularityBitMap, bound = 0; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ u1Byte final_candidate[2] = {0xFF, 0xFF}; //for path A and path B -+ BOOLEAN bResult = TRUE; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ BOOLEAN is2T = IS_92C_SERIAL( pHalData->VersionID); -+#else -+ BOOLEAN is2T = 0; -+#endif -+ -+ if(is2T) -+ bound = 8; -+ else -+ bound = 4; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> IQK:phy_SimularityCompare_8812A c1 %d c2 %d!!!\n", c1, c2)); -+ -+ -+ SimularityBitMap = 0; -+ -+ for( i = 0; i < bound; i++ ) -+ { -+ diff = (result[c1][i] > result[c2][i]) ? (result[c1][i] - result[c2][i]) : (result[c2][i] - result[c1][i]); -+ if (diff > MAX_TOLERANCE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:phy_SimularityCompare_8812A differnece overflow index %d compare1 0x%x compare2 0x%x!!!\n", i, (u4Byte)result[c1][i], (u4Byte)result[c2][i])); -+ -+ if((i == 2 || i == 6) && !SimularityBitMap) -+ { -+ if(result[c1][i]+result[c1][i+1] == 0) -+ final_candidate[(i/4)] = c2; -+ else if (result[c2][i]+result[c2][i+1] == 0) -+ final_candidate[(i/4)] = c1; -+ else -+ SimularityBitMap = SimularityBitMap|(1< Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, RX_X>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, RX_Y>>1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc10 = %x ====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xc10))); -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, RX_X>>1); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, RX_Y>>1); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x====>fill to IQC\n ", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe10 = %x====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xe10))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_TX_FillIQC_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN unsigned int TX_X, -+ IN unsigned int TX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x00000080); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x20040000); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, TX_Y); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, TX_X); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X&0x000007ff, TX_Y&0x000007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xcd4 = %x;;0xccc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xcd4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xccc, 0x000007ff))); -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xe90, 0x00000080); -+ ODM_Write4Byte(pDM_Odm, 0xec4, 0x20040000); -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x20000000); -+ ODM_SetBBReg(pDM_Odm, 0xecc, 0x000007ff, TX_Y); -+ ODM_SetBBReg(pDM_Odm, 0xed4, 0x000007ff, TX_X); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X&0x000007ff, TX_Y&0x000007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xed4 = %x;;0xecc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xed4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xecc, 0x000007ff))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_BackupMacBB_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //save MACBB default value -+ for (i = 0; i < MACBB_NUM; i++){ -+ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupMacBB Success!!!!\n")); -+} -+void _IQK_BackupRF_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte RFA_backup, -+ IN pu4Byte RFB_backup, -+ IN pu4Byte Backup_RF_REG, -+ IN u4Byte RF_NUM -+ ) -+{ -+ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save RF Parameters -+ for (i = 0; i < RF_NUM; i++){ -+ RFA_backup[i] = ODM_GetRFReg(pDM_Odm, RF_PATH_A, Backup_RF_REG[i], bMaskDWord); -+ RFB_backup[i] = ODM_GetRFReg(pDM_Odm, RF_PATH_B, Backup_RF_REG[i], bMaskDWord); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupRF Success!!!!\n")); -+} -+void _IQK_BackupAFE_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ AFE_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_AFE_REG[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupAFE Success!!!!\n")); -+} -+void _IQK_RestoreMacBB_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload MacBB Parameters -+ for (i = 0; i < MACBB_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreMacBB Success!!!!\n")); -+} -+void _IQK_RestoreRF_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN pu4Byte Backup_RF_REG, -+ IN pu4Byte RF_backup, -+ IN u4Byte RF_REG_NUM -+ ) -+{ -+ u4Byte i; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ for (i = 0; i < RF_REG_NUM; i++) -+ ODM_SetRFReg(pDM_Odm, Path, Backup_RF_REG[i], bRFRegOffsetMask, RF_backup[i]); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x0); -+ -+ switch(Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path A Success!!!!\n")); -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path B Success!!!!\n")); -+ } -+ break; -+ default: -+ break; -+ } -+} -+void _IQK_RestoreAFE_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_AFE_REG[i], AFE_backup[i]); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x3c000000); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x0); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreAFE Success!!!!\n")); -+} -+ -+ -+void _IQK_ConfigureMAC_8812A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ // ========MAC register setting======== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_Write1Byte(pDM_Odm, 0x522, 0x3f); -+ ODM_SetBBReg(pDM_Odm, 0x550, BIT(11)|BIT(3), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT(28), 0x0); // CCK Off -+ ODM_Write1Byte(pDM_Odm, 0x808, 0x00); // RX ante off -+ ODM_SetBBReg(pDM_Odm, 0x838, 0xf, 0xc); // CCA off -+} -+ -+#define cal_num 3 -+ -+void _IQK_Tx_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN u1Byte chnlIdx -+ ) -+{ -+ u4Byte TX_fail,RX_fail, delay_count, IQK_ready, cal_retry, cal = 0, temp_reg65; -+ int TX_X = 0, TX_Y = 0, RX_X = 0, RX_Y = 0, TX_Average = 0, RX_Average = 0; -+ int TX_X0[cal_num], TX_Y0[cal_num], RX_X0[cal_num], RX_Y0[cal_num]; -+ BOOLEAN TX0IQKOK = FALSE, RX0IQKOK = FALSE; -+ int TX_X1[cal_num], TX_Y1[cal_num], RX_X1[cal_num], RX_Y1[cal_num]; -+ BOOLEAN TX1IQKOK = FALSE, RX1IQKOK = FALSE, VDF_enable = FALSE; -+ int i, k, VDF_Y[3], VDF_X[3], Tx_dt[3], Rx_dt[3], ii, dx = 0, dy = 0, TX_finish = 0, RX_finish = 0; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ pDM_Odm->priv->pshare->IQK_total_cnt++; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BandWidth = %d ExtPA = %d pBand = %d\n", *pDM_Odm->pBandWidth, pDM_Odm->ExtPA, *pDM_Odm->pBandType)); -+ if (*pDM_Odm->pBandWidth == 2){ -+ VDF_enable = TRUE; -+ } -+ temp_reg65 = ODM_GetRFReg(pDM_Odm, Path, 0x65, bMaskDWord); -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // ========Path-A AFE all on======== -+ // Port 0 DAC/ADC on -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); -+ -+ // Port 1 DAC/ADC off -+ ODM_Write4Byte(pDM_Odm, 0xe60, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xe64, 0x00000000); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); -+ -+ ODM_SetBBReg(pDM_Odm, 0xc00, 0xf, 0x4);// hardware 3-wire off -+ -+ // IQK Setting -+ //====== TX IQK ====== -+ // 1. DAC/ADC sampling rate (160 MHz) -+ ODM_SetBBReg(pDM_Odm, 0xc5c, BIT(26)|BIT(25)|BIT(24), 0x7); -+ ODM_SetBBReg(pDM_Odm, 0x8c4, BIT(30), 0x1); -+ //ODM_SetBBReg(pDM_Odm, 0xcb0, 0x000000f0, 0x7); -+ ODM_SetBBReg(pDM_Odm, 0xcb0, 0x00ff0000, 0x77); -+ ODM_SetBBReg(pDM_Odm, 0xcb4, 0x03000000, 0x0); -+ } -+ break; -+ case ODM_RF_PATH_B: -+ {ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // Port 0 DAC/ADC off -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x00000000); -+ -+ // Port 1 DAC/ADC on -+ ODM_Write4Byte(pDM_Odm, 0xe60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xe64, 0x77777777); -+ -+ ODM_Write4Byte(pDM_Odm, 0xe68, 0x19791979); -+ -+ ODM_SetBBReg(pDM_Odm, 0xe00, 0xf, 0x4);// hardware 3-wire off -+ -+ // DAC/ADC sampling rate (160 MHz) -+ ODM_SetBBReg(pDM_Odm, 0xe5c, BIT(26)|BIT(25)|BIT(24), 0x7); -+ ODM_SetBBReg(pDM_Odm, 0x8c4, BIT(30), 0x1); -+ //ODM_SetBBReg(pDM_Odm, 0xeb0, 0x000000f0, 0x7); -+ ODM_SetBBReg(pDM_Odm, 0xeb0, 0x00ff0000, 0x77); -+ ODM_SetBBReg(pDM_Odm, 0xeb4, 0x03000000, 0x0); -+ } -+ break; -+ default: -+ break; -+ } -+ while (cal < cal_num){ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ //====== TX IQK ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80002); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3fffd); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe83f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403e3); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f1); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28163e96); -+ -+ if (VDF_enable == 1){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXVDF Start\n")); -+ for (k = 0;k <= 2; k++){ -+ switch (k){ -+ case 0: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); -+ } -+ break; -+ case 1: -+ { -+ ODM_SetBBReg(pDM_Odm, 0xc80, BIT(28), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xc84, BIT(28), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910);// [0]:AGC_en, [15]:idac_K_Mask -+ } -+ break; -+ case 2: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); -+ Tx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Tx_dt = %d\n", Tx_dt[cal])); -+ Tx_dt[cal] = ((16*Tx_dt[cal])*10000/15708); -+ Tx_dt[cal] = (Tx_dt[cal] >> 1 )+(Tx_dt[cal] & BIT(0)); -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c20);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xce8, 0x3fff0000, Tx_dt[cal] & 0x00003fff); -+ } -+ break; -+ default: -+ break; -+ } -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨?¥??v¤?µ¹ iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((IQK_ready) || (delay_count>20)){ -+ break; -+ } -+ else{ -+ delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = TRUE; -+ break; -+ } -+ else{ -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10){ -+ break; -+ } -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXA_VDF_cal_retry = %d\n", cal_retry)); -+ TX_X0[cal] = VDF_X[k-1] ; -+ TX_Y0[cal] = VDF_Y[k-1]; -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨?¥??v¤?µ¹ iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ delay_ms(10); //Delay 25ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((IQK_ready) || (delay_count>20)) { -+ break; -+ } -+ else{ -+ delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ TX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ TX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = TRUE; -+ /* -+ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x01000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x03000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+ */ -+ break; -+ } -+ else{ -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXA_cal_retry = %d\n", cal_retry)); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, Path, 0x8, 0xffc00)); // Load LOK -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ if (TX0IQKOK == FALSE) -+ break; // TXK fail, Don't do RXK -+ -+ -+ if (VDF_enable == 1){ -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); // TX VDF Disable -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXVDF Start\n")); -+ -+ //====== RX mode TXK (RXK Step 1) ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe7bf); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d0); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161420); -+ -+ for (k = 0;k <= 2; k++){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (VDF_X[k])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (VDF_Y[k])>>21&0x000007ff); -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ switch (k){ -+ case 0: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(30), 0x0); -+ } -+ break; -+ case 1: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x28008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x08008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ } -+ break; -+ case 2: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); -+ Rx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Rx_dt = %d\n", Rx_dt[cal])); -+ Rx_dt[cal] = ((16*Rx_dt[cal])*10000/13823); -+ Rx_dt[cal] = (Rx_dt[cal] >> 1 )+(Rx_dt[cal] & BIT(0)); -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c20);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, 0x00003fff, Rx_dt[cal] & 0x00003fff); -+ } -+ break; -+ default: -+ break; -+ } -+ -+ -+ if (k==2){ -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(30), 0x1); //RX VDF Enable -+ } -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨?¥??v¤?µ¹ iqk_dpk module -+ -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); -+ if (RX_fail == 0){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ RX0IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); -+ RX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ -+ } -+ } -+ else{ -+ RX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXA_VDF_cal_retry = %d\n", cal_retry)); -+ RX_X0[cal] = VDF_X[k-1] ; -+ RX_Y0[cal] = VDF_Y[k-1]; -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x1); // TX VDF Enable -+ } -+ else{ -+ //====== RX mode TXK (RXK Step 1) ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // 1. TX RF Setting -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe7bf); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d0); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X0[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y0[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161cc0); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨?¥??v¤?µ¹ iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); -+ if (RX_fail == 0){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ RX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ RX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ RX0IQKOK = TRUE; -+/* -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x05000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x07000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+*/ -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); -+ RX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ -+ } -+ } -+ else{ -+ RX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXA_cal_retry = %d\n", cal_retry)); -+ } -+ if (TX0IQKOK) -+ TX_Average++; -+ if (RX0IQKOK) -+ RX_Average++; -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ //Path-B TX/RX IQK -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80002); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3fffd); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe83f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); -+ ODM_SetBBReg(pDM_Odm, 0xe94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ -+ -+ if (pDM_Odm->ExtPA) -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x821403e3); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x821403f1); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x68163e96); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28163e96); -+ -+ if (VDF_enable == 1){ -+ for (k = 0;k <= 2; k++){ -+ switch (k){ -+ case 0: -+ { -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x18008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x38008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910); -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x0); -+ } -+ break; -+ case 1: -+ { -+ ODM_SetBBReg(pDM_Odm, 0xe80, BIT(28), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xe84, BIT(28), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910); -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x0); -+ } -+ break; -+ case 2: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); -+ Tx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Tx_dt = %d\n", Tx_dt[cal])); -+ Tx_dt[cal] = ((16*Tx_dt[cal])*10000/15708); -+ Tx_dt[cal] = (Tx_dt[cal] >> 1 )+(Tx_dt[cal] & BIT(0)); -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x18008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x38008c20);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xee8, 0x3fff0000, Tx_dt[cal] & 0x00003fff); -+ } -+ break; -+ default: -+ break; -+ } -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] ±N SI/PI ¨?¥??v¤?µ¹ iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); -+ if ((IQK_ready) || (delay_count>20)) { -+ break; -+ } -+ else { -+ delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x02000000); -+ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x04000000); -+ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ TX1IQKOK = TRUE; -+ break; -+ } -+ else{ -+ TX1IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10){ -+ break; -+ } -+ } -+ } -+ else{ -+ TX1IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10){ -+ break; -+ } -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXB_VDF_cal_retry = %d\n", cal_retry)); -+ TX_X1[cal] = VDF_X[k-1] ; -+ TX_Y1[cal] = VDF_Y[k-1]; -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xee8, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] ±N SI/PI ¨?¥??v¤?µ¹ iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ delay_ms(10); //Delay 25ms -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); -+ if ((IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(12)); -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x02000000); -+ TX_X1[cal] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x04000000); -+ TX_Y1[cal] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ TX1IQKOK = TRUE; -+ /* -+ int reg1 = 0, reg2 = 0, Image_Power = 0; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x01000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x02000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x03000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x04000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+ */ -+ break; -+ } -+ else{ -+ TX1IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10){ -+ break; -+ } -+ } -+ } -+ else { -+ TX1IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10){ -+ break; -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXB_cal_retry = %d\n", cal_retry)); -+ } -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, Path, 0x8, 0xffc00)); // Load LOK -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (TX1IQKOK == FALSE) -+ break; // TXK fail, Don't do RXK -+ -+ -+ -+ if (VDF_enable == 1){ -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x0); // TX VDF Disable -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXVDF Start\n")); -+ -+ //====== RX IQK ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe7bf); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d0); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x02140119); -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28161420); -+ -+ for (k = 0;k <= 2; k++){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (VDF_X[k])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (VDF_Y[k])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ switch (k){ -+ case 0: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x38008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x18008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(30), 0x0); -+ } -+ break; -+ case 1: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x28008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x08008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(30), 0x0); -+ } -+ break; -+ case 2: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); -+ Rx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Rx_dt = %d\n", Rx_dt[cal])); -+ Rx_dt[cal] = ((16*Rx_dt[cal])*10000/13823); -+ Rx_dt[cal] = (Rx_dt[cal] >> 1 )+(Rx_dt[cal] & BIT(0)); -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x38008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x18008c20);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xee8, 0x00003fff, Rx_dt[cal] & 0x00003fff); -+ } -+ break; -+ default: -+ break; -+ } -+ -+ -+ if (k==2){ -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(30), 0x1); //RX VDF Enable -+ } -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] ±N SI/PI ¨?¥??v¤?µ¹ iqk_dpk module -+ -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); -+ if ((IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(11)); -+ if (RX_fail == 0){ -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x06000000); -+ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x08000000); -+ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ RX1IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, 0x0>>1); -+ RX1IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ -+ } -+ } -+ else{ -+ RX1IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXB_VDF_cal_retry = %d\n", cal_retry)); -+ RX_X1[cal] = VDF_X[k-1] ; -+ RX_Y1[cal] = VDF_Y[k-1]; -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x1); // TX VDF Enable -+ } -+ else{ -+ //====== RX mode TXK (RXK Step 1) ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe7bf); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d0); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X1[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y1[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x38008c15);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x18008c15);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x02140119); -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28161cc0); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] ???SI/PI 使用?????iqk_dpk module -+ -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); -+ if ((IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(11)); -+ if (RX_fail == 0){ -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x06000000); -+ RX_X1[cal] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x08000000); -+ RX_Y1[cal] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ RX1IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, 0x0>>1); -+ RX1IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ else{ -+ RX1IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXB_cal_retry = %d\n", cal_retry)); -+ } -+ -+ -+ if (RX1IQKOK) -+ RX_Average++; -+ -+ -+ if (TX1IQKOK) -+ TX_Average++; -+ -+ } -+ break; -+ default: -+ break; -+ } -+ cal++; -+ } -+ // FillIQK Result -+ switch (Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_A =======\n")); -+ if (TX_Average == 0){ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ break; -+ } -+ for (i = 0; i < TX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X0[%d] = %x ;; TX_Y0[%d] = %x\n", i, (TX_X0[i])>>21&0x000007ff, i, (TX_Y0[i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < TX_Average; i++){ -+ for (ii = i+1; ii >21) - (TX_X0[ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (TX_Y0[i]>>21) - (TX_Y0[ii]>>21); -+ if (dy < 4 && dy > -4){ -+ TX_X = ((TX_X0[i]>>21) + (TX_X0[ii]>>21))/2; -+ TX_Y = ((TX_Y0[i]>>21) + (TX_Y0[ii]>>21))/2; -+ if (*pDM_Odm->pBandWidth == 2){ -+ Tx_dt[0] = (Tx_dt[i] + Tx_dt[ii])/2; -+ } -+ TX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (TX_finish == 1) -+ break; -+ } -+ if (*pDM_Odm->pBandWidth == 2){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xce8, 0x3fff0000, Tx_dt[0] & 0x00003fff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ } -+ if (TX_finish == 1){ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, TX_X, TX_Y); -+ } -+ else{ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ if (RX_Average == 0){ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ break; -+ } -+ -+ for (i = 0; i < RX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[%d] = %x ;; RX_Y0[%d] = %x\n", i, (RX_X0[i])>>21&0x000007ff, i, (RX_Y0[i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < RX_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_X0[ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_Y0[i]>>21) - (RX_Y0[ii]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_X = ((RX_X0[i]>>21) + (RX_X0[ii]>>21))/2; -+ RX_Y = ((RX_Y0[i]>>21) + (RX_Y0[ii]>>21))/2; -+ if (*pDM_Odm->pBandWidth == 2){ -+ Rx_dt[0] = (Rx_dt[i] + Rx_dt[ii])/2; -+ } -+ RX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (RX_finish == 1) -+ break; -+ } -+ if (*pDM_Odm->pBandWidth == 2){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xce8, 0x00003fff, Rx_dt[0] & 0x00003fff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ } -+ if (RX_finish == 1){ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, RX_X, RX_Y); -+ } -+ else{ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ if (TX_finish && RX_finish){ -+ pRFCalibrateInfo->bNeedIQK = FALSE; -+ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][0] = ((TX_X & 0x000007ff) << 16) + (TX_Y & 0x000007ff); //Path A TX -+ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][1] = ((RX_X & 0x000007ff) << 16) + (RX_Y & 0x000007ff); //Path A RX -+ -+ if (*pDM_Odm->pBandWidth == 2){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C -+ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][4] = ODM_Read4Byte( pDM_Odm, 0xce8); //Path B VDF -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ } -+ } -+ -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_B =======\n")); -+ if (TX_Average == 0){ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ break; -+ } -+ -+ for (i = 0; i < TX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X1[%d] = %x ;; TX_Y1[%d] = %x\n", i, (TX_X1[i])>>21&0x000007ff, i, (TX_Y1[i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < TX_Average; i++){ -+ for (ii = i+1; ii >21) - (TX_X1[ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (TX_Y1[i]>>21) - (TX_Y1[ii]>>21); -+ if (dy < 4 && dy > -4){ -+ TX_X = ((TX_X1[i]>>21) + (TX_X1[ii]>>21))/2; -+ TX_Y = ((TX_Y1[i]>>21) + (TX_Y1[ii]>>21))/2; -+ if (*pDM_Odm->pBandWidth == 2){ -+ Tx_dt[0] = (Tx_dt[i] + Tx_dt[ii])/2; -+ } -+ TX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (TX_finish == 1) -+ break; -+ } -+ if (*pDM_Odm->pBandWidth == 2){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xee8, 0x3fff0000, Tx_dt[0] & 0x00003fff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ } -+ if (TX_finish == 1){ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, TX_X, TX_Y); -+ } -+ else{ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ if (RX_Average == 0){ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ break; -+ } -+ -+ for (i = 0; i < RX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X1[%d] = %x ;; RX_Y1[%d] = %x\n", i, (RX_X1[i])>>21&0x000007ff, i, (RX_Y1[i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < RX_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_X1[ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_Y1[i]>>21) - (RX_Y1[ii]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_X = ((RX_X1[i]>>21) + (RX_X1[ii]>>21))/2; -+ RX_Y = ((RX_Y1[i]>>21) + (RX_Y1[ii]>>21))/2; -+ if (*pDM_Odm->pBandWidth == 2){ -+ Rx_dt[0] = (Rx_dt[i] + Rx_dt[ii])/2; -+ } -+ RX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (RX_finish == 1) -+ break; -+ } -+ if (*pDM_Odm->pBandWidth == 2){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xee8, 0x00003fff, Rx_dt[0] & 0x00003fff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ } -+ if (RX_finish == 1){ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, RX_X, RX_Y); -+ } -+ else{ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ if (TX_finish && RX_finish){ -+ pRFCalibrateInfo->bNeedIQK = FALSE; -+ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][2] = ((TX_X & 0x000007ff) << 16) + (TX_Y & 0x000007ff); //Path B TX -+ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][3] = ((RX_X & 0x000007ff) << 16) + (RX_Y & 0x000007ff); //Path B RX -+ -+ if (*pDM_Odm->pBandWidth == 2){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C -+ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][5] = ODM_Read4Byte( pDM_Odm, 0xee8); //Path B VDF -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ } -+ } -+ -+ } -+ break; -+ default: -+ break; -+ } -+ -+ if (!TX_finish && !RX_finish) -+ priv->pshare->IQK_fail_cnt++; -+} -+ -+#define MACBB_REG_NUM 10 -+#define AFE_REG_NUM 14 -+#define RF_REG_NUM 3 -+/* -+IQK v1.0 update TXIQK high power parameter -+*/ -+VOID -+phy_IQCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte Channel -+ ) -+{ -+ u4Byte MACBB_backup[MACBB_REG_NUM], AFE_backup[AFE_REG_NUM], RFA_backup[RF_REG_NUM], RFB_backup[RF_REG_NUM]; -+ u4Byte Backup_MACBB_REG[MACBB_REG_NUM] = {0x520, 0x550, 0x808, 0x838, 0x90c, 0xb00, 0xc00, 0xe00, 0x8c4, 0x82c}; -+ u4Byte Backup_AFE_REG[AFE_REG_NUM] = {0xc5c, 0xc60, 0xc64, 0xc68, 0xcb8, 0xcb0, 0xcb4, -+ 0xe5c, 0xe60, 0xe64, 0xe68, 0xeb8, 0xeb0, 0xeb4}; -+ u4Byte Backup_RF_REG[RF_REG_NUM] = {0x65, 0x8f, 0x0}; -+ u1Byte chnlIdx = ODM_GetRightChnlPlaceforIQK(Channel); -+ -+ _IQK_BackupMacBB_8812A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); -+ _IQK_BackupAFE_8812A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); -+ _IQK_BackupRF_8812A(pDM_Odm, RFA_backup, RFB_backup, Backup_RF_REG, RF_REG_NUM); -+ -+ _IQK_ConfigureMAC_8812A(pDM_Odm); -+ _IQK_Tx_8812A(pDM_Odm, ODM_RF_PATH_A, chnlIdx); -+ _IQK_RestoreRF_8812A(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG, RFA_backup, RF_REG_NUM); -+ -+ _IQK_Tx_8812A(pDM_Odm, ODM_RF_PATH_B, chnlIdx); -+ _IQK_RestoreRF_8812A(pDM_Odm, ODM_RF_PATH_B, Backup_RF_REG, RFB_backup, RF_REG_NUM); -+ -+ _IQK_RestoreAFE_8812A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); -+ _IQK_RestoreMacBB_8812A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); -+ -+ //_IQK_Exit_8812A(pDM_Odm); -+ //_IQK_TX_CheckResult_8812A -+ -+} -+ -+ -+VOID -+ phy_LCCalibrate_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN is2T -+ ) -+{ -+ u1Byte tmpReg; -+ u4Byte RF_Amode=0, RF_Bmode=0, LC_Cal; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ //Check continuous TX and Packet TX -+ tmpReg = ODM_Read1Byte(pDM_Odm, 0xd03); -+ -+ if((tmpReg&0x70) != 0) //Deal with contisuous TX case -+ ODM_Write1Byte(pDM_Odm, 0xd03, tmpReg&0x8F); //disable all continuous TX -+ else // Deal with Packet TX case -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0xFF); // block all queues -+ -+ if((tmpReg&0x70) != 0) -+ { -+ //1. Read original RF mode -+ //Path-A -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ RF_Amode = PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_AC, bMask12Bits); -+ -+ //Path-B -+ if(is2T) -+ RF_Bmode = PHY_QueryRFReg(pAdapter, RF_PATH_B, RF_AC, bMask12Bits); -+#else -+ RF_Amode = ODM_GetRFReg(pDM_Odm, RF_PATH_A, RF_AC, bMask12Bits); -+ -+ //Path-B -+ if(is2T) -+ RF_Bmode = ODM_GetRFReg(pDM_Odm, RF_PATH_B, RF_AC, bMask12Bits); -+#endif -+ -+ //2. Set RF mode = standby mode -+ //Path-A -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_AC, bMask12Bits, (RF_Amode&0x8FFFF)|0x10000); -+ -+ //Path-B -+ if(is2T) -+ ODM_SetRFReg(pDM_Odm, RF_PATH_B, RF_AC, bMask12Bits, (RF_Bmode&0x8FFFF)|0x10000); -+ } -+ -+ //3. Read RF reg18 -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ LC_Cal = PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_CHNLBW, bMask12Bits); -+#else -+ LC_Cal = ODM_GetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, bMask12Bits); -+#endif -+ -+ //4. Set LC calibration begin bit15 -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, bMask12Bits, LC_Cal|0x08000); -+ -+ ODM_delay_ms(100); -+ -+ -+ //Restore original situation -+ if((tmpReg&0x70) != 0) //Deal with contisuous TX case -+ { -+ //Path-A -+ ODM_Write1Byte(pDM_Odm, 0xd03, tmpReg); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_AC, bMask12Bits, RF_Amode); -+ -+ //Path-B -+ if(is2T) -+ ODM_SetRFReg(pDM_Odm, RF_PATH_B, RF_AC, bMask12Bits, RF_Bmode); -+ } -+ else // Deal with Packet TX case -+ { -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0x00); -+ } -+} -+ -+//Analog Pre-distortion calibration -+#define APK_BB_REG_NUM 8 -+#define APK_CURVE_REG_NUM 4 -+#define PATH_NUM 2 -+ -+VOID -+ phy_APCalibrate_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN s1Byte delta, -+ IN BOOLEAN is2T -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ u4Byte regD[PATH_NUM]; -+ u4Byte tmpReg, index, offset, apkbound; -+ u1Byte path, i, pathbound = PATH_NUM; -+ u4Byte BB_backup[APK_BB_REG_NUM]; -+ u4Byte BB_REG[APK_BB_REG_NUM] = { -+ rFPGA1_TxBlock, rOFDM0_TRxPathEnable, -+ rFPGA0_RFMOD, rOFDM0_TRMuxPar, -+ rFPGA0_XCD_RFInterfaceSW, rFPGA0_XAB_RFInterfaceSW, -+ rFPGA0_XA_RFInterfaceOE, rFPGA0_XB_RFInterfaceOE }; -+ u4Byte BB_AP_MODE[APK_BB_REG_NUM] = { -+ 0x00000020, 0x00a05430, 0x02040000, -+ 0x000800e4, 0x00204000 }; -+ u4Byte BB_normal_AP_MODE[APK_BB_REG_NUM] = { -+ 0x00000020, 0x00a05430, 0x02040000, -+ 0x000800e4, 0x22204000 }; -+ -+ u4Byte AFE_backup[IQK_ADDA_REG_NUM]; -+ u4Byte AFE_REG[IQK_ADDA_REG_NUM] = { -+ rFPGA0_XCD_SwitchControl, rBlue_Tooth, -+ rRx_Wait_CCA, rTx_CCK_RFON, -+ rTx_CCK_BBON, rTx_OFDM_RFON, -+ rTx_OFDM_BBON, rTx_To_Rx, -+ rTx_To_Tx, rRx_CCK, -+ rRx_OFDM, rRx_Wait_RIFS, -+ rRx_TO_Rx, rStandby, -+ rSleep, rPMPD_ANAEN }; -+ -+ u4Byte MAC_backup[IQK_MAC_REG_NUM]; -+ u4Byte MAC_REG[IQK_MAC_REG_NUM] = { -+ REG_TXPAUSE, REG_BCN_CTRL, -+ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; -+ -+ u4Byte APK_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x0852c, 0x1852c, 0x5852c, 0x1852c, 0x5852c}, -+ {0x2852e, 0x0852e, 0x3852e, 0x0852e, 0x0852e} -+ }; -+ -+ u4Byte APK_normal_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x0852c, 0x0a52c, 0x3a52c, 0x5a52c, 0x5a52c}, //path settings equal to path b settings -+ {0x0852c, 0x0a52c, 0x5a52c, 0x5a52c, 0x5a52c} -+ }; -+ -+ u4Byte APK_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x52019, 0x52014, 0x52013, 0x5200f, 0x5208d}, -+ {0x5201a, 0x52019, 0x52016, 0x52033, 0x52050} -+ }; -+ -+ u4Byte APK_normal_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a}, //path settings equal to path b settings -+ {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a} -+ }; -+ -+ u4Byte AFE_on_off[PATH_NUM] = { -+ 0x04db25a4, 0x0b1b25a4}; //path A on path B off / path A off path B on -+ -+ u4Byte APK_offset[PATH_NUM] = { -+ rConfig_AntA, rConfig_AntB}; -+ -+ u4Byte APK_normal_offset[PATH_NUM] = { -+ rConfig_Pmpd_AntA, rConfig_Pmpd_AntB}; -+ -+ u4Byte APK_value[PATH_NUM] = { -+ 0x92fc0000, 0x12fc0000}; -+ -+ u4Byte APK_normal_value[PATH_NUM] = { -+ 0x92680000, 0x12680000}; -+ -+ s1Byte APK_delta_mapping[APK_BB_REG_NUM][13] = { -+ {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-6, -4, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-1, -1, -1, -1, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-11, -9, -7, -5, -3, -1, 0, 0, 0, 0, 0, 0, 0} -+ }; -+ -+ u4Byte APK_normal_setting_value_1[13] = { -+ 0x01017018, 0xf7ed8f84, 0x1b1a1816, 0x2522201e, 0x322e2b28, -+ 0x433f3a36, 0x5b544e49, 0x7b726a62, 0xa69a8f84, 0xdfcfc0b3, -+ 0x12680000, 0x00880000, 0x00880000 -+ }; -+ -+ u4Byte APK_normal_setting_value_2[16] = { -+ 0x01c7021d, 0x01670183, 0x01000123, 0x00bf00e2, 0x008d00a3, -+ 0x0068007b, 0x004d0059, 0x003a0042, 0x002b0031, 0x001f0025, -+ 0x0017001b, 0x00110014, 0x000c000f, 0x0009000b, 0x00070008, -+ 0x00050006 -+ }; -+ -+ u4Byte APK_result[PATH_NUM][APK_BB_REG_NUM]; //val_1_1a, val_1_2a, val_2a, val_3a, val_4a -+ // u4Byte AP_curve[PATH_NUM][APK_CURVE_REG_NUM]; -+ -+ s4Byte BB_offset, delta_V, delta_offset; -+ -+#if defined(MP_DRIVER) && (MP_DRIVER == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+#else -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+#endif -+ pMptCtx->APK_bound[0] = 45; -+ pMptCtx->APK_bound[1] = 52; -+ -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>phy_APCalibrate_8812A() delta %d\n", delta)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("AP Calibration for %s\n", (is2T ? "2T2R" : "1T1R"))); -+ if(!is2T) -+ pathbound = 1; -+ -+ //2 FOR NORMAL CHIP SETTINGS -+ -+ // Temporarily do not allow normal driver to do the following settings because these offset -+ // and value will cause RF internal PA to be unpredictably disabled by HW, such that RF Tx signal -+ // will disappear after disable/enable card many times on 88CU. RF SD and DD have not find the -+ // root cause, so we remove these actions temporarily. Added by tynli and SD3 Allen. 2010.05.31. -+#if !defined(MP_DRIVER) || (MP_DRIVER != 1) -+ return; -+#endif -+ //settings adjust for normal chip -+ for(index = 0; index < PATH_NUM; index ++) -+ { -+ APK_offset[index] = APK_normal_offset[index]; -+ APK_value[index] = APK_normal_value[index]; -+ AFE_on_off[index] = 0x6fdb25a4; -+ } -+ -+ for(index = 0; index < APK_BB_REG_NUM; index ++) -+ { -+ for(path = 0; path < pathbound; path++) -+ { -+ APK_RF_init_value[path][index] = APK_normal_RF_init_value[path][index]; -+ APK_RF_value_0[path][index] = APK_normal_RF_value_0[path][index]; -+ } -+ BB_AP_MODE[index] = BB_normal_AP_MODE[index]; -+ } -+ -+ apkbound = 6; -+ -+ //save BB default value -+ for(index = 0; index < APK_BB_REG_NUM ; index++) -+ { -+ if(index == 0) //skip -+ continue; -+ BB_backup[index] = ODM_GetBBReg(pDM_Odm, BB_REG[index], bMaskDWord); -+ } -+ -+ //save MAC default value -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_SaveMACRegisters_8812A(pAdapter, MAC_REG, MAC_backup); -+ -+ //save AFE default value -+ _PHY_SaveADDARegisters_8812A(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+#else -+ _PHY_SaveMACRegisters_8812A(pDM_Odm, MAC_REG, MAC_backup); -+ -+ //save AFE default value -+ _PHY_SaveADDARegisters_8812A(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+#endif -+ -+ for(path = 0; path < pathbound; path++) -+ { -+ -+ -+ if(path == RF_PATH_A) -+ { -+ //path A APK -+ //load APK setting -+ //path-A -+ offset = rPdp_AntA; -+ for(index = 0; index < 11; index ++) -+ { -+ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); -+ -+ offset = rConfig_AntA; -+ for(; index < 13; index ++) -+ { -+ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ -+ //page-B1 -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); -+ -+ //path A -+ offset = rPdp_AntA; -+ for(index = 0; index < 16; index++) -+ { -+ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_2[index]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0); -+ } -+ else if(path == RF_PATH_B) -+ { -+ //path B APK -+ //load APK setting -+ //path-B -+ offset = rPdp_AntB; -+ for(index = 0; index < 10; index ++) -+ { -+ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x12680000); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); -+ -+ offset = rConfig_AntA; -+ index = 11; -+ for(; index < 13; index ++) //offset 0xb68, 0xb6c -+ { -+ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ -+ //page-B1 -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); -+ -+ //path B -+ offset = 0xb60; -+ for(index = 0; index < 16; index++) -+ { -+ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_2[index]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0); -+ } -+ -+ //save RF default value -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ regD[path] = PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bMaskDWord); -+#else -+ regD[path] = ODM_GetRFReg(pDM_Odm, path, RF_TXBIAS_A, bMaskDWord); -+#endif -+ -+ //Path A AFE all on, path B AFE All off or vise versa -+ for(index = 0; index < IQK_ADDA_REG_NUM ; index++) -+ ODM_SetBBReg(pDM_Odm, AFE_REG[index], bMaskDWord, AFE_on_off[path]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0xe70 %x\n", ODM_GetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord))); -+ -+ //BB to AP mode -+ if(path == 0) -+ { -+ for(index = 0; index < APK_BB_REG_NUM ; index++) -+ { -+ -+ if(index == 0) //skip -+ continue; -+ else if (index < 5) -+ ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_AP_MODE[index]); -+ else if (BB_REG[index] == 0x870) -+ ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_backup[index]|BIT10|BIT26); -+ else -+ ODM_SetBBReg(pDM_Odm, BB_REG[index], BIT10, 0x0); -+ } -+ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ } -+ else //path B -+ { -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x01008c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x01008c00); -+ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0x800 %x\n", ODM_GetBBReg(pDM_Odm, 0x800, bMaskDWord))); -+ -+ //MAC settings -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_MACSettingCalibration_8812A(pAdapter, MAC_REG, MAC_backup); -+#else -+ _PHY_MACSettingCalibration_8812A(pDM_Odm, MAC_REG, MAC_backup); -+#endif -+ -+ if(path == RF_PATH_A) //Path B to standby mode -+ { -+ ODM_SetRFReg(pDM_Odm, RF_PATH_B, RF_AC, bMaskDWord, 0x10000); -+ } -+ else //Path A to standby mode -+ { -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_AC, bMaskDWord, 0x10000); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_MODE1, bMaskDWord, 0x1000f); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_MODE2, bMaskDWord, 0x20103); -+ } -+ -+ delta_offset = ((delta+14)/2); -+ if(delta_offset < 0) -+ delta_offset = 0; -+ else if (delta_offset > 12) -+ delta_offset = 12; -+ -+ //AP calibration -+ for(index = 0; index < APK_BB_REG_NUM; index++) -+ { -+ if(index != 1) //only DO PA11+PAD01001, AP RF setting -+ continue; -+ -+ tmpReg = APK_RF_init_value[path][index]; -+#if 1 -+ if(!pDM_Odm->RFCalibrateInfo.bAPKThermalMeterIgnore) -+ { -+ BB_offset = (tmpReg & 0xF0000) >> 16; -+ -+ if(!(tmpReg & BIT15)) //sign bit 0 -+ { -+ BB_offset = -BB_offset; -+ } -+ -+ delta_V = APK_delta_mapping[index][delta_offset]; -+ -+ BB_offset += delta_V; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() APK index %d tmpReg 0x%x delta_V %d delta_offset %d\n", index, tmpReg, (int)delta_V, (int)delta_offset)); -+ -+ if(BB_offset < 0) -+ { -+ tmpReg = tmpReg & (~BIT15); -+ BB_offset = -BB_offset; -+ } -+ else -+ { -+ tmpReg = tmpReg | BIT15; -+ } -+ tmpReg = (tmpReg & 0xFFF0FFFF) | (BB_offset << 16); -+ } -+#endif -+ -+ ODM_SetRFReg(pDM_Odm, path, RF_IPA_A, bMaskDWord, 0x8992e); -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0xc %x\n", PHY_QueryRFReg(pAdapter, path, RF_IPA_A, bMaskDWord))); -+ ODM_SetRFReg(pDM_Odm, path, RF_AC, bMaskDWord, APK_RF_value_0[path][index]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0x0 %x\n", PHY_QueryRFReg(pAdapter, path, RF_AC, bMaskDWord))); -+ ODM_SetRFReg(pDM_Odm, path, RF_TXBIAS_A, bMaskDWord, tmpReg); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0xd %x\n", PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bMaskDWord))); -+#else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0xc %x\n", ODM_GetRFReg(pDM_Odm, path, RF_IPA_A, bMaskDWord))); -+ ODM_SetRFReg(pDM_Odm, path, RF_AC, bMaskDWord, APK_RF_value_0[path][index]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0x0 %x\n", ODM_GetRFReg(pDM_Odm, path, RF_AC, bMaskDWord))); -+ ODM_SetRFReg(pDM_Odm, path, RF_TXBIAS_A, bMaskDWord, tmpReg); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0xd %x\n", ODM_GetRFReg(pDM_Odm, path, RF_TXBIAS_A, bMaskDWord))); -+#endif -+ -+ // PA11+PAD01111, one shot -+ i = 0; -+ do -+ { -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x800000); -+ { -+ ODM_SetBBReg(pDM_Odm, APK_offset[path], bMaskDWord, APK_value[0]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0x%x value 0x%x\n", APK_offset[path], ODM_GetBBReg(pDM_Odm, APK_offset[path], bMaskDWord))); -+ ODM_delay_ms(3); -+ ODM_SetBBReg(pDM_Odm, APK_offset[path], bMaskDWord, APK_value[1]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0x%x value 0x%x\n", APK_offset[path], ODM_GetBBReg(pDM_Odm, APK_offset[path], bMaskDWord))); -+ -+ ODM_delay_ms(20); -+ } -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0); -+ -+ if(path == RF_PATH_A) -+ tmpReg = ODM_GetBBReg(pDM_Odm, rAPK, 0x03E00000); -+ else -+ tmpReg = ODM_GetBBReg(pDM_Odm, rAPK, 0xF8000000); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8812A() offset 0xbd8[25:21] %x\n", tmpReg)); -+ -+ -+ i++; -+ } -+ while(tmpReg > apkbound && i < 4); -+ -+ APK_result[path][index] = tmpReg; -+ } -+ } -+ -+ //reload MAC default value -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_ReloadMACRegisters_8812A(pAdapter, MAC_REG, MAC_backup); -+#else -+ _PHY_ReloadMACRegisters_8812A(pDM_Odm, MAC_REG, MAC_backup); -+#endif -+ -+ //reload BB default value -+ for(index = 0; index < APK_BB_REG_NUM ; index++) -+ { -+ -+ if(index == 0) //skip -+ continue; -+ ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_backup[index]); -+ } -+ -+ //reload AFE default value -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_ReloadADDARegisters_8812A(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+#else -+ _PHY_ReloadADDARegisters_8812A(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+#endif -+ -+ //reload RF path default value -+ for(path = 0; path < pathbound; path++) -+ { -+ ODM_SetRFReg(pDM_Odm, path, 0xd, bMaskDWord, regD[path]); -+ if(path == RF_PATH_B) -+ { -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_MODE1, bMaskDWord, 0x1000f); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_MODE2, bMaskDWord, 0x20101); -+ } -+ -+ //note no index == 0 -+ if (APK_result[path][1] > 6) -+ APK_result[path][1] = 6; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("apk path %d result %d 0x%x \t", path, 1, APK_result[path][1])); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\n")); -+ -+ -+ for(path = 0; path < pathbound; path++) -+ { -+ ODM_SetRFReg(pDM_Odm, path, 0x3, bMaskDWord, -+ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (APK_result[path][1] << 5) | APK_result[path][1])); -+ if(path == RF_PATH_A) -+ ODM_SetRFReg(pDM_Odm, path, 0x4, bMaskDWord, -+ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x00 << 5) | 0x05)); -+ else -+ ODM_SetRFReg(pDM_Odm, path, 0x4, bMaskDWord, -+ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x02 << 5) | 0x05)); -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ ODM_SetRFReg(pDM_Odm, path, RF_BS_PA_APSET_G9_G11, bMaskDWord, -+ ((0x08 << 15) | (0x08 << 10) | (0x08 << 5) | 0x08)); -+#endif -+ } -+ -+ pDM_Odm->RFCalibrateInfo.bAPKdone = TRUE; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==phy_APCalibrate_8812A()\n")); -+} -+ -+ -+ -+#define DP_BB_REG_NUM 7 -+#define DP_RF_REG_NUM 1 -+#define DP_RETRY_LIMIT 10 -+#define DP_PATH_NUM 2 -+#define DP_DPK_NUM 3 -+#define DP_DPK_VALUE_NUM 2 -+ -+ -+#if 0 //FOR_8812_IQK -+VOID -+PHY_IQCalibrate_8812A( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery -+ ) -+{ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else // (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#endif -+#if (MP_DRIVER == 1) -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+ #else// (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ #endif -+#endif//(MP_DRIVER == 1) -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE) ) -+ if (ODM_CheckPowerStatus(pAdapter) == FALSE) -+ return; -+#endif -+ -+#if MP_DRIVER == 1 -+ if( ! (pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) ) -+#endif -+ phy_IQCalibrate_8812A(pDM_Odm); -+ -+ -+} -+#endif -+ -+VOID -+PHY_LCCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if 0 -+ BOOLEAN bStartContTx = FALSE, bSingleTone = FALSE, bCarrierSuppression = FALSE; -+ u4Byte timeout = 2000, timecount = 0; -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else // (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+ -+#if (MP_DRIVER == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+#else// (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+#endif -+#endif//(MP_DRIVER == 1) -+#endif -+ -+ -+ -+ -+#if MP_DRIVER == 1 -+ bStartContTx = pMptCtx->bStartContTx; -+ bSingleTone = pMptCtx->bSingleTone; -+ bCarrierSuppression = pMptCtx->bCarrierSuppression; -+#endif -+ -+ -+#ifdef DISABLE_BB_RF -+ return; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) -+ if(!(pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)) -+ { -+ return; -+ } -+#endif -+ // 20120213 Turn on when continuous Tx to pass lab testing. (required by Edlu) -+ if(bSingleTone || bCarrierSuppression) -+ return; -+ -+ while(*(pDM_Odm->pbScanInProcess) && timecount < timeout) -+ { -+ ODM_delay_ms(50); -+ timecount += 50; -+ } -+ -+ pDM_Odm->RFCalibrateInfo.bLCKInProgress = TRUE; -+ -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK:Start!!!interface %d currentband %x delay %d ms\n", pDM_Odm->interfaceIndex, pHalData->CurrentBandType92D, timecount)); -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ if(IS_2T2R(pHalData->VersionID)) -+ { -+ phy_LCCalibrate_8812A(pAdapter, TRUE); -+ } -+ else -+#endif -+ { -+ // For 88C 1T1R -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ phy_LCCalibrate_8812A(pAdapter, FALSE); -+#else -+ phy_LCCalibrate_8812A(pDM_Odm, FALSE); -+#endif -+ } -+ -+ pDM_Odm->RFCalibrateInfo.bLCKInProgress = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK:Finish!!!interface %d\n", pDM_Odm->InterfaceIndex)); -+#endif -+} -+ -+VOID -+ PHY_APCalibrate_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN s1Byte delta -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+#ifdef DISABLE_BB_RF -+ return; -+#endif -+ -+ return; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) -+ if(!(pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)) -+ { -+ return; -+ } -+#endif -+ -+#if defined(FOR_BRAZIL_PRETEST) && (FOR_BRAZIL_PRETEST != 1) -+ if(pDM_Odm->RFCalibrateInfo.bAPKdone) -+#endif -+ return; -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if(IS_92C_SERIAL( pHalData->VersionID)){ -+ phy_APCalibrate_8812A(pAdapter, delta, TRUE); -+ } -+ else -+#endif -+ { -+ // For 88C 1T1R -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ phy_APCalibrate_8812A(pAdapter, delta, FALSE); -+#else -+ phy_APCalibrate_8812A(pDM_Odm, delta, FALSE); -+#endif -+ } -+} -+ VOID phy_SetRFPathSwitch_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bMain, -+ IN BOOLEAN is2T -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if(!pAdapter->bHWInitReady) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if(pAdapter->hw_init_completed == _FALSE) -+#endif -+ { -+ u1Byte u1bTmp; -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_LEDCFG2) | BIT7; -+ ODM_Write1Byte(pDM_Odm, REG_LEDCFG2, u1bTmp); -+ //ODM_SetBBReg(pDM_Odm, REG_LEDCFG0, BIT23, 0x01); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XAB_RFParameter, BIT13, 0x01); -+ } -+ -+#endif -+ -+ if(is2T) //92C -+ { -+ if(bMain) -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_RFInterfaceOE, BIT5|BIT6, 0x1); //92C_Path_A -+ else -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_RFInterfaceOE, BIT5|BIT6, 0x2); //BT -+ } -+ else //88C -+ { -+ -+ if(bMain) -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, BIT8|BIT9, 0x2); //Main -+ else -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, BIT8|BIT9, 0x1); //Aux -+ } -+} -+ VOID PHY_SetRFPathSwitch_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bMain -+ ) -+{ -+ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+#ifdef DISABLE_BB_RF -+ return; -+#endif -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (IS_92C_SERIAL(pHalData->VersionID)) -+ { -+ phy_SetRFPathSwitch_8812A(pAdapter, bMain, TRUE); -+ } -+ else -+#endif -+ { -+ // For 88C 1T1R -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ phy_SetRFPathSwitch_8812A(pAdapter, bMain, FALSE); -+#else -+ phy_SetRFPathSwitch_8812A(pDM_Odm, bMain, FALSE); -+#endif -+ } -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+//digital predistortion -+VOID -+ phy_DigitalPredistortion_8812A( -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PADAPTER pAdapter, -+#else -+ IN PDM_ODM_T pDM_Odm, -+#endif -+ IN BOOLEAN is2T -+ ) -+{ -+#if (RT_PLATFORM == PLATFORM_WINDOWS) -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ -+ u4Byte tmpReg, tmpReg2, index, i; -+ u1Byte path, pathbound = PATH_NUM; -+ u4Byte AFE_backup[IQK_ADDA_REG_NUM]; -+ u4Byte AFE_REG[IQK_ADDA_REG_NUM] = { -+ rFPGA0_XCD_SwitchControl, rBlue_Tooth, -+ rRx_Wait_CCA, rTx_CCK_RFON, -+ rTx_CCK_BBON, rTx_OFDM_RFON, -+ rTx_OFDM_BBON, rTx_To_Rx, -+ rTx_To_Tx, rRx_CCK, -+ rRx_OFDM, rRx_Wait_RIFS, -+ rRx_TO_Rx, rStandby, -+ rSleep, rPMPD_ANAEN }; -+ -+ u4Byte BB_backup[DP_BB_REG_NUM]; -+ u4Byte BB_REG[DP_BB_REG_NUM] = { -+ rOFDM0_TRxPathEnable, rFPGA0_RFMOD, -+ rOFDM0_TRMuxPar, rFPGA0_XCD_RFInterfaceSW, -+ rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, -+ rFPGA0_XB_RFInterfaceOE}; -+ u4Byte BB_settings[DP_BB_REG_NUM] = { -+ 0x00a05430, 0x02040000, 0x000800e4, 0x22208000, -+ 0x0, 0x0, 0x0}; -+ -+ u4Byte RF_backup[DP_PATH_NUM][DP_RF_REG_NUM]; -+ u4Byte RF_REG[DP_RF_REG_NUM] = { -+ RF_TXBIAS_A}; -+ -+ u4Byte MAC_backup[IQK_MAC_REG_NUM]; -+ u4Byte MAC_REG[IQK_MAC_REG_NUM] = { -+ REG_TXPAUSE, REG_BCN_CTRL, -+ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; -+ -+ u4Byte Tx_AGC[DP_DPK_NUM][DP_DPK_VALUE_NUM] = { -+ {0x1e1e1e1e, 0x03901e1e}, -+ {0x18181818, 0x03901818}, -+ {0x0e0e0e0e, 0x03900e0e} -+ }; -+ -+ u4Byte AFE_on_off[PATH_NUM] = { -+ 0x04db25a4, 0x0b1b25a4}; //path A on path B off / path A off path B on -+ -+ u1Byte RetryCount = 0; -+ -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>phy_DigitalPredistortion_8812A()\n")); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_DigitalPredistortion_8812A for %s %s\n", (is2T ? "2T2R" : "1T1R"))); -+ -+ //save BB default value -+ for(index=0; index tx_agc 1f ~11 -+ // PA gain = 11 & PAD2 => tx_agc 10~0e -+ // PA gain = 01 => tx_agc 0b~0d -+ // PA gain = 00 => tx_agc 0a~00 -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); -+ ODM_SetBBReg(pDM_Odm, 0xbc0, bMaskDWord, 0x0005361f); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0); -+ -+ //do inner loopback DPK 3 times -+ for(i = 0; i < 3; i++) -+ { -+ //PA gain = 11 & PAD2 => tx_agc = 0x0f/0x0c/0x07 -+ for(index = 0; index < 3; index++) -+ ODM_SetBBReg(pDM_Odm, 0xe00+index*4, bMaskDWord, Tx_AGC[i][0]); -+ ODM_SetBBReg(pDM_Odm,0xe00+index*4, bMaskDWord, Tx_AGC[i][1]); -+ for(index = 0; index < 4; index++) -+ ODM_SetBBReg(pDM_Odm,0xe10+index*4, bMaskDWord, Tx_AGC[i][0]); -+ -+ // PAGE_B for Path-A inner loopback DPK setting -+ ODM_SetBBReg(pDM_Odm,rPdp_AntA, bMaskDWord, 0x02097098); -+ ODM_SetBBReg(pDM_Odm,rPdp_AntA_4, bMaskDWord, 0xf76d9f84); -+ ODM_SetBBReg(pDM_Odm,rConfig_Pmpd_AntA, bMaskDWord, 0x0004ab87); -+ ODM_SetBBReg(pDM_Odm,rConfig_AntA, bMaskDWord, 0x00880000); -+ -+ //----send one shot signal----// -+ // Path A -+ ODM_SetBBReg(pDM_Odm,rConfig_Pmpd_AntA, bMaskDWord, 0x80047788); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x00047788); -+ ODM_delay_ms(50); -+ } -+ -+ //PA gain = 11 => tx_agc = 1a -+ for(index = 0; index < 3; index++) -+ ODM_SetBBReg(pDM_Odm,0xe00+index*4, bMaskDWord, 0x34343434); -+ ODM_SetBBReg(pDM_Odm,0xe08+index*4, bMaskDWord, 0x03903434); -+ for(index = 0; index < 4; index++) -+ ODM_SetBBReg(pDM_Odm,0xe10+index*4, bMaskDWord, 0x34343434); -+ -+ //==================================== -+ // PAGE_B for Path-A DPK setting -+ //==================================== -+ // open inner loopback @ b00[19]:10 od 0xb00 0x01097018 -+ ODM_SetBBReg(pDM_Odm,rPdp_AntA, bMaskDWord, 0x02017098); -+ ODM_SetBBReg(pDM_Odm,rPdp_AntA_4, bMaskDWord, 0xf76d9f84); -+ ODM_SetBBReg(pDM_Odm,rConfig_Pmpd_AntA, bMaskDWord, 0x0004ab87); -+ ODM_SetBBReg(pDM_Odm,rConfig_AntA, bMaskDWord, 0x00880000); -+ -+ //rf_lpbk_setup -+ //1.rf 00:5205a, rf 0d:0e52c -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x0c, bMaskDWord, 0x8992b); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x0d, bMaskDWord, 0x0e52c); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x00, bMaskDWord, 0x5205a ); -+ -+ //----send one shot signal----// -+ // Path A -+ ODM_SetBBReg(pDM_Odm,rConfig_Pmpd_AntA, bMaskDWord, 0x800477c0); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm,rConfig_Pmpd_AntA, bMaskDWord, 0x000477c0); -+ ODM_delay_ms(50); -+ -+ while(RetryCount < DP_RETRY_LIMIT && !pDM_Odm->RFCalibrateInfo.bDPPathAOK) -+ { -+ //----read back measurement results----// -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x0c297018); -+ tmpReg = ODM_GetBBReg(pDM_Odm, 0xbe0, bMaskDWord); -+ ODM_delay_ms(10); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x0c29701f); -+ tmpReg2 = ODM_GetBBReg(pDM_Odm, 0xbe8, bMaskDWord); -+ ODM_delay_ms(10); -+ -+ tmpReg = (tmpReg & bMaskHWord) >> 16; -+ tmpReg2 = (tmpReg2 & bMaskHWord) >> 16; -+ if(tmpReg < 0xf0 || tmpReg > 0x105 || tmpReg2 > 0xff ) -+ { -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x02017098); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x800000); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x800477c0); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x000477c0); -+ ODM_delay_ms(50); -+ RetryCount++; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A DPK RetryCount %d 0xbe0[31:16] %x 0xbe8[31:16] %x\n", RetryCount, tmpReg, tmpReg2)); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A DPK Sucess\n")); -+ pDM_Odm->RFCalibrateInfo.bDPPathAOK = TRUE; -+ break; -+ } -+ } -+ RetryCount = 0; -+ -+ //DPP path A -+ if(pDM_Odm->RFCalibrateInfo.bDPPathAOK) -+ { -+ // DP settings -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x01017098); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0x776d9f84); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x0004ab87); -+ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00880000); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); -+ -+ for(i=rPdp_AntA; i<=0xb3c; i+=4) -+ { -+ ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x40004000); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A ofsset = 0x%x\n", i)); -+ } -+ -+ //pwsf -+ ODM_SetBBReg(pDM_Odm, 0xb40, bMaskDWord, 0x40404040); -+ ODM_SetBBReg(pDM_Odm, 0xb44, bMaskDWord, 0x28324040); -+ ODM_SetBBReg(pDM_Odm, 0xb48, bMaskDWord, 0x10141920); -+ -+ for(i=0xb4c; i<=0xb5c; i+=4) -+ { -+ ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x0c0c0c0c); -+ } -+ -+ //TX_AGC boundary -+ ODM_SetBBReg(pDM_Odm, 0xbc0, bMaskDWord, 0x0005361f); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0x00000000); -+ } -+ -+ //DPK path B -+ if(is2T) -+ { -+ //Path A to standby mode -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_AC, bMaskDWord, 0x10000); -+ -+ // LUTs => tx_agc -+ // PA gain = 11 & PAD1, => tx_agc 1f ~11 -+ // PA gain = 11 & PAD2, => tx_agc 10 ~0e -+ // PA gain = 01 => tx_agc 0b ~0d -+ // PA gain = 00 => tx_agc 0a ~00 -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); -+ ODM_SetBBReg(pDM_Odm, 0xbc4, bMaskDWord, 0x0005361f); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0); -+ -+ //do inner loopback DPK 3 times -+ for(i = 0; i < 3; i++) -+ { -+ //PA gain = 11 & PAD2 => tx_agc = 0x0f/0x0c/0x07 -+ for(index = 0; index < 4; index++) -+ ODM_SetBBReg(pDM_Odm, 0x830+index*4, bMaskDWord, Tx_AGC[i][0]); -+ for(index = 0; index < 2; index++) -+ ODM_SetBBReg(pDM_Odm, 0x848+index*4, bMaskDWord, Tx_AGC[i][0]); -+ for(index = 0; index < 2; index++) -+ ODM_SetBBReg(pDM_Odm, 0x868+index*4, bMaskDWord, Tx_AGC[i][0]); -+ -+ // PAGE_B for Path-A inner loopback DPK setting -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x02097098); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0xf76d9f84); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x0004ab87); -+ ODM_SetBBReg(pDM_Odm, rConfig_AntB, bMaskDWord, 0x00880000); -+ -+ //----send one shot signal----// -+ // Path B -+ ODM_SetBBReg(pDM_Odm,rConfig_Pmpd_AntB, bMaskDWord, 0x80047788); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x00047788); -+ ODM_delay_ms(50); -+ } -+ -+ // PA gain = 11 => tx_agc = 1a -+ for(index = 0; index < 4; index++) -+ ODM_SetBBReg(pDM_Odm, 0x830+index*4, bMaskDWord, 0x34343434); -+ for(index = 0; index < 2; index++) -+ ODM_SetBBReg(pDM_Odm, 0x848+index*4, bMaskDWord, 0x34343434); -+ for(index = 0; index < 2; index++) -+ ODM_SetBBReg(pDM_Odm, 0x868+index*4, bMaskDWord, 0x34343434); -+ -+ // PAGE_B for Path-B DPK setting -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x02017098); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0xf76d9f84); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x0004ab87); -+ ODM_SetBBReg(pDM_Odm, rConfig_AntB, bMaskDWord, 0x00880000); -+ -+ // RF lpbk switches on -+ ODM_SetBBReg(pDM_Odm, 0x840, bMaskDWord, 0x0101000f); -+ ODM_SetBBReg(pDM_Odm, 0x840, bMaskDWord, 0x01120103); -+ -+ //Path-B RF lpbk -+ ODM_SetRFReg(pDM_Odm, RF_PATH_B, 0x0c, bMaskDWord, 0x8992b); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_B, 0x0d, bMaskDWord, 0x0e52c); -+ ODM_SetRFReg(pDM_Odm, RF_PATH_B, RF_AC, bMaskDWord, 0x5205a); -+ -+ //----send one shot signal----// -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x800477c0); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x000477c0); -+ ODM_delay_ms(50); -+ -+ while(RetryCount < DP_RETRY_LIMIT && !pDM_Odm->RFCalibrateInfo.bDPPathBOK) -+ { -+ //----read back measurement results----// -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x0c297018); -+ tmpReg = ODM_GetBBReg(pDM_Odm, 0xbf0, bMaskDWord); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x0c29701f); -+ tmpReg2 = ODM_GetBBReg(pDM_Odm, 0xbf8, bMaskDWord); -+ -+ tmpReg = (tmpReg & bMaskHWord) >> 16; -+ tmpReg2 = (tmpReg2 & bMaskHWord) >> 16; -+ -+ if(tmpReg < 0xf0 || tmpReg > 0x105 || tmpReg2 > 0xff) -+ { -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x02017098); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x800000); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x800477c0); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x000477c0); -+ ODM_delay_ms(50); -+ RetryCount++; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK RetryCount %d 0xbf0[31:16] %x, 0xbf8[31:16] %x\n", RetryCount , tmpReg, tmpReg2)); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK Success\n")); -+ pDM_Odm->RFCalibrateInfo.bDPPathBOK = TRUE; -+ break; -+ } -+ } -+ -+ //DPP path B -+ if(pDM_Odm->RFCalibrateInfo.bDPPathBOK) -+ { -+ // DP setting -+ // LUT by SRAM -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x01017098); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0x776d9f84); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x0004ab87); -+ ODM_SetBBReg(pDM_Odm, rConfig_AntB, bMaskDWord, 0x00880000); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); -+ for(i=0xb60; i<=0xb9c; i+=4) -+ { -+ ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x40004000); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B ofsset = 0x%x\n", i)); -+ } -+ -+ // PWSF -+ ODM_SetBBReg(pDM_Odm, 0xba0, bMaskDWord, 0x40404040); -+ ODM_SetBBReg(pDM_Odm, 0xba4, bMaskDWord, 0x28324050); -+ ODM_SetBBReg(pDM_Odm, 0xba8, bMaskDWord, 0x0c141920); -+ -+ for(i=0xbac; i<=0xbbc; i+=4) -+ { -+ ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x0c0c0c0c); -+ } -+ -+ // tx_agc boundary -+ ODM_SetBBReg(pDM_Odm, 0xbc4, bMaskDWord, 0x0005361f); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0); -+ -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0x00000000); -+ } -+ } -+ -+ //reload BB default value -+ for(index=0; indexRFCalibrateInfo.bDPdone = TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==phy_DigitalPredistortion_8812A()\n")); -+#endif -+} -+ -+VOID -+ phy_DigitalPredistortion_8812A_8812A( -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PADAPTER pAdapter -+#else -+ IN PDM_ODM_T pDM_Odm -+#endif -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+#ifdef DISABLE_BB_RF -+ return; -+#endif -+ -+ return; -+ -+ if(pDM_Odm->RFCalibrateInfo.bDPdone) -+ return; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ if(IS_92C_SERIAL( pHalData->VersionID)){ -+ phy_DigitalPredistortion_8812A(pAdapter, TRUE); -+ } -+ else -+#endif -+ { -+ // For 88C 1T1R -+ phy_DigitalPredistortion_8812A(pAdapter, FALSE); -+ } -+} -+ -+ -+ -+//return value TRUE => Main; FALSE => Aux -+ -+ BOOLEAN phy_QueryRFPathSwitch_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN is2T -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ if(!pAdapter->bHWInitReady) -+ { -+ u1Byte u1bTmp; -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_LEDCFG2) | BIT7; -+ ODM_Write1Byte(pDM_Odm, REG_LEDCFG2, u1bTmp); -+ //ODM_SetBBReg(pDM_Odm, REG_LEDCFG0, BIT23, 0x01); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XAB_RFParameter, BIT13, 0x01); -+ } -+ -+ if(is2T) // -+ { -+ if(ODM_GetBBReg(pDM_Odm, rFPGA0_XB_RFInterfaceOE, BIT5|BIT6) == 0x01) -+ return TRUE; -+ else -+ return FALSE; -+ } -+ else -+ { -+ if((ODM_GetBBReg(pDM_Odm, rFPGA0_XB_RFInterfaceOE, BIT5|BIT4|BIT3) == 0x0) || -+ (ODM_GetBBReg(pDM_Odm, rConfig_ram64x16, BIT31) == 0x0)) -+ return TRUE; -+ else -+ return FALSE; -+ } -+} -+ -+ -+ -+//return value TRUE => Main; FALSE => Aux -+ BOOLEAN PHY_QueryRFPathSwitch_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER pAdapter -+#endif -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+#ifdef DISABLE_BB_RF -+ return TRUE; -+#endif -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ //if(IS_92C_SERIAL( pHalData->VersionID)){ -+ if(IS_2T2R( pHalData->VersionID)){ -+ return phy_QueryRFPathSwitch_8812A(pAdapter, TRUE); -+ } -+ else -+#endif -+ { -+ // For 88C 1T1R -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ return phy_QueryRFPathSwitch_8812A(pAdapter, FALSE); -+#else -+ return phy_QueryRFPathSwitch_8812A(pDM_Odm, FALSE); -+#endif -+ } -+} -+#endif -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ap.h linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ap.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ap.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ap.h 2017-06-07 23:07:21.024688761 +0300 -@@ -0,0 +1,153 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL_PHY_RF_8812A_H__ -+#define __HAL_PHY_RF_8812A_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define IQK_DELAY_TIME_8812A 10 //ms -+#define index_mapping_NUM_8812A 15 -+#define AVG_THERMAL_NUM_8812A 4 -+#define RF_T_METER_8812A 0x42 -+ -+ -+#if 0 -+void ConfigureTxpowerTrack_8812A( -+ PTXPWRTRACK_CFG pConfig -+ ); -+ -+ -+ -+ -+void DoIQK_8812A( -+ PVOID pDM_VOID, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ); -+ -+VOID -+ODM_TxPwrTrackSetPwr8812A( -+ PDM_ODM_T pDM_Odm, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ); -+ -+#endif -+ -+ -+//1 7. IQK -+ -+#if 0 -+ -+void -+PHY_IQCalibrate_8812A( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery -+); -+ -+#else -+ -+ -+VOID -+phy_IQCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte Channel -+); -+ -+#endif -+ -+ -+// -+// LC calibrate -+// -+void -+PHY_LCCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm -+); -+ -+// -+// AP calibrate -+// -+void -+PHY_APCalibrate_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN s1Byte delta); -+void -+PHY_DigitalPredistortion_8812A( IN PADAPTER pAdapter); -+ -+ -+#if 0 //FOR_8812_IQK -+VOID -+_PHY_SaveADDARegisters( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte ADDAReg, -+ IN pu4Byte ADDABackup, -+ IN u4Byte RegisterNum -+ ); -+ -+VOID -+_PHY_PathADDAOn( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte ADDAReg, -+ IN BOOLEAN isPathAOn, -+ IN BOOLEAN is2T -+ ); -+ -+VOID -+_PHY_MACSettingCalibration( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte MACReg, -+ IN pu4Byte MACBackup -+ ); -+ -+ -+ -+VOID -+_PHY_PathAStandBy( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER pAdapter -+#endif -+ ); -+ -+#endif -+ -+ -+#endif // #ifndef __HAL_PHY_RF_8812A_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ce.c linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ce.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ce.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ce.c 2017-06-07 23:07:21.024688761 +0300 -@@ -0,0 +1,2197 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+// 2010/04/25 MH Define the max tx power tracking tx agc power. -+#define ODM_TXPWRTRACK_MAX_IDX8812A 6 -+ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+ -+//3============================================================ -+//3 Tx Power Tracking -+//3============================================================ -+ -+ -+void DoIQK_8812A( -+ PVOID pDM_VOID, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+#endif -+ -+ ODM_ResetIQKResult(pDM_Odm); -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; -+ PHY_IQCalibrate_8812A(Adapter, FALSE); -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: odm_TxPwrTrackSetPwr88E() -+ * -+ * Overview: 88E change all channel tx power accordign to flag. -+ * OFDM & CCK are all different. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 04/23/2012 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+VOID -+ODM_TxPwrTrackSetPwr8812A( -+ IN PVOID pDM_VOID, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ) -+{ -+ u4Byte finalBbSwingIdx[2]; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ u1Byte PwrTrackingLimit = 26; //+1.0dB -+ u1Byte TxRate = 0xFF; -+ u1Byte Final_OFDM_Swing_Index = 0; -+ u1Byte Final_CCK_Swing_Index = 0; -+ u1Byte i = 0; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ if (pDM_Odm->mp_mode == TRUE) { -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ #if (MP_DRIVER == 1) -+ PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ #endif -+ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ #endif -+ #endif -+ } else { -+ u2Byte rate = *(pDM_Odm->pForcedDataRate); -+ -+ if (!rate) { /*auto rate*/ -+ if (rate != 0xFF) { -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -+ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ TxRate = HwRateToMRate(pDM_Odm->TxRate); -+ #endif -+ } -+ } else { /*force rate*/ -+ TxRate = (u1Byte)rate; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Power Tracking TxRate=0x%X\n", TxRate)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8812A\n")); -+ -+ if(TxRate != 0xFF) //20130429 Mimic Modify High Rate BBSwing Limit. -+ { -+ //2 CCK -+ if((TxRate >= MGN_1M)&&(TxRate <= MGN_11M)) -+ PwrTrackingLimit = 32; //+4dB -+ //2 OFDM -+ else if((TxRate >= MGN_6M)&&(TxRate <= MGN_48M)) -+ PwrTrackingLimit = 30; //+3dB -+ else if(TxRate == MGN_54M) -+ PwrTrackingLimit = 28; //+2dB -+ //2 HT -+ else if((TxRate >= MGN_MCS0)&&(TxRate <= MGN_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_MCS3)&&(TxRate <= MGN_MCS4)) //16QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if((TxRate >= MGN_MCS5)&&(TxRate <= MGN_MCS7)) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ -+ else if((TxRate >= MGN_MCS8)&&(TxRate <= MGN_MCS10)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_MCS11)&&(TxRate <= MGN_MCS12)) //16QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if((TxRate >= MGN_MCS13)&&(TxRate <= MGN_MCS15)) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ -+ //2 VHT -+ else if((TxRate >= MGN_VHT1SS_MCS0)&&(TxRate <= MGN_VHT1SS_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_VHT1SS_MCS3)&&(TxRate <= MGN_VHT1SS_MCS4)) //16QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if((TxRate >= MGN_VHT1SS_MCS5)&&(TxRate <= MGN_VHT1SS_MCS6)) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ else if(TxRate == MGN_VHT1SS_MCS7) //64QAM -+ PwrTrackingLimit = 26; //+1dB -+ else if(TxRate == MGN_VHT1SS_MCS8) //256QAM -+ PwrTrackingLimit = 24; //+0dB -+ else if(TxRate == MGN_VHT1SS_MCS9) //256QAM -+ PwrTrackingLimit = 22; //-1dB -+ -+ else if((TxRate >= MGN_VHT2SS_MCS0)&&(TxRate <= MGN_VHT2SS_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_VHT2SS_MCS3)&&(TxRate <= MGN_VHT2SS_MCS4)) //16QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if((TxRate >= MGN_VHT2SS_MCS5)&&(TxRate <= MGN_VHT2SS_MCS6)) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ else if(TxRate == MGN_VHT2SS_MCS7) //64QAM -+ PwrTrackingLimit = 26; //+1dB -+ else if(TxRate == MGN_VHT2SS_MCS8) //256QAM -+ PwrTrackingLimit = 24; //+0dB -+ else if(TxRate == MGN_VHT2SS_MCS9) //256QAM -+ PwrTrackingLimit = 22; //-1dB -+ -+ else -+ PwrTrackingLimit = 24; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("TxRate=0x%x, PwrTrackingLimit=%d\n", TxRate, PwrTrackingLimit)); -+ -+ -+ if (Method == BBSWING) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8812A\n")); -+ -+ if (RFPath == ODM_RF_PATH_A) -+ { -+ finalBbSwingIdx[ODM_RF_PATH_A] = (pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A] > PwrTrackingLimit) ? PwrTrackingLimit : pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A]; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A]=%d, pDM_Odm->RealBbSwingIdx[ODM_RF_PATH_A]=%d\n", -+ pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A], finalBbSwingIdx[ODM_RF_PATH_A])); -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_A]]); -+ } -+ else -+ { -+ finalBbSwingIdx[ODM_RF_PATH_B] = (pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_B] > PwrTrackingLimit) ? PwrTrackingLimit : pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_B]; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_B]=%d, pDM_Odm->RealBbSwingIdx[ODM_RF_PATH_B]=%d\n", -+ pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_B], finalBbSwingIdx[ODM_RF_PATH_B])); -+ -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_B]]); -+ } -+ } -+ -+ else if (Method == MIX_MODE) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("pRFCalibrateInfo->DefaultOfdmIndex=%d, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]=%d, RF_Path = %d\n", -+ pRFCalibrateInfo->DefaultOfdmIndex, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath], RFPath)); -+ -+ Final_CCK_Swing_Index = pRFCalibrateInfo->DefaultCckIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; -+ Final_OFDM_Swing_Index = pRFCalibrateInfo->DefaultOfdmIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; -+ -+ if (RFPath == ODM_RF_PATH_A) -+ { -+ if(Final_OFDM_Swing_Index > PwrTrackingLimit) //BBSwing higher then Limit -+ { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx = Final_CCK_Swing_Index - PwrTrackingLimit; /*CCK Follow the same compensate value as Path A*/ -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit; -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[PwrTrackingLimit]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_A); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d\n", PwrTrackingLimit, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else if (Final_OFDM_Swing_Index <= 0) -+ { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx = Final_CCK_Swing_Index; /*CCK Follow the same compensate value as Path A*/ -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index; -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[0]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_A); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d\n", pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[Final_OFDM_Swing_Index]); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Compensate with BBSwing , Final_OFDM_Swing_Index = %d\n", Final_OFDM_Swing_Index)); -+ -+ if (pRFCalibrateInfo->Modify_TxAGC_Flag_PathA) /*If TxAGC has changed, reset TxAGC again*/ -+ { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx = 0; -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = 0; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_A); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A pDM_Odm->Modify_TxAGC_Flag = FALSE\n")); -+ } -+ } -+ } -+ -+ if (RFPath == ODM_RF_PATH_B) -+ { -+ if(Final_OFDM_Swing_Index > PwrTrackingLimit) //BBSwing higher then Limit -+ { -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit; -+ -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[PwrTrackingLimit]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = TRUE; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_B); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d\n", PwrTrackingLimit, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else if (Final_OFDM_Swing_Index <= 0) -+ { -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index; -+ -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[0]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = TRUE; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_B); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d\n", pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[Final_OFDM_Swing_Index]); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Compensate with BBSwing , Final_OFDM_Swing_Index = %d\n", Final_OFDM_Swing_Index)); -+ -+ if (pRFCalibrateInfo->Modify_TxAGC_Flag_PathB) /*If TxAGC has changed, reset TxAGC again*/ -+ { -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = 0; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_B); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B pDM_Odm->Modify_TxAGC_Flag = FALSE\n")); -+ } -+ } -+ } -+ -+ } -+ else -+ { -+ return; -+ } -+} -+ -+VOID -+GetDeltaSwingTable_8812A( -+ IN PVOID pDM_VOID, -+ OUT pu1Byte *TemperatureUP_A, -+ OUT pu1Byte *TemperatureDOWN_A, -+ OUT pu1Byte *TemperatureUP_B, -+ OUT pu1Byte *TemperatureDOWN_B -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u1Byte TxRate = 0xFF; -+ u1Byte channel = pHalData->CurrentChannel; -+ -+ if (pDM_Odm->mp_mode == TRUE) { -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ #if (MP_DRIVER == 1) -+ PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ #endif -+ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ #endif -+ #endif -+ } else { -+ u2Byte rate = *(pDM_Odm->pForcedDataRate); -+ -+ if (!rate) { /*auto rate*/ -+ if (rate != 0xFF) { -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -+ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ TxRate = HwRateToMRate(pDM_Odm->TxRate); -+ #endif -+ } -+ } else { /*force rate*/ -+ TxRate = (u1Byte)rate; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Power Tracking TxRate=0x%X\n", TxRate)); -+ -+ if ( 1 <= channel && channel <= 14) { -+ if (IS_CCK_RATE(TxRate)) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N; -+ } else { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N; -+ } -+ } else if ( 36 <= channel && channel <= 64) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0]; -+ } else if ( 100 <= channel && channel <= 140) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1]; -+ } else if ( 149 <= channel && channel <= 173) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2]; -+ } else { -+ *TemperatureUP_A = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_A = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ *TemperatureUP_B = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_B = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ } -+ -+ return; -+} -+ -+void ConfigureTxpowerTrack_8812A( -+ PTXPWRTRACK_CFG pConfig -+ ) -+{ -+ pConfig->SwingTableSize_CCK = TXSCALE_TABLE_SIZE; -+ pConfig->SwingTableSize_OFDM = TXSCALE_TABLE_SIZE; -+ pConfig->Threshold_IQK = IQK_THRESHOLD; -+ pConfig->AverageThermalNum = AVG_THERMAL_NUM_8812A; -+ pConfig->RfPathCount = MAX_PATH_NUM_8812A; -+ pConfig->ThermalRegAddr = RF_T_METER_8812A; -+ -+ pConfig->ODM_TxPwrTrackSetPwr = ODM_TxPwrTrackSetPwr8812A; -+ pConfig->DoIQK = DoIQK_8812A; -+ pConfig->PHY_LCCalibrate = PHY_LCCalibrate_8812A; -+ pConfig->GetDeltaSwingTable = GetDeltaSwingTable_8812A; -+} -+ -+ -+#define BW_20M 0 -+#define BW_40M 1 -+#define BW_80M 2 -+ -+void _IQK_RX_FillIQC_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN unsigned int RX_X, -+ IN unsigned int RX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ if (RX_X>>1 >=0x112 || (RX_Y>>1 >= 0x12 && RX_Y>>1 <= 0x3ee)){ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x100); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, RX_X>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, RX_Y>>1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc10 = %x ====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xc10))); -+ } -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ if (RX_X>>1 >=0x112 || (RX_Y>>1 >= 0x12 && RX_Y>>1 <= 0x3ee)){ -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x100); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, 0); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, RX_X>>1); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, RX_Y>>1); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x====>fill to IQC\n ", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe10 = %x====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xe10))); -+ } -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_TX_FillIQC_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN unsigned int TX_X, -+ IN unsigned int TX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xc90, BIT(7), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT(18), 0x1); -+ if (!pDM_Odm->DPK_Done) -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT(29), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc8, BIT(29), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, TX_Y); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, TX_X); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X&0x000007ff, TX_Y&0x000007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xcd4 = %x;;0xccc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xcd4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xccc, 0x000007ff))); -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xe90, BIT(7), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT(18), 0x1); -+ if (!pDM_Odm->DPK_Done) -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT(29), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec8, BIT(29), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xecc, 0x000007ff, TX_Y); -+ ODM_SetBBReg(pDM_Odm, 0xed4, 0x000007ff, TX_X); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X&0x000007ff, TX_Y&0x000007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xed4 = %x;;0xecc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xed4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xecc, 0x000007ff))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_BackupMacBB_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //save MACBB default value -+ for (i = 0; i < MACBB_NUM; i++){ -+ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupMacBB Success!!!!\n")); -+} -+void _IQK_BackupRF_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte RFA_backup, -+ IN pu4Byte RFB_backup, -+ IN pu4Byte Backup_RF_REG, -+ IN u4Byte RF_NUM -+ ) -+{ -+ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save RF Parameters -+ for (i = 0; i < RF_NUM; i++){ -+ RFA_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG[i], bMaskDWord); -+ RFB_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, Backup_RF_REG[i], bMaskDWord); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupRF Success!!!!\n")); -+} -+void _IQK_BackupAFE_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ AFE_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_AFE_REG[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupAFE Success!!!!\n")); -+} -+void _IQK_RestoreMacBB_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload MacBB Parameters -+ for (i = 0; i < MACBB_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreMacBB Success!!!!\n")); -+} -+void _IQK_RestoreRF_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN pu4Byte Backup_RF_REG, -+ IN pu4Byte RF_backup, -+ IN u4Byte RF_REG_NUM -+ ) -+{ -+ u4Byte i; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ for (i = 0; i < RF_REG_NUM; i++) -+ ODM_SetRFReg(pDM_Odm, Path, Backup_RF_REG[i], bRFRegOffsetMask, RF_backup[i]); -+ -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x0); -+ -+ switch(Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path A Success!!!!\n")); -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path B Success!!!!\n")); -+ } -+ break; -+ default: -+ break; -+ } -+} -+void _IQK_RestoreAFE_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_AFE_REG[i], AFE_backup[i]); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); -+ ODM_SetBBReg(pDM_Odm, 0xc90, BIT(7), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT(18), 0x1); -+ if (!pDM_Odm->DPK_Done) -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT(29), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc8, BIT(29), 0x1); -+ //ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x3c000000); -+ ODM_SetBBReg(pDM_Odm, 0xe90, BIT(7), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT(18), 0x1); -+ if (!pDM_Odm->DPK_Done) -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT(29), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec8, BIT(29), 0x1); -+ //ODM_Write4Byte(pDM_Odm, 0xeb8, 0x0); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreAFE Success!!!!\n")); -+} -+ -+ -+void _IQK_ConfigureMAC_8812A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ // ========MAC register setting======== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_Write1Byte(pDM_Odm, 0x522, 0x3f); -+ ODM_SetBBReg(pDM_Odm, 0x550, BIT(11)|BIT(3), 0x0); -+ ODM_Write1Byte(pDM_Odm, 0x808, 0x00); // RX ante off -+ ODM_SetBBReg(pDM_Odm, 0x838, 0xf, 0xc); // CCA off -+ ODM_Write1Byte(pDM_Odm, 0xa07, 0xf); // CCK RX Path off -+} -+ -+#define cal_num 10 -+ -+void _IQK_Tx_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte chnlIdx -+ ) -+{ -+ u1Byte delay_count, cal = 0; -+ u1Byte cal0_retry, cal1_retry, TX0_Average = 0, TX1_Average = 0, RX0_Average = 0, RX1_Average = 0; -+ int TX_IQC_temp[10][4], TX_IQC[4]={}; //TX_IQC = [TX0_X, TX0_Y,TX1_X,TX1_Y]; for 3 times -+ int RX_IQC_temp[10][4], RX_IQC[4]={}; //RX_IQC = [RX0_X, RX0_Y,RX1_X,RX1_Y]; for 3 times -+ BOOLEAN TX0_fail = TRUE, RX0_fail = TRUE, IQK0_ready = FALSE, TX0_finish = FALSE, RX0_finish = FALSE; -+ BOOLEAN TX1_fail = TRUE, RX1_fail = TRUE, IQK1_ready = FALSE, TX1_finish = FALSE, RX1_finish = FALSE, VDF_enable = FALSE; -+ int i, ii, dx = 0, dy = 0; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BandWidth = %d, ExtPA5G = %d, ExtPA2G = %d\n", *pDM_Odm->pBandWidth, pDM_Odm->ExtPA5G, pDM_Odm->ExtPA)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Interface = %d, RFE_Type = %d\n", pDM_Odm->SupportInterface, pDM_Odm->RFEType)); -+ if (*pDM_Odm->pBandWidth == 2){ -+ VDF_enable = TRUE; -+ } -+ VDF_enable = FALSE; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // ========Path-A AFE all on======== -+ // Port 0 DAC/ADC on -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); -+ -+ // Port 1 DAC/ADC on -+ ODM_Write4Byte(pDM_Odm, 0xe60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xe64, 0x77777777); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe68, 0x19791979); -+ ODM_SetBBReg(pDM_Odm, 0xc00, 0xf, 0x4);// hardware 3-wire off -+ ODM_SetBBReg(pDM_Odm, 0xe00, 0xf, 0x4);// hardware 3-wire off -+ -+ // DAC/ADC sampling rate (160 MHz) -+ ODM_SetBBReg(pDM_Odm, 0xc5c, BIT(26)|BIT(25)|BIT(24), 0x7); -+ ODM_SetBBReg(pDM_Odm, 0xe5c, BIT(26)|BIT(25)|BIT(24), 0x7); -+ -+ //====== Path A TX IQK RF Setting ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, bRFRegOffsetMask, 0x80002); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, bRFRegOffsetMask, 0x3fffd); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, bRFRegOffsetMask, 0xfe83f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8f, bRFRegOffsetMask, 0x8a001); -+ //====== Path B TX IQK RF Setting ====== -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, bRFRegOffsetMask, 0x80002); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, bRFRegOffsetMask, 0x3fffd); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, bRFRegOffsetMask, 0xfe83f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xe94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA5G){ -+ if (pDM_Odm->RFEType == 1){ -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403e3); -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x821403e3); -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x821403f7); -+ } -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f1); -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x821403f1); -+ } -+ if (*pDM_Odm->pBandType){ -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x68163e96); -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28163e96); -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28163e96); -+ if (pDM_Odm->RFEType == 3){ -+ if (pDM_Odm->ExtPA) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403e3); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ } -+ } -+ -+ if (VDF_enable){} -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xee8, 0x00000000); -+ -+ cal0_retry = 0; -+ cal1_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ if (!TX0_finish) -+ IQK0_ready = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if (!TX1_finish) -+ IQK1_ready = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); -+ if ((IQK0_ready && IQK1_ready) || (delay_count>20)) -+ break; -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX delay_count = %d\n", delay_count)); -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX0_fail = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ TX1_fail = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd40, BIT(12)); -+ if (!(TX0_fail || TX0_finish)){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ TX_IQC_temp[TX0_Average][0] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ TX_IQC_temp[TX0_Average][1] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X0[%d] = %x ;; TX_Y0[%d] = %x\n", TX0_Average, (TX_IQC_temp[TX0_Average][0])>>21&0x000007ff, TX0_Average, (TX_IQC_temp[TX0_Average][1])>>21&0x000007ff)); -+ /* -+ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x01000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x03000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+ */ -+ TX0_Average++; -+ } -+ else{ -+ cal0_retry++; -+ if (cal0_retry == 10) -+ break; -+ } -+ if (!(TX1_fail || TX1_finish)){ -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x02000000); -+ TX_IQC_temp[TX1_Average][2] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x04000000); -+ TX_IQC_temp[TX1_Average][3] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X1[%d] = %x ;; TX_Y1[%d] = %x\n", TX1_Average, (TX_IQC_temp[TX1_Average][2])>>21&0x000007ff, TX1_Average, (TX_IQC_temp[TX1_Average][3])>>21&0x000007ff)); -+ /* -+ int reg1 = 0, reg2 = 0, Image_Power = 0; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x01000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x02000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x03000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x04000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+ */ -+ TX1_Average++; -+ } -+ else{ -+ cal1_retry++; -+ if (cal1_retry == 10) -+ break; -+ } -+ } -+ else{ -+ cal0_retry++; -+ cal1_retry++; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay 20ms TX IQK Not Ready!!!!!\n")); -+ if (cal0_retry == 10) -+ break; -+ } -+ if (TX0_Average >= 2){ -+ for (i = 0; i < TX0_Average; i++){ -+ for (ii = i+1; ii >21) - (TX_IQC_temp[ii][0]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (TX_IQC_temp[i][1]>>21) - (TX_IQC_temp[ii][1]>>21); -+ if (dy < 4 && dy > -4){ -+ TX_IQC[0] = ((TX_IQC_temp[i][0]>>21) + (TX_IQC_temp[ii][0]>>21))/2; -+ TX_IQC[1] = ((TX_IQC_temp[i][1]>>21) + (TX_IQC_temp[ii][1]>>21))/2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXA_X = %x;;TXA_Y = %x\n", TX_IQC[0]&0x000007ff, TX_IQC[1]&0x000007ff)); -+ TX0_finish = TRUE; -+ } -+ } -+ } -+ } -+ } -+ if (TX1_Average >= 2){ -+ for (i = 0; i < TX1_Average; i++){ -+ for (ii = i+1; ii >21) - (TX_IQC_temp[ii][2]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (TX_IQC_temp[i][3]>>21) - (TX_IQC_temp[ii][3]>>21); -+ if (dy < 4 && dy > -4){ -+ TX_IQC[2] = ((TX_IQC_temp[i][2]>>21) + (TX_IQC_temp[ii][2]>>21))/2; -+ TX_IQC[3] = ((TX_IQC_temp[i][3]>>21) + (TX_IQC_temp[ii][3]>>21))/2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXB_X = %x;;TXB_Y = %x\n", TX_IQC[2]&0x000007ff, TX_IQC[3]&0x000007ff)); -+ TX1_finish = TRUE; -+ } -+ } -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX0_Average = %d, TX1_Average = %d\n", TX0_Average, TX1_Average)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX0_finish = %d, TX1_finish = %d\n", TX0_finish, TX1_finish)); -+ if (TX0_finish && TX1_finish) -+ break; -+ if ((cal0_retry + TX0_Average) >= 10 || (cal1_retry + TX1_Average) >= 10 ) -+ break; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXA_cal_retry = %d\n", cal0_retry)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXB_cal_retry = %d\n", cal1_retry)); -+ -+ } -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8, 0xffc00)); // Load LOK -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x8, 0xffc00)); // Load LOK -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (VDF_enable == 1){} -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ if (TX0_finish){ -+ //====== Path A RX IQK RF Setting====== -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, bRFRegOffsetMask, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, bRFRegOffsetMask, 0xfe7bf); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x65, bRFRegOffsetMask, 0x931d1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, bRFRegOffsetMask, 0x00000); -+ } -+ if (TX1_finish){ -+ //====== Path B RX IQK RF Setting====== -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, bRFRegOffsetMask, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, bRFRegOffsetMask, 0xfe7bf); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x65, bRFRegOffsetMask, 0x931d1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, bRFRegOffsetMask, 0x00000); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ else -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a890); -+ //ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a890); -+ if (pDM_Odm->RFEType == 1){ -+ ODM_Write4Byte(pDM_Odm, 0xcb0, 0x77777717); -+ ODM_Write4Byte(pDM_Odm, 0xcb4, 0x00000077); -+ ODM_Write4Byte(pDM_Odm, 0xeb0, 0x77777717); -+ ODM_Write4Byte(pDM_Odm, 0xeb4, 0x00000077); -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xcb0, 0x77777717); -+ ODM_Write4Byte(pDM_Odm, 0xcb4, 0x02000077); -+ ODM_Write4Byte(pDM_Odm, 0xeb0, 0x77777717); -+ ODM_Write4Byte(pDM_Odm, 0xeb4, 0x02000077); -+ } -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ if (TX0_finish){ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x82140119); -+ } -+ if (TX1_finish){ -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x82140119); -+ } -+ cal0_retry = 0; -+ cal1_retry = 0; -+ while(1){ -+ // one shot -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ if (TX0_finish){ -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_IQC[0])&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_IQC[1])&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ if (pDM_Odm->RFEType == 1){ -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161500); -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28160cc0); -+ } -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00300000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000); -+ ODM_delay_ms(5); //Delay 5ms -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ } -+ if (TX1_finish){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_IQC[2])&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_IQC[3])&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ if (pDM_Odm->RFEType == 1){ -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28161500); -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28160ca0); -+ } -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00300000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_delay_ms(5); //Delay 5ms -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x3c000000); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); -+ } -+ delay_count = 0; -+ while (1){ -+ if (!RX0_finish && TX0_finish) -+ IQK0_ready = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if (!RX1_finish && TX1_finish) -+ IQK1_ready = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); -+ if ((IQK0_ready && IQK1_ready)||(delay_count>20)) -+ break; -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX delay_count = %d\n", delay_count)); -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX0_fail = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); -+ RX1_fail = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd40, BIT(11)); -+ if (!(RX0_fail || RX0_finish) && TX0_finish){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ RX_IQC_temp[RX0_Average][0] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ RX_IQC_temp[RX0_Average][1] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[%d] = %x ;; RX_Y0[%d] = %x\n", RX0_Average, (RX_IQC_temp[RX0_Average][0])>>21&0x000007ff, RX0_Average, (RX_IQC_temp[RX0_Average][1])>>21&0x000007ff)); -+/* -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x05000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ DbgPrint("reg1 = %d, reg2 = %d", reg1, reg2); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x07000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+*/ -+ RX0_Average++; -+ } -+ else{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("1. RXA_cal_retry = %d\n", cal0_retry)); -+ cal0_retry++; -+ if (cal0_retry == 10) -+ break; -+ } -+ if (!(RX1_fail || RX1_finish) && TX1_finish){ -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x06000000); -+ RX_IQC_temp[RX1_Average][2] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x08000000); -+ RX_IQC_temp[RX1_Average][3] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X1[%d] = %x ;; RX_Y1[%d] = %x\n", RX1_Average, (RX_IQC_temp[RX1_Average][2])>>21&0x000007ff, RX1_Average, (RX_IQC_temp[RX1_Average][3])>>21&0x000007ff)); -+/* -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x05000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x06000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ DbgPrint("reg1 = %d, reg2 = %d", reg1, reg2); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x07000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x08000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+*/ -+ RX1_Average++; -+ } -+ else{ -+ cal1_retry++; -+ if (cal1_retry == 10) -+ break; -+ } -+ -+ } -+ else{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("2. RXA_cal_retry = %d\n", cal0_retry)); -+ cal0_retry++; -+ cal1_retry++; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay 20ms RX IQK Not Ready!!!!!\n")); -+ if (cal0_retry == 10) -+ break; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("3. RXA_cal_retry = %d\n", cal0_retry)); -+ if (RX0_Average >= 2){ -+ for (i = 0; i < RX0_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_IQC_temp[ii][0]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_IQC_temp[i][1]>>21) - (RX_IQC_temp[ii][1]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_IQC[0]= ((RX_IQC_temp[i][0]>>21) + (RX_IQC_temp[ii][0]>>21))/2; -+ RX_IQC[1] = ((RX_IQC_temp[i][1]>>21) + (RX_IQC_temp[ii][1]>>21))/2; -+ RX0_finish = TRUE; -+ break; -+ } -+ } -+ } -+ } -+ } -+ if (RX1_Average >= 2){ -+ for (i = 0; i < RX1_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_IQC_temp[ii][2]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_IQC_temp[i][3]>>21) - (RX_IQC_temp[ii][3]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_IQC[2] = ((RX_IQC_temp[i][2]>>21) + (RX_IQC_temp[ii][2]>>21))/2; -+ RX_IQC[3] = ((RX_IQC_temp[i][3]>>21) + (RX_IQC_temp[ii][3]>>21))/2; -+ RX1_finish = TRUE; -+ break; -+ } -+ } -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX0_Average = %d, RX1_Average = %d\n", RX0_Average, RX1_Average)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX0_finish = %d, RX1_finish = %d\n", RX0_finish, RX1_finish)); -+ if ((RX0_finish|| !TX0_finish) && (RX1_finish || !TX1_finish) ) -+ break; -+ if ((cal0_retry + RX0_Average) >= 10 || (cal1_retry + RX1_Average) >= 10 || RX0_Average == 3 || RX1_Average == 3) -+ break; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXA_cal_retry = %d\n", cal0_retry)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXB_cal_retry = %d\n", cal1_retry)); -+ } -+ -+ // FillIQK Result -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_A =======\n")); -+ -+ if (TX0_finish){ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_A, TX_IQC[0], TX_IQC[1]); -+ } -+ else{ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_A, 0x200, 0x0); -+ } -+ -+ -+ -+ if (RX0_finish){ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_A, RX_IQC[0], RX_IQC[1]); -+ } -+ else{ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_A, 0x200, 0x0); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_B =======\n")); -+ -+ if (TX1_finish){ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_B, TX_IQC[2], TX_IQC[3]); -+ } -+ else{ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_B, 0x200, 0x0); -+ } -+ -+ -+ -+ if (RX1_finish){ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_B, RX_IQC[2], RX_IQC[3]); -+ } -+ else{ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_B, 0x200, 0x0); -+ } -+ -+ -+ -+} -+ -+#define MACBB_REG_NUM 9 -+#define AFE_REG_NUM 12 -+#define RF_REG_NUM 3 -+ -+// Maintained by BB James. -+VOID -+phy_IQCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte Channel -+ ) -+{ -+ u4Byte MACBB_backup[MACBB_REG_NUM], AFE_backup[AFE_REG_NUM] = {0}, RFA_backup[RF_REG_NUM] = {0}, RFB_backup[RF_REG_NUM] = {0}; -+ u4Byte Backup_MACBB_REG[MACBB_REG_NUM] = {0x520, 0x550, 0x808, 0xa04, 0x90c, 0xc00, 0xe00, 0x838, 0x82c}; -+ u4Byte Backup_AFE_REG[AFE_REG_NUM] = {0xc5c, 0xc60, 0xc64, 0xc68, 0xcb0, 0xcb4, -+ 0xe5c, 0xe60, 0xe64, 0xe68, 0xeb0, 0xeb4}; -+ u4Byte Reg_C1B8, Reg_E1B8; -+ u4Byte Backup_RF_REG[RF_REG_NUM] = {0x65, 0x8f, 0x0}; -+ u1Byte chnlIdx = ODM_GetRightChnlPlaceforIQK(Channel); -+ -+ _IQK_BackupMacBB_8812A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ Reg_C1B8 = ODM_Read4Byte(pDM_Odm, 0xcb8); -+ Reg_E1B8 = ODM_Read4Byte(pDM_Odm, 0xeb8); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ _IQK_BackupAFE_8812A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); -+ _IQK_BackupRF_8812A(pDM_Odm, RFA_backup, RFB_backup, Backup_RF_REG, RF_REG_NUM); -+ -+ _IQK_ConfigureMAC_8812A(pDM_Odm); -+ _IQK_Tx_8812A(pDM_Odm, chnlIdx); -+ _IQK_RestoreRF_8812A(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG, RFA_backup, RF_REG_NUM); -+ _IQK_RestoreRF_8812A(pDM_Odm, ODM_RF_PATH_B, Backup_RF_REG, RFB_backup, RF_REG_NUM); -+ -+ _IQK_RestoreAFE_8812A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, Reg_C1B8); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, Reg_E1B8); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ _IQK_RestoreMacBB_8812A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); -+ -+ -+} -+ -+VOID -+phy_LCCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN BOOLEAN is2T -+ ) -+{ -+ u4Byte /*RF_Amode=0, RF_Bmode=0,*/ LC_Cal = 0, tmp = 0; -+ -+ //Check continuous TX and Packet TX -+ u4Byte reg0x914 = ODM_Read4Byte(pDM_Odm, rSingleTone_ContTx_Jaguar);; -+ -+ // Backup RF reg18. -+ LC_Cal = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); -+ -+ if((reg0x914 & 0x70000) != 0) //If contTx, disable all continuous TX. 0x914[18:16] -+ // <20121121, Kordan> A workaround: If we set 0x914[18:16] as zero, BB turns off ContTx -+ // until another packet comes in. To avoid ContTx being turned off, we skip this step. -+ ;//ODM_Write4Byte(pDM_Odm, rSingleTone_ContTx_Jaguar, reg0x914 & (~0x70000)); -+ else // If packet Tx-ing, pause Tx. -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0xFF); -+ -+ -+/* -+ //3 1. Read original RF mode -+ RF_Amode = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask); -+ if(is2T) -+ RF_Bmode = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bRFRegOffsetMask); -+ -+ -+ //3 2. Set RF mode = standby mode -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask, (RF_Amode&0x8FFFF)|0x10000); -+ if(is2T) -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bRFRegOffsetMask, (RF_Bmode&0x8FFFF)|0x10000); -+*/ -+ -+ // Enter LCK mode -+ tmp = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask, tmp | BIT14); -+ -+ //3 3. Read RF reg18 -+ LC_Cal = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); -+ -+ //3 4. Set LC calibration begin bit15 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal|0x08000); -+ -+ ODM_delay_ms(150); // suggest by RFSI Binson -+ -+ // Leave LCK mode -+ tmp = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask, tmp & ~BIT14); -+ -+ -+ -+ //3 Restore original situation -+ if((reg0x914 & 70000) != 0) //Deal with contisuous TX case, 0x914[18:16] -+ { -+ // <20121121, Kordan> A workaround: If we set 0x914[18:16] as zero, BB turns off ContTx -+ // until another packet comes in. To avoid ContTx being turned off, we skip this step. -+ //ODM_Write4Byte(pDM_Odm, rSingleTone_ContTx_Jaguar, reg0x914); -+ } -+ else // Deal with Packet TX case -+ { -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0x00); -+ } -+ -+ // Recover channel number -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal); -+ -+ /* -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask, RF_Amode); -+ if(is2T) -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bRFRegOffsetMask, RF_Bmode); -+ */ -+ -+} -+ -+ -+ -+ -+ -+#define DP_BB_REG_NUM 7 -+#define DP_RF_REG_NUM 1 -+#define DP_RETRY_LIMIT 10 -+#define DP_PATH_NUM 2 -+#define DP_DPK_NUM 3 -+#define DP_DPK_VALUE_NUM 2 -+ -+VOID -+phy_ReloadIQKSetting_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte Channel -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ u1Byte chnlIdx = ODM_GetRightChnlPlaceforIQK(Channel); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][0]&0x7ff); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][0]&0x7ff0000)>>16); -+ ODM_SetBBReg(pDM_Odm, 0xecc, 0x000007ff, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][2]&0x7ff); -+ ODM_SetBBReg(pDM_Odm, 0xed4, 0x000007ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][2]&0x7ff0000)>>16); -+ -+ if (*pDM_Odm->pBandWidth != 2){ -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xee8, 0x0); -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xce8, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][4]); -+ ODM_Write4Byte(pDM_Odm, 0xee8, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][5]); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][1]&0x7ff0000)>>17); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][1]&0x7ff)>>1); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][3]&0x7ff0000)>>17); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][3]&0x7ff)>>1); -+ -+ -+} -+ -+VOID -+PHY_ResetIQKResult_8812A( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ ODM_SetBBReg(pDM_Odm, 0xecc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xed4, 0x000007ff, 0x200); -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xee8, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x100); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x100); -+} -+ -+VOID -+phy_IQCalibrate_By_FW_8812A( -+ IN PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u1Byte IQKcmd[3] = {pHalData->CurrentChannel, 0x0, 0x0}; -+ u1Byte Buf1 = 0x0; -+ u1Byte Buf2 = 0x0; -+ -+//Byte 2, Bit 4 ~ Bit 5 : BandType -+ if(pHalData->CurrentBandType) -+ Buf1 = 0x2<<4; -+ else -+ Buf1 = 0x1<<4; -+ -+//Byte 2, Bit 0 ~ Bit 3 : Bandwidth -+ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) -+ Buf2 = 0x1; -+ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) -+ Buf2 = 0x1<<1; -+ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) -+ Buf2 = 0x1<<2; -+ else -+ Buf2 = 0x1<<3; -+ -+ IQKcmd[1] = Buf1 | Buf2; -+ IQKcmd[2] = pHalData->ExternalPA_5G | pHalData->ExternalLNA_5G<<1; -+ -+ DBG_871X("== IQK Start ==\n"); -+ -+ FillH2CCmd_8812(pAdapter, 0x45, 3, IQKcmd); -+ -+ rtl8812_iqk_wait(pAdapter, 500); -+} -+ -+VOID -+PHY_IQCalibrate_8812A( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery -+ ) -+{ -+ u4Byte counter = 0; -+ u4Byte StartTime; -+ s4Byte ProgressingTime; -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); -+ #else // (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+#endif -+ -+#if (MP_DRIVER == 1) -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+ #else// (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ #endif -+#endif//(MP_DRIVER == 1) -+ -+//#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE) ) -+ //if (ODM_CheckPowerStatus(pAdapter) == FALSE) -+ //return; -+//#endif -+ pDM_Odm->IQKFWOffload = 0; -+ StartTime = ODM_GetCurrentTime( pDM_Odm); -+ -+#if MP_DRIVER == 1 -+ if( ! (pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) ) -+#endif -+ { -+ -+ if(pDM_Odm->IQKFWOffload) -+ { -+ phy_IQCalibrate_By_FW_8812A(pAdapter); -+ } -+ else -+ { -+ phy_IQCalibrate_8812A(pDM_Odm, pHalData->CurrentChannel); -+ } -+ } -+ ProgressingTime = ODM_GetProgressingTime( pDM_Odm, StartTime); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK ProgressingTime = %d\n", ProgressingTime)); -+} -+ -+ -+VOID -+PHY_LCCalibrate_8812A( -+ IN PVOID pDM_VOID -+ ) -+{ -+ BOOLEAN bStartContTx = FALSE, bSingleTone = FALSE, bCarrierSuppression = FALSE; -+ u4Byte StartTime; -+ s4Byte ProgressingTime; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ #if (MP_DRIVER == 1) -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+ #else// (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ #endif -+ bStartContTx = pMptCtx->bStartContTx; -+ bSingleTone = pMptCtx->bSingleTone; -+ bCarrierSuppression = pMptCtx->bCarrierSuppression; -+ #endif//(MP_DRIVER == 1) -+#endif -+ -+ StartTime = ODM_GetCurrentTime( pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> PHY_LCCalibrate_8812A\n")); -+ -+ phy_LCCalibrate_8812A(pDM_Odm, TRUE); -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== PHY_LCCalibrate_8812A\n")); -+ ProgressingTime = ODM_GetProgressingTime( pDM_Odm, StartTime); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK ProgressingTime = %d\n", ProgressingTime)); -+ -+} -+ -+VOID phy_SetRFPathSwitch_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bMain, -+ IN BOOLEAN is2T -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+ -+#endif -+ -+ if (IS_HARDWARE_TYPE_8821(pAdapter)) -+ { -+ if(bMain) -+ ODM_SetBBReg(pDM_Odm, rA_RFE_Pinmux_Jaguar+4, BIT29|BIT28, 0x1); //Main -+ else -+ ODM_SetBBReg(pDM_Odm, rA_RFE_Pinmux_Jaguar+4, BIT29|BIT28, 0x2); //Aux -+ } -+ else if (IS_HARDWARE_TYPE_8812(pAdapter)) -+ { -+ if (pHalData->RFEType == 5) -+ { -+ if(bMain) { -+ //WiFi -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x2); -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); -+ } else { -+ // BT -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x1); -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); -+ } -+ } -+ } -+ -+} -+ -+VOID PHY_SetRFPathSwitch_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bMain -+ ) -+{ -+ -+#if DISABLE_BB_RF -+ return; -+#endif -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ phy_SetRFPathSwitch_8812A(pAdapter, bMain, TRUE); -+ -+#endif -+} -+ -+ -+VOID -+_DPK_ThermalCompensation( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+VOID -+_DPK_parareload( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ -+ -+ ) -+{ -+ u4Byte i; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //save MACBB default value -+ for (i = 0; i < MACBB_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); -+ } -+} -+ -+ -+VOID -+_DPK_parabackup( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ -+ -+ ) -+{ -+ u4Byte i; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //save MACBB default value -+ for (i = 0; i < MACBB_NUM; i++){ -+ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); -+ } -+} -+ -+VOID -+_DPK_Globalparaset( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+ //***************************************// -+ //set MAC register -+ //***************************************// -+ -+ //TX pause -+ ODM_Write4Byte(pDM_Odm, 0x520, 0x007f3F0F); -+ -+ //***************************************// -+ //set BB register -+ //***************************************// -+ -+ // reg82c[31] = b'0, page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083d5); -+ -+ // test pin in/out control -+ ODM_Write4Byte(pDM_Odm, 0x970, 0x00000000); -+ -+ // path A regcb8[3:0] = h'd, TRSW to TX -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0050824d); -+ -+ // path B regeb8[3:0] = h'd, TRSW to TX -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x0050824d); -+ -+ // reg838[3:0] = h'c, CCA off -+ ODM_Write4Byte(pDM_Odm, 0x838, 0x06c8d24c); -+ -+ // path A 3-wire off -+ ODM_Write4Byte(pDM_Odm, 0xc00, 0x00000004); -+ -+ // path B 3-wire off -+ ODM_Write4Byte(pDM_Odm, 0xe00, 0x00000004); -+ -+ // reg90c[15] = b'1, DAC fifo reset by CSWU -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ -+ // reset DPK circuit -+ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); -+ -+ // path A regc94[0] = b'1 (r_gothrough_iqkdpk), N DPK i normal path -+ ODM_Write4Byte(pDM_Odm, 0xc94, 0x01000001); -+ -+ // path B rege94[0] = b'1 (r_gothrough_iqkdpk), N DPK i normal path -+ ODM_Write4Byte(pDM_Odm, 0xe94, 0x01000001); -+ -+ //***************************************// -+ //set AFE register -+ //***************************************// -+ -+ //path A -+ //regc68 regc84ӬOn򥿱` Tx mode ɪ]w@P -+ -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc6c, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc70, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc74, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc78, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc7c, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x19791979); -+ -+ // force DAC/ADC power on -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); -+ -+ //path B -+ //rege68 rege84ӬOn򥿱` Tx mode ɪ]w@P -+ -+ ODM_Write4Byte(pDM_Odm, 0xe68, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe6c, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe70, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe74, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe78, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe7c, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x19791979); -+ -+ // force DAC/ADC power on -+ ODM_Write4Byte(pDM_Odm, 0xe60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xe64, 0x77777777); -+ -+} -+ -+ -+VOID -+_DPK_GetGainLoss( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte path -+ ) -+{ -+ u4Byte GL_I=0,GL_Q=0; -+ u4Byte GL_I_tmp=0,GL_Q_tmp=0; -+ -+ u4Byte Power_GL; -+ u2Byte Scaler[]={0x4000, 0x41db, 0x43c7, 0x45c3, 0x47cf, 0x49ec, 0x4c19, 0x4e46, 0x5093,0x52f2, //10 -+ 0x5560, 0x57cf, 0x5a7f, 0x5d0e, 0x5fbe -+ }; -+ u1Byte sindex=0; -+ u4Byte pagesel = 0,regsel = 0; -+ -+ if(path == 0) //pathA -+ { -+ pagesel = 0; -+ regsel = 0; -+ } -+ else //pathB -+ { -+ pagesel = 0x200; -+ regsel = 0x40; -+ } -+ -+ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0601f0bf); -+ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x0c000000); -+ -+ -+ -+ GL_I_tmp = ODM_GetBBReg(pDM_Odm, 0xd00+regsel, 0xffff0000); -+ GL_Q_tmp = ODM_GetBBReg(pDM_Odm, 0xd00+regsel, 0x0000ffff); -+ -+ if(GL_I_tmp >= 0x8000) -+ GL_I = (GL_I_tmp-0x8000+0x1); -+ else -+ GL_I = GL_I_tmp; -+ -+ -+ if(GL_Q_tmp >= 0x8000) -+ GL_Q = (GL_Q_tmp-0x8000+0x1); -+ else -+ GL_Q = GL_Q_tmp; -+ -+ Power_GL = ((GL_I*GL_I)+(GL_Q*GL_Q))/4; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Power_GL = 0x%x", Power_GL)); -+ -+ if (Power_GL > 63676){ -+ sindex = 0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 0 dB\n")); -+ } -+ else if (63676 >= Power_GL && Power_GL > 60114){ -+ sindex = 1; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 0.25 dB\n")); -+ } -+ else if (60114 >= Power_GL && Power_GL> 56751){ -+ sindex = 2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 0.5 dB\n")); -+ } -+ else if (56751 >= Power_GL && Power_GL> 53577){ -+ sindex = 3; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 0.75 dB\n")); -+ } -+ else if (53577 >= Power_GL && Power_GL> 49145){ -+ sindex = 4; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 1 dB\n")); -+ } -+ else if (49145 >= Power_GL && Power_GL> 47750){ -+ sindex = 5; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 1.25 dB\n")); -+ } -+ else if (47750 >= Power_GL && Power_GL> 45079){ -+ sindex = 6; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 1.5 dB\n")); -+ } -+ else if (45079 >= Power_GL && Power_GL> 42557){ -+ sindex = 7; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 1.75 dB\n")); -+ } -+ else if (42557 >= Power_GL && Power_GL> 40177){ -+ sindex = 8; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 2 dB\n")); -+ } -+ else if (40177 >= Power_GL && Power_GL> 37929){ -+ sindex = 9; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 2.25 dB\n")); -+ } -+ else if (37929 >= Power_GL && Power_GL> 35807){ -+ sindex = 10; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 2.5 dB\n")); -+ } -+ else if (35807 >= Power_GL && Power_GL> 33804){ -+ sindex = 11; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 2.75 dB\n")); -+ } -+ else if (33804 >= Power_GL && Power_GL> 31913){ -+ sindex = 12; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 3 dB\n")); -+ } -+ else if (31913 >= Power_GL && Power_GL> 30128){ -+ sindex = 13; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 3.25 dB\n")); -+ } -+ else if (30128 >= Power_GL){ -+ sindex = 14; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 3.5 dB\n")); -+ } -+ -+ -+ ODM_Write4Byte(pDM_Odm, 0xc98+pagesel, (Scaler[sindex] << 16) | Scaler[sindex]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Set Gainloss reg 0xc98(0xe98)= 0x%x\n",ODM_Read4Byte(pDM_Odm, 0xc98+pagesel))); -+ -+} -+ -+ -+VOID -+_DPK_EnableDP( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte path, -+ IN u4Byte TXindex -+ ) -+{ -+ -+ //***************************************// -+ //Enable DP -+ //***************************************// -+ -+ //PWSF[6] = 0x40 = 0dB, set the address represented TXindex as 0dB -+ u1Byte PWSF[] = { 0xff, 0xca, 0xa1, 0x80, 0x65, 0x51, 0x40, //6~0dB -+ 0x33, 0x28, 0x20, 0x19, 0x14, 0x10, 0x0d, //-1~-7dB -+ 0x0a, 0x08, 0x06, 0x05, 0x04, 0x03, 0x03, //-8~-14dB -+ 0x02, 0x02, 0x01, 0x01, -+ }; -+ u1Byte zeropoint; -+ u1Byte pwsf1,pwsf2; -+ u1Byte i; -+ u4Byte pagesel = 0,regsel = 0; -+ -+ if(path == 0) -+ { -+ pagesel = 0; -+ regsel = 0; -+ } -+ else -+ { -+ pagesel = 0x200; -+ regsel = 0x40; -+ } -+ -+ -+ //=========// -+ // DPK setting // -+ //=========// -+ // reg82c[31] = b'1, page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083d5); -+ -+ -+ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0000f098); -+ ODM_Write4Byte(pDM_Odm, 0xc94+pagesel, 0x776c9f84); -+ ODM_Write4Byte(pDM_Odm, 0xcc4+pagesel, 0x08840000); -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x20000000); -+ ODM_Write4Byte(pDM_Odm, 0xc8c+pagesel, 0x3c000000); -+ -+ -+ // gPWSF table in 1st SRAM for PA = 11 use -+ ODM_Write4Byte(pDM_Odm, 0xc20+pagesel, 0x00000800); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Write PWSF table\n")); -+ -+ -+ if(TXindex == 0x1f) -+ zeropoint = 0; -+ else if(TXindex == 0x1e) -+ zeropoint = 1; -+ else if(TXindex == 0x1d) -+ zeropoint = 2; -+ else if(TXindex == 0x1c) -+ zeropoint = 3; -+ else if(TXindex == 0x1b) -+ zeropoint = 4; -+ else if(TXindex == 0x1a) -+ zeropoint = 5; -+ else if(TXindex == 0x19) -+ zeropoint = 6; -+ else -+ zeropoint = 6; -+ -+ -+ -+ for(i=0;i<16;i++) -+ { -+ pwsf1 = (6-zeropoint)+i*2; -+ if(pwsf1 > 24) -+ pwsf1 = 24; -+ -+ pwsf2 = (6-zeropoint-1)+i*2; -+ if(pwsf2 > 24) -+ pwsf2 = 24; -+ -+ ODM_Write4Byte(pDM_Odm, 0xce4+pagesel, 0x00000001 | i<<1 | (PWSF[pwsf1]<<8) | (PWSF[pwsf2]<<16)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0x%x\n", ODM_Read4Byte(pDM_Odm, 0xce4+pagesel))); -+ ODM_SetBBReg(pDM_Odm, 0xce4+pagesel, 0xff, 0x0); -+ } -+ -+ ODM_Write4Byte(pDM_Odm, 0xce4+pagesel, 0x00000000); -+ -+ // reg82c[31] = b'0, page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083d5); -+ -+} -+ -+ -+VOID -+_DPK_pathABDPK( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte TXindex = 0; -+ u1Byte path = 0; -+ u4Byte pagesel = 0,regsel = 0; -+ u4Byte i=0,j=0; -+ -+ for(path=0;path<2;path ++) //path A = 0; path B = 1; -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path %s DPK start!!!\n", (path==0)?"A":"B")); -+ -+ if(path == 0) -+ { -+ pagesel = 0; -+ regsel = 0; -+ } -+ else -+ { -+ pagesel = 0x200; -+ regsel = 0x40; -+ } -+ -+ //***************************************// -+ //find compress-2.5dB TX index -+ //***************************************// -+ -+ -+ // reg82c[31] = b'1, page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083d5); -+ -+ // regc20[15:13] = dB sel, iD Gain Loss function hM dB_sel ҳ]wPA gain lossؼЩҹ Tx AGC . -+ // dB_sel = b'000 ' 1.0 dB PA gain loss -+ // dB_sel = b'001 ' 1.5 dB PA gain loss -+ // dB_sel = b'010 ' 2.0 dB PA gain loss -+ // dB_sel = b'011 ' 2.5 dB PA gain loss -+ // dB_sel = b'100 ' 3.0 dB PA gain loss -+ // dB_sel = b'101 ' 3.5 dB PA gain loss -+ // dB_sel = b'110 ' 4.0 dB PA gain loss -+ ODM_Write4Byte(pDM_Odm, 0xc20+pagesel, 0x00006000); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0401e038); -+ ODM_Write4Byte(pDM_Odm, 0xc94+pagesel, 0xf76c9f84); -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x000c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc4+pagesel, 0x148b0000); -+ ODM_Write4Byte(pDM_Odm, 0xc8c+pagesel, 0x3c000000); -+ -+ // tx_amp ' Mw Ramp UiTjp -+ ODM_Write4Byte(pDM_Odm, 0xc98+pagesel, 0x41382e21); -+ ODM_Write4Byte(pDM_Odm, 0xc9c+pagesel, 0x5b554f48); -+ ODM_Write4Byte(pDM_Odm, 0xca0+pagesel, 0x6f6b6661); -+ ODM_Write4Byte(pDM_Odm, 0xca4+pagesel, 0x817d7874); -+ ODM_Write4Byte(pDM_Odm, 0xca8+pagesel, 0x908c8884); -+ ODM_Write4Byte(pDM_Odm, 0xcac+pagesel, 0x9d9a9793); -+ ODM_Write4Byte(pDM_Odm, 0xcb0+pagesel, 0xaaa7a4a1); -+ ODM_Write4Byte(pDM_Odm, 0xcb4+pagesel, 0xb6b3b0ad); -+ -+ // tx_inverse ' Ramp Uipower ˼, HpX PA gain report?? -+ ODM_Write4Byte(pDM_Odm, 0xc40+pagesel, 0x02ce03e9); -+ ODM_Write4Byte(pDM_Odm, 0xc44+pagesel, 0x01fd0249); -+ ODM_Write4Byte(pDM_Odm, 0xc48+pagesel, 0x01a101c9); -+ ODM_Write4Byte(pDM_Odm, 0xc4c+pagesel, 0x016a0181); -+ ODM_Write4Byte(pDM_Odm, 0xc50+pagesel, 0x01430155); -+ ODM_Write4Byte(pDM_Odm, 0xc54+pagesel, 0x01270135); -+ ODM_Write4Byte(pDM_Odm, 0xc58+pagesel, 0x0112011c); -+ ODM_Write4Byte(pDM_Odm, 0xc5c+pagesel, 0x01000108); -+ ODM_Write4Byte(pDM_Odm, 0xc60+pagesel, 0x00f100f8); -+ ODM_Write4Byte(pDM_Odm, 0xc64+pagesel, 0x00e500eb); -+ ODM_Write4Byte(pDM_Odm, 0xc68+pagesel, 0x00db00e0); -+ ODM_Write4Byte(pDM_Odm, 0xc6c+pagesel, 0x00d100d5); -+ ODM_Write4Byte(pDM_Odm, 0xc70+pagesel, 0x00c900cd); -+ ODM_Write4Byte(pDM_Odm, 0xc74+pagesel, 0x00c200c5); -+ ODM_Write4Byte(pDM_Odm, 0xc78+pagesel, 0x00bb00be); -+ ODM_Write4Byte(pDM_Odm, 0xc7c+pagesel, 0x00b500b8); -+ -+ //============// -+ // RF setting for DPK // -+ //============// -+ -+ //pathA,pathB standby mode -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)0x0, 0x0, bRFRegOffsetMask, 0x10000); -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)0x1, 0x0, bRFRegOffsetMask, 0x10000); -+ -+ // 00[4:0] = Tx AGC, 00[9:5] = Rx AGC (BB), 00[12:10] = Rx AGC (LNA) -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)(0x0+path), 0x0, bRFRegOffsetMask, 0x50bff); -+ -+ -+ // 64[14:12] = loop back attenuation -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)(0x0+path), 0x64, bRFRegOffsetMask, 0x19aac); -+ -+ // 8f[14:13] = PGA2 gain -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)(0x0+path), 0x8f, bRFRegOffsetMask, 0x8e001); -+ -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x800c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x000c5599); -+ -+ -+ // delay 100 ms -+ ODM_delay_ms(100); -+ -+ -+ // read back -+ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0109f018); -+ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x09000000); -+ // iHb d00[3:0] Ū^, dB_sel ҳ]w gain loss |b@ Tx AGC ]w -+ // Ū^d00[3:0] = h'1 ' Tx AGC = 15 -+ // Ū^d00[3:0] = h'2 ' Tx AGC = 16 -+ // Ū^d00[3:0] = h'3 ' Tx AGC = 17 -+ // Ū^d00[3:0] = h'4 ' Tx AGC = 18 -+ // Ū^d00[3:0] = h'5 ' Tx AGC = 19 -+ // Ū^d00[3:0] = h'6 ' Tx AGC = 1a -+ // Ū^d00[3:0] = h'7 ' Tx AGC = 1b -+ // Ū^d00[3:0] = h'8 ' Tx AGC = 1c -+ // Ū^d00[3:0] = h'9 ' Tx AGC = 1d -+ // Ū^d00[3:0] = h'a ' Tx AGC = 1e -+ // Ū^d00[3:0] = h'b ' Tx AGC = 1f -+ -+ TXindex = ODM_GetBBReg(pDM_Odm, 0xd00+regsel, 0x0000000f); -+ -+ -+ //***************************************// -+ //get LUT -+ //***************************************// -+ -+ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0001e038); -+ ODM_Write4Byte(pDM_Odm, 0xc94+pagesel, 0xf76c9f84); -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x400c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc4+pagesel, 0x11930080); //0xcc4[9:4]= DPk fail threshold -+ ODM_Write4Byte(pDM_Odm, 0xc8c+pagesel, 0x3c000000); -+ -+ -+ // tx_amp ' Mw Ramp UiTjp -+ -+ ODM_Write4Byte(pDM_Odm, 0xc98+pagesel, 0x41382e21); -+ ODM_Write4Byte(pDM_Odm, 0xc9c+pagesel, 0x5b554f48); -+ ODM_Write4Byte(pDM_Odm, 0xca0+pagesel, 0x6f6b6661); -+ ODM_Write4Byte(pDM_Odm, 0xca4+pagesel, 0x817d7874); -+ ODM_Write4Byte(pDM_Odm, 0xca8+pagesel, 0x908c8884); -+ ODM_Write4Byte(pDM_Odm, 0xcac+pagesel, 0x9d9a9793); -+ ODM_Write4Byte(pDM_Odm, 0xcb0+pagesel, 0xaaa7a4a1); -+ ODM_Write4Byte(pDM_Odm, 0xcb4+pagesel, 0xb6b3b0ad); -+ -+ // tx_inverse ' Ramp Uipower ˼, HpX PA gain -+ ODM_Write4Byte(pDM_Odm, 0xc40+pagesel, 0x02ce03e9); -+ ODM_Write4Byte(pDM_Odm, 0xc44+pagesel, 0x01fd0249); -+ ODM_Write4Byte(pDM_Odm, 0xc48+pagesel, 0x01a101c9); -+ ODM_Write4Byte(pDM_Odm, 0xc4c+pagesel, 0x016a0181); -+ ODM_Write4Byte(pDM_Odm, 0xc50+pagesel, 0x01430155); -+ ODM_Write4Byte(pDM_Odm, 0xc54+pagesel, 0x01270135); -+ ODM_Write4Byte(pDM_Odm, 0xc58+pagesel, 0x0112011c); -+ ODM_Write4Byte(pDM_Odm, 0xc5c+pagesel, 0x01000108); -+ ODM_Write4Byte(pDM_Odm, 0xc60+pagesel, 0x00f100f8); -+ ODM_Write4Byte(pDM_Odm, 0xc64+pagesel, 0x00e500eb); -+ ODM_Write4Byte(pDM_Odm, 0xc68+pagesel, 0x00db00e0); -+ ODM_Write4Byte(pDM_Odm, 0xc6c+pagesel, 0x00d100d5); -+ ODM_Write4Byte(pDM_Odm, 0xc70+pagesel, 0x00c900cd); -+ ODM_Write4Byte(pDM_Odm, 0xc74+pagesel, 0x00c200c5); -+ ODM_Write4Byte(pDM_Odm, 0xc78+pagesel, 0x00bb00be); -+ ODM_Write4Byte(pDM_Odm, 0xc7c+pagesel, 0x00b500b8); -+ -+ //fill BB TX index for the DPK reference -+ // reg82c[31] =1b'0, page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083d5); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc20+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc24+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc28+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc2c+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc30+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc34+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc38+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc3c+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc40+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc44+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc48+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc4c+pagesel, 0x3c3c3c3c); -+ -+ // reg82c[31] =1b'1, page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083d5); -+ -+ -+ -+ // r_agc_boudary -+ // PA gain = 11 tx_agc q1f 11 boundary = b'11111 ' PageC1 bc0[4:0] = 11111 -+ // PA gain = 10 tx_agc q11 11 ? boundary = b'10011 ' PageC1 bc0[9:5] = 10001 -+ // PA gain = 01 tx_agc q10 0e ? boundary = b'10000 ' PageC1 bc0[14:10] = 10000 -+ // PA gain = 00 tx_agc q0d 00 ? boundary = b'01101 ' PageC1 bc0[19:15] = 01101 -+ ODM_Write4Byte(pDM_Odm, 0xcbc+pagesel, 0x0006c23f); -+ -+ // r_bnd, t~4 PWSF (power scaling factor) boundary, ]ثeub PA gain = 11 ɤ~v, ҥH] h'fffff Yi. -+ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x000fffff); -+ -+ //============// -+ // RF setting for DPK // -+ //============// -+ // 00[4:0] = Tx AGC, 00[9:5] = Rx AGC (BB), 00[12:10] = Rx AGC (LNA) -+ // B reg00[4:0] = h'1d, Oѫe gain loss function o쪺G. -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)(0x0+path), 0x0, bRFRegOffsetMask, 0x517e0 | TXindex); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF 0x0 = 0x%x\n", 0x517e0 | TXindex)); -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0xc00c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x400c5599); -+ -+ // delay 100 ms -+ ODM_delay_ms(100); -+ -+ // read back dp_fail report -+ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x00000000); -+ -+ //if d00[6] = 1, DPK fail -+ if(ODM_GetBBReg(pDM_Odm, 0xd00+regsel, BIT6)) -+ { -+ //bypass DPK -+ ODM_Write4Byte(pDM_Odm, 0xcc4+pagesel, 0x28848000); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path %s DPK fail!!!!!!!!!!!!!!!!!!!!!\n", (path==0)?"A":"B")); -+ -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path %s DPK ok!!!!!!!!!!!!!!!!!!!!!\n", (path==0)?"A":"B")); -+ -+ -+ -+ //read LMS table -->debug message only -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("read LMS\n")); -+ -+ for(i=0;i<8;i++){ -+ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0601f0b8+i); -+ for(j=0;j<4;j++){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x09000000+(j<<24)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0x%x", ODM_Read4Byte(pDM_Odm, 0xd00+regsel))); -+ } -+ } -+ -+ -+ //***************************************// -+ //get gain loss -+ //***************************************// -+ -+ _DPK_GetGainLoss(pDM_Odm,path); -+ -+ -+ //***************************************// -+ //Enable DP -+ //***************************************// -+ -+ _DPK_EnableDP(pDM_Odm, path, TXindex); -+ -+ -+} -+ -+ -+} -+ -+ -+ -+VOID -+phy_DPCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte backupRegAddrs[] = { -+ 0x970, 0xcb8, 0x838, 0xc00, 0x90c, 0xb00, 0xc94, 0x82c, 0x520, 0xc60, // 10 -+ 0xc64, 0xc68, 0xc6c, 0xc70, 0xc74, 0xc78, 0xc7c, 0xc80, 0xc84, 0xc50, // 20 -+ 0xc20, 0xc24, 0xc28, 0xc2c, 0xc30, 0xc34, 0xc38, 0xc3c, 0xc40, 0xc44, // 30 -+ 0xc48, 0xc4c, 0xe50, 0xe20, 0xe24, 0xe28, 0xe2c, 0xe30, 0xe34, 0xe38, // 40 -+ 0xe3c, 0xe40, 0xe44, 0xe48, 0xe4c, 0xeb8, 0xe00, 0xe94, 0xe60, 0xe64, //50 -+ 0xe68, 0xe6c, 0xe70, 0xe74, 0xe78, 0xe7c, 0xe80, 0xe84 -+ }; -+ -+ u4Byte backupRegData[sizeof(backupRegAddrs)/sizeof(u4Byte)]; -+ -+ -+ //backup BB&MAC default value -+ -+ _DPK_parabackup(pDM_Odm, backupRegData, backupRegAddrs, sizeof(backupRegAddrs)/sizeof(u4Byte)); -+ -+ //set global parameters -+ _DPK_Globalparaset(pDM_Odm); -+ -+ //DPK -+ _DPK_pathABDPK(pDM_Odm); -+ -+ // TH_DPK=thermalmeter -+ -+ -+ //reload BB&MAC defaul value; -+ _DPK_parareload(pDM_Odm, backupRegData, backupRegAddrs, sizeof(backupRegAddrs)/sizeof(u4Byte)); -+ -+} -+ -+VOID -+PHY_DPCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ pDM_Odm->DPK_Done = TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> PHY_DPCalibrate_8812A\n")); -+ phy_DPCalibrate_8812A(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== PHY_DPCalibrate_8812A\n")); -+} -+ -+ -+ -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ce.h linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ce.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_ce.h 2017-06-07 23:07:21.024688761 +0300 -@@ -0,0 +1,106 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL_PHY_RF_8812A_H__ -+#define __HAL_PHY_RF_8812A_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define IQK_DELAY_TIME_8812A 10 //ms -+#define IQK_DEFERRED_TIME_8812A 4 //sec -+#define index_mapping_NUM_8812A 15 -+#define AVG_THERMAL_NUM_8812A 4 -+#define RF_T_METER_8812A 0x42 -+ -+ -+void ConfigureTxpowerTrack_8812A( -+ PTXPWRTRACK_CFG pConfig -+ ); -+ -+VOID -+GetDeltaSwingTable_8812A( -+ IN PVOID pDM_VOID, -+ OUT pu1Byte *TemperatureUP_A, -+ OUT pu1Byte *TemperatureDOWN_A, -+ OUT pu1Byte *TemperatureUP_B, -+ OUT pu1Byte *TemperatureDOWN_B -+ ); -+ -+void DoIQK_8812A( -+ PVOID pDM_VOID, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ); -+ -+VOID -+ODM_TxPwrTrackSetPwr8812A( -+ PVOID pDM_VOID, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ); -+ -+//1 7. IQK -+ -+void -+PHY_IQCalibrate_8812A( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery -+); -+ -+ -+// -+// LC calibrate -+// -+void -+PHY_LCCalibrate_8812A( -+ PVOID pDM_VOID -+); -+ -+// -+// AP calibrate -+// -+void -+PHY_APCalibrate_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN s1Byte delta); -+void -+PHY_DigitalPredistortion_8812A( IN PADAPTER pAdapter); -+ -+VOID -+PHY_DPCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm -+); -+VOID PHY_SetRFPathSwitch_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bMain -+ ); -+ -+ -+#endif // #ifndef __HAL_PHY_RF_8812A_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_win.c linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_win.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_win.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_win.c 2017-06-07 23:07:21.024688761 +0300 -@@ -0,0 +1,2977 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+// 2010/04/25 MH Define the max tx power tracking tx agc power. -+#define ODM_TXPWRTRACK_MAX_IDX8812A 6 -+ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+//3============================================================ -+//3 Tx Power Tracking -+//3============================================================ -+ -+ -+void DoIQK_8812A( -+ PVOID pDM_VOID, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+#endif -+ -+ ODM_ResetIQKResult(pDM_Odm); -+ -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; -+ PHY_IQCalibrate_8812A(Adapter, FALSE); -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: odm_TxPwrTrackSetPwr88E() -+ * -+ * Overview: 88E change all channel tx power accordign to flag. -+ * OFDM & CCK are all different. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 04/23/2012 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+VOID -+ODM_TxPwrTrackSetPwr8812A( -+ PDM_ODM_T pDM_Odm, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ) -+{ -+ u4Byte finalBbSwingIdx[2]; -+ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ u1Byte PwrTrackingLimit = 26; //+1.0dB -+ u1Byte TxRate = 0xFF; -+ u1Byte Final_OFDM_Swing_Index = 0; -+ u1Byte Final_CCK_Swing_Index = 0; -+ u1Byte i = 0; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ if (pDM_Odm->mp_mode == TRUE) { -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ #if (MP_DRIVER == 1) -+ PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ #endif -+ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ #endif -+ #endif -+ } else { -+ u2Byte rate = *(pDM_Odm->pForcedDataRate); -+ -+ if (!rate) { /*auto rate*/ -+ if (rate != 0xFF) { -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -+ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ TxRate = HwRateToMRate(pDM_Odm->TxRate); -+ #endif -+ } -+ } else { /*force rate*/ -+ TxRate = (u1Byte)rate; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Power Tracking TxRate=0x%X\n", TxRate)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8812A\n")); -+ -+ if(TxRate != 0xFF) //20130429 Mimic Modify High Rate BBSwing Limit. -+ { -+ //2 CCK -+ if((TxRate >= MGN_1M)&&(TxRate <= MGN_11M)) -+ PwrTrackingLimit = 32; //+4dB -+ //2 OFDM -+ else if((TxRate >= MGN_6M)&&(TxRate <= MGN_48M)) -+ PwrTrackingLimit = 30; //+3dB -+ else if(TxRate == MGN_54M) -+ PwrTrackingLimit = 28; //+2dB -+ //2 HT -+ else if((TxRate >= MGN_MCS0)&&(TxRate <= MGN_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_MCS3)&&(TxRate <= MGN_MCS4)) //16QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if((TxRate >= MGN_MCS5)&&(TxRate <= MGN_MCS7)) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ -+ else if((TxRate >= MGN_MCS8)&&(TxRate <= MGN_MCS10)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_MCS11)&&(TxRate <= MGN_MCS12)) //16QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if((TxRate >= MGN_MCS13)&&(TxRate <= MGN_MCS15)) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ -+ //2 VHT -+ else if((TxRate >= MGN_VHT1SS_MCS0)&&(TxRate <= MGN_VHT1SS_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_VHT1SS_MCS3)&&(TxRate <= MGN_VHT1SS_MCS4)) //16QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if((TxRate >= MGN_VHT1SS_MCS5)&&(TxRate <= MGN_VHT1SS_MCS6)) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ else if(TxRate == MGN_VHT1SS_MCS7) //64QAM -+ PwrTrackingLimit = 26; //+1dB -+ else if(TxRate == MGN_VHT1SS_MCS8) //256QAM -+ PwrTrackingLimit = 24; //+0dB -+ else if(TxRate == MGN_VHT1SS_MCS9) //256QAM -+ PwrTrackingLimit = 22; //-1dB -+ -+ else if((TxRate >= MGN_VHT2SS_MCS0)&&(TxRate <= MGN_VHT2SS_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_VHT2SS_MCS3)&&(TxRate <= MGN_VHT2SS_MCS4)) //16QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if((TxRate >= MGN_VHT2SS_MCS5)&&(TxRate <= MGN_VHT2SS_MCS6)) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ else if(TxRate == MGN_VHT2SS_MCS7) //64QAM -+ PwrTrackingLimit = 26; //+1dB -+ else if(TxRate == MGN_VHT2SS_MCS8) //256QAM -+ PwrTrackingLimit = 24; //+0dB -+ else if(TxRate == MGN_VHT2SS_MCS9) //256QAM -+ PwrTrackingLimit = 22; //-1dB -+ -+ else -+ PwrTrackingLimit = 24; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("TxRate=0x%x, PwrTrackingLimit=%d\n", TxRate, PwrTrackingLimit)); -+ -+ -+ if (Method == BBSWING) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8812A\n")); -+ -+ if (RFPath == ODM_RF_PATH_A) -+ { -+ finalBbSwingIdx[ODM_RF_PATH_A] = (pRFCalibrateInfo->OFDM_index[ODM_RF_PATH_A] > PwrTrackingLimit) ? PwrTrackingLimit : pRFCalibrateInfo->OFDM_index[ODM_RF_PATH_A]; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pRFCalibrateInfo->OFDM_index[ODM_RF_PATH_A]=%d, pDM_Odm->RealBbSwingIdx[ODM_RF_PATH_A]=%d\n", -+ pRFCalibrateInfo->OFDM_index[ODM_RF_PATH_A], finalBbSwingIdx[ODM_RF_PATH_A])); -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_A]]); -+ } -+ else -+ { -+ finalBbSwingIdx[ODM_RF_PATH_B] = (pRFCalibrateInfo->OFDM_index[ODM_RF_PATH_B] > PwrTrackingLimit) ? PwrTrackingLimit : pRFCalibrateInfo->OFDM_index[ODM_RF_PATH_B]; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pRFCalibrateInfo->OFDM_index[ODM_RF_PATH_B]=%d, pDM_Odm->RealBbSwingIdx[ODM_RF_PATH_B]=%d\n", -+ pRFCalibrateInfo->OFDM_index[ODM_RF_PATH_B], finalBbSwingIdx[ODM_RF_PATH_B])); -+ -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_B]]); -+ } -+ } -+ -+ else if (Method == MIX_MODE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pRFCalibrateInfo->DefaultOfdmIndex=%d, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]=%d, RF_Path = %d\n", -+ pRFCalibrateInfo->DefaultOfdmIndex, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath],RFPath )); -+ -+ Final_CCK_Swing_Index = pRFCalibrateInfo->DefaultCckIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; -+ Final_OFDM_Swing_Index = pRFCalibrateInfo->DefaultOfdmIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; -+ -+ if (RFPath == ODM_RF_PATH_A) -+ { -+ -+ if(Final_OFDM_Swing_Index > PwrTrackingLimit) //BBSwing higher then Limit -+ { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx= Final_CCK_Swing_Index - PwrTrackingLimit; // CCK Follow the same compensate value as Path A -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit; -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[PwrTrackingLimit]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA= TRUE; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_A); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else if (Final_OFDM_Swing_Index < 0) -+ { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx= Final_CCK_Swing_Index; // CCK Follow the same compensate value as Path A -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index; -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[0]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA= TRUE; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_A); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[Final_OFDM_Swing_Index]); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); -+ -+ if(pRFCalibrateInfo->Modify_TxAGC_Flag_PathA) //If TxAGC has changed, reset TxAGC again -+ { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx= 0; -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = 0; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_A); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA= FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A pDM_Odm->Modify_TxAGC_Flag = FALSE \n")); -+ } -+ } -+ } -+ -+ if (RFPath == ODM_RF_PATH_B) -+ { -+ if(Final_OFDM_Swing_Index > PwrTrackingLimit) //BBSwing higher then Limit -+ { -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit; -+ -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[PwrTrackingLimit]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB= TRUE; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_B); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_B Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else if (Final_OFDM_Swing_Index < 0) -+ { -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index; -+ -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[0]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = TRUE; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_B); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_B Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[Final_OFDM_Swing_Index]); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_B Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); -+ -+ if(pRFCalibrateInfo->Modify_TxAGC_Flag_PathB) //If TxAGC has changed, reset TxAGC again -+ { -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = 0; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_B); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_B pDM_Odm->Modify_TxAGC_Flag = FALSE \n")); -+ } -+ } -+ } -+ -+ } -+ else -+ { -+ return; -+ } -+} -+ -+VOID -+GetDeltaSwingTable_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ OUT pu1Byte *TemperatureUP_A, -+ OUT pu1Byte *TemperatureDOWN_A, -+ OUT pu1Byte *TemperatureUP_B, -+ OUT pu1Byte *TemperatureDOWN_B -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u1Byte TxRate = 0xFF; -+ u1Byte channel = pHalData->CurrentChannel; -+ -+ -+ if (pDM_Odm->mp_mode == TRUE) { -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ #if (MP_DRIVER == 1) -+ PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ #endif -+ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ #endif -+ #endif -+ } else { -+ u2Byte rate = *(pDM_Odm->pForcedDataRate); -+ -+ if (!rate) { /*auto rate*/ -+ if (rate != 0xFF) { -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -+ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ TxRate = HwRateToMRate(pDM_Odm->TxRate); -+ #endif -+ } -+ } else { /*force rate*/ -+ TxRate = (u1Byte)rate; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Power Tracking TxRate=0x%X\n", TxRate)); -+ -+ if ( 1 <= channel && channel <= 14) { -+ if (IS_CCK_RATE(TxRate)) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N; -+ } else { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N; -+ } -+ } else if ( 36 <= channel && channel <= 64) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0]; -+ } else if ( 100 <= channel && channel <= 140) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1]; -+ } else if ( 149 <= channel && channel <= 173) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2]; -+ } else { -+ *TemperatureUP_A = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_A = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ *TemperatureUP_B = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_B = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ } -+ -+ return; -+} -+ -+void ConfigureTxpowerTrack_8812A( -+ PTXPWRTRACK_CFG pConfig -+ ) -+{ -+ pConfig->SwingTableSize_CCK = TXSCALE_TABLE_SIZE; -+ pConfig->SwingTableSize_OFDM = TXSCALE_TABLE_SIZE; -+ pConfig->Threshold_IQK = IQK_THRESHOLD; -+ pConfig->Threshold_DPK = DPK_THRESHOLD; -+ pConfig->AverageThermalNum = AVG_THERMAL_NUM_8812A; -+ pConfig->RfPathCount = MAX_PATH_NUM_8812A; -+ pConfig->ThermalRegAddr = RF_T_METER_8812A; -+ -+ pConfig->ODM_TxPwrTrackSetPwr = ODM_TxPwrTrackSetPwr8812A; -+ pConfig->DoIQK = DoIQK_8812A; -+ pConfig->PHY_LCCalibrate = PHY_LCCalibrate_8812A; -+ pConfig->GetDeltaSwingTable = GetDeltaSwingTable_8812A; -+} -+ -+ -+#define BW_20M 0 -+#define BW_40M 1 -+#define BW_80M 2 -+ -+void _IQK_RX_FillIQC_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN unsigned int RX_X, -+ IN unsigned int RX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ if (RX_X>>1 >=0x112 || (RX_Y>>1 >= 0x12 && RX_Y>>1 <= 0x3ee)){ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x100); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, RX_X>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, RX_Y>>1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc10 = %x ====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xc10))); -+ } -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ if (RX_X>>1 >=0x112 || (RX_Y>>1 >= 0x12 && RX_Y>>1 <= 0x3ee)){ -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x100); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, 0); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, RX_X>>1); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, RX_Y>>1); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x====>fill to IQC\n ", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe10 = %x====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xe10))); -+ } -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_TX_FillIQC_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN unsigned int TX_X, -+ IN unsigned int TX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xc90, BIT(7), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT(18), 0x1); -+ if (!pDM_Odm->DPK_Done) -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT(29), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc8, BIT(29), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, TX_Y); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, TX_X); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X&0x000007ff, TX_Y&0x000007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xcd4 = %x;;0xccc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xcd4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xccc, 0x000007ff))); -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xe90, BIT(7), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT(18), 0x1); -+ if (!pDM_Odm->DPK_Done) -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT(29), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec8, BIT(29), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xecc, 0x000007ff, TX_Y); -+ ODM_SetBBReg(pDM_Odm, 0xed4, 0x000007ff, TX_X); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X&0x000007ff, TX_Y&0x000007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xed4 = %x;;0xecc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xed4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xecc, 0x000007ff))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_BackupMacBB_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //save MACBB default value -+ for (i = 0; i < MACBB_NUM; i++){ -+ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupMacBB Success!!!!\n")); -+} -+void _IQK_BackupRF_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte RFA_backup, -+ IN pu4Byte RFB_backup, -+ IN pu4Byte Backup_RF_REG, -+ IN u4Byte RF_NUM -+ ) -+{ -+ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save RF Parameters -+ for (i = 0; i < RF_NUM; i++){ -+ RFA_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG[i], bMaskDWord); -+ RFB_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, Backup_RF_REG[i], bMaskDWord); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupRF Success!!!!\n")); -+} -+void _IQK_BackupAFE_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ AFE_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_AFE_REG[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupAFE Success!!!!\n")); -+} -+void _IQK_RestoreMacBB_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload MacBB Parameters -+ for (i = 0; i < MACBB_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreMacBB Success!!!!\n")); -+} -+void _IQK_RestoreRF_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN pu4Byte Backup_RF_REG, -+ IN pu4Byte RF_backup, -+ IN u4Byte RF_REG_NUM -+ ) -+{ -+ u4Byte i; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ for (i = 0; i < RF_REG_NUM; i++) -+ ODM_SetRFReg(pDM_Odm, Path, Backup_RF_REG[i], bRFRegOffsetMask, RF_backup[i]); -+ -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x0); -+ -+ switch(Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path A Success!!!!\n")); -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path B Success!!!!\n")); -+ } -+ break; -+ default: -+ break; -+ } -+} -+void _IQK_RestoreAFE_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_AFE_REG[i], AFE_backup[i]); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); -+ ODM_SetBBReg(pDM_Odm, 0xc90, BIT(7), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT(18), 0x1); -+ if (!pDM_Odm->DPK_Done) -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT(29), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc8, BIT(29), 0x1); -+ //ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x3c000000); -+ ODM_SetBBReg(pDM_Odm, 0xe90, BIT(7), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT(18), 0x1); -+ if (!pDM_Odm->DPK_Done) -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT(29), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec8, BIT(29), 0x1); -+ //ODM_Write4Byte(pDM_Odm, 0xeb8, 0x0); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreAFE Success!!!!\n")); -+} -+ -+ -+void _IQK_ConfigureMAC_8812A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ // ========MAC register setting======== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_Write1Byte(pDM_Odm, 0x522, 0x3f); -+ ODM_SetBBReg(pDM_Odm, 0x550, BIT(11)|BIT(3), 0x0); -+ ODM_Write1Byte(pDM_Odm, 0x808, 0x00); // RX ante off -+ ODM_SetBBReg(pDM_Odm, 0x838, 0xf, 0xc); // CCA off -+ ODM_Write1Byte(pDM_Odm, 0xa07, 0xf); // CCK RX Path off -+} -+ -+#define cal_num 10 -+ -+void _IQK_Tx_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte chnlIdx -+ ) -+{ -+ u1Byte delay_count; -+ u1Byte cal0_retry, cal1_retry, TX0_Average = 0, TX1_Average = 0, RX0_Average = 0, RX1_Average = 0; -+ int TX_IQC_temp[10][4], TX_IQC[4]; //TX_IQC = [TX0_X, TX0_Y,TX1_X,TX1_Y]; for 3 times -+ int RX_IQC_temp[10][4], RX_IQC[4]; //RX_IQC = [RX0_X, RX0_Y,RX1_X,RX1_Y]; for 3 times -+ BOOLEAN TX0_fail = TRUE, RX0_fail = TRUE, IQK0_ready = FALSE, TX0_finish = FALSE, RX0_finish = FALSE; -+ BOOLEAN TX1_fail = TRUE, RX1_fail = TRUE, IQK1_ready = FALSE, TX1_finish = FALSE, RX1_finish = FALSE; -+ int i, ii, dx = 0, dy = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BandWidth = %d, ExtPA5G = %d, ExtPA2G = %d\n", *pDM_Odm->pBandWidth, pDM_Odm->ExtPA5G, pDM_Odm->ExtPA)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Interface = %d, RFE_Type = %d\n", pDM_Odm->SupportInterface, pDM_Odm->RFEType)); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // ========Path-A AFE all on======== -+ // Port 0 DAC/ADC on -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); -+ -+ // Port 1 DAC/ADC on -+ ODM_Write4Byte(pDM_Odm, 0xe60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xe64, 0x77777777); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe68, 0x19791979); -+ ODM_SetBBReg(pDM_Odm, 0xc00, 0xf, 0x4);// hardware 3-wire off -+ ODM_SetBBReg(pDM_Odm, 0xe00, 0xf, 0x4);// hardware 3-wire off -+ -+ // DAC/ADC sampling rate (160 MHz) -+ ODM_SetBBReg(pDM_Odm, 0xc5c, BIT(26)|BIT(25)|BIT(24), 0x7); -+ ODM_SetBBReg(pDM_Odm, 0xe5c, BIT(26)|BIT(25)|BIT(24), 0x7); -+ -+ //====== Path A TX IQK RF Setting ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, bRFRegOffsetMask, 0x80002); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, bRFRegOffsetMask, 0x3fffd); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, bRFRegOffsetMask, 0xfe83f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8f, bRFRegOffsetMask, 0x8a001); -+ //====== Path B TX IQK RF Setting ====== -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, bRFRegOffsetMask, 0x80002); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, bRFRegOffsetMask, 0x3fffd); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, bRFRegOffsetMask, 0xfe83f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xe94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA5G){ -+ if (pDM_Odm->RFEType == 1){ -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403e3); -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x821403e3); -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x821403f7); -+ } -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f1); -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x821403f1); -+ } -+ if (*pDM_Odm->pBandType){ -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x68163e96); -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28163e96); -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28163e96); -+ if (pDM_Odm->RFEType == 3){ -+ if (pDM_Odm->ExtPA) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403e3); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ } -+ } -+ -+ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xee8, 0x00000000); -+ -+ cal0_retry = 0; -+ cal1_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ if (!TX0_finish) -+ IQK0_ready = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if (!TX1_finish) -+ IQK1_ready = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); -+ if ((IQK0_ready && IQK1_ready) || (delay_count>20)) -+ break; -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX delay_count = %d\n", delay_count)); -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX0_fail = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ TX1_fail = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd40, BIT(12)); -+ if (!(TX0_fail || TX0_finish)){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ TX_IQC_temp[TX0_Average][0] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ TX_IQC_temp[TX0_Average][1] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X0[%d] = %x ;; TX_Y0[%d] = %x\n", TX0_Average, (TX_IQC_temp[TX0_Average][0])>>21&0x000007ff, TX0_Average, (TX_IQC_temp[TX0_Average][1])>>21&0x000007ff)); -+ /* -+ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x01000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x03000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+ */ -+ TX0_Average++; -+ } -+ else{ -+ cal0_retry++; -+ if (cal0_retry == 10) -+ break; -+ } -+ if (!(TX1_fail || TX1_finish)){ -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x02000000); -+ TX_IQC_temp[TX1_Average][2] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x04000000); -+ TX_IQC_temp[TX1_Average][3] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X1[%d] = %x ;; TX_Y1[%d] = %x\n", TX1_Average, (TX_IQC_temp[TX1_Average][2])>>21&0x000007ff, TX1_Average, (TX_IQC_temp[TX1_Average][3])>>21&0x000007ff)); -+ /* -+ int reg1 = 0, reg2 = 0, Image_Power = 0; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x01000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x02000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x03000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x04000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+ */ -+ TX1_Average++; -+ } -+ else{ -+ cal1_retry++; -+ if (cal1_retry == 10) -+ break; -+ } -+ } -+ else{ -+ cal0_retry++; -+ cal1_retry++; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay 20ms TX IQK Not Ready!!!!!\n")); -+ if (cal0_retry == 10) -+ break; -+ } -+ if (TX0_Average >= 2){ -+ for (i = 0; i < TX0_Average; i++){ -+ for (ii = i+1; ii >21) - (TX_IQC_temp[ii][0]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (TX_IQC_temp[i][1]>>21) - (TX_IQC_temp[ii][1]>>21); -+ if (dy < 4 && dy > -4){ -+ TX_IQC[0] = ((TX_IQC_temp[i][0]>>21) + (TX_IQC_temp[ii][0]>>21))/2; -+ TX_IQC[1] = ((TX_IQC_temp[i][1]>>21) + (TX_IQC_temp[ii][1]>>21))/2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXA_X = %x;;TXA_Y = %x\n", TX_IQC[0]&0x000007ff, TX_IQC[1]&0x000007ff)); -+ TX0_finish = TRUE; -+ } -+ } -+ } -+ } -+ } -+ if (TX1_Average >= 2){ -+ for (i = 0; i < TX1_Average; i++){ -+ for (ii = i+1; ii >21) - (TX_IQC_temp[ii][2]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (TX_IQC_temp[i][3]>>21) - (TX_IQC_temp[ii][3]>>21); -+ if (dy < 4 && dy > -4){ -+ TX_IQC[2] = ((TX_IQC_temp[i][2]>>21) + (TX_IQC_temp[ii][2]>>21))/2; -+ TX_IQC[3] = ((TX_IQC_temp[i][3]>>21) + (TX_IQC_temp[ii][3]>>21))/2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXB_X = %x;;TXB_Y = %x\n", TX_IQC[2]&0x000007ff, TX_IQC[3]&0x000007ff)); -+ TX1_finish = TRUE; -+ } -+ } -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX0_Average = %d, TX1_Average = %d\n", TX0_Average, TX1_Average)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX0_finish = %d, TX1_finish = %d\n", TX0_finish, TX1_finish)); -+ if (TX0_finish && TX1_finish) -+ break; -+ if ((cal0_retry + TX0_Average) >= 10 || (cal1_retry + TX1_Average) >= 10 ) -+ break; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXA_cal_retry = %d\n", cal0_retry)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXB_cal_retry = %d\n", cal1_retry)); -+ -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8, 0xffc00)); // Load LOK -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x8, 0xffc00)); // Load LOK -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ if (TX0_finish){ -+ //====== Path A RX IQK RF Setting====== -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, bRFRegOffsetMask, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, bRFRegOffsetMask, 0xfe7bf); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x65, bRFRegOffsetMask, 0x931d1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, bRFRegOffsetMask, 0x00000); -+ } -+ if (TX1_finish){ -+ //====== Path B RX IQK RF Setting====== -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, bRFRegOffsetMask, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, bRFRegOffsetMask, 0xfe7bf); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x65, bRFRegOffsetMask, 0x931d1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, bRFRegOffsetMask, 0x00000); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ else -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a890); -+ //ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a890); -+ if (pDM_Odm->RFEType == 1){ -+ ODM_Write4Byte(pDM_Odm, 0xcb0, 0x77777717); -+ ODM_Write4Byte(pDM_Odm, 0xcb4, 0x00000077); -+ ODM_Write4Byte(pDM_Odm, 0xeb0, 0x77777717); -+ ODM_Write4Byte(pDM_Odm, 0xeb4, 0x00000077); -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xcb0, 0x77777717); -+ ODM_Write4Byte(pDM_Odm, 0xcb4, 0x02000077); -+ ODM_Write4Byte(pDM_Odm, 0xeb0, 0x77777717); -+ ODM_Write4Byte(pDM_Odm, 0xeb4, 0x02000077); -+ } -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ if (TX0_finish){ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x82140119); -+ } -+ if (TX1_finish){ -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x82140119); -+ } -+ cal0_retry = 0; -+ cal1_retry = 0; -+ while(1){ -+ // one shot -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ if (TX0_finish){ -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_IQC[0])&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_IQC[1])&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ if (pDM_Odm->RFEType == 1){ -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161500); -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28160cc0); -+ } -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00300000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000); -+ ODM_delay_ms(5); //Delay 5ms -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ } -+ if (TX1_finish){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_IQC[2])&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_IQC[3])&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ if (pDM_Odm->RFEType == 1){ -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28161500); -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28160ca0); -+ } -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00300000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_delay_ms(5); //Delay 5ms -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x3c000000); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); -+ } -+ delay_count = 0; -+ while (1){ -+ if (!RX0_finish && TX0_finish) -+ IQK0_ready = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if (!RX1_finish && TX1_finish) -+ IQK1_ready = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); -+ if ((IQK0_ready && IQK1_ready)||(delay_count>20)) -+ break; -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX delay_count = %d\n", delay_count)); -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX0_fail = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); -+ RX1_fail = (BOOLEAN) ODM_GetBBReg(pDM_Odm, 0xd40, BIT(11)); -+ if (!(RX0_fail || RX0_finish) && TX0_finish){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ RX_IQC_temp[RX0_Average][0] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ RX_IQC_temp[RX0_Average][1] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[%d] = %x ;; RX_Y0[%d] = %x\n", RX0_Average, (RX_IQC_temp[RX0_Average][0])>>21&0x000007ff, RX0_Average, (RX_IQC_temp[RX0_Average][1])>>21&0x000007ff)); -+/* -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x05000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ DbgPrint("reg1 = %d, reg2 = %d", reg1, reg2); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x07000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+*/ -+ RX0_Average++; -+ } -+ else{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("1. RXA_cal_retry = %d\n", cal0_retry)); -+ cal0_retry++; -+ if (cal0_retry == 10) -+ break; -+ } -+ if (!(RX1_fail || RX1_finish) && TX1_finish){ -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x06000000); -+ RX_IQC_temp[RX1_Average][2] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x08000000); -+ RX_IQC_temp[RX1_Average][3] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X1[%d] = %x ;; RX_Y1[%d] = %x\n", RX1_Average, (RX_IQC_temp[RX1_Average][2])>>21&0x000007ff, RX1_Average, (RX_IQC_temp[RX1_Average][3])>>21&0x000007ff)); -+/* -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x05000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x06000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ DbgPrint("reg1 = %d, reg2 = %d", reg1, reg2); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x07000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x08000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+*/ -+ RX1_Average++; -+ } -+ else{ -+ cal1_retry++; -+ if (cal1_retry == 10) -+ break; -+ } -+ -+ } -+ else{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("2. RXA_cal_retry = %d\n", cal0_retry)); -+ cal0_retry++; -+ cal1_retry++; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Delay 20ms RX IQK Not Ready!!!!!\n")); -+ if (cal0_retry == 10) -+ break; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("3. RXA_cal_retry = %d\n", cal0_retry)); -+ if (RX0_Average >= 2){ -+ for (i = 0; i < RX0_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_IQC_temp[ii][0]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_IQC_temp[i][1]>>21) - (RX_IQC_temp[ii][1]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_IQC[0]= ((RX_IQC_temp[i][0]>>21) + (RX_IQC_temp[ii][0]>>21))/2; -+ RX_IQC[1] = ((RX_IQC_temp[i][1]>>21) + (RX_IQC_temp[ii][1]>>21))/2; -+ RX0_finish = TRUE; -+ break; -+ } -+ } -+ } -+ } -+ } -+ if (RX1_Average >= 2){ -+ for (i = 0; i < RX1_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_IQC_temp[ii][2]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_IQC_temp[i][3]>>21) - (RX_IQC_temp[ii][3]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_IQC[2] = ((RX_IQC_temp[i][2]>>21) + (RX_IQC_temp[ii][2]>>21))/2; -+ RX_IQC[3] = ((RX_IQC_temp[i][3]>>21) + (RX_IQC_temp[ii][3]>>21))/2; -+ RX1_finish = TRUE; -+ break; -+ } -+ } -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX0_Average = %d, RX1_Average = %d\n", RX0_Average, RX1_Average)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX0_finish = %d, RX1_finish = %d\n", RX0_finish, RX1_finish)); -+ if ((RX0_finish|| !TX0_finish) && (RX1_finish || !TX1_finish) ) -+ break; -+ if ((cal0_retry + RX0_Average) >= 10 || (cal1_retry + RX1_Average) >= 10 || RX0_Average == 3 || RX1_Average == 3) -+ break; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXA_cal_retry = %d\n", cal0_retry)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXB_cal_retry = %d\n", cal1_retry)); -+ -+ -+ // FillIQK Result -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_A =======\n")); -+ -+ if (TX0_finish){ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_A, TX_IQC[0], TX_IQC[1]); -+ } -+ else{ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_A, 0x200, 0x0); -+ } -+ -+ -+ -+ if (RX0_finish){ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_A, RX_IQC[0], RX_IQC[1]); -+ } -+ else{ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_A, 0x200, 0x0); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_B =======\n")); -+ -+ if (TX1_finish){ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_B, TX_IQC[2], TX_IQC[3]); -+ } -+ else{ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_B, 0x200, 0x0); -+ } -+ -+ -+ -+ if (RX1_finish){ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_B, RX_IQC[2], RX_IQC[3]); -+ } -+ else{ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, ODM_RF_PATH_B, 0x200, 0x0); -+ } -+ -+ -+ -+} -+ -+#define MACBB_REG_NUM 9 -+#define AFE_REG_NUM 12 -+#define RF_REG_NUM 3 -+ -+// Maintained by BB James. -+VOID -+phy_IQCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte Channel -+ ) -+{ -+ u4Byte MACBB_backup[MACBB_REG_NUM], AFE_backup[AFE_REG_NUM], RFA_backup[RF_REG_NUM], RFB_backup[RF_REG_NUM]; -+ u4Byte Backup_MACBB_REG[MACBB_REG_NUM] = {0x520, 0x550, 0x808, 0xa04, 0x90c, 0xc00, 0xe00, 0x838, 0x82c}; -+ u4Byte Backup_AFE_REG[AFE_REG_NUM] = {0xc5c, 0xc60, 0xc64, 0xc68, 0xcb0, 0xcb4, -+ 0xe5c, 0xe60, 0xe64, 0xe68, 0xeb0, 0xeb4}; -+ u4Byte Reg_C1B8, Reg_E1B8; -+ u4Byte Backup_RF_REG[RF_REG_NUM] = {0x65, 0x8f, 0x0}; -+ u1Byte chnlIdx = GetRightChnlPlaceforIQK(Channel); -+ -+ _IQK_BackupMacBB_8812A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ Reg_C1B8 = ODM_Read4Byte(pDM_Odm, 0xcb8); -+ Reg_E1B8 = ODM_Read4Byte(pDM_Odm, 0xeb8); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ _IQK_BackupAFE_8812A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); -+ _IQK_BackupRF_8812A(pDM_Odm, RFA_backup, RFB_backup, Backup_RF_REG, RF_REG_NUM); -+ -+ _IQK_ConfigureMAC_8812A(pDM_Odm); -+ _IQK_Tx_8812A(pDM_Odm, chnlIdx); -+ _IQK_RestoreRF_8812A(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG, RFA_backup, RF_REG_NUM); -+ _IQK_RestoreRF_8812A(pDM_Odm, ODM_RF_PATH_B, Backup_RF_REG, RFB_backup, RF_REG_NUM); -+ -+ _IQK_RestoreAFE_8812A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, Reg_C1B8); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, Reg_E1B8); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ _IQK_RestoreMacBB_8812A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); -+ -+ -+} -+ -+VOID -+phy_LCCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN BOOLEAN is2T -+ ) -+{ -+ u4Byte /*RF_Amode=0, RF_Bmode=0,*/ LC_Cal = 0, tmp = 0; -+ -+ //Check continuous TX and Packet TX -+ u4Byte reg0x914 = ODM_Read4Byte(pDM_Odm, rSingleTone_ContTx_Jaguar);; -+ -+ // Backup RF reg18. -+ LC_Cal = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); -+ -+ if((reg0x914 & 0x70000) != 0) //If contTx, disable all continuous TX. 0x914[18:16] -+ // <20121121, Kordan> A workaround: If we set 0x914[18:16] as zero, BB turns off ContTx -+ // until another packet comes in. To avoid ContTx being turned off, we skip this step. -+ ;//ODM_Write4Byte(pDM_Odm, rSingleTone_ContTx_Jaguar, reg0x914 & (~0x70000)); -+ else // If packet Tx-ing, pause Tx. -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE_8812A, 0xFF); -+ -+ -+/* -+ //3 1. Read original RF mode -+ RF_Amode = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask); -+ if(is2T) -+ RF_Bmode = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bRFRegOffsetMask); -+ -+ -+ //3 2. Set RF mode = standby mode -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask, (RF_Amode&0x8FFFF)|0x10000); -+ if(is2T) -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bRFRegOffsetMask, (RF_Bmode&0x8FFFF)|0x10000); -+*/ -+ -+ // Enter LCK mode -+ tmp = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask, tmp | BIT14); -+ -+ //3 3. Read RF reg18 -+ LC_Cal = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); -+ -+ //3 4. Set LC calibration begin bit15 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal|0x08000); -+ -+ ODM_delay_ms(150); // suggest by RFSI Binson -+ -+ // Leave LCK mode -+ tmp = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask, tmp & ~BIT14); -+ -+ //3 Restore original situation -+ if((reg0x914 & 70000) != 0) //Deal with contisuous TX case, 0x914[18:16] -+ { -+ // <20121121, Kordan> A workaround: If we set 0x914[18:16] as zero, BB turns off ContTx -+ // until another packet comes in. To avoid ContTx being turned off, we skip this step. -+ //ODM_Write4Byte(pDM_Odm, rSingleTone_ContTx_Jaguar, reg0x914); -+ } -+ else // Deal with Packet TX case -+ { -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE_8812A, 0x00); -+ } -+ -+ // Recover channel number -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal); -+ -+ /* -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask, RF_Amode); -+ if(is2T) -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bRFRegOffsetMask, RF_Bmode); -+ */ -+ -+} -+ -+ -+ -+ -+ -+#define DP_BB_REG_NUM 7 -+#define DP_RF_REG_NUM 1 -+#define DP_RETRY_LIMIT 10 -+#define DP_PATH_NUM 2 -+#define DP_DPK_NUM 3 -+#define DP_DPK_VALUE_NUM 2 -+ -+VOID -+phy_ReloadIQKSetting_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte Channel -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ u1Byte chnlIdx = GetRightChnlPlaceforIQK(Channel); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][0]&0x7ff); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][0]&0x7ff0000)>>16); -+ ODM_SetBBReg(pDM_Odm, 0xecc, 0x000007ff, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][2]&0x7ff); -+ ODM_SetBBReg(pDM_Odm, 0xed4, 0x000007ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][2]&0x7ff0000)>>16); -+ -+ if (*pDM_Odm->pBandWidth != 2){ -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xee8, 0x0); -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xce8, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][4]); -+ ODM_Write4Byte(pDM_Odm, 0xee8, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][5]); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][1]&0x7ff0000)>>17); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][1]&0x7ff)>>1); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][3]&0x7ff0000)>>17); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][3]&0x7ff)>>1); -+ -+ -+} -+ -+VOID -+PHY_ResetIQKResult_8812A( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ ODM_SetBBReg(pDM_Odm, 0xecc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xed4, 0x000007ff, 0x200); -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xee8, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x100); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x100); -+} -+ -+VOID -+phy_IQCalibrate_By_FW_8812A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+ u1Byte IQKcmd[3] = {*pDM_Odm->pChannel, 0x0, 0x0}; -+ u1Byte Buf1 = 0x0; -+ u1Byte Buf2 = 0x0; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+//Byte 2, Bit 4 ~ Bit 5 : BandType -+ if(*pDM_Odm->pBandType) -+ Buf1 = 0x2<<4; -+ else -+ Buf1 = 0x1<<4; -+ -+//Byte 2, Bit 0 ~ Bit 3 : Bandwidth -+ if(*pDM_Odm->pBandWidth == ODM_BW20M) -+ Buf2 = 0x1; -+ else if(*pDM_Odm->pBandWidth == ODM_BW40M) -+ Buf2 = 0x1<<1; -+ else if(*pDM_Odm->pBandWidth == ODM_BW80M) -+ Buf2 = 0x1<<2; -+ else -+ Buf2 = 0x1<<3; -+ -+ IQKcmd[1] = Buf1 | Buf2; -+ IQKcmd[2] = pDM_Odm->ExtPA5G | pDM_Odm->ExtPA<<1 | pDM_Odm->SupportInterface<<2 | pDM_Odm->RFEType<<5; -+ -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK Start ==\n")); -+ pRFCalibrateInfo->IQK_StartTime = 0; -+ pRFCalibrateInfo->IQK_StartTime = ODM_GetCurrentTime(pDM_Odm); -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== StartTime: %u\n", pRFCalibrateInfo->IQK_StartTime)); -+ -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_IQ_CALIBRATION, 3, IQKcmd); -+ -+ -+} -+ -+VOID -+PHY_IQCalibrate_8812A( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery -+ ) -+{ -+ u4Byte counter = 0; -+ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #else // (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+#endif -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+#if (MP_DRIVER == 1) -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+ #else// (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ #endif -+#endif//(MP_DRIVER == 1) -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE) ) -+ if (ODM_CheckPowerStatus(pAdapter) == FALSE) -+ return; -+#endif -+ //pMgntInfo->RegIQKFWOffload = (u1Byte)ODM_GetBBReg( pDM_Odm, 0x444, BIT8); -+#if MP_DRIVER == 1 -+ -+ // Add to determine IQK ON/OFF in certain case, Suggested by Cheng. -+ if (!pHalData->IQK_MP_Switch) -+ return; -+ -+ -+ if( ! (pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) ) -+#endif -+ { -+ -+ //3 == FW IQK == -+ if(pMgntInfo->RegIQKFWOffload) -+ { -+ if ( ! pRFCalibrateInfo->bIQKInProgress) -+ { -+ PlatformAcquireSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ pRFCalibrateInfo->bIQKInProgress = TRUE; -+ PlatformReleaseSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ -+ phy_IQCalibrate_By_FW_8812A(pDM_Odm); -+ } -+ else -+ { -+ for(counter = 0; counter < 10; counter++){ -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK IN PROGRESS == #%d\n", counter)); -+ delay_ms(50); -+ if ( ! pRFCalibrateInfo->bIQKInProgress) -+ { -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK RETURN FROM WAITING ==\n")); -+ break; -+ } -+ } -+ -+ if (pRFCalibrateInfo->bIQKInProgress) -+ { -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK TIMEOUT (Still in progress after 500ms) ==\n")); -+ PlatformAcquireSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ pRFCalibrateInfo->bIQKInProgress = FALSE; -+ PlatformReleaseSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ } -+ else -+ { -+ PlatformAcquireSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ pRFCalibrateInfo->bIQKInProgress = TRUE; -+ PlatformReleaseSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ phy_IQCalibrate_By_FW_8812A(pDM_Odm); -+ } -+ -+ -+ } -+ } -+ //3 == Driver IQK == -+ else -+ { -+ if ( ! pRFCalibrateInfo->bIQKInProgress) -+ { -+ PlatformAcquireSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ pRFCalibrateInfo->bIQKInProgress = TRUE; -+ PlatformReleaseSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ -+ //RT_TRACE(COMP_P2P, DBG_LOUD, ("1 %s: KeGetCurrentIrql(): %d\n", __FUNCTION__, KeGetCurrentIrql())); -+ phy_IQCalibrate_8812A(pDM_Odm, pHalData->CurrentChannel); -+ //RT_TRACE(COMP_P2P, DBG_LOUD, ("3 %s: KeGetCurrentIrql(): %d\n", __FUNCTION__, KeGetCurrentIrql())); -+ -+ PlatformAcquireSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ pRFCalibrateInfo->bIQKInProgress = FALSE; -+ PlatformReleaseSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ } -+ } -+ -+ -+ } -+ -+} -+ -+ -+VOID -+PHY_LCCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ -+#if (MP_DRIVER == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+#else -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+#endif -+#endif -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> PHY_LCCalibrate_8812A\n")); -+ -+#if (MP_DRIVER == 1) -+ phy_LCCalibrate_8812A(pDM_Odm, TRUE); -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== PHY_LCCalibrate_8812A\n")); -+ -+} -+ -+VOID phy_SetRFPathSwitch_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bMain, -+ IN BOOLEAN is2T -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+ -+#endif -+ -+ if (IS_HARDWARE_TYPE_8821(pAdapter)) -+ { -+ if(bMain) -+ ODM_SetBBReg(pDM_Odm, rA_RFE_Pinmux_Jaguar+4, BIT29|BIT28, 0x1); //Main -+ else -+ ODM_SetBBReg(pDM_Odm, rA_RFE_Pinmux_Jaguar+4, BIT29|BIT28, 0x2); //Aux -+ } -+ else if (IS_HARDWARE_TYPE_8812(pAdapter)) -+ { -+ if (pHalData->RFEType == 5) -+ { -+ if(bMain) { -+ // WiFi -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x2); -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); -+ } else { -+ // BT -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x1); -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); -+ } -+ } -+ else if (pHalData->RFEType == 1) -+ { // <131224, VincentL> When RFEType == 1 also Set 0x900, suggested by RF Binson. -+ if(bMain) { -+ // WiFi -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x2); -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); -+ } else { -+ // BT -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x1); -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); -+ } -+ } -+ -+ } -+ -+} -+VOID PHY_SetRFPathSwitch_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bMain -+ ) -+{ -+ -+#if DISABLE_BB_RF -+ return; -+#endif -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ phy_SetRFPathSwitch_8812A(pAdapter, bMain, TRUE); -+ -+#endif -+} -+ -+s4Byte -+_Sign( -+ IN u4Byte Number -+ ) -+{ -+ if ((Number & BIT10) == BIT10) {// Negative -+ Number &= (~0xFFFFFC00); // [9:0] -+ Number = ~Number; -+ Number &= (~0xFFFFFC00); // [9:0] -+ Number += 1; -+ Number &= (~0xFFFFF800); // [10:0] -+ return -1 * Number; -+ } else { // Positive -+ return (s4Byte)Number; -+ } -+} -+ -+ -+VOID -+_DPK_MacBBBackup_PathA( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte BackupRegAddr, -+ IN OUT pu4Byte BackupRegData, -+ IN u4Byte Number -+ ) -+{ -+ u4Byte i; -+ -+ for (i = 0; i < Number; i++) -+ BackupRegData[i] = ODM_Read4Byte(pDM_Odm, BackupRegAddr[i]); -+} -+VOID -+_DPK_MacBBRestore_PathA( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte BackupRegAddr, -+ IN pu4Byte BackupRegData, -+ IN u4Byte Number -+ ) -+{ -+ u4Byte i; -+ -+ for (i = 0; i < Number; i++) -+ ODM_Write4Byte(pDM_Odm, BackupRegAddr[i], BackupRegData[i]); -+} -+ -+ -+VOID -+_DPK_RFBackup_PathA( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte BackupRegAddr, -+ IN ODM_RF_RADIO_PATH_E RFPath, -+ IN OUT pu4Byte BackupRegData, -+ IN u4Byte Number -+ ) -+{ -+ u4Byte i; -+ -+ for (i = 0; i < Number; i++) -+ BackupRegData[i] = ODM_GetRFReg(pDM_Odm, RFPath, BackupRegAddr[i], bRFRegOffsetMask); -+} -+ -+VOID -+_DPK_RFRestore_PathA( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte BackupRegAddr, -+ IN ODM_RF_RADIO_PATH_E RFPath, -+ IN pu4Byte BackupRegData, -+ IN u4Byte Number -+ ) -+{ -+ u4Byte i; -+ -+ for (i = 0; i < Number; i++) -+ ODM_SetRFReg(pDM_Odm, RFPath, BackupRegAddr[i], bRFRegOffsetMask, BackupRegData[i]); -+} -+ -+ -+ -+s4Byte -+_ComputeLoopBackGain_PathA( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ // compute loopback gain -+ // ptmpLBGain Ψ쪺function hex2dec() ON twos complementQiনQi, Qi쪺榡s11.10 -+ // |1, d00[10:0] = h'3ff, gL hex2dec(h'3ff) = 1023, -+ // |2, d00[10:0] = h'400, gL hex2dec(h'400) = -1024, -+ // |3, d00[10:0] = h'0A9, gL hex2dec(h'0A9) = 169, -+ // |4, d00[10:0] = h'54c, gL hex2dec(h'54c) = -692, -+ // |5, d00[10:0] = h'7ff, gL hex2dec(h'7ff) = -1, -+ u4Byte reg0xD00_26_16 = ODM_GetBBReg(pDM_Odm, 0xD00, 0x7FF0000); -+ u4Byte reg0xD00_10_0 = ODM_GetBBReg(pDM_Odm, 0xD00, 0x7FF); -+ -+ s4Byte tmpLBGain = _Sign(reg0xD00_26_16)*_Sign(reg0xD00_26_16) + _Sign(reg0xD00_10_0)*_Sign(reg0xD00_10_0); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _ComputeLoopBackGain_PathA, tmpLBGain = 0x%X\n", tmpLBGain)); -+ -+ return tmpLBGain; -+} -+ -+ -+BOOLEAN -+_FineTuneLoopBackGain_PathA( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte DpkTxAGC -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ s4Byte tmpLBGain = 0; -+ -+ u4Byte rf0x64_orig = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x64, 0x7); -+ u4Byte rf0x64_new = rf0x64_orig; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _FineTuneLoopBackGain\n")); -+ -+ do { -+ // RF setting -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask, DpkTxAGC); -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ // `Npage c1c90bDPKL{dUQLthread or processgpage cc90 -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x0101f018); -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x800c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x000c5599); -+ // delay 50 ms, delay ɶ@I, Tw PA Scan function -+ delay_ms(50); -+ -+ // reg82c[31] = 0 --> page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask, 0x33d8d); -+ -+ tmpLBGain = _ComputeLoopBackGain_PathA(pDM_Odm); -+ -+ if ((rf0x64_new == (BIT2|BIT1|BIT0)) || (rf0x64_new == 0)) { -+ //printf('DPK Phase 1 failed'); -+ pRFCalibrateInfo->bDPKFail = TRUE; -+ break; -+ //Go to DPK Phase 5 -+ } else { -+ if (tmpLBGain < 263390) {// fine tune loopback path gain: newReg64[2:0] = reg64[2:0] - 3b'001 -+ rf0x64_new -= 1; -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x64, 0x7, rf0x64_new); -+ -+ } else if (tmpLBGain > 661607) {// fine tune loopback path gain: newReg64 [2:0] = reg64[2:0] + 3b'001 -+ rf0x64_new += 1; -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x64, 0x7, rf0x64_new); -+ -+ } else { -+ pRFCalibrateInfo->bDPKFail = FALSE; -+ } -+ } -+ -+ } while (tmpLBGain < 263390 || 661607 < tmpLBGain); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _FineTuneLoopBackGain\n")); -+ -+ return pRFCalibrateInfo->bDPKFail ? FALSE : TRUE; -+ -+} -+ -+ -+ -+VOID -+_DPK_Init_PathA( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _DPK_Init\n")); -+ -+ //TX pause -+ ODM_Write1Byte(pDM_Odm, 0x522, 0x7f); -+ -+ // reg82c[31] = b'0, page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ -+ // AFE setting -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); -+ -+ // external TRSW T -+ ODM_Write4Byte(pDM_Odm, 0xcb0, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xcb4, 0x01000077); -+ -+ // hardware 3-wire off -+ ODM_Write4Byte(pDM_Odm, 0xc00, 0x00000004); -+ -+ // CCA off -+ ODM_Write4Byte(pDM_Odm, 0x838, 0x16C89B4c); -+ -+ //90c[15]: dac fifo reset by CSWU -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ -+ // r_gothrough_iqkdpk -+ ODM_Write4Byte(pDM_Odm, 0xc94, 0x0100005D); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ -+ // IQK Amp off -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); -+ -+ // tx_amp -+ ODM_Write4Byte(pDM_Odm, 0xc98, 0x41382e21); -+ ODM_Write4Byte(pDM_Odm, 0xc9c, 0x5b554f48); -+ ODM_Write4Byte(pDM_Odm, 0xca0, 0x6f6b6661); -+ ODM_Write4Byte(pDM_Odm, 0xca4, 0x817d7874); -+ ODM_Write4Byte(pDM_Odm, 0xca8, 0x908c8884); -+ ODM_Write4Byte(pDM_Odm, 0xcac, 0x9d9a9793); -+ ODM_Write4Byte(pDM_Odm, 0xcb0, 0xaaa7a4a1); -+ ODM_Write4Byte(pDM_Odm, 0xcb4, 0xb6b3b0ad); -+ -+ // tx_inverse -+ ODM_Write4Byte(pDM_Odm, 0xc40, 0x02ce03e9); -+ ODM_Write4Byte(pDM_Odm, 0xc44, 0x01fd0249); -+ ODM_Write4Byte(pDM_Odm, 0xc48, 0x01a101c9); -+ ODM_Write4Byte(pDM_Odm, 0xc4c, 0x016a0181); -+ ODM_Write4Byte(pDM_Odm, 0xc50, 0x01430155); -+ ODM_Write4Byte(pDM_Odm, 0xc54, 0x01270135); -+ ODM_Write4Byte(pDM_Odm, 0xc58, 0x0112011c); -+ ODM_Write4Byte(pDM_Odm, 0xc5c, 0x01000108); -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x00f100f8); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x00e500eb); -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x00db00e0); -+ ODM_Write4Byte(pDM_Odm, 0xc6c, 0x00d100d5); -+ ODM_Write4Byte(pDM_Odm, 0xc70, 0x00c900cd); -+ ODM_Write4Byte(pDM_Odm, 0xc74, 0x00c200c5); -+ ODM_Write4Byte(pDM_Odm, 0xc78, 0x00bb00be); -+ ODM_Write4Byte(pDM_Odm, 0xc7c, 0x00b500b8); -+ -+ // reg82c[31] = b'0, page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ -+ pRFCalibrateInfo->bDPKFail = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _DPK_Init\n")); -+ -+} -+ -+ -+BOOLEAN -+_DPK_AdjustRFGain_PathA( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ s4Byte tmpLBGain = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _DPK_AdjustRFGain\n")); -+ -+ // RF setting -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask, 0x50bfc); -+ // Attn: A mode @ reg64[2:0], G mode @ reg56 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x64, bRFRegOffsetMask, 0x19aac); -+ // PGA gain: RF reg8f[14:13] -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8f, bRFRegOffsetMask, 0x8a001); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ -+ // DPK setting -+ ODM_Write4Byte(pDM_Odm, 0xc94, 0xf76c9f84); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x000c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x11838000); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0xFFF000, 0x100); // Ncd4[23:12] 令 h'100, 䥦줸ЫOdȤng -+ // `Npage c1c90bDPKL{dUQLthread or processgpage cc90 -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x0101f018); -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x800c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x000c5599); -+ // delay 50 ms, delay ɶ@I, Tw PA Scan function -+ delay_ms(50); -+ -+ // read back Loopback Gain -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x09000000); -+ -+ // reg82c[31] = 0 --> page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask, 0x33d8d); -+ -+ tmpLBGain = _ComputeLoopBackGain_PathA(pDM_Odm); -+ -+ // coarse tune loopback gain by RF reg8f[14:13] = 2b'11 -+ if (tmpLBGain < 263390) -+ { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8f, bRFRegOffsetMask, 0x8e001); -+ _FineTuneLoopBackGain_PathA(pDM_Odm, 0x50bfc); -+ -+ } -+ else if (tmpLBGain > 661607) -+ { -+ // coarse tune loopback gain by RF reg8f[14:13] = 2b'00 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8f, bRFRegOffsetMask, 0x88001); -+ _FineTuneLoopBackGain_PathA(pDM_Odm, 0x50bfc); -+ } -+ else -+ pRFCalibrateInfo->bDPKFail = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _DPK_AdjustRFGain\n")); -+ -+ return pRFCalibrateInfo->bDPKFail ? FALSE : TRUE; -+ -+} -+ -+ -+ -+VOID -+_DPK_GainLossToFindTxAGC_PathA( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ u4Byte Reg0xD00 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _DPK_GainLossToFindTxAGC\n")); -+ -+ // RF setting -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask, 0x50bfc); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ -+ // regc20[15:13] = dB sel, iD Gain Loss function hM dB_sel ҳ]wPA gain lossؼЩҹ Tx AGC . -+ // dB_sel = b'000 ' 1.0 dB PA gain loss -+ // dB_sel = b'001 ' 1.5 dB PA gain loss -+ // dB_sel = b'010 ' 2.0 dB PA gain loss -+ // dB_sel = b'011 ' 2.5 dB PA gain loss -+ // dB_sel = b'100 ' 3.0 dB PA gain loss -+ // dB_sel = b'101 ' 3.5 dB PA gain loss -+ // dB_sel = b'110 ' 4.0 dB PA gain loss -+ ODM_Write4Byte(pDM_Odm, 0xc20, 0x00002000); -+ -+ // DPK setting -+ ODM_Write4Byte(pDM_Odm, 0xc94, 0xf76c9f84); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x000c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x148b8000); -+ -+ // `Npage c1c90bDPKL{dUQLthread or processgpage cc90 -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x0401f018); -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x800c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x000c5599); -+ // delay 50 ms, delay ɶ@I, Tw PA Scan function -+ delay_ms(50); -+ -+ // read back Loopback Gain -+ // iHb d00[3:0] Ū^, dB_sel ҳ]w gain loss |b@ Tx AGC ]w -+ // Ū^d00[3:0] = h'1 ' Tx AGC = h'13 -+ // Ū^d00[3:0] = h'2 ' Tx AGC = h'14 -+ // Ū^d00[3:0] = h'3 ' Tx AGC = h'15 -+ // Ū^d00[3:0] = h'4 ' Tx AGC = h'16 -+ // Ū^d00[3:0] = h'5 ' Tx AGC = h'17 -+ // Ū^d00[3:0] = h'6 ' Tx AGC = h'18 -+ // Ū^d00[3:0] = h'7 ' Tx AGC = h'19 -+ // Ū^d00[3:0] = h'8 ' Tx AGC = h'1a -+ // Ū^d00[3:0] = h'9 ' Tx AGC = h'1b -+ // Ū^d00[3:0] = h'a ' Tx AGC = h'1c -+ // -+ Reg0xD00 = ODM_Read4Byte(pDM_Odm, 0xd00); -+ switch (ODM_Read4Byte(pDM_Odm, 0xd00) & (BIT3|BIT2|BIT1|BIT0)) -+ { -+ case 0x0: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x2; break; -+ case 0x1: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x3; break; -+ case 0x2: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x4; break; -+ case 0x3: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x5; break; -+ case 0x4: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x6; break; -+ case 0x5: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x7; break; -+ case 0x6: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x8; break; -+ case 0x7: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x9; break; -+ case 0x8: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0xa; break; -+ case 0x9: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0xb; break; -+ case 0xa: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0xc; break; -+ } -+ // reg82c[31] = 0 --> page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask, 0x33d8d); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _DPK_GainLossToFindTxAGC\n")); -+} -+ -+ -+BOOLEAN -+_DPK_AdjustRFGainByFoundTxAGC_PathA -+( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ s4Byte tmpLBGain = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _DPK_AdjustRFGainByFoundTxAGC\n")); -+ -+ // RF setting, s]wRF reg00, |ҥDPK Phase 2o쪺 d00[3:0] = 0x6 ' TX AGC= 0x18 ' RF reg00[4:0] = 0x18 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask, pRFCalibrateInfo->DpkTxAGC); -+ // Attn: A mode @ reg64[2:0], G mode @ reg56 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x64, bRFRegOffsetMask, 0x19aac); -+ // PGA gain: RF reg8f[14:13] -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8f, bRFRegOffsetMask, 0x8a001); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ -+ // DPK setting -+ ODM_Write4Byte(pDM_Odm, 0xc94, 0xf76c9f84); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x000c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x11838000); -+ -+ // `Npage c1c90bDPKL{dUQLthread or processgpage cc90 -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x0101f018); -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x800c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x000c5599); -+ // delay 50 ms, delay ɶ@I, Tw PA Scan function -+ delay_ms(50); -+ -+ // reg82c[31] = 0 --> page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask, 0x33d8d); -+ -+ -+ tmpLBGain = _ComputeLoopBackGain_PathA(pDM_Odm); -+ -+ if (tmpLBGain < 263390) -+ { -+ // coarse tune loopback gain by RF reg8f[14:13] = 2b'11 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8f, bRFRegOffsetMask, 0x8e001); -+ _FineTuneLoopBackGain_PathA(pDM_Odm, pRFCalibrateInfo->DpkTxAGC); -+ } -+ else if (tmpLBGain > 661607) -+ { -+ // coarse tune loopback gain by RF reg8f[14:13] = 2b'00 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8f, bRFRegOffsetMask, 0x88001); -+ _FineTuneLoopBackGain_PathA(pDM_Odm, pRFCalibrateInfo->DpkTxAGC); -+ } -+ else -+ pRFCalibrateInfo->bDPKFail = FALSE;//Go to DPK Phase 4 -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _DPK_AdjustRFGainByFoundTxAGC\n")); -+ -+ return pRFCalibrateInfo->bDPKFail ? FALSE : TRUE; -+ -+} -+ -+ -+VOID -+_DPK_DoAutoDPK_PathA( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ u4Byte tmpLBGain = 0, reg0xD00 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _DPK_DoAutoDPK\n")); -+ -+ -+ // reg82c[31] = 0 --> page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ // RF setting, BRF reg00, P DPK Phase 3 @P -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask, pRFCalibrateInfo->DpkTxAGC); -+ // Baseband Data Rate setting -+ ODM_Write4Byte(pDM_Odm, 0xc20, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc24, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc28, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc2c, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc30, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc34, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc38, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc3c, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc40, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc44, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc48, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc4c, 0x3c3c3c3c); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ -+ // DPK setting -+ ODM_Write4Byte(pDM_Odm, 0xc94, 0xf76C9f84); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x400C5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x11938080); //0xcc4[9:4]= DPk fail threshold -+ -+ if ( 36 <= *(pDM_Odm->pChannel) && *(pDM_Odm->pChannel) <= 53)//Channelchannel at low band) -+ // r_agc -+ ODM_Write4Byte(pDM_Odm, 0xcbc, 0x00022a1f); -+ else -+ // r_agc -+ ODM_Write4Byte(pDM_Odm, 0xcbc, 0x00009dbf); -+ -+ // `Npage c1c90bDPKL{dUQLthread or processgpage cc90 -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x0101f018); // TODO: 0xC90(rA_LSSIWrite_Jaguar) can not be overwritten. -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0xc00c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x400c5599); -+ // delay 50 ms, delay ɶ@I, Tw PA Scan function -+ delay_ms(50); -+ -+ // reg82c[31] = 0 --> page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ // T-meter RFReg42[17] = 1 to enable read T-meter, [15:10] ' T-meter value -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x42, BIT17, 1); -+ pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_A] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x42, 0xFC00); // ŪX42[15:10] ȨæsܼTMeter -+ DbgPrint("pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_A] = 0x%X\n", pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_A]); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask, 0x33D8D); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ // read back dp_fail report -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ //dp_failobitbd00[6], d00[6] = 1, calibration. -+ reg0xD00 = ODM_Read4Byte(pDM_Odm, 0xd00); -+ -+ if ((reg0xD00 & BIT6) == BIT6) { -+ //printf('DPK fail') -+ pRFCalibrateInfo->bDPKFail = TRUE; -+ //Go to DPK Phase 5 -+ } else { -+ //printf('DPK success') -+ } -+ -+ -+ // read back -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x0201f01f); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0c000000); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ -+ // ptmpGainLoss Ψ쪺function hex2dec() ON twos complementQiনQi, Qi쪺榡s11.9 -+ // |1, d00[10:0] = h'3ff, gL hex2dec(h'3ff) = 1023, -+ // |2, d00[10:0] = h'400, gL hex2dec(h'400) = -1024, -+ // |3, d00[10:0] = h'0A9, gL hex2dec(h'0A9) = 169, -+ // |4, d00[10:0] = h'54c, gL hex2dec(h'54c) = -692, -+ // |4, d00[10:0] = h'7ff, gL hex2dec(h'7ff) = -1, -+ tmpLBGain = _ComputeLoopBackGain_PathA(pDM_Odm); -+ -+ -+ // Gain Scaling -+ if (227007 < tmpLBGain) -+ pRFCalibrateInfo->DpkGain = 0x43ca43ca; -+ else if (214309 < tmpLBGain && tmpLBGain <= 227007) -+ pRFCalibrateInfo->DpkGain = 0x45c545c5; -+ else if (202321 < tmpLBGain && tmpLBGain <= 214309) -+ pRFCalibrateInfo->DpkGain = 0x47cf47cf; -+ else if (191003 < tmpLBGain && tmpLBGain <= 202321) -+ pRFCalibrateInfo->DpkGain = 0x49e749e7; -+ else if (180318 < tmpLBGain && tmpLBGain <= 191003) -+ pRFCalibrateInfo->DpkGain = 0x4c104c10; -+ else if (170231 < tmpLBGain && tmpLBGain <= 180318) -+ pRFCalibrateInfo->DpkGain = 0x4e494e49; -+ else if (160709 < tmpLBGain && tmpLBGain <= 170231) -+ pRFCalibrateInfo->DpkGain = 0x50925092; -+ else if (151719 < tmpLBGain && tmpLBGain <= 160709) -+ pRFCalibrateInfo->DpkGain = 0x52ec52ec; -+ else if (151719 <= tmpLBGain) -+ pRFCalibrateInfo->DpkGain = 0x55585558; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _DPK_DoAutoDPK\n")); -+} -+ -+ -+VOID -+_DPK_EnableDP_PathA( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _DPK_EnableDP\n")); -+ -+ // [31] = 1 --> switch to page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ -+ // enable IQC matrix --> ] BB H|gL predistortion module, ~gL IQC matrix DAC Xh -+ // ҥHn enable predistortion module {c90[7] = 1 (enable_predis) cc4[18] = 1 (Tw IQK/DPK module clock), cc8[29] = 1 (@IQK/DPK module ̪mux, T{ data path IQK/DPK)} -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x0000f098); -+ ODM_Write4Byte(pDM_Odm, 0xc94, 0x776d9f84); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); -+ // r_bnd -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x000fffff); -+ -+ if (pRFCalibrateInfo->bDPKFail) -+ { -+ // cc4[29] = 1 (bypass DP LUT) -+ ODM_Write4Byte(pDM_Odm, 0xc98, 0x40004000); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x28840000); -+ } -+ else -+ { -+ ODM_Write4Byte(pDM_Odm, 0xc98, pRFCalibrateInfo->DpkGain); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x08840000); -+ -+ // PWSF -+ // gPWSF table in 1st SRAM for PA = 11 use -+ ODM_Write4Byte(pDM_Odm, 0xc20, 0x00000800); -+ -+ //******************************************************* -+ //0xce4[0]Owrite enableA0xce4[7:1]OaddressA0xce4[15:8]M0xce4[23:16]TX indexA -+ //Ym0(0xce4[7:1] = 0x0)0xce4[15:8]쪺TX RF index O0x1f,A -+ //0xce4[23:16]쪺O0x1eAYm1(0xce4[7:1] = 0x1)A0xce4 [15:8]0x1dA -+ //0xce4[23:16]0x1cAL̦ACdata쳣Oۮt1dBCYgainloss쪺RF TX index=0x18A -+ //hb0xce4 address0x18an0x40(]NO0dB)ALhӤUtableǨC1dB̧DZƦC -+ //NҦ0xce4cdata쳣J۹ȡC -+ //*************************************************************// -+ -+ { -+ const s4Byte LEN = 25; -+ u4Byte baseIdx = 6; // 0 dB: 0x40 -+ u4Byte TablePWSF[] = { -+ 0xff, 0xca, 0xa1, 0x80, 0x65, 0x51, 0x40/* 0 dB */, -+ 0x33, 0x28, 0x20, 0x19, 0x14, 0x10, -+ 0x0d, 0x0a, 0x08, 0x06, 0x05, 0x04, -+ 0x03, 0x03, 0x02, 0x02, 0x01, 0x01 -+ }; -+ -+ u4Byte centerTxIdx = pRFCalibrateInfo->DpkTxAGC & 0x1F; -+ u4Byte centerAddr = (0x1F-centerTxIdx) / 2; -+ s4Byte i = 0, j = 0, value = 0, startIdx = 0; -+ -+ // Upper -+ startIdx = (((0x1F-centerTxIdx)%2 == 0) ? baseIdx+1 : baseIdx); -+ -+ for (i = startIdx, j = 0; (centerAddr-j+1) >= 1; i -= 2, j++) { -+ if (i-1 < 0) -+ value = (TablePWSF[0] << 16) | (TablePWSF[0] << 8) | ((centerAddr-j) << 1) | 0x1; -+ else -+ value = (TablePWSF[i] << 16) | (TablePWSF[i-1] << 8) | ((centerAddr-j) << 1) | 0x1; -+ -+ ODM_Write4Byte(pDM_Odm, 0xce4, value); -+ ODM_Write1Byte(pDM_Odm, 0xce4, 0x0); //write disable -+ } -+ -+ // Lower -+ startIdx = (((0x1F-centerTxIdx)%2 == 0) ? baseIdx+2 : baseIdx+1); -+ centerAddr++; // Skip centerTxIdx -+ for (i = startIdx, j = 0; (centerAddr+j) < 16; i += 2, j++) { // Total: 16*2 = 32 values (Upper+Lower) -+ if (i+1 >= LEN) -+ value = (TablePWSF[LEN-1] << 16) | (TablePWSF[LEN-1] << 8) | ((centerAddr+j) << 1) | 0x1; -+ else -+ value = (TablePWSF[i+1] << 16) | (TablePWSF[i] << 8) | ((centerAddr+j) << 1) | 0x1; -+ ODM_Write4Byte(pDM_Odm, 0xce4, value); -+ ODM_Write1Byte(pDM_Odm, 0xce4, 0x0); //write disable -+ } -+ } -+ } -+ // [31] = 0 --> switch to page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _DPK_EnableDP\n")); -+ -+} -+ -+ -+ -+ -+ -+VOID -+phy_DPCalibrate_PathA_8812A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte backupMacBBRegAddrs[] = { -+ 0xC60, 0xC64, 0xC68, 0x82C, 0x838, 0x90C, 0x522, 0xC00, 0xC20, 0xC24, // 10 -+ 0xC28, 0xC2C, 0xC30, 0xC34, 0xC38, 0xC3C, 0xC40, 0xC44, 0xC48, 0xC4C, // 20 -+ 0xC94, 0xCB0, 0xCB4 -+ }; -+ u4Byte backupRFRegAddrs[] = {0x00, 0x64, 0x8F}; -+ -+ u4Byte backupMacBBRegData[sizeof(backupMacBBRegAddrs)/sizeof(u4Byte)]; -+ u4Byte backupRFRegData_A[sizeof(backupRFRegAddrs)/sizeof(u4Byte)]; -+ //u4Byte backupRFRegData_B[sizeof(backupRFRegAddrs)/sizeof(u4Byte)]; -+ -+ -+ _DPK_MacBBBackup_PathA(pDM_Odm, backupMacBBRegAddrs, backupMacBBRegData, sizeof(backupMacBBRegAddrs)/sizeof(u4Byte)); -+ _DPK_RFBackup_PathA(pDM_Odm, backupRFRegAddrs, ODM_RF_PATH_A, backupRFRegData_A, sizeof(backupRFRegAddrs)/sizeof(u4Byte)); -+ -+ _DPK_Init_PathA(pDM_Odm); -+ -+ if (_DPK_AdjustRFGain_PathA(pDM_Odm)) { // Phase 1 -+ _DPK_GainLossToFindTxAGC_PathA(pDM_Odm); // Phase 2 -+ if (_DPK_AdjustRFGainByFoundTxAGC_PathA(pDM_Odm)) // Phase 3 -+ _DPK_DoAutoDPK_PathA(pDM_Odm); // Phase 4 -+ } -+ _DPK_EnableDP_PathA(pDM_Odm); // Phase 5 -+ -+ _DPK_MacBBRestore_PathA(pDM_Odm, backupMacBBRegAddrs, backupMacBBRegData, sizeof(backupMacBBRegAddrs)/sizeof(u4Byte)); -+ _DPK_RFRestore_PathA(pDM_Odm, backupRFRegAddrs, ODM_RF_PATH_A, backupRFRegData_A, sizeof(backupRFRegAddrs)/sizeof(u4Byte)); -+} -+ -+ -+VOID -+_DPK_MacBBBackup_PathB( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte BackupRegAddr, -+ IN OUT pu4Byte BackupRegData, -+ IN u4Byte Number -+ ) -+{ -+ u4Byte i; -+ -+ for (i = 0; i < Number; i++) -+ BackupRegData[i] = ODM_Read4Byte(pDM_Odm, BackupRegAddr[i]); -+} -+ -+VOID -+_DPK_MacBBRestore_PathB( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte BackupRegAddr, -+ IN pu4Byte BackupRegData, -+ IN u4Byte Number -+ ) -+{ -+ u4Byte i; -+ -+ for (i = 0; i < Number; i++) -+ ODM_Write4Byte(pDM_Odm, BackupRegAddr[i], BackupRegData[i]); -+} -+ -+ -+VOID -+_DPK_RFBackup_PathB( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte BackupRegAddr, -+ IN ODM_RF_RADIO_PATH_E RFPath, -+ IN OUT pu4Byte BackupRegData, -+ IN u4Byte Number -+ ) -+{ -+ u4Byte i; -+ -+ for (i = 0; i < Number; i++) -+ BackupRegData[i] = ODM_GetRFReg(pDM_Odm, RFPath, BackupRegAddr[i], bRFRegOffsetMask); -+} -+ -+VOID -+_DPK_RFRestore_PathB( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte BackupRegAddr, -+ IN ODM_RF_RADIO_PATH_E RFPath, -+ IN pu4Byte BackupRegData, -+ IN u4Byte Number -+ ) -+{ -+ u4Byte i; -+ -+ for (i = 0; i < Number; i++) -+ ODM_SetRFReg(pDM_Odm, RFPath, BackupRegAddr[i], bRFRegOffsetMask, BackupRegData[i]); -+} -+ -+ -+ -+s4Byte -+_ComputeLoopBackGain_PathB( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ // compute loopback gain -+ // ptmpLBGain Ψ쪺function hex2dec() ON twos complementQiনQi, Qi쪺榡s11.10 -+ // |1, d00[10:0] = h'3ff, gL hex2dec(h'3ff) = 1023, -+ // |2, d00[10:0] = h'400, gL hex2dec(h'400) = -1024, -+ // |3, d00[10:0] = h'0A9, gL hex2dec(h'0A9) = 169, -+ // |4, d00[10:0] = h'54c, gL hex2dec(h'54c) = -692, -+ // |5, d00[10:0] = h'7ff, gL hex2dec(h'7ff) = -1, -+ u4Byte reg0xD40_26_16 = ODM_GetBBReg(pDM_Odm, 0xD40, 0x7FF0000); -+ u4Byte reg0xD40_10_0 = ODM_GetBBReg(pDM_Odm, 0xD40, 0x7FF); -+ -+ s4Byte tmpLBGain = _Sign(reg0xD40_26_16)*_Sign(reg0xD40_26_16) + _Sign(reg0xD40_10_0)*_Sign(reg0xD40_10_0); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _ComputeLoopBackGain_PathB, tmpLBGain = 0x%X\n", tmpLBGain)); -+ -+ return tmpLBGain; -+} -+ -+ -+BOOLEAN -+_FineTuneLoopBackGain_PathB( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte DpkTxAGC -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ s4Byte tmpLBGain = 0; -+ -+ u4Byte rf0x64_orig = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x64, 0x7); -+ u4Byte rf0x64_new = rf0x64_orig; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _FineTuneLoopBackGain_PathB\n")); -+ -+ do { -+ // RF setting -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x00, bRFRegOffsetMask, DpkTxAGC); -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ // `Npage c1c90bDPKL{dUQLthread or processgpage cc90 -+ ODM_Write4Byte(pDM_Odm, 0xe90, 0x0101f018); -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x800c5599); -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x000c5599); -+ // delay 50 ms, delay ɶ@I, Tw PA Scan function -+ delay_ms(50); -+ -+ // reg82c[31] = 0 --> page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x00, bRFRegOffsetMask, 0x33d8d); -+ -+ tmpLBGain = _ComputeLoopBackGain_PathB(pDM_Odm); -+ -+ if ((rf0x64_new == (BIT2|BIT1|BIT0)) || (rf0x64_new == 0)) { -+ //printf('DPK Phase 1 failed'); -+ pRFCalibrateInfo->bDPKFail = TRUE; -+ break; -+ //Go to DPK Phase 5 -+ } else { -+ if (tmpLBGain < 263390) {// fine tune loopback path gain: newReg64[2:0] = reg64[2:0] - 3b'001 -+ rf0x64_new -= 1; -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x64, 0x7, rf0x64_new); -+ -+ } else if (tmpLBGain > 661607) {// fine tune loopback path gain: newReg64 [2:0] = reg64[2:0] + 3b'001 -+ rf0x64_new += 1; -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x64, 0x7, rf0x64_new); -+ -+ } else { -+ pRFCalibrateInfo->bDPKFail = FALSE; -+ } -+ } -+ -+ } while (tmpLBGain < 263390 || 661607 < tmpLBGain); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _FineTuneLoopBackGain_PathB\n")); -+ -+ return pRFCalibrateInfo->bDPKFail ? FALSE : TRUE; -+ -+} -+ -+ -+ -+VOID -+_DPK_Init_PathB( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _DPK_Init\n")); -+ -+ //TX pause -+ ODM_Write1Byte(pDM_Odm, 0x522, 0x7f); -+ -+ // reg82c[31] = b'0, page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ -+ // AFE setting -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x59791979); -+ ODM_Write4Byte(pDM_Odm, 0xe60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xe64, 0x77777777); -+ -+ // external TRSW T -+ ODM_Write4Byte(pDM_Odm, 0xeb0, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xeb4, 0x01000077); -+ -+ // hardware 3-wire off -+ ODM_Write4Byte(pDM_Odm, 0xe00, 0x00000004); -+ -+ // CCA off -+ ODM_Write4Byte(pDM_Odm, 0x838, 0x16C89B4c); -+ -+ //90c[15]: dac fifo reset by CSWU -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ -+ // r_gothrough_iqkdpk -+ ODM_Write4Byte(pDM_Odm, 0xe94, 0x0100005D); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ -+ // IQK Amp off -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x3c000000); -+ -+ // tx_amp -+ ODM_Write4Byte(pDM_Odm, 0xe98, 0x41382e21); -+ ODM_Write4Byte(pDM_Odm, 0xe9c, 0x5b554f48); -+ ODM_Write4Byte(pDM_Odm, 0xea0, 0x6f6b6661); -+ ODM_Write4Byte(pDM_Odm, 0xea4, 0x817d7874); -+ ODM_Write4Byte(pDM_Odm, 0xea8, 0x908c8884); -+ ODM_Write4Byte(pDM_Odm, 0xeac, 0x9d9a9793); -+ ODM_Write4Byte(pDM_Odm, 0xeb0, 0xaaa7a4a1); -+ ODM_Write4Byte(pDM_Odm, 0xeb4, 0xb6b3b0ad); -+ -+ // tx_inverse -+ ODM_Write4Byte(pDM_Odm, 0xe40, 0x02ce03e9); -+ ODM_Write4Byte(pDM_Odm, 0xe44, 0x01fd0249); -+ ODM_Write4Byte(pDM_Odm, 0xe48, 0x01a101c9); -+ ODM_Write4Byte(pDM_Odm, 0xe4c, 0x016a0181); -+ ODM_Write4Byte(pDM_Odm, 0xe50, 0x01430155); -+ ODM_Write4Byte(pDM_Odm, 0xe54, 0x01270135); -+ ODM_Write4Byte(pDM_Odm, 0xe58, 0x0112011c); -+ ODM_Write4Byte(pDM_Odm, 0xe5c, 0x01000108); -+ ODM_Write4Byte(pDM_Odm, 0xe60, 0x00f100f8); -+ ODM_Write4Byte(pDM_Odm, 0xe64, 0x00e500eb); -+ ODM_Write4Byte(pDM_Odm, 0xe68, 0x00db00e0); -+ ODM_Write4Byte(pDM_Odm, 0xe6c, 0x00d100d5); -+ ODM_Write4Byte(pDM_Odm, 0xe70, 0x00c900cd); -+ ODM_Write4Byte(pDM_Odm, 0xe74, 0x00c200c5); -+ ODM_Write4Byte(pDM_Odm, 0xe78, 0x00bb00be); -+ ODM_Write4Byte(pDM_Odm, 0xe7c, 0x00b500b8); -+ -+ // reg82c[31] = b'0, page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ -+ pRFCalibrateInfo->bDPKFail = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _DPK_Init\n")); -+ -+} -+ -+ -+BOOLEAN -+_DPK_AdjustRFGain_PathB( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ s4Byte tmpLBGain = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _DPK_AdjustRFGain\n")); -+ -+ // RF setting -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x00, bRFRegOffsetMask, 0x50bfc); -+ // Attn: A mode @ reg64[2:0], G mode @ reg56 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x64, bRFRegOffsetMask, 0x19aac); -+ // PGA gain: RF reg8f[14:13] -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x8f, bRFRegOffsetMask, 0x8a001); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ -+ // DPK setting -+ ODM_Write4Byte(pDM_Odm, 0xe94, 0xf76c9f84); -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x000c5599); -+ ODM_Write4Byte(pDM_Odm, 0xec4, 0x11838000); -+ ODM_SetBBReg(pDM_Odm, 0xed4, 0xFFF000, 0x100); // Ncd4[23:12] 令 h'100, 䥦줸ЫOdȤng -+ // `Npage c1c90bDPKL{dUQLthread or processgpage cc90 -+ ODM_Write4Byte(pDM_Odm, 0xe90, 0x0101f018); -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x800c5599); -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x000c5599); -+ // delay 50 ms, delay ɶ@I, Tw PA Scan function -+ delay_ms(50); -+ -+ // read back Loopback Gain -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x09000000); -+ -+ // reg82c[31] = 0 --> page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x00, bRFRegOffsetMask, 0x33d8d); -+ -+ tmpLBGain = _ComputeLoopBackGain_PathB(pDM_Odm); -+ -+ // coarse tune loopback gain by RF reg8f[14:13] = 2b'11 -+ if (tmpLBGain < 263390) -+ { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x8f, bRFRegOffsetMask, 0x8e001); -+ _FineTuneLoopBackGain_PathB(pDM_Odm, 0x50bfc); -+ -+ } -+ else if (tmpLBGain > 661607) -+ { -+ // coarse tune loopback gain by RF reg8f[14:13] = 2b'00 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x8f, bRFRegOffsetMask, 0x88001); -+ _FineTuneLoopBackGain_PathB(pDM_Odm, 0x50bfc); -+ } -+ else -+ pRFCalibrateInfo->bDPKFail = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _DPK_AdjustRFGain\n")); -+ -+ return pRFCalibrateInfo->bDPKFail ? FALSE : TRUE; -+ -+} -+ -+ -+ -+VOID -+_DPK_GainLossToFindTxAGC_PathB( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ u4Byte Reg0xD40 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _DPK_GainLossToFindTxAGC\n")); -+ -+ // RF setting -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x00, bRFRegOffsetMask, 0x50bfc); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ -+ // regc20[15:13] = dB sel, iD Gain Loss function hM dB_sel ҳ]wPA gain lossؼЩҹ Tx AGC . -+ // dB_sel = b'000 ' 1.0 dB PA gain loss -+ // dB_sel = b'001 ' 1.5 dB PA gain loss -+ // dB_sel = b'010 ' 2.0 dB PA gain loss -+ // dB_sel = b'011 ' 2.5 dB PA gain loss -+ // dB_sel = b'100 ' 3.0 dB PA gain loss -+ // dB_sel = b'101 ' 3.5 dB PA gain loss -+ // dB_sel = b'110 ' 4.0 dB PA gain loss -+ ODM_Write4Byte(pDM_Odm, 0xe20, 0x00002000); -+ -+ // DPK setting -+ ODM_Write4Byte(pDM_Odm, 0xe94, 0xf76c9f84); -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x000c5599); -+ ODM_Write4Byte(pDM_Odm, 0xec4, 0x148b8000); -+ -+ // `Npage c1c90bDPKL{dUQLthread or processgpage cc90 -+ ODM_Write4Byte(pDM_Odm, 0xe90, 0x0401f018); -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x800c5599); -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x000c5599); -+ // delay 50 ms, delay ɶ@I, Tw PA Scan function -+ delay_ms(50); -+ -+ // read back Loopback Gain -+ // iHb d40[3:0] Ū^, dB_sel ҳ]w gain loss |b@ Tx AGC ]w -+ // Ū^d00[3:0] = h'1 ' Tx AGC = h'13 -+ // Ū^d00[3:0] = h'2 ' Tx AGC = h'14 -+ // Ū^d00[3:0] = h'3 ' Tx AGC = h'15 -+ // Ū^d00[3:0] = h'4 ' Tx AGC = h'16 -+ // Ū^d00[3:0] = h'5 ' Tx AGC = h'17 -+ // Ū^d00[3:0] = h'6 ' Tx AGC = h'18 -+ // Ū^d00[3:0] = h'7 ' Tx AGC = h'19 -+ // Ū^d00[3:0] = h'8 ' Tx AGC = h'1a -+ // Ū^d00[3:0] = h'9 ' Tx AGC = h'1b -+ // Ū^d00[3:0] = h'a ' Tx AGC = h'1c -+ // -+ Reg0xD40 = ODM_Read4Byte(pDM_Odm, 0xd40); -+ switch (ODM_Read4Byte(pDM_Odm, 0xd40) & (BIT3|BIT2|BIT1|BIT0)) -+ { -+ case 0x0: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x2; break; -+ case 0x1: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x3; break; -+ case 0x2: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x4; break; -+ case 0x3: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x5; break; -+ case 0x4: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x6; break; -+ case 0x5: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x7; break; -+ case 0x6: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x8; break; -+ case 0x7: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0x9; break; -+ case 0x8: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0xa; break; -+ case 0x9: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0xb; break; -+ case 0xa: pRFCalibrateInfo->DpkTxAGC = 0x50bf0 | 0xc; break; -+ } -+ // reg82c[31] = 0 --> page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x00, bRFRegOffsetMask, 0x33d8d); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _DPK_GainLossToFindTxAGC\n")); -+} -+ -+ -+BOOLEAN -+_DPK_AdjustRFGainByFoundTxAGC_PathB -+( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ s4Byte tmpLBGain = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _DPK_AdjustRFGainByFoundTxAGC\n")); -+ -+ // RF setting, s]wRF reg00, |ҥDPK Phase 2o쪺 d40[3:0] = 0x6 ' TX AGC= 0x18 ' RF reg00[4:0] = 0x18 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x00, bRFRegOffsetMask, pRFCalibrateInfo->DpkTxAGC); -+ // Attn: A mode @ reg64[2:0], G mode @ reg56 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x64, bRFRegOffsetMask, 0x19aac); -+ // PGA gain: RF reg8f[14:13] -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x8f, bRFRegOffsetMask, 0x8a001); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ -+ // DPK setting -+ ODM_Write4Byte(pDM_Odm, 0xe94, 0xf76c9f84); -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x000c5599); -+ ODM_Write4Byte(pDM_Odm, 0xec4, 0x11838000); -+ -+ // `Npage c1c90bDPKL{dUQLthread or processgpage cc90 -+ ODM_Write4Byte(pDM_Odm, 0xe90, 0x0101f018); -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x800c5599); -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x000c5599); -+ // delay 50 ms, delay ɶ@I, Tw PA Scan function -+ delay_ms(50); -+ -+ // reg82c[31] = 0 --> page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x00, bRFRegOffsetMask, 0x33d8d); -+ -+ -+ tmpLBGain = _ComputeLoopBackGain_PathB(pDM_Odm); -+ -+ if (tmpLBGain < 263390) -+ { -+ // coarse tune loopback gain by RF reg8f[14:13] = 2b'11 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x8f, bRFRegOffsetMask, 0x8e001); -+ _FineTuneLoopBackGain_PathB(pDM_Odm, pRFCalibrateInfo->DpkTxAGC); -+ } -+ else if (tmpLBGain > 661607) -+ { -+ // coarse tune loopback gain by RF reg8f[14:13] = 2b'00 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x8f, bRFRegOffsetMask, 0x88001); -+ _FineTuneLoopBackGain_PathB(pDM_Odm, pRFCalibrateInfo->DpkTxAGC); -+ } -+ else -+ pRFCalibrateInfo->bDPKFail = FALSE;//Go to DPK Phase 4 -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _DPK_AdjustRFGainByFoundTxAGC\n")); -+ -+ return pRFCalibrateInfo->bDPKFail ? FALSE : TRUE; -+ -+} -+ -+ -+VOID -+_DPK_DoAutoDPK_PathB( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ u4Byte tmpLBGain = 0, reg0xD40 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _DPK_DoAutoDPK\n")); -+ -+ -+ // reg82c[31] = 0 --> page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ // RF setting, BRF reg00, P DPK Phase 3 @P -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x00, bRFRegOffsetMask, pRFCalibrateInfo->DpkTxAGC); -+ // Baseband Data Rate setting -+ ODM_Write4Byte(pDM_Odm, 0xe20, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xe24, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xe28, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xe2c, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xe30, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xe34, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xe38, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xe3c, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xe40, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xe44, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xe48, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xe4c, 0x3c3c3c3c); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ -+ // DPK setting -+ ODM_Write4Byte(pDM_Odm, 0xe94, 0xf76C9f84); -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x400C5599); -+ ODM_Write4Byte(pDM_Odm, 0xec4, 0x11938080); //0xec4[9:4]= DPk fail threshold -+ -+ if ( 36 <= *(pDM_Odm->pChannel) && *(pDM_Odm->pChannel) <= 53)//Channelchannel at low band) -+ // r_agc -+ ODM_Write4Byte(pDM_Odm, 0xebc, 0x00022a1f); -+ else -+ // r_agc -+ ODM_Write4Byte(pDM_Odm, 0xebc, 0x00009dbf); -+ -+ // `Npage c1c90bDPKL{dUQLthread or processgpage cc90 -+ ODM_Write4Byte(pDM_Odm, 0xe90, 0x0101f018); // TODO: 0xe90(rA_LSSIWrite_Jaguar) can not be overwritten. -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0xc00c5599); -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x400c5599); -+ // delay 50 ms, delay ɶ@I, Tw PA Scan function -+ delay_ms(50); -+ -+ // reg82c[31] = 0 --> page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ // T-meter RFReg42[17] = 1 to enable read T-meter, [15:10] ' T-meter value -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x42, BIT17, 1); -+ pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_B] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x42, 0xFC00); // ŪX42[15:10] ȨæsܼTMeter -+ DbgPrint("pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_B] = 0x%X\n", pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_B]); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x00, bRFRegOffsetMask, 0x33D8D); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ // read back dp_fail report -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); -+ //dp_failobitbd40[6], d40[6] = 1, calibration. -+ reg0xD40 = ODM_Read4Byte(pDM_Odm, 0xd40); -+ -+ if ((reg0xD40 & BIT6) == BIT6) { -+ //printf('DPK fail') -+ pRFCalibrateInfo->bDPKFail = TRUE; -+ //Go to DPK Phase 5 -+ } else { -+ //printf('DPK success') -+ } -+ -+ -+ // read back -+ ODM_Write4Byte(pDM_Odm, 0xe90, 0x0201f01f); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x0c000000); -+ -+ // reg82c[31] = 1 --> page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ -+ // ptmpGainLoss Ψ쪺function hex2dec() ON twos complementQiনQi, Qi쪺榡s11.9 -+ // |1, d00[10:0] = h'3ff, gL hex2dec(h'3ff) = 1023, -+ // |2, d00[10:0] = h'400, gL hex2dec(h'400) = -1024, -+ // |3, d00[10:0] = h'0A9, gL hex2dec(h'0A9) = 169, -+ // |4, d00[10:0] = h'54c, gL hex2dec(h'54c) = -692, -+ // |4, d00[10:0] = h'7ff, gL hex2dec(h'7ff) = -1, -+ tmpLBGain = _ComputeLoopBackGain_PathB(pDM_Odm); -+ -+ -+ // Gain Scaling -+ if (227007 < tmpLBGain) -+ pRFCalibrateInfo->DpkGain = 0x43ca43ca; -+ else if (214309 < tmpLBGain && tmpLBGain <= 227007) -+ pRFCalibrateInfo->DpkGain = 0x45c545c5; -+ else if (202321 < tmpLBGain && tmpLBGain <= 214309) -+ pRFCalibrateInfo->DpkGain = 0x47cf47cf; -+ else if (191003 < tmpLBGain && tmpLBGain <= 202321) -+ pRFCalibrateInfo->DpkGain = 0x49e749e7; -+ else if (180318 < tmpLBGain && tmpLBGain <= 191003) -+ pRFCalibrateInfo->DpkGain = 0x4c104c10; -+ else if (170231 < tmpLBGain && tmpLBGain <= 180318) -+ pRFCalibrateInfo->DpkGain = 0x4e494e49; -+ else if (160709 < tmpLBGain && tmpLBGain <= 170231) -+ pRFCalibrateInfo->DpkGain = 0x50925092; -+ else if (151719 < tmpLBGain && tmpLBGain <= 160709) -+ pRFCalibrateInfo->DpkGain = 0x52ec52ec; -+ else if (151719 <= tmpLBGain) -+ pRFCalibrateInfo->DpkGain = 0x55585558; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _DPK_DoAutoDPK\n")); -+} -+ -+ -+VOID -+_DPK_EnableDP_PathB( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> _DPK_EnableDP\n")); -+ -+ // [31] = 1 --> switch to page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083dd); -+ -+ // enable IQC matrix --> ] BB H|gL predistortion module, ~gL IQC matrix DAC Xh -+ // ҥHn enable predistortion module {c90[7] = 1 (enable_predis) cc4[18] = 1 (Tw IQK/DPK module clock), cc8[29] = 1 (@IQK/DPK module ̪mux, T{ data path IQK/DPK)} -+ ODM_Write4Byte(pDM_Odm, 0xe90, 0x0000f098); -+ ODM_Write4Byte(pDM_Odm, 0xe94, 0x776d9f84); -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x20000000); -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x3c000000); -+ // r_bnd -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x000fffff); -+ -+ if (pRFCalibrateInfo->bDPKFail) -+ { -+ // cc4[29] = 1 (bypass DP LUT) -+ ODM_Write4Byte(pDM_Odm, 0xe98, 0x40004000); -+ ODM_Write4Byte(pDM_Odm, 0xec4, 0x28840000); -+ } -+ else -+ { -+ ODM_Write4Byte(pDM_Odm, 0xe98, pRFCalibrateInfo->DpkGain); -+ ODM_Write4Byte(pDM_Odm, 0xec4, 0x08840000); -+ -+ // PWSF -+ // gPWSF table in 1st SRAM for PA = 11 use -+ ODM_Write4Byte(pDM_Odm, 0xe20, 0x00000800); -+ -+ //******************************************************* -+ //0xee4[0]Owrite enableA0xee4[7:1]OaddressA0xee4[15:8]M0xee4[23:16]TX indexA -+ //Ym0(0xee4[7:1] = 0x0)0xee4[15:8]쪺TX RF index O0x1f,A -+ //0xee4[23:16]쪺O0x1eAYm1(0xee4[7:1] = 0x1)A0xee4 [15:8]0x1dA -+ //0xee4[23:16]0x1cAL̦ACdata쳣Oۮt1dBCYgainloss쪺RF TX index=0x18A -+ //hb0xee4 address0x18an0x40(]NO0dB)ALhӤUtableǨC1dB̧DZƦC -+ //NҦ0xee4cdata쳣J۹ȡC -+ //*************************************************************// -+ -+ { -+ const s4Byte LEN = 25; -+ u4Byte baseIdx = 6; // 0 dB: 0x40 -+ u4Byte TablePWSF[] = { -+ 0xff, 0xca, 0xa1, 0x80, 0x65, 0x51, 0x40/* 0 dB */, -+ 0x33, 0x28, 0x20, 0x19, 0x14, 0x10, -+ 0x0d, 0x0a, 0x08, 0x06, 0x05, 0x04, -+ 0x03, 0x03, 0x02, 0x02, 0x01, 0x01 -+ }; -+ -+ u4Byte centerTxIdx = pRFCalibrateInfo->DpkTxAGC & 0x1F; -+ u4Byte centerAddr = (0x1F-centerTxIdx) / 2; -+ s4Byte i = 0, j = 0, value = 0, startIdx = 0; -+ -+ // Upper -+ startIdx = (((0x1F-centerTxIdx)%2 == 0) ? baseIdx+1 : baseIdx); -+ -+ for (i = startIdx, j = 0; (centerAddr-j+1) >= 1; i -= 2, j++) { -+ if (i-1 < 0) -+ value = (TablePWSF[0] << 16) | (TablePWSF[0] << 8) | ((centerAddr-j) << 1) | 0x1; -+ else -+ value = (TablePWSF[i] << 16) | (TablePWSF[i-1] << 8) | ((centerAddr-j) << 1) | 0x1; -+ -+ ODM_Write4Byte(pDM_Odm, 0xee4, value); -+ ODM_Write1Byte(pDM_Odm, 0xee4, 0x0); //write disable -+ } -+ -+ // Lower -+ startIdx = (((0x1F-centerTxIdx)%2 == 0) ? baseIdx+2 : baseIdx+1); -+ centerAddr++; // Skip centerTxIdx -+ for (i = startIdx, j = 0; (centerAddr+j) < 16; i += 2, j++) { // Total: 16*2 = 32 values (Upper+Lower) -+ if (i+1 >= LEN) -+ value = (TablePWSF[LEN-1] << 16) | (TablePWSF[LEN-1] << 8) | ((centerAddr+j) << 1) | 0x1; -+ else -+ value = (TablePWSF[i+1] << 16) | (TablePWSF[i] << 8) | ((centerAddr+j) << 1) | 0x1; -+ ODM_Write4Byte(pDM_Odm, 0xee4, value); -+ ODM_Write1Byte(pDM_Odm, 0xee4, 0x0); //write disable -+ } -+ } -+ } -+ // [31] = 0 --> switch to page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083dd); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== _DPK_EnableDP\n")); -+ -+} -+ -+ -+ -+ -+ -+VOID -+phy_DPCalibrate_PathB_8812A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte backupMacBBRegAddrs[] = { -+ 0xE60, 0xE64, 0xC68, 0x82C, 0x838, 0x90C, 0x522, 0xE00, 0xE20, 0xE24, // 10 -+ 0xE28, 0xE2C, 0xE30, 0xE34, 0xE38, 0xE3C, 0xE40, 0xE44, 0xE48, 0xE4C, // 20 -+ 0xE94, 0xEB0, 0xEB4 -+ }; -+ u4Byte backupRFRegAddrs[] = {0x00, 0x64, 0x8F}; -+ -+ u4Byte backupMacBBRegData[sizeof(backupMacBBRegAddrs)/sizeof(u4Byte)]; -+ u4Byte backupRFRegData_A[sizeof(backupRFRegAddrs)/sizeof(u4Byte)]; -+ //u4Byte backupRFRegData_B[sizeof(backupRFRegAddrs)/sizeof(u4Byte)]; -+ -+ -+ _DPK_MacBBBackup_PathB(pDM_Odm, backupMacBBRegAddrs, backupMacBBRegData, sizeof(backupMacBBRegAddrs)/sizeof(u4Byte)); -+ _DPK_RFBackup_PathB(pDM_Odm, backupRFRegAddrs, ODM_RF_PATH_B, backupRFRegData_A, sizeof(backupRFRegAddrs)/sizeof(u4Byte)); -+ -+ _DPK_Init_PathB(pDM_Odm); -+ -+ if (_DPK_AdjustRFGain_PathB(pDM_Odm)) { // Phase 1 -+ _DPK_GainLossToFindTxAGC_PathB(pDM_Odm); // Phase 2 -+ if (_DPK_AdjustRFGainByFoundTxAGC_PathB(pDM_Odm)) // Phase 3 -+ _DPK_DoAutoDPK_PathB(pDM_Odm); // Phase 4 -+ } -+ _DPK_EnableDP_PathB(pDM_Odm); // Phase 5 -+ -+ _DPK_MacBBRestore_PathB(pDM_Odm, backupMacBBRegAddrs, backupMacBBRegData, sizeof(backupMacBBRegAddrs)/sizeof(u4Byte)); -+ _DPK_RFRestore_PathB(pDM_Odm, backupRFRegAddrs, ODM_RF_PATH_B, backupRFRegData_A, sizeof(backupRFRegAddrs)/sizeof(u4Byte)); -+} -+VOID -+PHY_DPCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ pDM_Odm->DPK_Done = TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> PHY_DPCalibrate_8812A\n")); -+ phy_DPCalibrate_PathA_8812A(pDM_Odm); -+ phy_DPCalibrate_PathB_8812A(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== PHY_DPCalibrate_8812A\n")); -+} -+ -+ -+ -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_win.h linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_win.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_win.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/halphyrf_8812a_win.h 2017-06-07 23:07:21.024688761 +0300 -@@ -0,0 +1,106 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL_PHY_RF_8812A_H__ -+#define __HAL_PHY_RF_8812A_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define IQK_DELAY_TIME_8812A 10 //ms -+#define IQK_DEFERRED_TIME_8812A 4 //sec -+#define index_mapping_NUM_8812A 15 -+#define AVG_THERMAL_NUM_8812A 4 -+#define RF_T_METER_8812A 0x42 -+ -+ -+void ConfigureTxpowerTrack_8812A( -+ PTXPWRTRACK_CFG pConfig -+ ); -+ -+VOID -+GetDeltaSwingTable_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ OUT pu1Byte *TemperatureUP_A, -+ OUT pu1Byte *TemperatureDOWN_A, -+ OUT pu1Byte *TemperatureUP_B, -+ OUT pu1Byte *TemperatureDOWN_B -+ ); -+ -+void DoIQK_8812A( -+ PVOID pDM_VOID, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ); -+ -+VOID -+ODM_TxPwrTrackSetPwr8812A( -+ PDM_ODM_T pDM_Odm, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ); -+ -+//1 7. IQK -+ -+void -+PHY_IQCalibrate_8812A( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery -+); -+ -+ -+// -+// LC calibrate -+// -+void -+PHY_LCCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm -+); -+ -+// -+// AP calibrate -+// -+void -+PHY_APCalibrate_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN s1Byte delta); -+void -+PHY_DigitalPredistortion_8812A( IN PADAPTER pAdapter); -+ -+VOID -+PHY_DPCalibrate_8812A( -+ IN PDM_ODM_T pDM_Odm -+); -+VOID PHY_SetRFPathSwitch_8812A( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bMain -+ ); -+ -+ -+#endif // #ifndef __HAL_PHY_RF_8812A_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_regconfig8812a.c linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_regconfig8812a.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_regconfig8812a.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_regconfig8812a.c 2017-06-07 23:07:21.024688761 +0300 -@@ -0,0 +1,195 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8812A_SUPPORT == 1) -+ -+void -+odm_ConfigRFReg_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data, -+ IN ODM_RF_RADIO_PATH_E RF_PATH, -+ IN u4Byte RegAddr -+ ) -+{ -+ if (Addr == 0xfe || Addr == 0xffe) { -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ } else { -+ ODM_SetRFReg(pDM_Odm, RF_PATH, RegAddr, bRFRegOffsetMask, Data); -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ } -+} -+ -+ -+void -+odm_ConfigRF_RadioA_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data -+ ) -+{ -+ u4Byte content = 0x1000; // RF_Content: radioa_txt -+ u4Byte maskforPhySet= (u4Byte)(content&0xE000); -+ -+ odm_ConfigRFReg_8812A(pDM_Odm, Addr, Data, ODM_RF_PATH_A, Addr|maskforPhySet); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioA] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigRF_RadioB_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data -+ ) -+{ -+ u4Byte content = 0x1001; // RF_Content: radiob_txt -+ u4Byte maskforPhySet= (u4Byte)(content&0xE000); -+ -+ odm_ConfigRFReg_8812A(pDM_Odm, Addr, Data, ODM_RF_PATH_B, Addr|maskforPhySet); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioB] %08X %08X\n", Addr, Data)); -+ -+} -+ -+void -+odm_ConfigMAC_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u1Byte Data -+ ) -+{ -+ ODM_Write1Byte(pDM_Odm, Addr, Data); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigMACWithHeaderFile: [MAC_REG] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_AGC_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ) -+{ -+ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [AGC_TAB] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_PHY_REG_PG_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Band, -+ IN u4Byte RfPath, -+ IN u4Byte TxNum, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ) -+{ -+ if (Addr == 0xfe || Addr == 0xffe) -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ else { -+#if !(DM_ODM_SUPPORT_TYPE&ODM_AP) -+ PHY_StoreTxPowerByRate(pDM_Odm->Adapter, Band, RfPath, TxNum, Addr, Bitmask, Data); -+#endif -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X %08X\n", Addr, Bitmask, Data)); -+} -+ -+void -+odm_ConfigBB_PHY_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ) -+{ -+ if (Addr == 0xfe) -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ else if (Addr == 0xfd) -+ ODM_delay_ms(5); -+ else if (Addr == 0xfc) -+ ODM_delay_ms(1); -+ else if (Addr == 0xfb) -+ ODM_delay_us(50); -+ else if (Addr == 0xfa) -+ ODM_delay_us(5); -+ else if (Addr == 0xf9) -+ ODM_delay_us(1); -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ } -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_TXPWR_LMT_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte Regulation, -+ IN pu1Byte Band, -+ IN pu1Byte Bandwidth, -+ IN pu1Byte RateSection, -+ IN pu1Byte RfPath, -+ IN pu1Byte Channel, -+ IN pu1Byte PowerLimit -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PHY_SetTxPowerLimit(pDM_Odm, Regulation, Band, -+ Bandwidth, RateSection, RfPath, Channel, PowerLimit); -+#endif -+} -+ -+#else /* #if (RTL8812A_SUPPORT == 1) */ -+void -+odm_ConfigRFReg_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data, -+ IN ODM_RF_RADIO_PATH_E RF_PATH, -+ IN u4Byte RegAddr -+ ){} -+ -+#endif /* #if (RTL8812A_SUPPORT == 1) */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_regconfig8812a.h linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_regconfig8812a.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_regconfig8812a.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_regconfig8812a.h 2017-06-07 23:07:21.024688761 +0300 -@@ -0,0 +1,96 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_ODM_REGCONFIG_H_8812A -+#define __INC_ODM_REGCONFIG_H_8812A -+ -+#if (RTL8812A_SUPPORT == 1) -+ -+void -+odm_ConfigRFReg_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data, -+ IN ODM_RF_RADIO_PATH_E RF_PATH, -+ IN u4Byte RegAddr -+ ); -+ -+void -+odm_ConfigRF_RadioA_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigRF_RadioB_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigMAC_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u1Byte Data -+ ); -+ -+void -+odm_ConfigBB_AGC_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_PHY_REG_PG_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Band, -+ IN u4Byte RfPath, -+ IN u4Byte TxNum, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_PHY_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_TXPWR_LMT_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte Regulation, -+ IN pu1Byte Band, -+ IN pu1Byte Bandwidth, -+ IN pu1Byte RateSection, -+ IN pu1Byte RfPath, -+ IN pu1Byte Channel, -+ IN pu1Byte PowerLimit -+ ); -+ -+#endif -+#endif // end of SUPPORT -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_rtl8812a.c linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_rtl8812a.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_rtl8812a.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_rtl8812a.c 2017-06-07 23:07:21.024688761 +0300 -@@ -0,0 +1,161 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+ -+#include "../phydm_precomp.h" -+ -+#if (RTL8812A_SUPPORT == 1) -+ -+#if(defined(CONFIG_PATH_DIVERSITY)) -+VOID -+odm_UpdateTxPath_8812A(IN PDM_ODM_T pDM_Odm, IN u1Byte Path) -+{ -+ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; -+ -+ if(pDM_PathDiv->RespTxPath != Path) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Need to Update Tx Path\n")); -+ -+ if(Path == ODM_RF_PATH_A) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x80c , 0xFFF0, 0x111); //Tx by Reg -+ ODM_SetBBReg(pDM_Odm, 0x6d8 , BIT7|BIT6, 1); //Resp Tx by Txinfo -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, 0x80c , 0xFFF0, 0x222); //Tx by Reg -+ ODM_SetBBReg(pDM_Odm, 0x6d8 , BIT7|BIT6, 2); //Resp Tx by Txinfo -+ } -+ } -+ pDM_PathDiv->RespTxPath = Path; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Path=%s\n",(Path==ODM_RF_PATH_A)?"ODM_RF_PATH_A":"ODM_RF_PATH_B")); -+} -+ -+ -+VOID -+ODM_PathDiversityInit_8812A( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i; -+ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; -+ -+ ODM_SetBBReg(pDM_Odm, 0x80c , BIT29, 1); //Tx path from Reg -+ ODM_SetBBReg(pDM_Odm, 0x80c , 0xFFF0, 0x111); //Tx by Reg -+ ODM_SetBBReg(pDM_Odm, 0x6d8 , BIT7|BIT6, 1); //Resp Tx by Txinfo -+ odm_UpdateTxPath_8812A(pDM_Odm, ODM_RF_PATH_A); -+ -+ for (i=0; iPathSel[i] = 1; // TxInfo default at path-A -+ } -+} -+ -+ -+ -+VOID -+ODM_PathDiversity_8812A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte i, RssiAvgA=0, RssiAvgB=0, LocalMinRSSI, MinRSSI=0xFF; -+ u1Byte TxRespPath=0, TargetPath; -+ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; -+ PSTA_INFO_T pEntry; -+ -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Odm_PathDiversity_8812A() =>\n")); -+ -+ for (i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pEntry)) -+ { -+ //2 Caculate RSSI per Path -+ RssiAvgA = (pDM_PathDiv->PathA_Cnt[i]!=0)?(pDM_PathDiv->PathA_Sum[i]/pDM_PathDiv->PathA_Cnt[i]):0; -+ RssiAvgB = (pDM_PathDiv->PathB_Cnt[i]!=0)?(pDM_PathDiv->PathB_Sum[i]/pDM_PathDiv->PathB_Cnt[i]):0; -+ TargetPath = (RssiAvgA==RssiAvgB)?pDM_PathDiv->RespTxPath:((RssiAvgA>=RssiAvgB)?ODM_RF_PATH_A:ODM_RF_PATH_B); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("MacID=%d, PathA_Sum=%d, PathA_Cnt=%d\n", i, pDM_PathDiv->PathA_Sum[i], pDM_PathDiv->PathA_Cnt[i])); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("MacID=%d, PathB_Sum=%d, PathB_Cnt=%d\n",i, pDM_PathDiv->PathB_Sum[i], pDM_PathDiv->PathB_Cnt[i])); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("MacID=%d, RssiAvgA= %d, RssiAvgB= %d\n", i, RssiAvgA, RssiAvgB)); -+ -+ //2 Select Resp Tx Path -+ LocalMinRSSI = (RssiAvgA>RssiAvgB)?RssiAvgB:RssiAvgA; -+ if(LocalMinRSSI < MinRSSI) -+ { -+ MinRSSI = LocalMinRSSI; -+ TxRespPath = TargetPath; -+ } -+ -+ //2 Select Tx DESC -+ if(TargetPath == ODM_RF_PATH_A) -+ pDM_PathDiv->PathSel[i] = 1; -+ else -+ pDM_PathDiv->PathSel[i] = 2; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Tx from TxInfo, TargetPath=%s\n", -+ (TargetPath==ODM_RF_PATH_A)?"ODM_RF_PATH_A":"ODM_RF_PATH_B")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("pDM_PathDiv->PathSel[%d] = %d\n", i, pDM_PathDiv->PathSel[i])); -+ -+ } -+ pDM_PathDiv->PathA_Cnt[i] = 0; -+ pDM_PathDiv->PathA_Sum[i] = 0; -+ pDM_PathDiv->PathB_Cnt[i] = 0; -+ pDM_PathDiv->PathB_Sum[i] = 0; -+ } -+ -+ //2 Update Tx Path -+ odm_UpdateTxPath_8812A(pDM_Odm, TxRespPath); -+ -+} -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+VOID -+ODM_SetTxPathByTxInfo_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte pDesc, -+ IN u1Byte macId -+) -+{ -+ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; -+ -+ if((pDM_Odm->SupportICType != ODM_RTL8812)||(!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV))) -+ return; -+ -+ SET_TX_DESC_TX_ANT_8812(pDesc, pDM_PathDiv->PathSel[macId]); -+} -+#else// (DM_ODM_SUPPORT_TYPE == ODM_AP) -+VOID -+ODM_SetTxPathByTxInfo_8812A( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ -+} -+#endif -+ -+#endif // CONFIG_PATH_DIVERSITY -+#endif //#if (RTL8812A_SUPPORT == 1) -\ Ingen nyrad vid filslut -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_rtl8812a.h linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_rtl8812a.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_rtl8812a.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/phydm_rtl8812a.h 2017-06-07 23:07:21.024688761 +0300 -@@ -0,0 +1,46 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODM_RTL8812A_H__ -+#define __ODM_RTL8812A_H__ -+#if(defined(CONFIG_PATH_DIVERSITY)) -+ -+VOID -+ODM_PathStatistics_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte MacId, -+ IN u4Byte RSSI_A, -+ IN u4Byte RSSI_B -+); -+ -+VOID -+ODM_PathDiversityInit_8812A( IN PDM_ODM_T pDM_Odm); -+ -+VOID -+ODM_PathDiversity_8812A( IN PDM_ODM_T pDM_Odm); -+ -+VOID -+ODM_SetTxPathByTxInfo_8812A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte pDesc, -+ IN u1Byte macId -+); -+ #endif -+ #endif -\ Ingen nyrad vid filslut -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/version_rtl8812a.h linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/version_rtl8812a.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8812a/version_rtl8812a.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8812a/version_rtl8812a.h 2017-06-07 23:07:21.024688761 +0300 -@@ -0,0 +1,4 @@ -+/*RTL8812A PHY Parameters*/ -+#define RELEASE_DATE_8812A 20150602 -+#define COMMIT_BY_8192E "BB_Jeffery" -+#define RELEASE_VERSION_8812A 55 -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_bb.c linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_bb.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_bb.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_bb.c 2017-06-07 23:07:21.025688852 +0300 -@@ -0,0 +1,742 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.14*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8821A_SUPPORT == 1) -+static BOOLEAN -+CheckPositive( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2, -+ IN const u4Byte Condition3, -+ IN const u4Byte Condition4 -+) -+{ -+ u1Byte _BoardType = ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA*/ -+ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA*/ -+ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA*/ -+ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ -+ ((pDM_Odm->BoardType & BIT2) >> 2) << 4; /* _BT*/ -+ -+ u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; -+ u4Byte driver1 = pDM_Odm->CutVersion << 24 | -+ (pDM_Odm->SupportInterface & 0xF0) << 16 | -+ pDM_Odm->SupportPlatform << 16 | -+ pDM_Odm->PackageType << 12 | -+ (pDM_Odm->SupportInterface & 0x0F) << 8 | -+ _BoardType; -+ -+ u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | -+ (pDM_Odm->TypeGPA & 0xFF) << 8 | -+ (pDM_Odm->TypeALNA & 0xFF) << 16 | -+ (pDM_Odm->TypeAPA & 0xFF) << 24; -+ -+u4Byte driver3 = 0; -+ -+ u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | -+ (pDM_Odm->TypeGPA & 0xFF00) | -+ (pDM_Odm->TypeALNA & 0xFF00) << 8 | -+ (pDM_Odm->TypeAPA & 0xFF00) << 16; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Platform, Interface) = (0x%X, 0x%X)\n", pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Board, Package) = (0x%X, 0x%X)\n", pDM_Odm->BoardType, pDM_Odm->PackageType)); -+ -+ -+ /*============== Value Defined Check ===============*/ -+ /*QFN Type [15:12] and Cut Version [27:24] need to do value check*/ -+ -+ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return FALSE; -+ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return FALSE; -+ -+ /*=============== Bit Defined Check ================*/ -+ /* We don't care [31:28] */ -+ -+ cond1 &= 0x00FF0FFF; -+ driver1 &= 0x00FF0FFF; -+ -+ if ((cond1 & driver1) == cond1) { -+ u4Byte bitMask = 0; -+ -+ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE*/ -+ return TRUE; -+ -+ if ((cond1 & BIT0) != 0) /*GLNA*/ -+ bitMask |= 0x000000FF; -+ if ((cond1 & BIT1) != 0) /*GPA*/ -+ bitMask |= 0x0000FF00; -+ if ((cond1 & BIT2) != 0) /*ALNA*/ -+ bitMask |= 0x00FF0000; -+ if ((cond1 & BIT3) != 0) /*APA*/ -+ bitMask |= 0xFF000000; -+ -+ if (((cond2 & bitMask) == (driver2 & bitMask)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ -+ return TRUE; -+ else -+ return FALSE; -+ } else -+ return FALSE; -+} -+static BOOLEAN -+CheckNegative( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2 -+) -+{ -+ return TRUE; -+} -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8821A_AGC_TAB[] = { -+ 0x81C, 0xBF000001, -+ 0x81C, 0xBF020001, -+ 0x81C, 0xBF040001, -+ 0x81C, 0xBF060001, -+ 0x81C, 0xBE080001, -+ 0x81C, 0xBD0A0001, -+ 0x81C, 0xBC0C0001, -+ 0x81C, 0xBA0E0001, -+ 0x81C, 0xB9100001, -+ 0x81C, 0xB8120001, -+ 0x81C, 0xB7140001, -+ 0x81C, 0xB6160001, -+ 0x81C, 0xB5180001, -+ 0x81C, 0xB41A0001, -+ 0x81C, 0xB31C0001, -+ 0x81C, 0xB21E0001, -+ 0x81C, 0xB1200001, -+ 0x81C, 0xB0220001, -+ 0x81C, 0xAF240001, -+ 0x81C, 0xAE260001, -+ 0x81C, 0xAD280001, -+ 0x81C, 0xAC2A0001, -+ 0x81C, 0xAB2C0001, -+ 0x81C, 0xAA2E0001, -+ 0x81C, 0xA9300001, -+ 0x81C, 0xA8320001, -+ 0x81C, 0xA7340001, -+ 0x81C, 0xA6360001, -+ 0x81C, 0xA5380001, -+ 0x81C, 0xA43A0001, -+ 0x81C, 0x683C0001, -+ 0x81C, 0x673E0001, -+ 0x81C, 0x66400001, -+ 0x81C, 0x65420001, -+ 0x81C, 0x64440001, -+ 0x81C, 0x63460001, -+ 0x81C, 0x62480001, -+ 0x81C, 0x614A0001, -+ 0x81C, 0x474C0001, -+ 0x81C, 0x464E0001, -+ 0x81C, 0x45500001, -+ 0x81C, 0x44520001, -+ 0x81C, 0x43540001, -+ 0x81C, 0x42560001, -+ 0x81C, 0x41580001, -+ 0x81C, 0x285A0001, -+ 0x81C, 0x275C0001, -+ 0x81C, 0x265E0001, -+ 0x81C, 0x25600001, -+ 0x81C, 0x24620001, -+ 0x81C, 0x0A640001, -+ 0x81C, 0x09660001, -+ 0x81C, 0x08680001, -+ 0x81C, 0x076A0001, -+ 0x81C, 0x066C0001, -+ 0x81C, 0x056E0001, -+ 0x81C, 0x04700001, -+ 0x81C, 0x03720001, -+ 0x81C, 0x02740001, -+ 0x81C, 0x01760001, -+ 0x81C, 0x01780001, -+ 0x81C, 0x017A0001, -+ 0x81C, 0x017C0001, -+ 0x81C, 0x017E0001, -+ 0x8000020c, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFB000101, -+ 0x81C, 0xFA020101, -+ 0x81C, 0xF9040101, -+ 0x81C, 0xF8060101, -+ 0x81C, 0xF7080101, -+ 0x81C, 0xF60A0101, -+ 0x81C, 0xF50C0101, -+ 0x81C, 0xF40E0101, -+ 0x81C, 0xF3100101, -+ 0x81C, 0xF2120101, -+ 0x81C, 0xF1140101, -+ 0x81C, 0xF0160101, -+ 0x81C, 0xEF180101, -+ 0x81C, 0xEE1A0101, -+ 0x81C, 0xED1C0101, -+ 0x81C, 0xEC1E0101, -+ 0x81C, 0xEB200101, -+ 0x81C, 0xEA220101, -+ 0x81C, 0xE9240101, -+ 0x81C, 0xE8260101, -+ 0x81C, 0xE7280101, -+ 0x81C, 0xE62A0101, -+ 0x81C, 0xE52C0101, -+ 0x81C, 0xE42E0101, -+ 0x81C, 0xE3300101, -+ 0x81C, 0xA5320101, -+ 0x81C, 0xA4340101, -+ 0x81C, 0xA3360101, -+ 0x81C, 0x87380101, -+ 0x81C, 0x863A0101, -+ 0x81C, 0x853C0101, -+ 0x81C, 0x843E0101, -+ 0x81C, 0x69400101, -+ 0x81C, 0x68420101, -+ 0x81C, 0x67440101, -+ 0x81C, 0x66460101, -+ 0x81C, 0x49480101, -+ 0x81C, 0x484A0101, -+ 0x81C, 0x474C0101, -+ 0x81C, 0x2A4E0101, -+ 0x81C, 0x29500101, -+ 0x81C, 0x28520101, -+ 0x81C, 0x27540101, -+ 0x81C, 0x26560101, -+ 0x81C, 0x25580101, -+ 0x81C, 0x245A0101, -+ 0x81C, 0x235C0101, -+ 0x81C, 0x055E0101, -+ 0x81C, 0x04600101, -+ 0x81C, 0x03620101, -+ 0x81C, 0x02640101, -+ 0x81C, 0x01660101, -+ 0x81C, 0x01680101, -+ 0x81C, 0x016A0101, -+ 0x81C, 0x016C0101, -+ 0x81C, 0x016E0101, -+ 0x81C, 0x01700101, -+ 0x81C, 0x01720101, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFB000101, -+ 0x81C, 0xFA020101, -+ 0x81C, 0xF9040101, -+ 0x81C, 0xF8060101, -+ 0x81C, 0xF7080101, -+ 0x81C, 0xF60A0101, -+ 0x81C, 0xF50C0101, -+ 0x81C, 0xF40E0101, -+ 0x81C, 0xF3100101, -+ 0x81C, 0xF2120101, -+ 0x81C, 0xF1140101, -+ 0x81C, 0xF0160101, -+ 0x81C, 0xEF180101, -+ 0x81C, 0xEE1A0101, -+ 0x81C, 0xED1C0101, -+ 0x81C, 0xEC1E0101, -+ 0x81C, 0xEB200101, -+ 0x81C, 0xEA220101, -+ 0x81C, 0xE9240101, -+ 0x81C, 0xE8260101, -+ 0x81C, 0xE7280101, -+ 0x81C, 0xE62A0101, -+ 0x81C, 0xE52C0101, -+ 0x81C, 0xE42E0101, -+ 0x81C, 0xE3300101, -+ 0x81C, 0xA5320101, -+ 0x81C, 0xA4340101, -+ 0x81C, 0xA3360101, -+ 0x81C, 0x87380101, -+ 0x81C, 0x863A0101, -+ 0x81C, 0x853C0101, -+ 0x81C, 0x843E0101, -+ 0x81C, 0x69400101, -+ 0x81C, 0x68420101, -+ 0x81C, 0x67440101, -+ 0x81C, 0x66460101, -+ 0x81C, 0x49480101, -+ 0x81C, 0x484A0101, -+ 0x81C, 0x474C0101, -+ 0x81C, 0x2A4E0101, -+ 0x81C, 0x29500101, -+ 0x81C, 0x28520101, -+ 0x81C, 0x27540101, -+ 0x81C, 0x26560101, -+ 0x81C, 0x25580101, -+ 0x81C, 0x245A0101, -+ 0x81C, 0x235C0101, -+ 0x81C, 0x055E0101, -+ 0x81C, 0x04600101, -+ 0x81C, 0x03620101, -+ 0x81C, 0x02640101, -+ 0x81C, 0x01660101, -+ 0x81C, 0x01680101, -+ 0x81C, 0x016A0101, -+ 0x81C, 0x016C0101, -+ 0x81C, 0x016E0101, -+ 0x81C, 0x01700101, -+ 0x81C, 0x01720101, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0xFF000101, -+ 0x81C, 0xFF020101, -+ 0x81C, 0xFE040101, -+ 0x81C, 0xFD060101, -+ 0x81C, 0xFC080101, -+ 0x81C, 0xFD0A0101, -+ 0x81C, 0xFC0C0101, -+ 0x81C, 0xFB0E0101, -+ 0x81C, 0xFA100101, -+ 0x81C, 0xF9120101, -+ 0x81C, 0xF8140101, -+ 0x81C, 0xF7160101, -+ 0x81C, 0xF6180101, -+ 0x81C, 0xF51A0101, -+ 0x81C, 0xF41C0101, -+ 0x81C, 0xF31E0101, -+ 0x81C, 0xF2200101, -+ 0x81C, 0xF1220101, -+ 0x81C, 0xF0240101, -+ 0x81C, 0xEF260101, -+ 0x81C, 0xEE280101, -+ 0x81C, 0xED2A0101, -+ 0x81C, 0xEC2C0101, -+ 0x81C, 0xEB2E0101, -+ 0x81C, 0xEA300101, -+ 0x81C, 0xE9320101, -+ 0x81C, 0xE8340101, -+ 0x81C, 0xE7360101, -+ 0x81C, 0xE6380101, -+ 0x81C, 0xE53A0101, -+ 0x81C, 0xE43C0101, -+ 0x81C, 0xE33E0101, -+ 0x81C, 0xA5400101, -+ 0x81C, 0xA4420101, -+ 0x81C, 0xA3440101, -+ 0x81C, 0x87460101, -+ 0x81C, 0x86480101, -+ 0x81C, 0x854A0101, -+ 0x81C, 0x844C0101, -+ 0x81C, 0x694E0101, -+ 0x81C, 0x68500101, -+ 0x81C, 0x67520101, -+ 0x81C, 0x66540101, -+ 0x81C, 0x49560101, -+ 0x81C, 0x48580101, -+ 0x81C, 0x475A0101, -+ 0x81C, 0x2A5C0101, -+ 0x81C, 0x295E0101, -+ 0x81C, 0x28600101, -+ 0x81C, 0x27620101, -+ 0x81C, 0x26640101, -+ 0x81C, 0x25660101, -+ 0x81C, 0x24680101, -+ 0x81C, 0x236A0101, -+ 0x81C, 0x056C0101, -+ 0x81C, 0x046E0101, -+ 0x81C, 0x03700101, -+ 0x81C, 0x02720101, -+ 0xB0000000, 0x00000000, -+ 0x81C, 0x01740101, -+ 0x81C, 0x01760101, -+ 0x81C, 0x01780101, -+ 0x81C, 0x017A0101, -+ 0x81C, 0x017C0101, -+ 0x81C, 0x017E0101, -+ 0xC50, 0x00000022, -+ 0xC50, 0x00000020, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_AGC_TAB( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_AGC_TAB)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8821A_AGC_TAB; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8821A_AGC_TAB\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } -+ else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigBB_AGC_8821A(pDM_Odm, v1, bMaskDWord, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8821A_AGC_TAB(void) -+{ -+ return 54; -+} -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8821A_PHY_REG[] = { -+ 0x800, 0x0020D090, -+ 0x804, 0x080112E0, -+ 0x808, 0x0E028211, -+ 0x80C, 0x92131111, -+ 0x810, 0x20101261, -+ 0x814, 0x020C3D10, -+ 0x818, 0x03A00385, -+ 0x820, 0x00000000, -+ 0x824, 0x00030FE0, -+ 0x828, 0x00000000, -+ 0x82C, 0x002081DD, -+ 0x830, 0x2AAAEEC8, -+ 0x834, 0x0037A706, -+ 0x838, 0x06489B44, -+ 0x83C, 0x0000095B, -+ 0x840, 0xC0000001, -+ 0x844, 0x40003CDE, -+ 0x848, 0x62103F8B, -+ 0x84C, 0x6CFDFFB8, -+ 0x850, 0x28874706, -+ 0x854, 0x0001520C, -+ 0x858, 0x8060E000, -+ 0x85C, 0x74210168, -+ 0x860, 0x6929C321, -+ 0x864, 0x79727432, -+ 0x868, 0x8CA7A314, -+ 0x86C, 0x888C2878, -+ 0x870, 0x08888888, -+ 0x874, 0x31612C2E, -+ 0x878, 0x00000152, -+ 0x87C, 0x000FD000, -+ 0x8A0, 0x00000013, -+ 0x8A4, 0x7F7F7F7F, -+ 0x8A8, 0xA2000338, -+ 0x8AC, 0x0FF0FA0A, -+ 0x8B4, 0x000FC080, -+ 0x8B8, 0x6C10D7FF, -+ 0x8BC, 0x0CA52090, -+ 0x8C0, 0x1BF00020, -+ 0x8C4, 0x00000000, -+ 0x8C8, 0x00013169, -+ 0x8CC, 0x08248492, -+ 0x8D4, 0x940008A0, -+ 0x8D8, 0x290B5612, -+ 0x8F8, 0x400002C0, -+ 0x8FC, 0x00000000, -+ 0x900, 0x00000700, -+ 0x90C, 0x00000000, -+ 0x910, 0x0000FC00, -+ 0x914, 0x00000404, -+ 0x918, 0x1C1028C0, -+ 0x91C, 0x64B11A1C, -+ 0x920, 0xE0767233, -+ 0x924, 0x055AA500, -+ 0x928, 0x00000004, -+ 0x92C, 0xFFFE0000, -+ 0x930, 0xFFFFFFFE, -+ 0x934, 0x001FFFFF, -+ 0x960, 0x00000000, -+ 0x964, 0x00000000, -+ 0x968, 0x00000000, -+ 0x96C, 0x00000000, -+ 0x970, 0x801FFFFF, -+ 0x974, 0x000003FF, -+ 0x978, 0x00000000, -+ 0x97C, 0x00000000, -+ 0x980, 0x00000000, -+ 0x984, 0x00000000, -+ 0x988, 0x00000000, -+ 0x990, 0x27100000, -+ 0x994, 0xFFFF0100, -+ 0x998, 0xFFFFFF5C, -+ 0x99C, 0xFFFFFFFF, -+ 0x9A0, 0x000000FF, -+ 0x9A4, 0x00480080, -+ 0x9A8, 0x00000000, -+ 0x9AC, 0x00000000, -+ 0x9B0, 0x81081008, -+ 0x9B4, 0x01081008, -+ 0x9B8, 0x01081008, -+ 0x9BC, 0x01081008, -+ 0x9D0, 0x00000000, -+ 0x9D4, 0x00000000, -+ 0x9D8, 0x00000000, -+ 0x9DC, 0x00000000, -+ 0x9E0, 0x00005D00, -+ 0x9E4, 0x00000003, -+ 0x9E8, 0x00000001, -+ 0xA00, 0x00D047C8, -+ 0xA04, 0x01FF800C, -+ 0xA08, 0x8C8A8300, -+ 0xA0C, 0x2E68000F, -+ 0xA10, 0x9500BB78, -+ 0xA14, 0x11144028, -+ 0xA18, 0x00881117, -+ 0xA1C, 0x89140F00, -+ 0xA20, 0x1A1B0000, -+ 0xA24, 0x090E1317, -+ 0xA28, 0x00000204, -+ 0xA2C, 0x00900000, -+ 0xA70, 0x101FFF00, -+ 0xA74, 0x00000008, -+ 0xA78, 0x00000900, -+ 0xA7C, 0x225B0606, -+ 0xA80, 0x21805490, -+ 0xA84, 0x001F0000, -+ 0xB00, 0x03100040, -+ 0xB04, 0x0000B000, -+ 0xB08, 0xAE0201EB, -+ 0xB0C, 0x01003207, -+ 0xB10, 0x00009807, -+ 0xB14, 0x01000000, -+ 0xB18, 0x00000002, -+ 0xB1C, 0x00000002, -+ 0xB20, 0x0000001F, -+ 0xB24, 0x03020100, -+ 0xB28, 0x07060504, -+ 0xB2C, 0x0B0A0908, -+ 0xB30, 0x0F0E0D0C, -+ 0xB34, 0x13121110, -+ 0xB38, 0x17161514, -+ 0xB3C, 0x0000003A, -+ 0xB40, 0x00000000, -+ 0xB44, 0x00000000, -+ 0xB48, 0x13000032, -+ 0xB4C, 0x48080000, -+ 0xB50, 0x00000000, -+ 0xB54, 0x00000000, -+ 0xB58, 0x00000000, -+ 0xB5C, 0x00000000, -+ 0xC00, 0x00000007, -+ 0xC04, 0x00042020, -+ 0xC08, 0x80410231, -+ 0xC0C, 0x00000000, -+ 0xC10, 0x00000100, -+ 0xC14, 0x01000000, -+ 0xC1C, 0x40000003, -+ 0xC20, 0x2C2C2C2C, -+ 0xC24, 0x30303030, -+ 0xC28, 0x30303030, -+ 0xC2C, 0x2C2C2C2C, -+ 0xC30, 0x2C2C2C2C, -+ 0xC34, 0x2C2C2C2C, -+ 0xC38, 0x2C2C2C2C, -+ 0xC3C, 0x2A2A2A2A, -+ 0xC40, 0x2A2A2A2A, -+ 0xC44, 0x2A2A2A2A, -+ 0xC48, 0x2A2A2A2A, -+ 0xC4C, 0x2A2A2A2A, -+ 0xC50, 0x00000020, -+ 0xC54, 0x001C1208, -+ 0xC58, 0x30000C1C, -+ 0xC5C, 0x00000058, -+ 0xC60, 0x34344443, -+ 0xC64, 0x07003333, -+ 0xC68, 0x19791979, -+ 0xC6C, 0x19791979, -+ 0xC70, 0x19791979, -+ 0xC74, 0x19791979, -+ 0xC78, 0x19791979, -+ 0xC7C, 0x19791979, -+ 0xC80, 0x19791979, -+ 0xC84, 0x19791979, -+ 0xC94, 0x0100005C, -+ 0xC98, 0x00000000, -+ 0xC9C, 0x00000000, -+ 0xCA0, 0x00000029, -+ 0xCA4, 0x08040201, -+ 0xCA8, 0x80402010, -+ 0xCB0, 0x77775747, -+ 0xCB4, 0x10000077, -+ 0xCB8, 0x00508240, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_PHY_REG( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_PHY_REG)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8821A_PHY_REG; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8821A_PHY_REG\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } -+ else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigBB_PHY_8821A(pDM_Odm, v1, bMaskDWord, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8821A_PHY_REG(void) -+{ -+ return 54; -+} -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8821A_PHY_REG_PG[] = { -+ 0, 0, 0, 0x00000c20, 0xffffffff, 0x32343638, -+ 0, 0, 0, 0x00000c24, 0xffffffff, 0x36363838, -+ 0, 0, 0, 0x00000c28, 0xffffffff, 0x28303234, -+ 0, 0, 0, 0x00000c2c, 0xffffffff, 0x34363838, -+ 0, 0, 0, 0x00000c30, 0xffffffff, 0x26283032, -+ 0, 0, 0, 0x00000c3c, 0xffffffff, 0x32343636, -+ 0, 0, 0, 0x00000c40, 0xffffffff, 0x24262830, -+ 0, 0, 0, 0x00000c44, 0x0000ffff, 0x00002022, -+ 1, 0, 0, 0x00000c24, 0xffffffff, 0x34343636, -+ 1, 0, 0, 0x00000c28, 0xffffffff, 0x26283032, -+ 1, 0, 0, 0x00000c2c, 0xffffffff, 0x32343636, -+ 1, 0, 0, 0x00000c30, 0xffffffff, 0x24262830, -+ 1, 0, 0, 0x00000c3c, 0xffffffff, 0x32343636, -+ 1, 0, 0, 0x00000c40, 0xffffffff, 0x24262830, -+ 1, 0, 0, 0x00000c44, 0x0000ffff, 0x00002022 -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_PHY_REG_PG( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_PHY_REG_PG)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8821A_PHY_REG_PG; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrByRate, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrByRate = ArrayLen/6; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8821A_PHY_REG_PG\n")); -+ -+ pDM_Odm->PhyRegPgVersion = 1; -+ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; -+ -+ for (i = 0; i < ArrayLen; i += 6) { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ u4Byte v3 = Array[i+2]; -+ u4Byte v4 = Array[i+3]; -+ u4Byte v5 = Array[i+4]; -+ u4Byte v6 = Array[i+5]; -+ -+ odm_ConfigBB_PHY_REG_PG_8821A(pDM_Odm, v1, v2, v3, v4, v5, v6); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf(pHalData->BufOfLinesPwrByRate[i/6], 100, "%s, %s, %s, 0x%X, 0x%08X, 0x%08X,", -+ (v1 == 0?"2.4G":" 5G"), (v2 == 0?"A":"B"), (v3 == 0?"1Tx":"2Tx"), v4, v5, v6); -+#endif -+ } -+} -+ -+ -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_bb.h linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_bb.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_bb.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_bb.h 2017-06-07 23:07:21.025688852 +0300 -@@ -0,0 +1,59 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.14*/ -+#if (RTL8821A_SUPPORT == 1) -+#ifndef __INC_MP_BB_HW_IMG_8821A_H -+#define __INC_MP_BB_HW_IMG_8821A_H -+ -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_AGC_TAB(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_AGC_TAB(void); -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_PHY_REG(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_PHY_REG(void); -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_PHY_REG_PG(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_PHY_REG_PG(void); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_fw.c linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_fw.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_fw.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_fw.c 2017-06-07 23:07:21.029689216 +0300 -@@ -0,0 +1,6873 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.16*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8821A_SUPPORT == 1) -+#if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) -+ -+ -+u1Byte Array_MP_8821A_FW_AP[] = { -+0x01, 0x21, 0x20, 0x00, 0x25, 0x00, 0x00, 0x00, 0x09, 0x08, 0x18, 0x09, 0x7E, 0x40, 0x00, 0x00, -+0xED, 0x24, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x47, 0x8D, 0x02, 0x5F, 0xF8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x60, 0x34, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x77, 0xEE, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x5F, 0xF9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x6F, 0xF3, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x77, 0xED, 0x00, 0x04, 0x0C, 0x00, 0x00, 0x00, 0x04, 0x08, 0x08, 0x00, -+0x00, 0x00, 0x0A, 0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, -+0x03, 0x02, 0x00, 0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, -+0x0C, 0x0A, 0x07, 0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, -+0x00, 0x08, 0x0B, 0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, -+0x09, 0x04, 0x00, 0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, -+0x24, 0x22, 0x14, 0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, -+0x00, 0x20, 0x23, 0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, -+0x0F, 0x04, 0x00, 0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, -+0x31, 0x2F, 0x18, 0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, -+0x00, 0x30, 0x31, 0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, -+0x14, 0x00, 0x00, 0x30, 0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, -+0x00, 0x00, 0x05, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0x10, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x3F, 0x00, 0x00, 0x00, -+0x00, 0x15, 0xF0, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0xCF, 0xFF, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, -+0x25, 0x27, 0x28, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, -+0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, -+0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, -+0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, -+0x2A, 0x2A, 0x2A, 0x00, 0x04, 0x00, 0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x18, 0x00, 0x24, 0x00, -+0x30, 0x00, 0x48, 0x00, 0x60, 0x00, 0x90, 0x00, 0xC0, 0x00, 0xD8, 0x00, 0x3C, 0x00, 0x64, 0x00, -+0x78, 0x00, 0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, 0x90, 0x01, 0xE0, 0x00, 0xA0, 0x00, 0xF0, 0x01, -+0x40, 0x01, 0x90, 0x02, 0x58, 0x03, 0x20, 0x04, 0xB0, 0x06, 0x40, 0x00, 0xC8, 0x01, 0x18, 0x01, -+0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x00, 0xC8, 0x01, 0x18, 0x01, -+0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x00, 0x3C, 0x00, 0x50, 0x00, -+0x64, 0x00, 0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, 0x90, 0x01, 0x90, 0x02, 0x58, 0x03, 0x20, 0x00, -+0x78, 0x00, 0xF0, 0x01, 0x90, 0x02, 0x58, 0x03, 0xE8, 0x07, 0xD0, 0x09, 0x60, 0x0F, 0xA0, 0x12, -+0xC0, 0x15, 0x18, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, -+0x40, 0x07, 0xD0, 0x07, 0xD0, 0x07, 0xD0, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, 0xD0, 0x03, -+0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x07, 0xD0, 0x07, 0xD0, 0x00, 0x02, 0x00, 0x02, 0x00, -+0x04, 0x00, 0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x48, 0x00, -+0x60, 0x00, 0x6C, 0x00, 0x14, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, -+0xC8, 0x00, 0xF0, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x01, 0x2C, 0x01, 0x90, 0x02, -+0x58, 0x03, 0x20, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, -+0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, -+0x20, 0x03, 0xE8, 0x00, 0x1E, 0x00, 0x28, 0x00, 0x32, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, -+0xC8, 0x00, 0xF0, 0x01, 0x7C, 0x01, 0x90, 0x00, 0x3C, 0x00, 0x78, 0x00, 0xC8, 0x01, 0x2C, 0x01, -+0xF4, 0x03, 0xE8, 0x04, 0xB0, 0x07, 0xD0, 0x09, 0x60, 0x0A, 0xF0, 0x00, 0x64, 0x00, 0x8C, 0x00, -+0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x00, -+0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, -+0xE8, 0x03, 0xE8, 0x01, 0x01, 0x01, 0x02, 0x01, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, 0x05, 0x05, -+0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, -+0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, -+0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x0B, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, -+0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, 0x04, 0x05, -+0x06, 0x07, 0x08, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x02, 0x04, 0x06, 0x07, 0x08, -+0x0A, 0x0B, 0x0C, 0x03, 0x05, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, -+0x0A, 0x0B, 0x0C, 0x02, 0x04, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x03, 0x05, 0x06, -+0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, -+0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x19, 0x06, 0x04, 0x02, 0x00, -+0x18, 0x00, 0x04, 0x0C, 0x14, 0x2C, 0x36, 0x04, 0x08, 0x08, 0x08, 0x0A, 0x0A, 0x04, 0x04, 0x04, -+0x05, 0x04, 0x04, 0x05, 0x07, 0x07, 0x07, 0x08, 0x0A, 0x04, 0x07, 0x0A, 0x0E, 0x11, 0x13, 0x14, -+0x15, 0x03, 0x04, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, -+0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x07, 0x08, 0x08, 0x0A, 0x0A, 0x0C, 0x0E, -+0x10, 0x11, 0x11, 0x07, 0x09, 0x09, 0x0B, 0x0B, 0x0D, 0x0F, 0x13, 0x13, 0x14, 0x05, 0x05, 0x07, -+0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, -+0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, 0x07, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x05, 0x06, 0x07, -+0x0D, 0x10, 0x11, 0x12, 0x12, 0x07, 0x08, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, -+0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x05, 0x06, 0x08, -+0x09, 0x0C, 0x0E, 0x12, 0x12, 0x13, 0x14, 0x07, 0x08, 0x09, 0x0A, 0x0C, 0x0F, 0x12, 0x12, 0x14, -+0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, -+0x0E, 0x11, 0x13, 0x13, 0x13, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x44, 0xE4, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x48, 0xAE, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x48, 0xAE, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x45, 0x2D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x45, 0x2C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x45, 0x2D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, -+0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0x02, 0x47, 0xCB, -+0x02, 0x45, 0xBD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, -+0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, -+0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, -+0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x48, 0x93, 0xE4, 0x7E, -+0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, -+0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, -+0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, -+0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, -+0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, -+0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, -+0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xA4, -+0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, -+0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, -+0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, -+0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, -+0xA3, 0x80, 0xDF, 0x41, 0xA6, 0xB5, 0x00, 0x41, 0xA6, 0xB6, 0x00, 0x44, 0xA6, 0x85, 0x41, 0x4E, -+0x59, 0x00, 0x44, 0xA6, 0x81, 0x61, 0x6E, 0x79, 0x00, 0x41, 0xA6, 0xC3, 0x00, 0x00, 0x4B, 0x08, -+0x58, 0xA8, 0x58, 0xCF, 0xE4, 0xFD, 0x7F, 0x8D, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, -+0x82, 0x75, 0x83, 0x00, 0xED, 0xF1, 0xFC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0xBE, 0xED, 0xF0, 0x90, 0xA6, 0xBD, 0xEF, 0xF0, 0xD3, 0x94, 0x07, -+0x50, 0x41, 0x7F, 0x47, 0x31, 0x71, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, -+0x47, 0x11, 0xB8, 0x7F, 0x46, 0x31, 0x71, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, -+0x46, 0xF1, 0xE3, 0x60, 0x0D, 0x7F, 0x45, 0x31, 0x71, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, -+0x80, 0x0C, 0x7F, 0x45, 0x31, 0x71, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, -+0x45, 0x80, 0x45, 0x90, 0xA6, 0xBD, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0x31, 0x71, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x11, 0xB8, 0x7F, 0x62, 0x31, 0x71, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0xF1, 0xE3, 0x60, 0x0E, 0x31, 0x6F, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x0D, 0x31, 0x6F, 0x80, 0x02, 0xC3, -+0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x11, 0xB8, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, -+0x61, 0x31, 0x7E, 0x90, 0xA6, 0xBD, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xE0, 0x90, 0xA6, 0xBF, 0xF1, 0xFC, -+0x90, 0xA6, 0xBF, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x71, 0xBB, 0x20, 0xE6, 0x02, 0x41, 0x8F, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0xA6, 0xAC, 0xF0, -+0x7F, 0x8D, 0x31, 0x7E, 0x90, 0xA6, 0xAD, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0xA6, 0xAE, -+0xF0, 0x90, 0xA6, 0xAD, 0xE0, 0x24, 0xFC, 0x60, 0x0F, 0x24, 0x03, 0x60, 0x02, 0x41, 0x88, 0x90, -+0xA6, 0xAC, 0xE0, 0xFF, 0x71, 0x6B, 0x41, 0x88, 0x90, 0xA6, 0xAC, 0xE0, 0x24, 0x15, 0x12, 0x66, -+0x27, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x51, 0xC1, 0x75, 0xF0, 0x04, 0x71, 0xC7, 0x13, 0x13, 0x54, -+0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x51, 0xC1, 0x75, 0xF0, 0x04, 0x71, 0xC7, 0x12, 0x57, 0x4E, 0xFB, -+0x0D, 0xE4, 0xFF, 0x51, 0xC1, 0x75, 0xF0, 0x04, 0x71, 0xC7, 0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, -+0xFF, 0x51, 0xC1, 0x75, 0xF0, 0x04, 0x12, 0x67, 0xF7, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xC1, -+0x75, 0xF0, 0x04, 0x90, 0x96, 0x16, 0x51, 0xBC, 0x75, 0xF0, 0x04, 0xF1, 0xD5, 0xC4, 0x13, 0x54, -+0x01, 0xFB, 0x0D, 0x7F, 0x01, 0x51, 0xC1, 0x75, 0xF0, 0x04, 0xF1, 0xD5, 0x54, 0x1F, 0x51, 0xBF, -+0x12, 0x63, 0xBA, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xC1, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x01, -+0x51, 0xBC, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x51, 0xBC, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, -+0x51, 0xBC, 0x75, 0xF0, 0x08, 0x12, 0x80, 0x5B, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xC1, 0x75, 0xF0, -+0x08, 0x90, 0x89, 0x05, 0x51, 0xBC, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x06, 0x51, 0xBC, 0x75, 0xF0, -+0x08, 0x12, 0x80, 0x53, 0xFB, 0x0D, 0x51, 0x94, 0x71, 0xBB, 0x30, 0xE0, 0x02, 0x11, 0xB4, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, -+0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, -+0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0x11, 0x4F, 0xE0, 0xFB, -+0x0D, 0x51, 0x94, 0x90, 0xA6, 0xAC, 0xE0, 0x22, 0x7F, 0x54, 0x31, 0x7E, 0xE5, 0x0D, 0x5F, 0xF5, -+0x11, 0x7F, 0x55, 0x31, 0x7E, 0xE5, 0x0E, 0x5F, 0xF5, 0x12, 0x7F, 0x56, 0x31, 0x7E, 0xE5, 0x0F, -+0x5F, 0xF5, 0x13, 0x7F, 0x57, 0x31, 0x7E, 0xE5, 0x10, 0x5F, 0xF5, 0x14, 0xAD, 0x11, 0x7F, 0x54, -+0x11, 0xB8, 0xAD, 0x12, 0x7F, 0x55, 0x11, 0xB8, 0xAD, 0x13, 0x7F, 0x56, 0x11, 0xB8, 0xAD, 0x14, -+0x7F, 0x57, 0x11, 0xB8, 0x53, 0x91, 0xEF, 0x22, 0x7F, 0x81, 0x31, 0x7E, 0xEF, 0x54, 0xFE, 0xFD, -+0x7F, 0x81, 0x11, 0xB8, 0x7F, 0x80, 0x31, 0x7E, 0xEF, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x11, 0xB8, -+0x12, 0x7C, 0x26, 0x12, 0x3D, 0x3B, 0x12, 0x7A, 0xE7, 0x12, 0x7C, 0x33, 0x7F, 0x01, 0x12, 0x45, -+0xF5, 0x7F, 0x02, 0x12, 0x45, 0xF5, 0x12, 0x58, 0x16, 0x12, 0x77, 0x88, 0x90, 0x01, 0xCC, 0x74, -+0x0F, 0xF0, 0x7F, 0x80, 0x31, 0x7E, 0xEF, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x11, 0xB8, 0x75, 0x28, -+0xFF, 0x12, 0x58, 0xA1, 0x12, 0x78, 0x63, 0x7F, 0x81, 0x31, 0x7E, 0xEF, 0x44, 0x04, 0xFD, 0x7F, -+0x81, 0x11, 0xB8, 0x12, 0x7C, 0x3D, 0xE4, 0xFF, 0x02, 0x46, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0xA6, 0xBB, 0xEF, 0xF0, 0x71, 0xBB, 0x30, 0xE6, 0x3A, 0x7F, 0x8D, 0x31, 0x7E, -+0xEF, 0x64, 0x01, 0x70, 0x31, 0x90, 0xA6, 0xBC, 0xF0, 0x90, 0xA6, 0xBC, 0xE0, 0xFD, 0x90, 0xA6, -+0xBB, 0xE0, 0x75, 0xF0, 0x10, 0xF1, 0x6B, 0xE5, 0x82, 0x2D, 0x12, 0x63, 0xAE, 0xE0, 0xFB, 0xE4, -+0xFF, 0x51, 0x94, 0x90, 0xA6, 0xBC, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xDA, 0x71, -+0xBB, 0x30, 0xE0, 0x02, 0x11, 0xB4, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x8F, 0x31, 0x7E, 0xEF, -+0x22, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x52, 0x90, 0x96, 0x18, 0x11, 0x4F, 0xE0, 0x22, 0x75, 0x40, -+0xFF, 0x75, 0x41, 0x43, 0x75, 0x42, 0xB1, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x20, -+0xF1, 0xDC, 0x75, 0x41, 0x43, 0x75, 0x42, 0xB7, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0xA3, 0x79, -+0x26, 0xF1, 0xDC, 0x75, 0x41, 0x43, 0x75, 0x42, 0xBD, 0x75, 0x43, 0x54, 0x7B, 0x01, 0x7A, 0xA3, -+0x79, 0x2C, 0xF1, 0xDC, 0x75, 0x41, 0x44, 0x75, 0x42, 0x11, 0x75, 0x43, 0x54, 0x7B, 0x01, 0x7A, -+0xA3, 0x79, 0x80, 0x12, 0x34, 0x62, 0xE4, 0xF5, 0x51, 0xE4, 0xFF, 0x74, 0x95, 0x25, 0x51, 0xF1, -+0x5A, 0xE0, 0x54, 0xFE, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x51, 0x90, 0x81, 0x00, 0xBF, 0x03, 0x08, -+0x12, 0x63, 0xA8, 0x74, 0x80, 0xF0, 0x80, 0x05, 0x12, 0x63, 0xA8, 0xE4, 0xF0, 0x75, 0xF0, 0x08, -+0xE5, 0x51, 0x12, 0x63, 0xA5, 0xE4, 0xF0, 0x0F, 0xBF, 0x10, 0xD0, 0x05, 0x51, 0xE5, 0x51, 0xB4, -+0x80, 0xC7, 0xE4, 0x90, 0xAD, 0xE2, 0xF0, 0x90, 0x94, 0x91, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, -+0x00, 0xE4, 0xF5, 0x51, 0xE4, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x51, 0x12, 0x6B, 0x42, 0xF0, 0x0F, -+0xBF, 0x05, 0xF3, 0x74, 0x96, 0x25, 0x51, 0x12, 0x7F, 0xB0, 0xE4, 0xF0, 0xE5, 0x51, 0x12, 0x6C, -+0x89, 0xB1, 0x56, 0x74, 0x95, 0x25, 0x51, 0x12, 0x6C, 0x97, 0xE4, 0xF0, 0xE5, 0x51, 0xB1, 0x4D, -+0xE5, 0x51, 0xF1, 0xEB, 0xB1, 0x56, 0xE5, 0x51, 0xF1, 0x4B, 0xB1, 0x56, 0xE5, 0x51, 0xF1, 0x39, -+0xB1, 0x56, 0x75, 0xF0, 0x04, 0xE5, 0x51, 0x12, 0x67, 0xF7, 0x74, 0x3F, 0xB1, 0x34, 0xF1, 0xF5, -+0xE4, 0xB1, 0x34, 0xF1, 0xD5, 0x54, 0xE0, 0x44, 0x09, 0xB1, 0x34, 0x71, 0xC7, 0x54, 0xF3, 0xB1, -+0x34, 0x71, 0xC7, 0x54, 0xFC, 0xB1, 0x34, 0xF1, 0xD5, 0x44, 0x20, 0xB1, 0x34, 0x71, 0xC7, 0x54, -+0xCF, 0xB1, 0x34, 0x71, 0xC7, 0x44, 0x40, 0xB1, 0x34, 0x71, 0xC7, 0x54, 0x7F, 0xB1, 0x34, 0xF1, -+0xF5, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x51, 0xF1, 0x6B, 0xEF, 0xF0, 0x74, 0x95, 0x25, 0x51, -+0xF1, 0x5A, 0xE4, 0xF0, 0x05, 0x51, 0xE5, 0x51, 0x64, 0x80, 0x60, 0x02, 0x81, 0x64, 0x90, 0x04, -+0x49, 0x74, 0xF0, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0xA5, 0x08, 0x74, 0x02, -+0xF0, 0xA3, 0x74, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xE4, 0xFB, -+0xFD, 0xFF, 0x12, 0x7D, 0xD7, 0x74, 0x15, 0x25, 0x51, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, -+0x74, 0xFF, 0xF0, 0x22, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x51, 0x22, 0xE0, 0xFF, 0x25, 0xE0, 0x24, -+0x95, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x25, 0xE0, 0x24, -+0x95, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x06, 0x89, -+0x90, 0xA5, 0x13, 0x12, 0x74, 0x74, 0x90, 0xA5, 0x14, 0x12, 0x65, 0x70, 0x90, 0xA5, 0x15, 0xF0, -+0x90, 0x04, 0x87, 0xE0, 0x60, 0x02, 0xE1, 0x21, 0xE4, 0xFF, 0x74, 0x18, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0xA5, 0xF5, 0x83, 0xE4, 0xF0, 0x0F, 0xEF, 0xB4, 0x0C, 0xEF, 0x90, 0xA5, 0x15, 0xE0, 0x30, -+0xE0, 0x62, 0x90, 0xA5, 0x13, 0xE0, 0xD3, 0x94, 0x80, 0x40, 0x59, 0xA3, 0xE0, 0xD3, 0x94, 0x80, -+0x40, 0x52, 0xF1, 0x45, 0x90, 0xA6, 0x2E, 0xEE, 0x12, 0x57, 0x02, 0xA3, 0xF1, 0xC7, 0x7B, 0x01, -+0xFA, 0x7D, 0x02, 0x7F, 0x80, 0x12, 0x56, 0x3E, 0x90, 0xA5, 0x18, 0x74, 0x01, 0xF1, 0x44, 0x90, -+0xA5, 0x19, 0xF1, 0x43, 0x78, 0x08, 0x12, 0x08, 0x47, 0x90, 0xA5, 0x1A, 0xF1, 0x43, 0x78, 0x10, -+0x12, 0x08, 0x47, 0x90, 0xA5, 0x1B, 0xF1, 0x43, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0xA5, 0x1C, -+0xEF, 0xF0, 0x12, 0x80, 0x14, 0x74, 0x05, 0xF0, 0x90, 0x94, 0x91, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x00, 0x00, 0xE1, 0x18, 0x90, 0xA5, 0x15, 0xE0, 0x20, 0xE1, 0x02, 0xC1, 0x7C, 0x90, 0xA5, 0x18, -+0x74, 0x02, 0xF0, 0x12, 0x80, 0x30, 0x50, 0x32, 0xF1, 0x37, 0x12, 0x7F, 0xDA, 0xF1, 0x4A, 0x12, -+0x56, 0xE6, 0x7B, 0x01, 0xFA, 0x7D, 0x03, 0x7F, 0x80, 0x12, 0x56, 0x3E, 0x90, 0xA5, 0x13, 0xE0, -+0xFD, 0xF1, 0x39, 0xF1, 0x30, 0x90, 0xA5, 0x19, 0xF1, 0x22, 0x90, 0xA5, 0x1B, 0x12, 0x80, 0x63, -+0xF1, 0x37, 0xB1, 0x56, 0xF1, 0x4A, 0xB1, 0x56, 0x80, 0x06, 0x90, 0xA5, 0x19, 0x74, 0xEA, 0xF0, -+0x12, 0x80, 0x27, 0x50, 0x29, 0xF1, 0x37, 0x12, 0x7F, 0xDA, 0xF1, 0x4A, 0x12, 0x56, 0xE6, 0x7B, -+0x01, 0xFA, 0x7D, 0x04, 0x12, 0x80, 0x0A, 0xFD, 0xF1, 0x39, 0xF1, 0x30, 0x90, 0xA5, 0x1D, 0xF1, -+0x22, 0x12, 0x7F, 0xEA, 0xF1, 0x37, 0xB1, 0x56, 0xF1, 0x4A, 0xB1, 0x56, 0x80, 0x06, 0x90, 0xA5, -+0x1D, 0x74, 0xEA, 0xF0, 0x12, 0x80, 0x14, 0x74, 0x09, 0xF0, 0xE1, 0x18, 0x90, 0xA5, 0x15, 0xE0, -+0x60, 0x02, 0xE1, 0x0D, 0x12, 0x80, 0x30, 0x50, 0x35, 0x12, 0x56, 0xCA, 0x7B, 0x01, 0xFA, 0x7D, -+0x05, 0x7F, 0x80, 0x12, 0x56, 0x3E, 0x12, 0x7F, 0xE2, 0xF1, 0xEA, 0xF1, 0x30, 0x90, 0xA5, 0x19, -+0x12, 0x80, 0x63, 0xE0, 0xFD, 0x12, 0x7F, 0x93, 0xF1, 0x30, 0x90, 0xA5, 0x1B, 0x12, 0x80, 0x1E, -+0xF1, 0x6B, 0xE0, 0x90, 0xA5, 0x1D, 0xF0, 0x90, 0xA5, 0x13, 0xB1, 0x3B, 0x80, 0x04, 0x12, 0x7F, -+0xE2, 0xF0, 0x12, 0x80, 0x27, 0x50, 0x30, 0x12, 0x56, 0xCA, 0x7B, 0x01, 0xFA, 0x7D, 0x06, 0x12, -+0x80, 0x0A, 0x90, 0xA5, 0x1E, 0xF1, 0xEA, 0xF1, 0x30, 0x12, 0x7F, 0xEA, 0xE0, 0xFD, 0x12, 0x7F, -+0x93, 0xF1, 0x30, 0x90, 0xA5, 0x21, 0x12, 0x80, 0x1E, 0xF1, 0x6B, 0xE0, 0x90, 0xA5, 0x23, 0xF0, -+0x90, 0xA5, 0x14, 0xB1, 0x3B, 0x80, 0x08, 0x90, 0xA5, 0x14, 0xE0, 0x90, 0xA5, 0x1E, 0xF0, 0x90, -+0xA5, 0x16, 0x74, 0x04, 0xF0, 0x90, 0xA5, 0x24, 0x74, 0x0C, 0xF0, 0x80, 0x0B, 0x90, 0xA5, 0x16, -+0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA5, 0x24, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x16, 0x12, 0x71, -+0x2D, 0x22, 0xF0, 0xEE, 0xA3, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x96, 0xF5, 0x82, 0xE4, 0x34, 0x9E, -+0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0xE0, 0xFF, 0x25, 0xE0, 0x24, 0x16, 0xF5, 0x82, 0xE4, -+0x34, 0xA0, 0x22, 0xEF, 0xF0, 0x90, 0x94, 0x91, 0x01, 0x37, 0xEF, 0x25, 0xE0, 0x24, 0x96, 0xF5, -+0x82, 0xE4, 0x34, 0x9E, 0x22, 0xF0, 0x74, 0x95, 0x25, 0x52, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, -+0x83, 0x22, 0x90, 0xA5, 0x1E, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x52, 0x90, 0x81, 0x00, 0x01, 0x4F, -+0x90, 0x01, 0x30, 0xE4, 0xF1, 0xC7, 0x90, 0x01, 0x38, 0xF1, 0xC7, 0xFD, 0x7F, 0x50, 0x11, 0xB8, -+0xE4, 0xFD, 0x7F, 0x51, 0x11, 0xB8, 0xE4, 0xFD, 0x7F, 0x52, 0x11, 0xB8, 0xE4, 0xFD, 0x7F, 0x53, -+0x01, 0xB8, 0x90, 0x01, 0x34, 0x74, 0xFF, 0xF1, 0xC7, 0x90, 0x01, 0x3C, 0xF1, 0xC7, 0xFD, 0x7F, -+0x54, 0x11, 0xB8, 0x7D, 0xFF, 0x7F, 0x55, 0x11, 0xB8, 0x7D, 0xFF, 0x7F, 0x56, 0x11, 0xB8, 0x7D, -+0xFF, 0x7F, 0x57, 0x01, 0xB8, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA6, 0x2E, 0xE5, 0x55, 0xF0, 0xA3, -+0xE5, 0x56, 0xF0, 0xE4, 0x90, 0xA6, 0x32, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xFF, -+0x75, 0xF0, 0x04, 0xE5, 0x52, 0x90, 0x96, 0x17, 0x11, 0x4F, 0xE0, 0x22, 0x12, 0x34, 0x62, 0x75, -+0x40, 0xFF, 0x22, 0x11, 0xB8, 0x90, 0xA6, 0xBE, 0xE0, 0x22, 0xF0, 0x25, 0xE0, 0x24, 0x95, 0xF5, -+0x82, 0xE4, 0x34, 0x9C, 0x22, 0x90, 0x96, 0x16, 0x01, 0x4F, 0x21, 0x9A, 0xF0, 0x7F, 0x10, 0x7E, -+0x00, 0x02, 0x3D, 0x7A, 0xE0, 0x90, 0xA6, 0x95, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x90, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -+0xA6, 0x94, 0xE0, 0xF5, 0x3B, 0xA3, 0xE0, 0xF5, 0x3C, 0x12, 0x35, 0x7A, 0x90, 0xA6, 0x90, 0x12, -+0x7A, 0xBC, 0xA3, 0xA3, 0xA3, 0x74, 0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xAD, 0x07, 0x90, -+0xA5, 0x01, 0xE0, 0x75, 0xF0, 0x20, 0xA4, 0xFF, 0x90, 0xA6, 0x96, 0x11, 0xE4, 0x90, 0xA5, 0x02, -+0xE0, 0x75, 0xF0, 0x08, 0xA4, 0xAE, 0xF0, 0x90, 0xA6, 0x98, 0xF0, 0xEE, 0xA3, 0xF0, 0x11, 0xD0, -+0x90, 0xA6, 0x9A, 0xF0, 0xEE, 0xA3, 0xF0, 0xED, 0x64, 0x01, 0x60, 0x63, 0x90, 0xA4, 0xFF, 0xE0, -+0xFE, 0xF1, 0x4E, 0x30, 0xE0, 0x59, 0xEE, 0xF1, 0x7C, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x11, 0xD8, -+0xFE, 0x54, 0x0F, 0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFD, 0x11, 0xD8, 0xC4, 0x13, 0x54, -+0x07, 0x30, 0xE0, 0x24, 0xA3, 0xE0, 0x30, 0xE0, 0x0F, 0x90, 0xA6, 0x9B, 0xE0, 0x90, 0xA6, 0x94, -+0xF0, 0x90, 0xA6, 0x9A, 0x11, 0x04, 0x80, 0x10, 0x11, 0xD0, 0xFF, 0x12, 0x3D, 0x7A, 0xF1, 0x77, -+0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0x48, 0xCC, 0x90, 0xA4, 0xFF, 0xE0, 0xC4, 0x54, 0x0F, 0x30, -+0xE0, 0x0D, 0x90, 0xA6, 0x99, 0xE0, 0x90, 0xA6, 0x94, 0xF0, 0x90, 0xA6, 0x98, 0x11, 0x04, 0x22, -+0x90, 0xA6, 0x96, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x12, 0x48, 0xCC, 0x90, 0xA4, 0xFF, 0xE0, 0x22, -+0xFF, 0x90, 0xA6, 0x2E, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x04, 0x85, 0xE0, 0xF5, -+0x5C, 0x90, 0x9D, 0x95, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x52, 0x90, 0xA4, 0xFD, 0xE0, 0xFF, 0xE5, -+0x52, 0xC3, 0x9F, 0x40, 0x02, 0xC1, 0x09, 0xE5, 0x52, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA5, -+0x1F, 0xF0, 0xE5, 0x52, 0x54, 0x07, 0xA3, 0xF0, 0x90, 0x04, 0xA0, 0xE0, 0xFF, 0xA3, 0xE0, 0xFE, -+0xEF, 0x64, 0x01, 0x70, 0x25, 0xE5, 0x52, 0x6E, 0x70, 0x20, 0xA3, 0xE0, 0xF5, 0x53, 0xA3, 0xE0, -+0x12, 0x4F, 0x62, 0xE5, 0x53, 0xF0, 0xF1, 0x5E, 0xE0, 0x54, 0xFC, 0xFF, 0x90, 0xA5, 0x1E, 0xE0, -+0x54, 0x03, 0x4F, 0xFF, 0xF1, 0x5E, 0xEF, 0xF0, 0xC1, 0x05, 0xE5, 0x5C, 0x60, 0x15, 0x90, 0x9D, -+0x95, 0xE0, 0x85, 0x5C, 0xF0, 0x84, 0xE5, 0xF0, 0x60, 0x09, 0xE4, 0xFD, 0xAF, 0x52, 0x12, 0x6A, -+0xE8, 0xC1, 0x05, 0xAF, 0x52, 0x12, 0x75, 0x78, 0xEF, 0x70, 0x02, 0xC1, 0x05, 0x12, 0x4B, 0xC2, -+0xF1, 0x4E, 0x30, 0xE0, 0x02, 0xC1, 0x05, 0x90, 0xA5, 0x1F, 0x12, 0x6C, 0xBB, 0xE0, 0xFD, 0x7C, -+0x00, 0x90, 0xA5, 0x20, 0x12, 0x6F, 0xC5, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0x12, 0x6F, 0xD3, 0x60, 0x02, 0xC1, 0x05, 0xE5, 0x52, 0x12, 0x6C, 0x89, 0x12, 0x4F, 0x30, 0x4E, -+0x70, 0x08, 0x12, 0x6C, 0x93, 0xE0, 0x70, 0x02, 0xC1, 0x05, 0xE5, 0x52, 0x12, 0x7E, 0xEC, 0x7B, -+0x01, 0x90, 0xA5, 0x12, 0x12, 0x48, 0x64, 0xE5, 0x52, 0x12, 0x6C, 0x89, 0xF5, 0x83, 0xE0, 0xF5, -+0x57, 0xA3, 0xE0, 0xF5, 0x58, 0x12, 0x6C, 0x93, 0xE0, 0xFF, 0x90, 0xA5, 0x15, 0xE4, 0x12, 0x6F, -+0xE3, 0xE5, 0x52, 0x12, 0x67, 0xF7, 0xE0, 0x90, 0xA5, 0x1D, 0xF0, 0x12, 0x4B, 0xC2, 0x13, 0x13, -+0x54, 0x03, 0x12, 0x4F, 0x62, 0xE0, 0xF5, 0x53, 0x54, 0x7F, 0xF5, 0x54, 0xF1, 0x3D, 0x12, 0x07, -+0x80, 0x11, 0xE0, 0x12, 0x80, 0x73, 0x90, 0xA6, 0x30, 0x11, 0xE4, 0xF1, 0x37, 0xFF, 0x90, 0xA6, -+0x32, 0x11, 0xE4, 0xF1, 0x31, 0xFF, 0x90, 0xA6, 0x34, 0x11, 0xE4, 0x7B, 0x01, 0x7A, 0x00, 0xF1, -+0x0C, 0xD1, 0xB1, 0x11, 0xE0, 0x90, 0xA5, 0x15, 0x12, 0x7F, 0x9D, 0xA3, 0xF1, 0x1B, 0xA3, 0xE4, -+0xF0, 0xA3, 0xE5, 0x53, 0xF0, 0x7B, 0x02, 0x7A, 0x00, 0xF1, 0x0C, 0x12, 0x6E, 0x6D, 0xE5, 0x52, -+0xF0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0x12, 0x7F, 0x88, 0xF1, 0x01, 0x12, 0x6F, 0xDB, -+0xF1, 0x12, 0xF1, 0x3D, 0x12, 0x80, 0x73, 0xAE, 0xF0, 0x12, 0x07, 0x80, 0xD1, 0x27, 0xFE, 0x90, -+0x00, 0x06, 0xD1, 0x30, 0xFE, 0x90, 0x00, 0x08, 0xD1, 0x30, 0x90, 0xA5, 0x17, 0xF0, 0xA3, 0xEF, -+0xF0, 0xF1, 0x31, 0xFD, 0xAC, 0xF0, 0x25, 0xE0, 0xFF, 0xEC, 0x33, 0xFE, 0xEF, 0x2D, 0xFD, 0xEE, -+0x3C, 0xFC, 0xF1, 0x37, 0x25, 0xE0, 0xFF, 0xE5, 0xF0, 0x33, 0xFE, 0x90, 0x00, 0x02, 0xD1, 0x30, -+0xCF, 0x2D, 0xFD, 0xEF, 0x3C, 0xFC, 0xD1, 0xB1, 0xAE, 0xF0, 0x78, 0x02, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0x2D, 0xFF, 0xEC, 0x3E, 0x90, 0xA5, 0x1B, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x07, -+0x80, 0xFF, 0x90, 0xA5, 0x17, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xC3, 0x9F, 0xFE, 0xEC, 0x95, 0xF0, -+0xA3, 0xF0, 0xA3, 0xCE, 0xF0, 0xE5, 0x52, 0x12, 0x4F, 0xEB, 0xF5, 0x83, 0xEC, 0x8D, 0xF0, 0x12, -+0x08, 0xD6, 0x90, 0xA5, 0x1B, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xE5, 0x52, 0x12, 0x4F, 0x4B, 0xF1, -+0xF2, 0x90, 0xA5, 0x15, 0xE0, 0xFE, 0xA3, 0xE0, 0x12, 0x7F, 0x90, 0xF1, 0xF2, 0xE5, 0x52, 0x12, -+0x4F, 0x39, 0xF5, 0x83, 0xE5, 0x57, 0x85, 0x58, 0xF0, 0x12, 0x08, 0xD6, 0x90, 0x94, 0x91, 0x12, -+0x48, 0x43, 0x90, 0xA5, 0x19, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0x12, 0x48, 0x10, -+0x90, 0x94, 0x91, 0x12, 0x08, 0x6D, 0x90, 0xA5, 0x17, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0xA6, 0x2E, -+0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA5, 0x1B, 0x12, 0x7F, 0x9D, 0x90, 0xA5, 0x15, 0xE0, 0xFF, -+0xA3, 0xE0, 0x90, 0xA6, 0x32, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xF1, 0x1B, 0x7B, 0x04, 0x7A, -+0x00, 0xF1, 0x12, 0xE5, 0x52, 0x12, 0x4F, 0xEB, 0x12, 0x4F, 0x30, 0xFF, 0xC0, 0x07, 0xC0, 0x06, -+0xE5, 0x52, 0x12, 0x4F, 0x27, 0x12, 0x7F, 0x90, 0x12, 0x7F, 0xDA, 0xE5, 0x52, 0x12, 0x4F, 0x39, -+0xF5, 0x83, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0xA6, 0x34, 0xCB, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA6, -+0x32, 0xEC, 0x12, 0x7F, 0xCA, 0xD0, 0xE0, 0xF0, 0xA3, 0xD0, 0xE0, 0xF0, 0x7B, 0x05, 0x7A, 0x00, -+0xF1, 0x12, 0x90, 0xA5, 0x1D, 0xE0, 0xFF, 0xE5, 0x54, 0xD3, 0x9F, 0x40, 0x12, 0x8F, 0x54, 0xE5, -+0x53, 0x30, 0xE7, 0x07, 0xE5, 0x54, 0x44, 0x80, 0xFF, 0x80, 0x02, 0xAF, 0x54, 0x8F, 0x53, 0xE5, -+0x54, 0x90, 0x41, 0x5F, 0x93, 0x12, 0x66, 0x22, 0xE0, 0xC3, 0x9F, 0x40, 0x0B, 0x74, 0x2C, 0x25, -+0x54, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0x80, 0x09, 0x74, 0x80, 0x25, 0x54, 0xF5, 0x82, 0xE4, 0x34, -+0xA3, 0xF5, 0x83, 0xE0, 0xFF, 0x12, 0x7E, 0xF9, 0x90, 0xA5, 0x0F, 0x12, 0x48, 0x64, 0x74, 0x96, -+0x25, 0x52, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xC3, 0x94, 0x05, 0x40, 0x02, 0xA1, -+0xE7, 0xE5, 0x53, 0x30, 0xE7, 0x04, 0x05, 0x59, 0x05, 0x59, 0x90, 0x04, 0x8D, 0xE5, 0x59, 0xF0, -+0x90, 0x04, 0x8C, 0xE0, 0x64, 0x01, 0x70, 0x26, 0xE5, 0x54, 0xC3, 0x94, 0x0C, 0x40, 0x1F, 0x74, -+0x84, 0x25, 0x54, 0x12, 0x5F, 0x29, 0xE0, 0xFF, 0x60, 0x14, 0x54, 0x7F, 0xFE, 0xEF, 0x30, 0xE7, -+0x07, 0xEE, 0x25, 0x59, 0xF5, 0x59, 0x80, 0x06, 0xC3, 0xE5, 0x59, 0x9E, 0xF5, 0x59, 0x90, 0x04, -+0x8E, 0xE5, 0x59, 0xF0, 0xD3, 0x94, 0x1A, 0xAF, 0x59, 0x40, 0x02, 0x7F, 0x1A, 0x12, 0x7E, 0xF9, -+0x90, 0xA5, 0x0F, 0x12, 0x48, 0x64, 0x90, 0xA6, 0x2E, 0xF1, 0x01, 0xA3, 0x12, 0x4F, 0xC7, 0x7B, -+0x03, 0xFA, 0xF1, 0x0C, 0xC3, 0xE5, 0x58, 0x94, 0x0F, 0xE5, 0x57, 0x94, 0x00, 0x40, 0x02, 0x81, -+0xE0, 0xD1, 0xB1, 0xFF, 0x90, 0xA5, 0x16, 0xE0, 0x2F, 0xFF, 0x90, 0xA5, 0x15, 0xE0, 0x35, 0xF0, -+0xFE, 0x90, 0x00, 0x06, 0xD1, 0x30, 0xFE, 0xF1, 0x37, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0x12, 0x7F, -+0xF5, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x19, 0xF1, 0x18, 0xE5, 0x57, 0xD1, 0x0A, 0x90, 0xA6, -+0x32, 0xF1, 0x02, 0x7B, 0x01, 0xF1, 0x55, 0xFB, 0x7D, 0x01, 0xAF, 0x52, 0x12, 0x67, 0xFD, 0xA1, -+0xE2, 0xF1, 0x3D, 0x12, 0x07, 0x80, 0x65, 0x58, 0x70, 0x04, 0xE5, 0xF0, 0x65, 0x57, 0x70, 0x31, -+0x12, 0x4F, 0xD0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0xFE, 0xEF, 0x54, 0x3F, 0xFF, 0xEE, 0x04, -+0x54, 0x03, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0x4F, 0xF0, 0xF1, 0x18, 0xE5, 0x57, 0xC3, 0xD1, 0x0A, -+0x90, 0xA6, 0x32, 0xF1, 0x02, 0x7B, 0x02, 0xF1, 0x55, 0xFD, 0xAF, 0x52, 0x12, 0x6C, 0xDA, 0x80, -+0x17, 0x90, 0x9D, 0x95, 0xE0, 0xFF, 0x90, 0xA6, 0x2E, 0xF1, 0x01, 0xA3, 0x12, 0x4F, 0xC7, 0x7B, -+0x08, 0xFA, 0x7D, 0x03, 0x7F, 0x01, 0xD1, 0x3E, 0x12, 0x4F, 0xD0, 0x54, 0x3F, 0xF0, 0xA1, 0xE2, -+0xE5, 0x52, 0x64, 0x01, 0x70, 0x44, 0xD1, 0xB1, 0xFF, 0xAE, 0xF0, 0xF1, 0x31, 0x2F, 0xFD, 0xE5, -+0xF0, 0x3E, 0x12, 0x7F, 0xF5, 0xC3, 0xED, 0x9F, 0xEC, 0x9E, 0x50, 0x08, 0x90, 0xA3, 0x16, 0x74, -+0x01, 0xF0, 0x80, 0x26, 0xD1, 0xB1, 0xFB, 0xAA, 0xF0, 0xE5, 0x58, 0xAE, 0x57, 0x78, 0x03, 0xCE, -+0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x7C, 0x00, 0x7D, 0x05, 0x12, 0x07, 0x03, 0xD3, 0xEB, -+0x9F, 0xEA, 0x9E, 0x40, 0x05, 0xE4, 0x90, 0xA3, 0x16, 0xF0, 0xAB, 0x59, 0xAD, 0x52, 0xAF, 0x58, -+0xAE, 0x57, 0x12, 0x7E, 0x19, 0x8E, 0x55, 0x8F, 0x56, 0xF1, 0x23, 0xF1, 0x43, 0xC3, 0x95, 0x56, -+0xEE, 0x95, 0x55, 0x50, 0x14, 0x90, 0xA6, 0x30, 0xEE, 0x12, 0x4F, 0xB5, 0x7B, 0x01, 0xD1, 0x39, -+0x7D, 0x01, 0xAF, 0x52, 0x12, 0x6C, 0xDA, 0x80, 0x2A, 0xF1, 0x69, 0xD3, 0x74, 0x01, 0x93, 0x95, -+0x56, 0xE4, 0x93, 0x95, 0x55, 0x40, 0x22, 0xF1, 0x23, 0xE4, 0x93, 0xFF, 0x74, 0x01, 0x93, 0x90, -+0xA6, 0x30, 0xCF, 0x12, 0x4F, 0xB5, 0x7B, 0x02, 0xD1, 0x39, 0xE4, 0xFB, 0x7D, 0x01, 0xAF, 0x52, -+0x12, 0x67, 0xFD, 0xD1, 0xBE, 0xE4, 0xF0, 0x80, 0x59, 0xF1, 0x23, 0xF1, 0x43, 0xF1, 0x69, 0xE4, -+0x93, 0xFD, 0x74, 0x01, 0x93, 0x90, 0xA6, 0x32, 0xCD, 0x12, 0x7F, 0xCA, 0xE5, 0x55, 0xF0, 0xA3, -+0xE5, 0x56, 0xD1, 0xBD, 0xE0, 0xFF, 0x90, 0xA6, 0x34, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x7B, 0x03, -+0x7A, 0x00, 0xD1, 0x3A, 0xD1, 0xBE, 0xE0, 0x04, 0xD1, 0xBD, 0xE0, 0xC3, 0x94, 0x05, 0x40, 0x22, -+0xD1, 0xBE, 0xE4, 0xF0, 0xF1, 0x69, 0xF1, 0x43, 0xF1, 0x23, 0x74, 0x01, 0x93, 0x2F, 0xFF, 0xE4, -+0x93, 0x3E, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x52, 0x12, 0x6C, 0xAC, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0xE4, 0xF5, 0x55, 0xF5, 0x56, 0x75, 0x5B, 0x01, 0x7D, 0x01, 0xAF, 0x52, 0x12, 0x6A, -+0xE8, 0xE4, 0x90, 0xA6, 0x2E, 0x12, 0x4F, 0xC7, 0xA3, 0x12, 0x4F, 0xC7, 0x7B, 0x01, 0xFA, 0x7D, -+0xFF, 0x7F, 0x01, 0xD1, 0x3E, 0x05, 0x52, 0x01, 0xFA, 0x22, 0x13, 0xA3, 0xF0, 0xE5, 0x58, 0x13, -+0xA3, 0xF0, 0x90, 0xA5, 0x12, 0x12, 0x48, 0x5B, 0x90, 0x00, 0x06, 0x12, 0x07, 0xAB, 0xFF, 0xAE, -+0xF0, 0x90, 0x00, 0x08, 0x12, 0x07, 0xAB, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xFE, 0x90, 0x00, 0x04, -+0x12, 0x07, 0xAB, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0x22, 0xFA, 0x7D, 0x05, 0x7F, 0x01, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x1E, 0xE0, 0xFE, 0x60, 0x60, 0xEF, 0x54, 0x1F, 0x60, -+0x5B, 0x90, 0xA6, 0x38, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xEB, 0xA3, 0xF0, 0xEA, 0xA3, 0xF0, 0x90, -+0xA6, 0x2E, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0xA6, 0x3C, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0xA6, 0x30, -+0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0xA6, 0x3E, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0xA6, 0x32, 0xE0, 0xFC, -+0xA3, 0xE0, 0x90, 0xA6, 0x40, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0xA6, 0x34, 0xE0, 0xFC, 0xA3, 0xE0, -+0x90, 0xA6, 0x42, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0xA6, 0x36, 0x74, 0xFE, 0xF0, 0x90, 0xA6, 0x44, -+0x74, 0x0C, 0xF0, 0x7B, 0x01, 0x7A, 0xA6, 0x79, 0x36, 0x12, 0x71, 0x2D, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0xA5, 0x12, 0x12, 0x48, 0x5B, 0x90, 0x00, 0x08, 0x02, 0x07, 0xAB, 0xF0, 0x74, 0x15, -+0x25, 0x52, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0x22, 0xE0, 0xFF, 0x25, 0xE0, 0x24, 0x95, -+0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEF, 0x25, 0xE0, 0x24, -+0x95, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0xA6, 0x30, 0xCF, -+0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA6, 0x2E, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0xE9, 0xFF, 0x90, 0xA6, -+0x32, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x7D, 0x01, 0x7F, 0x01, -+0xC1, 0x3E, 0x7D, 0x60, 0x7F, 0x01, 0xC1, 0x3E, 0x90, 0xA6, 0x2E, 0xE5, 0x57, 0xF0, 0xA3, 0xE5, -+0x58, 0xF0, 0x22, 0xE5, 0x54, 0x25, 0xE0, 0x24, 0xB3, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0xF5, 0x83, -+0x22, 0x90, 0x00, 0x06, 0x02, 0x07, 0xAB, 0x90, 0x00, 0x04, 0x02, 0x07, 0xAB, 0x90, 0xA5, 0x12, -+0x02, 0x48, 0x5B, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x22, 0xEF, 0x54, 0x80, 0xC4, 0x13, -+0x13, 0x13, 0x54, 0x01, 0x22, 0xFA, 0x7D, 0x03, 0x7F, 0x01, 0xD1, 0x3E, 0xE4, 0x22, 0x75, 0xF0, -+0x10, 0xE5, 0x52, 0x90, 0x81, 0x05, 0x02, 0x48, 0x4F, 0xE5, 0x54, 0x25, 0xE0, 0x24, 0x5B, 0xF5, -+0x82, 0xE4, 0x34, 0x42, 0xF5, 0x83, 0x22, 0x90, 0xA4, 0xFF, 0xE0, 0xFE, 0x54, 0x0F, 0xFF, 0xEE, -+0xC4, 0x13, 0x13, 0x54, 0x03, 0x7D, 0x00, 0x22, 0x90, 0xA4, 0xFF, 0xE0, 0xFF, 0xF1, 0x4E, 0x30, -+0xE0, 0x1B, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x12, 0x75, 0x5C, 0x90, 0xA5, 0x00, 0xE0, -+0x30, 0xE0, 0x0A, 0xF1, 0x77, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0x48, 0xCC, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0xB7, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x7D, 0x44, 0x7F, -+0x6F, 0x12, 0x79, 0x2F, 0x12, 0x78, 0xD3, 0x90, 0xA6, 0xB8, 0xE0, 0x90, 0xA6, 0xB7, 0xB4, 0x01, -+0x0C, 0xE0, 0x75, 0xF0, 0x10, 0xF1, 0x63, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x0A, 0xE0, 0x75, 0xF0, -+0x10, 0xF1, 0x63, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0xFD, 0xFF, 0x12, 0x79, 0x2F, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x02, 0x08, 0xD6, 0x80, 0x8C, 0x7F, 0xF4, 0x12, 0x49, -+0x7E, 0xEF, 0x20, 0xE5, 0x0E, 0x7F, 0xF4, 0x12, 0x49, 0x7E, 0xEF, 0x7F, 0x01, 0x20, 0xE4, 0x05, -+0x7F, 0x02, 0x22, 0x7F, 0x03, 0x22, 0x12, 0x57, 0xFC, 0x90, 0xA3, 0x1D, 0xEF, 0xF0, 0x11, 0x30, -+0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, 0x36, 0x83, -+0x12, 0x4F, 0x70, 0x12, 0x4F, 0x92, 0x11, 0x63, 0x11, 0x82, 0xE4, 0xF5, 0x0D, 0xF5, 0x0E, 0xF5, -+0x0F, 0x75, 0x10, 0x80, 0x43, 0x10, 0x02, 0xAD, 0x0D, 0x7F, 0x50, 0x12, 0x48, 0xB8, 0xAD, 0x0E, -+0x7F, 0x51, 0x12, 0x48, 0xB8, 0xAD, 0x0F, 0x7F, 0x52, 0x12, 0x48, 0xB8, 0xAD, 0x10, 0x7F, 0x53, -+0x02, 0x48, 0xB8, 0x75, 0x15, 0x12, 0xE4, 0xF5, 0x16, 0x75, 0x17, 0x87, 0x75, 0x18, 0x73, 0x90, -+0x01, 0x30, 0xE5, 0x15, 0xF0, 0xA3, 0xE5, 0x16, 0xF0, 0xA3, 0xE5, 0x17, 0xF0, 0xA3, 0xE5, 0x18, -+0xF0, 0x22, 0x75, 0x1D, 0x06, 0x75, 0x1E, 0x01, 0x75, 0x1F, 0x03, 0x75, 0x20, 0x62, 0x90, 0x01, -+0x38, 0xE5, 0x1D, 0xF0, 0xA3, 0xE5, 0x1E, 0xF0, 0xA3, 0xE5, 0x1F, 0xF0, 0xA3, 0xE5, 0x20, 0xF0, -+0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, 0x85, 0x22, 0xE4, 0x90, 0xA5, 0x0D, 0xF0, 0x90, 0xA5, 0x0D, -+0xE0, 0x64, 0x01, 0xF0, 0x24, 0xA8, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x58, 0xA3, 0xF0, 0x12, 0x3D, -+0x6E, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x38, 0x12, 0x4F, 0xFA, 0x12, 0x45, 0x2D, 0x80, 0xDE, 0xE4, -+0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x47, 0x2E, 0x90, 0xA5, 0x0E, 0xEF, 0xF0, 0x60, 0xF0, 0x90, -+0xA3, 0x17, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE0, 0x0F, -+0x90, 0xA3, 0x17, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x6B, 0x53, 0x12, 0x50, 0xEB, 0xD1, -+0x56, 0x30, 0xE1, 0x06, 0x54, 0xFD, 0xF0, 0x12, 0x76, 0x95, 0xD1, 0x56, 0x30, 0xE2, 0x06, 0x54, -+0xFB, 0xF0, 0x12, 0x7B, 0x36, 0xD1, 0x56, 0x30, 0xE5, 0x0B, 0x54, 0xDF, 0xF0, 0x12, 0x7B, 0x05, -+0xBF, 0x01, 0x02, 0x31, 0x29, 0xD2, 0xAF, 0x80, 0xB6, 0x90, 0xA4, 0xE4, 0xE0, 0x90, 0xA5, 0x72, -+0xF0, 0x90, 0xA4, 0xE5, 0xE0, 0x90, 0xA5, 0x73, 0xF0, 0x90, 0xA4, 0xE6, 0xE0, 0x90, 0xA5, 0x74, -+0xF0, 0x90, 0xA4, 0xE7, 0xE0, 0x90, 0xA5, 0x75, 0xF0, 0x90, 0xA4, 0xE8, 0xE0, 0x90, 0xA5, 0x76, -+0xF0, 0x90, 0xA4, 0xD5, 0xE0, 0x90, 0xA5, 0x77, 0xF0, 0x90, 0xA4, 0xD6, 0xE0, 0x90, 0xA5, 0x78, -+0xF0, 0x90, 0xA4, 0xD7, 0xE0, 0x90, 0xA5, 0x79, 0xF0, 0x90, 0xA4, 0xD8, 0xE0, 0x90, 0xA5, 0x7A, -+0xF0, 0x90, 0xA4, 0xD9, 0xE0, 0x90, 0xA5, 0x7B, 0xF0, 0x90, 0xA4, 0xDA, 0xE0, 0x90, 0xA5, 0x7C, -+0xF0, 0x90, 0xA4, 0xDB, 0xE0, 0x90, 0xA5, 0x7D, 0xF0, 0x90, 0xA4, 0xDC, 0xE0, 0x90, 0xA5, 0x7E, -+0xF0, 0x90, 0xA4, 0xDD, 0xE0, 0x90, 0xA5, 0x7F, 0xF0, 0x90, 0xA4, 0xDE, 0xE0, 0x90, 0xA5, 0x80, -+0xF0, 0xF1, 0x41, 0x12, 0x4F, 0xC7, 0xA3, 0xF0, 0x90, 0xA5, 0x1A, 0xF0, 0xB1, 0xEF, 0x50, 0x04, -+0xB1, 0xFC, 0x80, 0xF8, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x12, 0x7A, 0xCD, 0x90, -+0xA5, 0x0F, 0xF0, 0xA3, 0xF1, 0x31, 0xB1, 0xEF, 0x50, 0x4C, 0xD1, 0x60, 0x90, 0xA5, 0x1A, 0xE0, -+0xFE, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xD1, 0xCE, 0xE0, 0x24, 0x4D, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x1C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xD1, 0xCE, -+0xE0, 0x24, 0x4E, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xEE, 0xF1, 0x5E, 0xF5, 0x83, 0x12, -+0x48, 0x64, 0xD1, 0xD2, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0xEE, 0xD1, 0xC0, 0x12, -+0x48, 0x64, 0xD1, 0x09, 0x80, 0xB0, 0x90, 0x02, 0x87, 0xE0, 0x70, 0x02, 0xA1, 0xE1, 0x90, 0xA4, -+0xC7, 0xE0, 0x20, 0xE0, 0x02, 0xA1, 0xE1, 0xE4, 0x90, 0xA5, 0x8B, 0x12, 0x4F, 0xC7, 0xA3, 0xF0, -+0x90, 0xA5, 0x0F, 0xE0, 0xFF, 0xA3, 0xE0, 0xA3, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA5, 0x11, -+0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, 0x90, 0xFD, 0x11, 0xF0, 0xF1, 0x53, 0xE0, 0xFE, 0xD1, 0xB5, -+0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0x90, 0xA5, 0x13, 0xF0, 0xA3, 0xF1, -+0x77, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0xA5, 0x16, 0xF0, 0xFC, 0x74, 0x07, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0x90, 0xA5, 0x18, 0xF0, 0xEC, -+0x24, 0x18, 0x90, 0xA5, 0x15, 0xF0, 0xFD, 0x90, 0xA5, 0x11, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD1, -+0x19, 0xEF, 0x54, 0xFC, 0x90, 0xA5, 0x17, 0xF0, 0x90, 0xA5, 0x16, 0xE0, 0x24, 0x18, 0xFF, 0xE4, -+0x33, 0x90, 0xA5, 0x13, 0x8F, 0xF0, 0x12, 0x08, 0xD6, 0x90, 0xA5, 0x13, 0xE0, 0xFE, 0xA3, 0xE0, -+0xFF, 0x12, 0x7F, 0x3E, 0x90, 0xA5, 0x0F, 0x12, 0x57, 0xF4, 0x90, 0xA4, 0xC5, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x90, 0xA5, 0x0F, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x9F, 0xEC, 0x9E, 0x40, 0x11, -+0x90, 0xA4, 0xC6, 0xF1, 0x6A, 0xED, 0x9F, 0xFF, 0xEC, 0x9E, 0x90, 0xA5, 0x0F, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0xA5, 0x17, 0xE0, 0x24, 0xC0, 0x60, 0x02, 0x81, 0xC0, 0xB1, 0xE2, 0x24, 0x18, 0xFD, -+0xD1, 0x19, 0xEF, 0x60, 0x02, 0x81, 0xB6, 0xB1, 0xE2, 0x24, 0x19, 0xFD, 0xD1, 0x19, 0x90, 0xA5, -+0x30, 0xF1, 0x39, 0x90, 0xA5, 0x30, 0xE0, 0xFF, 0x90, 0xA5, 0x19, 0xE0, 0xFD, 0xC3, 0x9F, 0x50, -+0x19, 0xB1, 0xE2, 0x24, 0x1A, 0xD1, 0x7B, 0x90, 0xA5, 0x19, 0xE0, 0x24, 0x31, 0xF5, 0x82, 0xE4, -+0x34, 0xA5, 0xF5, 0x83, 0xEF, 0xF0, 0xD1, 0x74, 0x80, 0xD9, 0x90, 0xA5, 0x30, 0xE0, 0x70, 0x02, -+0x61, 0xF3, 0xE4, 0x90, 0xA5, 0x1A, 0xF0, 0xB1, 0xEF, 0x40, 0x02, 0x61, 0xDB, 0xD1, 0x60, 0x90, -+0xA5, 0x1A, 0xE0, 0xFF, 0x24, 0x1C, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xE0, 0xFE, 0x90, -+0xA5, 0x30, 0xE0, 0xFD, 0xEE, 0x6D, 0x70, 0x1F, 0xEF, 0xF1, 0x5E, 0xF5, 0x83, 0x12, 0x48, 0x5B, -+0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xD1, 0xDD, 0xED, 0xF0, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, -+0xD1, 0x8C, 0xEF, 0x60, 0x02, 0x80, 0x47, 0x90, 0xA5, 0x30, 0xE0, 0x64, 0x03, 0x70, 0x4E, 0xD1, -+0xDD, 0x74, 0x03, 0xF0, 0x7A, 0xA6, 0x79, 0x85, 0xD1, 0x8C, 0xEF, 0x70, 0x0E, 0xD1, 0xDD, 0x74, -+0x03, 0xF0, 0x7A, 0xA6, 0x79, 0x81, 0xD1, 0x8C, 0xEF, 0x60, 0x2A, 0x90, 0xA5, 0x1A, 0xE0, 0xFF, -+0x24, 0x7C, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xE0, 0x60, 0x02, 0x80, 0x0B, 0x90, 0xA5, -+0x1A, 0xE0, 0xFF, 0x24, 0x77, 0xF1, 0x4A, 0x60, 0x05, 0x74, 0x8B, 0x2F, 0x80, 0x15, 0xD1, 0x48, -+0x74, 0x01, 0xF0, 0x80, 0x12, 0x90, 0xA5, 0x1A, 0xE0, 0x24, 0x8B, 0x80, 0x06, 0x90, 0xA5, 0x1A, -+0xE0, 0x24, 0x8B, 0xD1, 0x4E, 0xE4, 0xF0, 0xD1, 0x09, 0x61, 0x37, 0x90, 0xA5, 0x8B, 0xE0, 0x70, -+0x4F, 0xA3, 0xE0, 0x70, 0x4B, 0xA3, 0xE0, 0x70, 0x47, 0xA3, 0xE0, 0x70, 0x43, 0xA3, 0xE0, 0x70, -+0x3F, 0x81, 0xB6, 0xE4, 0x90, 0xA5, 0x1A, 0xF0, 0xB1, 0xEF, 0x50, 0x1C, 0x74, 0x77, 0x2E, 0xF1, -+0x4A, 0x60, 0x09, 0x74, 0x8B, 0x2E, 0xD1, 0x4E, 0xE4, 0xF0, 0x80, 0x08, 0x74, 0x8B, 0x2E, 0xD1, -+0x4E, 0x74, 0x01, 0xF0, 0xD1, 0x09, 0x80, 0xE0, 0x90, 0xA5, 0x8B, 0xE0, 0x70, 0x12, 0xA3, 0xE0, -+0x70, 0x0E, 0xA3, 0xE0, 0x70, 0x0A, 0xA3, 0xE0, 0x70, 0x06, 0xA3, 0xE0, 0x70, 0x02, 0x81, 0xB6, -+0xE4, 0x90, 0xA5, 0x1A, 0xF0, 0xB1, 0xEF, 0x50, 0x7D, 0xD1, 0x60, 0xD1, 0x48, 0xE0, 0x60, 0x72, -+0xE4, 0xFF, 0xFE, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0B, 0xF1, 0x9A, 0x50, 0x07, 0x0F, 0xBF, 0x00, -+0x01, 0x0E, 0x80, 0xEF, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x58, 0x90, 0xA5, 0x1A, 0xE0, 0x24, 0x72, -+0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA6, 0xAB, 0x74, 0x06, 0xF0, 0x7B, -+0x08, 0x7D, 0x01, 0x12, 0x7C, 0xFA, 0x90, 0xA5, 0x13, 0xEE, 0xF0, 0xA3, 0xF1, 0x39, 0x90, 0xA5, -+0x19, 0xE0, 0xFD, 0xC3, 0x94, 0x06, 0x50, 0x20, 0xB1, 0xE2, 0x24, 0x0A, 0xD1, 0x7B, 0x90, 0xA5, -+0x13, 0xA3, 0xE0, 0xFE, 0x90, 0xA5, 0x19, 0xE0, 0x2E, 0x24, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xEF, 0xF0, 0xD1, 0x74, 0x80, 0xD6, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x90, 0x06, -+0x35, 0xF0, 0xD1, 0x09, 0x81, 0x35, 0xF1, 0x84, 0x90, 0x06, 0x36, 0x74, 0xDD, 0xF0, 0x41, 0x16, -+0x90, 0xA5, 0x18, 0xE0, 0x60, 0x02, 0xA1, 0xDD, 0xB1, 0xE2, 0x24, 0x16, 0xFD, 0xD1, 0x19, 0x90, -+0x06, 0x34, 0xEF, 0xF0, 0xB1, 0xE2, 0x24, 0x17, 0xFD, 0xD1, 0x19, 0x90, 0x06, 0x37, 0xF1, 0x31, -+0xB1, 0xEF, 0x50, 0x6B, 0xD1, 0x60, 0xE4, 0x90, 0xA5, 0x19, 0xF0, 0x90, 0xA5, 0x19, 0xE0, 0xFF, -+0xC3, 0x94, 0x06, 0x50, 0x56, 0xEF, 0x60, 0x04, 0x64, 0x01, 0x70, 0x24, 0xB1, 0xE2, 0xD1, 0x10, -+0x90, 0xA5, 0x19, 0xE0, 0xFE, 0x24, 0xA0, 0xF1, 0x29, 0xEF, 0xF0, 0x90, 0xA5, 0x1A, 0xE0, 0xD1, -+0xC0, 0x12, 0x48, 0x5B, 0x8E, 0x82, 0xD1, 0x86, 0xFF, 0x74, 0xA2, 0x2E, 0xF1, 0x29, 0xEF, 0xF0, -+0xB1, 0xE2, 0xD1, 0x10, 0x90, 0xA5, 0x1A, 0xE0, 0xFE, 0xD1, 0xC0, 0x12, 0x48, 0x5B, 0x90, 0xA5, -+0x19, 0xE0, 0xF5, 0x82, 0xD1, 0x86, 0x6F, 0x60, 0x0E, 0x74, 0x86, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -+0xA5, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x04, 0xD1, 0x74, 0x80, 0xA0, 0xD1, 0x09, 0x80, 0x91, 0x90, -+0xA5, 0x86, 0xE0, 0x64, 0x01, 0x60, 0x17, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x11, 0xA3, 0xE0, 0x64, -+0x01, 0x60, 0x0B, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x05, 0xA3, 0xE0, 0xB4, 0x01, 0x06, 0x90, 0xA5, -+0x1B, 0x74, 0x01, 0xF0, 0x90, 0xA5, 0x1B, 0xE0, 0x64, 0x01, 0x70, 0x4E, 0xF1, 0xC1, 0x12, 0x70, -+0x7B, 0x12, 0x70, 0x40, 0x90, 0xA4, 0xE9, 0xE0, 0x70, 0x02, 0x41, 0x16, 0x90, 0x01, 0x3C, 0xE0, -+0x30, 0xE4, 0x03, 0x74, 0x10, 0xF0, 0x7D, 0x10, 0xE4, 0xFF, 0xF1, 0xA2, 0x90, 0xA4, 0xEA, 0xE0, -+0x60, 0x08, 0xF5, 0x35, 0xE4, 0xF5, 0x36, 0xFB, 0x80, 0x15, 0x90, 0xA4, 0xEB, 0xE0, 0x60, 0x08, -+0xFB, 0xE4, 0xF5, 0x35, 0xF5, 0x36, 0x80, 0x07, 0x75, 0x35, 0x20, 0xE4, 0xF5, 0x36, 0xFB, 0x7D, -+0x01, 0x7F, 0x60, 0x7E, 0x01, 0x12, 0x3B, 0xDB, 0x41, 0x16, 0xF1, 0x41, 0x12, 0x4F, 0xC7, 0xA3, -+0xF0, 0x90, 0xA5, 0x1A, 0xF0, 0xB1, 0xEF, 0x50, 0x04, 0xB1, 0xFC, 0x80, 0xF8, 0xF1, 0x84, 0x41, -+0x16, 0x22, 0x90, 0xA5, 0x11, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0xA5, 0x15, 0xE0, 0x22, 0x90, -+0xA4, 0xD2, 0xE0, 0xFF, 0x90, 0xA5, 0x1A, 0xE0, 0xFE, 0xC3, 0x9F, 0x22, 0x74, 0x86, 0x2E, 0xF5, -+0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x90, 0xA5, 0x1A, 0xE0, 0x04, 0xF0, 0x22, -+0x24, 0x04, 0xFD, 0x90, 0xA5, 0x19, 0xE0, 0x2D, 0xFD, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, -+0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0xA4, 0xC6, 0xE0, 0x9B, 0x90, 0xA4, 0xC5, 0xE0, 0x9A, 0x50, 0x09, -+0xA3, 0xF1, 0x6A, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, -+0x74, 0x00, 0x2F, 0xD1, 0xB8, 0xE0, 0xFF, 0x22, 0x90, 0xA5, 0x1A, 0xE0, 0x24, 0x8B, 0xF5, 0x82, -+0xE4, 0x34, 0xA5, 0xF5, 0x83, 0x22, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0xA3, 0x17, 0xE0, 0xFF, 0x22, -+0x74, 0x72, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xFD, 0x10, 0xEF, -+0xF0, 0x7F, 0x00, 0x22, 0x90, 0xA5, 0x19, 0xE0, 0x04, 0xF0, 0x22, 0xFC, 0xED, 0x2C, 0xFD, 0x80, -+0x98, 0x12, 0x48, 0x5B, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x02, 0x06, 0xA2, 0x90, 0xA5, 0x90, 0x12, -+0x48, 0x64, 0xE4, 0xFF, 0x90, 0xA5, 0x96, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x14, 0x90, 0xA5, -+0x93, 0xD1, 0x81, 0xFE, 0x90, 0xA5, 0x90, 0xD1, 0x81, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x0F, -+0x80, 0xE2, 0x7F, 0x01, 0x22, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0x22, -+0x75, 0xF0, 0x03, 0xA4, 0x24, 0x63, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0x22, 0xF5, 0x83, -+0xEF, 0xF0, 0x74, 0x81, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0x22, 0x7B, 0x01, 0x7A, -+0xA5, 0x79, 0x31, 0x90, 0xA5, 0x93, 0x12, 0x48, 0x64, 0x90, 0xA5, 0x96, 0x22, 0xE4, 0xFC, 0xED, -+0x2C, 0x24, 0x00, 0xD1, 0xB8, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xF3, 0xD1, 0xB5, 0xEF, 0xF0, -+0xEE, 0x54, 0x3F, 0xFF, 0xF1, 0x53, 0xF1, 0x77, 0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, -+0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x04, 0xF5, 0x83, -+0x22, 0xEF, 0xF0, 0xE4, 0x90, 0xA5, 0x1A, 0xF0, 0x22, 0xEF, 0xF0, 0xE4, 0x90, 0xA5, 0x19, 0xF0, -+0x22, 0xE4, 0x90, 0xA5, 0x1B, 0xF0, 0x90, 0xA5, 0x86, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, -+0x83, 0xE0, 0x22, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0x22, 0x75, 0xF0, -+0x03, 0xA4, 0x24, 0x21, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0x22, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0xA4, -+0xC5, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0x22, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, -+0xFB, 0xF5, 0x83, 0x22, 0x90, 0xA5, 0x0F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x02, 0x84, 0xEF, -+0xF0, 0xEE, 0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xD3, 0xEF, 0x94, 0xE8, 0xEE, 0x94, -+0x03, 0x22, 0x74, 0x1D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x74, 0x15, 0xF1, 0xF0, 0xFE, 0xF6, 0x74, 0x30, 0x80, -+0xEB, 0xC2, 0xAF, 0x90, 0xA4, 0xC7, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0xF1, 0xB7, -+0x90, 0x02, 0x09, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x04, 0x25, 0xF0, -+0xE4, 0x90, 0xA4, 0xD3, 0xF0, 0xA3, 0xF0, 0xD2, 0xAF, 0x22, 0x74, 0x1D, 0xF1, 0xF0, 0x80, 0xB8, -+0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0x22, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, -+0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x12, 0x4A, 0xC8, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, -+0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, -+0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, -+0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0x12, 0x7C, 0x47, 0xE5, 0x19, 0x30, 0xE1, 0x03, 0x12, 0x77, 0x7F, 0xE5, 0x19, 0x30, 0xE3, -+0x03, 0x12, 0x77, 0xB7, 0xE5, 0x19, 0x30, 0xE4, 0x03, 0x12, 0x77, 0xA4, 0xE5, 0x19, 0x30, 0xE5, -+0x03, 0x12, 0x7C, 0xA4, 0xE5, 0x1B, 0x30, 0xE0, 0x03, 0x12, 0x7A, 0xD6, 0xE5, 0x1B, 0x30, 0xE1, -+0x03, 0x12, 0x70, 0x93, 0xE5, 0x1B, 0x30, 0xE7, 0x03, 0x12, 0x7C, 0xE0, 0xE5, 0x1C, 0x30, 0xE0, -+0x03, 0x12, 0x7C, 0xF1, 0xE5, 0x1C, 0x30, 0xE4, 0x03, 0x12, 0x6F, 0xCF, 0xE5, 0x1C, 0x30, 0xE5, -+0x02, 0x11, 0xC6, 0xE5, 0x1C, 0x30, 0xE6, 0x03, 0x12, 0x77, 0x73, 0xD0, 0x07, 0xD0, 0x06, 0xD0, -+0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, -+0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, 0xF5, 0x65, 0x90, 0xA4, 0xFD, 0xE0, 0xFF, 0xE5, 0x65, -+0xC3, 0x9F, 0x40, 0x02, 0x21, 0xA6, 0xAF, 0x65, 0x12, 0x75, 0x78, 0xEF, 0x70, 0x02, 0x21, 0xA2, -+0xE5, 0x65, 0x12, 0x6F, 0xA7, 0xE5, 0x65, 0x54, 0x07, 0xFE, 0x74, 0x81, 0x2F, 0x12, 0x6C, 0xBE, -+0xE0, 0xFD, 0xAF, 0x06, 0x12, 0x6F, 0xC7, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x21, 0xA2, 0x75, 0xF0, 0x10, 0xE5, 0x65, 0x12, 0x6A, 0xE2, 0xE0, -+0x20, 0xE7, 0x02, 0x80, 0x10, 0x75, 0xF0, 0x10, 0xE5, 0x65, 0x90, 0x81, 0x02, 0x12, 0x48, 0x4F, -+0xE0, 0xFF, 0x20, 0xE7, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x20, 0xF0, 0x80, 0x74, 0xEF, 0x30, -+0xE6, 0x24, 0x12, 0x7F, 0x78, 0x12, 0x57, 0x01, 0x12, 0x6F, 0xDB, 0x7D, 0x01, 0x7F, 0x10, 0x12, -+0x56, 0x3E, 0x75, 0xF0, 0x10, 0xE5, 0x65, 0x12, 0x4F, 0x6B, 0x12, 0x80, 0x4B, 0x12, 0x4B, 0xC7, -+0x31, 0xB3, 0xE4, 0xFB, 0x80, 0x47, 0x31, 0xA7, 0xE0, 0x04, 0xF0, 0x12, 0x7F, 0x78, 0xE4, 0xF0, -+0xA3, 0xEF, 0xF0, 0x74, 0x96, 0x25, 0x65, 0x12, 0x6E, 0x84, 0xE0, 0x12, 0x56, 0xFD, 0x7B, 0x01, -+0xFA, 0x7D, 0x02, 0x7F, 0x10, 0x12, 0x56, 0x3E, 0x31, 0xA7, 0xE0, 0xD3, 0x94, 0x01, 0x40, 0x0B, -+0xAF, 0x65, 0x12, 0x6E, 0x9F, 0x31, 0xA7, 0xE4, 0xF0, 0x80, 0x17, 0x75, 0xF0, 0x10, 0xE5, 0x65, -+0x12, 0x4F, 0x6B, 0x12, 0x80, 0x4B, 0x12, 0x4B, 0xC7, 0x31, 0xB3, 0x7B, 0x01, 0xAF, 0x65, 0x12, -+0x69, 0x6C, 0x05, 0x65, 0x01, 0xC9, 0x22, 0x74, 0x96, 0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0xA1, -+0xF5, 0x83, 0x22, 0x13, 0x13, 0x54, 0x03, 0xF5, 0x72, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA6, 0xB2, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0x12, 0x4F, 0xD5, 0x54, 0x1F, 0xF5, 0x6E, -+0x60, 0x15, 0x64, 0x02, 0x60, 0x11, 0xE5, 0x6E, 0x64, 0x04, 0x60, 0x0B, 0xE5, 0x6E, 0x64, 0x09, -+0x60, 0x05, 0xE5, 0x6E, 0xB4, 0x0C, 0x08, 0x12, 0x7F, 0xAA, 0x74, 0x02, 0xF0, 0x80, 0x06, 0x12, -+0x7F, 0xAA, 0x74, 0x01, 0xF0, 0xE4, 0xF5, 0x69, 0x90, 0xA6, 0xB2, 0xE0, 0xFE, 0x71, 0xBA, 0xE5, -+0x82, 0x25, 0x69, 0x71, 0xAE, 0xE0, 0xFF, 0xE5, 0x6E, 0x75, 0xF0, 0x07, 0xA4, 0x24, 0x04, 0xF5, -+0x82, 0xE4, 0x34, 0x41, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x69, 0x71, 0xAE, 0xE4, 0x93, 0xFD, 0xEF, -+0x5D, 0x90, 0xA6, 0xB4, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x12, 0x4B, 0xC7, 0x54, 0x03, 0xFF, 0xBF, -+0x02, 0x0B, 0xE5, 0x69, 0x70, 0x07, 0x90, 0xA6, 0xB4, 0xE0, 0x54, 0xF0, 0xF0, 0x90, 0xA6, 0xB4, -+0xE0, 0xFF, 0x71, 0xB6, 0xE5, 0x82, 0x25, 0x69, 0x71, 0xAE, 0xEF, 0xF0, 0x05, 0x69, 0xE5, 0x69, -+0x64, 0x07, 0x70, 0xA4, 0x90, 0xA6, 0xB2, 0xE0, 0x75, 0xF0, 0x04, 0x12, 0x4B, 0xC7, 0xFF, 0xC4, -+0x54, 0x03, 0xFD, 0xE4, 0xF5, 0x6C, 0x75, 0x6A, 0x06, 0xE5, 0x6A, 0xB4, 0x06, 0x07, 0x71, 0x9D, -+0xE0, 0x54, 0x0F, 0x80, 0x09, 0x71, 0xB6, 0xE5, 0x82, 0x25, 0x6A, 0x71, 0xAE, 0xE0, 0x90, 0xA6, -+0xB3, 0xF0, 0x90, 0xA6, 0xB3, 0xE0, 0x60, 0x34, 0x75, 0x69, 0x07, 0x12, 0x80, 0x6B, 0x80, 0x05, -+0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x80, 0x42, 0x60, 0x17, 0x12, 0x80, 0x39, 0xF5, -+0x6C, 0xED, 0x60, 0x25, 0xE5, 0x6C, 0xD3, 0x94, 0x0B, 0x40, 0x1E, 0x74, 0x20, 0x25, 0x6C, 0xF5, -+0x6C, 0x80, 0x16, 0x15, 0x69, 0xE5, 0x69, 0xC3, 0x94, 0x00, 0x50, 0xCF, 0xE5, 0x6A, 0x60, 0x09, -+0x15, 0x6A, 0xE5, 0x6A, 0xC3, 0x94, 0x00, 0x50, 0xA0, 0xE4, 0xF5, 0x6D, 0xF5, 0x6A, 0xE5, 0x6A, -+0xB4, 0x06, 0x07, 0x71, 0x9D, 0xE0, 0x54, 0x0F, 0x80, 0x09, 0x71, 0xB6, 0xE5, 0x82, 0x25, 0x6A, -+0x71, 0xAE, 0xE0, 0x90, 0xA6, 0xB3, 0xF0, 0x90, 0xA6, 0xB3, 0xE0, 0x60, 0x32, 0xE4, 0xF5, 0x69, -+0x12, 0x80, 0x6B, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x80, 0x42, 0x60, -+0x17, 0x12, 0x80, 0x39, 0xF5, 0x6D, 0xED, 0x60, 0x1E, 0xE5, 0x6D, 0xD3, 0x94, 0x0B, 0x40, 0x17, -+0x74, 0x20, 0x25, 0x6D, 0xF5, 0x6D, 0x80, 0x0F, 0x05, 0x69, 0xE5, 0x69, 0xB4, 0x08, 0xD1, 0x05, -+0x6A, 0xE5, 0x6A, 0x64, 0x07, 0x70, 0xA7, 0x90, 0xA6, 0xB2, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xF1, -+0xF7, 0xE5, 0x6C, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4F, 0xF5, 0xE5, 0x6D, 0xF0, 0x75, 0xF0, -+0x10, 0xEF, 0x12, 0x4F, 0x6B, 0xE0, 0xFF, 0x54, 0x7F, 0xF5, 0x6B, 0xEF, 0x54, 0x80, 0xFF, 0xE5, -+0x6B, 0xD3, 0x95, 0x6C, 0x40, 0x04, 0xE5, 0x6C, 0x80, 0x09, 0xE5, 0x6B, 0xC3, 0x95, 0x6D, 0x50, -+0x05, 0xE5, 0x6D, 0x4F, 0xF5, 0x6B, 0x90, 0xA6, 0xB2, 0xE0, 0xFF, 0x24, 0x16, 0xF5, 0x82, 0xE4, -+0x34, 0xA1, 0xF5, 0x83, 0xE5, 0x6B, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4B, 0xC7, 0x31, 0xB3, -+0x90, 0xA6, 0xB2, 0xE0, 0xFF, 0xE4, 0xFB, 0xAD, 0x6B, 0x12, 0x69, 0x6C, 0x90, 0xA6, 0xB2, 0xE0, -+0x75, 0xF0, 0x10, 0x12, 0x6C, 0x61, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFF, 0x90, 0xA6, -+0xB2, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x48, 0x4F, 0xE5, 0x82, 0x2F, 0xF5, 0x82, -+0xE4, 0x35, 0x83, 0xF5, 0x83, 0x22, 0x90, 0xA6, 0xB2, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, -+0x02, 0x48, 0x4F, 0x8F, 0x55, 0x90, 0xA5, 0x13, 0x74, 0x0E, 0xF0, 0xED, 0x24, 0xFE, 0x60, 0x59, -+0x04, 0x60, 0x02, 0x81, 0x88, 0x12, 0x80, 0x00, 0x74, 0x0C, 0xF0, 0x74, 0x15, 0x25, 0x55, 0xD1, -+0x27, 0xE0, 0x90, 0xA5, 0x16, 0x91, 0x90, 0x12, 0x4B, 0xC7, 0xFD, 0x13, 0x13, 0x54, 0x03, 0x90, -+0xA5, 0x17, 0xF0, 0xED, 0x12, 0x57, 0x4E, 0xA3, 0x91, 0x90, 0x12, 0x4B, 0xC7, 0xFF, 0xC4, 0x54, -+0x03, 0x90, 0xA5, 0x19, 0x91, 0x90, 0xF1, 0xF7, 0xE0, 0x90, 0xA5, 0x1A, 0x91, 0x90, 0x12, 0x4F, -+0xF5, 0xE0, 0x90, 0xA5, 0x1B, 0x91, 0x90, 0x12, 0x4F, 0xD5, 0xFD, 0xC4, 0x13, 0x54, 0x01, 0x90, -+0xA5, 0x1C, 0xF0, 0xED, 0x54, 0x1F, 0xA3, 0x80, 0x59, 0x12, 0x80, 0x00, 0x74, 0x0D, 0x91, 0x89, -+0x71, 0xBD, 0xE0, 0x90, 0xA5, 0x16, 0x91, 0x89, 0x90, 0x89, 0x01, 0x12, 0x48, 0x4F, 0xE0, 0x90, -+0xA5, 0x17, 0x91, 0x89, 0x90, 0x89, 0x02, 0x12, 0x48, 0x4F, 0xE0, 0x90, 0xA5, 0x18, 0x91, 0x89, -+0x90, 0x89, 0x03, 0x12, 0x48, 0x4F, 0xE0, 0x90, 0xA5, 0x19, 0x91, 0x89, 0x12, 0x80, 0x5B, 0x90, -+0xA5, 0x1A, 0x91, 0x89, 0x90, 0x89, 0x05, 0x12, 0x48, 0x4F, 0xE0, 0x90, 0xA5, 0x1B, 0x91, 0x89, -+0x90, 0x89, 0x06, 0x12, 0x48, 0x4F, 0xE0, 0x90, 0xA5, 0x1C, 0x91, 0x89, 0x12, 0x80, 0x53, 0x90, -+0xA5, 0x1D, 0xF0, 0xF1, 0x44, 0x12, 0x71, 0x2D, 0x22, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x55, 0x22, -+0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x55, 0x22, 0x12, 0x06, 0x89, 0x54, 0x7F, 0xF5, 0x52, 0x12, 0x74, -+0x75, 0xFF, 0x54, 0x1F, 0xF5, 0x54, 0x12, 0x57, 0x4B, 0xF5, 0x53, 0xB1, 0x71, 0xFF, 0x54, 0x03, -+0xF5, 0x55, 0xEF, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0xF5, 0x58, 0xB1, 0x71, 0xFF, 0x54, 0x40, 0xC4, -+0x13, 0x13, 0x54, 0x03, 0xF5, 0x56, 0x12, 0x57, 0x4B, 0xF5, 0x57, 0xB1, 0x71, 0xFF, 0x54, 0x08, -+0xFE, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xF5, 0x5A, 0xEF, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xF5, -+0x5B, 0xE5, 0x57, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0x12, 0x4B, 0xC1, 0x54, 0x7F, -+0x4F, 0xF0, 0xE5, 0x56, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0x12, 0x4B, 0xC1, 0x54, 0xBF, -+0x4F, 0xF0, 0xE5, 0x5A, 0x70, 0x69, 0xE5, 0x54, 0x54, 0x1F, 0x12, 0x4F, 0xCF, 0x54, 0xE0, 0x4F, -+0xF0, 0xE5, 0x55, 0x54, 0x03, 0x12, 0x4B, 0xC1, 0x54, 0xFC, 0x4F, 0xF0, 0xEF, 0x25, 0xE0, 0x25, -+0xE0, 0x12, 0x4B, 0xC1, 0x54, 0xF3, 0x4F, 0xF0, 0xE5, 0x53, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, -+0x12, 0x4F, 0xCF, 0x54, 0xDF, 0x4F, 0xF0, 0xE5, 0x58, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0x12, 0x4B, -+0xC1, 0x54, 0xCF, 0x4F, 0xF0, 0xE4, 0xF5, 0x59, 0x85, 0x59, 0x82, 0x75, 0x83, 0x00, 0xA3, 0xA3, -+0xA3, 0x12, 0x06, 0xA2, 0xFF, 0x75, 0xF0, 0x08, 0xE5, 0x52, 0x71, 0xBD, 0xE5, 0x82, 0x25, 0x59, -+0x71, 0xAE, 0xEF, 0xF0, 0x05, 0x59, 0xE5, 0x59, 0xB4, 0x04, 0xDD, 0xAF, 0x52, 0x31, 0xBA, 0x22, -+0xF0, 0x90, 0x00, 0x02, 0x02, 0x06, 0xA2, 0x12, 0x74, 0x6E, 0x12, 0x06, 0x89, 0xF5, 0x52, 0x24, -+0x95, 0x12, 0x4F, 0x5A, 0xE0, 0x54, 0x98, 0x12, 0x4F, 0x55, 0xC0, 0x83, 0xC0, 0x82, 0xD1, 0x14, -+0x54, 0x01, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0x12, 0x4F, 0x55, 0xC0, 0x83, 0xC0, 0x82, -+0xD1, 0x14, 0x54, 0x02, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0x12, 0x4F, 0x55, 0xC0, 0x83, -+0xC0, 0x82, 0xD1, 0x14, 0x54, 0x04, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0x12, 0x4F, 0x55, -+0xC0, 0x83, 0xC0, 0x82, 0xD1, 0x14, 0x54, 0x40, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0x12, -+0x4F, 0x55, 0xC0, 0x83, 0xC0, 0x82, 0xD1, 0x14, 0x54, 0x20, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, -+0x83, 0xF0, 0xE5, 0x52, 0x70, 0x08, 0xD1, 0x1C, 0x54, 0x04, 0x90, 0x04, 0xAB, 0xF0, 0xE5, 0x52, -+0xC3, 0x94, 0x80, 0x50, 0x06, 0xB1, 0x71, 0xD1, 0x22, 0xEF, 0xF0, 0x12, 0x4F, 0x56, 0xE0, 0x30, -+0xE5, 0x11, 0x12, 0x4B, 0xC2, 0x13, 0x13, 0x54, 0x03, 0xFB, 0xD1, 0x23, 0xE0, 0xFD, 0xAF, 0x52, -+0x12, 0x6E, 0xF8, 0x22, 0xE0, 0xFF, 0x90, 0xA5, 0x13, 0x12, 0x48, 0x5B, 0x90, 0x00, 0x03, 0x02, -+0x06, 0xA2, 0xFF, 0x74, 0x15, 0x25, 0x52, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0x22, 0x90, -+0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0xA6, 0xB9, 0xF0, 0x90, 0xA6, 0xB9, 0xE0, 0xFD, 0x70, 0x02, -+0xE1, 0x3A, 0x90, 0xA4, 0x2B, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, -+0x14, 0xFF, 0x90, 0xA4, 0x2C, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, -+0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0xA6, 0xB5, 0x12, 0x6F, 0xC5, -+0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0xE1, 0x1D, -+0xE4, 0x90, 0xA6, 0xBA, 0xF0, 0x90, 0xA6, 0xBA, 0xE0, 0xF9, 0xC3, 0x94, 0x04, 0x50, 0x42, 0xF1, -+0x3C, 0xA4, 0xFF, 0xE9, 0xFD, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xD0, 0x12, -+0x7F, 0xB8, 0x90, 0xA3, 0xDB, 0x12, 0x48, 0x4F, 0xE5, 0x82, 0x29, 0x71, 0xAE, 0xEF, 0xF1, 0x3B, -+0xA4, 0x2D, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xF0, 0x12, 0x7F, 0xB8, 0x90, 0xA3, 0xDF, 0x12, -+0x48, 0x4F, 0xE5, 0x82, 0x29, 0x71, 0xAE, 0xEF, 0xF0, 0x90, 0xA6, 0xBA, 0xE0, 0x04, 0xF0, 0x80, -+0xB4, 0x90, 0xA6, 0xB9, 0xE0, 0xFF, 0x90, 0xA6, 0xB5, 0x12, 0x49, 0x76, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0xA6, 0xB9, 0xF0, 0x90, 0xA6, 0xB5, 0xE0, 0xFF, 0x74, 0x01, 0xA8, -+0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0xA6, 0xB5, 0xE0, -+0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0xA4, 0x2C, 0x12, 0x76, 0xF5, 0xB4, 0x0A, 0x02, 0x7F, -+0x01, 0xEF, 0x70, 0x02, 0xC1, 0x39, 0xE4, 0x90, 0xA4, 0x2C, 0xF0, 0xC1, 0x39, 0x90, 0x01, 0xC0, -+0xE0, 0x44, 0x02, 0xF0, 0x90, 0xA6, 0xB5, 0xE0, 0x44, 0x80, 0x90, 0x00, 0x8A, 0xF1, 0x3B, 0x90, -+0x01, 0xD0, 0x12, 0x48, 0x4F, 0xE0, 0x90, 0x01, 0xC3, 0xF0, 0x22, 0xF0, 0x90, 0xA6, 0xB5, 0xE0, -+0x75, 0xF0, 0x04, 0x22, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x13, 0x22, 0xF1, 0x44, 0x7F, 0xF5, 0x7E, -+0x01, 0x12, 0x33, 0xFD, 0xBF, 0x01, 0x06, 0x90, 0xA5, 0x13, 0xE0, 0xA3, 0xF0, 0xF1, 0x44, 0x7F, -+0xF6, 0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, 0x01, 0x08, 0x90, 0xA5, 0x13, 0xE0, 0x90, 0xA5, 0x15, -+0xF0, 0xF1, 0x44, 0x7F, 0xF4, 0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, 0x01, 0x08, 0x90, 0xA5, 0x13, -+0xE0, 0x90, 0xA5, 0x16, 0xF0, 0xF1, 0x44, 0x7F, 0xF3, 0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, 0x01, -+0x08, 0x90, 0xA5, 0x13, 0xE0, 0x90, 0xA5, 0x17, 0xF0, 0xF1, 0x44, 0x7F, 0xF2, 0x7E, 0x01, 0x12, -+0x33, 0xFD, 0xBF, 0x01, 0x04, 0x12, 0x7F, 0xE2, 0xF0, 0x90, 0xA5, 0x14, 0xE0, 0xFF, 0xA3, 0xE0, -+0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0xA5, 0x1C, 0xF0, 0x90, 0xA5, 0x18, 0xE0, 0x90, 0xA5, -+0x1D, 0xF0, 0x90, 0xA5, 0x1E, 0x74, 0x12, 0xF0, 0x90, 0xA5, 0x2C, 0x74, 0x05, 0xF0, 0x90, 0xA5, -+0x20, 0x12, 0x7E, 0x11, 0xF0, 0x90, 0xA5, 0x1C, 0xE0, 0x90, 0xA5, 0x23, 0xF0, 0x90, 0xA5, 0x1D, -+0xE0, 0x90, 0xA5, 0x24, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x1E, 0x12, 0x71, 0x4C, 0x7F, 0x04, -+0x02, 0x71, 0x31, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x15, 0x02, 0x48, 0x4F, 0x90, 0xA5, 0x22, -+0xEB, 0xF0, 0xA9, 0x05, 0x90, 0xA5, 0x21, 0xEF, 0xF0, 0xFD, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x12, -+0x4F, 0x6B, 0xE0, 0xF5, 0x5D, 0x54, 0x7F, 0xF5, 0x5F, 0x75, 0xF0, 0x04, 0xEE, 0x12, 0x4F, 0xF5, -+0xE0, 0xFA, 0x91, 0x6F, 0x12, 0x67, 0xF7, 0xE0, 0xFC, 0x75, 0xF0, 0x04, 0xEE, 0x12, 0x4B, 0xC7, -+0x13, 0x13, 0x54, 0x03, 0xF5, 0x5E, 0xE5, 0x5F, 0x12, 0x57, 0x6B, 0x12, 0x57, 0x43, 0xED, 0x91, -+0xAC, 0xEE, 0xF1, 0xE3, 0xED, 0x12, 0x4B, 0xC7, 0xC4, 0x54, 0x03, 0x90, 0xA5, 0x23, 0xF0, 0x74, -+0x16, 0x2D, 0xD1, 0x78, 0xE5, 0x5F, 0xF0, 0x74, 0x16, 0x2D, 0xF1, 0xBD, 0xE5, 0x5E, 0xF0, 0xE5, -+0x5F, 0xD3, 0x9C, 0x40, 0x06, 0x8C, 0x5F, 0xAF, 0x04, 0x8F, 0x5D, 0xE9, 0x70, 0x02, 0x21, 0x42, -+0xAF, 0x01, 0x8F, 0x60, 0xE5, 0x5D, 0x30, 0xE7, 0x05, 0x85, 0x5F, 0x5D, 0x15, 0x60, 0xE5, 0x60, -+0x70, 0x02, 0x21, 0x42, 0x90, 0xA5, 0x21, 0xE0, 0xFF, 0xAD, 0x5D, 0x12, 0x7D, 0xA8, 0xEF, 0xF4, -+0x60, 0x0A, 0x8F, 0x5D, 0x15, 0x60, 0xE5, 0x60, 0x70, 0x02, 0x21, 0x42, 0xE5, 0x5F, 0x64, 0x2C, -+0x70, 0x20, 0xE5, 0x5E, 0xD3, 0x94, 0x00, 0x40, 0x19, 0xE5, 0x5E, 0xD3, 0x94, 0x02, 0x50, 0x12, -+0x15, 0x5E, 0xE5, 0x5E, 0xD1, 0xF1, 0xFF, 0x91, 0x6F, 0x12, 0x4B, 0xC7, 0x54, 0xF3, 0x4F, 0xF0, -+0x15, 0x60, 0xE5, 0x60, 0x60, 0x7C, 0xE5, 0x5F, 0xD3, 0x9A, 0x40, 0x72, 0xE4, 0x90, 0xA5, 0x24, -+0xF0, 0x90, 0xA5, 0x23, 0xE0, 0xFF, 0xAD, 0x5F, 0x91, 0xC6, 0x8F, 0x5F, 0x85, 0x5F, 0x5D, 0xE0, -+0xFF, 0xAD, 0x02, 0x91, 0xC6, 0xAA, 0x07, 0xA9, 0x5D, 0xE5, 0x5F, 0x14, 0xFB, 0xEB, 0xC3, 0x9A, -+0x40, 0x3B, 0xEB, 0xF1, 0xA7, 0x90, 0xA5, 0x21, 0x12, 0x63, 0xA1, 0xE0, 0xFD, 0x7C, 0x00, 0xEB, -+0x54, 0x07, 0xF1, 0xC6, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xF1, 0xD3, 0x60, -+0x19, 0xE5, 0x5F, 0xA9, 0x03, 0xB4, 0x14, 0x02, 0x79, 0x0C, 0x90, 0xA5, 0x24, 0xE0, 0x04, 0xF0, -+0xE0, 0x65, 0x60, 0x60, 0x08, 0xE9, 0xD3, 0x9A, 0x40, 0x03, 0x1B, 0x80, 0xC0, 0xAF, 0x01, 0x8F, -+0x5D, 0x90, 0xA5, 0x23, 0xE0, 0xFF, 0xAD, 0x5D, 0xD1, 0x8C, 0x8F, 0x5D, 0x80, 0x04, 0xAF, 0x02, -+0x8F, 0x5D, 0x90, 0xA5, 0x21, 0xE0, 0xFF, 0xD1, 0x6D, 0xEF, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, -+0x5D, 0xF1, 0xB5, 0x12, 0x57, 0x05, 0x7B, 0x01, 0xFA, 0x7D, 0x05, 0x7F, 0x08, 0x12, 0x56, 0x3E, -+0x90, 0xA5, 0x21, 0xE0, 0xFF, 0x85, 0x5E, 0x72, 0xE4, 0xFB, 0xAD, 0x5D, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x8F, 0x6F, 0x8D, 0x70, 0x8B, 0x71, 0xE4, 0x90, 0xA6, 0x7E, 0xF0, 0xE5, 0x6F, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA6, 0x79, 0xF0, 0xE5, 0x6F, 0x54, 0x07, 0x90, 0xA6, 0x7B, -+0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x51, 0xE2, 0xE0, 0x90, 0xA6, 0x7C, 0xF0, 0x12, 0x67, 0xF3, 0xE0, -+0x54, 0x7F, 0x90, 0xA6, 0x7F, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x6F, 0x12, 0x4F, 0xF5, 0xE0, 0x90, -+0xA6, 0x80, 0xF0, 0x91, 0x80, 0xE5, 0x71, 0x70, 0x35, 0x90, 0xA6, 0x48, 0xF0, 0xFB, 0xAF, 0x6F, -+0xF1, 0x73, 0x90, 0xA6, 0x7A, 0xE0, 0xFF, 0x12, 0x57, 0x6B, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x93, -+0xFD, 0xEF, 0x12, 0x57, 0x25, 0x74, 0x01, 0x93, 0x2D, 0xFF, 0xE4, 0x93, 0x3C, 0xC3, 0x13, 0xFE, -+0xEF, 0x13, 0xFF, 0xE5, 0x6F, 0x91, 0xAC, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x80, 0x19, 0xE5, 0x71, -+0xB4, 0x01, 0x14, 0x90, 0xA3, 0x1E, 0xE0, 0x60, 0x0E, 0x90, 0xA6, 0x48, 0x74, 0x05, 0xF0, 0xE4, -+0xFB, 0xAD, 0x70, 0xAF, 0x6F, 0xF1, 0x73, 0x90, 0xA6, 0x7F, 0xE0, 0xFF, 0x90, 0xA6, 0x7A, 0xE0, -+0xFE, 0xD3, 0x9F, 0x40, 0x0B, 0xE5, 0x70, 0x54, 0x80, 0xFD, 0xEF, 0x4D, 0xF5, 0x70, 0x80, 0x0C, -+0x90, 0xA6, 0x80, 0xE0, 0xFF, 0xEE, 0xC3, 0x9F, 0x50, 0x02, 0x8F, 0x70, 0x91, 0x80, 0xE5, 0x70, -+0x54, 0x80, 0x90, 0xA6, 0x7D, 0xF0, 0xE5, 0x71, 0x70, 0x24, 0x91, 0xB8, 0xC0, 0x83, 0xC0, 0x82, -+0xE0, 0xFF, 0x90, 0xA6, 0x7B, 0x12, 0x49, 0x76, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, -+0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA6, 0x7C, 0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x3A, 0x91, 0xB8, -+0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA6, 0x7B, 0x12, 0x49, 0x76, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0x4F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x51, 0xDD, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0xA6, -+0x7C, 0xF0, 0x90, 0xA6, 0x7A, 0xE0, 0x90, 0x43, 0x03, 0x93, 0xFE, 0x33, 0x33, 0x33, 0x54, 0xF8, -+0x4F, 0x90, 0xA6, 0x7C, 0xF0, 0x44, 0x80, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x6F, 0x12, 0x4F, 0x6B, -+0xE5, 0x70, 0xF0, 0xE5, 0x6F, 0x70, 0x06, 0x90, 0x01, 0xC8, 0xE5, 0x70, 0xF0, 0x90, 0xA6, 0x7C, -+0xE0, 0xFF, 0x51, 0xDD, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x6F, 0x12, 0x57, 0x63, 0xE0, 0x54, -+0xFC, 0xFF, 0xE5, 0x72, 0x54, 0x03, 0x4F, 0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x6F, 0x12, 0x57, 0x63, -+0xEF, 0xF0, 0x7D, 0x01, 0xAF, 0x6F, 0x51, 0xE8, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x10, -+0xE5, 0x6F, 0x90, 0x81, 0x01, 0x02, 0x48, 0x4F, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, -+0x60, 0x3F, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x01, 0x71, 0x4C, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, -+0x90, 0x8D, 0x03, 0x71, 0x4C, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x05, 0x71, 0x4C, 0xF0, -+0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x07, 0x71, 0x4C, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, -+0x09, 0x71, 0x4C, 0xF0, 0xEF, 0x91, 0x89, 0x12, 0x4D, 0x56, 0x74, 0x95, 0x2F, 0x91, 0x97, 0xE4, -+0xF0, 0x91, 0x5D, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0x91, 0x5D, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x8D, 0x01, 0x12, 0x48, 0x4F, 0x75, 0xF0, 0x02, 0xEF, 0x12, 0x48, 0x4F, 0xE4, -+0xF0, 0xA3, 0x22, 0x90, 0xA5, 0xA7, 0xEF, 0xF0, 0x90, 0xA4, 0xFD, 0xE0, 0x90, 0xA6, 0x29, 0xF0, -+0xE4, 0x90, 0xA5, 0xA8, 0xF0, 0x90, 0xA6, 0x29, 0xE0, 0xFE, 0x90, 0xA5, 0xA8, 0xE0, 0xFF, 0xC3, -+0x9E, 0x50, 0x30, 0xE0, 0xFE, 0x24, 0xA9, 0x91, 0x55, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xEE, 0x91, -+0x61, 0xE0, 0x30, 0xE7, 0x09, 0x74, 0x81, 0x2F, 0x91, 0x67, 0xE4, 0xF0, 0x80, 0x0D, 0xF1, 0xAE, -+0x90, 0xA5, 0xA8, 0xE0, 0x24, 0xA9, 0x91, 0x55, 0x74, 0x01, 0xF0, 0x90, 0xA5, 0xA8, 0xE0, 0x04, -+0xF0, 0x80, 0xC2, 0x7F, 0x0C, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xE4, 0x90, 0xA5, 0xA8, 0xF0, 0x90, -+0xA6, 0x29, 0xE0, 0xFF, 0x90, 0xA5, 0xA8, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0x81, 0x54, 0x74, -+0xA9, 0x2E, 0x91, 0x55, 0xE0, 0x70, 0x02, 0x81, 0x4C, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x06, -+0x91, 0x77, 0xEE, 0x90, 0x81, 0x07, 0x91, 0x9F, 0xFC, 0x91, 0x89, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x0A, 0x91, 0x77, 0xEC, 0x90, 0x81, 0x0B, 0x91, -+0x9F, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x12, 0x48, 0x4F, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x7F, -+0x01, 0x90, 0xA5, 0xA8, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x0B, 0x12, 0x63, 0xA8, 0xE0, -+0xFD, 0x75, 0xF0, 0x0A, 0xEE, 0x71, 0x42, 0xED, 0xF0, 0x0F, 0xEF, 0xB4, 0x05, 0xE3, 0x90, 0xA5, -+0xA8, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x09, 0x12, 0x48, 0x4F, 0xE0, 0xFE, 0x74, 0x95, -+0x2F, 0x91, 0x97, 0xEE, 0xF0, 0x90, 0xA5, 0xA8, 0xE0, 0xFF, 0x90, 0xA5, 0xA7, 0xE0, 0xFD, 0x51, -+0xE8, 0x90, 0xA5, 0xA8, 0xE0, 0x24, 0x81, 0x91, 0x67, 0x74, 0x01, 0xF0, 0x90, 0xA5, 0xA8, 0xE0, -+0x04, 0xF0, 0x61, 0xAF, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x10, -+0xEF, 0x90, 0x81, 0x03, 0x02, 0x48, 0x4F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0x90, -+0xA5, 0x21, 0xE0, 0x75, 0xF0, 0x04, 0x22, 0x12, 0x48, 0x4F, 0xE0, 0xFD, 0x75, 0xF0, 0x10, 0x22, -+0xE5, 0x70, 0x54, 0x7F, 0x90, 0xA6, 0x7A, 0xF0, 0x22, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, -+0x34, 0x92, 0x22, 0x74, 0x95, 0x25, 0x52, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0x22, 0x12, -+0x48, 0x4F, 0xE0, 0xFE, 0xED, 0xFF, 0x90, 0xA5, 0xA8, 0xE0, 0x22, 0xE0, 0x25, 0xE0, 0x24, 0x95, -+0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0x90, 0xA6, 0x79, 0xE0, 0x24, 0x81, 0xF5, 0x82, -+0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0xEF, 0x60, 0x0A, 0xED, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0x7E, -+0x20, 0x80, 0x02, 0xE4, 0xFE, 0xC3, 0xED, 0x9E, 0xFF, 0x22, 0x8F, 0x5D, 0x8D, 0x5E, 0x74, 0x96, -+0x2F, 0xD1, 0x84, 0x74, 0xFF, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x12, 0x4F, 0x6B, 0xE0, 0xF5, 0x5F, -+0x54, 0x7F, 0xF5, 0x60, 0xE5, 0x5F, 0x54, 0x80, 0xF5, 0x61, 0x12, 0x67, 0xF3, 0xE0, 0xF5, 0x63, -+0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4B, 0xC7, 0xC4, 0x54, 0x03, 0xF5, 0x64, 0xE5, 0x60, 0x12, 0x57, -+0x25, 0x12, 0x57, 0x43, 0xE5, 0x5D, 0x91, 0xAC, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xD1, 0x74, 0xE5, -+0x5F, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x5D, 0x12, 0x4B, 0xC7, 0x13, 0x13, 0x54, 0x03, 0xF5, 0x62, -+0x74, 0x16, 0x25, 0x5D, 0xF1, 0xBD, 0xE5, 0x62, 0xF0, 0xE5, 0x60, 0x64, 0x2C, 0x70, 0x53, 0x75, -+0xF0, 0x04, 0xE5, 0x5D, 0x12, 0x4B, 0xC7, 0xFF, 0x54, 0x03, 0xFE, 0xE5, 0x62, 0xC3, 0x9E, 0x50, -+0x41, 0xEE, 0xFD, 0xEF, 0x13, 0x13, 0x54, 0x03, 0xFF, 0x90, 0xA6, 0x32, 0xE4, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0xA6, 0x30, 0xE4, 0xF0, 0xA3, 0xED, 0xF0, 0xD1, 0x6D, 0xE5, 0x62, 0xF0, 0xE4, 0x90, -+0xA6, 0x34, 0xF1, 0xDC, 0xFD, 0x7F, 0x04, 0x12, 0x56, 0x3E, 0x05, 0x62, 0xE5, 0x62, 0xD1, 0xF1, -+0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x5D, 0x12, 0x4B, 0xC7, 0x54, 0xF3, 0x4F, 0xF0, 0x85, 0x60, 0x5F, -+0xC1, 0x38, 0xE5, 0x60, 0xC3, 0x95, 0x63, 0x50, 0x5E, 0xAD, 0x60, 0xAF, 0x64, 0x91, 0xC6, 0x8F, -+0x60, 0xAD, 0x63, 0xAF, 0x64, 0x91, 0xC6, 0x8F, 0x63, 0xE5, 0x60, 0x04, 0xFD, 0xED, 0xD3, 0x95, -+0x63, 0x50, 0x2B, 0xED, 0xF1, 0xA7, 0x75, 0xF0, 0x08, 0xE5, 0x5D, 0x12, 0x63, 0xA5, 0xE0, 0xFB, -+0x7A, 0x00, 0xED, 0x54, 0x07, 0xF1, 0xC6, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0xF1, 0xEB, 0x60, 0x07, 0x8D, 0x60, 0x85, 0x60, 0x5F, 0x80, 0x03, 0x0D, 0x80, 0xCF, 0xAD, 0x5F, -+0xAF, 0x64, 0xD1, 0x8C, 0x8F, 0x5F, 0xD1, 0x80, 0xE0, 0xFD, 0xF4, 0x60, 0x4B, 0xAF, 0x64, 0xD1, -+0x8C, 0xD1, 0x80, 0xEF, 0xF0, 0x80, 0x41, 0xE5, 0x60, 0x65, 0x63, 0x70, 0x34, 0x75, 0xF0, 0x04, -+0xE5, 0x5D, 0x12, 0x4F, 0xD5, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0D, 0xE5, 0x5F, 0x20, 0xE7, -+0x08, 0xE5, 0x60, 0x44, 0x80, 0xF5, 0x5F, 0x80, 0x1F, 0xE5, 0x5D, 0x91, 0xAC, 0x12, 0x7F, 0x9D, -+0xD1, 0x6D, 0xE5, 0x5D, 0x12, 0x4F, 0xC2, 0x7B, 0x01, 0xFA, 0x7D, 0x02, 0x7F, 0x04, 0x02, 0x56, -+0x3E, 0xD1, 0x74, 0xE5, 0x63, 0xF0, 0xF5, 0x5F, 0xD1, 0x6D, 0xE5, 0x5F, 0xF0, 0x74, 0x96, 0x25, -+0x5D, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0x12, 0x7F, 0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xE4, -+0xF0, 0xA3, 0xE5, 0x62, 0xF1, 0xB5, 0xF0, 0x7B, 0x01, 0x7A, 0x00, 0x7D, 0x05, 0x7F, 0x04, 0x12, -+0x56, 0x3E, 0x85, 0x62, 0x72, 0xAB, 0x5E, 0xAD, 0x5F, 0xAF, 0x5D, 0x21, 0x6C, 0x90, 0xA6, 0x2E, -+0xE4, 0xF0, 0xA3, 0x22, 0x74, 0x16, 0x25, 0x5D, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0x22, -+0x74, 0x96, 0x25, 0x5D, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0x22, 0xEF, 0x60, 0x0A, 0xED, -+0xD3, 0x94, 0x0B, 0x40, 0x04, 0x7E, 0x20, 0x80, 0x02, 0xE4, 0xFE, 0xED, 0x2E, 0xFF, 0x22, 0x75, -+0xF0, 0x04, 0xEF, 0x12, 0x4B, 0xC7, 0xFE, 0x13, 0x13, 0x54, 0x03, 0xFC, 0x12, 0x67, 0xF3, 0xE0, -+0xFB, 0x74, 0x16, 0x2F, 0xD1, 0x78, 0xE0, 0x54, 0x7F, 0xFD, 0x64, 0x2C, 0x70, 0x1C, 0xEE, 0x54, -+0x03, 0xFE, 0xEC, 0xD3, 0x9E, 0x50, 0x13, 0xEC, 0x60, 0x10, 0x1C, 0xEC, 0xD1, 0xF1, 0xFE, 0x75, -+0xF0, 0x04, 0xEF, 0x12, 0x4B, 0xC7, 0x54, 0xF3, 0x4E, 0xF0, 0xED, 0xD3, 0x9B, 0x40, 0x02, 0xAD, -+0x03, 0x74, 0x16, 0x2F, 0xD1, 0x78, 0xE0, 0x54, 0x80, 0x42, 0x05, 0x8C, 0x72, 0xE4, 0xFB, 0x21, -+0x6C, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0x22, 0x8F, 0x53, 0x8D, 0x54, 0x8B, 0x55, 0x75, 0xF0, -+0x04, 0xEF, 0x12, 0x4B, 0xC7, 0xC4, 0x54, 0x03, 0x90, 0xA5, 0x18, 0xF0, 0x90, 0xA5, 0x16, 0x60, -+0x09, 0x74, 0x32, 0xF0, 0xA3, 0x74, 0x2F, 0xF0, 0x80, 0x07, 0x74, 0x11, 0xF0, 0xA3, 0x74, 0x0F, -+0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x53, 0x12, 0x4F, 0x6B, 0xE0, 0xFD, 0x90, 0xA6, 0x48, 0x74, 0x04, -+0xF0, 0xE4, 0xFB, 0xAF, 0x53, 0xF1, 0x73, 0xE5, 0x54, 0xD3, 0x94, 0x2D, 0x40, 0x0A, 0x75, 0xF0, -+0x04, 0xE5, 0x53, 0x12, 0x67, 0xF7, 0x80, 0x20, 0xE5, 0x54, 0xD3, 0x94, 0x1E, 0x40, 0x05, 0x90, -+0xA5, 0x16, 0x80, 0x14, 0xE5, 0x54, 0xD3, 0x94, 0x14, 0x40, 0x05, 0x90, 0xA5, 0x17, 0x80, 0x08, -+0x75, 0xF0, 0x04, 0xE5, 0x53, 0x12, 0x4F, 0xF5, 0xE0, 0xFD, 0x85, 0x55, 0x72, 0xE4, 0xFB, 0xAF, -+0x53, 0x21, 0x6C, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x4B, 0xED, 0xF0, 0xA3, -+0xEF, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA6, 0x48, 0xE0, 0x90, 0xA6, 0x4E, 0xF0, 0x90, 0xA6, 0x49, -+0x74, 0x0C, 0xF0, 0x90, 0xA6, 0x57, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0xA6, 0x79, 0x49, 0x12, -+0x71, 0x2D, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0x22, 0x91, 0x5D, -+0xE0, 0x44, 0x40, 0xF0, 0x22, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x5E, 0x22, 0xF5, 0x82, 0xE4, -+0x34, 0x9E, 0xF5, 0x83, 0x22, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x22, 0xE4, -+0xFF, 0x61, 0x53, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x22, 0xA3, 0xF0, 0xA3, 0xF0, 0x7B, -+0x01, 0xFA, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0x22, 0xFF, 0xEE, 0x5A, 0xFE, 0xEF, -+0x5B, 0x4E, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, -+0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0x12, 0x7C, 0x74, 0xE5, 0x21, 0x30, 0xE4, 0x02, 0x11, 0x3E, 0xE5, 0x24, 0x30, 0xE1, 0x04, 0x7F, -+0x04, 0x11, 0x84, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -+0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x11, 0x7B, -+0x90, 0xA6, 0xC2, 0xEF, 0xF0, 0x90, 0xA3, 0x1D, 0xE0, 0xB4, 0x02, 0x12, 0x90, 0xA6, 0xC2, 0xE0, -+0xFF, 0x64, 0x01, 0x60, 0x25, 0x90, 0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, 0x19, 0x90, 0x01, -+0x00, 0x74, 0xFF, 0xF0, 0x7F, 0x64, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x06, 0x90, 0xE0, 0x44, -+0x01, 0xF0, 0x90, 0xA6, 0xC2, 0xE0, 0xFF, 0x12, 0x50, 0x3D, 0x22, 0x90, 0x01, 0xC7, 0x74, 0x66, -+0xF0, 0xE4, 0xFF, 0x22, 0x8F, 0x26, 0x7F, 0x02, 0x12, 0x47, 0x07, 0x90, 0xA3, 0x17, 0xE0, 0x45, -+0x26, 0xF0, 0x22, 0xF1, 0xDE, 0xBF, 0x03, 0x14, 0x90, 0xA4, 0xFE, 0xE0, 0xB4, 0x01, 0x0D, 0x90, -+0x01, 0xB8, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x21, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x01, 0x80, 0xD4, -+0x90, 0xA5, 0x97, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, 0x66, 0xA3, 0xE0, 0xF5, 0x67, 0x65, -+0x66, 0x60, 0x69, 0x90, 0xA5, 0x98, 0x74, 0x03, 0xF0, 0x90, 0xA5, 0xA6, 0x74, 0x08, 0xF0, 0xE5, -+0x67, 0x04, 0x54, 0x0F, 0xF5, 0x68, 0xE4, 0xF5, 0x65, 0xE5, 0x68, 0x75, 0xF0, 0x08, 0xA4, 0x24, -+0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x65, 0x12, 0x63, 0xAE, 0xE0, -+0xFF, 0x74, 0x9A, 0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x65, -+0xE5, 0x65, 0xB4, 0x08, 0xD4, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x98, 0x31, 0x4C, 0xE5, 0x67, 0x04, -+0x54, 0x0F, 0xF5, 0x67, 0xB4, 0x0F, 0x03, 0xE4, 0xF5, 0x67, 0x90, 0x04, 0x7F, 0xE5, 0x67, 0xF0, -+0x90, 0xA5, 0x97, 0xE0, 0x7F, 0x04, 0x70, 0x02, 0x01, 0x84, 0x31, 0x31, 0x22, 0x31, 0x4C, 0x7F, -+0x04, 0x90, 0xA6, 0xC0, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x47, 0x07, 0x90, 0xA3, 0x17, 0xE0, 0xFF, -+0x90, 0xA6, 0xC0, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0xA3, 0x17, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xC3, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, -+0xEF, 0x14, 0xFF, 0x90, 0xA4, 0xC4, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, -+0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x28, 0xC0, 0x01, 0x90, 0xA4, -+0xC4, 0xE0, 0xF1, 0xAB, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, -+0x06, 0x63, 0x90, 0xA4, 0xC4, 0xD1, 0xF5, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, -+0x90, 0xA4, 0xC4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x91, 0x6E, 0xE4, 0x90, 0xA5, 0x18, 0xF0, -+0xFD, 0x51, 0x23, 0x8D, 0x82, 0x12, 0x5E, 0x86, 0xF4, 0x60, 0x35, 0x90, 0xA5, 0x18, 0xE0, 0xFF, -+0x51, 0x23, 0x8D, 0x82, 0x12, 0x5E, 0x86, 0xFE, 0x75, 0xF0, 0x10, 0x12, 0x6A, 0xE2, 0xE0, 0x12, -+0x57, 0x4E, 0xFC, 0xA8, 0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0xA5, 0x18, -+0xF0, 0x75, 0xF0, 0x10, 0xEE, 0x12, 0x4F, 0x6B, 0xE0, 0xFF, 0x51, 0x12, 0xEF, 0xF0, 0x80, 0x05, -+0x51, 0x12, 0x74, 0xFF, 0xF0, 0x0D, 0xED, 0xB4, 0x07, 0xB7, 0x90, 0xA5, 0x16, 0x74, 0x05, 0xF0, -+0x90, 0xA5, 0x24, 0x74, 0x08, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x16, 0x31, 0x4C, 0x7F, 0x04, -+0x21, 0x31, 0x74, 0x19, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0x22, 0x90, 0xA5, 0x13, -+0x12, 0x48, 0x64, 0x90, 0xA5, 0x13, 0x02, 0x48, 0x5B, 0xE4, 0x90, 0xA5, 0x28, 0xF0, 0x90, 0xA5, -+0x28, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x50, 0x63, 0x74, 0x26, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA3, -+0xF5, 0x83, 0xE0, 0xFF, 0xD3, 0x94, 0x0A, 0x50, 0x02, 0x80, 0x02, 0x7F, 0x0A, 0xAE, 0x07, 0xEF, -+0x24, 0x02, 0x90, 0xA5, 0x27, 0xF0, 0x90, 0xA5, 0x19, 0x74, 0x0E, 0xF0, 0x90, 0xA5, 0x1B, 0x74, -+0x01, 0xF0, 0x51, 0x9C, 0xF5, 0x83, 0xE0, 0x90, 0xA5, 0x1C, 0xF0, 0xE4, 0xFF, 0xEF, 0xC3, 0x9E, -+0x50, 0x19, 0x51, 0x9C, 0xF5, 0x83, 0xE0, 0x2F, 0xB1, 0x16, 0xE0, 0xFD, 0x74, 0x1D, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xED, 0xF0, 0x0F, 0x80, 0xE2, 0x7B, 0x01, 0x7A, 0xA5, 0x79, -+0x19, 0x31, 0x2D, 0x90, 0xA5, 0x28, 0xE0, 0x04, 0xF0, 0x80, 0x93, 0x22, 0x90, 0xA5, 0x28, 0xE0, -+0x24, 0x20, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0x22, 0x91, 0x6E, 0xB1, 0x09, 0x30, 0xE1, 0x02, 0x41, -+0x29, 0x51, 0x23, 0x12, 0x06, 0x89, 0x90, 0xA5, 0x16, 0x91, 0x74, 0x90, 0xA5, 0x17, 0x12, 0x65, -+0x70, 0x90, 0xA5, 0x18, 0xB1, 0x0F, 0x75, 0xF0, 0x10, 0xA4, 0xFF, 0x12, 0x66, 0x1C, 0xFD, 0xEF, -+0x4D, 0xFF, 0x90, 0xA5, 0x17, 0xE0, 0xB4, 0x01, 0x06, 0xA3, 0xE0, 0xB1, 0x16, 0xEF, 0xF0, 0x22, -+0x90, 0xA5, 0x10, 0x12, 0x48, 0x64, 0x90, 0xA5, 0x0F, 0xEF, 0xF0, 0x12, 0x48, 0x6D, 0x73, 0x1F, -+0x00, 0x73, 0x27, 0x01, 0x73, 0x2F, 0x08, 0x73, 0x37, 0x09, 0x73, 0x3F, 0x0A, 0x73, 0x47, 0x12, -+0x73, 0x50, 0x13, 0x73, 0x58, 0x40, 0x73, 0x61, 0x42, 0x73, 0x6A, 0x43, 0x73, 0x73, 0x44, 0x73, -+0x7B, 0x47, 0x73, 0x83, 0x49, 0x73, 0x8B, 0xC2, 0x73, 0x93, 0xC4, 0x00, 0x00, 0x73, 0x9B, 0x90, -+0xA5, 0x10, 0x12, 0x48, 0x5B, 0x81, 0x7B, 0x90, 0xA5, 0x10, 0x12, 0x48, 0x5B, 0x81, 0xBE, 0x90, -+0xA5, 0x10, 0x12, 0x48, 0x5B, 0x61, 0xC1, 0x90, 0xA5, 0x10, 0x12, 0x48, 0x5B, 0x80, 0x6C, 0x90, -+0xA5, 0x10, 0x12, 0x48, 0x5B, 0x80, 0x6F, 0x90, 0xA5, 0x10, 0x12, 0x48, 0x5B, 0x02, 0x7C, 0x12, -+0x90, 0xA5, 0x10, 0x12, 0x48, 0x5B, 0xC1, 0xFC, 0x90, 0xA5, 0x10, 0x12, 0x48, 0x5B, 0x02, 0x64, -+0x97, 0x90, 0xA5, 0x10, 0x12, 0x48, 0x5B, 0x02, 0x65, 0x77, 0x90, 0xA5, 0x10, 0x12, 0x48, 0x5B, -+0x02, 0x4D, 0x5D, 0x90, 0xA5, 0x10, 0x12, 0x48, 0x5B, 0x21, 0xA9, 0x90, 0xA5, 0x10, 0x12, 0x48, -+0x5B, 0x41, 0xA8, 0x90, 0xA5, 0x10, 0x12, 0x48, 0x5B, 0xA1, 0x3F, 0x90, 0xA5, 0x10, 0x12, 0x48, -+0x5B, 0xE1, 0x9C, 0x90, 0xA5, 0x10, 0x12, 0x48, 0x5B, 0xA1, 0x2C, 0x90, 0x01, 0xC0, 0xE0, 0x44, -+0x01, 0xF0, 0x90, 0xA5, 0x0F, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x51, 0x1D, 0xB1, 0x20, 0x7A, -+0xA4, 0x79, 0xDF, 0x02, 0x34, 0x62, 0x51, 0x1D, 0xB1, 0x20, 0x7A, 0xA4, 0x79, 0xE4, 0x02, 0x34, -+0x62, 0x91, 0x6E, 0x12, 0x06, 0x89, 0x30, 0xE0, 0x13, 0xD1, 0x62, 0x90, 0xA3, 0x1D, 0xE0, 0x64, -+0x01, 0x70, 0x28, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x1F, 0x90, 0xA4, 0xE9, 0xE0, -+0x60, 0x16, 0x7D, 0x10, 0xE4, 0xFF, 0x12, 0x5F, 0xEA, 0x90, 0x01, 0x3C, 0xE0, 0x30, 0xE4, 0x03, -+0x74, 0x10, 0xF0, 0x90, 0x01, 0x63, 0xE4, 0xF0, 0x12, 0x5F, 0xC1, 0x51, 0x23, 0x91, 0x75, 0x90, -+0xA4, 0xC8, 0x12, 0x65, 0x70, 0x90, 0xA4, 0xC9, 0xF0, 0x90, 0xA4, 0xC8, 0xE0, 0x54, 0x01, 0x90, -+0xA4, 0xD5, 0xF0, 0x90, 0xA4, 0xC8, 0xE0, 0x54, 0x02, 0x90, 0xA4, 0xD6, 0xF0, 0x90, 0xA4, 0xC8, -+0xE0, 0x54, 0x04, 0x90, 0xA4, 0xD7, 0xF0, 0x90, 0xA4, 0xC8, 0xE0, 0x54, 0x08, 0x90, 0xA4, 0xD8, -+0xF0, 0x90, 0xA4, 0xC8, 0xE0, 0x54, 0x10, 0x90, 0xA4, 0xD9, 0xF0, 0x90, 0xA4, 0xC9, 0xE0, 0x54, -+0x01, 0x90, 0xA4, 0xDA, 0xF0, 0x90, 0xA4, 0xC9, 0xE0, 0x54, 0x02, 0x90, 0xA4, 0xDB, 0xF0, 0x90, -+0xA4, 0xC9, 0xE0, 0x54, 0x04, 0x90, 0xA4, 0xDC, 0xF0, 0x90, 0xA4, 0xC9, 0xE0, 0x54, 0x08, 0x90, -+0xA4, 0xDD, 0xF0, 0x90, 0xA4, 0xC9, 0xE0, 0x54, 0x10, 0x90, 0xA4, 0xDE, 0xF0, 0x22, 0x90, 0xA5, -+0x13, 0x02, 0x48, 0x64, 0xF0, 0x90, 0x00, 0x01, 0x02, 0x06, 0xA2, 0x90, 0x02, 0x09, 0xE0, 0xF5, -+0x52, 0x12, 0x06, 0x89, 0x25, 0x52, 0x90, 0xA3, 0xD4, 0x91, 0x74, 0x25, 0x52, 0x90, 0xA3, 0xD5, -+0x12, 0x65, 0x70, 0x25, 0x52, 0x90, 0xA3, 0xD6, 0xF0, 0x12, 0x66, 0x1C, 0x25, 0x52, 0x90, 0xA3, -+0xD7, 0xB1, 0x0F, 0x25, 0x52, 0x90, 0xA3, 0xD8, 0xF0, 0xB1, 0x09, 0x25, 0x52, 0x90, 0xA3, 0xD9, -+0xF0, 0x90, 0x00, 0x06, 0x12, 0x06, 0xA2, 0x25, 0x52, 0x90, 0xA3, 0xDA, 0xF0, 0x22, 0x8B, 0x52, -+0x8A, 0x53, 0x89, 0x54, 0x91, 0x75, 0xFF, 0xF5, 0x56, 0x12, 0x06, 0x89, 0xFE, 0xC3, 0x13, 0x30, -+0xE0, 0x07, 0x12, 0x65, 0x71, 0xF5, 0x57, 0x80, 0x02, 0x8F, 0x57, 0x85, 0x56, 0x55, 0xE5, 0x55, -+0xD3, 0x95, 0x57, 0x50, 0x23, 0xAB, 0x52, 0xAA, 0x53, 0xA9, 0x54, 0x12, 0x06, 0x89, 0x54, 0x01, -+0xFD, 0xAF, 0x55, 0xB1, 0xA1, 0xAF, 0x55, 0xB1, 0x78, 0xEF, 0xAF, 0x55, 0x70, 0x04, 0xF1, 0x7A, -+0x80, 0x02, 0xF1, 0x75, 0x05, 0x55, 0x80, 0xD6, 0x22, 0x90, 0x00, 0x05, 0x02, 0x06, 0xA2, 0xF0, -+0x90, 0x00, 0x04, 0x02, 0x06, 0xA2, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0x22, -+0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x05, 0x7B, 0x01, 0x22, 0x12, 0x06, 0x89, 0x90, -+0xA4, 0xE9, 0x91, 0x74, 0x90, 0xA4, 0xEA, 0x12, 0x65, 0x70, 0x90, 0xA4, 0xEB, 0xF0, 0x22, 0x91, -+0x75, 0xF5, 0x52, 0x12, 0x65, 0x71, 0xF5, 0x53, 0x12, 0x06, 0x89, 0xF5, 0x54, 0x90, 0xA3, 0x1E, -+0xF0, 0xE5, 0x52, 0x60, 0x06, 0xFD, 0xAF, 0x53, 0x12, 0x63, 0xC3, 0x22, 0xE4, 0x90, 0xA6, 0x6C, -+0xF0, 0x90, 0xA6, 0x6A, 0x74, 0x14, 0xF0, 0x90, 0xA6, 0x78, 0x74, 0x01, 0xF0, 0xFB, 0x7A, 0xA6, -+0x79, 0x6A, 0x31, 0x4C, 0x7F, 0x04, 0x21, 0x31, 0xD1, 0x2E, 0xB1, 0x96, 0xE0, 0xFD, 0x7C, 0x00, -+0x12, 0x6F, 0xC7, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0x6F, 0xD3, 0x7F, -+0x00, 0x60, 0x02, 0x7F, 0x01, 0x22, 0x74, 0xED, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, -+0x22, 0xD1, 0x2E, 0xED, 0x70, 0x12, 0xB1, 0x96, 0xC0, 0x83, 0xC0, 0x82, 0xB1, 0xD4, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0x80, 0x0F, 0xB1, 0x96, 0xC0, 0x83, 0xC0, 0x82, 0xB1, 0xD4, -+0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xB1, 0xDC, 0x90, 0xA4, -+0xFD, 0xEF, 0xF0, 0x22, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x7D, 0x10, 0xED, 0x14, 0xF9, 0x24, 0xED, 0xB1, 0x99, 0xE0, 0x60, 0x36, 0x7C, -+0x08, 0xEC, 0x14, 0x90, 0xA6, 0xC1, 0xF0, 0x74, 0xED, 0x29, 0xB1, 0x99, 0xE0, 0xFB, 0x7A, 0x00, -+0x90, 0xA6, 0xC1, 0x12, 0x6F, 0xC5, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, -+0x6F, 0xEB, 0x60, 0x0F, 0xE9, 0x75, 0xF0, 0x08, 0xA4, 0xFF, 0x90, 0xA6, 0xC1, 0xE0, 0x2F, 0x04, -+0xFF, 0x80, 0x06, 0xDC, 0xCC, 0xDD, 0xBE, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0xFE, 0xEF, 0x54, 0x07, 0xFF, 0x22, 0x90, 0x07, 0x1F, 0xE0, 0x54, 0x7F, -+0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0xFF, 0x90, 0xA5, 0x99, 0xF0, 0x90, 0xA5, 0x97, 0x74, -+0x02, 0xF0, 0x90, 0xA5, 0xA5, 0x14, 0xF0, 0xFB, 0x7A, 0xA5, 0x79, 0x97, 0x31, 0x4C, 0x7F, 0x04, -+0x21, 0x31, 0x12, 0x7A, 0xC5, 0x90, 0xA4, 0xC5, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x86, 0xE0, -+0x44, 0x04, 0xF0, 0x90, 0xA4, 0xC7, 0xE0, 0x44, 0x01, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0xF1, 0xC3, -+0x90, 0x05, 0x52, 0xE0, 0x54, 0x07, 0x04, 0x90, 0xA4, 0xD2, 0x12, 0x57, 0x05, 0x90, 0x04, 0x22, -+0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x2C, 0xE0, -+0xFF, 0x90, 0xA4, 0x2B, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, -+0x3F, 0x90, 0xA4, 0x2B, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0xA3, 0xDB, 0x12, 0x48, 0x4F, 0xE0, -+0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0xDC, 0xF9, 0x74, 0xA3, 0x35, 0xF0, 0xFA, 0x7B, 0x01, -+0xAF, 0x05, 0x51, 0xE0, 0x90, 0xA4, 0x2B, 0xD1, 0xF5, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, -+0x05, 0xE4, 0x90, 0xA4, 0x2B, 0xF0, 0x12, 0x66, 0x2F, 0x90, 0xA3, 0x17, 0xE0, 0x44, 0x02, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0x22, 0x12, 0x06, 0x89, 0xFF, -+0x54, 0x80, 0xFE, 0x90, 0xA4, 0xFF, 0xE0, 0x54, 0x7F, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x40, 0xFF, -+0xEE, 0x54, 0xBF, 0x4F, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFE, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, -+0x4D, 0xFF, 0x90, 0xA4, 0xFF, 0xF0, 0xEE, 0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, -+0x12, 0x06, 0x89, 0x54, 0x0F, 0xFE, 0xEF, 0x54, 0xF0, 0x4E, 0x90, 0xA4, 0xFF, 0x91, 0x74, 0xFF, -+0x54, 0x7F, 0x90, 0xA5, 0x01, 0xF0, 0x12, 0x57, 0x4B, 0xFF, 0x90, 0xA5, 0x00, 0xE0, 0x54, 0xFE, -+0x4F, 0x12, 0x65, 0x70, 0x90, 0xA5, 0x02, 0xF0, 0x12, 0x66, 0x1C, 0x54, 0x01, 0x25, 0xE0, 0xFF, -+0x90, 0xA5, 0x00, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0x12, 0x57, 0x77, 0x20, 0xE0, 0x02, 0x7D, 0x01, -+0x02, 0x48, 0xCC, 0xC1, 0x3A, 0xE4, 0xFD, 0x02, 0x57, 0xAE, 0x7D, 0x01, 0x02, 0x57, 0xAE, 0xE4, -+0xFF, 0x01, 0xB0, 0xE4, 0xFD, 0xFF, 0xA1, 0xA1, 0xF1, 0x83, 0xF1, 0xD0, 0x12, 0x4B, 0xCE, 0x12, -+0x7F, 0x60, 0x12, 0x7F, 0x21, 0x90, 0xA4, 0xFE, 0x74, 0x01, 0xF0, 0x22, 0x12, 0x06, 0x89, 0x90, -+0xA4, 0xFE, 0xF0, 0x22, 0x12, 0x66, 0x2F, 0x7F, 0x02, 0x01, 0x84, 0x75, 0xF0, 0x0F, 0xA4, 0x24, -+0x2D, 0xF9, 0x74, 0xA4, 0x35, 0xF0, 0x22, 0x90, 0xA4, 0xC7, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x20, -+0x11, 0x84, 0x22, 0x74, 0x15, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x02, 0x5F, 0xAC, -+0xE4, 0x90, 0xA4, 0xC3, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x2B, 0xF0, 0xA3, 0xF0, 0x22, 0xE4, 0xF5, -+0x65, 0xF5, 0x66, 0xF5, 0x67, 0x90, 0x01, 0x02, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0x32, 0x32, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x89, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x7D, 0x00, -+0x7C, 0x00, 0xE4, 0x90, 0xA6, 0x8F, 0xF0, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, 0xBC, 0xE4, 0xFF, -+0xEC, 0x90, 0xA6, 0x8B, 0x12, 0x08, 0x6D, 0x90, 0xA6, 0x8B, 0x12, 0x48, 0x43, 0x90, 0xA6, 0x8A, -+0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x12, 0x48, 0x2A, 0xA3, 0x12, 0x08, 0x6D, 0x90, 0xA6, 0x8B, -+0x31, 0x8D, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x38, 0x07, 0x11, 0x5C, 0x90, 0xA6, 0x89, 0xE0, 0x75, -+0xF0, 0x08, 0xA4, 0x24, 0xB5, 0xF5, 0x82, 0xE4, 0x34, 0xAD, 0x12, 0x4F, 0x30, 0xFF, 0x12, 0x37, -+0xBC, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x14, 0x7E, 0x00, -+0x02, 0x3D, 0x7A, 0xE4, 0x90, 0xA5, 0x05, 0xF0, 0xA3, 0xF0, 0x11, 0xB3, 0xEF, 0x64, 0x01, 0x60, -+0x3B, 0xC3, 0x90, 0xA5, 0x06, 0xE0, 0x94, 0x88, 0x90, 0xA5, 0x05, 0xE0, 0x94, 0x13, 0x40, 0x0F, -+0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1D, 0x90, -+0xA5, 0x05, 0x11, 0xCC, 0x11, 0x5C, 0xD3, 0x90, 0xA5, 0x06, 0xE0, 0x94, 0x32, 0x90, 0xA5, 0x05, -+0xE0, 0x94, 0x00, 0x40, 0xC5, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xBE, 0x90, 0x01, 0xC7, 0x74, -+0xFE, 0xF0, 0x22, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, 0xF0, 0x31, 0x9D, 0x90, 0x01, -+0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0x75, 0xF0, 0x01, -+0x02, 0x08, 0xD6, 0xE4, 0x90, 0xA6, 0xAF, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA6, -+0xB1, 0xF0, 0x7D, 0x47, 0x7F, 0xFF, 0x31, 0x2F, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x11, 0xA3, 0xE0, -+0x70, 0x0D, 0xA3, 0xE0, 0x70, 0x09, 0xA3, 0xE0, 0x70, 0x05, 0x31, 0x28, 0x7F, 0x01, 0x22, 0xD3, -+0x90, 0xA6, 0xB0, 0xE0, 0x94, 0xE8, 0x90, 0xA6, 0xAF, 0xE0, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x01, -+0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x31, 0x28, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3D, -+0x7A, 0x90, 0xA6, 0xAF, 0x11, 0xCC, 0x80, 0xC0, 0x90, 0xA6, 0xB1, 0xE0, 0xFF, 0x7D, 0x48, 0x90, -+0x05, 0x22, 0xEF, 0xF0, 0x90, 0xA3, 0x1B, 0xED, 0xF0, 0x22, 0x90, 0xA4, 0xD2, 0xE0, 0xFD, 0x7C, -+0x00, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x07, 0x15, 0xED, 0x4C, 0x70, 0x05, 0x90, 0xA4, -+0xDF, 0x80, 0x2A, 0xED, 0x64, 0x01, 0x4C, 0x70, 0x05, 0x90, 0xA4, 0xE0, 0x80, 0x1F, 0xED, 0x64, -+0x02, 0x4C, 0x70, 0x05, 0x90, 0xA4, 0xE1, 0x80, 0x14, 0xED, 0x64, 0x03, 0x4C, 0x70, 0x05, 0x90, -+0xA4, 0xE2, 0x80, 0x09, 0xED, 0x64, 0x04, 0x4C, 0x70, 0x0C, 0x90, 0xA4, 0xE3, 0xE0, 0xFF, 0x31, -+0x87, 0x90, 0xA4, 0xD3, 0x11, 0xCC, 0x22, 0x90, 0x04, 0x24, 0xEF, 0xF0, 0x22, 0x12, 0x48, 0x37, -+0x90, 0xAA, 0xB9, 0x02, 0x08, 0x6D, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x7F, 0x0A, 0x7E, -+0x00, 0x02, 0x3D, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x9C, 0xEE, 0x12, -+0x57, 0x02, 0x90, 0xA6, 0x9C, 0x51, 0xBC, 0xE0, 0x60, 0x21, 0xC3, 0x90, 0xA6, 0x9F, 0xE0, 0x94, -+0xE8, 0x90, 0xA6, 0x9E, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, -+0x7F, 0x00, 0x80, 0x09, 0x90, 0xA6, 0x9E, 0x31, 0x96, 0x80, 0xD7, 0x7F, 0x01, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0xA4, 0x12, 0x48, 0x64, 0x7F, -+0x96, 0x7E, 0x02, 0x31, 0xA4, 0xEF, 0x60, 0x44, 0x51, 0xC5, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, -+0x3E, 0xFE, 0x90, 0xA6, 0xA7, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0xA6, 0xA7, -+0xE0, 0xFD, 0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA6, 0xA4, 0x51, 0xB3, 0x24, 0x02, -+0xFF, 0xE4, 0x33, 0xFE, 0x12, 0x5E, 0xED, 0x90, 0xA6, 0xA7, 0xE0, 0x24, 0x18, 0xFF, 0x90, 0xA6, -+0xA4, 0x12, 0x48, 0x5B, 0x51, 0x41, 0x90, 0x02, 0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0xA6, 0xA0, 0xEF, 0xF0, 0xA3, 0x12, 0x48, 0x64, 0x90, 0xA6, 0xB6, 0xE0, 0xFE, 0x04, -+0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x06, 0xE1, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, -+0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0xA6, 0xA1, 0x12, 0x48, 0x5B, 0x8B, 0x40, -+0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x62, -+0x90, 0xA6, 0xA0, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, -+0x02, 0xC0, 0x01, 0xA3, 0x12, 0x48, 0x5B, 0xE9, 0x24, 0x02, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, -+0x41, 0x89, 0x42, 0x90, 0xA6, 0xA1, 0x51, 0xB3, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, -+0x02, 0x34, 0x62, 0x12, 0x48, 0x5B, 0x90, 0x00, 0x0E, 0x02, 0x06, 0xA2, 0xE0, 0xFE, 0xA3, 0xE0, -+0xF5, 0x82, 0x8E, 0x83, 0x22, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, -+0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0xE4, 0xF5, 0x65, 0xF5, 0x66, 0xF5, 0x67, 0x90, 0xA4, 0xC7, -+0xE0, 0x30, 0xE0, 0x02, 0x31, 0x3A, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, -+0x9A, 0xE0, 0x54, 0xC0, 0xF0, 0x31, 0x9D, 0x90, 0x01, 0x99, 0xE0, 0x44, 0xC0, 0xF0, 0x90, 0x01, -+0x9B, 0x74, 0x80, 0xF0, 0x22, 0xE4, 0x90, 0xA5, 0x0F, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, -+0x20, 0xE1, 0x20, 0xC3, 0x90, 0xA5, 0x10, 0xE0, 0x94, 0xD0, 0x90, 0xA5, 0x0F, 0xE0, 0x94, 0x07, -+0x40, 0x0A, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0xA5, 0x0F, 0x31, -+0x96, 0x80, 0xD9, 0x7F, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, -+0xA4, 0xC4, 0xE0, 0xFE, 0x90, 0xA4, 0xC3, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, -+0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, 0x40, 0xED, 0x12, 0x77, 0xAB, 0xFA, 0x7B, 0x01, 0x31, 0xE2, -+0x7F, 0x01, 0xEF, 0x60, 0x32, 0x90, 0xA4, 0xC3, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, -+0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA4, 0xC3, 0xF0, 0x90, 0xA4, 0xC4, 0xE0, 0xFF, -+0x90, 0xA4, 0xC3, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x07, -+0x90, 0xA3, 0x17, 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x58, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x37, 0xBC, 0x90, 0xA6, -+0x62, 0x12, 0x08, 0x6D, 0x90, 0xA6, 0x5A, 0x12, 0x48, 0x37, 0x12, 0x08, 0x3A, 0x90, 0xA6, 0x62, -+0x12, 0x48, 0x43, 0x12, 0x48, 0x1D, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA6, -+0x5A, 0x12, 0x48, 0x37, 0x90, 0xA6, 0x5E, 0x12, 0x48, 0x43, 0x12, 0x48, 0x1D, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x2A, 0x90, 0xA6, 0x66, 0x12, 0x08, 0x6D, 0x90, 0xA6, -+0x66, 0x31, 0x8D, 0x90, 0xA6, 0x58, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x38, 0x07, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x77, 0xEF, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x12, 0x06, 0x89, 0xFF, 0x90, 0xA4, 0xEC, 0xF0, 0xBF, 0x01, 0x08, 0x12, 0x67, 0x4B, -+0xE4, 0x90, 0xA4, 0xEC, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, -+0xE4, 0xF0, 0x22, 0xE4, 0x90, 0xA3, 0x17, 0x12, 0x4F, 0xC7, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0xE4, -+0x74, 0x25, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x15, 0xF5, 0x19, 0xA3, -+0xE0, 0x55, 0x16, 0xF5, 0x1A, 0xA3, 0xE0, 0x55, 0x17, 0xF5, 0x1B, 0xA3, 0xE0, 0x55, 0x18, 0xF5, -+0x1C, 0x90, 0x01, 0x34, 0xE5, 0x19, 0xF0, 0xA3, 0xE5, 0x1A, 0xF0, 0xA3, 0xE5, 0x1B, 0xF0, 0xA3, -+0xE5, 0x1C, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x1D, 0xF5, 0x21, 0xA3, 0xE0, 0x55, 0x1E, -+0xF5, 0x22, 0xA3, 0xE0, 0x55, 0x1F, 0xF5, 0x23, 0xA3, 0xE0, 0x55, 0x20, 0xF5, 0x24, 0x90, 0x01, -+0x3C, 0xE5, 0x21, 0xF0, 0xA3, 0xE5, 0x22, 0xF0, 0xA3, 0xE5, 0x23, 0xF0, 0xA3, 0xE5, 0x24, 0xF0, -+0x53, 0x91, 0xDF, 0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0xA5, 0x97, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, -+0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, -+0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x4F, -+0x70, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x48, 0xB8, 0x80, 0xFE, 0x22, -+0x12, 0x77, 0xDE, 0xBF, 0x03, 0x02, 0x91, 0xE9, 0x22, 0x90, 0x05, 0x21, 0xE0, 0x54, 0x7F, 0xF0, -+0x22, 0x12, 0x77, 0xE5, 0xBF, 0x03, 0x02, 0x91, 0xE9, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA6, 0xA9, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA6, 0xA8, 0xEF, 0xF0, 0xE4, 0xFD, -+0xFC, 0x12, 0x5E, 0x6C, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0xA6, 0xA8, 0xE0, 0x90, 0x04, 0x25, 0xF0, -+0x90, 0xA6, 0xA9, 0xE0, 0x60, 0x05, 0xB1, 0x9C, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0xB1, 0x9C, 0x54, 0xC0, 0xF0, -+0x90, 0xA6, 0xAB, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xEF, 0xF0, 0xB1, 0x91, 0xE0, 0x54, 0x01, 0xFF, 0x90, 0xA6, 0xAA, 0xE0, 0x25, 0xE0, 0x25, -+0xE0, 0xFE, 0xEF, 0x44, 0x02, 0x4E, 0xFF, 0xAE, 0x05, 0xB1, 0x91, 0xEF, 0xF0, 0x74, 0x11, 0x2E, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x74, 0x29, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x74, 0x12, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x21, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x7E, 0xFF, 0xED, 0xC3, 0x94, 0x33, 0x40, 0x19, -+0xED, 0xD3, 0x94, 0x35, 0x50, 0x13, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4F, 0xD5, 0xC4, 0x13, 0x54, -+0x07, 0x30, 0xE0, 0x05, 0xED, 0x14, 0x44, 0x80, 0xFE, 0xED, 0x14, 0xFD, 0x74, 0x16, 0x2F, 0x12, -+0x6E, 0x78, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, -+0x30, 0xD1, 0x11, 0xF0, 0x90, 0xA5, 0x08, 0xE0, 0x90, 0x04, 0x33, 0xF0, 0x90, 0xA5, 0x09, 0xE0, -+0x90, 0x04, 0x34, 0xF0, 0x90, 0xA5, 0x0A, 0xE0, 0x90, 0x04, 0x35, 0xF0, 0x90, 0xA5, 0x0B, 0xE0, -+0x90, 0x04, 0x36, 0xF0, 0x90, 0xA5, 0x0C, 0xE0, 0x90, 0x04, 0x37, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0x22, 0x90, 0xA5, 0x21, 0xEE, 0xF0, 0xA3, 0xD1, -+0x11, 0xF0, 0x90, 0xA5, 0x23, 0xE0, 0xD1, 0xEC, 0x7B, 0x01, 0x90, 0xA5, 0x28, 0x12, 0x48, 0x64, -+0x90, 0xA5, 0x24, 0xE0, 0xD1, 0xFC, 0xA3, 0x12, 0x48, 0x64, 0xD1, 0xE4, 0xFF, 0xF1, 0x0B, 0x8F, -+0x61, 0xA3, 0x12, 0x6C, 0xAB, 0xE0, 0xF5, 0x5D, 0xA3, 0xE0, 0xF5, 0x5E, 0xE4, 0xF5, 0x62, 0x90, -+0xA5, 0x28, 0x12, 0x48, 0x5B, 0x75, 0xF0, 0x02, 0xE5, 0x62, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, -+0x12, 0x07, 0xAB, 0xAE, 0xF0, 0xA8, 0x61, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, -+0xF9, 0xFF, 0x90, 0xA5, 0x25, 0x12, 0x48, 0x5B, 0x85, 0x62, 0x82, 0x12, 0x5E, 0x86, 0xFD, 0x7C, -+0x00, 0x12, 0x07, 0x03, 0xEF, 0x25, 0x5E, 0xF5, 0x5E, 0xEE, 0x35, 0x5D, 0xF5, 0x5D, 0x05, 0x62, -+0xE5, 0x62, 0xB4, 0x05, 0xBA, 0x90, 0xA5, 0x25, 0x12, 0x48, 0x5B, 0x12, 0x75, 0x09, 0xFD, 0x7C, -+0x00, 0xD1, 0xE4, 0xA8, 0x61, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, -+0x12, 0x07, 0x03, 0x8E, 0x5F, 0x8F, 0x60, 0xD3, 0xE5, 0x5E, 0x95, 0x60, 0xE5, 0x5D, 0x95, 0x5F, -+0x40, 0x0C, 0xE5, 0x5E, 0x95, 0x60, 0xFF, 0xE5, 0x5D, 0x95, 0x5F, 0xFE, 0x80, 0x04, 0x7E, 0x00, -+0x7F, 0x00, 0x8E, 0x5D, 0x8F, 0x5E, 0x90, 0xA5, 0x23, 0x12, 0x6C, 0xAB, 0xE5, 0x5D, 0xF0, 0xA3, -+0xE5, 0x5E, 0xF0, 0x22, 0x90, 0xA5, 0x21, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x75, 0xF0, 0x0A, 0xA4, -+0x24, 0x01, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x22, 0x8F, 0x59, 0xEF, 0x75, 0xF0, 0x06, 0xA4, -+0x24, 0x62, 0xF9, 0x74, 0x40, 0x35, 0xF0, 0xFA, 0x7B, 0xFF, 0x22, 0x12, 0x5F, 0x9A, 0x40, 0x03, -+0x7F, 0x05, 0x22, 0xD3, 0xEF, 0x94, 0xC8, 0xEE, 0x94, 0x00, 0x7F, 0x00, 0x40, 0x02, 0x7F, 0x02, -+0x22, 0x90, 0xA4, 0xFF, 0xE0, 0x54, 0x7F, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, -+0xF0, 0xE4, 0x90, 0xA5, 0x01, 0xF0, 0x90, 0xA4, 0xFF, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x7D, 0x07, -+0xEF, 0x5D, 0xC3, 0x60, 0x0A, 0xF1, 0x53, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x03, 0xF1, -+0x53, 0xFF, 0x22, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, 0x22, -+0x90, 0xA4, 0xC7, 0xE0, 0x54, 0xFE, 0x12, 0x57, 0x05, 0x90, 0xA4, 0xCE, 0x12, 0x4F, 0xC7, 0x90, -+0xA4, 0xE9, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0xA6, 0x2E, 0xE4, 0xF0, 0xA3, 0xE5, 0x65, -+0xF0, 0x24, 0x96, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA6, 0x30, 0x22, -+0xFF, 0xE5, 0x52, 0x25, 0xE0, 0x24, 0x95, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0x22, 0xE0, 0xFF, 0xA3, -+0xE0, 0x90, 0xA6, 0x30, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0xA6, 0xB2, 0xE0, 0x24, 0x96, -+0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0x22, 0x2F, 0xF5, 0x82, 0x74, 0x01, 0x3E, 0xF5, 0x83, -+0xE0, 0xFF, 0x90, 0xA4, 0x2C, 0xE0, 0x75, 0xF0, 0x08, 0x22, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA6, -+0x30, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA6, 0x2E, 0x22, 0xF5, 0x83, 0xE0, 0xFC, 0xA3, 0xE0, -+0xFD, 0x22, 0x90, 0xA5, 0x13, 0xE0, 0x90, 0xA5, 0x18, 0x22, 0x90, 0xA5, 0x1F, 0xF0, 0xEE, 0xA3, -+0xF0, 0x90, 0xA5, 0x14, 0x22, 0xFC, 0xE5, 0x57, 0xC3, 0x13, 0xFE, 0xE5, 0x58, 0x13, 0xFF, 0x22, -+0x90, 0xA5, 0x21, 0x74, 0x09, 0xF0, 0x90, 0xA5, 0x15, 0x22, 0x7F, 0x80, 0x12, 0x56, 0x3E, 0x90, -+0xA5, 0x14, 0xE0, 0x22, 0x90, 0xA5, 0x16, 0x74, 0x0D, 0xF0, 0x90, 0xA5, 0x24, 0x22, 0xF0, 0xEE, -+0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x22, 0x90, 0xA5, 0x14, 0xE0, 0xF9, 0xD3, 0x94, 0x80, 0x22, -+0x90, 0xA5, 0x13, 0xE0, 0xF9, 0xD3, 0x94, 0x80, 0x22, 0xE5, 0x6A, 0x75, 0xF0, 0x08, 0xA4, 0x25, -+0x69, 0x22, 0xFF, 0x90, 0xA6, 0xB3, 0xE0, 0xFB, 0xEF, 0x5B, 0x22, 0xE0, 0xFD, 0x75, 0xF0, 0x04, -+0xE5, 0x65, 0x22, 0x90, 0x89, 0x07, 0x12, 0x48, 0x4F, 0xE0, 0x22, 0x90, 0x89, 0x04, 0x12, 0x48, -+0x4F, 0xE0, 0x22, 0xF0, 0xEE, 0xA3, 0xF0, 0x90, 0xA5, 0x13, 0x22, 0x74, 0x01, 0x7E, 0x00, 0xA8, -+0x69, 0x08, 0x22, 0x90, 0x00, 0x02, 0x12, 0x07, 0xAB, 0xFF, 0x22, 0x00, 0x8E, 0x3E, -+}; -+u4Byte ArrayLength_MP_8821A_FW_AP = 16542; -+ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_AP( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8821A_FW_AP; -+#else -+ ODM_MoveMemory(pDM_Odm, pFirmware, Array_MP_8821A_FW_AP, ArrayLength_MP_8821A_FW_AP); -+#endif -+ *pFirmwareSize = ArrayLength_MP_8821A_FW_AP; -+} -+ -+ -+#endif /* #if (defined(CONFIG_AP_WOWLAN)||(DM_ODM_SUPPORT_TYPE & (ODM_AP)) */ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) || (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ -+ -+u1Byte Array_MP_8821A_FW_NIC[] = { -+0x01, 0x21, 0x10, 0x00, 0x25, 0x00, 0x00, 0x00, 0x09, 0x08, 0x18, 0x09, 0x76, 0x7A, 0x00, 0x00, -+0xED, 0x24, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x49, 0x62, 0x02, 0x6F, 0xF4, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x70, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x8F, 0xF6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x6F, 0xF5, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x7F, 0xF4, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x8F, 0xF5, 0x00, 0x04, 0x0C, 0x00, 0x00, 0x00, 0x04, 0x08, 0x08, 0x00, -+0x00, 0x00, 0x0A, 0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, -+0x03, 0x02, 0x00, 0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, -+0x0C, 0x0A, 0x07, 0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, -+0x00, 0x08, 0x0B, 0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, -+0x09, 0x04, 0x00, 0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, -+0x24, 0x22, 0x14, 0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, -+0x00, 0x20, 0x23, 0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, -+0x0F, 0x04, 0x00, 0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, -+0x31, 0x2F, 0x18, 0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, -+0x00, 0x30, 0x31, 0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, -+0x14, 0x00, 0x00, 0x30, 0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, -+0x00, 0x00, 0x05, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0x10, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x3F, 0x00, 0x00, 0x00, -+0x00, 0x15, 0xF0, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0xCF, 0xFF, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, -+0x25, 0x27, 0x28, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, -+0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, -+0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, -+0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, -+0x2A, 0x2A, 0x2A, 0x00, 0x04, 0x00, 0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x18, 0x00, 0x24, 0x00, -+0x30, 0x00, 0x48, 0x00, 0x60, 0x00, 0x90, 0x00, 0xC0, 0x00, 0xD8, 0x00, 0x3C, 0x00, 0x64, 0x00, -+0x78, 0x00, 0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, 0x90, 0x01, 0xE0, 0x00, 0xA0, 0x00, 0xF0, 0x01, -+0x40, 0x01, 0x90, 0x02, 0x58, 0x03, 0x20, 0x04, 0xB0, 0x06, 0x40, 0x00, 0xC8, 0x01, 0x18, 0x01, -+0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x00, 0xC8, 0x01, 0x18, 0x01, -+0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x00, 0x3C, 0x00, 0x50, 0x00, -+0x64, 0x00, 0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, 0x90, 0x01, 0x90, 0x02, 0x58, 0x03, 0x20, 0x00, -+0x78, 0x00, 0xF0, 0x01, 0x90, 0x02, 0x58, 0x03, 0xE8, 0x07, 0xD0, 0x09, 0x60, 0x0F, 0xA0, 0x12, -+0xC0, 0x15, 0x18, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, -+0x40, 0x07, 0xD0, 0x07, 0xD0, 0x07, 0xD0, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, 0xD0, 0x03, -+0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x07, 0xD0, 0x07, 0xD0, 0x00, 0x02, 0x00, 0x02, 0x00, -+0x04, 0x00, 0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x48, 0x00, -+0x60, 0x00, 0x6C, 0x00, 0x14, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, -+0xC8, 0x00, 0xF0, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x01, 0x2C, 0x01, 0x90, 0x02, -+0x58, 0x03, 0x20, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, -+0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, -+0x20, 0x03, 0xE8, 0x00, 0x1E, 0x00, 0x28, 0x00, 0x32, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, -+0xC8, 0x00, 0xF0, 0x01, 0x7C, 0x01, 0x90, 0x00, 0x3C, 0x00, 0x78, 0x00, 0xC8, 0x01, 0x2C, 0x01, -+0xF4, 0x03, 0xE8, 0x04, 0xB0, 0x07, 0xD0, 0x09, 0x60, 0x0A, 0xF0, 0x00, 0x64, 0x00, 0x8C, 0x00, -+0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x00, -+0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, -+0xE8, 0x03, 0xE8, 0x01, 0x01, 0x01, 0x02, 0x01, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, 0x05, 0x05, -+0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, -+0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, -+0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x0B, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, -+0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, 0x04, 0x05, -+0x06, 0x07, 0x08, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x02, 0x04, 0x06, 0x07, 0x08, -+0x0A, 0x0B, 0x0C, 0x03, 0x05, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, -+0x0A, 0x0B, 0x0C, 0x02, 0x04, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x03, 0x05, 0x06, -+0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, -+0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x19, 0x06, 0x04, 0x02, 0x00, -+0x18, 0x00, 0x04, 0x0C, 0x14, 0x2C, 0x36, 0x04, 0x08, 0x08, 0x08, 0x0A, 0x0A, 0x04, 0x04, 0x04, -+0x05, 0x04, 0x04, 0x05, 0x07, 0x07, 0x07, 0x08, 0x0A, 0x04, 0x07, 0x0A, 0x0E, 0x11, 0x13, 0x14, -+0x15, 0x03, 0x04, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, -+0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x07, 0x08, 0x08, 0x0A, 0x0A, 0x0C, 0x0E, -+0x10, 0x11, 0x11, 0x07, 0x09, 0x09, 0x0B, 0x0B, 0x0D, 0x0F, 0x13, 0x13, 0x14, 0x05, 0x05, 0x07, -+0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, -+0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, 0x07, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x05, 0x06, 0x07, -+0x0D, 0x10, 0x11, 0x12, 0x12, 0x07, 0x08, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, -+0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x05, 0x06, 0x08, -+0x09, 0x0C, 0x0E, 0x12, 0x12, 0x13, 0x14, 0x07, 0x08, 0x09, 0x0A, 0x0C, 0x0F, 0x12, 0x12, 0x14, -+0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, -+0x0E, 0x11, 0x13, 0x13, 0x13, 0x0C, 0x00, 0x0C, 0x94, 0x0C, 0x88, 0x0C, 0x8C, 0x0C, 0xE8, 0x0C, -+0x10, 0x0D, 0x00, 0x0C, 0x90, 0x0C, 0xC4, 0x0C, 0xC8, 0x0C, 0xCC, 0x0C, 0xD4, 0x0C, 0x80, 0x0C, -+0x84, 0x0C, 0xB8, 0x0E, 0x00, 0x0E, 0x94, 0x0E, 0x88, 0x0E, 0x8C, 0x0E, 0xE8, 0x0E, 0x10, 0x0D, -+0x40, 0x0E, 0x90, 0x0E, 0xC4, 0x0E, 0xC8, 0x0E, 0xCC, 0x0E, 0xD4, 0x0E, 0x80, 0x0E, 0x84, 0x0E, -+0xB8, 0x05, 0x22, 0x05, 0x50, 0x05, 0x51, 0x08, 0x08, 0x0A, 0x04, 0x09, 0x0C, 0x0C, 0x00, 0x0E, -+0x00, 0x08, 0x38, 0x08, 0x2C, 0x0C, 0x5C, 0x0C, 0x60, 0x0C, 0x64, 0x0C, 0x68, 0x0C, 0xB0, 0x0C, -+0xB4, 0x0E, 0x5C, 0x0E, 0x60, 0x0E, 0x64, 0x0E, 0x68, 0x0E, 0xB0, 0x0E, 0xB4, 0x00, 0x01, 0x04, -+0x02, 0x03, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x44, 0xE4, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4A, 0x1C, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x4A, 0x1C, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x45, 0x2D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x45, 0x2C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x45, 0x2D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, -+0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xEF, 0x2B, 0xFF, -+0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, -+0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xE8, 0x8F, 0xF0, 0xA4, 0xCC, 0x8B, 0xF0, 0xA4, -+0x2C, 0xFC, 0xE9, 0x8E, 0xF0, 0xA4, 0x2C, 0xFC, 0x8A, 0xF0, 0xED, 0xA4, 0x2C, 0xFC, 0xEA, 0x8E, -+0xF0, 0xA4, 0xCD, 0xA8, 0xF0, 0x8B, 0xF0, 0xA4, 0x2D, 0xCC, 0x38, 0x25, 0xF0, 0xFD, 0xE9, 0x8F, -+0xF0, 0xA4, 0x2C, 0xCD, 0x35, 0xF0, 0xFC, 0xEB, 0x8E, 0xF0, 0xA4, 0xFE, 0xA9, 0xF0, 0xEB, 0x8F, -+0xF0, 0xA4, 0xCF, 0xC5, 0xF0, 0x2E, 0xCD, 0x39, 0xFE, 0xE4, 0x3C, 0xFC, 0xEA, 0xA4, 0x2D, 0xCE, -+0x35, 0xF0, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, -+0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, -+0x22, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, 0xEC, 0x64, 0x80, -+0xC8, 0x64, 0x80, 0x98, 0x45, 0xF0, 0x22, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, -+0x9D, 0x42, 0xF0, 0xE8, 0x9C, 0x45, 0xF0, 0x22, 0xBB, 0x01, 0x07, 0x89, 0x82, 0x8A, 0x83, 0x02, -+0x48, 0xC6, 0x50, 0x05, 0xE9, 0xF8, 0x02, 0x49, 0x22, 0xBB, 0xFE, 0x05, 0xE9, 0xF8, 0x02, 0x49, -+0x2E, 0x89, 0x82, 0x8A, 0x83, 0x02, 0x49, 0x3A, 0xBB, 0x01, 0x0D, 0xE5, 0x82, 0x29, 0xF5, 0x82, -+0xE5, 0x83, 0x3A, 0xF5, 0x83, 0x02, 0x48, 0xC6, 0x50, 0x07, 0xE9, 0x25, 0x82, 0xF8, 0x02, 0x49, -+0x22, 0xBB, 0xFE, 0x07, 0xE9, 0x25, 0x82, 0xF8, 0x02, 0x49, 0x2E, 0xE5, 0x82, 0x29, 0xF5, 0x82, -+0xE5, 0x83, 0x3A, 0xF5, 0x83, 0x02, 0x49, 0x3A, 0xBB, 0x01, 0x07, 0x89, 0x82, 0x8A, 0x83, 0x02, -+0x08, 0x6D, 0x50, 0x05, 0xE9, 0xF8, 0x02, 0x49, 0x4A, 0xBB, 0xFE, 0x05, 0xE9, 0xF8, 0x02, 0x49, -+0x56, 0x22, 0xBB, 0x01, 0x0D, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0x02, -+0x08, 0x6D, 0x50, 0x07, 0xE9, 0x25, 0x82, 0xF8, 0x02, 0x49, 0x4A, 0xBB, 0xFE, 0x07, 0xE9, 0x25, -+0x82, 0xF8, 0x02, 0x49, 0x56, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, -+0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xA4, 0x25, -+0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, -+0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, -+0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, -+0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, -+0x80, 0xDF, 0xE6, 0xFC, 0x08, 0xE6, 0xFD, 0x08, 0xE6, 0xFE, 0x08, 0xE6, 0xFF, 0x22, 0xE2, 0xFC, -+0x08, 0xE2, 0xFD, 0x08, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x22, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x93, -+0xFD, 0x74, 0x02, 0x93, 0xFE, 0x74, 0x03, 0x93, 0xFF, 0x22, 0xEC, 0xF6, 0x08, 0xED, 0xF6, 0x08, -+0xEE, 0xF6, 0x08, 0xEF, 0xF6, 0x22, 0xEC, 0xF2, 0x08, 0xED, 0xF2, 0x08, 0xEE, 0xF2, 0x08, 0xEF, -+0xF2, 0x22, 0x02, 0x49, 0xA0, 0x02, 0x45, 0xBD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, -+0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, -+0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, -+0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, -+0x90, 0x49, 0xE5, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, -+0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, -+0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, -+0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, -+0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0x41, 0xA5, 0x17, 0x00, 0x41, 0xA5, 0x18, 0x00, 0x60, 0x26, 0xA4, -+0x1C, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x24, -+0x28, 0x2C, 0x30, 0x34, 0x38, 0x3C, 0x40, 0x64, 0x68, 0x6C, 0x70, 0x74, 0x78, 0x7C, 0x80, 0x84, -+0x88, 0x8C, 0x95, 0x99, 0x9D, 0xA1, 0xA5, 0x41, 0xA5, 0x2B, 0x00, 0x00, 0x4C, 0x93, 0x58, 0x88, -+0x5F, 0xFE, 0xE4, 0xFD, 0x7F, 0x8D, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, 0x75, -+0x83, 0x00, 0xED, 0xF0, 0x7F, 0x10, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xB1, 0x6A, 0x20, 0xE6, 0x02, 0x61, 0x35, 0x90, 0x00, -+0x8C, 0xE0, 0x90, 0xA5, 0x05, 0xF0, 0x7F, 0x8D, 0x71, 0xB4, 0x90, 0xA5, 0x06, 0xEF, 0xF0, 0x90, -+0x00, 0x8E, 0xE0, 0x90, 0xA5, 0x07, 0xF0, 0x90, 0xA5, 0x06, 0xE0, 0x24, 0xFC, 0x60, 0x0F, 0x24, -+0x03, 0x60, 0x02, 0x61, 0x2E, 0x90, 0xA5, 0x05, 0xE0, 0xFF, 0xB1, 0x1A, 0x61, 0x2E, 0x90, 0xA5, -+0x05, 0xE0, 0x24, 0x11, 0x12, 0xBA, 0x24, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x71, 0x67, 0x75, 0xF0, -+0x04, 0xB1, 0xC2, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x67, 0x75, 0xF0, 0x04, -+0xB1, 0xC2, 0x12, 0x6D, 0xA4, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x67, 0x75, 0xF0, 0x04, 0xB1, 0xC2, -+0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x67, 0x75, 0xF0, 0x04, 0x12, 0x6F, 0xE7, 0xE0, -+0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x67, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x12, 0x71, 0x62, 0x75, 0xF0, -+0x04, 0xF1, 0x45, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0x71, 0x67, 0x75, 0xF0, 0x04, -+0xF1, 0x45, 0x54, 0x1F, 0x71, 0x65, 0x12, 0x6A, 0x73, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x67, -+0x75, 0xF0, 0x08, 0x90, 0x89, 0x01, 0x71, 0x62, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x71, 0x62, -+0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x71, 0x62, 0x75, 0xF0, 0x08, 0x12, 0xBA, 0x54, 0xFB, 0xE4, -+0xFD, 0x0F, 0x71, 0x67, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x05, 0x71, 0x62, 0x75, 0xF0, 0x08, 0x90, -+0x89, 0x06, 0x71, 0x62, 0x75, 0xF0, 0x08, 0x12, 0xBA, 0x4C, 0xFB, 0x0D, 0x71, 0x3A, 0xB1, 0x6A, -+0x30, 0xE0, 0x02, 0x51, 0x22, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, -+0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, -+0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, -+0xF0, 0x22, 0x11, 0xDE, 0xE0, 0xFB, 0x0D, 0x71, 0x3A, 0x90, 0xA5, 0x05, 0xE0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x56, 0x73, 0x7F, 0x00, 0x7E, 0x0C, 0xB1, 0x01, 0x12, 0xB9, -+0x90, 0xB1, 0x01, 0x12, 0xBA, 0x16, 0x71, 0xE9, 0x71, 0xD6, 0x71, 0xD6, 0x54, 0xFE, 0xFD, 0x7F, -+0x02, 0x51, 0x26, 0x12, 0xBA, 0x6C, 0xEF, 0x44, 0x40, 0xB1, 0x07, 0xF1, 0xFC, 0x90, 0x01, 0x00, -+0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, 0x75, 0x83, 0x00, -+0xE0, 0x90, 0xA5, 0x23, 0xF0, 0x7F, 0x10, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0xA5, 0x23, 0xE0, -+0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x51, 0x26, 0x7F, 0x02, 0x71, -+0xB4, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x51, 0x26, 0x7F, 0x02, 0x71, 0xB4, 0xEF, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x10, 0x71, 0xB4, 0xEF, 0x44, 0x0C, 0xFD, 0x7F, 0x10, -+0x51, 0x26, 0x7F, 0x72, 0x71, 0xB4, 0xEF, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x51, 0x26, 0x90, 0x01, -+0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, -+0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x12, 0xBA, 0x6C, 0xEF, 0x54, 0xBF, 0xF1, 0x97, 0xB1, -+0x12, 0xF1, 0xFC, 0x71, 0xE9, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x51, 0x26, 0x7F, 0x00, 0x7E, 0x0C, -+0xF1, 0x91, 0xB1, 0x12, 0x12, 0xB9, 0x90, 0xF1, 0x91, 0xB1, 0x12, 0x12, 0xBA, 0x16, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x7F, 0x54, 0x71, 0xB4, 0xE5, 0x51, 0x5F, 0xF5, 0x55, 0x7F, 0x55, 0x71, 0xB4, -+0xE5, 0x52, 0x5F, 0xF5, 0x56, 0x7F, 0x56, 0x71, 0xB4, 0xE5, 0x53, 0x5F, 0xF5, 0x57, 0x7F, 0x57, -+0x71, 0xB4, 0xE5, 0x54, 0x5F, 0xF5, 0x58, 0xAD, 0x55, 0x7F, 0x54, 0x51, 0x26, 0xAD, 0x56, 0x7F, -+0x55, 0x51, 0x26, 0xAD, 0x57, 0x7F, 0x56, 0x51, 0x26, 0xAD, 0x58, 0x7F, 0x57, 0x51, 0x26, 0x53, -+0x91, 0xEF, 0x22, 0x7F, 0x81, 0x71, 0xB4, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, 0x81, 0x51, 0x26, 0x7F, -+0x80, 0x71, 0xB4, 0xEF, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x51, 0x26, 0x12, 0xA0, 0x43, 0x12, 0x3D, -+0x3B, 0x12, 0x9F, 0xB3, 0x12, 0xA0, 0xCA, 0x7F, 0x01, 0x12, 0x45, 0xF5, 0x90, 0xA1, 0x50, 0x74, -+0x02, 0xF0, 0xFF, 0x12, 0x45, 0xF5, 0x90, 0xA1, 0x50, 0xE0, 0x04, 0xF0, 0x12, 0x58, 0x1A, 0x12, -+0x9A, 0x2B, 0x90, 0x01, 0xCC, 0x74, 0x0F, 0xF0, 0x7F, 0x80, 0x71, 0xB4, 0xEF, 0x44, 0x40, 0xFD, -+0x7F, 0x80, 0x51, 0x26, 0x75, 0x28, 0xFF, 0x12, 0x58, 0x81, 0x12, 0xA0, 0x50, 0x7F, 0x81, 0x71, -+0xB4, 0xEF, 0x44, 0x04, 0xFD, 0x7F, 0x81, 0x51, 0x26, 0x12, 0xA0, 0xD1, 0xE4, 0xFF, 0x02, 0x46, -+0x7E, 0x12, 0x37, 0xBC, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA4, 0xF1, 0x12, 0x08, 0x6D, 0x90, -+0xA4, 0xF1, 0x11, 0xC6, 0x90, 0xAA, 0xB9, 0x02, 0x08, 0x6D, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA5, 0x1D, 0xEF, 0xF0, 0xB1, 0x6A, 0x30, 0xE6, 0x3A, 0x7F, 0x8D, 0x71, 0xB4, 0xEF, -+0x64, 0x01, 0x70, 0x31, 0x90, 0xA5, 0x1E, 0xF0, 0x90, 0xA5, 0x1E, 0xE0, 0xFD, 0x90, 0xA5, 0x1D, -+0xE0, 0x75, 0xF0, 0x10, 0x12, 0x78, 0xE7, 0xE5, 0x82, 0x2D, 0xF1, 0xC9, 0xE0, 0xFB, 0xE4, 0xFF, -+0x71, 0x3A, 0x90, 0xA5, 0x1E, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xDA, 0xB1, 0x6A, -+0x30, 0xE0, 0x02, 0x51, 0x22, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x8F, 0x71, 0xB4, 0xEF, 0x22, -+0x90, 0xA0, 0xDB, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA0, 0xEA, 0xE0, 0xFD, 0x7F, 0x93, 0x51, 0x26, -+0x90, 0xA0, 0xE0, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, -+0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x7F, 0x08, 0x71, 0xB4, 0xEF, 0x44, 0x10, 0xFD, -+0x7F, 0x08, 0x51, 0x26, 0x7F, 0x01, 0x12, 0x96, 0xE2, 0x7F, 0x90, 0x71, 0xB4, 0xEF, 0x44, 0x01, -+0xFD, 0x7F, 0x90, 0x51, 0x26, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0xFF, 0x75, 0xF0, 0x04, -+0xE5, 0x0F, 0x90, 0x96, 0x14, 0x11, 0xDE, 0xE0, 0x22, 0x75, 0x40, 0xFF, 0x75, 0x41, 0x43, 0x75, -+0x42, 0xB1, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0x9F, 0x79, 0x1C, 0xF1, 0xF3, 0x75, 0x41, 0x43, -+0x75, 0x42, 0xB7, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0x9F, 0x79, 0x22, 0xF1, 0xF3, 0x75, 0x41, -+0x43, 0x75, 0x42, 0xBD, 0x75, 0x43, 0x54, 0x7B, 0x01, 0x7A, 0x9F, 0x79, 0x28, 0xF1, 0xF3, 0x75, -+0x41, 0x44, 0x75, 0x42, 0x11, 0x75, 0x43, 0x54, 0x7B, 0x01, 0x7A, 0x9F, 0x79, 0x7C, 0x12, 0x34, -+0x62, 0xE4, 0xF5, 0x0D, 0xE4, 0xFF, 0x74, 0x91, 0x25, 0x0D, 0xF1, 0x37, 0xE0, 0x54, 0xFE, 0xF0, -+0x75, 0xF0, 0x10, 0xE5, 0x0D, 0x90, 0x81, 0x00, 0xBF, 0x03, 0x07, 0xF1, 0xC4, 0x74, 0x80, 0xF0, -+0x80, 0x04, 0xF1, 0xC4, 0xE4, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x0D, 0xF1, 0xC1, 0xE4, 0xF0, 0x0F, -+0xBF, 0x10, 0xD3, 0x05, 0x0D, 0xE5, 0x0D, 0xB4, 0x80, 0xCA, 0xE4, 0x90, 0xAD, 0xE2, 0xF0, 0xF5, -+0x0D, 0xE4, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x0D, 0x12, 0x7C, 0x73, 0xF0, 0x0F, 0xBF, 0x05, 0xF3, -+0x74, 0x12, 0x25, 0x0D, 0x12, 0xB9, 0x01, 0x74, 0x3F, 0xF0, 0x74, 0x11, 0x25, 0x0D, 0x12, 0x67, -+0xC5, 0xE4, 0xF0, 0x74, 0x01, 0x25, 0x0D, 0x12, 0x66, 0xB2, 0x74, 0xC0, 0xF0, 0x74, 0x92, 0x25, -+0x0D, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xE5, 0x0D, 0x12, 0xB8, 0xC5, 0xE4, -+0xF0, 0xA3, 0xF0, 0x74, 0x91, 0x25, 0x0D, 0x12, 0xB8, 0xE7, 0xF1, 0x2B, 0x12, 0x6F, 0xE7, 0x74, -+0x3F, 0xF1, 0x2C, 0x12, 0x6E, 0x39, 0xF1, 0x2B, 0xF1, 0x45, 0x54, 0xE0, 0x44, 0x09, 0xF1, 0x2C, -+0xB1, 0xC2, 0x54, 0xF3, 0xF1, 0x2C, 0xB1, 0xC2, 0x54, 0xFC, 0xF1, 0x2C, 0xF1, 0x45, 0x44, 0x20, -+0xF1, 0x2C, 0xB1, 0xC2, 0x54, 0xCF, 0xF1, 0x2C, 0xB1, 0xC2, 0x44, 0x40, 0xF1, 0x2C, 0xB1, 0xC2, -+0x54, 0x7F, 0xF1, 0x2C, 0x12, 0x6E, 0x39, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x0D, 0x12, 0x78, -+0xE7, 0xEF, 0xF0, 0x74, 0x91, 0x25, 0x0D, 0xF1, 0x37, 0xE4, 0xF0, 0x05, 0x0D, 0xE5, 0x0D, 0x64, -+0x80, 0x60, 0x02, 0xC1, 0x51, 0x90, 0x04, 0x49, 0x74, 0xF0, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, -+0xFF, 0xF0, 0x90, 0xA2, 0x81, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, -+0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xE4, 0xFB, 0xFD, 0xFF, 0x12, 0xA5, 0x0B, 0x74, 0x11, 0x25, 0x0D, -+0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x22, 0xE4, 0xF0, 0x75, 0xF0, 0x04, -+0xE5, 0x0D, 0x22, 0x74, 0x91, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x22, 0xFF, -+0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x96, 0x13, 0x11, 0xDE, 0xE0, 0x22, 0x90, 0x01, 0x30, 0xE4, -+0xF1, 0xB1, 0x90, 0x01, 0x38, 0xF1, 0xB1, 0xFD, 0x7F, 0x50, 0x51, 0x26, 0xE4, 0xFD, 0x7F, 0x51, -+0x51, 0x26, 0xE4, 0xFD, 0x7F, 0x52, 0x51, 0x26, 0xE4, 0xFD, 0x7F, 0x53, 0x41, 0x26, 0x90, 0x01, -+0x34, 0x74, 0xFF, 0xF1, 0xB1, 0x90, 0x01, 0x3C, 0xF1, 0xB1, 0xFD, 0x7F, 0x54, 0x51, 0x26, 0x7D, -+0xFF, 0x7F, 0x55, 0x51, 0x26, 0x7D, 0xFF, 0x7F, 0x56, 0x51, 0x26, 0x7D, 0xFF, 0x7F, 0x57, 0x41, -+0x26, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0xA4, 0xED, 0x12, 0x08, 0x6D, 0x90, -+0xA4, 0xED, 0x22, 0x90, 0xA4, 0x46, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, -+0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xFF, 0x90, 0xA5, 0x0E, 0xE0, 0x75, 0xF0, -+0x08, 0x90, 0x89, 0x00, 0x11, 0xDE, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, -+0x22, 0xE4, 0xF5, 0x51, 0xF5, 0x52, 0xF5, 0x53, 0x75, 0x54, 0x80, 0xAD, 0x51, 0x7F, 0x50, 0x51, -+0x26, 0xAD, 0x52, 0x7F, 0x51, 0x51, 0x26, 0xAD, 0x53, 0x7F, 0x52, 0x51, 0x26, 0xAD, 0x54, 0x7F, -+0x53, 0x41, 0x26, 0x12, 0x34, 0x62, 0x75, 0x40, 0xFF, 0x22, 0x41, 0x40, 0x7F, 0xB4, 0x7E, 0x08, -+0x02, 0x38, 0x07, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0x90, 0xA4, 0xD0, 0xF0, 0x90, 0xA1, 0x3D, 0xE0, -+0x90, 0xA4, 0xD1, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0xA4, 0xCC, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA4, 0xD0, 0xE0, 0xF5, 0x3B, -+0xA3, 0xE0, 0xF5, 0x3C, 0x12, 0x35, 0x7A, 0x90, 0xA4, 0xCC, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, -+0x8E, 0x83, 0xA3, 0xA3, 0xA3, 0x74, 0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0xA3, -+0x58, 0xF0, 0x90, 0xA1, 0x51, 0xE0, 0x20, 0xE0, 0x02, 0x21, 0xDB, 0x90, 0xA1, 0x53, 0xE0, 0xB4, -+0x14, 0x0B, 0x7F, 0x01, 0x31, 0xE6, 0xEF, 0x60, 0x02, 0x21, 0xDB, 0x21, 0x83, 0x31, 0xDD, 0xF1, -+0xAC, 0x90, 0xA3, 0x54, 0xF0, 0x60, 0x07, 0xE0, 0x64, 0x02, 0x60, 0x02, 0x21, 0x51, 0x90, 0xA1, -+0x53, 0xE0, 0x70, 0x34, 0x91, 0x74, 0x30, 0xE0, 0x02, 0x21, 0x40, 0x12, 0xBA, 0x3C, 0xF0, 0x7D, -+0x4E, 0x7F, 0x6F, 0xB1, 0x9C, 0x31, 0xDD, 0x71, 0x64, 0xFF, 0x7E, 0x00, 0x7B, 0x04, 0x7D, 0x01, -+0xD1, 0x13, 0xBF, 0x01, 0x0C, 0xB1, 0x00, 0x44, 0x01, 0xF0, 0x90, 0xA1, 0x53, 0x74, 0x01, 0xF0, -+0x22, 0x12, 0xB9, 0x6A, 0x7D, 0x4F, 0x80, 0x79, 0x90, 0xA1, 0x53, 0xE0, 0x64, 0x01, 0x60, 0x02, -+0x21, 0x40, 0xB1, 0x00, 0xFF, 0x30, 0xE0, 0x08, 0x90, 0xA3, 0x58, 0x74, 0x01, 0xF0, 0x80, 0x16, -+0xEF, 0xC3, 0x13, 0x20, 0xE0, 0x10, 0x90, 0xA3, 0x58, 0x74, 0x01, 0xF0, 0x12, 0xBA, 0x3C, 0xF0, -+0x7D, 0x50, 0x7F, 0x6F, 0xB1, 0x9C, 0x90, 0xA3, 0x58, 0xE0, 0x60, 0x54, 0x90, 0xA1, 0xCF, 0xE0, -+0x64, 0x06, 0x60, 0x3F, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x01, 0x40, 0x08, 0x90, 0xA3, 0x59, -+0x74, 0x04, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA3, 0x59, 0xF0, 0x31, 0xDD, 0x71, 0x64, 0xFF, 0x7E, -+0x00, 0x90, 0xA3, 0x59, 0xE0, 0xFB, 0x7D, 0x01, 0xD1, 0x13, 0xBF, 0x01, 0x0F, 0x12, 0xB8, 0xF6, -+0x74, 0x03, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x01, 0x1B, 0x12, 0xB9, 0x6A, 0x7D, -+0x51, 0xA1, 0x9C, 0xE4, 0x90, 0xA1, 0xCF, 0xF0, 0x12, 0xA2, 0x41, 0xB1, 0x00, 0x54, 0xFB, 0xF0, -+0x12, 0xB9, 0xFC, 0x60, 0x02, 0x21, 0xDB, 0xFF, 0x31, 0xE6, 0xEF, 0x60, 0x02, 0x21, 0xDB, 0x80, -+0x32, 0x90, 0xA3, 0x54, 0xE0, 0x64, 0x03, 0x70, 0x2E, 0x12, 0xB9, 0xFC, 0x70, 0x7D, 0x91, 0x74, -+0x20, 0xE0, 0x15, 0x31, 0xDD, 0x12, 0xB9, 0xC8, 0xB5, 0x07, 0x05, 0xE4, 0x90, 0xA3, 0x57, 0xF0, -+0x71, 0x92, 0x12, 0xB8, 0xEF, 0xEF, 0x11, 0x13, 0x31, 0xDD, 0xB1, 0x13, 0xE4, 0xFF, 0x31, 0xE6, -+0xEF, 0x70, 0x58, 0x7F, 0x06, 0x81, 0x15, 0x90, 0xA3, 0x54, 0xE0, 0x64, 0x01, 0x70, 0x4C, 0x12, -+0xB9, 0xFC, 0x70, 0x47, 0x31, 0xDD, 0x12, 0xB9, 0xC8, 0xB5, 0x07, 0x05, 0xE4, 0x90, 0xA3, 0x57, -+0xF0, 0x91, 0x74, 0x20, 0xE0, 0x08, 0x71, 0x92, 0x12, 0xB8, 0xEF, 0xEF, 0x11, 0x13, 0x71, 0x92, -+0xD3, 0x94, 0x1F, 0x90, 0xA1, 0x51, 0xE0, 0x40, 0x09, 0x71, 0x61, 0xFF, 0x7D, 0x00, 0x7C, 0x7C, -+0x80, 0x0F, 0xC3, 0x71, 0x61, 0xFB, 0x71, 0x92, 0x7D, 0x00, 0x25, 0xE0, 0x25, 0xE0, 0xFC, 0xAF, -+0x03, 0xD1, 0xCA, 0x31, 0xDD, 0xB1, 0x13, 0xE4, 0xFF, 0x31, 0xE6, 0x22, 0xF0, 0x90, 0xA1, 0x51, -+0xE0, 0xC3, 0x13, 0x54, 0x07, 0x22, 0x90, 0xA3, 0x5A, 0xEF, 0xF0, 0xD1, 0x73, 0xEF, 0x70, 0x02, -+0xFF, 0x22, 0x31, 0xDD, 0x90, 0xA1, 0x8D, 0xF0, 0x90, 0xA1, 0x51, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, -+0xEF, 0x54, 0xF1, 0xFF, 0xEE, 0x04, 0x54, 0x07, 0x25, 0xE0, 0x4F, 0xF0, 0xA3, 0xE0, 0xFF, 0x90, -+0xA1, 0x51, 0xE0, 0xFE, 0xC3, 0x13, 0x54, 0x07, 0xB5, 0x07, 0x04, 0xEE, 0x54, 0xF1, 0xF0, 0x31, -+0xDD, 0xF5, 0x26, 0x90, 0xA3, 0x5A, 0xE0, 0x90, 0xA1, 0x53, 0x70, 0x03, 0xF0, 0x80, 0x03, 0x74, -+0x14, 0xF0, 0x75, 0xF0, 0x13, 0xE5, 0x26, 0x12, 0x99, 0xEA, 0x30, 0xE0, 0x26, 0x71, 0x86, 0xE0, -+0x24, 0x96, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0xFF, 0x71, 0x6F, 0xEF, 0x71, 0x85, -+0xE0, 0x04, 0x71, 0x85, 0xE0, 0xFF, 0x90, 0xA1, 0x95, 0xE0, 0xFE, 0xEF, 0xB5, 0x06, 0x04, 0x71, -+0x86, 0xE4, 0xF0, 0x71, 0x6F, 0xE0, 0xFF, 0x90, 0xA1, 0x8D, 0xE0, 0x75, 0xF0, 0x13, 0x71, 0x74, -+0xE0, 0x6F, 0x70, 0x02, 0x41, 0xFA, 0x71, 0x6F, 0xE0, 0xFC, 0x75, 0xF0, 0x13, 0xE5, 0x26, 0xD1, -+0x66, 0x12, 0x91, 0x33, 0x90, 0xA1, 0xC6, 0x12, 0x6D, 0xA3, 0x30, 0xE0, 0x4E, 0x75, 0xF0, 0x13, -+0xE5, 0x26, 0x90, 0xA1, 0x5F, 0x71, 0x7A, 0xFD, 0x90, 0xA4, 0xA5, 0x12, 0x08, 0x6D, 0x75, 0xF0, -+0x13, 0xE5, 0x26, 0x90, 0xA1, 0x61, 0x71, 0x7A, 0xFD, 0x90, 0xA4, 0xA9, 0x12, 0x08, 0x6D, 0xE4, -+0xFF, 0x12, 0xA9, 0x2F, 0x75, 0xF0, 0x13, 0xE5, 0x26, 0x90, 0xA1, 0x63, 0x71, 0x7A, 0xFD, 0x90, -+0xA4, 0xAE, 0x12, 0x08, 0x6D, 0x75, 0xF0, 0x13, 0xE5, 0x26, 0x90, 0xA1, 0x65, 0x71, 0x7A, 0xFD, -+0x90, 0xA4, 0xB2, 0x12, 0x08, 0x6D, 0xE4, 0xFF, 0x12, 0xAA, 0x3F, 0x75, 0xF0, 0x13, 0xE5, 0x26, -+0xD1, 0x66, 0x54, 0x03, 0xFF, 0xEE, 0xC4, 0x13, 0x54, 0x07, 0xFD, 0x75, 0xF0, 0x13, 0xE5, 0x26, -+0xD1, 0x66, 0x13, 0x13, 0x54, 0x07, 0xFB, 0x12, 0x94, 0x95, 0x75, 0xF0, 0x13, 0xE5, 0x26, 0x90, -+0xA1, 0x5C, 0x12, 0x48, 0xDE, 0xE0, 0x04, 0xF0, 0x90, 0xA3, 0x5A, 0xE0, 0x70, 0x29, 0x91, 0x74, -+0x20, 0xE0, 0x24, 0x75, 0xF0, 0x13, 0xE5, 0x26, 0xF1, 0xAF, 0x60, 0x0B, 0x75, 0xF0, 0x13, 0xE5, -+0x26, 0xF1, 0xAF, 0xFF, 0xBF, 0x02, 0x10, 0x75, 0xF0, 0x13, 0xE5, 0x26, 0x71, 0x67, 0xFF, 0x7E, -+0x00, 0x7B, 0x04, 0xE4, 0xFD, 0xD1, 0x13, 0xAD, 0x26, 0x7F, 0x01, 0xB1, 0x16, 0x90, 0xA1, 0x8F, -+0xE0, 0xC3, 0x13, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x04, 0xE4, 0xFF, 0x91, 0x15, 0x90, 0x01, 0xA5, -+0xE0, 0xB4, 0xFF, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0xA5, 0xE0, 0x04, 0xF0, 0x7F, 0x01, -+0x22, 0x13, 0x54, 0x07, 0x75, 0xF0, 0x13, 0x90, 0xA1, 0x5D, 0x12, 0x48, 0xDE, 0xE0, 0x22, 0x75, -+0xF0, 0x13, 0xE5, 0x26, 0x90, 0xA1, 0x54, 0x02, 0x48, 0xDE, 0x12, 0x48, 0xDE, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0xE4, 0xFC, 0x22, 0xF0, 0x74, 0xB9, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, -+0x83, 0x22, 0x90, 0xA3, 0x57, 0xE0, 0x75, 0xF0, 0x13, 0x90, 0xA1, 0x56, 0x12, 0x48, 0xDE, 0xE0, -+0x22, 0x90, 0xA1, 0xC6, 0x12, 0xA2, 0x4B, 0x30, 0xE0, 0x6A, 0x90, 0xA1, 0x51, 0xE0, 0x30, 0xE0, -+0x63, 0x90, 0xA1, 0xCA, 0xF1, 0xF9, 0x90, 0xA1, 0xC6, 0xE0, 0x54, 0xBF, 0x12, 0x8F, 0x9D, 0x90, -+0xA1, 0x69, 0xE0, 0x24, 0xFB, 0x12, 0x8F, 0xAC, 0x7F, 0x60, 0x7E, 0x01, 0x11, 0x1B, 0x31, 0xDD, -+0xF1, 0xAC, 0x90, 0xA3, 0x53, 0xF0, 0x90, 0xA1, 0x8F, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -+0x21, 0xEF, 0x54, 0xEF, 0xF0, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x27, 0x31, 0xDD, 0x71, -+0x96, 0x24, 0xFC, 0xFF, 0x12, 0xB8, 0xF6, 0xEF, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, -+0x01, 0x1B, 0x90, 0xA3, 0x53, 0xE0, 0xFF, 0x64, 0x03, 0x60, 0x04, 0xEF, 0xB4, 0x01, 0x05, 0x12, -+0xA2, 0x41, 0x11, 0x4D, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xA9, 0x07, 0x90, 0x05, -+0x63, 0xE0, 0xFE, 0x90, 0x05, 0x62, 0x12, 0x9F, 0x76, 0x3E, 0xAD, 0x07, 0xFC, 0x90, 0x05, 0x61, -+0xE0, 0xFE, 0x90, 0x05, 0x60, 0x12, 0x97, 0x74, 0x90, 0xA4, 0x95, 0x74, 0x17, 0xF0, 0x90, 0xA4, -+0xA3, 0x74, 0x06, 0xF0, 0x90, 0xA4, 0x97, 0xE9, 0x31, 0xDC, 0x75, 0xF0, 0x13, 0x71, 0x74, 0xE0, -+0x90, 0xA4, 0x98, 0xF0, 0xAB, 0x07, 0xA3, 0xEB, 0xF0, 0xEE, 0xA3, 0xF0, 0xAF, 0x05, 0xA3, 0xEF, -+0xF0, 0xAE, 0x04, 0xEE, 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x95, 0x12, 0x68, 0x6B, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x8F, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x22, 0xE4, 0x90, 0xA3, -+0x53, 0xF0, 0x90, 0xA1, 0x51, 0xE0, 0xFF, 0x30, 0xE0, 0x6E, 0x91, 0x74, 0x20, 0xE0, 0x69, 0xEF, -+0xC3, 0x13, 0x54, 0x07, 0xFF, 0xB1, 0x08, 0xFE, 0x30, 0xE0, 0x5D, 0x75, 0xF0, 0x13, 0xEF, 0x90, -+0xA1, 0x5B, 0x12, 0x48, 0xDE, 0xEE, 0x54, 0xFE, 0xF0, 0x75, 0xF0, 0x13, 0xEF, 0xB1, 0x0B, 0x13, -+0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0E, 0x90, 0xA1, 0x93, 0x91, 0xF9, 0x54, 0xFB, 0xF0, 0x90, 0xA3, -+0x53, 0x74, 0x01, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, 0x22, 0x12, 0xA2, 0x41, 0xB1, 0x00, -+0x44, 0x02, 0xF0, 0xE4, 0x90, 0xA1, 0xCF, 0x31, 0xDC, 0xFD, 0x7F, 0x02, 0xB1, 0x16, 0x90, 0xA3, -+0x53, 0xE0, 0x60, 0x14, 0xE4, 0x90, 0xA1, 0x91, 0xF0, 0xA3, 0xF0, 0x01, 0x4D, 0x90, 0xA1, 0x91, -+0x91, 0xF9, 0x54, 0xFD, 0xF0, 0x12, 0x8B, 0x2E, 0x22, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, -+0x90, 0xA1, 0x51, 0xE0, 0xC3, 0x13, 0x54, 0x07, 0x75, 0xF0, 0x13, 0x90, 0xA1, 0x5B, 0x12, 0x48, -+0xDE, 0xE0, 0x22, 0xFD, 0x7F, 0x02, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x15, -+0xED, 0xF0, 0x90, 0xA5, 0x14, 0xEF, 0xF0, 0x64, 0x02, 0x70, 0x27, 0x90, 0x05, 0x22, 0xE0, 0x90, -+0xA5, 0x16, 0xF0, 0x7D, 0x4A, 0x7F, 0x6F, 0xB1, 0x9C, 0xD1, 0x73, 0xBF, 0x01, 0x07, 0x90, 0x04, -+0xD4, 0x74, 0xFF, 0x80, 0x43, 0x90, 0xA5, 0x16, 0xE0, 0xFF, 0x7D, 0x46, 0xB1, 0x9C, 0x7F, 0x00, -+0x80, 0x3B, 0x90, 0xA5, 0x14, 0xE0, 0x64, 0x01, 0x70, 0x2A, 0xFD, 0xFF, 0xB1, 0x9C, 0x90, 0xA5, -+0x15, 0xE0, 0xFF, 0x75, 0xF0, 0x13, 0x90, 0xA1, 0x59, 0x12, 0x48, 0xDE, 0xE0, 0xF4, 0x90, 0x04, -+0xD4, 0xF0, 0x75, 0xF0, 0x13, 0xEF, 0x90, 0xA1, 0x5A, 0x12, 0x48, 0xDE, 0xE0, 0xF4, 0x90, 0x04, -+0xD5, 0xF0, 0x80, 0x07, 0x90, 0x04, 0xD4, 0xE4, 0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x58, 0xE9, 0xE4, 0xFD, 0xFF, 0x90, 0x05, 0x22, 0xEF, -+0xF0, 0x90, 0x9F, 0x17, 0xED, 0xF0, 0x22, 0x8F, 0x13, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA2, 0x94, -+0xF0, 0x7D, 0x17, 0xD1, 0x6F, 0xEF, 0x64, 0x01, 0x70, 0x4D, 0x75, 0xF0, 0x13, 0xE5, 0x13, 0x71, -+0x74, 0xE0, 0xFC, 0xD1, 0x61, 0x12, 0x91, 0x33, 0xD1, 0x61, 0x54, 0x03, 0xFF, 0xEE, 0xC4, 0x13, -+0x54, 0x07, 0xFD, 0xD1, 0x61, 0x13, 0x13, 0x54, 0x07, 0xFB, 0x12, 0x94, 0x95, 0x91, 0x74, 0x20, -+0xE0, 0x1C, 0x75, 0xF0, 0x13, 0xE5, 0x13, 0xF1, 0xAF, 0xFF, 0x60, 0x03, 0xBF, 0x02, 0x0F, 0x75, -+0xF0, 0x13, 0xE5, 0x13, 0x71, 0x67, 0xFF, 0x7E, 0x00, 0xE4, 0xFB, 0xFD, 0xD1, 0x13, 0xAD, 0x13, -+0x7F, 0x01, 0xB1, 0x16, 0x7F, 0x01, 0x22, 0x90, 0xA2, 0x94, 0xE0, 0xFF, 0x7D, 0x49, 0xB1, 0x9C, -+0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xC5, 0x12, 0x97, 0x7E, -+0x90, 0x04, 0x1D, 0xE0, 0x60, 0x2A, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA4, 0xCB, 0xF0, 0x7D, 0x14, -+0xD1, 0x6F, 0xEF, 0x64, 0x01, 0x70, 0x0A, 0x12, 0xB8, 0x91, 0xE0, 0xFF, 0x12, 0x8C, 0xBA, 0x80, -+0x04, 0x7F, 0x00, 0x80, 0x17, 0x90, 0xA4, 0xCB, 0xE0, 0xFF, 0x7D, 0x15, 0xB1, 0x9C, 0x80, 0x08, -+0x12, 0xB8, 0x91, 0xE0, 0xFF, 0x12, 0x8C, 0xBA, 0xF1, 0xF2, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x75, 0xF0, 0x13, 0xE5, 0x13, 0x90, 0xA1, 0x55, 0x12, 0x48, 0xDE, 0xE0, 0xFE, 0x22, 0x7F, -+0xFF, 0xB1, 0x9C, 0xE4, 0x90, 0xA5, 0x0B, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA5, -+0x0D, 0xF0, 0x7D, 0x47, 0x7F, 0xFF, 0xB1, 0x9C, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x12, 0xA3, 0xE0, -+0x70, 0x0E, 0xA3, 0xE0, 0x70, 0x0A, 0xA3, 0xE0, 0x70, 0x06, 0x12, 0xB9, 0xE9, 0x7F, 0x01, 0x22, -+0xD3, 0x90, 0xA5, 0x0C, 0xE0, 0x94, 0xE8, 0x90, 0xA5, 0x0B, 0xE0, 0x94, 0x03, 0x40, 0x0D, 0x90, -+0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0xB9, 0xE9, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, -+0x12, 0x3D, 0x7A, 0x90, 0xA5, 0x0B, 0xF1, 0xF9, 0x80, 0xBE, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA3, 0x5A, 0xEF, 0xF0, 0xA3, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x04, 0x1D, 0xE0, -+0x60, 0x1D, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA3, 0x5F, 0xF0, 0x7D, 0x36, 0xD1, 0x6F, 0xBF, 0x01, -+0x03, 0x12, 0xB7, 0xF2, 0x90, 0xA3, 0x5F, 0xE0, 0xFF, 0x7D, 0x37, 0xB1, 0x9C, 0x80, 0x03, 0x12, -+0xB7, 0xF2, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x6F, 0xFF, 0x7D, 0x38, 0xB1, 0x9C, 0xF1, 0xF2, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xEA, 0xED, 0xF0, -+0xA3, 0xEB, 0xF0, 0x90, 0xA4, 0xE9, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xB8, 0x4E, 0x7C, 0x00, -+0xAD, 0x07, 0x90, 0xA4, 0xE9, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0xA4, 0xEA, 0xE0, 0x60, 0x06, -+0x12, 0xB9, 0xBC, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x12, 0xB9, 0xBC, 0x54, 0xC0, 0xF0, 0x90, 0xA4, 0xEC, 0xE0, -+0xFF, 0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x74, -+0x12, 0x2E, 0x12, 0x8D, 0x94, 0xE0, 0x54, 0x01, 0xFF, 0x90, 0xA4, 0xEB, 0xE0, 0x25, 0xE0, 0x25, -+0xE0, 0xFE, 0xEF, 0x44, 0x02, 0x4E, 0xFF, 0xAE, 0x05, 0x74, 0x12, 0x2E, 0x12, 0x8D, 0x94, 0xEF, -+0xF0, 0x74, 0x11, 0x2E, 0x12, 0x8F, 0xB4, 0x74, 0xFF, 0xF0, 0x74, 0x29, 0x2E, 0x12, 0x8D, 0x7F, -+0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x13, 0x90, -+0xA1, 0x57, 0x12, 0x48, 0xDE, 0xE0, 0x54, 0x07, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA5, 0x01, 0xEF, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1D, 0x90, 0x05, 0x22, 0xE0, 0x90, -+0xA5, 0x04, 0xF0, 0x7D, 0x29, 0xD1, 0x6F, 0xBF, 0x01, 0x03, 0x12, 0x8C, 0x99, 0x90, 0xA5, 0x04, -+0xE0, 0xFF, 0x7D, 0x2A, 0xB1, 0x9C, 0x80, 0x03, 0x12, 0x8C, 0x99, 0xF1, 0xF2, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x08, 0xD6, -+0x7F, 0xF4, 0x12, 0x4B, 0xB4, 0xEF, 0x20, 0xE5, 0x0E, 0x7F, 0xF4, 0x12, 0x4B, 0xB4, 0xEF, 0x7F, -+0x01, 0x20, 0xE4, 0x05, 0x7F, 0x02, 0x22, 0x7F, 0x03, 0x22, 0x11, 0x00, 0x90, 0x9F, 0x19, 0xEF, -+0xF0, 0x11, 0x33, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, -+0x02, 0x36, 0x83, 0x12, 0x4F, 0x4C, 0x12, 0x4F, 0x6E, 0x11, 0x40, 0x11, 0x5F, 0x02, 0x4F, 0xD1, -+0x75, 0x59, 0x12, 0xE4, 0xF5, 0x5A, 0x75, 0x5B, 0x07, 0x75, 0x5C, 0x72, 0x90, 0x01, 0x30, 0xE5, -+0x59, 0xF0, 0xA3, 0xE5, 0x5A, 0xF0, 0xA3, 0xE5, 0x5B, 0xF0, 0xA3, 0xE5, 0x5C, 0xF0, 0x22, 0x75, -+0x61, 0x06, 0x43, 0x61, 0x10, 0x75, 0x62, 0x01, 0x75, 0x63, 0x13, 0x75, 0x64, 0x62, 0x90, 0x01, -+0x38, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, 0x62, 0xF0, 0xA3, 0xE5, 0x63, 0xF0, 0xA3, 0xE5, 0x64, 0xF0, -+0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, 0x85, 0x22, 0xE4, 0x90, 0xA2, 0x86, 0xF0, 0x90, 0xA2, 0x86, -+0xE0, 0x64, 0x01, 0xF0, 0x24, 0x88, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x58, 0xA3, 0xF0, 0x12, 0x3D, -+0x6E, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x38, 0x90, 0xA0, 0xDF, 0xE0, 0x60, 0x0E, 0x90, 0xA0, 0xE2, -+0xE0, 0xFF, 0x90, 0xA0, 0xE1, 0xE0, 0x6F, 0x60, 0x02, 0x11, 0xD0, 0xC2, 0xAF, 0x12, 0xA0, 0xA3, -+0xBF, 0x01, 0x03, 0x12, 0xB6, 0x59, 0xD2, 0xAF, 0x12, 0x4F, 0xFA, 0x12, 0x45, 0x2D, 0x80, 0xBD, -+0x90, 0xA0, 0xD5, 0xE0, 0x90, 0xA0, 0xE1, 0x30, 0xE0, 0x05, 0xE0, 0xFF, 0x02, 0xA2, 0x52, 0xE0, -+0xFF, 0x7D, 0x01, 0x80, 0x04, 0x7D, 0x01, 0x7F, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA5, 0x29, 0xED, 0xF0, 0x90, 0xA0, 0xDA, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, -+0xE0, 0x02, 0x41, 0x36, 0xEE, 0x12, 0x6D, 0xA4, 0x30, 0xE0, 0x02, 0x41, 0x36, 0x90, 0xA0, 0xE2, -+0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x41, 0x36, 0xEF, 0x70, 0x02, 0x21, 0xA8, 0x24, 0xFE, 0x70, 0x02, -+0x21, 0xE2, 0x24, 0xFE, 0x60, 0x4A, 0x24, 0xFC, 0x70, 0x02, 0x41, 0x1D, 0x24, 0xFC, 0x60, 0x02, -+0x41, 0x2F, 0xEE, 0xB4, 0x0E, 0x02, 0x51, 0x80, 0x90, 0xA0, 0xE2, 0xE0, 0x70, 0x04, 0x7F, 0x01, -+0x51, 0xCB, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x06, 0x02, 0x51, 0xA5, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, -+0x04, 0x0F, 0x90, 0xA5, 0x29, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x86, 0x7C, 0x80, 0x03, 0x12, 0x84, -+0xDA, 0x90, 0xA0, 0xE2, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x41, 0x2F, 0x12, 0xB7, 0xE5, 0x41, 0x2F, -+0x90, 0xA0, 0xE2, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x51, 0xCB, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x06, -+0x02, 0x51, 0xA5, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x0E, 0x07, 0x51, 0x3B, 0xBF, 0x01, 0x02, 0x51, -+0x80, 0x90, 0xA0, 0xE2, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x41, 0x2F, 0x51, 0x3B, 0xEF, 0x64, 0x01, -+0x60, 0x02, 0x41, 0x2F, 0x51, 0xE4, 0x41, 0x2F, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x0E, 0x07, 0x51, -+0x3B, 0xBF, 0x01, 0x02, 0x51, 0x80, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x06, 0x02, 0x51, 0xA5, 0x90, -+0xA0, 0xE2, 0xE0, 0xB4, 0x0C, 0x07, 0x51, 0x3B, 0xBF, 0x01, 0x02, 0x51, 0xE4, 0x90, 0xA0, 0xE2, -+0xE0, 0x64, 0x04, 0x70, 0x5A, 0x12, 0xB6, 0xA7, 0xEF, 0x64, 0x01, 0x70, 0x52, 0x12, 0xB7, 0x95, -+0x80, 0x4D, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x0E, 0x07, 0x51, 0x3B, 0xBF, 0x01, 0x02, 0x51, 0x80, -+0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x06, 0x02, 0x51, 0xA5, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x0C, 0x07, -+0x51, 0x3B, 0xBF, 0x01, 0x02, 0x51, 0xE4, 0x90, 0xA0, 0xE2, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x51, -+0xCB, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x04, 0x17, 0x12, 0xB7, 0xB6, 0x80, 0x12, 0x90, 0xA0, 0xE2, -+0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0xA0, 0xDB, 0x12, 0x85, 0xFC, 0x30, 0xE0, 0x02, 0xF1, 0xDF, 0x90, -+0xA0, 0xE2, 0x12, 0xB9, 0x5D, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x12, 0x8F, 0xDC, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x76, 0x01, 0x80, 0x1E, 0x12, -+0x8F, 0xD2, 0x30, 0xE0, 0x05, 0x75, 0x76, 0x02, 0x80, 0x13, 0x90, 0xA0, 0xE1, 0xE0, 0xD3, 0x94, -+0x04, 0x40, 0x05, 0x75, 0x76, 0x08, 0x80, 0x05, 0x12, 0xB7, 0x3E, 0x80, 0x0E, 0x90, 0x01, 0xB9, -+0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x76, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0xA0, 0xDB, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x04, 0x71, 0x1A, 0x80, 0x12, 0x12, 0xB9, 0xD3, -+0xF1, 0xD0, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA0, 0xD9, 0x74, 0x04, 0xF0, 0xE4, -+0xFD, 0xFF, 0x02, 0x55, 0x9C, 0x90, 0xA0, 0xDB, 0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x07, 0xE0, -+0x44, 0x40, 0xF1, 0xD0, 0x80, 0x0F, 0x71, 0x16, 0x90, 0x05, 0x27, 0xE0, 0x54, 0x7F, 0xF0, 0x90, -+0xA0, 0xD9, 0x74, 0x0C, 0xF0, 0xE4, 0xFD, 0xFF, 0x02, 0x55, 0x9C, 0x90, 0xA5, 0x28, 0xEF, 0xF0, -+0x12, 0x4B, 0xEF, 0x90, 0xA5, 0x28, 0xE0, 0x60, 0x03, 0x12, 0x8B, 0x2E, 0x7D, 0x04, 0xF1, 0xD7, -+0x74, 0x04, 0xF0, 0x22, 0x12, 0x83, 0xC1, 0x70, 0x2C, 0x90, 0xA0, 0xDB, 0xE0, 0x54, 0xFD, 0xF0, -+0x7D, 0x2C, 0x7F, 0x6F, 0x12, 0x55, 0x9C, 0x7D, 0x08, 0x7F, 0x01, 0x12, 0x8C, 0x3A, 0xBF, 0x01, -+0x0F, 0x90, 0xA0, 0xDA, 0xE0, 0x44, 0x80, 0xF0, 0x7D, 0x0E, 0xF1, 0xD7, 0x74, 0x0E, 0xF0, 0x22, -+0x12, 0xA3, 0x4A, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0x7F, 0xF0, 0x7D, 0x0C, 0x7F, 0x01, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x27, 0xEF, 0xF0, 0x14, 0x60, 0x15, 0x14, 0x60, 0x19, -+0x24, 0x02, 0x70, 0x1A, 0xED, 0x54, 0x01, 0xFF, 0x90, 0xA0, 0xDA, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, -+0x80, 0x0C, 0x90, 0xA0, 0xE2, 0xED, 0xF0, 0x80, 0x05, 0x90, 0xA0, 0xE1, 0xED, 0xF0, 0x12, 0x4D, -+0x6A, 0x30, 0xE4, 0x2C, 0x90, 0xA5, 0x27, 0xE0, 0x14, 0x60, 0x07, 0x14, 0x60, 0x18, 0x24, 0x02, -+0x70, 0x1E, 0x90, 0xA0, 0xDA, 0xE0, 0x12, 0x6F, 0xDA, 0xFF, 0x90, 0xA0, 0xE2, 0xE0, 0x54, 0x7F, -+0x4F, 0xFD, 0x7F, 0x88, 0x80, 0x07, 0x90, 0xA0, 0xE1, 0xE0, 0xFD, 0x7F, 0x89, 0x12, 0x4A, 0x26, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8B, 0x0F, 0x8A, 0x10, -+0x89, 0x11, 0x90, 0x05, 0x27, 0xE0, 0xF5, 0x12, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, -+0x01, 0x7B, 0x01, 0x7A, 0xA0, 0x79, 0xD5, 0x12, 0x34, 0x62, 0x12, 0x99, 0xF2, 0xFF, 0xC3, 0x13, -+0x20, 0xE0, 0x02, 0x81, 0x43, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x76, 0x12, 0x82, 0x0D, 0x75, -+0x12, 0x21, 0x90, 0xA0, 0xD5, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x05, 0x12, 0xB9, 0x4D, -+0x80, 0x0D, 0xE4, 0x90, 0xA0, 0xD6, 0xF0, 0xA3, 0xF0, 0x7D, 0x40, 0xFF, 0x12, 0x77, 0xA9, 0x90, -+0xA0, 0xD5, 0x12, 0x86, 0x06, 0x30, 0xE0, 0x03, 0x43, 0x12, 0x12, 0xEF, 0xC4, 0x54, 0x0F, 0x30, -+0xE0, 0x03, 0x43, 0x12, 0x14, 0x90, 0xA0, 0xD5, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x03, -+0x43, 0x12, 0x80, 0x12, 0xA2, 0x48, 0x20, 0xE0, 0x03, 0x43, 0x12, 0x40, 0xB1, 0xB2, 0x90, 0xA0, -+0xD8, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xB1, 0xB9, 0x12, 0x8E, 0xE7, 0x30, 0xE0, 0x04, 0x7F, 0x04, -+0x80, 0x0C, 0x12, 0x84, 0x66, 0xEF, 0x60, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0xB1, 0xB9, -+0x81, 0xBB, 0xB1, 0xAF, 0x90, 0xA0, 0xD8, 0xE0, 0x64, 0x04, 0x60, 0x02, 0x81, 0xEA, 0xFF, 0xB1, -+0xB9, 0x81, 0xEA, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x79, 0x12, 0x82, 0x0D, 0x43, 0x12, 0x31, -+0x90, 0xA0, 0xD5, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x05, 0x12, 0xB9, 0x4D, 0x80, 0x07, -+0x7D, 0x40, 0xE4, 0xFF, 0x12, 0x77, 0xA9, 0x90, 0xA0, 0xD5, 0x12, 0x86, 0x06, 0x30, 0xE0, 0x03, -+0x43, 0x12, 0x02, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x43, 0x12, 0x04, 0xB1, 0xB2, 0x12, -+0x8E, 0xE7, 0x30, 0xE0, 0x0B, 0x12, 0x8E, 0xE0, 0x60, 0x31, 0xE4, 0xFD, 0x7F, 0x02, 0x80, 0x1F, -+0x12, 0x8B, 0x65, 0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x02, 0x19, 0x12, 0x8B, 0x57, 0x12, 0x84, 0x66, -+0xBF, 0x01, 0x09, 0x90, 0xA0, 0xE1, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x03, 0xE4, 0xFD, 0xFF, 0x11, -+0xE9, 0x80, 0x08, 0x90, 0xA0, 0xE2, 0xE0, 0x90, 0xA0, 0xD9, 0xF0, 0x90, 0x05, 0x40, 0x74, 0x22, -+0xF0, 0x80, 0x27, 0xB1, 0xAF, 0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x02, 0x06, 0x7D, 0x01, 0x7F, 0x04, -+0x80, 0x0B, 0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x08, 0x06, 0x7D, 0x01, 0x7F, 0x0C, 0x11, 0xE9, 0x12, -+0x8F, 0xCA, 0x90, 0xA0, 0xE1, 0x11, 0xDF, 0x12, 0x9A, 0x06, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0xA2, 0x89, 0x12, 0x48, 0xF3, 0x90, 0xA2, 0x88, 0xEF, 0xF0, 0x12, 0x48, 0xFC, 0x5D, 0x3D, 0x00, -+0x5D, 0x42, 0x01, 0x5D, 0x47, 0x10, 0x5D, 0x4C, 0x12, 0x5D, 0x51, 0x14, 0x5D, 0xA8, 0x15, 0x5D, -+0x56, 0x16, 0x5D, 0x5B, 0x18, 0x5D, 0x60, 0x19, 0x5D, 0x65, 0x1A, 0x5D, 0x6A, 0x20, 0x5D, 0x6E, -+0x24, 0x5D, 0x72, 0x25, 0x5D, 0x77, 0x27, 0x5D, 0x7C, 0x28, 0x5D, 0x81, 0x40, 0x5D, 0x86, 0x42, -+0x5D, 0x94, 0x45, 0x5D, 0x8A, 0x47, 0x5D, 0x8F, 0x49, 0x00, 0x00, 0x5D, 0x99, 0xB1, 0xA9, 0x02, -+0x6F, 0x73, 0xB1, 0xA9, 0x02, 0x84, 0x7F, 0xB1, 0xA9, 0x02, 0x97, 0xDA, 0xB1, 0xA9, 0x02, 0x9B, -+0x4B, 0xB1, 0xA9, 0x02, 0x9B, 0x5F, 0xB1, 0xA9, 0x02, 0x6F, 0x0E, 0xB1, 0xA9, 0x02, 0x98, 0x02, -+0xB1, 0xA9, 0x02, 0x9B, 0x1B, 0xB1, 0xA9, 0x02, 0x6D, 0xAB, 0xB1, 0xA9, 0xE1, 0x6E, 0xB1, 0xA9, -+0x61, 0x85, 0xB1, 0xA9, 0x02, 0x9B, 0x6E, 0xB1, 0xA9, 0x02, 0x9B, 0x76, 0xB1, 0xA9, 0x02, 0x9B, -+0xB4, 0xB1, 0xA9, 0x02, 0x6C, 0xC3, 0xB1, 0xA9, 0xC1, 0xAD, 0xB1, 0xA9, 0x02, 0x6F, 0x30, 0xB1, -+0xA9, 0x02, 0x6F, 0xB0, 0xB1, 0xA9, 0x02, 0x6E, 0x8A, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, -+0x90, 0xA2, 0x88, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, 0xA2, 0x89, 0x02, 0x48, 0xEA, 0x75, -+0x12, 0x01, 0x90, 0x05, 0x27, 0xE5, 0x12, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA0, 0xD8, 0xE0, 0xF5, 0x75, 0xE5, 0x75, 0x6F, 0x70, 0x02, 0xC1, 0xA8, 0xEF, 0x14, 0x60, -+0x3E, 0x14, 0x60, 0x61, 0x14, 0x70, 0x02, 0xC1, 0x5C, 0x14, 0x70, 0x02, 0xC1, 0x83, 0x24, 0x04, -+0x60, 0x02, 0xC1, 0xA8, 0xE5, 0x75, 0xB4, 0x04, 0x05, 0x12, 0x8B, 0x3B, 0xC1, 0xA8, 0xE5, 0x75, -+0xB4, 0x02, 0x05, 0x12, 0x8B, 0x45, 0xC1, 0xA8, 0xE5, 0x75, 0xB4, 0x03, 0x05, 0x12, 0x8B, 0x4E, -+0xC1, 0xA8, 0xE5, 0x75, 0x64, 0x01, 0x60, 0x02, 0xC1, 0xA8, 0x12, 0x8B, 0x3D, 0xC1, 0xA8, 0xE5, -+0x75, 0xB4, 0x04, 0x05, 0x12, 0x8B, 0x34, 0xC1, 0xA8, 0xE5, 0x75, 0xB4, 0x02, 0x05, 0x12, 0x8B, -+0x49, 0xC1, 0xA8, 0xE5, 0x75, 0xB4, 0x03, 0x05, 0x12, 0x8B, 0x52, 0x80, 0x7B, 0xE5, 0x75, 0x70, -+0x77, 0xF1, 0xF1, 0x80, 0x73, 0xE5, 0x75, 0xB4, 0x04, 0x05, 0x12, 0x8B, 0x6D, 0x80, 0x69, 0xE5, -+0x75, 0xB4, 0x01, 0x05, 0x12, 0x8F, 0x8F, 0x80, 0x5F, 0xE5, 0x75, 0xB4, 0x03, 0x05, 0x12, 0x8F, -+0x85, 0x80, 0x55, 0xE5, 0x75, 0x70, 0x51, 0x12, 0x8F, 0x93, 0x80, 0x4C, 0xE5, 0x75, 0xB4, 0x04, -+0x05, 0x12, 0x8B, 0x80, 0x80, 0x42, 0xE5, 0x75, 0xB4, 0x01, 0x05, 0x12, 0x8F, 0xBC, 0x80, 0x38, -+0xE5, 0x75, 0xB4, 0x02, 0x05, 0x12, 0x8F, 0x98, 0x80, 0x2E, 0xE5, 0x75, 0x70, 0x2A, 0x12, 0x8F, -+0xC5, 0x80, 0x25, 0xE5, 0x75, 0xB4, 0x03, 0x05, 0x12, 0xB6, 0x3C, 0x80, 0x1B, 0xE5, 0x75, 0xB4, -+0x01, 0x05, 0x12, 0xB6, 0x27, 0x80, 0x11, 0xE5, 0x75, 0xB4, 0x02, 0x05, 0x12, 0xB6, 0x45, 0x80, -+0x07, 0xE5, 0x75, 0x70, 0x03, 0x12, 0xB6, 0x40, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF1, 0xF8, 0x12, -+0x06, 0x89, 0xF5, 0x0F, 0x24, 0x91, 0x12, 0x4F, 0x37, 0xE0, 0x54, 0x98, 0xF0, 0x12, 0x4F, 0x33, -+0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x66, 0xF1, 0x60, 0x54, 0x01, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, -+0x83, 0xF0, 0x12, 0x4F, 0x33, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x66, 0xF1, 0x60, 0x54, 0x02, 0xFE, -+0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x12, 0x4F, 0x33, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x66, -+0xF1, 0x60, 0x54, 0x04, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x12, 0x4F, 0x33, 0xC0, -+0x83, 0xC0, 0x82, 0xF1, 0x66, 0xF1, 0x60, 0x54, 0x40, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, -+0xF0, 0x12, 0x4F, 0x33, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x66, 0xF1, 0x60, 0x54, 0x20, 0xFE, 0xEF, -+0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xE5, 0x0F, 0x70, 0x08, 0xF1, 0x60, 0x54, 0x04, 0x90, 0x04, -+0xAB, 0xF0, 0xE5, 0x0F, 0xC3, 0x94, 0x80, 0x50, 0x0A, 0x12, 0x6D, 0x9A, 0x12, 0x66, 0x98, 0xF5, -+0x83, 0xEF, 0xF0, 0x12, 0x4F, 0x33, 0xE0, 0x30, 0xE5, 0x14, 0x12, 0x4D, 0xBD, 0x13, 0x13, 0x54, -+0x03, 0xFB, 0x12, 0x66, 0x99, 0xF5, 0x83, 0xE0, 0xFD, 0xAF, 0x0F, 0x12, 0xA4, 0x5B, 0x22, 0xF0, -+0x90, 0x00, 0x03, 0x02, 0x06, 0xA2, 0xE0, 0xFF, 0x90, 0xA2, 0x8C, 0x02, 0x48, 0xEA, 0xF1, 0xF8, -+0x12, 0x06, 0x89, 0xFF, 0x54, 0x7F, 0x90, 0xA0, 0xDF, 0xF0, 0xEF, 0x12, 0x6D, 0xA4, 0xA3, 0x12, -+0x6F, 0x07, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0xA0, 0xDD, 0xE0, 0x54, 0xF0, 0x4E, -+0xF1, 0x5F, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0xA0, 0xDA, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, -+0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0x12, 0x8D, 0xCC, 0x4F, 0xF0, 0x12, 0x6D, 0x9A, 0x90, 0xA0, -+0xDE, 0x12, 0x6F, 0x6C, 0xFD, 0x7F, 0x02, 0x71, 0x1E, 0xF1, 0x68, 0x12, 0x86, 0x4A, 0x12, 0xA3, -+0x4A, 0xF0, 0x90, 0xA0, 0xDF, 0x12, 0xB9, 0x5D, 0x12, 0x8D, 0xCB, 0x90, 0x01, 0xBE, 0xF0, 0x22, -+0xF0, 0x7D, 0x04, 0x7F, 0x01, 0x61, 0x1E, 0x7F, 0x01, 0x71, 0x1E, 0x90, 0xA0, 0xD9, 0x22, 0x7D, -+0x2F, 0x7F, 0xFF, 0x12, 0x55, 0x9C, 0x12, 0x4B, 0x6E, 0x7D, 0x08, 0xF1, 0xD7, 0x74, 0x08, 0xF0, -+0x22, 0x90, 0xA0, 0xD8, 0x74, 0x01, 0xF0, 0x22, 0x90, 0xA2, 0x8C, 0x02, 0x48, 0xF3, 0xE4, 0xFB, -+0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x47, 0x2E, 0x90, 0xA2, 0x87, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x9F, -+0x13, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE0, 0x0E, 0x90, -+0x9F, 0x13, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x7C, 0x84, 0x11, 0x49, 0x12, 0xBA, 0x0C, -+0x30, 0xE1, 0x06, 0x54, 0xFD, 0xF0, 0x12, 0x9D, 0x1B, 0x12, 0xBA, 0x0C, 0x30, 0xE2, 0x06, 0x54, -+0xFB, 0xF0, 0x12, 0x9F, 0x09, 0xD2, 0xAF, 0x80, 0xC5, 0x90, 0x04, 0x85, 0xE0, 0xF5, 0x1B, 0x90, -+0x9B, 0x91, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x0F, 0x90, 0xA0, 0xD4, 0xE0, 0xFF, 0xE5, 0x0F, 0xC3, -+0x9F, 0x40, 0x02, 0xC1, 0x53, 0xE5, 0x0F, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA2, 0x95, 0xF0, -+0xE5, 0x0F, 0x54, 0x07, 0xA3, 0xF0, 0x90, 0x04, 0xA0, 0xE0, 0xFF, 0xA3, 0xE0, 0xFE, 0xEF, 0x64, -+0x01, 0x70, 0x27, 0xE5, 0x0F, 0x6E, 0x70, 0x22, 0xA3, 0xE0, 0xF5, 0x10, 0xA3, 0xE0, 0x12, 0x78, -+0xDE, 0xE5, 0x10, 0xF0, 0x12, 0x8B, 0xD0, 0xE0, 0x54, 0xFC, 0xFF, 0x90, 0xA2, 0x91, 0xE0, 0x54, -+0x03, 0x4F, 0xFF, 0x12, 0x8B, 0xD0, 0xEF, 0xF0, 0xC1, 0x4F, 0xE5, 0x1B, 0x60, 0x15, 0x90, 0x9B, -+0x91, 0xE0, 0x85, 0x1B, 0xF0, 0x84, 0xE5, 0xF0, 0x60, 0x09, 0xE4, 0xFD, 0xAF, 0x0F, 0x12, 0x7C, -+0x16, 0xC1, 0x4F, 0xAF, 0x0F, 0x12, 0x82, 0x72, 0xEF, 0x70, 0x02, 0xC1, 0x4F, 0x12, 0x4D, 0xBD, -+0x12, 0x6D, 0xA4, 0x30, 0xE0, 0x02, 0xC1, 0x4F, 0x90, 0xA2, 0x95, 0x12, 0x7C, 0x0B, 0xE0, 0xFD, -+0x7C, 0x00, 0x90, 0xA2, 0x96, 0x12, 0x7F, 0xD0, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0x12, 0xB9, 0xB4, 0x60, 0x02, 0xC1, 0x4F, 0x12, 0xB8, 0xC3, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, -+0x70, 0x08, 0x12, 0xB8, 0xE3, 0xE0, 0x70, 0x02, 0xC1, 0x4F, 0xE5, 0x0F, 0x12, 0xA6, 0x34, 0x7B, -+0x01, 0x90, 0xA2, 0x8B, 0x12, 0x48, 0xF3, 0x12, 0xB8, 0xC3, 0xE0, 0xF5, 0x14, 0xA3, 0xE0, 0xF5, -+0x15, 0x12, 0xB8, 0xE3, 0xE0, 0xFF, 0x90, 0xA2, 0x8E, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, -+0x04, 0xE5, 0x0F, 0x12, 0x6F, 0xE7, 0xE0, 0x90, 0xA2, 0x90, 0xF0, 0x12, 0x4D, 0xBD, 0x13, 0x13, -+0x54, 0x03, 0x12, 0x78, 0xDE, 0xE0, 0xF5, 0x10, 0x54, 0x7F, 0xF5, 0x11, 0x12, 0xBA, 0x03, 0xD1, -+0xA3, 0x90, 0x00, 0x02, 0x12, 0x07, 0xAB, 0xFF, 0x90, 0xA4, 0x48, 0xD1, 0xA7, 0x90, 0x00, 0x04, -+0x12, 0x07, 0xAB, 0xFF, 0x90, 0xA4, 0x4A, 0xD1, 0xA7, 0xF1, 0xCD, 0xFF, 0x90, 0xA4, 0x4C, 0xD1, -+0xA7, 0x7B, 0x01, 0xF1, 0xDA, 0xF1, 0x9B, 0xD1, 0xA3, 0x90, 0xA2, 0x8E, 0x12, 0xB9, 0x84, 0xF0, -+0xA3, 0xE5, 0x14, 0xF0, 0xA3, 0xE5, 0x15, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x10, 0xF0, 0x7B, -+0x02, 0xF1, 0xDA, 0x90, 0xA2, 0x90, 0xE0, 0xFF, 0xE5, 0x11, 0xD3, 0x9F, 0x40, 0x12, 0x8F, 0x11, -+0xE5, 0x10, 0x30, 0xE7, 0x07, 0xE5, 0x11, 0x44, 0x80, 0xFF, 0x80, 0x02, 0xAF, 0x11, 0x8F, 0x10, -+0xE5, 0x11, 0x90, 0x41, 0x5F, 0x93, 0xD1, 0x98, 0xF5, 0x83, 0xE0, 0xC3, 0x9F, 0x40, 0x0B, 0x74, -+0x28, 0x25, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0x80, 0x09, 0x74, 0x7C, 0x25, 0x11, 0xF5, 0x82, -+0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xFF, 0x12, 0xA6, 0x41, 0x90, 0xA2, 0x88, 0x12, 0x48, 0xF3, -+0xF1, 0xA7, 0xC3, 0x94, 0x05, 0x40, 0x02, 0x61, 0xF8, 0xE5, 0x10, 0x30, 0xE7, 0x04, 0x05, 0x16, -+0x05, 0x16, 0x90, 0x04, 0x8D, 0xE5, 0x16, 0xF0, 0x90, 0x04, 0x8C, 0xE0, 0x64, 0x01, 0x70, 0x2A, -+0xE5, 0x11, 0xC3, 0x94, 0x0C, 0x40, 0x23, 0x74, 0x84, 0x25, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x04, -+0xF5, 0x83, 0xE0, 0xFF, 0x60, 0x14, 0x54, 0x7F, 0xFE, 0xEF, 0x30, 0xE7, 0x07, 0xEE, 0x25, 0x16, -+0xF5, 0x16, 0x80, 0x06, 0xC3, 0xE5, 0x16, 0x9E, 0xF5, 0x16, 0x90, 0x04, 0x8E, 0xE5, 0x16, 0xF0, -+0xD3, 0x94, 0x1A, 0xAF, 0x16, 0x40, 0x02, 0x7F, 0x1A, 0x12, 0xA6, 0x41, 0x90, 0xA2, 0x88, 0x12, -+0x48, 0xF3, 0x12, 0x4F, 0xA3, 0x7B, 0x03, 0xFA, 0xF1, 0xDC, 0xC3, 0xE5, 0x15, 0x94, 0x0F, 0xE5, -+0x14, 0x94, 0x00, 0x40, 0x02, 0x41, 0xE4, 0xF1, 0x9B, 0xFF, 0x90, 0xA2, 0x8F, 0xE0, 0x2F, 0xFF, -+0x90, 0xA2, 0x8E, 0xE0, 0x35, 0xF0, 0xFE, 0xF1, 0xCD, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, -+0x00, 0x04, 0x12, 0x07, 0xAB, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0x12, 0xB9, 0xDE, 0xD3, 0xED, 0x9F, -+0xEC, 0x9E, 0x40, 0x15, 0x12, 0xB9, 0x77, 0x12, 0xB8, 0x56, 0x7B, 0x01, 0xF1, 0xF4, 0xE4, 0xFB, -+0x7D, 0x01, 0xAF, 0x0F, 0x12, 0x7E, 0x04, 0x61, 0xF1, 0x12, 0xBA, 0x03, 0x65, 0x15, 0x70, 0x04, -+0xE5, 0xF0, 0x65, 0x14, 0x70, 0x2A, 0x12, 0x4F, 0x40, 0x12, 0x8E, 0xEB, 0xFE, 0xEF, 0x54, 0x3F, -+0xFF, 0xEE, 0x04, 0x54, 0x03, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0x4F, 0xF0, 0x12, 0xB9, 0x77, 0xC3, -+0x12, 0xB8, 0x56, 0x7B, 0x02, 0xF1, 0xF4, 0xE4, 0xFD, 0xAF, 0x0F, 0x12, 0x79, 0x0A, 0x80, 0x0C, -+0x90, 0x9B, 0x91, 0xE0, 0xFF, 0x12, 0x4F, 0xA3, 0x7B, 0x08, 0xF1, 0xF4, 0x12, 0x4F, 0x40, 0x54, -+0x3F, 0xF0, 0x61, 0xF1, 0xE5, 0x0F, 0x70, 0x44, 0xF1, 0x9B, 0xFF, 0xAE, 0xF0, 0xF1, 0xCD, 0x2F, -+0xFD, 0xE5, 0xF0, 0x3E, 0x12, 0xB9, 0xDE, 0xC3, 0xED, 0x9F, 0xEC, 0x9E, 0x50, 0x08, 0x90, 0x9F, -+0x12, 0x74, 0x01, 0xF0, 0x80, 0x26, 0xF1, 0x9B, 0xFB, 0xAA, 0xF0, 0xE5, 0x15, 0xAE, 0x14, 0x78, -+0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x7C, 0x00, 0x7D, 0x05, 0x12, 0x07, 0x03, -+0xD3, 0xEB, 0x9F, 0xEA, 0x9E, 0x40, 0x05, 0xE4, 0x90, 0x9F, 0x12, 0xF0, 0xAB, 0x16, 0xAD, 0x0F, -+0xAF, 0x15, 0xAE, 0x14, 0x12, 0xA5, 0x5F, 0x8E, 0x12, 0x8F, 0x13, 0xF1, 0x8F, 0xD1, 0x8E, 0xC3, -+0x95, 0x13, 0xEE, 0x95, 0x12, 0x50, 0x18, 0x12, 0xB8, 0xD1, 0xF0, 0xE4, 0x90, 0xA4, 0x4A, 0x12, -+0x4F, 0xB1, 0x7B, 0x01, 0xF1, 0xD3, 0x7D, 0x01, 0xAF, 0x0F, 0x12, 0x79, 0x0A, 0x80, 0x36, 0xF1, -+0xE2, 0xF5, 0x83, 0xD3, 0x74, 0x01, 0x93, 0x95, 0x13, 0xE4, 0x93, 0x95, 0x12, 0x40, 0x2C, 0xF1, -+0x8F, 0xF5, 0x83, 0xE4, 0x93, 0xFF, 0x74, 0x01, 0x93, 0x90, 0xA4, 0x48, 0xCF, 0x12, 0xB8, 0xD5, -+0xF0, 0xE4, 0x90, 0xA4, 0x4A, 0x12, 0x4F, 0xB1, 0x7B, 0x02, 0xF1, 0xD3, 0xE4, 0xFB, 0x7D, 0x01, -+0xAF, 0x0F, 0x12, 0x7E, 0x04, 0xD1, 0xBB, 0xE4, 0xF0, 0x80, 0x56, 0xF1, 0x8F, 0xD1, 0x8E, 0xF1, -+0xE2, 0xF5, 0x83, 0xE4, 0x93, 0xFD, 0x74, 0x01, 0x93, 0x90, 0xA4, 0x4A, 0xCD, 0xF0, 0xA3, 0xED, -+0xF0, 0x12, 0xB8, 0xD1, 0xD1, 0xBA, 0xE0, 0xFF, 0x90, 0xA4, 0x4C, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, -+0x7B, 0x03, 0x7A, 0x00, 0xF1, 0xD4, 0xD1, 0xBB, 0xE0, 0x04, 0xD1, 0xBA, 0xE0, 0xC3, 0x94, 0x05, -+0x40, 0x1F, 0xD1, 0xBB, 0xE4, 0xF0, 0xF1, 0xE2, 0xD1, 0x8E, 0xF1, 0x8F, 0xF5, 0x83, 0x74, 0x01, -+0x93, 0x2F, 0xFF, 0xE4, 0x93, 0x3E, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x0F, 0x12, 0x7F, -+0x95, 0xE4, 0xF5, 0x12, 0xF5, 0x13, 0xC1, 0x18, 0xF1, 0xA7, 0xF9, 0x64, 0x05, 0x60, 0x02, 0x81, -+0xBF, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, 0x12, 0x57, 0xB2, 0xF5, 0x19, 0xD1, 0x99, -+0xF5, 0x83, 0xE0, 0xC3, 0x94, 0x30, 0x40, 0x12, 0x12, 0x4F, 0x33, 0xE0, 0x20, 0xE2, 0x0B, 0x12, -+0x4D, 0xBD, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x0E, 0xE4, 0xF5, 0x19, 0xF1, 0xB4, 0xE4, -+0xF0, 0x12, 0xB9, 0x15, 0xE4, 0xF0, 0x80, 0x0C, 0xAD, 0x11, 0xAF, 0x0F, 0x12, 0xA3, 0xE4, 0x12, -+0xB9, 0x15, 0xEF, 0xF0, 0x12, 0xB9, 0x15, 0xE0, 0x64, 0x01, 0x70, 0x6B, 0x12, 0xB9, 0x09, 0xE0, -+0xFF, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xD1, 0x99, 0xF5, 0x83, 0xE0, 0xFE, 0xC3, 0x12, 0x8A, -+0xC5, 0x50, 0x0B, 0x12, 0xB8, 0xFD, 0xE0, 0xFD, 0xE5, 0x11, 0xC3, 0x9D, 0x40, 0x1C, 0xE5, 0x19, -+0x70, 0x05, 0x75, 0x19, 0x01, 0x80, 0x0D, 0xE5, 0x19, 0xB4, 0x01, 0x05, 0x75, 0x19, 0x03, 0x80, -+0x03, 0x75, 0x19, 0x05, 0x12, 0xB9, 0x09, 0xEE, 0x80, 0x22, 0xD1, 0x99, 0xF5, 0x83, 0xE0, 0x24, -+0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xC3, 0xEF, 0x12, 0x8A, 0xC5, 0x50, 0x06, 0xF1, 0xC1, 0xE0, 0xB4, -+0x0A, 0x10, 0xD1, 0x99, 0xF5, 0x83, 0xE0, 0xFF, 0x12, 0xB9, 0x09, 0xEF, 0xF1, 0xC0, 0xE4, 0xF0, -+0x80, 0x05, 0xF1, 0xB4, 0xE0, 0x04, 0xF0, 0x12, 0xB8, 0xFD, 0xE5, 0x11, 0xF0, 0xC1, 0x05, 0xE9, -+0x64, 0x06, 0x60, 0x02, 0xC1, 0x18, 0xF5, 0x12, 0xF5, 0x13, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, -+0x81, 0x01, 0x12, 0x57, 0xB2, 0xF5, 0x19, 0xAF, 0x15, 0xAE, 0x14, 0x12, 0xA5, 0x45, 0x8F, 0x17, -+0xE5, 0x16, 0xD3, 0x94, 0x13, 0x40, 0x1F, 0x90, 0xA2, 0x88, 0x12, 0x48, 0xEA, 0x12, 0x6E, 0x6C, -+0xFD, 0x7C, 0x00, 0xE5, 0x15, 0xAE, 0x14, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, -+0x13, 0xD8, 0xF9, 0xFF, 0x80, 0x19, 0xE5, 0x15, 0xAE, 0x14, 0xA8, 0x17, 0x08, 0x80, 0x05, 0xCE, -+0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x43, 0xB0, 0xE4, 0x93, 0xFD, 0x7C, 0x00, 0x12, -+0x07, 0x03, 0x90, 0xA2, 0x92, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xF5, 0x18, 0xE5, 0x16, 0xD3, -+0x94, 0x13, 0x40, 0x1D, 0x12, 0xA6, 0x53, 0xA8, 0x17, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, -+0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xA2, 0x88, 0x12, 0x48, 0xEA, 0x85, 0x18, 0x82, 0xF1, 0xEE, 0x80, -+0x16, 0x12, 0xA6, 0x53, 0xA8, 0x17, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, -+0xFF, 0xE5, 0x18, 0x90, 0x43, 0xAB, 0x93, 0x12, 0xA6, 0x2C, 0x25, 0x13, 0xF5, 0x13, 0xEE, 0x35, -+0x12, 0xF5, 0x12, 0xC3, 0x90, 0xA2, 0x93, 0xE0, 0x95, 0x13, 0x90, 0xA2, 0x92, 0xE0, 0x95, 0x12, -+0x40, 0x08, 0x05, 0x18, 0xE5, 0x18, 0x64, 0x05, 0x70, 0xA3, 0xE5, 0x18, 0xC3, 0x13, 0xF5, 0x18, -+0xE5, 0x19, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0xFF, 0xD3, 0x95, 0x18, -+0x40, 0x06, 0xEF, 0x95, 0x18, 0xFF, 0x80, 0x02, 0xE4, 0xFF, 0xD1, 0xAE, 0xE0, 0xC3, 0x13, 0xFE, -+0xEF, 0xC4, 0x33, 0x54, 0xE0, 0x2E, 0xFE, 0xD1, 0xAE, 0xEE, 0xF0, 0xD1, 0xAE, 0xE0, 0xC3, 0x94, -+0xC0, 0x40, 0x05, 0xD1, 0xAE, 0x74, 0xC0, 0xF0, 0xD1, 0xAE, 0xE0, 0x24, 0x1F, 0xFF, 0xE4, 0x33, -+0xFE, 0xEF, 0x78, 0x06, 0xCE, 0xA2, 0xE7, 0x13, 0xCE, 0x13, 0xD8, 0xF8, 0x25, 0xE0, 0xFF, 0x70, -+0x04, 0xF5, 0x19, 0x80, 0x04, 0xEF, 0x14, 0xF5, 0x19, 0xD3, 0x90, 0xA2, 0x8F, 0xE0, 0x94, 0x03, -+0x90, 0xA2, 0x8E, 0xE0, 0x94, 0x00, 0x50, 0x0A, 0xD1, 0x99, 0xF5, 0x83, 0xE0, 0xC3, 0x94, 0x30, -+0x50, 0x03, 0xE4, 0xF5, 0x19, 0x12, 0x7B, 0xFD, 0xE0, 0x54, 0xF8, 0x90, 0xA2, 0x94, 0xF0, 0x45, -+0x19, 0xFF, 0xF0, 0x12, 0x7B, 0xFD, 0xEF, 0xF0, 0xF1, 0xA7, 0xD3, 0x94, 0x05, 0x74, 0x92, 0x50, -+0x06, 0xF1, 0xA9, 0x04, 0xF0, 0x80, 0x0B, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, -+0xE4, 0xF0, 0x75, 0x1A, 0x01, 0x7D, 0x01, 0xAF, 0x0F, 0x12, 0x7C, 0x16, 0xE4, 0x90, 0xA4, 0x46, -+0xF0, 0x12, 0x4F, 0xAC, 0xA3, 0xF0, 0x7B, 0x01, 0xFA, 0x7D, 0xFF, 0x7F, 0x01, 0xF1, 0xF9, 0x05, -+0x0F, 0x01, 0x58, 0x22, 0x12, 0x38, 0x07, 0x90, 0xA3, 0x35, 0xE0, 0x75, 0xF0, 0x1E, 0xA4, 0x24, -+0x71, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, -+0x37, 0xBC, 0xE4, 0xFF, 0xFE, 0xEC, 0x54, 0x07, 0xFC, 0x90, 0xA4, 0x14, 0x12, 0x08, 0x6D, 0x90, -+0xA3, 0x35, 0xE0, 0x75, 0xF0, 0x1E, 0xA4, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0xF5, 0x83, -+0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x22, 0xFF, 0x74, 0x11, 0x25, 0x0F, 0xF5, 0x82, 0xE4, -+0x34, 0x9A, 0x22, 0xFF, 0x90, 0xA4, 0x46, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x74, 0x01, -+0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0xF0, 0x74, 0x11, 0x25, 0x0F, 0xF5, -+0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0x22, 0x12, 0x95, 0xEB, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, -+0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x12, 0x96, 0x25, 0x90, 0xA2, -+0xF9, 0xE0, 0xFD, 0x12, 0x97, 0x6A, 0xD1, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x12, 0x90, 0xB0, 0x12, -+0x97, 0x8A, 0x12, 0x4D, 0x14, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x38, 0x07, 0x12, 0x95, 0x85, 0xE0, -+0xC3, 0x94, 0x06, 0x40, 0xD9, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x90, -+0xA4, 0x89, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x7F, 0x2C, 0x7E, 0x08, 0x12, 0xB5, 0xDA, -+0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x80, 0xF1, 0x86, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x00, 0x00, 0x7F, 0x84, 0xF1, 0x86, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x88, 0xF1, -+0x86, 0x12, 0x08, 0x79, 0x3C, 0x00, 0x00, 0x00, 0x7F, 0x8C, 0xF1, 0x86, 0x12, 0x08, 0x79, 0x00, -+0x00, 0x00, 0x00, 0x7F, 0xB8, 0xF1, 0x86, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x80, 0x7F, 0x90, -+0xF1, 0x86, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x94, 0xF1, 0x86, 0x12, 0x08, 0x79, -+0x20, 0x04, 0x00, 0x00, 0x7F, 0xC4, 0xF1, 0x86, 0x12, 0x08, 0x79, 0x20, 0x00, 0x00, 0x00, 0x7F, -+0xC8, 0x7E, 0x0C, 0x02, 0x38, 0x07, 0x7E, 0x0C, 0x12, 0x38, 0x07, 0x90, 0xAA, 0xB9, 0x22, 0xE5, -+0x11, 0x25, 0xE0, 0x24, 0xB3, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x22, 0x90, 0xA2, 0x8B, 0x12, 0x48, -+0xEA, 0x90, 0x00, 0x08, 0x02, 0x07, 0xAB, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, -+0xF5, 0x83, 0xE0, 0x22, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, -+0xF0, 0x74, 0x11, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x22, 0x90, 0x00, 0x06, -+0x02, 0x07, 0xAB, 0xFA, 0x7D, 0x05, 0x7F, 0x01, 0x80, 0x1F, 0x7A, 0x00, 0x7D, 0x01, 0x7F, 0x01, -+0x80, 0x17, 0xE5, 0x11, 0x25, 0xE0, 0x24, 0x5B, 0xF5, 0x82, 0xE4, 0x34, 0x42, 0x22, 0x75, 0x83, -+0x00, 0x02, 0x06, 0xA2, 0xFA, 0x7D, 0x03, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x9F, 0x1A, 0xE0, 0xFE, 0x60, 0x5F, 0xEF, 0x54, 0x1F, 0x60, 0x5A, 0x90, 0xA4, 0x50, 0xEF, -+0xF0, 0xA3, 0xED, 0xF0, 0xEB, 0xA3, 0xF0, 0xEA, 0xA3, 0xF0, 0x90, 0xA4, 0x46, 0xE0, 0xFC, 0xA3, -+0xE0, 0x90, 0xA4, 0x54, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0xA4, 0x48, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, -+0xA4, 0x56, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0xA4, 0x4A, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0xA4, 0x58, -+0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0xA4, 0x4C, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0xA4, 0x5A, 0xF0, 0xEC, -+0xA3, 0xF0, 0x90, 0xA4, 0x4E, 0x74, 0xFE, 0xF0, 0x90, 0xA4, 0x5C, 0x74, 0x0C, 0xF0, 0x7B, 0x01, -+0x7A, 0xA4, 0x79, 0x4E, 0x11, 0x6B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x31, 0x59, 0x7F, 0x04, 0x90, -+0xA5, 0x24, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x47, 0x07, 0x90, 0x9F, 0x13, 0xE0, 0xFF, 0x90, 0xA5, -+0x24, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x9F, 0x13, 0xF0, 0x22, 0x8F, 0x12, 0x90, 0xA2, 0x8C, 0x74, -+0x0E, 0xF0, 0xED, 0x24, 0xFE, 0x60, 0x57, 0x04, 0x60, 0x02, 0x21, 0x4A, 0x51, 0x65, 0x74, 0x0C, -+0xF0, 0x74, 0x11, 0x25, 0x12, 0x12, 0xBA, 0x24, 0xE0, 0x90, 0xA2, 0x8F, 0x31, 0x52, 0x12, 0x4D, -+0xC2, 0xFD, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA2, 0x90, 0xF0, 0xED, 0xB1, 0xA4, 0xA3, 0x31, 0x52, -+0x12, 0x4D, 0xC2, 0xFF, 0xC4, 0x54, 0x03, 0x90, 0xA2, 0x92, 0x31, 0x52, 0xF1, 0xE7, 0xE0, 0x90, -+0xA2, 0x93, 0x31, 0x52, 0xD1, 0x39, 0xE0, 0x90, 0xA2, 0x94, 0x31, 0x52, 0x12, 0x4F, 0x45, 0xFD, -+0xC4, 0x13, 0x54, 0x01, 0x90, 0xA2, 0x95, 0xF0, 0xED, 0x54, 0x1F, 0xA3, 0x80, 0x58, 0x51, 0x65, -+0x74, 0x0D, 0x31, 0x4B, 0x51, 0x76, 0xE0, 0x90, 0xA2, 0x8F, 0x31, 0x4B, 0x90, 0x89, 0x01, 0x12, -+0x48, 0xDE, 0xE0, 0x90, 0xA2, 0x90, 0x31, 0x4B, 0x90, 0x89, 0x02, 0x12, 0x48, 0xDE, 0xE0, 0x90, -+0xA2, 0x91, 0x31, 0x4B, 0x90, 0x89, 0x03, 0x12, 0x48, 0xDE, 0xE0, 0x90, 0xA2, 0x92, 0x31, 0x4B, -+0x12, 0xBA, 0x54, 0x90, 0xA2, 0x93, 0x31, 0x4B, 0x90, 0x89, 0x05, 0x12, 0x48, 0xDE, 0xE0, 0x90, -+0xA2, 0x94, 0x31, 0x4B, 0x90, 0x89, 0x06, 0x12, 0x48, 0xDE, 0xE0, 0x90, 0xA2, 0x95, 0x31, 0x4B, -+0x12, 0xBA, 0x4C, 0x90, 0xA2, 0x96, 0x31, 0xB8, 0x11, 0x6B, 0x22, 0xF0, 0x75, 0xF0, 0x08, 0xE5, -+0x12, 0x22, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x12, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA0, 0xBF, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, -+0x90, 0xA0, 0xC0, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, -+0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x2A, 0xC0, 0x01, 0x90, 0xA0, 0xC0, 0xE0, 0x12, -+0x9F, 0x8F, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x06, 0x63, -+0x90, 0xA0, 0xC0, 0x12, 0x9D, 0x74, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, -+0xA0, 0xC0, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x8C, 0x22, -+0x31, 0xB9, 0x7F, 0xF5, 0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, 0x01, 0x06, 0x90, 0xA2, 0x8C, 0xE0, -+0xA3, 0xF0, 0x31, 0xB9, 0x7F, 0xF6, 0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, 0x01, 0x08, 0x90, 0xA2, -+0x8C, 0xE0, 0x90, 0xA2, 0x8E, 0xF0, 0x31, 0xB9, 0x7F, 0xF4, 0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, -+0x01, 0x08, 0x90, 0xA2, 0x8C, 0xE0, 0x90, 0xA2, 0x8F, 0xF0, 0x31, 0xB9, 0x7F, 0xF3, 0x7E, 0x01, -+0x12, 0x33, 0xFD, 0xBF, 0x01, 0x08, 0x90, 0xA2, 0x8C, 0xE0, 0x90, 0xA2, 0x90, 0xF0, 0x31, 0xB9, -+0x7F, 0xF2, 0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, 0x01, 0x08, 0x90, 0xA2, 0x8C, 0xE0, 0x90, 0xA2, -+0x91, 0xF0, 0x90, 0xA2, 0x8D, 0x12, 0x97, 0x62, 0xFB, 0xA3, 0xE0, 0x90, 0xA2, 0x95, 0xF0, 0x90, -+0xA2, 0x91, 0xE0, 0x90, 0xA2, 0x96, 0xF0, 0x90, 0xA2, 0x97, 0x74, 0x12, 0xF0, 0x90, 0xA2, 0xA5, -+0x74, 0x05, 0xF0, 0x90, 0xA2, 0x99, 0x12, 0x97, 0x81, 0x90, 0xA2, 0x95, 0xE0, 0x90, 0xA2, 0x9C, -+0xF0, 0x90, 0xA2, 0x96, 0xE0, 0x90, 0xA2, 0x9D, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x97, 0x31, -+0x59, 0x7F, 0x04, 0x01, 0x6F, 0x90, 0xA2, 0x9A, 0x74, 0x09, 0xF0, 0x90, 0xA2, 0x8E, 0x22, 0x90, -+0xA5, 0x0E, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x02, 0x48, 0xDE, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x0E, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0x12, 0x4F, 0x45, 0x54, 0x1F, -+0xF5, 0x6F, 0x60, 0x15, 0x64, 0x02, 0x60, 0x11, 0xE5, 0x6F, 0x64, 0x04, 0x60, 0x0B, 0xE5, 0x6F, -+0x64, 0x09, 0x60, 0x05, 0xE5, 0x6F, 0xB4, 0x0C, 0x09, 0xD1, 0x58, 0xF5, 0x83, 0x74, 0x02, 0xF0, -+0x80, 0x07, 0xD1, 0x58, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0xE4, 0xF5, 0x6A, 0x90, 0xA5, 0x0E, 0xE0, -+0xFE, 0x51, 0x73, 0xE5, 0x82, 0x25, 0x6A, 0x12, 0x4F, 0xC9, 0xE0, 0xFF, 0xE5, 0x6F, 0x75, 0xF0, -+0x07, 0xA4, 0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x6A, 0x12, -+0x4F, 0xC9, 0xE4, 0x93, 0xFD, 0xEF, 0x5D, 0x90, 0xA5, 0x10, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x12, -+0x4D, 0xC2, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0B, 0xE5, 0x6A, 0x70, 0x07, 0x90, 0xA5, 0x10, 0xE0, -+0x54, 0xF0, 0xF0, 0x90, 0xA5, 0x10, 0xE0, 0xFF, 0x51, 0x6F, 0xE5, 0x82, 0x25, 0x6A, 0x12, 0x4F, -+0xC9, 0xEF, 0xF0, 0x05, 0x6A, 0xE5, 0x6A, 0x64, 0x07, 0x70, 0xA1, 0x90, 0xA5, 0x0E, 0xE0, 0x75, -+0xF0, 0x04, 0x12, 0x4D, 0xC2, 0xFF, 0xC4, 0x54, 0x03, 0xFD, 0xE4, 0xF5, 0x6D, 0x75, 0x6B, 0x06, -+0xE5, 0x6B, 0xB4, 0x06, 0x08, 0x12, 0x4F, 0xB9, 0xE0, 0x54, 0x0F, 0x80, 0x0A, 0x51, 0x6F, 0xE5, -+0x82, 0x25, 0x6B, 0x12, 0x4F, 0xC9, 0xE0, 0x90, 0xA5, 0x0F, 0xF0, 0x90, 0xA5, 0x0F, 0xE0, 0x60, -+0x38, 0x75, 0x6A, 0x07, 0xD1, 0x47, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xD1, -+0x3F, 0x5B, 0x60, 0x1C, 0xE5, 0x6B, 0x75, 0xF0, 0x08, 0xA4, 0x25, 0x6A, 0xF5, 0x6D, 0xED, 0x60, -+0x25, 0xE5, 0x6D, 0xD3, 0x94, 0x0B, 0x40, 0x1E, 0x74, 0x20, 0x25, 0x6D, 0xF5, 0x6D, 0x80, 0x16, -+0x15, 0x6A, 0xE5, 0x6A, 0xC3, 0x94, 0x00, 0x50, 0xCB, 0xE5, 0x6B, 0x60, 0x09, 0x15, 0x6B, 0xE5, -+0x6B, 0xC3, 0x94, 0x00, 0x50, 0x9A, 0xE4, 0xF5, 0x6E, 0xF5, 0x6B, 0xE5, 0x6B, 0xB4, 0x06, 0x08, -+0x12, 0x4F, 0xB9, 0xE0, 0x54, 0x0F, 0x80, 0x0A, 0x51, 0x6F, 0xE5, 0x82, 0x25, 0x6B, 0x12, 0x4F, -+0xC9, 0xE0, 0x90, 0xA5, 0x0F, 0xF0, 0x90, 0xA5, 0x0F, 0xE0, 0x60, 0x36, 0xE4, 0xF5, 0x6A, 0xD1, -+0x47, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xD1, 0x3F, 0x5B, 0x60, 0x1C, 0xE5, -+0x6B, 0x75, 0xF0, 0x08, 0xA4, 0x25, 0x6A, 0xF5, 0x6E, 0xED, 0x60, 0x1E, 0xE5, 0x6E, 0xD3, 0x94, -+0x0B, 0x40, 0x17, 0x74, 0x20, 0x25, 0x6E, 0xF5, 0x6E, 0x80, 0x0F, 0x05, 0x6A, 0xE5, 0x6A, 0xB4, -+0x08, 0xCD, 0x05, 0x6B, 0xE5, 0x6B, 0x64, 0x07, 0x70, 0xA1, 0x90, 0xA5, 0x0E, 0xE0, 0xFF, 0x75, -+0xF0, 0x04, 0xF1, 0xE7, 0xE5, 0x6D, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0xD1, 0x39, 0xE5, 0x6E, 0xF0, -+0x75, 0xF0, 0x10, 0xEF, 0x12, 0x78, 0xE7, 0xE0, 0xFF, 0x54, 0x7F, 0xF5, 0x6C, 0xEF, 0x54, 0x80, -+0xFF, 0xE5, 0x6C, 0xD3, 0x95, 0x6D, 0x40, 0x04, 0xE5, 0x6D, 0x80, 0x09, 0xE5, 0x6C, 0xC3, 0x95, -+0x6E, 0x50, 0x05, 0xE5, 0x6E, 0x4F, 0xF5, 0x6C, 0x90, 0xA5, 0x0E, 0xE0, 0xFF, 0x24, 0x12, 0x12, -+0xB9, 0x01, 0xE5, 0x6C, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4D, 0xC2, 0xF1, 0xED, 0x90, 0xA5, -+0x0E, 0xE0, 0xFF, 0xE4, 0xFB, 0xAD, 0x6C, 0x12, 0x7A, 0x82, 0x90, 0xA5, 0x0E, 0xE0, 0xFF, 0x75, -+0xF0, 0x10, 0x12, 0x7D, 0x92, 0xE4, 0xF0, 0xE5, 0x6D, 0xC3, 0x94, 0x36, 0x40, 0x07, 0x91, 0xB8, -+0x74, 0x05, 0xF0, 0x80, 0x3E, 0xE5, 0x6D, 0xC3, 0x94, 0x2C, 0x40, 0x07, 0x91, 0xB8, 0x74, 0x04, -+0xF0, 0x80, 0x30, 0xE5, 0x6D, 0xC3, 0x94, 0x14, 0x40, 0x07, 0x91, 0xB8, 0x74, 0x03, 0xF0, 0x80, -+0x22, 0xE5, 0x6D, 0xC3, 0x94, 0x0C, 0x40, 0x07, 0x91, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x14, 0xE5, -+0x6D, 0xC3, 0x94, 0x04, 0x74, 0x91, 0x40, 0x07, 0x91, 0xBA, 0x74, 0x01, 0xF0, 0x80, 0x04, 0x91, -+0xBA, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x91, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x95, -+0xF5, 0x83, 0x22, 0x12, 0x06, 0x89, 0x54, 0x7F, 0xF5, 0x0F, 0xF1, 0x08, 0xFF, 0x54, 0x1F, 0xF5, -+0x11, 0xEF, 0x54, 0x80, 0xB1, 0xA4, 0xF5, 0x10, 0xB1, 0x9A, 0xFF, 0x54, 0x03, 0xF5, 0x12, 0xEF, -+0x54, 0x30, 0xC4, 0x54, 0x0F, 0xF5, 0x15, 0xB1, 0x9A, 0xFF, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, -+0x03, 0xF5, 0x13, 0xEF, 0x54, 0x80, 0xB1, 0xA4, 0xF5, 0x14, 0xB1, 0x9A, 0xFF, 0x54, 0x08, 0xFE, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0xF5, 0x17, 0xEF, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xF5, 0x18, -+0xE5, 0x14, 0xF1, 0xDA, 0x12, 0x4D, 0xBC, 0x54, 0x7F, 0x4F, 0xF0, 0xE5, 0x13, 0x54, 0x01, 0xC4, -+0x33, 0x33, 0x54, 0xC0, 0x12, 0x4D, 0xBC, 0x54, 0xBF, 0x4F, 0xF0, 0xE5, 0x17, 0x70, 0x6A, 0xE5, -+0x11, 0x54, 0x1F, 0x12, 0x4F, 0x3F, 0x54, 0xE0, 0x4F, 0xF0, 0xE5, 0x12, 0x54, 0x03, 0x12, 0x4D, -+0xBC, 0x54, 0xFC, 0x4F, 0xF0, 0xEF, 0x25, 0xE0, 0x25, 0xE0, 0x12, 0x4D, 0xBC, 0x54, 0xF3, 0x4F, -+0xF0, 0xE5, 0x10, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0x12, 0x4F, 0x3F, 0x54, 0xDF, 0x4F, 0xF0, -+0xE5, 0x15, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0x12, 0x4D, 0xBC, 0x54, 0xCF, 0x4F, 0xF0, 0xE4, 0xF5, -+0x16, 0x85, 0x16, 0x82, 0x75, 0x83, 0x00, 0xA3, 0xA3, 0xA3, 0x12, 0x06, 0xA2, 0xFF, 0x75, 0xF0, -+0x08, 0xE5, 0x0F, 0x51, 0x76, 0xE5, 0x82, 0x25, 0x16, 0x12, 0x4F, 0xC9, 0xEF, 0xF0, 0x05, 0x16, -+0xE5, 0x16, 0xB4, 0x04, 0xDC, 0xAF, 0x0F, 0x51, 0x7C, 0x22, 0x90, 0x00, 0x02, 0x02, 0x06, 0xA2, -+0x90, 0xA1, 0xC5, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0xF1, 0xD1, 0xC3, 0x13, 0x54, -+0x0F, 0x90, 0xA2, 0x8C, 0xF0, 0xB1, 0x9A, 0x54, 0x03, 0xFE, 0xF1, 0x08, 0xFD, 0xED, 0xD1, 0x30, -+0x90, 0xA1, 0x5F, 0xD1, 0x4F, 0xB1, 0x9A, 0x7E, 0x00, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, 0x13, -+0xD8, 0xF9, 0x54, 0x3F, 0xFD, 0x12, 0x5F, 0x60, 0x75, 0xF0, 0x40, 0xA4, 0xFF, 0xE5, 0xF0, 0x54, -+0x03, 0xFE, 0xEF, 0x54, 0xC0, 0xD1, 0x2D, 0x90, 0xA1, 0x61, 0xD1, 0x64, 0x54, 0x07, 0xFE, 0xF1, -+0x6D, 0xFD, 0xED, 0xD1, 0x30, 0x90, 0xA1, 0x63, 0xD1, 0x64, 0x7E, 0x00, 0x78, 0x03, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0x54, 0x1F, 0xFD, 0xF1, 0xCB, 0x75, 0xF0, 0x20, 0xA4, 0xFF, 0xE5, -+0xF0, 0x54, 0x07, 0xFE, 0xEF, 0x54, 0xE0, 0xD1, 0x2D, 0x90, 0xA1, 0x65, 0xD1, 0x4F, 0x12, 0x06, -+0x89, 0xF1, 0xDA, 0xFF, 0x90, 0xA1, 0xC6, 0xE0, 0x54, 0x7F, 0x4F, 0xF0, 0x22, 0xFF, 0xEF, 0x4D, -+0xFF, 0x90, 0xA2, 0x8C, 0xE0, 0x75, 0xF0, 0x13, 0x22, 0x90, 0x96, 0x12, 0x02, 0x48, 0xDE, 0xFF, -+0x90, 0xA5, 0x0F, 0xE0, 0xFB, 0xEF, 0x22, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x6A, 0x08, 0x22, 0x12, -+0x48, 0xDE, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0xA5, 0x0E, 0xE0, 0x24, 0x92, 0xF5, 0x82, -+0xE4, 0x34, 0x9E, 0x22, 0x12, 0x48, 0xDE, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x00, 0x05, 0x02, -+0x06, 0xA2, 0x90, 0xA2, 0x8C, 0x74, 0x11, 0xF0, 0x90, 0xA2, 0x9A, 0x74, 0x01, 0xF0, 0x90, 0xA2, -+0x8E, 0xEF, 0x31, 0xB8, 0x31, 0x59, 0x7F, 0x04, 0x01, 0x6F, 0xF1, 0x08, 0x90, 0xA1, 0xD0, 0xF0, -+0xB1, 0x9A, 0x90, 0xA1, 0xD1, 0xF0, 0xD1, 0x9C, 0x7F, 0x01, 0x80, 0xD6, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0xD1, 0xFA, 0x7A, 0xA2, 0x79, 0x8C, 0x12, 0x95, 0x1F, 0x7B, 0x01, 0x7A, 0xA2, -+0x79, 0xC3, 0xF1, 0x00, 0x7A, 0xA2, 0x79, 0xAB, 0x12, 0x95, 0xF5, 0x7B, 0x01, 0x7A, 0xA2, 0x79, -+0xE7, 0xF1, 0x00, 0x7A, 0xA2, 0x79, 0xDB, 0x12, 0x90, 0x77, 0x12, 0xAB, 0x23, 0xE4, 0xFF, 0x12, -+0xAD, 0xB8, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0xDB, 0xE4, 0xFF, 0x12, 0x96, 0x32, 0x7B, 0x01, 0x7A, -+0xA2, 0x79, 0xC3, 0xF1, 0x00, 0x7A, 0xA2, 0x79, 0xAB, 0x12, 0x66, 0xC7, 0xD1, 0xFA, 0x7A, 0xA2, -+0x79, 0x8C, 0x12, 0x95, 0x8C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x8F, -+0x90, 0xA2, 0xF6, 0x02, 0x48, 0xF3, 0x4F, 0xF0, 0x90, 0x00, 0x01, 0x02, 0x06, 0xA2, 0xF1, 0xD1, -+0x90, 0xA1, 0x59, 0xF1, 0x07, 0x90, 0xA1, 0x5A, 0xF0, 0xB1, 0x9A, 0x90, 0xA1, 0x6C, 0x12, 0x5F, -+0x5F, 0x90, 0xA1, 0x6D, 0xF1, 0x6C, 0x90, 0xA1, 0x7F, 0xD1, 0x6B, 0x90, 0xA1, 0x80, 0xF0, 0x22, -+0x12, 0x5F, 0xF8, 0xD1, 0x6C, 0x30, 0xE1, 0x03, 0x02, 0xA6, 0x6A, 0x12, 0x5F, 0x68, 0x12, 0x06, -+0x89, 0x90, 0xA2, 0x8F, 0xF1, 0x07, 0x90, 0xA2, 0x90, 0xF0, 0xB1, 0x9A, 0x90, 0xA2, 0x91, 0xF1, -+0x6C, 0x75, 0xF0, 0x10, 0xA4, 0xFF, 0x12, 0x5F, 0x60, 0xFD, 0xEF, 0x4D, 0xFF, 0x90, 0xA2, 0x90, -+0xE0, 0xB4, 0x01, 0x07, 0xA3, 0xE0, 0x12, 0xA6, 0xE8, 0xEF, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x04, -+0x02, 0x06, 0xA2, 0x90, 0x02, 0x09, 0xE0, 0xF5, 0x0F, 0x12, 0x06, 0x89, 0x25, 0x0F, 0x90, 0x9F, -+0xD0, 0xF1, 0x07, 0x25, 0x0F, 0x90, 0x9F, 0xD1, 0xF0, 0xB1, 0x9A, 0x25, 0x0F, 0x90, 0x9F, 0xD2, -+0x12, 0x5F, 0x5F, 0x25, 0x0F, 0x90, 0x9F, 0xD3, 0xF1, 0x6C, 0x25, 0x0F, 0x90, 0x9F, 0xD4, 0xD1, -+0x6B, 0x25, 0x0F, 0x90, 0x9F, 0xD5, 0xF0, 0xF1, 0xCB, 0x25, 0x0F, 0x90, 0x9F, 0xD6, 0xF0, 0x22, -+0xF1, 0x08, 0xF5, 0x0F, 0xB1, 0x9A, 0xF5, 0x10, 0x12, 0x06, 0x89, 0xF5, 0x11, 0x90, 0x9F, 0x1A, -+0xF0, 0xE5, 0x0F, 0x60, 0x05, 0xFD, 0xAF, 0x10, 0x11, 0x8A, 0x22, 0x90, 0x00, 0x06, 0x02, 0x06, -+0xA2, 0x8B, 0x0F, 0x8A, 0x10, 0x89, 0x11, 0x02, 0x06, 0x89, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, -+0x54, 0x80, 0x22, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x11, 0x02, 0x48, 0xDE, 0x13, 0x13, 0x54, -+0x03, 0xF5, 0x73, 0x22, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -+0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x12, 0x4C, 0x53, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, -+0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, -+0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x12, 0xA0, 0xDB, -+0xE5, 0x5D, 0x30, 0xE1, 0x03, 0x12, 0x9E, 0x03, 0xE5, 0x5D, 0x30, 0xE4, 0x03, 0x12, 0x9C, 0xFB, -+0xE5, 0x5D, 0x30, 0xE5, 0x03, 0x12, 0xA1, 0x38, 0xE5, 0x5D, 0x30, 0xE6, 0x03, 0x12, 0xA1, 0x74, -+0xE5, 0x5F, 0x30, 0xE0, 0x03, 0x12, 0xA1, 0x81, 0xE5, 0x5F, 0x30, 0xE1, 0x02, 0x11, 0xE1, 0xE5, -+0x5F, 0x30, 0xE2, 0x03, 0x12, 0xA2, 0x6C, 0xE5, 0x5F, 0x30, 0xE3, 0x03, 0x12, 0x84, 0xE7, 0xE5, -+0x5F, 0x30, 0xE4, 0x03, 0x12, 0x85, 0x02, 0xE5, 0x5F, 0x30, 0xE5, 0x03, 0x12, 0x8D, 0xAC, 0xE5, -+0x5F, 0x30, 0xE6, 0x03, 0x12, 0xA2, 0x95, 0xE5, 0x60, 0x30, 0xE1, 0x03, 0x12, 0x8F, 0x3D, 0xE5, -+0x60, 0x30, 0xE4, 0x03, 0x12, 0xA2, 0xAE, 0xE5, 0x60, 0x30, 0xE5, 0x02, 0xF1, 0xF2, 0xE5, 0x60, -+0x30, 0xE6, 0x03, 0x12, 0xA2, 0xB3, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, -+0x32, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0xA0, 0xD7, 0x74, 0x01, 0xF0, 0x90, 0xA0, -+0xDF, 0xE0, 0x70, 0x02, 0x21, 0x7C, 0x90, 0xA0, 0xF6, 0xE0, 0x04, 0x31, 0x92, 0x12, 0x48, 0x04, -+0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x31, 0xAC, 0x78, 0x10, 0x12, -+0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x31, 0xAC, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0x90, 0xA1, 0x2A, 0x12, 0x08, 0x6D, 0x90, 0xA0, -+0xDB, 0x12, 0x99, 0xFF, 0x30, 0xE0, 0x0C, 0x12, 0x8B, 0x03, 0x74, 0x05, 0xF0, 0x12, 0x89, 0xFD, -+0x12, 0x8B, 0x23, 0x90, 0xA0, 0xDB, 0x12, 0x8F, 0xD5, 0x30, 0xE0, 0x09, 0x90, 0x01, 0x3B, 0xE0, -+0x30, 0xE4, 0x02, 0xF1, 0x9F, 0x90, 0xA5, 0x26, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x80, 0x40, -+0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x01, 0x12, 0x9C, -+0xFF, 0x90, 0xA1, 0x43, 0xE0, 0x30, 0xE0, 0x09, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x02, 0xF1, -+0x9F, 0x22, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x08, 0x12, 0x08, -+0x5A, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x90, 0x05, 0x60, 0xE0, 0xFF, 0xE4, 0xFC, -+0xFD, 0xFE, 0x22, 0x31, 0x93, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0x05, 0x62, 0x31, 0xAC, 0x78, 0x10, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x31, 0xAC, -+0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0xB9, 0xF3, -+0x90, 0x05, 0x65, 0x31, 0xAC, 0xF1, 0xBE, 0x90, 0x05, 0x64, 0x31, 0xAC, 0x12, 0x48, 0x04, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x66, 0x31, 0xAC, 0x78, 0x10, 0x12, 0x08, -+0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x31, 0xAC, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0xF1, 0xB5, 0x90, 0xA1, 0xC5, 0xE0, 0xFF, 0x12, 0x6D, 0xA4, 0x30, 0xE0, -+0x41, 0xF1, 0x99, 0xE4, 0xFB, 0xFA, 0xF9, 0xEC, 0x54, 0x80, 0xF8, 0x90, 0xA1, 0xBC, 0x12, 0x48, -+0xC6, 0xE4, 0xFF, 0xFE, 0xFD, 0xEC, 0x54, 0x80, 0xFC, 0xC3, 0x12, 0x48, 0x27, 0x60, 0x23, 0xF1, -+0x91, 0xEF, 0x54, 0x01, 0xFB, 0xE4, 0xF8, 0x90, 0xA1, 0xC0, 0x12, 0x48, 0xC6, 0xEF, 0x54, 0x01, -+0xFF, 0xE4, 0xFE, 0xFD, 0xFC, 0xC3, 0x12, 0x48, 0x27, 0x70, 0x07, 0x90, 0xA1, 0xC6, 0xE0, 0x44, -+0x20, 0xF0, 0xF1, 0x99, 0x90, 0xA1, 0xBC, 0x12, 0x08, 0x6D, 0xF1, 0x91, 0x90, 0xA1, 0xC0, 0x12, -+0x08, 0x6D, 0x90, 0xA1, 0xC6, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x02, 0x61, 0xCA, 0x12, -+0x6D, 0xA0, 0x20, 0xE0, 0x02, 0x61, 0xCA, 0x12, 0x99, 0xE2, 0x90, 0x05, 0xCF, 0xE0, 0x54, 0xEF, -+0xF0, 0x90, 0xA1, 0xC8, 0x31, 0xAC, 0xB1, 0x31, 0x90, 0x05, 0xE4, 0xEF, 0xF0, 0xB1, 0x3F, 0x78, -+0x08, 0x12, 0x08, 0x47, 0x90, 0x05, 0xE5, 0xEF, 0xF0, 0xB1, 0x3F, 0x78, 0x10, 0x12, 0x08, 0x47, -+0x90, 0x05, 0xE6, 0xEF, 0xF0, 0xB1, 0x3F, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0x05, 0xE7, 0xEF, -+0xF0, 0x90, 0xA1, 0x69, 0x31, 0xAC, 0xB1, 0x31, 0x90, 0x05, 0xE0, 0xEF, 0xF0, 0xB1, 0x3F, 0x78, -+0x08, 0x12, 0x08, 0x47, 0x90, 0x05, 0xE1, 0xEF, 0xF0, 0xB1, 0x3F, 0x78, 0x10, 0x12, 0x08, 0x47, -+0x90, 0x05, 0xE2, 0xEF, 0xF0, 0xB1, 0x3F, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0x05, 0xE3, 0xEF, -+0x31, 0x92, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, -+0x31, 0xAC, 0x78, 0x10, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -+0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x31, 0xAC, 0x78, 0x18, 0x12, -+0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0x90, 0xA3, 0x4B, -+0x12, 0x08, 0x6D, 0x90, 0xA3, 0x4B, 0x12, 0x48, 0xD2, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, -+0x03, 0x90, 0xA1, 0xC7, 0xE0, 0xFF, 0xEF, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0xE4, 0x33, 0xFD, -+0xE4, 0x33, 0xFC, 0xE4, 0xFB, 0x7A, 0x04, 0xF9, 0xF8, 0x12, 0x47, 0xA8, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x8D, 0xB1, 0x39, 0x90, 0x05, 0xE8, 0xEF, 0xF0, 0xB1, 0x3F, -+0x78, 0x08, 0x12, 0x08, 0x47, 0x90, 0x05, 0xE9, 0xEF, 0xF0, 0xB1, 0x3F, 0x78, 0x10, 0x12, 0x08, -+0x47, 0x90, 0x05, 0xEA, 0xEF, 0xF0, 0xB1, 0x3F, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0x05, 0xEB, -+0xEF, 0xF0, 0x90, 0xA1, 0xC9, 0xE0, 0x90, 0x05, 0xEC, 0xF0, 0x90, 0x05, 0x53, 0x74, 0x10, 0xF0, -+0x90, 0x05, 0x27, 0xE0, 0x44, 0x12, 0x12, 0x9A, 0xEC, 0xF0, 0x90, 0xA1, 0xC6, 0xE0, 0xFF, 0x54, -+0x1F, 0x70, 0x02, 0xA1, 0x30, 0xEF, 0x54, 0xE0, 0xFE, 0xEF, 0x14, 0x54, 0x1F, 0x4E, 0xF0, 0x54, -+0x1F, 0x60, 0x02, 0xA1, 0x30, 0x90, 0x05, 0x22, 0xE0, 0x44, 0x40, 0x12, 0xAB, 0x94, 0xF0, 0x90, -+0x05, 0x69, 0x31, 0xAC, 0xF1, 0xBE, 0x90, 0x05, 0x68, 0x31, 0xAC, 0x12, 0x48, 0x04, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x6A, 0x31, 0xAC, 0x78, 0x10, 0x12, 0x08, 0x5A, -+0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0xA3, 0x31, 0xAC, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -+0x01, 0xD0, 0x00, 0x12, 0xB9, 0xF3, 0xF1, 0x99, 0x90, 0xA3, 0x4B, 0x12, 0x08, 0x6D, 0x90, 0x05, -+0x6D, 0x31, 0xAC, 0xF1, 0xBE, 0x90, 0x05, 0x6C, 0x31, 0xAC, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x6E, 0x31, 0xAC, 0x78, 0x10, 0x12, 0x08, 0x5A, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0xA3, 0x31, 0xAC, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0xF1, 0xB5, 0x90, 0xA3, 0x43, 0x12, 0x48, 0xD2, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, -+0xC0, 0x03, 0x90, 0xA1, 0xC5, 0xE0, 0x54, 0x7F, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0xFB, 0x7A, 0x04, -+0xF9, 0xF8, 0x12, 0x47, 0xA8, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x8D, -+0x90, 0xA3, 0x43, 0xB1, 0x3C, 0x90, 0xA3, 0x43, 0x12, 0x8B, 0x14, 0x50, 0x0D, 0xF1, 0x91, 0x12, -+0x9F, 0x7E, 0xE4, 0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0xF1, 0xB8, 0xF1, 0x99, 0x90, 0x05, 0x60, 0xF1, -+0x97, 0x78, 0x08, 0x12, 0x08, 0x47, 0x90, 0x05, 0x61, 0xEF, 0xF0, 0x90, 0xA3, 0x43, 0xF1, 0xEA, -+0x90, 0x05, 0x62, 0xF1, 0x97, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0x05, 0x63, 0xF1, 0x8F, 0x90, -+0x05, 0x64, 0xF1, 0x8F, 0x78, 0x08, 0x12, 0x08, 0x47, 0x90, 0x05, 0x65, 0xEF, 0xF0, 0x90, 0xA3, -+0x47, 0xF1, 0xEA, 0x90, 0x05, 0x66, 0xF1, 0x8F, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0x05, 0x67, -+0xEF, 0xF0, 0x90, 0x05, 0x50, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x54, 0xBF, 0xF0, -+0x90, 0xA1, 0xC6, 0xE0, 0x54, 0xE0, 0x44, 0x14, 0xF0, 0x90, 0xA1, 0xC5, 0xE0, 0x44, 0x80, 0xF0, -+0x22, 0xFB, 0x7A, 0x04, 0xF9, 0xF8, 0x12, 0x47, 0xA8, 0x90, 0xA3, 0x4B, 0x12, 0x08, 0x6D, 0x90, -+0xA3, 0x4B, 0x02, 0x48, 0xC6, 0x90, 0xA4, 0xD2, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x34, 0x7E, 0x08, 0x12, 0x37, 0xBC, 0x90, 0xA4, 0xD4, 0x12, -+0x08, 0x6D, 0x90, 0xA4, 0xD2, 0xE0, 0x14, 0x60, 0x5E, 0x14, 0x70, 0x02, 0xC1, 0x86, 0x24, 0x02, -+0x60, 0x02, 0xE1, 0x15, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA4, -+0x89, 0x12, 0x08, 0x79, 0x00, 0x30, 0x02, 0x00, 0xF1, 0x85, 0x12, 0x08, 0x79, 0x40, 0x00, 0x00, -+0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xC4, 0xF1, 0x87, 0x12, -+0x08, 0x79, 0x00, 0x1C, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x10, 0x00, 0x00, -+0x7F, 0x64, 0xF1, 0x87, 0x12, 0x08, 0x79, 0x03, 0xC0, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, -+0x79, 0x02, 0x00, 0x00, 0x00, 0xC1, 0xF8, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x00, 0x30, 0x03, -+0xC3, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x30, 0x02, 0x01, 0xF1, 0x85, 0x12, 0x08, 0x79, -+0x40, 0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xC4, -+0xF1, 0x87, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x3C, 0x90, 0xA4, 0xD3, 0x31, 0xAC, 0xF1, 0x7A, -+0x12, 0x08, 0x79, 0xF0, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xD3, 0x31, 0xAC, 0x12, 0xAA, 0x34, 0x7F, -+0x38, 0xF1, 0x87, 0x12, 0x08, 0x79, 0x00, 0x1C, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, -+0x00, 0x08, 0x00, 0x00, 0xF1, 0xCC, 0x60, 0x13, 0x12, 0x08, 0x79, 0x03, 0xC0, 0x00, 0x00, 0x90, -+0xA4, 0x89, 0x12, 0x08, 0x79, 0x01, 0x80, 0x00, 0x00, 0x80, 0x11, 0x12, 0x08, 0x79, 0x03, 0xC0, -+0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x02, 0x00, 0x00, 0x00, 0x7F, 0x48, 0x7E, 0x08, -+0xF1, 0x1A, 0x90, 0xA4, 0xD3, 0xE0, 0x90, 0xA4, 0x85, 0xB4, 0x01, 0x13, 0x12, 0x08, 0x79, 0x00, -+0x00, 0x00, 0x10, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x10, 0x80, 0x11, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x00, 0x10, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, -+0x7F, 0x00, 0x7E, 0x0A, 0xE1, 0x13, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x00, 0x30, 0x03, 0xC3, -+0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x30, 0x02, 0x02, 0xF1, 0x85, 0x12, 0x08, 0x79, 0x40, -+0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x40, 0x00, 0x00, 0x00, 0x7F, 0xC4, 0xF1, -+0x87, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x3C, 0x90, 0xA4, 0xD3, 0x31, 0xAC, 0xF1, 0x7A, 0x12, -+0x08, 0x79, 0xF0, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xD3, 0x31, 0xAC, 0x12, 0xAA, 0x34, 0x7F, 0x38, -+0xF1, 0x87, 0x12, 0x08, 0x79, 0x00, 0x1C, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, -+0x08, 0x00, 0x00, 0xF1, 0xCC, 0x60, 0x17, 0x12, 0x08, 0x79, 0x03, 0xC0, 0x00, 0x00, 0x90, 0xA4, -+0x89, 0x12, 0x08, 0x79, 0x01, 0x40, 0x00, 0x00, 0x7F, 0x48, 0x7E, 0x08, 0x80, 0x15, 0x12, 0x08, -+0x79, 0x03, 0xC0, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x01, 0xC0, 0x00, 0x00, 0x7F, -+0x48, 0x7E, 0x08, 0xF1, 0x1A, 0x22, 0x7F, 0x04, 0x7E, 0x0A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA4, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x37, 0xBC, 0x90, 0xA4, 0x8D, 0x12, -+0x08, 0x6D, 0x90, 0xA4, 0x85, 0x12, 0x48, 0xC6, 0x12, 0x08, 0x3A, 0x90, 0xA4, 0x8D, 0xF1, 0xE4, -+0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA4, 0x85, 0x12, 0x48, 0xC6, 0x90, 0xA4, -+0x89, 0xF1, 0xE4, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0x90, 0xA4, -+0x91, 0x12, 0x08, 0x6D, 0x90, 0xA4, 0x91, 0x12, 0x4D, 0x12, 0x90, 0xA4, 0x83, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x12, 0x38, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x78, 0x02, 0x12, 0x08, 0x5A, 0x90, -+0xA4, 0x89, 0x12, 0x08, 0x6D, 0x7F, 0xAC, 0x7E, 0x08, 0xF1, 0x1A, 0x90, 0xA4, 0x85, 0x22, 0xEF, -+0xF0, 0x90, 0xA3, 0x47, 0x02, 0x48, 0xC6, 0xEF, 0xF0, 0x90, 0xA3, 0x43, 0x02, 0x48, 0xC6, 0x7D, -+0x02, 0x7F, 0x02, 0xF1, 0xA9, 0x7D, 0x01, 0x7F, 0x02, 0x74, 0x59, 0x12, 0xBA, 0x44, 0xFE, 0xF6, -+0x74, 0x30, 0x02, 0x82, 0x02, 0x12, 0x48, 0x04, 0x90, 0xA3, 0x47, 0x02, 0x08, 0x6D, 0x78, 0x08, -+0x12, 0x08, 0x5A, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, 0x7F, 0x64, 0x7E, 0x08, -+0xF1, 0x1A, 0x90, 0xA4, 0xD4, 0x12, 0x48, 0xC6, 0xE4, 0xFF, 0xFE, 0xFD, 0xEC, 0x54, 0x04, 0xFC, -+0x90, 0xA4, 0x85, 0x22, 0x12, 0x48, 0xD2, 0x02, 0x47, 0xF7, 0x12, 0x48, 0xC6, 0x78, 0x10, 0x02, -+0x08, 0x47, 0xE4, 0xF5, 0x22, 0x90, 0xA0, 0xD4, 0xE0, 0xFF, 0xE5, 0x22, 0xC3, 0x9F, 0x40, 0x02, -+0x01, 0xC9, 0xAF, 0x22, 0x12, 0x82, 0x72, 0xEF, 0x70, 0x02, 0x01, 0xC4, 0xE5, 0x22, 0xF1, 0xBA, -+0xE5, 0x22, 0x54, 0x07, 0xFE, 0x74, 0x81, 0x2F, 0x91, 0x0E, 0xE0, 0xFD, 0xAF, 0x06, 0xF1, 0xD2, -+0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x01, 0xC4, -+0x75, 0xF0, 0x10, 0xE5, 0x22, 0x91, 0x02, 0xE0, 0x20, 0xE7, 0x02, 0x80, 0x10, 0x75, 0xF0, 0x10, -+0xE5, 0x22, 0x90, 0x81, 0x02, 0x12, 0x48, 0xDE, 0xE0, 0xFF, 0x20, 0xE7, 0x09, 0x90, 0x01, 0xC1, -+0xE0, 0x44, 0x20, 0xF0, 0x80, 0x6E, 0xEF, 0x30, 0xE6, 0x23, 0x11, 0xED, 0xE4, 0x12, 0x4F, 0xB0, -+0x7B, 0x01, 0xFA, 0x7D, 0x01, 0x7F, 0x10, 0x12, 0x67, 0xF9, 0x75, 0xF0, 0x10, 0xE5, 0x22, 0x11, -+0xE7, 0x11, 0xD6, 0x12, 0x4D, 0xC2, 0x12, 0x6F, 0xED, 0xE4, 0xFB, 0x80, 0x43, 0x11, 0xCA, 0xE0, -+0x04, 0xF0, 0x11, 0xED, 0x74, 0x92, 0x25, 0x22, 0x71, 0xF5, 0xE0, 0xFF, 0x90, 0xA4, 0x4A, 0xE4, -+0x12, 0xB8, 0x87, 0x7B, 0x01, 0xFA, 0x7D, 0x02, 0x7F, 0x10, 0x12, 0x67, 0xF9, 0x11, 0xCA, 0xE0, -+0xD3, 0x94, 0x01, 0x40, 0x0A, 0xAF, 0x22, 0xB1, 0xC4, 0x11, 0xCA, 0xE4, 0xF0, 0x80, 0x15, 0x75, -+0xF0, 0x10, 0xE5, 0x22, 0x11, 0xE7, 0x11, 0xD6, 0x12, 0x4D, 0xC2, 0x12, 0x6F, 0xED, 0x7B, 0x01, -+0xAF, 0x22, 0x51, 0x82, 0x05, 0x22, 0x02, 0x77, 0xF5, 0x22, 0x74, 0x92, 0x25, 0x22, 0xF5, 0x82, -+0xE4, 0x34, 0x9D, 0xF5, 0x83, 0x22, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x22, 0x22, 0x90, 0xA2, -+0x91, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x00, 0x02, 0x48, 0xDE, 0x90, 0xA4, 0x46, -+0xE4, 0xF0, 0xA3, 0xE5, 0x22, 0xF0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, -+0xFF, 0x90, 0xA4, 0x48, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x8F, 0x1C, 0x8D, 0x1D, 0x74, 0x92, -+0x2F, 0x71, 0xF5, 0x74, 0xFF, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x11, 0xE7, 0xE0, 0xF5, 0x1E, 0x54, -+0x7F, 0xFC, 0xE5, 0x1E, 0x54, 0x80, 0xF5, 0x1F, 0x12, 0x6F, 0xE3, 0xE0, 0xF5, 0x21, 0x75, 0xF0, -+0x04, 0xEF, 0x12, 0x4D, 0xC2, 0xC4, 0x54, 0x03, 0xFB, 0xEC, 0x12, 0x67, 0x91, 0x12, 0x66, 0x8E, -+0xE5, 0x1C, 0xF1, 0x95, 0x74, 0x12, 0x25, 0x1C, 0xB1, 0xBC, 0xE5, 0x1E, 0xF0, 0x75, 0xF0, 0x04, -+0xE5, 0x1C, 0x12, 0x4D, 0xC2, 0x13, 0x13, 0x54, 0x03, 0xF5, 0x20, 0x74, 0x12, 0x25, 0x1C, 0xF1, -+0xC8, 0xE5, 0x20, 0xF0, 0xEC, 0x64, 0x2D, 0x70, 0x2E, 0x75, 0xF0, 0x04, 0xE5, 0x1C, 0x12, 0x4D, -+0xC2, 0xFF, 0x54, 0x03, 0xFE, 0xE5, 0x20, 0xC3, 0x9E, 0x50, 0x1C, 0x75, 0x1E, 0x2C, 0x05, 0x20, -+0xE5, 0x20, 0xF1, 0xC1, 0xFE, 0x75, 0xF0, 0x04, 0xE5, 0x1C, 0x90, 0x96, 0x14, 0x12, 0x48, 0xDE, -+0xEF, 0x54, 0xF3, 0x4E, 0xF0, 0x41, 0x54, 0xBC, 0x2C, 0x05, 0x75, 0x1E, 0x2D, 0x41, 0x54, 0xEC, -+0xC3, 0x95, 0x21, 0x50, 0x65, 0xAF, 0x03, 0xAD, 0x04, 0xF1, 0xA6, 0xAC, 0x07, 0xAF, 0x03, 0xAD, -+0x21, 0xF1, 0xA6, 0x8F, 0x21, 0xEC, 0x04, 0xFD, 0xED, 0xD3, 0x95, 0x21, 0x50, 0x33, 0xED, 0xF1, -+0xBA, 0x75, 0xF0, 0x08, 0xE5, 0x1C, 0x12, 0x4F, 0xC1, 0xE0, 0xF5, 0x82, 0x75, 0x83, 0x00, 0xED, -+0x54, 0x07, 0xF1, 0xD1, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x55, -+0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, 0x60, 0x06, 0xAC, 0x05, 0x8C, 0x1E, 0x80, 0x03, 0x0D, 0x80, -+0xC7, 0xAF, 0x03, 0xAD, 0x1E, 0xF1, 0xDA, 0x8F, 0x1E, 0x71, 0xF1, 0xE0, 0xFD, 0xF4, 0x60, 0x54, -+0xAF, 0x03, 0xF1, 0xDA, 0x71, 0xF1, 0xEF, 0xF0, 0x80, 0x4A, 0xEC, 0x65, 0x21, 0x70, 0x3A, 0x75, -+0xF0, 0x04, 0xE5, 0x1C, 0x12, 0x4F, 0x45, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0C, 0xE5, 0x1E, -+0x20, 0xE7, 0x07, 0xEC, 0x44, 0x80, 0xF5, 0x1E, 0x80, 0x2A, 0xE5, 0x1C, 0x12, 0xA6, 0x20, 0x12, -+0xB9, 0x84, 0xF0, 0xB1, 0xA2, 0xE5, 0x1C, 0xF0, 0xE4, 0x90, 0xA4, 0x4A, 0x12, 0x4F, 0xB1, 0x7B, -+0x01, 0xFA, 0x7D, 0x02, 0x7F, 0x04, 0x02, 0x67, 0xF9, 0x74, 0x12, 0x25, 0x1C, 0xB1, 0xBC, 0xE5, -+0x21, 0xF0, 0xF5, 0x1E, 0xB1, 0xA2, 0xE5, 0x1E, 0xF0, 0x74, 0x92, 0x25, 0x1C, 0xF5, 0x82, 0xE4, -+0x34, 0x9B, 0x11, 0xFD, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x20, 0x12, 0xBA, 0x5C, 0xF0, 0x7B, 0x01, -+0x7A, 0x00, 0x7D, 0x05, 0x7F, 0x04, 0x12, 0x67, 0xF9, 0x85, 0x20, 0x73, 0xAB, 0x1D, 0xAD, 0x1E, -+0xAF, 0x1C, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x70, 0x8D, 0x71, 0x8B, 0x72, 0xE4, -+0x90, 0xA4, 0xBB, 0xF0, 0xE5, 0x70, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA4, 0xB6, 0xF0, 0xE5, -+0x70, 0x54, 0x07, 0x90, 0xA4, 0xB8, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x91, 0x02, 0xE0, 0x90, 0xA4, -+0xB9, 0xF0, 0x12, 0x6F, 0xE3, 0xE0, 0x54, 0x7F, 0x90, 0xA4, 0xBC, 0xF0, 0x75, 0xF0, 0x04, 0xE5, -+0x70, 0x12, 0x6E, 0x39, 0xE0, 0x90, 0xA4, 0xBD, 0xF0, 0xB1, 0xB1, 0xF0, 0xE5, 0x72, 0x70, 0x30, -+0x90, 0xA4, 0x60, 0xF0, 0xFB, 0xAF, 0x70, 0x12, 0xA4, 0xD7, 0x90, 0xA4, 0xB7, 0xE0, 0xFF, 0x12, -+0x67, 0xE4, 0x12, 0x96, 0xD2, 0xFD, 0xEF, 0x12, 0x67, 0x91, 0xF5, 0x83, 0x74, 0x01, 0x93, 0x2D, -+0xFF, 0xE4, 0x93, 0x3C, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x70, 0xF1, 0x95, 0x80, 0x1A, -+0xE5, 0x72, 0xB4, 0x01, 0x15, 0x90, 0x9F, 0x1A, 0xE0, 0x60, 0x0F, 0x90, 0xA4, 0x60, 0x74, 0x05, -+0xF0, 0xE4, 0xFB, 0xAD, 0x71, 0xAF, 0x70, 0x12, 0xA4, 0xD7, 0x90, 0xA4, 0xBC, 0xE0, 0xFF, 0x90, -+0xA4, 0xB7, 0xE0, 0xFE, 0xD3, 0x9F, 0x40, 0x0B, 0xE5, 0x71, 0x54, 0x80, 0xFD, 0xEF, 0x4D, 0xF5, -+0x71, 0x80, 0x0C, 0x90, 0xA4, 0xBD, 0xE0, 0xFF, 0xEE, 0xC3, 0x9F, 0x50, 0x02, 0x8F, 0x71, 0xB1, -+0xB1, 0xF0, 0xE5, 0x71, 0x54, 0x80, 0x90, 0xA4, 0xBA, 0xF0, 0xE5, 0x72, 0x70, 0x1F, 0x91, 0x08, -+0xC0, 0x83, 0xC0, 0x82, 0x12, 0x9D, 0x0E, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xD0, -+0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA4, 0xB9, 0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x3B, 0x91, 0x08, 0xC0, -+0x83, 0xC0, 0x82, 0x12, 0x9D, 0x0E, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xD0, 0x82, 0xD0, -+0x83, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x70, 0x90, 0x81, 0x01, 0x12, 0x57, 0xB2, 0xFF, 0x90, 0xA4, -+0xB9, 0xF0, 0x90, 0xA4, 0xB7, 0xE0, 0x90, 0x43, 0x03, 0x93, 0xFE, 0x33, 0x33, 0x33, 0x54, 0xF8, -+0x4F, 0x90, 0xA4, 0xB9, 0xF0, 0x44, 0x80, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x70, 0x11, 0xE7, 0xE5, -+0x71, 0xF0, 0xE5, 0x70, 0x70, 0x06, 0x90, 0x01, 0xC8, 0xE5, 0x71, 0xF0, 0x90, 0xA4, 0xB9, 0xE0, -+0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x70, 0x91, 0x02, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x70, 0x12, -+0x8B, 0xD5, 0xE0, 0x54, 0xFC, 0xFF, 0xE5, 0x73, 0x54, 0x03, 0x4F, 0xFF, 0x75, 0xF0, 0x10, 0xE5, -+0x70, 0x12, 0x8B, 0xD5, 0xEF, 0xF0, 0x7D, 0x01, 0xAF, 0x70, 0x91, 0x16, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x74, 0x92, 0x25, 0x1C, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x10, -+0xE5, 0x0F, 0x90, 0x81, 0x01, 0x02, 0x48, 0xDE, 0x90, 0xA4, 0xB6, 0xE0, 0x24, 0x81, 0xF5, 0x82, -+0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x42, -+0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x01, 0x91, 0x7D, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, -+0x03, 0x91, 0x7D, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x05, 0x91, 0x7D, 0xF0, 0x75, 0xF0, -+0x0A, 0xEF, 0x90, 0x8D, 0x07, 0x91, 0x7D, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x09, 0x91, -+0x7D, 0xF0, 0xEF, 0x12, 0xB8, 0xC5, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x91, 0x2F, 0x12, 0xB8, 0xE7, -+0xE4, 0xF0, 0xB1, 0x8E, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0xB1, 0x8E, 0xEE, 0xF0, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0x8D, 0x01, 0x12, 0x48, 0xDE, 0x75, 0xF0, 0x02, 0xEF, 0x12, 0x48, 0xDE, -+0xE4, 0xF0, 0xA3, 0x22, 0x90, 0xA3, 0x61, 0xEF, 0xF0, 0x90, 0xA0, 0xD4, 0xE0, 0x90, 0xA3, 0xE3, -+0xF0, 0xE4, 0x90, 0xA3, 0x62, 0xF0, 0x90, 0xA3, 0xE3, 0xE0, 0xFE, 0x90, 0xA3, 0x62, 0xE0, 0xFF, -+0xC3, 0x9E, 0x50, 0x2C, 0xE0, 0xFE, 0xB1, 0x98, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xEE, 0xB1, 0x92, -+0xE0, 0x30, 0xE7, 0x09, 0x74, 0x81, 0x2F, 0xB1, 0xA9, 0xE4, 0xF0, 0x80, 0x0B, 0xF1, 0xED, 0x90, -+0xA3, 0x62, 0xE0, 0xB1, 0x98, 0x74, 0x01, 0xF0, 0x90, 0xA3, 0x62, 0xE0, 0x04, 0xF0, 0x80, 0xC6, -+0x7F, 0x0C, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xE4, 0x90, 0xA3, 0x62, 0xF0, 0x90, 0xA3, 0xE3, 0xE0, -+0xFF, 0x90, 0xA3, 0x62, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0xA1, 0x8D, 0x74, 0x63, 0x2E, 0xB1, -+0x9A, 0xE0, 0x70, 0x02, 0xA1, 0x85, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x06, 0x12, 0x48, 0xDE, -+0xE0, 0xFD, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x07, 0x12, 0xB9, 0xA8, 0xFC, 0x25, 0xE0, 0x24, -+0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF1, 0x9E, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x0A, 0x12, -+0x48, 0xDE, 0xE0, 0xFD, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x0B, 0x12, 0xB9, 0xA8, 0x75, 0xF0, -+0x0A, 0x90, 0x8D, 0x01, 0x12, 0x6E, 0x4F, 0x7F, 0x01, 0x90, 0xA3, 0x62, 0xE0, 0xFE, 0x75, 0xF0, -+0x10, 0x90, 0x81, 0x0B, 0x12, 0x4F, 0xC4, 0xE0, 0xFD, 0x75, 0xF0, 0x0A, 0xEE, 0x91, 0x73, 0xED, -+0xF0, 0x0F, 0xEF, 0xB4, 0x05, 0xE3, 0x90, 0xA3, 0x62, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0x90, 0x81, -+0x09, 0x12, 0x48, 0xDE, 0xE0, 0xFE, 0x74, 0x91, 0x2F, 0x12, 0xB8, 0xE7, 0xEE, 0xF0, 0x90, 0xA3, -+0x62, 0xE0, 0xFF, 0x90, 0xA3, 0x61, 0xE0, 0xFD, 0x91, 0x16, 0x90, 0xA3, 0x62, 0xE0, 0x24, 0x81, -+0xB1, 0xA9, 0x74, 0x01, 0xF0, 0x90, 0xA3, 0x62, 0xE0, 0x04, 0xF0, 0x81, 0xDC, 0x22, 0x75, 0xF0, -+0x10, 0xEF, 0x90, 0x81, 0x03, 0x02, 0x48, 0xDE, 0x24, 0x63, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, -+0x83, 0x22, 0x90, 0xA4, 0x46, 0xE4, 0xF0, 0xA3, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0x22, 0xE5, 0x71, 0x54, 0x7F, 0x90, 0xA4, 0xB7, 0x22, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x9E, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4D, 0xC2, 0xF9, 0x12, 0x6F, 0xE3, 0xE0, -+0xFC, 0xB1, 0xB9, 0xE0, 0x54, 0x7F, 0xFD, 0x74, 0x12, 0x2F, 0xF1, 0xC8, 0xE0, 0xFE, 0xF1, 0xC1, -+0xFB, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x14, 0x12, 0x48, 0xDE, 0xE9, 0x54, 0xF3, 0x4B, 0xF0, -+0xED, 0xD3, 0x9C, 0x40, 0x02, 0xAD, 0x04, 0xB1, 0xB9, 0xE0, 0x54, 0x80, 0x42, 0x05, 0x8E, 0x73, -+0xE4, 0xFB, 0x41, 0x82, 0x90, 0xA2, 0x98, 0xEB, 0xF0, 0xA9, 0x05, 0x90, 0xA2, 0x97, 0xEF, 0xF0, -+0xFD, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x11, 0xE7, 0xE0, 0xF5, 0x1C, 0x54, 0x7F, 0xF5, 0x1E, 0x75, -+0xF0, 0x04, 0xEE, 0x12, 0x6E, 0x39, 0xE0, 0xFA, 0x12, 0xBA, 0x64, 0x12, 0x6F, 0xE7, 0xE0, 0xFC, -+0x75, 0xF0, 0x04, 0xEE, 0x12, 0x4D, 0xC2, 0x13, 0x13, 0x54, 0x03, 0xF5, 0x1D, 0xE5, 0x1E, 0x12, -+0x67, 0xE4, 0x12, 0x66, 0x8E, 0xED, 0xF1, 0x95, 0x75, 0xF0, 0x04, 0xED, 0x12, 0x4D, 0xC2, 0xC4, -+0x54, 0x03, 0x90, 0xA2, 0x99, 0xF0, 0x74, 0x12, 0x2D, 0xB1, 0xBC, 0xE5, 0x1E, 0xF0, 0x74, 0x12, -+0x2D, 0xF1, 0xC8, 0xE5, 0x1D, 0xF0, 0xE5, 0x1E, 0xD3, 0x9C, 0x40, 0x06, 0x8C, 0x1E, 0xAF, 0x04, -+0x8F, 0x1C, 0xE9, 0x70, 0x02, 0xE1, 0x68, 0xAF, 0x01, 0x8F, 0x1F, 0xE5, 0x1C, 0x30, 0xE7, 0x05, -+0x85, 0x1E, 0x1C, 0x15, 0x1F, 0xE5, 0x1F, 0x70, 0x02, 0xE1, 0x68, 0x90, 0xA2, 0x97, 0xE0, 0xFF, -+0xAD, 0x1C, 0x12, 0xA3, 0xB8, 0xEF, 0xF4, 0x60, 0x0A, 0x8F, 0x1C, 0x15, 0x1F, 0xE5, 0x1F, 0x70, -+0x02, 0xE1, 0x68, 0xE5, 0x1C, 0x64, 0x2C, 0x70, 0x27, 0xE5, 0x1D, 0xD3, 0x94, 0x00, 0x40, 0x20, -+0xE5, 0x1D, 0xD3, 0x94, 0x02, 0x50, 0x19, 0x15, 0x1D, 0x75, 0x1C, 0x2D, 0xE5, 0x1D, 0xF1, 0xC1, -+0xFF, 0x12, 0xBA, 0x64, 0x12, 0x4D, 0xC2, 0x54, 0xF3, 0x4F, 0xF0, 0xD5, 0x1F, 0x19, 0xE1, 0x68, -+0xE5, 0x1C, 0xB4, 0x2D, 0x12, 0xE5, 0x1D, 0xD3, 0x94, 0x02, 0x50, 0x0B, 0x75, 0x1C, 0x2C, 0x15, -+0x1F, 0xE5, 0x1F, 0x70, 0x02, 0xE1, 0x68, 0xE5, 0x1F, 0x60, 0x7D, 0xE5, 0x1E, 0xD3, 0x9A, 0x40, -+0x73, 0xE4, 0x90, 0xA2, 0x9A, 0xF0, 0x90, 0xA2, 0x99, 0xE0, 0xFF, 0xAD, 0x1E, 0xF1, 0xA6, 0x8F, -+0x1E, 0x85, 0x1E, 0x1C, 0xE0, 0xFF, 0xAD, 0x02, 0xF1, 0xA6, 0xAA, 0x07, 0xA9, 0x1C, 0xE5, 0x1E, -+0x14, 0xFB, 0xEB, 0xC3, 0x9A, 0x40, 0x3C, 0xEB, 0xF1, 0xBA, 0x90, 0xA2, 0x97, 0x12, 0x4F, 0xBD, -+0xE0, 0xFD, 0x7C, 0x00, 0xEB, 0x54, 0x07, 0xF1, 0xD1, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -+0xD8, 0xF9, 0x12, 0xB9, 0xB4, 0x60, 0x19, 0xE5, 0x1E, 0xA9, 0x03, 0xB4, 0x14, 0x02, 0x79, 0x0C, -+0x90, 0xA2, 0x9A, 0xE0, 0x04, 0xF0, 0xE0, 0x65, 0x1F, 0x60, 0x08, 0xE9, 0xD3, 0x9A, 0x40, 0x03, -+0x1B, 0x80, 0xBF, 0xAF, 0x01, 0x8F, 0x1C, 0x90, 0xA2, 0x99, 0xE0, 0xFF, 0xAD, 0x1C, 0xF1, 0xDA, -+0x8F, 0x1C, 0x80, 0x04, 0xAF, 0x02, 0x8F, 0x1C, 0x90, 0xA2, 0x97, 0xE0, 0xFF, 0xB1, 0xA2, 0xEF, -+0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x1C, 0x12, 0xBA, 0x5C, 0x12, 0xB8, 0x8A, 0x7B, 0x01, 0xFA, -+0x7D, 0x05, 0x7F, 0x08, 0x12, 0x67, 0xF9, 0x90, 0xA2, 0x97, 0xE0, 0xFF, 0x85, 0x1D, 0x73, 0xE4, -+0xFB, 0xAD, 0x1C, 0x41, 0x82, 0x25, 0xE0, 0x24, 0x91, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xEF, 0x60, 0x0A, 0xED, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0x7E, -+0x20, 0x80, 0x02, 0xE4, 0xFE, 0xC3, 0xED, 0x9E, 0xFF, 0x22, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, -+0x22, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x22, -+0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x22, 0xEF, 0x60, 0x0A, 0xED, 0xD3, 0x94, -+0x0B, 0x40, 0x04, 0x7E, 0x20, 0x80, 0x02, 0xE4, 0xFE, 0xED, 0x2E, 0xFF, 0x22, 0xB1, 0x8E, 0xE0, -+0x44, 0x40, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, -+0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0x12, 0xA1, 0x08, 0xE5, 0x65, 0x30, 0xE1, 0x03, 0x12, 0xA2, 0xDD, 0xE5, 0x65, 0x30, 0xE2, -+0x02, 0xB1, 0x1D, 0xE5, 0x65, 0x30, 0xE4, 0x03, 0x12, 0xA2, 0xE9, 0xE5, 0x65, 0x30, 0xE5, 0x03, -+0x12, 0xA2, 0xF8, 0xE5, 0x66, 0x30, 0xE0, 0x03, 0x12, 0x8A, 0xCE, 0xE5, 0x67, 0x30, 0xE1, 0x02, -+0xD1, 0xB5, 0xE5, 0x67, 0x30, 0xE0, 0x03, 0x12, 0xA1, 0xC1, 0xE5, 0x67, 0x30, 0xE4, 0x03, 0x12, -+0xA2, 0xF9, 0xE5, 0x68, 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, 0x9C, 0xFF, 0xE5, 0x68, 0x30, 0xE4, -+0x02, 0x11, 0x8E, 0xE5, 0x68, 0x30, 0xE5, 0x03, 0x12, 0x8F, 0x5C, 0xE5, 0x68, 0x30, 0xE6, 0x03, -+0x12, 0xA3, 0x0F, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -+0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x71, 0xC9, -+0x31, 0x06, 0x90, 0xA1, 0x43, 0xE0, 0x30, 0xE0, 0x16, 0x12, 0xBA, 0x2C, 0xF0, 0x90, 0xA1, 0x46, -+0xE0, 0x60, 0x05, 0x14, 0xF0, 0x02, 0x5F, 0xDF, 0x12, 0x9B, 0xAA, 0xE4, 0xFF, 0x11, 0xB0, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x1A, 0x51, 0x59, 0x60, 0x0A, -+0x11, 0xF8, 0x51, 0x11, 0x12, 0xBA, 0x2C, 0xF0, 0x80, 0x07, 0x11, 0xF8, 0x31, 0xF9, 0x12, 0x77, -+0x9F, 0x12, 0x5F, 0xDF, 0x80, 0x19, 0x51, 0x59, 0x60, 0x06, 0x11, 0xF8, 0x51, 0x11, 0x80, 0x04, -+0x11, 0xF8, 0x31, 0xF9, 0x31, 0x06, 0x7D, 0x01, 0x7F, 0x02, 0x31, 0x0A, 0x12, 0xB7, 0xE5, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0xF0, -+0x7D, 0x01, 0x7F, 0x02, 0x31, 0x0A, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x59, 0x2F, 0xF8, 0xE6, 0x4D, -+0xFE, 0xF6, 0x74, 0x30, 0x41, 0x02, 0x90, 0x05, 0x62, 0xE0, 0xFE, 0x90, 0x05, 0x61, 0xE0, 0xFD, -+0xED, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xA3, 0x43, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0x71, 0xC1, 0x60, 0x02, 0x21, 0xED, 0x90, 0xA0, 0xDF, 0xE0, 0x70, 0x02, 0x21, -+0xED, 0x51, 0x69, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0xA0, 0xE6, 0xF0, 0x90, -+0x06, 0xAA, 0xE0, 0x90, 0xA0, 0xE5, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0xA0, 0xE5, 0xE0, -+0xFE, 0xFF, 0x80, 0x00, 0x90, 0xA0, 0xE6, 0xEF, 0xF0, 0x12, 0x88, 0x6A, 0xE4, 0x90, 0xA0, 0xE8, -+0x12, 0xB9, 0x21, 0x91, 0xF7, 0xB1, 0xBB, 0x54, 0xEF, 0xF0, 0x51, 0x69, 0x24, 0xFD, 0x50, 0x02, -+0x80, 0x0F, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x05, 0x12, 0x8D, 0xD3, 0x80, 0x03, 0x12, 0x8E, -+0x44, 0xD1, 0x03, 0x30, 0xE0, 0x55, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x21, 0x51, -+0x61, 0x6F, 0x70, 0x47, 0x90, 0xA0, 0xDB, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0xBA, 0x34, 0x11, 0xF4, -+0x51, 0x11, 0x12, 0x77, 0xA5, 0x12, 0xBA, 0x1D, 0x90, 0xA0, 0xE6, 0xE0, 0x14, 0xF0, 0x80, 0x2B, -+0x90, 0xA0, 0xDD, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x20, 0x51, 0x61, 0xFE, 0x6F, 0x60, -+0x1A, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x11, 0x90, 0xA0, 0xDB, 0xB1, 0xFC, 0x30, -+0xE0, 0x09, 0xEF, 0x54, 0xBF, 0x11, 0xF4, 0x31, 0xF9, 0x31, 0x00, 0x51, 0x19, 0x90, 0xA0, 0xD5, -+0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x02, 0x51, 0x19, 0x22, 0x74, 0x61, 0x12, 0xBA, 0x44, 0xFE, 0xF6, -+0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x7D, 0x03, 0x7F, -+0x02, 0x74, 0x61, 0x2F, 0xF8, 0xE6, 0x4D, 0x80, 0xE5, 0x90, 0xA0, 0xDB, 0xE0, 0x44, 0x04, 0xF0, -+0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, 0x31, 0x0A, -+0x7D, 0x02, 0x7F, 0x03, 0x31, 0x0A, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0x12, 0xB9, 0x21, 0xE4, -+0xFF, 0x51, 0x72, 0xBF, 0x01, 0x10, 0xB1, 0x5D, 0x90, 0xA0, 0xE2, 0xE0, 0x20, 0xE2, 0x09, 0x7D, -+0x01, 0x7F, 0x04, 0x02, 0x58, 0xE9, 0x51, 0x19, 0x22, 0x90, 0xA1, 0x45, 0xE0, 0x90, 0x01, 0x3F, -+0x22, 0x90, 0xA0, 0xE5, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0x90, 0xA0, 0xDD, 0xE0, 0xFF, 0xC4, 0x54, -+0x0F, 0x22, 0x12, 0x9A, 0xF4, 0x12, 0x9A, 0x86, 0xE0, 0xFD, 0x7C, 0x00, 0x12, 0x7F, 0xD2, 0x80, -+0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, 0xB9, 0xB4, 0x7F, 0x00, 0x60, 0x02, 0x7F, -+0x01, 0x22, 0xEF, 0x70, 0x39, 0x7D, 0x78, 0x7F, 0x02, 0x12, 0x77, 0xA9, 0x7D, 0x02, 0x7F, 0x03, -+0x12, 0x77, 0xA9, 0x7D, 0xC8, 0x7F, 0x02, 0x31, 0xF9, 0x91, 0xF7, 0xF0, 0xE4, 0xFF, 0x51, 0x72, -+0xEF, 0x70, 0x0A, 0x91, 0x72, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x80, 0x07, 0x7D, 0x01, 0x7F, -+0x0C, 0x12, 0x58, 0xE9, 0x91, 0x77, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x41, 0x21, -+0xE4, 0xF5, 0x22, 0x90, 0xA0, 0xDF, 0xE0, 0x70, 0x02, 0x61, 0xAE, 0x71, 0xC1, 0x60, 0x02, 0x61, -+0xAE, 0x12, 0x71, 0x93, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0x05, 0x62, 0x12, 0x71, 0xAC, 0x78, 0x10, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x71, -+0xAC, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0xB9, -+0x2C, 0x51, 0x69, 0x60, 0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0xA0, 0xE6, 0xE0, -+0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, 0xA0, 0xE8, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, -+0xA0, 0xE5, 0xE0, 0xA3, 0xF0, 0x80, 0x00, 0x75, 0x22, 0x01, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, -+0x11, 0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x02, 0x03, 0xE4, 0xF5, 0x22, 0x91, 0x66, 0xEF, 0x70, 0x02, -+0xF5, 0x22, 0xE5, 0x22, 0x60, 0x48, 0x90, 0xA0, 0xE3, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA0, 0xE8, -+0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x14, 0xE4, 0x90, 0xA4, 0xD0, 0xF0, 0x90, 0xA0, 0xE8, 0xE0, -+0x71, 0xBA, 0x12, 0x50, 0x10, 0x90, 0xA0, 0xE8, 0xE0, 0x80, 0x13, 0xE4, 0x90, 0xA4, 0xD0, 0x71, -+0xAF, 0x12, 0x50, 0x10, 0x90, 0xA0, 0xE8, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x71, 0xBA, -+0x90, 0xA0, 0xF8, 0xF0, 0x90, 0xA0, 0xE2, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x58, 0xE5, 0x22, 0xF0, -+0x90, 0xA0, 0xE8, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0xA0, 0xE7, 0xE0, 0x2F, -+0x22, 0xE4, 0xFF, 0x51, 0x72, 0xEF, 0x64, 0x01, 0x22, 0xE4, 0x90, 0xA3, 0x53, 0xF0, 0x90, 0xA0, -+0xDF, 0xE0, 0x70, 0x02, 0x81, 0x65, 0x71, 0xC1, 0x60, 0x02, 0x81, 0x65, 0x12, 0xBA, 0x34, 0x12, -+0x71, 0x92, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, -+0x12, 0x71, 0xAC, 0x78, 0x10, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x71, 0xAC, 0x78, -+0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0xB9, 0x2C, 0x90, -+0xA3, 0x53, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0xA0, 0xE6, 0xF0, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, -+0x15, 0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x02, 0x05, 0xE4, 0x90, 0xA3, 0x53, 0xF0, 0x91, 0x66, 0xEF, -+0x70, 0x04, 0x90, 0xA3, 0x53, 0xF0, 0x90, 0xA3, 0x53, 0xE0, 0x60, 0x19, 0x90, 0xA0, 0xE3, 0xE0, -+0x44, 0x10, 0x12, 0x8F, 0x9D, 0x90, 0xA0, 0xE7, 0x12, 0x50, 0x0F, 0x90, 0xA0, 0xE2, 0xE0, 0x20, -+0xE2, 0x03, 0x12, 0x58, 0xE5, 0x22, 0x90, 0x05, 0x43, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, -+0x01, 0x22, 0x12, 0x4B, 0xEF, 0x91, 0xDA, 0x90, 0xA0, 0xDA, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x8B, -+0x0F, 0x8A, 0x10, 0x89, 0x11, 0x12, 0x6F, 0x08, 0xFF, 0xF5, 0x13, 0x12, 0x06, 0x89, 0xFE, 0xC3, -+0x13, 0x30, 0xE0, 0x07, 0x12, 0x6D, 0x9A, 0xF5, 0x14, 0x80, 0x02, 0x8F, 0x14, 0x85, 0x13, 0x12, -+0xE5, 0x12, 0xD3, 0x95, 0x14, 0x50, 0x20, 0x12, 0x99, 0xF2, 0x54, 0x01, 0xFD, 0xAF, 0x12, 0x12, -+0x9A, 0x4B, 0xAF, 0x12, 0x51, 0x72, 0xEF, 0xAF, 0x12, 0x70, 0x05, 0x12, 0x8F, 0x8B, 0x80, 0x03, -+0x12, 0x8F, 0x87, 0x05, 0x12, 0x80, 0xD9, 0xE5, 0x13, 0x70, 0x0E, 0xFF, 0x51, 0x72, 0xEF, 0x70, -+0x08, 0x91, 0x72, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x12, 0x8B, 0x1B, 0x12, 0x8B, 0x2E, -+0x7D, 0x0C, 0x7F, 0x01, 0x02, 0x5B, 0x1E, 0x71, 0xC1, 0x70, 0x0B, 0x90, 0xA0, 0xDF, 0xE0, 0x60, -+0x05, 0x91, 0xF7, 0x12, 0x50, 0x06, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, -+0x02, 0x22, 0x71, 0xC1, 0x70, 0x16, 0x90, 0xA0, 0xDF, 0xE0, 0x60, 0x10, 0x91, 0xF7, 0xF0, 0x90, -+0xA0, 0xDA, 0xE0, 0xB1, 0xB9, 0x54, 0x07, 0x70, 0x03, 0x12, 0x58, 0xD0, 0x22, 0x90, 0xA0, 0xDF, -+0xE0, 0x60, 0x11, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x05, 0x12, 0x8F, 0x0D, 0x80, 0x05, 0x91, -+0x77, 0x12, 0x58, 0xD0, 0x90, 0xA1, 0x53, 0xE0, 0xB4, 0x01, 0x03, 0x12, 0x50, 0x4D, 0x22, 0x90, -+0x01, 0x57, 0xE0, 0x60, 0x17, 0x91, 0xFA, 0xF0, 0xB1, 0xF9, 0x30, 0xE0, 0x02, 0x80, 0x69, 0xD1, -+0x0E, 0x40, 0x09, 0xE4, 0xFF, 0x51, 0x72, 0xBF, 0x01, 0x02, 0xB1, 0x5D, 0x22, 0x90, 0xA0, 0xDB, -+0xE0, 0x54, 0xFB, 0xF0, 0x22, 0xD1, 0x03, 0x30, 0xE0, 0x0C, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x30, 0xE0, 0x03, 0x12, 0xBA, 0x1D, 0xB1, 0xF9, 0x30, 0xE0, 0x08, 0xB1, 0xB8, 0x54, 0x07, 0x70, -+0x36, 0x80, 0x31, 0xD1, 0x0E, 0x40, 0x2D, 0x71, 0xC1, 0x70, 0x2C, 0x12, 0x8D, 0xCC, 0x70, 0x04, -+0xB1, 0xC4, 0x80, 0xC9, 0xB1, 0xC4, 0x90, 0xA0, 0xE9, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, -+0x40, 0x09, 0xB1, 0x5D, 0xE4, 0x90, 0xA0, 0xE9, 0xF0, 0x80, 0x03, 0x12, 0x8D, 0x9C, 0xE4, 0x90, -+0xA0, 0xE8, 0xF0, 0x22, 0x12, 0x58, 0xD0, 0x22, 0xEF, 0x54, 0xFB, 0xF0, 0x90, 0xA0, 0xE3, 0xE0, -+0x54, 0xFD, 0xF0, 0x22, 0xD1, 0x1B, 0x40, 0x30, 0x90, 0xA0, 0xF9, 0xE0, 0x04, 0xF0, 0x90, 0xA1, -+0x3B, 0xE0, 0xFF, 0x90, 0xA0, 0xF9, 0xE0, 0xD3, 0x9F, 0x50, 0x1D, 0x90, 0xA0, 0xF1, 0xE0, 0x04, -+0x71, 0xAF, 0x90, 0xA0, 0xF8, 0xF0, 0xFB, 0x90, 0xA0, 0xF1, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, -+0xA5, 0x00, 0x74, 0x04, 0xF0, 0x12, 0x89, 0xFD, 0x22, 0x90, 0xA0, 0xDA, 0xE0, 0xFF, 0x13, 0x13, -+0x54, 0x3F, 0x22, 0x90, 0xA0, 0xDB, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0xA0, -+0xE8, 0xE0, 0x04, 0xF0, 0x90, 0xA0, 0xE3, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0xA1, 0x3C, 0xE0, 0xFF, -+0x90, 0xA0, 0xE8, 0xE0, 0xD3, 0x9F, 0x22, 0x90, 0xA0, 0xDA, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, -+0xA0, 0xE8, 0xF0, 0xA3, 0xF0, 0x90, 0xA0, 0xE3, 0xF0, 0x90, 0xA0, 0xDB, 0xE0, 0x54, 0xF7, 0xF0, -+0x54, 0xBF, 0x11, 0xFF, 0x7D, 0x10, 0x7F, 0x03, 0x21, 0xF9, 0x90, 0xA2, 0x8F, 0x12, 0x48, 0xF3, -+0xD1, 0x27, 0x90, 0xA0, 0xDF, 0xE0, 0xFF, 0x51, 0x92, 0x90, 0xA0, 0xDF, 0xE0, 0x60, 0x1C, 0x90, -+0xA2, 0x8F, 0x12, 0x48, 0xEA, 0x12, 0x6F, 0x08, 0x54, 0x0F, 0xFF, 0x12, 0x6D, 0x9A, 0xFD, 0x12, -+0xB6, 0x7A, 0x12, 0x8B, 0x03, 0x74, 0x01, 0xF0, 0x12, 0x89, 0xFD, 0x22, 0xEF, 0x60, 0x35, 0x71, -+0xC1, 0x70, 0x31, 0x90, 0xA0, 0xDB, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, 0x2B, 0x7F, 0x0F, 0x12, 0x55, -+0x9C, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0x12, 0x8C, 0x36, 0xBF, 0x01, 0x10, 0x90, 0xA0, -+0xDA, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x06, 0x12, 0x5F, 0xD7, 0x74, 0x06, 0xF0, 0x22, 0x12, 0xA3, -+0x4A, 0x74, 0x08, 0xF0, 0x22, 0x90, 0xA0, 0xD5, 0xE0, 0xFF, 0x30, 0xE0, 0x41, 0x90, 0xA0, 0xD9, -+0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0xA0, 0xD8, 0xE0, 0x7D, 0x00, 0xB4, 0x04, -+0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x27, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x05, 0x12, 0xA1, 0xA6, -+0x80, 0x1C, 0xB1, 0x3F, 0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x0C, 0x06, 0xE4, 0xFD, 0x7F, 0x08, 0x80, -+0x0A, 0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x04, 0x06, 0xE4, 0xFD, 0xFF, 0x12, 0x58, 0xE9, 0x02, 0x53, -+0xA1, 0xEF, 0x64, 0x01, 0x70, 0x23, 0x12, 0xB7, 0x95, 0x90, 0x01, 0x38, 0xE4, 0x12, 0x4F, 0xB1, -+0x90, 0x01, 0x30, 0x12, 0x4F, 0xB1, 0x90, 0x01, 0x30, 0x74, 0x10, 0xF0, 0x90, 0x01, 0x39, 0x74, -+0x01, 0xF0, 0x90, 0x00, 0x53, 0x74, 0x80, 0xF0, 0x22, 0x12, 0x97, 0xC1, 0x90, 0xA1, 0x4D, 0xE0, -+0x90, 0x01, 0x31, 0xF0, 0x90, 0xA1, 0x4E, 0xE0, 0x90, 0x01, 0x32, 0xF0, 0x90, 0xA1, 0x4F, 0xE0, -+0x90, 0x01, 0x33, 0xF0, 0x90, 0xA1, 0x48, 0xE0, 0x90, 0x01, 0x38, 0xF0, 0x90, 0xA1, 0x4B, 0xE0, -+0x90, 0x01, 0x3B, 0x11, 0xFF, 0x7F, 0x01, 0x12, 0x5A, 0xCB, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, -+0x7B, 0x01, 0x7A, 0xA0, 0x79, 0xDA, 0x12, 0x08, 0xAA, 0x12, 0x9B, 0x00, 0x12, 0x08, 0xAA, 0x90, -+0xA0, 0xDE, 0x74, 0x02, 0xF0, 0x90, 0xA0, 0xE5, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, -+0x90, 0xA0, 0xEB, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0x12, 0xB9, 0x3D, 0x12, 0xB7, 0xCE, 0xE4, 0xFD, -+0xFF, 0x12, 0x5B, 0x1E, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x5B, 0x1E, 0x12, 0x5B, 0x1A, 0x90, 0x9F, -+0x19, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0xA0, 0xEA, 0x74, 0xFF, 0xF0, 0x80, 0x12, 0x90, 0x9F, 0x19, -+0xE0, 0x90, 0xA0, 0xEA, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x40, 0xF0, 0x90, -+0xA1, 0x3C, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, -+0xA3, 0x74, 0x07, 0x12, 0xB9, 0x3D, 0x90, 0xA1, 0x47, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0x38, -+0xE0, 0x90, 0xA1, 0x48, 0xF0, 0x90, 0x01, 0x39, 0xE0, 0x90, 0xA1, 0x49, 0xF0, 0x90, 0x01, 0x3A, -+0xE0, 0x90, 0xA1, 0x4A, 0xF0, 0x90, 0x01, 0x3B, 0xE0, 0x90, 0xA1, 0x4B, 0xF0, 0x90, 0x01, 0x30, -+0xE0, 0x90, 0xA1, 0x4C, 0xF0, 0x90, 0x01, 0x31, 0xE0, 0x90, 0xA1, 0x4D, 0xF0, 0x90, 0x01, 0x32, -+0xE0, 0x90, 0xA1, 0x4E, 0xF0, 0x90, 0x01, 0x33, 0xE0, 0x90, 0xA1, 0x4F, 0xF0, 0x7F, 0x01, 0x11, -+0x46, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA1, -+0x79, 0x40, 0x12, 0x08, 0xAA, 0x71, 0x1B, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x71, 0x2E, -+0xE4, 0x90, 0xA1, 0x42, 0xF0, 0x22, 0xE4, 0xFE, 0x31, 0xCD, 0xE4, 0xF0, 0x0E, 0xEE, 0xB4, 0x2D, -+0xF7, 0xE4, 0x90, 0xA0, 0xF6, 0xF0, 0x90, 0xA0, 0xF5, 0xF0, 0x90, 0xA0, 0xF9, 0xF0, 0xEF, 0xB4, -+0x01, 0x07, 0xA3, 0x74, 0x2D, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0x12, 0x71, 0x93, 0x12, 0x48, 0x04, -+0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0x71, 0xAC, 0x78, 0x10, -+0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x71, 0xAC, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0x90, 0xA1, 0x2E, 0x12, 0x08, 0x6D, -+0x90, 0xA1, 0x32, 0x12, 0x48, 0xC6, 0x90, 0xA1, 0x2E, 0x71, 0x14, 0x40, 0x3F, 0x90, 0xA0, 0xDA, -+0xE0, 0x90, 0xA1, 0x32, 0x30, 0xE0, 0x0F, 0x31, 0xE0, 0x90, 0xA0, 0xFC, 0xE0, 0x24, 0x04, 0x2F, -+0xFF, 0x90, 0xA1, 0x36, 0x80, 0x05, 0x31, 0xE0, 0x90, 0xA1, 0x37, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, -+0x90, 0xA3, 0x45, 0xF0, 0x90, 0xA3, 0x45, 0xE0, 0xFF, 0xC3, 0x94, 0x2D, 0x50, 0x0E, 0x74, 0xFD, -+0x2F, 0x31, 0xD0, 0xE0, 0x04, 0xF0, 0x90, 0xA0, 0xF5, 0xE0, 0x04, 0xF0, 0x90, 0xA0, 0xF5, 0xE0, -+0xFF, 0xD3, 0x90, 0xA1, 0x39, 0xE0, 0x9F, 0x90, 0xA1, 0x38, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x21, -+0xCC, 0xE4, 0xFF, 0xFE, 0x31, 0xCD, 0xE0, 0x2F, 0xFF, 0x90, 0xA1, 0x3A, 0xE0, 0xFD, 0xEF, 0xD3, -+0x9D, 0x40, 0x07, 0x90, 0xA3, 0x46, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xE5, 0xE4, -+0xFF, 0xFE, 0x31, 0xCD, 0xE0, 0x2F, 0xFF, 0x90, 0xA1, 0x3A, 0xE0, 0xFD, 0xC3, 0x90, 0xA1, 0x39, -+0xE0, 0x9D, 0xFD, 0x90, 0xA1, 0x38, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, 0x40, -+0x07, 0x90, 0xA3, 0x47, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xD5, 0x90, 0xA3, 0x46, -+0xE0, 0x90, 0xA0, 0xFA, 0xF0, 0x90, 0xA3, 0x47, 0xE0, 0x90, 0xA0, 0xFB, 0x31, 0xD8, 0x94, 0x0A, -+0x40, 0x0A, 0xEF, 0x24, 0xF6, 0x90, 0xA0, 0xF2, 0xF0, 0xE4, 0x80, 0x09, 0xE4, 0x90, 0xA0, 0xF2, -+0x31, 0xD8, 0x74, 0x0A, 0x9F, 0x90, 0xA0, 0xF1, 0xF0, 0x90, 0xA0, 0xFA, 0xE0, 0xFF, 0xA3, 0xE0, -+0xC3, 0x9F, 0x90, 0xA0, 0xF8, 0xF0, 0x90, 0xA0, 0xDA, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0xA1, 0x36, -+0x80, 0x03, 0x90, 0xA1, 0x37, 0xE0, 0x04, 0xFF, 0x90, 0xA0, 0xF8, 0xE0, 0x2F, 0xF0, 0x90, 0xA0, -+0xF8, 0xE0, 0xC3, 0x94, 0x0A, 0x50, 0x03, 0x74, 0x0A, 0xF0, 0x90, 0xA0, 0xF8, 0xE0, 0x24, 0x02, -+0xF0, 0x71, 0x03, 0x74, 0x03, 0xF0, 0x31, 0xFD, 0xE4, 0xFF, 0x11, 0x46, 0x22, 0x74, 0xFD, 0x2E, -+0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0x22, 0xF0, 0x90, 0xA0, 0xFA, 0xE0, 0xFF, 0xC3, 0x22, -+0x12, 0x48, 0xD2, 0x90, 0xA1, 0x2E, 0x12, 0x48, 0xC6, 0x12, 0x47, 0x9A, 0x78, 0x0A, 0x12, 0x08, -+0x47, 0x90, 0xA0, 0xF7, 0xE0, 0xFE, 0xC3, 0x74, 0x0A, 0x9E, 0x2F, 0xFF, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0x90, 0xA0, 0xDB, 0x12, 0x6D, 0xA3, 0x30, 0xE0, 0x02, 0x41, -+0xB7, 0x90, 0xA0, 0xDA, 0xE0, 0x30, 0xE0, 0x16, 0x90, 0xA0, 0xFC, 0xE0, 0x24, 0x04, 0x90, 0xA0, -+0xF4, 0xF0, 0x90, 0xA0, 0xFC, 0xE0, 0x24, 0x03, 0x90, 0xA0, 0xF3, 0xF0, 0x80, 0x0D, 0x90, 0xA0, -+0xF4, 0x74, 0x02, 0xF0, 0x90, 0xA0, 0xF3, 0x14, 0xF0, 0x0B, 0x0B, 0x90, 0xA0, 0xF3, 0xE0, 0xFA, -+0x90, 0xA0, 0xF2, 0xE0, 0xD3, 0x9A, 0x50, 0x0E, 0x90, 0xA0, 0xE7, 0xEB, 0xF0, 0x90, 0xA0, 0xF4, -+0xE0, 0xC3, 0x9D, 0x2C, 0x80, 0x11, 0xC3, 0xED, 0x9A, 0x2B, 0x90, 0xA0, 0xE7, 0xF0, 0x90, 0xA0, -+0xF3, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0xA0, 0xF7, 0xF0, 0x90, 0xA0, 0xF4, 0xE0, 0xFF, -+0x24, 0x0A, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0xA0, 0xF7, 0x51, 0xC3, 0x40, 0x04, 0xEF, 0x24, 0x0A, -+0xF0, 0x90, 0xA0, 0xF7, 0xE0, 0xFF, 0x24, 0x23, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0xA0, 0xE7, 0x51, -+0xC3, 0x40, 0x04, 0xEF, 0x24, 0x23, 0xF0, 0x90, 0xA0, 0xF7, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0xA0, -+0xEB, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, 0xE0, 0x6F, 0x70, 0x01, 0xE4, 0x60, 0x03, -+0x12, 0xB9, 0x22, 0x71, 0x23, 0x80, 0x07, 0x90, 0xA0, 0xDC, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0x12, 0xA3, -+0x54, 0x90, 0xA3, 0x53, 0xEF, 0xF0, 0x30, 0xE0, 0x05, 0x7D, 0x01, 0xE4, 0x80, 0x02, 0xE4, 0xFD, -+0xFF, 0x12, 0x5B, 0x1E, 0x90, 0xA3, 0x53, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, -+0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x71, 0x03, 0x74, 0x02, -+0xF0, 0x21, 0xFD, 0x90, 0xA0, 0xF1, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA0, 0xF8, 0xE0, 0xFB, -+0x90, 0xA5, 0x00, 0x22, 0x12, 0x48, 0xD2, 0xC3, 0x02, 0x48, 0x27, 0x90, 0x06, 0x04, 0xE0, 0x54, -+0x7F, 0xF0, 0x22, 0x90, 0xA0, 0xDC, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x12, 0x4B, 0xEF, 0xE4, 0xFD, -+0xFF, 0x02, 0x55, 0x9C, 0x71, 0x2E, 0x71, 0x65, 0x02, 0x5F, 0xF1, 0x71, 0x34, 0xF1, 0xA4, 0xE4, -+0x90, 0xA0, 0xD8, 0xF0, 0x22, 0x71, 0x49, 0x80, 0xF4, 0x71, 0x2B, 0x02, 0x5F, 0xF1, 0x71, 0x52, -+0x80, 0xEB, 0x71, 0x2E, 0x02, 0x5F, 0xF1, 0x71, 0x2E, 0x12, 0x5F, 0xD1, 0x71, 0x65, 0x90, 0xA0, -+0xD9, 0x74, 0x04, 0xF0, 0x22, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0x71, 0x65, 0x7D, -+0x23, 0x7F, 0xFF, 0x12, 0x55, 0x9C, 0x12, 0x4B, 0x6E, 0x90, 0xA0, 0xD8, 0x74, 0x02, 0xF0, 0x22, -+0x7D, 0x22, 0x7F, 0xFF, 0x12, 0x55, 0x9C, 0x71, 0x65, 0x90, 0xA0, 0xD8, 0x74, 0x03, 0xF0, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x19, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x7D, -+0x44, 0x7F, 0x6F, 0x12, 0x55, 0x9C, 0x12, 0x56, 0x73, 0x90, 0xA5, 0x1A, 0xE0, 0x90, 0xA5, 0x19, -+0xB4, 0x01, 0x0C, 0xE0, 0x75, 0xF0, 0x10, 0x71, 0xD5, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x0A, 0xE0, -+0x75, 0xF0, 0x10, 0x71, 0xD5, 0xE0, 0x54, 0xFB, 0xF0, 0x71, 0x2E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x05, 0x02, 0x48, 0xDE, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0xA5, 0x2A, 0xEF, 0xF0, 0x90, 0x9F, 0xD2, 0xE0, 0xFF, 0x90, 0x04, 0x1C, 0xE0, -+0x6F, 0x70, 0x3E, 0x90, 0xA0, 0xE2, 0xE0, 0x64, 0x0E, 0x70, 0x15, 0x90, 0xA5, 0x2A, 0xE0, 0x70, -+0x30, 0x90, 0xA0, 0xDA, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0x12, 0x5B, 0x16, 0x80, 0x1F, -+0x90, 0xA0, 0xE2, 0xE0, 0x64, 0x06, 0x70, 0x19, 0x90, 0xA5, 0x2A, 0xE0, 0x60, 0x13, 0x90, 0xA0, -+0xDA, 0xE0, 0x54, 0xBF, 0xF0, 0x12, 0xB9, 0xD3, 0xF0, 0x90, 0xA0, 0xE2, 0x74, 0x04, 0xF0, 0x71, -+0x2E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x08, 0xE4, 0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA4, 0xD8, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x9F, 0x15, 0xE0, 0x04, 0xF0, 0x90, -+0x04, 0x1D, 0xE0, 0x60, 0x2C, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA4, 0xDC, 0xF0, 0x7D, 0x26, 0x12, -+0x56, 0x6F, 0xEF, 0x64, 0x01, 0x70, 0x07, 0x91, 0xE3, 0x20, 0xE0, 0x02, 0xB1, 0x0E, 0x90, 0xA4, -+0xDC, 0xE0, 0xFF, 0x7D, 0x27, 0x12, 0x55, 0x9C, 0x90, 0xA4, 0xD8, 0xE0, 0xFF, 0x71, 0xDB, 0x80, -+0x0E, 0x90, 0xA4, 0xD8, 0xE0, 0xFF, 0x71, 0xDB, 0x91, 0xE3, 0x20, 0xE0, 0x02, 0xB1, 0x0E, 0x12, -+0x57, 0xF2, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9F, 0xD3, 0xE0, 0xFF, 0x90, 0xA4, -+0xEC, 0x74, 0x0B, 0xF0, 0x7B, 0x08, 0x7D, 0x01, 0x12, 0x57, 0x14, 0x90, 0xA5, 0x02, 0xEE, 0xF0, -+0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA5, 0x01, 0xE0, 0xFF, 0x91, 0xD7, 0x54, 0x3F, 0xF0, 0xEF, -+0x60, 0x0A, 0xB1, 0x7C, 0x44, 0x10, 0x91, 0xD6, 0x44, 0x80, 0xF0, 0x22, 0xB1, 0x7C, 0x54, 0xEF, -+0x91, 0xD6, 0x44, 0x40, 0xF0, 0x22, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x22, 0x90, 0x9F, 0xD2, 0xE0, 0xFF, 0x90, 0xA4, 0xD9, 0xE0, 0xFB, 0x90, 0xA4, 0xEC, -+0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x57, 0x14, 0x90, 0xA4, 0xDA, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, -+0xF0, 0xFD, 0x90, 0xA4, 0xD8, 0xE0, 0xFF, 0x91, 0xBA, 0x90, 0xA1, 0x51, 0xE0, 0x22, 0x90, 0xA4, -+0xDA, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0xB1, -+0x88, 0x44, 0x01, 0xF0, 0xB1, 0x88, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0xB1, 0x94, -+0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x11, 0x2C, 0xF1, 0xB4, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, -+0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, 0xA7, -+0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, 0x74, -+0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xB1, 0x74, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xB1, -+0x74, 0xED, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x29, 0x2D, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xF1, 0x0D, 0x90, 0xA0, -+0xE2, 0xE0, 0x64, 0x0C, 0x60, 0x05, 0x12, 0x55, 0x92, 0x91, 0x36, 0x22, 0xE4, 0xFF, 0x12, 0x82, -+0x72, 0xBF, 0x01, 0x10, 0x90, 0xA0, 0xDF, 0xE0, 0x60, 0x0A, 0xB1, 0xCC, 0x64, 0x02, 0x60, 0x02, -+0xC1, 0x85, 0xB1, 0x9C, 0x22, 0x90, 0xA0, 0xE3, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0xA0, 0xDD, 0xE0, -+0x54, 0x0F, 0x22, 0x90, 0x06, 0xA9, 0xE0, 0x90, 0xA3, 0x45, 0xF0, 0xE0, 0xFD, 0x54, 0xC0, 0x70, -+0x04, 0xD1, 0x3C, 0x80, 0x53, 0xED, 0x30, 0xE6, 0x3D, 0x90, 0xA0, 0xDF, 0xE0, 0x64, 0x02, 0x70, -+0x27, 0x90, 0xA0, 0xDA, 0xE0, 0xFF, 0xC3, 0x13, 0x20, 0xE0, 0x09, 0x90, 0xA0, 0xE3, 0xE0, 0x44, -+0x01, 0xF0, 0x80, 0x1A, 0xB1, 0xCC, 0x64, 0x01, 0x70, 0x1E, 0x90, 0xA0, 0xE3, 0xE0, 0x44, 0x04, -+0xF0, 0x7F, 0x01, 0x12, 0x57, 0xB9, 0x80, 0x10, 0xB1, 0xC5, 0x64, 0x02, 0x60, 0x04, 0xD1, 0x85, -+0x80, 0x06, 0xB1, 0x9C, 0x80, 0x02, 0xD1, 0x3C, 0x90, 0xA3, 0x45, 0xE0, 0x90, 0xA0, 0xE3, 0x30, -+0xE7, 0x05, 0x12, 0x50, 0x03, 0x80, 0x72, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0xA0, 0xE3, 0xE0, -+0x54, 0xFE, 0xF0, 0x22, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x22, 0x54, 0xC0, 0x70, 0x08, 0xD1, 0x3C, -+0x54, 0xFD, 0xF0, 0x02, 0x58, 0xD0, 0xE5, 0x22, 0x30, 0xE6, 0x16, 0x90, 0xA0, 0xDF, 0xE0, 0x64, -+0x01, 0x70, 0x10, 0xB1, 0xC5, 0x64, 0x02, 0x60, 0x04, 0xD1, 0x85, 0x80, 0x06, 0xB1, 0x9C, 0x80, -+0x02, 0xD1, 0x3C, 0xE5, 0x22, 0x90, 0xA0, 0xE3, 0x30, 0xE7, 0x05, 0x12, 0x50, 0x03, 0x80, 0x29, -+0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x1D, 0x90, 0x9F, 0xD1, 0xE0, 0xFF, -+0x90, 0xA4, 0xEC, 0x74, 0x09, 0xF0, 0x7B, 0x18, 0xE4, 0xFD, 0x12, 0x57, 0x14, 0x90, 0xA5, 0x21, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x57, 0xF2, 0x22, 0x90, 0xA0, 0xDA, 0xE0, 0x44, 0x04, 0xF0, -+0x22, 0x90, 0xA0, 0xDF, 0xE0, 0x64, 0x02, 0x60, 0x0F, 0xB1, 0xCC, 0x60, 0x0B, 0xF1, 0xDC, 0xEF, -+0x70, 0x06, 0xFD, 0x7F, 0x0C, 0x12, 0x58, 0xE9, 0x22, 0xD1, 0xE7, 0x30, 0xE0, 0x0B, 0xD1, 0xE0, -+0x60, 0x07, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x58, 0xE9, 0xD1, 0xE0, 0x60, 0x02, 0xD1, 0xB1, 0x22, -+0x90, 0xA0, 0xD9, 0xE0, 0x64, 0x02, 0x22, 0x90, 0xA0, 0xD5, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, -+0x03, 0x22, 0x90, 0xA0, 0xDF, 0xE0, 0x64, 0x01, 0x70, 0x12, 0xB1, 0xCC, 0x60, 0x05, 0x12, 0x55, -+0x92, 0x80, 0x0A, 0x90, 0xA0, 0xE2, 0xE0, 0x70, 0x03, 0x12, 0x58, 0xE5, 0x22, 0xF1, 0xD2, 0x30, -+0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x3C, -+0x74, 0x04, 0xF1, 0x9D, 0x90, 0xA1, 0x3E, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF1, 0xAC, 0x7F, 0x58, -+0x7E, 0x01, 0x12, 0x50, 0x1B, 0x90, 0xA0, 0xDA, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0xA0, 0xDF, -+0xE0, 0x70, 0x07, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x11, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, -+0x08, 0x12, 0x84, 0x66, 0xBF, 0x01, 0x04, 0xC1, 0xB1, 0xD1, 0xF2, 0x22, 0x90, 0xA0, 0xDA, 0xD1, -+0xEA, 0x30, 0xE0, 0x20, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA0, 0xDB, 0x30, -+0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFE, 0x12, 0xA3, 0x49, 0x74, 0x04, -+0xF0, 0x12, 0x58, 0xD0, 0x22, 0x61, 0x76, 0xE4, 0xFD, 0x61, 0x90, 0x7D, 0x01, 0x61, 0x90, 0x7D, -+0x20, 0x61, 0x71, 0x12, 0x5F, 0xF1, 0x80, 0xF7, 0x12, 0x4B, 0xEF, 0x61, 0x89, 0xF0, 0xE4, 0x90, -+0xA4, 0xD0, 0xF0, 0x22, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x22, 0x90, 0xA4, 0xD1, 0xF0, -+0xE4, 0xFB, 0xFD, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x7D, 0x21, 0x7F, 0xFF, -+0x12, 0x55, 0x9C, 0x61, 0x89, 0x12, 0x5F, 0xF1, 0x80, 0xF2, 0xF1, 0xDC, 0xEF, 0x70, 0x02, 0xD1, -+0xF2, 0x22, 0x90, 0xA0, 0xDA, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x04, 0x1A, 0xE0, -+0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x7F, 0x01, -+0x60, 0x02, 0x7F, 0x00, 0x22, 0x32, 0x32, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, -+0xBE, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x7D, 0x00, 0x7C, 0x00, 0xE4, 0x90, 0xA4, 0xC4, 0xF0, 0x7F, -+0xB0, 0x7E, 0x08, 0x12, 0x37, 0xBC, 0xE4, 0xFF, 0xEC, 0x90, 0xA4, 0xC0, 0x12, 0x08, 0x6D, 0x90, -+0xA4, 0xC0, 0x12, 0x48, 0xD2, 0x90, 0xA4, 0xBF, 0x12, 0x71, 0xAC, 0x12, 0x48, 0x04, 0xA3, 0x12, -+0x08, 0x6D, 0x90, 0xA4, 0xC0, 0x12, 0x4D, 0x12, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x38, 0x07, 0xD1, -+0xDB, 0x90, 0xA4, 0xBE, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0xB5, 0xF5, 0x82, 0xE4, 0x34, 0xAD, -+0x11, 0x60, 0x12, 0x37, 0xBC, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, -+0x8F, 0xF7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xB1, 0xEB, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, -+0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x2C, 0x7E, 0x08, 0x12, 0x77, -+0x1A, 0x7D, 0x65, 0x11, 0xAC, 0x12, 0x48, 0x88, 0x7D, 0x8F, 0x11, 0xAC, 0x90, 0x00, 0x04, 0x12, -+0x48, 0xA2, 0xE4, 0xFD, 0x11, 0xAD, 0x90, 0x00, 0x08, 0x02, 0x48, 0xA2, 0xE4, 0xFF, 0x11, 0x68, -+0x90, 0xA2, 0xF3, 0x02, 0x48, 0xEA, 0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x71, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA4, 0x70, 0xEF, 0xF0, -+0xA3, 0xA3, 0xE0, 0xFD, 0x11, 0x68, 0x90, 0xA4, 0x7B, 0x12, 0x08, 0x6D, 0x90, 0xA4, 0x73, 0x12, -+0x48, 0xC6, 0x12, 0x08, 0x3A, 0x90, 0xA4, 0x7B, 0x12, 0x77, 0xE4, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0xA4, 0x73, 0x12, 0x48, 0xC6, 0x90, 0xA4, 0x77, 0x12, 0x77, 0xE4, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0x90, 0xA4, 0x7F, 0x12, 0x08, 0x6D, -+0x90, 0xA4, 0x71, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0xA4, 0x7F, 0x12, 0x48, 0xC6, 0x90, 0xAA, -+0x96, 0x12, 0x08, 0x6D, 0x90, 0xA4, 0x70, 0xE0, 0xFF, 0xD0, 0x05, 0x12, 0x3C, 0x33, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x54, 0x03, 0xFD, 0xEE, 0x13, 0x13, 0x54, 0x07, 0xFB, 0x90, 0xA1, 0x51, 0xE0, -+0xFE, 0xC4, 0x54, 0x0F, 0x90, 0xA4, 0xF8, 0xF0, 0xAF, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA4, 0xF6, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA4, 0xF5, 0xEF, 0xF0, 0x90, 0xA4, -+0xF8, 0xE0, 0xFD, 0x91, 0x4A, 0x90, 0xA4, 0xF5, 0xE0, 0xC3, 0x94, 0x0E, 0x50, 0x3F, 0x90, 0xA4, -+0x85, 0x12, 0x08, 0x79, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x12, 0xD4, -+0x00, 0x00, 0x91, 0x2F, 0x90, 0xA4, 0x73, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA4, -+0x77, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x71, 0x91, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, -+0x00, 0x90, 0xA4, 0x77, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x41, 0xC8, 0x91, 0x40, 0x50, -+0x1B, 0xEF, 0x94, 0x30, 0x50, 0x16, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x1F, 0xFE, 0x00, 0x00, -+0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x09, 0x28, 0x00, 0x00, 0x80, 0x64, 0x90, 0xA4, 0xF5, 0xE0, -+0xFF, 0x74, 0x32, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x40, 0x50, 0x16, 0x90, 0xA4, 0x85, 0x12, -+0x08, 0x79, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x08, 0xA6, 0x00, 0x00, -+0x80, 0x3E, 0x91, 0x36, 0x50, 0x1B, 0xEF, 0x94, 0x74, 0x50, 0x16, 0x90, 0xA4, 0x85, 0x12, 0x08, -+0x79, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x08, 0xA4, 0x00, 0x00, 0x80, -+0x1F, 0x90, 0xA4, 0xF5, 0xE0, 0xFF, 0x74, 0x76, 0xD3, 0x9F, 0x50, 0x16, 0x90, 0xA4, 0x85, 0x12, -+0x08, 0x79, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x08, 0x24, 0x00, 0x00, -+0x91, 0x2F, 0x91, 0x40, 0x50, 0x2E, 0xEF, 0x94, 0x40, 0x50, 0x29, 0x90, 0xA4, 0x73, 0x12, 0x08, -+0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA4, 0x77, 0x12, 0x08, 0x79, 0x00, 0x01, 0x01, 0x00, 0x71, -+0x91, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA4, 0x77, 0x12, 0x08, 0x79, 0x00, 0x01, -+0x01, 0x00, 0x80, 0x64, 0x91, 0x36, 0x50, 0x2E, 0xEF, 0x94, 0x8C, 0x50, 0x29, 0x90, 0xA4, 0x73, -+0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA4, 0x77, 0x12, 0x08, 0x79, 0x00, 0x03, 0x01, -+0x00, 0x71, 0x91, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA4, 0x77, 0x12, 0x08, 0x79, -+0x00, 0x03, 0x01, 0x00, 0x80, 0x32, 0x90, 0xA4, 0xF5, 0xE0, 0xFF, 0x74, 0x8C, 0xC3, 0x9F, 0x50, -+0x29, 0x90, 0xA4, 0x73, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA4, 0x77, 0x12, 0x08, -+0x79, 0x00, 0x05, 0x01, 0x00, 0x71, 0x91, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA4, -+0x77, 0x12, 0x08, 0x79, 0x00, 0x05, 0x01, 0x00, 0x11, 0xB6, 0x90, 0xA4, 0xF6, 0xE0, 0x64, 0x02, -+0x70, 0x51, 0x90, 0xA4, 0xF5, 0xE0, 0xFF, 0xD3, 0x94, 0x30, 0x50, 0x05, 0x75, 0x74, 0x2A, 0x80, -+0x5E, 0xEF, 0xD3, 0x94, 0x40, 0x50, 0x05, 0x75, 0x74, 0x3A, 0x80, 0x53, 0xEF, 0xD3, 0x94, 0x70, -+0x50, 0x05, 0x75, 0x74, 0x6A, 0x80, 0x48, 0xEF, 0xD3, 0x94, 0x80, 0x50, 0x05, 0x75, 0x74, 0x7A, -+0x80, 0x3D, 0xEF, 0xD3, 0x94, 0x90, 0x50, 0x05, 0x75, 0x74, 0x8A, 0x80, 0x32, 0xEF, 0xD3, 0x94, -+0xA1, 0x50, 0x05, 0x75, 0x74, 0x9B, 0x80, 0x27, 0xEF, 0xD3, 0x94, 0xB1, 0x50, 0x21, 0x75, 0x74, -+0xAB, 0x80, 0x1C, 0x90, 0xA4, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x31, 0xA3, 0xE0, 0x90, 0xA4, 0xF5, -+0xB4, 0x01, 0x07, 0xE0, 0x24, 0x02, 0xF5, 0x74, 0x80, 0x05, 0xE0, 0x24, 0xFE, 0xF5, 0x74, 0x90, -+0xA4, 0x73, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x74, 0xE4, 0xFC, 0xFD, 0xFE, 0x71, -+0x8B, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x74, 0x80, 0x1E, 0x90, 0xA4, 0x73, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA4, 0xF5, 0x12, 0x71, 0xAC, 0x71, 0x8B, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA4, 0xF5, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA4, -+0x77, 0x12, 0x08, 0x6D, 0x11, 0xB6, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA4, 0x77, 0x12, 0x08, -+0x6D, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x11, 0xBC, 0x90, 0xA4, 0x73, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x14, 0x60, 0x30, 0x14, 0x60, 0x56, 0x24, 0x02, 0x70, 0x7B, 0x90, -+0xA4, 0x73, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, 0x77, 0x12, 0x08, 0x79, 0x00, -+0x00, 0x0C, 0x00, 0x71, 0x91, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, 0x77, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x80, 0x50, 0x90, 0xA4, 0x73, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x0C, 0x00, 0x90, 0xA4, 0x77, 0x12, 0x08, 0x79, 0x00, 0x00, 0x04, 0x00, 0x71, 0x91, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, 0x77, 0x12, 0x08, 0x79, 0x00, 0x00, 0x04, 0x00, 0x80, -+0x27, 0x90, 0xA4, 0x73, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, 0x77, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x00, 0x00, 0x71, 0x91, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, -+0x77, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x11, 0xB6, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, -+0x60, 0x7E, 0x08, 0x02, 0x77, 0x1A, 0x90, 0xA4, 0xF5, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x22, -+0x90, 0xA4, 0xF5, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x22, 0x90, 0xA5, 0x20, 0xED, 0xF0, 0x90, -+0xA5, 0x1F, 0xEF, 0xF0, 0xD3, 0x94, 0x0E, 0x50, 0x15, 0x91, 0x89, 0xEF, 0x60, 0x2A, 0x91, 0x89, -+0xEF, 0x64, 0x01, 0x70, 0x23, 0x90, 0xA5, 0x20, 0xE0, 0xFD, 0xE4, 0xFF, 0x80, 0x15, 0x90, 0xA5, -+0x1F, 0xE0, 0xD3, 0x94, 0x0E, 0x40, 0x11, 0x91, 0x89, 0xEF, 0x70, 0x0A, 0x90, 0xA5, 0x20, 0xE0, -+0xFD, 0x7F, 0x01, 0x02, 0xA7, 0x60, 0x91, 0x89, 0x22, 0x90, 0x04, 0x54, 0xE0, 0x7F, 0x00, 0x30, -+0xE7, 0x02, 0x7F, 0x01, 0x22, 0x90, 0xA4, 0xF9, 0xF1, 0x81, 0xE4, 0xFE, 0x7D, 0x18, 0xFF, 0x12, -+0x3D, 0x2C, 0x90, 0xA4, 0xFC, 0xEF, 0xF0, 0x90, 0xA4, 0xF9, 0xE0, 0xFF, 0x91, 0xCF, 0x90, 0xA4, -+0xF9, 0xF1, 0x62, 0xFB, 0x12, 0xA6, 0xF2, 0xAE, 0x07, 0x90, 0x04, 0x83, 0xEE, 0xF0, 0x90, 0xA4, -+0xF9, 0xE0, 0xFF, 0xAD, 0x06, 0x12, 0x75, 0x45, 0x90, 0xA4, 0xF9, 0xE0, 0xFF, 0x61, 0x9D, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xA9, 0x07, 0x90, 0x06, 0x69, 0xE0, 0xFE, 0x90, 0x06, 0x68, -+0xF1, 0x74, 0xE9, 0x14, 0x60, 0x0F, 0x14, 0x60, 0x1E, 0x24, 0x02, 0x70, 0x25, 0xEE, 0x54, 0xFE, -+0xFE, 0xB1, 0x17, 0x80, 0x1A, 0xEF, 0x44, 0x80, 0xFF, 0xEE, 0x54, 0xFE, 0xFC, 0x90, 0x06, 0x68, -+0xEF, 0xF0, 0xEC, 0xA3, 0xF0, 0x80, 0x0B, 0xEE, 0x44, 0x01, 0xFC, 0xB1, 0x17, 0xAE, 0x04, 0xEE, -+0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x54, 0x7F, 0x90, 0x06, 0x68, 0xF0, 0x22, 0xB1, -+0xEB, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x00, 0x00, 0xD1, 0x25, 0x90, 0xA2, 0xF9, 0xE0, 0xFF, 0xD1, 0xC9, 0xF5, 0x82, 0x8C, 0x83, 0xE0, -+0xFE, 0x11, 0xB0, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xEE, 0x12, 0x06, 0xE1, 0xB1, 0x85, 0xE0, 0xB4, -+0x03, 0xE2, 0xE4, 0x90, 0xA2, 0xF9, 0xF0, 0x90, 0xA2, 0xF9, 0xE0, 0xFF, 0xC3, 0x94, 0x07, 0x50, -+0x10, 0xEF, 0xD1, 0xB2, 0x12, 0x66, 0x8E, 0x12, 0x37, 0xBC, 0x90, 0xA2, 0xF6, 0xB1, 0x72, 0x80, -+0xE6, 0x22, 0x12, 0x48, 0xEA, 0x90, 0xA2, 0xF9, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0xF5, 0x82, 0x85, -+0xF0, 0x83, 0x12, 0x48, 0xA2, 0x90, 0xA2, 0xF9, 0xE0, 0x04, 0xF0, 0x22, 0xB1, 0xEB, 0x12, 0x08, -+0x79, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0xD1, -+0x25, 0x11, 0xB0, 0x90, 0xA2, 0xF9, 0xE0, 0xFF, 0xF5, 0x82, 0x12, 0x67, 0xEE, 0xFE, 0xEF, 0xD1, -+0xC9, 0xF5, 0x82, 0x8C, 0x83, 0xEE, 0xF0, 0xB1, 0x85, 0xE0, 0xB4, 0x03, 0xE4, 0xE4, 0x90, 0xA2, -+0xF9, 0xF0, 0x90, 0xA2, 0xF9, 0xE0, 0xFD, 0xD1, 0xB2, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0xA2, 0xF6, 0x12, 0x48, 0xEA, 0xF1, 0x8A, 0x12, 0x4D, 0x14, 0xD0, 0x07, 0xD0, 0x06, 0x12, -+0x38, 0x07, 0xB1, 0x85, 0xE0, 0xC3, 0x94, 0x07, 0x40, 0xD8, 0x22, 0x90, 0xA2, 0xF3, 0x12, 0x48, -+0xF3, 0x90, 0xA4, 0x85, 0x22, 0xB1, 0xEB, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA4, -+0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0xD1, 0x25, 0x90, 0xA2, 0xF9, 0xE0, 0xFF, 0xC3, -+0x94, 0x06, 0x50, 0x10, 0xEF, 0xF1, 0x6A, 0x12, 0x66, 0x8E, 0x12, 0x37, 0xBC, 0x90, 0xA2, 0xF3, -+0xB1, 0x72, 0x80, 0xE6, 0x22, 0x7F, 0x2C, 0x7E, 0x08, 0x12, 0x77, 0x1A, 0xE4, 0x90, 0xA2, 0xF9, -+0xF0, 0x22, 0x90, 0xA2, 0xF3, 0xEF, 0xF0, 0xA3, 0xB1, 0xEE, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, -+0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x2C, 0x7E, 0x08, 0x12, -+0x77, 0x1A, 0xD1, 0x9D, 0x12, 0x48, 0x38, 0xD1, 0xA6, 0x7D, 0x65, 0xD1, 0x9B, 0x90, 0x00, 0x04, -+0xD1, 0xA3, 0x7D, 0x8F, 0xD1, 0x9B, 0x90, 0x00, 0x08, 0xD1, 0xA3, 0xE4, 0xFD, 0xD1, 0xC3, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0xF1, 0x5A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, -+0x07, 0xC0, 0x05, 0x90, 0xA3, 0x37, 0x12, 0x48, 0xC6, 0x90, 0xAA, 0x9C, 0x12, 0x08, 0x6D, 0xD0, -+0x05, 0xD0, 0x07, 0x12, 0x32, 0x34, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD1, 0x78, 0x90, 0xA2, 0xF4, -+0x02, 0x48, 0xEA, 0x12, 0x48, 0x58, 0x90, 0xA3, 0x37, 0x12, 0x08, 0x6D, 0x90, 0xA2, 0xF3, 0xE0, -+0xFF, 0x22, 0x25, 0xE0, 0x24, 0xA7, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x22, 0x90, 0xA2, 0xF3, 0xE0, -+0xFF, 0x7D, 0x65, 0xD1, 0x78, 0x90, 0xA3, 0x37, 0x22, 0x25, 0xE0, 0x24, 0xA1, 0xF5, 0x82, 0xE4, -+0x34, 0x44, 0xF5, 0x83, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x93, 0x22, 0x7F, 0x14, 0x7E, 0x00, 0x02, -+0x3D, 0x7A, 0x90, 0xA5, 0x08, 0x12, 0xB8, 0x89, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, -+0x02, 0x7F, 0x01, 0x90, 0xA5, 0x08, 0xE0, 0x6F, 0x60, 0x35, 0xC3, 0x90, 0xA5, 0x0A, 0xE0, 0x94, -+0x88, 0x90, 0xA5, 0x09, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, -+0x22, 0x90, 0xA5, 0x09, 0x12, 0x57, 0xF9, 0xD1, 0xDB, 0xD3, 0x90, 0xA5, 0x0A, 0xE0, 0x94, 0x32, -+0x90, 0xA5, 0x09, 0xE0, 0x94, 0x00, 0x40, 0xC0, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB9, 0x22, -+0x12, 0xA3, 0x99, 0x7F, 0x08, 0x12, 0x4B, 0xB4, 0xEF, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x4A, -+0x26, 0xE4, 0xFF, 0xD1, 0xE2, 0x90, 0xA0, 0xDA, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x02, -+0xF1, 0xC1, 0x90, 0xA0, 0xDB, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x90, 0xA2, 0xF3, 0xE0, 0xFF, 0x7D, -+0xEF, 0x22, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0x22, 0x25, 0xE0, 0x24, 0xB5, 0xF5, 0x82, -+0xE4, 0x34, 0x44, 0x22, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0xFE, 0x22, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x22, 0x75, 0xF0, 0x04, 0xED, 0xA4, 0xF5, -+0x82, 0x85, 0xF0, 0x83, 0x02, 0x48, 0x58, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x4D, -+0x70, 0xF1, 0x30, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA0, 0xE2, 0xE0, 0xFF, 0x60, 0x03, 0xB4, -+0x08, 0x0E, 0x12, 0xB7, 0x46, 0xBF, 0x01, 0x08, 0xF1, 0x97, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, -+0x22, 0x90, 0xA1, 0x4C, 0xE0, 0x90, 0x01, 0x30, 0xF0, 0x90, 0xA1, 0x49, 0xE0, 0x90, 0x01, 0x39, -+0xF0, 0x90, 0xA1, 0x4A, 0xE0, 0x90, 0x01, 0x3A, 0xF0, 0x22, 0x12, 0x5F, 0xF8, 0x90, 0x04, 0x24, -+0xE0, 0xF5, 0x0F, 0xE4, 0xFF, 0x12, 0x5F, 0x68, 0x8F, 0x82, 0x12, 0x67, 0xEE, 0x25, 0x0F, 0xFE, -+0x75, 0xF0, 0x13, 0xEF, 0x90, 0xA1, 0x5D, 0x12, 0x48, 0xDE, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x03, -+0xE4, 0x22, 0x12, 0x6F, 0xD1, 0xFF, 0x54, 0x0F, 0xF5, 0x12, 0xEF, 0xC4, 0x54, 0x0F, 0x64, 0x0F, -+0x70, 0x4C, 0x90, 0x01, 0xA4, 0x04, 0xF0, 0x90, 0xA1, 0x51, 0xE0, 0x54, 0xFE, 0xFF, 0xF0, 0xE5, -+0x12, 0x54, 0x07, 0x25, 0xE0, 0xFE, 0xEF, 0x54, 0xF1, 0x4E, 0x31, 0xB4, 0x60, 0x03, 0xBF, 0x01, -+0x0A, 0x31, 0xE2, 0x90, 0x01, 0xA4, 0x74, 0x02, 0xF0, 0x80, 0x07, 0x7D, 0x20, 0xE4, 0xFF, 0x12, -+0x81, 0xF9, 0xAF, 0x12, 0x12, 0x55, 0xA7, 0xBF, 0x01, 0x08, 0xE4, 0xFD, 0xFF, 0x12, 0x55, 0x16, -+0x80, 0x00, 0x7F, 0x02, 0x12, 0x54, 0x15, 0x90, 0x01, 0xA4, 0x74, 0x04, 0xF0, 0x22, 0xE5, 0x12, -+0x75, 0xF0, 0x13, 0xA4, 0x24, 0x54, 0xF9, 0x74, 0xA1, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xC0, 0x02, -+0xC0, 0x01, 0xE5, 0x11, 0x24, 0x01, 0xF9, 0xE4, 0x35, 0x10, 0x85, 0x0F, 0x40, 0xF5, 0x41, 0x89, -+0x42, 0x75, 0x43, 0x04, 0xD0, 0x01, 0xD0, 0x02, 0x12, 0x34, 0x62, 0xAB, 0x0F, 0xAA, 0x10, 0xA9, -+0x11, 0x12, 0x6F, 0xCB, 0x54, 0x80, 0x12, 0x6D, 0xA4, 0xFF, 0x75, 0xF0, 0x13, 0xE5, 0x12, 0x31, -+0xEA, 0x54, 0xFE, 0x4F, 0xF0, 0x75, 0xF0, 0x13, 0xE5, 0x12, 0x90, 0xA1, 0x57, 0x12, 0x48, 0xDE, -+0xE0, 0x54, 0xF7, 0xF0, 0x12, 0x06, 0x89, 0xC4, 0x54, 0x0F, 0x14, 0x65, 0x12, 0x60, 0x02, 0x21, -+0xB3, 0x90, 0xA0, 0xDF, 0xE0, 0x70, 0x07, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x05, 0x7F, 0x05, -+0x02, 0x54, 0x15, 0x90, 0x01, 0xA4, 0xE4, 0xF0, 0xA3, 0xF0, 0x31, 0xF2, 0xC4, 0x54, 0x0F, 0x90, -+0xA1, 0x52, 0xF0, 0x12, 0x6F, 0xCB, 0xFF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFE, 0x90, 0xA1, 0x51, -+0xE0, 0x54, 0x0F, 0x4E, 0xF0, 0xEF, 0x54, 0x10, 0x25, 0xE0, 0xFF, 0x90, 0xA1, 0x8F, 0xE0, 0x54, -+0xDF, 0x4F, 0xFF, 0xF0, 0x12, 0x6F, 0xCB, 0x54, 0x60, 0xC4, 0x54, 0x0F, 0xFE, 0xEF, 0x54, 0xF9, -+0x4E, 0x90, 0xA1, 0x8F, 0xF0, 0x90, 0xA1, 0x51, 0xE0, 0x54, 0xF1, 0xF0, 0x90, 0x05, 0x58, 0x74, -+0x02, 0x31, 0xFB, 0x44, 0x40, 0xF0, 0x54, 0x7F, 0xF0, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, -+0xE0, 0x06, 0xEF, 0x54, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0xA1, 0x51, 0xE0, 0x44, 0x01, 0x31, 0xB4, -+0x60, 0x05, 0xEF, 0x64, 0x01, 0x70, 0x1D, 0x90, 0xA1, 0xC6, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, -+0x30, 0xE0, 0x08, 0xEF, 0x54, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x2D, 0x90, 0x05, 0x27, 0xE0, 0x44, -+0x32, 0xF0, 0x80, 0x24, 0x7D, 0x20, 0xE4, 0xFF, 0x12, 0x82, 0x11, 0xE4, 0xFF, 0xEF, 0xFD, 0xC3, -+0x74, 0x87, 0x31, 0xBF, 0x74, 0x03, 0x31, 0xCF, 0xEF, 0xFD, 0xC3, 0x74, 0x8B, 0x31, 0xBF, 0x74, -+0x07, 0x31, 0xCF, 0x0F, 0xEF, 0xB4, 0x04, 0xE5, 0x7F, 0x03, 0x12, 0x54, 0x15, 0x90, 0xA1, 0x56, -+0xE0, 0x90, 0xA1, 0xC4, 0xB4, 0x64, 0x05, 0x74, 0xC8, 0xF0, 0x80, 0x03, 0x74, 0x64, 0xF0, 0x90, -+0xA1, 0xBC, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x90, 0xA1, 0xC0, 0x12, 0x08, 0x79, 0x00, -+0x00, 0x00, 0x00, 0x22, 0xF0, 0x90, 0xA1, 0x57, 0xE0, 0x54, 0x07, 0xFF, 0x64, 0x03, 0x22, 0x9D, -+0xFD, 0x74, 0x05, 0x94, 0x00, 0x8D, 0x82, 0xF5, 0x83, 0xE0, 0xFE, 0xEF, 0xFD, 0xC3, 0x22, 0x9D, -+0xFD, 0xE4, 0x94, 0x00, 0xFC, 0x74, 0x8C, 0x2D, 0xF5, 0x82, 0x74, 0xA2, 0x3C, 0xF5, 0x83, 0xEE, -+0xF0, 0x22, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xED, 0xF0, 0x22, 0x90, 0xA1, 0x58, 0x12, 0x48, 0xDE, -+0xE0, 0x22, 0xAB, 0x0F, 0xAA, 0x10, 0xA9, 0x11, 0x02, 0x06, 0x89, 0xF0, 0x90, 0xA1, 0xC5, 0xE0, -+0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x22, 0x7E, 0x00, 0x7F, 0x01, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA0, -+0x79, 0xD5, 0x12, 0x08, 0xAA, 0x90, 0xA0, 0xD5, 0xE0, 0x54, 0xFD, 0xF0, 0xE4, 0x12, 0x4F, 0xB2, -+0xA3, 0x74, 0x0C, 0x51, 0xEC, 0x31, 0xFB, 0x54, 0xE0, 0xF0, 0x22, 0x51, 0x48, 0x71, 0x0D, 0x12, -+0x4D, 0xC9, 0x51, 0x06, 0x12, 0x87, 0x5A, 0x51, 0xE7, 0x7E, 0x00, 0x7F, 0x7F, 0x7D, 0x00, 0x7B, -+0x01, 0x7A, 0xA1, 0x79, 0x51, 0x02, 0x08, 0xAA, 0xE4, 0xFD, 0xFF, 0x51, 0xF4, 0xED, 0x70, 0x12, -+0x51, 0x86, 0xC0, 0x83, 0xC0, 0x82, 0x51, 0x7E, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, -+0x80, 0x0F, 0x51, 0x86, 0xC0, 0x83, 0xC0, 0x82, 0x51, 0x7E, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -+0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x51, 0x91, 0x90, 0xA0, 0xD4, 0xEF, 0xF0, 0x22, 0xE0, 0xFE, -+0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, 0x74, 0xC4, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7D, 0x10, 0xED, 0x14, 0xF9, 0x24, 0xC4, 0x51, -+0x89, 0xE0, 0x60, 0x3A, 0x7C, 0x08, 0xEC, 0x14, 0x90, 0xA5, 0x25, 0xF0, 0x74, 0xC4, 0x29, 0x51, -+0x89, 0xE0, 0xFB, 0x7A, 0x00, 0x90, 0xA5, 0x25, 0x12, 0x7F, 0xD0, 0x80, 0x05, 0xC3, 0x33, 0xCE, -+0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x0F, 0xE9, 0x75, 0xF0, -+0x08, 0xA4, 0xFF, 0x90, 0xA5, 0x25, 0xE0, 0x2F, 0x04, 0xFF, 0x80, 0x06, 0xDC, 0xC8, 0xDD, 0xBA, -+0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x71, 0x00, 0x02, 0x08, 0xAA, 0xF0, 0x90, 0xA1, 0xC6, -+0xE0, 0x54, 0xDF, 0x22, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFE, 0xEF, 0x54, 0x07, 0xFF, 0x22, -+0x7E, 0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x43, 0x22, 0xE4, 0x90, 0xA0, -+0xBF, 0xF0, 0xA3, 0xF0, 0x90, 0xA0, 0x27, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x6F, 0xD1, 0xFF, 0x54, -+0x01, 0xC4, 0x33, 0x54, 0xE0, 0xFE, 0x51, 0xED, 0x4E, 0xF0, 0xEF, 0x54, 0xFE, 0xC3, 0x13, 0xFF, -+0x90, 0xA1, 0xC5, 0xE0, 0x54, 0x80, 0x12, 0x6F, 0x06, 0x90, 0xA1, 0xC7, 0xF0, 0x12, 0x6D, 0x9A, -+0x90, 0xA1, 0xC8, 0x12, 0x5F, 0x5F, 0x90, 0xA1, 0xC9, 0xF0, 0x22, 0x12, 0x06, 0x89, 0xFF, 0x90, -+0xA0, 0xC3, 0xF0, 0xBF, 0x01, 0x08, 0x12, 0x69, 0xC0, 0xE4, 0x90, 0xA0, 0xC3, 0xF0, 0x22, 0x12, -+0x06, 0x89, 0x54, 0x01, 0xFF, 0x90, 0xA2, 0x7D, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x06, -+0x89, 0x90, 0xA1, 0x42, 0xF0, 0x22, 0x71, 0xA2, 0x90, 0xA1, 0x43, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, -+0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x12, 0x6F, 0x06, 0x90, 0xA1, 0x44, 0xF0, 0x12, -+0x6D, 0x9A, 0x90, 0xA1, 0x45, 0xF0, 0x71, 0xAA, 0x90, 0xA1, 0x43, 0xE0, 0x54, 0x01, 0xFF, 0x02, -+0x80, 0xB0, 0x12, 0x06, 0x89, 0xFF, 0x54, 0x01, 0xFE, 0x22, 0x90, 0xA1, 0x44, 0xE0, 0x14, 0x90, -+0xA1, 0x46, 0xF0, 0x22, 0x71, 0xA2, 0x90, 0xA1, 0x47, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0x54, -+0x02, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0xA0, 0xDA, 0xE0, 0x54, 0xEF, 0x4F, 0xF0, 0x90, -+0xA1, 0x47, 0xE0, 0x54, 0x01, 0xFF, 0x02, 0x87, 0x01, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, -+0xA5, 0x1B, 0xF0, 0x90, 0xA5, 0x1B, 0xE0, 0xFD, 0x70, 0x02, 0x81, 0xE3, 0x90, 0xA0, 0x27, 0xE0, -+0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA0, 0x28, 0xE0, -+0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, -+0x44, 0x01, 0xF0, 0x22, 0x90, 0xA5, 0x17, 0x12, 0x7F, 0xD0, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x81, 0xC6, 0xE4, 0x90, 0xA5, 0x1C, 0xF0, 0x90, -+0xA5, 0x1C, 0xE0, 0xF9, 0xC3, 0x94, 0x04, 0x50, 0x43, 0x91, 0xE5, 0xA4, 0xFF, 0xE9, 0xFD, 0x7C, -+0x00, 0x2F, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xD0, 0x91, 0xED, 0xE0, 0xB1, 0x7B, 0xE5, 0x82, -+0x29, 0x12, 0x4F, 0xC9, 0xEF, 0x91, 0xE4, 0xA4, 0x2D, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xF0, -+0x91, 0xED, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x9F, 0xDB, 0x12, 0x48, 0xDE, 0xE5, 0x82, 0x29, 0x12, -+0x4F, 0xC9, 0xEF, 0xF0, 0x90, 0xA5, 0x1C, 0xE0, 0x04, 0xF0, 0x80, 0xB3, 0x90, 0xA5, 0x1B, 0xE0, -+0xFF, 0x90, 0xA5, 0x17, 0xB1, 0x13, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0xA5, -+0x1B, 0xF0, 0x90, 0xA5, 0x17, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0xA5, 0x17, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, -+0x90, 0xA0, 0x28, 0xB1, 0x74, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x61, 0xE3, 0xE4, -+0x90, 0xA0, 0x28, 0xF0, 0x61, 0xE3, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0xA5, 0x17, -+0xE0, 0x44, 0x80, 0x90, 0x00, 0x8A, 0x91, 0xE4, 0x90, 0x01, 0xD0, 0x12, 0x48, 0xDE, 0xE0, 0x90, -+0x01, 0xC3, 0xF0, 0x22, 0xF0, 0x90, 0xA5, 0x17, 0xE0, 0x75, 0xF0, 0x04, 0x22, 0x2F, 0xF5, 0x82, -+0x74, 0x01, 0x3E, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA0, 0x28, 0x22, 0x71, 0xD9, 0x7F, 0x02, 0x8F, -+0x27, 0x7F, 0x02, 0x12, 0x47, 0x07, 0x90, 0x9F, 0x13, 0xE0, 0x45, 0x27, 0xF0, 0x22, 0xE0, 0xFF, -+0x90, 0xA4, 0xB8, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0xA0, 0x28, 0xE0, 0xFF, 0x90, 0xA0, 0x27, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, -+0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x38, 0x90, 0xA0, 0x27, 0xE0, 0xFE, 0xB1, 0x7B, 0xE0, 0xFD, -+0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0xD8, 0xF9, 0x74, 0x9F, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, -+0x05, 0x12, 0x5C, 0xEF, 0x90, 0xA0, 0x27, 0xB1, 0x74, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, -+0x05, 0xE4, 0x90, 0xA0, 0x27, 0xF0, 0x71, 0xD9, 0x90, 0x9F, 0x13, 0xE0, 0x44, 0x02, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0x22, 0x75, 0xF0, 0x08, 0x90, 0x9F, -+0xD7, 0x02, 0x48, 0xDE, 0x90, 0xA3, 0x43, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, 0x23, 0xA3, -+0xE0, 0xF5, 0x24, 0x65, 0x23, 0x60, 0x6B, 0x90, 0xA3, 0x44, 0x74, 0x03, 0xF0, 0x90, 0xA3, 0x52, -+0x74, 0x08, 0xF0, 0xE5, 0x24, 0x04, 0x54, 0x0F, 0xF5, 0x25, 0xE4, 0xF5, 0x22, 0xE5, 0x25, 0x75, -+0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x22, -+0x12, 0x4F, 0xC9, 0xE0, 0xFF, 0x74, 0x46, 0x25, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, -+0xEF, 0xF0, 0x05, 0x22, 0xE5, 0x22, 0xB4, 0x08, 0xD4, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x44, 0x12, -+0x69, 0x59, 0xE5, 0x24, 0x04, 0x54, 0x0F, 0xF5, 0x24, 0xB4, 0x0F, 0x03, 0xE4, 0xF5, 0x24, 0x90, -+0x04, 0x7F, 0xE5, 0x24, 0xF0, 0x90, 0xA3, 0x43, 0xE0, 0x7F, 0x04, 0x70, 0x02, 0x81, 0xFF, 0x12, -+0x68, 0x6F, 0x22, 0xE4, 0xFF, 0xA1, 0x84, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, -+0xDD, 0xEE, 0x12, 0xB8, 0x87, 0x90, 0xA4, 0xDD, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, -+0xE0, 0x60, 0x24, 0xC3, 0x90, 0xA4, 0xE0, 0xE0, 0x94, 0xE8, 0x90, 0xA4, 0xDF, 0xE0, 0x94, 0x03, -+0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x0C, 0x90, 0xA4, 0xDF, -+0x12, 0x57, 0xF9, 0xF1, 0x6F, 0x80, 0xCE, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xE5, 0x12, 0x48, 0xF3, 0x7F, 0x96, 0x7E, 0x02, 0xD1, -+0x07, 0xEF, 0x60, 0x47, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xF1, 0x76, 0x3E, 0xFE, -+0xF1, 0x7E, 0x90, 0xA4, 0xE8, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0xA4, 0xE8, -+0xE0, 0xFD, 0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA4, 0xE5, 0xF1, 0x86, 0x24, 0x02, -+0xFF, 0xE4, 0x33, 0xFE, 0xD1, 0xB0, 0x90, 0xA4, 0xE8, 0xE0, 0x24, 0x18, 0xFF, 0x90, 0xA4, 0xE5, -+0x12, 0x48, 0xEA, 0xF1, 0xD0, 0x90, 0x02, 0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, 0xF1, 0x01, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xF3, 0x74, -+0x00, 0x2D, 0xF1, 0x01, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, -+0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, -+0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, -+0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0xE4, 0xFF, 0x90, 0xA0, 0xC0, 0xE0, 0xFE, 0x90, 0xA0, 0xBF, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, -+0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, 0x3F, 0xED, 0xF1, 0x8F, 0xFA, 0x7B, 0x01, -+0xD1, 0x4E, 0x7F, 0x01, 0xEF, 0x60, 0x32, 0x90, 0xA0, 0xBF, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, -+0x02, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA0, 0xBF, 0xF0, 0x90, 0xA0, 0xC0, -+0xE0, 0xFF, 0x90, 0xA0, 0xBF, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, -+0x70, 0x07, 0x90, 0x9F, 0x13, 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x7F, -+0x0A, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x22, 0xEF, 0x24, -+0x01, 0xFF, 0xE4, 0x3E, 0xFE, 0x22, 0x12, 0x48, 0xEA, 0x90, 0x00, 0x0E, 0x02, 0x06, 0xA2, 0x75, -+0xF0, 0x0F, 0xA4, 0x24, 0x29, 0xF9, 0x74, 0xA0, 0x35, 0xF0, 0x22, 0x90, 0x01, 0x9A, 0xE0, 0x54, -+0xC0, 0x44, 0x0B, 0xF1, 0x6E, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, -+0x7F, 0x01, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, -+0xF1, 0x6E, 0x90, 0x01, 0x99, 0xE0, 0x44, 0xC0, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x80, 0xF0, 0x22, -+0x90, 0xA4, 0xE1, 0xEF, 0xF0, 0xA3, 0x12, 0x48, 0xF3, 0x90, 0xA5, 0x18, 0xE0, 0xFE, 0x04, 0xF0, -+0x90, 0x00, 0x01, 0xEE, 0x12, 0x06, 0xE1, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, -+0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0xA4, 0xE2, 0x12, 0x48, 0xEA, 0x8B, 0x40, 0x8A, -+0x41, 0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x90, -+0xA4, 0xE1, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, -+0xC0, 0x01, 0xA3, 0x12, 0x48, 0xEA, 0xE9, 0x24, 0x02, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, -+0x89, 0x42, 0x90, 0xA4, 0xE2, 0x12, 0x9F, 0x86, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, -+0x02, 0x34, 0x62, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, -+0xE4, 0x90, 0xA2, 0x7E, 0xF0, 0xA3, 0xF0, 0x12, 0x9F, 0x9B, 0xEF, 0x64, 0x01, 0x60, 0x3D, 0xC3, -+0x90, 0xA2, 0x7F, 0xE0, 0x94, 0x88, 0x90, 0xA2, 0x7E, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, -+0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1F, 0x90, 0xA2, 0x7E, -+0x12, 0x57, 0xF9, 0x12, 0x96, 0xDB, 0xD3, 0x90, 0xA2, 0x7F, 0xE0, 0x94, 0x32, 0x90, 0xA2, 0x7E, -+0xE0, 0x94, 0x00, 0x40, 0xC2, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xBB, 0x90, 0x01, 0xC7, 0x74, -+0xFE, 0xF0, 0x22, 0x7F, 0x02, 0x90, 0xA1, 0x50, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, -+0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, -+0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x9F, 0x13, 0x02, 0x4F, -+0xAF, 0x90, 0x01, 0xE4, 0x74, 0x25, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, -+0x59, 0xF5, 0x5D, 0xA3, 0xE0, 0x55, 0x5A, 0xF5, 0x5E, 0xA3, 0xE0, 0x55, 0x5B, 0xF5, 0x5F, 0xA3, -+0xE0, 0x55, 0x5C, 0xF5, 0x60, 0x90, 0x01, 0x34, 0xE5, 0x5D, 0xF0, 0xA3, 0xE5, 0x5E, 0xF0, 0xA3, -+0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x61, 0xF5, 0x65, -+0xA3, 0xE0, 0x55, 0x62, 0xF5, 0x66, 0xA3, 0xE0, 0x55, 0x63, 0xF5, 0x67, 0xA3, 0xE0, 0x55, 0x64, -+0xF5, 0x68, 0x90, 0x01, 0x3C, 0xE5, 0x65, 0xF0, 0xA3, 0xE5, 0x66, 0xF0, 0xA3, 0xE5, 0x67, 0xF0, -+0xA3, 0xE5, 0x68, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0xA3, 0x43, 0xF0, -+0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, 0x23, -+0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, 0xA8, -+0xF5, 0xE8, 0x12, 0x4F, 0x4C, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x4A, -+0x26, 0x80, 0xFE, 0x22, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x05, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, -+0x22, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x10, 0xA3, 0x74, 0x01, 0xF0, 0x90, 0xA0, 0xD5, 0xE0, -+0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x31, 0xA6, 0x12, 0x82, 0xD0, 0x90, 0xA1, 0x51, 0xE0, 0x30, -+0xE0, 0x03, 0x12, 0x71, 0xB3, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x84, 0x66, -+0xBF, 0x01, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x12, 0x5D, 0xB9, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0xA0, 0xD5, 0xE0, 0xFF, 0x30, 0xE0, 0x40, 0x90, 0xA0, 0xD9, 0xE0, 0x7E, 0x00, 0xB4, -+0x02, 0x02, 0x7E, 0x01, 0x90, 0xA0, 0xD8, 0xE0, 0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, -+0x4E, 0x70, 0x26, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x04, 0x31, 0xA6, 0x80, 0x1C, 0x12, 0x8E, 0xC9, -+0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x08, 0x06, 0xE4, 0xFD, 0x7F, 0x0C, 0x80, 0x09, 0x90, 0xA0, 0xD9, -+0xE0, 0x70, 0x06, 0xFD, 0x7F, 0x04, 0x12, 0x58, 0xE9, 0x90, 0xA1, 0xC6, 0x51, 0x4B, 0x30, 0xE0, -+0x1B, 0x90, 0xA1, 0x51, 0xE0, 0xFF, 0x30, 0xE0, 0x13, 0xC3, 0x13, 0x54, 0x07, 0x12, 0x57, 0xAC, -+0xFE, 0x51, 0x2D, 0xEE, 0x60, 0x03, 0xB4, 0x02, 0x03, 0x12, 0x50, 0x4D, 0x22, 0x12, 0x55, 0x00, -+0x20, 0xE0, 0x07, 0xC3, 0x13, 0x30, 0xE0, 0x08, 0x80, 0x07, 0x12, 0x55, 0x00, 0x44, 0x04, 0xF0, -+0x22, 0x90, 0xA1, 0x53, 0x74, 0x05, 0xF0, 0x22, 0x90, 0xA0, 0xD5, 0xE0, 0xC4, 0x13, 0x13, 0x54, -+0x03, 0x22, 0xAE, 0x07, 0x12, 0x84, 0x66, 0xBF, 0x01, 0x0F, 0x51, 0x48, 0x20, 0xE0, 0x0A, 0xAF, -+0x06, 0x7D, 0x01, 0x12, 0x58, 0xE9, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0xA0, 0xD5, 0xE0, -+0xFF, 0x30, 0xE0, 0x05, 0x12, 0x8E, 0xE0, 0x60, 0x1B, 0x90, 0xA0, 0xDF, 0xE0, 0x70, 0x04, 0xEF, -+0x30, 0xE0, 0x0B, 0x90, 0xA0, 0xE2, 0xE0, 0x64, 0x02, 0x60, 0x09, 0x12, 0x81, 0x16, 0x90, 0x01, -+0xE6, 0xE0, 0x04, 0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x82, 0x72, 0xBF, 0x01, 0x10, 0x90, 0xA0, 0xDF, -+0xE0, 0x60, 0x0A, 0x12, 0x8E, 0x3C, 0x54, 0x07, 0x70, 0x03, 0x12, 0x58, 0xD0, 0x22, 0xE4, 0xFF, -+0x02, 0x7C, 0x84, 0x90, 0x07, 0x1F, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, -+0xFF, 0x90, 0xA3, 0x45, 0xF0, 0x90, 0xA3, 0x43, 0x74, 0x02, 0xF0, 0x90, 0xA3, 0x51, 0x14, 0xF0, -+0xFB, 0x7A, 0xA3, 0x79, 0x43, 0x12, 0x69, 0x59, 0x7F, 0x04, 0x02, 0x68, 0x6F, 0x90, 0xA0, 0xDF, -+0xE0, 0x60, 0x03, 0x12, 0x85, 0x65, 0x02, 0x50, 0x4D, 0x90, 0xA1, 0x51, 0xE0, 0x30, 0xE0, 0x07, -+0x90, 0xA1, 0xC6, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0x22, 0x90, 0xA1, 0x51, 0xE0, 0x30, 0xE0, 0x0E, -+0x12, 0x6D, 0xA0, 0x30, 0xE0, 0x08, 0xA3, 0xE0, 0x44, 0x20, 0xF0, 0x44, 0x40, 0xF0, 0x22, 0x90, -+0xA0, 0xDA, 0xE0, 0xFF, 0x12, 0x6D, 0xA4, 0x30, 0xE0, 0x24, 0xEF, 0x54, 0x7F, 0xF0, 0x90, 0x04, -+0xE0, 0xE0, 0x90, 0xA0, 0xDB, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, 0x54, -+0xFD, 0x71, 0x49, 0x04, 0xF0, 0x90, 0xA0, 0xDF, 0xE0, 0x60, 0x03, 0x12, 0x58, 0xD0, 0x90, 0x04, -+0xE0, 0xE0, 0x30, 0xE1, 0x03, 0x12, 0x54, 0x7D, 0x22, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, -+0x90, 0x01, 0xB8, 0x22, 0xE4, 0x90, 0xA3, 0x55, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x4B, 0xB4, -+0x90, 0xA3, 0x54, 0xEF, 0xF0, 0x7F, 0x83, 0x12, 0x4B, 0xB4, 0xAE, 0x07, 0x90, 0xA3, 0x54, 0xE0, -+0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0xA3, 0x56, 0xE0, 0x94, 0x64, 0x90, 0xA3, 0x55, 0xE0, -+0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA3, 0x54, 0xE0, 0xFF, -+0x22, 0x90, 0xA3, 0x55, 0x12, 0x57, 0xF9, 0x80, 0xC2, 0x90, 0x01, 0xC4, 0x74, 0x99, 0xF0, 0x74, -+0xA3, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x4B, 0xB4, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0x99, 0x04, 0x90, -+0x01, 0xC4, 0xF0, 0x74, 0xA3, 0xA3, 0xF0, 0x22, 0x7E, 0xFF, 0xED, 0xC3, 0x94, 0x33, 0x40, 0x19, -+0xED, 0xD3, 0x94, 0x35, 0x50, 0x13, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4F, 0x45, 0xC4, 0x13, 0x54, -+0x07, 0x30, 0xE0, 0x05, 0xED, 0x14, 0x44, 0x80, 0xFE, 0xED, 0x14, 0xFD, 0x12, 0x7D, 0xB9, 0xED, -+0xF0, 0xAF, 0x06, 0x22, 0xE4, 0xF5, 0x1C, 0x12, 0x6C, 0xB8, 0xE0, 0xFE, 0xB4, 0x05, 0x14, 0xED, -+0xC3, 0x94, 0x3B, 0x50, 0x5B, 0xED, 0xC3, 0x94, 0x31, 0x40, 0x5D, 0xED, 0xD3, 0x94, 0x35, 0x50, -+0x57, 0x80, 0x4D, 0xEE, 0xB4, 0x04, 0x08, 0xED, 0xC3, 0x94, 0x31, 0x40, 0x4B, 0x80, 0x41, 0x12, -+0x6C, 0xB8, 0xE0, 0xFE, 0xB4, 0x03, 0x14, 0xED, 0xC3, 0x94, 0x19, 0x50, 0x0C, 0xED, 0xC3, 0x94, -+0x11, 0x40, 0x35, 0xED, 0xD3, 0x94, 0x13, 0x50, 0x2F, 0x80, 0x25, 0xEE, 0xB4, 0x02, 0x08, 0xED, -+0xC3, 0x94, 0x11, 0x40, 0x23, 0x80, 0x19, 0x12, 0x6C, 0xB8, 0xE0, 0xFE, 0xB4, 0x01, 0x08, 0xED, -+0xC3, 0x94, 0x0A, 0x40, 0x13, 0x80, 0x09, 0xEE, 0x70, 0x0B, 0xED, 0xC3, 0x94, 0x03, 0x40, 0x08, -+0x75, 0x1C, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x1C, 0xAF, 0x1C, 0x22, 0x8F, 0x10, 0x8D, 0x11, 0x8B, -+0x12, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x4D, 0xC2, 0xC4, 0x54, 0x03, 0x90, 0xA2, 0x91, 0xF0, 0x90, -+0xA2, 0x8F, 0x60, 0x09, 0x74, 0x32, 0xF0, 0xA3, 0x74, 0x2F, 0xF0, 0x80, 0x07, 0x74, 0x11, 0xF0, -+0xA3, 0x74, 0x0F, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x10, 0x12, 0x78, 0xE7, 0xE0, 0xFD, 0x90, 0xA4, -+0x60, 0x74, 0x04, 0xF0, 0xE4, 0xFB, 0xAF, 0x10, 0x91, 0xD7, 0xE5, 0x11, 0xD3, 0x94, 0x2D, 0x40, -+0x0A, 0x75, 0xF0, 0x04, 0xE5, 0x10, 0x12, 0x6F, 0xE7, 0x80, 0x20, 0xE5, 0x11, 0xD3, 0x94, 0x1E, -+0x40, 0x05, 0x90, 0xA2, 0x8F, 0x80, 0x14, 0xE5, 0x11, 0xD3, 0x94, 0x14, 0x40, 0x05, 0x90, 0xA2, -+0x90, 0x80, 0x08, 0x75, 0xF0, 0x04, 0xE5, 0x10, 0x12, 0x6E, 0x39, 0xE0, 0xFD, 0x85, 0x12, 0x73, -+0xE4, 0xFB, 0xAF, 0x10, 0x02, 0x7A, 0x82, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, -+0x63, 0xED, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA4, 0x60, 0xE0, 0x90, 0xA4, 0x66, -+0xF0, 0x90, 0xA4, 0x61, 0x74, 0x0C, 0xF0, 0x90, 0xA4, 0x6F, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, -+0xA4, 0x79, 0x61, 0x12, 0x68, 0x6B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x04, 0x30, 0x12, 0x97, 0x81, 0x90, 0xA2, 0x81, 0xE0, 0x90, 0x04, 0x33, 0xF0, -+0x90, 0xA2, 0x82, 0xE0, 0x90, 0x04, 0x34, 0xF0, 0x90, 0xA2, 0x83, 0xE0, 0x90, 0x04, 0x35, 0xF0, -+0x90, 0xA2, 0x84, 0xE0, 0x90, 0x04, 0x36, 0xF0, 0x90, 0xA2, 0x85, 0xE0, 0x90, 0x04, 0x37, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0xEF, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x03, 0x7F, 0x05, -+0x22, 0xD3, 0xEF, 0x94, 0xC8, 0xEE, 0x94, 0x00, 0x7F, 0x00, 0x40, 0x02, 0x7F, 0x02, 0x22, 0x90, -+0xA2, 0x97, 0x12, 0x97, 0x7E, 0x90, 0xA2, 0x99, 0xE0, 0xD1, 0x34, 0x7B, 0x01, 0x90, 0xA2, 0x9E, -+0x12, 0x48, 0xF3, 0x90, 0xA2, 0x9A, 0xE0, 0xD1, 0x44, 0xA3, 0x12, 0x48, 0xF3, 0xD1, 0x17, 0xFF, -+0xB1, 0x45, 0x8F, 0x20, 0xA3, 0xD1, 0x1F, 0xE0, 0xF5, 0x1C, 0xA3, 0xE0, 0xF5, 0x1D, 0xE4, 0xF5, -+0x21, 0x90, 0xA2, 0x9E, 0x12, 0x48, 0xEA, 0x75, 0xF0, 0x02, 0xE5, 0x21, 0xD1, 0x5E, 0xA8, 0x20, -+0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xA2, 0x9B, 0x12, 0x48, -+0xEA, 0x85, 0x21, 0x82, 0x12, 0x67, 0xEE, 0xD1, 0x2C, 0x25, 0x1D, 0xF5, 0x1D, 0xEE, 0x35, 0x1C, -+0xF5, 0x1C, 0x05, 0x21, 0xE5, 0x21, 0xB4, 0x05, 0xC8, 0x90, 0xA2, 0x9B, 0x12, 0x48, 0xEA, 0x12, -+0x6E, 0x6C, 0xFD, 0x7C, 0x00, 0xD1, 0x17, 0xA8, 0x20, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, -+0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x07, 0x03, 0x8E, 0x1E, 0x8F, 0x1F, 0xD3, 0xE5, 0x1D, 0x95, 0x1F, -+0xE5, 0x1C, 0x95, 0x1E, 0x40, 0x0C, 0xE5, 0x1D, 0x95, 0x1F, 0xFF, 0xE5, 0x1C, 0x95, 0x1E, 0xFE, -+0x80, 0x04, 0x7E, 0x00, 0x7F, 0x00, 0x8E, 0x1C, 0x8F, 0x1D, 0x90, 0xA2, 0x99, 0xD1, 0x1F, 0xE5, -+0x1C, 0xF0, 0xA3, 0xE5, 0x1D, 0xF0, 0x22, 0x90, 0xA2, 0x97, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0xE0, -+0x25, 0xE0, 0x24, 0x91, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0xFD, 0x7C, 0x00, 0x12, -+0x07, 0x03, 0xEF, 0x22, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x01, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, -+0x22, 0x8F, 0x16, 0xEF, 0x75, 0xF0, 0x06, 0xA4, 0x24, 0x62, 0xF9, 0x74, 0x40, 0x35, 0xF0, 0xFA, -+0x7B, 0xFF, 0x22, 0x90, 0xA2, 0x8B, 0x12, 0x48, 0xEA, 0x75, 0xF0, 0x02, 0xE5, 0x18, 0xA4, 0xF5, -+0x82, 0x85, 0xF0, 0x83, 0x12, 0x07, 0xAB, 0xAE, 0xF0, 0x22, 0xE4, 0x90, 0xA2, 0xA1, 0xF0, 0x90, -+0xA2, 0xA1, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x50, 0x60, 0x74, 0x22, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x9F, 0xF5, 0x83, 0xE0, 0xFF, 0xD3, 0x94, 0x0A, 0x50, 0x02, 0x80, 0x02, 0x7F, 0x0A, 0xAE, 0x07, -+0xEF, 0x24, 0x02, 0x90, 0xA2, 0xA0, 0xF0, 0x90, 0xA2, 0x92, 0x74, 0x0E, 0xF0, 0x90, 0xA2, 0x94, -+0x74, 0x01, 0xF0, 0xD1, 0xDA, 0xE0, 0x90, 0xA2, 0x95, 0xF0, 0xE4, 0xFF, 0xEF, 0xC3, 0x9E, 0x50, -+0x17, 0xD1, 0xDA, 0xE0, 0x2F, 0xD1, 0xE8, 0xE0, 0xFD, 0x74, 0x96, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0xA2, 0xF5, 0x83, 0xED, 0xF0, 0x0F, 0x80, 0xE4, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x92, 0x12, 0x68, -+0x6B, 0x90, 0xA2, 0xA1, 0xE0, 0x04, 0xF0, 0x80, 0x96, 0x22, 0x90, 0xA2, 0xA1, 0xE0, 0x24, 0x1C, -+0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0x22, 0x24, 0x7C, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, -+0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFE, 0xFC, 0xEF, 0x64, 0x02, 0x70, -+0x40, 0xED, 0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, 0x06, 0xED, 0xB4, 0x02, 0x02, 0x7E, 0x09, 0xEB, -+0xB4, 0x01, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x04, 0x80, 0x38, 0xEB, 0xB4, 0x02, 0x08, 0xED, -+0xB4, 0x01, 0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x02, 0x04, 0x7C, -+0x01, 0x80, 0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, 0xED, 0x64, 0x02, 0x70, 0x16, 0x7C, 0x03, 0x80, -+0x12, 0xEF, 0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x06, 0xEB, 0xB4, 0x01, -+0x02, 0x7C, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4C, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0xA5, 0x12, 0xED, 0xF0, 0x90, 0xA5, 0x11, 0xEF, 0xF0, 0x70, 0x79, 0x90, 0xA4, 0x85, 0x12, -+0x08, 0x79, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x30, 0x00, 0x00, 0x00, -+0x74, 0x08, 0xFF, 0xFE, 0x12, 0x77, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0F, 0x00, 0x90, 0xA4, -+0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x12, 0xA8, 0x59, 0x12, 0x08, 0x79, 0x30, 0x00, -+0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, -+0x12, 0x77, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, -+0x00, 0x00, 0x00, 0x10, 0x7F, 0x0C, 0x12, 0x77, 0x87, 0x12, 0x08, 0x79, 0x0F, 0x00, 0x00, 0x00, -+0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x01, 0x00, 0x00, 0x00, 0x12, 0x77, 0x16, 0x90, 0x04, 0x54, -+0xE0, 0x54, 0x7F, 0x80, 0x6A, 0x90, 0xA5, 0x11, 0xE0, 0x64, 0x01, 0x70, 0x61, 0x90, 0x04, 0x54, -+0xE0, 0x44, 0x80, 0x12, 0xA8, 0x4F, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x30, 0x00, 0x00, 0x00, -+0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x12, 0x77, -+0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0F, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x01, 0x00, 0x11, 0x59, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA4, 0x89, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x0C, 0x12, 0x77, 0x87, 0x12, 0x08, 0x79, 0x0F, 0x00, 0x00, -+0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x0F, 0x00, 0x00, 0x00, 0x12, 0x77, 0x16, 0x22, 0x90, -+0xA5, 0x13, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x22, 0x7F, 0x1C, 0x7E, 0x0C, 0x12, 0x77, 0x1A, -+0x90, 0xA5, 0x11, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x11, 0x6E, 0x90, 0xA4, 0x85, 0x22, 0xEF, 0x90, -+0xA4, 0x85, 0x70, 0x2B, 0x12, 0x08, 0x79, 0x00, 0x00, 0xF0, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x70, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x77, 0x89, 0x12, 0x08, 0x79, 0x00, -+0x00, 0x00, 0xF0, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x70, 0x80, 0x29, 0x12, -+0x08, 0x79, 0x00, 0x00, 0xF0, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x50, 0x00, -+0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x77, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA4, -+0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x40, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x77, 0x89, 0x12, -+0x08, 0x79, 0x00, 0x10, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, -+0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x77, 0x89, 0x12, 0x08, 0x79, 0x00, 0x40, 0x00, 0x00, 0x90, 0xA4, -+0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x77, 0x89, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x00, 0x07, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x07, -+0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x77, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x07, 0x00, 0x90, 0xA4, -+0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x07, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, 0x02, 0x77, 0x1A, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xA4, 0xEF, 0xF0, 0x90, 0xA4, 0x85, 0x12, 0x08, -+0x79, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, -+0x2C, 0x7E, 0x08, 0x12, 0x77, 0x1A, 0x51, 0x16, 0xE4, 0x7B, 0x12, 0x7A, 0x01, 0xF9, 0xF8, 0xD3, -+0x12, 0x48, 0x27, 0x40, 0x2D, 0x51, 0x16, 0xE4, 0x7B, 0xEE, 0x1A, 0xF8, 0xC3, 0x12, 0x48, 0x27, -+0x50, 0x20, 0x90, 0xA4, 0xA9, 0x51, 0x19, 0xE4, 0x7B, 0x12, 0xF8, 0xD3, 0x12, 0x48, 0x27, 0x50, -+0x51, 0x90, 0xA4, 0xA9, 0x51, 0x19, 0xE4, 0x7B, 0xEE, 0x7A, 0x03, 0xF8, 0xC3, 0x12, 0x48, 0x27, -+0x40, 0x40, 0x51, 0x24, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA4, 0x85, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x03, 0xFF, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x01, 0x00, 0xD0, -+0x07, 0xD0, 0x06, 0x51, 0x21, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA4, 0x85, 0x12, -+0x08, 0x79, 0x03, 0xFF, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, -+0x80, 0x38, 0x51, 0x24, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA4, 0x85, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x03, 0xFF, 0x51, 0x16, 0x51, 0x39, 0xD0, 0x07, 0xD0, 0x06, 0x51, 0x21, 0x12, -+0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x03, 0xFF, 0x00, 0x00, -+0x90, 0xA4, 0xA9, 0x12, 0x48, 0xC6, 0x78, 0x0F, 0x51, 0x36, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x77, -+0x1A, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA4, 0xA5, 0x12, 0x48, 0xC6, 0x78, 0x01, 0x02, 0x08, -+0x47, 0x12, 0x77, 0x1A, 0x90, 0xA4, 0xA4, 0xE0, 0x75, 0xF0, 0x1E, 0xA4, 0x24, 0x6F, 0xF5, 0x82, -+0xE4, 0x34, 0x44, 0x22, 0x78, 0x1C, 0x12, 0x08, 0x5A, 0x90, 0xA4, 0x89, 0x02, 0x08, 0x6D, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xAD, 0xEF, 0xF0, 0x90, 0xA4, 0x85, 0x12, 0x08, -+0x79, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x7F, -+0x2C, 0x7E, 0x08, 0x12, 0x77, 0x1A, 0x71, 0x1A, 0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x12, -+0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x80, -+0xD0, 0x07, 0xD0, 0x06, 0x71, 0x17, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x12, 0x66, 0x8E, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x20, 0x04, 0x00, 0x00, 0xD0, 0x07, -+0xD0, 0x06, 0x71, 0x17, 0x24, 0x77, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x12, 0x66, 0x8E, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x20, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, -+0x71, 0x17, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x00, 0x00, 0x07, 0xFF, 0x90, 0xA4, 0xB2, 0x12, 0x48, 0xC6, -+0x51, 0x39, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x77, 0x1A, 0x71, 0x1A, 0x24, 0x7B, 0xF5, 0x82, 0xE4, -+0x34, 0x44, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x00, -+0x00, 0x07, 0xFF, 0x90, 0xA4, 0xAE, 0x12, 0x48, 0xC6, 0x51, 0x39, 0xD0, 0x07, 0xD0, 0x06, 0x12, -+0x77, 0x1A, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x38, 0x07, 0x90, 0xA4, 0xAD, 0xE0, 0x75, 0xF0, -+0x1E, 0xA4, 0x22, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, -+0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x2C, 0x7E, 0x08, 0x12, 0x77, 0x1A, 0x90, 0x05, -+0x22, 0x74, 0x3F, 0x71, 0x94, 0xF0, 0xA3, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0xA4, 0x85, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x74, -+0x08, 0xFF, 0xFE, 0x12, 0x77, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x0F, 0x90, 0xA4, 0x89, -+0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x0C, 0x7F, 0x38, 0x12, 0x77, 0x87, 0x12, 0x08, 0x79, 0xFF, -+0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x0F, 0x7F, 0x04, 0x7E, -+0x0A, 0x02, 0x77, 0x1A, 0xF0, 0x90, 0x05, 0x50, 0xE0, 0x54, 0xF7, 0x22, 0x90, 0xA3, 0x35, 0xEF, -+0xF0, 0xA3, 0xED, 0xF0, 0xE4, 0xA3, 0xF0, 0x12, 0x66, 0x7F, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, -+0xB9, 0x12, 0x08, 0x79, 0x00, 0x10, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x67, 0x88, 0x12, -+0x08, 0x79, 0xFA, 0x00, 0x00, 0x00, 0x7F, 0x80, 0x7E, 0x09, 0x12, 0x67, 0x88, 0x12, 0x08, 0x79, -+0xF8, 0x00, 0x00, 0x00, 0x7F, 0x80, 0x7E, 0x09, 0x12, 0x38, 0x07, 0x7F, 0x03, 0x7E, 0x00, 0x12, -+0x3C, 0xEC, 0x90, 0xA3, 0x35, 0xE0, 0x60, 0x04, 0xA3, 0xE0, 0x70, 0x07, 0x7F, 0x04, 0x7E, 0x00, -+0x12, 0x3C, 0xEC, 0xE4, 0x90, 0xA3, 0x38, 0xF0, 0xB1, 0x6E, 0x12, 0x66, 0x8E, 0x12, 0x37, 0xBC, -+0xE4, 0xFF, 0xEE, 0x54, 0x04, 0xFE, 0xE4, 0xFD, 0xFC, 0x78, 0x0A, 0x12, 0x08, 0x47, 0xEF, 0x70, -+0x18, 0x90, 0xA3, 0x38, 0xE0, 0xD3, 0x94, 0x14, 0x50, 0x0F, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3C, -+0xEC, 0x90, 0xA3, 0x38, 0xE0, 0x04, 0xF0, 0x80, 0xCF, 0x12, 0x66, 0x7F, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x38, -+0x07, 0x90, 0xA3, 0x38, 0xE0, 0xC3, 0x94, 0x14, 0x40, 0x02, 0xA1, 0x5F, 0x90, 0xA3, 0x36, 0xE0, -+0x70, 0x45, 0xB1, 0x6E, 0x12, 0x66, 0x8E, 0xB1, 0x8D, 0xF0, 0x70, 0x33, 0x12, 0x66, 0x7F, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x02, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, -+0x06, 0x12, 0x66, 0x54, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x04, 0x00, -+0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0xB1, 0x6B, 0x12, 0x66, 0x8E, 0xB1, 0xA1, 0xA1, 0x65, 0xB1, -+0x7E, 0x60, 0x02, 0x61, 0xA7, 0xA1, 0x65, 0xB1, 0x6E, 0x12, 0x66, 0x8E, 0xB1, 0x8D, 0xF0, 0x60, -+0x02, 0xA1, 0x57, 0x12, 0x66, 0x7F, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, -+0x06, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x66, 0x54, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0xAA, 0xB9, 0x12, 0x08, 0x79, 0x08, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0xB1, 0x6B, 0x12, -+0x66, 0x8E, 0xB1, 0xA1, 0x12, 0x66, 0x7F, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, -+0x79, 0x05, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0xB1, 0x6B, 0x12, 0x66, 0x8E, 0x12, 0x37, -+0xBC, 0x90, 0xA3, 0x3B, 0x12, 0x66, 0x7C, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, -+0x79, 0x06, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0xB1, 0x6B, 0x12, 0x66, 0x8E, 0xB1, 0x95, -+0x90, 0xA3, 0x3F, 0x12, 0x66, 0x7C, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, -+0x07, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0xB1, 0x6B, 0x12, 0x66, 0x8E, 0x12, 0x37, 0xBC, -+0x90, 0xA3, 0x3B, 0x12, 0x66, 0x7C, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, -+0x08, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0xB1, 0x6B, 0x12, 0x66, 0x8E, 0xB1, 0x95, 0x90, -+0xA3, 0x3F, 0x12, 0x08, 0x6D, 0x80, 0x0E, 0xB1, 0x7E, 0x60, 0x02, 0x61, 0xA7, 0x80, 0x06, 0xB1, -+0x7E, 0x60, 0x02, 0x61, 0xA7, 0x90, 0xA3, 0x3A, 0xE0, 0xFF, 0x22, 0x12, 0x38, 0x07, 0x90, 0xA3, -+0x35, 0xE0, 0x75, 0xF0, 0x1E, 0xA4, 0x24, 0x71, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x22, 0xE4, 0x90, -+0xA3, 0x3A, 0xF0, 0x90, 0xA3, 0x37, 0xE0, 0x04, 0xF0, 0xE0, 0x64, 0x0A, 0x22, 0x12, 0x37, 0xBC, -+0xE4, 0x90, 0xA3, 0x39, 0x22, 0x12, 0x37, 0xBC, 0xEF, 0x54, 0x1F, 0xFF, 0xE4, 0xFE, 0xFD, 0xFC, -+0x22, 0x12, 0x37, 0xBC, 0xE4, 0xFF, 0xFE, 0xEC, 0x54, 0x07, 0xFC, 0x90, 0xA4, 0x18, 0x12, 0x08, -+0x6D, 0x90, 0xA3, 0x3A, 0x74, 0x01, 0xF0, 0x22, 0x90, 0xA2, 0xF3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, -+0x90, 0xA3, 0x10, 0x12, 0x4F, 0xAD, 0x78, 0x17, 0x7C, 0xA3, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x44, -+0x79, 0xCD, 0xFE, 0x7F, 0x06, 0x12, 0x06, 0x63, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x80, 0x00, -+0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x12, 0xB5, 0xB2, 0x75, -+0xF0, 0x0C, 0xA4, 0x24, 0xB7, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, -+0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x77, 0x77, 0x77, 0x77, 0xD0, 0x07, 0xD0, 0x06, 0x12, -+0xB9, 0x9C, 0x24, 0xB9, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x77, 0x77, 0x77, 0x77, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0xB9, -+0x9C, 0x24, 0xBB, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0xAA, 0xB9, 0x12, 0x08, 0x79, 0x19, 0x79, 0x19, 0x79, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x38, 0x07, -+0x12, 0xB4, 0xF4, 0x24, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, -+0x07, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x0F, 0x90, 0xA4, 0x89, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x00, 0x04, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0xB5, 0xB6, 0x75, 0xF0, 0x0C, 0xA4, -+0x12, 0x97, 0x6C, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, -+0x07, 0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x07, 0x00, 0x00, 0x00, 0xD0, 0x07, -+0xD0, 0x06, 0x12, 0x77, 0x89, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x12, 0xB6, 0x1C, 0x12, 0x08, 0x79, 0x00, 0x08, 0x00, 0x02, -+0x12, 0x97, 0x5A, 0x12, 0x96, 0xC3, 0x12, 0x08, 0x79, 0x00, 0x02, 0x00, 0x00, 0x12, 0xB6, 0x09, -+0x12, 0x96, 0xC3, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x3F, 0x12, 0xB6, 0x01, 0x12, 0x96, 0xC3, -+0x12, 0x08, 0x79, 0x00, 0x0F, 0x3E, 0xC3, 0x12, 0xB5, 0xF9, 0x12, 0x96, 0xC3, 0x12, 0x08, 0x79, -+0x00, 0x09, 0x31, 0xD5, 0x12, 0x96, 0xBC, 0x12, 0x08, 0x79, 0x00, 0x08, 0xA0, 0x01, 0x12, 0xB5, -+0xE9, 0x12, 0x96, 0x78, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x00, 0x00, 0x80, 0x00, 0x7F, 0x0C, -+0x7E, 0x09, 0x12, 0x38, 0x07, 0x12, 0xB4, 0xF4, 0x24, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x12, -+0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x01, -+0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x01, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0xB5, -+0xDA, 0x12, 0x08, 0x79, 0x29, 0x00, 0x20, 0x00, 0x7F, 0x78, 0x7E, 0x09, 0x12, 0x67, 0x88, 0x12, -+0x08, 0x79, 0xA9, 0x00, 0x20, 0x00, 0x7F, 0x7C, 0x7E, 0x09, 0x12, 0x67, 0x88, 0x12, 0x08, 0x79, -+0x00, 0x46, 0x29, 0x10, 0x12, 0xB6, 0x11, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA4, -+0x89, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x12, 0xB4, 0xED, 0x12, 0xB5, 0xF1, 0x12, 0x66, -+0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x82, 0x14, 0x03, 0xE3, 0xD0, -+0x07, 0xD0, 0x06, 0x12, 0x38, 0x07, 0x90, 0xA1, 0xD0, 0xE0, 0x30, 0xE5, 0x19, 0x12, 0xB4, 0xF4, -+0x12, 0xB5, 0xE1, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, -+0x40, 0x16, 0x3E, 0x96, 0x80, 0x1E, 0x90, 0xA1, 0xD0, 0xE0, 0x30, 0xE4, 0x1E, 0x12, 0xB4, 0xF4, -+0x12, 0xB5, 0xE1, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, -+0x00, 0x16, 0x3E, 0x96, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x38, 0x07, 0x12, 0xB4, 0xF4, 0x12, 0xB5, -+0x61, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x18, 0x00, -+0x8C, 0x10, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x38, 0x07, 0x12, 0xB4, 0xF4, 0x12, 0xB5, 0x69, 0x12, -+0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x38, 0x00, 0x8C, 0x10, -+0xD0, 0x07, 0xD0, 0x06, 0x12, 0x38, 0x07, 0xE4, 0x90, 0xA2, 0xF4, 0xF0, 0x90, 0xA2, 0xF3, 0xE0, -+0xFF, 0xE4, 0xFD, 0x12, 0xAB, 0x9C, 0x90, 0xA3, 0x14, 0xB1, 0x89, 0x90, 0xA2, 0xF4, 0xE0, 0xFA, -+0xB1, 0x53, 0xB1, 0x9C, 0xB1, 0x45, 0x12, 0x08, 0x6D, 0xEB, 0x60, 0x06, 0x90, 0xA3, 0x10, 0xE0, -+0x04, 0xF0, 0x90, 0xA2, 0xF4, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x03, 0x40, 0xCE, 0x90, 0xA4, -+0x85, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x00, 0x00, 0xB1, 0xB2, 0xFF, 0x7D, 0x08, 0x12, 0x90, 0x68, 0xE4, 0xFF, 0xEE, 0x54, 0xFC, 0xFE, -+0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x90, 0xA4, 0x77, 0x12, 0x08, 0x6D, 0x90, 0xA4, 0x73, 0x12, -+0x08, 0x79, 0x00, 0x07, 0xFE, 0x00, 0x90, 0xA2, 0xF3, 0xE0, 0xFF, 0x7D, 0x58, 0x7C, 0x00, 0x12, -+0x90, 0xBC, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, -+0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x7F, 0x2C, 0x7E, 0x08, 0x12, 0x77, 0x1A, 0x90, 0xA3, 0x14, -+0xE0, 0x70, 0x02, 0x41, 0x8A, 0x90, 0xA4, 0x85, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x90, -+0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0xD1, 0x1C, 0x12, 0x08, 0x79, 0x00, 0x08, -+0x00, 0x00, 0x12, 0x97, 0x5A, 0x12, 0x96, 0xC3, 0x12, 0x08, 0x79, 0x00, 0x03, 0x00, 0x00, 0xD1, -+0x09, 0x12, 0x96, 0xC3, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x2F, 0xD1, 0x01, 0x12, 0x96, 0xC3, -+0x12, 0x08, 0x79, 0x00, 0x0F, 0xFF, 0xBB, 0xB1, 0xF9, 0x12, 0x96, 0xC3, 0x12, 0x08, 0x79, 0x00, -+0x08, 0x80, 0x01, 0xB1, 0xE9, 0x12, 0x96, 0xC3, 0x12, 0x08, 0x79, 0x00, 0x09, 0x31, 0xD8, 0x12, -+0x96, 0xBC, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x12, 0x97, 0x5A, 0x12, 0x96, 0x78, 0x90, -+0xA4, 0x85, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x80, -+0x00, 0x00, 0x00, 0x7F, 0x78, 0x7E, 0x09, 0x12, 0x77, 0x89, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, -+0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x7C, 0x7E, 0x09, 0xB1, -+0xDA, 0x12, 0x08, 0x79, 0x00, 0x00, 0x80, 0x00, 0x7F, 0x0C, 0x7E, 0x09, 0x12, 0x67, 0x88, 0x12, -+0x08, 0x79, 0x00, 0x46, 0xA9, 0x11, 0xD1, 0x11, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x90, -+0xA4, 0x89, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x91, 0xED, 0xB1, 0x61, 0x12, 0x66, 0x8E, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x38, 0x00, 0x8C, 0x10, 0xD0, 0x07, -+0xD0, 0x06, 0x12, 0x38, 0x07, 0x91, 0xF4, 0xB1, 0x69, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x18, 0x00, 0x8C, 0x10, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x38, -+0x07, 0x91, 0xF4, 0xB1, 0xF1, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, -+0x08, 0x79, 0x02, 0x14, 0x01, 0x19, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x38, 0x07, 0x91, 0xF4, 0xB1, -+0xE1, 0x12, 0x66, 0x8E, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x28, 0x16, -+0x0D, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x38, 0x07, 0xE4, 0x90, 0xA2, 0xF6, 0xF0, 0x90, 0xA4, -+0x85, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x00, 0x00, 0x7F, 0x2C, 0x12, 0x77, 0x87, 0x12, 0x08, 0x79, 0x03, 0xFF, 0x80, 0x00, 0x90, 0xA2, -+0xF6, 0xE0, 0xB1, 0x53, 0x12, 0xAA, 0x19, 0xE4, 0xFF, 0xEE, 0x54, 0x80, 0xFE, 0xEC, 0x54, 0x03, -+0xFC, 0x12, 0xAA, 0x39, 0x7F, 0x78, 0x7E, 0x09, 0x12, 0x77, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x07, 0xFF, 0x90, 0xA2, 0xF6, 0xE0, 0xB1, 0x45, 0x12, 0x77, 0xEA, 0xEE, 0x54, 0x07, 0xFE, 0xE4, -+0xFD, 0xFC, 0x12, 0xAA, 0x39, 0x7F, 0x78, 0x7E, 0x09, 0x12, 0x77, 0x89, 0x12, 0x08, 0x79, 0x80, -+0x00, 0x00, 0x00, 0x90, 0xA4, 0x89, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0xB1, 0xB2, 0xFF, -+0x7D, 0x01, 0x12, 0xAB, 0x9C, 0x90, 0xA3, 0x15, 0xB1, 0x89, 0x90, 0xA2, 0xF6, 0xE0, 0xFA, 0xB1, -+0xCC, 0xB1, 0x9C, 0xB1, 0xBE, 0x12, 0x08, 0x6D, 0xEB, 0x60, 0x06, 0x90, 0xA3, 0x11, 0xE0, 0x04, -+0xF0, 0xB1, 0x81, 0xC3, 0x94, 0x03, 0x50, 0x02, 0x21, 0xEE, 0x90, 0xA3, 0x10, 0xE0, 0x70, 0x1C, -+0x90, 0xA4, 0xAE, 0x12, 0x08, 0x79, 0x00, 0x00, 0x02, 0x00, 0x90, 0xA4, 0xB2, 0x12, 0x08, 0x79, -+0x00, 0x00, 0x00, 0x00, 0x90, 0xA2, 0xF3, 0xE0, 0xFF, 0x02, 0xAA, 0x3F, 0xE4, 0x90, 0xA2, 0xF6, -+0xF0, 0x90, 0xA2, 0xF6, 0xE0, 0xFB, 0xB1, 0x53, 0x12, 0x77, 0xEA, 0xEB, 0x91, 0xCD, 0x12, 0x7F, -+0x9E, 0x90, 0xA2, 0xF6, 0xE0, 0xFB, 0xB1, 0x45, 0x12, 0x77, 0xEA, 0x91, 0xE2, 0x12, 0x7F, 0x9E, -+0x90, 0xA2, 0xF6, 0xE0, 0xFB, 0xB1, 0xCC, 0x12, 0x77, 0xEA, 0xEB, 0x91, 0xC3, 0x12, 0x7F, 0x9E, -+0x90, 0xA2, 0xF6, 0xE0, 0xFB, 0xB1, 0xBE, 0x12, 0x77, 0xEA, 0x91, 0xD7, 0x12, 0x7F, 0x9E, 0xB1, -+0x81, 0x64, 0x03, 0x70, 0xBC, 0xE4, 0x90, 0xA2, 0xF5, 0xF0, 0x90, 0xA3, 0x10, 0x91, 0xBC, 0xFE, -+0xC3, 0x9F, 0x40, 0x02, 0x61, 0x8B, 0xEE, 0x04, 0x90, 0xA2, 0xF7, 0xF0, 0x90, 0xA3, 0x10, 0xB1, -+0x92, 0x50, 0x68, 0xEE, 0x91, 0xCD, 0x91, 0xB7, 0x91, 0xCD, 0xB1, 0x1B, 0x91, 0xFD, 0xB1, 0x79, -+0x12, 0x48, 0x11, 0x50, 0x4E, 0xB1, 0xA7, 0xB1, 0x14, 0x40, 0x48, 0x90, 0xA2, 0xF7, 0xE0, 0x91, -+0xE3, 0x91, 0xB7, 0x91, 0xE3, 0xB1, 0x1B, 0x90, 0xA3, 0x0C, 0xB1, 0x00, 0xB1, 0x71, 0x12, 0x48, -+0x11, 0x50, 0x30, 0xB1, 0x0A, 0x40, 0x2C, 0x90, 0xA2, 0xF7, 0xE0, 0xFB, 0x91, 0xCD, 0x91, 0xB7, -+0xFA, 0x91, 0xCD, 0xB1, 0x2D, 0x90, 0xA2, 0xF8, 0x12, 0x08, 0x6D, 0x91, 0xE2, 0x12, 0x90, 0x60, -+0xEA, 0x91, 0xE3, 0xB1, 0x2D, 0x90, 0xA2, 0xFC, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x12, 0x74, 0x01, -+0xF0, 0x80, 0x08, 0x90, 0xA2, 0xF7, 0xE0, 0x04, 0xF0, 0x80, 0x91, 0x90, 0xA3, 0x12, 0xE0, 0x64, -+0x01, 0x60, 0x08, 0x90, 0xA2, 0xF5, 0xE0, 0x04, 0xF0, 0x41, 0xFA, 0x90, 0xA3, 0x12, 0xE0, 0xB4, -+0x01, 0x1A, 0x90, 0xA2, 0xF8, 0x12, 0x48, 0xC6, 0x90, 0xA4, 0xAE, 0x12, 0x08, 0x6D, 0x90, 0xA2, -+0xFC, 0x12, 0x48, 0xC6, 0x90, 0xA4, 0xB2, 0x12, 0x08, 0x6D, 0x80, 0x14, 0x90, 0xA4, 0xAE, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x02, 0x00, 0x90, 0xA4, 0xB2, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, -+0x90, 0xA2, 0xF3, 0xE0, 0xFF, 0x12, 0xAA, 0x3F, 0x90, 0xA3, 0x11, 0xE0, 0x70, 0x16, 0x90, 0xA4, -+0xA5, 0x12, 0x08, 0x79, 0x00, 0x00, 0x01, 0x00, 0x90, 0xA4, 0xA9, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x00, 0x00, 0x81, 0xAF, 0xE4, 0x90, 0xA2, 0xF5, 0xF0, 0x90, 0xA3, 0x11, 0x91, 0xBC, 0xFE, 0xC3, -+0x9F, 0x40, 0x02, 0x81, 0x7A, 0xEE, 0x04, 0x90, 0xA2, 0xF7, 0xF0, 0x90, 0xA3, 0x11, 0xB1, 0x92, -+0x50, 0x68, 0xEE, 0x91, 0xC3, 0x91, 0xB7, 0x91, 0xC3, 0xB1, 0x1B, 0x91, 0xFD, 0xB1, 0x79, 0x12, -+0x48, 0x11, 0x50, 0x4E, 0xB1, 0xA7, 0xB1, 0x14, 0x40, 0x48, 0x90, 0xA2, 0xF7, 0xE0, 0x91, 0xD8, -+0x91, 0xB7, 0x91, 0xD8, 0xB1, 0x1B, 0x90, 0xA3, 0x0C, 0xB1, 0x00, 0xB1, 0x71, 0x12, 0x48, 0x11, -+0x50, 0x30, 0xB1, 0x0A, 0x40, 0x2C, 0x90, 0xA2, 0xF7, 0xE0, 0xFB, 0x91, 0xC3, 0x91, 0xB7, 0xFA, -+0x91, 0xC3, 0xB1, 0x2D, 0x90, 0xA3, 0x00, 0x12, 0x08, 0x6D, 0x91, 0xD7, 0x12, 0x90, 0x60, 0xEA, -+0x91, 0xD8, 0xB1, 0x2D, 0x90, 0xA3, 0x04, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x13, 0x74, 0x01, 0xF0, -+0x80, 0x08, 0x90, 0xA2, 0xF7, 0xE0, 0x04, 0xF0, 0x80, 0x91, 0x90, 0xA3, 0x13, 0xE0, 0x64, 0x01, -+0x60, 0x08, 0x90, 0xA2, 0xF5, 0xE0, 0x04, 0xF0, 0x61, 0xE9, 0x90, 0xA3, 0x13, 0xE0, 0xB4, 0x01, -+0x1A, 0x90, 0xA3, 0x00, 0x12, 0x48, 0xC6, 0x90, 0xA4, 0xA5, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x04, -+0x12, 0x48, 0xC6, 0x90, 0xA4, 0xA9, 0x12, 0x08, 0x6D, 0x80, 0x14, 0x90, 0xA4, 0xA5, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x01, 0x00, 0x90, 0xA4, 0xA9, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x90, -+0xA2, 0xF3, 0xE0, 0xFF, 0x02, 0xA9, 0x2F, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0xA2, -+0xF5, 0xE0, 0x22, 0x25, 0xE0, 0x24, 0x29, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0x22, 0x25, 0xE0, 0x24, -+0x1D, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0x22, 0xEB, 0x25, 0xE0, 0x24, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0xA3, 0x22, 0xEB, 0x25, 0xE0, 0x24, 0x23, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0x22, 0x7F, 0x2C, 0x7E, -+0x08, 0x12, 0x77, 0x1A, 0x90, 0xA2, 0xF3, 0xE0, 0x75, 0xF0, 0x1E, 0xA4, 0x22, 0x90, 0xA3, 0x08, -+0x12, 0x08, 0x6D, 0xE4, 0x7F, 0x04, 0xFE, 0xFD, 0xFC, 0x22, 0x74, 0xFF, 0x7F, 0xFC, 0xFE, 0xFD, -+0xFC, 0x90, 0xA3, 0x0C, 0x12, 0x48, 0xD2, 0xD3, 0x02, 0x48, 0x11, 0xF5, 0x83, 0xE0, 0xFC, 0xA3, -+0xE0, 0xC3, 0x9F, 0xFF, 0xEC, 0x9E, 0xFE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x22, 0xF5, 0x83, 0xE0, -+0xFC, 0xA3, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, 0xA2, 0xE7, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xEE, 0x33, -+0x95, 0xE0, 0xFD, 0xFC, 0x22, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0xF0, 0xF5, 0x82, 0xE4, 0x34, 0xA3, -+0xF5, 0x83, 0x22, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0xE4, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, -+0x22, 0x24, 0x7D, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x22, 0x24, 0x7F, 0xF5, 0x82, 0xE4, 0x34, 0x44, -+0x22, 0x90, 0xA3, 0x0C, 0x12, 0x48, 0xD2, 0xC3, 0x22, 0x90, 0xA3, 0x08, 0x12, 0x48, 0xD2, 0xC3, -+0x22, 0x90, 0xA2, 0xF6, 0xE0, 0x04, 0xF0, 0xE0, 0x22, 0xEF, 0xF0, 0xFB, 0x90, 0xA4, 0x14, 0x02, -+0x48, 0xC6, 0xE0, 0xFF, 0x90, 0xA2, 0xF7, 0xE0, 0xFE, 0xC3, 0x9F, 0x22, 0x12, 0x08, 0x6D, 0x90, -+0xA4, 0x18, 0x12, 0x48, 0xC6, 0xEA, 0x22, 0x74, 0xFF, 0x7F, 0xFC, 0xFE, 0xFD, 0xFC, 0x90, 0xA3, -+0x08, 0x22, 0x7F, 0x2C, 0x7E, 0x08, 0x12, 0x77, 0x1A, 0x90, 0xA2, 0xF3, 0xE0, 0x22, 0x25, 0xE0, -+0x25, 0xE0, 0x24, 0x08, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0x22, 0x25, 0xE0, 0x25, 0xE0, -+0x24, 0xFC, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0x22, 0x12, 0x77, 0x1A, 0x90, 0xAA, 0xB9, -+0x22, 0x24, 0x6B, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x22, 0x90, 0xA2, 0xF3, 0xE0, 0xFF, 0x7D, 0x8F, -+0x22, 0x24, 0x69, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0x22, 0x90, 0xA2, 0xF3, 0xE0, 0xFF, 0x7D, 0x32, -+0x22, 0x90, 0xA2, 0xF3, 0xE0, 0xFF, 0x7D, 0x31, 0x22, 0x90, 0xA2, 0xF3, 0xE0, 0xFF, 0x7D, 0x30, -+0x22, 0x7F, 0x84, 0x7E, 0x09, 0x12, 0x38, 0x07, 0x90, 0xA4, 0x85, 0x22, 0x7F, 0x2C, 0x7E, 0x08, -+0x12, 0x77, 0x1A, 0x90, 0xA3, 0x37, 0x22, 0x7D, 0x1F, 0x7F, 0x6F, 0x12, 0x55, 0x9C, 0x90, 0x05, -+0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0xA0, 0xD8, 0x74, 0x04, 0xF0, 0x22, 0x7D, 0x25, 0x80, 0xE9, -+0x12, 0x5F, 0xF1, 0x80, 0xE2, 0x12, 0x4B, 0xEF, 0x7D, 0x24, 0x80, 0xDD, 0x90, 0xA0, 0xD8, 0xE0, -+0x64, 0x02, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x90, 0xA0, 0xDA, 0xE0, 0x30, 0xE0, 0x19, -+0x90, 0xA0, 0xD5, 0xE0, 0xFF, 0x30, 0xE0, 0x0E, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xD1, 0x4C, 0xBF, -+0x01, 0x07, 0x80, 0x02, 0x80, 0x00, 0x12, 0x97, 0xA8, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0B, 0x04, -+0x70, 0x24, 0x90, 0xA0, 0xE5, 0x74, 0x02, 0xF0, 0x80, 0x13, 0xED, 0x70, 0x06, 0x90, 0xA1, 0x3F, -+0xE0, 0x80, 0x02, 0xED, 0x14, 0x90, 0xA0, 0xE5, 0xF0, 0x90, 0xA0, 0xE5, 0xE0, 0xA3, 0xF0, 0x90, -+0xA0, 0xDB, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x8F, -+0xDC, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x77, 0x01, 0x80, 0x70, 0x90, 0xA0, 0xE3, 0xE0, 0xFF, -+0x54, 0x03, 0x60, 0x05, 0x75, 0x77, 0x02, 0x80, 0x62, 0x90, 0xA0, 0xE1, 0xE0, 0xFE, 0xE4, 0xC3, -+0x9E, 0x50, 0x05, 0x75, 0x77, 0x04, 0x80, 0x53, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x77, 0x08, 0x80, -+0x4A, 0x90, 0xA0, 0xE3, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x77, 0x10, 0x80, 0x3E, 0x90, 0xA0, 0xDB, -+0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x77, 0x20, 0x80, 0x2E, 0x90, 0xA1, 0x42, -+0xE0, 0x60, 0x05, 0x75, 0x77, 0x80, 0x80, 0x23, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, 0x05, 0x75, -+0x77, 0x11, 0x80, 0x17, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, 0xFF, 0xBF, -+0x80, 0x05, 0x75, 0x77, 0x12, 0x80, 0x04, 0xF1, 0x3E, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x04, -+0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x77, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, -+0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0xA1, 0x43, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x35, 0x90, -+0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, -+0x0E, 0x01, 0x80, 0x22, 0x90, 0x02, 0x96, 0xE0, 0x60, 0x05, 0x75, 0x0E, 0x10, 0x80, 0x17, 0x90, -+0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, -+0x0E, 0x04, 0x80, 0x02, 0x80, 0xB8, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, -+0x0E, 0xF0, 0x7F, 0x00, 0x22, 0x7D, 0x2D, 0x12, 0x56, 0x6F, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, -+0xFD, 0x7F, 0x03, 0x12, 0x81, 0x0A, 0x12, 0x4B, 0x6E, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x5B, 0x1E, -+0xE4, 0x90, 0xA0, 0xD9, 0xF0, 0x22, 0x7D, 0x2E, 0x7F, 0x6F, 0x12, 0x55, 0x9C, 0x7D, 0x02, 0x7F, -+0x01, 0x12, 0x5B, 0x1E, 0x12, 0x8F, 0xA4, 0x90, 0xA0, 0xD9, 0x74, 0x02, 0xF0, 0x22, 0x90, 0xA1, -+0x36, 0x74, 0x04, 0xF0, 0xA3, 0x14, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, -+0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x8B, 0x2B, 0x12, 0x5B, 0x1A, 0x90, 0xA0, 0xD9, 0x74, 0x0C, -+0xF0, 0x22, 0x90, 0xA3, 0x5A, 0xE0, 0xFF, 0x90, 0xA4, 0xEC, 0x74, 0x0C, 0xF0, 0xE4, 0xFB, 0x7D, -+0x01, 0x12, 0x57, 0x14, 0x90, 0xA3, 0x5D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA3, 0x5B, 0xE0, -+0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAB, 0x07, 0x90, 0xA3, 0x60, -+0xED, 0xF0, 0xEC, 0xF9, 0xE0, 0xFF, 0xAE, 0x03, 0x74, 0x2A, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x2B, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE9, 0xF0, -+0x74, 0x0D, 0x2E, 0x12, 0x8D, 0x8B, 0x44, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xFD, -+0x10, 0xEF, 0xF0, 0x7F, 0x00, 0x22, 0x13, 0xA3, 0xF0, 0xE5, 0x15, 0x13, 0xA3, 0xF0, 0x90, 0xA2, -+0x8B, 0x12, 0x48, 0xEA, 0x90, 0x00, 0x06, 0x12, 0x07, 0xAB, 0xFF, 0xAE, 0xF0, 0x90, 0x00, 0x08, -+0x12, 0x07, 0xAB, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xFE, 0x90, 0x00, 0x04, 0x12, 0x07, 0xAB, 0x2F, -+0xFF, 0xEE, 0x35, 0xF0, 0x90, 0xA4, 0x4A, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, -+0x22, 0x90, 0xA4, 0xC5, 0xA3, 0xE0, 0xFF, 0x90, 0xA4, 0xEC, 0x74, 0x03, 0xF0, 0x7B, 0x06, 0x7D, -+0x01, 0x12, 0x57, 0x14, 0x90, 0xA4, 0xC9, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA4, -+0xC8, 0xE0, 0xFF, 0x74, 0x10, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, -+0xA4, 0xC7, 0x22, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, -+0x22, 0x90, 0xA4, 0x48, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA4, 0x46, 0xE5, 0x12, 0xF0, 0xA3, -+0xE5, 0x13, 0x22, 0x74, 0x91, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0x22, 0x24, -+0xFC, 0xFF, 0x90, 0xA3, 0x56, 0xF0, 0xE4, 0x90, 0xA4, 0xD0, 0xF0, 0xA3, 0x22, 0x74, 0x12, 0x25, -+0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0x22, 0x74, 0x01, 0x25, 0x0F, 0xF5, 0x82, 0xE4, -+0x34, 0x94, 0xF5, 0x83, 0x22, 0x74, 0x91, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, -+0x22, 0xF0, 0x90, 0xA0, 0xEB, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0x12, 0x48, 0x04, 0x90, -+0xA1, 0x32, 0x12, 0x08, 0x6D, 0x90, 0xA0, 0xDB, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0xF0, 0x90, 0xA0, -+0xFC, 0xE0, 0x24, 0x04, 0x90, 0xA0, 0xF7, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x22, 0x90, 0x01, 0x34, -+0x74, 0x40, 0xF0, 0xFD, 0xE4, 0xFF, 0x12, 0x81, 0x0A, 0x43, 0x12, 0x08, 0x22, 0xE0, 0x90, 0x01, -+0xBA, 0xF0, 0x90, 0xA0, 0xE1, 0xE0, 0x90, 0x01, 0xBB, 0x22, 0x90, 0xA1, 0x8F, 0xE0, 0x44, 0x10, -+0xF0, 0x90, 0xA3, 0x55, 0xE0, 0xFF, 0x22, 0x90, 0xA4, 0x46, 0xE5, 0x14, 0xF0, 0xA3, 0xE5, 0x15, -+0xF0, 0xE5, 0x14, 0x22, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0xA4, 0x48, 0xCF, 0xF0, 0xA3, 0xEF, 0x22, -+0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x38, 0x07, 0x7F, 0x00, 0x7E, 0x0E, 0x22, 0x12, 0x38, 0x07, 0x90, -+0xA2, 0xF3, 0xE0, 0x75, 0xF0, 0x0C, 0xA4, 0x22, 0x12, 0x48, 0xDE, 0xE0, 0xFE, 0xED, 0xFF, 0x90, -+0xA3, 0x62, 0xE0, 0x22, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x22, 0x74, 0x21, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x04, 0xFF, 0x90, 0xA3, 0x57, 0xF0, 0x90, 0xA1, -+0x52, 0xE0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0x22, 0xFC, 0xE5, -+0x14, 0xC3, 0x13, 0xFE, 0xE5, 0x15, 0x13, 0xFF, 0x22, 0x90, 0xA5, 0x0D, 0xE0, 0xFF, 0x7D, 0x48, -+0x02, 0x55, 0x9C, 0x12, 0x48, 0x04, 0x90, 0xA3, 0x43, 0x02, 0x08, 0x6D, 0x90, 0xA1, 0x53, 0xE0, -+0x64, 0x05, 0x22, 0x90, 0xA2, 0x8B, 0x12, 0x48, 0xEA, 0x02, 0x07, 0x80, 0xD2, 0xAF, 0xC2, 0xAF, -+0x90, 0x9F, 0x13, 0xE0, 0xFF, 0x22, 0x7F, 0x00, 0x7E, 0x0E, 0x02, 0x38, 0x07, 0x7D, 0x02, 0x7F, -+0x02, 0x02, 0x77, 0xA9, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0x22, 0x90, 0xA1, 0x45, 0xE0, -+0x90, 0x05, 0x73, 0x22, 0x90, 0xA0, 0xE5, 0xE0, 0x90, 0x05, 0x73, 0x22, 0x90, 0x05, 0x22, 0xE0, -+0x90, 0xA3, 0x55, 0x22, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0x22, 0x90, 0x89, 0x07, 0x12, -+0x48, 0xDE, 0xE0, 0x22, 0x90, 0x89, 0x04, 0x12, 0x48, 0xDE, 0xE0, 0x22, 0xF0, 0xA3, 0xE4, 0xF0, -+0xA3, 0xE5, 0x1D, 0x22, 0x90, 0xA2, 0x97, 0xE0, 0x75, 0xF0, 0x04, 0x22, 0x7F, 0xB4, 0x7E, 0x08, -+0x02, 0x37, 0xBC, 0x00, 0xB4, 0x1C, -+}; -+u4Byte ArrayLength_MP_8821A_FW_NIC = 31382; -+ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_NIC( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8821A_FW_NIC; -+#else -+ ODM_MoveMemory(pDM_Odm, pFirmware, Array_MP_8821A_FW_NIC, ArrayLength_MP_8821A_FW_NIC); -+#endif -+ *pFirmwareSize = ArrayLength_MP_8821A_FW_NIC; -+} -+ -+ -+u1Byte Array_MP_8821A_FW_NIC_BT[] = { -+0x01, 0x21, 0x13, 0x00, 0x25, 0x00, 0x00, 0x00, 0x09, 0x08, 0x18, 0x09, 0xA2, 0x7F, 0x00, 0x00, -+0xED, 0x24, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x48, 0x22, 0x02, 0x6F, 0xE7, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x70, 0x23, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x8F, 0xE3, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x6F, 0xE8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x7F, 0xE4, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x87, 0xEC, 0x00, 0x04, 0x0C, 0x00, 0x00, 0x00, 0x04, 0x08, 0x08, 0x00, -+0x00, 0x00, 0x0A, 0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, -+0x03, 0x02, 0x00, 0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, -+0x0C, 0x0A, 0x07, 0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, -+0x00, 0x08, 0x0B, 0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, -+0x09, 0x04, 0x00, 0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, -+0x24, 0x22, 0x14, 0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, -+0x00, 0x20, 0x23, 0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, -+0x0F, 0x04, 0x00, 0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, -+0x31, 0x2F, 0x18, 0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, -+0x00, 0x30, 0x31, 0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, -+0x14, 0x00, 0x00, 0x30, 0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, -+0x00, 0x00, 0x05, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0x10, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x3F, 0x00, 0x00, 0x00, -+0x00, 0x15, 0xF0, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0xCF, 0xFF, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, -+0x25, 0x27, 0x28, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, -+0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, -+0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, -+0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, -+0x2A, 0x2A, 0x2A, 0x00, 0x04, 0x00, 0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x18, 0x00, 0x24, 0x00, -+0x30, 0x00, 0x48, 0x00, 0x60, 0x00, 0x90, 0x00, 0xC0, 0x00, 0xD8, 0x00, 0x3C, 0x00, 0x64, 0x00, -+0x78, 0x00, 0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, 0x90, 0x01, 0xE0, 0x00, 0xA0, 0x00, 0xF0, 0x01, -+0x40, 0x01, 0x90, 0x02, 0x58, 0x03, 0x20, 0x04, 0xB0, 0x06, 0x40, 0x00, 0xC8, 0x01, 0x18, 0x01, -+0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x00, 0xC8, 0x01, 0x18, 0x01, -+0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x00, 0x3C, 0x00, 0x50, 0x00, -+0x64, 0x00, 0xA0, 0x00, 0xF0, 0x01, 0x40, 0x01, 0x90, 0x01, 0x90, 0x02, 0x58, 0x03, 0x20, 0x00, -+0x78, 0x00, 0xF0, 0x01, 0x90, 0x02, 0x58, 0x03, 0xE8, 0x07, 0xD0, 0x09, 0x60, 0x0F, 0xA0, 0x12, -+0xC0, 0x15, 0x18, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, 0xD0, 0x03, 0xE8, 0x04, 0xB0, 0x06, -+0x40, 0x07, 0xD0, 0x07, 0xD0, 0x07, 0xD0, 0x00, 0xC8, 0x01, 0x18, 0x01, 0xE0, 0x02, 0xD0, 0x03, -+0xE8, 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x07, 0xD0, 0x07, 0xD0, 0x00, 0x02, 0x00, 0x02, 0x00, -+0x04, 0x00, 0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x48, 0x00, -+0x60, 0x00, 0x6C, 0x00, 0x14, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, -+0xC8, 0x00, 0xF0, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x01, 0x2C, 0x01, 0x90, 0x02, -+0x58, 0x03, 0x20, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, -+0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, -+0x20, 0x03, 0xE8, 0x00, 0x1E, 0x00, 0x28, 0x00, 0x32, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, -+0xC8, 0x00, 0xF0, 0x01, 0x7C, 0x01, 0x90, 0x00, 0x3C, 0x00, 0x78, 0x00, 0xC8, 0x01, 0x2C, 0x01, -+0xF4, 0x03, 0xE8, 0x04, 0xB0, 0x07, 0xD0, 0x09, 0x60, 0x0A, 0xF0, 0x00, 0x64, 0x00, 0x8C, 0x00, -+0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x00, -+0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, -+0xE8, 0x03, 0xE8, 0x01, 0x01, 0x01, 0x02, 0x01, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, 0x05, 0x05, -+0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, -+0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, -+0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x0B, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, -+0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, 0x04, 0x05, -+0x06, 0x07, 0x08, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x02, 0x04, 0x06, 0x07, 0x08, -+0x0A, 0x0B, 0x0C, 0x03, 0x05, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, -+0x0A, 0x0B, 0x0C, 0x02, 0x04, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x03, 0x05, 0x06, -+0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, -+0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x19, 0x06, 0x04, 0x02, 0x00, -+0x18, 0x00, 0x04, 0x0C, 0x14, 0x2C, 0x36, 0x04, 0x08, 0x08, 0x08, 0x0A, 0x0A, 0x04, 0x04, 0x04, -+0x05, 0x04, 0x04, 0x05, 0x07, 0x07, 0x07, 0x08, 0x0A, 0x04, 0x07, 0x0A, 0x0E, 0x11, 0x13, 0x14, -+0x15, 0x03, 0x04, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, -+0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x07, 0x08, 0x08, 0x0A, 0x0A, 0x0C, 0x0E, -+0x10, 0x11, 0x11, 0x07, 0x09, 0x09, 0x0B, 0x0B, 0x0D, 0x0F, 0x13, 0x13, 0x14, 0x05, 0x05, 0x07, -+0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, -+0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, 0x07, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x05, 0x06, 0x07, -+0x0D, 0x10, 0x11, 0x12, 0x12, 0x07, 0x08, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, -+0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x05, 0x06, 0x08, -+0x09, 0x0C, 0x0E, 0x12, 0x12, 0x13, 0x14, 0x07, 0x08, 0x09, 0x0A, 0x0C, 0x0F, 0x12, 0x12, 0x14, -+0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, -+0x0E, 0x11, 0x13, 0x13, 0x13, 0x0C, 0x00, 0x0C, 0x94, 0x0C, 0x88, 0x0C, 0x8C, 0x0C, 0xE8, 0x0C, -+0x10, 0x0D, 0x00, 0x0C, 0x90, 0x0C, 0xC4, 0x0C, 0xC8, 0x0C, 0xCC, 0x0C, 0xD4, 0x0C, 0x80, 0x0C, -+0x84, 0x0C, 0xB8, 0x0E, 0x00, 0x0E, 0x94, 0x0E, 0x88, 0x0E, 0x8C, 0x0E, 0xE8, 0x0E, 0x10, 0x0D, -+0x40, 0x0E, 0x90, 0x0E, 0xC4, 0x0E, 0xC8, 0x0E, 0xCC, 0x0E, 0xD4, 0x0E, 0x80, 0x0E, 0x84, 0x0E, -+0xB8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x44, 0xE4, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x48, 0xC5, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x48, 0xC5, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x45, 0x2D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x45, 0x2C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x45, 0x2D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, -+0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xC3, 0xEF, 0x9B, -+0xFF, 0xEE, 0x9A, 0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, -+0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, -+0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, -+0xF0, 0xE8, 0x9C, 0x45, 0xF0, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, -+0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xA4, 0x25, -+0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, -+0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, -+0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, -+0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, -+0x80, 0xDF, 0x02, 0x48, 0x60, 0x02, 0x45, 0xBD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, -+0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, -+0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, -+0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, -+0x90, 0x48, 0xA5, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, -+0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, -+0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, -+0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, -+0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0x41, 0xA3, 0xE7, 0x00, 0x41, 0xA3, 0xE8, 0x00, 0x41, 0xA3, 0xE9, -+0x00, 0x41, 0xA3, 0xED, 0x00, 0x01, 0x27, 0x00, 0x41, 0xA3, 0xEE, 0x00, 0x41, 0xA3, 0xEF, 0x00, -+0x41, 0xA4, 0x14, 0x00, 0x00, 0x4B, 0xD0, 0x5F, 0xFF, 0x67, 0xF1, 0xE4, 0xFD, 0x7F, 0x8D, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xED, 0x12, 0xBF, 0x32, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x8F, 0x51, 0xB0, 0xEF, -+0x20, 0xE6, 0x02, 0x21, 0xE5, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0xA3, 0xF0, 0xF0, 0x7F, 0x8D, 0x51, -+0xB0, 0x90, 0xA3, 0xF1, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0xA3, 0xF2, 0xF0, 0x90, 0xA3, -+0xF1, 0xE0, 0x24, 0xFC, 0x60, 0x10, 0x24, 0x03, 0x60, 0x02, 0x21, 0xDB, 0x90, 0xA3, 0xF0, 0xE0, -+0xFF, 0x12, 0xB9, 0x39, 0x21, 0xDB, 0x90, 0xA3, 0xF0, 0xE0, 0x24, 0x11, 0x12, 0x6D, 0x16, 0xE0, -+0xFB, 0xE4, 0xFD, 0xFF, 0x51, 0x18, 0x75, 0xF0, 0x04, 0x12, 0x66, 0xFE, 0x13, 0x13, 0x54, 0x03, -+0xFB, 0x0D, 0xE4, 0xFF, 0x51, 0x18, 0x75, 0xF0, 0x04, 0x12, 0x66, 0xFE, 0x12, 0x77, 0xBC, 0xFB, -+0x0D, 0xE4, 0xFF, 0x51, 0x18, 0x75, 0xF0, 0x04, 0x12, 0x66, 0xFE, 0xC4, 0x54, 0x03, 0xFB, 0x0D, -+0xE4, 0xFF, 0x51, 0x18, 0x75, 0xF0, 0x04, 0x12, 0x6F, 0xE1, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, -+0x18, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x12, 0x51, 0x12, 0x75, 0xF0, 0x04, 0x12, 0x6E, 0x46, 0xC4, -+0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0x51, 0x18, 0x75, 0xF0, 0x04, 0x12, 0x6E, 0x46, 0x54, -+0x1F, 0x51, 0x16, 0x12, 0x73, 0xEA, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0x18, 0x75, 0xF0, 0x08, -+0x90, 0x89, 0x01, 0x51, 0x12, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x51, 0x12, 0x75, 0xF0, 0x08, -+0x90, 0x89, 0x03, 0x51, 0x12, 0x75, 0xF0, 0x08, 0x12, 0xBF, 0x70, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, -+0x18, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x05, 0x51, 0x12, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x06, 0x51, -+0x12, 0x75, 0xF0, 0x08, 0x12, 0xBF, 0x68, 0xFB, 0x0D, 0x31, 0xEA, 0x7F, 0x8F, 0x51, 0xB0, 0xEF, -+0x30, 0xE0, 0x02, 0x11, 0xCB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, -+0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, -+0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, -+0xF0, 0x22, 0x12, 0x47, 0xDE, 0xE0, 0xFB, 0x0D, 0x31, 0xEA, 0x90, 0xA3, 0xF0, 0xE0, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x56, 0x2E, 0x7F, 0x00, 0x7E, 0x0C, 0x91, 0x3E, 0x12, -+0xBE, 0xAE, 0x91, 0x3E, 0x12, 0xBF, 0x51, 0x51, 0xE0, 0x51, 0xCD, 0x51, 0xCD, 0x54, 0xFE, 0xFD, -+0x7F, 0x02, 0x11, 0xCF, 0x12, 0xBF, 0x20, 0x44, 0x40, 0x91, 0x44, 0x12, 0xBF, 0x4A, 0x90, 0x01, -+0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0x12, -+0x8C, 0xFA, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0x8B, 0x4F, 0xF1, 0xFB, 0x13, 0x30, 0xE0, 0x33, -+0x90, 0xA1, 0x92, 0xE0, 0x60, 0x08, 0x90, 0xA3, 0xA9, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, -+0xA3, 0xA9, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA3, 0xAA, 0xF0, -+0x80, 0x06, 0x90, 0xA3, 0xAA, 0x74, 0x02, 0xF0, 0x90, 0xA3, 0xA9, 0x12, 0x62, 0x19, 0x7F, 0x01, -+0x12, 0x8B, 0x4F, 0x90, 0xA1, 0x40, 0xE0, 0x60, 0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xE0, 0x90, 0xA4, 0x0C, -+0x12, 0xBF, 0x32, 0x90, 0xA4, 0x0C, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x54, 0xFE, 0xFD, -+0x7F, 0x02, 0x11, 0xCF, 0x7F, 0x02, 0x51, 0xB0, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x11, 0xCF, -+0x7F, 0x02, 0x51, 0xB0, 0xEF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x10, 0x51, -+0xB0, 0xEF, 0x44, 0x0C, 0xFD, 0x7F, 0x10, 0x11, 0xCF, 0x7F, 0x72, 0x51, 0xB0, 0xEF, 0x54, 0xF3, -+0xFD, 0x7F, 0x72, 0x11, 0xCF, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, -+0xFF, 0x12, 0x8C, 0xFA, 0x30, 0xE0, 0x05, 0x7F, 0x03, 0x12, 0x8B, 0x4F, 0x90, 0xA1, 0x6B, 0xE0, -+0x20, 0xE0, 0x32, 0xF1, 0xFB, 0x13, 0x30, 0xE0, 0x2C, 0x90, 0xA1, 0x92, 0xE0, 0x60, 0x07, 0xE4, -+0x90, 0xA3, 0xA3, 0xF0, 0x80, 0x06, 0x90, 0xA3, 0xA3, 0x74, 0x01, 0xF0, 0xEF, 0xC4, 0x13, 0x54, -+0x07, 0x90, 0xA3, 0xA4, 0x30, 0xE0, 0x05, 0x74, 0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, -+0xA3, 0xA3, 0x12, 0x62, 0x19, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, -+0xF0, 0x12, 0xBF, 0x20, 0x54, 0xBF, 0x12, 0xBE, 0x40, 0x91, 0x4F, 0x12, 0xBF, 0x4A, 0x51, 0xE0, -+0x44, 0x01, 0xFD, 0x7F, 0x02, 0x11, 0xCF, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0xBE, 0x3A, 0x91, 0x4F, -+0x12, 0xBE, 0xAE, 0x12, 0xBE, 0x3A, 0x91, 0x4F, 0x12, 0xBF, 0x51, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x7F, 0x54, 0x51, 0xB0, 0xE5, 0x51, 0x5F, 0xF5, 0x55, 0x7F, 0x55, 0x51, 0xB0, 0xE5, 0x52, 0x5F, -+0xF5, 0x56, 0x7F, 0x56, 0x51, 0xB0, 0xE5, 0x53, 0x5F, 0xF5, 0x57, 0x7F, 0x57, 0x51, 0xB0, 0xE5, -+0x54, 0x5F, 0xF5, 0x58, 0xAD, 0x55, 0x7F, 0x54, 0x11, 0xCF, 0xAD, 0x56, 0x7F, 0x55, 0x11, 0xCF, -+0xAD, 0x57, 0x7F, 0x56, 0x11, 0xCF, 0xAD, 0x58, 0x7F, 0x57, 0x11, 0xCF, 0x53, 0x91, 0xEF, 0x22, -+0x7F, 0x81, 0x51, 0xB0, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, 0x81, 0x11, 0xCF, 0x7F, 0x80, 0x51, 0xB0, -+0xEF, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x11, 0xCF, 0x12, 0xAF, 0x75, 0x12, 0x3D, 0x3B, 0x12, 0xAF, -+0x82, 0x12, 0xAF, 0xC7, 0x7F, 0x01, 0x12, 0x45, 0xF5, 0x90, 0xA1, 0xB2, 0x74, 0x02, 0xF0, 0xFF, -+0x12, 0x45, 0xF5, 0x90, 0xA1, 0xB2, 0xE0, 0x04, 0xF0, 0x12, 0x58, 0x19, 0x12, 0x99, 0x21, 0x90, -+0x01, 0xCC, 0x74, 0x0F, 0xF0, 0x7F, 0x80, 0x51, 0xB0, 0xEF, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x11, -+0xCF, 0x75, 0x28, 0xFF, 0x12, 0x5F, 0xF8, 0x12, 0x90, 0xD0, 0x7F, 0x81, 0x51, 0xB0, 0xEF, 0x44, -+0x04, 0xFD, 0x7F, 0x81, 0x11, 0xCF, 0x12, 0xAF, 0xD1, 0xE4, 0xFF, 0x02, 0x46, 0x7E, 0x12, 0x37, -+0xBC, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA3, 0xA5, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0xA5, 0x12, -+0x47, 0xC6, 0x90, 0xAA, 0xB9, 0x02, 0x08, 0x6D, 0x7F, 0x2C, 0x7E, 0x08, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x23, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x37, 0xBC, 0x90, 0xA3, -+0x2D, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x25, 0x12, 0x47, 0xC6, 0x12, 0x08, 0x3A, 0x90, 0xA3, 0x2D, -+0x12, 0x7E, 0xA5, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x25, 0x12, 0x47, -+0xC6, 0x90, 0xA3, 0x29, 0x12, 0x7E, 0xA5, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -+0x47, 0xA8, 0x90, 0xA3, 0x31, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x31, 0x91, 0x4F, 0x90, 0xA3, 0x23, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x38, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA3, 0xAB, -+0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x34, 0x7E, -+0x08, 0x12, 0x37, 0xBC, 0x90, 0xA3, 0xAD, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0xAB, 0xE0, 0x14, 0x60, -+0x5E, 0x14, 0x70, 0x02, 0xC1, 0x04, 0x24, 0x02, 0x60, 0x02, 0xC1, 0x99, 0x90, 0xA3, 0x25, 0x12, -+0x08, 0x79, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, 0x30, 0x02, 0x00, -+0xD1, 0xA5, 0x12, 0x08, 0x79, 0x40, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, -+0x00, 0x00, 0x00, 0x7F, 0xC4, 0xD1, 0xA7, 0x12, 0x08, 0x79, 0x00, 0x1C, 0x00, 0x00, 0x90, 0xA3, -+0x29, 0x12, 0x08, 0x79, 0x00, 0x10, 0x00, 0x00, 0x7F, 0x64, 0xD1, 0xA7, 0x12, 0x08, 0x79, 0x03, -+0xC0, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x02, 0x00, 0x00, 0x00, 0xC1, 0x7C, 0x90, -+0xA3, 0x25, 0x12, 0x08, 0x79, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, -+0x30, 0x02, 0x01, 0xD1, 0xA5, 0x12, 0x08, 0x79, 0x40, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xC4, 0xD1, 0xA7, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, -+0x3C, 0x90, 0xA3, 0xAC, 0xF1, 0xF2, 0xD1, 0x9A, 0x12, 0x08, 0x79, 0xF0, 0x00, 0x00, 0x00, 0x90, -+0xA3, 0xAC, 0xF1, 0xF2, 0x78, 0x1C, 0x12, 0x08, 0x5A, 0x12, 0x9F, 0x31, 0x7F, 0x38, 0xD1, 0xA7, -+0x12, 0x08, 0x79, 0x00, 0x1C, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, 0x08, 0x00, -+0x00, 0x12, 0xBE, 0x4C, 0x60, 0x13, 0x12, 0x08, 0x79, 0x03, 0xC0, 0x00, 0x00, 0x90, 0xA3, 0x29, -+0x12, 0x08, 0x79, 0x01, 0x80, 0x00, 0x00, 0x80, 0x11, 0x12, 0x08, 0x79, 0x03, 0xC0, 0x00, 0x00, -+0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x02, 0x00, 0x00, 0x00, 0x7F, 0x48, 0x7E, 0x08, 0x91, 0x5C, -+0x90, 0xA3, 0xAC, 0xE0, 0x90, 0xA3, 0x25, 0xB4, 0x01, 0x13, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, -+0x10, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x10, 0x80, 0x11, 0x12, 0x08, 0x79, -+0x00, 0x00, 0x00, 0x10, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, -+0x7E, 0x0A, 0xC1, 0x97, 0x90, 0xA3, 0x25, 0x12, 0x08, 0x79, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA3, -+0x29, 0x12, 0x08, 0x79, 0x00, 0x30, 0x02, 0x02, 0xD1, 0xA5, 0x12, 0x08, 0x79, 0x40, 0x00, 0x00, -+0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x40, 0x00, 0x00, 0x00, 0x7F, 0xC4, 0xD1, 0xA7, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x00, 0x3C, 0x90, 0xA3, 0xAC, 0xF1, 0xF2, 0xD1, 0x9A, 0x12, 0x08, 0x79, -+0xF0, 0x00, 0x00, 0x00, 0x90, 0xA3, 0xAC, 0xF1, 0xF2, 0x78, 0x1C, 0x12, 0x08, 0x5A, 0x12, 0x9F, -+0x31, 0x7F, 0x38, 0xD1, 0xA7, 0x12, 0x08, 0x79, 0x00, 0x1C, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, -+0x08, 0x79, 0x00, 0x08, 0x00, 0x00, 0x12, 0xBE, 0x4C, 0x60, 0x17, 0x12, 0x08, 0x79, 0x03, 0xC0, -+0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x01, 0x40, 0x00, 0x00, 0x7F, 0x48, 0x7E, 0x08, -+0x80, 0x15, 0x12, 0x08, 0x79, 0x03, 0xC0, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x01, -+0xC0, 0x00, 0x00, 0x7F, 0x48, 0x7E, 0x08, 0x91, 0x5C, 0x22, 0x78, 0x02, 0x12, 0x08, 0x5A, 0x90, -+0xA3, 0x29, 0x12, 0x08, 0x6D, 0x7F, 0xAC, 0x7E, 0x08, 0x91, 0x5C, 0x90, 0xA3, 0x25, 0x22, 0xEF, -+0x90, 0xA3, 0x25, 0x70, 0x2A, 0x12, 0x08, 0x79, 0x00, 0x00, 0xF0, 0x00, 0x90, 0xA3, 0x29, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x70, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, 0xD1, 0xA9, 0x12, 0x08, 0x79, 0x00, -+0x00, 0x00, 0xF0, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x70, 0x80, 0x28, 0x12, -+0x08, 0x79, 0x00, 0x00, 0xF0, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, 0x00, 0x50, 0x00, -+0x7F, 0xB0, 0x7E, 0x0C, 0xD1, 0xA9, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA3, 0x29, -+0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x40, 0x7F, 0xB0, 0x7E, 0x0C, 0xD1, 0xA9, 0x12, 0x08, 0x79, -+0x00, 0x10, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB4, -+0x7E, 0x0C, 0xD1, 0xA9, 0x12, 0x08, 0x79, 0x00, 0x40, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0xD1, 0xA9, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x00, 0x07, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x07, 0x7F, 0xB0, 0x7E, 0x0C, -+0xD1, 0xA9, 0x12, 0x08, 0x79, 0x00, 0x00, 0x07, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, -+0x00, 0x07, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, 0x81, 0x5C, 0x90, 0xA0, 0xDB, 0xE0, 0x44, 0x10, 0xF0, -+0x90, 0xA0, 0xEA, 0xE0, 0xFD, 0x7F, 0x93, 0x11, 0xCF, 0x90, 0xA0, 0xE0, 0xE0, 0x60, 0x12, 0x90, -+0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, -+0xF0, 0x7F, 0x08, 0x51, 0xB0, 0xEF, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x11, 0xCF, 0x7F, 0x01, 0x12, -+0x90, 0x59, 0x7F, 0x90, 0x51, 0xB0, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x90, 0x11, 0xCF, 0x7F, 0x14, -+0x7E, 0x00, 0x02, 0x3D, 0x7A, 0x90, 0x01, 0x30, 0x12, 0x58, 0x8B, 0x90, 0x01, 0x38, 0x12, 0x58, -+0x8C, 0xFD, 0x7F, 0x50, 0x11, 0xCF, 0xE4, 0xFD, 0x7F, 0x51, 0x11, 0xCF, 0xE4, 0xFD, 0x7F, 0x52, -+0x11, 0xCF, 0xE4, 0xFD, 0x7F, 0x53, 0x01, 0xCF, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0xFF, 0xE4, 0xFC, -+0xFD, 0xFE, 0x78, 0x08, 0x12, 0x08, 0x5A, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x90, -+0x05, 0x60, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0x01, 0xE4, 0x90, 0xA1, 0x41, 0xE0, 0xFF, -+0xC3, 0x22, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0x90, 0xA3, 0x9D, 0xF0, 0x90, 0xA1, 0x3D, 0xE0, 0x90, -+0xA3, 0x9E, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA3, 0x99, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA3, 0x9D, 0xE0, 0xF5, 0x3B, 0xA3, -+0xE0, 0xF5, 0x3C, 0x12, 0x35, 0x7A, 0x90, 0xA3, 0x99, 0x12, 0x96, 0xCC, 0xA3, 0xA3, 0xA3, 0x74, -+0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xF5, 0x21, 0x90, 0xA0, 0xDF, 0xE0, 0x70, 0x02, -+0x21, 0x2D, 0xF1, 0xE6, 0x60, 0x02, 0x21, 0x2D, 0x12, 0x4F, 0xD9, 0x12, 0x47, 0xA8, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0x4F, 0xF2, 0x78, 0x10, 0x12, 0x08, -+0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0xA8, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x4F, 0xF2, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0xA7, 0x37, 0x90, 0xA0, 0xDB, 0xE0, 0x44, 0x80, 0xF0, 0x12, -+0x5F, 0x01, 0x60, 0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0xA0, 0xE6, 0xE0, 0x14, -+0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, 0xA0, 0xE8, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0xA0, -+0xE5, 0xE0, 0xA3, 0xF0, 0x80, 0x00, 0x75, 0x21, 0x01, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x12, -+0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x02, 0x03, 0xE4, 0xF5, 0x21, 0x12, 0x5F, 0x13, 0xEF, 0x70, 0x02, -+0xF5, 0x21, 0xE5, 0x21, 0x60, 0x47, 0x12, 0xA7, 0x2F, 0x90, 0xA0, 0xE8, 0xE0, 0x60, 0x04, 0x64, -+0x01, 0x70, 0x14, 0xE4, 0x90, 0xA3, 0x9D, 0xF0, 0x90, 0xA0, 0xE8, 0xE0, 0x12, 0x96, 0x3C, 0x11, -+0x0F, 0x90, 0xA0, 0xE8, 0xE0, 0x80, 0x13, 0xE4, 0x90, 0xA3, 0x9D, 0x12, 0x96, 0x31, 0x11, 0x0F, -+0x90, 0xA0, 0xE8, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x12, 0x96, 0x3C, 0x90, 0xA0, 0xF8, -+0xF0, 0x90, 0xA0, 0xE2, 0xE0, 0x20, 0xE2, 0x02, 0x31, 0x2E, 0x12, 0xA6, 0x5E, 0x22, 0x7D, 0x01, -+0x7F, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x12, 0xED, 0xF0, 0x90, 0xA0, -+0xDA, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x41, 0x80, 0xEE, 0x12, 0x77, -+0xBC, 0x30, 0xE0, 0x02, 0x41, 0x80, 0x90, 0xA0, 0xE2, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x41, 0x80, -+0xEF, 0x70, 0x02, 0x21, 0xF1, 0x24, 0xFE, 0x70, 0x02, 0x41, 0x2B, 0x24, 0xFE, 0x60, 0x4A, 0x24, -+0xFC, 0x70, 0x02, 0x41, 0x66, 0x24, 0xFC, 0x60, 0x02, 0x41, 0x79, 0xEE, 0xB4, 0x0E, 0x02, 0x51, -+0xE4, 0x90, 0xA0, 0xE2, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xD1, 0xFE, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, -+0x06, 0x02, 0x71, 0x07, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x04, 0x0F, 0x90, 0xA4, 0x12, 0xE0, 0xFF, -+0x60, 0x05, 0x12, 0xB6, 0x8A, 0x80, 0x03, 0x12, 0x5F, 0x1F, 0x90, 0xA0, 0xE2, 0xE0, 0x64, 0x08, -+0x60, 0x02, 0x41, 0x79, 0x12, 0xBD, 0x52, 0x41, 0x79, 0x90, 0xA0, 0xE2, 0xE0, 0x70, 0x04, 0x7F, -+0x01, 0xD1, 0xFE, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x07, 0x90, 0xA0, 0xE2, 0xE0, -+0xB4, 0x0E, 0x07, 0x51, 0x85, 0xBF, 0x01, 0x02, 0x51, 0xE4, 0x90, 0xA0, 0xE2, 0xE0, 0x64, 0x0C, -+0x60, 0x02, 0x41, 0x79, 0x51, 0x85, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x41, 0x79, 0xD1, 0xC9, 0x41, -+0x79, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x0E, 0x07, 0x51, 0x85, 0xBF, 0x01, 0x02, 0x51, 0xE4, 0x90, -+0xA0, 0xE2, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x07, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x0C, 0x07, 0x51, -+0x85, 0xBF, 0x01, 0x02, 0xD1, 0xC9, 0x90, 0xA0, 0xE2, 0xE0, 0x64, 0x04, 0x70, 0x5B, 0x12, 0xBC, -+0x7E, 0xEF, 0x64, 0x01, 0x70, 0x53, 0x12, 0x5F, 0x96, 0x80, 0x4E, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, -+0x0E, 0x07, 0x51, 0x85, 0xBF, 0x01, 0x02, 0x51, 0xE4, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x06, 0x02, -+0x71, 0x07, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x0C, 0x07, 0x51, 0x85, 0xBF, 0x01, 0x02, 0xD1, 0xC9, -+0x90, 0xA0, 0xE2, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xD1, 0xFE, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x04, -+0x18, 0x12, 0xBC, 0x0E, 0x80, 0x13, 0x90, 0xA0, 0xE2, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, 0xA0, 0xDB, -+0x12, 0x87, 0xDA, 0x30, 0xE0, 0x03, 0x12, 0xB6, 0xCB, 0x90, 0xA0, 0xE2, 0x12, 0xBE, 0x94, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA1, 0x50, 0xE0, -+0x30, 0xE0, 0x10, 0x90, 0xA1, 0x56, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x12, 0x75, 0x79, -+0x10, 0x80, 0x2E, 0x12, 0x97, 0xBF, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x79, 0x01, 0x80, 0x21, -+0x90, 0xA0, 0xDA, 0x12, 0x8C, 0xFE, 0x30, 0xE0, 0x05, 0x75, 0x79, 0x02, 0x80, 0x13, 0x90, 0xA0, -+0xE1, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x79, 0x08, 0x80, 0x05, 0x12, 0x97, 0x95, 0x80, -+0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x79, 0xF0, 0x7F, 0x00, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA0, 0xDB, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x05, 0x12, 0x59, 0xE3, -+0x80, 0x10, 0x12, 0xBD, 0xDA, 0x44, 0x80, 0xF1, 0xD6, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x80, 0xF0, -+0xF1, 0x10, 0xE4, 0xFD, 0xFF, 0x80, 0x2F, 0x90, 0xA0, 0xDB, 0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, -+0x07, 0xE0, 0x44, 0x40, 0xF1, 0xD6, 0x80, 0x10, 0x12, 0x59, 0xDF, 0x90, 0x05, 0x27, 0xE0, 0x54, -+0x7F, 0xF0, 0x90, 0xA0, 0xD9, 0x74, 0x0C, 0xF0, 0xE4, 0xFD, 0xFF, 0x80, 0x09, 0xE4, 0xFD, 0x7F, -+0x0C, 0x31, 0x32, 0xE4, 0xFD, 0xFF, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x9F, 0x17, 0xED, 0xF0, -+0x22, 0xE4, 0x90, 0xA2, 0xF1, 0xF0, 0x90, 0xA1, 0xB3, 0xE0, 0x20, 0xE0, 0x02, 0x81, 0x73, 0x90, -+0xA1, 0xB5, 0xE0, 0xB4, 0x14, 0x0B, 0x7F, 0x01, 0x91, 0x7E, 0xEF, 0x60, 0x02, 0x81, 0x73, 0x81, -+0x6E, 0x12, 0x94, 0x29, 0x90, 0xA2, 0xEF, 0xF0, 0x60, 0x07, 0xE0, 0x64, 0x02, 0x60, 0x02, 0x81, -+0x35, 0x90, 0xA1, 0xB5, 0xE0, 0x70, 0x31, 0xF1, 0xA8, 0x30, 0xE0, 0x02, 0x81, 0x25, 0x12, 0xBF, -+0x0E, 0x7D, 0x4E, 0x7F, 0x6F, 0x71, 0x36, 0x91, 0x75, 0x12, 0x7F, 0x08, 0x7B, 0x04, 0x7D, 0x01, -+0xB1, 0xE1, 0xBF, 0x01, 0x0C, 0xF1, 0x1E, 0x44, 0x01, 0xF0, 0x90, 0xA1, 0xB5, 0x74, 0x01, 0xF0, -+0x22, 0x12, 0xBE, 0xA1, 0x7D, 0x4F, 0x80, 0x6F, 0x90, 0xA1, 0xB5, 0xE0, 0x64, 0x01, 0x70, 0x75, -+0xF1, 0x1E, 0xFF, 0x30, 0xE0, 0x08, 0x90, 0xA2, 0xF1, 0x74, 0x01, 0xF0, 0x80, 0x15, 0xEF, 0xC3, -+0x13, 0x20, 0xE0, 0x0F, 0x90, 0xA2, 0xF1, 0x74, 0x01, 0xF0, 0x12, 0xBF, 0x0E, 0x7D, 0x50, 0x7F, -+0x6F, 0x71, 0x36, 0x90, 0xA2, 0xF1, 0xE0, 0x60, 0x4C, 0x90, 0xA2, 0x31, 0xE0, 0x64, 0x06, 0x60, -+0x38, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x01, 0x40, 0x08, 0x90, 0xA2, 0xF2, 0x74, 0x04, 0xF0, -+0x80, 0x05, 0xE4, 0x90, 0xA2, 0xF2, 0xF0, 0x91, 0x75, 0x12, 0x7F, 0x08, 0x90, 0xA2, 0xF2, 0xE0, -+0xFB, 0x7D, 0x01, 0xB1, 0xE1, 0xBF, 0x01, 0x0A, 0x12, 0x8A, 0xBF, 0x74, 0x03, 0x12, 0x96, 0xC3, -+0x01, 0x1A, 0x12, 0xBE, 0xA1, 0x7D, 0x51, 0x61, 0x36, 0xE4, 0x90, 0xA2, 0x31, 0xF0, 0xF1, 0xF8, -+0xF1, 0x1E, 0x54, 0xFB, 0xF0, 0x90, 0xA1, 0xB5, 0xE0, 0x64, 0x05, 0x70, 0x46, 0xFF, 0x91, 0x7E, -+0xEF, 0x70, 0x40, 0x80, 0x39, 0x90, 0xA2, 0xEF, 0xE0, 0x64, 0x03, 0x70, 0x36, 0x90, 0xA1, 0xB5, -+0xE0, 0x64, 0x05, 0x70, 0x2E, 0xF1, 0xA8, 0x20, 0xE0, 0x15, 0x91, 0x75, 0x04, 0xFF, 0xA3, 0xE0, -+0xB5, 0x07, 0x02, 0xE4, 0xFF, 0x75, 0xF0, 0x13, 0xEF, 0x12, 0x8A, 0xB5, 0xEF, 0x11, 0x12, 0x91, -+0x75, 0xFD, 0x7F, 0x02, 0x12, 0xAE, 0x30, 0xE4, 0xFF, 0x91, 0x7E, 0xEF, 0x70, 0x05, 0x7F, 0x06, -+0x12, 0x78, 0x64, 0x22, 0xF0, 0x90, 0xA1, 0xB3, 0xE0, 0xC3, 0x13, 0x54, 0x07, 0x22, 0x90, 0xA2, -+0xF3, 0xEF, 0xF0, 0xD1, 0x2E, 0xEF, 0x70, 0x02, 0xFF, 0x22, 0x91, 0x75, 0x90, 0xA1, 0xEF, 0xF0, -+0x90, 0xA1, 0xB3, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, 0xEF, 0x54, 0xF1, 0xFF, 0xEE, 0x04, 0x54, 0x07, -+0x25, 0xE0, 0x4F, 0xF0, 0xA3, 0xE0, 0xFF, 0x90, 0xA1, 0xB3, 0xE0, 0xFE, 0xC3, 0x13, 0x54, 0x07, -+0xB5, 0x07, 0x04, 0xEE, 0x54, 0xF1, 0xF0, 0x91, 0x75, 0xF5, 0x25, 0x90, 0xA2, 0xF3, 0xE0, 0x90, -+0xA1, 0xB5, 0x70, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x14, 0xF0, 0x75, 0xF0, 0x13, 0xE5, 0x25, 0x12, -+0x7F, 0xB9, 0x30, 0xE0, 0x26, 0xD1, 0xBD, 0xE0, 0x24, 0xF8, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, -+0x83, 0xE0, 0xFF, 0xD1, 0xA5, 0xEF, 0xD1, 0xBC, 0xE0, 0x04, 0xD1, 0xBC, 0xE0, 0xFF, 0x90, 0xA1, -+0xF7, 0xE0, 0xFE, 0xEF, 0xB5, 0x06, 0x04, 0xD1, 0xBD, 0xE4, 0xF0, 0xD1, 0xA5, 0xE0, 0xFF, 0x90, -+0xA1, 0xEF, 0xE0, 0x75, 0xF0, 0x13, 0xD1, 0xAA, 0xE0, 0x6F, 0x60, 0x6F, 0xD1, 0xA5, 0xE0, 0xFC, -+0x75, 0xF0, 0x13, 0xE5, 0x25, 0x12, 0x7E, 0x9C, 0x12, 0x7B, 0x18, 0x90, 0xA2, 0x28, 0x12, 0x77, -+0xBB, 0x30, 0xE0, 0x40, 0x75, 0xF0, 0x13, 0xE5, 0x25, 0x90, 0xA1, 0xC1, 0xD1, 0xB0, 0x90, 0xA3, -+0x72, 0x12, 0xBF, 0x17, 0x90, 0xA1, 0xC3, 0xD1, 0xB0, 0x90, 0xA3, 0x76, 0x12, 0x08, 0x6D, 0xE4, -+0xFF, 0x12, 0x9E, 0x43, 0x75, 0xF0, 0x13, 0xE5, 0x25, 0x90, 0xA1, 0xC5, 0xD1, 0xB0, 0x90, 0xA3, -+0x7B, 0x12, 0xBF, 0x17, 0x90, 0xA1, 0xC7, 0xD1, 0xB0, 0x90, 0xA3, 0x7F, 0x12, 0x08, 0x6D, 0xE4, -+0xFF, 0x12, 0x9D, 0x6E, 0x75, 0xF0, 0x13, 0xE5, 0x25, 0x12, 0x7E, 0x9C, 0x12, 0x7F, 0xCA, 0xFD, -+0x75, 0xF0, 0x13, 0xE5, 0x25, 0x12, 0x7E, 0x9C, 0x12, 0x7E, 0xAB, 0x75, 0xF0, 0x13, 0xE5, 0x25, -+0x90, 0xA1, 0xBE, 0x12, 0x47, 0xDE, 0xE0, 0x04, 0xF0, 0x90, 0xA2, 0xF3, 0xE0, 0x70, 0x29, 0xF1, -+0xA8, 0x20, 0xE0, 0x24, 0x75, 0xF0, 0x13, 0xE5, 0x25, 0x12, 0x94, 0x34, 0x60, 0x0C, 0x75, 0xF0, -+0x13, 0xE5, 0x25, 0x12, 0x94, 0x34, 0xFF, 0xBF, 0x02, 0x0E, 0x75, 0xF0, 0x13, 0xE5, 0x25, 0x12, -+0x7F, 0x0B, 0x7B, 0x04, 0xE4, 0xFD, 0xB1, 0xE1, 0xAD, 0x25, 0x7F, 0x01, 0x12, 0xAE, 0x30, 0x90, -+0xA1, 0xF1, 0x12, 0x8D, 0x08, 0xBF, 0x02, 0x05, 0xE4, 0xFF, 0x12, 0x78, 0x64, 0x90, 0x01, 0xA5, -+0xE0, 0xB4, 0xFF, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0xA5, 0xE0, 0x04, 0xF0, 0x7F, 0x01, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x92, 0x12, 0xAB, 0xAA, 0x90, 0x04, -+0x1D, 0xE0, 0x60, 0x28, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA3, 0x98, 0xF0, 0x7D, 0x14, 0xD1, 0x2A, -+0xEF, 0x64, 0x01, 0x70, 0x08, 0x12, 0xBD, 0xEB, 0x12, 0x84, 0xD2, 0x80, 0x04, 0x7F, 0x00, 0x80, -+0x14, 0x90, 0xA3, 0x98, 0xE0, 0xFF, 0x7D, 0x15, 0x71, 0x36, 0x80, 0x06, 0x12, 0xBD, 0xEB, 0x12, -+0x84, 0xD2, 0x12, 0xBE, 0xFC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0xFF, 0x71, 0x36, 0xE4, 0x90, -+0xA3, 0xF6, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA3, 0xF8, 0xF0, 0x7D, 0x47, 0x7F, -+0xFF, 0x71, 0x36, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x14, 0xA3, 0xE0, 0x70, 0x10, 0xA3, 0xE0, 0x70, -+0x0C, 0xA3, 0xE0, 0x70, 0x08, 0x12, 0xBF, 0x80, 0x71, 0x36, 0x7F, 0x01, 0x22, 0x12, 0x84, 0x41, -+0x30, 0xE0, 0x15, 0xD3, 0x90, 0xA3, 0xF7, 0xE0, 0x94, 0x03, 0x90, 0xA3, 0xF6, 0xE0, 0x94, 0x00, -+0x40, 0x02, 0x80, 0x13, 0x7F, 0x01, 0x80, 0x20, 0xD3, 0x90, 0xA3, 0xF7, 0xE0, 0x94, 0xE8, 0x90, -+0xA3, 0xF6, 0xE0, 0x94, 0x03, 0x40, 0x0F, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0xBF, -+0x80, 0x71, 0x36, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0xA3, 0xF6, -+0x12, 0x91, 0x20, 0x80, 0x9E, 0x75, 0xF0, 0x13, 0xE5, 0x25, 0x90, 0xA1, 0xB6, 0x02, 0x47, 0xDE, -+0x12, 0x47, 0xDE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0x22, 0xF0, 0x74, 0x1B, 0x25, -+0x25, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0x22, 0xF1, 0xE6, 0x70, 0x30, 0x90, 0xA0, 0xDB, -+0xE0, 0x54, 0xFD, 0xF0, 0x7D, 0x2C, 0x7F, 0x6F, 0x71, 0x36, 0x12, 0x87, 0x9F, 0xF0, 0x7D, 0x08, -+0x7F, 0x01, 0x12, 0x84, 0x4F, 0xBF, 0x01, 0x10, 0x90, 0xA0, 0xDA, 0xE0, 0x44, 0x80, 0xF0, 0x7D, -+0x0E, 0x12, 0xB6, 0xC2, 0x74, 0x0E, 0xF0, 0x22, 0x12, 0xB6, 0x80, 0x04, 0xF0, 0x22, 0x90, 0xA4, -+0x11, 0xEF, 0xF0, 0x12, 0x4A, 0xE6, 0x90, 0xA4, 0x11, 0xE0, 0x60, 0x02, 0xF1, 0xE1, 0xF1, 0xD7, -+0x90, 0xA0, 0xD9, 0x74, 0x04, 0xF0, 0x22, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x90, 0xA1, -+0xB3, 0xE0, 0xC3, 0x13, 0x54, 0x07, 0x75, 0xF0, 0x13, 0x90, 0xA1, 0xBD, 0x12, 0x47, 0xDE, 0xE0, -+0x22, 0xE4, 0x90, 0xA2, 0xEE, 0xF0, 0x90, 0xA1, 0xB3, 0xE0, 0xFF, 0x30, 0xE0, 0x69, 0xF1, 0xA8, -+0x20, 0xE0, 0x64, 0xEF, 0xC3, 0x13, 0x54, 0x07, 0xFF, 0xF1, 0x26, 0xFE, 0x30, 0xE0, 0x58, 0x75, -+0xF0, 0x13, 0xEF, 0x90, 0xA1, 0xBD, 0x12, 0x47, 0xDE, 0xEE, 0x54, 0xFE, 0xF0, 0x75, 0xF0, 0x13, -+0xEF, 0xF1, 0x29, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0A, 0x90, 0xA1, 0xF5, 0xF1, 0x17, 0x54, -+0xFB, 0x12, 0x8C, 0x0B, 0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, 0x22, 0xF1, 0xF8, 0xF1, 0x1E, 0x44, -+0x02, 0xF0, 0xE4, 0x90, 0xA2, 0x31, 0x91, 0x74, 0xFD, 0x7F, 0x02, 0x12, 0xAE, 0x30, 0x90, 0xA2, -+0xEE, 0xE0, 0x60, 0x13, 0xE4, 0x90, 0xA1, 0xF3, 0xF0, 0xA3, 0xF0, 0x61, 0x41, 0x90, 0xA1, 0xF3, -+0xF1, 0x17, 0x54, 0xFD, 0xF0, 0xF1, 0xE1, 0x22, 0x90, 0xA1, 0xF1, 0xE0, 0xC4, 0x13, 0x54, 0x07, -+0x22, 0x90, 0xA1, 0x50, 0xE0, 0x20, 0xE0, 0x1D, 0x90, 0xA0, 0xDF, 0xE0, 0x64, 0x01, 0x70, 0x15, -+0x12, 0xA6, 0x5E, 0x12, 0x61, 0x32, 0x60, 0x05, 0x71, 0x2D, 0x02, 0x96, 0x85, 0x90, 0xA0, 0xE2, -+0xE0, 0x70, 0x02, 0x31, 0x2E, 0x22, 0xF0, 0x7D, 0x04, 0x7F, 0x01, 0x02, 0x59, 0xE7, 0x12, 0x4A, -+0xE6, 0xE4, 0xFD, 0xFF, 0x61, 0x36, 0xE4, 0xFF, 0x12, 0x5E, 0xC9, 0xEF, 0x64, 0x01, 0x22, 0xF1, -+0xE1, 0xF1, 0xD7, 0x12, 0xBC, 0x48, 0xE1, 0x10, 0x90, 0xA1, 0xB5, 0x74, 0x05, 0xF0, 0x22, 0x7F, -+0xF4, 0x12, 0x4A, 0xB0, 0xEF, 0x20, 0xE5, 0x0E, 0x7F, 0xF4, 0x12, 0x4A, 0xB0, 0xEF, 0x7F, 0x01, -+0x20, 0xE4, 0x05, 0x7F, 0x02, 0x22, 0x7F, 0x03, 0x22, 0x12, 0x57, 0xFF, 0x90, 0x9F, 0x19, 0xEF, -+0xF0, 0x11, 0x33, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, -+0x02, 0x36, 0x83, 0x12, 0x4F, 0xB5, 0x11, 0x64, 0x12, 0xAF, 0x2E, 0x12, 0xAF, 0x4D, 0xE4, 0xF5, -+0x51, 0xF5, 0x52, 0xF5, 0x53, 0x75, 0x54, 0x80, 0xAD, 0x51, 0x7F, 0x50, 0x12, 0x48, 0xCF, 0xAD, -+0x52, 0x7F, 0x51, 0x12, 0x48, 0xCF, 0xAD, 0x53, 0x7F, 0x52, 0x12, 0x48, 0xCF, 0xAD, 0x54, 0x7F, -+0x53, 0x02, 0x48, 0xCF, 0x90, 0x01, 0x34, 0x74, 0xFF, 0x11, 0x8C, 0x90, 0x01, 0x3C, 0x11, 0x8C, -+0xFD, 0x7F, 0x54, 0x12, 0x48, 0xCF, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x48, 0xCF, 0x7D, 0xFF, 0x7F, -+0x56, 0x12, 0x48, 0xCF, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x48, 0xCF, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, -+0xF0, 0xA3, 0xF0, 0x22, 0xEF, 0x64, 0x01, 0x70, 0x1F, 0xF1, 0x96, 0x90, 0x01, 0x38, 0x11, 0x8B, -+0x90, 0x01, 0x30, 0x11, 0x8C, 0x90, 0x01, 0x30, 0x74, 0x10, 0xF0, 0x90, 0x01, 0x39, 0x74, 0x01, -+0xF0, 0x90, 0x00, 0x53, 0x74, 0x80, 0xF0, 0x22, 0x12, 0xBD, 0x5F, 0x90, 0xA1, 0x4D, 0xE0, 0x90, -+0x01, 0x31, 0xF0, 0x90, 0xA1, 0x4E, 0xE0, 0x90, 0x01, 0x32, 0xF0, 0x90, 0xA1, 0x4F, 0xE0, 0x90, -+0x01, 0x33, 0xF0, 0x90, 0xA1, 0x48, 0xE0, 0x90, 0x01, 0x38, 0xF0, 0x90, 0xA1, 0x4B, 0xE0, 0x90, -+0x01, 0x3B, 0x51, 0x59, 0x7F, 0x01, 0x12, 0x56, 0xFE, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, -+0x01, 0x7A, 0xA0, 0x79, 0xDA, 0x12, 0x08, 0xAA, 0x12, 0x9A, 0x25, 0x12, 0x08, 0xAA, 0x90, 0xA0, -+0xDE, 0x74, 0x02, 0xF0, 0x90, 0xA0, 0xE5, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x90, -+0xA0, 0xEB, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0x51, 0x51, 0x90, 0xA0, 0xF7, 0xF0, 0xA3, 0x74, 0x0A, -+0xF0, 0x12, 0xBD, 0x3B, 0xE4, 0xFD, 0xFF, 0x31, 0xE7, 0x7D, 0x0C, 0x7F, 0x02, 0x31, 0xE7, 0x31, -+0xE3, 0x90, 0x9F, 0x19, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0xA0, 0xEA, 0x74, 0xFF, 0xF0, 0x80, 0x12, -+0x90, 0x9F, 0x19, 0xE0, 0x90, 0xA0, 0xEA, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, -+0x40, 0xF0, 0x90, 0xA1, 0x3C, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, 0x01, -+0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0x51, 0x51, 0x90, 0xA0, 0xF7, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, -+0x90, 0xA1, 0x47, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0x38, 0xE0, 0x90, 0xA1, 0x48, 0xF0, 0x90, -+0x01, 0x39, 0xE0, 0x90, 0xA1, 0x49, 0xF0, 0x90, 0x01, 0x3A, 0xE0, 0x90, 0xA1, 0x4A, 0xF0, 0x90, -+0x01, 0x3B, 0xE0, 0x90, 0xA1, 0x4B, 0xF0, 0x90, 0x01, 0x30, 0xE0, 0x90, 0xA1, 0x4C, 0xF0, 0x90, -+0x01, 0x31, 0xE0, 0x90, 0xA1, 0x4D, 0xF0, 0x90, 0x01, 0x32, 0xE0, 0x90, 0xA1, 0x4E, 0xF0, 0x90, -+0x01, 0x33, 0xE0, 0x90, 0xA1, 0x4F, 0xF0, 0x7F, 0x01, 0x12, 0xB5, 0x2A, 0x90, 0x05, 0x58, 0x74, -+0x02, 0xF0, 0x7E, 0x00, 0xFF, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x40, 0x12, 0x08, 0xAA, -+0x12, 0xBF, 0x42, 0x12, 0xBF, 0x3A, 0x12, 0x57, 0xE1, 0xE4, 0x90, 0xA1, 0x42, 0xF0, 0x22, 0xE0, -+0x54, 0x7F, 0xF0, 0x7D, 0x0C, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, -+0x10, 0xEF, 0xF0, 0x14, 0x60, 0x15, 0x14, 0x60, 0x19, 0x24, 0x02, 0x70, 0x1A, 0xED, 0x54, 0x01, -+0xFF, 0x90, 0xA0, 0xDA, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x80, 0x0C, 0x90, 0xA0, 0xE2, 0xED, 0xF0, -+0x80, 0x05, 0x90, 0xA0, 0xE1, 0xED, 0xF0, 0x7F, 0x8F, 0x12, 0x4A, 0xB0, 0xEF, 0x30, 0xE4, 0x2C, -+0x90, 0xA4, 0x10, 0xE0, 0x14, 0x60, 0x07, 0x14, 0x60, 0x18, 0x24, 0x02, 0x70, 0x1E, 0x90, 0xA0, -+0xDA, 0xE0, 0x12, 0xBE, 0x7D, 0xFF, 0x90, 0xA0, 0xE2, 0xE0, 0x54, 0x7F, 0x4F, 0xFD, 0x7F, 0x88, -+0x80, 0x07, 0x90, 0xA0, 0xE1, 0xE0, 0xFD, 0x7F, 0x89, 0x12, 0x48, 0xCF, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xF0, 0x90, 0xA0, 0xFC, 0xE0, 0x24, 0x04, 0x22, 0xF0, 0x7D, 0x01, 0x7F, 0x02, 0x51, 0x64, -+0x7D, 0x02, 0x7F, 0x02, 0x74, 0x59, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x61, 0xAC, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x18, 0xD1, 0xF1, 0x60, 0x09, -+0x51, 0xB6, 0x71, 0xBB, 0x12, 0xBF, 0x05, 0x80, 0x06, 0x51, 0xB6, 0x71, 0xA3, 0x71, 0xC3, 0x12, -+0xB6, 0xCB, 0x80, 0x19, 0xD1, 0xF1, 0x60, 0x06, 0x51, 0xB6, 0x71, 0xBB, 0x80, 0x04, 0x51, 0xB6, -+0x71, 0xA3, 0x51, 0x60, 0x7D, 0x01, 0x7F, 0x02, 0x51, 0x64, 0x12, 0xBD, 0x52, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x90, 0x05, 0x62, -+0xE0, 0xFE, 0x90, 0x05, 0x61, 0xE0, 0xFD, 0xED, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, -+0xF9, 0xFF, 0x90, 0xA2, 0xDE, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x57, 0xE6, 0x60, 0x02, 0x61, -+0x97, 0x90, 0xA0, 0xDF, 0xE0, 0x70, 0x02, 0x61, 0x97, 0xF1, 0x01, 0x64, 0x01, 0x70, 0x22, 0x90, -+0x06, 0xAB, 0xE0, 0x90, 0xA0, 0xE6, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0xA0, 0xE5, 0xF0, 0xA3, -+0xE0, 0xFF, 0x70, 0x08, 0x90, 0xA0, 0xE5, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0xA0, 0xE6, 0xEF, -+0xF0, 0x12, 0xB3, 0x53, 0xE4, 0x90, 0xA0, 0xE8, 0x12, 0xB5, 0x4E, 0x12, 0x96, 0x7A, 0x12, 0x96, -+0x17, 0x54, 0xEF, 0xF0, 0xF1, 0x01, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x0F, 0x90, 0xA0, 0xD5, 0xE0, -+0x30, 0xE0, 0x05, 0x12, 0x60, 0xBF, 0x80, 0x03, 0x12, 0x60, 0x7C, 0xD1, 0x3B, 0x30, 0xE0, 0x55, -+0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x20, 0xD1, 0xF9, 0x6F, 0x70, 0x47, 0x90, 0xA0, -+0xDB, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0xA7, 0x27, 0x51, 0xB2, 0x71, 0xBB, 0x71, 0xC9, 0x12, 0x96, -+0xBC, 0x90, 0xA0, 0xE6, 0xE0, 0x14, 0xF0, 0x80, 0x2C, 0x90, 0xA0, 0xDD, 0xE0, 0xC4, 0x54, 0x0F, -+0x64, 0x01, 0x70, 0x21, 0xD1, 0xF9, 0xFE, 0x6F, 0x60, 0x1B, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, -+0x6F, 0x60, 0x12, 0x90, 0xA0, 0xDB, 0x12, 0x87, 0xDA, 0x30, 0xE0, 0x09, 0xEF, 0x54, 0xBF, 0x51, -+0xB2, 0x71, 0xA3, 0x51, 0x5A, 0xD1, 0xC1, 0x90, 0xA0, 0xD5, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x02, -+0xD1, 0xC1, 0x22, 0x74, 0x61, 0x12, 0xBF, 0x60, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x7D, 0x03, 0x7F, 0x02, 0x74, 0x61, 0x2F, 0xF8, 0xE6, -+0x4D, 0x80, 0xE5, 0x7D, 0x02, 0x7F, 0x02, 0x71, 0xCD, 0x7D, 0x01, 0x7F, 0x02, 0x74, 0x59, 0x12, -+0xBF, 0x60, 0xFE, 0xF6, 0x74, 0x30, 0x80, 0xD4, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8B, -+0x0F, 0x8A, 0x10, 0x89, 0x11, 0x90, 0x05, 0x27, 0xE0, 0xF5, 0x12, 0x12, 0x93, 0xA7, 0x75, 0x43, -+0x01, 0x7B, 0x01, 0x7A, 0xA0, 0x79, 0xD5, 0x12, 0x34, 0x62, 0x12, 0x7A, 0x86, 0x12, 0x06, 0x89, -+0xFF, 0xC3, 0x13, 0x20, 0xE0, 0x02, 0x81, 0x96, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x73, 0x71, -+0xB7, 0x75, 0x12, 0x21, 0xF1, 0x0A, 0x30, 0xE0, 0x07, 0xD1, 0x46, 0x43, 0x12, 0x08, 0x80, 0x0C, -+0xE4, 0x90, 0xA0, 0xD6, 0xF0, 0xA3, 0xF0, 0x7D, 0x40, 0xFF, 0x71, 0xCD, 0x90, 0xA0, 0xD5, 0xD1, -+0x3E, 0x30, 0xE0, 0x03, 0x43, 0x12, 0x12, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x43, 0x12, -+0x14, 0x90, 0xA0, 0xD5, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x03, 0x43, 0x12, 0x80, 0x90, -+0xA0, 0xD5, 0x12, 0x84, 0x44, 0x20, 0xE0, 0x03, 0x43, 0x12, 0x40, 0xB1, 0x42, 0x90, 0xA0, 0xD8, -+0xE0, 0x70, 0x04, 0x7F, 0x01, 0xB1, 0x49, 0x90, 0xA0, 0xD5, 0xD1, 0xE9, 0x30, 0xE0, 0x04, 0x7F, -+0x04, 0x80, 0x0B, 0xF1, 0x13, 0xEF, 0x60, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0xB1, 0x49, -+0xA1, 0x09, 0x75, 0x12, 0x01, 0xB1, 0x42, 0x90, 0xA0, 0xD8, 0xE0, 0x64, 0x04, 0x60, 0x02, 0xA1, -+0x3D, 0xFF, 0xB1, 0x49, 0xA1, 0x3D, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x74, 0x71, 0xB7, 0x43, -+0x12, 0x31, 0xF1, 0x0A, 0x30, 0xE0, 0x07, 0xD1, 0x46, 0x43, 0x12, 0x08, 0x80, 0x06, 0x7D, 0x40, -+0xE4, 0xFF, 0x71, 0xCD, 0x90, 0xA0, 0xD5, 0xD1, 0x3E, 0x30, 0xE0, 0x03, 0x43, 0x12, 0x02, 0xEF, -+0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x43, 0x12, 0x04, 0xB1, 0x42, 0x90, 0xA0, 0xD5, 0xD1, 0xE9, -+0x30, 0xE0, 0x0B, 0x12, 0x94, 0xC2, 0x60, 0x31, 0xE4, 0xFD, 0x7F, 0x02, 0x80, 0x1E, 0x12, 0xBC, -+0x48, 0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x02, 0x19, 0x12, 0x57, 0xEF, 0xF1, 0x13, 0xBF, 0x01, 0x09, -+0x90, 0xA0, 0xE1, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x03, 0xE4, 0xFD, 0xFF, 0x12, 0x51, 0x32, 0x80, -+0x08, 0x90, 0xA0, 0xE2, 0xE0, 0x90, 0xA0, 0xD9, 0xF0, 0x90, 0x05, 0x40, 0x74, 0x22, 0xF0, 0x80, -+0x2C, 0x75, 0x12, 0x01, 0xB1, 0x42, 0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x02, 0x06, 0x7D, 0x01, 0x7F, -+0x04, 0x80, 0x0B, 0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x08, 0x07, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x51, -+0x32, 0x12, 0x97, 0xD8, 0x90, 0xA0, 0xE1, 0x12, 0x60, 0x56, 0x12, 0x99, 0xD7, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x05, 0x27, 0xE5, 0x12, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA0, 0xD8, 0xE0, 0xF5, 0x78, 0xE5, 0x78, 0x6F, 0x70, 0x02, 0xC1, 0x36, 0xEF, 0x14, 0x60, -+0x3E, 0x14, 0x60, 0x60, 0x14, 0x70, 0x02, 0xA1, 0xEA, 0x14, 0x70, 0x02, 0xC1, 0x11, 0x24, 0x04, -+0x60, 0x02, 0xC1, 0x36, 0xE5, 0x78, 0xB4, 0x04, 0x05, 0x12, 0xBB, 0xF5, 0xC1, 0x36, 0xE5, 0x78, -+0xB4, 0x02, 0x05, 0x12, 0xBB, 0xED, 0xC1, 0x36, 0xE5, 0x78, 0xB4, 0x03, 0x05, 0x12, 0xBB, 0xF1, -+0xC1, 0x36, 0xE5, 0x78, 0x64, 0x01, 0x60, 0x02, 0xC1, 0x36, 0x12, 0xBB, 0xE5, 0xC1, 0x36, 0xE5, -+0x78, 0xB4, 0x04, 0x04, 0xF1, 0xDF, 0xC1, 0x36, 0xE5, 0x78, 0xB4, 0x02, 0x05, 0x12, 0xBB, 0xFA, -+0xC1, 0x36, 0xE5, 0x78, 0xB4, 0x03, 0x05, 0x12, 0xBC, 0x00, 0x80, 0x7A, 0xE5, 0x78, 0x70, 0x76, -+0xF1, 0xD8, 0x80, 0x72, 0xE5, 0x78, 0xB4, 0x04, 0x05, 0x12, 0xBC, 0x50, 0x80, 0x68, 0xE5, 0x78, -+0xB4, 0x01, 0x04, 0xF1, 0xE7, 0x80, 0x5F, 0xE5, 0x78, 0xB4, 0x03, 0x05, 0x12, 0xBC, 0x5D, 0x80, -+0x55, 0xE5, 0x78, 0x70, 0x51, 0x12, 0xBC, 0x57, 0x80, 0x4C, 0xE5, 0x78, 0xB4, 0x04, 0x05, 0x12, -+0xBC, 0x33, 0x80, 0x42, 0xE5, 0x78, 0xB4, 0x01, 0x05, 0x12, 0xBC, 0x25, 0x80, 0x38, 0xE5, 0x78, -+0xB4, 0x02, 0x05, 0x12, 0xBC, 0x43, 0x80, 0x2E, 0xE5, 0x78, 0x70, 0x2A, 0x12, 0xBC, 0x3E, 0x80, -+0x25, 0xE5, 0x78, 0xB4, 0x03, 0x05, 0x12, 0xBB, 0xD6, 0x80, 0x1B, 0xE5, 0x78, 0xB4, 0x01, 0x05, -+0x12, 0xBB, 0xB9, 0x80, 0x11, 0xE5, 0x78, 0xB4, 0x02, 0x05, 0x12, 0xBB, 0xDC, 0x80, 0x07, 0xE5, -+0x78, 0x70, 0x03, 0x12, 0xBB, 0xBF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA0, 0xDB, 0xE0, 0xFF, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x01, 0x34, 0x74, 0x40, 0xF0, 0xFD, 0xE4, 0xFF, 0x41, -+0x64, 0xEF, 0x70, 0x33, 0x7D, 0x78, 0x7F, 0x02, 0x71, 0xCD, 0x7D, 0x02, 0x7F, 0x03, 0x71, 0xCD, -+0x7D, 0xC8, 0x7F, 0x02, 0x71, 0xA3, 0x12, 0x96, 0x7A, 0xF0, 0xE4, 0xFF, 0xD1, 0xC9, 0xEF, 0x70, -+0x0A, 0xF1, 0x2B, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x80, 0x07, 0x7D, 0x01, 0x7F, 0x0C, 0x12, -+0x51, 0x32, 0xF1, 0x30, 0x02, 0xBF, 0x3A, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, -+0xF0, 0x7D, 0x78, 0xFF, 0x51, 0x64, 0x7D, 0x02, 0x7F, 0x03, 0x51, 0x64, 0x90, 0x06, 0x0A, 0xE0, -+0x44, 0x07, 0x12, 0xB5, 0x4E, 0xE4, 0xFF, 0xD1, 0xC9, 0xBF, 0x01, 0x12, 0x12, 0x95, 0x68, 0xF0, -+0x90, 0xA0, 0xE2, 0xE0, 0x20, 0xE2, 0x09, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x51, 0x32, 0xD1, 0xC1, -+0x22, 0x90, 0xA0, 0xDB, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x12, 0x9A, 0x0C, 0x12, 0x99, 0x71, 0xE0, -+0xFD, 0x7C, 0x00, 0x12, 0x9A, 0x59, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x12, -+0xBF, 0x78, 0x7F, 0x00, 0x60, 0x02, 0x7F, 0x01, 0x22, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x22, 0x90, 0xA1, 0x45, 0xE0, 0x90, 0x01, 0x3F, 0x22, 0x90, 0xA0, 0xE5, 0xE0, 0xFF, 0xA3, 0xE0, -+0x22, 0x90, 0xA0, 0xDD, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0xA0, 0xD5, 0xE0, 0x13, 0x13, -+0x54, 0x3F, 0x22, 0x90, 0x05, 0x43, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x12, -+0xBF, 0x42, 0x12, 0x57, 0xE1, 0x7D, 0x0C, 0x7F, 0x01, 0x21, 0xE7, 0x12, 0x4A, 0xE6, 0xF1, 0x1F, -+0x90, 0xA0, 0xDA, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x8B, 0x0F, 0x8A, 0x10, 0x89, 0x11, 0x12, 0x67, -+0x96, 0xFF, 0xF5, 0x13, 0x12, 0x06, 0x89, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0x12, 0x67, 0x07, -+0xF5, 0x14, 0x80, 0x02, 0x8F, 0x14, 0x85, 0x13, 0x12, 0xE5, 0x12, 0xD3, 0x95, 0x14, 0x50, 0x23, -+0x12, 0x7A, 0x86, 0x12, 0x06, 0x89, 0x54, 0x01, 0xFD, 0xAF, 0x12, 0x12, 0x99, 0x36, 0xAF, 0x12, -+0xD1, 0xC9, 0xEF, 0xAF, 0x12, 0x70, 0x05, 0x12, 0xAE, 0x24, 0x80, 0x03, 0x12, 0xAE, 0x20, 0x05, -+0x12, 0x80, 0xD6, 0xE5, 0x13, 0x70, 0x0E, 0xFF, 0xD1, 0xC9, 0xEF, 0x70, 0x08, 0xF1, 0x2B, 0x54, -+0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x7D, 0x2D, 0x12, 0x56, 0x2A, 0x90, 0x01, 0x37, 0x74, 0x02, -+0xF0, 0xFD, 0x7F, 0x03, 0x51, 0x64, 0x12, 0x4A, 0x1F, 0xE4, 0xFD, 0x7F, 0x01, 0x31, 0xE7, 0xE4, -+0x90, 0xA0, 0xD9, 0xF0, 0x22, 0x90, 0xA0, 0xDA, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA0, 0xE8, -+0xF0, 0xA3, 0xF0, 0x90, 0xA0, 0xE3, 0xF0, 0x90, 0xA0, 0xDB, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, -+0x51, 0x59, 0x7D, 0x10, 0x7F, 0x03, 0x61, 0xA3, 0x90, 0xA0, 0xD8, 0x74, 0x01, 0xF0, 0x22, 0x12, -+0x57, 0xE1, 0x12, 0xBC, 0x48, 0x80, 0xF1, 0x7D, 0x20, 0x7F, 0xFF, 0x12, 0x53, 0x36, 0x12, 0x4A, -+0x1F, 0x90, 0xA0, 0xD8, 0x74, 0x02, 0xF0, 0x22, 0x75, 0xE8, 0x07, 0x75, 0xA8, 0x85, 0x22, 0xE4, -+0x90, 0xA2, 0xBE, 0xF0, 0x90, 0xA2, 0xBE, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0xFF, 0x90, 0x01, 0xC4, -+0xF0, 0x74, 0x5F, 0xA3, 0xF0, 0x12, 0x3D, 0x6E, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x38, 0x90, 0xA0, -+0xDF, 0xE0, 0x60, 0x0E, 0x90, 0xA0, 0xE2, 0xE0, 0xFF, 0x90, 0xA0, 0xE1, 0xE0, 0x6F, 0x60, 0x02, -+0x11, 0x47, 0xC2, 0xAF, 0x12, 0xAF, 0xA0, 0xBF, 0x01, 0x03, 0x12, 0x97, 0x26, 0xD2, 0xAF, 0x12, -+0x4F, 0xF9, 0x12, 0x45, 0x2D, 0x80, 0xBD, 0x90, 0xA0, 0xD5, 0xE0, 0x90, 0xA0, 0xE1, 0x30, 0xE0, -+0x05, 0xE0, 0xFF, 0x02, 0xBC, 0x60, 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x51, 0x32, 0xE4, 0xFF, 0x12, -+0x5E, 0xC9, 0xBF, 0x01, 0x0E, 0x90, 0xA0, 0xDF, 0xE0, 0x60, 0x08, 0x11, 0x74, 0x54, 0x07, 0x70, -+0x02, 0x11, 0x47, 0x22, 0x90, 0xA0, 0xE3, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x06, 0xA9, 0xE0, -+0xF5, 0x21, 0x54, 0xC0, 0x70, 0x07, 0x11, 0x74, 0x54, 0xFD, 0xF0, 0x80, 0xBA, 0xE5, 0x21, 0x30, -+0xE6, 0x18, 0x90, 0xA0, 0xDF, 0xE0, 0x64, 0x01, 0x70, 0x12, 0x31, 0x2B, 0x64, 0x02, 0x60, 0x05, -+0x12, 0xAD, 0x60, 0x80, 0x07, 0x12, 0x96, 0x20, 0x80, 0x02, 0x11, 0x74, 0xE5, 0x21, 0x90, 0xA0, -+0xE3, 0x30, 0xE7, 0x06, 0x12, 0x50, 0x02, 0x02, 0xBF, 0x58, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, -+0x06, 0xA9, 0xE0, 0x90, 0xA2, 0xE0, 0xF0, 0xE0, 0xFD, 0x54, 0xC0, 0x70, 0x04, 0x11, 0x74, 0x80, -+0x56, 0xED, 0x30, 0xE6, 0x3F, 0x90, 0xA0, 0xDF, 0xE0, 0x64, 0x02, 0x70, 0x27, 0x90, 0xA0, 0xDA, -+0xE0, 0xFF, 0xC3, 0x13, 0x20, 0xE0, 0x09, 0x90, 0xA0, 0xE3, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x1A, -+0x31, 0x32, 0x64, 0x01, 0x70, 0x20, 0x90, 0xA0, 0xE3, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x01, 0x12, -+0x85, 0xEB, 0x80, 0x12, 0x31, 0x2B, 0x64, 0x02, 0x60, 0x05, 0x12, 0xAD, 0x60, 0x80, 0x07, 0x12, -+0x96, 0x20, 0x80, 0x02, 0x11, 0x74, 0x90, 0xA2, 0xE0, 0xE0, 0x90, 0xA0, 0xE3, 0x30, 0xE7, 0x06, -+0x12, 0x50, 0x02, 0x02, 0xBF, 0x58, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0xA0, 0xE3, 0xE0, 0x44, -+0x01, 0xF0, 0x90, 0xA0, 0xDD, 0xE0, 0x54, 0x0F, 0x22, 0x51, 0xC3, 0x12, 0x06, 0x89, 0xFF, 0x54, -+0x7F, 0x90, 0xA0, 0xDF, 0xF0, 0xEF, 0x12, 0x77, 0xBC, 0xA3, 0xF1, 0x95, 0xFF, 0x54, 0xF0, 0xC4, -+0x54, 0x0F, 0xFE, 0x90, 0xA0, 0xDD, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x91, 0xE2, 0x54, 0x01, 0x25, -+0xE0, 0xFE, 0x90, 0xA0, 0xDA, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, -+0xFF, 0x31, 0x32, 0x4F, 0xF1, 0x06, 0x90, 0xA0, 0xDE, 0x12, 0xA0, 0xCE, 0xFD, 0x7F, 0x02, 0x12, -+0x59, 0xE7, 0x51, 0xC9, 0x51, 0x13, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0xA1, 0x41, 0x12, 0xA3, 0xAB, -+0x4F, 0xFF, 0x51, 0x12, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x12, 0xBF, 0x90, 0x54, 0x08, -+0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0xFF, 0x51, 0x12, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x12, -+0xBF, 0x90, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xFF, 0x51, 0x12, 0x54, 0x40, 0xFE, 0xEF, -+0x54, 0xBF, 0x4E, 0x90, 0xA1, 0x41, 0xF0, 0x12, 0x5E, 0xE9, 0x20, 0xE0, 0x28, 0xEF, 0xC3, 0x13, -+0x20, 0xE0, 0x0B, 0x75, 0x10, 0x01, 0x90, 0xA1, 0x92, 0xE0, 0x60, 0x0B, 0x80, 0x0E, 0xE4, 0xF5, -+0x10, 0x90, 0xA1, 0x92, 0xE0, 0x60, 0x05, 0xE4, 0xF5, 0x0F, 0x80, 0x03, 0x75, 0x0F, 0x01, 0xAD, -+0x10, 0xAF, 0x0F, 0x51, 0x1E, 0x51, 0xC9, 0x12, 0xB4, 0xF9, 0x12, 0xB6, 0x80, 0xF0, 0x90, 0xA0, -+0xDF, 0x12, 0xBE, 0x94, 0x31, 0x31, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x12, 0x47, 0xDE, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0x90, 0x00, 0x05, 0x02, 0x06, 0xA2, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x74, 0x8D, 0x75, 0x90, 0xA1, 0x53, 0x12, 0x84, 0x44, 0x20, -+0xE0, 0x7C, 0x12, 0x8B, 0x0D, 0x51, 0xBD, 0xE5, 0x74, 0x64, 0x02, 0x60, 0x1A, 0x51, 0xB3, 0xE5, -+0x74, 0x90, 0xA3, 0xC3, 0xB4, 0x01, 0x08, 0x12, 0x47, 0xC6, 0xEC, 0x44, 0x20, 0x80, 0x06, 0x12, -+0x47, 0xC6, 0xEC, 0x44, 0x10, 0x51, 0xBC, 0xE5, 0x75, 0x64, 0x02, 0x60, 0x3D, 0x90, 0xA3, 0xC3, -+0x12, 0x47, 0xC6, 0xE4, 0xFF, 0xEC, 0x51, 0xBD, 0xE5, 0x75, 0x70, 0x09, 0x12, 0xBF, 0x98, 0x44, -+0x77, 0xFF, 0xEC, 0x80, 0x23, 0x12, 0xBF, 0x98, 0x44, 0x66, 0xFF, 0xEC, 0x51, 0xBD, 0x51, 0xB3, -+0x90, 0xA1, 0x92, 0xE0, 0x90, 0xA3, 0xC3, 0x60, 0x08, 0x12, 0x47, 0xC6, 0xEC, 0x44, 0x10, 0x80, -+0x06, 0x12, 0x47, 0xC6, 0xEC, 0x44, 0x20, 0xFC, 0x51, 0xBD, 0xE5, 0x74, 0xB4, 0x02, 0x06, 0xE5, -+0x75, 0x64, 0x02, 0x60, 0x09, 0x90, 0xA3, 0xC3, 0x12, 0x4C, 0x4F, 0x12, 0x8F, 0xCC, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0xA3, 0xC3, 0x12, 0x47, 0xC6, 0xEC, 0x54, 0xCF, 0xFC, 0x90, 0xA3, 0xC3, -+0x02, 0x08, 0x6D, 0x90, 0xA2, 0xC4, 0x12, 0x47, 0xF3, 0x90, 0xA2, 0xC4, 0x02, 0x47, 0xEA, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x51, 0xC3, 0x12, 0x93, 0xA7, 0x75, 0x43, 0x05, 0x7B, 0x01, -+0x7A, 0xA1, 0x79, 0x50, 0x12, 0x34, 0x62, 0x51, 0xC9, 0x12, 0x06, 0x89, 0x20, 0xE0, 0x02, 0x81, -+0x4B, 0x90, 0x05, 0x54, 0xE0, 0x90, 0xA1, 0x61, 0xF0, 0xE0, 0xC3, 0x13, 0x90, 0xA1, 0x60, 0x12, -+0x87, 0xC5, 0x30, 0xE0, 0x13, 0xF1, 0x96, 0x90, 0xA1, 0x51, 0xF0, 0x24, 0x0A, 0x90, 0xA1, 0x82, -+0xF1, 0x06, 0x90, 0xA1, 0x52, 0xF0, 0x80, 0x48, 0xF1, 0x96, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x14, -+0xEF, 0xC3, 0x94, 0x03, 0x50, 0x07, 0x90, 0xA1, 0x51, 0x74, 0x03, 0x80, 0x0C, 0xF1, 0x96, 0x90, -+0xA1, 0x51, 0x80, 0x05, 0x90, 0xA1, 0x51, 0x74, 0x2A, 0xF0, 0x24, 0x0A, 0x90, 0xA1, 0x82, 0xF0, -+0xF1, 0x07, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, 0x94, 0x03, 0x90, 0xA1, 0x52, 0x50, -+0x05, 0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, 0x90, 0xA1, 0x52, 0x74, 0x2A, 0xF0, -+0x12, 0x84, 0x41, 0x30, 0xE0, 0x3D, 0x90, 0xA1, 0x51, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0xA1, -+0x59, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0xA1, 0x52, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, -+0xA1, 0x5B, 0xF0, 0x90, 0xA1, 0x51, 0xE0, 0xC3, 0x13, 0x90, 0xA1, 0x5C, 0xF0, 0x90, 0xA1, 0x52, -+0xE0, 0xC3, 0x13, 0x90, 0xA1, 0x5D, 0xF0, 0x90, 0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, -+0x12, 0x5B, 0xBB, 0xE4, 0x90, 0xA1, 0x90, 0xF0, 0x91, 0xDC, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, -+0xE0, 0x36, 0x90, 0xA1, 0x50, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x06, 0x12, 0x77, 0xBB, 0x30, 0xE0, -+0x27, 0x12, 0x06, 0x89, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x08, 0x90, 0xA1, 0x92, 0xE0, -+0x60, 0x08, 0x80, 0x0B, 0x90, 0xA1, 0x92, 0xE0, 0x60, 0x05, 0x75, 0x0F, 0x01, 0x80, 0x03, 0xE4, -+0xF5, 0x0F, 0x7D, 0x02, 0xAF, 0x0F, 0x51, 0x1E, 0x90, 0xA1, 0x50, 0xE0, 0xC4, 0x54, 0x0F, 0x30, -+0xE0, 0x15, 0x12, 0xAB, 0x6D, 0x54, 0x07, 0x30, 0xE0, 0x07, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x59, -+0xE7, 0x12, 0xBF, 0x88, 0x74, 0x11, 0xF0, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, 0xA1, 0x58, -+0xE0, 0xB4, 0x01, 0x08, 0x90, 0xA1, 0x63, 0x74, 0x01, 0xF0, 0x80, 0x28, 0x90, 0xA1, 0x58, 0xE0, -+0xB4, 0x04, 0x08, 0x90, 0xA1, 0x63, 0x74, 0x04, 0xF0, 0x80, 0x19, 0x90, 0xA1, 0x58, 0xE0, 0xB4, -+0x06, 0x08, 0x90, 0xA1, 0x63, 0x74, 0x02, 0xF0, 0x80, 0x0A, 0x90, 0xA1, 0x58, 0xE0, 0xB4, 0x07, -+0x03, 0x12, 0x87, 0xA6, 0xE4, 0x90, 0xA1, 0x58, 0xF0, 0x80, 0x55, 0x91, 0xDC, 0x12, 0x5E, 0xEA, -+0x30, 0xE0, 0x05, 0x75, 0x10, 0x02, 0x80, 0x11, 0x12, 0x06, 0x89, 0x12, 0x5E, 0x3F, 0x30, 0xE0, -+0x05, 0x75, 0x10, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x10, 0x12, 0xAD, 0x08, 0x90, 0xA1, 0xB1, 0xE0, -+0x30, 0xE0, 0x04, 0x7D, 0xA0, 0x80, 0x02, 0x7D, 0x20, 0x7F, 0x40, 0x12, 0x48, 0xCF, 0x91, 0xDC, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x8B, -+0x4F, 0xAD, 0x10, 0x7F, 0x02, 0x51, 0x1E, 0x12, 0x57, 0xE1, 0x12, 0xBF, 0x88, 0x74, 0x43, 0xF0, -+0x12, 0xAB, 0x97, 0x90, 0xA1, 0x62, 0xF0, 0x12, 0x77, 0xB8, 0x30, 0xE0, 0x09, 0x90, 0xA1, 0x83, -+0xE0, 0x44, 0x02, 0xF0, 0x80, 0x0C, 0x7F, 0x01, 0x12, 0x97, 0xE1, 0x90, 0xA1, 0x83, 0xE0, 0x54, -+0xFD, 0xF0, 0x7F, 0x03, 0x12, 0x8D, 0x4E, 0x90, 0xA1, 0x50, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0xA1, -+0x54, 0xE0, 0x54, 0xBF, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x90, 0xA2, 0xC4, 0x12, -+0x47, 0xEA, 0x90, 0x00, 0x03, 0x02, 0x06, 0xA2, 0xF1, 0xEB, 0x12, 0x06, 0x89, 0xF5, 0x0F, 0x24, -+0x91, 0xB1, 0x83, 0xE0, 0x54, 0x98, 0xB1, 0x7E, 0xC0, 0x83, 0xC0, 0x82, 0x91, 0xDA, 0x54, 0x01, -+0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xB1, 0x7E, 0xC0, 0x83, 0xC0, 0x82, 0x91, 0xDA, 0x54, -+0x02, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xB1, 0x7E, 0xC0, 0x83, 0xC0, 0x82, 0x91, 0xDA, -+0x54, 0x04, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xB1, 0x7E, 0xC0, 0x83, 0xC0, 0x82, 0x91, -+0xDA, 0x54, 0x40, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xB1, 0x7E, 0xC0, 0x83, 0xC0, 0x82, -+0x91, 0xDA, 0x54, 0x20, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xE5, 0x0F, 0x70, 0x08, -+0x91, 0xE2, 0x54, 0x04, 0x90, 0x04, 0xAB, 0xF0, 0xE5, 0x0F, 0xC3, 0x94, 0x80, 0x50, 0x07, 0xF1, -+0x07, 0x12, 0x6D, 0x11, 0xEF, 0xF0, 0xB1, 0x7F, 0xE0, 0x30, 0xE5, 0x11, 0xD1, 0xF9, 0x13, 0x13, -+0x54, 0x03, 0xFB, 0x12, 0x6D, 0x12, 0xE0, 0xFD, 0xAF, 0x0F, 0x12, 0xB7, 0x73, 0x22, 0xF0, 0x74, -+0x91, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x22, 0x75, 0x40, 0xFF, 0x75, 0x41, -+0x43, 0x75, 0x42, 0xB1, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0x9F, 0x79, 0x1C, 0xF1, 0xDE, 0x75, -+0x41, 0x43, 0x75, 0x42, 0xB7, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0x9F, 0x79, 0x22, 0xF1, 0xDE, -+0x75, 0x41, 0x43, 0x75, 0x42, 0xBD, 0x75, 0x43, 0x54, 0x7B, 0x01, 0x7A, 0x9F, 0x79, 0x28, 0xF1, -+0xDE, 0x75, 0x41, 0x44, 0x75, 0x42, 0x11, 0x75, 0x43, 0x54, 0x7B, 0x01, 0x7A, 0x9F, 0x79, 0x7C, -+0x12, 0x34, 0x62, 0xE4, 0xF5, 0x0D, 0xE4, 0xFF, 0x74, 0x91, 0x25, 0x0D, 0xB1, 0x83, 0xE0, 0x54, -+0xFE, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0D, 0x90, 0x81, 0x00, 0xBF, 0x03, 0x08, 0x12, 0x73, 0xCD, -+0x74, 0x80, 0xF0, 0x80, 0x05, 0x12, 0x73, 0xCD, 0xE4, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x0D, 0x12, -+0x73, 0xCA, 0xE4, 0xF0, 0x0F, 0xBF, 0x10, 0xD0, 0x05, 0x0D, 0xE5, 0x0D, 0xB4, 0x80, 0xC7, 0xE4, -+0x90, 0xAD, 0xE2, 0xF0, 0xF5, 0x0D, 0xE4, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x0D, 0x12, 0x6E, 0xA9, -+0xF0, 0x0F, 0xBF, 0x05, 0xF3, 0x74, 0x12, 0x25, 0x0D, 0x12, 0xBE, 0x75, 0x74, 0x3F, 0xF0, 0x74, -+0x11, 0x25, 0x0D, 0x12, 0x6D, 0x54, 0xE4, 0xF0, 0x74, 0x01, 0x25, 0x0D, 0x12, 0x6D, 0x22, 0x74, -+0xC0, 0xF0, 0x74, 0x92, 0x25, 0x0D, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xE5, -+0x0D, 0x12, 0x6F, 0xC9, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x91, 0x25, 0x0D, 0x12, 0x6F, 0x9B, 0xD1, -+0xF0, 0x12, 0x6F, 0xE1, 0x74, 0x3F, 0xD1, 0xF1, 0xF1, 0xE5, 0xD1, 0xF0, 0x12, 0x6E, 0x46, 0x54, -+0xE0, 0x44, 0x09, 0xD1, 0xF1, 0xD1, 0xFE, 0x54, 0xF3, 0xD1, 0xF1, 0xD1, 0xFE, 0x54, 0xFC, 0xD1, -+0xF1, 0x12, 0x6E, 0x46, 0x44, 0x20, 0xD1, 0xF1, 0xD1, 0xFE, 0x54, 0xCF, 0xD1, 0xF1, 0xD1, 0xFE, -+0x44, 0x40, 0xD1, 0xF1, 0xD1, 0xFE, 0x54, 0x7F, 0xD1, 0xF1, 0xF1, 0xE5, 0xE0, 0xFF, 0x75, 0xF0, -+0x10, 0xE5, 0x0D, 0x12, 0x73, 0xFC, 0xEF, 0xF0, 0x74, 0x91, 0x25, 0x0D, 0xB1, 0x83, 0xE4, 0xF0, -+0x05, 0x0D, 0xE5, 0x0D, 0x64, 0x80, 0x60, 0x02, 0xC1, 0x16, 0x90, 0x04, 0x49, 0x74, 0xF0, 0xF0, -+0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0xA2, 0xB9, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, -+0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xE4, 0xFB, 0xFD, 0xFF, 0x12, 0xAC, -+0xCF, 0x74, 0x11, 0x25, 0x0D, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x22, -+0xE4, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0D, 0x22, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x96, -+0x14, 0x12, 0x47, 0xDE, 0xE0, 0x22, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x06, 0xA2, 0x12, 0x7F, 0xC1, -+0xC3, 0x13, 0x54, 0x0F, 0x90, 0xA2, 0xC4, 0xF1, 0x06, 0x54, 0x03, 0xFE, 0xF1, 0x96, 0xFD, 0xED, -+0xF1, 0xD5, 0x90, 0xA1, 0xC1, 0x12, 0xB2, 0x0E, 0xF1, 0x06, 0x7E, 0x00, 0x78, 0x02, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0x54, 0x3F, 0xFD, 0x91, 0xE2, 0x75, 0xF0, 0x40, 0xA4, 0xFF, 0xE5, -+0xF0, 0x54, 0x03, 0xFE, 0xEF, 0x54, 0xC0, 0xF1, 0xD2, 0x90, 0xA1, 0xC3, 0x51, 0x0B, 0x54, 0x07, -+0xFE, 0x12, 0xA0, 0xCF, 0xFD, 0xED, 0xF1, 0xD5, 0x90, 0xA1, 0xC5, 0x51, 0x0B, 0x7E, 0x00, 0x78, -+0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0x54, 0x1F, 0xFD, 0x12, 0x7A, 0x79, 0x75, 0xF0, -+0x20, 0xA4, 0xFF, 0xE5, 0xF0, 0x54, 0x07, 0xFE, 0xEF, 0x54, 0xE0, 0xF1, 0xD2, 0x90, 0xA1, 0xC7, -+0x12, 0xB2, 0x0E, 0xF0, 0x12, 0x06, 0x89, 0x12, 0xBE, 0x7D, 0xFF, 0x90, 0xA2, 0x28, 0xE0, 0x54, -+0x7F, 0x4F, 0xF0, 0x22, 0x4F, 0xF0, 0x90, 0x00, 0x01, 0x02, 0x06, 0xA2, 0xF1, 0xEB, 0x51, 0x13, -+0x30, 0xE1, 0x03, 0x02, 0xB8, 0x73, 0x51, 0xC9, 0x12, 0x06, 0x89, 0x90, 0xA2, 0xC7, 0xF1, 0x95, -+0x90, 0xA2, 0xC8, 0xF1, 0x06, 0x12, 0xA0, 0xCB, 0x75, 0xF0, 0x10, 0xA4, 0xFF, 0x91, 0xE2, 0xFD, -+0xEF, 0x4D, 0xFF, 0x90, 0xA2, 0xC8, 0xE0, 0xB4, 0x01, 0x07, 0xA3, 0xE0, 0x12, 0xB8, 0xF6, 0xEF, -+0xF0, 0x22, 0xFF, 0xEF, 0x4D, 0xFF, 0x90, 0xA2, 0xC4, 0xE0, 0x75, 0xF0, 0x13, 0x22, 0x12, 0x34, -+0x62, 0x75, 0x40, 0xFF, 0x22, 0x90, 0x96, 0x12, 0x02, 0x47, 0xDE, 0x90, 0xA2, 0xC4, 0x02, 0x47, -+0xF3, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x47, 0x2E, 0x90, 0xA2, 0xBF, 0xEF, 0xF0, 0x60, -+0xF0, 0x90, 0x9F, 0x13, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, -+0xE0, 0x0E, 0x90, 0x9F, 0x13, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0xB0, 0xEB, 0x11, 0x51, -+0x11, 0x48, 0xFF, 0x30, 0xE1, 0x06, 0x54, 0xFD, 0xF0, 0x12, 0xA5, 0x0B, 0x11, 0x48, 0xFF, 0x30, -+0xE2, 0x06, 0x54, 0xFB, 0xF0, 0x12, 0x92, 0xD4, 0x11, 0x48, 0xFF, 0x30, 0xE6, 0x06, 0x54, 0xBF, -+0xF0, 0x12, 0x9F, 0xD7, 0xD2, 0xAF, 0x80, 0xB9, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x9F, 0x13, 0xE0, -+0x22, 0xE4, 0xF5, 0x0F, 0x90, 0xA0, 0xD4, 0xE0, 0xFF, 0xE5, 0x0F, 0xC3, 0x9F, 0x40, 0x02, 0xA1, -+0x10, 0xE5, 0x0F, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA2, 0xCD, 0xF0, 0xE5, 0x0F, 0x54, 0x07, -+0xA3, 0xF0, 0x90, 0x04, 0xA0, 0xE0, 0xFF, 0xA3, 0xE0, 0xFE, 0xEF, 0x64, 0x01, 0x70, 0x25, 0xE5, -+0x0F, 0x6E, 0x70, 0x20, 0xA3, 0xE0, 0xF5, 0x10, 0xA3, 0xE0, 0x12, 0x73, 0xF3, 0xE5, 0x10, 0xF0, -+0xF1, 0x8C, 0xE0, 0x54, 0xFC, 0xFF, 0x90, 0xA2, 0xC9, 0xE0, 0x54, 0x03, 0x4F, 0xFF, 0xF1, 0x8C, -+0xEF, 0xF0, 0xA1, 0x0C, 0xAF, 0x0F, 0x12, 0x5E, 0xC9, 0xEF, 0x70, 0x02, 0xA1, 0x0C, 0x12, 0x66, -+0xF9, 0x12, 0x77, 0xBC, 0x30, 0xE0, 0x02, 0xA1, 0x0C, 0x90, 0xA2, 0xCD, 0x12, 0x77, 0x82, 0xE0, -+0xFD, 0x7C, 0x00, 0x90, 0xA2, 0xCE, 0xE0, 0x12, 0x9A, 0x58, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0x12, 0xBF, 0x78, 0x60, 0x02, 0xA1, 0x0C, 0xF1, 0xC7, 0xE0, 0xFE, 0xA3, 0xE0, -+0x4E, 0x70, 0x07, 0xF1, 0x97, 0xE0, 0x70, 0x02, 0xA1, 0x0C, 0xE5, 0x0F, 0x12, 0xAC, 0xA8, 0x7B, -+0x01, 0x90, 0xA2, 0xC3, 0x12, 0x47, 0xF3, 0xF1, 0xC7, 0xE0, 0xF5, 0x14, 0xA3, 0xE0, 0xF5, 0x15, -+0xF1, 0x97, 0xE0, 0xFF, 0x90, 0xA2, 0xC6, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0xE5, -+0x0F, 0xF1, 0xE1, 0xE0, 0x90, 0xA2, 0xC8, 0xF0, 0xFD, 0x12, 0x66, 0xF9, 0xFE, 0x13, 0x13, 0x54, -+0x03, 0x12, 0x73, 0xF3, 0xE0, 0xF5, 0x10, 0x54, 0x7F, 0xF5, 0x11, 0xD3, 0x9D, 0x40, 0x16, 0x90, -+0xA2, 0xC8, 0xE0, 0xF5, 0x11, 0xE5, 0x10, 0x30, 0xE7, 0x07, 0xE5, 0x11, 0x44, 0x80, 0xFF, 0x80, -+0x02, 0xAF, 0x11, 0x8F, 0x10, 0xE5, 0x11, 0x90, 0x41, 0x5F, 0x93, 0xB1, 0x11, 0xE0, 0xC3, 0x9F, -+0x40, 0x0B, 0x74, 0x28, 0x25, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0x80, 0x09, 0x74, 0x7C, 0x25, -+0x11, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xFF, 0x12, 0xAC, 0x77, 0x90, 0xA2, 0xC0, -+0x12, 0x47, 0xF3, 0xB1, 0x36, 0xC3, 0x94, 0x05, 0x40, 0x02, 0x41, 0xD8, 0xAD, 0x16, 0xAF, 0x11, -+0x12, 0xB8, 0x23, 0x8F, 0x16, 0xE5, 0x10, 0x30, 0xE7, 0x04, 0x05, 0x16, 0x05, 0x16, 0xE5, 0x16, -+0xD3, 0x94, 0x1A, 0xAF, 0x16, 0x40, 0x02, 0x7F, 0x1A, 0x12, 0xAC, 0x77, 0x90, 0xA2, 0xC0, 0x12, -+0x47, 0xF3, 0xC3, 0xE5, 0x15, 0x94, 0x0F, 0xE5, 0x14, 0x94, 0x00, 0x50, 0x71, 0xF1, 0xA3, 0xFF, -+0x90, 0xA2, 0xC7, 0xE0, 0x2F, 0xFF, 0x90, 0xA2, 0xC6, 0xE0, 0x35, 0xF0, 0xFE, 0xF1, 0xD5, 0xFF, -+0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x04, 0x12, 0x07, 0xAB, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0x12, -+0xBE, 0xF2, 0xFF, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x05, 0x12, 0x9B, 0xA1, 0x41, 0xD1, 0x90, -+0xA2, 0xC3, 0x12, 0x47, 0xEA, 0x12, 0x07, 0x80, 0x65, 0x15, 0x70, 0x04, 0xE5, 0xF0, 0x65, 0x14, -+0x75, 0xF0, 0x04, 0x70, 0x22, 0xD1, 0x44, 0x12, 0x5E, 0xEA, 0xFE, 0xEF, 0x54, 0x3F, 0xFF, 0xEE, -+0x04, 0x54, 0x03, 0xFE, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0x4F, 0xF0, 0xE4, 0xFD, 0xAF, 0x0F, 0x12, -+0x9A, 0x61, 0x75, 0xF0, 0x04, 0x80, 0x00, 0xD1, 0x44, 0x54, 0x3F, 0xF0, 0x41, 0xD1, 0xE5, 0x0F, -+0x70, 0x44, 0xF1, 0xA3, 0xFF, 0xAE, 0xF0, 0xF1, 0xD5, 0xFD, 0xE5, 0xF0, 0x3E, 0x12, 0xBE, 0xF2, -+0xFF, 0xC3, 0xED, 0x9F, 0xEC, 0x9E, 0x50, 0x08, 0x90, 0x9F, 0x12, 0x74, 0x01, 0xF0, 0x80, 0x26, -+0xF1, 0xA3, 0xFB, 0xAA, 0xF0, 0xE5, 0x15, 0xAE, 0x14, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, -+0xD8, 0xF9, 0xFF, 0x7C, 0x00, 0x7D, 0x05, 0x12, 0x07, 0x03, 0xD3, 0xEB, 0x9F, 0xEA, 0x9E, 0x40, -+0x05, 0xE4, 0x90, 0x9F, 0x12, 0xF0, 0xAB, 0x16, 0xAD, 0x0F, 0xAF, 0x15, 0xAE, 0x14, 0x12, 0xAB, -+0xB6, 0x8E, 0x12, 0x8F, 0x13, 0x12, 0x9F, 0xCB, 0xF5, 0x83, 0xC3, 0x12, 0xBE, 0xE8, 0x50, 0x09, -+0x7D, 0x01, 0xAF, 0x0F, 0x12, 0x9A, 0x61, 0x80, 0x0E, 0x12, 0xBE, 0x65, 0xF5, 0x83, 0xD3, 0x12, -+0xBE, 0xE8, 0x40, 0x09, 0x12, 0x9B, 0xA1, 0xB1, 0x2A, 0xE4, 0xF0, 0x80, 0x34, 0xB1, 0x2A, 0xE0, -+0x04, 0xF0, 0xB1, 0x2A, 0xE0, 0xC3, 0x94, 0x05, 0x40, 0x27, 0xB1, 0x2A, 0xE4, 0xF0, 0x12, 0xBE, -+0x65, 0x12, 0x9D, 0x64, 0x12, 0x9F, 0xCB, 0xF5, 0x83, 0x74, 0x01, 0x93, 0x2F, 0xFF, 0xE4, 0x93, -+0x3E, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x0F, 0x12, 0x9D, 0x49, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0xE4, 0xF5, 0x12, 0xF5, 0x13, 0x81, 0xE9, 0xB1, 0x36, 0xF9, 0x64, 0x05, 0x60, 0x02, 0x61, -+0x91, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, 0x12, 0x94, 0x37, 0xF5, 0x19, 0xB1, 0x12, -+0xE0, 0xC3, 0x94, 0x30, 0x40, 0x12, 0x12, 0x65, 0x7F, 0xE0, 0x20, 0xE2, 0x0B, 0x12, 0x66, 0xF9, -+0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x0D, 0xE4, 0xF5, 0x19, 0xB1, 0x43, 0xE4, 0xF0, 0xF1, -+0xBB, 0xE4, 0xF0, 0x80, 0x0B, 0xAD, 0x11, 0xAF, 0x0F, 0x12, 0xB6, 0xFC, 0xF1, 0xBB, 0xEF, 0xF0, -+0xF1, 0xBB, 0xE0, 0x64, 0x01, 0x70, 0x62, 0xF1, 0xAF, 0xE0, 0xFF, 0x24, 0x05, 0xFD, 0xE4, 0x33, -+0xFC, 0xB1, 0x12, 0xE0, 0xFE, 0xC3, 0x12, 0xB3, 0x4A, 0x50, 0x0B, 0x12, 0xBE, 0x71, 0xE0, 0xFD, -+0xE5, 0x11, 0xC3, 0x9D, 0x40, 0x1B, 0xE5, 0x19, 0x70, 0x05, 0x75, 0x19, 0x01, 0x80, 0x0D, 0xE5, -+0x19, 0xB4, 0x01, 0x05, 0x75, 0x19, 0x03, 0x80, 0x03, 0x75, 0x19, 0x05, 0xF1, 0xAF, 0xEE, 0x80, -+0x1D, 0xB1, 0x12, 0xE0, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xC3, 0xEF, 0x12, 0xB3, 0x4A, 0x50, -+0x06, 0xB1, 0x50, 0xE0, 0xB4, 0x0A, 0x0D, 0xB1, 0x12, 0xE0, 0xFF, 0xF1, 0xAF, 0xEF, 0xB1, 0x4F, -+0xE4, 0xF0, 0x80, 0x05, 0xB1, 0x43, 0xE0, 0x04, 0xF0, 0x12, 0xBE, 0x71, 0xE5, 0x11, 0xF0, 0x81, -+0xD6, 0xE9, 0x64, 0x06, 0x60, 0x02, 0x81, 0xE9, 0xF5, 0x12, 0xF5, 0x13, 0x75, 0xF0, 0x10, 0xE5, -+0x0F, 0x90, 0x81, 0x01, 0x12, 0x94, 0x37, 0xF5, 0x19, 0xAF, 0x15, 0xAE, 0x14, 0x12, 0xAC, 0xB5, -+0x8F, 0x17, 0xE5, 0x16, 0xD3, 0x94, 0x13, 0x40, 0x1F, 0x90, 0xA2, 0xC0, 0x12, 0x47, 0xEA, 0x12, -+0x62, 0x13, 0xFD, 0x7C, 0x00, 0xE5, 0x15, 0xAE, 0x14, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x80, 0x19, 0xE5, 0x15, 0xAE, 0x14, 0xA8, 0x17, 0x08, 0x80, -+0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x43, 0xB0, 0xE4, 0x93, 0xFD, 0x7C, -+0x00, 0x12, 0x07, 0x03, 0x90, 0xA2, 0xCA, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xF5, 0x18, 0xE5, -+0x16, 0xD3, 0x94, 0x13, 0x40, 0x1E, 0x12, 0xAC, 0x89, 0xA8, 0x17, 0x08, 0x80, 0x05, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xA2, 0xC0, 0x12, 0x47, 0xEA, 0x85, 0x18, 0x82, 0x12, -+0xA4, 0x0E, 0x80, 0x16, 0x12, 0xAC, 0x89, 0xA8, 0x17, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, -+0x13, 0xD8, 0xF9, 0xFF, 0xE5, 0x18, 0x90, 0x43, 0xAB, 0x93, 0x12, 0xAC, 0xA0, 0x25, 0x13, 0xF5, -+0x13, 0xEE, 0x35, 0x12, 0xF5, 0x12, 0xC3, 0x90, 0xA2, 0xCB, 0xE0, 0x95, 0x13, 0x90, 0xA2, 0xCA, -+0xE0, 0x95, 0x12, 0x40, 0x08, 0x05, 0x18, 0xE5, 0x18, 0x64, 0x05, 0x70, 0xA2, 0xE5, 0x18, 0xC3, -+0x13, 0xF5, 0x18, 0xE5, 0x19, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0xFF, -+0xD3, 0x95, 0x18, 0x40, 0x06, 0xEF, 0x95, 0x18, 0xFF, 0x80, 0x02, 0xE4, 0xFF, 0xB1, 0x1E, 0xE0, -+0xC3, 0x13, 0xFE, 0xEF, 0xC4, 0x33, 0x54, 0xE0, 0x2E, 0xFE, 0xB1, 0x1E, 0xEE, 0xF0, 0xB1, 0x1E, -+0xE0, 0xC3, 0x94, 0xC0, 0x40, 0x05, 0xB1, 0x1E, 0x74, 0xC0, 0xF0, 0xB1, 0x1E, 0xE0, 0x24, 0x1F, -+0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x06, 0xCE, 0xA2, 0xE7, 0x13, 0xCE, 0x13, 0xD8, 0xF8, 0x25, -+0xE0, 0xFF, 0x70, 0x04, 0xF5, 0x19, 0x80, 0x04, 0xEF, 0x14, 0xF5, 0x19, 0xD3, 0x90, 0xA2, 0xC7, -+0xE0, 0x94, 0x03, 0x90, 0xA2, 0xC6, 0xE0, 0x94, 0x00, 0x50, 0x08, 0xB1, 0x12, 0xE0, 0xC3, 0x94, -+0x30, 0x50, 0x03, 0xE4, 0xF5, 0x19, 0x12, 0x77, 0x67, 0xE0, 0x54, 0xF8, 0x90, 0xA2, 0xCC, 0xF0, -+0x45, 0x19, 0xFF, 0xF0, 0x12, 0x77, 0x67, 0xEF, 0xF0, 0xB1, 0x36, 0xD3, 0x94, 0x05, 0x74, 0x92, -+0x50, 0x06, 0xB1, 0x38, 0x04, 0xF0, 0x80, 0x0B, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, -+0x83, 0xE4, 0xF0, 0x75, 0x1A, 0x01, 0x7D, 0x01, 0xAF, 0x0F, 0xD1, 0x4E, 0x05, 0x0F, 0x01, 0x54, -+0x22, 0xFF, 0x74, 0x11, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0x22, 0x74, 0x01, -+0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0x74, 0x11, 0x25, 0x0F, 0xF5, 0x82, -+0xE4, 0x34, 0x98, 0xF5, 0x83, 0x22, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, -+0x83, 0xE0, 0x22, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, 0xF0, -+0x74, 0x11, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x22, 0x8F, 0x12, 0x90, 0xA2, -+0xC4, 0x74, 0x0E, 0xF0, 0xED, 0x24, 0xFE, 0x60, 0x6C, 0x04, 0x60, 0x02, 0xC1, 0x38, 0x12, 0xBE, -+0xDE, 0x74, 0x0C, 0xF0, 0x74, 0x11, 0x25, 0x12, 0xB1, 0x16, 0xE0, 0x90, 0xA2, 0xC7, 0xF0, 0x75, -+0xF0, 0x04, 0xE5, 0x12, 0x12, 0x66, 0xFE, 0xFD, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA2, 0xC8, 0xF0, -+0xED, 0x12, 0x77, 0xBC, 0xA3, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x12, 0x12, 0x66, 0xFE, 0xFF, 0xC4, -+0x54, 0x03, 0x90, 0xA2, 0xCA, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x12, 0xF1, 0xE1, 0xE0, 0x90, 0xA2, -+0xCB, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x12, 0x12, 0x67, 0xE5, 0xE0, 0x90, 0xA2, 0xCC, 0xF0, 0x75, -+0xF0, 0x04, 0xE5, 0x12, 0xD1, 0x46, 0xFD, 0xC4, 0x13, 0x54, 0x01, 0x90, 0xA2, 0xCD, 0xF0, 0xED, -+0x54, 0x1F, 0xA3, 0x80, 0x5A, 0x12, 0xBE, 0xDE, 0x74, 0x0D, 0xD1, 0x39, 0x12, 0x73, 0xED, 0xE0, -+0x90, 0xA2, 0xC7, 0xD1, 0x39, 0x90, 0x89, 0x01, 0x12, 0x47, 0xDE, 0xE0, 0x90, 0xA2, 0xC8, 0xD1, -+0x39, 0x90, 0x89, 0x02, 0x12, 0x47, 0xDE, 0xE0, 0x90, 0xA2, 0xC9, 0xD1, 0x39, 0x90, 0x89, 0x03, -+0x12, 0x47, 0xDE, 0xE0, 0x90, 0xA2, 0xCA, 0xD1, 0x39, 0x12, 0xBF, 0x70, 0x90, 0xA2, 0xCB, 0xD1, -+0x39, 0x90, 0x89, 0x05, 0x12, 0x47, 0xDE, 0xE0, 0x90, 0xA2, 0xCC, 0xD1, 0x39, 0x90, 0x89, 0x06, -+0x12, 0x47, 0xDE, 0xE0, 0x90, 0xA2, 0xCD, 0xD1, 0x39, 0x12, 0xBF, 0x68, 0x90, 0xA2, 0xCE, 0xD1, -+0xBA, 0x12, 0x78, 0x06, 0x7F, 0x04, 0xF1, 0x67, 0x22, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x12, 0x22, -+0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x96, 0x13, 0x12, 0x47, 0xDE, 0xE0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x40, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x01, 0xD1, -+0xB3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x03, 0xD1, 0xB3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, -+0x90, 0x8D, 0x05, 0xD1, 0xB3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x07, 0xD1, 0xB3, 0xF0, -+0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x09, 0xD1, 0xB3, 0xF0, 0xEF, 0xF1, 0xC9, 0xE4, 0xF0, 0xA3, -+0xF0, 0x74, 0x91, 0x2F, 0xF1, 0x9B, 0xE4, 0xF0, 0xF1, 0x82, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, -+0xF1, 0x82, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8D, 0x01, 0x12, 0x47, 0xDE, 0x75, -+0xF0, 0x02, 0xEF, 0x12, 0x47, 0xDE, 0xE4, 0xF0, 0xA3, 0x22, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, -+0xC4, 0x22, 0xD1, 0xBB, 0x7F, 0xF5, 0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, 0x01, 0x06, 0x90, 0xA2, -+0xC4, 0xE0, 0xA3, 0xF0, 0xD1, 0xBB, 0x7F, 0xF6, 0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, 0x01, 0x08, -+0x90, 0xA2, 0xC4, 0xE0, 0x90, 0xA2, 0xC6, 0xF0, 0xD1, 0xBB, 0x7F, 0xF4, 0x7E, 0x01, 0x12, 0x33, -+0xFD, 0xBF, 0x01, 0x08, 0x90, 0xA2, 0xC4, 0xE0, 0x90, 0xA2, 0xC7, 0xF0, 0xD1, 0xBB, 0x7F, 0xF3, -+0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, 0x01, 0x08, 0x90, 0xA2, 0xC4, 0xE0, 0x90, 0xA2, 0xC8, 0xF0, -+0xD1, 0xBB, 0x7F, 0xF2, 0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, 0x01, 0x08, 0x90, 0xA2, 0xC4, 0xE0, -+0x90, 0xA2, 0xC9, 0xF0, 0x90, 0xA2, 0xC5, 0x12, 0x7F, 0x9E, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0xA2, -+0xCD, 0xF0, 0x90, 0xA2, 0xC9, 0xE0, 0x90, 0xA2, 0xCE, 0xF0, 0x90, 0xA2, 0xCF, 0x74, 0x12, 0xF0, -+0x90, 0xA2, 0xDD, 0x74, 0x05, 0xF0, 0x90, 0xA2, 0xD1, 0x12, 0xAB, 0xAD, 0x90, 0xA2, 0xCD, 0xE0, -+0x90, 0xA2, 0xD4, 0xF0, 0x90, 0xA2, 0xCE, 0xE0, 0x90, 0xA2, 0xD5, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, -+0x79, 0xCF, 0x12, 0x78, 0x06, 0x7F, 0x04, 0x90, 0xA4, 0x0D, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x47, -+0x07, 0x90, 0x9F, 0x13, 0xE0, 0xFF, 0x90, 0xA4, 0x0D, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x9F, 0x13, -+0xF0, 0x22, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x03, 0x02, 0x47, 0xDE, 0x75, 0xF0, 0x10, 0xE5, -+0x0F, 0x90, 0x81, 0x05, 0x02, 0x47, 0xDE, 0x74, 0x91, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x98, -+0xF5, 0x83, 0x22, 0x90, 0xA2, 0xC3, 0x12, 0x47, 0xEA, 0x90, 0x00, 0x08, 0x02, 0x07, 0xAB, 0x74, -+0x01, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0x74, 0x91, 0x25, 0x0F, 0xF5, -+0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0x22, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, -+0x34, 0x92, 0xF5, 0x83, 0x22, 0x90, 0x00, 0x06, 0x12, 0x07, 0xAB, 0x2F, 0x22, 0x75, 0xF0, 0x04, -+0xEF, 0x90, 0x96, 0x11, 0x02, 0x47, 0xDE, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, -+0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x12, 0x4B, 0x90, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, -+0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, -+0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, -+0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0x12, 0xAF, 0xDB, 0xE5, 0x5D, 0x30, 0xE1, 0x03, 0x12, 0xAF, 0x2A, 0xE5, 0x5D, 0x30, 0xE4, 0x02, -+0xF1, 0x60, 0xE5, 0x5D, 0x30, 0xE5, 0x03, 0x12, 0xB0, 0x38, 0xE5, 0x5D, 0x30, 0xE6, 0x03, 0x12, -+0xB0, 0x74, 0xE5, 0x5F, 0x30, 0xE0, 0x03, 0x12, 0xB0, 0x81, 0xE5, 0x5F, 0x30, 0xE1, 0x03, 0x12, -+0x8E, 0xA7, 0xE5, 0x5F, 0x30, 0xE2, 0x03, 0x12, 0xB0, 0x9F, 0xE5, 0x5F, 0x30, 0xE3, 0x03, 0x12, -+0x96, 0xEC, 0xE5, 0x5F, 0x30, 0xE4, 0x03, 0x12, 0x96, 0x5E, 0xE5, 0x5F, 0x30, 0xE5, 0x03, 0x12, -+0x96, 0x43, 0xE5, 0x5F, 0x30, 0xE6, 0x03, 0x12, 0x60, 0x5D, 0xE5, 0x60, 0x30, 0xE1, 0x03, 0x12, -+0xB0, 0xC8, 0xE5, 0x60, 0x30, 0xE4, 0x03, 0x12, 0xB0, 0xE9, 0xE5, 0x60, 0x30, 0xE5, 0x02, 0x11, -+0xD3, 0xE5, 0x60, 0x30, 0xE6, 0x02, 0xF1, 0xDD, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, -+0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, -+0xD0, 0xE0, 0x32, 0xE4, 0xF5, 0x21, 0x90, 0xA0, 0xD4, 0xE0, 0xFF, 0xE5, 0x21, 0xC3, 0x9F, 0x40, -+0x02, 0x21, 0x87, 0xAF, 0x21, 0x12, 0x5E, 0xC9, 0xEF, 0x70, 0x02, 0x21, 0x83, 0xE5, 0x21, 0x12, -+0x9F, 0x87, 0xE5, 0x21, 0x54, 0x07, 0xFE, 0x74, 0x81, 0x2F, 0xF1, 0x85, 0xE0, 0xFD, 0xAF, 0x06, -+0x12, 0x9A, 0x59, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x60, -+0x72, 0x75, 0xF0, 0x10, 0xE5, 0x21, 0xF1, 0x6C, 0xE0, 0x20, 0xE7, 0x02, 0x80, 0x10, 0x75, 0xF0, -+0x10, 0xE5, 0x21, 0x90, 0x81, 0x02, 0x12, 0x47, 0xDE, 0xE0, 0xFF, 0x20, 0xE7, 0x09, 0x90, 0x01, -+0xC1, 0xE0, 0x44, 0x20, 0xF0, 0x80, 0x4C, 0xEF, 0x30, 0xE6, 0x17, 0x75, 0xF0, 0x10, 0xE5, 0x21, -+0x71, 0xFC, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x21, 0x12, 0x66, 0xFE, 0x31, 0x94, 0xE4, 0xFB, -+0x80, 0x2D, 0x31, 0x88, 0xE0, 0x04, 0xF0, 0x31, 0x88, 0xE0, 0xD3, 0x94, 0x01, 0x40, 0x0B, 0xAF, -+0x21, 0x12, 0x9F, 0x37, 0x31, 0x88, 0xE4, 0xF0, 0x80, 0x19, 0x75, 0xF0, 0x10, 0xE5, 0x21, 0x71, -+0xFC, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x21, 0x12, 0x66, 0xFE, 0x31, 0x94, 0x7B, 0x01, 0xAF, -+0x21, 0xB1, 0xED, 0x05, 0x21, 0x01, 0xD6, 0x22, 0x74, 0x92, 0x25, 0x21, 0xF5, 0x82, 0xE4, 0x34, -+0x9D, 0xF5, 0x83, 0x22, 0x13, 0x13, 0x54, 0x03, 0xF5, 0x73, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0xA3, 0xF9, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0x12, 0x6E, 0x46, 0x54, 0x1F, 0xF5, -+0x6F, 0x60, 0x15, 0x64, 0x02, 0x60, 0x11, 0xE5, 0x6F, 0x64, 0x04, 0x60, 0x0B, 0xE5, 0x6F, 0x64, -+0x09, 0x60, 0x05, 0xE5, 0x6F, 0xB4, 0x0C, 0x09, 0xF1, 0xC3, 0xF5, 0x83, 0x74, 0x02, 0xF0, 0x80, -+0x07, 0xF1, 0xC3, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0xE4, 0xF5, 0x6A, 0x90, 0xA3, 0xF9, 0xE0, 0xFE, -+0x71, 0xEA, 0xE5, 0x82, 0x25, 0x6A, 0x71, 0xD3, 0xE0, 0xFF, 0xE5, 0x6F, 0x75, 0xF0, 0x07, 0xA4, -+0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x6A, 0x71, 0xD3, 0xE4, -+0x93, 0xFD, 0xEF, 0x5D, 0x90, 0xA3, 0xFB, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x12, 0x66, 0xFE, 0x54, -+0x03, 0xFF, 0xBF, 0x02, 0x0B, 0xE5, 0x6A, 0x70, 0x07, 0x90, 0xA3, 0xFB, 0xE0, 0x54, 0xF0, 0xF0, -+0x90, 0xA3, 0xFB, 0xE0, 0xFF, 0x71, 0xE6, 0xE5, 0x82, 0x25, 0x6A, 0x71, 0xD3, 0xEF, 0xF0, 0x05, -+0x6A, 0xE5, 0x6A, 0x64, 0x07, 0x70, 0xA4, 0x90, 0xA3, 0xF9, 0xE0, 0x75, 0xF0, 0x04, 0x12, 0x66, -+0xFE, 0xFF, 0xC4, 0x54, 0x03, 0xFD, 0xE4, 0xF5, 0x6D, 0x75, 0x6B, 0x06, 0xE5, 0x6B, 0xB4, 0x06, -+0x07, 0x71, 0xC2, 0xE0, 0x54, 0x0F, 0x80, 0x09, 0x71, 0xE6, 0xE5, 0x82, 0x25, 0x6B, 0x71, 0xD3, -+0xE0, 0x90, 0xA3, 0xFA, 0xF0, 0x90, 0xA3, 0xFA, 0xE0, 0x60, 0x31, 0x75, 0x6A, 0x07, 0xF1, 0x95, -+0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xF1, 0xA6, 0x60, 0x16, 0xF1, 0x9D, 0xF5, -+0x6D, 0xED, 0x60, 0x25, 0xE5, 0x6D, 0xD3, 0x94, 0x0B, 0x40, 0x1E, 0x74, 0x20, 0x25, 0x6D, 0xF5, -+0x6D, 0x80, 0x16, 0x15, 0x6A, 0xE5, 0x6A, 0xC3, 0x94, 0x00, 0x50, 0xD2, 0xE5, 0x6B, 0x60, 0x09, -+0x15, 0x6B, 0xE5, 0x6B, 0xC3, 0x94, 0x00, 0x50, 0xA3, 0xE4, 0xF5, 0x6E, 0xF5, 0x6B, 0xE5, 0x6B, -+0xB4, 0x06, 0x07, 0x71, 0xC2, 0xE0, 0x54, 0x0F, 0x80, 0x09, 0x71, 0xE6, 0xE5, 0x82, 0x25, 0x6B, -+0x71, 0xD3, 0xE0, 0x90, 0xA3, 0xFA, 0xF0, 0x90, 0xA3, 0xFA, 0xE0, 0x60, 0x2F, 0xE4, 0xF5, 0x6A, -+0xF1, 0x95, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xF1, 0xA6, 0x60, 0x16, 0xF1, -+0x9D, 0xF5, 0x6E, 0xED, 0x60, 0x1E, 0xE5, 0x6E, 0xD3, 0x94, 0x0B, 0x40, 0x17, 0x74, 0x20, 0x25, -+0x6E, 0xF5, 0x6E, 0x80, 0x0F, 0x05, 0x6A, 0xE5, 0x6A, 0xB4, 0x08, 0xD4, 0x05, 0x6B, 0xE5, 0x6B, -+0x64, 0x07, 0x70, 0xAA, 0x90, 0xA3, 0xF9, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x12, 0x6F, 0xE1, 0xE5, -+0x6D, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x67, 0xE5, 0xE5, 0x6E, 0xF0, 0x75, 0xF0, 0x10, 0xEF, -+0x71, 0xFC, 0xE0, 0xFF, 0x54, 0x7F, 0xF5, 0x6C, 0xEF, 0x54, 0x80, 0xFF, 0xE5, 0x6C, 0xD3, 0x95, -+0x6D, 0x40, 0x04, 0xE5, 0x6D, 0x80, 0x09, 0xE5, 0x6C, 0xC3, 0x95, 0x6E, 0x50, 0x05, 0xE5, 0x6E, -+0x4F, 0xF5, 0x6C, 0x90, 0xA3, 0xF9, 0xE0, 0xFF, 0x24, 0x12, 0x12, 0xBE, 0x75, 0xE5, 0x6C, 0xF0, -+0x75, 0xF0, 0x04, 0xEF, 0x12, 0x66, 0xFE, 0x31, 0x94, 0x90, 0xA3, 0xF9, 0xE0, 0xFF, 0xE4, 0xFB, -+0xAD, 0x6C, 0xB1, 0xED, 0x90, 0xA3, 0xF9, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0x12, 0x6F, 0x86, 0xE4, -+0xF0, 0xE5, 0x6D, 0xC3, 0x94, 0x36, 0x40, 0x07, 0x71, 0xDB, 0x74, 0x05, 0xF0, 0x80, 0x3E, 0xE5, -+0x6D, 0xC3, 0x94, 0x2C, 0x40, 0x07, 0x71, 0xDB, 0x74, 0x04, 0xF0, 0x80, 0x30, 0xE5, 0x6D, 0xC3, -+0x94, 0x14, 0x40, 0x07, 0x71, 0xDB, 0x74, 0x03, 0xF0, 0x80, 0x22, 0xE5, 0x6D, 0xC3, 0x94, 0x0C, -+0x40, 0x07, 0x71, 0xDB, 0x74, 0x02, 0xF0, 0x80, 0x14, 0xE5, 0x6D, 0xC3, 0x94, 0x04, 0x74, 0x91, -+0x40, 0x07, 0x71, 0xDD, 0x74, 0x01, 0xF0, 0x80, 0x04, 0x71, 0xDD, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xFF, 0x90, 0xA3, 0xF9, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x47, 0xDE, -+0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x22, 0x74, 0x91, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0x90, 0xA3, 0xF9, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, -+0x02, 0x47, 0xDE, 0x90, 0xA2, 0xC9, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x00, 0x02, -+0x47, 0xDE, 0x12, 0x06, 0x89, 0x54, 0x7F, 0xF5, 0x0F, 0x12, 0x67, 0x96, 0xFF, 0x54, 0x1F, 0xF5, -+0x11, 0xEF, 0x54, 0x80, 0xF1, 0xBC, 0xF5, 0x10, 0x12, 0x67, 0x07, 0xFF, 0x54, 0x03, 0xF5, 0x12, -+0xEF, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0xF5, 0x15, 0x12, 0x67, 0x07, 0xFF, 0x54, 0x40, 0xC4, 0x13, -+0x13, 0x54, 0x03, 0xF5, 0x13, 0xEF, 0x54, 0x80, 0xF1, 0xBC, 0xF5, 0x14, 0x12, 0x67, 0x07, 0xFF, -+0x54, 0x08, 0xFE, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xF5, 0x17, 0xEF, 0x54, 0x04, 0x13, 0x13, 0x54, -+0x3F, 0xF5, 0x18, 0xE5, 0x14, 0x12, 0xBE, 0x7D, 0x12, 0x66, 0xF8, 0x54, 0x7F, 0x4F, 0xF0, 0xE5, -+0x13, 0xF1, 0x8D, 0x12, 0x66, 0xF8, 0x54, 0xBF, 0x4F, 0xF0, 0xE5, 0x17, 0x70, 0x69, 0xE5, 0x11, -+0x54, 0x1F, 0x12, 0x6E, 0x40, 0x54, 0xE0, 0x4F, 0xF0, 0xE5, 0x12, 0x54, 0x03, 0x12, 0x66, 0xF8, -+0x54, 0xFC, 0x4F, 0xF0, 0xEF, 0x25, 0xE0, 0x25, 0xE0, 0x12, 0x66, 0xF8, 0x54, 0xF3, 0x4F, 0xF0, -+0xE5, 0x10, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0x12, 0x6E, 0x40, 0x54, 0xDF, 0x4F, 0xF0, 0xE5, -+0x15, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0x12, 0x66, 0xF8, 0x54, 0xCF, 0x4F, 0xF0, 0xE4, 0xF5, 0x16, -+0x85, 0x16, 0x82, 0x75, 0x83, 0x00, 0xA3, 0xA3, 0xA3, 0x12, 0x06, 0xA2, 0xFF, 0x75, 0xF0, 0x08, -+0xE5, 0x0F, 0x71, 0xED, 0xE5, 0x82, 0x25, 0x16, 0x71, 0xD3, 0xEF, 0xF0, 0x05, 0x16, 0xE5, 0x16, -+0xB4, 0x04, 0xDD, 0xAF, 0x0F, 0x31, 0x9B, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0xA4, -+0x04, 0xF0, 0x90, 0xA4, 0x04, 0xE0, 0xFD, 0x70, 0x02, 0xA1, 0xE3, 0x90, 0xA0, 0x27, 0xE0, 0xFF, -+0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA0, 0x28, 0xE0, 0xB5, -+0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, -+0x01, 0xF0, 0x22, 0x90, 0xA3, 0xEE, 0xE0, 0x12, 0x9A, 0x58, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0xA1, 0xC6, 0xE4, 0x90, 0xA4, 0x05, 0xF0, 0x90, -+0xA4, 0x05, 0xE0, 0xF9, 0xC3, 0x94, 0x04, 0x50, 0x42, 0xB1, 0xE5, 0xA4, 0xFF, 0xE9, 0xFD, 0x7C, -+0x00, 0x2F, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xD0, 0xF1, 0xCF, 0xE0, 0x12, 0xA5, 0x65, 0xE5, -+0x82, 0x29, 0x71, 0xD3, 0xEF, 0xB1, 0xE4, 0xA4, 0x2D, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xF0, -+0xF1, 0xCF, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x9F, 0xDB, 0x12, 0x47, 0xDE, 0xE5, 0x82, 0x29, 0x71, -+0xD3, 0xEF, 0xF0, 0x90, 0xA4, 0x05, 0xE0, 0x04, 0xF0, 0x80, 0xB4, 0x90, 0xA4, 0x04, 0xE0, 0xFF, -+0x90, 0xA3, 0xEE, 0xF1, 0x77, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0xA4, 0x04, -+0xF0, 0x90, 0xA3, 0xEE, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, -+0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0xA3, 0xEE, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, -+0xA0, 0x28, 0x12, 0x7F, 0xAB, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x81, 0xE2, 0xE4, -+0x90, 0xA0, 0x28, 0xF0, 0x81, 0xE2, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0xA3, 0xEE, -+0xE0, 0x44, 0x80, 0x90, 0x00, 0x8A, 0xB1, 0xE4, 0x90, 0x01, 0xD0, 0x12, 0x47, 0xDE, 0xE0, 0x90, -+0x01, 0xC3, 0xF0, 0x22, 0xF0, 0x90, 0xA3, 0xEE, 0xE0, 0x75, 0xF0, 0x04, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x70, 0x8D, 0x71, 0x8B, 0x72, 0xE4, 0x90, 0xA3, 0x88, 0xF0, 0xE5, -+0x70, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA3, 0x83, 0xF0, 0xE5, 0x70, 0x54, 0x07, 0x90, 0xA3, -+0x85, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0xF1, 0x6C, 0xE0, 0x90, 0xA3, 0x86, 0xF0, 0x12, 0x6F, 0xDD, -+0xE0, 0x54, 0x7F, 0x90, 0xA3, 0x89, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x70, 0x12, 0x67, 0xE5, 0xE0, -+0x90, 0xA3, 0x8A, 0xF0, 0xF1, 0xAF, 0xE5, 0x72, 0x70, 0x37, 0x90, 0xA3, 0x00, 0xF0, 0xFB, 0xAF, -+0x70, 0x12, 0xB9, 0x00, 0x90, 0xA3, 0x84, 0xE0, 0xFF, 0x12, 0xBE, 0x67, 0x12, 0x9F, 0xC3, 0x93, -+0xFD, 0xEF, 0x12, 0x9F, 0xCD, 0xF5, 0x83, 0x74, 0x01, 0x93, 0x2D, 0xFF, 0xE4, 0x93, 0x3C, 0xC3, -+0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x70, 0x12, 0x9D, 0x49, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x80, -+0x1A, 0xE5, 0x72, 0xB4, 0x01, 0x15, 0x90, 0x9F, 0x1A, 0xE0, 0x60, 0x0F, 0x90, 0xA3, 0x00, 0x74, -+0x05, 0xF0, 0xE4, 0xFB, 0xAD, 0x71, 0xAF, 0x70, 0x12, 0xB9, 0x00, 0x90, 0xA3, 0x89, 0xE0, 0xFF, -+0x90, 0xA3, 0x84, 0xE0, 0xFE, 0xD3, 0x9F, 0x40, 0x0B, 0xE5, 0x71, 0x54, 0x80, 0xFD, 0xEF, 0x4D, -+0xF5, 0x71, 0x80, 0x0C, 0x90, 0xA3, 0x8A, 0xE0, 0xFF, 0xEE, 0xC3, 0x9F, 0x50, 0x02, 0x8F, 0x71, -+0xF1, 0xAF, 0xE5, 0x71, 0x54, 0x80, 0x90, 0xA3, 0x87, 0xF0, 0xE5, 0x72, 0x70, 0x1E, 0xF1, 0x7F, -+0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x72, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xD0, 0x82, -+0xD0, 0x83, 0xF0, 0x90, 0xA3, 0x86, 0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x3A, 0xF1, 0x7F, 0xC0, 0x83, -+0xC0, 0x82, 0xF1, 0x72, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, -+0x75, 0xF0, 0x10, 0xE5, 0x70, 0x90, 0x81, 0x01, 0x12, 0x94, 0x37, 0xFF, 0x90, 0xA3, 0x86, 0xF0, -+0x90, 0xA3, 0x84, 0xE0, 0x90, 0x43, 0x03, 0x93, 0xFE, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x4F, 0x90, -+0xA3, 0x86, 0xF0, 0x44, 0x80, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x70, 0x71, 0xFC, 0xE5, 0x71, 0xF0, -+0xE5, 0x70, 0x70, 0x06, 0x90, 0x01, 0xC8, 0xE5, 0x71, 0xF0, 0x90, 0xA3, 0x86, 0xE0, 0xFF, 0x75, -+0xF0, 0x10, 0xE5, 0x70, 0xF1, 0x6C, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x70, 0x12, 0x6F, 0x91, -+0xE0, 0x54, 0xFC, 0xFF, 0xE5, 0x73, 0x54, 0x03, 0x4F, 0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x70, 0x12, -+0x6F, 0x91, 0xEF, 0xF0, 0x7D, 0x01, 0xAF, 0x70, 0x12, 0x6E, 0x4E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x91, 0xD8, 0x7F, 0x02, 0x02, 0x7F, 0x8F, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, 0x02, -+0x47, 0xDE, 0xE0, 0xFF, 0x90, 0xA3, 0x85, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, 0x90, -+0xA3, 0x83, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0x54, 0x01, 0xC4, -+0x33, 0x33, 0x54, 0xC0, 0x22, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x6A, 0x08, 0x22, 0xE5, 0x6B, 0x75, -+0xF0, 0x08, 0xA4, 0x25, 0x6A, 0x22, 0xFF, 0x90, 0xA3, 0xFA, 0xE0, 0xFB, 0xEF, 0x5B, 0x22, 0xE5, -+0x71, 0x54, 0x7F, 0x90, 0xA3, 0x84, 0xF0, 0x22, 0x90, 0xA1, 0x53, 0xE0, 0xC4, 0x13, 0x13, 0x13, -+0x54, 0x01, 0x22, 0x90, 0xA3, 0xF9, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0x22, 0x2F, -+0xF5, 0x82, 0x74, 0x01, 0x3E, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA0, 0x28, 0x22, 0x90, 0x07, 0x1F, -+0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0xFF, 0x90, 0xA2, 0xE0, 0xF0, 0x90, -+0xA2, 0xDE, 0x74, 0x02, 0xF0, 0x90, 0xA2, 0xEC, 0x14, 0xF0, 0xFB, 0x7A, 0xA2, 0x79, 0xDE, 0x11, -+0x06, 0x7F, 0x04, 0x02, 0x6F, 0x67, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA0, 0xBF, -+0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA0, 0xC0, -+0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, -+0xE0, 0x44, 0x02, 0xF0, 0x80, 0x29, 0xC0, 0x01, 0x90, 0xA0, 0xC0, 0xE0, 0x12, 0x96, 0xE0, 0xA8, -+0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x06, 0x63, 0x90, 0xA0, 0xC0, -+0xF1, 0xAB, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA0, 0xC0, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xA9, 0x07, 0x90, 0x05, 0x63, -+0xE0, 0xFE, 0x90, 0x05, 0x62, 0xF1, 0xD3, 0xAD, 0x07, 0xFC, 0x90, 0x05, 0x61, 0xE0, 0xFE, 0x90, -+0x05, 0x60, 0x12, 0xBB, 0xAF, 0x90, 0xA3, 0x62, 0x74, 0x17, 0xF0, 0x90, 0xA3, 0x70, 0x74, 0x06, -+0xF0, 0x90, 0xA3, 0x64, 0xE9, 0x12, 0x54, 0x74, 0x75, 0xF0, 0x13, 0x12, 0x56, 0xAA, 0xE0, 0x90, -+0xA3, 0x65, 0xF0, 0xAB, 0x07, 0xA3, 0xEB, 0xF0, 0xEE, 0xA3, 0xF0, 0xAF, 0x05, 0xA3, 0xEF, 0xF0, -+0xAE, 0x04, 0xEE, 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x62, 0x11, 0x06, 0x7F, 0x04, 0x12, -+0x6F, 0x67, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF1, 0xC1, 0xFF, 0x54, 0x0F, 0xF5, 0x12, 0xEF, 0xC4, -+0x54, 0x0F, 0x64, 0x0F, 0x70, 0x51, 0x90, 0x01, 0xA4, 0x04, 0xF0, 0x90, 0xA1, 0xB3, 0xE0, 0x54, -+0xFE, 0xFF, 0xF0, 0xE5, 0x12, 0x54, 0x07, 0x25, 0xE0, 0xFE, 0xEF, 0x54, 0xF1, 0x4E, 0x51, 0x8D, -+0x64, 0x03, 0x60, 0x03, 0xBF, 0x01, 0x0F, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xED, 0xF0, 0x90, 0x01, -+0xA4, 0x74, 0x02, 0xF0, 0x80, 0x07, 0x7D, 0x20, 0xE4, 0xFF, 0x12, 0x5B, 0xA3, 0xAF, 0x12, 0x51, -+0xB5, 0xBF, 0x01, 0x08, 0xE4, 0xFD, 0xFF, 0x12, 0xAE, 0x30, 0x80, 0x00, 0x7F, 0x02, 0x11, 0x64, -+0x90, 0x01, 0xA4, 0x74, 0x04, 0xF0, 0x22, 0xE5, 0x12, 0x75, 0xF0, 0x13, 0xA4, 0x24, 0xB6, 0xF9, -+0x74, 0xA1, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xC0, 0x02, 0xC0, 0x01, 0xE5, 0x11, 0x24, 0x01, 0xF9, -+0xE4, 0x35, 0x10, 0x85, 0x0F, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0xD0, 0x01, 0xD0, -+0x02, 0x12, 0x34, 0x62, 0x51, 0x86, 0x51, 0x79, 0x54, 0x80, 0x12, 0x77, 0xBC, 0xFF, 0x75, 0xF0, -+0x13, 0xE5, 0x12, 0xF1, 0xB9, 0x54, 0xFE, 0x4F, 0xF0, 0x75, 0xF0, 0x13, 0xE5, 0x12, 0x90, 0xA1, -+0xB9, 0x12, 0x47, 0xDE, 0xE0, 0x54, 0xF7, 0xF0, 0x12, 0x06, 0x89, 0xC4, 0x54, 0x0F, 0x14, 0x65, -+0x12, 0x60, 0x02, 0x41, 0x77, 0x90, 0xA0, 0xDF, 0xE0, 0x70, 0x07, 0x90, 0xA0, 0xD5, 0xE0, 0x30, -+0xE0, 0x04, 0x7F, 0x05, 0x01, 0x64, 0x90, 0x01, 0xA4, 0xE4, 0xF0, 0xA3, 0xF0, 0x51, 0x86, 0x12, -+0x06, 0x89, 0xC4, 0x54, 0x0F, 0x90, 0xA1, 0xB4, 0x51, 0x78, 0xFF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, -+0xFE, 0x90, 0xA1, 0xB3, 0xE0, 0x54, 0x0F, 0x4E, 0xF0, 0xEF, 0x54, 0x10, 0x25, 0xE0, 0xFF, 0x90, -+0xA1, 0xF1, 0xE0, 0x54, 0xDF, 0x4F, 0xFF, 0x51, 0x78, 0x54, 0x60, 0xC4, 0x54, 0x0F, 0xFE, 0xEF, -+0x54, 0xF9, 0x4E, 0x90, 0xA1, 0xF1, 0xF0, 0x90, 0xA1, 0xB3, 0xE0, 0x54, 0xF1, 0xF0, 0x90, 0x05, -+0x58, 0x74, 0x02, 0x12, 0x9A, 0x01, 0x44, 0x40, 0xF0, 0x54, 0x7F, 0xF0, 0x51, 0x7F, 0x30, 0xE0, -+0x06, 0xEF, 0x54, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0xA1, 0xB3, 0xE0, 0x44, 0x01, 0x51, 0x8D, 0x64, -+0x03, 0x60, 0x05, 0xEF, 0x64, 0x01, 0x70, 0x19, 0x90, 0xA2, 0x28, 0x51, 0x7F, 0x30, 0xE0, 0x08, -+0xEF, 0x54, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x35, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x32, 0xF0, 0x80, -+0x2C, 0x7D, 0x20, 0xE4, 0xFF, 0x12, 0x5B, 0xBB, 0xE4, 0xFF, 0xEF, 0xFD, 0xC3, 0x74, 0x87, 0x51, -+0x96, 0xFD, 0xC3, 0x74, 0x03, 0x51, 0xA4, 0xEE, 0xF0, 0xEF, 0xFD, 0xC3, 0x74, 0x8B, 0x51, 0x96, -+0xFD, 0xC3, 0x74, 0x07, 0x51, 0xA4, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x04, 0xDD, 0x7F, 0x03, 0x11, -+0x64, 0x90, 0xA1, 0xB8, 0xE0, 0x90, 0xA2, 0x26, 0xB4, 0x64, 0x05, 0x74, 0xC8, 0xF0, 0x80, 0x03, -+0x74, 0x64, 0xF0, 0x90, 0xA2, 0x1E, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x90, 0xA2, 0x22, -+0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x22, 0xF0, 0x90, 0x00, 0x06, 0x02, 0x06, 0xA2, 0xE0, -+0xFF, 0xC4, 0x13, 0x54, 0x07, 0x22, 0xAB, 0x0F, 0xAA, 0x10, 0xA9, 0x11, 0x22, 0xF0, 0x90, 0xA1, -+0xB9, 0xE0, 0x54, 0x07, 0xFF, 0x22, 0x9D, 0xFD, 0x74, 0x05, 0x94, 0x00, 0x8D, 0x82, 0xF5, 0x83, -+0xE0, 0xFE, 0xEF, 0x22, 0x9D, 0xFD, 0xE4, 0x94, 0x00, 0xFC, 0x74, 0xC4, 0x2D, 0xF5, 0x82, 0x74, -+0xA2, 0x3C, 0xF5, 0x83, 0x22, 0x8F, 0x13, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA2, 0xCC, 0xF0, 0x7D, -+0x17, 0x12, 0x56, 0x2A, 0xEF, 0x64, 0x01, 0x70, 0x42, 0x75, 0xF0, 0x13, 0xE5, 0x13, 0x12, 0x56, -+0xAA, 0xE0, 0xFC, 0xD1, 0x97, 0x71, 0x18, 0xD1, 0x97, 0xF1, 0xCA, 0xFD, 0xD1, 0x97, 0xD1, 0xAB, -+0x12, 0x57, 0xA8, 0x20, 0xE0, 0x1B, 0x75, 0xF0, 0x13, 0xE5, 0x13, 0x12, 0x94, 0x34, 0xFF, 0x60, -+0x03, 0xBF, 0x02, 0x0D, 0x75, 0xF0, 0x13, 0xE5, 0x13, 0xF1, 0x0B, 0xE4, 0xFB, 0xFD, 0x12, 0x55, -+0xE1, 0xAD, 0x13, 0x7F, 0x01, 0x12, 0xAE, 0x30, 0x7F, 0x01, 0x22, 0x90, 0xA2, 0xCC, 0xE0, 0xFF, -+0x7D, 0x49, 0x12, 0x53, 0x36, 0x7F, 0x00, 0x22, 0x54, 0x03, 0xFD, 0xEE, 0x13, 0x13, 0x54, 0x07, -+0xFB, 0x90, 0xA1, 0xB3, 0xE0, 0xFE, 0xC4, 0x54, 0x0F, 0x90, 0xA3, 0xDA, 0xF0, 0xAF, 0x04, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0xD8, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA3, -+0xD7, 0xEF, 0xF0, 0x90, 0xA3, 0xDA, 0xE0, 0xFD, 0x12, 0xBA, 0x0F, 0x90, 0xA3, 0xD7, 0xE0, 0xC3, -+0x94, 0x0E, 0x50, 0x3F, 0x90, 0xA3, 0x25, 0x12, 0x08, 0x79, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA3, -+0x29, 0x12, 0x08, 0x79, 0x12, 0xD4, 0x00, 0x00, 0xD1, 0xED, 0x90, 0xA3, 0x13, 0x12, 0x08, 0x79, -+0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, 0x17, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0xB1, 0xF0, -+0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, 0x17, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, -+0x00, 0x81, 0xAE, 0xD1, 0xFE, 0x50, 0x1B, 0xEF, 0x94, 0x30, 0x50, 0x16, 0x90, 0xA3, 0x25, 0x12, -+0x08, 0x79, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x09, 0x28, 0x00, 0x00, -+0x80, 0x64, 0x90, 0xA3, 0xD7, 0xE0, 0xFF, 0x74, 0x32, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x40, -+0x50, 0x16, 0x90, 0xA3, 0x25, 0x12, 0x08, 0x79, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, -+0x08, 0x79, 0x08, 0xA6, 0x00, 0x00, 0x80, 0x3E, 0xD1, 0xF4, 0x50, 0x1B, 0xEF, 0x94, 0x74, 0x50, -+0x16, 0x90, 0xA3, 0x25, 0x12, 0x08, 0x79, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, -+0x79, 0x08, 0xA4, 0x00, 0x00, 0x80, 0x1F, 0x90, 0xA3, 0xD7, 0xE0, 0xFF, 0x74, 0x76, 0xD3, 0x9F, -+0x50, 0x16, 0x90, 0xA3, 0x25, 0x12, 0x08, 0x79, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, -+0x08, 0x79, 0x08, 0x24, 0x00, 0x00, 0xD1, 0xED, 0xD1, 0xFE, 0x50, 0x2E, 0xEF, 0x94, 0x40, 0x50, -+0x29, 0x90, 0xA3, 0x13, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, 0x17, 0x12, 0x08, -+0x79, 0x00, 0x01, 0x01, 0x00, 0xB1, 0xF0, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, -+0x17, 0x12, 0x08, 0x79, 0x00, 0x01, 0x01, 0x00, 0x80, 0x64, 0xD1, 0xF4, 0x50, 0x2E, 0xEF, 0x94, -+0x8C, 0x50, 0x29, 0x90, 0xA3, 0x13, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, 0x17, -+0x12, 0x08, 0x79, 0x00, 0x03, 0x01, 0x00, 0xB1, 0xF0, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, -+0x90, 0xA3, 0x17, 0x12, 0x08, 0x79, 0x00, 0x03, 0x01, 0x00, 0x80, 0x32, 0x90, 0xA3, 0xD7, 0xE0, -+0xFF, 0x74, 0x8C, 0xC3, 0x9F, 0x50, 0x2B, 0x90, 0xA3, 0x13, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, -+0x00, 0x90, 0xA3, 0x17, 0x12, 0x08, 0x79, 0x00, 0x05, 0x01, 0x00, 0xB1, 0xF0, 0x12, 0x08, 0x79, -+0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, 0x17, 0x12, 0x08, 0x79, 0x00, 0x05, 0x01, 0x00, 0xD1, 0x90, -+0xB1, 0x75, 0x90, 0xA3, 0xD8, 0xE0, 0x64, 0x02, 0x70, 0x51, 0x90, 0xA3, 0xD7, 0xE0, 0xFF, 0xD3, -+0x94, 0x30, 0x50, 0x05, 0x75, 0x77, 0x2A, 0x80, 0x5E, 0xEF, 0xD3, 0x94, 0x40, 0x50, 0x05, 0x75, -+0x77, 0x3A, 0x80, 0x53, 0xEF, 0xD3, 0x94, 0x70, 0x50, 0x05, 0x75, 0x77, 0x6A, 0x80, 0x48, 0xEF, -+0xD3, 0x94, 0x80, 0x50, 0x05, 0x75, 0x77, 0x7A, 0x80, 0x3D, 0xEF, 0xD3, 0x94, 0x90, 0x50, 0x05, -+0x75, 0x77, 0x8A, 0x80, 0x32, 0xEF, 0xD3, 0x94, 0xA1, 0x50, 0x05, 0x75, 0x77, 0x9B, 0x80, 0x27, -+0xEF, 0xD3, 0x94, 0xB1, 0x50, 0x21, 0x75, 0x77, 0xAB, 0x80, 0x1C, 0x90, 0xA3, 0xD8, 0xE0, 0x64, -+0x01, 0x70, 0x31, 0xA3, 0xE0, 0x90, 0xA3, 0xD7, 0xB4, 0x01, 0x07, 0xE0, 0x24, 0x02, 0xF5, 0x77, -+0x80, 0x05, 0xE0, 0x24, 0xFE, 0xF5, 0x77, 0x90, 0xA3, 0x13, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, -+0xFF, 0xAF, 0x77, 0xE4, 0xFC, 0xFD, 0xFE, 0xB1, 0xEA, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0xFF, -+0xAF, 0x77, 0x80, 0x1E, 0x90, 0xA3, 0x13, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA3, -+0xD7, 0x12, 0x4F, 0xF2, 0xB1, 0xEA, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA3, 0xD7, -+0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA3, 0x17, 0x12, 0x08, 0x6D, 0xD1, 0x90, 0xB1, 0x75, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x11, 0xEC, -+0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA3, 0x10, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0xF1, 0x16, 0x90, -+0xA3, 0x1B, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x13, 0x12, 0x47, 0xC6, 0x12, 0x08, 0x3A, 0x90, 0xA3, -+0x1B, 0xD1, 0xA5, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x13, 0x12, 0x47, -+0xC6, 0x90, 0xA3, 0x17, 0xD1, 0xA5, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, -+0xA8, 0x90, 0xA3, 0x1F, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x11, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, -+0xA3, 0x1F, 0x12, 0x47, 0xC6, 0x90, 0xAA, 0x96, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x10, 0xE0, 0xFF, -+0xD0, 0x05, 0x12, 0x3C, 0x33, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA3, 0x17, 0x12, 0x08, 0x6D, -+0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0xB1, 0x75, 0x90, 0xA3, 0x13, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0xEF, 0x14, 0x60, 0x30, 0x14, 0x60, 0x56, 0x24, 0x02, 0x70, 0x7D, 0x90, 0xA3, -+0x13, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA3, 0x17, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x0C, 0x00, 0xB1, 0xF0, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA3, 0x17, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x0C, 0x00, 0x80, 0x50, 0x90, 0xA3, 0x13, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, -+0x00, 0x90, 0xA3, 0x17, 0x12, 0x08, 0x79, 0x00, 0x00, 0x04, 0x00, 0xB1, 0xF0, 0x12, 0x08, 0x79, -+0x00, 0x00, 0x0C, 0x00, 0x90, 0xA3, 0x17, 0x12, 0x08, 0x79, 0x00, 0x00, 0x04, 0x00, 0x80, 0x27, -+0x90, 0xA3, 0x13, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA3, 0x17, 0x12, 0x08, 0x79, -+0x00, 0x00, 0x00, 0x00, 0xB1, 0xF0, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA3, 0x17, -+0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0xD1, 0x90, 0xB1, 0x75, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0x22, 0x75, 0xF0, 0x13, 0xE5, 0x13, 0x90, 0xA1, 0xB7, 0x12, -+0x47, 0xDE, 0xE0, 0xFE, 0x22, 0x12, 0x47, 0xD2, 0x02, 0x47, 0x9B, 0x13, 0x13, 0x54, 0x07, 0xFB, -+0x90, 0xA3, 0xDB, 0x12, 0xAB, 0xAD, 0xE4, 0xFE, 0x7D, 0x18, 0xFF, 0x12, 0x3D, 0x2C, 0x90, 0xA3, -+0xDE, 0xEF, 0xF0, 0x90, 0xA3, 0xDB, 0xE0, 0xFF, 0x12, 0xBB, 0x5F, 0x90, 0xA3, 0xDB, 0xF1, 0x9E, -+0xE0, 0xFB, 0x12, 0xB9, 0x95, 0xAE, 0x07, 0x90, 0x04, 0x83, 0xEE, 0xF0, 0x90, 0xA3, 0xDB, 0xE0, -+0xFF, 0xAD, 0x06, 0x12, 0x4C, 0xBD, 0x90, 0xA3, 0xDB, 0xE0, 0xFF, 0xA1, 0xFC, 0x7F, 0x60, 0x7E, -+0x08, 0x02, 0x4C, 0x5C, 0x90, 0xA3, 0xD7, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x22, 0x90, 0xA3, -+0xD7, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x22, 0x75, 0xF0, 0x13, 0x90, 0xA1, 0xBF, 0x12, 0x47, -+0xDE, 0xE0, 0xFF, 0x7E, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x8F, 0xE4, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x53, 0x74, -+0x15, 0xF0, 0x90, 0xA3, 0x61, 0x74, 0x01, 0xF0, 0x90, 0xA3, 0x55, 0xEF, 0xF0, 0x7B, 0x01, 0x7A, -+0xA3, 0x79, 0x53, 0x11, 0x06, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA3, 0xB1, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x47, 0xF3, 0x12, 0xBE, 0x1F, -+0x70, 0x1E, 0x90, 0xFD, 0x58, 0xE0, 0x20, 0xE0, 0x0F, 0x90, 0xA3, 0xB1, 0xF1, 0x9E, 0x12, 0x47, -+0xEA, 0x12, 0xA4, 0x14, 0x7F, 0x01, 0x80, 0x0E, 0x7F, 0x01, 0xF1, 0x8B, 0x7F, 0x02, 0x80, 0x06, -+0x7F, 0x02, 0xF1, 0x8B, 0x7F, 0x03, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF1, 0x25, 0x7F, 0x04, 0x8F, -+0x76, 0x7F, 0x02, 0x12, 0x47, 0x07, 0x90, 0x9F, 0x13, 0xE0, 0x45, 0x76, 0xF0, 0x22, 0xE0, 0xFF, -+0xA3, 0xE0, 0xFD, 0xA3, 0x22, 0x7D, 0x01, 0x7F, 0x17, 0x80, 0x9F, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, -+0x00, 0x22, 0x12, 0x89, 0xD5, 0x7F, 0x04, 0x80, 0xD6, 0x90, 0xA1, 0xBA, 0x12, 0x47, 0xDE, 0xE0, -+0x22, 0x8B, 0x0F, 0x8A, 0x10, 0x89, 0x11, 0x02, 0x06, 0x89, 0x54, 0x03, 0xFF, 0xEE, 0xC4, 0x13, -+0x54, 0x07, 0x22, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0xF1, 0x4A, 0x90, 0xA2, -+0xC4, 0xEF, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, -+0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0x12, 0xB0, 0x08, 0xE5, 0x65, 0x30, 0xE1, 0x02, 0x11, 0x95, 0xE5, 0x65, 0x30, 0xE2, 0x03, -+0x12, 0xB2, 0x1E, 0xE5, 0x65, 0x30, 0xE4, 0x03, 0x12, 0xB2, 0x41, 0xE5, 0x65, 0x30, 0xE5, 0x02, -+0xF1, 0xE1, 0xE5, 0x66, 0x30, 0xE0, 0x03, 0x12, 0xB2, 0x53, 0xE5, 0x67, 0x30, 0xE1, 0x03, 0x12, -+0x94, 0xE2, 0xE5, 0x67, 0x30, 0xE0, 0x03, 0x12, 0x94, 0x5E, 0xE5, 0x67, 0x30, 0xE2, 0x0A, 0x12, -+0x8F, 0x93, 0x90, 0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, 0x67, 0x30, 0xE4, 0x03, 0x12, 0xB5, -+0xCB, 0xE5, 0x68, 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, 0x7F, 0x8F, 0xE5, 0x68, 0x30, 0xE4, 0x02, -+0x11, 0xA1, 0xE5, 0x68, 0x30, 0xE5, 0x03, 0x12, 0xB5, 0xE4, 0xE5, 0x68, 0x30, 0xE6, 0x03, 0x12, -+0xB6, 0x20, 0xE5, 0x68, 0x30, 0xE7, 0x03, 0x12, 0x8D, 0x0F, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, -+0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, -+0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0xA0, 0xDF, 0xE0, 0x60, 0x03, 0x12, 0x95, 0x6F, 0x02, 0x53, -+0x41, 0x12, 0xA6, 0x87, 0x12, 0x5A, 0x60, 0x11, 0xC7, 0x90, 0xA1, 0x43, 0xE0, 0x30, 0xE0, 0x16, -+0x12, 0xBF, 0x05, 0x90, 0xA1, 0x46, 0xE0, 0x60, 0x05, 0x14, 0xF0, 0x02, 0xB6, 0xCB, 0x12, 0xA5, -+0x80, 0xE4, 0xFF, 0x12, 0x5A, 0x70, 0x22, 0x90, 0xA1, 0x50, 0xE0, 0x30, 0xE0, 0x04, 0xE4, 0xFF, -+0x11, 0xD3, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0xBB, 0xEF, 0xF0, 0xA3, -+0x74, 0x02, 0xF0, 0xE4, 0xFF, 0x12, 0x8D, 0x4E, 0x90, 0xA1, 0x75, 0xE0, 0x44, 0x10, 0xF0, 0x90, -+0xA1, 0x54, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x01, 0x80, 0x31, 0x90, 0xA1, 0x50, 0x91, 0x44, 0x30, -+0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x25, 0x12, 0xBF, 0x29, 0x30, 0xE0, 0x10, 0xEF, 0x13, 0x13, 0x54, -+0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x09, 0x80, 0x13, 0x7F, 0x03, 0x80, 0x0F, 0x90, 0xA1, 0x53, 0xE0, -+0xC3, 0x13, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x09, 0x12, 0x8B, 0x4F, 0x90, 0xA3, -+0xBB, 0xE0, 0x64, 0x03, 0x70, 0x71, 0x91, 0x41, 0x30, 0xE0, 0x64, 0x90, 0xA1, 0x5A, 0xE0, 0xFF, -+0x90, 0xA1, 0x65, 0xE0, 0xFE, 0xD3, 0x9F, 0x40, 0x37, 0xEE, 0x75, 0xF0, 0x03, 0xA4, 0xFF, 0x90, -+0xA1, 0x5C, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, 0xFF, 0x24, 0x03, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0xA1, -+0x52, 0xE0, 0xFE, 0x12, 0xB3, 0x49, 0x40, 0x08, 0xEE, 0x9F, 0x90, 0xA3, 0xBE, 0xF0, 0x80, 0x06, -+0x90, 0xA3, 0xBE, 0x74, 0x03, 0xF0, 0x90, 0xA3, 0xBE, 0x51, 0x97, 0xE0, 0x04, 0xF0, 0x80, 0x18, -+0x90, 0xA1, 0x5D, 0xE0, 0xFF, 0x51, 0x88, 0x90, 0xA1, 0x58, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA1, -+0x63, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA1, 0x65, 0xF0, 0x80, 0x08, 0x90, -+0xA1, 0x52, 0x51, 0x97, 0xE0, 0x04, 0xF0, 0x90, 0xA1, 0x50, 0x12, 0x77, 0xBB, 0x30, 0xE0, 0x07, -+0xE4, 0x90, 0xA3, 0xBD, 0xF0, 0x80, 0x06, 0x90, 0xA3, 0xBD, 0x74, 0x01, 0xF0, 0x12, 0xAB, 0x85, -+0x20, 0xE0, 0x13, 0x90, 0xA1, 0x92, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0xA3, 0xBC, 0xF0, 0x80, 0x06, -+0x90, 0xA3, 0xBC, 0x74, 0x01, 0xF0, 0x90, 0xA3, 0xBC, 0x12, 0x62, 0x19, 0x90, 0xA1, 0x62, 0x74, -+0x01, 0xF0, 0x12, 0xAB, 0x74, 0x30, 0xE0, 0x0D, 0x90, 0xA3, 0xBB, 0xE0, 0x70, 0x37, 0xFD, 0xFF, -+0x12, 0x53, 0x36, 0x80, 0x30, 0x90, 0xA1, 0x50, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x12, 0x12, -+0xBE, 0xD2, 0x60, 0x04, 0x7D, 0x01, 0x80, 0x18, 0x12, 0x57, 0xE1, 0x7D, 0x01, 0x7F, 0x0C, 0x80, -+0x11, 0x90, 0xA3, 0xBB, 0xE0, 0xB4, 0x03, 0x0D, 0x90, 0xA0, 0xDF, 0xE0, 0x60, 0x07, 0xE4, 0xFD, -+0x7F, 0x04, 0x12, 0x51, 0x32, 0x90, 0xA1, 0x42, 0xE0, 0x60, 0x18, 0x90, 0xA3, 0xBB, 0xE0, 0x70, -+0x04, 0x7D, 0x04, 0x80, 0x0A, 0x90, 0xA3, 0xBB, 0xE0, 0x64, 0x03, 0x70, 0x31, 0x7D, 0x0B, 0x7F, -+0x6F, 0x80, 0x28, 0x90, 0xA3, 0xBB, 0xE0, 0x70, 0x04, 0xFD, 0xFF, 0x80, 0x1E, 0x90, 0xA3, 0xBB, -+0xE0, 0xB4, 0x03, 0x1A, 0x90, 0xA1, 0x50, 0x12, 0x7A, 0x7F, 0x20, 0xE0, 0x0B, 0xEF, 0x13, 0x13, -+0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0xAD, 0x60, 0xE4, 0xFD, 0xFF, 0x12, 0x53, 0x36, 0x12, 0x77, -+0xB8, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0x97, 0xE1, 0x12, 0x8F, 0xC5, 0x30, 0xE0, 0x04, 0x12, -+0xBE, 0x86, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x8A, 0xBF, 0xEF, 0xF0, 0xE4, 0xFB, 0xFD, -+0x7F, 0x6C, 0x7E, 0x01, 0x02, 0x50, 0x1A, 0xE0, 0xFF, 0x51, 0x88, 0x90, 0xA1, 0x63, 0x22, 0x91, -+0x41, 0x20, 0xE0, 0x02, 0x81, 0x40, 0x90, 0xA1, 0x58, 0xE0, 0x64, 0x01, 0x70, 0x29, 0x90, 0x06, -+0x92, 0xE0, 0x20, 0xE2, 0x06, 0x90, 0x04, 0xE3, 0xE0, 0x60, 0x17, 0xD1, 0x3A, 0xF0, 0x90, 0xA1, -+0x5C, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0xFF, 0x90, 0xA1, 0x65, 0xE0, 0xB5, 0x07, 0x02, 0x80, 0x02, -+0x81, 0x2B, 0xF1, 0xCE, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0x58, 0xE0, 0x64, 0x04, 0x70, 0x26, 0x90, -+0x06, 0x92, 0xE0, 0x20, 0xE2, 0x06, 0x90, 0x04, 0xE3, 0xE0, 0x60, 0x13, 0xD1, 0x3A, 0xF0, 0x90, -+0xA1, 0x5B, 0xE0, 0xFF, 0x90, 0xA1, 0x65, 0xE0, 0xB5, 0x07, 0x02, 0x80, 0x02, 0x81, 0x2B, 0xF1, -+0xCE, 0x74, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0x58, 0xE0, 0x64, 0x06, 0x60, 0x02, 0x61, 0xB8, 0xD1, -+0x73, 0x50, 0x08, 0x90, 0xA1, 0x66, 0xE0, 0x94, 0x03, 0x40, 0x1A, 0xF1, 0xC6, 0x90, 0xA1, 0x63, -+0x30, 0xE0, 0x05, 0x74, 0x05, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0xE4, 0x90, 0xA1, 0x58, 0xF0, -+0x90, 0xA1, 0x66, 0xF0, 0x22, 0x90, 0xA1, 0x57, 0xF1, 0xDA, 0x30, 0xE0, 0x1A, 0xEF, 0x54, 0xFB, -+0xF0, 0xE4, 0xA3, 0xF1, 0xC5, 0x30, 0xE0, 0x02, 0x61, 0xDA, 0xD1, 0x73, 0x90, 0xA1, 0x63, 0x40, -+0x02, 0x61, 0xDD, 0x74, 0x02, 0xF0, 0x22, 0xF1, 0x9F, 0xF0, 0x90, 0xA1, 0x66, 0xE0, 0x04, 0xF0, -+0x7F, 0x03, 0x51, 0x88, 0xD1, 0x73, 0x50, 0x0A, 0x90, 0xA1, 0x66, 0xE0, 0x94, 0x03, 0x50, 0x02, -+0x81, 0x40, 0x90, 0x9F, 0xD2, 0xE0, 0xFF, 0x90, 0xA3, 0xD6, 0x74, 0x0A, 0xF0, 0x7B, 0x01, 0x7D, -+0x01, 0xB1, 0x3D, 0xAD, 0x07, 0xAC, 0x06, 0xE4, 0xFF, 0x91, 0xD2, 0x90, 0xA0, 0xDA, 0x12, 0x9A, -+0x05, 0x54, 0xFD, 0xF0, 0x90, 0xA1, 0x57, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0x12, 0x57, 0xD6, -+0x7F, 0x03, 0x12, 0x8B, 0x4F, 0x90, 0x05, 0x22, 0xE0, 0x44, 0x10, 0xFF, 0x7D, 0x03, 0x12, 0x53, -+0x36, 0x90, 0x04, 0x9C, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0x58, 0xE0, 0x64, 0x07, 0x70, 0x32, -+0x90, 0xA1, 0x66, 0xE0, 0xB4, 0x04, 0x04, 0xF1, 0xA6, 0x80, 0x5A, 0x90, 0xA1, 0x57, 0xF1, 0xDA, -+0x30, 0xE0, 0x0E, 0xEF, 0x54, 0xFB, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0xA1, 0x63, 0x74, 0x05, 0xF0, -+0x22, 0xF1, 0x9F, 0xF0, 0x7D, 0x08, 0x7F, 0x01, 0x91, 0x4F, 0x90, 0xA1, 0x66, 0xE0, 0x04, 0xF0, -+0x80, 0x39, 0x90, 0xA1, 0x58, 0xE0, 0x64, 0x09, 0x70, 0x46, 0x90, 0xA1, 0x57, 0xE0, 0x30, 0xE0, -+0x0A, 0xF1, 0xA6, 0x90, 0xA1, 0x57, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x06, 0x92, 0xE0, 0x30, -+0xE2, 0x1D, 0xD1, 0x3D, 0xF0, 0xE0, 0xB4, 0x02, 0x12, 0xF1, 0xBD, 0x60, 0x05, 0x74, 0x05, 0xF0, -+0x80, 0x03, 0x74, 0x02, 0xF0, 0xE4, 0x90, 0xA1, 0x58, 0xF0, 0x22, 0x7F, 0x03, 0x41, 0x88, 0xF1, -+0xBD, 0x60, 0x05, 0x74, 0x05, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0xE4, 0x90, 0xA1, 0x58, 0xF0, -+0x22, 0x90, 0xA1, 0x54, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x7D, 0x08, 0xE4, 0xFF, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0xB6, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x9F, -+0x15, 0xE0, 0x04, 0xF0, 0x90, 0xA1, 0x50, 0xE0, 0x30, 0xE0, 0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, -+0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x34, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA3, 0xBA, 0xF0, -+0x7D, 0x26, 0x12, 0x56, 0x2A, 0xEF, 0x64, 0x01, 0x70, 0x07, 0xB1, 0x13, 0x20, 0xE0, 0x0E, 0x80, -+0x0A, 0x91, 0x41, 0x30, 0xE0, 0x07, 0xB1, 0x13, 0x20, 0xE0, 0x02, 0xD1, 0x9F, 0x90, 0xA3, 0xBA, -+0xE0, 0xFF, 0x7D, 0x27, 0x12, 0x53, 0x36, 0x12, 0xBD, 0x78, 0x80, 0x0A, 0x12, 0xBD, 0x78, 0xB1, -+0x13, 0x20, 0xE0, 0x02, 0xD1, 0x9F, 0x90, 0xA1, 0x50, 0xE0, 0x30, 0xE0, 0x0D, 0x91, 0x41, 0x30, -+0xE0, 0x08, 0x12, 0xAB, 0x7D, 0x7D, 0x28, 0x12, 0x53, 0x36, 0x12, 0xBE, 0xFC, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD1, 0x47, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x2F, 0xD1, 0x2E, 0x44, 0x10, 0xD1, 0x46, -+0x44, 0x80, 0xF0, 0x12, 0xAB, 0x6D, 0x54, 0x07, 0x30, 0xE0, 0x27, 0x12, 0xAB, 0x8E, 0x50, 0x0B, -+0xEF, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x74, 0x2B, 0x2D, 0xE1, 0xE2, 0x74, 0x2B, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x7F, 0xF0, 0x22, 0xD1, 0x2E, 0x54, 0xEF, 0xD1, 0x46, 0x44, -+0x40, 0xF0, 0x22, 0x90, 0x9F, 0xD2, 0xE0, 0xFF, 0x90, 0xA3, 0xB7, 0xE0, 0xFB, 0x90, 0xA3, 0xD6, -+0x74, 0x0A, 0xF0, 0x7D, 0x01, 0xB1, 0x3D, 0x90, 0xA3, 0xB8, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, -+0xFD, 0x90, 0xA3, 0xB6, 0xE0, 0xFF, 0x91, 0xD2, 0x90, 0xA1, 0xB3, 0xE0, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0xD4, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA3, 0xD3, 0xEF, -+0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xBD, 0xE3, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0xA3, 0xD3, 0xE0, 0x90, -+0x04, 0x25, 0xF0, 0x90, 0xA3, 0xD4, 0xE0, 0x60, 0x06, 0x12, 0xBE, 0xC6, 0x44, 0x80, 0xF0, 0xAF, -+0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x12, -+0xBE, 0xC6, 0x54, 0xC0, 0xF0, 0x90, 0xA3, 0xD6, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x12, 0x2E, 0xF1, 0x09, 0xE0, 0x54, 0x01, -+0xFF, 0x90, 0xA3, 0xD5, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x44, 0x02, 0x4E, 0xFF, 0xAE, -+0x05, 0x74, 0x12, 0x2E, 0xF1, 0x09, 0xEF, 0xF0, 0x74, 0x11, 0x2E, 0xF1, 0xB5, 0x74, 0xFF, 0xF0, -+0x74, 0x29, 0x2E, 0xD1, 0x31, 0x54, 0xF7, 0xF0, 0x90, 0xA1, 0x50, 0xE0, 0x30, 0xE0, 0x0D, 0x12, -+0xBE, 0xBA, 0x44, 0x80, 0xF0, 0x90, 0x05, 0x12, 0xE4, 0xF0, 0x80, 0x06, 0x12, 0xBE, 0xBA, 0x54, -+0x7F, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0xA3, 0xE3, 0xEF, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x21, 0x90, 0x05, 0x22, -+0xE0, 0x90, 0xA3, 0xE6, 0xF0, 0x7D, 0x29, 0x12, 0x56, 0x2A, 0xBF, 0x01, 0x05, 0xD1, 0x53, 0xFF, -+0x91, 0xD2, 0x90, 0xA3, 0xE6, 0xE0, 0xFF, 0x7D, 0x2A, 0x12, 0x53, 0x36, 0x80, 0x05, 0xD1, 0x53, -+0xFF, 0x91, 0xD2, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x29, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, -+0x90, 0xA1, 0x65, 0xE0, 0x04, 0x22, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x22, 0x90, 0x9F, 0xD3, 0xE0, 0xFF, 0x90, 0xA3, 0xD6, 0x74, 0x0B, 0xF0, 0x7B, 0x08, -+0x7D, 0x01, 0xB1, 0x3D, 0x90, 0xA3, 0xE4, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA3, -+0xE3, 0xE0, 0x22, 0x90, 0xA1, 0x66, 0xE0, 0xFF, 0x90, 0xA1, 0x65, 0xE0, 0x2F, 0xFF, 0xE4, 0x33, -+0xFE, 0x7C, 0x00, 0x7D, 0x03, 0x12, 0x07, 0x03, 0x90, 0xA1, 0x51, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, -+0xFE, 0x90, 0xA1, 0x82, 0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0x74, 0x80, 0xF8, 0x6E, 0x98, 0x22, 0x90, -+0xA3, 0xB8, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, -+0xF1, 0x93, 0x44, 0x01, 0xF0, 0xF1, 0x93, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0xF1, -+0x09, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x11, 0x2C, 0xF1, 0xB5, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, -+0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, -+0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, -+0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF1, 0xAD, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, -+0xF1, 0xAD, 0xED, 0xF0, 0x22, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0x22, 0x90, 0x9F, 0xD4, 0xE0, 0xFF, 0x90, 0xA3, 0xD6, 0x74, 0x01, 0xF0, 0x7B, 0x08, 0xFD, 0xB1, -+0x3D, 0x90, 0xA2, 0xF2, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA2, 0xEF, 0xE0, 0xFF, -+0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0xA2, 0xF9, 0xF0, 0x90, 0xA2, 0xF6, 0xEC, 0x12, 0xAB, 0xAE, -+0x90, 0xA2, 0xF6, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x91, 0xD2, 0x90, 0xA2, 0xF6, 0xA3, 0xE0, 0xFF, -+0xFD, 0x24, 0x0D, 0xF1, 0x96, 0x44, 0x80, 0xF0, 0x74, 0x0D, 0x2D, 0xF1, 0x96, 0x54, 0xEF, 0xF1, -+0x05, 0xE0, 0x44, 0x02, 0xF1, 0x05, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0xA2, 0xF8, 0xE0, 0xFF, 0x90, -+0xA2, 0xF6, 0xA3, 0xE0, 0xFE, 0x24, 0x2A, 0x12, 0xAB, 0xA0, 0x90, 0xA2, 0xF9, 0xE0, 0xFF, 0x74, -+0x2B, 0x2E, 0xF1, 0xE2, 0x74, 0x2C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x24, -+0x02, 0xF0, 0x22, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, -+0xA1, 0x57, 0xE0, 0x44, 0x02, 0x22, 0x90, 0xA1, 0x63, 0x74, 0x05, 0xF0, 0x22, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0xA3, 0xE8, -+0xE0, 0x90, 0xA1, 0x63, 0x22, 0xF0, 0x90, 0xA1, 0x53, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0xE4, 0x90, -+0xA1, 0x58, 0xF0, 0x90, 0xA1, 0x63, 0x22, 0x90, 0xA0, 0xDA, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, -+0x22, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, -+0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, -+0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x11, 0x29, 0x53, 0x91, 0xBF, 0xD0, 0x07, -+0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, -+0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0xFD, 0x68, 0xE0, 0xFF, 0x90, 0xFD, -+0x60, 0xE0, 0x90, 0xA2, 0xFB, 0xF0, 0xEF, 0x20, 0xE0, 0x02, 0x21, 0x64, 0x90, 0xA3, 0xE9, 0xE0, -+0x70, 0x1A, 0x7F, 0x2E, 0x12, 0x4A, 0xB0, 0x90, 0xA1, 0x8E, 0xEF, 0xF0, 0x7F, 0x2D, 0x12, 0x4A, -+0xB0, 0x90, 0xA1, 0x8F, 0xEF, 0xF0, 0x90, 0xA3, 0xE9, 0x74, 0x01, 0xF0, 0x90, 0xA2, 0xFB, 0xE0, -+0x64, 0x15, 0x70, 0x55, 0x90, 0xFD, 0x62, 0xE0, 0xFF, 0x30, 0xE6, 0x11, 0xF4, 0x54, 0x3F, 0x04, -+0xFE, 0x31, 0x6D, 0xC3, 0x9E, 0x31, 0x65, 0x40, 0x12, 0xE4, 0xF0, 0x80, 0x0E, 0x31, 0x6D, 0xFE, -+0xEF, 0x54, 0x3F, 0x2E, 0x31, 0x65, 0x40, 0x03, 0x74, 0x3F, 0xF0, 0x90, 0xA2, 0xFA, 0xE0, 0xFF, -+0x54, 0x30, 0xC4, 0x54, 0x0F, 0xFE, 0xEF, 0x25, 0xE0, 0x25, 0xE0, 0x4E, 0xF5, 0x26, 0xFD, 0x7F, -+0x2E, 0x12, 0x48, 0xCF, 0x90, 0xA2, 0xFA, 0xE0, 0xC4, 0x54, 0xF0, 0xFF, 0x90, 0xA1, 0x8F, 0xE0, -+0x54, 0x0F, 0x4F, 0xFD, 0x7F, 0x2D, 0x12, 0x48, 0xCF, 0x90, 0xA2, 0xFB, 0xE0, 0xB4, 0x23, 0x05, -+0x7F, 0x01, 0x12, 0x7F, 0xB2, 0x90, 0xA2, 0xFB, 0xE0, 0xB4, 0x27, 0x05, 0x7F, 0x02, 0x12, 0x7F, -+0xB2, 0x90, 0xA2, 0xFB, 0xE0, 0xB4, 0x30, 0x0D, 0xE4, 0xFB, 0xFD, 0x7F, 0x01, 0x12, 0xA7, 0xA1, -+0x7F, 0x04, 0x12, 0x7F, 0x8F, 0x90, 0xA2, 0xFB, 0xE0, 0x64, 0x34, 0x70, 0x3F, 0x90, 0xFD, 0x62, -+0xE0, 0x30, 0xE0, 0x2D, 0x90, 0xA1, 0x75, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x2F, 0x75, 0x26, 0x01, -+0x7B, 0x00, 0x7A, 0x00, 0x79, 0x26, 0x7D, 0x01, 0x7F, 0x34, 0x12, 0x7F, 0x4A, 0x75, 0x26, 0x03, -+0xAF, 0x26, 0x31, 0x76, 0x90, 0x04, 0x9D, 0xE4, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x51, 0x5E, 0x80, -+0x0B, 0x51, 0xC6, 0x90, 0x04, 0x9D, 0xE0, 0x54, 0xFE, 0xF0, 0x51, 0xAD, 0x90, 0xA2, 0xFB, 0xE0, -+0x64, 0x39, 0x70, 0x29, 0x90, 0xA1, 0x50, 0xE0, 0x30, 0xE0, 0x22, 0xF1, 0x8A, 0x30, 0xE0, 0x1D, -+0x90, 0xA1, 0x75, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x13, 0x90, 0xA1, 0x63, 0xE0, 0x24, 0xFD, -+0x60, 0x04, 0x24, 0x03, 0x70, 0x07, 0x51, 0xBF, 0x74, 0x05, 0x12, 0x96, 0xD5, 0x90, 0xFD, 0x68, -+0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0xA2, 0xFA, 0xF0, 0xD3, 0x94, 0x3F, 0x22, 0x90, 0xA1, 0x8E, -+0xE0, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x90, 0xA2, 0xFC, 0xEF, 0xF0, 0x71, 0x0D, 0xE4, 0xFE, 0xFD, -+0xEC, 0x90, 0xA1, 0x6C, 0x12, 0x08, 0x6D, 0x90, 0xA1, 0x6B, 0xE0, 0x44, 0x01, 0xF0, 0x7D, 0x11, -+0x7F, 0xFF, 0x12, 0x53, 0x36, 0x12, 0x4A, 0x1F, 0x90, 0x07, 0x78, 0xE0, 0x90, 0xA1, 0x70, 0xF0, -+0xF1, 0x82, 0x12, 0x62, 0x1E, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, 0x70, 0x02, 0x80, 0x1C, 0xED, 0xB4, -+0x01, 0x06, 0x31, 0xCE, 0x44, 0x20, 0xF0, 0x22, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, 0xB4, 0x02, 0x06, -+0x31, 0xCE, 0x44, 0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x03, 0x31, 0xCE, 0xF0, 0x22, 0x90, 0xA1, -+0x6B, 0xE0, 0x54, 0x1F, 0x22, 0x90, 0xA3, 0x35, 0x74, 0x09, 0xF0, 0x90, 0xA3, 0x43, 0x74, 0x07, -+0xF0, 0x90, 0xA3, 0x37, 0xEF, 0xF0, 0x70, 0x31, 0x90, 0xA1, 0x69, 0xE0, 0x60, 0x1A, 0xA3, 0xE0, -+0x60, 0x02, 0x80, 0x0C, 0x90, 0x07, 0x70, 0xE0, 0x70, 0x06, 0x90, 0x07, 0x74, 0xE0, 0x60, 0x08, -+0x90, 0xA3, 0x38, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA3, 0x38, 0xF0, 0xE4, 0x90, 0xA3, -+0x39, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0x80, 0x39, 0x90, 0xFD, 0x62, 0xE0, 0x90, 0xA3, 0x38, -+0xF0, 0x90, 0xFD, 0x63, 0xE0, 0x90, 0xA3, 0x39, 0xF0, 0x90, 0xFD, 0x64, 0xE0, 0x90, 0xA3, 0x3A, -+0xF0, 0x90, 0xFD, 0x65, 0xE0, 0x90, 0xA3, 0x3B, 0xF0, 0x90, 0xFD, 0x66, 0xE0, 0x90, 0xA3, 0x3C, -+0xF0, 0x90, 0xFD, 0x67, 0xE0, 0x90, 0xA3, 0x3D, 0xF0, 0x90, 0xA3, 0x38, 0xE0, 0x54, 0x01, 0x90, -+0xA1, 0x69, 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x35, 0x02, 0x78, 0x06, 0x90, 0x01, -+0xE7, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x12, 0x06, 0x89, 0x54, 0x01, 0xF1, 0xDB, 0x54, 0xFD, 0x4F, -+0xF0, 0xE0, 0xC3, 0x13, 0xFF, 0x54, 0x01, 0x90, 0x01, 0xE6, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, -+0xEF, 0x30, 0xE0, 0x27, 0x12, 0xBE, 0x1F, 0x70, 0x20, 0x90, 0xA1, 0x99, 0xE0, 0x30, 0xE0, 0x02, -+0x80, 0x19, 0x90, 0xFD, 0x62, 0xE0, 0xB4, 0xAD, 0x0E, 0xA3, 0xE0, 0xB4, 0x35, 0x09, 0x51, 0x5E, -+0x90, 0x01, 0xE5, 0x74, 0xDF, 0xF0, 0x22, 0x80, 0x00, 0x80, 0x02, 0x80, 0xB1, 0x90, 0x01, 0xE7, -+0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0xA1, 0xB8, 0x12, 0x47, 0xDE, 0xE0, 0x24, 0xFC, 0xFF, 0xE4, -+0x90, 0xA3, 0x9D, 0xF0, 0xA3, 0x22, 0x90, 0xA1, 0x6B, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, -+0x90, 0xA1, 0x70, 0xE0, 0xFF, 0x71, 0x4F, 0x71, 0x0D, 0xE4, 0xFF, 0xE4, 0xFC, 0x71, 0x03, 0x12, -+0x47, 0xC6, 0x90, 0xA1, 0x6C, 0x12, 0x47, 0xD2, 0x12, 0x47, 0xA8, 0x71, 0x03, 0x12, 0x4C, 0x4F, -+0xF1, 0xCC, 0x90, 0xA0, 0xDF, 0xE0, 0x70, 0x0A, 0x90, 0xA1, 0x43, 0xE0, 0x20, 0xE0, 0x03, 0x12, -+0x57, 0xDE, 0x22, 0x90, 0xA3, 0xBF, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0xBF, 0x22, 0x7F, 0xB4, 0x7E, -+0x0C, 0x02, 0x37, 0xBC, 0x71, 0x3F, 0x90, 0xA1, 0x6B, 0x12, 0x7A, 0x7F, 0xFE, 0xEF, 0xC3, 0x13, -+0x54, 0x0F, 0xC3, 0x9E, 0x40, 0x02, 0x80, 0x9E, 0x90, 0xA1, 0x6B, 0xE0, 0xFF, 0xC3, 0x13, 0x54, -+0x0F, 0xFE, 0xEF, 0x54, 0xE1, 0xFF, 0xEE, 0x04, 0x54, 0x0F, 0x25, 0xE0, 0x4F, 0xF0, 0x22, 0x7D, -+0x12, 0x7F, 0xFF, 0x12, 0x53, 0x36, 0x7F, 0x01, 0x71, 0x4F, 0xF1, 0x82, 0x02, 0x62, 0x1E, 0x90, -+0xA1, 0x75, 0x91, 0xFE, 0x30, 0xE0, 0x07, 0x90, 0x07, 0x78, 0x74, 0x09, 0xF0, 0x22, 0x90, 0xA1, -+0xB1, 0xE0, 0x30, 0xE0, 0x1D, 0xEF, 0x24, 0xFD, 0x60, 0x0E, 0x24, 0xFA, 0x60, 0x0E, 0x24, 0xFC, -+0x60, 0x0E, 0x24, 0x0C, 0x7F, 0x02, 0x80, 0x0A, 0x7F, 0x03, 0x80, 0x06, 0x7F, 0x0B, 0x80, 0x02, -+0x7F, 0x0E, 0x90, 0x07, 0x78, 0xEF, 0xF0, 0x22, 0xAD, 0x07, 0xED, 0x70, 0x19, 0x91, 0x13, 0x70, -+0x02, 0x80, 0x17, 0xBC, 0x01, 0x02, 0x80, 0x19, 0x91, 0x13, 0xBC, 0x02, 0x02, 0x80, 0x1B, 0xEC, -+0x64, 0x03, 0x70, 0x21, 0x80, 0x1B, 0x91, 0x1B, 0x70, 0x04, 0x7F, 0x01, 0x80, 0x15, 0xBC, 0x01, -+0x04, 0x7F, 0x03, 0x80, 0x0E, 0x91, 0x1B, 0xBC, 0x02, 0x04, 0x7F, 0x09, 0x80, 0x05, 0xBC, 0x03, -+0x04, 0x7F, 0x0D, 0x71, 0x4F, 0x90, 0xA1, 0x9F, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x3A, -+0xED, 0x70, 0x1B, 0xA3, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA2, 0xEE, -+0xF0, 0x80, 0x02, 0x91, 0x0C, 0x90, 0xA2, 0xEE, 0xE0, 0xFD, 0xE4, 0xFF, 0x80, 0x19, 0x90, 0xA1, -+0xA0, 0x12, 0x84, 0x44, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA2, 0xEE, 0xF0, 0x80, 0x02, 0x91, 0x0C, -+0x90, 0xA2, 0xEE, 0xE0, 0xFD, 0x7F, 0x01, 0x12, 0x62, 0x1E, 0x22, 0xF0, 0x90, 0xA2, 0xEE, 0x74, -+0x01, 0xF0, 0x22, 0x90, 0xA1, 0xA0, 0xE0, 0x54, 0x03, 0xFC, 0x22, 0x90, 0xA1, 0xA0, 0xE0, 0xC4, -+0x54, 0x03, 0xFC, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA1, 0xA6, 0xE0, 0xB4, -+0x01, 0x02, 0x80, 0x40, 0x90, 0xA1, 0xA6, 0xE0, 0xB4, 0x02, 0x10, 0xB1, 0x27, 0x7F, 0x01, 0xB1, -+0x4E, 0x71, 0x88, 0x90, 0xA1, 0xA6, 0x74, 0x03, 0xF0, 0x80, 0x3B, 0x90, 0xA1, 0xA6, 0xE0, 0x64, -+0x03, 0x70, 0x1A, 0x90, 0xA1, 0xA9, 0xB1, 0x2A, 0xE4, 0xFF, 0xB1, 0x4E, 0x71, 0x88, 0xB1, 0x05, -+0xE4, 0xFB, 0xFD, 0x91, 0x8B, 0x90, 0xA1, 0xA6, 0x74, 0x04, 0xF0, 0x80, 0x19, 0x90, 0xA1, 0xA6, -+0xE0, 0xB4, 0x04, 0x12, 0xB1, 0x05, 0x7B, 0x01, 0x7D, 0x01, 0x91, 0x8B, 0x90, 0xA1, 0xA6, 0x74, -+0x02, 0xF0, 0x90, 0xA1, 0xA4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0xEE, 0x12, 0xAB, -+0xAD, 0x90, 0xA1, 0x9F, 0x91, 0xFE, 0x20, 0xE0, 0x0E, 0x90, 0xA2, 0xEF, 0xE0, 0xB4, 0x01, 0x07, -+0x7D, 0x36, 0x7F, 0x6F, 0x12, 0x53, 0x36, 0x90, 0xA2, 0xEE, 0xE0, 0x70, 0x0C, 0x90, 0xA2, 0xF0, -+0xE0, 0xFF, 0x7D, 0x05, 0x12, 0x84, 0x4F, 0x80, 0x2D, 0x90, 0xA2, 0xEE, 0xE0, 0xB4, 0x01, 0x0A, -+0x90, 0xA2, 0xF0, 0xE0, 0xFF, 0x12, 0x85, 0xEB, 0x80, 0x1C, 0x90, 0xA2, 0xEE, 0xE0, 0xB4, 0x02, -+0x15, 0xA3, 0xE0, 0xB4, 0x01, 0x10, 0x90, 0x9F, 0xD5, 0xE0, 0xFF, 0x90, 0xA1, 0xAD, 0xE0, 0xFC, -+0xA3, 0xE0, 0xFD, 0x12, 0xA9, 0x9C, 0x90, 0xA1, 0x9F, 0x91, 0xFE, 0x20, 0xE0, 0x0B, 0x90, 0xA2, -+0xEF, 0xE0, 0x70, 0x05, 0xFD, 0xFF, 0x12, 0x53, 0x36, 0x22, 0xF0, 0x90, 0xA1, 0x41, 0xE0, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0xA1, 0x9F, 0xE0, 0xC3, 0x13, 0x54, 0x03, 0xFF, 0x22, 0x90, -+0xA1, 0x6B, 0xE0, 0x30, 0xE0, 0x04, 0x71, 0x3F, 0x80, 0x03, 0x12, 0xA9, 0x5E, 0x90, 0xA1, 0x9F, -+0xE0, 0x30, 0xE0, 0x02, 0x91, 0x24, 0x22, 0x90, 0xA1, 0xAB, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xAD, -+0x07, 0xEE, 0xFF, 0x90, 0x01, 0x6F, 0xE4, 0xF0, 0x8F, 0x35, 0xAF, 0x05, 0x8F, 0x36, 0xFB, 0xFD, -+0x7F, 0x6C, 0x7E, 0x01, 0x12, 0x3B, 0xDB, 0x90, 0x01, 0x6F, 0x74, 0x05, 0xF0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x64, 0x03, 0x70, 0x0E, 0x90, 0xA1, 0x53, 0x12, 0x84, 0x44, -+0x90, 0x06, 0xCC, 0x30, 0xE0, 0x3A, 0x80, 0x2D, 0x90, 0xA1, 0x54, 0xE0, 0xC4, 0x54, 0x0F, 0x30, -+0xE0, 0x10, 0xEF, 0x90, 0x06, 0xCC, 0x70, 0x06, 0xE0, 0x54, 0xFC, 0xF0, 0x80, 0x04, 0xE0, 0x44, -+0x03, 0xF0, 0x90, 0xA1, 0x9F, 0xE0, 0x30, 0xE0, 0x1B, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x0E, 0xEF, -+0x90, 0x06, 0xCC, 0x70, 0x06, 0xE0, 0x54, 0xFC, 0xF0, 0x80, 0x09, 0x80, 0x03, 0x90, 0x06, 0xCC, -+0xE0, 0x44, 0x03, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x7D, 0x02, 0x90, 0xA1, 0x50, 0xE0, 0x20, 0xE0, 0x02, 0xC1, 0xA2, 0xF1, 0x8A, 0x20, 0xE0, 0x02, -+0xC1, 0xA2, 0xE4, 0xFF, 0xB1, 0x4E, 0x90, 0xA1, 0x54, 0xE0, 0x30, 0xE0, 0x03, 0x0F, 0x80, 0x32, -+0x90, 0xA1, 0x50, 0x12, 0x84, 0x44, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x25, 0x12, 0xBF, 0x29, -+0x30, 0xE0, 0x10, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x09, 0x80, 0x13, 0x7F, -+0x03, 0x80, 0x0F, 0x90, 0xA1, 0x53, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, -+0x7F, 0x09, 0x71, 0x4F, 0x90, 0xA1, 0x50, 0x12, 0x77, 0xBB, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA2, -+0xEE, 0xF0, 0x80, 0x02, 0x91, 0x0C, 0x12, 0xAB, 0x85, 0x20, 0xE0, 0x0C, 0x90, 0xA1, 0x92, 0xE0, -+0x60, 0x04, 0xE4, 0xFD, 0x80, 0x02, 0x7D, 0x01, 0xAF, 0x05, 0x90, 0xA2, 0xEE, 0xE0, 0xFD, 0x12, -+0x62, 0x1E, 0x90, 0xA1, 0x75, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0xA1, 0x50, 0x12, 0x7A, 0x7F, 0x20, -+0xE0, 0x26, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x12, 0x12, 0xBE, 0xD2, 0x60, 0x04, 0x7D, 0x01, -+0x80, 0x11, 0x12, 0x57, 0xE1, 0x7D, 0x01, 0x7F, 0x0C, 0x80, 0x0A, 0x90, 0xA0, 0xDF, 0xE0, 0x60, -+0x07, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x51, 0x32, 0x90, 0xA1, 0x42, 0xE0, 0x60, 0x06, 0x7D, 0x04, -+0x7F, 0x6F, 0x80, 0x17, 0x90, 0xA1, 0x50, 0x12, 0x7A, 0x7F, 0x20, 0xE0, 0x0B, 0xEF, 0x13, 0x13, -+0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0xAD, 0x60, 0xE4, 0xFD, 0xFF, 0x12, 0x53, 0x36, 0x12, 0x77, -+0xB8, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0x97, 0xE1, 0xF1, 0xC5, 0x30, 0xE0, 0x04, 0x12, 0xBE, -+0x86, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x6B, 0xE0, 0x30, 0xE0, 0x04, 0x71, 0x14, -+0x80, 0x03, 0x12, 0xAD, 0x1E, 0x12, 0x84, 0x41, 0x30, 0xE0, 0x13, 0x90, 0xA1, 0x9B, 0xE0, 0x04, -+0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, 0xF0, 0x90, 0xA1, 0x9B, 0xF0, 0x90, 0xA0, -+0xD5, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0xA0, 0xD7, 0x74, 0x01, 0xF0, 0x90, 0xA0, 0xDF, 0xE0, 0x70, -+0x02, 0xE1, 0x6B, 0x90, 0xA0, 0xF6, 0xE0, 0x04, 0x12, 0x4F, 0xD8, 0x12, 0x47, 0xA8, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0x4F, 0xF2, 0x78, 0x10, 0x12, 0x08, -+0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0xA8, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x4F, 0xF2, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0xA8, 0x90, 0xA1, 0x2A, 0x12, 0x08, 0x6D, 0x90, 0xA0, -+0xDB, 0x12, 0x9A, 0x05, 0x30, 0xE0, 0x0B, 0x12, 0xB4, 0xE8, 0x74, 0x05, 0xF0, 0x12, 0xB2, 0x85, -+0xF1, 0xD3, 0x90, 0xA0, 0xDB, 0x91, 0xFE, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, -+0x03, 0x12, 0x5B, 0xC3, 0x90, 0xA4, 0x0F, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x80, 0x40, 0x0B, -+0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x01, 0x12, 0x7F, 0x8F, -+0x90, 0xA1, 0x43, 0xE0, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0x5B, -+0xC3, 0x22, 0x90, 0xA1, 0x92, 0xE0, 0xFF, 0xE4, 0xFD, 0x22, 0x90, 0xA1, 0x54, 0xE0, 0x13, 0x13, -+0x54, 0x3F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA1, 0x9F, 0xE0, 0x30, 0xE0, -+0x1F, 0x90, 0xA1, 0xA4, 0xE0, 0xB4, 0x01, 0x0C, 0xA3, 0xE0, 0xB4, 0x01, 0x13, 0x74, 0x02, 0xF0, -+0xB1, 0x27, 0x80, 0x0C, 0x90, 0xA1, 0xA4, 0xE0, 0xB4, 0x02, 0x05, 0x74, 0x03, 0xF0, 0x91, 0x24, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x54, 0xE0, 0xC3, 0x13, 0x22, 0x7F, 0xB4, 0x7E, 0x0C, -+0x02, 0x38, 0x07, 0x90, 0xA0, 0xDC, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x25, 0xE0, 0xFF, 0x90, 0xA1, -+0x75, 0xE0, 0x22, 0x32, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x8B, 0xEF, 0xF0, -+0xA3, 0xED, 0xF0, 0x7D, 0x00, 0x7C, 0x00, 0xE4, 0x90, 0xA3, 0x91, 0xF0, 0x7F, 0xB0, 0x7E, 0x08, -+0x12, 0x37, 0xBC, 0xE4, 0xFF, 0xEC, 0x90, 0xA3, 0x8D, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x8D, 0x12, -+0x47, 0xD2, 0x90, 0xA3, 0x8C, 0x12, 0x4F, 0xF2, 0x12, 0x47, 0xA8, 0xA3, 0x12, 0x08, 0x6D, 0x90, -+0xA3, 0x8D, 0x12, 0x4C, 0x4F, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x38, 0x07, 0x11, 0x52, 0x90, 0xA3, -+0x8B, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0xB5, 0xF5, 0x82, 0xE4, 0x34, 0xAD, 0xF5, 0x83, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x37, 0xBC, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0x90, 0xA3, 0xF3, 0x31, 0x80, 0x90, 0x01, -+0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0xA3, 0xF3, 0xE0, 0x6F, 0x60, 0x34, -+0xC3, 0x90, 0xA3, 0xF5, 0xE0, 0x94, 0x88, 0x90, 0xA3, 0xF4, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, -+0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA3, 0xF4, 0x31, 0x20, 0x11, 0x52, 0xD3, 0x90, -+0xA3, 0xF5, 0xE0, 0x94, 0x32, 0x90, 0xA3, 0xF4, 0xE0, 0x94, 0x00, 0x40, 0xC1, 0x90, 0x01, 0xC6, -+0xE0, 0x30, 0xE0, 0xBA, 0x22, 0x12, 0xB6, 0xDD, 0x7F, 0x08, 0x12, 0x4A, 0xB0, 0xEF, 0x54, 0xEF, -+0xFD, 0x7F, 0x08, 0x12, 0x48, 0xCF, 0xE4, 0xFF, 0x11, 0x59, 0x90, 0xA0, 0xDA, 0xE0, 0xFF, 0xC4, -+0x54, 0x0F, 0x30, 0xE0, 0x03, 0x12, 0xBD, 0x5F, 0x90, 0xA0, 0xDB, 0xE0, 0x54, 0xEF, 0xF0, 0x22, -+0xE4, 0x90, 0xA2, 0xB6, 0xF0, 0xA3, 0xF0, 0x31, 0x27, 0xEF, 0x64, 0x01, 0x60, 0x3B, 0xC3, 0x90, -+0xA2, 0xB7, 0xE0, 0x94, 0x88, 0x90, 0xA2, 0xB6, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, -+0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1D, 0x90, 0xA2, 0xB6, 0x31, -+0x20, 0x11, 0x52, 0xD3, 0x90, 0xA2, 0xB7, 0xE0, 0x94, 0x32, 0x90, 0xA2, 0xB6, 0xE0, 0x94, 0x00, -+0x40, 0xC5, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xBE, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, -+0xE4, 0x75, 0xF0, 0x01, 0x02, 0x08, 0xD6, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, 0x51, -+0x0C, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0xC7, 0xEE, 0xF0, 0xA3, 0x31, 0x80, 0x90, 0xA3, -+0xC7, 0xD1, 0xCC, 0xE0, 0x60, 0x23, 0xC3, 0x90, 0xA3, 0xCA, 0xE0, 0x94, 0xE8, 0x90, 0xA3, 0xC9, -+0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x0B, -+0x90, 0xA3, 0xC9, 0x31, 0x20, 0x51, 0x0D, 0x80, 0xD5, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x62, 0xC3, 0x71, 0xA7, 0x75, 0x43, 0x05, -+0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x9F, 0x12, 0x34, 0x62, 0x90, 0xA1, 0xA1, 0x51, 0x01, 0xEF, 0x78, -+0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xA1, 0xA9, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0xA1, 0xA2, 0x51, 0x01, 0xEF, 0x78, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, -+0xFF, 0x90, 0xA1, 0xAB, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA1, 0xA3, 0x51, 0x01, 0x90, 0xA1, -+0xAD, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA1, 0x9F, 0xE0, 0x30, 0xE0, 0x13, 0x90, 0xA1, 0xA4, -+0x74, 0x01, 0xF0, 0xA3, 0xF0, 0xA3, 0x31, 0x81, 0x90, 0x07, 0x83, 0xE0, 0x44, 0x20, 0xF0, 0x22, -+0xE4, 0x90, 0xA1, 0xA4, 0x12, 0x58, 0x8C, 0xA3, 0xF0, 0x90, 0x07, 0x83, 0xE0, 0x54, 0xDF, 0xF0, -+0x22, 0xE0, 0xFF, 0x7E, 0x00, 0x7C, 0x01, 0x7D, 0x40, 0x02, 0x07, 0x03, 0xF0, 0x7F, 0x0A, 0x7E, -+0x00, 0x02, 0x3D, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0xCF, 0x12, 0x47, -+0xF3, 0x7F, 0x96, 0x7E, 0x02, 0x31, 0x3F, 0xEF, 0x60, 0x4C, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, -+0x01, 0x16, 0x12, 0x7F, 0xD3, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0xA3, 0xD2, -+0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0xA3, 0xD2, 0xE0, 0xFD, 0x90, 0x02, 0x94, -+0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA3, 0xCF, 0x71, 0xAE, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0x51, -+0x7B, 0x90, 0xA3, 0xD2, 0xE0, 0x24, 0x18, 0xFF, 0x90, 0xA3, 0xCF, 0x12, 0x47, 0xEA, 0x71, 0x39, -+0x90, 0x02, 0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFC, 0xED, 0x2C, 0x24, -+0x00, 0x51, 0xCC, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xF3, 0x74, 0x00, 0x2D, 0x51, 0xCC, 0xEF, -+0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, -+0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x74, -+0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, -+0xFB, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA0, 0xC0, -+0xE0, 0xFE, 0x90, 0xA0, 0xBF, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, -+0xEE, 0x64, 0x01, 0x60, 0x3F, 0xED, 0xD1, 0xE0, 0xFA, 0x7B, 0x01, 0x51, 0x14, 0x7F, 0x01, 0xEF, -+0x60, 0x32, 0x90, 0xA0, 0xBF, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, 0x02, 0x7F, 0x00, -+0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA0, 0xBF, 0xF0, 0x90, 0xA0, 0xC0, 0xE0, 0xFF, 0x90, 0xA0, 0xBF, -+0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x07, 0x90, 0x9F, 0x13, -+0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA3, 0xCB, 0xEF, 0xF0, 0xA3, 0x12, -+0x47, 0xF3, 0x90, 0xA3, 0xEF, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x06, 0xE1, -+0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, -+0x90, 0xA3, 0xCC, 0x12, 0x47, 0xEA, 0x71, 0xA7, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, -+0x03, 0x12, 0x34, 0x62, 0x90, 0xA3, 0xCB, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, -+0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x47, 0xEA, 0xE9, 0x24, 0x02, 0xF9, 0xE4, -+0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0xA3, 0xCC, 0x71, 0xAE, 0xF5, 0x43, 0xD0, 0x01, -+0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x62, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x22, 0x12, 0x47, -+0xEA, 0x90, 0x00, 0x0E, 0x02, 0x06, 0xA2, 0x90, 0xA2, 0x28, 0x12, 0x84, 0x44, 0x30, 0xE0, 0x68, -+0x90, 0xA1, 0xB3, 0xE0, 0x30, 0xE0, 0x61, 0x90, 0xA2, 0x2C, 0x31, 0x20, 0x90, 0xA2, 0x28, 0xE0, -+0x54, 0xBF, 0xF0, 0xE4, 0x90, 0xA3, 0x9D, 0xF0, 0x90, 0xA1, 0xCB, 0xE0, 0x24, 0xFB, 0x90, 0xA3, -+0x9E, 0xD1, 0xD5, 0x91, 0x29, 0x90, 0xA2, 0xEE, 0xF0, 0x90, 0xA1, 0xF1, 0xE0, 0xFF, 0xC4, 0x54, -+0x0F, 0x30, 0xE0, 0x21, 0xEF, 0x54, 0xEF, 0xF0, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x28, -+0x12, 0x54, 0x75, 0x75, 0xF0, 0x13, 0x12, 0x8A, 0xB5, 0xEF, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, -+0x7E, 0x01, 0x02, 0x50, 0x1A, 0x90, 0xA2, 0xEE, 0xE0, 0xFF, 0x64, 0x03, 0x60, 0x04, 0xEF, 0xB4, -+0x01, 0x06, 0x12, 0x57, 0xF8, 0x12, 0x53, 0x41, 0x22, 0x90, 0xA1, 0xB3, 0xE0, 0xC3, 0x13, 0x54, -+0x07, 0x75, 0xF0, 0x13, 0x90, 0xA1, 0xB9, 0x12, 0x47, 0xDE, 0xE0, 0x54, 0x07, 0x22, 0x90, 0xA2, -+0x28, 0x12, 0x84, 0x44, 0x30, 0xE0, 0x16, 0x90, 0xA1, 0xB3, 0xE0, 0xFF, 0x30, 0xE0, 0x0E, 0x91, -+0x2D, 0xFE, 0xF1, 0xAA, 0xEE, 0x60, 0x03, 0xB4, 0x02, 0x03, 0x12, 0x53, 0x41, 0x22, 0x90, 0xA0, -+0xD5, 0xE0, 0xFF, 0x30, 0xE0, 0x3F, 0x90, 0xA0, 0xD9, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, -+0x01, 0x90, 0xA0, 0xD8, 0xE0, 0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x25, -+0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x04, 0xB1, 0x2C, 0x80, 0x1B, 0x91, 0xA7, 0x90, 0xA0, 0xD9, 0xE0, -+0xB4, 0x08, 0x06, 0xE4, 0xFD, 0x7F, 0x0C, 0x80, 0x09, 0x90, 0xA0, 0xD9, 0xE0, 0x70, 0x06, 0xFD, -+0x7F, 0x04, 0x12, 0x51, 0x32, 0x80, 0x97, 0x90, 0xA0, 0xD5, 0x12, 0x5E, 0xE9, 0x30, 0xE0, 0x0B, -+0x91, 0xC2, 0x60, 0x07, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x51, 0x32, 0x91, 0xC2, 0x60, 0x02, 0x91, -+0xC9, 0x22, 0x90, 0xA0, 0xD9, 0xE0, 0x64, 0x02, 0x22, 0x90, 0xA0, 0xDF, 0xE0, 0x64, 0x02, 0x60, -+0x10, 0x12, 0x61, 0x32, 0x60, 0x0B, 0xF1, 0xBF, 0xEF, 0x70, 0x06, 0xFD, 0x7F, 0x0C, 0x12, 0x51, -+0x32, 0x22, 0x90, 0xA0, 0xD5, 0xE0, 0xFF, 0x30, 0xE0, 0x40, 0x90, 0xA0, 0xD9, 0xE0, 0x7E, 0x00, -+0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0xA0, 0xD8, 0xE0, 0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, -+0xED, 0x4E, 0x70, 0x26, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x04, 0xB1, 0x2C, 0x80, 0x1C, 0xB1, 0x47, -+0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x0C, 0x06, 0xE4, 0xFD, 0x7F, 0x08, 0x80, 0x0A, 0x90, 0xA0, 0xD9, -+0xE0, 0xB4, 0x04, 0x06, 0xE4, 0xFD, 0xFF, 0x12, 0x51, 0x32, 0x61, 0xB7, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x12, 0x5F, 0x13, 0xBF, 0x01, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x12, -+0x5D, 0x49, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0x57, 0xE0, 0x60, 0x1A, 0xD1, 0x7D, 0xF0, -+0x12, 0x87, 0xD7, 0x30, 0xE0, 0x02, 0xC1, 0x14, 0xB1, 0xFB, 0x40, 0x0B, 0xE4, 0xFF, 0x12, 0x5E, -+0xC9, 0xBF, 0x01, 0x03, 0xB1, 0x68, 0xF0, 0x22, 0x90, 0xA0, 0xDB, 0xE0, 0x54, 0xFB, 0x22, 0x12, -+0x5E, 0x3B, 0x30, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xD1, 0xBC, -+0x12, 0x87, 0xD7, 0x30, 0xE0, 0x08, 0xD1, 0x14, 0x54, 0x07, 0x70, 0x39, 0x80, 0x34, 0xB1, 0xFB, -+0x40, 0x30, 0x12, 0x57, 0xE6, 0x70, 0x2E, 0x12, 0x61, 0x32, 0x70, 0x06, 0xB1, 0xC6, 0xB1, 0x68, -+0xF0, 0x22, 0xB1, 0xC6, 0x90, 0xA0, 0xE9, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x0A, -+0xB1, 0x68, 0xF0, 0xE4, 0x90, 0xA0, 0xE9, 0xF0, 0x80, 0x02, 0xD1, 0x20, 0xE4, 0x90, 0xA0, 0xE8, -+0xF0, 0x22, 0x12, 0x60, 0x47, 0x22, 0xD1, 0x08, 0x40, 0x30, 0x90, 0xA0, 0xF9, 0xE0, 0x04, 0xF0, -+0x90, 0xA1, 0x3B, 0xE0, 0xFF, 0x90, 0xA0, 0xF9, 0xE0, 0xD3, 0x9F, 0x50, 0x1D, 0x90, 0xA0, 0xF1, -+0xE0, 0x04, 0xD1, 0x31, 0x90, 0xA0, 0xF8, 0xF0, 0xFB, 0x90, 0xA0, 0xF1, 0xE0, 0xFF, 0xA3, 0xE0, -+0xFD, 0x90, 0xA3, 0xE2, 0x74, 0x04, 0xF0, 0x12, 0xB2, 0x85, 0x22, 0x90, 0xA0, 0xE8, 0xE0, 0x04, -+0xF0, 0x90, 0xA0, 0xE3, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0xA1, 0x3C, 0xE0, 0xFF, 0x90, 0xA0, 0xE8, -+0xE0, 0xD3, 0x9F, 0x22, 0xEF, 0x54, 0xFB, 0xF0, 0x90, 0xA0, 0xE3, 0xE0, 0x54, 0xFD, 0xF0, 0x22, -+0xD1, 0x85, 0x90, 0xA0, 0xE2, 0xE0, 0x64, 0x0C, 0x60, 0x06, 0x12, 0x53, 0x2D, 0x12, 0x84, 0x4B, -+0x22, 0xF0, 0x90, 0xA0, 0xE8, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0xA0, 0xE7, -+0xE0, 0x2F, 0x22, 0xE4, 0xFF, 0x12, 0x5E, 0xC9, 0xBF, 0x01, 0x12, 0x90, 0xA0, 0xDF, 0xE0, 0x60, -+0x0C, 0x12, 0x61, 0x32, 0x64, 0x02, 0x60, 0x03, 0x02, 0xAD, 0x60, 0xD1, 0x20, 0x22, 0x12, 0x57, -+0xE6, 0x70, 0x16, 0x90, 0xA0, 0xDF, 0xE0, 0x60, 0x10, 0xD1, 0x7A, 0xF0, 0x90, 0xA0, 0xDA, 0xE0, -+0xD1, 0x15, 0x54, 0x07, 0x70, 0x03, 0x12, 0x60, 0x47, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, -+0x01, 0x3C, 0x74, 0x02, 0x22, 0x90, 0xA0, 0xDA, 0x12, 0x8C, 0xFE, 0x30, 0xE0, 0x05, 0x90, 0x01, -+0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, -+0x90, 0xA3, 0x9D, 0xF0, 0x90, 0xA1, 0x3E, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0x90, 0xA3, 0x9E, 0xD1, -+0xC3, 0x12, 0x50, 0x1A, 0x90, 0xA0, 0xDA, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x7D, 0x02, 0x7F, 0x02, -+0x02, 0x5B, 0xCD, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, -+0xF5, 0x82, 0x8E, 0x83, 0x22, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x60, 0x7E, 0x01, 0x02, 0x50, 0x1A, -+0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x29, 0xF9, 0x74, 0xA0, 0x35, 0xF0, 0x22, 0x12, 0x57, 0xE6, 0x70, -+0x0B, 0x90, 0xA0, 0xDF, 0xE0, 0x60, 0x05, 0xD1, 0x7A, 0x12, 0x50, 0x05, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x4F, 0x69, 0x11, 0xA5, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA0, -+0xE2, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0D, 0xF1, 0x46, 0xBF, 0x01, 0x08, 0xD1, 0xFD, 0x90, -+0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA0, 0xDA, 0xE0, 0x30, 0xE0, 0x18, 0x90, 0xA0, 0xD5, -+0xE0, 0xFF, 0x30, 0xE0, 0x0E, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xF1, 0x9D, 0xBF, 0x01, 0x06, 0x80, -+0x02, 0x80, 0x00, 0xF1, 0x0E, 0x22, 0x90, 0xA1, 0x43, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x35, 0x90, -+0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, -+0x0E, 0x01, 0x80, 0x22, 0x90, 0x02, 0x96, 0xE0, 0x60, 0x05, 0x75, 0x0E, 0x10, 0x80, 0x17, 0x90, -+0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, -+0x0E, 0x04, 0x80, 0x02, 0x80, 0x0F, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, -+0x0E, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0xA0, 0xD8, -+0xE0, 0x64, 0x02, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x12, 0x57, 0x1E, 0x20, 0xE0, 0x08, -+0xC3, 0x13, 0x30, 0xE0, 0x09, 0x02, 0x57, 0xF8, 0x12, 0x57, 0x1E, 0x44, 0x04, 0xF0, 0x22, 0x90, -+0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, -+0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0xF1, 0xBF, 0xEF, 0x70, 0x03, 0x12, 0x57, 0xB1, -+0x22, 0x90, 0xA1, 0x83, 0xE0, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x16, 0xEF, 0xB4, 0x01, 0x05, 0x90, -+0xA1, 0x8A, 0x80, 0x03, 0x90, 0xA1, 0x86, 0x12, 0x4C, 0x4F, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x38, -+0x07, 0x22, 0x7E, 0x00, 0x7F, 0x19, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x83, 0x12, 0x08, -+0xAA, 0x51, 0x18, 0x90, 0xA1, 0x8A, 0x12, 0x47, 0xC6, 0x90, 0xA1, 0x86, 0x12, 0x08, 0x6D, 0x90, -+0x9F, 0x19, 0xE0, 0xFF, 0x64, 0x02, 0x70, 0x1A, 0x31, 0x1A, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, -+0xA1, 0x92, 0xEE, 0xF0, 0x31, 0x1A, 0x30, 0xE1, 0x02, 0x7E, 0x01, 0x90, 0xA1, 0x93, 0xEE, 0xF0, -+0x80, 0x3A, 0xEF, 0x64, 0x01, 0x70, 0x15, 0x11, 0xB1, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0xA1, -+0x92, 0xEF, 0xF0, 0x11, 0xB1, 0x30, 0xE1, 0x02, 0x7F, 0x01, 0x80, 0x1B, 0x90, 0x9F, 0x19, 0xE0, -+0x64, 0x03, 0x70, 0x18, 0x11, 0xAA, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0xA1, 0x92, 0xEF, 0xF0, -+0x11, 0xAA, 0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0xA1, 0x93, 0xEF, 0xF0, 0x90, 0xFD, 0x68, 0xE0, -+0x44, 0x02, 0xF0, 0x7F, 0x01, 0x12, 0x8B, 0x4F, 0x11, 0xB8, 0x12, 0xAD, 0x08, 0x90, 0xA1, 0x69, -+0x74, 0x01, 0xF0, 0x90, 0xA1, 0x9F, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x04, 0x8F, 0xE4, 0xF0, 0x90, -+0xA1, 0xB1, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, -+0x22, 0x90, 0xFD, 0x70, 0xE0, 0x7F, 0x00, 0x22, 0x7E, 0x00, 0x7F, 0x33, 0x7D, 0x00, 0x7B, 0x01, -+0x7A, 0xA1, 0x79, 0x50, 0x12, 0x08, 0xAA, 0x90, 0xA1, 0x51, 0x74, 0x0B, 0xF0, 0xA3, 0x74, 0x08, -+0xF0, 0x90, 0x9F, 0x19, 0xE0, 0xFC, 0x64, 0x02, 0x70, 0x15, 0x31, 0x1A, 0x30, 0xE2, 0x02, 0x7E, -+0x01, 0xEE, 0x12, 0x77, 0x8D, 0xFE, 0x90, 0xA1, 0x53, 0xE0, 0x54, 0xBF, 0x4E, 0xF0, 0x22, 0xEC, -+0x64, 0x01, 0x70, 0x09, 0x11, 0xB1, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, 0x0F, 0x90, 0x9F, 0x19, -+0xE0, 0x64, 0x03, 0x70, 0x14, 0x11, 0xAA, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0xEF, 0x12, 0x77, 0x8D, -+0xFF, 0x90, 0xA1, 0x53, 0xE0, 0x54, 0xBF, 0x4F, 0xF0, 0x22, 0x90, 0xFD, 0x80, 0xE0, 0x7E, 0x00, -+0x22, 0x31, 0x33, 0x51, 0x32, 0x12, 0x65, 0x8B, 0x31, 0xD7, 0x12, 0x58, 0xE9, 0x31, 0xD2, 0x51, -+0x40, 0x01, 0x02, 0xE4, 0xFD, 0xFF, 0x51, 0x0C, 0xED, 0x70, 0x12, 0x31, 0x71, 0xC0, 0x83, 0xC0, -+0x82, 0x31, 0x69, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0x80, 0x0F, 0x31, 0x71, 0xC0, -+0x83, 0xC0, 0x82, 0x31, 0x69, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0xD0, 0x82, 0xD0, 0x83, -+0xF0, 0x31, 0x7C, 0x90, 0xA0, 0xD4, 0xEF, 0xF0, 0x22, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x07, 0x08, -+0x22, 0x74, 0xC4, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x7D, 0x10, 0xED, 0x14, 0xF9, 0x24, 0xC4, 0x31, 0x74, 0xE0, 0x60, 0x3A, 0x7C, -+0x08, 0xEC, 0x14, 0x90, 0xA4, 0x0E, 0xF0, 0x74, 0xC4, 0x29, 0x31, 0x74, 0xE0, 0xFB, 0x7A, 0x00, -+0x90, 0xA4, 0x0E, 0xE0, 0x51, 0x58, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -+0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x0F, 0xE9, 0x75, 0xF0, 0x08, 0xA4, 0xFF, 0x90, 0xA4, -+0x0E, 0xE0, 0x2F, 0x04, 0xFF, 0x80, 0x06, 0xDC, 0xC8, 0xDD, 0xBA, 0x7F, 0x00, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x51, 0x25, 0x02, 0x08, 0xAA, 0x7E, 0x00, 0x7F, 0x01, 0x7D, 0x00, 0x7B, 0x01, 0x7A, -+0xA0, 0x79, 0xD5, 0x12, 0x08, 0xAA, 0x90, 0xA0, 0xD5, 0xE0, 0x54, 0xFD, 0xF0, 0xE4, 0x12, 0x58, -+0x8D, 0xA3, 0x74, 0x0C, 0xF0, 0x90, 0xA2, 0x28, 0xE0, 0x54, 0xDF, 0x51, 0x01, 0x54, 0xE0, 0xF0, -+0x22, 0xF0, 0x90, 0xA2, 0x27, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x22, 0xEF, 0x13, 0x13, 0x13, -+0x54, 0x1F, 0xFE, 0xEF, 0x54, 0x07, 0xFF, 0x22, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0x90, -+0xA1, 0x8A, 0x02, 0x08, 0x6D, 0x7E, 0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA1, 0x79, -+0x43, 0x22, 0xE4, 0x90, 0xA0, 0xBF, 0xF0, 0xA3, 0xF0, 0x90, 0xA0, 0x27, 0xF0, 0xA3, 0xF0, 0x22, -+0x7E, 0x00, 0x7F, 0x7F, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0xB3, 0x02, 0x08, 0xAA, 0xE0, -+0xF5, 0x82, 0x75, 0x83, 0x00, 0xED, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, -+0x22, 0x8D, 0x1B, 0xAC, 0x07, 0x71, 0x8D, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x75, 0xF0, 0x10, 0xEC, -+0x12, 0x73, 0xFC, 0xE0, 0xFB, 0x54, 0x7F, 0xF5, 0x1C, 0xEB, 0x54, 0x80, 0xF5, 0x1D, 0x75, 0xF0, -+0x04, 0xEC, 0x12, 0x6F, 0xE1, 0xE0, 0xF5, 0x1F, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0x66, 0xFE, 0xC4, -+0x54, 0x03, 0xF5, 0x20, 0xE5, 0x1C, 0xF1, 0xCD, 0xB1, 0x64, 0xEC, 0xB1, 0x49, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x74, 0x12, 0x2C, 0x71, 0x99, 0xEB, 0xF0, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0x66, 0xFE, -+0x13, 0x13, 0x54, 0x03, 0xF5, 0x1E, 0x74, 0x12, 0x2C, 0xF1, 0x7F, 0xE5, 0x1E, 0xF0, 0xE5, 0x1C, -+0x64, 0x2D, 0x70, 0x2B, 0x75, 0xF0, 0x04, 0xEC, 0x12, 0x66, 0xFE, 0xFF, 0x54, 0x03, 0xFE, 0xE5, -+0x1E, 0xC3, 0x9E, 0x50, 0x1A, 0x7B, 0x2C, 0x05, 0x1E, 0xE5, 0x1E, 0xF1, 0x78, 0xFE, 0x75, 0xF0, -+0x04, 0xEC, 0x90, 0x96, 0x14, 0x12, 0x47, 0xDE, 0xEF, 0x54, 0xF3, 0x4E, 0xF0, 0x61, 0x80, 0xE5, -+0x1C, 0xB4, 0x2C, 0x04, 0x7B, 0x2D, 0x61, 0x80, 0xE5, 0x1C, 0xC3, 0x95, 0x1F, 0x50, 0x59, 0xAD, -+0x1C, 0xAF, 0x20, 0xB1, 0x21, 0x8F, 0x1C, 0xAD, 0x1F, 0xAF, 0x20, 0xB1, 0x21, 0x8F, 0x1F, 0xE5, -+0x1C, 0x04, 0xFD, 0xED, 0xD3, 0x95, 0x1F, 0x50, 0x22, 0xED, 0xF1, 0x87, 0x75, 0xF0, 0x08, 0xEC, -+0x12, 0x73, 0xCA, 0x51, 0x4F, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xF1, 0x8E, -+0x60, 0x06, 0x8D, 0x1C, 0xAB, 0x1C, 0x80, 0x03, 0x0D, 0x80, 0xD8, 0xAD, 0x03, 0xAF, 0x20, 0xB1, -+0x35, 0xAB, 0x07, 0x71, 0x8D, 0xF5, 0x83, 0xE0, 0xFD, 0xF4, 0x60, 0x34, 0xAF, 0x20, 0xB1, 0x35, -+0x71, 0x8D, 0xF5, 0x83, 0xEF, 0xF0, 0x80, 0x28, 0xE5, 0x1C, 0x65, 0x1F, 0x70, 0x19, 0x75, 0xF0, -+0x04, 0xEC, 0x12, 0x6E, 0x46, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x20, 0xEB, 0x20, 0xE7, 0x1C, -+0xE5, 0x1C, 0x44, 0x80, 0xFB, 0x80, 0x09, 0x74, 0x12, 0x2C, 0x71, 0x99, 0xE5, 0x1F, 0xF0, 0xFB, -+0xAF, 0x04, 0xAD, 0x03, 0x85, 0x1E, 0x73, 0xAB, 0x1B, 0x12, 0x75, 0xED, 0x22, 0x74, 0x92, 0x2C, -+0xF5, 0x82, 0xE4, 0x34, 0x9B, 0x22, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, -+0x22, 0xE4, 0xFB, 0x7D, 0x01, 0xAF, 0x0F, 0x90, 0xA2, 0xCF, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0xAA, -+0x07, 0x75, 0xF0, 0x10, 0xEA, 0x12, 0x73, 0xFC, 0xE0, 0xF5, 0x1B, 0x54, 0x7F, 0xF5, 0x1D, 0x75, -+0xF0, 0x04, 0xEA, 0x12, 0x67, 0xE5, 0xE0, 0xF9, 0x75, 0xF0, 0x04, 0xEA, 0x12, 0x6F, 0xE1, 0xE0, -+0xFF, 0x75, 0xF0, 0x04, 0xEA, 0x12, 0x66, 0xFE, 0x13, 0x13, 0x54, 0x03, 0xF5, 0x1C, 0xE5, 0x1D, -+0x12, 0xBE, 0x67, 0xF1, 0xC3, 0x93, 0xFD, 0xEA, 0xB1, 0x49, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x75, -+0xF0, 0x04, 0xEA, 0x12, 0x66, 0xFE, 0xFE, 0xC4, 0x54, 0x03, 0x90, 0xA2, 0xD1, 0xF0, 0x74, 0x12, -+0x2A, 0x71, 0x99, 0xE5, 0x1D, 0xF0, 0x74, 0x12, 0x2A, 0xF1, 0x7F, 0xE5, 0x1C, 0xF0, 0xE5, 0x1D, -+0xD3, 0x9F, 0x40, 0x04, 0x8F, 0x1D, 0x8F, 0x1B, 0x90, 0xA2, 0xCF, 0xE0, 0xFF, 0x70, 0x02, 0xA1, -+0x15, 0x8F, 0x1E, 0xE5, 0x1B, 0x30, 0xE7, 0x05, 0x85, 0x1D, 0x1B, 0x15, 0x1E, 0xE5, 0x1E, 0x70, -+0x02, 0xA1, 0x15, 0xAF, 0x02, 0xAD, 0x1B, 0xF1, 0x98, 0xEF, 0xF4, 0x60, 0x0A, 0x8F, 0x1B, 0x15, -+0x1E, 0xE5, 0x1E, 0x70, 0x02, 0xA1, 0x15, 0xE5, 0x1B, 0x64, 0x2C, 0x70, 0x28, 0xE5, 0x1C, 0xD3, -+0x94, 0x00, 0x40, 0x21, 0xE5, 0x1C, 0xD3, 0x94, 0x02, 0x50, 0x1A, 0x15, 0x1C, 0x75, 0x1B, 0x2D, -+0xE5, 0x1C, 0xF1, 0x78, 0xFF, 0x75, 0xF0, 0x04, 0xEA, 0x12, 0x66, 0xFE, 0x54, 0xF3, 0x4F, 0xF0, -+0xD5, 0x1E, 0x19, 0xA1, 0x15, 0xE5, 0x1B, 0xB4, 0x2D, 0x12, 0xE5, 0x1C, 0xD3, 0x94, 0x02, 0x50, -+0x0B, 0x75, 0x1B, 0x2C, 0x15, 0x1E, 0xE5, 0x1E, 0x70, 0x02, 0xA1, 0x15, 0xE5, 0x1E, 0x70, 0x02, -+0xA1, 0x15, 0xE5, 0x1D, 0xD3, 0x99, 0x40, 0x79, 0xE4, 0x90, 0xA2, 0xD2, 0xF0, 0x90, 0xA2, 0xD1, -+0xE0, 0xFF, 0xAD, 0x1D, 0xB1, 0x21, 0x8F, 0x1D, 0x85, 0x1D, 0x1B, 0xE0, 0xFF, 0xAD, 0x01, 0xB1, -+0x21, 0xA9, 0x07, 0x90, 0xA2, 0xD3, 0xE5, 0x1B, 0xF0, 0xE5, 0x1D, 0x14, 0xFD, 0xED, 0xC3, 0x99, -+0x40, 0x3C, 0xED, 0xF1, 0x87, 0x75, 0xF0, 0x08, 0xEA, 0x12, 0x73, 0xCA, 0x51, 0x4F, 0x80, 0x05, -+0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xF1, 0x8E, 0x60, 0x20, 0xE5, 0x1D, 0x90, 0xA2, 0xD3, -+0xB4, 0x14, 0x05, 0x74, 0x0C, 0xF0, 0x80, 0x02, 0xED, 0xF0, 0x90, 0xA2, 0xD2, 0xE0, 0x04, 0xF0, -+0xE0, 0x65, 0x1E, 0x60, 0x09, 0xA3, 0xE0, 0xD3, 0x99, 0x40, 0x03, 0x1D, 0x80, 0xBF, 0x90, 0xA2, -+0xD3, 0xE0, 0xF5, 0x1B, 0x90, 0xA2, 0xD1, 0xE0, 0xFF, 0xAD, 0x1B, 0xB1, 0x35, 0x8F, 0x1B, 0x80, -+0x04, 0xAF, 0x01, 0x8F, 0x1B, 0xAF, 0x02, 0x85, 0x1C, 0x73, 0xE4, 0xFB, 0xAD, 0x1B, 0x02, 0x75, -+0xED, 0xEF, 0x60, 0x0A, 0xED, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0x7E, 0x20, 0x80, 0x02, 0xE4, 0xFE, -+0xC3, 0xED, 0x9E, 0xFF, 0x22, 0xEF, 0x60, 0x0A, 0xED, 0xD3, 0x94, 0x0B, 0x40, 0x04, 0x7E, 0x20, -+0x80, 0x02, 0xE4, 0xFE, 0xED, 0x2E, 0xFF, 0x22, 0xE0, 0x25, 0xE0, 0x24, 0x91, 0xF5, 0x82, 0xE4, -+0x34, 0x94, 0xF5, 0x83, 0x22, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1E, 0xA4, 0x24, 0x6F, 0xF5, -+0x82, 0xE4, 0x34, 0x44, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x7A, 0xEF, 0xF0, 0x90, 0xA3, 0x25, 0x12, 0x08, 0x79, -+0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x12, 0x4C, -+0x58, 0xD1, 0x3A, 0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0xB1, 0x64, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x80, 0xD0, 0x07, 0xD0, 0x06, 0xD1, 0x37, -+0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0xB1, 0x64, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, -+0x12, 0x08, 0x79, 0x20, 0x04, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0xD1, 0x37, 0x24, 0x77, 0xF5, -+0x82, 0xE4, 0x34, 0x44, 0xB1, 0x64, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x79, -+0x20, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0xD1, 0x37, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, -+0x44, 0xB1, 0x64, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x25, 0x12, 0x08, 0x79, 0x00, 0x00, 0x07, -+0xFF, 0x90, 0xA3, 0x7F, 0xF1, 0x2E, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x4C, 0x5C, 0xD1, 0x3A, 0x24, -+0x7B, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0xB1, 0x64, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x25, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x07, 0xFF, 0x90, 0xA3, 0x7B, 0xF1, 0x2E, 0xD0, 0x07, 0xD0, 0x06, 0x12, -+0x4C, 0x5C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x38, 0x07, 0x90, 0xA3, 0x7A, 0xE0, 0x75, 0xF0, -+0x1E, 0xA4, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x71, 0xEF, 0xF0, 0x90, -+0xA3, 0x25, 0x12, 0x08, 0x79, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, -+0x00, 0x00, 0x00, 0x12, 0x4C, 0x58, 0xF1, 0x23, 0xE4, 0x7B, 0x12, 0x7A, 0x01, 0xF9, 0xF8, 0xD3, -+0x12, 0x47, 0xB5, 0x40, 0x2D, 0xF1, 0x23, 0xE4, 0x7B, 0xEE, 0x1A, 0xF8, 0xC3, 0x12, 0x47, 0xB5, -+0x50, 0x20, 0x90, 0xA3, 0x76, 0xF1, 0x26, 0xE4, 0x7B, 0x12, 0xF8, 0xD3, 0x12, 0x47, 0xB5, 0x50, -+0x4E, 0x90, 0xA3, 0x76, 0xF1, 0x26, 0xE4, 0x7B, 0xEE, 0x7A, 0x03, 0xF8, 0xC3, 0x12, 0x47, 0xB5, -+0x40, 0x3D, 0xB1, 0x55, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x25, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x03, 0xFF, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, 0x00, 0x01, 0x00, 0xD0, 0x07, 0xD0, 0x06, -+0x12, 0x4C, 0x5C, 0xB1, 0x55, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x25, 0x12, 0x08, 0x79, 0x03, -+0xFF, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x80, 0x38, 0xB1, -+0x55, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x25, 0x12, 0x08, 0x79, 0x00, 0x00, 0x03, 0xFF, 0xF1, -+0x23, 0xF1, 0x31, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x4C, 0x5C, 0xB1, 0x55, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0xA3, 0x25, 0x12, 0x08, 0x79, 0x03, 0xFF, 0x00, 0x00, 0x90, 0xA3, 0x76, 0x12, 0x47, 0xC6, -+0x78, 0x0F, 0x12, 0x08, 0x5A, 0xF1, 0x31, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x4C, 0x5C, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0xA3, 0x72, 0x12, 0x47, 0xC6, 0x78, 0x01, 0x02, 0x08, 0x47, 0x12, 0x47, -+0xC6, 0x90, 0xA3, 0x29, 0x02, 0x08, 0x6D, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x66, 0xFE, 0xF9, 0x12, -+0x6F, 0xDD, 0xE0, 0xFC, 0x71, 0x96, 0xE0, 0x54, 0x7F, 0xFD, 0x74, 0x12, 0x2F, 0xF1, 0x7F, 0xE0, -+0xFE, 0xF1, 0x78, 0xFB, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x14, 0x12, 0x47, 0xDE, 0xE9, 0x54, -+0xF3, 0x4B, 0xF0, 0xED, 0xD3, 0x9C, 0x40, 0x02, 0xAD, 0x04, 0x71, 0x96, 0xE0, 0x54, 0x80, 0x42, -+0x05, 0x8E, 0x73, 0xE4, 0xFB, 0x02, 0x75, 0xED, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0x22, 0xF5, -+0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x22, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0x22, 0xFF, 0xEE, -+0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, 0x22, 0x7E, 0xFF, 0xED, 0xC3, 0x94, 0x33, 0x40, 0x19, -+0xED, 0xD3, 0x94, 0x35, 0x50, 0x13, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x6E, 0x46, 0xC4, 0x13, 0x54, -+0x07, 0x30, 0xE0, 0x05, 0xED, 0x14, 0x44, 0x80, 0xFE, 0xED, 0x14, 0xFD, 0x71, 0x96, 0xED, 0xF0, -+0xAF, 0x06, 0x22, 0xF5, 0x83, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x22, 0xE5, 0x11, 0x25, 0xE0, 0x24, -+0xB3, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x22, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x9C, 0x12, 0xA5, 0x6E, -+0xB4, 0x02, 0x19, 0x90, 0xA3, 0xE7, 0xE0, 0x64, 0x04, 0x60, 0x0C, 0x7F, 0x40, 0x12, 0x6F, 0x67, -+0x90, 0xA3, 0xE7, 0xE0, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0xA3, 0xE7, 0xF0, 0x22, 0x90, 0xA2, 0xC4, -+0x74, 0x0A, 0xF0, 0x90, 0xA2, 0xD2, 0x74, 0x06, 0xF0, 0x12, 0x06, 0x89, 0x90, 0xA2, 0xC6, 0x12, -+0x67, 0x95, 0x90, 0xA2, 0xC7, 0x12, 0x67, 0x06, 0x90, 0xA2, 0xC8, 0xF0, 0x12, 0x64, 0xE2, 0x11, -+0xCB, 0x90, 0xA2, 0xCA, 0x12, 0x62, 0x12, 0x90, 0xA2, 0xCB, 0x12, 0x6E, 0xBA, 0x02, 0x78, 0x06, -+0x12, 0x06, 0x89, 0xF5, 0x0F, 0x12, 0x67, 0x96, 0xF5, 0x12, 0x12, 0x67, 0x07, 0xF5, 0x13, 0x12, -+0x64, 0xE2, 0xF5, 0x14, 0x11, 0xCF, 0xF5, 0x15, 0x12, 0x62, 0x13, 0xF5, 0x16, 0x12, 0x7A, 0x79, -+0xF5, 0x17, 0xE5, 0x0F, 0x12, 0x47, 0xFC, 0xA0, 0x70, 0x00, 0xA0, 0x78, 0x01, 0xA0, 0x80, 0x02, -+0xA0, 0x88, 0x03, 0xA0, 0x90, 0x04, 0xA0, 0x98, 0x05, 0xA0, 0xA1, 0x06, 0x00, 0x00, 0xA0, 0xB8, -+0x75, 0x10, 0x02, 0x75, 0x11, 0x29, 0x80, 0x46, 0x75, 0x10, 0x06, 0x75, 0x11, 0x2A, 0x80, 0x3E, -+0x75, 0x10, 0x01, 0x75, 0x11, 0x31, 0x80, 0x36, 0x75, 0x10, 0x01, 0x75, 0x11, 0x32, 0x80, 0x2E, -+0x75, 0x10, 0x06, 0x75, 0x11, 0x33, 0x80, 0x26, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x12, 0x02, 0x9F, -+0xFD, 0x90, 0xA1, 0x94, 0xE5, 0x12, 0xF0, 0xA3, 0xE5, 0x13, 0xF0, 0xA3, 0xE5, 0x14, 0xF0, 0xA3, -+0xE5, 0x15, 0xF0, 0xA3, 0xE5, 0x16, 0xF0, 0x22, 0x75, 0x10, 0x01, 0x75, 0x11, 0xFF, 0x7B, 0x00, -+0x7A, 0x00, 0x79, 0x12, 0xAD, 0x10, 0xAF, 0x11, 0x02, 0x7F, 0x4A, 0x90, 0xA2, 0xC9, 0xF0, 0x90, -+0x00, 0x04, 0x02, 0x06, 0xA2, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x06, 0x89, 0x90, -+0xA2, 0xC4, 0x12, 0x67, 0x95, 0x90, 0xA2, 0xC5, 0x12, 0x67, 0x06, 0x90, 0xA2, 0xC6, 0xF0, 0x12, -+0x64, 0xE2, 0x90, 0xA2, 0xC7, 0x11, 0xCE, 0x90, 0xA2, 0xC8, 0x12, 0x91, 0x81, 0x90, 0xA1, 0x78, -+0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA2, 0xC5, 0xE0, 0xB4, 0x0C, 0x06, 0xE5, 0x27, 0x70, 0x0E, 0x80, -+0x00, 0x12, 0x6E, 0xBB, 0x7D, 0x07, 0x7F, 0x30, 0x12, 0x7F, 0x4A, 0x8F, 0x0F, 0x90, 0xA2, 0xC5, -+0xE0, 0xB4, 0x0D, 0x0E, 0xE5, 0x0F, 0x64, 0x01, 0x60, 0x05, 0x75, 0x27, 0x01, 0x80, 0x03, 0xE4, -+0xF5, 0x27, 0xE5, 0x0F, 0xB4, 0x01, 0x05, 0x75, 0x10, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x10, 0x90, -+0xA2, 0xC4, 0xE0, 0xFB, 0xAD, 0x10, 0xE4, 0xFF, 0xF1, 0xA1, 0x7F, 0x04, 0x12, 0x6F, 0x67, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xF3, 0x90, 0xA2, 0xC0, 0xEF, 0xF0, 0x12, -+0x47, 0xFC, 0xA1, 0xCF, 0x00, 0xA1, 0xD7, 0x01, 0xA1, 0xE0, 0x10, 0xA1, 0xE8, 0x12, 0xA1, 0xF0, -+0x14, 0xA2, 0xFB, 0x15, 0xA1, 0xF8, 0x16, 0xA2, 0x00, 0x18, 0xA2, 0x09, 0x19, 0xA2, 0x11, 0x1A, -+0xA2, 0x1A, 0x20, 0xA2, 0x23, 0x24, 0xA2, 0x2C, 0x25, 0xA2, 0x34, 0x27, 0xA2, 0x3C, 0x28, 0xA2, -+0x44, 0x40, 0xA2, 0x4D, 0x42, 0xA2, 0x56, 0x47, 0xA2, 0x5F, 0x49, 0xA2, 0x67, 0x60, 0xA2, 0x70, -+0x61, 0xA2, 0x78, 0x62, 0xA2, 0x81, 0x63, 0xA2, 0x89, 0x64, 0xA2, 0x92, 0x65, 0xA2, 0x9A, 0x66, -+0xA2, 0xA2, 0x67, 0xA2, 0xAA, 0x68, 0xA2, 0xB2, 0x69, 0xA2, 0xBA, 0x6B, 0xA2, 0xC3, 0x6C, 0xA2, -+0xCB, 0x6D, 0xA2, 0xD4, 0x6E, 0xA2, 0xDC, 0x6F, 0xA2, 0xE4, 0x70, 0x00, 0x00, 0xA2, 0xEC, 0x90, -+0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x81, 0xCB, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x02, 0x5F, 0x38, -+0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x61, 0xDF, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0xA1, 0xB5, -+0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0xA1, 0xA6, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x61, 0xB9, -+0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x02, 0x78, 0xC7, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0xE1, -+0x6D, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x02, 0x67, 0x0D, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, -+0x02, 0x61, 0x39, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x02, 0x5B, 0xD8, 0x90, 0xA2, 0xC1, 0x12, -+0x47, 0xEA, 0x81, 0x95, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x41, 0xFC, 0x90, 0xA2, 0xC1, 0x12, -+0x47, 0xEA, 0x61, 0x1C, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x02, 0x74, 0x02, 0x90, 0xA2, 0xC1, -+0x12, 0x47, 0xEA, 0x02, 0x64, 0xE8, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x02, 0x67, 0x9C, 0x90, -+0xA2, 0xC1, 0x12, 0x47, 0xEA, 0xA1, 0xFD, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x02, 0x62, 0xCF, -+0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0xC1, 0x1B, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x02, 0x7F, -+0xA5, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0xA1, 0x8A, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x02, -+0xAD, 0x91, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0xA1, 0x98, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, -+0x81, 0x6A, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x01, 0xD5, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, -+0xA1, 0xC9, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x01, 0x30, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, -+0x02, 0x91, 0x88, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0xA1, 0xE3, 0x90, 0xA2, 0xC1, 0x12, 0x47, -+0xEA, 0x02, 0x8A, 0x66, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0xE1, 0x40, 0x90, 0xA2, 0xC1, 0x12, -+0x47, 0xEA, 0xC1, 0x3B, 0x90, 0xA2, 0xC1, 0x12, 0x47, 0xEA, 0x80, 0x5D, 0x90, 0x01, 0xC0, 0xE0, -+0x44, 0x01, 0xF0, 0x90, 0xA2, 0xC0, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x71, 0x41, 0x90, 0xA1, -+0x43, 0x71, 0xAB, 0x12, 0x67, 0x94, 0x90, 0xA1, 0x44, 0x12, 0x67, 0x06, 0x90, 0xA1, 0x45, 0xF0, -+0xB1, 0x80, 0x90, 0xA1, 0x43, 0xE0, 0x54, 0x01, 0xFF, 0x02, 0x5A, 0x70, 0x71, 0x41, 0x90, 0xA1, -+0x47, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0x54, 0x02, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, -+0xA0, 0xDA, 0xE0, 0x54, 0xEF, 0x4F, 0xF0, 0x90, 0xA1, 0x47, 0xE0, 0x54, 0x01, 0xFF, 0x02, 0x58, -+0x94, 0x12, 0x06, 0x89, 0xFF, 0x54, 0x01, 0xFE, 0x22, 0x71, 0x41, 0x90, 0xA1, 0xB1, 0x71, 0xAB, -+0x4F, 0xF0, 0x30, 0xE0, 0x55, 0x90, 0x00, 0x40, 0xE0, 0x54, 0xBF, 0x44, 0xA0, 0xFD, 0x7F, 0x40, -+0x12, 0x48, 0xCF, 0x90, 0x00, 0x41, 0xE0, 0x44, 0x04, 0xFD, 0x7F, 0x41, 0x12, 0x48, 0xCF, 0x90, -+0x00, 0x6A, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x6A, 0x12, 0x48, 0xCF, 0x90, 0x07, 0x6E, 0x74, 0x55, -+0xF0, 0xA3, 0x74, 0x12, 0xF0, 0x90, 0x07, 0x78, 0xE0, 0x54, 0xF2, 0x44, 0x02, 0xF0, 0x90, 0x06, -+0xCC, 0xE0, 0x44, 0x03, 0xF0, 0x90, 0x07, 0x65, 0xE0, 0x54, 0xF5, 0xF0, 0x90, 0x05, 0x23, 0xE0, -+0x54, 0x7F, 0xF0, 0xE4, 0xFD, 0x7F, 0x66, 0x12, 0x48, 0xCF, 0x22, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, -+0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x22, 0x12, 0x7F, 0xC1, 0x90, 0xA1, 0xBB, 0x12, -+0x67, 0x95, 0x90, 0xA1, 0xBC, 0x12, 0x67, 0x06, 0x90, 0xA1, 0xCE, 0xF0, 0x12, 0x64, 0xE2, 0x90, -+0xA1, 0xCF, 0x11, 0xCE, 0x90, 0xA1, 0xE1, 0x12, 0x62, 0x12, 0x90, 0xA1, 0xE2, 0xF0, 0x22, 0x12, -+0x67, 0xEB, 0x90, 0x04, 0x24, 0xE0, 0xF5, 0x0F, 0xE4, 0xFF, 0x12, 0x62, 0xC9, 0x8F, 0x82, 0x91, -+0x0E, 0x25, 0x0F, 0xFE, 0x75, 0xF0, 0x13, 0xEF, 0x90, 0xA1, 0xBF, 0x12, 0x47, 0xDE, 0xEE, 0xF0, -+0x0F, 0xEF, 0xB4, 0x03, 0xE5, 0x22, 0x90, 0xA3, 0xEA, 0x12, 0x47, 0xEA, 0x8E, 0x82, 0x75, 0x83, -+0x00, 0x02, 0x06, 0xA2, 0x90, 0xA3, 0xEA, 0x12, 0x47, 0xF3, 0xE4, 0xFE, 0x90, 0xFD, 0x50, 0xEF, -+0xF0, 0x64, 0x30, 0x60, 0x23, 0xA3, 0xED, 0xF0, 0xEE, 0xC3, 0x9D, 0x50, 0x0C, 0x91, 0x06, 0xFF, -+0x74, 0x52, 0x91, 0x61, 0xEF, 0xF0, 0x0E, 0x80, 0xEF, 0xEE, 0xC3, 0x94, 0x06, 0x50, 0x1B, 0x74, -+0x52, 0x91, 0x61, 0xE4, 0xF0, 0x0E, 0x80, 0xF1, 0xEE, 0xC3, 0x94, 0x07, 0x50, 0x0C, 0x91, 0x06, -+0xFF, 0x74, 0x51, 0x91, 0x61, 0xEF, 0xF0, 0x0E, 0x80, 0xEE, 0x90, 0xFD, 0x58, 0x74, 0x01, 0xF0, -+0x22, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFD, 0xF5, 0x83, 0x22, 0x12, 0x62, 0xC3, 0x12, 0x06, 0x89, -+0x90, 0xA1, 0x9C, 0x12, 0x67, 0x95, 0x90, 0xA1, 0x9D, 0x12, 0x67, 0x06, 0x90, 0xA1, 0x9E, 0xF0, -+0x90, 0xA1, 0x78, 0xE0, 0x44, 0x01, 0xF0, 0x12, 0x62, 0xC9, 0xB1, 0x6E, 0xB4, 0x02, 0x05, 0x7F, -+0x40, 0x12, 0x6F, 0x67, 0x22, 0x12, 0x06, 0x89, 0x90, 0xA1, 0x42, 0xF0, 0x60, 0x2C, 0x90, 0xA1, -+0x50, 0xE0, 0x20, 0xE0, 0x25, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x51, 0x32, 0x12, 0x4F, 0xFB, 0x13, -+0x30, 0xE0, 0x17, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x0E, 0xB1, 0x77, 0x30, 0xE0, -+0x04, 0x7F, 0x0D, 0x80, 0x02, 0x7F, 0x09, 0x12, 0x8B, 0x4F, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xF5, -+0x0F, 0x12, 0x06, 0x89, 0x25, 0x0F, 0x90, 0x9F, 0xD0, 0x12, 0x67, 0x95, 0x25, 0x0F, 0x90, 0x9F, -+0xD1, 0x12, 0x67, 0x06, 0x25, 0x0F, 0x90, 0x9F, 0xD2, 0xF0, 0x12, 0x64, 0xE2, 0x25, 0x0F, 0x90, -+0x9F, 0xD3, 0x11, 0xCE, 0x25, 0x0F, 0x90, 0x9F, 0xD4, 0x12, 0x62, 0x12, 0x25, 0x0F, 0x90, 0x9F, -+0xD5, 0x12, 0x7A, 0x78, 0x25, 0x0F, 0x90, 0x9F, 0xD6, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0xA0, 0x28, 0xE0, 0xFF, 0x90, 0xA0, 0x27, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, -+0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x39, 0x90, 0xA0, 0x27, 0xE0, 0xFE, 0xB1, 0x65, 0xE0, 0xFD, -+0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0xD8, 0xF9, 0x74, 0x9F, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, -+0x05, 0x31, 0x54, 0x90, 0xA0, 0x27, 0x12, 0x7F, 0xAB, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, -+0x05, 0xE4, 0x90, 0xA0, 0x27, 0xF0, 0x12, 0x74, 0xD8, 0x90, 0x9F, 0x13, 0xE0, 0x44, 0x02, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x08, 0x90, 0x9F, 0xD7, 0x02, 0x47, 0xDE, 0x7D, 0x03, -+0x7F, 0x11, 0x12, 0x7F, 0x4A, 0xEF, 0x22, 0x90, 0xA1, 0x41, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x22, -+0x90, 0xA1, 0x44, 0xE0, 0x14, 0x90, 0xA1, 0x46, 0xF0, 0x22, 0x90, 0xA1, 0x78, 0xE0, 0x44, 0x10, -+0xF0, 0x7D, 0x01, 0x7F, 0x1B, 0x02, 0x7F, 0xDC, 0x12, 0x06, 0x89, 0x90, 0xA1, 0x92, 0x12, 0x67, -+0x95, 0x90, 0xA1, 0x93, 0xF0, 0x22, 0x12, 0x06, 0x89, 0x54, 0x01, 0xFF, 0x90, 0xA2, 0x32, 0xE0, -+0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x06, 0x89, 0xFF, 0x90, 0xA0, 0xC3, 0xF0, 0xBF, 0x01, 0x08, -+0x12, 0x6E, 0xC2, 0xE4, 0x90, 0xA0, 0xC3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA1, 0x79, 0xE0, 0x44, 0x01, 0xF0, 0x7D, 0x01, 0x7F, 0x28, 0x12, 0x7F, 0xDC, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x12, 0x62, 0xC3, 0x12, 0x06, 0x89, 0x90, 0xA1, 0xAF, 0x12, 0x67, 0x95, 0x90, -+0xA1, 0xB0, 0xF0, 0x12, 0x62, 0xC9, 0x7D, 0x02, 0x7F, 0x38, 0x02, 0x7F, 0x4A, 0x12, 0x67, 0x96, -+0xF5, 0x0F, 0x12, 0x67, 0x07, 0xF5, 0x10, 0x12, 0x06, 0x89, 0xF5, 0x11, 0x90, 0x9F, 0x1A, 0xF0, -+0xE5, 0x0F, 0x60, 0x06, 0xFD, 0xAF, 0x10, 0x12, 0x6D, 0x5C, 0x22, 0x90, 0xA1, 0x78, 0xE0, 0x44, -+0x04, 0xF0, 0x7D, 0x01, 0x7F, 0x23, 0x12, 0x7F, 0x4A, 0x8F, 0x0F, 0xE5, 0x0F, 0xB4, 0x03, 0x0A, -+0xE4, 0xFF, 0x12, 0x89, 0xD5, 0x7F, 0x04, 0x12, 0x6F, 0x67, 0x22, 0x12, 0x06, 0x89, 0x54, 0x01, -+0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0xA1, 0x75, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x12, 0x8C, -+0xFE, 0x90, 0x07, 0x65, 0x30, 0xE0, 0x04, 0x74, 0x18, 0xF0, 0x22, 0xE4, 0xF0, 0x22, 0x12, 0x4F, -+0xFB, 0x13, 0x30, 0xE0, 0x21, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x18, 0x12, 0x87, -+0xC6, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x0B, 0xB1, 0x77, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, -+0x02, 0x7F, 0x09, 0x12, 0x8B, 0x4F, 0x22, 0xE4, 0x90, 0xA2, 0xEE, 0xF0, 0x90, 0xA0, 0xDF, 0xE0, -+0x70, 0x02, 0xE1, 0x26, 0x12, 0x57, 0xE6, 0x60, 0x02, 0xE1, 0x26, 0xF1, 0x27, 0x12, 0x4F, 0xD8, -+0x12, 0x47, 0xA8, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0x4F, -+0xF2, 0x78, 0x10, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, -+0xA8, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x4F, 0xF2, 0x78, 0x18, 0x12, -+0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xF1, 0x37, 0x90, 0xA0, 0xDB, 0xE0, -+0x44, 0x80, 0x12, 0x8C, 0x0B, 0xE4, 0x90, 0xA0, 0xE6, 0xF0, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, -+0x16, 0x90, 0xA0, 0xD9, 0xE0, 0xB4, 0x02, 0x05, 0xE4, 0x90, 0xA2, 0xEE, 0xF0, 0x12, 0x5F, 0x13, -+0xEF, 0x70, 0x04, 0x90, 0xA2, 0xEE, 0xF0, 0x90, 0xA2, 0xEE, 0xE0, 0x60, 0x19, 0xF1, 0x2F, 0xE4, -+0x90, 0xA3, 0x9D, 0xF0, 0x90, 0xA0, 0xE7, 0x12, 0x50, 0x0E, 0x90, 0xA0, 0xE2, 0xE0, 0x20, 0xE2, -+0x03, 0x12, 0x51, 0x2E, 0xD1, 0x5E, 0x22, 0x90, 0xA0, 0xE5, 0xE0, 0x90, 0x05, 0x73, 0x22, 0x90, -+0xA0, 0xE3, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x12, 0x47, 0xA8, 0x90, 0xA1, 0x32, 0x02, 0x08, 0x6D, -+0x12, 0x06, 0x89, 0x54, 0x01, 0x25, 0xE0, 0x12, 0x8F, 0xDB, 0x54, 0xFB, 0x4F, 0xF0, 0xE0, 0x13, -+0x13, 0x54, 0x3F, 0x30, 0xE0, 0x08, 0x90, 0x07, 0x65, 0xE0, 0x44, 0x18, 0xF0, 0x22, 0x90, 0xA1, -+0x99, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x07, 0x65, 0xE0, 0x54, 0xE7, 0xF0, 0x22, 0x12, 0x7F, 0xC1, -+0xFF, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0xFE, 0x90, 0xA2, 0x28, 0xE0, 0x54, 0xDF, 0x4E, 0xF0, -+0xEF, 0x54, 0xFE, 0xC3, 0x13, 0xFF, 0x90, 0xA2, 0x27, 0xE0, 0x54, 0x80, 0x12, 0x67, 0x94, 0x90, -+0xA2, 0x29, 0x12, 0x67, 0x06, 0x90, 0xA2, 0x2A, 0xF0, 0x12, 0x64, 0xE2, 0x90, 0xA2, 0x2B, 0xF0, -+0x22, 0x90, 0xA3, 0x44, 0x74, 0x0B, 0xF0, 0x90, 0xA3, 0x52, 0x74, 0x07, 0xF0, 0x90, 0xA3, 0x46, -+0xEF, 0xF0, 0x60, 0x32, 0x90, 0xFD, 0x63, 0xE0, 0x90, 0xA3, 0x47, 0xF0, 0x90, 0xFD, 0x61, 0xE0, -+0x90, 0xA3, 0x48, 0xF0, 0x90, 0xFD, 0x64, 0xE0, 0x90, 0xA3, 0x49, 0xF0, 0x90, 0xFD, 0x65, 0xE0, -+0x90, 0xA3, 0x4A, 0xF0, 0x90, 0xFD, 0x66, 0xE0, 0x90, 0xA3, 0x4B, 0xF0, 0x90, 0xFD, 0x67, 0xE0, -+0x90, 0xA3, 0x4C, 0xF0, 0x80, 0x0D, 0x90, 0xA3, 0x47, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0xE4, 0xA3, -+0x12, 0x58, 0x8C, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x44, 0x02, 0x78, 0x06, 0x90, 0xA2, 0xEF, 0x71, -+0xAD, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x21, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA2, 0xF4, 0xF0, 0x7D, -+0x01, 0x12, 0x56, 0x2A, 0xEF, 0x64, 0x01, 0x70, 0x03, 0x12, 0x87, 0x11, 0x90, 0xA2, 0xF4, 0xE0, -+0xFF, 0x7D, 0x02, 0x12, 0x53, 0x36, 0x80, 0x03, 0x12, 0x87, 0x11, 0x90, 0x04, 0x1F, 0x74, 0x20, -+0xF0, 0x22, 0x90, 0xA2, 0xEE, 0xEF, 0xF0, 0x7F, 0x03, 0x12, 0x82, 0x88, 0x12, 0x87, 0xC6, 0x90, -+0xA1, 0x63, 0x30, 0xE0, 0x05, 0x74, 0x05, 0xF0, 0x80, 0x03, 0xE0, 0x04, 0xF0, 0x90, 0xA1, 0x54, -+0x12, 0x7A, 0x7F, 0x20, 0xE0, 0x09, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x38, 0x12, -+0x87, 0xC6, 0x30, 0xE0, 0x0A, 0x90, 0xA1, 0x51, 0xE0, 0xFF, 0x90, 0xA1, 0x61, 0x80, 0x21, 0x90, -+0xA2, 0xEE, 0xE0, 0xFC, 0xB4, 0x01, 0x0D, 0x90, 0xA1, 0x51, 0xE0, 0xFE, 0x90, 0xA1, 0x60, 0xE0, -+0xC3, 0x9E, 0x80, 0x0F, 0xEC, 0xB4, 0x04, 0x0F, 0x90, 0xA1, 0x52, 0xE0, 0xFF, 0x90, 0xA1, 0x60, -+0xE0, 0xC3, 0x9F, 0x90, 0xA1, 0x67, 0xF0, 0x71, 0x74, 0x30, 0xE0, 0x22, 0x71, 0x6D, 0x54, 0x07, -+0x20, 0xE0, 0x02, 0x21, 0x26, 0x71, 0x8E, 0x50, 0x0A, 0xEF, 0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xE4, -+0xFD, 0x80, 0x05, 0x7B, 0x7F, 0x7D, 0xFF, 0xE4, 0xFF, 0x12, 0xA7, 0xFC, 0x80, 0x68, 0x90, 0xA1, -+0x50, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x45, 0x71, 0x97, 0xFD, 0x7F, 0x04, 0x12, 0x51, 0x32, -+0x12, 0x84, 0x41, 0x30, 0xE0, 0x37, 0x12, 0x87, 0x9F, 0xF0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA1, -+0x66, 0xF0, 0x90, 0xA1, 0x63, 0xF0, 0x90, 0xA2, 0xEE, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0xA1, -+0x58, 0x74, 0x06, 0xF0, 0x80, 0x0A, 0xEF, 0xB4, 0x04, 0x06, 0x90, 0xA1, 0x58, 0x74, 0x07, 0xF0, -+0x90, 0xA1, 0x42, 0xE0, 0x60, 0x07, 0x90, 0xA1, 0x57, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0xA2, 0xEE, -+0xE0, 0xB4, 0x01, 0x04, 0x7D, 0x06, 0x80, 0x09, 0x90, 0xA2, 0xEE, 0xE0, 0xB4, 0x04, 0x07, 0x7D, -+0x0C, 0x7F, 0x6F, 0x12, 0x53, 0x36, 0x90, 0xA1, 0x54, 0x12, 0x8C, 0xFE, 0x30, 0xE0, 0x24, 0x90, -+0xA1, 0x67, 0xE0, 0xFE, 0xC3, 0x94, 0x20, 0x50, 0x0F, 0xEE, 0x7D, 0x00, 0x25, 0xE0, 0x25, 0xE0, -+0xFC, 0x90, 0x9F, 0xD5, 0xE0, 0xFF, 0x80, 0x09, 0x90, 0x9F, 0xD5, 0xE0, 0xFF, 0x7D, 0xFF, 0x7C, -+0x7F, 0x31, 0x9C, 0x90, 0xA1, 0x53, 0xE0, 0x30, 0xE0, 0x03, 0x12, 0x57, 0xE1, 0x22, 0x90, 0xA1, -+0x50, 0xE0, 0x30, 0xE0, 0x36, 0x12, 0x82, 0x9F, 0x90, 0xA1, 0x63, 0xE0, 0xFF, 0xB4, 0x01, 0x02, -+0x80, 0x1D, 0x90, 0xA1, 0x63, 0xE0, 0xFF, 0xB4, 0x02, 0x02, 0x80, 0x1D, 0x90, 0xA1, 0x63, 0xE0, -+0xFF, 0xB4, 0x03, 0x03, 0x02, 0x80, 0xD3, 0x90, 0xA1, 0x63, 0xE0, 0xFF, 0xB4, 0x04, 0x02, 0x01, -+0x32, 0x90, 0xA1, 0x63, 0xE0, 0xFF, 0xB4, 0x05, 0x02, 0x51, 0x3B, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0xF1, 0xEF, 0xF0, 0xA3, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x04, -+0x1D, 0xE0, 0x60, 0x1E, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA2, 0xF6, 0xF0, 0x7D, 0x36, 0x12, 0x56, -+0x2A, 0xBF, 0x01, 0x02, 0x31, 0xE6, 0x90, 0xA2, 0xF6, 0xE0, 0xFF, 0x7D, 0x37, 0x12, 0x53, 0x36, -+0x80, 0x02, 0x31, 0xE6, 0x71, 0x7D, 0x7D, 0x38, 0x12, 0x53, 0x36, 0x90, 0x04, 0x1F, 0x74, 0x20, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0xF1, 0xE0, 0xFF, 0x90, 0xA3, 0xD6, 0x74, 0x0C, -+0xF0, 0xE4, 0xFB, 0x7D, 0x01, 0x12, 0x85, 0x3D, 0x90, 0xA2, 0xF4, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0x90, 0xA2, 0xF2, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAB, -+0x07, 0x90, 0xA2, 0xF7, 0xED, 0xF0, 0xEC, 0xF9, 0xE0, 0xFF, 0xAE, 0x03, 0x74, 0x2A, 0x2E, 0x71, -+0xA0, 0x74, 0x2B, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE9, 0xF0, 0x74, 0x0D, 0x2E, -+0x12, 0x87, 0x96, 0x44, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0xEE, 0xEF, 0xF0, -+0x90, 0xA2, 0xF0, 0x74, 0x02, 0xF0, 0x7F, 0x01, 0x12, 0x8D, 0x4E, 0x90, 0xA1, 0x54, 0x12, 0x77, -+0xBB, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x8B, 0x4F, 0x90, 0xA2, 0xEE, -+0xE0, 0xB4, 0x02, 0x11, 0x90, 0xA1, 0x51, 0xE0, 0x24, 0x03, 0xFF, 0x90, 0xA1, 0x60, 0xE0, 0xC3, -+0x9F, 0xFF, 0x12, 0x82, 0x88, 0x90, 0xA1, 0x50, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xE4, 0x90, -+0xA2, 0xEF, 0xF0, 0x80, 0x06, 0x90, 0xA2, 0xEF, 0x74, 0x01, 0xF0, 0x71, 0x85, 0x20, 0xE0, 0x13, -+0x90, 0xA1, 0x92, 0xE0, 0x60, 0x08, 0x90, 0xA2, 0xF0, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, -+0xA2, 0xF0, 0xF0, 0x90, 0xA2, 0xF0, 0xE0, 0xFF, 0x90, 0xA2, 0xEF, 0xE0, 0xFD, 0x12, 0x62, 0x1E, -+0xE4, 0x90, 0xA1, 0x62, 0xF0, 0x90, 0xA2, 0xEE, 0xE0, 0xFF, 0xB4, 0x02, 0x08, 0x90, 0xA1, 0x63, -+0xE0, 0x04, 0xF0, 0x80, 0x09, 0xEF, 0xB4, 0x05, 0x05, 0xE4, 0x90, 0xA1, 0x63, 0xF0, 0x71, 0x74, -+0x30, 0xE0, 0x17, 0x90, 0xA2, 0xEE, 0xE0, 0xB4, 0x02, 0x04, 0x7D, 0x08, 0x80, 0x58, 0x90, 0xA2, -+0xEE, 0xE0, 0x64, 0x05, 0x70, 0x55, 0x7D, 0x0E, 0x80, 0x4C, 0x90, 0xA1, 0x50, 0xE0, 0xC4, 0x54, -+0x0F, 0x30, 0xE0, 0x23, 0x71, 0x6D, 0x54, 0x07, 0x20, 0xE0, 0x05, 0x71, 0x65, 0x12, 0x51, 0x32, -+0x90, 0xA2, 0xEE, 0xE0, 0xB4, 0x02, 0x04, 0x7D, 0x09, 0x80, 0x2B, 0x90, 0xA2, 0xEE, 0xE0, 0x64, -+0x05, 0x70, 0x28, 0x7D, 0x0F, 0x80, 0x1F, 0x90, 0xA0, 0xDF, 0xE0, 0x60, 0x1E, 0x71, 0x65, 0x12, -+0x51, 0x32, 0x90, 0xA2, 0xEE, 0xE0, 0xB4, 0x02, 0x04, 0x7D, 0x0A, 0x80, 0x09, 0x90, 0xA2, 0xEE, -+0xE0, 0xB4, 0x05, 0x07, 0x7D, 0x10, 0x7F, 0x6F, 0x12, 0x53, 0x36, 0x90, 0xA1, 0x53, 0xE0, 0x30, -+0xE0, 0x03, 0x12, 0x57, 0xE1, 0x12, 0x77, 0xB8, 0x30, 0xE0, 0x05, 0xE4, 0xFF, 0x12, 0x97, 0xE1, -+0x12, 0x8F, 0xC5, 0x30, 0xE0, 0x0E, 0x90, 0x06, 0xCD, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x06, 0xCF, -+0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x90, 0xA0, 0xE1, 0xE0, 0xFF, 0xE4, 0xFD, 0x22, 0x90, 0xA1, 0x54, -+0xE0, 0xC4, 0x13, 0x22, 0x90, 0xA1, 0x50, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x22, 0x90, 0x05, 0x22, -+0xE0, 0x54, 0x6F, 0xFF, 0x22, 0x90, 0xA1, 0x53, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x22, 0x90, 0xA1, -+0x67, 0xE0, 0xFF, 0xC3, 0x94, 0x20, 0x22, 0x90, 0xA1, 0x56, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x22, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, -+0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x22, 0x90, 0xA2, 0xCF, 0x71, 0xAA, 0x90, 0xA2, 0xD1, 0xE0, 0x91, -+0xA8, 0x7B, 0x01, 0x90, 0xA2, 0xD6, 0x12, 0x47, 0xF3, 0x90, 0xA2, 0xD2, 0xE0, 0x91, 0x7A, 0xA3, -+0x12, 0x47, 0xF3, 0x91, 0x6F, 0xFF, 0x91, 0xB5, 0x8F, 0x1F, 0xA3, 0x12, 0x9D, 0x48, 0xE0, 0xF5, -+0x1B, 0xA3, 0xE0, 0xF5, 0x1C, 0xE4, 0xF5, 0x20, 0x90, 0xA2, 0xD6, 0x12, 0x47, 0xEA, 0x75, 0xF0, -+0x02, 0xE5, 0x20, 0x91, 0x94, 0xA8, 0x1F, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, -+0xF9, 0xFF, 0x90, 0xA2, 0xD3, 0x12, 0x47, 0xEA, 0x85, 0x20, 0x82, 0x12, 0xA4, 0x0E, 0x91, 0xA0, -+0x25, 0x1C, 0xF5, 0x1C, 0xEE, 0x35, 0x1B, 0xF5, 0x1B, 0x05, 0x20, 0xE5, 0x20, 0xB4, 0x05, 0xC8, -+0x90, 0xA2, 0xD3, 0x12, 0x47, 0xEA, 0x12, 0x62, 0x13, 0xFD, 0x7C, 0x00, 0x91, 0x6F, 0xA8, 0x1F, -+0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x07, 0x03, 0x8E, 0x1D, -+0x8F, 0x1E, 0xD3, 0xE5, 0x1C, 0x95, 0x1E, 0xE5, 0x1B, 0x95, 0x1D, 0x40, 0x0C, 0xE5, 0x1C, 0x95, -+0x1E, 0xFF, 0xE5, 0x1B, 0x95, 0x1D, 0xFE, 0x80, 0x04, 0x7E, 0x00, 0x7F, 0x00, 0x8E, 0x1B, 0x8F, -+0x1C, 0x90, 0xA2, 0xD1, 0x12, 0x9D, 0x48, 0xE5, 0x1B, 0xF0, 0xA3, 0xE5, 0x1C, 0xF0, 0x22, 0x90, -+0xA2, 0xCF, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x8F, 0x16, 0xEF, 0x75, 0xF0, 0x06, 0xA4, 0x24, 0x62, -+0xF9, 0x74, 0x40, 0x35, 0xF0, 0xFA, 0x7B, 0xFF, 0x22, 0x90, 0xA2, 0xC3, 0x12, 0x47, 0xEA, 0x75, -+0xF0, 0x02, 0xE5, 0x18, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x07, 0xAB, 0xAE, 0xF0, 0x22, -+0xFD, 0x7C, 0x00, 0x12, 0x07, 0x03, 0xEF, 0x22, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x01, 0xF9, 0x74, -+0x8D, 0x35, 0xF0, 0xFA, 0x22, 0xD3, 0xEF, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x03, 0x7F, 0x05, -+0x22, 0xD3, 0xEF, 0x94, 0xC8, 0xEE, 0x94, 0x00, 0x7F, 0x00, 0x40, 0x02, 0x7F, 0x02, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x30, 0x71, 0xAD, 0x90, 0xA2, 0xB9, 0xE0, 0x90, -+0x04, 0x33, 0xF0, 0x90, 0xA2, 0xBA, 0xE0, 0x90, 0x04, 0x34, 0xF0, 0x90, 0xA2, 0xBB, 0xE0, 0x90, -+0x04, 0x35, 0xF0, 0x90, 0xA2, 0xBC, 0xE0, 0x90, 0x04, 0x36, 0xF0, 0x90, 0xA2, 0xBD, 0xE0, 0x90, -+0x04, 0x37, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7E, 0x00, 0x7F, 0x0A, 0x7D, 0x00, 0x7B, 0x01, -+0x7A, 0xA1, 0x79, 0x78, 0x12, 0x08, 0xAA, 0x90, 0xA1, 0x64, 0x74, 0x02, 0xF0, 0x22, 0x90, 0xA1, -+0x50, 0xE0, 0x30, 0xE0, 0x3A, 0xA3, 0x12, 0x82, 0x97, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0xA1, 0x58, -+0xF0, 0x90, 0xA1, 0x65, 0xF0, 0xA3, 0xF0, 0x90, 0xA1, 0x62, 0x04, 0xF0, 0x90, 0xA1, 0x42, 0xE0, -+0x60, 0x07, 0x7D, 0x05, 0x7F, 0x6F, 0x02, 0x53, 0x36, 0x12, 0x57, 0xE1, 0x90, 0xA1, 0x50, 0x12, -+0x7A, 0x7F, 0x20, 0xE0, 0x0A, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0xB1, 0x60, 0x22, -+0x90, 0xA1, 0x41, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x26, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x20, -+0x90, 0x9F, 0xD1, 0xE0, 0xFF, 0x90, 0xA3, 0xD6, 0x74, 0x09, 0xF0, 0x7B, 0x18, 0xE4, 0xFD, 0x12, -+0x85, 0x3D, 0x90, 0xA4, 0x0A, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, -+0x22, 0x12, 0x67, 0xEB, 0x90, 0xA3, 0xED, 0xE0, 0x70, 0x09, 0x12, 0x9A, 0x18, 0x90, 0xA3, 0xED, -+0x74, 0x01, 0xF0, 0x12, 0x62, 0xC9, 0x12, 0x06, 0x89, 0xFF, 0xE4, 0x8F, 0x12, 0xF5, 0x11, 0xF5, -+0x10, 0xF5, 0x0F, 0x90, 0xA1, 0x8A, 0x12, 0x47, 0xC6, 0xEC, 0x54, 0xC1, 0xFC, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0xAF, 0x12, 0xAE, 0x11, 0xAD, 0x10, 0xAC, 0x0F, 0x78, 0x19, 0x12, -+0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0xA8, 0x90, 0xA1, 0x86, -+0x02, 0x08, 0x6D, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x02, 0xEF, 0xF0, 0xA3, -+0xED, 0xF0, 0x7D, 0x44, 0xD1, 0x28, 0x90, 0xA4, 0x03, 0xE0, 0x90, 0xA4, 0x02, 0xB4, 0x01, 0x0D, -+0xE0, 0x75, 0xF0, 0x10, 0x12, 0x6F, 0x91, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x0B, 0xE0, 0x75, 0xF0, -+0x10, 0x12, 0x6F, 0x91, 0xE0, 0x54, 0xFB, 0xF0, 0x12, 0x57, 0xE1, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xE4, 0xFD, 0x80, 0xBF, 0x7D, 0x01, 0x80, 0xBB, 0x7F, 0x6F, 0x12, 0x53, 0x36, 0x02, 0x56, 0x2E, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x00, 0xED, 0xF0, 0x90, 0xA3, 0xFF, 0xEF, -+0xF0, 0x64, 0x02, 0x70, 0x24, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA4, 0x01, 0xF0, 0x7D, 0x4A, 0xD1, -+0x28, 0xBF, 0x01, 0x07, 0x90, 0x04, 0xD4, 0x74, 0xFF, 0x80, 0x45, 0x90, 0xA4, 0x01, 0xE0, 0xFF, -+0x7D, 0x46, 0x12, 0x53, 0x36, 0x7F, 0x00, 0x80, 0x3C, 0x90, 0xA3, 0xFF, 0xE0, 0x64, 0x01, 0x70, -+0x2B, 0xFD, 0xFF, 0x12, 0x53, 0x36, 0x90, 0xA4, 0x00, 0xE0, 0xFF, 0x75, 0xF0, 0x13, 0x90, 0xA1, -+0xBB, 0x12, 0x47, 0xDE, 0xE0, 0xF4, 0x90, 0x04, 0xD4, 0xF0, 0x75, 0xF0, 0x13, 0xEF, 0x90, 0xA1, -+0xBC, 0x12, 0x47, 0xDE, 0xE0, 0xF4, 0x90, 0x04, 0xD5, 0xF0, 0x80, 0x07, 0x90, 0x04, 0xD4, 0xE4, -+0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0xDE, 0xEF, 0xF0, 0x90, -+0x04, 0x7E, 0xE0, 0xF5, 0x22, 0xA3, 0xE0, 0xF5, 0x23, 0x65, 0x22, 0x60, 0x6C, 0x90, 0xA2, 0xDF, -+0x74, 0x03, 0xF0, 0x90, 0xA2, 0xED, 0x74, 0x08, 0xF0, 0xE5, 0x23, 0x04, 0x54, 0x0F, 0xF5, 0x24, -+0xE4, 0xF5, 0x21, 0xE5, 0x24, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, -+0xF5, 0x83, 0xE5, 0x82, 0x25, 0x21, 0x12, 0x73, 0xD3, 0xE0, 0xFF, 0x74, 0xE1, 0x25, 0x21, 0xF5, -+0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x21, 0xE5, 0x21, 0xB4, 0x08, 0xD4, 0x7B, -+0x01, 0x7A, 0xA2, 0x79, 0xDF, 0x12, 0x78, 0x06, 0xE5, 0x23, 0x04, 0x54, 0x0F, 0xF5, 0x23, 0xB4, -+0x0F, 0x03, 0xE4, 0xF5, 0x23, 0x90, 0x04, 0x7F, 0xE5, 0x23, 0xF0, 0x90, 0xA2, 0xDE, 0xE0, 0x7F, -+0x04, 0x70, 0x03, 0x02, 0x7F, 0x8F, 0x12, 0x6F, 0x67, 0x22, 0xE4, 0xFF, 0xC1, 0xAA, 0x75, 0x59, -+0x12, 0xE4, 0xF5, 0x5A, 0x75, 0x5B, 0x07, 0x75, 0x5C, 0x72, 0x90, 0x01, 0x30, 0xE5, 0x59, 0xF0, -+0xA3, 0xE5, 0x5A, 0xF0, 0xA3, 0xE5, 0x5B, 0xF0, 0xA3, 0xE5, 0x5C, 0xF0, 0x22, 0x75, 0x61, 0x06, -+0x43, 0x61, 0x10, 0x75, 0x62, 0x01, 0x75, 0x63, 0x13, 0x75, 0x64, 0x62, 0x43, 0x64, 0x80, 0x43, -+0x63, 0x04, 0x90, 0x01, 0x38, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, 0x62, 0xF0, 0xA3, 0xE5, 0x63, 0xF0, -+0xA3, 0xE5, 0x64, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, -+0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x12, -+0x92, 0x0C, 0x90, 0x01, 0x99, 0xE0, 0x44, 0xC0, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x80, 0xF0, 0x22, -+0x7F, 0x02, 0x90, 0xA1, 0xB2, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, -+0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, -+0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x9F, 0x13, 0x12, 0x58, 0x8C, 0xA3, 0xF0, -+0x22, 0x90, 0x01, 0xE4, 0x74, 0x25, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, -+0x59, 0xF5, 0x5D, 0xA3, 0xE0, 0x55, 0x5A, 0xF5, 0x5E, 0xA3, 0xE0, 0x55, 0x5B, 0xF5, 0x5F, 0xA3, -+0xE0, 0x55, 0x5C, 0xF5, 0x60, 0x90, 0x01, 0x34, 0xE5, 0x5D, 0xF0, 0xA3, 0xE5, 0x5E, 0xF0, 0xA3, -+0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x61, 0xF5, 0x65, -+0xA3, 0xE0, 0x55, 0x62, 0xF5, 0x66, 0xA3, 0xE0, 0x55, 0x63, 0xF5, 0x67, 0xA3, 0xE0, 0x55, 0x64, -+0xF5, 0x68, 0x90, 0x01, 0x3C, 0xE5, 0x65, 0xF0, 0xA3, 0xE5, 0x66, 0xF0, 0xA3, 0xE5, 0x67, 0xF0, -+0xA3, 0xE5, 0x68, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0xA2, 0xDE, 0xF0, -+0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, 0x23, -+0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, 0xA8, -+0xF5, 0xE8, 0x12, 0x4F, 0xB5, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x48, -+0xCF, 0x80, 0xFE, 0x22, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x05, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, -+0x22, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x11, 0xA3, 0x74, 0x01, 0xF0, 0x90, 0xA0, 0xD5, 0xE0, -+0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x03, 0x12, 0x95, 0x2C, 0x12, 0x50, 0x47, 0x02, 0x80, 0xC7, 0x90, -+0xA0, 0xD5, 0xE0, 0xFF, 0x30, 0xE0, 0x05, 0x12, 0x94, 0xC2, 0x60, 0x1B, 0x90, 0xA0, 0xDF, 0xE0, -+0x70, 0x04, 0xEF, 0x30, 0xE0, 0x0B, 0x90, 0xA0, 0xE2, 0xE0, 0x64, 0x02, 0x60, 0x09, 0x12, 0x5A, -+0xBD, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA0, 0xDF, 0xE0, 0x70, 0x07, 0x90, 0xA0, -+0xD5, 0xE0, 0x30, 0xE0, 0x13, 0x90, 0xA0, 0xD5, 0xE0, 0x30, 0xE0, 0x09, 0x12, 0x5F, 0x13, 0xBF, -+0x01, 0x06, 0x02, 0x94, 0xC9, 0x12, 0x57, 0xB1, 0x22, 0xE4, 0xFF, 0x90, 0xA2, 0x33, 0xEF, 0xF0, -+0x90, 0xA0, 0xD4, 0xE0, 0x90, 0xA2, 0xB5, 0xF0, 0xE4, 0x90, 0xA2, 0x34, 0xF0, 0x90, 0xA2, 0xB5, -+0xE0, 0xFE, 0x90, 0xA2, 0x34, 0xE0, 0xFF, 0xC3, 0x9E, 0x50, 0x2D, 0xE0, 0xFE, 0x31, 0xE7, 0xE4, -+0xF0, 0x75, 0xF0, 0x10, 0xEE, 0x12, 0x6F, 0x86, 0xE0, 0x30, 0xE7, 0x09, 0x74, 0x81, 0x2F, 0x31, -+0xF1, 0xE4, 0xF0, 0x80, 0x0B, 0x51, 0x16, 0x90, 0xA2, 0x34, 0xE0, 0x31, 0xE7, 0x74, 0x01, 0xF0, -+0x90, 0xA2, 0x34, 0xE0, 0x04, 0xF0, 0x80, 0xC5, 0x7F, 0x0C, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xE4, -+0x90, 0xA2, 0x34, 0xF0, 0x90, 0xA2, 0xB5, 0xE0, 0xFF, 0x90, 0xA2, 0x34, 0xE0, 0xFE, 0xC3, 0x9F, -+0x40, 0x02, 0x21, 0xE6, 0x74, 0x35, 0x2E, 0x31, 0xE9, 0xE0, 0x70, 0x02, 0x21, 0xDE, 0x75, 0xF0, -+0x10, 0xEE, 0x90, 0x81, 0x06, 0x31, 0xF9, 0xEE, 0x90, 0x81, 0x07, 0x51, 0x02, 0xFC, 0x12, 0x6F, -+0xC9, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x0A, 0x31, 0xF9, 0xEC, -+0x90, 0x81, 0x0B, 0x51, 0x02, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x51, 0x0E, 0xF0, 0x7F, 0x01, -+0x90, 0xA2, 0x34, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x0B, 0x12, 0x73, 0xCD, 0xE0, 0xFD, -+0x75, 0xF0, 0x0A, 0xEE, 0x12, 0x6E, 0xA9, 0xED, 0xF0, 0x0F, 0xEF, 0xB4, 0x05, 0xE2, 0x90, 0xA2, -+0x34, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x09, 0x12, 0x47, 0xDE, 0xE0, 0xFE, 0x74, 0x91, -+0x2F, 0x12, 0x6F, 0x9B, 0xEE, 0xF0, 0x90, 0xA2, 0x34, 0xE0, 0xFF, 0x90, 0xA2, 0x33, 0xE0, 0xFD, -+0x12, 0x6E, 0x4E, 0x90, 0xA2, 0x34, 0xE0, 0x24, 0x81, 0x31, 0xF1, 0x74, 0x01, 0xF0, 0x90, 0xA2, -+0x34, 0xE0, 0x04, 0xF0, 0x21, 0x44, 0x22, 0x24, 0x35, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, -+0x22, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0x12, 0x47, 0xDE, 0xE0, 0xFD, 0x75, 0xF0, -+0x10, 0x22, 0x12, 0x47, 0xDE, 0xE0, 0xFE, 0xED, 0xFF, 0x90, 0xA2, 0x34, 0xE0, 0x22, 0x12, 0x47, -+0xDE, 0xEE, 0xF0, 0xA3, 0xEF, 0x22, 0x12, 0x6F, 0x82, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0x90, 0xA0, -+0xDF, 0xE0, 0x60, 0x12, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x05, 0x12, 0x96, 0x85, 0x80, 0x06, -+0x12, 0x5F, 0x30, 0x12, 0x60, 0x47, 0x90, 0xA1, 0xB5, 0xE0, 0xB4, 0x01, 0x03, 0x12, 0x53, 0x41, -+0x22, 0x12, 0x8D, 0xA9, 0x90, 0xA1, 0xB3, 0xE0, 0x30, 0xE0, 0x07, 0x90, 0xA2, 0x28, 0xE0, 0x44, -+0x40, 0xF0, 0x22, 0xB1, 0x86, 0x90, 0xA2, 0xEE, 0xEF, 0xF0, 0x30, 0xE0, 0x05, 0x7D, 0x01, 0xE4, -+0x80, 0x02, 0xE4, 0xFD, 0xFF, 0x12, 0x59, 0xE7, 0x90, 0xA2, 0xEE, 0xE0, 0x30, 0xE6, 0x11, 0x90, -+0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, -+0x91, 0xE8, 0x74, 0x02, 0xF0, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0x90, 0xA0, -+0xDB, 0x12, 0x77, 0xBB, 0x30, 0xE0, 0x02, 0x61, 0x3C, 0x90, 0xA0, 0xDA, 0xE0, 0x30, 0xE0, 0x13, -+0x12, 0x5A, 0x52, 0x90, 0xA0, 0xF4, 0xF0, 0x90, 0xA0, 0xFC, 0xE0, 0x24, 0x03, 0x90, 0xA0, 0xF3, -+0xF0, 0x80, 0x0D, 0x90, 0xA0, 0xF4, 0x74, 0x02, 0xF0, 0x90, 0xA0, 0xF3, 0x14, 0xF0, 0x0B, 0x0B, -+0x90, 0xA0, 0xF3, 0xE0, 0xFA, 0x90, 0xA0, 0xF2, 0xE0, 0xD3, 0x9A, 0x50, 0x0E, 0x90, 0xA0, 0xE7, -+0xEB, 0xF0, 0x90, 0xA0, 0xF4, 0xE0, 0xC3, 0x9D, 0x2C, 0x80, 0x11, 0xC3, 0xED, 0x9A, 0x2B, 0x90, -+0xA0, 0xE7, 0xF0, 0x90, 0xA0, 0xF3, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0xA0, 0xF7, 0xF0, -+0x90, 0xA0, 0xF4, 0xE0, 0xFF, 0x24, 0x0A, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0xA0, 0xF7, 0x71, 0x48, -+0x40, 0x04, 0xEF, 0x24, 0x0A, 0xF0, 0x90, 0xA0, 0xF7, 0xE0, 0xFF, 0x24, 0x23, 0xFD, 0xE4, 0x33, -+0xFC, 0x90, 0xA0, 0xE7, 0x71, 0x48, 0x40, 0x04, 0xEF, 0x24, 0x23, 0xF0, 0x90, 0xA0, 0xF7, 0xE0, -+0xFF, 0x7E, 0x00, 0x90, 0xA0, 0xEB, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, 0xE0, 0x6F, -+0x70, 0x01, 0xE4, 0x60, 0x02, 0xB1, 0x4F, 0x12, 0x8F, 0xD3, 0x80, 0x07, 0x90, 0xA0, 0xDC, 0xE0, -+0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, -+0x80, 0x98, 0x22, 0x12, 0x4F, 0xD9, 0x12, 0x47, 0xA8, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0x90, 0x05, 0x62, 0x12, 0x4F, 0xF2, 0x78, 0x10, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0xA8, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, -+0x12, 0x4F, 0xF2, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0x12, 0x47, 0xA8, 0x90, 0xA1, 0x2E, 0x12, 0x08, 0x6D, 0x90, 0xA1, 0x32, 0x12, 0x47, 0xC6, 0x90, -+0xA1, 0x2E, 0x12, 0x47, 0xD2, 0xC3, 0x12, 0x47, 0xB5, 0x40, 0x3C, 0x90, 0xA0, 0xDA, 0xE0, 0x90, -+0xA1, 0x32, 0x30, 0xE0, 0x0C, 0x91, 0xCB, 0x12, 0x5A, 0x52, 0x2F, 0xFF, 0x90, 0xA1, 0x36, 0x80, -+0x05, 0x91, 0xCB, 0x90, 0xA1, 0x37, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, 0x90, 0xA2, 0xE0, 0xF0, 0x90, -+0xA2, 0xE0, 0xE0, 0xFF, 0xC3, 0x94, 0x2D, 0x50, 0x0E, 0x74, 0xFD, 0x2F, 0x91, 0xBB, 0xE0, 0x04, -+0xF0, 0x90, 0xA0, 0xF5, 0xE0, 0x04, 0xF0, 0x90, 0xA0, 0xF5, 0xE0, 0xFF, 0xD3, 0x90, 0xA1, 0x39, -+0xE0, 0x9F, 0x90, 0xA1, 0x38, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x81, 0xB7, 0xE4, 0xFF, 0xFE, 0x91, -+0xB8, 0xE0, 0x2F, 0xFF, 0x90, 0xA1, 0x3A, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, 0x40, 0x07, 0x90, 0xA2, -+0xE1, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xE5, 0xE4, 0xFF, 0xFE, 0x91, 0xB8, 0xE0, -+0x2F, 0xFF, 0x90, 0xA1, 0x3A, 0xE0, 0xFD, 0xC3, 0x90, 0xA1, 0x39, 0xE0, 0x9D, 0xFD, 0x90, 0xA1, -+0x38, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, 0x40, 0x07, 0x90, 0xA2, 0xE2, 0xEE, -+0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xD5, 0x90, 0xA2, 0xE1, 0xE0, 0x90, 0xA0, 0xFA, 0xF0, -+0x90, 0xA2, 0xE2, 0xE0, 0x90, 0xA0, 0xFB, 0x91, 0xC3, 0x94, 0x0A, 0x40, 0x0A, 0xEF, 0x24, 0xF6, -+0x90, 0xA0, 0xF2, 0xF0, 0xE4, 0x80, 0x09, 0xE4, 0x90, 0xA0, 0xF2, 0x91, 0xC3, 0x74, 0x0A, 0x9F, -+0x90, 0xA0, 0xF1, 0xF0, 0x90, 0xA0, 0xFA, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0xA0, 0xF8, -+0xF0, 0x90, 0xA0, 0xDA, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0xA1, 0x36, 0x80, 0x03, 0x90, 0xA1, 0x37, -+0xE0, 0x04, 0xFF, 0x90, 0xA0, 0xF8, 0xE0, 0x2F, 0xF0, 0x90, 0xA0, 0xF8, 0xE0, 0xC3, 0x94, 0x0A, -+0x50, 0x03, 0x74, 0x0A, 0xF0, 0x90, 0xA0, 0xF8, 0xE0, 0x24, 0x02, 0xF0, 0x91, 0xE8, 0x74, 0x03, -+0xF0, 0x51, 0x85, 0xE4, 0xFF, 0xB1, 0x2A, 0x22, 0x74, 0xFD, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xA0, -+0xF5, 0x83, 0x22, 0xF0, 0x90, 0xA0, 0xFA, 0xE0, 0xFF, 0xC3, 0x22, 0x12, 0x47, 0xD2, 0x90, 0xA1, -+0x2E, 0x12, 0x47, 0xC6, 0x12, 0x47, 0x8D, 0x78, 0x0A, 0x12, 0x08, 0x47, 0x90, 0xA0, 0xF7, 0xE0, -+0xFE, 0xC3, 0x74, 0x0A, 0x9E, 0x2F, 0xFF, 0x22, 0x90, 0xA0, 0xF1, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, -+0x90, 0xA0, 0xF8, 0xE0, 0xFB, 0x90, 0xA3, 0xE2, 0x22, 0x90, 0xA2, 0xC7, 0x12, 0x47, 0xF3, 0x12, -+0x5F, 0xB5, 0x90, 0xA0, 0xDF, 0xE0, 0xFF, 0x12, 0x5E, 0x51, 0x90, 0xA0, 0xDF, 0xE0, 0x60, 0x19, -+0x90, 0xA2, 0xC7, 0x12, 0x47, 0xEA, 0x12, 0x67, 0x96, 0x54, 0x0F, 0xFF, 0x12, 0x67, 0x07, 0xFD, -+0xB1, 0x59, 0x91, 0xE8, 0x74, 0x01, 0xF0, 0x51, 0x85, 0x22, 0xE4, 0xFE, 0x91, 0xB8, 0xE4, 0xF0, -+0x0E, 0xEE, 0xB4, 0x2D, 0xF7, 0xE4, 0x90, 0xA0, 0xF6, 0xF0, 0x90, 0xA0, 0xF5, 0xF0, 0x90, 0xA0, -+0xF9, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0x2D, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xF0, 0x90, -+0xA0, 0xEB, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0B, 0x04, 0x70, -+0x24, 0x90, 0xA0, 0xE5, 0x74, 0x02, 0xF0, 0x80, 0x13, 0xED, 0x70, 0x06, 0x90, 0xA1, 0x3F, 0xE0, -+0x80, 0x02, 0xED, 0x14, 0x90, 0xA0, 0xE5, 0xF0, 0x90, 0xA0, 0xE5, 0xE0, 0xA3, 0xF0, 0x90, 0xA0, -+0xDB, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0xE4, 0x90, 0xA2, 0xF0, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, -+0x4A, 0xB0, 0x90, 0xA2, 0xEF, 0xEF, 0xF0, 0x7F, 0x83, 0x12, 0x4A, 0xB0, 0xAE, 0x07, 0x90, 0xA2, -+0xEF, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0xA2, 0xF1, 0xE0, 0x94, 0x64, 0x90, 0xA2, -+0xF0, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA2, 0xEF, -+0xE0, 0xFF, 0x22, 0x90, 0xA2, 0xF0, 0x12, 0x91, 0x20, 0x80, 0xC2, 0x90, 0xA1, 0xB3, 0xE0, 0x30, -+0xE0, 0x11, 0x90, 0xA2, 0x27, 0x12, 0x77, 0xBB, 0x30, 0xE0, 0x08, 0xA3, 0xE0, 0x44, 0x20, 0xF0, -+0x44, 0x40, 0xF0, 0x22, 0x90, 0xA0, 0xDA, 0x12, 0x5E, 0xE9, 0x30, 0xE0, 0x29, 0xEF, 0x54, 0xBF, -+0xD1, 0x17, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFE, 0xD1, 0x7F, -+0x74, 0x04, 0xF0, 0x90, 0xA1, 0x56, 0x12, 0x7A, 0x7F, 0x30, 0xE0, 0x07, 0x7D, 0x01, 0x7F, 0x0C, -+0x02, 0x51, 0x32, 0x12, 0x60, 0x47, 0x22, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA0, 0xDB, 0x22, -+0x90, 0xA0, 0xDA, 0xE0, 0xFF, 0x12, 0x77, 0xBC, 0x30, 0xE0, 0x1E, 0xEF, 0x54, 0x7F, 0xD1, 0x17, -+0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, 0x54, 0xFD, 0xD1, 0x7F, 0x04, 0xF0, -+0x90, 0xA0, 0xDF, 0xE0, 0x60, 0x03, 0x12, 0x60, 0x47, 0x90, 0xA1, 0x54, 0x12, 0x5E, 0xE9, 0x30, -+0xE0, 0x22, 0x90, 0xA1, 0x57, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x18, 0xEF, 0x54, 0xFD, 0xF0, -+0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA1, 0x57, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x04, -+0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, 0x03, 0x12, 0x57, 0x31, 0x22, 0xF0, -+0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x22, 0xEF, 0x60, 0x34, 0x12, 0x57, 0xE6, -+0x70, 0x2F, 0x90, 0xA0, 0xDB, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, 0x2B, 0x7F, 0x0F, 0x12, 0x53, 0x36, -+0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0x12, 0x84, 0x4B, 0xBF, 0x01, 0x0F, 0x90, 0xA0, 0xDA, -+0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x06, 0xD1, 0xC2, 0x74, 0x06, 0xF0, 0x22, 0xD1, 0x80, 0x74, 0x08, -+0xF0, 0x22, 0x7F, 0x01, 0x12, 0x59, 0xE7, 0x90, 0xA0, 0xD9, 0x22, 0x7D, 0x2F, 0x7F, 0xFF, 0x12, -+0x53, 0x36, 0x12, 0x4A, 0x1F, 0x7D, 0x08, 0xD1, 0xC2, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x01, 0xC4, -+0x74, 0xDD, 0xF0, 0x74, 0xB6, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x4A, 0xB0, 0xEF, 0x20, 0xE0, 0xF7, -+0x74, 0xDD, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB6, 0xA3, 0xF0, 0x22, 0xE4, 0xF5, 0x1B, 0x12, -+0x73, 0xDB, 0xE0, 0xFE, 0xB4, 0x05, 0x14, 0xED, 0xC3, 0x94, 0x3B, 0x50, 0x5B, 0xED, 0xC3, 0x94, -+0x31, 0x40, 0x5D, 0xED, 0xD3, 0x94, 0x35, 0x50, 0x57, 0x80, 0x4D, 0xEE, 0xB4, 0x04, 0x08, 0xED, -+0xC3, 0x94, 0x31, 0x40, 0x4B, 0x80, 0x41, 0x12, 0x73, 0xDB, 0xE0, 0xFE, 0xB4, 0x03, 0x14, 0xED, -+0xC3, 0x94, 0x19, 0x50, 0x0C, 0xED, 0xC3, 0x94, 0x11, 0x40, 0x35, 0xED, 0xD3, 0x94, 0x13, 0x50, -+0x2F, 0x80, 0x25, 0xEE, 0xB4, 0x02, 0x08, 0xED, 0xC3, 0x94, 0x11, 0x40, 0x23, 0x80, 0x19, 0x12, -+0x73, 0xDB, 0xE0, 0xFE, 0xB4, 0x01, 0x08, 0xED, 0xC3, 0x94, 0x0A, 0x40, 0x13, 0x80, 0x09, 0xEE, -+0x70, 0x0B, 0xED, 0xC3, 0x94, 0x03, 0x40, 0x08, 0x75, 0x1B, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x1B, -+0xAF, 0x1B, 0x22, 0x8F, 0x10, 0x8D, 0x11, 0x8B, 0x12, 0x75, 0xF0, 0x04, 0xEF, 0x12, 0x66, 0xFE, -+0xC4, 0x54, 0x03, 0x90, 0xA2, 0xC9, 0xF0, 0x90, 0xA2, 0xC7, 0x60, 0x09, 0x74, 0x32, 0xF0, 0xA3, -+0x74, 0x2F, 0xF0, 0x80, 0x07, 0x74, 0x11, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0x75, 0xF0, 0x10, 0xE5, -+0x10, 0x12, 0x73, 0xFC, 0xE0, 0xFD, 0x90, 0xA3, 0x00, 0x74, 0x04, 0xF0, 0xE4, 0xFB, 0xAF, 0x10, -+0x12, 0xB9, 0x00, 0xE5, 0x11, 0xD3, 0x94, 0x2D, 0x40, 0x0A, 0x75, 0xF0, 0x04, 0xE5, 0x10, 0x12, -+0x6F, 0xE1, 0x80, 0x20, 0xE5, 0x11, 0xD3, 0x94, 0x1E, 0x40, 0x05, 0x90, 0xA2, 0xC7, 0x80, 0x14, -+0xE5, 0x11, 0xD3, 0x94, 0x14, 0x40, 0x05, 0x90, 0xA2, 0xC8, 0x80, 0x08, 0x75, 0xF0, 0x04, 0xE5, -+0x10, 0x12, 0x67, 0xE5, 0xE0, 0xFD, 0x85, 0x12, 0x73, 0xE4, 0xFB, 0xAF, 0x10, 0x02, 0x75, 0xED, -+0xEF, 0x64, 0x13, 0x60, 0x04, 0xEF, 0xB4, 0x0B, 0x05, 0x90, 0xA1, 0x96, 0x80, 0x1F, 0xEF, 0x64, -+0x12, 0x60, 0x04, 0xEF, 0xB4, 0x0A, 0x05, 0x90, 0xA1, 0x97, 0x80, 0x11, 0xEF, 0x64, 0x11, 0x60, -+0x04, 0xEF, 0xB4, 0x09, 0x05, 0x90, 0xA1, 0x98, 0x80, 0x03, 0x90, 0xA1, 0x95, 0xE0, 0xF5, 0x1D, -+0xAF, 0x1D, 0x22, 0x8D, 0x1B, 0x90, 0xA1, 0x94, 0xE0, 0x60, 0x45, 0x12, 0xB7, 0xF0, 0x8F, 0x1C, -+0xE5, 0x1C, 0xC3, 0x94, 0x80, 0x50, 0x27, 0xE5, 0x1C, 0x94, 0x1B, 0x40, 0x02, 0x80, 0x12, 0xED, -+0x25, 0x1C, 0xFF, 0xE4, 0x33, 0xFE, 0xD3, 0xEF, 0x94, 0x1B, 0xEE, 0x64, 0x80, 0x94, 0x80, 0x40, -+0x05, 0x75, 0x1B, 0x1B, 0x80, 0x1A, 0xE5, 0x1C, 0x25, 0x1B, 0xF5, 0x1B, 0x80, 0x12, 0xC3, 0xE4, -+0x95, 0x1C, 0xF5, 0x1C, 0xED, 0xD3, 0x95, 0x1C, 0x40, 0x06, 0xE5, 0x1B, 0x95, 0x1C, 0xF5, 0x1B, -+0xAF, 0x1B, 0x22, 0xE4, 0x90, 0xA2, 0xD9, 0xF0, 0x90, 0xA2, 0xD9, 0xE0, 0xFF, 0xC3, 0x94, 0x06, -+0x50, 0x65, 0x74, 0x22, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xFF, 0xD3, 0x94, -+0x0A, 0x50, 0x02, 0x80, 0x02, 0x7F, 0x0A, 0xAE, 0x07, 0xEF, 0x24, 0x02, 0x90, 0xA2, 0xD8, 0xF0, -+0x90, 0xA2, 0xCA, 0x74, 0x0E, 0xF0, 0x90, 0xA2, 0xCC, 0x74, 0x01, 0xF0, 0x11, 0xE8, 0xE0, 0x90, -+0xA2, 0xCD, 0xF0, 0xE4, 0xFF, 0xEF, 0xC3, 0x9E, 0x50, 0x17, 0x11, 0xE8, 0xE0, 0x2F, 0x11, 0xF6, -+0xE0, 0xFD, 0x74, 0xCE, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xED, 0xF0, 0x0F, 0x80, -+0xE4, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0xCA, 0x12, 0x78, 0x06, 0x7F, 0x04, 0x12, 0x6F, 0x67, 0x90, -+0xA2, 0xD9, 0xE0, 0x04, 0xF0, 0x80, 0x91, 0x22, 0x90, 0xA2, 0xD9, 0xE0, 0x24, 0x1C, 0xF5, 0x82, -+0xE4, 0x34, 0x9F, 0xF5, 0x83, 0x22, 0x24, 0x7C, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x03, 0xED, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, -+0xEB, 0xF0, 0x90, 0xA3, 0x00, 0xE0, 0x90, 0xA3, 0x06, 0xF0, 0x90, 0xA3, 0x01, 0x74, 0x0C, 0xF0, -+0x90, 0xA3, 0x0F, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x01, 0x12, 0x78, 0x06, 0x7F, -+0x04, 0x12, 0x6F, 0x67, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA4, 0x06, 0xEF, 0xF0, 0x7F, 0x8F, 0x12, 0x4A, 0xB0, 0xEF, 0x30, 0xE6, 0x42, 0x7F, 0x8D, -+0x12, 0x4A, 0xB0, 0xEF, 0x64, 0x01, 0x70, 0x38, 0x90, 0xA4, 0x07, 0xF0, 0x90, 0xA4, 0x07, 0xE0, -+0xFD, 0x90, 0xA4, 0x06, 0xE0, 0x75, 0xF0, 0x10, 0x12, 0x73, 0xFC, 0xE5, 0x82, 0x2D, 0x12, 0x73, -+0xD3, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x49, 0xEA, 0x90, 0xA4, 0x07, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, -+0x94, 0x10, 0x40, 0xD8, 0x7F, 0x8F, 0x12, 0x4A, 0xB0, 0xEF, 0x30, 0xE0, 0x03, 0x12, 0x48, 0xCB, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFE, 0xFC, 0xEF, -+0x64, 0x02, 0x70, 0x40, 0xED, 0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, 0x06, 0xED, 0xB4, 0x02, 0x02, -+0x7E, 0x09, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x04, 0x80, 0x38, 0xEB, 0xB4, -+0x02, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, -+0x02, 0x04, 0x7C, 0x01, 0x80, 0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, 0xED, 0x64, 0x02, 0x70, 0x16, -+0x7C, 0x03, 0x80, 0x12, 0xEF, 0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x06, -+0xEB, 0xB4, 0x01, 0x02, 0x7C, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4C, 0xFF, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0x04, 0x54, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x90, -+0xA4, 0x09, 0xED, 0xF0, 0x90, 0xA4, 0x08, 0xEF, 0xF0, 0xD3, 0x94, 0x0E, 0x50, 0x15, 0x51, 0x03, -+0xEF, 0x60, 0x29, 0x51, 0x03, 0xEF, 0x64, 0x01, 0x70, 0x22, 0x90, 0xA4, 0x09, 0xE0, 0xFD, 0xE4, -+0xFF, 0x80, 0x15, 0x90, 0xA4, 0x08, 0xE0, 0xD3, 0x94, 0x0E, 0x40, 0x10, 0x51, 0x03, 0xEF, 0x70, -+0x09, 0x90, 0xA4, 0x09, 0xE0, 0xFD, 0x7F, 0x01, 0x80, 0x03, 0x51, 0x03, 0x22, 0x90, 0xA3, 0xFD, -+0xED, 0xF0, 0x90, 0xA3, 0xFC, 0xEF, 0xF0, 0x70, 0x77, 0x90, 0xA3, 0x25, 0x12, 0x08, 0x79, 0x30, -+0x00, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, -+0xFE, 0x12, 0x4E, 0xA9, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0F, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x00, 0x00, 0x71, 0x49, 0x12, 0x08, 0x79, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA3, -+0x29, 0x12, 0x08, 0x79, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x12, 0x4E, 0xA9, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x10, -+0x7F, 0x0C, 0x12, 0x4E, 0xA7, 0x12, 0x08, 0x79, 0x0F, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, -+0x08, 0x79, 0x01, 0x00, 0x00, 0x00, 0x71, 0x38, 0x90, 0x04, 0x54, 0xE0, 0x54, 0x7F, 0x80, 0x6F, -+0x90, 0xA3, 0xFC, 0xE0, 0x64, 0x01, 0x70, 0x5F, 0x90, 0x04, 0x54, 0xE0, 0x44, 0x80, 0x71, 0x3F, -+0x90, 0xA3, 0x25, 0x12, 0x08, 0x79, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, -+0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x12, 0x4E, 0xA9, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x0F, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, 0x00, 0x01, 0x00, 0x71, 0x49, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA3, 0x29, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, -+0x0C, 0x12, 0x4E, 0xA7, 0x12, 0x08, 0x79, 0x0F, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x29, 0x12, 0x08, -+0x79, 0x0F, 0x00, 0x00, 0x00, 0x71, 0x38, 0x22, 0x7F, 0x04, 0x7E, 0x0A, 0x02, 0x4C, 0x5C, 0x90, -+0xA3, 0xFE, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x22, 0x7F, 0x1C, 0x7E, 0x0C, 0x12, 0x4C, 0x5C, -+0x90, 0xA3, 0xFC, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x4E, 0xAF, 0x90, 0xA3, 0x25, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xA9, 0x07, 0x90, 0x06, 0x69, 0xE0, 0xFE, 0x90, 0x06, 0x68, -+0x71, 0xAF, 0xE9, 0x14, 0x60, 0x0F, 0x14, 0x60, 0x1E, 0x24, 0x02, 0x70, 0x25, 0xEE, 0x54, 0xFE, -+0xFE, 0x71, 0xA7, 0x80, 0x1A, 0xEF, 0x44, 0x80, 0xFF, 0xEE, 0x54, 0xFE, 0xFC, 0x90, 0x06, 0x68, -+0xEF, 0xF0, 0xEC, 0xA3, 0xF0, 0x80, 0x0B, 0xEE, 0x44, 0x01, 0xFC, 0x71, 0xA7, 0xAE, 0x04, 0xEE, -+0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x54, 0x7F, 0x90, 0x06, 0x68, 0xF0, 0x22, 0xE0, -+0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0xFE, 0x22, 0x7D, 0x1F, 0x71, 0xC4, 0xF0, 0x22, 0x12, -+0x5F, 0xD8, 0x80, 0xF5, 0x7F, 0x6F, 0x12, 0x53, 0x36, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, -+0x90, 0xA0, 0xD8, 0x74, 0x04, 0x22, 0x7D, 0x25, 0x71, 0xC4, 0xF0, 0x22, 0x12, 0x4A, 0xE6, 0x7D, -+0x24, 0x71, 0xC4, 0xF0, 0x22, 0x91, 0x06, 0xE4, 0x90, 0xA0, 0xD8, 0xF0, 0x22, 0x71, 0xFA, 0x80, -+0xF4, 0x91, 0x00, 0x80, 0xF0, 0x12, 0x5F, 0xDF, 0x80, 0xEB, 0x12, 0x57, 0xDE, 0x02, 0x5F, 0xD8, -+0x12, 0x57, 0xE1, 0x02, 0x5F, 0xD8, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x22, 0x7D, 0x2E, -+0x7F, 0x6F, 0x12, 0x53, 0x36, 0x7D, 0x02, 0x7F, 0x01, 0x12, 0x59, 0xE7, 0x91, 0x06, 0x90, 0xA0, -+0xD9, 0x74, 0x02, 0xF0, 0x22, 0x7D, 0x21, 0x7F, 0xFF, 0x12, 0x53, 0x36, 0x90, 0xA0, 0xD8, 0x74, -+0x03, 0xF0, 0x22, 0x7D, 0x22, 0x7F, 0xFF, 0x12, 0x53, 0x36, 0x91, 0x48, 0x80, 0xEE, 0x12, 0x5F, -+0xD8, 0x80, 0xE2, 0x12, 0x4A, 0xE6, 0x80, 0xE4, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0xF0, 0x22, -+0x91, 0x48, 0x7D, 0x23, 0x02, 0x5F, 0xE9, 0x12, 0x5F, 0xD8, 0x02, 0x5F, 0xE7, 0x02, 0x5F, 0xEE, -+0xAE, 0x07, 0x12, 0x5F, 0x13, 0xBF, 0x01, 0x13, 0x90, 0xA0, 0xD5, 0x12, 0x84, 0x44, 0x20, 0xE0, -+0x0A, 0xAF, 0x06, 0x7D, 0x01, 0x12, 0x51, 0x32, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA1, 0x50, 0xE0, 0x30, 0xE0, 0x1E, 0x90, 0xA1, 0x62, 0xE0, -+0x60, 0x05, 0x75, 0x7A, 0x40, 0xA1, 0x28, 0x90, 0xA0, 0xE1, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, -+0x80, 0x2D, 0x90, 0xA1, 0x42, 0xE0, 0x60, 0x7B, 0x80, 0x55, 0x12, 0x97, 0xBF, 0xEF, 0x64, 0x01, -+0x60, 0x05, 0x75, 0x7A, 0x01, 0x80, 0x71, 0x90, 0xA0, 0xE3, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, -+0x75, 0x7A, 0x02, 0x80, 0x63, 0x90, 0xA0, 0xE1, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, -+0x7A, 0x04, 0x80, 0x54, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x7A, 0x08, 0x80, 0x4B, 0x90, 0xA0, 0xE3, -+0xE0, 0x30, 0xE4, 0x05, 0x75, 0x7A, 0x10, 0x80, 0x3F, 0x90, 0xA0, 0xDB, 0xE0, 0x13, 0x13, 0x54, -+0x3F, 0x20, 0xE0, 0x05, 0x75, 0x7A, 0x20, 0x80, 0x2F, 0x90, 0xA1, 0x42, 0xE0, 0x60, 0x05, 0x75, -+0x7A, 0x80, 0x80, 0x24, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, 0x05, 0x75, 0x7A, 0x11, 0x80, 0x18, -+0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, 0x05, 0x75, 0x7A, -+0x12, 0x80, 0x05, 0x12, 0x97, 0x95, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, -+0xB8, 0xE5, 0x7A, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x36, 0x74, 0x04, -+0xF0, 0xA3, 0x14, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, -+0xF0, 0x22, 0x12, 0x57, 0xDE, 0x12, 0x59, 0xE3, 0x90, 0xA0, 0xD9, 0x74, 0x0C, 0xF0, 0x22, 0x90, -+0xA1, 0x4C, 0xE0, 0x90, 0x01, 0x30, 0xF0, 0x90, 0xA1, 0x49, 0xE0, 0x90, 0x01, 0x39, 0xF0, 0x90, -+0xA1, 0x4A, 0xE0, 0x90, 0x01, 0x3A, 0xF0, 0x22, 0x90, 0xA3, 0xB6, 0xE0, 0xFF, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x13, 0xEF, 0xF0, 0x90, 0x9F, 0xD2, 0xE0, 0xFF, 0x90, 0x04, -+0x1C, 0xE0, 0x6F, 0x70, 0x40, 0x90, 0xA0, 0xE2, 0xE0, 0x64, 0x0E, 0x70, 0x15, 0x90, 0xA4, 0x13, -+0xE0, 0x70, 0x32, 0x90, 0xA0, 0xDA, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0x12, 0x59, 0xDF, -+0x80, 0x20, 0x90, 0xA0, 0xE2, 0xE0, 0x64, 0x06, 0x70, 0x1B, 0x90, 0xA4, 0x13, 0xE0, 0x60, 0x15, -+0x90, 0xA0, 0xDA, 0xE0, 0x54, 0xBF, 0xF0, 0xB1, 0xDA, 0x44, 0x80, 0xF0, 0x90, 0xA0, 0xE2, 0x74, -+0x04, 0xF0, 0x12, 0x57, 0xE1, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, -+0xF0, 0xE0, 0x22, 0x90, 0xFD, 0x10, 0xEF, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0xA3, 0x92, 0xA3, 0xE0, -+0xFF, 0x90, 0xA3, 0xD6, 0x74, 0x03, 0xF0, 0x7B, 0x06, 0x7D, 0x01, 0x12, 0x85, 0x3D, 0x90, 0xA3, -+0x96, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA3, 0x95, 0xE0, 0xFF, 0x74, 0x10, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0xA3, 0x94, 0xE0, 0xFF, 0x22, 0x7F, -+0xA3, 0x12, 0x4A, 0xB0, 0xEF, 0x54, 0xF8, 0x44, 0x05, 0xFD, 0x7F, 0xA3, 0x12, 0x48, 0xCF, 0x7F, -+0xA0, 0x12, 0x4A, 0xB0, 0xEF, 0x54, 0x0F, 0x64, 0x04, 0x22, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x03, -+0xFF, 0xEC, 0x90, 0xA3, 0x9F, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x9F, 0x22, 0x7F, 0x64, 0x7E, 0x08, -+0x12, 0x4C, 0x5C, 0x90, 0xA3, 0xAD, 0x12, 0x47, 0xC6, 0xE4, 0xFF, 0xFE, 0xFD, 0xEC, 0x54, 0x04, -+0xFC, 0x90, 0xA3, 0x25, 0x22, 0xE5, 0x11, 0x25, 0xE0, 0x24, 0x5B, 0xF5, 0x82, 0xE4, 0x34, 0x42, -+0x22, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0x22, 0x54, 0x01, 0xC4, -+0x33, 0x33, 0x33, 0x54, 0x80, 0x22, 0x90, 0x06, 0xCD, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x06, 0xCF, -+0xE0, 0x44, 0x10, 0x22, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0xA0, 0xE1, 0xE0, 0x90, 0x01, 0xBB, -+0x22, 0x90, 0xA1, 0xF1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA2, 0xF0, 0xE0, 0xFF, 0x22, 0x7F, 0x00, -+0x7E, 0x0C, 0x12, 0x38, 0x07, 0x7F, 0x00, 0x7E, 0x0E, 0x22, 0x74, 0x05, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x22, 0x90, 0xA1, 0x56, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0xA1, 0x42, 0xE0, 0x22, 0x90, 0xA2, -+0xD2, 0x74, 0x09, 0xF0, 0x90, 0xA2, 0xC6, 0x22, 0x74, 0x01, 0x93, 0x95, 0x13, 0xE4, 0x93, 0x95, -+0x12, 0x22, 0xFC, 0xE5, 0x14, 0xC3, 0x13, 0xFE, 0xE5, 0x15, 0x13, 0x22, 0x90, 0x04, 0x1F, 0x74, -+0x20, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0xA1, 0x45, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x90, 0x05, -+0x22, 0xE0, 0x90, 0xA2, 0xF0, 0xF0, 0x22, 0x12, 0x08, 0x6D, 0x75, 0xF0, 0x13, 0xE5, 0x25, 0x22, -+0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0xBC, 0xEF, 0x22, 0x90, 0xA1, 0x53, 0xE0, 0xFF, 0xC4, 0x54, -+0x0F, 0x22, 0xF0, 0x7F, 0x10, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, -+0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0x7F, 0xB4, 0x7E, 0x08, 0x02, 0x38, -+0x07, 0x7F, 0x00, 0x7E, 0x0E, 0x02, 0x38, 0x07, 0x90, 0xA0, 0xDA, 0xE0, 0x44, 0x04, 0xF0, 0x22, -+0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0x22, 0x90, 0x89, 0x07, 0x12, 0x47, 0xDE, 0xE0, 0x22, -+0x90, 0x89, 0x04, 0x12, 0x47, 0xDE, 0xE0, 0x22, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x22, -+0x90, 0xA3, 0xF8, 0xE0, 0xFF, 0x7D, 0x48, 0x22, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, -+0x4D, 0xFF, 0x90, 0xA1, 0x41, 0xF0, 0xEE, 0x22, 0x90, 0xA3, 0xC3, 0x12, 0x47, 0xC6, 0xEF, 0x22, -+0xB2, 0x45, -+}; -+u4Byte ArrayLength_MP_8821A_FW_NIC_BT = 32706; -+ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_NIC_BT( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8821A_FW_NIC_BT; -+#else -+ ODM_MoveMemory(pDM_Odm, pFirmware, Array_MP_8821A_FW_NIC_BT, ArrayLength_MP_8821A_FW_NIC_BT); -+#endif -+ *pFirmwareSize = ArrayLength_MP_8821A_FW_NIC_BT; -+} -+ -+ -+u1Byte Array_MP_8821A_FW_WoWLAN[] = { -+0x01, 0x21, 0x30, 0x00, 0x25, 0x00, 0x00, 0x00, 0x09, 0x08, 0x18, 0x09, 0x90, 0x6A, 0x00, 0x00, -+0xED, 0x24, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x4A, 0x28, 0x02, 0x6F, 0xF8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x70, 0x34, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x87, 0xEC, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x6F, 0xF9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x7F, 0xE0, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x87, 0xEB, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x44, 0xE4, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4A, 0xC7, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x4A, 0xC7, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x45, 0x2D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x45, 0x2C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x45, 0x2D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, -+0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xEF, 0x2B, 0xFF, -+0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, -+0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xE8, 0x8F, 0xF0, 0xA4, 0xCC, 0x8B, 0xF0, 0xA4, -+0x2C, 0xFC, 0xE9, 0x8E, 0xF0, 0xA4, 0x2C, 0xFC, 0x8A, 0xF0, 0xED, 0xA4, 0x2C, 0xFC, 0xEA, 0x8E, -+0xF0, 0xA4, 0xCD, 0xA8, 0xF0, 0x8B, 0xF0, 0xA4, 0x2D, 0xCC, 0x38, 0x25, 0xF0, 0xFD, 0xE9, 0x8F, -+0xF0, 0xA4, 0x2C, 0xCD, 0x35, 0xF0, 0xFC, 0xEB, 0x8E, 0xF0, 0xA4, 0xFE, 0xA9, 0xF0, 0xEB, 0x8F, -+0xF0, 0xA4, 0xCF, 0xC5, 0xF0, 0x2E, 0xCD, 0x39, 0xFE, 0xE4, 0x3C, 0xFC, 0xEA, 0xA4, 0x2D, 0xCE, -+0x35, 0xF0, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, -+0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, -+0x22, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, 0xE8, 0x9C, 0x45, -+0xF0, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE0, 0xF8, -+0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, -+0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, -+0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, -+0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, -+0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0xE3, 0xF5, -+0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x6B, 0xDF, 0xF5, 0x80, 0x67, 0xE3, 0xF5, 0xF0, 0x09, 0xE6, -+0x08, 0xB5, 0xF0, 0x5E, 0xDF, 0xF5, 0x80, 0x5A, 0x87, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x52, -+0xDF, 0xF6, 0x80, 0x4E, 0x87, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x46, 0xDF, 0xF6, 0x80, 0x42, -+0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x36, 0xDF, 0xF6, 0x80, 0x32, -+0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x25, 0xDF, 0xF5, 0x80, -+0x21, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, 0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x14, 0xDF, 0xF5, -+0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x02, -+0xDF, 0xF4, 0x02, 0x49, 0xAD, 0x80, 0x87, 0x80, 0xE9, 0x80, 0x90, 0x80, 0xD4, 0x80, 0x3E, 0x80, -+0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, 0x80, 0xB7, 0x80, 0x8D, 0x80, 0xA3, 0x80, 0x51, 0x80, -+0x74, 0x80, 0x3C, 0x02, 0x49, 0xB9, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, -+0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x76, 0xDF, 0xE3, 0xDE, 0xE1, 0x80, 0x70, 0x89, 0x82, 0x8A, -+0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, 0xB5, 0xF0, 0x62, 0xDF, 0xF4, 0x80, 0x5E, 0x89, -+0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, 0x51, 0xDF, 0xF5, 0x80, 0x4D, -+0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, 0xB5, 0xF0, 0x40, 0xDF, 0xF5, 0x80, -+0x3C, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, 0x2E, 0xDF, -+0xF4, 0x80, 0x2A, 0x80, 0x02, 0x80, 0x57, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, -+0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x06, 0xDF, 0xE4, 0xDE, 0xE2, 0x80, 0x00, 0x7F, 0xFF, 0xB5, -+0xF0, 0x02, 0x0F, 0x22, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, -+0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, -+0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xD5, 0xDF, 0xE5, 0xDE, 0xE3, 0x80, 0xCF, 0x89, 0x82, -+0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, -+0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xAF, 0xDF, 0xE4, -+0xDE, 0xE2, 0x80, 0xA9, 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xAB, 0xED, 0x24, 0x02, -+0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x8E, 0x23, -+0x23, 0x45, 0x82, 0x23, 0x90, 0x48, 0xF5, 0x73, 0x02, 0x4A, 0x66, 0x02, 0x45, 0xBD, 0xE4, 0x93, -+0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, -+0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, -+0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, -+0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x4A, 0xAB, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, -+0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, -+0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, -+0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, -+0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0x41, 0x95, 0xD9, 0x00, 0x41, -+0x95, 0xDA, 0x00, 0x41, 0x95, 0xEA, 0x00, 0x41, 0x95, 0x05, 0x00, 0x41, 0x94, 0xE7, 0x00, 0x44, -+0x95, 0xC9, 0x00, 0x50, 0xF2, 0x01, 0x00, 0x4C, 0xB7, 0x60, 0xD2, 0x67, 0xF9, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xED, 0x12, 0xAA, 0x40, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0xE0, 0xED, 0xF0, 0x90, 0x95, -+0xDF, 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x41, 0x7F, 0x47, 0x71, 0x87, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, 0x51, 0xCD, 0x7F, 0x46, 0x71, 0x87, 0x80, 0x02, 0xC3, -+0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x46, 0xF1, 0xD4, 0x60, 0x0D, 0x7F, 0x45, 0x71, 0x87, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x80, 0x0C, 0x7F, 0x45, 0x71, 0x87, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x45, 0x80, 0x45, 0x90, 0x95, 0xDF, 0xE0, 0x24, 0xF8, 0xF0, -+0x7F, 0x63, 0x71, 0x87, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x51, -+0xCD, 0x7F, 0x62, 0x71, 0x87, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0xF1, -+0xD4, 0x60, 0x0E, 0x71, 0x85, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, -+0x0D, 0x71, 0x85, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x51, 0xCD, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x61, 0x71, 0x94, 0x90, 0x95, 0xDF, 0xE0, 0xFE, 0x74, 0x01, -+0xA8, 0x06, 0x08, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, 0x75, 0x83, 0x00, -+0xE0, 0x90, 0x95, 0xE5, 0x12, 0xAA, 0x40, 0x90, 0x95, 0xE5, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x7F, 0xFF, 0x12, 0x5A, 0xD4, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x5D, 0x94, -+0x7F, 0x00, 0x7E, 0x0C, 0xF1, 0x99, 0x12, 0xA9, 0xD8, 0xF1, 0x99, 0x12, 0xAA, 0x48, 0x91, 0x0E, -+0x71, 0xFB, 0x71, 0xFB, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x51, 0xCD, 0x12, 0xAA, 0x2E, 0x44, 0x40, -+0xF1, 0x9F, 0xF1, 0xFD, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, -+0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x54, 0xFE, 0xFD, 0x7F, 0x02, -+0x51, 0xCD, 0x7F, 0x02, 0x71, 0x94, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x51, 0xCD, 0x7F, 0x02, -+0x71, 0x94, 0xEF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x10, 0x71, 0x94, 0xEF, -+0x44, 0x0C, 0xFD, 0x7F, 0x10, 0x51, 0xCD, 0x7F, 0x72, 0x71, 0x94, 0xEF, 0x54, 0xF3, 0xFD, 0x7F, -+0x72, 0x51, 0xCD, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, -+0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x12, 0xAA, 0x2E, 0x54, -+0xBF, 0xF1, 0xEB, 0xF1, 0xAA, 0xF1, 0xFD, 0x91, 0x0E, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x51, 0xCD, -+0x7F, 0x00, 0x7E, 0x0C, 0xF1, 0xE5, 0xF1, 0xAA, 0x12, 0xA9, 0xD8, 0xF1, 0xE5, 0xF1, 0xAA, 0x12, -+0xAA, 0x48, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x54, 0x71, 0x94, 0xE5, 0x0D, 0x5F, 0xF5, 0x11, -+0x7F, 0x55, 0x71, 0x94, 0xE5, 0x0E, 0x5F, 0xF5, 0x12, 0x7F, 0x56, 0x71, 0x94, 0xE5, 0x0F, 0x5F, -+0xF5, 0x13, 0x7F, 0x57, 0x71, 0x94, 0xE5, 0x10, 0x5F, 0xF5, 0x14, 0xAD, 0x11, 0x7F, 0x54, 0x51, -+0xCD, 0xAD, 0x12, 0x7F, 0x55, 0x51, 0xCD, 0xAD, 0x13, 0x7F, 0x56, 0x51, 0xCD, 0xAD, 0x14, 0x7F, -+0x57, 0x51, 0xCD, 0x53, 0x91, 0xEF, 0x22, 0x7F, 0x81, 0x71, 0x94, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, -+0x81, 0x51, 0xCD, 0x7F, 0x80, 0x71, 0x94, 0xEF, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x51, 0xCD, 0x12, -+0xA0, 0x42, 0x12, 0x3D, 0x3B, 0x12, 0x9D, 0x82, 0xF1, 0xF7, 0x7F, 0x01, 0x12, 0x45, 0xF5, 0x90, -+0x93, 0xC1, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x45, 0xF5, 0x90, 0x93, 0xC1, 0xE0, 0x04, 0xF0, 0x12, -+0x60, 0x1C, 0x12, 0x96, 0xB2, 0x90, 0x01, 0xCC, 0x74, 0x0F, 0xF0, 0x7F, 0x80, 0x71, 0x94, 0xEF, -+0x44, 0x40, 0xFD, 0x7F, 0x80, 0x51, 0xCD, 0x75, 0x28, 0xFF, 0x12, 0x60, 0xCB, 0x12, 0xA0, 0x4F, -+0x12, 0x97, 0xD9, 0x7F, 0x81, 0x71, 0x94, 0xEF, 0x44, 0x04, 0xFD, 0x7F, 0x81, 0x51, 0xCD, 0x12, -+0xA0, 0xC9, 0xE4, 0xFF, 0x02, 0x46, 0x7E, 0xAD, 0x07, 0x90, 0x8F, 0x35, 0xE0, 0x75, 0xF0, 0x40, -+0xA4, 0xFF, 0x90, 0x95, 0x9B, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x8F, -+0x36, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0x90, 0x95, 0x9E, 0xF0, 0x90, 0x8F, 0x37, 0xE0, 0x13, 0x13, -+0x54, 0x01, 0x90, 0x95, 0x9F, 0xF0, 0xED, 0x64, 0x01, 0x70, 0x6E, 0xE0, 0x70, 0x15, 0x90, 0x95, -+0x9B, 0xE0, 0x70, 0x02, 0xA3, 0xE0, 0x60, 0x0B, 0x90, 0x95, 0x9B, 0x74, 0xFF, 0x75, 0xF0, 0xD0, -+0x12, 0x08, 0xD6, 0xB1, 0xDA, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x51, 0xE2, -+0xB1, 0xDA, 0x54, 0x01, 0xFD, 0x51, 0xE2, 0x90, 0x8F, 0x36, 0xE0, 0x30, 0xE0, 0x3B, 0xB1, 0xCA, -+0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x51, 0xE2, 0xE4, 0x90, 0x95, 0x9D, 0xF0, -+0x90, 0x95, 0x9E, 0xE0, 0xFF, 0x90, 0x95, 0x9D, 0xE0, 0xC3, 0x9F, 0x50, 0x1C, 0xB1, 0xCA, 0x54, -+0x01, 0xFD, 0x51, 0xE2, 0xB1, 0xCA, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x51, -+0xE2, 0x90, 0x95, 0x9D, 0xE0, 0x04, 0xF0, 0x80, 0xD7, 0x22, 0x90, 0x95, 0x9B, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x90, 0x95, 0x9F, 0xE0, 0xFD, 0x12, 0xA2, 0x07, 0x90, 0x8F, 0x34, 0xE0, 0x54, 0x7F, -+0xFF, 0x90, 0x8F, 0x33, 0xE0, 0xFE, 0xC4, 0x13, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x12, 0x97, 0x87, 0x12, 0x06, 0x89, 0x20, 0xE0, 0x05, 0x12, 0x94, 0x7A, 0xC1, 0xF8, 0x12, 0xA2, -+0xC8, 0x90, 0x8F, 0x33, 0x12, 0x87, 0x15, 0x12, 0xAA, 0x4F, 0xFF, 0x90, 0x8F, 0x33, 0x12, 0xA3, -+0x7F, 0x12, 0x87, 0x23, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x90, 0x8F, 0x33, 0x12, -+0xA9, 0xC0, 0x12, 0x87, 0x23, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, 0x4D, 0xFF, 0x90, 0x8F, 0x33, -+0x12, 0xAA, 0x25, 0x12, 0x84, 0xB2, 0x54, 0x80, 0xFF, 0x90, 0x8F, 0x34, 0xE0, 0x54, 0x7F, 0x4F, -+0xF0, 0x12, 0x06, 0x89, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, -+0x04, 0xF0, 0x90, 0x93, 0xDC, 0x11, 0x46, 0x12, 0x06, 0x89, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, -+0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x8D, 0x07, 0xE0, 0xB4, 0x02, 0x06, -+0x12, 0x6C, 0x4F, 0x20, 0xE0, 0x64, 0x12, 0x84, 0xB4, 0x54, 0x7F, 0xFF, 0x90, 0x8F, 0x34, 0xE0, -+0x54, 0x80, 0x12, 0x86, 0x50, 0x90, 0x8F, 0x35, 0x12, 0x87, 0x9C, 0xFF, 0x54, 0x01, 0xFE, 0x90, -+0x8F, 0x36, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xEE, 0x54, 0x01, 0x4F, -+0x12, 0x87, 0x94, 0x54, 0x04, 0xFF, 0x90, 0x8F, 0x37, 0xE0, 0x54, 0xFB, 0x4F, 0xF0, 0xB1, 0xDA, -+0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x51, 0xE2, 0x90, 0x8D, 0x07, 0xE0, 0xB4, -+0x01, 0x18, 0x7F, 0x4E, 0x71, 0x94, 0xEF, 0x54, 0xBF, 0xFD, 0x7F, 0x4E, 0x51, 0xCD, 0x7F, 0x4A, -+0x71, 0x94, 0xEF, 0x54, 0xFB, 0xFD, 0x7F, 0x4A, 0x51, 0xCD, 0x90, 0x8D, 0x07, 0xE0, 0xB4, 0x01, -+0x17, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x91, 0x0B, 0x74, 0x05, 0xF0, 0x12, 0x97, -+0xC4, 0x7A, 0x90, 0x79, 0x4A, 0x12, 0x08, 0xAA, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0xD9, -+0x11, 0x4F, 0x90, 0x93, 0xD8, 0xEF, 0xF0, 0x11, 0x58, 0x4F, 0x3A, 0x00, 0x4F, 0x3F, 0x01, 0x4F, -+0x44, 0x03, 0x4F, 0x49, 0x04, 0x4F, 0x4E, 0x12, 0x4F, 0x53, 0x14, 0x4F, 0x58, 0x20, 0x4F, 0x5D, -+0x25, 0x4F, 0x67, 0x80, 0x4F, 0x62, 0x81, 0x4F, 0x6B, 0x82, 0x4F, 0x70, 0x83, 0x4F, 0x75, 0x84, -+0x4F, 0x7F, 0x86, 0x4F, 0x7A, 0x88, 0x00, 0x00, 0x4F, 0x84, 0xF1, 0x94, 0x02, 0x87, 0xA3, 0xF1, -+0x94, 0x02, 0x73, 0x13, 0xF1, 0x94, 0x02, 0xA2, 0xA4, 0xF1, 0x94, 0x02, 0x97, 0x47, 0xF1, 0x94, -+0x02, 0x9D, 0x57, 0xF1, 0x94, 0x02, 0x9F, 0x94, 0xF1, 0x94, 0x02, 0x87, 0x2A, 0xF1, 0x94, 0x02, -+0x9F, 0xA3, 0xF1, 0x94, 0x02, 0x86, 0x58, 0xF1, 0x94, 0xA1, 0xE9, 0xF1, 0x94, 0x02, 0xA4, 0x40, -+0xF1, 0x94, 0x02, 0xA4, 0x56, 0xF1, 0x94, 0x02, 0xA4, 0xB6, 0xF1, 0x94, 0x02, 0xA4, 0xA3, 0xF1, -+0x94, 0x02, 0xA2, 0xD6, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x93, 0xD8, 0xE0, 0x90, -+0x01, 0xC2, 0xF0, 0x22, 0x90, 0x93, 0xD9, 0x01, 0x46, 0x12, 0x37, 0xBC, 0xEF, 0x54, 0xFC, 0xFF, -+0xEC, 0x90, 0x95, 0xB9, 0x12, 0x08, 0x6D, 0x90, 0x95, 0xB9, 0x11, 0x22, 0x90, 0xAA, 0xB9, 0x02, -+0x08, 0x6D, 0x90, 0x01, 0x30, 0xE4, 0xF1, 0xDD, 0x90, 0x01, 0x38, 0xF1, 0xDD, 0xFD, 0x7F, 0x50, -+0x51, 0xCD, 0xE4, 0xFD, 0x7F, 0x51, 0x51, 0xCD, 0xE4, 0xFD, 0x7F, 0x52, 0x51, 0xCD, 0xE4, 0xFD, -+0x7F, 0x53, 0x41, 0xCD, 0x51, 0xCD, 0x90, 0x95, 0xE0, 0xE0, 0x22, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, -+0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0x95, 0xB5, -+0x12, 0x08, 0x6D, 0x90, 0x95, 0xB5, 0x22, 0xE4, 0x90, 0x8D, 0x01, 0x80, 0xDE, 0x7F, 0xB4, 0x7E, -+0x08, 0x02, 0x38, 0x07, 0xF0, 0xE4, 0x90, 0x95, 0x87, 0xF0, 0x90, 0x8F, 0x2A, 0xE0, 0x90, 0x95, -+0x88, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x95, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0x87, 0xE0, 0xF5, 0x3B, 0xA3, 0xE0, -+0xF5, 0x3C, 0x12, 0x35, 0x7A, 0x90, 0x95, 0x83, 0x12, 0x9D, 0x44, 0xA3, 0xA3, 0xA3, 0x74, 0x05, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xF5, 0x58, 0x90, 0x8E, 0xCC, 0xE0, 0x70, 0x02, 0x21, -+0x04, 0x12, 0x72, 0x5E, 0x60, 0x02, 0x21, 0x04, 0x31, 0x06, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x31, 0x1F, 0x78, 0x10, 0x12, 0x08, 0x5A, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0xA3, 0x31, 0x1F, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x12, 0xA8, 0x21, 0x44, 0x80, 0xF0, 0x12, 0xAA, 0x75, 0x60, 0x22, 0x24, 0xFE, 0x60, -+0x03, 0x04, 0x70, 0x1E, 0x90, 0x8E, 0xD3, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, 0x8E, -+0xD5, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x8E, 0xD2, 0xE0, 0xA3, 0xF0, 0x80, 0x00, 0x75, -+0x58, 0x01, 0xE5, 0x58, 0x60, 0x3E, 0x12, 0xA8, 0x19, 0x90, 0x8E, 0xD5, 0xE0, 0x60, 0x04, 0x64, -+0x01, 0x70, 0x13, 0xE4, 0x90, 0x95, 0x87, 0xF0, 0x90, 0x8E, 0xD5, 0xE0, 0xF1, 0xED, 0x11, 0x0E, -+0x90, 0x8E, 0xD5, 0xE0, 0x80, 0x0E, 0xE4, 0x90, 0x95, 0x87, 0x12, 0xA9, 0x77, 0xF1, 0xED, 0x11, -+0x0E, 0x12, 0xA9, 0x78, 0xF1, 0xED, 0x90, 0x8E, 0xE5, 0xF0, 0x90, 0x8E, 0xCF, 0xE0, 0x20, 0xE2, -+0x03, 0x12, 0x58, 0xCC, 0x22, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, -+0x08, 0x12, 0x08, 0x5A, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x90, 0x05, 0x60, 0xE0, -+0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x93, -+0xDC, 0xF0, 0xA3, 0xF0, 0x90, 0x93, 0xE1, 0xF0, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x93, 0xE2, 0xF0, -+0x90, 0x93, 0xBF, 0x12, 0x97, 0xAC, 0x90, 0x93, 0xDC, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x71, 0x3E, -+0xE0, 0x90, 0x91, 0x63, 0xF0, 0x74, 0x01, 0x2F, 0xF1, 0xD5, 0xE0, 0x90, 0x91, 0x64, 0xF0, 0x12, -+0xA9, 0x32, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0x78, 0x10, 0x12, 0x08, 0x5A, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0x12, 0x8F, 0xDB, 0x31, 0x1F, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x8D, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0xF1, 0xCE, 0x31, 0x1F, 0x78, 0x08, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x71, 0x2E, 0x31, 0x1F, 0x12, 0x47, 0x8D, 0x90, 0x91, 0x67, 0x12, 0xA9, 0x2F, 0x31, -+0x1F, 0x78, 0x10, 0x12, 0x08, 0x5A, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x12, 0x8F, -+0xDB, 0x31, 0x1F, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0x12, 0x47, 0x8D, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xF1, 0xCE, 0x31, 0x1F, 0x78, -+0x08, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x71, 0x2E, 0x31, 0x1F, -+0x12, 0x47, 0x8D, 0x90, 0x91, 0x6B, 0x12, 0xA9, 0x2F, 0x31, 0x1F, 0x78, 0x10, 0x12, 0x08, 0x5A, -+0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x12, 0x8F, 0xDB, 0x31, 0x1F, 0x78, 0x18, 0x12, -+0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x8D, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0xF1, 0xCE, 0x31, 0x1F, 0x78, 0x08, 0x12, 0x08, 0x5A, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x71, 0x2E, 0x31, 0x1F, 0x12, 0x47, 0x8D, 0x90, 0x91, 0x6F, -+0x12, 0x08, 0x6D, 0x90, 0x93, 0xDC, 0xE4, 0x75, 0xF0, 0x04, 0xF1, 0xE4, 0x12, 0xA9, 0x83, 0x71, -+0x3E, 0xE0, 0xFF, 0x12, 0xAA, 0x1C, 0xF1, 0x33, 0xE0, 0xB4, 0x10, 0xF0, 0xF1, 0xDD, 0x12, 0xA9, -+0x83, 0x71, 0x3E, 0xE0, 0xFF, 0x74, 0x83, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x91, 0xF1, 0x33, 0xE0, -+0xB4, 0x10, 0xEB, 0xF1, 0xDD, 0x12, 0xA9, 0x83, 0x71, 0x3E, 0xE0, 0xFF, 0x74, 0x93, 0x2E, 0xF5, -+0x82, 0xE4, 0x34, 0x91, 0xF1, 0x33, 0xE0, 0xB4, 0x10, 0xEB, 0xF1, 0xDD, 0x90, 0x93, 0xDE, 0xE0, -+0xFF, 0xC3, 0x94, 0x08, 0x50, 0x1F, 0x90, 0x93, 0xDC, 0xA3, 0xE0, 0xFE, 0xEF, 0x2E, 0x71, 0x3E, -+0xE0, 0xFE, 0x90, 0x93, 0xE2, 0xE0, 0xFD, 0xEE, 0x2D, 0xFE, 0x74, 0xA3, 0x2F, 0x12, 0x9B, 0x44, -+0xEE, 0xF1, 0x36, 0x80, 0xD7, 0x90, 0x93, 0xBF, 0xE0, 0x90, 0x93, 0xE0, 0xF0, 0x90, 0x93, 0xDC, -+0xE4, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x93, 0xDE, 0xE0, 0xFF, 0xC3, 0x94, -+0x10, 0x50, 0x44, 0xEF, 0x12, 0xA9, 0xA3, 0xC0, 0x03, 0xC0, 0x01, 0x90, 0x93, 0xDC, 0xA3, 0xE0, -+0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x20, 0xD0, -+0x01, 0xD0, 0x03, 0x12, 0x5F, 0xEA, 0x12, 0xAA, 0x57, 0x90, 0x93, 0xDC, 0xE0, 0xB4, 0x01, 0x13, -+0xA3, 0xE0, 0xB4, 0x00, 0x0E, 0x90, 0x93, 0xE0, 0xE0, 0x04, 0xF0, 0x12, 0x8E, 0x00, 0xE4, 0xF0, -+0xA3, 0xEF, 0xF0, 0xF1, 0x37, 0x80, 0xB2, 0xE4, 0x90, 0x93, 0xDE, 0xF0, 0xE4, 0xFF, 0x0F, 0xEF, -+0xB4, 0x20, 0xFB, 0xF1, 0x37, 0xE0, 0xB4, 0x10, 0xF3, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x47, -+0x8D, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x90, 0x93, 0xDC, 0xA3, 0xE0, 0x24, 0x00, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x95, 0x89, 0x12, 0x9B, 0x36, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x34, 0x7E, 0x08, 0x12, 0x37, 0xBC, 0x90, 0x95, 0x8B, 0x12, -+0x08, 0x6D, 0x90, 0x95, 0x89, 0xE0, 0x14, 0x60, 0x5E, 0x14, 0x70, 0x02, 0x81, 0x86, 0x24, 0x02, -+0x60, 0x02, 0xA1, 0x15, 0x90, 0x95, 0x2F, 0x12, 0x08, 0x79, 0x00, 0x30, 0x03, 0xC3, 0x90, 0x95, -+0x33, 0x12, 0x08, 0x79, 0x00, 0x30, 0x02, 0x00, 0xB1, 0x87, 0x12, 0x08, 0x79, 0x40, 0x00, 0x00, -+0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xC4, 0xB1, 0x89, 0x12, -+0x08, 0x79, 0x00, 0x1C, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x10, 0x00, 0x00, -+0x7F, 0x64, 0xB1, 0x89, 0x12, 0x08, 0x79, 0x03, 0xC0, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, -+0x79, 0x02, 0x00, 0x00, 0x00, 0x81, 0xF8, 0x90, 0x95, 0x2F, 0x12, 0x08, 0x79, 0x00, 0x30, 0x03, -+0xC3, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x30, 0x02, 0x01, 0xB1, 0x87, 0x12, 0x08, 0x79, -+0x40, 0x00, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xC4, -+0xB1, 0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x3C, 0x90, 0x95, 0x8A, 0x31, 0x1F, 0xB1, 0x7C, -+0x12, 0x08, 0x79, 0xF0, 0x00, 0x00, 0x00, 0x90, 0x95, 0x8A, 0x31, 0x1F, 0xF1, 0xC3, 0x7F, 0x38, -+0xB1, 0x89, 0x12, 0x08, 0x79, 0x00, 0x1C, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, -+0x08, 0x00, 0x00, 0x12, 0xA9, 0x4B, 0x60, 0x13, 0x12, 0x08, 0x79, 0x03, 0xC0, 0x00, 0x00, 0x90, -+0x95, 0x33, 0x12, 0x08, 0x79, 0x01, 0x80, 0x00, 0x00, 0x80, 0x11, 0x12, 0x08, 0x79, 0x03, 0xC0, -+0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x02, 0x00, 0x00, 0x00, 0x7F, 0x48, 0x7E, 0x08, -+0xB1, 0x1A, 0x90, 0x95, 0x8A, 0xE0, 0x90, 0x95, 0x2F, 0xB4, 0x01, 0x13, 0x12, 0x08, 0x79, 0x00, -+0x00, 0x00, 0x10, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x10, 0x80, 0x11, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x00, 0x10, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, -+0x7F, 0x00, 0x7E, 0x0A, 0xA1, 0x13, 0x90, 0x95, 0x2F, 0x12, 0x08, 0x79, 0x00, 0x30, 0x03, 0xC3, -+0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x30, 0x02, 0x02, 0xB1, 0x87, 0x12, 0x08, 0x79, 0x40, -+0x00, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x40, 0x00, 0x00, 0x00, 0x7F, 0xC4, 0xB1, -+0x89, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x3C, 0x90, 0x95, 0x8A, 0x31, 0x1F, 0xB1, 0x7C, 0x12, -+0x08, 0x79, 0xF0, 0x00, 0x00, 0x00, 0x90, 0x95, 0x8A, 0x31, 0x1F, 0xF1, 0xC3, 0x7F, 0x38, 0xB1, -+0x89, 0x12, 0x08, 0x79, 0x00, 0x1C, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x08, -+0x00, 0x00, 0x12, 0xA9, 0x4B, 0x60, 0x17, 0x12, 0x08, 0x79, 0x03, 0xC0, 0x00, 0x00, 0x90, 0x95, -+0x33, 0x12, 0x08, 0x79, 0x01, 0x40, 0x00, 0x00, 0x7F, 0x48, 0x7E, 0x08, 0x80, 0x15, 0x12, 0x08, -+0x79, 0x03, 0xC0, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x01, 0xC0, 0x00, 0x00, 0x7F, -+0x48, 0x7E, 0x08, 0xB1, 0x1A, 0x22, 0x7F, 0x58, 0x7E, 0x0C, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x95, 0x2D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x37, 0xBC, 0x90, 0x95, 0x37, 0x12, -+0x08, 0x6D, 0x90, 0x95, 0x2F, 0x12, 0x48, 0x22, 0x12, 0x08, 0x3A, 0x90, 0x95, 0x37, 0x12, 0x8B, -+0xCB, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x95, 0x2F, 0x12, 0x48, 0x22, 0x90, -+0x95, 0x33, 0x12, 0x8B, 0xCB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, -+0x90, 0x95, 0x3B, 0x12, 0x08, 0x6D, 0x90, 0x95, 0x3B, 0x12, 0x4F, 0xAA, 0x90, 0x95, 0x2D, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x38, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x78, 0x02, 0x12, 0x08, -+0x5A, 0x90, 0x95, 0x33, 0x12, 0x08, 0x6D, 0x7F, 0xAC, 0x7E, 0x08, 0xB1, 0x1A, 0x90, 0x95, 0x2F, -+0x22, 0xEF, 0x90, 0x95, 0x2F, 0x70, 0x2A, 0x12, 0x08, 0x79, 0x00, 0x00, 0xF0, 0x00, 0x90, 0x95, -+0x33, 0x12, 0x08, 0x79, 0x00, 0x00, 0x70, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, 0xB1, 0x8B, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x00, 0xF0, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x70, 0x80, -+0x28, 0x12, 0x08, 0x79, 0x00, 0x00, 0xF0, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x50, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, 0xB1, 0x8B, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0xF0, 0x90, -+0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x40, 0x7F, 0xB0, 0x7E, 0x0C, 0xB1, 0x8B, 0x12, -+0x08, 0x79, 0x00, 0x10, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, -+0x7F, 0xB4, 0x7E, 0x0C, 0xB1, 0x8B, 0x12, 0x08, 0x79, 0x00, 0x40, 0x00, 0x00, 0x90, 0x95, 0x33, -+0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0xB1, 0x8B, 0x12, 0x08, 0x79, -+0x00, 0x00, 0x00, 0x07, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x07, 0x7F, 0xB0, -+0x7E, 0x0C, 0xB1, 0x8B, 0x12, 0x08, 0x79, 0x00, 0x00, 0x07, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x07, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, 0xA1, 0x1A, 0x90, 0x95, 0xD7, 0xED, 0xF0, -+0x90, 0x95, 0xD6, 0xEF, 0xF0, 0x70, 0x75, 0x90, 0x95, 0x2F, 0x12, 0x08, 0x79, 0x30, 0x00, 0x00, -+0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0xB1, -+0x8B, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0F, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x00, 0x00, 0xF1, 0x3E, 0x12, 0x08, 0x79, 0x30, 0x00, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, -+0x79, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0xB1, 0x8B, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x00, 0xF0, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x10, 0x7F, 0x0C, 0xB1, 0x89, -+0x12, 0x08, 0x79, 0x0F, 0x00, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x01, 0x00, 0x00, -+0x00, 0xF1, 0xF4, 0x90, 0x04, 0x54, 0xE0, 0x54, 0x7F, 0x02, 0xAA, 0x12, 0x90, 0x95, 0xD6, 0xE0, -+0x64, 0x01, 0x70, 0x5E, 0x90, 0x04, 0x54, 0xE0, 0x44, 0x80, 0x12, 0xAA, 0x12, 0x90, 0x95, 0x2F, -+0x12, 0x08, 0x79, 0x30, 0x00, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x30, 0x00, 0x00, -+0x00, 0x74, 0x08, 0xFF, 0xFE, 0xB1, 0x8B, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0F, 0x00, 0x90, 0x95, -+0x33, 0x12, 0x08, 0x79, 0x00, 0x00, 0x01, 0x00, 0xF1, 0x3E, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, -+0xF0, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x0C, 0xB1, 0x89, 0x12, -+0x08, 0x79, 0x0F, 0x00, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x0F, 0x00, 0x00, 0x00, -+0xF1, 0xF4, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0xDE, 0xE0, 0x04, 0xF0, 0x22, 0x7F, 0x1C, -+0x7E, 0x0C, 0xB1, 0x1A, 0x90, 0x95, 0xD6, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xB1, 0x91, 0x90, 0x95, -+0x2F, 0x22, 0x90, 0x8E, 0xB2, 0x12, 0x77, 0xF0, 0x30, 0xE0, 0x08, 0x12, 0x97, 0x94, 0xE4, 0x90, -+0x95, 0x04, 0xF0, 0x90, 0x95, 0x2F, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x94, 0xEA, -+0x31, 0x1F, 0xF1, 0xC8, 0x7F, 0x50, 0x7E, 0x0C, 0xB1, 0x8B, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, -+0x7F, 0x90, 0x94, 0xEB, 0x31, 0x1F, 0xF1, 0xC8, 0xB1, 0x16, 0x90, 0x95, 0x00, 0xE0, 0x90, 0x06, -+0x08, 0xF0, 0x90, 0x95, 0x02, 0xA3, 0xE0, 0x90, 0x06, 0xA0, 0xF0, 0xA3, 0xE4, 0xF0, 0x90, 0x94, -+0xEE, 0xE0, 0xFF, 0x60, 0x0D, 0x90, 0x94, 0xF0, 0xE0, 0xFD, 0x90, 0x94, 0xEF, 0xE0, 0xFB, 0x12, -+0x8C, 0x4F, 0x90, 0x94, 0xED, 0xE0, 0xFF, 0x60, 0x09, 0x12, 0x9D, 0x34, 0x12, 0x9D, 0x3B, 0x12, -+0x88, 0xE6, 0x22, 0x78, 0x1C, 0x12, 0x08, 0x5A, 0x90, 0x95, 0x33, 0x02, 0x08, 0x6D, 0x90, 0x93, -+0xDC, 0xA3, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x93, 0xDC, -+0xE4, 0x75, 0xF0, 0x10, 0x12, 0x08, 0xD6, 0xE4, 0x90, 0x93, 0xDE, 0xF0, 0x22, 0xFF, 0x90, 0x8E, -+0xD4, 0xE0, 0x2F, 0x22, 0x7F, 0x04, 0x7E, 0x0A, 0xA1, 0x1A, 0x01, 0x46, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x11, 0x37, 0x30, 0xE6, 0x2A, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x95, 0xCD, 0xF0, -+0x7F, 0x8D, 0x12, 0x4B, 0x94, 0x90, 0x95, 0xCE, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0x95, -+0xCF, 0xF0, 0x90, 0x95, 0xCE, 0xE0, 0x11, 0x37, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, -+0x4A, 0xCD, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x8F, 0x12, 0x4B, 0x94, 0xEF, 0x22, 0x90, 0x8E, -+0xCE, 0xE0, 0x90, 0x95, 0x01, 0xF0, 0x7D, 0x02, 0x7F, 0x02, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x95, 0xEB, 0xEF, 0xF0, 0x14, 0x60, 0x15, 0x14, 0x60, 0x19, 0x24, 0x02, 0x70, 0x1A, -+0xED, 0x54, 0x01, 0xFF, 0x90, 0x8E, 0xC7, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x80, 0x0C, 0x90, 0x8E, -+0xCF, 0xED, 0xF0, 0x80, 0x05, 0x90, 0x8E, 0xCE, 0xED, 0xF0, 0x11, 0x37, 0x30, 0xE4, 0x31, 0x90, -+0x95, 0xEB, 0xE0, 0x14, 0x60, 0x07, 0x14, 0x60, 0x1D, 0x24, 0x02, 0x70, 0x23, 0x90, 0x8E, 0xC7, -+0xE0, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0xFF, 0x90, 0x8E, 0xCF, 0xE0, 0x54, 0x7F, -+0x4F, 0xFD, 0x7F, 0x88, 0x80, 0x07, 0x90, 0x8E, 0xCE, 0xE0, 0xFD, 0x7F, 0x89, 0x12, 0x4A, 0xCD, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, 0xEC, 0xEF, 0xF0, 0x12, 0x4C, 0x14, 0x90, 0x95, 0xEC, -+0xE0, 0x60, 0x03, 0x12, 0x77, 0xE3, 0x7D, 0x04, 0x7F, 0x01, 0x01, 0x4A, 0x7D, 0x01, 0x7F, 0x04, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0xED, 0xED, 0xF0, 0x90, 0x8E, 0xC7, 0xE0, -+0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x41, 0x18, 0xEE, 0x12, 0x6C, 0x53, 0x30, -+0xE0, 0x02, 0x41, 0x18, 0x90, 0x8E, 0xCF, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x41, 0x18, 0xEF, 0x70, -+0x02, 0x21, 0x8E, 0x24, 0xFE, 0x70, 0x02, 0x21, 0xC7, 0x24, 0xFE, 0x60, 0x49, 0x24, 0xFC, 0x70, -+0x02, 0x41, 0x02, 0x24, 0xFC, 0x60, 0x02, 0x41, 0x12, 0xEE, 0xB4, 0x0E, 0x02, 0x51, 0x62, 0x90, -+0x8E, 0xCF, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x11, 0xB5, 0x90, 0x8E, 0xCF, 0xE0, 0xB4, 0x06, 0x02, -+0x51, 0x7D, 0x90, 0x8E, 0xCF, 0xE0, 0xB4, 0x04, 0x0E, 0x90, 0x95, 0xED, 0xE0, 0xFF, 0x60, 0x04, -+0xF1, 0x14, 0x80, 0x03, 0x12, 0x76, 0x0C, 0x90, 0x8E, 0xCF, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x41, -+0x12, 0x12, 0xA8, 0x3B, 0x41, 0x12, 0x90, 0x8E, 0xCF, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x11, 0xB5, -+0x90, 0x8E, 0xCF, 0xE0, 0xB4, 0x06, 0x02, 0x51, 0x7D, 0x90, 0x8E, 0xCF, 0xE0, 0xB4, 0x0E, 0x07, -+0x51, 0x1D, 0xBF, 0x01, 0x02, 0x51, 0x62, 0x90, 0x8E, 0xCF, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x41, -+0x12, 0x51, 0x1D, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x41, 0x12, 0x51, 0x9E, 0x41, 0x12, 0x90, 0x8E, -+0xCF, 0xE0, 0xB4, 0x0E, 0x07, 0x51, 0x1D, 0xBF, 0x01, 0x02, 0x51, 0x62, 0x90, 0x8E, 0xCF, 0xE0, -+0xB4, 0x06, 0x02, 0x51, 0x7D, 0x90, 0x8E, 0xCF, 0xE0, 0xB4, 0x0C, 0x07, 0x51, 0x1D, 0xBF, 0x01, -+0x02, 0x51, 0x9E, 0x90, 0x8E, 0xCF, 0xE0, 0x64, 0x04, 0x70, 0x57, 0x12, 0xA6, 0xC4, 0xEF, 0x64, -+0x01, 0x70, 0x4F, 0xD1, 0x04, 0x80, 0x4B, 0x90, 0x8E, 0xCF, 0xE0, 0xB4, 0x0E, 0x07, 0x51, 0x1D, -+0xBF, 0x01, 0x02, 0x51, 0x62, 0x90, 0x8E, 0xCF, 0xE0, 0xB4, 0x06, 0x02, 0x51, 0x7D, 0x90, 0x8E, -+0xCF, 0xE0, 0xB4, 0x0C, 0x07, 0x51, 0x1D, 0xBF, 0x01, 0x02, 0x51, 0x9E, 0x90, 0x8E, 0xCF, 0xE0, -+0x70, 0x04, 0x7F, 0x01, 0x11, 0xB5, 0x90, 0x8E, 0xCF, 0xE0, 0xB4, 0x04, 0x15, 0x12, 0xA7, 0x8F, -+0x80, 0x10, 0x90, 0x8E, 0xCF, 0xE0, 0xB4, 0x0C, 0x09, 0x12, 0x77, 0xED, 0x30, 0xE0, 0x03, 0x12, -+0xA8, 0x2F, 0x90, 0x8E, 0xCF, 0x12, 0xA9, 0xB2, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xA6, 0xAB, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x5B, 0x01, 0x80, -+0x1E, 0x12, 0x7F, 0xBA, 0x30, 0xE0, 0x05, 0x75, 0x5B, 0x02, 0x80, 0x13, 0x90, 0x8E, 0xCE, 0xE0, -+0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x5B, 0x08, 0x80, 0x05, 0x12, 0xA7, 0x5A, 0x80, 0x0E, 0x90, -+0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x5B, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x8E, 0xC8, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x04, 0x7D, 0x0C, 0x80, 0x05, 0x12, -+0xA6, 0x63, 0x7D, 0x04, 0x7F, 0x01, 0x11, 0x4A, 0xE4, 0xFD, 0xFF, 0x80, 0x57, 0x90, 0x8E, 0xC8, -+0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x08, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x04, 0x80, 0x06, 0xE0, -+0x54, 0x7F, 0xF0, 0x7D, 0x0C, 0x7F, 0x01, 0x11, 0x4A, 0xE4, 0xFD, 0xFF, 0x80, 0x36, 0x12, 0x72, -+0x5E, 0x70, 0x27, 0x90, 0x8E, 0xC8, 0xE0, 0x54, 0xFD, 0xF0, 0x7D, 0x2C, 0x7F, 0x6F, 0x51, 0xD4, -+0x7D, 0x08, 0x7F, 0x01, 0xD1, 0x21, 0xBF, 0x01, 0x0D, 0x90, 0x8E, 0xC7, 0xE0, 0x44, 0x80, 0xF0, -+0x7D, 0x0E, 0x7F, 0x01, 0x01, 0x4A, 0xF1, 0xF8, 0x04, 0xF0, 0x22, 0xE4, 0xFD, 0x7F, 0x0C, 0x11, -+0xD0, 0xE4, 0xFD, 0xFF, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x8D, 0x05, 0xED, 0xF0, 0x22, 0x90, -+0x94, 0x05, 0x12, 0x48, 0x4F, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x94, 0x16, 0xF0, 0x90, 0x04, 0x1D, -+0xE0, 0x60, 0x0B, 0x7D, 0x39, 0xB1, 0x90, 0xEF, 0x64, 0x01, 0x70, 0x1B, 0x80, 0x00, 0x90, 0x93, -+0xB3, 0xE0, 0xFF, 0x90, 0x95, 0xB4, 0x74, 0x11, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0xD1, 0x6E, 0x90, -+0x94, 0x13, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x94, 0x13, 0x12, 0x92, 0x23, 0x90, 0x94, 0x15, -+0xEF, 0xF0, 0x90, 0x94, 0x13, 0x12, 0x93, 0xC0, 0x7B, 0x01, 0x90, 0x94, 0x11, 0xE0, 0xFD, 0x12, -+0x92, 0x69, 0x90, 0x94, 0x12, 0xE0, 0x60, 0x02, 0x61, 0xBC, 0xB1, 0xF7, 0xC0, 0x03, 0xC0, 0x02, -+0xC0, 0x01, 0x90, 0x94, 0x08, 0xB1, 0x86, 0x75, 0x43, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, -+0x91, 0x57, 0x12, 0xA9, 0x99, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x94, 0x05, 0xB1, 0x86, -+0x75, 0x43, 0x10, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x91, 0x57, 0xB1, 0xFA, 0xC0, 0x03, 0xC0, -+0x02, 0xC0, 0x01, 0xB1, 0x83, 0x75, 0x43, 0x10, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x91, 0x57, -+0x24, 0x60, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xB1, -+0x83, 0x75, 0x43, 0x10, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x91, 0x57, 0x24, 0x72, 0xF9, 0xE4, -+0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x94, 0x0E, 0xB1, 0x86, -+0x75, 0x43, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x90, 0x94, 0x0B, 0x12, -+0x48, 0x46, 0x90, 0x94, 0x42, 0x12, 0x48, 0x4F, 0x90, 0x94, 0x45, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x00, 0x20, 0x90, 0x94, 0x49, 0x74, 0x3A, 0xF0, 0x90, 0x94, 0x05, 0x12, 0x48, 0x46, 0x12, 0xA3, -+0xDD, 0x91, 0x5A, 0x24, 0x30, 0xF9, 0xE4, 0x34, 0xFC, 0xF1, 0xB7, 0x75, 0x43, 0x28, 0x7B, 0x01, -+0x7A, 0x94, 0x79, 0x17, 0x91, 0x57, 0x12, 0xAA, 0x08, 0xC0, 0x03, 0x8B, 0x40, 0x75, 0x41, 0x8F, -+0x75, 0x42, 0xD9, 0x75, 0x43, 0x28, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x90, 0x94, 0x15, 0xE0, 0xFF, -+0x90, 0x94, 0x14, 0xE0, 0x2F, 0xFF, 0x90, 0x94, 0x13, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x30, 0xFD, -+0xE4, 0x3F, 0xFC, 0x90, 0x93, 0xB3, 0xE0, 0xFB, 0x7F, 0x3A, 0x12, 0x90, 0x09, 0x91, 0x5A, 0x12, -+0xAA, 0x08, 0xC0, 0x03, 0x8B, 0x40, 0x75, 0x41, 0x94, 0x75, 0x42, 0x17, 0x75, 0x43, 0x28, 0xD0, -+0x03, 0x12, 0x34, 0x62, 0x90, 0x06, 0x33, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x94, 0x16, 0xE0, 0xFF, -+0x7D, 0x3A, 0x51, 0xD4, 0x02, 0x97, 0xD2, 0x12, 0x34, 0x62, 0x90, 0x94, 0x13, 0xA3, 0xE0, 0xFF, -+0xA3, 0xE0, 0x2F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0x3F, 0x12, 0x48, -+0x4F, 0x78, 0x4B, 0x7C, 0x95, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x64, 0x12, 0x7B, 0xDF, -+0x90, 0x05, 0x22, 0xE0, 0x90, 0x95, 0x4A, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0B, 0x7D, 0x33, -+0xB1, 0x90, 0xEF, 0x64, 0x01, 0x70, 0x1B, 0x80, 0x00, 0x90, 0x93, 0xB2, 0xE0, 0xFF, 0x90, 0x95, -+0xB4, 0x74, 0x10, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0xD1, 0x6E, 0x90, 0x95, 0x47, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x95, 0x47, 0x12, 0x92, 0x23, 0x90, 0x95, 0x49, 0xEF, 0xF0, 0x90, 0x95, 0x47, -+0x12, 0x93, 0xC0, 0x7B, 0x01, 0x90, 0x95, 0x45, 0xE0, 0xFD, 0x12, 0x92, 0x69, 0x90, 0x95, 0x46, -+0xE0, 0x70, 0x4E, 0xB1, 0xF7, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x95, 0x42, 0xB1, 0x86, -+0x75, 0x43, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0xB1, 0xF0, 0x91, 0x5D, 0xF1, 0xF1, 0xFA, -+0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x95, 0x42, 0xB1, 0x86, 0x75, 0x43, 0x06, -+0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0xB1, 0xF0, 0x91, 0x5D, 0x12, 0xA9, 0x99, 0xC0, 0x03, 0xC0, -+0x02, 0xC0, 0x01, 0x90, 0x95, 0x3F, 0xB1, 0x86, 0x75, 0x43, 0x04, 0xD0, 0x01, 0xD0, 0x02, 0x80, -+0x45, 0x90, 0x95, 0x46, 0xE0, 0x64, 0x01, 0x70, 0x42, 0xB1, 0xF7, 0xC0, 0x03, 0x8B, 0x40, 0x75, -+0x41, 0x8F, 0x75, 0x42, 0x55, 0x75, 0x43, 0x06, 0xD0, 0x03, 0xB1, 0xF0, 0x91, 0x5D, 0xF1, 0xF1, -+0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x40, 0x75, 0x41, 0x8F, 0x75, 0x42, 0x5F, 0x75, 0x43, 0x06, -+0xD0, 0x03, 0xB1, 0xF0, 0x91, 0x5D, 0x12, 0xA9, 0x99, 0xC0, 0x03, 0x8B, 0x40, 0x75, 0x41, 0x8F, -+0x75, 0x42, 0x65, 0x75, 0x43, 0x04, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x90, 0x06, 0x30, 0xE0, 0x44, -+0x10, 0xF0, 0x90, 0x95, 0x4A, 0xE0, 0xFF, 0x7D, 0x34, 0x51, 0xD4, 0x12, 0x97, 0xD2, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0x94, 0x0B, 0x12, 0x48, 0x46, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x22, -+0x7F, 0xFF, 0x51, 0xD4, 0xE4, 0x90, 0x95, 0xD3, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, -+0x95, 0xD5, 0xF0, 0x7D, 0x47, 0x7F, 0xFF, 0x51, 0xD4, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x14, 0xA3, -+0xE0, 0x70, 0x10, 0xA3, 0xE0, 0x70, 0x0C, 0xA3, 0xE0, 0x70, 0x08, 0x12, 0xAA, 0x85, 0x51, 0xD4, -+0x7F, 0x01, 0x22, 0xD3, 0x90, 0x95, 0xD4, 0xE0, 0x94, 0xE8, 0x90, 0x95, 0xD3, 0xE0, 0x94, 0x03, -+0x40, 0x0F, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0xAA, 0x85, 0x51, 0xD4, 0x7F, 0x00, -+0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x95, 0xD3, 0x12, 0x62, 0x6B, 0x80, 0xB9, -+0x12, 0x34, 0x62, 0x90, 0x95, 0x47, 0x22, 0xA3, 0xA3, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, -+0xFA, 0x7B, 0x01, 0x22, 0x7D, 0x2D, 0xB1, 0x90, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, -+0x03, 0x12, 0x74, 0x6A, 0x12, 0x4B, 0xB6, 0xE4, 0xFD, 0x7F, 0x01, 0x01, 0x4A, 0x7D, 0x08, 0xE4, -+0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0xA0, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, -+0x90, 0x8D, 0x03, 0xE0, 0x04, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x22, 0x90, 0x05, 0x22, 0xE0, -+0x90, 0x95, 0xA4, 0xF0, 0x7D, 0x26, 0xB1, 0x90, 0xEF, 0x64, 0x01, 0x70, 0x03, 0x12, 0xA8, 0x45, -+0x90, 0x95, 0xA4, 0xE0, 0xFF, 0x7D, 0x27, 0x51, 0xD4, 0x12, 0xA5, 0xF6, 0x80, 0x06, 0x12, 0xA5, -+0xF6, 0x12, 0xA8, 0x45, 0x12, 0x97, 0xD2, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0xB2, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x95, 0xB1, -+0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0x8F, 0x9F, 0x90, 0x95, 0xB1, 0xE0, 0x90, 0x04, 0x25, 0xF0, -+0x90, 0x95, 0xB2, 0xE0, 0x60, 0x06, 0x12, 0xA9, 0xF0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x12, 0xA9, 0xF0, 0x54, -+0xC0, 0xF0, 0x90, 0x95, 0xB4, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x8B, 0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, 0x40, 0x08, -+0x12, 0xAA, 0x37, 0x74, 0x04, 0xF0, 0x80, 0x05, 0x12, 0xAA, 0x37, 0xE4, 0xF0, 0xAF, 0x05, 0x12, -+0xA8, 0xE1, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x95, 0xB3, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xEE, -+0x44, 0x02, 0x4B, 0xFE, 0x12, 0xA8, 0xE1, 0xEE, 0xF0, 0x74, 0x11, 0x2F, 0x12, 0xA8, 0xEC, 0x74, -+0xFF, 0xF0, 0x74, 0x29, 0x2F, 0x12, 0x8F, 0xA9, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x60, 0x30, 0x12, 0x72, 0x5E, 0x70, 0x2B, 0x90, 0x8E, 0xC8, 0xE0, -+0x54, 0xFE, 0xF0, 0x7D, 0x2B, 0x7F, 0x0F, 0x51, 0xD4, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, -+0xD1, 0x1D, 0xBF, 0x01, 0x0D, 0x90, 0x8E, 0xC7, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x06, 0x7F, 0x01, -+0x01, 0x4A, 0xF1, 0xF8, 0x74, 0x08, 0xF0, 0x22, 0x12, 0x8E, 0x02, 0xE4, 0x12, 0x9E, 0xCA, 0x12, -+0x92, 0x23, 0x90, 0x93, 0xDE, 0xEF, 0xF0, 0x90, 0x93, 0xDC, 0xA3, 0xE0, 0x24, 0x38, 0xF9, 0xE4, -+0x34, 0xFC, 0xF1, 0xB7, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x55, 0xF1, 0xEA, 0x91, -+0x5D, 0x24, 0x3E, 0xF9, 0xE4, 0x34, 0xFC, 0xF1, 0xB7, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x8F, -+0x79, 0x5B, 0xF1, 0xEA, 0x91, 0x5D, 0xF1, 0xF1, 0xF1, 0xB7, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, -+0x8F, 0x79, 0x5F, 0xF1, 0xEA, 0x91, 0x5D, 0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0xF1, 0xB7, 0x75, -+0x43, 0x04, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x65, 0x02, 0x34, 0x62, 0x12, 0x8D, 0x3F, 0x7E, 0x00, -+0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, 0x22, 0x12, -+0xA5, 0x10, 0x90, 0x8E, 0xCF, 0xE0, 0x64, 0x0C, 0x60, 0x04, 0x51, 0xCB, 0xD1, 0x1D, 0x22, 0x90, -+0x8E, 0xCC, 0xE0, 0x64, 0x01, 0x70, 0x12, 0x12, 0x73, 0xD5, 0x60, 0x05, 0x51, 0xCB, 0x02, 0xA5, -+0x10, 0x90, 0x8E, 0xCF, 0xE0, 0x70, 0x02, 0x11, 0xCC, 0x22, 0x12, 0x34, 0x62, 0x90, 0x93, 0xDC, -+0x22, 0x24, 0x42, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, -+0xB8, 0x22, 0x7F, 0xF4, 0x12, 0x4B, 0x94, 0xEF, 0x20, 0xE5, 0x0E, 0x7F, 0xF4, 0x12, 0x4B, 0x94, -+0xEF, 0x7F, 0x01, 0x20, 0xE4, 0x05, 0x7F, 0x02, 0x22, 0x7F, 0x03, 0x22, 0x11, 0x02, 0x90, 0x8D, -+0x07, 0xEF, 0xF0, 0x11, 0x35, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, -+0x80, 0xF0, 0x02, 0x36, 0x83, 0x12, 0x4F, 0xB2, 0x11, 0xA2, 0x11, 0x64, 0x11, 0x83, 0xE4, 0xF5, -+0x0D, 0xF5, 0x0E, 0xF5, 0x0F, 0x75, 0x10, 0x80, 0xAD, 0x0D, 0x7F, 0x50, 0x12, 0x4A, 0xCD, 0xAD, -+0x0E, 0x7F, 0x51, 0x12, 0x4A, 0xCD, 0xAD, 0x0F, 0x7F, 0x52, 0x12, 0x4A, 0xCD, 0xAD, 0x10, 0x7F, -+0x53, 0x02, 0x4A, 0xCD, 0x75, 0x15, 0x10, 0xE4, 0xF5, 0x16, 0x75, 0x17, 0x07, 0x75, 0x18, 0x42, -+0x90, 0x01, 0x30, 0xE5, 0x15, 0xF0, 0xA3, 0xE5, 0x16, 0xF0, 0xA3, 0xE5, 0x17, 0xF0, 0xA3, 0xE5, -+0x18, 0xF0, 0x22, 0x75, 0x1D, 0x07, 0x75, 0x1E, 0x01, 0x75, 0x1F, 0x03, 0x75, 0x20, 0x62, 0x90, -+0x01, 0x38, 0xE5, 0x1D, 0xF0, 0xA3, 0xE5, 0x1E, 0xF0, 0xA3, 0xE5, 0x1F, 0xF0, 0xA3, 0xE5, 0x20, -+0xF0, 0x22, 0x90, 0x01, 0x34, 0x74, 0xFF, 0x12, 0x4F, 0xDD, 0x90, 0x01, 0x3C, 0x12, 0x4F, 0xDD, -+0xFD, 0x7F, 0x54, 0x12, 0x4A, 0xCD, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x4A, 0xCD, 0x7D, 0xFF, 0x7F, -+0x56, 0x12, 0x4A, 0xCD, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x4A, 0xCD, 0x75, 0xE8, 0x03, 0x75, 0xA8, -+0x85, 0x22, 0xE4, 0x90, 0x93, 0xD6, 0xF0, 0x90, 0x93, 0xD6, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0xD2, -+0x90, 0x01, 0xC4, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0x12, 0x3D, 0x6E, 0xBF, 0x01, 0x03, 0x12, 0x31, -+0x38, 0x90, 0x8E, 0xCC, 0xE0, 0x60, 0x0F, 0x90, 0x8E, 0xCF, 0xE0, 0xFF, 0x90, 0x8E, 0xCE, 0xE0, -+0x6F, 0x60, 0x03, 0x12, 0x73, 0xE4, 0xC2, 0xAF, 0x12, 0xA0, 0xA2, 0xBF, 0x01, 0x02, 0x31, 0x1A, -+0xD2, 0xAF, 0x12, 0x57, 0xFC, 0x12, 0x45, 0x2D, 0x80, 0xBD, 0x90, 0x8E, 0xC7, 0xE0, 0x30, 0xE0, -+0x02, 0x31, 0x24, 0x22, 0x90, 0x8E, 0xCF, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0D, 0x51, 0x06, -+0xBF, 0x01, 0x08, 0x31, 0x3C, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x31, 0xB6, 0x31, 0x4C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0xA1, 0xDD, 0x7F, -+0x08, 0x12, 0x4B, 0x94, 0xEF, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x4A, 0xCD, 0xE4, 0xFF, 0x31, -+0x69, 0x90, 0x8E, 0xC8, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x90, 0x95, 0xD0, 0x12, 0x7F, 0xA2, 0x90, -+0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x95, 0xD0, 0xE0, 0x6F, 0x60, -+0x34, 0xC3, 0x90, 0x95, 0xD2, 0xE0, 0x94, 0x88, 0x90, 0x95, 0xD1, 0xE0, 0x94, 0x13, 0x40, 0x08, -+0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x95, 0xD1, 0x51, 0x6B, 0xF1, 0xF2, 0xD3, -+0x90, 0x95, 0xD2, 0xE0, 0x94, 0x32, 0x90, 0x95, 0xD1, 0xE0, 0x94, 0x00, 0x40, 0xC1, 0x90, 0x01, -+0xC6, 0xE0, 0x30, 0xE0, 0xBA, 0x22, 0x90, 0x8E, 0xC8, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x8E, 0xD7, -+0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x4A, 0xCD, 0x90, 0x8E, 0xCD, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, -+0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x7F, -+0x08, 0x12, 0x4B, 0x94, 0xEF, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x4A, 0xCD, 0x7F, 0x01, 0x31, -+0x69, 0x7F, 0x90, 0x12, 0x4B, 0x94, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x4A, 0xCD, 0x7F, -+0x14, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, -+0x00, 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, 0x51, 0x01, 0x80, 0x41, 0x90, 0x8F, 0x30, 0xE0, 0x30, -+0xE0, 0x0B, 0x90, 0x02, 0x82, 0xE0, 0x60, 0x05, 0x75, 0x51, 0x02, 0x80, 0x2F, 0x90, 0x8F, 0x39, -+0xE0, 0x30, 0xE0, 0x05, 0x75, 0x51, 0x08, 0x80, 0x23, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, -+0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x51, 0x04, 0x80, 0x0E, 0x90, 0x04, -+0x1D, 0xE0, 0x60, 0x05, 0x75, 0x51, 0x40, 0x80, 0x03, 0x02, 0xA7, 0x5A, 0x90, 0x01, 0xB9, 0x74, -+0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x51, 0xF0, 0x7F, 0x00, 0x22, 0xE4, 0x75, 0xF0, 0x01, 0x02, -+0x08, 0xD6, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0xE0, 0x12, 0x7B, 0xF0, 0x90, -+0x93, 0xF8, 0x74, 0x18, 0xF0, 0x7E, 0x00, 0x7F, 0x80, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x94, 0x79, -+0x00, 0x12, 0x08, 0xAA, 0x90, 0x01, 0xC4, 0x74, 0x72, 0xF0, 0x74, 0x62, 0xA3, 0xF0, 0x90, 0x93, -+0xB4, 0xE0, 0xFF, 0x12, 0x8D, 0x3F, 0x90, 0x93, 0xF7, 0xEF, 0xF0, 0xF9, 0xE0, 0xFE, 0x24, 0x29, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x41, 0xF0, 0xEE, 0x24, 0x28, 0xFD, 0xE4, 0x33, -+0xFC, 0x90, 0x93, 0xF8, 0xE0, 0x7A, 0x00, 0x2D, 0xFE, 0xEA, 0x3C, 0x90, 0x93, 0xFC, 0xF0, 0xA3, -+0xCE, 0xF0, 0x74, 0x28, 0x29, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x90, 0x93, 0xE2, 0xE0, -+0xFD, 0x12, 0x92, 0x69, 0xB1, 0x78, 0x90, 0x93, 0xFC, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x93, 0xFA, -+0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x94, 0x00, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xE4, -+0xA3, 0xF0, 0xA3, 0x74, 0x5F, 0xF0, 0x90, 0x93, 0xFC, 0x12, 0x6F, 0xD9, 0x90, 0x90, 0x45, 0xE0, -+0xFF, 0x7E, 0x02, 0xB4, 0xFE, 0x02, 0x7E, 0xFE, 0x90, 0x93, 0xFC, 0xA3, 0xE0, 0xFD, 0x12, 0x53, -+0x3E, 0xEE, 0xF0, 0x74, 0x00, 0x2D, 0x12, 0x53, 0x40, 0xE0, 0x90, 0x94, 0x04, 0xF0, 0x90, 0x93, -+0xFC, 0x51, 0x6B, 0x90, 0x90, 0xDA, 0xE0, 0x90, 0x93, 0xE0, 0xB4, 0x01, 0x0B, 0xE0, 0x44, 0x03, -+0xFC, 0xA3, 0xE0, 0x44, 0x10, 0xFD, 0x80, 0x09, 0xE0, 0x44, 0x03, 0xFC, 0xA3, 0xE0, 0x44, 0x20, -+0xFD, 0x90, 0x93, 0xFE, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x94, 0x05, 0x74, 0x03, 0xF0, 0xA3, -+0x74, 0x12, 0xF0, 0xB1, 0x94, 0x12, 0x08, 0xD6, 0xEF, 0x64, 0xFE, 0x70, 0x25, 0x90, 0x93, 0xFC, -+0xA3, 0xE0, 0x24, 0x00, 0x12, 0x93, 0xCD, 0xC0, 0x03, 0x8B, 0x40, 0xB1, 0xC7, 0xD0, 0x03, 0x12, -+0x34, 0x62, 0x75, 0x40, 0x01, 0xB1, 0xC7, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0x07, 0x12, 0x34, 0x62, -+0x80, 0x56, 0x90, 0x93, 0xAF, 0xE0, 0xFF, 0xB4, 0x02, 0x26, 0x90, 0x93, 0xFC, 0xE0, 0xFC, 0xA3, -+0xE0, 0xFD, 0x24, 0x00, 0xF5, 0x82, 0x74, 0xFC, 0x3C, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2D, -+0xF5, 0x82, 0x74, 0xFC, 0x3C, 0xF5, 0x83, 0x74, 0x20, 0xB1, 0x9C, 0x74, 0x20, 0xF0, 0x80, 0x28, -+0xEF, 0xB4, 0x04, 0x24, 0x90, 0x93, 0xFC, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x24, 0x00, 0xF5, 0x82, -+0x74, 0xFC, 0x3E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2F, 0xF5, 0x82, 0x74, 0xFC, 0x3E, 0xF5, -+0x83, 0x74, 0x10, 0xB1, 0x9C, 0x74, 0x10, 0xF0, 0xB1, 0x94, 0x12, 0x08, 0xD6, 0xE4, 0x90, 0x93, -+0xF9, 0xF0, 0xB1, 0xD1, 0xE0, 0xFE, 0x90, 0x93, 0xFC, 0xA3, 0xE0, 0xFD, 0xEF, 0x2D, 0x12, 0x53, -+0x3E, 0xEE, 0xF0, 0xB1, 0xD1, 0xE0, 0xFE, 0x74, 0x09, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, -+0x83, 0xEE, 0xB1, 0x70, 0xE0, 0xB4, 0x08, 0xDA, 0xB1, 0x82, 0x90, 0x93, 0xFC, 0x12, 0xAA, 0x57, -+0x90, 0x93, 0xFC, 0xE4, 0x75, 0xF0, 0x10, 0x12, 0x08, 0xD6, 0xB1, 0x78, 0xE4, 0x90, 0x94, 0x83, -+0xF0, 0xE4, 0x90, 0x93, 0xF9, 0xF0, 0xB1, 0xA4, 0x50, 0x0F, 0x12, 0xA9, 0x64, 0xB1, 0x69, 0xB1, -+0xAD, 0x12, 0x53, 0x3D, 0xE4, 0xB1, 0x70, 0x80, 0xED, 0x12, 0xAA, 0x66, 0x90, 0x06, 0x31, 0xE0, -+0x54, 0xFB, 0xF0, 0x90, 0x93, 0xB5, 0xE0, 0xFD, 0xFF, 0x90, 0x93, 0xB4, 0xE0, 0xC3, 0x9F, 0xFF, -+0xEF, 0xFE, 0x90, 0x93, 0xF8, 0x12, 0x90, 0x00, 0xCF, 0x24, 0x38, 0xCF, 0x34, 0x00, 0xFE, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0xAC, 0x7A, 0x74, 0x10, 0xF0, 0xED, 0xFE, 0xE4, 0x78, 0x03, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0xAC, 0x7B, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, -+0xD0, 0x06, 0x7B, 0x63, 0xE4, 0xFD, 0xFC, 0x12, 0x38, 0xC6, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0x00, -+0x90, 0xAC, 0xA0, 0x12, 0x48, 0x4F, 0x7A, 0x93, 0x79, 0xE3, 0x90, 0xAC, 0xA3, 0x12, 0x48, 0x4F, -+0x90, 0xAC, 0xA6, 0x74, 0x10, 0xF0, 0x7A, 0x90, 0x79, 0x01, 0x12, 0x34, 0xC2, 0x90, 0x94, 0x83, -+0xE0, 0x04, 0xF0, 0x90, 0x06, 0x31, 0xE0, 0x30, 0xE2, 0x06, 0xB1, 0x8C, 0x50, 0x02, 0x81, 0x31, -+0xB1, 0x8C, 0x40, 0x0A, 0x90, 0x06, 0x35, 0xE0, 0x44, 0x20, 0x90, 0x06, 0x34, 0xF0, 0xE4, 0x90, -+0x93, 0xF9, 0xF0, 0xB1, 0xA4, 0x50, 0x21, 0x12, 0xA9, 0x64, 0xB1, 0x69, 0xB1, 0xAD, 0x90, 0x93, -+0xF9, 0xE0, 0x24, 0xE3, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x93, 0xF7, -+0x12, 0x53, 0x3D, 0xEF, 0xB1, 0x70, 0x80, 0xDB, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x22, 0x90, 0x05, -+0x22, 0xE0, 0x90, 0x94, 0x82, 0xF0, 0x7D, 0x1D, 0x12, 0x5D, 0x90, 0xBF, 0x01, 0x06, 0xB1, 0x54, -+0x90, 0x04, 0x25, 0xF0, 0x90, 0x94, 0x82, 0xE0, 0xFF, 0x7D, 0x1E, 0x12, 0x5A, 0xD4, 0x80, 0x06, -+0xB1, 0x54, 0x90, 0x04, 0x25, 0xF0, 0x12, 0x97, 0xD2, 0x90, 0x8E, 0xCF, 0xE0, 0x70, 0x05, 0x7F, -+0x01, 0x12, 0x58, 0xB5, 0x74, 0x72, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x62, 0xA3, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0xB4, 0xE0, 0xFF, 0x90, 0x95, 0xB4, 0x74, 0x08, 0xF0, 0x7B, -+0x18, 0x7D, 0x01, 0x12, 0x5E, 0x6E, 0x90, 0x93, 0xF7, 0xEF, 0xF0, 0x90, 0x93, 0xB4, 0xE0, 0x22, -+0xF0, 0x90, 0x93, 0xF9, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x93, 0xFC, 0xE4, 0x75, 0xF0, 0x08, 0x12, -+0x08, 0xD6, 0x90, 0x93, 0xFC, 0xE4, 0x75, 0xF0, 0x08, 0x02, 0x08, 0xD6, 0x90, 0x94, 0x83, 0xE0, -+0xC3, 0x94, 0x0A, 0x22, 0x90, 0x93, 0xFC, 0xE4, 0x75, 0xF0, 0x02, 0x22, 0xF0, 0xE4, 0x90, 0x94, -+0x07, 0xF0, 0xA3, 0x22, 0x90, 0x93, 0xF9, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x22, 0xFD, 0xB1, 0xB6, -+0x90, 0x93, 0xF7, 0xEF, 0xF0, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x0A, 0x0D, 0xED, 0x13, 0x90, -+0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0x75, 0x41, 0x90, 0x75, 0x42, 0x48, 0x75, 0x43, 0x02, -+0x22, 0x90, 0x93, 0xF9, 0xE0, 0xFF, 0x24, 0x4A, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xEF, 0x44, 0x08, 0xF0, -+0xED, 0x2F, 0xFF, 0xE4, 0x3E, 0xFE, 0x7C, 0x00, 0xEF, 0x24, 0x08, 0xFF, 0xEC, 0x3E, 0x90, 0x93, -+0xDB, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, 0x00, 0x7F, 0x83, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x90, 0x79, -+0x41, 0x12, 0x08, 0xAA, 0x90, 0x93, 0xDC, 0xE0, 0x24, 0x01, 0xF1, 0x00, 0x90, 0x90, 0x42, 0xF1, -+0x0C, 0x24, 0x04, 0xF1, 0x00, 0x90, 0x90, 0x45, 0xF1, 0x0C, 0x24, 0x05, 0xF1, 0x00, 0x90, 0x90, -+0x46, 0xF1, 0x0C, 0x24, 0x06, 0xF1, 0x00, 0x90, 0x90, 0x47, 0xF1, 0x0C, 0x24, 0x07, 0xF1, 0x00, -+0x90, 0x90, 0x48, 0xF1, 0x0C, 0x24, 0x08, 0xF1, 0x00, 0x90, 0x90, 0x49, 0xEF, 0xF0, 0xE4, 0x90, -+0x93, 0xDA, 0xF0, 0x90, 0x93, 0xDA, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x17, 0x90, 0x93, 0xDC, -+0xE0, 0x24, 0x09, 0xFD, 0x90, 0x93, 0xDB, 0xE0, 0xF1, 0x28, 0x90, 0x93, 0xDA, 0xE0, 0xB1, 0xD6, -+0xF1, 0xE9, 0x80, 0xDF, 0xE4, 0x90, 0x93, 0xDA, 0xF0, 0x90, 0x93, 0xDA, 0xE0, 0xFF, 0xC3, 0x94, -+0x20, 0x50, 0x1E, 0x90, 0x93, 0xDC, 0xE0, 0x24, 0x63, 0xFD, 0x90, 0x93, 0xDB, 0xE0, 0xF1, 0x28, -+0x90, 0x93, 0xDA, 0xE0, 0x24, 0xA4, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xF1, 0xE9, 0x80, -+0xD8, 0x90, 0x90, 0x46, 0x12, 0x7F, 0xB2, 0x12, 0x7D, 0x71, 0x30, 0xE3, 0x0D, 0x7F, 0x01, 0x12, -+0x6C, 0x62, 0x90, 0x01, 0xC7, 0x74, 0x03, 0xF0, 0x80, 0x3F, 0x90, 0x93, 0xD8, 0xA3, 0xE0, 0xFF, -+0x7C, 0x00, 0x54, 0x07, 0xFD, 0x64, 0x01, 0x60, 0x05, 0xED, 0x64, 0x02, 0x70, 0x2B, 0xED, 0x64, -+0x02, 0x4C, 0x70, 0x25, 0xEF, 0x54, 0x30, 0xFF, 0xE4, 0xC4, 0xF8, 0x54, 0xF0, 0xC8, 0xEF, 0xC4, -+0x54, 0x0F, 0x48, 0x90, 0x90, 0xDA, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xE4, 0xFD, 0x12, 0x7C, 0xF0, -+0x90, 0x06, 0x31, 0xE0, 0x54, 0xF7, 0x44, 0x10, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xFF, 0x90, 0x93, 0xDB, 0xE0, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x80, 0x29, 0xEF, 0xF0, 0x90, 0x93, -+0xDC, 0xE0, 0x22, 0x90, 0x93, 0xDA, 0xE0, 0xFD, 0x90, 0x93, 0xD9, 0xE0, 0x2D, 0xFD, 0x90, 0x93, -+0xD8, 0xE0, 0x34, 0x00, 0xCD, 0x24, 0x10, 0xCD, 0x34, 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, -+0xEE, 0x3C, 0xFE, 0xE4, 0xFD, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, -+0x90, 0x8E, 0xB0, 0xE0, 0x9B, 0x90, 0x8E, 0xAF, 0xE0, 0x9A, 0x50, 0x0C, 0xA3, 0x12, 0x9E, 0xDB, -+0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0x12, 0x9E, 0xBA, 0x74, 0x00, 0x2F, 0x12, 0x9C, -+0x3A, 0xE0, 0xFF, 0x22, 0x90, 0x93, 0xE8, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x7D, 0x09, 0xF1, 0x35, -+0xEF, 0x64, 0x06, 0x70, 0x24, 0xF1, 0xE0, 0x7D, 0x14, 0xF1, 0x35, 0xEF, 0x70, 0x1B, 0xF1, 0xE0, -+0x7D, 0x15, 0xF1, 0x35, 0xEF, 0x64, 0x50, 0x70, 0x10, 0xF1, 0xE0, 0x7D, 0x21, 0xF1, 0x35, 0xEF, -+0x20, 0xE0, 0x03, 0x30, 0xE2, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x8F, 0x31, 0xE0, 0x13, 0x13, 0x54, -+0x3F, 0x30, 0xE0, 0x39, 0xF1, 0xE0, 0x7D, 0x09, 0xF1, 0x35, 0xEF, 0x64, 0x11, 0x70, 0x2E, 0x90, -+0x93, 0xE9, 0xE0, 0x24, 0x14, 0xFF, 0x90, 0x93, 0xE8, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x93, 0xEA, -+0xF0, 0xA3, 0xEF, 0xF0, 0x7D, 0x02, 0xF1, 0x35, 0xEF, 0x70, 0x12, 0x90, 0x93, 0xEA, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0x7D, 0x03, 0xF1, 0x35, 0xBF, 0x89, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, -+0x90, 0x93, 0xE8, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xEF, 0xF0, 0x90, 0x93, 0xDA, 0xE0, 0x04, -+0xF0, 0x22, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, -+0x47, 0x2E, 0x90, 0x93, 0xD7, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x8D, 0x01, 0xE0, 0xFF, 0x70, 0x04, -+0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE1, 0x0A, 0x90, 0x8D, 0x01, 0xE0, 0x54, 0xFD, -+0xF0, 0x12, 0x9F, 0xAB, 0x71, 0x72, 0x30, 0xE2, 0x06, 0x54, 0xFB, 0xF0, 0x12, 0x9C, 0x42, 0x71, -+0x72, 0x30, 0xE4, 0x0B, 0x54, 0xEF, 0xF0, 0x12, 0x9F, 0x60, 0xBF, 0x01, 0x02, 0x11, 0x4D, 0x71, -+0x72, 0x30, 0xE7, 0x05, 0x54, 0x7F, 0xF0, 0x71, 0x7C, 0xD2, 0xAF, 0x80, 0xBC, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x95, 0x0F, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, -+0x12, 0x7F, 0xA3, 0x90, 0x95, 0x17, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0x4D, -+0xF0, 0x74, 0x68, 0xA3, 0xF0, 0x12, 0x9E, 0xD2, 0x12, 0x8E, 0x10, 0x90, 0x95, 0x06, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x02, 0x82, 0xE0, 0x90, 0x95, 0x0E, 0xF0, 0x90, 0x8F, 0x30, 0xE0, 0x20, 0xE0, -+0x02, 0x61, 0x4F, 0xE4, 0x90, 0x95, 0x0D, 0xF0, 0x90, 0x95, 0x0E, 0xE0, 0xFF, 0x90, 0x95, 0x0D, -+0xE0, 0xC3, 0x9F, 0x40, 0x02, 0x61, 0x4F, 0x90, 0x95, 0x06, 0x12, 0x93, 0xA6, 0x90, 0xFD, 0x11, -+0xF0, 0x90, 0x95, 0x17, 0xEF, 0xF0, 0x12, 0x8F, 0xEA, 0x54, 0x3F, 0xFE, 0x90, 0x95, 0x08, 0xF0, -+0xA3, 0xEF, 0xF0, 0x90, 0x95, 0x13, 0xEE, 0x12, 0x9D, 0x9F, 0xE0, 0x54, 0x03, 0xFE, 0xEF, 0x24, -+0x18, 0x2E, 0xFF, 0x90, 0x95, 0x18, 0xF0, 0x90, 0x95, 0x07, 0xE0, 0x2F, 0xFF, 0x90, 0x95, 0x06, -+0xE0, 0x34, 0x00, 0xFE, 0x90, 0x95, 0x0A, 0x91, 0x3D, 0xC0, 0x07, 0x71, 0x60, 0x7D, 0x01, 0x12, -+0x67, 0x35, 0xC0, 0x07, 0x71, 0x60, 0x7D, 0x04, 0x12, 0x67, 0x35, 0xAB, 0x07, 0xD0, 0x05, 0xD0, -+0x07, 0x12, 0x92, 0x49, 0x90, 0x95, 0x0F, 0xEF, 0x71, 0x5F, 0xE4, 0xFD, 0x12, 0x67, 0x35, 0xEF, -+0x54, 0xFC, 0x90, 0x95, 0x0C, 0xF0, 0x90, 0x95, 0x18, 0xE0, 0xFF, 0x90, 0x95, 0x08, 0xE4, 0x8F, -+0xF0, 0x12, 0x08, 0xD6, 0x90, 0x95, 0x08, 0x12, 0x9E, 0x47, 0x90, 0x95, 0x08, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x95, 0x06, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7D, 0x0F, 0x12, 0x67, 0x35, 0x90, -+0x95, 0x08, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x90, 0x95, 0x06, 0xEC, 0x8D, 0xF0, 0x12, 0x9E, 0xC2, -+0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x90, 0x95, 0x07, 0xE0, 0x9D, 0x90, 0x95, 0x06, 0xE0, 0x9C, 0x40, -+0x18, 0x90, 0x8E, 0xB0, 0xE0, 0x24, 0x01, 0xFD, 0x12, 0x9E, 0xDF, 0xFC, 0xC3, 0x90, 0x95, 0x07, -+0xE0, 0x9D, 0xF0, 0x90, 0x95, 0x06, 0xE0, 0x9C, 0xF0, 0xEF, 0x30, 0xE6, 0x06, 0x90, 0x01, 0xC7, -+0x74, 0x22, 0xF0, 0xEF, 0x30, 0xE7, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x21, 0xF0, 0xEF, 0x30, 0xE5, -+0x06, 0x90, 0x01, 0xC7, 0x74, 0x23, 0xF0, 0x90, 0x95, 0x05, 0xE0, 0x60, 0x37, 0x90, 0x95, 0x0C, -+0xE0, 0x24, 0xB0, 0x60, 0x14, 0x24, 0xD0, 0x60, 0x02, 0x41, 0xDD, 0x91, 0x35, 0x20, 0xE0, 0x15, -+0x91, 0x27, 0x20, 0xE0, 0x02, 0x41, 0xDD, 0x80, 0x0C, 0x91, 0x35, 0x20, 0xE0, 0x07, 0x91, 0x27, -+0x20, 0xE0, 0x02, 0x41, 0xDD, 0x71, 0x60, 0x90, 0x95, 0x13, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x12, -+0x7D, 0x7A, 0x41, 0xDD, 0x90, 0x95, 0x0C, 0xE0, 0x24, 0x40, 0x60, 0x04, 0x24, 0x20, 0x70, 0x2A, -+0x90, 0x8F, 0x33, 0xE0, 0xFF, 0x91, 0x53, 0x20, 0xE0, 0x02, 0x41, 0xDD, 0x90, 0x8F, 0x46, 0xE0, -+0x04, 0x71, 0x5F, 0x12, 0x7F, 0x49, 0xEF, 0x70, 0x02, 0x41, 0xDD, 0x90, 0x95, 0x0C, 0xE0, 0xFF, -+0xF1, 0xE0, 0x90, 0x8F, 0x47, 0xE0, 0x04, 0xF0, 0x41, 0xDD, 0x12, 0x7F, 0xC4, 0x30, 0xE0, 0x5E, -+0x90, 0x95, 0x0F, 0xE0, 0xFF, 0x90, 0x95, 0x0B, 0xE0, 0x2F, 0xFF, 0x90, 0x95, 0x0A, 0xE0, 0x34, -+0x00, 0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, 0xFE, 0x90, 0x95, 0x15, 0x91, 0x3D, 0xEF, 0x64, 0x45, -+0x70, 0x3C, 0x71, 0x69, 0x12, 0x7D, 0x3A, 0xEF, 0x64, 0x01, 0x70, 0x32, 0x71, 0x69, 0x12, 0x7D, -+0x08, 0xEF, 0x64, 0x01, 0x70, 0x28, 0x90, 0x95, 0x19, 0x04, 0xF0, 0x90, 0x95, 0x15, 0x12, 0x7C, -+0x46, 0xFD, 0x12, 0x7D, 0xDA, 0xEF, 0x70, 0x0E, 0x90, 0x95, 0x17, 0xE0, 0xFD, 0x90, 0xFD, 0x11, -+0xF0, 0x71, 0x69, 0x12, 0x7D, 0x9C, 0x90, 0x95, 0x17, 0xE0, 0x90, 0xFD, 0x11, 0xF0, 0x71, 0x60, -+0x12, 0x7F, 0x49, 0xEF, 0x60, 0x20, 0x71, 0x60, 0x90, 0x95, 0x0F, 0xE0, 0xFD, 0x90, 0x95, 0x12, -+0xE0, 0xFB, 0x90, 0x95, 0x17, 0xE0, 0x90, 0x95, 0x99, 0xF0, 0x12, 0x7C, 0x4E, 0xEF, 0x60, 0x06, -+0x90, 0x95, 0x19, 0x74, 0x01, 0xF0, 0x90, 0x8F, 0x30, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x13, 0x71, -+0x60, 0x90, 0x95, 0x0F, 0xE0, 0xFD, 0x12, 0x78, 0x1C, 0xEF, 0x60, 0x06, 0x90, 0x95, 0x19, 0x74, -+0x01, 0xF0, 0xF1, 0xF1, 0x54, 0x3F, 0x30, 0xE0, 0x0A, 0x71, 0x60, 0x90, 0x95, 0x0F, 0xE0, 0xFD, -+0x12, 0x79, 0x61, 0x90, 0x8F, 0x30, 0xE0, 0xFF, 0x91, 0x53, 0x30, 0xE0, 0x10, 0x90, 0x95, 0x19, -+0xE0, 0x70, 0x0A, 0x71, 0x60, 0x90, 0x95, 0x0F, 0xE0, 0xFD, 0x12, 0x7B, 0x3B, 0x12, 0xA4, 0x1C, -+0xEF, 0x64, 0x01, 0x60, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x0F, 0x91, 0x46, 0x30, 0xE0, -+0x06, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x7F, 0x01, 0x91, 0x62, 0x12, 0xA3, 0x89, 0xEF, 0x64, -+0x01, 0x70, 0x36, 0x90, 0x8F, 0x48, 0xE0, 0x04, 0xF0, 0x12, 0x9E, 0xF9, 0xAD, 0x07, 0xEF, 0x64, -+0x01, 0x60, 0x1E, 0xF1, 0xCE, 0xED, 0xB4, 0x02, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x42, 0xF0, 0x80, -+0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x43, 0xF0, 0x7F, 0x01, 0x91, 0x62, 0x80, -+0x1E, 0x90, 0x95, 0x06, 0x12, 0x9E, 0xE6, 0x80, 0x0E, 0x91, 0x46, 0x20, 0xE0, 0x11, 0x90, 0x8F, -+0x30, 0xE0, 0x54, 0xFE, 0xF0, 0x80, 0x08, 0x90, 0x95, 0x0D, 0xE0, 0x04, 0xF0, 0x01, 0x98, 0x74, -+0x4D, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x68, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, -+0x90, 0x95, 0x0A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x95, 0x15, 0xE0, 0xFE, 0xA3, 0xE0, -+0xFF, 0x22, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x8D, 0x01, 0xE0, 0xFF, 0x22, 0xE4, 0x90, 0x93, 0xD8, -+0xF0, 0x90, 0x93, 0xD8, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x40, 0x02, 0x81, 0x13, 0x12, 0x96, 0x90, -+0xE0, 0x64, 0x01, 0x70, 0x76, 0x90, 0x93, 0xD8, 0xE0, 0x91, 0x19, 0x12, 0x48, 0x22, 0xE4, 0x7B, -+0x01, 0x91, 0x2E, 0x70, 0x3C, 0x90, 0x93, 0xD8, 0xE0, 0xFB, 0x12, 0xA9, 0xCA, 0xE0, 0x60, 0x21, -+0x14, 0x70, 0x58, 0xEB, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x9B, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, -+0x83, 0x12, 0x48, 0x22, 0xEB, 0x91, 0x19, 0x12, 0x08, 0x6D, 0x90, 0x93, 0xD8, 0xE0, 0xFF, 0x80, -+0x0B, 0x91, 0x14, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0xAF, 0x03, 0x12, 0x97, 0xF0, 0x80, -+0x2A, 0x90, 0x93, 0xD8, 0xE0, 0x91, 0x19, 0x12, 0x48, 0x22, 0xE4, 0xFB, 0x91, 0x2E, 0x50, 0x1B, -+0x91, 0x14, 0x12, 0x48, 0x22, 0xEF, 0x24, 0xFF, 0xFF, 0xEE, 0x34, 0xFF, 0xFE, 0xED, 0x34, 0xFF, -+0xFD, 0xEC, 0x34, 0xFF, 0xFC, 0xEB, 0x91, 0x19, 0x12, 0x08, 0x6D, 0x90, 0x93, 0xD8, 0xE0, 0x04, -+0xF0, 0x61, 0x81, 0x22, 0x90, 0x93, 0xD8, 0xE0, 0xFB, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x97, 0xF5, -+0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xFA, 0xF9, -+0xF8, 0xC3, 0x02, 0x48, 0x11, 0x90, 0x8E, 0xB2, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xF0, 0xA3, 0xEF, -+0xF0, 0xE4, 0xFD, 0x02, 0x67, 0x35, 0x90, 0x8F, 0x32, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x22, 0x90, -+0x8F, 0x34, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, -+0x7F, 0x01, 0x90, 0x95, 0xE9, 0xEF, 0xF0, 0x90, 0x8D, 0x07, 0xE0, 0x64, 0x02, 0x70, 0x1D, 0x90, -+0x95, 0xE9, 0xE0, 0xFD, 0x64, 0x01, 0x70, 0x2C, 0xF1, 0xCE, 0x91, 0x4F, 0x30, 0xE0, 0x09, 0x90, -+0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, 0x1C, 0xAF, 0x05, 0x80, 0x15, 0x90, 0x01, 0x00, 0x74, -+0xFF, 0xF0, 0x12, 0xAA, 0x66, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x95, 0xE9, 0xE0, -+0xFF, 0x12, 0x4D, 0x27, 0xF1, 0x46, 0xF0, 0x90, 0x8F, 0x30, 0xE0, 0x54, 0xBF, 0xF0, 0x22, 0x90, -+0x93, 0xDC, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x93, 0xDA, 0x12, 0x7F, 0x42, 0x90, 0x94, 0x00, -+0xF0, 0xEF, 0x24, 0x24, 0xFF, 0xE4, 0x3E, 0xFE, 0xC0, 0x06, 0xF1, 0x28, 0xD0, 0x06, 0xE4, 0xFB, -+0xFA, 0xD1, 0xF8, 0x4E, 0x60, 0x3E, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x94, 0x01, 0x12, 0x67, 0x04, -+0x90, 0x93, 0xDF, 0xF1, 0x11, 0x90, 0x93, 0xDF, 0xF1, 0x07, 0xFE, 0xC3, 0x9F, 0x50, 0x25, 0x90, -+0x94, 0x02, 0xE0, 0x24, 0x02, 0xFD, 0x90, 0x94, 0x01, 0xE0, 0x34, 0x00, 0xFC, 0xEE, 0x7E, 0x00, -+0x2D, 0x12, 0x67, 0x2F, 0x90, 0x93, 0xDE, 0xE0, 0x24, 0xE0, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0x12, -+0x57, 0x33, 0x80, 0xD1, 0xF1, 0x19, 0xC0, 0x06, 0xF1, 0x28, 0xD0, 0x06, 0x7B, 0x03, 0xD1, 0xF5, -+0x90, 0x93, 0xDB, 0xE0, 0x24, 0x22, 0xF1, 0x1F, 0x90, 0x94, 0x01, 0x91, 0x3D, 0xEF, 0x20, 0xE4, -+0x02, 0xA1, 0xE5, 0x90, 0x94, 0x00, 0xE0, 0x04, 0xF0, 0xF1, 0x19, 0xC0, 0x06, 0xF1, 0x28, 0xD0, -+0x06, 0x7B, 0x30, 0xD1, 0xF5, 0x4E, 0x60, 0x45, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x94, 0x01, 0x12, -+0x67, 0x04, 0xF1, 0x0E, 0xF1, 0x04, 0xC3, 0x9F, 0x50, 0x33, 0x90, 0x94, 0x02, 0xE0, 0x24, 0x0D, -+0xFF, 0x90, 0x94, 0x01, 0x12, 0x67, 0x04, 0x90, 0x94, 0x03, 0xEF, 0xF0, 0xBF, 0x02, 0x09, 0x90, -+0x94, 0x00, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x0E, 0x90, 0x94, 0x03, 0xE0, 0xB4, 0x04, 0x07, 0x90, -+0x94, 0x00, 0xE0, 0x24, 0x40, 0xF0, 0xF1, 0xD6, 0x12, 0x57, 0x37, 0x80, 0xC7, 0xF1, 0x19, 0xC0, -+0x06, 0xF1, 0x28, 0xD0, 0x06, 0x7B, 0xDD, 0x7A, 0x00, 0x7D, 0x01, 0xD1, 0xF9, 0x4E, 0x60, 0x4A, -+0xE0, 0x24, 0x0C, 0xFF, 0x90, 0x94, 0x01, 0x12, 0x67, 0x04, 0xF1, 0x0E, 0xF1, 0x04, 0xC3, 0x9F, -+0x50, 0x38, 0x90, 0x94, 0x02, 0xE0, 0x24, 0x11, 0xFF, 0x90, 0x94, 0x01, 0x12, 0x67, 0x04, 0x90, -+0x94, 0x03, 0xEF, 0xF0, 0xBF, 0x02, 0x09, 0x90, 0x94, 0x00, 0xE0, 0x24, 0x02, 0xF0, 0x80, 0x0E, -+0x90, 0x94, 0x03, 0xE0, 0xB4, 0x04, 0x07, 0x90, 0x94, 0x00, 0xE0, 0x24, 0x04, 0xF0, 0xF1, 0xD6, -+0x12, 0x57, 0x37, 0x80, 0xC7, 0xE4, 0x90, 0x94, 0x00, 0xF0, 0x90, 0x91, 0x63, 0xE0, 0x90, 0x04, -+0xFD, 0xF1, 0x12, 0x90, 0x91, 0x63, 0xF1, 0x07, 0xFE, 0xC3, 0x9F, 0x50, 0x61, 0x12, 0xAA, 0x1C, -+0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x93, 0xDF, 0xE0, 0xFE, 0x6F, 0x70, 0x4D, 0x90, 0x04, 0xFC, 0xE0, -+0x04, 0xF0, 0x90, 0x93, 0xDE, 0xE0, 0x24, 0x83, 0xF5, 0x82, 0xE4, 0x34, 0x91, 0xF5, 0x83, 0xE0, -+0xFF, 0x90, 0x94, 0x00, 0xE0, 0xFD, 0x4F, 0x60, 0x04, 0xED, 0x5F, 0x60, 0x2C, 0xEE, 0xFF, 0x7E, -+0x00, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x93, 0xDE, 0xE0, 0x12, 0xA9, 0xA3, 0x78, 0xE0, 0x7C, 0x93, -+0x7D, 0x01, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x4A, 0x04, 0xEF, 0x70, 0x0D, 0x90, 0x01, 0xC7, 0x74, -+0x55, 0xF0, 0x7F, 0x01, 0x91, 0x62, 0x12, 0x96, 0x65, 0x12, 0x57, 0x37, 0x80, 0x95, 0x22, 0x90, -+0x94, 0x05, 0x12, 0x7B, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xEB, 0xF0, 0xC3, 0x90, 0x94, 0x0B, 0xE0, -+0x94, 0x01, 0x90, 0x94, 0x0A, 0xE0, 0x94, 0x00, 0x50, 0x02, 0x80, 0x75, 0xE4, 0x90, 0x94, 0x0E, -+0xF0, 0xA3, 0xF0, 0xF1, 0x3D, 0xE4, 0xFD, 0x12, 0x67, 0x35, 0x90, 0x94, 0x08, 0xE0, 0x70, 0x03, -+0xA3, 0xE0, 0x6F, 0x70, 0x19, 0x90, 0x94, 0x06, 0xE0, 0x24, 0x02, 0x12, 0x7F, 0xAA, 0xFE, 0x90, -+0x94, 0x07, 0xE0, 0xFD, 0x12, 0xA9, 0x22, 0xBF, 0x01, 0x02, 0xE1, 0x3D, 0x80, 0x00, 0x90, 0x94, -+0x06, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x94, 0x05, 0x12, 0x67, 0x04, 0x7E, 0x00, 0x90, 0x94, 0x0C, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x24, 0x02, 0xFF, 0xEE, 0x33, 0xFE, 0x90, 0x94, 0x05, 0x8F, 0xF0, -+0x12, 0x08, 0xD6, 0x90, 0x94, 0x0E, 0xEE, 0x8F, 0xF0, 0x12, 0x08, 0xD6, 0x90, 0x94, 0x0A, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x90, 0x94, 0x0F, 0xE0, 0x9F, 0x90, 0x94, 0x0E, 0xE0, 0x9E, 0x40, -+0x92, 0xE4, 0xFE, 0xFF, 0x22, 0x7A, 0x00, 0xE4, 0xFD, 0xD1, 0x5F, 0x90, 0x94, 0x01, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x94, 0x04, 0xE0, 0xFF, 0x90, 0x93, 0xDE, 0xE0, 0x22, 0x90, 0x94, -+0x04, 0xEF, 0xF0, 0xE4, 0x90, 0x93, 0xDE, 0xF0, 0x22, 0x90, 0x93, 0xDB, 0xE0, 0x24, 0x24, 0xFF, -+0x90, 0x93, 0xDA, 0xE0, 0x34, 0x00, 0xFE, 0x22, 0x90, 0x93, 0xDD, 0xE0, 0x24, 0xDC, 0xFE, 0x90, -+0x93, 0xDC, 0xE0, 0x34, 0xFF, 0x90, 0x94, 0x0A, 0xF0, 0xA3, 0xCE, 0xF0, 0x22, 0x90, 0x94, 0x05, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x93, 0xC6, 0xE0, 0x54, 0xFE, 0x22, 0x90, 0x93, 0xC6, -+0xE0, 0x30, 0xE0, 0x78, 0x90, 0x93, 0xCA, 0xE0, 0x04, 0xF0, 0x90, 0x93, 0xCD, 0xE0, 0x64, 0x01, -+0x70, 0x2D, 0x90, 0x93, 0xC6, 0x12, 0x77, 0xF0, 0x30, 0xE0, 0x24, 0x90, 0x93, 0xCC, 0xE0, 0x70, -+0x1E, 0x90, 0x93, 0xC9, 0xE0, 0xFE, 0xA3, 0xE0, 0xC3, 0x9E, 0x40, 0x13, 0x91, 0x27, 0x30, 0xE0, -+0x08, 0x12, 0x81, 0x17, 0xF1, 0x46, 0xF0, 0x80, 0x06, 0x91, 0x5A, 0xF1, 0x46, 0xF0, 0x22, 0x90, -+0x93, 0xCA, 0xE0, 0xFF, 0x90, 0x93, 0xC7, 0xE0, 0xD3, 0x9F, 0x50, 0x30, 0x90, 0x06, 0x92, 0xE0, -+0x20, 0xE2, 0x1A, 0x90, 0x93, 0xCC, 0xE0, 0x70, 0x14, 0x7D, 0x08, 0xFF, 0x12, 0x5E, 0x21, 0x90, -+0x93, 0xCB, 0xE0, 0x04, 0xF0, 0x90, 0x93, 0xC5, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, -+0x74, 0x04, 0xF0, 0xE4, 0x90, 0x93, 0xCA, 0xF0, 0x90, 0x93, 0xCC, 0xF0, 0x22, 0xF0, 0x90, 0x8F, -+0x39, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x94, 0x01, 0xE4, 0x75, 0xF0, 0x04, 0x02, 0x08, 0xD6, -+0xEF, 0x90, 0x01, 0xC7, 0xB4, 0xA0, 0x05, 0x74, 0x04, 0xF0, 0x80, 0x03, 0x74, 0x08, 0xF0, 0x80, -+0xDD, 0x90, 0x8F, 0x30, 0xE0, 0x13, 0x13, 0x22, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, -+0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x12, 0x4C, 0x77, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, -+0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, -+0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, -+0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0x12, 0xA0, 0xD3, 0xE5, 0x19, 0x30, 0xE3, 0x02, 0x51, 0x42, 0xE5, 0x19, 0x30, 0xE4, 0x02, -+0x31, 0x09, 0xE5, 0x19, 0x30, 0xE5, 0x03, 0x12, 0xA1, 0x30, 0xE5, 0x1B, 0x30, 0xE0, 0x03, 0x12, -+0x57, 0xFA, 0xE5, 0x1B, 0x30, 0xE1, 0x02, 0xD1, 0x18, 0xE5, 0x1B, 0x30, 0xE2, 0x03, 0x12, 0xA1, -+0x6C, 0xE5, 0x1B, 0x30, 0xE3, 0x02, 0x51, 0x4E, 0xE5, 0x1B, 0x30, 0xE4, 0x02, 0x51, 0x66, 0xE5, -+0x1B, 0x30, 0xE5, 0x02, 0x51, 0xBF, 0xE5, 0x1B, 0x30, 0xE6, 0x02, 0x51, 0xA9, 0xE5, 0x1C, 0x30, -+0xE1, 0x03, 0x12, 0xA1, 0x84, 0xE5, 0x1C, 0x30, 0xE6, 0x02, 0x11, 0xC7, 0xD0, 0x07, 0xD0, 0x06, -+0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, -+0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x07, 0x1F, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x07, -+0x1C, 0xE0, 0x54, 0x01, 0xFF, 0x90, 0x94, 0x86, 0xF0, 0x90, 0x94, 0x84, 0x74, 0x02, 0xF0, 0x90, -+0x94, 0x92, 0x14, 0xF0, 0xFB, 0x7A, 0x94, 0x79, 0x84, 0x12, 0x9A, 0x2B, 0x7F, 0x04, 0x90, 0x95, -+0xE6, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x47, 0x07, 0x90, 0x8D, 0x01, 0xE0, 0xFF, 0x90, 0x95, 0xE6, -+0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x8D, 0x01, 0xF0, 0x22, 0x31, 0x1C, 0x7F, 0x02, 0x8F, 0x59, 0x7F, -+0x02, 0x12, 0x47, 0x07, 0x90, 0x8D, 0x01, 0xE0, 0x45, 0x59, 0xF0, 0x22, 0x90, 0x01, 0xCC, 0xE0, -+0x54, 0x0F, 0x90, 0x95, 0xDD, 0xF0, 0x90, 0x95, 0xDD, 0xE0, 0xFD, 0x70, 0x02, 0x41, 0x17, 0x90, -+0x8E, 0x15, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, -+0x8E, 0x16, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, -+0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x95, 0xD9, 0x12, 0x81, 0xC4, 0x80, 0x05, 0xC3, -+0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x21, 0xF9, 0xE4, 0x90, 0x95, -+0xDE, 0xF0, 0x90, 0x95, 0xDE, 0xE0, 0xF9, 0xC3, 0x94, 0x04, 0x50, 0x31, 0x51, 0x18, 0xA4, 0xFF, -+0xE9, 0xFD, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xD0, 0x51, 0x30, 0x90, 0x8D, -+0xC5, 0x51, 0x20, 0x51, 0x18, 0xA4, 0x2D, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xF0, 0x51, 0x30, -+0x90, 0x8D, 0xC9, 0x51, 0x20, 0x90, 0x95, 0xDE, 0xE0, 0x04, 0xF0, 0x80, 0xC5, 0x90, 0x95, 0xDD, -+0xE0, 0xFF, 0x90, 0x95, 0xD9, 0x12, 0x4B, 0x8C, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, -+0x90, 0x95, 0xDD, 0xF0, 0x90, 0x95, 0xD9, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0x95, 0xD9, 0xE0, 0x04, 0xF0, 0xE0, 0x54, -+0x03, 0xF0, 0x90, 0x8E, 0x16, 0x12, 0x9B, 0x3D, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, -+0x21, 0x26, 0xE4, 0x90, 0x8E, 0x16, 0xF0, 0x21, 0x26, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, -+0x90, 0x95, 0xD9, 0xE0, 0x44, 0x80, 0x90, 0x00, 0x8A, 0xF0, 0x51, 0x18, 0x90, 0x01, 0xD0, 0x12, -+0x48, 0x3A, 0xE0, 0x90, 0x01, 0xC3, 0xF0, 0x22, 0x90, 0x95, 0xD9, 0xE0, 0x75, 0xF0, 0x04, 0x22, -+0x12, 0x48, 0x3A, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x22, -+0x2F, 0xF5, 0x82, 0x74, 0x01, 0x3E, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x8E, 0x16, 0xE0, 0x75, 0xF0, -+0x08, 0x22, 0x90, 0x8F, 0x30, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x10, 0x31, 0x0D, 0x22, 0x51, 0x5E, -+0x70, 0x0B, 0x90, 0x8E, 0xCC, 0xE0, 0x60, 0x05, 0xB1, 0xAD, 0x12, 0x50, 0x04, 0x22, 0xE4, 0xFF, -+0x51, 0x80, 0xEF, 0x64, 0x01, 0x22, 0x51, 0x5E, 0x70, 0x15, 0x90, 0x8E, 0xCC, 0xE0, 0x60, 0x0F, -+0xB1, 0xAD, 0xF0, 0x90, 0x8E, 0xC7, 0xE0, 0xF1, 0x25, 0x54, 0x07, 0x70, 0x02, 0x71, 0xE4, 0x22, -+0x12, 0x6C, 0x27, 0xFE, 0xEF, 0x54, 0x07, 0xFF, 0x12, 0x81, 0x64, 0xE0, 0xFD, 0x7C, 0x00, 0x12, -+0x81, 0xC6, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, -+0x5D, 0x4E, 0x7F, 0x00, 0x60, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0xFF, 0x51, 0x80, 0xBF, 0x01, 0x0E, -+0x90, 0x8E, 0xCC, 0xE0, 0x60, 0x08, 0xB1, 0x8B, 0x54, 0x07, 0x70, 0x02, 0x71, 0xE4, 0x22, 0xE4, -+0xFF, 0x51, 0x80, 0xBF, 0x01, 0x11, 0x90, 0x8E, 0xCC, 0xE0, 0x60, 0x0B, 0x71, 0xD5, 0x64, 0x02, -+0x60, 0x02, 0xE1, 0x53, 0x12, 0x5F, 0xBF, 0x22, 0x90, 0x93, 0xC2, 0xE0, 0x30, 0xE0, 0x33, 0x51, -+0x5E, 0x70, 0x2F, 0x90, 0x95, 0xEA, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0x93, 0xC4, -+0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x95, 0xEA, 0xF0, 0x90, 0x93, 0xC4, 0xE0, 0xFF, 0x90, 0x93, 0xC3, -+0xE0, 0xD3, 0x9F, 0x50, 0x0D, 0x90, 0x93, 0xC5, 0xE0, 0x70, 0x07, 0xE4, 0x90, 0x93, 0xC4, 0xF0, -+0xF1, 0xF7, 0x22, 0x8B, 0x52, 0x8A, 0x53, 0x89, 0x54, 0x12, 0x84, 0xB4, 0xFF, 0xF5, 0x56, 0x12, -+0x06, 0x89, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0x12, 0x86, 0x52, 0xF5, 0x57, 0x80, 0x02, 0x8F, -+0x57, 0x85, 0x56, 0x55, 0xE5, 0x55, 0xD3, 0x95, 0x57, 0x50, 0x25, 0xAB, 0x52, 0xAA, 0x53, 0xA9, -+0x54, 0x12, 0x06, 0x89, 0x54, 0x01, 0xFD, 0xAF, 0x55, 0x12, 0x81, 0x23, 0xAF, 0x55, 0x51, 0x80, -+0xEF, 0xAF, 0x55, 0x70, 0x05, 0x12, 0x81, 0x1E, 0x80, 0x02, 0xF1, 0x96, 0x05, 0x55, 0x80, 0xD4, -+0xE5, 0x56, 0x70, 0x0E, 0xFF, 0x51, 0x80, 0xEF, 0x70, 0x08, 0xB1, 0xFF, 0x54, 0xBF, 0xF0, 0x54, -+0x7F, 0xF0, 0x22, 0xF1, 0x1A, 0x30, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, -+0x02, 0xB1, 0xEF, 0x90, 0x8E, 0xC7, 0xF1, 0xF0, 0x30, 0xE0, 0x09, 0xEF, 0xF1, 0x25, 0x54, 0x07, -+0x70, 0x42, 0x80, 0x3E, 0x90, 0x8E, 0xD5, 0xE0, 0x04, 0xF0, 0x90, 0x8E, 0xD0, 0xE0, 0x54, 0xEF, -+0xF0, 0x12, 0xA9, 0xE4, 0x40, 0x2C, 0x51, 0x5E, 0x70, 0x2A, 0x71, 0xD5, 0x70, 0x04, 0x71, 0xEE, -+0x80, 0x2A, 0x71, 0xEE, 0x90, 0x8E, 0xD6, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x09, -+0x71, 0xDC, 0xE4, 0x90, 0x8E, 0xD6, 0xF0, 0x80, 0x03, 0x12, 0x5F, 0xBF, 0xE4, 0x90, 0x8E, 0xD5, -+0xF0, 0x22, 0x71, 0xE4, 0x22, 0x90, 0x8E, 0xCA, 0xE0, 0x54, 0x0F, 0x22, 0x90, 0x8E, 0xC8, 0xE0, -+0x54, 0xFB, 0xF0, 0x22, 0x90, 0x8E, 0xCE, 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x58, 0xD0, 0x12, 0xA9, -+0xE4, 0x40, 0x34, 0x90, 0x8E, 0xE6, 0xE0, 0x04, 0xF0, 0x90, 0x8F, 0x28, 0xE0, 0xFF, 0x90, 0x8E, -+0xE6, 0xE0, 0xD3, 0x9F, 0x50, 0x21, 0x90, 0x8E, 0xDE, 0xE0, 0x04, 0x12, 0xA9, 0x77, 0x12, 0x57, -+0xED, 0x90, 0x8E, 0xE5, 0xF0, 0xFB, 0x90, 0x8E, 0xDE, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x95, -+0xC8, 0x74, 0x04, 0xF0, 0x12, 0x82, 0x04, 0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, -+0x02, 0xF0, 0x7D, 0x78, 0xFF, 0x91, 0x6A, 0x7D, 0x02, 0x7F, 0x03, 0x91, 0x6A, 0x90, 0x06, 0x0A, -+0xE0, 0x44, 0x07, 0x12, 0xA9, 0x8E, 0xE4, 0xFF, 0x51, 0x80, 0xBF, 0x01, 0x10, 0x71, 0xDC, 0x90, -+0x8E, 0xCF, 0xE0, 0x20, 0xE2, 0x09, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x58, 0xD0, 0xF1, 0xD0, 0x22, -+0x7D, 0x01, 0x7F, 0x02, 0x91, 0x6A, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x15, 0x2F, 0xF8, 0xE6, 0x4D, -+0xFE, 0xF6, 0x74, 0x30, 0xF1, 0x34, 0xF0, 0x22, 0x90, 0x05, 0x62, 0xE0, 0xFE, 0x90, 0x05, 0x61, -+0xE0, 0xFD, 0xED, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x93, 0xAE, -+0x51, 0x5E, 0x60, 0x02, 0xA1, 0x39, 0x90, 0x8E, 0xCC, 0xE0, 0x70, 0x02, 0xA1, 0x39, 0xB1, 0xA4, -+0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x8E, 0xD3, 0xF0, 0x90, 0x06, 0xAA, 0xE0, -+0x90, 0x8E, 0xD2, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x8E, 0xD2, 0xE0, 0xFE, 0xFF, 0x80, -+0x00, 0x90, 0x8E, 0xD3, 0xEF, 0xF0, 0x12, 0x82, 0xD7, 0xE4, 0x90, 0x8E, 0xD5, 0x12, 0xA9, 0x8E, -+0xB1, 0xAD, 0xF1, 0x27, 0x54, 0xEF, 0xF0, 0xB1, 0xA4, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x02, 0xB1, -+0x3A, 0xF1, 0x1A, 0x30, 0xE0, 0x51, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x22, 0xB1, -+0x93, 0x6F, 0x70, 0x43, 0x90, 0x8E, 0xC8, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0xAA, 0x7D, 0xB1, 0x9B, -+0x7F, 0x03, 0x12, 0xA1, 0xFC, 0xF1, 0x0C, 0xB1, 0xEF, 0x90, 0x8E, 0xD3, 0xE0, 0x14, 0xF0, 0x80, -+0x26, 0x12, 0xAA, 0x75, 0x64, 0x01, 0x70, 0x1F, 0xB1, 0x93, 0xFE, 0x6F, 0x60, 0x19, 0x90, 0x05, -+0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x10, 0xF1, 0xED, 0x30, 0xE0, 0x0B, 0xEF, 0x54, 0xBF, 0xB1, -+0x9B, 0x7F, 0x03, 0xF1, 0x12, 0x91, 0x60, 0xF1, 0xD0, 0x22, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x58, -+0x54, 0xC0, 0x70, 0x07, 0xB1, 0x8B, 0x54, 0xFD, 0xF0, 0x61, 0xE4, 0xE5, 0x58, 0x30, 0xE6, 0x1E, -+0x90, 0x8E, 0xCC, 0xE0, 0x64, 0x01, 0x70, 0x18, 0x90, 0x8E, 0xD0, 0xE0, 0x44, 0x01, 0xF0, 0x71, -+0xD5, 0x64, 0x02, 0x60, 0x04, 0xF1, 0x53, 0x80, 0x07, 0x12, 0x5F, 0xBF, 0x80, 0x02, 0xB1, 0x8B, -+0xE5, 0x58, 0x90, 0x8E, 0xD0, 0x30, 0xE7, 0x0E, 0xE0, 0x44, 0x02, 0x12, 0x50, 0x04, 0x90, 0x8E, -+0xC7, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x8E, 0xD0, 0xE0, 0x54, -+0xFE, 0xF0, 0x22, 0x90, 0x8E, 0xD2, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, -+0x10, 0xF0, 0xFD, 0x22, 0x90, 0x8E, 0xCA, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x01, 0x57, -+0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0xEF, 0x70, 0x32, 0x7D, 0x78, 0x7F, 0x02, 0xB1, -+0xF3, 0x7D, 0x02, 0x7F, 0x03, 0xB1, 0xF3, 0x7D, 0xC8, 0x7F, 0x02, 0xF1, 0x12, 0xB1, 0xAD, 0xF0, -+0xE4, 0xFF, 0x51, 0x80, 0xEF, 0x70, 0x0A, 0xB1, 0xFF, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x80, -+0x07, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x58, 0xD0, 0xD1, 0x04, 0x02, 0xA6, 0x5B, 0x81, 0x28, 0x7D, -+0x02, 0x7F, 0x02, 0x74, 0x15, 0xF1, 0xD8, 0xFE, 0xF6, 0x74, 0x30, 0xF1, 0x34, 0xF0, 0x22, 0x12, -+0x4C, 0x14, 0xD1, 0x0C, 0x90, 0x8E, 0xC7, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x12, 0xA6, 0x53, 0xF1, -+0xE3, 0x7D, 0x0C, 0x7F, 0x01, 0x02, 0x58, 0x4A, 0x90, 0x8E, 0xCC, 0xE0, 0x70, 0x02, 0xC1, 0xA9, -+0x90, 0x8E, 0xE3, 0xE0, 0x04, 0x12, 0x51, 0x05, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0x51, 0x1F, 0x78, 0x10, 0x12, 0x08, 0x5A, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0xA3, 0x12, 0x51, 0x1F, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x12, 0x48, 0x04, 0x90, 0x8F, 0x17, 0x12, 0xA8, 0x27, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, -+0x30, 0xE0, 0x0F, 0x12, 0x84, 0x71, 0x90, 0x95, 0xC8, 0x74, 0x05, 0xF0, 0x12, 0x82, 0x04, 0x12, -+0xAA, 0x6D, 0xF1, 0x1A, 0x30, 0xE0, 0x0B, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x04, 0xB1, 0xEF, -+0xF1, 0x0C, 0x90, 0x95, 0xE8, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, -+0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x12, 0x6F, 0x4D, 0x51, 0xD8, 0xE4, 0x90, -+0x93, 0xC5, 0xF0, 0x12, 0x7F, 0xC4, 0x30, 0xE0, 0x52, 0x90, 0x91, 0x0D, 0xE0, 0xFE, 0xA3, 0xE0, -+0xFF, 0x7C, 0x00, 0x7D, 0x64, 0x12, 0x07, 0x15, 0x90, 0x91, 0x61, 0xE0, 0x6E, 0x70, 0x03, 0xA3, -+0xE0, 0x6F, 0x60, 0x0A, 0x90, 0x91, 0x61, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x08, 0xD6, 0x90, 0x91, -+0x11, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x91, 0x1F, 0xE0, 0xB5, 0x06, 0x14, 0xA3, 0xE0, 0xB5, -+0x07, 0x0F, 0xEF, 0x4E, 0x60, 0x0B, 0x90, 0x01, 0xC7, 0x74, 0x31, 0xF0, 0x7F, 0x01, 0x02, 0x6C, -+0x62, 0x12, 0x91, 0x9A, 0xE4, 0x90, 0x91, 0x61, 0xF0, 0xA3, 0xF0, 0x22, 0x7D, 0x01, 0x7F, 0x02, -+0xA1, 0xF3, 0x74, 0x1D, 0xF1, 0xD8, 0xF1, 0x30, 0xF0, 0x22, 0x90, 0x8E, 0xC8, 0xE0, 0xFF, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0x8E, 0xD0, 0xE0, 0x54, 0xFD, 0xF0, 0x22, -+0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0x22, 0x90, 0x8E, -+0xCC, 0xE0, 0x60, 0x0E, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x03, 0x02, 0xA5, 0x10, 0xD1, 0x04, -+0x71, 0xE4, 0x22, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x18, 0x90, 0x8D, 0xBF, 0xE0, 0xFF, 0x90, 0x95, -+0xB4, 0x74, 0x09, 0xF0, 0x7B, 0x18, 0xE4, 0xFD, 0x12, 0x5E, 0x6E, 0x90, 0x95, 0xE3, 0x12, 0x97, -+0xCD, 0x22, 0x90, 0x8E, 0xC7, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x8E, 0xD5, 0xF0, 0xA3, 0xF0, -+0x90, 0x8E, 0xD0, 0xF0, 0x90, 0x8E, 0xC8, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, 0xF0, 0x91, 0x60, -+0x7D, 0x10, 0x7F, 0x03, 0xE1, 0x12, 0xE4, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x95, 0xDB, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x7D, 0x44, 0x7F, 0x6F, 0x12, 0x5A, 0xD4, 0x12, 0x5D, -+0x94, 0x90, 0x95, 0xDC, 0xE0, 0x90, 0x95, 0xDB, 0xB4, 0x01, 0x08, 0x12, 0xA9, 0xFC, 0x44, 0x04, -+0xF0, 0x80, 0x06, 0x12, 0xA9, 0xFC, 0x54, 0xFB, 0xF0, 0xF1, 0xE3, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0x8E, 0xC8, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0x22, -+0x12, 0x4C, 0x14, 0xE4, 0xFD, 0xFF, 0x02, 0x5A, 0xD4, 0x7F, 0x80, 0x21, 0x0D, 0x90, 0x8E, 0xC8, -+0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x90, 0x93, 0xC2, 0xF1, 0xF0, 0x30, 0xE0, 0x0D, 0x7B, -+0x00, 0x7A, 0x00, 0x79, 0x00, 0x11, 0x0F, 0x04, 0xF0, 0x02, 0x5C, 0x64, 0x02, 0x5E, 0x1D, 0x90, -+0x95, 0x42, 0x12, 0x48, 0x4F, 0xE4, 0x90, 0x95, 0x45, 0xF0, 0xA3, 0x22, 0x71, 0xED, 0x91, 0x3A, -+0x7A, 0x40, 0x79, 0x56, 0x71, 0xDF, 0x78, 0xE7, 0x7C, 0x93, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, -+0x79, 0x5C, 0x71, 0x13, 0x78, 0xEB, 0x7C, 0x93, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x60, -+0x71, 0x13, 0xE4, 0x90, 0x93, 0xF0, 0xF0, 0x31, 0x4F, 0xCF, 0x24, 0x06, 0xCF, 0x12, 0x67, 0x05, -+0xEF, 0x64, 0x08, 0x60, 0x02, 0x21, 0x37, 0x31, 0x4F, 0xCF, 0x24, 0x07, 0xCF, 0x12, 0x67, 0x05, -+0xEF, 0x64, 0x06, 0x60, 0x02, 0x21, 0x37, 0x90, 0x93, 0xF0, 0x04, 0xF0, 0xE4, 0x90, 0x93, 0xEF, -+0xF0, 0x31, 0x3D, 0x94, 0x06, 0x50, 0x17, 0x90, 0x93, 0xD9, 0xE0, 0x24, 0x0A, 0xFD, 0x90, 0x93, -+0xD8, 0xE0, 0x12, 0x67, 0x28, 0x90, 0x93, 0xEF, 0x91, 0x31, 0x31, 0x44, 0x80, 0xE3, 0x71, 0xE6, -+0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x40, 0xF1, 0x99, 0x60, 0x02, 0x21, 0x37, 0x90, 0x93, 0xEF, 0xF0, -+0x31, 0x3D, 0x94, 0x04, 0x50, 0x19, 0x51, 0xF5, 0x31, 0x5A, 0xCD, 0x24, 0x20, 0x12, 0x67, 0x27, -+0x90, 0x93, 0xEF, 0xE0, 0x24, 0xEB, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0x31, 0x44, 0x80, 0xE1, 0x78, -+0xEB, 0x7C, 0x93, 0x91, 0xDF, 0x70, 0x67, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x01, 0x54, 0xDF, 0xF0, -+0x90, 0x8F, 0x32, 0xE0, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0xC7, 0x74, 0x09, 0x12, 0x6F, 0xCD, 0x80, -+0x56, 0xE4, 0x90, 0x93, 0xEF, 0xF0, 0x31, 0x3D, 0x94, 0x06, 0x50, 0x0C, 0x12, 0x67, 0x13, 0x90, -+0x93, 0xEF, 0x91, 0x28, 0x31, 0x44, 0x80, 0xEE, 0xE4, 0x90, 0x93, 0xEF, 0xF0, 0x31, 0x3D, 0x94, -+0x04, 0x50, 0x19, 0x51, 0xF5, 0x31, 0x5A, 0xCD, 0x24, 0x16, 0x12, 0x67, 0x27, 0x90, 0x93, 0xEF, -+0xE0, 0x24, 0xE7, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0x31, 0x44, 0x80, 0xE1, 0x7B, 0x01, 0x7A, 0x93, -+0x79, 0xE1, 0x11, 0x0F, 0xF0, 0x7A, 0x93, 0x79, 0xE7, 0x12, 0x5C, 0x64, 0x80, 0x09, 0x90, 0x06, -+0x30, 0xE0, 0x44, 0x21, 0x54, 0xEF, 0xF0, 0x90, 0x93, 0xF0, 0xE0, 0xFF, 0x22, 0x90, 0x93, 0xEF, -+0xE0, 0xFF, 0xC3, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0xEF, 0xE0, 0x04, 0xF0, 0x22, 0x90, -+0x93, 0xDA, 0xE0, 0xFF, 0x90, 0x93, 0xD9, 0xE0, 0x2F, 0xFF, 0x90, 0x93, 0xD8, 0xE0, 0x34, 0x00, -+0x22, 0x71, 0xED, 0x71, 0xE6, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x6A, 0x71, 0xDF, 0x91, 0x3A, 0x7A, -+0x40, 0x79, 0x70, 0x71, 0x1A, 0x78, 0xF1, 0x7C, 0x93, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, -+0x80, 0x71, 0x1A, 0xE4, 0x90, 0x94, 0x04, 0xF0, 0x90, 0x93, 0xD8, 0x91, 0x46, 0xFD, 0x71, 0xF9, -+0xEF, 0x64, 0x01, 0x60, 0x02, 0x41, 0xEF, 0x31, 0x4F, 0xCF, 0x24, 0x0E, 0xCF, 0x12, 0x67, 0x05, -+0xEF, 0x64, 0x3A, 0x60, 0x02, 0x41, 0xEF, 0x31, 0x4F, 0xCF, 0x24, 0x30, 0xCF, 0x12, 0x67, 0x05, -+0xEF, 0x64, 0x87, 0x60, 0x02, 0x41, 0xEF, 0x90, 0x94, 0x04, 0x04, 0xF0, 0xE4, 0x90, 0x94, 0x01, -+0xF0, 0x71, 0x01, 0x94, 0x10, 0x50, 0x19, 0x51, 0xF5, 0x31, 0x5A, 0xCD, 0x24, 0x38, 0x12, 0x67, -+0x27, 0x90, 0x94, 0x01, 0xE0, 0x24, 0xF1, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0x71, 0x08, 0x80, 0xE1, -+0xE4, 0x90, 0x94, 0x02, 0xF0, 0x90, 0x94, 0x02, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, 0x02, 0x41, -+0xEF, 0x75, 0xF0, 0x38, 0xEF, 0x71, 0x21, 0x20, 0xE0, 0x02, 0x41, 0xEF, 0xE4, 0x90, 0x94, 0x03, -+0xF0, 0x71, 0x32, 0x90, 0x8F, 0x6A, 0x12, 0x48, 0x3A, 0xE0, 0xFE, 0x90, 0x94, 0x03, 0xE0, 0xC3, -+0x9E, 0x40, 0x02, 0x41, 0xE7, 0xEF, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x81, 0xF9, 0x74, 0x8F, 0x35, -+0xF0, 0xFA, 0x7B, 0x01, 0xE0, 0x75, 0xF0, 0x10, 0xA4, 0x29, 0xF9, 0xEA, 0x35, 0xF0, 0xFA, 0x78, -+0xF1, 0x7C, 0x93, 0x71, 0x29, 0xEF, 0x60, 0x02, 0x41, 0xD8, 0x90, 0x06, 0x33, 0xE0, 0x44, 0x01, -+0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x94, 0x01, 0xF0, 0x71, 0x01, 0x94, 0x06, 0x50, 0x13, 0x51, 0xF5, -+0x31, 0x5A, 0xCD, 0x24, 0x4A, 0x12, 0x67, 0x27, 0x90, 0x94, 0x01, 0x91, 0x31, 0x71, 0x08, 0x80, -+0xE7, 0xE4, 0x90, 0x94, 0x01, 0xF0, 0x71, 0x01, 0x94, 0x10, 0x50, 0x0C, 0x12, 0x67, 0x13, 0x90, -+0x94, 0x01, 0x91, 0x28, 0x71, 0x08, 0x80, 0xEE, 0x71, 0x32, 0x71, 0x21, 0xFE, 0xC3, 0x13, 0x30, -+0xE0, 0x1A, 0xEF, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x71, 0xF9, 0x74, 0x8F, 0x35, 0xF0, 0xFA, 0x7B, -+0x01, 0x78, 0xE1, 0x7C, 0x93, 0x71, 0x29, 0xEF, 0x70, 0x45, 0x80, 0x00, 0x7B, 0x01, 0x7A, 0x93, -+0x79, 0xDB, 0x90, 0x94, 0x08, 0x12, 0x48, 0x4F, 0x7A, 0x93, 0x79, 0xF1, 0x90, 0x94, 0x0B, 0x12, -+0x48, 0x4F, 0x90, 0x94, 0x02, 0xE0, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x6B, 0xF9, 0x74, 0x8F, 0x35, -+0xF0, 0xFA, 0x90, 0x94, 0x0E, 0x12, 0x48, 0x4F, 0xE4, 0x90, 0x94, 0x11, 0xF0, 0xA3, 0xF0, 0x7A, -+0x93, 0x79, 0xE1, 0x12, 0x5A, 0xDF, 0x80, 0x07, 0x90, 0x06, 0x33, 0xE0, 0x44, 0x05, 0xF0, 0x90, -+0x94, 0x03, 0xE0, 0x04, 0xF0, 0x41, 0x01, 0x90, 0x94, 0x02, 0xE0, 0x04, 0xF0, 0x21, 0xE5, 0x90, -+0x94, 0x04, 0xE0, 0xFF, 0x22, 0x90, 0x93, 0xDA, 0xE0, 0xFD, 0x90, 0x93, 0xD9, 0xE0, 0x2D, 0xFD, -+0x22, 0x90, 0x94, 0x01, 0xE0, 0xFF, 0xC3, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x94, 0x01, 0xE0, -+0x04, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x04, 0x02, 0x06, 0x63, 0x7E, 0x00, 0x7F, 0x10, 0x02, 0x06, -+0x63, 0x90, 0x8F, 0x69, 0x12, 0x48, 0x3A, 0xE0, 0x22, 0x7D, 0x01, 0x7E, 0x00, 0x7F, 0x10, 0x02, -+0x4A, 0x04, 0x90, 0x94, 0x02, 0xE0, 0xFF, 0x75, 0xF0, 0x38, 0x22, 0x71, 0xED, 0x71, 0xE6, 0x7B, -+0xFF, 0x7A, 0x40, 0x79, 0x90, 0x71, 0xDF, 0x78, 0xE2, 0x7C, 0x93, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, -+0x40, 0x79, 0x96, 0x71, 0x13, 0xB1, 0x93, 0xF1, 0x49, 0xEF, 0x70, 0x02, 0x61, 0xDE, 0x31, 0x4F, -+0xFE, 0x90, 0x93, 0xE6, 0xF0, 0xA3, 0xEF, 0xF0, 0x24, 0x06, 0xFF, 0xE4, 0x3E, 0x12, 0x67, 0x07, -+0xEF, 0x64, 0x08, 0x70, 0x69, 0x90, 0x93, 0xE7, 0xE0, 0x24, 0x07, 0xFF, 0x90, 0x93, 0xE6, 0x12, -+0x67, 0x04, 0xEF, 0x70, 0x59, 0x90, 0x93, 0xE1, 0xF0, 0x90, 0x93, 0xE1, 0xE0, 0xFF, 0xC3, 0x94, -+0x04, 0x50, 0x25, 0x90, 0x93, 0xE7, 0xE0, 0x24, 0x18, 0xFD, 0x90, 0x93, 0xE6, 0xE0, 0x12, 0x67, -+0x28, 0x90, 0x93, 0xE1, 0xE0, 0x24, 0xE2, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, -+0x90, 0x93, 0xE1, 0xE0, 0x04, 0xF0, 0x80, 0xD1, 0x78, 0xE2, 0x7C, 0x93, 0x91, 0xDF, 0x70, 0x1E, -+0x90, 0x93, 0xE7, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x93, 0xE6, 0xE0, 0x34, 0x00, 0xFE, 0x12, 0x67, -+0x64, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x22, 0x12, 0x6F, 0xCD, 0x22, 0x7E, -+0x00, 0x7F, 0x06, 0x02, 0x06, 0x63, 0x78, 0xDB, 0x7C, 0x93, 0x7D, 0x01, 0x22, 0x90, 0x93, 0xD8, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x22, 0x90, 0x94, 0x05, 0x71, 0xF0, 0x2F, 0xFF, -+0xE4, 0x3E, 0xCF, 0x24, 0x06, 0xCF, 0x12, 0x67, 0x05, 0xBF, 0x86, 0x19, 0x90, 0x94, 0x07, 0xE0, -+0xFF, 0x90, 0x94, 0x06, 0xE0, 0x2F, 0xF1, 0xAA, 0xCF, 0x24, 0x07, 0xCF, 0x12, 0x67, 0x05, 0xBF, -+0xDD, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0xE0, 0x24, 0xE1, 0xF5, 0x82, 0xE4, 0x34, 0x93, -+0x22, 0xE0, 0x24, 0xDB, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0x22, 0x78, 0xE1, 0x7C, 0x93, 0x7D, 0x01, -+0x7B, 0xFF, 0x22, 0x90, 0x95, 0x95, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0x90, 0x95, -+0x97, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x95, 0x95, 0xF1, 0x42, 0x90, 0x95, 0x9A, 0xF0, 0xFD, -+0x12, 0x67, 0x35, 0xEF, 0x54, 0x0C, 0x64, 0x08, 0x70, 0x54, 0x91, 0x43, 0x91, 0xC4, 0x64, 0x88, -+0x70, 0x4C, 0x91, 0x43, 0x24, 0x07, 0xFD, 0x12, 0x67, 0x35, 0xEF, 0x64, 0x8E, 0x70, 0x3F, 0x90, -+0x95, 0x9A, 0x04, 0xF0, 0x91, 0xCC, 0x04, 0xFD, 0x12, 0x67, 0x35, 0xEF, 0x64, 0x03, 0x70, 0x2E, -+0x91, 0xCC, 0x91, 0xC4, 0x30, 0xE3, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x01, 0x80, 0x1D, 0x90, 0x8F, -+0x30, 0xF1, 0xBD, 0x30, 0xE0, 0x08, 0x91, 0x43, 0xFD, 0x12, 0x65, 0xE0, 0x80, 0x10, 0x90, 0x8F, -+0x33, 0xF1, 0xC7, 0x30, 0xE0, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x02, 0x12, 0x6F, 0xCD, 0x90, 0x95, -+0x9A, 0xE0, 0xFF, 0x22, 0x24, 0x06, 0xFD, 0x12, 0x67, 0x35, 0xEF, 0x22, 0x90, 0x95, 0x95, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x98, 0xE0, 0xFD, 0x90, 0x95, 0x97, 0xE0, 0x2D, 0x22, 0x7D, -+0x01, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x5B, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x4A, 0x04, 0xEF, 0x22, -+0x90, 0x93, 0xDF, 0xED, 0xF0, 0x90, 0x93, 0xDD, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xD1, 0x33, 0x90, -+0x93, 0xDD, 0x91, 0x46, 0xFD, 0x02, 0x62, 0x72, 0xB1, 0x71, 0x24, 0x16, 0xFF, 0xE4, 0x3E, 0x12, -+0x67, 0x07, 0x90, 0x91, 0x1D, 0xA3, 0xE0, 0xB5, 0x07, 0x1A, 0x90, 0x93, 0xD9, 0xE0, 0x24, 0x16, -+0x31, 0x59, 0xFE, 0x7D, 0x01, 0x12, 0x67, 0x35, 0xEF, 0xFD, 0x90, 0x91, 0x1D, 0xE0, 0x6D, 0x70, -+0x01, 0xE4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x7F, 0x01, 0x22, 0xB1, 0x71, 0xE4, 0xA3, 0xF0, 0x90, -+0x93, 0xDA, 0xE0, 0xFD, 0xC3, 0x94, 0x04, 0x50, 0x25, 0x90, 0x93, 0xD9, 0xE0, 0x24, 0x10, 0x31, -+0x59, 0xFE, 0x12, 0x67, 0x35, 0x90, 0x93, 0xDA, 0xE0, 0x24, 0x19, 0xF5, 0x82, 0xE4, 0x34, 0x91, -+0xF5, 0x83, 0xE0, 0x6F, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x12, 0x67, 0xEB, 0x80, 0xD1, 0x7F, 0x01, -+0x22, 0x90, 0x93, 0xD8, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xB1, 0x71, 0x90, 0x94, 0xE7, 0xE0, -+0x64, 0x01, 0xF0, 0xE0, 0x24, 0x7A, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x7D, 0xA3, 0xF0, 0xB1, 0x93, -+0x02, 0x6C, 0xAF, 0x90, 0x93, 0xD8, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x71, 0xED, 0xE4, 0xA3, -+0xF0, 0xD1, 0x2A, 0x50, 0x1D, 0xB1, 0x93, 0xD1, 0x23, 0x90, 0x93, 0xDB, 0xE0, 0x24, 0x41, 0xF5, -+0x82, 0xE4, 0x34, 0x91, 0xF5, 0x83, 0xE0, 0xB5, 0x07, 0x1D, 0x90, 0x93, 0xDB, 0xE0, 0x04, 0xF0, -+0x80, 0xDF, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x30, 0xF0, 0x7F, -+0x01, 0x12, 0x6C, 0x62, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x71, 0xED, 0x90, 0x91, 0x13, 0xE0, -+0x70, 0x02, 0xA3, 0xE0, 0x60, 0x29, 0xE4, 0x90, 0x93, 0xDB, 0xF0, 0xD1, 0x2A, 0x50, 0x23, 0xB1, -+0x93, 0xD1, 0x23, 0x90, 0x93, 0xDB, 0xE0, 0x24, 0x21, 0xF5, 0x82, 0xE4, 0x34, 0x91, 0xF5, 0x83, -+0xE0, 0x6F, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x93, 0xDB, 0xE0, 0x04, 0xF0, 0x80, 0xDC, 0x7F, -+0x00, 0x22, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0xE4, 0x90, 0x91, 0x1F, 0xF0, 0xA3, 0xF0, -+0x7F, 0x01, 0x22, 0xED, 0x24, 0x1C, 0xFD, 0x02, 0x67, 0x35, 0x90, 0x93, 0xDB, 0xE0, 0xFD, 0xC3, -+0x94, 0x02, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0xB0, 0xE0, 0xFD, 0xB4, -+0x02, 0x07, 0xF1, 0x31, 0x74, 0x08, 0xF0, 0x80, 0x09, 0xED, 0xB4, 0x04, 0x05, 0xF1, 0x31, 0x74, -+0x10, 0xF0, 0xEF, 0x64, 0x02, 0x4E, 0x60, 0x02, 0xE1, 0x2C, 0x90, 0x90, 0x42, 0xE0, 0xFF, 0x64, -+0xFE, 0x70, 0x02, 0xE1, 0x2C, 0xEF, 0x64, 0x02, 0x60, 0x07, 0xEF, 0x64, 0x03, 0x60, 0x02, 0xE1, -+0x2C, 0x90, 0x90, 0xA2, 0xF1, 0xB2, 0x90, 0x94, 0x33, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xF1, 0x39, -+0x7A, 0x93, 0x79, 0xF1, 0x12, 0x08, 0xAA, 0xF1, 0x39, 0x7A, 0x94, 0x79, 0x11, 0x12, 0x08, 0xAA, -+0x90, 0xAC, 0x7A, 0x74, 0x10, 0xF1, 0xA3, 0x7B, 0x20, 0xFD, 0xFC, 0xFF, 0xFE, 0x12, 0x38, 0xC6, -+0x7B, 0x01, 0x7A, 0x90, 0x79, 0xA4, 0x90, 0xAC, 0x89, 0x12, 0x48, 0x4F, 0x7A, 0x94, 0x79, 0x11, -+0x90, 0xAC, 0x8C, 0x12, 0x48, 0x4F, 0x90, 0xAC, 0x8F, 0x74, 0x20, 0xF0, 0x7A, 0x90, 0x79, 0x11, -+0x12, 0x33, 0x97, 0x75, 0x40, 0x01, 0x75, 0x41, 0x94, 0x75, 0x42, 0x19, 0x75, 0x43, 0x18, 0x7B, -+0x01, 0x7A, 0x93, 0x79, 0xF1, 0x12, 0x34, 0x62, 0x75, 0x40, 0x01, 0x75, 0x41, 0x93, 0x75, 0x42, -+0xF9, 0x75, 0x43, 0x10, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xE0, 0x12, 0x34, 0x62, 0x90, 0x93, 0xF7, -+0xE0, 0x54, 0x03, 0x90, 0x93, 0xF0, 0xF0, 0xC3, 0x94, 0x04, 0x50, 0x1C, 0xE0, 0x90, 0x91, 0x0B, -+0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, 0x93, 0x75, 0x42, 0xE0, 0x75, 0x43, 0x10, 0x7B, 0x01, 0x7A, -+0x90, 0x79, 0xEB, 0x12, 0x34, 0x62, 0x80, 0x06, 0x90, 0x91, 0x0B, 0x74, 0x05, 0xF0, 0x90, 0x93, -+0xF0, 0xE0, 0xFF, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xE0, 0x12, 0x84, 0xED, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0x94, 0x31, 0x74, 0x80, 0xF0, 0xA3, 0x22, 0x7E, 0x00, 0x7F, 0x20, 0x7D, 0x00, 0x7B, -+0x01, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x22, 0x90, 0x95, 0x6B, 0xF1, 0x42, 0x90, 0x95, -+0x73, 0xF0, 0x90, 0x95, 0x73, 0xE0, 0xFD, 0xC3, 0x94, 0x06, 0x50, 0x28, 0x90, 0x95, 0x6C, 0xE0, -+0x24, 0x04, 0xFF, 0x90, 0x95, 0x6B, 0xE0, 0x34, 0x00, 0xFE, 0x12, 0x67, 0x35, 0x90, 0x95, 0x73, -+0xE0, 0x24, 0x6D, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x95, 0x73, 0xE0, -+0x04, 0xF0, 0x80, 0xCE, 0x78, 0x3A, 0x7C, 0x8F, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x6D, -+0xF1, 0x99, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x4A, 0x04, -+0xEF, 0x22, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xFF, 0x90, 0x94, 0x05, 0xE0, 0x34, -+0x00, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFD, 0xED, 0xFF, 0x22, 0x90, 0x8E, 0xC7, 0xE0, 0x13, 0x13, -+0x13, 0x54, 0x1F, 0x22, 0x90, 0x8F, 0x30, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x93, -+0xC2, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0x54, 0xFB, 0xF0, 0xA3, 0x74, 0x0A, 0x80, 0xC3, -+0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, -+0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x12, 0xA1, 0x00, -+0xE5, 0x21, 0x30, 0xE0, 0x03, 0x12, 0x77, 0xE9, 0xE5, 0x21, 0x30, 0xE1, 0x03, 0x12, 0xA1, 0x8E, -+0xE5, 0x21, 0x30, 0xE2, 0x03, 0x12, 0x77, 0x3E, 0xE5, 0x22, 0x30, 0xE0, 0x02, 0x31, 0xCE, 0xE5, -+0x24, 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, 0x71, 0x0D, 0xE5, 0x24, 0x30, 0xE4, 0x02, 0x11, 0x59, -+0xE5, 0x24, 0x30, 0xE5, 0x02, 0x11, 0x63, 0xE5, 0x24, 0x30, 0xE6, 0x02, 0x11, 0xDF, 0xD0, 0x07, -+0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, -+0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x12, 0xA7, 0x9D, 0x7D, 0x02, 0x7F, 0x02, -+0x02, 0x74, 0x6A, 0x90, 0x8E, 0xC7, 0x12, 0x97, 0xBC, 0x30, 0xE0, 0x1B, 0xEF, 0x54, 0xBF, 0x31, -+0x0E, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x0A, 0xE0, 0x54, 0xFE, 0xF0, 0x12, 0x5F, -+0xF8, 0x74, 0x04, 0xF0, 0x12, 0x73, 0xE4, 0xE4, 0xFF, 0x90, 0x93, 0xC6, 0xE0, 0xFD, 0x30, 0xE0, -+0x4D, 0x90, 0x93, 0xCB, 0xE0, 0xFC, 0x60, 0x46, 0x31, 0xC6, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x0B, 0xE4, 0x90, 0x93, -+0xCB, 0xF0, 0x90, 0x93, 0xCD, 0x04, 0xF0, 0x22, 0x90, 0x93, 0xC8, 0xE0, 0xD3, 0x9C, 0x50, 0x15, -+0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x31, 0x17, 0x80, 0x03, 0x12, 0x6C, 0x5A, -+0x12, 0x6F, 0x46, 0xF0, 0x22, 0x12, 0x5E, 0x1D, 0x90, 0x93, 0xCB, 0xE0, 0x04, 0xF0, 0x22, 0x90, -+0x8E, 0xC7, 0xE0, 0xFF, 0x12, 0x6C, 0x53, 0x30, 0xE0, 0x20, 0xEF, 0x54, 0x7F, 0x31, 0x0E, 0x30, -+0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFD, 0xF0, 0x12, 0x5F, 0xF8, 0x04, -+0xF0, 0x90, 0x8E, 0xCC, 0xE0, 0x60, 0x03, 0x12, 0x73, 0xE4, 0x7F, 0x01, 0x01, 0x89, 0xF0, 0x90, -+0x04, 0xE0, 0xE0, 0x90, 0x8E, 0xC8, 0x22, 0xE4, 0xFD, 0xFF, 0x31, 0x23, 0xE4, 0xFF, 0x7D, 0x01, -+0x02, 0x77, 0x98, 0x12, 0x6C, 0x27, 0xFE, 0xEF, 0x54, 0x07, 0xFF, 0xED, 0x70, 0x12, 0x31, 0x64, -+0xC0, 0x83, 0xC0, 0x82, 0x31, 0x5C, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0x80, 0x0F, -+0x31, 0x64, 0xC0, 0x83, 0xC0, 0x82, 0x31, 0x5C, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0xD0, -+0x82, 0xD0, 0x83, 0xF0, 0x31, 0x6F, 0x90, 0x8E, 0xC6, 0xEF, 0xF0, 0x22, 0xE0, 0xFE, 0x74, 0x01, -+0xA8, 0x07, 0x08, 0x22, 0x74, 0xB6, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7D, 0x10, 0xED, 0x14, 0xF9, 0x24, 0xB6, 0x31, 0x67, 0xE0, -+0x60, 0x39, 0x7C, 0x08, 0xEC, 0x14, 0x90, 0x95, 0xE7, 0xF0, 0x74, 0xB6, 0x29, 0x31, 0x67, 0xE0, -+0xFB, 0x7A, 0x00, 0x90, 0x95, 0xE7, 0x31, 0xC4, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0xFF, 0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x0F, 0xE9, 0x75, 0xF0, 0x08, 0xA4, 0xFF, -+0x90, 0x95, 0xE7, 0xE0, 0x2F, 0x04, 0xFF, 0x80, 0x06, 0xDC, 0xC9, 0xDD, 0xBB, 0x7F, 0x00, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x22, 0x12, 0xA1, -+0x98, 0x90, 0x94, 0x93, 0xEF, 0xF0, 0x30, 0xE0, 0x05, 0x7D, 0x01, 0xE4, 0x80, 0x02, 0xE4, 0xFD, -+0xFF, 0x12, 0x58, 0x4A, 0x90, 0x94, 0x93, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, -+0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x91, 0x71, 0x90, 0x95, -+0xC8, 0x74, 0x02, 0xF0, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0x90, 0x8E, 0xC8, -+0x12, 0x6C, 0x52, 0x30, 0xE0, 0x02, 0x41, 0xC1, 0x90, 0x8E, 0xC7, 0xE0, 0x30, 0xE0, 0x16, 0x90, -+0x8E, 0xE9, 0xE0, 0x24, 0x04, 0x90, 0x8E, 0xE1, 0xF0, 0x90, 0x8E, 0xE9, 0xE0, 0x24, 0x03, 0x90, -+0x8E, 0xE0, 0xF0, 0x80, 0x0D, 0x90, 0x8E, 0xE1, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0xE0, 0x14, 0xF0, -+0x0B, 0x0B, 0x90, 0x8E, 0xE0, 0xE0, 0xFA, 0x90, 0x8E, 0xDF, 0xE0, 0xD3, 0x9A, 0x50, 0x0E, 0x90, -+0x8E, 0xD4, 0xEB, 0xF0, 0x90, 0x8E, 0xE1, 0xE0, 0xC3, 0x9D, 0x2C, 0x80, 0x11, 0xC3, 0xED, 0x9A, -+0x2B, 0x90, 0x8E, 0xD4, 0xF0, 0x90, 0x8E, 0xE0, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x8E, -+0xE4, 0xF0, 0x90, 0x8E, 0xE1, 0xE0, 0xFF, 0x24, 0x0A, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x8E, 0xE4, -+0x51, 0xCD, 0x98, 0x40, 0x04, 0xEF, 0x24, 0x0A, 0xF0, 0x90, 0x8E, 0xE4, 0xE0, 0xFF, 0x24, 0x23, -+0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x8E, 0xD4, 0x51, 0xCD, 0x98, 0x40, 0x04, 0xEF, 0x24, 0x23, 0xF0, -+0x90, 0x8E, 0xE4, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0x8E, 0xD8, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -+0x05, 0x58, 0xE0, 0x6F, 0x70, 0x01, 0xE4, 0x60, 0x03, 0x12, 0xA9, 0x8F, 0x12, 0xAA, 0x6D, 0x80, -+0x07, 0x90, 0x8E, 0xC9, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xD3, 0x9D, -+0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x22, 0x12, 0x51, 0x06, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0x51, 0x1F, 0x78, 0x10, 0x12, 0x08, 0x5A, -+0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0xA3, 0x12, 0x51, 0x1F, 0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0x90, 0x8F, 0x1B, 0x12, 0x08, 0x6D, 0x90, 0x8F, 0x1F, -+0x12, 0x48, 0x22, 0x90, 0x8F, 0x1B, 0x12, 0x48, 0x2E, 0xC3, 0x12, 0x48, 0x11, 0x40, 0x41, 0x90, -+0x8E, 0xC7, 0xE0, 0x90, 0x8F, 0x1F, 0x30, 0xE0, 0x10, 0x91, 0x55, 0xFF, 0x90, 0x8E, 0xE9, 0xE0, -+0x24, 0x04, 0x2F, 0xFF, 0x90, 0x8F, 0x23, 0x80, 0x06, 0x91, 0x55, 0xFF, 0x90, 0x8F, 0x24, 0xE0, -+0xFE, 0xC3, 0xEF, 0x9E, 0x90, 0x94, 0x86, 0xF0, 0x90, 0x94, 0x86, 0xE0, 0xFF, 0xC3, 0x94, 0x2D, -+0x50, 0x0E, 0x74, 0xEA, 0x2F, 0x91, 0x3C, 0xE0, 0x04, 0xF0, 0x90, 0x8E, 0xE2, 0xE0, 0x04, 0xF0, -+0x90, 0x8E, 0xE2, 0xE0, 0xFF, 0xD3, 0x90, 0x8F, 0x26, 0xE0, 0x9F, 0x90, 0x8F, 0x25, 0xE0, 0x94, -+0x00, 0x40, 0x02, 0x81, 0x38, 0xE4, 0xFF, 0xFE, 0x91, 0x39, 0x91, 0x4C, 0xEF, 0xD3, 0x9D, 0x40, -+0x07, 0x90, 0x94, 0x87, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xEB, 0xE4, 0xFF, 0xFE, -+0x91, 0x39, 0x91, 0x4C, 0xC3, 0x90, 0x8F, 0x26, 0xE0, 0x9D, 0xFD, 0x90, 0x8F, 0x25, 0xE0, 0x94, -+0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, 0x40, 0x07, 0x90, 0x94, 0x88, 0xEE, 0xF0, 0x80, 0x05, -+0x0E, 0xEE, 0xB4, 0x2D, 0xDB, 0x90, 0x94, 0x87, 0xE0, 0x90, 0x8E, 0xE7, 0xF0, 0x90, 0x94, 0x88, -+0xE0, 0x90, 0x8E, 0xE8, 0x91, 0x44, 0x94, 0x0A, 0x40, 0x0A, 0xEF, 0x24, 0xF6, 0x90, 0x8E, 0xDF, -+0xF0, 0xE4, 0x80, 0x09, 0xE4, 0x90, 0x8E, 0xDF, 0x91, 0x44, 0x74, 0x0A, 0x9F, 0x90, 0x8E, 0xDE, -+0xF0, 0x90, 0x8E, 0xE7, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x8E, 0xE5, 0xF0, 0x90, 0x8E, -+0xC7, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8F, 0x23, 0x80, 0x03, 0x90, 0x8F, 0x24, 0xE0, 0x04, 0xFF, -+0x90, 0x8E, 0xE5, 0xE0, 0x2F, 0xF0, 0x90, 0x8E, 0xE5, 0xE0, 0xC3, 0x94, 0x0A, 0x50, 0x03, 0x74, -+0x0A, 0xF0, 0x90, 0x8E, 0xE5, 0xE0, 0x24, 0x02, 0xF0, 0x91, 0x71, 0x90, 0x95, 0xC8, 0x74, 0x03, -+0xF0, 0x51, 0x04, 0xE4, 0xFF, 0x12, 0xA6, 0x86, 0x22, 0x74, 0xEA, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -+0x8E, 0xF5, 0x83, 0x22, 0xF0, 0x90, 0x8E, 0xE7, 0xE0, 0xFF, 0xC3, 0x22, 0xE0, 0x2F, 0xFF, 0x90, -+0x8F, 0x27, 0xE0, 0xFD, 0x22, 0x12, 0x48, 0x2E, 0x90, 0x8F, 0x1B, 0x12, 0x48, 0x22, 0x12, 0x47, -+0x9A, 0x78, 0x0A, 0x12, 0x08, 0x47, 0x90, 0x8E, 0xE4, 0xE0, 0xFE, 0xC3, 0x74, 0x0A, 0x9E, 0x2F, -+0x22, 0x90, 0x8E, 0xDE, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8E, 0xE5, 0xE0, 0xFB, 0x22, 0x90, -+0x93, 0xDF, 0x12, 0x48, 0x4F, 0x12, 0x77, 0x72, 0x90, 0x8E, 0xCC, 0xE0, 0xFF, 0x12, 0x75, 0xB8, -+0x90, 0x8E, 0xCC, 0xE0, 0x60, 0x1B, 0x90, 0x93, 0xDF, 0x12, 0x48, 0x46, 0x91, 0xB4, 0x54, 0x0F, -+0xFF, 0xD1, 0x52, 0xFD, 0x12, 0xA7, 0x62, 0x91, 0x71, 0x90, 0x95, 0xC8, 0x74, 0x01, 0xF0, 0x51, -+0x04, 0x22, 0x4E, 0xF0, 0x90, 0x00, 0x01, 0x02, 0x06, 0xA2, 0xFF, 0x7B, 0x01, 0x7A, 0x94, 0x79, -+0x39, 0x12, 0x06, 0x89, 0x90, 0x06, 0x74, 0x91, 0xB3, 0x90, 0x06, 0x75, 0xD1, 0x51, 0x90, 0x06, -+0x76, 0xF1, 0x9C, 0x90, 0x06, 0x77, 0xF0, 0x90, 0x06, 0x70, 0xEF, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, -+0x04, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0x90, 0x94, 0x35, -+0xEF, 0xF0, 0xA3, 0x12, 0x48, 0x4F, 0x90, 0x94, 0x36, 0x12, 0x5D, 0x86, 0xB1, 0x58, 0x24, 0x02, -+0x91, 0xBA, 0xB1, 0x6D, 0x24, 0x04, 0xB1, 0x4F, 0x24, 0x03, 0x91, 0xBA, 0xB1, 0x6D, 0x24, 0x08, -+0xB1, 0x4F, 0x24, 0x04, 0x91, 0xBA, 0xB1, 0x6D, 0x24, 0x0C, 0xB1, 0x4F, 0x24, 0x05, 0x91, 0xBA, -+0x90, 0x94, 0x35, 0xE0, 0xFE, 0x44, 0x50, 0x90, 0x94, 0x39, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0xA3, -+0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x91, 0xBA, 0x90, 0x94, 0x39, 0x74, -+0xFF, 0x12, 0x4F, 0xDD, 0xB1, 0x64, 0x04, 0x91, 0xBA, 0x90, 0x06, 0x72, 0xE4, 0xF0, 0x22, 0xF9, -+0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x94, 0x79, -+0x39, 0x12, 0x34, 0x62, 0x90, 0x94, 0x35, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x22, 0x90, 0x94, 0x36, -+0x12, 0x48, 0x46, 0xE9, 0x22, 0x90, 0x95, 0x51, 0x12, 0x48, 0x4F, 0x12, 0x06, 0x89, 0x90, 0x95, -+0x56, 0x91, 0xB3, 0x90, 0x95, 0x57, 0xF1, 0x94, 0x90, 0x95, 0x58, 0xF1, 0xE4, 0x90, 0x95, 0x59, -+0xF1, 0xDD, 0x90, 0x95, 0x5A, 0xF0, 0x90, 0x00, 0x07, 0x12, 0x06, 0xA2, 0x90, 0x95, 0x5B, 0xF1, -+0x9C, 0x90, 0x95, 0x5E, 0xF0, 0xED, 0x70, 0x19, 0xFF, 0xD1, 0x45, 0xE0, 0xB4, 0xFF, 0x06, 0xD1, -+0x45, 0xE4, 0xF0, 0x80, 0x07, 0xD1, 0x45, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x06, -+0xE8, 0x90, 0x95, 0x55, 0xE0, 0xFF, 0xB4, 0x04, 0x15, 0xA3, 0xE0, 0xFE, 0xD1, 0x3F, 0xEE, 0x12, -+0xAA, 0x5E, 0xFE, 0xD1, 0x3F, 0x12, 0x9D, 0x23, 0x90, 0x00, 0x02, 0xE4, 0x80, 0x21, 0xEF, 0xB4, -+0x02, 0x20, 0x90, 0x95, 0x57, 0xD1, 0x3D, 0xEF, 0x12, 0xAA, 0x5E, 0x44, 0x20, 0x54, 0x7F, 0xD1, -+0x3E, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x06, 0xE1, 0x90, 0x95, 0x56, 0xE0, 0x90, 0x00, 0x02, 0x12, -+0x06, 0xE1, 0xD1, 0x3F, 0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x06, 0x89, 0x44, 0x20, -+0x12, 0x06, 0xCF, 0x90, 0x95, 0x58, 0xD1, 0x3D, 0x90, 0x00, 0x04, 0xEF, 0x12, 0x06, 0xE1, 0x90, -+0x95, 0x59, 0xE0, 0x90, 0x00, 0x05, 0x12, 0x06, 0xE1, 0x90, 0x95, 0x5A, 0xE0, 0x90, 0x00, 0x06, -+0x12, 0x06, 0xE1, 0x90, 0x95, 0x5B, 0xE0, 0x90, 0x00, 0x07, 0x02, 0x06, 0xE1, 0xE0, 0xFF, 0x90, -+0x95, 0x51, 0x02, 0x48, 0x46, 0x74, 0x56, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, -+0x4F, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x06, 0xA2, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, -+0xA2, 0xCE, 0x90, 0x8F, 0x30, 0xF1, 0x15, 0x12, 0xAA, 0x4F, 0xFF, 0x90, 0x8F, 0x30, 0x12, 0xA3, -+0x7F, 0xF1, 0x23, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x90, 0x8F, 0x30, 0x12, 0xA9, -+0xC0, 0xF1, 0x23, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, 0x4D, 0xFF, 0x90, 0x8F, 0x30, 0x12, 0xAA, -+0x25, 0x4E, 0xD1, 0x51, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8F, 0x32, 0xE0, 0x54, 0xFE, 0x91, 0xB2, -+0xFE, 0x54, 0x01, 0xFD, 0x90, 0x8F, 0x31, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEE, 0x54, 0x04, -+0xFE, 0xED, 0x54, 0xFB, 0x4E, 0xF0, 0xEF, 0x54, 0x10, 0xFF, 0xA3, 0xE0, 0x54, 0xEF, 0x4F, 0xFF, -+0xD1, 0x51, 0x12, 0xA9, 0xC2, 0x90, 0x8F, 0x32, 0xF0, 0x12, 0x8E, 0x08, 0x12, 0x97, 0x9C, 0x90, -+0x8F, 0x30, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, 0x12, 0xA4, 0xF6, 0x12, 0x6F, 0xF1, 0x54, 0x01, -+0xFF, 0x12, 0xA3, 0xD2, 0x12, 0x6F, 0xF1, 0x13, 0x54, 0x01, 0xFF, 0x12, 0x93, 0xD5, 0x90, 0x8F, -+0x30, 0xE0, 0xC4, 0x54, 0x01, 0xFF, 0x12, 0xA5, 0x02, 0x90, 0x8F, 0x30, 0xE0, 0xC4, 0x13, 0x13, -+0x54, 0x01, 0xFF, 0x12, 0x8E, 0x8B, 0x90, 0x8F, 0x30, 0xE0, 0x54, 0x01, 0xFF, 0x12, 0x94, 0xA4, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, -+0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFE, 0x22, 0x12, 0x97, 0x87, 0x12, 0x06, 0x89, -+0xFF, 0x54, 0x7F, 0x90, 0x8E, 0xCC, 0xF0, 0xEF, 0x12, 0x6C, 0x53, 0xA3, 0x91, 0xB3, 0xFF, 0x54, -+0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0x8E, 0xCA, 0xE0, 0x54, 0xF0, 0xF1, 0x9B, 0x54, 0x01, 0x25, -+0xE0, 0xFE, 0x90, 0x8E, 0xC7, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, -+0xFF, 0x12, 0x73, 0xD5, 0xD1, 0x50, 0x90, 0x8E, 0xCB, 0xF1, 0x94, 0xFD, 0x7F, 0x02, 0x12, 0x58, -+0x4A, 0x90, 0x95, 0x05, 0xE0, 0x60, 0x03, 0x12, 0x58, 0x3E, 0x90, 0x93, 0xDC, 0x12, 0x48, 0x46, -+0x91, 0x7F, 0x12, 0x5F, 0xF8, 0xF0, 0x90, 0x8E, 0xCC, 0x12, 0xA9, 0xB2, 0x12, 0x73, 0xD5, 0x90, -+0x01, 0xBE, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x06, 0xA2, 0x4E, 0xF0, 0x90, 0x00, 0x03, -+0x02, 0x06, 0xA2, 0x90, 0x02, 0x09, 0xE0, 0xF5, 0x52, 0x12, 0x06, 0x89, 0x25, 0x52, 0x90, 0x8D, -+0xBE, 0x91, 0xB3, 0x25, 0x52, 0x90, 0x8D, 0xBF, 0xD1, 0x51, 0x25, 0x52, 0x90, 0x8D, 0xC0, 0xF1, -+0x9C, 0x25, 0x52, 0x90, 0x8D, 0xC1, 0xF1, 0x94, 0x25, 0x52, 0x90, 0x8D, 0xC2, 0xF1, 0xE4, 0x25, -+0x52, 0x90, 0x8D, 0xC3, 0xF1, 0xDD, 0x25, 0x52, 0x90, 0x8D, 0xC4, 0xF0, 0x22, 0xF0, 0x90, 0x00, -+0x06, 0x02, 0x06, 0xA2, 0xF0, 0x90, 0x00, 0x05, 0x02, 0x06, 0xA2, 0x32, 0x32, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0x7C, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x7D, 0x00, 0x7C, 0x00, -+0xE4, 0x90, 0x95, 0x82, 0xF0, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, 0xBC, 0xE4, 0xFF, 0xEC, 0x90, -+0x95, 0x7E, 0x12, 0x08, 0x6D, 0x90, 0x95, 0x7E, 0x12, 0x48, 0x2E, 0x90, 0x95, 0x7D, 0x12, 0x51, -+0x1F, 0x12, 0x48, 0x04, 0xA3, 0x12, 0x08, 0x6D, 0x90, 0x95, 0x7E, 0x12, 0x4F, 0xAA, 0x7F, 0xB0, -+0x7E, 0x08, 0x12, 0x38, 0x07, 0x12, 0x67, 0xF2, 0x90, 0x95, 0x7C, 0xE0, 0x75, 0xF0, 0x08, 0xA4, -+0x24, 0xB5, 0xF5, 0x82, 0xE4, 0x34, 0xAD, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x37, -+0xBC, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x12, 0x87, 0xED, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x18, 0x7C, 0x00, 0x7F, -+0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0x1B, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, -+0x90, 0x95, 0x1A, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x11, 0x5C, 0x90, 0x95, 0x25, 0x12, 0x08, -+0x6D, 0x90, 0x95, 0x1D, 0x12, 0x48, 0x22, 0x12, 0x08, 0x3A, 0x90, 0x95, 0x25, 0x71, 0xCB, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x95, 0x1D, 0x12, 0x48, 0x22, 0x90, 0x95, 0x21, -+0x71, 0xCB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0x04, 0x90, 0x95, 0x29, -+0x12, 0x08, 0x6D, 0x90, 0x95, 0x1B, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x95, 0x29, 0x12, 0x48, -+0x22, 0x90, 0xAA, 0x96, 0x12, 0x08, 0x6D, 0x90, 0x95, 0x1A, 0xE0, 0xFF, 0xD0, 0x05, 0x12, 0x3C, -+0x33, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0xBE, -+0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x95, 0xBD, 0xEF, 0xF0, 0x90, 0x95, 0xC0, 0xE0, 0xFD, 0x71, -+0xEC, 0x90, 0x95, 0xBD, 0xE0, 0xC3, 0x94, 0x0E, 0x50, 0x3F, 0x90, 0x95, 0x2F, 0x12, 0x08, 0x79, -+0x1F, 0xFE, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x12, 0xD4, 0x00, 0x00, 0x71, 0xD1, -+0x90, 0x95, 0x1D, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0x95, 0x21, 0x12, 0x08, 0x79, -+0x00, 0x00, 0x00, 0x00, 0x71, 0x2D, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0x95, 0x21, -+0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x41, 0x64, 0x71, 0xE2, 0x50, 0x1B, 0xEF, 0x94, 0x30, -+0x50, 0x16, 0x90, 0x95, 0x2F, 0x12, 0x08, 0x79, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x95, 0x33, 0x12, -+0x08, 0x79, 0x09, 0x28, 0x00, 0x00, 0x80, 0x64, 0x90, 0x95, 0xBD, 0xE0, 0xFF, 0x74, 0x32, 0xD3, -+0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x40, 0x50, 0x16, 0x90, 0x95, 0x2F, 0x12, 0x08, 0x79, 0x1F, 0xFE, -+0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x08, 0xA6, 0x00, 0x00, 0x80, 0x3E, 0x71, 0xD8, -+0x50, 0x1B, 0xEF, 0x94, 0x74, 0x50, 0x16, 0x90, 0x95, 0x2F, 0x12, 0x08, 0x79, 0x1F, 0xFE, 0x00, -+0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x08, 0xA4, 0x00, 0x00, 0x80, 0x1F, 0x90, 0x95, 0xBD, -+0xE0, 0xFF, 0x74, 0x76, 0xD3, 0x9F, 0x50, 0x16, 0x90, 0x95, 0x2F, 0x12, 0x08, 0x79, 0x1F, 0xFE, -+0x00, 0x00, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x08, 0x24, 0x00, 0x00, 0x71, 0xD1, 0x71, 0xE2, -+0x50, 0x2E, 0xEF, 0x94, 0x40, 0x50, 0x29, 0x90, 0x95, 0x1D, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, -+0x00, 0x90, 0x95, 0x21, 0x12, 0x08, 0x79, 0x00, 0x01, 0x01, 0x00, 0x71, 0x2D, 0x12, 0x08, 0x79, -+0x00, 0x07, 0x03, 0x00, 0x90, 0x95, 0x21, 0x12, 0x08, 0x79, 0x00, 0x01, 0x01, 0x00, 0x80, 0x64, -+0x71, 0xD8, 0x50, 0x2E, 0xEF, 0x94, 0x8C, 0x50, 0x29, 0x90, 0x95, 0x1D, 0x12, 0x08, 0x79, 0x00, -+0x07, 0x03, 0x00, 0x90, 0x95, 0x21, 0x12, 0x08, 0x79, 0x00, 0x03, 0x01, 0x00, 0x71, 0x2D, 0x12, -+0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0x95, 0x21, 0x12, 0x08, 0x79, 0x00, 0x03, 0x01, 0x00, -+0x80, 0x32, 0x90, 0x95, 0xBD, 0xE0, 0xFF, 0x74, 0x8C, 0xC3, 0x9F, 0x50, 0x29, 0x90, 0x95, 0x1D, -+0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0x95, 0x21, 0x12, 0x08, 0x79, 0x00, 0x05, 0x01, -+0x00, 0x71, 0x2D, 0x12, 0x08, 0x79, 0x00, 0x07, 0x03, 0x00, 0x90, 0x95, 0x21, 0x12, 0x08, 0x79, -+0x00, 0x05, 0x01, 0x00, 0x11, 0x6B, 0x90, 0x95, 0xBE, 0xE0, 0x64, 0x02, 0x70, 0x51, 0x90, 0x95, -+0xBD, 0xE0, 0xFF, 0xD3, 0x94, 0x30, 0x50, 0x05, 0x75, 0x5A, 0x2A, 0x80, 0x5E, 0xEF, 0xD3, 0x94, -+0x40, 0x50, 0x05, 0x75, 0x5A, 0x3A, 0x80, 0x53, 0xEF, 0xD3, 0x94, 0x70, 0x50, 0x05, 0x75, 0x5A, -+0x6A, 0x80, 0x48, 0xEF, 0xD3, 0x94, 0x80, 0x50, 0x05, 0x75, 0x5A, 0x7A, 0x80, 0x3D, 0xEF, 0xD3, -+0x94, 0x90, 0x50, 0x05, 0x75, 0x5A, 0x8A, 0x80, 0x32, 0xEF, 0xD3, 0x94, 0xA1, 0x50, 0x05, 0x75, -+0x5A, 0x9B, 0x80, 0x27, 0xEF, 0xD3, 0x94, 0xB1, 0x50, 0x21, 0x75, 0x5A, 0xAB, 0x80, 0x1C, 0x90, -+0x95, 0xBE, 0xE0, 0x64, 0x01, 0x70, 0x31, 0xA3, 0xE0, 0x90, 0x95, 0xBD, 0xB4, 0x01, 0x07, 0xE0, -+0x24, 0x02, 0xF5, 0x5A, 0x80, 0x05, 0xE0, 0x24, 0xFE, 0xF5, 0x5A, 0x90, 0x95, 0x1D, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x5A, 0xE4, 0xFC, 0xFD, 0xFE, 0x71, 0x27, 0x12, 0x08, 0x79, -+0x00, 0x00, 0x00, 0xFF, 0xAF, 0x5A, 0x80, 0x1E, 0x90, 0x95, 0x1D, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x00, 0xFF, 0x90, 0x95, 0xBD, 0x12, 0x51, 0x1F, 0x71, 0x27, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, -+0xFF, 0x90, 0x95, 0xBD, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x95, 0x21, 0x12, 0x08, 0x6D, -+0x11, 0x6B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, 0x21, 0x12, 0x08, 0x6D, 0x7D, 0x18, 0x7C, -+0x00, 0xE4, 0xFF, 0x11, 0x71, 0x90, 0x95, 0x1D, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0xEF, 0x14, 0x60, 0x30, 0x14, 0x60, 0x56, 0x24, 0x02, 0x70, 0x7B, 0x90, 0x95, 0x1D, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x95, 0x21, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x71, -+0x2D, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x95, 0x21, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x0C, 0x00, 0x80, 0x50, 0x90, 0x95, 0x1D, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x95, -+0x21, 0x12, 0x08, 0x79, 0x00, 0x00, 0x04, 0x00, 0x71, 0x2D, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, -+0x00, 0x90, 0x95, 0x21, 0x12, 0x08, 0x79, 0x00, 0x00, 0x04, 0x00, 0x80, 0x27, 0x90, 0x95, 0x1D, -+0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x95, 0x21, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, -+0x00, 0x71, 0x2D, 0x12, 0x08, 0x79, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x95, 0x21, 0x12, 0x08, 0x79, -+0x00, 0x00, 0x00, 0x00, 0x11, 0x6B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x48, 0x2E, 0x02, 0x47, -+0xF7, 0x7F, 0x60, 0x7E, 0x08, 0x02, 0x55, 0x1A, 0x90, 0x95, 0xBD, 0xE0, 0xFF, 0x74, 0x64, 0xD3, -+0x9F, 0x22, 0x90, 0x95, 0xBD, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x22, 0x90, 0x95, 0xE2, 0xED, -+0xF0, 0x90, 0x95, 0xE1, 0xEF, 0xF0, 0xD3, 0x94, 0x0E, 0x50, 0x16, 0x91, 0x43, 0xEF, 0x60, 0x42, -+0x91, 0x43, 0xEF, 0x64, 0x01, 0x70, 0x3B, 0x90, 0x95, 0xE2, 0xE0, 0xFD, 0xE4, 0xFF, 0x02, 0x56, -+0x4B, 0x90, 0x95, 0xE1, 0xE0, 0xD3, 0x94, 0x0E, 0x40, 0x28, 0x91, 0x43, 0xEF, 0x70, 0x21, 0x90, -+0x8E, 0xB2, 0xE0, 0x30, 0xE0, 0x02, 0x91, 0xDE, 0x90, 0x95, 0xE2, 0xE0, 0xFD, 0x7F, 0x01, 0x12, -+0x56, 0x4B, 0x90, 0x8E, 0xB2, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x05, 0x02, 0x97, 0x94, -+0x91, 0x43, 0x22, 0x90, 0x04, 0x54, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x90, -+0x95, 0xC1, 0x12, 0x9B, 0x36, 0xEB, 0xF0, 0xE4, 0xFE, 0x7D, 0x18, 0xFF, 0x12, 0x3D, 0x2C, 0x90, -+0x95, 0xC4, 0xEF, 0xF0, 0x90, 0x95, 0xC1, 0xE0, 0xFF, 0x91, 0x8C, 0x90, 0x95, 0xC1, 0x12, 0x9D, -+0x32, 0x12, 0xA2, 0x36, 0xAE, 0x07, 0x90, 0x04, 0x83, 0xEE, 0xF0, 0x90, 0x95, 0xC1, 0xE0, 0xFF, -+0xAD, 0x06, 0x12, 0x53, 0x48, 0x90, 0x95, 0xC1, 0xE0, 0xFF, 0x61, 0x39, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0xA9, 0x07, 0x90, 0x06, 0x69, 0xE0, 0xFE, 0x90, 0x06, 0x68, 0x12, 0x90, 0x00, -+0xFE, 0xE9, 0x14, 0x60, 0x0F, 0x14, 0x60, 0x1E, 0x24, 0x02, 0x70, 0x25, 0xEE, 0x54, 0xFE, 0xFE, -+0x91, 0xD6, 0x80, 0x1A, 0xEF, 0x44, 0x80, 0xFF, 0xEE, 0x54, 0xFE, 0xFC, 0x90, 0x06, 0x68, 0xEF, -+0xF0, 0xEC, 0xA3, 0xF0, 0x80, 0x0B, 0xEE, 0x44, 0x01, 0xFC, 0x91, 0xD6, 0xAE, 0x04, 0xEE, 0xA3, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x54, 0x7F, 0x90, 0x06, 0x68, 0xF0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x93, 0xEB, 0xF0, 0x7D, 0x1B, 0x7F, -+0xFF, 0x12, 0x5A, 0xD4, 0x90, 0x8E, 0xB3, 0xE0, 0xFF, 0xB1, 0x3F, 0x90, 0x93, 0xEA, 0xEF, 0xF0, -+0xE0, 0x24, 0x10, 0xF0, 0xE0, 0xFF, 0x12, 0x53, 0x3E, 0xE0, 0x54, 0x80, 0x44, 0x04, 0xFE, 0x74, -+0x00, 0x2F, 0x12, 0x53, 0x40, 0xEE, 0xF0, 0x90, 0x93, 0xEB, 0xE0, 0xFF, 0x7D, 0x1C, 0x12, 0x5A, -+0xD4, 0x90, 0x93, 0xEA, 0xE0, 0x24, 0xF0, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x93, 0xEB, 0xE0, 0x04, -+0xF0, 0xE0, 0xB4, 0x1E, 0xF6, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8E, 0xB4, 0xE0, 0xFF, 0x90, -+0xFD, 0x10, 0xEF, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x93, 0xBC, 0xD1, 0x00, 0xEF, 0xF0, 0xE0, 0xFE, -+0x24, 0x28, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x29, 0x2E, 0xF1, 0xA9, -+0xFD, 0x90, 0x93, 0xDC, 0xE0, 0x24, 0x2C, 0x12, 0x92, 0x40, 0x90, 0x93, 0xDC, 0xE0, 0x2F, 0x24, -+0x30, 0xA3, 0xF0, 0xE0, 0xFD, 0x24, 0x04, 0xF1, 0x15, 0xFE, 0x12, 0x93, 0xB7, 0xF5, 0x83, 0xD1, -+0x10, 0x90, 0x91, 0x17, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x93, 0xDD, 0xE0, 0x24, 0x0C, 0xF9, 0xE4, -+0x34, 0xFC, 0x12, 0x5F, 0xB7, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x91, 0x79, 0x19, 0x12, 0x34, -+0x62, 0x90, 0x93, 0xDD, 0xE0, 0x24, 0x14, 0xF0, 0xE0, 0xFD, 0x12, 0x57, 0xD3, 0xE0, 0xFE, 0x74, -+0x00, 0x2D, 0x12, 0x53, 0x40, 0xD1, 0x10, 0x90, 0x91, 0x1D, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x93, -+0xBD, 0xD1, 0x00, 0xEF, 0xF0, 0x90, 0x91, 0x13, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x4E, 0x60, 0x14, -+0x90, 0x93, 0xDC, 0xE0, 0x24, 0x00, 0x12, 0x5F, 0xB3, 0x8F, 0x43, 0x7B, 0x01, 0x7A, 0x91, 0x79, -+0x21, 0x12, 0x34, 0x62, 0x90, 0x93, 0xBE, 0xD1, 0x00, 0xEF, 0xF0, 0x24, 0x00, 0x12, 0x5F, 0xB3, -+0x90, 0x91, 0x15, 0xA3, 0xE0, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x91, 0x79, 0x41, 0x02, 0x34, 0x62, -+0xE0, 0xFF, 0xB1, 0x3F, 0x90, 0x93, 0xDC, 0x22, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, -+0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0x7F, 0x50, 0x7E, 0x0C, 0x12, 0x37, 0xBC, -+0x90, 0x94, 0xEA, 0xEF, 0xF0, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0x90, 0x94, 0xEB, 0xEF, -+0xF0, 0x90, 0x95, 0x2F, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x95, 0x33, 0x12, 0x08, -+0x79, 0x00, 0x00, 0x00, 0x17, 0x7F, 0x50, 0x7E, 0x0C, 0x12, 0x55, 0x8B, 0x12, 0x08, 0x79, 0x00, -+0x00, 0x00, 0x7F, 0x90, 0x95, 0x33, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x17, 0x12, 0x55, 0x16, -+0x90, 0x06, 0x08, 0xE0, 0x90, 0x95, 0x00, 0xF0, 0x90, 0x06, 0xA1, 0xE0, 0xFE, 0x90, 0x06, 0xA0, -+0xD1, 0x10, 0x90, 0x95, 0x02, 0xF0, 0xA3, 0xEF, 0x12, 0xA3, 0x76, 0x90, 0x06, 0xA0, 0x74, 0x20, -+0xF0, 0xA3, 0x74, 0x01, 0xF0, 0xE4, 0xFB, 0xFD, 0xFF, 0x81, 0x4F, 0xEF, 0x60, 0x04, 0xD1, 0x93, -+0xB1, 0x47, 0x22, 0xE4, 0xFD, 0xFC, 0x90, 0x93, 0xBB, 0xF1, 0x9D, 0xAB, 0x05, 0x74, 0x01, 0x2B, -+0x12, 0x57, 0xD5, 0xE0, 0xFE, 0x74, 0x00, 0x2B, 0x12, 0x53, 0x40, 0x12, 0x90, 0x00, 0x90, 0x91, -+0x0D, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x03, 0x2B, 0xF1, 0xE2, 0xE0, 0xFE, 0x74, 0x02, 0x2B, 0x12, -+0xA9, 0x43, 0xE0, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x91, 0x0F, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, -+0x05, 0x2B, 0xF1, 0x82, 0xFE, 0x74, 0x04, 0x2B, 0xF1, 0x15, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, -+0x91, 0x11, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x07, 0x2B, 0xF1, 0x94, 0xFE, 0x74, 0x06, 0x2B, 0xF1, -+0x79, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x91, 0x13, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x09, 0x2B, -+0xF1, 0xB6, 0xFE, 0x74, 0x08, 0x2B, 0xF1, 0x8B, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x91, 0x15, -+0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xB1, 0x3A, -+0x74, 0x00, 0x2F, 0x12, 0x53, 0x40, 0xE0, 0x90, 0x94, 0xEC, 0xF0, 0x74, 0x01, 0x2F, 0x12, 0x57, -+0xD5, 0xE0, 0x90, 0x94, 0xED, 0xF0, 0x74, 0x02, 0x2F, 0x12, 0xA9, 0x43, 0xE0, 0x90, 0x94, 0xEE, -+0xF0, 0x74, 0x03, 0x2F, 0xF1, 0xE2, 0xE0, 0x90, 0x94, 0xEF, 0xF0, 0x74, 0x04, 0x2F, 0xF1, 0x15, -+0x90, 0x94, 0xF0, 0xF0, 0x74, 0x05, 0x2F, 0xF1, 0x82, 0x90, 0x94, 0xF1, 0xF0, 0x74, 0x06, 0x2F, -+0xF1, 0x79, 0x90, 0x94, 0xF2, 0xF0, 0x74, 0x07, 0x2F, 0xF1, 0x94, 0x90, 0x94, 0xF3, 0xF0, 0x74, -+0x08, 0x2F, 0xF1, 0x8B, 0x90, 0x94, 0xF4, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xE0, 0xFF, 0xB1, -+0x3F, 0x7C, 0x00, 0xAD, 0x07, 0x22, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x22, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF1, -+0xB3, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x0A, 0xF1, 0xA6, 0x44, 0x10, 0xF1, 0xB2, 0x44, 0x80, 0xF0, -+0x22, 0xF1, 0xA6, 0x54, 0xEF, 0xF1, 0xB2, 0x44, 0x40, 0xF0, 0x22, 0x90, 0x93, 0xDC, 0xA3, 0xE0, -+0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, -+0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x95, 0x5F, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0xAA, 0x07, 0x90, 0x95, 0x65, 0x12, 0x08, 0x79, -+0x00, 0x00, 0x00, 0x00, 0x90, 0xFD, 0x10, 0xEB, 0xF0, 0xEA, 0x24, 0xEF, 0x60, 0x4A, 0x24, 0xD7, -+0x70, 0x02, 0x21, 0x02, 0x24, 0x3A, 0x60, 0x02, 0x21, 0x39, 0x31, 0x62, 0x24, 0x0A, 0x31, 0x69, -+0xED, 0xF0, 0xFE, 0x12, 0x53, 0x3E, 0xE4, 0xF0, 0x74, 0x01, 0x2E, 0x12, 0x57, 0xD5, 0xE4, 0xF0, -+0xFE, 0x74, 0x00, 0x2F, 0x31, 0x72, 0x7D, 0x14, 0x7C, 0x00, 0x31, 0x7A, 0x7B, 0x00, 0x7A, 0x00, -+0x79, 0x00, 0x90, 0xAC, 0x67, 0x12, 0x48, 0x4F, 0x31, 0x5C, 0x90, 0xAC, 0x6A, 0x12, 0x08, 0x6D, -+0x7D, 0x14, 0x7C, 0x00, 0xE4, 0xFF, 0x01, 0xFD, 0x90, 0x95, 0x5F, 0xE4, 0x75, 0xF0, 0x14, 0x12, -+0x08, 0xD6, 0x90, 0x95, 0x5F, 0xA3, 0xE0, 0xFB, 0xFF, 0x24, 0x06, 0xFC, 0x31, 0x6A, 0xCC, 0xF0, -+0x90, 0x95, 0x69, 0xA3, 0xE0, 0xFE, 0x12, 0x53, 0x3E, 0xE4, 0xF0, 0x74, 0x01, 0x2E, 0x12, 0x57, -+0xD5, 0xE4, 0xF0, 0x74, 0x04, 0x2F, 0x12, 0x8F, 0x15, 0xFE, 0xAD, 0x03, 0x71, 0xB7, 0x12, 0x8F, -+0xFE, 0x90, 0x95, 0x63, 0xF0, 0xA3, 0xEF, 0xF0, 0xED, 0x7E, 0x00, 0x24, 0x00, 0x31, 0x72, 0x31, -+0x83, 0x31, 0x7A, 0x90, 0x95, 0x5F, 0x74, 0xFF, 0x75, 0xF0, 0xEC, 0x12, 0x08, 0xD6, 0x31, 0x62, -+0x7E, 0x00, 0x24, 0x0C, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x02, 0xC0, 0x01, 0x74, -+0x10, 0x2F, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x90, 0xAC, 0x67, 0x12, 0x48, 0x4F, 0x31, 0x5C, 0x90, -+0xAC, 0x6A, 0x12, 0x08, 0x6D, 0x31, 0x83, 0xD0, 0x01, 0xD0, 0x02, 0x7F, 0x11, 0x12, 0x1B, 0x9A, -+0x80, 0x2F, 0x31, 0x62, 0x24, 0x2A, 0x31, 0x69, 0xED, 0xF0, 0xFE, 0x12, 0x53, 0x3E, 0xE4, 0xF0, -+0x74, 0x01, 0x2E, 0x12, 0x57, 0xD5, 0xE4, 0xF0, 0x71, 0xCA, 0x7D, 0x48, 0x7C, 0x00, 0x12, 0x24, -+0xE6, 0x31, 0x56, 0x31, 0x8C, 0xE4, 0xFD, 0xFC, 0x31, 0x56, 0x31, 0x8C, 0x31, 0x56, 0x12, 0x08, -+0x3A, 0x90, 0x95, 0x61, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0x61, 0x71, 0xA6, 0x90, 0x95, -+0x69, 0xA3, 0xE0, 0xFE, 0x12, 0x53, 0x3E, 0xEF, 0xF0, 0x74, 0x01, 0x2E, 0x12, 0x57, 0xD5, 0xED, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, 0x65, 0x12, 0x08, 0x6D, 0x90, 0x95, 0x65, 0x02, -+0x48, 0x22, 0x90, 0x95, 0x5F, 0xA3, 0xE0, 0xFF, 0x22, 0xFD, 0xE4, 0x33, 0x90, 0x95, 0x69, 0xF0, -+0xA3, 0x22, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0x12, 0x24, 0xE6, 0x90, 0x95, 0x65, -+0x02, 0x08, 0x6D, 0x90, 0x95, 0x63, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x22, 0x78, 0x10, 0x12, 0x08, -+0x47, 0x90, 0x95, 0x65, 0x12, 0x48, 0x2E, 0x02, 0x47, 0x8D, 0xE4, 0x90, 0x94, 0x87, 0xF0, 0xA3, -+0xF0, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0x9F, 0x32, 0xEF, 0x64, 0x01, 0x70, 0x69, -+0x90, 0x93, 0xBC, 0xE0, 0xFF, 0x90, 0x95, 0xB4, 0x74, 0x0D, 0xF0, 0x7B, 0x08, 0x7D, 0x01, 0x12, -+0x5E, 0x6E, 0x71, 0xAE, 0x90, 0x94, 0x84, 0x51, 0x23, 0x90, 0x94, 0x86, 0xEF, 0xF0, 0x90, 0x94, -+0x84, 0x71, 0xC0, 0x7B, 0x01, 0xE4, 0xFD, 0x51, 0x69, 0x90, 0x94, 0x86, 0xE0, 0xFF, 0x90, 0x94, -+0x85, 0xE0, 0x2F, 0xFF, 0x90, 0x94, 0x84, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x30, 0xCF, 0x34, 0x00, -+0xFE, 0x90, 0x94, 0x87, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xA8, 0xF4, 0x51, 0x1A, 0x90, 0x93, 0xBC, -+0xE0, 0xFB, 0xE4, 0xFF, 0x11, 0x09, 0x51, 0x1A, 0x90, 0x93, 0xB8, 0xE0, 0xFB, 0x7F, 0x11, 0x11, -+0x09, 0xF1, 0xD2, 0x90, 0x91, 0x1F, 0x12, 0x62, 0x6B, 0x22, 0x90, 0x94, 0x87, 0xE0, 0xFC, 0xA3, -+0xE0, 0xFD, 0x22, 0xA3, 0xE0, 0xFE, 0x24, 0x28, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -+0xFF, 0x74, 0x29, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFD, 0x74, 0x2C, 0x2E, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFE, 0xEF, 0x30, 0xE7, 0x04, 0x7C, -+0x02, 0x80, 0x02, 0xE4, 0xFC, 0xED, 0x30, 0xE6, 0x08, 0xAF, 0x03, 0x71, 0x67, 0xAE, 0x07, 0x80, -+0x02, 0xE4, 0xFE, 0xEC, 0x24, 0x18, 0x2E, 0xFF, 0x22, 0x90, 0x95, 0x92, 0xED, 0xF0, 0x90, 0x95, -+0x8F, 0x12, 0x48, 0x4F, 0xE4, 0x90, 0x95, 0x93, 0xF0, 0xA3, 0xF0, 0x12, 0x06, 0x89, 0xFF, 0x12, -+0x84, 0xB4, 0xFD, 0x12, 0x87, 0x95, 0xFB, 0x51, 0x49, 0x90, 0x95, 0x93, 0xEF, 0xF0, 0x90, 0x95, -+0x8F, 0x12, 0x48, 0x46, 0x12, 0x87, 0x95, 0xFF, 0x71, 0x67, 0x90, 0x95, 0x94, 0xEF, 0xF0, 0x90, -+0x91, 0x0C, 0xE0, 0x24, 0xFE, 0x60, 0x14, 0x24, 0xFE, 0x60, 0x10, 0x14, 0x60, 0x07, 0x14, 0x60, -+0x04, 0x24, 0x05, 0x70, 0x41, 0x51, 0xF7, 0x71, 0x03, 0x80, 0x0D, 0x51, 0xF7, 0x90, 0x91, 0x0C, -+0xE0, 0x90, 0x95, 0x55, 0xF0, 0x12, 0x85, 0x75, 0x90, 0x95, 0x94, 0xE0, 0xFF, 0x90, 0x95, 0x8F, -+0x12, 0x48, 0x46, 0x90, 0x95, 0x93, 0xE0, 0x7C, 0x00, 0x29, 0xF9, 0xEC, 0x3A, 0xFA, 0xC3, 0xE9, -+0x9F, 0xF9, 0xEA, 0x94, 0x00, 0xFA, 0x75, 0x40, 0x01, 0x75, 0x41, 0x90, 0x75, 0x42, 0xDB, 0xA3, -+0xE0, 0xF5, 0x43, 0x12, 0x34, 0x62, 0x22, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xDB, 0x90, 0x95, 0x92, -+0xE0, 0xFD, 0x22, 0x90, 0x95, 0x77, 0xED, 0xF0, 0x90, 0x95, 0x74, 0x12, 0x48, 0x4F, 0x12, 0x87, -+0x9D, 0x90, 0x95, 0x7B, 0xF0, 0x90, 0x95, 0x74, 0x12, 0x5D, 0x86, 0x75, 0x43, 0x03, 0x7B, 0x01, -+0x7A, 0x95, 0x79, 0x78, 0x12, 0x34, 0x62, 0x90, 0x95, 0x77, 0xE0, 0x70, 0x2E, 0xFF, 0x71, 0x5C, -+0xE0, 0xB4, 0xFF, 0x06, 0x71, 0x5C, 0xE4, 0xF0, 0x80, 0x07, 0x71, 0x5C, 0xE0, 0x04, 0xF0, 0x80, -+0x05, 0x0F, 0xEF, 0xB4, 0x03, 0xE8, 0x75, 0x40, 0x01, 0x75, 0x41, 0x95, 0x75, 0x42, 0x78, 0x75, -+0x43, 0x03, 0x90, 0x95, 0x74, 0x12, 0x48, 0x46, 0x12, 0x34, 0x62, 0x22, 0x74, 0x78, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x20, -+0xE0, 0x05, 0x90, 0x93, 0xAF, 0x80, 0x03, 0x90, 0x93, 0xB0, 0xE0, 0x90, 0x91, 0x0C, 0xF0, 0x90, -+0x91, 0x0C, 0xE0, 0x14, 0x60, 0x13, 0x14, 0x60, 0x14, 0x24, 0xFE, 0x60, 0x10, 0x14, 0x60, 0x09, -+0x14, 0x60, 0x06, 0x24, 0x06, 0xE4, 0xFE, 0x80, 0x06, 0x7E, 0x04, 0x80, 0x02, 0x7E, 0x08, 0xAF, -+0x06, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, 0xFF, 0x22, 0x90, 0x94, -+0x84, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x74, 0x05, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0x22, -+0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x22, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, -+0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xE4, 0xFD, 0xFC, 0xEF, 0x60, 0x3D, 0x90, 0x93, 0xB5, 0x12, 0x8F, -+0x9D, 0x71, 0xCA, 0xF1, 0x87, 0x90, 0x93, 0xDC, 0x12, 0x5D, 0x86, 0x75, 0x43, 0x40, 0x7B, 0x01, -+0x7A, 0x90, 0x79, 0x01, 0x12, 0x34, 0x62, 0xE4, 0xFD, 0x7F, 0x03, 0x12, 0x30, 0x0A, 0x90, 0x93, -+0xB6, 0xE0, 0xFE, 0xE4, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x39, -+0x00, 0x7D, 0x01, 0x7F, 0x03, 0x12, 0x30, 0x0A, 0x22, 0x90, 0x93, 0xDF, 0xEF, 0xF0, 0xE4, 0xFF, -+0x74, 0xDB, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x84, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x04, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x08, 0xE3, 0x90, 0x91, 0x0B, -+0xE0, 0x90, 0x04, 0x8C, 0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, 0x90, 0x75, 0x42, 0x4A, 0x75, 0x43, -+0x08, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xE3, 0x12, 0x34, 0x62, 0x90, 0x93, 0xC0, 0xE0, 0x60, 0x19, -+0x90, 0x93, 0xDF, 0xF1, 0xAC, 0x71, 0xCA, 0xC0, 0x03, 0x8B, 0x40, 0x75, 0x41, 0x90, 0x75, 0x42, -+0xDB, 0x75, 0x43, 0x32, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x22, 0xD1, 0x9F, 0x90, 0x93, 0xC0, 0xE0, -+0xFF, 0x91, 0x19, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x90, 0x8D, 0x07, 0xE0, 0xFF, 0xB4, 0x01, -+0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, -+0x54, 0xFB, 0xF0, 0x22, 0xEF, 0x60, 0x38, 0x90, 0x93, 0xB1, 0xE0, 0xFF, 0x60, 0x03, 0x12, 0xA3, -+0xB4, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x12, 0x8E, 0x08, 0xF1, 0x9C, 0x90, 0x06, 0x09, 0xE0, 0x54, -+0xFE, 0xF0, 0x7D, 0x35, 0x12, 0x4B, 0xB1, 0xF1, 0xB4, 0x12, 0x9E, 0x6E, 0xB1, 0xDC, 0x12, 0x77, -+0xE0, 0xF1, 0x13, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, 0xFF, 0x02, 0x74, 0x6A, 0x7D, -+0x08, 0xE4, 0xFF, 0x12, 0x75, 0xF3, 0x90, 0x06, 0x90, 0xE0, 0x54, 0xF0, 0xF0, 0xF1, 0x94, 0x91, -+0x7A, 0xD1, 0x63, 0x7E, 0x00, 0x7F, 0x25, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x30, 0x12, -+0x08, 0xAA, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x20, 0xF0, 0xD1, 0x9F, 0xD1, 0xF2, 0x90, 0x8D, 0x07, -+0xE0, 0xFF, 0x64, 0x02, 0x70, 0x2A, 0xB1, 0xD5, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, 0x8F, 0x4F, -+0xB1, 0xD3, 0x30, 0xE1, 0x02, 0x7E, 0x01, 0x90, 0x8F, 0x4D, 0xB1, 0xD3, 0x30, 0xE2, 0x02, 0x7E, -+0x01, 0x90, 0x8F, 0x4E, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, 0x90, 0x02, 0xFB, 0xF0, 0x80, 0x4A, -+0xEF, 0x64, 0x01, 0x70, 0x1D, 0xB1, 0xCC, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x8F, 0x4F, 0xB1, -+0xCA, 0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x8F, 0x4D, 0xB1, 0xCA, 0x30, 0xE2, 0x02, 0x7F, 0x01, -+0x80, 0x23, 0x90, 0x8D, 0x07, 0xE0, 0x64, 0x03, 0x70, 0x20, 0xB1, 0xC3, 0x30, 0xE0, 0x02, 0x7F, -+0x01, 0x90, 0x8F, 0x4F, 0xB1, 0xC1, 0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x8F, 0x4D, 0xB1, 0xC1, -+0x30, 0xE2, 0x02, 0x7F, 0x01, 0x90, 0x8F, 0x4E, 0xEF, 0xF0, 0x90, 0x8F, 0x30, 0xE0, 0x54, 0xEF, -+0xF0, 0xE4, 0x90, 0x91, 0x63, 0xF0, 0xA3, 0xF0, 0x90, 0x91, 0x6B, 0x12, 0x08, 0x79, 0x00, 0x00, -+0x00, 0x00, 0x90, 0x91, 0x6F, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x90, 0x91, 0x67, 0x12, -+0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x90, 0x93, 0xAB, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, -+0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x70, 0xE0, -+0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, 0x7E, 0x00, 0x22, 0xF1, 0x8D, 0xF1, 0xA4, -+0x30, 0xE0, 0x17, 0x90, 0x8E, 0xB2, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x0C, 0x90, 0x93, -+0xEB, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x14, 0xB1, 0xFB, 0x22, 0xE4, 0x90, 0x93, 0xEF, 0xF0, -+0x7F, 0x03, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0xEA, 0xEF, 0xF0, 0xD1, 0x75, -+0x90, 0x93, 0xEA, 0xE0, 0xFF, 0xD1, 0x91, 0x74, 0x01, 0xF0, 0x90, 0x93, 0xEF, 0xE0, 0xFE, 0xEF, -+0x12, 0xA9, 0xCA, 0xEE, 0xF0, 0x90, 0x93, 0xEA, 0xE0, 0x12, 0x6C, 0x19, 0x12, 0x08, 0x79, 0x00, -+0x00, 0x00, 0x01, 0xD1, 0x5D, 0x78, 0x10, 0x12, 0x08, 0x47, 0xAB, 0x07, 0xD1, 0x5D, 0x78, 0x08, -+0x12, 0x08, 0x47, 0x90, 0x95, 0x87, 0xEF, 0xF0, 0xD1, 0x5D, 0x90, 0x95, 0x88, 0xEF, 0xF0, 0x7D, -+0x01, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x50, 0x19, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0xEB, -+0x02, 0x48, 0x22, 0xD1, 0x85, 0x90, 0x8F, 0x30, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x04, -+0xD1, 0x75, 0xB1, 0x8A, 0x22, 0x90, 0x01, 0x53, 0xE4, 0xF0, 0xFF, 0xD1, 0x90, 0xE4, 0xF0, 0x0F, -+0xEF, 0xB4, 0x08, 0xF7, 0x22, 0x90, 0x8F, 0x30, 0xF1, 0xBC, 0x30, 0xE0, 0x02, 0xD1, 0xF2, 0x22, -+0xEF, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0xA0, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFD, 0x7F, 0x8F, 0x12, 0x4A, 0xCD, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xF1, 0x8E, 0x12, 0xA0, 0x0C, 0x12, 0xA5, 0x4A, 0x91, 0xF3, 0x12, 0x7F, 0xCE, 0xD1, -+0xDE, 0x90, 0x93, 0xCE, 0xE0, 0x54, 0x7F, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, -+0xF0, 0xE4, 0x90, 0x93, 0xD0, 0xF0, 0x90, 0x93, 0xCE, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xF1, 0xC4, -+0x7A, 0x93, 0x79, 0xC6, 0x12, 0x08, 0xAA, 0x90, 0x93, 0xC7, 0x74, 0x08, 0xF0, 0xA3, 0x74, 0x03, -+0xF0, 0x22, 0x12, 0x6C, 0xA7, 0xE4, 0x90, 0x93, 0xBB, 0x12, 0x4F, 0xDD, 0x90, 0x91, 0x0D, 0x12, -+0x4F, 0xDB, 0xA3, 0x12, 0x4F, 0xDB, 0x90, 0x91, 0x1F, 0xF0, 0xA3, 0xF0, 0x90, 0x91, 0x61, 0xF0, -+0xA3, 0xF0, 0x22, 0xE4, 0xFF, 0x74, 0x18, 0xF1, 0x3D, 0xFE, 0x74, 0x40, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x8F, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x10, 0xF1, 0x3D, 0xFE, 0x74, 0x3A, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x06, 0xD9, 0x22, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0x22, 0xF1, 0x87, 0xD1, 0xDE, 0x12, 0xA2, 0xC8, 0x12, 0x6F, -+0x46, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x2D, 0x12, 0x84, 0xB4, 0x90, 0x93, 0xC7, 0x12, -+0x86, 0x51, 0x90, 0x93, 0xC8, 0xF0, 0x12, 0x06, 0x89, 0xFF, 0x54, 0x04, 0xFE, 0x90, 0x93, 0xC6, -+0xE0, 0x54, 0xFB, 0x12, 0x87, 0x9B, 0x90, 0x93, 0xC9, 0xF0, 0xEF, 0x54, 0x08, 0xFF, 0x90, 0x93, -+0xC6, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x22, 0x90, 0x93, 0xDC, 0x02, 0x48, 0x4F, 0x22, 0xE4, 0xFD, -+0xFF, 0x02, 0x81, 0x23, 0x90, 0x02, 0x86, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x8E, 0xAF, 0xF0, -+0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x8F, 0x30, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0xE0, 0xFF, 0x12, 0x8D, -+0x3F, 0x7E, 0x00, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0xFF, 0xC4, 0x13, -+0x13, 0x54, 0x03, 0x22, 0x7E, 0x00, 0x7F, 0x08, 0x7D, 0x00, 0x7B, 0x01, 0x22, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0xE4, 0xFF, 0xD1, 0x90, 0xE4, 0xF0, 0x0F, 0xEF, 0xB4, 0x08, 0xF7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xEF, 0x24, 0xFC, 0x60, 0x05, 0x04, 0x70, 0x05, 0x80, 0x04, 0x12, 0x98, 0x75, 0x22, 0xE4, 0x90, -+0x93, 0xD9, 0xF0, 0x90, 0x95, 0x05, 0x04, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x04, 0xF0, 0x90, -+0x93, 0xAB, 0x12, 0x48, 0x22, 0x71, 0x4C, 0xE4, 0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x90, 0x93, 0xAB, -+0x12, 0x08, 0x6D, 0x12, 0x8E, 0x19, 0xE4, 0x90, 0x94, 0xE9, 0xF0, 0xFF, 0x31, 0xAC, 0x12, 0x72, -+0x5E, 0x70, 0x2C, 0x11, 0x6E, 0x7F, 0x05, 0x7E, 0x00, 0x12, 0x3C, 0xEC, 0x12, 0x58, 0x3E, 0x90, -+0x8E, 0xCF, 0xE0, 0x64, 0x02, 0x60, 0x18, 0x90, 0x93, 0xD9, 0xE0, 0x04, 0xF0, 0x7F, 0x01, 0x7E, -+0x00, 0x12, 0x3C, 0xEC, 0x11, 0x6E, 0x90, 0x93, 0xD9, 0xE0, 0xD3, 0x94, 0x0A, 0x40, 0xE0, 0x90, -+0x93, 0xEB, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x0A, 0x31, 0xA4, 0x02, 0x96, 0x02, 0x7D, 0x01, -+0x7F, 0x02, 0x02, 0x58, 0xD0, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x94, 0xFC, 0xE0, -+0xFF, 0xF1, 0x0F, 0xEF, 0x70, 0x02, 0x21, 0x2A, 0x90, 0x94, 0xFD, 0xE0, 0xFB, 0xD3, 0x94, 0x00, -+0x40, 0x1A, 0x90, 0x95, 0x2F, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x0F, 0xAF, 0x03, 0xE4, 0xFC, -+0xFD, 0xFE, 0x12, 0x57, 0xC8, 0x7F, 0x20, 0x7E, 0x0C, 0x12, 0x55, 0x1A, 0x90, 0x94, 0xFC, 0xE0, -+0xFF, 0x90, 0x06, 0x33, 0xF0, 0xB1, 0x3B, 0xE4, 0xFB, 0xFD, 0x12, 0x88, 0xE6, 0x90, 0x94, 0xFF, -+0xE0, 0x60, 0x07, 0x90, 0x8E, 0xB3, 0xE0, 0xFF, 0x31, 0x6F, 0x12, 0x97, 0xA4, 0x30, 0xE0, 0x35, -+0x90, 0x91, 0x64, 0xE0, 0x60, 0x2F, 0xE4, 0x90, 0x93, 0xDA, 0xF0, 0x90, 0x91, 0x64, 0xE0, 0xFF, -+0x90, 0x93, 0xDA, 0xE0, 0xC3, 0x9F, 0x50, 0x1D, 0x7F, 0x03, 0x7E, 0x00, 0x12, 0x3C, 0xEC, 0x90, -+0x93, 0xDA, 0xE0, 0x24, 0xA3, 0x71, 0x44, 0xE0, 0xFF, 0x31, 0x6F, 0x90, 0x01, 0xA6, 0xE0, 0x04, -+0x12, 0x67, 0xEA, 0x80, 0xD6, 0x90, 0x94, 0xFE, 0xE0, 0x90, 0x93, 0xD9, 0xF0, 0x90, 0x94, 0xE9, -+0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x31, 0xAC, 0x90, 0x93, 0xD9, 0x12, 0x51, 0x1F, 0x90, 0x93, 0xEB, -+0x12, 0x08, 0x6D, 0x31, 0xA4, 0x12, 0x96, 0x02, 0x80, 0x40, 0xE4, 0x90, 0x94, 0xE9, 0xF0, 0x90, -+0x95, 0x05, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x12, 0x57, 0x52, 0xE4, 0xFF, 0x12, -+0x72, 0x80, 0xBF, 0x01, 0x0C, 0x90, 0x95, 0x01, 0xE0, 0xFD, 0x7F, 0x02, 0x12, 0x58, 0x4A, 0xB1, -+0x4D, 0x90, 0x93, 0xDB, 0x74, 0x07, 0xF0, 0x90, 0x93, 0xE9, 0xF0, 0x7B, 0x01, 0x7A, 0x93, 0x79, -+0xDB, 0x51, 0x2B, 0x7F, 0x04, 0x12, 0x70, 0xEE, 0x31, 0xDF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0xEA, 0xEF, 0xF0, 0xF1, 0x32, 0xBF, 0x01, 0x1F, -+0x90, 0x06, 0x32, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x93, 0xEA, 0xE0, 0xFF, 0x90, 0x95, 0xB4, 0x74, -+0x07, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0x12, 0x5E, 0x6E, 0x90, 0x93, 0xEB, 0x12, 0x97, 0xCD, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x93, 0xEF, 0xF0, 0x7F, 0x04, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x93, 0xEA, 0xEF, 0xF0, 0x12, 0x8D, 0x3A, 0x74, 0x10, 0x2F, 0xFF, 0x90, -+0x93, 0xEA, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x2F, 0xFF, 0x24, 0x00, 0x12, 0x5F, 0xB3, 0x75, 0x43, -+0x04, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xFC, 0x12, 0x34, 0x62, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0x8E, 0xB2, 0x12, 0x77, 0x1D, 0x30, 0xE0, 0x3A, 0xEF, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x33, 0x90, -+0x91, 0x6B, 0x12, 0x48, 0x22, 0xEC, 0x4D, 0x4E, 0x4F, 0x60, 0x13, 0x90, 0x93, 0xAB, 0x12, 0x48, -+0x2E, 0xD3, 0x12, 0x48, 0x11, 0x40, 0x07, 0x51, 0x23, 0x90, 0x91, 0x6F, 0x80, 0x05, 0x51, 0x23, -+0x90, 0x91, 0x67, 0x12, 0x48, 0x2E, 0x12, 0x47, 0xA8, 0x90, 0x93, 0xEB, 0x12, 0x08, 0x6D, 0x12, -+0x95, 0xFB, 0x22, 0xE4, 0x7F, 0xE8, 0x7E, 0x03, 0xFD, 0xFC, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x8E, 0xAD, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, -+0x14, 0xFF, 0x90, 0x8E, 0xAE, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, -+0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x28, 0xC0, 0x01, 0x90, 0x8E, 0xAE, -+0xE0, 0x91, 0xA7, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x06, -+0x63, 0x90, 0x8E, 0xAE, 0x71, 0x3D, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, -+0x8E, 0xAE, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0xE7, 0x74, 0x12, 0xF0, 0x90, 0x93, -+0xF5, 0x74, 0x05, 0xF0, 0x90, 0x93, 0xE9, 0x71, 0x36, 0xEB, 0xF0, 0x90, 0x93, 0xE5, 0xE0, 0x90, -+0x93, 0xEC, 0xF0, 0x90, 0x93, 0xE6, 0xE0, 0x90, 0x93, 0xED, 0xF0, 0x7B, 0x01, 0x7A, 0x93, 0x79, -+0xE7, 0x51, 0x2B, 0x7F, 0x04, 0x02, 0x70, 0xEE, 0x71, 0x2F, 0x7F, 0xF5, 0x7E, 0x01, 0x12, 0x33, -+0xFD, 0xBF, 0x01, 0x06, 0x90, 0x93, 0xDC, 0xE0, 0xA3, 0xF0, 0x71, 0x2F, 0x7F, 0xF6, 0x7E, 0x01, -+0x12, 0x33, 0xFD, 0xBF, 0x01, 0x08, 0x90, 0x93, 0xDC, 0xE0, 0x90, 0x93, 0xDE, 0xF0, 0x71, 0x2F, -+0x7F, 0xF4, 0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, 0x01, 0x08, 0x90, 0x93, 0xDC, 0xE0, 0x90, 0x93, -+0xDF, 0xF0, 0x71, 0x2F, 0x7F, 0xF3, 0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, 0x01, 0x08, 0x90, 0x93, -+0xDC, 0xE0, 0x90, 0x93, 0xE0, 0xF0, 0x71, 0x2F, 0x7F, 0xF2, 0x7E, 0x01, 0x12, 0x33, 0xFD, 0xBF, -+0x01, 0x08, 0x90, 0x93, 0xDC, 0xE0, 0x90, 0x93, 0xE1, 0xF0, 0x90, 0x93, 0xDD, 0xB1, 0x32, 0xA3, -+0xE0, 0x90, 0x93, 0xE5, 0xF0, 0x90, 0x93, 0xE1, 0xE0, 0x90, 0x93, 0xE6, 0xF0, 0x41, 0x88, 0x7B, -+0x01, 0x7A, 0x93, 0x79, 0xDC, 0x22, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x22, 0xE0, 0x04, 0xF0, -+0xE0, 0x7F, 0x00, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x91, 0xF5, 0x83, 0x22, 0xEF, 0x24, 0x01, 0xFF, -+0xE4, 0x3E, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0xAD, 0x12, 0x48, -+0x4F, 0x7F, 0x96, 0x7E, 0x02, 0x71, 0xAE, 0xEF, 0x60, 0x3F, 0x12, 0x8E, 0x08, 0xFE, 0x71, 0x4C, -+0x90, 0x95, 0xB0, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x95, 0xB0, 0xE0, 0xFD, -+0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0xAD, 0xB1, 0x1A, 0x24, 0x02, 0xFF, 0xE4, -+0x33, 0xFE, 0x71, 0xF1, 0x90, 0x95, 0xB0, 0xE0, 0x24, 0x18, 0xFF, 0x90, 0x95, 0xAD, 0x12, 0x48, -+0x46, 0x91, 0xB3, 0x90, 0x02, 0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0xA5, 0xEE, 0xF0, 0xA3, 0x12, 0x7F, 0xA2, 0x90, 0x95, -+0xA5, 0xB1, 0x44, 0xE0, 0x60, 0x24, 0xC3, 0x90, 0x95, 0xA8, 0xE0, 0x94, 0xE8, 0x90, 0x95, 0xA7, -+0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x0C, -+0x90, 0x95, 0xA7, 0x12, 0x62, 0x6B, 0xB1, 0x2B, 0x80, 0xD4, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, 0x91, 0x3A, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xF3, -+0x74, 0x00, 0x2D, 0x91, 0x3A, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, -+0x83, 0xE0, 0x54, 0xF0, 0xF0, 0xB1, 0xB6, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, -+0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x8E, 0xAE, 0xE0, 0xFE, -+0x90, 0x8E, 0xAD, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, -+0x01, 0x60, 0x3F, 0xED, 0x91, 0xA7, 0xFA, 0x7B, 0x01, 0x71, 0x54, 0x7F, 0x01, 0xEF, 0x60, 0x32, -+0x90, 0x8E, 0xAD, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, -+0x05, 0xE4, 0x90, 0x8E, 0xAD, 0xF0, 0x90, 0x8E, 0xAE, 0xE0, 0xFF, 0x90, 0x8E, 0xAD, 0xE0, 0xB5, -+0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x07, 0x90, 0x8D, 0x01, 0xE0, 0x44, -+0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x17, 0xF9, 0x74, 0x8E, -+0x35, 0xF0, 0x22, 0x90, 0x95, 0xA9, 0xEF, 0xF0, 0xA3, 0x12, 0x48, 0x4F, 0x90, 0x95, 0xDA, 0xE0, -+0xFE, 0x04, 0xF0, 0xB1, 0x23, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, -+0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x95, 0xAA, 0x12, 0x5D, 0x86, 0x75, 0x43, 0x02, 0xD0, 0x01, -+0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x90, 0x95, 0xA9, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, -+0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x48, 0x46, 0xE9, 0x24, -+0x02, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0x95, 0xAA, 0xB1, 0x1A, 0xF5, -+0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x62, 0x12, 0x48, 0x46, 0x90, 0x00, 0x0E, -+0x02, 0x06, 0xA2, 0x90, 0x00, 0x01, 0xEE, 0x02, 0x06, 0xE1, 0xF0, 0x7F, 0x0A, 0x7E, 0x00, 0x02, -+0x3D, 0x7A, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0x22, 0x90, 0x94, 0xF4, 0xE0, 0x90, -+0x95, 0xC0, 0xF0, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x12, 0x77, 0xE3, -+0x7D, 0x04, 0x7F, 0x01, 0x02, 0x58, 0x4A, 0x12, 0x06, 0x89, 0xFF, 0x90, 0x8E, 0xB1, 0xF0, 0xBF, -+0x01, 0x07, 0x51, 0xB8, 0xE4, 0x90, 0x8E, 0xB1, 0xF0, 0x22, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, -+0x44, 0x0B, 0xB1, 0x2A, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, -+0x01, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0xB1, -+0x2A, 0x90, 0x01, 0x99, 0xE0, 0x44, 0xC0, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x80, 0xF0, 0x22, 0xF0, -+0xA3, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, -+0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, -+0x22, 0xD1, 0xD2, 0x12, 0x8E, 0x10, 0x90, 0x93, 0xDC, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x87, -+0xE0, 0xF9, 0x90, 0x8F, 0x30, 0xE0, 0x30, 0xE0, 0x6D, 0xEC, 0xC3, 0x99, 0x50, 0x68, 0x90, 0x93, -+0xDC, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xD1, 0xBA, 0xAD, 0x07, 0x12, 0x8F, 0xEA, 0x54, 0x3F, 0x90, -+0x93, 0xDE, 0xB1, 0x9F, 0xE0, 0x54, 0x03, 0xFB, 0xEF, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0xCF, 0x2B, -+0xCF, 0x3A, 0x90, 0x93, 0xDE, 0x8F, 0xF0, 0x12, 0x08, 0xD6, 0x90, 0x93, 0xDE, 0xD1, 0x47, 0x90, -+0x93, 0xDE, 0xEE, 0xD1, 0xCA, 0xEE, 0x8F, 0xF0, 0xD1, 0xC2, 0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x90, -+0x93, 0xDD, 0xE0, 0x9F, 0x90, 0x93, 0xDC, 0xE0, 0x9E, 0x40, 0x13, 0x90, 0x8E, 0xB0, 0xD1, 0xDB, -+0xFE, 0xC3, 0x90, 0x93, 0xDD, 0xE0, 0x9F, 0xF0, 0x90, 0x93, 0xDC, 0xE0, 0x9E, 0xF0, 0x90, 0x93, -+0xDC, 0xD1, 0xE6, 0x0C, 0x80, 0x93, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7D, 0x07, 0xEF, 0x5D, -+0xC3, 0x60, 0x0A, 0xD1, 0x61, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x03, 0xD1, 0x61, 0xFF, -+0x22, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, 0x22, 0xD1, 0xF9, -+0xAD, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x6E, 0xF0, 0x74, 0x9E, 0xA3, 0xF0, 0xED, 0x64, 0x01, 0x60, -+0x1E, 0x12, 0x6F, 0xCE, 0xED, 0xB4, 0x02, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x40, 0xF0, 0x80, 0x0A, -+0xED, 0xB4, 0x04, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x41, 0xF0, 0x7F, 0x01, 0x02, 0x6C, 0x62, 0xB1, -+0xC1, 0x90, 0x02, 0x87, 0xE0, 0x70, 0xF8, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x02, 0xF0, 0x74, 0x6E, -+0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x9E, 0xA3, 0xF0, 0x22, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, -+0x03, 0x22, 0x12, 0x08, 0xD6, 0x90, 0x8E, 0xAF, 0xE0, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x93, -+0xDC, 0x22, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x22, 0xE0, 0x24, 0x01, 0xFF, 0x90, -+0x8E, 0xAF, 0xE0, 0x34, 0x00, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x02, 0x84, 0xEF, 0xF0, -+0xEE, 0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE2, 0x03, -+0x7F, 0x04, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x7F, 0x01, 0x20, 0xE1, 0x02, 0x7F, 0x02, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x94, 0xEC, 0xE0, 0xFE, 0x90, 0x94, 0xE9, 0xE0, 0xC3, -+0x9E, 0x40, 0x04, 0x7F, 0x00, 0x80, 0x06, 0xEF, 0x7F, 0x01, 0x70, 0x01, 0xFF, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, -+0x05, 0x22, 0xE0, 0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, -+0xC6, 0xE0, 0x30, 0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xE4, 0x90, 0x93, 0xD8, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x23, 0xC3, 0x90, -+0x93, 0xD9, 0xE0, 0x94, 0xD0, 0x90, 0x93, 0xD8, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, -+0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x93, 0xD8, 0x12, 0x62, 0x6B, 0xB1, 0x2B, 0x80, -+0xD6, 0x7F, 0x01, 0x22, 0x12, 0x06, 0x89, 0x54, 0x01, 0xFF, 0x90, 0x93, 0xD3, 0xE0, 0x54, 0xFE, -+0x4F, 0xF0, 0x22, 0x12, 0x06, 0x89, 0x90, 0x8F, 0x2F, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x8E, 0x16, 0xE0, 0xFF, 0x90, 0x8E, 0x15, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, -+0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x40, 0x90, 0x8E, 0x15, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, -+0x8D, 0xC5, 0x12, 0x48, 0x3A, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0xC6, 0xF9, 0x74, -+0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x12, 0x4E, 0xFD, 0x90, 0x8E, 0x15, 0x71, 0x3D, -+0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x8E, 0x15, 0xF0, 0x12, 0x71, 0x1C, -+0x90, 0x8D, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x8E, 0xAD, -+0xF0, 0xA3, 0xF0, 0x90, 0x8E, 0x15, 0xF0, 0xA3, 0xF0, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, -+0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, -+0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, -+0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0xE4, -+0x90, 0x93, 0xD4, 0xF0, 0xA3, 0xF0, 0x12, 0x9D, 0x6A, 0xEF, 0x64, 0x01, 0x60, 0x3D, 0xC3, 0x90, -+0x93, 0xD5, 0xE0, 0x94, 0x88, 0x90, 0x93, 0xD4, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, -+0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1F, 0x90, 0x93, 0xD4, 0x12, -+0x62, 0x6B, 0x12, 0x67, 0xF2, 0xD3, 0x90, 0x93, 0xD5, 0xE0, 0x94, 0x32, 0x90, 0x93, 0xD4, 0xE0, -+0x94, 0x00, 0x40, 0xC2, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xBB, 0x90, 0x01, 0xC7, 0x74, 0xFE, -+0xF0, 0x22, 0x7F, 0x02, 0x90, 0x93, 0xC1, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, -+0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, -+0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x25, 0xF0, 0xA3, -+0xE4, 0xF0, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x15, 0xF5, 0x19, 0xA3, 0xE0, 0x55, 0x16, 0xF5, -+0x1A, 0xA3, 0xE0, 0x55, 0x17, 0xF5, 0x1B, 0xA3, 0xE0, 0x55, 0x18, 0xF5, 0x1C, 0x90, 0x01, 0x34, -+0xE5, 0x19, 0xF0, 0xA3, 0xE5, 0x1A, 0xF0, 0xA3, 0xE5, 0x1B, 0xF0, 0xA3, 0xE5, 0x1C, 0xF0, 0x22, -+0x90, 0x01, 0x3C, 0xE0, 0x55, 0x1D, 0xF5, 0x21, 0xA3, 0xE0, 0x55, 0x1E, 0xF5, 0x22, 0xA3, 0xE0, -+0x55, 0x1F, 0xF5, 0x23, 0xA3, 0xE0, 0x55, 0x20, 0xF5, 0x24, 0x90, 0x01, 0x3C, 0xE5, 0x21, 0xF0, -+0xA3, 0xE5, 0x22, 0xF0, 0xA3, 0xE5, 0x23, 0xF0, 0xA3, 0xE5, 0x24, 0xF0, 0x53, 0x91, 0xDF, 0x22, -+0x90, 0x01, 0xCF, 0xE0, 0x90, 0x94, 0x84, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, -+0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, -+0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x4F, 0xB2, 0x90, 0x00, 0x03, -+0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x4A, 0xCD, 0x80, 0xFE, 0x22, 0x90, 0x93, 0xCC, 0xE0, -+0x04, 0xF0, 0x90, 0x8E, 0xCF, 0xE0, 0x64, 0x02, 0x60, 0x09, 0x12, 0x74, 0x78, 0x90, 0x01, 0xE6, -+0xE0, 0x04, 0xF0, 0x22, 0x90, 0x8E, 0xCC, 0xE0, 0x60, 0x03, 0x12, 0x5F, 0xCF, 0x22, 0x90, 0x8E, -+0xCC, 0xE0, 0x60, 0x03, 0x12, 0x73, 0x73, 0x22, 0xE4, 0x90, 0x94, 0x95, 0xF0, 0xA3, 0xF0, 0x7F, -+0x83, 0x12, 0x4B, 0x94, 0x90, 0x94, 0x94, 0xEF, 0xF0, 0x7F, 0x83, 0x12, 0x4B, 0x94, 0xAE, 0x07, -+0x90, 0x94, 0x94, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x94, 0x96, 0xE0, 0x94, 0x64, -+0x90, 0x94, 0x95, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, -+0x94, 0x94, 0xE0, 0xFF, 0x22, 0x90, 0x94, 0x95, 0x12, 0x62, 0x6B, 0x80, 0xC2, 0x90, 0x01, 0xC4, -+0x74, 0xDD, 0xF0, 0x74, 0xA1, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x4B, 0x94, 0xEF, 0x20, 0xE0, 0xF7, -+0x74, 0xDD, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xA1, 0xA3, 0xF0, 0x22, 0x74, 0x1D, 0x2F, 0xF8, -+0xE6, 0x4D, 0x12, 0x77, 0x30, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x26, -+0x8F, 0x27, 0xBD, 0x01, 0x15, 0xE5, 0x27, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, -+0xFF, 0xEE, 0x54, 0x1F, 0xFE, 0x12, 0x3C, 0xEC, 0x80, 0x07, 0xAF, 0x27, 0xAE, 0x26, 0x12, 0x3D, -+0x7A, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFE, 0xFC, -+0xEF, 0x64, 0x02, 0x70, 0x40, 0xED, 0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, 0x06, 0xED, 0xB4, 0x02, -+0x02, 0x7E, 0x09, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x04, 0x80, 0x38, 0xEB, -+0xB4, 0x02, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, 0xB4, 0x01, 0x08, 0xED, -+0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, 0xED, 0x64, 0x02, 0x70, -+0x16, 0x7C, 0x03, 0x80, 0x12, 0xEF, 0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, -+0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7C, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4C, 0xFF, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x51, 0xCE, 0x90, 0x93, 0xC2, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, -+0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x12, 0x06, 0x89, 0xC3, 0x13, 0x30, 0xE0, 0x07, -+0x12, 0x84, 0xB4, 0x90, 0x93, 0xC3, 0xF0, 0x22, 0x90, 0x93, 0xDC, 0x12, 0x48, 0x46, 0x12, 0x06, -+0x89, 0xFF, 0x54, 0x01, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x02, 0x09, -+0xE0, 0xFD, 0x51, 0xCE, 0x90, 0x8E, 0xB2, 0x12, 0x87, 0x15, 0x54, 0x04, 0xFC, 0xEF, 0x54, 0xFB, -+0x4C, 0xFF, 0x90, 0x8E, 0xB2, 0x71, 0x7F, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0x54, 0x10, 0xFE, 0xEF, -+0x54, 0xEF, 0x4E, 0x90, 0x8E, 0xB2, 0x12, 0x84, 0xB3, 0xFF, 0xED, 0x2F, 0x90, 0x8E, 0xB3, 0x12, -+0x86, 0x51, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x8E, 0xB4, 0xF0, 0x90, 0x8E, 0xB2, 0xE0, 0xFF, -+0x20, 0xE0, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0A, 0x90, 0x06, 0x31, 0xE0, 0x44, -+0x40, 0xF0, 0x12, 0x8F, 0x1E, 0x90, 0x8E, 0xB2, 0xE0, 0xFF, 0x30, 0xE0, 0x34, 0x90, 0x06, 0x32, -+0xE0, 0x44, 0x01, 0xF0, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0x71, 0x76, 0xEF, 0x13, 0x13, 0x54, -+0x3F, 0x30, 0xE0, 0x09, 0x12, 0x97, 0xB4, 0x90, 0x95, 0x04, 0x74, 0x01, 0xF0, 0x7D, 0x08, 0xE4, -+0xFF, 0x12, 0x74, 0x6A, 0x90, 0x93, 0xEB, 0x12, 0x08, 0x79, 0x00, 0x00, 0x27, 0x10, 0x12, 0x95, -+0xFB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0x06, 0x08, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0xF0, -+0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0x22, 0x90, 0x8F, 0x32, 0xE0, 0xC4, 0x54, 0x0F, -+0x20, 0xE0, 0x0A, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x03, 0x12, 0x6F, 0xCE, 0x90, 0x8F, 0x39, -+0xE0, 0x30, 0xE0, 0x0D, 0x90, 0x8F, 0x33, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x03, 0x7F, 0x00, -+0x22, 0x7F, 0x01, 0x22, 0x12, 0x5F, 0xAB, 0x75, 0x43, 0x08, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xDB, -+0x02, 0x34, 0x62, 0x12, 0x5F, 0xAB, 0x75, 0x43, 0x70, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x69, 0x02, -+0x34, 0x62, 0xEF, 0x60, 0x07, 0x90, 0x93, 0xB7, 0xE0, 0xFF, 0x71, 0xC3, 0x22, 0x90, 0x94, 0x3F, -+0x12, 0x48, 0x4F, 0x90, 0x94, 0x42, 0x12, 0x5D, 0x86, 0x75, 0x43, 0x10, 0x7B, 0x01, 0x7A, 0x8F, -+0x79, 0xD9, 0x12, 0x34, 0x62, 0x90, 0x94, 0x3F, 0x12, 0x5D, 0x86, 0x75, 0x43, 0x10, 0x7B, 0x01, -+0x7A, 0x8F, 0x79, 0xE9, 0x12, 0x34, 0x62, 0x90, 0x94, 0x45, 0x12, 0x48, 0x22, 0x90, 0x8F, 0xF9, -+0x12, 0x08, 0x6D, 0x90, 0x94, 0x49, 0xE0, 0x90, 0x90, 0x00, 0xF0, 0x22, 0x90, 0x8F, 0x39, 0xE0, -+0x30, 0xE0, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x06, 0x90, 0xE0, 0x20, 0xE5, 0x10, 0x90, 0x01, 0x3F, -+0xE0, 0x30, 0xE2, 0x09, 0x90, 0x01, 0xC7, 0x74, 0x25, 0xF0, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, -+0x90, 0x02, 0x09, 0xE0, 0x90, 0x93, 0xDC, 0xF0, 0x12, 0x06, 0x89, 0x90, 0x93, 0xAF, 0x12, 0x84, -+0xB3, 0x90, 0x93, 0xB0, 0xF0, 0x22, 0x91, 0x96, 0x2E, 0x90, 0x93, 0xB1, 0x12, 0x84, 0xB3, 0xFF, -+0xED, 0x2F, 0x90, 0x93, 0xB2, 0x12, 0x86, 0x51, 0xFF, 0xED, 0x2F, 0x90, 0x93, 0xB3, 0x12, 0x87, -+0x9C, 0xFF, 0xED, 0x2F, 0x90, 0x93, 0xB4, 0x12, 0x87, 0x94, 0xFF, 0xED, 0x2F, 0x90, 0x93, 0xB5, -+0x12, 0x87, 0xE4, 0xFF, 0xED, 0x2F, 0x90, 0x93, 0xB6, 0x12, 0x87, 0xDD, 0xFF, 0xAE, 0x05, 0xED, -+0x2F, 0x90, 0x93, 0xB7, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x06, 0x89, 0xFE, 0xAF, -+0x05, 0xED, 0x22, 0x91, 0x96, 0x2E, 0x90, 0x93, 0xBF, 0x12, 0x84, 0xB3, 0xFF, 0xAE, 0x05, 0xED, -+0x2F, 0x90, 0x93, 0xC0, 0xF0, 0x22, 0x91, 0x96, 0x2E, 0x90, 0x93, 0xB8, 0x12, 0x84, 0xB3, 0xFF, -+0xED, 0x2F, 0x90, 0x93, 0xB9, 0x12, 0x86, 0x51, 0xFF, 0xED, 0x2F, 0x90, 0x93, 0xBA, 0x12, 0x87, -+0x9C, 0xFF, 0xED, 0x2F, 0x90, 0x93, 0xBB, 0x12, 0x87, 0x94, 0xFF, 0xED, 0x2F, 0x90, 0x93, 0xBC, -+0x12, 0x87, 0xE4, 0xFF, 0xED, 0x2F, 0x90, 0x93, 0xBD, 0x12, 0x87, 0xDD, 0xFF, 0xAE, 0x05, 0xED, -+0x2F, 0x90, 0x93, 0xBE, 0xF0, 0x22, 0xEF, 0x60, 0x08, 0x90, 0x93, 0xB2, 0xE0, 0xFF, 0x12, 0x5F, -+0x48, 0x22, 0xEF, 0x60, 0x0A, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x80, 0xF0, 0x12, 0x51, 0x26, 0x22, -+0x12, 0x7F, 0xBA, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, -+0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0x95, 0x87, 0xF0, 0x90, 0x8F, 0x2B, 0xE0, -+0xC3, 0x13, 0x54, 0x7F, 0x90, 0x95, 0x88, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, -+0x50, 0x19, 0x90, 0x8E, 0xC7, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, -+0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xC7, 0x12, 0x08, 0xAA, 0x90, 0x8E, 0xCB, 0x74, 0x02, 0xF0, 0x90, -+0x8E, 0xD2, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x90, 0x8E, 0xD8, 0xE4, 0xF0, 0xA3, -+0x74, 0x02, 0xB1, 0xDF, 0xD1, 0x6F, 0xE4, 0xFD, 0xFF, 0x12, 0x58, 0x4A, 0x7D, 0x0C, 0x7F, 0x02, -+0x12, 0x58, 0x4A, 0xB1, 0xEF, 0x90, 0x8D, 0x07, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0x8E, 0xD7, -+0x74, 0xFF, 0xF0, 0x80, 0x0F, 0xEF, 0x90, 0x8E, 0xD7, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, -+0x03, 0x74, 0x40, 0xF0, 0x90, 0x8F, 0x29, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, -+0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0xB1, 0xDF, 0x7F, 0x01, 0xD1, 0x86, 0x90, 0x05, -+0x58, 0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x2D, 0x12, -+0x08, 0xAA, 0xD1, 0x53, 0xD1, 0x5B, 0x12, 0x77, 0xE3, 0xE4, 0x90, 0x8F, 0x2F, 0xF0, 0x22, 0xF0, -+0x90, 0x8E, 0xE9, 0xE0, 0x24, 0x04, 0x90, 0x8E, 0xE4, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x22, 0x7D, -+0x0C, 0x7F, 0x01, 0x02, 0x58, 0x4A, 0x90, 0x95, 0xA0, 0xE0, 0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x95, 0xEE, 0xEF, 0xF0, 0x90, 0x8D, 0xC0, 0xE0, 0xFF, 0x90, 0x04, 0x1C, 0xE0, -+0x6F, 0x70, 0x3B, 0x90, 0x8E, 0xCF, 0xE0, 0x64, 0x0E, 0x70, 0x13, 0x90, 0x95, 0xEE, 0xE0, 0x70, -+0x2D, 0x90, 0x8E, 0xC7, 0xE0, 0x54, 0x7F, 0xF0, 0xD1, 0x53, 0xB1, 0xEF, 0x80, 0x1D, 0x90, 0x8E, -+0xCF, 0xE0, 0x64, 0x06, 0x70, 0x18, 0x90, 0x95, 0xEE, 0xE0, 0x60, 0x12, 0x90, 0x8E, 0xC7, 0xE0, -+0x54, 0xBF, 0xF0, 0xD1, 0x63, 0x90, 0x8E, 0xCF, 0x74, 0x04, 0xF0, 0x12, 0x77, 0xE3, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x06, 0x0A, 0xE0, 0x54, -+0xF8, 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x90, -+0x8F, 0x23, 0x74, 0x04, 0xF0, 0xA3, 0x14, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, -+0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0xE4, 0xFE, 0x12, 0x84, 0x39, 0xE4, 0xF0, 0x0E, 0xEE, 0xB4, -+0x2D, 0xF6, 0xE4, 0x90, 0x8E, 0xE3, 0xF0, 0x90, 0x8E, 0xE2, 0xF0, 0x90, 0x8E, 0xE6, 0xF0, 0xEF, -+0xB4, 0x01, 0x07, 0xA3, 0x74, 0x2D, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0x90, 0x04, 0x1A, 0xE0, 0xF4, -+0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x7F, 0x01, 0x60, -+0x02, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD1, 0xAB, 0xEF, 0x64, 0x01, -+0x60, 0x05, 0x75, 0x5C, 0x01, 0x80, 0x70, 0x90, 0x8E, 0xD0, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, -+0x75, 0x5C, 0x02, 0x80, 0x62, 0x90, 0x8E, 0xCE, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, -+0x5C, 0x04, 0x80, 0x53, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x5C, 0x08, 0x80, 0x4A, 0x90, 0x8E, 0xD0, -+0xE0, 0x30, 0xE4, 0x05, 0x75, 0x5C, 0x10, 0x80, 0x3E, 0x90, 0x8E, 0xC8, 0xE0, 0x13, 0x13, 0x54, -+0x3F, 0x20, 0xE0, 0x05, 0x75, 0x5C, 0x20, 0x80, 0x2E, 0x90, 0x8F, 0x2F, 0xE0, 0x60, 0x05, 0x75, -+0x5C, 0x80, 0x80, 0x23, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, 0x05, 0x75, 0x5C, 0x11, 0x80, 0x17, -+0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, 0x05, 0x75, 0x5C, -+0x12, 0x80, 0x04, 0xF1, 0x5A, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, -+0xE5, 0x5C, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, -+0x01, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0B, 0x04, 0x70, 0x24, 0x90, 0x8E, 0xD2, 0x74, 0x02, 0xF0, -+0x80, 0x13, 0xED, 0x70, 0x06, 0x90, 0x8F, 0x2C, 0xE0, 0x80, 0x02, 0xED, 0x14, 0x90, 0x8E, 0xD2, -+0xF0, 0x90, 0x8E, 0xD2, 0xE0, 0xA3, 0xF0, 0x90, 0x8E, 0xC8, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x7D, -+0x2E, 0x7F, 0x6F, 0x12, 0x5A, 0xD4, 0x7D, 0x02, 0x7F, 0x01, 0x02, 0x58, 0x4A, 0xE4, 0x90, 0x94, -+0x93, 0xF0, 0x90, 0x8E, 0xCC, 0xE0, 0x60, 0x70, 0x12, 0x72, 0x5E, 0x70, 0x6B, 0x12, 0xAA, 0x7D, -+0x12, 0x51, 0x05, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, -+0x62, 0x12, 0x51, 0x1F, 0x78, 0x10, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0x12, 0x48, 0x04, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x51, 0x1F, -+0x78, 0x18, 0x12, 0x08, 0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0xA8, 0x21, -+0x44, 0x80, 0xF0, 0x90, 0x94, 0x93, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x8E, 0xD3, 0xF0, 0x04, 0x60, -+0x17, 0x11, 0x19, 0xE4, 0x90, 0x95, 0x87, 0xF0, 0x90, 0x8E, 0xD4, 0x12, 0x50, 0x0D, 0x90, 0x8E, -+0xCF, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x58, 0xCC, 0x22, 0x90, 0x8E, 0xD0, 0xE0, 0x44, 0x10, 0xF0, -+0x22, 0x12, 0x48, 0x04, 0x90, 0x8F, 0x1F, 0x12, 0x08, 0x6D, 0x90, 0x8E, 0xC8, 0xE0, 0x22, 0x7D, -+0x2F, 0x12, 0x4B, 0xB1, 0x7D, 0x08, 0x7F, 0x01, 0x02, 0x58, 0x4A, 0x12, 0x77, 0xE0, 0x7D, 0x0C, -+0x7F, 0x01, 0x02, 0x58, 0x4A, 0x90, 0x8D, 0xC0, 0xE0, 0xFF, 0x90, 0x95, 0xA1, 0xE0, 0xFB, 0x90, -+0x95, 0xB4, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x5E, 0x6E, 0x90, 0x95, 0xA2, 0xEE, 0xF0, 0xFC, -+0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x95, 0xA0, 0xE0, 0xFF, 0x12, 0x8F, 0xBF, 0x90, 0x95, 0xA2, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x11, 0xD5, 0x44, -+0x01, 0xF0, 0x11, 0xD5, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0x11, 0xE4, 0xE0, 0x44, -+0xFA, 0xF0, 0x74, 0x11, 0x2C, 0x11, 0xEC, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, -+0x12, 0x8F, 0x79, 0x44, 0x0E, 0xF0, 0x90, 0x04, 0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, -+0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0x11, 0xCD, -+0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0x11, 0xCD, 0xED, 0xF0, 0x22, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -+0x22, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0x22, 0xAD, 0x07, 0x90, 0x91, 0x17, 0x12, 0x62, 0x6B, 0x90, 0x91, 0x17, 0xE0, -+0xFF, 0xAE, 0x05, 0x74, 0x04, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, -+0x91, 0x17, 0xA3, 0xE0, 0xFF, 0x74, 0x05, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, -+0xF0, 0x22, 0xED, 0x14, 0x60, 0x06, 0x04, 0x70, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x01, 0x22, 0x12, -+0x08, 0x6D, 0x90, 0x93, 0xDC, 0xE4, 0x75, 0xF0, 0x04, 0x12, 0x08, 0xD6, 0x90, 0x93, 0xDC, 0xA3, -+0xE0, 0x24, 0x02, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x7F, 0x64, 0x7E, 0x08, 0x12, -+0x55, 0x1A, 0x90, 0x95, 0x8B, 0x12, 0x48, 0x22, 0xE4, 0xFF, 0xFE, 0xFD, 0xEC, 0x54, 0x04, 0xFC, -+0x90, 0x95, 0x2F, 0x22, 0x90, 0x93, 0xFD, 0xE0, 0x2F, 0xFF, 0x90, 0x93, 0xFC, 0xE0, 0x34, 0x00, -+0xFE, 0x90, 0x94, 0x80, 0xF0, 0xA3, 0x22, 0xF0, 0x90, 0x8E, 0xD5, 0xE0, 0x75, 0xF0, 0x03, 0xA4, -+0x24, 0xFE, 0x22, 0x90, 0x93, 0xDC, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFE, 0x2F, 0x22, 0xF0, 0x90, -+0x8E, 0xD8, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, -+0x7B, 0x01, 0x22, 0x75, 0xF0, 0x20, 0xA4, 0x24, 0xAB, 0xF9, 0x74, 0x91, 0x35, 0xF0, 0xFA, 0x7B, -+0x01, 0x22, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x8E, 0xCE, 0xE0, 0x90, 0x01, 0xBB, 0xF0, 0x22, -+0xF0, 0xEE, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0x22, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x9F, -+0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x38, 0x07, 0x7F, -+0x00, 0x7E, 0x0E, 0x22, 0x90, 0x8F, 0x29, 0xE0, 0xFF, 0x90, 0x8E, 0xD5, 0xE0, 0xD3, 0x9F, 0x22, -+0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xE0, 0x75, 0xF0, 0x10, -+0x90, 0x81, 0x05, 0x12, 0x48, 0x3A, 0xE0, 0x22, 0x24, 0x30, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, -+0x01, 0x22, 0x90, 0x95, 0xD8, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x22, 0x74, 0x73, 0x2E, 0xF5, -+0x82, 0xE4, 0x34, 0x91, 0x22, 0xF0, 0xEE, 0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, 0x22, 0x7F, 0xB4, -+0x7E, 0x08, 0x12, 0x37, 0xBC, 0xEF, 0x22, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, -+0xF0, 0x7F, 0x10, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0x7F, 0x00, 0x7E, 0x0E, 0x02, 0x38, 0x07, 0x54, -+0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0x22, 0xE4, 0x75, 0xF0, 0x20, 0x02, 0x08, 0xD6, 0x12, 0x06, -+0xCF, 0x90, 0x95, 0x57, 0xE0, 0x22, 0x7F, 0x64, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0x90, 0x8E, 0xC9, -+0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x8E, 0xCA, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x8E, 0xD2, -+0xE0, 0x90, 0x05, 0x73, 0x22, 0x90, 0x95, 0xD5, 0xE0, 0xFF, 0x7D, 0x48, 0x22, 0x00, 0xAE, 0x5E, -+ -+}; -+u4Byte ArrayLength_MP_8821A_FW_WoWLAN = 27312; -+ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_WoWLAN( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8821A_FW_WoWLAN; -+#else -+ ODM_MoveMemory(pDM_Odm, pFirmware, Array_MP_8821A_FW_WoWLAN, ArrayLength_MP_8821A_FW_WoWLAN); -+#endif -+ *pFirmwareSize = ArrayLength_MP_8821A_FW_WoWLAN; -+} -+ -+ -+ -+#endif /* end of (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP)))*/ -+ -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_fw.h linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_fw.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_fw.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_fw.h 2017-06-07 23:07:21.029689216 +0300 -@@ -0,0 +1,73 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.16*/ -+#if (RTL8821A_SUPPORT == 1) -+#ifndef __INC_MP_FW_HW_IMG_8821A_H -+#define __INC_MP_FW_HW_IMG_8821A_H -+ -+ -+/****************************************************************************** -+* FW_AP.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_AP( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_NIC.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_NIC( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_NIC_BT.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_NIC_BT( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_WoWLAN.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_WoWLAN( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_mac.c linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_mac.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_mac.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_mac.c 2017-06-07 23:07:21.029689216 +0300 -@@ -0,0 +1,286 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.14*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8821A_SUPPORT == 1) -+static BOOLEAN -+CheckPositive( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2, -+ IN const u4Byte Condition3, -+ IN const u4Byte Condition4 -+) -+{ -+ u1Byte _BoardType = ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA*/ -+ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA*/ -+ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA*/ -+ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ -+ ((pDM_Odm->BoardType & BIT2) >> 2) << 4; /* _BT*/ -+ -+ u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; -+ u4Byte driver1 = pDM_Odm->CutVersion << 24 | -+ (pDM_Odm->SupportInterface & 0xF0) << 16 | -+ pDM_Odm->SupportPlatform << 16 | -+ pDM_Odm->PackageType << 12 | -+ (pDM_Odm->SupportInterface & 0x0F) << 8 | -+ _BoardType; -+ -+ u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | -+ (pDM_Odm->TypeGPA & 0xFF) << 8 | -+ (pDM_Odm->TypeALNA & 0xFF) << 16 | -+ (pDM_Odm->TypeAPA & 0xFF) << 24; -+ -+u4Byte driver3 = 0; -+ -+ u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | -+ (pDM_Odm->TypeGPA & 0xFF00) | -+ (pDM_Odm->TypeALNA & 0xFF00) << 8 | -+ (pDM_Odm->TypeAPA & 0xFF00) << 16; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Platform, Interface) = (0x%X, 0x%X)\n", pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Board, Package) = (0x%X, 0x%X)\n", pDM_Odm->BoardType, pDM_Odm->PackageType)); -+ -+ -+ /*============== Value Defined Check ===============*/ -+ /*QFN Type [15:12] and Cut Version [27:24] need to do value check*/ -+ -+ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return FALSE; -+ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return FALSE; -+ -+ /*=============== Bit Defined Check ================*/ -+ /* We don't care [31:28] */ -+ -+ cond1 &= 0x00FF0FFF; -+ driver1 &= 0x00FF0FFF; -+ -+ if ((cond1 & driver1) == cond1) { -+ u4Byte bitMask = 0; -+ -+ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE*/ -+ return TRUE; -+ -+ if ((cond1 & BIT0) != 0) /*GLNA*/ -+ bitMask |= 0x000000FF; -+ if ((cond1 & BIT1) != 0) /*GPA*/ -+ bitMask |= 0x0000FF00; -+ if ((cond1 & BIT2) != 0) /*ALNA*/ -+ bitMask |= 0x00FF0000; -+ if ((cond1 & BIT3) != 0) /*APA*/ -+ bitMask |= 0xFF000000; -+ -+ if (((cond2 & bitMask) == (driver2 & bitMask)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ -+ return TRUE; -+ else -+ return FALSE; -+ } else -+ return FALSE; -+} -+static BOOLEAN -+CheckNegative( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2 -+) -+{ -+ return TRUE; -+} -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8821A_MAC_REG[] = { -+ 0x421, 0x0000000F, -+ 0x428, 0x0000000A, -+ 0x429, 0x00000010, -+ 0x430, 0x00000000, -+ 0x431, 0x00000000, -+ 0x432, 0x00000000, -+ 0x433, 0x00000001, -+ 0x434, 0x00000004, -+ 0x435, 0x00000005, -+ 0x436, 0x00000007, -+ 0x437, 0x00000008, -+ 0x43C, 0x00000004, -+ 0x43D, 0x00000005, -+ 0x43E, 0x00000007, -+ 0x43F, 0x00000008, -+ 0x440, 0x0000005D, -+ 0x441, 0x00000001, -+ 0x442, 0x00000000, -+ 0x444, 0x00000010, -+ 0x445, 0x00000000, -+ 0x446, 0x00000000, -+ 0x447, 0x00000000, -+ 0x448, 0x00000000, -+ 0x449, 0x000000F0, -+ 0x44A, 0x0000000F, -+ 0x44B, 0x0000003E, -+ 0x44C, 0x00000010, -+ 0x44D, 0x00000000, -+ 0x44E, 0x00000000, -+ 0x44F, 0x00000000, -+ 0x450, 0x00000000, -+ 0x451, 0x000000F0, -+ 0x452, 0x0000000F, -+ 0x453, 0x00000000, -+ 0x456, 0x0000005E, -+ 0x460, 0x00000066, -+ 0x461, 0x00000066, -+ 0x4C8, 0x0000003F, -+ 0x4C9, 0x000000FF, -+ 0x4CC, 0x000000FF, -+ 0x4CD, 0x000000FF, -+ 0x4CE, 0x00000001, -+ 0x500, 0x00000026, -+ 0x501, 0x000000A2, -+ 0x502, 0x0000002F, -+ 0x503, 0x00000000, -+ 0x504, 0x00000028, -+ 0x505, 0x000000A3, -+ 0x506, 0x0000005E, -+ 0x507, 0x00000000, -+ 0x508, 0x0000002B, -+ 0x509, 0x000000A4, -+ 0x50A, 0x0000005E, -+ 0x50B, 0x00000000, -+ 0x50C, 0x0000004F, -+ 0x50D, 0x000000A4, -+ 0x50E, 0x00000000, -+ 0x50F, 0x00000000, -+ 0x512, 0x0000001C, -+ 0x514, 0x0000000A, -+ 0x516, 0x0000000A, -+ 0x525, 0x0000004F, -+ 0x550, 0x00000010, -+ 0x551, 0x00000010, -+ 0x559, 0x00000002, -+ 0x55C, 0x00000050, -+ 0x55D, 0x000000FF, -+ 0x605, 0x00000030, -+ 0x607, 0x00000007, -+ 0x608, 0x0000000E, -+ 0x609, 0x0000002A, -+ 0x620, 0x000000FF, -+ 0x621, 0x000000FF, -+ 0x622, 0x000000FF, -+ 0x623, 0x000000FF, -+ 0x624, 0x000000FF, -+ 0x625, 0x000000FF, -+ 0x626, 0x000000FF, -+ 0x627, 0x000000FF, -+ 0x638, 0x00000050, -+ 0x63C, 0x0000000A, -+ 0x63D, 0x0000000A, -+ 0x63E, 0x0000000E, -+ 0x63F, 0x0000000E, -+ 0x640, 0x00000040, -+ 0x642, 0x00000040, -+ 0x643, 0x00000000, -+ 0x652, 0x000000C8, -+ 0x66E, 0x00000005, -+ 0x700, 0x00000021, -+ 0x701, 0x00000043, -+ 0x702, 0x00000065, -+ 0x703, 0x00000087, -+ 0x708, 0x00000021, -+ 0x709, 0x00000043, -+ 0x70A, 0x00000065, -+ 0x70B, 0x00000087, -+ 0x718, 0x00000040, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_MAC_REG( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_MAC_REG)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8821A_MAC_REG; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8821A_MAC_REG\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } -+ else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigMAC_8821A(pDM_Odm, v1, (u1Byte)v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8821A_MAC_REG(void) -+{ -+ return 54; -+} -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_mac.h linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_mac.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_mac.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_mac.h 2017-06-07 23:07:21.029689216 +0300 -@@ -0,0 +1,39 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.14*/ -+#if (RTL8821A_SUPPORT == 1) -+#ifndef __INC_MP_MAC_HW_IMG_8821A_H -+#define __INC_MP_MAC_HW_IMG_8821A_H -+ -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_MAC_REG(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_MAC_REG(void); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_rf.c linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_rf.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_rf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_rf.c 2017-06-07 23:07:21.030689307 +0300 -@@ -0,0 +1,4856 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.14*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8821A_SUPPORT == 1) -+static BOOLEAN -+CheckPositive( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2, -+ IN const u4Byte Condition3, -+ IN const u4Byte Condition4 -+) -+{ -+ u1Byte _BoardType = ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA*/ -+ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA*/ -+ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA*/ -+ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ -+ ((pDM_Odm->BoardType & BIT2) >> 2) << 4; /* _BT*/ -+ -+ u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; -+ u4Byte driver1 = pDM_Odm->CutVersion << 24 | -+ (pDM_Odm->SupportInterface & 0xF0) << 16 | -+ pDM_Odm->SupportPlatform << 16 | -+ pDM_Odm->PackageType << 12 | -+ (pDM_Odm->SupportInterface & 0x0F) << 8 | -+ _BoardType; -+ -+ u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | -+ (pDM_Odm->TypeGPA & 0xFF) << 8 | -+ (pDM_Odm->TypeALNA & 0xFF) << 16 | -+ (pDM_Odm->TypeAPA & 0xFF) << 24; -+ -+u4Byte driver3 = 0; -+ -+ u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | -+ (pDM_Odm->TypeGPA & 0xFF00) | -+ (pDM_Odm->TypeALNA & 0xFF00) << 8 | -+ (pDM_Odm->TypeAPA & 0xFF00) << 16; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Platform, Interface) = (0x%X, 0x%X)\n", pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Board, Package) = (0x%X, 0x%X)\n", pDM_Odm->BoardType, pDM_Odm->PackageType)); -+ -+ -+ /*============== Value Defined Check ===============*/ -+ /*QFN Type [15:12] and Cut Version [27:24] need to do value check*/ -+ -+ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return FALSE; -+ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return FALSE; -+ -+ /*=============== Bit Defined Check ================*/ -+ /* We don't care [31:28] */ -+ -+ cond1 &= 0x00FF0FFF; -+ driver1 &= 0x00FF0FFF; -+ -+ if ((cond1 & driver1) == cond1) { -+ u4Byte bitMask = 0; -+ -+ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE*/ -+ return TRUE; -+ -+ if ((cond1 & BIT0) != 0) /*GLNA*/ -+ bitMask |= 0x000000FF; -+ if ((cond1 & BIT1) != 0) /*GPA*/ -+ bitMask |= 0x0000FF00; -+ if ((cond1 & BIT2) != 0) /*ALNA*/ -+ bitMask |= 0x00FF0000; -+ if ((cond1 & BIT3) != 0) /*APA*/ -+ bitMask |= 0xFF000000; -+ -+ if (((cond2 & bitMask) == (driver2 & bitMask)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ -+ return TRUE; -+ else -+ return FALSE; -+ } else -+ return FALSE; -+} -+static BOOLEAN -+CheckNegative( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2 -+) -+{ -+ return TRUE; -+} -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8821A_RadioA[] = { -+ 0x018, 0x0001712A, -+ 0x056, 0x00051CF2, -+ 0x066, 0x00040000, -+ 0x000, 0x00010000, -+ 0x01E, 0x00080000, -+ 0x082, 0x00000830, -+ 0x083, 0x00021800, -+ 0x084, 0x00028000, -+ 0x085, 0x00048000, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x086, 0x0009483A, -+ 0xA0000000, 0x00000000, -+ 0x086, 0x00094838, -+ 0xB0000000, 0x00000000, -+ 0x087, 0x00044980, -+ 0x088, 0x00048000, -+ 0x089, 0x0000D480, -+ 0x08A, 0x00042240, -+ 0x08B, 0x000F0380, -+ 0x08C, 0x00090000, -+ 0x08D, 0x00022852, -+ 0x08E, 0x00065540, -+ 0x08F, 0x00088001, -+ 0x0EF, 0x00020000, -+ 0x03E, 0x00000380, -+ 0x03F, 0x00090018, -+ 0x03E, 0x00020380, -+ 0x03F, 0x000A0018, -+ 0x03E, 0x00040308, -+ 0x03F, 0x000A0018, -+ 0x03E, 0x00060018, -+ 0x03F, 0x000A0018, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x089, 0x00000080, -+ 0x08B, 0x00080180, -+ 0x0EF, 0x00001000, -+ 0x03A, 0x00000244, -+ 0x03B, 0x00038027, -+ 0x03C, 0x00082000, -+ 0x03A, 0x00000244, -+ 0x03B, 0x00030113, -+ 0x03C, 0x00082000, -+ 0x03A, 0x0000014C, -+ 0x03B, 0x00028027, -+ 0x03C, 0x00082000, -+ 0x03A, 0x000000CC, -+ 0x03B, 0x00027027, -+ 0x03C, 0x00042000, -+ 0x03A, 0x0000014C, -+ 0x03B, 0x0001F913, -+ 0x03C, 0x00042000, -+ 0x03A, 0x0000010C, -+ 0x03B, 0x00017F10, -+ 0x03C, 0x00012000, -+ 0x03A, 0x000000D0, -+ 0x03B, 0x00008027, -+ 0x03C, 0x000CA000, -+ 0x03A, 0x00000244, -+ 0x03B, 0x00078027, -+ 0x03C, 0x00082000, -+ 0x03A, 0x00000244, -+ 0x03B, 0x00070113, -+ 0x03C, 0x00082000, -+ 0x03A, 0x0000014C, -+ 0x03B, 0x00068027, -+ 0x03C, 0x00082000, -+ 0x03A, 0x000000CC, -+ 0x03B, 0x00067027, -+ 0x03C, 0x00042000, -+ 0x03A, 0x0000014C, -+ 0x03B, 0x0005F913, -+ 0x03C, 0x00042000, -+ 0x03A, 0x0000010C, -+ 0x03B, 0x00057F10, -+ 0x03C, 0x00012000, -+ 0x03A, 0x000000D0, -+ 0x03B, 0x00048027, -+ 0x03C, 0x000CA000, -+ 0x03A, 0x00000244, -+ 0x03B, 0x000B8027, -+ 0x03C, 0x00082000, -+ 0x03A, 0x00000244, -+ 0x03B, 0x000B0113, -+ 0x03C, 0x00082000, -+ 0x03A, 0x0000014C, -+ 0x03B, 0x000A8027, -+ 0x03C, 0x00082000, -+ 0x03A, 0x000000CC, -+ 0x03B, 0x000A7027, -+ 0x03C, 0x00042000, -+ 0x03A, 0x0000014C, -+ 0x03B, 0x0009F913, -+ 0x03C, 0x00042000, -+ 0x03A, 0x0000010C, -+ 0x03B, 0x00097F10, -+ 0x03C, 0x00012000, -+ 0x03A, 0x000000D0, -+ 0x03B, 0x00088027, -+ 0x03C, 0x000CA000, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00001100, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0004ADF3, -+ 0x034, 0x00049DF0, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0004ADF3, -+ 0x034, 0x00049DF0, -+ 0x90000210, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0004ADF5, -+ 0x034, 0x00049DF2, -+ 0x9000020c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0004A0F3, -+ 0x034, 0x000490B1, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0004A0F3, -+ 0x034, 0x000490B1, -+ 0x90000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0004ADF5, -+ 0x034, 0x00049DF2, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0004ADF3, -+ 0x034, 0x00049DF0, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x0004ADF7, -+ 0x034, 0x00049DF3, -+ 0xB0000000, 0x00000000, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00048DED, -+ 0x034, 0x00047DEA, -+ 0x034, 0x00046DE7, -+ 0x034, 0x00045CE9, -+ 0x034, 0x00044CE6, -+ 0x034, 0x000438C6, -+ 0x034, 0x00042886, -+ 0x034, 0x00041486, -+ 0x034, 0x00040447, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00048DED, -+ 0x034, 0x00047DEA, -+ 0x034, 0x00046DE7, -+ 0x034, 0x00045CE9, -+ 0x034, 0x00044CE6, -+ 0x034, 0x000438C6, -+ 0x034, 0x00042886, -+ 0x034, 0x00041486, -+ 0x034, 0x00040447, -+ 0x9000020c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x000480AE, -+ 0x034, 0x000470AB, -+ 0x034, 0x0004608B, -+ 0x034, 0x00045069, -+ 0x034, 0x00044048, -+ 0x034, 0x00043045, -+ 0x034, 0x00042026, -+ 0x034, 0x00041023, -+ 0x034, 0x00040002, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x000480AE, -+ 0x034, 0x000470AB, -+ 0x034, 0x0004608B, -+ 0x034, 0x00045069, -+ 0x034, 0x00044048, -+ 0x034, 0x00043045, -+ 0x034, 0x00042026, -+ 0x034, 0x00041023, -+ 0x034, 0x00040002, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00048DED, -+ 0x034, 0x00047DEA, -+ 0x034, 0x00046DE7, -+ 0x034, 0x00045CE9, -+ 0x034, 0x00044CE6, -+ 0x034, 0x000438C6, -+ 0x034, 0x00042886, -+ 0x034, 0x00041486, -+ 0x034, 0x00040447, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x00048DEF, -+ 0x034, 0x00047DEC, -+ 0x034, 0x00046DE9, -+ 0x034, 0x00045CCB, -+ 0x034, 0x0004488D, -+ 0x034, 0x0004348D, -+ 0x034, 0x0004248A, -+ 0x034, 0x0004108D, -+ 0x034, 0x0004008A, -+ 0xB0000000, 0x00000000, -+ 0x80000210, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0002ADF4, -+ 0x9000020c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0002A0F3, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0002A0F3, -+ 0x90000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0002ADF4, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x0002ADF7, -+ 0xB0000000, 0x00000000, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00029DF4, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00029DF4, -+ 0x90000210, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00029DF1, -+ 0x9000020c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x000290F0, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x000290F0, -+ 0x90000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00029DF1, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00029DF4, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x00029DF2, -+ 0xB0000000, 0x00000000, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00028DF1, -+ 0x034, 0x00027DEE, -+ 0x034, 0x00026DEB, -+ 0x034, 0x00025CEC, -+ 0x034, 0x00024CE9, -+ 0x034, 0x000238CA, -+ 0x034, 0x00022889, -+ 0x034, 0x00021489, -+ 0x034, 0x0002044A, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00028DF1, -+ 0x034, 0x00027DEE, -+ 0x034, 0x00026DEB, -+ 0x034, 0x00025CEC, -+ 0x034, 0x00024CE9, -+ 0x034, 0x000238CA, -+ 0x034, 0x00022889, -+ 0x034, 0x00021489, -+ 0x034, 0x0002044A, -+ 0x9000020c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x000280AF, -+ 0x034, 0x000270AC, -+ 0x034, 0x0002608B, -+ 0x034, 0x00025069, -+ 0x034, 0x00024048, -+ 0x034, 0x00023045, -+ 0x034, 0x00022026, -+ 0x034, 0x00021023, -+ 0x034, 0x00020002, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x000280AF, -+ 0x034, 0x000270AC, -+ 0x034, 0x0002608B, -+ 0x034, 0x00025069, -+ 0x034, 0x00024048, -+ 0x034, 0x00023045, -+ 0x034, 0x00022026, -+ 0x034, 0x00021023, -+ 0x034, 0x00020002, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00028DF1, -+ 0x034, 0x00027DEE, -+ 0x034, 0x00026DEB, -+ 0x034, 0x00025CEC, -+ 0x034, 0x00024CE9, -+ 0x034, 0x000238CA, -+ 0x034, 0x00022889, -+ 0x034, 0x00021489, -+ 0x034, 0x0002044A, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x00028DEE, -+ 0x034, 0x00027DEB, -+ 0x034, 0x00026CCD, -+ 0x034, 0x00025CCA, -+ 0x034, 0x0002488C, -+ 0x034, 0x0002384C, -+ 0x034, 0x00022849, -+ 0x034, 0x00021449, -+ 0x034, 0x0002004D, -+ 0xB0000000, 0x00000000, -+ 0x8000020c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0000A0D7, -+ 0x034, 0x000090D3, -+ 0x034, 0x000080B1, -+ 0x034, 0x000070AE, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0000A0D7, -+ 0x034, 0x000090D3, -+ 0x034, 0x000080B1, -+ 0x034, 0x000070AE, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x0000ADF7, -+ 0x034, 0x00009DF4, -+ 0x034, 0x00008DF1, -+ 0x034, 0x00007DEE, -+ 0xB0000000, 0x00000000, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00006DEB, -+ 0x034, 0x00005CEC, -+ 0x034, 0x00004CE9, -+ 0x034, 0x000038CA, -+ 0x034, 0x00002889, -+ 0x034, 0x00001489, -+ 0x034, 0x0000044A, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00006DEB, -+ 0x034, 0x00005CEC, -+ 0x034, 0x00004CE9, -+ 0x034, 0x000038CA, -+ 0x034, 0x00002889, -+ 0x034, 0x00001489, -+ 0x034, 0x0000044A, -+ 0x9000020c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0000608D, -+ 0x034, 0x0000506B, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x00002044, -+ 0x034, 0x00001025, -+ 0x034, 0x00000004, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x0000608D, -+ 0x034, 0x0000506B, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x00002044, -+ 0x034, 0x00001025, -+ 0x034, 0x00000004, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x034, 0x00006DEB, -+ 0x034, 0x00005CEC, -+ 0x034, 0x00004CE9, -+ 0x034, 0x000038CA, -+ 0x034, 0x00002889, -+ 0x034, 0x00001489, -+ 0x034, 0x0000044A, -+ 0xA0000000, 0x00000000, -+ 0x034, 0x00006DCD, -+ 0x034, 0x00005CCD, -+ 0x034, 0x00004CCA, -+ 0x034, 0x0000388C, -+ 0x034, 0x00002888, -+ 0x034, 0x00001488, -+ 0x034, 0x00000486, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x035, 0x00000187, -+ 0x035, 0x00008187, -+ 0x035, 0x00010187, -+ 0x035, 0x00020188, -+ 0x035, 0x00028188, -+ 0x035, 0x00030188, -+ 0x035, 0x00040188, -+ 0x035, 0x00048188, -+ 0x035, 0x00050188, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x035, 0x00000187, -+ 0x035, 0x00008187, -+ 0x035, 0x00010187, -+ 0x035, 0x00020188, -+ 0x035, 0x00028188, -+ 0x035, 0x00030188, -+ 0x035, 0x00040188, -+ 0x035, 0x00048188, -+ 0x035, 0x00050188, -+ 0x90000210, 0x00000000, 0x40000000, 0x00000000, -+ 0x035, 0x00000128, -+ 0x035, 0x00008128, -+ 0x035, 0x00010128, -+ 0x035, 0x000201C8, -+ 0x035, 0x000281C8, -+ 0x035, 0x000301C8, -+ 0x035, 0x000401C8, -+ 0x035, 0x000481C8, -+ 0x035, 0x000501C8, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x035, 0x00000145, -+ 0x035, 0x00008145, -+ 0x035, 0x00010145, -+ 0x035, 0x00020196, -+ 0x035, 0x00028196, -+ 0x035, 0x00030196, -+ 0x035, 0x000401C7, -+ 0x035, 0x000481C7, -+ 0x035, 0x000501C7, -+ 0x90000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x035, 0x00000128, -+ 0x035, 0x00008128, -+ 0x035, 0x00010128, -+ 0x035, 0x000201C8, -+ 0x035, 0x000281C8, -+ 0x035, 0x000301C8, -+ 0x035, 0x000401C8, -+ 0x035, 0x000481C8, -+ 0x035, 0x000501C8, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x035, 0x00000187, -+ 0x035, 0x00008187, -+ 0x035, 0x00010187, -+ 0x035, 0x00020188, -+ 0x035, 0x00028188, -+ 0x035, 0x00030188, -+ 0x035, 0x00040188, -+ 0x035, 0x00048188, -+ 0x035, 0x00050188, -+ 0xA0000000, 0x00000000, -+ 0x035, 0x00000145, -+ 0x035, 0x00008145, -+ 0x035, 0x00010145, -+ 0x035, 0x00020196, -+ 0x035, 0x00028196, -+ 0x035, 0x00030196, -+ 0x035, 0x000401C7, -+ 0x035, 0x000481C7, -+ 0x035, 0x000501C7, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x036, 0x00085733, -+ 0x036, 0x0008D733, -+ 0x036, 0x00095733, -+ 0x036, 0x0009D733, -+ 0x036, 0x000A64B4, -+ 0x036, 0x000AE4B4, -+ 0x036, 0x000B64B4, -+ 0x036, 0x000BE4B4, -+ 0x036, 0x000C64B4, -+ 0x036, 0x000CE4B4, -+ 0x036, 0x000D64B4, -+ 0x036, 0x000DE4B4, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x036, 0x00085733, -+ 0x036, 0x0008D733, -+ 0x036, 0x00095733, -+ 0x036, 0x0009D733, -+ 0x036, 0x000A64B4, -+ 0x036, 0x000AE4B4, -+ 0x036, 0x000B64B4, -+ 0x036, 0x000BE4B4, -+ 0x036, 0x000C64B4, -+ 0x036, 0x000CE4B4, -+ 0x036, 0x000D64B4, -+ 0x036, 0x000DE4B4, -+ 0x90000210, 0x00000000, 0x40000000, 0x00000000, -+ 0x036, 0x000063B5, -+ 0x036, 0x0000E3B5, -+ 0x036, 0x000163B5, -+ 0x036, 0x0001E3B5, -+ 0x036, 0x000263B5, -+ 0x036, 0x0002E3B5, -+ 0x036, 0x000363B5, -+ 0x036, 0x0003E3B5, -+ 0x036, 0x000463B5, -+ 0x036, 0x0004E3B5, -+ 0x036, 0x000563B5, -+ 0x036, 0x0005E3B5, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x036, 0x000056B3, -+ 0x036, 0x0000D6B3, -+ 0x036, 0x000156B3, -+ 0x036, 0x0001D6B3, -+ 0x036, 0x00026634, -+ 0x036, 0x0002E634, -+ 0x036, 0x00036634, -+ 0x036, 0x0003E634, -+ 0x036, 0x000467B4, -+ 0x036, 0x0004E7B4, -+ 0x036, 0x000567B4, -+ 0x036, 0x0005E7B4, -+ 0x90000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x036, 0x000063B5, -+ 0x036, 0x0000E3B5, -+ 0x036, 0x000163B5, -+ 0x036, 0x0001E3B5, -+ 0x036, 0x000263B5, -+ 0x036, 0x0002E3B5, -+ 0x036, 0x000363B5, -+ 0x036, 0x0003E3B5, -+ 0x036, 0x000463B5, -+ 0x036, 0x0004E3B5, -+ 0x036, 0x000563B5, -+ 0x036, 0x0005E3B5, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x036, 0x00085733, -+ 0x036, 0x0008D733, -+ 0x036, 0x00095733, -+ 0x036, 0x0009D733, -+ 0x036, 0x000A64B4, -+ 0x036, 0x000AE4B4, -+ 0x036, 0x000B64B4, -+ 0x036, 0x000BE4B4, -+ 0x036, 0x000C64B4, -+ 0x036, 0x000CE4B4, -+ 0x036, 0x000D64B4, -+ 0x036, 0x000DE4B4, -+ 0xA0000000, 0x00000000, -+ 0x036, 0x000056B3, -+ 0x036, 0x0000D6B3, -+ 0x036, 0x000156B3, -+ 0x036, 0x0001D6B3, -+ 0x036, 0x00026634, -+ 0x036, 0x0002E634, -+ 0x036, 0x00036634, -+ 0x036, 0x0003E634, -+ 0x036, 0x000467B4, -+ 0x036, 0x0004E7B4, -+ 0x036, 0x000567B4, -+ 0x036, 0x0005E7B4, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000008, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x000001C8, -+ 0x03C, 0x00000492, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x000001C8, -+ 0x03C, 0x00000492, -+ 0x90000210, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x000001B6, -+ 0x03C, 0x00000492, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x0000022A, -+ 0x03C, 0x00000594, -+ 0x90000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x000001B6, -+ 0x03C, 0x00000492, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x000001C8, -+ 0x03C, 0x00000492, -+ 0xA0000000, 0x00000000, -+ 0x03C, 0x0000022A, -+ 0x03C, 0x00000594, -+ 0xB0000000, 0x00000000, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x00000800, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x00000800, -+ 0x90000210, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x00000800, -+ 0x9000020c, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x00000820, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x00000820, -+ 0x90000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x00000800, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x03C, 0x00000800, -+ 0xA0000000, 0x00000000, -+ 0x03C, 0x00000900, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000002, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x008, 0x0004E400, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x008, 0x0004E400, -+ 0x90000210, 0x00000000, 0x40000000, 0x00000000, -+ 0x008, 0x00002000, -+ 0x9000020c, 0x00000000, 0x40000000, 0x00000000, -+ 0x008, 0x00002000, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x008, 0x00002000, -+ 0x90000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x008, 0x00002000, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x008, 0x0004E400, -+ 0xA0000000, 0x00000000, -+ 0x008, 0x00002000, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x0DF, 0x000000C0, -+ 0x01F, 0x00000064, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x058, 0x000A7284, -+ 0x059, 0x000600EC, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x058, 0x000A7284, -+ 0x059, 0x000600EC, -+ 0x9000020c, 0x00000000, 0x40000000, 0x00000000, -+ 0x058, 0x00081184, -+ 0x059, 0x0006016C, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x058, 0x00081184, -+ 0x059, 0x0006016C, -+ 0x90000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x058, 0x00081184, -+ 0x059, 0x0006016C, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x058, 0x000A7284, -+ 0x059, 0x000600EC, -+ 0xA0000000, 0x00000000, -+ 0x058, 0x00081184, -+ 0x059, 0x0006016C, -+ 0xB0000000, 0x00000000, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x061, 0x000E8D73, -+ 0x062, 0x00093FC5, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x061, 0x000E8D73, -+ 0x062, 0x00093FC5, -+ 0x90000210, 0x00000000, 0x40000000, 0x00000000, -+ 0x061, 0x000EFD83, -+ 0x062, 0x00093FCC, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x061, 0x000EAD53, -+ 0x062, 0x00093BC4, -+ 0x90000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x061, 0x000EFD83, -+ 0x062, 0x00093FCC, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x061, 0x000E8D73, -+ 0x062, 0x00093FC5, -+ 0xA0000000, 0x00000000, -+ 0x061, 0x000EAD53, -+ 0x062, 0x00093BC4, -+ 0xB0000000, 0x00000000, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x000110E9, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x000110E9, -+ 0x90000210, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x000110EB, -+ 0x9000020c, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x000110E9, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x000110E9, -+ 0x90000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x000110EB, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x000110E9, -+ 0xA0000000, 0x00000000, -+ 0x063, 0x000714E9, -+ 0xB0000000, 0x00000000, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x064, 0x0001C27C, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x064, 0x0001C27C, -+ 0x90000210, 0x00000000, 0x40000000, 0x00000000, -+ 0x064, 0x0001C27C, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x064, 0x0001C67C, -+ 0x90000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x064, 0x0001C27C, -+ 0x90000410, 0x00000000, 0x40000000, 0x00000000, -+ 0x064, 0x0001C27C, -+ 0xA0000000, 0x00000000, -+ 0x064, 0x0001C67C, -+ 0xB0000000, 0x00000000, -+ 0x80000111, 0x00000000, 0x40000000, 0x00000000, -+ 0x065, 0x00091016, -+ 0x90000110, 0x00000000, 0x40000000, 0x00000000, -+ 0x065, 0x00091016, -+ 0x90000210, 0x00000000, 0x40000000, 0x00000000, -+ 0x065, 0x00093016, -+ 0x9000020c, 0x00000000, 0x40000000, 0x00000000, -+ 0x065, 0x00093015, -+ 0x9000040c, 0x00000000, 0x40000000, 0x00000000, -+ 0x065, 0x00093015, -+ 0x90000200, 0x00000000, 0x40000000, 0x00000000, -+ 0x065, 0x00093016, -+ 0xA0000000, 0x00000000, -+ 0x065, 0x00091016, -+ 0xB0000000, 0x00000000, -+ 0x018, 0x00000006, -+ 0x0EF, 0x00002000, -+ 0x03B, 0x0003824B, -+ 0x03B, 0x0003024B, -+ 0x03B, 0x0002844B, -+ 0x03B, 0x00020F4B, -+ 0x03B, 0x00018F4B, -+ 0x03B, 0x000104B2, -+ 0x03B, 0x00008049, -+ 0x03B, 0x00000148, -+ 0x03B, 0x0007824B, -+ 0x03B, 0x0007024B, -+ 0x03B, 0x0006824B, -+ 0x03B, 0x00060F4B, -+ 0x03B, 0x00058F4B, -+ 0x03B, 0x000504B2, -+ 0x03B, 0x00048049, -+ 0x03B, 0x00040148, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000100, -+ 0x034, 0x0000ADF3, -+ 0x034, 0x00009DF0, -+ 0x034, 0x00008D70, -+ 0x034, 0x00007D6D, -+ 0x034, 0x00006CEE, -+ 0x034, 0x00005CCC, -+ 0x034, 0x000044EC, -+ 0x034, 0x000034AC, -+ 0x034, 0x0000246D, -+ 0x034, 0x0000106F, -+ 0x034, 0x0000006C, -+ 0x0EF, 0x00000000, -+ 0x0ED, 0x00000010, -+ 0x044, 0x0000ADF2, -+ 0x044, 0x00009DEF, -+ 0x044, 0x00008DEC, -+ 0x044, 0x00007DE9, -+ 0x044, 0x00006CEC, -+ 0x044, 0x00005CE9, -+ 0x044, 0x000044EC, -+ 0x044, 0x000034E9, -+ 0x044, 0x0000246C, -+ 0x044, 0x00001469, -+ 0x044, 0x0000006C, -+ 0x0ED, 0x00000000, -+ 0x0ED, 0x00000001, -+ 0x040, 0x00038DA7, -+ 0x040, 0x000300C2, -+ 0x040, 0x000288E2, -+ 0x040, 0x000200B8, -+ 0x040, 0x000188A5, -+ 0x040, 0x00010FBC, -+ 0x040, 0x00008F71, -+ 0x040, 0x00000240, -+ 0x0ED, 0x00000000, -+ 0x0EF, 0x000020A2, -+ 0x0DF, 0x00000080, -+ 0x035, 0x00000120, -+ 0x035, 0x00008120, -+ 0x035, 0x00010120, -+ 0x036, 0x00000085, -+ 0x036, 0x00008085, -+ 0x036, 0x00010085, -+ 0x036, 0x00018085, -+ 0x0EF, 0x00000000, -+ 0x051, 0x00000C31, -+ 0x052, 0x00000622, -+ 0x053, 0x000FC70B, -+ 0x054, 0x0000017E, -+ 0x056, 0x00051DF3, -+ 0x051, 0x00000C01, -+ 0x052, 0x000006D6, -+ 0x053, 0x000FC649, -+ 0x070, 0x00049661, -+ 0x071, 0x0007843E, -+ 0x072, 0x00000382, -+ 0x074, 0x00051400, -+ 0x035, 0x00000160, -+ 0x035, 0x00008160, -+ 0x035, 0x00010160, -+ 0x036, 0x00000124, -+ 0x036, 0x00008124, -+ 0x036, 0x00010124, -+ 0x036, 0x00018124, -+ 0x0ED, 0x0000000C, -+ 0x045, 0x00000140, -+ 0x045, 0x00008140, -+ 0x045, 0x00010140, -+ 0x046, 0x00000124, -+ 0x046, 0x00008124, -+ 0x046, 0x00010124, -+ 0x046, 0x00018124, -+ 0x0DF, 0x00000088, -+ 0x0B3, 0x000F0E18, -+ 0x0B4, 0x0001214C, -+ 0x0B7, 0x0003000C, -+ 0x01C, 0x000539D2, -+ 0x0C4, 0x000AFE00, -+ 0x018, 0x0001F12A, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x018, 0x0001712A, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_RadioA( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_RadioA)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8821A_RadioA; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8821A_RadioA\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } -+ else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigRF_RadioA_8821A(pDM_Odm, v1, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8821A_RadioA(void) -+{ -+ return 54; -+} -+ -+/****************************************************************************** -+* TxPowerTrack_AP.TXT -+******************************************************************************/ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_AP_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_AP_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 17, 17, 18, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_AP_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 4, 4, 5, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 13, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_AP_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 7, 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 18, 19, 19, 19}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_AP_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_AP_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_AP_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_AP_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_AP_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_AP_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_AP_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_AP_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+#endif -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_AP( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8821A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE*3); -+#endif -+} -+ -+/****************************************************************************** -+* TxPowerTrack_PCIE.TXT -+******************************************************************************/ -+ -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}; -+#endif -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_PCIE( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8821A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); -+#endif -+} -+ -+/****************************************************************************** -+* TxPowerTrack_SDIO.TXT -+******************************************************************************/ -+ -+#if DEV_BUS_TYPE == RT_SDIO_INTERFACE -+u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_SDIO_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_SDIO_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_SDIO_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_SDIO_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_SDIO_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_SDIO_8821A[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_SDIO_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_SDIO_8821A[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_SDIO_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_SDIO_8821A[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_SDIO_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_SDIO_8821A[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}; -+#endif -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_SDIO( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8821A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_SDIO_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_SDIO_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_SDIO_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_SDIO_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_SDIO_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_SDIO_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_SDIO_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_SDIO_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_SDIO_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_SDIO_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_SDIO_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_SDIO_8821A, DELTA_SWINGIDX_SIZE*3); -+#endif -+} -+ -+/****************************************************************************** -+* TxPowerTrack_USB.TXT -+******************************************************************************/ -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16, 16}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8821A[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8821A[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8821A[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8821A[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}; -+#endif -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_USB( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8821A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE*3); -+#endif -+} -+ -+/****************************************************************************** -+* TXPWR_LMT_8811AU_FEM.TXT -+******************************************************************************/ -+ -+const char *Array_MP_8821A_TXPWR_LMT_8811AU_FEM[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "28", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "26", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "26", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "24", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "24", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "22", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "104", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "104", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "104", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "32", -+ "MKK", "5G", "20M", "HT", "1T", "36", "32", -+ "FCC", "5G", "20M", "HT", "1T", "40", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "32", -+ "MKK", "5G", "20M", "HT", "1T", "40", "32", -+ "FCC", "5G", "20M", "HT", "1T", "44", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "32", -+ "MKK", "5G", "20M", "HT", "1T", "44", "32", -+ "FCC", "5G", "20M", "HT", "1T", "48", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "32", -+ "MKK", "5G", "20M", "HT", "1T", "48", "32", -+ "FCC", "5G", "20M", "HT", "1T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "32", -+ "MKK", "5G", "20M", "HT", "1T", "52", "32", -+ "FCC", "5G", "20M", "HT", "1T", "56", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "32", -+ "MKK", "5G", "20M", "HT", "1T", "56", "32", -+ "FCC", "5G", "20M", "HT", "1T", "60", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "32", -+ "MKK", "5G", "20M", "HT", "1T", "60", "32", -+ "FCC", "5G", "20M", "HT", "1T", "64", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "32", -+ "MKK", "5G", "20M", "HT", "1T", "64", "32", -+ "FCC", "5G", "20M", "HT", "1T", "100", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "32", -+ "MKK", "5G", "20M", "HT", "1T", "100", "32", -+ "FCC", "5G", "20M", "HT", "1T", "104", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "104", "32", -+ "MKK", "5G", "20M", "HT", "1T", "104", "32", -+ "FCC", "5G", "20M", "HT", "1T", "108", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "32", -+ "MKK", "5G", "20M", "HT", "1T", "108", "32", -+ "FCC", "5G", "20M", "HT", "1T", "112", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "32", -+ "MKK", "5G", "20M", "HT", "1T", "112", "32", -+ "FCC", "5G", "20M", "HT", "1T", "116", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "32", -+ "MKK", "5G", "20M", "HT", "1T", "116", "32", -+ "FCC", "5G", "20M", "HT", "1T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "32", -+ "MKK", "5G", "20M", "HT", "1T", "120", "32", -+ "FCC", "5G", "20M", "HT", "1T", "124", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "32", -+ "MKK", "5G", "20M", "HT", "1T", "124", "32", -+ "FCC", "5G", "20M", "HT", "1T", "128", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "32", -+ "MKK", "5G", "20M", "HT", "1T", "128", "32", -+ "FCC", "5G", "20M", "HT", "1T", "132", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "32", -+ "MKK", "5G", "20M", "HT", "1T", "132", "32", -+ "FCC", "5G", "20M", "HT", "1T", "136", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "32", -+ "MKK", "5G", "20M", "HT", "1T", "136", "32", -+ "FCC", "5G", "20M", "HT", "1T", "140", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "32", -+ "MKK", "5G", "20M", "HT", "1T", "140", "32", -+ "FCC", "5G", "20M", "HT", "1T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "32", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "32", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "32", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "32", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "32", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "30", -+ "MKK", "5G", "20M", "HT", "2T", "36", "30", -+ "FCC", "5G", "20M", "HT", "2T", "40", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "30", -+ "MKK", "5G", "20M", "HT", "2T", "40", "30", -+ "FCC", "5G", "20M", "HT", "2T", "44", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "30", -+ "MKK", "5G", "20M", "HT", "2T", "44", "30", -+ "FCC", "5G", "20M", "HT", "2T", "48", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "30", -+ "MKK", "5G", "20M", "HT", "2T", "48", "30", -+ "FCC", "5G", "20M", "HT", "2T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "30", -+ "MKK", "5G", "20M", "HT", "2T", "52", "30", -+ "FCC", "5G", "20M", "HT", "2T", "56", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "30", -+ "MKK", "5G", "20M", "HT", "2T", "56", "30", -+ "FCC", "5G", "20M", "HT", "2T", "60", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "30", -+ "MKK", "5G", "20M", "HT", "2T", "60", "30", -+ "FCC", "5G", "20M", "HT", "2T", "64", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "30", -+ "MKK", "5G", "20M", "HT", "2T", "64", "30", -+ "FCC", "5G", "20M", "HT", "2T", "100", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "30", -+ "MKK", "5G", "20M", "HT", "2T", "100", "30", -+ "FCC", "5G", "20M", "HT", "2T", "104", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "104", "30", -+ "MKK", "5G", "20M", "HT", "2T", "104", "30", -+ "FCC", "5G", "20M", "HT", "2T", "108", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "30", -+ "MKK", "5G", "20M", "HT", "2T", "108", "30", -+ "FCC", "5G", "20M", "HT", "2T", "112", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "30", -+ "MKK", "5G", "20M", "HT", "2T", "112", "30", -+ "FCC", "5G", "20M", "HT", "2T", "116", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "30", -+ "MKK", "5G", "20M", "HT", "2T", "116", "30", -+ "FCC", "5G", "20M", "HT", "2T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "30", -+ "MKK", "5G", "20M", "HT", "2T", "120", "30", -+ "FCC", "5G", "20M", "HT", "2T", "124", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "30", -+ "MKK", "5G", "20M", "HT", "2T", "124", "30", -+ "FCC", "5G", "20M", "HT", "2T", "128", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "30", -+ "MKK", "5G", "20M", "HT", "2T", "128", "30", -+ "FCC", "5G", "20M", "HT", "2T", "132", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "30", -+ "MKK", "5G", "20M", "HT", "2T", "132", "30", -+ "FCC", "5G", "20M", "HT", "2T", "136", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "30", -+ "MKK", "5G", "20M", "HT", "2T", "136", "30", -+ "FCC", "5G", "20M", "HT", "2T", "140", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "30", -+ "MKK", "5G", "20M", "HT", "2T", "140", "30", -+ "FCC", "5G", "20M", "HT", "2T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "30", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "30", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "30", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "30", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "30", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "32", -+ "MKK", "5G", "40M", "HT", "1T", "38", "32", -+ "FCC", "5G", "40M", "HT", "1T", "46", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "32", -+ "MKK", "5G", "40M", "HT", "1T", "46", "32", -+ "FCC", "5G", "40M", "HT", "1T", "54", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "32", -+ "MKK", "5G", "40M", "HT", "1T", "54", "32", -+ "FCC", "5G", "40M", "HT", "1T", "62", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "32", -+ "MKK", "5G", "40M", "HT", "1T", "62", "32", -+ "FCC", "5G", "40M", "HT", "1T", "102", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "32", -+ "MKK", "5G", "40M", "HT", "1T", "102", "32", -+ "FCC", "5G", "40M", "HT", "1T", "110", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "32", -+ "MKK", "5G", "40M", "HT", "1T", "110", "32", -+ "FCC", "5G", "40M", "HT", "1T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "32", -+ "MKK", "5G", "40M", "HT", "1T", "118", "32", -+ "FCC", "5G", "40M", "HT", "1T", "126", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "32", -+ "MKK", "5G", "40M", "HT", "1T", "126", "32", -+ "FCC", "5G", "40M", "HT", "1T", "134", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "32", -+ "MKK", "5G", "40M", "HT", "1T", "134", "32", -+ "FCC", "5G", "40M", "HT", "1T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "32", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "32", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "30", -+ "MKK", "5G", "40M", "HT", "2T", "38", "30", -+ "FCC", "5G", "40M", "HT", "2T", "46", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "30", -+ "MKK", "5G", "40M", "HT", "2T", "46", "30", -+ "FCC", "5G", "40M", "HT", "2T", "54", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "30", -+ "MKK", "5G", "40M", "HT", "2T", "54", "30", -+ "FCC", "5G", "40M", "HT", "2T", "62", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "30", -+ "MKK", "5G", "40M", "HT", "2T", "62", "30", -+ "FCC", "5G", "40M", "HT", "2T", "102", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "30", -+ "MKK", "5G", "40M", "HT", "2T", "102", "30", -+ "FCC", "5G", "40M", "HT", "2T", "110", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "30", -+ "MKK", "5G", "40M", "HT", "2T", "110", "30", -+ "FCC", "5G", "40M", "HT", "2T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "30", -+ "MKK", "5G", "40M", "HT", "2T", "118", "30", -+ "FCC", "5G", "40M", "HT", "2T", "126", "32", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "30", -+ "MKK", "5G", "40M", "HT", "2T", "126", "30", -+ "FCC", "5G", "40M", "HT", "2T", "134", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "30", -+ "MKK", "5G", "40M", "HT", "2T", "134", "30", -+ "FCC", "5G", "40M", "HT", "2T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "30", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "30", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "32", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "32", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8811AU_FEM( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_TXPWR_LMT_8811AU_FEM)/sizeof(pu1Byte); -+ pu1Byte *Array = (pu1Byte *)Array_MP_8821A_TXPWR_LMT_8811AU_FEM; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrLmt = ArrayLen/7; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8811AU_FEM\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7) { -+ pu1Byte regulation = Array[i]; -+ pu1Byte band = Array[i+1]; -+ pu1Byte bandwidth = Array[i+2]; -+ pu1Byte rate = Array[i+3]; -+ pu1Byte rfPath = Array[i+4]; -+ pu1Byte chnl = Array[i+5]; -+ pu1Byte val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8821A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf(pHalData->BufOfLinesPwrLmt[i/7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", -+ regulation, band, bandwidth, rate, rfPath, chnl, val); -+#endif -+ } -+ -+} -+ -+/****************************************************************************** -+* TXPWR_LMT_8811AU_IPA.TXT -+******************************************************************************/ -+ -+const char *Array_MP_8821A_TXPWR_LMT_8811AU_IPA[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "28", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "26", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "26", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "24", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "24", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "22", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "104", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "104", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "104", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "30", -+ "MKK", "5G", "20M", "HT", "1T", "36", "30", -+ "FCC", "5G", "20M", "HT", "1T", "40", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "30", -+ "MKK", "5G", "20M", "HT", "1T", "40", "30", -+ "FCC", "5G", "20M", "HT", "1T", "44", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "30", -+ "MKK", "5G", "20M", "HT", "1T", "44", "30", -+ "FCC", "5G", "20M", "HT", "1T", "48", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "30", -+ "MKK", "5G", "20M", "HT", "1T", "48", "30", -+ "FCC", "5G", "20M", "HT", "1T", "52", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "30", -+ "MKK", "5G", "20M", "HT", "1T", "52", "30", -+ "FCC", "5G", "20M", "HT", "1T", "56", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "30", -+ "MKK", "5G", "20M", "HT", "1T", "56", "30", -+ "FCC", "5G", "20M", "HT", "1T", "60", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "30", -+ "MKK", "5G", "20M", "HT", "1T", "60", "30", -+ "FCC", "5G", "20M", "HT", "1T", "64", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "30", -+ "MKK", "5G", "20M", "HT", "1T", "64", "30", -+ "FCC", "5G", "20M", "HT", "1T", "100", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "30", -+ "MKK", "5G", "20M", "HT", "1T", "100", "30", -+ "FCC", "5G", "20M", "HT", "1T", "104", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "104", "30", -+ "MKK", "5G", "20M", "HT", "1T", "104", "30", -+ "FCC", "5G", "20M", "HT", "1T", "108", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "30", -+ "MKK", "5G", "20M", "HT", "1T", "108", "30", -+ "FCC", "5G", "20M", "HT", "1T", "112", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "30", -+ "MKK", "5G", "20M", "HT", "1T", "112", "30", -+ "FCC", "5G", "20M", "HT", "1T", "116", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "30", -+ "MKK", "5G", "20M", "HT", "1T", "116", "30", -+ "FCC", "5G", "20M", "HT", "1T", "120", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "30", -+ "MKK", "5G", "20M", "HT", "1T", "120", "30", -+ "FCC", "5G", "20M", "HT", "1T", "124", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "30", -+ "MKK", "5G", "20M", "HT", "1T", "124", "30", -+ "FCC", "5G", "20M", "HT", "1T", "128", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "30", -+ "MKK", "5G", "20M", "HT", "1T", "128", "30", -+ "FCC", "5G", "20M", "HT", "1T", "132", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "30", -+ "MKK", "5G", "20M", "HT", "1T", "132", "30", -+ "FCC", "5G", "20M", "HT", "1T", "136", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "30", -+ "MKK", "5G", "20M", "HT", "1T", "136", "30", -+ "FCC", "5G", "20M", "HT", "1T", "140", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "30", -+ "MKK", "5G", "20M", "HT", "1T", "140", "30", -+ "FCC", "5G", "20M", "HT", "1T", "149", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "30", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "30", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "30", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "30", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "30", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "30", -+ "MKK", "5G", "20M", "HT", "2T", "36", "30", -+ "FCC", "5G", "20M", "HT", "2T", "40", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "30", -+ "MKK", "5G", "20M", "HT", "2T", "40", "30", -+ "FCC", "5G", "20M", "HT", "2T", "44", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "30", -+ "MKK", "5G", "20M", "HT", "2T", "44", "30", -+ "FCC", "5G", "20M", "HT", "2T", "48", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "30", -+ "MKK", "5G", "20M", "HT", "2T", "48", "30", -+ "FCC", "5G", "20M", "HT", "2T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "30", -+ "MKK", "5G", "20M", "HT", "2T", "52", "30", -+ "FCC", "5G", "20M", "HT", "2T", "56", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "30", -+ "MKK", "5G", "20M", "HT", "2T", "56", "30", -+ "FCC", "5G", "20M", "HT", "2T", "60", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "30", -+ "MKK", "5G", "20M", "HT", "2T", "60", "30", -+ "FCC", "5G", "20M", "HT", "2T", "64", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "30", -+ "MKK", "5G", "20M", "HT", "2T", "64", "30", -+ "FCC", "5G", "20M", "HT", "2T", "100", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "30", -+ "MKK", "5G", "20M", "HT", "2T", "100", "30", -+ "FCC", "5G", "20M", "HT", "2T", "104", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "104", "30", -+ "MKK", "5G", "20M", "HT", "2T", "104", "30", -+ "FCC", "5G", "20M", "HT", "2T", "108", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "30", -+ "MKK", "5G", "20M", "HT", "2T", "108", "30", -+ "FCC", "5G", "20M", "HT", "2T", "112", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "30", -+ "MKK", "5G", "20M", "HT", "2T", "112", "30", -+ "FCC", "5G", "20M", "HT", "2T", "116", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "30", -+ "MKK", "5G", "20M", "HT", "2T", "116", "30", -+ "FCC", "5G", "20M", "HT", "2T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "30", -+ "MKK", "5G", "20M", "HT", "2T", "120", "30", -+ "FCC", "5G", "20M", "HT", "2T", "124", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "30", -+ "MKK", "5G", "20M", "HT", "2T", "124", "30", -+ "FCC", "5G", "20M", "HT", "2T", "128", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "30", -+ "MKK", "5G", "20M", "HT", "2T", "128", "30", -+ "FCC", "5G", "20M", "HT", "2T", "132", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "30", -+ "MKK", "5G", "20M", "HT", "2T", "132", "30", -+ "FCC", "5G", "20M", "HT", "2T", "136", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "30", -+ "MKK", "5G", "20M", "HT", "2T", "136", "30", -+ "FCC", "5G", "20M", "HT", "2T", "140", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "30", -+ "MKK", "5G", "20M", "HT", "2T", "140", "30", -+ "FCC", "5G", "20M", "HT", "2T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "30", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "30", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "30", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "30", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "30", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "30", -+ "MKK", "5G", "40M", "HT", "1T", "38", "30", -+ "FCC", "5G", "40M", "HT", "1T", "46", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "30", -+ "MKK", "5G", "40M", "HT", "1T", "46", "30", -+ "FCC", "5G", "40M", "HT", "1T", "54", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "30", -+ "MKK", "5G", "40M", "HT", "1T", "54", "30", -+ "FCC", "5G", "40M", "HT", "1T", "62", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "30", -+ "MKK", "5G", "40M", "HT", "1T", "62", "30", -+ "FCC", "5G", "40M", "HT", "1T", "102", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "30", -+ "MKK", "5G", "40M", "HT", "1T", "102", "30", -+ "FCC", "5G", "40M", "HT", "1T", "110", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "30", -+ "MKK", "5G", "40M", "HT", "1T", "110", "30", -+ "FCC", "5G", "40M", "HT", "1T", "118", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "30", -+ "MKK", "5G", "40M", "HT", "1T", "118", "30", -+ "FCC", "5G", "40M", "HT", "1T", "126", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "30", -+ "MKK", "5G", "40M", "HT", "1T", "126", "30", -+ "FCC", "5G", "40M", "HT", "1T", "134", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "30", -+ "MKK", "5G", "40M", "HT", "1T", "134", "30", -+ "FCC", "5G", "40M", "HT", "1T", "151", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "30", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "30", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "30", -+ "MKK", "5G", "40M", "HT", "2T", "38", "30", -+ "FCC", "5G", "40M", "HT", "2T", "46", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "30", -+ "MKK", "5G", "40M", "HT", "2T", "46", "30", -+ "FCC", "5G", "40M", "HT", "2T", "54", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "30", -+ "MKK", "5G", "40M", "HT", "2T", "54", "30", -+ "FCC", "5G", "40M", "HT", "2T", "62", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "30", -+ "MKK", "5G", "40M", "HT", "2T", "62", "30", -+ "FCC", "5G", "40M", "HT", "2T", "102", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "30", -+ "MKK", "5G", "40M", "HT", "2T", "102", "30", -+ "FCC", "5G", "40M", "HT", "2T", "110", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "30", -+ "MKK", "5G", "40M", "HT", "2T", "110", "30", -+ "FCC", "5G", "40M", "HT", "2T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "30", -+ "MKK", "5G", "40M", "HT", "2T", "118", "30", -+ "FCC", "5G", "40M", "HT", "2T", "126", "32", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "30", -+ "MKK", "5G", "40M", "HT", "2T", "126", "30", -+ "FCC", "5G", "40M", "HT", "2T", "134", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "30", -+ "MKK", "5G", "40M", "HT", "2T", "134", "30", -+ "FCC", "5G", "40M", "HT", "2T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "30", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "30", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "28", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "26", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "32", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8811AU_IPA( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_TXPWR_LMT_8811AU_IPA)/sizeof(pu1Byte); -+ pu1Byte *Array = (pu1Byte *)Array_MP_8821A_TXPWR_LMT_8811AU_IPA; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrLmt = ArrayLen/7; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8811AU_IPA\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7) { -+ pu1Byte regulation = Array[i]; -+ pu1Byte band = Array[i+1]; -+ pu1Byte bandwidth = Array[i+2]; -+ pu1Byte rate = Array[i+3]; -+ pu1Byte rfPath = Array[i+4]; -+ pu1Byte chnl = Array[i+5]; -+ pu1Byte val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8821A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf(pHalData->BufOfLinesPwrLmt[i/7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", -+ regulation, band, bandwidth, rate, rfPath, chnl, val); -+#endif -+ } -+ -+} -+ -+/****************************************************************************** -+* TXPWR_LMT_8821A.TXT -+******************************************************************************/ -+ -+const char *Array_MP_8821A_TXPWR_LMT_8821A[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "28", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "26", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "26", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "24", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "30", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "26", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "24", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "26", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "26", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "22", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "26", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "104", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "104", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "104", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "30", -+ "MKK", "5G", "20M", "HT", "1T", "36", "30", -+ "FCC", "5G", "20M", "HT", "1T", "40", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "30", -+ "MKK", "5G", "20M", "HT", "1T", "40", "30", -+ "FCC", "5G", "20M", "HT", "1T", "44", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "30", -+ "MKK", "5G", "20M", "HT", "1T", "44", "30", -+ "FCC", "5G", "20M", "HT", "1T", "48", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "30", -+ "MKK", "5G", "20M", "HT", "1T", "48", "30", -+ "FCC", "5G", "20M", "HT", "1T", "52", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "30", -+ "MKK", "5G", "20M", "HT", "1T", "52", "30", -+ "FCC", "5G", "20M", "HT", "1T", "56", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "30", -+ "MKK", "5G", "20M", "HT", "1T", "56", "30", -+ "FCC", "5G", "20M", "HT", "1T", "60", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "30", -+ "MKK", "5G", "20M", "HT", "1T", "60", "30", -+ "FCC", "5G", "20M", "HT", "1T", "64", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "30", -+ "MKK", "5G", "20M", "HT", "1T", "64", "30", -+ "FCC", "5G", "20M", "HT", "1T", "100", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "30", -+ "MKK", "5G", "20M", "HT", "1T", "100", "30", -+ "FCC", "5G", "20M", "HT", "1T", "104", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "104", "30", -+ "MKK", "5G", "20M", "HT", "1T", "104", "30", -+ "FCC", "5G", "20M", "HT", "1T", "108", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "30", -+ "MKK", "5G", "20M", "HT", "1T", "108", "30", -+ "FCC", "5G", "20M", "HT", "1T", "112", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "30", -+ "MKK", "5G", "20M", "HT", "1T", "112", "30", -+ "FCC", "5G", "20M", "HT", "1T", "116", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "30", -+ "MKK", "5G", "20M", "HT", "1T", "116", "30", -+ "FCC", "5G", "20M", "HT", "1T", "120", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "30", -+ "MKK", "5G", "20M", "HT", "1T", "120", "30", -+ "FCC", "5G", "20M", "HT", "1T", "124", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "30", -+ "MKK", "5G", "20M", "HT", "1T", "124", "30", -+ "FCC", "5G", "20M", "HT", "1T", "128", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "30", -+ "MKK", "5G", "20M", "HT", "1T", "128", "30", -+ "FCC", "5G", "20M", "HT", "1T", "132", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "30", -+ "MKK", "5G", "20M", "HT", "1T", "132", "30", -+ "FCC", "5G", "20M", "HT", "1T", "136", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "30", -+ "MKK", "5G", "20M", "HT", "1T", "136", "30", -+ "FCC", "5G", "20M", "HT", "1T", "140", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "30", -+ "MKK", "5G", "20M", "HT", "1T", "140", "30", -+ "FCC", "5G", "20M", "HT", "1T", "149", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "30", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "30", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "30", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "30", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "30", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "30", -+ "MKK", "5G", "20M", "HT", "2T", "36", "30", -+ "FCC", "5G", "20M", "HT", "2T", "40", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "30", -+ "MKK", "5G", "20M", "HT", "2T", "40", "30", -+ "FCC", "5G", "20M", "HT", "2T", "44", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "30", -+ "MKK", "5G", "20M", "HT", "2T", "44", "30", -+ "FCC", "5G", "20M", "HT", "2T", "48", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "30", -+ "MKK", "5G", "20M", "HT", "2T", "48", "30", -+ "FCC", "5G", "20M", "HT", "2T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "30", -+ "MKK", "5G", "20M", "HT", "2T", "52", "30", -+ "FCC", "5G", "20M", "HT", "2T", "56", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "30", -+ "MKK", "5G", "20M", "HT", "2T", "56", "30", -+ "FCC", "5G", "20M", "HT", "2T", "60", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "30", -+ "MKK", "5G", "20M", "HT", "2T", "60", "30", -+ "FCC", "5G", "20M", "HT", "2T", "64", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "30", -+ "MKK", "5G", "20M", "HT", "2T", "64", "30", -+ "FCC", "5G", "20M", "HT", "2T", "100", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "30", -+ "MKK", "5G", "20M", "HT", "2T", "100", "30", -+ "FCC", "5G", "20M", "HT", "2T", "104", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "104", "30", -+ "MKK", "5G", "20M", "HT", "2T", "104", "30", -+ "FCC", "5G", "20M", "HT", "2T", "108", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "30", -+ "MKK", "5G", "20M", "HT", "2T", "108", "30", -+ "FCC", "5G", "20M", "HT", "2T", "112", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "30", -+ "MKK", "5G", "20M", "HT", "2T", "112", "30", -+ "FCC", "5G", "20M", "HT", "2T", "116", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "30", -+ "MKK", "5G", "20M", "HT", "2T", "116", "30", -+ "FCC", "5G", "20M", "HT", "2T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "30", -+ "MKK", "5G", "20M", "HT", "2T", "120", "30", -+ "FCC", "5G", "20M", "HT", "2T", "124", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "30", -+ "MKK", "5G", "20M", "HT", "2T", "124", "30", -+ "FCC", "5G", "20M", "HT", "2T", "128", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "30", -+ "MKK", "5G", "20M", "HT", "2T", "128", "30", -+ "FCC", "5G", "20M", "HT", "2T", "132", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "30", -+ "MKK", "5G", "20M", "HT", "2T", "132", "30", -+ "FCC", "5G", "20M", "HT", "2T", "136", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "30", -+ "MKK", "5G", "20M", "HT", "2T", "136", "30", -+ "FCC", "5G", "20M", "HT", "2T", "140", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "30", -+ "MKK", "5G", "20M", "HT", "2T", "140", "30", -+ "FCC", "5G", "20M", "HT", "2T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "30", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "30", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "30", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "30", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "30", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "26", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "30", -+ "MKK", "5G", "40M", "HT", "1T", "38", "30", -+ "FCC", "5G", "40M", "HT", "1T", "46", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "30", -+ "MKK", "5G", "40M", "HT", "1T", "46", "30", -+ "FCC", "5G", "40M", "HT", "1T", "54", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "30", -+ "MKK", "5G", "40M", "HT", "1T", "54", "30", -+ "FCC", "5G", "40M", "HT", "1T", "62", "24", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "30", -+ "MKK", "5G", "40M", "HT", "1T", "62", "30", -+ "FCC", "5G", "40M", "HT", "1T", "102", "24", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "30", -+ "MKK", "5G", "40M", "HT", "1T", "102", "30", -+ "FCC", "5G", "40M", "HT", "1T", "110", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "30", -+ "MKK", "5G", "40M", "HT", "1T", "110", "30", -+ "FCC", "5G", "40M", "HT", "1T", "118", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "30", -+ "MKK", "5G", "40M", "HT", "1T", "118", "30", -+ "FCC", "5G", "40M", "HT", "1T", "126", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "30", -+ "MKK", "5G", "40M", "HT", "1T", "126", "30", -+ "FCC", "5G", "40M", "HT", "1T", "134", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "30", -+ "MKK", "5G", "40M", "HT", "1T", "134", "30", -+ "FCC", "5G", "40M", "HT", "1T", "151", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "30", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "30", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "30", -+ "MKK", "5G", "40M", "HT", "2T", "38", "30", -+ "FCC", "5G", "40M", "HT", "2T", "46", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "30", -+ "MKK", "5G", "40M", "HT", "2T", "46", "30", -+ "FCC", "5G", "40M", "HT", "2T", "54", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "30", -+ "MKK", "5G", "40M", "HT", "2T", "54", "30", -+ "FCC", "5G", "40M", "HT", "2T", "62", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "30", -+ "MKK", "5G", "40M", "HT", "2T", "62", "30", -+ "FCC", "5G", "40M", "HT", "2T", "102", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "30", -+ "MKK", "5G", "40M", "HT", "2T", "102", "30", -+ "FCC", "5G", "40M", "HT", "2T", "110", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "30", -+ "MKK", "5G", "40M", "HT", "2T", "110", "30", -+ "FCC", "5G", "40M", "HT", "2T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "30", -+ "MKK", "5G", "40M", "HT", "2T", "118", "30", -+ "FCC", "5G", "40M", "HT", "2T", "126", "32", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "30", -+ "MKK", "5G", "40M", "HT", "2T", "126", "30", -+ "FCC", "5G", "40M", "HT", "2T", "134", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "30", -+ "MKK", "5G", "40M", "HT", "2T", "134", "30", -+ "FCC", "5G", "40M", "HT", "2T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "30", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "30", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "22", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "20", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "20", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "20", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "28", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "32", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8821A( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_TXPWR_LMT_8821A)/sizeof(pu1Byte); -+ pu1Byte *Array = (pu1Byte *)Array_MP_8821A_TXPWR_LMT_8821A; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrLmt = ArrayLen/7; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8821A\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7) { -+ pu1Byte regulation = Array[i]; -+ pu1Byte band = Array[i+1]; -+ pu1Byte bandwidth = Array[i+2]; -+ pu1Byte rate = Array[i+3]; -+ pu1Byte rfPath = Array[i+4]; -+ pu1Byte chnl = Array[i+5]; -+ pu1Byte val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8821A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf(pHalData->BufOfLinesPwrLmt[i/7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", -+ regulation, band, bandwidth, rate, rfPath, chnl, val); -+#endif -+ } -+ -+} -+ -+/****************************************************************************** -+* TXPWR_LMT_8821A_SAR_13dBm.TXT -+******************************************************************************/ -+ -+const char *Array_MP_8821A_TXPWR_LMT_8821A_SAR_13dBm[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "28", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "26", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "26", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "24", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "24", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "22", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "104", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "104", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "104", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "26", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "26", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "26", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "26", -+ "MKK", "5G", "20M", "HT", "1T", "36", "26", -+ "FCC", "5G", "20M", "HT", "1T", "40", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "26", -+ "MKK", "5G", "20M", "HT", "1T", "40", "26", -+ "FCC", "5G", "20M", "HT", "1T", "44", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "26", -+ "MKK", "5G", "20M", "HT", "1T", "44", "26", -+ "FCC", "5G", "20M", "HT", "1T", "48", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "26", -+ "MKK", "5G", "20M", "HT", "1T", "48", "26", -+ "FCC", "5G", "20M", "HT", "1T", "52", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "26", -+ "MKK", "5G", "20M", "HT", "1T", "52", "26", -+ "FCC", "5G", "20M", "HT", "1T", "56", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "26", -+ "MKK", "5G", "20M", "HT", "1T", "56", "26", -+ "FCC", "5G", "20M", "HT", "1T", "60", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "26", -+ "MKK", "5G", "20M", "HT", "1T", "60", "26", -+ "FCC", "5G", "20M", "HT", "1T", "64", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "26", -+ "MKK", "5G", "20M", "HT", "1T", "64", "26", -+ "FCC", "5G", "20M", "HT", "1T", "100", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "26", -+ "MKK", "5G", "20M", "HT", "1T", "100", "26", -+ "FCC", "5G", "20M", "HT", "1T", "104", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "104", "26", -+ "MKK", "5G", "20M", "HT", "1T", "104", "26", -+ "FCC", "5G", "20M", "HT", "1T", "108", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "26", -+ "MKK", "5G", "20M", "HT", "1T", "108", "26", -+ "FCC", "5G", "20M", "HT", "1T", "112", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "26", -+ "MKK", "5G", "20M", "HT", "1T", "112", "26", -+ "FCC", "5G", "20M", "HT", "1T", "116", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "26", -+ "MKK", "5G", "20M", "HT", "1T", "116", "26", -+ "FCC", "5G", "20M", "HT", "1T", "120", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "26", -+ "MKK", "5G", "20M", "HT", "1T", "120", "26", -+ "FCC", "5G", "20M", "HT", "1T", "124", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "26", -+ "MKK", "5G", "20M", "HT", "1T", "124", "26", -+ "FCC", "5G", "20M", "HT", "1T", "128", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "26", -+ "MKK", "5G", "20M", "HT", "1T", "128", "26", -+ "FCC", "5G", "20M", "HT", "1T", "132", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "26", -+ "MKK", "5G", "20M", "HT", "1T", "132", "26", -+ "FCC", "5G", "20M", "HT", "1T", "136", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "26", -+ "MKK", "5G", "20M", "HT", "1T", "136", "26", -+ "FCC", "5G", "20M", "HT", "1T", "140", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "26", -+ "MKK", "5G", "20M", "HT", "1T", "140", "26", -+ "FCC", "5G", "20M", "HT", "1T", "149", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "26", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "26", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "26", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "26", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "26", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "26", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "26", -+ "MKK", "5G", "20M", "HT", "2T", "36", "26", -+ "FCC", "5G", "20M", "HT", "2T", "40", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "26", -+ "MKK", "5G", "20M", "HT", "2T", "40", "26", -+ "FCC", "5G", "20M", "HT", "2T", "44", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "26", -+ "MKK", "5G", "20M", "HT", "2T", "44", "26", -+ "FCC", "5G", "20M", "HT", "2T", "48", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "26", -+ "MKK", "5G", "20M", "HT", "2T", "48", "26", -+ "FCC", "5G", "20M", "HT", "2T", "52", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "26", -+ "MKK", "5G", "20M", "HT", "2T", "52", "26", -+ "FCC", "5G", "20M", "HT", "2T", "56", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "26", -+ "MKK", "5G", "20M", "HT", "2T", "56", "26", -+ "FCC", "5G", "20M", "HT", "2T", "60", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "26", -+ "MKK", "5G", "20M", "HT", "2T", "60", "26", -+ "FCC", "5G", "20M", "HT", "2T", "64", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "26", -+ "MKK", "5G", "20M", "HT", "2T", "64", "26", -+ "FCC", "5G", "20M", "HT", "2T", "100", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "26", -+ "MKK", "5G", "20M", "HT", "2T", "100", "26", -+ "FCC", "5G", "20M", "HT", "2T", "104", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "104", "26", -+ "MKK", "5G", "20M", "HT", "2T", "104", "26", -+ "FCC", "5G", "20M", "HT", "2T", "108", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "26", -+ "MKK", "5G", "20M", "HT", "2T", "108", "26", -+ "FCC", "5G", "20M", "HT", "2T", "112", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "26", -+ "MKK", "5G", "20M", "HT", "2T", "112", "26", -+ "FCC", "5G", "20M", "HT", "2T", "116", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "26", -+ "MKK", "5G", "20M", "HT", "2T", "116", "26", -+ "FCC", "5G", "20M", "HT", "2T", "120", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "26", -+ "MKK", "5G", "20M", "HT", "2T", "120", "26", -+ "FCC", "5G", "20M", "HT", "2T", "124", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "26", -+ "MKK", "5G", "20M", "HT", "2T", "124", "26", -+ "FCC", "5G", "20M", "HT", "2T", "128", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "26", -+ "MKK", "5G", "20M", "HT", "2T", "128", "26", -+ "FCC", "5G", "20M", "HT", "2T", "132", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "26", -+ "MKK", "5G", "20M", "HT", "2T", "132", "26", -+ "FCC", "5G", "20M", "HT", "2T", "136", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "26", -+ "MKK", "5G", "20M", "HT", "2T", "136", "26", -+ "FCC", "5G", "20M", "HT", "2T", "140", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "26", -+ "MKK", "5G", "20M", "HT", "2T", "140", "26", -+ "FCC", "5G", "20M", "HT", "2T", "149", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "26", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "26", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "26", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "26", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "26", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "26", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "26", -+ "MKK", "5G", "40M", "HT", "1T", "38", "26", -+ "FCC", "5G", "40M", "HT", "1T", "46", "26", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "26", -+ "MKK", "5G", "40M", "HT", "1T", "46", "26", -+ "FCC", "5G", "40M", "HT", "1T", "54", "26", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "26", -+ "MKK", "5G", "40M", "HT", "1T", "54", "26", -+ "FCC", "5G", "40M", "HT", "1T", "62", "24", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "26", -+ "MKK", "5G", "40M", "HT", "1T", "62", "26", -+ "FCC", "5G", "40M", "HT", "1T", "102", "24", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "26", -+ "MKK", "5G", "40M", "HT", "1T", "102", "26", -+ "FCC", "5G", "40M", "HT", "1T", "110", "26", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "26", -+ "MKK", "5G", "40M", "HT", "1T", "110", "26", -+ "FCC", "5G", "40M", "HT", "1T", "118", "26", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "26", -+ "MKK", "5G", "40M", "HT", "1T", "118", "26", -+ "FCC", "5G", "40M", "HT", "1T", "126", "26", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "26", -+ "MKK", "5G", "40M", "HT", "1T", "126", "26", -+ "FCC", "5G", "40M", "HT", "1T", "134", "26", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "26", -+ "MKK", "5G", "40M", "HT", "1T", "134", "26", -+ "FCC", "5G", "40M", "HT", "1T", "151", "26", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "26", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "26", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "26", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "26", -+ "MKK", "5G", "40M", "HT", "2T", "38", "26", -+ "FCC", "5G", "40M", "HT", "2T", "46", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "26", -+ "MKK", "5G", "40M", "HT", "2T", "46", "26", -+ "FCC", "5G", "40M", "HT", "2T", "54", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "26", -+ "MKK", "5G", "40M", "HT", "2T", "54", "26", -+ "FCC", "5G", "40M", "HT", "2T", "62", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "26", -+ "MKK", "5G", "40M", "HT", "2T", "62", "26", -+ "FCC", "5G", "40M", "HT", "2T", "102", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "26", -+ "MKK", "5G", "40M", "HT", "2T", "102", "26", -+ "FCC", "5G", "40M", "HT", "2T", "110", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "26", -+ "MKK", "5G", "40M", "HT", "2T", "110", "26", -+ "FCC", "5G", "40M", "HT", "2T", "118", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "26", -+ "MKK", "5G", "40M", "HT", "2T", "118", "26", -+ "FCC", "5G", "40M", "HT", "2T", "126", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "26", -+ "MKK", "5G", "40M", "HT", "2T", "126", "26", -+ "FCC", "5G", "40M", "HT", "2T", "134", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "26", -+ "MKK", "5G", "40M", "HT", "2T", "134", "26", -+ "FCC", "5G", "40M", "HT", "2T", "151", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "26", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "26", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "22", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "26", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "26", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "20", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "26", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "26", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "20", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "26", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "26", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "20", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "26", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "26", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "26", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "26", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "26", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "26", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "26", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "26", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "26", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "26", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "26", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "26", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "26", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8821A_SAR_13dBm( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_TXPWR_LMT_8821A_SAR_13dBm)/sizeof(pu1Byte); -+ pu1Byte *Array = (pu1Byte *)Array_MP_8821A_TXPWR_LMT_8821A_SAR_13dBm; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrLmt = ArrayLen/7; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8821A_SAR_13dBm\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7) { -+ pu1Byte regulation = Array[i]; -+ pu1Byte band = Array[i+1]; -+ pu1Byte bandwidth = Array[i+2]; -+ pu1Byte rate = Array[i+3]; -+ pu1Byte rfPath = Array[i+4]; -+ pu1Byte chnl = Array[i+5]; -+ pu1Byte val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8821A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf(pHalData->BufOfLinesPwrLmt[i/7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", -+ regulation, band, bandwidth, rate, rfPath, chnl, val); -+#endif -+ } -+ -+} -+ -+/****************************************************************************** -+* TXPWR_LMT_8821A_SAR_5mm.TXT -+******************************************************************************/ -+ -+const char *Array_MP_8821A_TXPWR_LMT_8821A_SAR_5mm[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "28", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "26", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "26", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "24", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "24", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "22", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "104", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "104", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "104", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "30", -+ "MKK", "5G", "20M", "HT", "1T", "36", "30", -+ "FCC", "5G", "20M", "HT", "1T", "40", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "30", -+ "MKK", "5G", "20M", "HT", "1T", "40", "30", -+ "FCC", "5G", "20M", "HT", "1T", "44", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "30", -+ "MKK", "5G", "20M", "HT", "1T", "44", "30", -+ "FCC", "5G", "20M", "HT", "1T", "48", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "30", -+ "MKK", "5G", "20M", "HT", "1T", "48", "30", -+ "FCC", "5G", "20M", "HT", "1T", "52", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "30", -+ "MKK", "5G", "20M", "HT", "1T", "52", "30", -+ "FCC", "5G", "20M", "HT", "1T", "56", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "30", -+ "MKK", "5G", "20M", "HT", "1T", "56", "30", -+ "FCC", "5G", "20M", "HT", "1T", "60", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "30", -+ "MKK", "5G", "20M", "HT", "1T", "60", "30", -+ "FCC", "5G", "20M", "HT", "1T", "64", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "30", -+ "MKK", "5G", "20M", "HT", "1T", "64", "30", -+ "FCC", "5G", "20M", "HT", "1T", "100", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "30", -+ "MKK", "5G", "20M", "HT", "1T", "100", "30", -+ "FCC", "5G", "20M", "HT", "1T", "104", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "104", "30", -+ "MKK", "5G", "20M", "HT", "1T", "104", "30", -+ "FCC", "5G", "20M", "HT", "1T", "108", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "30", -+ "MKK", "5G", "20M", "HT", "1T", "108", "30", -+ "FCC", "5G", "20M", "HT", "1T", "112", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "30", -+ "MKK", "5G", "20M", "HT", "1T", "112", "30", -+ "FCC", "5G", "20M", "HT", "1T", "116", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "30", -+ "MKK", "5G", "20M", "HT", "1T", "116", "30", -+ "FCC", "5G", "20M", "HT", "1T", "120", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "30", -+ "MKK", "5G", "20M", "HT", "1T", "120", "30", -+ "FCC", "5G", "20M", "HT", "1T", "124", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "30", -+ "MKK", "5G", "20M", "HT", "1T", "124", "30", -+ "FCC", "5G", "20M", "HT", "1T", "128", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "30", -+ "MKK", "5G", "20M", "HT", "1T", "128", "30", -+ "FCC", "5G", "20M", "HT", "1T", "132", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "30", -+ "MKK", "5G", "20M", "HT", "1T", "132", "30", -+ "FCC", "5G", "20M", "HT", "1T", "136", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "30", -+ "MKK", "5G", "20M", "HT", "1T", "136", "30", -+ "FCC", "5G", "20M", "HT", "1T", "140", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "30", -+ "MKK", "5G", "20M", "HT", "1T", "140", "30", -+ "FCC", "5G", "20M", "HT", "1T", "149", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "30", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "30", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "30", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "30", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "30", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "30", -+ "MKK", "5G", "20M", "HT", "2T", "36", "30", -+ "FCC", "5G", "20M", "HT", "2T", "40", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "30", -+ "MKK", "5G", "20M", "HT", "2T", "40", "30", -+ "FCC", "5G", "20M", "HT", "2T", "44", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "30", -+ "MKK", "5G", "20M", "HT", "2T", "44", "30", -+ "FCC", "5G", "20M", "HT", "2T", "48", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "30", -+ "MKK", "5G", "20M", "HT", "2T", "48", "30", -+ "FCC", "5G", "20M", "HT", "2T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "30", -+ "MKK", "5G", "20M", "HT", "2T", "52", "30", -+ "FCC", "5G", "20M", "HT", "2T", "56", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "30", -+ "MKK", "5G", "20M", "HT", "2T", "56", "30", -+ "FCC", "5G", "20M", "HT", "2T", "60", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "30", -+ "MKK", "5G", "20M", "HT", "2T", "60", "30", -+ "FCC", "5G", "20M", "HT", "2T", "64", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "30", -+ "MKK", "5G", "20M", "HT", "2T", "64", "30", -+ "FCC", "5G", "20M", "HT", "2T", "100", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "30", -+ "MKK", "5G", "20M", "HT", "2T", "100", "30", -+ "FCC", "5G", "20M", "HT", "2T", "104", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "104", "30", -+ "MKK", "5G", "20M", "HT", "2T", "104", "30", -+ "FCC", "5G", "20M", "HT", "2T", "108", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "30", -+ "MKK", "5G", "20M", "HT", "2T", "108", "30", -+ "FCC", "5G", "20M", "HT", "2T", "112", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "30", -+ "MKK", "5G", "20M", "HT", "2T", "112", "30", -+ "FCC", "5G", "20M", "HT", "2T", "116", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "30", -+ "MKK", "5G", "20M", "HT", "2T", "116", "30", -+ "FCC", "5G", "20M", "HT", "2T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "30", -+ "MKK", "5G", "20M", "HT", "2T", "120", "30", -+ "FCC", "5G", "20M", "HT", "2T", "124", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "30", -+ "MKK", "5G", "20M", "HT", "2T", "124", "30", -+ "FCC", "5G", "20M", "HT", "2T", "128", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "30", -+ "MKK", "5G", "20M", "HT", "2T", "128", "30", -+ "FCC", "5G", "20M", "HT", "2T", "132", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "30", -+ "MKK", "5G", "20M", "HT", "2T", "132", "30", -+ "FCC", "5G", "20M", "HT", "2T", "136", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "30", -+ "MKK", "5G", "20M", "HT", "2T", "136", "30", -+ "FCC", "5G", "20M", "HT", "2T", "140", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "30", -+ "MKK", "5G", "20M", "HT", "2T", "140", "30", -+ "FCC", "5G", "20M", "HT", "2T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "30", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "30", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "30", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "30", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "30", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "26", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "30", -+ "MKK", "5G", "40M", "HT", "1T", "38", "30", -+ "FCC", "5G", "40M", "HT", "1T", "46", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "30", -+ "MKK", "5G", "40M", "HT", "1T", "46", "30", -+ "FCC", "5G", "40M", "HT", "1T", "54", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "30", -+ "MKK", "5G", "40M", "HT", "1T", "54", "30", -+ "FCC", "5G", "40M", "HT", "1T", "62", "24", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "30", -+ "MKK", "5G", "40M", "HT", "1T", "62", "30", -+ "FCC", "5G", "40M", "HT", "1T", "102", "24", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "30", -+ "MKK", "5G", "40M", "HT", "1T", "102", "30", -+ "FCC", "5G", "40M", "HT", "1T", "110", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "30", -+ "MKK", "5G", "40M", "HT", "1T", "110", "30", -+ "FCC", "5G", "40M", "HT", "1T", "118", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "30", -+ "MKK", "5G", "40M", "HT", "1T", "118", "30", -+ "FCC", "5G", "40M", "HT", "1T", "126", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "30", -+ "MKK", "5G", "40M", "HT", "1T", "126", "30", -+ "FCC", "5G", "40M", "HT", "1T", "134", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "30", -+ "MKK", "5G", "40M", "HT", "1T", "134", "30", -+ "FCC", "5G", "40M", "HT", "1T", "151", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "30", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "30", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "30", -+ "MKK", "5G", "40M", "HT", "2T", "38", "30", -+ "FCC", "5G", "40M", "HT", "2T", "46", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "30", -+ "MKK", "5G", "40M", "HT", "2T", "46", "30", -+ "FCC", "5G", "40M", "HT", "2T", "54", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "30", -+ "MKK", "5G", "40M", "HT", "2T", "54", "30", -+ "FCC", "5G", "40M", "HT", "2T", "62", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "30", -+ "MKK", "5G", "40M", "HT", "2T", "62", "30", -+ "FCC", "5G", "40M", "HT", "2T", "102", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "30", -+ "MKK", "5G", "40M", "HT", "2T", "102", "30", -+ "FCC", "5G", "40M", "HT", "2T", "110", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "30", -+ "MKK", "5G", "40M", "HT", "2T", "110", "30", -+ "FCC", "5G", "40M", "HT", "2T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "30", -+ "MKK", "5G", "40M", "HT", "2T", "118", "30", -+ "FCC", "5G", "40M", "HT", "2T", "126", "32", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "30", -+ "MKK", "5G", "40M", "HT", "2T", "126", "30", -+ "FCC", "5G", "40M", "HT", "2T", "134", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "30", -+ "MKK", "5G", "40M", "HT", "2T", "134", "30", -+ "FCC", "5G", "40M", "HT", "2T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "30", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "30", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "22", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "20", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "20", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "20", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "26", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "32", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8821A_SAR_5mm( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_TXPWR_LMT_8821A_SAR_5mm)/sizeof(pu1Byte); -+ pu1Byte *Array = (pu1Byte *)Array_MP_8821A_TXPWR_LMT_8821A_SAR_5mm; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrLmt = ArrayLen/7; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8821A_SAR_5mm\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7) { -+ pu1Byte regulation = Array[i]; -+ pu1Byte band = Array[i+1]; -+ pu1Byte bandwidth = Array[i+2]; -+ pu1Byte rate = Array[i+3]; -+ pu1Byte rfPath = Array[i+4]; -+ pu1Byte chnl = Array[i+5]; -+ pu1Byte val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8821A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf(pHalData->BufOfLinesPwrLmt[i/7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", -+ regulation, band, bandwidth, rate, rfPath, chnl, val); -+#endif -+ } -+ -+} -+ -+/****************************************************************************** -+* TXPWR_LMT_8821A_SAR_8mm.TXT -+******************************************************************************/ -+ -+const char *Array_MP_8821A_TXPWR_LMT_8821A_SAR_8mm[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "28", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "26", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "28", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "26", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "24", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "24", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "26", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "22", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "104", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "104", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "104", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "30", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "30", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "30", -+ "MKK", "5G", "20M", "HT", "1T", "36", "30", -+ "FCC", "5G", "20M", "HT", "1T", "40", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "30", -+ "MKK", "5G", "20M", "HT", "1T", "40", "30", -+ "FCC", "5G", "20M", "HT", "1T", "44", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "30", -+ "MKK", "5G", "20M", "HT", "1T", "44", "30", -+ "FCC", "5G", "20M", "HT", "1T", "48", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "30", -+ "MKK", "5G", "20M", "HT", "1T", "48", "30", -+ "FCC", "5G", "20M", "HT", "1T", "52", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "30", -+ "MKK", "5G", "20M", "HT", "1T", "52", "30", -+ "FCC", "5G", "20M", "HT", "1T", "56", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "30", -+ "MKK", "5G", "20M", "HT", "1T", "56", "30", -+ "FCC", "5G", "20M", "HT", "1T", "60", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "30", -+ "MKK", "5G", "20M", "HT", "1T", "60", "30", -+ "FCC", "5G", "20M", "HT", "1T", "64", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "30", -+ "MKK", "5G", "20M", "HT", "1T", "64", "30", -+ "FCC", "5G", "20M", "HT", "1T", "100", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "30", -+ "MKK", "5G", "20M", "HT", "1T", "100", "30", -+ "FCC", "5G", "20M", "HT", "1T", "104", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "104", "30", -+ "MKK", "5G", "20M", "HT", "1T", "104", "30", -+ "FCC", "5G", "20M", "HT", "1T", "108", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "30", -+ "MKK", "5G", "20M", "HT", "1T", "108", "30", -+ "FCC", "5G", "20M", "HT", "1T", "112", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "30", -+ "MKK", "5G", "20M", "HT", "1T", "112", "30", -+ "FCC", "5G", "20M", "HT", "1T", "116", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "30", -+ "MKK", "5G", "20M", "HT", "1T", "116", "30", -+ "FCC", "5G", "20M", "HT", "1T", "120", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "30", -+ "MKK", "5G", "20M", "HT", "1T", "120", "30", -+ "FCC", "5G", "20M", "HT", "1T", "124", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "30", -+ "MKK", "5G", "20M", "HT", "1T", "124", "30", -+ "FCC", "5G", "20M", "HT", "1T", "128", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "30", -+ "MKK", "5G", "20M", "HT", "1T", "128", "30", -+ "FCC", "5G", "20M", "HT", "1T", "132", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "30", -+ "MKK", "5G", "20M", "HT", "1T", "132", "30", -+ "FCC", "5G", "20M", "HT", "1T", "136", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "30", -+ "MKK", "5G", "20M", "HT", "1T", "136", "30", -+ "FCC", "5G", "20M", "HT", "1T", "140", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "30", -+ "MKK", "5G", "20M", "HT", "1T", "140", "30", -+ "FCC", "5G", "20M", "HT", "1T", "149", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "30", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "30", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "30", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "30", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "30", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "30", -+ "MKK", "5G", "20M", "HT", "2T", "36", "30", -+ "FCC", "5G", "20M", "HT", "2T", "40", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "30", -+ "MKK", "5G", "20M", "HT", "2T", "40", "30", -+ "FCC", "5G", "20M", "HT", "2T", "44", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "30", -+ "MKK", "5G", "20M", "HT", "2T", "44", "30", -+ "FCC", "5G", "20M", "HT", "2T", "48", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "30", -+ "MKK", "5G", "20M", "HT", "2T", "48", "30", -+ "FCC", "5G", "20M", "HT", "2T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "30", -+ "MKK", "5G", "20M", "HT", "2T", "52", "30", -+ "FCC", "5G", "20M", "HT", "2T", "56", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "30", -+ "MKK", "5G", "20M", "HT", "2T", "56", "30", -+ "FCC", "5G", "20M", "HT", "2T", "60", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "30", -+ "MKK", "5G", "20M", "HT", "2T", "60", "30", -+ "FCC", "5G", "20M", "HT", "2T", "64", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "30", -+ "MKK", "5G", "20M", "HT", "2T", "64", "30", -+ "FCC", "5G", "20M", "HT", "2T", "100", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "30", -+ "MKK", "5G", "20M", "HT", "2T", "100", "30", -+ "FCC", "5G", "20M", "HT", "2T", "104", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "104", "30", -+ "MKK", "5G", "20M", "HT", "2T", "104", "30", -+ "FCC", "5G", "20M", "HT", "2T", "108", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "30", -+ "MKK", "5G", "20M", "HT", "2T", "108", "30", -+ "FCC", "5G", "20M", "HT", "2T", "112", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "30", -+ "MKK", "5G", "20M", "HT", "2T", "112", "30", -+ "FCC", "5G", "20M", "HT", "2T", "116", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "30", -+ "MKK", "5G", "20M", "HT", "2T", "116", "30", -+ "FCC", "5G", "20M", "HT", "2T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "30", -+ "MKK", "5G", "20M", "HT", "2T", "120", "30", -+ "FCC", "5G", "20M", "HT", "2T", "124", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "30", -+ "MKK", "5G", "20M", "HT", "2T", "124", "30", -+ "FCC", "5G", "20M", "HT", "2T", "128", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "30", -+ "MKK", "5G", "20M", "HT", "2T", "128", "30", -+ "FCC", "5G", "20M", "HT", "2T", "132", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "30", -+ "MKK", "5G", "20M", "HT", "2T", "132", "30", -+ "FCC", "5G", "20M", "HT", "2T", "136", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "30", -+ "MKK", "5G", "20M", "HT", "2T", "136", "30", -+ "FCC", "5G", "20M", "HT", "2T", "140", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "30", -+ "MKK", "5G", "20M", "HT", "2T", "140", "30", -+ "FCC", "5G", "20M", "HT", "2T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "30", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "30", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "30", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "30", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "30", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "26", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "30", -+ "MKK", "5G", "40M", "HT", "1T", "38", "30", -+ "FCC", "5G", "40M", "HT", "1T", "46", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "30", -+ "MKK", "5G", "40M", "HT", "1T", "46", "30", -+ "FCC", "5G", "40M", "HT", "1T", "54", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "30", -+ "MKK", "5G", "40M", "HT", "1T", "54", "30", -+ "FCC", "5G", "40M", "HT", "1T", "62", "24", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "30", -+ "MKK", "5G", "40M", "HT", "1T", "62", "30", -+ "FCC", "5G", "40M", "HT", "1T", "102", "24", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "30", -+ "MKK", "5G", "40M", "HT", "1T", "102", "30", -+ "FCC", "5G", "40M", "HT", "1T", "110", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "30", -+ "MKK", "5G", "40M", "HT", "1T", "110", "30", -+ "FCC", "5G", "40M", "HT", "1T", "118", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "30", -+ "MKK", "5G", "40M", "HT", "1T", "118", "30", -+ "FCC", "5G", "40M", "HT", "1T", "126", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "30", -+ "MKK", "5G", "40M", "HT", "1T", "126", "30", -+ "FCC", "5G", "40M", "HT", "1T", "134", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "30", -+ "MKK", "5G", "40M", "HT", "1T", "134", "30", -+ "FCC", "5G", "40M", "HT", "1T", "151", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "30", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "30", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "30", -+ "MKK", "5G", "40M", "HT", "2T", "38", "30", -+ "FCC", "5G", "40M", "HT", "2T", "46", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "30", -+ "MKK", "5G", "40M", "HT", "2T", "46", "30", -+ "FCC", "5G", "40M", "HT", "2T", "54", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "30", -+ "MKK", "5G", "40M", "HT", "2T", "54", "30", -+ "FCC", "5G", "40M", "HT", "2T", "62", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "30", -+ "MKK", "5G", "40M", "HT", "2T", "62", "30", -+ "FCC", "5G", "40M", "HT", "2T", "102", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "30", -+ "MKK", "5G", "40M", "HT", "2T", "102", "30", -+ "FCC", "5G", "40M", "HT", "2T", "110", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "30", -+ "MKK", "5G", "40M", "HT", "2T", "110", "30", -+ "FCC", "5G", "40M", "HT", "2T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "30", -+ "MKK", "5G", "40M", "HT", "2T", "118", "30", -+ "FCC", "5G", "40M", "HT", "2T", "126", "32", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "30", -+ "MKK", "5G", "40M", "HT", "2T", "126", "30", -+ "FCC", "5G", "40M", "HT", "2T", "134", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "30", -+ "MKK", "5G", "40M", "HT", "2T", "134", "30", -+ "FCC", "5G", "40M", "HT", "2T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "30", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "30", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "22", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "20", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "20", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "20", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "28", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "32", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8821A_SAR_8mm( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_TXPWR_LMT_8821A_SAR_8mm)/sizeof(pu1Byte); -+ pu1Byte *Array = (pu1Byte *)Array_MP_8821A_TXPWR_LMT_8821A_SAR_8mm; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrLmt = ArrayLen/7; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8821A_SAR_8mm\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7) { -+ pu1Byte regulation = Array[i]; -+ pu1Byte band = Array[i+1]; -+ pu1Byte bandwidth = Array[i+2]; -+ pu1Byte rate = Array[i+3]; -+ pu1Byte rfPath = Array[i+4]; -+ pu1Byte chnl = Array[i+5]; -+ pu1Byte val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8821A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf(pHalData->BufOfLinesPwrLmt[i/7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", -+ regulation, band, bandwidth, rate, rfPath, chnl, val); -+#endif -+ } -+ -+} -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_rf.h linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_rf.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halhwimg8821a_rf.h 2017-06-07 23:07:21.030689307 +0300 -@@ -0,0 +1,139 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.14*/ -+#if (RTL8821A_SUPPORT == 1) -+#ifndef __INC_MP_RF_HW_IMG_8821A_H -+#define __INC_MP_RF_HW_IMG_8821A_H -+ -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_RadioA(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_RadioA(void); -+ -+/****************************************************************************** -+* TxPowerTrack_AP.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_AP(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_TxPowerTrack_AP(void); -+ -+/****************************************************************************** -+* TxPowerTrack_PCIE.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_PCIE(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_TxPowerTrack_PCIE(void); -+ -+/****************************************************************************** -+* TxPowerTrack_SDIO.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_SDIO(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_TxPowerTrack_SDIO(void); -+ -+/****************************************************************************** -+* TxPowerTrack_USB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_USB(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_TxPowerTrack_USB(void); -+ -+/****************************************************************************** -+* TXPWR_LMT_8811AU_FEM.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8811AU_FEM(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_TXPWR_LMT_8811AU_FEM(void); -+ -+/****************************************************************************** -+* TXPWR_LMT_8811AU_IPA.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8811AU_IPA(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_TXPWR_LMT_8811AU_IPA(void); -+ -+/****************************************************************************** -+* TXPWR_LMT_8821A.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8821A(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_TXPWR_LMT_8821A(void); -+ -+/****************************************************************************** -+* TXPWR_LMT_8821A_SAR_13dBm.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8821A_SAR_13dBm(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_TXPWR_LMT_8821A_SAR_13dBm(void); -+ -+/****************************************************************************** -+* TXPWR_LMT_8821A_SAR_5mm.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8821A_SAR_5mm(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_TXPWR_LMT_8821A_SAR_5mm(void); -+ -+/****************************************************************************** -+* TXPWR_LMT_8821A_SAR_8mm.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT_8821A_SAR_8mm(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8821A_TXPWR_LMT_8821A_SAR_8mm(void); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_ce.c linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_ce.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_ce.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_ce.c 2017-06-07 23:07:21.030689307 +0300 -@@ -0,0 +1,292 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+// 2010/04/25 MH Define the max tx power tracking tx agc power. -+#define ODM_TXPWRTRACK_MAX_IDX8821A 6 -+ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+ -+//3 ============================================================ -+//3 Tx Power Tracking -+//3 ============================================================ -+ -+VOID -+ODM_TxPwrTrackSetPwr8821A( -+ IN PVOID pDM_VOID, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ u1Byte PwrTrackingLimit = 26; //+1.0dB -+ u1Byte TxRate = 0xFF; -+ u1Byte Final_OFDM_Swing_Index = 0; -+ u1Byte Final_CCK_Swing_Index = 0; -+ u1Byte i = 0; -+ u4Byte finalBbSwingIdx[1]; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ if (pDM_Odm->mp_mode == TRUE) -+ { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE )) -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); -+ #elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ #endif -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+#endif -+ } -+ else -+ { -+ u2Byte rate = *(pDM_Odm->pForcedDataRate); -+ -+ if(!rate) //auto rate -+ { -+ if(pDM_Odm->TxRate != 0xFF) -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -+ #elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ TxRate = HwRateToMRate(pDM_Odm->TxRate); -+ #endif -+ } -+ else //force rate -+ { -+ TxRate = (u1Byte)rate; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8821A\n")); -+ -+ if(TxRate != 0xFF) -+ { -+ //2 CCK -+ if((TxRate >= MGN_1M)&&(TxRate <= MGN_11M)) -+ PwrTrackingLimit = 32; //+4dB -+ //2 OFDM -+ else if((TxRate >= MGN_6M)&&(TxRate <= MGN_48M)) -+ PwrTrackingLimit = 30; //+3dB -+ else if(TxRate == MGN_54M) -+ PwrTrackingLimit = 28; //+2dB -+ //2 HT -+ else if((TxRate >= MGN_MCS0)&&(TxRate <= MGN_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_MCS3)&&(TxRate <= MGN_MCS4)) //16QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if((TxRate >= MGN_MCS5)&&(TxRate <= MGN_MCS7)) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ -+ //2 VHT -+ else if((TxRate >= MGN_VHT1SS_MCS0)&&(TxRate <= MGN_VHT1SS_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_VHT1SS_MCS3)&&(TxRate <= MGN_VHT1SS_MCS4)) //16QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if((TxRate >= MGN_VHT1SS_MCS5)&&(TxRate <= MGN_VHT1SS_MCS6)) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ else if(TxRate == MGN_VHT1SS_MCS7) //64QAM -+ PwrTrackingLimit = 26; //+1dB -+ else if(TxRate == MGN_VHT1SS_MCS8) //256QAM -+ PwrTrackingLimit = 24; //+0dB -+ else if(TxRate == MGN_VHT1SS_MCS9) //256QAM -+ PwrTrackingLimit = 22; //-1dB -+ -+ else -+ PwrTrackingLimit = 24; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("TxRate=0x%x, PwrTrackingLimit=%d\n", TxRate, PwrTrackingLimit)); -+ -+ if (Method == BBSWING) -+ { -+ if (RFPath == ODM_RF_PATH_A) -+ { -+ finalBbSwingIdx[ODM_RF_PATH_A] = (pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A] > PwrTrackingLimit) ? PwrTrackingLimit : pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A]; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A]=%d, pDM_Odm->RealBbSwingIdx[ODM_RF_PATH_A]=%d\n", -+ pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A], finalBbSwingIdx[ODM_RF_PATH_A])); -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_A]]); -+ } -+ } -+ else if (Method == MIX_MODE) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("pRFCalibrateInfo->DefaultOfdmIndex=%d, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]=%d, RF_Path = %d\n", -+ pRFCalibrateInfo->DefaultOfdmIndex, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath], RFPath)); -+ -+ Final_CCK_Swing_Index = pRFCalibrateInfo->DefaultCckIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; -+ Final_OFDM_Swing_Index = pRFCalibrateInfo->DefaultOfdmIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; -+ -+ if (RFPath == ODM_RF_PATH_A) -+ { -+ if (Final_OFDM_Swing_Index > PwrTrackingLimit) /*BBSwing higher then Limit*/ -+ { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx = Final_CCK_Swing_Index - PwrTrackingLimit; -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit; -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[PwrTrackingLimit]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_A); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d\n", PwrTrackingLimit, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else if (Final_OFDM_Swing_Index <= 0) -+ { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx = Final_CCK_Swing_Index; -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index; -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[0]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_A); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d\n", pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[Final_OFDM_Swing_Index]); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Compensate with BBSwing , Final_OFDM_Swing_Index = %d\n", Final_OFDM_Swing_Index)); -+ -+ if (pRFCalibrateInfo->Modify_TxAGC_Flag_PathA) /*If TxAGC has changed, reset TxAGC again*/ -+ { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx = 0; -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = 0; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_A); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A pDM_Odm->Modify_TxAGC_Flag = FALSE\n")); -+ } -+ } -+ } -+ } -+ else -+ { -+ return; -+ } -+} // odm_TxPwrTrackSetPwr88E -+ -+VOID -+GetDeltaSwingTable_8821A( -+ IN PVOID pDM_VOID, -+ OUT pu1Byte *TemperatureUP_A, -+ OUT pu1Byte *TemperatureDOWN_A, -+ OUT pu1Byte *TemperatureUP_B, -+ OUT pu1Byte *TemperatureDOWN_B -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u2Byte rate = *(pDM_Odm->pForcedDataRate); -+ u1Byte channel = pHalData->CurrentChannel; -+ -+ -+ if ( 1 <= channel && channel <= 14) { -+ if (IS_CCK_RATE(rate)) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N; -+ } else { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N; -+ } -+ } else if ( 36 <= channel && channel <= 64) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0]; -+ } else if ( 100 <= channel && channel <= 140) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1]; -+ } else if ( 149 <= channel && channel <= 173) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2]; -+ } else { -+ *TemperatureUP_A = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_A = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ *TemperatureUP_B = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_B = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ } -+ -+ return; -+} -+ -+void ConfigureTxpowerTrack_8821A( -+ PTXPWRTRACK_CFG pConfig -+ ) -+{ -+ pConfig->SwingTableSize_CCK = TXSCALE_TABLE_SIZE; -+ pConfig->SwingTableSize_OFDM = TXSCALE_TABLE_SIZE; -+ pConfig->Threshold_IQK = IQK_THRESHOLD; -+ pConfig->AverageThermalNum = AVG_THERMAL_NUM_8812A; -+ pConfig->RfPathCount = MAX_PATH_NUM_8821A; -+ pConfig->ThermalRegAddr = RF_T_METER_8812A; -+ -+ pConfig->ODM_TxPwrTrackSetPwr = ODM_TxPwrTrackSetPwr8821A; -+ pConfig->DoIQK = DoIQK_8821A; -+ pConfig->PHY_LCCalibrate = PHY_LCCalibrate_8821A; -+ pConfig->GetDeltaSwingTable = GetDeltaSwingTable_8821A; -+} -+ -+#define DP_BB_REG_NUM 7 -+#define DP_RF_REG_NUM 1 -+#define DP_RETRY_LIMIT 10 -+#define DP_PATH_NUM 2 -+#define DP_DPK_NUM 3 -+#define DP_DPK_VALUE_NUM 2 -+ -+VOID -+PHY_LCCalibrate_8821A( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u8Byte StartTime; -+ u8Byte ProgressingTime; -+ -+ StartTime = ODM_GetCurrentTime( pDM_Odm); -+ PHY_LCCalibrate_8812A(pDM_Odm); -+ ProgressingTime = ODM_GetProgressingTime( pDM_Odm, StartTime); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK ProgressingTime = %lld\n", ProgressingTime)); -+} -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_ce.h linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_ce.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_ce.h 2017-06-07 23:07:21.030689307 +0300 -@@ -0,0 +1,52 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL_PHY_RF_8821A_H__ -+#define __HAL_PHY_RF_8821A_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+void ConfigureTxpowerTrack_8821A( -+ PTXPWRTRACK_CFG pConfig -+ ); -+ -+VOID -+ODM_TxPwrTrackSetPwr8821A( -+ IN PVOID pDM_VOID, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ); -+ -+VOID -+PHY_LCCalibrate_8821A( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+GetDeltaSwingTable_8821A( -+ IN PVOID pDM_VOID, -+ OUT pu1Byte *TemperatureUP_A, -+ OUT pu1Byte *TemperatureDOWN_A, -+ OUT pu1Byte *TemperatureUP_B, -+ OUT pu1Byte *TemperatureDOWN_B -+); -+#endif // #ifndef __HAL_PHY_RF_8821A_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_win.c linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_win.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_win.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_win.c 2017-06-07 23:07:21.030689307 +0300 -@@ -0,0 +1,1103 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+// 2010/04/25 MH Define the max tx power tracking tx agc power. -+#define ODM_TXPWRTRACK_MAX_IDX8821A 6 -+ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+ -+//3 ============================================================ -+//3 Tx Power Tracking -+//3 ============================================================ -+ -+ -+void setIqkMatrix_8821A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte OFDM_index, -+ u1Byte RFPath, -+ s4Byte IqkResult_X, -+ s4Byte IqkResult_Y -+ ) -+{ -+ s4Byte ele_A=0, ele_D, ele_C=0, value32; -+ -+ ele_D = (OFDMSwingTable_New[OFDM_index] & 0xFFC00000)>>22; -+ -+ //new element A = element D x X -+ if((IqkResult_X != 0) && (*(pDM_Odm->pBandType) == ODM_BAND_2_4G)) -+ { -+ if ((IqkResult_X & 0x00000200) != 0) //consider minus -+ IqkResult_X = IqkResult_X | 0xFFFFFC00; -+ ele_A = ((IqkResult_X * ele_D)>>8)&0x000003FF; -+ -+ //new element C = element D x Y -+ if ((IqkResult_Y & 0x00000200) != 0) -+ IqkResult_Y = IqkResult_Y | 0xFFFFFC00; -+ ele_C = ((IqkResult_Y * ele_D)>>8)&0x000003FF; -+ -+ if (RFPath == ODM_RF_PATH_A) -+ switch (RFPath) -+ { -+ case ODM_RF_PATH_A: -+ //wirte new elements A, C, D to regC80 and regC94, element B is always 0 -+ value32 = (ele_D<<22)|((ele_C&0x3F)<<16)|ele_A; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord, value32); -+ -+ value32 = (ele_C&0x000003C0)>>6; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, bMaskH4Bits, value32); -+ -+ value32 = ((IqkResult_X * ele_D)>>7)&0x01; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT24, value32); -+ break; -+ default: -+ break; -+ } -+ } -+ else -+ { -+ switch (RFPath) -+ { -+ case ODM_RF_PATH_A: -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord, OFDMSwingTable_New[OFDM_index]); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, bMaskH4Bits, 0x00); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT24, 0x00); -+ break; -+ -+ default: -+ break; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("TxPwrTracking path B: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x 0xeb4 = 0x%x 0xebc = 0x%x\n", -+ (u4Byte)IqkResult_X, (u4Byte)IqkResult_Y, (u4Byte)ele_A, (u4Byte)ele_C, (u4Byte)ele_D, (u4Byte)IqkResult_X, (u4Byte)IqkResult_Y)); -+} -+ -+void DoIQK_8821A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+#endif -+ -+ ODM_ResetIQKResult(pDM_Odm); -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; -+ PHY_IQCalibrate_8821A(Adapter, FALSE); -+} -+ -+ -+VOID -+ODM_TxPwrTrackSetPwr8821A( -+ PDM_ODM_T pDM_Odm, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ u1Byte PwrTrackingLimit = 26; //+1.0dB -+ u1Byte TxRate = 0xFF; -+ u1Byte Final_OFDM_Swing_Index = 0; -+ u1Byte Final_CCK_Swing_Index = 0; -+ u4Byte finalBbSwingIdx[1]; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+#if (MP_DRIVER==1) -+ PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+#else -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ -+ if(!pMgntInfo->ForcedDataRate) //auto rate -+ { -+ if(pDM_Odm->TxRate != 0xFF) -+ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -+ } -+ else //force rate -+ { -+ TxRate = (u1Byte) pMgntInfo->ForcedDataRate; -+ } -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8821A\n")); -+ -+ if(TxRate != 0xFF) -+ { -+ //2 CCK -+ if((TxRate >= MGN_1M)&&(TxRate <= MGN_11M)) -+ PwrTrackingLimit = 32; //+4dB -+ //2 OFDM -+ else if((TxRate >= MGN_6M)&&(TxRate <= MGN_48M)) -+ PwrTrackingLimit = 30; //+3dB -+ else if(TxRate == MGN_54M) -+ PwrTrackingLimit = 28; //+2dB -+ //2 HT -+ else if((TxRate >= MGN_MCS0)&&(TxRate <= MGN_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_MCS3)&&(TxRate <= MGN_MCS4)) //16QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if((TxRate >= MGN_MCS5)&&(TxRate <= MGN_MCS7)) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ -+ //2 VHT -+ else if((TxRate >= MGN_VHT1SS_MCS0)&&(TxRate <= MGN_VHT1SS_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_VHT1SS_MCS3)&&(TxRate <= MGN_VHT1SS_MCS4)) //16QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if((TxRate >= MGN_VHT1SS_MCS5)&&(TxRate <= MGN_VHT1SS_MCS6)) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ else if(TxRate == MGN_VHT1SS_MCS7) //64QAM -+ PwrTrackingLimit = 26; //+1dB -+ else if(TxRate == MGN_VHT1SS_MCS8) //256QAM -+ PwrTrackingLimit = 24; //+0dB -+ else if(TxRate == MGN_VHT1SS_MCS9) //256QAM -+ PwrTrackingLimit = 22; //-1dB -+ -+ else -+ PwrTrackingLimit = 24; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("TxRate=0x%x, PwrTrackingLimit=%d\n", TxRate, PwrTrackingLimit)); -+ -+ if (Method == BBSWING) -+ { -+ if (RFPath == ODM_RF_PATH_A) -+ { -+ finalBbSwingIdx[ODM_RF_PATH_A] = (pRFCalibrateInfo->OFDM_index[ODM_RF_PATH_A] > PwrTrackingLimit) ? PwrTrackingLimit : pRFCalibrateInfo->OFDM_index[ODM_RF_PATH_A]; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pRFCalibrateInfo->OFDM_index[ODM_RF_PATH_A]=%d, pDM_Odm->RealBbSwingIdx[ODM_RF_PATH_A]=%d\n", -+ pRFCalibrateInfo->OFDM_index[ODM_RF_PATH_A], finalBbSwingIdx[ODM_RF_PATH_A])); -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_A]]); -+ } -+ } -+ else if (Method == MIX_MODE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pRFCalibrateInfo->DefaultOfdmIndex=%d, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]=%d, RF_Path = %d\n", -+ pRFCalibrateInfo->DefaultOfdmIndex, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath],RFPath )); -+ -+ Final_CCK_Swing_Index = pRFCalibrateInfo->DefaultCckIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; -+ Final_OFDM_Swing_Index = pRFCalibrateInfo->DefaultOfdmIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; -+ -+ if (RFPath == ODM_RF_PATH_A) -+ { -+ if(Final_OFDM_Swing_Index > PwrTrackingLimit) //BBSwing higher then Limit -+ { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx= Final_CCK_Swing_Index - PwrTrackingLimit; -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit; -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[PwrTrackingLimit]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA= TRUE; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_A); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else if (Final_OFDM_Swing_Index < 0) -+ { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx= Final_CCK_Swing_Index; -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index; -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[0]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA= TRUE; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_A); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[Final_OFDM_Swing_Index]); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); -+ -+ if(pRFCalibrateInfo->Modify_TxAGC_Flag_PathA) //If TxAGC has changed, reset TxAGC again -+ { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx= 0; -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = 0; -+ -+ PHY_SetTxPowerLevelByPath(Adapter, pHalData->CurrentChannel, ODM_RF_PATH_A); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA= FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A pDM_Odm->Modify_TxAGC_Flag = FALSE \n")); -+ } -+ } -+ } -+ } -+ else -+ { -+ return; -+ } -+} // odm_TxPwrTrackSetPwr88E -+ -+VOID -+GetDeltaSwingTable_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ OUT pu1Byte *TemperatureUP_A, -+ OUT pu1Byte *TemperatureDOWN_A, -+ OUT pu1Byte *TemperatureUP_B, -+ OUT pu1Byte *TemperatureDOWN_B -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u2Byte rate = *(pDM_Odm->pForcedDataRate); -+ u1Byte channel = pHalData->CurrentChannel; -+ -+ -+ if ( 1 <= channel && channel <= 14) { -+ if (IS_CCK_RATE(rate)) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N; -+ } else { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N; -+ } -+ } else if ( 36 <= channel && channel <= 64) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0]; -+ } else if ( 100 <= channel && channel <= 140) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1]; -+ } else if ( 149 <= channel && channel <= 173) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2]; -+ } else { -+ *TemperatureUP_A = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_A = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ *TemperatureUP_B = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_B = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ } -+ -+ return; -+} -+ -+void ConfigureTxpowerTrack_8821A( -+ PTXPWRTRACK_CFG pConfig -+ ) -+{ -+ pConfig->SwingTableSize_CCK = TXSCALE_TABLE_SIZE; -+ pConfig->SwingTableSize_OFDM = TXSCALE_TABLE_SIZE; -+ pConfig->Threshold_IQK = IQK_THRESHOLD; -+ pConfig->AverageThermalNum = AVG_THERMAL_NUM_8812A; -+ pConfig->RfPathCount = MAX_PATH_NUM_8821A; -+ pConfig->ThermalRegAddr = RF_T_METER_8812A; -+ -+ pConfig->ODM_TxPwrTrackSetPwr = ODM_TxPwrTrackSetPwr8821A; -+ pConfig->DoIQK = DoIQK_8821A; -+ pConfig->PHY_LCCalibrate = PHY_LCCalibrate_8821A; -+ pConfig->GetDeltaSwingTable = GetDeltaSwingTable_8821A; -+} -+ -+//1 7. IQK -+#define MAX_TOLERANCE 5 -+#define IQK_DELAY_TIME 1 //ms -+ -+void _IQK_RX_FillIQC_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN unsigned int RX_X, -+ IN unsigned int RX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, RX_X>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, RX_Y>>1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1, RX_Y>>1)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc10 = %x ====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xc10))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_TX_FillIQC_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN unsigned int TX_X, -+ IN unsigned int TX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x00000080); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x20040000); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, TX_Y); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, TX_X); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X, TX_Y)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xcd4 = %x;;0xccc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xcd4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xccc, 0x000007ff))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_BackupMacBB_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //save MACBB default value -+ for (i = 0; i < MACBB_NUM; i++){ -+ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupMacBB Success!!!!\n")); -+} -+void _IQK_BackupRF_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte RFA_backup, -+ IN pu4Byte RFB_backup, -+ IN pu4Byte Backup_RF_REG, -+ IN u4Byte RF_NUM -+ ) -+{ -+ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save RF Parameters -+ for (i = 0; i < RF_NUM; i++){ -+ RFA_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG[i], bMaskDWord); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupRF Success!!!!\n")); -+} -+void _IQK_BackupAFE_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ AFE_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_AFE_REG[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupAFE Success!!!!\n")); -+} -+void _IQK_RestoreMacBB_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload MacBB Parameters -+ for (i = 0; i < MACBB_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreMacBB Success!!!!\n")); -+} -+void _IQK_RestoreRF_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN pu4Byte Backup_RF_REG, -+ IN pu4Byte RF_backup, -+ IN u4Byte RF_REG_NUM -+ ) -+{ -+ u4Byte i; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ for (i = 0; i < RF_REG_NUM; i++) -+ ODM_SetRFReg(pDM_Odm, Path, Backup_RF_REG[i], bRFRegOffsetMask, RF_backup[i]); -+ -+ switch(Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path A Success!!!!\n")); -+ } -+ break; -+ default: -+ break; -+ } -+} -+void _IQK_RestoreAFE_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_AFE_REG[i], AFE_backup[i]); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x00000080); -+ ODM_Write4Byte(pDM_Odm, 0xc94, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x20040000); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreAFE Success!!!!\n")); -+} -+ -+ -+void _IQK_ConfigureMAC_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ // ========MAC register setting======== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_Write1Byte(pDM_Odm, 0x522, 0x3f); -+ ODM_SetBBReg(pDM_Odm, 0x550, BIT(11)|BIT(3), 0x0); -+ ODM_Write1Byte(pDM_Odm, 0x808, 0x00); // RX ante off -+ ODM_SetBBReg(pDM_Odm, 0x838, 0xf, 0xc); // CCA off -+ ODM_Write1Byte(pDM_Odm, 0xa07, 0xf); // CCK RX Path off -+} -+ -+#define cal_num 3 -+ -+void _IQK_Tx_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path -+ ) -+{ -+ u4Byte TX_fail, RX_fail, delay_count, IQK_ready, cal_retry, cal = 0; -+ int TX_X = 0, TX_Y = 0, RX_X = 0, RX_Y = 0, TX_Average = 0, RX_Average = 0, RXIQK_Loop = 0, RX_X_temp = 0, RX_Y_temp = 0; -+ int TX_X0[cal_num], TX_Y0[cal_num], RX_X0[2][cal_num], RX_Y0[2][cal_num]; -+ BOOLEAN TX0IQKOK = FALSE, RX0IQKOK = FALSE; -+ int i, ii, dx = 0, dy = 0, TX_finish = 0, RX_finish1 = 0, RX_finish2 = 0; -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BandWidth = %d, SupportInterface = %d, ExtPA = %d, ExtPA5G = %d\n", *pDM_Odm->pBandWidth, pDM_Odm->SupportInterface, pDM_Odm->ExtPA, pDM_Odm->ExtPA5G)); -+ -+ while (cal < cal_num){ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ //Path-A LOK -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // ========Path-A AFE all on======== -+ // Port 0 DAC/ADC on -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); -+ -+ ODM_SetBBReg(pDM_Odm, 0xc00, 0xf, 0x4);// hardware 3-wire off -+ -+ // LOK Setting -+ //====== LOK ====== -+ // 1. DAC/ADC sampling rate (160 MHz) -+ ODM_SetBBReg(pDM_Odm, 0xc5c, BIT(26)|BIT(25)|BIT(24), 0x7); -+ -+ // 2. LoK RF Setting (at BW = 20M) -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80002); -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x3); // BW 20M -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0003f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xf3fc3); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA5G) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f4); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28163e96); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, Path, 0x8, 0xffc00)); // Load LOK -+ switch (*pDM_Odm->pBandWidth) -+ { -+ case 1: -+ { -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x1); -+ } -+ break; -+ case 2: -+ { -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x0); -+ } -+ break; -+ default: -+ break; -+ -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ // 3. TX RF Setting -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0003f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xf3fc3); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA5G) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403e3); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x40163e96); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x00163e96); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready) || (delay_count>20)) { -+ break; -+ } -+ else{ -+ delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ TX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ TX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ -+ -+ if (TX0IQKOK == FALSE) -+ break; // TXK fail, Don't do RXK -+ -+ //====== RX IQK ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // 1. RX RF Setting -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0002f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfffbb); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d8); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X0[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y0[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); -+ -+ if (pDM_Odm->SupportInterface == 1){ -+ RXIQK_Loop = 2; // for 2% fail; -+ } -+ else{ -+ RXIQK_Loop = 1; -+ } -+ for(i = 0; i < RXIQK_Loop; i++){ -+ if (pDM_Odm->SupportInterface == 1) -+ if(i == 0) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161100); //Good -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28160d00); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28160d00); -+ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); -+ if (RX_fail == 0){ -+ /* -+ DbgPrint("====== RXIQK (%d) ======", i); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x05000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ DbgPrint("reg1 = %d, reg2 = %d", reg1, reg2); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x07000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+ */ -+ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ RX_X0[i][cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ RX_Y0[i][cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ RX0IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); -+ RX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ -+ } -+ } -+ else{ -+ RX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ } -+ -+ if (TX0IQKOK) -+ TX_Average++; -+ if (RX0IQKOK) -+ RX_Average++; -+ } -+ break; -+ default: -+ break; -+ } -+ cal++; -+ } -+ // FillIQK Result -+ switch (Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_A =======\n")); -+ if (TX_Average == 0) -+ break; -+ -+ for (i = 0; i < TX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X0[%d] = %x ;; TX_Y0[%d] = %x\n", i, (TX_X0[i])>>21&0x000007ff, i, (TX_Y0[i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < TX_Average; i++){ -+ for (ii = i+1; ii >21) - (TX_X0[ii]>>21); -+ if (dx < 3 && dx > -3){ -+ dy = (TX_Y0[i]>>21) - (TX_Y0[ii]>>21); -+ if (dy < 3 && dy > -3){ -+ TX_X = ((TX_X0[i]>>21) + (TX_X0[ii]>>21))/2; -+ TX_Y = ((TX_Y0[i]>>21) + (TX_Y0[ii]>>21))/2; -+ TX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (TX_finish == 1) -+ break; -+ } -+ -+ if (TX_finish == 1){ -+ _IQK_TX_FillIQC_8821A(pDM_Odm, Path, TX_X, TX_Y); -+ } -+ else{ -+ _IQK_TX_FillIQC_8821A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ -+ if (RX_Average == 0) -+ break; -+ -+ for (i = 0; i < RX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[0][%d] = %x ;; RX_Y0[0][%d] = %x\n", i, (RX_X0[0][i])>>21&0x000007ff, i, (RX_Y0[0][i])>>21&0x000007ff)); -+ if (RXIQK_Loop == 2) -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[1][%d] = %x ;; RX_Y0[1][%d] = %x\n", i, (RX_X0[1][i])>>21&0x000007ff, i, (RX_Y0[1][i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < RX_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_X0[0][ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_Y0[0][i]>>21) - (RX_Y0[0][ii]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_X_temp = ((RX_X0[0][i]>>21) + (RX_X0[0][ii]>>21))/2; -+ RX_Y_temp = ((RX_Y0[0][i]>>21) + (RX_Y0[0][ii]>>21))/2; -+ RX_finish1 = 1; -+ break; -+ } -+ } -+ } -+ if (RX_finish1 == 1){ -+ RX_X = RX_X_temp; -+ RX_Y = RX_Y_temp; -+ break; -+ } -+ } -+ if(RXIQK_Loop == 2){ -+ for (i = 0; i < RX_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_X0[1][ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_Y0[1][i]>>21) - (RX_Y0[1][ii]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_X = ((RX_X0[1][i]>>21) + (RX_X0[1][ii]>>21))/2; -+ RX_Y = ((RX_Y0[1][i]>>21) + (RX_Y0[1][ii]>>21))/2; -+ RX_finish2 = 1; -+ break; -+ } -+ } -+ } -+ if (RX_finish2 == 1) -+ break; -+ } -+ if(RX_finish1 && RX_finish2){ -+ RX_X = (RX_X+RX_X_temp)/2; -+ RX_Y = (RX_Y+RX_Y_temp)/2; -+ } -+ } -+ if (RX_finish1 || RX_finish1){ -+ _IQK_RX_FillIQC_8821A(pDM_Odm, Path, RX_X, RX_Y); -+ } -+ else{ -+ _IQK_RX_FillIQC_8821A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+#define MACBB_REG_NUM 8 -+#define AFE_REG_NUM 4 -+#define RF_REG_NUM 3 -+ -+VOID -+phy_IQCalibrate_By_FW_8821A( -+ IN PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u1Byte IQKcmd[3] = {pHalData->CurrentChannel, 0x0, 0x0}; -+ u1Byte Buf1 = 0x0; -+ u1Byte Buf2 = 0x0; -+ -+//Byte 2, Bit 4 ~ Bit 5 : BandType -+ if(pHalData->CurrentBandType) -+ Buf1 = 0x2<<4; -+ else -+ Buf1 = 0x1<<4; -+ -+//Byte 2, Bit 0 ~ Bit 3 : Bandwidth -+ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) -+ Buf2 = 0x1; -+ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) -+ Buf2 = 0x1<<1; -+ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) -+ Buf2 = 0x1<<2; -+ else -+ Buf2 = 0x1<<3; -+ -+ IQKcmd[1] = Buf1 | Buf2; -+ IQKcmd[2] = pHalData->ExternalPA_5G | pHalData->ExternalLNA_5G<<1; -+ -+ -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK Start ==\n")); -+ pHalData->IQK_StartTimer = 0; -+ pHalData->IQK_StartTimer = PlatformGetCurrentTime(); -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== StartTime: %u\n", pHalData->IQK_StartTimer)); -+ -+#if(H2C_USE_IO_THREAD == 1) -+ FW8821A_FillH2cCommand(pAdapter, 0x45, 3, IQKcmd); -+#else -+ FillH2CCommand8821A(pAdapter, 0x45, 3, IQKcmd); -+#endif -+ -+} -+ -+VOID -+phy_IQCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte MACBB_backup[MACBB_REG_NUM], AFE_backup[AFE_REG_NUM], RFA_backup[RF_REG_NUM], RFB_backup[RF_REG_NUM]; -+ u4Byte Backup_MACBB_REG[MACBB_REG_NUM] = {0x520, 0x550, 0x808, 0xa04, 0x90c, 0xc00, 0x838, 0x82c}; -+ u4Byte Backup_AFE_REG[AFE_REG_NUM] = {0xc5c, 0xc60, 0xc64, 0xc68}; -+ u4Byte Backup_RF_REG[RF_REG_NUM] = {0x65, 0x8f, 0x0}; -+ -+ _IQK_BackupMacBB_8821A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); -+ _IQK_BackupAFE_8821A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); -+ _IQK_BackupRF_8821A(pDM_Odm, RFA_backup, RFB_backup, Backup_RF_REG, RF_REG_NUM); -+ -+ _IQK_ConfigureMAC_8821A(pDM_Odm); -+ _IQK_Tx_8821A(pDM_Odm, ODM_RF_PATH_A); -+ _IQK_RestoreRF_8821A(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG, RFA_backup, RF_REG_NUM); -+ -+ _IQK_RestoreAFE_8821A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); -+ _IQK_RestoreMacBB_8821A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); -+ -+ //_IQK_Exit_8821A(pDM_Odm); -+ //_IQK_TX_CheckResult_8821A -+ -+} -+ -+ -+ -+ -+#define DP_BB_REG_NUM 7 -+#define DP_RF_REG_NUM 1 -+#define DP_RETRY_LIMIT 10 -+#define DP_PATH_NUM 2 -+#define DP_DPK_NUM 3 -+#define DP_DPK_VALUE_NUM 2 -+ -+ -+VOID -+PHY_ResetIQKResult_8821A( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x100); -+} -+ -+ -+VOID -+PHY_IQCalibrate_8821A( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery -+ ) -+{ -+ u4Byte counter = 0; -+ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #else // (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+#endif -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+#if (MP_DRIVER == 1) -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+ #else// (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ #endif -+#endif//(MP_DRIVER == 1) -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE) ) -+ if (ODM_CheckPowerStatus(pAdapter) == FALSE) -+ return; -+#endif -+ -+#if MP_DRIVER == 1 -+ if( ! (pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) ) -+#endif -+ { -+ //3 == FW IQK == -+ if(pMgntInfo->RegIQKFWOffload) -+ { -+ if ( ! pRFCalibrateInfo->bIQKInProgress) -+ { -+ PlatformAcquireSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ pRFCalibrateInfo->bIQKInProgress = TRUE; -+ PlatformReleaseSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ -+ phy_IQCalibrate_By_FW_8821A(pAdapter); -+ } -+ else -+ { -+ for(counter = 0; counter < 10; counter++){ -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK IN PROGRESS == #%d\n", counter)); -+ delay_ms(50); -+ if ( ! pRFCalibrateInfo->bIQKInProgress) -+ { -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK RETURN FROM WAITING ==\n")); -+ break; -+ } -+ } -+ -+ if (pRFCalibrateInfo->bIQKInProgress) -+ { -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK TIMEOUT (Still in progress after 500ms) ==\n")); -+ PlatformAcquireSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ pRFCalibrateInfo->bIQKInProgress = FALSE; -+ PlatformReleaseSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ } -+ else -+ { -+ PlatformAcquireSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ pRFCalibrateInfo->bIQKInProgress = TRUE; -+ PlatformReleaseSpinLock(pAdapter, RT_IQK_SPINLOCK); -+ phy_IQCalibrate_By_FW_8821A(pAdapter); -+ } -+ -+ -+ } -+ } -+ //3 == Driver IQK == -+ else { -+ if ( ! pRFCalibrateInfo->bIQKInProgress) { -+ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ pRFCalibrateInfo->bIQKInProgress = TRUE; -+ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ -+ phy_IQCalibrate_8821A(pDM_Odm); -+ -+ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ pRFCalibrateInfo->bIQKInProgress = FALSE; -+ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ } -+ } -+ } -+} -+ -+ -+VOID -+PHY_LCCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PHY_LCCalibrate_8812A(pDM_Odm); -+} -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_win.h linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_win.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_win.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/halphyrf_8821a_win.h 2017-06-07 23:07:21.030689307 +0300 -@@ -0,0 +1,72 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL_PHY_RF_8821A_H__ -+#define __HAL_PHY_RF_8821A_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define IQK_DELAY_TIME_8821A 10 //ms -+#define index_mapping_NUM_8821A 15 -+#define AVG_THERMAL_NUM_8821A 4 -+#define RF_T_METER_8821A 0x42 -+ -+ -+void ConfigureTxpowerTrack_8821A( -+ PTXPWRTRACK_CFG pConfig -+ ); -+ -+void DoIQK_8821A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ); -+ -+VOID -+ODM_TxPwrTrackSetPwr8821A( -+ PDM_ODM_T pDM_Odm, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ); -+ -+//1 7. IQK -+ -+void -+PHY_IQCalibrate_8821A( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery -+); -+ -+VOID -+PHY_LCCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm -+); -+ -+VOID -+GetDeltaSwingTable_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ OUT pu1Byte *TemperatureUP_A, -+ OUT pu1Byte *TemperatureDOWN_A, -+ OUT pu1Byte *TemperatureUP_B, -+ OUT pu1Byte *TemperatureDOWN_B -+); -+#endif // #ifndef __HAL_PHY_RF_8821A_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/mp_precomp.h linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/mp_precomp.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/mp_precomp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/mp_precomp.h 2017-06-07 23:07:21.030689307 +0300 -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//#include -+//#include "phydm_precomp.h" -+//#include "../phydm_precomp.h" -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ap.c linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ap.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ap.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ap.c 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,875 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+#define cal_num_8821A 3 -+#define MACBB_REG_NUM_8821A 8 -+#define AFE_REG_NUM_8821A 4 -+#define RF_REG_NUM_8821A 3 -+/*---------------------------Define Local Constant---------------------------*/ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+void DoIQK_8821A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ) -+{ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; -+ PHY_IQCalibrate_8821A(pDM_Odm, FALSE); -+} -+#endif -+void _IQK_RX_FillIQC_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN unsigned int RX_X, -+ IN unsigned int RX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, RX_X>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, (RX_Y>>1) & 0x000003ff); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1, RX_Y>>1)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc10 = %x ====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xc10))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_TX_FillIQC_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN unsigned int TX_X, -+ IN unsigned int TX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x00000080); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x20040000); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, TX_Y); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, TX_X); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X, TX_Y)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xcd4 = %x;;0xccc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xcd4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xccc, 0x000007ff))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_BackupMacBB_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //save MACBB default value -+ for (i = 0; i < MACBB_NUM; i++){ -+ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupMacBB Success!!!!\n")); -+} -+ -+void _IQK_BackupRF_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte RFA_backup, -+ IN pu4Byte RFB_backup, -+ IN pu4Byte Backup_RF_REG, -+ IN u4Byte RF_NUM -+ ) -+{ -+ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save RF Parameters -+ for (i = 0; i < RF_NUM; i++){ -+ RFA_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG[i], bMaskDWord); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupRF Success!!!!\n")); -+} -+ -+void _IQK_BackupAFE_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ AFE_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_AFE_REG[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupAFE Success!!!!\n")); -+} -+ -+void _IQK_RestoreMacBB_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload MacBB Parameters -+ for (i = 0; i < MACBB_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreMacBB Success!!!!\n")); -+} -+ -+void _IQK_RestoreRF_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN pu4Byte Backup_RF_REG, -+ IN pu4Byte RF_backup, -+ IN u4Byte RF_REG_NUM -+ ) -+{ -+ u4Byte i; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ for (i = 0; i < RF_REG_NUM; i++) -+ ODM_SetRFReg(pDM_Odm, Path, Backup_RF_REG[i], bRFRegOffsetMask, RF_backup[i]); -+ -+ switch(Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path A Success!!!!\n")); -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+void _IQK_RestoreAFE_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_AFE_REG[i], AFE_backup[i]); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x00000080); -+ ODM_Write4Byte(pDM_Odm, 0xc94, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x20040000); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreAFE Success!!!!\n")); -+} -+ -+void _IQK_ConfigureMAC_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ // ========MAC register setting======== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_Write1Byte(pDM_Odm, 0x522, 0x3f); -+ ODM_SetBBReg(pDM_Odm, 0x550, BIT(11)|BIT(3), 0x0); -+ ODM_Write1Byte(pDM_Odm, 0x808, 0x00); // RX ante off -+ ODM_SetBBReg(pDM_Odm, 0x838, 0xf, 0xc); // CCA off -+ ODM_Write1Byte(pDM_Odm, 0xa07, 0xf); // CCK RX Path off -+} -+ -+void _IQK_Tx_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path -+ ) -+{ -+ u4Byte TX_fail, RX_fail, delay_count, IQK_ready, cal_retry, cal = 0; -+ int TX_X = 0, TX_Y = 0, RX_X = 0, RX_Y = 0, TX_Average = 0, RX_Average = 0, RXIQK_Loop = 0, RX_X_temp = 0, RX_Y_temp = 0; -+ int TX_X0[cal_num_8821A], TX_Y0[cal_num_8821A], RX_X0[2][cal_num_8821A], RX_Y0[2][cal_num_8821A]; -+ BOOLEAN TX0IQKOK = FALSE, RX0IQKOK = FALSE; -+ BOOLEAN VDF_enable = FALSE; -+ int i, k, VDF_Y[3], VDF_X[3], Tx_dt[3], ii, dx = 0, dy = 0, TX_finish = 0, RX_finish1 = 0, RX_finish2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BandWidth = %d, SupportInterface = %d, ExtPA = %d, ExtPA5G = %d\n", *pDM_Odm->pBandWidth, pDM_Odm->SupportInterface, pDM_Odm->ExtPA, pDM_Odm->ExtPA5G)); -+ if (*pDM_Odm->pBandWidth == 2){ -+ VDF_enable = TRUE; -+ } -+ -+ while (cal < cal_num_8821A){ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ //Path-A LOK -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // ========Path-A AFE all on======== -+ // Port 0 DAC/ADC on -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); -+ -+ ODM_SetBBReg(pDM_Odm, 0xc00, 0xf, 0x4);// hardware 3-wire off -+ -+ // LOK Setting -+ //====== LOK ====== -+ // 1. DAC/ADC sampling rate (160 MHz) -+ ODM_SetBBReg(pDM_Odm, 0xc5c, BIT(26)|BIT(25)|BIT(24), 0x7); -+ -+ // 2. LoK RF Setting (at BW = 20M) -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80002); -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x3); // BW 20M -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0003f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xf3fc3); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA5G) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f4); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28163e96); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, Path, 0x8, 0xffc00)); // Load LOK -+ switch (*pDM_Odm->pBandWidth) -+ { -+ case 1: -+ { -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x1); -+ } -+ break; -+ case 2: -+ { -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x0); -+ } -+ break; -+ default: -+ break; -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ // 3. TX RF Setting -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0003f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xf3fc3); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA5G) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403e3); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x40163e96); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x00163e96); -+ -+ if (VDF_enable == 1){ -+ for (k = 0;k <= 2; k++){ -+ switch (k){ -+ case 0: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); -+ } -+ break; -+ case 1: -+ { -+ ODM_SetBBReg(pDM_Odm, 0xc80, BIT(28), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xc84, BIT(28), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); -+ } -+ break; -+ case 2: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); -+ Tx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); -+ Tx_dt[cal] = ((16*Tx_dt[cal])*10000/15708); -+ Tx_dt[cal] = (Tx_dt[cal] >> 1 )+(Tx_dt[cal] & BIT(0)); -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c20);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xce8, 0x3fff0000, Tx_dt[cal] & 0x00003fff); -+ } -+ break; -+ } -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready) || (delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10){ -+ break; -+ } -+ } -+ } -+ } -+ if (k == 3){ -+ TX_X0[cal] = VDF_X[k-1] ; -+ TX_Y0[cal] = VDF_Y[k-1]; -+ } -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready) || (delay_count>20)) { -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ TX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ TX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ } -+ -+ if (TX0IQKOK == FALSE) -+ break; // TXK fail, Don't do RXK -+ -+ //====== RX IQK ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // 1. RX RF Setting -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0002f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfffbb); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d8); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X0[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y0[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); -+ -+ if (pDM_Odm->SupportInterface == 1){ -+ RXIQK_Loop = 2; // for 2% fail; -+ } -+ else{ -+ RXIQK_Loop = 1; -+ } -+ for(i = 0; i < RXIQK_Loop; i++){ -+ if (pDM_Odm->SupportInterface == 1) -+ if(i == 0) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161100); //Good -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28160d00); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28160d00); -+ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); -+ if (RX_fail == 0){ -+ /* -+ DbgPrint("====== RXIQK (%d) ======", i); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x05000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ DbgPrint("reg1 = %d, reg2 = %d", reg1, reg2); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x07000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+ */ -+ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ RX_X0[i][cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ RX_Y0[i][cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ RX0IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); -+ RX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ -+ } -+ } -+ else{ -+ RX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ } -+ -+ if (TX0IQKOK) -+ TX_Average++; -+ if (RX0IQKOK) -+ RX_Average++; -+ } -+ break; -+ default: -+ break; -+ } -+ cal++; -+ } -+ // FillIQK Result -+ switch (Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_A =======\n")); -+ if (TX_Average == 0) -+ break; -+ -+ for (i = 0; i < TX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X0[%d] = %x ;; TX_Y0[%d] = %x\n", i, (TX_X0[i])>>21&0x000007ff, i, (TX_Y0[i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < TX_Average; i++){ -+ for (ii = i+1; ii >21) - (TX_X0[ii]>>21); -+ if (dx < 3 && dx > -3){ -+ dy = (TX_Y0[i]>>21) - (TX_Y0[ii]>>21); -+ if (dy < 3 && dy > -3){ -+ TX_X = ((TX_X0[i]>>21) + (TX_X0[ii]>>21))/2; -+ TX_Y = ((TX_Y0[i]>>21) + (TX_Y0[ii]>>21))/2; -+ TX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (TX_finish == 1) -+ break; -+ } -+ -+ if (TX_finish == 1){ -+ _IQK_TX_FillIQC_8821A(pDM_Odm, Path, TX_X, TX_Y); -+ } -+ else{ -+ _IQK_TX_FillIQC_8821A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ -+ if (RX_Average == 0) -+ break; -+ -+ for (i = 0; i < RX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[0][%d] = %x ;; RX_Y0[0][%d] = %x\n", i, (RX_X0[0][i])>>21&0x000007ff, i, (RX_Y0[0][i])>>21&0x000007ff)); -+ if (RXIQK_Loop == 2) -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[1][%d] = %x ;; RX_Y0[1][%d] = %x\n", i, (RX_X0[1][i])>>21&0x000007ff, i, (RX_Y0[1][i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < RX_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_X0[0][ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_Y0[0][i]>>21) - (RX_Y0[0][ii]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_X_temp = ((RX_X0[0][i]>>21) + (RX_X0[0][ii]>>21))/2; -+ RX_Y_temp = ((RX_Y0[0][i]>>21) + (RX_Y0[0][ii]>>21))/2; -+ RX_finish1 = 1; -+ break; -+ } -+ } -+ } -+ if (RX_finish1 == 1){ -+ RX_X = RX_X_temp; -+ RX_Y = RX_Y_temp; -+ break; -+ } -+ } -+ if(RXIQK_Loop == 2){ -+ for (i = 0; i < RX_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_X0[1][ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_Y0[1][i]>>21) - (RX_Y0[1][ii]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_X = ((RX_X0[1][i]>>21) + (RX_X0[1][ii]>>21))/2; -+ RX_Y = ((RX_Y0[1][i]>>21) + (RX_Y0[1][ii]>>21))/2; -+ RX_finish2 = 1; -+ break; -+ } -+ } -+ } -+ if (RX_finish2 == 1) -+ break; -+ } -+ if(RX_finish1 && RX_finish2){ -+ RX_X = (RX_X+RX_X_temp)/2; -+ RX_Y = (RX_Y+RX_Y_temp)/2; -+ } -+ } -+ if (RX_finish1 || RX_finish2){ -+ _IQK_RX_FillIQC_8821A(pDM_Odm, Path, RX_X, RX_Y); -+ } -+ else{ -+ _IQK_RX_FillIQC_8821A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+VOID -+phy_IQCalibrate_By_FW_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+ u1Byte IQKcmd[3] = {*pDM_Odm->pChannel, 0x0, 0x0}; -+ u1Byte Buf1 = 0x0; -+ u1Byte Buf2 = 0x0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("pChannel: %d \n", *pDM_Odm->pChannel)); -+ -+ -+//Byte 2, Bit 4 ~ Bit 5 : BandType -+ if(*pDM_Odm->pBandType) -+ Buf1 = 0x2<<4; -+ else -+ Buf1 = 0x1<<4; -+ -+//Byte 2, Bit 0 ~ Bit 3 : Bandwidth -+ if(*pDM_Odm->pBandWidth == ODM_BW20M) -+ Buf2 = 0x1; -+ else if(*pDM_Odm->pBandWidth == ODM_BW40M) -+ Buf2 = 0x1<<1; -+ else if(*pDM_Odm->pBandWidth == ODM_BW80M) -+ Buf2 = 0x1<<2; -+ else -+ Buf2 = 0x1<<3; -+ -+ IQKcmd[1] = Buf1 | Buf2; -+ IQKcmd[2] = pDM_Odm->ExtPA5G | pDM_Odm->ExtLNA5G<<1; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== FW IQK Start ==\n")); -+ pDM_Odm->RFCalibrateInfo.IQK_StartTime = 0; -+ pDM_Odm->RFCalibrateInfo.IQK_StartTime = ODM_GetCurrentTime( pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== StartTime: %lld\n", pDM_Odm->RFCalibrateInfo.IQK_StartTime)); -+ ODM_FillH2CCmd(pDM_Odm, 0x45, 3, IQKcmd); -+ -+ -+} -+#endif -+ -+VOID -+phy_IQCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte MACBB_backup[MACBB_REG_NUM_8821A], AFE_backup[AFE_REG_NUM_8821A], RFA_backup[RF_REG_NUM_8821A], RFB_backup[RF_REG_NUM_8821A]; -+ u4Byte Backup_MACBB_REG[MACBB_REG_NUM_8821A] = {0x520, 0x550, 0x808, 0xa04, 0x90c, 0xc00, 0x838, 0x82c}; -+ u4Byte Backup_AFE_REG[AFE_REG_NUM_8821A] = {0xc5c, 0xc60, 0xc64, 0xc68}; -+ u4Byte Backup_RF_REG[RF_REG_NUM_8821A] = {0x65, 0x8f, 0x0}; -+ -+ _IQK_BackupMacBB_8821A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM_8821A); -+ _IQK_BackupAFE_8821A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM_8821A); -+ _IQK_BackupRF_8821A(pDM_Odm, RFA_backup, RFB_backup, Backup_RF_REG, RF_REG_NUM_8821A); -+ -+ _IQK_ConfigureMAC_8821A(pDM_Odm); -+ _IQK_Tx_8821A(pDM_Odm, ODM_RF_PATH_A); -+ -+ _IQK_RestoreRF_8821A(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG, RFA_backup, RF_REG_NUM_8821A); -+ _IQK_RestoreAFE_8821A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM_8821A); -+ _IQK_RestoreMacBB_8821A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM_8821A); -+} -+ -+VOID -+PHY_ResetIQKResult_8821A( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x100); -+} -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+VOID -+PHY_IQCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN BOOLEAN bReCovery -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ u4Byte counter = 0; -+ #endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN ) -+ if (ODM_CheckPowerStatus(pAdapter) == FALSE) -+ return; -+#endif -+ -+ if (pDM_Odm->mp_mode){ //(MP_DRIVER == 1) -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #if (MP_DRIVER == 1) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+ if( pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) -+ return; -+ #endif -+ #else// (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ if( pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) -+ return; -+ #endif -+ -+ } -+ -+ -+ //3 == FW IQK == -+ if(pDM_Odm->IQKFWOffload) -+ { -+ if ( ! pDM_Odm->RFCalibrateInfo.bIQKInProgress) -+ { -+ ODM_AcquireSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = TRUE; -+ ODM_ReleaseSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ phy_IQCalibrate_By_FW_8821A(pDM_Odm); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ for(counter = 0; counter < 10; counter++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== FW IQK IN PROGRESS == #%d\n", counter)); -+ ODM_delay_ms(50); -+ if ( ! pDM_Odm->RFCalibrateInfo.bIQKInProgress) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== FW IQK RETURN FROM WAITING ==\n")); -+ break; -+ } -+ } -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ rtl8812_iqk_wait(pAdapter, 500); -+ #endif -+ if (pDM_Odm->RFCalibrateInfo.bIQKInProgress) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== FW IQK TIMEOUT (Still in progress after 500ms) ==\n")); -+ ODM_AcquireSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; -+ ODM_ReleaseSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== Return the IQK CMD, because the IQK in Progress ==\n")); -+ } -+ } -+ //3 == Driver IQK == -+ else { -+ if ( ! pDM_Odm->RFCalibrateInfo.bIQKInProgress) { -+ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = TRUE; -+ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ -+ pDM_Odm->RFCalibrateInfo.IQK_StartTime = ODM_GetCurrentTime( pDM_Odm); -+ phy_IQCalibrate_8821A(pDM_Odm); -+ pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime = ODM_GetProgressingTime( pDM_Odm, pDM_Odm->RFCalibrateInfo.IQK_StartTime); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK ProgressingTime = %lld ms\n", pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime)); -+ -+ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; -+ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== Return the IQK CMD, because the IQK in Progress ==\n")); -+ } -+ } -+ -+} -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ap.h linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ap.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ap.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ap.h 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDM_IQK_8821A_H__ -+#define __PHYDM_IQK_8821A_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+/*---------------------------End Define Parameters-------------------------------*/ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+void -+DoIQK_8821A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ); -+void -+PHY_IQCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN BOOLEAN bReCovery -+); -+#else -+VOID -+phy_IQCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ); -+#endif -+#endif // #ifndef __PHYDM_IQK_8821A_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ce.c linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ce.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ce.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ce.c 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,876 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+#define cal_num_8821A 3 -+#define MACBB_REG_NUM_8821A 8 -+#define AFE_REG_NUM_8821A 4 -+#define RF_REG_NUM_8821A 3 -+/*---------------------------Define Local Constant---------------------------*/ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+void DoIQK_8821A( -+ PVOID pDM_VOID, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; -+ PHY_IQCalibrate_8821A(pDM_Odm, FALSE); -+} -+#endif -+void _IQK_RX_FillIQC_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN unsigned int RX_X, -+ IN unsigned int RX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, RX_X>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, (RX_Y>>1) & 0x000003ff); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1, RX_Y>>1)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc10 = %x ====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xc10))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_TX_FillIQC_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN unsigned int TX_X, -+ IN unsigned int TX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x00000080); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x20040000); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, TX_Y); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, TX_X); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X, TX_Y)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xcd4 = %x;;0xccc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xcd4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xccc, 0x000007ff))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_BackupMacBB_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //save MACBB default value -+ for (i = 0; i < MACBB_NUM; i++){ -+ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupMacBB Success!!!!\n")); -+} -+ -+void _IQK_BackupRF_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte RFA_backup, -+ IN pu4Byte RFB_backup, -+ IN pu4Byte Backup_RF_REG, -+ IN u4Byte RF_NUM -+ ) -+{ -+ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save RF Parameters -+ for (i = 0; i < RF_NUM; i++){ -+ RFA_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG[i], bMaskDWord); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupRF Success!!!!\n")); -+} -+ -+void _IQK_BackupAFE_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ AFE_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_AFE_REG[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupAFE Success!!!!\n")); -+} -+ -+void _IQK_RestoreMacBB_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload MacBB Parameters -+ for (i = 0; i < MACBB_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreMacBB Success!!!!\n")); -+} -+ -+void _IQK_RestoreRF_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN pu4Byte Backup_RF_REG, -+ IN pu4Byte RF_backup, -+ IN u4Byte RF_REG_NUM -+ ) -+{ -+ u4Byte i; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ for (i = 0; i < RF_REG_NUM; i++) -+ ODM_SetRFReg(pDM_Odm, Path, Backup_RF_REG[i], bRFRegOffsetMask, RF_backup[i]); -+ -+ switch(Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path A Success!!!!\n")); -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+void _IQK_RestoreAFE_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_AFE_REG[i], AFE_backup[i]); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x00000080); -+ ODM_Write4Byte(pDM_Odm, 0xc94, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x20040000); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreAFE Success!!!!\n")); -+} -+ -+void _IQK_ConfigureMAC_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ // ========MAC register setting======== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_Write1Byte(pDM_Odm, 0x522, 0x3f); -+ ODM_SetBBReg(pDM_Odm, 0x550, BIT(11)|BIT(3), 0x0); -+ ODM_Write1Byte(pDM_Odm, 0x808, 0x00); // RX ante off -+ ODM_SetBBReg(pDM_Odm, 0x838, 0xf, 0xc); // CCA off -+ ODM_Write1Byte(pDM_Odm, 0xa07, 0xf); // CCK RX Path off -+} -+ -+void _IQK_Tx_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path -+ ) -+{ -+ u4Byte TX_fail, RX_fail, delay_count, IQK_ready, cal_retry, cal = 0; -+ int TX_X = 0, TX_Y = 0, RX_X = 0, RX_Y = 0, TX_Average = 0, RX_Average = 0, RXIQK_Loop = 0, RX_X_temp = 0, RX_Y_temp = 0; -+ int TX_X0[cal_num_8821A], TX_Y0[cal_num_8821A], RX_X0[2][cal_num_8821A], RX_Y0[2][cal_num_8821A]; -+ BOOLEAN TX0IQKOK = FALSE, RX0IQKOK = FALSE; -+ BOOLEAN VDF_enable = FALSE; -+ int i, k, VDF_Y[3], VDF_X[3], Tx_dt[3], ii, dx = 0, dy = 0, TX_finish = 0, RX_finish1 = 0, RX_finish2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BandWidth = %d, SupportInterface = %d, ExtPA = %d, ExtPA5G = %d\n", *pDM_Odm->pBandWidth, pDM_Odm->SupportInterface, pDM_Odm->ExtPA, pDM_Odm->ExtPA5G)); -+ if (*pDM_Odm->pBandWidth == 2){ -+ VDF_enable = TRUE; -+ } -+ -+ while (cal < cal_num_8821A){ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ //Path-A LOK -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // ========Path-A AFE all on======== -+ // Port 0 DAC/ADC on -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); -+ -+ ODM_SetBBReg(pDM_Odm, 0xc00, 0xf, 0x4);// hardware 3-wire off -+ -+ // LOK Setting -+ //====== LOK ====== -+ // 1. DAC/ADC sampling rate (160 MHz) -+ ODM_SetBBReg(pDM_Odm, 0xc5c, BIT(26)|BIT(25)|BIT(24), 0x7); -+ -+ // 2. LoK RF Setting (at BW = 20M) -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80002); -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x3); // BW 20M -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0003f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xf3fc3); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA5G) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f4); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28163e96); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, Path, 0x8, 0xffc00)); // Load LOK -+ switch (*pDM_Odm->pBandWidth) -+ { -+ case 1: -+ { -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x1); -+ } -+ break; -+ case 2: -+ { -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x0); -+ } -+ break; -+ default: -+ break; -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ // 3. TX RF Setting -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0003f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xf3fc3); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA5G) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403e3); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x40163e96); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x00163e96); -+ -+ if (VDF_enable == 1){ -+ for (k = 0;k <= 2; k++){ -+ switch (k){ -+ case 0: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); -+ } -+ break; -+ case 1: -+ { -+ ODM_SetBBReg(pDM_Odm, 0xc80, BIT(28), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xc84, BIT(28), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); -+ } -+ break; -+ case 2: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); -+ Tx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); -+ Tx_dt[cal] = ((16*Tx_dt[cal])*10000/15708); -+ Tx_dt[cal] = (Tx_dt[cal] >> 1 )+(Tx_dt[cal] & BIT(0)); -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c20);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xce8, 0x3fff0000, Tx_dt[cal] & 0x00003fff); -+ } -+ break; -+ } -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready) || (delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10){ -+ break; -+ } -+ } -+ } -+ } -+ if (k == 3){ -+ TX_X0[cal] = VDF_X[k-1] ; -+ TX_Y0[cal] = VDF_Y[k-1]; -+ } -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready) || (delay_count>20)) { -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ TX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ TX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ } -+ -+ if (TX0IQKOK == FALSE) -+ break; // TXK fail, Don't do RXK -+ -+ //====== RX IQK ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // 1. RX RF Setting -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0002f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfffbb); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d8); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X0[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y0[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); -+ -+ if (pDM_Odm->SupportInterface == 1){ -+ RXIQK_Loop = 2; // for 2% fail; -+ } -+ else{ -+ RXIQK_Loop = 1; -+ } -+ for(i = 0; i < RXIQK_Loop; i++){ -+ if (pDM_Odm->SupportInterface == 1) -+ if(i == 0) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161100); //Good -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28160d00); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28160d00); -+ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); -+ if (RX_fail == 0){ -+ /* -+ DbgPrint("====== RXIQK (%d) ======", i); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x05000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ DbgPrint("reg1 = %d, reg2 = %d", reg1, reg2); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x07000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+ */ -+ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ RX_X0[i][cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ RX_Y0[i][cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ RX0IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); -+ RX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ -+ } -+ } -+ else{ -+ RX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ } -+ -+ if (TX0IQKOK) -+ TX_Average++; -+ if (RX0IQKOK) -+ RX_Average++; -+ } -+ break; -+ default: -+ break; -+ } -+ cal++; -+ } -+ // FillIQK Result -+ switch (Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_A =======\n")); -+ if (TX_Average == 0) -+ break; -+ -+ for (i = 0; i < TX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X0[%d] = %x ;; TX_Y0[%d] = %x\n", i, (TX_X0[i])>>21&0x000007ff, i, (TX_Y0[i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < TX_Average; i++){ -+ for (ii = i+1; ii >21) - (TX_X0[ii]>>21); -+ if (dx < 3 && dx > -3){ -+ dy = (TX_Y0[i]>>21) - (TX_Y0[ii]>>21); -+ if (dy < 3 && dy > -3){ -+ TX_X = ((TX_X0[i]>>21) + (TX_X0[ii]>>21))/2; -+ TX_Y = ((TX_Y0[i]>>21) + (TX_Y0[ii]>>21))/2; -+ TX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (TX_finish == 1) -+ break; -+ } -+ -+ if (TX_finish == 1){ -+ _IQK_TX_FillIQC_8821A(pDM_Odm, Path, TX_X, TX_Y); -+ } -+ else{ -+ _IQK_TX_FillIQC_8821A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ -+ if (RX_Average == 0) -+ break; -+ -+ for (i = 0; i < RX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[0][%d] = %x ;; RX_Y0[0][%d] = %x\n", i, (RX_X0[0][i])>>21&0x000007ff, i, (RX_Y0[0][i])>>21&0x000007ff)); -+ if (RXIQK_Loop == 2) -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[1][%d] = %x ;; RX_Y0[1][%d] = %x\n", i, (RX_X0[1][i])>>21&0x000007ff, i, (RX_Y0[1][i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < RX_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_X0[0][ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_Y0[0][i]>>21) - (RX_Y0[0][ii]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_X_temp = ((RX_X0[0][i]>>21) + (RX_X0[0][ii]>>21))/2; -+ RX_Y_temp = ((RX_Y0[0][i]>>21) + (RX_Y0[0][ii]>>21))/2; -+ RX_finish1 = 1; -+ break; -+ } -+ } -+ } -+ if (RX_finish1 == 1){ -+ RX_X = RX_X_temp; -+ RX_Y = RX_Y_temp; -+ break; -+ } -+ } -+ if(RXIQK_Loop == 2){ -+ for (i = 0; i < RX_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_X0[1][ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_Y0[1][i]>>21) - (RX_Y0[1][ii]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_X = ((RX_X0[1][i]>>21) + (RX_X0[1][ii]>>21))/2; -+ RX_Y = ((RX_Y0[1][i]>>21) + (RX_Y0[1][ii]>>21))/2; -+ RX_finish2 = 1; -+ break; -+ } -+ } -+ } -+ if (RX_finish2 == 1) -+ break; -+ } -+ if(RX_finish1 && RX_finish2){ -+ RX_X = (RX_X+RX_X_temp)/2; -+ RX_Y = (RX_Y+RX_Y_temp)/2; -+ } -+ } -+ if (RX_finish1 || RX_finish2){ -+ _IQK_RX_FillIQC_8821A(pDM_Odm, Path, RX_X, RX_Y); -+ } -+ else{ -+ _IQK_RX_FillIQC_8821A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+VOID -+phy_IQCalibrate_By_FW_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+ u1Byte IQKcmd[3] = {*pDM_Odm->pChannel, 0x0, 0x0}; -+ u1Byte Buf1 = 0x0; -+ u1Byte Buf2 = 0x0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("pChannel: %d \n", *pDM_Odm->pChannel)); -+ -+ -+//Byte 2, Bit 4 ~ Bit 5 : BandType -+ if(*pDM_Odm->pBandType) -+ Buf1 = 0x2<<4; -+ else -+ Buf1 = 0x1<<4; -+ -+//Byte 2, Bit 0 ~ Bit 3 : Bandwidth -+ if(*pDM_Odm->pBandWidth == ODM_BW20M) -+ Buf2 = 0x1; -+ else if(*pDM_Odm->pBandWidth == ODM_BW40M) -+ Buf2 = 0x1<<1; -+ else if(*pDM_Odm->pBandWidth == ODM_BW80M) -+ Buf2 = 0x1<<2; -+ else -+ Buf2 = 0x1<<3; -+ -+ IQKcmd[1] = Buf1 | Buf2; -+ IQKcmd[2] = pDM_Odm->ExtPA5G | pDM_Odm->ExtLNA5G<<1; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== FW IQK Start ==\n")); -+ pDM_Odm->RFCalibrateInfo.IQK_StartTime = 0; -+ pDM_Odm->RFCalibrateInfo.IQK_StartTime = ODM_GetCurrentTime( pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== StartTime: %lld\n", pDM_Odm->RFCalibrateInfo.IQK_StartTime)); -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_IQ_CALIBRATION, 3, IQKcmd); -+ -+ -+} -+#endif -+ -+VOID -+phy_IQCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte MACBB_backup[MACBB_REG_NUM_8821A], AFE_backup[AFE_REG_NUM_8821A], RFA_backup[RF_REG_NUM_8821A], RFB_backup[RF_REG_NUM_8821A]; -+ u4Byte Backup_MACBB_REG[MACBB_REG_NUM_8821A] = {0x520, 0x550, 0x808, 0xa04, 0x90c, 0xc00, 0x838, 0x82c}; -+ u4Byte Backup_AFE_REG[AFE_REG_NUM_8821A] = {0xc5c, 0xc60, 0xc64, 0xc68}; -+ u4Byte Backup_RF_REG[RF_REG_NUM_8821A] = {0x65, 0x8f, 0x0}; -+ -+ _IQK_BackupMacBB_8821A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM_8821A); -+ _IQK_BackupAFE_8821A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM_8821A); -+ _IQK_BackupRF_8821A(pDM_Odm, RFA_backup, RFB_backup, Backup_RF_REG, RF_REG_NUM_8821A); -+ -+ _IQK_ConfigureMAC_8821A(pDM_Odm); -+ _IQK_Tx_8821A(pDM_Odm, ODM_RF_PATH_A); -+ -+ _IQK_RestoreRF_8821A(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG, RFA_backup, RF_REG_NUM_8821A); -+ _IQK_RestoreAFE_8821A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM_8821A); -+ _IQK_RestoreMacBB_8821A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM_8821A); -+} -+ -+VOID -+PHY_ResetIQKResult_8821A( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x100); -+} -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+VOID -+PHY_IQCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN BOOLEAN bReCovery -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ u4Byte counter = 0; -+ #endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN ) -+ if (ODM_CheckPowerStatus(pAdapter) == FALSE) -+ return; -+#endif -+ -+ if (pDM_Odm->mp_mode){ //(MP_DRIVER == 1) -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #if (MP_DRIVER == 1) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+ if( pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) -+ return; -+ #endif -+ #else// (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ if( pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) -+ return; -+ pDM_Odm->IQKFWOffload = 0; /*MP mode NO FW IQK*/ -+ #endif -+ -+ } -+ -+ //3 == FW IQK == -+ if(pDM_Odm->IQKFWOffload) -+ { -+ if ( ! pDM_Odm->RFCalibrateInfo.bIQKInProgress) -+ { -+ ODM_AcquireSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = TRUE; -+ ODM_ReleaseSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ phy_IQCalibrate_By_FW_8821A(pDM_Odm); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ for(counter = 0; counter < 10; counter++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== FW IQK IN PROGRESS == #%d\n", counter)); -+ ODM_delay_ms(50); -+ if ( ! pDM_Odm->RFCalibrateInfo.bIQKInProgress) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== FW IQK RETURN FROM WAITING ==\n")); -+ break; -+ } -+ } -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ rtl8812_iqk_wait(pAdapter, 500); -+ #endif -+ if (pDM_Odm->RFCalibrateInfo.bIQKInProgress) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== FW IQK TIMEOUT (Still in progress after 500ms) ==\n")); -+ ODM_AcquireSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; -+ ODM_ReleaseSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== Return the IQK CMD, because the IQK in Progress ==\n")); -+ } -+ } -+ //3 == Driver IQK == -+ else { -+ if ( ! pDM_Odm->RFCalibrateInfo.bIQKInProgress) { -+ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = TRUE; -+ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ -+ pDM_Odm->RFCalibrateInfo.IQK_StartTime = ODM_GetCurrentTime( pDM_Odm); -+ phy_IQCalibrate_8821A(pDM_Odm); -+ pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime = ODM_GetProgressingTime( pDM_Odm, pDM_Odm->RFCalibrateInfo.IQK_StartTime); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK ProgressingTime = %lld ms\n", pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime)); -+ -+ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; -+ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== Return the IQK CMD, because the IQK in Progress ==\n")); -+ } -+ } -+ -+} -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ce.h linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ce.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_ce.h 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDM_IQK_8821A_H__ -+#define __PHYDM_IQK_8821A_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+/*---------------------------End Define Parameters-------------------------------*/ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+void -+DoIQK_8821A( -+ PVOID pDM_VOID, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ); -+void -+PHY_IQCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN BOOLEAN bReCovery -+); -+#else -+VOID -+phy_IQCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ); -+#endif -+#endif // #ifndef __PHYDM_IQK_8821A_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_win.c linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_win.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_win.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_win.c 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,875 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+#define cal_num_8821A 3 -+#define MACBB_REG_NUM_8821A 8 -+#define AFE_REG_NUM_8821A 4 -+#define RF_REG_NUM_8821A 3 -+/*---------------------------Define Local Constant---------------------------*/ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+void DoIQK_8821A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ) -+{ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; -+ PHY_IQCalibrate_8821A(pDM_Odm, FALSE); -+} -+#endif -+void _IQK_RX_FillIQC_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN unsigned int RX_X, -+ IN unsigned int RX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, RX_X>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, (RX_Y>>1) & 0x000003ff); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1, RX_Y>>1)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc10 = %x ====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xc10))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_TX_FillIQC_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN unsigned int TX_X, -+ IN unsigned int TX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x00000080); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x20040000); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, TX_Y); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, TX_X); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X, TX_Y)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xcd4 = %x;;0xccc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xcd4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xccc, 0x000007ff))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+void _IQK_BackupMacBB_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //save MACBB default value -+ for (i = 0; i < MACBB_NUM; i++){ -+ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupMacBB Success!!!!\n")); -+} -+ -+void _IQK_BackupRF_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte RFA_backup, -+ IN pu4Byte RFB_backup, -+ IN pu4Byte Backup_RF_REG, -+ IN u4Byte RF_NUM -+ ) -+{ -+ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save RF Parameters -+ for (i = 0; i < RF_NUM; i++){ -+ RFA_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG[i], bMaskDWord); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupRF Success!!!!\n")); -+} -+ -+void _IQK_BackupAFE_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ AFE_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_AFE_REG[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupAFE Success!!!!\n")); -+} -+ -+void _IQK_RestoreMacBB_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte MACBB_backup, -+ IN pu4Byte Backup_MACBB_REG, -+ IN u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload MacBB Parameters -+ for (i = 0; i < MACBB_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreMacBB Success!!!!\n")); -+} -+ -+void _IQK_RestoreRF_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN pu4Byte Backup_RF_REG, -+ IN pu4Byte RF_backup, -+ IN u4Byte RF_REG_NUM -+ ) -+{ -+ u4Byte i; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ for (i = 0; i < RF_REG_NUM; i++) -+ ODM_SetRFReg(pDM_Odm, Path, Backup_RF_REG[i], bRFRegOffsetMask, RF_backup[i]); -+ -+ switch(Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path A Success!!!!\n")); -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+void _IQK_RestoreAFE_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu4Byte AFE_backup, -+ IN pu4Byte Backup_AFE_REG, -+ IN u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_AFE_REG[i], AFE_backup[i]); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x00000080); -+ ODM_Write4Byte(pDM_Odm, 0xc94, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x20040000); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreAFE Success!!!!\n")); -+} -+ -+void _IQK_ConfigureMAC_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ // ========MAC register setting======== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_Write1Byte(pDM_Odm, 0x522, 0x3f); -+ ODM_SetBBReg(pDM_Odm, 0x550, BIT(11)|BIT(3), 0x0); -+ ODM_Write1Byte(pDM_Odm, 0x808, 0x00); // RX ante off -+ ODM_SetBBReg(pDM_Odm, 0x838, 0xf, 0xc); // CCA off -+ ODM_Write1Byte(pDM_Odm, 0xa07, 0xf); // CCK RX Path off -+} -+ -+void _IQK_Tx_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path -+ ) -+{ -+ u4Byte TX_fail, RX_fail, delay_count, IQK_ready, cal_retry, cal = 0; -+ int TX_X = 0, TX_Y = 0, RX_X = 0, RX_Y = 0, TX_Average = 0, RX_Average = 0, RXIQK_Loop = 0, RX_X_temp = 0, RX_Y_temp = 0; -+ int TX_X0[cal_num_8821A], TX_Y0[cal_num_8821A], RX_X0[2][cal_num_8821A], RX_Y0[2][cal_num_8821A]; -+ BOOLEAN TX0IQKOK = FALSE, RX0IQKOK = FALSE; -+ BOOLEAN VDF_enable = FALSE; -+ int i, k, VDF_Y[3], VDF_X[3], Tx_dt[3], ii, dx = 0, dy = 0, TX_finish = 0, RX_finish1 = 0, RX_finish2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BandWidth = %d, SupportInterface = %d, ExtPA = %d, ExtPA5G = %d\n", *pDM_Odm->pBandWidth, pDM_Odm->SupportInterface, pDM_Odm->ExtPA, pDM_Odm->ExtPA5G)); -+ if (*pDM_Odm->pBandWidth == 2){ -+ VDF_enable = TRUE; -+ } -+ -+ while (cal < cal_num_8821A){ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ //Path-A LOK -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // ========Path-A AFE all on======== -+ // Port 0 DAC/ADC on -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); -+ -+ ODM_SetBBReg(pDM_Odm, 0xc00, 0xf, 0x4);// hardware 3-wire off -+ -+ // LOK Setting -+ //====== LOK ====== -+ // 1. DAC/ADC sampling rate (160 MHz) -+ ODM_SetBBReg(pDM_Odm, 0xc5c, BIT(26)|BIT(25)|BIT(24), 0x7); -+ -+ // 2. LoK RF Setting (at BW = 20M) -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80002); -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x3); // BW 20M -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0003f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xf3fc3); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA5G) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f4); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28163e96); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, Path, 0x8, 0xffc00)); // Load LOK -+ switch (*pDM_Odm->pBandWidth) -+ { -+ case 1: -+ { -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x1); -+ } -+ break; -+ case 2: -+ { -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x0); -+ } -+ break; -+ default: -+ break; -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ // 3. TX RF Setting -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0003f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xf3fc3); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA5G) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403e3); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x40163e96); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x00163e96); -+ -+ if (VDF_enable == 1){ -+ for (k = 0;k <= 2; k++){ -+ switch (k){ -+ case 0: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); -+ } -+ break; -+ case 1: -+ { -+ ODM_SetBBReg(pDM_Odm, 0xc80, BIT(28), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xc84, BIT(28), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); -+ } -+ break; -+ case 2: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); -+ Tx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); -+ Tx_dt[cal] = ((16*Tx_dt[cal])*10000/15708); -+ Tx_dt[cal] = (Tx_dt[cal] >> 1 )+(Tx_dt[cal] & BIT(0)); -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c20);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xce8, 0x3fff0000, Tx_dt[cal] & 0x00003fff); -+ } -+ break; -+ } -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready) || (delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10){ -+ break; -+ } -+ } -+ } -+ } -+ if (k == 3){ -+ TX_X0[cal] = VDF_X[k-1] ; -+ TX_Y0[cal] = VDF_Y[k-1]; -+ } -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready) || (delay_count>20)) { -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ TX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ TX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ } -+ -+ if (TX0IQKOK == FALSE) -+ break; // TXK fail, Don't do RXK -+ -+ //====== RX IQK ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // 1. RX RF Setting -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0002f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfffbb); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d8); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X0[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y0[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); -+ -+ if (pDM_Odm->SupportInterface == 1){ -+ RXIQK_Loop = 2; // for 2% fail; -+ } -+ else{ -+ RXIQK_Loop = 1; -+ } -+ for(i = 0; i < RXIQK_Loop; i++){ -+ if (pDM_Odm->SupportInterface == 1) -+ if(i == 0) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161100); //Good -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28160d00); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28160d00); -+ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] N SI/PI ϥv iqk_dpk module -+ -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); -+ if (RX_fail == 0){ -+ /* -+ DbgPrint("====== RXIQK (%d) ======", i); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x05000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ DbgPrint("reg1 = %d, reg2 = %d", reg1, reg2); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x07000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+ */ -+ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ RX_X0[i][cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ RX_Y0[i][cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ RX0IQKOK = TRUE; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); -+ RX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ -+ } -+ } -+ else{ -+ RX0IQKOK = FALSE; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ } -+ -+ if (TX0IQKOK) -+ TX_Average++; -+ if (RX0IQKOK) -+ RX_Average++; -+ } -+ break; -+ default: -+ break; -+ } -+ cal++; -+ } -+ // FillIQK Result -+ switch (Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_A =======\n")); -+ if (TX_Average == 0) -+ break; -+ -+ for (i = 0; i < TX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X0[%d] = %x ;; TX_Y0[%d] = %x\n", i, (TX_X0[i])>>21&0x000007ff, i, (TX_Y0[i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < TX_Average; i++){ -+ for (ii = i+1; ii >21) - (TX_X0[ii]>>21); -+ if (dx < 3 && dx > -3){ -+ dy = (TX_Y0[i]>>21) - (TX_Y0[ii]>>21); -+ if (dy < 3 && dy > -3){ -+ TX_X = ((TX_X0[i]>>21) + (TX_X0[ii]>>21))/2; -+ TX_Y = ((TX_Y0[i]>>21) + (TX_Y0[ii]>>21))/2; -+ TX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (TX_finish == 1) -+ break; -+ } -+ -+ if (TX_finish == 1){ -+ _IQK_TX_FillIQC_8821A(pDM_Odm, Path, TX_X, TX_Y); -+ } -+ else{ -+ _IQK_TX_FillIQC_8821A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ -+ if (RX_Average == 0) -+ break; -+ -+ for (i = 0; i < RX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[0][%d] = %x ;; RX_Y0[0][%d] = %x\n", i, (RX_X0[0][i])>>21&0x000007ff, i, (RX_Y0[0][i])>>21&0x000007ff)); -+ if (RXIQK_Loop == 2) -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[1][%d] = %x ;; RX_Y0[1][%d] = %x\n", i, (RX_X0[1][i])>>21&0x000007ff, i, (RX_Y0[1][i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < RX_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_X0[0][ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_Y0[0][i]>>21) - (RX_Y0[0][ii]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_X_temp = ((RX_X0[0][i]>>21) + (RX_X0[0][ii]>>21))/2; -+ RX_Y_temp = ((RX_Y0[0][i]>>21) + (RX_Y0[0][ii]>>21))/2; -+ RX_finish1 = 1; -+ break; -+ } -+ } -+ } -+ if (RX_finish1 == 1){ -+ RX_X = RX_X_temp; -+ RX_Y = RX_Y_temp; -+ break; -+ } -+ } -+ if(RXIQK_Loop == 2){ -+ for (i = 0; i < RX_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_X0[1][ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_Y0[1][i]>>21) - (RX_Y0[1][ii]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_X = ((RX_X0[1][i]>>21) + (RX_X0[1][ii]>>21))/2; -+ RX_Y = ((RX_Y0[1][i]>>21) + (RX_Y0[1][ii]>>21))/2; -+ RX_finish2 = 1; -+ break; -+ } -+ } -+ } -+ if (RX_finish2 == 1) -+ break; -+ } -+ if(RX_finish1 && RX_finish2){ -+ RX_X = (RX_X+RX_X_temp)/2; -+ RX_Y = (RX_Y+RX_Y_temp)/2; -+ } -+ } -+ if (RX_finish1 || RX_finish2){ -+ _IQK_RX_FillIQC_8821A(pDM_Odm, Path, RX_X, RX_Y); -+ } -+ else{ -+ _IQK_RX_FillIQC_8821A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+VOID -+phy_IQCalibrate_By_FW_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+ u1Byte IQKcmd[3] = {*pDM_Odm->pChannel, 0x0, 0x0}; -+ u1Byte Buf1 = 0x0; -+ u1Byte Buf2 = 0x0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("pChannel: %d \n", *pDM_Odm->pChannel)); -+ -+ -+//Byte 2, Bit 4 ~ Bit 5 : BandType -+ if(*pDM_Odm->pBandType) -+ Buf1 = 0x2<<4; -+ else -+ Buf1 = 0x1<<4; -+ -+//Byte 2, Bit 0 ~ Bit 3 : Bandwidth -+ if(*pDM_Odm->pBandWidth == ODM_BW20M) -+ Buf2 = 0x1; -+ else if(*pDM_Odm->pBandWidth == ODM_BW40M) -+ Buf2 = 0x1<<1; -+ else if(*pDM_Odm->pBandWidth == ODM_BW80M) -+ Buf2 = 0x1<<2; -+ else -+ Buf2 = 0x1<<3; -+ -+ IQKcmd[1] = Buf1 | Buf2; -+ IQKcmd[2] = pDM_Odm->ExtPA5G | pDM_Odm->ExtLNA5G<<1; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== FW IQK Start ==\n")); -+ pDM_Odm->RFCalibrateInfo.IQK_StartTime = 0; -+ pDM_Odm->RFCalibrateInfo.IQK_StartTime = ODM_GetCurrentTime( pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== StartTime: %lld\n", pDM_Odm->RFCalibrateInfo.IQK_StartTime)); -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_IQ_CALIBRATION, 3, IQKcmd); -+ -+ -+} -+#endif -+ -+VOID -+phy_IQCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte MACBB_backup[MACBB_REG_NUM_8821A], AFE_backup[AFE_REG_NUM_8821A], RFA_backup[RF_REG_NUM_8821A], RFB_backup[RF_REG_NUM_8821A]; -+ u4Byte Backup_MACBB_REG[MACBB_REG_NUM_8821A] = {0x520, 0x550, 0x808, 0xa04, 0x90c, 0xc00, 0x838, 0x82c}; -+ u4Byte Backup_AFE_REG[AFE_REG_NUM_8821A] = {0xc5c, 0xc60, 0xc64, 0xc68}; -+ u4Byte Backup_RF_REG[RF_REG_NUM_8821A] = {0x65, 0x8f, 0x0}; -+ -+ _IQK_BackupMacBB_8821A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM_8821A); -+ _IQK_BackupAFE_8821A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM_8821A); -+ _IQK_BackupRF_8821A(pDM_Odm, RFA_backup, RFB_backup, Backup_RF_REG, RF_REG_NUM_8821A); -+ -+ _IQK_ConfigureMAC_8821A(pDM_Odm); -+ _IQK_Tx_8821A(pDM_Odm, ODM_RF_PATH_A); -+ -+ _IQK_RestoreRF_8821A(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG, RFA_backup, RF_REG_NUM_8821A); -+ _IQK_RestoreAFE_8821A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM_8821A); -+ _IQK_RestoreMacBB_8821A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM_8821A); -+} -+ -+VOID -+PHY_ResetIQKResult_8821A( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x100); -+} -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+VOID -+PHY_IQCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN BOOLEAN bReCovery -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ u4Byte counter = 0; -+ #endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN ) -+ if (ODM_CheckPowerStatus(pAdapter) == FALSE) -+ return; -+#endif -+ -+ if (pDM_Odm->mp_mode){ //(MP_DRIVER == 1) -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #if (MP_DRIVER == 1) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+ if( pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) -+ return; -+ #endif -+ #else// (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ if( pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) -+ return; -+ #endif -+ -+ } -+ pDM_Odm->IQKFWOffload = 0; -+ -+ //3 == FW IQK == -+ if(pDM_Odm->IQKFWOffload) -+ { -+ if ( ! pDM_Odm->RFCalibrateInfo.bIQKInProgress) -+ { -+ ODM_AcquireSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = TRUE; -+ ODM_ReleaseSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ phy_IQCalibrate_By_FW_8821A(pDM_Odm); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ for(counter = 0; counter < 10; counter++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== FW IQK IN PROGRESS == #%d\n", counter)); -+ ODM_delay_ms(50); -+ if ( ! pDM_Odm->RFCalibrateInfo.bIQKInProgress) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== FW IQK RETURN FROM WAITING ==\n")); -+ break; -+ } -+ } -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ rtl8812_iqk_wait(pAdapter, 500); -+ #endif -+ if (pDM_Odm->RFCalibrateInfo.bIQKInProgress) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== FW IQK TIMEOUT (Still in progress after 500ms) ==\n")); -+ ODM_AcquireSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; -+ ODM_ReleaseSpinLock( pDM_Odm, RT_IQK_SPINLOCK); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== Return the IQK CMD, because the IQK in Progress ==\n")); -+ } -+ } -+ //3 == Driver IQK == -+ else { -+ if ( ! pDM_Odm->RFCalibrateInfo.bIQKInProgress) { -+ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = TRUE; -+ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ -+ pDM_Odm->RFCalibrateInfo.IQK_StartTime = ODM_GetCurrentTime( pDM_Odm); -+ phy_IQCalibrate_8821A(pDM_Odm); -+ pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime = ODM_GetProgressingTime( pDM_Odm, pDM_Odm->RFCalibrateInfo.IQK_StartTime); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK ProgressingTime = %lld ms\n", pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime)); -+ -+ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; -+ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== Return the IQK CMD, because the IQK in Progress ==\n")); -+ } -+ } -+ -+} -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_win.h linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_win.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_win.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_iqk_8821a_win.h 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDM_IQK_8821A_H__ -+#define __PHYDM_IQK_8821A_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+/*---------------------------End Define Parameters-------------------------------*/ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+void -+DoIQK_8821A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ); -+void -+PHY_IQCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN BOOLEAN bReCovery -+); -+#else -+VOID -+phy_IQCalibrate_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ); -+#endif -+#endif // #ifndef __PHYDM_IQK_8821A_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_regconfig8821a.c linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_regconfig8821a.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_regconfig8821a.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_regconfig8821a.c 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,220 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8821A_SUPPORT == 1) -+ -+void -+odm_ConfigRFReg_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data, -+ IN ODM_RF_RADIO_PATH_E RF_PATH, -+ IN u4Byte RegAddr -+ ) -+{ -+ if(Addr == 0xfe || Addr == 0xffe) -+ { -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ } -+ else if (Addr == 0xfd) -+ { -+ ODM_delay_ms(5); -+ } -+ else if (Addr == 0xfc) -+ { -+ ODM_delay_ms(1); -+ } -+ else if (Addr == 0xfb) -+ { -+ ODM_delay_us(50); -+ } -+ else if (Addr == 0xfa) -+ { -+ ODM_delay_us(5); -+ } -+ else if (Addr == 0xf9) -+ { -+ ODM_delay_us(1); -+ } -+ else -+ { -+ ODM_SetRFReg(pDM_Odm, RF_PATH, RegAddr, bRFRegOffsetMask, Data); -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ } -+} -+ -+ -+void -+odm_ConfigRF_RadioA_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data -+ ) -+{ -+ u4Byte content = 0x1000; // RF_Content: radioa_txt -+ u4Byte maskforPhySet= (u4Byte)(content&0xE000); -+ -+ odm_ConfigRFReg_8821A(pDM_Odm, Addr, Data, ODM_RF_PATH_A, Addr|maskforPhySet); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioA] %08X %08X\n", Addr, Data)); -+} -+ -+// 8821 no RF B -+/* -+void -+odm_ConfigRF_RadioB_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data -+ ) -+{ -+ u4Byte content = 0x1001; // RF_Content: radiob_txt -+ u4Byte maskforPhySet= (u4Byte)(content&0xE000); -+ -+ odm_ConfigRFReg_8812A(pDM_Odm, Addr, Data, ODM_RF_PATH_B, Addr|maskforPhySet); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioB] %08X %08X\n", Addr, Data)); -+ -+} -+*/ -+ -+void -+odm_ConfigMAC_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u1Byte Data -+ ) -+{ -+ ODM_Write1Byte(pDM_Odm, Addr, Data); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigMACWithHeaderFile: [MAC_REG] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_AGC_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ) -+{ -+ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [AGC_TAB] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_PHY_REG_PG_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Band, -+ IN u4Byte RfPath, -+ IN u4Byte TxNum, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ) -+{ -+ if (Addr == 0xfe) -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ else if (Addr == 0xfd) -+ ODM_delay_ms(5); -+ else if (Addr == 0xfc) -+ ODM_delay_ms(1); -+ else if (Addr == 0xfb) -+ ODM_delay_us(50); -+ else if (Addr == 0xfa) -+ ODM_delay_us(5); -+ else if (Addr == 0xf9) -+ ODM_delay_us(1); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X %08X\n", Addr, Bitmask, Data)); -+ -+#if !(DM_ODM_SUPPORT_TYPE&ODM_AP) -+ PHY_StoreTxPowerByRate(pDM_Odm->Adapter, Band, RfPath, TxNum, Addr, Bitmask, Data); -+#endif -+ -+} -+ -+void -+odm_ConfigBB_PHY_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ) -+{ -+ if (Addr == 0xfe) -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ else if (Addr == 0xfd) -+ ODM_delay_ms(5); -+ else if (Addr == 0xfc) -+ ODM_delay_ms(1); -+ else if (Addr == 0xfb) -+ ODM_delay_us(50); -+ else if (Addr == 0xfa) -+ ODM_delay_us(5); -+ else if (Addr == 0xf9) -+ ODM_delay_us(1); -+ else if (Addr == 0xa24) -+ pDM_Odm->RFCalibrateInfo.RegA24 = Data; -+ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); -+ -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_TXPWR_LMT_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte Regulation, -+ IN pu1Byte Band, -+ IN pu1Byte Bandwidth, -+ IN pu1Byte RateSection, -+ IN pu1Byte RfPath, -+ IN pu1Byte Channel, -+ IN pu1Byte PowerLimit -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PHY_SetTxPowerLimit(pDM_Odm, Regulation, Band, -+ Bandwidth, RateSection, RfPath, Channel, PowerLimit); -+#endif -+} -+ -+#endif /* #if (RTL8821A_SUPPORT == 1)*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_regconfig8821a.h linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_regconfig8821a.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_regconfig8821a.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_regconfig8821a.h 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,96 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_ODM_REGCONFIG_H_8821A -+#define __INC_ODM_REGCONFIG_H_8821A -+ -+#if (RTL8821A_SUPPORT == 1) -+ -+void -+odm_ConfigRFReg_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data, -+ IN ODM_RF_RADIO_PATH_E RF_PATH, -+ IN u4Byte RegAddr -+ ); -+ -+void -+odm_ConfigRF_RadioA_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigRF_RadioB_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigMAC_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u1Byte Data -+ ); -+ -+void -+odm_ConfigBB_AGC_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_PHY_REG_PG_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Band, -+ IN u4Byte RfPath, -+ IN u4Byte TxNum, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_PHY_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_TXPWR_LMT_8821A( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte Regulation, -+ IN pu1Byte Band, -+ IN pu1Byte Bandwidth, -+ IN pu1Byte RateSection, -+ IN pu1Byte RfPath, -+ IN pu1Byte Channel, -+ IN pu1Byte PowerLimit -+ ); -+ -+#endif -+#endif // end of SUPPORT -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_rtl8821a.c linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_rtl8821a.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_rtl8821a.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_rtl8821a.c 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,78 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+ -+#include "../phydm_precomp.h" -+ -+#if (RTL8821A_SUPPORT == 1) -+ -+VOID -+phydm_set_ext_band_switch_8821A( -+ IN PVOID pDM_VOID, -+ IN u4Byte band -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /*Output Pin Settings*/ -+ ODM_SetMACReg(pDM_Odm, 0x4C, BIT23, 0); /*select DPDT_P and DPDT_N as output pin*/ -+ ODM_SetMACReg(pDM_Odm, 0x4C, BIT24, 1); /*by WLAN control*/ -+ -+ ODM_SetBBReg(pDM_Odm, 0xCB4, 0xF, 7); /*DPDT_P = 1b'0*/ -+ ODM_SetBBReg(pDM_Odm, 0xCB4, 0xF0, 7); /*DPDT_N = 1b'0*/ -+ -+ if (band == ODM_BAND_2_4G) { -+ ODM_SetBBReg(pDM_Odm, 0xCB4, (BIT29|BIT28), 1); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A set band switch = 2b'01\n")); -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0xCB4, BIT29|BIT28, 2); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A set band switch = 2b'10\n")); -+ } -+} -+ -+VOID -+odm_DynamicTryStateAgg_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ if((pDM_Odm->SupportICType == ODM_RTL8821) && (pDM_Odm->SupportInterface == ODM_ITRF_USB)) -+ { -+ if(pDM_Odm->RSSI_Min > 25) -+ ODM_Write1Byte(pDM_Odm, 0x4CF, 0x02); -+ else if(pDM_Odm->RSSI_Min < 20) -+ ODM_Write1Byte(pDM_Odm, 0x4CF, 0x00); -+ } -+} -+ -+VOID -+odm_HWSetting_8821A( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ odm_DynamicTryStateAgg_8821A(pDM_Odm); -+} -+ -+#endif //#if (RTL8821A_SUPPORT == 1) -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_rtl8821a.h linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_rtl8821a.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_rtl8821a.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/phydm_rtl8821a.h 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,35 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __ODM_RTL8821A_H__ -+#define __ODM_RTL8821A_H__ -+ -+VOID -+phydm_set_ext_band_switch_8821A( -+ IN PVOID pDM_VOID, -+ IN u4Byte band -+); -+ -+VOID -+odm_HWSetting_8821A( -+ IN PDM_ODM_T pDM_Odm -+); -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/version_rtl8821a.h linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/version_rtl8821a.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/rtl8821a/version_rtl8821a.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/rtl8821a/version_rtl8821a.h 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,5 @@ -+/*RTL8821A PHY Parameters*/ -+#define SVN_COMMIT_VERSION_8821A 56 -+#define RELEASE_DATE_8821A 20150622 -+#define COMMIT_BY_8821A "BB_YUCHEN" -+#define RELEASE_VERSION_8821A 54 -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/halcomtxbf.c linux/3rdparty/rtl8812au/hal/phydm/txbf/halcomtxbf.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/halcomtxbf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/halcomtxbf.c 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,551 @@ -+//============================================================ -+// Description: -+// -+// This file is for TXBF mechanism -+// -+//============================================================ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+/*Beamforming halcomtxbf API create by YuChen 2015/05*/ -+ -+VOID -+halComTxbf_beamformInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ HalTxbf8822B_Init(pDM_Odm); -+} -+ -+/*Only used for MU BFer Entry when get GID management frame (self is as MU STA)*/ -+VOID -+halComTxbf_ConfigGtab( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ HalTxbf8822B_ConfigGtab(pDM_Odm); -+} -+ -+VOID -+phydm_beamformSetSoundingEnter( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_EnterWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_EnterWorkItem)); -+#else -+ halComTxbf_EnterWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetSoundingLeave( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_LeaveWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_LeaveWorkItem)); -+#else -+ halComTxbf_LeaveWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetSoundingRate( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_RateWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_RateWorkItem)); -+#else -+ halComTxbf_RateWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetSoundingStatus( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_StatusWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_StatusWorkItem)); -+#else -+ halComTxbf_StatusWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetSoundingFwNdpa( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (*pDM_Odm->pbFwDwRsvdPageInProgress) -+ ODM_SetTimer(pDM_Odm, &(pTxbfInfo->Txbf_FwNdpaTimer), 5); -+ else -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_FwNdpaWorkItem)); -+#else -+ halComTxbf_FwNdpaWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetSoundingClk( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_ClkWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_ClkWorkItem)); -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PADAPTER padapter = pDM_Odm->Adapter; -+ -+ rtw_run_in_thread_cmd(padapter, halComTxbf_ClkWorkItemCallback, padapter); -+#else -+ halComTxbf_ClkWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetResetTxPath( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_ResetTxPathWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_ResetTxPathWorkItem)); -+#else -+ halComTxbf_ResetTxPathWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetGetTxRate( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_GetTxRateWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_GetTxRateWorkItem)); -+#else -+ halComTxbf_GetTxRateWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+halComTxbf_EnterWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ u1Byte Idx = pTxbfInfo->TXBFIdx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) -+ HalTxbfJaguar_Enter(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8192E) -+ HalTxbf8192E_Enter(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_Enter(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8821B) -+ HalTxbf8821B_Enter(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ HalTxbf8822B_Enter(pDM_Odm, Idx); -+} -+ -+VOID -+halComTxbf_LeaveWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ u1Byte Idx = pTxbfInfo->TXBFIdx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) -+ HalTxbfJaguar_Leave(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8192E) -+ HalTxbf8192E_Leave(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_Leave(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8821B) -+ HalTxbf8821B_Leave(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ HalTxbf8822B_Leave(pDM_Odm, Idx); -+} -+ -+ -+VOID -+halComTxbf_FwNdpaWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ u1Byte Idx = pTxbfInfo->NdpaIdx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) -+ HalTxbfJaguar_FwTxBF(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8192E) -+ HalTxbf8192E_FwTxBF(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_FwTxBF(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8821B) -+ HalTxbf8821B_FwTxBF(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ HalTxbf8822B_FwTxBF(pDM_Odm, Idx); -+} -+ -+VOID -+halComTxbf_ClkWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8812) -+ HalTxbfJaguar_Clk_8812A(pDM_Odm); -+} -+ -+ -+ -+VOID -+halComTxbf_RateWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ u1Byte BW = pTxbfInfo->BW; -+ u1Byte Rate = pTxbfInfo->Rate; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8812) -+ HalTxbf8812A_setNDPArate(pDM_Odm, BW, Rate); -+ else if (pDM_Odm->SupportICType & ODM_RTL8192E) -+ HalTxbf8192E_setNDPArate(pDM_Odm, BW, Rate); -+ else if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_setNDPArate(pDM_Odm, BW, Rate); -+ -+} -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+halComTxbf_FwNdpaTimerCallback( -+ IN PRT_TIMER pTimer -+ ) -+{ -+ -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (*pDM_Odm->pbFwDwRsvdPageInProgress) -+ ODM_SetTimer(pDM_Odm, &(pTxbfInfo->Txbf_FwNdpaTimer), 5); -+ else -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_FwNdpaWorkItem)); -+} -+#endif -+ -+ -+VOID -+halComTxbf_StatusWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ u1Byte Idx = pTxbfInfo->TXBFIdx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) -+ HalTxbfJaguar_Status(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8192E) -+ HalTxbf8192E_Status(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_Status(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8821B) -+ HalTxbf8821B_Status(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ HalTxbf8822B_Status(pDM_Odm, Idx); -+} -+ -+VOID -+halComTxbf_ResetTxPathWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ u1Byte Idx = pTxbfInfo->TXBFIdx; -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_ResetTxPath(pDM_Odm, Idx); -+ -+} -+ -+VOID -+halComTxbf_GetTxRateWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_GetTxRate(pDM_Odm); -+} -+ -+ -+BOOLEAN -+HalComTxbf_Set( -+ IN PVOID pDM_VOID, -+ IN u1Byte setType, -+ IN PVOID pInBuf -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PBOOLEAN pBoolean=(PBOOLEAN)pInBuf; -+ pu1Byte pU1Tmp=(pu1Byte)pInBuf; -+ pu4Byte pU4Tmp=(pu4Byte)pInBuf; -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] setType = 0x%X\n", __func__, setType)); -+ -+ switch(setType){ -+ case TXBF_SET_SOUNDING_ENTER: -+ pTxbfInfo->TXBFIdx = *pU1Tmp; -+ phydm_beamformSetSoundingEnter(pDM_Odm); -+ break; -+ -+ case TXBF_SET_SOUNDING_LEAVE: -+ pTxbfInfo->TXBFIdx = *pU1Tmp; -+ phydm_beamformSetSoundingLeave(pDM_Odm); -+ break; -+ -+ case TXBF_SET_SOUNDING_RATE: -+ pTxbfInfo->BW = pU1Tmp[0]; -+ pTxbfInfo->Rate = pU1Tmp[1]; -+ phydm_beamformSetSoundingRate(pDM_Odm); -+ break; -+ -+ case TXBF_SET_SOUNDING_STATUS: -+ pTxbfInfo->TXBFIdx = *pU1Tmp; -+ phydm_beamformSetSoundingStatus(pDM_Odm); -+ break; -+ -+ case TXBF_SET_SOUNDING_FW_NDPA: -+ pTxbfInfo->NdpaIdx = *pU1Tmp; -+ phydm_beamformSetSoundingFwNdpa(pDM_Odm); -+ break; -+ -+ case TXBF_SET_SOUNDING_CLK: -+ phydm_beamformSetSoundingClk(pDM_Odm); -+ break; -+ -+ case TXBF_SET_TX_PATH_RESET: -+ pTxbfInfo->TXBFIdx = *pU1Tmp; -+ phydm_beamformSetResetTxPath(pDM_Odm); -+ break; -+ -+ case TXBF_SET_GET_TX_RATE: -+ phydm_beamformSetGetTxRate(pDM_Odm); -+ break; -+ -+ } -+ -+ return TRUE; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+BOOLEAN -+HalComTxbf_Get( -+ IN PADAPTER Adapter, -+ IN u1Byte getType, -+ OUT PVOID pOutBuf -+ ) -+{ -+ PHAL_DATA_TYPE pHalData=GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ PBOOLEAN pBoolean=(PBOOLEAN)pOutBuf; -+ ps4Byte pS4Tmp=(ps4Byte)pOutBuf; -+ pu4Byte pU4Tmp=(pu4Byte)pOutBuf; -+ pu1Byte pU1Tmp=(pu1Byte)pOutBuf; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (getType == TXBF_GET_EXPLICIT_BEAMFORMEE) { -+ if (IS_HARDWARE_TYPE_OLDER_THAN_8812A(Adapter)) -+ *pBoolean = FALSE; -+ else if (/*IS_HARDWARE_TYPE_8822B(Adapter) ||*/ -+ IS_HARDWARE_TYPE_8821B(Adapter) || -+ IS_HARDWARE_TYPE_8192E(Adapter) || -+ IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(Adapter)) -+ *pBoolean = TRUE; -+ else -+ *pBoolean = FALSE; -+ } else if (getType == TXBF_GET_EXPLICIT_BEAMFORMER) { -+ if (IS_HARDWARE_TYPE_OLDER_THAN_8812A(Adapter)) -+ *pBoolean = FALSE; -+ else if (/*IS_HARDWARE_TYPE_8822B(Adapter) ||*/ -+ IS_HARDWARE_TYPE_8821B(Adapter) || -+ IS_HARDWARE_TYPE_8192E(Adapter) || -+ IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(Adapter)) { -+ if(pHalData->RF_Type == RF_2T2R || pHalData->RF_Type == RF_3T3R) -+ *pBoolean = TRUE; -+ else -+ *pBoolean = FALSE; -+ } else -+ *pBoolean = FALSE; -+ } else if (getType == TXBF_GET_MU_MIMO_STA) { -+#if (RTL8822B_SUPPORT == 1) -+ if (/*pDM_Odm->SupportICType & (ODM_RTL8822B)*/ -+ IS_HARDWARE_TYPE_8822B(Adapter)) -+ *pBoolean = TRUE; -+ else -+#endif -+ *pBoolean = FALSE; -+ -+ -+ } else if (getType == TXBF_GET_MU_MIMO_AP) { -+#if (RTL8822B_SUPPORT == 1) -+ if (/*pDM_Odm->SupportICType & (ODM_RTL8822B)*/ -+ IS_HARDWARE_TYPE_8822B(Adapter)) -+ *pBoolean = TRUE; -+ else -+#endif -+ *pBoolean = FALSE; -+ } -+ -+ return TRUE; -+} -+#endif -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/halcomtxbf.h linux/3rdparty/rtl8812au/hal/phydm/txbf/halcomtxbf.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/halcomtxbf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/halcomtxbf.h 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,181 @@ -+#ifndef __HAL_COM_TXBF_H__ -+#define __HAL_COM_TXBF_H__ -+ -+/* -+typedef BOOLEAN -+(*TXBF_GET)( -+ IN PVOID pAdapter, -+ IN u1Byte getType, -+ OUT PVOID pOutBuf -+ ); -+ -+typedef BOOLEAN -+(*TXBF_SET)( -+ IN PVOID pAdapter, -+ IN u1Byte setType, -+ OUT PVOID pInBuf -+ ); -+*/ -+#define TxBF_Nr(a, b) ((a > b) ? (b) : (a)) -+ -+typedef enum _TXBF_SET_TYPE{ -+ TXBF_SET_SOUNDING_ENTER, -+ TXBF_SET_SOUNDING_LEAVE, -+ TXBF_SET_SOUNDING_RATE, -+ TXBF_SET_SOUNDING_STATUS, -+ TXBF_SET_SOUNDING_FW_NDPA, -+ TXBF_SET_SOUNDING_CLK, -+ TXBF_SET_TX_PATH_RESET, -+ TXBF_SET_GET_TX_RATE -+}TXBF_SET_TYPE,*PTXBF_SET_TYPE; -+ -+ -+typedef enum _TXBF_GET_TYPE{ -+ TXBF_GET_EXPLICIT_BEAMFORMEE, -+ TXBF_GET_EXPLICIT_BEAMFORMER, -+ TXBF_GET_MU_MIMO_STA, -+ TXBF_GET_MU_MIMO_AP -+}TXBF_GET_TYPE,*PTXBF_GET_TYPE; -+ -+ -+ -+//2 HAL TXBF related -+typedef struct _HAL_TXBF_INFO { -+ u1Byte TXBFIdx; -+ u1Byte NdpaIdx; -+ u1Byte BW; -+ u1Byte Rate; -+ -+ RT_TIMER Txbf_FwNdpaTimer; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_WORK_ITEM Txbf_EnterWorkItem; -+ RT_WORK_ITEM Txbf_LeaveWorkItem; -+ RT_WORK_ITEM Txbf_FwNdpaWorkItem; -+ RT_WORK_ITEM Txbf_ClkWorkItem; -+ RT_WORK_ITEM Txbf_StatusWorkItem; -+ RT_WORK_ITEM Txbf_RateWorkItem; -+ RT_WORK_ITEM Txbf_ResetTxPathWorkItem; -+ RT_WORK_ITEM Txbf_GetTxRateWorkItem; -+#endif -+ -+} HAL_TXBF_INFO, *PHAL_TXBF_INFO; -+ -+#if (BEAMFORMING_SUPPORT == 1) -+ -+VOID -+halComTxbf_beamformInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+halComTxbf_ConfigGtab( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+halComTxbf_EnterWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_LeaveWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_FwNdpaWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_ClkWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_ResetTxPathWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_GetTxRateWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_RateWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_FwNdpaTimerCallback( -+ IN PRT_TIMER pTimer -+ ); -+ -+VOID -+halComTxbf_StatusWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+BOOLEAN -+HalComTxbf_Set( -+ IN PVOID pDM_VOID, -+ IN u1Byte setType, -+ IN PVOID pInBuf -+ ); -+ -+BOOLEAN -+HalComTxbf_Get( -+ IN PADAPTER Adapter, -+ IN u1Byte getType, -+ OUT PVOID pOutBuf -+ ); -+ -+#else -+#define halComTxbf_beamformInit(pDM_VOID) NULL -+#define halComTxbf_ConfigGtab(pDM_VOID) NULL -+#define halComTxbf_EnterWorkItemCallback(_Adapter) NULL -+#define halComTxbf_LeaveWorkItemCallback(_Adapter) NULL -+#define halComTxbf_FwNdpaWorkItemCallback(_Adapter) NULL -+#define halComTxbf_ClkWorkItemCallback(_Adapter) NULL -+#define halComTxbf_RateWorkItemCallback(_Adapter) NULL -+#define halComTxbf_FwNdpaTimerCallback(_Adapter) NULL -+#define halComTxbf_StatusWorkItemCallback(_Adapter) NULL -+#define HalComTxbf_Get(_Adapter, _getType, _pOutBuf) -+ -+#endif -+ -+#endif // #ifndef __HAL_COM_TXBF_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8192e.c linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8192e.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8192e.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8192e.c 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,392 @@ -+//============================================================ -+// Description: -+// -+// This file is for 8192E TXBF mechanism -+// -+//============================================================ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (RTL8192E_SUPPORT == 1) -+ -+VOID -+HalTxbf8192E_setNDPArate( -+ IN PVOID pDM_VOID, -+ IN u1Byte BW, -+ IN u1Byte Rate -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8192E, (Rate << 2 | BW)); -+ -+} -+ -+VOID -+halTxbf8192E_RfMode( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORMING_INFO pBeamInfo -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ BOOLEAN bSelfBeamformer = FALSE; -+ BOOLEAN bSelfBeamformee = FALSE; -+ BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->RFType == ODM_1T1R) -+ return; -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); /*RF Mode table write enable*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WE_LUT, 0x80000, 0x1); /*RF Mode table write enable*/ -+ -+ if (pBeamInfo->beamformee_su_cnt > 0) { -+ /*Path_A*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode 0x30=0x18000*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0x77fc2); /*Enable TXIQGEN in RX mode*/ -+ /*Path_B*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0x77fc2); /*Enable TXIQGEN in RX mode*/ -+ } else { -+ /*Path_A*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0x77f82); /*Disable TXIQGEN in RX mode*/ -+ /*Path_B*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0x77f82); /*Disable TXIQGEN in RX mode*/ -+ } -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x0); /*RF Mode table write disable*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WE_LUT, 0x80000, 0x0); /*RF Mode table write disable*/ -+ -+ if (pBeamInfo->beamformee_su_cnt > 0) { -+ ODM_SetBBReg(pDM_Odm, rFPGA1_TxInfo, bMaskDWord, 0x83321333); -+ ODM_SetBBReg(pDM_Odm, rCCK0_AFESetting, bMaskByte3, 0xc1); -+ } else -+ ODM_SetBBReg(pDM_Odm, rFPGA1_TxInfo, bMaskDWord, 0x81121313); -+} -+ -+ -+ -+VOID -+halTxbf8192E_FwTxBFCmd( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx, Period0 = 0, Period1 = 0; -+ u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u1Byte u1TxBFParm[3] = {0}; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ if (pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (Idx == 0) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) -+ PageNum0 = 0xFE; -+ else -+ PageNum0 = 0xFF; //stop sounding -+ Period0 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } else if (Idx == 1) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) -+ PageNum1 = 0xFE; -+ else -+ PageNum1 = 0xFF; //stop sounding -+ Period1 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } -+ } -+ } -+ -+ u1TxBFParm[0] = PageNum0; -+ u1TxBFParm[1] = PageNum1; -+ u1TxBFParm[2] = (Period1 << 4) | Period0; -+ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_TXBF, 3, u1TxBFParm); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, -+ ("[%s] PageNum0 = %d Period0 = %d, PageNum1 = %d Period1 %d\n", __func__, PageNum0, Period0, PageNum1, Period1)); -+} -+ -+ -+VOID -+halTxbf8192E_DownloadNDPA( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte u1bTmp = 0, tmpReg422 = 0, Head_Page; -+ u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; -+ BOOLEAN bSendBeacon = FALSE; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ u1Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; -+ /*default reseved 1 page for the IC type which is undefined.*/ -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *pDM_Odm->pbFwDwRsvdPageInProgress = TRUE; -+#endif -+ if (Idx == 0) -+ Head_Page = 0xFE; -+ else -+ Head_Page = 0xFE; -+ -+ Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu1Byte)&TxPageBndy); -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8192E+1); -+ ODM_Write1Byte(pDM_Odm, REG_CR_8192E+1, (u1bTmp | BIT0)); -+ -+ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ tmpReg422 = ODM_Read1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8192E+2); -+ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8192E+2, tmpReg422 & (~BIT6)); -+ -+ if (tmpReg422 & BIT6) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_WARNING, ("%s There is an Adapter is sending beacon.\n", __func__)); -+ bSendBeacon = TRUE; -+ } -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xFE/0xFD NDPA Head for TXDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+1, Head_Page); -+ -+ do { -+ /*Clear beacon valid check bit.*/ -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2); -+ ODM_Write1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2, (BcnValidReg | BIT0)); -+ -+ // download NDPA rsvd page. -+ Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); -+ -+#if(DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_MGQ_TXBD_NUM_8192E+3); -+ count = 0; -+ while ((count < 20) && (u1bTmp & BIT4)) { -+ count++; -+ ODM_delay_us(10); -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_MGQ_TXBD_NUM_8192E+3); -+ } -+ ODM_Write1Byte(pDM_Odm, REG_MGQ_TXBD_NUM_8192E+3, u1bTmp | BIT4); -+#endif -+ -+ /*check rsvd page download OK.*/ -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2); -+ count = 0; -+ while (!(BcnValidReg & BIT0) && count < 20) { -+ count++; -+ ODM_delay_us(10); -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2); -+ } -+ DLBcnCount++; -+ } while (!(BcnValidReg & BIT0) && DLBcnCount < 5); -+ -+ if (!(BcnValidReg & BIT0)) -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_WARNING, ("%s Download RSVD page failed!\n", __func__)); -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xF9 Beacon Head for TXDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+1, TxPageBndy); -+ -+ /*To make sure that if there exists an adapter which would like to send beacon.*/ -+ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ -+ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause*/ -+ /*the beacon cannot be sent by HW.*/ -+ /*2010.06.23. Added by tynli.*/ -+ if (bSendBeacon) -+ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8192E+2, tmpReg422); -+ -+ /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ -+ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8192E+1); -+ ODM_Write1Byte(pDM_Odm, REG_CR_8192E+1, (u1bTmp & (~BIT0))); -+ -+ pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *pDM_Odm->pbFwDwRsvdPageInProgress = FALSE; -+#endif -+} -+ -+ -+VOID -+HalTxbf8192E_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte BFerBFeeIdx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ u1Byte BFerIdx = (BFerBFeeIdx & 0xF0) >> 4; -+ u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); -+ u4Byte CSI_Param; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ u2Byte STAid = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ halTxbf8192E_RfMode(pDM_Odm, pBeamformingInfo); -+ -+ if (pDM_Odm->RFType == ODM_2T2R) -+ ODM_Write4Byte(pDM_Odm, 0xd80, 0x00000000); /*Nc =2*/ -+ -+ if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { -+ BeamformerEntry = pBeamformingInfo->BeamformerEntry[BFerIdx]; -+ -+ /*Sounding protocol control*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8192E, 0xCB); -+ -+ /*MAC address/Partial AID of Beamformer*/ -+ if (BFerIdx == 0) { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8192E+i), BeamformerEntry.MacAddr[i]); -+ } else { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER1_INFO_8192E+i), BeamformerEntry.MacAddr[i]); -+ } -+ -+ /*CSI report parameters of Beamformer Default use Nc = 2*/ -+ CSI_Param = 0x03090309; -+ -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8192E, CSI_Param); -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8192E, CSI_Param); -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8192E, CSI_Param); -+ -+ /*Timeout value for MAC to leave NDP_RX_standby_state (60 us, Test chip) (80 us, MP chip)*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8192E+3, 0x50); -+ -+ } -+ -+ if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[BFeeIdx]; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ STAid = BeamformeeEntry.MacId; -+ else -+ STAid = BeamformeeEntry.P_AID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s], STAid=0x%X\n", __func__, STAid)); -+ -+ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ -+ if (BFeeIdx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E, STAid); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8192E+3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8192E+3) | BIT4 | BIT6 | BIT7); -+ } else -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E+2, STAid | BIT12 | BIT14 | BIT15); -+ -+ /*CSI report parameters of Beamformee*/ -+ if (BFeeIdx == 0) { -+ /*Get BIT24 & BIT25*/ -+ u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+3) & 0x3; -+ -+ ODM_Write1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+3, tmp | 0x60); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E, STAid | BIT9); -+ } else { -+ /*Set BIT25*/ -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2, STAid | 0xE200); -+ } -+ phydm_Beamforming_Notify(pDM_Odm); -+ -+ } -+} -+ -+ -+VOID -+HalTxbf8192E_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ halTxbf8192E_RfMode(pDM_Odm, pBeamInfo); -+ -+ /* Clear P_AID of Beamformee -+ * Clear MAC addresss of Beamformer -+ * Clear Associated Bfmee Sel -+ */ -+ if (pBeamInfo->BeamformCap == BEAMFORMING_CAP_NONE) -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8192E, 0xC8); -+ -+ if (Idx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E, 0); -+ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8192E, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8192E+4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E, 0); -+ } else { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E+2, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8192E+2) & 0xF000); -+ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8192E, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8192E+4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2, ODM_Read2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2) & 0x60); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Idx %d\n", __func__, Idx)); -+} -+ -+ -+VOID -+HalTxbf8192E_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte BeamCtrlVal; -+ u4Byte BeamCtrlReg; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformEntry = pBeamInfo->BeamformeeEntry[Idx]; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ BeamCtrlVal = BeamformEntry.MacId; -+ else -+ BeamCtrlVal = BeamformEntry.P_AID; -+ -+ if (Idx == 0) -+ BeamCtrlReg = REG_TXBF_CTRL_8192E; -+ else { -+ BeamCtrlReg = REG_TXBF_CTRL_8192E+2; -+ BeamCtrlVal |= BIT12 | BIT14 | BIT15; -+ } -+ -+ if (BeamformEntry.BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (BeamformEntry.SoundBW == CHANNEL_WIDTH_20) -+ BeamCtrlVal |= BIT9; -+ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_40) -+ BeamCtrlVal |= BIT10; -+ } else -+ BeamCtrlVal &= ~(BIT9 | BIT10 | BIT11); -+ -+ ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Idx %d BeamCtrlReg %x BeamCtrlVal %x\n", __func__, Idx, BeamCtrlReg, BeamCtrlVal)); -+} -+ -+ -+VOID -+HalTxbf8192E_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ halTxbf8192E_DownloadNDPA(pDM_Odm, Idx); -+ -+ halTxbf8192E_FwTxBFCmd(pDM_Odm); -+} -+ -+#endif /* #if (RTL8192E_SUPPORT == 1)*/ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8192e.h linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8192e.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8192e.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8192e.h 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,52 @@ -+#ifndef __HAL_TXBF_8192E_H__ -+#define __HAL_TXBF_8192E_H__ -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (RTL8192E_SUPPORT == 1) -+VOID -+HalTxbf8192E_setNDPArate( -+ IN PVOID pDM_VOID, -+ IN u1Byte BW, -+ IN u1Byte Rate -+); -+ -+VOID -+HalTxbf8192E_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8192E_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8192E_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8192E_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+#else -+ -+#define HalTxbf8192E_setNDPArate(pDM_VOID, BW, Rate) -+#define HalTxbf8192E_Enter(pDM_VOID, Idx) -+#define HalTxbf8192E_Leave(pDM_VOID, Idx) -+#define HalTxbf8192E_Status(pDM_VOID, Idx) -+#define HalTxbf8192E_FwTxBF(pDM_VOID, Idx) -+ -+#endif -+ -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8814a.c linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8814a.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8814a.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8814a.c 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,653 @@ -+//============================================================ -+// Description: -+// -+// This file is for 8814A TXBF mechanism -+// -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (RTL8814A_SUPPORT == 1) -+ -+VOID -+HalTxbf8814A_setNDPArate( -+ IN PVOID pDM_VOID, -+ IN u1Byte BW, -+ IN u1Byte Rate -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8814A, BW); -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_RATE_8814A, (u1Byte) Rate); -+ -+} -+ -+#define PHYDM_MEMORY_MAP_BUF_READ 0x8000 -+#define PHYDM_CTRL_INFO_PAGE 0x660 -+ -+VOID -+phydm_DataRate_8814A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte macId, -+ OUT pu4Byte data, -+ IN u1Byte dataLen -+ ) -+{ -+ u1Byte i = 0; -+ u2Byte XReadDataAddr = 0; -+ -+ ODM_Write2Byte(pDM_Odm, REG_PKTBUF_DBG_CTRL_8814A, PHYDM_CTRL_INFO_PAGE); -+ XReadDataAddr = PHYDM_MEMORY_MAP_BUF_READ + macId*32; /*Ctrl Info: 32Bytes for each macid(n)*/ -+ -+ if ((XReadDataAddr < PHYDM_MEMORY_MAP_BUF_READ) || (XReadDataAddr > 0x8FFF)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("XReadDataAddr(0x%x) is not correct!\n", XReadDataAddr)); -+ return; -+ } -+ -+ /* Read data */ -+ for (i = 0; i < dataLen; i++) -+ *(data+i) = ODM_Read2Byte(pDM_Odm, XReadDataAddr+i); -+ -+} -+ -+VOID -+HalTxbf8814A_GetTxRate( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pEntry; -+ u4Byte TxRptData = 0; -+ u1Byte DataRate = 0xFF; -+ -+ pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); -+ -+ phydm_DataRate_8814A(pDM_Odm, (u1Byte)pEntry->MacId, &TxRptData, 1); -+ DataRate = (u1Byte)TxRptData; -+ DataRate &= bMask7bits; /*Bit7 indicates SGI*/ -+ -+ pDM_Odm->TxBfDataRate = DataRate; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] pDM_Odm->TxBfDataRate = 0x%x\n", __func__, pDM_Odm->TxBfDataRate)); -+} -+ -+VOID -+HalTxbf8814A_ResetTxPath( -+ IN PVOID pDM_VOID, -+ IN u1Byte idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ u1Byte Nr_index = 0; -+ -+ if (idx < BEAMFORMEE_ENTRY_NUM) -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[idx]; -+ else -+ return; -+ -+ if ((pDM_Odm->LastUSBHub) != (*pDM_Odm->HubUsbMode)) { -+ Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), BeamformeeEntry.CompSteeringNumofBFer); -+ -+ if (idx == 0) { -+ switch (Nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskL3Bytes, 0x936); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x9360); -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskByte3 | bMaskByte2HighNibble, 0x93e); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskDWord, 0x93e93e0); -+ break; -+ -+ default: /*Nr>3, same as Case 3*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskByte3 | bMaskByte2HighNibble, 0x93f); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskDWord, 0x93f93f0); -+ break; -+ } -+ } else { -+ switch (Nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskByte3 | bMaskByte2HighNibble, 0x936); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x9360); -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskByte3 | bMaskByte2HighNibble, 0x93e); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskDWord, 0x93e93e0); -+ break; -+ -+ default: /*Nr>3, same as Case 3*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskByte3 | bMaskByte2HighNibble, 0x93f); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskDWord, 0x93f93f0); -+ break; -+ } -+ } -+ -+ pDM_Odm->LastUSBHub = *pDM_Odm->HubUsbMode; -+ } else -+ return; -+#endif -+} -+ -+ -+u1Byte -+halTxbf8814A_GetNtx( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Ntx = 0; -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { -+ if (*pDM_Odm->HubUsbMode == 2) {/*USB3.0*/ -+ if (pDM_Odm->RFType == ODM_4T4R) -+ Ntx = 3; -+ else if (pDM_Odm->RFType == ODM_3T3R) -+ Ntx = 2; -+ else -+ Ntx = 1; -+ } else if (*pDM_Odm->HubUsbMode == 1) /*USB 2.0 always 2Tx*/ -+ Ntx = 1; -+ else -+ Ntx = 1; -+ } else -+#endif -+ { -+ if (pDM_Odm->RFType == ODM_4T4R) -+ Ntx = 3; -+ else if (pDM_Odm->RFType == ODM_3T3R) -+ Ntx = 2; -+ else -+ Ntx = 1; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Ntx = %d\n", __func__, Ntx)); -+ return Ntx; -+} -+ -+u1Byte -+halTxbf8814A_GetNrx( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Nrx = 0; -+ -+ if (pDM_Odm->RFType == ODM_4T4R) -+ Nrx = 3; -+ else if (pDM_Odm->RFType == ODM_3T3R) -+ Nrx = 2; -+ else if (pDM_Odm->RFType == ODM_2T2R) -+ Nrx = 1; -+ else if (pDM_Odm->RFType == ODM_2T3R) -+ Nrx = 2; -+ else if (pDM_Odm->RFType == ODM_2T4R) -+ Nrx = 3; -+ else if (pDM_Odm->RFType == ODM_1T1R) -+ Nrx = 0; -+ else if (pDM_Odm->RFType == ODM_1T2R) -+ Nrx = 1; -+ else -+ Nrx = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Nrx = %d\n", __func__, Nrx)); -+ return Nrx; -+} -+ -+VOID -+halTxbf8814A_RfMode( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORMING_INFO pBeamformingInfo, -+ IN u1Byte idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i, Nr_index = 0; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ -+ if (idx < BEAMFORMEE_ENTRY_NUM) -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[idx]; -+ else -+ return; -+ -+ Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), BeamformeeEntry.CompSteeringNumofBFer); -+ -+ if (pDM_Odm->RFType == ODM_1T1R) -+ return; -+ -+ for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) { -+ ODM_SetRFReg(pDM_Odm, i, RF_WeLut_Jaguar, 0x80000, 0x1); -+ /*RF Mode table write enable*/ -+ } -+ -+ if (pBeamformingInfo->beamformee_su_cnt > 0) { -+ for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) { -+ ODM_SetRFReg(pDM_Odm, i, RF_ModeTableAddr, 0xfffff, 0x18000); -+ /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, i, RF_ModeTableData0, 0xfffff, 0xBE77F); -+ /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, i, RF_ModeTableData1, 0xfffff, 0x226BF); -+ /*Enable TXIQGEN in RX mode*/ -+ } -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF); -+ /*Enable TXIQGEN in RX mode*/ -+ } -+ -+ for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) { -+ ODM_SetRFReg(pDM_Odm, i, RF_WeLut_Jaguar, 0x80000, 0x0); -+ /*RF Mode table write disable*/ -+ } -+ -+ if (pBeamformingInfo->beamformee_su_cnt > 0) { -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ pDM_Odm->LastUSBHub = *pDM_Odm->HubUsbMode; -+#endif -+ -+ /*for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1, BIT28 | BIT29, 0x2); /*enable BB TxBF ant mapping register*/ -+ -+ if (idx == 0) { -+ switch (Nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskL3Bytes, 0x936); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x9360); -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskByte3 | bMaskByte2HighNibble, 0x93e); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskDWord, 0x93e93e0); -+ break; -+ -+ default: /*Nr>3, same as Case 3*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskByte3 | bMaskByte2HighNibble, 0x93f); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskDWord, 0x93f93f0); -+ break; -+ } -+ } else { -+ switch (Nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskByte3 | bMaskByte2HighNibble, 0x936); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x9360); -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskByte3 | bMaskByte2HighNibble, 0x93e); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskDWord, 0x93e93e0); -+ break; -+ -+ default: /*Nr>3, same as Case 3*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskByte3 | bMaskByte2HighNibble, 0x93f); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskDWord, 0x93f93f0); -+ break; -+ } -+ } -+ } -+ -+ if ((pBeamformingInfo->beamformee_su_cnt == 0) && (pBeamformingInfo->beamformer_su_cnt == 0)) { -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, bMaskByte3 | bMaskByte2HighNibble, 0x932); /*set TxPath selection for 8814a BFer bug refine*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskDWord, 0x93e9360); -+ } -+} -+#if 0 -+VOID -+halTxbf8814A_DownloadNDPA( -+ IN PADAPTER Adapter, -+ IN u1Byte Idx -+) -+{ -+ u1Byte u1bTmp = 0, tmpReg422 = 0; -+ u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; -+ u2Byte Head_Page = 0x7FE; -+ BOOLEAN bSendBeacon = FALSE; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u2Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8814A; /*default reseved 1 page for the IC type which is undefined.*/ -+ PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ -+ pHalData->bFwDwRsvdPageInProgress = TRUE; -+ Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu2Byte)&TxPageBndy); -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR_8814A + 1); -+ PlatformEFIOWrite1Byte(Adapter, REG_CR_8814A + 1, (u1bTmp | BIT0)); -+ -+ -+ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ tmpReg422 = PlatformEFIORead1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A + 2); -+ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A + 2, tmpReg422 & (~BIT6)); -+ -+ if (tmpReg422 & BIT6) { -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("SetBeamformDownloadNDPA_8814A(): There is an Adapter is sending beacon.\n")); -+ bSendBeacon = TRUE; -+ } -+ -+ /*0x204[11:0] Beacon Head for TXDMA*/ -+ PlatformEFIOWrite2Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A, Head_Page); -+ -+ do { -+ /*Clear beacon valid check bit.*/ -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A + 1); -+ PlatformEFIOWrite1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A + 1, (BcnValidReg | BIT7)); -+ -+ /*download NDPA rsvd page.*/ -+ if (pBeamEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) -+ Beamforming_SendVHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->AID, pBeamEntry->SoundBW, BEACON_QUEUE); -+ else -+ Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); -+ -+ /*check rsvd page download OK.*/ -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A + 1); -+ count = 0; -+ while (!(BcnValidReg & BIT7) && count < 20) { -+ count++; -+ delay_us(10); -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A + 2); -+ } -+ DLBcnCount++; -+ } while (!(BcnValidReg & BIT7) && DLBcnCount < 5); -+ -+ if (!(BcnValidReg & BIT0)) -+ RT_DISP(FBEAM, FBEAM_ERROR, ("%s Download RSVD page failed!\n", __func__)); -+ -+ /*0x204[11:0] Beacon Head for TXDMA*/ -+ PlatformEFIOWrite2Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A, TxPageBndy); -+ -+ /*To make sure that if there exists an adapter which would like to send beacon.*/ -+ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ -+ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ -+ /*the beacon cannot be sent by HW.*/ -+ /*2010.06.23. Added by tynli.*/ -+ if (bSendBeacon) -+ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A + 2, tmpReg422); -+ -+ /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ -+ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR_8814A + 1); -+ PlatformEFIOWrite1Byte(Adapter, REG_CR_8814A + 1, (u1bTmp & (~BIT0))); -+ -+ pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+ -+ pHalData->bFwDwRsvdPageInProgress = FALSE; -+} -+ -+VOID -+halTxbf8814A_FwTxBFCmd( -+ IN PADAPTER Adapter -+) -+{ -+ u1Byte Idx, Period = 0; -+ u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u1Byte u1TxBFParm[3] = {0}; -+ -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); -+ -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bUsed && pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) { -+ PageNum0 = 0xFE; -+ PageNum1 = 0x07; -+ Period = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } else if (PageNum0 == 0xFF) { -+ PageNum0 = 0xFF; /*stop sounding*/ -+ PageNum1 = 0x0F; -+ } -+ } -+ } -+ -+ u1TxBFParm[0] = PageNum0; -+ u1TxBFParm[1] = PageNum1; -+ u1TxBFParm[2] = Period; -+ FillH2CCmd(Adapter, PHYDM_H2C_TXBF, 3, u1TxBFParm); -+ -+ RT_DISP(FBEAM, FBEAM_FUN, ("@%s End, PageNum0 = 0x%x, PageNum1 = 0x%x Period = %d", __func__, PageNum0, PageNum1, Period)); -+} -+#endif -+VOID -+HalTxbf8814A_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte BFerBFeeIdx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ u1Byte BFerIdx = (BFerBFeeIdx & 0xF0) >> 4; -+ u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ u2Byte STAid = 0, CSI_Param = 0; -+ u1Byte Nc_index = 0, Nr_index = 0, grouping = 0, codebookinfo = 0, coefficientsize = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BFerIdx=%d, BFeeIdx=%d\n", __func__, BFerIdx, BFeeIdx)); -+ ODM_SetMACReg(pDM_Odm, REG_SND_PTCL_CTRL_8814A, bMaskByte1 | bMaskByte2, 0x0202); -+ -+ if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { -+ BeamformerEntry = pBeamformingInfo->BeamformerEntry[BFerIdx]; -+ /*Sounding protocol control*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8814A, 0xDB); -+ -+ /*MAC address/Partial AID of Beamformer*/ -+ if (BFerIdx == 0) { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8814A + i), BeamformerEntry.MacAddr[i]); -+ } else { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER1_INFO_8814A + i), BeamformerEntry.MacAddr[i]); -+ } -+ -+ /*CSI report parameters of Beamformer*/ -+ Nc_index = halTxbf8814A_GetNrx(pDM_Odm); /*for 8814A Nrx = 3(4 Ant), min=0(1 Ant)*/ -+ Nr_index = BeamformerEntry.NumofSoundingDim; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so Nr_index don't care*/ -+ -+ grouping = 0; -+ -+ /*for ac = 1, for n = 3*/ -+ if (BeamformerEntry.BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU) -+ codebookinfo = 1; -+ else if (BeamformerEntry.BeamformEntryCap & BEAMFORMEE_CAP_HT_EXPLICIT) -+ codebookinfo = 3; -+ -+ coefficientsize = 3; -+ -+ CSI_Param = (u2Byte)((coefficientsize << 10) | (codebookinfo << 8) | (grouping << 6) | (Nr_index << 3) | (Nc_index)); -+ -+ if (BFerIdx == 0) -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A, CSI_Param); -+ else -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A + 2, CSI_Param); -+ /*ndp_rx_standby_timer, 8814 need > 0x56, suggest from Dvaid*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8814A + 3, 0x40); -+ -+ } -+ -+ if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[BFeeIdx]; -+ -+ halTxbf8814A_RfMode(pDM_Odm, pBeamformingInfo, BFeeIdx); -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ STAid = BeamformeeEntry.MacId; -+ else -+ STAid = BeamformeeEntry.P_AID; -+ -+ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ -+ if (BFeeIdx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A, STAid); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3) | BIT4 | BIT6 | BIT7); -+ } else -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 2, STAid | BIT14 | BIT15 | BIT12); -+ -+ /*CSI report parameters of Beamformee*/ -+ if (BFeeIdx == 0) { -+ /*Get BIT24 & BIT25*/ -+ u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3) & 0x3; -+ -+ ODM_Write1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3, tmp | 0x60); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A, STAid | BIT9); -+ } else -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, STAid | 0xE200); /*Set BIT25*/ -+ -+ phydm_Beamforming_Notify(pDM_Odm); -+ } -+ -+} -+ -+ -+VOID -+HalTxbf8814A_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ -+ if (Idx < BEAMFORMER_ENTRY_NUM) { -+ BeamformerEntry = pBeamformingInfo->BeamformerEntry[Idx]; -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[Idx]; -+ } else -+ return; -+ -+ /*Clear P_AID of Beamformee*/ -+ /*Clear MAC address of Beamformer*/ -+ /*Clear Associated Bfmee Sel*/ -+ -+ if (BeamformerEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8814A, 0xD8); -+ if (Idx == 0) { -+ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8814A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8814A + 4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A, 0); -+ } else { -+ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8814A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8814A + 4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A + 2, 0); -+ } -+ } -+ -+ if (BeamformeeEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ halTxbf8814A_RfMode(pDM_Odm, pBeamformingInfo, Idx); -+ if (Idx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A, 0x0); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3) | BIT4 | BIT6 | BIT7); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A, 0); -+ } else { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 2, 0x0 | BIT14 | BIT15 | BIT12); -+ -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, ODM_Read2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2) & 0x60); -+ } -+ } -+} -+ -+VOID -+HalTxbf8814A_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte BeamCtrlVal, tmpVal; -+ u4Byte BeamCtrlReg; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformEntry; -+ -+ if (Idx < BEAMFORMEE_ENTRY_NUM) -+ BeamformEntry = pBeamformingInfo->BeamformeeEntry[Idx]; -+ else -+ return; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ BeamCtrlVal = BeamformEntry.MacId; -+ else -+ BeamCtrlVal = BeamformEntry.P_AID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, BeamformEntry.BeamformEntryState = %d", __func__, BeamformEntry.BeamformEntryState)); -+ -+ if (Idx == 0) -+ BeamCtrlReg = REG_TXBF_CTRL_8814A; -+ else { -+ BeamCtrlReg = REG_TXBF_CTRL_8814A + 2; -+ BeamCtrlVal |= BIT12 | BIT14 | BIT15; -+ } -+ -+ if (BeamformEntry.BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (BeamformEntry.SoundBW == CHANNEL_WIDTH_20) -+ BeamCtrlVal |= BIT9; -+ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_40) -+ BeamCtrlVal |= (BIT9 | BIT10); -+ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_80) -+ BeamCtrlVal |= (BIT9 | BIT10 | BIT11); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, Don't apply Vmatrix", __func__)); -+ BeamCtrlVal &= ~(BIT9 | BIT10 | BIT11); -+ } -+ -+ ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); -+ /*disable NDP packet use beamforming */ -+ tmpVal = ODM_Read2Byte(pDM_Odm, REG_TXBF_CTRL_8814A); -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A, tmpVal | BIT15); -+ -+} -+ -+ -+ -+ -+ -+VOID -+HalTxbf8814A_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+#if 0 -+ PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ -+ if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ halTxbf8814A_DownloadNDPA(Adapter, Idx); -+ -+ halTxbf8814A_FwTxBFCmd(Adapter); -+#endif -+} -+ -+#endif /* (RTL8814A_SUPPORT == 1)*/ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8814a.h linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8814a.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8814a.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8814a.h 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,70 @@ -+#ifndef __HAL_TXBF_8814A_H__ -+#define __HAL_TXBF_8814A_H__ -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (RTL8814A_SUPPORT == 1) -+VOID -+HalTxbf8814A_setNDPArate( -+ IN PVOID pDM_VOID, -+ IN u1Byte BW, -+ IN u1Byte Rate -+); -+ -+u1Byte -+halTxbf8814A_GetNtx( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+HalTxbf8814A_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8814A_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8814A_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+VOID -+HalTxbf8814A_ResetTxPath( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8814A_GetTxRate( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+HalTxbf8814A_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+#else -+ -+#define HalTxbf8814A_setNDPArate(pDM_VOID, BW, Rate) -+#define halTxbf8814A_GetNtx(pDM_VOID) 0 -+#define HalTxbf8814A_Enter(pDM_VOID, Idx) -+#define HalTxbf8814A_Leave(pDM_VOID, Idx) -+#define HalTxbf8814A_Status(pDM_VOID, Idx) -+#define HalTxbf8814A_ResetTxPath(pDM_VOID, Idx) -+#define HalTxbf8814A_GetTxRate(pDM_VOID) -+#define HalTxbf8814A_FwTxBF(pDM_VOID, Idx) -+#endif -+ -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8821b.c linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8821b.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8821b.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8821b.c 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,400 @@ -+/*============================================================*/ -+/*Description:*/ -+/*This file is for 8812/8821/8811 TXBF mechanism*/ -+/*============================================================*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (RTL8821B_SUPPORT == 1) -+ -+VOID -+halTxbf8821B_RfMode( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORMING_INFO pBeamInfo -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->RFType == ODM_1T1R) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] set TxIQGen\n", __func__)); -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000, 0x1); /*RF Mode table write enable*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000, 0x1); /*RF Mode table write enable*/ -+ -+ if (pBeamInfo->beamformee_su_cnt > 0) { -+ /*Path_A*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ -+ /*Path_B*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ -+ } else { -+ /*Path_A*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ -+ /*Path_B*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ -+ } -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000, 0x0); /*RF Mode table write disable*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000, 0x0); /*RF Mode table write disable*/ -+ -+ if (pBeamInfo->beamformee_su_cnt > 0) -+ ODM_SetBBReg(pDM_Odm, rTxPath_Jaguar, bMaskByte1, 0x33); -+ else -+ ODM_SetBBReg(pDM_Odm, rTxPath_Jaguar, bMaskByte1, 0x11); -+} -+ -+#if 0 -+VOID -+halTxbf8821B_DownloadNDPA( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte Idx -+) -+{ -+ u1Byte u1bTmp = 0, tmpReg422 = 0, Head_Page; -+ u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; -+ BOOLEAN bSendBeacon = FALSE; -+ u1Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; /*default reseved 1 page for the IC type which is undefined.*/ -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDM_Odm->Adapter); -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ pHalData->bFwDwRsvdPageInProgress = TRUE; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (Idx == 0) -+ Head_Page = 0xFE; -+ else -+ Head_Page = 0xFE; -+ -+ Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu1Byte)&TxPageBndy); -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8821B + 1); -+ ODM_Write1Byte(pDM_Odm, REG_CR_8821B + 1, (u1bTmp | BIT0)); -+ -+ -+ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ tmpReg422 = ODM_Read1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8821B + 2); -+ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8821B + 2, tmpReg422 & (~BIT6)); -+ -+ if (tmpReg422 & BIT6) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("SetBeamformDownloadNDPA_8812(): There is an Adapter is sending beacon.\n")); -+ bSendBeacon = TRUE; -+ } -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 1, Head_Page); -+ -+ do { -+ /*Clear beacon valid check bit.*/ -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); -+ ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 2, (BcnValidReg | BIT0)); -+ -+ /*download NDPA rsvd page.*/ -+ if (pBeamEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) -+ Beamforming_SendVHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->AID, pBeamEntry->SoundBW, BEACON_QUEUE); -+ else -+ Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); -+ -+ /*check rsvd page download OK.*/ -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); -+ count = 0; -+ while (!(BcnValidReg & BIT0) && count < 20) { -+ count++; -+ ODM_delay_ms(10); -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); -+ } -+ DLBcnCount++; -+ } while (!(BcnValidReg & BIT0) && DLBcnCount < 5); -+ -+ if (!(BcnValidReg & BIT0)) -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Download RSVD page failed!\n", __func__)); -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 1, TxPageBndy); -+ -+ /*To make sure that if there exists an adapter which would like to send beacon.*/ -+ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ -+ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause*/ -+ /*the beacon cannot be sent by HW.*/ -+ /*2010.06.23. Added by tynli.*/ -+ if (bSendBeacon) -+ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8821B + 2, tmpReg422); -+ -+ /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ -+ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8821B + 1); -+ ODM_Write1Byte(pDM_Odm, REG_CR_8821B + 1, (u1bTmp & (~BIT0))); -+ -+ pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+ -+ pHalData->bFwDwRsvdPageInProgress = FALSE; -+} -+ -+ -+VOID -+halTxbf8821B_FwTxBFCmd( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u1Byte Idx, Period0 = 0, Period1 = 0; -+ u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u1Byte u1TxBFParm[3] = {0}; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ /*Modified by David*/ -+ if (pBeamInfo->BeamformeeEntry[Idx].bUsed && pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (Idx == 0) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) -+ PageNum0 = 0xFE; -+ else -+ PageNum0 = 0xFF; /*stop sounding*/ -+ Period0 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } else if (Idx == 1) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) -+ PageNum1 = 0xFE; -+ else -+ PageNum1 = 0xFF; /*stop sounding*/ -+ Period1 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } -+ } -+ } -+ -+ u1TxBFParm[0] = PageNum0; -+ u1TxBFParm[1] = PageNum1; -+ u1TxBFParm[2] = (Period1 << 4) | Period0; -+ FillH2CCmd(Adapter, PHYDM_H2C_TXBF, 3, u1TxBFParm); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, -+ ("[%s] PageNum0 = %d Period0 = %d, PageNum1 = %d Period1 %d\n", __func__, PageNum0, Period0, PageNum1, Period1)); -+} -+ -+#endif -+VOID -+HalTxbf8821B_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte BFerBFeeIdx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ u1Byte BFerIdx = (BFerBFeeIdx & 0xF0) >> 4; -+ u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); -+ u4Byte CSI_Param; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ u2Byte STAid = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Start!\n", __func__)); -+ -+ halTxbf8821B_RfMode(pDM_Odm, pBeamformingInfo); -+ -+ if (pDM_Odm->RFType == ODM_2T2R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CSI_CONTENT_VALUE, bMaskDWord, 0x00000000); /*Nc =2*/ -+ else -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CSI_CONTENT_VALUE, bMaskDWord, 0x01081008); /*Nc =1*/ -+ -+ if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { -+ BeamformerEntry = pBeamformingInfo->BeamformerEntry[BFerIdx]; -+ -+ /*Sounding protocol control*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8821B, 0xCB); -+ -+ /*MAC address/Partial AID of Beamformer*/ -+ if (BFerIdx == 0) { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_BFMER0_INFO_8812A + i), BeamformerEntry.MacAddr[i]); -+ /*CSI report use legacy ofdm so don't need to fill P_AID. */ -+ /*PlatformEFIOWrite2Byte(Adapter, REG_BFMER0_INFO_8821B+6, BeamformEntry.P_AID); */ -+ } else { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_BFMER1_INFO_8812A + i), BeamformerEntry.MacAddr[i]); -+ /*CSI report use legacy ofdm so don't need to fill P_AID.*/ -+ /*PlatformEFIOWrite2Byte(Adapter, REG_BFMER1_INFO_8821B+6, BeamformEntry.P_AID);*/ -+ } -+ -+ /*CSI report parameters of Beamformee*/ -+ if (BeamformerEntry.BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU) { -+ if (pDM_Odm->RFType == ODM_2T2R) -+ CSI_Param = 0x01090109; -+ else -+ CSI_Param = 0x01080108; -+ } else { -+ if (pDM_Odm->RFType == ODM_2T2R) -+ CSI_Param = 0x03090309; -+ else -+ CSI_Param = 0x03080308; -+ } -+ -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8821B, CSI_Param); -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8821B, CSI_Param); -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8821B, CSI_Param); -+ -+ /*Timeout value for MAC to leave NDP_RX_standby_state (60 us, Test chip) (80 us, MP chip)*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8821B + 3, 0x50); -+ } -+ -+ -+ if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[BFeeIdx]; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ STAid = BeamformeeEntry.MacId; -+ else -+ STAid = BeamformeeEntry.P_AID; -+ -+ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ -+ if (BFeeIdx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8821B, STAid); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8821B + 3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8821B + 3) | BIT4 | BIT6 | BIT7); -+ } else -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8821B + 2, STAid | BIT12 | BIT14 | BIT15); -+ -+ /*CSI report parameters of Beamformee*/ -+ if (BFeeIdx == 0) { -+ /*Get BIT24 & BIT25*/ -+ u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 3) & 0x3; -+ -+ ODM_Write1Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 3, tmp | 0x60); -+ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A, STAid | BIT9); -+ } else { -+ /*Set BIT25*/ -+ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2, STAid | 0xE200); -+ } -+ phydm_Beamforming_Notify(pDM_Odm); -+ } -+} -+ -+ -+VOID -+HalTxbf8821B_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ -+ if (Idx < BEAMFORMER_ENTRY_NUM) { -+ BeamformerEntry = pBeamformingInfo->BeamformerEntry[Idx]; -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[Idx]; -+ } else -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Start!, IDx = %d\n", __func__, Idx)); -+ -+ /*Clear P_AID of Beamformee*/ -+ /*Clear MAC address of Beamformer*/ -+ /*Clear Associated Bfmee Sel*/ -+ -+ if (BeamformerEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8821B, 0xC8); -+ if (Idx == 0) { -+ ODM_Write4Byte(pDM_Odm, REG_BFMER0_INFO_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_BFMER0_INFO_8812A + 4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8821B, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8821B, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8821B, 0); -+ } else { -+ ODM_Write4Byte(pDM_Odm, REG_BFMER1_INFO_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_BFMER1_INFO_8812A + 4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8821B, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8821B, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8821B, 0); -+ } -+ } -+ -+ if (BeamformeeEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ halTxbf8821B_RfMode(pDM_Odm, pBeamformingInfo); -+ if (Idx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8821B, 0x0); -+ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A, 0); -+ } else { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8821B + 2, ODM_Read2Byte(pDM_Odm, REG_TXBF_CTRL_8821B + 2) & 0xF000); -+ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2, ODM_Read2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2) & 0x60); -+ } -+ } -+ -+} -+ -+ -+VOID -+HalTxbf8821B_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte BeamCtrlVal; -+ u4Byte BeamCtrlReg; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformEntry = pBeamInfo->BeamformeeEntry[Idx]; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ BeamCtrlVal = BeamformEntry.MacId; -+ else -+ BeamCtrlVal = BeamformEntry.P_AID; -+ -+ if (Idx == 0) -+ BeamCtrlReg = REG_TXBF_CTRL_8821B; -+ else { -+ BeamCtrlReg = REG_TXBF_CTRL_8821B + 2; -+ BeamCtrlVal |= BIT12 | BIT14 | BIT15; -+ } -+ -+ if (BeamformEntry.BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (BeamformEntry.SoundBW == CHANNEL_WIDTH_20) -+ BeamCtrlVal |= BIT9; -+ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_40) -+ BeamCtrlVal |= BIT10; -+ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_80) -+ BeamCtrlVal |= BIT11; -+ } else -+ BeamCtrlVal &= ~(BIT9 | BIT10 | BIT11); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BeamCtrlVal = 0x%x!\n", __func__, BeamCtrlVal)); -+ -+ ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); -+} -+ -+ -+ -+VOID -+HalTxbf8821B_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+#if 0 -+ if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ halTxbf8821B_DownloadNDPA(pDM_Odm, Idx); -+ -+ halTxbf8821B_FwTxBFCmd(pDM_Odm); -+#endif -+} -+ -+#endif -+ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8821b.h linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8821b.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8821b.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8821b.h 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,43 @@ -+#ifndef __HAL_TXBF_8821B_H__ -+#define __HAL_TXBF_8821B_H__ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (RTL8821B_SUPPORT == 1) -+VOID -+HalTxbf8821B_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8821B_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8821B_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8821B_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+#else -+#define HalTxbf8821B_Enter(pDM_VOID, Idx) -+#define HalTxbf8821B_Leave(pDM_VOID, Idx) -+#define HalTxbf8821B_Status(pDM_VOID, Idx) -+#define HalTxbf8821B_FwTxBF(pDM_VOID, Idx) -+#endif -+ -+ -+#endif -+ -+#endif // #ifndef __HAL_TXBF_8821B_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8822b.c linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8822b.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8822b.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8822b.c 2017-06-07 23:07:21.031689398 +0300 -@@ -0,0 +1,1099 @@ -+/*============================================================*/ -+/* Description: */ -+/* */ -+/* This file is for 8814A TXBF mechanism */ -+/* */ -+/*============================================================*/ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (RTL8822B_SUPPORT == 1) -+ -+#if 0 -+VOID -+HalTxbf8814A_GetBeamformcap( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = GET_BEAMFORM_INFO(Adapter); -+ BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; -+ -+ BeamformCap = phydm_Beamforming_GetBeamCap(pDM_Odm, pBeamformingInfo); -+ -+ if (BeamformCap == pBeamformingInfo->BeamformCap) -+ return; -+ else -+ pBeamformingInfo->BeamformCap = BeamformCap; -+ -+} -+ -+VOID -+HalTxbf8814A_GetTxRate( -+ IN PADAPTER Adapter -+) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); -+ PRT_BEAMFORMEE_ENTRY pEntry; -+ u4Byte TxRptData = 0; -+ u1Byte DataRate = 0xFF; -+ -+ pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); -+ -+ ReadSdramData_8814A(Adapter, (u1Byte)pEntry->MacId, LOC_8814A_CTRL_INFO, &TxRptData, 1); -+ DataRate = (u1Byte)TxRptData; -+ DataRate &= bMask7bits; /*Bit7 indicates SGI*/ -+ -+ pDM_Odm->TxBfDataRate = DataRate; -+ -+} -+ -+VOID -+HalTxbf8814A_ResetTxPath( -+ IN PADAPTER Adapter, -+ IN u1Byte idx -+) -+{ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = GET_BEAMFORM_INFO(Adapter); -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ u1Byte Nr_index = 0; -+ -+ if (idx < BEAMFORMEE_ENTRY_NUM) -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[idx]; -+ else -+ return; -+ -+ if ((pDM_Odm->LastUSBHub) != (RT_GetHubUSBMode(Adapter))) { -+ Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(Adapter), BeamformeeEntry.CompSteeringNumofBFer); -+ -+ if (idx == 0) { -+ switch (Nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF0, BIT3|BIT2|BIT1|BIT0, 0x6); /*1ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF0, BIT7|BIT6|BIT5|BIT4, 0x6); /*2ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF0, 0x0000ff00, 0x10); /*BC*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_1, BIT23|BIT22|BIT21|BIT20, 0x6); /*set TxPath selection for 8814a BFer bug refine*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_1, bMaskByte3, 0x10); /*if Bfer enable, always use 3Tx for all Spatial stream*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x1060); -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF0, BIT3|BIT2|BIT1|BIT0, 0xe); /*1ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF0, BIT7|BIT6|BIT5|BIT4, 0xe); /*2ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF0, 0x0000ff00, 0x90); /*BCD*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF0, BIT19|BIT18|BIT17|BIT16, 0xe); /*3ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF0, 0xff00000, 0x90); /*bcd*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_1, BIT23|BIT22|BIT21|BIT20, 0xe); /*set TxPath selection for 8814a BFer bug refine*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_1, bMaskByte3, 0x90); /*if Bfer enable, always use 3Tx for all Spatial stream*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_2, bMaskDWord, 0x90e90e0); -+ break; -+ -+ default: /*Nr>3, same as Case 3*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF0, BIT3|BIT2|BIT1|BIT0, 0xf); /*1ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF0, BIT7|BIT6|BIT5|BIT4, 0xf); /*2ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF0, 0x0000ff00, 0x93); /*BC*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF0, BIT19|BIT18|BIT17|BIT16, 0xf); /*3ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF0, 0xff00000, 0x93); /*bcd*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_1, BIT23|BIT22|BIT21|BIT20, 0xf); /*set TxPath selection for 8814a BFer bug refine*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_1, bMaskByte3, 0x93); /*if Bfer enable, always use 3Tx for all Spatial stream*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_2, bMaskDWord, 0x93f93f0); -+ break; -+ } -+ } else { -+ switch (Nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF1, BIT3|BIT2|BIT1|BIT0, 0x6); /*1ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF1, BIT7|BIT6|BIT5|BIT4, 0x6); /*2ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF1, 0x0000ff00, 0x10); /*BC*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_1, BIT23|BIT22|BIT21|BIT20, 0x6); /*set TxPath selection for 8814a BFer bug refine*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_1, bMaskByte3, 0x10); /*if Bfer enable, always use 3Tx for all Spatial stream*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x1060); -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF1, BIT3|BIT2|BIT1|BIT0, 0xe); /*1ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF1, BIT7|BIT6|BIT5|BIT4, 0xe); /*2ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF1, 0x0000ff00, 0x90); /*BC*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF1, BIT19|BIT18|BIT17|BIT16, 0xe); /*3ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF1, 0xff00000, 0x90); /*bcd*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_1, BIT23|BIT22|BIT21|BIT20, 0xe); /*set TxPath selection for 8814a BFer bug refine*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_1, bMaskByte3, 0x90); /*if Bfer enable, always use 3Tx for all Spatial stream*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_2, bMaskDWord, 0x90e90e0); -+ break; -+ -+ default: /*Nr>3, same as Case 3*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF1, BIT3|BIT2|BIT1|BIT0, 0xf); /*1ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF1, BIT7|BIT6|BIT5|BIT4, 0xf); /*2ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF1, 0x0000ff00, 0x93); /*BC*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF1, BIT19|BIT18|BIT17|BIT16, 0xf); /*3ss*/ -+ PHY_SetBBReg(Adapter, REG_BB_TXBF_ANT_SET_BF1, 0xff00000, 0x93); /*bcd*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_1, BIT23|BIT22|BIT21|BIT20, 0xf); /*set TxPath selection for 8814a BFer bug refine*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_1, bMaskByte3, 0x93); /*if Bfer enable, always use 3Tx for all Spatial stream*/ -+ PHY_SetBBReg(Adapter, REG_BB_TX_PATH_SEL_2, bMaskDWord, 0x93f93f0); -+ break; -+ -+ } -+ } -+ -+ pDM_Odm->LastUSBHub = RT_GetHubUSBMode(Adapter); -+ } -+ else -+ return; -+#endif -+} -+#endif -+ -+u1Byte -+halTxbf8822B_GetNtx( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Ntx = 0; -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { -+ if (*pDM_Odm->HubUsbMode == 2) {/*USB3.0*/ -+ if (pDM_Odm->RFType == ODM_4T4R) -+ Ntx = 3; -+ else if (pDM_Odm->RFType == ODM_3T3R) -+ Ntx = 2; -+ else -+ Ntx = 1; -+ } else if (*pDM_Odm->HubUsbMode == 1) /*USB 2.0 always 2Tx*/ -+ Ntx = 1; -+ else -+ Ntx = 1; -+ } else -+#endif -+ { -+ if (pDM_Odm->RFType == ODM_4T4R) -+ Ntx = 3; -+ else if (pDM_Odm->RFType == ODM_3T3R) -+ Ntx = 2; -+ else -+ Ntx = 1; -+ } -+ -+ return Ntx; -+ -+} -+ -+u1Byte -+halTxbf8822B_GetNrx( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Nrx = 0; -+ -+ if (pDM_Odm->RFType == ODM_4T4R) -+ Nrx = 3; -+ else if (pDM_Odm->RFType == ODM_3T3R) -+ Nrx = 2; -+ else if (pDM_Odm->RFType == ODM_2T2R) -+ Nrx = 1; -+ else if (pDM_Odm->RFType == ODM_2T3R) -+ Nrx = 2; -+ else if (pDM_Odm->RFType == ODM_2T4R) -+ Nrx = 3; -+ else if (pDM_Odm->RFType == ODM_1T1R) -+ Nrx = 0; -+ else if (pDM_Odm->RFType == ODM_1T2R) -+ Nrx = 1; -+ else -+ Nrx = 0; -+ -+ return Nrx; -+ -+} -+ -+/***************SU & MU BFee Entry********************/ -+VOID -+halTxbf8822B_RfMode( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORMING_INFO pBeamformingInfo, -+ IN u1Byte idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i, Nr_index = 0; -+ BOOLEAN bSelfBeamformer = FALSE; -+ BOOLEAN bSelfBeamformee = FALSE; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ -+ if (idx < BEAMFORMEE_ENTRY_NUM) -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[idx]; -+ else -+ return; -+ -+ if (pDM_Odm->RFType == ODM_1T1R) -+ return; -+ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { -+ ODM_SetRFReg(pDM_Odm, i, RF_WeLut_Jaguar, 0x80000, 0x1); -+ /*RF Mode table write enable*/ -+ } -+ -+ if ((pBeamformingInfo->beamformee_su_cnt > 0) || (pBeamformingInfo->beamformee_mu_cnt > 0)) { -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { -+ ODM_SetRFReg(pDM_Odm, i, RF_ModeTableAddr, 0xfffff, 0x18000); -+ /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, i, RF_ModeTableData0, 0xfffff, 0xBE77F); -+ /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, i, RF_ModeTableData1, 0xfffff, 0x226BF); -+ /*Enable TXIQGEN in RX mode*/ -+ } -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF); -+ /*Enable TXIQGEN in RX mode*/ -+ } -+ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { -+ ODM_SetRFReg(pDM_Odm, i, RF_WeLut_Jaguar, 0x80000, 0x0); -+ /*RF Mode table write disable*/ -+ } -+ -+ if (pBeamformingInfo->beamformee_su_cnt > 0) { -+ -+ /*for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1, BIT28|BIT29, 0x2); /*enable BB TxBF ant mapping register*/ -+ -+ if (idx == 0) { -+ /*Nsts = 2 AB*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0, 0xffff, 0x0433); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, 0xfff00000, 0x043); -+ /*ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x430);*/ -+ -+ } else {/*IDX =1*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1, 0xffff, 0x0433); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, 0xfff00000, 0x043); -+ /*ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x430;*/ -+ } -+ } else { -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, 0xfff00000, 0x1); /*1SS by path-A*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x430); /*2SS by path-A,B*/ -+ } -+ -+ if (pBeamformingInfo->beamformee_mu_cnt > 0) { -+ /*MU STAs share the common setting*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1, BIT31, 1); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1, 0xffff, 0x0433); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1, 0xfff00000, 0x043); -+ } -+ -+} -+#if 0 -+VOID -+halTxbf8822B_DownloadNDPA( -+ IN PADAPTER Adapter, -+ IN u1Byte Idx -+ ) -+{ -+ u1Byte u1bTmp = 0, tmpReg422 = 0; -+ u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; -+ u2Byte Head_Page = 0x7FE; -+ BOOLEAN bSendBeacon = FALSE; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u2Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8814A; /*default reseved 1 page for the IC type which is undefined.*/ -+ PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry+Idx; -+ -+ pHalData->bFwDwRsvdPageInProgress = TRUE; -+ Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu2Byte)&TxPageBndy); -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR_8814A+1); -+ PlatformEFIOWrite1Byte(Adapter, REG_CR_8814A+1, (u1bTmp|BIT0)); -+ -+ -+ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ tmpReg422 = PlatformEFIORead1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A+2); -+ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A+2, tmpReg422&(~BIT6)); -+ -+ if (tmpReg422 & BIT6) { -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("SetBeamformDownloadNDPA_8814A(): There is an Adapter is sending beacon.\n")); -+ bSendBeacon = TRUE; -+ } -+ -+ /*0x204[11:0] Beacon Head for TXDMA*/ -+ PlatformEFIOWrite2Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A, Head_Page); -+ -+ do { -+ /*Clear beacon valid check bit.*/ -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A+1); -+ PlatformEFIOWrite1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A+1, (BcnValidReg|BIT7)); -+ -+ /*download NDPA rsvd page.*/ -+ if (pBeamEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) -+ Beamforming_SendVHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->AID, pBeamEntry->SoundBW, BEACON_QUEUE); -+ else -+ Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); -+ -+ /*check rsvd page download OK.*/ -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A + 1); -+ count = 0; -+ while (!(BcnValidReg & BIT7) && count < 20) { -+ count++; -+ delay_us(10); -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A+2); -+ } -+ DLBcnCount++; -+ } while (!(BcnValidReg & BIT7) && DLBcnCount < 5); -+ -+ if (!(BcnValidReg & BIT0)) -+ RT_DISP(FBEAM, FBEAM_ERROR, ("%s Download RSVD page failed!\n", __func__)); -+ -+ /*0x204[11:0] Beacon Head for TXDMA*/ -+ PlatformEFIOWrite2Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A, TxPageBndy); -+ -+ /*To make sure that if there exists an adapter which would like to send beacon.*/ -+ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ -+ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ -+ /*the beacon cannot be sent by HW.*/ -+ /*2010.06.23. Added by tynli.*/ -+ if (bSendBeacon) -+ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A+2, tmpReg422); -+ -+ /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ -+ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR_8814A+1); -+ PlatformEFIOWrite1Byte(Adapter, REG_CR_8814A+1, (u1bTmp&(~BIT0))); -+ -+ pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+ -+ pHalData->bFwDwRsvdPageInProgress = FALSE; -+} -+ -+VOID -+halTxbf8822B_FwTxBFCmd( -+ IN PADAPTER Adapter -+ ) -+{ -+ u1Byte Idx, Period = 0; -+ u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u1Byte u1TxBFParm[3] = {0}; -+ -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); -+ -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bUsed && pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) { -+ PageNum0 = 0xFE; -+ PageNum1 = 0x07; -+ Period = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } else if (PageNum0 == 0xFF) { -+ PageNum0 = 0xFF; /*stop sounding*/ -+ PageNum1 = 0x0F; -+ } -+ } -+ } -+ -+ u1TxBFParm[0] = PageNum0; -+ u1TxBFParm[1] = PageNum1; -+ u1TxBFParm[2] = Period; -+ FillH2CCmd(Adapter, PHYDM_H2C_TXBF, 3, u1TxBFParm); -+ -+ RT_DISP(FBEAM, FBEAM_FUN, ("@%s End, PageNum0 = 0x%x, PageNum1 = 0x%x Period = %d", __func__, PageNum0, PageNum1, Period)); -+} -+#endif -+ -+VOID -+HalTxbf8822B_Init( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte u1bTmp; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ -+ ODM_SetBBReg(pDM_Odm, 0x14c0 , BIT16, 1); /*Enable P1 aggr new packet according to P0 transfer time*/ -+ ODM_SetBBReg(pDM_Odm, 0x14c0 , BIT15|BIT14|BIT13|BIT12, 1); /*MU Retry Limit*/ -+ ODM_SetBBReg(pDM_Odm, 0x14c0 , BIT7, 0); /*Disable Tx MU-MIMO until sounding done*/ -+ ODM_SetBBReg(pDM_Odm, 0x14c0 , 0x3F, 0); /* Clear validity of MU STAs */ -+ ODM_Write1Byte(pDM_Odm, 0x167c , 0x70); /*MU-MIMO Option as default value*/ -+ ODM_Write2Byte(pDM_Odm, 0x1680 , 0); /*MU-MIMO Control as default value*/ -+ -+ /* Set MU NDPA rate & BW source */ -+ /* 0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, 0x42C); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B, (u1bTmp|BIT6)); -+ /* 0x45F[7:0] = 0x10 (Rate=OFDM_6M, BW20) */ -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8822B, 0x10); -+ -+ /* Init HW variable */ -+ pBeamformingInfo->RegMUTxCtrl = ODM_Read4Byte(pDM_Odm, 0x14c0); -+} -+ -+VOID -+HalTxbf8822B_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte BFerBFeeIdx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ u1Byte BFerIdx = (BFerBFeeIdx & 0xF0)>>4; -+ u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); -+ u2Byte CSI_Param = 0; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamformeeEntry; -+ PRT_BEAMFORMER_ENTRY pBeamformerEntry; -+ u2Byte value16, STAid = 0; -+ u1Byte Nc_index = 0, Nr_index = 0, grouping = 0, codebookinfo = 0, coefficientsize = 0; -+ u4Byte gid_valid, user_position_l, user_position_h; -+ u4Byte mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e}; -+ u1Byte u1bTmp; -+ u4Byte u4bTmp; -+ -+ RT_DISP(FBEAM, FBEAM_FUN, ("%s: BFerBFeeIdx=%d, BFerIdx=%d, BFeeIdx=%d\n", __func__, BFerBFeeIdx, BFerIdx, BFeeIdx)); -+ -+ /*************SU BFer Entry Init*************/ -+ if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { -+ pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[BFerIdx]; -+ pBeamformerEntry->is_mu_ap = FALSE; -+ /*Sounding protocol control*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xDB); -+ -+ -+ for (i = 0; i < MAX_BEAMFORMER_SU; i++) { -+ if ((pBeamformingInfo->beamformer_su_reg_maping & BIT(i)) == 0) { -+ pBeamformingInfo->beamformer_su_reg_maping |= BIT(i); -+ pBeamformerEntry->su_reg_index = i; -+ break; -+ } -+ } -+ -+ /*MAC address/Partial AID of Beamformer*/ -+ if (pBeamformerEntry->su_reg_index == 0) { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8822B+i), pBeamformerEntry->MacAddr[i]); -+ } else { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER1_INFO_8822B+i), pBeamformerEntry->MacAddr[i]); -+ } -+ -+ /*CSI report parameters of Beamformer*/ -+ Nc_index = halTxbf8822B_GetNrx(pDM_Odm); /*for 8814A Nrx = 3(4 Ant), min=0(1 Ant)*/ -+ Nr_index = pBeamformerEntry->NumofSoundingDim; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so Nr_index don't care*/ -+ -+ grouping = 0; -+ -+ /*for ac = 1, for n = 3*/ -+ if (pBeamformerEntry->BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU) -+ codebookinfo = 1; -+ else if (pBeamformerEntry->BeamformEntryCap & BEAMFORMEE_CAP_HT_EXPLICIT) -+ codebookinfo = 3; -+ -+ coefficientsize = 3; -+ -+ CSI_Param = (u2Byte)((coefficientsize<<10)|(codebookinfo<<8)|(grouping<<6)|(Nr_index<<3)|(Nc_index)); -+ -+ if (BFerIdx == 0) -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8822B, CSI_Param); -+ else -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8822B+2, CSI_Param); -+ /*ndp_rx_standby_timer, 8814 need > 0x56, suggest from Dvaid*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8814A+3, 0x70); -+ -+ } -+ -+ /*************SU BFee Entry Init*************/ -+ if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { -+ pBeamformeeEntry = &pBeamformingInfo->BeamformeeEntry[BFeeIdx]; -+ pBeamformeeEntry->is_mu_sta = FALSE; -+ halTxbf8822B_RfMode(pDM_Odm, pBeamformingInfo, BFeeIdx); -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ STAid = pBeamformeeEntry->MacId; -+ else -+ STAid = pBeamformeeEntry->P_AID; -+ -+ for (i = 0; i < MAX_BEAMFORMEE_SU; i++) { -+ if ((pBeamformingInfo->beamformee_su_reg_maping & BIT(i)) == 0) { -+ pBeamformingInfo->beamformee_su_reg_maping |= BIT(i); -+ pBeamformeeEntry->su_reg_index = i; -+ break; -+ } -+ } -+ -+ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ -+ if (pBeamformeeEntry->su_reg_index == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B, STAid); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3)|BIT4|BIT6|BIT7); -+ } else { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B+2, STAid | BIT14 | BIT15 | BIT12); -+ } -+ -+ /*CSI report parameters of Beamformee*/ -+ if (pBeamformeeEntry->su_reg_index == 0) { -+ /*Get BIT24 & BIT25*/ -+ u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+3) & 0x3; -+ -+ ODM_Write1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B + 3, tmp | 0x60); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B, STAid | BIT9); -+ } else -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+2, STAid | 0xE200); /*Set BIT25*/ -+ -+ phydm_Beamforming_Notify(pDM_Odm); -+ } -+ -+ /*************MU BFer Entry Init*************/ -+ if ((pBeamformingInfo->beamformer_mu_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { -+ pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[BFerIdx]; -+ pBeamformingInfo->mu_ap_index = BFerIdx; -+ pBeamformerEntry->is_mu_ap = TRUE; -+ for (i = 0; i < 8; i++) -+ pBeamformerEntry->gid_valid[i] = 0; -+ for (i = 0; i < 16; i++) -+ pBeamformerEntry->user_position[i] = 0; -+ -+ /*Sounding protocol control*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xDB); -+ -+ /* MAC address */ -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8822B+i), pBeamformerEntry->MacAddr[i]); -+ -+ /* Set partial AID */ -+ ODM_Write2Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8822B+6), pBeamformerEntry->P_AID); -+ -+ /* Fill our AID to 0x1680[11:0] and [13:12] = 2b'00, BF report segment select to 3895 bytes*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, 0x1680); -+ u1bTmp = (pBeamformerEntry->AID)&0xFFF; -+ ODM_Write1Byte(pDM_Odm, 0x1680, u1bTmp); -+ -+ /* Set 80us for leaving ndp_rx_standby_state */ -+ ODM_Write1Byte(pDM_Odm, 0x71B, 0x50); -+ -+ /* Set 0x6A0[14] = 1 to accept action_no_ack */ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1); -+ u1bTmp |= 0x40; -+ ODM_Write1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1, u1bTmp); -+ /* Set 0x6A2[5:4] = 1 to NDPA and BF report poll */ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_RXFLTMAP1_8822B); -+ u1bTmp |= 0x30; -+ ODM_Write1Byte(pDM_Odm, REG_RXFLTMAP1_8822B, u1bTmp); -+ -+ /*CSI report parameters of Beamformer*/ -+ Nc_index = halTxbf8822B_GetNrx(pDM_Odm); /* Depend on RF type */ -+ Nr_index = 1; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so Nr_index don't care*/ -+ grouping = 0; /*no grouping*/ -+ codebookinfo = 1; /*7 bit for psi, 9 bit for phi*/ -+ coefficientsize = 0; /*This is nothing really matter*/ -+ CSI_Param = (u2Byte)((coefficientsize<<10)|(codebookinfo<<8)|(grouping<<6)|(Nr_index<<3)|(Nc_index)); -+ ODM_Write2Byte(pDM_Odm, 0x6F4, CSI_Param); -+ -+ } -+ -+ /*************MU BFee Entry Init*************/ -+ if ((pBeamformingInfo->beamformee_mu_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { -+ pBeamformeeEntry = &pBeamformingInfo->BeamformeeEntry[BFeeIdx]; -+ pBeamformeeEntry->is_mu_sta = TRUE; -+ for (i = 0; i < MAX_BEAMFORMEE_MU; i++) { -+ if ((pBeamformingInfo->beamformee_mu_reg_maping & BIT(i)) == 0) { -+ pBeamformingInfo->beamformee_mu_reg_maping |= BIT(i); -+ pBeamformeeEntry->mu_reg_index = i; -+ break; -+ } -+ } -+ -+ if (pBeamformeeEntry->mu_reg_index == 0xFF) { -+ /* There is no valid bit in beamformee_mu_reg_maping */ -+ RT_DISP(FBEAM, FBEAM_FUN, ("%s: ERROR! There is no valid bit in beamformee_mu_reg_maping!\n", __func__)); -+ return; -+ } -+ -+ /*User position table*/ -+ switch (pBeamformeeEntry->mu_reg_index) { -+ case 0: -+ gid_valid = 0x7fe; -+ user_position_l = 0x111110; -+ user_position_h = 0x0; -+ break; -+ case 1: -+ gid_valid = 0x7f806; -+ user_position_l = 0x11000004; -+ user_position_h = 0x11; -+ break; -+ case 2: -+ gid_valid = 0x1f81818; -+ user_position_l = 0x400040; -+ user_position_h = 0x11100; -+ break; -+ case 3: -+ gid_valid = 0x1e186060; -+ user_position_l = 0x4000400; -+ user_position_h = 0x1100040; -+ break; -+ case 4: -+ gid_valid = 0x66618180; -+ user_position_l = 0x40004000; -+ user_position_h = 0x10040400; -+ break; -+ case 5: -+ gid_valid = 0x79860600; -+ user_position_l = 0x40000; -+ user_position_h = 0x4404004; -+ break; -+ } -+ -+ for (i = 0; i < 8; i++) { -+ if (i < 4) { -+ pBeamformeeEntry->gid_valid[i] = (u1Byte)(gid_valid & 0xFF); -+ gid_valid = (gid_valid >> 8); -+ } else -+ pBeamformeeEntry->gid_valid[i] = 0; -+ } -+ for (i = 0; i < 16; i++) { -+ if (i < 4) { -+ pBeamformeeEntry->user_position[i] = (u1Byte)(user_position_l & 0xFF); -+ user_position_l = user_position_l >> 8; -+ } else if (i < 8) { -+ pBeamformeeEntry->user_position[i] = (u1Byte)(user_position_h & 0xFF); -+ user_position_h = user_position_h >> 8; -+ } else -+ pBeamformeeEntry->user_position[i] = 0; -+ } -+ -+ /*Sounding protocol control*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xDB); -+ -+ /*select MU STA table*/ -+ pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); -+ pBeamformingInfo->RegMUTxCtrl |= (pBeamformeeEntry->mu_reg_index << 8)&(BIT8|BIT9|BIT10); -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ -+ ODM_SetBBReg(pDM_Odm, 0x14c4 , bMaskDWord, 0); /*Reset gid_valid table*/ -+ ODM_SetBBReg(pDM_Odm, 0x14c8 , bMaskDWord, user_position_l); -+ ODM_SetBBReg(pDM_Odm, 0x14cc , bMaskDWord, user_position_h); -+ -+ /*set validity of MU STAs*/ -+ pBeamformingInfo->RegMUTxCtrl &= 0xFFFFFFC0; -+ pBeamformingInfo->RegMUTxCtrl |= pBeamformingInfo->beamformee_mu_reg_maping&0x3F; -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ -+ value16 = ODM_Read2Byte(pDM_Odm, mu_reg[pBeamformeeEntry->mu_reg_index]); -+ value16 &= 0xFE00; /*Clear PAID*/ -+ value16 |= BIT9; /*Enable MU BFee*/ -+ value16 |= pBeamformeeEntry->P_AID; -+ ODM_Write2Byte(pDM_Odm, mu_reg[pBeamformeeEntry->mu_reg_index] , value16); -+ -+ /* 0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3); -+ u1bTmp |= 0xD0; /* Set bit 28, 30, 31 to 3b'111*/ -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3, u1bTmp); -+ /* Set NDPA to 6M*/ -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_RATE_8822B, 0x4); /* 6M */ -+ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8822B); -+ u1bTmp &= 0xFC; /* Clear bit 0, 1*/ -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8822B, u1bTmp); -+ -+ u4bTmp = ODM_Read4Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B); -+ u4bTmp = ((u4bTmp & 0xFF0000FF) | 0x020200); /* Set [23:8] to 0x0202 */ -+ ODM_Write4Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, u4bTmp); -+ -+ /* Set 0x6A0[14] = 1 to accept action_no_ack */ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1); -+ u1bTmp |= 0x40; -+ ODM_Write1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1, u1bTmp); -+ /* End of MAC registers setting */ -+ -+ halTxbf8822B_RfMode(pDM_Odm, pBeamformingInfo, BFeeIdx); -+#if (SUPPORT_MU_BF == 1) -+ /*Special for plugfest*/ -+ delay_ms(50); /* wait for 4-way handshake ending*/ -+ SendSWVHTGIDMgntFrame(pDM_Odm, pBeamformeeEntry->MacAddr, BFeeIdx); -+#endif -+ -+ phydm_Beamforming_Notify(pDM_Odm); -+ -+ } -+ -+} -+ -+ -+VOID -+HalTxbf8822B_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMER_ENTRY pBeamformerEntry; -+ PRT_BEAMFORMEE_ENTRY pBeamformeeEntry; -+ u4Byte mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e}; -+ -+ if (Idx < BEAMFORMER_ENTRY_NUM) { -+ pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[Idx]; -+ pBeamformeeEntry = &pBeamformingInfo->BeamformeeEntry[Idx]; -+ } else -+ return; -+ -+ /*Clear P_AID of Beamformee*/ -+ /*Clear MAC address of Beamformer*/ -+ /*Clear Associated Bfmee Sel*/ -+ -+ if (pBeamformerEntry->BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xD8); -+ if (pBeamformerEntry->is_mu_ap == 0) { /*SU BFer */ -+ if (pBeamformerEntry->su_reg_index == 0) { -+ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8822B, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8822B+4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8822B, 0); -+ } else { -+ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8822B, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8822B+4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8822B+2, 0); -+ } -+ pBeamformingInfo->beamformer_su_reg_maping &= ~(BIT(pBeamformerEntry->su_reg_index)); -+ pBeamformerEntry->su_reg_index = 0xFF; -+ } else { /*MU BFer */ -+ /*set validity of MU STA0 and MU STA1*/ -+ pBeamformingInfo->RegMUTxCtrl &= 0xFFFFFFC0; -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ -+ ODM_Memory_Set(pDM_Odm, pBeamformerEntry->gid_valid, 0, 8); -+ ODM_Memory_Set(pDM_Odm, pBeamformerEntry->user_position, 0, 16); -+ pBeamformerEntry->is_mu_ap = FALSE; -+ } -+ } -+ -+ if (pBeamformeeEntry->BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ halTxbf8822B_RfMode(pDM_Odm, pBeamformingInfo, Idx); -+ if (pBeamformeeEntry->is_mu_sta == 0) { /*SU BFee*/ -+ if (pBeamformeeEntry->su_reg_index == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B, 0x0); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3)|BIT4|BIT6|BIT7); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B, 0); -+ } else { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B+2, 0x0 | BIT14 | BIT15 | BIT12); -+ -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+2, -+ ODM_Read2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+2) & 0x60); -+ } -+ pBeamformingInfo->beamformee_su_reg_maping &= ~(BIT(pBeamformeeEntry->su_reg_index)); -+ pBeamformeeEntry->su_reg_index = 0xFF; -+ } else { /*MU BFee */ -+ /*Disable sending NDPA & BF-rpt-poll to this BFee*/ -+ ODM_Write2Byte(pDM_Odm, mu_reg[pBeamformeeEntry->mu_reg_index] , 0); -+ /*set validity of MU STA*/ -+ pBeamformingInfo->RegMUTxCtrl &= ~(BIT(pBeamformeeEntry->mu_reg_index)); -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ -+ -+ pBeamformeeEntry->is_mu_sta = FALSE; -+ pBeamformingInfo->beamformee_mu_reg_maping &= ~(BIT(pBeamformeeEntry->mu_reg_index)); -+ pBeamformeeEntry->mu_reg_index = 0xFF; -+ } -+ } -+} -+ -+ -+/***********SU & MU BFee Entry Only when souding done****************/ -+VOID -+HalTxbf8822B_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte BeamCtrlVal, tmpVal; -+ u4Byte BeamCtrlReg; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry; -+ BOOLEAN is_mu_sounding = pBeamformingInfo->is_mu_sounding, is_bitmap_ready = FALSE; -+ u16 bitmap; -+ u8 idx, gid, i; -+ u8 id1, id0; -+ u32 gid_valid[6] = {0}; -+ u32 user_position_lsb[6] = {0}; -+ u32 user_position_msb[6] = {0}; -+ u32 value32; -+ -+ if (Idx < BEAMFORMEE_ENTRY_NUM) -+ pBeamformEntry = &pBeamformingInfo->BeamformeeEntry[Idx]; -+ else -+ return; -+ -+ /*SU sounding done */ -+ if (is_mu_sounding == FALSE) { -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ BeamCtrlVal = pBeamformEntry->MacId; -+ else -+ BeamCtrlVal = pBeamformEntry->P_AID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, BeamformEntry.BeamformEntryState = %d", __func__, pBeamformEntry->BeamformEntryState)); -+ -+ if (pBeamformEntry->su_reg_index == 0) { -+ BeamCtrlReg = REG_TXBF_CTRL_8822B; -+ } else { -+ BeamCtrlReg = REG_TXBF_CTRL_8822B+2; -+ BeamCtrlVal |= BIT12|BIT14|BIT15; -+ } -+ -+ if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (pBeamformEntry->SoundBW == CHANNEL_WIDTH_20) -+ BeamCtrlVal |= BIT9; -+ else if (pBeamformEntry->SoundBW == CHANNEL_WIDTH_40) -+ BeamCtrlVal |= (BIT9|BIT10); -+ else if (pBeamformEntry->SoundBW == CHANNEL_WIDTH_80) -+ BeamCtrlVal |= (BIT9|BIT10|BIT11); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, Don't apply Vmatrix", __func__)); -+ BeamCtrlVal &= ~(BIT9|BIT10|BIT11); -+ } -+ -+ ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); -+ /*disable NDP packet use beamforming */ -+ tmpVal = ODM_Read2Byte(pDM_Odm, REG_TXBF_CTRL_8822B); -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B, tmpVal|BIT15); -+ } else { -+ /*MU sounding done */ -+ if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ /*value32 = ODM_GetBBReg(pDM_Odm, 0xF4C, 0xFFFF0000);*/ -+ value32 = 1; -+ -+ is_bitmap_ready = (BOOLEAN)((value32 & BIT15) >> 15); -+ bitmap = (u16)(value32 & 0x3FFF); -+ -+ for (idx = 0; idx < 15; idx++) { -+ if (idx < 5) {/*bit0~4*/ -+ id0 = 0; -+ id1 = (u8)(idx + 1); -+ } else if (idx < 9) { /*bit5~8*/ -+ id0 = 1; -+ id1 = (u8)(idx - 3); -+ } else if (idx < 12) { /*bit9~11*/ -+ id0 = 2; -+ id1 = (u8)(idx - 6); -+ } else if (idx < 14) { /*bit12~13*/ -+ id0 = 3; -+ id1 = (u8)(idx - 8); -+ } else { /*bit14*/ -+ id0 = 4; -+ id1 = (u8)(idx - 9); -+ } -+ if (bitmap & BIT(idx)) { -+ /*Pair 1*/ -+ gid = (idx << 1) + 1; -+ gid_valid[id0] |= (BIT(gid)); -+ gid_valid[id1] |= (BIT(gid)); -+ /*Pair 2*/ -+ gid += 1; -+ gid_valid[id0] |= (BIT(gid)); -+ gid_valid[id1] |= (BIT(gid)); -+ } else { -+ /*Pair 1*/ -+ gid = (idx << 1) + 1; -+ gid_valid[id0] &= ~(BIT(gid)); -+ gid_valid[id1] &= ~(BIT(gid)); -+ /*Pair 2*/ -+ gid += 1; -+ gid_valid[id0] &= ~(BIT(gid)); -+ gid_valid[id1] &= ~(BIT(gid)); -+ } -+ } -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ pBeamformEntry = &pBeamformingInfo->BeamformeeEntry[i]; -+ if ((pBeamformEntry->is_mu_sta) && (pBeamformEntry->mu_reg_index < 6)) { -+ value32 = gid_valid[pBeamformEntry->mu_reg_index]; -+ for (idx = 0; idx < 4; idx++) { -+ pBeamformEntry->gid_valid[idx] = (u8)(value32 & 0xFF); -+ value32 = (value32 >> 8); -+ } -+ } -+ } -+ -+ for (idx = 0; idx < 6; idx++) { -+ pBeamformingInfo->RegMUTxCtrl |= ~(BIT8|BIT9|BIT10); -+ pBeamformingInfo->RegMUTxCtrl |= ((idx<<8)&(BIT8|BIT9|BIT10)); -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ ODM_SetMACReg(pDM_Odm, 0x14C4, bMaskDWord, gid_valid[idx]); /*set MU STA gid valid table*/ -+ } -+ -+ /*Enable TxMU PPDU*/ -+ pBeamformingInfo->RegMUTxCtrl |= BIT7; -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ } -+ } -+} -+ -+/*Only used for MU BFer Entry when get GID management frame (self is as MU STA)*/ -+VOID -+HalTxbf8822B_ConfigGtab( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMER_ENTRY pBeamformerEntry = NULL; -+ u4Byte gid_valid = 0, user_position_l = 0, user_position_h = 0, i; -+ -+ if (pBeamformingInfo->mu_ap_index < BEAMFORMER_ENTRY_NUM) -+ pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[pBeamformingInfo->mu_ap_index]; -+ else -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s==>\n", __func__)); -+ -+ /*For GID 0~31*/ -+ for (i = 0; i < 4; i++) -+ gid_valid |= (pBeamformerEntry->gid_valid[i] << (i<<3)); -+ for (i = 0; i < 8; i++) { -+ if (i < 4) -+ user_position_l |= (pBeamformerEntry->user_position[i] << (i << 3)); -+ else -+ user_position_h |= (pBeamformerEntry->user_position[i] << ((i - 4)<<3)); -+ } -+ /*select MU STA0 table*/ -+ pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ ODM_SetBBReg(pDM_Odm, 0x14c4, bMaskDWord, gid_valid); -+ ODM_SetBBReg(pDM_Odm, 0x14c8, bMaskDWord, user_position_l); -+ ODM_SetBBReg(pDM_Odm, 0x14cc, bMaskDWord, user_position_h); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: STA0: gid_valid = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", -+ __func__, gid_valid, user_position_l, user_position_h)); -+ -+ gid_valid = 0; -+ user_position_l = 0; -+ user_position_h = 0; -+ -+ /*For GID 32~64*/ -+ for (i = 4; i < 8; i++) -+ gid_valid |= (pBeamformerEntry->gid_valid[i] << ((i - 4)<<3)); -+ for (i = 8; i < 16; i++) { -+ if (i < 4) -+ user_position_l |= (pBeamformerEntry->user_position[i] << ((i - 8) << 3)); -+ else -+ user_position_h |= (pBeamformerEntry->user_position[i] << ((i - 12) << 3)); -+ } -+ /*select MU STA1 table*/ -+ pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); -+ pBeamformingInfo->RegMUTxCtrl |= BIT8; -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ ODM_SetBBReg(pDM_Odm, 0x14c4, bMaskDWord, gid_valid); -+ ODM_SetBBReg(pDM_Odm, 0x14c8, bMaskDWord, user_position_l); -+ ODM_SetBBReg(pDM_Odm, 0x14cc, bMaskDWord, user_position_h); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: STA1: gid_valid = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", -+ __func__, gid_valid, user_position_l, user_position_h)); -+ -+ /* Set validity of MU STA0 and MU STA1*/ -+ pBeamformingInfo->RegMUTxCtrl &= 0xFFFFFFC0; -+ pBeamformingInfo->RegMUTxCtrl |= 0x3; /* STA0, STA1*/ -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ -+} -+ -+ -+ -+#if 0 -+/*This function translate the bitmap to GTAB*/ -+VOID -+haltxbf8822b_gtab_translation( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u8 idx, gid; -+ u8 id1, id0; -+ u32 gid_valid[6] = {0}; -+ u32 user_position_lsb[6] = {0}; -+ u32 user_position_msb[6] = {0}; -+ -+ for (idx = 0; idx < 15; idx++) { -+ if (idx < 5) {/*bit0~4*/ -+ id0 = 0; -+ id1 = (u8)(idx + 1); -+ } else if (idx < 9) { /*bit5~8*/ -+ id0 = 1; -+ id1 = (u8)(idx - 3); -+ } else if (idx < 12) { /*bit9~11*/ -+ id0 = 2; -+ id1 = (u8)(idx - 6); -+ } else if (idx < 14) { /*bit12~13*/ -+ id0 = 3; -+ id1 = (u8)(idx - 8); -+ } else { /*bit14*/ -+ id0 = 4; -+ id1 = (u8)(idx - 9); -+ } -+ -+ /*Pair 1*/ -+ gid = (idx << 1) + 1; -+ gid_valid[id0] |= (1 << gid); -+ gid_valid[id1] |= (1 << gid); -+ if (gid < 16) { -+ /*user_position_lsb[id0] |= (0 << (gid << 1));*/ -+ user_position_lsb[id1] |= (1 << (gid << 1)); -+ } else { -+ /*user_position_msb[id0] |= (0 << ((gid - 16) << 1));*/ -+ user_position_msb[id1] |= (1 << ((gid - 16) << 1)); -+ } -+ -+ /*Pair 2*/ -+ gid += 1; -+ gid_valid[id0] |= (1 << gid); -+ gid_valid[id1] |= (1 << gid); -+ if (gid < 16) { -+ user_position_lsb[id0] |= (1 << (gid << 1)); -+ /*user_position_lsb[id1] |= (0 << (gid << 1));*/ -+ } else { -+ user_position_msb[id0] |= (1 << ((gid - 16) << 1)); -+ /*user_position_msb[id1] |= (0 << ((gid - 16) << 1));*/ -+ } -+ -+ } -+ -+ -+ for (idx = 0; idx < 6; idx++) { -+ /*DbgPrint("gid_valid[%d] = 0x%x\n", idx, gid_valid[idx]); -+ DbgPrint("user_position[%d] = 0x%x %x\n", idx, user_position_msb[idx], user_position_lsb[idx]);*/ -+ } -+} -+#endif -+ -+VOID -+HalTxbf8822B_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ) -+{ -+#if 0 -+ PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry+Idx; -+ -+ if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ halTxbf8822B_DownloadNDPA(Adapter, Idx); -+ -+ halTxbf8822B_FwTxBFCmd(Adapter); -+#endif -+} -+ -+#else /* (RTL8822B_SUPPORT == 1)*/ -+ -+#endif /* (RTL8822B_SUPPORT == 1)*/ -+ -+#endif /*(BEAMFORMING_SUPPORT == 1)*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8822b.h linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8822b.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8822b.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbf8822b.h 2017-06-07 23:07:21.032689489 +0300 -@@ -0,0 +1,53 @@ -+#ifndef __HAL_TXBF_8822B_H__ -+#define __HAL_TXBF_8822B_H__ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (RTL8822B_SUPPORT == 1) -+ -+VOID -+HalTxbf8822B_Init( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+HalTxbf8822B_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8822B_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8822B_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+VOID -+HalTxbf8822B_ConfigGtab( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+HalTxbf8822B_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+#else -+#define HalTxbf8822B_Init(pDM_VOID) -+#define HalTxbf8822B_Enter(pDM_VOID, Idx) -+#define HalTxbf8822B_Leave(pDM_VOID, Idx) -+#define HalTxbf8822B_Status(pDM_VOID, Idx) -+#define HalTxbf8822B_FwTxBF(pDM_VOID, Idx) -+#define HalTxbf8822B_ConfigGtab(pDM_VOID) -+#endif -+ -+ -+#endif -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfinterface.c linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfinterface.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfinterface.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfinterface.c 2017-06-07 23:07:21.032689489 +0300 -@@ -0,0 +1,1384 @@ -+//============================================================ -+// Description: -+// -+// This file is for TXBF interface mechanism -+// -+//============================================================ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+Beamforming_GidPAid( -+ PADAPTER Adapter, -+ PRT_TCB pTcb -+) -+{ -+ u1Byte Idx = 0; -+ u1Byte RA[6] ={0}; -+ pu1Byte pHeader = GET_FRAME_OF_FIRST_FRAG(Adapter, pTcb); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ -+ if (Adapter->HardwareType < HARDWARE_TYPE_RTL8192EE) -+ return; -+ else if (IS_WIRELESS_MODE_N(Adapter) == FALSE) -+ return; -+ -+#if (SUPPORT_MU_BF == 1) -+ if (pTcb->TxBFPktType == RT_BF_PKT_TYPE_BROADCAST_NDPA) { /* MU NDPA */ -+#else -+ if (0) { -+#endif -+ /* Fill G_ID and P_AID */ -+ pTcb->G_ID = 63; -+ if (pBeamInfo->FirstMUBFeeIndex < BEAMFORMEE_ENTRY_NUM) { -+ pTcb->P_AID = pBeamInfo->BeamformeeEntry[pBeamInfo->FirstMUBFeeIndex].P_AID; -+ RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, pTcb->G_ID, pTcb->P_AID)); -+ } -+ } else { -+ GET_80211_HDR_ADDRESS1(pHeader, &RA); -+ -+ // VHT SU PPDU carrying one or more group addressed MPDUs or -+ // Transmitting a VHT NDP intended for multiple recipients -+ if (MacAddr_isBcst(RA) || MacAddr_isMulticast(RA) || pTcb->macId == MAC_ID_STATIC_FOR_BROADCAST_MULTICAST) { -+ pTcb->G_ID = 63; -+ pTcb->P_AID = 0; -+ } else if (ACTING_AS_AP(Adapter)) { -+ u2Byte AID = (u2Byte) (MacIdGetOwnerAssociatedClientAID(Adapter, pTcb->macId) & 0x1ff); /*AID[0:8]*/ -+ -+ /*RT_DISP(FBEAM, FBEAM_FUN, ("@%s pTcb->macId=0x%X, AID=0x%X\n", __func__, pTcb->macId, AID));*/ -+ pTcb->G_ID = 63; -+ -+ if (AID == 0) /*A PPDU sent by an AP to a non associated STA*/ -+ pTcb->P_AID = 0; -+ else { /*Sent by an AP and addressed to a STA associated with that AP*/ -+ u2Byte BSSID = 0; -+ GET_80211_HDR_ADDRESS2(pHeader, &RA); -+ BSSID = ((RA[5] & 0xf0) >> 4) ^ (RA[5] & 0xf); /*BSSID[44:47] xor BSSID[40:43]*/ -+ pTcb->P_AID = (AID + BSSID *32) & 0x1ff; /*(dec(A) + dec(B)*32) mod 512*/ -+ } -+ } else if (ACTING_AS_IBSS(Adapter)) { -+ pTcb->G_ID = 63; -+ /*P_AID for infrasturcture mode; MACID for ad-hoc mode. */ -+ pTcb->P_AID = pTcb->macId; -+ } else if (MgntLinkStatusQuery(Adapter)) { /*Addressed to AP*/ -+ pTcb->G_ID = 0; -+ GET_80211_HDR_ADDRESS1(pHeader, &RA); -+ pTcb->P_AID = RA[5]; /*RA[39:47]*/ -+ pTcb->P_AID = (pTcb->P_AID << 1) | (RA[4] >> 7 ); -+ } else { -+ pTcb->G_ID = 63; -+ pTcb->P_AID = 0; -+ } -+ /*RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, pTcb->G_ID, pTcb->P_AID));*/ -+ } -+} -+ -+ -+RT_STATUS -+Beamforming_GetReportFrame( -+ IN PADAPTER Adapter, -+ IN PRT_RFD pRfd, -+ IN POCTET_STRING pPduOS -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; -+ pu1Byte pMIMOCtrlField, pCSIReport, pCSIMatrix; -+ u1Byte Idx, Nc, Nr, CH_W; -+ u2Byte CSIMatrixLen = 0; -+ -+ ACT_PKT_TYPE pktType = ACT_PKT_TYPE_UNKNOWN; -+ -+ //Memory comparison to see if CSI report is the same with previous one -+ pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, Frame_Addr2(*pPduOS), &Idx); -+ -+ if (pBeamformEntry == NULL) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Beamforming_GetReportFrame: Cannot find entry by addr\n")); -+ return RT_STATUS_FAILURE; -+ } -+ -+ pktType = PacketGetActionFrameType(pPduOS); -+ -+ //-@ Modified by David -+ if (pktType == ACT_PKT_VHT_COMPRESSED_BEAMFORMING) { -+ pMIMOCtrlField = pPduOS->Octet + 26; -+ Nc = ((*pMIMOCtrlField) & 0x7) + 1; -+ Nr = (((*pMIMOCtrlField) & 0x38) >> 3) + 1; -+ CH_W = (((*pMIMOCtrlField) & 0xC0) >> 6); -+ pCSIMatrix = pMIMOCtrlField + 3 + Nc; //24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(Nc=2) -+ CSIMatrixLen = pPduOS->Length - 26 -3 -Nc; -+ } else if (pktType == ACT_PKT_HT_COMPRESSED_BEAMFORMING) { -+ pMIMOCtrlField = pPduOS->Octet + 26; -+ Nc = ((*pMIMOCtrlField) & 0x3) + 1; -+ Nr = (((*pMIMOCtrlField) & 0xC) >> 2) + 1; -+ CH_W = (((*pMIMOCtrlField) & 0x10) >> 4); -+ pCSIMatrix = pMIMOCtrlField + 6 + Nr; //24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(Nc=2) -+ CSIMatrixLen = pPduOS->Length - 26 -6 -Nr; -+ } else -+ return RT_STATUS_SUCCESS; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] idx=%d, pkt type=%d, Nc=%d, Nr=%d, CH_W=%d\n", __func__, Idx, pktType, Nc, Nr, CH_W)); -+ -+ return RT_STATUS_SUCCESS; -+} -+ -+ -+VOID -+ConstructHTNDPAPacket( -+ PADAPTER Adapter, -+ pu1Byte RA, -+ pu1Byte Buffer, -+ pu4Byte pLength, -+ CHANNEL_WIDTH BW -+ ) -+{ -+ u2Byte Duration= 0; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ OCTET_STRING pNDPAFrame,ActionContent; -+ u1Byte ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; -+ -+ PlatformZeroMemory(Buffer, 32); -+ -+ SET_80211_HDR_FRAME_CONTROL(Buffer,0); -+ -+ SET_80211_HDR_ORDER(Buffer, 1); -+ SET_80211_HDR_TYPE_AND_SUBTYPE(Buffer,Type_Action_No_Ack); -+ -+ SET_80211_HDR_ADDRESS1(Buffer, RA); -+ SET_80211_HDR_ADDRESS2(Buffer, Adapter->CurrentAddress); -+ SET_80211_HDR_ADDRESS3(Buffer, pMgntInfo->Bssid); -+ -+ Duration = 2*aSifsTime + 40; -+ -+ if (BW == CHANNEL_WIDTH_40) -+ Duration+= 87; -+ else -+ Duration+= 180; -+ -+ SET_80211_HDR_DURATION(Buffer, Duration); -+ -+ //HT control field -+ SET_HT_CTRL_CSI_STEERING(Buffer+sMacHdrLng, 3); -+ SET_HT_CTRL_NDP_ANNOUNCEMENT(Buffer+sMacHdrLng, 1); -+ -+ FillOctetString(pNDPAFrame, Buffer, sMacHdrLng+sHTCLng); -+ -+ FillOctetString(ActionContent, ActionHdr, 4); -+ PacketAppendData(&pNDPAFrame, ActionContent); -+ -+ *pLength = 32; -+} -+ -+ -+ -+ -+BOOLEAN -+SendFWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u4Byte BufLen; -+ pu1Byte BufAddr; -+ u1Byte DescLen = 0, Idx = 0, NDPTxRate; -+ PADAPTER pDefAdapter = GetDefaultAdapter(Adapter); -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pBeamformEntry == NULL) -+ return FALSE; -+ -+ NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetFWBuffer(pDefAdapter, &pTcb, &pBuf)) { -+#if(DEV_BUS_TYPE != RT_PCI_INTERFACE) -+ DescLen = Adapter->HWDescHeadLength - pHalData->USBALLDummyLength; -+#endif -+ BufAddr = pBuf->Buffer.VirtualAddress + DescLen; -+ -+ ConstructHTNDPAPacket( -+ Adapter, -+ RA, -+ BufAddr, -+ &BufLen, -+ BW -+ ); -+ -+ pTcb->PacketLength = BufLen + DescLen; -+ -+ pTcb->bTxEnableSwCalcDur = TRUE; -+ -+ pTcb->BWOfPacket = BW; -+ -+ if(ACTING_AS_IBSS(Adapter) || ACTING_AS_AP(Adapter)) -+ pTcb->G_ID = 63; -+ -+ pTcb->P_AID = pBeamformEntry->P_AID; -+ pTcb->DataRate = NDPTxRate; /*rate of NDP decide by Nr*/ -+ -+ Adapter->HalFunc.CmdSendPacketHandler(Adapter, pTcb, pBuf, pTcb->PacketLength, DESC_PACKET_TYPE_NORMAL, FALSE); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+} -+ -+ -+BOOLEAN -+SendSWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u1Byte Idx = 0, NDPTxRate = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { -+ ConstructHTNDPAPacket( -+ Adapter, -+ RA, -+ pBuf->Buffer.VirtualAddress, -+ &pTcb->PacketLength, -+ BW -+ ); -+ -+ pTcb->bTxEnableSwCalcDur = TRUE; -+ -+ pTcb->BWOfPacket = BW; -+ -+ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+} -+ -+ -+ -+VOID -+ConstructVHTNDPAPacket( -+ IN PDM_ODM_T pDM_Odm, -+ pu1Byte RA, -+ u2Byte AID, -+ pu1Byte Buffer, -+ pu4Byte pLength, -+ CHANNEL_WIDTH BW -+ ) -+{ -+ u2Byte Duration= 0; -+ u1Byte Sequence = 0; -+ pu1Byte pNDPAFrame = Buffer; -+ RT_NDPA_STA_INFO STAInfo; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ u1Byte Idx = 0; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ // Frame control. -+ SET_80211_HDR_FRAME_CONTROL(pNDPAFrame, 0); -+ SET_80211_HDR_TYPE_AND_SUBTYPE(pNDPAFrame, Type_NDPA); -+ -+ SET_80211_HDR_ADDRESS1(pNDPAFrame, RA); -+ SET_80211_HDR_ADDRESS2(pNDPAFrame, pBeamformEntry->MyMacAddr); -+ -+ Duration = 2*aSifsTime + 44; -+ -+ if (BW == CHANNEL_WIDTH_80) -+ Duration += 40; -+ else if(BW == CHANNEL_WIDTH_40) -+ Duration+= 87; -+ else -+ Duration+= 180; -+ -+ SET_80211_HDR_DURATION(pNDPAFrame, Duration); -+ -+ Sequence = *(pDM_Odm->pSoundingSeq) << 2; -+ ODM_MoveMemory(pDM_Odm, pNDPAFrame+16, &Sequence, 1); -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS) || phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP) == FALSE) -+ AID = 0; -+ -+ STAInfo.AID = AID; -+ STAInfo.FeedbackType = 0; -+ STAInfo.NcIndex = 0; -+ -+ ODM_MoveMemory(pDM_Odm, pNDPAFrame+17, (pu1Byte)&STAInfo, 2); -+ -+ *pLength = 19; -+} -+ -+ -+BOOLEAN -+SendFWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u4Byte BufLen; -+ pu1Byte BufAddr; -+ u1Byte DescLen = 0, Idx = 0, NDPTxRate = 0; -+ PADAPTER pDefAdapter = GetDefaultAdapter(Adapter); -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry =phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pBeamformEntry == NULL) -+ return FALSE; -+ -+ NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetFWBuffer(pDefAdapter, &pTcb, &pBuf)) { -+#if(DEV_BUS_TYPE != RT_PCI_INTERFACE) -+ DescLen = Adapter->HWDescHeadLength - pHalData->USBALLDummyLength; -+#endif -+ BufAddr = pBuf->Buffer.VirtualAddress + DescLen; -+ -+ ConstructVHTNDPAPacket( -+ pDM_Odm, -+ RA, -+ AID, -+ BufAddr, -+ &BufLen, -+ BW -+ ); -+ -+ pTcb->PacketLength = BufLen + DescLen; -+ -+ pTcb->bTxEnableSwCalcDur = TRUE; -+ -+ pTcb->BWOfPacket = BW; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS) || phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) -+ pTcb->G_ID = 63; -+ -+ pTcb->P_AID = pBeamformEntry->P_AID; -+ pTcb->DataRate = NDPTxRate; /*decide by Nr*/ -+ -+ Adapter->HalFunc.CmdSendPacketHandler(Adapter, pTcb, pBuf, pTcb->PacketLength, DESC_PACKET_TYPE_NORMAL, FALSE); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End, ret=%d\n", __func__, ret)); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+} -+ -+ -+ -+BOOLEAN -+SendSWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u1Byte Idx = 0, NDPTxRate = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { -+ ConstructVHTNDPAPacket( -+ pDM_Odm, -+ RA, -+ AID, -+ pBuf->Buffer.VirtualAddress, -+ &pTcb->PacketLength, -+ BW -+ ); -+ -+ pTcb->bTxEnableSwCalcDur = TRUE; -+ pTcb->BWOfPacket = BW; -+ -+ /*rate of NDP decide by Nr*/ -+ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+} -+ -+#ifdef SUPPORT_MU_BF -+#if (SUPPORT_MU_BF == 1) -+/* -+// Description: On VHT GID management frame by an MU beamformee. -+// -+// 2015.05.20. Created by tynli. -+*/ -+RT_STATUS -+Beamforming_GetVHTGIDMgntFrame( -+ IN PADAPTER Adapter, -+ IN PRT_RFD pRfd, -+ IN POCTET_STRING pPduOS -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ RT_STATUS rtStatus = RT_STATUS_SUCCESS; -+ pu1Byte pBuffer = NULL; -+ pu1Byte pRaddr = NULL; -+ u1Byte MemStatus[8] = {0}, UserPos[16] = {0}; -+ u1Byte idx; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMER_ENTRY pBeamformEntry = &pBeamInfo->BeamformerEntry[pBeamInfo->mu_ap_index]; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] On VHT GID mgnt frame!\n", __func__)); -+ -+ /* Check length*/ -+ if (pPduOS->Length < (FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY+16)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Beamforming_GetVHTGIDMgntFrame(): Invalid length (%d)\n", pPduOS->Length)); -+ return RT_STATUS_INVALID_LENGTH; -+ } -+ -+ /* Check RA*/ -+ pRaddr = (pu1Byte)(pPduOS->Octet)+4; -+ if (!eqMacAddr(pRaddr, Adapter->CurrentAddress)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Beamforming_GetVHTGIDMgntFrame(): Drop because of RA error.\n")); -+ return RT_STATUS_PKT_DROP; -+ } -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "On VHT GID Mgnt Frame ==>:\n", pPduOS->Octet, pPduOS->Length); -+ -+ /*Parsing Membership Status Array*/ -+ pBuffer = pPduOS->Octet + FRAME_OFFSET_VHT_GID_MGNT_MEMBERSHIP_STATUS_ARRAY; -+ for (idx = 0; idx < 8; idx++) { -+ MemStatus[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(pBuffer+idx); -+ pBeamformEntry->gid_valid[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(pBuffer+idx); -+ } -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "MemStatus: ", MemStatus, 8); -+ -+ /* Parsing User Position Array*/ -+ pBuffer = pPduOS->Octet + FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY; -+ for (idx = 0; idx < 16; idx++) { -+ UserPos[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(pBuffer+idx); -+ pBeamformEntry->user_position[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(pBuffer+idx); -+ } -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "UserPos: ", UserPos, 16); -+ -+ /* Group ID detail printed*/ -+ { -+ u1Byte i, j; -+ u1Byte tmpVal; -+ u2Byte tmpVal2; -+ -+ for (i = 0; i < 8; i++) { -+ tmpVal = MemStatus[i]; -+ tmpVal2 = ((UserPos[i*2 + 1] << 8) & 0xFF00) + (UserPos[i * 2] & 0xFF); -+ for (j = 0; j < 8; j++) { -+ if ((tmpVal >> j) & BIT0) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Use Group ID (%d), User Position (%d)\n", -+ (i*8+j), (tmpVal2 >> 2 * j)&0x3)); -+ } -+ } -+ } -+ } -+ -+ /* Indicate GID frame to IHV service. */ -+ { -+ u1Byte Indibuffer[24] = {0}; -+ u1Byte Indioffset = 0; -+ -+ PlatformMoveMemory(Indibuffer + Indioffset, pBeamformEntry->gid_valid, 8); -+ Indioffset += 8; -+ PlatformMoveMemory(Indibuffer + Indioffset, pBeamformEntry->user_position, 16); -+ Indioffset += 16; -+ -+ PlatformIndicateCustomStatus( -+ Adapter, -+ RT_CUSTOM_EVENT_VHT_RECV_GID_MGNT_FRAME, -+ RT_CUSTOM_INDI_TARGET_IHV, -+ Indibuffer, -+ Indioffset); -+ } -+ -+ /* Config HW GID table */ -+ halComTxbf_ConfigGtab(pDM_Odm); -+ -+ return rtStatus; -+} -+ -+/* -+// Description: Construct VHT Group ID (GID) management frame. -+// -+// 2015.05.20. Created by tynli. -+*/ -+VOID -+ConstructVHTGIDMgntFrame( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte RA, -+ IN PRT_BEAMFORMEE_ENTRY pBeamformEntry, -+ OUT pu1Byte Buffer, -+ OUT pu4Byte pLength -+ -+) -+{ -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ OCTET_STRING osFTMFrame, tmp; -+ -+ FillOctetString(osFTMFrame, Buffer, 0); -+ *pLength = 0; -+ -+ ConstructMaFrameHdr( -+ Adapter, -+ RA, -+ ACT_CAT_VHT, -+ ACT_VHT_GROUPID_MANAGEMENT, -+ &osFTMFrame); -+ -+ /* Membership Status Array*/ -+ FillOctetString(tmp, pBeamformEntry->gid_valid, 8); -+ PacketAppendData(&osFTMFrame, tmp); -+ -+ /* User Position Array*/ -+ FillOctetString(tmp, pBeamformEntry->user_position, 16); -+ PacketAppendData(&osFTMFrame, tmp); -+ -+ *pLength = osFTMFrame.Length; -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "ConstructVHTGIDMgntFrame():\n", Buffer, *pLength); -+} -+ -+BOOLEAN -+SendSWVHTGIDMgntFrame( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u1Byte DataRate = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = &pBeamInfo->BeamformeeEntry[Idx]; -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { -+ ConstructVHTGIDMgntFrame( -+ pDM_Odm, -+ RA, -+ pBeamformEntry, -+ pBuf->Buffer.VirtualAddress, -+ &pTcb->PacketLength -+ ); -+ -+ pTcb->BWOfPacket = CHANNEL_WIDTH_20; -+ DataRate = MGN_6M; -+ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, DataRate); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+} -+ -+ -+/* -+// Description: Construct VHT beamforming report poll. -+// -+// 2015.05.20. Created by tynli. -+*/ -+VOID -+ConstructVHTBFReportPoll( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte RA, -+ OUT pu1Byte Buffer, -+ OUT pu4Byte pLength -+) -+{ -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ pu1Byte pBFRptPoll = Buffer; -+ -+ /* Frame control*/ -+ SET_80211_HDR_FRAME_CONTROL(pBFRptPoll, 0); -+ SET_80211_HDR_TYPE_AND_SUBTYPE(pBFRptPoll, Type_Beamforming_Report_Poll); -+ -+ /* Duration*/ -+ SET_80211_HDR_DURATION(pBFRptPoll, 100); -+ -+ /* RA*/ -+ SET_VHT_BF_REPORT_POLL_RA(pBFRptPoll, RA); -+ -+ /* TA*/ -+ SET_VHT_BF_REPORT_POLL_TA(pBFRptPoll, Adapter->CurrentAddress); -+ -+ /* Feedback Segment Retransmission Bitmap*/ -+ SET_VHT_BF_REPORT_POLL_FEEDBACK_SEG_RETRAN_BITMAP(pBFRptPoll, 0xFF); -+ -+ *pLength = 17; -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "ConstructVHTBFReportPoll():\n", Buffer, *pLength); -+ -+} -+ -+BOOLEAN -+SendSWVHTBFReportPoll( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN BOOLEAN bFinalPoll -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u1Byte Idx = 0, DataRate = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { -+ ConstructVHTBFReportPoll( -+ pDM_Odm, -+ RA, -+ pBuf->Buffer.VirtualAddress, -+ &pTcb->PacketLength -+ ); -+ -+ pTcb->bTxEnableSwCalcDur = TRUE; /* need?*/ -+ pTcb->BWOfPacket = CHANNEL_WIDTH_20; -+ -+ if (bFinalPoll) -+ pTcb->TxBFPktType = RT_BF_PKT_TYPE_FINAL_BF_REPORT_POLL; -+ else -+ pTcb->TxBFPktType = RT_BF_PKT_TYPE_BF_REPORT_POLL; -+ -+ DataRate = MGN_6M; /* Legacy OFDM rate*/ -+ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, DataRate); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "SendSWVHTBFReportPoll():\n", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+ -+} -+ -+ -+/* -+// Description: Construct VHT MU NDPA packet. -+// We should combine this function with ConstructVHTNDPAPacket() in the future. -+// -+// 2015.05.21. Created by tynli. -+*/ -+VOID -+ConstructVHTMUNDPAPacket( -+ IN PDM_ODM_T pDM_Odm, -+ IN CHANNEL_WIDTH BW, -+ OUT pu1Byte Buffer, -+ OUT pu4Byte pLength -+ ) -+{ -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ u2Byte Duration = 0; -+ u1Byte Sequence = 0; -+ pu1Byte pNDPAFrame = Buffer; -+ RT_NDPA_STA_INFO STAInfo; -+ u1Byte idx; -+ u1Byte DestAddr[6] = {0}; -+ PRT_BEAMFORMEE_ENTRY pEntry = NULL; -+ -+ /* Fill the first MU BFee entry (STA1) MAC addr to destination address then -+ HW will change A1 to broadcast addr. 2015.05.28. Suggested by SD1 Chunchu. */ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ pEntry = &(pBeamInfo->BeamformeeEntry[idx]); -+ if (pEntry->is_mu_sta) { -+ cpMacAddr(DestAddr, pEntry->MacAddr); -+ break; -+ } -+ } -+ if (pEntry == NULL) -+ return; -+ -+ /* Frame control.*/ -+ SET_80211_HDR_FRAME_CONTROL(pNDPAFrame, 0); -+ SET_80211_HDR_TYPE_AND_SUBTYPE(pNDPAFrame, Type_NDPA); -+ -+ SET_80211_HDR_ADDRESS1(pNDPAFrame, DestAddr); -+ SET_80211_HDR_ADDRESS2(pNDPAFrame, pEntry->MyMacAddr); -+ -+ /*--------------------------------------------*/ -+ /* Need to modify "Duration" to MU consideration. */ -+ Duration = 2*aSifsTime + 44; -+ -+ if (BW == CHANNEL_WIDTH_80) -+ Duration += 40; -+ else if(BW == CHANNEL_WIDTH_40) -+ Duration+= 87; -+ else -+ Duration+= 180; -+ /*--------------------------------------------*/ -+ -+ SET_80211_HDR_DURATION(pNDPAFrame, Duration); -+ -+ Sequence = *(pDM_Odm->pSoundingSeq) << 2; -+ ODM_MoveMemory(pDM_Odm, pNDPAFrame + 16, &Sequence, 1); -+ -+ *pLength = 17; -+ -+ /* Construct STA info. for multiple STAs*/ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ pEntry = &(pBeamInfo->BeamformeeEntry[idx]); -+ if (pEntry->is_mu_sta) { -+ STAInfo.AID = pEntry->AID; -+ STAInfo.FeedbackType = 1; /* 1'b1: MU*/ -+ STAInfo.NcIndex = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get BeamformeeEntry idx(%d), AID =%d\n", __func__, idx, pEntry->AID)); -+ -+ ODM_MoveMemory(pDM_Odm, pNDPAFrame+(*pLength), (pu1Byte)&STAInfo, 2); -+ *pLength += 2; -+ } -+ } -+ -+} -+ -+BOOLEAN -+SendSWVHTMUNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u1Byte NDPTxRate = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ -+ NDPTxRate = MGN_VHT2SS_MCS0; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { -+ ConstructVHTMUNDPAPacket( -+ pDM_Odm, -+ BW, -+ pBuf->Buffer.VirtualAddress, -+ &pTcb->PacketLength -+ ); -+ -+ pTcb->bTxEnableSwCalcDur = TRUE; -+ pTcb->BWOfPacket = BW; -+ pTcb->TxBFPktType = RT_BF_PKT_TYPE_BROADCAST_NDPA; -+ -+ /*rate of NDP decide by Nr*/ -+ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+} -+ -+#endif /*#if (SUPPORT_MU_BF == 1)*/ -+#endif /*#ifdef SUPPORT_MU_BF*/ -+ -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+u4Byte -+Beamforming_GetReportFrame( -+ IN PVOID pDM_VOID, -+ union recv_frame *precv_frame -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte ret = _SUCCESS; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; -+ pu1Byte pframe = precv_frame->u.hdr.rx_data; -+ u4Byte frame_len = precv_frame->u.hdr.len; -+ pu1Byte TA; -+ u1Byte Idx, offset; -+ -+ /*DBG_871X("beamforming_get_report_frame\n");*/ -+ -+ /*Memory comparison to see if CSI report is the same with previous one*/ -+ TA = GetAddr2Ptr(pframe); -+ pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, TA, &Idx); -+ if(pBeamformEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) -+ offset = 31; /*24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ -+ else if(pBeamformEntry->BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT) -+ offset = 34; /*24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ -+ else -+ return ret; -+ -+ /*DBG_871X("%s MacId %d offset=%d\n", __FUNCTION__, pBeamformEntry->mac_id, offset);*/ -+ -+ return ret; -+} -+ -+ -+BOOLEAN -+SendFWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u1Byte ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; -+ u1Byte *pframe; -+ u2Byte *fctrl; -+ u2Byte duration = 0; -+ u1Byte aSifsTime = 0, NDPTxRate = 0, Idx = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ DBG_871X("%s, alloc mgnt frame fail\n", __func__); -+ return _FALSE; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ -+ pattrib->qsel = QSLT_BEACON; -+ NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ pattrib->rate = NDPTxRate; -+ pattrib->bwmode = BW; -+ pattrib->order = 1; -+ pattrib->subtype = WIFI_ACTION_NOACK; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetOrderBit(pframe); -+ SetFrameSubType(pframe, WIFI_ACTION_NOACK); -+ -+ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ if( pmlmeext->cur_wireless_mode == WIRELESS_11B) -+ aSifsTime = 10; -+ else -+ aSifsTime = 16; -+ -+ duration = 2*aSifsTime + 40; -+ -+ if(BW == CHANNEL_WIDTH_40) -+ duration+= 87; -+ else -+ duration+= 180; -+ -+ SetDuration(pframe, duration); -+ -+ //HT control field -+ SET_HT_CTRL_CSI_STEERING(pframe+24, 3); -+ SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe+24, 1); -+ -+ _rtw_memcpy(pframe+28, ActionHdr, 4); -+ -+ pattrib->pktlen = 32; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+ -+BOOLEAN -+SendSWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u1Byte ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; -+ pu1Byte pframe; -+ pu2Byte fctrl; -+ u2Byte duration = 0; -+ u1Byte aSifsTime = 0, NDPTxRate = 0, Idx = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ DBG_871X("%s, alloc mgnt frame fail\n", __func__); -+ return _FALSE; -+ } -+ -+ /*update attribute*/ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ pattrib->qsel = QSLT_MGNT; -+ pattrib->rate = NDPTxRate; -+ pattrib->bwmode = BW; -+ pattrib->order = 1; -+ pattrib->subtype = WIFI_ACTION_NOACK; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetOrderBit(pframe); -+ SetFrameSubType(pframe, WIFI_ACTION_NOACK); -+ -+ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ if (pmlmeext->cur_wireless_mode == WIRELESS_11B) -+ aSifsTime = 10; -+ else -+ aSifsTime = 16; -+ -+ duration = 2*aSifsTime + 40; -+ -+ if (BW == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ SetDuration(pframe, duration); -+ -+ /*HT control field*/ -+ SET_HT_CTRL_CSI_STEERING(pframe+24, 3); -+ SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe+24, 1); -+ -+ _rtw_memcpy(pframe+28, ActionHdr, 4); -+ -+ pattrib->pktlen = 32; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+ -+BOOLEAN -+SendFWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ pu1Byte pframe; -+ pu2Byte fctrl; -+ u2Byte duration = 0; -+ u1Byte sequence = 0, aSifsTime = 0, NDPTxRate= 0, Idx = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ RT_NDPA_STA_INFO sta_info; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ DBG_871X("%s, alloc mgnt frame fail\n", __func__); -+ return _FALSE; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ _rtw_memcpy(pattrib->ra, RA, ETH_ALEN); -+ update_mgntframe_attrib(Adapter, pattrib); -+ -+ pattrib->qsel = QSLT_BEACON; -+ NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ pattrib->rate = NDPTxRate; -+ pattrib->bwmode = BW; -+ pattrib->subtype = WIFI_NDPA; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetFrameSubType(pframe, WIFI_NDPA); -+ -+ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); -+ -+ if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ duration = 2*aSifsTime + 44; -+ -+ if(BW == CHANNEL_WIDTH_80) -+ duration += 40; -+ else if(BW == CHANNEL_WIDTH_40) -+ duration+= 87; -+ else -+ duration+= 180; -+ -+ SetDuration(pframe, duration); -+ -+ sequence = pBeamInfo->SoundingSequence<< 2; -+ if (pBeamInfo->SoundingSequence >= 0x3f) -+ pBeamInfo->SoundingSequence = 0; -+ else -+ pBeamInfo->SoundingSequence++; -+ -+ _rtw_memcpy(pframe+16, &sequence,1); -+ -+ if (((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ AID = 0; -+ -+ sta_info.AID = AID; -+ sta_info.FeedbackType = 0; -+ sta_info.NcIndex= 0; -+ -+ _rtw_memcpy(pframe+17, (u8 *)&sta_info, 2); -+ -+ pattrib->pktlen = 19; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+ -+ -+BOOLEAN -+SendSWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ RT_NDPA_STA_INFO ndpa_sta_info; -+ u1Byte NDPTxRate = 0, sequence = 0, aSifsTime = 0, Idx = 0; -+ pu1Byte pframe; -+ pu2Byte fctrl; -+ u2Byte duration = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ DBG_871X("%s, alloc mgnt frame fail\n", __func__); -+ return _FALSE; -+ } -+ -+ /*update attribute*/ -+ pattrib = &pmgntframe->attrib; -+ _rtw_memcpy(pattrib->ra, RA, ETH_ALEN); -+ update_mgntframe_attrib(Adapter, pattrib); -+ pattrib->qsel = QSLT_MGNT; -+ pattrib->rate = NDPTxRate; -+ pattrib->bwmode = BW; -+ pattrib->subtype = WIFI_NDPA; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetFrameSubType(pframe, WIFI_NDPA); -+ -+ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); -+ -+ if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ duration = 2*aSifsTime + 44; -+ -+ if (BW == CHANNEL_WIDTH_80) -+ duration += 40; -+ else if (BW == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ SetDuration(pframe, duration); -+ -+ sequence = pBeamInfo->SoundingSequence << 2; -+ if (pBeamInfo->SoundingSequence >= 0x3f) -+ pBeamInfo->SoundingSequence = 0; -+ else -+ pBeamInfo->SoundingSequence++; -+ -+ _rtw_memcpy(pframe+16, &sequence, 1); -+ if (((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ AID = 0; -+ -+ ndpa_sta_info.AID = AID; -+ ndpa_sta_info.FeedbackType = 0; -+ ndpa_sta_info.NcIndex = 0; -+ -+ _rtw_memcpy(pframe+17, (u8 *)&ndpa_sta_info, 2); -+ -+ pattrib->pktlen = 19; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] [%d]\n", __func__, __LINE__)); -+ -+ return _TRUE; -+} -+ -+ -+#endif -+ -+ -+VOID -+Beamforming_GetNDPAFrame( -+ IN PVOID pDM_VOID, -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN OCTET_STRING pduOS -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ union recv_frame *precv_frame -+#endif -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ pu1Byte TA ; -+ u1Byte Idx, Sequence; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pu1Byte pNDPAFrame = pduOS.Octet; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ pu1Byte pNDPAFrame = precv_frame->u.hdr.rx_data; -+#endif -+ PRT_BEAMFORMER_ENTRY pBeamformerEntry = NULL; /*Modified By Jeffery @2014-10-29*/ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "Beamforming_GetNDPAFrame\n", pduOS.Octet, pduOS.Length); -+ if (IsCtrlNDPA(pNDPAFrame) == FALSE) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (GetFrameSubType(pNDPAFrame) != WIFI_NDPA) -+#endif -+ return; -+ else if (!(pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8821))) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] not 8812 or 8821A, return\n", __func__)); -+ return; -+ } -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ TA = Frame_Addr2(pduOS); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ TA = GetAddr2Ptr(pNDPAFrame); -+#endif -+ /*Remove signaling TA. */ -+ TA[0] = TA[0] & 0xFE; -+ -+ pBeamformerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, TA, &Idx); // Modified By Jeffery @2014-10-29 -+ -+ /*Break options for Clock Reset*/ -+ if (pBeamformerEntry == NULL) -+ return; -+ else if (!(pBeamformerEntry->BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU)) -+ return; -+ /*LogSuccess: As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is NO LONGER needed !2015-04-10, Jeffery*/ -+ /*ClockResetTimes: While BFer entry always doesn't receive our CSI, clock will reset again and again.So ClockResetTimes is limited to 5 times.2015-04-13, Jeffery*/ -+ else if ((pBeamformerEntry->LogSuccess == 1) || (pBeamformerEntry->ClockResetTimes == 5)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] LogSeq=%d, PreLogSeq=%d, LogRetryCnt=%d, LogSuccess=%d, ClockResetTimes=%d, clock reset is no longer needed.\n", -+ __func__, pBeamformerEntry->LogSeq, pBeamformerEntry->PreLogSeq, pBeamformerEntry->LogRetryCnt, pBeamformerEntry->LogSuccess, pBeamformerEntry->ClockResetTimes)); -+ -+ return; -+ } -+ -+ Sequence = (pNDPAFrame[16]) >> 2; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start, Sequence=%d, LogSeq=%d, PreLogSeq=%d, LogRetryCnt=%d, ClockResetTimes=%d, LogSuccess=%d\n", -+ __func__, Sequence, pBeamformerEntry->LogSeq, pBeamformerEntry->PreLogSeq, pBeamformerEntry->LogRetryCnt, pBeamformerEntry->ClockResetTimes, pBeamformerEntry->LogSuccess)); -+ -+ if ((pBeamformerEntry->LogSeq != 0) && (pBeamformerEntry->PreLogSeq != 0)) { -+ /*Success condition*/ -+ if ((pBeamformerEntry->LogSeq != Sequence) && (pBeamformerEntry->PreLogSeq != pBeamformerEntry->LogSeq)) { -+ /* break option for clcok reset, 2015-03-30, Jeffery */ -+ pBeamformerEntry->LogRetryCnt = 0; -+ /*As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is no longer needed.*/ -+ /*That is, LogSuccess is NOT needed to be reset to zero, 2015-04-13, Jeffery*/ -+ pBeamformerEntry->LogSuccess = 1; -+ -+ } else {/*Fail condition*/ -+ -+ if (pBeamformerEntry->LogRetryCnt == 5) { -+ pBeamformerEntry->ClockResetTimes++; -+ pBeamformerEntry->LogRetryCnt = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Clock Reset!!! ClockResetTimes=%d\n", -+ __func__, pBeamformerEntry->ClockResetTimes)); -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_CLK, NULL); -+ -+ } else -+ pBeamformerEntry->LogRetryCnt++; -+ } -+ } -+ -+ /*Update LogSeq & PreLogSeq*/ -+ pBeamformerEntry->PreLogSeq = pBeamformerEntry->LogSeq; -+ pBeamformerEntry->LogSeq = Sequence; -+ -+} -+ -+ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfinterface.h linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfinterface.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfinterface.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfinterface.h 2017-06-07 23:07:21.032689489 +0300 -@@ -0,0 +1,158 @@ -+#ifndef __HAL_TXBF_INTERFACE_H__ -+#define __HAL_TXBF_INTERFACE_H__ -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+Beamforming_GidPAid( -+ PADAPTER Adapter, -+ PRT_TCB pTcb -+ ); -+ -+RT_STATUS -+Beamforming_GetReportFrame( -+ IN PADAPTER Adapter, -+ IN PRT_RFD pRfd, -+ IN POCTET_STRING pPduOS -+ ); -+ -+VOID -+Beamforming_GetNDPAFrame( -+ IN PVOID pDM_VOID, -+ IN OCTET_STRING pduOS -+ ); -+ -+BOOLEAN -+SendFWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+BOOLEAN -+SendFWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+BOOLEAN -+SendSWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+BOOLEAN -+SendSWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+#ifdef SUPPORT_MU_BF -+#if (SUPPORT_MU_BF == 1) -+RT_STATUS -+Beamforming_GetVHTGIDMgntFrame( -+ IN PADAPTER Adapter, -+ IN PRT_RFD pRfd, -+ IN POCTET_STRING pPduOS -+ ); -+ -+BOOLEAN -+SendSWVHTGIDMgntFrame( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u1Byte Idx -+ ); -+ -+BOOLEAN -+SendSWVHTBFReportPoll( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN BOOLEAN bFinalPoll -+ ); -+ -+BOOLEAN -+SendSWVHTMUNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN CHANNEL_WIDTH BW -+ ); -+#else -+#define Beamforming_GetVHTGIDMgntFrame(Adapter, pRfd, pPduOS) RT_STATUS_FAILURE -+#define SendSWVHTGIDMgntFrame(pDM_VOID, RA) -+#define SendSWVHTBFReportPoll(pDM_VOID, RA, bFinalPoll) -+#define SendSWVHTMUNDPAPacket(pDM_VOID, BW) -+#endif -+#endif -+ -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+u4Byte -+Beamforming_GetReportFrame( -+ IN PVOID pDM_VOID, -+ union recv_frame *precv_frame -+ ); -+ -+BOOLEAN -+SendFWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+BOOLEAN -+SendSWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+BOOLEAN -+SendFWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+BOOLEAN -+SendSWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ); -+#endif -+ -+VOID -+Beamforming_GetNDPAFrame( -+ IN PVOID pDM_VOID, -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN OCTET_STRING pduOS -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ union recv_frame *precv_frame -+#endif -+); -+ -+#else -+#define Beamforming_GetNDPAFrame(pDM_Odm, _PduOS) -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#define Beamforming_GetReportFrame(Adapter, precv_frame) RT_STATUS_FAILURE -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define Beamforming_GetReportFrame(Adapter, pRfd, pPduOS) RT_STATUS_FAILURE -+#define Beamforming_GetVHTGIDMgntFrame(Adapter, pRfd, pPduOS) RT_STATUS_FAILURE -+#endif -+#define SendFWHTNDPAPacket(pDM_VOID, RA, BW) -+#define SendSWHTNDPAPacket(pDM_VOID, RA, BW) -+#define SendFWVHTNDPAPacket(pDM_VOID, RA, AID, BW) -+#define SendSWVHTNDPAPacket(pDM_VOID, RA, AID, BW) -+#define SendSWVHTGIDMgntFrame(pDM_VOID, RA, idx) -+#define SendSWVHTBFReportPoll(pDM_VOID, RA, bFinalPoll) -+#define SendSWVHTMUNDPAPacket(pDM_VOID, BW) -+#endif -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfjaguar.c linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfjaguar.c ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfjaguar.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfjaguar.c 2017-06-07 23:07:21.032689489 +0300 -@@ -0,0 +1,527 @@ -+//============================================================ -+// Description: -+// -+// This file is for 8812/8821/8811 TXBF mechanism -+// -+//============================================================ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -+VOID -+HalTxbf8812A_setNDPArate( -+ IN PVOID pDM_VOID, -+ IN u1Byte BW, -+ IN u1Byte Rate -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8812A, (Rate << 2 | BW)); -+ -+} -+ -+VOID -+halTxbfJaguar_RfMode( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORMING_INFO pBeamInfo -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->RFType == ODM_1T1R) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] set TxIQGen\n", __func__)); -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000, 0x1); /*RF Mode table write enable*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000, 0x1); /*RF Mode table write enable*/ -+ -+ if (pBeamInfo->beamformee_su_cnt > 0) { -+ // Paath_A -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ -+ // Path_B -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ -+ } else { -+ // Paath_A -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ -+ // Path_B -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ -+ } -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000, 0x0); /*RF Mode table write disable*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000, 0x0); /*RF Mode table write disable*/ -+ -+ if (pBeamInfo->beamformee_su_cnt > 0) -+ ODM_SetBBReg(pDM_Odm, rTxPath_Jaguar, bMaskByte1, 0x33); -+ else -+ ODM_SetBBReg(pDM_Odm, rTxPath_Jaguar, bMaskByte1, 0x11); -+} -+ -+ -+VOID -+halTxbfJaguar_DownloadNDPA( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte u1bTmp = 0, tmpReg422 = 0, Head_Page; -+ u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; -+ BOOLEAN bSendBeacon = FALSE; -+ u1Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; /*default reseved 1 page for the IC type which is undefined.*/ -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *pDM_Odm->pbFwDwRsvdPageInProgress = TRUE; -+#endif -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (Idx == 0) -+ Head_Page = 0xFE; -+ else -+ Head_Page = 0xFE; -+ -+ Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu1Byte)&TxPageBndy); -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8812A + 1); -+ ODM_Write1Byte(pDM_Odm, REG_CR_8812A + 1, (u1bTmp | BIT0)); -+ -+ -+ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ tmpReg422 = ODM_Read1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8812A + 2); -+ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8812A + 2, tmpReg422 & (~BIT6)); -+ -+ if (tmpReg422 & BIT6) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("SetBeamformDownloadNDPA_8812(): There is an Adapter is sending beacon.\n")); -+ bSendBeacon = TRUE; -+ } -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 1, Head_Page); -+ -+ do { -+ /*Clear beacon valid check bit.*/ -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); -+ ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 2, (BcnValidReg | BIT0)); -+ -+ /*download NDPA rsvd page.*/ -+ if (pBeamEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) -+ Beamforming_SendVHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->AID, pBeamEntry->SoundBW, BEACON_QUEUE); -+ else -+ Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); -+ -+ /*check rsvd page download OK.*/ -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); -+ count = 0; -+ while (!(BcnValidReg & BIT0) && count < 20) { -+ count++; -+ ODM_delay_ms(10); -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); -+ } -+ DLBcnCount++; -+ } while (!(BcnValidReg & BIT0) && DLBcnCount < 5); -+ -+ if (!(BcnValidReg & BIT0)) -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Download RSVD page failed!\n", __func__)); -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 1, TxPageBndy); -+ -+ /*To make sure that if there exists an adapter which would like to send beacon.*/ -+ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ -+ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause*/ -+ /*the beacon cannot be sent by HW.*/ -+ /*2010.06.23. Added by tynli.*/ -+ if (bSendBeacon) -+ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8812A + 2, tmpReg422); -+ -+ /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ -+ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8812A + 1); -+ ODM_Write1Byte(pDM_Odm, REG_CR_8812A + 1, (u1bTmp & (~BIT0))); -+ -+ pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *pDM_Odm->pbFwDwRsvdPageInProgress = FALSE; -+#endif -+} -+ -+ -+VOID -+halTxbfJaguar_FwTxBFCmd( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx, Period0 = 0, Period1 = 0; -+ u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u1Byte u1TxBFParm[3] = {0}; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ /*Modified by David*/ -+ if (pBeamInfo->BeamformeeEntry[Idx].bUsed && pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (Idx == 0) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) -+ PageNum0 = 0xFE; -+ else -+ PageNum0 = 0xFF; /*stop sounding*/ -+ Period0 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } else if (Idx == 1) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) -+ PageNum1 = 0xFE; -+ else -+ PageNum1 = 0xFF; /*stop sounding*/ -+ Period1 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } -+ } -+ } -+ -+ u1TxBFParm[0] = PageNum0; -+ u1TxBFParm[1] = PageNum1; -+ u1TxBFParm[2] = (Period1 << 4) | Period0; -+ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_TXBF, 3, u1TxBFParm); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, -+ ("[%s] PageNum0 = %d Period0 = %d, PageNum1 = %d Period1 %d\n", __func__, PageNum0, Period0, PageNum1, Period1)); -+} -+ -+ -+VOID -+HalTxbfJaguar_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte BFerBFeeIdx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ u1Byte BFerIdx = (BFerBFeeIdx & 0xF0) >> 4; -+ u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); -+ u4Byte CSI_Param; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ u2Byte STAid = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Start!\n", __func__)); -+ -+ halTxbfJaguar_RfMode(pDM_Odm, pBeamformingInfo); -+ -+ if (pDM_Odm->RFType == ODM_2T2R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CSI_CONTENT_VALUE, bMaskDWord, 0x00000000); /*Nc =2*/ -+ else -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CSI_CONTENT_VALUE, bMaskDWord, 0x01081008); /*Nc =1*/ -+ -+ if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { -+ BeamformerEntry = pBeamformingInfo->BeamformerEntry[BFerIdx]; -+ -+ /*Sounding protocol control*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xCB); -+ -+ /*MAC address/Partial AID of Beamformer*/ -+ if (BFerIdx == 0) { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_BFMER0_INFO_8812A + i), BeamformerEntry.MacAddr[i]); -+ /*CSI report use legacy ofdm so don't need to fill P_AID. */ -+ /*PlatformEFIOWrite2Byte(Adapter, REG_BFMER0_INFO_8812A+6, BeamformEntry.P_AID); */ -+ } else { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_BFMER1_INFO_8812A + i), BeamformerEntry.MacAddr[i]); -+ /*CSI report use legacy ofdm so don't need to fill P_AID.*/ -+ /*PlatformEFIOWrite2Byte(Adapter, REG_BFMER1_INFO_8812A+6, BeamformEntry.P_AID);*/ -+ } -+ -+ /*CSI report parameters of Beamformee*/ -+ if (BeamformerEntry.BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU) { -+ if (pDM_Odm->RFType == ODM_2T2R) -+ CSI_Param = 0x01090109; -+ else -+ CSI_Param = 0x01080108; -+ } else { -+ if (pDM_Odm->RFType == ODM_2T2R) -+ CSI_Param = 0x03090309; -+ else -+ CSI_Param = 0x03080308; -+ } -+ -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8812A, CSI_Param); -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8812A, CSI_Param); -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8812A, CSI_Param); -+ -+ /*Timeout value for MAC to leave NDP_RX_standby_state (60 us, Test chip) (80 us, MP chip)*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A + 3, 0x50); -+ } -+ -+ -+ if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[BFeeIdx]; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ STAid = BeamformeeEntry.MacId; -+ else -+ STAid = BeamformeeEntry.P_AID; -+ -+ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ -+ if (BFeeIdx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A, STAid); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 3) | BIT4 | BIT6 | BIT7); -+ } else -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 2, STAid | BIT12 | BIT14 | BIT15); -+ -+ /*CSI report parameters of Beamformee*/ -+ if (BFeeIdx == 0) { -+ /*Get BIT24 & BIT25*/ -+ u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 3) & 0x3; -+ -+ ODM_Write1Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 3, tmp | 0x60); -+ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A, STAid | BIT9); -+ } else { -+ /*Set BIT25*/ -+ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2, STAid | 0xE200); -+ } -+ phydm_Beamforming_Notify(pDM_Odm); -+ } -+} -+ -+ -+VOID -+HalTxbfJaguar_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ -+ if (Idx < BEAMFORMER_ENTRY_NUM) { -+ BeamformerEntry = pBeamformingInfo->BeamformerEntry[Idx]; -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[Idx]; -+ } else -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Start!, IDx = %d\n", __func__, Idx)); -+ -+ /*Clear P_AID of Beamformee*/ -+ /*Clear MAC address of Beamformer*/ -+ /*Clear Associated Bfmee Sel*/ -+ -+ if (BeamformerEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xC8); -+ if (Idx == 0) { -+ ODM_Write4Byte(pDM_Odm, REG_BFMER0_INFO_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_BFMER0_INFO_8812A + 4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8812A, 0); -+ } else { -+ ODM_Write4Byte(pDM_Odm, REG_BFMER1_INFO_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_BFMER1_INFO_8812A + 4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8812A, 0); -+ } -+ } -+ -+ if (BeamformeeEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ halTxbfJaguar_RfMode(pDM_Odm, pBeamformingInfo); -+ if (Idx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A, 0x0); -+ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A, 0); -+ } else { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 2, ODM_Read2Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 2) & 0xF000); -+ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2, ODM_Read2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2) & 0x60); -+ } -+ } -+ -+} -+ -+ -+VOID -+HalTxbfJaguar_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte BeamCtrlVal; -+ u4Byte BeamCtrlReg; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformEntry = pBeamInfo->BeamformeeEntry[Idx]; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ BeamCtrlVal = BeamformEntry.MacId; -+ else -+ BeamCtrlVal = BeamformEntry.P_AID; -+ -+ if (Idx == 0) -+ BeamCtrlReg = REG_TXBF_CTRL_8812A; -+ else { -+ BeamCtrlReg = REG_TXBF_CTRL_8812A + 2; -+ BeamCtrlVal |= BIT12 | BIT14 | BIT15; -+ } -+ -+ if (BeamformEntry.BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (BeamformEntry.SoundBW == CHANNEL_WIDTH_20) -+ BeamCtrlVal |= BIT9; -+ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_40) -+ BeamCtrlVal |= (BIT9 | BIT10); -+ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_80) -+ BeamCtrlVal |= (BIT9 | BIT10 | BIT11); -+ } else -+ BeamCtrlVal &= ~(BIT9 | BIT10 | BIT11); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BeamCtrlVal = 0x%x!\n", __func__, BeamCtrlVal)); -+ -+ ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); -+} -+ -+ -+ -+VOID -+HalTxbfJaguar_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ halTxbfJaguar_DownloadNDPA(pDM_Odm, Idx); -+ -+ halTxbfJaguar_FwTxBFCmd(pDM_Odm); -+} -+ -+ -+VOID -+HalTxbfJaguar_Patch( -+ IN PVOID pDM_VOID, -+ IN u1Byte Operation -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pBeamInfo->BeamformCap == BEAMFORMING_CAP_NONE) -+ return; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (Operation == SCAN_OPT_BACKUP_BAND0) -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xC8); -+ else if (Operation == SCAN_OPT_RESTORE) -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xCB); -+#endif -+} -+ -+VOID -+HalTxbfJaguar_Clk_8812A( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte u2btmp; -+ u1Byte Count = 0, u1btmp; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (*(pDM_Odm->pbScanInProcess)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] return by Scan\n", __func__)); -+ return; -+ } -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ /*Stop PCIe TxDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_PCIE_CTRL_REG_8812A + 1, 0xFE); -+#endif -+ -+ /*Stop Usb TxDMA*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_DISABLE_FUNC(Adapter, DF_TX_BIT); -+ PlatformReturnAllPendingTxPackets(Adapter); -+#else -+ rtw_write_port_cancel(Adapter); -+#endif -+ -+ /*Wait TXFF empty*/ -+ for (Count = 0; Count < 100; Count++) { -+ u2btmp = ODM_Read2Byte(pDM_Odm, REG_TXPKT_EMPTY_8812A); -+ u2btmp = u2btmp & 0xfff; -+ if (u2btmp != 0xfff) { -+ ODM_delay_ms(10); -+ continue; -+ } else -+ break; -+ } -+ -+ /*TX pause*/ -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE_8812A, 0xFF); -+ -+ /*Wait TX State Machine OK*/ -+ for (Count = 0; Count < 100; Count++) { -+ if (ODM_Read4Byte(pDM_Odm, REG_SCH_TXCMD_8812A) != 0) -+ continue; -+ else -+ break; -+ } -+ -+ -+ /*Stop RX DMA path*/ -+ u1btmp = ODM_Read1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A); -+ ODM_Write1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A, u1btmp | BIT2); -+ -+ for (Count = 0; Count < 100; Count++) { -+ u1btmp = ODM_Read1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A); -+ if (u1btmp & BIT1) -+ break; -+ else -+ ODM_delay_ms(10); -+ } -+ -+ /*Disable clock*/ -+ ODM_Write1Byte(pDM_Odm, REG_SYS_CLKR_8812A + 1, 0xf0); -+ /*Disable 320M*/ -+ ODM_Write1Byte(pDM_Odm, REG_AFE_PLL_CTRL_8812A + 3, 0x8); -+ /*Enable 320M*/ -+ ODM_Write1Byte(pDM_Odm, REG_AFE_PLL_CTRL_8812A + 3, 0xa); -+ /*Enable clock*/ -+ ODM_Write1Byte(pDM_Odm, REG_SYS_CLKR_8812A + 1, 0xfc); -+ -+ -+ /*Release Tx pause*/ -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE_8812A, 0); -+ -+ /*Enable RX DMA path*/ -+ u1btmp = ODM_Read1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A); -+ ODM_Write1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A, u1btmp & (~BIT2)); -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ /*Enable PCIe TxDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_PCIE_CTRL_REG_8812A + 1, 0); -+#endif -+ /*Start Usb TxDMA*/ -+ RT_ENABLE_FUNC(Adapter, DF_TX_BIT); -+} -+ -+#endif -+ -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfjaguar.h linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfjaguar.h ---- linux.old/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfjaguar.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/phydm/txbf/haltxbfjaguar.h 2017-06-07 23:07:21.032689489 +0300 -@@ -0,0 +1,67 @@ -+#ifndef __HAL_TXBF_JAGUAR_H__ -+#define __HAL_TXBF_JAGUAR_H__ -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -+VOID -+HalTxbf8812A_setNDPArate( -+ IN PVOID pDM_VOID, -+ IN u1Byte BW, -+ IN u1Byte Rate -+); -+ -+ -+VOID -+HalTxbfJaguar_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbfJaguar_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbfJaguar_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbfJaguar_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbfJaguar_Patch( -+ IN PVOID pDM_VOID, -+ IN u1Byte Operation -+ ); -+ -+ -+VOID -+HalTxbfJaguar_Clk_8812A( -+ IN PVOID pDM_VOID -+ ); -+ -+#else -+ -+#define HalTxbf8812A_setNDPArate(pDM_VOID, BW, Rate) -+#define HalTxbfJaguar_Enter(pDM_VOID, Idx) -+#define HalTxbfJaguar_Leave(pDM_VOID, Idx) -+#define HalTxbfJaguar_Status(pDM_VOID, Idx) -+#define HalTxbfJaguar_FwTxBF(pDM_VOID, Idx) -+#define HalTxbfJaguar_Patch(pDM_VOID, Operation) -+#define HalTxbfJaguar_Clk_8812A(pDM_VOID) -+#endif -+ -+#endif -+#endif // #ifndef __HAL_TXBF_JAGUAR_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/Hal8812PwrSeq.c linux/3rdparty/rtl8812au/hal/rtl8812a/Hal8812PwrSeq.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/Hal8812PwrSeq.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/Hal8812PwrSeq.c 2017-06-07 23:07:21.032689489 +0300 -@@ -0,0 +1,98 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "Hal8812PwrSeq.h" -+#include -+ -+/* -+ drivers should parse below arrays and do the corresponding actions -+*/ -+//3 Power on Array -+WLAN_PWR_CFG rtl8812_power_on_flow[RTL8812_TRANS_CARDEMU_TO_ACT_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_CARDEMU_TO_ACT -+ RTL8812_TRANS_END -+}; -+ -+//3Radio off GPIO Array -+WLAN_PWR_CFG rtl8812_radio_off_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_ACT_TO_CARDEMU -+ RTL8812_TRANS_END -+}; -+ -+//3Card Disable Array -+WLAN_PWR_CFG rtl8812_card_disable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_ACT_TO_CARDEMU -+ RTL8812_TRANS_CARDEMU_TO_CARDDIS -+ RTL8812_TRANS_END -+}; -+ -+//3 Card Enable Array -+WLAN_PWR_CFG rtl8812_card_enable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_CARDDIS_TO_CARDEMU -+ RTL8812_TRANS_CARDEMU_TO_ACT -+ RTL8812_TRANS_END -+}; -+ -+//3Suspend Array -+WLAN_PWR_CFG rtl8812_suspend_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_SUS_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_ACT_TO_CARDEMU -+ RTL8812_TRANS_CARDEMU_TO_SUS -+ RTL8812_TRANS_END -+}; -+ -+//3 Resume Array -+WLAN_PWR_CFG rtl8812_resume_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_SUS_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_SUS_TO_CARDEMU -+ RTL8812_TRANS_CARDEMU_TO_ACT -+ RTL8812_TRANS_END -+}; -+ -+ -+ -+//3HWPDN Array -+WLAN_PWR_CFG rtl8812_hwpdn_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_ACT_TO_CARDEMU -+ RTL8812_TRANS_CARDEMU_TO_PDN -+ RTL8812_TRANS_END -+}; -+ -+//3 Enter LPS -+WLAN_PWR_CFG rtl8812_enter_lps_flow[RTL8812_TRANS_ACT_TO_LPS_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ //FW behavior -+ RTL8812_TRANS_ACT_TO_LPS -+ RTL8812_TRANS_END -+}; -+ -+//3 Leave LPS -+WLAN_PWR_CFG rtl8812_leave_lps_flow[RTL8812_TRANS_LPS_TO_ACT_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ //FW behavior -+ RTL8812_TRANS_LPS_TO_ACT -+ RTL8812_TRANS_END -+}; -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/Hal8821APwrSeq.c linux/3rdparty/rtl8812au/hal/rtl8812a/Hal8821APwrSeq.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/Hal8821APwrSeq.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/Hal8821APwrSeq.c 2017-06-07 23:07:21.032689489 +0300 -@@ -0,0 +1,96 @@ -+ -+/*++ -+Copyright (c) Realtek Semiconductor Corp. All rights reserved. -+ -+Module Name: -+ Hal8821PwrSeq.c -+ -+Abstract: -+ This file includes all kinds of Power Action event for RTL8821A and corresponding hardware configurtions which are released from HW SD. -+ -+Major Change History: -+ When Who What -+ ---------- --------------- ------------------------------- -+ 2011-08-08 Roger Create. -+ -+--*/ -+ -+ -+#include "Hal8821APwrSeq.h" -+#include -+ -+ -+/* -+ drivers should parse below arrays and do the corresponding actions -+*/ -+//3 Power on Array -+WLAN_PWR_CFG rtl8821A_power_on_flow[RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_CARDEMU_TO_ACT -+ RTL8821A_TRANS_END -+}; -+ -+//3Radio off GPIO Array -+WLAN_PWR_CFG rtl8821A_radio_off_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_ACT_TO_CARDEMU -+ RTL8821A_TRANS_END -+}; -+ -+//3Card Disable Array -+WLAN_PWR_CFG rtl8821A_card_disable_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_ACT_TO_CARDEMU -+ RTL8821A_TRANS_CARDEMU_TO_CARDDIS -+ RTL8821A_TRANS_END -+}; -+ -+//3 Card Enable Array -+WLAN_PWR_CFG rtl8821A_card_enable_flow[RTL8821A_TRANS_CARDDIS_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_CARDDIS_TO_CARDEMU -+ RTL8821A_TRANS_CARDEMU_TO_ACT -+ RTL8821A_TRANS_END -+}; -+ -+//3Suspend Array -+WLAN_PWR_CFG rtl8821A_suspend_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_ACT_TO_CARDEMU -+ RTL8821A_TRANS_CARDEMU_TO_SUS -+ RTL8821A_TRANS_END -+}; -+ -+//3 Resume Array -+WLAN_PWR_CFG rtl8821A_resume_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_SUS_TO_CARDEMU -+ RTL8821A_TRANS_CARDEMU_TO_ACT -+ RTL8821A_TRANS_END -+}; -+ -+ -+ -+//3HWPDN Array -+WLAN_PWR_CFG rtl8821A_hwpdn_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_ACT_TO_CARDEMU -+ RTL8821A_TRANS_CARDEMU_TO_PDN -+ RTL8821A_TRANS_END -+}; -+ -+//3 Enter LPS -+WLAN_PWR_CFG rtl8821A_enter_lps_flow[RTL8821A_TRANS_ACT_TO_LPS_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ //FW behavior -+ RTL8821A_TRANS_ACT_TO_LPS -+ RTL8821A_TRANS_END -+}; -+ -+//3 Leave LPS -+WLAN_PWR_CFG rtl8821A_leave_lps_flow[RTL8821A_TRANS_LPS_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ //FW behavior -+ RTL8821A_TRANS_LPS_TO_ACT -+ RTL8821A_TRANS_END -+}; -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_cmd.c linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_cmd.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_cmd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_cmd.c 2017-06-07 23:07:21.032689489 +0300 -@@ -0,0 +1,1979 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTL8812A_CMD_C_ -+ -+//#include -+#include -+#include "hal_com_h2c.h" -+#include -+#define CONFIG_H2C_EF -+ -+#define RTL8812_MAX_H2C_BOX_NUMS 4 -+#define RTL8812_MAX_CMD_LEN 7 -+#define RTL8812_MESSAGE_BOX_SIZE 4 -+#define RTL8812_EX_MESSAGE_BOX_SIZE 4 -+ -+ -+static u8 _is_fw_read_cmd_down(_adapter* padapter, u8 msgbox_num) -+{ -+ u8 read_down = _FALSE; -+ int retry_cnts = 100; -+ -+ u8 valid; -+ -+ //DBG_8192C(" _is_fw_read_cmd_down ,reg_1cc(%x),msg_box(%d)...\n",rtw_read8(padapter,REG_HMETFR),msgbox_num); -+ -+ do{ -+ valid = rtw_read8(padapter,REG_HMETFR) & BIT(msgbox_num); -+ if(0 == valid ){ -+ read_down = _TRUE; -+ } -+ else -+ rtw_msleep_os(1); -+ }while( (!read_down) && (retry_cnts--)); -+ -+ return read_down; -+ -+} -+ -+ -+/***************************************** -+* H2C Msg format : -+* 0x1DF - 0x1D0 -+*| 31 - 8 | 7-5 4 - 0 | -+*| h2c_msg |Class_ID CMD_ID | -+* -+* Extend 0x1FF - 0x1F0 -+*|31 - 0 | -+*|ext_msg| -+******************************************/ -+s32 FillH2CCmd_8812(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) -+{ -+ u8 h2c_box_num; -+ u32 msgbox_addr; -+ u32 msgbox_ex_addr; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 cmd_idx,ext_cmd_len; -+ u32 h2c_cmd = 0; -+ u32 h2c_cmd_ex = 0; -+ s32 ret = _FAIL; -+ -+_func_enter_; -+ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ pHalData = GET_HAL_DATA(padapter); -+ -+ -+ if(padapter->bFWReady == _FALSE) -+ { -+ //DBG_8192C("FillH2CCmd_8812(): return H2C cmd because fw is not ready\n"); -+ return ret; -+ } -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->h2c_fwcmd_mutex), NULL); -+ -+ -+ if (!pCmdBuffer) { -+ goto exit; -+ } -+ if (CmdLen > RTL8812_MAX_CMD_LEN) { -+ goto exit; -+ } -+ if (rtw_is_surprise_removed(padapter)) -+ goto exit; -+ -+ //pay attention to if race condition happened in H2C cmd setting. -+ do{ -+ h2c_box_num = pHalData->LastHMEBoxNum; -+ -+ if(!_is_fw_read_cmd_down(padapter, h2c_box_num)){ -+ DBG_8192C(" fw read cmd failed...\n"); -+ goto exit; -+ } -+ -+ *(u8*)(&h2c_cmd) = ElementID; -+ -+ if(CmdLen<=3) -+ { -+ _rtw_memcpy((u8*)(&h2c_cmd)+1, pCmdBuffer, CmdLen ); -+ } -+ else{ -+ _rtw_memcpy((u8*)(&h2c_cmd)+1, pCmdBuffer,3); -+ ext_cmd_len = CmdLen-3; -+ _rtw_memcpy((u8*)(&h2c_cmd_ex), pCmdBuffer+3,ext_cmd_len ); -+ -+ //Write Ext command -+ msgbox_ex_addr = REG_HMEBOX_EXT0_8812 + (h2c_box_num *RTL8812_EX_MESSAGE_BOX_SIZE); -+ #ifdef CONFIG_H2C_EF -+ for(cmd_idx=0;cmd_idxh2c_cmd:0x%x, reg:0x%x =>h2c_cmd_ex:0x%x ..\n" -+ // ,pHalData->LastHMEBoxNum ,CmdLen,msgbox_addr,h2c_cmd,msgbox_ex_addr,h2c_cmd_ex); -+ -+ pHalData->LastHMEBoxNum = (h2c_box_num+1) % RTL8812_MAX_H2C_BOX_NUMS; -+ -+ }while(0); -+ -+ ret = _SUCCESS; -+ -+exit: -+ -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->h2c_fwcmd_mutex), NULL); -+ -+_func_exit_; -+ -+ return ret; -+} -+ -+u8 rtl8812_set_rssi_cmd(_adapter*padapter, u8 *param) -+{ -+ u8 res=_SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+_func_enter_; -+ -+ *((u32*) param ) = cpu_to_le32( *((u32*) param ) ); -+ -+ FillH2CCmd_8812(padapter, H2C_8812_RSSI_REPORT, 4, param); -+ -+_func_exit_; -+ -+ return res; -+} -+ -+u8 Get_VHT_ENI( -+ u32 IOTAction, -+ u32 WirelessMode, -+ u32 ratr_bitmap -+ ) -+{ -+ u8 Ret = 0; -+ -+ if(WirelessMode == WIRELESS_11_24AC) -+ { -+ if(ratr_bitmap & 0xfff00000) // Mix , 2SS -+ Ret = 3; -+ else // Mix, 1SS -+ Ret = 2; -+ } -+ else if(WirelessMode == WIRELESS_11_5AC) -+ { -+ Ret = 1; // VHT -+ } -+ -+ return (Ret << 4); -+} -+ -+BOOLEAN -+Get_RA_ShortGI_8812( -+ PADAPTER Adapter, -+ struct sta_info *psta, -+ u8 shortGIrate, -+ u32 ratr_bitmap -+) -+{ -+ BOOLEAN bShortGI; -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ bShortGI = shortGIrate; -+ -+#ifdef CONFIG_80211AC_VHT -+ if( bShortGI && -+ IsSupportedVHT(psta->wireless_mode) && -+ (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP) && -+ TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX) -+ ) -+ { -+ if(ratr_bitmap & 0xC0000000) -+ bShortGI = _FALSE; -+ } -+#endif -+ -+ return bShortGI; -+} -+ -+ -+void -+Set_RA_LDPC_8812( -+ struct sta_info *psta, -+ BOOLEAN bLDPC -+ ) -+{ -+ if(psta == NULL) -+ return; -+#ifdef CONFIG_80211AC_VHT -+ if(psta->wireless_mode == WIRELESS_11_5AC) -+ { -+ if(bLDPC && TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_CAP_TX)) -+ SET_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX); -+ else -+ CLEAR_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX); -+ } -+ else if(IsSupportedHT(psta->wireless_mode) || IsSupportedVHT(psta->wireless_mode)) -+ { -+ if(bLDPC && TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_CAP_TX)) -+ SET_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_ENABLE_TX); -+ else -+ CLEAR_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_ENABLE_TX); -+ } -+ -+ update_ldpc_stbc_cap(psta); -+#endif -+ -+ //DBG_871X("MacId %d bLDPC %d\n", psta->mac_id, bLDPC); -+} -+ -+ -+u8 -+Get_RA_LDPC_8812( -+ struct sta_info *psta -+) -+{ -+ u8 bLDPC = 0; -+ -+ if (psta != NULL) { -+ if(psta->mac_id == 1) { -+ bLDPC = 0; -+ } else { -+#ifdef CONFIG_80211AC_VHT -+ if(IsSupportedVHT(psta->wireless_mode)) -+ { -+ if(TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_CAP_TX)) -+ bLDPC = 1; -+ else -+ bLDPC = 0; -+ } -+ else if(IsSupportedHT(psta->wireless_mode)) -+ { -+ if(TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_CAP_TX)) -+ bLDPC =1; -+ else -+ bLDPC =0; -+ } -+ else -+#endif -+ bLDPC = 0; -+ } -+ } -+ -+ return (bLDPC << 2); -+} -+ -+void rtl8812_set_raid_cmd(PADAPTER padapter, u32 bitmap, u8* arg) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_info *psta; -+ u8 macid, init_rate, raid, shortGIrate=_FALSE; -+ -+_func_enter_; -+ -+ macid = arg[0]; -+ raid = arg[1]; -+ shortGIrate = arg[2]; -+ init_rate = arg[3]; -+ -+ psta = pmlmeinfo->FW_sta_info[macid].psta; -+ if(psta == NULL) -+ { -+ return; -+ } -+ -+ if(pHalData->fw_ractrl == _TRUE) -+ { -+ u8 H2CCommand[7] ={0}; -+ -+ shortGIrate = Get_RA_ShortGI_8812(padapter, psta, shortGIrate, bitmap); -+ -+ H2CCommand[0] = macid; -+ H2CCommand[1] = (raid & 0x1F) | (shortGIrate?0x80:0x00) ; -+ H2CCommand[2] = (psta->bw_mode & 0x3) |Get_RA_LDPC_8812(psta) |Get_VHT_ENI(0, psta->wireless_mode, bitmap); -+ -+ //DisableTXPowerTraining -+ if(pHalData->bDisableTXPowerTraining){ -+ H2CCommand[2] |= BIT6; -+ DBG_871X("%s,Disable PWT by driver\n",__FUNCTION__); -+ } -+ else{ -+ PDM_ODM_T pDM_OutSrc = &pHalData->odmpriv; -+ -+ if(pDM_OutSrc->bDisablePowerTraining){ -+ H2CCommand[2] |= BIT6; -+ DBG_871X("%s,Disable PWT by DM\n",__FUNCTION__); -+ } -+ } -+ -+ H2CCommand[3] = (u8)(bitmap & 0x000000ff); -+ H2CCommand[4] = (u8)((bitmap & 0x0000ff00) >>8); -+ H2CCommand[5] = (u8)((bitmap & 0x00ff0000) >> 16); -+ H2CCommand[6] = (u8)((bitmap & 0xff000000) >> 24); -+ -+ //DBG_871X("rtl8812_set_raid_cmd, bitmap=0x%x, mac_id=0x%x, raid=0x%x, shortGIrate=%x\n", bitmap, macid, raid, shortGIrate); -+ -+ FillH2CCmd_8812(padapter, H2C_8812_RA_MASK, 7, H2CCommand); -+ } -+ -+ if (shortGIrate==_TRUE) -+ init_rate |= BIT(7); -+ -+ pHalData->INIDATA_RATE[macid] = init_rate; -+ -+_func_exit_; -+ -+} -+ -+void rtl8812_Add_RateATid(PADAPTER pAdapter, u64 rate_bitmap, u8 *arg, u8 rssi_level) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 macid; -+ u32 bitmap = (u32) rate_bitmap; -+ -+ macid = arg[0]; -+ -+ if(rssi_level != DM_RATR_STA_INIT) -+ bitmap = ODM_Get_Rate_Bitmap(&pHalData->odmpriv, macid, bitmap, rssi_level); -+ -+ rtl8812_set_raid_cmd(pAdapter, bitmap, arg); -+} -+ -+void rtl8812_set_FwPwrMode_cmd(PADAPTER padapter, u8 PSMode) -+{ -+ u8 u1H2CSetPwrMode[H2C_PWRMODE_LEN]={0}; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8 Mode = 0, RLBM = 0, PowerState = 0, LPSAwakeIntvl = 2, pwrModeByte5 = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+_func_enter_; -+ -+ DBG_871X("%s: Mode=%d SmartPS=%d UAPSD=%d\n", __FUNCTION__, -+ PSMode, pwrpriv->smart_ps, padapter->registrypriv.uapsd_enable); -+ -+ switch(PSMode) -+ { -+ case PS_MODE_ACTIVE: -+ Mode = 0; -+ break; -+ case PS_MODE_MIN: -+ Mode = 1; -+ break; -+ case PS_MODE_MAX: -+ RLBM = 1; -+ Mode = 1; -+ break; -+ case PS_MODE_DTIM: -+ RLBM = 2; -+ Mode = 1; -+ break; -+ case PS_MODE_UAPSD_WMM: -+ Mode = 2; -+ break; -+ default: -+ Mode = 0; -+ break; -+ } -+ -+ if (Mode > PS_MODE_ACTIVE) -+ { -+#ifdef CONFIG_BT_COEXIST -+ if ((rtw_btcoex_IsBtControlLps(padapter) == _TRUE) && (_TRUE == pHalData->EEPROMBluetoothCoexist)) -+ { -+ PowerState = rtw_btcoex_RpwmVal(padapter); -+ pwrModeByte5 = rtw_btcoex_LpsVal(padapter); -+ } -+ else -+#endif // CONFIG_BT_COEXIST -+ { -+ PowerState = 0x00;// AllON(0x0C), RFON(0x04), RFOFF(0x00) -+ pwrModeByte5 = 0x40; -+ } -+ -+#ifdef CONFIG_EXT_CLK -+ Mode |= BIT(7);//supporting 26M XTAL CLK_Request feature. -+#endif //CONFIG_EXT_CLK -+ } -+ else -+ { -+ PowerState = 0x0C;// AllON(0x0C), RFON(0x04), RFOFF(0x00) -+ pwrModeByte5 = 0x40; -+ } -+ -+ // 0: Active, 1: LPS, 2: WMMPS -+ SET_8812_H2CCMD_PWRMODE_PARM_MODE(u1H2CSetPwrMode, Mode); -+ -+ // 0:Min, 1:Max , 2:User define -+ SET_8812_H2CCMD_PWRMODE_PARM_RLBM(u1H2CSetPwrMode, RLBM); -+ -+ // (LPS) smart_ps: 0: PS_Poll, 1: PS_Poll , 2: NullData -+ // (WMM)smart_ps: 0:PS_Poll, 1:NullData -+ SET_8812_H2CCMD_PWRMODE_PARM_SMART_PS(u1H2CSetPwrMode, pwrpriv->smart_ps); -+ -+ // AwakeInterval: Unit is beacon interval, this field is only valid in PS_DTIM mode -+ SET_8812_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(u1H2CSetPwrMode, LPSAwakeIntvl); -+ -+ // (WMM only)bAllQueueUAPSD -+ SET_8812_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(u1H2CSetPwrMode, padapter->registrypriv.uapsd_enable); -+ -+ // AllON(0x0C), RFON(0x04), RFOFF(0x00) -+ SET_8812_H2CCMD_PWRMODE_PARM_PWR_STATE(u1H2CSetPwrMode, PowerState); -+ -+ SET_8812_H2CCMD_PWRMODE_PARM_BYTE5(u1H2CSetPwrMode, pwrModeByte5); -+ -+#ifdef CONFIG_BT_COEXIST -+ if (_TRUE == pHalData->EEPROMBluetoothCoexist) -+ rtw_btcoex_RecordPwrMode(padapter, u1H2CSetPwrMode, sizeof(u1H2CSetPwrMode)); -+#endif // CONFIG_BT_COEXIST -+ //DBG_871X("u1H2CSetPwrMode="MAC_FMT"\n", MAC_ARG(u1H2CSetPwrMode)); -+ FillH2CCmd_8812(padapter, H2C_8812_SETPWRMODE, sizeof(u1H2CSetPwrMode), u1H2CSetPwrMode); -+ -+_func_exit_; -+} -+ -+void rtl8812_set_FwMediaStatus_cmd(PADAPTER padapter, u16 mstatus_rpt ) -+{ -+ u8 u1JoinBssRptParm[3]={0}; -+ u8 mstatus, macId, macId_Ind = 0, macId_End = 0; -+ -+ mstatus = (u8) (mstatus_rpt & 0xFF); -+ macId = (u8)(mstatus_rpt >> 8) ; -+ -+ SET_8812_H2CCMD_MSRRPT_PARM_OPMODE(u1JoinBssRptParm, mstatus); -+ SET_8812_H2CCMD_MSRRPT_PARM_MACID_IND(u1JoinBssRptParm, macId_Ind); -+ -+ SET_8812_H2CCMD_MSRRPT_PARM_MACID(u1JoinBssRptParm, macId); -+ SET_8812_H2CCMD_MSRRPT_PARM_MACID_END(u1JoinBssRptParm, macId_End); -+ -+ DBG_871X("[MacId], Set MacId Ctrl(original) = 0x%x \n", u1JoinBssRptParm[0]<<16|u1JoinBssRptParm[1]<<8|u1JoinBssRptParm[2]); -+ -+ FillH2CCmd_8812(padapter, H2C_8812_MSRRPT, 3, u1JoinBssRptParm); -+} -+ -+void ConstructBeacon(_adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 rate_len, pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ //pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pktlen = sizeof (struct rtw_ieee80211_hdr_3addr); -+ -+ //timestamp will be inserted by hardware -+ pframe += 8; -+ pktlen += 8; -+ -+ // beacon interval: 2 bytes -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ // capability info: 2 bytes -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ if( (pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ { -+ //DBG_871X("ie len=%d\n", cur_network->IELength); -+ pktlen += cur_network->IELength - sizeof(NDIS_802_11_FIXED_IEs); -+ _rtw_memcpy(pframe, cur_network->IEs+sizeof(NDIS_802_11_FIXED_IEs), pktlen); -+ -+ goto _ConstructBeacon; -+ } -+ -+ //below for ad-hoc mode -+ -+ // SSID -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pktlen); -+ -+ // supported rates... -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8)? 8: rate_len), cur_network->SupportedRates, &pktlen); -+ -+ // DS parameter set -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pktlen); -+ -+ if( (pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) -+ { -+ u32 ATIMWindow; -+ // IBSS Parameter Set... -+ //ATIMWindow = cur->Configuration.ATIMWindow; -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pktlen); -+ } -+ -+ -+ //todo: ERP IE -+ -+ -+ // EXTERNDED SUPPORTED RATE -+ if (rate_len > 8) -+ { -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen); -+ } -+ -+ -+ //todo:HT for adhoc -+ -+_ConstructBeacon: -+ -+ if ((pktlen + TXDESC_SIZE) > 512) -+ { -+ DBG_871X("beacon frame too large\n"); -+ return; -+ } -+ -+ *pLength = pktlen; -+ -+ //DBG_871X("%s bcn_sz=%d\n", __FUNCTION__, pktlen); -+ -+} -+ -+void ConstructPSPoll(_adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ // Frame control. -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ SetPwrMgt(fctrl); -+ SetFrameSubType(pframe, WIFI_PSPOLL); -+ -+ // AID. -+ SetDuration(pframe, (pmlmeinfo->aid | 0xc000)); -+ -+ // BSSID. -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ // TA. -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ *pLength = 16; -+} -+ -+void ConstructNullFunctionData( -+ PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength, -+ u8 *StaAddr, -+ u8 bQoS, -+ u8 AC, -+ u8 bEosp, -+ u8 bForcePowerSave) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ //DBG_871X("%s:%d\n", __FUNCTION__, bForcePowerSave); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ if (bForcePowerSave) -+ { -+ SetPwrMgt(fctrl); -+ } -+ -+ switch(cur_network->network.InfrastructureMode) -+ { -+ case Ndis802_11Infrastructure: -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, StaAddr, ETH_ALEN); -+ break; -+ case Ndis802_11APMode: -+ SetFrDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ break; -+ case Ndis802_11IBSS: -+ default: -+ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ break; -+ } -+ -+ SetSeqNum(pwlanhdr, 0); -+ -+ if (bQoS == _TRUE) { -+ struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; -+ -+ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); -+ -+ pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos*)pframe; -+ SetPriority(&pwlanqoshdr->qc, AC); -+ SetEOSP(&pwlanqoshdr->qc, bEosp); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ } else { -+ SetFrameSubType(pframe, WIFI_DATA_NULL); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ } -+ -+ *pLength = pktlen; -+} -+ -+void ConstructProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength, u8 *StaAddr, BOOLEAN bHideSSID) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u8 *mac, *bssid; -+ u32 pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = adapter_mac_addr(padapter); -+ bssid = cur_network->MacAddress; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, bssid, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(fctrl, WIFI_PROBERSP); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pframe += pktlen; -+ -+ if(cur_network->IELength>MAX_IE_SZ) -+ return; -+ -+ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ pframe += cur_network->IELength; -+ pktlen += cur_network->IELength; -+ -+ *pLength = pktlen; -+} -+ -+#ifdef CONFIG_GTK_OL -+static void ConstructGTKResponse( -+ PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength -+ ) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ static u8 LLCHeader[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x88, 0x8E}; -+ static u8 GTKbody_a[11] ={0x01, 0x03, 0x00, 0x5F, 0x02, 0x03, 0x12, 0x00, 0x10, 0x42, 0x0B}; -+ u8 *pGTKRspPkt = pframe; -+ u8 EncryptionHeadOverhead = 0; -+ //DBG_871X("%s:%d\n", __FUNCTION__, bForcePowerSave); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ //------------------------------------------------------------------------- -+ // MAC Header. -+ //------------------------------------------------------------------------- -+ SetFrameType(fctrl, WIFI_DATA); -+ //SetFrameSubType(fctrl, 0); -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetDuration(pwlanhdr, 0); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ *pLength = sMacHdrLng; -+#else -+ *pLength = 24; -+#endif //CONFIG_WAPI_SUPPORT -+ -+//YJ,del,120503 -+#if 0 -+ //------------------------------------------------------------------------- -+ // Qos Header: leave space for it if necessary. -+ //------------------------------------------------------------------------- -+ if(pStaQos->CurrentQosMode > QOS_DISABLE) -+ { -+ SET_80211_HDR_QOS_EN(pGTKRspPkt, 1); -+ PlatformZeroMemory(&(Buffer[*pLength]), sQoSCtlLng); -+ *pLength += sQoSCtlLng; -+ } -+#endif //0 -+ //------------------------------------------------------------------------- -+ // Security Header: leave space for it if necessary. -+ //------------------------------------------------------------------------- -+ -+#if 1 -+ switch (psecuritypriv->dot11PrivacyAlgrthm) -+ { -+ case _WEP40_: -+ case _WEP104_: -+ EncryptionHeadOverhead = 4; -+ break; -+ case _TKIP_: -+ EncryptionHeadOverhead = 8; -+ break; -+ case _AES_: -+ EncryptionHeadOverhead = 8; -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ EncryptionHeadOverhead = 18; -+ break; -+#endif //CONFIG_WAPI_SUPPORT -+ default: -+ EncryptionHeadOverhead = 0; -+ } -+ -+ if(EncryptionHeadOverhead > 0) -+ { -+ _rtw_memset(&(pframe[*pLength]), 0,EncryptionHeadOverhead); -+ *pLength += EncryptionHeadOverhead; -+ //SET_80211_HDR_WEP(pGTKRspPkt, 1); //Suggested by CCW. -+ //GTK's privacy bit is done by FW -+ //SetPrivacy(fctrl); -+ } -+#endif //1 -+ //------------------------------------------------------------------------- -+ // Frame Body. -+ //------------------------------------------------------------------------- -+ pGTKRspPkt = (u8*)(pframe+ *pLength); -+ // LLC header -+ _rtw_memcpy(pGTKRspPkt, LLCHeader, 8); -+ *pLength += 8; -+ -+ // GTK element -+ pGTKRspPkt += 8; -+ -+ //GTK frame body after LLC, part 1 -+ _rtw_memcpy(pGTKRspPkt, GTKbody_a, 11); -+ *pLength += 11; -+ pGTKRspPkt += 11; -+ //GTK frame body after LLC, part 2 -+ _rtw_memset(&(pframe[*pLength]), 0, 88); -+ *pLength += 88; -+ pGTKRspPkt += 88; -+ -+} -+#endif //CONFIG_GTK_OL -+ -+// To check if reserved page content is destroyed by beacon beacuse beacon is too large. -+// 2010.06.23. Added by tynli. -+VOID -+CheckFwRsvdPageContent( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE* pHalData = GET_HAL_DATA(Adapter); -+ u32 MaxBcnPageNum; -+ -+ if(pHalData->FwRsvdPageStartOffset != 0) -+ { -+ /*MaxBcnPageNum = PageNum_128(pMgntInfo->MaxBeaconSize); -+ RT_ASSERT((MaxBcnPageNum <= pHalData->FwRsvdPageStartOffset), -+ ("CheckFwRsvdPageContent(): The reserved page content has been"\ -+ "destroyed by beacon!!! MaxBcnPageNum(%d) FwRsvdPageStartOffset(%d)\n!", -+ MaxBcnPageNum, pHalData->FwRsvdPageStartOffset));*/ -+ } -+} -+ -+// -+// Description: Get the reserved page number in Tx packet buffer. -+// Retrun value: the page number. -+// 2012.08.09, by tynli. -+// -+u8 -+GetTxBufferRsvdPageNum8812(_adapter *Adapter, bool bWoWLANBoundary) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 RsvdPageNum=0; -+ u8 TxPageBndy= LAST_ENTRY_OF_TX_PKT_BUFFER_8812; // default reseved 1 page for the IC type which is undefined. -+ -+ if(bWoWLANBoundary) -+ { -+ rtw_hal_get_def_var(Adapter, HAL_DEF_TX_PAGE_BOUNDARY_WOWLAN, (u8 *)&TxPageBndy); -+ } -+ else -+ { -+ rtw_hal_get_def_var(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&TxPageBndy); -+ } -+ -+ RsvdPageNum = LAST_ENTRY_OF_TX_PKT_BUFFER_8812 -TxPageBndy + 1; -+ -+ return RsvdPageNum; -+} -+ -+// -+// Description: Fill the reserved packets that FW will use to RSVD page. -+// Now we just send 4 types packet to rsvd page. -+// (1)Beacon, (2)Ps-poll, (3)Null data, (4)ProbeRsp. -+// Input: -+// bDLFinished - FALSE: At the first time we will send all the packets as a large packet to Hw, -+// so we need to set the packet length to total lengh. -+// TRUE: At the second time, we should send the first packet (default:beacon) -+// to Hw again and set the lengh in descriptor to the real beacon lengh. -+// 2009.10.15 by tynli. -+static void SetFwRsvdPagePkt_8812(PADAPTER padapter, BOOLEAN bDLFinished) -+{ -+ PHAL_DATA_TYPE pHalData; -+ struct xmit_frame *pcmdframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ u32 PSPollLength, NullFunctionDataLength, QosNullLength; -+ u32 BcnLen; -+ u8 TotalPageNum=0, CurtPktPageNum=0, TxDescLen=0, RsvdPageNum=0; -+ u8 *ReservedPagePacket; -+ u8 RsvdPageLoc[5] = {0}; -+ u16 BufIndex=0, PageSize = 256; -+ u32 TotalPacketLen, MaxRsvdPageBufSize=0;; -+ -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pxmitpriv = &padapter->xmitpriv; -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ if(IS_HARDWARE_TYPE_8812(padapter)) -+ PageSize = 512; -+ else if (IS_HARDWARE_TYPE_8821(padapter)) -+ PageSize = PAGE_SIZE_TX_8821A; -+ -+ // The function SetFwRsvdPagePkt_8812() input must be added a value "bDLWholePackets" to -+ // decide if download wowlan packets, and use "bDLWholePackets" to be GetTxBufferRsvdPageNum8812() 2nd input value. -+ RsvdPageNum = GetTxBufferRsvdPageNum8812(padapter, _FALSE); -+ MaxRsvdPageBufSize = RsvdPageNum*PageSize; -+ -+ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); -+ if (pcmdframe == NULL) { -+ return; -+ } -+ -+ ReservedPagePacket = pcmdframe->buf_addr; -+ -+ TxDescLen = TXDESC_SIZE;//The desc lengh in Tx packet buffer of 8812A is 40 bytes. -+ -+ //(1) beacon -+ BufIndex = TXDESC_OFFSET; -+ ConstructBeacon(padapter, &ReservedPagePacket[BufIndex], &BcnLen); -+ -+ // When we count the first page size, we need to reserve description size for the RSVD -+ // packet, it will be filled in front of the packet in TXPKTBUF. -+ CurtPktPageNum = (u8)PageNum(BcnLen+TxDescLen, PageSize); -+ -+ if(bDLFinished) -+ { -+ TotalPageNum += CurtPktPageNum; -+ TotalPacketLen = (TotalPageNum*PageSize); -+ DBG_871X("%s(): Beacon page size = %d\n",__FUNCTION__,TotalPageNum); -+ } -+ else -+ { -+ TotalPageNum += CurtPktPageNum; -+ -+ pHalData->FwRsvdPageStartOffset = TotalPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ if(BufIndex > MaxRsvdPageBufSize) -+ { -+ DBG_871X("%s(): Beacon: The rsvd page size is not enough!!BufIndex %d, MaxRsvdPageBufSize %d\n",__FUNCTION__, -+ BufIndex,MaxRsvdPageBufSize); -+ goto error; -+ } -+ -+ //(2) ps-poll -+ ConstructPSPoll(padapter, &ReservedPagePacket[BufIndex], &PSPollLength); -+ rtl8812a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], PSPollLength, _TRUE, _FALSE, _FALSE); -+ -+ SET_8812_H2CCMD_RSVDPAGE_LOC_PSPOLL(RsvdPageLoc, TotalPageNum); -+ -+ //DBG_871X("SetFwRsvdPagePkt_8812(): HW_VAR_SET_TX_CMD: PS-POLL %p %d\n", -+ // &ReservedPagePacket[BufIndex-TxDescLen], (PSPollLength+TxDescLen)); -+ -+ CurtPktPageNum = (u8)PageNum(PSPollLength+TxDescLen, PageSize); -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ if(BufIndex > MaxRsvdPageBufSize) -+ { -+ DBG_871X("%s(): ps-poll: The rsvd page size is not enough!!BufIndex %d, MaxRsvdPageBufSize %d\n",__FUNCTION__, -+ BufIndex,MaxRsvdPageBufSize); -+ goto error; -+ } -+ -+ //(3) null data -+ ConstructNullFunctionData( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ &NullFunctionDataLength, -+ get_my_bssid(&pmlmeinfo->network), -+ _FALSE, 0, 0, _FALSE); -+ rtl8812a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], NullFunctionDataLength, _FALSE, _FALSE, _FALSE); -+ -+ SET_8812_H2CCMD_RSVDPAGE_LOC_NULL_DATA(RsvdPageLoc, TotalPageNum); -+ -+ //DBG_871X("SetFwRsvdPagePkt_8812(): HW_VAR_SET_TX_CMD: NULL DATA %p %d\n", -+ // &ReservedPagePacket[BufIndex-TxDescLen], (NullFunctionDataLength+TxDescLen)); -+ -+ CurtPktPageNum = (u8)PageNum(NullFunctionDataLength+TxDescLen, PageSize); -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ if(BufIndex > MaxRsvdPageBufSize) -+ { -+ DBG_871X("%s(): Null-data: The rsvd page size is not enough!!BufIndex %d, MaxRsvdPageBufSize %d\n",__FUNCTION__, -+ BufIndex,MaxRsvdPageBufSize); -+ goto error; -+ } -+ -+ //(5) Qos null data -+ ConstructNullFunctionData( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ &QosNullLength, -+ get_my_bssid(&pmlmeinfo->network), -+ _TRUE, 0, 0, _FALSE); -+ rtl8812a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], QosNullLength, _FALSE, _FALSE, _FALSE); -+ -+ SET_8812_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(RsvdPageLoc, TotalPageNum); -+ -+ //DBG_871X("SetFwRsvdPagePkt_8812(): HW_VAR_SET_TX_CMD: QOS NULL DATA %p %d\n", -+ // &ReservedPagePacket[BufIndex-TxDescLen], (QosNullLength+TxDescLen)); -+ -+ CurtPktPageNum = (u8)PageNum(QosNullLength+TxDescLen, PageSize); -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ TotalPacketLen = (TotalPageNum * PageSize); -+ } -+ -+ -+ if(TotalPacketLen > MaxRsvdPageBufSize) -+ { -+ DBG_871X("%s(): ERROR: The rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n",__FUNCTION__, -+ TotalPacketLen,MaxRsvdPageBufSize); -+ goto error; -+ } -+ else -+ { -+ // update attribute -+ pattrib = &pcmdframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->qsel = QSLT_BEACON; -+ pattrib->pktlen = pattrib->last_txcmdsz = TotalPacketLen - TxDescLen; -+#ifdef CONFIG_PCI_HCI -+ dump_mgntframe(padapter, pcmdframe); -+#else -+ dump_mgntframe_and_wait(padapter, pcmdframe, 100); -+#endif -+ } -+ -+ if(!bDLFinished) -+ { -+ DBG_871X("%s: Set RSVD page location to Fw ,TotalPacketLen(%d), TotalPageNum(%d)\n", __FUNCTION__,TotalPacketLen,TotalPageNum); -+ FillH2CCmd_8812(padapter, H2C_8812_RSVDPAGE, 5, RsvdPageLoc); -+ } -+ -+ return; -+ -+error: -+ rtw_free_xmitframe(pxmitpriv, pcmdframe); -+} -+ -+#ifdef CONFIG_P2P_PS -+void rtl8812_set_p2p_ps_offload_cmd(_adapter* padapter, u8 p2p_ps_state) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ u8 *p2p_ps_offload = (u8 *)&pHalData->p2p_ps_offload; -+ u8 i; -+ -+_func_enter_; -+ -+#if 1 -+ switch(p2p_ps_state) -+ { -+ case P2P_PS_DISABLE: -+ DBG_8192C("P2P_PS_DISABLE \n"); -+ _rtw_memset(p2p_ps_offload, 0, 1); -+ break; -+ case P2P_PS_ENABLE: -+ DBG_8192C("P2P_PS_ENABLE \n"); -+ // update CTWindow value. -+ if( pwdinfo->ctwindow > 0 ) -+ { -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_CTWINDOW_EN(p2p_ps_offload, 1); -+ rtw_write8(padapter, REG_P2P_CTWIN, pwdinfo->ctwindow); -+ } -+ -+ // hw only support 2 set of NoA -+ for( i=0 ; inoa_num ; i++) -+ { -+ // To control the register setting for which NOA -+ rtw_write8(padapter, REG_NOA_DESC_SEL, (i << 4)); -+ if(i == 0) { -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(p2p_ps_offload, 1); -+ } else { -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(p2p_ps_offload, 1); -+ } -+ -+ // config P2P NoA Descriptor Register -+ //DBG_8192C("%s(): noa_duration = %x\n",__FUNCTION__,pwdinfo->noa_duration[i]); -+ rtw_write32(padapter, REG_NOA_DESC_DURATION, pwdinfo->noa_duration[i]); -+ -+ //DBG_8192C("%s(): noa_interval = %x\n",__FUNCTION__,pwdinfo->noa_interval[i]); -+ rtw_write32(padapter, REG_NOA_DESC_INTERVAL, pwdinfo->noa_interval[i]); -+ -+ //DBG_8192C("%s(): start_time = %x\n",__FUNCTION__,pwdinfo->noa_start_time[i]); -+ rtw_write32(padapter, REG_NOA_DESC_START, pwdinfo->noa_start_time[i]); -+ -+ //DBG_8192C("%s(): noa_count = %x\n",__FUNCTION__,pwdinfo->noa_count[i]); -+ rtw_write8(padapter, REG_NOA_DESC_COUNT, pwdinfo->noa_count[i]); -+ } -+ -+ if( (pwdinfo->opp_ps == 1) || (pwdinfo->noa_num > 0) ) -+ { -+ // rst p2p circuit -+ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(4)); -+ -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_ENABLE(p2p_ps_offload, 1); -+ -+ if(pwdinfo->role == P2P_ROLE_GO) -+ { -+ // 1: Owner, 0: Client -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_ROLE(p2p_ps_offload, 1); -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(p2p_ps_offload, 0); -+ } -+ else -+ { -+ // 1: Owner, 0: Client -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_ROLE(p2p_ps_offload, 0); -+ } -+ -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(p2p_ps_offload, 0); -+ } -+ break; -+ case P2P_PS_SCAN: -+ DBG_8192C("P2P_PS_SCAN \n"); -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(p2p_ps_offload, 1); -+ break; -+ case P2P_PS_SCAN_DONE: -+ DBG_8192C("P2P_PS_SCAN_DONE \n"); -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(p2p_ps_offload, 0); -+ pwdinfo->p2p_ps_state = P2P_PS_ENABLE; -+ break; -+ default: -+ break; -+ } -+ -+ DBG_871X("P2P_PS_OFFLOAD : %x\n", p2p_ps_offload[0]); -+ FillH2CCmd_8812(padapter, H2C_8812_P2P_PS_OFFLOAD, 1, p2p_ps_offload); -+#endif -+ -+_func_exit_; -+ -+} -+#endif //CONFIG_P2P -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+/* -+ ask FW to Reset sync register at Beacon early interrupt -+*/ -+u8 rtl8812_reset_tsf(_adapter *padapter, u8 reset_port ) -+{ -+ u8 buf[2]; -+ u8 res=_SUCCESS; -+ -+ s32 ret; -+_func_enter_; -+ if (IFACE_PORT0==reset_port) { -+ buf[0] = 0x1; buf[1] = 0; -+ } else{ -+ buf[0] = 0x0; buf[1] = 0x1; -+ } -+ -+ ret = FillH2CCmd_8812(padapter, H2C_8812_TSF_RESET, 2, buf); -+ -+_func_exit_; -+ -+ return res; -+} -+ -+int reset_tsf(PADAPTER Adapter, u8 reset_port ) -+{ -+ u8 reset_cnt_before = 0, reset_cnt_after = 0, loop_cnt = 0; -+ u32 reg_reset_tsf_cnt = (IFACE_PORT0==reset_port) ? -+ REG_FW_RESET_TSF_CNT_0:REG_FW_RESET_TSF_CNT_1; -+ u32 reg_bcncrtl = (IFACE_PORT0==reset_port) ? -+ REG_BCN_CTRL_1:REG_BCN_CTRL; -+ -+ rtw_scan_abort(Adapter->pbuddy_adapter); /* site survey will cause reset_tsf fail */ -+ reset_cnt_after = reset_cnt_before = rtw_read8(Adapter,reg_reset_tsf_cnt); -+ rtl8812_reset_tsf(Adapter, reset_port); -+ -+ while ((reset_cnt_after == reset_cnt_before ) && (loop_cnt < 10)) { -+ rtw_msleep_os(100); -+ loop_cnt++; -+ reset_cnt_after = rtw_read8(Adapter, reg_reset_tsf_cnt); -+ } -+ -+ return(loop_cnt >= 10) ? _FAIL : _TRUE; -+} -+ -+ -+#endif // CONFIG_TSF_RESET_OFFLOAD -+ -+static void rtl8812_set_FwRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) -+{ -+ u8 u1H2CRsvdPageParm[H2C_RSVDPAGE_LOC_LEN]={0}; -+ -+ DBG_871X("8812au/8821/8811 RsvdPageLoc: ProbeRsp=%d PsPoll=%d Null=%d QoSNull=%d BTNull=%d\n", -+ rsvdpageloc->LocProbeRsp, rsvdpageloc->LocPsPoll, -+ rsvdpageloc->LocNullData, rsvdpageloc->LocQosNull, -+ rsvdpageloc->LocBTQosNull); -+ -+ SET_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(u1H2CRsvdPageParm, rsvdpageloc->LocProbeRsp); -+ SET_H2CCMD_RSVDPAGE_LOC_PSPOLL(u1H2CRsvdPageParm, rsvdpageloc->LocPsPoll); -+ SET_H2CCMD_RSVDPAGE_LOC_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocNullData); -+ SET_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocQosNull); -+ SET_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocBTQosNull); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CRsvdPageParm:", u1H2CRsvdPageParm, H2C_RSVDPAGE_LOC_LEN); -+ FillH2CCmd_8812(padapter, H2C_RSVD_PAGE, H2C_RSVDPAGE_LOC_LEN, u1H2CRsvdPageParm); -+} -+ -+ -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ -+static void rtl8812_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 res = 0, count = 0; -+#ifdef CONFIG_WOWLAN -+ u8 u1H2CAoacRsvdPageParm[H2C_AOAC_RSVDPAGE_LOC_LEN]={0}; -+ -+ DBG_871X("8192EAOACRsvdPageLoc: RWC=%d ArpRsp=%d NbrAdv=%d GtkRsp=%d GtkInfo=%d ProbeReq=%d NetworkList=%d\n", -+ rsvdpageloc->LocRemoteCtrlInfo, rsvdpageloc->LocArpRsp, -+ rsvdpageloc->LocNbrAdv, rsvdpageloc->LocGTKRsp, -+ rsvdpageloc->LocGTKInfo, rsvdpageloc->LocProbeReq, -+ rsvdpageloc->LocNetList); -+ -+#ifdef CONFIG_PNO_SUPPORT -+ DBG_871X("NLO_INFO=%d\n", rsvdpageloc->LocPNOInfo); -+#endif -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) { -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocRemoteCtrlInfo); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocArpRsp); -+ //SET_H2CCMD_AOAC_RSVDPAGE_LOC_NEIGHBOR_ADV(u1H2CAoacRsvdPageParm, rsvdpageloc->LocNbrAdv); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKRsp); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKInfo); -+#ifdef CONFIG_GTK_OL -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_EXT_MEM(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKEXTMEM); -+#endif // CONFIG_GTK_OL -+ } else { -+#ifdef CONFIG_PNO_SUPPORT -+ if(!pwrpriv->pno_in_resume) { -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_NLO_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocPNOInfo); -+ } -+#endif -+ } -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_always_, "u1H2CAoacRsvdPageParm:", u1H2CAoacRsvdPageParm, H2C_AOAC_RSVDPAGE_LOC_LEN); -+ FillH2CCmd_8812(padapter, H2C_AOAC_RSVD_PAGE, H2C_AOAC_RSVDPAGE_LOC_LEN, u1H2CAoacRsvdPageParm); -+ -+#ifdef CONFIG_PNO_SUPPORT -+ if (!check_fwstate(pmlmepriv, WIFI_AP_STATE) && -+ !check_fwstate(pmlmepriv, _FW_LINKED) && -+ pwrpriv->pno_in_resume == _FALSE) { -+ -+ res = rtw_read8(padapter, 0x1b8); -+ while(res == 0 && count < 25) { -+ DBG_871X("[%d] FW loc_NLOInfo: %d\n", count, res); -+ res = rtw_read8(padapter, 0x1b8); -+ count++; -+ rtw_msleep_os(2); -+ } -+ } -+#endif // CONFIG_PNO_SUPPORT -+#endif // CONFIG_WOWLAN -+} -+#endif -+ -+void rtl8812_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ BOOLEAN bSendBeacon = _FALSE; -+ BOOLEAN bcn_valid = _FALSE; -+ u8 DLBcnCount = 0; -+ u32 poll = 0; -+ -+_func_enter_; -+ -+ DBG_871X("%s mstatus(%x)\n", __func__ , mstatus); -+ -+ if (mstatus == 1) { -+ /* -+ * We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. -+ * Suggested by filen. Added by tynli. -+ */ -+ rtw_write16(padapter, REG_BCN_PSR_RPT, (0xC000|pmlmeinfo->aid)); -+ /* -+ * Do not set TSF again here or vWiFi beacon DMA INT will not work. -+ * correct_TSF(padapter, pmlmeext); -+ * Hw sequende enable by dedault. 2010.06.23. by tynli. -+ * rtw_write16(padapter, REG_NQOS_SEQ, ((pmlmeext->mgnt_seq+100)&0xFFF)); -+ * rtw_write8(padapter, REG_HWSEQ_CTRL, 0xFF); -+ */ -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ pHalData->RegCR_1 |= BIT0; -+ rtw_write8(padapter , REG_CR+1 , pHalData->RegCR_1); -+ -+ /* -+ * Disable Hw protection for a time which revserd for Hw sending beacon. -+ * Fix download reserved page packet fail that access collision with the protection time. -+ * 2010.05.11. Added by tynli. -+ * SetBcnCtrlReg(padapter, 0, BIT3); -+ * SetBcnCtrlReg(padapter, BIT4, 0); -+ */ -+ rtw_write8(padapter, REG_BCN_CTRL , rtw_read8(padapter , REG_BCN_CTRL)&(~BIT(3))); -+ rtw_write8(padapter, REG_BCN_CTRL , rtw_read8(padapter , REG_BCN_CTRL)|BIT(4)); -+ -+ if (pHalData->RegFwHwTxQCtrl&BIT6) { -+ DBG_871X("HalDownloadRSVDPage(): There is an Adapter is sending beacon.\n"); -+ bSendBeacon = _TRUE; -+ } -+ -+ /* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ rtw_write8(padapter , REG_FWHW_TXQ_CTRL+2 , (pHalData->RegFwHwTxQCtrl&(~BIT6))); -+ pHalData->RegFwHwTxQCtrl &= (~BIT6); -+ -+ /* Clear beacon valid check bit.*/ -+ rtw_hal_set_hwreg(padapter , HW_VAR_BCN_VALID, NULL); -+ DLBcnCount = 0; -+ poll = 0; -+ do { -+ rtw_hal_set_fw_rsvd_page(padapter , _FALSE); -+ DLBcnCount++; -+ do { -+ rtw_yield_os(); -+ /*rtw_mdelay_os(10);*/ -+ /* check rsvd page download OK.*/ -+ rtw_hal_get_hwreg(padapter , HW_VAR_BCN_VALID , (u8 *)(&bcn_valid)); -+ poll++; -+ } while (!bcn_valid && (poll%10) != 0 && !RTW_CANNOT_RUN(padapter)); -+ -+ } while (!bcn_valid && DLBcnCount <= 100 && !RTW_CANNOT_RUN(padapter)); -+ -+ /*RT_ASSERT(bcn_valid, ("HalDownloadRSVDPage88ES(): 1 Download RSVD page failed!\n"));*/ -+ if (RTW_CANNOT_RUN(padapter)) -+ DBG_871X("%s bSurpriseRemoved:%s, bDriverStopped:%s\n" -+ , __func__ -+ , rtw_is_surprise_removed(padapter)?"True":"False" -+ , rtw_is_drv_stopped(padapter)?"True":"False"); -+ else if (!bcn_valid) -+ DBG_871X(ADPT_FMT": 1 DL RSVD page failed! DLBcnCount:%u, poll:%u\n", -+ ADPT_ARG(padapter) , DLBcnCount , poll); -+ else { -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ -+ pwrctl->fw_psmode_iface_id = padapter->iface_id; -+ DBG_871X(ADPT_FMT": 1 DL RSVD page success! DLBcnCount:%u, poll:%u\n", -+ ADPT_ARG(padapter) , DLBcnCount , poll); -+ } -+ /* -+ * We just can send the reserved page twice during the time that Tx thread is stopped (e.g. pnpsetpower) -+ * because we need to free the Tx BCN Desc which is used by the first reserved page packet. -+ * At run time, we cannot get the Tx Desc until it is released in TxHandleInterrupt() so we will return -+ * the beacon TCB in the following code. 2011.11.23. by tynli. -+ */ -+ /*if(bcn_valid && padapter->bEnterPnpSleep)*/ -+ if (0) { -+ if (bSendBeacon) { -+ rtw_hal_set_hwreg(padapter , HW_VAR_BCN_VALID, NULL); -+ DLBcnCount = 0; -+ poll = 0; -+ do { -+ /*SetFwRsvdPagePkt_8812(padapter, _TRUE);*/ -+ rtw_hal_set_fw_rsvd_page(padapter , _TRUE); -+ DLBcnCount++; -+ -+ do { -+ rtw_yield_os(); -+ /*rtw_mdelay_os(10);*/ -+ /* check rsvd page download OK.*/ -+ rtw_hal_get_hwreg(padapter , HW_VAR_BCN_VALID , (u8 *)(&bcn_valid)); -+ poll++; -+ } while (!bcn_valid && (poll%10) != 0 && !RTW_CANNOT_RUN(padapter)); -+ } while (!bcn_valid && DLBcnCount <= 100 && !RTW_CANNOT_RUN(padapter)); -+ -+ /*RT_ASSERT(bcn_valid, ("HalDownloadRSVDPage(): 2 Download RSVD page failed!\n"));*/ -+ if (RTW_CANNOT_RUN(padapter)) -+ DBG_871X("%s bSurpriseRemoved:%s, bDriverStopped:%s\n" -+ , __func__ -+ , rtw_is_surprise_removed(padapter)?"True":"False" -+ , rtw_is_drv_stopped(padapter)?"True":"False"); -+ else if (!bcn_valid) -+ DBG_871X("%s: 2 Download RSVD page failed! DLBcnCount:%u, poll:%u\n" , __func__ , DLBcnCount , poll); -+ else -+ DBG_871X("%s: 2 Download RSVD success! DLBcnCount:%u, poll:%u\n" , __func__ , DLBcnCount , poll); -+ } -+ } -+ -+ /* Enable Bcn*/ -+ /*SetBcnCtrlReg(padapter, BIT3, 0);*/ -+ /*SetBcnCtrlReg(padapter, 0, BIT4);*/ -+ rtw_write8(padapter , REG_BCN_CTRL , rtw_read8(padapter , REG_BCN_CTRL)|BIT(3)); -+ rtw_write8(padapter , REG_BCN_CTRL , rtw_read8(padapter , REG_BCN_CTRL)&(~BIT(4))); -+ -+ /* -+ * To make sure that if there exists an adapter which would like to send beacon. -+ * If exists, the origianl value of 0x422[6] will be 1, we should check this to -+ * prevent from setting 0x422[6] to 0 after download reserved page, or it will cause -+ * the beacon cannot be sent by HW. -+ * 2010.06.23. Added by tynli. -+ */ -+ if (bSendBeacon) { -+ rtw_write8(padapter , REG_FWHW_TXQ_CTRL+2 , (pHalData->RegFwHwTxQCtrl|BIT6)); -+ pHalData->RegFwHwTxQCtrl |= BIT6; -+ } -+ -+ -+ /* Update RSVD page location H2C to Fw.*/ -+ if (bcn_valid) { -+ rtw_hal_set_hwreg(padapter , HW_VAR_BCN_VALID , NULL); -+ DBG_871X("Set RSVD page location to Fw.\n"); -+ /*FillH2CCmd88E(Adapter, H2C_88E_RSVDPAGE, H2C_RSVDPAGE_LOC_LENGTH, pMgntInfo->u1RsvdPageLoc);*/ -+ } -+ -+ /* Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ -+ /*if(!padapter->bEnterPnpSleep)*/ -+ { -+ #ifndef CONFIG_PCI_HCI -+ /* Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ -+ pHalData->RegCR_1 &= (~BIT0); -+ rtw_write8(padapter, REG_CR+1 , pHalData->RegCR_1); -+ #endif -+ } -+ } -+#ifdef CONFIG_WOWLAN -+ if (adapter_to_pwrctl(padapter)->wowlan_mode) { -+ u16 media_status; -+ -+ media_status = mstatus; -+ rtl8812_set_FwMediaStatus_cmd(padapter, media_status); -+ DBG_871X_LEVEL(_drv_info_, "%s wowlan_mode is on\n" , __func__); -+ } else { -+ DBG_871X_LEVEL(_drv_info_, "%s wowlan_mode is off\n" , __func__); -+ } -+#endif /*CONFIG_WOWLAN*/ -+_func_exit_; -+} -+ -+int rtl8812_iqk_wait(_adapter* padapter, u32 timeout_ms) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct submit_ctx *iqk_sctx = &pHalData->iqk_sctx; -+ -+ iqk_sctx->submit_time = rtw_get_current_time(); -+ iqk_sctx->timeout_ms = timeout_ms; -+ iqk_sctx->status = RTW_SCTX_SUBMITTED; -+ -+ return rtw_sctx_wait(iqk_sctx, __func__); -+} -+ -+void rtl8812_iqk_done(_adapter* padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct submit_ctx *iqk_sctx = &pHalData->iqk_sctx; -+ -+ rtw_sctx_done(&iqk_sctx); -+} -+ -+static VOID -+C2HTxBeamformingHandler_8812( -+ IN PADAPTER Adapter, -+ IN u8* CmdBuf, -+ IN u8 CmdLen -+) -+{ -+ u8 status = CmdBuf[0] & BIT0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+#ifdef CONFIG_BEAMFORMING -+ -+#if (BEAMFORMING_SUPPORT == 1) -+ Beamforming_CheckSoundingSuccess(pDM_Odm, status); -+ #if (0)/*DEV_BUS_TYPE == RT_PCI_INTERFACE)*/ -+ phydm_Beamforming_End_SW(pDM_Odm, status); -+ #endif -+ -+#else /*(BEAMFORMING_SUPPORT == 0) - drv beamforming*/ -+ beamforming_check_sounding_success(Adapter, status); -+ #if (0)/*DEV_BUS_TYPE == RT_PCI_INTERFACE)*/ -+ beamforming_end_fw(Adapter, status); -+ #endif -+#endif -+ -+#endif /*#ifdef CONFIG_BEAMFORMING*/ -+} -+ -+static VOID -+C2HTxFeedbackHandler_8812( -+ IN PADAPTER Adapter, -+ IN u8 *CmdBuf, -+ IN u8 CmdLen -+) -+{ -+#ifdef CONFIG_XMIT_ACK -+ if (GET_8812_C2H_TX_RPT_RETRY_OVER(CmdBuf) | GET_8812_C2H_TX_RPT_LIFE_TIME_OVER(CmdBuf)) { -+ rtw_ack_tx_done(&Adapter->xmitpriv, RTW_SCTX_DONE_CCX_PKT_FAIL); -+ } else { -+ rtw_ack_tx_done(&Adapter->xmitpriv, RTW_SCTX_DONE_SUCCESS); -+ } -+#endif -+} -+ -+s32 -+_C2HContentParsing8812( -+ IN PADAPTER Adapter, -+ IN u8 c2hCmdId, -+ IN u8 c2hCmdLen, -+ IN u8 *tmpBuf -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ s32 ret = _SUCCESS; -+ -+ switch (c2hCmdId) { -+ case C2H_8812_TXBF: -+ DBG_871X("[C2H], C2H_8812_TXBF!!\n"); -+ C2HTxBeamformingHandler_8812(Adapter, tmpBuf, c2hCmdLen); -+ break; -+ -+ case C2H_8812_TX_REPORT: -+ //DBG_871X("[C2H], C2H_8812_TX_REPORT!!\n"); -+ C2HTxFeedbackHandler_8812(Adapter, tmpBuf, c2hCmdLen); -+ break; -+ -+#ifdef CONFIG_BT_COEXIST -+ case C2H_8812_BT_INFO: -+ //DBG_871X("[C2H], C2H_8812_BT_INFO!!\n"); -+ rtw_btcoex_BtInfoNotify(Adapter, c2hCmdLen, tmpBuf); -+ break; -+#endif -+ -+ case C2H_8812_BT_MP: -+ DBG_871X("[C2H], C2H_8812_BT_MP!!\n"); -+#ifdef CONFIG_MP_INCLUDED -+// MPTBT_FwC2hBtMpCtrl(Adapter, tmpBuf, c2hCmdLen); -+#else -+ //NDBG_FwC2hBtControl(Adapter, tmpBuf, c2hCmdLen); -+#endif -+ break; -+ -+ case C2H_8812_FW_SWCHNL: -+ //DBG_871X("channel to %d\n", *tmpBuf); -+ break; -+ -+ case C2H_8812_IQK_FINISH: -+ DBG_871X("== IQK Finish ==\n"); -+ rtl8812_iqk_done(Adapter); -+ //rtw_odm_acquirespinlock(Adapter, RT_IQK_SPINLOCK); -+ //pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; -+ //rtw_odm_releasespinlock(Adapter, RT_IQK_SPINLOCK); -+ break; -+ -+ case C2H_8812_MAILBOX_STATUS: -+ DBG_871X("[C2H], mailbox status:%u\n", *tmpBuf); -+ break; -+#ifdef CONFIG_FW_C2H_DEBUG -+ case C2H_8812_EXTEND: -+ { -+ u8 Extend_c2hSubID = tmpBuf[0]; -+ -+ if (Extend_c2hSubID == EXTEND_C2H_8812_DBG_PRINT) { -+ DBG_871X("[C2H], FW_DEBUG.\n"); -+ phydm_fw_trace_handler_8051(pDM_Odm, tmpBuf, c2hCmdLen); -+ } -+ } -+ break; -+#endif /* CONFIG_FW_C2H_DEBUG*/ -+ -+ default: -+ if (!(phydm_c2H_content_parsing(pDM_Odm, c2hCmdId, c2hCmdLen, tmpBuf))) { -+ DBG_871X("%s: [WARNING] unknown C2H(0x%02x)\n", __func__, c2hCmdId); -+ ret = _FAIL; -+ } -+ break; -+ } -+ -+ return ret; -+} -+ -+ -+VOID -+C2HPacketHandler_8812( -+ IN PADAPTER Adapter, -+ IN u8 *Buffer, -+ IN u8 Length -+ ) -+{ -+ struct c2h_evt_hdr_88xx *c2h_evt = (struct c2h_evt_hdr_88xx *)Buffer; -+ u8 c2hCmdId=0, c2hCmdSeq=0, c2hCmdLen=0; -+ u8 *tmpBuf=NULL; -+ -+ //PRINT_DATA(("C2HPacketHandler_8812"), Buffer, Length); -+ c2hCmdId = Buffer[0]; -+ c2hCmdSeq = Buffer[1]; -+ c2hCmdLen = Length -2; -+ tmpBuf = Buffer+2; -+ -+ //DBG_871X("[C2H packet], c2hCmdId=0x%x, c2hCmdSeq=0x%x, c2hCmdLen=%d\n", c2hCmdId, c2hCmdSeq, c2hCmdLen); -+ -+#ifdef CONFIG_BT_COEXIST -+ if (Length>16) { -+ DBG_871X("[C2H packet], c2hCmdId=0x%x, c2hCmdSeq=0x%x, c2hCmdLen=%d\n", c2hCmdId, c2hCmdSeq, c2hCmdLen); -+ rtw_warn_on(1); -+ } -+ -+ if (c2hCmdId == C2H_8812_BT_INFO) { -+ /* enqueue */ -+ if ((c2h_evt = (struct c2h_evt_hdr_88xx *)rtw_zmalloc(16)) != NULL) { -+ _rtw_memcpy(c2h_evt, Buffer, Length); -+ c2h_evt->plen = Length - 2; -+ //DBG_871X("-[C2H packet], id=0x%x, seq=0x%x, plen=%d\n", c2h_evt->id, c2h_evt->seq, c2h_evt->plen); -+ rtw_c2h_wk_cmd(Adapter, (u8 *)c2h_evt); -+ } -+ } -+ else -+#endif /* CONFIG_BT_COEXIST */ -+ { -+#ifdef CONFIG_BEAMFORMING -+ if (c2hCmdId == C2H_8812_TXBF) { -+ /* enqueue */ -+ c2h_evt = (struct c2h_evt_hdr_88xx *)rtw_zmalloc(16); -+ if (c2h_evt != NULL) { -+ _rtw_memcpy(c2h_evt, Buffer, Length); -+ c2h_evt->plen = Length - 2; -+ /*DBG_871X("-[C2H packet], id=0x%x, seq=0x%x, plen=%d\n", c2h_evt->id, c2h_evt->seq, c2h_evt->plen);*/ -+ rtw_c2h_wk_cmd(Adapter, (u8 *)c2h_evt); -+ } -+ } else -+#endif -+ { /* handle directly */ -+ _C2HContentParsing8812(Adapter, c2hCmdId, c2hCmdLen, tmpBuf); -+ } -+} -+} -+ -+#ifdef CONFIG_BT_COEXIST -+ -+void ConstructBtNullFunctionData( -+ PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength, -+ u8 *StaAddr, -+ u8 bQoS, -+ u8 AC, -+ u8 bEosp, -+ u8 bForcePowerSave) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 bssid[ETH_ALEN]; -+ -+ //DBG_871X("%s:%d\n", __FUNCTION__, bForcePowerSave); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; -+ -+ if (NULL == StaAddr) -+ { -+ _rtw_memcpy(bssid, adapter_mac_addr(padapter), ETH_ALEN); -+ StaAddr = bssid; -+ } -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ if (bForcePowerSave) -+ { -+ SetPwrMgt(fctrl); -+ } -+ -+ SetFrDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ SetDuration(pwlanhdr, 0); -+ SetSeqNum(pwlanhdr, 0); -+ -+ if (bQoS == _TRUE) { -+ struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; -+ -+ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); -+ -+ pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos*)pframe; -+ SetPriority(&pwlanqoshdr->qc, AC); -+ SetEOSP(&pwlanqoshdr->qc, bEosp); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ } else { -+ SetFrameSubType(pframe, WIFI_DATA_NULL); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ } -+ -+ *pLength = pktlen; -+} -+ -+ -+static void SetFwRsvdPagePkt_BTCoex(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ struct xmit_frame *pcmdframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ struct pwrctrl_priv *pwrctl; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u32 BeaconLength=0; -+ u32 NullDataLength=0, QosNullLength=0, BTQosNullLength=0; -+ u32 ProbeReqLength=0; -+ u8 *ReservedPagePacket; -+ u8 TxDescLen = TXDESC_SIZE, TxDescOffset = TXDESC_OFFSET; -+ u8 TotalPageNum=0, CurtPktPageNum=0, RsvdPageNum=0; -+ u16 BufIndex, PageSize = 256; -+ u32 TotalPacketLen, MaxRsvdPageBufSize=0; -+ RSVDPAGE_LOC RsvdPageLoc; -+ -+ -+ if(IS_HARDWARE_TYPE_8812(padapter)) -+ PageSize = 512; -+ else if (IS_HARDWARE_TYPE_8821(padapter)) -+ PageSize = PAGE_SIZE_TX_8821A; -+ //DBG_871X("%s---->\n", __FUNCTION__); -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ pxmitpriv = &padapter->xmitpriv; -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ pwrctl = adapter_to_pwrctl(padapter); -+ -+ //RsvdPageNum = BCNQ_PAGE_NUM_8723B + WOWLAN_PAGE_NUM_8723B; -+ -+ if(IS_HARDWARE_TYPE_8812(padapter)) -+ RsvdPageNum = BCNQ_PAGE_NUM_8812; -+ else if (IS_HARDWARE_TYPE_8821(padapter)) -+ RsvdPageNum = BCNQ_PAGE_NUM_8821; -+ MaxRsvdPageBufSize = RsvdPageNum*PageSize; -+ -+ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); -+ if (pcmdframe == NULL) { -+ DBG_871X("%s: alloc ReservedPagePacket fail!\n", __FUNCTION__); -+ return; -+ } -+ -+ ReservedPagePacket = pcmdframe->buf_addr; -+ _rtw_memset(&RsvdPageLoc, 0, sizeof(RSVDPAGE_LOC)); -+ -+ //3 (1) beacon -+ BufIndex = TxDescOffset; -+ ConstructBeacon(padapter, &ReservedPagePacket[BufIndex], &BeaconLength); -+ -+ // When we count the first page size, we need to reserve description size for the RSVD -+ // packet, it will be filled in front of the packet in TXPKTBUF. -+ CurtPktPageNum = (u8)PageNum(TxDescLen + BeaconLength, PageSize); -+ -+ //If we don't add 1 more page, the WOWLAN function has a problem. Baron thinks it's a bug of firmware -+ if (CurtPktPageNum == 1) -+ { -+ CurtPktPageNum += 1; -+ } -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ /* Jump to lastest third page *;RESERV 2 PAGES for TxBF NDPA */ -+ if (BufIndex < (MaxRsvdPageBufSize - PageSize)) -+ { -+ BufIndex = TxDescOffset + (MaxRsvdPageBufSize - PageSize); -+ if(IS_HARDWARE_TYPE_8812(padapter)) -+ TotalPageNum = BCNQ_PAGE_NUM_8812-2; -+ else if (IS_HARDWARE_TYPE_8821(padapter)) -+ TotalPageNum = BCNQ_PAGE_NUM_8821-2; -+ -+ } -+ -+ //3 (6) BT Qos null data -+ RsvdPageLoc.LocBTQosNull = TotalPageNum; -+ ConstructBtNullFunctionData( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ &BTQosNullLength, -+ NULL, -+ _TRUE, 0, 0, _FALSE); -+ rtl8812a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], BTQosNullLength, _FALSE, _TRUE, _FALSE); -+ -+ //DBG_871X("%s(): HW_VAR_SET_TX_CMD: BT QOS NULL DATA %p %d\n", -+ // __FUNCTION__, &ReservedPagePacket[BufIndex-TxDescLen], (BTQosNullLength+TxDescLen)); -+ -+ CurtPktPageNum = (u8)PageNum(TxDescLen + BTQosNullLength,PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ TotalPacketLen = BufIndex + BTQosNullLength; -+ if(TotalPacketLen > MaxRsvdPageBufSize) -+ { -+ DBG_871X("%s(): ERROR: The rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n",__FUNCTION__, -+ TotalPacketLen,MaxRsvdPageBufSize); -+ goto error; -+ } -+ else -+ { -+ // update attribute -+ pattrib = &pcmdframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->qsel = QSLT_BEACON; -+ pattrib->pktlen = pattrib->last_txcmdsz = TotalPacketLen - TxDescOffset; -+#ifdef CONFIG_PCI_HCI -+ dump_mgntframe(padapter, pcmdframe); -+#else -+ dump_mgntframe_and_wait(padapter, pcmdframe, 100); -+#endif -+ } -+ -+ DBG_871X("%s: Set RSVD page location to Fw ,TotalPacketLen(%d), TotalPageNum(%d)\n", __FUNCTION__,TotalPacketLen,TotalPageNum); -+ if(check_fwstate(pmlmepriv, _FW_LINKED)) { -+ rtl8812_set_FwRsvdPage_cmd(padapter, &RsvdPageLoc); -+ #ifdef CONFIG_WOWLAN -+ rtl8812_set_FwAoacRsvdPage_cmd(padapter, &RsvdPageLoc); -+ #endif -+ } -+ -+ return; -+ -+error: -+ -+ rtw_free_xmitframe(pxmitpriv, pcmdframe); -+} -+ -+ -+void rtl8812a_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ BOOLEAN bRecover = _FALSE; -+ BOOLEAN bcn_valid = _FALSE; -+ u8 DLBcnCount=0; -+ u32 poll = 0; -+ u8 val8; -+ u8 v8; -+ -+_func_enter_; -+ -+ DBG_8192C("+" FUNC_ADPT_FMT ": iface_type=%d", -+ FUNC_ADPT_ARG(padapter), get_iface_type(padapter)); -+ -+ -+ -+ -+ -+ // We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. -+ // Suggested by filen. Added by tynli. -+ rtw_write16(padapter, REG_BCN_PSR_RPT, (0xC000|pmlmeinfo->aid)); -+ -+ // set REG_CR bit 8 -+ v8 = rtw_read8(padapter, REG_CR+1); -+ v8 |= BIT(0); // ENSWBCN -+ rtw_write8(padapter, REG_CR+1, v8); -+ -+ // Disable Hw protection for a time which revserd for Hw sending beacon. -+ // Fix download reserved page packet fail that access collision with the protection time. -+ // 2010.05.11. Added by tynli. -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 &= ~BIT(3); -+ val8 |= BIT(4); -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ // Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. -+ if (pHalData->RegFwHwTxQCtrl & BIT(6)) -+ bRecover = _TRUE; -+ -+ // To tell Hw the packet is not a real beacon frame. -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, pHalData->RegFwHwTxQCtrl & ~BIT(6)); -+ pHalData->RegFwHwTxQCtrl &= ~BIT(6); -+ -+ // Clear beacon valid check bit. -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ -+ DLBcnCount = 0; -+ poll = 0; -+ do -+ { -+ SetFwRsvdPagePkt_BTCoex(padapter); -+ DLBcnCount++; -+ do -+ { -+ rtw_yield_os(); -+ //rtw_mdelay_os(10); -+ // check rsvd page download OK. -+ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8*)(&bcn_valid)); -+ poll++; -+ } while (!bcn_valid && (poll%10) != 0 && !RTW_CANNOT_RUN(padapter)); -+ -+ } while (!bcn_valid && DLBcnCount <= 100 && !RTW_CANNOT_RUN(padapter)); -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ ; -+ else if(!bcn_valid) -+ DBG_871X(ADPT_FMT": 1 DL RSVD page failed! DLBcnCount:%u, poll:%u\n", -+ ADPT_ARG(padapter) ,DLBcnCount, poll); -+ else { -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ pwrctl->fw_psmode_iface_id = padapter->iface_id; -+ DBG_871X(ADPT_FMT": 1 DL RSVD page success! DLBcnCount:%u, poll:%u\n", -+ ADPT_ARG(padapter), DLBcnCount, poll); -+ } -+ -+ // 2010.05.11. Added by tynli. -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 |= BIT(3); -+ val8 &= ~BIT(4); -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ // To make sure that if there exists an adapter which would like to send beacon. -+ // If exists, the origianl value of 0x422[6] will be 1, we should check this to -+ // prevent from setting 0x422[6] to 0 after download reserved page, or it will cause -+ // the beacon cannot be sent by HW. -+ // 2010.06.23. Added by tynli. -+ if(bRecover) -+ { -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, pHalData->RegFwHwTxQCtrl | BIT(6)); -+ pHalData->RegFwHwTxQCtrl |= BIT(6); -+ } -+ -+ #ifndef CONFIG_PCI_HCI -+ // Clear CR[8] or beacon packet will not be send to TxBuf anymore. -+ v8 = rtw_read8(padapter, REG_CR+1); -+ v8 &= ~BIT(0); // ~ENSWBCN -+ rtw_write8(padapter, REG_CR+1, v8); -+ #endif -+ -+ -+_func_exit_; -+} -+ -+#endif // CONFIG_BT_COEXIST -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_dm.c linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_dm.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_dm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_dm.c 2017-06-07 23:07:21.032689489 +0300 -@@ -0,0 +1,573 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+//============================================================ -+// Description: -+// -+// This file is for 92CE/92CU dynamic mechanism only -+// -+// -+//============================================================ -+#define _RTL8812A_DM_C_ -+ -+//============================================================ -+// include files -+//============================================================ -+//#include -+#include -+ -+//============================================================ -+// Global var -+//============================================================ -+ -+ -+static VOID -+dm_CheckProtection( -+ IN PADAPTER Adapter -+ ) -+{ -+#if 0 -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ u1Byte CurRate, RateThreshold; -+ -+ if(pMgntInfo->pHTInfo->bCurBW40MHz) -+ RateThreshold = MGN_MCS1; -+ else -+ RateThreshold = MGN_MCS3; -+ -+ if(Adapter->TxStats.CurrentInitTxRate <= RateThreshold) -+ { -+ pMgntInfo->bDmDisableProtect = TRUE; -+ DbgPrint("Forced disable protect: %x\n", Adapter->TxStats.CurrentInitTxRate); -+ } -+ else -+ { -+ pMgntInfo->bDmDisableProtect = FALSE; -+ DbgPrint("Enable protect: %x\n", Adapter->TxStats.CurrentInitTxRate); -+ } -+#endif -+} -+ -+static VOID -+dm_CheckStatistics( -+ IN PADAPTER Adapter -+ ) -+{ -+#if 0 -+ if(!Adapter->MgntInfo.bMediaConnect) -+ return; -+ -+ //2008.12.10 tynli Add for getting Current_Tx_Rate_Reg flexibly. -+ rtw_hal_get_hwreg( Adapter, HW_VAR_INIT_TX_RATE, (pu1Byte)(&Adapter->TxStats.CurrentInitTxRate) ); -+ -+ // Calculate current Tx Rate(Successful transmited!!) -+ -+ // Calculate current Rx Rate(Successful received!!) -+ -+ //for tx tx retry count -+ rtw_hal_get_hwreg( Adapter, HW_VAR_RETRY_COUNT, (pu1Byte)(&Adapter->TxStats.NumTxRetryCount) ); -+#endif -+} -+#ifdef CONFIG_SUPPORT_HW_WPS_PBC -+static void dm_CheckPbcGPIO(_adapter *padapter) -+{ -+ u8 tmp1byte; -+ u8 bPbcPressed = _FALSE; -+ -+ if(!padapter->registrypriv.hw_wps_pbc) -+ return; -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) -+ if (IS_HARDWARE_TYPE_8812(padapter)) -+ { -+ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL); -+ tmp1byte |= (HAL_8812A_HW_GPIO_WPS_BIT); -+ rtw_write8(padapter, GPIO_IO_SEL, tmp1byte); //enable GPIO[2] as output mode -+ -+ tmp1byte &= ~(HAL_8812A_HW_GPIO_WPS_BIT); -+ rtw_write8(padapter, GPIO_IN, tmp1byte); //reset the floating voltage level -+ -+ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL); -+ tmp1byte &= ~(HAL_8812A_HW_GPIO_WPS_BIT); -+ rtw_write8(padapter, GPIO_IO_SEL, tmp1byte); //enable GPIO[2] as input mode -+ -+ tmp1byte =rtw_read8(padapter, GPIO_IN); -+ -+ if (tmp1byte == 0xff) -+ return ; -+ -+ if (tmp1byte&HAL_8812A_HW_GPIO_WPS_BIT) -+ bPbcPressed = _TRUE; -+ -+ } -+ else if (IS_HARDWARE_TYPE_8821(padapter)) -+ { -+ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL_8811A); -+ tmp1byte |= (BIT4); -+ rtw_write8(padapter, GPIO_IO_SEL_8811A, tmp1byte); //enable GPIO[2] as output mode -+ -+ tmp1byte &= ~(BIT4); -+ rtw_write8(padapter, GPIO_IN_8811A, tmp1byte); //reset the floating voltage level -+ -+ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL_8811A); -+ tmp1byte &= ~(BIT4); -+ rtw_write8(padapter, GPIO_IO_SEL_8811A, tmp1byte); //enable GPIO[2] as input mode -+ -+ tmp1byte =rtw_read8(padapter, GPIO_IN_8811A); -+ -+ if (tmp1byte == 0xff) -+ return ; -+ -+ if (tmp1byte&BIT4) -+ { -+ bPbcPressed = _TRUE; -+ } -+ } -+#else -+ -+#endif -+ -+ if( _TRUE == bPbcPressed) -+ { -+ // Here we only set bPbcPressed to true -+ // After trigger PBC, the variable will be set to false -+ DBG_8192C("CheckPbcGPIO - PBC is pressed\n"); -+ -+ rtw_request_wps_pbc_event(padapter); -+ } -+} -+#endif //#ifdef CONFIG_SUPPORT_HW_WPS_PBC -+ -+#ifdef CONFIG_PCI_HCI -+// -+// Description: -+// Perform interrupt migration dynamically to reduce CPU utilization. -+// -+// Assumption: -+// 1. Do not enable migration under WIFI test. -+// -+// Created by Roger, 2010.03.05. -+// -+VOID -+dm_InterruptMigration( -+ IN PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bCurrentIntMt, bCurrentACIntDisable; -+ BOOLEAN IntMtToSet = _FALSE; -+ BOOLEAN ACIntToSet = _FALSE; -+ -+ -+ // Retrieve current interrupt migration and Tx four ACs IMR settings first. -+ bCurrentIntMt = pHalData->bInterruptMigration; -+ bCurrentACIntDisable = pHalData->bDisableTxInt; -+ -+ // -+ // Currently we use busy traffic for reference instead of RxIntOK counts to prevent non-linear Rx statistics -+ // when interrupt migration is set before. 2010.03.05. -+ // -+ if(!Adapter->registrypriv.wifi_spec && -+ (check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) && -+ pmlmepriv->LinkDetectInfo.bHigherBusyTraffic) -+ { -+ IntMtToSet = _TRUE; -+ -+ // To check whether we should disable Tx interrupt or not. -+ if(pmlmepriv->LinkDetectInfo.bHigherBusyRxTraffic ) -+ ACIntToSet = _TRUE; -+ } -+ -+ //Update current settings. -+ if( bCurrentIntMt != IntMtToSet ){ -+ DBG_8192C("%s(): Update interrrupt migration(%d)\n",__FUNCTION__,IntMtToSet); -+ if(IntMtToSet) -+ { -+ // -+ // Set interrrupt migration timer and corresponging Tx/Rx counter. -+ // timer 25ns*0xfa0=100us for 0xf packets. -+ // 2010.03.05. -+ // -+ rtw_write32(Adapter, REG_INT_MIG, 0xff000fa0);// 0x306:Rx, 0x307:Tx -+ pHalData->bInterruptMigration = IntMtToSet; -+ } -+ else -+ { -+ // Reset all interrupt migration settings. -+ rtw_write32(Adapter, REG_INT_MIG, 0); -+ pHalData->bInterruptMigration = IntMtToSet; -+ } -+ } -+ -+ /*if( bCurrentACIntDisable != ACIntToSet ){ -+ DBG_8192C("%s(): Update AC interrrupt(%d)\n",__FUNCTION__,ACIntToSet); -+ if(ACIntToSet) // Disable four ACs interrupts. -+ { -+ // -+ // Disable VO, VI, BE and BK four AC interrupts to gain more efficient CPU utilization. -+ // When extremely highly Rx OK occurs, we will disable Tx interrupts. -+ // 2010.03.05. -+ // -+ UpdateInterruptMask8192CE( Adapter, 0, RT_AC_INT_MASKS ); -+ pHalData->bDisableTxInt = ACIntToSet; -+ } -+ else// Enable four ACs interrupts. -+ { -+ UpdateInterruptMask8192CE( Adapter, RT_AC_INT_MASKS, 0 ); -+ pHalData->bDisableTxInt = ACIntToSet; -+ } -+ }*/ -+ -+} -+ -+#endif -+ -+// -+// Initialize GPIO setting registers -+// -+static void -+dm_InitGPIOSetting( -+ IN PADAPTER Adapter -+ ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ u8 tmp1byte; -+ -+ tmp1byte = rtw_read8(Adapter, REG_GPIO_MUXCFG); -+ tmp1byte &= (GPIOSEL_GPIO | ~GPIOSEL_ENBT); -+ -+ rtw_write8(Adapter, REG_GPIO_MUXCFG, tmp1byte); -+} -+ -+//============================================================ -+// functions -+//============================================================ -+static void Init_ODM_ComInfo_8812(PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ u32 SupportAbility = 0; -+ u8 cut_ver,fab_ver; -+ -+ Init_ODM_ComInfo(Adapter); -+ -+ if (IS_HARDWARE_TYPE_8812(Adapter)) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_IC_TYPE, ODM_RTL8812); -+ else if (IS_HARDWARE_TYPE_8821(Adapter)) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_IC_TYPE, ODM_RTL8821); -+ -+ fab_ver = ODM_TSMC; -+ if(IS_A_CUT(pHalData->VersionID)) -+ cut_ver = ODM_CUT_A; -+ else if(IS_B_CUT(pHalData->VersionID)) -+ cut_ver = ODM_CUT_B; -+ else if(IS_C_CUT(pHalData->VersionID)) -+ cut_ver = ODM_CUT_C; -+ else if(IS_D_CUT(pHalData->VersionID)) -+ cut_ver = ODM_CUT_D; -+ else if(IS_E_CUT(pHalData->VersionID)) -+ cut_ver = ODM_CUT_E; -+ else -+ cut_ver = ODM_CUT_A; -+ -+ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_FAB_VER,fab_ver); -+ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_CUT_VER,cut_ver); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, pHalData->TRxAntDivType); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_IQKFWOFFLOAD, pHalData->RegIQKFWOffload); -+ -+ #ifdef CONFIG_DISABLE_ODM -+ SupportAbility = 0; -+ #else -+ SupportAbility = ODM_RF_CALIBRATION | -+ ODM_RF_TX_PWR_TRACK -+ ; -+ /*if(pHalData->AntDivCfg) -+ SupportAbility |= ODM_BB_ANT_DIV; */ -+ #endif -+ -+ ODM_CmnInfoUpdate(pDM_Odm,ODM_CMNINFO_ABILITY,SupportAbility); -+ -+} -+static void Update_ODM_ComInfo_8812(PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ u32 SupportAbility = 0; -+ -+ SupportAbility = 0 -+ | ODM_BB_DIG -+ | ODM_BB_RA_MASK -+ | ODM_BB_FA_CNT -+ | ODM_BB_RSSI_MONITOR -+ | ODM_BB_CFO_TRACKING -+ | ODM_RF_TX_PWR_TRACK -+ | ODM_MAC_EDCA_TURBO -+ | ODM_BB_NHM_CNT -+// | ODM_BB_PWR_TRAIN -+ ; -+ -+ if (rtw_odm_adaptivity_needed(Adapter) == _TRUE) { -+ rtw_odm_adaptivity_config_msg(RTW_DBGDUMP, Adapter); -+ SupportAbility |= ODM_BB_ADAPTIVITY; -+ } -+ -+ if(pHalData->AntDivCfg) -+ SupportAbility |= ODM_BB_ANT_DIV; -+ -+#if (MP_DRIVER==1) -+ if (Adapter->registrypriv.mp_mode == 1) { -+ SupportAbility = 0 -+ | ODM_RF_CALIBRATION -+ | ODM_RF_TX_PWR_TRACK -+ ; -+ } -+#endif//(MP_DRIVER==1) -+ -+#ifdef CONFIG_DISABLE_ODM -+ SupportAbility = 0; -+#endif//CONFIG_DISABLE_ODM -+ -+ ODM_CmnInfoUpdate(pDM_Odm,ODM_CMNINFO_ABILITY,SupportAbility); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, pHalData->TRxAntDivType); -+} -+ -+void -+rtl8812_InitHalDm( -+ IN PADAPTER Adapter -+ ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ u8 i; -+ -+#ifdef CONFIG_USB_HCI -+ dm_InitGPIOSetting(Adapter); -+#endif -+ -+ pHalData->DM_Type = DM_Type_ByDriver; -+ -+ Update_ODM_ComInfo_8812(Adapter); -+ ODM_DMInit(pDM_Odm); -+ -+ //Adapter->fix_rate = 0xFF; -+ -+} -+ -+ -+VOID -+rtl8812_HalDmWatchDog( -+ IN PADAPTER Adapter -+ ) -+{ -+ BOOLEAN bFwCurrentInPSMode = _FALSE; -+ BOOLEAN bFwPSAwake = _TRUE; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+#ifdef CONFIG_CONCURRENT_MODE -+ PADAPTER pbuddy_adapter = Adapter->pbuddy_adapter; -+#endif //CONFIG_CONCURRENT_MODE -+ -+ _func_enter_; -+ -+ if (!rtw_is_hw_init_completed(Adapter)) -+ goto skip_dm; -+ -+#ifdef CONFIG_LPS -+ bFwCurrentInPSMode = adapter_to_pwrctl(Adapter)->bFwCurrentInPSMode; -+ rtw_hal_get_hwreg(Adapter, HW_VAR_FWLPS_RF_ON, (u8 *)(&bFwPSAwake)); -+#endif -+ -+#ifdef CONFIG_P2P_PS -+ // Fw is under p2p powersaving mode, driver should stop dynamic mechanism. -+ // modifed by thomas. 2011.06.11. -+ if(Adapter->wdinfo.p2p_ps_mode) -+ bFwPSAwake = _FALSE; -+#endif //CONFIG_P2P_PS -+ -+ if ((rtw_is_hw_init_completed(Adapter)) -+ && ((!bFwCurrentInPSMode) && bFwPSAwake)) { -+ // -+ // Calculate Tx/Rx statistics. -+ // -+ dm_CheckStatistics(Adapter); -+ rtw_hal_check_rxfifo_full(Adapter); -+ // -+ // Dynamically switch RTS/CTS protection. -+ // -+ //dm_CheckProtection(Adapter); -+ -+#ifdef CONFIG_PCI_HCI -+ // 20100630 Joseph: Disable Interrupt Migration mechanism temporarily because it degrades Rx throughput. -+ // Tx Migration settings. -+ //dm_InterruptMigration(Adapter); -+ -+ //if(Adapter->HalFunc.TxCheckStuckHandler(Adapter)) -+ // PlatformScheduleWorkItem(&(GET_HAL_DATA(Adapter)->HalResetWorkItem)); -+#endif -+ -+ } -+ -+ //ODM -+ if (rtw_is_hw_init_completed(Adapter)) -+ { -+ u8 bLinked=_FALSE; -+ u8 bsta_state=_FALSE; -+ u8 bBtDisabled = _TRUE; -+ -+ #ifdef CONFIG_DISABLE_ODM -+ pHalData->odmpriv.SupportAbility = 0; -+ #endif -+ -+ if(rtw_linked_check(Adapter)){ -+ bLinked = _TRUE; -+ if (check_fwstate(&Adapter->mlmepriv, WIFI_STATION_STATE)) -+ bsta_state = _TRUE; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(pbuddy_adapter && rtw_linked_check(pbuddy_adapter)){ -+ bLinked = _TRUE; -+ if(pbuddy_adapter && check_fwstate(&pbuddy_adapter->mlmepriv, WIFI_STATION_STATE)) -+ bsta_state = _TRUE; -+ } -+#endif //CONFIG_CONCURRENT_MODE -+ -+ ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_LINK, bLinked); -+ ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_STATION_STATE, bsta_state); -+ -+#ifdef CONFIG_BT_COEXIST -+ bBtDisabled = rtw_btcoex_IsBtDisabled(Adapter); -+#endif // CONFIG_BT_COEXIST -+ ODM_CmnInfoUpdate(&pHalData->odmpriv, ODM_CMNINFO_BT_ENABLED, ((bBtDisabled == _TRUE)?_FALSE:_TRUE)); -+ -+ ODM_DMWatchdog(&pHalData->odmpriv); -+ -+ } -+ -+skip_dm: -+ -+#ifdef CONFIG_SUPPORT_HW_WPS_PBC -+ // Check GPIO to determine current Pbc status. -+ dm_CheckPbcGPIO(Adapter); -+#endif -+ -+ return; -+} -+ -+void rtl8812_init_dm_priv(IN PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ -+ //_rtw_spinlock_init(&(pHalData->odm_stainfo_lock)); -+ -+#ifdef CONFIG_BT_COEXIST -+ /* firmware size issue, btcoex fw doesn't support IQK offload */ -+ if (pHalData->EEPROMBluetoothCoexist == _FALSE) -+#endif -+ { -+ pHalData->RegIQKFWOffload = 1; -+ rtw_sctx_init(&pHalData->iqk_sctx, 0); -+ } -+ -+ Init_ODM_ComInfo_8812(Adapter); -+ ODM_InitAllTimers(podmpriv ); -+ PHYDM_InitDebugSetting(podmpriv); -+ -+ pHalData->TxPwrInPercentage = TX_PWR_PERCENTAGE_3; -+ -+} -+ -+void rtl8812_deinit_dm_priv(IN PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ //_rtw_spinlock_free(&pHalData->odm_stainfo_lock); -+ ODM_CancelAllTimers(podmpriv); -+} -+ -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+// Add new function to reset the state of antenna diversity before link. -+// -+// Compare RSSI for deciding antenna -+void AntDivCompare8812(PADAPTER Adapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src) -+{ -+ //PADAPTER Adapter = pDM_Odm->Adapter ; -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ if(0 != pHalData->AntDivCfg ) -+ { -+ //DBG_8192C("update_network=> orgRSSI(%d)(%d),newRSSI(%d)(%d)\n",dst->Rssi,query_rx_pwr_percentage(dst->Rssi), -+ // src->Rssi,query_rx_pwr_percentage(src->Rssi)); -+ //select optimum_antenna for before linked =>For antenna diversity -+ if(dst->Rssi >= src->Rssi )//keep org parameter -+ { -+ src->Rssi = dst->Rssi; -+ src->PhyInfo.Optimum_antenna = dst->PhyInfo.Optimum_antenna; -+ } -+ } -+} -+ -+// Add new function to reset the state of antenna diversity before link. -+u8 AntDivBeforeLink8812(PADAPTER Adapter ) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm =&pHalData->odmpriv; -+ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ -+ // Condition that does not need to use antenna diversity. -+ if(pHalData->AntDivCfg==0) -+ { -+ //DBG_8192C("odm_AntDivBeforeLink8192C(): No AntDiv Mechanism.\n"); -+ return _FALSE; -+ } -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ { -+ return _FALSE; -+ } -+ -+ -+ if(pDM_SWAT_Table->SWAS_NoLink_State == 0){ -+ //switch channel -+ pDM_SWAT_Table->SWAS_NoLink_State = 1; -+ pDM_SWAT_Table->CurAntenna = (pDM_SWAT_Table->CurAntenna==MAIN_ANT)?AUX_ANT:MAIN_ANT; -+ -+ //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300, pDM_SWAT_Table->CurAntenna); -+ rtw_antenna_select_cmd(Adapter, pDM_SWAT_Table->CurAntenna, _FALSE); -+ //DBG_8192C("%s change antenna to ANT_( %s ).....\n",__FUNCTION__, (pDM_SWAT_Table->CurAntenna==MAIN_ANT)?"MAIN":"AUX"); -+ return _TRUE; -+ } -+ else -+ { -+ pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ return _FALSE; -+ } -+ -+} -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c 2017-06-07 23:07:21.033689581 +0300 -@@ -0,0 +1,6720 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_hal_init.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_hal_init.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_hal_init.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_hal_init.c 2018-02-06 17:42:30.714967223 +0200 +@@ -0,0 +1,5955 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -271739,38 +111269,475 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTL8812A_HAL_INIT_C_ + +//#include +#include + ++ ++#if defined(CONFIG_IOL) ++void iol_mode_enable(PADAPTER padapter, u8 enable) ++{ ++ u8 reg_0xf0 = 0; ++ ++ if(enable) ++ { ++ //Enable initial offload ++ reg_0xf0 = rtw_read8(padapter, REG_SYS_CFG); ++ //DBG_871X("%s reg_0xf0:0x%02x, write 0x%02x\n", __FUNCTION__, reg_0xf0, reg_0xf0|IOL_ENABLE); ++ rtw_write8(padapter, REG_SYS_CFG, reg_0xf0|SW_OFFLOAD_EN); ++ ++ _8051Reset8812(padapter); ++ } ++ else ++ { ++ //disable initial offload ++ reg_0xf0 = rtw_read8(padapter, REG_SYS_CFG); ++ //DBG_871X("%s reg_0xf0:0x%02x, write 0x%02x\n", __FUNCTION__, reg_0xf0, reg_0xf0& ~IOL_ENABLE); ++ rtw_write8(padapter, REG_SYS_CFG, reg_0xf0 & ~SW_OFFLOAD_EN); ++ } ++} ++ ++s32 iol_execute(PADAPTER padapter, u8 control) ++{ ++ s32 status = _FAIL; ++ u8 reg_0x88 = 0; ++ u32 start = 0, passing_time = 0; ++ control = control&0x0f; ++ ++ reg_0x88 = rtw_read8(padapter, 0x88); ++ //DBG_871X("%s reg_0x88:0x%02x, write 0x%02x\n", __FUNCTION__, reg_0x88, reg_0x88|control); ++ rtw_write8(padapter, 0x88, reg_0x88|control); ++ ++ start = rtw_get_current_time(); ++ while((reg_0x88=rtw_read8(padapter, 0x88)) & control ++ && (passing_time=rtw_get_passing_time_ms(start))<1000 ++ ) { ++ DBG_871X("%s polling reg_0x88:0x%02x\n", __FUNCTION__, reg_0x88); ++ rtw_usleep_os(100); ++ } ++ ++ reg_0x88 = rtw_read8(padapter, 0x88); ++ status = (reg_0x88 & control)?_FAIL:_SUCCESS; ++ if(reg_0x88 & control<<4) ++ status = _FAIL; ++ ++ DBG_871X("%s in %u ms, reg_0x88:0x%02x\n", __FUNCTION__, passing_time, reg_0x88); ++ ++ return status; ++} ++ ++s32 iol_InitLLTTable( ++ PADAPTER padapter, ++ u8 txpktbuf_bndy ++ ) ++{ ++ //DBG_871X("%s txpktbuf_bndy:%u\n", __FUNCTION__, txpktbuf_bndy); ++ rtw_write8(padapter, REG_TDECTRL+1, txpktbuf_bndy); ++ return iol_execute(padapter, IOL_INIT_LLT); ++} ++ ++static void ++efuse_phymap_to_logical(u8 * phymap, u16 _offset, u16 _size_byte, u8 *pbuf) ++{ ++ u8 *efuseTbl = NULL; ++ u8 rtemp8; ++ u16 eFuse_Addr = 0; ++ u8 offset, wren; ++ u16 i, j; ++ u16 **eFuseWord = NULL; ++ u16 efuse_utilized = 0; ++ u8 efuse_usage = 0; ++ u8 u1temp = 0; ++ ++ ++ efuseTbl = (u8*)rtw_zmalloc(EFUSE_MAP_LEN_JAGUAR); ++ if(efuseTbl == NULL) ++ { ++ DBG_871X("%s: alloc efuseTbl fail!\n", __FUNCTION__); ++ goto exit; ++ } ++ ++ eFuseWord= (u16 **)rtw_malloc2d(EFUSE_MAX_SECTION_JAGUAR, EFUSE_MAX_WORD_UNIT, sizeof(u16)); ++ if(eFuseWord == NULL) ++ { ++ DBG_871X("%s: alloc eFuseWord fail!\n", __FUNCTION__); ++ goto exit; ++ } ++ ++ // 0. Refresh efuse init map as all oxFF. ++ for (i = 0; i < EFUSE_MAX_SECTION_JAGUAR; i++) ++ for (j = 0; j < EFUSE_MAX_WORD_UNIT; j++) ++ eFuseWord[i][j] = 0xFFFF; ++ ++ // ++ // 1. Read the first byte to check if efuse is empty!!! ++ // ++ // ++ rtemp8 = *(phymap+eFuse_Addr); ++ if(rtemp8 != 0xFF) ++ { ++ efuse_utilized++; ++ //printk("efuse_Addr-%d efuse_data=%x\n", eFuse_Addr, *rtemp8); ++ eFuse_Addr++; ++ } ++ else ++ { ++ DBG_871X("EFUSE is empty efuse_Addr-%d efuse_data=%x\n", eFuse_Addr, rtemp8); ++ goto exit; ++ } ++ ++ ++ // ++ // 2. Read real efuse content. Filter PG header and every section data. ++ // ++ while((rtemp8 != 0xFF) && (eFuse_Addr < EFUSE_REAL_CONTENT_LEN_JAGUAR)) ++ { ++ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("efuse_Addr-%d efuse_data=%x\n", eFuse_Addr-1, *rtemp8)); ++ ++ // Check PG header for section num. ++ if((rtemp8 & 0x1F ) == 0x0F) //extended header ++ { ++ u1temp =( (rtemp8 & 0xE0) >> 5); ++ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("extended header u1temp=%x *rtemp&0xE0 0x%x\n", u1temp, *rtemp8 & 0xE0)); ++ ++ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("extended header u1temp=%x \n", u1temp)); ++ ++ rtemp8 = *(phymap+eFuse_Addr); ++ ++ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("extended header efuse_Addr-%d efuse_data=%x\n", eFuse_Addr, *rtemp8)); ++ ++ if((rtemp8 & 0x0F) == 0x0F) ++ { ++ eFuse_Addr++; ++ rtemp8 = *(phymap+eFuse_Addr); ++ ++ if(rtemp8 != 0xFF && (eFuse_Addr < EFUSE_REAL_CONTENT_LEN_JAGUAR)) ++ { ++ eFuse_Addr++; ++ } ++ continue; ++ } ++ else ++ { ++ offset = ((rtemp8 & 0xF0) >> 1) | u1temp; ++ wren = (rtemp8 & 0x0F); ++ eFuse_Addr++; ++ } ++ } ++ else ++ { ++ offset = ((rtemp8 >> 4) & 0x0f); ++ wren = (rtemp8 & 0x0f); ++ } ++ ++ if(offset < EFUSE_MAX_SECTION_JAGUAR) ++ { ++ // Get word enable value from PG header ++ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("Offset-%d Worden=%x\n", offset, wren)); ++ ++ for(i=0; i= EFUSE_REAL_CONTENT_LEN_JAGUAR) ++ break; ++ ++ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("Addr=%d", eFuse_Addr)); ++ rtemp8 = *(phymap+eFuse_Addr); ++ eFuse_Addr++; ++ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("Data=0x%x\n", *rtemp8)); ++ ++ efuse_utilized++; ++ eFuseWord[offset][i] |= (((u2Byte)rtemp8 << 8) & 0xff00); ++ ++ if(eFuse_Addr >= EFUSE_REAL_CONTENT_LEN_JAGUAR) ++ break; ++ } ++ ++ wren >>= 1; ++ ++ } ++ } ++ ++ // Read next PG header ++ rtemp8 = *(phymap+eFuse_Addr); ++ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("Addr=%d rtemp 0x%x\n", eFuse_Addr, *rtemp8)); ++ ++ if(rtemp8 != 0xFF && (eFuse_Addr < EFUSE_REAL_CONTENT_LEN_JAGUAR)) ++ { ++ efuse_utilized++; ++ eFuse_Addr++; ++ } ++ } ++ ++ // ++ // 3. Collect 16 sections and 4 word unit into Efuse map. ++ // ++ for(i=0; i> 8) & 0xff); ++ } ++ } ++ ++ ++ // ++ // 4. Copy from Efuse map to output pointer memory!!! ++ // ++ for(i=0; i<_size_byte; i++) ++ { ++ pbuf[i] = efuseTbl[_offset+i]; ++ } ++ ++ // ++ // 5. Calculate Efuse utilization. ++ // ++ efuse_usage = (u1Byte)((efuse_utilized*100)/EFUSE_REAL_CONTENT_LEN_JAGUAR); ++ //Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_EFUSE_BYTES, (u8 *)&efuse_utilized); ++ ++exit: ++ if(efuseTbl) ++ rtw_mfree(efuseTbl, EFUSE_MAP_LEN_JAGUAR); ++ ++ if(eFuseWord) ++ rtw_mfree2d((void *)eFuseWord, EFUSE_MAX_SECTION_JAGUAR, EFUSE_MAX_WORD_UNIT, sizeof(u16)); ++} ++ ++void efuse_read_phymap_from_txpktbuf( ++ ADAPTER *adapter, ++ int bcnhead, //beacon head, where FW store len(2-byte) and efuse physical map. ++ u8 *content, //buffer to store efuse physical map ++ u16 *size //for efuse content: the max byte to read. will update to byte read ++ ) ++{ ++ u16 dbg_addr = 0; ++ u32 start = 0, passing_time = 0; ++ u8 reg_0x143 = 0; ++ u8 reg_0x106 = 0; ++ u32 lo32 = 0, hi32 = 0; ++ u16 len = 0, count = 0; ++ int i = 0; ++ u16 limit = *size; ++ ++ u8 *pos = content; ++ ++ if(bcnhead<0) //if not valid ++ bcnhead = rtw_read8(adapter, REG_TDECTRL+1); ++ ++ DBG_871X("%s bcnhead:%d\n", __FUNCTION__, bcnhead); ++ ++ //reg_0x106 = rtw_read8(adapter, REG_PKT_BUFF_ACCESS_CTRL); ++ //DBG_871X("%s reg_0x106:0x%02x, write 0x%02x\n", __FUNCTION__, reg_0x106, 0x69); ++ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, TXPKT_BUF_SELECT); ++ //DBG_871X("%s reg_0x106:0x%02x\n", __FUNCTION__, rtw_read8(adapter, 0x106)); ++ ++ dbg_addr = bcnhead*128/8; //8-bytes addressing ++ ++ while(1) ++ { ++ //DBG_871X("%s dbg_addr:0x%x\n", __FUNCTION__, dbg_addr+i); ++ rtw_write16(adapter, REG_PKTBUF_DBG_ADDR, dbg_addr+i); ++ ++ //DBG_871X("%s write reg_0x143:0x00\n", __FUNCTION__); ++ rtw_write8(adapter, REG_TXPKTBUF_DBG, 0); ++ start = rtw_get_current_time(); ++ while(!(reg_0x143=rtw_read8(adapter, REG_TXPKTBUF_DBG))//dbg ++ //while(rtw_read8(adapter, REG_TXPKTBUF_DBG) & BIT0 ++ && (passing_time=rtw_get_passing_time_ms(start))<1000 ++ ) { ++ DBG_871X("%s polling reg_0x143:0x%02x, reg_0x106:0x%02x\n", __FUNCTION__, reg_0x143, rtw_read8(adapter, 0x106)); ++ rtw_usleep_os(100); ++ } ++ ++ ++ lo32 = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L); ++ hi32 = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H); ++ ++ #if 0 ++ DBG_871X("%s lo32:0x%08x, %02x %02x %02x %02x\n", __FUNCTION__, lo32 ++ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_L) ++ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_L+1) ++ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_L+2) ++ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_L+3) ++ ); ++ DBG_871X("%s hi32:0x%08x, %02x %02x %02x %02x\n", __FUNCTION__, hi32 ++ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_H) ++ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_H+1) ++ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_H+2) ++ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_H+3) ++ ); ++ #endif ++ ++ if(i==0) ++ { ++ #if 1 //for debug ++ u8 lenc[2]; ++ u16 lenbak, aaabak; ++ u16 aaa; ++ lenc[0] = rtw_read8(adapter, REG_PKTBUF_DBG_DATA_L); ++ lenc[1] = rtw_read8(adapter, REG_PKTBUF_DBG_DATA_L+1); ++ ++ aaabak = le16_to_cpup((u16*)lenc); ++ lenbak = le16_to_cpu(*((u16*)lenc)); ++ aaa = le16_to_cpup((u16*)&lo32); ++ #endif ++ len = le16_to_cpu(*((u16*)&lo32)); ++ ++ limit = len-2=count+2?2:limit-count); ++ count+=limit>=count+2?2:limit-count; ++ pos=content+count; ++ ++ } ++ else ++ { ++ _rtw_memcpy(pos, ((u8*)&lo32), limit>=count+4?4:limit-count); ++ count+=limit>=count+4?4:limit-count; ++ pos=content+count; ++ ++ ++ } ++ ++ if(limit>count && len-2>count) { ++ _rtw_memcpy(pos, (u8*)&hi32, limit>=count+4?4:limit-count); ++ count+=limit>=count+4?4:limit-count; ++ pos=content+count; ++ } ++ ++ if(limit<=count || len-2<=count) ++ break; ++ ++ i++; ++ } ++ ++ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, DISABLE_TRXPKT_BUF_ACCESS); ++ ++ DBG_871X("%s read count:%u\n", __FUNCTION__, count); ++ *size = count; ++ ++} ++ ++ ++static bool efuse_read_phymap( ++ PADAPTER Adapter, ++ u8 *pbuf, //buffer to store efuse physical map ++ u16 *size //the max byte to read. will update to byte read ++ ) ++{ ++ u8 *pos = pbuf; ++ u16 limit = *size; ++ u16 addr = 0; ++ bool reach_end = false; ++ ++ // ++ // Refresh efuse init map as all 0xFF. ++ // ++ _rtw_memset(pbuf, 0xFF, limit); ++ ++ ++ // ++ // Read physical efuse content. ++ // ++ while(addr < limit) ++ { ++ ReadEFuseByte(Adapter, addr, pos, false); ++ if(*pos != 0xFF) ++ { ++ pos++; ++ addr++; ++ } ++ else ++ { ++ reach_end = true; ++ break; ++ } ++ } ++ ++ *size = addr; ++ ++ return reach_end; ++ ++} ++ ++s32 iol_read_efuse( ++ PADAPTER padapter, ++ u8 txpktbuf_bndy, ++ u16 offset, ++ u16 size_byte, ++ u8 *logical_map ++ ) ++{ ++ s32 status = _FAIL; ++ u8 reg_0x106 = 0; ++ u8 physical_map[512]; ++ u16 size = 512; ++ int i; ++ ++ ++ rtw_write8(padapter, REG_TDECTRL+1, txpktbuf_bndy); ++ _rtw_memset(physical_map, 0xFF, 512); ++ ++ ///reg_0x106 = rtw_read8(padapter, REG_PKT_BUFF_ACCESS_CTRL); ++ //DBG_871X("%s reg_0x106:0x%02x, write 0x%02x\n", __FUNCTION__, reg_0x106, 0x69); ++ rtw_write8(padapter, REG_PKT_BUFF_ACCESS_CTRL, TXPKT_BUF_SELECT); ++ //DBG_871X("%s reg_0x106:0x%02x\n", __FUNCTION__, rtw_read8(padapter, 0x106)); ++ ++ status = iol_execute(padapter, IOL_READ_EFUSE_MAP); ++ ++ if(status == _SUCCESS) ++ efuse_read_phymap_from_txpktbuf(padapter, txpktbuf_bndy, physical_map, &size); ++ ++ #if 0 ++ DBG_871X("%s physical map\n", __FUNCTION__); ++ for(i=0;ipwrctrlpriv; + -+ EFUSE_ShadowRead(Adapter, 1, EEPROM_RF_FEATURE_OPTION_8812, (u32 *)&tmpvalue); ++ EFUSE_ShadowRead(Adapter, 1, EEPROM_RF_OPT3_92C, (u32 *)&tmpvalue); + + // 2010/08/25 MH INF priority > PDN Efuse value. + if(tmpvalue & BIT(4) && pwrctrlpriv->reg_pdnmode) + { -+ pHalData->pwrdown = _TRUE; ++ pHalData->pwrdown = true; + } + else + { -+ pHalData->pwrdown = _FALSE; ++ pHalData->pwrdown = false; + } + + DBG_8192C("HalDetectPwrDownMode(): PDN=%d\n", pHalData->pwrdown); @@ -271876,10 +111850,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + return pHalData->pwrdown; +} // HalDetectPwrDownMode + -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++#ifdef CONFIG_WOWLAN +void Hal_DetectWoWMode(PADAPTER pAdapter) +{ -+ adapter_to_pwrctl(pAdapter)->bSupportRemoteWakeup = _TRUE; ++ pAdapter->pwrctrlpriv.bSupportRemoteWakeup = true; ++ DBG_871X("%s\n", __func__); +} +#endif + @@ -271905,19 +111880,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + pHalData->RegBcnCtrlVal |= SetBits; + pHalData->RegBcnCtrlVal &= ~ClearBits; + -+#if 0 -+//#ifdef CONFIG_SDIO_HCI -+ if (pHalData->sdio_himr & (SDIO_HIMR_TXBCNOK_MSK | SDIO_HIMR_TXBCNERR_MSK)) -+ pHalData->RegBcnCtrlVal |= EN_TXBCN_RPT; -+#endif -+ + rtw_write8(padapter, REG_BCN_CTRL, (u8)pHalData->RegBcnCtrlVal); +} + -+static VOID ++static void +_FWDownloadEnable_8812( -+ IN PADAPTER padapter, -+ IN BOOLEAN enable ++ PADAPTER padapter, ++ bool enable + ) +{ + u8 tmp; @@ -271933,19 +111902,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + rtw_write8(padapter, REG_MCUFWDL+2, tmp&0xf7); + } + else -+ { -+ ++ { ++ + // MCU firmware download disable. + tmp = rtw_read8(padapter, REG_MCUFWDL); + rtw_write8(padapter, REG_MCUFWDL, tmp&0xfe); + } +} -+#define MAX_REG_BOLCK_SIZE 196 ++#define MAX_REG_BOLCK_SIZE 196 +static int +_BlockWrite_8812( -+ IN PADAPTER padapter, -+ IN PVOID buffer, -+ IN u32 buffSize ++ PADAPTER padapter, ++ void * buffer, ++ u32 buffSize + ) +{ + int ret = _SUCCESS; @@ -271957,14 +111926,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + u32 remainSize_p1 = 0, remainSize_p2 = 0; + u8 *bufferPtr = (u8*)buffer; + u32 i=0, offset=0; -+#ifdef CONFIG_PCI_HCI -+ u8 remainFW[4] = {0, 0, 0, 0}; -+ u8 *p = NULL; -+#endif -+ -+#ifdef CONFIG_USB_HCI + blockSize_p1 = MAX_REG_BOLCK_SIZE; -+#endif + + //3 Phase #1 + blockCount_p1 = buffSize / blockSize_p1; @@ -271978,35 +111940,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + for (i = 0; i < blockCount_p1; i++) + { -+#ifdef CONFIG_USB_HCI + ret = rtw_writeN(padapter, (FW_START_ADDRESS + i * blockSize_p1), blockSize_p1, (bufferPtr + i * blockSize_p1)); -+#else -+ ret = rtw_write32(padapter, (FW_START_ADDRESS + i * blockSize_p1), le32_to_cpu(*((u32*)(bufferPtr + i * blockSize_p1)))); -+#endif + + if(ret == _FAIL) + goto exit; + } + -+#ifdef CONFIG_PCI_HCI -+ p = (u8*)((u32*)(bufferPtr + blockCount_p1 * blockSize_p1)); -+ if (remainSize_p1) { -+ switch (remainSize_p1) { -+ case 0: -+ break; -+ case 3: -+ remainFW[2]=*(p+2); -+ case 2: -+ remainFW[1]=*(p+1); -+ case 1: -+ remainFW[0]=*(p); -+ ret = rtw_write32(padapter, (FW_START_ADDRESS + blockCount_p1 * blockSize_p1), -+ le32_to_cpu(*(u32*)remainFW)); -+ } -+ return ret; -+ } -+#endif -+ + //3 Phase #2 + if (remainSize_p1) + { @@ -272021,14 +111960,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + (buffSize-offset), blockSize_p2 ,blockCount_p2, remainSize_p2)); + } + -+#ifdef CONFIG_USB_HCI + for (i = 0; i < blockCount_p2; i++) { + ret = rtw_writeN(padapter, (FW_START_ADDRESS + offset + i*blockSize_p2), blockSize_p2, (bufferPtr + offset + i*blockSize_p2)); -+ ++ + if(ret == _FAIL) + goto exit; + } -+#endif + } + + //3 Phase #3 @@ -272044,7 +111981,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + for(i = 0 ; i < blockCount_p3 ; i++){ + ret =rtw_write8(padapter, (FW_START_ADDRESS + offset + i), *(bufferPtr + offset + i)); -+ ++ + if(ret == _FAIL) + goto exit; + } @@ -272056,10 +111993,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + +static int +_PageWrite_8812( -+ IN PADAPTER padapter, -+ IN u32 page, -+ IN PVOID buffer, -+ IN u32 size ++ PADAPTER padapter, ++ u32 page, ++ void * buffer, ++ u32 size + ) +{ + u8 value8; @@ -272071,7 +112008,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + return _BlockWrite_8812(padapter,buffer,size); +} + -+static VOID ++static void +_FillDummy_8812( + u8* pFwBuf, + u32* pFwLen @@ -272093,31 +112030,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + +static int +_WriteFW_8812( -+ IN PADAPTER padapter, -+ IN PVOID buffer, -+ IN u32 size ++ PADAPTER padapter, ++ void * buffer, ++ u32 size + ) +{ + // Since we need dynamic decide method of dwonload fw, so we call this function to get chip version. ++ // We can remove _ReadChipVersion from ReadpadapterInfo8192C later. + int ret = _SUCCESS; + u32 pageNums,remainSize ; + u32 page, offset; + u8 *bufferPtr = (u8*)buffer; + -+#ifdef CONFIG_PCI_HCI -+ // 20100120 Joseph: Add for 88CE normal chip. -+ // Fill in zero to make firmware image to dword alignment. -+// _FillDummy(bufferPtr, &size); -+#endif -+ + pageNums = size / MAX_DLFW_PAGE_SIZE ; -+ //RT_ASSERT((pageNums <= 4), ("Page numbers should not greater then 4 \n")); + remainSize = size % MAX_DLFW_PAGE_SIZE; + + for (page = 0; page < pageNums; page++) { + offset = page * MAX_DLFW_PAGE_SIZE; + ret = _PageWrite_8812(padapter, page, bufferPtr+offset, MAX_DLFW_PAGE_SIZE); -+ ++ + if(ret == _FAIL) + goto exit; + } @@ -272125,7 +112056,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + offset = pageNums * MAX_DLFW_PAGE_SIZE; + page = pageNums; + ret = _PageWrite_8812(padapter, page, bufferPtr+offset, remainSize); -+ ++ + if(ret == _FAIL) + goto exit; + @@ -272143,15 +112074,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + // Reset MCU IO Wrapper- sugggest by SD1-Gimmy + if(IS_HARDWARE_TYPE_8812(padapter)) + { -+ u1bTmp2 = rtw_read8(padapter, REG_RSV_CTRL); -+ rtw_write8(padapter, REG_RSV_CTRL, u1bTmp2&(~BIT1)); + u1bTmp2 = rtw_read8(padapter, REG_RSV_CTRL+1); + rtw_write8(padapter, REG_RSV_CTRL+1, u1bTmp2&(~BIT3)); + } + else if(IS_HARDWARE_TYPE_8821(padapter)) + { -+ u1bTmp2 = rtw_read8(padapter, REG_RSV_CTRL); -+ rtw_write8(padapter, REG_RSV_CTRL, u1bTmp2&(~BIT1)); + u1bTmp2 = rtw_read8(padapter, REG_RSV_CTRL+1); + rtw_write8(padapter, REG_RSV_CTRL+1, u1bTmp2&(~BIT0)); + } @@ -272162,15 +112089,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + // Enable MCU IO Wrapper + if(IS_HARDWARE_TYPE_8812(padapter)) + { -+ u1bTmp2 = rtw_read8(padapter, REG_RSV_CTRL); -+ rtw_write8(padapter, REG_RSV_CTRL, u1bTmp2&(~BIT1)); + u1bTmp2 = rtw_read8(padapter, REG_RSV_CTRL+1); + rtw_write8(padapter, REG_RSV_CTRL+1, u1bTmp2 |(BIT3)); + } + else if(IS_HARDWARE_TYPE_8821(padapter)) + { -+ u1bTmp2 = rtw_read8(padapter, REG_RSV_CTRL); -+ rtw_write8(padapter, REG_RSV_CTRL, u1bTmp2&(~BIT1)); + u1bTmp2 = rtw_read8(padapter, REG_RSV_CTRL+1); + rtw_write8(padapter, REG_RSV_CTRL+1, u1bTmp2|(BIT0)); + } @@ -272180,97 +112103,62 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + DBG_871X("=====> _8051Reset8812(): 8051 reset success .\n"); +} + -+static s32 polling_fwdl_chksum(_adapter *adapter, u32 min_cnt, u32 timeout_ms) ++static s32 _FWFreeToGo8812(PADAPTER padapter) +{ -+ s32 ret = _FAIL; -+ u32 value32; -+ u32 start = rtw_get_current_time(); -+ u32 cnt = 0; -+ -+ /* polling CheckSum report */ -+ do { -+ cnt++; -+ value32 = rtw_read32(adapter, REG_MCUFWDL); -+ if (value32 & FWDL_ChkSum_rpt || RTW_CANNOT_RUN(adapter)) -+ break; -+ rtw_yield_os(); -+ } while (rtw_get_passing_time_ms(start) < timeout_ms || cnt < min_cnt); -+ -+ if (!(value32 & FWDL_ChkSum_rpt)) { -+ goto exit; -+ } -+ -+ if (rtw_fwdl_test_trigger_chksum_fail()) -+ goto exit; -+ -+ ret = _SUCCESS; -+ -+exit: -+ DBG_871X("%s: Checksum report %s! (%u, %dms), REG_MCUFWDL:0x%08x\n", __FUNCTION__ -+ , (ret==_SUCCESS)?"OK":"Fail", cnt, rtw_get_passing_time_ms(start), value32); -+ -+ return ret; -+} -+ -+static s32 _FWFreeToGo8812(_adapter *adapter, u32 min_cnt, u32 timeout_ms) -+{ -+ s32 ret = _FAIL; ++ u32 counter = 0; + u32 value32; -+ u32 start = rtw_get_current_time(); -+ u32 cnt = 0; ++ u8 value8; + -+ value32 = rtw_read32(adapter, REG_MCUFWDL); ++ // polling CheckSum report ++ do { ++ value32 = rtw_read32(padapter, REG_MCUFWDL); ++ if (value32 & FWDL_ChkSum_rpt) break; ++ } while (counter++ < 6000); ++ ++ if (counter >= 6000) { ++ DBG_871X("%s: chksum report fail! REG_MCUFWDL:0x%08x\n", __FUNCTION__, value32); ++ return _FAIL; ++ } ++ DBG_871X("%s: Checksum report OK! REG_MCUFWDL:0x%08x\n", __FUNCTION__, value32); ++ ++ value32 = rtw_read32(padapter, REG_MCUFWDL); + value32 |= MCUFWDL_RDY; + value32 &= ~WINTINI_RDY; -+ rtw_write32(adapter, REG_MCUFWDL, value32); ++ rtw_write32(padapter, REG_MCUFWDL, value32); + -+ _8051Reset8812(adapter); ++ _8051Reset8812(padapter); + -+ /* polling for FW ready */ ++ // polling for FW ready ++ counter = 0; + do { -+ cnt++; -+ value32 = rtw_read32(adapter, REG_MCUFWDL); -+ if (value32 & WINTINI_RDY || RTW_CANNOT_RUN(adapter)) -+ break; -+ rtw_yield_os(); -+ } while (rtw_get_passing_time_ms(start) < timeout_ms || cnt < min_cnt); ++ value32 = rtw_read32(padapter, REG_MCUFWDL); ++ if (value32 & WINTINI_RDY) { ++ DBG_871X("%s: Polling FW ready success!! REG_MCUFWDL:0x%08x\n", __FUNCTION__, value32); ++ return _SUCCESS; ++ } ++ rtw_udelay_os(5); ++ } while (counter++ < 6000); + -+ if (!(value32 & WINTINI_RDY)) { -+ goto exit; -+ } -+ -+ if (rtw_fwdl_test_trigger_wintint_rdy_fail()) -+ goto exit; -+ -+ ret = _SUCCESS; -+ -+exit: -+ DBG_871X("%s: Polling FW ready %s! (%u, %dms), REG_MCUFWDL:0x%08x\n", __FUNCTION__ -+ , (ret==_SUCCESS)?"OK":"Fail", cnt, rtw_get_passing_time_ms(start), value32); -+ -+ return ret; ++ DBG_871X ("%s: Polling FW ready fail!! REG_MCUFWDL:0x%08x\n", __FUNCTION__, value32); ++ return _FAIL; +} + +#ifdef CONFIG_FILE_FWIMG +extern char *rtw_fw_file_path; +u8 FwBuffer8812[FW_SIZE_8812]; -+#ifdef CONFIG_MP_INCLUDED -+extern char *rtw_fw_mp_bt_file_path; -+#endif // CONFIG_MP_INCLUDED -+u8 FwBuffer[FW_SIZE_8812]; +#endif //CONFIG_FILE_FWIMG + +s32 +FirmwareDownload8812( -+ IN PADAPTER Adapter, -+ IN BOOLEAN bUsedWoWLANFw ++ PADAPTER Adapter, ++ bool bUsedWoWLANFw +) +{ + s32 rtStatus = _SUCCESS; -+ u8 write_fw = 0; ++ u8 writeFW_retry = 0; + u32 fwdl_start_time; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ + u8 *pFwImageFileName; + u8 *pucMappedFile = NULL; + PRT_FIRMWARE_8812 pFirmware = NULL; @@ -272284,11 +112172,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + if(!pFirmware) + { + rtStatus = _FAIL; -+ goto exit; ++ goto Exit; + } + + #ifdef CONFIG_FILE_FWIMG -+ if(rtw_is_file_readable(rtw_fw_file_path) == _TRUE) ++ if(rtw_is_file_readable(rtw_fw_file_path) == true) + { + DBG_871X("%s accquire FW from file:%s\n", __FUNCTION__, rtw_fw_file_path); + pFirmware->eFWSource = FW_SOURCE_IMG_FILE; @@ -272296,54 +112184,53 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + else + #endif //CONFIG_FILE_FWIMG + { -+ DBG_871X("%s fw source from Header\n", __FUNCTION__); + pFirmware->eFWSource = FW_SOURCE_HEADER_FILE; + } + ++ DBG_871X(" ===> FirmwareDownload8812() fw source from %s.\n", (pFirmware->eFWSource ? "Header": "File")); ++ + switch(pFirmware->eFWSource) + { + case FW_SOURCE_IMG_FILE: + #ifdef CONFIG_FILE_FWIMG -+ rtStatus = rtw_retrieve_from_file(rtw_fw_file_path, FwBuffer8812, FW_SIZE_8812); ++ rtStatus = rtw_retrive_from_file(rtw_fw_file_path, FwBuffer8812, FW_SIZE_8812); + pFirmware->ulFwLength = rtStatus>=0?rtStatus:0; + pFirmware->szFwBuffer = FwBuffer8812; + #endif //CONFIG_FILE_FWIMG + break; + case FW_SOURCE_HEADER_FILE: -+ #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ if (bUsedWoWLANFw) { -+ if (!pwrpriv->wowlan_ap_mode) { -+ ODM_ConfigFWWithHeaderFile(&pHalData->odmpriv, CONFIG_FW_WoWLAN, (u8 *)&(pFirmware->szFwBuffer), &(pFirmware->ulFwLength)); -+ DBG_871X("%s fw:%s, size: %d\n", __func__, "WoWLAN", pFirmware->ulFwLength); -+ } else { -+ ODM_ConfigFWWithHeaderFile(&pHalData->odmpriv, CONFIG_FW_AP_WoWLAN, (u8 *)&pFirmware->szFwBuffer, &pFirmware->ulFwLength); -+ DBG_871X("%s fw: %s, size: %d\n", __func__, "AP_WoWLAN", pFirmware->ulFwLength); -+ } -+ } else -+ #endif /* CONFIG_WOWLAN */ -+ #ifdef CONFIG_BT_COEXIST -+ if (pHalData->EEPROMBluetoothCoexist == _TRUE) { -+ ODM_ConfigFWWithHeaderFile(&pHalData->odmpriv, CONFIG_FW_BT, (u8 *)&(pFirmware->szFwBuffer), &(pFirmware->ulFwLength)); -+ DBG_871X("%s fw:%s, size: %d\n", __FUNCTION__, "NIC-BTCOEX", pFirmware->ulFwLength); -+ } else -+ #endif /* CONFIG_BT_COEXIST */ -+ { -+ ODM_ConfigFWWithHeaderFile(&pHalData->odmpriv, CONFIG_FW_NIC, (u8 *)&(pFirmware->szFwBuffer), &(pFirmware->ulFwLength)); -+ DBG_871X("%s fw:%s, size: %d\n", __FUNCTION__, "NIC", pFirmware->ulFwLength); ++ ODM_ConfigFWWithHeaderFile(&pHalData->odmpriv, CONFIG_FW_NIC, (u8 *)&(pFirmware->szFwBuffer), &(pFirmware->ulFwLength)); ++ DBG_871X(" ===> FirmwareDownload8812() fw:%s, size: %d\n", "Firmware for NIC", pFirmware->ulFwLength); ++ ++#ifdef CONFIG_WOWLAN ++ ODM_ConfigFWWithHeaderFile(&pHalData->odmpriv, CONFIG_FW_WoWLAN, (u8 *)&(pFirmware->szWoWLANFwBuffer), &(pFirmware->ulWoWLANFwLength)); ++ DBG_871X(" ===> FirmwareDownload88E() fw:%s, size: %d\n", "Firmware for WoWLAN", pFirmware->ulWoWLANFwLength); ++#endif //CONFIG_WOWLAN ++ ++ if (pFirmware->ulFwLength > FW_SIZE_8812) { ++ rtStatus = _FAIL; ++ RT_TRACE(_module_hal_init_c_, _drv_err_, ("Firmware size exceed 0x%X. Check it.\n", FW_SIZE_8812) ); ++ goto Exit; + } ++ + break; + } + -+ if (pFirmware->ulFwLength > FW_SIZE_8812) { -+ rtStatus = _FAIL; -+ DBG_871X_LEVEL(_drv_emerg_, "Firmware size:%u exceed %u\n", pFirmware->ulFwLength, FW_SIZE_8812); -+ goto exit; ++#ifdef CONFIG_WOWLAN ++ if (bUsedWoWLANFw) { ++ pFirmwareBuf = pFirmware->szWoWLANFwBuffer; ++ FirmwareLen = pFirmware->ulWoWLANFwLength; ++ pFwHdr = (u8 *)pFirmware->szWoWLANFwBuffer; ++ } else ++#endif ++ { ++ pFirmwareBuf = pFirmware->szFwBuffer; ++ FirmwareLen = pFirmware->ulFwLength; ++ DBG_871X_LEVEL(_drv_info_, "+%s: !bUsedWoWLANFw, FmrmwareLen:%d+\n", __func__, FirmwareLen); ++ // To Check Fw header. Added by tynli. 2009.12.04. ++ pFwHdr = (u8 *)pFirmware->szFwBuffer; + } + -+ pFirmwareBuf = pFirmware->szFwBuffer; -+ FirmwareLen = pFirmware->ulFwLength; -+ pFwHdr = (u8 *)pFirmware->szFwBuffer; -+ + pHalData->FirmwareVersion = (u16)GET_FIRMWARE_HDR_VERSION_8812(pFwHdr); + pHalData->FirmwareSubVersion = (u16)GET_FIRMWARE_HDR_SUB_VER_8812(pFwHdr); + pHalData->FirmwareSignature = (u16)GET_FIRMWARE_HDR_SIGNATURE_8812(pFwHdr); @@ -272363,51 +112250,53 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + if (rtw_read8(Adapter, REG_MCUFWDL) & BIT7) //8051 RAM code + { + rtw_write8(Adapter, REG_MCUFWDL, 0x00); -+ _8051Reset8812(Adapter); ++ _8051Reset8812(Adapter); + } + -+ _FWDownloadEnable_8812(Adapter, _TRUE); ++ _FWDownloadEnable_8812(Adapter, true); + fwdl_start_time = rtw_get_current_time(); -+ while (!RTW_CANNOT_RUN(Adapter) -+ && (write_fw++ < 3 || rtw_get_passing_time_ms(fwdl_start_time) < 500)) -+ { -+ /* reset FWDL chksum */ ++ while(1) { ++ //reset the FWDL chksum + rtw_write8(Adapter, REG_MCUFWDL, rtw_read8(Adapter, REG_MCUFWDL)|FWDL_ChkSum_rpt); -+ ++ + rtStatus = _WriteFW_8812(Adapter, pFirmwareBuf, FirmwareLen); -+ if (rtStatus != _SUCCESS) -+ continue; + -+ rtStatus = polling_fwdl_chksum(Adapter, 5, 50); -+ if (rtStatus == _SUCCESS) ++ if(rtStatus == _SUCCESS ++ ||(rtw_get_passing_time_ms(fwdl_start_time) > 500 && writeFW_retry++ >= 3) ++ ) + break; ++ ++ DBG_871X("%s writeFW_retry:%u, time after fwdl_start_time:%ums\n", __FUNCTION__ ++ , writeFW_retry ++ , rtw_get_passing_time_ms(fwdl_start_time) ++ ); ++ } ++ _FWDownloadEnable_8812(Adapter, false); ++ if(_SUCCESS != rtStatus){ ++ DBG_871X("DL Firmware failed!\n"); ++ goto Exit; + } -+ _FWDownloadEnable_8812(Adapter, _FALSE); -+ if(_SUCCESS != rtStatus) -+ goto fwdl_stat; + -+ rtStatus = _FWFreeToGo8812(Adapter, 10, 200); -+ if (_SUCCESS != rtStatus) -+ goto fwdl_stat; ++ rtStatus = _FWFreeToGo8812(Adapter); ++ if (_SUCCESS != rtStatus) { ++ DBG_871X("DL Firmware failed!\n"); ++ goto Exit; ++ } ++ RT_TRACE(_module_hal_init_c_, _drv_info_, ("Firmware is ready to run!\n")); + -+fwdl_stat: -+ DBG_871X("FWDL %s. write_fw:%u, %dms\n" -+ , (rtStatus == _SUCCESS)?"success":"fail" -+ , write_fw -+ , rtw_get_passing_time_ms(fwdl_start_time) -+ ); ++Exit: + -+exit: + if (pFirmware) + rtw_mfree((u8*)pFirmware, sizeof(RT_FIRMWARE_8812)); + ++ //RT_TRACE(COMP_INIT, DBG_LOUD, (" <=== FirmwareDownload91C()\n")); +#ifdef CONFIG_WOWLAN -+ if (adapter_to_pwrctl(Adapter)->wowlan_mode) -+ InitializeFirmwareVars8812(Adapter); ++ if (Adapter->pwrctrlpriv.wowlan_mode) ++ InitializeFirmwareVars8812(Adapter); + else -+ DBG_871X_LEVEL(_drv_always_, "%s: wowland_mode:%d wowlan_wake_reason:%d\n", -+ __func__, adapter_to_pwrctl(Adapter)->wowlan_mode, -+ adapter_to_pwrctl(Adapter)->wowlan_wake_reason); ++ DBG_871X_LEVEL(_drv_always_, "%s: wowland_mode:%d wowlan_wake_reason:%d\n", ++ __func__, Adapter->pwrctrlpriv.wowlan_mode, ++ Adapter->pwrctrlpriv.wowlan_wake_reason); +#endif + + return rtStatus; @@ -272417,435 +112306,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +void InitializeFirmwareVars8812(PADAPTER padapter) +{ + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct pwrctrl_priv *pwrpriv; ++ pwrpriv = &padapter->pwrctrlpriv; + + // Init Fw LPS related. -+ pwrpriv->bFwCurrentInPSMode = _FALSE; -+ -+ /* Init H2C cmd. */ -+ rtw_write8(padapter, REG_HMETFR, 0x0f); -+ ++ padapter->pwrctrlpriv.bFwCurrentInPSMode = false; + // Init H2C counter. by tynli. 2009.12.09. + pHalData->LastHMEBoxNum = 0; +} + -+ -+// -+// Description: Determine the contents of H2C BT_FW_PATCH Command sent to FW. -+// 2013.01.23 by tynli -+// Porting from 8723B. 2013.04.01 -+// -+VOID -+SetFwBTFwPatchCmd_8821( -+ IN PADAPTER Adapter, -+ IN u2Byte FwSize -+ ) -+{ -+ u1Byte u1BTFwPatchParm[6]={0}; -+ -+ DBG_871X("SetFwBTFwPatchCmd_8821(): FwSize = %d\n", FwSize); -+ -+ //SET_8812_H2CCMD_BT_FW_PATCH_ENABLE(u1BTFwPatchParm, 1); -+ SET_8812_H2CCMD_BT_FW_PATCH_SIZE(u1BTFwPatchParm, FwSize); -+ SET_8812_H2CCMD_BT_FW_PATCH_ADDR0(u1BTFwPatchParm, 0); -+ SET_8812_H2CCMD_BT_FW_PATCH_ADDR1(u1BTFwPatchParm, 0xa0); -+ SET_8812_H2CCMD_BT_FW_PATCH_ADDR2(u1BTFwPatchParm, 0x10); -+ SET_8812_H2CCMD_BT_FW_PATCH_ADDR3(u1BTFwPatchParm, 0x80); -+ -+ FillH2CCmd_8812(Adapter, H2C_8812_BT_FW_PATCH, 6 , u1BTFwPatchParm); -+} -+ -+ -+int _CheckWLANFwPatchBTFwReady_8821A( PADAPTER Adapter ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u4Byte count=0; -+ u1Byte u1bTmp; -+ int ret = _FAIL; -+ -+#if (DEV_BUS_TYPE == RT_SDIO_INTERFACE) -+ u4Byte txpktbuf_bndy; -+#endif -+ -+ //--------------------------------------------------------- -+ // Check if BT FW patch procedure is ready. -+ //--------------------------------------------------------- -+ do{ -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_FW_DRV_MSG_8812); -+ if((u1bTmp&BIT6) || (u1bTmp&BIT7)) -+ { -+ ret = _SUCCESS; -+ break; -+ } -+ count++; -+ RT_TRACE(_module_mp_, _drv_info_,("0x81=%x, wait for 50 ms (%d) times.\n", -+ u1bTmp, count)); -+ rtw_msleep_os(50); // 50ms -+ }while(!((u1bTmp&BIT6) || (u1bTmp&BIT7)) && count < 50); -+ -+ RT_TRACE(_module_mp_, _drv_notice_,("_CheckWLANFwPatchBTFwReady():" -+ " Polling ready bit 0x88[6:7] for %d times.\n", count)); -+ -+ if(count >= 50) -+ { -+ DBG_871X("_CheckWLANFwPatchBTFwReady():" -+ " Polling ready bit 0x88[6:7] FAIL!!\n"); -+ } -+ -+ //--------------------------------------------------------- -+ // Reset beacon setting to the initial value. -+ //--------------------------------------------------------- -+#if (DEV_BUS_TYPE == RT_SDIO_INTERFACE) -+#if 0 -+ if(!Adapter->MgntInfo.bWiFiConfg) -+ { -+ txpktbuf_bndy = TX_PAGE_BOUNDARY_8821; -+ } -+ else -+#endif -+ {// for WMM -+ txpktbuf_bndy = WMM_NORMAL_TX_PAGE_BOUNDARY_8821; -+ } -+ -+ ret = InitLLTTable8812A(Adapter, txpktbuf_bndy); -+ if(_SUCCESS != ret){ -+ DBG_871X("_CheckWLANFwPatchBTFwReady_8821A(): Failed to init LLT!\n"); -+ } -+ -+ // Init Tx boundary. -+ PlatformEFIOWrite1Byte(Adapter, REG_TDECTRL+1, (u1Byte)txpktbuf_bndy); -+#endif -+ -+ SetBcnCtrlReg(Adapter, BIT3, 0); -+ SetBcnCtrlReg(Adapter, 0, BIT4); -+ -+ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL+2, (pHalData->RegFwHwTxQCtrl|BIT6)); -+ pHalData->RegFwHwTxQCtrl |= BIT6; -+ -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR+1); -+ PlatformEFIOWrite1Byte(Adapter, REG_CR+1, (u1bTmp&(~BIT0))); -+ -+ return ret; -+} -+ -+ -+int _WriteBTFWtoTxPktBuf8812( -+ PADAPTER Adapter, -+ PVOID buffer, -+ u4Byte FwBufLen, -+ u1Byte times -+ ) -+{ -+ int rtStatus = _SUCCESS; -+ //u4Byte value32; -+ //u1Byte numHQ, numLQ, numPubQ;//, txpktbuf_bndy; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ //PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ u1Byte BcnValidReg; -+ u1Byte count=0, DLBcnCount=0; -+ pu1Byte FwbufferPtr = (pu1Byte)buffer; -+ //PRT_TCB pTcb, ptempTcb; -+ //PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN bRecover=_FALSE; -+ pu1Byte ReservedPagePacket = NULL; -+ pu1Byte pGenBufReservedPagePacket = NULL; -+ u4Byte TotalPktLen,txpktbuf_bndy; -+ //u1Byte tmpReg422; -+ //u1Byte u1bTmp; -+ u8 *pframe; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ u8 txdesc_offset = TXDESC_OFFSET; -+ u8 val8; -+ -+#if 1//(DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ TotalPktLen = FwBufLen; -+#else -+ TotalPktLen = FwBufLen+pHalData->HWDescHeadLength; -+#endif -+ if((TotalPktLen+TXDESC_OFFSET) > MAX_CMDBUF_SZ) -+ { -+ DBG_871X(" WARNING %s => Total packet len = %d over MAX_CMDBUF_SZ:%d \n" -+ ,__FUNCTION__,(TotalPktLen+TXDESC_OFFSET),MAX_CMDBUF_SZ); -+ return _FAIL; -+ } -+ pGenBufReservedPagePacket = rtw_zmalloc(TotalPktLen);//GetGenTempBuffer (Adapter, TotalPktLen); -+ if (!pGenBufReservedPagePacket) -+ return _FAIL; -+ -+ ReservedPagePacket = (u1Byte *)pGenBufReservedPagePacket; -+ -+ _rtw_memset(ReservedPagePacket, 0, TotalPktLen); -+ -+#if 1//(DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ _rtw_memcpy(ReservedPagePacket, FwbufferPtr, FwBufLen); -+ -+#else -+ PlatformMoveMemory(ReservedPagePacket+Adapter->HWDescHeadLength , FwbufferPtr, FwBufLen); -+#endif -+ -+ //--------------------------------------------------------- -+ // 1. Pause BCN -+ //--------------------------------------------------------- -+ //Set REG_CR bit 8. DMA beacon by SW. -+#if 0//(DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR+1); -+ PlatformEFIOWrite1Byte(Adapter, REG_CR+1, (u1bTmp|BIT0)); -+#else -+ // Remove for temparaily because of the code on v2002 is not sync to MERGE_TMEP for USB/SDIO. -+ // De not remove this part on MERGE_TEMP. by tynli. -+ //pHalData->RegCR_1 |= (BIT0); -+ //PlatformEFIOWrite1Byte(Adapter, REG_CR+1, pHalData->RegCR_1); -+#endif -+ -+ // Disable Hw protection for a time which revserd for Hw sending beacon. -+ // Fix download reserved page packet fail that access collision with the protection time. -+ // 2010.05.11. Added by tynli. -+ val8 = rtw_read8(Adapter, REG_BCN_CTRL); -+ val8 &= ~BIT(3); -+ val8 |= BIT(4); -+ rtw_write8(Adapter, REG_BCN_CTRL, val8); -+ -+#if 0//(DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ tmpReg422 = PlatformEFIORead1Byte(Adapter, REG_FWHW_TXQ_CTRL+2); -+ if( tmpReg422&BIT6) -+ bRecover = TRUE; -+ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL+2, tmpReg422&(~BIT6)); -+#else -+ // Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. -+ if(pHalData->RegFwHwTxQCtrl & BIT(6)) -+ bRecover=_TRUE; -+ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL+2, (pHalData->RegFwHwTxQCtrl&(~BIT(6)))); -+ pHalData->RegFwHwTxQCtrl &= (~ BIT(6)); -+#endif -+ -+ //--------------------------------------------------------- -+ // 2. Adjust LLT table to an even boundary. -+ //--------------------------------------------------------- -+#if 0//(DEV_BUS_TYPE == RT_SDIO_INTERFACE) -+ txpktbuf_bndy = 10; // rsvd page start address should be an even value. -+ rtStatus = InitLLTTable8723BS(Adapter, txpktbuf_bndy); -+ if(_SUCCESS != rtStatus){ -+ DBG_8192C("_CheckWLANFwPatchBTFwReady_8723B(): Failed to init LLT!\n"); -+ return _FAIL; -+ } -+ -+ // Init Tx boundary. -+ PlatformEFIOWrite1Byte(Adapter, REG_DWBCN0_CTRL_8723B+1, (u1Byte)txpktbuf_bndy); -+#endif -+ -+ -+ //--------------------------------------------------------- -+ // 3. Write Fw to Tx packet buffer by reseverd page. -+ //--------------------------------------------------------- -+ do -+ { -+ // download rsvd page. -+ // Clear beacon valid check bit. -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_TDECTRL+2); -+ PlatformEFIOWrite1Byte(Adapter, REG_TDECTRL+2, BcnValidReg&(~BIT(0))); -+ -+ //BT patch is big, we should set 0x209 < 0x40 suggested from Gimmy -+ RT_TRACE(_module_mp_, _drv_info_,("0x209:%x\n", -+ PlatformEFIORead1Byte(Adapter, REG_TDECTRL+1)));//209 < 0x40 -+ -+ PlatformEFIOWrite1Byte(Adapter, REG_TDECTRL+1, (0x90-0x20*(times-1))); -+ DBG_871X("0x209:0x%x\n", PlatformEFIORead1Byte(Adapter, REG_TDECTRL+1)); -+ RT_TRACE(_module_mp_, _drv_info_,("0x209:%x\n", -+ PlatformEFIORead1Byte(Adapter, REG_TDECTRL+1))); -+ -+#if 0 -+ // Acquice TX spin lock before GetFwBuf and send the packet to prevent system deadlock. -+ // Advertised by Roger. Added by tynli. 2010.02.22. -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ if(MgntGetFWBuffer(Adapter, &pTcb, &pBuf)) -+ { -+ PlatformMoveMemory(pBuf->Buffer.VirtualAddress, ReservedPagePacket, TotalPktLen); -+ CmdSendPacket(Adapter, pTcb, pBuf, TotalPktLen, DESC_PACKET_TYPE_NORMAL, FALSE); -+ } -+ else -+ dbgdump("SetFwRsvdPagePkt(): MgntGetFWBuffer FAIL!!!!!!!!.\n"); -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+#else -+ /*--------------------------------------------------------- -+ tx reserved_page_packet -+ ----------------------------------------------------------*/ -+ if ((pmgntframe = rtw_alloc_cmdxmitframe(pxmitpriv)) == NULL) { -+ rtStatus = _FAIL; -+ goto exit; -+ } -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ -+ pattrib->qsel = QSLT_BEACON; -+ pattrib->pktlen = pattrib->last_txcmdsz = FwBufLen ; -+ -+ //_rtw_memset(pmgntframe->buf_addr, 0, TotalPktLen+txdesc_size); -+ //pmgntframe->buf_addr = ReservedPagePacket ; -+ -+ _rtw_memcpy( (u8*) (pmgntframe->buf_addr + txdesc_offset), ReservedPagePacket, FwBufLen); -+ DBG_871X("[%d]===>TotalPktLen + TXDESC_OFFSET TotalPacketLen:%d \n", DLBcnCount, (FwBufLen + txdesc_offset)); -+ -+#ifdef CONFIG_PCI_HCI -+ dump_mgntframe(Adapter, pmgntframe); -+#else -+ dump_mgntframe_and_wait(Adapter, pmgntframe, 100); -+#endif -+ -+#endif -+#if 1 -+ // check rsvd page download OK. -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_TDECTRL+2); -+ while(!(BcnValidReg & BIT(0)) && count <200) -+ { -+ count++; -+ //PlatformSleepUs(10); -+ rtw_msleep_os(1); -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_TDECTRL+2); -+ RT_TRACE(_module_mp_, _drv_notice_,("Poll 0x20A = %x\n", BcnValidReg)); -+ } -+ DLBcnCount++; -+ //DBG_871X("##0x208:%08x,0x210=%08x\n",PlatformEFIORead4Byte(Adapter, REG_TDECTRL),PlatformEFIORead4Byte(Adapter, 0x210)); -+ -+ PlatformEFIOWrite1Byte(Adapter, REG_TDECTRL+2,BcnValidReg); -+ -+ }while((!(BcnValidReg&BIT(0))) && DLBcnCount<5); -+ -+ -+#endif -+ if(DLBcnCount >=5){ -+ DBG_871X(" check rsvd page download OK DLBcnCount =%d \n",DLBcnCount); -+ rtStatus = _FAIL; -+ goto exit; -+ } -+ -+ if(!(BcnValidReg&BIT(0))) -+ { -+ DBG_871X("_WriteFWtoTxPktBuf(): 1 Download RSVD page failed!\n"); -+ rtStatus = _FAIL; -+ goto exit; -+ } -+ -+ //--------------------------------------------------------- -+ // 4. Set Tx boundary to the initial value -+ //--------------------------------------------------------- -+ -+ -+ //--------------------------------------------------------- -+ // 5. Reset beacon setting to the initial value. -+ // After _CheckWLANFwPatchBTFwReady(). -+ //--------------------------------------------------------- -+ -+exit: -+ -+ if(pGenBufReservedPagePacket) -+ { -+ DBG_871X("_WriteBTFWtoTxPktBuf8723B => rtw_mfree pGenBufReservedPagePacket!\n"); -+ rtw_mfree((u8*)pGenBufReservedPagePacket, TotalPktLen); -+ } -+ return rtStatus; -+} -+ -+ -+int ReservedPage_Compare(PADAPTER Adapter,PRT_MP_FIRMWARE pFirmware,u32 BTPatchSize) -+{ -+ u8 temp,ret,lastBTsz; -+ u32 u1bTmp=0,address_start=0,count=0,i=0; -+ u8 *myBTFwBuffer = NULL; -+ -+ myBTFwBuffer = rtw_zmalloc(BTPatchSize); -+ if (myBTFwBuffer == NULL) -+ { -+ DBG_871X("%s can't be executed due to the failed malloc.\n", __FUNCTION__); -+ Adapter->mppriv.bTxBufCkFail=_TRUE; -+ return _FALSE; -+ } -+ -+ temp=rtw_read8(Adapter,0x209); -+ -+ address_start=(temp*128)/8; -+ -+ rtw_write32(Adapter,0x140,0x00000000); -+ rtw_write32(Adapter,0x144,0x00000000); -+ rtw_write32(Adapter,0x148,0x00000000); -+ -+ rtw_write8(Adapter,0x106,0x69); -+ -+ -+ for(i=0;i<(BTPatchSize/8);i++) -+ { -+ rtw_write32(Adapter,0x140,address_start+5+i) ; -+ -+ //polling until reg 0x140[23]=1; -+ do{ -+ u1bTmp = rtw_read32(Adapter, 0x140); -+ if(u1bTmp&BIT(23)) -+ { -+ ret = _SUCCESS; -+ break; -+ } -+ count++; -+ DBG_871X("0x140=%x, wait for 10 ms (%d) times.\n",u1bTmp, count); -+ rtw_msleep_os(10); // 10ms -+ }while(!(u1bTmp&BIT(23)) && count < 50); -+ -+ myBTFwBuffer[i*8+0]=rtw_read8(Adapter, 0x144); -+ myBTFwBuffer[i*8+1]=rtw_read8(Adapter, 0x145); -+ myBTFwBuffer[i*8+2]=rtw_read8(Adapter, 0x146); -+ myBTFwBuffer[i*8+3]=rtw_read8(Adapter, 0x147); -+ myBTFwBuffer[i*8+4]=rtw_read8(Adapter, 0x148); -+ myBTFwBuffer[i*8+5]=rtw_read8(Adapter, 0x149); -+ myBTFwBuffer[i*8+6]=rtw_read8(Adapter, 0x14a); -+ myBTFwBuffer[i*8+7]=rtw_read8(Adapter, 0x14b); -+ } -+ -+ rtw_write32(Adapter,0x140,address_start+5+BTPatchSize/8) ; -+ -+ lastBTsz=BTPatchSize%8; -+ -+ //polling until reg 0x140[23]=1; -+ u1bTmp=0; -+ count=0; -+ do{ -+ u1bTmp = rtw_read32(Adapter, 0x140); -+ if(u1bTmp&BIT(23)) -+ { -+ ret = _SUCCESS; -+ break; -+ } -+ count++; -+ DBG_871X("0x140=%x, wait for 10 ms (%d) times.\n",u1bTmp, count); -+ rtw_msleep_os(10); // 10ms -+ }while(!(u1bTmp&BIT(23)) && count < 50); -+ -+ for(i=0;iszFwBuffer[i]) -+ { -+ DBG_871X(" In direct myBTFwBuffer[%d]=%x , pFirmware->szFwBuffer=%x\n",i, myBTFwBuffer[i],pFirmware->szFwBuffer[i]); -+ Adapter->mppriv.bTxBufCkFail=_TRUE; -+ break; -+ } -+ } -+ -+ if (myBTFwBuffer != NULL) -+ { -+ rtw_mfree(myBTFwBuffer, BTPatchSize); -+ } -+ -+ return _TRUE; -+} -+ -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++#ifdef CONFIG_WOWLAN +//=========================================== +// +// Description: Prepare some information to Fw for WoWLAN. @@ -272855,15 +112325,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +// +// 2011.04.12 by tynli. +// -+VOID ++void +SetFwRelatedForWoWLAN8812( -+ IN PADAPTER padapter, -+ IN u8 bHostIsGoingtoSleep ++ PADAPTER padapter, ++ u8 bHostIsGoingtoSleep +) +{ + int status=_FAIL; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 bRecover = _FALSE; ++ u8 bRecover = false; + // + // 1. Before WoWLAN we need to re-download WoWLAN Fw. + // @@ -272879,22 +112349,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + // + InitializeFirmwareVars8812(padapter); +} -+#endif /*defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN)*/ ++#endif //CONFIG_WOWLAN ++ ++static void rtl8812_free_hal_data(PADAPTER padapter) ++{ ++ ++ if (padapter->HalData) { ++#ifdef CONFIG_CONCURRENT_MODE ++ if(padapter->isprimary) ++#endif //CONFIG_CONCURRENT_MODE ++ rtw_mfree(padapter->HalData, sizeof(HAL_DATA_TYPE)); ++ padapter->HalData = NULL; ++ } ++ ++} + +//=========================================================== +// Efuse related code +//=========================================================== -+BOOLEAN ++bool +Hal_GetChnlGroup8812A( -+ IN u8 Channel, -+ OUT u8* pGroup ++ u8 Channel, ++ u8* pGroup + ) +{ -+ BOOLEAN bIn24G=_TRUE; ++ bool bIn24G=true; + + if(Channel <= 14) + { -+ bIn24G=_TRUE; ++ bIn24G=true; + + if (1 <= Channel && Channel <= 2 ) *pGroup = 0; + else if (3 <= Channel && Channel <= 5 ) *pGroup = 1; @@ -272908,7 +112391,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + } + else + { -+ bIn24G=_FALSE; ++ bIn24G=false; + + if (36 <= Channel && Channel <= 42) *pGroup = 0; + else if (44 <= Channel && Channel <= 48) *pGroup = 1; @@ -272937,22 +112420,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + +static void +hal_ReadPowerValueFromPROM8812A( -+ IN PADAPTER Adapter, -+ IN PTxPowerInfo24G pwrInfo24G, -+ IN PTxPowerInfo5G pwrInfo5G, -+ IN u8* PROMContent, -+ IN BOOLEAN AutoLoadFail ++ PADAPTER Adapter, ++ PTxPowerInfo24G pwrInfo24G, ++ PTxPowerInfo5G pwrInfo5G, ++ u8* PROMContent, ++ bool AutoLoadFail + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + u32 rfPath, eeAddr=EEPROM_TX_PWR_INX_8812, group,TxCount=0; -+ ++ + _rtw_memset(pwrInfo24G, 0, sizeof(TxPowerInfo24G)); + _rtw_memset(pwrInfo5G, 0, sizeof(TxPowerInfo5G)); + + //DBG_871X("hal_ReadPowerValueFromPROM8812A(): PROMContent[0x%x]=0x%x\n", (eeAddr+1), PROMContent[eeAddr+1]); + if(0xFF == PROMContent[eeAddr+1]) //YJ,add,120316 -+ AutoLoadFail = _TRUE; ++ AutoLoadFail = true; + + if(AutoLoadFail) + { @@ -272979,14 +112462,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + pwrInfo24G->CCK_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; + pwrInfo24G->OFDM_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; + } -+ } ++ } + + // 5G default value + for(group = 0 ; group < MAX_CHNL_GROUP_5G; group++) + { + pwrInfo5G->IndexBW40_Base[rfPath][group] = EEPROM_DEFAULT_5G_INDEX; + } -+ ++ + for(TxCount=0;TxCountBW160_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; + + } -+ } -+ ++ } ++ + } -+ -+ //pHalData->bNOPG = _TRUE; ++ ++ //pHalData->bNOPG = true; + return; + } + -+ pHalData->bTXPowerDataReadFromEEPORM = _TRUE; //YJ,move,120316 ++ pHalData->bTXPowerDataReadFromEEPORM = true; //YJ,move,120316 + + for(rfPath = 0 ; rfPath < MAX_RF_PATH ; rfPath++) + { @@ -273024,9 +112507,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + if(pwrInfo24G->IndexCCK_Base[rfPath][group] == 0xFF) + { + pwrInfo24G->IndexCCK_Base[rfPath][group] = EEPROM_DEFAULT_24G_INDEX; -+ //pHalData->bNOPG = _TRUE; ++ //pHalData->bNOPG = true; + } -+ //DBG_871X("8812-2G RF-%d-G-%d CCK-Addr-%x BASE=%x\n", ++ //DBG_871X("8812-2G RF-%d-G-%d CCK-Addr-%x BASE=%x\n", + //rfPath, group, eeAddr-1, pwrInfo24G->IndexCCK_Base[rfPath][group]); + } + for(group = 0 ; group < MAX_CHNL_GROUP_24G-1; group++) @@ -273034,7 +112517,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + pwrInfo24G->IndexBW40_Base[rfPath][group] = PROMContent[eeAddr++]; + if(pwrInfo24G->IndexBW40_Base[rfPath][group] == 0xFF) + pwrInfo24G->IndexBW40_Base[rfPath][group] = EEPROM_DEFAULT_24G_INDEX; -+ //DBG_871X("8812-2G RF-%d-G-%d BW40-Addr-%x BASE=%x\n", ++ //DBG_871X("8812-2G RF-%d-G-%d BW40-Addr-%x BASE=%x\n", + //rfPath, group, eeAddr-1, pwrInfo24G->IndexBW40_Base[rfPath][group]); + } + for(TxCount=0;TxCountBW40_Diff[rfPath][TxCount] = 0; + -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; -+ if (pwrInfo24G->BW20_Diff[rfPath][TxCount] & BIT3) /*4bit sign number to 8 bit sign number*/ -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] |= 0xF0; ++ { ++ pwrInfo24G->BW20_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; ++ if(pwrInfo24G->BW20_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number ++ pwrInfo24G->BW20_Diff[rfPath][TxCount] |= 0xF0; ++ } ++ //DBG_871X("8812-2G RF-%d-SS-%d BW20-Addr-%x DIFF=%d\n", ++ //rfPath, TxCount, eeAddr, pwrInfo24G->BW20_Diff[rfPath][TxCount]); + -+ /*DBG_871X("8812-2G RF-%d-SS-%d BW20-Addr-%x DIFF=%d\n", -+ rfPath, TxCount, eeAddr, pwrInfo24G->BW20_Diff[rfPath][TxCount]);*/ -+ -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); -+ if (pwrInfo24G->OFDM_Diff[rfPath][TxCount] & BIT3) /*4bit sign number to 8 bit sign number*/ -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] |= 0xF0; -+ -+ /*DBG_871X("8812-2G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", -+ rfPath, TxCount, eeAddr, pwrInfo24G->OFDM_Diff[rfPath][TxCount]);*/ ++ { ++ pwrInfo24G->OFDM_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); ++ if(pwrInfo24G->OFDM_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number ++ pwrInfo24G->OFDM_Diff[rfPath][TxCount] |= 0xF0; ++ } ++ //DBG_871X("8812-2G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", ++ //rfPath, TxCount, eeAddr, pwrInfo24G->OFDM_Diff[rfPath][TxCount]); + + pwrInfo24G->CCK_Diff[rfPath][TxCount] = 0; + eeAddr++; -+ } else{ ++ } ++ else ++ { + -+ pwrInfo24G->BW40_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; -+ if (pwrInfo24G->BW40_Diff[rfPath][TxCount] & BIT3) /*4bit sign number to 8 bit sign number*/ -+ pwrInfo24G->BW40_Diff[rfPath][TxCount] |= 0xF0; -+ -+ /*DBG_871X("8812-2G RF-%d-SS-%d BW40-Addr-%x DIFF=%d\n", -+ rfPath, TxCount, eeAddr, pwrInfo24G->BW40_Diff[rfPath][TxCount]);*/ ++ { ++ pwrInfo24G->BW40_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; ++ if(pwrInfo24G->BW40_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number ++ pwrInfo24G->BW40_Diff[rfPath][TxCount] |= 0xF0; ++ } ++ //DBG_871X("8812-2G RF-%d-SS-%d BW40-Addr-%x DIFF=%d\n", ++ //rfPath, TxCount, eeAddr, pwrInfo24G->BW40_Diff[rfPath][TxCount]); + + -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); -+ if (pwrInfo24G->BW20_Diff[rfPath][TxCount] & BIT3) /*4bit sign number to 8 bit sign number*/ -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] |= 0xF0; -+ -+ /*DBG_871X("8812-2G RF-%d-SS-%d BW20-Addr-%x DIFF=%d\n", -+ rfPath, TxCount, eeAddr, pwrInfo24G->BW20_Diff[rfPath][TxCount]);*/ ++ { ++ pwrInfo24G->BW20_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); ++ if(pwrInfo24G->BW20_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number ++ pwrInfo24G->BW20_Diff[rfPath][TxCount] |= 0xF0; ++ } ++ //DBG_871X("8812-2G RF-%d-SS-%d BW20-Addr-%x DIFF=%d\n", ++ //rfPath, TxCount, eeAddr, pwrInfo24G->BW20_Diff[rfPath][TxCount]); + + eeAddr++; + -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; -+ if (pwrInfo24G->OFDM_Diff[rfPath][TxCount] & BIT3) /*4bit sign number to 8 bit sign number*/ -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] |= 0xF0; + -+ /*DBG_871X("8812-2G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", -+ rfPath, TxCount, eeAddr, pwrInfo24G->OFDM_Diff[rfPath][TxCount]);*/ ++ { ++ pwrInfo24G->OFDM_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; ++ if(pwrInfo24G->OFDM_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number ++ pwrInfo24G->OFDM_Diff[rfPath][TxCount] |= 0xF0; ++ } ++ //DBG_871X("8812-2G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", ++ //rfPath, TxCount, eeAddr, pwrInfo24G->BW20_Diff[rfPath][TxCount]); + + -+ pwrInfo24G->CCK_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); -+ if (pwrInfo24G->CCK_Diff[rfPath][TxCount] & BIT3) /*4bit sign number to 8 bit sign number*/ -+ pwrInfo24G->CCK_Diff[rfPath][TxCount] |= 0xF0; -+ -+ /*DBG_871X("8812-2G RF-%d-SS-%d CCK-Addr-%x DIFF=%d\n", -+ rfPath, TxCount, eeAddr, pwrInfo24G->CCK_Diff[rfPath][TxCount]);*/ ++ { ++ pwrInfo24G->CCK_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); ++ if(pwrInfo24G->CCK_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number ++ pwrInfo24G->CCK_Diff[rfPath][TxCount] |= 0xF0; ++ } ++ //DBG_871X("8812-2G RF-%d-SS-%d CCK-Addr-%x DIFF=%d\n", ++ //rfPath, TxCount, eeAddr, pwrInfo24G->CCK_Diff[rfPath][TxCount]); + + eeAddr++; + } @@ -273102,249 +112594,205 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + { + pwrInfo5G->IndexBW40_Base[rfPath][group] = PROMContent[eeAddr++]; + if(pwrInfo5G->IndexBW40_Base[rfPath][group] == 0xFF) -+ pwrInfo5G->IndexBW40_Base[rfPath][group] = EEPROM_DEFAULT_DIFF; ++ pwrInfo5G->IndexBW40_Base[rfPath][group] = EEPROM_DEFAULT_DIFF; + -+ //DBG_871X("8812-5G RF-%d-G-%d BW40-Addr-%x BASE=%x\n", ++ //DBG_871X("8812-5G RF-%d-G-%d BW40-Addr-%x BASE=%x\n", + // rfPath, TxCount, eeAddr-1, pwrInfo5G->IndexBW40_Base[rfPath][group]); + } -+ ++ + for(TxCount=0;TxCountBW40_Diff[rfPath][TxCount]= 0; -+ -+ pwrInfo5G->BW20_Diff[rfPath][0] = (PROMContent[eeAddr]&0xf0)>>4; -+ if (pwrInfo5G->BW20_Diff[rfPath][TxCount] & BIT3) /*4bit sign number to 8 bit sign number*/ -+ pwrInfo5G->BW20_Diff[rfPath][TxCount] |= 0xF0; -+ /*DBG_871X("8812-5G RF-%d-SS-%d BW20-Addr-%x DIFF=%d\n", -+ rfPath, TxCount, eeAddr, pwrInfo5G->BW20_Diff[rfPath][TxCount]);*/ ++ pwrInfo5G->BW40_Diff[rfPath][TxCount]= 0; + + -+ pwrInfo5G->OFDM_Diff[rfPath][0] = (PROMContent[eeAddr]&0x0f); -+ if (pwrInfo5G->OFDM_Diff[rfPath][TxCount] & BIT3) /*4bit sign number to 8 bit sign number*/ -+ pwrInfo5G->OFDM_Diff[rfPath][TxCount] |= 0xF0; -+ -+ /*DBG_871X("8812-5G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", -+ rfPath, TxCount, eeAddr, pwrInfo5G->OFDM_Diff[rfPath][TxCount]);*/ ++ { ++ pwrInfo5G->BW20_Diff[rfPath][0] = (PROMContent[eeAddr]&0xf0)>>4; ++ if(pwrInfo5G->BW20_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number ++ pwrInfo5G->BW20_Diff[rfPath][TxCount] |= 0xF0; ++ } ++ //DBG_871X("8812-5G RF-%d-SS-%d BW20-Addr-%x DIFF=%d\n", ++ //rfPath, TxCount, eeAddr, pwrInfo5G->BW20_Diff[rfPath][TxCount]); ++ ++ ++ { ++ pwrInfo5G->OFDM_Diff[rfPath][0] = (PROMContent[eeAddr]&0x0f); ++ if(pwrInfo5G->OFDM_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number ++ pwrInfo5G->OFDM_Diff[rfPath][TxCount] |= 0xF0; ++ } ++ //DBG_871X("8812-5G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", ++ //rfPath, TxCount, eeAddr, pwrInfo5G->OFDM_Diff[rfPath][TxCount]); + + eeAddr++; + } + else + { -+ pwrInfo5G->BW40_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; -+ if (pwrInfo5G->BW40_Diff[rfPath][TxCount] & BIT3) /*4bit sign number to 8 bit sign number*/ ++ ++ { ++ pwrInfo5G->BW40_Diff[rfPath][TxCount]= (PROMContent[eeAddr]&0xf0)>>4; ++ if(pwrInfo5G->BW40_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number + pwrInfo5G->BW40_Diff[rfPath][TxCount] |= 0xF0; -+ -+ /*DBG_871X("8812-5G RF-%d-SS-%d BW40-Addr-%x DIFF=%d\n", -+ rfPath, TxCount, eeAddr, pwrInfo5G->BW40_Diff[rfPath][TxCount]);*/ -+ -+ pwrInfo5G->BW20_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); -+ if (pwrInfo5G->BW20_Diff[rfPath][TxCount] & BIT3) /*4bit sign number to 8 bit sign number*/ ++ } ++ //DBG_871X("8812-5G RF-%d-SS-%d BW40-Addr-%x DIFF=%d\n", ++ //rfPath, TxCount, eeAddr, pwrInfo5G->BW40_Diff[rfPath][TxCount]); ++ ++ ++ { ++ pwrInfo5G->BW20_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); ++ if(pwrInfo5G->BW20_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number + pwrInfo5G->BW20_Diff[rfPath][TxCount] |= 0xF0; -+ -+ /*DBG_871X("8812-5G RF-%d-SS-%d BW20-Addr-%x DIFF=%d\n", -+ rfPath, TxCount, eeAddr, pwrInfo5G->BW20_Diff[rfPath][TxCount]);*/ -+ ++ } ++ //DBG_871X("8812-5G RF-%d-SS-%d BW20-Addr-%x DIFF=%d\n", ++ //rfPath, TxCount, eeAddr, pwrInfo5G->BW20_Diff[rfPath][TxCount]); ++ + eeAddr++; + } -+ } ++ } + + -+ pwrInfo5G->OFDM_Diff[rfPath][1] = (PROMContent[eeAddr]&0xf0)>>4; -+ pwrInfo5G->OFDM_Diff[rfPath][2] = (PROMContent[eeAddr]&0x0f); -+ -+ /*DBG_871X("8812-5G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", -+ rfPath, 2, eeAddr, pwrInfo5G->OFDM_Diff[rfPath][2]);*/ -+ eeAddr++; -+ -+ -+ pwrInfo5G->OFDM_Diff[rfPath][3] = (PROMContent[eeAddr]&0x0f); -+ -+ /*DBG_871X("8812-5G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", -+ rfPath, 3, eeAddr, pwrInfo5G->OFDM_Diff[rfPath][3]);*/ ++ { ++ pwrInfo5G->OFDM_Diff[rfPath][1] = (PROMContent[eeAddr]&0xf0)>>4; ++ pwrInfo5G->OFDM_Diff[rfPath][2] = (PROMContent[eeAddr]&0x0f); ++ } ++ //DBG_871X("8812-5G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", ++ // rfPath, 2, eeAddr, pwrInfo5G->OFDM_Diff[rfPath][2]); + eeAddr++; -+ ++ ++ ++ pwrInfo5G->OFDM_Diff[rfPath][3] = (PROMContent[eeAddr]&0x0f); ++ ++ //DBG_871X("8812-5G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", ++ //rfPath, 3, eeAddr, pwrInfo5G->OFDM_Diff[rfPath][3]); ++ eeAddr++; ++ + for(TxCount=1;TxCountOFDM_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo5G->OFDM_Diff[rfPath][TxCount] |= 0xF0; ++ pwrInfo5G->OFDM_Diff[rfPath][TxCount] |= 0xF0; + -+ //DBG_871X("8812-5G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", ++ //DBG_871X("8812-5G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", + //rfPath, TxCount, eeAddr, pwrInfo5G->OFDM_Diff[rfPath][TxCount]); -+ } -+ -+ for(TxCount=0;TxCountBW80_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; -+ if (pwrInfo5G->BW80_Diff[rfPath][TxCount] & BIT3) /*4bit sign number to 8 bit sign number*/ -+ pwrInfo5G->BW80_Diff[rfPath][TxCount] |= 0xF0; -+ -+ /*DBG_871X("8812-5G RF-%d-SS-%d BW80-Addr-%x DIFF=%d\n", -+ rfPath, TxCount, eeAddr, pwrInfo5G->BW80_Diff[rfPath][TxCount]);*/ -+ -+ pwrInfo5G->BW160_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); -+ if (pwrInfo5G->BW160_Diff[rfPath][TxCount] & BIT3) /*4bit sign number to 8 bit sign number*/ -+ pwrInfo5G->BW160_Diff[rfPath][TxCount] |= 0xF0; -+ -+ /*DBG_871X("8812-5G RF-%d-SS-%d BW160-Addr-%x DIFF=%d\n", -+ rfPath, TxCount, eeAddr, pwrInfo5G->BW160_Diff[rfPath][TxCount]);*/ ++ for(TxCount=0;TxCountBW80_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; ++ if(pwrInfo5G->BW80_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number ++ pwrInfo5G->BW80_Diff[rfPath][TxCount] |= 0xF0; ++ } ++ //DBG_871X("8812-5G RF-%d-SS-%d BW80-Addr-%x DIFF=%d\n", ++ //rfPath, TxCount, eeAddr, pwrInfo5G->BW80_Diff[rfPath][TxCount]); ++ ++ ++ { ++ pwrInfo5G->BW160_Diff[rfPath][TxCount]= (PROMContent[eeAddr]&0x0f); ++ if(pwrInfo5G->BW160_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number ++ pwrInfo5G->BW160_Diff[rfPath][TxCount] |= 0xF0; ++ } ++ //DBG_871X("8812-5G RF-%d-SS-%d BW160-Addr-%x DIFF=%d\n", ++ //rfPath, TxCount, eeAddr, pwrInfo5G->BW160_Diff[rfPath][TxCount]); + eeAddr++; + } + } + +} + -+VOID ++void +Hal_EfuseParseBTCoexistInfo8812A( -+ IN PADAPTER Adapter, -+ IN u8 *hwinfo, -+ IN BOOLEAN AutoLoadFail ++ PADAPTER Adapter, ++ pu1Byte hwinfo, ++ bool AutoLoadFail + ) +{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 tmp_u8; -+ u32 tmp_u32; -+ -+ if (IS_HARDWARE_TYPE_8812(Adapter)) { -+ -+ pHalData->EEPROMBluetoothType = BT_RTL8812A; -+ -+ if (!AutoLoadFail) { -+ tmp_u8 = hwinfo[EEPROM_RF_BOARD_OPTION_8812]; -+ if( ((tmp_u8 & 0xe0)>>5) == 0x1)// [7:5] -+ pHalData->EEPROMBluetoothCoexist = _TRUE; -+ else -+ pHalData->EEPROMBluetoothCoexist = _FALSE; -+ -+ tmp_u8 = hwinfo[EEPROM_RF_BT_SETTING_8812]; -+ pHalData->EEPROMBluetoothAntNum = (tmp_u8&0x1); // bit [0] -+ } else { -+ pHalData->EEPROMBluetoothCoexist = _FALSE; -+ pHalData->EEPROMBluetoothAntNum = Ant_x1; -+ } -+ } else if (IS_HARDWARE_TYPE_8821(Adapter)){ -+ -+ pHalData->EEPROMBluetoothType = BT_RTL8821; -+ -+ if (!AutoLoadFail) { -+ tmp_u32 = rtw_read32(Adapter, REG_MULTI_FUNC_CTRL); -+ if(tmp_u32 & BT_FUNC_EN) -+ pHalData->EEPROMBluetoothCoexist = _TRUE; -+ else -+ pHalData->EEPROMBluetoothCoexist = _FALSE; -+ -+ tmp_u8 = hwinfo[EEPROM_RF_BT_SETTING_8821]; -+ pHalData->EEPROMBluetoothAntNum = (tmp_u8&0x1); // bit [0] -+ } else { -+ pHalData->EEPROMBluetoothCoexist = _FALSE; -+ pHalData->EEPROMBluetoothAntNum = Ant_x2; -+ } -+ -+ #ifdef CONFIG_BTCOEX_FORCE_CSR -+ pHalData->EEPROMBluetoothType = BT_CSR_BC8; -+ pHalData->EEPROMBluetoothCoexist = _TRUE; -+ pHalData->EEPROMBluetoothAntNum = Ant_x2; -+ #endif -+ } else { -+ rtw_warn_on(1); -+ } -+ +#ifdef CONFIG_BT_COEXIST -+ if(_TRUE == pHalData->EEPROMBluetoothCoexist && IS_HARDWARE_TYPE_8812(Adapter)) -+ { -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if ( !hal_btcoex_AntIsolationConfig_ParaFile (Adapter , RTL8812_WIFI_ANT_ISOLATION)) { ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ pHalData->EEPROMBluetoothCoexist = 0; ++ pHalData->EEPROMBluetoothType = BT_CSR_BC8; ++ pHalData->EEPROMBluetoothAntNum = Ant_x2; ++ pHalData->EEPROMBluetoothAntIsolation = 1; ++ pHalData->EEPROMBluetoothRadioShared = BT_Radio_Shared; ++ BT_InitHalVars(Adapter); +#endif -+ -+ DBG_871X("%s : %s file read fail\n", __func__, RTL8812_WIFI_ANT_ISOLATION); -+ pHalData->EEPROMBluetoothCoexist = _TRUE; -+ hal_btcoex_SetAntIsolationType(Adapter, 0); -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ } -+#endif -+ } -+ rtw_btcoex_SetBTCoexist(Adapter, pHalData->EEPROMBluetoothCoexist); -+ rtw_btcoex_SetChipType(Adapter, pHalData->EEPROMBluetoothType); -+ rtw_btcoex_SetPGAntNum(Adapter, pHalData->EEPROMBluetoothAntNum==Ant_x2?2:1); -+ DBG_871X("%s: BTCoexist=%s, AntNum=%d\n", __func__, pHalData->EEPROMBluetoothCoexist == _TRUE?"Enable":"Disable" -+ ,pHalData->EEPROMBluetoothAntNum==Ant_x2?2:1); -+#endif /* CONFIG_BT_COEXIST */ +} + +void +Hal_EfuseParseIDCode8812A( -+ IN PADAPTER padapter, -+ IN u8 *hwinfo ++ PADAPTER padapter, ++ u8 *hwinfo + ) +{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); + u16 EEPROMId; + + + // Checl 0x8129 again for making sure autoload status!! -+ EEPROMId = EF2Byte(*((u16*)&hwinfo[0])); ++ EEPROMId = le16_to_cpu(*((u16*)hwinfo)); + if (EEPROMId != RTL_EEPROM_ID) + { + DBG_8192C("EEPROM ID(%#x) is invalid!!\n", EEPROMId); -+ pHalData->bautoload_fail_flag = _TRUE; ++ pEEPROM->bautoload_fail_flag = true; + } + else + { -+ pHalData->bautoload_fail_flag = _FALSE; ++ pEEPROM->bautoload_fail_flag = false; + } + + DBG_8192C("EEPROM ID=0x%04x\n", EEPROMId); +} + -+VOID ++void +Hal_ReadPROMVersion8812A( -+ IN PADAPTER Adapter, -+ IN u8* PROMContent, -+ IN BOOLEAN AutoloadFail ++ PADAPTER Adapter, ++ u8* PROMContent, ++ bool AutoloadFail + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + + if(AutoloadFail){ -+ pHalData->EEPROMVersion = EEPROM_Default_Version; ++ pHalData->EEPROMVersion = EEPROM_Default_Version; + } + else{ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ pHalData->EEPROMVersion = *(u8 *)&PROMContent[EEPROM_VERSION_8812]; -+ else -+ pHalData->EEPROMVersion = *(u8 *)&PROMContent[EEPROM_VERSION_8821]; ++ pHalData->EEPROMVersion = *(u8 *)&PROMContent[EEPROM_VERSION_8812]; + if(pHalData->EEPROMVersion == 0xFF) -+ pHalData->EEPROMVersion = EEPROM_Default_Version; ++ pHalData->EEPROMVersion = EEPROM_Default_Version; + } + //DBG_871X("pHalData->EEPROMVersion is 0x%x\n", pHalData->EEPROMVersion); +} + +void +Hal_ReadTxPowerInfo8812A( -+ IN PADAPTER Adapter, -+ IN u8* PROMContent, -+ IN BOOLEAN AutoLoadFail ++ PADAPTER Adapter, ++ u8* PROMContent, ++ bool AutoLoadFail + ) -+{ ++{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + TxPowerInfo24G pwrInfo24G; + TxPowerInfo5G pwrInfo5G; + u8 rfPath, ch, group, TxCount; ++ u8 channel5G[CHANNEL_MAX_NUMBER_5G] = ++ {36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112, ++ 114,116,118,120,122,124,126,128,130,132,134,136,138,140,142,144,149,151, ++ 153,155,157,159,161,163,165,167,168,169,171,173,175,177}; ++ u8 channel5G_80M[CHANNEL_MAX_NUMBER_5G_80M] = {42, 58, 106, 122, 138, 155, 171}; + + hal_ReadPowerValueFromPROM8812A(Adapter, &pwrInfo24G,&pwrInfo5G, PROMContent, AutoLoadFail); + + //if(!AutoLoadFail) -+ // pHalData->bTXPowerDataReadFromEEPORM = _TRUE; ++ // pHalData->bTXPowerDataReadFromEEPORM = true; + + for(rfPath = 0 ; rfPath < MAX_RF_PATH ; rfPath++) + { -+ for (ch = 0 ; ch < CENTER_CH_2G_NUM ; ch++) { ++ for(ch = 0 ; ch < CHANNEL_MAX_NUMBER_2G ; ch++) ++ { + Hal_GetChnlGroup8812A(ch+1, &group); + -+ if(ch == 14-1) ++ if(ch == 14-1) + { + pHalData->Index24G_CCK_Base[rfPath][ch] = pwrInfo24G.IndexCCK_Base[rfPath][5]; + pHalData->Index24G_BW40_Base[rfPath][ch] = pwrInfo24G.IndexBW40_Base[rfPath][group]; @@ -273354,28 +112802,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + pHalData->Index24G_CCK_Base[rfPath][ch] = pwrInfo24G.IndexCCK_Base[rfPath][group]; + pHalData->Index24G_BW40_Base[rfPath][ch] = pwrInfo24G.IndexBW40_Base[rfPath][group]; + } -+ //DBG_871X("======= Path %d, ChannelIndex %d, Group %d=======\n",rfPath,ch, group); ++ //DBG_871X("======= Path %d, ChannelIndex %d, Group %d=======\n",rfPath,ch, group); + //DBG_871X("Index24G_CCK_Base[%d][%d] = 0x%x\n",rfPath,ch ,pHalData->Index24G_CCK_Base[rfPath][ch]); + //DBG_871X("Index24G_BW40_Base[%d][%d] = 0x%x\n",rfPath,ch,pHalData->Index24G_BW40_Base[rfPath][ch]); -+ } ++ } ++ ++ for(ch = 0 ; ch < CHANNEL_MAX_NUMBER_5G; ch++) ++ { ++ Hal_GetChnlGroup8812A(channel5G[ch], &group); + -+ for (ch = 0 ; ch < CENTER_CH_5G_ALL_NUM; ch++) { -+ Hal_GetChnlGroup8812A(center_ch_5g_all[ch], &group); -+ + pHalData->Index5G_BW40_Base[rfPath][ch] = pwrInfo5G.IndexBW40_Base[rfPath][group]; -+ //DBG_871X("======= Path %d, ChannelIndex %d, Group %d=======\n",rfPath,ch, group); ++ //DBG_871X("======= Path %d, ChannelIndex %d, Group %d=======\n",rfPath,ch, group); + //DBG_871X("Index5G_BW40_Base[%d][%d] = 0x%x\n",rfPath,ch,pHalData->Index5G_BW40_Base[rfPath][ch]); + } -+ for (ch = 0 ; ch < CENTER_CH_5G_80M_NUM; ch++) { ++ for(ch = 0 ; ch < CHANNEL_MAX_NUMBER_5G_80M; ch++) ++ { + u8 upper, lower; -+ -+ Hal_GetChnlGroup8812A(center_ch_5g_80m[ch], &group); ++ ++ Hal_GetChnlGroup8812A(channel5G_80M[ch], &group); + upper = pwrInfo5G.IndexBW40_Base[rfPath][group]; + lower = pwrInfo5G.IndexBW40_Base[rfPath][group+1]; -+ ++ + pHalData->Index5G_BW80_Base[rfPath][ch] = (upper + lower) / 2; -+ -+ //DBG_871X("======= Path %d, ChannelIndex %d, Group %d=======\n",rfPath,ch, group); ++ ++ //DBG_871X("======= Path %d, ChannelIndex %d, Group %d=======\n",rfPath,ch, group); + //DBG_871X("Index5G_BW80_Base[%d][%d] = 0x%x\n",rfPath,ch,pHalData->Index5G_BW80_Base[rfPath][ch]); + } + @@ -273385,7 +112835,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + pHalData->OFDM_24G_Diff[rfPath][TxCount]=pwrInfo24G.OFDM_Diff[rfPath][TxCount]; + pHalData->BW20_24G_Diff[rfPath][TxCount]=pwrInfo24G.BW20_Diff[rfPath][TxCount]; + pHalData->BW40_24G_Diff[rfPath][TxCount]=pwrInfo24G.BW40_Diff[rfPath][TxCount]; -+ ++ + pHalData->OFDM_5G_Diff[rfPath][TxCount]=pwrInfo5G.OFDM_Diff[rfPath][TxCount]; + pHalData->BW20_5G_Diff[rfPath][TxCount]=pwrInfo5G.BW20_Diff[rfPath][TxCount]; + pHalData->BW40_5G_Diff[rfPath][TxCount]=pwrInfo5G.BW40_Diff[rfPath][TxCount]; @@ -273402,36 +112852,44 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + DBG_871X("BW20_5G_Diff[%d][%d]= %d\n",rfPath,TxCount,pHalData->BW20_5G_Diff[rfPath][TxCount]); + DBG_871X("BW40_5G_Diff[%d][%d]= %d\n",rfPath,TxCount,pHalData->BW40_5G_Diff[rfPath][TxCount]); + DBG_871X("BW80_5G_Diff[%d][%d]= %d\n",rfPath,TxCount,pHalData->BW80_5G_Diff[rfPath][TxCount]); -+#endif ++#endif + } + } + -+ ++ + // 2010/10/19 MH Add Regulator recognize for CU. + if(!AutoLoadFail) + { + struct registry_priv *registry_par = &Adapter->registrypriv; -+ -+ -+ if(PROMContent[EEPROM_RF_BOARD_OPTION_8812] == 0xFF) -+ pHalData->EEPROMRegulatory = (EEPROM_DEFAULT_BOARD_OPTION&0x7); //bit0~2 -+ else -+ pHalData->EEPROMRegulatory = (PROMContent[EEPROM_RF_BOARD_OPTION_8812]&0x7); //bit0~2 ++ if( registry_par->regulatory_tid == 0xff){ + ++ if(PROMContent[EEPROM_RF_BOARD_OPTION_8812] == 0xFF) ++ pHalData->EEPROMRegulatory = (EEPROM_DEFAULT_BOARD_OPTION&0x7); //bit0~2 ++ else ++ pHalData->EEPROMRegulatory = (PROMContent[EEPROM_RF_BOARD_OPTION_8812]&0x7); //bit0~2 ++ } ++ else{ ++ pHalData->EEPROMRegulatory = registry_par->regulatory_tid; ++ } ++ ++ // 2012/09/26 MH Add for TX power calibrate rate. ++ pHalData->TxPwrCalibrateRate = PROMContent[EEPROM_TX_PWR_CALIBRATE_RATE_8812]; + } + else + { + pHalData->EEPROMRegulatory = 0; ++ // 2012/09/26 MH Add for TX power calibrate rate. ++ pHalData->TxPwrCalibrateRate = EEPROM_DEFAULT_TX_CALIBRATE_RATE; + } -+ DBG_871X("EEPROMRegulatory = 0x%x \n", pHalData->EEPROMRegulatory); ++ DBG_871X("EEPROMRegulatory = 0x%x TxPwrCalibrateRate=0x%x\n", pHalData->EEPROMRegulatory, pHalData->TxPwrCalibrateRate); + +} + -+VOID ++void +Hal_ReadBoardType8812A( -+ IN PADAPTER Adapter, -+ IN u8* PROMContent, -+ IN BOOLEAN AutoloadFail ++ PADAPTER Adapter, ++ u8* PROMContent, ++ bool AutoloadFail + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -273450,11 +112908,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + +} + -+VOID ++void +Hal_ReadThermalMeter_8812A( -+ IN PADAPTER Adapter, -+ IN u8* PROMContent, -+ IN BOOLEAN AutoloadFail ++ PADAPTER Adapter, ++ u8* PROMContent, ++ bool AutoloadFail + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -273463,7 +112921,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + // + // ThermalMeter from EEPROM + // -+ if(!AutoloadFail) ++ if(!AutoloadFail) + pHalData->EEPROMThermalMeter = PROMContent[EEPROM_THERMAL_METER_8812]; + else + pHalData->EEPROMThermalMeter = EEPROM_Default_ThermalMeter_8812; @@ -273471,66 +112929,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + if(pHalData->EEPROMThermalMeter == 0xff || AutoloadFail) + { -+ pHalData->odmpriv.RFCalibrateInfo.bAPKThermalMeterIgnore = _TRUE; -+ pHalData->EEPROMThermalMeter = 0xFF; ++ pHalData->bAPKThermalMeterIgnore = true; ++ pHalData->EEPROMThermalMeter = 0xFF; + } + -+ //pHalData->ThermalMeter[0] = pHalData->EEPROMThermalMeter; ++ //pHalData->ThermalMeter[0] = pHalData->EEPROMThermalMeter; + DBG_871X("ThermalMeter = 0x%x\n", pHalData->EEPROMThermalMeter); +} + -+void Hal_ReadRemoteWakeup_8812A( -+ PADAPTER padapter, -+ IN u8* hwinfo, -+ IN BOOLEAN AutoLoadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ u8 tmpvalue; -+ -+ if(AutoLoadFail){ -+ pwrctl->bHWPowerdown = _FALSE; -+ pwrctl->bSupportRemoteWakeup = _FALSE; -+ } -+ else -+ { -+ // decide hw if support remote wakeup function -+ // if hw supported, 8051 (SIE) will generate WeakUP signal( D+/D- toggle) when autoresume -+#ifdef CONFIG_USB_HCI -+ if(IS_HARDWARE_TYPE_8821U(padapter)) -+ pwrctl->bSupportRemoteWakeup = (hwinfo[EEPROM_USB_OPTIONAL_FUNCTION0_8811AU] & BIT1)?_TRUE :_FALSE; -+ else -+ pwrctl->bSupportRemoteWakeup = (hwinfo[EEPROM_USB_OPTIONAL_FUNCTION0] & BIT1)?_TRUE :_FALSE; -+#endif //CONFIG_USB_HCI -+ -+ DBG_871X("%s...bSupportRemoteWakeup(%x)\n",__FUNCTION__, pwrctl->bSupportRemoteWakeup); -+ } -+} -+ -+VOID ++void +Hal_ReadChannelPlan8812A( -+ IN PADAPTER padapter, -+ IN u8* hwinfo, -+ IN BOOLEAN AutoLoadFail ++ PADAPTER padapter, ++ u8* hwinfo, ++ bool AutoLoadFail + ) +{ -+ padapter->mlmepriv.ChannelPlan = hal_com_config_channel_plan( ++ padapter->mlmepriv.ChannelPlan = hal_com_get_channel_plan( + padapter + , hwinfo?hwinfo[EEPROM_ChannelPlan_8812]:0xFF + , padapter->registrypriv.channel_plan -+ , RTW_CHPLAN_REALTEK_DEFINE ++ , RT_CHANNEL_DOMAIN_REALTEK_DEFINE + , AutoLoadFail + ); + + DBG_871X("mlmepriv.ChannelPlan = 0x%02x\n", padapter->mlmepriv.ChannelPlan); +} + -+VOID ++void +Hal_EfuseParseXtal_8812A( -+ IN PADAPTER pAdapter, -+ IN u8* hwinfo, -+ IN BOOLEAN AutoLoadFail ++ PADAPTER pAdapter, ++ u8* hwinfo, ++ bool AutoLoadFail + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); @@ -273548,34 +112977,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + DBG_871X("CrystalCap: 0x%2x\n", pHalData->CrystalCap); +} + -+VOID ++void +Hal_ReadAntennaDiversity8812A( -+ IN PADAPTER pAdapter, -+ IN u8* PROMContent, -+ IN BOOLEAN AutoLoadFail ++ PADAPTER pAdapter, ++ u8* PROMContent, ++ bool AutoLoadFail + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); + struct registry_priv *registry_par = &pAdapter->registrypriv; -+ ++ + if(!AutoLoadFail) + { + // Antenna Diversity setting. + if(registry_par->antdiv_cfg == 2) + { + pHalData->AntDivCfg = (PROMContent[EEPROM_RF_BOARD_OPTION_8812]&0x18)>>3; -+ if(PROMContent[EEPROM_RF_BOARD_OPTION_8812] == 0xFF) -+ pHalData->AntDivCfg = (EEPROM_DEFAULT_BOARD_OPTION&0x18)>>3;; ++ if(PROMContent[EEPROM_RF_BOARD_OPTION_8812] == 0xFF) ++ pHalData->AntDivCfg = (EEPROM_DEFAULT_BOARD_OPTION&0x18)>>3;; + } + else + { + pHalData->AntDivCfg = registry_par->antdiv_cfg; + } + -+#ifdef CONFIG_BT_COEXIST -+ if(hal_btcoex_1Ant(pAdapter)) ++ if(pHalData->EEPROMBluetoothCoexist!=0 && pHalData->EEPROMBluetoothAntNum==Ant_x1) + pHalData->AntDivCfg = 0; -+#endif + + pHalData->TRxAntDivType = PROMContent[EEPROM_RF_ANTENNA_OPT_8812]; //todo by page + if (pHalData->TRxAntDivType == 0xFF) @@ -273584,53 +113011,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + else + { + pHalData->AntDivCfg = 0; -+ } -+ -+ DBG_871X("SWAS: bHwAntDiv = %x, TRxAntDivType = %x\n", pHalData->AntDivCfg, pHalData->TRxAntDivType); -+} -+ -+VOID -+Hal_ReadAntennaDiversity8821A( -+ IN PADAPTER pAdapter, -+ IN u8 *PROMContent, -+ IN BOOLEAN AutoLoadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct registry_priv *registry_par = &pAdapter->registrypriv; -+ -+ if(!AutoLoadFail) -+ { -+ // Antenna Diversity setting. -+ if(registry_par->antdiv_cfg == 2) -+ pHalData->AntDivCfg = (PROMContent[EEPROM_RF_BOARD_OPTION_8812]& BIT3)?_TRUE:_FALSE; -+ else -+ pHalData->AntDivCfg = registry_par->antdiv_cfg; -+ -+#ifdef CONFIG_BT_COEXIST -+ if(hal_btcoex_1Ant(pAdapter)) -+ pHalData->AntDivCfg = 0; -+#endif -+ -+ //pHalData->TRxAntDivType = FIXED_HW_ANTDIV; // For 88EE, 1Tx and 1RxCG are fixed.(1Ant, Tx and RxCG are both on aux port) -+ pHalData->TRxAntDivType = CG_TRX_HW_ANTDIV; //DPDT -+ -+ //3 TODO -+ pHalData->AntDivCfg = 0; -+ } -+ else -+ { -+ pHalData->AntDivCfg = 0; ++ //pHalData->TRxAntDivType = pHalData->TRxAntDivType; // ????? + } + + DBG_871X("SWAS: bHwAntDiv = %x, TRxAntDivType = %x\n", pHalData->AntDivCfg, pHalData->TRxAntDivType); +} + -+VOID -+hal_ReadPAType_8812A( -+ IN PADAPTER Adapter, -+ IN u8* PROMContent, -+ IN BOOLEAN AutoloadFail ++void ++Hal_ReadPAType_8812A( ++ PADAPTER Adapter, ++ u8* PROMContent, ++ bool AutoloadFail + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -273639,17 +113030,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + { + if (GetRegAmplifierType2G(Adapter) == 0) // AUTO + { -+ pHalData->PAType_2G = EF1Byte( *(u8 *)&PROMContent[EEPROM_PA_TYPE_8812AU] ); -+ pHalData->LNAType_2G = EF1Byte( *(u8 *)&PROMContent[EEPROM_LNA_TYPE_2G_8812AU] ); -+ if (pHalData->PAType_2G == 0xFF) ++ pHalData->PAType_2G = ( *(u8 *)&PROMContent[EEPROM_PA_TYPE_8812AU] ); ++ pHalData->LNAType_2G = ( *(u8 *)&PROMContent[EEPROM_LNA_TYPE_2G_8812AU] ); ++ if (pHalData->PAType_2G == 0xFF && pHalData->LNAType_2G == 0xFF) { + pHalData->PAType_2G = 0; -+ if(pHalData->LNAType_2G == 0xFF) + pHalData->LNAType_2G = 0; -+ ++ } + pHalData->ExternalPA_2G = ((pHalData->PAType_2G & BIT5) && (pHalData->PAType_2G & BIT4)) ? 1 : 0; + pHalData->ExternalLNA_2G = ((pHalData->LNAType_2G & BIT7) && (pHalData->LNAType_2G & BIT3)) ? 1 : 0; + } -+ else ++ else + { + pHalData->ExternalPA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_PA) ? 1 : 0; + pHalData->ExternalLNA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_LNA) ? 1 : 0; @@ -273657,13 +113047,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + if (GetRegAmplifierType5G(Adapter) == 0) // AUTO + { -+ pHalData->PAType_5G = EF1Byte( *(u8 *)&PROMContent[EEPROM_PA_TYPE_8812AU] ); -+ pHalData->LNAType_5G = EF1Byte( *(u8 *)&PROMContent[EEPROM_LNA_TYPE_5G_8812AU] ); -+ if (pHalData->PAType_5G == 0xFF) ++ pHalData->PAType_5G = ( *(u8 *)&PROMContent[EEPROM_PA_TYPE_8812AU] ); ++ pHalData->LNAType_5G = ( *(u8 *)&PROMContent[EEPROM_LNA_TYPE_5G_8812AU] ); ++ if (pHalData->PAType_5G == 0xFF && pHalData->LNAType_5G == 0xFF) { + pHalData->PAType_5G = 0; -+ if (pHalData->LNAType_5G == 0xFF) + pHalData->LNAType_5G = 0; -+ ++ } + pHalData->ExternalPA_5G = ((pHalData->PAType_5G & BIT1) && (pHalData->PAType_5G & BIT0)) ? 1 : 0; + pHalData->ExternalLNA_5G = ((pHalData->LNAType_5G & BIT7) && (pHalData->LNAType_5G & BIT3)) ? 1 : 0; + } @@ -273675,11 +113064,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + } + else + { -+ pHalData->ExternalPA_2G = EEPROM_Default_PAType; -+ pHalData->ExternalPA_5G = 0xFF; -+ pHalData->ExternalLNA_2G = EEPROM_Default_LNAType; -+ pHalData->ExternalLNA_5G = 0xFF; -+ ++ pHalData->ExternalPA_2G = EEPROM_Default_PAType; ++ pHalData->ExternalPA_5G = 0xFF; ++ pHalData->ExternalLNA_2G = EEPROM_Default_LNAType; ++ pHalData->ExternalLNA_5G = 0xFF; ++ + if (GetRegAmplifierType2G(Adapter) == 0) // AUTO + { + pHalData->ExternalPA_2G = 0; @@ -273707,49 +113096,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + DBG_871X("pHalData->LNAType_5G is 0x%x, pHalData->ExternalLNA_5G = %d\n", pHalData->LNAType_5G, pHalData->ExternalLNA_5G); +} + -+VOID -+Hal_ReadAmplifierType_8812A( -+ IN PADAPTER Adapter, -+ IN u8* PROMContent, -+ IN BOOLEAN AutoloadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ u8 extTypePA_2G_A = (PROMContent[0xBD] & BIT2) >> 2; // 0xBD[2] -+ u8 extTypePA_2G_B = (PROMContent[0xBD] & BIT6) >> 6; // 0xBD[6] -+ u8 extTypePA_5G_A = (PROMContent[0xBF] & BIT2) >> 2; // 0xBF[2] -+ u8 extTypePA_5G_B = (PROMContent[0xBF] & BIT6) >> 6; // 0xBF[6] -+ u8 extTypeLNA_2G_A = (PROMContent[0xBD] & (BIT1|BIT0)) >> 0; // 0xBD[1:0] -+ u8 extTypeLNA_2G_B = (PROMContent[0xBD] & (BIT5|BIT4)) >> 4; // 0xBD[5:4] -+ u8 extTypeLNA_5G_A = (PROMContent[0xBF] & (BIT1|BIT0)) >> 0; // 0xBF[1:0] -+ u8 extTypeLNA_5G_B = (PROMContent[0xBF] & (BIT5|BIT4)) >> 4; // 0xBF[5:4] -+ -+ hal_ReadPAType_8812A(Adapter, PROMContent, AutoloadFail); -+ -+ if ((pHalData->PAType_2G & (BIT5|BIT4)) == (BIT5|BIT4)) // [2.4G] Path A and B are both extPA -+ pHalData->TypeGPA = extTypePA_2G_B << 2 | extTypePA_2G_A; -+ -+ if ((pHalData->PAType_5G & (BIT1|BIT0)) == (BIT1|BIT0)) // [5G] Path A and B are both extPA -+ pHalData->TypeAPA = extTypePA_5G_B << 2 | extTypePA_5G_A; -+ -+ if ((pHalData->LNAType_2G & (BIT7|BIT3)) == (BIT7|BIT3)) // [2.4G] Path A and B are both extLNA -+ pHalData->TypeGLNA = extTypeLNA_2G_B << 2 | extTypeLNA_2G_A; -+ -+ if ((pHalData->LNAType_5G & (BIT7|BIT3)) == (BIT7|BIT3)) // [5G] Path A and B are both extLNA -+ pHalData->TypeALNA = extTypeLNA_5G_B << 2 | extTypeLNA_5G_A; -+ -+ DBG_871X("pHalData->TypeGPA = 0x%X\n", pHalData->TypeGPA); -+ DBG_871X("pHalData->TypeAPA = 0x%X\n", pHalData->TypeAPA); -+ DBG_871X("pHalData->TypeGLNA = 0x%X\n", pHalData->TypeGLNA); -+ DBG_871X("pHalData->TypeALNA = 0x%X\n", pHalData->TypeALNA); -+} -+ -+VOID ++void +Hal_ReadPAType_8821A( -+ IN PADAPTER Adapter, -+ IN u8* PROMContent, -+ IN BOOLEAN AutoloadFail ++ PADAPTER Adapter, ++ u8* PROMContent, ++ bool AutoloadFail + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -273758,17 +113109,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + { + if (GetRegAmplifierType2G(Adapter) == 0) // AUTO + { -+ pHalData->PAType_2G = EF1Byte( *(u8 *)&PROMContent[EEPROM_PA_TYPE_8812AU] ); -+ pHalData->LNAType_2G = EF1Byte( *(u8 *)&PROMContent[EEPROM_LNA_TYPE_2G_8812AU] ); -+ if(pHalData->PAType_2G == 0xFF ) ++ pHalData->PAType_2G = ( *(u8 *)&PROMContent[EEPROM_PA_TYPE_8812AU] ); ++ pHalData->LNAType_2G = ( *(u8 *)&PROMContent[EEPROM_LNA_TYPE_2G_8812AU] ); ++ if (pHalData->PAType_2G == 0xFF && pHalData->LNAType_2G == 0xFF) { + pHalData->PAType_2G = 0; -+ if(pHalData->LNAType_2G == 0xFF) + pHalData->LNAType_2G = 0; -+ ++ } + pHalData->ExternalPA_2G = (pHalData->PAType_2G & BIT4) ? 1 : 0; + pHalData->ExternalLNA_2G = (pHalData->LNAType_2G & BIT3) ? 1 : 0; + } -+ else ++ else + { + pHalData->ExternalPA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_PA) ? 1 : 0; + pHalData->ExternalLNA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_LNA) ? 1 : 0; @@ -273776,13 +113126,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + if (GetRegAmplifierType5G(Adapter) == 0) // AUTO + { -+ pHalData->PAType_5G = EF1Byte( *(u8 *)&PROMContent[EEPROM_PA_TYPE_8812AU] ); -+ pHalData->LNAType_5G = EF1Byte( *(u8 *)&PROMContent[EEPROM_LNA_TYPE_5G_8812AU] ); -+ if (pHalData->PAType_5G == 0xFF) ++ pHalData->PAType_5G = ( *(u8 *)&PROMContent[EEPROM_PA_TYPE_8812AU] ); ++ pHalData->LNAType_5G = ( *(u8 *)&PROMContent[EEPROM_LNA_TYPE_5G_8812AU] ); ++ if (pHalData->PAType_5G == 0xFF && pHalData->LNAType_5G == 0xFF) { + pHalData->PAType_5G = 0; -+ if (pHalData->LNAType_5G == 0xFF) + pHalData->LNAType_5G = 0; -+ ++ } + pHalData->ExternalPA_5G = (pHalData->PAType_5G & BIT0) ? 1 : 0; + pHalData->ExternalLNA_5G = (pHalData->LNAType_5G & BIT3) ? 1 : 0; + } @@ -273794,30 +113143,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + } + else + { -+ pHalData->ExternalPA_2G = EEPROM_Default_PAType; -+ pHalData->ExternalPA_5G = 0xFF; -+ pHalData->ExternalLNA_2G = EEPROM_Default_LNAType; -+ pHalData->ExternalLNA_5G = 0xFF; -+ ++ pHalData->ExternalPA_2G = EEPROM_Default_PAType; ++ pHalData->ExternalPA_5G = 0xFF; ++ pHalData->ExternalLNA_2G = EEPROM_Default_LNAType; ++ pHalData->ExternalLNA_5G = 0xFF; ++ + if (GetRegAmplifierType2G(Adapter) == 0) // AUTO -+ { -+ pHalData->ExternalPA_2G = 0; -+ pHalData->ExternalLNA_2G = 0; ++ { ++ pHalData->ExternalPA_2G = 0; ++ pHalData->ExternalLNA_2G = 0; + } + else + { -+ pHalData->ExternalPA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_PA) ? 1 : 0; -+ pHalData->ExternalLNA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_LNA) ? 1 : 0; ++ pHalData->ExternalPA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_PA) ? 1 : 0; ++ pHalData->ExternalLNA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_LNA) ? 1 : 0; + } + if (GetRegAmplifierType5G(Adapter) == 0) // AUTO -+ { -+ pHalData->ExternalPA_5G = 0; -+ pHalData->ExternalLNA_5G = 0; ++ { ++ pHalData->ExternalPA_5G = 0; ++ pHalData->ExternalLNA_5G = 0; + } + else + { -+ pHalData->ExternalPA_5G = (GetRegAmplifierType5G(Adapter)&ODM_BOARD_EXT_PA_5G) ? 1 : 0; -+ pHalData->ExternalLNA_5G = (GetRegAmplifierType5G(Adapter)&ODM_BOARD_EXT_LNA_5G) ? 1 : 0; ++ pHalData->ExternalPA_5G = (GetRegAmplifierType5G(Adapter)&ODM_BOARD_EXT_PA_5G) ? 1 : 0; ++ pHalData->ExternalLNA_5G = (GetRegAmplifierType5G(Adapter)&ODM_BOARD_EXT_LNA_5G) ? 1 : 0; + } + } + DBG_871X("pHalData->PAType_2G is 0x%x, pHalData->ExternalPA_2G = %d\n", pHalData->PAType_2G, pHalData->ExternalPA_2G); @@ -273826,37 +113175,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + DBG_871X("pHalData->LNAType_5G is 0x%x, pHalData->ExternalLNA_5G = %d\n", pHalData->LNAType_5G, pHalData->ExternalLNA_5G); +} + -+VOID ++void +Hal_ReadRFEType_8812A( -+ IN PADAPTER Adapter, -+ IN u8* PROMContent, -+ IN BOOLEAN AutoloadFail ++ PADAPTER Adapter, ++ u8* PROMContent, ++ bool AutoloadFail + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + + if(!AutoloadFail) + { -+ if(( GetRegRFEType(Adapter) != 64)|| 0xFF == PROMContent[EEPROM_RFE_OPTION_8812]) -+ { -+ if(GetRegRFEType(Adapter) != 64) -+ pHalData->RFEType = GetRegRFEType(Adapter); -+ else -+ { -+ if (IS_HARDWARE_TYPE_8812AU(Adapter)) -+ pHalData->RFEType = 0; -+ else if (IS_HARDWARE_TYPE_8812E(Adapter)) -+ pHalData->RFEType = 2; -+ else -+ pHalData->RFEType = EEPROM_DEFAULT_RFE_OPTION; -+ } -+ -+ } ++ if(GetRegRFEType(Adapter) != 64) ++ pHalData->RFEType = GetRegRFEType(Adapter); + else if(PROMContent[EEPROM_RFE_OPTION_8812] & BIT7) + { + if(pHalData->ExternalLNA_5G) + { -+ if(pHalData->ExternalPA_5G) ++ if(pHalData->ExternalPA_5G) + { + if(pHalData->ExternalLNA_2G && pHalData->ExternalPA_2G ) + pHalData->RFEType = 3; @@ -273874,12 +113210,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + pHalData->RFEType = PROMContent[EEPROM_RFE_OPTION_8812]&0x3F; + + // 2013/03/19 MH Due to othe customer already use incorrect EFUSE map -+ // to for their product. We need to add workaround to prevent to modify ++ // to for their product. We need to add workaround to prevent to modify + // spec and notify all customer to revise the IC 0xca content. After + // discussing with Willis an YN, revise driver code to prevent. -+ if (pHalData->RFEType == 4 && -+ (pHalData->ExternalPA_5G == _TRUE || pHalData->ExternalPA_2G == _TRUE || -+ pHalData->ExternalLNA_5G == _TRUE || pHalData->ExternalLNA_2G == _TRUE)) ++ if (pHalData->RFEType == 4 && ++ (pHalData->ExternalPA_5G == true || pHalData->ExternalPA_2G == true || ++ pHalData->ExternalLNA_5G == true || pHalData->ExternalLNA_2G == true)) + { + if (IS_HARDWARE_TYPE_8812AU(Adapter)) + pHalData->RFEType = 0; @@ -273891,91 +113227,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + else + { + if(GetRegRFEType(Adapter) != 64) -+ pHalData->RFEType = GetRegRFEType(Adapter); ++ pHalData->RFEType = GetRegRFEType(Adapter); + else -+ { -+ if (IS_HARDWARE_TYPE_8812AU(Adapter)) -+ pHalData->RFEType = 0; -+ else if (IS_HARDWARE_TYPE_8812E(Adapter)) -+ pHalData->RFEType = 2; -+ else -+ pHalData->RFEType = EEPROM_DEFAULT_RFE_OPTION; -+ } ++ pHalData->RFEType = EEPROM_DEFAULT_RFE_OPTION; + } + + DBG_871X("RFE Type: 0x%2x\n", pHalData->RFEType); +} + -+void Hal_EfuseParseKFreeData_8821A( -+ IN PADAPTER Adapter, -+ IN u8 *PROMContent, -+ IN BOOLEAN AutoloadFail) -+{ -+#ifdef CONFIG_RF_GAIN_OFFSET -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct kfree_data_t *kfree_data = &pHalData->kfree_data; -+ -+ if ((Adapter->registrypriv.RegRfKFreeEnable == 1) || !AutoloadFail) { -+ kfree_data->bb_gain[BB_GAIN_2G][RF_PATH_A] -+ = KFREE_BB_GAIN_2G_TX_OFFSET(EFUSE_Read1Byte(Adapter, PPG_BB_GAIN_2G_TXA_OFFSET_8821A) & PPG_BB_GAIN_2G_TX_OFFSET_MASK); -+ kfree_data->bb_gain[BB_GAIN_5GLB1][RF_PATH_A] -+ = KFREE_BB_GAIN_5G_TX_OFFSET(EFUSE_Read1Byte(Adapter, PPG_BB_GAIN_5GLB1_TXA_OFFSET_8821A) & PPG_BB_GAIN_5G_TX_OFFSET_MASK); -+ kfree_data->bb_gain[BB_GAIN_5GLB2][RF_PATH_A] -+ = KFREE_BB_GAIN_5G_TX_OFFSET(EFUSE_Read1Byte(Adapter, PPG_BB_GAIN_5GLB2_TXA_OFFSET_8821A) & PPG_BB_GAIN_5G_TX_OFFSET_MASK); -+ kfree_data->bb_gain[BB_GAIN_5GMB1][RF_PATH_A] -+ = KFREE_BB_GAIN_5G_TX_OFFSET(EFUSE_Read1Byte(Adapter, PPG_BB_GAIN_5GMB1_TXA_OFFSET_8821A) & PPG_BB_GAIN_5G_TX_OFFSET_MASK); -+ kfree_data->bb_gain[BB_GAIN_5GMB2][RF_PATH_A] -+ = KFREE_BB_GAIN_5G_TX_OFFSET(EFUSE_Read1Byte(Adapter, PPG_BB_GAIN_5GMB2_TXA_OFFSET_8821A) & PPG_BB_GAIN_5G_TX_OFFSET_MASK); -+ kfree_data->bb_gain[BB_GAIN_5GHB][RF_PATH_A] -+ = KFREE_BB_GAIN_5G_TX_OFFSET(EFUSE_Read1Byte(Adapter, PPG_BB_GAIN_5GHB_TXA_OFFSET_8821A) & PPG_BB_GAIN_5G_TX_OFFSET_MASK); -+ kfree_data->thermal -+ = KFREE_THERMAL_OFFSET(EFUSE_Read1Byte(Adapter, PPG_THERMAL_OFFSET_8821A) & PPG_THERMAL_OFFSET_MASK); -+ } -+ -+ if (!AutoloadFail) { -+ if (GET_PG_KFREE_ON_8821A(PROMContent)) -+ kfree_data->flag |= KFREE_FLAG_ON; -+ if (GET_PG_KFREE_THERMAL_K_ON_8821A(PROMContent)) -+ kfree_data->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } else { -+ if (!kfree_data_is_bb_gain_empty(kfree_data)) -+ kfree_data->flag |= KFREE_FLAG_ON; -+ if (kfree_data->thermal != 0) -+ kfree_data->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } -+ -+ if (Adapter->registrypriv.RegRfKFreeEnable == 1) { -+ kfree_data->flag |= KFREE_FLAG_ON; -+ kfree_data->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } -+ -+ if (kfree_data->flag & KFREE_FLAG_THERMAL_K_ON) -+ pHalData->EEPROMThermalMeter += kfree_data->thermal; -+ -+ DBG_871X("kfree flag:0x%02x\n", kfree_data->flag); -+ if (Adapter->registrypriv.RegRfKFreeEnable || kfree_data->flag & KFREE_FLAG_ON) { -+ int i; -+ -+ DBG_871X_SEL_NL(RTW_DBGDUMP, "bb_gain:"); -+ for (i = 0; i < BB_GAIN_NUM; i++) -+ DBG_871X_SEL(RTW_DBGDUMP, "%d ", kfree_data->bb_gain[i][RF_PATH_A]); -+ DBG_871X_SEL(RTW_DBGDUMP, "\n"); -+ } -+ if (Adapter->registrypriv.RegRfKFreeEnable || kfree_data->flag & KFREE_FLAG_THERMAL_K_ON) -+ DBG_871X("thermal:%d\n", kfree_data->thermal); -+ -+#endif /*CONFIG_RF_GAIN_OFFSET */ -+} -+ +// +// 2013/04/15 MH Add 8812AU- VL/VS/VN for different board type. +// -+VOID ++void +hal_ReadUsbType_8812AU( -+ IN PADAPTER Adapter, -+ IN u8 *PROMContent, -+ IN BOOLEAN AutoloadFail ++ PADAPTER Adapter, ++ u8 *PROMContent, ++ bool AutoloadFail + ) +{ + //if (IS_HARDWARE_TYPE_8812AU(Adapter) && Adapter->UsbModeMechanism.RegForcedUsbMode == 5) @@ -273983,51 +113250,53 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); + u8 reg_tmp, i, j, antenna = 0, wmode = 0; + // Read anenna type from EFUSE 1019/1018 -+ for (i = 0; i < 2; i++) { -+ /* -+ Check efuse address 1019 -+ Check efuse address 1018 -+ */ -+ efuse_OneByteRead(Adapter, 1019-i, ®_tmp, _FALSE); -+ /* -+ CHeck bit 7-5 -+ Check bit 3-1 -+ */ -+ if (((reg_tmp>>5) & 0x7) != 0) { -+ antenna = ((reg_tmp>>5) & 0x7); -+ break; -+ } else if ((reg_tmp>>1 & 0x07) != 0) { -+ antenna = ((reg_tmp>>1) & 0x07); -+ break; -+ } -+ ++ for (i = 0; i < 2; i++) ++ { ++ // Check efuse address 1019 ++ // Check efuse address 1018 ++ efuse_OneByteRead(Adapter, 1019-i, ®_tmp, false); + ++ for (j = 0; j < 2; j++) ++ { ++ // CHeck bit 7-5 ++ // Check bit 3-1 ++ antenna = ((reg_tmp&0xee) >> (5-(j*4))); ++ if (antenna == 0) ++ continue; ++ else ++ { ++ break; ++ } ++ } + } + + // Read anenna type from EFUSE 1021/1020 -+ for (i = 0; i < 2; i++) { -+ /* -+ Check efuse address 1021 -+ Check efuse address 1020 -+ */ -+ efuse_OneByteRead(Adapter, 1021-i, ®_tmp, _FALSE); ++ for (i = 0; i < 2; i++) ++ { ++ // Check efuse address 1019 ++ // Check efuse address 1018 ++ efuse_OneByteRead(Adapter, 1021-i, ®_tmp, false); + -+ /* CHeck bit 3-2 */ -+ if (((reg_tmp>>2) & 0x3) != 0) { -+ wmode = ((reg_tmp>>2) & 0x3); -+ break; ++ for (j = 0; j < 2; j++) ++ { ++ // CHeck bit 3-2 ++ // Check bit 1-0 ++ wmode = ((reg_tmp&0x0f) >> (2-(j*2))); ++ if (wmode) ++ continue; ++ else ++ { ++ break; ++ } + } -+ -+ + } + -+ DBG_871X("%s: antenna=%d, wmode=%d\n", __func__, antenna, wmode); + // Antenna == 1 WMODE = 3 RTL8812AU-VL 11AC + USB2.0 Mode + if (antenna == 1) + { + // Config 8812AU as 1*1 mode AC mode. + pHalData->rf_type = RF_1T1R; -+ //UsbModeSwitch_SetUsbModeMechOn(Adapter, FALSE); ++ //UsbModeSwitch_SetUsbModeMechOn(Adapter, false); + //pHalData->EFUSEHidden = EFUSE_HIDDEN_812AU_VL; + DBG_871X("%s(): EFUSE_HIDDEN_812AU_VL\n",__FUNCTION__); + } @@ -274041,25 +113310,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + //pHalData->EFUSEHidden = EFUSE_HIDDEN_812AU; + DBG_871X("%s(): EFUSE_HIDDEN_812AU\n",__FUNCTION__); + } -+ else ++ else + { + // Antenna == 2 WMODE = 3 RTL8812AU-VS 11AC + USB2.0 Mode + // Driver will not support USB automatic switch -+ //UsbModeSwitch_SetUsbModeMechOn(Adapter, FALSE); ++ //UsbModeSwitch_SetUsbModeMechOn(Adapter, false); + //pHalData->EFUSEHidden = EFUSE_HIDDEN_812AU_VS; -+ DBG_871X("%s(): EFUSE_HIDDEN_8812AU_VS\n", __func__); ++ DBG_871X("%s(): EFUSE_HIDDEN_812AU_VS\n",__FUNCTION__); + } + } + else if (wmode == 2) + { + // Antenna == 2 WMODE = 2 RTL8812AU-VN 11N only + USB2.0 Mode -+ //UsbModeSwitch_SetUsbModeMechOn(Adapter, FALSE); ++ //UsbModeSwitch_SetUsbModeMechOn(Adapter, false); + //pHalData->EFUSEHidden = EFUSE_HIDDEN_812AU_VN; -+ DBG_871X("%s(): EFUSE_HIDDEN_8812AU_VN\n", __func__); -+ Adapter->registrypriv.vht_enable = 0; -+ ++ DBG_871X("%s(): EFUSE_HIDDEN_812AU_VN\n",__FUNCTION__); + } -+ } ++ } + } +} + @@ -274068,17 +113335,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + LDOE25_SHIFT = 28 , + }; + -+static VOID ++static void +Hal_EfusePowerSwitch8812A( -+ IN PADAPTER pAdapter, -+ IN u8 bWrite, -+ IN u8 PwrState) ++ PADAPTER pAdapter, ++ u8 bWrite, ++ u8 PwrState) +{ + u8 tempval; + u16 tmpV16; + #define EFUSE_ACCESS_ON_JAGUAR 0x69 + #define EFUSE_ACCESS_OFF_JAGUAR 0x00 -+ if (PwrState == _TRUE) ++ if (PwrState == true) + { + rtw_write8(pAdapter, REG_EFUSE_BURN_GNT_8812, EFUSE_ACCESS_ON_JAGUAR); + @@ -274103,7 +113370,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + rtw_write16(pAdapter,REG_SYS_CLKR,tmpV16); + } + -+ if(bWrite == _TRUE) ++ if(bWrite == true) + { + // Enable LDO 2.5V before read/write action + tempval = rtw_read8(pAdapter, EFUSE_TEST+3); @@ -274117,7 +113384,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + { + rtw_write8(pAdapter, REG_EFUSE_BURN_GNT_8812, EFUSE_ACCESS_OFF_JAGUAR); + -+ if(bWrite == _TRUE){ ++ if(bWrite == true){ + // Disable LDO 2.5V after read/write action + tempval = rtw_read8(pAdapter, EFUSE_TEST+3); + rtw_write8(pAdapter, EFUSE_TEST+3, (tempval & 0x7F)); @@ -274125,32 +113392,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + } +} + -+static VOID ++static void +rtl8812_EfusePowerSwitch( -+ IN PADAPTER pAdapter, -+ IN u8 bWrite, -+ IN u8 PwrState) ++ PADAPTER pAdapter, ++ u8 bWrite, ++ u8 PwrState) +{ -+ Hal_EfusePowerSwitch8812A(pAdapter, bWrite, PwrState); ++ Hal_EfusePowerSwitch8812A(pAdapter, bWrite, PwrState); +} + -+static BOOLEAN ++static bool +Hal_EfuseSwitchToBank8812A( -+ IN PADAPTER pAdapter, -+ IN u1Byte bank, -+ IN BOOLEAN bPseudoTest ++ PADAPTER pAdapter, ++ u1Byte bank, ++ bool bPseudoTest + ) +{ -+ return _FALSE; ++ return false; +} + -+static VOID ++static void +Hal_EfuseReadEFuse8812A( + PADAPTER Adapter, + u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ IN BOOLEAN bPseudoTest ++ u16 _size_byte, ++ u8 *pbuf, ++ bool bPseudoTest + ) +{ + u8 *efuseTbl = NULL; @@ -274179,7 +113446,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + goto exit; + } + -+ eFuseWord= (u16 **)rtw_malloc2d(EFUSE_MAX_SECTION_JAGUAR, EFUSE_MAX_WORD_UNIT, 2); ++ eFuseWord= (u16 **)rtw_malloc2d(EFUSE_MAX_SECTION_JAGUAR, EFUSE_MAX_WORD_UNIT, sizeof(u16)); + if(eFuseWord == NULL) + { + DBG_871X("%s: alloc eFuseWord fail!\n", __FUNCTION__); @@ -274193,9 +113460,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + // + // 1. Read the first byte to check if efuse is empty!!! -+ // + // -+ efuse_OneByteRead(Adapter, eFuse_Addr++, &efuseHeader, bPseudoTest); ++ // ++ efuse_OneByteRead(Adapter, eFuse_Addr++, &efuseHeader, bPseudoTest); + + if(efuseHeader != 0xFF) + { @@ -274215,14 +113482,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + while((efuseHeader != 0xFF) && AVAILABLE_EFUSE_ADDR_8812(eFuse_Addr)) + { + //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("efuse_Addr-%d efuse_data=%x\n", eFuse_Addr-1, *rtemp8)); -+ ++ + // Check PG header for section num. + if(EXT_HEADER(efuseHeader)) //extended header + { + offset_2_0 = GET_HDR_OFFSET_2_0(efuseHeader); + //RT_DISP(FEEPROM, EFUSE_READ_ALL, ("extended header offset_2_0=%X\n", offset_2_0)); + -+ efuse_OneByteRead(Adapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); ++ efuse_OneByteRead(Adapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); + + //RT_DISP(FEEPROM, EFUSE_READ_ALL, ("efuse[%X]=%X\n", eFuse_Addr-1, efuseExtHdr)); + @@ -274256,7 +113523,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + offset = ((efuseHeader >> 4) & 0x0f); + wden = (efuseHeader & 0x0f); + } -+ ++ + if(offset < EFUSE_MAX_SECTION_JAGUAR) + { + // Get word enable value from PG header @@ -274264,7 +113531,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + for(i=0; ieeprompriv.efuse_eeprom_data, 0x130) == false) ++ { ++ int i; ++ DBG_871X("%s compare first 0x130 byte fail\n", __FUNCTION__); ++ for(i=0;i<512;i++) ++ { ++ if(i%16==0) ++ DBG_871X("0x%03x: ", i); ++ DBG_871X("%02x ", logical_map[i]); ++ if(i%16==15) ++ DBG_871X("\n"); ++ } ++ DBG_871X("\n"); ++ } ++#endif +} + +//Do not support BT -+VOID ++void +Hal_EFUSEGetEfuseDefinition8812A( -+ IN PADAPTER pAdapter, -+ IN u1Byte efuseType, -+ IN u1Byte type, -+ OUT PVOID pOut ++ PADAPTER pAdapter, ++ u1Byte efuseType, ++ u1Byte type, ++ void * pOut + ) +{ + switch(type) @@ -274429,12 +113725,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + break; + } +} -+VOID ++void +Hal_EFUSEGetEfuseDefinition_Pseudo8812A( -+ IN PADAPTER pAdapter, -+ IN u8 efuseType, -+ IN u8 type, -+ OUT PVOID pOut ++ PADAPTER pAdapter, ++ u8 efuseType, ++ u8 type, ++ void * pOut + ) +{ + switch(type) @@ -274499,13 +113795,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +} + + -+static VOID ++static void +rtl8812_EFUSE_GetEfuseDefinition( -+ IN PADAPTER pAdapter, -+ IN u8 efuseType, -+ IN u8 type, -+ OUT void *pOut, -+ IN BOOLEAN bPseudoTest ++ PADAPTER pAdapter, ++ u8 efuseType, ++ u8 type, ++ void *pOut, ++ bool bPseudoTest + ) +{ + if(bPseudoTest) @@ -274519,18 +113815,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +} + +static u8 -+Hal_EfuseWordEnableDataWrite8812A( IN PADAPTER pAdapter, -+ IN u16 efuse_addr, -+ IN u8 word_en, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) ++Hal_EfuseWordEnableDataWrite8812A(PADAPTER pAdapter, ++ u16 efuse_addr, ++ u8 word_en, ++ u8 *data, ++ bool bPseudoTest) +{ + u16 tmpaddr = 0; + u16 start_addr = efuse_addr; + u8 badworden = 0x0F; + u8 tmpdata[8]; + -+ _rtw_memset((PVOID)tmpdata, 0xff, PGPKT_DATA_SIZE); ++ _rtw_memset((void *)tmpdata, 0xff, PGPKT_DATA_SIZE); + //RT_TRACE(COMP_EFUSE, DBG_LOUD, ("word_en = %x efuse_addr=%x\n", word_en, efuse_addr)); + + if(!(word_en&BIT0)) @@ -274585,11 +113881,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +} + +static u8 -+rtl8812_Efuse_WordEnableDataWrite( IN PADAPTER pAdapter, -+ IN u16 efuse_addr, -+ IN u8 word_en, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) ++rtl8812_Efuse_WordEnableDataWrite(PADAPTER pAdapter, ++ u16 efuse_addr, ++ u8 word_en, ++ u8 *data, ++ bool bPseudoTest) +{ + u8 ret=0; + @@ -274600,10 +113896,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + +static u16 -+hal_EfuseGetCurrentSize_8812A(IN PADAPTER pAdapter, -+ IN BOOLEAN bPseudoTest) ++hal_EfuseGetCurrentSize_8812A(PADAPTER pAdapter, ++ bool bPseudoTest) +{ -+ int bContinual = _TRUE; ++ int bContinual = true; + + u16 efuse_addr = 0; + u8 hoffset=0,hworden=0; @@ -274652,7 +113948,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + } + else + { -+ bContinual = _FALSE ; ++ bContinual = false ; + } + } + @@ -274672,9 +113968,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + +static u16 +rtl8812_EfuseGetCurrentSize( -+ IN PADAPTER pAdapter, -+ IN u8 efuseType, -+ IN BOOLEAN bPseudoTest) ++ PADAPTER pAdapter, ++ u8 efuseType, ++ bool bPseudoTest) +{ + u16 ret=0; + @@ -274686,15 +113982,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + +static int +hal_EfusePgPacketRead_8812A( -+ IN PADAPTER pAdapter, -+ IN u8 offset, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) ++ PADAPTER pAdapter, ++ u8 offset, ++ u8 *data, ++ bool bPseudoTest) +{ + u8 ReadState = PG_STATE_HEADER; + -+ int bContinual = _TRUE; -+ int bDataEmpty = _TRUE ; ++ int bContinual = true; ++ int bDataEmpty = true ; + + u8 efuse_data,word_cnts = 0; + u16 efuse_addr = 0; @@ -274705,12 +114001,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + u8 tmp_header = 0; + + if(data==NULL) -+ return _FALSE; ++ return false; + if(offset>EFUSE_MAX_SECTION_JAGUAR) -+ return _FALSE; ++ return false; + -+ _rtw_memset((PVOID)data, 0xff, sizeof(u8)*PGPKT_DATA_SIZE); -+ _rtw_memset((PVOID)tmpdata, 0xff, sizeof(u8)*PGPKT_DATA_SIZE); ++ _rtw_memset((void *)data, 0xff, sizeof(u8)*PGPKT_DATA_SIZE); ++ _rtw_memset((void *)tmpdata, 0xff, sizeof(u8)*PGPKT_DATA_SIZE); + + + // @@ -274748,7 +114044,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + hworden = efuse_data & 0x0F; + } + word_cnts = Efuse_CalculateWordCnts(hworden); -+ bDataEmpty = _TRUE ; ++ bDataEmpty = true ; + + if(hoffset==offset) + { @@ -274759,11 +114055,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + tmpdata[tmpidx] = efuse_data; + if(efuse_data!=0xff) + { -+ bDataEmpty = _FALSE; ++ bDataEmpty = false; + } + } + } -+ if(bDataEmpty==_FALSE){ ++ if(bDataEmpty==false){ + ReadState = PG_STATE_DATA; + }else{//read next header + efuse_addr = efuse_addr + (word_cnts*2)+1; @@ -274777,7 +114073,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + } + else{ -+ bContinual = _FALSE ; ++ bContinual = false ; + } + } + //------- Data section Read ------------- @@ -274792,17 +114088,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + if( (data[0]==0xff) &&(data[1]==0xff) && (data[2]==0xff) && (data[3]==0xff) && + (data[4]==0xff) &&(data[5]==0xff) && (data[6]==0xff) && (data[7]==0xff)) -+ return _FALSE; ++ return false; + else -+ return _TRUE; ++ return true; + +} + +static int -+rtl8812_Efuse_PgPacketRead( IN PADAPTER pAdapter, -+ IN u8 offset, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) ++rtl8812_Efuse_PgPacketRead( PADAPTER pAdapter, ++ u8 offset, ++ u8 *data, ++ bool bPseudoTest) +{ + int ret=0; + @@ -274812,16 +114108,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +} + +int -+hal_EfusePgPacketWrite_8812A(IN PADAPTER pAdapter, -+ IN u8 offset, -+ IN u8 word_en, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) ++hal_EfusePgPacketWrite_8812A(PADAPTER pAdapter, ++ u8 offset, ++ u8 word_en, ++ u8 *data, ++ bool bPseudoTest) +{ -+ u8 WriteState = PG_STATE_HEADER; ++ u8 WriteState = PG_STATE_HEADER; + -+ int bContinual = _TRUE,bDataEmpty=_TRUE; -+ //int bResult = _TRUE; ++ int bContinual = true,bDataEmpty=true; ++ //int bResult = true; + u16 efuse_addr = 0; + u8 efuse_data; + @@ -274830,17 +114126,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + u8 tmp_word_cnts=0,target_word_cnts=0; + u8 tmp_header,match_word_en,tmp_word_en; + -+ PGPKT_STRUCT target_pkt; ++ PGPKT_STRUCT target_pkt; + PGPKT_STRUCT tmp_pkt; -+ ++ + u8 originaldata[sizeof(u8)*8]; + u8 tmpindex = 0,badworden = 0x0F; + + static int repeat_times = 0; + -+ BOOLEAN bExtendedHeader = _FALSE; ++ bool bExtendedHeader = false; + u8 efuseType=EFUSE_WIFI; -+ ++ + // + // Efuse has been pre-programmed dummy 5Bytes at the end of Efuse by CP. + // So we have to prevent unexpected data string connection, which will cause @@ -274851,7 +114147,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + if( Efuse_GetCurrentSize(pAdapter, efuseType, bPseudoTest) >= (EFUSE_REAL_CONTENT_LEN_JAGUAR-EFUSE_OOB_PROTECT_BYTES_JAGUAR)) + { + DBG_871X("hal_EfusePgPacketWrite_8812A() error: %x >= %x\n", Efuse_GetCurrentSize(pAdapter, efuseType, bPseudoTest), (EFUSE_REAL_CONTENT_LEN_JAGUAR-EFUSE_OOB_PROTECT_BYTES_JAGUAR)); -+ return _FALSE; ++ return false; + } + + // Init the 8 bytes content as 0xff @@ -274863,12 +114159,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + //DBG_871X("hal_EfusePgPacketWrite_8812A target offset 0x%x word_en 0x%x \n", target_pkt.offset, target_pkt.word_en); + -+ _rtw_memset((PVOID)target_pkt.data, 0xFF, sizeof(u8)*8); -+ ++ _rtw_memset((void *)target_pkt.data, 0xFF, sizeof(u8)*8); ++ + efuse_WordEnableDataRead(word_en, data, target_pkt.data); + target_word_cnts = Efuse_CalculateWordCnts(target_pkt.word_en); + -+ //efuse_reg_ctrl(pAdapter,_TRUE);//power on ++ //efuse_reg_ctrl(pAdapter,true);//power on + //DBG_871X("EFUSE Power ON\n"); + + // @@ -274880,14 +114176,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + while( bContinual && (efuse_addr < (EFUSE_REAL_CONTENT_LEN_JAGUAR-EFUSE_OOB_PROTECT_BYTES_JAGUAR)) ) + { + if(WriteState==PG_STATE_HEADER) -+ { -+ bDataEmpty=_TRUE; -+ badworden = 0x0F; ++ { ++ bDataEmpty=true; ++ badworden = 0x0F; + //************ so ******************* + //DBG_871X("EFUSE PG_STATE_HEADER\n"); + if ( efuse_OneByteRead(pAdapter, efuse_addr ,&efuse_data, bPseudoTest) && + (efuse_data!=0xFF)) -+ { ++ { + if((efuse_data&0x1F) == 0x0F) //extended header + { + tmp_header = efuse_data; @@ -274895,7 +114191,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + efuse_OneByteRead(pAdapter, efuse_addr ,&efuse_data, bPseudoTest); + if((efuse_data & 0x0F) == 0x0F) //wren fail + { -+ u8 next = 0, next_next = 0, data = 0, i = 0; ++ u8 next = 0, next_next = 0, data = 0, i = 0; + u8 s = ((tmp_header & 0xF0) >> 4); + efuse_OneByteRead(pAdapter, efuse_addr+1, &next, bPseudoTest); + efuse_OneByteRead(pAdapter, efuse_addr+2, &next_next, bPseudoTest); @@ -274913,7 +114209,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + efuse_OneByteRead(pAdapter, efuse_addr, &data, bPseudoTest); + if (data == 0x27) + break; -+ } ++ } + break; + case 0xE: + for (i = 0; i < 3; ++i) { @@ -274921,15 +114217,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + efuse_OneByteRead(pAdapter, efuse_addr, &data, bPseudoTest); + if (data == 0x17) + break; -+ } ++ } + break; + default: + break; + } + efuse_OneByteWrite(pAdapter, efuse_addr+1, 0xFF, bPseudoTest); -+ efuse_OneByteWrite(pAdapter, efuse_addr+2, 0xFF, bPseudoTest); ++ efuse_OneByteWrite(pAdapter, efuse_addr+2, 0xFF, bPseudoTest); + efuse_addr += 3; -+ } else { ++ } else { + efuse_addr++; + } + continue; @@ -274941,12 +114237,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + } + } + else -+ { ++ { + u8 i = 0, data = 0; -+ tmp_header = efuse_data; ++ tmp_header = efuse_data; + tmp_pkt.offset = (tmp_header>>4) & 0x0F; -+ tmp_pkt.word_en = tmp_header & 0x0F; -+ ++ tmp_pkt.word_en = tmp_header & 0x0F; ++ + if (tmp_pkt.word_en == 0xF) { + u8 next = 0; + efuse_OneByteRead(pAdapter, efuse_addr+1, &next, bPseudoTest); @@ -274957,10 +114253,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + efuse_OneByteRead(pAdapter, efuse_addr, &data, bPseudoTest); + if (data == tmp_header) + break; -+ } ++ } + efuse_OneByteWrite(pAdapter, efuse_addr+1, 0xFF, bPseudoTest); + efuse_OneByteWrite(pAdapter, efuse_addr+2, 0xFF, bPseudoTest); -+ efuse_addr += 2; ++ efuse_addr += 2; + } + } + } @@ -274977,21 +114273,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +#endif + } + else //write the same offset -+ { ++ { + //DBG_871X("hal_EfusePgPacketWrite_8812A section offset the same\n"); + //************ so-2 ******************* + for(tmpindex=0 ; tmpindex<(tmp_word_cnts*2) ; tmpindex++) + { + if(efuse_OneByteRead(pAdapter, (efuse_addr+1+tmpindex) ,&efuse_data, bPseudoTest)&&(efuse_data != 0xFF)){ -+ bDataEmpty = _FALSE; ++ bDataEmpty = false; + } -+ } ++ } + //************ so-2-1 ******************* -+ if(bDataEmpty == _FALSE) -+ { ++ if(bDataEmpty == false) ++ { + //DBG_871X("hal_EfusePgPacketWrite_8812A section offset the same and data is NOT empty\n"); -+ -+ efuse_addr = efuse_addr + (tmp_word_cnts*2) +1; //Next pg_packet ++ ++ efuse_addr = efuse_addr + (tmp_word_cnts*2) +1; //Next pg_packet +#if (EFUSE_ERROE_HANDLE == 1) + WriteState=PG_STATE_HEADER; +#endif @@ -275003,7 +114299,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + if( !( (target_pkt.word_en&BIT0)|(tmp_pkt.word_en&BIT0) )) + { + match_word_en &= (~BIT0); -+ } ++ } + if( !( (target_pkt.word_en&BIT1)|(tmp_pkt.word_en&BIT1) )) + { + match_word_en &= (~BIT1); @@ -275015,24 +114311,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + if( !( (target_pkt.word_en&BIT3)|(tmp_pkt.word_en&BIT3) )) + { + match_word_en &= (~BIT3); -+ } -+ ++ } ++ + //************ so-2-2-A ******************* + if((match_word_en&0x0F)!=0x0F) -+ { ++ { + badworden = Efuse_WordEnableDataWrite(pAdapter,efuse_addr+1, tmp_pkt.word_en ,target_pkt.data, bPseudoTest); -+ ++ + //************ so-2-2-A-1 ******************* + //############################ + if(0x0F != (badworden&0x0F)) -+ { ++ { + u8 reorg_offset = offset; -+ u8 reorg_worden=badworden; -+ Efuse_PgPacketWrite(pAdapter, reorg_offset, reorg_worden, target_pkt.data, bPseudoTest); -+ } -+ //############################ ++ u8 reorg_worden=badworden; ++ Efuse_PgPacketWrite(pAdapter, reorg_offset, reorg_worden, target_pkt.data, bPseudoTest); ++ } ++ //############################ + -+ tmp_word_en = 0x0F; //not the same bit as original wren ++ tmp_word_en = 0x0F; //not the same bit as original wren + if( (target_pkt.word_en&BIT0)^(match_word_en&BIT0) ) + { + tmp_word_en &= (~BIT0); @@ -275044,52 +114340,52 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + if( (target_pkt.word_en&BIT2)^(match_word_en&BIT2) ) + { + tmp_word_en &= (~BIT2); -+ } ++ } + if( (target_pkt.word_en&BIT3)^(match_word_en&BIT3) ) + { + tmp_word_en &=(~BIT3); -+ } -+ -+ //************ so-2-2-A-2 ******************* ++ } ++ ++ //************ so-2-2-A-2 ******************* + if((tmp_word_en&0x0F)!=0x0F){ -+ //reorganize other pg packet -+// efuse_addr = efuse_addr + (2*tmp_word_cnts) +1;//next pg packet addr ++ //reorganize other pg packet ++// efuse_addr = efuse_addr + (2*tmp_word_cnts) +1;//next pg packet addr + efuse_addr = Efuse_GetCurrentSize(pAdapter, efuseType, bPseudoTest); + //=========================== + target_pkt.offset = offset; -+ target_pkt.word_en= tmp_word_en; ++ target_pkt.word_en= tmp_word_en; + //=========================== -+ }else{ -+ bContinual = _FALSE; ++ }else{ ++ bContinual = false; + } +#if (EFUSE_ERROE_HANDLE == 1) + WriteState=PG_STATE_HEADER; + repeat_times++; + if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = _FALSE; -+ //bResult = _FALSE; ++ bContinual = false; ++ //bResult = false; + } +#endif + } + else{//************ so-2-2-B ******************* -+ //reorganize other pg packet -+ efuse_addr = efuse_addr + (2*tmp_word_cnts) +1;//next pg packet addr ++ //reorganize other pg packet ++ efuse_addr = efuse_addr + (2*tmp_word_cnts) +1;//next pg packet addr + //=========================== + target_pkt.offset = offset; -+ //target_pkt.word_en= target_pkt.word_en; -+ //=========================== ++ target_pkt.word_en= target_pkt.word_en; ++ //=========================== +#if (EFUSE_ERROE_HANDLE == 1) + WriteState=PG_STATE_HEADER; +#endif -+ } -+ } -+ } ++ } ++ } ++ } + DBG_871X("EFUSE PG_STATE_HEADER-1\n"); + } + else //************ s1: header == oxff ******************* + { -+ bExtendedHeader = _FALSE; -+ ++ bExtendedHeader = false; ++ + if(target_pkt.offset >= EFUSE_MAX_SECTION_BASE) + { + pg_header = ((target_pkt.offset &0x07) << 5) | 0x0F; @@ -275100,21 +114396,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + efuse_OneByteRead(pAdapter,efuse_addr, &tmp_header, bPseudoTest); + + while(tmp_header == 0xFF) -+ { ++ { + //DBG_871X("hal_EfusePgPacketWrite_8812A extended pg_header[2:0] wirte fail \n"); + -+ repeat_times++; -+ ++ repeat_times++; ++ + if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = _FALSE; -+ //bResult = _FALSE; ++ bContinual = false; ++ //bResult = false; + efuse_addr++; + break; -+ } ++ } + efuse_OneByteWrite(pAdapter,efuse_addr, pg_header, bPseudoTest); -+ efuse_OneByteRead(pAdapter,efuse_addr, &tmp_header, bPseudoTest); ++ efuse_OneByteRead(pAdapter,efuse_addr, &tmp_header, bPseudoTest); + } -+ ++ + if(!bContinual) + break; + @@ -275130,14 +114426,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + efuse_OneByteRead(pAdapter,efuse_addr, &tmp_header, bPseudoTest); + + while(tmp_header == 0xFF) -+ { -+ repeat_times++; ++ { ++ repeat_times++; + + if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = _FALSE; -+ //bResult = _FALSE; ++ bContinual = false; ++ //bResult = false; + break; -+ } ++ } + efuse_OneByteWrite(pAdapter,efuse_addr, pg_header, bPseudoTest); + efuse_OneByteRead(pAdapter,efuse_addr, &tmp_header, bPseudoTest); + } @@ -275147,31 +114443,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + if((tmp_header & 0x0F) == 0x0F) //wren PG fail + { -+ repeat_times++; ++ repeat_times++; + + if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = _FALSE; -+ //bResult = _FALSE; ++ bContinual = false; ++ //bResult = false; + break; -+ } ++ } + else + { + efuse_addr++; + continue; + } + } -+ else if(pg_header != tmp_header) //offset PG fail ++ else if(pg_header != tmp_header) //offset PG fail + { -+ bExtendedHeader = _TRUE; ++ bExtendedHeader = true; + tmp_pkt.offset = ((pg_header_temp & 0xE0) >> 5) | ((tmp_header & 0xF0) >> 1); -+ tmp_pkt.word_en= tmp_header & 0x0F; -+ tmp_word_cnts = Efuse_CalculateWordCnts(tmp_pkt.word_en); ++ tmp_pkt.word_en= tmp_header & 0x0F; ++ tmp_word_cnts = Efuse_CalculateWordCnts(tmp_pkt.word_en); + } + } + else if ((tmp_header & 0x1F) == 0x0F) //wrong extended header + { + efuse_addr+=2; -+ continue; ++ continue; + } + } + else @@ -275180,49 +114476,49 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + efuse_OneByteWrite(pAdapter,efuse_addr, pg_header, bPseudoTest); + efuse_OneByteRead(pAdapter,efuse_addr, &tmp_header, bPseudoTest); + } -+ ++ + if(tmp_header == pg_header) -+ { //************ s1-1******************* -+ WriteState = PG_STATE_DATA; -+ } ++ { //************ s1-1******************* ++ WriteState = PG_STATE_DATA; ++ } +#if (EFUSE_ERROE_HANDLE == 1) -+ else if(tmp_header == 0xFF){//************ s1-3: if Write or read func doesn't work ******************* ++ else if(tmp_header == 0xFF){//************ s1-3: if Write or read func doesn't work ******************* + //efuse_addr doesn't change -+ WriteState = PG_STATE_HEADER; ++ WriteState = PG_STATE_HEADER; + repeat_times++; + if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = _FALSE; -+ //bResult = _FALSE; ++ bContinual = false; ++ //bResult = false; + } + } +#endif + else -+ {//************ s1-2 : fixed the header procedure ******************* ++ {//************ s1-2 : fixed the header procedure ******************* + if(!bExtendedHeader) + { + tmp_pkt.offset = (tmp_header>>4) & 0x0F; -+ tmp_pkt.word_en= tmp_header & 0x0F; ++ tmp_pkt.word_en= tmp_header & 0x0F; + tmp_word_cnts = Efuse_CalculateWordCnts(tmp_pkt.word_en); + } -+ ++ + //************ s1-2-A :cover the exist data ******************* + _rtw_memset(originaldata, 0xff, sizeof(u8)*8); -+ ++ + if(Efuse_PgPacketRead( pAdapter, tmp_pkt.offset,originaldata, bPseudoTest)) -+ { //check if data exist -+ //efuse_reg_ctrl(pAdapter,_TRUE);//power on ++ { //check if data exist ++ //efuse_reg_ctrl(pAdapter,true);//power on + badworden = Efuse_WordEnableDataWrite(pAdapter,efuse_addr+1,tmp_pkt.word_en,originaldata, bPseudoTest); + //############################ + if(0x0F != (badworden&0x0F)) -+ { ++ { + u8 reorg_offset = tmp_pkt.offset; -+ u8 reorg_worden=badworden; -+ Efuse_PgPacketWrite(pAdapter,reorg_offset,reorg_worden,originaldata, bPseudoTest); ++ u8 reorg_worden=badworden; ++ Efuse_PgPacketWrite(pAdapter,reorg_offset,reorg_worden,originaldata, bPseudoTest); + efuse_addr = Efuse_GetCurrentSize(pAdapter, efuseType, bPseudoTest); + } + //############################ + else{ -+ efuse_addr = efuse_addr + (tmp_word_cnts*2) +1; //Next pg_packet ++ efuse_addr = efuse_addr + (tmp_word_cnts*2) +1; //Next pg_packet + } + } + //************ s1-2-B: wrong address******************* @@ -275232,11 +114528,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + } + +#if (EFUSE_ERROE_HANDLE == 1) -+ WriteState=PG_STATE_HEADER; ++ WriteState=PG_STATE_HEADER; + repeat_times++; + if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = _FALSE; -+ //bResult = _FALSE; ++ bContinual = false; ++ //bResult = false; + } +#endif + @@ -275247,30 +114543,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + } + //write data state -+ else if(WriteState==PG_STATE_DATA) ++ else if(WriteState==PG_STATE_DATA) + { //************ s1-1 ******************* + //DBG_871X("EFUSE PG_STATE_DATA\n"); + badworden = 0x0f; -+ badworden = Efuse_WordEnableDataWrite(pAdapter,efuse_addr+1,target_pkt.word_en,target_pkt.data, bPseudoTest); ++ badworden = Efuse_WordEnableDataWrite(pAdapter,efuse_addr+1,target_pkt.word_en,target_pkt.data, bPseudoTest); + if((badworden&0x0F)==0x0F) + { //************ s1-1-A ******************* -+ bContinual = _FALSE; ++ bContinual = false; + } + else + {//reorganize other pg packet //************ s1-1-B ******************* + efuse_addr = efuse_addr + (2*target_word_cnts) +1;//next pg packet addr -+ ++ + //=========================== + target_pkt.offset = offset; -+ target_pkt.word_en= badworden; ++ target_pkt.word_en= badworden; + target_word_cnts = Efuse_CalculateWordCnts(target_pkt.word_en); -+ //=========================== ++ //=========================== +#if (EFUSE_ERROE_HANDLE == 1) -+ WriteState=PG_STATE_HEADER; ++ WriteState=PG_STATE_HEADER; + repeat_times++; + if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = _FALSE; -+ //bResult = _FALSE; ++ bContinual = false; ++ //bResult = false; + } +#endif + //DBG_871X("EFUSE PG_STATE_HEADER-3\n"); @@ -275282,17 +114578,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + { + DBG_871X("hal_EfusePgPacketWrite_8812A(): efuse_addr(%#x) Out of size!!\n", efuse_addr); + } -+ //efuse_reg_ctrl(pAdapter,_FALSE);//power off -+ -+ return _TRUE; ++ //efuse_reg_ctrl(pAdapter,false);//power off ++ ++ return true; +} + +static int -+rtl8812_Efuse_PgPacketWrite(IN PADAPTER pAdapter, -+ IN u8 offset, -+ IN u8 word_en, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) ++rtl8812_Efuse_PgPacketWrite(PADAPTER pAdapter, ++ u8 offset, ++ u8 word_en, ++ u8 *data, ++ bool bPseudoTest) +{ + int ret; + @@ -275301,6 +114597,128 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + return ret; +} + ++#ifdef CONFIG_EFUSE_CONFIG_FILE ++static s32 _halReadPGDataFromFile(PADAPTER padapter, u8 *pbuf) ++{ ++ u32 i; ++ struct file *fp; ++ mm_segment_t fs; ++ u8 temp[3]; ++ loff_t pos = 0; ++ ++ ++ temp[2] = 0; // add end of string '\0' ++ ++ DBG_8192C("%s: Read Efuse from file [%s]\n", __FUNCTION__, EFUSE_FILE_PATH); ++ fp = filp_open(EFUSE_FILE_PATH, O_RDONLY, 0); ++ if (IS_ERR(fp)) { ++ DBG_8192C("%s: Error, Read Efuse configure file FAIL!\n", __FUNCTION__); ++ pEEPROM->bloadfile_fail_flag = true; ++ return _FAIL; ++ } ++ ++ fs = get_fs(); ++ set_fs(KERNEL_DS); ++ for (i=0; ibloadfile_fail_flag = false; ++ return _SUCCESS; ++} ++ ++static s32 _halReadMACAddrFromFile(PADAPTER padapter, u8 *pbuf) ++{ ++ struct file *fp; ++ mm_segment_t fs; ++ loff_t pos = 0; ++ u8 source_addr[18]; ++ u8 *head, *end; ++ u32 curtime; ++ u32 i; ++ s32 ret = _SUCCESS; ++ ++ u8 null_mac_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; ++ u8 multi_mac_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ ++ curtime = rtw_get_current_time(); ++ ++ _rtw_memset(source_addr, 0, 18); ++ _rtw_memset(pbuf, 0, ETH_ALEN); ++ ++ fp = filp_open(MAC_ADDRESS_FILE_PATH, O_RDONLY, 0); ++ if (IS_ERR(fp)) ++ { ++ ret = _FAIL; ++ DBG_8192C("%s: Error, Read MAC address file FAIL!\n", __FUNCTION__); ++ } ++ else ++ { ++ fs = get_fs(); ++ set_fs(KERNEL_DS); ++ ++ vfs_read(fp, source_addr, 18, &pos); ++ source_addr[17] = ':'; ++ ++ head = end = source_addr; ++ for (i=0; i>8) & 0xff) ; ++ pbuf[5] = (u8)((curtime>>16) & 0xff) ; ++ } ++ ++ DBG_8192C("%s: Permanent Address = " MAC_FMT "\n", __FUNCTION__, MAC_ARG(pbuf)); ++ ++ return ret; ++} ++#endif // CONFIG_EFUSE_CONFIG_FILE ++ +void InitRDGSetting8812A(PADAPTER padapter) +{ + rtw_write8(padapter, REG_RD_CTRL, 0xFF); @@ -275319,13 +114737,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +#endif + + //if (pHalData->rf_type == RF_1T1R){ -+ // pHalData->bRFPathRxEnable[0] = _TRUE; ++ // pHalData->bRFPathRxEnable[0] = true; + //} + //else { // Default unknow type is 2T2r -+ // pHalData->bRFPathRxEnable[0] = pHalData->bRFPathRxEnable[1] = _TRUE; ++ // pHalData->bRFPathRxEnable[0] = pHalData->bRFPathRxEnable[1] = true; + //} + -+ if (IsSupported24G(padapter->registrypriv.wireless_mode) && ++ if (IsSupported24G(padapter->registrypriv.wireless_mode) && + IsSupported5G(padapter->registrypriv.wireless_mode)) + pHalData->BandSet = BAND_ON_BOTH; + else if (IsSupported5G(padapter->registrypriv.wireless_mode)) @@ -275337,6 +114755,66 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + // pHalData->BandSet = BAND_ON_2_4G; +} + ++void rtl8812_GetHalODMVar( ++ PADAPTER Adapter, ++ HAL_ODM_VARIABLE eVariable, ++ void * pValue1, ++ bool bSet) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T podmpriv = &pHalData->odmpriv; ++ switch(eVariable){ ++ case HAL_ODM_STA_INFO: ++ break; ++ default: ++ break; ++ } ++} ++ ++void rtl8812_SetHalODMVar( ++ PADAPTER Adapter, ++ HAL_ODM_VARIABLE eVariable, ++ void * pValue1, ++ bool bSet) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ PDM_ODM_T podmpriv = &pHalData->odmpriv; ++ //_irqL irqL; ++ switch(eVariable){ ++ case HAL_ODM_STA_INFO: ++ { ++ struct sta_info *psta = (struct sta_info *)pValue1; ++ if(bSet){ ++ DBG_8192C("### Set STA_(%d) info\n",psta->mac_id); ++ ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS,psta->mac_id,psta); ++ #if(RATE_ADAPTIVE_SUPPORT==1) ++ ODM_RAInfo_Init(podmpriv,psta->mac_id); ++ #endif ++ } ++ else{ ++ DBG_8192C("### Clean STA_(%d) info\n",psta->mac_id); ++ //_enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); ++ ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS,psta->mac_id,NULL); ++ ++ //_exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); ++ } ++ } ++ break; ++ case HAL_ODM_P2P_STATE: ++ ODM_CmnInfoUpdate(podmpriv,ODM_CMNINFO_WIFI_DIRECT,bSet); ++ break; ++ case HAL_ODM_WIFI_DISPLAY_STATE: ++ ODM_CmnInfoUpdate(podmpriv,ODM_CMNINFO_WIFI_DISPLAY,bSet); ++ break; ++ default: ++ break; ++ } ++} ++ ++void rtl8812_clone_haldata(_adapter* dst_adapter, _adapter* src_adapter) ++{ ++ _rtw_memcpy(dst_adapter->HalData, src_adapter->HalData, dst_adapter->hal_data_sz); ++} + +void rtl8812_start_thread(PADAPTER padapter) +{ @@ -275359,7 +114837,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + +u8 +GetEEPROMSize8812A( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + u8 size = 0; @@ -275367,7 +114845,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + curRCR = rtw_read16(Adapter, REG_SYS_EEPROM_CTRL); + size = (curRCR & EEPROMSEL) ? 6 : 4; // 6: EEPROM used is 93C46, 4: boot from E-Fuse. -+ ++ + DBG_871X("EEPROM type is %s\n", size==4 ? "E-FUSE" : "93C46"); + //return size; + return 4; // <20120713, Kordan> The default value of HW is 6 ?!! @@ -275375,27 +114853,51 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + +void CheckAutoloadState8812A(PADAPTER padapter) +{ ++ PEEPROM_EFUSE_PRIV pEEPROM; + u8 val8; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); ++ ++ ++ pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); + + /* check system boot selection */ + val8 = rtw_read8(padapter, REG_9346CR); -+ pHalData->EepromOrEfuse = (val8 & BOOT_FROM_EEPROM) ? _TRUE : _FALSE; -+ pHalData->bautoload_fail_flag = (val8 & EEPROM_EN) ? _FALSE : _TRUE; ++ pEEPROM->EepromOrEfuse = (val8 & BOOT_FROM_EEPROM) ? true : false; ++ pEEPROM->bautoload_fail_flag = (val8 & EEPROM_EN) ? false : true; + + DBG_8192C("%s: 9346CR(%#x)=0x%02x, Boot from %s, Autoload %s!\n", + __FUNCTION__, REG_9346CR, val8, -+ (pHalData->EepromOrEfuse ? "EEPROM" : "EFUSE"), -+ (pHalData->bautoload_fail_flag ? "Fail" : "OK")); ++ (pEEPROM->EepromOrEfuse ? "EEPROM" : "EFUSE"), ++ (pEEPROM->bautoload_fail_flag ? "Fail" : "OK")); +} + +void InitPGData8812A(PADAPTER padapter) -+{ ++{ ++ PEEPROM_EFUSE_PRIV pEEPROM; + u32 i; + u16 val16; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); + -+ if (_FALSE == pHalData->bautoload_fail_flag) ++ ++ pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); ++ ++#ifdef CONFIG_EFUSE_CONFIG_FILE ++ { ++ s32 tmp; ++ u32 addr; ++ ++ tmp = _halReadPGDataFromFile(padapter, pEEPROM->efuse_eeprom_data); ++ pEEPROM->bloadfile_fail_flag = ((tmp==_FAIL) ? true : false); ++ tmp = _halReadMACAddrFromFile(padapter, pEEPROM->mac_addr); ++ pEEPROM->bloadmac_fail_flag = ((tmp==_FAIL) ? true : false); ++ ++ if (IS_HARDWARE_TYPE_8812AU(padapter)) ++ addr = EEPROM_MAC_ADDR_8812AE; ++ else ++ addr = EEPROM_MAC_ADDR_8821AE; ++ _rtw_memcpy(&pEEPROM->efuse_eeprom_data[addr], pEEPROM->mac_addr, ETH_ALEN); ++ } ++#else // !CONFIG_EFUSE_CONFIG_FILE ++ ++ if (false == pEEPROM->bautoload_fail_flag) + { + // autoload OK. + if (is_boot_from_eeprom(padapter)) @@ -275403,56 +114905,56 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + // Read all Content from EEPROM or EFUSE. + for (i = 0; i < HWSET_MAX_SIZE_JAGUAR; i += 2) + { -+ //val16 = EF2Byte(ReadEEprom(pAdapter, (u2Byte) (i>>1))); ++ //val16 = le16_to_cpu(ReadEEprom(pAdapter, (u2Byte) (i>>1))); + //*((u16*)(&PROMContent[i])) = val16; + } + } + else + { + // Read EFUSE real map to shadow. -+ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, _FALSE); ++ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, false); + } + } + else + { + // update to default value 0xFF + if (!is_boot_from_eeprom(padapter)) -+ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, _FALSE); ++ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, false); + } -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ if (check_phy_efuse_tx_power_info_valid(padapter) == _FALSE) { -+ if (Hal_readPGDataFromConfigFile(padapter) != _SUCCESS) -+ DBG_871X_LEVEL(_drv_err_, "invalid phy efuse and read from file fail, will use driver default!!\n"); -+ } -+#endif ++#endif // !CONFIG_EFUSE_CONFIG_FILE +} + -+static void read_chip_version_8812a(PADAPTER Adapter) ++void ++ReadChipVersion8812A( ++ PADAPTER Adapter ++ ) +{ + u32 value32; ++ HAL_VERSION ChipVersion; + PHAL_DATA_TYPE pHalData; ++ ++ + pHalData = GET_HAL_DATA(Adapter); + + value32 = rtw_read32(Adapter, REG_SYS_CFG); + DBG_8192C("%s SYS_CFG(0x%X)=0x%08x \n", __FUNCTION__, REG_SYS_CFG, value32); + + if(IS_HARDWARE_TYPE_8812(Adapter)) -+ pHalData->VersionID.ICType = CHIP_8812; ++ ChipVersion.ICType = CHIP_8812; + else -+ pHalData->VersionID.ICType = CHIP_8821; ++ ChipVersion.ICType = CHIP_8821; + -+ pHalData->VersionID.ChipType = ((value32 & RTL_ID) ? TEST_CHIP : NORMAL_CHIP); ++ ChipVersion.ChipType = ((value32 & RTL_ID) ? TEST_CHIP : NORMAL_CHIP); ++ ++ if (Adapter->registrypriv.rf_config == RF_MAX_TYPE) { ++ if(IS_HARDWARE_TYPE_8812(Adapter)) ++ ChipVersion.RFType = RF_TYPE_2T2R;//RF_2T2R; ++ else ++ ChipVersion.RFType = RF_TYPE_1T1R;//RF_1T1R; ++ } + + if (IS_HARDWARE_TYPE_8812(Adapter)) -+ pHalData->VersionID.RFType = RF_TYPE_2T2R; /* RF_2T2R; */ -+ else -+ pHalData->VersionID.RFType = RF_TYPE_1T1R; /* RF_1T1R; */ -+ -+ if(Adapter->registrypriv.special_rf_path == 1) -+ pHalData->VersionID.RFType = RF_TYPE_1T1R; //RF_1T1R; -+ -+ if (IS_HARDWARE_TYPE_8812(Adapter)) -+ pHalData->VersionID.VendorType = ((value32 & VENDOR_ID) ? CHIP_VENDOR_UMC : CHIP_VENDOR_TSMC); ++ ChipVersion.VendorType = ((value32 & VENDOR_ID) ? CHIP_VENDOR_UMC : CHIP_VENDOR_TSMC); + else + { + u32 vendor; @@ -275470,14 +114972,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + vendor = CHIP_VENDOR_UMC; + break; + } -+ pHalData->VersionID.VendorType = vendor; ++ ChipVersion.VendorType = vendor; + } -+ pHalData->VersionID.CUTVersion = (value32 & CHIP_VER_RTL_MASK)>>CHIP_VER_RTL_SHIFT; // IC version (CUT) ++ ChipVersion.CUTVersion = (value32 & CHIP_VER_RTL_MASK)>>CHIP_VER_RTL_SHIFT; // IC version (CUT) + if(IS_HARDWARE_TYPE_8812(Adapter)) -+ pHalData->VersionID.CUTVersion += 1; ++ ChipVersion.CUTVersion += 1; + + //value32 = rtw_read32(Adapter, REG_GPIO_OUTSTS); -+ pHalData->VersionID.ROMVer = 0; // ROM code version. ++ ChipVersion.ROMVer = 0; // ROM code version. + + // For multi-function consideration. Added by Roger, 2010.10.06. + pHalData->MultiFunc = RT_MULTI_FUNC_NONE; @@ -275486,24 +114988,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + pHalData->MultiFunc |= ((value32 & BT_FUNC_EN) ? RT_MULTI_FUNC_BT : 0); + pHalData->PolarityCtl = ((value32 & WL_HWPDN_SL) ? RT_POLARITY_HIGH_ACT : RT_POLARITY_LOW_ACT); + -+ rtw_hal_config_rftype(Adapter); -+#if 1 -+ dump_chip_info(pHalData->VersionID); ++#if 1 ++ dump_chip_info(ChipVersion); +#endif + ++ _rtw_memcpy(&pHalData->VersionID, &ChipVersion, sizeof(HAL_VERSION)); ++ ++ if (IS_1T2R(ChipVersion)){ ++ pHalData->rf_type = RF_1T2R; ++ pHalData->NumTotalRFPath = 2; ++ } ++ else if (IS_2T2R(ChipVersion)){ ++ pHalData->rf_type = RF_2T2R; ++ pHalData->NumTotalRFPath = 2; ++ } ++ else{ ++ pHalData->rf_type = RF_1T1R; ++ pHalData->NumTotalRFPath = 1; ++ } ++ ++ DBG_8192C("RF_Type is %x!!\n", pHalData->rf_type); +} + -+VOID ++void +Hal_PatchwithJaguar_8812( -+ IN PADAPTER Adapter, -+ IN RT_MEDIA_STATUS MediaStatus ++ PADAPTER Adapter, ++ RT_MEDIA_STATUS MediaStatus + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + struct mlme_ext_priv *pmlmeext = &(Adapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + -+ if( (MediaStatus == RT_MEDIA_CONNECT) && ++ if( (MediaStatus == RT_MEDIA_CONNECT) && + (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK_JAGUAR_BCUTAP )) + { + rtw_write8(Adapter, rVhtlen_Use_Lsig_Jaguar, 0x1); @@ -275512,17 +115029,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + else + { + rtw_write8(Adapter, rVhtlen_Use_Lsig_Jaguar, 0x3F); -+ /* rtw_write8(Adapter, REG_TCR+3, BIT0|BIT1|BIT2); */ -+ /* -+ * 20150707 yiwei.sun -+ * set 0x604[24] = 0 , to fix 11ac vht 80Mhz mode mcs 8 , 9 udp pkt lose issue -+ * suggest by MAC team Jong & Scott -+ */ -+ rtw_write8(Adapter , REG_TCR+3 , BIT1|BIT2); ++ rtw_write8(Adapter, REG_TCR+3, BIT0|BIT1|BIT2); + } + + -+ if( (MediaStatus == RT_MEDIA_CONNECT) && ++ if( (MediaStatus == RT_MEDIA_CONNECT) && + ((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK_JAGUAR_BCUTAP) || + (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP))) + { @@ -275538,13 +115049,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + +void UpdateHalRAMask8812A(PADAPTER padapter, u32 mac_id, u8 rssi_level) +{ ++ //volatile unsigned int result; ++ u8 init_rate=0; ++ u8 networkType, raid; + u32 mask,rate_bitmap; -+ u8 shortGIrate = _FALSE; ++ u8 shortGIrate = false; ++ int supportRateNum = 0; + u8 arg[4] = {0}; + struct sta_info *psta; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ //struct dm_priv *pdmpriv = &pHalData->dmpriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + + if (mac_id >= NUM_STA) //CAM_SIZE + { @@ -275557,97 +115074,126 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + return; + } + -+ shortGIrate = query_ra_short_GI(psta); ++ switch (mac_id) ++ { ++ case 0:// for infra mode ++#ifdef CONFIG_CONCURRENT_MODE ++ case 2:// first station uses macid=0, second station uses macid=2 ++#endif ++ supportRateNum = rtw_get_rateset_len(cur_network->SupportedRates); ++ networkType = judge_network_type(padapter, cur_network->SupportedRates, supportRateNum); ++ //pmlmeext->cur_wireless_mode = networkType; ++ //raid = networktype_to_raid(networkType); ++ raid = rtw_hal_networktype_to_raid(padapter, networkType); + -+ mask = psta->ra_mask; ++ mask = update_supported_rate(cur_network->SupportedRates, supportRateNum); ++#ifdef CONFIG_80211AC_VHT ++ if (pmlmeinfo->VHT_enable) { ++ mask |= (rtw_vht_rate_to_bitmap(psta->vhtpriv.vht_mcs_map) << 12); ++ shortGIrate = psta->vhtpriv.sgi; ++ } ++ else ++#endif ++ { ++ mask |= (pmlmeinfo->HT_enable)? update_MCS_rate(&(pmlmeinfo->HT_caps)): 0; ++ if (support_short_GI(padapter, &(pmlmeinfo->HT_caps))) ++ shortGIrate = true; ++ } + -+ rate_bitmap = 0xffffffff; -+ rate_bitmap = ODM_Get_Rate_Bitmap(&pHalData->odmpriv,mac_id,mask,rssi_level); -+ DBG_871X("%s => mac_id:%d, networkType:0x%02x, mask:0x%08x\n\t ==> rssi_level:%d, rate_bitmap:0x%08x, psta->raid=%d\n", -+ __func__, mac_id, psta->wireless_mode, mask, rssi_level, rate_bitmap, psta->raid); ++ break; ++ ++ case 1://for broadcast/multicast ++ supportRateNum = rtw_get_rateset_len(pmlmeinfo->FW_sta_info[mac_id].SupportedRates); ++ if(pmlmeext->cur_wireless_mode & WIRELESS_11B) ++ networkType = WIRELESS_11B; ++ else ++ networkType = WIRELESS_11G; ++ //raid = networktype_to_raid(networkType); ++ raid = rtw_hal_networktype_to_raid(padapter, networkType); ++ mask = update_basic_rate(cur_network->SupportedRates, supportRateNum); ++ ++ ++ break; ++ ++ default: //for each sta in IBSS ++ supportRateNum = rtw_get_rateset_len(pmlmeinfo->FW_sta_info[mac_id].SupportedRates); ++ networkType = judge_network_type(padapter, pmlmeinfo->FW_sta_info[mac_id].SupportedRates, supportRateNum) & 0xf; ++ //pmlmeext->cur_wireless_mode = networkType; ++ //raid = networktype_to_raid(networkType); ++ raid = rtw_hal_networktype_to_raid(padapter, networkType); ++ mask = update_supported_rate(cur_network->SupportedRates, supportRateNum); ++ ++ //todo: support HT in IBSS ++ ++ break; ++ } ++ ++ //mask &=0x0fffffff; ++ rate_bitmap = 0xffffffff; ++#ifdef CONFIG_ODM_REFRESH_RAMASK ++ { ++ rate_bitmap = ODM_Get_Rate_Bitmap(&pHalData->odmpriv,mac_id,mask,rssi_level); ++ printk("%s => mac_id:%d, networkType:0x%02x, mask:0x%08x\n\t ==> rssi_level:%d, rate_bitmap:0x%08x\n", ++ __FUNCTION__,mac_id,networkType,mask,rssi_level,rate_bitmap); ++ } ++#endif + + mask &= rate_bitmap; ++ init_rate = get_highest_rate_idx(mask)&0x3f; + -+#ifdef CONFIG_BT_COEXIST -+ if (pHalData->EEPROMBluetoothCoexist == 1) -+ { -+ rate_bitmap = rtw_btcoex_GetRaMask(padapter); -+ mask &= ~rate_bitmap; -+ } -+#endif // CONFIG_BT_COEXIST ++ //arg[0] = macid ++ //arg[1] = raid ++ //arg[2] = shortGIrate ++ //arg[3] = init_rate + + arg[0] = mac_id; -+ arg[1] = psta->raid; ++ arg[1] = raid; + arg[2] = shortGIrate; -+ arg[3] = psta->init_rate; ++ arg[3] = init_rate; + + rtl8812_set_raid_cmd(padapter, mask, arg); ++ ++ //set ra_id ++ psta->raid = raid; ++ psta->init_rate = init_rate; +} + +void InitDefaultValue8821A(PADAPTER padapter) +{ + PHAL_DATA_TYPE pHalData; + struct pwrctrl_priv *pwrctrlpriv; ++ struct dm_priv *pdmpriv; + u8 i; + ++ + pHalData = GET_HAL_DATA(padapter); -+ pwrctrlpriv = adapter_to_pwrctl(padapter); ++ pwrctrlpriv = &padapter->pwrctrlpriv; ++ pdmpriv = &pHalData->dmpriv; + + // init default value -+ pHalData->fw_ractrl = _FALSE; ++ pHalData->fw_ractrl = false; + if (!pwrctrlpriv->bkeepfwalive) -+ pHalData->LastHMEBoxNum = 0; -+ -+ /* hal capability values */ -+ #ifdef CONFIG_RTL8821A -+ if(IS_HARDWARE_TYPE_8821(padapter)) { -+ pHalData->macid_num = MACID_NUM_8821A; -+ pHalData->sec_cam_ent_num = SEC_CAM_ENT_NUM_8821A; -+ pHalData->nss_num = NSS_NUM_8821A; -+ } else -+ #endif -+ { -+ pHalData->macid_num = MACID_NUM_8812A; -+ pHalData->sec_cam_ent_num = SEC_CAM_ENT_NUM_8812A; -+ pHalData->nss_num = NSS_NUM_8812A; -+ } ++ pHalData->LastHMEBoxNum = 0; + + // init dm default value -+ pHalData->bChnlBWInitialized = _FALSE; -+ pHalData->bIQKInitialized = _FALSE; ++ pHalData->bChnlBWInitialzed = false; ++ pHalData->odmpriv.RFCalibrateInfo.bIQKInitialized = false; + pHalData->odmpriv.RFCalibrateInfo.TM_Trigger = 0;//for IQK + pHalData->pwrGroupCnt = 0; + pHalData->PGMaxGroup = MAX_PG_GROUP; + pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP_index = 0; + for (i = 0; i < HP_THERMAL_NUM; i++) + pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP[i] = 0; -+ pHalData->EfuseHal.fakeEfuseBank = 0; -+ pHalData->EfuseHal.fakeEfuseUsedBytes = 0; -+ _rtw_memset(pHalData->EfuseHal.fakeEfuseContent, 0xFF, EFUSE_MAX_HW_SIZE); -+ _rtw_memset(pHalData->EfuseHal.fakeEfuseInitMap, 0xFF, EFUSE_MAX_MAP_LEN); -+ _rtw_memset(pHalData->EfuseHal.fakeEfuseModifiedMap, 0xFF, EFUSE_MAX_MAP_LEN); +} + -+VOID ++void +_InitBeaconParameters_8812A( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u16 val16; -+ u8 val8; + -+ val8 = DIS_TSF_UDT; -+ val16 = val8 | (val8 << 8); // port0 and port1 -+#ifdef CONFIG_BT_COEXIST -+ if (pHalData->EEPROMBluetoothCoexist == 1) -+ { -+ // Enable prot0 beacon function for PSTDMA -+ val16 |= EN_BCN_FUNCTION; -+ } -+#endif -+ rtw_write16(Adapter, REG_BCN_CTRL, val16); -+ //rtw_write16(Adapter, REG_BCN_CTRL, 0x1010); ++ rtw_write16(Adapter, REG_BCN_CTRL, 0x1010); + + // TODO: Remove these magic number + rtw_write16(Adapter, REG_TBTT_PROHIBIT,0x6404);// ms @@ -275659,29 +115205,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + rtw_write16(Adapter, REG_BCNTCFG, 0x660F); + + pHalData->RegBcnCtrlVal = rtw_read8(Adapter, REG_BCN_CTRL); -+ pHalData->RegTxPause = rtw_read8(Adapter, REG_TXPAUSE); ++ pHalData->RegTxPause = rtw_read8(Adapter, REG_TXPAUSE); + pHalData->RegFwHwTxQCtrl = rtw_read8(Adapter, REG_FWHW_TXQ_CTRL+2); + pHalData->RegReg542 = rtw_read8(Adapter, REG_TBTT_PROHIBIT+2); + pHalData->RegCR_1 = rtw_read8(Adapter, REG_CR+1); +} + -+static VOID ++static void +_BeaconFunctionEnable( -+ IN PADAPTER Adapter, -+ IN BOOLEAN Enable, -+ IN BOOLEAN Linked ++ PADAPTER Adapter, ++ bool Enable, ++ bool Linked + ) +{ + rtw_write8(Adapter, REG_BCN_CTRL, (BIT4 | BIT3 | BIT1)); + //SetBcnCtrlReg(Adapter, (BIT4 | BIT3 | BIT1), 0x00); -+ //RT_TRACE(COMP_BEACON, DBG_LOUD, ("_BeaconFunctionEnable 0x550 0x%x\n", PlatformEFIORead1Byte(Adapter, 0x550))); ++ //RT_TRACE(COMP_BEACON, DBG_LOUD, ("_BeaconFunctionEnable 0x550 0x%x\n", PlatformEFIORead1Byte(Adapter, 0x550))); + -+ rtw_write8(Adapter, REG_RD_CTRL+1, 0x6F); ++ rtw_write8(Adapter, REG_RD_CTRL+1, 0x6F); +} + +static void ResumeTxBeacon(_adapter *padapter) +{ -+ HAL_DATA_TYPE* pHalData = GET_HAL_DATA(padapter); ++ HAL_DATA_TYPE* pHalData = GET_HAL_DATA(padapter); + + // 2010.03.01. Marked by tynli. No need to call workitem beacause we record the value + // which should be read from register to a global variable. @@ -275712,25 +115258,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u32 bcn_ctrl_reg = REG_BCN_CTRL; -+ //reset TSF, enable update TSF, correcting TSF On Beacon -+ ++ u32 bcn_ctrl_reg = REG_BCN_CTRL; ++ //reset TSF, enable update TSF, correcting TSF On Beacon ++ + //REG_BCN_INTERVAL + //REG_BCNDMATIM + //REG_ATIMWND + //REG_TBTT_PROHIBIT + //REG_DRVERLYINT -+ //REG_BCN_MAX_ERR ++ //REG_BCN_MAX_ERR + //REG_BCNTCFG //(0x510) + //REG_DUAL_TSF_RST -+ //REG_BCN_CTRL //(0x550) ++ //REG_BCN_CTRL //(0x550) + + //BCN interval +#ifdef CONFIG_CONCURRENT_MODE + if (padapter->iface_type == IFACE_PORT1){ + bcn_ctrl_reg = REG_BCN_CTRL_1; + } -+#endif ++#endif + rtw_write16(padapter, REG_BCN_INTERVAL, pmlmeinfo->bcn_interval); + rtw_write8(padapter, REG_ATIMWND, 0x02);// 2ms + @@ -275738,23 +115284,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + rtw_write8(padapter, REG_SLOT, 0x09); + -+ value32 =rtw_read32(padapter, REG_TCR); ++ value32 =rtw_read32(padapter, REG_TCR); + value32 &= ~TSFRST; -+ rtw_write32(padapter, REG_TCR, value32); ++ rtw_write32(padapter, REG_TCR, value32); + + value32 |= TSFRST; -+ rtw_write32(padapter, REG_TCR, value32); ++ rtw_write32(padapter, REG_TCR, value32); + + // NOTE: Fix test chip's bug (about contention windows's randomness) + rtw_write8(padapter, REG_RXTSF_OFFSET_CCK, 0x50); + rtw_write8(padapter, REG_RXTSF_OFFSET_OFDM, 0x50); + -+ _BeaconFunctionEnable(padapter, _TRUE, _TRUE); ++ _BeaconFunctionEnable(padapter, true, true); + + ResumeTxBeacon(padapter); + + //rtw_write8(padapter, 0x422, rtw_read8(padapter, 0x422)|BIT(6)); -+ ++ + //rtw_write8(padapter, 0x541, 0xff); + + //rtw_write8(padapter, 0x542, rtw_read8(padapter, 0x541)|BIT(0)); @@ -275763,632 +115309,46 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + +} + -+#ifdef CONFIG_BEAMFORMING -+ -+#if (BEAMFORMING_SUPPORT == 0) -+VOID -+SetBeamformingCLK_8812( -+ IN PADAPTER Adapter -+ ) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); -+ u16 u2btmp; -+ u8 Count = 0, u1btmp; -+ -+ DBG_871X(" ==>%s\n", __FUNCTION__); -+ -+ if ( (check_fwstate(&Adapter->mlmepriv, _FW_UNDER_SURVEY)==_TRUE) -+#ifdef CONFIG_CONCURRENT_MODE -+ || (check_buddy_fwstate(Adapter, _FW_UNDER_SURVEY) == _TRUE) -+#endif -+ ) -+ { -+ DBG_871X(" <==%s return by Scan\n", __FUNCTION__); -+ return; -+ } -+ -+ // Stop Usb TxDMA -+ rtw_write_port_cancel(Adapter); -+ -+#ifdef CONFIG_PCI_HCI -+ // Stop PCIe TxDMA -+ rtw_write8(Adapter, REG_PCIE_CTRL_REG+1, 0xFE); -+#endif -+ -+ // Wait TXFF empty -+ for(Count = 0; Count < 100; Count++) -+ { -+ u2btmp = rtw_read16(Adapter, REG_TXPKT_EMPTY); -+ u2btmp = u2btmp & 0xfff; -+ if(u2btmp != 0xfff) -+ { -+ rtw_mdelay_os(10); -+ continue; -+ } -+ else -+ break; -+ } -+ -+ DBG_871X(" Tx Empty count %d \n", Count); -+ -+ // TX pause -+ rtw_write8(Adapter, REG_TXPAUSE, 0xFF); -+ -+ // Wait TX State Machine OK -+ for(Count = 0; Count < 100; Count++) -+ { -+ if (rtw_read32(Adapter, REG_SCH_TXCMD_8812A) != 0) -+ continue; -+ else -+ break; -+ } -+ -+ DBG_871X(" Tx Status count %d\n", Count); -+ -+ // Stop RX DMA path -+ u1btmp = rtw_read8(Adapter, REG_RXDMA_CONTROL_8812A); -+ rtw_write8(Adapter, REG_RXDMA_CONTROL_8812A, u1btmp | BIT2); -+ -+ for(Count = 0; Count < 100; Count++) -+ { -+ u1btmp = rtw_read8(Adapter, REG_RXDMA_CONTROL_8812A); -+ if(u1btmp & BIT1) -+ break; -+ else -+ rtw_mdelay_os(10); -+ } -+ -+ DBG_871X(" Rx Empty count %d \n", Count); -+ -+ // Disable clock -+ rtw_write8(Adapter, REG_SYS_CLKR+1, 0xf0); -+ // Disable 320M -+ rtw_write8(Adapter, REG_AFE_PLL_CTRL+3, 0x8); -+ // Enable 320M -+ rtw_write8(Adapter, REG_AFE_PLL_CTRL+3, 0xa); -+ // Enable clock -+ rtw_write8(Adapter, REG_SYS_CLKR+1, 0xfc); -+ -+ // Release Tx pause -+ rtw_write8(Adapter, REG_TXPAUSE, 0); -+ -+ // Enable RX DMA path -+ u1btmp = rtw_read8(Adapter, REG_RXDMA_CONTROL_8812A); -+ rtw_write8(Adapter, REG_RXDMA_CONTROL_8812A, u1btmp & (~BIT2)); -+ -+ // Start Usb TxDMA -+ RTW_ENABLE_FUNC(Adapter, DF_TX_BIT); -+ DBG_871X("%s \n", __FUNCTION__); -+ -+ DBG_871X("<==%s\n", __FUNCTION__); -+} -+ -+VOID -+SetBeamformRfMode_8812( -+ IN PADAPTER Adapter, -+ IN struct beamforming_info *pBeamInfo -+ ) -+{ -+ BOOLEAN bSelfBeamformer = _FALSE; -+ BOOLEAN bSelfBeamformee = _FALSE; -+ BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; -+ -+ BeamformCap = beamforming_get_beamform_cap(pBeamInfo); -+ -+ if(BeamformCap == pBeamInfo->beamforming_cap) -+ return; -+ else -+ pBeamInfo->beamforming_cap = BeamformCap; -+ -+ if(GET_RF_TYPE(Adapter) == RF_1T1R) -+ return; -+ -+ bSelfBeamformer = BeamformCap & BEAMFORMER_CAP; -+ bSelfBeamformee = BeamformCap & BEAMFORMEE_CAP; -+ -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000,0x1); // RF Mode table write enable -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000,0x1); // RF Mode table write enable -+ -+ if(bSelfBeamformer) -+ { -+ // Paath_A -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_ModeTableAddr, 0x78000,0x3); // Select RX mode -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff,0x3F7FF); // Set Table data -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff,0xE26BF); // Enable TXIQGEN in RX mode -+ // Path_B -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_B, RF_ModeTableAddr, 0x78000, 0x3); // Select RX mode -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff,0x3F7FF); // Set Table data -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff,0xE26BF); // Enable TXIQGEN in RX mode -+ } -+ else -+ { -+ // Paath_A -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_ModeTableAddr, 0x78000, 0x3); // Select RX mode -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff,0x3F7FF); // Set Table data -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff,0xC26BF); // Disable TXIQGEN in RX mode -+ // Path_B -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_B, RF_ModeTableAddr, 0x78000, 0x3); // Select RX mode -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff,0x3F7FF); // Set Table data -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff,0xC26BF); // Disable TXIQGEN in RX mode -+ } -+ -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000,0x0); // RF Mode table write disable -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000,0x0); // RF Mode table write disable -+ -+ if(bSelfBeamformer) -+ PHY_SetBBReg(Adapter, rTxPath_Jaguar, bMaskByte1, 0x33); -+ else -+ PHY_SetBBReg(Adapter, rTxPath_Jaguar, bMaskByte1, 0x11); -+} -+ -+ -+ -+VOID -+SetBeamformEnter_8812( -+ IN PADAPTER Adapter, -+ IN u8 Idx -+ ) -+{ -+ u8 i = 0; -+ u32 CSI_Param; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct beamforming_entry BeamformEntry = pBeamInfo->beamforming_entry[Idx]; -+ u16 STAid = 0; -+ -+ SetBeamformRfMode_8812(Adapter, pBeamInfo); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) -+ STAid = BeamformEntry.mac_id; -+ else -+ STAid = BeamformEntry.p_aid; -+ -+ // Sounding protocol control -+ rtw_write8(Adapter, REG_SND_PTCL_CTRL_8812A, 0xCB); -+ -+ // MAC addresss/Partial AID of Beamformer -+ if(Idx == 0) -+ { -+ for(i = 0; i < 6 ; i++) -+ rtw_write8(Adapter, (REG_BFMER0_INFO_8812A+i), BeamformEntry.mac_addr[i]); -+ /* CSI report use legacy ofdm so don't need to fill P_AID.*/ -+ /*rtw_write16(Adapter, REG_BFMER0_INFO_8812A+6, BeamformEntry.P_AID);*/ -+ } -+ else -+ { -+ for(i = 0; i < 6 ; i++) -+ rtw_write8(Adapter, (REG_BFMER1_INFO_8812A+i), BeamformEntry.mac_addr[i]); -+ /* CSI report use legacy ofdm so don't need to fill P_AID.*/ -+ /*rtw_write16(Adapter, REG_BFMER1_INFO_8812A+6, BeamformEntry.P_AID);*/ -+ } -+ -+ /* CSI report parameters of Beamformee */ -+ if( (BeamformEntry.beamforming_entry_cap & BEAMFORMEE_CAP_VHT_SU) || -+ (BeamformEntry.beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) ) -+ { -+ if(pHalData->rf_type == RF_2T2R) -+ CSI_Param = 0x01090109; -+ else -+ CSI_Param = 0x01080108; -+ } -+ else -+ { -+ if(pHalData->rf_type == RF_2T2R) -+ CSI_Param = 0x03090309; -+ else -+ CSI_Param = 0x03080308; -+ } -+ -+ if(pHalData->rf_type == RF_2T2R) -+ rtw_write32(Adapter, 0x9B4, 0x00000000); /* Nc =2 */ -+ else -+ rtw_write32(Adapter, 0x9B4, 0x01081008); /* Nc =1 */ -+ -+ rtw_write32(Adapter, REG_CSI_RPT_PARAM_BW20_8812A, CSI_Param); -+ rtw_write32(Adapter, REG_CSI_RPT_PARAM_BW40_8812A, CSI_Param); -+ rtw_write32(Adapter, REG_CSI_RPT_PARAM_BW80_8812A, CSI_Param); -+ -+ /* P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt */ -+ if(Idx == 0) -+ { -+ rtw_write16(Adapter, REG_TXBF_CTRL_8812A, STAid); -+ rtw_write8(Adapter, REG_TXBF_CTRL_8812A+3, rtw_read8(Adapter, REG_TXBF_CTRL_8812A+3)|BIT4|BIT6|BIT7); -+ } -+ else -+ { -+ rtw_write16(Adapter, REG_TXBF_CTRL_8812A+2, STAid | BIT12 | BIT14 | BIT15); -+ } -+ -+ /* CSI report parameters of Beamformee */ -+ if(Idx == 0) -+ { -+ /* Get BIT24 & BIT25*/ -+ u8 tmp = rtw_read8(Adapter, REG_BFMEE_SEL_8812A+3) & 0x3; -+ -+ rtw_write8(Adapter, REG_BFMEE_SEL_8812A+3, tmp | 0x60); -+ rtw_write16(Adapter, REG_BFMEE_SEL_8812A, STAid | BIT9); -+ } -+ else -+ { -+ // Set BIT25 -+ rtw_write16(Adapter, REG_BFMEE_SEL_8812A+2, STAid | (0xE2 << 8)); -+ } -+ -+ // Timeout value for MAC to leave NDP_RX_standby_state (60 us, Test chip) (80 us, MP chip) -+ rtw_write8(Adapter, REG_SND_PTCL_CTRL_8812A+3, 0x50); -+ -+ beamforming_notify(Adapter); -+} -+ -+ -+VOID -+SetBeamformLeave_8812( -+ IN PADAPTER Adapter, -+ IN u8 Idx -+ ) -+{ -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(&(Adapter->mlmepriv)); -+ -+ SetBeamformRfMode_8812(Adapter, pBeamInfo); -+ -+ /* Clear P_AID of Beamformee -+ * Clear MAC addresss of Beamformer -+ * Clear Associated Bfmee Sel -+ */ -+ if(pBeamInfo->beamforming_cap == BEAMFORMING_CAP_NONE) -+ rtw_write8(Adapter, REG_SND_PTCL_CTRL_8812A, 0xC8); -+ -+ if(Idx == 0) -+ { -+ rtw_write16(Adapter, REG_TXBF_CTRL_8812A, 0); -+ -+ rtw_write32(Adapter, REG_BFMER0_INFO_8812A, 0); -+ rtw_write16(Adapter, REG_BFMER0_INFO_8812A+4, 0); -+ -+ rtw_write16(Adapter, REG_BFMEE_SEL_8812A, 0); -+ } -+ else -+ { -+ rtw_write16(Adapter, REG_TXBF_CTRL_8812A+2, rtw_read16(Adapter, REG_TXBF_CTRL_8812A+2) & 0xF000); -+ -+ rtw_write32(Adapter, REG_BFMER1_INFO_8812A, 0); -+ rtw_write16(Adapter, REG_BFMER1_INFO_8812A+4, 0); -+ -+ rtw_write16(Adapter, REG_BFMEE_SEL_8812A+2, rtw_read16(Adapter, REG_BFMEE_SEL_8812A+2) & 0x60); -+ } -+} -+ -+ -+VOID -+SetBeamformStatus_8812( -+ IN PADAPTER Adapter, -+ IN u8 Idx -+ ) -+{ -+ u16 BeamCtrlVal; -+ u32 BeamCtrlReg; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct beamforming_entry BeamformEntry = pBeamInfo->beamforming_entry[Idx]; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) -+ BeamCtrlVal = BeamformEntry.mac_id; -+ else -+ BeamCtrlVal = BeamformEntry.p_aid; -+ -+ if(Idx == 0) -+ BeamCtrlReg = REG_TXBF_CTRL_8812A; -+ else -+ { -+ BeamCtrlReg = REG_TXBF_CTRL_8812A+2; -+ BeamCtrlVal |= BIT12 | BIT14|BIT15; -+ } -+ -+ if(BeamformEntry.beamforming_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) -+ { -+ if(BeamformEntry.sound_bw == CHANNEL_WIDTH_20) -+ BeamCtrlVal |= BIT9; -+ else if(BeamformEntry.sound_bw == CHANNEL_WIDTH_40) -+ BeamCtrlVal |= BIT10; -+ else if(BeamformEntry.sound_bw == CHANNEL_WIDTH_80) -+ BeamCtrlVal |= BIT11; -+ } -+ else -+ { -+ BeamCtrlVal &= ~(BIT9|BIT10|BIT11); -+ } -+ -+ rtw_write16(Adapter, BeamCtrlReg, BeamCtrlVal); -+ -+ DBG_871X("%s Idx %d BeamCtrlReg %x BeamCtrlVal %x\n", __FUNCTION__, Idx, BeamCtrlReg, BeamCtrlVal); -+} -+ -+ -+VOID -+SetBeamformFwTxBFCmd_8812( -+ IN PADAPTER Adapter -+ ) -+{ -+ u8 Idx, Period0 = 0, Period1 = 0; -+ u8 PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u8 u1TxBFParm[3]={0}; -+ -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ -+ for(Idx = 0; Idx < BEAMFORMING_ENTRY_NUM; Idx++) -+ { -+ if(pBeamInfo->beamforming_entry[Idx].beamforming_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) -+ { -+ if(Idx == 0) -+ { -+ if(pBeamInfo->beamforming_entry[Idx].bSound) -+ PageNum0 = 0xFE; -+ else -+ PageNum0 = 0xFF; //stop sounding -+ Period0 = (u8)(pBeamInfo->beamforming_entry[Idx].sound_period); -+ } -+ else if(Idx == 1) -+ { -+ if(pBeamInfo->beamforming_entry[Idx].bSound) -+ PageNum1 = 0xFE; -+ else -+ PageNum1 = 0xFF; //stop sounding -+ Period1 = (u8)(pBeamInfo->beamforming_entry[Idx].sound_period); -+ } -+ } -+ } -+ -+ u1TxBFParm[0] = PageNum0; -+ u1TxBFParm[1] = PageNum1; -+ u1TxBFParm[2] = (Period1 << 4) | Period0; -+ FillH2CCmd_8812(Adapter, H2C_8812_TxBF, 3, u1TxBFParm); -+ -+ DBG_871X("%s PageNum0 = %d Period0 = %d\n", __FUNCTION__, PageNum0, Period0); -+ DBG_871X("PageNum1 = %d Period1 %d\n", PageNum1, Period1); -+} -+ -+ -+VOID -+SetBeamformDownloadNDPA_8812( -+ IN PADAPTER Adapter, -+ IN u8 Idx -+ ) -+{ -+ u8 u1bTmp=0, tmpReg422=0, Head_Page; -+ u8 BcnValidReg=0, count=0, DLBcnCount=0; -+ BOOLEAN bSendBeacon=_FALSE; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 TxPageBndy= LAST_ENTRY_OF_TX_PKT_BUFFER_8812; // default reseved 1 page for the IC type which is undefined. -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(&(Adapter->mlmepriv)); -+ struct beamforming_entry *pBeamEntry = pBeamInfo->beamforming_entry+Idx; -+ -+ //pHalData->bFwDwRsvdPageInProgress = _TRUE; -+ -+ if(Idx == 0) -+ Head_Page = 0xFE; -+ else -+ Head_Page = 0xFE; -+ -+ rtw_hal_get_def_var(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&TxPageBndy); -+ -+ //Set REG_CR bit 8. DMA beacon by SW. -+ u1bTmp = rtw_read8(Adapter, REG_CR+1); -+ rtw_write8(Adapter, REG_CR+1, (u1bTmp|BIT0)); -+ -+ pHalData->RegCR_1 |= BIT0; -+ rtw_write8(Adapter, REG_CR+1, pHalData->RegCR_1); -+ -+ // Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. -+ tmpReg422 = rtw_read8(Adapter, REG_FWHW_TXQ_CTRL+2); -+ rtw_write8(Adapter, REG_FWHW_TXQ_CTRL+2, tmpReg422&(~BIT6)); -+ -+ if(tmpReg422&BIT6) -+ { -+ DBG_871X("SetBeamformDownloadNDPA_8812(): There is an Adapter is sending beacon.\n"); -+ bSendBeacon = _TRUE; -+ } -+ -+ // TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA -+ rtw_write8(Adapter,REG_TDECTRL+1, Head_Page); -+ -+ do -+ { -+ // Clear beacon valid check bit. -+ BcnValidReg = rtw_read8(Adapter, REG_TDECTRL+2); -+ rtw_write8(Adapter, REG_TDECTRL+2, (BcnValidReg|BIT0)); -+ -+ // download NDPA rsvd page. -+ if(pBeamEntry->beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) -+ beamforming_send_vht_ndpa_packet(Adapter,pBeamEntry->mac_addr,pBeamEntry->aid,pBeamEntry->sound_bw, BCN_QUEUE_INX); -+ else -+ beamforming_send_ht_ndpa_packet(Adapter,pBeamEntry->mac_addr,pBeamEntry->sound_bw, BCN_QUEUE_INX); -+ -+ // check rsvd page download OK. -+ BcnValidReg = rtw_read8(Adapter, REG_TDECTRL+2); -+ count=0; -+ while(!(BcnValidReg & BIT0) && count <20) -+ { -+ count++; -+ rtw_udelay_os(10); -+ BcnValidReg = rtw_read8(Adapter, REG_TDECTRL+2); -+ } -+ DLBcnCount++; -+ }while(!(BcnValidReg&BIT0) && DLBcnCount<5); -+ -+ if(!(BcnValidReg&BIT0)) -+ DBG_871X("%s Download RSVD page failed!\n", __FUNCTION__); -+ -+ // TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA -+ rtw_write8(Adapter,REG_TDECTRL+1, TxPageBndy); -+ -+ // To make sure that if there exists an adapter which would like to send beacon. -+ // If exists, the origianl value of 0x422[6] will be 1, we should check this to -+ // prevent from setting 0x422[6] to 0 after download reserved page, or it will cause -+ // the beacon cannot be sent by HW. -+ // 2010.06.23. Added by tynli. -+ if(bSendBeacon) -+ { -+ rtw_write8(Adapter, REG_FWHW_TXQ_CTRL+2, tmpReg422); -+ } -+ -+ // Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli. -+ // Clear CR[8] or beacon packet will not be send to TxBuf anymore. -+ u1bTmp = rtw_read8(Adapter, REG_CR+1); -+ rtw_write8(Adapter, REG_CR+1, (u1bTmp&(~BIT0))); -+ -+ pBeamEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+ -+ //pHalData->bFwDwRsvdPageInProgress = _FALSE; -+} -+ -+VOID -+SetBeamformFwTxBF_8812( -+ IN PADAPTER Adapter, -+ IN u8 Idx -+ ) -+{ -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(&(Adapter->mlmepriv)); -+ struct beamforming_entry *pBeamEntry = pBeamInfo->beamforming_entry+Idx; -+ -+ if(pBeamEntry->beamforming_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ SetBeamformDownloadNDPA_8812(Adapter, Idx); -+ -+ SetBeamformFwTxBFCmd_8812(Adapter); -+} -+ -+ -+VOID -+SetBeamformPatch_8812( -+ IN PADAPTER Adapter, -+ IN u8 Operation -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(&(Adapter->mlmepriv)); -+ -+ if(pBeamInfo->beamforming_cap == BEAMFORMING_CAP_NONE) -+ return; -+ -+ /*if(Operation == SCAN_OPT_BACKUP_BAND0) -+ { -+ rtw_write8(Adapter, REG_SND_PTCL_CTRL_8812A, 0xC8); -+ } -+ else if(Operation == SCAN_OPT_RESTORE) -+ { -+ rtw_write8(Adapter, REG_SND_PTCL_CTRL_8812A, 0xCB); -+ }*/ -+} -+#endif /*#if (BEAMFORMING_SUPPORT == 0) - for drv beamforming*/ -+#endif /*#ifdef CONFIG_BEAMFORMING*/ -+ -+static void hw_var_set_monitor(PADAPTER Adapter, u8 variable, u8 *val) -+{ -+ u32 value_rcr, rcr_bits; -+ u16 value_rxfltmap2; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ -+ if (*((u8 *)val) == _HW_STATE_MONITOR_) { -+ -+ /* Leave IPS */ -+ rtw_pm_set_ips(Adapter, IPS_NONE); -+ LeaveAllPowerSaveMode(Adapter); -+ -+ /* Receive all type */ -+ rcr_bits = RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_APWRMGT | RCR_ADF | RCR_ACF | RCR_AMF | RCR_APP_PHYST_RXFF; -+ -+ /* Append FCS */ -+ rcr_bits |= RCR_APPFCS; -+ -+ #if 0 -+ /* -+ CRC and ICV packet will drop in recvbuf2recvframe() -+ We no turn on it. -+ */ -+ rcr_bits |= (RCR_ACRC32 | RCR_AICV); -+ #endif -+ -+ /* Receive all data frames */ -+ value_rxfltmap2 = 0xFFFF; -+ -+ value_rcr = rcr_bits; -+ rtw_write32(Adapter, REG_RCR, value_rcr); -+ -+ rtw_write16(Adapter, REG_RXFLTMAP2, value_rxfltmap2); -+ -+ #if 0 -+ /* tx pause */ -+ rtw_write8(padapter, REG_TXPAUSE, 0xFF); -+ #endif -+ } else { -+ /* do nothing */ -+ } -+ -+} -+ +static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8* val) +{ -+ u8 val8; ++ u8 val8; + u8 mode = *((u8 *)val); -+ u32 value_rcr; -+ static u8 isMonitor = _FALSE; -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if (isMonitor == _TRUE) { -+ /* reset RCR */ -+ rtw_write32(Adapter, REG_RCR, pHalData->ReceiveConfig); -+ isMonitor = _FALSE; -+ } -+ -+ if (mode == _HW_STATE_MONITOR_) { -+ isMonitor = _TRUE; -+ /* set net_type */ -+ Set_MSR(Adapter, _HW_STATE_NOLINK_); -+ -+ hw_var_set_monitor(Adapter, variable, val); -+ return; -+ } + +#ifdef CONFIG_CONCURRENT_MODE + if(Adapter->iface_type == IFACE_PORT1) + { + // disable Port1 TSF update + rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)|DIS_TSF_UDT); -+ ++ + // set net_type + val8 = rtw_read8(Adapter, MSR)&0x03; + val8 |= (mode<<2); + rtw_write8(Adapter, MSR, val8); -+ ++ + DBG_871X("%s()-%d mode = %d\n", __FUNCTION__, __LINE__, mode); + + if((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) + { + if(!check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE)) + { -+ StopTxBeacon(Adapter); -+#ifdef CONFIG_PCI_HCI -+ UpdateInterruptMask8812AE( Adapter, 0, 0, RT_BCN_INT_MASKS, 0); -+#else -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN ++ #ifdef CONFIG_INTERRUPT_BASED_TXBCN + -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT ++ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT + rtw_write8(Adapter, REG_DRVERLYINT, 0x05);//restore early int time to 5ms -+ UpdateInterruptMask8812AU(Adapter,_TRUE, 0, IMR_BCNDMAINT0_8812); ++ UpdateInterruptMask8812AU(Adapter,true, 0, IMR_BCNDMAINT1_8812); + #endif // CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8812AU(Adapter,_TRUE ,0, (IMR_TXBCN0ERR_8812|IMR_TXBCN0OK_8812)); ++ ++ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR ++ UpdateInterruptMask8812AU(Adapter,true ,0, (IMR_TXBCN0ERR_8812|IMR_TXBCN0OK_8812)); + #endif// CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ ++ + #endif //CONFIG_INTERRUPT_BASED_TXBCN -+#endif ++ ++ ++ StopTxBeacon(Adapter); + } -+ -+ rtw_write8(Adapter,REG_BCN_CTRL_1, 0x11);//disable atim wnd and disable beacon function ++ ++ rtw_write8(Adapter,REG_BCN_CTRL_1, 0x19);//disable atim wnd + //rtw_write8(Adapter,REG_BCN_CTRL_1, 0x18); + } + else if((mode == _HW_STATE_ADHOC_) /*|| (mode == _HW_STATE_AP_)*/) @@ -276398,51 +115358,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + } + else if(mode == _HW_STATE_AP_) + { -+#ifdef CONFIG_PCI_HCI -+ UpdateInterruptMask8812AE( Adapter, RT_BCN_INT_MASKS, 0, 0, 0); -+#else -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN + #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ UpdateInterruptMask8812AU(Adapter,_TRUE ,IMR_BCNDMAINT0_8812, 0); ++ UpdateInterruptMask8812AU(Adapter,true ,IMR_BCNDMAINT1_8812, 0); + #endif//CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT + -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8812AU(Adapter,_TRUE ,(IMR_TXBCN0ERR_8812|IMR_TXBCN0OK_8812), 0); ++ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR ++ UpdateInterruptMask8812AU(Adapter,true ,(IMR_TXBCN0ERR_8812|IMR_TXBCN0OK_8812), 0); + #endif//CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR + -+ #endif //CONFIG_INTERRUPT_BASED_TXBCN -+#endif ++#endif //CONFIG_INTERRUPT_BASED_TXBCN + + ResumeTxBeacon(Adapter); -+ ++ + rtw_write8(Adapter, REG_BCN_CTRL_1, 0x12); + -+ #ifdef CONFIG_PCI_HCI -+ //Beacon is polled to TXBUF SWBCN -+ rtw_write32(Adapter, REG_CR, rtw_read32(Adapter, REG_CR)|BIT(8)); -+ DBG_871X("CR:SWBCN %x \n",rtw_read32(Adapter,0x100)); -+ #endif + //Set RCR + //rtw_write32(padapter, REG_RCR, 0x70002a8e);//CBSSID_DATA must set to 0 + //rtw_write32(Adapter, REG_RCR, 0x7000228e);//CBSSID_DATA must set to 0 -+ //rtw_write32(Adapter, REG_RCR, 0x7000208e);//CBSSID_DATA must set to 0,reject ICV_ERR packet -+ value_rcr = rtw_read32(Adapter, REG_RCR); -+ value_rcr &= ~(RCR_CBSSID_DATA);//Clear CBSSID_DATA -+ rtw_write32(Adapter, REG_RCR, value_rcr); -+ ++ rtw_write32(Adapter, REG_RCR, 0x7000208e);//CBSSID_DATA must set to 0,reject ICV_ERR packet + //enable to rx data frame + rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); ++ //enable to rx ps-poll ++ rtw_write16(Adapter, REG_RXFLTMAP1, 0x0400); + -+ //Beacon Control related register for first time -+ rtw_write8(Adapter, REG_BCNDMATIM, 0x02); // 2ms ++ //Beacon Control related register for first time ++ rtw_write8(Adapter, REG_BCNDMATIM, 0x02); // 2ms + + //rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF); + rtw_write8(Adapter, REG_ATIMWND_1, 0x0a); // 10ms for port1 + rtw_write16(Adapter, REG_BCNTCFG, 0x00); + rtw_write16(Adapter, REG_TBTT_PROHIBIT, 0xff04); + rtw_write16(Adapter, REG_TSFTR_SYN_OFFSET, 0x7fff);// +32767 (~32ms) -+ -+ //reset TSF2 ++ ++ //reset TSF2 + rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(1)); + + //enable BCN1 Function for if2 @@ -276453,24 +115402,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + { + // select BCN on port 1 + rtw_write8(Adapter, REG_CCK_CHECK_8812, rtw_read8(Adapter, REG_CCK_CHECK_8812)|BIT(5)); -+ } ++ } + +#ifdef CONFIG_CONCURRENT_MODE + if(check_buddy_fwstate(Adapter, WIFI_FW_NULL_STATE)) -+ rtw_write8(Adapter, REG_BCN_CTRL, ++ rtw_write8(Adapter, REG_BCN_CTRL, + rtw_read8(Adapter, REG_BCN_CTRL) & ~EN_BCN_FUNCTION); +#endif + //BCN1 TSF will sync to BCN0 TSF with offset(0x518) if if1_sta linked + //rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)|BIT(5)); + //rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(3)); -+ ++ + //dis BCN0 ATIM WND if if1 is station + rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)|DIS_ATIM); + +#ifdef CONFIG_TSF_RESET_OFFLOAD + // Reset TSF for STA+AP concurrent mode + if ( check_buddy_fwstate(Adapter, (WIFI_STATION_STATE|WIFI_ASOC_STATE)) ) { -+ if (reset_tsf(Adapter, IFACE_PORT1) == _FALSE) ++ if (reset_tsf(Adapter, IFACE_PORT1) == false) + DBG_871X("ERROR! %s()-%d: Reset port1 TSF fail\n", + __FUNCTION__, __LINE__); + } @@ -276482,38 +115431,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + { + // disable Port0 TSF update + rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)|DIS_TSF_UDT); -+ ++ + // set net_type + val8 = rtw_read8(Adapter, MSR)&0x0c; + val8 |= mode; + rtw_write8(Adapter, MSR, val8); -+ ++ + DBG_871X("%s()-%d mode = %d\n", __FUNCTION__, __LINE__, mode); -+ ++ + if((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) + { +#ifdef CONFIG_CONCURRENT_MODE -+ if(!check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE)) ++ if(!check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE)) +#endif // CONFIG_CONCURRENT_MODE + { -+ StopTxBeacon(Adapter); -+#ifdef CONFIG_PCI_HCI -+ UpdateInterruptMask8812AE( Adapter, 0, 0, RT_BCN_INT_MASKS, 0); -+#else + #ifdef CONFIG_INTERRUPT_BASED_TXBCN + #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ rtw_write8(Adapter, REG_DRVERLYINT, 0x05);//restore early int time to 5ms -+ UpdateInterruptMask8812AU(Adapter,_TRUE, 0, IMR_BCNDMAINT0_8812); ++ rtw_write8(Adapter, REG_DRVERLYINT, 0x05);//restore early int time to 5ms ++ UpdateInterruptMask8812AU(Adapter,true, 0, IMR_BCNDMAINT0_8812); + #endif//CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8812AU(Adapter,_TRUE ,0, (IMR_TXBCN0ERR_8812|IMR_TXBCN0OK_8812)); ++ ++ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR ++ UpdateInterruptMask8812AU(Adapter,true ,0, (IMR_TXBCN0ERR_8812|IMR_TXBCN0OK_8812)); + #endif //CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ ++ + #endif //CONFIG_INTERRUPT_BASED_TXBCN -+#endif ++ StopTxBeacon(Adapter); + } -+ ++ + rtw_write8(Adapter,REG_BCN_CTRL, 0x19);//disable atim wnd + //rtw_write8(Adapter,REG_BCN_CTRL, 0x18); + } @@ -276524,44 +115469,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + } + else if(mode == _HW_STATE_AP_) + { -+#ifdef CONFIG_PCI_HCI -+ UpdateInterruptMask8812AE( Adapter, RT_BCN_INT_MASKS, 0, 0, 0); -+#else -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN ++#ifdef CONFIG_INTERRUPT_BASED_TXBCN + #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ UpdateInterruptMask8812AU(Adapter,_TRUE ,IMR_BCNDMAINT0_8812, 0); ++ UpdateInterruptMask8812AU(Adapter,true ,IMR_BCNDMAINT0_8812, 0); + #endif//CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT + -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8812AU(Adapter,_TRUE ,(IMR_TXBCN0ERR_8812|IMR_TXBCN0OK_8812), 0); ++ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR ++ UpdateInterruptMask8812AU(Adapter,true ,(IMR_TXBCN0ERR_8812|IMR_TXBCN0OK_8812), 0); + #endif//CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ -+ #endif //CONFIG_INTERRUPT_BASED_TXBCN -+#endif ++ ++#endif //CONFIG_INTERRUPT_BASED_TXBCN ++ + + ResumeTxBeacon(Adapter); + + rtw_write8(Adapter, REG_BCN_CTRL, 0x12); -+ #ifdef CONFIG_PCI_HCI -+ //Beacon is polled to TXBUF SWBCN -+ rtw_write32(Adapter, REG_CR, rtw_read32(Adapter, REG_CR)|BIT(8)); -+ DBG_871X("CR:SWBCN %x \n",rtw_read32(Adapter,0x100)); -+ #endif + + //Set RCR + //rtw_write32(padapter, REG_RCR, 0x70002a8e);//CBSSID_DATA must set to 0 + //rtw_write32(Adapter, REG_RCR, 0x7000228e);//CBSSID_DATA must set to 0 -+ //rtw_write32(Adapter, REG_RCR, 0x7000208e);//CBSSID_DATA must set to 0,reject ICV_ERR packet -+ value_rcr = rtw_read32(Adapter, REG_RCR); -+ value_rcr &= ~(RCR_CBSSID_DATA);//Clear CBSSID_DATA -+ rtw_write32(Adapter, REG_RCR, value_rcr); -+ ++ rtw_write32(Adapter, REG_RCR, 0x7000208e);//CBSSID_DATA must set to 0,reject ICV_ERR packet + //enable to rx data frame + rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); ++ //enable to rx ps-poll ++ rtw_write16(Adapter, REG_RXFLTMAP1, 0x0400); + + //Beacon Control related register for first time -+ rtw_write8(Adapter, REG_BCNDMATIM, 0x02); // 2ms -+ ++ rtw_write8(Adapter, REG_BCNDMATIM, 0x02); // 2ms ++ + //rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF); + rtw_write8(Adapter, REG_ATIMWND, 0x0a); // 10ms + rtw_write16(Adapter, REG_BCNTCFG, 0x00); @@ -276570,7 +115505,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + //reset TSF + rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(0)); -+ ++ + //enable BCN0 Function for if1 + //don't enable update TSF0 for if1 (due to TSF update when beacon/probe rsp are received) + rtw_write8(Adapter, REG_BCN_CTRL, (DIS_TSF_UDT|EN_BCN_FUNCTION | EN_TXBCN_RPT|DIS_BCNQ_SUB)); @@ -276578,12 +115513,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + if(IS_HARDWARE_TYPE_8821(Adapter)) + { + // select BCN on port 0 -+ rtw_write8(Adapter, REG_CCK_CHECK_8812, rtw_read8(Adapter, REG_CCK_CHECK_8812)&(~BIT(5))); ++ rtw_write8(Adapter, REG_CCK_CHECK_8812, rtw_read8(Adapter, REG_CCK_CHECK_8812)&(~BIT(5))); + } + +#ifdef CONFIG_CONCURRENT_MODE + if(check_buddy_fwstate(Adapter, WIFI_FW_NULL_STATE)) -+ rtw_write8(Adapter, REG_BCN_CTRL_1, ++ rtw_write8(Adapter, REG_BCN_CTRL_1, + rtw_read8(Adapter, REG_BCN_CTRL_1) & ~EN_BCN_FUNCTION); +#endif + @@ -276592,13 +115527,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +#ifdef CONFIG_TSF_RESET_OFFLOAD + // Reset TSF for STA+AP concurrent mode + if ( check_buddy_fwstate(Adapter, (WIFI_STATION_STATE|WIFI_ASOC_STATE)) ) { -+ if (reset_tsf(Adapter, IFACE_PORT0) == _FALSE) ++ if (reset_tsf(Adapter, IFACE_PORT0) == false) + DBG_871X("ERROR! %s()-%d: Reset port0 TSF fail\n", + __FUNCTION__, __LINE__); + } +#endif // CONFIG_TSF_RESET_OFFLOAD + } + } ++ +} + +static void hw_var_set_macaddr(PADAPTER Adapter, u8 variable, u8* val) @@ -276619,9 +115555,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + for(idx = 0 ; idx < 6; idx++) + { -+ rtw_write8(GET_PRIMARY_ADAPTER(Adapter), (reg_macid+idx), val[idx]); ++ rtw_write8(Adapter, (reg_macid+idx), val[idx]); + } -+ ++ +} + +static void hw_var_set_bssid(PADAPTER Adapter, u8 variable, u8* val) @@ -276650,15 +115586,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +static void hw_var_set_bcn_func(PADAPTER Adapter, u8 variable, u8* val) +{ + u32 bcn_ctrl_reg; -+ u8 val8; ++ +#ifdef CONFIG_CONCURRENT_MODE + if(Adapter->iface_type == IFACE_PORT1) + { + bcn_ctrl_reg = REG_BCN_CTRL_1; -+ } ++ } + else -+#endif -+ { ++#endif ++ { + bcn_ctrl_reg = REG_BCN_CTRL; + } + @@ -276668,24 +115604,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + } + else + { -+ -+ u8 val8; -+ val8 = rtw_read8(Adapter, bcn_ctrl_reg); -+ val8 &= ~(EN_BCN_FUNCTION | EN_TXBCN_RPT); -+ -+#ifdef CONFIG_BT_COEXIST -+ if (GET_HAL_DATA(Adapter)->EEPROMBluetoothCoexist == 1) -+ { -+ // Always enable port0 beacon function for PSTDMA -+ if (REG_BCN_CTRL == bcn_ctrl_reg) -+ val8 |= EN_BCN_FUNCTION; -+ } -+#endif -+ -+ rtw_write8(Adapter, bcn_ctrl_reg, val8); -+ //rtw_write8(Adapter, bcn_ctrl_reg, rtw_read8(Adapter, bcn_ctrl_reg)&(~(EN_BCN_FUNCTION | EN_TXBCN_RPT))); ++ rtw_write8(Adapter, bcn_ctrl_reg, rtw_read8(Adapter, bcn_ctrl_reg)&(~(EN_BCN_FUNCTION | EN_TXBCN_RPT))); + } -+ ++ + +} + @@ -276700,7 +115621,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + tsf = pmlmeext->TSFValue - rtw_modular64(pmlmeext->TSFValue, (pmlmeinfo->bcn_interval*1024)) -1024; //us + + if(((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ { ++ { + //pHalData->RegTxPause |= STOP_BCNQ;BIT(6) + //rtw_write8(Adapter, REG_TXPAUSE, (rtw_read8(Adapter, REG_TXPAUSE)|BIT(6))); + StopTxBeacon(Adapter); @@ -276710,18 +115631,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + { + //disable related TSF function + rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)&(~BIT(3))); -+ ++ + rtw_write32(Adapter, REG_TSFTR1, tsf); + rtw_write32(Adapter, REG_TSFTR1+4, tsf>>32); + + + //enable related TSF function -+ rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)|BIT(3)); ++ rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)|BIT(3)); + + // Update buddy port's TSF if it is SoftAP for beacon TX issue! + if ( (pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE + && check_buddy_fwstate(Adapter, WIFI_AP_STATE) -+ ) { ++ ) { + //disable related TSF function + rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)&(~BIT(3))); + @@ -276732,30 +115653,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)|BIT(3)); +#ifdef CONFIG_TSF_RESET_OFFLOAD + // Update buddy port's TSF(TBTT) if it is SoftAP for beacon TX issue! -+ if (reset_tsf(Adapter, IFACE_PORT0) == _FALSE) ++ if (reset_tsf(Adapter, IFACE_PORT0) == false) + DBG_871X("ERROR! %s()-%d: Reset port0 TSF fail\n", + __FUNCTION__, __LINE__); + -+#endif // CONFIG_TSF_RESET_OFFLOAD -+ } ++#endif // CONFIG_TSF_RESET_OFFLOAD ++ } ++ + -+ + } + else + { + //disable related TSF function + rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)&(~BIT(3))); -+ ++ + rtw_write32(Adapter, REG_TSFTR, tsf); + rtw_write32(Adapter, REG_TSFTR+4, tsf>>32); + + //enable related TSF function + rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)|BIT(3)); -+ ++ + // Update buddy port's TSF if it is SoftAP for beacon TX issue! + if ( (pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE + && check_buddy_fwstate(Adapter, WIFI_AP_STATE) -+ ) { ++ ) { + //disable related TSF function + rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)&(~BIT(3))); + @@ -276766,15 +115687,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)|BIT(3)); +#ifdef CONFIG_TSF_RESET_OFFLOAD + // Update buddy port's TSF if it is SoftAP for beacon TX issue! -+ if (reset_tsf(Adapter, IFACE_PORT1) == _FALSE) ++ if (reset_tsf(Adapter, IFACE_PORT1) == false) + DBG_871X("ERROR! %s()-%d: Reset port1 TSF fail\n", + __FUNCTION__, __LINE__); +#endif // CONFIG_TSF_RESET_OFFLOAD -+ } ++ } + + } -+ -+ ++ ++ + if(((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) + { + //pHalData->RegTxPause &= (~STOP_BCNQ); @@ -276787,10 +115708,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +static void hw_var_set_mlme_disconnect(PADAPTER Adapter, u8 variable, u8* val) +{ +#ifdef CONFIG_CONCURRENT_MODE -+ -+ if(check_buddy_mlmeinfo_state(Adapter, _HW_STATE_NOLINK_)) ++ ++ if(check_buddy_mlmeinfo_state(Adapter, _HW_STATE_NOLINK_)) + rtw_write16(Adapter, REG_RXFLTMAP2, 0x00); -+ ++ + + if(Adapter->iface_type == IFACE_PORT1) + { @@ -276799,9 +115720,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + //disable update TSF1 + rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)|BIT(4)); -+ -+ // disable Port1's beacon function -+ rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)&(~BIT(3))); + } + else + { @@ -276816,14 +115734,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + +static void hw_var_set_mlme_sitesurvey(PADAPTER Adapter, u8 variable, u8* val) +{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); + u32 value_rcr, rcr_clear_bit, reg_bcn_ctl; + u16 value_rxfltmap2; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + struct mlme_priv *pmlmepriv=&(Adapter->mlmepriv); -+ u8 ap_num; -+ -+ rtw_dev_iface_status(Adapter, NULL, NULL, NULL, &ap_num, NULL); + +#ifdef CONFIG_CONCURRENT_MODE + if(Adapter->iface_type == IFACE_PORT1) @@ -276836,7 +115750,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + rcr_clear_bit = (RCR_CBSSID_BCN | RCR_CBSSID_DATA); + -+ /* Receive all data frames */ ++ // Recieve all data frames + value_rxfltmap2 = 0xFFFF; + +#else /* CONFIG_FIND_BEST_CHANNEL */ @@ -276848,17 +115762,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + +#endif /* CONFIG_FIND_BEST_CHANNEL */ + -+ if( (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ if( (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) +#ifdef CONFIG_CONCURRENT_MODE -+ || (check_buddy_fwstate(Adapter, WIFI_AP_STATE) == _TRUE) ++ || (check_buddy_fwstate(Adapter, WIFI_AP_STATE) == true) +#endif + ) -+ { -+ rcr_clear_bit = RCR_CBSSID_BCN; ++ { ++ rcr_clear_bit = RCR_CBSSID_BCN; + } +#ifdef CONFIG_TDLS + // TDLS will clear RCR_CBSSID_DATA bit for connection. -+ else if (Adapter->tdlsinfo.link_established == _TRUE) ++ else if (Adapter->tdlsinfo.setup_state & TDLS_LINKED_STATE) + { + rcr_clear_bit = RCR_CBSSID_BCN; + } @@ -276881,12 +115795,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + // Save orignal RRSR setting. + pHalData->RegRRSR = rtw_read16(Adapter, REG_RRSR); + -+ if (ap_num) ++#ifdef CONFIG_CONCURRENT_MODE ++ if(check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE) && ++ check_buddy_fwstate(Adapter, _FW_LINKED)) ++ { + StopTxBeacon(Adapter); ++ } ++#endif + } + else//sitesurvey done + { -+ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) ++ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) +#ifdef CONFIG_CONCURRENT_MODE + || check_buddy_fwstate(Adapter, (_FW_LINKED|WIFI_AP_STATE)) +#endif @@ -276907,29 +115826,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + // Restore orignal RRSR setting. + rtw_write16(Adapter, REG_RRSR, pHalData->RegRRSR); + -+ if (ap_num) { -+ int i; -+ _adapter *iface; -+ ++#ifdef CONFIG_CONCURRENT_MODE ++ if(check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE) && ++ check_buddy_fwstate(Adapter, _FW_LINKED)) ++ { + ResumeTxBeacon(Adapter); -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE -+ && check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE -+ ) { -+ iface->mlmepriv.update_bcn = _TRUE; -+ #ifndef CONFIG_INTERRUPT_BASED_TXBCN -+ #if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ tx_beacon_hdl(iface, NULL); -+ #endif -+ #endif -+ } -+ } + } -+ } ++#endif ++ } +} + +static void hw_var_set_mlme_join(PADAPTER Adapter, u8 variable, u8* val) @@ -276939,31 +115843,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + u8 type = *((u8 *)val); + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); + + if(type == 0) // prepare to join -+ { ++ { + if(check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE) && -+ check_buddy_fwstate(Adapter, _FW_LINKED)) ++ check_buddy_fwstate(Adapter, _FW_LINKED)) + { + StopTxBeacon(Adapter); + } -+ ++ + //enable to rx data frame.Accept all data frame + //rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_ADF); + rtw_write16(Adapter, REG_RXFLTMAP2,0xFFFF); + + if(check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE)) + { -+ rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR)|RCR_CBSSID_BCN); -+ } ++ rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR)|RCR_CBSSID_BCN); ++ } + else + { + rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR)|RCR_CBSSID_DATA|RCR_CBSSID_BCN); -+ } ++ } + -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) + { -+ RetryLimit = (pHalData->CustomerID == RT_CID_CCX) ? 7 : 48; ++ RetryLimit = (pEEPROM->CustomerID == RT_CID_CCX) ? 7 : 48; + } + else // Ad-hoc Mode + { @@ -276971,30 +115876,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + } + } + else if(type == 1) //joinbss_event call back when join res < 0 -+ { -+ if(check_buddy_mlmeinfo_state(Adapter, _HW_STATE_NOLINK_)) ++ { ++ if(check_buddy_mlmeinfo_state(Adapter, _HW_STATE_NOLINK_)) + rtw_write16(Adapter, REG_RXFLTMAP2,0x00); + + if(check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE) && + check_buddy_fwstate(Adapter, _FW_LINKED)) + { -+ ResumeTxBeacon(Adapter); -+ ++ ResumeTxBeacon(Adapter); ++ + //reset TSF 1/2 after ResumeTxBeacon -+ rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(1)|BIT(0)); -+ ++ rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(1)|BIT(0)); ++ + } + } + else if(type == 2) //sta add event call back + { -+ ++ + //enable update TSF + if(Adapter->iface_type == IFACE_PORT1) + rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)&(~BIT(4))); -+ else ++ else + rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)&(~BIT(4))); -+ -+ ++ ++ + if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE)) + { + //fixed beacon issue for 8191su........... @@ -277006,30 +115911,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + if(check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE) && + check_buddy_fwstate(Adapter, _FW_LINKED)) + { -+ ResumeTxBeacon(Adapter); -+ ++ ResumeTxBeacon(Adapter); ++ + //reset TSF 1/2 after ResumeTxBeacon + rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(1)|BIT(0)); + } -+ ++ + } + + rtw_write16(Adapter, REG_RL, RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT); -+ ++ +#endif +} + +void SetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval) +{ -+ PHAL_DATA_TYPE pHalData; ++ PHAL_DATA_TYPE pHalData; ++ struct dm_priv *pdmpriv; + PDM_ODM_T podmpriv; + u8 val8; + u16 val16; + u32 val32; + -+_func_enter_; + -+ pHalData = GET_HAL_DATA(padapter); ++ ++ pHalData = GET_HAL_DATA(padapter); ++ pdmpriv = &pHalData->dmpriv; + podmpriv = &pHalData->odmpriv; + + switch (variable) @@ -277059,46 +115966,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + break; + + case HW_VAR_BASIC_RATE: -+ { -+ struct mlme_ext_info *mlmext_info = &padapter->mlmeextpriv.mlmext_info; -+ u16 input_b = 0, masked = 0, ioted = 0, BrateCfg = 0; -+ u16 rrsr_2g_force_mask = RRSR_CCK_RATES; -+ u16 rrsr_2g_allow_mask = (RRSR_24M|RRSR_12M|RRSR_6M|RRSR_CCK_RATES); -+ u16 rrsr_5g_force_mask = (RRSR_6M); -+ u16 rrsr_5g_allow_mask = (RRSR_OFDM_RATES); -+ -+ HalSetBrateCfg(padapter, pval, &BrateCfg); -+ input_b = BrateCfg; -+ -+ /* apply force and allow mask */ -+ if(pHalData->CurrentBandType == BAND_ON_2_4G) + { -+ BrateCfg |= rrsr_2g_force_mask; -+ BrateCfg &= rrsr_2g_allow_mask; ++ u16 BrateCfg = 0; ++ u8 RateIndex = 0; ++ ++ // 2007.01.16, by Emily ++ // Select RRSR (in Legacy-OFDM and CCK) ++ // For 8190, we select only 24M, 12M, 6M, 11M, 5.5M, 2M, and 1M from the Basic rate. ++ // We do not use other rates. ++ HalSetBrateCfg(padapter, pval, &BrateCfg); ++ ++ if(pHalData->CurrentBandType == BAND_ON_2_4G) ++ { ++ //CCK 2M ACK should be disabled for some BCM and Atheros AP IOT ++ //because CCK 2M has poor TXEVM ++ //CCK 5.5M & 11M ACK should be enabled for better performance ++ ++ pHalData->BasicRateSet = BrateCfg = (BrateCfg |0xd) & 0x15d; ++ BrateCfg |= 0x01; // default enable 1M ACK rate ++ } ++ else // 5G ++ { ++ pHalData->BasicRateSet &= 0xFF0; ++ BrateCfg |= 0x10; // default enable 6M ACK rate ++ } ++// DBG_8192C("HW_VAR_BASIC_RATE: BrateCfg(%#x)\n", BrateCfg); ++ ++ // Set RRSR rate table. ++ rtw_write8(padapter, REG_RRSR, BrateCfg&0xff); ++ rtw_write8(padapter, REG_RRSR+1, (BrateCfg>>8)&0xff); ++ rtw_write8(padapter, REG_RRSR+2, rtw_read8(padapter, REG_RRSR+2)&0xf0); + } -+ else // 5G -+ { -+ BrateCfg |= rrsr_5g_force_mask; -+ BrateCfg &= rrsr_5g_allow_mask; -+ } -+ masked = BrateCfg; -+ -+ /* IOT consideration */ -+ if (mlmext_info->assoc_AP_vendor == HT_IOT_PEER_CISCO) { -+ /* if peer is cisco and didn't use ofdm rate, we enable 6M ack */ -+ if((BrateCfg & (RRSR_24M|RRSR_12M|RRSR_6M)) == 0) -+ BrateCfg |= RRSR_6M; -+ } -+ ioted = BrateCfg; -+ -+ pHalData->BasicRateSet = BrateCfg; -+ -+ DBG_8192C("HW_VAR_BASIC_RATE: %#x -> %#x -> %#x\n", input_b, masked, ioted); -+ -+ // Set RRSR rate table. -+ rtw_write16(padapter, REG_RRSR, BrateCfg); -+ rtw_write8(padapter, REG_RRSR+2, rtw_read8(padapter, REG_RRSR+2)&0xf0); -+ } + break; + + case HW_VAR_TXPAUSE: @@ -277122,7 +116020,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + tsf = pmlmeext->TSFValue - rtw_modular64(pmlmeext->TSFValue, (pmlmeinfo->bcn_interval*1024)) -1024; //us + + if(((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ { ++ { + //pHalData->RegTxPause |= STOP_BCNQ;BIT(6) + //rtw_write8(padapter, REG_TXPAUSE, (rtw_read8(padapter, REG_TXPAUSE)|BIT(6))); + StopTxBeacon(padapter); @@ -277130,14 +116028,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + //disable related TSF function + rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)&(~BIT(3))); -+ ++ + rtw_write32(padapter, REG_TSFTR, tsf); + rtw_write32(padapter, REG_TSFTR+4, tsf>>32); + + //enable related TSF function + rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)|BIT(3)); -+ -+ ++ ++ + if(((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) + { + //pHalData->RegTxPause &= (~STOP_BCNQ); @@ -277186,8 +116084,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + hw_var_set_mlme_sitesurvey(padapter, variable, pval); + +#ifdef CONFIG_BT_COEXIST -+ if (_TRUE == pHalData->EEPROMBluetoothCoexist) -+ rtw_btcoex_ScanNotify(padapter, *pval?_TRUE:_FALSE); ++ BT_WifiScanNotify(padapter, *pval?true:false); +#endif + break; + @@ -277199,7 +116096,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + u8 RetryLimit = 0x30; + u8 type = *(u8*)pval; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); ++ + if (type == 0) // prepare to join + { + //enable to rx data frame.Accept all data frame @@ -277213,14 +116111,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + val32 |= RCR_CBSSID_DATA|RCR_CBSSID_BCN; + rtw_write32(padapter, REG_RCR, val32); + -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) + { -+ RetryLimit = (pHalData->CustomerID == RT_CID_CCX) ? 7 : 48; ++ RetryLimit = (pEEPROM->CustomerID == RT_CID_CCX) ? 7 : 48; + } + else // Ad-hoc Mode + { + RetryLimit = 0x7; + } ++ ++ pHalData->bNeedIQK = true; + } + else if (type == 1) //joinbss_event call back when join res < 0 + { @@ -277245,23 +116145,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +#endif // !CONFIG_CONCURRENT_MODE + +#ifdef CONFIG_BT_COEXIST -+ if (_TRUE == pHalData->EEPROMBluetoothCoexist) ++ switch (*pval) + { -+ switch (*pval) -+ { -+ case 0: -+ // prepare to join -+ rtw_btcoex_ConnectNotify(padapter, _TRUE); -+ break; -+ case 1: -+ // joinbss_event callback when join res < 0 -+ rtw_btcoex_ConnectNotify(padapter, _FALSE); -+ break; -+ case 2: -+ // sta add event callback -+ // rtw_btcoex_MediaStatusNotify(padapter, RT_MEDIA_CONNECT); -+ break; -+ } ++ case 0: ++ // prepare to join ++ BT_WifiAssociateNotify(padapter, true); ++ break; ++ case 1: ++ // joinbss_event callback when join res < 0 ++ BT_WifiAssociateNotify(padapter, false); ++ break; ++ case 2: ++ // sta add event callback ++// BT_WifiMediaStatusNotify(padapter, RT_MEDIA_CONNECT); ++ break; + } +#endif + break; @@ -277269,16 +116166,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + case HW_VAR_ON_RCR_AM: + val32 = rtw_read32(padapter, REG_RCR); + val32 |= RCR_AM; -+ rtw_write32(padapter, REG_RCR, val32); -+ DBG_8192C("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(padapter, REG_RCR)); -+ break; ++ rtw_write32(padapter, REG_RCR, val32); ++ DBG_8192C("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(padapter, REG_RCR)); ++ break; + + case HW_VAR_OFF_RCR_AM: + val32 = rtw_read32(padapter, REG_RCR); + val32 &= ~RCR_AM; -+ rtw_write32(padapter, REG_RCR, val32); -+ DBG_8192C("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(padapter, REG_RCR)); -+ break; ++ rtw_write32(padapter, REG_RCR, val32); ++ DBG_8192C("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(padapter, REG_RCR)); ++ break; + + case HW_VAR_BEACON_INTERVAL: + rtw_write16(padapter, REG_BCN_INTERVAL, *(u16*)pval); @@ -277295,8 +116192,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + if ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) + { + DBG_8192C("%s==> bcn_interval:%d, eraly_int:%d\n", __FUNCTION__, bcn_interval, bcn_interval>>1); -+ rtw_write8(padapter, REG_DRVERLYINT, bcn_interval>>1);// 50ms for sdio -+ } ++ rtw_write8(padapter, REG_DRVERLYINT, bcn_interval>>1);// 50ms for sdio ++ } + } +#endif // CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT + break; @@ -277327,6 +116224,44 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + } + break; + ++ case HW_VAR_SEC_CFG: ++#ifdef CONFIG_CONCURRENT_MODE ++ // enable tx enc and rx dec engine, and no key search for MC/BC ++ val8 = 0x0c | BIT(5); ++#else ++ val8 = *pval; ++#endif ++ rtw_write8(padapter, REG_SECCFG, val8); ++ break; ++ ++ case HW_VAR_DM_FLAG: ++ podmpriv->SupportAbility = *(u32*)pval; ++ break; ++ ++ case HW_VAR_DM_FUNC_OP: ++ if (*pval) // save dm flag ++ podmpriv->BK_SupportAbility = podmpriv->SupportAbility; ++ else // restore dm flag ++ podmpriv->SupportAbility = podmpriv->BK_SupportAbility; ++ break; ++ ++ case HW_VAR_DM_FUNC_SET: ++ val32 = *(u32*)pval; ++ if (val32 == DYNAMIC_ALL_FUNC_ENABLE) { ++ pdmpriv->DMFlag = pdmpriv->InitDMFlag; ++ podmpriv->SupportAbility = pdmpriv->InitODMFlag; ++ } else { ++ podmpriv->SupportAbility |= val32; ++ } ++ break; ++ ++ case HW_VAR_DM_FUNC_CLR: ++ val32 = *(u32*)pval; ++ // input is already a mask to clear function ++ // don't invert it again! George,Lucas@20130513 ++ podmpriv->SupportAbility &= val32; ++ break; ++ + case HW_VAR_CAM_EMPTY_ENTRY: + { + u8 ucIndex = *pval; @@ -277362,6 +116297,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + rtw_write32(padapter, RWCAM, val32); + break; + ++ case HW_VAR_CAM_WRITE: ++ { ++ u32 cmd; ++ u32 *cam_val = (u32*)pval; ++ ++ rtw_write32(padapter, WCAMI, cam_val[0]); ++ ++ cmd = CAM_POLLINIG | CAM_WRITE | cam_val[1]; ++ rtw_write32(padapter, RWCAM, cmd); ++ } ++ break; ++ ++ case HW_VAR_CAM_READ: ++ break; ++ + case HW_VAR_AC_PARAM_VO: + rtw_write32(padapter, REG_EDCA_VO_PARAM, *(u32*)pval); + break; @@ -277409,6 +116359,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + rtw_write8(padapter, REG_ACMHWCTRL, AcmCtrl ); + } + break; ++ ++ case HW_VAR_AMPDU_MIN_SPACE: ++ pHalData->AMPDUDensity = *(u8*)pval; ++ break; ++ + case HW_VAR_AMPDU_FACTOR: + { + u32 AMPDULen = *(u8*)pval; @@ -277442,9 +116397,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + // Forece leave RF low power mode for 1T1R to prevent conficting setting in Fw power + // saving sequence. 2010.06.07. Added by tynli. Suggested by SD3 yschang. -+ if (psmode != PS_MODE_ACTIVE) ++ if ((psmode != PS_MODE_ACTIVE) && (!IS_92C_SERIAL(pHalData->VersionID))) + { -+ ODM_RF_Saving(podmpriv, _TRUE); ++ ODM_RF_Saving(podmpriv, true); + } + rtl8812_set_FwPwrMode_cmd(padapter, psmode); + } @@ -277467,6 +116422,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + rtw_write32(padapter, REG_RCR, val32); + break; + ++ case HW_VAR_TDLS_INIT_CH_SEN: ++ val32 = rtw_read32(padapter, REG_RCR); ++ val32 &= (~RCR_CBSSID_DATA) & (~RCR_CBSSID_BCN); ++ rtw_write32(padapter, REG_RCR, val32); ++ rtw_write16(padapter, REG_RXFLTMAP2, 0xffff); ++ ++ // disable update TSF ++ val8 = rtw_read8(padapter, REG_BCN_CTRL); ++ val8 |= BIT(4); ++ rtw_write8(padapter, REG_BCN_CTRL, val8); ++ break; ++ ++ case HW_VAR_TDLS_DONE_CH_SEN: ++ // enable update TSF ++ val8 = rtw_read8(padapter, REG_BCN_CTRL); ++ val8 &= ~BIT(4); ++ rtw_write8(padapter, REG_BCN_CTRL, val8); ++ ++ val32 = rtw_read32(padapter, REG_RCR); ++ val32 |= RCR_CBSSID_BCN; ++ rtw_write32(padapter, REG_RCR, val32); ++ break; ++ + case HW_VAR_TDLS_RS_RCR: + val32 = rtw_read32(padapter, REG_RCR); + val32 |= RCR_CBSSID_DATA; @@ -277474,6 +116452,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + break; +#endif // CONFIG_TDLS + ++ case HW_VAR_INITIAL_GAIN: ++ { ++ pDIG_T pDigTable = &podmpriv->DM_DigTable; ++ u32 rx_gain = *(u32*)pval; ++ ++ if (rx_gain == 0xff) {//restore rx gain ++ ODM_Write_DIG(podmpriv, pDigTable->BackupIGValue); ++ } else { ++ pDigTable->BackupIGValue = pDigTable->CurIGValue; ++ ODM_Write_DIG(podmpriv, rx_gain); ++ } ++ } ++ break; ++ ++#ifdef CONFIG_BT_COEXIST ++ case HW_VAR_BT_SET_COEXIST: ++ rtl8812_set_dm_bt_coexist(padapter, *pval); ++ break; ++ ++ case HW_VAR_BT_ISSUE_DELBA: ++ rtl8812_issue_delete_ba(padapter, *pval); ++ break; ++#endif ++ ++#if (RATE_ADAPTIVE_SUPPORT==1) ++ case HW_VAR_RPT_TIMER_SETTING: ++ { ++ val16 = *(u16*)pval; ++ ODM_RA_Set_TxRPT_Time(podmpriv, val16); ++ } ++ break; ++#endif ++ +#ifdef CONFIG_SW_ANTENNA_DIVERSITY + case HW_VAR_ANTENNA_DIVERSITY_LINK: + //SwAntDivRestAfterLink8192C(padapter); @@ -277483,14 +116494,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + case HW_VAR_ANTENNA_DIVERSITY_SELECT: + { + u8 Optimum_antenna = *pval; -+ u8 Ant; ++ u8 Ant; + + //switch antenna to Optimum_antenna + //DBG_8192C("==> HW_VAR_ANTENNA_DIVERSITY_SELECT , Ant_(%s)\n",(Optimum_antenna==2)?"A":"B"); + if (pHalData->CurAntenna != Optimum_antenna) + { + Ant = (Optimum_antenna==2) ? MAIN_ANT : AUX_ANT; -+ ODM_UpdateRxIdleAnt(podmpriv, Ant); ++ ODM_UpdateRxIdleAnt_88E(podmpriv, Ant); + + pHalData->CurAntenna = Optimum_antenna; + //DBG_8192C("==> HW_VAR_ANTENNA_DIVERSITY_SELECT , Ant_(%s)\n",(Optimum_antenna==2)?"A":"B"); @@ -277524,9 +116535,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + case HW_VAR_FIFO_CLEARN_UP: + { + struct pwrctrl_priv *pwrpriv; -+ u8 trycnt = 100; ++ u8 trycnt = 100; + -+ pwrpriv = adapter_to_pwrctl(padapter); ++ pwrpriv = &padapter->pwrctrlpriv; + + // pause tx + rtw_write8(padapter, REG_TXPAUSE, 0xff); @@ -277534,7 +116545,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + // keep sn + padapter->xmitpriv.nqos_ssn = rtw_read16(padapter, REG_NQOS_SEQ); + -+ if (pwrpriv->bkeepfwalive != _TRUE) ++ if (pwrpriv->bkeepfwalive != true) + { + // RX DMA stop + val32 = rtw_read32(padapter, REG_RXPKT_NUM); @@ -277543,9 +116554,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + do { + val32 = rtw_read32(padapter, REG_RXPKT_NUM); + val32 &= RXDMA_IDLE; -+ if (val32) ++ if (!val32) + break; -+ } while (--trycnt); ++ } while (trycnt--); + if (trycnt == 0) + { + DBG_8192C("[HW_VAR_FIFO_CLEARN_UP] Stop RX DMA failed......\n"); @@ -277558,62 +116569,57 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + } + } + break; -+ case HW_VAR_RESTORE_HW_SEQ: -+ /* restore Sequence No. */ -+ rtw_write8(padapter, 0x4dc, padapter->xmitpriv.nqos_ssn); -+ break; ++ ++#ifdef CONFIG_CONCURRENT_MODE + case HW_VAR_CHECK_TXBUF: + { -+ u8 retry_limit; -+ u32 reg_200 = 0, reg_204 = 0; -+ u32 init_reg_200 = 0, init_reg_204 = 0; -+ u32 start = rtw_get_current_time(); -+ u32 pass_ms; -+ int i = 0; ++ u32 i; ++ u8 RetryLimit; ++ u32 reg_200, reg_204; + -+ retry_limit = 0x01; ++ RetryLimit = 0x01; + -+ val16 = retry_limit << RETRY_LIMIT_SHORT_SHIFT | retry_limit << RETRY_LIMIT_LONG_SHIFT; ++ val16 = RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT; + rtw_write16(padapter, REG_RL, val16); + -+ while (rtw_get_passing_time_ms(start) < 2000 -+ && !RTW_CANNOT_RUN(padapter) -+ ) { ++ for (i=0; i<1000; i++) ++ { + reg_200 = rtw_read32(padapter, 0x200); + reg_204 = rtw_read32(padapter, 0x204); -+ -+ if (i == 0) { -+ init_reg_200 = reg_200; -+ init_reg_204 = reg_204; -+ } -+ -+ i++; -+ if ((reg_200 & 0x00ffffff) != (reg_204 & 0x00ffffff)) { -+ //DBG_871X("%s: (HW_VAR_CHECK_TXBUF)TXBUF NOT empty - 0x204=0x%x, 0x200=0x%x (%d)\n", __FUNCTION__, reg_204, reg_200, i); ++ if (reg_200 != reg_204) ++ { ++// DBG_8192C("%s: (HW_VAR_CHECK_TXBUF)Tx buffer NOT empty - 0x204=0x%x, 0x200=0x%x (%d)\n", __FUNCTION__, reg_204, reg_200, i); + rtw_msleep_os(10); -+ } else { ++ } ++ else ++ { ++ DBG_8192C("%s: (HW_VAR_CHECK_TXBUF)Tx buffer Empty(%d)\n", __FUNCTION__, i); + break; + } + } -+ -+ pass_ms = rtw_get_passing_time_ms(start); -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ ; -+ else if (pass_ms >= 2000 || (reg_200 & 0x00ffffff) != (reg_204 & 0x00ffffff)) { -+ DBG_871X_LEVEL(_drv_always_, "%s:(HW_VAR_CHECK_TXBUF)NOT empty(%d) in %d ms\n", __FUNCTION__, i, pass_ms); -+ DBG_871X_LEVEL(_drv_always_, "%s:(HW_VAR_CHECK_TXBUF)0x200=0x%08x, 0x204=0x%08x (0x%08x, 0x%08x)\n", -+ __FUNCTION__, reg_200, reg_204, init_reg_200, init_reg_204); -+ //rtw_warn_on(1); -+ } else { -+ DBG_871X("%s:(HW_VAR_CHECK_TXBUF)TXBUF Empty(%d) in %d ms\n", __FUNCTION__, i, pass_ms); ++ if (i == 1000) ++ { ++ DBG_8192C("%s: (HW_VAR_CHECK_TXBUF)TXBUF is still not Empty after %d times check!\n", __FUNCTION__, i); ++ DBG_8192C("%s: (HW_VAR_CHECK_TXBUF)0x204=0x%08x, 0x200=0x%08x\n", __FUNCTION__, reg_204, reg_200); + } + -+ retry_limit = 0x30; -+ val16 = retry_limit << RETRY_LIMIT_SHORT_SHIFT | retry_limit << RETRY_LIMIT_LONG_SHIFT; ++ RetryLimit = 0x30; ++ val16 = RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT; + rtw_write16(padapter, REG_RL, val16); + } + break; ++#endif ++ ++#if (RATE_ADAPTIVE_SUPPORT == 1) ++ case HW_VAR_TX_RPT_MAX_MACID: ++ { ++ u8 maxMacid = *pval; ++ DBG_8192C("### MacID(%d),Set Max Tx RPT MID(%d)\n", maxMacid, maxMacid+1); ++ rtw_write8(padapter, REG_TX_RPT_CTRL+1, maxMacid+1); ++ } ++ break; ++#endif ++ + case HW_VAR_H2C_MEDIA_STATUS_RPT: + { + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -277653,9 +116659,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +#ifdef CONFIG_CONCURRENT_MODE + if (IS_HARDWARE_TYPE_8821(padapter) && padapter->iface_type == IFACE_PORT1) + { -+ val8 = rtw_read8(padapter, REG_DWBCN1_CTRL_8812+2); ++ val8 = rtw_read8(padapter, REG_TDECTRL1_8812+2); + val8 |= BIT(0); -+ rtw_write8(padapter, REG_DWBCN1_CTRL_8812+2, val8); ++ rtw_write8(padapter, REG_TDECTRL1_8812+2, val8); + } + else +#endif @@ -277672,25 +116678,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + if (IS_HARDWARE_TYPE_8821(padapter) && padapter->iface_type == IFACE_PORT1) + { + // SW_BCN_SEL - Port1 -+ val8 = rtw_read8(padapter, REG_DWBCN1_CTRL_8812+2); ++ val8 = rtw_read8(padapter, REG_TDECTRL1_8812+2); + val8 |= BIT(4); -+ rtw_write8(padapter, REG_DWBCN1_CTRL_8812+2, val8); ++ rtw_write8(padapter, REG_TDECTRL1_8812+2, val8); + } + else +#endif + { + // SW_BCN_SEL - Port0 -+ val8 = rtw_read8(padapter, REG_DWBCN1_CTRL_8812+2); ++ val8 = rtw_read8(padapter, REG_TDECTRL1_8812+2); + val8 &= ~BIT(4); -+ rtw_write8(padapter, REG_DWBCN1_CTRL_8812+2, val8); ++ rtw_write8(padapter, REG_TDECTRL1_8812+2, val8); + } + break; + + case HW_VAR_WIRELESS_MODE: + { -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; + u8 R2T_SIFS = 0, SIFS_Timer = 0; + u8 wireless_mode = *pval; + @@ -277703,7 +116706,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + rtw_write8(padapter, REG_SIFS_CTX+1, SIFS_Timer); + // SIFS for OFDM consecutive tx like CTS data! + rtw_write8(padapter, REG_SIFS_TRX+1, SIFS_Timer); -+ ++ + rtw_write8(padapter,REG_SPEC_SIFS+1, SIFS_Timer); + rtw_write8(padapter,REG_MAC_SPEC_SIFS+1, SIFS_Timer); + @@ -277715,281 +116718,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + // Adjust R2T SIFS for IOT issue. Add by hpfan 2013.01.25 + // Set R2T SIFS to 0x0a for Atheros IOT. Add by hpfan 2013.02.22 + // -+ // Mac has 10 us delay so use 0xa value is enough. ++ // Mac has 10 us delay so use 0xa value is enough. + R2T_SIFS = 0xa; -+#ifdef CONFIG_80211AC_VHT -+ if (wireless_mode & WIRELESS_11_5AC && -+ //MgntLinkStatusQuery(Adapter) && -+ TEST_FLAG(pmlmepriv->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_RX) && -+ TEST_FLAG(pmlmepriv->vhtpriv.stbc_cap, STBC_VHT_ENABLE_RX)) -+ { -+ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_ATHEROS) -+ R2T_SIFS = 0x8; -+ else -+ R2T_SIFS = 0xa; -+ } -+#endif //CONFIG_80211AC_VHT + + rtw_write8(padapter, REG_RESP_SIFS_OFDM+1, R2T_SIFS); + } + break; + -+ case HW_VAR_DO_IQK: -+ pHalData->bNeedIQK = _TRUE; -+ break; -+ case HW_VAR_DL_RSVD_PAGE: -+#ifdef CONFIG_BT_COEXIST -+ if (pHalData->EEPROMBluetoothCoexist == 1) -+ { -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) -+ { -+ rtl8812a_download_BTCoex_AP_mode_rsvd_page(padapter); -+ } -+ } -+#endif // CONFIG_BT_COEXIST -+ break; -+#ifdef CONFIG_BEAMFORMING -+ -+#if (BEAMFORMING_SUPPORT == 1) /*add by YuChen for PHYDM -TxBF AutoTest HW Timer 8812A*/ -+ case HW_VAR_HW_REG_TIMER_INIT: -+ { -+ HAL_HW_TIMER_TYPE TimerType = (*(PHAL_HW_TIMER_TYPE)pval)>>16; -+ -+ rtw_write8(padapter, 0x164, 1); -+ -+ if (TimerType == HAL_TIMER_TXBF) -+ rtw_write16(padapter, 0x15C, (*(pu2Byte)pval)); -+ else if (TimerType == HAL_TIMER_EARLYMODE) -+ rtw_write32(padapter, 0x160, 0x05000190); -+ break; -+ } -+ -+ case HW_VAR_HW_REG_TIMER_START: -+ { -+ HAL_HW_TIMER_TYPE TimerType = *(PHAL_HW_TIMER_TYPE)pval; -+ -+ if (TimerType == HAL_TIMER_TXBF) -+ rtw_write8(padapter, 0x15F, 0x5); -+ else if (TimerType == HAL_TIMER_EARLYMODE) -+ rtw_write8(padapter, 0x163, 0x5); -+ break; -+ } -+ case HW_VAR_HW_REG_TIMER_RESTART: -+ { -+ HAL_HW_TIMER_TYPE TimerType = *(PHAL_HW_TIMER_TYPE)pval & 0xffff; -+ -+ if (TimerType == HAL_TIMER_TXBF) { -+ u4Byte Reg15C = (*(pu4Byte)pval) >> 16 | BIT24 | BIT26; -+ -+ rtw_write8(padapter, 0x15F, 0x0); -+ rtw_write32(padapter, 0x15F, Reg15C); -+ } else if (TimerType == HAL_TIMER_EARLYMODE) { -+ rtw_write8(padapter, 0x163, 0x0); -+ rtw_write8(padapter, 0x163, 0x5); -+ } -+ break; -+ } -+ case HW_VAR_HW_REG_TIMER_STOP: -+ { -+ HAL_HW_TIMER_TYPE TimerType = *(PHAL_HW_TIMER_TYPE)pval; -+ -+ if (TimerType == HAL_TIMER_TXBF) -+ rtw_write8(padapter, 0x15F, 0); -+ else if (TimerType == HAL_TIMER_EARLYMODE) -+ rtw_write8(padapter, 0x163, 0x0); -+ break; -+ } -+ -+#else /*(BEAMFORMING_SUPPORT == 0) - for drv beamforming*/ -+ -+ case HW_VAR_SOUNDING_ENTER: -+ SetBeamformEnter_8812(padapter, *pval); -+ break; -+ -+ case HW_VAR_SOUNDING_LEAVE: -+ SetBeamformLeave_8812(padapter, *pval); -+ break; -+ -+ case HW_VAR_SOUNDING_RATE: -+ rtw_write8(padapter, REG_NDPA_OPT_CTRL_8812A, (MRateToHwRate(pval[1]) << 2 | pval[0])); -+ break; -+ -+ case HW_VAR_SOUNDING_STATUS: -+ SetBeamformStatus_8812(padapter, *pval); -+ break; -+ -+ case HW_VAR_SOUNDING_FW_NDPA: -+ SetBeamformFwTxBF_8812(padapter, *pval); -+ break; -+ -+ case HW_VAR_SOUNDING_CLK: -+ SetBeamformingCLK_8812(padapter); -+ break; -+#endif -+ -+#endif/*#ifdef CONFIG_BEAMFORMING*/ -+ case HW_VAR_MACID_SLEEP: -+ { -+ u32 reg_macid_sleep; -+ u8 bit_shift; -+ u8 id = *(u8*)pval; -+ u32 val32; -+ -+ if (id < 32) { -+ reg_macid_sleep = REG_MACID_SLEEP; -+ bit_shift = id; -+ } else if (id < 64) { -+ reg_macid_sleep = REG_MACID_SLEEP_1; -+ bit_shift = id-32; -+ } else if (id < 96) { -+ reg_macid_sleep = REG_MACID_SLEEP_2; -+ bit_shift = id-64; -+ } else if (id < 128) { -+ reg_macid_sleep = REG_MACID_SLEEP_3; -+ bit_shift = id-96; -+ } else { -+ rtw_warn_on(1); -+ break; -+ } -+ -+ val32 = rtw_read32(padapter, reg_macid_sleep); -+ DBG_8192C(FUNC_ADPT_FMT ": [HW_VAR_MACID_SLEEP] macid=%d, org reg_0x%03x=0x%08X\n", -+ FUNC_ADPT_ARG(padapter), id, reg_macid_sleep, val32); -+ -+ if (val32 & BIT(bit_shift)) -+ break; -+ -+ val32 |= BIT(bit_shift); -+ rtw_write32(padapter, reg_macid_sleep, val32); -+ } -+ break; -+ -+ case HW_VAR_MACID_WAKEUP: -+ { -+ u32 reg_macid_sleep; -+ u8 bit_shift; -+ u8 id = *(u8*)pval; -+ u32 val32; -+ -+ if (id < 32) { -+ reg_macid_sleep = REG_MACID_SLEEP; -+ bit_shift = id; -+ } else if (id < 64) { -+ reg_macid_sleep = REG_MACID_SLEEP_1; -+ bit_shift = id-32; -+ } else if (id < 96) { -+ reg_macid_sleep = REG_MACID_SLEEP_2; -+ bit_shift = id-64; -+ } else if (id < 128) { -+ reg_macid_sleep = REG_MACID_SLEEP_3; -+ bit_shift = id-96; -+ } else { -+ rtw_warn_on(1); -+ break; -+ } -+ -+ val32 = rtw_read32(padapter, reg_macid_sleep); -+ DBG_8192C(FUNC_ADPT_FMT ": [HW_VAR_MACID_WAKEUP] macid=%d, org reg_0x%03x=0x%08X\n", -+ FUNC_ADPT_ARG(padapter), id, reg_macid_sleep, val32); -+ -+ if (!(val32 & BIT(bit_shift))) -+ break; -+ -+ val32 &= ~BIT(bit_shift); -+ rtw_write32(padapter, reg_macid_sleep, val32); -+ } -+ break; -+#ifdef CONFIG_GPIO_WAKEUP -+ case HW_SET_GPIO_WL_CTRL: -+ { -+ u8 enable = *pval; -+ u8 value = rtw_read8(padapter, 0x4e); -+ if (enable && (value & BIT(6))) { -+ value &= ~BIT(6); -+ rtw_write8(padapter, 0x4e, value); -+ } else if (enable == _FALSE){ -+ value |= BIT(6); -+ rtw_write8(padapter, 0x4e, value); -+ } -+ DBG_871X("%s: set WL control, 0x4E=0x%02X\n", -+ __func__, rtw_read8(padapter, 0x4e)); -+ } -+ break; -+#endif + default: -+ SetHwReg(padapter, variable, pval); ++ DBG_8192C("%s: [WARNNING] variable(%d) not defined!\n", __FUNCTION__, variable); + break; + } + -+_func_exit_; -+} + -+struct qinfo_8812a { -+ u32 head:8; -+ u32 pkt_num:7; -+ u32 tail:8; -+ u32 ac:2; -+ u32 macid:7; -+}; -+ -+struct bcn_qinfo_8812a { -+ u16 head:8; -+ u16 pkt_num:8; -+}; -+ -+void dump_qinfo_8812a(void *sel, struct qinfo_8812a *info, const char *tag) -+{ -+ //if (info->pkt_num) -+ DBG_871X_SEL_NL(sel, "%shead:0x%02x, tail:0x%02x, pkt_num:%u, macid:%u, ac:%u\n" -+ , tag ? tag : "", info->head, info->tail, info->pkt_num, info->macid, info->ac -+ ); -+} -+ -+void dump_bcn_qinfo_8812a(void *sel, struct bcn_qinfo_8812a *info, const char *tag) -+{ -+ //if (info->pkt_num) -+ DBG_871X_SEL_NL(sel, "%shead:0x%02x, pkt_num:%u\n" -+ , tag ? tag : "", info->head, info->pkt_num -+ ); -+} -+ -+void dump_mac_qinfo_8812a(void *sel, _adapter *adapter) -+{ -+ u32 q0_info; -+ u32 q1_info; -+ u32 q2_info; -+ u32 q3_info; -+ u32 q4_info; -+ u32 q5_info; -+ u32 q6_info; -+ u32 q7_info; -+ u32 mg_q_info; -+ u32 hi_q_info; -+ u16 bcn_q_info; -+ -+ q0_info = rtw_read32(adapter, REG_Q0_INFO); -+ q1_info = rtw_read32(adapter, REG_Q1_INFO); -+ q2_info = rtw_read32(adapter, REG_Q2_INFO); -+ q3_info = rtw_read32(adapter, REG_Q3_INFO); -+ q4_info = rtw_read32(adapter, REG_Q4_INFO); -+ q5_info = rtw_read32(adapter, REG_Q5_INFO); -+ q6_info = rtw_read32(adapter, REG_Q6_INFO); -+ q7_info = rtw_read32(adapter, REG_Q7_INFO); -+ mg_q_info = rtw_read32(adapter, REG_MGQ_INFO); -+ hi_q_info = rtw_read32(adapter, REG_HGQ_INFO); -+ bcn_q_info = rtw_read16(adapter, REG_BCNQ_INFO); -+ -+ dump_qinfo_8812a(sel, (struct qinfo_8812a *)&q0_info, "Q0 "); -+ dump_qinfo_8812a(sel, (struct qinfo_8812a *)&q1_info, "Q1 "); -+ dump_qinfo_8812a(sel, (struct qinfo_8812a *)&q2_info, "Q2 "); -+ dump_qinfo_8812a(sel, (struct qinfo_8812a *)&q3_info, "Q3 "); -+ dump_qinfo_8812a(sel, (struct qinfo_8812a *)&q4_info, "Q4 "); -+ dump_qinfo_8812a(sel, (struct qinfo_8812a *)&q5_info, "Q5 "); -+ dump_qinfo_8812a(sel, (struct qinfo_8812a *)&q6_info, "Q6 "); -+ dump_qinfo_8812a(sel, (struct qinfo_8812a *)&q7_info, "Q7 "); -+ dump_qinfo_8812a(sel, (struct qinfo_8812a *)&mg_q_info, "MG "); -+ dump_qinfo_8812a(sel, (struct qinfo_8812a *)&hi_q_info, "HI "); -+ dump_bcn_qinfo_8812a(sel, (struct bcn_qinfo_8812a *)&bcn_q_info, "BCN "); +} + +void GetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval) @@ -278000,13 +116741,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + u16 val16; + u32 val32; + -+_func_enter_; ++ + + pHalData = GET_HAL_DATA(padapter); + podmpriv = &pHalData->odmpriv; + + switch (variable) + { ++ case HW_VAR_BASIC_RATE: ++ *(u16*)pval = pHalData->BasicRateSet; ++ break; ++ + case HW_VAR_TXPAUSE: + *pval = rtw_read8(padapter, REG_TXPAUSE); + break; @@ -278015,25 +116760,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +#ifdef CONFIG_CONCURRENT_MODE + if (IS_HARDWARE_TYPE_8821(padapter) && padapter->iface_type == IFACE_PORT1) + { -+ val8 = rtw_read8(padapter, REG_DWBCN1_CTRL_8812+2); -+ *pval = (BIT(0) & val8) ? _TRUE:_FALSE; ++ val8 = rtw_read8(padapter, REG_TDECTRL1_8812+2); ++ *pval = (BIT(0) & val8) ? true:false; + } + else +#endif + { + //BCN_VALID, BIT16 of REG_TDECTRL = BIT0 of REG_TDECTRL+2 + val8 = rtw_read8(padapter, REG_TDECTRL+2); -+ *pval = (BIT(0) & val8) ? _TRUE:_FALSE; ++ *pval = (BIT(0) & val8) ? true:false; + } + break; + ++ case HW_VAR_DM_FLAG: ++ *pval = podmpriv->SupportAbility; ++ break; ++ ++ case HW_VAR_RF_TYPE: ++ *pval = pHalData->rf_type; ++ break; ++ + case HW_VAR_FWLPS_RF_ON: + //When we halt NIC, we should check if FW LPS is leave. -+ if(adapter_to_pwrctl(padapter)->rf_pwrstate == rf_off) ++ if(padapter->pwrctrlpriv.rf_pwrstate == rf_off) + { + // If it is in HW/SW Radio OFF or IPS state, we do not check Fw LPS Leave, + // because Fw is unload. -+ *pval = _TRUE; ++ *pval = true; + } + else + { @@ -278041,11 +116794,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + valRCR = rtw_read32(padapter, REG_RCR); + valRCR &= 0x00070000; + if(valRCR) -+ *pval = _FALSE; ++ *pval = false; + else -+ *pval = _TRUE; ++ *pval = true; + } -+ ++ + break; + +#ifdef CONFIG_ANTENNA_DIVERSITY @@ -278055,7 +116808,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +#endif + + case HW_VAR_EFUSE_BYTES: // To get EFUE total used bytes, added by Roger, 2008.12.22. -+ *(u16*)pval = pHalData->EfuseUsedBytes; ++ *(u16*)pval = pHalData->EfuseUsedBytes; + break; + + case HW_VAR_APFM_ON_MAC: @@ -278064,19 +116817,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + case HW_VAR_CHK_HI_QUEUE_EMPTY: + val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); -+ *pval = (val16 & BIT(10)) ? _TRUE:_FALSE; -+ break; -+ -+ case HW_VAR_DUMP_MAC_QUEUE_INFO: -+ dump_mac_qinfo_8812a(pval, padapter); ++ *pval = (val16 & BIT(10)) ? true:false; + break; + + default: -+ GetHwReg(padapter, variable, pval); ++ DBG_8192C("%s: [WARNNING] variable(%d) not defined!\n", __FUNCTION__, variable); + break; + } + -+_func_exit_; ++ +} + +/* @@ -278094,8 +116843,109 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + switch (variable) + { ++ case HAL_DEF_DBG_DM_FUNC: ++ { ++ u8 dm_func; ++ struct dm_priv *pdmpriv; ++ DM_ODM_T *podmpriv; ++ ++ ++ dm_func = *((u8*)pval); ++ pdmpriv = &pHalData->dmpriv; ++ podmpriv = &pHalData->odmpriv; ++ ++ if (dm_func == 0) ++ { ++ //disable all dynamic func ++ podmpriv->SupportAbility = DYNAMIC_FUNC_DISABLE; ++ DBG_8192C("==> Disable all dynamic function...\n"); ++ } ++ else if (dm_func == 1) ++ { ++ // disable DIG ++ podmpriv->SupportAbility &= (~DYNAMIC_BB_DIG); ++ DBG_8192C("==> Disable DIG...\n"); ++ } ++ else if (dm_func == 2) ++ { ++ // disable High power ++ podmpriv->SupportAbility &= (~DYNAMIC_BB_DYNAMIC_TXPWR); ++ } ++ else if (dm_func == 3) ++ { ++ // disable tx power tracking ++ podmpriv->SupportAbility &= (~DYNAMIC_RF_CALIBRATION); ++ DBG_8192C("==> Disable tx power tracking...\n"); ++ } ++// else if (dm_func == 4) ++// { ++ // disable BT coexistence ++// pdmpriv->DMFlag &= (~DYNAMIC_FUNC_BT); ++// } ++ else if (dm_func == 5) ++ { ++ // disable antenna diversity ++ podmpriv->SupportAbility &= (~DYNAMIC_BB_ANT_DIV); ++ } ++ else if (dm_func == 6) ++ { ++ // turn on all dynamic func ++ if (!(podmpriv->SupportAbility & DYNAMIC_BB_DIG)) ++ { ++ pDIG_T pDigTable = &podmpriv->DM_DigTable; ++ pDigTable->CurIGValue = rtw_read8(padapter, 0xc50); ++ } ++// pdmpriv->DMFlag |= DYNAMIC_FUNC_BT; ++ podmpriv->SupportAbility = DYNAMIC_ALL_FUNC_ENABLE; ++ DBG_8192C("==> Turn on all dynamic function...\n"); ++ } ++ } ++ break; ++ ++ case HAL_DEF_DBG_DUMP_RXPKT: ++ pHalData->bDumpRxPkt = *(u8*)pval; ++ break; ++ ++ case HAL_DEF_DBG_DUMP_TXPKT: ++ pHalData->bDumpTxPkt = *(u8*)pval; ++ break; ++ ++ case HW_DEF_FA_CNT_DUMP: ++ { ++ u8 mac_id; ++ PDM_ODM_T pDM_Odm; ++ ++ ++ mac_id = *(u8*)pval; ++ pDM_Odm = &pHalData->odmpriv; ++ ++ if (padapter->bLinkInfoDump & BIT(1)) ++ pDM_Odm->DebugComponents |= ODM_COMP_DIG; ++ else ++ pDM_Odm->DebugComponents &= ~ODM_COMP_DIG; ++ ++ if (padapter->bLinkInfoDump & BIT(2)) ++ pDM_Odm->DebugComponents |= ODM_COMP_FA_CNT; ++ else ++ pDM_Odm->DebugComponents &= ~ODM_COMP_FA_CNT; ++ } ++ break; ++ ++ case HW_DEF_ODM_DBG_FLAG: ++ { ++ u64 DebugComponents; ++ PDM_ODM_T pDM_Odm; ++ ++ ++ DebugComponents = *((u64*)pval); ++ pDM_Odm = &pHalData->odmpriv; ++ pDM_Odm->DebugComponents = DebugComponents; ++ } ++ break; ++ + default: -+ bResult = SetHalDefVar(padapter, variable, pval); ++ DBG_8192C("%s: [ERROR] HAL_DEF_VARIABLE(%d) not defined!\n", __FUNCTION__, variable); ++ bResult = _FAIL; + break; + } + @@ -278103,7 +116953,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 +} + +/* -+ * Description: ++ * Description: + * Query setting of specified variable. + */ +u8 GetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval) @@ -278117,11 +116967,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + + switch (variable) + { -+ ++ case HAL_DEF_UNDERCORATEDSMOOTHEDPWDB: ++ { ++ struct mlme_priv *pmlmepriv; ++ struct sta_priv *pstapriv; ++ struct sta_info *psta; ++ ++ pmlmepriv = &padapter->mlmepriv; ++ pstapriv = &padapter->stapriv; ++ psta = rtw_get_stainfo(pstapriv, pmlmepriv->cur_network.network.MacAddress); ++ if (psta) ++ { ++ *((int*)pval) = psta->rssi_stat.UndecoratedSmoothedPWDB; ++ } ++ } ++ break; + +#ifdef CONFIG_ANTENNA_DIVERSITY + case HAL_DEF_IS_SUPPORT_ANT_DIV: -+ *((u8*)pval) = (pHalData->AntDivCfg==0) ? _FALSE : _TRUE; ++ *((u8*)pval) = (pHalData->AntDivCfg==0) ? false : true; + break; +#endif + @@ -278140,33 +117004,53 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + break; + + case HAL_DEF_RX_PACKET_OFFSET: -+ *((u32*)pval) = RXDESC_SIZE + DRVINFO_SZ*8; ++ *((u32*)pval) = RXDESC_SIZE + DRVINFO_SZ; + break; + ++ case HAL_DEF_DBG_DM_FUNC: ++ *((u32*)pval) = pHalData->odmpriv.SupportAbility; ++ break; ++ ++#if (RATE_ADAPTIVE_SUPPORT == 1) ++ case HAL_DEF_RA_DECISION_RATE: ++ { ++ u8 MacID = *(u8*)pval; ++ *((u8*)pval) = ODM_RA_GetDecisionRate_8812A(&pHalData->odmpriv, MacID); ++ } ++ break; ++ ++ case HAL_DEF_RA_SGI: ++ { ++ u8 MacID = *(u8*)pval; ++ *((u8*)pval) = ODM_RA_GetShortGI_8812A(&pHalData->odmpriv, MacID); ++ } ++ break; ++#endif // (RATE_ADAPTIVE_SUPPORT == 1) ++ ++#if (POWER_TRAINING_ACTIVE == 1) ++ case HAL_DEF_PT_PWR_STATUS: ++ { ++ u8 MacID = *(u8*)pval; ++ *(u8*)pval = ODM_RA_GetHwPwrStatus_8812A(&pHalData->odmpriv, MacID); ++ } ++ break; ++#endif //(POWER_TRAINING_ACTIVE == 1) ++ + case HW_VAR_MAX_RX_AMPDU_FACTOR: + *((u32*)pval) = MAX_AMPDU_FACTOR_64K; + break; + -+ case HW_VAR_BEST_AMPDU_DENSITY: -+ *((u32 *)pval) = AMPDU_DENSITY_VALUE_7; -+ break; -+ -+ case HAL_DEF_TX_LDPC: ++ case HAL_DEF_LDPC: + if (IS_VENDOR_8812A_C_CUT(padapter)) -+ *(u8*)pval = _TRUE; ++ *(u8*)pval = true; + else if (IS_HARDWARE_TYPE_8821(padapter)) -+ *(u8*)pval = _TRUE; ++ *(u8*)pval = false; + else -+ *(u8*)pval = _FALSE; -+ break; -+ -+ case HAL_DEF_RX_LDPC: -+ if (IS_VENDOR_8812A_C_CUT(padapter)) -+ *(u8*)pval = _TRUE; -+ else if (IS_HARDWARE_TYPE_8821(padapter)) -+ *(u8*)pval = _FALSE; -+ else -+ *(u8*)pval = _FALSE; ++ *(u8*)pval = false; ++#if (MP_DRIVER == 1) ++ if (padapter->registrypriv.mp_mode == 1) ++ *(u8*)pval = true; ++#endif + break; + + case HAL_DEF_TX_STBC: @@ -278180,70 +117064,61 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + *(u8*)pval = 1; + break; + -+ case HAL_DEF_EXPLICIT_BEAMFORMER: -+ if(pHalData->rf_type == RF_2T2R) -+ *((PBOOLEAN)pval) = _TRUE; -+ else -+ *((PBOOLEAN)pval) = _FALSE; -+ break; -+ -+ case HAL_DEF_EXPLICIT_BEAMFORMEE: -+ *((PBOOLEAN)pval) = _TRUE; -+ break; -+ + case HW_DEF_RA_INFO_DUMP: + { + u8 mac_id = *(u8*)pval; -+ u32 cmd ; ++ u32 cmd = 0x40000400 | mac_id; + u32 ra_info1, ra_info2; + u32 rate_mask1, rate_mask2; -+ u8 curr_tx_rate,curr_tx_sgi,hight_rate,lowest_rate; -+ -+ DBG_8192C("============ RA status check Mac_id:%d ===================\n", mac_id); + -+ cmd = 0x40000100 |mac_id; -+ rtw_write32(padapter,REG_HMEBOX_E2_E3_8812,cmd); -+ rtw_msleep_os(10); -+ ra_info1 = rtw_read32(padapter,REG_RSVD5_8812); -+ curr_tx_rate = ra_info1&0x7F; -+ curr_tx_sgi = (ra_info1>>7)&0x01; -+ DBG_8192C("[ ra_info1:0x%08x ] =>cur_tx_rate= %s,cur_sgi:%d, PWRSTS = 0x%02x \n", -+ ra_info1, -+ HDATA_RATE(curr_tx_rate), -+ curr_tx_sgi, -+ (ra_info1>>8) & 0x07); ++ if ((padapter->bLinkInfoDump & BIT(0)) ++ && (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == true)) ++ { ++ DBG_8192C("============ RA status check Mac_id:%d ===================\n", mac_id); + -+ cmd = 0x40000400 | mac_id; -+ rtw_write32(padapter, REG_HMEBOX_E2_E3_8812,cmd); -+ rtw_msleep_os(10); -+ ra_info1 = rtw_read32(padapter, REG_RSVD5_8812); -+ ra_info2 = rtw_read32(padapter, REG_RSVD6_8812); -+ rate_mask1 = rtw_read32(padapter,REG_RSVD7_8812); -+ rate_mask2 = rtw_read32(padapter,REG_RSVD8_8812); -+ hight_rate = ra_info2&0xFF; -+ lowest_rate = (ra_info2>>8) & 0xFF; -+ DBG_8192C("[ ra_info1:0x%08x ] =>RSSI=%d, BW_setting=0x%02x, DISRA=0x%02x, VHT_EN=0x%02x\n", -+ ra_info1, -+ ra_info1&0xFF, -+ (ra_info1>>8) & 0xFF, -+ (ra_info1>>16) & 0xFF, -+ (ra_info1>>24) & 0xFF); -+ -+ DBG_8192C("[ ra_info2:0x%08x ] =>hight_rate=%s, lowest_rate=%s, SGI=0x%02x, RateID=%d\n", -+ ra_info2, -+ HDATA_RATE(hight_rate), -+ HDATA_RATE(lowest_rate), -+ (ra_info2>>16) & 0xFF, -+ (ra_info2>>24) & 0xFF); -+ DBG_8192C("rate_mask2=0x%08x, rate_mask1=0x%08x\n", rate_mask2, rate_mask1); ++ rtw_write32(padapter, REG_HMEBOX_E2_E3_8812,cmd); ++ ra_info1 = rtw_read32(padapter, REG_RSVD5_8812); ++ ra_info2 = rtw_read32(padapter, REG_RSVD6_8812); ++ rate_mask1 = rtw_read32(padapter,REG_RSVD7_8812); ++ rate_mask2 = rtw_read32(padapter,REG_RSVD8_8812); ++ ++ DBG_8192C("[ ra_info1:0x%08x ] =>RSSI=%d, BW_setting=0x%02x, DISRA=0x%02x, VHT_EN=0x%02x\n", ++ ra_info1, ++ ra_info1&0xFF, ++ (ra_info1>>8) & 0xFF, ++ (ra_info1>>16) & 0xFF, ++ (ra_info1>>24) & 0xFF); ++ ++ DBG_8192C("[ ra_info2:0x%08x ] =>hight_rate=0x%02x, lowest_rate=0x%02x, SGI=0x%02x, RateID=%d\n", ++ ra_info2, ++ ra_info2&0xFF, ++ (ra_info2>>8) & 0xFF, ++ (ra_info2>>16) & 0xFF, ++ (ra_info2>>24) & 0xFF); ++ ++ DBG_8192C("rate_mask2=0x%08x, rate_mask1=0x%08x\n", rate_mask2, rate_mask1); ++ } + } + break; + -+ case HAL_DEF_TX_PAGE_SIZE: -+ if (IS_HARDWARE_TYPE_8812(padapter)) -+ *(u32*)pval = PAGE_SIZE_512; -+ else -+ *(u32*)pval = PAGE_SIZE_256; ++ case HAL_DEF_DBG_DUMP_RXPKT: ++ *(u8*)pval = pHalData->bDumpRxPkt; ++ break; ++ ++ case HAL_DEF_DBG_DUMP_TXPKT: ++ *(u8*)pval = pHalData->bDumpTxPkt; ++ break; ++ ++ case HW_DEF_ODM_DBG_FLAG: ++ { ++ u64 DebugComponents; ++ PDM_ODM_T pDM_Odm; ++ ++ pDM_Odm = &pHalData->odmpriv; ++ DebugComponents = pDM_Odm->DebugComponents; ++ DBG_8192C("%s: pDM_Odm->DebugComponents=0x%llx\n", __FUNCTION__, DebugComponents); ++ *((u64*)pval) = DebugComponents; ++ } + break; + + case HAL_DEF_TX_PAGE_BOUNDARY: @@ -278267,134 +117142,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + *(u8*)pval = TX_PAGE_BOUNDARY_WOWLAN_8812; + break; + -+ case HAL_DEF_MACID_SLEEP: -+ *(u8*)pval = _TRUE; // support macid sleep -+ break; -+ case HAL_DEF_RX_DMA_SZ_WOW: -+ if (IS_HARDWARE_TYPE_8821(padapter)) -+ *(u32 *)pval = MAX_RX_DMA_BUFFER_SIZE_8821 - RESV_FMWF; -+ else -+ *(u32 *)pval = MAX_RX_DMA_BUFFER_SIZE_8812 - RESV_FMWF; -+ break; -+ case HAL_DEF_RX_DMA_SZ: -+ if (IS_HARDWARE_TYPE_8821(padapter)) -+ *(u32 *)pval = RX_DMA_BOUNDARY_8821 + 1; -+ else -+ *(u32 *)pval = RX_DMA_BOUNDARY_8812 + 1; -+ break; -+ case HAL_DEF_RX_PAGE_SIZE: -+ *((u32 *)pval) = 8; -+ break; + default: -+ bResult = GetHalDefVar(padapter, variable, pval); ++ DBG_8192C("%s: [ERROR] HAL_DEF_VARIABLE(%d) not defined!\n", __FUNCTION__, variable); ++ bResult = _FAIL; + break; + } + + return bResult; +} -+s32 c2h_id_filter_ccx_8812a(u8 *buf) -+{ -+ struct c2h_evt_hdr_88xx *c2h_evt = (struct c2h_evt_hdr_88xx *)buf; -+ s32 ret = _FALSE; -+ if (c2h_evt->id == C2H_8812_TX_REPORT) -+ ret = _TRUE; -+ -+ return ret; -+} -+ -+static s32 c2h_handler_8812a(PADAPTER padapter, u8 *buf) -+{ -+ struct c2h_evt_hdr_88xx *c2h_evt = (struct c2h_evt_hdr_88xx *)buf; -+ s32 ret = _SUCCESS; -+ -+ if (c2h_evt == NULL) { -+ DBG_8192C("%s c2h_evt is NULL\n",__FUNCTION__); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ ret = _C2HContentParsing8812(padapter, c2h_evt->id, c2h_evt->plen, c2h_evt->payload); -+ -+exit: -+ return ret; -+} -+ -+#ifdef CONFIG_BT_COEXIST -+void rtl8812a_combo_card_WifiOnlyHwInit(PADAPTER pdapter) -+{ -+ u8 u1Tmp; -+ DBG_871X("%s !\n", __FUNCTION__); -+ if(IS_HARDWARE_TYPE_8812(pdapter)) -+ { -+ //0x790[5:0]=0x5 -+ u1Tmp = rtw_read8(pdapter,0x790); -+ u1Tmp = (u1Tmp & 0xb0) | 0x05 ; -+ rtw_write8(pdapter,0x790,u1Tmp); -+ // PTA parameter -+ //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, 0x0); -+ //pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, 0xffffff); -+ //pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, 0x55555555); -+ //pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, 0x55555555); -+ rtw_write8(pdapter,0x6cc,0x0); -+ rtw_write32(pdapter,0x6c8,0xffffff); -+ rtw_write32(pdapter,0x6c4,0x55555555); -+ rtw_write32(pdapter,0x6c0,0x55555555); -+ -+ // coex parameters -+ //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x3); -+ rtw_write8(pdapter,0x778,0x3); -+ -+ // enable counter statistics -+ //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+ rtw_write8(pdapter,0x76e,0xc); -+ -+ // enable PTA -+ //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x20); -+ rtw_write8(pdapter,0x40, 0x20); -+ -+ // bt clock related -+ //u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4); -+ //u1Tmp |= BIT7; -+ //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4, u1Tmp); -+ u1Tmp = rtw_read8(pdapter,0x4); -+ u1Tmp |= BIT7; -+ rtw_write8(pdapter,0x4, u1Tmp); -+ -+ // bt clock related -+ //u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x7); -+ //u1Tmp |= BIT1; -+ //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x7, u1Tmp); -+ u1Tmp = rtw_read8(pdapter,0x7); -+ u1Tmp |= BIT1; -+ rtw_write8(pdapter,0x7, u1Tmp); -+ } -+ -+ -+} -+#endif //CONFIG_BT_COEXIST + +void rtl8812_set_hal_ops(struct hal_ops *pHalFunc) +{ ++ pHalFunc->free_hal_data = &rtl8812_free_hal_data; ++ + pHalFunc->dm_init = &rtl8812_init_dm_priv; + pHalFunc->dm_deinit = &rtl8812_deinit_dm_priv; + -+ pHalFunc->SetBeaconRelatedRegistersHandler = &SetBeaconRelatedRegisters8812A; -+ + pHalFunc->UpdateRAMaskHandler = &UpdateHalRAMask8812A; + -+ pHalFunc->read_chip_version = read_chip_version_8812a; ++ pHalFunc->read_chip_version = &ReadChipVersion8812A; + + pHalFunc->set_bwmode_handler = &PHY_SetBWMode8812; + pHalFunc->set_channel_handler = &PHY_SwChnl8812; + pHalFunc->set_chnl_bw_handler = &PHY_SetSwChnlBWMode8812; + -+ pHalFunc->set_tx_power_level_handler = &PHY_SetTxPowerLevel8812; -+ pHalFunc->get_tx_power_level_handler = &PHY_GetTxPowerLevel8812; -+ + pHalFunc->hal_dm_watchdog = &rtl8812_HalDmWatchDog; + + pHalFunc->Add_RateATid = &rtl8812_Add_RateATid; -+ ++#ifdef CONFIG_CONCURRENT_MODE ++ pHalFunc->clone_haldata = &rtl8812_clone_haldata; ++#endif + pHalFunc->run_thread= &rtl8812_start_thread; + pHalFunc->cancel_thread= &rtl8812_stop_thread; + @@ -278428,2326 +117205,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_hal_init.c linux/3 + pHalFunc->sreset_inprogress= &sreset_inprogress; +#endif //DBG_CONFIG_ERROR_DETECT + -+ pHalFunc->GetHalODMVarHandler = GetHalODMVar; -+ pHalFunc->SetHalODMVarHandler = SetHalODMVar; ++ pHalFunc->GetHalODMVarHandler = &rtl8812_GetHalODMVar; ++ pHalFunc->SetHalODMVarHandler = &rtl8812_SetHalODMVar; + pHalFunc->hal_notch_filter = &hal_notch_filter_8812; + + pHalFunc->SetBeaconRelatedRegistersHandler = &SetBeaconRelatedRegisters8812A; -+ -+ pHalFunc->c2h_handler = c2h_handler_8812a; -+ pHalFunc->c2h_id_filter_ccx = c2h_id_filter_ccx_8812a; -+ -+ pHalFunc->fill_h2c_cmd = &FillH2CCmd_8812; -+ pHalFunc->fill_fake_txdesc = &rtl8812a_fill_fake_txdesc; -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ pHalFunc->hal_set_wowlan_fw = &SetFwRelatedForWoWLAN8812; -+#endif -+ pHalFunc->hal_get_tx_buff_rsvd_page_num = &GetTxBufferRsvdPageNum8812; +} -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_phycfg.c linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_phycfg.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_phycfg.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_phycfg.c 2017-06-07 23:07:21.033689581 +0300 -@@ -0,0 +1,2100 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTL8812A_PHYCFG_C_ -+ -+//#include -+ -+#include -+ -+ -+const char *const GLBwSrc[]={ -+ "CHANNEL_WIDTH_20", -+ "CHANNEL_WIDTH_40", -+ "CHANNEL_WIDTH_80", -+ "CHANNEL_WIDTH_160", -+ "CHANNEL_WIDTH_80_80" -+}; -+#define ENABLE_POWER_BY_RATE 1 -+#define POWERINDEX_ARRAY_SIZE 48 //= cckRatesSize + ofdmRatesSize + htRates1TSize + htRates2TSize + vhtRates1TSize + vhtRates1TSize; -+ -+/*---------------------Define local function prototype-----------------------*/ -+ -+/*----------------------------Function Body----------------------------------*/ -+ -+// -+// 1. BB register R/W API -+// -+ -+u32 -+PHY_QueryBBReg8812( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask -+ ) -+{ -+ u32 ReturnValue = 0, OriginalValue, BitShift; -+ -+#if (DISABLE_BB_RF == 1) -+ return 0; -+#endif -+ -+ //DBG_871X("--->PHY_QueryBBReg8812(): RegAddr(%#x), BitMask(%#x)\n", RegAddr, BitMask); -+ -+ -+ OriginalValue = rtw_read32(Adapter, RegAddr); -+ BitShift = PHY_CalculateBitShift(BitMask); -+ ReturnValue = (OriginalValue & BitMask) >> BitShift; -+ -+ //DBG_871X("BBR MASK=0x%x Addr[0x%x]=0x%x\n", BitMask, RegAddr, OriginalValue); -+ return (ReturnValue); -+} -+ -+ -+VOID -+PHY_SetBBReg8812( -+ IN PADAPTER Adapter, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ) -+{ -+ u4Byte OriginalValue, BitShift; -+ -+#if (DISABLE_BB_RF == 1) -+ return; -+#endif -+ -+ if(BitMask!= bMaskDWord) -+ {//if not "double word" write -+ OriginalValue = rtw_read32(Adapter, RegAddr); -+ BitShift = PHY_CalculateBitShift(BitMask); -+ Data = ((OriginalValue) & (~BitMask)) |( ((Data << BitShift)) & BitMask); -+ } -+ -+ rtw_write32(Adapter, RegAddr, Data); -+ -+ //DBG_871X("BBW MASK=0x%x Addr[0x%x]=0x%x\n", BitMask, RegAddr, Data); -+} -+ -+// -+// 2. RF register R/W API -+// -+ -+static u32 -+phy_RFSerialRead( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset -+ ) -+{ -+ u32 retValue = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ BB_REGISTER_DEFINITION_T *pPhyReg = &pHalData->PHYRegDef[eRFPath]; -+ BOOLEAN bIsPIMode = _FALSE; -+ -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(Adapter)->rf_read_reg_mutex) , NULL); -+ // 2009/06/17 MH We can not execute IO for power save or other accident mode. -+ //if(RT_CANNOT_IO(Adapter)) -+ //{ -+ // RT_DISP(FPHY, PHY_RFR, ("phy_RFSerialRead return all one\n")); -+ // return 0xFFFFFFFF; -+ //} -+ -+ // <20120809, Kordan> CCA OFF(when entering), asked by James to avoid reading the wrong value. -+ // <20120828, Kordan> Toggling CCA would affect RF 0x0, skip it! -+ if (Offset != 0x0 && ! (IS_VENDOR_8812A_C_CUT(Adapter) || IS_HARDWARE_TYPE_8821(Adapter))) -+ PHY_SetBBReg(Adapter, rCCAonSec_Jaguar, 0x8, 1); -+ -+ Offset &= 0xff; -+ -+ if (eRFPath == RF_PATH_A) -+ bIsPIMode = (BOOLEAN)PHY_QueryBBReg(Adapter, 0xC00, 0x4); -+ else if (eRFPath == RF_PATH_B) -+ bIsPIMode = (BOOLEAN)PHY_QueryBBReg(Adapter, 0xE00, 0x4); -+ -+ PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, bHSSIRead_addr_Jaguar, Offset); -+ -+ if (IS_VENDOR_8812A_C_CUT(Adapter) || IS_HARDWARE_TYPE_8821(Adapter)) -+ rtw_udelay_os(20); -+ -+ if (bIsPIMode) -+ { -+ retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBackPi, rRead_data_Jaguar); -+ //DBG_871X("[PI mode] RFR-%d Addr[0x%x]=0x%x\n", eRFPath, pPhyReg->rfLSSIReadBackPi, retValue); -+ } -+ else -+ { -+ retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBack, rRead_data_Jaguar); -+ //DBG_871X("[SI mode] RFR-%d Addr[0x%x]=0x%x\n", eRFPath, pPhyReg->rfLSSIReadBack, retValue); -+ } -+ -+ // <20120809, Kordan> CCA ON(when exiting), asked by James to avoid reading the wrong value. -+ // <20120828, Kordan> Toggling CCA would affect RF 0x0, skip it! -+ if (Offset != 0x0 && ! (IS_VENDOR_8812A_C_CUT(Adapter) || IS_HARDWARE_TYPE_8821(Adapter))) -+ PHY_SetBBReg(Adapter, rCCAonSec_Jaguar, 0x8, 0); -+ -+ _exit_critical_mutex(&(adapter_to_dvobj(Adapter)->rf_read_reg_mutex), NULL); -+ return retValue; -+} -+ -+ -+static VOID -+phy_RFSerialWrite( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset, -+ IN u32 Data -+ ) -+{ -+ u32 DataAndAddr = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ BB_REGISTER_DEFINITION_T *pPhyReg = &pHalData->PHYRegDef[eRFPath]; -+ -+ // 2009/06/17 MH We can not execute IO for power save or other accident mode. -+ //if(RT_CANNOT_IO(Adapter)) -+ //{ -+ // RTPRINT(FPHY, PHY_RFW, ("phy_RFSerialWrite stop\n")); -+ // return; -+ //} -+ -+ Offset &= 0xff; -+ -+ // Shadow Update -+ //PHY_RFShadowWrite(Adapter, eRFPath, Offset, Data); -+ -+ // Put write addr in [27:20] and write data in [19:00] -+ DataAndAddr = ((Offset<<20) | (Data&0x000fffff)) & 0x0fffffff; -+ -+ // Write Operation -+ // TODO: Dynamically determine whether using PI or SI to write RF registers. -+ PHY_SetBBReg(Adapter, pPhyReg->rf3wireOffset, bMaskDWord, DataAndAddr); -+ //DBG_871X("RFW-%d Addr[0x%x]=0x%x\n", eRFPath, pPhyReg->rf3wireOffset, DataAndAddr); -+ -+} -+ -+u32 -+PHY_QueryRFReg8812( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask -+ ) -+{ -+ u32 Original_Value, Readback_Value, BitShift; -+ -+#if (DISABLE_BB_RF == 1) -+ return 0; -+#endif -+ -+ Original_Value = phy_RFSerialRead(Adapter, eRFPath, RegAddr); -+ -+ BitShift = PHY_CalculateBitShift(BitMask); -+ Readback_Value = (Original_Value & BitMask) >> BitShift; -+ -+ return (Readback_Value); -+} -+ -+VOID -+PHY_SetRFReg8812( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+ ) -+{ -+#if (DISABLE_BB_RF == 1) -+ return; -+#endif -+ -+ if(BitMask == 0) -+ return; -+ -+ // RF data is 20 bits only -+ if (BitMask != bLSSIWrite_data_Jaguar) { -+ u32 Original_Value, BitShift; -+ Original_Value = phy_RFSerialRead(Adapter, eRFPath, RegAddr); -+ BitShift = PHY_CalculateBitShift(BitMask); -+ Data = ((Original_Value) & (~BitMask)) | (Data<< BitShift); -+ } -+ -+ phy_RFSerialWrite(Adapter, eRFPath, RegAddr, Data); -+ -+} -+ -+// -+// 3. Initial MAC/BB/RF config by reading MAC/BB/RF txt. -+// -+ -+s32 PHY_MACConfig8812(PADAPTER Adapter) -+{ -+ int rtStatus = _FAIL; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ s8 *pszMACRegFile; -+ s8 sz8812MACRegFile[] = RTL8812_PHY_MACREG; -+ s8 sz8821MACRegFile[] = RTL8821_PHY_MACREG; -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ { -+ pszMACRegFile = sz8812MACRegFile; -+ } -+ else -+ { -+ pszMACRegFile = sz8821MACRegFile; -+ } -+ -+ // -+ // Config MAC -+ // -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ rtStatus = phy_ConfigMACWithParaFile(Adapter, pszMACRegFile); -+ if (rtStatus == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ ODM_ConfigMACWithHeaderFile(&pHalData->odmpriv); -+ rtStatus = _SUCCESS; -+#endif//CONFIG_EMBEDDED_FWIMG -+ } -+ -+ return rtStatus; -+} -+ -+ -+static VOID -+phy_InitBBRFRegisterDefinition( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ // RF Interface Sowrtware Control -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfs = rFPGA0_XAB_RFInterfaceSW; // 16 LSBs if read 32-bit from 0x870 -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfs = rFPGA0_XAB_RFInterfaceSW; // 16 MSBs if read 32-bit from 0x870 (16-bit for 0x872) -+ -+ // RF Interface Output (and Enable) -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfo = rFPGA0_XA_RFInterfaceOE; // 16 LSBs if read 32-bit from 0x860 -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfo = rFPGA0_XB_RFInterfaceOE; // 16 LSBs if read 32-bit from 0x864 -+ -+ // RF Interface (Output and) Enable -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfe = rFPGA0_XA_RFInterfaceOE; // 16 MSBs if read 32-bit from 0x860 (16-bit for 0x862) -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfe = rFPGA0_XB_RFInterfaceOE; // 16 MSBs if read 32-bit from 0x864 (16-bit for 0x866) -+ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rf3wireOffset = rA_LSSIWrite_Jaguar; //LSSI Parameter -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rf3wireOffset = rB_LSSIWrite_Jaguar; -+ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfHSSIPara2 = rHSSIRead_Jaguar; //wire control parameter2 -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfHSSIPara2 = rHSSIRead_Jaguar; //wire control parameter2 -+ -+ // Tranceiver Readback LSSI/HSPI mode -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfLSSIReadBack = rA_SIRead_Jaguar; -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfLSSIReadBack = rB_SIRead_Jaguar; -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfLSSIReadBackPi = rA_PIRead_Jaguar; -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfLSSIReadBackPi = rB_PIRead_Jaguar; -+} -+ -+VOID -+PHY_BB8812_Config_1T( -+ IN PADAPTER Adapter -+ ) -+{ -+ // BB OFDM RX Path_A -+ PHY_SetBBReg(Adapter, rRxPath_Jaguar, bRxPath_Jaguar, 0x11); -+ // BB OFDM TX Path_A -+ PHY_SetBBReg(Adapter, rTxPath_Jaguar, bMaskLWord, 0x1111); -+ // BB CCK R/Rx Path_A -+ PHY_SetBBReg(Adapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); -+ // MCS support -+ PHY_SetBBReg(Adapter, 0x8bc, 0xc0000060, 0x4); -+ // RF Path_B HSSI OFF -+ PHY_SetBBReg(Adapter, 0xe00, 0xf, 0x4); -+ // RF Path_B Power Down -+ PHY_SetBBReg(Adapter, 0xe90, bMaskDWord, 0); -+ // ADDA Path_B OFF -+ PHY_SetBBReg(Adapter, 0xe60, bMaskDWord, 0); -+ PHY_SetBBReg(Adapter, 0xe64, bMaskDWord, 0); -+} -+ -+ -+static int -+phy_BB8812_Config_ParaFile( -+ IN PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rtStatus = _SUCCESS; -+ -+ s8 sz8812BBRegFile[] = RTL8812_PHY_REG; -+ s8 sz8812AGCTableFile[] = RTL8812_AGC_TAB; -+ s8 sz8812BBRegPgFile[] = RTL8812_PHY_REG_PG; -+ s8 sz8812BBRegMpFile[] = RTL8812_PHY_REG_MP; -+ s8 sz8812BBRegLimitFile[] = RTL8812_TXPWR_LMT; -+ -+ s8 sz8821BBRegFile[] = RTL8821_PHY_REG; -+ s8 sz8821AGCTableFile[] = RTL8821_AGC_TAB; -+ s8 sz8821BBRegPgFile[] = RTL8821_PHY_REG_PG; -+ s8 sz8821BBRegMpFile[] = RTL8821_PHY_REG_MP; -+ s8 sz8821RFTxPwrLmtFile[] = RTL8821_TXPWR_LMT; -+ s8 *pszBBRegFile = NULL, *pszAGCTableFile = NULL, -+ *pszBBRegPgFile = NULL, *pszBBRegMpFile=NULL, -+ *pszRFTxPwrLmtFile = NULL; -+ -+ -+ //DBG_871X("==>phy_BB8812_Config_ParaFile\n"); -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ { -+ pszBBRegFile=sz8812BBRegFile ; -+ pszAGCTableFile =sz8812AGCTableFile; -+ pszBBRegPgFile = sz8812BBRegPgFile; -+ pszBBRegMpFile = sz8812BBRegMpFile; -+ pszRFTxPwrLmtFile = sz8812BBRegLimitFile; -+ } -+ else -+ { -+ pszBBRegFile=sz8821BBRegFile ; -+ pszAGCTableFile =sz8821AGCTableFile; -+ pszBBRegPgFile = sz8821BBRegPgFile; -+ pszBBRegMpFile = sz8821BBRegMpFile; -+ pszRFTxPwrLmtFile = sz8821RFTxPwrLmtFile; -+ } -+ -+ DBG_871X("===> phy_BB8812_Config_ParaFile() EEPROMRegulatory %d\n", pHalData->EEPROMRegulatory ); -+ -+ //DBG_871X(" ===> phy_BB8812_Config_ParaFile() phy_reg:%s\n",pszBBRegFile); -+ //DBG_871X(" ===> phy_BB8812_Config_ParaFile() phy_reg_pg:%s\n",pszBBRegPgFile); -+ //DBG_871X(" ===> phy_BB8812_Config_ParaFile() agc_table:%s\n",pszAGCTableFile); -+ -+ // Read Tx Power Limit -+ PHY_InitTxPowerLimit( Adapter ); -+ if ( Adapter->registrypriv.RegEnableTxPowerLimit == 1 || -+ ( Adapter->registrypriv.RegEnableTxPowerLimit == 2 && pHalData->EEPROMRegulatory == 1 ) ) -+ { -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (PHY_ConfigRFWithPowerLimitTableParaFile( Adapter, pszRFTxPwrLmtFile )== _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS != ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv, CONFIG_RF_TXPWR_LMT, (ODM_RF_RADIO_PATH_E)0)) -+ rtStatus = _FAIL; -+#endif -+ } -+ -+ if(rtStatus != _SUCCESS){ -+ DBG_871X("%s():Read Tx power limit fail\n",__FUNCTION__ ); -+ goto phy_BB_Config_ParaFile_Fail; -+ } -+ } -+ -+ // Read PHY_REG.TXT BB INIT!! -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (phy_ConfigBBWithParaFile(Adapter, pszBBRegFile, CONFIG_BB_PHY_REG) == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG)) -+ rtStatus = _FAIL; -+#endif -+ } -+ -+ if(rtStatus != _SUCCESS){ -+ DBG_871X("%s(): CONFIG_BB_PHY_REG Fail!!\n",__FUNCTION__ ); -+ goto phy_BB_Config_ParaFile_Fail; -+ } -+ -+ // Read PHY_REG_MP.TXT BB INIT!! -+#if (MP_DRIVER == 1) -+ if (Adapter->registrypriv.mp_mode == 1) { -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (phy_ConfigBBWithMpParaFile(Adapter, pszBBRegMpFile) == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG_MP)) -+ rtStatus = _FAIL; -+#endif -+ } -+ -+ if(rtStatus != _SUCCESS){ -+ DBG_871X("phy_BB8812_Config_ParaFile():Write BB Reg MP Fail!!\n"); -+ goto phy_BB_Config_ParaFile_Fail; -+ } -+ } -+#endif // #if (MP_DRIVER == 1) -+ -+ // If EEPROM or EFUSE autoload OK, We must config by PHY_REG_PG.txt -+ PHY_InitTxPowerByRate( Adapter ); -+ if ( Adapter->registrypriv.RegEnableTxPowerByRate == 1 || -+ ( Adapter->registrypriv.RegEnableTxPowerByRate == 2 && pHalData->EEPROMRegulatory != 2 ) ) -+ { -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (phy_ConfigBBWithPgParaFile(Adapter, pszBBRegPgFile) == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG_PG)) -+ rtStatus = _FAIL; -+#endif -+ } -+ -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) -+ PHY_TxPowerByRateConfiguration( Adapter ); -+ -+ if ( Adapter->registrypriv.RegEnableTxPowerLimit == 1 || -+ ( Adapter->registrypriv.RegEnableTxPowerLimit == 2 && pHalData->EEPROMRegulatory == 1 ) ) -+ PHY_ConvertTxPowerLimitToPowerIndex( Adapter ); -+ -+ if(rtStatus != _SUCCESS){ -+ DBG_871X("%s(): CONFIG_BB_PHY_REG_PG Fail!!\n",__FUNCTION__ ); -+ goto phy_BB_Config_ParaFile_Fail; -+ } -+ } -+ -+ // BB AGC table Initialization -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (phy_ConfigBBWithParaFile(Adapter, pszAGCTableFile, CONFIG_BB_AGC_TAB) == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_AGC_TAB)) -+ rtStatus = _FAIL; -+#endif -+ } -+ -+ if(rtStatus != _SUCCESS){ -+ DBG_871X("%s(): CONFIG_BB_AGC_TAB Fail!!\n",__FUNCTION__ ); -+ } -+ -+phy_BB_Config_ParaFile_Fail: -+ -+ return rtStatus; -+} -+ -+int -+PHY_BBConfig8812( -+ IN PADAPTER Adapter -+ ) -+{ -+ int rtStatus = _SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 TmpU1B=0; -+ -+ phy_InitBBRFRegisterDefinition(Adapter); -+ -+ //tangw check start 20120412 -+ // . APLL_EN,,APLL_320_GATEB,APLL_320BIAS, auto config by hw fsm after pfsm_go (0x4 bit 8) set -+ TmpU1B = rtw_read8(Adapter, REG_SYS_FUNC_EN); -+ -+ if(IS_HARDWARE_TYPE_8812AU(Adapter) || IS_HARDWARE_TYPE_8821U(Adapter)) -+ TmpU1B |= FEN_USBA; -+ else if(IS_HARDWARE_TYPE_8812E(Adapter) || IS_HARDWARE_TYPE_8821E(Adapter)) -+ TmpU1B |= FEN_PCIEA; -+ -+ rtw_write8(Adapter, REG_SYS_FUNC_EN, TmpU1B); -+ -+ rtw_write8(Adapter, REG_SYS_FUNC_EN, (TmpU1B|FEN_BB_GLB_RSTn|FEN_BBRSTB));//same with 8812 -+ //6. 0x1f[7:0] = 0x07 PathA RF Power On -+ rtw_write8(Adapter, REG_RF_CTRL, 0x07);//RF_SDMRSTB,RF_RSTB,RF_EN same with 8723a -+ //7. PathB RF Power On -+ rtw_write8(Adapter, REG_OPT_CTRL_8812+2, 0x7);//RF_SDMRSTB,RF_RSTB,RF_EN same with 8723a -+ //tangw check end 20120412 -+ -+ -+ // -+ // Config BB and AGC -+ // -+ rtStatus = phy_BB8812_Config_ParaFile(Adapter); -+ -+ hal_set_crystal_cap(Adapter, pHalData->CrystalCap); -+ -+ if(IS_HARDWARE_TYPE_JAGUAR(Adapter)) -+ { -+ pHalData->Reg837 = rtw_read8(Adapter, 0x837); -+ } -+ -+ return rtStatus; -+} -+ -+int -+PHY_RFConfig8812( -+ IN PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rtStatus = _SUCCESS; -+ -+ if (RTW_CANNOT_RUN(Adapter)) -+ return _FAIL; -+ -+ switch(pHalData->rf_chip) -+ { -+ case RF_PSEUDO_11N: -+ DBG_871X("%s(): RF_PSEUDO_11N\n",__FUNCTION__); -+ break; -+ default: -+ rtStatus = PHY_RF6052_Config_8812(Adapter); -+ break; -+ } -+ -+ return rtStatus; -+} -+ -+VOID -+PHY_TxPowerTrainingByPath_8812( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel, -+ IN u8 RfPath -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ u8 i; -+ u32 PowerLevel, writeData, writeOffset; -+ -+ if(RfPath >= pHalData->NumTotalRFPath) -+ return; -+ -+ writeData = 0; -+ if(RfPath == ODM_RF_PATH_A) -+ { -+ PowerLevel = PHY_GetTxPowerIndex_8812A(Adapter, ODM_RF_PATH_A, MGN_MCS7, BandWidth, Channel); -+ writeOffset = rA_TxPwrTraing_Jaguar; -+ } -+ else -+ { -+ PowerLevel = PHY_GetTxPowerIndex_8812A(Adapter, ODM_RF_PATH_B, MGN_MCS7, BandWidth, Channel); -+ writeOffset = rB_TxPwrTraing_Jaguar; -+ } -+ -+ for(i = 0; i < 3; i++) -+ { -+ if(i == 0) -+ PowerLevel = PowerLevel - 10; -+ else if(i == 1) -+ PowerLevel = PowerLevel - 8; -+ else -+ PowerLevel = PowerLevel - 6; -+ writeData |= (((PowerLevel > 2)?(PowerLevel):2) << (i * 8)); -+ } -+ -+ PHY_SetBBReg(Adapter, writeOffset, 0xffffff, writeData); -+} -+ -+VOID -+phy_TxPwrAdjInPercentage( -+ IN PADAPTER Adapter, -+ OUT u8* pTxPwrIdx) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 TxPwrInPercentage = 0; -+ -+ // Retrieve default TxPwr index settings from registry. -+ TxPwrInPercentage = pHalData->TxPwrInPercentage; -+ -+ if(*pTxPwrIdx > RF6052_MAX_TX_PWR) -+ *pTxPwrIdx = RF6052_MAX_TX_PWR; -+ -+ // -+ // NEC Spec: dB = 10*log(X/Y), X: target value, Y: default value. -+ // For example: TxPower 50%, 10*log(50/100)=(nearly)-3dB -+ // 2010.07.26. -+ // -+ if(TxPwrInPercentage & TX_PWR_PERCENTAGE_0)// 12.5% , -9dB -+ { -+ *pTxPwrIdx -=18; -+ } -+ else if(TxPwrInPercentage & TX_PWR_PERCENTAGE_1)// 25%, -6dB -+ { -+ *pTxPwrIdx -=12; -+ } -+ else if(TxPwrInPercentage & TX_PWR_PERCENTAGE_2)// 50%, -3dB -+ { -+ *pTxPwrIdx -=6; -+ } -+ -+ if(*pTxPwrIdx > RF6052_MAX_TX_PWR) // Avoid underflow condition. -+ *pTxPwrIdx = RF6052_MAX_TX_PWR; -+} -+ -+VOID -+PHY_GetTxPowerLevel8812( -+ IN PADAPTER Adapter, -+ OUT s32* powerlevel -+ ) -+{ -+#if 0 -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ s4Byte TxPwrDbm = 13; -+ RT_TRACE(COMP_TXAGC, DBG_LOUD, ("PHY_GetTxPowerLevel8812(): TxPowerLevel: %#x\n", TxPwrDbm)); -+ -+ if ( pMgntInfo->ClientConfigPwrInDbm != UNSPECIFIED_PWR_DBM ) -+ *powerlevel = pMgntInfo->ClientConfigPwrInDbm; -+ else -+ *powerlevel = TxPwrDbm; -+#endif -+} -+ -+//create new definition of PHY_SetTxPowerLevel8812 by YP. -+//Page revised on 20121106 -+//the new way to set tx power by rate, NByte access, here N byte shall be 4 byte(DWord) or NByte(N>4) access. by page/YP, 20121106 -+VOID -+PHY_SetTxPowerLevel8812( -+ IN PADAPTER Adapter, -+ IN u8 Channel -+ ) -+{ -+ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ u8 path = 0; -+ -+ //DBG_871X("==>PHY_SetTxPowerLevel8812()\n"); -+ -+ for( path = ODM_RF_PATH_A; path < pHalData->NumTotalRFPath; ++path ) -+ { -+ PHY_SetTxPowerLevelByPath(Adapter, Channel, path); -+ PHY_TxPowerTrainingByPath_8812(Adapter, pHalData->CurrentChannelBW, Channel, path); -+ } -+ -+ //DBG_871X("<==PHY_SetTxPowerLevel8812()\n"); -+} -+ -+u8 -+phy_GetCurrentTxNum_8812A( -+ IN PADAPTER pAdapter, -+ IN u8 Rate -+ ) -+{ -+ u8 tx_num = 0; -+ -+ if ( ( Rate >= MGN_MCS8 && Rate <= MGN_MCS15 ) || -+ ( Rate >= MGN_VHT2SS_MCS0 && Rate <= MGN_VHT2SS_MCS9 ) ) -+ tx_num = RF_2TX; -+ else -+ tx_num = RF_1TX; -+ -+ return tx_num; -+} -+ -+/************************************************************************************************************** -+ * Description: -+ * The low-level interface to get the FINAL Tx Power Index , called by both MP and Normal Driver. -+ * -+ * <20120830, Kordan> -+ **************************************************************************************************************/ -+u8 -+PHY_GetTxPowerIndex_8812A( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel -+ ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ s8 powerDiffByRate = 0; -+ s8 txPower = 0, limit = 0; -+ u8 tx_num = phy_GetCurrentTxNum_8812A( pAdapter, Rate ); -+ BOOLEAN bIn24G = _FALSE; -+ -+ //DBG_871X("===> PHY_GetTxPowerIndex_8812A\n"); -+ -+ txPower = (s8) PHY_GetTxPowerIndexBase( pAdapter, RFPath, Rate, BandWidth, Channel, &bIn24G ); -+ -+ powerDiffByRate = PHY_GetTxPowerByRate( pAdapter, (u8)(!bIn24G), RFPath, tx_num, Rate ); -+ -+ limit = PHY_GetTxPowerLimit( pAdapter, pAdapter->registrypriv.RegPwrTblSel, (u8)(!bIn24G), pHalData->CurrentChannelBW, RFPath, Rate, pHalData->CurrentChannel); -+ -+ powerDiffByRate = powerDiffByRate > limit ? limit : powerDiffByRate; -+ //DBG_871X("Rate-0x%x: (TxPower, PowerDiffByRate Path-%c) = (0x%X, %d)\n", Rate, ((RFPath==0)?'A':'B'), txPower, powerDiffByRate); -+ -+ // We need to reduce power index for VHT MCS 8 & 9. -+ if (Rate == MGN_VHT1SS_MCS8 || Rate == MGN_VHT1SS_MCS9 || -+ Rate == MGN_VHT2SS_MCS8 || Rate == MGN_VHT2SS_MCS9) -+ { -+ txPower += powerDiffByRate; -+ } -+ else -+ { -+#ifdef CONFIG_USB_HCI -+ // -+ // 2013/01/29 MH For preventing VHT rate of 8812AU to be used in USB 2.0 mode -+ // and the current will be more than 500mA and card disappear. We need to limit -+ // TX power with any power by rate for VHT in U2. -+ // 2013/01/30 MH According to power current test compare with BCM AC NIC, we -+ // decide to use host hub = 2.0 mode to enable tx power limit behavior. -+ // -+ if (adapter_to_dvobj(pAdapter)->usb_speed == RTW_USB_SPEED_2 && IS_HARDWARE_TYPE_8812AU(pAdapter)) -+ { -+ powerDiffByRate = 0; -+ } -+#endif -+ txPower += powerDiffByRate; -+#if 0 -+ // -+ // 2013/02/06 MH Add for ASUS requiremen for adjusting TX power limit. -+ // This is a temporarily dirty fix for asus , neeed to revise later! -+ // 2013/03/07 MH Asus add more request. -+ // 2013/03/14 MH Asus add one more request for the power control. -+ // -+ if (Channel >= 36) -+ { -+ txPower += pMgntInfo->RegTPCLvl5g; -+ -+ if (txPower > pMgntInfo->RegTPCLvl5gD) -+ txPower -= pMgntInfo->RegTPCLvl5gD; -+ } -+ else -+ { -+ txPower += pMgntInfo->RegTPCLvl; -+ -+ if (txPower > pMgntInfo->RegTPCLvlD) -+ txPower -= pMgntInfo->RegTPCLvlD; -+ } -+#endif -+ } -+ -+ txPower += PHY_GetTxPowerTrackingOffset( pAdapter, RFPath, Rate ); -+ -+ // 2012/09/26 MH We need to take care high power device limiation to prevent destroy EXT_PA. -+ // This case had ever happened in CU/SU high power module. THe limitation = 0x20. -+ // But for 8812, we still not know the value. -+ phy_TxPwrAdjInPercentage(pAdapter, (u8 *)&txPower); -+ -+ if(txPower > MAX_POWER_INDEX) -+ txPower = MAX_POWER_INDEX; -+ -+ if ( txPower % 2 == 1 && !IS_NORMAL_CHIP(pHalData->VersionID)) -+ --txPower; -+ -+ //DBG_871X("Final Tx Power(RF-%c, Channel: %d) = %d(0x%X)\n", ((RFPath==0)?'A':'B'), Channel,txPower, txPower); -+ -+ return (u8) txPower; -+} -+ -+/************************************************************************************************************** -+ * Description: -+ * The low-level interface to set TxAGC , called by both MP and Normal Driver. -+ * -+ * <20120830, Kordan> -+ **************************************************************************************************************/ -+ -+VOID -+PHY_SetTxPowerIndex_8812A( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ BOOLEAN Direction = _FALSE; -+ u32 TxagcOffset = 0; -+ -+ // <20120928, Kordan> A workaround in 8812A/8821A testchip, to fix the bug of odd Tx power indexes. -+ if ( (PowerIndex % 2 == 1) && IS_HARDWARE_TYPE_JAGUAR(Adapter) && IS_TEST_CHIP(pHalData->VersionID) ) -+ PowerIndex -= 1; -+ -+ //2013.01.18 LukeLee: Modify TXAGC by dcmd_Dynamic_Ctrl() -+ if(RFPath == RF_PATH_A) -+ { -+ Direction = pHalData->odmpriv.IsTxagcOffsetPositiveA; -+ TxagcOffset = pHalData->odmpriv.TxagcOffsetValueA; -+ } -+ else if(RFPath == RF_PATH_B) -+ { -+ Direction = pHalData->odmpriv.IsTxagcOffsetPositiveB; -+ TxagcOffset = pHalData->odmpriv.TxagcOffsetValueB; -+ } -+ if(Direction == _FALSE) -+ { -+ if(PowerIndex > TxagcOffset) -+ PowerIndex -= TxagcOffset; -+ else -+ PowerIndex = 0; -+ } -+ else -+ { -+ PowerIndex += TxagcOffset; -+ if(PowerIndex > 0x3F) -+ PowerIndex = 0x3F; -+ } -+ -+ if (RFPath == RF_PATH_A) -+ { -+ switch (Rate) -+ { -+ case MGN_1M: PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_2M: PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_5_5M: PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_11M: PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_6M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm18_Ofdm6_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_9M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm18_Ofdm6_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_12M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm18_Ofdm6_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_18M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm18_Ofdm6_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_24M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm54_Ofdm24_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_36M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm54_Ofdm24_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_48M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm54_Ofdm24_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_54M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm54_Ofdm24_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS0: PHY_SetBBReg(Adapter, rTxAGC_A_MCS3_MCS0_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS1: PHY_SetBBReg(Adapter, rTxAGC_A_MCS3_MCS0_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS2: PHY_SetBBReg(Adapter, rTxAGC_A_MCS3_MCS0_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS3: PHY_SetBBReg(Adapter, rTxAGC_A_MCS3_MCS0_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS4: PHY_SetBBReg(Adapter, rTxAGC_A_MCS7_MCS4_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS5: PHY_SetBBReg(Adapter, rTxAGC_A_MCS7_MCS4_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS6: PHY_SetBBReg(Adapter, rTxAGC_A_MCS7_MCS4_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS7: PHY_SetBBReg(Adapter, rTxAGC_A_MCS7_MCS4_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS8: PHY_SetBBReg(Adapter, rTxAGC_A_MCS11_MCS8_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS9: PHY_SetBBReg(Adapter, rTxAGC_A_MCS11_MCS8_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS10: PHY_SetBBReg(Adapter, rTxAGC_A_MCS11_MCS8_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS11: PHY_SetBBReg(Adapter, rTxAGC_A_MCS11_MCS8_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS12: PHY_SetBBReg(Adapter, rTxAGC_A_MCS15_MCS12_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS13: PHY_SetBBReg(Adapter, rTxAGC_A_MCS15_MCS12_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS14: PHY_SetBBReg(Adapter, rTxAGC_A_MCS15_MCS12_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS15: PHY_SetBBReg(Adapter, rTxAGC_A_MCS15_MCS12_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT1SS_MCS0: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index3_Nss1Index0_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT1SS_MCS1: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index3_Nss1Index0_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT1SS_MCS2: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index3_Nss1Index0_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT1SS_MCS3: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index3_Nss1Index0_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT1SS_MCS4: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index7_Nss1Index4_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT1SS_MCS5: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index7_Nss1Index4_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT1SS_MCS6: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index7_Nss1Index4_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT1SS_MCS7: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index7_Nss1Index4_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT1SS_MCS8: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index1_Nss1Index8_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT1SS_MCS9: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index1_Nss1Index8_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT2SS_MCS0: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index1_Nss1Index8_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT2SS_MCS1: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index1_Nss1Index8_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT2SS_MCS2: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index5_Nss2Index2_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT2SS_MCS3: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index5_Nss2Index2_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT2SS_MCS4: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index5_Nss2Index2_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT2SS_MCS5: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index5_Nss2Index2_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT2SS_MCS6: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index9_Nss2Index6_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT2SS_MCS7: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index9_Nss2Index6_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT2SS_MCS8: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index9_Nss2Index6_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT2SS_MCS9: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index9_Nss2Index6_JAguar, bMaskByte3, PowerIndex); break; -+ -+ default: -+ DBG_871X("Invalid Rate!!\n"); -+ break; -+ } -+ } -+ else if (RFPath == RF_PATH_B) -+ { -+ switch (Rate) -+ { -+ case MGN_1M: PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_2M: PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_5_5M: PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_11M: PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_6M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm18_Ofdm6_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_9M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm18_Ofdm6_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_12M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm18_Ofdm6_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_18M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm18_Ofdm6_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_24M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm54_Ofdm24_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_36M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm54_Ofdm24_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_48M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm54_Ofdm24_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_54M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm54_Ofdm24_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS0: PHY_SetBBReg(Adapter, rTxAGC_B_MCS3_MCS0_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS1: PHY_SetBBReg(Adapter, rTxAGC_B_MCS3_MCS0_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS2: PHY_SetBBReg(Adapter, rTxAGC_B_MCS3_MCS0_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS3: PHY_SetBBReg(Adapter, rTxAGC_B_MCS3_MCS0_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS4: PHY_SetBBReg(Adapter, rTxAGC_B_MCS7_MCS4_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS5: PHY_SetBBReg(Adapter, rTxAGC_B_MCS7_MCS4_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS6: PHY_SetBBReg(Adapter, rTxAGC_B_MCS7_MCS4_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS7: PHY_SetBBReg(Adapter, rTxAGC_B_MCS7_MCS4_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS8: PHY_SetBBReg(Adapter, rTxAGC_B_MCS11_MCS8_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS9: PHY_SetBBReg(Adapter, rTxAGC_B_MCS11_MCS8_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS10: PHY_SetBBReg(Adapter, rTxAGC_B_MCS11_MCS8_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS11: PHY_SetBBReg(Adapter, rTxAGC_B_MCS11_MCS8_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS12: PHY_SetBBReg(Adapter, rTxAGC_B_MCS15_MCS12_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS13: PHY_SetBBReg(Adapter, rTxAGC_B_MCS15_MCS12_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS14: PHY_SetBBReg(Adapter, rTxAGC_B_MCS15_MCS12_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS15: PHY_SetBBReg(Adapter, rTxAGC_B_MCS15_MCS12_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT1SS_MCS0: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index3_Nss1Index0_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT1SS_MCS1: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index3_Nss1Index0_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT1SS_MCS2: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index3_Nss1Index0_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT1SS_MCS3: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index3_Nss1Index0_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT1SS_MCS4: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index7_Nss1Index4_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT1SS_MCS5: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index7_Nss1Index4_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT1SS_MCS6: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index7_Nss1Index4_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT1SS_MCS7: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index7_Nss1Index4_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT1SS_MCS8: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index1_Nss1Index8_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT1SS_MCS9: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index1_Nss1Index8_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT2SS_MCS0: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index1_Nss1Index8_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT2SS_MCS1: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index1_Nss1Index8_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT2SS_MCS2: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index5_Nss2Index2_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT2SS_MCS3: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index5_Nss2Index2_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT2SS_MCS4: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index5_Nss2Index2_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT2SS_MCS5: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index5_Nss2Index2_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT2SS_MCS6: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index9_Nss2Index6_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT2SS_MCS7: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index9_Nss2Index6_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT2SS_MCS8: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index9_Nss2Index6_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT2SS_MCS9: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index9_Nss2Index6_JAguar, bMaskByte3, PowerIndex); break; -+ -+ default: -+ DBG_871X("Invalid Rate!!\n"); -+ break; -+ } -+ } -+ else -+ { -+ DBG_871X("Invalid RFPath!!\n"); -+ } -+} -+ -+BOOLEAN -+PHY_UpdateTxPowerDbm8812( -+ IN PADAPTER Adapter, -+ IN int powerInDbm -+ ) -+{ -+ return _TRUE; -+} -+ -+ -+u32 PHY_GetTxBBSwing_8812A( -+ IN PADAPTER Adapter, -+ IN BAND_TYPE Band, -+ IN u8 RFPath -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(GetDefaultAdapter(Adapter)); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ s8 bbSwing_2G = -1 * GetRegTxBBSwing_2G(Adapter); -+ s8 bbSwing_5G = -1 * GetRegTxBBSwing_5G(Adapter); -+ u32 out = 0x200; -+ const s8 AUTO = -1; -+ -+ -+ if (pHalData->bautoload_fail_flag) -+ { -+ if ( Band == BAND_ON_2_4G ) { -+ pRFCalibrateInfo->BBSwingDiff2G = bbSwing_2G; -+ if (bbSwing_2G == 0) out = 0x200; // 0 dB -+ else if (bbSwing_2G == -3) out = 0x16A; // -3 dB -+ else if (bbSwing_2G == -6) out = 0x101; // -6 dB -+ else if (bbSwing_2G == -9) out = 0x0B6; // -9 dB -+ else { -+ if ( pHalData->ExternalPA_2G ) { -+ pRFCalibrateInfo->BBSwingDiff2G = -3; -+ out = 0x16A; -+ } else { -+ pRFCalibrateInfo->BBSwingDiff2G = 0; -+ out = 0x200; -+ } -+ } -+ } else if ( Band == BAND_ON_5G ) { -+ pRFCalibrateInfo->BBSwingDiff5G = bbSwing_5G; -+ if (bbSwing_5G == 0) out = 0x200; // 0 dB -+ else if (bbSwing_5G == -3) out = 0x16A; // -3 dB -+ else if (bbSwing_5G == -6) out = 0x101; // -6 dB -+ else if (bbSwing_5G == -9) out = 0x0B6; // -9 dB -+ else { -+ if ( pHalData->ExternalPA_5G || IS_HARDWARE_TYPE_8821(Adapter)) { -+ pRFCalibrateInfo->BBSwingDiff5G = -3; -+ out = 0x16A; -+ } else { -+ pRFCalibrateInfo->BBSwingDiff5G = 0; -+ out = 0x200; -+ } -+ } -+ } else { -+ pRFCalibrateInfo->BBSwingDiff2G = -3; -+ pRFCalibrateInfo->BBSwingDiff5G = -3; -+ out = 0x16A; // -3 dB -+ } -+ } -+ else -+ { -+ u32 swing = 0, onePathSwing = 0; -+ -+ if (Band == BAND_ON_2_4G) { -+ if (GetRegTxBBSwing_2G(Adapter) == AUTO) -+ { -+ EFUSE_ShadowRead(Adapter, 1, EEPROM_TX_BBSWING_2G_8812, (u32 *)&swing); -+ swing = (swing == 0xFF) ? 0x00 : swing; -+ } -+ else if (bbSwing_2G == 0) swing = 0x00; // 0 dB -+ else if (bbSwing_2G == -3) swing = 0x05; // -3 dB -+ else if (bbSwing_2G == -6) swing = 0x0A; // -6 dB -+ else if (bbSwing_2G == -9) swing = 0xFF; // -9 dB -+ else swing = 0x00; -+ } -+ else { -+ if (GetRegTxBBSwing_5G(Adapter) == AUTO) -+ { -+ EFUSE_ShadowRead(Adapter, 1, EEPROM_TX_BBSWING_5G_8812, (u32 *)&swing); -+ swing = (swing == 0xFF) ? 0x00 : swing; -+ } -+ else if (bbSwing_5G == 0) swing = 0x00; // 0 dB -+ else if (bbSwing_5G == -3) swing = 0x05; // -3 dB -+ else if (bbSwing_5G == -6) swing = 0x0A; // -6 dB -+ else if (bbSwing_5G == -9) swing = 0xFF; // -9 dB -+ else swing = 0x00; -+ } -+ -+ if (RFPath == ODM_RF_PATH_A) -+ onePathSwing = (swing & 0x3) >> 0; // 0xC6/C7[1:0] -+ else if(RFPath == ODM_RF_PATH_B) -+ onePathSwing = (swing & 0xC) >> 2; // 0xC6/C7[3:2] -+ -+ if (onePathSwing == 0x0) { -+ if (Band == BAND_ON_2_4G) -+ pRFCalibrateInfo->BBSwingDiff2G = 0; -+ else -+ pRFCalibrateInfo->BBSwingDiff5G = 0; -+ out = 0x200; // 0 dB -+ } else if (onePathSwing == 0x1) { -+ if (Band == BAND_ON_2_4G) -+ pRFCalibrateInfo->BBSwingDiff2G = -3; -+ else -+ pRFCalibrateInfo->BBSwingDiff5G = -3; -+ out = 0x16A; // -3 dB -+ } else if (onePathSwing == 0x2) { -+ if (Band == BAND_ON_2_4G) -+ pRFCalibrateInfo->BBSwingDiff2G = -6; -+ else -+ pRFCalibrateInfo->BBSwingDiff5G = -6; -+ out = 0x101; // -6 dB -+ } else if (onePathSwing == 0x3) { -+ if (Band == BAND_ON_2_4G) -+ pRFCalibrateInfo->BBSwingDiff2G = -9; -+ else -+ pRFCalibrateInfo->BBSwingDiff5G = -9; -+ out = 0x0B6; // -9 dB -+ } -+ } -+ -+ //DBG_871X("<=== PHY_GetTxBBSwing_8812A, out = 0x%X\n", out); -+ -+ return out; -+} -+ -+VOID -+phy_SetRFEReg8812( -+ IN PADAPTER Adapter, -+ IN u8 Band -+) -+{ -+ u1Byte u1tmp = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if(Band == BAND_ON_2_4G) -+ { -+ switch(pHalData->RFEType){ -+ case 0: case 2: -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); -+ break; -+ case 1: -+#ifdef CONFIG_BT_COEXIST -+ if (hal_btcoex_IsBtExist(Adapter) && (Adapter->registrypriv.mp_mode==0)) -+ { -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,0xffffff, 0x777777); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar, 0x33f00000, 0x000); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); -+ } -+ else -+#endif -+ { -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); -+ } -+ break; -+ case 3: -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x54337770); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x54337770); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar,0x00000303, 0x1); -+ break; -+ case 4: -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x001); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x001); -+ break; -+ case 5: -+ rtw_write8(Adapter, rA_RFE_Pinmux_Jaguar+2, 0x77); -+ -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ u1tmp = rtw_read8(Adapter, rA_RFE_Inv_Jaguar+3); -+ rtw_write8(Adapter, rA_RFE_Inv_Jaguar+3, (u1tmp &= ~BIT0)); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar, bMask_RFEInv_Jaguar, 0x000); -+ break; -+ default: -+ break; -+ } -+ } -+ else -+ { -+ switch(pHalData->RFEType){ -+ case 0: -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337717); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337717); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ break; -+ case 1: -+#ifdef CONFIG_BT_COEXIST -+ if (hal_btcoex_IsBtExist(Adapter) && (Adapter->registrypriv.mp_mode==0)) -+ { -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,0xffffff, 0x337717); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337717); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar, 0x33f00000, 0x000); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); -+ } -+ else -+#endif -+ { -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337717); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337717); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); -+ } -+ break; -+ case 2: -+ case 4: -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337777); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337777); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ break; -+ case 3: -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x54337717); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x54337717); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar,0x00000303, 0x1); -+ break; -+ case 5: -+ rtw_write8(Adapter, rA_RFE_Pinmux_Jaguar+2, 0x33); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337777); -+ u1tmp = rtw_read8(Adapter, rA_RFE_Inv_Jaguar+3); -+ rtw_write8(Adapter, rA_RFE_Inv_Jaguar+3, (u1tmp |= BIT0)); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar, bMask_RFEInv_Jaguar, 0x010); -+ break; -+ default: -+ break; -+ } -+ } -+} -+ -+void phy_SetBBSwingByBand_8812A( -+ IN PADAPTER Adapter, -+ IN u8 Band, -+ IN u1Byte PreviousBand -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(GetDefaultAdapter(Adapter)); -+ -+ //<20120903, Kordan> Tx BB swing setting for RL6286, asked by Ynlin. -+ if (IS_NORMAL_CHIP(pHalData->VersionID) || IS_HARDWARE_TYPE_8821(Adapter)) -+ { -+#if (MP_DRIVER == 1) -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+#endif -+ s8 BBDiffBetweenBand = 0; -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ u8 path = ODM_RF_PATH_A; -+ -+ PHY_SetBBReg(Adapter, rA_TxScale_Jaguar, 0xFFE00000, -+ PHY_GetTxBBSwing_8812A(Adapter, (BAND_TYPE)Band, ODM_RF_PATH_A)); // 0xC1C[31:21] -+ PHY_SetBBReg(Adapter, rB_TxScale_Jaguar, 0xFFE00000, -+ PHY_GetTxBBSwing_8812A(Adapter, (BAND_TYPE)Band, ODM_RF_PATH_B)); // 0xE1C[31:21] -+ -+ // <20121005, Kordan> When TxPowerTrack is ON, we should take care of the change of BB swing. -+ // That is, reset all info to trigger Tx power tracking. -+ { -+#if (MP_DRIVER == 1) -+ path = pMptCtx->MptRfPath; -+#endif -+ -+ if (Band != PreviousBand) -+ { -+ BBDiffBetweenBand = (pRFCalibrateInfo->BBSwingDiff2G - pRFCalibrateInfo->BBSwingDiff5G); -+ BBDiffBetweenBand = (Band == BAND_ON_2_4G) ? BBDiffBetweenBand : (-1 * BBDiffBetweenBand); -+ pRFCalibrateInfo->DefaultOfdmIndex += BBDiffBetweenBand*2; -+ } -+ -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+ } -+ } -+} -+ -+ -+VOID -+phy_SetRFEReg8821( -+ IN PADAPTER Adapter, -+ IN u1Byte Band -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if(Band == BAND_ON_2_4G) -+ { -+ // Turn off RF PA and LNA -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0xF000, 0x7); // 0xCB0[15:12] = 0x7 (LNA_On) -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0xF0, 0x7); // 0xCB0[7:4] = 0x7 (PAPE_A) -+ -+ if (pHalData->ExternalLNA_2G) { -+ // <20131223, VincentL> Turn on 2.4G External LNA (Asked by Luke Lee & Alex Wang) -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar, BIT20, 1); // 0xCB4 = 0x10100077; -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar, BIT22, 0); // 0xCB4 = 0x10100077; -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, BIT2|BIT1|BIT0, 0x2); // 0xCB0[2:0] = b'010 -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, BIT10|BIT9|BIT8, 0x2); // 0xCB0[10:8] = b'010 -+ -+ }else{ -+ // <20131223, VincentL> Bypass 2.4G External LNA (Asked by Luke Lee & Alex Wang) -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar, BIT20, 0); // 0xCB4 = 0x10000077; -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar, BIT22, 0); // 0xCB4 = 0x10000077; -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, BIT2|BIT1|BIT0, 0x7); // 0xCB0[2:0] = b'111 -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, BIT10|BIT9|BIT8, 0x7); // 0xCB0[10:8] = b'111 -+ } -+ } -+ else -+ { -+ // Turn ON RF PA and LNA -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0xF000, 0x5); // 0xCB0[15:12] = 0x5 (LNA_On) -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0xF0, 0x4); // 0xCB0[7:4] = 0x4 (PAPE_A) -+ -+ // <20131223, VincentL> Bypass 2.4G External LNA (Asked by Luke Lee & Alex Wang) -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar, BIT20, 0); // 0xCB4 = 0x10000077; -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar, BIT22, 0); // 0xCB4 = 0x10000077; -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, BIT2|BIT1|BIT0, 0x7); // 0xCB0[2:0] = b'111 -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, BIT10|BIT9|BIT8, 0x7); // 0xCB0[10:8] = b'111 -+ -+ } -+} -+ -+ -+ -+s32 -+PHY_SwitchWirelessBand8812( -+ IN PADAPTER Adapter, -+ IN u8 Band -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 currentBand = pHalData->CurrentBandType; -+ -+ //DBG_871X("==>PHY_SwitchWirelessBand8812() %s\n", ((Band==0)?"2.4G":"5G")); -+ -+ pHalData->CurrentBandType =(BAND_TYPE)Band; -+ -+ if(Band == BAND_ON_2_4G) -+ {// 2.4G band -+ -+ PHY_SetBBReg(Adapter, rOFDMCCKEN_Jaguar, bOFDMEN_Jaguar|bCCKEN_Jaguar, 0x03); -+ -+ if (IS_HARDWARE_TYPE_8821(Adapter)) -+ phy_SetRFEReg8821(Adapter, Band); -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ { -+ // <20131128, VincentL> Remove 0x830[3:1] setting when switching 2G/5G, requested by Yn. -+ PHY_SetBBReg(Adapter,rBWIndication_Jaguar,0x3,0x1); // 0x834[1:0] = 0x1 -+ //BB Yn user guide R27 -+ PHY_SetBBReg(Adapter,rPwed_TH_Jaguar, BIT13|BIT14|BIT15|BIT16|BIT17, 0x17); //0x830[17:13]=5'b10111 -+ } -+ -+ // AGC table select -+ if(IS_VENDOR_8821A_MP_CHIP(Adapter)) -+ PHY_SetBBReg(Adapter, rA_TxScale_Jaguar, 0xF00, 0); // 0xC1C[11:8] = 0 -+ else -+ PHY_SetBBReg(Adapter, rAGC_table_Jaguar, 0x3, 0); // 0x82C[1:0] = 2b'00 -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ phy_SetRFEReg8812(Adapter, Band); -+ -+ // <20131106, Kordan> Workaround to fix CCK FA for scan issue. -+ //if( pHalData->bMPMode == FALSE) -+ if(Adapter->registrypriv.mp_mode==0) -+ { -+ PHY_SetBBReg(Adapter, rTxPath_Jaguar, 0xf0, 0x1); -+ PHY_SetBBReg(Adapter, rCCK_RX_Jaguar, 0x0f000000, 0x1); -+ } -+ -+ update_tx_basic_rate(Adapter, WIRELESS_11BG); -+ -+ // CCK_CHECK_en -+ rtw_write8(Adapter, REG_CCK_CHECK_8812, 0x0); -+ } -+ else //5G band -+ { -+ u16 count = 0, reg41A = 0; -+ -+ if (IS_HARDWARE_TYPE_8821(Adapter)) -+ phy_SetRFEReg8821(Adapter, Band); -+ -+ // CCK_CHECK_en -+ rtw_write8(Adapter, REG_CCK_CHECK_8812, 0x80); -+ -+ count = 0; -+ reg41A = rtw_read16(Adapter, REG_TXPKT_EMPTY); -+ //DBG_871X("Reg41A value %d", reg41A); -+ reg41A &= 0x30; -+ while((reg41A!= 0x30) && (count < 50)) -+ { -+ rtw_udelay_os(50); -+ //DBG_871X("Delay 50us \n"); -+ -+ reg41A = rtw_read16(Adapter, REG_TXPKT_EMPTY); -+ reg41A &= 0x30; -+ count++; -+ //DBG_871X("Reg41A value %d", reg41A); -+ } -+ if(count != 0) -+ DBG_871X("PHY_SwitchWirelessBand8812(): Switch to 5G Band. Count = %d reg41A=0x%x\n", count, reg41A); -+ -+ // 2012/02/01, Sinda add registry to switch workaround without long-run verification for scan issue. -+ if(Adapter->registrypriv.mp_mode==0) -+ PHY_SetBBReg(Adapter, rOFDMCCKEN_Jaguar, bOFDMEN_Jaguar|bCCKEN_Jaguar, 0x03); -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ { -+ // <20131128, VincentL> Remove 0x830[3:1] setting when switching 2G/5G, requested by Yn. -+ PHY_SetBBReg(Adapter,rBWIndication_Jaguar,0x3,0x2); // 0x834[1:0] = 0x2 -+ //BB Yn user guide R27 -+ PHY_SetBBReg(Adapter,rPwed_TH_Jaguar, BIT13|BIT14|BIT15|BIT16|BIT17, 0x15); //0x830[17:13]=5'b10101 -+ } -+ -+ // AGC table select -+ if (IS_VENDOR_8821A_MP_CHIP(Adapter)) -+ PHY_SetBBReg(Adapter, rA_TxScale_Jaguar, 0xF00, 1); // 0xC1C[11:8] = 1 -+ else -+ PHY_SetBBReg(Adapter, rAGC_table_Jaguar, 0x3, 1); // 0x82C[1:0] = 2'b00 -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ phy_SetRFEReg8812(Adapter, Band); -+ -+ // <20131106, Kordan> Workaround to fix CCK FA for scan issue. -+ //if( pHalData->bMPMode == FALSE) -+ if(Adapter->registrypriv.mp_mode==0) -+ { -+ PHY_SetBBReg(Adapter, rTxPath_Jaguar, 0xf0, 0x0); -+ PHY_SetBBReg(Adapter, rCCK_RX_Jaguar, 0x0f000000, 0xF); -+ } -+ else -+ { -+ // cck_enable -+ PHY_SetBBReg(Adapter, rOFDMCCKEN_Jaguar, bOFDMEN_Jaguar|bCCKEN_Jaguar, 0x02); -+ } -+ -+ //avoid using cck rate in 5G band -+ // Set RRSR rate table. -+ update_tx_basic_rate(Adapter, WIRELESS_11A); -+ -+ -+ //DBG_871X("==>PHY_SwitchWirelessBand8812() BAND_ON_5G settings OFDM index 0x%x\n", pHalData->OFDM_index[RF_PATH_A]); -+ } -+ -+ phy_SetBBSwingByBand_8812A(Adapter, Band, currentBand); -+ //DBG_871X("<==PHY_SwitchWirelessBand8812():Switch Band OK.\n"); -+ return _SUCCESS; -+} -+ -+BOOLEAN -+phy_SwBand8812( -+ IN PADAPTER pAdapter, -+ IN u8 channelToSW -+) -+{ -+ u8 u1Btmp; -+ BOOLEAN ret_value = _TRUE; -+ u8 Band = BAND_ON_5G, BandToSW; -+ -+ u1Btmp = rtw_read8(pAdapter, REG_CCK_CHECK_8812); -+ if(u1Btmp & BIT7) -+ Band = BAND_ON_5G; -+ else -+ Band = BAND_ON_2_4G; -+ -+ // Use current channel to judge Band Type and switch Band if need. -+ if(channelToSW > 14) -+ { -+ BandToSW = BAND_ON_5G; -+ } -+ else -+ { -+ BandToSW = BAND_ON_2_4G; -+ } -+ -+ if(BandToSW != Band) -+ PHY_SwitchWirelessBand8812(pAdapter,BandToSW); -+ -+ return ret_value; -+} -+ -+u8 -+phy_GetSecondaryChnl_8812( -+ IN PADAPTER Adapter -+) -+{ -+ u8 SCSettingOf40 = 0, SCSettingOf20 = 0; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ //DBG_871X("SCMapping: Case: pHalData->CurrentChannelBW %d, pHalData->nCur80MhzPrimeSC %d, pHalData->nCur40MhzPrimeSC %d \n",pHalData->CurrentChannelBW,pHalData->nCur80MhzPrimeSC,pHalData->nCur40MhzPrimeSC); -+ if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_80) -+ { -+ if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOf40 = VHT_DATA_SC_40_LOWER_OF_80MHZ; -+ else if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOf40 = VHT_DATA_SC_40_UPPER_OF_80MHZ; -+ else -+ DBG_871X("SCMapping: DONOT CARE Mode Setting\n"); -+ -+ if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOf20 = VHT_DATA_SC_20_LOWEST_OF_80MHZ; -+ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOf20 = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOf20 = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOf20 = VHT_DATA_SC_20_UPPERST_OF_80MHZ; -+ else -+ DBG_871X("SCMapping: DONOT CARE Mode Setting\n"); -+ } -+ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) -+ { -+ //DBG_871X("SCMapping: Case: pHalData->CurrentChannelBW %d, pHalData->nCur40MhzPrimeSC %d \n",pHalData->CurrentChannelBW,pHalData->nCur40MhzPrimeSC); -+ -+ if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOf20 = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOf20 = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else -+ DBG_871X("SCMapping: DONOT CARE Mode Setting\n"); -+ } -+ -+ /*DBG_871X("SCMapping: SC Value %x\n", ((SCSettingOf40 << 4) | SCSettingOf20));*/ -+ return ( (SCSettingOf40 << 4) | SCSettingOf20); -+} -+ -+VOID -+phy_SetRegBW_8812( -+ IN PADAPTER Adapter, -+ CHANNEL_WIDTH CurrentBW -+) -+{ -+ u16 RegRfMod_BW, u2tmp = 0; -+ RegRfMod_BW = rtw_read16(Adapter, REG_WMAC_TRXPTCL_CTL); -+ -+ switch(CurrentBW) -+ { -+ case CHANNEL_WIDTH_20: -+ rtw_write16(Adapter, REG_WMAC_TRXPTCL_CTL, (RegRfMod_BW & 0xFE7F)); // BIT 7 = 0, BIT 8 = 0 -+ break; -+ -+ case CHANNEL_WIDTH_40: -+ u2tmp = RegRfMod_BW | BIT7; -+ rtw_write16(Adapter, REG_WMAC_TRXPTCL_CTL, (u2tmp & 0xFEFF)); // BIT 7 = 1, BIT 8 = 0 -+ break; -+ -+ case CHANNEL_WIDTH_80: -+ u2tmp = RegRfMod_BW | BIT8; -+ rtw_write16(Adapter, REG_WMAC_TRXPTCL_CTL, (u2tmp & 0xFF7F)); // BIT 7 = 0, BIT 8 = 1 -+ break; -+ -+ default: -+ DBG_871X("phy_PostSetBWMode8812(): unknown Bandwidth: %#X\n",CurrentBW); -+ break; -+ } -+ -+} -+ -+void -+phy_FixSpur_8812A( -+ IN PADAPTER pAdapter, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u1Byte Channel -+) -+{ -+ // C cut Item12 ADC FIFO CLOCK -+ if(IS_VENDOR_8812A_C_CUT(pAdapter)) -+ { -+ if(Bandwidth == CHANNEL_WIDTH_40 && Channel == 11) -+ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0xC00, 0x3) ; // 0x8AC[11:10] = 2'b11 -+ else -+ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0xC00, 0x2); // 0x8AC[11:10] = 2'b10 -+ -+ // <20120914, Kordan> A workarould to resolve 2480Mhz spur by setting ADC clock as 160M. (Asked by Binson) -+ if (Bandwidth == CHANNEL_WIDTH_20 && -+ (Channel == 13 || Channel == 14)) { -+ -+ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0x300, 0x3); // 0x8AC[9:8] = 2'b11 -+ PHY_SetBBReg(pAdapter, rADC_Buf_Clk_Jaguar, BIT30, 1); // 0x8C4[30] = 1 -+ -+ } else if (Bandwidth == CHANNEL_WIDTH_40 && -+ Channel == 11) { -+ -+ PHY_SetBBReg(pAdapter, rADC_Buf_Clk_Jaguar, BIT30, 1); // 0x8C4[30] = 1 -+ -+ } else if (Bandwidth != CHANNEL_WIDTH_80) { -+ -+ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0x300, 0x2); // 0x8AC[9:8] = 2'b10 -+ PHY_SetBBReg(pAdapter, rADC_Buf_Clk_Jaguar, BIT30, 0); // 0x8C4[30] = 0 -+ -+ } -+ } -+ else if (IS_HARDWARE_TYPE_8812(pAdapter)) -+ { -+ // <20120914, Kordan> A workarould to resolve 2480Mhz spur by setting ADC clock as 160M. (Asked by Binson) -+ if (Bandwidth == CHANNEL_WIDTH_20 && -+ (Channel == 13 || Channel == 14)) -+ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0x300, 0x3); // 0x8AC[9:8] = 11 -+ else if (Channel <= 14) // 2.4G only -+ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0x300, 0x2); // 0x8AC[9:8] = 10 -+ } -+ -+} -+ -+VOID -+phy_PostSetBwMode8812( -+ IN PADAPTER Adapter -+) -+{ -+ u8 SubChnlNum = 0; -+ u8 L1pkVal = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ -+ //3 Set Reg668 BW -+ phy_SetRegBW_8812(Adapter, pHalData->CurrentChannelBW); -+ -+ //3 Set Reg483 -+ SubChnlNum = phy_GetSecondaryChnl_8812(Adapter); -+ rtw_write8(Adapter, REG_DATA_SC_8812, SubChnlNum); -+ -+ if(pHalData->rf_chip == RF_PSEUDO_11N) -+ { -+ DBG_871X("phy_PostSetBwMode8812: return for PSEUDO \n"); -+ return; -+ } -+ -+ //DBG_871X("[BW:CHNL], phy_PostSetBwMode8812(), set BW=%s !!\n", GLBwSrc[pHalData->CurrentChannelBW]); -+ -+ //3 Set Reg848 Reg864 Reg8AC Reg8C4 RegA00 -+ switch(pHalData->CurrentChannelBW) -+ { -+ case CHANNEL_WIDTH_20: -+ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x003003C3, 0x00300200); // 0x8ac[21,20,9:6,1,0]=8'b11100000 -+ PHY_SetBBReg(Adapter, rADC_Buf_Clk_Jaguar, BIT30, 0); // 0x8c4[30] = 1'b0 -+ -+ if(pHalData->rf_type == RF_2T2R) -+ PHY_SetBBReg(Adapter, rL1PeakTH_Jaguar, 0x03C00000, 7); // 2R 0x848[25:22] = 0x7 -+ else -+ PHY_SetBBReg(Adapter, rL1PeakTH_Jaguar, 0x03C00000, 8); // 1R 0x848[25:22] = 0x8 -+ -+ break; -+ -+ case CHANNEL_WIDTH_40: -+ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x003003C3, 0x00300201); // 0x8ac[21,20,9:6,1,0]=8'b11100000 -+ PHY_SetBBReg(Adapter, rADC_Buf_Clk_Jaguar, BIT30, 0); // 0x8c4[30] = 1'b0 -+ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x3C, SubChnlNum); -+ PHY_SetBBReg(Adapter, rCCAonSec_Jaguar, 0xf0000000, SubChnlNum); -+ -+ if(pHalData->Reg837 & BIT2) -+ L1pkVal = 6; -+ else -+ { -+ if(pHalData->rf_type == RF_2T2R) -+ L1pkVal = 7; -+ else -+ L1pkVal = 8; -+ } -+ -+ PHY_SetBBReg(Adapter, rL1PeakTH_Jaguar, 0x03C00000, L1pkVal); // 0x848[25:22] = 0x6 -+ -+ if(SubChnlNum == VHT_DATA_SC_20_UPPER_OF_80MHZ) -+ PHY_SetBBReg(Adapter, rCCK_System_Jaguar, bCCK_System_Jaguar, 1); -+ else -+ PHY_SetBBReg(Adapter, rCCK_System_Jaguar, bCCK_System_Jaguar, 0); -+ break; -+ -+ case CHANNEL_WIDTH_80: -+ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x003003C3, 0x00300202); // 0x8ac[21,20,9:6,1,0]=8'b11100010 -+ PHY_SetBBReg(Adapter, rADC_Buf_Clk_Jaguar, BIT30, 1); // 0x8c4[30] = 1 -+ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x3C, SubChnlNum); -+ PHY_SetBBReg(Adapter, rCCAonSec_Jaguar, 0xf0000000, SubChnlNum); -+ -+ if(pHalData->Reg837 & BIT2) -+ L1pkVal = 5; -+ else -+ { -+ if(pHalData->rf_type == RF_2T2R) -+ L1pkVal = 6; -+ else -+ L1pkVal = 7; -+ } -+ PHY_SetBBReg(Adapter, rL1PeakTH_Jaguar, 0x03C00000, L1pkVal); // 0x848[25:22] = 0x5 -+ -+ break; -+ -+ default: -+ DBG_871X("phy_PostSetBWMode8812(): unknown Bandwidth: %#X\n",pHalData->CurrentChannelBW); -+ break; -+ } -+ -+ // <20121109, Kordan> A workaround for 8812A only. -+ phy_FixSpur_8812A(Adapter, pHalData->CurrentChannelBW, pHalData->CurrentChannel); -+ -+ //DBG_871X("phy_PostSetBwMode8812(): Reg483: %x\n", rtw_read8(Adapter, 0x483)); -+ //DBG_871X("phy_PostSetBwMode8812(): Reg668: %x\n", rtw_read32(Adapter, 0x668)); -+ //DBG_871X("phy_PostSetBwMode8812(): Reg8AC: %x\n", PHY_QueryBBReg(Adapter, rRFMOD_Jaguar, 0xffffffff)); -+ -+ //3 Set RF related register -+ PHY_RF6052SetBandwidth8812(Adapter, pHalData->CurrentChannelBW); -+} -+ -+//<20130207, Kordan> The variales initialized here are used in odm_LNAPowerControl(). -+VOID phy_InitRssiTRSW( -+ IN PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ u8 channel = pHalData->CurrentChannel; -+ -+ if (pHalData->RFEType == 3){ -+ -+ if (channel <= 14) { -+ pDM_Odm->RSSI_TRSW_H = 70; // Unit: percentage(%) -+ pDM_Odm->RSSI_TRSW_iso = 25; -+ } else { -+ pDM_Odm->RSSI_TRSW_H = 80; -+ pDM_Odm->RSSI_TRSW_iso = 25; -+ } -+ -+ pDM_Odm->RSSI_TRSW_L = pDM_Odm->RSSI_TRSW_H - pDM_Odm->RSSI_TRSW_iso - 10; -+ } -+} -+ -+/*Referenced from "WB-20130801-YN-RL6286 Settings for Spur Issues R02.xls"*/ -+VOID -+phy_SpurCalibration_8812A( -+ IN PADAPTER pAdapter, -+ IN u8 Channel, -+ IN u8 Bandwidth -+ ) -+{ -+ //RT_TRACE(COMP_SCAN, DBG_LOUD, ("===>phy_SpurCalibration_8812A()\n")); -+ -+ //2 1. Reset -+ PHY_SetBBReg(pAdapter, 0x874, BIT0, 0); -+ PHY_SetBBReg(pAdapter, 0x874, BIT21 , 0); -+ PHY_SetBBReg(pAdapter, 0x878, BIT8|BIT7|BIT6, 0); -+ PHY_SetBBReg(pAdapter, 0x878, BIT0, 0); -+ PHY_SetBBReg(pAdapter, 0x87C, BIT13, 0); -+ PHY_SetBBReg(pAdapter, 0x880, bMaskDWord, 0); -+ PHY_SetBBReg(pAdapter, 0x884, bMaskDWord, 0); -+ PHY_SetBBReg(pAdapter, 0x898, bMaskDWord, 0); -+ PHY_SetBBReg(pAdapter, 0x89C, bMaskDWord, 0); -+ -+ -+ //2 2. Register Setting 1 (False Alarm) -+ if (((Channel == 149 || Channel == 153) && Bandwidth == CHANNEL_WIDTH_20) || -+ (Channel == 151 && Bandwidth == CHANNEL_WIDTH_40) || -+ (Channel == 155 && Bandwidth == CHANNEL_WIDTH_80)) { -+ -+ PHY_SetBBReg(pAdapter, 0x878, BIT6, 0); -+ PHY_SetBBReg(pAdapter, 0x878, BIT7, 0); -+ PHY_SetBBReg(pAdapter, 0x878, BIT8, 1); -+ PHY_SetBBReg(pAdapter, 0x878, BIT0, 1); -+ PHY_SetBBReg(pAdapter, 0x87C, BIT13, 1); -+ } -+ -+ //2 3. Register Setting 2 (SINR) -+ PHY_SetBBReg(pAdapter, 0x874, BIT21, 1); -+ PHY_SetBBReg(pAdapter, 0x874, BIT0 , 1); -+ -+ if (Channel == 149 && Bandwidth == CHANNEL_WIDTH_20) -+ PHY_SetBBReg(pAdapter, 0x884, bMaskDWord, 0x00010000); -+ else if (Channel == 153 && Bandwidth == CHANNEL_WIDTH_20) -+ PHY_SetBBReg(pAdapter, 0x89C, bMaskDWord, 0x00010000); -+ else if (Channel == 151 && Bandwidth == CHANNEL_WIDTH_40) -+ PHY_SetBBReg(pAdapter, 0x880, bMaskDWord, 0x00010000); -+ else if (Channel == 155 && Bandwidth == CHANNEL_WIDTH_80) -+ PHY_SetBBReg(pAdapter, 0x898, bMaskDWord, 0x00010000); -+ //RT_TRACE(COMP_SCAN, DBG_LOUD, ("<===phy_SpurCalibration_8812A()\n")); -+ -+} -+ -+VOID -+phy_SwChnl8812( -+ IN PADAPTER pAdapter -+ ) -+{ -+ u8 eRFPath = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 channelToSW = pHalData->CurrentChannel; -+ u8 bandwidthToSw = pHalData->CurrentChannelBW; -+ -+ if(phy_SwBand8812(pAdapter, channelToSW) == _FALSE) -+ { -+ DBG_871X("error Chnl %d !\n", channelToSW); -+ } -+ -+ //<20130313, Kordan> Sample code to demonstrate how to configure AGC_TAB_DIFF.(Disabled by now) -+#if (MP_DRIVER == 1) -+ if (pAdapter->registrypriv.mp_mode == 1) -+ ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_AGC_TAB_DIFF); -+#endif -+ -+ if(pHalData->rf_chip == RF_PSEUDO_11N) -+ { -+ DBG_871X("phy_SwChnl8812: return for PSEUDO \n"); -+ return; -+ } -+ -+ //DBG_871X("[BW:CHNL], phy_SwChnl8812(), switch to channel %d !!\n", channelToSW); -+ -+ // fc_area -+ if (36 <= channelToSW && channelToSW <= 48) -+ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x494); -+ else if (50 <= channelToSW && channelToSW <= 64) -+ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x453); -+ else if (100 <= channelToSW && channelToSW <= 116) -+ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x452); -+ else if (118 <= channelToSW) -+ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x412); -+ else -+ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x96a); -+ -+ for(eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) -+ { -+ // RF_MOD_AG -+ if (36 <= channelToSW && channelToSW <= 64) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, BIT18|BIT17|BIT16|BIT9|BIT8, 0x101); //5'b00101); -+ else if (100 <= channelToSW && channelToSW <= 140) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, BIT18|BIT17|BIT16|BIT9|BIT8, 0x301); //5'b01101); -+ else if (140 < channelToSW) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, BIT18|BIT17|BIT16|BIT9|BIT8, 0x501); //5'b10101); -+ else -+ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, BIT18|BIT17|BIT16|BIT9|BIT8, 0x000); //5'b00000); -+ -+ // <20121109, Kordan> A workaround for 8812A only. -+ phy_FixSpur_8812A(pAdapter, pHalData->CurrentChannelBW, channelToSW); -+ -+ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, bMaskByte0, channelToSW); -+ -+ // <20130104, Kordan> APK for MP chip is done on initialization from folder. -+ if (IS_HARDWARE_TYPE_8821U(pAdapter) && ( !IS_NORMAL_CHIP(pHalData->VersionID)) && channelToSW > 14 ) -+ { -+ // <20121116, Kordan> For better result of APK. Asked by AlexWang. -+ if (36 <= channelToSW && channelToSW <= 64) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x710E7); -+ else if (100 <= channelToSW && channelToSW <= 140) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x716E9); -+ else -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x714E9); -+ } -+ else if (IS_HARDWARE_TYPE_8821S(pAdapter) && channelToSW > 14) -+ { -+ // <20130111, Kordan> For better result of APK. Asked by Willson. -+ if (36 <= channelToSW && channelToSW <= 64) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x714E9); -+ else if (100 <= channelToSW && channelToSW <= 140) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x110E9); -+ else -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x714E9); -+ } -+ else if (IS_HARDWARE_TYPE_8821E(pAdapter) && channelToSW > 14) -+ { -+ // <20130613, Kordan> For better result of APK. Asked by Willson. -+ if (36 <= channelToSW && channelToSW <= 64) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x114E9); -+ else if (100 <= channelToSW && channelToSW <= 140) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x110E9); -+ else -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x110E9); -+ } -+ } -+ -+ /*only for 8812A mp mode*/ -+ if (IS_HARDWARE_TYPE_8812(pAdapter) && (pHalData->LNAType_5G == 0x00) -+ && pAdapter->registrypriv.mp_mode == _TRUE) -+ phy_SpurCalibration_8812A(pAdapter, channelToSW, bandwidthToSw); -+} -+ -+VOID -+phy_SwChnlAndSetBwMode8812( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ //DBG_871X("phy_SwChnlAndSetBwMode8812(): bSwChnl %d, bSetChnlBW %d \n", pHalData->bSwChnl, pHalData->bSetChnlBW); -+ if ( Adapter->bNotifyChannelChange ) -+ { -+ DBG_871X( "[%s] bSwChnl=%d, ch=%d, bSetChnlBW=%d, bw=%d\n", -+ __FUNCTION__, -+ pHalData->bSwChnl, -+ pHalData->CurrentChannel, -+ pHalData->bSetChnlBW, -+ pHalData->CurrentChannelBW); -+ } -+ -+ if (RTW_CANNOT_RUN(Adapter)) -+ return; -+ -+ -+ if(pHalData->bSwChnl) -+ { -+ phy_SwChnl8812(Adapter); -+ pHalData->bSwChnl = _FALSE; -+ } -+ -+ if(pHalData->bSetChnlBW) -+ { -+ phy_PostSetBwMode8812(Adapter); -+ pHalData->bSetChnlBW = _FALSE; -+ } -+ -+ ODM_ClearTxPowerTrackingState(&pHalData->odmpriv); -+ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ phy_InitRssiTRSW(Adapter); -+ -+ if ( (pHalData->bNeedIQK == _TRUE) -+#if (MP_DRIVER == 1) -+ || (Adapter->registrypriv.mp_mode == 1) -+#endif -+ ) -+ { -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ { -+#if (RTL8812A_SUPPORT == 1) -+ PHY_IQCalibrate_8812A(Adapter, _FALSE); -+#endif -+ } -+ else if(IS_HARDWARE_TYPE_8821(Adapter)) -+ { -+#if (RTL8821A_SUPPORT == 1) -+ PHY_IQCalibrate_8821A(pDM_Odm, _FALSE); -+#endif -+ } -+ pHalData->bNeedIQK = _FALSE; -+ } -+} -+ -+VOID -+PHY_HandleSwChnlAndSetBW8812( -+ IN PADAPTER Adapter, -+ IN BOOLEAN bSwitchChannel, -+ IN BOOLEAN bSetBandWidth, -+ IN u8 ChannelNum, -+ IN CHANNEL_WIDTH ChnlWidth, -+ IN u8 ChnlOffsetOf40MHz, -+ IN u8 ChnlOffsetOf80MHz, -+ IN u8 CenterFrequencyIndex1 -+) -+{ -+ PADAPTER pDefAdapter = GetDefaultAdapter(Adapter); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDefAdapter); -+ u8 tmpChannel = pHalData->CurrentChannel; -+ CHANNEL_WIDTH tmpBW= pHalData->CurrentChannelBW; -+ u8 tmpnCur40MhzPrimeSC = pHalData->nCur40MhzPrimeSC; -+ u8 tmpnCur80MhzPrimeSC = pHalData->nCur80MhzPrimeSC; -+ u8 tmpCenterFrequencyIndex1 =pHalData->CurrentCenterFrequencyIndex1; -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ -+ //DBG_871X("=> PHY_HandleSwChnlAndSetBW8812: bSwitchChannel %d, bSetBandWidth %d \n",bSwitchChannel,bSetBandWidth); -+ -+ //check is swchnl or setbw -+ if(!bSwitchChannel && !bSetBandWidth) -+ { -+ DBG_871X("PHY_HandleSwChnlAndSetBW8812: not switch channel and not set bandwidth \n"); -+ return; -+ } -+ -+ //skip change for channel or bandwidth is the same -+ if(bSwitchChannel) -+ { -+ if(pHalData->CurrentChannel != ChannelNum) -+ { -+ if (HAL_IsLegalChannel(Adapter, ChannelNum)) -+ pHalData->bSwChnl = _TRUE; -+ else -+ return; -+ } -+ } -+ -+ if(bSetBandWidth) -+ { -+ if(pHalData->bChnlBWInitialized == _FALSE) -+ { -+ pHalData->bChnlBWInitialized = _TRUE; -+ pHalData->bSetChnlBW = _TRUE; -+ } -+ else if((pHalData->CurrentChannelBW != ChnlWidth) || -+ (pHalData->nCur40MhzPrimeSC != ChnlOffsetOf40MHz) || -+ (pHalData->nCur80MhzPrimeSC != ChnlOffsetOf80MHz) || -+ (pHalData->CurrentCenterFrequencyIndex1!= CenterFrequencyIndex1)) -+ { -+ pHalData->bSetChnlBW = _TRUE; -+ } -+ } -+ -+ if(!pHalData->bSetChnlBW && !pHalData->bSwChnl) -+ { -+ //DBG_871X("<= PHY_HandleSwChnlAndSetBW8812: bSwChnl %d, bSetChnlBW %d \n",pHalData->bSwChnl,pHalData->bSetChnlBW); -+ return; -+ } -+ -+ -+ if(pHalData->bSwChnl) -+ { -+ pHalData->CurrentChannel=ChannelNum; -+ pHalData->CurrentCenterFrequencyIndex1 = ChannelNum; -+ } -+ -+ -+ if(pHalData->bSetChnlBW) -+ { -+ pHalData->CurrentChannelBW = ChnlWidth; -+#if 0 -+ if(ExtChnlOffsetOf40MHz==EXTCHNL_OFFSET_LOWER) -+ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else if(ExtChnlOffsetOf40MHz==EXTCHNL_OFFSET_UPPER) -+ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else -+ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if(ExtChnlOffsetOf80MHz==EXTCHNL_OFFSET_LOWER) -+ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else if(ExtChnlOffsetOf80MHz==EXTCHNL_OFFSET_UPPER) -+ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else -+ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+#else -+ pHalData->nCur40MhzPrimeSC = ChnlOffsetOf40MHz; -+ pHalData->nCur80MhzPrimeSC = ChnlOffsetOf80MHz; -+#endif -+ -+ pHalData->CurrentCenterFrequencyIndex1 = CenterFrequencyIndex1; -+ } -+ -+ //Switch workitem or set timer to do switch channel or setbandwidth operation -+ if (!RTW_CANNOT_RUN(Adapter)) -+ phy_SwChnlAndSetBwMode8812(Adapter); -+ else -+ { -+ if(pHalData->bSwChnl) -+ { -+ pHalData->CurrentChannel = tmpChannel; -+ pHalData->CurrentCenterFrequencyIndex1 = tmpChannel; -+ } -+ if(pHalData->bSetChnlBW) -+ { -+ pHalData->CurrentChannelBW = tmpBW; -+ pHalData->nCur40MhzPrimeSC = tmpnCur40MhzPrimeSC; -+ pHalData->nCur80MhzPrimeSC = tmpnCur80MhzPrimeSC; -+ pHalData->CurrentCenterFrequencyIndex1 = tmpCenterFrequencyIndex1; -+ } -+ } -+ -+ //DBG_871X("Channel %d ChannelBW %d ",pHalData->CurrentChannel, pHalData->CurrentChannelBW); -+ //DBG_871X("40MhzPrimeSC %d 80MhzPrimeSC %d ",pHalData->nCur40MhzPrimeSC, pHalData->nCur80MhzPrimeSC); -+ //DBG_871X("CenterFrequencyIndex1 %d \n",pHalData->CurrentCenterFrequencyIndex1); -+ -+ //DBG_871X("<= PHY_HandleSwChnlAndSetBW8812: bSwChnl %d, bSetChnlBW %d \n",pHalData->bSwChnl,pHalData->bSetChnlBW); -+ -+} -+ -+VOID -+PHY_SetBWMode8812( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth, // 20M or 40M -+ IN u8 Offset // Upper, Lower, or Don't care -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ //DBG_871X("%s()===>\n",__FUNCTION__); -+ -+ PHY_HandleSwChnlAndSetBW8812(Adapter, _FALSE, _TRUE, pHalData->CurrentChannel, Bandwidth, Offset, Offset, pHalData->CurrentChannel); -+ -+ //DBG_871X("<==%s()\n",__FUNCTION__); -+} -+ -+VOID -+PHY_SwChnl8812( -+ IN PADAPTER Adapter, -+ IN u8 channel -+ ) -+{ -+ //DBG_871X("%s()===>\n",__FUNCTION__); -+ -+ PHY_HandleSwChnlAndSetBW8812(Adapter, _TRUE, _FALSE, channel, 0, 0, 0, channel); -+ -+ //DBG_871X("<==%s()\n",__FUNCTION__); -+} -+ -+VOID -+PHY_SetSwChnlBWMode8812( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+) -+{ -+ //DBG_871X("%s()===>\n",__FUNCTION__); -+ -+ PHY_HandleSwChnlAndSetBW8812(Adapter, _TRUE, _TRUE, channel, Bandwidth, Offset40, Offset80, channel); -+ -+ //DBG_871X("<==%s()\n",__FUNCTION__); -+} -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_rf6052.c linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_rf6052.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_rf6052.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_rf6052.c 2017-06-07 23:07:21.033689581 +0300 -@@ -0,0 +1,190 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTL8812A_RF6052_C_ -+ -+//#include -+#include -+ -+ -+/*----------------------------------------------------------------------------- -+ * Function: PHY_RF6052SetBandwidth() -+ * -+ * Overview: This function is called by SetBWModeCallback8190Pci() only -+ * -+ * Input: PADAPTER Adapter -+ * WIRELESS_BANDWIDTH_E Bandwidth //20M or 40M -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Note: For RF type 0222D -+ *---------------------------------------------------------------------------*/ -+VOID -+PHY_RF6052SetBandwidth8812( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth) //20M or 40M -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ switch(Bandwidth) -+ { -+ case CHANNEL_WIDTH_20: -+ //DBG_871X("PHY_RF6052SetBandwidth8812(), set 20MHz\n"); -+ PHY_SetRFReg(Adapter, RF_PATH_A, RF_CHNLBW_Jaguar, BIT11|BIT10, 3); -+ PHY_SetRFReg(Adapter, RF_PATH_B, RF_CHNLBW_Jaguar, BIT11|BIT10, 3); -+ break; -+ -+ case CHANNEL_WIDTH_40: -+ //DBG_871X("PHY_RF6052SetBandwidth8812(), set 40MHz\n"); -+ PHY_SetRFReg(Adapter, RF_PATH_A, RF_CHNLBW_Jaguar, BIT11|BIT10, 1); -+ PHY_SetRFReg(Adapter, RF_PATH_B, RF_CHNLBW_Jaguar, BIT11|BIT10, 1); -+ break; -+ -+ case CHANNEL_WIDTH_80: -+ //DBG_871X("PHY_RF6052SetBandwidth8812(), set 80MHz\n"); -+ PHY_SetRFReg(Adapter, RF_PATH_A, RF_CHNLBW_Jaguar, BIT11|BIT10, 0); -+ PHY_SetRFReg(Adapter, RF_PATH_B, RF_CHNLBW_Jaguar, BIT11|BIT10, 0); -+ break; -+ -+ default: -+ DBG_871X("PHY_RF6052SetBandwidth8812(): unknown Bandwidth: %#X\n",Bandwidth ); -+ break; -+ } -+} -+ -+static int -+phy_RF6052_Config_ParaFile_8812( -+ IN PADAPTER Adapter -+ ) -+{ -+ u8 eRFPath; -+ int rtStatus = _SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ static char sz8812RadioAFile[] = RTL8812_PHY_RADIO_A; -+ static char sz8812RadioBFile[] = RTL8812_PHY_RADIO_B; -+ static char sz8812TxPwrTrack[] = RTL8812_TXPWR_TRACK; -+ static char sz8821RadioAFile[] = RTL8821_PHY_RADIO_A; -+ static char sz8821RadioBFile[] = RTL8821_PHY_RADIO_B; -+ static char sz8821TxPwrTrack[] = RTL8821_TXPWR_TRACK; -+ char *pszRadioAFile = NULL, *pszRadioBFile = NULL, *pszTxPwrTrack = NULL; -+ -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ { -+ pszRadioAFile = sz8812RadioAFile; -+ pszRadioBFile = sz8812RadioBFile; -+ pszTxPwrTrack = sz8812TxPwrTrack; -+ } -+ else -+ { -+ pszRadioAFile = sz8821RadioAFile; -+ pszRadioBFile = sz8821RadioBFile; -+ pszTxPwrTrack = sz8821TxPwrTrack; -+ } -+ -+ -+ //3//----------------------------------------------------------------- -+ //3// <2> Initialize RF -+ //3//----------------------------------------------------------------- -+ //for(eRFPath = RF_PATH_A; eRFPath NumTotalRFPath; eRFPath++) -+ for(eRFPath = 0; eRFPath NumTotalRFPath; eRFPath++) -+ { -+ /*----Initialize RF fom connfiguration file----*/ -+ switch(eRFPath) -+ { -+ case RF_PATH_A: -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (PHY_ConfigRFWithParaFile(Adapter, pszRadioAFile, eRFPath) == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if(HAL_STATUS_FAILURE ==ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv,CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) -+ rtStatus = _FAIL; -+#endif -+ } -+ break; -+ case RF_PATH_B: -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (PHY_ConfigRFWithParaFile(Adapter, pszRadioBFile, eRFPath) == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if(HAL_STATUS_FAILURE ==ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv,CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) -+ rtStatus = _FAIL; -+#endif -+ } -+ break; -+ default: -+ break; -+ } -+ -+ if(rtStatus != _SUCCESS){ -+ DBG_871X("%s():Radio[%d] Fail!!", __FUNCTION__, eRFPath); -+ goto phy_RF6052_Config_ParaFile_Fail; -+ } -+ -+ } -+ -+ //3 ----------------------------------------------------------------- -+ //3 Configuration of Tx Power Tracking -+ //3 ----------------------------------------------------------------- -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (PHY_ConfigRFWithTxPwrTrackParaFile(Adapter, pszTxPwrTrack) == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ ODM_ConfigRFWithTxPwrTrackHeaderFile(&pHalData->odmpriv); -+#endif -+ } -+ -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("<---phy_RF6052_Config_ParaFile_8812()\n")); -+ -+phy_RF6052_Config_ParaFile_Fail: -+ return rtStatus; -+} -+ -+ -+int -+PHY_RF6052_Config_8812( -+ IN PADAPTER Adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rtStatus = _SUCCESS; -+ -+ // Initialize general global value -+ if(pHalData->rf_type == RF_1T1R) -+ pHalData->NumTotalRFPath = 1; -+ else -+ pHalData->NumTotalRFPath = 2; -+ -+ // -+ // Config BB and RF -+ // -+ rtStatus = phy_RF6052_Config_ParaFile_8812(Adapter); -+ -+ return rtStatus; -+ -+} -+ -+ -+/* End of HalRf6052.c */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_rxdesc.c linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_rxdesc.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_rxdesc.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_rxdesc.c 2017-06-07 23:07:21.033689581 +0300 -@@ -0,0 +1,68 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_mp.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_mp.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_mp.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_mp.c 2018-02-06 17:42:30.714967223 +0200 +@@ -0,0 +1,1098 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -280761,10 +117228,6013 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_rxdesc.c linux/3rd + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++#define _RTL8812A_MP_C_ ++#ifdef CONFIG_MP_INCLUDED ++ ++//#include ++#include ++ ++ ++s32 Hal_SetPowerTracking(PADAPTER padapter, u8 enable) ++{ ++ bool bResult = true; ++ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ pHalData->TxPowerTrackControl = (u1Byte)enable; ++ if(pHalData->TxPowerTrackControl > 1) ++ pHalData->TxPowerTrackControl = 0; ++ return bResult; ++ ++ ++ return _SUCCESS; ++} ++ ++void Hal_GetPowerTracking(PADAPTER padapter, u8 *enable) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ ++ ++ *enable = pDM_Odm->RFCalibrateInfo.TxPowerTrackControl; ++} ++ ++static void Hal_disable_dm(PADAPTER padapter) ++{ ++ u8 v8; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ ++ ++ //3 1. disable firmware dynamic mechanism ++ // disable Power Training, Rate Adaptive ++ v8 = rtw_read8(padapter, REG_BCN_CTRL); ++ v8 &= ~EN_BCN_FUNCTION; ++ rtw_write8(padapter, REG_BCN_CTRL, v8); ++ ++ //3 2. disable driver dynamic mechanism ++ // disable Dynamic Initial Gain ++ // disable High Power ++ // disable Power Tracking ++ Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); ++ ++ // enable APK, LCK and IQK but disable power tracking ++ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = false; ++ Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, true); ++} ++ ++/*----------------------------------------------------------------------------- ++ * Function: mpt_SwitchRfSetting + * ++ * Overview: Change RF Setting when we siwthc channel/rate/BW for MP. ++ * ++ * Input: IN PADAPTER pAdapter ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 01/08/2009 MHC Suggestion from SD3 Willis for 92S series. ++ * 01/09/2009 MHC Add CCK modification for 40MHZ. Suggestion from SD3. ++ * ++ *---------------------------------------------------------------------------*/ ++void Hal_mpt_SwitchRfSetting(PADAPTER pAdapter) ++{ ++ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ struct mp_priv *pmp = &pAdapter->mppriv; ++ u1Byte ChannelToSw = pmp->channel; ++ u32 ulRateIdx = pmp->rateidx; ++ u32 ulbandwidth = pmp->bandwidth; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ // <20120525, Kordan> Dynamic mechanism for APK, asked by Dennis. ++ pmp->MptCtx.backup0x52_RF_A = (u1Byte)PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0); ++ pmp->MptCtx.backup0x52_RF_B = (u1Byte)PHY_QueryRFReg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0); ++ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0, 0xD); ++ PHY_SetRFReg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0, 0xD); ++ ++ return ; ++} ++/*---------------------------hal\rtl8192c\MPT_Phy.c---------------------------*/ ++ ++/*---------------------------hal\rtl8192c\MPT_HelperFunc.c---------------------------*/ ++void Hal_MPT_CCKTxPowerAdjust(PADAPTER Adapter, bool bInCH14) ++{ ++ u32 TempVal = 0, TempVal2 = 0, TempVal3 = 0; ++ u32 CurrCCKSwingVal = 0, CCKSwingIndex = 12; ++ u8 i; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ ++ // get current cck swing value and check 0xa22 & 0xa23 later to match the table. ++ CurrCCKSwingVal = read_bbreg(Adapter, rCCK0_TxFilter1, bMaskHWord); ++ ++ if (!bInCH14) ++ { ++ // Readback the current bb cck swing value and compare with the table to ++ // get the current swing index ++ for (i = 0; i < CCK_TABLE_SIZE; i++) ++ { ++ if (((CurrCCKSwingVal&0xff) == (u32)CCKSwingTable_Ch1_Ch13[i][0]) && ++ (((CurrCCKSwingVal&0xff00)>>8) == (u32)CCKSwingTable_Ch1_Ch13[i][1])) ++ { ++ CCKSwingIndex = i; ++// RT_TRACE(COMP_INIT, DBG_LOUD,("Ch1~13, Current reg0x%x = 0x%lx, CCKSwingIndex=0x%x\n", ++// (rCCK0_TxFilter1+2), CurrCCKSwingVal, CCKSwingIndex)); ++ break; ++ } ++ } ++ ++ //Write 0xa22 0xa23 ++ TempVal = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][0] + ++ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][1]<<8) ; ++ ++ ++ //Write 0xa24 ~ 0xa27 ++ TempVal2 = 0; ++ TempVal2 = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][2] + ++ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][3]<<8) + ++ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][4]<<16 )+ ++ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][5]<<24); ++ ++ //Write 0xa28 0xa29 ++ TempVal3 = 0; ++ TempVal3 = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][6] + ++ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][7]<<8) ; ++ } ++ else ++ { ++ for (i = 0; i < CCK_TABLE_SIZE; i++) ++ { ++ if (((CurrCCKSwingVal&0xff) == (u32)CCKSwingTable_Ch14[i][0]) && ++ (((CurrCCKSwingVal&0xff00)>>8) == (u32)CCKSwingTable_Ch14[i][1])) ++ { ++ CCKSwingIndex = i; ++// RT_TRACE(COMP_INIT, DBG_LOUD,("Ch14, Current reg0x%x = 0x%lx, CCKSwingIndex=0x%x\n", ++// (rCCK0_TxFilter1+2), CurrCCKSwingVal, CCKSwingIndex)); ++ break; ++ } ++ } ++ ++ //Write 0xa22 0xa23 ++ TempVal = CCKSwingTable_Ch14[CCKSwingIndex][0] + ++ (CCKSwingTable_Ch14[CCKSwingIndex][1]<<8) ; ++ ++ //Write 0xa24 ~ 0xa27 ++ TempVal2 = 0; ++ TempVal2 = CCKSwingTable_Ch14[CCKSwingIndex][2] + ++ (CCKSwingTable_Ch14[CCKSwingIndex][3]<<8) + ++ (CCKSwingTable_Ch14[CCKSwingIndex][4]<<16 )+ ++ (CCKSwingTable_Ch14[CCKSwingIndex][5]<<24); ++ ++ //Write 0xa28 0xa29 ++ TempVal3 = 0; ++ TempVal3 = CCKSwingTable_Ch14[CCKSwingIndex][6] + ++ (CCKSwingTable_Ch14[CCKSwingIndex][7]<<8) ; ++ } ++ ++ write_bbreg(Adapter, rCCK0_TxFilter1, bMaskHWord, TempVal); ++ write_bbreg(Adapter, rCCK0_TxFilter2, bMaskDWord, TempVal2); ++ write_bbreg(Adapter, rCCK0_DebugPort, bMaskLWord, TempVal3); ++} ++ ++void Hal_MPT_CCKTxPowerAdjustbyIndex(PADAPTER pAdapter, bool beven) ++{ ++ s32 TempCCk; ++ u8 CCK_index, CCK_index_old; ++ u8 Action = 0; //0: no action, 1: even->odd, 2:odd->even ++ u8 TimeOut = 100; ++ s32 i = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; ++ ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ ++ ++ if (!IS_92C_SERIAL(pHalData->VersionID)) ++ return; ++#if 0 ++ while(PlatformAtomicExchange(&Adapter->IntrCCKRefCount, true) == true) ++ { ++ PlatformSleepUs(100); ++ TimeOut--; ++ if(TimeOut <= 0) ++ { ++ RTPRINT(FINIT, INIT_TxPower, ++ ("!!!MPT_CCKTxPowerAdjustbyIndex Wait for check CCK gain index too long!!!\n" )); ++ break; ++ } ++ } ++#endif ++ if (beven && !pMptCtx->bMptIndexEven) //odd->even ++ { ++ Action = 2; ++ pMptCtx->bMptIndexEven = true; ++ } ++ else if (!beven && pMptCtx->bMptIndexEven) //even->odd ++ { ++ Action = 1; ++ pMptCtx->bMptIndexEven = false; ++ } ++ ++ if (Action != 0) ++ { ++ //Query CCK default setting From 0xa24 ++ TempCCk = read_bbreg(pAdapter, rCCK0_TxFilter2, bMaskDWord) & bMaskCCK; ++ for (i = 0; i < CCK_TABLE_SIZE; i++) ++ { ++ if (pDM_Odm->RFCalibrateInfo.bCCKinCH14) ++ { ++ if (_rtw_memcmp((void*)&TempCCk, (void*)&CCKSwingTable_Ch14[i][2], 4) == true) ++ { ++ CCK_index_old = (u8) i; ++// RTPRINT(FINIT, INIT_TxPower,("MPT_CCKTxPowerAdjustbyIndex: Initial reg0x%x = 0x%lx, CCK_index=0x%x, ch 14 %d\n", ++// rCCK0_TxFilter2, TempCCk, CCK_index_old, pHalData->bCCKinCH14)); ++ break; ++ } ++ } ++ else ++ { ++ if (_rtw_memcmp((void*)&TempCCk, (void*)&CCKSwingTable_Ch1_Ch13[i][2], 4) == true) ++ { ++ CCK_index_old = (u8) i; ++// RTPRINT(FINIT, INIT_TxPower,("MPT_CCKTxPowerAdjustbyIndex: Initial reg0x%x = 0x%lx, CCK_index=0x%x, ch14 %d\n", ++// rCCK0_TxFilter2, TempCCk, CCK_index_old, pHalData->bCCKinCH14)); ++ break; ++ } ++ } ++ } ++ ++ if (Action == 1) ++ CCK_index = CCK_index_old - 1; ++ else ++ CCK_index = CCK_index_old + 1; ++ ++// RTPRINT(FINIT, INIT_TxPower,("MPT_CCKTxPowerAdjustbyIndex: new CCK_index=0x%x\n", ++// CCK_index)); ++ ++ //Adjust CCK according to gain index ++ if (!pDM_Odm->RFCalibrateInfo.bCCKinCH14) { ++ rtw_write8(pAdapter, 0xa22, CCKSwingTable_Ch1_Ch13[CCK_index][0]); ++ rtw_write8(pAdapter, 0xa23, CCKSwingTable_Ch1_Ch13[CCK_index][1]); ++ rtw_write8(pAdapter, 0xa24, CCKSwingTable_Ch1_Ch13[CCK_index][2]); ++ rtw_write8(pAdapter, 0xa25, CCKSwingTable_Ch1_Ch13[CCK_index][3]); ++ rtw_write8(pAdapter, 0xa26, CCKSwingTable_Ch1_Ch13[CCK_index][4]); ++ rtw_write8(pAdapter, 0xa27, CCKSwingTable_Ch1_Ch13[CCK_index][5]); ++ rtw_write8(pAdapter, 0xa28, CCKSwingTable_Ch1_Ch13[CCK_index][6]); ++ rtw_write8(pAdapter, 0xa29, CCKSwingTable_Ch1_Ch13[CCK_index][7]); ++ } else { ++ rtw_write8(pAdapter, 0xa22, CCKSwingTable_Ch14[CCK_index][0]); ++ rtw_write8(pAdapter, 0xa23, CCKSwingTable_Ch14[CCK_index][1]); ++ rtw_write8(pAdapter, 0xa24, CCKSwingTable_Ch14[CCK_index][2]); ++ rtw_write8(pAdapter, 0xa25, CCKSwingTable_Ch14[CCK_index][3]); ++ rtw_write8(pAdapter, 0xa26, CCKSwingTable_Ch14[CCK_index][4]); ++ rtw_write8(pAdapter, 0xa27, CCKSwingTable_Ch14[CCK_index][5]); ++ rtw_write8(pAdapter, 0xa28, CCKSwingTable_Ch14[CCK_index][6]); ++ rtw_write8(pAdapter, 0xa29, CCKSwingTable_Ch14[CCK_index][7]); ++ } ++ } ++#if 0 ++ RTPRINT(FINIT, INIT_TxPower, ++ ("MPT_CCKTxPowerAdjustbyIndex 0xa20=%x\n", PlatformEFIORead4Byte(Adapter, 0xa20))); ++ ++ PlatformAtomicExchange(&Adapter->IntrCCKRefCount, false); ++#endif ++} ++/*---------------------------hal\rtl8192c\MPT_HelperFunc.c---------------------------*/ ++ ++/* ++ * SetChannel ++ * Description ++ * Use H2C command to change channel, ++ * not only modify rf register, but also other setting need to be done. ++ */ ++void Hal_SetChannel(PADAPTER pAdapter) ++{ ++#if 0 ++ struct mp_priv *pmp = &pAdapter->mppriv; ++ ++// SelectChannel(pAdapter, pmp->channel); ++ set_channel_bwmode(pAdapter, pmp->channel, pmp->channel_offset, pmp->bandwidth); ++#else ++ u8 eRFPath; ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ struct mp_priv *pmp = &pAdapter->mppriv; ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); ++ ++ u8 channel = pmp->channel; ++ u8 bandwidth = pmp->bandwidth; ++ u8 rate = pmp->rateidx; ++ ++ ++ // set RF channel register ++ for (eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) ++ { ++ if(IS_HARDWARE_TYPE_8192D(pAdapter)) ++ _write_rfreg(pAdapter, eRFPath, ODM_CHANNEL, 0xFF, channel); ++ else ++ _write_rfreg(pAdapter, eRFPath, ODM_CHANNEL, 0x3FF, channel); ++ } ++ //Hal_mpt_SwitchRfSetting(pAdapter); ++ ++ SelectChannel(pAdapter, channel); ++ ++ if (pHalData->CurrentChannel == 14 && !pDM_Odm->RFCalibrateInfo.bCCKinCH14) { ++ pDM_Odm->RFCalibrateInfo.bCCKinCH14 = true; ++ Hal_MPT_CCKTxPowerAdjust(pAdapter, pDM_Odm->RFCalibrateInfo.bCCKinCH14); ++ } ++ else if (pHalData->CurrentChannel != 14 && pDM_Odm->RFCalibrateInfo.bCCKinCH14) { ++ pDM_Odm->RFCalibrateInfo.bCCKinCH14 = false; ++ Hal_MPT_CCKTxPowerAdjust(pAdapter, pDM_Odm->RFCalibrateInfo.bCCKinCH14); ++ } ++ ++#endif ++} ++ ++/* ++ * Notice ++ * Switch bandwitdth may change center frequency(channel) ++ */ ++void Hal_SetBandwidth(PADAPTER pAdapter) ++{ ++ struct mp_priv *pmp = &pAdapter->mppriv; ++ ++ ++ SetBWMode(pAdapter, pmp->bandwidth, pmp->prime_channel_offset); ++ Hal_mpt_SwitchRfSetting(pAdapter); ++} ++ ++void Hal_SetCCKTxPower(PADAPTER pAdapter, u8 *TxPower) ++{ ++ u32 tmpval = 0; ++ ++ ++ // rf-A cck tx power ++ write_bbreg(pAdapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, TxPower[RF_PATH_A]); ++ tmpval = (TxPower[RF_PATH_A]<<16) | (TxPower[RF_PATH_A]<<8) | TxPower[RF_PATH_A]; ++ write_bbreg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, 0xffffff00, tmpval); ++ ++ // rf-B cck tx power ++ write_bbreg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte0, TxPower[RF_PATH_B]); ++ tmpval = (TxPower[RF_PATH_B]<<16) | (TxPower[RF_PATH_B]<<8) | TxPower[RF_PATH_B]; ++ write_bbreg(pAdapter, rTxAGC_B_CCK1_55_Mcs32, 0xffffff00, tmpval); ++ ++ RT_TRACE(_module_mp_, _drv_notice_, ++ ("-SetCCKTxPower: A[0x%02x] B[0x%02x]\n", ++ TxPower[RF_PATH_A], TxPower[RF_PATH_B])); ++} ++ ++void Hal_SetOFDMTxPower(PADAPTER pAdapter, u8 *TxPower) ++{ ++ u32 TxAGC = 0; ++ u8 tmpval = 0; ++ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ ++ // HT Tx-rf(A) ++ tmpval = TxPower[RF_PATH_A]; ++ TxAGC = (tmpval<<24) | (tmpval<<16) | (tmpval<<8) | tmpval; ++ ++ write_bbreg(pAdapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); ++ write_bbreg(pAdapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); ++ write_bbreg(pAdapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); ++ write_bbreg(pAdapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); ++ write_bbreg(pAdapter, rTxAGC_A_Mcs11_Mcs08, bMaskDWord, TxAGC); ++ write_bbreg(pAdapter, rTxAGC_A_Mcs15_Mcs12, bMaskDWord, TxAGC); ++ ++ // HT Tx-rf(B) ++ tmpval = TxPower[RF_PATH_B]; ++ TxAGC = (tmpval<<24) | (tmpval<<16) | (tmpval<<8) | tmpval; ++ ++ write_bbreg(pAdapter, rTxAGC_B_Rate18_06, bMaskDWord, TxAGC); ++ write_bbreg(pAdapter, rTxAGC_B_Rate54_24, bMaskDWord, TxAGC); ++ write_bbreg(pAdapter, rTxAGC_B_Mcs03_Mcs00, bMaskDWord, TxAGC); ++ write_bbreg(pAdapter, rTxAGC_B_Mcs07_Mcs04, bMaskDWord, TxAGC); ++ write_bbreg(pAdapter, rTxAGC_B_Mcs11_Mcs08, bMaskDWord, TxAGC); ++ write_bbreg(pAdapter, rTxAGC_B_Mcs15_Mcs12, bMaskDWord, TxAGC); ++ ++} ++ ++void Hal_SetAntennaPathPower(PADAPTER pAdapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u8 TxPowerLevel[MAX_RF_PATH]; ++ u8 rfPath; ++ ++ TxPowerLevel[RF_PATH_A] = pAdapter->mppriv.txpoweridx; ++ TxPowerLevel[RF_PATH_B] = pAdapter->mppriv.txpoweridx_b; ++ ++ switch (pAdapter->mppriv.antenna_tx) ++ { ++ case ANTENNA_A: ++ default: ++ rfPath = RF_PATH_A; ++ break; ++ case ANTENNA_B: ++ rfPath = RF_PATH_B; ++ break; ++ case ANTENNA_C: ++ rfPath = RF_PATH_C; ++ break; ++ } ++ ++ switch (pHalData->rf_chip) ++ { ++ case RF_8225: ++ case RF_8256: ++ case RF_6052: ++ Hal_SetCCKTxPower(pAdapter, TxPowerLevel); ++ if (pAdapter->mppriv.rateidx < MPT_RATE_6M) // CCK rate ++ Hal_MPT_CCKTxPowerAdjustbyIndex(pAdapter, TxPowerLevel[rfPath]%2 == 0); ++ Hal_SetOFDMTxPower(pAdapter, TxPowerLevel); ++ break; ++ ++ default: ++ break; ++ } ++} ++ ++typedef enum _MPT_TXPWR_DEF{ ++ MPT_CCK, ++ MPT_OFDM, // L and HT OFDM ++ MPT_VHT_OFDM ++}MPT_TXPWR_DEF; ++ ++void ++mpt_SetTxPower_8812( ++ PADAPTER pAdapter, ++ MPT_TXPWR_DEF Rate, ++ pu1Byte pTxPower ++ ) ++{ ++ u1Byte path = 0; ++ ++ switch (Rate) ++ { ++ case MPT_CCK: ++ { ++ for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_B; path++) ++ { ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_1M ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_2M ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_5_5M); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_11M ); ++ } ++ } ++ break; ++ case MPT_OFDM: ++ { ++ for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_B; path++) ++ { ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_1M ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_2M ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_5_5M); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_11M ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_6M ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_9M ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_12M); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_18M); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_24M); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_36M); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_48M); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_54M); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS0 ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS1 ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS2 ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS3 ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS4 ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS5 ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS6 ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS7 ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS8 ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS9 ); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS10); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS11); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS12); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS13); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS14); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS15); ++ } ++ } break; ++ case MPT_VHT_OFDM: ++ { ++ for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_B; path++) ++ { ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS0); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS1); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS2); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS3); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS4); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS5); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS6); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS7); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS8); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS9); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS0); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS1); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS2); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS3); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS4); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS5); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS6); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS7); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS8); ++ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS9); ++ } ++ ++ } break; ++ ++ default: ++ DBG_871X("<===mpt_SetTxPower_8812: Illegal channel!!\n"); ++ break; ++ } ++ ++} ++ ++void Hal_SetTxPower(PADAPTER pAdapter) ++ { ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); ++ u1Byte path; ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ ++ path = ( pAdapter->mppriv.antenna_tx == ANTENNA_A) ? (ODM_RF_PATH_A) : (ODM_RF_PATH_B); ++ ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) ++ { ++ DBG_871X("===> MPT_ProSetTxPower: Jaguar\n"); ++ mpt_SetTxPower_8812(pAdapter, MPT_CCK, pMptCtx->TxPwrLevel); ++ mpt_SetTxPower_8812(pAdapter, MPT_OFDM, pMptCtx->TxPwrLevel); ++ mpt_SetTxPower_8812(pAdapter, MPT_VHT_OFDM, pMptCtx->TxPwrLevel); ++ } ++ ++ ODM_ClearTxPowerTrackingState(pDM_Odm); ++ ++} ++ ++void Hal_SetTxAGCOffset(PADAPTER pAdapter, u32 ulTxAGCOffset) ++{ ++ u32 TxAGCOffset_B, TxAGCOffset_C, TxAGCOffset_D,tmpAGC; ++ ++ TxAGCOffset_B = (ulTxAGCOffset&0x000000ff); ++ TxAGCOffset_C = ((ulTxAGCOffset&0x0000ff00)>>8); ++ TxAGCOffset_D = ((ulTxAGCOffset&0x00ff0000)>>16); ++ ++ tmpAGC = (TxAGCOffset_D<<8 | TxAGCOffset_C<<4 | TxAGCOffset_B); ++ write_bbreg(pAdapter, rFPGA0_TxGainStage, ++ (bXBTxAGC|bXCTxAGC|bXDTxAGC), tmpAGC); ++} ++ ++void Hal_SetDataRate(PADAPTER pAdapter) ++{ ++ //Hal_mpt_SwitchRfSetting(pAdapter); ++} ++ ++#define RF_PATH_AB 22 ++void Hal_SetAntenna(PADAPTER pAdapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; ++ R_ANTENNA_SELECT_OFDM *p_ofdm_tx; /* OFDM Tx register */ ++ R_ANTENNA_SELECT_CCK *p_cck_txrx; ++ ++ u8 r_rx_antenna_ofdm = 0, r_ant_select_cck_val = 0; ++ u8 chgTx = 0, chgRx = 0; ++ u32 r_ant_sel_cck_val = 0, r_ant_select_ofdm_val = 0, r_ofdm_tx_en_val = 0; ++ u32 reg0xC50 = 0; ++ ++ ++ p_ofdm_tx = (R_ANTENNA_SELECT_OFDM *)&r_ant_select_ofdm_val; ++ p_cck_txrx = (R_ANTENNA_SELECT_CCK *)&r_ant_select_cck_val; ++ ++ switch (pAdapter->mppriv.antenna_tx) ++ { ++ case ANTENNA_A: ++ pMptCtx->MptRfPath = ODM_RF_PATH_A; ++ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x1111); ++ if (pHalData->RFEType == 3) ++ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0 ); ++ break; ++ ++ case ANTENNA_B: ++ pMptCtx->MptRfPath = ODM_RF_PATH_B; ++ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x2222); ++ if (pHalData->RFEType == 3) ++ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x1 ); ++ break; ++ break; ++ ++ case ANTENNA_AB: // For 8192S ++ pMptCtx->MptRfPath = RF_PATH_AB; ++ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x3333); ++ if (pHalData->RFEType == 3) ++ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0 ); ++ break; ++ ++ default: ++ pMptCtx->MptRfPath = RF_PATH_AB; ++ DBG_871X("Unknown Tx antenna.\n"); ++ break; ++ } ++ ++ switch (pAdapter->mppriv.antenna_rx) { ++ case ANTENNA_A: ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); // RF_B_0x0[19:16] = 1, Standby mode ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, BIT19|BIT18|BIT17|BIT16, 0x3); ++ ++ // <20121101, Kordan> To prevent gain table from not switched, asked by Ynlin. ++ reg0xC50 = PHY_QueryBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0); ++ PHY_SetBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50+2); ++ PHY_SetBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50); ++ break; ++ case ANTENNA_B: ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); // RF_A_0x0[19:16] = 1, Standby mode ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x1); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, BIT19|BIT18|BIT17|BIT16, 0x3); ++ ++ // <20121101, Kordan> To prevent gain table from not switched, asked by Ynlin. ++ reg0xC50 = PHY_QueryBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0); ++ PHY_SetBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50+2); ++ PHY_SetBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50); ++ break; ++ case ANTENNA_AB: ++ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x33); ++ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); // RF_B_0x0[19:16] = 3, Rx mode ++ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); ++ break; ++ default: ++ DBG_871X("Unknown Rx antenna.\n"); ++ break; ++ } ++ ++ RT_TRACE(_module_mp_, _drv_notice_, ("-SwitchAntenna: finished\n")); ++} ++ ++s32 Hal_SetThermalMeter(PADAPTER pAdapter, u8 target_ther) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ ++ if (!netif_running(pAdapter->pnetdev)) { ++ RT_TRACE(_module_mp_, _drv_warning_, ("SetThermalMeter! Fail: interface not opened!\n")); ++ return _FAIL; ++ } ++ ++ if (check_fwstate(&pAdapter->mlmepriv, WIFI_MP_STATE) == false) { ++ RT_TRACE(_module_mp_, _drv_warning_, ("SetThermalMeter: Fail! not in MP mode!\n")); ++ return _FAIL; ++ } ++ ++ target_ther &= 0xff; ++ if (target_ther < 0x07) ++ target_ther = 0x07; ++ else if (target_ther > 0x1d) ++ target_ther = 0x1d; ++ ++ pHalData->EEPROMThermalMeter = target_ther; ++ ++ return _SUCCESS; ++} ++ ++void Hal_TriggerRFThermalMeter(PADAPTER pAdapter) ++{ ++ _write_rfreg( pAdapter, RF_PATH_A , RF_T_METER_8812A , BIT17 |BIT16 , 0x03 ); ++ ++// RT_TRACE(_module_mp_,_drv_alert_, ("TriggerRFThermalMeter() finished.\n" )); ++} ++ ++u8 Hal_ReadRFThermalMeter(PADAPTER pAdapter) ++{ ++ u32 ThermalValue = 0; ++ ++ ThermalValue = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, RF_T_METER_8812A, 0xfc00); // 0x42: RF Reg[15:10] ++ ++// RT_TRACE(_module_mp_, _drv_alert_, ("ThermalValue = 0x%x\n", ThermalValue)); ++ return (u8)ThermalValue; ++} ++ ++void Hal_GetThermalMeter(PADAPTER pAdapter, u8 *value) ++{ ++#if 0 ++ fw_cmd(pAdapter, IOCMD_GET_THERMAL_METER); ++ rtw_msleep_os(1000); ++ fw_cmd_data(pAdapter, value, 1); ++ *value &= 0xFF; ++#else ++ ++ Hal_TriggerRFThermalMeter(pAdapter); ++ rtw_msleep_os(1000); ++ *value = Hal_ReadRFThermalMeter(pAdapter); ++#endif ++} ++ ++void Hal_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ pAdapter->mppriv.MptCtx.bSingleCarrier = bStart; ++ if (bStart)// Start Single Carrier. ++ { ++ RT_TRACE(_module_mp_,_drv_alert_, ("SetSingleCarrierTx: test start\n")); ++ // 1. if OFDM block on? ++ if(!read_bbreg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) ++ write_bbreg(pAdapter, rFPGA0_RFMOD, bOFDMEn, bEnable);//set OFDM block on ++ ++ // 2. set CCK test mode off, set to CCK normal mode ++ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, bDisable); ++ // 3. turn on scramble setting ++ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, bEnable); ++ ++ // 4. Turn On Continue Tx and turn off the other test modes. ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) ++ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_SingleCarrier); ++ else ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_SingleCarrier); ++ ++ //for dynamic set Power index. ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); ++ ++ } ++ else// Stop Single Carrier. ++ { ++ RT_TRACE(_module_mp_,_drv_alert_, ("SetSingleCarrierTx: test stop\n")); ++ //Turn off all test modes. ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) ++ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_ALL_OFF); ++ else ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ALL_OFF); ++ ++ //Delay 10 ms //delay_ms(10); ++ rtw_msleep_os(10); ++ ++ //BB Reset ++ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); ++ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); ++ ++ //Stop for dynamic set Power index. ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); ++ ++ } ++} ++ ++ ++void Hal_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; ++ bool is92C = IS_92C_SERIAL(pHalData->VersionID); ++ ++ u8 rfPath; ++ u32 reg58 = 0x0; ++ static u4Byte regRF0x0 = 0x0; ++ static u4Byte reg0xCB0 = 0x0; ++ static u4Byte reg0xEB0 = 0x0; ++ static u4Byte reg0xCB4 = 0x0; ++ static u4Byte reg0xEB4 = 0x0; ++ switch (pAdapter->mppriv.antenna_tx) ++ { ++ case ANTENNA_A: ++ default: ++ rfPath = RF_PATH_A; ++ break; ++ case ANTENNA_B: ++ rfPath = RF_PATH_B; ++ break; ++ case ANTENNA_C: ++ rfPath = RF_PATH_C; ++ break; ++ } ++ ++ pAdapter->mppriv.MptCtx.bSingleTone = bStart; ++ if (bStart)// Start Single Tone. ++ { ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) ++ { ++ u1Byte p = ODM_RF_PATH_A; ++ ++ regRF0x0 = PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, bRFRegOffsetMask); ++ reg0xCB0 = PHY_QueryBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord); ++ reg0xEB0 = PHY_QueryBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord); ++ reg0xCB4 = PHY_QueryBBReg(pAdapter, rA_RFE_Pinmux_Jaguar+4, bMaskDWord); ++ reg0xEB4 = PHY_QueryBBReg(pAdapter, rB_RFE_Pinmux_Jaguar+4, bMaskDWord); ++ ++ PHY_SetBBReg(pAdapter, rOFDMCCKEN_Jaguar, BIT29|BIT28, 0x0); // Disable CCK and OFDM ++ ++ if (pMptCtx->MptRfPath == RF_PATH_AB) { ++ for (p = ODM_RF_PATH_A; p <= ODM_RF_PATH_B; ++p) { ++ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, 0xF0000, 0x2); // Tx mode: RF0x00[19:16]=4'b0010 ++ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, 0x1F, 0x0); // Lowest RF gain index: RF_0x0[4:0] = 0 ++ PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x1); // RF LO enabled ++ } ++ } else { ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC_Jaguar, 0xF0000, 0x2); // Tx mode: RF0x00[19:16]=4'b0010 ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC_Jaguar, 0x1F, 0x0); // Lowest RF gain index: RF_0x0[4:0] = 0 ++ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); // RF LO enabled ++ } ++ ++ ++ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); // 0xCB0[[23:16, 7:4] = 0x77007 ++ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); // 0xCB0[[23:16, 7:4] = 0x77007 ++ ++ if (pHalData->ExternalPA_5G) { ++ ++ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar+4, 0xFF00000, 0x12); // 0xCB4[23:16] = 0x12 ++ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar+4, 0xFF00000, 0x12); // 0xEB4[23:16] = 0x12 ++ } else if (pHalData->ExternalPA_2G) { ++ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar+4, 0xFF00000, 0x11); // 0xCB4[23:16] = 0x11 ++ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar+4, 0xFF00000, 0x11); // 0xEB4[23:16] = 0x11 ++ } ++ } ++ else ++ { ++ // Turn On SingleTone and turn off the other test modes. ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_SingleTone); ++ } ++ ++ //for dynamic set Power index. ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); ++ ++ } ++ else// Stop Single Tone. ++ { ++ RT_TRACE(_module_mp_,_drv_alert_, ("SetSingleToneTx: test stop\n")); ++ ++ { // <20120326, Kordan> To amplify the power of tone for Xtal calibration. (asked by Edlu) ++ // <20120326, Kordan> Only in single tone mode. (asked by Edlu) ++ if (IS_HARDWARE_TYPE_8188E(pAdapter)) ++ { ++ reg58 = PHY_QueryRFReg(pAdapter, RF_PATH_A, LNA_Low_Gain_3, bRFRegOffsetMask); ++ reg58 &= 0xFFFFFFF0; ++ PHY_SetRFReg(pAdapter, RF_PATH_A, LNA_Low_Gain_3, bRFRegOffsetMask, reg58); ++ } ++ ++ write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x1); ++ write_bbreg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 0x1); ++ } ++ if (is92C) { ++ _write_rfreg(pAdapter, RF_PATH_A, 0x21, BIT19, 0x00); ++ rtw_usleep_os(100); ++ write_rfreg(pAdapter, RF_PATH_A, 0x00, 0x32d75); // PAD all on. ++ write_rfreg(pAdapter, RF_PATH_B, 0x00, 0x32d75); // PAD all on. ++ rtw_usleep_os(100); ++ } else { ++ write_rfreg(pAdapter, rfPath, 0x21, 0x54000); ++ rtw_usleep_os(100); ++ write_rfreg(pAdapter, rfPath, 0x00, 0x30000); // PAD all on. ++ rtw_usleep_os(100); ++ } ++ ++ //Stop for dynamic set Power index. ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); ++ ++ } ++ ++} ++ ++ ++ ++void Hal_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) ++{ ++ pAdapter->mppriv.MptCtx.bCarrierSuppression = bStart; ++ if (bStart) // Start Carrier Suppression. ++ { ++ RT_TRACE(_module_mp_,_drv_alert_, ("SetCarrierSuppressionTx: test start\n")); ++ //if(pMgntInfo->dot11CurrentWirelessMode == WIRELESS_MODE_B) ++ if (pAdapter->mppriv.rateidx <= MPT_RATE_11M) ++ { ++ // 1. if CCK block on? ++ if(!read_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn)) ++ write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, bEnable);//set CCK block on ++ ++ //Turn Off All Test Mode ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) ++ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_ALL_OFF); ++ else ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ALL_OFF); ++ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); //transmit mode ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x0); //turn off scramble setting ++ //Set CCK Tx Test Rate ++ //PHY_SetBBReg(pAdapter, rCCK0_System, bCCKTxRate, pMgntInfo->ForcedDataRate); ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKTxRate, 0x0); //Set FTxRate to 1Mbps ++ } ++ ++ //for dynamic set Power index. ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); ++ ++ } ++ else// Stop Carrier Suppression. ++ { ++ RT_TRACE(_module_mp_,_drv_alert_, ("SetCarrierSuppressionTx: test stop\n")); ++ //if(pMgntInfo->dot11CurrentWirelessMode == WIRELESS_MODE_B) ++ if (pAdapter->mppriv.rateidx <= MPT_RATE_11M ) { ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); //normal mode ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x1); //turn on scramble setting ++ ++ //BB Reset ++ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); ++ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); ++ } ++ ++ //Stop for dynamic set Power index. ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); ++ ++ } ++ //DbgPrint("\n MPT_ProSetCarrierSupp() is finished. \n"); ++} ++ ++void Hal_SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart) ++{ ++ u32 cckrate; ++ ++ if (bStart) ++ { ++ RT_TRACE(_module_mp_, _drv_alert_, ++ ("SetCCKContinuousTx: test start\n")); ++ ++ // 1. if CCK block on? ++ if(!read_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn)) ++ write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, bEnable);//set CCK block on ++ ++ //Turn Off All Test Mode ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) ++ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_ALL_OFF); ++ else ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ALL_OFF); ++ //Set CCK Tx Test Rate ++ #if 0 ++ switch(pAdapter->mppriv.rateidx) ++ { ++ case 2: ++ cckrate = 0; ++ break; ++ case 4: ++ cckrate = 1; ++ break; ++ case 11: ++ cckrate = 2; ++ break; ++ case 22: ++ cckrate = 3; ++ break; ++ default: ++ cckrate = 0; ++ break; ++ } ++ #else ++ cckrate = pAdapter->mppriv.rateidx; ++ #endif ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKTxRate, cckrate); ++ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); //transmit mode ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x1); //turn on scramble setting ++ ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); ++ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); ++ ++ pAdapter->mppriv.MptCtx.bCckContTx = true; ++ pAdapter->mppriv.MptCtx.bOfdmContTx = false; ++ ++ } ++ else { ++ RT_TRACE(_module_mp_, _drv_info_, ++ ("SetCCKContinuousTx: test stop\n")); ++ ++ pAdapter->mppriv.MptCtx.bCckContTx = false; ++ pAdapter->mppriv.MptCtx.bOfdmContTx = false; ++ ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); //normal mode ++ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x1); //turn on scramble setting ++ ++ //BB Reset ++ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); ++ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); ++ ++ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); ++ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); ++ } ++}/* mpt_StartCckContTx */ ++ ++void Hal_SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ ++ if (bStart) { ++ RT_TRACE(_module_mp_, _drv_info_, ("SetOFDMContinuousTx: test start\n")); ++ // 1. if OFDM block on? ++ if(!read_bbreg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) ++ write_bbreg(pAdapter, rFPGA0_RFMOD, bOFDMEn, bEnable);//set OFDM block on ++ ++ ++ // 2. set CCK test mode off, set to CCK normal mode ++ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, bDisable); ++ ++ // 3. turn on scramble setting ++ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, bEnable); ++ ++ // 4. Turn On Continue Tx and turn off the other test modes. ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) ++ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_ContinuousTx); ++ else ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ContinuousTx); ++ //for dynamic set Power index. ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); ++ ++ } else { ++ RT_TRACE(_module_mp_,_drv_info_, ("SetOFDMContinuousTx: test stop\n")); ++ ++ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) ++ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_ALL_OFF); ++ else ++ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ALL_OFF); ++ ++ rtw_msleep_os(10); ++ //BB Reset ++ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); ++ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); ++ ++ //Stop for dynamic set Power index. ++ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); ++ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); ++ } ++ ++ pAdapter->mppriv.MptCtx.bCckContTx = false; ++ pAdapter->mppriv.MptCtx.bOfdmContTx = bStart; ++}/* mpt_StartOfdmContTx */ ++ ++void Hal_SetContinuousTx(PADAPTER pAdapter, u8 bStart) ++{ ++#if 0 ++ // ADC turn off [bit24-21] adc port0 ~ port1 ++ if (bStart) { ++ write_bbreg(pAdapter, rRx_Wait_CCCA, read_bbreg(pAdapter, rRx_Wait_CCCA) & 0xFE1FFFFF); ++ rtw_usleep_os(100); ++ } ++#endif ++ RT_TRACE(_module_mp_, _drv_info_, ++ ("SetContinuousTx: rate:%d\n", pAdapter->mppriv.rateidx)); ++ ++ pAdapter->mppriv.MptCtx.bStartContTx = bStart; ++ if (pAdapter->mppriv.rateidx <= MPT_RATE_11M) ++ { ++ Hal_SetCCKContinuousTx(pAdapter, bStart); ++ } ++ else if ((pAdapter->mppriv.rateidx >= MPT_RATE_6M) && ++ (pAdapter->mppriv.rateidx <= MPT_RATE_MCS15)) ++ { ++ Hal_SetOFDMContinuousTx(pAdapter, bStart); ++ } ++#if 0 ++ // ADC turn on [bit24-21] adc port0 ~ port1 ++ if (!bStart) { ++ write_bbreg(pAdapter, rRx_Wait_CCCA, read_bbreg(pAdapter, rRx_Wait_CCCA) | 0x01E00000); ++ } ++#endif ++} ++ ++#endif // CONFIG_MP_INCLUDE +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_phycfg.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_phycfg.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_phycfg.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_phycfg.c 2018-02-06 17:42:30.715967238 +0200 +@@ -0,0 +1,4327 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++#define _RTL8812A_PHYCFG_C_ ++ ++//#include ++ ++#include ++ ++ ++const char *const GLBwSrc[]={ ++ "CHANNEL_WIDTH_20", ++ "CHANNEL_WIDTH_40", ++ "CHANNEL_WIDTH_80", ++ "CHANNEL_WIDTH_160", ++ "CHANNEL_WIDTH_80_80" ++}; ++#define ENABLE_POWER_BY_RATE 1 ++#define POWERINDEX_ARRAY_SIZE 48 //= cckRatesSize + ofdmRatesSize + htRates1TSize + htRates2TSize + vhtRates1TSize + vhtRates1TSize; ++ ++/*---------------------Define local function prototype-----------------------*/ ++ ++/*----------------------------Function Body----------------------------------*/ ++ ++// ++// 1. BB register R/W API ++// ++ ++u32 ++PHY_QueryBBReg8812( ++ PADAPTER Adapter, ++ u32 RegAddr, ++ u32 BitMask ++ ) ++{ ++ u32 ReturnValue = 0, OriginalValue, BitShift; ++ ++#if (DISABLE_BB_RF == 1) ++ return 0; ++#endif ++ ++ //DBG_871X("--->PHY_QueryBBReg8812(): RegAddr(%#x), BitMask(%#x)\n", RegAddr, BitMask); ++ ++ ++ OriginalValue = rtw_read32(Adapter, RegAddr); ++ BitShift = PHY_CalculateBitShift(BitMask); ++ ReturnValue = (OriginalValue & BitMask) >> BitShift; ++ ++ //DBG_871X("BBR MASK=0x%x Addr[0x%x]=0x%x\n", BitMask, RegAddr, OriginalValue); ++ return (ReturnValue); ++} ++ ++ ++void ++PHY_SetBBReg8812( ++ PADAPTER Adapter, ++ u4Byte RegAddr, ++ u4Byte BitMask, ++ u4Byte Data ++ ) ++{ ++ u4Byte OriginalValue, BitShift; ++ ++#if (DISABLE_BB_RF == 1) ++ return; ++#endif ++ ++ if(BitMask!= bMaskDWord) ++ {//if not "double word" write ++ OriginalValue = rtw_read32(Adapter, RegAddr); ++ BitShift = PHY_CalculateBitShift(BitMask); ++ Data = ((OriginalValue) & (~BitMask)) |( ((Data << BitShift)) & BitMask); ++ } ++ ++ rtw_write32(Adapter, RegAddr, Data); ++ ++ //DBG_871X("BBW MASK=0x%x Addr[0x%x]=0x%x\n", BitMask, RegAddr, Data); ++} ++ ++// ++// 2. RF register R/W API ++// ++ ++static u32 ++phy_RFSerialRead( ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset ++ ) ++{ ++ u32 retValue = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ BB_REGISTER_DEFINITION_T *pPhyReg = &pHalData->PHYRegDef[eRFPath]; ++ bool bIsPIMode = false; ++ ++ ++ // 2009/06/17 MH We can not execute IO for power save or other accident mode. ++ //if(RT_CANNOT_IO(Adapter)) ++ //{ ++ // RT_DISP(FPHY, PHY_RFR, ("phy_RFSerialRead return all one\n")); ++ // return 0xFFFFFFFF; ++ //} ++ ++ // <20120809, Kordan> CCA OFF(when entering), asked by James to avoid reading the wrong value. ++ // <20120828, Kordan> Toggling CCA would affect RF 0x0, skip it! ++ if (Offset != 0x0 && ! (IS_VENDOR_8812A_C_CUT(Adapter) || IS_HARDWARE_TYPE_8821(Adapter))) ++ PHY_SetBBReg(Adapter, rCCAonSec_Jaguar, 0x8, 1); ++ ++ Offset &= 0xff; ++ ++ if (eRFPath == RF_PATH_A) ++ bIsPIMode = (bool)PHY_QueryBBReg(Adapter, 0xC00, 0x4); ++ else if (eRFPath == RF_PATH_B) ++ bIsPIMode = (bool)PHY_QueryBBReg(Adapter, 0xE00, 0x4); ++ ++ if(IS_VENDOR_8812A_TEST_CHIP(Adapter)) ++ PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, bMaskDWord, 0); ++ ++ PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, bHSSIRead_addr_Jaguar, Offset); ++ ++ if (IS_VENDOR_8812A_TEST_CHIP(Adapter) ) ++ PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, bMaskDWord, Offset|BIT8); ++ ++ if (IS_VENDOR_8812A_C_CUT(Adapter) || IS_HARDWARE_TYPE_8821(Adapter)) ++ rtw_udelay_os(20); ++ ++ if (bIsPIMode) ++ { ++ retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBackPi, rRead_data_Jaguar); ++ //DBG_871X("[PI mode] RFR-%d Addr[0x%x]=0x%x\n", eRFPath, pPhyReg->rfLSSIReadBackPi, retValue); ++ } ++ else ++ { ++ retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBack, rRead_data_Jaguar); ++ //DBG_871X("[SI mode] RFR-%d Addr[0x%x]=0x%x\n", eRFPath, pPhyReg->rfLSSIReadBack, retValue); ++ } ++ ++ // <20120809, Kordan> CCA ON(when exiting), asked by James to avoid reading the wrong value. ++ // <20120828, Kordan> Toggling CCA would affect RF 0x0, skip it! ++ if (Offset != 0x0 && ! (IS_VENDOR_8812A_C_CUT(Adapter) || IS_HARDWARE_TYPE_8821(Adapter))) ++ PHY_SetBBReg(Adapter, rCCAonSec_Jaguar, 0x8, 0); ++ ++ return retValue; ++} ++ ++ ++static void ++phy_RFSerialWrite( ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset, ++ u32 Data ++ ) ++{ ++ u32 DataAndAddr = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ BB_REGISTER_DEFINITION_T *pPhyReg = &pHalData->PHYRegDef[eRFPath]; ++ ++ // 2009/06/17 MH We can not execute IO for power save or other accident mode. ++ //if(RT_CANNOT_IO(Adapter)) ++ //{ ++ // RTPRINT(FPHY, PHY_RFW, ("phy_RFSerialWrite stop\n")); ++ // return; ++ //} ++ ++ Offset &= 0xff; ++ ++ // Shadow Update ++ //PHY_RFShadowWrite(Adapter, eRFPath, Offset, Data); ++ ++ // Put write addr in [27:20] and write data in [19:00] ++ DataAndAddr = ((Offset<<20) | (Data&0x000fffff)) & 0x0fffffff; ++ ++ //3 This is a workaround for 8812A test chips. ++ // <20120427, Kordan> MAC first moves lower 16 bits and then upper 16 bits of a 32-bit data. ++ // BaseBand doesn't know the two actions is actually only one action to access 32-bit data, ++ // so that the lower 16 bits is overwritten by the upper 16 bits. (Asked by ynlin.) ++ // (Unfortunately, the protection mechanism has not been implemented in 8812A yet.) ++ // 2012/10/26 MH Revise V3236 Lanhsin check in, if we do not enable the function ++ // for 8821, then it can not scan. ++ if ((!pHalData->bSupportUSB3) && (IS_TEST_CHIP(pHalData->VersionID))) // USB 2.0 or older ++ { ++ //if (IS_VENDOR_8812A_TEST_CHIP(Adapter) || IS_HARDWARE_TYPE_8821(Adapter) is) ++ { ++ rtw_write32(Adapter, 0x1EC, DataAndAddr); ++ if (eRFPath == RF_PATH_A) ++ rtw_write32(Adapter, 0x1E8, 0x4000F000|0xC90); ++ else ++ rtw_write32(Adapter, 0x1E8, 0x4000F000|0xE90); ++ } ++ } ++ else // USB 3.0 ++ { ++ // Write Operation ++ // TODO: Dynamically determine whether using PI or SI to write RF registers. ++ PHY_SetBBReg(Adapter, pPhyReg->rf3wireOffset, bMaskDWord, DataAndAddr); ++ //DBG_871X("RFW-%d Addr[0x%x]=0x%x\n", eRFPath, pPhyReg->rf3wireOffset, DataAndAddr); ++ } ++ ++} ++ ++u32 ++PHY_QueryRFReg8812( ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 RegAddr, ++ u32 BitMask ++ ) ++{ ++ u32 Original_Value, Readback_Value, BitShift; ++ ++#if (DISABLE_BB_RF == 1) ++ return 0; ++#endif ++ ++ Original_Value = phy_RFSerialRead(Adapter, eRFPath, RegAddr); ++ ++ BitShift = PHY_CalculateBitShift(BitMask); ++ Readback_Value = (Original_Value & BitMask) >> BitShift; ++ ++ return (Readback_Value); ++} ++ ++void ++PHY_SetRFReg8812( ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 RegAddr, ++ u32 BitMask, ++ u32 Data ++ ) ++{ ++#if (DISABLE_BB_RF == 1) ++ return; ++#endif ++ ++ if(BitMask == 0) ++ return; ++ ++ // RF data is 20 bits only ++ if (BitMask != bLSSIWrite_data_Jaguar) { ++ u32 Original_Value, BitShift; ++ Original_Value = phy_RFSerialRead(Adapter, eRFPath, RegAddr); ++ BitShift = PHY_CalculateBitShift(BitMask); ++ Data = ((Original_Value) & (~BitMask)) | (Data<< BitShift); ++ } ++ ++ phy_RFSerialWrite(Adapter, eRFPath, RegAddr, Data); ++ ++} ++ ++// ++// 3. Initial MAC/BB/RF config by reading MAC/BB/RF txt. ++// ++ ++s32 PHY_MACConfig8812(PADAPTER Adapter) ++{ ++ int rtStatus = _SUCCESS; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ s8 *pszMACRegFile; ++ s8 sz8812MACRegFile[] = RTL8812_PHY_MACREG; ++ ++ pszMACRegFile = sz8812MACRegFile; ++ ++ // ++ // Config MAC ++ // ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if(HAL_STATUS_SUCCESS != ODM_ConfigMACWithHeaderFile(&pHalData->odmpriv)) ++ rtStatus = _FAIL; ++#else ++ ++ // Not make sure EEPROM, add later ++ DBG_871X("Read MACREG.txt\n"); ++ rtStatus = phy_ConfigMACWithParaFile(Adapter, pszMACRegFile); ++#endif//CONFIG_EMBEDDED_FWIMG ++ ++ return rtStatus; ++} ++ ++ ++static void ++phy_InitBBRFRegisterDefinition( ++ PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ // RF Interface Sowrtware Control ++ pHalData->PHYRegDef[RF_PATH_A].rfintfs = rFPGA0_XAB_RFInterfaceSW; // 16 LSBs if read 32-bit from 0x870 ++ pHalData->PHYRegDef[RF_PATH_B].rfintfs = rFPGA0_XAB_RFInterfaceSW; // 16 MSBs if read 32-bit from 0x870 (16-bit for 0x872) ++ ++ // RF Interface Output (and Enable) ++ pHalData->PHYRegDef[RF_PATH_A].rfintfo = rFPGA0_XA_RFInterfaceOE; // 16 LSBs if read 32-bit from 0x860 ++ pHalData->PHYRegDef[RF_PATH_B].rfintfo = rFPGA0_XB_RFInterfaceOE; // 16 LSBs if read 32-bit from 0x864 ++ ++ // RF Interface (Output and) Enable ++ pHalData->PHYRegDef[RF_PATH_A].rfintfe = rFPGA0_XA_RFInterfaceOE; // 16 MSBs if read 32-bit from 0x860 (16-bit for 0x862) ++ pHalData->PHYRegDef[RF_PATH_B].rfintfe = rFPGA0_XB_RFInterfaceOE; // 16 MSBs if read 32-bit from 0x864 (16-bit for 0x866) ++ ++ pHalData->PHYRegDef[RF_PATH_A].rf3wireOffset = rA_LSSIWrite_Jaguar; //LSSI Parameter ++ pHalData->PHYRegDef[RF_PATH_B].rf3wireOffset = rB_LSSIWrite_Jaguar; ++ ++ pHalData->PHYRegDef[RF_PATH_A].rfHSSIPara2 = rHSSIRead_Jaguar; //wire control parameter2 ++ pHalData->PHYRegDef[RF_PATH_B].rfHSSIPara2 = rHSSIRead_Jaguar; //wire control parameter2 ++ ++ // Tranceiver Readback LSSI/HSPI mode ++ pHalData->PHYRegDef[RF_PATH_A].rfLSSIReadBack = rA_SIRead_Jaguar; ++ pHalData->PHYRegDef[RF_PATH_B].rfLSSIReadBack = rB_SIRead_Jaguar; ++ pHalData->PHYRegDef[RF_PATH_A].rfLSSIReadBackPi = rA_PIRead_Jaguar; ++ pHalData->PHYRegDef[RF_PATH_B].rfLSSIReadBackPi = rB_PIRead_Jaguar; ++ ++ //pHalData->bPhyValueInitReady=true; ++} ++ ++void ++PHY_BB8812_Config_1T( ++ PADAPTER Adapter ++ ) ++{ ++ // BB OFDM RX Path_A ++ PHY_SetBBReg(Adapter, rRxPath_Jaguar, bRxPath_Jaguar, 0x11); ++ // BB OFDM TX Path_A ++ PHY_SetBBReg(Adapter, rTxPath_Jaguar, bMaskLWord, 0x1111); ++ // BB CCK R/Rx Path_A ++ PHY_SetBBReg(Adapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); ++ // MCS support ++ PHY_SetBBReg(Adapter, 0x8bc, 0xc0000060, 0x4); ++ // RF Path_B HSSI OFF ++ PHY_SetBBReg(Adapter, 0xe00, 0xf, 0x4); ++ // RF Path_B Power Down ++ PHY_SetBBReg(Adapter, 0xe90, bMaskDWord, 0); ++ // ADDA Path_B OFF ++ PHY_SetBBReg(Adapter, 0xe60, bMaskDWord, 0); ++ PHY_SetBBReg(Adapter, 0xe64, bMaskDWord, 0); ++} ++ ++ ++static int ++phy_BB8812_Config_ParaFile( ++ PADAPTER Adapter ++ ) ++{ ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ int rtStatus = _SUCCESS; ++ ++ s8 sz8812BBRegFile[] = RTL8812_PHY_REG; ++ s8 sz8812AGCTableFile[] = RTL8812_AGC_TAB; ++ s8 sz8812BBRegPgFile[] = RTL8812_PHY_REG_PG; ++ s8 sz8812BBRegMpFile[] = RTL8812_PHY_REG_MP; ++ s8 sz8812BBRegLimitFile[] = RTL8812_TXPWR_LMT; ++ ++ s8 sz8821BBRegFile[] = RTL8821_PHY_REG; ++ s8 sz8821AGCTableFile[] = RTL8821_AGC_TAB; ++ s8 sz8821BBRegPgFile[] = RTL8821_PHY_REG_PG; ++ s8 sz8821BBRegMpFile[] = RTL8821_PHY_REG_MP; ++ s8 sz8821RFTxPwrLmtFile[] = RTL8821_TXPWR_LMT; ++ s8 *pszBBRegFile = NULL, *pszAGCTableFile = NULL, ++ *pszBBRegPgFile = NULL, *pszBBRegMpFile=NULL, ++ *pszRFTxPwrLmtFile = NULL; ++ ++ ++ //DBG_871X("==>phy_BB8812_Config_ParaFile\n"); ++ ++ if(IS_HARDWARE_TYPE_8812(Adapter)) ++ { ++ pszBBRegFile=sz8812BBRegFile ; ++ pszAGCTableFile =sz8812AGCTableFile; ++ pszBBRegPgFile = sz8812BBRegPgFile; ++ pszBBRegMpFile = sz8812BBRegMpFile; ++ pszRFTxPwrLmtFile = sz8812BBRegLimitFile; ++ } ++ else ++ { ++ pszBBRegFile=sz8821BBRegFile ; ++ pszAGCTableFile =sz8821AGCTableFile; ++ pszBBRegPgFile = sz8821BBRegPgFile; ++ pszBBRegMpFile = sz8821BBRegMpFile; ++ pszRFTxPwrLmtFile = sz8821RFTxPwrLmtFile; ++ } ++ ++ DBG_871X("===> phy_BB8812_Config_ParaFile() EEPROMRegulatory %d\n", pHalData->EEPROMRegulatory ); ++ ++ //DBG_871X(" ===> phy_BB8812_Config_ParaFile() phy_reg:%s\n",pszBBRegFile); ++ //DBG_871X(" ===> phy_BB8812_Config_ParaFile() phy_reg_pg:%s\n",pszBBRegPgFile); ++ //DBG_871X(" ===> phy_BB8812_Config_ParaFile() agc_table:%s\n",pszAGCTableFile); ++ ++ PHY_InitPowerLimitTable( &(pHalData->odmpriv) ); ++ ++ if ( ( Adapter->registrypriv.RegEnableTxPowerLimit == 1 && pHalData->EEPROMRegulatory != 2 ) || ++ pHalData->EEPROMRegulatory == 1 ) ++ { ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if (HAL_STATUS_SUCCESS != ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv, CONFIG_RF_TXPWR_LMT, 0)) ++ rtStatus = _FAIL; ++#else ++ rtStatus = PHY_ConfigBBWithPowerLimitTableParaFile( Adapter, pszRFTxPwrLmtFile ); ++#endif ++ ++ if(rtStatus != _SUCCESS){ ++ DBG_871X("phy_BB8812_Config_ParaFile():Write BB Reg Fail!!"); ++ goto phy_BB_Config_ParaFile_Fail; ++ } ++ } ++ ++ // Read PHY_REG.TXT BB INIT!! ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG)) ++ rtStatus = _FAIL; ++#else ++ // No matter what kind of CHIP we always read PHY_REG.txt. We must copy different ++ // type of parameter files to phy_reg.txt at first. ++ rtStatus = phy_ConfigBBWithParaFile(Adapter,pszBBRegFile); ++#endif ++ ++ if(rtStatus != _SUCCESS){ ++ DBG_871X("phy_BB8812_Config_ParaFile():Write BB Reg Fail!!"); ++ goto phy_BB_Config_ParaFile_Fail; ++ } ++ ++//f (MP_DRIVER == 1) ++#if 0 ++ // Read PHY_REG_MP.TXT BB INIT!! ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG)) ++ rtStatus = _FAIL; ++#else ++ // No matter what kind of CHIP we always read PHY_REG.txt. We must copy different ++ // type of parameter files to phy_reg.txt at first. ++ rtStatus = phy_ConfigBBWithMpParaFile(Adapter,pszBBRegMpFile); ++#endif ++ ++ if(rtStatus != _SUCCESS){ ++ DBG_871X("phy_BB8812_Config_ParaFile():Write BB Reg MP Fail!!"); ++ goto phy_BB_Config_ParaFile_Fail; ++ } ++#endif // #if (MP_DRIVER == 1) ++ ++ // If EEPROM or EFUSE autoload OK, We must config by PHY_REG_PG.txt ++ //1 TODO ++ if (pEEPROM->bautoload_fail_flag == false) ++ { ++ pHalData->pwrGroupCnt = 0; ++ ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG_PG)) ++ rtStatus = _FAIL; ++#else ++ rtStatus = phy_ConfigBBWithPgParaFile(Adapter, pszBBRegPgFile); ++#endif ++ ++ if(rtStatus != _SUCCESS){ ++ DBG_871X("phy_BB8812_Config_ParaFile():BB_PG Reg Fail!!"); ++ goto phy_BB_Config_ParaFile_Fail; ++ } ++ ++ if ( ( Adapter->registrypriv.RegEnableTxPowerLimit == 1 && pHalData->EEPROMRegulatory != 2 ) || ++ pHalData->EEPROMRegulatory == 1 ) ++ PHY_ConvertPowerLimitToPowerIndex( Adapter ); ++ } ++ ++ ++ // BB AGC table Initialization ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_AGC_TAB)) ++ rtStatus = _FAIL; ++#else ++ rtStatus = phy_ConfigBBWithParaFile(Adapter, pszAGCTableFile); ++#endif ++ ++ if(rtStatus != _SUCCESS){ ++ DBG_871X("phy_BB8812_Config_ParaFile():AGC Table Fail\n"); ++ goto phy_BB_Config_ParaFile_Fail; ++ } ++ ++phy_BB_Config_ParaFile_Fail: ++ ++ return rtStatus; ++} ++ ++int ++PHY_BBConfig8812( ++ PADAPTER Adapter ++ ) ++{ ++ int rtStatus = _SUCCESS; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 TmpU1B=0; ++ u8 CrystalCap; ++ ++ phy_InitBBRFRegisterDefinition(Adapter); ++ ++ //tangw check start 20120412 ++ // . APLL_EN,,APLL_320_GATEB,APLL_320BIAS, auto config by hw fsm after pfsm_go (0x4 bit 8) set ++ TmpU1B = rtw_read8(Adapter, REG_SYS_FUNC_EN); ++ ++ if(IS_HARDWARE_TYPE_8812AU(Adapter) || IS_HARDWARE_TYPE_8821U(Adapter)) ++ TmpU1B |= FEN_USBA; ++ else if(IS_HARDWARE_TYPE_8812E(Adapter) || IS_HARDWARE_TYPE_8821E(Adapter)) ++ TmpU1B |= FEN_PCIEA; ++ ++ rtw_write8(Adapter, REG_SYS_FUNC_EN, TmpU1B); ++ ++ rtw_write8(Adapter, REG_SYS_FUNC_EN, (TmpU1B|FEN_BB_GLB_RSTn|FEN_BBRSTB));//same with 8812 ++ //6. 0x1f[7:0] = 0x07 PathA RF Power On ++ rtw_write8(Adapter, REG_RF_CTRL, 0x07);//RF_SDMRSTB,RF_RSTB,RF_EN same with 8723a ++ //7. PathB RF Power On ++ rtw_write8(Adapter, REG_OPT_CTRL_8812+2, 0x7);//RF_SDMRSTB,RF_RSTB,RF_EN same with 8723a ++ //tangw check end 20120412 ++ ++ ++ // ++ // Config BB and AGC ++ // ++ rtStatus = phy_BB8812_Config_ParaFile(Adapter); ++ ++ if(IS_HARDWARE_TYPE_8812(Adapter)) ++ { ++ // write 0x2C[30:25] = 0x2C[24:19] = CrystalCap ++ CrystalCap = pHalData->CrystalCap & 0x3F; ++ PHY_SetBBReg(Adapter, REG_MAC_PHY_CTRL, 0x7FF80000, (CrystalCap | (CrystalCap << 6))); ++ } ++ else if ((IS_HARDWARE_TYPE_8723A(Adapter) && pHalData->EEPROMVersion >= 0x01) || ++ IS_HARDWARE_TYPE_8821(Adapter) || IS_HARDWARE_TYPE_8723B(Adapter) || ++ IS_HARDWARE_TYPE_8192E(Adapter)) ++ { ++ // 0x2C[23:18] = 0x2C[17:12] = CrystalCap ++ CrystalCap = pHalData->CrystalCap & 0x3F; ++ PHY_SetBBReg(Adapter, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCap | (CrystalCap << 6))); ++ } ++ ++ if(IS_HARDWARE_TYPE_JAGUAR(Adapter)) ++ { ++ pHalData->Reg837 = rtw_read8(Adapter, 0x837); ++ } ++ ++ return rtStatus; ++ ++} ++ ++int ++PHY_RFConfig8812( ++ PADAPTER Adapter ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ int rtStatus = _SUCCESS; ++ ++ if (Adapter->bSurpriseRemoved) ++ return _FAIL; ++ ++ switch(pHalData->rf_chip) ++ { ++ case RF_PSEUDO_11N: ++ DBG_871X("%s(): RF_PSEUDO_11N\n",__FUNCTION__); ++ break; ++ default: ++ rtStatus = PHY_RF6052_Config_8812(Adapter); ++ break; ++ } ++ ++ return rtStatus; ++} ++ ++bool ++eqNByte( ++ const u8* str1, ++ u8* str2, ++ u32 num ++ ) ++{ ++ if(num==0) ++ return false; ++ while(num>0) ++ { ++ num--; ++ if(str1[num]!=str2[num]) ++ return false; ++ } ++ return true; ++} ++ ++bool ++GetU1ByteIntegerFromStringInDecimal( ++ const s8* Str, ++ u8* pInt ++ ) ++{ ++ u16 i = 0; ++ *pInt = 0; ++ ++ while ( Str[i] != '\0' ) ++ { ++ if ( Str[i] >= '0' && Str[i] <= '9' ) ++ { ++ *pInt *= 10; ++ *pInt += ( Str[i] - '0' ); ++ } ++ else ++ { ++ return false; ++ } ++ ++i; ++ } ++ ++ return true; ++} ++ ++static s8 ++phy_GetChannelGroup( ++ BAND_TYPE Band, ++ u8 Channel ++ ) ++{ ++ s8 channelGroup = -1; ++ if ( Channel <= 14 && Band == BAND_ON_2_4G ) ++ { ++ if ( 1 <= Channel && Channel <= 2 ) channelGroup = 0; ++ else if ( 3 <= Channel && Channel <= 5 ) channelGroup = 1; ++ else if ( 6 <= Channel && Channel <= 8 ) channelGroup = 2; ++ else if ( 9 <= Channel && Channel <= 11 ) channelGroup = 3; ++ else if ( 12 <= Channel && Channel <= 14) channelGroup = 4; ++ else ++ { ++ DBG_871X( "==> phy_GetChannelGroup() in 2.4 G, but Channel %d in Group not found \n", Channel ); ++ channelGroup = -1; ++ } ++ } ++ else if( Band == BAND_ON_5G ) ++ { ++ if ( 36 <= Channel && Channel <= 42 ) channelGroup = 0; ++ else if ( 44 <= Channel && Channel <= 48 ) channelGroup = 1; ++ else if ( 50 <= Channel && Channel <= 58 ) channelGroup = 2; ++ else if ( 60 <= Channel && Channel <= 64 ) channelGroup = 3; ++ else if ( 100 <= Channel && Channel <= 106 ) channelGroup = 4; ++ else if ( 108 <= Channel && Channel <= 114 ) channelGroup = 5; ++ else if ( 116 <= Channel && Channel <= 122 ) channelGroup = 6; ++ else if ( 124 <= Channel && Channel <= 130 ) channelGroup = 7; ++ else if ( 132 <= Channel && Channel <= 138 ) channelGroup = 8; ++ else if ( 140 <= Channel && Channel <= 144 ) channelGroup = 9; ++ else if ( 149 <= Channel && Channel <= 155 ) channelGroup = 10; ++ else if ( 157 <= Channel && Channel <= 161 ) channelGroup = 11; ++ else if ( 165 <= Channel && Channel <= 171 ) channelGroup = 12; ++ else if ( 173 <= Channel && Channel <= 177 ) channelGroup = 13; ++ else ++ { ++ DBG_871X("==>phy_GetChannelGroup() in 5G, but Channel %d in Group not found \n", Channel ); ++ channelGroup = -1; ++ } ++ } ++ else ++ { ++ DBG_871X("==>phy_GetChannelGroup() in unsupported band %d\n", Band ); ++ channelGroup = -1; ++ } ++ ++ return channelGroup; ++} ++ ++u8 ++phy_getPowerByRateBaseIndex( ++ BAND_TYPE Band, ++ u8 Rate ++ ) ++{ ++ u8 index = 0; ++ if ( Band == BAND_ON_2_4G ) ++ { ++ switch ( Rate ) ++ { ++ case MGN_1M: case MGN_2M: case MGN_5_5M: case MGN_11M: ++ index = 0; ++ break; ++ ++ case MGN_6M: case MGN_9M: case MGN_12M: case MGN_18M: ++ case MGN_24M: case MGN_36M: case MGN_48M: case MGN_54M: ++ index = 1; ++ break; ++ ++ case MGN_MCS0: case MGN_MCS1: case MGN_MCS2: case MGN_MCS3: ++ case MGN_MCS4: case MGN_MCS5: case MGN_MCS6: case MGN_MCS7: ++ index = 2; ++ break; ++ ++ case MGN_MCS8: case MGN_MCS9: case MGN_MCS10: case MGN_MCS11: ++ case MGN_MCS12: case MGN_MCS13: case MGN_MCS14: case MGN_MCS15: ++ index = 3; ++ break; ++ ++ default: ++ DBG_871X("Wrong rate 0x%x to obtain index in 2.4G in phy_getPowerByRateBaseIndex()\n", Rate ); ++ break; ++ } ++ } ++ else if ( Band == BAND_ON_5G ) ++ { ++ switch ( Rate ) ++ { ++ case MGN_6M: case MGN_9M: case MGN_12M: case MGN_18M: ++ case MGN_24M: case MGN_36M: case MGN_48M: case MGN_54M: ++ index = 0; ++ break; ++ ++ case MGN_MCS0: case MGN_MCS1: case MGN_MCS2: case MGN_MCS3: ++ case MGN_MCS4: case MGN_MCS5: case MGN_MCS6: case MGN_MCS7: ++ index = 1; ++ break; ++ ++ case MGN_MCS8: case MGN_MCS9: case MGN_MCS10: case MGN_MCS11: ++ case MGN_MCS12: case MGN_MCS13: case MGN_MCS14: case MGN_MCS15: ++ index = 2; ++ break; ++ ++ case MGN_VHT1SS_MCS0: case MGN_VHT1SS_MCS1: case MGN_VHT1SS_MCS2: ++ case MGN_VHT1SS_MCS3: case MGN_VHT1SS_MCS4: case MGN_VHT1SS_MCS5: ++ case MGN_VHT1SS_MCS6: case MGN_VHT1SS_MCS7: case MGN_VHT1SS_MCS8: ++ case MGN_VHT1SS_MCS9: ++ index = 3; ++ break; ++ ++ case MGN_VHT2SS_MCS0: case MGN_VHT2SS_MCS1: case MGN_VHT2SS_MCS2: ++ case MGN_VHT2SS_MCS3: case MGN_VHT2SS_MCS4: case MGN_VHT2SS_MCS5: ++ case MGN_VHT2SS_MCS6: case MGN_VHT2SS_MCS7: case MGN_VHT2SS_MCS8: ++ case MGN_VHT2SS_MCS9: ++ index = 4; ++ break; ++ ++ default: ++ DBG_871X("Wrong rate 0x%x to obtain index in 5G in phy_getPowerByRateBaseIndex()\n", Rate ); ++ break; ++ } ++ } ++ ++ return index; ++} ++ ++void ++PHY_InitPowerLimitTable( ++ PDM_ODM_T pDM_Odm ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 i, j, k, l, m; ++ ++ //DBG_871X( "=====> PHY_InitPowerLimitTable()!\n" ); ++ ++ for ( i = 0; i < MAX_REGULATION_NUM; ++i ) ++ { ++ for ( j = 0; j < MAX_2_4G_BANDWITH_NUM; ++j ) ++ for ( k = 0; k < MAX_2_4G_RATE_SECTION_NUM; ++k ) ++ for ( m = 0; m < MAX_2_4G_CHANNEL_NUM; ++m ) ++ for ( l = 0; l < GET_HAL_RFPATH_NUM(Adapter) ;++l ) ++ pHalData->TxPwrLimit_2_4G[i][j][k][m][l] = MAX_POWER_INDEX; ++ } ++ ++ for ( i = 0; i < MAX_REGULATION_NUM; ++i ) ++ { ++ for ( j = 0; j < MAX_5G_BANDWITH_NUM; ++j ) ++ for ( k = 0; k < MAX_5G_RATE_SECTION_NUM; ++k ) ++ for ( m = 0; m < MAX_5G_CHANNEL_NUM; ++m ) ++ for ( l = 0; l < GET_HAL_RFPATH_NUM(Adapter) ; ++l ) ++ pHalData->TxPwrLimit_5G[i][j][k][m][l] = MAX_POWER_INDEX; ++ } ++ ++ //DBG_871X("<===== PHY_InitPowerLimitTable()!\n" ); ++} ++ ++void ++PHY_ConvertPowerLimitToPowerIndex( ++ PADAPTER Adapter ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 BW40PwrBasedBm2_4G, BW40PwrBasedBm5G; ++ u8 regulation, bw, channel, rateSection, group; ++ u8 baseIndex2_4G; ++ u8 baseIndex5G; ++ s8 tempValue = 0, tempPwrLmt = 0; ++ u8 rfPath = 0; ++ ++ DBG_871X( "=====> PHY_ConvertPowerLimitToPowerIndex()\n" ); ++ for ( regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation ) ++ { ++ for ( bw = 0; bw < MAX_2_4G_BANDWITH_NUM; ++bw ) ++ { ++ for ( group = 0; group < MAX_2_4G_CHANNEL_NUM; ++group ) ++ { ++ if ( group == 0 ) ++ channel = 1; ++ else if ( group == 1 ) ++ channel = 3; ++ else if ( group == 2 ) ++ channel = 6; ++ else if ( group == 3 ) ++ channel = 9; ++ else if ( group == 4 ) ++ channel = 12; ++ else ++ channel = 14; ++ ++ ++ for ( rateSection = 0; rateSection < MAX_2_4G_RATE_SECTION_NUM; ++rateSection ) ++ { ++ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) { ++ // obtain the base dBm values in 2.4G band ++ // CCK => 11M, OFDM => 54M, HT 1T => MCS7, HT 2T => MCS15 ++ if ( rateSection == 0 ) { //CCK ++ baseIndex2_4G = phy_getPowerByRateBaseIndex( BAND_ON_2_4G, MGN_11M ); ++ } ++ else if ( rateSection == 1 ) { //OFDM ++ baseIndex2_4G = phy_getPowerByRateBaseIndex( BAND_ON_2_4G, MGN_54M ); ++ } ++ else if ( rateSection == 2 ) { //HT IT ++ baseIndex2_4G = phy_getPowerByRateBaseIndex( BAND_ON_2_4G, MGN_MCS7 ); ++ } ++ else if ( rateSection == 3 ) { //HT 2T ++ baseIndex2_4G = phy_getPowerByRateBaseIndex( BAND_ON_2_4G, MGN_MCS15 ); ++ } ++ } ++ ++ // we initially record the raw power limit value in rf path A, so we must obtain the raw ++ // power limit value by using index rf path A and use it to calculate all the value of ++ // all the path ++ tempPwrLmt = pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][group][ODM_RF_PATH_A]; ++ // process ODM_RF_PATH_A later ++ for ( rfPath = 0; rfPath < MAX_RF_PATH_NUM; ++rfPath ) ++ { ++ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) ++ BW40PwrBasedBm2_4G = pHalData->TxPwrByRateBase2_4G[rfPath][baseIndex2_4G]; ++ else ++ BW40PwrBasedBm2_4G = Adapter->registrypriv.RegPowerBase * 2; ++ ++ if ( tempPwrLmt != MAX_POWER_INDEX ) { ++ tempValue = tempPwrLmt - BW40PwrBasedBm2_4G; ++ pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][group][rfPath] = tempValue; ++ } ++ ++ DBG_871X("TxPwrLimit_2_4G[regulation %d][bw %d][rateSection %d][group %d] %d=\n\ ++ (TxPwrLimit in dBm %d - BW40PwrLmt2_4G[channel %d][rfPath %d] %d) \n", ++ regulation, bw, rateSection, group, pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][group][rfPath], ++ tempPwrLmt, channel, rfPath, BW40PwrBasedBm2_4G ); ++ } ++ } ++ } ++ } ++ } ++ ++ if ( IS_HARDWARE_TYPE_8812( Adapter ) || IS_HARDWARE_TYPE_8821( Adapter ) ) ++ { ++ for ( regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation ) ++ { ++ for ( bw = 0; bw < MAX_5G_BANDWITH_NUM; ++bw ) ++ { ++ for ( group = 0; group < MAX_5G_CHANNEL_NUM; ++group ) ++ { ++ ++ /* channels of 5G band in Hal_ReadTxPowerInfo8812A() ++ 36,38,40,42,44, ++ 46,48,50,52,54, ++ 56,58,60,62,64, ++ 100,102,104,106,108, ++ 110,112,114,116,118, ++ 120,122,124,126,128, ++ 130,132,134,136,138, ++ 140,142,144,149,151, ++ 153,155,157,159,161, ++ 163,165,167,168,169, ++ 171,173,175,177 */ ++ if ( group == 0 ) ++ channel = 0; // index of chnl 36 in channel5G ++ else if ( group == 1 ) ++ channel = 4; // index of chnl 44 in chanl5G ++ else if ( group == 2 ) ++ channel = 7; // index of chnl 50 in chanl5G ++ else if ( group == 3 ) ++ channel = 12; // index of chnl 60 in chanl5G ++ else if ( group == 4 ) ++ channel = 15; // index of chnl 100 in chanl5G ++ else if ( group == 5 ) ++ channel = 19; // index of chnl 108 in chanl5G ++ else if ( group == 6 ) ++ channel = 23; // index of chnl 116 in chanl5G ++ else if ( group == 7 ) ++ channel = 27; // index of chnl 124 in chanl5G ++ else if ( group == 8 ) ++ channel = 31; // index of chnl 132 in chanl5G ++ else if ( group == 9 ) ++ channel = 35; // index of chnl 140 in chanl5G ++ else if ( group == 10 ) ++ channel = 38; // index of chnl 149 in chanl5G ++ else if ( group == 11 ) ++ channel = 42; // index of chnl 157 in chanl5G ++ else if ( group == 12 ) ++ channel = 46; // index of chnl 165 in chanl5G ++ else ++ channel = 51; // index of chnl 173 in chanl5G ++ ++ for ( rateSection = 1; rateSection < MAX_5G_RATE_SECTION_NUM; ++rateSection ) ++ { ++ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) { ++ // obtain the base dBm values in 5G band ++ // OFDM => 54M, HT 1T => MCS7, HT 2T => MCS15, ++ // VHT => 1SSMCS7, VHT 2T => 2SSMCS7 ++ if ( rateSection == 1 ) { //OFDM ++ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_54M ); ++ } ++ else if ( rateSection == 2 ) { //HT 1T ++ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_MCS7 ); ++ } ++ else if ( rateSection == 3 ) { //HT 2T ++ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_MCS15 ); ++ } ++ else if ( rateSection == 4 ) { //VHT 1T ++ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_VHT1SS_MCS7 ); ++ } ++ else if ( rateSection == 5 ) { //VHT 2T ++ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_VHT2SS_MCS7 ); ++ } ++ } ++ ++ // we initially record the raw power limit value in rf path A, so we must obtain the raw ++ // power limit value by using index rf path A and use it to calculate all the value of ++ // all the path ++ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation][bw][rateSection][group][ODM_RF_PATH_A]; ++ if ( tempPwrLmt == MAX_POWER_INDEX ) ++ { ++ if ( bw == 0 || bw == 1 ) { // 5G VHT and HT can cross reference ++ DBG_871X( "No power limit table of the specified band %d, bandwidth %d, ratesection %d, group %d, rf path %d\n", ++ 1, bw, rateSection, group, ODM_RF_PATH_A ); ++ if ( rateSection == 2 ) { ++ pHalData->TxPwrLimit_5G[regulation][bw][2][group][ODM_RF_PATH_A] = ++ pHalData->TxPwrLimit_5G[regulation][bw][4][group][ODM_RF_PATH_A]; ++ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] ++ [bw][4][group][ODM_RF_PATH_A]; ++ } ++ else if ( rateSection == 4 ) { ++ pHalData->TxPwrLimit_5G[regulation][bw][4][group][ODM_RF_PATH_A] = ++ pHalData->TxPwrLimit_5G[regulation][bw][2][group][ODM_RF_PATH_A]; ++ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] ++ [bw][2][group][ODM_RF_PATH_A]; ++ } ++ else if ( rateSection == 3 ) { ++ pHalData->TxPwrLimit_5G[regulation][bw][3][group][ODM_RF_PATH_A] = ++ pHalData->TxPwrLimit_5G[regulation][bw][5][group][ODM_RF_PATH_A]; ++ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] ++ [bw][5][group][ODM_RF_PATH_A]; ++ } ++ else if ( rateSection == 5 ) { ++ pHalData->TxPwrLimit_5G[regulation][bw][5][group][ODM_RF_PATH_A] = ++ pHalData->TxPwrLimit_5G[regulation][bw][3][group][ODM_RF_PATH_A]; ++ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] ++ [bw][3][group][ODM_RF_PATH_A]; ++ } ++ ++ DBG_871X("use other value %d", tempPwrLmt); ++ } ++ } ++ ++ // process ODM_RF_PATH_A later ++ for ( rfPath = ODM_RF_PATH_B; rfPath < MAX_RF_PATH_NUM; ++rfPath ) ++ { ++ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) ++ BW40PwrBasedBm5G = pHalData->TxPwrByRateBase5G[rfPath][baseIndex5G]; ++ else ++ BW40PwrBasedBm5G = Adapter->registrypriv.RegPowerBase * 2; ++ ++ if ( tempPwrLmt != MAX_POWER_INDEX ) { ++ tempValue = tempPwrLmt - BW40PwrBasedBm5G; ++ pHalData->TxPwrLimit_5G[regulation][bw][rateSection][group][rfPath] = tempValue; ++ } ++ ++ DBG_871X("TxPwrLimit_5G[regulation %d][bw %d][rateSection %d][group %d] %d=\n\ ++ (TxPwrLimit in dBm %d - BW40PwrLmt5G[channel %d][rfPath %d] %d) \n", ++ regulation, bw, rateSection, group, pHalData->TxPwrLimit_5G[regulation][bw][rateSection][group][rfPath], ++ tempPwrLmt, channel, rfPath, BW40PwrBasedBm5G ); ++ } ++ ++ } ++ ++ } ++ } ++ } ++ ++ // process value of ODM_RF_PATH_A ++ for ( regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation ) ++ { ++ for ( bw = 0; bw < MAX_5G_BANDWITH_NUM; ++bw ) ++ { ++ for ( group = 0; group < MAX_5G_CHANNEL_NUM; ++group ) ++ { ++ if ( group == 0 ) ++ channel = 0; // index of chnl 36 in channel5G ++ else if ( group == 1 ) ++ channel = 4; // index of chnl 44 in chanl5G ++ else if ( group == 2 ) ++ channel = 7; // index of chnl 50 in chanl5G ++ else if ( group == 3 ) ++ channel = 12; // index of chnl 60 in chanl5G ++ else if ( group == 4 ) ++ channel = 15; // index of chnl 100 in chanl5G ++ else if ( group == 5 ) ++ channel = 19; // index of chnl 108 in chanl5G ++ else if ( group == 6 ) ++ channel = 23; // index of chnl 116 in chanl5G ++ else if ( group == 7 ) ++ channel = 27; // index of chnl 124 in chanl5G ++ else if ( group == 8 ) ++ channel = 31; // index of chnl 132 in chanl5G ++ else if ( group == 9 ) ++ channel = 35; // index of chnl 140 in chanl5G ++ else if ( group == 10 ) ++ channel = 38; // index of chnl 149 in chanl5G ++ else if ( group == 11 ) ++ channel = 42; // index of chnl 157 in chanl5G ++ else if ( group == 12 ) ++ channel = 46; // index of chnl 165 in chanl5G ++ else ++ channel = 51; // index of chnl 173 in chanl5G ++ ++ for ( rateSection = 0; rateSection < MAX_5G_RATE_SECTION_NUM; ++rateSection ) ++ { ++ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) { ++ // obtain the base dBm values in 5G band ++ // OFDM => 54M, HT 1T => MCS7, HT 2T => MCS15, ++ // VHT => 1SSMCS7, VHT 2T => 2SSMCS7 ++ if ( rateSection == 1 ) { //OFDM ++ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_54M ); ++ } ++ else if ( rateSection == 2 ) { //HT 1T ++ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_MCS7 ); ++ } ++ else if ( rateSection == 3 ) { //HT 2T ++ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_MCS15 ); ++ } ++ else if ( rateSection == 4 ) { //VHT 1T ++ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_VHT1SS_MCS7 ); ++ } ++ else if ( rateSection == 5 ) { //VHT 2T ++ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_VHT2SS_MCS7 ); ++ } ++ } ++ ++ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation][bw][rateSection][group][ODM_RF_PATH_A]; ++ if ( tempPwrLmt == MAX_POWER_INDEX ) ++ { ++ if ( bw == 0 || bw == 1 ) { // 5G VHT and HT can cross reference ++ DBG_871X("No power limit table of the specified band %d, bandwidth %d, ratesection %d, group %d, rf path %d\n", ++ 1, bw, rateSection, group, ODM_RF_PATH_A ); ++ if ( rateSection == 2 ) ++ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] ++ [bw][4][group][ODM_RF_PATH_A]; ++ else if ( rateSection == 4 ) ++ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] ++ [bw][2][group][ODM_RF_PATH_A]; ++ else if ( rateSection == 3 ) ++ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] ++ [bw][5][group][ODM_RF_PATH_A]; ++ else if ( rateSection == 5 ) ++ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] ++ [bw][3][group][ODM_RF_PATH_A]; ++ ++ DBG_871X("use other value %d", tempPwrLmt ); ++ } ++ } ++ ++ ++ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) ++ BW40PwrBasedBm5G = pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][baseIndex5G]; ++ else ++ BW40PwrBasedBm5G = Adapter->registrypriv.RegPowerBase * 2; ++ ++ if ( tempPwrLmt != MAX_POWER_INDEX ) { ++ tempValue = tempPwrLmt - BW40PwrBasedBm5G; ++ pHalData->TxPwrLimit_5G[regulation][bw][rateSection][group][ODM_RF_PATH_A] = tempValue; ++ } ++ ++ DBG_871X("TxPwrLimit_5G[regulation %d][bw %d][rateSection %d][group %d] %d=\n\ ++ (TxPwrLimit in dBm %d - BW40PwrLmt5G[channel %d][rfPath %d] %d) \n", ++ regulation, bw, rateSection, group, pHalData->TxPwrLimit_5G[regulation][bw][rateSection][group][ODM_RF_PATH_A], ++ tempPwrLmt, channel, ODM_RF_PATH_A, BW40PwrBasedBm5G ); ++ } ++ } ++ } ++ } ++ } ++ DBG_871X("<===== PHY_ConvertPowerLimitToPowerIndex()\n" ); ++} ++ ++void ++PHY_SetPowerLimitTableValue( ++ PDM_ODM_T pDM_Odm, ++ const s8* Regulation, ++ const s8* Band, ++ const s8* Bandwidth, ++ const s8* RateSection, ++ const s8* RfPath, ++ const s8* Channel, ++ const s8* PowerLimit ++ ) ++{ ++ PADAPTER Adapter = pDM_Odm->Adapter; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA( Adapter ); ++ u8 regulation=0, bandwidth=0, rateSection=0, ++ channel, powerLimit, channelGroup; ++ ++ DBG_871X( "Index of power limit table \ ++ [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s][val %s]\n", ++ Band, Regulation, Bandwidth, RateSection, RfPath, Channel, PowerLimit ) ; ++ ++ if ( !GetU1ByteIntegerFromStringInDecimal( Channel, &channel ) || ++ !GetU1ByteIntegerFromStringInDecimal( PowerLimit, &powerLimit ) ) ++ { ++ DBG_871X("Illegal index of power limit table [chnl %s][val %s]\n", Channel, PowerLimit ); ++ } ++ ++ powerLimit = powerLimit > MAX_POWER_INDEX ? MAX_POWER_INDEX : powerLimit; ++ ++ if ( eqNByte( Regulation, "FCC", 3 ) ) regulation = 0; ++ else if ( eqNByte( Regulation, "MKK", 3 ) ) regulation = 1; ++ else if ( eqNByte( Regulation, "ETSI", 4 ) ) regulation = 2; ++ ++ if ( eqNByte( RateSection, "CCK", 3 ) ) ++ rateSection = 0; ++ else if ( eqNByte( RateSection, "OFDM", 4 ) ) ++ rateSection = 1; ++ else if ( eqNByte( RateSection, "HT", 2 ) && eqNByte( RfPath, "1T", 2 ) ) ++ rateSection = 2; ++ else if ( eqNByte( RateSection, "HT", 2 ) && eqNByte( RfPath, "2T", 2 ) ) ++ rateSection = 3; ++ else if ( eqNByte( RateSection, "VHT", 3 ) && eqNByte( RfPath, "1T", 2 ) ) ++ rateSection = 4; ++ else if ( eqNByte( RateSection, "VHT", 3 ) && eqNByte( RfPath, "2T", 2 ) ) ++ rateSection = 5; ++ ++ ++ if ( eqNByte( Bandwidth, "20M", 3 ) ) bandwidth = 0; ++ else if ( eqNByte( Bandwidth, "40M", 3 ) ) bandwidth = 1; ++ else if ( eqNByte( Bandwidth, "80M", 3 ) ) bandwidth = 2; ++ else if ( eqNByte( Bandwidth, "160M", 4 ) ) bandwidth = 3; ++ ++ if ( eqNByte( Band, "2.4G", 4 ) ) ++ { ++ DBG_871X( "2.4G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n", ++ regulation, bandwidth, rateSection, channel, powerLimit ); ++ channelGroup = phy_GetChannelGroup( BAND_ON_2_4G, channel ); ++ pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelGroup][ODM_RF_PATH_A] = powerLimit; ++ } ++ else if ( eqNByte( Band, "5G", 2 ) ) ++ { ++ DBG_871X("5G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n", ++ regulation, bandwidth, rateSection, channel, powerLimit ); ++ channelGroup = phy_GetChannelGroup( BAND_ON_5G, channel ); ++ pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelGroup][ODM_RF_PATH_A] = powerLimit; ++ } ++ else ++ { ++ DBG_871X("Cannot recognize the band info in %s\n", Band ); ++ return; ++ } ++} ++ ++u8 ++PHY_GetPowerLimitValue( ++ PADAPTER Adapter, ++ u32 RegPwrTblSel, ++ BAND_TYPE Band, ++ CHANNEL_WIDTH Bandwidth, ++ RF_PATH RfPath, ++ u8 DataRate, ++ u8 Channel ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ s16 band = -1, regulation = -1, bandwidth = -1, ++ rfPath = -1, rateSection = -1, channelGroup = -1; ++ u8 powerLimit = MAX_POWER_INDEX; ++ ++ if ( ( Adapter->registrypriv.RegEnableTxPowerLimit == 0 && pHalData->EEPROMRegulatory != 1 ) || ++ pHalData->EEPROMRegulatory == 2 ) ++ return MAX_POWER_INDEX; ++ ++ switch( RegPwrTblSel ) ++ { ++ case 1: ++ regulation = TXPWR_LMT_ETSI; ++ break; ++ case 2: ++ regulation = TXPWR_LMT_MKK; ++ break; ++ case 3: ++ regulation = TXPWR_LMT_FCC; ++ break; ++ ++ default: ++ regulation = TXPWR_LMT_FCC; ++ break; ++ } ++ //DBG_871X("pregistrypriv->RegPwrTblSel %d\n", RegPwrTblSel); ++ ++ ++ if ( Band == BAND_ON_2_4G ) band = 0; ++ else if ( Band == BAND_ON_5G ) band = 1; ++ ++ if ( Bandwidth == CHANNEL_WIDTH_20 ) bandwidth = 0; ++ else if ( Bandwidth == CHANNEL_WIDTH_40 ) bandwidth = 1; ++ else if ( Bandwidth == CHANNEL_WIDTH_80 ) bandwidth = 2; ++ else if ( Bandwidth == CHANNEL_WIDTH_160 ) bandwidth = 3; ++ ++ switch ( DataRate ) ++ { ++ case MGN_1M: case MGN_2M: case MGN_5_5M: case MGN_11M: ++ rateSection = 0; ++ break; ++ ++ case MGN_6M: case MGN_9M: case MGN_12M: case MGN_18M: ++ case MGN_24M: case MGN_36M: case MGN_48M: case MGN_54M: ++ rateSection = 1; ++ break; ++ ++ case MGN_MCS0: case MGN_MCS1: case MGN_MCS2: case MGN_MCS3: ++ case MGN_MCS4: case MGN_MCS5: case MGN_MCS6: case MGN_MCS7: ++ rateSection = 2; ++ break; ++ ++ case MGN_MCS8: case MGN_MCS9: case MGN_MCS10: case MGN_MCS11: ++ case MGN_MCS12: case MGN_MCS13: case MGN_MCS14: case MGN_MCS15: ++ rateSection = 3; ++ break; ++ ++ case MGN_VHT1SS_MCS0: case MGN_VHT1SS_MCS1: case MGN_VHT1SS_MCS2: ++ case MGN_VHT1SS_MCS3: case MGN_VHT1SS_MCS4: case MGN_VHT1SS_MCS5: ++ case MGN_VHT1SS_MCS6: case MGN_VHT1SS_MCS7: case MGN_VHT1SS_MCS8: ++ case MGN_VHT1SS_MCS9: ++ rateSection = 4; ++ break; ++ ++ case MGN_VHT2SS_MCS0: case MGN_VHT2SS_MCS1: case MGN_VHT2SS_MCS2: ++ case MGN_VHT2SS_MCS3: case MGN_VHT2SS_MCS4: case MGN_VHT2SS_MCS5: ++ case MGN_VHT2SS_MCS6: case MGN_VHT2SS_MCS7: case MGN_VHT2SS_MCS8: ++ case MGN_VHT2SS_MCS9: ++ rateSection = 5; ++ break; ++ ++ default: ++ DBG_871X("Wrong rate 0x%x\n", DataRate ); ++ break; ++ } ++ ++ if ( BAND_ON_2_4G && rateSection > 3 ) ++ DBG_871X("Wrong rate 0x%x: No VHT in 2.4G Band\n", DataRate ); ++ if ( BAND_ON_5G && rateSection == 0 ) ++ DBG_871X("Wrong rate 0x%x: No CCK in 5G Band\n", DataRate ); ++ ++ // workaround for wrong index combination to obtain tx power limit, ++ // OFDM only exists in BW 20M ++ if ( rateSection == 1 ) ++ bandwidth = 0; ++ ++ // workaround for wrong indxe combination to obtain tx power limit, ++ // HT on 80M will reference to HT on 40M ++ if ( ( rateSection == 2 || rateSection == 3 ) && Band == BAND_ON_5G && bandwidth == 2 ) { ++ bandwidth = 1; ++ } ++ ++ if ( Band == BAND_ON_2_4G ) ++ channelGroup = phy_GetChannelGroup( BAND_ON_2_4G, Channel ); ++ else if ( Band == BAND_ON_5G ) ++ channelGroup = phy_GetChannelGroup( BAND_ON_5G, Channel ); ++ else if ( Band == BAND_ON_BOTH ) ++ { ++ // BAND_ON_BOTH don't care temporarily ++ } ++ ++ if ( band == -1 || regulation == -1 || bandwidth == -1 || ++ rateSection == -1 || channelGroup == -1 ) ++ { ++ DBG_871X("Wrong index value to access power limit table \ ++ [band %d][regulation %d][bandwidth %d][rf_path %d][rate_section %d][chnlGroup %d]\n", ++ band, regulation, bandwidth, RfPath, rateSection, channelGroup ); ++ ++ return 0xFF; ++ } ++ ++ if ( Band == BAND_ON_2_4G ) ++ powerLimit = pHalData->TxPwrLimit_2_4G[regulation] ++ [bandwidth][rateSection][channelGroup][RfPath]; ++ else if ( Band == BAND_ON_5G ) ++ powerLimit = pHalData->TxPwrLimit_5G[regulation] ++ [bandwidth][rateSection][channelGroup][RfPath]; ++ else ++ DBG_871X("No power limit table of the specified band\n" ); ++ ++ // combine 5G VHT & HT rate ++ // 5G 20M and 40M HT and VHT can cross reference ++ /*if ( Band == BAND_ON_5G && powerLimit == MAX_POWER_INDEX ) { ++ if ( bandwidth == 0 || bandwidth == 1 ) { ++ if ( rateSection == 2 ) ++ powerLimit = pHalData->TxPwrLimit_5G[regulation] ++ [bandwidth][4][channelGroup][RfPath]; ++ else if ( rateSection == 4 ) ++ powerLimit = pHalData->TxPwrLimit_5G[regulation] ++ [bandwidth][2][channelGroup][RfPath]; ++ else if ( rateSection == 3 ) ++ powerLimit = pHalData->TxPwrLimit_5G[regulation] ++ [bandwidth][5][channelGroup][RfPath]; ++ else if ( rateSection == 5 ) ++ powerLimit = pHalData->TxPwrLimit_5G[regulation] ++ [bandwidth][3][channelGroup][RfPath]; ++ } ++ }*/ ++ ++ //DBG_871X("TxPwrLmt[Regulation %d][Band %d][BW %d][RFPath %d][Rate 0x%x][Chnl %d] = %d\n", ++ // regulation, pHalData->CurrentBandType, Bandwidth, RfPath, DataRate, Channel, powerLimit); ++ ++ return powerLimit; ++} ++ ++ ++// ++// 2012/10/18 ++// ++void ++PHY_StorePwrByRateIndexVhtSeries( ++ PADAPTER Adapter, ++ u32 RegAddr, ++ u32 BitMask, ++ u32 Data ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 rf_path, rate_section; ++ ++ // ++ // For VHT series TX power by rate table. ++ // VHT TX power by rate off setArray = ++ // Band:-2G&5G = 0 / 1 ++ // RF: at most 4*4 = ABCD=0/1/2/3 ++ // CCK=0 11/5.5/2/1 ++ // OFDM=1/2 18/12/9/6 54/48/36/24 ++ // HT=3/4/56 MCS0-3 MCS4-7 MCS8-11 MCS12-15 ++ // VHT=7/8/9/10/11 1SSMCS0-3 1SSMCS4-7 2SSMCS1/0/1SSMCS/9/8 2SSMCS2-5 ++ // ++ // #define TX_PWR_BY_RATE_NUM_BAND 2 ++ // #define TX_PWR_BY_RATE_NUM_RF 4 ++ // #define TX_PWR_BY_RATE_NUM_SECTION 12 ++ // ++ ++ // ++ // 1. Judge TX power by rate array band type. ++ // ++ //if(RegAddr == rTxAGC_A_CCK11_CCK1_JAguar || RegAddr == rTxAGC_B_CCK11_CCK1_JAguar) ++ if ((RegAddr & 0xFFF) == 0xC20) ++ { ++ pHalData->TxPwrByRateTable++; // Record that it is the first data to record. ++ pHalData->TxPwrByRateBand = 0; ++ } ++ ++ if ((RegAddr & 0xFFF) == 0xe20) ++ { ++ pHalData->TxPwrByRateTable++; // The value should be 2 now. ++ } ++ ++ if ((RegAddr & 0xFFF) == 0xC24 && pHalData->TxPwrByRateTable != 1) ++ { ++ pHalData->TxPwrByRateTable++; // The value should be 3 bow. ++ pHalData->TxPwrByRateBand = 1; ++ } ++ ++ // ++ // 2. Judge TX power by rate array RF type ++ // ++ if ((RegAddr & 0xF00) == 0xC00) ++ { ++ rf_path = 0; ++ } ++ else if ((RegAddr & 0xF00) == 0xE00) ++ { ++ rf_path = 1; ++ } ++ ++ // ++ // 3. Judge TX power by rate array rate section ++ // ++ if (rf_path == 0) ++ { ++ rate_section = (u8)((RegAddr&0xFFF)-0xC20)/4; ++ } ++ else if (rf_path == 1) ++ { ++ rate_section = (u8)((RegAddr&0xFFF)-0xE20)/4; ++ } ++ ++ pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section] = Data; ++ //DBG_871X("VHT TxPwrByRateOffset Addr-%x==>BAND/RF/SEC=%d/%d/%d = %08x\n", ++ // RegAddr, pHalData->TxPwrByRateBand, rf_path, rate_section, Data); ++ ++} ++ ++void ++phy_ChangePGDataFromExactToRelativeValue( ++ u32* pData, ++ u8 Start, ++ u8 End, ++ u8 BaseValue ++ ) ++{ ++ s8 i = 0; ++ u8 TempValue = 0; ++ u32 TempData = 0; ++ //BaseValue = ( BaseValue & 0xf ) + ( ( BaseValue >> 4 ) & 0xf ) * 10; ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("Corrected BaseValue %u\n", BaseValue ) ); ++ ++ for ( i = 3; i >= 0; --i ) ++ { ++ if ( i >= Start && i <= End ) ++ { ++ // Get the exact value ++ TempValue = ( u8 ) ( *pData >> ( i * 8 ) ) & 0xF; ++ TempValue += ( ( u8 ) ( ( *pData >> ( i * 8 + 4 ) ) & 0xF ) ) * 10; ++ ++ // Change the value to a relative value ++ TempValue = ( TempValue > BaseValue ) ? TempValue - BaseValue : BaseValue - TempValue; ++ } ++ else ++ { ++ TempValue = ( u8 ) ( *pData >> ( i * 8 ) ) & 0xFF; ++ } ++ ++ ++ ++ TempData <<= 8; ++ TempData |= TempValue; ++ } ++ ++ *pData = TempData; ++} ++ ++void phy_PreprocessVHTPGDataFromExactToRelativeValue( ++ PADAPTER Adapter, ++ u32 RegAddr, ++ u32 BitMask, ++ u32* pData ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 rf_path, rate_section, BaseValue = 0; ++ // ++ // For VHT series TX power by rate table. ++ // VHT TX power by rate off setArray = ++ // Band:-2G&5G = 0 / 1 ++ // RF: at most 4*4 = ABCD=0/1/2/3 ++ // CCK=0 11/5.5/2/1 ++ // OFDM=1/2 18/12/9/6 54/48/36/24 ++ // HT=3/4/56 MCS0-3 MCS4-7 MCS8-11 MCS12-15 ++ // VHT=7/8/9/10/11 1SSMCS0-3 1SSMCS4-7 2SSMCS1/0/1SSMCS/9/8 2SSMCS2-5 ++ // ++ // #define TX_PWR_BY_RATE_NUM_BAND 2 ++ // #define TX_PWR_BY_RATE_NUM_RF 4 ++ // #define TX_PWR_BY_RATE_NUM_SECTION 12 ++ // ++ // Judge TX power by rate array RF type ++ // ++ if ( ( RegAddr & 0xF00 ) == 0xC00 ) ++ { ++ rf_path = 0; ++ } ++ else if ( ( RegAddr & 0xF00 ) == 0xE00 ) ++ { ++ rf_path = 1; ++ } ++ ++ // ++ // Judge TX power by rate array rate section ++ // ++ if ( rf_path == 0 ) ++ { ++ rate_section = ( u8) ( ( RegAddr & 0xFFF ) - 0xC20 ) / 4; ++ } ++ else if ( rf_path == 1 ) ++ { ++ rate_section = ( u8 ) ( ( RegAddr & 0xFFF ) - 0xE20 ) / 4; ++ } ++ ++ switch ( RegAddr ) ++ { ++ case 0xC20: ++ case 0xE20: ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("RegAddr %x\n", RegAddr )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); ++ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); ++ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); ++ break; ++ ++ case 0xC28: ++ case 0xE28: ++ case 0xC30: ++ case 0xE30: ++ case 0xC38: ++ case 0xE38: ++ ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("RegAddr %x\n", RegAddr )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section - 1, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] )); ++ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); ++ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( ++ &( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] ), ++ 0, 3, BaseValue); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section - 1, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] )); ++ break; ++ ++ case 0xC44: ++ case 0xE44: ++ ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("RegAddr %x\n", RegAddr )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section - 1, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section - 2, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 2] )); ++ BaseValue = ( ( u8 ) ( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] >> 28 ) & 0xF ) * 10 + ++ ( ( u8 ) ( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] >> 24 ) & 0xF ); ++ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 1, BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( ++ &( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] ), ++ 0, 3, BaseValue); ++ phy_ChangePGDataFromExactToRelativeValue( ++ &( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 2] ), ++ 0, 3, BaseValue); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section - 1, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section - 2, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 2] )); ++ break; ++ ++ case 0xC4C: ++ case 0xE4C: ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("RegAddr %x\n", RegAddr )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section - 1, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section - 2, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 2] )); ++ BaseValue = ( ( u8 ) ( *pData >> 12 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 8 ) & 0xF ); ++ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( ++ &( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] ), ++ 0, 3, BaseValue); ++ phy_ChangePGDataFromExactToRelativeValue( ++ &( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 2] ), ++ 2, 3, BaseValue); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section - 1, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] )); ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", ++ // pHalData->TxPwrByRateBand, rf_path, rate_section - 2, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 2] )); ++ break; ++ } ++} ++ ++void ++phy_PreprocessPGDataFromExactToRelativeValue( ++ PADAPTER Adapter, ++ u4Byte RegAddr, ++ u4Byte BitMask, ++ pu4Byte pData ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u1Byte BaseValue = 0; ++ ++ if ( RegAddr == rTxAGC_A_Rate54_24 ) ++ { ++ //DBG_871X("RegAddr %x\n", RegAddr ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, before changing to relative\n", ++ // pHalData->pwrGroupCnt, *pData ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, before changing to relative\n", ++ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][0] ); ++ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); ++ //DBG_871X("BaseValue = %d\n", BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( ++ &( pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][0] ), ++ 0, 3, BaseValue); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, after changing to relative\n", ++ // pHalData->pwrGroupCnt, *pData ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, after changing to relative\n", ++ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][0] ); ++ } ++ ++ if ( RegAddr == rTxAGC_A_CCK1_Mcs32 ) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][6] = *pData; ++ //DBG_871X("MCSTxPowerLevelOriginalOffset[%d][6] = 0x%x\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][6]); ++ } ++ ++ if ( RegAddr == rTxAGC_B_CCK11_A_CCK2_11 && BitMask == 0xffffff00 ) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][7] = *pData; ++ //DBG_871X("MCSTxPowerLevelOriginalOffset[%d][7] = 0x%x\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][7]); ++ } ++ ++ if ( RegAddr == rTxAGC_A_Mcs07_Mcs04 ) ++ { ++ //DBG_871X("RegAddr %x\n", RegAddr ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, before changing to relative\n", ++ // pHalData->pwrGroupCnt, *pData ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, before changing to relative\n", ++ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][2] ); ++ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); ++ //DBG_871X("BaseValue = %d\n", BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( ++ &( pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][2] ), ++ 0, 3, BaseValue); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, after changing to relative\n", ++ // pHalData->pwrGroupCnt, *pData ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, after changing to relative\n", ++ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][2] ); ++ } ++ ++ if ( RegAddr == rTxAGC_A_Mcs11_Mcs08 ) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4] = *pData; ++ //DBG_871X("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4]); ++ } ++ ++ if ( RegAddr == rTxAGC_A_Mcs15_Mcs12 ) ++ { ++ //DBG_871X("RegAddr %x\n", RegAddr ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, before changing to relative\n", ++ // pHalData->pwrGroupCnt, *pData ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, before changing to relative\n", ++ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4] ); ++ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); ++ //DBG_871X("BaseValue = %d\n", BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( ++ &( pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4] ), ++ 0, 3, BaseValue); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, after changing to relative\n", ++ // pHalData->pwrGroupCnt, *pData ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, after changing to relative\n", ++ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4] ); ++ } ++ ++ if ( RegAddr == rTxAGC_B_Rate54_24 ) ++ { ++ //DBG_871X("RegAddr %x\n", RegAddr ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][9] = 0x%x, before changing to relative\n", ++ // pHalData->pwrGroupCnt, *pData ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][8] = 0x%x, before changing to relative\n", ++ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][8] ); ++ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); ++ //DBG_871X("BaseValue = %d\n", BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( ++ &( pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][8] ), ++ 0, 3, BaseValue); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][9] = 0x%x, after changing to relative\n", ++ // pHalData->pwrGroupCnt, *pData ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][8] = 0x%x, after changing to relative\n", ++ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][8] ); ++ ++ } ++ ++ if ( RegAddr == rTxAGC_B_CCK1_55_Mcs32 ) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][14] = *pData; ++ //DBG_871X("MCSTxPowerLevelOriginalOffset[%d][14] = 0x%x\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][14]); ++ } ++ ++ if ( RegAddr == rTxAGC_B_CCK11_A_CCK2_11 && BitMask == 0x000000ff ) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][15] = *pData; ++ //DBG_871X("MCSTxPowerLevelOriginalOffset[%d][15] = 0x%x\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][15]); ++ } ++ ++ if ( RegAddr == rTxAGC_B_Mcs07_Mcs04 ) ++ { ++ //DBG_871X("RegAddr %x\n", RegAddr ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][11] = 0x%x, before changing to relative\n", ++ // pHalData->pwrGroupCnt, *pData ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][10] = 0x%x, before changing to relative\n", ++ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][10] ); ++ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); ++ //DBG_871X("BaseValue = %d\n", BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( ++ &( pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][10] ), ++ 0, 3, BaseValue); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][11] = 0x%x, after changing to relative\n", ++ // pHalData->pwrGroupCnt, *pData ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][10] = 0x%x, after changing to relative\n", ++ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][10] ); ++ } ++ ++ if ( RegAddr == rTxAGC_B_Mcs15_Mcs12 ) ++ { ++ //DBG_871X("RegAddr %x\n", RegAddr ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][13] = 0x%x, before changing to relative\n", ++ // pHalData->pwrGroupCnt, *pData ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][12] = 0x%x, before changing to relative\n", ++ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][12] ); ++ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); ++ //DBG_871X("BaseValue = %d\n", BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); ++ phy_ChangePGDataFromExactToRelativeValue( ++ &( pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][12] ), ++ 0, 3, BaseValue); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][13] = 0x%x, after changing to relative\n", ++ // pHalData->pwrGroupCnt, *pData ); ++ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][12] = 0x%x, after changing to relative\n", ++ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][12] ); ++ } ++ ++ ++ ++ // ++ // 1. Judge TX power by rate array band type. ++ // ++ //if(RegAddr == rTxAGC_A_CCK11_CCK1_JAguar || RegAddr == rTxAGC_B_CCK11_CCK1_JAguar) ++ ++ if ( IS_HARDWARE_TYPE_8812( Adapter ) || ++ IS_HARDWARE_TYPE_8821( Adapter ) ) ++ { ++ phy_PreprocessVHTPGDataFromExactToRelativeValue( Adapter, RegAddr, ++ BitMask, pData ); ++ } ++ ++} ++ ++void ++phy_StorePwrByRateIndexBase( ++ PADAPTER Adapter, ++ u32 RegAddr, ++ u32 Data ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 Base = 0; ++ ++ ++ if( pHalData->TxPwrByRateTable == 1 && pHalData->TxPwrByRateBand == 0 ) // 2.4G ++ { ++ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) ++ { ++ Base = ( ( ( u8 ) ( Data >> 28 ) & 0xF ) * 10 + ++ ( ( u8 ) ( Data >> 24 ) & 0xF ) ); ++ ++ switch( RegAddr ) { ++ case 0xC20: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][0] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of CCK (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][0] ) ); ++ break; ++ case 0xC28: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][1] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of OFDM 54M (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][1] ) ); ++ break; ++ case 0xC30: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][2] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS7 (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][2] ) ); ++ break; ++ case 0xC38: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][3] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS15 (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][3] ) ); ++ break; ++ default: ++ break; ++ }; ++ } ++ else ++ { ++ Base = ( u8 ) ( Data >> 24 ); ++ switch( RegAddr ) { ++ case 0xC20: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][0] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of CCK (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][0] ) ); ++ break; ++ case 0xC28: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][1] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of OFDM 54M (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][1] ) ); ++ break; ++ case 0xC30: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][2] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS7 (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][2] ) ); ++ break; ++ case 0xC38: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][3] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS15 (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][3] ) ); ++ break; ++ default: ++ break; ++ }; ++ } ++ } ++ else if ( pHalData->TxPwrByRateTable == 3 && pHalData->TxPwrByRateBand == 1 ) // 5G ++ { ++ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) ++ { ++ Base = ( ( ( u8 ) ( Data >> 28 ) & 0xF ) * 10 + ++ ( ( u8 ) ( Data >> 24 ) & 0xF ) ); ++ ++ switch( RegAddr ) ++ { ++ case 0xC28: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][0] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of OFDM 54M (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][0] ) ); ++ break; ++ case 0xC30: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][1] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS7 (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][1] ) ); ++ break; ++ case 0xC38: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][2] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS15 (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][2] ) ); ++ break; ++ case 0xC40: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][3] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 1SS MCS7 (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][3] ) ); ++ break; ++ case 0xC4C: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][4] = ++ ( u8 ) ( ( Data >> 12 ) & 0xF ) * 10 + ++ ( u8 ) ( ( Data >> 8 ) & 0xF ); ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 2SS MCS7 (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][4] ) ); ++ break; ++ case 0xE28: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][0] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of OFDM 54M (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][0] ) ); ++ break; ++ case 0xE30: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][1] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS7 (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][1] ) ); ++ break; ++ case 0xE38: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][2] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS15 (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][2] ) ); ++ break; ++ case 0xE40: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][3] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 1SS MCS7 (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][3] ) ); ++ break; ++ case 0xE4C: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][4] = ++ ( u8 ) ( ( Data >> 12 ) & 0xF ) * 10 + ++ ( u8 ) ( ( Data >> 8 ) & 0xF ); ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 2SS MCS7 (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][4] ) ); ++ break; ++ default: ++ break; ++ }; ++ } ++ else ++ { ++ Base = ( u8 ) ( Data >> 24 ); ++ switch( RegAddr ) { ++ case 0xC28: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][0] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of OFDM 54M (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][0] ) ); ++ break; ++ case 0xC30: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][1] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS7 (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][1] ) ); ++ break; ++ case 0xC38: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][2] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS15 (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][2] ) ); ++ break; ++ case 0xC40: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][3] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 1SS MCS7 (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][3] ) ); ++ break; ++ case 0xC4C: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][4] = ( u8 ) ( ( Data >> 8 ) & 0xFF ); ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 2SS MCS7 (RF path A) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][4] ) ); ++ break; ++ case 0xE28: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][0] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of OFDM 54M (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][0] ) ); ++ break; ++ case 0xE30: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][1] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS7 (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][1] ) ); ++ break; ++ case 0xE38: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][2] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS15 (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][2] ) ); ++ break; ++ case 0xE40: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][3] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 1SS MCS7 (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][3] ) ); ++ break; ++ case 0xE4C: ++ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][4] = ( u8 ) ( ( Data >> 8 ) & 0xFF ); ++ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 2SS MCS7 (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][4] ) ); ++ break; ++ default: ++ break; ++ }; ++ } ++ } ++ else if( pHalData->TxPwrByRateTable == 2 && pHalData->TxPwrByRateBand == 0 ) // 2.4G ++ { ++ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) ++ { ++ Base = ( ( ( u8 ) ( Data >> 28 ) & 0xF ) * 10 + ++ ( ( u8 ) ( Data >> 24 ) & 0xF ) ); ++ ++ switch( RegAddr ) { ++ case 0xE20: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][0] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of CCK (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][0] ) ); ++ break; ++ case 0xE28: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][1] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of OFDM 54M (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][1] ) ); ++ break; ++ case 0xE30: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][2] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS7 (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][2] ) ); ++ break; ++ case 0xE38: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][3] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS15 (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][3] ) ); ++ break; ++ default: ++ break; ++ }; ++ ++ } ++ else ++ { ++ Base = ( u8 ) ( Data >> 24 ); ++ switch( RegAddr ) { ++ case 0xC20: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][0] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of CCK (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][0] ) ); ++ break; ++ case 0xC28: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][1] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of OFDM 54M (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][1] ) ); ++ break; ++ case 0xC30: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][2] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS7 (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][2] ) ); ++ break; ++ case 0xC38: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][3] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS15 (RF path B) = %d\n", ++ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][3] ) ); ++ break; ++ default: ++ break; ++ }; ++ } ++ } ++ ++ //-------------- following code is for 88E ----------------// ++ ++ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) ++ { ++ Base = ( u8 ) ( ( Data >> 28 ) & 0xF ) * 10 + ++ ( u8 ) ( ( Data >> 24 ) & 0xF ); ++ } ++ else ++ { ++ Base = ( u8 ) ( ( Data >> 24 ) & 0xFF ); ++ } ++ ++ switch ( RegAddr ) ++ { ++ ++ case rTxAGC_A_Rate54_24: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][1] = Base; ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][1] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of OFDM 54M (RF path A) = %d\n", pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][1])); ++ break; ++ case rTxAGC_A_Mcs07_Mcs04: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][2] = Base; ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][2] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS7 (RF path A) = %d\n", pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][2])); ++ break; ++ case rTxAGC_A_Mcs15_Mcs12: ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][3] = Base; ++ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][3] = Base; ++ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS15 (RF path A) = %d\n", pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][3])); ++ break; ++ default: ++ break; ++ ++ }; ++} ++ ++void ++storePwrIndexDiffRateOffset( ++ PADAPTER Adapter, ++ u32 RegAddr, ++ u32 BitMask, ++ u32 Data ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u32 tmpData = Data; ++ ++ // If the pHalData->DM_OutSrc.PhyRegPgValueType == 1, which means that the data in PHY_REG_PG data are ++ // exact value, we must change them into relative values ++ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) ++ { ++ //DBG_871X("PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE\n"); ++ phy_PreprocessPGDataFromExactToRelativeValue( Adapter, RegAddr, BitMask, &Data ); ++ //DBG_871X("Data = 0x%x, tmpData = 0x%x\n", Data, tmpData ); ++ } ++ ++ // ++ // 2012/09/26 MH Add for VHT series. The power by rate table is diffeent as before. ++ // 2012/10/24 MH Add description for the old tx power by rate method is only used ++ // for 11 n series. T ++ // ++ if (IS_HARDWARE_TYPE_8812(Adapter) || ++ IS_HARDWARE_TYPE_8821(Adapter)) ++ { ++ PHY_StorePwrByRateIndexVhtSeries(Adapter, RegAddr, BitMask, Data); ++ } ++ ++ // Awk add to stroe the base power by rate value ++ phy_StorePwrByRateIndexBase(Adapter, RegAddr, tmpData ); ++ ++ if(RegAddr == rTxAGC_A_Rate18_06) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][0] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][0])); ++ } ++ if(RegAddr == rTxAGC_A_Rate54_24) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][1] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][1])); ++ } ++ if(RegAddr == rTxAGC_A_CCK1_Mcs32) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][6] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][6] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][6])); ++ } ++ if(RegAddr == rTxAGC_B_CCK11_A_CCK2_11 && BitMask == 0xffffff00) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][7] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][7] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][7])); ++ } ++ if(RegAddr == rTxAGC_A_Mcs03_Mcs00) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][2] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][2])); ++ } ++ if(RegAddr == rTxAGC_A_Mcs07_Mcs04) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][3] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][3])); ++ } ++ if(RegAddr == rTxAGC_A_Mcs11_Mcs08) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4])); ++ } ++ if(RegAddr == rTxAGC_A_Mcs15_Mcs12) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][5] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][5])); ++ if(pHalData->rf_type== RF_1T1R) ++ { ++ pHalData->pwrGroupCnt++; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("pwrGroupCnt = %d\n", pHalData->pwrGroupCnt)); ++ } ++ } ++ if(RegAddr == rTxAGC_B_Rate18_06) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][8] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][8] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][8])); ++ } ++ if(RegAddr == rTxAGC_B_Rate54_24) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][9] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][9] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][9])); ++ } ++ if(RegAddr == rTxAGC_B_CCK1_55_Mcs32) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][14] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][14] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][14])); ++ } ++ if(RegAddr == rTxAGC_B_CCK11_A_CCK2_11 && BitMask == 0x000000ff) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][15] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][15] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][15])); ++ } ++ if(RegAddr == rTxAGC_B_Mcs03_Mcs00) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][10] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][10] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][10])); ++ } ++ if(RegAddr == rTxAGC_B_Mcs07_Mcs04) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][11] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][11] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][11])); ++ } ++ if(RegAddr == rTxAGC_B_Mcs11_Mcs08) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][12] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][12] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][12])); ++ } ++ if(RegAddr == rTxAGC_B_Mcs15_Mcs12) ++ { ++ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][13] = Data; ++ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][13] = 0x%lx\n", pHalData->pwrGroupCnt, ++ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][13])); ++ if(pHalData->rf_type != RF_1T1R) ++ pHalData->pwrGroupCnt++; ++ } ++} ++ ++static u8 ++phy_DbmToTxPwrIdx( ++ PADAPTER Adapter, ++ WIRELESS_MODE WirelessMode, ++ int PowerInDbm ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 TxPwrIdx = 0; ++ s32 Offset = 0; ++ ++#if 0 ++ // ++ // Tested by MP, we found that CCK Index 0 equals to 8dbm, OFDM legacy equals to ++ // 3dbm, and OFDM HT equals to 0dbm repectively. ++ // Note: ++ // The mapping may be different by different NICs. Do not use this formula for what needs accurate result. ++ // By Bruce, 2008-01-29. ++ // ++ switch(WirelessMode) ++ { ++ case WIRELESS_MODE_B: ++ //Offset = -7; ++ Offset = -6; // For 88 RU test only ++ TxPwrIdx = (u8)((pHalData->OriginalCckTxPwrIdx*( PowerInDbm-pHalData->MinCCKDbm))/(pHalData->MaxCCKDbm-pHalData->MinCCKDbm)); ++ break; ++ ++ case WIRELESS_MODE_G: ++ case WIRELESS_MODE_N_24G: ++ Offset = -8; ++ TxPwrIdx = (u8)((pHalData->OriginalOfdm24GTxPwrIdx* (PowerInDbm-pHalData->MinHOFDMDbm))/(pHalData->MaxHOFDMDbm-pHalData->MinHOFDMDbm)); ++ break; ++ ++ default: //for MacOSX compiler warning ++ break; ++ } ++ ++ if (PowerInDbm <= pHalData->MinCCKDbm || ++ PowerInDbm <= pHalData->MinLOFDMDbm || ++ PowerInDbm <= pHalData->MinHOFDMDbm) ++ { ++ TxPwrIdx = 0; ++ } ++ ++ // Simple judge to prevent tx power exceed the limitation. ++ if (PowerInDbm >= pHalData->MaxCCKDbm || ++ PowerInDbm >= pHalData->MaxLOFDMDbm || ++ PowerInDbm >= pHalData->MaxHOFDMDbm) ++ { ++ if (WirelessMode == WIRELESS_MODE_B) ++ TxPwrIdx = pHalData->OriginalCckTxPwrIdx; ++ else ++ TxPwrIdx = pHalData->OriginalOfdm24GTxPwrIdx; ++ } ++#endif ++ return TxPwrIdx; ++} ++ ++static int ++phy_TxPwrIdxToDbm( ++ PADAPTER Adapter, ++ WIRELESS_MODE WirelessMode, ++ u8 TxPwrIdx ++ ) ++{ ++ int Offset = 0; ++ int PwrOutDbm = 0; ++ ++ // ++ // Tested by MP, we found that CCK Index 0 equals to -7dbm, OFDM legacy equals to -8dbm. ++ // Note: ++ // The mapping may be different by different NICs. Do not use this formula for what needs accurate result. ++ // By Bruce, 2008-01-29. ++ // ++ switch(WirelessMode) ++ { ++ case WIRELESS_MODE_B: ++ Offset = -7; ++ break; ++ ++ case WIRELESS_MODE_G: ++ case WIRELESS_MODE_N_24G: ++ Offset = -8; ++ break; ++ ++ default: //for MacOSX compiler warning ++ break; ++ } ++ ++ PwrOutDbm = TxPwrIdx / 2 + Offset; // Discard the decimal part. ++ ++ return PwrOutDbm; ++} ++ ++void ++PHY_GetTxPowerLevel8812( ++ PADAPTER Adapter, ++ u32* powerlevel ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 TxPwrLevel = 0; ++ int TxPwrDbm; ++#if 0 ++ // ++ // Because the Tx power indexes are different, we report the maximum of them to ++ // meet the CCX TPC request. By Bruce, 2008-01-31. ++ // ++ ++ // CCK ++ TxPwrLevel = pHalData->CurrentCckTxPwrIdx; ++ TxPwrDbm = phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_B, TxPwrLevel); ++ pHalData->MaxCCKDbm = TxPwrDbm; ++ ++ // Legacy OFDM ++ TxPwrLevel = pHalData->CurrentOfdm24GTxPwrIdx + pHalData->LegacyHTTxPowerDiff; ++ ++ // Compare with Legacy OFDM Tx power. ++ pHalData->MaxLOFDMDbm = phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_G, TxPwrLevel); ++ if(phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_G, TxPwrLevel) > TxPwrDbm) ++ TxPwrDbm = phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_G, TxPwrLevel); ++ ++ // HT OFDM ++ TxPwrLevel = pHalData->CurrentOfdm24GTxPwrIdx; ++ ++ // Compare with HT OFDM Tx power. ++ pHalData->MaxHOFDMDbm = phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_G, TxPwrLevel); ++ if(phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_N_24G, TxPwrLevel) > TxPwrDbm) ++ TxPwrDbm = phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_N_24G, TxPwrLevel); ++ pHalData->MaxHOFDMDbm = TxPwrDbm; ++ ++ *powerlevel = TxPwrDbm; ++#endif ++} ++ ++void phy_PowerIndexCheck8812( ++ PADAPTER Adapter, ++ u8 channel, ++ u8 * cckPowerLevel, ++ u8 * ofdmPowerLevel, ++ u8 * BW20PowerLevel, ++ u8 * BW40PowerLevel ++ ) ++{ ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ // Add or not ??? ++ ++ pHalData->CurrentCckTxPwrIdx = cckPowerLevel[0]; ++ pHalData->CurrentOfdm24GTxPwrIdx = ofdmPowerLevel[0]; ++ pHalData->CurrentBW2024GTxPwrIdx = BW20PowerLevel[0]; ++ pHalData->CurrentBW4024GTxPwrIdx = BW40PowerLevel[0]; ++} ++ ++bool ++phy_GetChnlIndex8812A( ++ u8 Channel, ++ u8* ChannelIdx ++ ) ++{ ++ u8 channel5G[CHANNEL_MAX_NUMBER_5G] = ++ {36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112, ++ 114,116,118,120,122,124,126,128,130,132,134,136,138,140,142,144,149,151, ++ 153,155,157,159,161,163,165,167,168,169,171,173,175,177}; ++ u8 i = 0; ++ bool bIn24G=true; ++ ++ if(Channel <= 14) ++ { ++ bIn24G=true; ++ *ChannelIdx = Channel -1; ++ } ++ else ++ { ++ bIn24G = false; ++ ++ for (i = 0; i < sizeof(channel5G)/sizeof(u8); ++i) ++ { ++ if ( channel5G[i] == Channel) { ++ *ChannelIdx = i; ++ return bIn24G; ++ } ++ } ++ } ++ return bIn24G; ++ ++} ++ ++// ++// For VHT series, we will use a new TX pwr by rate array to meet new spec. ++// ++u32 ++phy_GetTxPwrByRateOffset_8812( ++ PADAPTER pAdapter, ++ u8 Band, ++ u8 Rf_Path, ++ u8 Rate_Section ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u8 shift = 0, original_rate = Rate_Section; ++ u32 tx_pwr_diff = 0; ++ ++ // ++ // For VHT series TX power by rate table. ++ // VHT TX power by rate off setArray = ++ // Band:-2G&5G = 0 / 1 ++ // RF: at most 4*4 = ABCD=0/1/2/3 ++ // CCK=0 11/5.5/2/1 ++ // OFDM=1/2 18/12/9/6 54/48/36/24 ++ // HT=3/4/5/6 MCS0-3 MCS4-7 MCS8-11 MCS12-15 ++ // VHT=7/8/9/10/11 1SSMCS0-3 1SSMCS4-7 2SSMCS1/0/1SSMCS/9/8 2SSMCS2-5 ++ // ++ // #define TX_PWR_BY_RATE_NUM_BAND 2 ++ // #define TX_PWR_BY_RATE_NUM_RF 4 ++ // #define TX_PWR_BY_RATE_NUM_SECTION 12 ++ // ++ ++ switch (Rate_Section) ++ { ++ case MGN_1M: ++ case MGN_2M: ++ case MGN_5_5M: ++ case MGN_11M: ++ Rate_Section =0; ++ break; ++ ++ case MGN_6M: ++ case MGN_9M: ++ case MGN_12M: ++ case MGN_18M: ++ Rate_Section =1; ++ break; ++ ++ case MGN_24M: ++ case MGN_36M: ++ case MGN_48M: ++ case MGN_54M: ++ Rate_Section =2; ++ break; ++ ++ case MGN_MCS0: ++ case MGN_MCS1: ++ case MGN_MCS2: ++ case MGN_MCS3: ++ Rate_Section =3; ++ break; ++ ++ case MGN_MCS4: ++ case MGN_MCS5: ++ case MGN_MCS6: ++ case MGN_MCS7: ++ Rate_Section =4; ++ break; ++ ++ case MGN_MCS8: ++ case MGN_MCS9: ++ case MGN_MCS10: ++ case MGN_MCS11: ++ Rate_Section =5; ++ break; ++ ++ case MGN_MCS12: ++ case MGN_MCS13: ++ case MGN_MCS14: ++ case MGN_MCS15: ++ Rate_Section =6; ++ break; ++ ++ case MGN_VHT1SS_MCS0: ++ case MGN_VHT1SS_MCS1: ++ case MGN_VHT1SS_MCS2: ++ case MGN_VHT1SS_MCS3: ++ Rate_Section =7; ++ break; ++ ++ case MGN_VHT1SS_MCS4: ++ case MGN_VHT1SS_MCS5: ++ case MGN_VHT1SS_MCS6: ++ case MGN_VHT1SS_MCS7: ++ Rate_Section =8; ++ break; ++ ++ case MGN_VHT1SS_MCS8: ++ case MGN_VHT1SS_MCS9: ++ case MGN_VHT2SS_MCS0: ++ case MGN_VHT2SS_MCS1: ++ Rate_Section =9; ++ break; ++ ++ case MGN_VHT2SS_MCS2: ++ case MGN_VHT2SS_MCS3: ++ case MGN_VHT2SS_MCS4: ++ case MGN_VHT2SS_MCS5: ++ Rate_Section =10; ++ break; ++ ++ case MGN_VHT2SS_MCS6: ++ case MGN_VHT2SS_MCS7: ++ case MGN_VHT2SS_MCS8: ++ case MGN_VHT2SS_MCS9: ++ Rate_Section =11; ++ break; ++ ++ default: ++ DBG_871X("Rate_Section is Illegal\n"); ++ break; ++ } ++ ++ switch (original_rate) ++ { ++ case MGN_1M: shift = 0; break; ++ case MGN_2M: shift = 8; break; ++ case MGN_5_5M: shift = 16; break; ++ case MGN_11M: shift = 24; break; ++ ++ case MGN_6M: shift = 0; break; ++ case MGN_9M: shift = 8; break; ++ case MGN_12M: shift = 16; break; ++ case MGN_18M: shift = 24; break; ++ ++ case MGN_24M: shift = 0; break; ++ case MGN_36M: shift = 8; break; ++ case MGN_48M: shift = 16; break; ++ case MGN_54M: shift = 24; break; ++ ++ case MGN_MCS0: shift = 0; break; ++ case MGN_MCS1: shift = 8; break; ++ case MGN_MCS2: shift = 16; break; ++ case MGN_MCS3: shift = 24; break; ++ ++ case MGN_MCS4: shift = 0; break; ++ case MGN_MCS5: shift = 8; break; ++ case MGN_MCS6: shift = 16; break; ++ case MGN_MCS7: shift = 24; break; ++ ++ case MGN_MCS8: shift = 0; break; ++ case MGN_MCS9: shift = 8; break; ++ case MGN_MCS10: shift = 16; break; ++ case MGN_MCS11: shift = 24; break; ++ ++ case MGN_MCS12: shift = 0; break; ++ case MGN_MCS13: shift = 8; break; ++ case MGN_MCS14: shift = 16; break; ++ case MGN_MCS15: shift = 24; break; ++ ++ case MGN_VHT1SS_MCS0: shift = 0; break; ++ case MGN_VHT1SS_MCS1: shift = 8; break; ++ case MGN_VHT1SS_MCS2: shift = 16; break; ++ case MGN_VHT1SS_MCS3: shift = 24; break; ++ ++ case MGN_VHT1SS_MCS4: shift = 0; break; ++ case MGN_VHT1SS_MCS5: shift = 8; break; ++ case MGN_VHT1SS_MCS6: shift = 16; break; ++ case MGN_VHT1SS_MCS7: shift = 24; break; ++ ++ case MGN_VHT1SS_MCS8: shift = 0; break; ++ case MGN_VHT1SS_MCS9: shift = 8; break; ++ case MGN_VHT2SS_MCS0: shift = 16; break; ++ case MGN_VHT2SS_MCS1: shift = 24; break; ++ ++ case MGN_VHT2SS_MCS2: shift = 0; break; ++ case MGN_VHT2SS_MCS3: shift = 8; break; ++ case MGN_VHT2SS_MCS4: shift = 16; break; ++ case MGN_VHT2SS_MCS5: shift = 24; break; ++ ++ case MGN_VHT2SS_MCS6: shift = 0; break; ++ case MGN_VHT2SS_MCS7: shift = 8; break; ++ case MGN_VHT2SS_MCS8: shift = 16; break; ++ case MGN_VHT2SS_MCS9: shift = 24; break; ++ ++ default: ++ DBG_871X("Rate_Section is Illegal\n"); ++ break; ++ } ++ ++ // Willis suggest to adopt 5G VHT power by rate for 2.4G ++ if ( Band == BAND_ON_2_4G && ( Rate_Section >= 7 && Rate_Section <= 11 ) ) ++ Band = BAND_ON_5G; ++ ++ tx_pwr_diff = (pHalData->TxPwrByRateOffset[Band][Rf_Path][Rate_Section] >> shift) & 0xff; ++ ++ //DBG_871X("TxPwrByRateOffset-BAND(%d)-RF(%d)-RAS(%d)=%x tx_pwr_diff=%d shift=%d\n", ++ //Band, Rf_Path, Rate_Section, pHalData->TxPwrByRateOffset[Band][Rf_Path][Rate_Section], tx_pwr_diff, shift); ++ ++ return tx_pwr_diff; ++ ++} // phy_GetTxPwrByRateOffset_8812 ++ ++ ++// ++// Description: ++// Subtract number of TxPwr index from different advance settings. ++// ++// 2010.03.09, added by Roger. ++// ++void ++phy_TxPwrAdjInPercentage( ++ PADAPTER Adapter, ++ u8* pTxPwrIdx) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 TxPwrInPercentage = 0; ++ ++ // Retrieve default TxPwr index settings from registry. ++ TxPwrInPercentage = pHalData->TxPwrInPercentage; ++ ++ if(*pTxPwrIdx > RF6052_MAX_TX_PWR) ++ *pTxPwrIdx = RF6052_MAX_TX_PWR; ++ ++ // ++ // NEC Spec: dB = 10*log(X/Y), X: target value, Y: default value. ++ // For example: TxPower 50%, 10*log(50/100)=(nearly)-3dB ++ // 2010.07.26. ++ // ++ if(TxPwrInPercentage & TX_PWR_PERCENTAGE_0)// 12.5% , -9dB ++ { ++ *pTxPwrIdx -=18; ++ } ++ else if(TxPwrInPercentage & TX_PWR_PERCENTAGE_1)// 25%, -6dB ++ { ++ *pTxPwrIdx -=12; ++ } ++ else if(TxPwrInPercentage & TX_PWR_PERCENTAGE_2)// 50%, -3dB ++ { ++ *pTxPwrIdx -=6; ++ } ++ ++ if(*pTxPwrIdx > RF6052_MAX_TX_PWR) // Avoid underflow condition. ++ *pTxPwrIdx = RF6052_MAX_TX_PWR; ++} ++ ++/************************************************************************************************************** ++ * Description: ++ * The low-level interface to get the FINAL Tx Power Index , called by both MP and Normal Driver. ++ * ++ * <20120830, Kordan> ++ **************************************************************************************************************/ ++u32 ++PHY_GetTxPowerIndex_8812A( ++ PADAPTER pAdapter, ++ u8 RFPath, ++ u8 Rate, ++ CHANNEL_WIDTH BandWidth, ++ u8 Channel ++ ) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ u8 i = 0; //default set to 1S ++ struct registry_priv *pregistrypriv = &pAdapter->registrypriv; ++ u32 powerDiffByRate = 0; ++ u32 txPower = 0; ++ u8 chnlIdx = (Channel-1); ++ bool bIn24G = false; ++ ++ //DBG_871X("===> PHY_GetTxPowerIndex_8812A\n"); ++ ++ if (HAL_IsLegalChannel(pAdapter, Channel) == false) ++ { ++ chnlIdx = 0; ++ DBG_871X("Illegal channel!!\n"); ++ } ++ ++ bIn24G = phy_GetChnlIndex8812A(Channel, &chnlIdx); ++ ++ //DBG_871X("[%s] Channel Index: %d\n", (bIn24G?"2.4G":"5G"), chnlIdx); ++ ++ if (bIn24G) //3 ============================== 2.4 G ============================== ++ { ++ if ( IS_CCK_RATE(Rate) ) ++ { ++ txPower = pHalData->Index24G_CCK_Base[RFPath][chnlIdx]; ++ } ++ else if ( MGN_6M <= Rate ) ++ { ++ txPower = pHalData->Index24G_BW40_Base[RFPath][chnlIdx]; ++ } ++ else ++ { ++ DBG_871X("===> mpt_ProQueryCaltxPower_Jaguar: INVALID Rate.\n"); ++ } ++ ++ //DBG_871X("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower); ++ ++ // OFDM-1T ++ if ( MGN_6M <= Rate && Rate <= MGN_54M && ! IS_CCK_RATE(Rate) ) ++ { ++ txPower += pHalData->OFDM_24G_Diff[RFPath][TX_1S]; ++ //DBG_871X("+PowerDiff 2.4G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_24G_Diff[RFPath][TX_1S]); ++ } ++ // BW20-1S, BW20-2S ++ if (BandWidth == CHANNEL_WIDTH_20) ++ { ++ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) ++ txPower += pHalData->BW20_24G_Diff[RFPath][TX_1S]; ++ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) ++ txPower += pHalData->BW20_24G_Diff[RFPath][TX_2S]; ++ ++ //DBG_871X("+PowerDiff 2.4G (RF-%c): (BW20-1S, BW20-2S) = (%d, %d)\n", ((RFPath==0)?'A':'B'), ++ // pHalData->BW20_24G_Diff[RFPath][TX_1S], pHalData->BW20_24G_Diff[RFPath][TX_2S]); ++ } ++ // BW40-1S, BW40-2S ++ else if (BandWidth == CHANNEL_WIDTH_40) ++ { ++ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) ++ txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; ++ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) ++ txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; ++ ++ //DBG_871X("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S) = (%d, %d)\n", ((RFPath==0)?'A':'B'), ++ // pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S]); ++ } ++ // Willis suggest adopt BW 40M power index while in BW 80 mode ++ else if ( BandWidth == CHANNEL_WIDTH_80 ) ++ { ++ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) ++ txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; ++ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) ++ txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; ++ ++ //DBG_871X("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S) = (%d, %d) P.S. Current is in BW 80MHz\n", ((RFPath==0)?'A':'B'), ++ // pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S]); ++ } ++ ++ // ++ // 2012/09/26 MH Accordng to BB team's opinion, there might 40M VHT mode in the future.? ++ // We need to judge VHT mode by what? ++ // ++ } ++ else //3 ============================== 5 G ============================== ++ { ++ if ( MGN_6M <= Rate ) ++ { ++ txPower = pHalData->Index5G_BW40_Base[RFPath][chnlIdx]; ++ } ++ else ++ { ++ DBG_871X("===> mpt_ProQueryCalTxPower_Jaguar: INVALID Rate.\n"); ++ } ++ ++ //DBG_871X("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower); ++ ++ // OFDM-1T ++ if ( MGN_6M <= Rate && Rate <= MGN_54M && ! IS_CCK_RATE(Rate)) ++ { ++ txPower += pHalData->OFDM_5G_Diff[RFPath][TX_1S]; ++ //DBG_871X("+PowerDiff 5G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_5G_Diff[RFPath][TX_1S]); ++ } ++ ++ // BW20-1S, BW20-2S ++ if (BandWidth == CHANNEL_WIDTH_20) ++ { ++ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) ++ txPower += pHalData->BW20_5G_Diff[RFPath][TX_1S]; ++ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) ++ txPower += pHalData->BW20_5G_Diff[RFPath][TX_2S]; ++ ++ //DBG_871X("+PowerDiff 5G (RF-%c): (BW20-1S, BW20-2S) = (%d, %d)\n", ((RFPath==0)?'A':'B'), ++ // pHalData->BW20_5G_Diff[RFPath][TX_1S], pHalData->BW20_5G_Diff[RFPath][TX_2S]); ++ } ++ // BW40-1S, BW40-2S ++ else if (BandWidth == CHANNEL_WIDTH_40) ++ { ++ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) ++ txPower += pHalData->BW40_5G_Diff[RFPath][TX_1S]; ++ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) ++ txPower += pHalData->BW40_5G_Diff[RFPath][TX_2S]; ++ ++ //DBG_871X("+PowerDiff 5G(RF-%c): (BW40-1S, BW40-2S) = (%d, %d)\n", ((RFPath==0)?'A':'B'), ++ // pHalData->BW40_5G_Diff[RFPath][TX_1S], pHalData->BW40_5G_Diff[RFPath][TX_2S]); ++ } ++ // BW80-1S, BW80-2S ++ else if (BandWidth== CHANNEL_WIDTH_80) ++ { ++ // <20121220, Kordan> Get the index of array "Index5G_BW80_Base". ++ u8 channel5G_80M[CHANNEL_MAX_NUMBER_5G_80M] = {42, 58, 106, 122, 138, 155, 171}; ++ for (i = 0; i < sizeof(channel5G_80M)/sizeof(u8); ++i) ++ if ( channel5G_80M[i] == Channel) ++ chnlIdx = i; ++ ++ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) ++ txPower = pHalData->Index5G_BW80_Base[RFPath][chnlIdx] + pHalData->BW80_5G_Diff[RFPath][TX_1S]; ++ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) ++ txPower = pHalData->Index5G_BW80_Base[RFPath][chnlIdx] + pHalData->BW80_5G_Diff[RFPath][TX_1S] + pHalData->BW80_5G_Diff[RFPath][TX_2S]; ++ ++ //DBG_871X("+PowerDiff 5G(RF-%c): (BW80-1S, BW80-2S) = (%d, %d)\n", ((RFPath==0)?'A':'B'), ++ // pHalData->BW80_5G_Diff[RFPath][TX_1S], pHalData->BW80_5G_Diff[RFPath][TX_2S]); ++ } ++ } ++ ++ // Band:-2G&5G = 0 / 1 ++ // Becasue in the functionwe use the bIn24G = 1=2.4G. Then we need to convert the value. ++ // RF: at most 4*4 = ABCD=0/1/2/3 ++ // CCK=0 11/5.5/2/1 ++ // OFDM=1/2 18/12/9/6 54/48/36/24 ++ // HT=3/4/5/6 MCS0-3 MCS4-7 MCS8-11 MCS12-15 ++ // VHT=7/8/9/10/11 1SSMCS0-3 1SSMCS4-7 2SSMCS1/0/1SSMCS/9/8 2SSMCS2-5 ++ if (pregistrypriv->RegPwrByRate == false && pHalData->EEPROMRegulatory != 2) ++ { ++ powerDiffByRate = phy_GetTxPwrByRateOffset_8812(pAdapter, (u8)(!bIn24G), RFPath, Rate); ++ ++ if ( ( pregistrypriv->RegEnableTxPowerLimit == 1 && pHalData->EEPROMRegulatory != 2 ) || ++ pHalData->EEPROMRegulatory == 1 ) ++ { ++ u8 limit = 0; ++ limit = PHY_GetPowerLimitValue(pAdapter, pregistrypriv->RegPwrTblSel, (u8)(!bIn24G) ? BAND_ON_5G : BAND_ON_2_4G, BandWidth, (ODM_RF_RADIO_PATH_E)RFPath, Rate, Channel); ++ ++ if ( Rate == MGN_VHT1SS_MCS8 || Rate == MGN_VHT1SS_MCS9 || ++ Rate == MGN_VHT2SS_MCS8 || Rate == MGN_VHT2SS_MCS9 ) ++ { ++ if ( limit < 0 ) ++ { ++ if ( powerDiffByRate < -limit ) ++ powerDiffByRate = -limit; ++ } ++ } ++ else ++ { ++ if ( limit < 0 ) ++ powerDiffByRate = limit; ++ else ++ powerDiffByRate = powerDiffByRate > limit ? limit : powerDiffByRate; ++ } ++ //DBG_871X("Maximum power by rate %d, final power by rate %d\n", limit, powerDiffByRate ); ++ } ++ } ++ ++ //DBG_871X("Rate-%x txPower=%x +PowerDiffByRate(RF-%c) = %d\n", Rate, txPower, ((RFPath==0)?'A':'B'), powerDiffByRate); ++ ++ // We need to reduce power index for VHT MCS 8 & 9. ++ if (Rate == MGN_VHT1SS_MCS8 || Rate == MGN_VHT1SS_MCS9 || ++ Rate == MGN_VHT2SS_MCS8 || Rate == MGN_VHT2SS_MCS9) ++ { ++ txPower -= powerDiffByRate; ++ } ++ else ++ { ++ // ++ // 2013/01/29 MH For preventing VHT rate of 8812AU to be used in USB 2.0 mode ++ // and the current will be more than 500mA and card disappear. We need to limit ++ // TX power with any power by rate for VHT in U2. ++ // 2013/01/30 MH According to power current test compare with BCM AC NIC, we ++ // decide to use host hub = 2.0 mode to enable tx power limit behavior. ++ // ++ if (adapter_to_dvobj(pAdapter)->usb_speed <= RTW_USB_SPEED_2 && IS_HARDWARE_TYPE_8812AU(pAdapter)) ++ { ++ powerDiffByRate = 0; ++ } ++ ++ txPower += powerDiffByRate; ++ } ++ //DBG_871X("BASE ON HT MCS7\n"); ++ //DBG_871X("Final Tx Power(RF-%c, Channel: %d) = %d(0x%X)\n", ((RFPath==0)?'A':'B'), chnlIdx+1, txPower, txPower); ++ ++ if(pDM_Odm->Modify_TxAGC_Flag_PathA || pDM_Odm->Modify_TxAGC_Flag_PathB) //20130424 Mimic whether path A or B has to modify TxAGC ++ { ++ //DBG_871X("Before add Remanant_OFDMSwingIdx[rfpath %u] %d", txPower); ++ txPower += pDM_Odm->Remnant_OFDMSwingIdx[RFPath]; ++ //DBG_871X("After add Remanant_OFDMSwingIdx[rfpath %u] %d => txPower %d", RFPath, pDM_Odm->Remnant_OFDMSwingIdx[RFPath], txPower); ++ } ++ ++ if(txPower > MAX_POWER_INDEX) ++ txPower = MAX_POWER_INDEX; ++ ++ // 2012/09/26 MH We need to take care high power device limiation to prevent destroy EXT_PA. ++ // This case had ever happened in CU/SU high power module. THe limitation = 0x20. ++ // But for 8812, we still not know the value. ++ phy_TxPwrAdjInPercentage(pAdapter, (u8 *)&txPower); ++ ++ return txPower; ++} ++ ++/************************************************************************************************************** ++ * Description: ++ * The low-level interface to set TxAGC , called by both MP and Normal Driver. ++ * ++ * <20120830, Kordan> ++ **************************************************************************************************************/ ++ ++void ++PHY_SetTxPowerIndex_8812A( ++ PADAPTER Adapter, ++ u4Byte PowerIndex, ++ u1Byte RFPath, ++ u1Byte Rate ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ bool Direction = false; ++ u4Byte TxagcOffset = 0; ++ ++ // <20120928, Kordan> A workaround in 8812A/8821A testchip, to fix the bug of odd Tx power indexes. ++ if ( (PowerIndex % 2 == 1) && IS_HARDWARE_TYPE_JAGUAR(Adapter) && IS_TEST_CHIP(pHalData->VersionID) ) ++ PowerIndex -= 1; ++ ++ //2013.01.18 LukeLee: Modify TXAGC by dcmd_Dynamic_Ctrl() ++ if(RFPath == RF_PATH_A) ++ { ++ Direction = pHalData->odmpriv.IsTxagcOffsetPositiveA; ++ TxagcOffset = pHalData->odmpriv.TxagcOffsetValueA; ++ } ++ else if(RFPath == RF_PATH_B) ++ { ++ Direction = pHalData->odmpriv.IsTxagcOffsetPositiveB; ++ TxagcOffset = pHalData->odmpriv.TxagcOffsetValueB; ++ } ++ if(Direction == false) ++ { ++ if(PowerIndex > TxagcOffset) ++ PowerIndex -= TxagcOffset; ++ else ++ PowerIndex = 0; ++ } ++ else ++ { ++ PowerIndex += TxagcOffset; ++ if(PowerIndex > 0x3F) ++ PowerIndex = 0x3F; ++ } ++ ++ if (RFPath == RF_PATH_A) ++ { ++ switch (Rate) ++ { ++ case MGN_1M: PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_2M: PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_5_5M: PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_11M: PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_6M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm18_Ofdm6_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_9M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm18_Ofdm6_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_12M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm18_Ofdm6_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_18M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm18_Ofdm6_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_24M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm54_Ofdm24_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_36M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm54_Ofdm24_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_48M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm54_Ofdm24_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_54M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm54_Ofdm24_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_MCS0: PHY_SetBBReg(Adapter, rTxAGC_A_MCS3_MCS0_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_MCS1: PHY_SetBBReg(Adapter, rTxAGC_A_MCS3_MCS0_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_MCS2: PHY_SetBBReg(Adapter, rTxAGC_A_MCS3_MCS0_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_MCS3: PHY_SetBBReg(Adapter, rTxAGC_A_MCS3_MCS0_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_MCS4: PHY_SetBBReg(Adapter, rTxAGC_A_MCS7_MCS4_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_MCS5: PHY_SetBBReg(Adapter, rTxAGC_A_MCS7_MCS4_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_MCS6: PHY_SetBBReg(Adapter, rTxAGC_A_MCS7_MCS4_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_MCS7: PHY_SetBBReg(Adapter, rTxAGC_A_MCS7_MCS4_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_MCS8: PHY_SetBBReg(Adapter, rTxAGC_A_MCS11_MCS8_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_MCS9: PHY_SetBBReg(Adapter, rTxAGC_A_MCS11_MCS8_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_MCS10: PHY_SetBBReg(Adapter, rTxAGC_A_MCS11_MCS8_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_MCS11: PHY_SetBBReg(Adapter, rTxAGC_A_MCS11_MCS8_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_MCS12: PHY_SetBBReg(Adapter, rTxAGC_A_MCS15_MCS12_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_MCS13: PHY_SetBBReg(Adapter, rTxAGC_A_MCS15_MCS12_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_MCS14: PHY_SetBBReg(Adapter, rTxAGC_A_MCS15_MCS12_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_MCS15: PHY_SetBBReg(Adapter, rTxAGC_A_MCS15_MCS12_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_VHT1SS_MCS0: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index3_Nss1Index0_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_VHT1SS_MCS1: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index3_Nss1Index0_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_VHT1SS_MCS2: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index3_Nss1Index0_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_VHT1SS_MCS3: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index3_Nss1Index0_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_VHT1SS_MCS4: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index7_Nss1Index4_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_VHT1SS_MCS5: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index7_Nss1Index4_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_VHT1SS_MCS6: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index7_Nss1Index4_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_VHT1SS_MCS7: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index7_Nss1Index4_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_VHT1SS_MCS8: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index1_Nss1Index8_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_VHT1SS_MCS9: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index1_Nss1Index8_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_VHT2SS_MCS0: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index1_Nss1Index8_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_VHT2SS_MCS1: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index1_Nss1Index8_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_VHT2SS_MCS2: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index5_Nss2Index2_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_VHT2SS_MCS3: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index5_Nss2Index2_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_VHT2SS_MCS4: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index5_Nss2Index2_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_VHT2SS_MCS5: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index5_Nss2Index2_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_VHT2SS_MCS6: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index9_Nss2Index6_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_VHT2SS_MCS7: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index9_Nss2Index6_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_VHT2SS_MCS8: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index9_Nss2Index6_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_VHT2SS_MCS9: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index9_Nss2Index6_JAguar, bMaskByte3, PowerIndex); break; ++ ++ default: ++ DBG_871X("Invalid Rate!!\n"); ++ break; ++ } ++ } ++ else if (RFPath == RF_PATH_B) ++ { ++ switch (Rate) ++ { ++ case MGN_1M: PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_2M: PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_5_5M: PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_11M: PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_6M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm18_Ofdm6_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_9M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm18_Ofdm6_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_12M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm18_Ofdm6_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_18M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm18_Ofdm6_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_24M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm54_Ofdm24_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_36M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm54_Ofdm24_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_48M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm54_Ofdm24_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_54M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm54_Ofdm24_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_MCS0: PHY_SetBBReg(Adapter, rTxAGC_B_MCS3_MCS0_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_MCS1: PHY_SetBBReg(Adapter, rTxAGC_B_MCS3_MCS0_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_MCS2: PHY_SetBBReg(Adapter, rTxAGC_B_MCS3_MCS0_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_MCS3: PHY_SetBBReg(Adapter, rTxAGC_B_MCS3_MCS0_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_MCS4: PHY_SetBBReg(Adapter, rTxAGC_B_MCS7_MCS4_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_MCS5: PHY_SetBBReg(Adapter, rTxAGC_B_MCS7_MCS4_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_MCS6: PHY_SetBBReg(Adapter, rTxAGC_B_MCS7_MCS4_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_MCS7: PHY_SetBBReg(Adapter, rTxAGC_B_MCS7_MCS4_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_MCS8: PHY_SetBBReg(Adapter, rTxAGC_B_MCS11_MCS8_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_MCS9: PHY_SetBBReg(Adapter, rTxAGC_B_MCS11_MCS8_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_MCS10: PHY_SetBBReg(Adapter, rTxAGC_B_MCS11_MCS8_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_MCS11: PHY_SetBBReg(Adapter, rTxAGC_B_MCS11_MCS8_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_MCS12: PHY_SetBBReg(Adapter, rTxAGC_B_MCS15_MCS12_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_MCS13: PHY_SetBBReg(Adapter, rTxAGC_B_MCS15_MCS12_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_MCS14: PHY_SetBBReg(Adapter, rTxAGC_B_MCS15_MCS12_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_MCS15: PHY_SetBBReg(Adapter, rTxAGC_B_MCS15_MCS12_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_VHT1SS_MCS0: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index3_Nss1Index0_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_VHT1SS_MCS1: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index3_Nss1Index0_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_VHT1SS_MCS2: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index3_Nss1Index0_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_VHT1SS_MCS3: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index3_Nss1Index0_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_VHT1SS_MCS4: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index7_Nss1Index4_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_VHT1SS_MCS5: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index7_Nss1Index4_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_VHT1SS_MCS6: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index7_Nss1Index4_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_VHT1SS_MCS7: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index7_Nss1Index4_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_VHT1SS_MCS8: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index1_Nss1Index8_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_VHT1SS_MCS9: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index1_Nss1Index8_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_VHT2SS_MCS0: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index1_Nss1Index8_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_VHT2SS_MCS1: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index1_Nss1Index8_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_VHT2SS_MCS2: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index5_Nss2Index2_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_VHT2SS_MCS3: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index5_Nss2Index2_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_VHT2SS_MCS4: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index5_Nss2Index2_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_VHT2SS_MCS5: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index5_Nss2Index2_JAguar, bMaskByte3, PowerIndex); break; ++ ++ case MGN_VHT2SS_MCS6: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index9_Nss2Index6_JAguar, bMaskByte0, PowerIndex); break; ++ case MGN_VHT2SS_MCS7: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index9_Nss2Index6_JAguar, bMaskByte1, PowerIndex); break; ++ case MGN_VHT2SS_MCS8: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index9_Nss2Index6_JAguar, bMaskByte2, PowerIndex); break; ++ case MGN_VHT2SS_MCS9: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index9_Nss2Index6_JAguar, bMaskByte3, PowerIndex); break; ++ ++ default: ++ DBG_871X("Invalid Rate!!\n"); ++ break; ++ } ++ } ++ else ++ { ++ DBG_871X("Invalid RFPath!!\n"); ++ } ++} ++ ++void ++phy_SetTxPowerIndexByRateArray( ++ PADAPTER pAdapter, ++ u8 RFPath, ++ CHANNEL_WIDTH BandWidth, ++ u8 Channel, ++ u8* Rates, ++ u8 RateArraySize ++ ) ++{ ++ u32 powerIndex = 0; ++ int i = 0; ++ ++ for (i = 0; i < RateArraySize; ++i) ++ { ++ powerIndex = PHY_GetTxPowerIndex_8812A(pAdapter, RFPath, Rates[i], BandWidth, Channel); ++ ++ PHY_SetTxPowerIndex_8812A(pAdapter, powerIndex, RFPath, Rates[i]); ++ } ++ ++} ++ ++void ++PHY_GetTxPowerIndexByRateArray_8812A( ++ PADAPTER pAdapter, ++ u8 RFPath, ++ CHANNEL_WIDTH BandWidth, ++ u8 Channel, ++ u8* Rate, ++ u8* PowerIndex, ++ u8 ArraySize ++ ) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); ++ u8 i; ++ for(i=0 ; iVersionID) ) ++ PowerIndex[i] -= 1; ++ } ++ ++} ++ ++void ++phy_TxPowerTrainingByPath_8812( ++ PADAPTER Adapter, ++ CHANNEL_WIDTH BandWidth, ++ u8 Channel, ++ u8 RfPath ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ u8 i; ++ u32 PowerLevel, writeData, writeOffset; ++ ++ if(RfPath >= pHalData->NumTotalRFPath) ++ return; ++ ++ writeData = 0; ++ if(RfPath == ODM_RF_PATH_A) ++ { ++ PowerLevel = PHY_GetTxPowerIndex_8812A(Adapter, ODM_RF_PATH_A, MGN_MCS7, BandWidth, Channel); ++ writeOffset = rA_TxPwrTraing_Jaguar; ++ } ++ else ++ { ++ PowerLevel = PHY_GetTxPowerIndex_8812A(Adapter, ODM_RF_PATH_B, MGN_MCS7, BandWidth, Channel); ++ writeOffset = rB_TxPwrTraing_Jaguar; ++ } ++ ++ for(i = 0; i < 3; i++) ++ { ++ if(i == 0) ++ PowerLevel = PowerLevel - 10; ++ else if(i == 1) ++ PowerLevel = PowerLevel - 8; ++ else ++ PowerLevel = PowerLevel - 6; ++ writeData |= (((PowerLevel > 2)?(PowerLevel):2) << (i * 8)); ++ } ++ ++ PHY_SetBBReg(Adapter, writeOffset, 0xffffff, writeData); ++} ++ ++void ++PHY_SetTxPowerLevelByPath8812( ++ PADAPTER Adapter, ++ u8 channel, ++ u8 path ++ ) ++{ ++ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ struct registry_priv *pregistrypriv = &Adapter->registrypriv; ++ u8 cckRates[] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}; ++ u8 ofdmRates[] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M}; ++ u8 htRates1T[] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}; ++ u8 htRates2T[] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}; ++ u8 vhtRates1T[] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4, ++ MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9}; ++ u8 vhtRates2T[] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, ++ MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9}; ++ ++ //DBG_871X("==>PHY_SetTxPowerLevelByPath8812()\n"); ++#if(MP_DRIVER == 1) ++ if (pregistrypriv->mp_mode == 1) ++ return; ++#endif ++ ++ //if(pMgntInfo->RegNByteAccess == 0) ++ { ++ if(pHalData->CurrentBandType == BAND_ON_2_4G) ++ phy_SetTxPowerIndexByRateArray(Adapter, path, pHalData->CurrentChannelBW, channel, ++ cckRates, sizeof(cckRates)/sizeof(u1Byte)); ++ ++ phy_SetTxPowerIndexByRateArray(Adapter, path, pHalData->CurrentChannelBW, channel, ++ ofdmRates, sizeof(ofdmRates)/sizeof(u1Byte)); ++ phy_SetTxPowerIndexByRateArray(Adapter, path, pHalData->CurrentChannelBW, channel, ++ htRates1T, sizeof(htRates1T)/sizeof(u1Byte)); ++ phy_SetTxPowerIndexByRateArray(Adapter, path, pHalData->CurrentChannelBW, channel, ++ vhtRates1T, sizeof(vhtRates1T)/sizeof(u1Byte)); ++ ++ if(pHalData->NumTotalRFPath >= 2) ++ { ++ phy_SetTxPowerIndexByRateArray(Adapter, path, pHalData->CurrentChannelBW, channel, ++ htRates2T, sizeof(htRates2T)/sizeof(u1Byte)); ++ phy_SetTxPowerIndexByRateArray(Adapter, path, pHalData->CurrentChannelBW, channel, ++ vhtRates2T, sizeof(vhtRates2T)/sizeof(u1Byte)); ++ } ++ } ++ phy_TxPowerTrainingByPath_8812(Adapter, pHalData->CurrentChannelBW, channel, path); ++} ++ ++//create new definition of PHY_SetTxPowerLevel8812 by YP. ++//Page revised on 20121106 ++//the new way to set tx power by rate, NByte access, here N byte shall be 4 byte(DWord) or NByte(N>4) access. by page/YP, 20121106 ++void ++PHY_SetTxPowerLevel8812( ++ PADAPTER Adapter, ++ u8 Channel ++ ) ++{ ++ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ u8 path = 0; ++ ++ for( path = ODM_RF_PATH_A; path < pHalData->NumTotalRFPath; ++path ) ++ { ++ PHY_SetTxPowerLevelByPath8812(Adapter, Channel, path); ++ } ++ ++ //DBG_871X("<==PHY_SetTxPowerLevel8812()\n"); ++} ++ ++bool ++PHY_UpdateTxPowerDbm8812( ++ PADAPTER Adapter, ++ int powerInDbm ++ ) ++{ ++ return true; ++} ++ ++ ++u32 PHY_GetTxBBSwing_8812A( ++ PADAPTER Adapter, ++ BAND_TYPE Band, ++ u8 RFPath ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(GetDefaultAdapter(Adapter)); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); ++ s8 bbSwing_2G = -1 * GetRegTxBBSwing_2G(Adapter); ++ s8 bbSwing_5G = -1 * GetRegTxBBSwing_5G(Adapter); ++ u32 out = 0x200; ++ const s8 AUTO = -1; ++ ++ ++ if (pEEPROM->bautoload_fail_flag) ++ { ++ if ( Band == BAND_ON_2_4G ) { ++ pRFCalibrateInfo->BBSwingDiff2G = bbSwing_2G; ++ if (bbSwing_2G == 0) out = 0x200; // 0 dB ++ else if (bbSwing_2G == -3) out = 0x16A; // -3 dB ++ else if (bbSwing_2G == -6) out = 0x101; // -6 dB ++ else if (bbSwing_2G == -9) out = 0x0B6; // -9 dB ++ else { ++ if ( pHalData->ExternalPA_2G ) { ++ pRFCalibrateInfo->BBSwingDiff2G = -3; ++ out = 0x16A; ++ } else { ++ pRFCalibrateInfo->BBSwingDiff2G = 0; ++ out = 0x200; ++ } ++ } ++ } else if ( Band == BAND_ON_5G ) { ++ pRFCalibrateInfo->BBSwingDiff5G = bbSwing_5G; ++ if (bbSwing_5G == 0) out = 0x200; // 0 dB ++ else if (bbSwing_5G == -3) out = 0x16A; // -3 dB ++ else if (bbSwing_5G == -6) out = 0x101; // -6 dB ++ else if (bbSwing_5G == -9) out = 0x0B6; // -9 dB ++ else { ++ if ( pHalData->ExternalPA_5G ) { ++ pRFCalibrateInfo->BBSwingDiff5G = -3; ++ out = 0x16A; ++ } else { ++ pRFCalibrateInfo->BBSwingDiff5G = 0; ++ out = 0x200; ++ } ++ } ++ } else { ++ pRFCalibrateInfo->BBSwingDiff2G = -3; ++ pRFCalibrateInfo->BBSwingDiff5G = -3; ++ out = 0x16A; // -3 dB ++ } ++ } ++ else ++ { ++ u32 swing = 0, swingA = 0, swingB = 0; ++ ++ if (Band == BAND_ON_2_4G) { ++ if (GetRegTxBBSwing_2G(Adapter) == AUTO) ++ { ++ EFUSE_ShadowRead(Adapter, 1, EEPROM_TX_BBSWING_2G_8812, (u32 *)&swing); ++ swing = (swing == 0xFF) ? 0x00 : swing; ++ } ++ else if (bbSwing_2G == 0) swing = 0x00; // 0 dB ++ else if (bbSwing_2G == -3) swing = 0x05; // -3 dB ++ else if (bbSwing_2G == -6) swing = 0x0A; // -6 dB ++ else if (bbSwing_2G == -9) swing = 0xFF; // -9 dB ++ else swing = 0x00; ++ } ++ else { ++ if (GetRegTxBBSwing_5G(Adapter) == AUTO) ++ { ++ EFUSE_ShadowRead(Adapter, 1, EEPROM_TX_BBSWING_5G_8812, (u32 *)&swing); ++ swing = (swing == 0xFF) ? 0x00 : swing; ++ } ++ else if (bbSwing_5G == 0) swing = 0x00; // 0 dB ++ else if (bbSwing_5G == -3) swing = 0x05; // -3 dB ++ else if (bbSwing_5G == -6) swing = 0x0A; // -6 dB ++ else if (bbSwing_5G == -9) swing = 0xFF; // -9 dB ++ else swing = 0x00; ++ } ++ ++ swingA = (swing & 0x3) >> 0; // 0xC6/C7[1:0] ++ swingB = (swing & 0xC) >> 2; // 0xC6/C7[3:2] ++ ++ //DBG_871X("===> PHY_GetTxBBSwing_8812A, swingA: 0x%X, swingB: 0x%X\n", swingA, swingB); ++ ++ //3 Path-A ++ if (swingA == 0x00) { ++ if (Band == BAND_ON_2_4G) ++ pRFCalibrateInfo->BBSwingDiff2G = 0; ++ else ++ pRFCalibrateInfo->BBSwingDiff5G = 0; ++ out = 0x200; // 0 dB ++ } else if (swingA == 0x01) { ++ if (Band == BAND_ON_2_4G) ++ pRFCalibrateInfo->BBSwingDiff2G = -3; ++ else ++ pRFCalibrateInfo->BBSwingDiff5G = -3; ++ out = 0x16A; // -3 dB ++ } else if (swingA == 0x10) { ++ if (Band == BAND_ON_2_4G) ++ pRFCalibrateInfo->BBSwingDiff2G = -6; ++ else ++ pRFCalibrateInfo->BBSwingDiff5G = -6; ++ out = 0x101; // -6 dB ++ } else if (swingA == 0x11) { ++ if (Band == BAND_ON_2_4G) ++ pRFCalibrateInfo->BBSwingDiff2G = -9; ++ else ++ pRFCalibrateInfo->BBSwingDiff5G = -9; ++ out = 0x0B6; // -9 dB ++ } ++ ++ //3 Path-B ++ if (swingB == 0x00) { ++ if (Band == BAND_ON_2_4G) ++ pRFCalibrateInfo->BBSwingDiff2G = 0; ++ else ++ pRFCalibrateInfo->BBSwingDiff5G = 0; ++ out = 0x200; // 0 dB ++ } else if (swingB == 0x01) { ++ if (Band == BAND_ON_2_4G) ++ pRFCalibrateInfo->BBSwingDiff2G = -3; ++ else ++ pRFCalibrateInfo->BBSwingDiff5G = -3; ++ out = 0x16A; // -3 dB ++ } else if (swingB == 0x10) { ++ if (Band == BAND_ON_2_4G) ++ pRFCalibrateInfo->BBSwingDiff2G = -6; ++ else ++ pRFCalibrateInfo->BBSwingDiff5G = -6; ++ out = 0x101; // -6 dB ++ } else if (swingB == 0x11) { ++ if (Band == BAND_ON_2_4G) ++ pRFCalibrateInfo->BBSwingDiff2G = -9; ++ else ++ pRFCalibrateInfo->BBSwingDiff5G = -9; ++ out = 0x0B6; // -9 dB ++ } ++ } ++ ++ //DBG_871X("<=== PHY_GetTxBBSwing_8812A, out = 0x%X\n", out); ++ ++ return out; ++} ++ ++void ++phy_SetRFEReg8812( ++ PADAPTER Adapter, ++ u8 Band ++) ++{ ++ u1Byte u1tmp = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ if(Band == BAND_ON_2_4G) ++ { ++ switch(pHalData->RFEType){ ++ case 0: case 1: case 2: ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); ++ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); ++ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); ++ break; ++ case 3: ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x54337770); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x54337770); ++ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); ++ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); ++ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar,0x00000303, 0x1); ++ break; ++ case 4: ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); ++ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x001); ++ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x001); ++ break; ++ case 5: ++ //if(BT_IsBtExist(Adapter)) ++ { ++ //rtw_write16(Adapter, rA_RFE_Pinmux_Jaguar, 0x7777); ++ rtw_write8(Adapter, rA_RFE_Pinmux_Jaguar+2, 0x77); ++ } ++ //else ++ //PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); ++ ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); ++ ++ //if(BT_IsBtExist(Adapter)) ++ { ++ //u1tmp = rtw_read8(Adapter, rA_RFE_Inv_Jaguar+2); ++ //rtw_write8(Adapter, rA_RFE_Inv_Jaguar+2, (u1tmp &0x0f)); ++ u1tmp = rtw_read8(Adapter, rA_RFE_Inv_Jaguar+3); ++ rtw_write8(Adapter, rA_RFE_Inv_Jaguar+3, (u1tmp &= ~BIT0)); ++ } ++ //else ++ //PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar, bMask_RFEInv_Jaguar, 0x000); ++ ++ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar, bMask_RFEInv_Jaguar, 0x000); ++ break; ++ default: ++ break; ++ } ++ } ++ else ++ { ++ switch(pHalData->RFEType){ ++ case 0: ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337717); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337717); ++ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); ++ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); ++ break; ++ case 1: ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337717); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337717); ++ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); ++ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); ++ break; ++ case 2: case 4: ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337777); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337777); ++ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); ++ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); ++ break; ++ case 3: ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x54337717); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x54337717); ++ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); ++ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); ++ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar,0x00000303, 0x1); ++ break; ++ case 5: ++ //if(BT_IsBtExist(Adapter)) ++ { ++ //rtw_write16(Adapter, rA_RFE_Pinmux_Jaguar, 0x7777); ++ if(pHalData->ExternalPA_5G) ++ PlatformEFIOWrite1Byte(Adapter, rA_RFE_Pinmux_Jaguar+2, 0x33); ++ else ++ PlatformEFIOWrite1Byte(Adapter, rA_RFE_Pinmux_Jaguar+2, 0x73); ++ } ++ #if 0 ++ else ++ { ++ if (pHalData->ExternalPA_5G) ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337777); ++ else ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77737777); ++ } ++ #endif ++ ++ if (pHalData->ExternalPA_5G) ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337777); ++ else ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77737777); ++ ++ //if(BT_IsBtExist(Adapter)) ++ { ++ //u1tmp = rtw_read8(Adapter, rA_RFE_Inv_Jaguar+2); ++ //rtw_write8(Adapter, rA_RFE_Inv_Jaguar+2, (u1tmp &0x0f)); ++ u1tmp = rtw_read8(Adapter, rA_RFE_Inv_Jaguar+3); ++ rtw_write8(Adapter, rA_RFE_Inv_Jaguar+3, (u1tmp |= BIT0)); ++ } ++ //else ++ //PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar, bMask_RFEInv_Jaguar, 0x010); ++ ++ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar, bMask_RFEInv_Jaguar, 0x010); ++ break; ++ default: ++ break; ++ } ++ } ++} ++ ++s32 ++PHY_SwitchWirelessBand8812( ++ PADAPTER Adapter, ++ u8 Band ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u8 currentBand = pHalData->CurrentBandType; ++ ++ //DBG_871X("==>PHY_SwitchWirelessBand8812() %s\n", ((Band==0)?"2.4G":"5G")); ++ ++ pHalData->CurrentBandType =(BAND_TYPE)Band; ++ ++ if(Band == BAND_ON_2_4G) ++ {// 2.4G band ++ ++ // STOP Tx/Rx ++ PHY_SetBBReg(Adapter, rOFDMCCKEN_Jaguar, bOFDMEN_Jaguar|bCCKEN_Jaguar, 0x00); ++ ++ if (IS_HARDWARE_TYPE_8821(Adapter)) ++ { ++ // Turn off RF PA and LNA ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0xF000, 0x7); // 0xCB0[15:12] = 0x7 (LNA_On) ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0xF0, 0x7); // 0xCB0[7:4] = 0x7 (PAPE_A) ++ } ++ ++ // AGC table select ++ if(IS_VENDOR_8821A_MP_CHIP(Adapter)) ++ PHY_SetBBReg(Adapter, rA_TxScale_Jaguar, 0xF00, 0); // 0xC1C[11:8] = 0 ++ else ++ PHY_SetBBReg(Adapter, rAGC_table_Jaguar, 0x3, 0); ++ ++ if(IS_VENDOR_8812A_TEST_CHIP(Adapter)) ++ { ++ // r_select_5G for path_A/B ++ PHY_SetBBReg(Adapter, rA_RFE_Jaguar, BIT12, 0x0); ++ PHY_SetBBReg(Adapter, rB_RFE_Jaguar, BIT12, 0x0); ++ ++ // LANON (5G uses external LNA) ++ PHY_SetBBReg(Adapter, rA_RFE_Jaguar, BIT15, 0x1); ++ PHY_SetBBReg(Adapter, rB_RFE_Jaguar, BIT15, 0x1); ++ } ++ else if(IS_VENDOR_8812A_MP_CHIP(Adapter)) ++ { ++ if(GetRegbENRFEType(Adapter)) ++ phy_SetRFEReg8812(Adapter, Band); ++ else ++ { ++ // PAPE_A (bypass RFE module in 2G) ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0x000000F0, 0x7); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, 0x000000F0, 0x7); ++ ++ // PAPE_G (bypass RFE module in 5G) ++ if (pHalData->ExternalPA_2G) { ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0x0000000F, 0x0); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, 0x0000000F, 0x0); ++ } else { ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0x0000000F, 0x7); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, 0x0000000F, 0x7); ++ } ++ ++ // TRSW bypass RFE moudle in 2G ++ if (pHalData->ExternalLNA_2G) { ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, bMaskByte2, 0x54); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, bMaskByte2, 0x54); ++ } else { ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, bMaskByte2, 0x77); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, bMaskByte2, 0x77); ++ } ++ } ++ } ++ ++ update_tx_basic_rate(Adapter, WIRELESS_11BG); ++ ++ // cck_enable ++ PHY_SetBBReg(Adapter, rOFDMCCKEN_Jaguar, bOFDMEN_Jaguar|bCCKEN_Jaguar, 0x3); ++ ++ // SYN Setting ++ if(IS_VENDOR_8812A_TEST_CHIP(Adapter)) ++ { ++ PHY_SetRFReg(Adapter, RF_PATH_A, 0xEF, bLSSIWrite_data_Jaguar, 0x40000); ++ PHY_SetRFReg(Adapter, RF_PATH_A, 0x3E, bLSSIWrite_data_Jaguar, 0x00000); ++ PHY_SetRFReg(Adapter, RF_PATH_A, 0x3F, bLSSIWrite_data_Jaguar, 0x0001c); ++ PHY_SetRFReg(Adapter, RF_PATH_A, 0xEF, bLSSIWrite_data_Jaguar, 0x00000); ++ PHY_SetRFReg(Adapter, RF_PATH_A, 0xB5, bLSSIWrite_data_Jaguar, 0x16BFF); ++ } ++ ++ // CCK_CHECK_en ++ rtw_write8(Adapter, REG_CCK_CHECK_8812, 0x0); ++ } ++ else //5G band ++ { ++ u16 count = 0, reg41A = 0; ++ ++ if (IS_HARDWARE_TYPE_8821(Adapter)) ++ { ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0xF000, 0x5); // 0xCB0[15:12] = 0x5 (LNA_On) ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0xF0, 0x4); // 0xCB0[7:4] = 0x4 (PAPE_A) ++ } ++ ++ // CCK_CHECK_en ++ rtw_write8(Adapter, REG_CCK_CHECK_8812, 0x80); ++ ++ count = 0; ++ reg41A = rtw_read16(Adapter, REG_TXPKT_EMPTY); ++ //DBG_871X("Reg41A value %d", reg41A); ++ reg41A &= 0x30; ++ while((reg41A!= 0x30) && (count < 50)) ++ { ++ rtw_udelay_os(50); ++ //DBG_871X("Delay 50us \n"); ++ ++ reg41A = rtw_read16(Adapter, REG_TXPKT_EMPTY); ++ reg41A &= 0x30; ++ count++; ++ //DBG_871X("Reg41A value %d", reg41A); ++ } ++ if(count != 0) ++ DBG_871X("PHY_SwitchWirelessBand8812(): Switch to 5G Band. Count = %d reg41A=0x%x\n", count, reg41A); ++ ++ // STOP Tx/Rx ++ PHY_SetBBReg(Adapter, rOFDMCCKEN_Jaguar, bOFDMEN_Jaguar|bCCKEN_Jaguar, 0x00); ++ ++ // AGC table select ++ if (IS_VENDOR_8821A_MP_CHIP(Adapter)) ++ PHY_SetBBReg(Adapter, rA_TxScale_Jaguar, 0xF00, 1); // 0xC1C[11:8] = 1 ++ else ++ PHY_SetBBReg(Adapter, rAGC_table_Jaguar, 0x3, 1); ++ ++ if(IS_VENDOR_8812A_TEST_CHIP(Adapter)) ++ { ++ // r_select_5G for path_A/B ++ PHY_SetBBReg(Adapter, rA_RFE_Jaguar, BIT12, 0x1); ++ PHY_SetBBReg(Adapter, rB_RFE_Jaguar, BIT12, 0x1); ++ ++ // LANON (5G uses external LNA) ++ PHY_SetBBReg(Adapter, rA_RFE_Jaguar, BIT15, 0x0); ++ PHY_SetBBReg(Adapter, rB_RFE_Jaguar, BIT15, 0x0); ++ } ++ else if(IS_VENDOR_8812A_MP_CHIP(Adapter)) ++ { ++ if(GetRegbENRFEType(Adapter)) ++ phy_SetRFEReg8812(Adapter, Band); ++ else ++ { ++ // PAPE_A (bypass RFE module in 2G) ++ if (pHalData->ExternalPA_5G) { ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0x000000F0, 0x1); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, 0x000000F0, 0x1); ++ } else { ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0x000000F0, 0x0); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, 0x000000F0, 0x0); ++ } ++ ++ // PAPE_G (bypass RFE module in 5G) ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0x0000000F, 0x7); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, 0x0000000F, 0x7); ++ ++ // TRSW bypass RFE moudle in 2G ++ if (pHalData->ExternalLNA_5G) { ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, bMaskByte2, 0x54); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, bMaskByte2, 0x54); ++ } else { ++ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, bMaskByte2, 0x77); ++ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, bMaskByte2, 0x77); ++ } ++ } ++ } ++ ++ //avoid using cck rate in 5G band ++ // Set RRSR rate table. ++ update_tx_basic_rate(Adapter, WIRELESS_11A); ++ ++ // cck_enable ++ PHY_SetBBReg(Adapter, rOFDMCCKEN_Jaguar, bOFDMEN_Jaguar|bCCKEN_Jaguar, 0x2); ++ ++ // SYN Setting ++ if(IS_VENDOR_8812A_TEST_CHIP(Adapter)) ++ { ++ PHY_SetRFReg(Adapter, RF_PATH_A, 0xEF, bLSSIWrite_data_Jaguar, 0x40000); ++ PHY_SetRFReg(Adapter, RF_PATH_A, 0x3E, bLSSIWrite_data_Jaguar, 0x00000); ++ PHY_SetRFReg(Adapter, RF_PATH_A, 0x3F, bLSSIWrite_data_Jaguar, 0x00017); ++ PHY_SetRFReg(Adapter, RF_PATH_A, 0xEF, bLSSIWrite_data_Jaguar, 0x00000); ++ PHY_SetRFReg(Adapter, RF_PATH_A, 0xB5, bLSSIWrite_data_Jaguar, 0x04BFF); ++ } ++ ++ //DBG_871X("==>PHY_SwitchWirelessBand8812() BAND_ON_5G settings OFDM index 0x%x\n", pHalData->OFDM_index[RF_PATH_A]); ++ } ++ ++ //<20120903, Kordan> Tx BB swing setting for RL6286, asked by Ynlin. ++ if (IS_NORMAL_CHIP(pHalData->VersionID) || IS_HARDWARE_TYPE_8821(Adapter)) ++ { ++ s8 BBDiffBetweenBand = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(GetDefaultAdapter(Adapter)); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); ++ ++ PHY_SetBBReg(Adapter, rA_TxScale_Jaguar, 0xFFE00000, ++ PHY_GetTxBBSwing_8812A(Adapter, (BAND_TYPE)Band, ODM_RF_PATH_A)); // 0xC1C[31:21] ++ PHY_SetBBReg(Adapter, rB_TxScale_Jaguar, 0xFFE00000, ++ PHY_GetTxBBSwing_8812A(Adapter, (BAND_TYPE)Band, ODM_RF_PATH_B)); // 0xE1C[31:21] ++ ++ // <20121005, Kordan> When TxPowerTrack is ON, we should take care of the change of BB swing. ++ // That is, reset all info to trigger Tx power tracking. ++ { ++ if (Band != currentBand) ++ { ++ BBDiffBetweenBand = (pRFCalibrateInfo->BBSwingDiff2G - pRFCalibrateInfo->BBSwingDiff5G); ++ BBDiffBetweenBand = (Band == BAND_ON_2_4G) ? BBDiffBetweenBand : (-1 * BBDiffBetweenBand); ++ pDM_Odm->DefaultOfdmIndex += BBDiffBetweenBand*2; ++ } ++ ++ ODM_ClearTxPowerTrackingState(pDM_Odm); ++ } ++ } ++ ++ //DBG_871X("<==PHY_SwitchWirelessBand8812():Switch Band OK.\n"); ++ return _SUCCESS; ++} ++ ++bool ++phy_SwBand8812( ++ PADAPTER pAdapter, ++ u8 channelToSW ++) ++{ ++ u8 u1Btmp; ++ bool ret_value = true; ++ u8 Band = BAND_ON_5G, BandToSW; ++ ++ u1Btmp = rtw_read8(pAdapter, REG_CCK_CHECK_8812); ++ if(u1Btmp & BIT7) ++ Band = BAND_ON_5G; ++ else ++ Band = BAND_ON_2_4G; ++ ++ // Use current channel to judge Band Type and switch Band if need. ++ if(channelToSW > 14) ++ { ++ BandToSW = BAND_ON_5G; ++ } ++ else ++ { ++ BandToSW = BAND_ON_2_4G; ++ } ++ ++ if(BandToSW != Band) ++ PHY_SwitchWirelessBand8812(pAdapter,BandToSW); ++ ++ return ret_value; ++} ++ ++u8 ++phy_GetSecondaryChnl_8812( ++ PADAPTER Adapter ++) ++{ ++ u8 SCSettingOf40 = 0, SCSettingOf20 = 0; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ ++ //DBG_871X("SCMapping: VHT Case: pHalData->CurrentChannelBW %d, pHalData->nCur80MhzPrimeSC %d, pHalData->nCur40MhzPrimeSC %d \n",pHalData->CurrentChannelBW,pHalData->nCur80MhzPrimeSC,pHalData->nCur40MhzPrimeSC); ++ if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_80) ++ { ++ if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) ++ SCSettingOf40 = VHT_DATA_SC_40_LOWER_OF_80MHZ; ++ else if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) ++ SCSettingOf40 = VHT_DATA_SC_40_UPPER_OF_80MHZ; ++ else ++ DBG_871X("SCMapping: Not Correct Primary40MHz Setting \n"); ++ ++ if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) ++ SCSettingOf20 = VHT_DATA_SC_20_LOWEST_OF_80MHZ; ++ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) ++ SCSettingOf20 = VHT_DATA_SC_20_LOWER_OF_80MHZ; ++ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) ++ SCSettingOf20 = VHT_DATA_SC_20_UPPER_OF_80MHZ; ++ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) ++ SCSettingOf20 = VHT_DATA_SC_20_UPPERST_OF_80MHZ; ++ else ++ DBG_871X("SCMapping: Not Correct Primary40MHz Setting \n"); ++ } ++ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) ++ { ++ //DBG_871X("SCMapping: VHT Case: pHalData->CurrentChannelBW %d, pHalData->nCur40MhzPrimeSC %d \n",pHalData->CurrentChannelBW,pHalData->nCur40MhzPrimeSC); ++ ++ if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) ++ SCSettingOf20 = VHT_DATA_SC_20_UPPER_OF_80MHZ; ++ else if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) ++ SCSettingOf20 = VHT_DATA_SC_20_LOWER_OF_80MHZ; ++ else ++ DBG_871X("SCMapping: Not Correct Primary40MHz Setting \n"); ++ } ++ ++ //DBG_871X("SCMapping: SC Value %x \n", ( (SCSettingOf40 << 4) | SCSettingOf20)); ++ return ( (SCSettingOf40 << 4) | SCSettingOf20); ++} ++ ++void ++phy_SetRegBW_8812( ++ PADAPTER Adapter, ++ CHANNEL_WIDTH CurrentBW ++) ++{ ++ u16 RegRfMod_BW, u2tmp = 0; ++ RegRfMod_BW = rtw_read16(Adapter, REG_WMAC_TRXPTCL_CTL); ++ ++ switch(CurrentBW) ++ { ++ case CHANNEL_WIDTH_20: ++ rtw_write16(Adapter, REG_WMAC_TRXPTCL_CTL, (RegRfMod_BW & 0xFE7F)); // BIT 7 = 0, BIT 8 = 0 ++ break; ++ ++ case CHANNEL_WIDTH_40: ++ u2tmp = RegRfMod_BW | BIT7; ++ rtw_write16(Adapter, REG_WMAC_TRXPTCL_CTL, (u2tmp & 0xFEFF)); // BIT 7 = 1, BIT 8 = 0 ++ break; ++ ++ case CHANNEL_WIDTH_80: ++ u2tmp = RegRfMod_BW | BIT8; ++ rtw_write16(Adapter, REG_WMAC_TRXPTCL_CTL, (u2tmp & 0xFF7F)); // BIT 7 = 0, BIT 8 = 1 ++ break; ++ ++ default: ++ DBG_871X("phy_PostSetBWMode8812(): unknown Bandwidth: %#X\n",CurrentBW); ++ break; ++ } ++ ++} ++ ++void ++phy_FixSpur_8812A( ++ PADAPTER pAdapter, ++ CHANNEL_WIDTH Bandwidth, ++ u1Byte Channel ++) ++{ ++ // C cut Item12 ADC FIFO CLOCK ++ if(IS_VENDOR_8812A_C_CUT(pAdapter)) ++ { ++ if(Bandwidth == CHANNEL_WIDTH_40 && Channel == 11) ++ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0xC00, 0x3) ; // 0x8AC[11:10] = 2'b11 ++ else ++ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0xC00, 0x2); // 0x8AC[11:10] = 2'b10 ++ ++ // <20120914, Kordan> A workarould to resolve 2480Mhz spur by setting ADC clock as 160M. (Asked by Binson) ++ if (Bandwidth == CHANNEL_WIDTH_20 && ++ (Channel == 13 || Channel == 14)) { ++ ++ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0x300, 0x3); // 0x8AC[9:8] = 2'b11 ++ PHY_SetBBReg(pAdapter, rADC_Buf_Clk_Jaguar, BIT30, 1); // 0x8C4[30] = 1 ++ ++ } else if (Bandwidth == CHANNEL_WIDTH_40 && ++ Channel == 11) { ++ ++ PHY_SetBBReg(pAdapter, rADC_Buf_Clk_Jaguar, BIT30, 1); // 0x8C4[30] = 1 ++ ++ } else if (Bandwidth != CHANNEL_WIDTH_80) { ++ ++ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0x300, 0x2); // 0x8AC[9:8] = 2'b10 ++ PHY_SetBBReg(pAdapter, rADC_Buf_Clk_Jaguar, BIT30, 0); // 0x8C4[30] = 0 ++ ++ } ++ } ++ else if (IS_HARDWARE_TYPE_8812(pAdapter)) ++ { ++ // <20120914, Kordan> A workarould to resolve 2480Mhz spur by setting ADC clock as 160M. (Asked by Binson) ++ if (Bandwidth == CHANNEL_WIDTH_20 && ++ (Channel == 13 || Channel == 14)) ++ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0x300, 0x3); // 0x8AC[9:8] = 11 ++ else if (Channel <= 14) // 2.4G only ++ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0x300, 0x2); // 0x8AC[9:8] = 10 ++ } ++ ++} ++ ++void ++phy_PostSetBwMode8812( ++ PADAPTER Adapter ++) ++{ ++ u8 SubChnlNum = 0; ++ u8 L1pkVal = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ ++ //3 Set Reg668 Reg440 BW ++ phy_SetRegBW_8812(Adapter, pHalData->CurrentChannelBW); ++ ++ //3 Set Reg483 ++ SubChnlNum = phy_GetSecondaryChnl_8812(Adapter); ++ rtw_write8(Adapter, REG_DATA_SC_8812, SubChnlNum); ++ ++ if(pHalData->rf_chip == RF_PSEUDO_11N) ++ { ++ DBG_871X("phy_PostSetBwMode8812: return for PSEUDO \n"); ++ return; ++ } ++ ++ //DBG_871X("[BW:CHNL], phy_PostSetBwMode8812(), set BW=%s !!\n", GLBwSrc[pHalData->CurrentChannelBW]); ++ ++ //3 Set Reg848 Reg864 Reg8AC Reg8C4 RegA00 ++ switch(pHalData->CurrentChannelBW) ++ { ++ case CHANNEL_WIDTH_20: ++ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x003003C3, 0x00300200); // 0x8ac[21,20,9:6,1,0]=8'b11100000 ++ PHY_SetBBReg(Adapter, rADC_Buf_Clk_Jaguar, BIT30, 0); // 0x8c4[30] = 1'b0 ++ ++ PHY_SetBBReg(Adapter, rFPGA0_XB_RFInterfaceOE, 0x001C0000, 4); // 0x864[20:18] = 3'b4 ++ ++ if(pHalData->rf_type == RF_2T2R) ++ PHY_SetBBReg(Adapter, rL1PeakTH_Jaguar, 0x03C00000, 7); // 2R 0x848[25:22] = 0x7 ++ else ++ PHY_SetBBReg(Adapter, rL1PeakTH_Jaguar, 0x03C00000, 8); // 1R 0x848[25:22] = 0x8 ++ ++ break; ++ ++ case CHANNEL_WIDTH_40: ++ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x003003C3, 0x00300201); // 0x8ac[21,20,9:6,1,0]=8'b11100000 ++ PHY_SetBBReg(Adapter, rADC_Buf_Clk_Jaguar, BIT30, 0); // 0x8c4[30] = 1'b0 ++ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x3C, SubChnlNum); ++ PHY_SetBBReg(Adapter, rCCAonSec_Jaguar, 0xf0000000, SubChnlNum); ++ ++ PHY_SetBBReg(Adapter, rFPGA0_XB_RFInterfaceOE, 0x001C0000, 2); // 0x864[20:18] = 3'b2 ++ ++ if(pHalData->Reg837 & BIT2) ++ L1pkVal = 6; ++ else ++ { ++ if(pHalData->rf_type == RF_2T2R) ++ L1pkVal = 7; ++ else ++ L1pkVal = 8; ++ } ++ ++ PHY_SetBBReg(Adapter, rL1PeakTH_Jaguar, 0x03C00000, L1pkVal); // 0x848[25:22] = 0x6 ++ ++ if(SubChnlNum == VHT_DATA_SC_20_UPPER_OF_80MHZ) ++ PHY_SetBBReg(Adapter, rCCK_System_Jaguar, bCCK_System_Jaguar, 1); ++ else ++ PHY_SetBBReg(Adapter, rCCK_System_Jaguar, bCCK_System_Jaguar, 0); ++ break; ++ ++ case CHANNEL_WIDTH_80: ++ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x003003C3, 0x00300202); // 0x8ac[21,20,9:6,1,0]=8'b11100010 ++ PHY_SetBBReg(Adapter, rADC_Buf_Clk_Jaguar, BIT30, 1); // 0x8c4[30] = 1 ++ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x3C, SubChnlNum); ++ PHY_SetBBReg(Adapter, rCCAonSec_Jaguar, 0xf0000000, SubChnlNum); ++ ++ PHY_SetBBReg(Adapter, rFPGA0_XB_RFInterfaceOE, 0x001C0000, 2); // 0x864[20:18] = 3'b2 ++ ++ if(pHalData->Reg837 & BIT2) ++ L1pkVal = 5; ++ else ++ { ++ if(pHalData->rf_type == RF_2T2R) ++ L1pkVal = 6; ++ else ++ L1pkVal = 7; ++ } ++ PHY_SetBBReg(Adapter, rL1PeakTH_Jaguar, 0x03C00000, L1pkVal); // 0x848[25:22] = 0x5 ++ ++ break; ++ ++ default: ++ DBG_871X("phy_PostSetBWMode8812(): unknown Bandwidth: %#X\n",pHalData->CurrentChannelBW); ++ break; ++ } ++ ++ // <20121109, Kordan> A workaround for 8812A only. ++ phy_FixSpur_8812A(Adapter, pHalData->CurrentChannelBW, pHalData->CurrentChannel); ++ ++ //DBG_871X("phy_PostSetBwMode8812(): Reg483: %x\n", rtw_read8(Adapter, 0x483)); ++ //DBG_871X("phy_PostSetBwMode8812(): Reg668: %x\n", rtw_read32(Adapter, 0x668)); ++ //DBG_871X("phy_PostSetBwMode8812(): Reg8AC: %x\n", PHY_QueryBBReg(Adapter, rRFMOD_Jaguar, 0xffffffff)); ++ ++ //3 Set RF related register ++ PHY_RF6052SetBandwidth8812(Adapter, pHalData->CurrentChannelBW); ++} ++ ++//<20130207, Kordan> The variales initialized here are used in odm_LNAPowerControl(). ++void phy_InitRssiTRSW( ++ PADAPTER pAdapter ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; ++ u8 channel = pHalData->CurrentChannel; ++ ++ if (pHalData->RFEType == 3){ ++ ++ if (channel <= 14) { ++ pDM_Odm->RSSI_TRSW_H = 70; // Unit: percentage(%) ++ pDM_Odm->RSSI_TRSW_iso = 25; ++ } else if (36 <= channel && channel <= 64) { ++ pDM_Odm->RSSI_TRSW_H = 70; ++ pDM_Odm->RSSI_TRSW_iso = 25; ++ } else if (100 <= channel && channel <= 144) { ++ pDM_Odm->RSSI_TRSW_H = 80; ++ pDM_Odm->RSSI_TRSW_iso = 35; ++ } else if (149 <= channel) { ++ pDM_Odm->RSSI_TRSW_H = 75; ++ pDM_Odm->RSSI_TRSW_iso = 30; ++ } ++ ++ pDM_Odm->RSSI_TRSW_L = pDM_Odm->RSSI_TRSW_H - pDM_Odm->RSSI_TRSW_iso - 10; ++ } ++} ++ ++void ++phy_SwChnl8812( ++ PADAPTER pAdapter ++ ) ++{ ++ u8 eRFPath = 0; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ u8 channelToSW = pHalData->CurrentChannel; ++ ++ if (pAdapter->registrypriv.mp_mode == 0) { ++ if(phy_SwBand8812(pAdapter, channelToSW) == false) ++ { ++ DBG_871X("error Chnl %d !\n", channelToSW); ++ } ++ } ++ ++ //<20130313, Kordan> Sample code to demonstrate how to configure AGC_TAB_DIFF.(Disabled by now) ++#if 0 ++ if (36 <= channelToSW && channelToSW <= 48) ++ AGC_DIFF_CONFIG(8812A,LB); ++ else if (50 <= channelToSW && channelToSW <= 64) ++ AGC_DIFF_CONFIG(8812A,MB); ++ else if (100 <= channelToSW && channelToSW <= 116) ++ AGC_DIFF_CONFIG(8812A,HB); ++#endif ++ ++ if(pHalData->rf_chip == RF_PSEUDO_11N) ++ { ++ DBG_871X("phy_SwChnl8812: return for PSEUDO \n"); ++ return; ++ } ++ ++ //DBG_871X("[BW:CHNL], phy_SwChnl8812(), switch to channel %d !!\n", channelToSW); ++ ++ // fc_area ++ if (36 <= channelToSW && channelToSW <= 48) ++ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x494); ++ else if (50 <= channelToSW && channelToSW <= 64) ++ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x453); ++ else if (100 <= channelToSW && channelToSW <= 116) ++ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x452); ++ else if (118 <= channelToSW) ++ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x412); ++ else ++ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x96a); ++ ++ for(eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) ++ { ++ // [2.4G] LC Tank ++ if(IS_VENDOR_8812A_TEST_CHIP(pAdapter)) ++ { ++ if (1 <= channelToSW && channelToSW <= 7) ++ PHY_SetRFReg(pAdapter, eRFPath, RF_TxLCTank_Jaguar, bLSSIWrite_data_Jaguar, 0x0017e); ++ else if (8 <= channelToSW && channelToSW <= 14) ++ PHY_SetRFReg(pAdapter, eRFPath, RF_TxLCTank_Jaguar, bLSSIWrite_data_Jaguar, 0x0013e); ++ } ++ ++ // RF_MOD_AG ++ if (36 <= channelToSW && channelToSW <= 64) ++ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, BIT18|BIT17|BIT16|BIT9|BIT8, 0x101); //5'b00101); ++ else if (100 <= channelToSW && channelToSW <= 140) ++ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, BIT18|BIT17|BIT16|BIT9|BIT8, 0x301); //5'b01101); ++ else if (140 < channelToSW) ++ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, BIT18|BIT17|BIT16|BIT9|BIT8, 0x501); //5'b10101); ++ else ++ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, BIT18|BIT17|BIT16|BIT9|BIT8, 0x000); //5'b00000); ++ ++ // <20121109, Kordan> A workaround for 8812A only. ++ phy_FixSpur_8812A(pAdapter, pHalData->CurrentChannelBW, channelToSW); ++ ++ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, bMaskByte0, channelToSW); ++ ++ // <20130104, Kordan> APK for MP chip is done on initialization from folder. ++ if (IS_HARDWARE_TYPE_8811AU(pAdapter) && ( !IS_NORMAL_CHIP(pHalData->VersionID)) && channelToSW > 14 ) ++ { ++ // <20121116, Kordan> For better result of APK. Asked by AlexWang. ++ if (36 <= channelToSW && channelToSW <= 64) ++ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x710E7); ++ else if (100 <= channelToSW && channelToSW <= 140) ++ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x716E9); ++ else ++ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x714E9); ++ } ++ else if ((IS_HARDWARE_TYPE_8821E(pAdapter) || IS_HARDWARE_TYPE_8821S(pAdapter)) ++ && channelToSW > 14) ++ { ++ // <20130111, Kordan> For better result of APK. Asked by Willson. ++ if (36 <= channelToSW && channelToSW <= 64) ++ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x714E9); ++ else if (100 <= channelToSW && channelToSW <= 140) ++ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x110E9); ++ else ++ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x714E9); ++ } ++ } ++} ++ ++void ++phy_SwChnlAndSetBwMode8812( ++ PADAPTER Adapter ++) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ //DBG_871X("phy_SwChnlAndSetBwMode8812(): bSwChnl %d, bSetChnlBW %d \n", pHalData->bSwChnl, pHalData->bSetChnlBW); ++ ++ if((Adapter->bDriverStopped) || (Adapter->bSurpriseRemoved)) ++ { ++ return; ++ } ++ ++ if(pHalData->bSwChnl) ++ { ++ phy_SwChnl8812(Adapter); ++ pHalData->bSwChnl = false; ++ } ++ ++ if(pHalData->bSetChnlBW) ++ { ++ phy_PostSetBwMode8812(Adapter); ++ pHalData->bSetChnlBW = false; ++ } ++ ++ ODM_ClearTxPowerTrackingState(&pHalData->odmpriv); ++ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); ++ ++ if(IS_HARDWARE_TYPE_8812(Adapter)) ++ phy_InitRssiTRSW(Adapter); ++ ++ if ( (pHalData->bNeedIQK == true) ++#if (MP_DRIVER == 1) ++ || (Adapter->registrypriv.mp_mode == 1) ++#endif ++ ) ++ { ++ if(IS_HARDWARE_TYPE_8812(Adapter)) ++ PHY_IQCalibrate_8812A(Adapter, false); ++ else if(IS_HARDWARE_TYPE_8821(Adapter)) ++ PHY_IQCalibrate_8821A(Adapter, false); ++ pHalData->bNeedIQK = false; ++ } ++} ++ ++void ++PHY_HandleSwChnlAndSetBW8812( ++ PADAPTER Adapter, ++ bool bSwitchChannel, ++ bool bSetBandWidth, ++ u8 ChannelNum, ++ CHANNEL_WIDTH ChnlWidth, ++ u8 ChnlOffsetOf40MHz, ++ u8 ChnlOffsetOf80MHz, ++ u8 CenterFrequencyIndex1 ++) ++{ ++ PADAPTER pDefAdapter = GetDefaultAdapter(Adapter); ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDefAdapter); ++ u8 tmpChannel = pHalData->CurrentChannel; ++ CHANNEL_WIDTH tmpBW= pHalData->CurrentChannelBW; ++ u8 tmpnCur40MhzPrimeSC = pHalData->nCur40MhzPrimeSC; ++ u8 tmpnCur80MhzPrimeSC = pHalData->nCur80MhzPrimeSC; ++ u8 tmpCenterFrequencyIndex1 =pHalData->CurrentCenterFrequencyIndex1; ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ ++ //DBG_871X("=> PHY_HandleSwChnlAndSetBW8812: bSwitchChannel %d, bSetBandWidth %d \n",bSwitchChannel,bSetBandWidth); ++ ++ //check is swchnl or setbw ++ if(!bSwitchChannel && !bSetBandWidth) ++ { ++ DBG_871X("PHY_HandleSwChnlAndSetBW8812: not switch channel and not set bandwidth \n"); ++ return; ++ } ++ ++ //skip change for channel or bandwidth is the same ++ if(bSwitchChannel) ++ { ++ if(pHalData->CurrentChannel != ChannelNum) ++ { ++ if (HAL_IsLegalChannel(Adapter, ChannelNum)) ++ pHalData->bSwChnl = true; ++ else ++ return; ++ } ++ } ++ ++ if(bSetBandWidth) ++ { ++ if(pHalData->bChnlBWInitialzed == false) ++ { ++ pHalData->bChnlBWInitialzed = true; ++ pHalData->bSetChnlBW = true; ++ } ++ else if((pHalData->CurrentChannelBW != ChnlWidth) || ++ (pHalData->nCur40MhzPrimeSC != ChnlOffsetOf40MHz) || ++ (pHalData->nCur80MhzPrimeSC != ChnlOffsetOf80MHz) || ++ (pHalData->CurrentCenterFrequencyIndex1!= CenterFrequencyIndex1)) ++ { ++ pHalData->bSetChnlBW = true; ++ } ++ } ++ ++ if(!pHalData->bSetChnlBW && !pHalData->bSwChnl) ++ { ++ //DBG_871X("<= PHY_HandleSwChnlAndSetBW8812: bSwChnl %d, bSetChnlBW %d \n",pHalData->bSwChnl,pHalData->bSetChnlBW); ++ return; ++ } ++ ++ ++ if(pHalData->bSwChnl) ++ { ++ pHalData->CurrentChannel=ChannelNum; ++ pHalData->CurrentCenterFrequencyIndex1 = ChannelNum; ++ } ++ ++ ++ if(pHalData->bSetChnlBW) ++ { ++ pHalData->CurrentChannelBW = ChnlWidth; ++#if 0 ++ if(ExtChnlOffsetOf40MHz==EXTCHNL_OFFSET_LOWER) ++ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_UPPER; ++ else if(ExtChnlOffsetOf40MHz==EXTCHNL_OFFSET_UPPER) ++ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_LOWER; ++ else ++ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++ ++ if(ExtChnlOffsetOf80MHz==EXTCHNL_OFFSET_LOWER) ++ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_UPPER; ++ else if(ExtChnlOffsetOf80MHz==EXTCHNL_OFFSET_UPPER) ++ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_LOWER; ++ else ++ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_DONT_CARE; ++#else ++ pHalData->nCur40MhzPrimeSC = ChnlOffsetOf40MHz; ++ pHalData->nCur80MhzPrimeSC = ChnlOffsetOf80MHz; ++#endif ++ ++ pHalData->CurrentCenterFrequencyIndex1 = CenterFrequencyIndex1; ++ } ++ ++ //Switch workitem or set timer to do switch channel or setbandwidth operation ++ if((!pDefAdapter->bDriverStopped) && (!pDefAdapter->bSurpriseRemoved)) ++ { ++ phy_SwChnlAndSetBwMode8812(Adapter); ++ } ++ else ++ { ++ if(pHalData->bSwChnl) ++ { ++ pHalData->CurrentChannel = tmpChannel; ++ pHalData->CurrentCenterFrequencyIndex1 = tmpChannel; ++ } ++ if(pHalData->bSetChnlBW) ++ { ++ pHalData->CurrentChannelBW = tmpBW; ++ pHalData->nCur40MhzPrimeSC = tmpnCur40MhzPrimeSC; ++ pHalData->nCur80MhzPrimeSC = tmpnCur80MhzPrimeSC; ++ pHalData->CurrentCenterFrequencyIndex1 = tmpCenterFrequencyIndex1; ++ } ++ } ++ ++ //DBG_871X("Channel %d ChannelBW %d ",pHalData->CurrentChannel, pHalData->CurrentChannelBW); ++ //DBG_871X("40MhzPrimeSC %d 80MhzPrimeSC %d ",pHalData->nCur40MhzPrimeSC, pHalData->nCur80MhzPrimeSC); ++ //DBG_871X("CenterFrequencyIndex1 %d \n",pHalData->CurrentCenterFrequencyIndex1); ++ ++ //DBG_871X("<= PHY_HandleSwChnlAndSetBW8812: bSwChnl %d, bSetChnlBW %d \n",pHalData->bSwChnl,pHalData->bSetChnlBW); ++ ++} ++ ++void ++PHY_SetBWMode8812( ++ PADAPTER Adapter, ++ CHANNEL_WIDTH Bandwidth, // 20M or 40M ++ u8 Offset // Upper, Lower, or Don't care ++) ++{ ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ ++ //DBG_871X("%s()===>\n",__FUNCTION__); ++ ++ PHY_HandleSwChnlAndSetBW8812(Adapter, false, true, pHalData->CurrentChannel, Bandwidth, Offset, Offset, pHalData->CurrentChannel); ++ ++ //DBG_871X("<==%s()\n",__FUNCTION__); ++} ++ ++void ++PHY_SwChnl8812( ++ PADAPTER Adapter, ++ u8 channel ++ ) ++{ ++ //DBG_871X("%s()===>\n",__FUNCTION__); ++ ++ PHY_HandleSwChnlAndSetBW8812(Adapter, true, false, channel, 0, 0, 0, channel); ++ ++ //DBG_871X("<==%s()\n",__FUNCTION__); ++} ++ ++void ++PHY_SetSwChnlBWMode8812( ++ PADAPTER Adapter, ++ u8 channel, ++ CHANNEL_WIDTH Bandwidth, ++ u8 Offset40, ++ u8 Offset80 ++) ++{ ++ //DBG_871X("%s()===>\n",__FUNCTION__); ++ ++ PHY_HandleSwChnlAndSetBW8812(Adapter, true, true, channel, Bandwidth, Offset40, Offset80, channel); ++ ++ //DBG_871X("<==%s()\n",__FUNCTION__); ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_rf6052.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_rf6052.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_rf6052.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_rf6052.c 2018-02-06 17:42:30.715967238 +0200 +@@ -0,0 +1,571 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++#define _RTL8812A_RF6052_C_ ++ ++//#include ++#include ++ ++ ++/*----------------------------------------------------------------------------- ++ * Function: PHY_RF6052SetBandwidth() ++ * ++ * Overview: This function is called by SetBWModeCallback8190Pci() only ++ * ++ * Input: PADAPTER Adapter ++ * WIRELESS_BANDWIDTH_E Bandwidth //20M or 40M ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Note: For RF type 0222D ++ *---------------------------------------------------------------------------*/ ++void ++PHY_RF6052SetBandwidth8812( ++ PADAPTER Adapter, ++ CHANNEL_WIDTH Bandwidth) //20M or 40M ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ switch(Bandwidth) ++ { ++ case CHANNEL_WIDTH_20: ++ //DBG_871X("PHY_RF6052SetBandwidth8812(), set 20MHz, pHalData->RfRegChnlVal[0] = 0x%x \n", pHalData->RfRegChnlVal[0]); ++ PHY_SetRFReg(Adapter, RF_PATH_A, RF_CHNLBW_Jaguar, BIT11|BIT10, 3); ++ PHY_SetRFReg(Adapter, RF_PATH_B, RF_CHNLBW_Jaguar, BIT11|BIT10, 3); ++ break; ++ ++ case CHANNEL_WIDTH_40: ++ //DBG_871X("PHY_RF6052SetBandwidth8812(), set 40MHz, pHalData->RfRegChnlVal[0] = 0x%x \n", pHalData->RfRegChnlVal[0]); ++ PHY_SetRFReg(Adapter, RF_PATH_A, RF_CHNLBW_Jaguar, BIT11|BIT10, 1); ++ PHY_SetRFReg(Adapter, RF_PATH_B, RF_CHNLBW_Jaguar, BIT11|BIT10, 1); ++ break; ++ ++ case CHANNEL_WIDTH_80: ++ //DBG_871X("PHY_RF6052SetBandwidth8812(), set 80MHz, pHalData->RfRegChnlVal[0] = 0x%x \n", pHalData->RfRegChnlVal[0]); ++ PHY_SetRFReg(Adapter, RF_PATH_A, RF_CHNLBW_Jaguar, BIT11|BIT10, 0); ++ PHY_SetRFReg(Adapter, RF_PATH_B, RF_CHNLBW_Jaguar, BIT11|BIT10, 0); ++ break; ++ ++ default: ++ DBG_871X("PHY_RF6052SetBandwidth8812(): unknown Bandwidth: %#X\n",Bandwidth ); ++ break; ++ } ++} ++ ++// ++// powerbase0 for OFDM rates ++// powerbase1 for HT MCS rates ++// ++void getPowerBase8812( ++ PADAPTER Adapter, ++ u8* pPowerLevelOFDM, ++ u8* pPowerLevelBW20, ++ u8* pPowerLevelBW40, ++ u8 Channel, ++ u32* OfdmBase, ++ u32* MCSBase ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ u32 powerBase0, powerBase1; ++ u8 i, powerlevel[2]; ++ ++ for(i=0; i<2; i++) ++ { ++ powerBase0 = pPowerLevelOFDM[i]; ++ ++ powerBase0 = (powerBase0<<24) | (powerBase0<<16) |(powerBase0<<8) |powerBase0; ++ *(OfdmBase+i) = powerBase0; ++ //DBG_871X(" [OFDM power base index rf(%c) = 0x%x]\n", ((i==0)?'A':'B'), *(OfdmBase+i)); ++ } ++ ++ for(i=0; iNumTotalRFPath; i++) ++ { ++ //Check HT20 to HT40 diff ++ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) ++ { ++ powerlevel[i] = pPowerLevelBW20[i]; ++ } ++ else ++ { ++ powerlevel[i] = pPowerLevelBW40[i]; ++ } ++ powerBase1 = powerlevel[i]; ++ powerBase1 = (powerBase1<<24) | (powerBase1<<16) |(powerBase1<<8) |powerBase1; ++ *(MCSBase+i) = powerBase1; ++ //DBG_871X(" [MCS power base index rf(%c) = 0x%x]\n", ((i==0)?'A':'B'), *(MCSBase+i)); ++ } ++} ++ ++void getTxPowerWriteValByRegulatory8812( ++ PADAPTER Adapter, ++ u8 Channel, ++ u8 index, ++ u32* powerBase0, ++ u32* powerBase1, ++ u32* pOutWriteVal ++ ) ++{ ++ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ u8 i, chnlGroup=0, pwr_diff_limit[4], customer_pwr_limit; ++ s8 pwr_diff=0; ++ u32 writeVal, customer_limit, rf; ++ u8 Regulatory = pHalData->EEPROMRegulatory; ++ ++ // ++ // Index 0 & 1= legacy OFDM, 2-5=HT_MCS rate ++ // ++#if 0 // (INTEL_PROXIMITY_SUPPORT == 1) ++ if(pMgntInfo->IntelProximityModeInfo.PowerOutput > 0) ++ Regulatory = 2; ++#endif ++ ++ for(rf=0; rf<2; rf++) ++ { ++ switch(Regulatory) ++ { ++ case 0: // Realtek better performance ++ // increase power diff defined by Realtek for large power ++ chnlGroup = 0; ++ //RTPRINT(FPHY, PHY_TXPWR, ("MCSTxPowerLevelOriginalOffset[%d][%d] = 0x%x\n", ++ // chnlGroup, index, pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)])); ++ writeVal = pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)] + ++ ((index<2)?powerBase0[rf]:powerBase1[rf]); ++ //RTPRINT(FPHY, PHY_TXPWR, ("RTK better performance, writeVal(%c) = 0x%x\n", ((rf==0)?'A':'B'), writeVal)); ++ break; ++ case 1: // Realtek regulatory ++ // increase power diff defined by Realtek for regulatory ++ { ++ if(pHalData->pwrGroupCnt == 1) ++ chnlGroup = 0; ++ //if(pHalData->pwrGroupCnt >= pHalData->PGMaxGroup) ++ { ++ if (Channel < 3) // Chanel 1-2 ++ chnlGroup = 0; ++ else if (Channel < 6) // Channel 3-5 ++ chnlGroup = 1; ++ else if(Channel <9) // Channel 6-8 ++ chnlGroup = 2; ++ else if(Channel <12) // Channel 9-11 ++ chnlGroup = 3; ++ else if(Channel <14) // Channel 12-13 ++ chnlGroup = 4; ++ else if(Channel ==14) // Channel 14 ++ chnlGroup = 5; ++ ++/* ++ if(Channel <= 3) ++ chnlGroup = 0; ++ else if(Channel >= 4 && Channel <= 9) ++ chnlGroup = 1; ++ else if(Channel > 9) ++ chnlGroup = 2; ++ ++ ++ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) ++ chnlGroup++; ++ else ++ chnlGroup+=4; ++*/ ++ } ++ //RTPRINT(FPHY, PHY_TXPWR, ("MCSTxPowerLevelOriginalOffset[%d][%d] = 0x%x\n", ++ //chnlGroup, index, pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)])); ++ writeVal = pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)] + ++ ((index<2)?powerBase0[rf]:powerBase1[rf]); ++ //RTPRINT(FPHY, PHY_TXPWR, ("Realtek regulatory, 20MHz, writeVal(%c) = 0x%x\n", ((rf==0)?'A':'B'), writeVal)); ++ } ++ break; ++ case 2: // Better regulatory ++ // don't increase any power diff ++ writeVal = ((index<2)?powerBase0[rf]:powerBase1[rf]); ++ //RTPRINT(FPHY, PHY_TXPWR, ("Better regulatory, writeVal(%c) = 0x%x\n", ((rf==0)?'A':'B'), writeVal)); ++ break; ++ case 3: // Customer defined power diff. ++ // increase power diff defined by customer. ++ chnlGroup = 0; ++ //RTPRINT(FPHY, PHY_TXPWR, ("MCSTxPowerLevelOriginalOffset[%d][%d] = 0x%x\n", ++ // chnlGroup, index, pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)])); ++ ++ /* ++ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) ++ { ++ RTPRINT(FPHY, PHY_TXPWR, ("customer's limit, 40MHz rf(%c) = 0x%x\n", ++ ((rf==0)?'A':'B'), pHalData->PwrGroupHT40[rf][Channel-1])); ++ } ++ else ++ { ++ RTPRINT(FPHY, PHY_TXPWR, ("customer's limit, 20MHz rf(%c) = 0x%x\n", ++ ((rf==0)?'A':'B'), pHalData->PwrGroupHT20[rf][Channel-1])); ++ }*/ ++ ++ if(index < 2) ++ pwr_diff = pHalData->TxPwrLegacyHtDiff[rf][Channel-1]; ++ else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) ++ pwr_diff = pHalData->TxPwrHt20Diff[rf][Channel-1]; ++ ++ //RTPRINT(FPHY, PHY_TXPWR, ("power diff rf(%c) = 0x%x\n", ((rf==0)?'A':'B'), pwr_diff)); ++ ++ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) ++ customer_pwr_limit = pHalData->PwrGroupHT40[rf][Channel-1]; ++ else ++ customer_pwr_limit = pHalData->PwrGroupHT20[rf][Channel-1]; ++ ++ //RTPRINT(FPHY, PHY_TXPWR, ("customer pwr limit rf(%c) = 0x%x\n", ((rf==0)?'A':'B'), customer_pwr_limit)); ++ ++ if(pwr_diff >= customer_pwr_limit) ++ pwr_diff = 0; ++ else ++ pwr_diff = customer_pwr_limit - pwr_diff; ++ ++ for (i=0; i<4; i++) ++ { ++ pwr_diff_limit[i] = (u1Byte)((pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)]&(0x7f<<(i*8)))>>(i*8)); ++ ++ if(pwr_diff_limit[i] > pwr_diff) ++ pwr_diff_limit[i] = pwr_diff; ++ } ++ customer_limit = (pwr_diff_limit[3]<<24) | (pwr_diff_limit[2]<<16) | ++ (pwr_diff_limit[1]<<8) | (pwr_diff_limit[0]); ++ //RTPRINT(FPHY, PHY_TXPWR, ("Customer's limit rf(%c) = 0x%x\n", ((rf==0)?'A':'B'), customer_limit)); ++ writeVal = customer_limit + ((index<2)?powerBase0[rf]:powerBase1[rf]); ++ //RTPRINT(FPHY, PHY_TXPWR, ("Customer, writeVal rf(%c)= 0x%x\n", ((rf==0)?'A':'B'), writeVal)); ++ break; ++ default: ++ chnlGroup = 0; ++ writeVal = pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)] + ++ ((index<2)?powerBase0[rf]:powerBase1[rf]); ++ //RTPRINT(FPHY, PHY_TXPWR, ("RTK better performance, writeVal rf(%c) = 0x%x\n", ((rf==0)?'A':'B'), writeVal)); ++ break; ++ } ++ ++// 20100427 Joseph: Driver dynamic Tx power shall not affect Tx power. It shall be determined by power training mechanism. ++// Currently, we cannot fully disable driver dynamic tx power mechanism because it is referenced by BT coexist mechanism. ++// In the future, two mechanism shall be separated from each other and maintained independantly. Thanks for Lanhsin's reminder. ++ //92d do not need this ++ if(pdmpriv->DynamicTxHighPowerLvl == TxHighPwrLevel_Level1) ++ writeVal = 0x14141414; ++ else if(pdmpriv->DynamicTxHighPowerLvl == TxHighPwrLevel_Level2) ++ writeVal = 0x00000000; ++ ++ // 20100628 Joseph: High power mode for BT-Coexist mechanism. ++ // This mechanism is only applied when Driver-Highpower-Mechanism is OFF. ++ if(pdmpriv->DynamicTxHighPowerLvl == TxHighPwrLevel_BT1) ++ { ++ //RTPRINT(FBT, BT_TRACE, ("Tx Power (-6)\n")); ++ writeVal = writeVal - 0x06060606; ++ } ++ else if(pdmpriv->DynamicTxHighPowerLvl == TxHighPwrLevel_BT2) ++ { ++ //RTPRINT(FBT, BT_TRACE, ("Tx Power (-0)\n")); ++ writeVal = writeVal ; ++ } ++ /* ++ if(pMgntInfo->bDisableTXPowerByRate) ++ { ++ // add for OID_RT_11N_TX_POWER_BY_RATE ,disable tx powre change by rate ++ writeVal = 0x2c2c2c2c; ++ } ++ */ ++ *(pOutWriteVal+rf) = writeVal; ++ } ++} ++ ++static void writeOFDMPowerReg8812( ++ PADAPTER Adapter, ++ u8 index, ++ u32* pValue ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ u2Byte RegOffset_A[6] = { ++ rTxAGC_A_Ofdm18_Ofdm6_JAguar, ++ rTxAGC_A_Ofdm54_Ofdm24_JAguar, ++ rTxAGC_A_MCS3_MCS0_JAguar, ++ rTxAGC_A_MCS7_MCS4_JAguar, ++ rTxAGC_A_MCS11_MCS8_JAguar, ++ rTxAGC_A_MCS15_MCS12_JAguar ++ }; ++ u2Byte RegOffset_B[6] = { ++ rTxAGC_B_Ofdm18_Ofdm6_JAguar, ++ rTxAGC_B_Ofdm54_Ofdm24_JAguar, ++ rTxAGC_B_MCS3_MCS0_JAguar, ++ rTxAGC_B_MCS7_MCS4_JAguar, ++ rTxAGC_B_MCS11_MCS8_JAguar, ++ rTxAGC_B_MCS15_MCS12_JAguar ++ }; ++ ++ u8 i, rf, pwr_val[4]; ++ u32 writeVal; ++ u16 RegOffset; ++ ++ for(rf=0; rf<2; rf++) ++ { ++ writeVal = pValue[rf]; ++ for(i=0; i>(i*8)); ++ if (pwr_val[i] > RF6052_MAX_TX_PWR) ++ pwr_val[i] = RF6052_MAX_TX_PWR; ++ } ++ writeVal = (pwr_val[3]<<24) | (pwr_val[2]<<16) |(pwr_val[1]<<8) |pwr_val[0]; ++ ++ if(rf == 0) ++ RegOffset = RegOffset_A[index]; ++ else ++ RegOffset = RegOffset_B[index]; ++ PHY_SetBBReg(Adapter, RegOffset, bMaskDWord, writeVal); ++ //RTPRINT(FPHY, PHY_TXPWR, ("Set 0x%x = %08x\n", RegOffset, writeVal)); ++ } ++} ++ ++void ++PHY_RF6052SetCckTxPower8812( ++ PADAPTER Adapter, ++ u8* pPowerlevel) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; ++ u32 TxAGC[2]={0, 0}, tmpval=0; ++ bool TurboScanOff = false; ++ u8 idx1, idx2; ++ u8* ptr; ++ ++ //FOR CE ,must disable turbo scan ++ TurboScanOff = true; ++ ++ if(pmlmeext->sitesurvey_res.state == SCAN_PROCESS) ++ { ++ TxAGC[RF_PATH_A] = 0x3f3f3f3f; ++ TxAGC[RF_PATH_B] = 0x3f3f3f3f; ++ ++ TurboScanOff = true;//disable turbo scan ++ ++ if(TurboScanOff) ++ { ++ for(idx1=RF_PATH_A; idx1<=RF_PATH_B; idx1++) ++ { ++ TxAGC[idx1] = ++ pPowerlevel[idx1] | (pPowerlevel[idx1]<<8) | ++ (pPowerlevel[idx1]<<16) | (pPowerlevel[idx1]<<24); ++ // 2010/10/18 MH For external PA module. We need to limit power index to be less than 0x20. ++ if (TxAGC[idx1] > 0x20 && pHalData->ExternalPA_5G) ++ TxAGC[idx1] = 0x20; ++ } ++ } ++ } ++ else ++ { ++// 20100427 Joseph: Driver dynamic Tx power shall not affect Tx power. It shall be determined by power training mechanism. ++// Currently, we cannot fully disable driver dynamic tx power mechanism because it is referenced by BT coexist mechanism. ++// In the future, two mechanism shall be separated from each other and maintained independantly. Thanks for Lanhsin's reminder. ++ if(pdmpriv->DynamicTxHighPowerLvl == TxHighPwrLevel_Level1) ++ { ++ TxAGC[RF_PATH_A] = 0x10101010; ++ TxAGC[RF_PATH_B] = 0x10101010; ++ } ++ else if(pdmpriv->DynamicTxHighPowerLvl == TxHighPwrLevel_Level2) ++ { ++ TxAGC[RF_PATH_A] = 0x00000000; ++ TxAGC[RF_PATH_B] = 0x00000000; ++ } ++ else ++ { ++ for(idx1=RF_PATH_A; idx1<=RF_PATH_B; idx1++) ++ { ++ TxAGC[idx1] = ++ pPowerlevel[idx1] | (pPowerlevel[idx1]<<8) | ++ (pPowerlevel[idx1]<<16) | (pPowerlevel[idx1]<<24); ++ } ++ ++ if(pHalData->EEPROMRegulatory==0) ++ { ++ tmpval = (pHalData->MCSTxPowerLevelOriginalOffset[0][6]) + ++ (pHalData->MCSTxPowerLevelOriginalOffset[0][7]<<8); ++ TxAGC[RF_PATH_A] += tmpval; ++ ++ tmpval = (pHalData->MCSTxPowerLevelOriginalOffset[0][14]) + ++ (pHalData->MCSTxPowerLevelOriginalOffset[0][15]<<24); ++ TxAGC[RF_PATH_B] += tmpval; ++ } ++ } ++ } ++ ++ for(idx1=RF_PATH_A; idx1<=RF_PATH_B; idx1++) ++ { ++ ptr = (u8*)(&(TxAGC[idx1])); ++ for(idx2=0; idx2<4; idx2++) ++ { ++ if(*ptr > RF6052_MAX_TX_PWR) ++ *ptr = RF6052_MAX_TX_PWR; ++ ptr++; ++ } ++ } ++ ++ // rf-A cck tx power ++ tmpval = TxAGC[RF_PATH_A]&0xff; ++ PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte1, tmpval); ++ //RT_DISP(FPHY, PHY_TXPWR, ("CCK PWR 1M (rf-A) = 0x%x (reg 0x%x)\n", tmpval, rTxAGC_A_CCK1_Mcs32)); ++ tmpval = TxAGC[RF_PATH_A]>>8; ++ PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, 0xffffff00, tmpval); ++ //RT_DISP(FPHY, PHY_TXPWR, ("CCK PWR 2~11M (rf-A) = 0x%x (reg 0x%x)\n", tmpval, rTxAGC_B_CCK11_A_CCK2_11)); ++ ++ // rf-B cck tx power ++ tmpval = TxAGC[RF_PATH_B]>>24; ++ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte0, tmpval); ++ //RT_DISP(FPHY, PHY_TXPWR, ("CCK PWR 11M (rf-B) = 0x%x (reg 0x%x)\n", tmpval, rTxAGC_B_CCK11_A_CCK2_11)); ++ tmpval = TxAGC[RF_PATH_B]&0x00ffffff; ++ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, 0xffffff00, tmpval); ++ //RT_DISP(FPHY, PHY_TXPWR, ("CCK PWR 1~5.5M (rf-B) = 0x%x (reg 0x%x)\n", tmpval, rTxAGC_B_CCK1_55_Mcs32)); ++ ++} /* PHY_RF6052SetCckTxPower */ ++ ++void ++PHY_RF6052SetOFDMTxPower8812( ++ PADAPTER Adapter, ++ u8* pPowerLevelOFDM, ++ u8* pPowerLevelBW20, ++ u8* pPowerLevelBW40, ++ u8 Channel) ++{ ++ u32 writeVal[2], powerBase0[2], powerBase1[2], pwrtrac_value; ++ u8 index = 0; ++ ++ ++ //DBG_871X("PHY_RF6052SetOFDMTxPower, channel(%d) \n", Channel); ++ ++ getPowerBase8812(Adapter, pPowerLevelOFDM,pPowerLevelBW20,pPowerLevelBW40, Channel, &powerBase0[0], &powerBase1[0]); ++ ++ for(index=0; index<6; index++) ++ { ++ getTxPowerWriteValByRegulatory8812(Adapter, Channel, index, ++ &powerBase0[0], &powerBase1[0], &writeVal[0]); ++ ++ writeOFDMPowerReg8812(Adapter, index, &writeVal[0]); ++ } ++} ++ ++static int ++phy_RF6052_Config_ParaFile_8812( ++ PADAPTER Adapter ++ ) ++{ ++ u8 eRFPath; ++ int rtStatus = _SUCCESS; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ static char sz8812RadioAFile[] = RTL8812_PHY_RADIO_A; ++ static char sz8812RadioBFile[] = RTL8812_PHY_RADIO_B; ++ static char sz8812TxPwrTrack[] = RTL8812_TXPWR_TRACK; ++ static char sz8821RadioAFile[] = RTL8821_PHY_RADIO_A; ++ static char sz8821RadioBFile[] = RTL8821_PHY_RADIO_B; ++ static char sz8821TxPwrTrack[] = RTL8821_TXPWR_TRACK; ++ char *pszRadioAFile = NULL, *pszRadioBFile = NULL, *pszTxPwrTrack = NULL; ++ ++ ++ if(IS_HARDWARE_TYPE_8812(Adapter)) ++ { ++ pszRadioAFile = sz8812RadioAFile; ++ pszRadioBFile = sz8812RadioBFile; ++ pszTxPwrTrack = sz8812TxPwrTrack; ++ } ++ else ++ { ++ pszRadioAFile = sz8821RadioAFile; ++ pszRadioBFile = sz8821RadioBFile; ++ pszTxPwrTrack = sz8821TxPwrTrack; ++ } ++ ++ ++ //3//----------------------------------------------------------------- ++ //3// <2> Initialize RF ++ //3//----------------------------------------------------------------- ++ //for(eRFPath = RF_PATH_A; eRFPath NumTotalRFPath; eRFPath++) ++ for(eRFPath = 0; eRFPath NumTotalRFPath; eRFPath++) ++ { ++ /*----Initialize RF fom connfiguration file----*/ ++ switch(eRFPath) ++ { ++ case RF_PATH_A: ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if(HAL_STATUS_FAILURE ==ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv,CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) ++ rtStatus= _FAIL; ++#else ++ rtStatus = PHY_ConfigRFWithParaFile(Adapter, pszRadioAFile, eRFPath); ++#endif//#ifdef CONFIG_EMBEDDED_FWIMG ++ break; ++ case RF_PATH_B: ++#ifdef CONFIG_EMBEDDED_FWIMG ++ if(HAL_STATUS_FAILURE ==ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv,CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) ++ rtStatus= _FAIL; ++#else ++ rtStatus =PHY_ConfigRFWithParaFile(Adapter, pszRadioBFile, eRFPath); ++#endif ++ break; ++ default: ++ break; ++ } ++ ++ if(rtStatus != _SUCCESS){ ++ DBG_871X("%s():Radio[%d] Fail!!", __FUNCTION__, eRFPath); ++ goto phy_RF6052_Config_ParaFile_Fail; ++ } ++ ++ } ++ ++ //3 ----------------------------------------------------------------- ++ //3 Configuration of Tx Power Tracking ++ //3 ----------------------------------------------------------------- ++ ++#ifdef CONFIG_EMBEDDED_FWIMG ++ ODM_ConfigRFWithTxPwrTrackHeaderFile(&pHalData->odmpriv); ++#else ++ PHY_ConfigRFWithTxPwrTrackParaFile(Adapter, pszTxPwrTrack); ++#endif ++ ++ //RT_TRACE(COMP_INIT, DBG_LOUD, ("<---phy_RF6052_Config_ParaFile_8812()\n")); ++ ++phy_RF6052_Config_ParaFile_Fail: ++ return rtStatus; ++} ++ ++ ++int ++PHY_RF6052_Config_8812( ++ PADAPTER Adapter) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ int rtStatus = _SUCCESS; ++ ++ // Initialize general global value ++ if(pHalData->rf_type == RF_1T1R) ++ pHalData->NumTotalRFPath = 1; ++ else ++ pHalData->NumTotalRFPath = 2; ++ ++ // ++ // Config BB and RF ++ // ++ rtStatus = phy_RF6052_Config_ParaFile_8812(Adapter); ++ ++ return rtStatus; ++ ++} ++ ++ ++/* End of HalRf6052.c */ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_rxdesc.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_rxdesc.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_rxdesc.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_rxdesc.c 2018-02-06 17:42:30.715967238 +0200 +@@ -0,0 +1,300 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#define _RTL8812A_RXDESC_C_ @@ -280772,6 +123242,159 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_rxdesc.c linux/3rd +//#include +#include + ++static s32 translate2dbm(u8 signal_strength_idx) ++{ ++ s32 signal_power; // in dBm. ++ ++ ++ // Translate to dBm (x=0.5y-95). ++ signal_power = (s32)((signal_strength_idx + 1) >> 1); ++ signal_power -= 95; ++ ++ return signal_power; ++} ++ ++ ++static void process_rssi(_adapter *padapter,union recv_frame *prframe) ++{ ++ u32 last_rssi, tmp_val; ++ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ struct signal_stat * signal_stat = &padapter->recvpriv.signal_strength_data; ++#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS ++ ++ //DBG_8192C("process_rssi=> pattrib->rssil(%d) signal_strength(%d)\n ",pattrib->RecvSignalPower,pattrib->signal_strength); ++ //if(pRfd->Status.bPacketToSelf || pRfd->Status.bPacketBeacon) ++ { ++ ++ #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ if(signal_stat->update_req) { ++ signal_stat->total_num = 0; ++ signal_stat->total_val = 0; ++ signal_stat->update_req = 0; ++ } ++ ++ signal_stat->total_num++; ++ signal_stat->total_val += pattrib->phy_info.SignalStrength; ++ signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; ++ #else //CONFIG_NEW_SIGNAL_STAT_PROCESS ++ ++ //Adapter->RxStats.RssiCalculateCnt++; //For antenna Test ++ if(padapter->recvpriv.signal_strength_data.total_num++ >= PHY_RSSI_SLID_WIN_MAX) ++ { ++ padapter->recvpriv.signal_strength_data.total_num = PHY_RSSI_SLID_WIN_MAX; ++ last_rssi = padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index]; ++ padapter->recvpriv.signal_strength_data.total_val -= last_rssi; ++ } ++ padapter->recvpriv.signal_strength_data.total_val +=pattrib->phy_info.SignalStrength; ++ ++ padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index++] = pattrib->phy_info.SignalStrength; ++ if(padapter->recvpriv.signal_strength_data.index >= PHY_RSSI_SLID_WIN_MAX) ++ padapter->recvpriv.signal_strength_data.index = 0; ++ ++ ++ tmp_val = padapter->recvpriv.signal_strength_data.total_val/padapter->recvpriv.signal_strength_data.total_num; ++ ++ if(padapter->recvpriv.is_signal_dbg) { ++ padapter->recvpriv.signal_strength= padapter->recvpriv.signal_strength_dbg; ++ padapter->recvpriv.rssi=(s8)translate2dbm((u8)padapter->recvpriv.signal_strength_dbg); ++ } else { ++ padapter->recvpriv.signal_strength= tmp_val; ++ padapter->recvpriv.rssi=(s8)translate2dbm((u8)tmp_val); ++ } ++ ++ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("UI RSSI = %d, ui_rssi.TotalVal = %d, ui_rssi.TotalNum = %d\n", tmp_val, padapter->recvpriv.signal_strength_data.total_val,padapter->recvpriv.signal_strength_data.total_num)); ++ #endif //CONFIG_NEW_SIGNAL_STAT_PROCESS ++ } ++ ++}// Process_UI_RSSI_8192C ++ ++ ++ ++static void process_link_qual(_adapter *padapter,union recv_frame *prframe) ++{ ++ u32 last_evm=0, tmpVal; ++ struct rx_pkt_attrib *pattrib; ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ struct signal_stat * signal_stat; ++#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS ++ ++ if(prframe == NULL || padapter==NULL){ ++ return; ++ } ++ ++ pattrib = &prframe->u.hdr.attrib; ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ signal_stat = &padapter->recvpriv.signal_qual_data; ++#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS ++ ++ //DBG_8192C("process_link_qual=> pattrib->signal_qual(%d)\n ",pattrib->signal_qual); ++ ++#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS ++ if(signal_stat->update_req) { ++ signal_stat->total_num = 0; ++ signal_stat->total_val = 0; ++ signal_stat->update_req = 0; ++ } ++ ++ signal_stat->total_num++; ++ signal_stat->total_val += pattrib->phy_info.SignalQuality; ++ signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; ++ ++#else //CONFIG_NEW_SIGNAL_STAT_PROCESS ++ if(pattrib->phy_info.SignalQuality != 0) ++ { ++ // ++ // 1. Record the general EVM to the sliding window. ++ // ++ if(padapter->recvpriv.signal_qual_data.total_num++ >= PHY_LINKQUALITY_SLID_WIN_MAX) ++ { ++ padapter->recvpriv.signal_qual_data.total_num = PHY_LINKQUALITY_SLID_WIN_MAX; ++ last_evm = padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index]; ++ padapter->recvpriv.signal_qual_data.total_val -= last_evm; ++ } ++ padapter->recvpriv.signal_qual_data.total_val += pattrib->phy_info.SignalQuality; ++ ++ padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = pattrib->phy_info.SignalQuality; ++ if(padapter->recvpriv.signal_qual_data.index >= PHY_LINKQUALITY_SLID_WIN_MAX) ++ padapter->recvpriv.signal_qual_data.index = 0; ++ ++ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("Total SQ=%d pattrib->signal_qual= %d\n", padapter->recvpriv.signal_qual_data.total_val, pattrib->phy_info.SignalQuality)); ++ ++ // <1> Showed on UI for user, in percentage. ++ tmpVal = padapter->recvpriv.signal_qual_data.total_val/padapter->recvpriv.signal_qual_data.total_num; ++ padapter->recvpriv.signal_qual=(u8)tmpVal; ++ ++ } ++ else ++ { ++ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,(" pattrib->signal_qual =%d\n", pattrib->phy_info.SignalQuality)); ++ } ++#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS ++ ++} ++ ++static void process_phy_info(_adapter *padapter, void *prframe) ++{ ++ union recv_frame *precvframe = (union recv_frame *)prframe; ++ ++ // ++ // Check RSSI ++ // ++ process_rssi(padapter, precvframe); ++ // ++ // Check PWDB. ++ // ++ //process_PWDB(padapter, precvframe); ++ ++ //UpdateRxSignalStatistics8192C(Adapter, pRfd); ++ // ++ // Check EVM ++ // ++ process_link_qual(padapter, precvframe); ++ ++} ++ +void rtl8812_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc) +{ + struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; @@ -280806,138 +123429,104 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_rxdesc.c linux/3rd + //Offset 12 + pattrib->data_rate=(u8)GET_RX_STATUS_DESC_RX_RATE_8812(pdesc);//((le32_to_cpu(pdesc->rxdw3))&0x7f); + -+ /* Offset 16 */ -+ pattrib->sgi = (u8)GET_RX_STATUS_DESC_SPLCP_8812(pdesc); -+ pattrib->ldpc = (u8)GET_RX_STATUS_DESC_LDPC_8812(pdesc); -+ pattrib->stbc = (u8)GET_RX_STATUS_DESC_STBC_8812(pdesc); -+ pattrib->bw = (u8)GET_RX_STATUS_DESC_BW_8812(pdesc); ++ //Offset 16 ++ //Offset 20 + -+ /* Offset 20 */ -+ /* pattrib->tsfl=(u8)GET_RX_STATUS_DESC_TSFL_8812(pdesc); */ +} + -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_sreset.c linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_sreset.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_sreset.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_sreset.c 2017-06-07 23:07:21.033689581 +0300 -@@ -0,0 +1,114 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTL8812A_SRESET_C_ -+ -+//#include -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+void rtl8812_sreset_xmit_status_check(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ unsigned long current_time; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ unsigned int diff_time; -+ u32 txdma_status; -+ -+ if( (txdma_status=rtw_read32(padapter, REG_TXDMA_STATUS)) !=0x00){ -+ DBG_871X("%s REG_TXDMA_STATUS:0x%08x\n", __FUNCTION__, txdma_status); -+ rtw_hal_sreset_reset(padapter); -+ } -+#ifdef CONFIG_USB_HCI -+ //total xmit irp = 4 -+ //DBG_8192C("==>%s free_xmitbuf_cnt(%d),txirp_cnt(%d)\n",__FUNCTION__,pxmitpriv->free_xmitbuf_cnt,pxmitpriv->txirp_cnt); -+ //if(pxmitpriv->txirp_cnt == NR_XMITBUFF+1) -+ current_time = rtw_get_current_time(); -+ -+ if (0 == pxmitpriv->free_xmitbuf_cnt || 0 == pxmitpriv->free_xmit_extbuf_cnt) { -+ -+ diff_time = rtw_get_passing_time_ms(psrtpriv->last_tx_time); -+ -+ if (diff_time > 2000) { -+ if (psrtpriv->last_tx_complete_time == 0) { -+ psrtpriv->last_tx_complete_time = current_time; -+ } -+ else{ -+ diff_time = rtw_get_passing_time_ms(psrtpriv->last_tx_complete_time); -+ if (diff_time > 4000) { -+ u32 ability = 0; -+ -+ //padapter->Wifi_Error_Status = WIFI_TX_HANG; -+ ability = rtw_phydm_ability_get(padapter); -+ -+ DBG_871X("%s tx hang %s\n", __FUNCTION__, -+ (ability & ODM_BB_ADAPTIVITY)? "ODM_BB_ADAPTIVITY" : ""); -+ -+ if (!(ability & ODM_BB_ADAPTIVITY)) -+ rtw_hal_sreset_reset(padapter); -+ } -+ } -+ } -+ } -+#endif //CONFIG_USB_HCI -+ -+ if (psrtpriv->dbg_trigger_point == SRESET_TGP_XMIT_STATUS) { -+ psrtpriv->dbg_trigger_point = SRESET_TGP_NULL; -+ rtw_hal_sreset_reset(padapter); -+ return; -+ } -+} -+ -+void rtl8812_sreset_linked_status_check(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ u32 rx_dma_status = 0; -+ rx_dma_status = rtw_read32(padapter,REG_RXDMA_STATUS); -+ if(rx_dma_status!= 0x00){ -+ DBG_8192C("%s REG_RXDMA_STATUS:0x%08x\n",__FUNCTION__,rx_dma_status); -+ } -+#if 0 -+ u32 regc50,regc58,reg824,reg800; -+ regc50 = rtw_read32(padapter,0xc50); -+ regc58 = rtw_read32(padapter,0xc58); -+ reg824 = rtw_read32(padapter,0x824); -+ reg800 = rtw_read32(padapter,0x800); -+ if( ((regc50&0xFFFFFF00)!= 0x69543400)|| -+ ((regc58&0xFFFFFF00)!= 0x69543400)|| -+ (((reg824&0xFFFFFF00)!= 0x00390000)&&(((reg824&0xFFFFFF00)!= 0x80390000)))|| -+ ( ((reg800&0xFFFFFF00)!= 0x03040000)&&((reg800&0xFFFFFF00)!= 0x83040000))) -+ { -+ DBG_8192C("%s regc50:0x%08x, regc58:0x%08x, reg824:0x%08x, reg800:0x%08x,\n", __FUNCTION__, -+ regc50, regc58, reg824, reg800); -+ rtw_hal_sreset_reset(padapter); -+ } -+#endif -+ -+ if (psrtpriv->dbg_trigger_point == SRESET_TGP_LINK_STATUS) { -+ psrtpriv->dbg_trigger_point = SRESET_TGP_NULL; -+ rtw_hal_sreset_reset(padapter); -+ return; -+ } -+} -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_xmit.c linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_xmit.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_xmit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_xmit.c 2017-06-07 23:07:21.033689581 +0300 -@@ -0,0 +1,552 @@ ++ ++/* ++ * Notice: ++ * Before calling this function, ++ * precvframe->u.hdr.rx_data should be ready! ++ */ ++void rtl8812_query_rx_phy_status( ++ union recv_frame *precvframe, ++ u8 *pphy_status) ++{ ++ PADAPTER padapter = precvframe->u.hdr.adapter; ++ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ PODM_PHY_INFO_T pPHYInfo = (PODM_PHY_INFO_T)(&pattrib->phy_info); ++ u8 *wlanhdr; ++ ODM_PACKET_INFO_T pkt_info; ++ u8 *sa; ++ struct sta_priv *pstapriv; ++ struct sta_info *psta; ++ //_irqL irqL; ++ ++ pkt_info.bPacketMatchBSSID =false; ++ pkt_info.bPacketToSelf = false; ++ pkt_info.bPacketBeacon = false; ++ ++ wlanhdr = get_recvframe_data(precvframe); ++ ++ pkt_info.bPacketMatchBSSID = ((!IsFrameTypeCtrl(wlanhdr)) && ++ !pattrib->icv_err && !pattrib->crc_err && ++ _rtw_memcmp(get_hdr_bssid(wlanhdr), get_bssid(&padapter->mlmepriv), ETH_ALEN)); ++ ++ pkt_info.bPacketToSelf = pkt_info.bPacketMatchBSSID && (_rtw_memcmp(get_da(wlanhdr), myid(&padapter->eeprompriv), ETH_ALEN)); ++ ++ pkt_info.bPacketBeacon = pkt_info.bPacketMatchBSSID && (GetFrameSubType(wlanhdr) == WIFI_BEACON); ++ ++ if(pkt_info.bPacketBeacon){ ++ if(check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) == true){ ++ sa = padapter->mlmepriv.cur_network.network.MacAddress; ++ #if 0 ++ { ++ DBG_8192C("==> rx beacon from AP[%02x:%02x:%02x:%02x:%02x:%02x]\n", ++ sa[0],sa[1],sa[2],sa[3],sa[4],sa[5]); ++ } ++ #endif ++ } ++ //to do Ad-hoc ++ } ++ else{ ++ sa = get_sa(wlanhdr); ++ } ++ ++ pstapriv = &padapter->stapriv; ++ pkt_info.StationID = 0xFF; ++ psta = rtw_get_stainfo(pstapriv, sa); ++ if (psta) ++ { ++ pkt_info.StationID = psta->mac_id; ++ //DBG_8192C("%s ==> StationID(%d)\n",__FUNCTION__,pkt_info.StationID); ++ } ++ pkt_info.DataRate = pattrib->data_rate; ++ //rtl8188e_query_rx_phy_status(precvframe, pphy_status); ++ ++ //_enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); ++ ODM_PhyStatusQuery(&pHalData->odmpriv,pPHYInfo,pphy_status,&(pkt_info)); ++ //_exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); ++ ++ precvframe->u.hdr.psta = NULL; ++ if (pkt_info.bPacketMatchBSSID && ++ (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == true)) ++ { ++ if (psta) ++ { ++ precvframe->u.hdr.psta = psta; ++ process_phy_info(padapter, precvframe); ++ ++ } ++ } ++ else if (pkt_info.bPacketToSelf || pkt_info.bPacketBeacon) ++ { ++ if (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE) == true) ++ { ++ if (psta) ++ { ++ precvframe->u.hdr.psta = psta; ++ } ++ } ++ process_phy_info(padapter, precvframe); ++ } ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_sreset.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_sreset.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_sreset.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_sreset.c 2018-02-06 17:42:30.715967238 +0200 +@@ -0,0 +1,94 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -280951,553 +123540,95 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/rtl8812a_xmit.c linux/3rdpa + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ -+#define _RTL8812A_XMIT_C_ ++#define _RTL8812A_SRESET_C_ + +//#include +#include + -+void _dbg_dump_tx_info(_adapter *padapter,int frame_tag, u8 *ptxdesc) ++#ifdef DBG_CONFIG_ERROR_DETECT ++void rtl8812_sreset_xmit_status_check(_adapter *padapter) +{ -+ u8 bDumpTxPkt; -+ u8 bDumpTxDesc = _FALSE; -+ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DUMP_TXPKT, &(bDumpTxPkt)); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; + -+ if(bDumpTxPkt ==1){//dump txdesc for data frame -+ DBG_871X("dump tx_desc for data frame\n"); -+ if((frame_tag&0x0f) == DATA_FRAMETAG){ -+ bDumpTxDesc = _TRUE; -+ } -+ } -+ else if(bDumpTxPkt ==2){//dump txdesc for mgnt frame -+ DBG_871X("dump tx_desc for mgnt frame\n"); -+ if((frame_tag&0x0f) == MGNT_FRAMETAG){ -+ bDumpTxDesc = _TRUE; -+ } -+ } -+ else if(bDumpTxPkt ==3){//dump early info ++ unsigned long current_time; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ unsigned int diff_time; ++ u32 txdma_status; ++ ++ if( (txdma_status=rtw_read32(padapter, REG_TXDMA_STATUS)) !=0x00){ ++ DBG_871X("%s REG_TXDMA_STATUS:0x%08x\n", __FUNCTION__, txdma_status); ++ rtw_hal_sreset_reset(padapter); + } -+ -+ if(bDumpTxDesc){ -+ // ptxdesc->txdw4 = cpu_to_le32(0x00001006);//RTS Rate=24M -+ // ptxdesc->txdw6 = 0x6666f800; -+ DBG_8192C("=====================================\n"); -+ DBG_8192C("Offset00(0x%08x)\n",*((u32 *)(ptxdesc))); -+ DBG_8192C("Offset04(0x%08x)\n",*((u32 *)(ptxdesc+4))); -+ DBG_8192C("Offset08(0x%08x)\n",*((u32 *)(ptxdesc+8))); -+ DBG_8192C("Offset12(0x%08x)\n",*((u32 *)(ptxdesc+12))); -+ DBG_8192C("Offset16(0x%08x)\n",*((u32 *)(ptxdesc+16))); -+ DBG_8192C("Offset20(0x%08x)\n",*((u32 *)(ptxdesc+20))); -+ DBG_8192C("Offset24(0x%08x)\n",*((u32 *)(ptxdesc+24))); -+ DBG_8192C("Offset28(0x%08x)\n",*((u32 *)(ptxdesc+28))); -+ DBG_8192C("Offset32(0x%08x)\n",*((u32 *)(ptxdesc+32))); -+ DBG_8192C("Offset36(0x%08x)\n",*((u32 *)(ptxdesc+36))); -+ DBG_8192C("=====================================\n"); ++ current_time = rtw_get_current_time(); ++ ++ if (0 == pxmitpriv->free_xmitbuf_cnt || 0 == pxmitpriv->free_xmit_extbuf_cnt) { ++ ++ diff_time = rtw_get_passing_time_ms(psrtpriv->last_tx_time); ++ ++ if (diff_time > 2000) { ++ if (psrtpriv->last_tx_complete_time == 0) { ++ psrtpriv->last_tx_complete_time = current_time; ++ } else { ++ diff_time = rtw_get_passing_time_ms(psrtpriv->last_tx_complete_time); ++ if (diff_time > 4000) { ++ DBG_871X("%s tx hang\n", __FUNCTION__); ++ rtw_hal_sreset_reset(padapter); ++ } ++ } ++ } + } + -+} -+ -+/* -+ * Description: -+ * Aggregation packets and send to hardware -+ * -+ * Return: -+ * 0 Success -+ * -1 Hardware resource(TX FIFO) not ready -+ * -2 Software resource(xmitbuf) not ready -+ */ -+#ifdef CONFIG_TX_EARLY_MODE -+ -+//#define DBG_EMINFO -+ -+#if RTL8188E_EARLY_MODE_PKT_NUM_10 == 1 -+ #define EARLY_MODE_MAX_PKT_NUM 10 -+#else -+ #define EARLY_MODE_MAX_PKT_NUM 5 -+#endif -+ -+ -+struct EMInfo{ -+ u8 EMPktNum; -+ u16 EMPktLen[EARLY_MODE_MAX_PKT_NUM]; -+}; -+ -+ -+void -+InsertEMContent_8812( -+ struct EMInfo *pEMInfo, -+ IN pu1Byte VirtualAddress) -+{ -+ -+#if RTL8188E_EARLY_MODE_PKT_NUM_10 == 1 -+ u1Byte index=0; -+ u4Byte dwtmp=0; -+#endif -+ -+ _rtw_memset(VirtualAddress, 0, EARLY_MODE_INFO_SIZE); -+ if(pEMInfo->EMPktNum==0) ++ if (psrtpriv->dbg_trigger_point == SRESET_TGP_XMIT_STATUS) { ++ psrtpriv->dbg_trigger_point = SRESET_TGP_NULL; ++ rtw_hal_sreset_reset(padapter); + return; -+ -+ #ifdef DBG_EMINFO -+ { -+ int i; -+ DBG_8192C("\n%s ==> pEMInfo->EMPktNum =%d\n",__FUNCTION__,pEMInfo->EMPktNum); -+ for(i=0;i< EARLY_MODE_MAX_PKT_NUM;i++){ -+ DBG_8192C("%s ==> pEMInfo->EMPktLen[%d] =%d\n",__FUNCTION__,i,pEMInfo->EMPktLen[i]); -+ } -+ + } -+ #endif -+ -+#if RTL8188E_EARLY_MODE_PKT_NUM_10 == 1 -+ SET_EARLYMODE_PKTNUM(VirtualAddress, pEMInfo->EMPktNum); -+ -+ if(pEMInfo->EMPktNum == 1){ -+ dwtmp = pEMInfo->EMPktLen[0]; -+ }else{ -+ dwtmp = pEMInfo->EMPktLen[0]; -+ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; -+ dwtmp += pEMInfo->EMPktLen[1]; -+ } -+ SET_EARLYMODE_LEN0(VirtualAddress, dwtmp); -+ if(pEMInfo->EMPktNum <= 3){ -+ dwtmp = pEMInfo->EMPktLen[2]; -+ }else{ -+ dwtmp = pEMInfo->EMPktLen[2]; -+ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; -+ dwtmp += pEMInfo->EMPktLen[3]; -+ } -+ SET_EARLYMODE_LEN1(VirtualAddress, dwtmp); -+ if(pEMInfo->EMPktNum <= 5){ -+ dwtmp = pEMInfo->EMPktLen[4]; -+ }else{ -+ dwtmp = pEMInfo->EMPktLen[4]; -+ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; -+ dwtmp += pEMInfo->EMPktLen[5]; -+ } -+ SET_EARLYMODE_LEN2_1(VirtualAddress, dwtmp&0xF); -+ SET_EARLYMODE_LEN2_2(VirtualAddress, dwtmp>>4); -+ if(pEMInfo->EMPktNum <= 7){ -+ dwtmp = pEMInfo->EMPktLen[6]; -+ }else{ -+ dwtmp = pEMInfo->EMPktLen[6]; -+ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; -+ dwtmp += pEMInfo->EMPktLen[7]; -+ } -+ SET_EARLYMODE_LEN3(VirtualAddress, dwtmp); -+ if(pEMInfo->EMPktNum <= 9){ -+ dwtmp = pEMInfo->EMPktLen[8]; -+ }else{ -+ dwtmp = pEMInfo->EMPktLen[8]; -+ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; -+ dwtmp += pEMInfo->EMPktLen[9]; -+ } -+ SET_EARLYMODE_LEN4(VirtualAddress, dwtmp); -+#else -+ SET_EARLYMODE_PKTNUM(VirtualAddress, pEMInfo->EMPktNum); -+ SET_EARLYMODE_LEN0(VirtualAddress, pEMInfo->EMPktLen[0]); -+ SET_EARLYMODE_LEN1(VirtualAddress, pEMInfo->EMPktLen[1]); -+ SET_EARLYMODE_LEN2_1(VirtualAddress, pEMInfo->EMPktLen[2]&0xF); -+ SET_EARLYMODE_LEN2_2(VirtualAddress, pEMInfo->EMPktLen[2]>>4); -+ SET_EARLYMODE_LEN3(VirtualAddress, pEMInfo->EMPktLen[3]); -+ SET_EARLYMODE_LEN4(VirtualAddress, pEMInfo->EMPktLen[4]); -+#endif -+ //RT_PRINT_DATA(COMP_SEND, DBG_LOUD, "EMHdr:", VirtualAddress, 8); -+ +} + -+ -+ -+void UpdateEarlyModeInfo8812(struct xmit_priv *pxmitpriv,struct xmit_buf *pxmitbuf ) ++void rtl8812_sreset_linked_status_check(_adapter *padapter) +{ -+ //_adapter *padapter, struct xmit_frame *pxmitframe,struct tx_servq *ptxservq -+ int index,j; -+ u16 offset,pktlen; -+ PTXDESC_8812 ptxdesc; -+ -+ u8 *pmem,*pEMInfo_mem; -+ s8 node_num_0=0,node_num_1=0; -+ struct EMInfo eminfo; -+ struct agg_pkt_info *paggpkt; -+ struct xmit_frame *pframe = (struct xmit_frame*)pxmitbuf->priv_data; -+ pmem= pframe->buf_addr; -+ -+ #ifdef DBG_EMINFO -+ DBG_8192C("\n%s ==> agg_num:%d\n",__FUNCTION__, pframe->agg_num); -+ for(index=0;indexagg_num;index++){ -+ offset = pxmitpriv->agg_pkt[index].offset; -+ pktlen = pxmitpriv->agg_pkt[index].pkt_len; -+ DBG_8192C("%s ==> agg_pkt[%d].offset=%d\n",__FUNCTION__,index,offset); -+ DBG_8192C("%s ==> agg_pkt[%d].pkt_len=%d\n",__FUNCTION__,index,pktlen); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct sreset_priv *psrtpriv = &pHalData->srestpriv; ++ ++ u32 rx_dma_status = 0; ++ rx_dma_status = rtw_read32(padapter,REG_RXDMA_STATUS); ++ if(rx_dma_status!= 0x00){ ++ DBG_8192C("%s REG_RXDMA_STATUS:0x%08x\n",__FUNCTION__,rx_dma_status); + } -+ #endif -+ -+ if( pframe->agg_num > EARLY_MODE_MAX_PKT_NUM) -+ { -+ node_num_0 = pframe->agg_num; -+ node_num_1= EARLY_MODE_MAX_PKT_NUM-1; ++#if 0 ++ u32 regc50,regc58,reg824,reg800; ++ regc50 = rtw_read32(padapter,0xc50); ++ regc58 = rtw_read32(padapter,0xc58); ++ reg824 = rtw_read32(padapter,0x824); ++ reg800 = rtw_read32(padapter,0x800); ++ if( ((regc50&0xFFFFFF00)!= 0x69543400)|| ++ ((regc58&0xFFFFFF00)!= 0x69543400)|| ++ (((reg824&0xFFFFFF00)!= 0x00390000)&&(((reg824&0xFFFFFF00)!= 0x80390000)))|| ++ ( ((reg800&0xFFFFFF00)!= 0x03040000)&&((reg800&0xFFFFFF00)!= 0x83040000))) ++ { ++ DBG_8192C("%s regc50:0x%08x, regc58:0x%08x, reg824:0x%08x, reg800:0x%08x,\n", __FUNCTION__, ++ regc50, regc58, reg824, reg800); ++ rtw_hal_sreset_reset(padapter); + } -+ -+ for(index=0;indexagg_num;index++){ -+ -+ offset = pxmitpriv->agg_pkt[index].offset; -+ pktlen = pxmitpriv->agg_pkt[index].pkt_len; -+ -+ _rtw_memset(&eminfo,0,sizeof(struct EMInfo)); -+ if( pframe->agg_num > EARLY_MODE_MAX_PKT_NUM){ -+ if(node_num_0 > EARLY_MODE_MAX_PKT_NUM){ -+ eminfo.EMPktNum = EARLY_MODE_MAX_PKT_NUM; -+ node_num_0--; -+ } -+ else{ -+ eminfo.EMPktNum = node_num_1; -+ node_num_1--; -+ } -+ } -+ else{ -+ eminfo.EMPktNum = pframe->agg_num-(index+1); -+ } -+ for(j=0;j< eminfo.EMPktNum ;j++){ -+ eminfo.EMPktLen[j] = pxmitpriv->agg_pkt[index+1+j].pkt_len+4;// 4 bytes CRC -+ } -+ -+ if(pmem){ -+ if(index==0){ -+ ptxdesc = (PTXDESC_8812)(pmem); -+ pEMInfo_mem = ((u8 *)ptxdesc)+TXDESC_SIZE; -+ } -+ else{ -+ pmem = pmem + pxmitpriv->agg_pkt[index-1].offset; -+ ptxdesc = (PTXDESC_8812)(pmem); -+ pEMInfo_mem = ((u8 *)ptxdesc)+TXDESC_SIZE; -+ } -+ -+ #ifdef DBG_EMINFO -+ DBG_8192C("%s ==> desc.pkt_len=%d\n",__FUNCTION__,ptxdesc->pktlen); -+ #endif -+ InsertEMContent_8812(&eminfo,pEMInfo_mem); -+ } -+ -+ -+ } -+ _rtw_memset(pxmitpriv->agg_pkt,0,sizeof(struct agg_pkt_info)*MAX_AGG_PKT_NUM); -+ -+} +#endif + -+void rtl8812a_cal_txdesc_chksum(u8 *ptxdesc) -+{ -+ u16 *usPtr; -+ u32 count; -+ u32 index; -+ u16 checksum = 0; -+ -+ -+ usPtr = (u16*)ptxdesc; -+ // checksume is always calculated by first 32 bytes, -+ // and it doesn't depend on TX DESC length. -+ // Thomas,Lucas@SD4,20130515 -+ count = 16; -+ -+ // Clear first -+ SET_TX_DESC_TX_DESC_CHECKSUM_8812(ptxdesc, 0); -+ -+ for(index = 0 ; index < count ; index++){ -+ checksum = checksum ^ le16_to_cpu(*(usPtr + index)); ++ if (psrtpriv->dbg_trigger_point == SRESET_TGP_LINK_STATUS) { ++ psrtpriv->dbg_trigger_point = SRESET_TGP_NULL; ++ rtw_hal_sreset_reset(padapter); ++ return; + } -+ -+ SET_TX_DESC_TX_DESC_CHECKSUM_8812(ptxdesc, checksum); +} -+ -+// -+// Description: In normal chip, we should send some packet to Hw which will be used by Fw -+// in FW LPS mode. The function is to fill the Tx descriptor of this packets, then -+// Fw can tell Hw to send these packet derectly. -+// -+void rtl8812a_fill_fake_txdesc( -+ PADAPTER padapter, -+ u8* pDesc, -+ u32 BufferLen, -+ u8 IsPsPoll, -+ u8 IsBTQosNull, -+ u8 bDataFrame) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ -+ // Clear all status -+ _rtw_memset(pDesc, 0, TXDESC_SIZE); -+ -+ SET_TX_DESC_FIRST_SEG_8812(pDesc, 1); -+ SET_TX_DESC_LAST_SEG_8812(pDesc, 1); -+ -+ SET_TX_DESC_OFFSET_8812(pDesc, TXDESC_SIZE); -+ -+ SET_TX_DESC_PKT_SIZE_8812(pDesc, BufferLen); -+ -+ SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT); -+ -+ if (pmlmeext->cur_wireless_mode & WIRELESS_11B) { -+ SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_B); -+ } else { -+ SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_G); -+ } -+ -+ //Set NAVUSEHDR to prevent Ps-poll AId filed to be changed to error vlaue by Hw. -+ if (IsPsPoll) -+ { -+ SET_TX_DESC_NAV_USE_HDR_8812(pDesc, 1); -+ } -+ else -+ { -+ SET_TX_DESC_HWSEQ_EN_8812(pDesc, 1); // Hw set sequence number -+ } -+ -+ if(IsBTQosNull) -+ { -+ SET_TX_DESC_BT_INT_8812(pDesc, 1); -+ } -+ -+ SET_TX_DESC_USE_RATE_8812(pDesc, 1); -+ SET_TX_DESC_OWN_8812(pDesc, 1); -+ -+ // -+ // Encrypt the data frame if under security mode excepct null data. Suggested by CCW. -+ // -+ if (_TRUE ==bDataFrame) -+ { -+ u32 EncAlg; -+ -+ EncAlg = padapter->securitypriv.dot11PrivacyAlgrthm; -+ switch (EncAlg) -+ { -+ case _NO_PRIVACY_: -+ SET_TX_DESC_SEC_TYPE_8812(pDesc, 0x0); -+ break; -+ case _WEP40_: -+ case _WEP104_: -+ case _TKIP_: -+ SET_TX_DESC_SEC_TYPE_8812(pDesc, 0x1); -+ break; -+ case _SMS4_: -+ SET_TX_DESC_SEC_TYPE_8812(pDesc, 0x2); -+ break; -+ case _AES_: -+ SET_TX_DESC_SEC_TYPE_8812(pDesc, 0x3); -+ break; -+ default: -+ SET_TX_DESC_SEC_TYPE_8812(pDesc, 0x0); -+ break; -+ } -+ } -+ SET_TX_DESC_TX_RATE_8812(pDesc, MRateToHwRate(pmlmeext->tx_rate)); -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) -+ // USB interface drop packet if the checksum of descriptor isn't correct. -+ // Using this checksum can let hardware recovery from packet bulk out error (e.g. Cancel URC, Bulk out error.). -+ rtl8812a_cal_txdesc_chksum(pDesc); +#endif -+} -+ -+void rtl8812a_fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc) -+{ -+ if ((pattrib->encrypt > 0) && !pattrib->bswenc) -+ { -+ switch (pattrib->encrypt) -+ { -+ //SEC_TYPE : 0:NO_ENC,1:WEP40/TKIP,2:WAPI,3:AES -+ case _WEP40_: -+ case _WEP104_: -+ case _TKIP_: -+ case _TKIP_WTMIC_: -+ SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x1); -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x2); -+ break; -+#endif -+ case _AES_: -+ SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x3); -+ break; -+ case _NO_PRIVACY_: -+ default: -+ SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x0); -+ break; -+ -+ } -+ -+ } -+ -+} -+ -+void rtl8812a_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ //DBG_8192C("vcs_mode=%d\n", pattrib->vcs_mode); -+ -+ if (pattrib->vcs_mode) { -+ -+ switch(pattrib->vcs_mode) -+ { -+ case RTS_CTS: -+ SET_TX_DESC_RTS_ENABLE_8812(ptxdesc, 1); -+ break; -+ case CTS_TO_SELF: -+ SET_TX_DESC_CTS2SELF_8812(ptxdesc, 1); -+ break; -+ case NONE_VCS: -+ default: -+ break; -+ } -+ -+ if (pmlmeinfo->preamble_mode == PREAMBLE_SHORT) -+ SET_TX_DESC_RTS_SHORT_8812(ptxdesc, 1); -+ -+ SET_TX_DESC_RTS_RATE_8812(ptxdesc, 0x8);//RTS Rate=24M -+ -+ SET_TX_DESC_RTS_RATE_FB_LIMIT_8812(ptxdesc, 0xf); -+ -+ //Enable HW RTS -+ if(IS_HARDWARE_TYPE_8821(padapter)) -+ SET_TX_DESC_HW_RTS_ENABLE_8812(ptxdesc, 1); -+ } -+} -+ -+void rtl8812a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc) -+{ -+ //DBG_8192C("bwmode=%d, ch_off=%d\n", pattrib->bwmode, pattrib->ch_offset); -+ -+ if(pattrib->ht_en) -+ { -+ // Set Bandwidth and sub-channel settings. -+ SET_TX_DESC_DATA_BW_8812(ptxdesc, BWMapping_8812(padapter,pattrib)); -+ -+ SET_TX_DESC_DATA_SC_8812(ptxdesc, SCMapping_8812(padapter,pattrib)); -+ } -+} -+ -+u8 -+BWMapping_8812( -+ IN PADAPTER Adapter, -+ IN struct pkt_attrib *pattrib -+) -+{ -+ u8 BWSettingOfDesc = 0; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ //DBG_871X("BWMapping pHalData->CurrentChannelBW %d, pattrib->bwmode %d \n",pHalData->CurrentChannelBW,pattrib->bwmode); -+ -+ if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_80) -+ { -+ if(pattrib->bwmode == CHANNEL_WIDTH_80) -+ BWSettingOfDesc= 2; -+ else if(pattrib->bwmode == CHANNEL_WIDTH_40) -+ BWSettingOfDesc = 1; -+ else -+ BWSettingOfDesc = 0; -+ } -+ else if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_40) -+ { -+ if((pattrib->bwmode == CHANNEL_WIDTH_40) || (pattrib->bwmode == CHANNEL_WIDTH_80)) -+ BWSettingOfDesc = 1; -+ else -+ BWSettingOfDesc = 0; -+ } -+ else -+ BWSettingOfDesc = 0; -+ -+ return BWSettingOfDesc; -+} -+ -+u8 -+SCMapping_8812( -+ IN PADAPTER Adapter, -+ IN struct pkt_attrib *pattrib -+) -+{ -+ u8 SCSettingOfDesc = 0; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ //DBG_871X("SCMapping: pHalData->CurrentChannelBW %d, pHalData->nCur80MhzPrimeSC %d, pHalData->nCur40MhzPrimeSC %d \n",pHalData->CurrentChannelBW,pHalData->nCur80MhzPrimeSC,pHalData->nCur40MhzPrimeSC); -+ -+ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) -+ { -+ if(pattrib->bwmode == CHANNEL_WIDTH_80) -+ { -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ } -+ else if(pattrib->bwmode == CHANNEL_WIDTH_40) -+ { -+ if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOfDesc = VHT_DATA_SC_40_LOWER_OF_80MHZ; -+ else if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOfDesc = VHT_DATA_SC_40_UPPER_OF_80MHZ; -+ else -+ DBG_871X("SCMapping: DONOT CARE Mode Setting\n"); -+ } -+ else -+ { -+ if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWEST_OF_80MHZ; -+ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPERST_OF_80MHZ; -+ else -+ DBG_871X("SCMapping: DONOT CARE Mode Setting\n"); -+ } -+ } -+ else if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_40) -+ { -+ //DBG_871X("SCMapping: HT Case: pHalData->CurrentChannelBW %d, pHalData->nCur40MhzPrimeSC %d \n",pHalData->CurrentChannelBW,pHalData->nCur40MhzPrimeSC); -+ -+ if(pattrib->bwmode == CHANNEL_WIDTH_40) -+ { -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ } -+ else if(pattrib->bwmode == CHANNEL_WIDTH_20) -+ { -+ if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ { -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ } -+ else if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ { -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ } -+ else -+ { -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ } -+ -+ } -+ } -+ else -+ { -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ } -+ -+ return SCSettingOfDesc; -+} -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c 2017-06-07 23:07:21.033689581 +0300 -@@ -0,0 +1,440 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812au_led.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812au_led.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812au_led.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812au_led.c 2018-02-06 17:42:30.715967238 +0200 +@@ -0,0 +1,442 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -281507,11 +123638,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTL8812AU_LED_C_ + @@ -281529,7 +123655,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 + + +//================================================================================ -+// LED_819xUsb routines. ++// LED_819xUsb routines. +//================================================================================ + +// @@ -281538,18 +123664,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 +// +static void +SwLedOn_8812AU( -+ PADAPTER padapter, ++ PADAPTER padapter, + PLED_USB pLed +) +{ + u8 LedCfg; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + -+ if (RTW_CANNOT_RUN(padapter)) ++ if( (padapter->bSurpriseRemoved == true) || ( padapter->bDriverStopped == true)) ++ { + return; ++ } + + if( RT_GetInterfaceSelection(padapter) == INTF_SEL2_MINICARD || -+ RT_GetInterfaceSelection(padapter) == INTF_SEL3_USB_Solo || ++ RT_GetInterfaceSelection(padapter) == INTF_SEL3_USB_Solo || + RT_GetInterfaceSelection(padapter) == INTF_SEL4_USB_Combo) + { + LedCfg = rtw_read8(padapter, REG_LEDCFG2); @@ -281589,8 +123717,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 + } + else + { -+ LedCfg = rtw_read8(padapter, REG_LEDCFG2) & 0xe0; -+ rtw_write8(padapter, REG_LEDCFG2, LedCfg|BIT7|BIT6|BIT5); // SW control led0 on. ++ LedCfg = rtw_read8(padapter, REG_LEDCFG2); ++ rtw_write8(padapter, REG_LEDCFG2, (LedCfg&0xe0)|BIT7|BIT6|BIT5); // SW control led0 on. + RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedOn LED0 Addr 0x%x, 0x%x\n", REG_LEDCFG2, rtw_read32(padapter, REG_LEDCFG2))); + } + break; @@ -281606,13 +123734,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 + rtw_write8(padapter, (REG_LEDCFG2), (LedCfg&0x70)|BIT5); // SW control led1 on. + RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedOn LED2 0x%x\n", rtw_read32(padapter, REG_LEDCFG2))); + break; -+ ++ + default: + break; + } + } + -+ pLed->bLedOn = _TRUE; ++ pLed->bLedOn = true; +} + + @@ -281622,26 +123750,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 +// +static void +SwLedOff_8812AU( -+ PADAPTER padapter, ++ PADAPTER padapter, + PLED_USB pLed +) +{ + u8 LedCfg; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + -+ if (RTW_CANNOT_RUN(padapter)) ++ if(padapter->bSurpriseRemoved == true) ++ { + return; ++ } + + if( RT_GetInterfaceSelection(padapter) == INTF_SEL2_MINICARD || + RT_GetInterfaceSelection(padapter) == INTF_SEL3_USB_Solo || + RT_GetInterfaceSelection(padapter) == INTF_SEL4_USB_Combo) -+ { ++ { + RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("In SwLedOff,LedAddr:%X LEDPIN=%d\n",REG_LEDCFG2, pLed->LedPin)); + LedCfg = rtw_read8(padapter, REG_LEDCFG2); -+ ++ + // 2009/10/23 MH Issau eed to move the LED GPIO from bit 0 to bit3. + // 2009/10/26 MH Issau if tyhe device is 8c DID is 0x8176, we need to enable bit6 to -+ // enable GPIO8 for controlling LED. ++ // enable GPIO8 for controlling LED. + // 2010/07/02 Supprt Open-drain arrangement for controlling the LED. Added by Roger. + // + switch(pLed->LedPin) @@ -281651,13 +123781,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 + break; + + case LED_PIN_LED0: -+ if(pHalData->bLedOpenDrain == _TRUE) ++ if(pHalData->bLedOpenDrain == true) + { -+ LedCfg &= 0x90; // Set to software control. -+ rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3)); ++ LedCfg &= 0x90; // Set to software control. ++ rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3)); + LedCfg = rtw_read8(padapter, REG_MAC_PINMUX_CFG); + LedCfg &= 0xFE; -+ rtw_write8(padapter, REG_MAC_PINMUX_CFG, LedCfg); ++ rtw_write8(padapter, REG_MAC_PINMUX_CFG, LedCfg); + } + else + { @@ -281692,8 +123822,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 + else + { + LedCfg = rtw_read8(padapter, REG_LEDCFG2); -+ LedCfg &= 0xe0; // Set to software control. -+ rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3|BIT7|BIT6|BIT5)); ++ LedCfg &= 0xe0; // Set to software control. ++ if(IS_HARDWARE_TYPE_8723A(padapter)) ++ rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3|BIT7|BIT5)); ++ else ++ rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3|BIT7|BIT6|BIT5)); + RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedOff LED0 0x%x\n", rtw_read32(padapter, REG_LEDCFG2))); + } + break; @@ -281717,7 +123850,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 + } + } + -+ pLed->bLedOn = _FALSE; ++ pLed->bLedOn = false; +} + +// @@ -281726,30 +123859,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 +// +static void +SwLedOn_8821AU( -+ PADAPTER Adapter, ++ PADAPTER Adapter, + PLED_USB pLed +) +{ + u8 LedCfg; + -+ if (RTW_CANNOT_RUN(Adapter)) ++ if( (Adapter->bSurpriseRemoved == true) || ( Adapter->bDriverStopped == true)) ++ { + return; -+ ++ } + + if( RT_GetInterfaceSelection(Adapter) == INTF_SEL2_MINICARD || -+ RT_GetInterfaceSelection(Adapter) == INTF_SEL3_USB_Solo || ++ RT_GetInterfaceSelection(Adapter) == INTF_SEL3_USB_Solo || + RT_GetInterfaceSelection(Adapter) == INTF_SEL4_USB_Combo) + { + LedCfg = rtw_read8(Adapter, REG_LEDCFG2); + RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("In SwLedON,LedAddr:%X LEDPIN=%d\n",REG_LEDCFG2, pLed->LedPin)); + switch(pLed->LedPin) -+ { ++ { + case LED_PIN_GPIO0: + break; + + case LED_PIN_LED0: + -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("In SwLedOn,LedAddr:%X LEDPIN=%d\n",REG_LEDCFG2, pLed->LedPin)); ++ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("In SwLedOn,LedAddr:%X LEDPIN=%d\n",REG_LEDCFG2, pLed->LedPin)); + LedCfg = rtw_read8(Adapter, REG_LEDCFG2); + rtw_write8(Adapter, REG_LEDCFG2, (LedCfg&0xf0)|BIT5|BIT6); // SW control led0 on. + break; @@ -281766,19 +123900,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 + else + { + switch(pLed->LedPin) -+ { ++ { + case LED_PIN_GPIO0: + break; + + case LED_PIN_LED0: + case LED_PIN_LED1: -+ case LED_PIN_LED2: ++ case LED_PIN_LED2: + if(IS_HARDWARE_TYPE_8821U(Adapter)) + { -+ LedCfg = rtw_read8(Adapter, REG_LEDCFG2) & 0x20; -+ rtw_write8(Adapter, REG_LEDCFG2, (LedCfg & ~(BIT3))|BIT5); // SW control led0 on. ++ LedCfg = rtw_read8(Adapter, REG_LEDCFG2); ++ rtw_write8(Adapter, REG_LEDCFG2, ((LedCfg&0x20) & (~BIT3))|BIT5); // SW control led0 on. + RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("8821 SwLedOn LED2 0x%x\n", rtw_read32(Adapter, REG_LEDCFG0))); -+ //DBG_871X("8821 SwLedOn LED2 0x%x\n", rtw_read32(Adapter, REG_LEDCFG0)); + } + + break; @@ -281787,7 +123920,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 + break; + } + } -+ pLed->bLedOn = _TRUE; ++ pLed->bLedOn = true; +} + + @@ -281797,26 +123930,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 +// +static void +SwLedOff_8821AU( -+ PADAPTER Adapter, ++ PADAPTER Adapter, + PLED_USB pLed +) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + u8 LedCfg; + -+ if (RTW_CANNOT_RUN(Adapter)) ++ if(Adapter->bSurpriseRemoved == true) ++ { + return; ++ } + + if( RT_GetInterfaceSelection(Adapter) == INTF_SEL2_MINICARD || + RT_GetInterfaceSelection(Adapter) == INTF_SEL3_USB_Solo || + RT_GetInterfaceSelection(Adapter) == INTF_SEL4_USB_Combo) -+ { ++ { + RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("In SwLedOff,LedAddr:%X LEDPIN=%d\n",REG_LEDCFG2, pLed->LedPin)); + LedCfg = rtw_read8(Adapter, REG_LEDCFG2); -+ ++ + // 2009/10/23 MH Issau eed to move the LED GPIO from bit 0 to bit3. + // 2009/10/26 MH Issau if tyhe device is 8c DID is 0x8176, we need to enable bit6 to -+ // enable GPIO8 for controlling LED. ++ // enable GPIO8 for controlling LED. + // 2010/07/02 Supprt Open-drain arrangement for controlling the LED. Added by Roger. + // + switch(pLed->LedPin) @@ -281826,13 +123961,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 + break; + + case LED_PIN_LED0: -+ if(pHalData->bLedOpenDrain == _TRUE) ++ if(pHalData->bLedOpenDrain == true) + { -+ LedCfg &= 0x90; // Set to software control. -+ rtw_write8(Adapter, REG_LEDCFG2, (LedCfg|BIT3)); ++ LedCfg &= 0x90; // Set to software control. ++ rtw_write8(Adapter, REG_LEDCFG2, (LedCfg|BIT3)); + LedCfg = rtw_read8(Adapter, REG_MAC_PINMUX_CFG); + LedCfg &= 0xFE; -+ rtw_write8(Adapter, REG_MAC_PINMUX_CFG, LedCfg); ++ rtw_write8(Adapter, REG_MAC_PINMUX_CFG, LedCfg); + } + else + { @@ -281864,7 +123999,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 + LedCfg = rtw_read8(Adapter, REG_LEDCFG2); + LedCfg &= 0x20; // Set to software control. + rtw_write8(Adapter, REG_LEDCFG2, (LedCfg|BIT3|BIT5)); -+ //DBG_871X("8821 SwLedOn LED2 0x%x\n", rtw_read32(Adapter, REG_LEDCFG0)); + RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("8821 SwLedOff LED2 0x%x\n", rtw_read32(Adapter, REG_LEDCFG0))); + } + @@ -281875,8 +124009,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 + break; + } + } -+ -+ pLed->bLedOn = _FALSE; ++ ++ pLed->bLedOn = false; +} + + @@ -281933,15 +124067,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_led.c linux/3 + DeInitLed( &(ledpriv->SwLed1) ); + DeInitLed( &(ledpriv->SwLed2) ); +} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_recv.c linux/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_recv.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_recv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_recv.c 2017-06-07 23:07:21.033689581 +0300 -@@ -0,0 +1,34 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812au_recv.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812au_recv.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812au_recv.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812au_recv.c 2018-02-06 17:42:30.715967238 +0200 +@@ -0,0 +1,194 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -281951,35 +124084,195 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_recv.c linux/ + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTL8812AU_RECV_C_ + +//#include +#include + ++ ++void rtl8812au_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf) ++{ ++ ++ precvbuf->transfer_len = 0; ++ ++ precvbuf->len = 0; ++ ++ precvbuf->ref_cnt = 0; ++ ++ if(precvbuf->pbuf) ++ { ++ precvbuf->pdata = precvbuf->phead = precvbuf->ptail = precvbuf->pbuf; ++ precvbuf->pend = precvbuf->pdata + MAX_RECVBUF_SZ; ++ } ++ ++} ++ +int rtl8812au_init_recv_priv(_adapter *padapter) +{ -+ return usb_init_recv_priv(padapter, INTERRUPT_MSG_FORMAT_LEN); ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ int i, res = _SUCCESS; ++ struct recv_buf *precvbuf; ++ ++#ifdef CONFIG_RECV_THREAD_MODE ++ _rtw_init_sema(&precvpriv->recv_sema, 0);//will be removed ++ _rtw_init_sema(&precvpriv->terminate_recvthread_sema, 0);//will be removed ++#endif ++ ++ tasklet_init(&precvpriv->recv_tasklet, ++ (void(*)(unsigned long))rtl8812au_recv_tasklet, ++ (unsigned long)padapter); ++ ++#ifdef CONFIG_USB_INTERRUPT_IN_PIPE ++ precvpriv->int_in_urb = usb_alloc_urb(0, GFP_KERNEL); ++ if(precvpriv->int_in_urb == NULL){ ++ res= _FAIL; ++ DBG_8192C("alloc_urb for interrupt in endpoint fail !!!!\n"); ++ goto exit; ++ } ++ precvpriv->int_in_buf = rtw_zmalloc(INTERRUPT_MSG_FORMAT_LEN); ++ if(precvpriv->int_in_buf == NULL){ ++ res= _FAIL; ++ DBG_8192C("alloc_mem for interrupt in endpoint fail !!!!\n"); ++ goto exit; ++ } ++#endif ++ ++ //init recv_buf ++ _rtw_init_queue(&precvpriv->free_recv_buf_queue); ++ ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX ++ _rtw_init_queue(&precvpriv->recv_buf_pending_queue); ++#endif // CONFIG_USE_USB_BUFFER_ALLOC_RX ++ ++ precvpriv->pallocated_recv_buf = rtw_zmalloc(NR_RECVBUFF *sizeof(struct recv_buf) + 4); ++ if(precvpriv->pallocated_recv_buf==NULL){ ++ res= _FAIL; ++ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("alloc recv_buf fail!\n")); ++ goto exit; ++ } ++ _rtw_memset(precvpriv->pallocated_recv_buf, 0, NR_RECVBUFF *sizeof(struct recv_buf) + 4); ++ ++ precvpriv->precv_buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(precvpriv->pallocated_recv_buf), 4); ++ //precvpriv->precv_buf = precvpriv->pallocated_recv_buf + 4 - ++ // ((uint) (precvpriv->pallocated_recv_buf) &(4-1)); ++ ++ ++ precvbuf = (struct recv_buf*)precvpriv->precv_buf; ++ ++ for(i=0; i < NR_RECVBUFF ; i++) ++ { ++ _rtw_init_listhead(&precvbuf->list); ++ ++ _rtw_spinlock_init(&precvbuf->recvbuf_lock); ++ ++ precvbuf->alloc_sz = MAX_RECVBUF_SZ; ++ ++ res = rtw_os_recvbuf_resource_alloc(padapter, precvbuf); ++ if(res==_FAIL) ++ break; ++ ++ precvbuf->ref_cnt = 0; ++ precvbuf->adapter =padapter; ++ ++ ++ //rtw_list_insert_tail(&precvbuf->list, &(precvpriv->free_recv_buf_queue.queue)); ++ ++ precvbuf++; ++ ++ } ++ ++ precvpriv->free_recv_buf_queue_cnt = NR_RECVBUFF; ++ ++ skb_queue_head_init(&precvpriv->rx_skb_queue); ++ ++#ifdef CONFIG_PREALLOC_RECV_SKB ++ { ++ int i; ++ SIZE_PTR tmpaddr=0; ++ SIZE_PTR alignment=0; ++ struct sk_buff *pskb=NULL; ++ ++ skb_queue_head_init(&precvpriv->free_recv_skb_queue); ++ ++ for(i=0; ipnetdev, MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ, GFP_KERNEL); ++ #endif ++ ++ if(pskb) ++ { ++ pskb->dev = padapter->pnetdev; ++ ++ tmpaddr = (SIZE_PTR)pskb->data; ++ alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1); ++ skb_reserve(pskb, (RECVBUFF_ALIGN_SZ - alignment)); ++ ++ skb_queue_tail(&precvpriv->free_recv_skb_queue, pskb); ++ } ++ ++ pskb=NULL; ++ ++ } ++ } ++#endif ++ ++exit: ++ return res; +} + -+void rtl8812au_free_recv_priv(_adapter *padapter) ++void rtl8812au_free_recv_priv (_adapter *padapter) +{ -+ usb_free_recv_priv(padapter, INTERRUPT_MSG_FORMAT_LEN); -+} ++ int i; ++ struct recv_buf *precvbuf; ++ struct recv_priv *precvpriv = &padapter->recvpriv; + -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c 2017-06-07 23:07:21.034689672 +0300 -@@ -0,0 +1,1123 @@ ++ precvbuf = (struct recv_buf *)precvpriv->precv_buf; ++ ++ for(i=0; i < NR_RECVBUFF ; i++) ++ { ++ rtw_os_recvbuf_resource_free(padapter, precvbuf); ++ precvbuf++; ++ } ++ ++ if(precvpriv->pallocated_recv_buf) ++ rtw_mfree(precvpriv->pallocated_recv_buf, NR_RECVBUFF *sizeof(struct recv_buf) + 4); ++ ++#ifdef CONFIG_USB_INTERRUPT_IN_PIPE ++ if(precvpriv->int_in_urb) ++ usb_free_urb(precvpriv->int_in_urb); ++ ++ if(precvpriv->int_in_buf) ++ rtw_mfree(precvpriv->int_in_buf, INTERRUPT_MSG_FORMAT_LEN); ++#endif//CONFIG_USB_INTERRUPT_IN_PIPE ++ ++ if (skb_queue_len(&precvpriv->rx_skb_queue)) { ++ DBG_8192C(KERN_WARNING "rx_skb_queue not empty\n"); ++ } ++ ++ skb_queue_purge(&precvpriv->rx_skb_queue); ++ ++#ifdef CONFIG_PREALLOC_RECV_SKB ++ ++ if (skb_queue_len(&precvpriv->free_recv_skb_queue)) { ++ DBG_8192C(KERN_WARNING "free_recv_skb_queue not empty, %d\n", skb_queue_len(&precvpriv->free_recv_skb_queue)); ++ } ++ ++ skb_queue_purge(&precvpriv->free_recv_skb_queue); ++#endif ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812au_xmit.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812au_xmit.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812au_xmit.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812au_xmit.c 2018-02-06 17:42:30.716967253 +0200 +@@ -0,0 +1,1036 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -281989,11 +124282,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RTL8812AU_XMIT_C_ + @@ -282006,11 +124294,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + -+#ifdef PLATFORM_LINUX + tasklet_init(&pxmitpriv->xmit_tasklet, + (void(*)(unsigned long))rtl8812au_xmit_tasklet, + (unsigned long)padapter); -+#endif +#ifdef CONFIG_TX_EARLY_MODE + pHalData->bEarlyModeEnable = padapter->registrypriv.early_mode; +#endif @@ -282023,23 +124309,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ +} + +static s32 update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem, s32 sz ,u8 bagg_pkt) -+{ ++{ + int pull=0; + uint qsel; + u8 data_rate,pwr_status,offset; + _adapter *padapter = pxmitframe->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; + u8 *ptxdesc = pmem; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + sint bmcst = IS_MCAST(pattrib->ra); + -+#ifndef CONFIG_USE_USB_BUFFER_ALLOC_TX ++#ifndef CONFIG_USE_USB_BUFFER_ALLOC_TX + if (padapter->registrypriv.mp_mode == 0) + { -+ if((PACKET_OFFSET_SZ != 0) && (!bagg_pkt) &&(rtw_usb_bulk_size_boundary(padapter,TXDESC_SIZE+sz)==_FALSE)) ++ if((!bagg_pkt) &&(rtw_usb_bulk_size_boundary(padapter,TXDESC_SIZE+sz)==false)) + { + ptxdesc = (pmem+PACKET_OFFSET_SZ); + //DBG_8192C("==> non-agg-pkt,shift pointer...\n"); @@ -282049,20 +124336,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ +#endif // CONFIG_USE_USB_BUFFER_ALLOC_TX + + _rtw_memset(ptxdesc, 0, TXDESC_SIZE); -+ ++ + //4 offset 0 + SET_TX_DESC_FIRST_SEG_8812(ptxdesc, 1); + SET_TX_DESC_LAST_SEG_8812(ptxdesc, 1); + SET_TX_DESC_OWN_8812(ptxdesc, 1); -+ ++ + //DBG_8192C("%s==> pkt_len=%d,bagg_pkt=%02x\n",__FUNCTION__,sz,bagg_pkt); + SET_TX_DESC_PKT_SIZE_8812(ptxdesc, sz); -+ -+ offset = TXDESC_SIZE + OFFSET_SZ; + -+#ifdef CONFIG_TX_EARLY_MODE -+ if(bagg_pkt){ -+ offset += EARLY_MODE_INFO_SIZE ;//0x28 ++ offset = TXDESC_SIZE + OFFSET_SZ; ++ ++#ifdef CONFIG_TX_EARLY_MODE ++ if(bagg_pkt){ ++ offset += EARLY_MODE_INFO_SIZE ;//0x28 + } +#endif + //DBG_8192C("%s==>offset(0x%02x) \n",__FUNCTION__,offset); @@ -282075,12 +124362,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ +#ifndef CONFIG_USE_USB_BUFFER_ALLOC_TX + if (padapter->registrypriv.mp_mode == 0) + { -+ if((PACKET_OFFSET_SZ != 0) && (!bagg_pkt)){ -+ if((pull) && (pxmitframe->pkt_offset>0)) { -+ pxmitframe->pkt_offset = pxmitframe->pkt_offset -1; ++ if(!bagg_pkt){ ++ if((pull) && (pxmitframe->pkt_offset>0)) { ++ pxmitframe->pkt_offset = pxmitframe->pkt_offset -1; + } + } -+ } ++ } +#endif + + //DBG_8192C("%s, pkt_offset=0x%02x\n",__FUNCTION__,pxmitframe->pkt_offset); @@ -282104,7 +124391,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + + if((pxmitframe->frame_tag&0x0f) == DATA_FRAMETAG) + { -+ //DBG_8192C("pxmitframe->frame_tag == DATA_FRAMETAG\n"); ++ //DBG_8192C("pxmitframe->frame_tag == DATA_FRAMETAG\n"); + + rtl8812a_fill_txdesc_sectype(pattrib, ptxdesc); + @@ -282123,17 +124410,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + (pattrib->ether_type != 0x88b4) && + (pattrib->dhcp_pkt != 1) +#ifdef CONFIG_AUTO_AP_MODE -+ && (pattrib->pctrl != _TRUE) ++ && (pattrib->pctrl != true) +#endif + ) + { + //Non EAP & ARP & DHCP type data packet + -+ if (pattrib->ampdu_en==_TRUE) { ++ if (pattrib->ampdu_en==true) { + SET_TX_DESC_AGG_ENABLE_8812(ptxdesc, 1); + SET_TX_DESC_MAX_AGG_NUM_8812(ptxdesc, 0x1f); + // Set A-MPDU aggregation. -+ SET_TX_DESC_AMPDU_DENSITY_8812(ptxdesc, pattrib->ampdu_spacing); ++ SET_TX_DESC_AMPDU_DENSITY_8812(ptxdesc, pHalData->AMPDUDensity); + } else { + SET_TX_DESC_AGG_BREAK_8812(ptxdesc, 1); + } @@ -282143,28 +124430,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + //DATA Rate FB LMT + SET_TX_DESC_DATA_RATE_FB_LIMIT_8812(ptxdesc, 0x1f); + -+ if (pHalData->fw_ractrl == _FALSE) { ++ if (pHalData->fw_ractrl == false) { + SET_TX_DESC_USE_RATE_8812(ptxdesc, 1); -+ -+ if(pHalData->INIDATA_RATE[pattrib->mac_id] & BIT(7)) -+ SET_TX_DESC_DATA_SHORT_8812(ptxdesc, 1); + -+ SET_TX_DESC_TX_RATE_8812(ptxdesc, (pHalData->INIDATA_RATE[pattrib->mac_id] & 0x7F)); ++ if(pdmpriv->INIDATA_RATE[pattrib->mac_id] & BIT(7)) ++ SET_TX_DESC_DATA_SHORT_8812(ptxdesc, 1); ++ ++ SET_TX_DESC_TX_RATE_8812(ptxdesc, (pdmpriv->INIDATA_RATE[pattrib->mac_id] & 0x7F)); + } + + if (padapter->fix_rate != 0xFF) { // modify data rate by iwpriv + SET_TX_DESC_USE_RATE_8812(ptxdesc, 1); + if(padapter->fix_rate & BIT(7)) -+ SET_TX_DESC_DATA_SHORT_8812(ptxdesc, 1); ++ SET_TX_DESC_DATA_SHORT_8812(ptxdesc, 1); + + SET_TX_DESC_TX_RATE_8812(ptxdesc, (padapter->fix_rate & 0x7F)); -+ if (!padapter->data_fb) -+ SET_TX_DESC_DISABLE_FB_8812(ptxdesc,1); + } + + if (pattrib->ldpc) + SET_TX_DESC_DATA_LDPC_8812(ptxdesc, 1); -+ if (pattrib->stbc) ++ if (pattrib->stbc) + SET_TX_DESC_DATA_STBC_8812(ptxdesc, 1); + } + else @@ -282184,80 +124469,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + + SET_TX_DESC_TX_RATE_8812(ptxdesc, MRateToHwRate(pmlmeext->tx_rate)); + } -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_XMIT_ACK -+ /* CCX-TXRPT ack for xmit mgmt frames. */ -+ if (pxmitframe->ack_report) { -+ SET_TX_DESC_SPE_RPT_8812(ptxdesc, 1); -+ #ifdef DBG_CCX -+ DBG_871X("%s set tx report\n", __func__); -+ #endif -+ } -+#endif /* CONFIG_XMIT_ACK */ -+#endif + } + else if((pxmitframe->frame_tag&0x0f)== MGNT_FRAMETAG) + { -+ //DBG_8192C("pxmitframe->frame_tag == MGNT_FRAMETAG\n"); ++ //DBG_8192C("pxmitframe->frame_tag == MGNT_FRAMETAG\n"); + + if(IS_HARDWARE_TYPE_8821(padapter)) + SET_TX_DESC_MBSSID_8821(ptxdesc, pattrib->mbssid); + ++ //offset 20 ++ SET_TX_DESC_RETRY_LIMIT_ENABLE_8812(ptxdesc, 1); ++ if (pattrib->retry_ctrl == true) { ++ SET_TX_DESC_DATA_RETRY_LIMIT_8812(ptxdesc, 6); ++ } else { ++ SET_TX_DESC_DATA_RETRY_LIMIT_8812(ptxdesc, 12); ++ } ++ + SET_TX_DESC_USE_RATE_8812(ptxdesc, 1); + +#ifdef CONFIG_INTEL_PROXIM -+ if((padapter->proximity.proxim_on==_TRUE)&&(pattrib->intel_proxim==_TRUE)){ ++ if((padapter->proximity.proxim_on==true)&&(pattrib->intel_proxim==true)){ + DBG_871X("\n %s pattrib->rate=%d\n",__FUNCTION__,pattrib->rate); + SET_TX_DESC_TX_RATE_8812(ptxdesc, pattrib->rate); + } + else +#endif + { -+ SET_TX_DESC_TX_RATE_8812(ptxdesc, MRateToHwRate(pattrib->rate)); ++ SET_TX_DESC_TX_RATE_8812(ptxdesc, MRateToHwRate(pmlmeext->tx_rate)); + } -+ -+ // VHT NDPA or HT NDPA Packet for Beamformer. -+ if((pattrib->subtype == WIFI_NDPA) || -+ ((pattrib->subtype == WIFI_ACTION_NOACK) && (pattrib->order == 1))) -+ { -+ SET_TX_DESC_NAV_USE_HDR_8812(ptxdesc, 1); -+ -+ SET_TX_DESC_DATA_BW_8812(ptxdesc, BWMapping_8812(padapter,pattrib)); -+ SET_TX_DESC_RTS_SC_8812(ptxdesc, SCMapping_8812(padapter,pattrib)); -+ -+ SET_TX_DESC_RETRY_LIMIT_ENABLE_8812(ptxdesc, 1); -+ SET_TX_DESC_DATA_RETRY_LIMIT_8812(ptxdesc, 5); -+ SET_TX_DESC_DISABLE_FB_8812(ptxdesc, 1); -+ -+ //if(pattrib->rts_cca) -+ //{ -+ // SET_TX_DESC_NDPA_8812(ptxdesc, 2); -+ //} -+ //else -+ { -+ SET_TX_DESC_NDPA_8812(ptxdesc, 1); -+ } -+ } -+ else -+ { -+ SET_TX_DESC_RETRY_LIMIT_ENABLE_8812(ptxdesc, 1); -+ if (pattrib->retry_ctrl == _TRUE) { -+ SET_TX_DESC_DATA_RETRY_LIMIT_8812(ptxdesc, 6); -+ } else { -+ SET_TX_DESC_DATA_RETRY_LIMIT_8812(ptxdesc, 12); -+ } -+ } -+ -+#ifdef CONFIG_XMIT_ACK -+ //CCX-TXRPT ack for xmit mgmt frames. -+ if (pxmitframe->ack_report) { -+ SET_TX_DESC_SPE_RPT_8812(ptxdesc, 1); -+ #ifdef DBG_CCX -+ DBG_871X("%s set tx report\n", __func__); -+ #endif -+ } -+#endif //CONFIG_XMIT_ACK + } + else if((pxmitframe->frame_tag&0x0f) == TXAGG_FRAMETAG) + { @@ -282267,7 +124506,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + else if(((pxmitframe->frame_tag&0x0f) == MP_FRAMETAG) && + (padapter->registrypriv.mp_mode == 1)) + { -+ fill_txdesc_for_mp(padapter, ptxdesc); ++ fill_txdesc_for_mp(padapter, (struct tx_desc *)ptxdesc); + } +#endif + else @@ -282278,11 +124517,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + SET_TX_DESC_TX_RATE_8812(ptxdesc, MRateToHwRate(pmlmeext->tx_rate)); + } + -+ SET_TX_DESC_GID_8812(ptxdesc, pattrib->txbf_g_id); -+ SET_TX_DESC_PAID_8812(ptxdesc, pattrib->txbf_p_aid); -+ + rtl8812a_cal_txdesc_chksum(ptxdesc); -+ _dbg_dump_tx_info(padapter,pxmitframe->frame_tag,ptxdesc); ++ _dbg_dump_tx_info(padapter,pxmitframe->frame_tag,ptxdesc); + return pull; +} + @@ -282314,16 +124550,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + return _FAIL; + } + -+ if (RTW_CANNOT_RUN(padapter)) { -+ RT_TRACE(_module_hal_xmit_c_, _drv_notice_ -+ , ("%s: bDriverStopped(%s) bSurpriseRemoved(%s)!\n" -+ , __func__ -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False")); ++ ret = (padapter->bDriverStopped == true) || (padapter->bSurpriseRemoved == true); ++ if (ret) { ++ RT_TRACE(_module_hal_xmit_c_, _drv_notice_, ++ ("%s: bDriverStopped(%d) bSurpriseRemoved(%d)!\n", ++ __FUNCTION__, padapter->bDriverStopped, padapter->bSurpriseRemoved)); + return _FAIL; + } + -+ if(check_pending_xmitbuf(pxmitpriv) == _FALSE) ++ if(check_pending_xmitbuf(pxmitpriv) == false) + return _SUCCESS; + +#ifdef CONFIG_LPS_LCLK @@ -282377,31 +124612,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + mem_addr = pxmitframe->buf_addr; + + RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_dump_xframe()\n")); -+ ++ + for (t = 0; t < pattrib->nr_frags; t++) + { + if (inner_ret != _SUCCESS && ret == _SUCCESS) + ret = _FAIL; -+ ++ + if (t != (pattrib->nr_frags - 1)) + { + RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("pattrib->nr_frags=%d\n", pattrib->nr_frags)); + + sz = pxmitpriv->frag_len; -+ sz = sz - 4 - (psecuritypriv->sw_encrypt ? 0 : pattrib->icv_len); ++ sz = sz - 4 - (psecuritypriv->sw_encrypt ? 0 : pattrib->icv_len); + } + else //no frag + { + sz = pattrib->last_txcmdsz; + } + -+ pull = update_txdesc(pxmitframe, mem_addr, sz, _FALSE); -+ ++ pull = update_txdesc(pxmitframe, mem_addr, sz, false); ++ + if(pull) + { + mem_addr += PACKET_OFFSET_SZ; //pull txdesc head -+ -+ //pxmitbuf ->pbuf = mem_addr; ++ ++ //pxmitbuf ->pbuf = mem_addr; + pxmitframe->buf_addr = mem_addr; + + w_sz = sz + TXDESC_SIZE; @@ -282409,7 +124644,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + else + { + w_sz = sz + TXDESC_SIZE + PACKET_OFFSET_SZ; -+ } ++ } + + ff_hwaddr = rtw_get_ff_hwaddr(pxmitframe); + @@ -282423,19 +124658,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + rtw_count_tx_stats(padapter, pxmitframe, sz); + + RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_write_port, w_sz=%d\n", w_sz)); -+ //DBG_8192C("rtw_write_port, w_sz=%d, sz=%d, txdesc_sz=%d, tid=%d\n", w_sz, sz, w_sz-sz, pattrib->priority); ++ //DBG_8192C("rtw_write_port, w_sz=%d, sz=%d, txdesc_sz=%d, tid=%d\n", w_sz, sz, w_sz-sz, pattrib->priority); + + mem_addr += w_sz; + + mem_addr = (u8 *)RND4(((SIZE_PTR)(mem_addr))); + + } -+ ++ + rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ ++ + if (ret != _SUCCESS) + rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_UNKNOWN); -+ ++ + return ret; +} + @@ -282484,9 +124719,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + // dump frame variable + u32 ff_hwaddr; + -+ _list *sta_plist, *sta_phead; -+ u8 single_sta_in_queue = _FALSE; -+ +#ifndef IDEA_CONDITION + int res = _SUCCESS; +#endif @@ -282499,7 +124731,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); + if (pxmitbuf == NULL){ + //DBG_871X("%s #1, connot alloc xmitbuf!!!! \n",__FUNCTION__); -+ return _FALSE; ++ return false; + } + } + @@ -282507,13 +124739,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + //3 1. pick up first frame + do { + rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ ++ + pxmitframe = rtw_dequeue_xframe(pxmitpriv, pxmitpriv->hwxmits, pxmitpriv->hwxmit_entry); + if (pxmitframe == NULL) { + // no more xmit frame, release xmit buffer + //DBG_8192C("no more xmit frame ,return\n"); + rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ return _FALSE; ++ return false; + } + +#ifndef IDEA_CONDITION @@ -282542,12 +124774,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + + pxmitframe->agg_num = 1; // alloc xmitframe should assign to 1. + #ifdef CONFIG_TX_EARLY_MODE -+ pxmitframe->pkt_offset = (PACKET_OFFSET_SZ/8)+1; // 2; // first frame of aggregation, reserve one offset for EM info ,another for usb bulk-out block check ++ pxmitframe->pkt_offset = 2; // first frame of aggregation, reserve one offset for EM info ,another for usb bulk-out block check + #else -+ pxmitframe->pkt_offset = (PACKET_OFFSET_SZ/8); // 1; // first frame of aggregation, reserve offset ++ pxmitframe->pkt_offset = 1; // first frame of aggregation, reserve offset + #endif + -+ if (rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe) == _FALSE) { ++ if (rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe) == false) { + DBG_871X("%s coalesce 1st xmitframe failed \n",__FUNCTION__); + continue; + } @@ -282569,11 +124801,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + descCount = 0; + bulkPtr = bulkSize; + if (pbuf < bulkPtr) -+ { + descCount++; -+ if (descCount == pHalData->UsbTxAggDescNum) -+ goto agg_end; -+ } + else { + descCount = 0; + bulkPtr = ((pbuf / bulkSize) + 1) * bulkSize; // round to next bulkSize @@ -282613,37 +124841,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + + _enter_critical_bh(&pxmitpriv->lock, &irqL); + -+ sta_phead = get_list_head(phwxmit->sta_queue); -+ sta_plist = get_next(sta_phead); -+ single_sta_in_queue = rtw_end_of_queue_search(sta_phead, get_next(sta_plist)); -+ + xmitframe_phead = get_list_head(&ptxservq->sta_pending); + xmitframe_plist = get_next(xmitframe_phead); -+ -+ while (rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist) == _FALSE) ++ ++ while (rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist) == false) + { + pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); + xmitframe_plist = get_next(xmitframe_plist); + -+ if(_FAIL == rtw_hal_busagg_qsel_check(padapter,pfirstframe->attrib.qsel,pxmitframe->attrib.qsel)) -+ break; -+ + pxmitframe->agg_num = 0; // not first frame of aggregation + #ifdef CONFIG_TX_EARLY_MODE + pxmitframe->pkt_offset = 1;// not first frame of aggregation,reserve offset for EM Info + #else + pxmitframe->pkt_offset = 0; // not first frame of aggregation, no need to reserve offset -+ #endif ++ #endif + + len = xmitframe_need_length(pxmitframe) + TXDESC_SIZE +(pxmitframe->pkt_offset*PACKET_OFFSET_SZ); -+ ++ + if (_RND8(pbuf + len) > MAX_XMITBUF_SZ) + //if (_RND8(pbuf + len) > (MAX_XMITBUF_SZ/2))//to do : for TX TP finial tune , Georgia 2012-0323 + { + //DBG_8192C("%s....len> MAX_XMITBUF_SZ\n",__FUNCTION__); + pxmitframe->agg_num = 1; -+ pxmitframe->pkt_offset = 1; -+ break; ++ pxmitframe->pkt_offset = 1; ++ break; + } + rtw_list_delete(&pxmitframe->list); + ptxservq->qcnt--; @@ -282672,8 +124893,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + +// pxmitframe->pxmitbuf = pxmitbuf; + pxmitframe->buf_addr = pxmitbuf->pbuf + pbuf; -+ -+ if (rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe) == _FALSE) { ++ ++ if (rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe) == false) { + DBG_871X("%s coalesce failed \n",__FUNCTION__); + rtw_free_xmitframe(pxmitpriv, pxmitframe); + continue; @@ -282684,8 +124905,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + rtw_os_xmit_complete(padapter, pxmitframe); + + // (len - TXDESC_SIZE) == pxmitframe->attrib.last_txcmdsz -+ update_txdesc(pxmitframe, pxmitframe->buf_addr, pxmitframe->attrib.last_txcmdsz,_TRUE); -+ ++ update_txdesc(pxmitframe, pxmitframe->buf_addr, pxmitframe->attrib.last_txcmdsz,true); ++ + // don't need xmitframe any more + rtw_free_xmitframe(pxmitpriv, pxmitframe); + @@ -282695,9 +124916,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + + + pfirstframe->agg_num++; -+#ifdef CONFIG_TX_EARLY_MODE -+ pxmitpriv->agg_pkt[pfirstframe->agg_num-1].offset = _RND8(len); -+ pxmitpriv->agg_pkt[pfirstframe->agg_num-1].pkt_len = pxmitframe->attrib.last_txcmdsz; ++#ifdef CONFIG_TX_EARLY_MODE ++ pxmitpriv->agg_pkt[pfirstframe->agg_num-1].offset = _RND8(len); ++ pxmitpriv->agg_pkt[pfirstframe->agg_num-1].pkt_len = pxmitframe->attrib.last_txcmdsz; +#endif + if (MAX_TX_AGG_PACKET_NUMBER == pfirstframe->agg_num) + break; @@ -282711,16 +124932,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + bulkPtr = ((pbuf / bulkSize) + 1) * bulkSize; + } + }//end while( aggregate same priority and same DA(AP or STA) frames) -+ if (_rtw_queue_empty(&ptxservq->sta_pending) == _TRUE) ++ ++ ++ if (_rtw_queue_empty(&ptxservq->sta_pending) == true) + rtw_list_delete(&ptxservq->tx_pending); -+ else if (single_sta_in_queue == _FALSE) { -+ /* Re-arrange the order of stations in this ac queue to balance the service for these stations */ -+ rtw_list_delete(&ptxservq->tx_pending); -+ rtw_list_insert_tail(&ptxservq->tx_pending, get_list_head(phwxmit->sta_queue)); -+ } + + _exit_critical_bh(&pxmitpriv->lock, &irqL); -+agg_end: +#ifdef CONFIG_80211N_HT + if ((pfirstframe->attrib.ether_type != 0x0806) && + (pfirstframe->attrib.ether_type != 0x888e) && @@ -282732,7 +124949,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ +#endif //CONFIG_80211N_HT +#ifndef CONFIG_USE_USB_BUFFER_ALLOC_TX + //3 3. update first frame txdesc -+ if ((PACKET_OFFSET_SZ != 0) && ((pbuf_tail % bulkSize) == 0)) { ++ if ((pbuf_tail % bulkSize) == 0) { + // remove pkt_offset + pbuf_tail -= PACKET_OFFSET_SZ; + pfirstframe->buf_addr += PACKET_OFFSET_SZ; @@ -282741,16 +124958,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + } +#endif // CONFIG_USE_USB_BUFFER_ALLOC_TX + -+ update_txdesc(pfirstframe, pfirstframe->buf_addr, pfirstframe->attrib.last_txcmdsz,_TRUE); -+ ++ update_txdesc(pfirstframe, pfirstframe->buf_addr, pfirstframe->attrib.last_txcmdsz,true); ++ + #ifdef CONFIG_TX_EARLY_MODE + //prepare EM info for first frame, agg_num value start from 1 + pxmitpriv->agg_pkt[0].offset = _RND8(pfirstframe->attrib.last_txcmdsz +TXDESC_SIZE +(pfirstframe->pkt_offset*PACKET_OFFSET_SZ)); -+ pxmitpriv->agg_pkt[0].pkt_len = pfirstframe->attrib.last_txcmdsz;//get from rtw_xmitframe_coalesce ++ pxmitpriv->agg_pkt[0].pkt_len = pfirstframe->attrib.last_txcmdsz;//get from rtw_xmitframe_coalesce + + UpdateEarlyModeInfo8812(pxmitpriv,pxmitbuf ); + #endif -+ ++ + //3 4. write xmit buffer to USB FIFO + ff_hwaddr = rtw_get_ff_hwaddr(pfirstframe); +//DBG_8192C("%s ===================================== write port,buf_size(%d) \n",__FUNCTION__,pbuf_tail); @@ -282761,23 +124978,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + //3 5. update statisitc + pbuf_tail -= (pfirstframe->agg_num * TXDESC_SIZE); + pbuf_tail -= (pfirstframe->pkt_offset * PACKET_OFFSET_SZ); -+ -+ ++ ++ + rtw_count_tx_stats(padapter, pfirstframe, pbuf_tail); + + rtw_free_xmitframe(pxmitpriv, pfirstframe); + -+ return _TRUE; ++ return true; +} + +#else + +s32 rtl8812au_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf) -+{ ++{ + + struct hw_xmit *phwxmits; + sint hwentry; -+ struct xmit_frame *pxmitframe=NULL; ++ struct xmit_frame *pxmitframe=NULL; + int res=_SUCCESS, xcnt = 0; + + phwxmits = pxmitpriv->hwxmits; @@ -282787,65 +125004,65 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + + if(pxmitbuf==NULL) + { -+ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); ++ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); + if(!pxmitbuf) + { -+ return _FALSE; -+ } -+ } ++ return false; ++ } ++ } + + + do -+ { ++ { + pxmitframe = rtw_dequeue_xframe(pxmitpriv, phwxmits, hwentry); -+ ++ + if(pxmitframe) + { -+ pxmitframe->pxmitbuf = pxmitbuf; ++ pxmitframe->pxmitbuf = pxmitbuf; + + pxmitframe->buf_addr = pxmitbuf->pbuf; + -+ pxmitbuf->priv_data = pxmitframe; ++ pxmitbuf->priv_data = pxmitframe; + + if((pxmitframe->frame_tag&0x0f) == DATA_FRAMETAG) -+ { ++ { + if(pxmitframe->attrib.priority<=15)//TID0~15 + { + res = rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe); -+ } ++ } + //DBG_8192C("==> pxmitframe->attrib.priority:%d\n",pxmitframe->attrib.priority); -+ rtw_os_xmit_complete(padapter, pxmitframe);//always return ndis_packet after rtw_xmitframe_coalesce ++ rtw_os_xmit_complete(padapter, pxmitframe);//always return ndis_packet after rtw_xmitframe_coalesce + } + -+ ++ + RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("xmitframe_complete(): rtw_dump_xframe\n")); + -+ ++ + if(res == _SUCCESS) + { -+ rtw_dump_xframe(padapter, pxmitframe); ++ rtw_dump_xframe(padapter, pxmitframe); + } + else + { + rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); ++ rtw_free_xmitframe(pxmitpriv, pxmitframe); + } -+ ++ + xcnt++; -+ ++ + } + else -+ { ++ { + rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ return _FALSE; ++ return false; + } + + break; -+ ++ + }while(0/*xcnt < (NR_XMITFRAME >> 3)*/); + -+ return _TRUE; -+ ++ return true; ++ +} +#endif + @@ -282869,8 +125086,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + +/* + * Return -+ * _TRUE dump packet directly -+ * _FALSE enqueue packet ++ * true dump packet directly ++ * false enqueue packet + */ +static s32 pre_xmitframe(_adapter *padapter, struct xmit_frame *pxmitframe) +{ @@ -282880,22 +125097,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + struct pkt_attrib *pattrib = &pxmitframe->attrib; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 lg_sta_num; + + _enter_critical_bh(&pxmitpriv->lock, &irqL); + ++//DBG_8192C("==> %s \n",__FUNCTION__); ++ + if (rtw_txframes_sta_ac_pending(padapter, pattrib) > 0) + { + //DBG_8192C("enqueue AC(%d)\n",pattrib->priority); + goto enqueue; + } + -+ if (rtw_xmit_ac_blocked(padapter) == _TRUE) ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) + goto enqueue; + -+ rtw_dev_iface_status(padapter, NULL, NULL , &lg_sta_num, NULL, NULL); -+ if (lg_sta_num) ++#ifdef CONFIG_CONCURRENT_MODE ++ if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) + goto enqueue; ++#endif + + pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); + if (pxmitbuf == NULL) @@ -282912,7 +125132,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + rtw_free_xmitframe(pxmitpriv, pxmitframe); + } + -+ return _TRUE; ++ return true; + +enqueue: + res = rtw_xmitframe_enqueue(padapter, pxmitframe); @@ -282922,11 +125142,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + RT_TRACE(_module_xmit_osdep_c_, _drv_err_, ("pre_xmitframe: enqueue xmitframe fail\n")); + rtw_free_xmitframe(pxmitpriv, pxmitframe); + ++ // Trick, make the statistics correct ++ pxmitpriv->tx_pkts--; + pxmitpriv->tx_drop++; -+ return _TRUE; ++ return true; + } + -+ return _FALSE; ++ return false; +} + +s32 rtl8812au_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe) @@ -282936,8 +125158,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + +/* + * Return -+ * _TRUE dump packet directly ok -+ * _FALSE temporary can't transmit packets to hardware ++ * true dump packet directly ok ++ * false temporary can't transmit packets to hardware + */ +s32 rtl8812au_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe) +{ @@ -282946,61 +125168,51 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + +s32 rtl8812au_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) +{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + s32 err; -+ -+ if ((err=rtw_xmitframe_enqueue(padapter, pxmitframe)) != _SUCCESS) -+ { ++ ++ if ((err=rtw_xmitframe_enqueue(padapter, pxmitframe)) != _SUCCESS) { + rtw_free_xmitframe(pxmitpriv, pxmitframe); + -+ pxmitpriv->tx_drop++; -+ } -+ else -+ { -+#ifdef PLATFORM_LINUX ++ // Trick, make the statistics correct ++ pxmitpriv->tx_pkts--; ++ pxmitpriv->tx_drop++; ++ } else { + tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+#endif + } -+ ++ + return err; -+ ++ +} + + +#ifdef CONFIG_HOSTAPD_MLME + +static void rtl8812au_hostap_mgnt_xmit_cb(struct urb *urb) -+{ -+#ifdef PLATFORM_LINUX ++{ + struct sk_buff *skb = (struct sk_buff *)urb->context; + -+ //DBG_8192C("%s\n", __FUNCTION__); -+ -+ rtw_skb_free(skb); -+#endif ++ dev_kfree_skb_any(skb); +} + +s32 rtl8812au_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt) +{ -+#ifdef PLATFORM_LINUX + u16 fc; -+ int rc, len, pipe; ++ int rc, len, pipe; + unsigned int bmcst, tid, qsel; + struct sk_buff *skb, *pxmit_skb; + struct urb *urb; + unsigned char *pxmitbuf; + struct tx_desc *ptxdesc; + struct rtw_ieee80211_hdr *tx_hdr; -+ struct hostapd_priv *phostapdpriv = padapter->phostapdpriv; ++ struct hostapd_priv *phostapdpriv = padapter->phostapdpriv; + struct net_device *pnetdev = padapter->pnetdev; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); ++ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); + -+ -+ //DBG_8192C("%s\n", __FUNCTION__); + + skb = pkt; -+ ++ + len = skb->len; + tx_hdr = (struct rtw_ieee80211_hdr *)(skb->data); + fc = le16_to_cpu(tx_hdr->frame_ctl); @@ -283009,7 +125221,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + if ((fc & RTW_IEEE80211_FCTL_FTYPE) != RTW_IEEE80211_FTYPE_MGMT) + goto _exit; + -+ pxmit_skb = rtw_skb_alloc(len + TXDESC_SIZE); ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18)) // http://www.mail-archive.com/netdev@vger.kernel.org/msg17214.html ++ pxmit_skb = dev_alloc_skb(len + TXDESC_SIZE); ++#else ++ pxmit_skb = netdev_alloc_skb(pnetdev, len + TXDESC_SIZE); ++#endif + + if(!pxmit_skb) + goto _exit; @@ -283021,42 +125237,42 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + goto _exit; + } + -+ // ----- fill tx desc ----- -+ ptxdesc = (struct tx_desc *)pxmitbuf; ++ // ----- fill tx desc ----- ++ ptxdesc = (struct tx_desc *)pxmitbuf; + _rtw_memset(ptxdesc, 0, sizeof(*ptxdesc)); -+ -+ //offset 0 -+ ptxdesc->txdw0 |= cpu_to_le32(len&0x0000ffff); ++ ++ //offset 0 ++ ptxdesc->txdw0 |= cpu_to_le32(len&0x0000ffff); + ptxdesc->txdw0 |= cpu_to_le32(((TXDESC_SIZE+OFFSET_SZ)<txdw0 |= cpu_to_le32(OWN | FSG | LSG); + -+ if(bmcst) ++ if(bmcst) + { + ptxdesc->txdw0 |= cpu_to_le32(BIT(24)); -+ } ++ } + -+ //offset 4 ++ //offset 4 + ptxdesc->txdw1 |= cpu_to_le32(0x00);//MAC_ID + + ptxdesc->txdw1 |= cpu_to_le32((0x12<txdw1 |= cpu_to_le32((0x06<< 16) & 0x000f0000);//b mode + -+ //offset 8 ++ //offset 8 + -+ //offset 12 ++ //offset 12 + ptxdesc->txdw3 |= cpu_to_le32((le16_to_cpu(tx_hdr->seq_ctl)<<16)&0xffff0000); + -+ //offset 16 ++ //offset 16 + ptxdesc->txdw4 |= cpu_to_le32(BIT(8));//driver uses rate -+ ++ + //offset 20 + + + //HW append seq + ptxdesc->txdw4 |= cpu_to_le32(BIT(7)); // Hw set sequence number + ptxdesc->txdw3 |= cpu_to_le32((8 <<28)); //set bit3 to 1. Suugested by TimChen. 2009.12.29. -+ ++ + + rtl8188eu_cal_txdesc_chksum(ptxdesc); + // ----- end of fill tx desc ----- @@ -283066,18 +125282,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + pxmitbuf = pxmitbuf + TXDESC_SIZE; + _rtw_memcpy(pxmitbuf, skb->data, len); + -+ //DBG_8192C("mgnt_xmit, len=%x\n", pxmit_skb->len); -+ -+ + // ----- prepare urb for submit ----- -+ ++ + //translate DMA FIFO addr to pipehandle -+ //pipe = ffaddr2pipehdl(pdvobj, MGT_QUEUE_INX); + pipe = usb_sndbulkpipe(pdvobj->pusbdev, pHalData->Queue2EPNum[(u8)MGT_QUEUE_INX]&0x0f); -+ ++ + usb_fill_bulk_urb(urb, pdvobj->pusbdev, pipe, + pxmit_skb->data, pxmit_skb->len, rtl8192cu_hostap_mgnt_xmit_cb, pxmit_skb); -+ ++ + urb->transfer_flags |= URB_ZERO_PACKET; + usb_anchor_urb(urb, &phostapdpriv->anchored); + rc = usb_submit_urb(urb, GFP_ATOMIC); @@ -283087,26 +125299,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/rtl8812au_xmit.c linux/ + } + usb_free_urb(urb); + -+ -+_exit: -+ -+ rtw_skb_free(skb); -+ -+#endif ++_exit: + ++ dev_kfree_skb_any(skb); + return 0; -+ +} +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c 2017-06-07 23:07:21.034689672 +0300 -@@ -0,0 +1,2856 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_xmit.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_xmit.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_xmit.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_xmit.c 2018-02-06 17:42:30.715967238 +0200 +@@ -0,0 +1,512 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -283116,10 +125322,521 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++#define _RTL8812A_XMIT_C_ ++ ++//#include ++#include ++ ++void _dbg_dump_tx_info(_adapter *padapter,int frame_tag, u8 *ptxdesc) ++{ ++ u8 bDumpTxPkt; ++ u8 bDumpTxDesc = false; ++ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DUMP_TXPKT, &(bDumpTxPkt)); ++ ++ if(bDumpTxPkt ==1){//dump txdesc for data frame ++ DBG_871X("dump tx_desc for data frame\n"); ++ if((frame_tag&0x0f) == DATA_FRAMETAG){ ++ bDumpTxDesc = true; ++ } ++ } ++ else if(bDumpTxPkt ==2){//dump txdesc for mgnt frame ++ DBG_871X("dump tx_desc for mgnt frame\n"); ++ if((frame_tag&0x0f) == MGNT_FRAMETAG){ ++ bDumpTxDesc = true; ++ } ++ } ++ else if(bDumpTxPkt ==3){//dump early info ++ } ++ ++ if(bDumpTxDesc){ ++ // ptxdesc->txdw4 = cpu_to_le32(0x00001006);//RTS Rate=24M ++ // ptxdesc->txdw6 = 0x6666f800; ++ DBG_8192C("=====================================\n"); ++ DBG_8192C("Offset00(0x%08x)\n",*((u32 *)(ptxdesc))); ++ DBG_8192C("Offset04(0x%08x)\n",*((u32 *)(ptxdesc+4))); ++ DBG_8192C("Offset08(0x%08x)\n",*((u32 *)(ptxdesc+8))); ++ DBG_8192C("Offset12(0x%08x)\n",*((u32 *)(ptxdesc+12))); ++ DBG_8192C("Offset16(0x%08x)\n",*((u32 *)(ptxdesc+16))); ++ DBG_8192C("Offset20(0x%08x)\n",*((u32 *)(ptxdesc+20))); ++ DBG_8192C("Offset24(0x%08x)\n",*((u32 *)(ptxdesc+24))); ++ DBG_8192C("Offset28(0x%08x)\n",*((u32 *)(ptxdesc+28))); ++ DBG_8192C("Offset32(0x%08x)\n",*((u32 *)(ptxdesc+32))); ++ DBG_8192C("Offset36(0x%08x)\n",*((u32 *)(ptxdesc+36))); ++ DBG_8192C("=====================================\n"); ++ } ++ ++} ++ ++/* ++ * Description: ++ * Aggregation packets and send to hardware + * ++ * Return: ++ * 0 Success ++ * -1 Hardware resource(TX FIFO) not ready ++ * -2 Software resource(xmitbuf) not ready ++ */ ++#ifdef CONFIG_TX_EARLY_MODE ++ ++//#define DBG_EMINFO ++ ++#if RTL8188E_EARLY_MODE_PKT_NUM_10 == 1 ++ #define EARLY_MODE_MAX_PKT_NUM 10 ++#else ++ #define EARLY_MODE_MAX_PKT_NUM 5 ++#endif ++ ++ ++struct EMInfo{ ++ u8 EMPktNum; ++ u16 EMPktLen[EARLY_MODE_MAX_PKT_NUM]; ++}; ++ ++ ++void ++InsertEMContent_8812( ++ struct EMInfo *pEMInfo, ++ IN pu1Byte VirtualAddress) ++{ ++ ++#if RTL8188E_EARLY_MODE_PKT_NUM_10 == 1 ++ u1Byte index=0; ++ u4Byte dwtmp=0; ++#endif ++ ++ _rtw_memset(VirtualAddress, 0, EARLY_MODE_INFO_SIZE); ++ if(pEMInfo->EMPktNum==0) ++ return; ++ ++ #ifdef DBG_EMINFO ++ { ++ int i; ++ DBG_8192C("\n%s ==> pEMInfo->EMPktNum =%d\n",__FUNCTION__,pEMInfo->EMPktNum); ++ for(i=0;i< EARLY_MODE_MAX_PKT_NUM;i++){ ++ DBG_8192C("%s ==> pEMInfo->EMPktLen[%d] =%d\n",__FUNCTION__,i,pEMInfo->EMPktLen[i]); ++ } ++ ++ } ++ #endif ++ ++#if RTL8188E_EARLY_MODE_PKT_NUM_10 == 1 ++ SET_EARLYMODE_PKTNUM(VirtualAddress, pEMInfo->EMPktNum); ++ ++ if(pEMInfo->EMPktNum == 1){ ++ dwtmp = pEMInfo->EMPktLen[0]; ++ }else{ ++ dwtmp = pEMInfo->EMPktLen[0]; ++ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; ++ dwtmp += pEMInfo->EMPktLen[1]; ++ } ++ SET_EARLYMODE_LEN0(VirtualAddress, dwtmp); ++ if(pEMInfo->EMPktNum <= 3){ ++ dwtmp = pEMInfo->EMPktLen[2]; ++ }else{ ++ dwtmp = pEMInfo->EMPktLen[2]; ++ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; ++ dwtmp += pEMInfo->EMPktLen[3]; ++ } ++ SET_EARLYMODE_LEN1(VirtualAddress, dwtmp); ++ if(pEMInfo->EMPktNum <= 5){ ++ dwtmp = pEMInfo->EMPktLen[4]; ++ }else{ ++ dwtmp = pEMInfo->EMPktLen[4]; ++ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; ++ dwtmp += pEMInfo->EMPktLen[5]; ++ } ++ SET_EARLYMODE_LEN2_1(VirtualAddress, dwtmp&0xF); ++ SET_EARLYMODE_LEN2_2(VirtualAddress, dwtmp>>4); ++ if(pEMInfo->EMPktNum <= 7){ ++ dwtmp = pEMInfo->EMPktLen[6]; ++ }else{ ++ dwtmp = pEMInfo->EMPktLen[6]; ++ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; ++ dwtmp += pEMInfo->EMPktLen[7]; ++ } ++ SET_EARLYMODE_LEN3(VirtualAddress, dwtmp); ++ if(pEMInfo->EMPktNum <= 9){ ++ dwtmp = pEMInfo->EMPktLen[8]; ++ }else{ ++ dwtmp = pEMInfo->EMPktLen[8]; ++ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; ++ dwtmp += pEMInfo->EMPktLen[9]; ++ } ++ SET_EARLYMODE_LEN4(VirtualAddress, dwtmp); ++#else ++ SET_EARLYMODE_PKTNUM(VirtualAddress, pEMInfo->EMPktNum); ++ SET_EARLYMODE_LEN0(VirtualAddress, pEMInfo->EMPktLen[0]); ++ SET_EARLYMODE_LEN1(VirtualAddress, pEMInfo->EMPktLen[1]); ++ SET_EARLYMODE_LEN2_1(VirtualAddress, pEMInfo->EMPktLen[2]&0xF); ++ SET_EARLYMODE_LEN2_2(VirtualAddress, pEMInfo->EMPktLen[2]>>4); ++ SET_EARLYMODE_LEN3(VirtualAddress, pEMInfo->EMPktLen[3]); ++ SET_EARLYMODE_LEN4(VirtualAddress, pEMInfo->EMPktLen[4]); ++#endif ++ //RT_PRINT_DATA(COMP_SEND, DBG_LOUD, "EMHdr:", VirtualAddress, 8); ++ ++} ++ ++ ++ ++void UpdateEarlyModeInfo8812(struct xmit_priv *pxmitpriv,struct xmit_buf *pxmitbuf ) ++{ ++ //_adapter *padapter, struct xmit_frame *pxmitframe,struct tx_servq *ptxservq ++ int index,j; ++ u16 offset,pktlen; ++ PTXDESC_8812 ptxdesc; ++ ++ u8 *pmem,*pEMInfo_mem; ++ s8 node_num_0=0,node_num_1=0; ++ struct EMInfo eminfo; ++ struct agg_pkt_info *paggpkt; ++ struct xmit_frame *pframe = (struct xmit_frame*)pxmitbuf->priv_data; ++ pmem= pframe->buf_addr; ++ ++ #ifdef DBG_EMINFO ++ DBG_8192C("\n%s ==> agg_num:%d\n",__FUNCTION__, pframe->agg_num); ++ for(index=0;indexagg_num;index++){ ++ offset = pxmitpriv->agg_pkt[index].offset; ++ pktlen = pxmitpriv->agg_pkt[index].pkt_len; ++ DBG_8192C("%s ==> agg_pkt[%d].offset=%d\n",__FUNCTION__,index,offset); ++ DBG_8192C("%s ==> agg_pkt[%d].pkt_len=%d\n",__FUNCTION__,index,pktlen); ++ } ++ #endif ++ ++ if( pframe->agg_num > EARLY_MODE_MAX_PKT_NUM) ++ { ++ node_num_0 = pframe->agg_num; ++ node_num_1= EARLY_MODE_MAX_PKT_NUM-1; ++ } ++ ++ for(index=0;indexagg_num;index++){ ++ ++ offset = pxmitpriv->agg_pkt[index].offset; ++ pktlen = pxmitpriv->agg_pkt[index].pkt_len; ++ ++ _rtw_memset(&eminfo,0,sizeof(struct EMInfo)); ++ if( pframe->agg_num > EARLY_MODE_MAX_PKT_NUM){ ++ if(node_num_0 > EARLY_MODE_MAX_PKT_NUM){ ++ eminfo.EMPktNum = EARLY_MODE_MAX_PKT_NUM; ++ node_num_0--; ++ } ++ else{ ++ eminfo.EMPktNum = node_num_1; ++ node_num_1--; ++ } ++ } ++ else{ ++ eminfo.EMPktNum = pframe->agg_num-(index+1); ++ } ++ for(j=0;j< eminfo.EMPktNum ;j++){ ++ eminfo.EMPktLen[j] = pxmitpriv->agg_pkt[index+1+j].pkt_len+4;// 4 bytes CRC ++ } ++ ++ if(pmem){ ++ if(index==0){ ++ ptxdesc = (PTXDESC_8812)(pmem); ++ pEMInfo_mem = ((u8 *)ptxdesc)+TXDESC_SIZE; ++ } ++ else{ ++ pmem = pmem + pxmitpriv->agg_pkt[index-1].offset; ++ ptxdesc = (PTXDESC_8812)(pmem); ++ pEMInfo_mem = ((u8 *)ptxdesc)+TXDESC_SIZE; ++ } ++ ++ #ifdef DBG_EMINFO ++ DBG_8192C("%s ==> desc.pkt_len=%d\n",__FUNCTION__,ptxdesc->pktlen); ++ #endif ++ InsertEMContent_8812(&eminfo,pEMInfo_mem); ++ } ++ ++ ++ } ++ _rtw_memset(pxmitpriv->agg_pkt,0,sizeof(struct agg_pkt_info)*MAX_AGG_PKT_NUM); ++ ++} ++#endif ++ ++void rtl8812a_cal_txdesc_chksum(u8 *ptxdesc) ++{ ++ u16 *usPtr; ++ u32 count; ++ u32 index; ++ u16 checksum = 0; ++ ++ ++ usPtr = (u16*)ptxdesc; ++ // checksume is always calculated by first 32 bytes, ++ // and it doesn't depend on TX DESC length. ++ // Thomas,Lucas@SD4,20130515 ++ count = 16; ++ ++ // Clear first ++ SET_TX_DESC_TX_DESC_CHECKSUM_8812(ptxdesc, 0); ++ ++ for(index = 0 ; index < count ; index++){ ++ checksum = checksum ^ le16_to_cpu(*(usPtr + index)); ++ } ++ ++ SET_TX_DESC_TX_DESC_CHECKSUM_8812(ptxdesc, checksum); ++} ++ ++// ++// Description: In normal chip, we should send some packet to Hw which will be used by Fw ++// in FW LPS mode. The function is to fill the Tx descriptor of this packets, then ++// Fw can tell Hw to send these packet derectly. ++// ++void rtl8812a_fill_fake_txdesc( ++ PADAPTER padapter, ++ u8* pDesc, ++ u32 BufferLen, ++ u8 IsPsPoll, ++ u8 IsBTQosNull) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ ++ ++ // Clear all status ++ _rtw_memset(pDesc, 0, TXDESC_SIZE); ++ ++ SET_TX_DESC_FIRST_SEG_8812(pDesc, 1); ++ SET_TX_DESC_LAST_SEG_8812(pDesc, 1); ++ ++ SET_TX_DESC_OFFSET_8812(pDesc, TXDESC_SIZE); ++ ++ SET_TX_DESC_PKT_SIZE_8812(pDesc, BufferLen); ++ ++ SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT); ++ ++ if (pmlmeext->cur_wireless_mode & WIRELESS_11B) { ++ SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_B); ++ } else { ++ SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_G); ++ } ++ ++ //Set NAVUSEHDR to prevent Ps-poll AId filed to be changed to error vlaue by Hw. ++ if (IsPsPoll) ++ { ++ SET_TX_DESC_NAV_USE_HDR_8812(pDesc, 1); ++ } ++ else ++ { ++ SET_TX_DESC_HWSEQ_EN_8812(pDesc, 1); // Hw set sequence number ++ } ++ ++ if(IsBTQosNull) ++ { ++ SET_TX_DESC_BT_INT_8812(pDesc, 1); ++ } ++ ++ SET_TX_DESC_USE_RATE_8812(pDesc, 1); ++ SET_TX_DESC_OWN_8812(pDesc, 1); ++ ++ SET_TX_DESC_TX_RATE_8812(pDesc, MRateToHwRate(pmlmeext->tx_rate)); ++ ++ // USB interface drop packet if the checksum of descriptor isn't correct. ++ // Using this checksum can let hardware recovery from packet bulk out error (e.g. Cancel URC, Bulk out error.). ++ rtl8812a_cal_txdesc_chksum(pDesc); ++} ++ ++void rtl8812a_fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc) ++{ ++ if ((pattrib->encrypt > 0) && !pattrib->bswenc) ++ { ++ switch (pattrib->encrypt) ++ { ++ //SEC_TYPE : 0:NO_ENC,1:WEP40/TKIP,2:WAPI,3:AES ++ case _WEP40_: ++ case _WEP104_: ++ case _TKIP_: ++ case _TKIP_WTMIC_: ++ SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x1); ++ break; ++#ifdef CONFIG_WAPI_SUPPORT ++ case _SMS4_: ++ SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x2); ++ break; ++#endif ++ case _AES_: ++ SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x3); ++ break; ++ case _NO_PRIVACY_: ++ default: ++ SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x0); ++ break; ++ ++ } ++ ++ } ++ ++} ++ ++void rtl8812a_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc) ++{ ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ //DBG_8192C("vcs_mode=%d\n", pattrib->vcs_mode); ++ ++ if (pattrib->vcs_mode) { ++ ++ switch(pattrib->vcs_mode) ++ { ++ case RTS_CTS: ++ SET_TX_DESC_RTS_ENABLE_8812(ptxdesc, 1); ++ break; ++ case CTS_TO_SELF: ++ SET_TX_DESC_CTS2SELF_8812(ptxdesc, 1); ++ break; ++ case NONE_VCS: ++ default: ++ break; ++ } ++ ++ if (pmlmeinfo->preamble_mode == PREAMBLE_SHORT) ++ SET_TX_DESC_RTS_SHORT_8812(ptxdesc, 1); ++ ++ SET_TX_DESC_RTS_RATE_8812(ptxdesc, 0x8);//RTS Rate=24M ++ ++ SET_TX_DESC_RTS_RATE_FB_LIMIT_8812(ptxdesc, 0xf); ++ ++ //Enable HW RTS ++ //SET_TX_DESC_HW_RTS_ENABLE_8812(ptxdesc, 1); ++ } ++} ++ ++void rtl8812a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc) ++{ ++ //DBG_8192C("bwmode=%d, ch_off=%d\n", pattrib->bwmode, pattrib->ch_offset); ++ ++ if(pattrib->ht_en) ++ { ++ // Set Bandwidth and sub-channel settings. ++ SET_TX_DESC_DATA_BW_8812(ptxdesc, BWMapping_8812(padapter,pattrib)); ++ ++ //SET_TX_DESC_DATA_SC_8812(ptxdesc, SCMapping_8812(padapter,pattrib)); ++ } ++} ++ ++u8 ++BWMapping_8812( ++ PADAPTER Adapter, ++ struct pkt_attrib *pattrib ++) ++{ ++ u8 BWSettingOfDesc = 0; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ ++ //DBG_871X("BWMapping pHalData->CurrentChannelBW %d, pattrib->bwmode %d \n",pHalData->CurrentChannelBW,pattrib->bwmode); ++ ++ if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_80) ++ { ++ if(pattrib->bwmode == CHANNEL_WIDTH_80) ++ BWSettingOfDesc= 2; ++ else if(pattrib->bwmode == CHANNEL_WIDTH_40) ++ BWSettingOfDesc = 1; ++ else ++ BWSettingOfDesc = 0; ++ } ++ else if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_40) ++ { ++ if((pattrib->bwmode == CHANNEL_WIDTH_40) || (pattrib->bwmode == CHANNEL_WIDTH_80)) ++ BWSettingOfDesc = 1; ++ else ++ BWSettingOfDesc = 0; ++ } ++ else ++ BWSettingOfDesc = 0; ++ ++ return BWSettingOfDesc; ++} ++ ++u8 ++SCMapping_8812( ++ PADAPTER Adapter, ++ struct pkt_attrib *pattrib ++) ++{ ++ u8 SCSettingOfDesc = 0; ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ //DBG_871X("SCMapping: pHalData->CurrentChannelBW %d, pHalData->nCur80MhzPrimeSC %d, pHalData->nCur40MhzPrimeSC %d \n",pHalData->CurrentChannelBW,pHalData->nCur80MhzPrimeSC,pHalData->nCur40MhzPrimeSC); ++ ++ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) ++ { ++ if(pattrib->bwmode == CHANNEL_WIDTH_80) ++ { ++ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; ++ } ++ else if(pattrib->bwmode == CHANNEL_WIDTH_40) ++ { ++ if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) ++ SCSettingOfDesc = VHT_DATA_SC_40_LOWER_OF_80MHZ; ++ else if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) ++ SCSettingOfDesc = VHT_DATA_SC_40_UPPER_OF_80MHZ; ++ else ++ DBG_871X("SCMapping: Not Correct Primary40MHz Setting \n"); ++ } ++ else ++ { ++ if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) ++ SCSettingOfDesc = VHT_DATA_SC_20_LOWEST_OF_80MHZ; ++ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) ++ SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ; ++ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) ++ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; ++ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) ++ SCSettingOfDesc = VHT_DATA_SC_20_UPPERST_OF_80MHZ; ++ else ++ DBG_871X("SCMapping: Not Correct Primary40MHz Setting \n"); ++ } ++ } ++ else if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_40) ++ { ++ //DBG_871X("SCMapping: HT Case: pHalData->CurrentChannelBW %d, pHalData->nCur40MhzPrimeSC %d \n",pHalData->CurrentChannelBW,pHalData->nCur40MhzPrimeSC); ++ ++ if(pattrib->bwmode == CHANNEL_WIDTH_40) ++ { ++ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; ++ } ++ else if(pattrib->bwmode == CHANNEL_WIDTH_20) ++ { ++ if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) ++ { ++ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; ++ } ++ else if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) ++ { ++ SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ; ++ } ++ else ++ { ++ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; ++ } ++ ++ } ++ } ++ else ++ { ++ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; ++ } ++ ++ return SCSettingOfDesc; ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/usb_halinit.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/usb_halinit.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/usb_halinit.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/usb_halinit.c 2018-02-06 17:42:30.716967253 +0200 +@@ -0,0 +1,2563 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#define _HCI_HAL_INIT_C_ @@ -283127,13 +125844,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +//#include +#include + -+#ifndef CONFIG_USB_HCI -+ -+#error "CONFIG_USB_HCI shall be on!\n" -+ -+#endif -+ -+ +static void _dbg_dump_macreg(_adapter *padapter) +{ + u32 offset = 0; @@ -283147,10 +125857,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + } +} + -+static VOID ++static void +_ConfigChipOutEP_8812( -+ IN PADAPTER pAdapter, -+ IN u8 NumOutPipe ++ PADAPTER pAdapter, ++ u8 NumOutPipe + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); @@ -283160,41 +125870,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + pHalData->OutEpNumber = 0; + + switch(NumOutPipe){ -+ case 4: ++ case 4: + pHalData->OutEpQueueSel=TX_SELE_HQ| TX_SELE_LQ|TX_SELE_NQ; + pHalData->OutEpNumber=4; -+ break; -+ case 3: ++ break; ++ case 3: + pHalData->OutEpQueueSel=TX_SELE_HQ| TX_SELE_LQ|TX_SELE_NQ; + pHalData->OutEpNumber=3; + break; -+ case 2: ++ case 2: + pHalData->OutEpQueueSel=TX_SELE_HQ| TX_SELE_NQ; + pHalData->OutEpNumber=2; + break; -+ case 1: ++ case 1: + pHalData->OutEpQueueSel=TX_SELE_HQ; + pHalData->OutEpNumber=1; + break; -+ default: ++ default: + break; -+ ++ + } + DBG_871X("%s OutEpQueueSel(0x%02x), OutEpNumber(%d) \n",__FUNCTION__,pHalData->OutEpQueueSel,pHalData->OutEpNumber ); + +} + -+static BOOLEAN HalUsbSetQueuePipeMapping8812AUsb( -+ IN PADAPTER pAdapter, -+ IN u8 NumInPipe, -+ IN u8 NumOutPipe ++static bool HalUsbSetQueuePipeMapping8812AUsb( ++ PADAPTER pAdapter, ++ u8 NumInPipe, ++ u8 NumOutPipe + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ BOOLEAN result = _FALSE; ++ bool result = false; + + _ConfigChipOutEP_8812(pAdapter, NumOutPipe); -+ ++ + // Normal chip with one IN and one OUT doesn't have interrupt IN EP. + if(1 == pHalData->OutEpNumber){ + if(1 != NumInPipe){ @@ -283208,12 +125918,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + //} + + result = Hal_MappingOutPipe(pAdapter, NumOutPipe); -+ ++ + return result; + +} + -+void rtl8812au_interface_configure(_adapter *padapter) ++static void rtl8812au_interface_configure(_adapter *padapter) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); @@ -283238,63 +125948,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + pHalData->UsbTxAggDescNum = 6; // only 4 bits + + if(IS_HARDWARE_TYPE_8812AU(padapter)) //page added for Jaguar -+ pHalData->UsbTxAggDescNum = 0x01 ; //adjust value for OQT Overflow issue //0x3; // only 4 bits ++ pHalData->UsbTxAggDescNum = 3; +#endif + +#ifdef CONFIG_USB_RX_AGGREGATION -+ if(IS_HARDWARE_TYPE_8812AU(padapter)) -+ pHalData->UsbRxAggMode = USB_RX_AGG_USB; -+ else -+ pHalData->UsbRxAggMode = USB_RX_AGG_USB; //todo: change to USB_RX_AGG_DMA; ++ pHalData->UsbRxAggMode = USB_RX_AGG_DMA;// USB_RX_AGG_DMA; + pHalData->UsbRxAggBlockCount = 8; //unit : 512b + pHalData->UsbRxAggBlockTimeout = 0x6; + pHalData->UsbRxAggPageCount = 16; //uint :128 b //0x0A; // 10 = MAX_RX_DMA_BUFFER_SIZE/2/pHalData->UsbBulkOutSize + pHalData->UsbRxAggPageTimeout = 0x6; //6, absolute time = 34ms/(2^6) + -+ if (IS_SUPER_SPEED_USB(padapter)) { -+ pHalData->RegAcUsbDmaSize = 0x7; -+ pHalData->RegAcUsbDmaTime = 0x1a; -+ } else { -+ //the setting to reduce RX FIFO overflow on USB2.0 and increase rx throughput -+ -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ u32 remainder = 0; -+ u8 quotient = 0; -+ -+ remainder = MAX_RECVBUF_SZ % (4*1024); -+ quotient = (u8)(MAX_RECVBUF_SZ >> 12); -+ -+ if (quotient > 5) { -+ pHalData->RegAcUsbDmaSize = 0x5; -+ pHalData->RegAcUsbDmaTime = 0x20; -+ } else { -+ if (remainder >= 2048) { -+ pHalData->RegAcUsbDmaSize = quotient; -+ pHalData->RegAcUsbDmaTime = 0x10; -+ } else { -+ pHalData->RegAcUsbDmaSize = (quotient-1); -+ pHalData->RegAcUsbDmaTime = 0x10; -+ } -+ } -+#else /* !CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ pHalData->RegAcUsbDmaSize = 0x5; -+ pHalData->RegAcUsbDmaTime = 0x20; -+#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ -+ } -+#endif /* CONFIG_USB_RX_AGGREGATION */ ++ pHalData->RegAcUsbDmaSize = 4; ++ pHalData->RegAcUsbDmaTime = 8; ++#endif + + HalUsbSetQueuePipeMapping8812AUsb(padapter, + pdvobjpriv->RtNumInPipes, pdvobjpriv->RtNumOutPipes); + +} + -+static VOID -+_InitBurstPktLen(IN PADAPTER Adapter) ++static void ++_InitBurstPktLen(PADAPTER Adapter) +{ + u1Byte speedvalue, provalue, temp; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ ++ + + //rtw_write16(Adapter, REG_TRXDMA_CTRL_8195, 0xf5b0); + //rtw_write16(Adapter, REG_TRXDMA_CTRL_8812, 0xf5b4); @@ -283304,21 +125982,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + //rtw_write8(Adapter, 0x3a, 0x46); + + // 0x456 = 0x70, sugguested by Zhilin -+ if(IS_HARDWARE_TYPE_8821U(Adapter)) -+ { -+ rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8812, 0x5e); -+ } -+ else -+ { -+ rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8812, 0x70); -+ } ++ rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8812, 0x70); + -+ rtw_write32(Adapter, REG_AMPDU_MAX_LENGTH_8812, 0xffffffff); ++ rtw_write32(Adapter, 0x458, 0xffffffff); + rtw_write8(Adapter, REG_USTIME_TSF, 0x50); + rtw_write8(Adapter, REG_USTIME_EDCA, 0x50); + + if(IS_HARDWARE_TYPE_8821U(Adapter)) -+ speedvalue = BIT7; ++ speedvalue = BIT7; + else + speedvalue = rtw_read8(Adapter, 0xff); //check device operation speed: SS 0xff bit7 + @@ -283329,27 +126000,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + { + pHalData->UsbBulkOutSize = USB_HIGH_SPEED_BULK_SIZE; + provalue = rtw_read8(Adapter, REG_RXDMA_PRO_8812); -+ rtw_write8(Adapter, REG_RXDMA_PRO_8812, ((provalue|BIT(4)|BIT(3)|BIT(2)|BIT(1))&(~BIT(5)))); //set burst pkt len=512B ++ rtw_write8(Adapter, REG_RXDMA_PRO_8812, ((provalue|BIT(4))&(~BIT(5)))); //set burst pkt len=512B ++ rtw_write16(Adapter, REG_RXDMA_PRO_8812, 0x1e); + } + else + { + pHalData->UsbBulkOutSize = 64; + provalue = rtw_read8(Adapter, REG_RXDMA_PRO_8812); -+ rtw_write8(Adapter, REG_RXDMA_PRO_8812, ((provalue|BIT(5)|BIT(3)|BIT(2)|BIT(1))&(~BIT(4)))); //set burst pkt len=64B ++ rtw_write8(Adapter, REG_RXDMA_PRO_8812, ((provalue|BIT(5))&(~BIT(4)))); //set burst pkt len=64B + } -+ ++ ++ rtw_write16(Adapter, REG_RXDMA_AGG_PG_TH,0x2005); //dmc agg th 20K ++ + //rtw_write8(Adapter, 0x10c, 0xb4); + //hal_UphyUpdate8812AU(Adapter); + -+ pHalData->bSupportUSB3 = _FALSE; ++ pHalData->bSupportUSB3 = false; + } + else //USB3 Mode + { + pHalData->UsbBulkOutSize = USB_SUPER_SPEED_BULK_SIZE; + provalue = rtw_read8(Adapter, REG_RXDMA_PRO_8812); -+ rtw_write8(Adapter, REG_RXDMA_PRO_8812, ((provalue|BIT(3)|BIT(2)|BIT(1))&(~(BIT5|BIT4)))); //set burst pkt len=1k ++ rtw_write8(Adapter, REG_RXDMA_PRO_8812, provalue&(~(BIT5|BIT4))); //set burst pkt len=1k ++ rtw_write16(Adapter, REG_RXDMA_PRO_8812, 0x0e); + //PlatformEFIOWrite2Byte(Adapter, REG_RXDMA_AGG_PG_TH,0x0a05); //dmc agg th 20K -+ pHalData->bSupportUSB3 = _TRUE; ++ pHalData->bSupportUSB3 = true; + + // set Reg 0xf008[3:4] to 2'00 to disable U1/U2 Mode to avoid 2.5G spur in USB3.0. added by page, 20120712 + rtw_write8(Adapter, 0xf008, rtw_read8(Adapter, 0xf008)&0xE7); @@ -283360,25 +126035,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +#else + rtw_write8(Adapter, REG_TDECTRL, 0x10); +#endif -+ ++ + temp = rtw_read8(Adapter, REG_SYS_FUNC_EN); + rtw_write8(Adapter, REG_SYS_FUNC_EN, temp&(~BIT(10))); //reset 8051 -+ ++ + rtw_write8(Adapter, REG_HT_SINGLE_AMPDU_8812,rtw_read8(Adapter, REG_HT_SINGLE_AMPDU_8812)|BIT(7)); //enable single pkt ampdu + rtw_write8(Adapter, REG_RX_PKT_LIMIT, 0x18); //for VHT packet length 11K + + rtw_write8(Adapter, REG_PIFS, 0x00); + -+ if(IS_HARDWARE_TYPE_8821U(Adapter) && (Adapter->registrypriv.wifi_spec == _FALSE)) ++ //Suggention by SD1 Jong and Pisa, by Maddest 20130107. ++ if(IS_HARDWARE_TYPE_8821U(Adapter) && (Adapter->registrypriv.wifi_spec == false)) + { -+ //0x0a0a too small , it can't pass AC logo. change to 0x1f1f -+ rtw_write16(Adapter, REG_MAX_AGGR_NUM, 0x1f1f); ++ rtw_write16(Adapter, REG_MAX_AGGR_NUM, 0x0a0a); + rtw_write8(Adapter, REG_FWHW_TXQ_CTRL, 0x80); ++ rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8812, 0x5e); + rtw_write32(Adapter, REG_FAST_EDCA_CTRL, 0x03087777); + } + else + { -+ rtw_write16(Adapter, REG_MAX_AGGR_NUM, 0x1f1f); ++ rtw_write8(Adapter, REG_MAX_AGGR_NUM, 0x1f); + rtw_write8(Adapter, REG_FWHW_TXQ_CTRL, rtw_read8(Adapter, REG_FWHW_TXQ_CTRL)&(~BIT(7))); + } + @@ -283386,36 +126062,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + { + rtw_write8(Adapter,REG_AMPDU_BURST_MODE_8812, 0x5F); + } -+ ++ + rtw_write8(Adapter, 0x1c, rtw_read8(Adapter, 0x1c) | BIT(5) |BIT(6)); //to prevent mac is reseted by bus. 20111208, by Page + + // ARFB table 9 for 11ac 5G 2SS -+ rtw_write32(Adapter, REG_ARFR0_8812, 0x00000010); -+ rtw_write32(Adapter, REG_ARFR0_8812+4, 0xfffff000); ++ rtw_write32(Adapter, REG_ARFR0, 0x00000010); ++ if(IS_NORMAL_CHIP(pHalData->VersionID)) ++ rtw_write32(Adapter, REG_ARFR0+4, 0xfffff000); ++ else ++ rtw_write32(Adapter, REG_ARFR0+4, 0x3e0ff000); + + // ARFB table 10 for 11ac 5G 1SS -+ rtw_write32(Adapter, REG_ARFR1_8812, 0x00000010); -+ rtw_write32(Adapter, REG_ARFR1_8812+4, 0x003ff000); ++ rtw_write32(Adapter, REG_ARFR1, 0x00000010); ++ if(IS_VENDOR_8812A_TEST_CHIP(Adapter)) ++ rtw_write32(Adapter, REG_ARFR1_8812+4, 0x000ff000); ++ else ++ rtw_write32(Adapter, REG_ARFR1_8812+4, 0x003ff000); + -+ // ARFB table 11 for 11ac 24G 1SS -+ rtw_write32(Adapter, REG_ARFR2_8812, 0x00000015); -+ rtw_write32(Adapter, REG_ARFR2_8812+4, 0x003ff000); -+ // ARFB table 12 for 11ac 24G 2SS -+ rtw_write32(Adapter, REG_ARFR3_8812, 0x00000015); -+ rtw_write32(Adapter, REG_ARFR3_8812+4, 0xffcff000); +} + -+static u32 _InitPowerOn_8812AU(_adapter *padapter) ++static u32 _InitPowerOn8812AU(_adapter *padapter) +{ + u16 u2btmp = 0; + u8 u1btmp = 0; -+ u8 bMacPwrCtrlOn=_FALSE; -+ // HW Power on sequence + -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if(bMacPwrCtrlOn == _TRUE) -+ return _SUCCESS; -+ + if(IS_VENDOR_8821A_MP_CHIP(padapter)) + { + // HW Power on sequence @@ -283447,19 +126117,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + | PROTOCOL_EN | SCHEDULE_EN | ENSEC | CALTMR_EN); + rtw_write16(padapter, REG_CR, u2btmp); + -+ //Need remove below furture, suggest by Jackie. ++ //Need remove below furture, suggest by Jackie. + // if 0xF0[24] =1 (LDO), need to set the 0x7C[6] to 1. + if(IS_HARDWARE_TYPE_8821U(padapter)) + { + u1btmp = rtw_read8(padapter, REG_SYS_CFG+3); + if(u1btmp & BIT0) //LDO mode. + { -+ u1btmp =rtw_read8(padapter, 0x7c); ++ u1btmp =rtw_read8(padapter, 0x7c); + rtw_write8(padapter,0x7c,u1btmp | BIT6); + } + } -+ bMacPwrCtrlOn = _TRUE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); + + return _SUCCESS; +} @@ -283475,9 +126143,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +//--------------------------------------------------------------- + +// Shall USB interface init this? -+static VOID ++static void +_InitInterrupt_8812AU( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -283487,9 +126155,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + rtw_write32(Adapter, REG_HIMR1_8812, pHalData->IntrMask[1]&0xFFFFFFFF); +} + -+static VOID ++static void +_InitQueueReservedPage_8821AUsb( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -283500,45 +126168,47 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + u32 numPubQ = 0; + u32 value32; + u8 value8; -+ BOOLEAN bWiFiConfig = pregistrypriv->wifi_spec; ++ bool bWiFiConfig = pregistrypriv->wifi_spec; + + if(!bWiFiConfig) -+ { ++ { ++ numPubQ = NORMAL_PAGE_NUM_PUBQ_8821; ++ + if(pHalData->OutEpQueueSel & TX_SELE_HQ) + { + numHQ = NORMAL_PAGE_NUM_HPQ_8821; + } -+ ++ + if(pHalData->OutEpQueueSel & TX_SELE_LQ) + { + numLQ = NORMAL_PAGE_NUM_LPQ_8821; + } -+ -+ // NOTE: This step shall be proceed before writting REG_RQPN. ++ ++ // NOTE: This step shall be proceed before writting REG_RQPN. + if(pHalData->OutEpQueueSel & TX_SELE_NQ){ + numNQ = NORMAL_PAGE_NUM_NPQ_8821; + } + } + else -+ { // WMM ++ { // WMM ++ numPubQ = WMM_NORMAL_PAGE_NUM_PUBQ_8821; ++ + if(pHalData->OutEpQueueSel & TX_SELE_HQ) + { + numHQ = WMM_NORMAL_PAGE_NUM_HPQ_8821; + } -+ ++ + if(pHalData->OutEpQueueSel & TX_SELE_LQ) + { + numLQ = WMM_NORMAL_PAGE_NUM_LPQ_8821; + } -+ -+ // NOTE: This step shall be proceed before writting REG_RQPN. ++ ++ // NOTE: This step shall be proceed before writting REG_RQPN. + if(pHalData->OutEpQueueSel & TX_SELE_NQ){ + numNQ = WMM_NORMAL_PAGE_NUM_NPQ_8821; + } + } + -+ numPubQ = TX_TOTAL_PAGE_NUMBER_8821 - numHQ - numLQ - numNQ; -+ + value8 = (u8)_NPQ(numNQ); + rtw_write8(Adapter, REG_RQPN_NPQ, value8); + @@ -283547,9 +126217,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + rtw_write32(Adapter, REG_RQPN, value32); +} + -+static VOID ++static void +_InitQueueReservedPage_8812AUsb( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -283560,45 +126230,47 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + u32 numPubQ = 0; + u32 value32; + u8 value8; -+ BOOLEAN bWiFiConfig = pregistrypriv->wifi_spec; ++ bool bWiFiConfig = pregistrypriv->wifi_spec; + + if(!bWiFiConfig) -+ { ++ { ++ numPubQ = NORMAL_PAGE_NUM_PUBQ_8812; ++ + if(pHalData->OutEpQueueSel & TX_SELE_HQ) + { + numHQ = NORMAL_PAGE_NUM_HPQ_8812; + } -+ ++ + if(pHalData->OutEpQueueSel & TX_SELE_LQ) + { + numLQ = NORMAL_PAGE_NUM_LPQ_8812; + } -+ -+ // NOTE: This step shall be proceed before writting REG_RQPN. ++ ++ // NOTE: This step shall be proceed before writting REG_RQPN. + if(pHalData->OutEpQueueSel & TX_SELE_NQ){ + numNQ = NORMAL_PAGE_NUM_NPQ_8812; + } + } + else -+ { // WMM ++ { // WMM ++ numPubQ = WMM_NORMAL_PAGE_NUM_PUBQ_8812; ++ + if(pHalData->OutEpQueueSel & TX_SELE_HQ) + { + numHQ = WMM_NORMAL_PAGE_NUM_HPQ_8812; + } -+ ++ + if(pHalData->OutEpQueueSel & TX_SELE_LQ) + { + numLQ = WMM_NORMAL_PAGE_NUM_LPQ_8812; + } -+ -+ // NOTE: This step shall be proceed before writting REG_RQPN. ++ ++ // NOTE: This step shall be proceed before writting REG_RQPN. + if(pHalData->OutEpQueueSel & TX_SELE_NQ){ + numNQ = WMM_NORMAL_PAGE_NUM_NPQ_8812; + } + } + -+ numPubQ = TX_TOTAL_PAGE_NUMBER_8812 - numHQ - numLQ - numNQ; -+ + value8 = (u8)_NPQ(numNQ); + rtw_write8(Adapter, REG_RQPN_NPQ, value8); + @@ -283607,18 +126279,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + rtw_write32(Adapter, REG_RQPN, value32); +} + -+static void _InitID_8812A(IN PADAPTER Adapter) ++static void _InitID_8812A( PADAPTER Adapter) +{ + hal_init_macaddr(Adapter);//set mac_address +} + -+static VOID ++static void +_InitTxBufferBoundary_8821AUsb( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) -+{ ++{ + struct registry_priv *pregistrypriv = &Adapter->registrypriv; -+ u8 txpktbuf_bndy; ++ u8 txpktbuf_bndy; + + if(!pregistrypriv->wifi_spec){ + txpktbuf_bndy = TX_PAGE_BOUNDARY_8821; @@ -283631,25 +126303,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + rtw_write8(Adapter, REG_BCNQ_BDNY, txpktbuf_bndy); + rtw_write8(Adapter, REG_MGQ_BDNY, txpktbuf_bndy); + rtw_write8(Adapter, REG_WMAC_LBK_BF_HD, txpktbuf_bndy); -+ rtw_write8(Adapter, REG_TRXFF_BNDY, txpktbuf_bndy); ++ rtw_write8(Adapter, REG_TRXFF_BNDY, txpktbuf_bndy); + rtw_write8(Adapter, REG_TDECTRL+1, txpktbuf_bndy); + +#ifdef CONFIG_CONCURRENT_MODE + rtw_write8(Adapter, REG_BCNQ1_BDNY, txpktbuf_bndy+8); -+ rtw_write8(Adapter, REG_DWBCN1_CTRL_8812+1, txpktbuf_bndy+8);//BCN1_HEAD ++ rtw_write8(Adapter, REG_TDECTRL1_8812+1, txpktbuf_bndy+8);//BCN1_HEAD + // BIT1- BIT_SW_BCN_SEL_EN -+ rtw_write8(Adapter, REG_DWBCN1_CTRL_8812+2, rtw_read8(Adapter, REG_DWBCN1_CTRL_8812+2)|BIT1); ++ rtw_write8(Adapter, REG_TDECTRL1_8812+2, rtw_read8(Adapter, REG_TDECTRL1_8812+2)|BIT1); +#endif -+ ++ +} + -+static VOID ++static void +_InitTxBufferBoundary_8812AUsb( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) -+{ ++{ + struct registry_priv *pregistrypriv = &Adapter->registrypriv; -+ u8 txpktbuf_bndy; ++ u8 txpktbuf_bndy; + + if(!pregistrypriv->wifi_spec){ + txpktbuf_bndy = TX_PAGE_BOUNDARY_8812; @@ -283662,68 +126334,68 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + rtw_write8(Adapter, REG_BCNQ_BDNY, txpktbuf_bndy); + rtw_write8(Adapter, REG_MGQ_BDNY, txpktbuf_bndy); + rtw_write8(Adapter, REG_WMAC_LBK_BF_HD, txpktbuf_bndy); -+ rtw_write8(Adapter, REG_TRXFF_BNDY, txpktbuf_bndy); ++ rtw_write8(Adapter, REG_TRXFF_BNDY, txpktbuf_bndy); + rtw_write8(Adapter, REG_TDECTRL+1, txpktbuf_bndy); -+ ++ +} + -+static VOID ++static void +_InitPageBoundary_8812AUsb( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ -+ //u2Byte rxff_bndy; ++ //u2Byte rxff_bndy; + //u2Byte Offset; -+ //BOOLEAN bSupportRemoteWakeUp; -+ ++ //bool bSupportRemoteWakeUp; ++ + //Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_WOWLAN , &bSupportRemoteWakeUp); + // RX Page Boundary + //srand(static_cast(time(NULL)) ); -+ ++ +// Offset = MAX_RX_DMA_BUFFER_SIZE_8812/256; +// rxff_bndy = (Offset*256)-1; + + if(IS_HARDWARE_TYPE_8812(Adapter)) -+ rtw_write16(Adapter, (REG_TRXFF_BNDY + 2), RX_DMA_BOUNDARY_8812); -+ else -+ rtw_write16(Adapter, (REG_TRXFF_BNDY + 2), RX_DMA_BOUNDARY_8821); -+ ++ rtw_write16(Adapter, (REG_TRXFF_BNDY + 2), MAX_RX_DMA_BUFFER_SIZE_8812-1); ++ else ++ rtw_write16(Adapter, (REG_TRXFF_BNDY + 2), MAX_RX_DMA_BUFFER_SIZE_8821-1); ++ +} + + -+static VOID ++static void +_InitNormalChipRegPriority_8812AUsb( -+ IN PADAPTER Adapter, -+ IN u16 beQ, -+ IN u16 bkQ, -+ IN u16 viQ, -+ IN u16 voQ, -+ IN u16 mgtQ, -+ IN u16 hiQ ++ PADAPTER Adapter, ++ u16 beQ, ++ u16 bkQ, ++ u16 viQ, ++ u16 voQ, ++ u16 mgtQ, ++ u16 hiQ + ) +{ + u16 value16 = (rtw_read16(Adapter, REG_TRXDMA_CTRL) & 0x7); + -+ value16 |= _TXDMA_BEQ_MAP(beQ) | _TXDMA_BKQ_MAP(bkQ) | -+ _TXDMA_VIQ_MAP(viQ) | _TXDMA_VOQ_MAP(voQ) | ++ value16 |= _TXDMA_BEQ_MAP(beQ) | _TXDMA_BKQ_MAP(bkQ) | ++ _TXDMA_VIQ_MAP(viQ) | _TXDMA_VOQ_MAP(voQ) | + _TXDMA_MGQ_MAP(mgtQ)| _TXDMA_HIQ_MAP(hiQ); -+ ++ + rtw_write16(Adapter, REG_TRXDMA_CTRL, value16); +} + -+static VOID ++static void +_InitNormalChipTwoOutEpPriority_8812AUsb( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + struct registry_priv *pregistrypriv = &Adapter->registrypriv; + u16 beQ,bkQ,viQ,voQ,mgtQ,hiQ; -+ ++ + + u16 valueHi = 0; + u16 valueLow = 0; -+ ++ + switch(pHalData->OutEpQueueSel) + { + case (TX_SELE_HQ | TX_SELE_LQ): @@ -283749,25 +126421,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + bkQ = valueLow; + viQ = valueHi; + voQ = valueHi; -+ mgtQ = valueHi; -+ hiQ = valueHi; ++ mgtQ = valueHi; ++ hiQ = valueHi; + } + else{//for WMM ,CONFIG_OUT_EP_WIFI_MODE + beQ = valueLow; -+ bkQ = valueHi; ++ bkQ = valueHi; + viQ = valueHi; + voQ = valueLow; + mgtQ = valueHi; -+ hiQ = valueHi; ++ hiQ = valueHi; + } + + _InitNormalChipRegPriority_8812AUsb(Adapter,beQ,bkQ,viQ,voQ,mgtQ,hiQ); + +} + -+static VOID ++static void +_InitNormalChipThreeOutEpPriority_8812AUsb( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + struct registry_priv *pregistrypriv = &Adapter->registrypriv; @@ -283775,26 +126447,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + + if(!pregistrypriv->wifi_spec ){// typical setting + beQ = QUEUE_LOW; -+ bkQ = QUEUE_LOW; -+ viQ = QUEUE_NORMAL; -+ voQ = QUEUE_HIGH; -+ mgtQ = QUEUE_HIGH; -+ hiQ = QUEUE_HIGH; ++ bkQ = QUEUE_LOW; ++ viQ = QUEUE_NORMAL; ++ voQ = QUEUE_HIGH; ++ mgtQ = QUEUE_HIGH; ++ hiQ = QUEUE_HIGH; + } + else{// for WMM + beQ = QUEUE_LOW; -+ bkQ = QUEUE_NORMAL; -+ viQ = QUEUE_NORMAL; -+ voQ = QUEUE_HIGH; -+ mgtQ = QUEUE_HIGH; -+ hiQ = QUEUE_HIGH; ++ bkQ = QUEUE_NORMAL; ++ viQ = QUEUE_NORMAL; ++ voQ = QUEUE_HIGH; ++ mgtQ = QUEUE_HIGH; ++ hiQ = QUEUE_HIGH; + } + _InitNormalChipRegPriority_8812AUsb(Adapter,beQ,bkQ,viQ,voQ,mgtQ,hiQ); +} + -+static VOID ++static void +_InitQueuePriority_8812AUsb( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -283816,21 +126488,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + + + -+static VOID ++static void +_InitHardwareDropIncorrectBulkOut_8812A( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ -+#ifdef ENABLE_USB_DROP_INCORRECT_OUT + u32 value32 = rtw_read32(Adapter, REG_TXDMA_OFFSET_CHK); + value32 |= DROP_DATA_EN; + rtw_write32(Adapter, REG_TXDMA_OFFSET_CHK, value32); -+#endif +} + -+static VOID ++static void +_InitNetworkType_8812A( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + u32 value32; @@ -283842,48 +126512,44 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + rtw_write32(Adapter, REG_CR, value32); +} + -+static VOID ++static void +_InitTransferPageSize_8812AUsb( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ -+ ++ + u8 value8; + value8 = _PSTX(PBP_512); + + PlatformEFIOWrite1Byte(Adapter, REG_PBP, value8); +} + -+static VOID ++static void +_InitDriverInfoSize_8812A( -+ IN PADAPTER Adapter, -+ IN u8 drvInfoSize ++ PADAPTER Adapter, ++ u8 drvInfoSize + ) +{ + rtw_write8(Adapter,REG_RX_DRVINFO_SZ, drvInfoSize); +} + -+static VOID ++static void +_InitWMACSetting_8812A( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + //u4Byte value32; -+ u16 value16; ++ //u16 value16; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + + //pHalData->ReceiveConfig = AAP | APM | AM | AB | APP_ICV | ADF | AMF | APP_FCS | HTC_LOC_CTRL | APP_MIC | APP_PHYSTS; -+ pHalData->ReceiveConfig = -+ RCR_APM | RCR_AM | RCR_AB |RCR_CBSSID_DATA| RCR_CBSSID_BCN| RCR_APP_ICV | RCR_AMF | RCR_HTC_LOC_CTRL | RCR_APP_MIC | RCR_APP_PHYST_RXFF; ++ pHalData->ReceiveConfig = ++ RCR_APM | RCR_AM | RCR_AB |RCR_CBSSID_DATA| RCR_CBSSID_BCN| RCR_APP_ICV | RCR_AMF | RCR_HTC_LOC_CTRL | RCR_APP_MIC | RCR_APP_PHYST_RXFF; + +#if (1 == RTL8812A_RX_PACKET_INCLUDE_CRC) + pHalData->ReceiveConfig |= ACRC32; +#endif + -+#ifdef CONFIG_RX_PACKET_APPEND_FCS -+ pHalData->ReceiveConfig |= RCR_APPFCS; -+#endif -+ + if(IS_HARDWARE_TYPE_8812AU(Adapter) || IS_HARDWARE_TYPE_8821U(Adapter)) + pHalData->ReceiveConfig |= FORCEACK; + @@ -283902,25 +126568,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + // 2010.09.08 hpfan + // Since ADF is removed from RCR, ps-poll will not be indicate to driver, + // RxFilterMap should mask ps-poll to gurantee AP mode can rx ps-poll. -+ value16 = BIT10; -+#ifdef CONFIG_BEAMFORMING -+ // NDPA packet subtype is 0x0101 -+ value16 |= BIT5; -+#endif/*CONFIG_BEAMFORMING*/ -+ rtw_write16(Adapter, REG_RXFLTMAP1, value16); ++ //value16 = 0x400; ++ //rtw_write16(Adapter, REG_RXFLTMAP1, value16); + + // Accept all management frames + //value16 = 0xFFFF; + //rtw_write16(Adapter, REG_RXFLTMAP0, value16); + + //enable RX_SHIFT bits -+ //rtw_write8(Adapter, REG_TRXDMA_CTRL, rtw_read8(Adapter, REG_TRXDMA_CTRL)|BIT(1)); ++ //rtw_write8(Adapter, REG_TRXDMA_CTRL, rtw_read8(Adapter, REG_TRXDMA_CTRL)|BIT(1)); + +} + -+static VOID ++static void +_InitAdaptiveCtrl_8812AUsb( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + u16 value16; @@ -283948,12 +126610,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + // Retry Limit + value16 = _LRL(0x30) | _SRL(0x30); + rtw_write16(Adapter, REG_RL, value16); -+ ++ +} + -+static VOID ++static void +_InitEDCA_8812AUsb( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + // Set Spec SIFS (used in NAV) @@ -283961,7 +126623,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + rtw_write16(Adapter,REG_MAC_SPEC_SIFS, 0x100a); + + // Set SIFS for CCK -+ rtw_write16(Adapter,REG_SIFS_CTX, 0x100a); ++ rtw_write16(Adapter,REG_SIFS_CTX, 0x100a); + + // Set SIFS for OFDM + rtw_write16(Adapter,REG_SIFS_TRX, 0x100a); @@ -283978,16 +126640,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +} + + -+static VOID ++static void +_InitBeaconMaxError_8812A( -+ IN PADAPTER Adapter, -+ IN BOOLEAN InfraMode ++ PADAPTER Adapter, ++ bool InfraMode + ) +{ -+#ifdef CONFIG_ADHOC_WORKAROUND_SETTING -+ rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF); ++#ifdef RTL8192CU_ADHOC_WORKAROUND_SETTING ++ rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF); +#else -+ //rtw_write8(Adapter, REG_BCN_MAX_ERR, (InfraMode ? 0xFF : 0x10)); ++ //rtw_write8(Adapter, REG_BCN_MAX_ERR, (InfraMode ? 0xFF : 0x10)); +#endif +} + @@ -283996,20 +126658,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +static void _InitHWLed(PADAPTER Adapter) +{ + struct led_priv *pledpriv = &(Adapter->ledpriv); -+ ++ + if( pledpriv->LedStrategy != HW_LED) + return; -+ ++ +// HW led control -+// to do .... ++// to do .... +//must consider cases of antenna diversity/ commbo card/solo card/mini card + +} +#endif //CONFIG_LED + -+static VOID ++static void +_InitRDGSetting_8812A( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + rtw_write8(Adapter,REG_RD_CTRL,0xFF); @@ -284017,13 +126679,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + rtw_write8(Adapter,REG_RD_RESP_PKT_TH,0x05); +} + -+static VOID ++static void ++_InitRxSetting_8812AU( ++ PADAPTER Adapter ++ ) ++{ ++ rtw_write32(Adapter, REG_MACID, 0x87654321); ++ rtw_write32(Adapter, 0x0700, 0x87654321); ++} ++ ++static void +_InitRetryFunction_8812A( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + u8 value8; -+ ++ + value8 = rtw_read8(Adapter, REG_FWHW_TXQ_CTRL); + value8 |= EN_AMPDU_RTY_NEW; + rtw_write8(Adapter, REG_FWHW_TXQ_CTRL, value8); @@ -284036,7 +126707,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +/*----------------------------------------------------------------------------- + * Function: usb_AggSettingTxUpdate() + * -+ * Overview: Seperate TX/RX parameters update independent for TP detection and ++ * Overview: Seperate TX/RX parameters update independent for TP detection and + * dynamic TX/RX aggreagtion parameters update. + * + * Input: PADAPTER @@ -284048,9 +126719,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + * 12/10/2010 MHC Seperate to smaller function. + * + *---------------------------------------------------------------------------*/ -+static VOID ++static void +usb_AggSettingTxUpdate_8812A( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ +#ifdef CONFIG_USB_TX_AGGREGATION @@ -284058,18 +126729,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + u32 value32; + + if(Adapter->registrypriv.wifi_spec) -+ pHalData->UsbTxAggMode = _FALSE; ++ pHalData->UsbTxAggMode = false; + + if(pHalData->UsbTxAggMode){ + value32 = rtw_read32(Adapter, REG_TDECTRL); + value32 = value32 & ~(BLK_DESC_NUM_MASK << BLK_DESC_NUM_SHIFT); + value32 |= ((pHalData->UsbTxAggDescNum & BLK_DESC_NUM_MASK) << BLK_DESC_NUM_SHIFT); -+ -+ rtw_write32(Adapter, REG_DWBCN0_CTRL_8812, value32); -+ if(IS_HARDWARE_TYPE_8821U(Adapter)) //page added for Jaguar -+ rtw_write8(Adapter, REG_DWBCN1_CTRL_8812, pHalData->UsbTxAggDescNum<<1); ++ ++ rtw_write32(Adapter, REG_TDECTRL, value32); + } -+ ++ +#endif +} // usb_AggSettingTxUpdate + @@ -284077,7 +126746,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +/*----------------------------------------------------------------------------- + * Function: usb_AggSettingRxUpdate() + * -+ * Overview: Seperate TX/RX parameters update independent for TP detection and ++ * Overview: Seperate TX/RX parameters update independent for TP detection and + * dynamic TX/RX aggreagtion parameters update. + * + * Input: PADAPTER @@ -284089,9 +126758,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + * 12/10/2010 MHC Seperate to smaller function. + * + *---------------------------------------------------------------------------*/ -+static VOID ++static void +usb_AggSettingRxUpdate_8812A( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ +#ifdef CONFIG_USB_RX_AGGREGATION @@ -284100,10 +126769,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + u8 valueUSB; + + valueDMA = rtw_read8(Adapter, REG_TRXDMA_CTRL); ++ + switch(pHalData->UsbRxAggMode) + { + case USB_RX_AGG_DMA: + valueDMA |= RXDMA_AGG_EN; ++ ++ //rtw_write8(Adapter, REG_RXDMA_AGG_PG_TH, 0x05); //dma agg mode, 20k + // + // 2012/10/26 MH For TX throught start rate temp fix. + // @@ -284112,25 +126784,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + + //Adjust DMA page and thresh. + temp = pHalData->RegAcUsbDmaSize | (pHalData->RegAcUsbDmaTime<<8); -+ rtw_write16(Adapter, REG_RXDMA_AGG_PG_TH, temp); -+ rtw_write8(Adapter, REG_RXDMA_AGG_PG_TH+3, BIT(7)); //for dma agg , 0x280[31]GBIT_RXDMA_AGG_OLD_MOD, set 1 ++ rtw_write16(Adapter, REG_RXDMA_AGG_PG_TH, temp); + } + break; + case USB_RX_AGG_USB: -+ valueDMA |= RXDMA_AGG_EN; -+ { -+ u16 temp; -+ -+ //Adjust DMA page and thresh. -+ temp = pHalData->RegAcUsbDmaSize | (pHalData->RegAcUsbDmaTime<<8); -+ rtw_write16(Adapter, REG_RXDMA_AGG_PG_TH, temp); -+ } -+ -+ break; + case USB_RX_AGG_MIX: + case USB_RX_AGG_DISABLE: + default: -+ // TODO: ++ // TODO: + break; + } + @@ -284138,9 +126799,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +#endif +} // usb_AggSettingRxUpdate + -+static VOID ++static void +init_UsbAggregationSetting_8812A( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -284152,7 +126813,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + usb_AggSettingRxUpdate_8812A(Adapter); + + // 201/12/10 MH Add for USB agg mode dynamic switch. -+ pHalData->UsbRxHighSpeedMode = _FALSE; ++ pHalData->UsbRxHighSpeedMode = false; +} + +/*----------------------------------------------------------------------------- @@ -284171,171 +126832,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + * + * Revised History: + * When Who Remark -+ * 12/10/2010 MHC Create Version 0. ++ * 12/10/2010 MHC Create Version 0. + * + *---------------------------------------------------------------------------*/ -+VOID ++static void +USB_AggModeSwitch( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ -+#if 0 -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ -+ //pHalData->UsbRxHighSpeedMode = FALSE; -+ // How to measure the RX speed? We assume that when traffic is more than -+ if (pMgntInfo->bRegAggDMEnable == FALSE) -+ { -+ return; // Inf not support. -+ } -+ -+ -+ if (pMgntInfo->LinkDetectInfo.bHigherBusyRxTraffic == TRUE && -+ pHalData->UsbRxHighSpeedMode == FALSE) -+ { -+ pHalData->UsbRxHighSpeedMode = TRUE; -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("UsbAggModeSwitchCheck to HIGH\n")); -+ } -+ else if (pMgntInfo->LinkDetectInfo.bHigherBusyRxTraffic == FALSE && -+ pHalData->UsbRxHighSpeedMode == TRUE) -+ { -+ pHalData->UsbRxHighSpeedMode = FALSE; -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("UsbAggModeSwitchCheck to LOW\n")); -+ } -+ else -+ { -+ return; -+ } -+ -+ -+#if USB_RX_AGGREGATION_92C -+ if (pHalData->UsbRxHighSpeedMode == TRUE) -+ { -+ // 2010/12/10 MH The parameter is tested by SD1 engineer and SD3 channel emulator. -+ // USB mode -+#if (RT_PLATFORM == PLATFORM_LINUX) -+ if (pMgntInfo->LinkDetectInfo.bTxBusyTraffic) -+ { -+ pHalData->RxAggBlockCount = 16; -+ pHalData->RxAggBlockTimeout = 7; -+ } -+ else -+#endif -+ { -+ pHalData->RxAggBlockCount = 40; -+ pHalData->RxAggBlockTimeout = 5; -+ } -+ // Mix mode -+ pHalData->RxAggPageCount = 72; -+ pHalData->RxAggPageTimeout = 6; -+ } -+ else -+ { -+ // USB mode -+ pHalData->RxAggBlockCount = pMgntInfo->RegRxAggBlockCount; -+ pHalData->RxAggBlockTimeout = pMgntInfo->RegRxAggBlockTimeout; -+ // Mix mode -+ pHalData->RxAggPageCount = pMgntInfo->RegRxAggPageCount; -+ pHalData->RxAggPageTimeout = pMgntInfo->RegRxAggPageTimeout; -+ } -+ -+ if (pHalData->RxAggBlockCount > MAX_RX_AGG_BLKCNT) -+ pHalData->RxAggBlockCount = MAX_RX_AGG_BLKCNT; -+#if (OS_WIN_FROM_VISTA(OS_VERSION)) || (RT_PLATFORM == PLATFORM_LINUX) // do not support WINXP to prevent usbehci.sys BSOD -+ if (IS_WIRELESS_MODE_N_24G(Adapter) || IS_WIRELESS_MODE_N_5G(Adapter)) -+ { -+ // -+ // 2010/12/24 MH According to V1012 QC IOT test, XP BSOD happen when running chariot test -+ // with the aggregation dynamic change!! We need to disable the function to prevent it is broken -+ // in usbehci.sys. -+ // -+ usb_AggSettingRxUpdate_8188E(Adapter); -+ -+ // 2010/12/27 MH According to designer's suggstion, we can only modify Timeout value. Otheriwse -+ // there might many HW incorrect behavior, the XP BSOD at usbehci.sys may be relative to the -+ // issue. Base on the newest test, we can not enable block cnt > 30, otherwise XP usbehci.sys may -+ // BSOD. -+ } -+#endif -+ -+#endif -+#endif +} // USB_AggModeSwitch + -+static VOID ++static void +_InitOperationMode_8812A( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ -+#if 0//gtest -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ u1Byte regBwOpMode = 0; -+ u4Byte regRATR = 0, regRRSR = 0; -+ -+ -+ //1 This part need to modified according to the rate set we filtered!! -+ // -+ // Set RRSR, RATR, and REG_BWOPMODE registers -+ // -+ switch(Adapter->RegWirelessMode) -+ { -+ case WIRELESS_MODE_B: -+ regBwOpMode = BW_OPMODE_20MHZ; -+ regRATR = RATE_ALL_CCK; -+ regRRSR = RATE_ALL_CCK; -+ break; -+ case WIRELESS_MODE_A: -+ regBwOpMode = BW_OPMODE_5G |BW_OPMODE_20MHZ; -+ regRATR = RATE_ALL_OFDM_AG; -+ regRRSR = RATE_ALL_OFDM_AG; -+ break; -+ case WIRELESS_MODE_G: -+ regBwOpMode = BW_OPMODE_20MHZ; -+ regRATR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; -+ regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; -+ break; -+ case WIRELESS_MODE_AUTO: -+ if (Adapter->bInHctTest) -+ { -+ regBwOpMode = BW_OPMODE_20MHZ; -+ regRATR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; -+ regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; -+ } -+ else -+ { -+ regBwOpMode = BW_OPMODE_20MHZ; -+ regRATR = RATE_ALL_CCK | RATE_ALL_OFDM_AG | RATE_ALL_OFDM_1SS | RATE_ALL_OFDM_2SS; -+ regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; -+ } -+ break; -+ case WIRELESS_MODE_N_24G: -+ // It support CCK rate by default. -+ // CCK rate will be filtered out only when associated AP does not support it. -+ regBwOpMode = BW_OPMODE_20MHZ; -+ regRATR = RATE_ALL_CCK | RATE_ALL_OFDM_AG | RATE_ALL_OFDM_1SS | RATE_ALL_OFDM_2SS; -+ regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; -+ break; -+ case WIRELESS_MODE_N_5G: -+ regBwOpMode = BW_OPMODE_5G; -+ regRATR = RATE_ALL_OFDM_AG | RATE_ALL_OFDM_1SS | RATE_ALL_OFDM_2SS; -+ regRRSR = RATE_ALL_OFDM_AG; -+ break; -+ -+ default: //for MacOSX compiler warning. -+ break; -+ } -+ -+ // Ziv ???????? -+ //PlatformEFIOWrite4Byte(Adapter, REG_INIRTS_RATE_SEL, regRRSR); -+ PlatformEFIOWrite1Byte(Adapter, REG_BWOPMODE, regBwOpMode); -+#endif +} + + +// Set CCK and OFDM Block "ON" -+static VOID _BBTurnOnBlock( -+ IN PADAPTER Adapter ++static void _BBTurnOnBlock( ++ PADAPTER Adapter + ) +{ +#if (DISABLE_BB_RF) @@ -284346,65 +126863,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + PHY_SetBBReg(Adapter, rFPGA0_RFMOD, bOFDMEn, 0x1); +} + -+static VOID _RfPowerSave( -+ IN PADAPTER Adapter ++static void _RfPowerSave( ++ PADAPTER Adapter + ) +{ -+#if 0 -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ u1Byte eRFPath; -+ -+#if (DISABLE_BB_RF) -+ return; -+#endif -+ -+ if(pMgntInfo->RegRfOff == TRUE){ // User disable RF via registry. -+ RT_TRACE((COMP_INIT|COMP_RF), DBG_LOUD, ("InitializeAdapter8192CUsb(): Turn off RF for RegRfOff.\n")); -+ MgntActSet_RF_State(Adapter, eRfOff, RF_CHANGE_BY_SW); -+ // Those action will be discard in MgntActSet_RF_State because off the same state -+ for(eRFPath = 0; eRFPath NumTotalRFPath; eRFPath++) -+ PHY_SetRFReg(Adapter, eRFPath, 0x4, 0xC00, 0x0); -+ } -+ else if(pMgntInfo->RfOffReason > RF_CHANGE_BY_PS){ // H/W or S/W RF OFF before sleep. -+ RT_TRACE((COMP_INIT|COMP_RF), DBG_LOUD, ("InitializeAdapter8192CUsb(): Turn off RF for RfOffReason(%ld).\n", pMgntInfo->RfOffReason)); -+ MgntActSet_RF_State(Adapter, eRfOff, pMgntInfo->RfOffReason); -+ } -+ else{ -+ pHalData->eRFPowerState = eRfOn; -+ pMgntInfo->RfOffReason = 0; -+ if(Adapter->bInSetPower || Adapter->bResetInProgress) -+ PlatformUsbEnableInPipes(Adapter); -+ RT_TRACE((COMP_INIT|COMP_RF), DBG_LOUD, ("InitializeAdapter8192CUsb(): RF is on.\n")); -+ } -+#endif +} + +enum { + Antenna_Lfet = 1, -+ Antenna_Right = 2, ++ Antenna_Right = 2, +}; + -+static VOID -+_InitAntenna_Selection_8812A(IN PADAPTER Adapter) ++static void ++_InitAntenna_Selection_8812A(PADAPTER Adapter) +{ + + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + + if(pHalData->AntDivCfg==0) + return; -+ DBG_8192C("==> %s ....\n",__FUNCTION__); ++ DBG_8192C("==> %s ....\n",__FUNCTION__); + + rtw_write8(Adapter, REG_LEDCFG2, 0x82); + + PHY_SetBBReg(Adapter, rFPGA0_XAB_RFParameter, BIT13, 0x01); -+ ++ + if(PHY_QueryBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300) == MAIN_ANT) + pHalData->CurAntenna = MAIN_ANT; + else + pHalData->CurAntenna = AUX_ANT; + DBG_8192C("%s,Cur_ant:(%x)%s\n",__FUNCTION__,pHalData->CurAntenna,(pHalData->CurAntenna == MAIN_ANT)?"MAIN_ANT":"AUX_ANT"); -+ ++ + +} + @@ -284413,134 +126902,115 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +// If Efuse 0x0e bit1 is not enabled, we can not support selective suspend for Minicard and +// slim card. +// -+static VOID ++static void +HalDetectSelectiveSuspendMode( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ -+#if 0 -+ u8 tmpvalue; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); ++} // HalDetectSelectiveSuspendMode ++/*----------------------------------------------------------------------------- ++ * Function: HwSuspendModeEnable92Cu() ++ * ++ * Overview: HW suspend mode switch. ++ * ++ * Input: NONE ++ * ++ * Output: NONE ++ * ++ * Return: NONE ++ * ++ * Revised History: ++ * When Who Remark ++ * 08/23/2010 MHC HW suspend mode switch test.. ++ *---------------------------------------------------------------------------*/ ++static void ++HwSuspendModeEnable_8812AU( ++ PADAPTER pAdapter, ++ u8 Type ++ ) ++{ ++ //PRT_USB_DEVICE pDevice = GET_RT_USB_DEVICE(pAdapter); ++ u16 reg = rtw_read16(pAdapter, REG_GPIO_MUXCFG); + -+ // If support HW radio detect, we need to enable WOL ability, otherwise, we -+ // can not use FW to notify host the power state switch. -+ -+ EFUSE_ShadowRead(Adapter, 1, EEPROM_USB_OPTIONAL1, (u32 *)&tmpvalue); -+ -+ DBG_8192C("HalDetectSelectiveSuspendMode(): SS "); -+ if(tmpvalue & BIT1) ++ //if (!pDevice->RegUsbSS) + { -+ DBG_8192C("Enable\n"); ++ return; ++ } ++ ++ // ++ // 2010/08/23 MH According to Alfred's suggestion, we need to to prevent HW ++ // to enter suspend mode automatically. Otherwise, it will shut down major power ++ // domain and 8051 will stop. When we try to enter selective suspend mode, we ++ // need to prevent HW to enter D2 mode aumotmatically. Another way, Host will ++ // issue a S10 signal to power domain. Then it will cleat SIC setting(from Yngli). ++ // We need to enable HW suspend mode when enter S3/S4 or disable. We need ++ // to disable HW suspend mode for IPS/radio_off. ++ // ++ //RT_TRACE(COMP_RF, DBG_LOUD, ("HwSuspendModeEnable92Cu = %d\n", Type)); ++ if (Type == false) ++ { ++ reg |= BIT14; ++ //RT_TRACE(COMP_RF, DBG_LOUD, ("REG_GPIO_MUXCFG = %x\n", reg)); ++ rtw_write16(pAdapter, REG_GPIO_MUXCFG, reg); ++ reg |= BIT12; ++ //RT_TRACE(COMP_RF, DBG_LOUD, ("REG_GPIO_MUXCFG = %x\n", reg)); ++ rtw_write16(pAdapter, REG_GPIO_MUXCFG, reg); + } + else + { -+ DBG_8192C("Disable\n"); -+ pdvobjpriv->RegUsbSS = _FALSE; ++ reg &= (~BIT12); ++ rtw_write16(pAdapter, REG_GPIO_MUXCFG, reg); ++ reg &= (~BIT14); ++ rtw_write16(pAdapter, REG_GPIO_MUXCFG, reg); + } + -+ // 2010/09/01 MH According to Dongle Selective Suspend INF. We can switch SS mode. -+ if (pdvobjpriv->RegUsbSS && !SUPPORT_HW_RADIO_DETECT(pHalData)) -+ { -+ //PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); ++} // HwSuspendModeEnable92Cu + -+ //if (!pMgntInfo->bRegDongleSS) -+ //{ -+ // RT_TRACE(COMP_INIT, DBG_LOUD, ("Dongle disable SS\n")); -+ pdvobjpriv->RegUsbSS = _FALSE; -+ //} -+ } -+#endif -+} // HalDetectSelectiveSuspendMode -+ -+rt_rf_power_state RfOnOffDetect(IN PADAPTER pAdapter ) ++static rt_rf_power_state RfOnOffDetect(PADAPTER pAdapter ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(pAdapter); + u8 val8; + rt_rf_power_state rfpowerstate = rf_off; + -+ if(pwrctl->bHWPowerdown) ++ if(pAdapter->pwrctrlpriv.bHWPowerdown) + { + val8 = rtw_read8(pAdapter, REG_HSISR); + DBG_8192C("pwrdown, 0x5c(BIT7)=%02x\n", val8); -+ rfpowerstate = (val8 & BIT7) ? rf_off: rf_on; ++ rfpowerstate = (val8 & BIT7) ? rf_off: rf_on; + } + else // rf on/off + { + rtw_write8( pAdapter, REG_MAC_PINMUX_CFG,rtw_read8(pAdapter, REG_MAC_PINMUX_CFG)&~(BIT3)); + val8 = rtw_read8(pAdapter, REG_GPIO_IO_SEL); + DBG_8192C("GPIO_IN=%02x\n", val8); -+ rfpowerstate = (val8 & BIT3) ? rf_on : rf_off; ++ rfpowerstate = (val8 & BIT3) ? rf_on : rf_off; + } + return rfpowerstate; +} // HalDetectPwrDownMode + -+void _ps_open_RF(_adapter *padapter) { -+ //here call with bRegSSPwrLvl 1, bRegSSPwrLvl 2 needs to be verified -+ //phy_SsPwrSwitch92CU(padapter, rf_on, 1); ++static void _ps_open_RF(_adapter *padapter) ++{ +} + -+void _ps_close_RF(_adapter *padapter){ ++static void _ps_close_RF(_adapter *padapter){ + //here call with bRegSSPwrLvl 1, bRegSSPwrLvl 2 needs to be verified + //phy_SsPwrSwitch92CU(padapter, rf_off, 1); +} + -+ -+/* A lightweight deinit function */ -+static void rtl8812au_hw_reset(_adapter *Adapter) -+{ -+ u8 reg_val=0; -+ if(rtw_read8(Adapter, REG_MCUFWDL)&BIT7) -+ { -+ _8051Reset8812(Adapter); -+ rtw_write8(Adapter, REG_MCUFWDL, 0x00); -+ //before BB reset should do clock gated -+ rtw_write32(Adapter, rFPGA0_XCD_RFPara, -+ rtw_read32(Adapter, rFPGA0_XCD_RFPara)|(BIT6)); -+ //reset BB -+ reg_val = rtw_read8(Adapter, REG_SYS_FUNC_EN); -+ reg_val &= ~(BIT(0) | BIT(1)); -+ rtw_write8(Adapter, REG_SYS_FUNC_EN, reg_val); -+ //reset RF -+ rtw_write8(Adapter, REG_RF_CTRL, 0); -+ //reset TRX path -+ rtw_write16(Adapter, REG_CR, 0); -+ //reset MAC -+ reg_val = rtw_read8(Adapter, REG_APS_FSMCO+1); -+ reg_val |= BIT(1); -+ reg_val = rtw_write8(Adapter, REG_APS_FSMCO+1, reg_val); //reg0x5[1] ,auto FSM off -+ -+ reg_val = rtw_read8(Adapter, REG_APS_FSMCO+1); -+ -+ //check if reg0x5[1] auto cleared -+ while(reg_val & BIT(1)){ -+ rtw_udelay_os(1); -+ reg_val = rtw_read8(Adapter, REG_APS_FSMCO+1); -+ } -+ reg_val |= BIT(0); -+ reg_val = rtw_write8(Adapter, REG_APS_FSMCO+1, reg_val); //reg0x5[0] ,auto FSM on -+ -+ reg_val = rtw_read8(Adapter, REG_SYS_FUNC_EN+1); -+ reg_val &= ~(BIT(4) | BIT(7)); -+ rtw_write8(Adapter, REG_SYS_FUNC_EN+1, reg_val); -+ reg_val = rtw_read8(Adapter, REG_SYS_FUNC_EN+1); -+ reg_val |= BIT(4) | BIT(7); -+ rtw_write8(Adapter, REG_SYS_FUNC_EN+1, reg_val); -+ } -+} -+ -+u32 rtl8812au_hal_init(PADAPTER Adapter) ++static u32 rtl8812au_hal_init(PADAPTER Adapter) +{ + u8 value8 = 0, u1bRegCR; + u16 value16; + u8 txpktbuf_bndy; + u32 status = _SUCCESS; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(Adapter); ++ struct pwrctrl_priv *pwrctrlpriv = &Adapter->pwrctrlpriv; + struct registry_priv *pregistrypriv = &Adapter->registrypriv; -+ ++ + rt_rf_power_state eRfPowerStateToSet; ++#ifdef CONFIG_BT_COEXIST ++ struct btcoexist_priv *pbtpriv = &(pHalData->bt_coexist); ++#endif + + u32 init_start_time = rtw_get_current_time(); + @@ -284616,20 +127086,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + + + -+_func_enter_; -+ ++ ++ +HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_BEGIN); -+ if(pwrctrlpriv->bkeepfwalive) ++ if(Adapter->pwrctrlpriv.bkeepfwalive) + { + _ps_open_RF(Adapter); + -+ if(pHalData->bIQKInitialized){ -+ //PHY_IQCalibrate_8812A(Adapter,_TRUE); ++ if(pHalData->odmpriv.RFCalibrateInfo.bIQKInitialized){ ++ //PHY_IQCalibrate_8812A(Adapter,true); + } + else + { -+ //PHY_IQCalibrate_8812A(Adapter,_FALSE); -+ //pHalData->bIQKInitialized = _TRUE; ++ //PHY_IQCalibrate_8812A(Adapter,false); ++ pHalData->odmpriv.RFCalibrateInfo.bIQKInitialized = true; + } + + //ODM_TXPowerTrackingCheck(&pHalData->odmpriv ); @@ -284639,17 +127109,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + } + + // Check if MAC has already power on. by tynli. 2011.05.27. -+ value8 = rtw_read8(Adapter, REG_SYS_CLKR+1); ++ value8 = rtw_read8(Adapter, REG_SYS_CLKR+1); + u1bRegCR = PlatformEFIORead1Byte(Adapter, REG_CR); + DBG_871X(" power-on :REG_SYS_CLKR 0x09=0x%02x. REG_CR 0x100=0x%02x.\n", value8, u1bRegCR); + if((value8&BIT3) && (u1bRegCR != 0 && u1bRegCR != 0xEA)) + { -+ //pHalData->bMACFuncEnable = TRUE; ++ //pHalData->bMACFuncEnable = true; + DBG_871X(" MAC has already power on.\n"); + } + else + { -+ //pHalData->bMACFuncEnable = FALSE; ++ //pHalData->bMACFuncEnable = false; + // Set FwPSState to ALL_ON mode to prevent from the I/O be return because of 32k + // state which is set before sleep under wowlan mode. 2012.01.04. by tynli. + //pHalData->FwPSState = FW_PS_STATE_ALL_ON_88E; @@ -284669,17 +127139,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + rtw_write8(Adapter, REG_RF_B_CTRL_8812, 7); + } + -+/* -+ If HW didn't go through a complete de-initial procedure, -+ it probably occurs some problem for double initial procedure. -+ Like "CONFIG_DEINIT_BEFORE_INIT" in 92du chip -+*/ -+ rtl8812au_hw_reset(Adapter); -+ -+ -+ +HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_INIT_PW_ON); -+ status = _InitPowerOn_8812AU(Adapter); ++ status = _InitPowerOn8812AU(Adapter); + if(status == _FAIL){ + RT_TRACE(_module_hci_hal_init_c_, _drv_err_, ("Failed to init power on!\n")); + goto exit; @@ -284698,37 +127159,46 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + else + txpktbuf_bndy = WMM_NORMAL_TX_PAGE_BOUNDARY_8821; + } -+ -+ status = InitLLTTable8812A(Adapter, txpktbuf_bndy); ++ ++ status = InitLLTTable8812(Adapter, txpktbuf_bndy); + if(status == _FAIL){ + RT_TRACE(_module_hci_hal_init_c_, _drv_err_, ("Failed to init LLT table\n")); + goto exit; + } + ++#if ENABLE_USB_DROP_INCORRECT_OUT + _InitHardwareDropIncorrectBulkOut_8812A(Adapter); ++#endif + + if(pHalData->bRDGEnable){ + _InitRDGSetting_8812A(Adapter); + } + +HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_DOWNLOAD_FW); -+ if (Adapter->registrypriv.mp_mode == 0) { -+ status = FirmwareDownload8812(Adapter, _FALSE); ++#if (MP_DRIVER == 1) ++ if (Adapter->registrypriv.mp_mode == 1) ++ { ++ _InitRxSetting_8812AU(Adapter); ++ } ++#endif //MP_DRIVER == 1 ++ { ++ status = FirmwareDownload8812(Adapter, false); + if (status != _SUCCESS) { + DBG_871X("%s: Download Firmware failed!!\n", __FUNCTION__); -+ Adapter->bFWReady = _FALSE; -+ pHalData->fw_ractrl = _FALSE; ++ Adapter->bFWReady = false; ++ pHalData->fw_ractrl = false; + //return status; + } else { + DBG_871X("%s: Download Firmware Success!!\n",__FUNCTION__); -+ Adapter->bFWReady = _TRUE; -+ pHalData->fw_ractrl = _TRUE; ++ Adapter->bFWReady = true; ++ pHalData->fw_ractrl = true; + } + } + ++ + InitializeFirmwareVars8812(Adapter); -+ -+ if(pwrctrlpriv->reg_rfoff == _TRUE){ ++ ++ if(pwrctrlpriv->reg_rfoff == true){ + pwrctrlpriv->rf_pwrstate = rf_off; + } + @@ -284750,21 +127220,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + goto exit; + } +#endif -+ ++ +HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_MISC01); + if(IS_HARDWARE_TYPE_8812(Adapter)) + { + _InitQueueReservedPage_8812AUsb(Adapter); -+ _InitTxBufferBoundary_8812AUsb(Adapter); -+ } ++ _InitTxBufferBoundary_8812AUsb(Adapter); ++ } + else if(IS_HARDWARE_TYPE_8821(Adapter)) + { + _InitQueueReservedPage_8821AUsb(Adapter); -+ _InitTxBufferBoundary_8821AUsb(Adapter); -+ } -+ ++ _InitTxBufferBoundary_8821AUsb(Adapter); ++ } ++ + _InitQueuePriority_8812AUsb(Adapter); -+ _InitPageBoundary_8812AUsb(Adapter); ++ _InitPageBoundary_8812AUsb(Adapter); + + if(IS_HARDWARE_TYPE_8812(Adapter)) + _InitTransferPageSize_8812AUsb(Adapter); @@ -284775,7 +127245,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + + _InitInterrupt_8812AU(Adapter); + _InitID_8812A(Adapter);//set mac_address -+ _InitNetworkType_8812A(Adapter);//set msr ++ _InitNetworkType_8812A(Adapter);//set msr + _InitWMACSetting_8812A(Adapter); + _InitAdaptiveCtrl_8812AUsb(Adapter); + _InitEDCA_8812AUsb(Adapter); @@ -284784,13 +127254,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + init_UsbAggregationSetting_8812A(Adapter); + _InitOperationMode_8812A(Adapter);//todo + _InitBeaconParameters_8812A(Adapter); -+ _InitBeaconMaxError_8812A(Adapter, _TRUE); ++ _InitBeaconMaxError_8812A(Adapter, true); + + _InitBurstPktLen(Adapter); //added by page. 20110919 + + // + // Init CR MACTXEN, MACRXEN after setting RxFF boundary REG_TRXFF_BNDY to patch -+ // Hw bug which Hw initials RxFF boundry size to a value which is larger than the real Rx buffer size in 88E. ++ // Hw bug which Hw initials RxFF boundry size to a value which is larger than the real Rx buffer size in 88E. + // 2011.08.05. by tynli. + // + value8 = rtw_read8(Adapter, REG_CR); @@ -284811,7 +127281,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + rtw_write16(Adapter, REG_PKT_BE_BK_LIFE_TIME, 0x3000); // unit: 256us. 3s +#endif // CONFIG_TX_MCAST2UNI +#endif // CONFIG_CONCURRENT_MODE || CONFIG_TX_MCAST2UNI -+ ++ + +#ifdef CONFIG_LED + _InitHWLed(Adapter); @@ -284835,7 +127305,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + +HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_RF); +#if (HAL_RF_ENABLE == 1) -+ status = PHY_RFConfig8812(Adapter); ++ status = PHY_RFConfig8812(Adapter); + if(status == _FAIL) + { + goto exit; @@ -284843,8 +127313,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + + if(pHalData->rf_type == RF_1T1R && IS_HARDWARE_TYPE_8812AU(Adapter)) + PHY_BB8812_Config_1T(Adapter); -+ if (Adapter->registrypriv.rf_config == RF_1T2R && IS_HARDWARE_TYPE_8812AU(Adapter)) -+ PHY_SetBBReg(Adapter, rTxPath_Jaguar, bMaskLWord, 0x1111); +#endif + + if(Adapter->registrypriv.channel <= 14) @@ -284852,7 +127320,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + else + PHY_SwitchWirelessBand8812(Adapter, BAND_ON_5G); + -+ rtw_hal_set_chnl_bw(Adapter, Adapter->registrypriv.channel, ++ rtw_hal_set_chnl_bw(Adapter, Adapter->registrypriv.channel, + CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE, HAL_PRIME_CHNL_OFFSET_DONT_CARE); + +HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_TURN_ON_BLOCK); @@ -284865,9 +127333,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + + // HW SEQ CTRL + //set 0x0 to 0xFF by tynli. Default enable HW SEQ NUM. -+ rtw_write8(Adapter,REG_HWSEQ_CTRL, 0xFF); -+ -+ // ++ rtw_write8(Adapter,REG_HWSEQ_CTRL, 0xFF); ++ ++ // + // Disable BAR, suggested by Scott + // 2010.04.09 add by hpfan + // @@ -284875,41 +127343,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + + if(pregistrypriv->wifi_spec) + rtw_write16(Adapter,REG_FAST_EDCA_CTRL ,0); -+ //adjust EDCCA to avoid collision -+ if(pregistrypriv->wifi_spec) -+ { -+ if (IS_HARDWARE_TYPE_8821(Adapter)) -+ if (Adapter->registrypriv.adaptivity_en == 0) { -+ Adapter->registrypriv.adaptivity_en = 1; -+ Adapter->registrypriv.adaptivity_mode = 0; -+ } -+ } ++ + //Nav limit , suggest by scott + rtw_write8(Adapter, 0x652, 0x0); + +HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_INIT_HAL_DM); + rtl8812_InitHalDm(Adapter); -+ ++ +#if (MP_DRIVER == 1) + if (Adapter->registrypriv.mp_mode == 1) + { + Adapter->mppriv.channel = pHalData->CurrentChannel; + MPT_InitializeAdapter(Adapter, Adapter->mppriv.channel); + } -+ else ++ else +#endif //#if (MP_DRIVER == 1) + { + // + // 2010/08/11 MH Merge from 8192SE for Minicard init. We need to confirm current radio status -+ // and then decide to enable RF or not.!!!??? For Selective suspend mode. We may not ++ // and then decide to enable RF or not.!!!??? For Selective suspend mode. We may not + // call init_adapter. May cause some problem?? + // -+ // Fix the bug that Hw/Sw radio off before S3/S4, the RF off action will not be executed -+ // in MgntActSet_RF_State() after wake up, because the value of pHalData->eRFPowerState ++ // Fix the bug that Hw/Sw radio off before S3/S4, the RF off action will not be executed ++ // in MgntActSet_RF_State() after wake up, because the value of pHalData->eRFPowerState + // is the same as eRfOff, we should change it to eRfOn after we config RF parameters. + // Added by tynli. 2010.03.30. + pwrctrlpriv->rf_pwrstate = rf_on; + ++ + //0x4c6[3] 1: RTS BW = Data BW + //0: RTS BW depends on CCA / secondary CCA result. + rtw_write8(Adapter, REG_QUEUE_CTRL, rtw_read8(Adapter, REG_QUEUE_CTRL)&0xF7); @@ -284926,34 +127387,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + // Reset USB mode switch setting + rtw_write8(Adapter, REG_SDIO_CTRL_8812, 0x0); + rtw_write8(Adapter, REG_ACLK_MON, 0x0); -+ ++ + //RT_TRACE(COMP_INIT, DBG_TRACE, ("InitializeAdapter8188EUsb() <====\n")); -+ ++ +HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_IQK); + // 2010/08/26 MH Merge from 8192CE. + if(pwrctrlpriv->rf_pwrstate == rf_on) + { -+/* if(IS_HARDWARE_TYPE_8812AU(Adapter)) -+ { -+#if (RTL8812A_SUPPORT == 1) -+ pHalData->bNeedIQK = _TRUE; -+ if(pHalData->bIQKInitialized) -+ PHY_IQCalibrate_8812A(Adapter, _TRUE); ++ if(IS_HARDWARE_TYPE_8812AU(Adapter)) { ++ pHalData->odmpriv.RFCalibrateInfo.bNeedIQK = true; ++ if(pHalData->odmpriv.RFCalibrateInfo.bIQKInitialized) ++ PHY_IQCalibrate_8812A(Adapter, true); + else + { -+ PHY_IQCalibrate_8812A(Adapter, _FALSE); -+ pHalData->bIQKInitialized = _TRUE; ++ PHY_IQCalibrate_8812A(Adapter, false); ++ pHalData->odmpriv.RFCalibrateInfo.bIQKInitialized = true; + } -+#endif -+ }*/ -+ ++ } ++ +HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_PW_TRACK); -+ -+ //ODM_TXPowerTrackingCheck(&pHalData->odmpriv ); -+ + +HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_LCK); -+ //PHY_LCCalibrate_8812A(Adapter); + } +} + @@ -284966,45 +127420,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +#ifdef CONFIG_BT_COEXIST +HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_BT_COEXIST); + //_InitBTCoexist(Adapter); ++#endif ++ + // 2010/08/23 MH According to Alfred's suggestion, we need to to prevent HW enter + // suspend mode automatically. -+ //HwSuspendModeEnable92Cu(Adapter, _FALSE); -+ -+ if ( _TRUE == pHalData->EEPROMBluetoothCoexist) -+ { -+ // Init BT hw config. -+ rtw_btcoex_HAL_Initialize(Adapter, _FALSE); -+ } -+ else -+ { -+ // In combo card run wifi only , must setting some hardware reg. -+ rtl8812a_combo_card_WifiOnlyHwInit(Adapter); -+ } -+#endif //CONFIG_BT_COEXIST ++ //HwSuspendModeEnable92Cu(Adapter, false); + +HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_MISC31); + + rtw_write8(Adapter, REG_USB_HRPWM, 0); + -+#ifdef CONFIG_XMIT_ACK -+ //ack for xmit mgmt frames. -+ rtw_write32(Adapter, REG_FWHW_TXQ_CTRL, rtw_read32(Adapter, REG_FWHW_TXQ_CTRL)|BIT(12)); -+#endif //CONFIG_XMIT_ACK -+ + //misc + { -+ int i; ++ int i; + u8 mac_addr[6]; + for(i=0; i<6; i++) -+ { ++ { +#ifdef CONFIG_CONCURRENT_MODE + if(Adapter->iface_type == IFACE_PORT1) + mac_addr[i] = rtw_read8(Adapter, REG_MACID1+i); + else +#endif -+ mac_addr[i] = rtw_read8(Adapter, REG_MACID+i); ++ mac_addr[i] = rtw_read8(Adapter, REG_MACID+i); + } -+ ++ + DBG_8192C("MAC Address from REG_MACID = "MAC_FMT"\n", MAC_ARG(mac_addr)); + } + @@ -285023,50 +127462,46 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + , (hal_init_stages_timestamp[hal_init_profiling_i+1]-hal_init_stages_timestamp[hal_init_profiling_i]) + , rtw_get_time_interval_ms(hal_init_stages_timestamp[hal_init_profiling_i], hal_init_stages_timestamp[hal_init_profiling_i+1]) + ); -+ } ++ } + #endif + + -+_func_exit_; ++ + + return status; +} + -+VOID -+hal_poweroff_8812au( -+ IN PADAPTER Adapter ++static void ++CardDisableRTL8812AU( ++ PADAPTER Adapter +) +{ + u8 u1bTmp; -+ u8 bMacPwrCtrlOn = _FALSE; -+ u16 utemp, ori_fsmc0; ++ u8 val8; ++ u16 val16; ++ u32 val32; + -+ rtw_hal_get_hwreg(Adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if(bMacPwrCtrlOn == _FALSE) -+ return ; + -+ ori_fsmc0 = utemp = rtw_read16(Adapter, REG_APS_FSMCO); -+ rtw_write16(Adapter, REG_APS_FSMCO, utemp & ~0x8000); -+ DBG_871X(" %s\n",__FUNCTION__); ++ //DBG_871X("CardDisableRTL8188EU\n"); + + //Stop Tx Report Timer. 0x4EC[Bit1]=b'0 + u1bTmp = rtw_read8(Adapter, REG_TX_RPT_CTRL); -+ rtw_write8(Adapter, REG_TX_RPT_CTRL, u1bTmp&(~BIT1)); ++ rtw_write8(Adapter, REG_TX_RPT_CTRL, val8&(~BIT1)); + -+ // stop rx ++ // stop rx + rtw_write8(Adapter, REG_CR, 0x0); -+ ++ + // Run LPS WL RFOFF flow -+ if(IS_HARDWARE_TYPE_8821U(Adapter)) ++ if(IS_HARDWARE_TYPE_8821U(Adapter)) + HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, Rtl8821A_NIC_LPS_ENTER_FLOW); -+ else ++ else + HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, Rtl8812_NIC_LPS_ENTER_FLOW); + -+ if((rtw_read8(Adapter, REG_MCUFWDL)&RAM_DL_SEL) && ++ if((rtw_read8(Adapter, REG_MCUFWDL)&RAM_DL_SEL) && + Adapter->bFWReady) //8051 RAM code + { + _8051Reset8812(Adapter); -+ } ++ } + + // Reset MCU. Suggested by Filen. 2011.01.26. by tynli. + u1bTmp = rtw_read8(Adapter, REG_SYS_FUNC_EN+1); @@ -285077,39 +127512,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + + // Card disable power action flow + if(IS_HARDWARE_TYPE_8821U(Adapter)) -+ HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, Rtl8821A_NIC_DISABLE_FLOW); ++ HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, Rtl8821A_NIC_DISABLE_FLOW); + else + HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, Rtl8812_NIC_DISABLE_FLOW); -+ -+ bMacPwrCtrlOn = _FALSE; -+ rtw_hal_set_hwreg(Adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ -+ Adapter->bFWReady = _FALSE; -+ -+ if (ori_fsmc0 & 0x8000) { -+ utemp = rtw_read16(Adapter, REG_APS_FSMCO); -+ rtw_write16(Adapter, REG_APS_FSMCO, utemp | 0x8000); -+ } +} + +static void rtl8812au_hw_power_down(_adapter *padapter) +{ + // 2010/-8/09 MH For power down module, we need to enable register block contrl reg at 0x1c. + // Then enable power down control bit of register 0x04 BIT4 and BIT15 as 1. -+ ++ + // Enable register area 0x0-0xc. -+ rtw_write8(padapter,REG_RSV_CTRL, 0x0); ++ rtw_write8(padapter,REG_RSV_CTRL, 0x0); + rtw_write16(padapter, REG_APS_FSMCO, 0x8812); +} + -+u32 rtl8812au_hal_deinit(PADAPTER Adapter) ++static u32 rtl8812au_hal_deinit(PADAPTER Adapter) + { -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(Adapter); ++ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ DBG_8192C("==> %s \n",__FUNCTION__); ++ DBG_8192C("==> %s \n",__FUNCTION__); + +#ifdef CONFIG_BT_COEXIST -+ if (hal_btcoex_IsBtExist(Adapter)) ++ if (BT_IsBtExist(Adapter)) + { + DBG_871X("BT module enable SIC\n"); + // Only under WIN7 we can support selective suspend and enter D3 state when system call halt adapter. @@ -285119,12 +127544,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + // the system will hang due to 8051 reset fail. + } + else -+#endif //CONFIG_BT_COEXIST ++#endif + { + rtw_write16(Adapter, REG_GPIO_MUXCFG, rtw_read16(Adapter, REG_GPIO_MUXCFG)&(~BIT12)); + } + -+ if(pHalData->bSupportUSB3 == _TRUE) ++ if(pHalData->bSupportUSB3 == true) + { + // set Reg 0xf008[3:4] to 2'11 to eable U1/U2 Mode in USB3.0. added by page, 20120712 + rtw_write8(Adapter, 0xf008, rtw_read8(Adapter, 0xf008)|0x18); @@ -285136,74 +127561,75 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + rtw_write32(Adapter, REG_HIMR1_8812, IMR_DISABLED_8812); + + #ifdef SUPPORT_HW_RFOFF_DETECTED -+ DBG_8192C("bkeepfwalive(%x)\n", pwrctl->bkeepfwalive); -+ if(pwrctl->bkeepfwalive) -+ { -+ _ps_close_RF(Adapter); -+ if((pwrctl->bHWPwrPindetect) && (pwrctl->bHWPowerdown)) ++ DBG_8192C("bkeepfwalive(%x)\n",Adapter->pwrctrlpriv.bkeepfwalive); ++ if(Adapter->pwrctrlpriv.bkeepfwalive) ++ { ++ _ps_close_RF(Adapter); ++ if((Adapter->pwrctrlpriv.bHWPwrPindetect) && (Adapter->pwrctrlpriv.bHWPowerdown)) + rtl8812au_hw_power_down(Adapter); -+ } ++ } + else +#endif -+ { -+ if (rtw_is_hw_init_completed(Adapter)) { -+ hal_poweroff_8812au(Adapter); ++ { ++ if(Adapter->hw_init_completed == true){ ++ CardDisableRTL8812AU(Adapter); + -+ if((pwrctl->bHWPwrPindetect ) && (pwrctl->bHWPowerdown)) ++ if((Adapter->pwrctrlpriv.bHWPwrPindetect ) && (Adapter->pwrctrlpriv.bHWPowerdown)) + rtl8812au_hw_power_down(Adapter); + } -+ } ++ } + return _SUCCESS; + } + + -+unsigned int rtl8812au_inirp_init(PADAPTER Adapter) -+{ -+ u8 i; ++static unsigned int rtl8812au_inirp_init(PADAPTER Adapter) ++{ ++ u8 i; + struct recv_buf *precvbuf; + uint status; + struct dvobj_priv *pdev= adapter_to_dvobj(Adapter); + struct intf_hdl * pintfhdl=&Adapter->iopriv.intf; -+ struct recv_priv *precvpriv = &(Adapter->recvpriv); ++ struct recv_priv *precvpriv = &(Adapter->recvpriv); + u32 (*_read_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); +#ifdef CONFIG_USB_INTERRUPT_IN_PIPE + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + u32 (*_read_interrupt)(struct intf_hdl *pintfhdl, u32 addr); +#endif + -+_func_enter_; ++ + + _read_port = pintfhdl->io_ops._read_port; + + status = _SUCCESS; + -+ RT_TRACE(_module_hci_hal_init_c_,_drv_info_,("===> usb_inirp_init \n")); -+ ++ RT_TRACE(_module_hci_hal_init_c_,_drv_info_,("===> usb_inirp_init \n")); ++ + precvpriv->ff_hwaddr = RECV_BULK_IN_ADDR; + -+ //issue Rx irp to receive data -+ precvbuf = (struct recv_buf *)precvpriv->precv_buf; ++ //issue Rx irp to receive data ++ precvbuf = (struct recv_buf *)precvpriv->precv_buf; + for(i=0; iff_hwaddr, 0, (unsigned char *)precvbuf) == _FALSE ) ++ if(_read_port(pintfhdl, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf) == false ) + { + RT_TRACE(_module_hci_hal_init_c_,_drv_err_,("usb_rx_init: usb_read_port error \n")); + status = _FAIL; + goto exit; + } -+ -+ precvbuf++; ++ ++ precvbuf++; + precvpriv->free_recv_buf_queue_cnt--; + } + +#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+ if (pdev->RtInPipe[REALTEK_USB_IN_INT_EP_IDX] != 0x05) { ++ if(pHalData->RtIntInPipe != 0x05) ++ { + status = _FAIL; -+ DBG_871X("%s =>Warning !! Have not USB Int-IN pipe, RtIntInPipe(%d)!!!\n", __func__, pdev->RtInPipe[REALTEK_USB_IN_INT_EP_IDX]); ++ DBG_871X("%s =>Warning !! Have not USB Int-IN pipe, pHalData->RtIntInPipe(%d)!!!\n",__FUNCTION__,pHalData->RtIntInPipe); + goto exit; -+ } ++ } + _read_interrupt = pintfhdl->io_ops._read_interrupt; -+ if(_read_interrupt(pintfhdl, RECV_INT_IN_ADDR) == _FALSE ) ++ if(_read_interrupt(pintfhdl, RECV_INT_IN_ADDR) == false ) + { + RT_TRACE(_module_hci_hal_init_c_,_drv_err_,("usb_rx_init: usb_read_interrupt error \n")); + status = _FAIL; @@ -285211,19 +127637,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +#endif + +exit: -+ ++ + RT_TRACE(_module_hci_hal_init_c_,_drv_info_,("<=== usb_inirp_init \n")); + -+_func_exit_; ++ + + return status; + +} + -+unsigned int rtl8812au_inirp_deinit(PADAPTER Adapter) -+{ ++static unsigned int rtl8812au_inirp_deinit(PADAPTER Adapter) ++{ + RT_TRACE(_module_hci_hal_init_c_,_drv_info_,("\n ===> usb_rx_deinit \n")); -+ ++ + rtw_read_port_cancel(Adapter); + + RT_TRACE(_module_hci_hal_init_c_,_drv_info_,("\n <=== usb_rx_deinit \n")); @@ -285236,174 +127662,148 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +// EEPROM/EFUSE Content Parsing +// +//------------------------------------------------------------------- -+VOID ++static void +hal_ReadIDs_8812AU( -+ IN PADAPTER Adapter, -+ IN pu1Byte PROMContent, -+ IN BOOLEAN AutoloadFail ++ PADAPTER Adapter, ++ pu1Byte PROMContent, ++ bool AutoloadFail + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); + + if( !AutoloadFail ) + { -+ // VID, PID ++ // VID, PID + if(IS_HARDWARE_TYPE_8812AU(Adapter)) + { -+ pHalData->EEPROMVID = EF2Byte( *(u16 *)&PROMContent[EEPROM_VID_8812AU] ); -+ pHalData->EEPROMPID = EF2Byte( *(u16 *)&PROMContent[EEPROM_PID_8812AU] ); ++ pHalData->EEPROMVID = le16_to_cpu( *(__le16 *)&PROMContent[EEPROM_VID_8812AU] ); ++ pHalData->EEPROMPID = le16_to_cpu( *(__le16 *)&PROMContent[EEPROM_PID_8812AU] ); + } + else if (IS_HARDWARE_TYPE_8821U(Adapter)) + + { -+ pHalData->EEPROMVID = EF2Byte( *(u16 *)&PROMContent[EEPROM_VID_8821AU] ); -+ pHalData->EEPROMPID = EF2Byte( *(u16 *)&PROMContent[EEPROM_PID_8821AU] ); ++ pHalData->EEPROMVID = le16_to_cpu( *(__le16 *)&PROMContent[EEPROM_VID_8821AU] ); ++ pHalData->EEPROMPID = le16_to_cpu( *(__le16 *)&PROMContent[EEPROM_PID_8821AU] ); + } + -+ -+ // Customer ID, 0x00 and 0xff are reserved for Realtek. ++ ++ // Customer ID, 0x00 and 0xff are reserved for Realtek. + pHalData->EEPROMCustomerID = *(u8 *)&PROMContent[EEPROM_CustomID_8812]; + pHalData->EEPROMSubCustomerID = EEPROM_Default_SubCustomerID; + + } + else + { -+ pHalData->EEPROMVID = EEPROM_Default_VID; -+ pHalData->EEPROMPID = EEPROM_Default_PID; ++ pHalData->EEPROMVID = EEPROM_Default_VID; ++ pHalData->EEPROMPID = EEPROM_Default_PID; + -+ // Customer ID, 0x00 and 0xff are reserved for Realtek. ++ // Customer ID, 0x00 and 0xff are reserved for Realtek. + pHalData->EEPROMCustomerID = EEPROM_Default_CustomerID; + pHalData->EEPROMSubCustomerID = EEPROM_Default_SubCustomerID; + + } + + if((pHalData->EEPROMVID == 0x050D) && (pHalData->EEPROMPID == 0x1106))// SerComm for Belkin. -+ pHalData->CustomerID = RT_CID_819x_Sercomm_Belkin; ++ pEEPROM->CustomerID = RT_CID_819x_Sercomm_Belkin; + else if((pHalData->EEPROMVID == 0x0846) && (pHalData->EEPROMPID == 0x9051))// SerComm for Netgear. -+ pHalData->CustomerID = RT_CID_819x_Sercomm_Netgear; ++ pEEPROM->CustomerID = RT_CID_819x_Sercomm_Netgear; + else if((pHalData->EEPROMVID == 0x2001) && (pHalData->EEPROMPID == 0x330e))//add by ylb 20121012 for customer led for alpha -+ pHalData->CustomerID = RT_CID_819x_ALPHA_Dlink; ++ pEEPROM->CustomerID = RT_CID_819x_ALPHA_Dlink; + else if((pHalData->EEPROMVID == 0x0B05) && (pHalData->EEPROMPID == 0x17D2))//Edimax for ASUS -+ pHalData->CustomerID = RT_CID_819x_Edimax_ASUS; -+ else if ((pHalData->EEPROMVID == 0x0846) &&(pHalData->EEPROMPID == 0x9052)) -+ pHalData->CustomerID = RT_CID_NETGEAR; -+ else if ((pHalData->EEPROMVID == 0x0411) && ((pHalData->EEPROMPID == 0x0242) || (pHalData->EEPROMPID == 0x025D))) -+ pHalData->CustomerID = RT_CID_DNI_BUFFALO; -+ else if (((pHalData->EEPROMVID == 0x2001) && (pHalData->EEPROMPID == 0x3314)) || -+ ((pHalData->EEPROMVID == 0x20F4) &&(pHalData->EEPROMPID == 0x804B)) || -+ ((pHalData->EEPROMVID == 0x20F4) &&(pHalData->EEPROMPID == 0x805B)) || -+ ((pHalData->EEPROMVID == 0x2001) &&(pHalData->EEPROMPID == 0x3315)) || -+ ((pHalData->EEPROMVID == 0x2001) &&(pHalData->EEPROMPID == 0x3316))) -+ pHalData->CustomerID = RT_CID_DLINK; -+ ++ pEEPROM->CustomerID = RT_CID_819x_Edimax_ASUS; ++ + DBG_871X("VID = 0x%04X, PID = 0x%04X\n", pHalData->EEPROMVID, pHalData->EEPROMPID); + DBG_871X("Customer ID: 0x%02X, SubCustomer ID: 0x%02X\n", pHalData->EEPROMCustomerID, pHalData->EEPROMSubCustomerID); +} + -+VOID -+hal_InitPGData_8812A( -+ IN PADAPTER padapter, -+ IN OUT u8* PROMContent ++static void ++hal_ReadMACAddress_8812AU( ++ PADAPTER Adapter, ++ u8* PROMContent, ++ bool AutoloadFail + ) +{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); ++ ++ if(false == AutoloadFail) ++ { ++ if(IS_HARDWARE_TYPE_8812AU(Adapter)) ++ { ++ //Read Permanent MAC address and set value to hardware ++ _rtw_memcpy(pEEPROM->mac_addr, &PROMContent[EEPROM_MAC_ADDR_8812AU], ETH_ALEN); ++ } ++ else if(IS_HARDWARE_TYPE_8821U(Adapter)) ++ { ++ //Read Permanent MAC address and set value to hardware ++ _rtw_memcpy(pEEPROM->mac_addr, &PROMContent[EEPROM_MAC_ADDR_8821AU], ETH_ALEN); ++ } ++ } ++ else ++ { ++ //Random assigh MAC address ++ u8 sMacAddr[ETH_ALEN] = {0x00, 0xE0, 0x4C, 0x88, 0x12, 0x00}; ++ //sMacAddr[5] = (u8)GetRandomNumber(1, 254); ++ _rtw_memcpy(pEEPROM->mac_addr, sMacAddr, ETH_ALEN); ++ } ++ ++ DBG_8192C("%s MAC Address from EFUSE = "MAC_FMT"\n",__FUNCTION__, MAC_ARG(pEEPROM->mac_addr)); ++} ++ ++static void ++hal_InitPGData_8812A( ++ PADAPTER padapter, ++ u8* PROMContent ++ ) ++{ ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); ++// HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + u32 i; + u16 value16; + -+ if(_FALSE == pHalData->bautoload_fail_flag) ++ if(false == pEEPROM->bautoload_fail_flag) + { // autoload OK. + if (is_boot_from_eeprom(padapter)) + { + // Read all Content from EEPROM or EFUSE. + for(i = 0; i < HWSET_MAX_SIZE_JAGUAR; i += 2) + { -+ //value16 = EF2Byte(ReadEEprom(pAdapter, (u2Byte) (i>>1))); ++ //value16 = le16_to_cpu(ReadEEprom(pAdapter, (u2Byte) (i>>1))); + //*((u16*)(&PROMContent[i])) = value16; + } + } + else + { -+ // -+ // 2013/03/08 MH Add for 8812A HW limitation, ROM code can only -+ // -+ if (IS_HARDWARE_TYPE_8812AU(padapter)) -+ { -+ u8 efuse_content[4]; -+ efuse_OneByteRead(padapter, 0x200, &efuse_content[0], _FALSE); -+ efuse_OneByteRead(padapter, 0x202, &efuse_content[1], _FALSE); -+ efuse_OneByteRead(padapter, 0x204, &efuse_content[2], _FALSE); -+ efuse_OneByteRead(padapter, 0x210, &efuse_content[3], _FALSE); -+ if (efuse_content[0] != 0xFF || -+ efuse_content[1] != 0xFF || -+ efuse_content[2] != 0xFF || -+ efuse_content[3] != 0xFF) -+ { -+ //DbgPrint("Disable FW ofl load\n"); -+ //pMgntInfo->RegFWOffload = FALSE; -+ } -+ } -+ + // Read EFUSE real map to shadow. -+ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, _FALSE); ++ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, false); + } + } + else + {//autoload fail + RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("AutoLoad Fail reported from CR9346!!\n")); -+ //pHalData->AutoloadFailFlag = _TRUE; -+ // -+ // 2013/03/08 MH Add for 8812A HW limitation, ROM code can only -+ // -+ if (IS_HARDWARE_TYPE_8812AU(padapter)) -+ { -+ u8 efuse_content[4]; -+ efuse_OneByteRead(padapter, 0x200, &efuse_content[0], _FALSE); -+ efuse_OneByteRead(padapter, 0x202, &efuse_content[1], _FALSE); -+ efuse_OneByteRead(padapter, 0x204, &efuse_content[2], _FALSE); -+ efuse_OneByteRead(padapter, 0x210, &efuse_content[3], _FALSE); -+ if (efuse_content[0] != 0xFF || -+ efuse_content[1] != 0xFF || -+ efuse_content[2] != 0xFF || -+ efuse_content[3] != 0xFF) -+ { -+ //DbgPrint("Disable FW ofl load\n"); -+ //pMgntInfo->RegFWOffload = FALSE; -+ pHalData->bautoload_fail_flag=_FALSE; -+ } -+ else -+ { -+ //DbgPrint("EFUSE_Read1Byte(pAdapter, (u2Byte)512) = %x\n", EFUSE_Read1Byte(pAdapter, (u2Byte)512)); -+ } -+ } -+ ++ //pHalData->AutoloadFailFlag = true; + //update to default value 0xFF + if (!is_boot_from_eeprom(padapter)) -+ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, _FALSE); ++ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, false); + } -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ if (check_phy_efuse_tx_power_info_valid(padapter) == _FALSE) { -+ if (Hal_readPGDataFromConfigFile(padapter) != _SUCCESS) -+ DBG_871X_LEVEL(_drv_err_, "invalid phy efuse and read from file fail, will use driver default!!\n"); -+ } -+#endif +} + -+VOID ++static void +hal_CustomizedBehavior_8812AU( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); + struct led_priv *pledpriv = &(Adapter->ledpriv); + -+ ++ + // Led mode -+ switch(pHalData->CustomerID) ++ switch(pEEPROM->CustomerID) + { + case RT_CID_DEFAULT: + pledpriv->LedStrategy = SW_LED_MODE9; -+ pledpriv->bRegUseLed = _TRUE; ++ pledpriv->bRegUseLed = true; + break; + + case RT_CID_819x_HP: @@ -285427,226 +127827,237 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + break; + + case RT_CID_WNC_NEC: -+ pledpriv->LedStrategy = SW_LED_MODE12; ++ pledpriv->LedStrategy = SW_LED_MODE12; + break; + + case RT_CID_NETGEAR: + pledpriv->LedStrategy = SW_LED_MODE13; + break; + -+ case RT_CID_DNI_BUFFALO: -+ pledpriv->LedStrategy = SW_LED_MODE14; -+ break; -+ -+ case RT_CID_DLINK: -+ pledpriv->LedStrategy = SW_LED_MODE15; -+ break; -+ + default: + pledpriv->LedStrategy = SW_LED_MODE9; + break; + } + -+ pHalData->bLedOpenDrain = _TRUE;// Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. ++ pHalData->bLedOpenDrain = true;// Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. +} + +static void +hal_CustomizeByCustomerID_8812AU( -+ IN PADAPTER pAdapter ++ PADAPTER pAdapter + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); + + // For customized behavior. + if((pHalData->EEPROMVID == 0x103C) && (pHalData->EEPROMPID == 0x1629))// HP Lite-On for RTL8188CUS Slim Combo. -+ pHalData->CustomerID = RT_CID_819x_HP; ++ pEEPROM->CustomerID = RT_CID_819x_HP; + else if ((pHalData->EEPROMVID == 0x9846) && (pHalData->EEPROMPID == 0x9041)) -+ pHalData->CustomerID = RT_CID_NETGEAR; ++ pEEPROM->CustomerID = RT_CID_NETGEAR; + else if ((pHalData->EEPROMVID == 0x2019) && (pHalData->EEPROMPID == 0x1201)) -+ pHalData->CustomerID = RT_CID_PLANEX; ++ pEEPROM->CustomerID = RT_CID_PLANEX; + else if((pHalData->EEPROMVID == 0x0BDA) &&(pHalData->EEPROMPID == 0x5088)) -+ pHalData->CustomerID = RT_CID_CC_C; -+ else if ((pHalData->EEPROMVID == 0x0411) && ((pHalData->EEPROMPID == 0x0242) || (pHalData->EEPROMPID == 0x025D))) -+ pHalData->CustomerID = RT_CID_DNI_BUFFALO; -+ else if (((pHalData->EEPROMVID == 0x2001) && (pHalData->EEPROMPID == 0x3314)) || -+ ((pHalData->EEPROMVID == 0x20F4) &&(pHalData->EEPROMPID == 0x804B)) || -+ ((pHalData->EEPROMVID == 0x20F4) &&(pHalData->EEPROMPID == 0x805B)) || -+ ((pHalData->EEPROMVID == 0x2001) &&(pHalData->EEPROMPID == 0x3315)) || -+ ((pHalData->EEPROMVID == 0x2001) &&(pHalData->EEPROMPID == 0x3316))) -+ pHalData->CustomerID = RT_CID_DLINK; -+ ++ pEEPROM->CustomerID = RT_CID_CC_C; ++ + DBG_871X("PID= 0x%x, VID= %x\n",pHalData->EEPROMPID,pHalData->EEPROMVID); -+ ++ + // Decide CustomerID according to VID/DID or EEPROM + switch(pHalData->EEPROMCustomerID) + { + case EEPROM_CID_DEFAULT: + if((pHalData->EEPROMVID == 0x2001) && (pHalData->EEPROMPID == 0x3308)) -+ pHalData->CustomerID = RT_CID_DLINK; ++ pEEPROM->CustomerID = RT_CID_DLINK; + else if((pHalData->EEPROMVID == 0x2001) && (pHalData->EEPROMPID == 0x3309)) -+ pHalData->CustomerID = RT_CID_DLINK; ++ pEEPROM->CustomerID = RT_CID_DLINK; + else if((pHalData->EEPROMVID == 0x2001) && (pHalData->EEPROMPID == 0x330a)) -+ pHalData->CustomerID = RT_CID_DLINK; ++ pEEPROM->CustomerID = RT_CID_DLINK; + else if((pHalData->EEPROMVID == 0x0BFF) && (pHalData->EEPROMPID == 0x8160)) + { -+ //pHalData->bAutoConnectEnable = _FALSE; -+ pHalData->CustomerID = RT_CID_CHINA_MOBILE; -+ } ++ //pHalData->bAutoConnectEnable = false; ++ pEEPROM->CustomerID = RT_CID_CHINA_MOBILE; ++ } + else if((pHalData->EEPROMVID == 0x0BDA) && (pHalData->EEPROMPID == 0x5088)) -+ pHalData->CustomerID = RT_CID_CC_C; ++ pEEPROM->CustomerID = RT_CID_CC_C; + else if ((pHalData->EEPROMVID == 0x0846) &&(pHalData->EEPROMPID == 0x9052)) -+ pHalData->CustomerID = RT_CID_NETGEAR; -+ else if ((pHalData->EEPROMVID == 0x0411) && ((pHalData->EEPROMPID == 0x0242) || (pHalData->EEPROMPID == 0x025D))) -+ pHalData->CustomerID = RT_CID_DNI_BUFFALO; -+ else if (((pHalData->EEPROMVID == 0x2001) && (pHalData->EEPROMPID == 0x3314)) || -+ ((pHalData->EEPROMVID == 0x20F4) &&(pHalData->EEPROMPID == 0x804B)) || -+ ((pHalData->EEPROMVID == 0x20F4) &&(pHalData->EEPROMPID == 0x805B)) || -+ ((pHalData->EEPROMVID == 0x2001) &&(pHalData->EEPROMPID == 0x3315)) || -+ ((pHalData->EEPROMVID == 0x2001) &&(pHalData->EEPROMPID == 0x3316))) -+ pHalData->CustomerID = RT_CID_DLINK; ++ pEEPROM->CustomerID = RT_CID_NETGEAR; + DBG_871X("PID= 0x%x, VID= %x\n",pHalData->EEPROMPID,pHalData->EEPROMVID); + break; + case EEPROM_CID_WHQL: -+ //padapter->bInHctTest = TRUE; -+ -+ //pMgntInfo->bSupportTurboMode = FALSE; -+ //pMgntInfo->bAutoTurboBy8186 = FALSE; -+ -+ //pMgntInfo->PowerSaveControl.bInactivePs = FALSE; -+ //pMgntInfo->PowerSaveControl.bIPSModeBackup = FALSE; -+ //pMgntInfo->PowerSaveControl.bLeisurePs = FALSE; -+ //pMgntInfo->PowerSaveControl.bLeisurePsModeBackup = FALSE; ++ //padapter->bInHctTest = true; ++ ++ //pMgntInfo->bSupportTurboMode = false; ++ //pMgntInfo->bAutoTurboBy8186 = false; ++ ++ //pMgntInfo->PowerSaveControl.bInactivePs = false; ++ //pMgntInfo->PowerSaveControl.bIPSModeBackup = false; ++ //pMgntInfo->PowerSaveControl.bLeisurePs = false; ++ //pMgntInfo->PowerSaveControl.bLeisurePsModeBackup = false; + //pMgntInfo->keepAliveLevel = 0; -+ -+ //padapter->bUnloadDriverwhenS3S4 = FALSE; -+ break; -+ default: -+ pHalData->CustomerID = RT_CID_DEFAULT; ++ ++ //padapter->bUnloadDriverwhenS3S4 = false; + break; -+ ++ default: ++ pEEPROM->CustomerID = RT_CID_DEFAULT; ++ break; ++ + } -+ DBG_871X("Customer ID: 0x%2x\n", pHalData->CustomerID); -+ ++ DBG_871X("Customer ID: 0x%2x\n", pEEPROM->CustomerID); ++ + hal_CustomizedBehavior_8812AU(pAdapter); +} + -+VOID ++static void +hal_ReadUsbModeSwitch_8812AU( -+ IN PADAPTER Adapter, -+ IN u8* PROMContent, -+ IN BOOLEAN AutoloadFail ++ PADAPTER Adapter, ++ u8* PROMContent, ++ bool AutoloadFail + ) +{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if(AutoloadFail) -+ pHalData->EEPROMUsbSwitch = _FALSE; -+ else -+ /* check efuse 0x08 bit2 */ -+ pHalData->EEPROMUsbSwitch = (PROMContent[EEPROM_USB_MODE_8812] & BIT1) >> 1; -+ -+ DBG_871X("Usb Switch: %d\n", pHalData->EEPROMUsbSwitch); +} + -+static VOID ++static void +ReadLEDSetting_8812AU( -+ IN PADAPTER Adapter, -+ IN u8* PROMContent, -+ IN BOOLEAN AutoloadFail ++ PADAPTER Adapter, ++ u8* PROMContent, ++ bool AutoloadFail + ) +{ + struct led_priv *pledpriv = &(Adapter->ledpriv); + +#ifdef CONFIG_SW_LED -+ pledpriv->bRegUseLed = _TRUE; ++ pledpriv->bRegUseLed = true; +#else // HW LED + pledpriv->LedStrategy = HW_LED; +#endif //CONFIG_SW_LED +} + -+VOID ++static void +InitAdapterVariablesByPROM_8812AU( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) +{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); + -+ hal_InitPGData_8812A(Adapter, pHalData->efuse_eeprom_data); ++ hal_InitPGData_8812A(Adapter, pEEPROM->efuse_eeprom_data); ++ Hal_EfuseParseIDCode8812A(Adapter, pEEPROM->efuse_eeprom_data); + -+ Hal_EfuseParseIDCode8812A(Adapter, pHalData->efuse_eeprom_data); -+ -+ Hal_ReadPROMVersion8812A(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ hal_ReadIDs_8812AU(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ hal_config_macaddr(Adapter, pHalData->bautoload_fail_flag); -+ Hal_ReadTxPowerInfo8812A(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ Hal_ReadBoardType8812A(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ Hal_ReadPROMVersion8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); ++ hal_ReadIDs_8812AU(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); ++ hal_ReadMACAddress_8812AU(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); ++ Hal_ReadTxPowerInfo8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); ++ Hal_ReadBoardType8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); + + // + // Read Bluetooth co-exist and initialize + // -+ Hal_EfuseParseBTCoexistInfo8812A(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ -+ Hal_ReadChannelPlan8812A(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ Hal_EfuseParseXtal_8812A(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ Hal_ReadThermalMeter_8812A(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ Hal_ReadRemoteWakeup_8812A(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ Hal_ReadAntennaDiversity8812A(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ Hal_EfuseParseBTCoexistInfo8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); ++ ++ Hal_ReadChannelPlan8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); ++ Hal_EfuseParseXtal_8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); ++ Hal_ReadThermalMeter_8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); ++ Hal_ReadAntennaDiversity8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); + + if(IS_HARDWARE_TYPE_8821U(Adapter)) + { -+ Hal_ReadPAType_8821A(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ Hal_ReadPAType_8821A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); + } + else + { -+ Hal_ReadAmplifierType_8812A(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ Hal_ReadRFEType_8812A(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ Hal_ReadPAType_8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); ++ Hal_ReadRFEType_8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); + } + -+ hal_ReadUsbModeSwitch_8812AU(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ hal_ReadUsbModeSwitch_8812AU(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); + hal_CustomizeByCustomerID_8812AU(Adapter); + -+ ReadLEDSetting_8812AU(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ ReadLEDSetting_8812AU(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); + + // 2013/04/15 MH Add for different board type recognize. -+ hal_ReadUsbType_8812AU(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ -+ if (IS_HARDWARE_TYPE_8821U(Adapter)) -+ Hal_EfuseParseKFreeData_8821A(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); ++ hal_ReadUsbType_8812AU(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); +} + +static void Hal_ReadPROMContent_8812A( -+ IN PADAPTER Adapter ++ PADAPTER Adapter + ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); ++{ ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); + u8 eeValue; + + /* check system boot selection */ + eeValue = rtw_read8(Adapter, REG_9346CR); -+ pHalData->EepromOrEfuse = (eeValue & BOOT_FROM_EEPROM) ? _TRUE : _FALSE; -+ pHalData->bautoload_fail_flag = (eeValue & EEPROM_EN) ? _FALSE : _TRUE; ++ pEEPROM->EepromOrEfuse = (eeValue & BOOT_FROM_EEPROM) ? true : false; ++ pEEPROM->bautoload_fail_flag = (eeValue & EEPROM_EN) ? false : true; + -+ DBG_8192C("Boot from %s, Autoload %s !\n", (pHalData->EepromOrEfuse ? "EEPROM" : "EFUSE"), -+ (pHalData->bautoload_fail_flag ? "Fail" : "OK") ); ++ DBG_8192C("Boot from %s, Autoload %s !\n", (pEEPROM->EepromOrEfuse ? "EEPROM" : "EFUSE"), ++ (pEEPROM->bautoload_fail_flag ? "Fail" : "OK") ); + + //pHalData->EEType = IS_BOOT_FROM_EEPROM(Adapter) ? EEPROM_93C46 : EEPROM_BOOT_EFUSE; + + InitAdapterVariablesByPROM_8812AU(Adapter); +} + -+void -+ReadAdapterInfo8812AU( -+ IN PADAPTER Adapter ++static void ++hal_ReadRFType_8812A( ++ PADAPTER Adapter + ) +{ -+ /* Read all content in Efuse/EEPROM. */ -+ Hal_ReadPROMContent_8812A(Adapter); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + -+ /* We need to define the RF type after all PROM value is recognized. */ -+ ReadRFType8812A(Adapter); ++#if DISABLE_BB_RF ++ pHalData->rf_chip = RF_PSEUDO_11N; ++#else ++ pHalData->rf_chip = RF_6052; ++#endif ++ ++ //if (pHalData->rf_type == RF_1T1R){ ++ // pHalData->bRFPathRxEnable[0] = true; ++ //} ++ //else { // Default unknow type is 2T2r ++ // pHalData->bRFPathRxEnable[0] = pHalData->bRFPathRxEnable[1] = true; ++ //} ++ ++ if (IsSupported24G(Adapter->registrypriv.wireless_mode) && ++ IsSupported5G(Adapter->registrypriv.wireless_mode)) ++ pHalData->BandSet = BAND_ON_BOTH; ++ else if (IsSupported5G(Adapter->registrypriv.wireless_mode)) ++ pHalData->BandSet = BAND_ON_5G; ++ else ++ pHalData->BandSet = BAND_ON_2_4G; ++ ++ //if(Adapter->bInHctTest) ++ // pHalData->BandSet = BAND_ON_2_4G; +} + -+void UpdateInterruptMask8812AU(PADAPTER padapter,u8 bHIMR0 ,u32 AddMSR, u32 RemoveMSR) ++static void ++hal_CustomizedBehavior_8812AUsb( ++ PADAPTER Adapter ++ ) ++{ ++} ++ ++static void ++ReadAdapterInfo8812AU( ++ PADAPTER Adapter ++ ) ++{ ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ ++ DBG_871X("====> ReadAdapterInfo8812AU\n"); ++ ++ // Read all content in Efuse/EEPROM. ++ Hal_ReadPROMContent_8812A(Adapter); ++ ++ // We need to define the RF type after all PROM value is recognized. ++ hal_ReadRFType_8812A(Adapter); ++ ++ // 2011/02/09 MH We gather the same value for all USB series IC. ++ hal_CustomizedBehavior_8812AUsb(Adapter); ++ ++ DBG_871X("ReadAdapterInfo8812AU <====\n"); ++} ++ ++static void UpdateInterruptMask8812AU(PADAPTER padapter,u8 bHIMR0 ,u32 AddMSR, u32 RemoveMSR) +{ + HAL_DATA_TYPE *pHalData; + @@ -285657,25 +128068,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + himr = &(pHalData->IntrMask[0]); + else + himr = &(pHalData->IntrMask[1]); -+ ++ + if (AddMSR) + *himr |= AddMSR; + + if (RemoveMSR) + *himr &= (~RemoveMSR); + -+ if(bHIMR0) ++ if(bHIMR0) + rtw_write32(padapter, REG_HIMR0_8812, *himr); + else -+ rtw_write32(padapter, REG_HIMR1_8812, *himr); ++ rtw_write32(padapter, REG_HIMR1_8812, *himr); + +} + -+void SetHwReg8812AU(PADAPTER Adapter, u8 variable, u8* val) ++static void SetHwReg8812AU(PADAPTER Adapter, u8 variable, u8* val) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(Adapter); -+_func_enter_; ++ struct dm_priv *pdmpriv = &pHalData->dmpriv; ++ DM_ODM_T *podmpriv = &pHalData->odmpriv; ++ + + switch(variable) + { @@ -285695,34 +128107,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +#ifdef CONFIG_LPS_LCLK + { + u8 ps_state = *((u8 *)val); -+ -+ /*rpwm value only use BIT0(clock bit) ,BIT6(Ack bit), and BIT7(Toggle bit) for 88e. -+ BIT0 value - 1: 32k, 0:40MHz. -+ BIT6 value - 1: report cpwm value after success set, 0:do not report. -+ BIT7 value - Toggle bit change. -+ modify by Thomas. 2012/4/2.*/ -+ ps_state = ps_state & 0xC1; -+ /*DBG_871X("##### Change RPWM value to = %x for switch clk #####\n", ps_state);*/ -+ rtw_write8(Adapter, REG_USB_HRPWM, ps_state); -+ } -+#endif -+#ifdef CONFIG_AP_WOWLAN -+ if (pwrctl->wowlan_ap_mode == _TRUE) { -+ u8 ps_state = *((u8 *)val); -+ -+ DBG_871X("%s, RPWM\n", __func__); ++ //rpwm value only use BIT0(clock bit) ,BIT6(Ack bit), and BIT7(Toggle bit) for 88e. ++ //BIT0 value - 1: 32k, 0:40MHz. ++ //BIT6 value - 1: report cpwm value after success set, 0:do not report. ++ //BIT7 value - Toggle bit change. ++ //modify by Thomas. 2012/4/2. + ps_state = ps_state & 0xC1; ++ //DBG_871X("##### Change RPWM value to = %x for switch clk #####\n",ps_state); + rtw_write8(Adapter, REG_USB_HRPWM, ps_state); + } +#endif + break; -+ + case HW_VAR_USB_MODE: + if(*val == 1) + rtw_write8(Adapter, REG_OPT_CTRL_8812, 0x4); + else if(*val == 2) + rtw_write8(Adapter, REG_OPT_CTRL_8812, 0x8); -+ ++ + rtw_write8(Adapter, REG_SDIO_CTRL_8812, 0x2); + rtw_write8(Adapter, REG_ACLK_MON, 0x1); + // @@ -285737,19 +128138,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + //rtw_write8(Adapter, REG_CAL_TIMER+1, 0x3); + rtw_write8(Adapter, REG_APS_FSMCO+1, 0x80); + break; -+ + default: + SetHwReg8812A(Adapter, variable, val); + break; + } + -+_func_exit_; ++ +} + -+void GetHwReg8812AU(PADAPTER Adapter, u8 variable, u8* val) ++static void GetHwReg8812AU(PADAPTER Adapter, u8 variable, u8* val) +{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+_func_enter_; ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); ++ DM_ODM_T *podmpriv = &pHalData->odmpriv; ++ + + switch(variable) + { @@ -285758,18 +128159,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + break; + } + -+_func_exit_; ++ +} + +// +// Description: +// Change default setting of specified variable. +// -+u8 ++static u8 +SetHalDefVar8812AUsb( -+ IN PADAPTER Adapter, -+ IN HAL_DEF_VARIABLE eVariable, -+ IN PVOID pValue ++ PADAPTER Adapter, ++ HAL_DEF_VARIABLE eVariable, ++ void * pValue + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -285786,14 +128187,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +} + +// -+// Description: ++// Description: +// Query setting of specified variable. +// -+u8 ++static u8 +GetHalDefVar8812AUsb( -+ IN PADAPTER Adapter, -+ IN HAL_DEF_VARIABLE eVariable, -+ IN PVOID pValue ++ PADAPTER Adapter, ++ HAL_DEF_VARIABLE eVariable, ++ void * pValue + ) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -285809,7 +128210,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + return bResult; +} + -+void _update_response_rate(_adapter *padapter,unsigned int mask) ++static void _update_response_rate(_adapter *padapter,unsigned int mask) +{ + u8 RateIndex = 0; + // Set RRSR rate table. @@ -285828,13 +128229,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +static void rtl8812au_init_default_value(_adapter * padapter) +{ + PHAL_DATA_TYPE pHalData; ++ struct pwrctrl_priv *pwrctrlpriv; ++ struct dm_priv *pdmpriv; ++ u8 i; + + pHalData = GET_HAL_DATA(padapter); ++ pwrctrlpriv = &padapter->pwrctrlpriv; ++ pdmpriv = &pHalData->dmpriv; + -+ InitDefaultValue8821A(padapter); ++ ++ //init default value ++ pHalData->fw_ractrl = false; ++ if(!pwrctrlpriv->bkeepfwalive) ++ pHalData->LastHMEBoxNum = 0; ++ ++ //init dm default value ++ pHalData->bChnlBWInitialzed = false; ++ pHalData->odmpriv.RFCalibrateInfo.bIQKInitialized = false; ++ pHalData->odmpriv.RFCalibrateInfo.TM_Trigger = 0;//for IQK ++ pHalData->pwrGroupCnt = 0; ++ pHalData->PGMaxGroup= MAX_PG_GROUP; ++ pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP_index = 0; ++ for(i = 0; i < HP_THERMAL_NUM; i++) ++ pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP[i] = 0; + + pHalData->IntrMask[0] = (u32)( \ -+ //IMR_ROK | ++ //IMR_ROK | + //IMR_RDU | + //IMR_VODOK | + //IMR_VIDOK | @@ -285859,7 +128279,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + //IMR_TXCCK | + 0); + -+ pHalData->IntrMask[1] = (u32)(\ ++ pHalData->IntrMask[1] = (u32)(\ + //IMR_RXFOVW | + //IMR_TXFOVW | + //IMR_RXERR | @@ -285883,8 +128303,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +} + +static u8 rtl8812au_ps_func(PADAPTER Adapter,HAL_INTF_PS_FUNC efunc_id, u8 *val) -+{ -+ u8 bResult = _TRUE; ++{ ++ u8 bResult = true; + switch(efunc_id){ + + #if defined(CONFIG_AUTOSUSPEND) && defined(SUPPORT_HW_RFOFF_DETECTED) @@ -285906,14 +128326,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +{ + struct hal_ops *pHalFunc = &padapter->HalFunc; + -+_func_enter_; + -+ pHalFunc->hal_power_on = _InitPowerOn_8812AU; -+ pHalFunc->hal_power_off = hal_poweroff_8812au; -+ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if(padapter->isprimary) ++#endif //CONFIG_CONCURRENT_MODE ++ { ++ padapter->HalData = rtw_zmalloc(sizeof(HAL_DATA_TYPE)); ++ if(padapter->HalData == NULL){ ++ DBG_8192C("cant not alloc memory for HAL DATA \n"); ++ } ++ } ++ //_rtw_memset(padapter->HalData, 0, sizeof(HAL_DATA_TYPE)); ++ padapter->hal_data_sz = sizeof(HAL_DATA_TYPE); ++ ++ pHalFunc->hal_power_on = _InitPowerOn8812AU; + pHalFunc->hal_init = &rtl8812au_hal_init; + pHalFunc->hal_deinit = &rtl8812au_hal_deinit; + ++ //pHalFunc->free_hal_data = &rtl8192c_free_hal_data; ++ + pHalFunc->inirp_init = &rtl8812au_inirp_init; + pHalFunc->inirp_deinit = &rtl8812au_inirp_deinit; + @@ -285927,17 +128359,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd + pHalFunc->DeInitSwLeds = &rtl8812au_DeInitSwLeds; +#else //case of hw led or no led + pHalFunc->InitSwLeds = NULL; -+ pHalFunc->DeInitSwLeds = NULL; ++ pHalFunc->DeInitSwLeds = NULL; +#endif//CONFIG_SW_LED -+ ++ + pHalFunc->init_default_value = &rtl8812au_init_default_value; + pHalFunc->intf_chip_configure = &rtl8812au_interface_configure; + pHalFunc->read_adapter_info = &ReadAdapterInfo8812AU; + + pHalFunc->SetHwRegHandler = &SetHwReg8812AU; + pHalFunc->GetHwRegHandler = &GetHwReg8812AU; -+ pHalFunc->GetHalDefVarHandler = &GetHalDefVar8812AUsb; -+ pHalFunc->SetHalDefVarHandler = &SetHalDefVar8812AUsb; ++ pHalFunc->GetHalDefVarHandler = &GetHalDefVar8812AUsb; ++ pHalFunc->SetHalDefVarHandler = &SetHalDefVar8812AUsb; ++ ++ pHalFunc->SetBeaconRelatedRegistersHandler = &SetBeaconRelatedRegisters8812A; + + pHalFunc->hal_xmit = &rtl8812au_hal_xmit; + pHalFunc->mgnt_xmit = &rtl8812au_mgnt_xmit; @@ -285950,23 +128384,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_halinit.c linux/3rd +#ifdef CONFIG_XMIT_THREAD_MODE + pHalFunc->xmit_thread_handler = &rtl8812au_xmit_buf_handler; +#endif -+#ifdef CONFIG_SUPPORT_USB_INT -+ pHalFunc->interrupt_handler = interrupt_handler_8812au; -+#endif -+ + rtl8812_set_hal_ops(pHalFunc); -+_func_exit_; ++ + +} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c ---- linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c 2017-06-07 23:07:21.034689672 +0300 -@@ -0,0 +1,496 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/usb_ops_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/usb_ops_linux.c +--- linux-4.14.17/3rdparty/rtl8812au/hal/usb_ops_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/usb_ops_linux.c 2018-02-06 17:42:30.716967253 +0200 +@@ -0,0 +1,1190 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -285976,30 +128405,187 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _HCI_OPS_OS_C_ + +//#include +#include + ++static u8 usb_read8(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ u8 request; ++ u8 requesttype; ++ u16 wvalue; ++ u16 index; ++ u16 len; ++ u8 data=0; ++ ++ request = 0x05; ++ requesttype = 0x01;//read_in ++ index = 0;//n/a ++ ++ wvalue = (u16)(addr&0x0000ffff); ++ len = 1; ++ ++ usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); ++ ++ return data; ++} ++ ++static u16 usb_read16(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ u8 request; ++ u8 requesttype; ++ u16 wvalue; ++ u16 index; ++ u16 len; ++ __le32 data; ++ ++ request = 0x05; ++ requesttype = 0x01;//read_in ++ index = 0;//n/a ++ ++ wvalue = (u16)(addr&0x0000ffff); ++ len = 2; ++ ++ usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); ++ ++ return (u16)(le32_to_cpu(data)&0xffff); ++} ++ ++static u32 usb_read32(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ u8 request; ++ u8 requesttype; ++ u16 wvalue; ++ u16 index; ++ u16 len; ++ __le32 data; ++ ++ request = 0x05; ++ requesttype = 0x01;//read_in ++ index = 0;//n/a ++ ++ wvalue = (u16)(addr&0x0000ffff); ++ len = 4; ++ ++ usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); ++ ++ return le32_to_cpu(data); ++} ++ ++static int usb_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val) ++{ ++ u8 request; ++ u8 requesttype; ++ u16 wvalue; ++ u16 index; ++ u16 len; ++ u8 data; ++ int ret; ++ ++ request = 0x05; ++ requesttype = 0x00;//write_out ++ index = 0;//n/a ++ ++ wvalue = (u16)(addr&0x0000ffff); ++ len = 1; ++ ++ data = val; ++ ++ ret = usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); ++ ++ return ret; ++} ++ ++static int usb_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val) ++{ ++ u8 request; ++ u8 requesttype; ++ u16 wvalue; ++ u16 index; ++ u16 len; ++ __le32 data; ++ int ret; ++ ++ request = 0x05; ++ requesttype = 0x00;//write_out ++ index = 0;//n/a ++ ++ wvalue = (u16)(addr&0x0000ffff); ++ len = 2; ++ ++ data = cpu_to_le32(val & 0x0000ffff); ++ ++ ret = usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); ++ ++ return ret; ++} ++ ++static int usb_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val) ++{ ++ u8 request; ++ u8 requesttype; ++ u16 wvalue; ++ u16 index; ++ u16 len; ++ __le32 data; ++ int ret; ++ ++ request = 0x05; ++ requesttype = 0x00;//write_out ++ index = 0;//n/a ++ ++ wvalue = (u16)(addr&0x0000ffff); ++ len = 4; ++ data = cpu_to_le32(val); ++ ++ ret =usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); ++ ++ return ret; ++} ++ ++static int usb_writeN(struct intf_hdl *pintfhdl, u32 addr, u32 length, u8 *pdata) ++{ ++ u8 request; ++ u8 requesttype; ++ u16 wvalue; ++ u16 index; ++ u16 len; ++ u8 buf[VENDOR_CMD_MAX_DATA_LEN]={0}; ++ int ret; ++ ++ ++ ++ request = 0x05; ++ requesttype = 0x00;//write_out ++ index = 0;//n/a ++ ++ wvalue = (u16)(addr&0x0000ffff); ++ len = length; ++ _rtw_memcpy(buf, pdata, len ); ++ ++ ret = usbctrl_vendorreq(pintfhdl, request, wvalue, index, buf, len, requesttype); ++ ++ ++ ++ return ret; ++ ++} ++ +#ifdef CONFIG_SUPPORT_USB_INT +void interrupt_handler_8812au(_adapter *padapter,u16 pkt_len,u8 *pbuf) -+{ ++{ + HAL_DATA_TYPE *pHalData=GET_HAL_DATA(padapter); + struct reportpwrstate_parm pwr_rpt; -+ ++ + if ( pkt_len != INTERRUPT_MSG_FORMAT_LEN ) + { + DBG_8192C("%s Invalid interrupt content length (%d)!\n", __FUNCTION__, pkt_len); + return ; + } + -+ // HISR ++ // HISR + _rtw_memcpy(&(pHalData->IntArray[0]), &(pbuf[USB_INTR_CONTENT_HISR_OFFSET]), 4); + _rtw_memcpy(&(pHalData->IntArray[1]), &(pbuf[USB_INTR_CONTENT_HISRE_OFFSET]), 4); + @@ -286007,11 +128593,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + { + u32 hisr=0 ,hisr_ex=0; + _rtw_memcpy(&hisr,&(pHalData->IntArray[0]),4); -+ hisr = le32_to_cpu(hisr); -+ ++ hisr = le32_to_cpu(hisr); ++ + _rtw_memcpy(&hisr_ex,&(pHalData->IntArray[1]),4); + hisr_ex = le32_to_cpu(hisr_ex); -+ ++ + if((hisr != 0) || (hisr_ex!=0)) + DBG_871X("===> %s hisr:0x%08x ,hisr_ex:0x%08x \n",__FUNCTION__,hisr,hisr_ex); + } @@ -286024,9 +128610,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + _rtw_memcpy(&pwr_rpt.state, &(pbuf[USB_INTR_CONTENT_CPWM1_OFFSET]), 1); + //_rtw_memcpy(&pwr_rpt.state2, &(pbuf[USB_INTR_CONTENT_CPWM2_OFFSET]), 1); + -+ //88e's cpwm value only change BIT0, so driver need to add PS_STATE_S2 for LPS flow. -+ pwr_rpt.state |= PS_STATE_S2; -+ _set_workitem(&(adapter_to_pwrctl(padapter)->cpwm_event)); ++ //88e's cpwm value only change BIT0, so driver need to add PS_STATE_S2 for LPS flow. ++ pwr_rpt.state |= PS_STATE_S2; ++ _set_workitem(&padapter->pwrctrlpriv.cpwm_event); + } +#endif//CONFIG_LPS_LCLK + @@ -286037,8 +128623,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + #endif + #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR + if (pHalData->IntArray[0] & (IMR_TBDER_88E|IMR_TBDOK_88E)) -+ #endif -+ { ++ #endif ++ { + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + #if 0 + if(pHalData->IntArray[0] & IMR_BCNDMAINT0_88E) @@ -286048,12 +128634,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + if(pHalData->IntArray[0] & IMR_TBDER_88E) + DBG_8192C("%s: HISR_TXBCNERR\n", __func__); + #endif -+ ++ + + if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) + { + //send_beacon(padapter); -+ if(pmlmepriv->update_bcn == _TRUE) ++ if(pmlmepriv->update_bcn == true) + { + //tx_beacon_hdl(padapter, NULL); + set_tx_beacon_cmd(padapter); @@ -286063,14 +128649,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + if(check_buddy_fwstate(padapter, WIFI_AP_STATE)) + { + //send_beacon(padapter); -+ if(padapter->pbuddy_adapter->mlmepriv.update_bcn == _TRUE) ++ if(padapter->pbuddy_adapter->mlmepriv.update_bcn == true) + { + //tx_beacon_hdl(padapter, NULL); + set_tx_beacon_cmd(padapter->pbuddy_adapter); + } + } +#endif -+ ++ + } +#endif //CONFIG_INTERRUPT_BASED_TXBCN + @@ -286085,137 +128671,230 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + if( pHalData->IntArray[1] & IMR_TXFOVW_88E ) + DBG_871X("===> %s Transmit FIFO Overflow \n",__FUNCTION__); + if( pHalData->IntArray[1] & IMR_RXFOVW_88E ) -+ DBG_871X("===> %s Receive FIFO Overflow \n",__FUNCTION__); ++ DBG_871X("===> %s Receive FIFO Overflow \n",__FUNCTION__); +#endif//DBG_CONFIG_ERROR_DETECT_INT + + -+ // C2H Event ++ // C2H Event + if(pbuf[0]!= 0){ -+ _rtw_memcpy(&(pHalData->C2hArray[0]), &(pbuf[USB_INTR_CONTENT_C2H_OFFSET]), 16); ++ _rtw_memcpy(&(pHalData->C2hArray[0]), &(pbuf[USB_INTR_CONTENT_C2H_OFFSET]), 16); + //rtw_c2h_wk_cmd(padapter); to do.. -+ } -+ ++ } ++ +} +#endif ++ ++#ifdef CONFIG_USB_INTERRUPT_IN_PIPE ++static void usb_read_interrupt_complete(struct urb *purb, struct pt_regs *regs) ++{ ++ int err; ++ _adapter *padapter = (_adapter *)purb->context; ++ ++ if(padapter->bSurpriseRemoved || padapter->bDriverStopped||padapter->bReadPortCancel) ++ { ++ DBG_8192C("%s() RX Warning! bDriverStopped(%d) OR bSurpriseRemoved(%d) bReadPortCancel(%d)\n", ++ __FUNCTION__,padapter->bDriverStopped, padapter->bSurpriseRemoved,padapter->bReadPortCancel); ++ ++ return; ++ } ++ ++ if(purb->status==0)//SUCCESS ++ { ++ if (purb->actual_length > INTERRUPT_MSG_FORMAT_LEN) ++ { ++ DBG_8192C("usb_read_interrupt_complete: purb->actual_length > INTERRUPT_MSG_FORMAT_LEN(%d)\n",INTERRUPT_MSG_FORMAT_LEN); ++ } ++ ++ interrupt_handler_8188eu(padapter, purb->actual_length,purb->transfer_buffer ); ++ ++ err = usb_submit_urb(purb, GFP_ATOMIC); ++ if((err) && (err != (-EPERM))) ++ { ++ DBG_8192C("cannot submit interrupt in-token(err = 0x%08x),urb_status = %d\n",err, purb->status); ++ } ++ } ++ else ++ { ++ DBG_8192C("###=> usb_read_interrupt_complete => urb status(%d)\n", purb->status); ++ ++ switch(purb->status) { ++ case -EINVAL: ++ case -EPIPE: ++ case -ENODEV: ++ case -ESHUTDOWN: ++ //padapter->bSurpriseRemoved=true; ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bSurpriseRemoved=true\n")); ++ case -ENOENT: ++ padapter->bDriverStopped=true; ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bDriverStopped=true\n")); ++ break; ++ case -EPROTO: ++ break; ++ case -EINPROGRESS: ++ DBG_8192C("ERROR: URB IS IN PROGRESS!/n"); ++ break; ++ default: ++ break; ++ } ++ } ++ ++} ++ ++static u32 usb_read_interrupt(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ int err; ++ unsigned int pipe; ++ u32 ret = _SUCCESS; ++ _adapter *adapter = pintfhdl->padapter; ++ struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter); ++ struct recv_priv *precvpriv = &adapter->recvpriv; ++ struct usb_device *pusbd = pdvobj->pusbdev; ++ ++ ++ ++ //translate DMA FIFO addr to pipehandle ++ pipe = ffaddr2pipehdl(pdvobj, addr); ++ ++ usb_fill_int_urb(precvpriv->int_in_urb, pusbd, pipe, ++ precvpriv->int_in_buf, ++ INTERRUPT_MSG_FORMAT_LEN, ++ usb_read_interrupt_complete, ++ adapter, ++ 1); ++ ++ err = usb_submit_urb(precvpriv->int_in_urb, GFP_ATOMIC); ++ if((err) && (err != (-EPERM))) ++ { ++ DBG_8192C("cannot submit interrupt in-token(err = 0x%08x),urb_status = %d\n",err, precvpriv->int_in_urb->status); ++ ret = _FAIL; ++ } ++ ++ ++ ++ return ret; ++} ++#endif ++ +static s32 pre_recv_entry(union recv_frame *precvframe, u8 *pphy_status) -+{ ++{ + s32 ret=_SUCCESS; -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 *secondary_myid, *paddr1; ++#ifdef CONFIG_CONCURRENT_MODE ++ u8 *primary_myid, *secondary_myid, *paddr1; + union recv_frame *precvframe_if2 = NULL; + _adapter *primary_padapter = precvframe->u.hdr.adapter; + _adapter *secondary_padapter = primary_padapter->pbuddy_adapter; + struct recv_priv *precvpriv = &primary_padapter->recvpriv; + _queue *pfree_recv_queue = &precvpriv->free_recv_queue; + u8 *pbuf = precvframe->u.hdr.rx_data; -+ ++ + if(!secondary_padapter) + return ret; -+ ++ + paddr1 = GetAddr1Ptr(pbuf); + -+ if(IS_MCAST(paddr1) == _FALSE)//unicast packets ++ if(IS_MCAST(paddr1) == false)//unicast packets + { -+ secondary_myid = adapter_mac_addr(secondary_padapter); ++ //primary_myid = myid(&primary_padapter->eeprompriv); ++ secondary_myid = myid(&secondary_padapter->eeprompriv); + + if(_rtw_memcmp(paddr1, secondary_myid, ETH_ALEN)) -+ { ++ { + //change to secondary interface + precvframe->u.hdr.adapter = secondary_padapter; -+ } ++ } + + //ret = recv_entry(precvframe); + + } -+ else // Handle BC/MC Packets ++ else // Handle BC/MC Packets + { -+ -+ u8 clone = _TRUE; ++ ++ u8 clone = true; +#if 0 + u8 type, subtype, *paddr2, *paddr3; -+ ++ + type = GetFrameType(pbuf); + subtype = GetFrameSubType(pbuf); //bit(7)~bit(2) -+ ++ + switch (type) + { + case WIFI_MGT_TYPE: //Handle BC/MC mgnt Packets + if(subtype == WIFI_BEACON) + { + paddr3 = GetAddr3Ptr(precvframe->u.hdr.rx_data); -+ ++ + if (check_fwstate(&secondary_padapter->mlmepriv, _FW_LINKED) && + _rtw_memcmp(paddr3, get_bssid(&secondary_padapter->mlmepriv), ETH_ALEN)) + { + //change to secondary interface + precvframe->u.hdr.adapter = secondary_padapter; -+ clone = _FALSE; ++ clone = false; + } + + if(check_fwstate(&primary_padapter->mlmepriv, _FW_LINKED) && + _rtw_memcmp(paddr3, get_bssid(&primary_padapter->mlmepriv), ETH_ALEN)) + { -+ if(clone==_FALSE) ++ if(clone==false) + { -+ clone = _TRUE; -+ } ++ clone = true; ++ } + else + { -+ clone = _FALSE; ++ clone = false; + } + -+ precvframe->u.hdr.adapter = primary_padapter; ++ precvframe->u.hdr.adapter = primary_padapter; + } + + if(check_fwstate(&primary_padapter->mlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) || + check_fwstate(&secondary_padapter->mlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)) + { -+ clone = _TRUE; -+ precvframe->u.hdr.adapter = primary_padapter; ++ clone = true; ++ precvframe->u.hdr.adapter = primary_padapter; + } -+ ++ + } + else if(subtype == WIFI_PROBEREQ) + { + //probe req frame is only for interface2 + //change to secondary interface + precvframe->u.hdr.adapter = secondary_padapter; -+ clone = _FALSE; -+ } ++ clone = false; ++ } + break; + case WIFI_CTRL_TYPE: // Handle BC/MC ctrl Packets -+ ++ + break; + case WIFI_DATA_TYPE: //Handle BC/MC data Packets + //Notes: AP MODE never rx BC/MC data packets -+ ++ + paddr2 = GetAddr2Ptr(precvframe->u.hdr.rx_data); + + if(_rtw_memcmp(paddr2, get_bssid(&secondary_padapter->mlmepriv), ETH_ALEN)) + { + //change to secondary interface + precvframe->u.hdr.adapter = secondary_padapter; -+ clone = _FALSE; ++ clone = false; + } + + break; + default: -+ -+ break; ++ ++ break; + } +#endif + -+ if(_TRUE == clone) ++ if(true == clone) + { -+ //clone/copy to if2 ++ //clone/copy to if2 + struct rx_pkt_attrib *pattrib = NULL; -+ ++ + precvframe_if2 = rtw_alloc_recvframe(pfree_recv_queue); + if(precvframe_if2) + { + precvframe_if2->u.hdr.adapter = secondary_padapter; -+ -+ _rtw_init_listhead(&precvframe_if2->u.hdr.list); ++ ++ _rtw_init_listhead(&precvframe_if2->u.hdr.list); + precvframe_if2->u.hdr.precvbuf = NULL; //can't access the precvbuf for new arch. + precvframe_if2->u.hdr.len=0; + @@ -286223,30 +128902,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + + pattrib = &precvframe_if2->u.hdr.attrib; + -+ if(rtw_os_alloc_recvframe(secondary_padapter, precvframe_if2, pbuf, NULL) == _SUCCESS) -+ { ++ if(rtw_os_alloc_recvframe(secondary_padapter, precvframe_if2, pbuf, NULL) == _SUCCESS) ++ { + recvframe_put(precvframe_if2, pattrib->pkt_len); + //recvframe_pull(precvframe_if2, drvinfo_sz + RXDESC_SIZE); + + if (pattrib->physt && pphy_status) -+ rx_query_phy_status(precvframe_if2, pphy_status); -+ -+ ret = rtw_recv_entry(precvframe_if2); -+ } ++ rtl8812_query_rx_phy_status(precvframe_if2, pphy_status); ++ ++ ret = rtw_recv_entry(precvframe_if2); ++ } + else + { + rtw_free_recvframe(precvframe_if2, pfree_recv_queue); -+ DBG_8192C("%s()-%d: alloc_skb() failed!\n", __FUNCTION__, __LINE__); ++ DBG_8192C("%s()-%d: alloc_skb() failed!\n", __FUNCTION__, __LINE__); + } + + } -+ ++ + } -+ ++ + } + //if (precvframe->u.hdr.attrib.physt) -+ // rx_query_phy_status(precvframe, pphy_status); -+ ++ // rtl8812_query_rx_phy_status(precvframe, pphy_status); ++ + //ret = rtw_recv_entry(precvframe); + +#endif @@ -286255,26 +128934,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + +} + -+int recvbuf2recvframe(PADAPTER padapter, void *ptr) ++static int recvbuf2recvframe(_adapter *padapter, ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX ++struct recv_buf *precvbuf ++#else ++_pkt *pskb ++#endif ++) +{ + u8 *pbuf; + u8 pkt_cnt = 0; + u32 pkt_offset; + s32 transfer_len; -+ u8 *pphy_status = NULL; ++ u8 *pphy_status = NULL; + union recv_frame *precvframe = NULL; + struct rx_pkt_attrib *pattrib = NULL; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + struct recv_priv *precvpriv = &padapter->recvpriv; + _queue *pfree_recv_queue = &precvpriv->free_recv_queue; -+ _pkt *pskb; + +#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ pskb = NULL; -+ transfer_len = (s32)((struct recv_buf*)ptr)->transfer_len; -+ pbuf = ((struct recv_buf*)ptr)->pbuf; ++ transfer_len = (s32)precvbuf->transfer_len; ++ pbuf = precvbuf->pbuf; +#else -+ pskb = (_pkt*)ptr; + transfer_len = (s32)pskb->len; + pbuf = pskb->data; +#endif//CONFIG_USE_USB_BUFFER_ALLOC_RX @@ -286289,19 +128971,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + if(precvframe==NULL) + { + RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("recvbuf2recvframe: precvframe==NULL\n")); -+ DBG_8192C("%s()-%d: rtw_alloc_recvframe() failed! RX Drop!\n", __FUNCTION__, __LINE__); ++ DBG_8192C("%s()-%d: rtw_alloc_recvframe() failed! RX Drop!\n", __FUNCTION__, __LINE__); + goto _exit_recvbuf2recvframe; + } + -+ _rtw_init_listhead(&precvframe->u.hdr.list); ++ _rtw_init_listhead(&precvframe->u.hdr.list); + precvframe->u.hdr.precvbuf = NULL; //can't access the precvbuf for new arch. + precvframe->u.hdr.len=0; + + rtl8812_query_rx_desc_status(precvframe, pbuf); + -+ pattrib = &precvframe->u.hdr.attrib; -+ -+ if ((padapter->registrypriv.mp_mode == 0) && ((pattrib->crc_err) || (pattrib->icv_err))) ++ pattrib = &precvframe->u.hdr.attrib; ++ ++ if ((pattrib->crc_err) || (pattrib->icv_err)) + { + DBG_8192C("%s: RX Warning! crc_err=%d icv_err=%d, skip!\n", __FUNCTION__, pattrib->crc_err, pattrib->icv_err); + @@ -286312,19 +128994,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + pkt_offset = RXDESC_SIZE + pattrib->drvinfo_sz + pattrib->shift_sz + pattrib->pkt_len; + + if((pattrib->pkt_len<=0) || (pkt_offset>transfer_len)) -+ { ++ { + RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("recvbuf2recvframe: pkt_len<=0\n")); -+ DBG_8192C("%s()-%d: RX Warning!,pkt_len<=0 or pkt_offset> transfer_len \n", __FUNCTION__, __LINE__); ++ DBG_8192C("%s()-%d: RX Warning!,pkt_len<=0 or pkt_offset> transfer_len \n", __FUNCTION__, __LINE__); + rtw_free_recvframe(precvframe, pfree_recv_queue); + goto _exit_recvbuf2recvframe; + } + -+#ifdef CONFIG_RX_PACKET_APPEND_FCS -+ if(pattrib->pkt_rpt_type == NORMAL_RX) -+ pattrib->pkt_len -= IEEE80211_FCS_LEN; ++ if(rtw_os_alloc_recvframe(padapter, precvframe, ++ (pbuf+pattrib->shift_sz + pattrib->drvinfo_sz + RXDESC_SIZE), ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX ++ NULL ++#else ++ pskb +#endif -+ if(rtw_os_alloc_recvframe(padapter, precvframe, -+ (pbuf + pattrib->shift_sz + pattrib->drvinfo_sz + RXDESC_SIZE), pskb) == _FAIL) ++ ) == _FAIL) + { + rtw_free_recvframe(precvframe, pfree_recv_queue); + @@ -286351,7 +129035,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 +#endif //CONFIG_CONCURRENT_MODE + + if(pattrib->physt && pphy_status) -+ rx_query_phy_status(precvframe, pphy_status); ++ rtl8812_query_rx_phy_status(precvframe, pphy_status); + + if(rtw_recv_entry(precvframe) != _SUCCESS) + { @@ -286361,11 +129045,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + + } + else{ // pkt_rpt_type == TX_REPORT1-CCX, TX_REPORT2-TX RTP,HIS_REPORT-USB HISR RTP ++ + if (pattrib->pkt_rpt_type == C2H_PACKET) { + //DBG_8192C("rx C2H_PACKET \n"); -+ C2HPacketHandler_8812(padapter,precvframe->u.hdr.rx_data,pattrib->pkt_len); ++ //C2HPacketHandler_8812A(padapter,precvframe->u.hdr.rx_data,pattrib->pkt_len); + } ++ //enqueue recvframe to txrtp queue ++ else if(pattrib->pkt_rpt_type == TX_REPORT1){ ++ DBG_8192C("rx CCX \n"); ++ } ++ else if(pattrib->pkt_rpt_type == TX_REPORT2){ ++ //DBG_8192C("rx TX RPT \n"); ++ } ++ /*else if(pattrib->pkt_rpt_type == HIS_REPORT) ++ { ++ //DBG_8192C("%s , rx USB HISR \n",__FUNCTION__); ++ #ifdef CONFIG_SUPPORT_USB_INT ++ interrupt_handler_8812au(padapter,pattrib->pkt_len,precvframe->u.hdr.rx_data); ++ #endif ++ }*/ + rtw_free_recvframe(precvframe, pfree_recv_queue); ++ + } + +#ifdef CONFIG_USB_RX_AGGREGATION @@ -286381,58 +129081,479 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + +_exit_recvbuf2recvframe: + -+ return _SUCCESS; ++ return _SUCCESS; +} + + ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX ++void rtl8812au_recv_tasklet(void *priv) ++{ ++ struct recv_buf *precvbuf = NULL; ++ _adapter *padapter = (_adapter*)priv; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ ++ while (NULL != (precvbuf = rtw_dequeue_recvbuf(&precvpriv->recv_buf_pending_queue))) ++ { ++ if ((padapter->bDriverStopped == true)||(padapter->bSurpriseRemoved== true)) ++ { ++ DBG_8192C("recv_tasklet => bDriverStopped or bSurpriseRemoved \n"); ++ ++ break; ++ } ++ ++ ++ recvbuf2recvframe(padapter, precvbuf); ++ ++ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); ++ } ++ ++} ++ ++static void usb_read_port_complete(struct urb *purb, struct pt_regs *regs) ++{ ++ struct recv_buf *precvbuf = (struct recv_buf *)purb->context; ++ _adapter *padapter =(_adapter *)precvbuf->adapter; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete!!!\n")); ++ ++ precvpriv->rx_pending_cnt --; ++ ++ if(padapter->bSurpriseRemoved || padapter->bDriverStopped||padapter->bReadPortCancel) ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bDriverStopped(%d) OR bSurpriseRemoved(%d)\n", padapter->bDriverStopped, padapter->bSurpriseRemoved)); ++ ++ goto exit; ++ } ++ ++ if(purb->status==0)//SUCCESS ++ { ++ if ((purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE)) ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete: (purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE)\n")); ++ ++ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); ++ } ++ else ++ { ++ rtw_reset_continual_urb_error(adapter_to_dvobj(padapter)); ++ ++ precvbuf->transfer_len = purb->actual_length; ++ ++ //rtw_enqueue_rx_transfer_buffer(precvpriv, rx_transfer_buf); ++ rtw_enqueue_recvbuf(precvbuf, &precvpriv->recv_buf_pending_queue); ++ ++ tasklet_schedule(&precvpriv->recv_tasklet); ++ } ++ } ++ else ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete : purb->status(%d) != 0 \n", purb->status)); ++ ++ DBG_8192C("###=> usb_read_port_complete => urb status(%d)\n", purb->status); ++ ++ if(rtw_inc_and_chk_continual_urb_error(adapter_to_dvobj(padapter)) == true ){ ++ padapter->bSurpriseRemoved = true; ++ } ++ ++ switch(purb->status) { ++ case -EINVAL: ++ case -EPIPE: ++ case -ENODEV: ++ case -ESHUTDOWN: ++ //padapter->bSurpriseRemoved=true; ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bSurpriseRemoved=true\n")); ++ case -ENOENT: ++ padapter->bDriverStopped=true; ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bDriverStopped=true\n")); ++ break; ++ case -EPROTO: ++ case -EILSEQ: ++ case -ETIME: ++ case -ECOMM: ++ case -EOVERFLOW: ++ #ifdef DBG_CONFIG_ERROR_DETECT ++ { ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ pHalData->srestpriv.Wifi_Error_Status = USB_READ_PORT_FAIL; ++ } ++ #endif ++ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); ++ break; ++ case -EINPROGRESS: ++ DBG_8192C("ERROR: URB IS IN PROGRESS!/n"); ++ break; ++ default: ++ break; ++ } ++ ++ } ++ ++exit: ++ ++ ++ ++} ++ ++static u32 usb_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) ++{ ++ int err; ++ unsigned int pipe; ++ u32 ret = _SUCCESS; ++ PURB purb = NULL; ++ struct recv_buf *precvbuf = (struct recv_buf *)rmem; ++ _adapter *adapter = pintfhdl->padapter; ++ struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter); ++ struct recv_priv *precvpriv = &adapter->recvpriv; ++ struct usb_device *pusbd = pdvobj->pusbdev; ++ ++ ++ ++ if(adapter->bDriverStopped || adapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx) ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port:( padapter->bDriverStopped ||padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n")); ++ return _FAIL; ++ } ++ ++ if(precvbuf !=NULL) ++ { ++ rtl8812au_init_recvbuf(adapter, precvbuf); ++ ++ if(precvbuf->pbuf) ++ { ++ precvpriv->rx_pending_cnt++; ++ ++ purb = precvbuf->purb; ++ ++ //translate DMA FIFO addr to pipehandle ++ pipe = ffaddr2pipehdl(pdvobj, addr); ++ ++ usb_fill_bulk_urb(purb, pusbd, pipe, ++ precvbuf->pbuf, ++ MAX_RECVBUF_SZ, ++ usb_read_port_complete, ++ precvbuf);//context is precvbuf ++ ++ purb->transfer_dma = precvbuf->dma_transfer_addr; ++ purb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; ++ ++ err = usb_submit_urb(purb, GFP_ATOMIC); ++ if((err) && (err != (-EPERM))) ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("cannot submit rx in-token(err=0x%.8x), URB_STATUS =0x%.8x", err, purb->status)); ++ DBG_8192C("cannot submit rx in-token(err = 0x%08x),urb_status = %d\n",err,purb->status); ++ ret = _FAIL; ++ } ++ ++ } ++ ++ } ++ else ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port:precvbuf ==NULL\n")); ++ ret = _FAIL; ++ } ++ ++ ++ ++ return ret; ++} ++#else // CONFIG_USE_USB_BUFFER_ALLOC_RX ++ ++void rtl8812au_recv_tasklet(void *priv) ++{ ++ _pkt *pskb; ++ _adapter *padapter = (_adapter*)priv; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ ++ while (NULL != (pskb = skb_dequeue(&precvpriv->rx_skb_queue))) ++ { ++ if ((padapter->bDriverStopped == true)||(padapter->bSurpriseRemoved== true)) ++ { ++ DBG_8192C("recv_tasklet => bDriverStopped or bSurpriseRemoved \n"); ++ dev_kfree_skb_any(pskb); ++ break; ++ } ++ ++ recvbuf2recvframe(padapter, pskb); ++ ++#ifdef CONFIG_PREALLOC_RECV_SKB ++ ++ skb_reset_tail_pointer(pskb); ++ ++ pskb->len = 0; ++ ++ skb_queue_tail(&precvpriv->free_recv_skb_queue, pskb); ++ ++#else ++ dev_kfree_skb_any(pskb); ++#endif ++ ++ } ++ ++} ++ ++ ++static void usb_read_port_complete(struct urb *purb, struct pt_regs *regs) ++{ ++ _irqL irqL; ++ uint isevt, *pbuf; ++ struct recv_buf *precvbuf = (struct recv_buf *)purb->context; ++ _adapter *padapter =(_adapter *)precvbuf->adapter; ++ struct recv_priv *precvpriv = &padapter->recvpriv; ++ ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete!!!\n")); ++ ++ precvpriv->rx_pending_cnt --; ++ if(padapter->bSurpriseRemoved || padapter->bDriverStopped||padapter->bReadPortCancel) ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bDriverStopped(%d) OR bSurpriseRemoved(%d)\n", padapter->bDriverStopped, padapter->bSurpriseRemoved)); ++ ++ #ifdef CONFIG_PREALLOC_RECV_SKB ++ precvbuf->reuse = true; ++ #else ++ if(precvbuf->pskb){ ++ DBG_8192C("==> free skb(%p)\n",precvbuf->pskb); ++ dev_kfree_skb_any(precvbuf->pskb); ++ } ++ #endif ++ DBG_8192C("%s() RX Warning! bDriverStopped(%d) OR bSurpriseRemoved(%d) bReadPortCancel(%d)\n", ++ __FUNCTION__,padapter->bDriverStopped, padapter->bSurpriseRemoved,padapter->bReadPortCancel); ++ return; ++ } ++ ++ if(purb->status==0)//SUCCESS ++ { ++ if ((purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE)) ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete: (purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE)\n")); ++ precvbuf->reuse = true; ++ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); ++ DBG_8192C("%s()-%d: RX Warning!\n", __FUNCTION__, __LINE__); ++ } ++ else ++ { ++ rtw_reset_continual_urb_error(adapter_to_dvobj(padapter)); ++ ++ precvbuf->transfer_len = purb->actual_length; ++ skb_put(precvbuf->pskb, purb->actual_length); ++ skb_queue_tail(&precvpriv->rx_skb_queue, precvbuf->pskb); ++ ++ if (skb_queue_len(&precvpriv->rx_skb_queue)<=1) ++ tasklet_schedule(&precvpriv->recv_tasklet); ++ ++ precvbuf->pskb = NULL; ++ precvbuf->reuse = false; ++ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); ++ } ++ } ++ else ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete : purb->status(%d) != 0 \n", purb->status)); ++ ++ DBG_8192C("###=> usb_read_port_complete => urb status(%d)\n", purb->status); ++ ++ if(rtw_inc_and_chk_continual_urb_error(adapter_to_dvobj(padapter)) == true ){ ++ padapter->bSurpriseRemoved = true; ++ } ++ ++ switch(purb->status) { ++ case -EINVAL: ++ case -EPIPE: ++ case -ENODEV: ++ case -ESHUTDOWN: ++ //padapter->bSurpriseRemoved=true; ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bSurpriseRemoved=true\n")); ++ case -ENOENT: ++ padapter->bDriverStopped=true; ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bDriverStopped=true\n")); ++ break; ++ case -EPROTO: ++ case -EILSEQ: ++ case -ETIME: ++ case -ECOMM: ++ case -EOVERFLOW: ++ #ifdef DBG_CONFIG_ERROR_DETECT ++ { ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ pHalData->srestpriv.Wifi_Error_Status = USB_READ_PORT_FAIL; ++ } ++ #endif ++ precvbuf->reuse = true; ++ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); ++ break; ++ case -EINPROGRESS: ++ DBG_8192C("ERROR: URB IS IN PROGRESS!/n"); ++ break; ++ default: ++ break; ++ } ++ ++ } ++} ++ ++static u32 usb_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) ++{ ++ _irqL irqL; ++ int err; ++ unsigned int pipe; ++ SIZE_PTR tmpaddr=0; ++ SIZE_PTR alignment=0; ++ u32 ret = _SUCCESS; ++ PURB purb = NULL; ++ struct recv_buf *precvbuf = (struct recv_buf *)rmem; ++ _adapter *adapter = pintfhdl->padapter; ++ struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter); ++ struct recv_priv *precvpriv = &adapter->recvpriv; ++ struct usb_device *pusbd = pdvobj->pusbdev; ++ ++ ++ ++ ++ if(adapter->bDriverStopped || adapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx) ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port:( padapter->bDriverStopped ||padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n")); ++ return _FAIL; ++ } ++ ++#ifdef CONFIG_PREALLOC_RECV_SKB ++ if((precvbuf->reuse == false) || (precvbuf->pskb == NULL)) ++ { ++ if (NULL != (precvbuf->pskb = skb_dequeue(&precvpriv->free_recv_skb_queue))) ++ { ++ precvbuf->reuse = true; ++ } ++ } ++#endif ++ ++ ++ if(precvbuf !=NULL) ++ { ++ rtl8812au_init_recvbuf(adapter, precvbuf); ++ ++ //re-assign for linux based on skb ++ if((precvbuf->reuse == false) || (precvbuf->pskb == NULL)) ++ { ++ //precvbuf->pskb = alloc_skb(MAX_RECVBUF_SZ, GFP_ATOMIC);//don't use this after v2.6.25 ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18)) // http://www.mail-archive.com/netdev@vger.kernel.org/msg17214.html ++ precvbuf->pskb = dev_alloc_skb(MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ); ++#else ++ precvbuf->pskb = netdev_alloc_skb(adapter->pnetdev, MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ); ++#endif ++ if(precvbuf->pskb == NULL) ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("init_recvbuf(): alloc_skb fail!\n")); ++ DBG_8192C("#### usb_read_port() alloc_skb fail!#####\n"); ++ return _FAIL; ++ } ++ ++ tmpaddr = (SIZE_PTR)precvbuf->pskb->data; ++ alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1); ++ skb_reserve(precvbuf->pskb, (RECVBUFF_ALIGN_SZ - alignment)); ++ ++ precvbuf->phead = precvbuf->pskb->head; ++ precvbuf->pdata = precvbuf->pskb->data; ++ precvbuf->ptail = skb_tail_pointer(precvbuf->pskb); ++ precvbuf->pend = skb_end_pointer(precvbuf->pskb); ++ precvbuf->pbuf = precvbuf->pskb->data; ++ } ++ else//reuse skb ++ { ++ precvbuf->phead = precvbuf->pskb->head; ++ precvbuf->pdata = precvbuf->pskb->data; ++ precvbuf->ptail = skb_tail_pointer(precvbuf->pskb); ++ precvbuf->pend = skb_end_pointer(precvbuf->pskb); ++ precvbuf->pbuf = precvbuf->pskb->data; ++ ++ precvbuf->reuse = false; ++ } ++ ++ //_enter_critical(&precvpriv->lock, &irqL); ++ //precvpriv->rx_pending_cnt++; ++ //precvbuf->irp_pending = true; ++ //_exit_critical(&precvpriv->lock, &irqL); ++ ++ precvpriv->rx_pending_cnt++; ++ ++ purb = precvbuf->purb; ++ ++ //translate DMA FIFO addr to pipehandle ++ pipe = ffaddr2pipehdl(pdvobj, addr); ++ ++ usb_fill_bulk_urb(purb, pusbd, pipe, ++ precvbuf->pbuf, ++ MAX_RECVBUF_SZ, ++ usb_read_port_complete, ++ precvbuf);//context is precvbuf ++ ++ err = usb_submit_urb(purb, GFP_ATOMIC); ++ if((err) && (err != (-EPERM))) ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("cannot submit rx in-token(err=0x%.8x), URB_STATUS =0x%.8x", err, purb->status)); ++ DBG_8192C("cannot submit rx in-token(err = 0x%08x),urb_status = %d\n",err,purb->status); ++ ret = _FAIL; ++ } ++ } ++ else ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port:precvbuf ==NULL\n")); ++ ret = _FAIL; ++ } ++ ++ ++ ++ return ret; ++} ++#endif // CONFIG_USE_USB_BUFFER_ALLOC_RX ++ +void rtl8812au_xmit_tasklet(void *priv) -+{ -+ int ret = _FALSE; ++{ ++ int ret = false; + _adapter *padapter = (_adapter*)priv; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + ++ if(check_fwstate(&padapter->mlmepriv, _FW_UNDER_SURVEY) == true) ++ return; ++ + while(1) + { -+ if (RTW_CANNOT_TX(padapter)) ++ if ((padapter->bDriverStopped == true)||(padapter->bSurpriseRemoved== true) || (padapter->bWritePortCancel == true)) + { + DBG_8192C("xmit_tasklet => bDriverStopped or bSurpriseRemoved or bWritePortCancel\n"); + break; + } + -+ if (rtw_xmit_ac_blocked(padapter) == _TRUE) -+ break; -+ + ret = rtl8812au_xmitframe_complete(padapter, pxmitpriv, NULL); + -+ if(ret==_FALSE) ++ if(ret==false) + break; -+ ++ + } -+ ++ +} + +void rtl8812au_set_intf_ops(struct _io_ops *pops) -+{ -+ _func_enter_; ++{ + -+ _rtw_memset((u8 *)pops, 0, sizeof(struct _io_ops)); ++ ++ _rtw_memset((u8 *)pops, 0, sizeof(struct _io_ops)); + + pops->_read8 = &usb_read8; + pops->_read16 = &usb_read16; + pops->_read32 = &usb_read32; + pops->_read_mem = &usb_read_mem; -+ pops->_read_port = &usb_read_port; -+ ++ pops->_read_port = &usb_read_port; ++ + pops->_write8 = &usb_write8; + pops->_write16 = &usb_write16; + pops->_write32 = &usb_write32; + pops->_writeN = &usb_writeN; -+ -+#ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ ++ ++#ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ + pops->_write8_async= &usb_async_write8; + pops->_write16_async = &usb_async_write16; + pops->_write32_async = &usb_async_write32; -+#endif ++#endif + pops->_write_mem = &usb_write_mem; + pops->_write_port = &usb_write_port; + @@ -286443,30 +129564,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/hal/rtl8812a/usb/usb_ops_linux.c linux/3 + pops->_read_interrupt = &usb_read_interrupt; +#endif + -+ _func_exit_; ++ + +} + -+void rtl8812au_set_hw_type(struct dvobj_priv *pdvobj) ++void rtl8812au_set_hw_type(_adapter *padapter) +{ -+ if (pdvobj->chip_type == RTL8812) { -+ pdvobj->HardwareType = HARDWARE_TYPE_RTL8812AU; ++ if(padapter->chip_type == RTL8812) ++ { ++ padapter->HardwareType = HARDWARE_TYPE_RTL8812AU; + DBG_871X("CHIP TYPE: RTL8812\n"); -+ } else if (pdvobj->chip_type == RTL8821) { -+ /*pdvobj->HardwareType = HARDWARE_TYPE_RTL8811AU; */ -+ pdvobj->HardwareType = HARDWARE_TYPE_RTL8821U; ++ } ++ else if(padapter->chip_type == RTL8821) ++ { ++ //padapter->HardwareType = HARDWARE_TYPE_RTL8811AU; ++ padapter->HardwareType = HARDWARE_TYPE_RTL8821U; + DBG_871X("CHIP TYPE: RTL8811AU or RTL8821U\n"); + } +} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/autoconf.h linux/3rdparty/rtl8812au/include/autoconf.h ---- linux.old/3rdparty/rtl8812au/include/autoconf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/autoconf.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,380 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/autoconf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/autoconf.h +--- linux-4.14.17/3rdparty/rtl8812au/include/autoconf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/autoconf.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,196 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -286476,15 +129599,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/autoconf.h linux/3rdparty/rtl881 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +//***** temporarily flag ******* +#define CONFIG_SINGLE_IMG -+//#define CONFIG_DISABLE_ODM ++#define CONFIG_ODM_REFRESH_RAMASK ++#define CONFIG_PHY_SETTING_WITH_ODM ++//for FPGA VERIFICATION config ++#define RTL8188E_FPGAtrue_PHY_VERIFICATION 0 + +//***** temporarily flag ******* +/* @@ -286494,124 +129615,59 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/autoconf.h linux/3rdparty/rtl881 +#define RTL871X_MODULE_NAME "8812AU" +#define DRV_NAME "rtl8812au" + -+ -+#define CONFIG_USB_HCI 1 -+ -+ +#define PLATFORM_LINUX 1 + -+ -+//#define CONFIG_IOCTL_CFG80211 1 -+ +#ifdef CONFIG_IOCTL_CFG80211 -+ //#define RTW_USE_CFG80211_STA_EVENT /* Indecate new sta asoc through cfg80211_new_sta */ + #define CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER -+ //#define CONFIG_DEBUG_CFG80211 -+ //#define CONFIG_DRV_ISSUE_PROV_REQ // IOT FOR S2 + #define CONFIG_SET_SCAN_DENY_TIMER +#endif + +/* + * Internal General Config + */ -+//#define CONFIG_H2CLBK + +#define CONFIG_EMBEDDED_FWIMG 1 -+//#define CONFIG_FILE_FWIMG -+ -+#define CONFIG_XMIT_ACK -+#ifdef CONFIG_XMIT_ACK -+ #define CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+#endif + +#define CONFIG_80211N_HT 1 + +#ifdef CONFIG_80211N_HT + #define CONFIG_80211AC_VHT 1 -+ #define CONFIG_BEAMFORMING -+ -+ #ifdef CONFIG_BEAMFORMING -+ #define CONFIG_BEAMFORMER_FW_NDPA -+ #define CONFIG_PHYDM_BEAMFORMING -+ #ifdef CONFIG_PHYDM_BEAMFORMING -+ #define BEAMFORMING_SUPPORT 1 /*for phydm beamforming*/ -+ #define SUPPORT_MU_BF 0 -+ #else -+ #define BEAMFORMING_SUPPORT 0 /*for driver beamforming*/ -+ #endif -+ #endif -+ +#endif + +#define CONFIG_RECV_REORDERING_CTRL 1 + -+//#define CONFIG_TCP_CSUM_OFFLOAD_RX 1 -+ -+//#define CONFIG_DRVEXT_MODULE 1 -+ +#define CONFIG_DFS 1 + -+ //#define CONFIG_SUPPORT_USB_INT -+ #ifdef CONFIG_SUPPORT_USB_INT -+//#define CONFIG_USB_INTERRUPT_IN_PIPE 1 ++#define CONFIG_IPS 1 ++ ++#define CONFIG_LPS 1 ++ ++#ifdef CONFIG_LPS_LCLK ++#define CONFIG_XMIT_THREAD_MODE +#endif + -+//#ifndef CONFIG_MP_INCLUDED -+ #define CONFIG_IPS 1 -+ #ifdef CONFIG_IPS -+ //#define CONFIG_IPS_LEVEL_2 1 //enable this to set default IPS mode to IPS_LEVEL_2 -+ #define CONFIG_IPS_CHECK_IN_WD // Do IPS Check in WatchDog. -+ #endif -+ //#define SUPPORT_HW_RFOFF_DETECTED 1 ++//after link ++#ifdef CONFIG_ANTENNA_DIVERSITY ++#define CONFIG_HW_ANTENNA_DIVERSITY ++#endif + -+ #define CONFIG_LPS 1 -+ #if defined(CONFIG_LPS) && defined(CONFIG_SUPPORT_USB_INT) -+ //#define CONFIG_LPS_LCLK 1 -+ #endif -+ -+ #ifdef CONFIG_LPS_LCLK -+ #define CONFIG_XMIT_THREAD_MODE -+ #endif -+ -+ //befor link -+ //#define CONFIG_ANTENNA_DIVERSITY -+ -+ //after link -+ #ifdef CONFIG_ANTENNA_DIVERSITY -+ #define CONFIG_HW_ANTENNA_DIVERSITY -+ #endif -+ -+ -+ //#define CONFIG_CONCURRENT_MODE 1 -+ #ifdef CONFIG_CONCURRENT_MODE -+ //#define CONFIG_HWPORT_SWAP //Port0->Sec , Port1 -> Pri -+ #define CONFIG_RUNTIME_PORT_SWITCH -+ //#define DBG_RUNTIME_PORT_SWITCH -+ #define CONFIG_SCAN_BACKOP -+ //#ifdef CONFIG_RTL8812A -+ // #define CONFIG_TSF_RESET_OFFLOAD 1 // For 2 PORT TSF SYNC. -+ //#endif -+ #endif -+ -+//#else //#ifndef CONFIG_MP_INCLUDED -+ -+//#endif //#ifndef CONFIG_MP_INCLUDED ++#ifdef CONFIG_CONCURRENT_MODE ++ #define CONFIG_TSF_RESET_OFFLOAD 1 // For 2 PORT TSF SYNC. ++#endif + +#define CONFIG_AP_MODE 1 +#ifdef CONFIG_AP_MODE -+ //#define CONFIG_INTERRUPT_BASED_TXBCN // Tx Beacon when driver BCN_OK ,BCN_ERR interrupt occurs + #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_INTERRUPT_BASED_TXBCN) + #undef CONFIG_INTERRUPT_BASED_TXBCN + #endif + #ifdef CONFIG_INTERRUPT_BASED_TXBCN -+ //#define CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ #define CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR ++ #define CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR + #endif -+ ++ + #define CONFIG_NATIVEAP_MLME + #ifndef CONFIG_NATIVEAP_MLME + #define CONFIG_HOSTAPD_MLME 1 -+ #endif ++ #endif + #define CONFIG_FIND_BEST_CHANNEL 1 +#endif + @@ -286620,61 +129676,43 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/autoconf.h linux/3rdparty/rtl881 + //The CONFIG_WFD is for supporting the Wi-Fi display + #define CONFIG_WFD + -+ #define CONFIG_P2P_REMOVE_GROUP_INFO -+ -+ //#define CONFIG_DBG_P2P ++ #ifndef CONFIG_WIFI_TEST ++ #define CONFIG_P2P_REMOVE_GROUP_INFO ++ #endif + + #define CONFIG_P2P_PS -+ //#define CONFIG_P2P_IPS -+ #define CONFIG_P2P_OP_CHK_SOCIAL_CH -+ #define CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT //replace CONFIG_P2P_CHK_INVITE_CH_LIST flag -+ #define CONFIG_P2P_INVITE_IOT +#endif + -+// Added by Kurt 20110511 -+#ifdef CONFIG_TDLS -+ #define CONFIG_TDLS_DRIVER_SETUP -+// #ifndef CONFIG_WFD -+// #define CONFIG_WFD -+// #endif -+// #define CONFIG_TDLS_AUTOSETUP -+ #define CONFIG_TDLS_AUTOCHECKALIVE -+ #define CONFIG_TDLS_CH_SW /* Enable "CONFIG_TDLS_CH_SW" by default, however limit it to only work in wifi logo test mode but not in normal mode currently */ -+#endif -+ -+ +#define CONFIG_SKB_COPY 1//for amsdu + +#define CONFIG_LED +#ifdef CONFIG_LED + #define CONFIG_SW_LED -+ #ifdef CONFIG_SW_LED -+ //#define CONFIG_LED_HANDLED_BY_CMD_THREAD -+ #endif +#endif // CONFIG_LED + ++#ifdef CONFIG_IOL ++ #define CONFIG_IOL_READ_EFUSE_MAP ++ #define CONFIG_IOL_LLT ++#endif ++ +#define USB_INTERFERENCE_ISSUE // this should be checked in all usb interface +#define CONFIG_GLOBAL_UI_PID + +#define CONFIG_LAYER2_ROAMING +#define CONFIG_LAYER2_ROAMING_RESUME -+//#define CONFIG_ADAPTOR_INFO_CACHING_FILE // now just applied on 8192cu only, should make it general... -+//#define CONFIG_RESUME_IN_WORKQUEUE -+//#define CONFIG_SET_SCAN_DENY_TIMER +#define CONFIG_LONG_DELAY_ISSUE +#define CONFIG_NEW_SIGNAL_STAT_PROCESS -+//#define CONFIG_SIGNAL_DISPLAY_DBM //display RX signal with dbm -+#ifdef CONFIG_SIGNAL_DISPLAY_DBM -+//#define CONFIG_BACKGROUND_NOISE_MONITOR -+#endif +#define RTW_NOTCH_FILTER 0 /* 0:Disable, 1:Enable, */ + -+#define CONFIG_TX_MCAST2UNI /*Support IP multicast->unicast*/ -+//#define CONFIG_CHECK_AC_LIFETIME 1 // Check packet lifetime of 4 ACs. ++#define CONFIG_BR_EXT 1 // Enable NAT2.5 support for STA mode interface with a L2 Bridge ++#ifdef CONFIG_BR_EXT ++#define CONFIG_BR_EXT_BRNAME "br0" ++#endif // CONFIG_BR_EXT + ++#define CONFIG_TX_MCAST2UNI 1 // Support IP multicast->unicast + -+/* -+ * Interface Related Config ++/* ++ * Interface Related Config + */ + +#ifndef CONFIG_MINIMAL_MEMORY_USAGE @@ -286682,60 +129720,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/autoconf.h linux/3rdparty/rtl881 + #define CONFIG_USB_RX_AGGREGATION 1 +#endif + -+//#define CONFIG_REDUCE_USB_TX_INT 1 // Trade-off: Improve performance, but may cause TX URBs blocked by USB Host/Bus driver on few platforms. -+//#define CONFIG_EASY_REPLACEMENT 1 ++#define CONFIG_PREALLOC_RECV_SKB 1 + -+/* ++/* + * CONFIG_USE_USB_BUFFER_ALLOC_XX uses Linux USB Buffer alloc API and is for Linux platform only now! + */ -+//#define CONFIG_USE_USB_BUFFER_ALLOC_TX 1 // Trade-off: For TX path, improve stability on some platforms, but may cause performance degrade on other platforms. -+//#define CONFIG_USE_USB_BUFFER_ALLOC_RX 1 // For RX path -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX + -+#else -+ #define CONFIG_PREALLOC_RECV_SKB -+ #ifdef CONFIG_PREALLOC_RECV_SKB -+ //#define CONFIG_FIX_NR_BULKIN_BUFFER /* only use PREALLOC_RECV_SKB buffer, don't alloc skb at runtime */ -+ #endif ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX ++#undef CONFIG_PREALLOC_RECV_SKB +#endif + -+/* ++/* + * USB VENDOR REQ BUFFER ALLOCATION METHOD + * if not set we'll use function local variable (stack memory) + */ -+//#define CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE +#define CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC + +#define CONFIG_USB_VENDOR_REQ_MUTEX +#define CONFIG_VENDOR_REQ_RETRY + -+//#define CONFIG_USB_SUPPORT_ASYNC_VDN_REQ 1 -+ -+#ifdef CONFIG_WOWLAN -+ //#define CONFIG_GTK_OL -+ #define CONFIG_ARP_KEEP_ALIVE -+#endif // CONFIG_WOWLAN -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ #ifndef WAKEUP_GPIO_IDX -+#define WAKEUP_GPIO_IDX 1 //WIFI Chip Side -+ #endif // !WAKEUP_GPIO_IDX -+#endif // CONFIG_GPIO_WAKEUP -+ +/* + * HAL Related Config + */ +#define RTL8812A_RX_PACKET_INCLUDE_CRC 0 + -+#define CONFIG_RX_PACKET_APPEND_FCS -+ -+//#define CONFIG_ONLY_ONE_OUT_EP_TO_LOW 0 -+ +#define CONFIG_OUT_EP_WIFI_MODE 0 + -+#define ENABLE_USB_DROP_INCORRECT_OUT ++#define ENABLE_USB_DROP_INCORRECT_OUT 0 + -+#define CONFIG_ADHOC_WORKAROUND_SETTING 1 ++#define RTL8192CU_ADHOC_WORKAROUND_SETTING 1 + +#define ENABLE_NEW_RFE_TYPE 0 + @@ -286744,60 +129757,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/autoconf.h linux/3rdparty/rtl881 +#ifdef CONFIG_MP_INCLUDED + #define MP_DRIVER 1 + #define CONFIG_MP_IWPRIV_SUPPORT 1 -+ //#undef CONFIG_USB_TX_AGGREGATION -+ //#undef CONFIG_USB_RX_AGGREGATION +#else + #define MP_DRIVER 0 +#endif + -+ +/* -+ * Platform Related Config ++ * Outsource Related Config + */ -+#ifdef CONFIG_PLATFORM_MN10300 -+ #define CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -+ #define CONFIG_USE_USB_BUFFER_ALLOC_RX -+ -+ #if defined (CONFIG_SW_ANTENNA_DIVERSITY) -+ #undef CONFIG_SW_ANTENNA_DIVERSITY -+ #define CONFIG_HW_ANTENNA_DIVERSITY -+ #endif + -+ #if defined (CONFIG_POWER_SAVING) -+ #undef CONFIG_POWER_SAVING -+ #endif -+ -+#endif//CONFIG_PLATFORM_MN10300 ++#define TEST_CHIP_SUPPORT 0 + ++#define RTL8723_FPGA_VERIFICATION 0 + -+#if defined(CONFIG_PLATFORM_ACTIONS_ATM702X) -+ #ifdef CONFIG_USB_TX_AGGREGATION -+ #undef CONFIG_USB_TX_AGGREGATION -+ #endif -+ #ifndef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ #define CONFIG_USE_USB_BUFFER_ALLOC_TX -+ #endif -+ #ifndef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ #define CONFIG_USE_USB_BUFFER_ALLOC_RX -+ #endif -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ // for ODM and outsrc BT-Coex -+ #define BT_30_SUPPORT 1 -+ #define CONFIG_BT_COEXIST_SOCKET_TRX -+ #ifndef CONFIG_LPS -+ #define CONFIG_LPS // download reserved page to FW -+ #endif -+#else // !CONFIG_BT_COEXIST -+ #define BT_30_SUPPORT 0 -+#endif // !CONFIG_BT_COEXIST -+ -+ -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+//#define CONFIG_TX_EARLY_MODE -+#endif ++#define RATE_ADAPTIVE_SUPPORT 0 ++#define POWER_TRAINING_ACTIVE 0 + +#define RTL8188E_EARLY_MODE_PKT_NUM_10 0 + @@ -286808,49 +129781,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/autoconf.h linux/3rdparty/rtl881 +/* + * Debug Related Config + */ -+#define DBG 1 -+ -+//#define CONFIG_DEBUG /* DBG_871X, etc... */ -+//#define CONFIG_DEBUG_RTL871X /* RT_TRACE, RT_PRINT_DATA, _func_enter_, _func_exit_ */ -+ -+#define CONFIG_PROC_DEBUG -+ -+#define DBG_CONFIG_ERROR_DETECT -+//#define DBG_CONFIG_ERROR_DETECT_INT -+//#define DBG_CONFIG_ERROR_RESET -+ -+//#define DBG_IO -+//#define DBG_DELAY_OS -+//#define DBG_MEM_ALLOC -+//#define DBG_IOCTL -+ -+//#define DBG_TX -+//#define DBG_XMIT_BUF -+//#define DBG_XMIT_BUF_EXT -+//#define DBG_TX_DROP_FRAME -+ -+//#define DBG_RX_DROP_FRAME -+//#define DBG_RX_SEQ -+//#define DBG_RX_SIGNAL_DISPLAY_PROCESSING -+//#define DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED "jeff-ap" -+ -+ -+ -+//#define DBG_SHOW_MCUFWDL_BEFORE_51_ENABLE -+//#define DBG_ROAMING_TEST -+ -+//#define DBG_HAL_INIT_PROFILING -+ -+//#define DBG_MEMORY_LEAK 1 -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/basic_types.h linux/3rdparty/rtl8812au/include/basic_types.h ---- linux.old/3rdparty/rtl8812au/include/basic_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/basic_types.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,364 @@ ++#define DBG 0 +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/basic_types.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/basic_types.h +--- linux-4.14.17/3rdparty/rtl8812au/include/basic_types.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/basic_types.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,205 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -286860,11 +129799,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/basic_types.h linux/3rdparty/rtl + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __BASIC_TYPES_H__ +#define __BASIC_TYPES_H__ @@ -286873,138 +129807,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/basic_types.h linux/3rdparty/rtl +#define SUCCESS 0 +#define FAIL (-1) + -+#ifndef TRUE -+ #define _TRUE 1 -+#else -+ #define _TRUE TRUE -+#endif -+ -+#ifndef FALSE -+ #define _FALSE 0 -+#else -+ #define _FALSE FALSE -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+ typedef signed char s8; -+ typedef unsigned char u8; -+ -+ typedef signed short s16; -+ typedef unsigned short u16; -+ -+ typedef signed long s32; -+ typedef unsigned long u32; -+ -+ typedef unsigned int uint; -+ typedef signed int sint; -+ -+ -+ typedef signed long long s64; -+ typedef unsigned long long u64; -+ -+ #ifdef NDIS50_MINIPORT -+ -+ #define NDIS_MAJOR_VERSION 5 -+ #define NDIS_MINOR_VERSION 0 -+ -+ #endif -+ -+ #ifdef NDIS51_MINIPORT -+ -+ #define NDIS_MAJOR_VERSION 5 -+ #define NDIS_MINOR_VERSION 1 -+ -+ #endif -+ -+ typedef NDIS_PROC proc_t; -+ -+ typedef LONG atomic_t; -+ -+#endif -+ -+ -+#ifdef PLATFORM_LINUX -+ #include + #include -+ #include -+ #include -+ #include -+ #include -+ #define IN -+ #define OUT -+ #define VOID void -+ #define NDIS_OID uint -+ #define NDIS_STATUS uint + + typedef signed int sint; + -+ #ifndef PVOID -+ typedef void * PVOID; -+ //#define PVOID (void *) -+ #endif -+ -+ #define UCHAR u8 -+ #define USHORT u16 -+ #define UINT u32 -+ #define ULONG u32 -+ -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 19)) -+ typedef _Bool bool; -+ #endif -+ + typedef void (*proc_t)(void*); + -+ typedef __kernel_size_t SIZE_T; ++ typedef __kernel_size_t SIZE_T; + typedef __kernel_ssize_t SSIZE_T; + #define FIELD_OFFSET(s,field) ((SSIZE_T)&((s*)(0))->field) -+ -+#endif -+ -+ -+#ifdef PLATFORM_FREEBSD -+ -+ typedef signed char s8; -+ typedef unsigned char u8; -+ -+ typedef signed short s16; -+ typedef unsigned short u16; -+ -+ typedef signed int s32; -+ typedef unsigned int u32; -+ -+ typedef unsigned int uint; -+ typedef signed int sint; -+ typedef long atomic_t; -+ -+ typedef signed long long s64; -+ typedef unsigned long long u64; -+ #define IN -+ #define OUT -+ #define VOID void -+ #define NDIS_OID uint -+ #define NDIS_STATUS uint -+ -+ #ifndef PVOID -+ typedef void * PVOID; -+ //#define PVOID (void *) -+ #endif -+ typedef u32 dma_addr_t; -+ #define UCHAR u8 -+ #define USHORT u16 -+ #define UINT u32 -+ #define ULONG u32 -+ -+ typedef void (*proc_t)(void*); -+ -+ typedef unsigned int __kernel_size_t; -+ typedef int __kernel_ssize_t; -+ -+ typedef __kernel_size_t SIZE_T; -+ typedef __kernel_ssize_t SSIZE_T; -+ #define FIELD_OFFSET(s,field) ((SSIZE_T)&((s*)(0))->field) -+ -+#endif + +#define MEM_ALIGNMENT_OFFSET (sizeof (SIZE_T)) +#define MEM_ALIGNMENT_PADDING (sizeof(SIZE_T) - 1) @@ -287023,25 +129834,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/basic_types.h linux/3rdparty/rtl +*/ + +// -+// Byte Swapping routine. -+// -+#define EF1Byte (u8) -+#define EF2Byte le16_to_cpu -+#define EF4Byte le32_to_cpu -+ -+// +// Read LE format data from memory +// -+#define ReadEF1Byte(_ptr) EF1Byte(*((u8 *)(_ptr))) -+#define ReadEF2Byte(_ptr) EF2Byte(*((u16 *)(_ptr))) -+#define ReadEF4Byte(_ptr) EF4Byte(*((u32 *)(_ptr))) ++#define Read(_ptr) (*((u8 *)(_ptr))) ++#define Readle16_to_cpu(_ptr) le16_to_cpu(*((__le16 *)(_ptr))) ++#define Readle32_to_cpu(_ptr) le32_to_cpu(*((__le32 *)(_ptr))) + +// +// Write LE data to memory +// -+#define WriteEF1Byte(_ptr, _val) (*((u8 *)(_ptr)))=EF1Byte(_val) -+#define WriteEF2Byte(_ptr, _val) (*((u16 *)(_ptr)))=EF2Byte(_val) -+#define WriteEF4Byte(_ptr, _val) (*((u32 *)(_ptr)))=EF4Byte(_val) ++#define Write(_ptr, _val) (*((u8 *)(_ptr)))=(_val) ++#define Writele16_to_cpu(_ptr, _val) (*((u16 *)(_ptr)))=le16_to_cpu(_val) ++#define Writele32_to_cpu(_ptr, _val) (*((u32 *)(_ptr)))=le32_to_cpu(_val) + +// +// Example: @@ -287058,7 +129862,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/basic_types.h linux/3rdparty/rtl +// BIT_OFFSET_LEN_MASK_32(16, 2) => 0x00030000 +// +#define BIT_OFFSET_LEN_MASK_32(__BitOffset, __BitLen) \ -+ (BIT_LEN_MASK_32(__BitLen) << (__BitOffset)) ++ (BIT_LEN_MASK_32(__BitLen) << (__BitOffset)) + +// +// Description: @@ -287066,7 +129870,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/basic_types.h linux/3rdparty/rtl +// 4-byte pointer in litten-endian system. +// +#define LE_P4BYTE_TO_HOST_4BYTE(__pStart) \ -+ (EF4Byte(*((u32 *)(__pStart)))) ++ (le32_to_cpu(*((__le32 *)(__pStart)))) + +// +// Description: @@ -287082,7 +129886,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/basic_types.h linux/3rdparty/rtl + +// +// Description: -+// Mask subfield (continuous bits in little-endian) of 4-byte value in litten byte oredering ++// Mask subfield (continuous bits in little-endian) of 4-byte value in litten byte oredering +// and return the result in 4-byte value in host byte ordering. +// +#define LE_BITS_CLEARED_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ @@ -287094,48 +129898,47 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/basic_types.h linux/3rdparty/rtl + +// +// Description: -+// Set subfield of little-endian 4-byte value to specified value. ++// Set subfield of little-endian 4-byte value to specified value. +// +#define SET_BITS_TO_LE_4BYTE(__pStart, __BitOffset, __BitLen, __Value) \ -+ *((u32 *)(__pStart)) = \ -+ EF4Byte( \ ++ *((__le32 *)(__pStart)) = \ ++ cpu_to_le32( \ + LE_BITS_CLEARED_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ + | \ + ( (((u32)__Value) & BIT_LEN_MASK_32(__BitLen)) << (__BitOffset) ) \ + ); + -+ ++ +#define BIT_LEN_MASK_16(__BitLen) \ + (0xFFFF >> (16 - (__BitLen))) -+ ++ +#define BIT_OFFSET_LEN_MASK_16(__BitOffset, __BitLen) \ + (BIT_LEN_MASK_16(__BitLen) << (__BitOffset)) -+ ++ +#define LE_P2BYTE_TO_HOST_2BYTE(__pStart) \ -+ (EF2Byte(*((u16 *)(__pStart)))) -+ ++ (le16_to_cpu(*((__le16 *)(__pStart)))) ++ +#define LE_BITS_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ + ( \ + ( LE_P2BYTE_TO_HOST_2BYTE(__pStart) >> (__BitOffset) ) \ + & \ + BIT_LEN_MASK_16(__BitLen) \ + ) -+ ++ +#define LE_BITS_CLEARED_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ + ( \ + LE_P2BYTE_TO_HOST_2BYTE(__pStart) \ + & \ -+ (u16)(~BIT_OFFSET_LEN_MASK_16(__BitOffset, __BitLen))\ ++ ( ~BIT_OFFSET_LEN_MASK_16(__BitOffset, __BitLen) ) \ + ) + -+#define SET_BITS_TO_LE_2BYTE(__pStart, __BitOffset, __BitLen, __Value) \ -+ *((u16 *)(__pStart)) = \ -+ EF2Byte( \ -+ LE_BITS_CLEARED_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ -+ | \ -+ ( (((u16)__Value) & BIT_LEN_MASK_16(__BitLen)) << (__BitOffset) ) \ ++#define SET_BITS_TO_LE_2BYTE(__pstart, __bitoffset, __bitlen, __val) \ ++ *((__le16 *)(__pstart)) = \ ++ cpu_to_le16( \ ++ LE_BITS_CLEARED_TO_2BYTE(__pstart, __bitoffset, __bitlen) | \ ++ ((((u16)__val) & BIT_LEN_MASK_16(__bitlen)) << (__bitoffset)) \ + ); -+ ++ +#define BIT_LEN_MASK_8(__BitLen) \ + (0xFF >> (8 - (__BitLen))) + @@ -287143,7 +129946,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/basic_types.h linux/3rdparty/rtl + (BIT_LEN_MASK_8(__BitLen) << (__BitOffset)) + +#define LE_P1BYTE_TO_HOST_1BYTE(__pStart) \ -+ (EF1Byte(*((u8 *)(__pStart)))) ++ ((*((u8 *)(__pStart)))) + +#define LE_BITS_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ + ( \ @@ -287156,69 +129959,46 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/basic_types.h linux/3rdparty/rtl + ( \ + LE_P1BYTE_TO_HOST_1BYTE(__pStart) \ + & \ -+ (u8)(~BIT_OFFSET_LEN_MASK_8(__BitOffset, __BitLen))\ ++ ( ~BIT_OFFSET_LEN_MASK_8(__BitOffset, __BitLen) ) \ + ) + +#define SET_BITS_TO_LE_1BYTE(__pStart, __BitOffset, __BitLen, __Value) \ -+do { \ + *((u8 *)(__pStart)) = \ -+ EF1Byte( \ ++ ( \ + LE_BITS_CLEARED_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ + | \ + ( (((u8)__Value) & BIT_LEN_MASK_8(__BitLen)) << (__BitOffset) ) \ -+ ); \ -+} while (0) -+ -+ -+#define LE_BITS_CLEARED_TO_2BYTE_16BIT(__pStart, __BitOffset, __BitLen) \ -+ ( \ -+ LE_P2BYTE_TO_HOST_2BYTE(__pStart) \ -+ ) -+ -+#define SET_BITS_TO_LE_2BYTE_16BIT(__pStart, __BitOffset, __BitLen, __Value) \ -+ *((u16 *)(__pStart)) = \ -+ EF2Byte( \ -+ LE_BITS_CLEARED_TO_2BYTE_16BIT(__pStart, __BitOffset, __BitLen) \ -+ | \ -+ ( (u16)__Value) \ + ); + ++//pclint +#define LE_BITS_CLEARED_TO_1BYTE_8BIT(__pStart, __BitOffset, __BitLen) \ + ( \ + LE_P1BYTE_TO_HOST_1BYTE(__pStart) \ + ) + ++//pclint +#define SET_BITS_TO_LE_1BYTE_8BIT(__pStart, __BitOffset, __BitLen, __Value) \ -+do { \ -+ *((u8 *)(__pStart)) = \ -+ EF1Byte( \ ++{ \ ++ *((pu1Byte)(__pStart)) = \ ++ ( \ + LE_BITS_CLEARED_TO_1BYTE_8BIT(__pStart, __BitOffset, __BitLen) \ + | \ -+ ((u8)__Value) \ ++ ((u1Byte)__Value) \ + ); \ -+} while (0) ++} + +// Get the N-bytes aligment offset from the current length +#define N_BYTE_ALIGMENT(__Value, __Aligment) ((__Aligment == 1) ? (__Value) : (((__Value + __Aligment - 1) / __Aligment) * __Aligment)) + -+typedef unsigned char BOOLEAN,*PBOOLEAN; -+ -+#define TEST_FLAG(__Flag,__testFlag) (((__Flag) & (__testFlag)) != 0) -+#define SET_FLAG(__Flag, __setFlag) ((__Flag) |= __setFlag) -+#define CLEAR_FLAG(__Flag, __clearFlag) ((__Flag) &= ~(__clearFlag)) -+#define CLEAR_FLAGS(__Flag) ((__Flag) = 0) -+#define TEST_FLAGS(__Flag, __testFlags) (((__Flag) & (__testFlags)) == (__testFlags)) -+ +#endif //__BASIC_TYPES_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/byteorder/big_endian.h linux/3rdparty/rtl8812au/include/byteorder/big_endian.h ---- linux.old/3rdparty/rtl8812au/include/byteorder/big_endian.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/byteorder/big_endian.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,88 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/circ_buf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/circ_buf.h +--- linux-4.14.17/3rdparty/rtl8812au/include/circ_buf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/circ_buf.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,22 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -287228,720 +130008,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/byteorder/big_endian.h linux/3rd + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _LINUX_BYTEORDER_BIG_ENDIAN_H -+#define _LINUX_BYTEORDER_BIG_ENDIAN_H -+ -+#ifndef __BIG_ENDIAN -+#define __BIG_ENDIAN 4321 -+#endif -+#ifndef __BIG_ENDIAN_BITFIELD -+#define __BIG_ENDIAN_BITFIELD -+#endif -+ -+#include -+ -+#define __constant_htonl(x) ((__u32)(x)) -+#define __constant_ntohl(x) ((__u32)(x)) -+#define __constant_htons(x) ((__u16)(x)) -+#define __constant_ntohs(x) ((__u16)(x)) -+#define __constant_cpu_to_le64(x) ___constant_swab64((x)) -+#define __constant_le64_to_cpu(x) ___constant_swab64((x)) -+#define __constant_cpu_to_le32(x) ___constant_swab32((x)) -+#define __constant_le32_to_cpu(x) ___constant_swab32((x)) -+#define __constant_cpu_to_le16(x) ___constant_swab16((x)) -+#define __constant_le16_to_cpu(x) ___constant_swab16((x)) -+#define __constant_cpu_to_be64(x) ((__u64)(x)) -+#define __constant_be64_to_cpu(x) ((__u64)(x)) -+#define __constant_cpu_to_be32(x) ((__u32)(x)) -+#define __constant_be32_to_cpu(x) ((__u32)(x)) -+#define __constant_cpu_to_be16(x) ((__u16)(x)) -+#define __constant_be16_to_cpu(x) ((__u16)(x)) -+#define __cpu_to_le64(x) __swab64((x)) -+#define __le64_to_cpu(x) __swab64((x)) -+#define __cpu_to_le32(x) __swab32((x)) -+#define __le32_to_cpu(x) __swab32((x)) -+#define __cpu_to_le16(x) __swab16((x)) -+#define __le16_to_cpu(x) __swab16((x)) -+#define __cpu_to_be64(x) ((__u64)(x)) -+#define __be64_to_cpu(x) ((__u64)(x)) -+#define __cpu_to_be32(x) ((__u32)(x)) -+#define __be32_to_cpu(x) ((__u32)(x)) -+#define __cpu_to_be16(x) ((__u16)(x)) -+#define __be16_to_cpu(x) ((__u16)(x)) -+#define __cpu_to_le64p(x) __swab64p((x)) -+#define __le64_to_cpup(x) __swab64p((x)) -+#define __cpu_to_le32p(x) __swab32p((x)) -+#define __le32_to_cpup(x) __swab32p((x)) -+#define __cpu_to_le16p(x) __swab16p((x)) -+#define __le16_to_cpup(x) __swab16p((x)) -+#define __cpu_to_be64p(x) (*(__u64*)(x)) -+#define __be64_to_cpup(x) (*(__u64*)(x)) -+#define __cpu_to_be32p(x) (*(__u32*)(x)) -+#define __be32_to_cpup(x) (*(__u32*)(x)) -+#define __cpu_to_be16p(x) (*(__u16*)(x)) -+#define __be16_to_cpup(x) (*(__u16*)(x)) -+#define __cpu_to_le64s(x) __swab64s((x)) -+#define __le64_to_cpus(x) __swab64s((x)) -+#define __cpu_to_le32s(x) __swab32s((x)) -+#define __le32_to_cpus(x) __swab32s((x)) -+#define __cpu_to_le16s(x) __swab16s((x)) -+#define __le16_to_cpus(x) __swab16s((x)) -+#define __cpu_to_be64s(x) do {} while (0) -+#define __be64_to_cpus(x) do {} while (0) -+#define __cpu_to_be32s(x) do {} while (0) -+#define __be32_to_cpus(x) do {} while (0) -+#define __cpu_to_be16s(x) do {} while (0) -+#define __be16_to_cpus(x) do {} while (0) -+ -+#include -+ -+#endif /* _LINUX_BYTEORDER_BIG_ENDIAN_H */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/byteorder/generic.h linux/3rdparty/rtl8812au/include/byteorder/generic.h ---- linux.old/3rdparty/rtl8812au/include/byteorder/generic.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/byteorder/generic.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,213 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _LINUX_BYTEORDER_GENERIC_H -+#define _LINUX_BYTEORDER_GENERIC_H -+ -+/* -+ * linux/byteorder_generic.h -+ * Generic Byte-reordering support -+ * -+ * Francois-Rene Rideau 19970707 -+ * gathered all the good ideas from all asm-foo/byteorder.h into one file, -+ * cleaned them up. -+ * I hope it is compliant with non-GCC compilers. -+ * I decided to put __BYTEORDER_HAS_U64__ in byteorder.h, -+ * because I wasn't sure it would be ok to put it in types.h -+ * Upgraded it to 2.1.43 -+ * Francois-Rene Rideau 19971012 -+ * Upgraded it to 2.1.57 -+ * to please Linus T., replaced huge #ifdef's between little/big endian -+ * by nestedly #include'd files. -+ * Francois-Rene Rideau 19971205 -+ * Made it to 2.1.71; now a facelift: -+ * Put files under include/linux/byteorder/ -+ * Split swab from generic support. -+ * -+ * TODO: -+ * = Regular kernel maintainers could also replace all these manual -+ * byteswap macros that remain, disseminated among drivers, -+ * after some grep or the sources... -+ * = Linus might want to rename all these macros and files to fit his taste, -+ * to fit his personal naming scheme. -+ * = it seems that a few drivers would also appreciate -+ * nybble swapping support... -+ * = every architecture could add their byteswap macro in asm/byteorder.h -+ * see how some architectures already do (i386, alpha, ppc, etc) -+ * = cpu_to_beXX and beXX_to_cpu might some day need to be well -+ * distinguished throughout the kernel. This is not the case currently, -+ * since little endian, big endian, and pdp endian machines needn't it. -+ * But this might be the case for, say, a port of Linux to 20/21 bit -+ * architectures (and F21 Linux addict around?). -+ */ -+ -+/* -+ * The following macros are to be defined by : -+ * -+ * Conversion of long and short int between network and host format -+ * ntohl(__u32 x) -+ * ntohs(__u16 x) -+ * htonl(__u32 x) -+ * htons(__u16 x) -+ * It seems that some programs (which? where? or perhaps a standard? POSIX?) -+ * might like the above to be functions, not macros (why?). -+ * if that's true, then detect them, and take measures. -+ * Anyway, the measure is: define only ___ntohl as a macro instead, -+ * and in a separate file, have -+ * unsigned long inline ntohl(x){return ___ntohl(x);} -+ * -+ * The same for constant arguments -+ * __constant_ntohl(__u32 x) -+ * __constant_ntohs(__u16 x) -+ * __constant_htonl(__u32 x) -+ * __constant_htons(__u16 x) -+ * -+ * Conversion of XX-bit integers (16- 32- or 64-) -+ * between native CPU format and little/big endian format -+ * 64-bit stuff only defined for proper architectures -+ * cpu_to_[bl]eXX(__uXX x) -+ * [bl]eXX_to_cpu(__uXX x) -+ * -+ * The same, but takes a pointer to the value to convert -+ * cpu_to_[bl]eXXp(__uXX x) -+ * [bl]eXX_to_cpup(__uXX x) -+ * -+ * The same, but change in situ -+ * cpu_to_[bl]eXXs(__uXX x) -+ * [bl]eXX_to_cpus(__uXX x) -+ * -+ * See asm-foo/byteorder.h for examples of how to provide -+ * architecture-optimized versions -+ * -+ */ -+ -+ -+#if defined(PLATFORM_LINUX) || defined(PLATFORM_WINDOWS) || defined(PLATFORM_MPIXEL) || defined(PLATFORM_FREEBSD) -+/* -+ * inside the kernel, we can use nicknames; -+ * outside of it, we must avoid POSIX namespace pollution... -+ */ -+#define cpu_to_le64 __cpu_to_le64 -+#define le64_to_cpu __le64_to_cpu -+#define cpu_to_le32 __cpu_to_le32 -+#define le32_to_cpu __le32_to_cpu -+#define cpu_to_le16 __cpu_to_le16 -+#define le16_to_cpu __le16_to_cpu -+#define cpu_to_be64 __cpu_to_be64 -+#define be64_to_cpu __be64_to_cpu -+#define cpu_to_be32 __cpu_to_be32 -+#define be32_to_cpu __be32_to_cpu -+#define cpu_to_be16 __cpu_to_be16 -+#define be16_to_cpu __be16_to_cpu -+#define cpu_to_le64p __cpu_to_le64p -+#define le64_to_cpup __le64_to_cpup -+#define cpu_to_le32p __cpu_to_le32p -+#define le32_to_cpup __le32_to_cpup -+#define cpu_to_le16p __cpu_to_le16p -+#define le16_to_cpup __le16_to_cpup -+#define cpu_to_be64p __cpu_to_be64p -+#define be64_to_cpup __be64_to_cpup -+#define cpu_to_be32p __cpu_to_be32p -+#define be32_to_cpup __be32_to_cpup -+#define cpu_to_be16p __cpu_to_be16p -+#define be16_to_cpup __be16_to_cpup -+#define cpu_to_le64s __cpu_to_le64s -+#define le64_to_cpus __le64_to_cpus -+#define cpu_to_le32s __cpu_to_le32s -+#define le32_to_cpus __le32_to_cpus -+#define cpu_to_le16s __cpu_to_le16s -+#define le16_to_cpus __le16_to_cpus -+#define cpu_to_be64s __cpu_to_be64s -+#define be64_to_cpus __be64_to_cpus -+#define cpu_to_be32s __cpu_to_be32s -+#define be32_to_cpus __be32_to_cpus -+#define cpu_to_be16s __cpu_to_be16s -+#define be16_to_cpus __be16_to_cpus -+#endif -+ -+ -+/* -+ * Handle ntohl and suches. These have various compatibility -+ * issues - like we want to give the prototype even though we -+ * also have a macro for them in case some strange program -+ * wants to take the address of the thing or something.. -+ * -+ * Note that these used to return a "long" in libc5, even though -+ * long is often 64-bit these days.. Thus the casts. -+ * -+ * They have to be macros in order to do the constant folding -+ * correctly - if the argument passed into a inline function -+ * it is no longer constant according to gcc.. -+ */ -+ -+#undef ntohl -+#undef ntohs -+#undef htonl -+#undef htons -+ -+/* -+ * Do the prototypes. Somebody might want to take the -+ * address or some such sick thing.. -+ */ -+#if defined(PLATFORM_LINUX) || (defined (__GLIBC__) && __GLIBC__ >= 2) -+extern __u32 ntohl(__u32); -+extern __u32 htonl(__u32); -+#else //defined(PLATFORM_LINUX) || (defined (__GLIBC__) && __GLIBC__ >= 2) -+#ifndef PLATFORM_FREEBSD -+extern unsigned long int ntohl(unsigned long int); -+extern unsigned long int htonl(unsigned long int); -+#endif -+#endif -+#ifndef PLATFORM_FREEBSD -+extern unsigned short int ntohs(unsigned short int); -+extern unsigned short int htons(unsigned short int); -+#endif -+ -+#if defined(__GNUC__) && (__GNUC__ >= 2) && defined(__OPTIMIZE__) || defined(PLATFORM_MPIXEL) -+ -+#define ___htonl(x) __cpu_to_be32(x) -+#define ___htons(x) __cpu_to_be16(x) -+#define ___ntohl(x) __be32_to_cpu(x) -+#define ___ntohs(x) __be16_to_cpu(x) -+ -+#if defined(PLATFORM_LINUX) || (defined (__GLIBC__) && __GLIBC__ >= 2) -+#define htonl(x) ___htonl(x) -+#define ntohl(x) ___ntohl(x) -+#else -+#define htonl(x) ((unsigned long)___htonl(x)) -+#define ntohl(x) ((unsigned long)___ntohl(x)) -+#endif -+#define htons(x) ___htons(x) -+#define ntohs(x) ___ntohs(x) -+ -+#endif /* OPTIMIZE */ -+ -+ -+#if defined (PLATFORM_WINDOWS) -+ -+#define htonl(x) __cpu_to_be32(x) -+#define ntohl(x) __be32_to_cpu(x) -+#define htons(x) __cpu_to_be16(x) -+#define ntohs(x) __be16_to_cpu(x) -+ -+ -+#endif -+ -+#endif /* _LINUX_BYTEORDER_GENERIC_H */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/byteorder/little_endian.h linux/3rdparty/rtl8812au/include/byteorder/little_endian.h ---- linux.old/3rdparty/rtl8812au/include/byteorder/little_endian.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/byteorder/little_endian.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,90 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _LINUX_BYTEORDER_LITTLE_ENDIAN_H -+#define _LINUX_BYTEORDER_LITTLE_ENDIAN_H -+ -+#ifndef __LITTLE_ENDIAN -+#define __LITTLE_ENDIAN 1234 -+#endif -+#ifndef __LITTLE_ENDIAN_BITFIELD -+#define __LITTLE_ENDIAN_BITFIELD -+#endif -+ -+#include -+ -+#ifndef __constant_htonl -+#define __constant_htonl(x) ___constant_swab32((x)) -+#define __constant_ntohl(x) ___constant_swab32((x)) -+#define __constant_htons(x) ___constant_swab16((x)) -+#define __constant_ntohs(x) ___constant_swab16((x)) -+#define __constant_cpu_to_le64(x) ((__u64)(x)) -+#define __constant_le64_to_cpu(x) ((__u64)(x)) -+#define __constant_cpu_to_le32(x) ((__u32)(x)) -+#define __constant_le32_to_cpu(x) ((__u32)(x)) -+#define __constant_cpu_to_le16(x) ((__u16)(x)) -+#define __constant_le16_to_cpu(x) ((__u16)(x)) -+#define __constant_cpu_to_be64(x) ___constant_swab64((x)) -+#define __constant_be64_to_cpu(x) ___constant_swab64((x)) -+#define __constant_cpu_to_be32(x) ___constant_swab32((x)) -+#define __constant_be32_to_cpu(x) ___constant_swab32((x)) -+#define __constant_cpu_to_be16(x) ___constant_swab16((x)) -+#define __constant_be16_to_cpu(x) ___constant_swab16((x)) -+#define __cpu_to_le64(x) ((__u64)(x)) -+#define __le64_to_cpu(x) ((__u64)(x)) -+#define __cpu_to_le32(x) ((__u32)(x)) -+#define __le32_to_cpu(x) ((__u32)(x)) -+#define __cpu_to_le16(x) ((__u16)(x)) -+#define __le16_to_cpu(x) ((__u16)(x)) -+#define __cpu_to_be64(x) __swab64((x)) -+#define __be64_to_cpu(x) __swab64((x)) -+#define __cpu_to_be32(x) __swab32((x)) -+#define __be32_to_cpu(x) __swab32((x)) -+#define __cpu_to_be16(x) __swab16((x)) -+#define __be16_to_cpu(x) __swab16((x)) -+#define __cpu_to_le64p(x) (*(__u64*)(x)) -+#define __le64_to_cpup(x) (*(__u64*)(x)) -+#define __cpu_to_le32p(x) (*(__u32*)(x)) -+#define __le32_to_cpup(x) (*(__u32*)(x)) -+#define __cpu_to_le16p(x) (*(__u16*)(x)) -+#define __le16_to_cpup(x) (*(__u16*)(x)) -+#define __cpu_to_be64p(x) __swab64p((x)) -+#define __be64_to_cpup(x) __swab64p((x)) -+#define __cpu_to_be32p(x) __swab32p((x)) -+#define __be32_to_cpup(x) __swab32p((x)) -+#define __cpu_to_be16p(x) __swab16p((x)) -+#define __be16_to_cpup(x) __swab16p((x)) -+#define __cpu_to_le64s(x) do {} while (0) -+#define __le64_to_cpus(x) do {} while (0) -+#define __cpu_to_le32s(x) do {} while (0) -+#define __le32_to_cpus(x) do {} while (0) -+#define __cpu_to_le16s(x) do {} while (0) -+#define __le16_to_cpus(x) do {} while (0) -+#define __cpu_to_be64s(x) __swab64s((x)) -+#define __be64_to_cpus(x) __swab64s((x)) -+#define __cpu_to_be32s(x) __swab32s((x)) -+#define __be32_to_cpus(x) __swab32s((x)) -+#define __cpu_to_be16s(x) __swab16s((x)) -+#define __be16_to_cpus(x) __swab16s((x)) -+#endif // __constant_htonl -+ -+#include -+ -+#endif /* _LINUX_BYTEORDER_LITTLE_ENDIAN_H */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/byteorder/swabb.h linux/3rdparty/rtl8812au/include/byteorder/swabb.h ---- linux.old/3rdparty/rtl8812au/include/byteorder/swabb.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/byteorder/swabb.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,157 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _LINUX_BYTEORDER_SWABB_H -+#define _LINUX_BYTEORDER_SWABB_H -+ -+/* -+ * linux/byteorder/swabb.h -+ * SWAp Bytes Bizarrely -+ * swaHHXX[ps]?(foo) -+ * -+ * Support for obNUXIous pdp-endian and other bizarre architectures. -+ * Will Linux ever run on such ancient beasts? if not, this file -+ * will be but a programming pearl. Still, it's a reminder that we -+ * shouldn't be making too many assumptions when trying to be portable. -+ * -+ */ -+ -+/* -+ * Meaning of the names I chose (vaxlinux people feel free to correct them): -+ * swahw32 swap 16-bit half-words in a 32-bit word -+ * swahb32 swap 8-bit halves of each 16-bit half-word in a 32-bit word -+ * -+ * No 64-bit support yet. I don't know NUXI conventions for long longs. -+ * I guarantee it will be a mess when it's there, though :-> -+ * It will be even worse if there are conflicting 64-bit conventions. -+ * Hopefully, no one ever used 64-bit objects on NUXI machines. -+ * -+ */ -+ -+#define ___swahw32(x) \ -+({ \ -+ __u32 __x = (x); \ -+ ((__u32)( \ -+ (((__u32)(__x) & (__u32)0x0000ffffUL) << 16) | \ -+ (((__u32)(__x) & (__u32)0xffff0000UL) >> 16) )); \ -+}) -+#define ___swahb32(x) \ -+({ \ -+ __u32 __x = (x); \ -+ ((__u32)( \ -+ (((__u32)(__x) & (__u32)0x00ff00ffUL) << 8) | \ -+ (((__u32)(__x) & (__u32)0xff00ff00UL) >> 8) )); \ -+}) -+ -+#define ___constant_swahw32(x) \ -+ ((__u32)( \ -+ (((__u32)(x) & (__u32)0x0000ffffUL) << 16) | \ -+ (((__u32)(x) & (__u32)0xffff0000UL) >> 16) )) -+#define ___constant_swahb32(x) \ -+ ((__u32)( \ -+ (((__u32)(x) & (__u32)0x00ff00ffUL) << 8) | \ -+ (((__u32)(x) & (__u32)0xff00ff00UL) >> 8) )) -+ -+/* -+ * provide defaults when no architecture-specific optimization is detected -+ */ -+#ifndef __arch__swahw32 -+# define __arch__swahw32(x) ___swahw32(x) -+#endif -+#ifndef __arch__swahb32 -+# define __arch__swahb32(x) ___swahb32(x) -+#endif -+ -+#ifndef __arch__swahw32p -+# define __arch__swahw32p(x) __swahw32(*(x)) -+#endif -+#ifndef __arch__swahb32p -+# define __arch__swahb32p(x) __swahb32(*(x)) -+#endif -+ -+#ifndef __arch__swahw32s -+# define __arch__swahw32s(x) do { *(x) = __swahw32p((x)); } while (0) -+#endif -+#ifndef __arch__swahb32s -+# define __arch__swahb32s(x) do { *(x) = __swahb32p((x)); } while (0) -+#endif -+ -+ -+/* -+ * Allow constant folding -+ */ -+#if defined(__GNUC__) && (__GNUC__ >= 2) && defined(__OPTIMIZE__) -+# define __swahw32(x) \ -+(__builtin_constant_p((__u32)(x)) ? \ -+ ___swahw32((x)) : \ -+ __fswahw32((x))) -+# define __swahb32(x) \ -+(__builtin_constant_p((__u32)(x)) ? \ -+ ___swahb32((x)) : \ -+ __fswahb32((x))) -+#else -+# define __swahw32(x) __fswahw32(x) -+# define __swahb32(x) __fswahb32(x) -+#endif /* OPTIMIZE */ -+ -+ -+__inline static__ __const__ __u32 __fswahw32(__u32 x) -+{ -+ return __arch__swahw32(x); -+} -+__inline static__ __u32 __swahw32p(__u32 *x) -+{ -+ return __arch__swahw32p(x); -+} -+__inline static__ void __swahw32s(__u32 *addr) -+{ -+ __arch__swahw32s(addr); -+} -+ -+ -+__inline static__ __const__ __u32 __fswahb32(__u32 x) -+{ -+ return __arch__swahb32(x); -+} -+__inline static__ __u32 __swahb32p(__u32 *x) -+{ -+ return __arch__swahb32p(x); -+} -+__inline static__ void __swahb32s(__u32 *addr) -+{ -+ __arch__swahb32s(addr); -+} -+ -+#ifdef __BYTEORDER_HAS_U64__ -+/* -+ * Not supported yet -+ */ -+#endif /* __BYTEORDER_HAS_U64__ */ -+ -+#if defined(PLATFORM_LINUX) -+#define swahw32 __swahw32 -+#define swahb32 __swahb32 -+#define swahw32p __swahw32p -+#define swahb32p __swahb32p -+#define swahw32s __swahw32s -+#define swahb32s __swahb32s -+#endif -+ -+#endif /* _LINUX_BYTEORDER_SWABB_H */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/byteorder/swab.h linux/3rdparty/rtl8812au/include/byteorder/swab.h ---- linux.old/3rdparty/rtl8812au/include/byteorder/swab.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/byteorder/swab.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,141 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _LINUX_BYTEORDER_SWAB_H -+#define _LINUX_BYTEORDER_SWAB_H -+ -+#if !defined(CONFIG_PLATFORM_MSTAR) -+#ifndef __u16 -+typedef unsigned short __u16; -+#endif -+ -+#ifndef __u32 -+typedef unsigned int __u32; -+#endif -+ -+#ifndef __u8 -+typedef unsigned char __u8; -+#endif -+ -+#ifndef __u64 -+typedef unsigned long long __u64; -+#endif -+ -+ -+__inline static __u16 ___swab16(__u16 x) -+{ -+ __u16 __x = x; -+ return -+ ((__u16)( -+ (((__u16)(__x) & (__u16)0x00ffU) << 8) | -+ (((__u16)(__x) & (__u16)0xff00U) >> 8) )); -+ -+} -+ -+__inline static __u32 ___swab32(__u32 x) -+{ -+ __u32 __x = (x); -+ return ((__u32)( -+ (((__u32)(__x) & (__u32)0x000000ffUL) << 24) | -+ (((__u32)(__x) & (__u32)0x0000ff00UL) << 8) | -+ (((__u32)(__x) & (__u32)0x00ff0000UL) >> 8) | -+ (((__u32)(__x) & (__u32)0xff000000UL) >> 24) )); -+} -+ -+__inline static __u64 ___swab64(__u64 x) -+{ -+ __u64 __x = (x); -+ -+ return -+ ((__u64)( \ -+ (__u64)(((__u64)(__x) & (__u64)0x00000000000000ffULL) << 56) | \ -+ (__u64)(((__u64)(__x) & (__u64)0x000000000000ff00ULL) << 40) | \ -+ (__u64)(((__u64)(__x) & (__u64)0x0000000000ff0000ULL) << 24) | \ -+ (__u64)(((__u64)(__x) & (__u64)0x00000000ff000000ULL) << 8) | \ -+ (__u64)(((__u64)(__x) & (__u64)0x000000ff00000000ULL) >> 8) | \ -+ (__u64)(((__u64)(__x) & (__u64)0x0000ff0000000000ULL) >> 24) | \ -+ (__u64)(((__u64)(__x) & (__u64)0x00ff000000000000ULL) >> 40) | \ -+ (__u64)(((__u64)(__x) & (__u64)0xff00000000000000ULL) >> 56) )); \ -+} -+#endif // CONFIG_PLATFORM_MSTAR -+ -+#ifndef __arch__swab16 -+__inline static __u16 __arch__swab16(__u16 x) -+{ -+ return ___swab16(x); -+} -+ -+#endif -+ -+#ifndef __arch__swab32 -+__inline static __u32 __arch__swab32(__u32 x) -+{ -+ __u32 __tmp = (x) ; -+ return ___swab32(__tmp); -+} -+#endif -+ -+#ifndef __arch__swab64 -+ -+__inline static __u64 __arch__swab64(__u64 x) -+{ -+ __u64 __tmp = (x) ; -+ return ___swab64(__tmp); -+} -+ -+ -+#endif -+ -+#ifndef __swab16 -+#define __swab16(x) __fswab16(x) -+#define __swab32(x) __fswab32(x) -+#define __swab64(x) __fswab64(x) -+#endif // __swab16 -+ -+#ifdef PLATFORM_FREEBSD -+__inline static __u16 __fswab16(__u16 x) -+#else -+__inline static const __u16 __fswab16(__u16 x) -+#endif //PLATFORM_FREEBSD -+{ -+ return __arch__swab16(x); -+} -+#ifdef PLATFORM_FREEBSD -+__inline static __u32 __fswab32(__u32 x) -+#else -+__inline static const __u32 __fswab32(__u32 x) -+#endif //PLATFORM_FREEBSD -+{ -+ return __arch__swab32(x); -+} -+ -+#if defined(PLATFORM_LINUX) || defined(PLATFORM_WINDOWS) -+#define swab16 __swab16 -+#define swab32 __swab32 -+#define swab64 __swab64 -+#define swab16p __swab16p -+#define swab32p __swab32p -+#define swab64p __swab64p -+#define swab16s __swab16s -+#define swab32s __swab32s -+#define swab64s __swab64s -+#endif -+ -+#endif /* _LINUX_BYTEORDER_SWAB_H */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/circ_buf.h linux/3rdparty/rtl8812au/include/circ_buf.h ---- linux.old/3rdparty/rtl8812au/include/circ_buf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/circ_buf.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __CIRC_BUF_H_ +#define __CIRC_BUF_H_ 1 @@ -287951,15 +130017,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/circ_buf.h linux/3rdparty/rtl881 +#define CIRC_SPACE(head,tail,size) CIRC_CNT((tail),((head)+1),(size)) + +#endif //_CIRC_BUF_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/cmd_osdep.h linux/3rdparty/rtl8812au/include/cmd_osdep.h ---- linux.old/3rdparty/rtl8812au/include/cmd_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/cmd_osdep.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,32 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/cmd_osdep.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/cmd_osdep.h +--- linux-4.14.17/3rdparty/rtl8812au/include/cmd_osdep.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/cmd_osdep.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,26 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -287969,11 +130034,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/cmd_osdep.h linux/3rdparty/rtl88 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __CMD_OSDEP_H_ +#define __CMD_OSDEP_H_ @@ -287987,28 +130047,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/cmd_osdep.h linux/3rdparty/rtl88 +extern struct cmd_obj *_rtw_dequeue_cmd(_queue *queue); + +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/custom_gpio.h linux/3rdparty/rtl8812au/include/custom_gpio.h ---- linux.old/3rdparty/rtl8812au/include/custom_gpio.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/custom_gpio.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,32 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/custom_gpio.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/custom_gpio.h +--- linux-4.14.17/3rdparty/rtl8812au/include/custom_gpio.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/custom_gpio.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,22 @@ +#ifndef __CUSTOM_GPIO_H__ +#define __CUSTOM_GPIO_H___ + +#include +#include + -+#ifdef PLATFORM_OS_XP -+#include -+#endif -+ -+#ifdef PLATFORM_OS_CE -+#include -+#endif -+ -+#ifdef PLATFORM_LINUX +#include -+#endif + +typedef enum cust_gpio_modes { + WLAN_PWDN_ON, @@ -288024,14 +130073,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/custom_gpio.h linux/3rdparty/rtl +extern void rtw_wifi_gpio_wlan_ctrl(int onoff); + +#endif -diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_conf.h linux/3rdparty/rtl8812au/include/drv_conf.h ---- linux.old/3rdparty/rtl8812au/include/drv_conf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/drv_conf.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,158 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/drv_conf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/drv_conf.h +--- linux-4.14.17/3rdparty/rtl8812au/include/drv_conf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/drv_conf.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,49 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -288041,43 +130090,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_conf.h linux/3rdparty/rtl881 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __DRV_CONF_H__ +#define __DRV_CONF_H__ +#include "autoconf.h" -+#include "hal_ic_cfg.h" + -+#if defined (PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+ -+#error "Shall be Linux or Windows, but not both!\n" -+ -+#endif -+ -+//Older Android kernel doesn't has CONFIG_ANDROID defined, -+//add this to force CONFIG_ANDROID defined -+#ifdef CONFIG_PLATFORM_ANDROID -+#ifndef CONFIG_ANDROID -+#define CONFIG_ANDROID -+#endif -+#endif -+ -+#ifdef CONFIG_ANDROID -+//Some Android build will restart the UI while non-printable ascii is passed -+//between java and c/c++ layer (JNI). We force CONFIG_VALIDATE_SSID -+//for Android here. If you are sure there is no risk on your system about this, -+//mask this macro define to support non-printable ascii ssid. -+//#define CONFIG_VALIDATE_SSID -+ -+//Android expect dbm as the rx signal strength unit -+#define CONFIG_SIGNAL_DISPLAY_DBM -+#endif -+ -+/* +#if defined(CONFIG_HAS_EARLYSUSPEND) && defined (CONFIG_RESUME_IN_WORKQUEUE) + #warning "You have CONFIG_HAS_EARLYSUSPEND enabled in your system, we disable CONFIG_RESUME_IN_WORKQUEUE automatically" + #undef CONFIG_RESUME_IN_WORKQUEUE @@ -288087,7 +130104,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_conf.h linux/3rdparty/rtl881 + #warning "You have CONFIG_ANDROID_POWER enabled in your system, we disable CONFIG_RESUME_IN_WORKQUEUE automatically" + #undef CONFIG_RESUME_IN_WORKQUEUE +#endif -+*/ + +#ifdef CONFIG_RESUME_IN_WORKQUEUE //this can be removed, because there is no case for this... + #if !defined( CONFIG_WAKELOCK) && !defined(CONFIG_ANDROID_POWER) @@ -288097,7 +130113,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_conf.h linux/3rdparty/rtl881 +#endif + +//About USB VENDOR REQ -+#if defined(CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC) && !defined(CONFIG_USB_VENDOR_REQ_MUTEX) ++#if defined(CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC) && !defined(CONFIG_USB_VENDOR_REQ_MUTEX) + #warning "define CONFIG_USB_VENDOR_REQ_MUTEX for CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC automatically" + #define CONFIG_USB_VENDOR_REQ_MUTEX +#endif @@ -288106,247 +130122,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_conf.h linux/3rdparty/rtl881 + #define CONFIG_USB_VENDOR_REQ_MUTEX +#endif + -+#if !defined(CONFIG_AP_MODE) && defined(CONFIG_DFS_MASTER) -+ #warning "undef CONFIG_DFS_MASTER because CONFIG_AP_MODE is not defined" -+ #undef CONFIG_DFS_MASTER -+#endif + -+#define DYNAMIC_CAMID_ALLOC -+ -+#define RTW_SCAN_SPARSE_MIRACAST 1 -+#define RTW_SCAN_SPARSE_BG 0 -+ -+#ifndef CONFIG_RTW_HIQ_FILTER -+ #define CONFIG_RTW_HIQ_FILTER 1 -+#endif -+ -+#ifndef CONFIG_RTW_ADAPTIVITY_EN -+ #define CONFIG_RTW_ADAPTIVITY_EN 0 -+#endif -+ -+#ifndef CONFIG_RTW_ADAPTIVITY_MODE -+ #define CONFIG_RTW_ADAPTIVITY_MODE 0 -+#endif -+ -+#ifndef CONFIG_RTW_ADAPTIVITY_DML -+ #define CONFIG_RTW_ADAPTIVITY_DML 0 -+#endif -+ -+#ifndef CONFIG_RTW_ADAPTIVITY_DC_BACKOFF -+ #define CONFIG_RTW_ADAPTIVITY_DC_BACKOFF 2 -+#endif -+ -+#ifndef CONFIG_RTW_ADAPTIVITY_TH_L2H_INI -+ #define CONFIG_RTW_ADAPTIVITY_TH_L2H_INI 0 -+#endif -+ -+#ifndef CONFIG_RTW_ADAPTIVITY_TH_EDCCA_HL_DIFF -+ #define CONFIG_RTW_ADAPTIVITY_TH_EDCCA_HL_DIFF 0 -+#endif -+ -+#ifndef CONFIG_RTW_AMPLIFIER_TYPE_2G -+ #define CONFIG_RTW_AMPLIFIER_TYPE_2G 0 -+#endif -+ -+#ifndef CONFIG_RTW_AMPLIFIER_TYPE_5G -+ #define CONFIG_RTW_AMPLIFIER_TYPE_5G 0 -+#endif -+ -+#ifndef CONFIG_RTW_RFE_TYPE -+ #define CONFIG_RTW_RFE_TYPE 64 -+#endif -+ -+#ifndef CONFIG_RTW_GLNA_TYPE -+ #define CONFIG_RTW_GLNA_TYPE 0 -+#endif -+ -+#ifndef CONFIG_RTW_PLL_REF_CLK_SEL -+ #define CONFIG_RTW_PLL_REF_CLK_SEL 0x0F -+#endif -+ -+#define MACID_NUM_SW_LIMIT 32 -+#define SEC_CAM_ENT_NUM_SW_LIMIT 32 -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) -+ #define CONFIG_IEEE80211_BAND_5GHZ -+#endif -+ -+/* -+ Mark CONFIG_DEAUTH_BEFORE_CONNECT by Arvin 2015/07/20 -+ If the failure of Wi-Fi connection is due to some irregular disconnection behavior (like unplug dongle, -+ power down etc.) in last time, we can unmark this flag to avoid some unpredictable response from AP. -+*/ -+/*#define CONFIG_DEAUTH_BEFORE_CONNECT */ -+ -+/*#define CONFIG_WEXT_DONT_JOIN_BYSSID */ +//#include + -+ -+/*#define CONFIG_DOSCAN_IN_BUSYTRAFFIC */ -+ +#endif // __DRV_CONF_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types_ce.h linux/3rdparty/rtl8812au/include/drv_types_ce.h ---- linux.old/3rdparty/rtl8812au/include/drv_types_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/drv_types_ce.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,93 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __DRV_TYPES_CE_H__ -+#define __DRV_TYPES_CE_H__ -+ -+#include -+#include -+ -+#include -+ -+#define MAX_ACTIVE_REG_PATH 256 -+ -+#define MAX_MCAST_LIST_NUM 32 -+ -+ -+ -+//for ioctl -+#define MAKE_DRIVER_VERSION(_MainVer,_MinorVer) ((((u32)(_MainVer))<<16)+_MinorVer) -+ -+#define NIC_HEADER_SIZE 14 //!< can be moved to typedef.h -+#define NIC_MAX_PACKET_SIZE 1514 //!< can be moved to typedef.h -+#define NIC_MAX_SEND_PACKETS 10 // max number of send packets the MiniportSendPackets function can accept, can be moved to typedef.h -+#define NIC_VENDOR_DRIVER_VERSION MAKE_DRIVER_VERSION(0,001) //!< can be moved to typedef.h -+#define NIC_MAX_PACKET_SIZE 1514 //!< can be moved to typedef.h -+ -+typedef struct _MP_REG_ENTRY -+{ -+ -+ NDIS_STRING RegName; // variable name text -+ BOOLEAN bRequired; // 1 -> required, 0 -> optional -+ -+ u8 Type; // NdisParameterInteger/NdisParameterHexInteger/NdisParameterStringle/NdisParameterMultiString -+ uint FieldOffset; // offset to MP_ADAPTER field -+ uint FieldSize; // size (in bytes) of the field -+ -+#ifdef UNDER_AMD64 -+ u64 Default; -+#else -+ u32 Default; // default value to use -+#endif -+ -+ u32 Min; // minimum value allowed -+ u32 Max; // maximum value allowed -+} MP_REG_ENTRY, *PMP_REG_ENTRY; -+ -+#ifdef CONFIG_USB_HCI -+typedef struct _USB_EXTENSION { -+ LPCUSB_FUNCS _lpUsbFuncs; -+ USB_HANDLE _hDevice; -+ PVOID pAdapter; -+ -+#if 0 -+ USB_ENDPOINT_DESCRIPTOR _endpACLIn; -+ USB_ENDPOINT_DESCRIPTOR _endpACLOutHigh; -+ USB_ENDPOINT_DESCRIPTOR _endpACLOutNormal; -+ -+ USB_PIPE pPipeIn; -+ USB_PIPE pPipeOutNormal; -+ USB_PIPE pPipeOutHigh; -+#endif -+ -+} USB_EXTENSION, *PUSB_EXTENSION; -+#endif -+ -+ -+typedef struct _OCTET_STRING{ -+ u8 *Octet; -+ u16 Length; -+} OCTET_STRING, *POCTET_STRING; -+ -+ -+ -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types_gspi.h linux/3rdparty/rtl8812au/include/drv_types_gspi.h ---- linux.old/3rdparty/rtl8812au/include/drv_types_gspi.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/drv_types_gspi.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,56 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __DRV_TYPES_GSPI_H__ -+#define __DRV_TYPES_GSPI_H__ -+ -+// SPI Header Files -+#ifdef PLATFORM_LINUX -+ #include -+ #include -+ #include -+ //#include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+#endif -+ -+ -+typedef struct gspi_data -+{ -+ u8 func_number; -+ -+ u8 tx_block_mode; -+ u8 rx_block_mode; -+ u32 block_transfer_len; -+ -+#ifdef PLATFORM_LINUX -+ struct spi_device *func; -+ -+ struct workqueue_struct *priv_wq; -+ struct delayed_work irq_work; -+#endif -+} GSPI_DATA, *PGSPI_DATA; -+ -+#endif // #ifndef __DRV_TYPES_GSPI_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl8812au/include/drv_types.h ---- linux.old/3rdparty/rtl8812au/include/drv_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/drv_types.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,1286 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/drv_types.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/drv_types.h +--- linux-4.14.17/3rdparty/rtl8812au/include/drv_types.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/drv_types.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,653 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. @@ -288360,11 +130143,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +/*------------------------------------------------------------------------------- + @@ -288379,40 +130157,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 +#include +#include +#include -+#include +#include +#include +#include -+#ifdef CONFIG_ARP_KEEP_ALIVE -+#include -+#include -+#endif + -+#ifdef PLATFORM_OS_XP -+#include -+#endif -+ -+#ifdef PLATFORM_OS_CE -+#include -+#endif -+ -+#ifdef PLATFORM_LINUX +#include -+#endif + +enum _NIC_VERSION { -+ + RTL8711_NIC, + RTL8712_NIC, + RTL8713_NIC, + RTL8716_NIC -+ +}; + +typedef struct _ADAPTER _adapter, ADAPTER,*PADAPTER; + +#include -+#include + +#ifdef CONFIG_80211N_HT +#include @@ -288426,25 +130186,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 +#include +#endif + ++#include +#include +#include +#include +#include +#include +#include -+ -+#ifdef CONFIG_BEAMFORMING -+#include -+#endif -+ +#include +#include +#include +#include +#include -+#include +#include -+#include "../hal/hal_dm.h" +#include +#include +#include @@ -288462,11 +130216,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 +#include +#include +#include -+#include -+ -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+#include -+#endif + +#ifdef CONFIG_P2P +#include @@ -288496,6 +130245,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 +#include +#endif // CONFIG_IOL + ++#ifdef CONFIG_BT_COEXIST ++#include ++#endif // CONFIG_BT_COEXIST ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++#include "ioctl_cfg80211.h" ++#endif //CONFIG_IOCTL_CFG80211 ++ +#include +#include +#include @@ -288503,10 +130260,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + +#include + -+#ifdef CONFIG_BT_COEXIST -+#include -+#endif // CONFIG_BT_COEXIST -+ +#define SPEC_DEV_ID_NONE BIT(0) +#define SPEC_DEV_ID_DISABLE_HT BIT(1) +#define SPEC_DEV_ID_ENABLE_PS BIT(2) @@ -288533,7 +130286,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + u8 network_mode; //infra, ad-hoc, auto + u8 channel;//ad-hoc support requirement + u8 wireless_mode;//A, B, G, auto -+ u8 scan_mode;//active, passive ++ u8 scan_mode;//active, passive + u8 radio_enable; + u8 preamble;//long, short, auto + u8 vrtl_carrier_sense;//Enable, Disable, Auto @@ -288545,13 +130298,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + u8 power_mgnt; + u8 ips_mode; + u8 smart_ps; -+ u8 usb_rxagg_mode; + u8 long_retry_lmt; + u8 short_retry_lmt; + u16 busy_thresh; + u8 ack_policy; + u8 mp_mode; -+ u8 mp_dm; + u8 software_encrypt; + u8 software_decrypt; + #ifdef CONFIG_TX_EARLY_MODE @@ -288576,7 +130327,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + // 0x21 means enable 2.4G 40MHz & 5G 80MHz + u8 bw_mode; + u8 ampdu_enable;//for tx -+ u8 rx_stbc; ++ u8 rx_stbc; + u8 ampdu_amsdu;//A-MPDU Supports A-MSDU is permitted + // Short GI support Bit Map + // BIT0 - 20MHz, 1: support, 0: non-support @@ -288584,20 +130335,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + // BIT2 - 80MHz, 1: support, 0: non-support + // BIT3 - 160MHz, 1: support, 0: non-support + u8 short_gi; ++#endif //CONFIG_80211N_HT ++ ++#ifdef CONFIG_80211AC_VHT ++ u8 vht_enable; ++ u8 ampdu_factor; ++ u8 vht_rate_sel; + // BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx + u8 ldpc_cap; + // BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx + u8 stbc_cap; + // BIT0: Enable VHT Beamformer, BIT1: Enable VHT Beamformee, BIT4: Enable HT Beamformer, BIT5: Enable HT Beamformee + u8 beamform_cap; -+ u8 beamformer_rf_num; -+ u8 beamformee_rf_num; -+#endif //CONFIG_80211N_HT -+ -+#ifdef CONFIG_80211AC_VHT -+ u8 vht_enable; //0:disable, 1:enable, 2:auto -+ u8 ampdu_factor; -+ u8 vht_rate_sel; +#endif //CONFIG_80211AC_VHT + + u8 lowrate_two_xmit; @@ -288606,21 +130355,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + u8 low_power ; + + u8 wifi_spec;// !turbo_mode -+ u8 special_rf_path; // 0: 2T2R ,1: only turn on path A 1T1R ++ + u8 channel_plan; +#ifdef CONFIG_BT_COEXIST + u8 btcoex; + u8 bt_iso; + u8 bt_sco; + u8 bt_ampdu; -+ s8 ant_num; +#endif -+ BOOLEAN bAcceptAddbaReq; ++ bool bAcceptAddbaReq; + + u8 antdiv_cfg; + u8 antdiv_type; -+ -+ u8 switch_usb_mode; + + u8 usbss_enable;//0:disable,1:enable + u8 hwpdn_mode;//0:disable,1:enable,2:decide by EFUSE config @@ -288640,6 +130386,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + u8 fw_iol; //enable iol without other concern +#endif + ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ u8 dmsp;//0:disable,1:enable ++#endif ++ +#ifdef CONFIG_80211D + u8 enable80211d; +#endif @@ -288653,96 +130403,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + u8 force_ant;//0 normal,1 main,2 aux + u8 force_igi;//0 normal +#endif -+ -+ /* for pll reference clock selction */ -+ u8 pll_ref_clk_sel; ++ u8 regulatory_tid; + + //define for tx power adjust ++ u32 RegTxPwrLimit; + u8 RegEnableTxPowerLimit; -+ u8 RegEnableTxPowerByRate; + u8 RegPowerBase; + u8 RegPwrTblSel; ++ u8 RegPwrByRate; + s8 TxBBSwing_2G; + s8 TxBBSwing_5G; + u8 AmplifierType_2G; + u8 AmplifierType_5G; + u8 bEn_RFE; + u8 RFE_Type; -+ u8 GLNA_Type; -+ u8 check_fw_ps; -+ u8 RegRfKFreeEnable; -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ u8 load_phy_file; -+ u8 RegDecryptCustomFile; -+#endif + +#ifdef CONFIG_MULTI_VIR_IFACES + u8 ext_iface_num;//primary/secondary iface is excluded +#endif -+ u8 qos_opt_enable; -+ -+ u8 hiq_filter; -+ u8 adaptivity_en; -+ u8 adaptivity_mode; -+ u8 adaptivity_dml; -+ u8 adaptivity_dc_backoff; -+ s8 adaptivity_th_l2h_ini; -+ s8 adaptivity_th_edcca_hl_diff; -+ -+ u8 boffefusemask; -+ BOOLEAN bFileMaskEfuse; -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ u8 acs_mode; -+ u8 acs_auto_scan; -+#endif +}; + + +//For registry parameters -+#define RGTRY_OFT(field) ((ULONG)FIELD_OFFSET(struct registry_priv,field)) ++#define RGTRY_OFT(field) ((u32)FIELD_OFFSET(struct registry_priv,field)) +#define RGTRY_SZ(field) sizeof(((struct registry_priv*) 0)->field) -+ -+#define GetRegAmplifierType2G(_Adapter) (_Adapter->registrypriv.AmplifierType_2G) -+#define GetRegAmplifierType5G(_Adapter) (_Adapter->registrypriv.AmplifierType_5G) -+ -+#define GetRegTxBBSwing_2G(_Adapter) (_Adapter->registrypriv.TxBBSwing_2G) -+#define GetRegTxBBSwing_5G(_Adapter) (_Adapter->registrypriv.TxBBSwing_5G) -+ -+#define GetRegbENRFEType(_Adapter) (_Adapter->registrypriv.bEn_RFE) -+#define GetRegRFEType(_Adapter) (_Adapter->registrypriv.RFE_Type) -+#define GetRegGLNAType(_Adapter) (_Adapter->registrypriv.GLNA_Type) -+ -+#define BSSID_OFT(field) ((ULONG)FIELD_OFFSET(WLAN_BSSID_EX,field)) ++#define BSSID_OFT(field) ((u32)FIELD_OFFSET(WLAN_BSSID_EX,field)) +#define BSSID_SZ(field) sizeof(((PWLAN_BSSID_EX) 0)->field) + ++#define MAX_CONTINUAL_URB_ERR 4 + -+ -+#ifdef CONFIG_SDIO_HCI -+#include -+#define INTF_DATA SDIO_DATA -+#elif defined(CONFIG_GSPI_HCI) -+#include -+#define INTF_DATA GSPI_DATA -+#elif defined(CONFIG_PCI_HCI) -+#include -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+#define is_primary_adapter(adapter) (adapter->adapter_type == PRIMARY_ADAPTER) -+#define is_vir_adapter(adapter) (adapter->adapter_type == MAX_ADAPTER) -+#define get_iface_type(adapter) (adapter->iface_type) -+#else -+#define is_primary_adapter(adapter) (1) -+#define is_vir_adapter(adapter) (0) -+#define get_iface_type(adapter) (IFACE_PORT0) -+#endif -+#define GET_PRIMARY_ADAPTER(padapter) (((_adapter *)padapter)->dvobj->padapters[IFACE_ID0]) ++#define GET_PRIMARY_ADAPTER(padapter) (((_adapter *)padapter)->dvobj->if1) +#define GET_IFACE_NUMS(padapter) (((_adapter *)padapter)->dvobj->iface_nums) +#define GET_ADAPTER(padapter, iface_id) (((_adapter *)padapter)->dvobj->padapters[iface_id]) + -+#define GetDefaultAdapter(padapter) padapter -+ +enum _IFACE_ID { + IFACE_ID0, //maping to PRIMARY_ADAPTER + IFACE_ID1, //maping to SECONDARY_ADAPTER @@ -288751,317 +130444,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + IFACE_ID_MAX, +}; + -+#ifdef CONFIG_DBG_COUNTER -+ -+struct rx_logs { -+ u32 intf_rx; -+ u32 intf_rx_err_recvframe; -+ u32 intf_rx_err_skb; -+ u32 intf_rx_report; -+ u32 core_rx; -+ u32 core_rx_pre; -+ u32 core_rx_pre_ver_err; -+ u32 core_rx_pre_mgmt; -+ u32 core_rx_pre_mgmt_err_80211w; -+ u32 core_rx_pre_mgmt_err; -+ u32 core_rx_pre_ctrl; -+ u32 core_rx_pre_ctrl_err; -+ u32 core_rx_pre_data; -+ u32 core_rx_pre_data_wapi_seq_err; -+ u32 core_rx_pre_data_wapi_key_err; -+ u32 core_rx_pre_data_handled; -+ u32 core_rx_pre_data_err; -+ u32 core_rx_pre_data_unknown; -+ u32 core_rx_pre_unknown; -+ u32 core_rx_enqueue; -+ u32 core_rx_dequeue; -+ u32 core_rx_post; -+ u32 core_rx_post_decrypt; -+ u32 core_rx_post_decrypt_wep; -+ u32 core_rx_post_decrypt_tkip; -+ u32 core_rx_post_decrypt_aes; -+ u32 core_rx_post_decrypt_wapi; -+ u32 core_rx_post_decrypt_hw; -+ u32 core_rx_post_decrypt_unknown; -+ u32 core_rx_post_decrypt_err; -+ u32 core_rx_post_defrag_err; -+ u32 core_rx_post_portctrl_err; -+ u32 core_rx_post_indicate; -+ u32 core_rx_post_indicate_in_oder; -+ u32 core_rx_post_indicate_reoder; -+ u32 core_rx_post_indicate_err; -+ u32 os_indicate; -+ u32 os_indicate_ap_mcast; -+ u32 os_indicate_ap_forward; -+ u32 os_indicate_ap_self; -+ u32 os_indicate_err; -+ u32 os_netif_ok; -+ u32 os_netif_err; -+}; -+ -+struct tx_logs { -+ u32 os_tx; -+ u32 os_tx_err_up; -+ u32 os_tx_err_xmit; -+ u32 os_tx_m2u; -+ u32 os_tx_m2u_ignore_fw_linked; -+ u32 os_tx_m2u_ignore_self; -+ u32 os_tx_m2u_entry; -+ u32 os_tx_m2u_entry_err_xmit; -+ u32 os_tx_m2u_entry_err_skb; -+ u32 os_tx_m2u_stop; -+ u32 core_tx; -+ u32 core_tx_err_pxmitframe; -+ u32 core_tx_err_brtx; -+ u32 core_tx_upd_attrib; -+ u32 core_tx_upd_attrib_adhoc; -+ u32 core_tx_upd_attrib_sta; -+ u32 core_tx_upd_attrib_ap; -+ u32 core_tx_upd_attrib_unknown; -+ u32 core_tx_upd_attrib_dhcp; -+ u32 core_tx_upd_attrib_icmp; -+ u32 core_tx_upd_attrib_active; -+ u32 core_tx_upd_attrib_err_ucast_sta; -+ u32 core_tx_upd_attrib_err_ucast_ap_link; -+ u32 core_tx_upd_attrib_err_sta; -+ u32 core_tx_upd_attrib_err_link; -+ u32 core_tx_upd_attrib_err_sec; -+ u32 core_tx_ap_enqueue_warn_fwstate; -+ u32 core_tx_ap_enqueue_warn_sta; -+ u32 core_tx_ap_enqueue_warn_nosta; -+ u32 core_tx_ap_enqueue_warn_link; -+ u32 core_tx_ap_enqueue_warn_trigger; -+ u32 core_tx_ap_enqueue_mcast; -+ u32 core_tx_ap_enqueue_ucast; -+ u32 core_tx_ap_enqueue; -+ u32 intf_tx; -+ u32 intf_tx_pending_ac; -+ u32 intf_tx_pending_fw_under_survey; -+ u32 intf_tx_pending_fw_under_linking; -+ u32 intf_tx_pending_xmitbuf; -+ u32 intf_tx_enqueue; -+ u32 core_tx_enqueue; -+ u32 core_tx_enqueue_class; -+ u32 core_tx_enqueue_class_err_sta; -+ u32 core_tx_enqueue_class_err_nosta; -+ u32 core_tx_enqueue_class_err_fwlink; -+ u32 intf_tx_direct; -+ u32 intf_tx_direct_err_coalesce; -+ u32 intf_tx_dequeue; -+ u32 intf_tx_dequeue_err_coalesce; -+ u32 intf_tx_dump_xframe; -+ u32 intf_tx_dump_xframe_err_txdesc; -+ u32 intf_tx_dump_xframe_err_port; -+}; -+ -+struct int_logs { -+ u32 all; -+ u32 err; -+ u32 tbdok; -+ u32 tbder; -+ u32 bcnderr; -+ u32 bcndma; -+ u32 bcndma_e; -+ u32 rx; -+ u32 rx_rdu; -+ u32 rx_fovw; -+ u32 txfovw; -+ u32 mgntok; -+ u32 highdok; -+ u32 bkdok; -+ u32 bedok; -+ u32 vidok; -+ u32 vodok; -+}; -+ -+#endif // CONFIG_DBG_COUNTER -+ -+struct debug_priv { -+ u32 dbg_sdio_free_irq_error_cnt; -+ u32 dbg_sdio_alloc_irq_error_cnt; -+ u32 dbg_sdio_free_irq_cnt; -+ u32 dbg_sdio_alloc_irq_cnt; -+ u32 dbg_sdio_deinit_error_cnt; -+ u32 dbg_sdio_init_error_cnt; -+ u32 dbg_suspend_error_cnt; -+ u32 dbg_suspend_cnt; -+ u32 dbg_resume_cnt; -+ u32 dbg_resume_error_cnt; -+ u32 dbg_deinit_fail_cnt; -+ u32 dbg_carddisable_cnt; -+ u32 dbg_carddisable_error_cnt; -+ u32 dbg_ps_insuspend_cnt; -+ u32 dbg_dev_unload_inIPS_cnt; -+ u32 dbg_wow_leave_ps_fail_cnt; -+ u32 dbg_scan_pwr_state_cnt; -+ u32 dbg_downloadfw_pwr_state_cnt; -+ u32 dbg_fw_read_ps_state_fail_cnt; -+ u32 dbg_leave_ips_fail_cnt; -+ u32 dbg_leave_lps_fail_cnt; -+ u32 dbg_h2c_leave32k_fail_cnt; -+ u32 dbg_diswow_dload_fw_fail_cnt; -+ u32 dbg_enwow_dload_fw_fail_cnt; -+ u32 dbg_ips_drvopen_fail_cnt; -+ u32 dbg_poll_fail_cnt; -+ u32 dbg_rpwm_toogle_cnt; -+ u32 dbg_rpwm_timeout_fail_cnt; -+ u32 dbg_sreset_cnt; -+ u64 dbg_rx_fifo_last_overflow; -+ u64 dbg_rx_fifo_curr_overflow; -+ u64 dbg_rx_fifo_diff_overflow; -+ u64 dbg_rx_ampdu_drop_count; -+ u64 dbg_rx_ampdu_forced_indicate_count; -+ u64 dbg_rx_ampdu_loss_count; -+ u64 dbg_rx_dup_mgt_frame_drop_count; -+ u64 dbg_rx_ampdu_window_shift_cnt; -+ u64 dbg_rx_conflic_mac_addr_cnt; -+}; -+ -+struct rtw_traffic_statistics { -+ // tx statistics -+ u64 tx_bytes; -+ u64 tx_pkts; -+ u64 tx_drop; -+ u64 cur_tx_bytes; -+ u64 last_tx_bytes; -+ u32 cur_tx_tp; // Tx throughput in MBps. -+ -+ // rx statistics -+ u64 rx_bytes; -+ u64 rx_pkts; -+ u64 rx_drop; -+ u64 cur_rx_bytes; -+ u64 last_rx_bytes; -+ u32 cur_rx_tp; // Rx throughput in MBps. -+}; -+ -+#define SEC_CAP_CHK_BMC BIT0 -+ -+#define SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH BIT0 -+ -+struct sec_cam_bmp { -+ u32 m0; -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ u32 m1; -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ u32 m2; -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ u32 m3; -+#endif -+}; -+ -+struct cam_ctl_t { -+ _lock lock; -+ -+ u8 sec_cap; -+ u32 flags; -+ -+ u8 num; -+ struct sec_cam_bmp used; -+ -+ _mutex sec_cam_access_mutex; -+}; -+ -+struct sec_cam_ent { -+ u16 ctrl; -+ u8 mac[ETH_ALEN]; -+ u8 key[16]; -+}; -+ -+#define KEY_FMT "%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" -+#define KEY_ARG(x) ((u8*)(x))[0],((u8*)(x))[1],((u8*)(x))[2],((u8*)(x))[3],((u8*)(x))[4],((u8*)(x))[5], \ -+ ((u8*)(x))[6],((u8*)(x))[7],((u8*)(x))[8],((u8*)(x))[9],((u8*)(x))[10],((u8*)(x))[11], \ -+ ((u8*)(x))[12],((u8*)(x))[13],((u8*)(x))[14],((u8*)(x))[15] -+ -+struct macid_bmp { -+ u32 m0; -+#if (MACID_NUM_SW_LIMIT > 32) -+ u32 m1; -+#endif -+#if (MACID_NUM_SW_LIMIT > 64) -+ u32 m2; -+#endif -+#if (MACID_NUM_SW_LIMIT > 96) -+ u32 m3; -+#endif -+}; -+ -+struct macid_ctl_t { -+ _lock lock; -+ u8 num; -+ struct macid_bmp used; -+ struct macid_bmp bmc; -+ struct macid_bmp if_g[IFACE_ID_MAX]; -+ struct macid_bmp ch_g[2]; /* 2 ch concurrency */ -+}; -+ -+struct rf_ctl_t { -+ #ifdef CONFIG_DFS_MASTER -+ bool radar_detect_by_sta_link; -+ bool pre_radar_detect_by_sta_link; -+ bool dfs_master_enabled; -+ -+ u8 radar_detect_ch; -+ u8 radar_detect_bw; -+ u8 radar_detect_offset; -+ u8 pre_radar_detect_ch; -+ u8 pre_radar_detect_bw; -+ u8 pre_radar_detect_offset; -+ -+ u32 cac_end_time; -+ -+ u8 dbg_dfs_master_fake_radar_detect_cnt; -+ u8 dbg_dfs_master_radar_detect_trigger_non; -+ u8 dbg_dfs_master_choose_dfs_ch_first; -+ #endif -+}; -+ -+#define RTW_CAC_STOPPED 0 -+#define IS_UNDER_CAC(rfctl) ((rfctl)->cac_end_time > rtw_get_current_time()) -+#define IS_CAC_STOPPED(rfctl) ((rfctl)->cac_end_time == RTW_CAC_STOPPED) -+ +struct dvobj_priv +{ -+ /*-------- below is common data --------*/ -+ u8 chip_type; -+ u8 HardwareType; -+ u8 interface_type;/*USB,SDIO,SPI,PCI*/ ++ _adapter *if1; //PRIMARY_ADAPTER ++ _adapter *if2; //SECONDARY_ADAPTER + -+ ATOMIC_T bSurpriseRemoved; -+ ATOMIC_T bDriverStopped; -+ -+ s32 processing_dev_remove; -+ -+ struct debug_priv drv_dbg; ++ //for local/global synchronization ++ // ++ _lock lock; ++ int macid[NUM_STA]; + + _mutex hw_init_mutex; + _mutex h2c_fwcmd_mutex; + _mutex setch_mutex; + _mutex setbw_mutex; -+ _mutex rf_read_reg_mutex; -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ _mutex sd_indirect_access_mutex; -+#endif + + unsigned char oper_channel; //saved channel info when call set_channel_bw + unsigned char oper_bwmode; + unsigned char oper_ch_offset;//PRIME_CHNL_OFFSET -+ u32 on_oper_ch_time; + + //extend to support mulitu interface -+ /*padapters[IFACE_ID0] == if1 - PRIMARY_ADAPTER*/ -+ /*padapters[IFACE_ID1] == if2 - SECONDARY_ADAPTER*/ ++ //padapters[IFACE_ID0] == if1 ++ //padapters[IFACE_ID1] == if2 + _adapter *padapters[IFACE_ID_MAX]; + u8 iface_nums; // total number of ifaces used runtime + -+ struct macid_ctl_t macid_ctl; -+ -+ struct cam_ctl_t cam_ctl; -+ struct sec_cam_ent cam_cache[SEC_CAM_ENT_NUM_SW_LIMIT]; -+ -+ struct rf_ctl_t rf_ctl; + + //For 92D, DMDP have 2 interface. + u8 InterfaceNumber; @@ -289069,21 +130476,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + + //In /Out Pipe information + int RtInPipe[2]; -+ int RtOutPipe[4]; ++ int RtOutPipe[3]; + u8 Queue2Pipe[HW_QUEUE_ENTRY];//for out pipe mapping + + u8 irq_alloc; -+ ATOMIC_T continual_io_error; -+ -+ ATOMIC_T disable_func; -+ -+ struct pwrctrl_priv pwrctl_priv; -+ -+ struct rtw_traffic_statistics traffic_stat; -+ -+#if defined(CONFIG_IOCTL_CFG80211) && defined(RTW_SINGLE_WIPHY) -+ struct wiphy *wiphy; -+#endif + +/*-------- below is for SDIO INTERFACE --------*/ + @@ -289093,8 +130489,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + +/*-------- below is for USB INTERFACE --------*/ + -+#ifdef CONFIG_USB_HCI -+ + u8 usb_speed; // 1.1, 2.0 or 3.0 + u8 nr_endpoint; + u8 RtNumInPipes; @@ -289114,116 +130508,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + u8 * usb_vendor_req_buf; +#endif + -+#ifdef PLATFORM_WINDOWS -+ //related device objects -+ PDEVICE_OBJECT pphysdevobj;//pPhysDevObj; -+ PDEVICE_OBJECT pfuncdevobj;//pFuncDevObj; -+ PDEVICE_OBJECT pnextdevobj;//pNextDevObj; -+ -+ u8 nextdevstacksz;//unsigned char NextDeviceStackSize; //= (CHAR)CEdevice->pUsbDevObj->StackSize + 1; -+ -+ //urb for control diescriptor request -+ -+#ifdef PLATFORM_OS_XP -+ struct _URB_CONTROL_DESCRIPTOR_REQUEST descriptor_urb; -+ PUSB_CONFIGURATION_DESCRIPTOR pconfig_descriptor;//UsbConfigurationDescriptor; -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ WCHAR active_path[MAX_ACTIVE_REG_PATH]; // adapter regpath -+ USB_EXTENSION usb_extension; -+ -+ _nic_hdl pipehdls_r8192c[0x10]; -+#endif -+ -+ u32 config_descriptor_len;//ULONG UsbConfigurationDescriptorLength; -+#endif//PLATFORM_WINDOWS -+ -+#ifdef PLATFORM_LINUX + struct usb_interface *pusbintf; + struct usb_device *pusbdev; -+#endif//PLATFORM_LINUX + -+#ifdef PLATFORM_FREEBSD -+ struct usb_interface *pusbintf; -+ struct usb_device *pusbdev; -+#endif//PLATFORM_FREEBSD -+ -+#endif//CONFIG_USB_HCI -+ -+/*-------- below is for PCIE INTERFACE --------*/ -+ -+#ifdef CONFIG_PCI_HCI -+ -+#ifdef PLATFORM_LINUX -+ struct pci_dev *ppcidev; -+ -+ //PCI MEM map -+ unsigned long pci_mem_end; /* shared mem end */ -+ unsigned long pci_mem_start; /* shared mem start */ -+ -+ //PCI IO map -+ unsigned long pci_base_addr; /* device I/O address */ -+ -+ //PciBridge -+ struct pci_priv pcipriv; -+ -+ unsigned int irq; /* get from pci_dev.irq, store to net_device.irq */ -+ u16 irqline; -+ u8 irq_enabled; -+ RT_ISR_CONTENT isr_content; -+ _lock irq_th_lock; -+ -+ //ASPM -+ u8 const_pci_aspm; -+ u8 const_amdpci_aspm; -+ u8 const_hwsw_rfoff_d3; -+ u8 const_support_pciaspm; -+ // pci-e bridge */ -+ u8 const_hostpci_aspm_setting; -+ // pci-e device */ -+ u8 const_devicepci_aspm_setting; -+ u8 b_support_aspm; // If it supports ASPM, Offset[560h] = 0x40, otherwise Offset[560h] = 0x00. -+ u8 b_support_backdoor; -+ u8 bdma64; -+#endif//PLATFORM_LINUX -+ -+#endif//CONFIG_PCI_HCI ++ ATOMIC_T continual_urb_error; +}; + -+#define dvobj_to_pwrctl(dvobj) (&(dvobj->pwrctl_priv)) -+#define pwrctl_to_dvobj(pwrctl) container_of(pwrctl, struct dvobj_priv, pwrctl_priv) -+#define dvobj_to_macidctl(dvobj) (&(dvobj->macid_ctl)) -+#define dvobj_to_regsty(dvobj) (&(dvobj->padapters[IFACE_ID0]->registrypriv)) -+#if defined(CONFIG_IOCTL_CFG80211) && defined(RTW_SINGLE_WIPHY) -+#define dvobj_to_wiphy(dvobj) ((dvobj)->wiphy) -+#endif -+#define dvobj_to_rfctl(dvobj) (&(dvobj->rf_ctl)) -+#define rfctl_to_dvobj(rfctl) container_of((rfctl), struct dvobj_priv, rf_ctl) -+ -+#ifdef PLATFORM_LINUX +static struct device *dvobj_to_dev(struct dvobj_priv *dvobj) +{ + /* todo: get interface type from dvobj and the return the dev accordingly */ -+#ifdef RTW_DVOBJ_CHIP_HW_TYPE -+#endif + -+#ifdef CONFIG_USB_HCI + return &dvobj->pusbintf->dev; -+#endif -+#ifdef CONFIG_SDIO_HCI -+ return &dvobj->intf_data.func->dev; -+#endif -+#ifdef CONFIG_GSPI_HCI -+ return &dvobj->intf_data.func->dev; -+#endif -+#ifdef CONFIG_PCI_HCI -+ return &dvobj->ppcidev->dev; -+#endif +} -+#endif -+ -+_adapter *dvobj_get_port0_adapter(struct dvobj_priv *dvobj); + +enum _IFACE_TYPE { + IFACE_PORT0, //mapping to port0 for C/D series chips @@ -289276,6 +130572,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + int DriverState;// for disable driver using module, use dongle to replace module. + int pid[3];//process id from UI, 0:wps, 1:hostapd, 2:dhcpcd + int bDongle;//build-in module or external dongle ++ u16 chip_type; ++ u16 HardwareType; ++ u16 interface_type;//USB,SDIO,SPI,PCI + + struct dvobj_priv *dvobj; + struct mlme_priv mlmepriv; @@ -289283,14 +130582,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + struct cmd_priv cmdpriv; + struct evt_priv evtpriv; + //struct io_queue *pio_queue; -+ struct io_priv iopriv; ++ struct io_priv iopriv; + struct xmit_priv xmitpriv; + struct recv_priv recvpriv; + struct sta_priv stapriv; + struct security_priv securitypriv; -+ _lock security_key_mutex; // add for CONFIG_IEEE80211W, none 11w also can use -+ struct registry_priv registrypriv; -+ ++ struct registry_priv registrypriv; ++ struct pwrctrl_priv pwrctrlpriv; ++ struct eeprom_priv eeprompriv; + struct led_priv ledpriv; + +#ifdef CONFIG_MP_INCLUDED @@ -289329,64 +130628,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + struct wifi_display_info wfd_info; +#endif //CONFIG_WFD + -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ struct bt_coex_info coex_info; -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+ -+ ERROR_CODE LastError; /* <20130613, Kordan> Only the functions associated with MP records the error code by now. */ -+ -+ PVOID HalData; ++ void * HalData; + u32 hal_data_sz; + struct hal_ops HalFunc; + ++ s32 bDriverStopped; ++ s32 bSurpriseRemoved; ++ s32 bCardDisableWOHSM; ++ + u32 IsrContent; + u32 ImrContent; + + u8 EepromAddressSize; ++ u8 hw_init_completed; + u8 bDriverIsGoingToUnload; + u8 init_adpt_in_progress; + u8 bHaltInProgress; -+#ifdef CONFIG_GPIO_API -+ u8 pre_gpio_pin; -+ struct gpio_int_priv { -+ u8 interrupt_mode; -+ u8 interrupt_enable_mask; -+ void (*callback[8])(u8 level); -+ }gpiointpriv; -+#endif ++ + _thread_hdl_ cmdThread; + _thread_hdl_ evtThread; + _thread_hdl_ xmitThread; + _thread_hdl_ recvThread; + -+#ifndef PLATFORM_LINUX -+ NDIS_STATUS (*dvobj_init)(struct dvobj_priv *dvobj); -+ void (*dvobj_deinit)(struct dvobj_priv *dvobj); -+#endif -+ -+ u32 (*intf_init)(struct dvobj_priv *dvobj); -+ void (*intf_deinit)(struct dvobj_priv *dvobj); -+ int (*intf_alloc_irq)(struct dvobj_priv *dvobj); -+ void (*intf_free_irq)(struct dvobj_priv *dvobj); -+ -+ + void (*intf_start)(_adapter * adapter); + void (*intf_stop)(_adapter * adapter); + -+#ifdef PLATFORM_WINDOWS -+ _nic_hdl hndis_adapter;//hNdisAdapter(NDISMiniportAdapterHandle); -+ _nic_hdl hndis_config;//hNdisConfiguration; -+ NDIS_STRING fw_img; -+ -+ u32 NdisPacketFilter; -+ u8 MCList[MAX_MCAST_LIST_NUM][6]; -+ u32 MCAddrCount; -+#endif //end of PLATFORM_WINDOWS -+ -+ -+#ifdef PLATFORM_LINUX + _nic_hdl pnetdev; -+ char old_ifname[IFNAMSIZ]; + + // used by rtw_rereg_nd_name related function + struct rereg_nd_name_data { @@ -289396,39 +130663,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + u8 old_bRegUseLed; + } rereg_nd_name_priv; + -+ u8 ndev_unregistering; + int bup; + struct net_device_stats stats; + struct iw_statistics iwstats; + struct proc_dir_entry *dir_dev;// for proc directory -+ struct proc_dir_entry *dir_odm; + +#ifdef CONFIG_IOCTL_CFG80211 + struct wireless_dev *rtw_wdev; -+ struct rtw_wdev_priv wdev_data; -+ -+ #if !defined(RTW_SINGLE_WIPHY) -+ struct wiphy *wiphy; -+ #endif -+ -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ _nic_hdl pifp; -+ int bup; -+ _lock glock; -+#endif //PLATFORM_FREEBSD -+ u8 mac_addr[ETH_ALEN]; ++#endif //CONFIG_IOCTL_CFG80211 + int net_closed; -+ -+ u8 netif_up; + + u8 bFWReady; + u8 bBTFWReady; ++ u8 bReadPortCancel; ++ u8 bWritePortCancel; + u8 bLinkInfoDump; -+ u8 bRxRSSIDisplay; + // Added by Albert 2012/10/26 + // The driver will show up the desired channel number when this flag is 1. + u8 bNotifyChannelChange; @@ -289449,7 +130698,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + //for PRIMARY_ADAPTER(IFACE_ID0) can directly refer to if1 in struct dvobj_priv + _adapter *pbuddy_adapter; + -+#if defined(CONFIG_CONCURRENT_MODE) ++#if defined(CONFIG_CONCURRENT_MODE) || defined(CONFIG_DUALMAC_CONCURRENT) + u8 isprimary; //is primary adapter or not + //notes: + // if isprimary is true, the adapter_type value is 0, iface_id is IFACE_ID0 for PRIMARY_ADAPTER @@ -289457,13 +130706,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + // refer to iface_id if iface_nums>2 and isprimary is false and the adapter_type value is 0xff. + u8 adapter_type;//used only in two inteface case(PRIMARY_ADAPTER and SECONDARY_ADAPTER) . + u8 iface_type; //interface port type, it depends on HW port -+#endif //CONFIG_CONCURRENT_MODE ++#endif //CONFIG_CONCURRENT_MODE || CONFIG_DUALMAC_CONCURRENT + + //extend to support multi interface + //IFACE_ID0 is equals to PRIMARY_ADAPTER + //IFACE_ID1 is equals to SECONDARY_ADAPTER + u8 iface_id; + ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ u8 DualMacConcurrent; // 1: DMSP 0:DMDP ++#endif ++ +#ifdef CONFIG_BR_EXT + _lock br_ext_lock; + //unsigned int macclone_completed; @@ -289490,157 +130743,54 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types.h linux/3rdparty/rtl88 + PLOOPBACKDATA ploopback; +#endif + -+ //for debug purpose -+ u8 fix_rate; -+ u8 data_fb; /* data rate fallback, valid only when fix_rate is not 0xff */ -+ u8 driver_vcs_en; //Enable=1, Disable=0 driver control vrtl_carrier_sense for tx -+ u8 driver_vcs_type;//force 0:disable VCS, 1:RTS-CTS, 2:CTS-to-self when vcs_en=1. -+ u8 driver_ampdu_spacing;//driver control AMPDU Density for peer sta's rx -+ u8 driver_rx_ampdu_factor;//0xff: disable drv ctrl, 0:8k, 1:16k, 2:32k, 3:64k; -+ u8 driver_rx_ampdu_spacing; //driver control Rx AMPDU Density -+ u8 fix_rx_ampdu_accept; -+ u8 fix_rx_ampdu_size; /* 0~127, TODO:consider each sta and each TID */ -+ unsigned char in_cta_test; -+#ifdef DBG_RX_COUNTER_DUMP -+ u8 dump_rx_cnt_mode;/*BIT0:drv,BIT1:mac,BIT2:phy*/ -+ u32 drv_rx_cnt_ok; -+ u32 drv_rx_cnt_crcerror; -+ u32 drv_rx_cnt_drop; -+#endif ++ u8 fix_rate; ++ ++ unsigned char in_cta_test; + -+#ifdef CONFIG_DBG_COUNTER -+ struct rx_logs rx_logs; -+ struct tx_logs tx_logs; -+ struct int_logs int_logs; -+#endif +}; + +#define adapter_to_dvobj(adapter) (adapter->dvobj) -+#define adapter_to_pwrctl(adapter) (dvobj_to_pwrctl(adapter->dvobj)) -+#define adapter_wdev_data(adapter) (&((adapter)->wdev_data)) -+#if defined(RTW_SINGLE_WIPHY) -+#define adapter_to_wiphy(adapter) dvobj_to_wiphy(adapter_to_dvobj(adapter)) -+#else -+#define adapter_to_wiphy(adapter) ((adapter)->wiphy) -+#endif + -+#define adapter_to_rfctl(adapter) dvobj_to_rfctl(adapter_to_dvobj((adapter))) ++int rtw_handle_dualmac(_adapter *adapter, bool init); + -+#define adapter_mac_addr(adapter) (adapter->mac_addr) -+ -+#define rtw_get_chip_type(adapter) (((PADAPTER)adapter)->dvobj->chip_type) -+#define rtw_get_hw_type(adapter) (((PADAPTER)adapter)->dvobj->HardwareType) -+#define rtw_get_intf_type(adapter) (((PADAPTER)adapter)->dvobj->interface_type) -+ -+static inline void rtw_set_surprise_removed(_adapter *padapter) ++__inline static u8 *myid(struct eeprom_priv *peepriv) +{ -+ ATOMIC_SET(&adapter_to_dvobj(padapter)->bSurpriseRemoved, _TRUE); ++ return (peepriv->mac_addr); +} -+static inline void rtw_clr_surprise_removed(_adapter *padapter) -+{ -+ ATOMIC_SET(&adapter_to_dvobj(padapter)->bSurpriseRemoved, _FALSE); -+} -+static inline void rtw_set_drv_stopped(_adapter *padapter) -+{ -+ ATOMIC_SET(&adapter_to_dvobj(padapter)->bDriverStopped, _TRUE); -+} -+static inline void rtw_clr_drv_stopped(_adapter *padapter) -+{ -+ ATOMIC_SET(&adapter_to_dvobj(padapter)->bDriverStopped, _FALSE); -+} -+#define rtw_is_surprise_removed(padapter) (ATOMIC_READ(&adapter_to_dvobj(padapter)->bSurpriseRemoved) == _TRUE) -+#define rtw_is_drv_stopped(padapter) (ATOMIC_READ(&adapter_to_dvobj(padapter)->bDriverStopped) == _TRUE) -+ -+// -+// Function disabled. -+// -+#define DF_TX_BIT BIT0 /*write_port_cancel*/ -+#define DF_RX_BIT BIT1 /*read_port_cancel*/ -+#define DF_IO_BIT BIT2 -+ -+//#define RTW_DISABLE_FUNC(padapter, func) (ATOMIC_ADD(&adapter_to_dvobj(padapter)->disable_func, (func))) -+//#define RTW_ENABLE_FUNC(padapter, func) (ATOMIC_SUB(&adapter_to_dvobj(padapter)->disable_func, (func))) -+__inline static void RTW_DISABLE_FUNC(_adapter*padapter, int func_bit) -+{ -+ int df = ATOMIC_READ(&adapter_to_dvobj(padapter)->disable_func); -+ df |= func_bit; -+ ATOMIC_SET(&adapter_to_dvobj(padapter)->disable_func, df); -+} -+ -+__inline static void RTW_ENABLE_FUNC(_adapter*padapter, int func_bit) -+{ -+ int df = ATOMIC_READ(&adapter_to_dvobj(padapter)->disable_func); -+ df &= ~(func_bit); -+ ATOMIC_SET(&adapter_to_dvobj(padapter)->disable_func, df); -+} -+ -+#define RTW_CANNOT_RUN(padapter) \ -+ (rtw_is_surprise_removed(padapter) || \ -+ rtw_is_drv_stopped(padapter)) -+ -+#define RTW_IS_FUNC_DISABLED(padapter, func_bit) (ATOMIC_READ(&adapter_to_dvobj(padapter)->disable_func) & (func_bit)) -+ -+#define RTW_CANNOT_IO(padapter) \ -+ (rtw_is_surprise_removed(padapter) || \ -+ RTW_IS_FUNC_DISABLED((padapter), DF_IO_BIT)) -+ -+#define RTW_CANNOT_RX(padapter) \ -+ (RTW_CANNOT_RUN(padapter) || \ -+ RTW_IS_FUNC_DISABLED((padapter), DF_RX_BIT)) -+ -+#define RTW_CANNOT_TX(padapter) \ -+ (RTW_CANNOT_RUN(padapter) || \ -+ RTW_IS_FUNC_DISABLED((padapter), DF_TX_BIT)) -+ -+#ifdef CONFIG_PNO_SUPPORT -+int rtw_parse_ssid_list_tlv(char** list_str, pno_ssid_t* ssid, int max, int *bytes_left); -+int rtw_dev_pno_set(struct net_device *net, pno_ssid_t* ssid, int num, -+ int pno_time, int pno_repeat, int pno_freq_expo_max); -+#ifdef CONFIG_PNO_SET_DEBUG -+void rtw_dev_pno_debug(struct net_device *net); -+#endif //CONFIG_PNO_SET_DEBUG -+#endif //CONFIG_PNO_SUPPORT -+ -+#ifdef CONFIG_WOWLAN -+int rtw_suspend_wow(_adapter *padapter); -+int rtw_resume_process_wow(_adapter *padapter); -+#endif + +// HCI Related header file -+#ifdef CONFIG_USB_HCI +#include +#include +#include -+#endif + -+#ifdef CONFIG_SDIO_HCI -+#include -+#include -+#include -+#endif ++extern int rtw_mc2u_disable; ++extern char *rtw_initmac; ++extern int rtw_ht_enable; ++extern int rtw_ampdu_enable; ++extern int rtw_bw_mode; + -+#ifdef CONFIG_GSPI_HCI -+#include -+#include -+#include -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+#include -+#include -+#include -+#endif ++void netdev_br_init(struct net_device *netdev); ++int pm_netdev_open(struct net_device *pnetdev,u8 bnormal); ++void rtw_indicate_wx_assoc_event(_adapter *padapter); ++void rtw_indicate_wx_disassoc_event(_adapter *padapter); ++void indicate_wx_scan_complete_event(_adapter *padapter); ++u8 rtw_do_join(_adapter * padapter); ++int nat25_handle_frame(_adapter *priv, struct sk_buff *skb); ++void *scdb_findEntry(_adapter *priv, unsigned char *macAddr, unsigned char *ipAddr); ++void dhcp_flag_bcast(_adapter *priv, struct sk_buff *skb); ++int nat25_db_handle(_adapter *priv, struct sk_buff *skb, int method); ++void nat25_db_expire(_adapter *priv); ++int rtw_change_ifname(_adapter *padapter, const char *ifname); + +#endif //__DRV_TYPES_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types_linux.h linux/3rdparty/rtl8812au/include/drv_types_linux.h ---- linux.old/3rdparty/rtl8812au/include/drv_types_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/drv_types_linux.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,25 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/drv_types_linux.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/drv_types_linux.h +--- linux-4.14.17/3rdparty/rtl8812au/include/drv_types_linux.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/drv_types_linux.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,19 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -289650,388 +130800,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types_linux.h linux/3rdparty + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __DRV_TYPES_LINUX_H__ +#define __DRV_TYPES_LINUX_H__ + + +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types_pci.h linux/3rdparty/rtl8812au/include/drv_types_pci.h ---- linux.old/3rdparty/rtl8812au/include/drv_types_pci.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/drv_types_pci.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,273 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __DRV_TYPES_PCI_H__ -+#define __DRV_TYPES_PCI_H__ -+ -+ -+#ifdef PLATFORM_LINUX -+#include -+#endif -+ -+ -+#define INTEL_VENDOR_ID 0x8086 -+#define SIS_VENDOR_ID 0x1039 -+#define ATI_VENDOR_ID 0x1002 -+#define ATI_DEVICE_ID 0x7914 -+#define AMD_VENDOR_ID 0x1022 -+ -+#define PCI_MAX_BRIDGE_NUMBER 255 -+#define PCI_MAX_DEVICES 32 -+#define PCI_MAX_FUNCTION 8 -+ -+#define PCI_CONF_ADDRESS 0x0CF8 // PCI Configuration Space Address -+#define PCI_CONF_DATA 0x0CFC // PCI Configuration Space Data -+ -+#define PCI_CLASS_BRIDGE_DEV 0x06 -+#define PCI_SUBCLASS_BR_PCI_TO_PCI 0x04 -+ -+#define PCI_CAPABILITY_ID_PCI_EXPRESS 0x10 -+ -+#define U1DONTCARE 0xFF -+#define U2DONTCARE 0xFFFF -+#define U4DONTCARE 0xFFFFFFFF -+ -+#define PCI_VENDER_ID_REALTEK 0x10ec -+ -+#define HAL_HW_PCI_8180_DEVICE_ID 0x8180 -+#define HAL_HW_PCI_8185_DEVICE_ID 0x8185 //8185 or 8185b -+#define HAL_HW_PCI_8188_DEVICE_ID 0x8188 //8185b -+#define HAL_HW_PCI_8198_DEVICE_ID 0x8198 //8185b -+#define HAL_HW_PCI_8190_DEVICE_ID 0x8190 //8190 -+#define HAL_HW_PCI_8723E_DEVICE_ID 0x8723 //8723E -+#define HAL_HW_PCI_8192_DEVICE_ID 0x8192 //8192 PCI-E -+#define HAL_HW_PCI_8192SE_DEVICE_ID 0x8192 //8192 SE -+#define HAL_HW_PCI_8174_DEVICE_ID 0x8174 //8192 SE -+#define HAL_HW_PCI_8173_DEVICE_ID 0x8173 //8191 SE Crab -+#define HAL_HW_PCI_8172_DEVICE_ID 0x8172 //8191 SE RE -+#define HAL_HW_PCI_8171_DEVICE_ID 0x8171 //8191 SE Unicron -+#define HAL_HW_PCI_0045_DEVICE_ID 0x0045 //8190 PCI for Ceraga -+#define HAL_HW_PCI_0046_DEVICE_ID 0x0046 //8190 Cardbus for Ceraga -+#define HAL_HW_PCI_0044_DEVICE_ID 0x0044 //8192e PCIE for Ceraga -+#define HAL_HW_PCI_0047_DEVICE_ID 0x0047 //8192e Express Card for Ceraga -+#define HAL_HW_PCI_700F_DEVICE_ID 0x700F -+#define HAL_HW_PCI_701F_DEVICE_ID 0x701F -+#define HAL_HW_PCI_DLINK_DEVICE_ID 0x3304 -+#define HAL_HW_PCI_8188EE_DEVICE_ID 0x8179 -+ -+#define HAL_MEMORY_MAPPED_IO_RANGE_8190PCI 0x1000 //8190 support 16 pages of IO registers -+#define HAL_HW_PCI_REVISION_ID_8190PCI 0x00 -+#define HAL_MEMORY_MAPPED_IO_RANGE_8192PCIE 0x4000 //8192 support 16 pages of IO registers -+#define HAL_HW_PCI_REVISION_ID_8192PCIE 0x01 -+#define HAL_MEMORY_MAPPED_IO_RANGE_8192SE 0x4000 //8192 support 16 pages of IO registers -+#define HAL_HW_PCI_REVISION_ID_8192SE 0x10 -+#define HAL_HW_PCI_REVISION_ID_8192CE 0x1 -+#define HAL_MEMORY_MAPPED_IO_RANGE_8192CE 0x4000 //8192 support 16 pages of IO registers -+#define HAL_HW_PCI_REVISION_ID_8192DE 0x0 -+#define HAL_MEMORY_MAPPED_IO_RANGE_8192DE 0x4000 //8192 support 16 pages of IO registers -+ -+enum pci_bridge_vendor { -+ PCI_BRIDGE_VENDOR_INTEL = 0x0,//0b'0000,0001 -+ PCI_BRIDGE_VENDOR_ATI, //= 0x02,//0b'0000,0010 -+ PCI_BRIDGE_VENDOR_AMD, //= 0x04,//0b'0000,0100 -+ PCI_BRIDGE_VENDOR_SIS ,//= 0x08,//0b'0000,1000 -+ PCI_BRIDGE_VENDOR_UNKNOWN, //= 0x40,//0b'0100,0000 -+ PCI_BRIDGE_VENDOR_MAX ,//= 0x80 -+} ; -+ -+// copy this data structor defination from MSDN SDK -+typedef struct _PCI_COMMON_CONFIG { -+ u16 VendorID; -+ u16 DeviceID; -+ u16 Command; -+ u16 Status; -+ u8 RevisionID; -+ u8 ProgIf; -+ u8 SubClass; -+ u8 BaseClass; -+ u8 CacheLineSize; -+ u8 LatencyTimer; -+ u8 HeaderType; -+ u8 BIST; -+ -+ union { -+ struct _PCI_HEADER_TYPE_0 { -+ u32 BaseAddresses[6]; -+ u32 CIS; -+ u16 SubVendorID; -+ u16 SubSystemID; -+ u32 ROMBaseAddress; -+ u8 CapabilitiesPtr; -+ u8 Reserved1[3]; -+ u32 Reserved2; -+ -+ u8 InterruptLine; -+ u8 InterruptPin; -+ u8 MinimumGrant; -+ u8 MaximumLatency; -+ } type0; -+#if 0 -+ struct _PCI_HEADER_TYPE_1 { -+ ULONG BaseAddresses[PCI_TYPE1_ADDRESSES]; -+ UCHAR PrimaryBusNumber; -+ UCHAR SecondaryBusNumber; -+ UCHAR SubordinateBusNumber; -+ UCHAR SecondaryLatencyTimer; -+ UCHAR IOBase; -+ UCHAR IOLimit; -+ USHORT SecondaryStatus; -+ USHORT MemoryBase; -+ USHORT MemoryLimit; -+ USHORT PrefetchableMemoryBase; -+ USHORT PrefetchableMemoryLimit; -+ ULONG PrefetchableMemoryBaseUpper32; -+ ULONG PrefetchableMemoryLimitUpper32; -+ USHORT IOBaseUpper; -+ USHORT IOLimitUpper; -+ ULONG Reserved2; -+ ULONG ExpansionROMBase; -+ UCHAR InterruptLine; -+ UCHAR InterruptPin; -+ USHORT BridgeControl; -+ } type1; -+ -+ struct _PCI_HEADER_TYPE_2 { -+ ULONG BaseAddress; -+ UCHAR CapabilitiesPtr; -+ UCHAR Reserved2; -+ USHORT SecondaryStatus; -+ UCHAR PrimaryBusNumber; -+ UCHAR CardbusBusNumber; -+ UCHAR SubordinateBusNumber; -+ UCHAR CardbusLatencyTimer; -+ ULONG MemoryBase0; -+ ULONG MemoryLimit0; -+ ULONG MemoryBase1; -+ ULONG MemoryLimit1; -+ USHORT IOBase0_LO; -+ USHORT IOBase0_HI; -+ USHORT IOLimit0_LO; -+ USHORT IOLimit0_HI; -+ USHORT IOBase1_LO; -+ USHORT IOBase1_HI; -+ USHORT IOLimit1_LO; -+ USHORT IOLimit1_HI; -+ UCHAR InterruptLine; -+ UCHAR InterruptPin; -+ USHORT BridgeControl; -+ USHORT SubVendorID; -+ USHORT SubSystemID; -+ ULONG LegacyBaseAddress; -+ UCHAR Reserved3[56]; -+ ULONG SystemControl; -+ UCHAR MultiMediaControl; -+ UCHAR GeneralStatus; -+ UCHAR Reserved4[2]; -+ UCHAR GPIO0Control; -+ UCHAR GPIO1Control; -+ UCHAR GPIO2Control; -+ UCHAR GPIO3Control; -+ ULONG IRQMuxRouting; -+ UCHAR RetryStatus; -+ UCHAR CardControl; -+ UCHAR DeviceControl; -+ UCHAR Diagnostic; -+ } type2; -+#endif -+ } u; -+ -+ u8 DeviceSpecific[108]; -+} PCI_COMMON_CONFIG , *PPCI_COMMON_CONFIG; -+ -+typedef struct _RT_PCI_CAPABILITIES_HEADER { -+ u8 CapabilityID; -+ u8 Next; -+} RT_PCI_CAPABILITIES_HEADER, *PRT_PCI_CAPABILITIES_HEADER; -+ -+struct pci_priv{ -+ BOOLEAN pci_clk_req; -+ -+ u8 pciehdr_offset; -+ // PCIeCap is only differece between B-cut and C-cut. -+ // Configuration Space offset 72[7:4] -+ // 0: A/B cut -+ // 1: C cut and later. -+ u8 pcie_cap; -+ u8 linkctrl_reg; -+ -+ u8 busnumber; -+ u8 devnumber; -+ u8 funcnumber; -+ -+ u8 pcibridge_busnum; -+ u8 pcibridge_devnum; -+ u8 pcibridge_funcnum; -+ u8 pcibridge_vendor; -+ u16 pcibridge_vendorid; -+ u16 pcibridge_deviceid; -+ u8 pcibridge_pciehdr_offset; -+ u8 pcibridge_linkctrlreg; -+ -+ u8 amd_l1_patch; -+}; -+ -+typedef struct _RT_ISR_CONTENT -+{ -+ union{ -+ u32 IntArray[2]; -+ u32 IntReg4Byte; -+ u16 IntReg2Byte; -+ }; -+}RT_ISR_CONTENT, *PRT_ISR_CONTENT; -+ -+//#define RegAddr(addr) (addr + 0xB2000000UL) -+//some platform macros will def here -+static inline void NdisRawWritePortUlong(u32 port, u32 val) -+{ -+ outl(val, port); -+ //writel(val, (u8 *)RegAddr(port)); -+} -+ -+static inline void NdisRawWritePortUchar(u32 port, u8 val) -+{ -+ outb(val, port); -+ //writeb(val, (u8 *)RegAddr(port)); -+} -+ -+static inline void NdisRawReadPortUchar(u32 port, u8 *pval) -+{ -+ *pval = inb(port); -+ //*pval = readb((u8 *)RegAddr(port)); -+} -+ -+static inline void NdisRawReadPortUshort(u32 port, u16 *pval) -+{ -+ *pval = inw(port); -+ //*pval = readw((u8 *)RegAddr(port)); -+} -+ -+static inline void NdisRawReadPortUlong(u32 port, u32 *pval) -+{ -+ *pval = inl(port); -+ //*pval = readl((u8 *)RegAddr(port)); -+} -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types_sdio.h linux/3rdparty/rtl8812au/include/drv_types_sdio.h ---- linux.old/3rdparty/rtl8812au/include/drv_types_sdio.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/drv_types_sdio.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,81 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __DRV_TYPES_SDIO_H__ -+#define __DRV_TYPES_SDIO_H__ -+ -+// SDIO Header Files -+#ifdef PLATFORM_LINUX -+ #include -+ #include -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_PLATFORM_SPRD) -+ #include -+ #include -+#endif -+ -+#ifdef CONFIG_PLATFORM_SPRD -+ #include -+ #include -+#endif // CONFIG_PLATFORM_SPRD -+#endif -+ -+#ifdef PLATFORM_OS_XP -+#include -+#include -+#endif -+ -+#ifdef PLATFORM_OS_CE -+#include -+#endif -+ -+ -+typedef struct sdio_data -+{ -+ u8 func_number; -+ -+ u8 tx_block_mode; -+ u8 rx_block_mode; -+ u32 block_transfer_len; -+ -+#ifdef PLATFORM_LINUX -+ struct sdio_func *func; -+ _thread_hdl_ sys_sdio_irq_thd; -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ PDEVICE_OBJECT pphysdevobj; -+ PDEVICE_OBJECT pfuncdevobj; -+ PDEVICE_OBJECT pnextdevobj; -+ SDBUS_INTERFACE_STANDARD sdbusinft; -+ u8 nextdevstacksz; -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ SD_DEVICE_HANDLE hDevice; -+ SD_CARD_RCA sd_rca; -+ SD_CARD_INTERFACE card_intf; -+ BOOLEAN enableIsarWithStatus; -+ WCHAR active_path[MAX_ACTIVE_REG_PATH]; -+ SD_HOST_BLOCK_CAPABILITY sd_host_blk_cap; -+#endif -+} SDIO_DATA, *PSDIO_DATA; -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types_xp.h linux/3rdparty/rtl8812au/include/drv_types_xp.h ---- linux.old/3rdparty/rtl8812au/include/drv_types_xp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/drv_types_xp.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,95 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/ethernet.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/ethernet.h +--- linux-4.14.17/3rdparty/rtl8812au/include/ethernet.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/ethernet.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,36 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -290041,112 +130823,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/drv_types_xp.h linux/3rdparty/rt + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ -+#ifndef __DRV_TYPES_XP_H__ -+#define __DRV_TYPES_XP_H__ -+ -+#include -+#include -+ -+ -+ -+#define MAX_MCAST_LIST_NUM 32 -+ -+ -+ -+//for ioctl -+#define MAKE_DRIVER_VERSION(_MainVer,_MinorVer) ((((u32)(_MainVer))<<16)+_MinorVer) -+ -+#define NIC_HEADER_SIZE 14 //!< can be moved to typedef.h -+#define NIC_MAX_PACKET_SIZE 1514 //!< can be moved to typedef.h -+#define NIC_MAX_SEND_PACKETS 10 // max number of send packets the MiniportSendPackets function can accept, can be moved to typedef.h -+#define NIC_VENDOR_DRIVER_VERSION MAKE_DRIVER_VERSION(0,001) //!< can be moved to typedef.h -+#define NIC_MAX_PACKET_SIZE 1514 //!< can be moved to typedef.h -+ -+ -+#undef ON_VISTA -+//added by Jackson -+#ifndef ON_VISTA -+// -+// Bus driver versions -+// -+ -+#define SDBUS_DRIVER_VERSION_1 0x100 -+#define SDBUS_DRIVER_VERSION_2 0x200 -+ -+#define SDP_FUNCTION_TYPE 4 -+#define SDP_BUS_DRIVER_VERSION 5 -+#define SDP_BUS_WIDTH 6 -+#define SDP_BUS_CLOCK 7 -+#define SDP_BUS_INTERFACE_CONTROL 8 -+#define SDP_HOST_BLOCK_LENGTH 9 -+#define SDP_FUNCTION_BLOCK_LENGTH 10 -+#define SDP_FN0_BLOCK_LENGTH 11 -+#define SDP_FUNCTION_INT_ENABLE 12 -+#endif -+ -+ -+typedef struct _MP_REG_ENTRY -+{ -+ -+ NDIS_STRING RegName; // variable name text -+ BOOLEAN bRequired; // 1 -> required, 0 -> optional -+ -+ u8 Type; // NdisParameterInteger/NdisParameterHexInteger/NdisParameterStringle/NdisParameterMultiString -+ uint FieldOffset; // offset to MP_ADAPTER field -+ uint FieldSize; // size (in bytes) of the field -+ -+#ifdef UNDER_AMD64 -+ u64 Default; -+#else -+ u32 Default; // default value to use -+#endif -+ -+ u32 Min; // minimum value allowed -+ u32 Max; // maximum value allowed -+} MP_REG_ENTRY, *PMP_REG_ENTRY; -+ -+ -+typedef struct _OCTET_STRING{ -+ u8 *Octet; -+ u16 Length; -+} OCTET_STRING, *POCTET_STRING; -+ -+ -+ -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/ethernet.h linux/3rdparty/rtl8812au/include/ethernet.h ---- linux.old/3rdparty/rtl8812au/include/ethernet.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/ethernet.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,42 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/*! \file */ ++/*! \file */ +#ifndef __INC_ETHERNET_H +#define __INC_ETHERNET_H + @@ -290157,251 +130835,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ethernet.h linux/3rdparty/rtl881 +#define MINIMUM_ETHERNET_PACKET_SIZE 60 //!< Minimum Ethernet Packet Size +#define MAXIMUM_ETHERNET_PACKET_SIZE 1514 //!< Maximum Ethernet Packet Size + -+#define RT_ETH_IS_MULTICAST(_pAddr) ((((UCHAR *)(_pAddr))[0]&0x01)!=0) //!< Is Multicast Address? ++#define RT_ETH_IS_MULTICAST(_pAddr) ((((u8 *)(_pAddr))[0]&0x01)!=0) //!< Is Multicast Address? +#define RT_ETH_IS_BROADCAST(_pAddr) ( \ -+ ((UCHAR *)(_pAddr))[0]==0xff && \ -+ ((UCHAR *)(_pAddr))[1]==0xff && \ -+ ((UCHAR *)(_pAddr))[2]==0xff && \ -+ ((UCHAR *)(_pAddr))[3]==0xff && \ -+ ((UCHAR *)(_pAddr))[4]==0xff && \ -+ ((UCHAR *)(_pAddr))[5]==0xff ) //!< Is Broadcast Address? ++ ((u8 *)(_pAddr))[0]==0xff && \ ++ ((u8 *)(_pAddr))[1]==0xff && \ ++ ((u8 *)(_pAddr))[2]==0xff && \ ++ ((u8 *)(_pAddr))[3]==0xff && \ ++ ((u8 *)(_pAddr))[4]==0xff && \ ++ ((u8 *)(_pAddr))[5]==0xff ) //!< Is Broadcast Address? + + +#endif // #ifndef __INC_ETHERNET_H -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/gspi_hal.h linux/3rdparty/rtl8812au/include/gspi_hal.h ---- linux.old/3rdparty/rtl8812au/include/gspi_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/gspi_hal.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,36 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __GSPI_HAL_H__ -+#define __GSPI_HAL_H__ -+ -+ -+void spi_int_dpc(PADAPTER padapter, u32 sdio_hisr); -+u8 rtw_set_hal_ops(_adapter *padapter); -+ -+#ifdef CONFIG_RTL8188E -+void rtl8188es_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8723B -+void rtl8723bs_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#endif //__GSPI_HAL_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/gspi_ops.h linux/3rdparty/rtl8812au/include/gspi_ops.h ---- linux.old/3rdparty/rtl8812au/include/gspi_ops.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/gspi_ops.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,185 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __GSPI_OPS_H__ -+#define __GSPI_OPS_H__ -+ -+/* follwing defination is based on -+ * GSPI spec of RTL8723, we temp -+ * suppose that it will be the same -+ * for diff chips of GSPI, if not -+ * we should move it to HAL folder */ -+#define SPI_LOCAL_DOMAIN 0x0 -+#define WLAN_IOREG_DOMAIN 0x8 -+#define FW_FIFO_DOMAIN 0x4 -+#define TX_HIQ_DOMAIN 0xc -+#define TX_MIQ_DOMAIN 0xd -+#define TX_LOQ_DOMAIN 0xe -+#define RX_RXFIFO_DOMAIN 0x1f -+ -+//IO Bus domain address mapping -+#define DEFUALT_OFFSET 0x0 -+#define SPI_LOCAL_OFFSET 0x10250000 -+#define WLAN_IOREG_OFFSET 0x10260000 -+#define FW_FIFO_OFFSET 0x10270000 -+#define TX_HIQ_OFFSET 0x10310000 -+#define TX_MIQ_OFFSET 0x1032000 -+#define TX_LOQ_OFFSET 0x10330000 -+#define RX_RXOFF_OFFSET 0x10340000 -+ -+//SPI Local registers -+#define SPI_REG_TX_CTRL 0x0000 // SPI Tx Control -+#define SPI_REG_STATUS_RECOVERY 0x0004 -+#define SPI_REG_INT_TIMEOUT 0x0006 -+#define SPI_REG_HIMR 0x0014 // SPI Host Interrupt Mask -+#define SPI_REG_HISR 0x0018 // SPI Host Interrupt Service Routine -+#define SPI_REG_RX0_REQ_LEN 0x001C // RXDMA Request Length -+#define SPI_REG_FREE_TXPG 0x0020 // Free Tx Buffer Page -+#define SPI_REG_HCPWM1 0x0024 // HCI Current Power Mode 1 -+#define SPI_REG_HCPWM2 0x0026 // HCI Current Power Mode 2 -+#define SPI_REG_HTSFR_INFO 0x0030 // HTSF Informaion -+#define SPI_REG_HRPWM1 0x0080 // HCI Request Power Mode 1 -+#define SPI_REG_HRPWM2 0x0082 // HCI Request Power Mode 2 -+#define SPI_REG_HPS_CLKR 0x0084 // HCI Power Save Clock -+#define SPI_REG_HSUS_CTRL 0x0086 // SPI HCI Suspend Control -+#define SPI_REG_HIMR_ON 0x0090 //SPI Host Extension Interrupt Mask Always -+#define SPI_REG_HISR_ON 0x0091 //SPI Host Extension Interrupt Status Always -+#define SPI_REG_CFG 0x00F0 //SPI Configuration Register -+ -+#define SPI_TX_CTRL (SPI_REG_TX_CTRL |SPI_LOCAL_OFFSET) -+#define SPI_STATUS_RECOVERY (SPI_REG_STATUS_RECOVERY |SPI_LOCAL_OFFSET) -+#define SPI_INT_TIMEOUT (SPI_REG_INT_TIMEOUT |SPI_LOCAL_OFFSET) -+#define SPI_HIMR (SPI_REG_HIMR |SPI_LOCAL_OFFSET) -+#define SPI_HISR (SPI_REG_HISR |SPI_LOCAL_OFFSET) -+#define SPI_RX0_REQ_LEN_1_BYTE (SPI_REG_RX0_REQ_LEN |SPI_LOCAL_OFFSET) -+#define SPI_FREE_TXPG (SPI_REG_FREE_TXPG |SPI_LOCAL_OFFSET) -+ -+#define SPI_HIMR_DISABLED 0 -+ -+//SPI HIMR MASK diff with SDIO -+#define SPI_HISR_RX_REQUEST BIT(0) -+#define SPI_HISR_AVAL BIT(1) -+#define SPI_HISR_TXERR BIT(2) -+#define SPI_HISR_RXERR BIT(3) -+#define SPI_HISR_TXFOVW BIT(4) -+#define SPI_HISR_RXFOVW BIT(5) -+#define SPI_HISR_TXBCNOK BIT(6) -+#define SPI_HISR_TXBCNERR BIT(7) -+#define SPI_HISR_BCNERLY_INT BIT(16) -+#define SPI_HISR_ATIMEND BIT(17) -+#define SPI_HISR_ATIMEND_E BIT(18) -+#define SPI_HISR_CTWEND BIT(19) -+#define SPI_HISR_C2HCMD BIT(20) -+#define SPI_HISR_CPWM1 BIT(21) -+#define SPI_HISR_CPWM2 BIT(22) -+#define SPI_HISR_HSISR_IND BIT(23) -+#define SPI_HISR_GTINT3_IND BIT(24) -+#define SPI_HISR_GTINT4_IND BIT(25) -+#define SPI_HISR_PSTIMEOUT BIT(26) -+#define SPI_HISR_OCPINT BIT(27) -+#define SPI_HISR_TSF_BIT32_TOGGLE BIT(29) -+ -+#define MASK_SPI_HISR_CLEAR (SPI_HISR_TXERR |\ -+ SPI_HISR_RXERR |\ -+ SPI_HISR_TXFOVW |\ -+ SPI_HISR_RXFOVW |\ -+ SPI_HISR_TXBCNOK |\ -+ SPI_HISR_TXBCNERR |\ -+ SPI_HISR_C2HCMD |\ -+ SPI_HISR_CPWM1 |\ -+ SPI_HISR_CPWM2 |\ -+ SPI_HISR_HSISR_IND |\ -+ SPI_HISR_GTINT3_IND |\ -+ SPI_HISR_GTINT4_IND |\ -+ SPI_HISR_PSTIMEOUT |\ -+ SPI_HISR_OCPINT) -+ -+#define REG_LEN_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 0, 8, x)//(x<<(unsigned int)24) -+#define REG_ADDR_FORMAT(pcmd,x) SET_BITS_TO_LE_4BYTE(pcmd, 8, 16, x)//(x<<(unsigned int)16) -+#define REG_DOMAIN_ID_FORMAT(pcmd,x) SET_BITS_TO_LE_4BYTE(pcmd, 24, 5, x)//(x<<(unsigned int)0) -+#define REG_FUN_FORMAT(pcmd,x) SET_BITS_TO_LE_4BYTE(pcmd, 29, 2, x)//(x<<(unsigned int)5) -+#define REG_RW_FORMAT(pcmd,x) SET_BITS_TO_LE_4BYTE(pcmd, 31, 1, x)//(x<<(unsigned int)7) -+ -+#define FIFO_LEN_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 0, 16, x)//(x<<(unsigned int)24) -+//#define FIFO_ADDR_FORMAT(pcmd,x) SET_BITS_TO_LE_4BYTE(pcmd, 8, 16, x)//(x<<(unsigned int)16) -+#define FIFO_DOMAIN_ID_FORMAT(pcmd,x) SET_BITS_TO_LE_4BYTE(pcmd, 24, 5, x)//(x<<(unsigned int)0) -+#define FIFO_FUN_FORMAT(pcmd,x) SET_BITS_TO_LE_4BYTE(pcmd, 29, 2, x)//(x<<(unsigned int)5) -+#define FIFO_RW_FORMAT(pcmd,x) SET_BITS_TO_LE_4BYTE(pcmd, 31, 1, x)//(x<<(unsigned int)7) -+ -+ -+//get status dword0 -+#define GET_STATUS_PUB_PAGE_NUM(status) LE_BITS_TO_4BYTE(status, 24, 8) -+#define GET_STATUS_HI_PAGE_NUM(status) LE_BITS_TO_4BYTE(status, 18, 6) -+#define GET_STATUS_MID_PAGE_NUM(status) LE_BITS_TO_4BYTE(status, 12, 6) -+#define GET_STATUS_LOW_PAGE_NUM(status) LE_BITS_TO_4BYTE(status, 6, 6) -+#define GET_STATUS_HISR_HI6BIT(status) LE_BITS_TO_4BYTE(status, 0, 6) -+ -+//get status dword1 -+#define GET_STATUS_HISR_MID8BIT(status) LE_BITS_TO_4BYTE(status + 4, 24, 8) -+#define GET_STATUS_HISR_LOW8BIT(status) LE_BITS_TO_4BYTE(status + 4, 16, 8) -+#define GET_STATUS_ERROR(status) LE_BITS_TO_4BYTE(status + 4, 17, 1) -+#define GET_STATUS_INT(status) LE_BITS_TO_4BYTE(status + 4, 16, 1) -+#define GET_STATUS_RX_LENGTH(status) LE_BITS_TO_4BYTE(status + 4, 0, 16) -+ -+ -+#define RXDESC_SIZE 24 -+ -+ -+struct spi_more_data { -+ unsigned long more_data; -+ unsigned long len; -+}; -+ -+#ifdef CONFIG_RTL8188E -+void rtl8188es_set_hal_ops(PADAPTER padapter); -+#define set_hal_ops rtl8188es_set_hal_ops -+#endif -+extern void spi_set_chip_endian(PADAPTER padapter); -+extern unsigned int spi_write8_endian(ADAPTER *Adapter, unsigned int addr, unsigned int buf, u32 big); -+extern void spi_set_intf_ops(_adapter *padapter,struct _io_ops *pops); -+extern void spi_set_chip_endian(PADAPTER padapter); -+extern void InitInterrupt8723ASdio(PADAPTER padapter); -+extern void InitSysInterrupt8723ASdio(PADAPTER padapter); -+extern void EnableInterrupt8723ASdio(PADAPTER padapter); -+extern void DisableInterrupt8723ASdio(PADAPTER padapter); -+extern void spi_int_hdl(PADAPTER padapter); -+extern u8 HalQueryTxBufferStatus8723ASdio(PADAPTER padapter); -+#ifdef CONFIG_RTL8723B -+extern void InitInterrupt8723BSdio(PADAPTER padapter); -+extern void InitSysInterrupt8723BSdio(PADAPTER padapter); -+extern void EnableInterrupt8723BSdio(PADAPTER padapter); -+extern void DisableInterrupt8723BSdio(PADAPTER padapter); -+extern u8 HalQueryTxBufferStatus8723BSdio(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8188E -+extern void InitInterrupt8188EGspi(PADAPTER padapter); -+extern void EnableInterrupt8188EGspi(PADAPTER padapter); -+extern void DisableInterrupt8188EGspi(PADAPTER padapter); -+extern void UpdateInterruptMask8188EGspi(PADAPTER padapter, u32 AddMSR, u32 RemoveMSR); -+extern u8 HalQueryTxBufferStatus8189EGspi(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8189EGspi(PADAPTER padapter); -+extern void ClearInterrupt8188EGspi(PADAPTER padapter); -+extern u8 CheckIPSStatus(PADAPTER padapter); -+#endif // CONFIG_RTL8188E -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+extern u8 RecvOnePkt(PADAPTER padapter, u32 size); -+#endif // CONFIG_WOWLAN -+ -+#endif //__GSPI_OPS_H__ -diff -Nurp linux.old/3rdparty/rtl8812au/include/gspi_ops_linux.h linux/3rdparty/rtl8812au/include/gspi_ops_linux.h ---- linux.old/3rdparty/rtl8812au/include/gspi_ops_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/gspi_ops_linux.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,24 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/h2clbk.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/h2clbk.h +--- linux-4.14.17/3rdparty/rtl8812au/include/h2clbk.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/h2clbk.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,26 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -290415,74 +130863,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/gspi_ops_linux.h linux/3rdparty/ + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_OPS_LINUX_H__ -+#define __SDIO_OPS_LINUX_H__ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/gspi_osintf.h linux/3rdparty/rtl8812au/include/gspi_osintf.h ---- linux.old/3rdparty/rtl8812au/include/gspi_osintf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/gspi_osintf.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_OSINTF_H__ -+#define __SDIO_OSINTF_H__ -+ -+ -+#ifdef PLATFORM_OS_CE -+extern NDIS_STATUS ce_sd_get_dev_hdl(PADAPTER padapter); -+SD_API_STATUS ce_sd_int_callback(SD_DEVICE_HANDLE hDevice, PADAPTER padapter); -+extern void sd_setup_irs(PADAPTER padapter); -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/h2clbk.h linux/3rdparty/rtl8812au/include/h2clbk.h ---- linux.old/3rdparty/rtl8812au/include/h2clbk.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/h2clbk.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,32 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ + + @@ -290493,1582 +130873,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/h2clbk.h linux/3rdparty/rtl8812a + +void _lbk_rsp(PADAPTER Adapter); + -+void _lbk_evt(IN PADAPTER Adapter); ++void _lbk_evt(PADAPTER Adapter); + +void h2c_event_callback(unsigned char *dev, unsigned char *pbuf); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8188EPhyCfg.h linux/3rdparty/rtl8812au/include/Hal8188EPhyCfg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8188EPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8188EPhyCfg.h 2017-06-07 23:07:21.034689672 +0300 -@@ -0,0 +1,274 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8188EPHYCFG_H__ -+#define __INC_HAL8188EPHYCFG_H__ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 //us -+#define AntennaDiversityValue 0x80 //(Adapter->bSoftwareAntennaDiversity ? 0x00:0x80) -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+#ifdef CONFIG_PCI_HCI -+#define MAX_AGGR_NUM 0x0B -+#else -+#define MAX_AGGR_NUM 0x07 -+#endif // CONFIG_PCI_HCI -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+#define MAX_TX_COUNT_8188E 1 -+ -+/* BB/RF related */ -+ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/*------------------------Export global variable----------------------------*/ -+/*------------------------Export global variable----------------------------*/ -+ -+ -+/*------------------------Export Marco Definition---------------------------*/ -+/*------------------------Export Marco Definition---------------------------*/ -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+// -+// BB and RF register read/write -+// -+u32 PHY_QueryBBReg8188E( IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask ); -+void PHY_SetBBReg8188E( IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data ); -+u32 PHY_QueryRFReg8188E( IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask ); -+void PHY_SetRFReg8188E( IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data ); -+ -+// -+// Initialization related function -+// -+/* MAC/BB/RF HAL config */ -+int PHY_MACConfig8188E(IN PADAPTER Adapter ); -+int PHY_BBConfig8188E(IN PADAPTER Adapter ); -+int PHY_RFConfig8188E(IN PADAPTER Adapter ); -+ -+/* RF config */ -+int rtl8188e_PHY_ConfigRFWithParaFile(IN PADAPTER Adapter, IN u8 * pFileName, u8 eRFPath); -+ -+// -+// RF Power setting -+// -+//extern BOOLEAN PHY_SetRFPowerState(IN PADAPTER Adapter, -+// IN RT_RF_POWER_STATE eRFPowerState); -+ -+// -+// BB TX Power R/W -+// -+void PHY_GetTxPowerLevel8188E( IN PADAPTER Adapter, -+ OUT s32* powerlevel ); -+void PHY_SetTxPowerLevel8188E( IN PADAPTER Adapter, -+ IN u8 channel ); -+BOOLEAN PHY_UpdateTxPowerDbm8188E( IN PADAPTER Adapter, -+ IN int powerInDbm ); -+ -+VOID -+PHY_SetTxPowerIndex_8188E( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+ ); -+ -+u8 -+PHY_GetTxPowerIndex_8188E( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel -+ ); -+ -+// -+// Switch bandwidth for 8192S -+// -+//extern void PHY_SetBWModeCallback8192C( IN PRT_TIMER pTimer ); -+void PHY_SetBWMode8188E( IN PADAPTER pAdapter, -+ IN CHANNEL_WIDTH ChnlWidth, -+ IN unsigned char Offset ); -+ -+// -+// Set FW CMD IO for 8192S. -+// -+//extern BOOLEAN HalSetIO8192C( IN PADAPTER Adapter, -+// IN IO_TYPE IOType); -+ -+// -+// Set A2 entry to fw for 8192S -+// -+extern void FillA2Entry8192C( IN PADAPTER Adapter, -+ IN u8 index, -+ IN u8* val); -+ -+ -+// -+// channel switch related funciton -+// -+//extern void PHY_SwChnlCallback8192C( IN PRT_TIMER pTimer ); -+void PHY_SwChnl8188E( IN PADAPTER pAdapter, -+ IN u8 channel ); -+ -+VOID -+PHY_SetSwChnlBWMode8188E( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+ -+// -+// BB/MAC/RF other monitor API -+// -+void PHY_SetMonitorMode8192C(IN PADAPTER pAdapter, -+ IN BOOLEAN bEnableMonitorMode ); -+ -+BOOLEAN PHY_CheckIsLegalRfPath8192C(IN PADAPTER pAdapter, -+ IN u32 eRFPath ); -+ -+VOID PHY_SetRFPathSwitch_8188E(IN PADAPTER pAdapter, IN BOOLEAN bMain); -+ -+extern VOID -+PHY_SwitchEphyParameter( -+ IN PADAPTER Adapter -+ ); -+ -+extern VOID -+PHY_EnableHostClkReq( -+ IN PADAPTER Adapter -+ ); -+ -+BOOLEAN -+SetAntennaConfig92C( -+ IN PADAPTER Adapter, -+ IN u8 DefaultAnt -+ ); -+ -+VOID -+storePwrIndexDiffRateOffset( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+ ); -+/*--------------------------Exported Function prototype---------------------*/ -+ -+// -+// Initialization related function -+// -+/* MAC/BB/RF HAL config */ -+//extern s32 PHY_MACConfig8723(PADAPTER padapter); -+//s32 PHY_BBConfig8723(PADAPTER padapter); -+//s32 PHY_RFConfig8723(PADAPTER padapter); -+ -+ -+ -+//================================================================== -+// Note: If SIC_ENABLE under PCIE, because of the slow operation -+// you should -+// 2) "#define RTL8723_FPGA_VERIFICATION 1" in Precomp.h.WlanE.Windows -+// 3) "#define RTL8190_Download_Firmware_From_Header 0" in Precomp.h.WlanE.Windows if needed. -+// -+#if (RTL8188E_SUPPORT == 1) && (RTL8188E_FPGA_TRUE_PHY_VERIFICATION == 1) -+#define SIC_ENABLE 1 -+#define SIC_HW_SUPPORT 1 -+#else -+#define SIC_ENABLE 0 -+#define SIC_HW_SUPPORT 0 -+#endif -+//================================================================== -+ -+ -+#define SIC_MAX_POLL_CNT 5 -+ -+#if(SIC_HW_SUPPORT == 1) -+#define SIC_CMD_READY 0 -+#define SIC_CMD_PREWRITE 0x1 -+#if(RTL8188E_SUPPORT == 1) -+#define SIC_CMD_WRITE 0x40 -+#define SIC_CMD_PREREAD 0x2 -+#define SIC_CMD_READ 0x80 -+#define SIC_CMD_INIT 0xf0 -+#define SIC_INIT_VAL 0xff -+ -+#define SIC_INIT_REG 0x1b7 -+#define SIC_CMD_REG 0x1EB // 1byte -+#define SIC_ADDR_REG 0x1E8 // 1b4~1b5, 2 bytes -+#define SIC_DATA_REG 0x1EC // 1b0~1b3 -+#else -+#define SIC_CMD_WRITE 0x11 -+#define SIC_CMD_PREREAD 0x2 -+#define SIC_CMD_READ 0x12 -+#define SIC_CMD_INIT 0x1f -+#define SIC_INIT_VAL 0xff -+ -+#define SIC_INIT_REG 0x1b7 -+#define SIC_CMD_REG 0x1b6 // 1byte -+#define SIC_ADDR_REG 0x1b4 // 1b4~1b5, 2 bytes -+#define SIC_DATA_REG 0x1b0 // 1b0~1b3 -+#endif -+#else -+#define SIC_CMD_READY 0 -+#define SIC_CMD_WRITE 1 -+#define SIC_CMD_READ 2 -+ -+#if(RTL8188E_SUPPORT == 1) -+#define SIC_CMD_REG 0x1EB // 1byte -+#define SIC_ADDR_REG 0x1E8 // 1b9~1ba, 2 bytes -+#define SIC_DATA_REG 0x1EC // 1bc~1bf -+#else -+#define SIC_CMD_REG 0x1b8 // 1byte -+#define SIC_ADDR_REG 0x1b9 // 1b9~1ba, 2 bytes -+#define SIC_DATA_REG 0x1bc // 1bc~1bf -+#endif -+#endif -+ -+#if(SIC_ENABLE == 1) -+VOID SIC_Init(IN PADAPTER Adapter); -+#endif -+ -+ -+#endif // __INC_HAL8192CPHYCFG_H -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8188EPhyReg.h linux/3rdparty/rtl8812au/include/Hal8188EPhyReg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8188EPhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8188EPhyReg.h 2017-06-07 23:07:21.034689672 +0300 -@@ -0,0 +1,1106 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8188EPHYREG_H__ -+#define __INC_HAL8188EPHYREG_H__ -+/*--------------------------Define Parameters-------------------------------*/ -+// -+// BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+// 3. RF register 0x00-2E -+// 4. Bit Mask for BB/RF register -+// 5. Other defintion for BB/RF R/W -+// -+ -+ -+// -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 1. Page1(0x100) -+// -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+// -+// 2. Page2(0x200) -+// -+// The following two definition are only used for USB interface. -+#define RF_BB_CMD_ADDR 0x02c0 // RF/BB read/write command address. -+#define RF_BB_CMD_DATA 0x02c4 // RF/BB read/write command data. -+ -+// -+// 3. Page8(0x800) -+// -+#define rFPGA0_RFMOD 0x800 //RF mode & CCK TxSC // RF BW Setting?? -+ -+#define rFPGA0_TxInfo 0x804 // Status report?? -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c // Set TX PWR init gain? -+ -+#define rFPGA0_RFTiming1 0x810 // Useless now -+#define rFPGA0_RFTiming2 0x814 -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 // RF 3 wire register -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_RFWakeUpParameter 0x850 // Useless now -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 // RF Channel switch -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 // RF Channel switch -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+#define rFPGA0_XAB_RFInterfaceSW 0x870 // RF Interface Software Control -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 -+#define rFPGA0_AdDaClockEn 0x888 // enable ad/da clock1 for dual-phy -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 // Tranceiver LSSI Readback -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 // Useless now -+#define TransceiverA_HSPI_Readback 0x8b8 // Transceiver A HSPI Readback -+#define TransceiverB_HSPI_Readback 0x8bc // Transceiver B HSPI Readback -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 // Useless now // RF Interface Readback Value -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 // Useless now -+ -+// -+// 4. Page9(0x900) -+// -+#define rFPGA1_RFMOD 0x900 //RF mode & OFDM TxSC // RF BW Setting?? -+ -+#define rFPGA1_TxBlock 0x904 // Useless now -+#define rFPGA1_DebugSelect 0x908 // Useless now -+#define rFPGA1_TxInfo 0x90c // Useless now // Status report?? -+ -+// -+// 5. PageA(0xA00) -+// -+// Set Control channel to upper or lower. These settings are required only for 40MHz -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 // Disable init gain now // Select RX path by RSSI -+#define rCCK0_CCA 0xa08 // Disable init gain now // Init gain -+ -+#define rCCK0_RxAGC1 0xa0c //AGC default value, saturation level // Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series -+#define rCCK0_RxAGC2 0xa10 //AGC & DAGC -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 //Timing recovery & Channel estimation threshold -+#define rCCK0_DSPParameter2 0xa1c //SQ threshold -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 //debug port and Tx filter3 -+#define rCCK0_FalseAlarmReport 0xa2c //0xa2d useless now 0xa30-a4f channel report -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 //0xa57 -+#define rCCK0_FACounterLower 0xa5c //0xa5b -+#define rCCK0_FACounterUpper 0xa58 //0xa5c -+ -+// -+// PageB(0xB00) -+// -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_ram64x16 0xb2c -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rConfig_Pmpd_AntB 0xb98 -+#define rAPK 0xbd8 -+ -+ -+ -+// -+// 6. PageC(0xC00) -+// -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 //RxIQ DC offset, Rx digital filter, DC notch filter -+#define rOFDM0_XARxIQImbalance 0xc14 //RxIQ imblance matrix -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 //PD,BW & SBD // DM tune init gain -+#define rOFDM0_RxDetector2 0xc34 //SBD & Fame Sync. -+#define rOFDM0_RxDetector3 0xc38 //Frame Sync. -+#define rOFDM0_RxDetector4 0xc3c //PD, SBD, Frame Sync & Short-GI -+ -+#define rOFDM0_RxDSP 0xc40 //Rx Sync Path -+#define rOFDM0_CFOandDAGC 0xc44 //CFO & DAGC -+#define rOFDM0_CCADropThreshold 0xc48 //CCA Drop threshold -+#define rOFDM0_ECCAThreshold 0xc4c // energy CCA -+ -+#define rOFDM0_XAAGCCore1 0xc50 // DIG -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 // TX PWR TRACK and DIG -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+ -+// -+// 7. PageD(0xD00) -+// -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 // No setting now -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_csi_fix_mask1 0xd40 -+#define rOFDM1_csi_fix_mask2 0xd44 -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 //cca, parity fail -+#define rOFDM_PHYCounter2 0xda4 //rate illegal, crc8 fail -+#define rOFDM_PHYCounter3 0xda8 //MCS not support -+ -+#define rOFDM_ShortCFOAB 0xdac // No setting now -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+// -+// 8. PageE(0xE00) -+// -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+// -+// 7. RF Register 0x00-0x2E (RF 8256) -+// RF-0222D 0x00-3F -+// -+//Zebra1 -+#define rZebra1_HSSIEnable 0x0 // Useless now -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+#define rZebra1_Channel 0x7 // RF channel switch -+ -+//#endif -+#define rZebra1_TxGain 0x8 // Useless now -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+//Zebra4 -+#define rGlobalCtrl 0 // Useless now -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+//RTL8258 -+#define rRTL8258_TxLPF 0x11 // Useless now -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa -+ -+// -+// RL6052 Register definition -+// -+#define RF_AC 0x00 // -+ -+#define RF_IQADJ_G1 0x01 // -+#define RF_IQADJ_G2 0x02 // -+ -+#define RF_POW_TRSW 0x05 // -+ -+#define RF_GAIN_RX 0x06 // -+#define RF_GAIN_TX 0x07 // -+ -+#define RF_TXM_IDAC 0x08 // -+#define RF_IPA_G 0x09 // -+#define RF_TXBIAS_G 0x0A -+#define RF_TXPA_AG 0x0B -+#define RF_IPA_A 0x0C // -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_BS_IQGEN 0x0F // -+ -+#define RF_MODE1 0x10 // -+#define RF_MODE2 0x11 // -+ -+#define RF_RX_AGC_HP 0x12 // -+#define RF_TX_AGC 0x13 // -+#define RF_BIAS 0x14 // -+#define RF_IPA 0x15 // -+#define RF_TXBIAS 0x16 -+#define RF_POW_ABILITY 0x17 // -+#define RF_CHNLBW 0x18 // RF channel and BW switch -+#define RF_TOP 0x19 // -+ -+#define RF_RX_G1 0x1A // -+#define RF_RX_G2 0x1B // -+ -+#define RF_RX_BB2 0x1C // -+#define RF_RX_BB1 0x1D // -+ -+#define RF_RCK1 0x1E // -+#define RF_RCK2 0x1F // -+ -+#define RF_TX_G1 0x20 // -+#define RF_TX_G2 0x21 // -+#define RF_TX_G3 0x22 // -+ -+#define RF_TX_BB1 0x23 // -+ -+#define RF_T_METER_88E 0x42 // -+#define RF_T_METER 0x24 // -+ -+#define RF_SYN_G1 0x25 // RF TX Power control -+#define RF_SYN_G2 0x26 // RF TX Power control -+#define RF_SYN_G3 0x27 // RF TX Power control -+#define RF_SYN_G4 0x28 // RF TX Power control -+#define RF_SYN_G5 0x29 // RF TX Power control -+#define RF_SYN_G6 0x2A // RF TX Power control -+#define RF_SYN_G7 0x2B // RF TX Power control -+#define RF_SYN_G8 0x2C // RF TX Power control -+ -+#define RF_RCK_OS 0x30 // RF TX PA control -+#define RF_TXPA_G1 0x31 // RF TX PA control -+#define RF_TXPA_G2 0x32 // RF TX PA control -+#define RF_TXPA_G3 0x33 // RF TX PA control -+#define RF_TX_BIAS_A 0x35 -+#define RF_TX_BIAS_D 0x36 -+#define RF_LOBF_9 0x38 -+#define RF_RXRF_A3 0x3C // -+#define RF_TRSW 0x3F -+ -+#define RF_TXRF_A2 0x41 -+#define RF_TXPA_G4 0x46 -+#define RF_TXPA_A4 0x4B -+#define RF_0x52 0x52 -+#define RF_WE_LUT 0xEF -+ -+ -+// -+//Bit Mask -+// -+// 1. Page1(0x100) -+#define bBBResetB 0x100 // Useless now? -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) -+ -+// 2. Page8(0x800) -+#define bRFMOD 0x1 // Reg 0x800 rFPGA0_RFMOD -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 // Useless now -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bAntennaSelect 0x0300 -+ -+#define bXBTxAGC 0xf00 // Reg 80c rFPGA0_TxGainStage -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 // Useless now -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf //Reg0x814 -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 //T2R -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 //chane gain at continue Tx -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 // Reg 0x820~84f rFPGA0_XA_HSSIParameter1 -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 // Useless now -+//#define bHWSISelect 0x8 -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 // Reg 0x870 rFPGA0_XAB_RFInterfaceSW -+ -+#define bRFSI_TRSW 0x20 // Useless now -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+ -+#define bLSSIReadAddress 0x7f800000 // T65 RF -+ -+#define bLSSIReadEdge 0x80000000 //LSSI "Read" edge signal -+ -+#define bLSSIReadBackData 0xfffff // T65 RF -+ -+#define bLSSIReadOKFlag 0x1000 // Useless now -+#define bCCKSampleRate 0x8 //0: 44MHz, 1:88MHz -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 // Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ -+ -+#define b80MClkDelay 0x18000000 // Useless -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 // Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 // Useless -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+// 3. Page9(0x900) -+#define bOFDMTxSC 0x30000000 // Useless -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff //reset debug page and also HWord, LWord -+#define bDebugItem 0xff //reset debug page and LWord -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 -+ -+// 4. PageA(0xA00) -+#define bCCKBBMode 0x3 // Useless -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 // Reg 0xa00 rCCK0_System 20/40 switch -+ -+#define bCCKScramble 0x8 // Useless -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 //r_rx_clk -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 //CCK Rx Iinital gain polarity -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f //AGCsamp_dly -+#define bCCKFixedRxAGC 0x8000 -+//#define bCCKRxAGCFormat 0x4000 //remove to HSSI register 0x824 -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+// 5. PageC(0xC00) -+#define bNumOfSTF 0x3 // Useless -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 //the threshold for high power -+#define bRSSI_Gen 0x7f000000 //the threshold for ant diversity -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+//#define bRxMF_Hold 0x3800 -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 -+ -+// 6. PageE(0xE00) -+#define bSTBCEn 0x4 // Useless -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+//#define bRxPath1 0x01 -+//#define bRxPath2 0x02 -+//#define bRxPath3 0x04 -+//#define bRxPath4 0x08 -+//#define bTxPath1 0x10 -+//#define bTxPath2 0x20 -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 //total -+#define bShortCFOFLength 11 //fraction -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf // Useless -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 // Useless -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 // Useless -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+//Rx Pseduo noise -+#define bRxPesudoNoiseOn 0x20000000 // Useless -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+//7. RF Register -+//Zebra1 -+#define bZebra1_HSSIEnable 0x8 // Useless -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+//Zebra4 -+#define bRTL8256RegModeCtrl1 0x100 // Useless -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+//RTL8258 -+#define bRTL8258_TxLPFBW 0xc // Useless -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 -+ -+ -+// -+// Other Definition -+// -+ -+//byte endable for sb_write -+#define bByte0 0x1 // Useless -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+//for PutRegsetting & GetRegSetting BitMask -+#define bMaskByte0 0xff // Reg 0xc50 rOFDM0_XAAGCCore~0xC6f -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+ -+ -+#define bEnable 0x1 // Useless -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 // Useless -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 //500ms // Useless -+#define tUpdateRxCounter 100 //100ms -+ -+#define rateCCK 0 // Useless -+#define rateOFDM 1 -+#define rateHT 2 -+ -+//define Register-End -+#define bPMAC_End 0x1ff // Useless -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+//define max debug item in each debug page -+//#define bMaxItem_FPGA_PHY0 0x9 -+//#define bMaxItem_FPGA_PHY1 0x3 -+//#define bMaxItem_PHY_11B 0x16 -+//#define bMaxItem_OFDM_PHY0 0x29 -+//#define bMaxItem_OFDM_PHY1 0x0 -+ -+#define bPMACControl 0x0 // Useless -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#define PathA 0x0 // Useless -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8188EPwrSeq.h linux/3rdparty/rtl8812au/include/Hal8188EPwrSeq.h ---- linux.old/3rdparty/rtl8812au/include/Hal8188EPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8188EPwrSeq.h 2017-06-07 23:07:21.034689672 +0300 -@@ -0,0 +1,176 @@ -+ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL8188EPWRSEQ_H__ -+#define __HAL8188EPWRSEQ_H__ -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WM-20110607-Paul-RTL8188E_Power_Architecture-R02.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+ -+ PWR SEQ Version: rtl8188E_PwrSeq_V09.h -+*/ -+#define RTL8188E_TRANS_CARDEMU_TO_ACT_STEPS 10 -+#define RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS 10 -+#define RTL8188E_TRANS_CARDEMU_TO_SUS_STEPS 10 -+#define RTL8188E_TRANS_SUS_TO_CARDEMU_STEPS 10 -+#define RTL8188E_TRANS_CARDEMU_TO_PDN_STEPS 10 -+#define RTL8188E_TRANS_PDN_TO_CARDEMU_STEPS 10 -+#define RTL8188E_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8188E_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8188E_TRANS_END_STEPS 1 -+ -+ -+#define RTL8188E_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0|BIT1, 0}, /* 0x02[1:0] = 0 reset BB*/ \ -+ {0x0026, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7}, /*0x24[23] = 2b'01 schmit trigger */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0}, /* 0x04[15] = 0 disable HWPDN (control by DRV)*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4|BIT3, 0}, /*0x04[12:11] = 2b'00 disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0}, /*0x04[8] = 1 polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0}, /*wait till 0x04[8] = 0*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*LDO normal mode*/ \ -+ -+#define RTL8188E_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*LDO Sleep mode*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ -+#define RTL8188E_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3|BIT4}, /*0x04[12:11] = 2b'11enable WL suspend for PCIe*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, BIT7}, /* 0x04[31:30] = 2b'10 enable enable bandgap mbias in suspend */ \ -+ {0x0041, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*Clear SIC_EN register 0x40[12] = 1'b0 */ \ -+ {0xfe10, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*Set USB suspend enable local register 0xfe10[4]=1 */ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8188E_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8188E_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0026, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7}, /*0x24[23] = 2b'01 schmit trigger */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /* 0x04[31:30] = 2b'10 enable enable bandgap mbias in suspend */ \ -+ {0x0041, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*Clear SIC_EN register 0x40[12] = 1'b0 */ \ -+ {0xfe10, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*Set USB suspend enable local register 0xfe10[4]=1 */ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8188E_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8188E_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8188E_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+//This is used by driver for LPSRadioOff Procedure, not for FW LPS Step -+#define RTL8188E_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x7F},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x3F},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8188E_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6|BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8188E_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // -+ -+ -+extern WLAN_PWR_CFG rtl8188E_power_on_flow[RTL8188E_TRANS_CARDEMU_TO_ACT_STEPS+RTL8188E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188E_radio_off_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS+RTL8188E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188E_card_disable_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS+RTL8188E_TRANS_CARDEMU_TO_PDN_STEPS+RTL8188E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188E_card_enable_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS+RTL8188E_TRANS_CARDEMU_TO_PDN_STEPS+RTL8188E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188E_suspend_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS+RTL8188E_TRANS_CARDEMU_TO_SUS_STEPS+RTL8188E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188E_resume_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS+RTL8188E_TRANS_CARDEMU_TO_SUS_STEPS+RTL8188E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188E_hwpdn_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS+RTL8188E_TRANS_CARDEMU_TO_PDN_STEPS+RTL8188E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188E_enter_lps_flow[RTL8188E_TRANS_ACT_TO_LPS_STEPS+RTL8188E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188E_leave_lps_flow[RTL8188E_TRANS_LPS_TO_ACT_STEPS+RTL8188E_TRANS_END_STEPS]; -+ -+#endif //__HAL8188EPWRSEQ_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8188FPhyCfg.h linux/3rdparty/rtl8812au/include/Hal8188FPhyCfg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8188FPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8188FPhyCfg.h 2017-06-07 23:07:21.034689672 +0300 -@@ -0,0 +1,149 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/Hal8812PhyCfg.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8812PhyCfg.h +--- linux-4.14.17/3rdparty/rtl8812au/include/Hal8812PhyCfg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8812PhyCfg.h 2018-02-06 17:42:30.716967253 +0200 +@@ -0,0 +1,198 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -292082,14 +130893,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8188FPhyCfg.h linux/3rdparty/ + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ -+#ifndef __INC_HAL8188FPHYCFG_H__ -+#define __INC_HAL8188FPHYCFG_H__ ++#ifndef __INC_HAL8812PHYCFG_H__ ++#define __INC_HAL8812PHYCFG_H__ ++ + +/*--------------------------Define Parameters-------------------------------*/ +#define LOOP_LIMIT 5 @@ -292098,6 +130905,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8188FPhyCfg.h linux/3rdparty/ +#define MAX_TXPWR_IDX_NMODE_92S 63 +#define Reset_Cnt_Limit 3 + ++ +#ifdef CONFIG_PCI_HCI +#define MAX_AGGR_NUM 0x0B +#else @@ -292105,123 +130913,175 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8188FPhyCfg.h linux/3rdparty/ +#endif // CONFIG_PCI_HCI + + -+/*--------------------------Define Parameters End-------------------------------*/ -+ ++/*--------------------------Define Parameters-------------------------------*/ + +/*------------------------------Define structure----------------------------*/ + -+/*------------------------------Define structure End----------------------------*/ ++ ++/* BB/RF related */ ++ ++/*------------------------------Define structure----------------------------*/ ++ ++ ++/*------------------------Export global variable----------------------------*/ ++/*------------------------Export global variable----------------------------*/ ++ ++ ++/*------------------------Export Marco Definition---------------------------*/ ++/*------------------------Export Marco Definition---------------------------*/ ++ + +/*--------------------------Exported Function prototype---------------------*/ -+u32 -+PHY_QueryBBReg_8188F( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask -+ ); -+ -+VOID -+PHY_SetBBReg_8188F( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+ ); -+ -+u32 -+PHY_QueryRFReg_8188F( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask -+ ); -+ -+VOID -+PHY_SetRFReg_8188F( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+ ); ++// ++// BB and RF register read/write ++// ++u32 PHY_QueryBBReg8812( PADAPTER Adapter, ++ u32 RegAddr, ++ u32 BitMask ); ++void PHY_SetBBReg8812( PADAPTER Adapter, ++ u32 RegAddr, ++ u32 BitMask, ++ u32 Data ); ++u32 PHY_QueryRFReg8812( PADAPTER Adapter, ++ u8 eRFPath, ++ u32 RegAddr, ++ u32 BitMask ); ++void PHY_SetRFReg8812( PADAPTER Adapter, ++ u8 eRFPath, ++ u32 RegAddr, ++ u32 BitMask, ++ u32 Data ); + ++// ++// Initialization related function ++// +/* MAC/BB/RF HAL config */ -+int PHY_BBConfig8188F(PADAPTER Adapter ); ++int PHY_MACConfig8812(PADAPTER Adapter ); ++int PHY_BBConfig8812(PADAPTER Adapter ); ++void PHY_BB8812_Config_1T(PADAPTER Adapter ); ++int PHY_RFConfig8812(PADAPTER Adapter ); + -+int PHY_RFConfig8188F(PADAPTER Adapter ); ++void ++PHY_InitPowerLimitTable( ++ PDM_ODM_T pDM_Odm ++ ); + -+s32 PHY_MACConfig8188F(PADAPTER padapter); ++void ++PHY_ConvertPowerLimitToPowerIndex( ++ PADAPTER Adapter ++ ); + -+int -+PHY_ConfigRFWithParaFile_8188F( -+ IN PADAPTER Adapter, -+ IN u8* pFileName, -+ RF_PATH eRFPath -+); -+ -+VOID -+PHY_SetTxPowerIndex_8188F( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate ++void ++PHY_SetPowerLimitTableValue( ++ PDM_ODM_T pDM_Odm, ++ const s8* Regulation, ++ const s8* Band, ++ const s8* Bandwidth, ++ const s8* RateSection, ++ const s8* RfPath, ++ const s8* Channel, ++ const s8* PowerLimit + ); + +u8 -+PHY_GetTxPowerIndex_8188F( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel ++PHY_GetPowerLimitValue( ++ PADAPTER Adapter, ++ u32 RegPwrTblSel, ++ BAND_TYPE Band, ++ CHANNEL_WIDTH Bandwidth, ++ RF_PATH RfPath, ++ u8 DataRate, ++ u8 Channel + ); + -+VOID -+PHY_GetTxPowerLevel8188F( -+ IN PADAPTER Adapter, -+ OUT s32* powerlevel -+ ); ++/* RF config */ + -+VOID -+PHY_SetTxPowerLevel8188F( -+ IN PADAPTER Adapter, -+ IN u8 channel -+ ); -+ -+VOID -+PHY_SetBWMode8188F( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth, // 20M or 40M -+ IN unsigned char Offset // Upper, Lower, or Don't care ++s32 ++PHY_SwitchWirelessBand8812( ++ PADAPTER Adapter, ++ u8 Band +); + -+VOID -+PHY_SwChnl8188F( // Call after initialization -+ IN PADAPTER Adapter, -+ IN u8 channel ++// ++// BB TX Power R/W ++// ++void PHY_GetTxPowerLevel8812(PADAPTER Adapter, u32* powerlevel ); ++void PHY_SetTxPowerLevel8812(PADAPTER Adapter, u8 Channel ); ++bool PHY_UpdateTxPowerDbm8812(PADAPTER Adapter, int powerInDbm ); ++u32 PHY_GetTxPowerIndex_8812A( ++ PADAPTER pAdapter, ++ u8 RFPath, ++ u8 Rate, ++ CHANNEL_WIDTH BandWidth, ++ u8 Channel + ); + -+VOID -+PHY_SetSwChnlBWMode8188F( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 ++u32 PHY_GetTxBBSwing_8812A( ++ PADAPTER Adapter, ++ BAND_TYPE Band, ++ u8 RFPath ++ ); ++ ++void ++PHY_SetTxPowerIndex_8812A( ++ PADAPTER Adapter, ++ u4Byte PowerIndex, ++ u1Byte RFPath, ++ u1Byte Rate ++ ); ++// ++// Switch bandwidth for 8192S ++// ++void ++PHY_SetBWMode8812( ++ PADAPTER pAdapter, ++ CHANNEL_WIDTH Bandwidth, ++ u8 Offset +); + -+VOID PHY_SetRFPathSwitch_8188F( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bMain ++// ++// channel switch related funciton ++// ++void ++PHY_SwChnl8812( ++ PADAPTER Adapter, ++ u8 channel ++); ++ ++ ++void ++PHY_SetSwChnlBWMode8812( ++ PADAPTER Adapter, ++ u8 channel, ++ CHANNEL_WIDTH Bandwidth, ++ u8 Offset40, ++ u8 Offset80 ++); ++ ++// ++// BB/MAC/RF other monitor API ++// ++ ++void ++PHY_SetRFPathSwitch_8812A( ++ PADAPTER pAdapter, ++ bool bMain ++); ++ ++void ++storePwrIndexDiffRateOffset( ++ PADAPTER Adapter, ++ u32 RegAddr, ++ u32 BitMask, ++ u32 Data + ); -+/*--------------------------Exported Function prototype End---------------------*/ + -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8188FPhyReg.h linux/3rdparty/rtl8812au/include/Hal8188FPhyReg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8188FPhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8188FPhyReg.h 2017-06-07 23:07:21.034689672 +0300 -@@ -0,0 +1,1171 @@ ++/*--------------------------Exported Function prototype---------------------*/ ++#endif // __INC_HAL8192CPHYCFG_H +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/Hal8812PhyReg.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8812PhyReg.h +--- linux-4.14.17/3rdparty/rtl8812au/include/Hal8812PhyReg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8812PhyReg.h 2018-02-06 17:42:30.716967253 +0200 +@@ -0,0 +1,718 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -292235,21 +131095,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8188FPhyReg.h linux/3rdparty/ + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ -+#ifndef __INC_HAL8188FPHYREG_H__ -+#define __INC_HAL8188FPHYREG_H__ -+ ++#ifndef __INC_HAL8812PHYREG_H__ ++#define __INC_HAL8812PHYREG_H__ +/*--------------------------Define Parameters-------------------------------*/ -+ -+//============================================================ -+// Regsiter offset definition -+//============================================================ -+ +// +// BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF +// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF @@ -292260,1150 +131109,724 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8188FPhyReg.h linux/3rdparty/ +// + + ++// BB Register Definition ++ ++#define rCCAonSec_Jaguar 0x838 ++ ++// BW and sideband setting ++#define rBWIndication_Jaguar 0x834 ++#define rL1PeakTH_Jaguar 0x848 ++#define rRFMOD_Jaguar 0x8ac //RF mode ++#define rADC_Buf_Clk_Jaguar 0x8c4 ++#define rRFECTRL_Jaguar 0x900 ++#define bRFMOD_Jaguar 0xc3 ++#define rCCK_System_Jaguar 0xa00 // for cck sideband ++#define bCCK_System_Jaguar 0x10 ++ ++// Block & Path enable ++#define rOFDMCCKEN_Jaguar 0x808 // OFDM/CCK block enable ++#define bOFDMEN_Jaguar 0x20000000 ++#define bCCKEN_Jaguar 0x10000000 ++#define rRxPath_Jaguar 0x808 // Rx antenna ++#define bRxPath_Jaguar 0xff ++#define rTxPath_Jaguar 0x80c // Tx antenna ++#define bTxPath_Jaguar 0x0fffffff ++#define rCCK_RX_Jaguar 0xa04 // for cck rx path selection ++#define bCCK_RX_Jaguar 0x0c000000 ++#define rVhtlen_Use_Lsig_Jaguar 0x8c3 // Use LSIG for VHT length ++ ++// RF read/write-related ++#define rHSSIRead_Jaguar 0x8b0 // RF read addr ++#define bHSSIRead_addr_Jaguar 0xff ++#define bHSSIRead_trigger_Jaguar 0x100 ++#define rA_PIRead_Jaguar 0xd04 // RF readback with PI ++#define rB_PIRead_Jaguar 0xd44 // RF readback with PI ++#define rA_SIRead_Jaguar 0xd08 // RF readback with SI ++#define rB_SIRead_Jaguar 0xd48 // RF readback with SI ++#define rRead_data_Jaguar 0xfffff ++#define rA_LSSIWrite_Jaguar 0xc90 // RF write addr ++#define rB_LSSIWrite_Jaguar 0xe90 // RF write addr ++#define bLSSIWrite_data_Jaguar 0x000fffff ++#define bLSSIWrite_addr_Jaguar 0x0ff00000 ++ ++ ++ ++// YN: mask the following register definition temporarily ++#define rFPGA0_XA_RFInterfaceOE 0x860 // RF Channel switch ++#define rFPGA0_XB_RFInterfaceOE 0x864 ++ ++#define rFPGA0_XAB_RFInterfaceSW 0x870 // RF Interface Software Control ++#define rFPGA0_XCD_RFInterfaceSW 0x874 ++ ++//#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter ++//#define rFPGA0_XCD_RFParameter 0x87c ++ ++//#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? ++//#define rFPGA0_AnalogParameter2 0x884 ++//#define rFPGA0_AnalogParameter3 0x888 ++//#define rFPGA0_AdDaClockEn 0x888 // enable ad/da clock1 for dual-phy ++//#define rFPGA0_AnalogParameter4 0x88c ++ ++ ++// CCK TX scaling ++#define rCCK_TxFilter1_Jaguar 0xa20 ++#define bCCK_TxFilter1_C0_Jaguar 0x00ff0000 ++#define bCCK_TxFilter1_C1_Jaguar 0xff000000 ++#define rCCK_TxFilter2_Jaguar 0xa24 ++#define bCCK_TxFilter2_C2_Jaguar 0x000000ff ++#define bCCK_TxFilter2_C3_Jaguar 0x0000ff00 ++#define bCCK_TxFilter2_C4_Jaguar 0x00ff0000 ++#define bCCK_TxFilter2_C5_Jaguar 0xff000000 ++#define rCCK_TxFilter3_Jaguar 0xa28 ++#define bCCK_TxFilter3_C6_Jaguar 0x000000ff ++#define bCCK_TxFilter3_C7_Jaguar 0x0000ff00 ++ ++ ++// YN: mask the following register definition temporarily ++//#define rPdp_AntA 0xb00 ++//#define rPdp_AntA_4 0xb04 ++//#define rConfig_Pmpd_AntA 0xb28 ++//#define rConfig_AntA 0xb68 ++//#define rConfig_AntB 0xb6c ++//#define rPdp_AntB 0xb70 ++//#define rPdp_AntB_4 0xb74 ++//#define rConfig_Pmpd_AntB 0xb98 ++//#define rAPK 0xbd8 ++ ++// RXIQC ++#define rA_RxIQC_AB_Jaguar 0xc10 //RxIQ imblance matrix coeff. A & B ++#define rA_RxIQC_CD_Jaguar 0xc14 //RxIQ imblance matrix coeff. C & D ++#define rA_TxScale_Jaguar 0xc1c // Pah_A TX scaling factor ++#define rB_TxScale_Jaguar 0xe1c // Path_B TX scaling factor ++#define rB_RxIQC_AB_Jaguar 0xe10 //RxIQ imblance matrix coeff. A & B ++#define rB_RxIQC_CD_Jaguar 0xe14 //RxIQ imblance matrix coeff. C & D ++#define b_RxIQC_AC_Jaguar 0x02ff // bit mask for IQC matrix element A & C ++#define b_RxIQC_BD_Jaguar 0x02ff0000 // bit mask for IQC matrix element A & C ++ ++ ++// DIG-related ++#define rA_IGI_Jaguar 0xc50 // Initial Gain for path-A ++#define rB_IGI_Jaguar 0xe50 // Initial Gain for path-B ++#define rOFDM_FalseAlarm1_Jaguar 0xf48 // counter for break ++#define rOFDM_FalseAlarm2_Jaguar 0xf4c // counter for spoofing ++#define rCCK_FalseAlarm_Jaguar 0xa5c // counter for cck false alarm ++#define b_FalseAlarm_Jaguar 0xffff ++#define rCCK_CCA_Jaguar 0xa08 // cca threshold ++#define bCCK_CCA_Jaguar 0x00ff0000 ++ ++// Tx Power Ttraining-related ++#define rA_TxPwrTraing_Jaguar 0xc54 ++#define rB_TxPwrTraing_Jaguar 0xe54 ++ ++// Report-related ++#define rOFDM_ShortCFOAB_Jaguar 0xf60 ++#define rOFDM_LongCFOAB_Jaguar 0xf64 ++#define rOFDM_EndCFOAB_Jaguar 0xf70 ++#define rOFDM_AGCReport_Jaguar 0xf84 ++#define rOFDM_RxSNR_Jaguar 0xf88 ++#define rOFDM_RxEVMCSI_Jaguar 0xf8c ++#define rOFDM_SIGReport_Jaguar 0xf90 ++ ++// Misc functions ++#define rEDCCA_Jaguar 0x8a4 // EDCCA ++#define bEDCCA_Jaguar 0xffff ++#define rAGC_table_Jaguar 0x82c // AGC tabel select ++#define bAGC_table_Jaguar 0x3 ++#define b_sel5g_Jaguar 0x1000 // sel5g ++#define b_LNA_sw_Jaguar 0x8000 // HW/WS control for LNA ++#define rFc_area_Jaguar 0x860 // fc_area ++#define bFc_area_Jaguar 0x1ffe000 ++#define rSingleTone_ContTx_Jaguar 0x914 ++ ++// RFE ++#define rA_RFE_Pinmux_Jaguar 0xcb0 // Path_A RFE cotrol pinmux ++#define rB_RFE_Pinmux_Jaguar 0xeb0 // Path_B RFE control pinmux ++#define rA_RFE_Inv_Jaguar 0xcb4 // Path_A RFE cotrol ++#define rB_RFE_Inv_Jaguar 0xeb4 // Path_B RFE control ++#define rA_RFE_Jaguar 0xcb8 // Path_A RFE cotrol ++#define rB_RFE_Jaguar 0xeb8 // Path_B RFE control ++#define r_ANTSEL_SW_Jaguar 0x900 // ANTSEL SW Control ++#define bMask_RFEInv_Jaguar 0x3ff00000 ++#define bMask_AntselPathFollow_Jaguar 0x00030000 ++ ++// TX AGC ++#define rTxAGC_A_CCK11_CCK1_JAguar 0xc20 ++#define rTxAGC_A_Ofdm18_Ofdm6_JAguar 0xc24 ++#define rTxAGC_A_Ofdm54_Ofdm24_JAguar 0xc28 ++#define rTxAGC_A_MCS3_MCS0_JAguar 0xc2c ++#define rTxAGC_A_MCS7_MCS4_JAguar 0xc30 ++#define rTxAGC_A_MCS11_MCS8_JAguar 0xc34 ++#define rTxAGC_A_MCS15_MCS12_JAguar 0xc38 ++#define rTxAGC_A_Nss1Index3_Nss1Index0_JAguar 0xc3c ++#define rTxAGC_A_Nss1Index7_Nss1Index4_JAguar 0xc40 ++#define rTxAGC_A_Nss2Index1_Nss1Index8_JAguar 0xc44 ++#define rTxAGC_A_Nss2Index5_Nss2Index2_JAguar 0xc48 ++#define rTxAGC_A_Nss2Index9_Nss2Index6_JAguar 0xc4c ++#define rTxAGC_B_CCK11_CCK1_JAguar 0xe20 ++#define rTxAGC_B_Ofdm18_Ofdm6_JAguar 0xe24 ++#define rTxAGC_B_Ofdm54_Ofdm24_JAguar 0xe28 ++#define rTxAGC_B_MCS3_MCS0_JAguar 0xe2c ++#define rTxAGC_B_MCS7_MCS4_JAguar 0xe30 ++#define rTxAGC_B_MCS11_MCS8_JAguar 0xe34 ++#define rTxAGC_B_MCS15_MCS12_JAguar 0xe38 ++#define rTxAGC_B_Nss1Index3_Nss1Index0_JAguar 0xe3c ++#define rTxAGC_B_Nss1Index7_Nss1Index4_JAguar 0xe40 ++#define rTxAGC_B_Nss2Index1_Nss1Index8_JAguar 0xe44 ++#define rTxAGC_B_Nss2Index5_Nss2Index2_JAguar 0xe48 ++#define rTxAGC_B_Nss2Index9_Nss2Index6_JAguar 0xe4c ++#define bTxAGC_byte0_Jaguar 0xff ++#define bTxAGC_byte1_Jaguar 0xff00 ++#define bTxAGC_byte2_Jaguar 0xff0000 ++#define bTxAGC_byte3_Jaguar 0xff000000 ++ ++// IQK YN: temporaily mask this part ++//#define rFPGA0_IQK 0xe28 ++//#define rTx_IQK_Tone_A 0xe30 ++//#define rRx_IQK_Tone_A 0xe34 ++//#define rTx_IQK_PI_A 0xe38 ++//#define rRx_IQK_PI_A 0xe3c ++ ++//#define rTx_IQK 0xe40 ++//#define rRx_IQK 0xe44 ++//#define rIQK_AGC_Pts 0xe48 ++//#define rIQK_AGC_Rsp 0xe4c ++//#define rTx_IQK_Tone_B 0xe50 ++//#define rRx_IQK_Tone_B 0xe54 ++//#define rTx_IQK_PI_B 0xe58 ++//#define rRx_IQK_PI_B 0xe5c ++//#define rIQK_AGC_Cont 0xe60 ++ ++ ++// AFE-related ++#define rA_AFEPwr1_Jaguar 0xc60 // dynamic AFE power control ++#define rA_AFEPwr2_Jaguar 0xc64 // dynamic AFE power control ++#define rA_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xc68 ++#define rA_Tx_CCKBBON_OFDMRFON_Jaguar 0xc6c ++#define rA_Tx_OFDMBBON_Tx2Rx_Jaguar 0xc70 ++#define rA_Tx2Tx_RXCCK_Jaguar 0xc74 ++#define rA_Rx_OFDM_WaitRIFS_Jaguar 0xc78 ++#define rA_Rx2Rx_BT_Jaguar 0xc7c ++#define rA_sleep_nav_Jaguar 0xc80 ++#define rA_pmpd_Jaguar 0xc84 ++#define rB_AFEPwr1_Jaguar 0xe60 // dynamic AFE power control ++#define rB_AFEPwr2_Jaguar 0xe64 // dynamic AFE power control ++#define rB_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xe68 ++#define rB_Tx_CCKBBON_OFDMRFON_Jaguar 0xe6c ++#define rB_Tx_OFDMBBON_Tx2Rx_Jaguar 0xe70 ++#define rB_Tx2Tx_RXCCK_Jaguar 0xe74 ++#define rB_Rx_OFDM_WaitRIFS_Jaguar 0xe78 ++#define rB_Rx2Rx_BT_Jaguar 0xe7c ++#define rB_sleep_nav_Jaguar 0xe80 ++#define rB_pmpd_Jaguar 0xe84 ++ ++ ++// YN: mask these registers temporaily ++//#define rTx_Power_Before_IQK_A 0xe94 ++//#define rTx_Power_After_IQK_A 0xe9c ++ ++//#define rRx_Power_Before_IQK_A 0xea0 ++//#define rRx_Power_Before_IQK_A_2 0xea4 ++//#define rRx_Power_After_IQK_A 0xea8 ++//#define rRx_Power_After_IQK_A_2 0xeac ++ ++//#define rTx_Power_Before_IQK_B 0xeb4 ++//#define rTx_Power_After_IQK_B 0xebc ++ ++//#define rRx_Power_Before_IQK_B 0xec0 ++//#define rRx_Power_Before_IQK_B_2 0xec4 ++//#define rRx_Power_After_IQK_B 0xec8 ++//#define rRx_Power_After_IQK_B_2 0xecc ++ ++ ++// RSSI Dump ++#define rA_RSSIDump_Jaguar 0xBF0 ++#define rB_RSSIDump_Jaguar 0xBF1 ++#define rS1_RXevmDump_Jaguar 0xBF4 ++#define rS2_RXevmDump_Jaguar 0xBF5 ++#define rA_RXsnrDump_Jaguar 0xBF6 ++#define rB_RXsnrDump_Jaguar 0xBF7 ++#define rA_CfoShortDump_Jaguar 0xBF8 ++#define rB_CfoShortDump_Jaguar 0xBFA ++#define rA_CfoLongDump_Jaguar 0xBEC ++#define rB_CfoLongDump_Jaguar 0xBEE ++ ++ ++// RF Register +// -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 1. Page1(0x100) -+// -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c ++#define RF_AC_Jaguar 0x00 // ++#define RF_RF_Top_Jaguar 0x07 // ++#define RF_TXLOK_Jaguar 0x08 // ++#define RF_TXAPK_Jaguar 0x0B ++#define RF_CHNLBW_Jaguar 0x18 // RF channel and BW switch ++#define RF_TxLCTank_Jaguar 0x54 ++#define RF_APK_Jaguar 0x63 ++#define bRF_CHNLBW_MOD_AG_Jaguar 0x70300 ++#define bRF_CHNLBW_BW 0xc00 ++#define RF_RCK1_Jaguar 0x1c // ++#define RF_RCK2_Jaguar 0x1d ++#define RF_RCK3_Jaguar 0x1e ++#define RF_LCK 0xB4 + -+// -+// 2. Page2(0x200) -+// -+// The following two definition are only used for USB interface. -+#define RF_BB_CMD_ADDR 0x02c0 // RF/BB read/write command address. -+#define RF_BB_CMD_DATA 0x02c4 // RF/BB read/write command data. -+ -+// -+// 3. Page8(0x800) -+// -+#define rFPGA0_RFMOD 0x800 //RF mode & CCK TxSC // RF BW Setting?? -+ -+#define rFPGA0_TxInfo 0x804 // Status report?? -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c // Set TX PWR init gain? -+ -+#define rFPGA0_RFTiming1 0x810 // Useless now -+#define rFPGA0_RFTiming2 0x814 -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 // RF 3 wire register -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+ -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_RFWakeUpParameter 0x850 // Useless now -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 // RF Channel switch -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 // RF Channel switch -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 // RF Interface Software Control -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 // Useless now -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 // Tranceiver LSSI Readback -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 // Useless now -+#define TransceiverA_HSPI_Readback 0x8b8 // Transceiver A HSPI Readback -+#define TransceiverB_HSPI_Readback 0x8bc // Transceiver B HSPI Readback -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 // Useless now // RF Interface Readback Value -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 // Useless now -+ -+// -+// 4. Page9(0x900) -+// -+#define rFPGA1_RFMOD 0x900 //RF mode & OFDM TxSC // RF BW Setting?? -+ -+#define rFPGA1_TxBlock 0x904 // Useless now -+#define rFPGA1_DebugSelect 0x908 // Useless now -+#define rFPGA1_TxInfo 0x90c // Useless now // Status report?? -+#define rS0S1_PathSwitch 0x948 -+ -+// -+// 5. PageA(0xA00) -+// -+// Set Control channel to upper or lower. These settings are required only for 40MHz -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 // Disable init gain now // Select RX path by RSSI -+#define rCCK0_CCA 0xa08 // Disable init gain now // Init gain -+ -+#define rCCK0_RxAGC1 0xa0c //AGC default value, saturation level // Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series -+#define rCCK0_RxAGC2 0xa10 //AGC & DAGC -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 //Timing recovery & Channel estimation threshold -+#define rCCK0_DSPParameter2 0xa1c //SQ threshold -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 //debug port and Tx filter3 -+#define rCCK0_FalseAlarmReport 0xa2c //0xa2d useless now 0xa30-a4f channel report -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 //0xa57 -+#define rCCK0_FACounterLower 0xa5c //0xa5b -+#define rCCK0_FACounterUpper 0xa58 //0xa5c -+// -+// PageB(0xB00) -+// -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rConfig_Pmpd_AntB 0xb98 -+#define rAPK 0xbd8 -+ -+// -+// 6. PageC(0xC00) -+// -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 //RxIQ DC offset, Rx digital filter, DC notch filter -+#define rOFDM0_XARxIQImbalance 0xc14 //RxIQ imblance matrix -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 //PD,BW & SBD // DM tune init gain -+#define rOFDM0_RxDetector2 0xc34 //SBD & Fame Sync. -+#define rOFDM0_RxDetector3 0xc38 //Frame Sync. -+#define rOFDM0_RxDetector4 0xc3c //PD, SBD, Frame Sync & Short-GI -+ -+#define rOFDM0_RxDSP 0xc40 //Rx Sync Path -+#define rOFDM0_CFOandDAGC 0xc44 //CFO & DAGC -+#define rOFDM0_CCADropThreshold 0xc48 //CCA Drop threshold -+#define rOFDM0_ECCAThreshold 0xc4c // energy CCA -+ -+#define rOFDM0_XAAGCCore1 0xc50 // DIG -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 // TX PWR TRACK and DIG -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+// -+// 7. PageD(0xD00) -+// -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 // No setting now -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 //cca, parity fail -+#define rOFDM_PHYCounter2 0xda4 //rate illegal, crc8 fail -+#define rOFDM_PHYCounter3 0xda8 //MCS not support -+ -+#define rOFDM_ShortCFOAB 0xdac // No setting now -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+// -+// 8. PageE(0xE00) -+// -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+// -+// 7. RF Register 0x00-0x2E (RF 8256) -+// RF-0222D 0x00-3F -+// -+//Zebra1 -+#define rZebra1_HSSIEnable 0x0 // Useless now -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+#define rZebra1_Channel 0x7 // RF channel switch -+ -+//#endif -+#define rZebra1_TxGain 0x8 // Useless now -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+//Zebra4 -+#define rGlobalCtrl 0 // Useless now -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+//RTL8258 -+#define rRTL8258_TxLPF 0x11 // Useless now -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa + +// +// RL6052 Register definition +// -+#define RF_AC 0x00 // -+ -+#define RF_IQADJ_G1 0x01 // -+#define RF_IQADJ_G2 0x02 // -+#define RF_BS_PA_APSET_G1_G4 0x03 -+#define RF_BS_PA_APSET_G5_G8 0x04 -+#define RF_POW_TRSW 0x05 // -+ -+#define RF_GAIN_RX 0x06 // -+#define RF_GAIN_TX 0x07 // -+ -+#define RF_TXM_IDAC 0x08 // -+#define RF_IPA_G 0x09 // -+#define RF_TXBIAS_G 0x0A -+#define RF_TXPA_AG 0x0B -+#define RF_IPA_A 0x0C // -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_BS_IQGEN 0x0F // -+ -+#define RF_MODE1 0x10 // -+#define RF_MODE2 0x11 // -+ -+#define RF_RX_AGC_HP 0x12 // -+#define RF_TX_AGC 0x13 // -+#define RF_BIAS 0x14 // -+#define RF_IPA 0x15 // -+#define RF_TXBIAS 0x16 // -+#define RF_POW_ABILITY 0x17 // -+#define RF_MODE_AG 0x18 // -+#define rRfChannel 0x18 // RF channel and BW switch -+#define RF_CHNLBW 0x18 // RF channel and BW switch -+#define RF_TOP 0x19 // -+ -+#define RF_RX_G1 0x1A // -+#define RF_RX_G2 0x1B // -+ -+#define RF_RX_BB2 0x1C // -+#define RF_RX_BB1 0x1D // -+ -+#define RF_RCK1 0x1E // -+#define RF_RCK2 0x1F // -+ -+#define RF_TX_G1 0x20 // -+#define RF_TX_G2 0x21 // -+#define RF_TX_G3 0x22 // -+ -+#define RF_TX_BB1 0x23 // -+ -+#define RF_T_METER 0x24 // -+ -+#define RF_SYN_G1 0x25 // RF TX Power control -+#define RF_SYN_G2 0x26 // RF TX Power control -+#define RF_SYN_G3 0x27 // RF TX Power control -+#define RF_SYN_G4 0x28 // RF TX Power control -+#define RF_SYN_G5 0x29 // RF TX Power control -+#define RF_SYN_G6 0x2A // RF TX Power control -+#define RF_SYN_G7 0x2B // RF TX Power control -+#define RF_SYN_G8 0x2C // RF TX Power control -+ -+#define RF_RCK_OS 0x30 // RF TX PA control -+ -+#define RF_TXPA_G1 0x31 // RF TX PA control -+#define RF_TXPA_G2 0x32 // RF TX PA control -+#define RF_TXPA_G3 0x33 // RF TX PA control -+#define RF_TX_BIAS_A 0x35 -+#define RF_TX_BIAS_D 0x36 -+#define RF_LOBF_9 0x38 -+#define RF_RXRF_A3 0x3C // -+#define RF_TRSW 0x3F -+ -+#define RF_TXRF_A2 0x41 -+#define RF_TXPA_G4 0x46 -+#define RF_TXPA_A4 0x4B -+#define RF_0x52 0x52 -+#define RF_RXG_MIX_SWBW 0x87 -+#define RF_DBG_LP_RX2 0xDF -+#define RF_WE_LUT 0xEF -+#define RF_S0S1 0xB0 -+ -+#define RF_TX_GAIN_OFFSET_8188F(_val) (abs((_val)) | (((_val) > 0) ? BIT5 : 0)) ++#define RF_AC 0x00 // ++#define RF_IPA_A 0x0C // ++#define RF_TXBIAS_A 0x0D ++#define RF_BS_PA_APSET_G9_G11 0x0E ++#define RF_MODE1 0x10 // ++#define RF_MODE2 0x11 // ++#define RF_CHNLBW 0x18 // RF channel and BW switch ++#define RF_RCK_OS 0x30 // RF TX PA control ++#define RF_TXPA_G1 0x31 // RF TX PA control ++#define RF_TXPA_G2 0x32 // RF TX PA control ++#define RF_TXPA_G3 0x33 // RF TX PA control ++#define RF_0x52 0x52 ++#define RF_WE_LUT 0xEF + +// +//Bit Mask +// +// 1. Page1(0x100) -+#define bBBResetB 0x100 // Useless now? -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 ++#define bBBResetB 0x100 // Useless now? ++#define bGlobalResetB 0x200 ++#define bOFDMTxStart 0x4 ++#define bCCKTxStart 0x8 ++#define bCRC32Debug 0x100 ++#define bPMACLoopback 0x10 ++#define bTxLSIG 0xffffff ++#define bOFDMTxRate 0xf ++#define bOFDMTxReserved 0x10 ++#define bOFDMTxLength 0x1ffe0 ++#define bOFDMTxParity 0x20000 ++#define bTxHTSIG1 0xffffff ++#define bTxHTMCSRate 0x7f ++#define bTxHTBW 0x80 ++#define bTxHTLength 0xffff00 ++#define bTxHTSIG2 0xffffff ++#define bTxHTSmoothing 0x1 ++#define bTxHTSounding 0x2 ++#define bTxHTReserved 0x4 ++#define bTxHTAggreation 0x8 ++#define bTxHTSTBC 0x30 ++#define bTxHTAdvanceCoding 0x40 ++#define bTxHTShortGI 0x80 ++#define bTxHTNumberHT_LTF 0x300 ++#define bTxHTCRC8 0x3fc00 ++#define bCounterReset 0x10000 ++#define bNumOfOFDMTx 0xffff ++#define bNumOfCCKTx 0xffff0000 ++#define bTxIdleInterval 0xffff ++#define bOFDMService 0xffff0000 ++#define bTxMACHeader 0xffffffff ++#define bTxDataInit 0xff ++#define bTxHTMode 0x100 ++#define bTxDataType 0x30000 ++#define bTxRandomSeed 0xffffffff ++#define bCCKTxPreamble 0x1 ++#define bCCKTxSFD 0xffff0000 ++#define bCCKTxSIG 0xff ++#define bCCKTxService 0xff00 ++#define bCCKLengthExt 0x8000 ++#define bCCKTxLength 0xffff0000 ++#define bCCKTxCRC16 0xffff ++#define bCCKTxStatus 0x1 ++#define bOFDMTxStatus 0x2 ++ ++ ++// ++// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF ++// 1. Page1(0x100) ++// ++#define rPMAC_Reset 0x100 ++#define rPMAC_TxStart 0x104 ++#define rPMAC_TxLegacySIG 0x108 ++#define rPMAC_TxHTSIG1 0x10c ++#define rPMAC_TxHTSIG2 0x110 ++#define rPMAC_PHYDebug 0x114 ++#define rPMAC_TxPacketNum 0x118 ++#define rPMAC_TxIdle 0x11c ++#define rPMAC_TxMACHeader0 0x120 ++#define rPMAC_TxMACHeader1 0x124 ++#define rPMAC_TxMACHeader2 0x128 ++#define rPMAC_TxMACHeader3 0x12c ++#define rPMAC_TxMACHeader4 0x130 ++#define rPMAC_TxMACHeader5 0x134 ++#define rPMAC_TxDataType 0x138 ++#define rPMAC_TxRandomSeed 0x13c ++#define rPMAC_CCKPLCPPreamble 0x140 ++#define rPMAC_CCKPLCPHeader 0x144 ++#define rPMAC_CCKCRC16 0x148 ++#define rPMAC_OFDMRxCRC32OK 0x170 ++#define rPMAC_OFDMRxCRC32Er 0x174 ++#define rPMAC_OFDMRxParityEr 0x178 ++#define rPMAC_OFDMRxCRC8Er 0x17c ++#define rPMAC_CCKCRxRC16Er 0x180 ++#define rPMAC_CCKCRxRC32Er 0x184 ++#define rPMAC_CCKCRxRC32OK 0x188 ++#define rPMAC_TxStatus 0x18c ++ ++// ++// 3. Page8(0x800) ++// ++#define rFPGA0_RFMOD 0x800 //RF mode & CCK TxSC // RF BW Setting?? ++ ++#define rFPGA0_TxInfo 0x804 // Status report?? ++#define rFPGA0_PSDFunction 0x808 ++#define rFPGA0_TxGainStage 0x80c // Set TX PWR init gain? ++ ++#define rFPGA0_XA_HSSIParameter1 0x820 // RF 3 wire register ++#define rFPGA0_XA_HSSIParameter2 0x824 ++#define rFPGA0_XB_HSSIParameter1 0x828 ++#define rFPGA0_XB_HSSIParameter2 0x82c ++ ++#define rFPGA0_XAB_SwitchControl 0x858 // RF Channel switch ++#define rFPGA0_XCD_SwitchControl 0x85c ++ ++#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter ++#define rFPGA0_XCD_RFParameter 0x87c ++ ++#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? ++#define rFPGA0_AnalogParameter2 0x884 ++#define rFPGA0_AnalogParameter3 0x888 ++#define rFPGA0_AdDaClockEn 0x888 // enable ad/da clock1 for dual-phy ++#define rFPGA0_AnalogParameter4 0x88c ++#define rFPGA0_XB_LSSIReadBack 0x8a4 ++// ++// 4. Page9(0x900) ++// ++#define rFPGA1_RFMOD 0x900 //RF mode & OFDM TxSC // RF BW Setting?? ++ ++#define rFPGA1_TxBlock 0x904 // Useless now ++#define rFPGA1_DebugSelect 0x908 // Useless now ++#define rFPGA1_TxInfo 0x90c // Useless now // Status report?? ++ ++// ++// PageA(0xA00) ++// ++#define rCCK0_System 0xa00 ++#define rCCK0_AFESetting 0xa04 // Disable init gain now // Select RX path by RSSI ++#define rCCK0_TxFilter1 0xa20 ++#define rCCK0_TxFilter2 0xa24 ++#define rCCK0_DebugPort 0xa28 //debug port and Tx filter3 ++ ++// ++// PageB(0xB00) ++// ++#define rPdp_AntA 0xb00 ++#define rPdp_AntA_4 0xb04 ++#define rConfig_Pmpd_AntA 0xb28 ++#define rConfig_AntA 0xb68 ++#define rConfig_AntB 0xb6c ++#define rPdp_AntB 0xb70 ++#define rPdp_AntB_4 0xb74 ++#define rConfig_Pmpd_AntB 0xb98 ++#define rAPK 0xbd8 ++ ++// ++// 6. PageC(0xC00) ++// ++#define rOFDM0_LSTF 0xc00 ++ ++#define rOFDM0_TRxPathEnable 0xc04 ++#define rOFDM0_TRMuxPar 0xc08 ++#define rOFDM0_TRSWIsolation 0xc0c ++ ++#define rOFDM0_XARxAFE 0xc10 //RxIQ DC offset, Rx digital filter, DC notch filter ++#define rOFDM0_XARxIQImbalance 0xc14 //RxIQ imblance matrix ++#define rOFDM0_XBRxAFE 0xc18 ++#define rOFDM0_XBRxIQImbalance 0xc1c ++#define rOFDM0_XCRxAFE 0xc20 ++#define rOFDM0_XCRxIQImbalance 0xc24 ++#define rOFDM0_XDRxAFE 0xc28 ++#define rOFDM0_XDRxIQImbalance 0xc2c ++ ++#define rOFDM0_RxDetector1 0xc30 //PD,BW & SBD // DM tune init gain ++#define rOFDM0_RxDetector2 0xc34 //SBD & Fame Sync. ++#define rOFDM0_RxDetector3 0xc38 //Frame Sync. ++#define rOFDM0_RxDetector4 0xc3c //PD, SBD, Frame Sync & Short-GI ++ ++#define rOFDM0_RxDSP 0xc40 //Rx Sync Path ++#define rOFDM0_CFOandDAGC 0xc44 //CFO & DAGC ++#define rOFDM0_CCADropThreshold 0xc48 //CCA Drop threshold ++#define rOFDM0_ECCAThreshold 0xc4c // energy CCA ++ ++#define rOFDM0_XAAGCCore1 0xc50 // DIG ++#define rOFDM0_XAAGCCore2 0xc54 ++#define rOFDM0_XBAGCCore1 0xc58 ++#define rOFDM0_XBAGCCore2 0xc5c ++#define rOFDM0_XCAGCCore1 0xc60 ++#define rOFDM0_XCAGCCore2 0xc64 ++#define rOFDM0_XDAGCCore1 0xc68 ++#define rOFDM0_XDAGCCore2 0xc6c ++ ++#define rOFDM0_AGCParameter1 0xc70 ++#define rOFDM0_AGCParameter2 0xc74 ++#define rOFDM0_AGCRSSITable 0xc78 ++#define rOFDM0_HTSTFAGC 0xc7c ++ ++#define rOFDM0_XATxIQImbalance 0xc80 // TX PWR TRACK and DIG ++#define rOFDM0_XATxAFE 0xc84 ++#define rOFDM0_XBTxIQImbalance 0xc88 ++#define rOFDM0_XBTxAFE 0xc8c ++#define rOFDM0_XCTxIQImbalance 0xc90 ++#define rOFDM0_XCTxAFE 0xc94 ++#define rOFDM0_XDTxIQImbalance 0xc98 ++#define rOFDM0_XDTxAFE 0xc9c ++ ++#define rOFDM0_RxIQExtAnta 0xca0 ++#define rOFDM0_TxCoeff1 0xca4 ++#define rOFDM0_TxCoeff2 0xca8 ++#define rOFDM0_TxCoeff3 0xcac ++#define rOFDM0_TxCoeff4 0xcb0 ++#define rOFDM0_TxCoeff5 0xcb4 ++#define rOFDM0_TxCoeff6 0xcb8 ++#define rOFDM0_RxHPParameter 0xce0 ++#define rOFDM0_TxPseudoNoiseWgt 0xce4 ++#define rOFDM0_FrameSync 0xcf0 ++#define rOFDM0_DFSReport 0xcf4 ++ ++// ++// 7. PageD(0xD00) ++// ++#define rOFDM1_LSTF 0xd00 ++#define rOFDM1_TRxPathEnable 0xd04 ++ ++// ++// 8. PageE(0xE00) ++// ++#define rTxAGC_A_Rate18_06 0xe00 ++#define rTxAGC_A_Rate54_24 0xe04 ++#define rTxAGC_A_CCK1_Mcs32 0xe08 ++#define rTxAGC_A_Mcs03_Mcs00 0xe10 ++#define rTxAGC_A_Mcs07_Mcs04 0xe14 ++#define rTxAGC_A_Mcs11_Mcs08 0xe18 ++#define rTxAGC_A_Mcs15_Mcs12 0xe1c ++ ++#define rTxAGC_B_Rate18_06 0x830 ++#define rTxAGC_B_Rate54_24 0x834 ++#define rTxAGC_B_CCK1_55_Mcs32 0x838 ++#define rTxAGC_B_Mcs03_Mcs00 0x83c ++#define rTxAGC_B_Mcs07_Mcs04 0x848 ++#define rTxAGC_B_Mcs11_Mcs08 0x84c ++#define rTxAGC_B_Mcs15_Mcs12 0x868 ++#define rTxAGC_B_CCK11_A_CCK2_11 0x86c ++ ++#define rFPGA0_IQK 0xe28 ++#define rTx_IQK_Tone_A 0xe30 ++#define rRx_IQK_Tone_A 0xe34 ++#define rTx_IQK_PI_A 0xe38 ++#define rRx_IQK_PI_A 0xe3c ++ ++#define rTx_IQK 0xe40 ++#define rRx_IQK 0xe44 ++#define rIQK_AGC_Pts 0xe48 ++#define rIQK_AGC_Rsp 0xe4c ++#define rTx_IQK_Tone_B 0xe50 ++#define rRx_IQK_Tone_B 0xe54 ++#define rTx_IQK_PI_B 0xe58 ++#define rRx_IQK_PI_B 0xe5c ++#define rIQK_AGC_Cont 0xe60 ++ ++#define rBlue_Tooth 0xe6c ++#define rRx_Wait_CCA 0xe70 ++#define rTx_CCK_RFON 0xe74 ++#define rTx_CCK_BBON 0xe78 ++#define rTx_OFDM_RFON 0xe7c ++#define rTx_OFDM_BBON 0xe80 ++#define rTx_To_Rx 0xe84 ++#define rTx_To_Tx 0xe88 ++#define rRx_CCK 0xe8c ++ ++#define rTx_Power_Before_IQK_A 0xe94 ++#define rTx_Power_After_IQK_A 0xe9c ++ ++#define rRx_Power_Before_IQK_A 0xea0 ++#define rRx_Power_Before_IQK_A_2 0xea4 ++#define rRx_Power_After_IQK_A 0xea8 ++#define rRx_Power_After_IQK_A_2 0xeac ++ ++#define rTx_Power_Before_IQK_B 0xeb4 ++#define rTx_Power_After_IQK_B 0xebc ++ ++#define rRx_Power_Before_IQK_B 0xec0 ++#define rRx_Power_Before_IQK_B_2 0xec4 ++#define rRx_Power_After_IQK_B 0xec8 ++#define rRx_Power_After_IQK_B_2 0xecc ++ ++#define rRx_OFDM 0xed0 ++#define rRx_Wait_RIFS 0xed4 ++#define rRx_TO_Rx 0xed8 ++#define rStandby 0xedc ++#define rSleep 0xee0 ++#define rPMPD_ANAEN 0xeec + -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) + +// 2. Page8(0x800) -+#define bRFMOD 0x1 // Reg 0x800 rFPGA0_RFMOD -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 // Useless now -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bAntennaSelect 0x0300 -+ -+#define bXBTxAGC 0xf00 // Reg 80c rFPGA0_TxGainStage -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 // Useless now -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf //Reg0x814 -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 //T2R -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 //chane gain at continue Tx -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 // Reg 0x820~84f rFPGA0_XA_HSSIParameter1 -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 // Useless now -+//#define bHWSISelect 0x8 -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 // Reg 0x870 rFPGA0_XAB_RFInterfaceSW -+ -+#define bRFSI_TRSW 0x20 // Useless now -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+ -+#define bLSSIReadAddress 0x7f800000 // T65 RF -+ -+#define bLSSIReadEdge 0x80000000 //LSSI "Read" edge signal -+ -+#define bLSSIReadBackData 0xfffff // T65 RF -+ -+#define bLSSIReadOKFlag 0x1000 // Useless now -+#define bCCKSampleRate 0x8 //0: 44MHz, 1:88MHz -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 // Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ -+ -+#define b80MClkDelay 0x18000000 // Useless -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 // Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 // Useless -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+// 3. Page9(0x900) -+#define bOFDMTxSC 0x30000000 // Useless -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff //reset debug page and also HWord, LWord -+#define bDebugItem 0xff //reset debug page and LWord -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 ++#define bRFMOD 0x1 // Reg 0x800 rFPGA0_RFMOD ++#define bJapanMode 0x2 ++#define bCCKTxSC 0x30 ++#define bCCKEn 0x1000000 ++#define bOFDMEn 0x2000000 ++#define bXBTxAGC 0xf00 // Reg 80c rFPGA0_TxGainStage ++#define bXCTxAGC 0xf000 ++#define bXDTxAGC 0xf0000 + +// 4. PageA(0xA00) -+#define bCCKBBMode 0x3 // Useless -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 ++#define bCCKBBMode 0x3 // Useless ++#define bCCKTxPowerSaving 0x80 ++#define bCCKRxPowerSaving 0x40 + -+#define bCCKSideBand 0x10 // Reg 0xa00 rCCK0_System 20/40 switch ++#define bCCKSideBand 0x10 // Reg 0xa00 rCCK0_System 20/40 switch + -+#define bCCKScramble 0x8 // Useless -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 //r_rx_clk -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 //CCK Rx Iinital gain polarity -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f //AGCsamp_dly -+#define bCCKFixedRxAGC 0x8000 -+//#define bCCKRxAGCFormat 0x4000 //remove to HSSI register 0x824 -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+// 5. PageC(0xC00) -+#define bNumOfSTF 0x3 // Useless -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 //the threshold for high power -+#define bRSSI_Gen 0x7f000000 //the threshold for ant diversity -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+//#define bRxMF_Hold 0x3800 -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 ++#define bCCKScramble 0x8 // Useless ++#define bCCKAntDiversity 0x8000 ++#define bCCKCarrierRecovery 0x4000 ++#define bCCKTxRate 0x3000 ++#define bCCKDCCancel 0x0800 ++#define bCCKISICancel 0x0400 ++#define bCCKMatchFilter 0x0200 ++#define bCCKEqualizer 0x0100 ++#define bCCKPreambleDetect 0x800000 ++#define bCCKFastFalseCCA 0x400000 ++#define bCCKChEstStart 0x300000 ++#define bCCKCCACount 0x080000 ++#define bCCKcs_lim 0x070000 ++#define bCCKBistMode 0x80000000 ++#define bCCKCCAMask 0x40000000 ++#define bCCKTxDACPhase 0x4 ++#define bCCKRxADCPhase 0x20000000 //r_rx_clk ++#define bCCKr_cp_mode0 0x0100 ++#define bCCKTxDCOffset 0xf0 ++#define bCCKRxDCOffset 0xf ++#define bCCKCCAMode 0xc000 ++#define bCCKFalseCS_lim 0x3f00 ++#define bCCKCS_ratio 0xc00000 ++#define bCCKCorgBit_sel 0x300000 ++#define bCCKPD_lim 0x0f0000 ++#define bCCKNewCCA 0x80000000 ++#define bCCKRxHPofIG 0x8000 ++#define bCCKRxIG 0x7f00 ++#define bCCKLNAPolarity 0x800000 ++#define bCCKRx1stGain 0x7f0000 ++#define bCCKRFExtend 0x20000000 //CCK Rx Iinital gain polarity ++#define bCCKRxAGCSatLevel 0x1f000000 ++#define bCCKRxAGCSatCount 0xe0 ++#define bCCKRxRFSettle 0x1f //AGCsamp_dly ++#define bCCKFixedRxAGC 0x8000 ++//#define bCCKRxAGCFormat 0x4000 //remove to HSSI register 0x824 ++#define bCCKAntennaPolarity 0x2000 ++#define bCCKTxFilterType 0x0c00 ++#define bCCKRxAGCReportType 0x0300 ++#define bCCKRxDAGCEn 0x80000000 ++#define bCCKRxDAGCPeriod 0x20000000 ++#define bCCKRxDAGCSatLevel 0x1f000000 ++#define bCCKTimingRecovery 0x800000 ++#define bCCKTxC0 0x3f0000 ++#define bCCKTxC1 0x3f000000 ++#define bCCKTxC2 0x3f ++#define bCCKTxC3 0x3f00 ++#define bCCKTxC4 0x3f0000 ++#define bCCKTxC5 0x3f000000 ++#define bCCKTxC6 0x3f ++#define bCCKTxC7 0x3f00 ++#define bCCKDebugPort 0xff0000 ++#define bCCKDACDebug 0x0f000000 ++#define bCCKFalseAlarmEnable 0x8000 ++#define bCCKFalseAlarmRead 0x4000 ++#define bCCKTRSSI 0x7f ++#define bCCKRxAGCReport 0xfe ++#define bCCKRxReport_AntSel 0x80000000 ++#define bCCKRxReport_MFOff 0x40000000 ++#define bCCKRxRxReport_SQLoss 0x20000000 ++#define bCCKRxReport_Pktloss 0x10000000 ++#define bCCKRxReport_Lockedbit 0x08000000 ++#define bCCKRxReport_RateError 0x04000000 ++#define bCCKRxReport_RxRate 0x03000000 ++#define bCCKRxFACounterLower 0xff ++#define bCCKRxFACounterUpper 0xff000000 ++#define bCCKRxHPAGCStart 0xe000 ++#define bCCKRxHPAGCFinal 0x1c00 ++#define bCCKRxFalseAlarmEnable 0x8000 ++#define bCCKFACounterFreeze 0x4000 ++#define bCCKTxPathSel 0x10000000 ++#define bCCKDefaultRxPath 0xc000000 ++#define bCCKOptionRxPath 0x3000000 + +// 6. PageE(0xE00) -+#define bSTBCEn 0x4 // Useless -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+//#define bRxPath1 0x01 -+//#define bRxPath2 0x02 -+//#define bRxPath3 0x04 -+//#define bRxPath4 0x08 -+//#define bTxPath1 0x10 -+//#define bTxPath2 0x20 -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 //total -+#define bShortCFOFLength 11 //fraction -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf // Useless -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 // Useless -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 // Useless -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+//Rx Pseduo noise -+#define bRxPesudoNoiseOn 0x20000000 // Useless -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+//7. RF Register -+//Zebra1 -+#define bZebra1_HSSIEnable 0x8 // Useless -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+//Zebra4 -+#define bRTL8256RegModeCtrl1 0x100 // Useless -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+//RTL8258 -+#define bRTL8258_TxLPFBW 0xc // Useless -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 ++#define bSTBCEn 0x4 // Useless ++#define bAntennaMapping 0x10 ++#define bNss 0x20 ++#define bCFOAntSumD 0x200 ++#define bPHYCounterReset 0x8000000 ++#define bCFOReportGet 0x4000000 ++#define bOFDMContinueTx 0x10000000 ++#define bOFDMSingleCarrier 0x20000000 ++#define bOFDMSingleTone 0x40000000 + + +// +// Other Definition +// + -+//byte endable for sb_write -+#define bByte0 0x1 // Useless -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf ++#define bEnable 0x1 // Useless ++#define bDisable 0x0 ++ ++//byte endable for srwrite ++#define bByte0 0x1 // Useless ++#define bByte1 0x2 ++#define bByte2 0x4 ++#define bByte3 0x8 ++#define bWord0 0x3 ++#define bWord1 0xc ++#define bDWord 0xf + +//for PutRegsetting & GetRegSetting BitMask -+#define bMaskByte0 0xff // Reg 0xc50 rOFDM0_XAAGCCore~0xC6f -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f ++#define bMaskByte0 0xff // Reg 0xc50 rOFDM0_XAAGCCore~0xC6f ++#define bMaskByte1 0xff00 ++#define bMaskByte2 0xff0000 ++#define bMaskByte3 0xff000000 ++#define bMaskHWord 0xffff0000 ++#define bMaskLWord 0x0000ffff ++#define bMaskDWord 0xffffffff ++#define bMask12Bits 0xfff ++#define bMaskH4Bits 0xf0000000 ++#define bMaskOFDM_D 0xffc00000 ++#define bMaskCCK 0x3f3f3f3f + -+ -+#define bEnable 0x1 // Useless -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 // Useless -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 //500ms // Useless -+#define tUpdateRxCounter 100 //100ms -+ -+#define rateCCK 0 // Useless -+#define rateOFDM 1 -+#define rateHT 2 -+ -+//define Register-End -+#define bPMAC_End 0x1ff // Useless -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+//define max debug item in each debug page -+//#define bMaxItem_FPGA_PHY0 0x9 -+//#define bMaxItem_FPGA_PHY1 0x3 -+//#define bMaxItem_PHY_11B 0x16 -+//#define bMaxItem_OFDM_PHY0 0x29 -+//#define bMaxItem_OFDM_PHY1 0x0 -+ -+#define bPMACControl 0x0 // Useless -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#define PathA 0x0 // Useless -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 + +/*--------------------------Define Parameters-------------------------------*/ + + -+// BB Register Definition -+// -+// 4. Page9(0x900) -+// -+#define rDPDT_control 0x92c -+#define rfe_ctrl_anta_src 0x930 -+#define rS0S1_PathSwitch 0x948 -+#define BBrx_DFIR 0x954 -+#define AGC_table_select 0xb2c -+ -+// -+// PageB(0xB00) -+// -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rPdp_AntA_8 0xb08 -+#define rPdp_AntA_C 0xb0c -+#define rPdp_AntA_10 0xb10 -+#define rPdp_AntA_14 0xb14 -+#define rPdp_AntA_18 0xb18 -+#define rPdp_AntA_1C 0xb1c -+#define rPdp_AntA_20 0xb20 -+#define rPdp_AntA_24 0xb24 -+ -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_ram64x16 0xb2c -+ -+#define rBndA 0xb30 -+#define rHssiPar 0xb34 -+ -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+ -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rPdp_AntB_8 0xb78 -+#define rPdp_AntB_C 0xb7c -+#define rPdp_AntB_10 0xb80 -+#define rPdp_AntB_14 0xb84 -+#define rPdp_AntB_18 0xb88 -+#define rPdp_AntB_1C 0xb8c -+#define rPdp_AntB_20 0xb90 -+#define rPdp_AntB_24 0xb94 -+ -+#define rConfig_Pmpd_AntB 0xb98 -+ -+#define rBndB 0xba0 -+ -+#define rAPK 0xbd8 -+#define rPm_Rx0_AntA 0xbdc -+#define rPm_Rx1_AntA 0xbe0 -+#define rPm_Rx2_AntA 0xbe4 -+#define rPm_Rx3_AntA 0xbe8 -+#define rPm_Rx0_AntB 0xbec -+#define rPm_Rx1_AntB 0xbf0 -+#define rPm_Rx2_AntB 0xbf4 -+#define rPm_Rx3_AntB 0xbf8 -+ +#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/Hal8812PwrSeq.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8812PwrSeq.h +--- linux-4.14.17/3rdparty/rtl8812au/include/Hal8812PwrSeq.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8812PwrSeq.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,204 @@ + -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8188FPwrSeq.h linux/3rdparty/rtl8812au/include/Hal8188FPwrSeq.h ---- linux.old/3rdparty/rtl8812au/include/Hal8188FPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8188FPwrSeq.h 2017-06-07 23:07:21.034689672 +0300 -@@ -0,0 +1,199 @@ -+#ifndef REALTEK_POWER_SEQUENCE_8188F -+#define REALTEK_POWER_SEQUENCE_8188F ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++#ifndef __HAL8812PWRSEQ_H__ ++#define __HAL8812PWRSEQ_H__ + +#include "HalPwrSeqCmd.h" + -+/* -+ Check document WM-20130815-JackieLau-RTL8188F_Power_Architecture v08.vsd ++/* ++ Check document WB-110628-DZ-RTL8195 (Jaguar) Power Architecture-R04.pdf + There are 6 HW Power States: + 0: POFF--Power Off + 1: PDN--Power Down @@ -293419,7657 +131842,367 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8188FPwrSeq.h linux/3rdparty/ + TRANS_SUS_TO_CARDEMU + TRANS_CARDEMU_TO_PDN + TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT ++ TRANS_LPS_TO_ACT + + TRANS_END +*/ -+#define RTL8188F_TRANS_CARDEMU_TO_ACT_STEPS 13 -+#define RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8188F_TRANS_CARDEMU_TO_SUS_STEPS 14 -+#define RTL8188F_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8188F_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8188F_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8188F_TRANS_ACT_TO_LPS_STEPS 11 -+#define RTL8188F_TRANS_LPS_TO_ACT_STEPS 13 -+#define RTL8188F_TRANS_ACT_TO_SWLPS_STEPS 21 -+#define RTL8188F_TRANS_SWLPS_TO_ACT_STEPS 14 -+#define RTL8188F_TRANS_END_STEPS 1 ++#define RTL8812_TRANS_CARDEMU_TO_ACT_STEPS 15 ++#define RTL8812_TRANS_ACT_TO_CARDEMU_STEPS 15 ++#define RTL8812_TRANS_CARDEMU_TO_SUS_STEPS 15 ++#define RTL8812_TRANS_SUS_TO_CARDEMU_STEPS 15 ++#define RTL8812_TRANS_CARDEMU_TO_PDN_STEPS 15 ++#define RTL8812_TRANS_PDN_TO_CARDEMU_STEPS 15 ++#define RTL8812_TRANS_ACT_TO_LPS_STEPS 15 ++#define RTL8812_TRANS_LPS_TO_ACT_STEPS 15 ++#define RTL8812_TRANS_END_STEPS 1 + + -+#define RTL8188F_TRANS_CARDEMU_TO_ACT \ ++#define RTL8812_TRANS_CARDEMU_TO_ACT \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ + {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT3), 0},/* 0x4[11]=1'b0 disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* 0x4[8]=1 polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ {0x0027, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x35}, /*0x27<=35 to reduce RF noise*/ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0},/* disable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ + -+#define RTL8188F_TRANS_ACT_TO_CARDEMU \ ++#define RTL8812_TRANS_ACT_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ ++ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ ++ /*{0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},//0x1F[7:0] = 0 turn off RF*/ \ ++ /*{0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},//0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x28}, /* 0x07[7:0] = 0x28 sps pwm mode */ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk =500k */ \ ++ /*{0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0|BIT1, 0}, // 0x02[1:0] = 0 reset BB */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ ++ ++#define RTL8812_TRANS_CARDEMU_TO_SUS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xcc},\ ++ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xEC},\ ++ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x07},/* gpio11 input mode, gpio10~8 output mode */ \ ++ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ ++ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ ++ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/* suspend option all off */ \ ++ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x80, BIT7},/*0x14[7] = 1 turn on ZCD */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, BIT0},/* 0x15[0] =1 trun on ZCD */ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x10, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk =500k */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 2b'11 enable WL suspend for PCIe*/ ++ ++#define RTL8812_TRANS_SUS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 2b'01enable WL suspend*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x10, 0},/*0x23[4] = 0 hpon LDO sleep mode leave */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, 0},/* 0x15[0] =0 trun off ZCD */ \ ++ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x80, 0},/*0x14[7] = 0 turn off ZCD */ \ ++ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ ++ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio11 input mode, gpio10~8 input mode */ ++ ++#define RTL8812_TRANS_CARDEMU_TO_CARDDIS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ /**{0x0194, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, //0x194[0]=0 , disable 32K clock*/ \ ++ /**{0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x94}, //0x93=0x94 , 90[30] =0 enable 500k ANA clock .switch clock from 12M to 500K , 90 [26] =0 disable EEprom loader clock*/ \ ++ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0}, /*0x03[2] = 0, reset 8051*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x05}, /*0x80=05h if reload fw, fill the default value of host_CPU handshake field*/ \ ++ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xcc},\ ++ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xEC},\ ++ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x07},/* gpio11 input mode, gpio10~8 output mode */ \ ++ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ ++ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ ++ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ ++ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x80, BIT7},/*0x14[7] = 1 turn on ZCD */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, BIT0},/* 0x15[0] =1 trun on ZCD */ \ ++ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, 0},/*0x12[0] = 0 force PFM mode */ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x10, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk =500k */ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07=0x20 , SOP option to disable BG/MB*/ \ ++ {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /*0x01f[1]=0 , disable RFC_0 control REG_RF_CTRL_8812 */ \ ++ {0x0076, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /*0x076[1]=0 , disable RFC_1 control REG_OPT_CTRL_8812 +2 */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 2b'01 enable WL suspend*/ ++ ++#define RTL8812_TRANS_CARDDIS_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*0x12[0] = 1 force PWM mode */ \ ++ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x80, 0},/*0x14[7] = 0 turn off ZCD */ \ ++ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, 0},/* 0x15[0] =0 trun off ZCD */ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x10, 0},/*0x23[4] = 0 hpon LDO leave sleep mode */ \ ++ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ ++ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio11 input mode, gpio10~8 input mode */ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0}, /*0x04[10] = 0, enable SW LPS PCIE only*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 2b'01enable WL suspend*/ \ ++ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2}, /*0x03[2] = 1, enable 8051*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ ++ ++ ++#define RTL8812_TRANS_CARDEMU_TO_PDN \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ ++ ++#define RTL8812_TRANS_PDN_TO_CARDEMU \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ ++ ++#define RTL8812_TRANS_ACT_TO_LPS \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x7F},/*Tx Pause*/ \ ++ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ ++ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated,and RF closed*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ ++ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ ++ ++ ++#define RTL8812_TRANS_LPS_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/ \ ++ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/ \ ++ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/ \ ++ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/ \ ++ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6|BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/ \ ++ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/ \ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/ \ ++ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ ++ ++#define RTL8812_TRANS_END \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // ++ ++ ++extern WLAN_PWR_CFG rtl8812_power_on_flow[RTL8812_TRANS_CARDEMU_TO_ACT_STEPS+RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_radio_off_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_card_disable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_card_enable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_suspend_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_SUS_STEPS+RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_resume_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_SUS_STEPS+RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_hwpdn_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_enter_lps_flow[RTL8812_TRANS_ACT_TO_LPS_STEPS+RTL8812_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8812_leave_lps_flow[RTL8812_TRANS_LPS_TO_ACT_STEPS+RTL8812_TRANS_END_STEPS]; ++ ++#endif //__HAL8812PWRSEQ_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/Hal8821APwrSeq.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8821APwrSeq.h +--- linux-4.14.17/3rdparty/rtl8812au/include/Hal8821APwrSeq.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8821APwrSeq.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,183 @@ ++#ifndef REALTEK_POWER_SEQUENCE_8821 ++#define REALTEK_POWER_SEQUENCE_8821 ++ ++#include "HalPwrSeqCmd.h" ++ ++/* ++ Check document WM-20121114-JackieLau-RTL8821A_Power_Architecture-R06.vsd ++ There are 6 HW Power States: ++ 0: POFF--Power Off ++ 1: PDN--Power Down ++ 2: CARDEMU--Card Emulation ++ 3: ACT--Active Mode ++ 4: LPS--Low Power State ++ 5: SUS--Suspend ++ ++ The transision from different states are defined below ++ TRANS_CARDEMU_TO_ACT ++ TRANS_ACT_TO_CARDEMU ++ TRANS_CARDEMU_TO_SUS ++ TRANS_SUS_TO_CARDEMU ++ TRANS_CARDEMU_TO_PDN ++ TRANS_ACT_TO_LPS ++ TRANS_LPS_TO_ACT ++ ++ TRANS_END ++*/ ++#define RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS 22 ++#define RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS 15 ++#define RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS 15 ++#define RTL8821A_TRANS_SUS_TO_CARDEMU_STEPS 15 ++#define RTL8821A_TRANS_CARDDIS_TO_CARDEMU_STEPS 15 ++#define RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS 15 ++#define RTL8821A_TRANS_PDN_TO_CARDEMU_STEPS 15 ++#define RTL8821A_TRANS_ACT_TO_LPS_STEPS 15 ++#define RTL8821A_TRANS_LPS_TO_ACT_STEPS 15 ++#define RTL8821A_TRANS_END_STEPS 1 ++ ++ ++#define RTL8821A_TRANS_CARDEMU_TO_ACT \ ++ /* format */ \ ++ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ ++ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ ++ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ ++ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ ++ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT4|BIT3), 0},/* disable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ \ ++ {0x004F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*0x4C[24] = 0x4F[0] = 1, switch DPDT_SEL_P output from WL BB */\ ++ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT5|BIT4), (BIT5|BIT4)},/*0x66[13] = 0x67[5] = 1, switch for PAPE_G/PAPE_A from WL BB ; 0x66[12] = 0x67[4] = 1, switch LNAON from WL BB */\ ++ {0x0025, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, 0},/*anapar_mac<118> , 0x25[6]=0 by wlan single function*/\ ++ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable falling edge triggering interrupt*/\ ++ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable GPIO9 interrupt mode*/\ ++ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 input mode*/\ ++ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*Enable HSISR GPIO[C:0] interrupt*/\ ++ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable HSISR GPIO9 interrupt*/\ ++ {0x007A, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x3A},/*0x7A = 0x3A start BT*/\ ++ {0x002E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF , 0x82 },/* 0x2C[23:12]=0x820 ; XTAL trim */ \ ++ {0x0010, PWR_CUT_A_MSK , PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6 , BIT6 },/* 0x10[6]=1 ; MPsW0x2CvA0x10[6]]1~WLAN */ \ ++ ++ ++#define RTL8821A_TRANS_ACT_TO_CARDEMU \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/*0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ -+ {0x0027, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x34}, /*0x27 <= 34, xtal_qsel=0 to xtal bring up*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ ++ {0x004F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*0x4C[24] = 0x4F[0] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ ++ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Enable rising edge triggering interrupt*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ ++ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ ++ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/ \ + -+#define RTL8188F_TRANS_CARDEMU_TO_SUS \ ++ ++#define RTL8821A_TRANS_CARDEMU_TO_SUS \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00}, /*0x07=0x00 , SOP option to disable BG/MB*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4|BIT3, (BIT4|BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3|BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ \ -+ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4},/* 0xC4[4] <= 1, turn off USB APHY LDO under suspend mode*/ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ + -+#define RTL8188F_TRANS_SUS_TO_CARDEMU \ ++#define RTL8821A_TRANS_SUS_TO_CARDEMU \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ \ -+ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0},/* 0xC4[4] <= 1, turn off USB APHY LDO under suspend mode*/ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ + -+#define RTL8188F_TRANS_CARDEMU_TO_CARDDIS \ ++#define RTL8821A_TRANS_CARDEMU_TO_CARDDIS \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00}, /*0x07=0x00 , SOP option to disable BG/MB*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07=0x20 , SOP option to disable BG/MB*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ ++ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ \ -+ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4},/* 0xC4[4] <= 1, turn off USB APHY LDO under suspend mode*/ ++ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ + -+#define RTL8188F_TRANS_CARDDIS_TO_CARDEMU \ ++#define RTL8821A_TRANS_CARDDIS_TO_CARDEMU \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ \ -+ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0},/* 0xC4[4] <= 1, turn off USB APHY LDO under suspend mode*/ ++ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ ++ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ + + -+#define RTL8188F_TRANS_CARDEMU_TO_PDN \ ++#define RTL8821A_TRANS_CARDEMU_TO_PDN \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ ++ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ ++ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK|PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ + {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ + -+#define RTL8188F_TRANS_PDN_TO_CARDEMU \ ++#define RTL8821A_TRANS_PDN_TO_CARDEMU \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ + -+#define RTL8188F_TRANS_ACT_TO_LPS \ ++#define RTL8821A_TRANS_ACT_TO_LPS \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0139, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*set RPWM IMR*/ \ ++ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ + {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ + {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ + {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ + {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ ++ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x3F},/*Reset MAC TRX*/ \ ++ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ + {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ ++ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ ++ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ + + -+#define RTL8188F_TRANS_LPS_TO_ACT \ ++#define RTL8821A_TRANS_LPS_TO_ACT \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ ++ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ + {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ ++ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0027, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xff,0x35},/*xtal_qsel=1 for low noise*/ \ ++ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ + {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x002B, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x1c, 0x1c}, /*. 0x2b[4:2] = 3b'111 to enable BB,AFE clock*/\ ++ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6|BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ + {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ + {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ ++ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ + {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+ -+ #define RTL8188F_TRANS_ACT_TO_SWLPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0139, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*set RPWM IMR*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x3F},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ {0x002b, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x1C, 0x00},/*0x2b[4:2]<=0 to gated BB,AFE clock*/ \ -+ {0x0027, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x34},/*xtal_qsel=0 for bring up*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x00},/* sdio LPS option*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x83},/* usb LPS option, open bandgap, xtal*/ \ -+ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0}, /* 0xC4[5]<=0, digital LDO no standby mode*/ \ -+ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7}, /* 0xC4[7]<=1, on domain voltage adjust*/ \ -+ {0x00a7, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0xe0}, /* low power LPS enable for sdio*/ \ -+ {0x00a7, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0xe4}, /* low power LPS enable for usb*/ \ -+ {0x0090, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /* enable WL_LPS_EN*/ + -+ -+#define RTL8188F_TRANS_SWLPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/*polling TSF stable*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1, enable security engine*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x06B7, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x09}, /*. reset MAC rx state machine*/\ -+ {0x06B4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x86}, /*. reset MAC rx state machine*/\ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/* set CPU RAM code ready*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*Reset CPU IO Wrapper*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0},/* Enable CPU*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*enable CPU IO Wrapper*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2},/* Enable CPU*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, BIT7},/*polling FW init ready */ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT6, BIT6},/*polling FW init ready */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8188F_TRANS_END \ ++#define RTL8821A_TRANS_END \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // + + -+extern WLAN_PWR_CFG rtl8188F_power_on_flow[RTL8188F_TRANS_CARDEMU_TO_ACT_STEPS+RTL8188F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188F_radio_off_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8188F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188F_card_disable_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8188F_TRANS_CARDEMU_TO_PDN_STEPS+RTL8188F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188F_card_enable_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8188F_TRANS_CARDEMU_TO_PDN_STEPS+RTL8188F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188F_suspend_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8188F_TRANS_CARDEMU_TO_SUS_STEPS+RTL8188F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188F_resume_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8188F_TRANS_CARDEMU_TO_SUS_STEPS+RTL8188F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188F_hwpdn_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8188F_TRANS_CARDEMU_TO_PDN_STEPS+RTL8188F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188F_enter_lps_flow[RTL8188F_TRANS_ACT_TO_LPS_STEPS+RTL8188F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188F_leave_lps_flow[RTL8188F_TRANS_LPS_TO_ACT_STEPS+RTL8188F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188F_enter_swlps_flow[RTL8188F_TRANS_ACT_TO_SWLPS_STEPS+RTL8188F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8188F_leave_swlps_flow[RTL8188F_TRANS_SWLPS_TO_ACT_STEPS+RTL8188F_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8821A_power_on_flow[RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8821A_radio_off_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8821A_card_disable_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8821A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8821A_card_enable_flow[RTL8821A_TRANS_CARDDIS_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8821A_suspend_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8821A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8821A_resume_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8821A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8821A_hwpdn_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8821A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8821A_enter_lps_flow[RTL8821A_TRANS_ACT_TO_LPS_STEPS+RTL8821A_TRANS_END_STEPS]; ++extern WLAN_PWR_CFG rtl8821A_leave_lps_flow[RTL8821A_TRANS_LPS_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]; ++ +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8192EPhyCfg.h linux/3rdparty/rtl8812au/include/Hal8192EPhyCfg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8192EPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8192EPhyCfg.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,178 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8192EPHYCFG_H__ -+#define __INC_HAL8192EPHYCFG_H__ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 //us -+#define AntennaDiversityValue 0x80 //(Adapter->bSoftwareAntennaDiversity ? 0x00:0x80) -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+#ifdef CONFIG_PCI_HCI -+#define MAX_AGGR_NUM 0x0B -+#else -+#define MAX_AGGR_NUM 0x07 -+#endif // CONFIG_PCI_HCI -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+/* BB/RF related */ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/*------------------------Export global variable----------------------------*/ -+/*------------------------Export global variable----------------------------*/ -+ -+ -+/*------------------------Export Marco Definition---------------------------*/ -+/*------------------------Export Marco Definition---------------------------*/ -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+// -+// BB and RF register read/write -+// -+u32 PHY_QueryBBReg8192E( IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask ); -+void PHY_SetBBReg8192E( IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data ); -+u32 PHY_QueryRFReg8192E( IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask ); -+void PHY_SetRFReg8192E( IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data ); -+ -+// -+// Initialization related function -+// -+/* MAC/BB/RF HAL config */ -+int PHY_MACConfig8192E(IN PADAPTER Adapter ); -+int PHY_BBConfig8192E(IN PADAPTER Adapter ); -+int PHY_RFConfig8192E(IN PADAPTER Adapter ); -+ -+/* RF config */ -+ -+ -+// -+// BB TX Power R/W -+// -+void PHY_GetTxPowerLevel8192E( IN PADAPTER Adapter, OUT s32* powerlevel ); -+void PHY_SetTxPowerLevel8192E( IN PADAPTER Adapter, IN u8 channel ); -+BOOLEAN PHY_UpdateTxPowerDbm8192E( IN PADAPTER Adapter, IN int powerInDbm ); -+ -+VOID -+PHY_SetTxPowerIndex_8192E( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+ ); -+ -+u8 -+PHY_GetTxPowerIndex_8192E( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel -+ ); -+ -+// -+// Switch bandwidth for 8192S -+// -+VOID -+PHY_SetBWMode8192E( -+ IN PADAPTER pAdapter, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset -+); -+ -+// -+// channel switch related funciton -+// -+VOID -+PHY_SwChnl8192E( -+ IN PADAPTER Adapter, -+ IN u8 channel -+); -+ -+ -+VOID -+PHY_SetSwChnlBWMode8192E( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+ -+VOID -+PHY_SetRFEReg_8192E( -+ IN PADAPTER Adapter -+); -+ -+void -+phy_SpurCalibration_8192E( -+ IN PADAPTER Adapter, -+ IN SPUR_CAL_METHOD Method -+); -+void PHY_SpurCalibration_8192E(IN PADAPTER Adapter); -+ -+#ifdef CONFIG_SPUR_CAL_NBI -+void -+phy_SpurCalibration_8192E_NBI( -+ IN PADAPTER Adapter -+); -+#endif -+// -+// BB/MAC/RF other monitor API -+// -+ -+VOID -+PHY_SetRFPathSwitch_8192E( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bMain -+); -+ -+VOID -+storePwrIndexDiffRateOffset( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+ ); -+ -+/*--------------------------Exported Function prototype---------------------*/ -+#endif // __INC_HAL8192CPHYCFG_H -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8192EPhyReg.h linux/3rdparty/rtl8812au/include/Hal8192EPhyReg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8192EPhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8192EPhyReg.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,1133 @@ -+/***************************************************************************** -+ * Copyright(c) 2008, RealTEK Technology Inc. All Right Reserved. -+ * -+ * Module: __INC_HAL8192SPHYREG_H -+ * -+ * -+ * Note: 1. Define PMAC/BB register map -+ * 2. Define RF register map -+ * 3. PMAC/BB register bit mask. -+ * 4. RF reg bit mask. -+ * 5. Other BB/RF relative definition. -+ * -+ * -+ * Export: Constants, macro, functions(API), global variables(None). -+ * -+ * Abbrev: -+ * -+ * History: -+ * Data Who Remark -+ * 08/07/2007 MHC 1. Porting from 9x series PHYCFG.h. -+ * 2. Reorganize code architecture. -+ * 09/25/2008 MH 1. Add RL6052 register definition -+ * -+ *****************************************************************************/ -+#ifndef __INC_HAL8192EPHYREG_H -+#define __INC_HAL8192EPHYREG_H -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+//============================================================ -+// 8192S Regsiter offset definition -+//============================================================ -+ -+// -+// BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+// 3. RF register 0x00-2E -+// 4. Bit Mask for BB/RF register -+// 5. Other defintion for BB/RF R/W -+// -+ -+ -+// -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 1. Page1(0x100) -+// -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+ -+// -+// 3. Page8(0x800) -+// -+#define rFPGA0_RFMOD 0x800 //RF mode & CCK TxSC // RF BW Setting?? -+ -+#define rFPGA0_TxInfo 0x804 // Status report?? -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c // Set TX PWR init gain? -+ -+#define rFPGA0_RFTiming1 0x810 // Useless now -+#define rFPGA0_RFTiming2 0x814 -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 // RF 3 wire register -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_RFWakeUpParameter 0x850 // Useless now -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 // RF Channel switch -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 // RF Channel switch -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 // RF Interface Software Control -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 -+#define rFPGA0_AdDaClockEn 0x888 // enable ad/da clock1 for dual-phy -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 // Tranceiver LSSI Readback -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 // Useless now -+#define TransceiverA_HSPI_Readback 0x8b8 // Transceiver A HSPI Readback -+#define TransceiverB_HSPI_Readback 0x8bc // Transceiver B HSPI Readback -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 // Useless now // RF Interface Readback Value -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 // Useless now -+ -+// -+// 4. Page9(0x900) -+// -+#define rFPGA1_RFMOD 0x900 //RF mode & OFDM TxSC // RF BW Setting?? -+ -+#define rFPGA1_TxBlock 0x904 // Useless now -+#define rFPGA1_DebugSelect 0x908 // Useless now -+#define rFPGA1_TxInfo 0x90c // Useless now // Status report?? -+ -+// -+// 5. PageA(0xA00) -+// -+// Set Control channel to upper or lower. These settings are required only for 40MHz -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 // Disable init gain now // Select RX path by RSSI -+#define rCCK0_CCA 0xa08 // Disable init gain now // Init gain -+ -+#define rCCK0_RxAGC1 0xa0c //AGC default value, saturation level // Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series -+#define rCCK0_RxAGC2 0xa10 //AGC & DAGC -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 //Timing recovery & Channel estimation threshold -+#define rCCK0_DSPParameter2 0xa1c //SQ threshold -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 //debug port and Tx filter3 -+#define rCCK0_FalseAlarmReport 0xa2c //0xa2d useless now 0xa30-a4f channel report -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 //0xa57 -+#define rCCK0_FACounterLower 0xa5c //0xa5b -+#define rCCK0_FACounterUpper 0xa58 //0xa5c -+ -+// -+// PageB(0xB00) -+// -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_ram64x16 0xb2c -+ -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rConfig_Pmpd_AntB 0xb98 -+#define rAPK 0xbd8 -+ -+ -+ -+// -+// 6. PageC(0xC00) -+// -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 //RxIQ DC offset, Rx digital filter, DC notch filter -+#define rOFDM0_XARxIQImbalance 0xc14 //RxIQ imblance matrix -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 //PD,BW & SBD // DM tune init gain -+#define rOFDM0_RxDetector2 0xc34 //SBD & Fame Sync. -+#define rOFDM0_RxDetector3 0xc38 //Frame Sync. -+#define rOFDM0_RxDetector4 0xc3c //PD, SBD, Frame Sync & Short-GI -+ -+#define rOFDM0_RxDSP 0xc40 //Rx Sync Path -+#define rOFDM0_CFOandDAGC 0xc44 //CFO & DAGC -+#define rOFDM0_CCADropThreshold 0xc48 //CCA Drop threshold -+#define rOFDM0_ECCAThreshold 0xc4c // energy CCA -+ -+#define rOFDM0_XAAGCCore1 0xc50 // DIG -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 // TX PWR TRACK and DIG -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+ -+// -+// 7. PageD(0xD00) -+// -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 // No setting now -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 //cca, parity fail -+#define rOFDM_PHYCounter2 0xda4 //rate illegal, crc8 fail -+#define rOFDM_PHYCounter3 0xda8 //MCS not support -+ -+#define rOFDM_ShortCFOAB 0xdac // No setting now -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+// -+// 8. PageE(0xE00) -+// -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+// -+// 7. RF Register 0x00-0x2E (RF 8256) -+// RF-0222D 0x00-3F -+// -+//Zebra1 -+#define rZebra1_HSSIEnable 0x0 // Useless now -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+#define rZebra1_Channel 0x7 // RF channel switch -+ -+//#endif -+#define rZebra1_TxGain 0x8 // Useless now -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+//Zebra4 -+#define rGlobalCtrl 0 // Useless now -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+//RTL8258 -+#define rRTL8258_TxLPF 0x11 // Useless now -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa -+ -+// -+// RL6052 Register definition -+// -+#define RF_AC 0x00 // -+ -+#define RF_IQADJ_G1 0x01 // -+#define RF_IQADJ_G2 0x02 // -+ -+#define RF_POW_TRSW 0x05 // -+ -+#define RF_GAIN_RX 0x06 // -+#define RF_GAIN_TX 0x07 // -+ -+#define RF_TXM_IDAC 0x08 // -+#define RF_IPA_G 0x09 // -+#define RF_TXBIAS_G 0x0A -+#define RF_TXPA_AG 0x0B -+#define RF_IPA_A 0x0C // -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_BS_IQGEN 0x0F // -+ -+#define RF_MODE1 0x10 // -+#define RF_MODE2 0x11 // -+ -+#define RF_RX_AGC_HP 0x12 // -+#define RF_TX_AGC 0x13 // -+#define RF_BIAS 0x14 // -+#define RF_IPA 0x15 // -+#define RF_TXBIAS 0x16 -+#define RF_POW_ABILITY 0x17 // -+#define RF_CHNLBW 0x18 // RF channel and BW switch -+#define RF_TOP 0x19 // -+ -+#define RF_RX_G1 0x1A // -+#define RF_RX_G2 0x1B // -+ -+#define RF_RX_BB2 0x1C // -+#define RF_RX_BB1 0x1D // -+ -+#define RF_RCK1 0x1E // -+#define RF_RCK2 0x1F // -+ -+#define RF_TX_G1 0x20 // -+#define RF_TX_G2 0x21 // -+#define RF_TX_G3 0x22 // -+ -+#define RF_TX_BB1 0x23 // -+ -+#define RF_T_METER_8192E 0x42 // -+#define RF_T_METER_88E 0x42 // -+#define RF_T_METER 0x24 // -+ -+//#endif -+ -+#define RF_SYN_G1 0x25 // RF TX Power control -+#define RF_SYN_G2 0x26 // RF TX Power control -+#define RF_SYN_G3 0x27 // RF TX Power control -+#define RF_SYN_G4 0x28 // RF TX Power control -+#define RF_SYN_G5 0x29 // RF TX Power control -+#define RF_SYN_G6 0x2A // RF TX Power control -+#define RF_SYN_G7 0x2B // RF TX Power control -+#define RF_SYN_G8 0x2C // RF TX Power control -+ -+#define RF_RCK_OS 0x30 // RF TX PA control -+#define RF_TXPA_G1 0x31 // RF TX PA control -+#define RF_TXPA_G2 0x32 // RF TX PA control -+#define RF_TXPA_G3 0x33 // RF TX PA control -+#define RF_TX_BIAS_A 0x35 -+#define RF_TX_BIAS_D 0x36 -+#define RF_LOBF_9 0x38 -+#define RF_RXRF_A3 0x3C // -+#define RF_TRSW 0x3F -+ -+#define RF_TXRF_A2 0x41 -+#define RF_TXPA_G4 0x46 -+#define RF_TXPA_A4 0x4B -+#define RF_0x52 0x52 -+#define RF_LDO 0xB1 -+#define RF_WE_LUT 0xEF -+ -+ -+// -+//Bit Mask -+// -+// 1. Page1(0x100) -+#define bBBResetB 0x100 // Useless now? -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) -+#define RF_TX_GAIN_OFFSET_8192E(_val) ((abs((_val)) << 1) | (((_val) > 0) ? BIT0 : 0)) -+ -+ -+// 2. Page8(0x800) -+#define bRFMOD 0x1 // Reg 0x800 rFPGA0_RFMOD -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 // Useless now -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bAntennaSelect 0x0300 -+ -+#define bXBTxAGC 0xf00 // Reg 80c rFPGA0_TxGainStage -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 // Useless now -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf //Reg0x814 -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 //T2R -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 //chane gain at continue Tx -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 // Reg 0x820~84f rFPGA0_XA_HSSIParameter1 -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 // Useless now -+//#define bHWSISelect 0x8 -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 // Reg 0x870 rFPGA0_XAB_RFInterfaceSW -+ -+#define bRFSI_TRSW 0x20 // Useless now -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+ -+#define bLSSIReadAddress 0x7f800000 // T65 RF -+ -+#define bLSSIReadEdge 0x80000000 //LSSI "Read" edge signal -+ -+#define bLSSIReadBackData 0xfffff // T65 RF -+ -+#define bLSSIReadOKFlag 0x1000 // Useless now -+#define bCCKSampleRate 0x8 //0: 44MHz, 1:88MHz -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 // Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ -+ -+#define b80MClkDelay 0x18000000 // Useless -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 // Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 // Useless -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+// 3. Page9(0x900) -+#define bOFDMTxSC 0x30000000 // Useless -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff //reset debug page and also HWord, LWord -+#define bDebugItem 0xff //reset debug page and LWord -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 -+ -+// 4. PageA(0xA00) -+#define bCCKBBMode 0x3 // Useless -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 // Reg 0xa00 rCCK0_System 20/40 switch -+ -+#define bCCKScramble 0x8 // Useless -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 //r_rx_clk -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 //CCK Rx Iinital gain polarity -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f //AGCsamp_dly -+#define bCCKFixedRxAGC 0x8000 -+//#define bCCKRxAGCFormat 0x4000 //remove to HSSI register 0x824 -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+// 5. PageC(0xC00) -+#define bNumOfSTF 0x3 // Useless -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 //the threshold for high power -+#define bRSSI_Gen 0x7f000000 //the threshold for ant diversity -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+//#define bRxMF_Hold 0x3800 -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 -+ -+// 6. PageE(0xE00) -+#define bSTBCEn 0x4 // Useless -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+//#define bRxPath1 0x01 -+//#define bRxPath2 0x02 -+//#define bRxPath3 0x04 -+//#define bRxPath4 0x08 -+//#define bTxPath1 0x10 -+//#define bTxPath2 0x20 -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 //total -+#define bShortCFOFLength 11 //fraction -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf // Useless -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 // Useless -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 // Useless -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+//Rx Pseduo noise -+#define bRxPesudoNoiseOn 0x20000000 // Useless -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+//7. RF Register -+//Zebra1 -+#define bZebra1_HSSIEnable 0x8 // Useless -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+//Zebra4 -+#define bRTL8256RegModeCtrl1 0x100 // Useless -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+//RTL8258 -+#define bRTL8258_TxLPFBW 0xc // Useless -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 -+ -+ -+// -+// Other Definition -+// -+ -+//byte endable for sb_write -+#define bByte0 0x1 // Useless -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+//for PutRegsetting & GetRegSetting BitMask -+#define bMaskByte0 0xff // Reg 0xc50 rOFDM0_XAAGCCore~0xC6f -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+//for PutRFRegsetting & GetRFRegSetting BitMask -+//#define bMask12Bits 0xfffff // RF Reg mask bits -+//#define bMask20Bits 0xfffff // RF Reg mask bits T65 RF -+#define bRFRegOffsetMask 0xfffff -+ -+#define bEnable 0x1 // Useless -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 // Useless -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 //500ms // Useless -+#define tUpdateRxCounter 100 //100ms -+ -+#define rateCCK 0 // Useless -+#define rateOFDM 1 -+#define rateHT 2 -+ -+//define Register-End -+#define bPMAC_End 0x1ff // Useless -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+//define max debug item in each debug page -+//#define bMaxItem_FPGA_PHY0 0x9 -+//#define bMaxItem_FPGA_PHY1 0x3 -+//#define bMaxItem_PHY_11B 0x16 -+//#define bMaxItem_OFDM_PHY0 0x29 -+//#define bMaxItem_OFDM_PHY1 0x0 -+ -+#define bPMACControl 0x0 // Useless -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#define PathA 0x0 // Useless -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 -+ -+ -+// RSSI Dump Message -+#define rA_RSSIDump_92E 0xcb0 -+#define rB_RSSIDump_92E 0xcb1 -+#define rS1_RXevmDump_92E 0xcb2 -+#define rS2_RXevmDump_92E 0xcb3 -+#define rA_RXsnrDump_92E 0xcb4 -+#define rB_RXsnrDump_92E 0xcb5 -+#define rA_CfoShortDump_92E 0xcb6 -+#define rB_CfoShortDump_92E 0xcb8 -+#define rA_CfoLongDump_92E 0xcba -+#define rB_CfoLongDump_92E 0xcbc -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+#endif //__INC_HAL8188EPHYREG_H -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8192EPwrSeq.h linux/3rdparty/rtl8812au/include/Hal8192EPwrSeq.h ---- linux.old/3rdparty/rtl8812au/include/Hal8192EPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8192EPwrSeq.h 2017-06-07 23:07:21.035689763 +0300 +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_com.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com.h +--- linux-4.14.17/3rdparty/rtl8812au/include/hal_com.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com.h 2018-02-06 17:42:30.717967268 +0200 @@ -0,0 +1,155 @@ -+#ifndef REALTEK_POWER_SEQUENCE_8192E -+#define REALTEK_POWER_SEQUENCE_8192E -+ -+#include "HalPwrSeqCmd.h" -+/* -+ Check document WM-20110607-Paul-RTL8192E_Power_Architecture-R02.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8192E_TRANS_CARDEMU_TO_ACT_STEPS 18 -+#define RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS 18 -+#define RTL8192E_TRANS_CARDEMU_TO_SUS_STEPS 18 -+#define RTL8192E_TRANS_SUS_TO_CARDEMU_STEPS 18 -+#define RTL8192E_TRANS_CARDEMU_TO_PDN_STEPS 18 -+#define RTL8192E_TRANS_PDN_TO_CARDEMU_STEPS 18 -+#define RTL8192E_TRANS_ACT_TO_LPS_STEPS 23 -+#define RTL8192E_TRANS_LPS_TO_ACT_STEPS 23 -+#define RTL8192E_TRANS_END_STEPS 1 -+ -+ -+#define RTL8192E_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT4|BIT3), 0},/* disable WL suspend*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ -+ -+#define RTL8192E_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/*0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ -+ -+#define RTL8192E_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4|BIT3, (BIT4|BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3|BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8192E_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8192E_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07=0x20 , SOP option to disable BG/MB*/ \ -+ {0x00CC, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2}, /*Unlock small LDO Register*/ \ -+ {0x0011, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*Disable small LDO*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8192E_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0011, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0}, /*Enable small LDO*/ \ -+ {0x00CC, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0}, /*Lock small LDO Register*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ -+ -+ -+#define RTL8192E_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8192E_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8192E_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8192E_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM, For Repeatly In and out, Taggle bit should be changed*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/\ -+ {0x013D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*Clear ISR*/ -+ -+#define RTL8192E_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // -+ -+ -+extern WLAN_PWR_CFG rtl8192E_power_on_flow[RTL8192E_TRANS_CARDEMU_TO_ACT_STEPS+RTL8192E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192E_radio_off_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192E_card_disable_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192E_TRANS_CARDEMU_TO_PDN_STEPS+RTL8192E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192E_card_enable_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192E_TRANS_CARDEMU_TO_PDN_STEPS+RTL8192E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192E_suspend_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192E_TRANS_CARDEMU_TO_SUS_STEPS+RTL8192E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192E_resume_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192E_TRANS_CARDEMU_TO_SUS_STEPS+RTL8192E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192E_hwpdn_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192E_TRANS_CARDEMU_TO_PDN_STEPS+RTL8192E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192E_enter_lps_flow[RTL8192E_TRANS_ACT_TO_LPS_STEPS+RTL8192E_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192E_leave_lps_flow[RTL8192E_TRANS_LPS_TO_ACT_STEPS+RTL8192E_TRANS_END_STEPS]; -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8703BPhyCfg.h linux/3rdparty/rtl8812au/include/Hal8703BPhyCfg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8703BPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8703BPhyCfg.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,144 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8703BPHYCFG_H__ -+#define __INC_HAL8703BPHYCFG_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 //us -+#define AntennaDiversityValue 0x80 //(Adapter->bSoftwareAntennaDiversity ? 0x00:0x80) -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+#ifdef CONFIG_PCI_HCI -+#define MAX_AGGR_NUM 0x0B -+#else -+#define MAX_AGGR_NUM 0x07 -+#endif // CONFIG_PCI_HCI -+ -+ -+/*--------------------------Define Parameters End-------------------------------*/ -+ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+/*------------------------------Define structure End----------------------------*/ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+u32 -+PHY_QueryBBReg_8703B( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask -+ ); -+ -+VOID -+PHY_SetBBReg_8703B( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+ ); -+ -+u32 -+PHY_QueryRFReg_8703B( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask -+ ); -+ -+VOID -+PHY_SetRFReg_8703B( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+ ); -+ -+/* MAC/BB/RF HAL config */ -+int PHY_BBConfig8703B(PADAPTER Adapter ); -+ -+int PHY_RFConfig8703B(PADAPTER Adapter ); -+ -+s32 PHY_MACConfig8703B(PADAPTER padapter); -+ -+int -+PHY_ConfigRFWithParaFile_8703B( -+ IN PADAPTER Adapter, -+ IN u8* pFileName, -+ RF_PATH eRFPath -+); -+ -+VOID -+PHY_SetTxPowerIndex_8703B( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+ ); -+ -+u8 -+PHY_GetTxPowerIndex_8703B( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel -+ ); -+ -+VOID -+PHY_GetTxPowerLevel8703B( -+ IN PADAPTER Adapter, -+ OUT s32* powerlevel -+ ); -+ -+VOID -+PHY_SetTxPowerLevel8703B( -+ IN PADAPTER Adapter, -+ IN u8 channel -+ ); -+ -+VOID -+PHY_SetBWMode8703B( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth, // 20M or 40M -+ IN unsigned char Offset // Upper, Lower, or Don't care -+); -+ -+VOID -+PHY_SwChnl8703B( // Call after initialization -+ IN PADAPTER Adapter, -+ IN u8 channel -+ ); -+ -+VOID -+PHY_SetSwChnlBWMode8703B( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+/*--------------------------Exported Function prototype End---------------------*/ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8703BPhyReg.h linux/3rdparty/rtl8812au/include/Hal8703BPhyReg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8703BPhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8703BPhyReg.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,1139 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8703BPHYREG_H__ -+#define __INC_HAL8703BPHYREG_H__ -+ -+#define rSYM_WLBT_PAPE_SEL 0x64 -+// -+// BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+// 3. RF register 0x00-2E -+// 4. Bit Mask for BB/RF register -+// 5. Other defintion for BB/RF R/W -+// -+ -+ -+// -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 1. Page1(0x100) -+// -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+// -+// 2. Page2(0x200) -+// -+// The following two definition are only used for USB interface. -+#define RF_BB_CMD_ADDR 0x02c0 // RF/BB read/write command address. -+#define RF_BB_CMD_DATA 0x02c4 // RF/BB read/write command data. -+ -+// -+// 3. Page8(0x800) -+// -+#define rFPGA0_RFMOD 0x800 //RF mode & CCK TxSC // RF BW Setting?? -+ -+#define rFPGA0_TxInfo 0x804 // Status report?? -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c // Set TX PWR init gain? -+ -+#define rFPGA0_RFTiming1 0x810 // Useless now -+#define rFPGA0_RFTiming2 0x814 -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 // RF 3 wire register -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+ -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_RFWakeUpParameter 0x850 // Useless now -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 // RF Channel switch -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 // RF Channel switch -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 // RF Interface Software Control -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 // Useless now -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 // Tranceiver LSSI Readback -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 // Useless now -+#define TransceiverA_HSPI_Readback 0x8b8 // Transceiver A HSPI Readback -+#define TransceiverB_HSPI_Readback 0x8bc // Transceiver B HSPI Readback -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 // Useless now // RF Interface Readback Value -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 // Useless now -+ -+// -+// 4. Page9(0x900) -+// -+#define rFPGA1_RFMOD 0x900 //RF mode & OFDM TxSC // RF BW Setting?? -+#define rFPGA1_TxBlock 0x904 // Useless now -+#define rFPGA1_DebugSelect 0x908 // Useless now -+#define rFPGA1_TxInfo 0x90c // Useless now // Status report?? -+#define rDPDT_control 0x92c -+#define rfe_ctrl_anta_src 0x930 -+#define rS0S1_PathSwitch 0x948 -+#define rBBrx_DFIR 0x954 -+ -+// -+// 5. PageA(0xA00) -+// -+// Set Control channel to upper or lower. These settings are required only for 40MHz -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 // Disable init gain now // Select RX path by RSSI -+#define rCCK0_CCA 0xa08 // Disable init gain now // Init gain -+ -+#define rCCK0_RxAGC1 0xa0c //AGC default value, saturation level // Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series -+#define rCCK0_RxAGC2 0xa10 //AGC & DAGC -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 //Timing recovery & Channel estimation threshold -+#define rCCK0_DSPParameter2 0xa1c //SQ threshold -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 //debug port and Tx filter3 -+#define rCCK0_FalseAlarmReport 0xa2c //0xa2d useless now 0xa30-a4f channel report -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 //0xa57 -+#define rCCK0_FACounterLower 0xa5c //0xa5b -+#define rCCK0_FACounterUpper 0xa58 //0xa5c -+ -+// -+// PageB(0xB00) -+// -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rPdp_AntA_8 0xb08 -+#define rPdp_AntA_C 0xb0c -+#define rPdp_AntA_10 0xb10 -+#define rPdp_AntA_14 0xb14 -+#define rPdp_AntA_18 0xb18 -+#define rPdp_AntA_1C 0xb1c -+#define rPdp_AntA_20 0xb20 -+#define rPdp_AntA_24 0xb24 -+ -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_ram64x16 0xb2c -+ -+#define rBndA 0xb30 -+#define rHssiPar 0xb34 -+ -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+ -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rPdp_AntB_8 0xb78 -+#define rPdp_AntB_C 0xb7c -+#define rPdp_AntB_10 0xb80 -+#define rPdp_AntB_14 0xb84 -+#define rPdp_AntB_18 0xb88 -+#define rPdp_AntB_1C 0xb8c -+#define rPdp_AntB_20 0xb90 -+#define rPdp_AntB_24 0xb94 -+ -+#define rConfig_Pmpd_AntB 0xb98 -+ -+#define rBndB 0xba0 -+ -+#define rAPK 0xbd8 -+#define rPm_Rx0_AntA 0xbdc -+#define rPm_Rx1_AntA 0xbe0 -+#define rPm_Rx2_AntA 0xbe4 -+#define rPm_Rx3_AntA 0xbe8 -+#define rPm_Rx0_AntB 0xbec -+#define rPm_Rx1_AntB 0xbf0 -+#define rPm_Rx2_AntB 0xbf4 -+#define rPm_Rx3_AntB 0xbf8 -+// -+// 6. PageC(0xC00) -+// -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 //RxIQ DC offset, Rx digital filter, DC notch filter -+#define rOFDM0_XARxIQImbalance 0xc14 //RxIQ imblance matrix -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 //PD,BW & SBD // DM tune init gain -+#define rOFDM0_RxDetector2 0xc34 //SBD & Fame Sync. -+#define rOFDM0_RxDetector3 0xc38 //Frame Sync. -+#define rOFDM0_RxDetector4 0xc3c //PD, SBD, Frame Sync & Short-GI -+ -+#define rOFDM0_RxDSP 0xc40 //Rx Sync Path -+#define rOFDM0_CFOandDAGC 0xc44 //CFO & DAGC -+#define rOFDM0_CCADropThreshold 0xc48 //CCA Drop threshold -+#define rOFDM0_ECCAThreshold 0xc4c // energy CCA -+ -+#define rOFDM0_XAAGCCore1 0xc50 // DIG -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 // TX PWR TRACK and DIG -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+// -+// 7. PageD(0xD00) -+// -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 // No setting now -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 //cca, parity fail -+#define rOFDM_PHYCounter2 0xda4 //rate illegal, crc8 fail -+#define rOFDM_PHYCounter3 0xda8 //MCS not support -+ -+#define rOFDM_ShortCFOAB 0xdac // No setting now -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+// -+// 8. PageE(0xE00) -+// -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+// -+// 7. RF Register 0x00-0x2E (RF 8256) -+// RF-0222D 0x00-3F -+// -+//Zebra1 -+#define rZebra1_HSSIEnable 0x0 // Useless now -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+#define rZebra1_Channel 0x7 // RF channel switch -+ -+//#endif -+#define rZebra1_TxGain 0x8 // Useless now -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+//Zebra4 -+#define rGlobalCtrl 0 // Useless now -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+//RTL8258 -+#define rRTL8258_TxLPF 0x11 // Useless now -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa -+ -+// -+// RL6052 Register definition -+// -+#define RF_AC 0x00 // -+ -+#define RF_IQADJ_G1 0x01 // -+#define RF_IQADJ_G2 0x02 // -+#define RF_BS_PA_APSET_G1_G4 0x03 -+#define RF_BS_PA_APSET_G5_G8 0x04 -+#define RF_POW_TRSW 0x05 // -+ -+#define RF_GAIN_RX 0x06 // -+#define RF_GAIN_TX 0x07 // -+ -+#define RF_TXM_IDAC 0x08 // -+#define RF_IPA_G 0x09 // -+#define RF_TXBIAS_G 0x0A -+#define RF_TXPA_AG 0x0B -+#define RF_IPA_A 0x0C // -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_BS_IQGEN 0x0F // -+ -+#define RF_MODE1 0x10 // -+#define RF_MODE2 0x11 // -+ -+#define RF_RX_AGC_HP 0x12 // -+#define RF_TX_AGC 0x13 // -+#define RF_BIAS 0x14 // -+#define RF_IPA 0x15 // -+#define RF_TXBIAS 0x16 // -+#define RF_POW_ABILITY 0x17 // -+#define RF_MODE_AG 0x18 // -+#define rRfChannel 0x18 // RF channel and BW switch -+#define RF_CHNLBW 0x18 // RF channel and BW switch -+#define RF_TOP 0x19 // -+ -+#define RF_RX_G1 0x1A // -+#define RF_RX_G2 0x1B // -+ -+#define RF_RX_BB2 0x1C // -+#define RF_RX_BB1 0x1D // -+ -+#define RF_RCK1 0x1E // -+#define RF_RCK2 0x1F // -+ -+#define RF_TX_G1 0x20 // -+#define RF_TX_G2 0x21 // -+#define RF_TX_G3 0x22 // -+ -+#define RF_TX_BB1 0x23 // -+ -+#define RF_T_METER 0x24 // -+ -+#define RF_SYN_G1 0x25 // RF TX Power control -+#define RF_SYN_G2 0x26 // RF TX Power control -+#define RF_SYN_G3 0x27 // RF TX Power control -+#define RF_SYN_G4 0x28 // RF TX Power control -+#define RF_SYN_G5 0x29 // RF TX Power control -+#define RF_SYN_G6 0x2A // RF TX Power control -+#define RF_SYN_G7 0x2B // RF TX Power control -+#define RF_SYN_G8 0x2C // RF TX Power control -+ -+#define RF_RCK_OS 0x30 // RF TX PA control -+ -+#define RF_TXPA_G1 0x31 // RF TX PA control -+#define RF_TXPA_G2 0x32 // RF TX PA control -+#define RF_TXPA_G3 0x33 // RF TX PA control -+#define RF_TX_BIAS_A 0x35 -+#define RF_TX_BIAS_D 0x36 -+#define RF_LOBF_9 0x38 -+#define RF_RXRF_A3 0x3C // -+#define RF_TRSW 0x3F -+ -+#define RF_TXRF_A2 0x41 -+#define RF_TXPA_G4 0x46 -+#define RF_TXPA_A4 0x4B -+#define RF_0x52 0x52 -+#define RF_WE_LUT 0xEF -+#define RF_S0S1 0xB0 -+ -+// -+//Bit Mask -+// -+// 1. Page1(0x100) -+#define bBBResetB 0x100 // Useless now? -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) -+#define RF_TX_GAIN_OFFSET_8703B(_val) (abs((_val)) | (((_val) > 0) ? BIT5 : 0)) -+ -+// 2. Page8(0x800) -+#define bRFMOD 0x1 // Reg 0x800 rFPGA0_RFMOD -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 // Useless now -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bAntennaSelect 0x0300 -+ -+#define bXBTxAGC 0xf00 // Reg 80c rFPGA0_TxGainStage -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 // Useless now -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf //Reg0x814 -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 //T2R -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 //chane gain at continue Tx -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 // Reg 0x820~84f rFPGA0_XA_HSSIParameter1 -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 // Useless now -+//#define bHWSISelect 0x8 -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 // Reg 0x870 rFPGA0_XAB_RFInterfaceSW -+ -+#define bRFSI_TRSW 0x20 // Useless now -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+ -+#define bLSSIReadAddress 0x7f800000 // T65 RF -+ -+#define bLSSIReadEdge 0x80000000 //LSSI "Read" edge signal -+ -+#define bLSSIReadBackData 0xfffff // T65 RF -+ -+#define bLSSIReadOKFlag 0x1000 // Useless now -+#define bCCKSampleRate 0x8 //0: 44MHz, 1:88MHz -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 // Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ -+ -+#define b80MClkDelay 0x18000000 // Useless -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 // Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 // Useless -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+// 3. Page9(0x900) -+#define bOFDMTxSC 0x30000000 // Useless -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff //reset debug page and also HWord, LWord -+#define bDebugItem 0xff //reset debug page and LWord -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 -+ -+// 4. PageA(0xA00) -+#define bCCKBBMode 0x3 // Useless -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 // Reg 0xa00 rCCK0_System 20/40 switch -+ -+#define bCCKScramble 0x8 // Useless -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 //r_rx_clk -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 //CCK Rx Iinital gain polarity -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f //AGCsamp_dly -+#define bCCKFixedRxAGC 0x8000 -+//#define bCCKRxAGCFormat 0x4000 //remove to HSSI register 0x824 -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+// 5. PageC(0xC00) -+#define bNumOfSTF 0x3 // Useless -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 //the threshold for high power -+#define bRSSI_Gen 0x7f000000 //the threshold for ant diversity -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+//#define bRxMF_Hold 0x3800 -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 -+ -+// 6. PageE(0xE00) -+#define bSTBCEn 0x4 // Useless -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+//#define bRxPath1 0x01 -+//#define bRxPath2 0x02 -+//#define bRxPath3 0x04 -+//#define bRxPath4 0x08 -+//#define bTxPath1 0x10 -+//#define bTxPath2 0x20 -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 //total -+#define bShortCFOFLength 11 //fraction -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf // Useless -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 // Useless -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 // Useless -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+//Rx Pseduo noise -+#define bRxPesudoNoiseOn 0x20000000 // Useless -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+//7. RF Register -+//Zebra1 -+#define bZebra1_HSSIEnable 0x8 // Useless -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+//Zebra4 -+#define bRTL8256RegModeCtrl1 0x100 // Useless -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+//RTL8258 -+#define bRTL8258_TxLPFBW 0xc // Useless -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 -+ -+ -+// -+// Other Definition -+// -+ -+//byte endable for sb_write -+#define bByte0 0x1 // Useless -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+//for PutRegsetting & GetRegSetting BitMask -+#define bMaskByte0 0xff // Reg 0xc50 rOFDM0_XAAGCCore~0xC6f -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+ -+#define bEnable 0x1 // Useless -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 // Useless -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 //500ms // Useless -+#define tUpdateRxCounter 100 //100ms -+ -+#define rateCCK 0 // Useless -+#define rateOFDM 1 -+#define rateHT 2 -+ -+//define Register-End -+#define bPMAC_End 0x1ff // Useless -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+//define max debug item in each debug page -+//#define bMaxItem_FPGA_PHY0 0x9 -+//#define bMaxItem_FPGA_PHY1 0x3 -+//#define bMaxItem_PHY_11B 0x16 -+//#define bMaxItem_OFDM_PHY0 0x29 -+//#define bMaxItem_OFDM_PHY1 0x0 -+ -+#define bPMACControl 0x0 // Useless -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#define PathA 0x0 // Useless -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8703BPwrSeq.h linux/3rdparty/rtl8812au/include/Hal8703BPwrSeq.h ---- linux.old/3rdparty/rtl8812au/include/Hal8703BPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8703BPwrSeq.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,184 @@ -+#ifndef REALTEK_POWER_SEQUENCE_8703B -+#define REALTEK_POWER_SEQUENCE_8703B -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WM-20140402-JackieLau-RTL8703B_Power_Architecture v09.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8703B_TRANS_CARDEMU_TO_ACT_STEPS 23 -+#define RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8703B_TRANS_CARDEMU_TO_SUS_STEPS 15 -+#define RTL8703B_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8703B_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8703B_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8703B_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8703B_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8703B_TRANS_END_STEPS 1 -+ -+ -+#define RTL8703B_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ -+ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT4|BIT3|BIT2), 0},/* disable SW LPS 0x04[10]=0 and WLSUS_EN 0x04[11]=0*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0 , BIT0},/* Disable USB suspend */ \ -+ {0x0004, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 , BIT3},/* enabled usb resume */ \ -+ {0x0004, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 , 0},/* disable usb resume */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0 , 0},/* Enable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT4|BIT3), 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, BIT6},/* Enable WL control XTAL setting*/ \ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable falling edge triggering interrupt*/\ -+ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable GPIO9 interrupt mode*/\ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 input mode*/\ -+ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*Enable HSISR GPIO[C:0] interrupt*/\ -+ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable HSISR GPIO9 interrupt*/\ -+ {0x0068, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3},/*For GPIO9 internal pull high setting by test chip*/\ -+ {0x0069, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, BIT6},/*For GPIO9 internal pull high setting*/\ -+ -+ -+#define RTL8703B_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Enable rising edge triggering interrupt*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, 0},/* Enable BT control XTAL setting*/\ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/\ -+ -+ -+#define RTL8703B_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4|BIT3, (BIT4|BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3|BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8703B_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8703B_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07=0x20 , SOP option to disable BG/MB*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8703B_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8703B_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK|PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8703B_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8703B_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8703B_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6|BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8703B_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // -+ -+ -+extern WLAN_PWR_CFG rtl8703B_power_on_flow[RTL8703B_TRANS_CARDEMU_TO_ACT_STEPS+RTL8703B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8703B_radio_off_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8703B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8703B_card_disable_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8703B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8703B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8703B_card_enable_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8703B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8703B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8703B_suspend_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8703B_TRANS_CARDEMU_TO_SUS_STEPS+RTL8703B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8703B_resume_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8703B_TRANS_CARDEMU_TO_SUS_STEPS+RTL8703B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8703B_hwpdn_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8703B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8703B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8703B_enter_lps_flow[RTL8703B_TRANS_ACT_TO_LPS_STEPS+RTL8703B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8703B_leave_lps_flow[RTL8703B_TRANS_LPS_TO_ACT_STEPS+RTL8703B_TRANS_END_STEPS]; -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8723BPhyCfg.h linux/3rdparty/rtl8812au/include/Hal8723BPhyCfg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8723BPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8723BPhyCfg.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,149 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8723BPHYCFG_H__ -+#define __INC_HAL8723BPHYCFG_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 //us -+#define AntennaDiversityValue 0x80 //(Adapter->bSoftwareAntennaDiversity ? 0x00:0x80) -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+#ifdef CONFIG_PCI_HCI -+#define MAX_AGGR_NUM 0x0B -+#else -+#define MAX_AGGR_NUM 0x07 -+#endif // CONFIG_PCI_HCI -+ -+ -+/*--------------------------Define Parameters End-------------------------------*/ -+ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+/*------------------------------Define structure End----------------------------*/ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+u32 -+PHY_QueryBBReg_8723B( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask -+ ); -+ -+VOID -+PHY_SetBBReg_8723B( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+ ); -+ -+u32 -+PHY_QueryRFReg_8723B( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask -+ ); -+ -+VOID -+PHY_SetRFReg_8723B( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+ ); -+ -+/* MAC/BB/RF HAL config */ -+int PHY_BBConfig8723B(PADAPTER Adapter ); -+ -+int PHY_RFConfig8723B(PADAPTER Adapter ); -+ -+s32 PHY_MACConfig8723B(PADAPTER padapter); -+ -+int -+PHY_ConfigRFWithParaFile_8723B( -+ IN PADAPTER Adapter, -+ IN u8* pFileName, -+ RF_PATH eRFPath -+); -+ -+VOID -+PHY_SetTxPowerIndex_8723B( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+ ); -+ -+u8 -+PHY_GetTxPowerIndex_8723B( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel -+ ); -+ -+VOID -+PHY_GetTxPowerLevel8723B( -+ IN PADAPTER Adapter, -+ OUT s32* powerlevel -+ ); -+ -+VOID -+PHY_SetTxPowerLevel8723B( -+ IN PADAPTER Adapter, -+ IN u8 channel -+ ); -+ -+VOID -+PHY_SetBWMode8723B( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth, // 20M or 40M -+ IN unsigned char Offset // Upper, Lower, or Don't care -+); -+ -+VOID -+PHY_SwChnl8723B( // Call after initialization -+ IN PADAPTER Adapter, -+ IN u8 channel -+ ); -+ -+VOID -+PHY_SetSwChnlBWMode8723B( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+ -+VOID PHY_SetRFPathSwitch_8723B( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bMain -+ ); -+/*--------------------------Exported Function prototype End---------------------*/ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8723BPhyReg.h linux/3rdparty/rtl8812au/include/Hal8723BPhyReg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8723BPhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8723BPhyReg.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,1137 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8723BPHYREG_H__ -+#define __INC_HAL8723BPHYREG_H__ -+ -+#define rSYM_WLBT_PAPE_SEL 0x64 -+// -+// BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+// 3. RF register 0x00-2E -+// 4. Bit Mask for BB/RF register -+// 5. Other defintion for BB/RF R/W -+// -+ -+ -+// -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 1. Page1(0x100) -+// -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+// -+// 2. Page2(0x200) -+// -+// The following two definition are only used for USB interface. -+#define RF_BB_CMD_ADDR 0x02c0 // RF/BB read/write command address. -+#define RF_BB_CMD_DATA 0x02c4 // RF/BB read/write command data. -+ -+// -+// 3. Page8(0x800) -+// -+#define rFPGA0_RFMOD 0x800 //RF mode & CCK TxSC // RF BW Setting?? -+ -+#define rFPGA0_TxInfo 0x804 // Status report?? -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c // Set TX PWR init gain? -+ -+#define rFPGA0_RFTiming1 0x810 // Useless now -+#define rFPGA0_RFTiming2 0x814 -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 // RF 3 wire register -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+ -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_RFWakeUpParameter 0x850 // Useless now -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 // RF Channel switch -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 // RF Channel switch -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 // RF Interface Software Control -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 // Useless now -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 // Tranceiver LSSI Readback -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 // Useless now -+#define TransceiverA_HSPI_Readback 0x8b8 // Transceiver A HSPI Readback -+#define TransceiverB_HSPI_Readback 0x8bc // Transceiver B HSPI Readback -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 // Useless now // RF Interface Readback Value -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 // Useless now -+ -+// -+// 4. Page9(0x900) -+// -+#define rFPGA1_RFMOD 0x900 //RF mode & OFDM TxSC // RF BW Setting?? -+#define rFPGA1_TxBlock 0x904 // Useless now -+#define rFPGA1_DebugSelect 0x908 // Useless now -+#define rFPGA1_TxInfo 0x90c // Useless now // Status report?? -+#define rDPDT_control 0x92c -+#define rfe_ctrl_anta_src 0x930 -+#define rS0S1_PathSwitch 0x948 -+ -+// -+// 5. PageA(0xA00) -+// -+// Set Control channel to upper or lower. These settings are required only for 40MHz -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 // Disable init gain now // Select RX path by RSSI -+#define rCCK0_CCA 0xa08 // Disable init gain now // Init gain -+ -+#define rCCK0_RxAGC1 0xa0c //AGC default value, saturation level // Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series -+#define rCCK0_RxAGC2 0xa10 //AGC & DAGC -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 //Timing recovery & Channel estimation threshold -+#define rCCK0_DSPParameter2 0xa1c //SQ threshold -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 //debug port and Tx filter3 -+#define rCCK0_FalseAlarmReport 0xa2c //0xa2d useless now 0xa30-a4f channel report -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 //0xa57 -+#define rCCK0_FACounterLower 0xa5c //0xa5b -+#define rCCK0_FACounterUpper 0xa58 //0xa5c -+ -+// -+// PageB(0xB00) -+// -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rPdp_AntA_8 0xb08 -+#define rPdp_AntA_C 0xb0c -+#define rPdp_AntA_10 0xb10 -+#define rPdp_AntA_14 0xb14 -+#define rPdp_AntA_18 0xb18 -+#define rPdp_AntA_1C 0xb1c -+#define rPdp_AntA_20 0xb20 -+#define rPdp_AntA_24 0xb24 -+ -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_ram64x16 0xb2c -+ -+#define rBndA 0xb30 -+#define rHssiPar 0xb34 -+ -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+ -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rPdp_AntB_8 0xb78 -+#define rPdp_AntB_C 0xb7c -+#define rPdp_AntB_10 0xb80 -+#define rPdp_AntB_14 0xb84 -+#define rPdp_AntB_18 0xb88 -+#define rPdp_AntB_1C 0xb8c -+#define rPdp_AntB_20 0xb90 -+#define rPdp_AntB_24 0xb94 -+ -+#define rConfig_Pmpd_AntB 0xb98 -+ -+#define rBndB 0xba0 -+ -+#define rAPK 0xbd8 -+#define rPm_Rx0_AntA 0xbdc -+#define rPm_Rx1_AntA 0xbe0 -+#define rPm_Rx2_AntA 0xbe4 -+#define rPm_Rx3_AntA 0xbe8 -+#define rPm_Rx0_AntB 0xbec -+#define rPm_Rx1_AntB 0xbf0 -+#define rPm_Rx2_AntB 0xbf4 -+#define rPm_Rx3_AntB 0xbf8 -+// -+// 6. PageC(0xC00) -+// -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 //RxIQ DC offset, Rx digital filter, DC notch filter -+#define rOFDM0_XARxIQImbalance 0xc14 //RxIQ imblance matrix -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 //PD,BW & SBD // DM tune init gain -+#define rOFDM0_RxDetector2 0xc34 //SBD & Fame Sync. -+#define rOFDM0_RxDetector3 0xc38 //Frame Sync. -+#define rOFDM0_RxDetector4 0xc3c //PD, SBD, Frame Sync & Short-GI -+ -+#define rOFDM0_RxDSP 0xc40 //Rx Sync Path -+#define rOFDM0_CFOandDAGC 0xc44 //CFO & DAGC -+#define rOFDM0_CCADropThreshold 0xc48 //CCA Drop threshold -+#define rOFDM0_ECCAThreshold 0xc4c // energy CCA -+ -+#define rOFDM0_XAAGCCore1 0xc50 // DIG -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 // TX PWR TRACK and DIG -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+// -+// 7. PageD(0xD00) -+// -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 // No setting now -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 //cca, parity fail -+#define rOFDM_PHYCounter2 0xda4 //rate illegal, crc8 fail -+#define rOFDM_PHYCounter3 0xda8 //MCS not support -+ -+#define rOFDM_ShortCFOAB 0xdac // No setting now -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+// -+// 8. PageE(0xE00) -+// -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+// -+// 7. RF Register 0x00-0x2E (RF 8256) -+// RF-0222D 0x00-3F -+// -+//Zebra1 -+#define rZebra1_HSSIEnable 0x0 // Useless now -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+#define rZebra1_Channel 0x7 // RF channel switch -+ -+//#endif -+#define rZebra1_TxGain 0x8 // Useless now -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+//Zebra4 -+#define rGlobalCtrl 0 // Useless now -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+//RTL8258 -+#define rRTL8258_TxLPF 0x11 // Useless now -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa -+ -+// -+// RL6052 Register definition -+// -+#define RF_AC 0x00 // -+ -+#define RF_IQADJ_G1 0x01 // -+#define RF_IQADJ_G2 0x02 // -+#define RF_BS_PA_APSET_G1_G4 0x03 -+#define RF_BS_PA_APSET_G5_G8 0x04 -+#define RF_POW_TRSW 0x05 // -+ -+#define RF_GAIN_RX 0x06 // -+#define RF_GAIN_TX 0x07 // -+ -+#define RF_TXM_IDAC 0x08 // -+#define RF_IPA_G 0x09 // -+#define RF_TXBIAS_G 0x0A -+#define RF_TXPA_AG 0x0B -+#define RF_IPA_A 0x0C // -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_BS_IQGEN 0x0F // -+ -+#define RF_MODE1 0x10 // -+#define RF_MODE2 0x11 // -+ -+#define RF_RX_AGC_HP 0x12 // -+#define RF_TX_AGC 0x13 // -+#define RF_BIAS 0x14 // -+#define RF_IPA 0x15 // -+#define RF_TXBIAS 0x16 // -+#define RF_POW_ABILITY 0x17 // -+#define RF_MODE_AG 0x18 // -+#define rRfChannel 0x18 // RF channel and BW switch -+#define RF_CHNLBW 0x18 // RF channel and BW switch -+#define RF_TOP 0x19 // -+ -+#define RF_RX_G1 0x1A // -+#define RF_RX_G2 0x1B // -+ -+#define RF_RX_BB2 0x1C // -+#define RF_RX_BB1 0x1D // -+ -+#define RF_RCK1 0x1E // -+#define RF_RCK2 0x1F // -+ -+#define RF_TX_G1 0x20 // -+#define RF_TX_G2 0x21 // -+#define RF_TX_G3 0x22 // -+ -+#define RF_TX_BB1 0x23 // -+ -+#define RF_T_METER 0x24 // -+ -+#define RF_SYN_G1 0x25 // RF TX Power control -+#define RF_SYN_G2 0x26 // RF TX Power control -+#define RF_SYN_G3 0x27 // RF TX Power control -+#define RF_SYN_G4 0x28 // RF TX Power control -+#define RF_SYN_G5 0x29 // RF TX Power control -+#define RF_SYN_G6 0x2A // RF TX Power control -+#define RF_SYN_G7 0x2B // RF TX Power control -+#define RF_SYN_G8 0x2C // RF TX Power control -+ -+#define RF_RCK_OS 0x30 // RF TX PA control -+ -+#define RF_TXPA_G1 0x31 // RF TX PA control -+#define RF_TXPA_G2 0x32 // RF TX PA control -+#define RF_TXPA_G3 0x33 // RF TX PA control -+#define RF_TX_BIAS_A 0x35 -+#define RF_TX_BIAS_D 0x36 -+#define RF_LOBF_9 0x38 -+#define RF_RXRF_A3 0x3C // -+#define RF_TRSW 0x3F -+ -+#define RF_TXRF_A2 0x41 -+#define RF_TXPA_G4 0x46 -+#define RF_TXPA_A4 0x4B -+#define RF_0x52 0x52 -+#define RF_WE_LUT 0xEF -+#define RF_S0S1 0xB0 -+ -+// -+//Bit Mask -+// -+// 1. Page1(0x100) -+#define bBBResetB 0x100 // Useless now? -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) -+ -+// 2. Page8(0x800) -+#define bRFMOD 0x1 // Reg 0x800 rFPGA0_RFMOD -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 // Useless now -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bAntennaSelect 0x0300 -+ -+#define bXBTxAGC 0xf00 // Reg 80c rFPGA0_TxGainStage -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 // Useless now -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf //Reg0x814 -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 //T2R -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 //chane gain at continue Tx -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 // Reg 0x820~84f rFPGA0_XA_HSSIParameter1 -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 // Useless now -+//#define bHWSISelect 0x8 -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 // Reg 0x870 rFPGA0_XAB_RFInterfaceSW -+ -+#define bRFSI_TRSW 0x20 // Useless now -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+ -+#define bLSSIReadAddress 0x7f800000 // T65 RF -+ -+#define bLSSIReadEdge 0x80000000 //LSSI "Read" edge signal -+ -+#define bLSSIReadBackData 0xfffff // T65 RF -+ -+#define bLSSIReadOKFlag 0x1000 // Useless now -+#define bCCKSampleRate 0x8 //0: 44MHz, 1:88MHz -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 // Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ -+ -+#define b80MClkDelay 0x18000000 // Useless -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 // Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 // Useless -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+// 3. Page9(0x900) -+#define bOFDMTxSC 0x30000000 // Useless -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff //reset debug page and also HWord, LWord -+#define bDebugItem 0xff //reset debug page and LWord -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 -+ -+// 4. PageA(0xA00) -+#define bCCKBBMode 0x3 // Useless -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 // Reg 0xa00 rCCK0_System 20/40 switch -+ -+#define bCCKScramble 0x8 // Useless -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 //r_rx_clk -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 //CCK Rx Iinital gain polarity -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f //AGCsamp_dly -+#define bCCKFixedRxAGC 0x8000 -+//#define bCCKRxAGCFormat 0x4000 //remove to HSSI register 0x824 -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+// 5. PageC(0xC00) -+#define bNumOfSTF 0x3 // Useless -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 //the threshold for high power -+#define bRSSI_Gen 0x7f000000 //the threshold for ant diversity -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+//#define bRxMF_Hold 0x3800 -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 -+ -+// 6. PageE(0xE00) -+#define bSTBCEn 0x4 // Useless -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+//#define bRxPath1 0x01 -+//#define bRxPath2 0x02 -+//#define bRxPath3 0x04 -+//#define bRxPath4 0x08 -+//#define bTxPath1 0x10 -+//#define bTxPath2 0x20 -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 //total -+#define bShortCFOFLength 11 //fraction -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf // Useless -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 // Useless -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 // Useless -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+//Rx Pseduo noise -+#define bRxPesudoNoiseOn 0x20000000 // Useless -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+//7. RF Register -+//Zebra1 -+#define bZebra1_HSSIEnable 0x8 // Useless -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+//Zebra4 -+#define bRTL8256RegModeCtrl1 0x100 // Useless -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+//RTL8258 -+#define bRTL8258_TxLPFBW 0xc // Useless -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 -+ -+ -+// -+// Other Definition -+// -+ -+//byte endable for sb_write -+#define bByte0 0x1 // Useless -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+//for PutRegsetting & GetRegSetting BitMask -+#define bMaskByte0 0xff // Reg 0xc50 rOFDM0_XAAGCCore~0xC6f -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+ -+#define bEnable 0x1 // Useless -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 // Useless -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 //500ms // Useless -+#define tUpdateRxCounter 100 //100ms -+ -+#define rateCCK 0 // Useless -+#define rateOFDM 1 -+#define rateHT 2 -+ -+//define Register-End -+#define bPMAC_End 0x1ff // Useless -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+//define max debug item in each debug page -+//#define bMaxItem_FPGA_PHY0 0x9 -+//#define bMaxItem_FPGA_PHY1 0x3 -+//#define bMaxItem_PHY_11B 0x16 -+//#define bMaxItem_OFDM_PHY0 0x29 -+//#define bMaxItem_OFDM_PHY1 0x0 -+ -+#define bPMACControl 0x0 // Useless -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#define PathA 0x0 // Useless -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8723BPwrSeq.h linux/3rdparty/rtl8812au/include/Hal8723BPwrSeq.h ---- linux.old/3rdparty/rtl8812au/include/Hal8723BPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8723BPwrSeq.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,233 @@ -+#ifndef REALTEK_POWER_SEQUENCE_8723B -+#define REALTEK_POWER_SEQUENCE_8723B -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WM-20130815-JackieLau-RTL8723B_Power_Architecture v08.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8723B_TRANS_CARDEMU_TO_ACT_STEPS 26 -+#define RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS 15 -+#define RTL8723B_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8723B_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8723B_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8723B_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8723B_TRANS_ACT_TO_SWLPS_STEPS 22 -+#define RTL8723B_TRANS_SWLPS_TO_ACT_STEPS 15 -+#define RTL8723B_TRANS_END_STEPS 1 -+ -+ -+#define RTL8723B_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ -+ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT4|BIT3|BIT2), 0},/* disable SW LPS 0x04[10]=0 and WLSUS_EN 0x04[11]=0*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0 , BIT0},/* Disable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0 , 0},/* Enable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT4|BIT3), 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, BIT6},/* Enable WL control XTAL setting*/ \ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable falling edge triggering interrupt*/\ -+ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable GPIO9 interrupt mode*/\ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 input mode*/\ -+ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*Enable HSISR GPIO[C:0] interrupt*/\ -+ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable HSISR GPIO9 interrupt*/\ -+ {0x0068, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3},/*For GPIO9 internal pull high setting by test chip*/\ -+ {0x0069, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, BIT6},/*For GPIO9 internal pull high setting*/\ -+ -+ -+#define RTL8723B_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Enable rising edge triggering interrupt*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, 0},/* Enable BT control XTAL setting*/\ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/\ -+ -+ -+#define RTL8723B_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4|BIT3, (BIT4|BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3|BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8723B_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8723B_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07=0x20 , SOP option to disable BG/MB*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8723B_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8723B_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK|PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8723B_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8723B_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8723B_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6|BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+ -+ #define RTL8723B_TRANS_ACT_TO_SWLPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0194, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*enable 32 K source*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1},/*CCK and OFDM are enable*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1},/*CCK and OFDM are enable*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x3F},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*disable security engine*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x40},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*reset dual TSF*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0},/*Reset CPU*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*Reset MCUFWDL register*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*Reset CPU IO Wrapper*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1},/*Reset CPU IO Wrapper*/ \ -+ {0x0287, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*polling RXFF packet number = 0 */ \ -+ {0x0286, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/*polling RXDMA idle */ \ -+ {0x013D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*Clear FW RPWM interrupt */\ -+ {0x0139, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*Set FW RPWM interrupt source*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4},/*switch TSF to 32K*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/*polling TSF stable*/\ -+ {0x0090, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*Set FW LPS*/ \ -+ {0x0090, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/*polling FW LPS ready */ -+ -+ -+#define RTL8723B_TRANS_SWLPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0},/*switch TSF to 32K*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/*polling TSF stable*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1, enable security engine*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x06B7, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x09}, /*. reset MAC rx state machine*/\ -+ {0x06B4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x86}, /*. reset MAC rx state machine*/\ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/* set CPU RAM code ready*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*Reset CPU IO Wrapper*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0},/* Enable CPU*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*enable CPU IO Wrapper*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2},/* Enable CPU*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, BIT7},/*polling FW init ready */ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT6, BIT6},/*polling FW init ready */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8723B_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // -+ -+ -+extern WLAN_PWR_CFG rtl8723B_power_on_flow[RTL8723B_TRANS_CARDEMU_TO_ACT_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_radio_off_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_card_disable_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_card_enable_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_suspend_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_resume_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_hwpdn_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_enter_lps_flow[RTL8723B_TRANS_ACT_TO_LPS_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_leave_lps_flow[RTL8723B_TRANS_LPS_TO_ACT_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_enter_swlps_flow[RTL8723B_TRANS_ACT_TO_SWLPS_STEPS+RTL8723B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723B_leave_swlps_flow[RTL8723B_TRANS_SWLPS_TO_ACT_STEPS+RTL8723B_TRANS_END_STEPS]; -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8723PwrSeq.h linux/3rdparty/rtl8812au/include/Hal8723PwrSeq.h ---- linux.old/3rdparty/rtl8812au/include/Hal8723PwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8723PwrSeq.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,170 @@ -+#ifndef __HAL8723PWRSEQ_H__ -+#define __HAL8723PWRSEQ_H__ -+/* -+ Check document WM-20110607-Paul-RTL8723A_Power_Architecture-R02.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#include "HalPwrSeqCmd.h" -+ -+#define RTL8723A_TRANS_CARDEMU_TO_ACT_STEPS 15 -+#define RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8723A_TRANS_CARDEMU_TO_SUS_STEPS 15 -+#define RTL8723A_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8723A_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8723A_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8723A_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8723A_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8723A_TRANS_END_STEPS 1 -+ -+ -+#define RTL8723A_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ -+ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT4|BIT3), 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ {0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 1},/*0x4C[23] = 0x4E[7] = 1, switch DPDT_SEL_P output from WL BB */\ -+ -+#define RTL8723A_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/*0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/ \ -+ -+ -+#define RTL8723A_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4|BIT3, (BIT4|BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3|BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8723A_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8723A_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07=0x20 , SOP option to disable BG/MB*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8723A_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8723A_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK|PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8723A_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8723A_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8723A_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6|BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8723A_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // -+ -+ -+extern WLAN_PWR_CFG rtl8723A_power_on_flow[RTL8723A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8723A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723A_radio_off_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723A_card_disable_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8723A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723A_card_enable_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8723A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723A_suspend_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8723A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723A_resume_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8723A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723A_hwpdn_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8723A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8723A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723A_enter_lps_flow[RTL8723A_TRANS_ACT_TO_LPS_STEPS+RTL8723A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8723A_leave_lps_flow[RTL8723A_TRANS_LPS_TO_ACT_STEPS+RTL8723A_TRANS_END_STEPS]; -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8812PhyCfg.h linux/3rdparty/rtl8812au/include/Hal8812PhyCfg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8812PhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8812PhyCfg.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,165 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8812PHYCFG_H__ -+#define __INC_HAL8812PHYCFG_H__ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 //us -+#define AntennaDiversityValue 0x80 //(Adapter->bSoftwareAntennaDiversity ? 0x00:0x80) -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+ -+#ifdef CONFIG_PCI_HCI -+#define MAX_AGGR_NUM 0x0B -+#else -+#define MAX_AGGR_NUM 0x07 -+#endif // CONFIG_PCI_HCI -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/* BB/RF related */ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/*------------------------Export global variable----------------------------*/ -+/*------------------------Export global variable----------------------------*/ -+ -+ -+/*------------------------Export Marco Definition---------------------------*/ -+/*------------------------Export Marco Definition---------------------------*/ -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+// -+// BB and RF register read/write -+// -+u32 PHY_QueryBBReg8812( IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask ); -+void PHY_SetBBReg8812( IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data ); -+u32 PHY_QueryRFReg8812( IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask ); -+void PHY_SetRFReg8812( IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data ); -+ -+// -+// Initialization related function -+// -+/* MAC/BB/RF HAL config */ -+int PHY_MACConfig8812(IN PADAPTER Adapter ); -+int PHY_BBConfig8812(IN PADAPTER Adapter ); -+void PHY_BB8812_Config_1T(IN PADAPTER Adapter ); -+int PHY_RFConfig8812(IN PADAPTER Adapter ); -+ -+/* RF config */ -+ -+s32 -+PHY_SwitchWirelessBand8812( -+ IN PADAPTER Adapter, -+ IN u8 Band -+); -+ -+// -+// BB TX Power R/W -+// -+void PHY_GetTxPowerLevel8812( IN PADAPTER Adapter, OUT s32* powerlevel ); -+void PHY_SetTxPowerLevel8812( IN PADAPTER Adapter, IN u8 Channel ); -+ -+BOOLEAN PHY_UpdateTxPowerDbm8812( IN PADAPTER Adapter, IN int powerInDbm ); -+u8 PHY_GetTxPowerIndex_8812A( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel -+ ); -+ -+u32 PHY_GetTxBBSwing_8812A( -+ IN PADAPTER Adapter, -+ IN BAND_TYPE Band, -+ IN u8 RFPath -+ ); -+ -+VOID -+PHY_SetTxPowerIndex_8812A( -+ IN PADAPTER Adapter, -+ IN u4Byte PowerIndex, -+ IN u1Byte RFPath, -+ IN u1Byte Rate -+ ); -+ -+// -+// Switch bandwidth for 8192S -+// -+VOID -+PHY_SetBWMode8812( -+ IN PADAPTER pAdapter, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset -+); -+ -+// -+// channel switch related funciton -+// -+VOID -+PHY_SwChnl8812( -+ IN PADAPTER Adapter, -+ IN u8 channel -+); -+ -+ -+VOID -+PHY_SetSwChnlBWMode8812( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+ -+// -+// BB/MAC/RF other monitor API -+// -+ -+VOID -+PHY_SetRFPathSwitch_8812A( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bMain -+); -+ -+/*--------------------------Exported Function prototype---------------------*/ -+#endif // __INC_HAL8192CPHYCFG_H -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8812PhyReg.h linux/3rdparty/rtl8812au/include/Hal8812PhyReg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8812PhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8812PhyReg.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,739 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8812PHYREG_H__ -+#define __INC_HAL8812PHYREG_H__ -+/*--------------------------Define Parameters-------------------------------*/ -+// -+// BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+// 3. RF register 0x00-2E -+// 4. Bit Mask for BB/RF register -+// 5. Other defintion for BB/RF R/W -+// -+ -+ -+// BB Register Definition -+ -+#define rCCAonSec_Jaguar 0x838 -+#define rPwed_TH_Jaguar 0x830 -+ -+// BW and sideband setting -+#define rBWIndication_Jaguar 0x834 -+#define rL1PeakTH_Jaguar 0x848 -+#define rFPGA0_XA_LSSIReadBack 0x8a0 /*Tranceiver LSSI Readback*/ -+#define rRFMOD_Jaguar 0x8ac //RF mode -+#define rADC_Buf_Clk_Jaguar 0x8c4 -+#define rRFECTRL_Jaguar 0x900 -+#define bRFMOD_Jaguar 0xc3 -+#define rCCK_System_Jaguar 0xa00 // for cck sideband -+#define bCCK_System_Jaguar 0x10 -+ -+// Block & Path enable -+#define rOFDMCCKEN_Jaguar 0x808 // OFDM/CCK block enable -+#define bOFDMEN_Jaguar 0x20000000 -+#define bCCKEN_Jaguar 0x10000000 -+#define rRxPath_Jaguar 0x808 // Rx antenna -+#define bRxPath_Jaguar 0xff -+#define rTxPath_Jaguar 0x80c // Tx antenna -+#define bTxPath_Jaguar 0x0fffffff -+#define rCCK_RX_Jaguar 0xa04 // for cck rx path selection -+#define bCCK_RX_Jaguar 0x0c000000 -+#define rVhtlen_Use_Lsig_Jaguar 0x8c3 // Use LSIG for VHT length -+ -+// RF read/write-related -+#define rHSSIRead_Jaguar 0x8b0 // RF read addr -+#define bHSSIRead_addr_Jaguar 0xff -+#define bHSSIRead_trigger_Jaguar 0x100 -+#define rA_PIRead_Jaguar 0xd04 // RF readback with PI -+#define rB_PIRead_Jaguar 0xd44 // RF readback with PI -+#define rA_SIRead_Jaguar 0xd08 // RF readback with SI -+#define rB_SIRead_Jaguar 0xd48 // RF readback with SI -+#define rRead_data_Jaguar 0xfffff -+#define rA_LSSIWrite_Jaguar 0xc90 // RF write addr -+#define rB_LSSIWrite_Jaguar 0xe90 // RF write addr -+#define bLSSIWrite_data_Jaguar 0x000fffff -+#define bLSSIWrite_addr_Jaguar 0x0ff00000 -+ -+ -+ -+// YN: mask the following register definition temporarily -+#define rFPGA0_XA_RFInterfaceOE 0x860 // RF Channel switch -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 // RF Interface Software Control -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+//#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter -+//#define rFPGA0_XCD_RFParameter 0x87c -+ -+//#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? -+//#define rFPGA0_AnalogParameter2 0x884 -+//#define rFPGA0_AnalogParameter3 0x888 -+//#define rFPGA0_AdDaClockEn 0x888 // enable ad/da clock1 for dual-phy -+//#define rFPGA0_AnalogParameter4 0x88c -+ -+ -+// CCK TX scaling -+#define rCCK_TxFilter1_Jaguar 0xa20 -+#define bCCK_TxFilter1_C0_Jaguar 0x00ff0000 -+#define bCCK_TxFilter1_C1_Jaguar 0xff000000 -+#define rCCK_TxFilter2_Jaguar 0xa24 -+#define bCCK_TxFilter2_C2_Jaguar 0x000000ff -+#define bCCK_TxFilter2_C3_Jaguar 0x0000ff00 -+#define bCCK_TxFilter2_C4_Jaguar 0x00ff0000 -+#define bCCK_TxFilter2_C5_Jaguar 0xff000000 -+#define rCCK_TxFilter3_Jaguar 0xa28 -+#define bCCK_TxFilter3_C6_Jaguar 0x000000ff -+#define bCCK_TxFilter3_C7_Jaguar 0x0000ff00 -+ -+ -+// YN: mask the following register definition temporarily -+//#define rPdp_AntA 0xb00 -+//#define rPdp_AntA_4 0xb04 -+//#define rConfig_Pmpd_AntA 0xb28 -+//#define rConfig_AntA 0xb68 -+//#define rConfig_AntB 0xb6c -+//#define rPdp_AntB 0xb70 -+//#define rPdp_AntB_4 0xb74 -+//#define rConfig_Pmpd_AntB 0xb98 -+//#define rAPK 0xbd8 -+ -+// RXIQC -+#define rA_RxIQC_AB_Jaguar 0xc10 //RxIQ imblance matrix coeff. A & B -+#define rA_RxIQC_CD_Jaguar 0xc14 //RxIQ imblance matrix coeff. C & D -+#define rA_TxScale_Jaguar 0xc1c // Pah_A TX scaling factor -+#define rB_TxScale_Jaguar 0xe1c // Path_B TX scaling factor -+#define rB_RxIQC_AB_Jaguar 0xe10 //RxIQ imblance matrix coeff. A & B -+#define rB_RxIQC_CD_Jaguar 0xe14 //RxIQ imblance matrix coeff. C & D -+#define b_RxIQC_AC_Jaguar 0x02ff // bit mask for IQC matrix element A & C -+#define b_RxIQC_BD_Jaguar 0x02ff0000 // bit mask for IQC matrix element A & C -+ -+ -+// DIG-related -+#define rA_IGI_Jaguar 0xc50 // Initial Gain for path-A -+#define rB_IGI_Jaguar 0xe50 // Initial Gain for path-B -+#define rOFDM_FalseAlarm1_Jaguar 0xf48 // counter for break -+#define rOFDM_FalseAlarm2_Jaguar 0xf4c // counter for spoofing -+#define rCCK_FalseAlarm_Jaguar 0xa5c // counter for cck false alarm -+#define b_FalseAlarm_Jaguar 0xffff -+#define rCCK_CCA_Jaguar 0xa08 // cca threshold -+#define bCCK_CCA_Jaguar 0x00ff0000 -+ -+// Tx Power Ttraining-related -+#define rA_TxPwrTraing_Jaguar 0xc54 -+#define rB_TxPwrTraing_Jaguar 0xe54 -+ -+// Report-related -+#define rOFDM_ShortCFOAB_Jaguar 0xf60 -+#define rOFDM_LongCFOAB_Jaguar 0xf64 -+#define rOFDM_EndCFOAB_Jaguar 0xf70 -+#define rOFDM_AGCReport_Jaguar 0xf84 -+#define rOFDM_RxSNR_Jaguar 0xf88 -+#define rOFDM_RxEVMCSI_Jaguar 0xf8c -+#define rOFDM_SIGReport_Jaguar 0xf90 -+ -+// Misc functions -+#define rEDCCA_Jaguar 0x8a4 // EDCCA -+#define bEDCCA_Jaguar 0xffff -+#define rAGC_table_Jaguar 0x82c // AGC tabel select -+#define bAGC_table_Jaguar 0x3 -+#define b_sel5g_Jaguar 0x1000 // sel5g -+#define b_LNA_sw_Jaguar 0x8000 // HW/WS control for LNA -+#define rFc_area_Jaguar 0x860 // fc_area -+#define bFc_area_Jaguar 0x1ffe000 -+#define rSingleTone_ContTx_Jaguar 0x914 -+ -+// RFE -+#define rA_RFE_Pinmux_Jaguar 0xcb0 // Path_A RFE cotrol pinmux -+#define rB_RFE_Pinmux_Jaguar 0xeb0 // Path_B RFE control pinmux -+#define rA_RFE_Inv_Jaguar 0xcb4 // Path_A RFE cotrol -+#define rB_RFE_Inv_Jaguar 0xeb4 // Path_B RFE control -+#define rA_RFE_Jaguar 0xcb8 // Path_A RFE cotrol -+#define rB_RFE_Jaguar 0xeb8 // Path_B RFE control -+#define r_ANTSEL_SW_Jaguar 0x900 // ANTSEL SW Control -+#define bMask_RFEInv_Jaguar 0x3ff00000 -+#define bMask_AntselPathFollow_Jaguar 0x00030000 -+ -+// TX AGC -+#define rTxAGC_A_CCK11_CCK1_JAguar 0xc20 -+#define rTxAGC_A_Ofdm18_Ofdm6_JAguar 0xc24 -+#define rTxAGC_A_Ofdm54_Ofdm24_JAguar 0xc28 -+#define rTxAGC_A_MCS3_MCS0_JAguar 0xc2c -+#define rTxAGC_A_MCS7_MCS4_JAguar 0xc30 -+#define rTxAGC_A_MCS11_MCS8_JAguar 0xc34 -+#define rTxAGC_A_MCS15_MCS12_JAguar 0xc38 -+#define rTxAGC_A_Nss1Index3_Nss1Index0_JAguar 0xc3c -+#define rTxAGC_A_Nss1Index7_Nss1Index4_JAguar 0xc40 -+#define rTxAGC_A_Nss2Index1_Nss1Index8_JAguar 0xc44 -+#define rTxAGC_A_Nss2Index5_Nss2Index2_JAguar 0xc48 -+#define rTxAGC_A_Nss2Index9_Nss2Index6_JAguar 0xc4c -+#define rTxAGC_B_CCK11_CCK1_JAguar 0xe20 -+#define rTxAGC_B_Ofdm18_Ofdm6_JAguar 0xe24 -+#define rTxAGC_B_Ofdm54_Ofdm24_JAguar 0xe28 -+#define rTxAGC_B_MCS3_MCS0_JAguar 0xe2c -+#define rTxAGC_B_MCS7_MCS4_JAguar 0xe30 -+#define rTxAGC_B_MCS11_MCS8_JAguar 0xe34 -+#define rTxAGC_B_MCS15_MCS12_JAguar 0xe38 -+#define rTxAGC_B_Nss1Index3_Nss1Index0_JAguar 0xe3c -+#define rTxAGC_B_Nss1Index7_Nss1Index4_JAguar 0xe40 -+#define rTxAGC_B_Nss2Index1_Nss1Index8_JAguar 0xe44 -+#define rTxAGC_B_Nss2Index5_Nss2Index2_JAguar 0xe48 -+#define rTxAGC_B_Nss2Index9_Nss2Index6_JAguar 0xe4c -+#define bTxAGC_byte0_Jaguar 0xff -+#define bTxAGC_byte1_Jaguar 0xff00 -+#define bTxAGC_byte2_Jaguar 0xff0000 -+#define bTxAGC_byte3_Jaguar 0xff000000 -+ -+// IQK YN: temporaily mask this part -+//#define rFPGA0_IQK 0xe28 -+//#define rTx_IQK_Tone_A 0xe30 -+//#define rRx_IQK_Tone_A 0xe34 -+//#define rTx_IQK_PI_A 0xe38 -+//#define rRx_IQK_PI_A 0xe3c -+ -+//#define rTx_IQK 0xe40 -+//#define rRx_IQK 0xe44 -+//#define rIQK_AGC_Pts 0xe48 -+//#define rIQK_AGC_Rsp 0xe4c -+//#define rTx_IQK_Tone_B 0xe50 -+//#define rRx_IQK_Tone_B 0xe54 -+//#define rTx_IQK_PI_B 0xe58 -+//#define rRx_IQK_PI_B 0xe5c -+//#define rIQK_AGC_Cont 0xe60 -+ -+ -+// AFE-related -+#define rA_AFEPwr1_Jaguar 0xc60 // dynamic AFE power control -+#define rA_AFEPwr2_Jaguar 0xc64 // dynamic AFE power control -+#define rA_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xc68 -+#define rA_Tx_CCKBBON_OFDMRFON_Jaguar 0xc6c -+#define rA_Tx_OFDMBBON_Tx2Rx_Jaguar 0xc70 -+#define rA_Tx2Tx_RXCCK_Jaguar 0xc74 -+#define rA_Rx_OFDM_WaitRIFS_Jaguar 0xc78 -+#define rA_Rx2Rx_BT_Jaguar 0xc7c -+#define rA_sleep_nav_Jaguar 0xc80 -+#define rA_pmpd_Jaguar 0xc84 -+#define rB_AFEPwr1_Jaguar 0xe60 // dynamic AFE power control -+#define rB_AFEPwr2_Jaguar 0xe64 // dynamic AFE power control -+#define rB_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xe68 -+#define rB_Tx_CCKBBON_OFDMRFON_Jaguar 0xe6c -+#define rB_Tx_OFDMBBON_Tx2Rx_Jaguar 0xe70 -+#define rB_Tx2Tx_RXCCK_Jaguar 0xe74 -+#define rB_Rx_OFDM_WaitRIFS_Jaguar 0xe78 -+#define rB_Rx2Rx_BT_Jaguar 0xe7c -+#define rB_sleep_nav_Jaguar 0xe80 -+#define rB_pmpd_Jaguar 0xe84 -+ -+ -+// YN: mask these registers temporaily -+//#define rTx_Power_Before_IQK_A 0xe94 -+//#define rTx_Power_After_IQK_A 0xe9c -+ -+//#define rRx_Power_Before_IQK_A 0xea0 -+//#define rRx_Power_Before_IQK_A_2 0xea4 -+//#define rRx_Power_After_IQK_A 0xea8 -+//#define rRx_Power_After_IQK_A_2 0xeac -+ -+//#define rTx_Power_Before_IQK_B 0xeb4 -+//#define rTx_Power_After_IQK_B 0xebc -+ -+//#define rRx_Power_Before_IQK_B 0xec0 -+//#define rRx_Power_Before_IQK_B_2 0xec4 -+//#define rRx_Power_After_IQK_B 0xec8 -+//#define rRx_Power_After_IQK_B_2 0xecc -+ -+ -+// RSSI Dump -+#define rA_RSSIDump_Jaguar 0xBF0 -+#define rB_RSSIDump_Jaguar 0xBF1 -+#define rS1_RXevmDump_Jaguar 0xBF4 -+#define rS2_RXevmDump_Jaguar 0xBF5 -+#define rA_RXsnrDump_Jaguar 0xBF6 -+#define rB_RXsnrDump_Jaguar 0xBF7 -+#define rA_CfoShortDump_Jaguar 0xBF8 -+#define rB_CfoShortDump_Jaguar 0xBFA -+#define rA_CfoLongDump_Jaguar 0xBEC -+#define rB_CfoLongDump_Jaguar 0xBEE -+ -+ -+// RF Register -+// -+#define RF_AC_Jaguar 0x00 // -+#define RF_RF_Top_Jaguar 0x07 // -+#define RF_TXLOK_Jaguar 0x08 // -+#define RF_TXAPK_Jaguar 0x0B -+#define RF_CHNLBW_Jaguar 0x18 // RF channel and BW switch -+#define RF_RCK1_Jaguar 0x1c // -+#define RF_RCK2_Jaguar 0x1d -+#define RF_RCK3_Jaguar 0x1e -+#define RF_ModeTableAddr 0x30 -+#define RF_ModeTableData0 0x31 -+#define RF_ModeTableData1 0x32 -+#define RF_TxLCTank_Jaguar 0x54 -+#define RF_APK_Jaguar 0x63 -+#define RF_LCK 0xB4 -+#define RF_WeLut_Jaguar 0xEF -+ -+#define bRF_CHNLBW_MOD_AG_Jaguar 0x70300 -+#define bRF_CHNLBW_BW 0xc00 -+ -+ -+// -+// RL6052 Register definition -+// -+#define RF_AC 0x00 // -+#define RF_IPA_A 0x0C // -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_MODE1 0x10 // -+#define RF_MODE2 0x11 // -+#define RF_CHNLBW 0x18 // RF channel and BW switch -+#define RF_RCK_OS 0x30 // RF TX PA control -+#define RF_TXPA_G1 0x31 // RF TX PA control -+#define RF_TXPA_G2 0x32 // RF TX PA control -+#define RF_TXPA_G3 0x33 // RF TX PA control -+#define RF_0x52 0x52 -+#define RF_WE_LUT 0xEF -+ -+#define RF_TX_GAIN_OFFSET_8812A(_val) ((abs((_val)) << 1) | (((_val) > 0) ? BIT0 : 0)) -+#define RF_TX_GAIN_OFFSET_8821A(_val) ((abs((_val)) << 1) | (((_val) > 0) ? BIT0 : 0)) -+ -+// -+//Bit Mask -+// -+// 1. Page1(0x100) -+#define bBBResetB 0x100 // Useless now? -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+ -+// -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 1. Page1(0x100) -+// -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+// -+// 3. Page8(0x800) -+// -+#define rFPGA0_RFMOD 0x800 //RF mode & CCK TxSC // RF BW Setting?? -+ -+#define rFPGA0_TxInfo 0x804 // Status report?? -+#define rFPGA0_PSDFunction 0x808 -+#define rFPGA0_TxGainStage 0x80c // Set TX PWR init gain? -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 // RF 3 wire register -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+ -+#define rFPGA0_XAB_SwitchControl 0x858 // RF Channel switch -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 -+#define rFPGA0_AdDaClockEn 0x888 // enable ad/da clock1 for dual-phy -+#define rFPGA0_AnalogParameter4 0x88c -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XCD_RFPara 0x8b4 -+ -+// -+// 4. Page9(0x900) -+// -+#define rFPGA1_RFMOD 0x900 //RF mode & OFDM TxSC // RF BW Setting?? -+ -+#define rFPGA1_TxBlock 0x904 // Useless now -+#define rFPGA1_DebugSelect 0x908 // Useless now -+#define rFPGA1_TxInfo 0x90c // Useless now // Status report?? -+ -+// -+// PageA(0xA00) -+// -+#define rCCK0_System 0xa00 -+#define rCCK0_AFESetting 0xa04 // Disable init gain now // Select RX path by RSSI -+#define rCCK0_DSPParameter2 0xa1c //SQ threshold -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 //debug port and Tx filter3 -+#define rCCK0_FalseAlarmReport 0xa2c //0xa2d useless now 0xa30-a4f channel report -+ -+// -+// PageB(0xB00) -+// -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rConfig_Pmpd_AntB 0xb98 -+#define rAPK 0xbd8 -+ -+// -+// 6. PageC(0xC00) -+// -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 //RxIQ DC offset, Rx digital filter, DC notch filter -+#define rOFDM0_XARxIQImbalance 0xc14 //RxIQ imblance matrix -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 //PD,BW & SBD // DM tune init gain -+#define rOFDM0_RxDetector2 0xc34 //SBD & Fame Sync. -+#define rOFDM0_RxDetector3 0xc38 //Frame Sync. -+#define rOFDM0_RxDetector4 0xc3c //PD, SBD, Frame Sync & Short-GI -+ -+#define rOFDM0_RxDSP 0xc40 //Rx Sync Path -+#define rOFDM0_CFOandDAGC 0xc44 //CFO & DAGC -+#define rOFDM0_CCADropThreshold 0xc48 //CCA Drop threshold -+#define rOFDM0_ECCAThreshold 0xc4c // energy CCA -+ -+#define rOFDM0_XAAGCCore1 0xc50 // DIG -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 // TX PWR TRACK and DIG -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+// -+// 7. PageD(0xD00) -+// -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+// -+// 8. PageE(0xE00) -+// -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+ -+// 2. Page8(0x800) -+#define bRFMOD 0x1 // Reg 0x800 rFPGA0_RFMOD -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+#define bXBTxAGC 0xf00 // Reg 80c rFPGA0_TxGainStage -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+// 4. PageA(0xA00) -+#define bCCKBBMode 0x3 // Useless -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 // Reg 0xa00 rCCK0_System 20/40 switch -+ -+#define bCCKScramble 0x8 // Useless -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 //r_rx_clk -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 //CCK Rx Iinital gain polarity -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f //AGCsamp_dly -+#define bCCKFixedRxAGC 0x8000 -+//#define bCCKRxAGCFormat 0x4000 //remove to HSSI register 0x824 -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+// 6. PageE(0xE00) -+#define bSTBCEn 0x4 // Useless -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+ -+ -+// -+// Other Definition -+// -+ -+#define bEnable 0x1 // Useless -+#define bDisable 0x0 -+ -+//byte endable for srwrite -+#define bByte0 0x1 // Useless -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+//for PutRegsetting & GetRegSetting BitMask -+#define bMaskByte0 0xff // Reg 0xc50 rOFDM0_XAAGCCore~0xC6f -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8812PwrSeq.h linux/3rdparty/rtl8812au/include/Hal8812PwrSeq.h ---- linux.old/3rdparty/rtl8812au/include/Hal8812PwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8812PwrSeq.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,210 @@ -+ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL8812PWRSEQ_H__ -+#define __HAL8812PWRSEQ_H__ -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WB-110628-DZ-RTL8195 (Jaguar) Power Architecture-R04.pdf -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8812_TRANS_CARDEMU_TO_ACT_STEPS 15 -+#define RTL8812_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8812_TRANS_CARDEMU_TO_SUS_STEPS 15 -+#define RTL8812_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8812_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8812_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8812_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8812_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8812_TRANS_END_STEPS 1 -+ -+ -+#define RTL8812_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ /*{0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0}, disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ -+ -+#define RTL8812_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ -+ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ /*{0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},//0x1F[7:0] = 0 turn off RF*/ \ -+ /*{0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},//0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x2A}, /* 0x07[7:0] = 0x28 sps pwm mode 0x2a for BT coex*/ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk =500k */ \ -+ /*{0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0|BIT1, 0}, // 0x02[1:0] = 0 reset BB */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ -+ -+#define RTL8812_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xcc},\ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xEC},\ -+ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x07},/* gpio11 input mode, gpio10~8 output mode */ \ -+ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ -+ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/* suspend option all off */ \ -+ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x80, BIT7},/*0x14[7] = 1 turn on ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, BIT0},/* 0x15[0] =1 trun on ZCD */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x10, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk =500k */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 2b'11 enable WL suspend for PCIe*/ -+ -+#define RTL8812_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 2b'01enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x10, 0},/*0x23[4] = 0 hpon LDO sleep mode leave */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, 0},/* 0x15[0] =0 trun off ZCD */ \ -+ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x80, 0},/*0x14[7] = 0 turn off ZCD */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ -+ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio11 input mode, gpio10~8 input mode */ -+ -+#define RTL8812_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ /**{0x0194, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, //0x194[0]=0 , disable 32K clock*/ \ -+ /**{0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x94}, //0x93=0x94 , 90[30] =0 enable 500k ANA clock .switch clock from 12M to 500K , 90 [26] =0 disable EEprom loader clock*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0}, /*0x03[2] = 0, reset 8051*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x05}, /*0x80=05h if reload fw, fill the default value of host_CPU handshake field*/ \ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xcc},\ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xEC},\ -+ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x07},/* gpio11 input mode, gpio10~8 output mode */ \ -+ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ -+ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ -+ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x80, BIT7},/*0x14[7] = 1 turn on ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, BIT0},/* 0x15[0] =1 trun on ZCD */ \ -+ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, 0},/*0x12[0] = 0 force PFM mode */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x10, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk =500k */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07=0x20 , SOP option to disable BG/MB*/ \ -+ {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /*0x01f[1]=0 , disable RFC_0 control REG_RF_CTRL_8812 */ \ -+ {0x0076, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /*0x076[1]=0 , disable RFC_1 control REG_OPT_CTRL_8812 +2 */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 2b'01 enable WL suspend*/ -+ -+#define RTL8812_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*0x12[0] = 1 force PWM mode */ \ -+ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x80, 0},/*0x14[7] = 0 turn off ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, 0},/* 0x15[0] =0 trun off ZCD */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x10, 0},/*0x23[4] = 0 hpon LDO leave sleep mode */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ -+ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio11 input mode, gpio10~8 input mode */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0}, /*0x04[10] = 0, enable SW LPS PCIE only*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 2b'01enable WL suspend*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2}, /*0x03[2] = 1, enable 8051*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8812_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8812_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8812_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x7F},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ -+ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated,and RF closed*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ -+ -+ -+#define RTL8812_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/ \ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/ \ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/ \ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/ \ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6|BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8812_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // -+ -+ -+extern WLAN_PWR_CFG rtl8812_power_on_flow[RTL8812_TRANS_CARDEMU_TO_ACT_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_radio_off_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_card_disable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_card_enable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_suspend_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_SUS_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_resume_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_SUS_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_hwpdn_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_enter_lps_flow[RTL8812_TRANS_ACT_TO_LPS_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_leave_lps_flow[RTL8812_TRANS_LPS_TO_ACT_STEPS+RTL8812_TRANS_END_STEPS]; -+ -+#endif //__HAL8812PWRSEQ_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8814PhyCfg.h linux/3rdparty/rtl8812au/include/Hal8814PhyCfg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8814PhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8814PhyCfg.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,282 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8814PHYCFG_H__ -+#define __INC_HAL8814PHYCFG_H__ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 //us -+#define AntennaDiversityValue 0x80 //(Adapter->bSoftwareAntennaDiversity ? 0x00:0x80) -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+ -+#ifdef CONFIG_PCI_HCI -+#define MAX_AGGR_NUM 0x0B -+#else -+#define MAX_AGGR_NUM 0x07 -+#endif // CONFIG_PCI_HCI -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/* BB/RF related */ -+ -+#define SIC_ENABLE 0 -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/*------------------------Export global variable----------------------------*/ -+/*------------------------Export global variable----------------------------*/ -+ -+ -+/*------------------------Export Marco Definition---------------------------*/ -+/*------------------------Export Marco Definition---------------------------*/ -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+//1. BB register R/W API -+ -+extern u32 -+PHY_QueryBBReg8814A( IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask ); -+ -+ -+VOID -+PHY_SetBBReg8814A( IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data ); -+ -+ -+extern u32 -+PHY_QueryRFReg8814A( IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask ); -+ -+ -+void -+PHY_SetRFReg8814A( IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data ); -+ -+//1 3. Initial BB/RF config by reading MAC/BB/RF txt. -+s32 -+phy_BB8814A_Config_ParaFile( -+ IN PADAPTER Adapter -+ ); -+ -+ -+RT_STATUS -+PHY_BBConfigMP_8814A( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+PHY_ConfigBB_8814A( -+ IN PADAPTER Adapter -+ ); -+ -+ -+VOID -+phy_ADC_CLK_8814A( -+ IN PADAPTER Adapter -+ ); -+ -+s32 -+PHY_RFConfig8814A( -+ IN PADAPTER Adapter -+ ); -+ -+// -+// RF Power setting -+// -+//BOOLEAN PHY_SetRFPowerState8814A(PADAPTER Adapter, rt_rf_power_state eRFPowerState); -+ -+//1 5. Tx Power setting API -+ -+VOID -+PHY_GetTxPowerLevel8814( -+ IN PADAPTER Adapter, -+ OUT ps4Byte powerlevel -+ ); -+ -+VOID -+PHY_SetTxPowerLevel8814( -+ IN PADAPTER Adapter, -+ IN u8 Channel -+ ); -+ -+u8 -+PHY_GetTxPowerIndex_8814A( -+ IN PADAPTER Adapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel -+ ); -+ -+VOID -+PHY_SetTxPowerIndex_8814A( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+ ); -+ -+ -+BOOLEAN -+PHY_UpdateTxPowerDbm8814A( -+ IN PADAPTER Adapter, -+ IN s4Byte powerInDbm -+ ); -+ -+ -+u32 -+PHY_GetTxBBSwing_8814A( -+ IN PADAPTER Adapter, -+ IN BAND_TYPE Band, -+ IN u8 RFPath -+ ); -+ -+ -+ -+//1 6. Channel setting API -+ -+VOID -+PHY_SwChnlTimerCallback8814A( -+ IN PRT_TIMER pTimer -+ ); -+ -+VOID -+PHY_SwChnlWorkItemCallback8814A( -+ IN PVOID pContext -+ ); -+ -+ -+VOID -+HAL_HandleSwChnl8814A( -+ IN PADAPTER pAdapter, -+ IN u8 channel -+ ); -+ -+VOID -+PHY_SwChnlSynchronously8814A( IN PADAPTER pAdapter, -+ IN u8 channel ); -+ -+VOID -+PHY_SwChnlAndSetBWModeCallback8814A(IN PVOID pContext); -+ -+ -+VOID -+PHY_HandleSwChnlAndSetBW8814A( -+ IN PADAPTER Adapter, -+ IN BOOLEAN bSwitchChannel, -+ IN BOOLEAN bSetBandWidth, -+ IN u8 ChannelNum, -+ IN CHANNEL_WIDTH ChnlWidth, -+ IN u8 ChnlOffsetOf40MHz, -+ IN u8 ChnlOffsetOf80MHz, -+ IN u8 CenterFrequencyIndex1 -+); -+ -+ -+BOOLEAN -+PHY_QueryRFPathSwitch_8814A( IN PADAPTER pAdapter); -+ -+ -+ -+//VOID PHY_SetMonitorMode8814A(PADAPTER pAdapter, BOOLEAN bEnableMonitorMode); -+ -+ -+#if (USE_WORKITEM) -+VOID -+RtCheckForHangWorkItemCallback8814A( -+ IN PVOID pContext -+); -+#endif -+ -+BOOLEAN -+SetAntennaConfig8814A( -+ IN PADAPTER Adapter, -+ IN u8 DefaultAnt -+ ); -+ -+VOID -+PHY_SetRFEReg8814A( -+ IN PADAPTER Adapter, -+ IN BOOLEAN bInit, -+ IN u8 Band -+ ); -+ -+ -+s32 -+PHY_SwitchWirelessBand8814A( -+ IN PADAPTER Adapter, -+ IN u8 Band -+); -+ -+VOID -+PHY_SetIO_8814A( -+ PADAPTER pAdapter -+ ); -+ -+VOID -+PHY_SetBWMode8814( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth, // 20M or 40M -+ IN u8 Offset // Upper, Lower, or Don't care -+); -+ -+VOID -+PHY_SwChnl8814( -+ IN PADAPTER Adapter, -+ IN u8 channel -+ ); -+ -+VOID -+PHY_SetSwChnlBWMode8814( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+ -+s32 PHY_MACConfig8814(PADAPTER Adapter); -+int PHY_BBConfig8814(PADAPTER Adapter); -+VOID PHY_Set_SecCCATH_by_RXANT_8814A(PADAPTER pAdapter, u4Byte ulAntennaRx); -+ -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+#endif // __INC_HAL8192CPHYCFG_H -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8814PhyReg.h linux/3rdparty/rtl8812au/include/Hal8814PhyReg.h ---- linux.old/3rdparty/rtl8812au/include/Hal8814PhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8814PhyReg.h 2017-06-07 23:07:21.035689763 +0300 -@@ -0,0 +1,860 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8814PHYREG_H__ -+#define __INC_HAL8814PHYREG_H__ -+/*--------------------------Define Parameters-------------------------------*/ -+// -+// BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+// 3. RF register 0x00-2E -+// 4. Bit Mask for BB/RF register -+// 5. Other defintion for BB/RF R/W -+// -+ -+ -+/* BB Register Definition */ -+ -+#define rCCAonSec_Jaguar 0x838 -+#define rPwed_TH_Jaguar 0x830 -+#define rL1_Weight_Jaguar 0x840 -+ -+// BW and sideband setting -+#define rBWIndication_Jaguar 0x834 -+#define rL1PeakTH_Jaguar 0x848 -+#define rRFMOD_Jaguar 0x8ac //RF mode -+#define rADC_Buf_Clk_Jaguar 0x8c4 -+#define rADC_Buf_40_Clk_Jaguar2 0x8c8 -+#define rRFECTRL_Jaguar 0x900 -+#define bRFMOD_Jaguar 0xc3 -+#define rCCK_System_Jaguar 0xa00 // for cck sideband -+#define bCCK_System_Jaguar 0x10 -+ -+// Block & Path enable -+#define rOFDMCCKEN_Jaguar 0x808 // OFDM/CCK block enable -+#define bOFDMEN_Jaguar 0x20000000 -+#define bCCKEN_Jaguar 0x10000000 -+#define rRxPath_Jaguar 0x808 // Rx antenna -+#define bRxPath_Jaguar 0xff -+#define rTxPath_Jaguar 0x80c // Tx antenna -+#define bTxPath_Jaguar 0x0fffffff -+#define rCCK_RX_Jaguar 0xa04 // for cck rx path selection -+#define bCCK_RX_Jaguar 0x0c000000 -+#define rVhtlen_Use_Lsig_Jaguar 0x8c3 // Use LSIG for VHT length -+ -+#define rRxPath_Jaguar2 0xa04 // Rx antenna -+#define rTxAnt_1Nsts_Jaguar2 0x93c // Tx antenna for 1Nsts -+#define rTxAnt_23Nsts_Jaguar2 0x940 // Tx antenna for 2Nsts and 3Nsts -+ -+ -+// RF read/write-related -+#define rHSSIRead_Jaguar 0x8b0 // RF read addr -+#define bHSSIRead_addr_Jaguar 0xff -+#define bHSSIRead_trigger_Jaguar 0x100 -+#define rA_PIRead_Jaguar 0xd04 // RF readback with PI -+#define rB_PIRead_Jaguar 0xd44 // RF readback with PI -+#define rA_SIRead_Jaguar 0xd08 // RF readback with SI -+#define rB_SIRead_Jaguar 0xd48 // RF readback with SI -+#define rRead_data_Jaguar 0xfffff -+#define rA_LSSIWrite_Jaguar 0xc90 // RF write addr -+#define rB_LSSIWrite_Jaguar 0xe90 // RF write addr -+#define bLSSIWrite_data_Jaguar 0x000fffff -+#define bLSSIWrite_addr_Jaguar 0x0ff00000 -+ -+#define rC_PIRead_Jaguar2 0xd84 // RF readback with PI -+#define rD_PIRead_Jaguar2 0xdC4 // RF readback with PI -+#define rC_SIRead_Jaguar2 0xd88 // RF readback with SI -+#define rD_SIRead_Jaguar2 0xdC8 // RF readback with SI -+#define rC_LSSIWrite_Jaguar2 0x1890 // RF write addr -+#define rD_LSSIWrite_Jaguar2 0x1A90 // RF write addr -+ -+ -+// YN: mask the following register definition temporarily -+#define rFPGA0_XA_RFInterfaceOE 0x860 // RF Channel switch -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 // RF Interface Software Control -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+//#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter -+//#define rFPGA0_XCD_RFParameter 0x87c -+ -+//#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? -+//#define rFPGA0_AnalogParameter2 0x884 -+//#define rFPGA0_AnalogParameter3 0x888 -+//#define rFPGA0_AdDaClockEn 0x888 // enable ad/da clock1 for dual-phy -+//#define rFPGA0_AnalogParameter4 0x88c -+ -+ -+// CCK TX scaling -+#define rCCK_TxFilter1_Jaguar 0xa20 -+#define bCCK_TxFilter1_C0_Jaguar 0x00ff0000 -+#define bCCK_TxFilter1_C1_Jaguar 0xff000000 -+#define rCCK_TxFilter2_Jaguar 0xa24 -+#define bCCK_TxFilter2_C2_Jaguar 0x000000ff -+#define bCCK_TxFilter2_C3_Jaguar 0x0000ff00 -+#define bCCK_TxFilter2_C4_Jaguar 0x00ff0000 -+#define bCCK_TxFilter2_C5_Jaguar 0xff000000 -+#define rCCK_TxFilter3_Jaguar 0xa28 -+#define bCCK_TxFilter3_C6_Jaguar 0x000000ff -+#define bCCK_TxFilter3_C7_Jaguar 0x0000ff00 -+/* NBI & CSI Mask setting */ -+#define rCSI_Mask_Setting1_Jaguar 0x874 -+#define rCSI_Fix_Mask0_Jaguar 0x880 -+#define rCSI_Fix_Mask1_Jaguar 0x884 -+#define rCSI_Fix_Mask2_Jaguar 0x888 -+#define rCSI_Fix_Mask3_Jaguar 0x88c -+#define rCSI_Fix_Mask4_Jaguar 0x890 -+#define rCSI_Fix_Mask5_Jaguar 0x894 -+#define rCSI_Fix_Mask6_Jaguar 0x898 -+#define rCSI_Fix_Mask7_Jaguar 0x89c -+#define rNBI_Setting_Jaguar 0x87c -+ -+ -+// YN: mask the following register definition temporarily -+//#define rPdp_AntA 0xb00 -+//#define rPdp_AntA_4 0xb04 -+//#define rConfig_Pmpd_AntA 0xb28 -+//#define rConfig_AntA 0xb68 -+//#define rConfig_AntB 0xb6c -+//#define rPdp_AntB 0xb70 -+//#define rPdp_AntB_4 0xb74 -+//#define rConfig_Pmpd_AntB 0xb98 -+//#define rAPK 0xbd8 -+ -+// RXIQC -+#define rA_RxIQC_AB_Jaguar 0xc10 //RxIQ imblance matrix coeff. A & B -+#define rA_RxIQC_CD_Jaguar 0xc14 //RxIQ imblance matrix coeff. C & D -+#define rA_TxScale_Jaguar 0xc1c // Pah_A TX scaling factor -+#define rB_TxScale_Jaguar 0xe1c // Path_B TX scaling factor -+#define rB_RxIQC_AB_Jaguar 0xe10 //RxIQ imblance matrix coeff. A & B -+#define rB_RxIQC_CD_Jaguar 0xe14 //RxIQ imblance matrix coeff. C & D -+#define b_RxIQC_AC_Jaguar 0x02ff // bit mask for IQC matrix element A & C -+#define b_RxIQC_BD_Jaguar 0x02ff0000 // bit mask for IQC matrix element A & C -+ -+#define rC_TxScale_Jaguar2 0x181c // Pah_C TX scaling factor -+#define rD_TxScale_Jaguar2 0x1A1c // Path_D TX scaling factor -+#define rRF_TxGainOffset 0x55 -+ -+// DIG-related -+#define rA_IGI_Jaguar 0xc50 // Initial Gain for path-A -+#define rB_IGI_Jaguar 0xe50 // Initial Gain for path-B -+#define rC_IGI_Jaguar2 0x1850 // Initial Gain for path-C -+#define rD_IGI_Jaguar2 0x1A50 // Initial Gain for path-D -+ -+#define rOFDM_FalseAlarm1_Jaguar 0xf48 // counter for break -+#define rOFDM_FalseAlarm2_Jaguar 0xf4c // counter for spoofing -+#define rCCK_FalseAlarm_Jaguar 0xa5c // counter for cck false alarm -+#define b_FalseAlarm_Jaguar 0xffff -+#define rCCK_CCA_Jaguar 0xa08 // cca threshold -+#define bCCK_CCA_Jaguar 0x00ff0000 -+ -+// Tx Power Ttraining-related -+#define rA_TxPwrTraing_Jaguar 0xc54 -+#define rB_TxPwrTraing_Jaguar 0xe54 -+ -+// Report-related -+#define rOFDM_ShortCFOAB_Jaguar 0xf60 -+#define rOFDM_LongCFOAB_Jaguar 0xf64 -+#define rOFDM_EndCFOAB_Jaguar 0xf70 -+#define rOFDM_AGCReport_Jaguar 0xf84 -+#define rOFDM_RxSNR_Jaguar 0xf88 -+#define rOFDM_RxEVMCSI_Jaguar 0xf8c -+#define rOFDM_SIGReport_Jaguar 0xf90 -+ -+// Misc functions -+#define rEDCCA_Jaguar 0x8a4 // EDCCA -+#define bEDCCA_Jaguar 0xffff -+#define rAGC_table_Jaguar 0x82c // AGC tabel select -+#define bAGC_table_Jaguar 0x3 -+#define b_sel5g_Jaguar 0x1000 // sel5g -+#define b_LNA_sw_Jaguar 0x8000 // HW/WS control for LNA -+#define rFc_area_Jaguar 0x860 // fc_area -+#define bFc_area_Jaguar 0x1ffe000 -+#define rSingleTone_ContTx_Jaguar 0x914 -+ -+#define rAGC_table_Jaguar2 0x958 // AGC tabel select -+#define rDMA_trigger_Jaguar2 0x95C // ADC sample mode -+ -+ -+// RFE -+#define rA_RFE_Pinmux_Jaguar 0xcb0 // Path_A RFE cotrol pinmux -+#define rB_RFE_Pinmux_Jaguar 0xeb0 // Path_B RFE control pinmux -+#define rA_RFE_Inv_Jaguar 0xcb4 // Path_A RFE cotrol -+#define rB_RFE_Inv_Jaguar 0xeb4 // Path_B RFE control -+#define rA_RFE_Jaguar 0xcb8 // Path_A RFE cotrol -+#define rB_RFE_Jaguar 0xeb8 // Path_B RFE control -+#define r_ANTSEL_SW_Jaguar 0x900 // ANTSEL SW Control -+#define bMask_RFEInv_Jaguar 0x3ff00000 -+#define bMask_AntselPathFollow_Jaguar 0x00030000 -+ -+#define rC_RFE_Pinmux_Jaguar 0x18B4 // Path_C RFE cotrol pinmux -+#define rD_RFE_Pinmux_Jaguar 0x1AB4 // Path_D RFE cotrol pinmux -+#define rA_RFE_Sel_Jaguar2 0x1990 -+ -+ -+ -+// TX AGC -+#define rTxAGC_A_CCK11_CCK1_JAguar 0xc20 -+#define rTxAGC_A_Ofdm18_Ofdm6_JAguar 0xc24 -+#define rTxAGC_A_Ofdm54_Ofdm24_JAguar 0xc28 -+#define rTxAGC_A_MCS3_MCS0_JAguar 0xc2c -+#define rTxAGC_A_MCS7_MCS4_JAguar 0xc30 -+#define rTxAGC_A_MCS11_MCS8_JAguar 0xc34 -+#define rTxAGC_A_MCS15_MCS12_JAguar 0xc38 -+#define rTxAGC_A_Nss1Index3_Nss1Index0_JAguar 0xc3c -+#define rTxAGC_A_Nss1Index7_Nss1Index4_JAguar 0xc40 -+#define rTxAGC_A_Nss2Index1_Nss1Index8_JAguar 0xc44 -+#define rTxAGC_A_Nss2Index5_Nss2Index2_JAguar 0xc48 -+#define rTxAGC_A_Nss2Index9_Nss2Index6_JAguar 0xc4c -+#define rTxAGC_B_CCK11_CCK1_JAguar 0xe20 -+#define rTxAGC_B_Ofdm18_Ofdm6_JAguar 0xe24 -+#define rTxAGC_B_Ofdm54_Ofdm24_JAguar 0xe28 -+#define rTxAGC_B_MCS3_MCS0_JAguar 0xe2c -+#define rTxAGC_B_MCS7_MCS4_JAguar 0xe30 -+#define rTxAGC_B_MCS11_MCS8_JAguar 0xe34 -+#define rTxAGC_B_MCS15_MCS12_JAguar 0xe38 -+#define rTxAGC_B_Nss1Index3_Nss1Index0_JAguar 0xe3c -+#define rTxAGC_B_Nss1Index7_Nss1Index4_JAguar 0xe40 -+#define rTxAGC_B_Nss2Index1_Nss1Index8_JAguar 0xe44 -+#define rTxAGC_B_Nss2Index5_Nss2Index2_JAguar 0xe48 -+#define rTxAGC_B_Nss2Index9_Nss2Index6_JAguar 0xe4c -+#define bTxAGC_byte0_Jaguar 0xff -+#define bTxAGC_byte1_Jaguar 0xff00 -+#define bTxAGC_byte2_Jaguar 0xff0000 -+#define bTxAGC_byte3_Jaguar 0xff000000 -+ -+ -+// TX AGC -+#define rTxAGC_A_CCK11_CCK1_Jaguar2 0xc20 -+#define rTxAGC_A_Ofdm18_Ofdm6_Jaguar2 0xc24 -+#define rTxAGC_A_Ofdm54_Ofdm24_Jaguar2 0xc28 -+#define rTxAGC_A_MCS3_MCS0_Jaguar2 0xc2c -+#define rTxAGC_A_MCS7_MCS4_Jaguar2 0xc30 -+#define rTxAGC_A_MCS11_MCS8_Jaguar2 0xc34 -+#define rTxAGC_A_MCS15_MCS12_Jaguar2 0xc38 -+#define rTxAGC_A_MCS19_MCS16_Jaguar2 0xcd8 -+#define rTxAGC_A_MCS23_MCS20_Jaguar2 0xcdc -+#define rTxAGC_A_Nss1Index3_Nss1Index0_Jaguar2 0xc3c -+#define rTxAGC_A_Nss1Index7_Nss1Index4_Jaguar2 0xc40 -+#define rTxAGC_A_Nss2Index1_Nss1Index8_Jaguar2 0xc44 -+#define rTxAGC_A_Nss2Index5_Nss2Index2_Jaguar2 0xc48 -+#define rTxAGC_A_Nss2Index9_Nss2Index6_Jaguar2 0xc4c -+#define rTxAGC_A_Nss3Index3_Nss3Index0_Jaguar2 0xce0 -+#define rTxAGC_A_Nss3Index7_Nss3Index4_Jaguar2 0xce4 -+#define rTxAGC_A_Nss3Index9_Nss3Index8_Jaguar2 0xce8 -+#define rTxAGC_B_CCK11_CCK1_Jaguar2 0xe20 -+#define rTxAGC_B_Ofdm18_Ofdm6_Jaguar2 0xe24 -+#define rTxAGC_B_Ofdm54_Ofdm24_Jaguar2 0xe28 -+#define rTxAGC_B_MCS3_MCS0_Jaguar2 0xe2c -+#define rTxAGC_B_MCS7_MCS4_Jaguar2 0xe30 -+#define rTxAGC_B_MCS11_MCS8_Jaguar2 0xe34 -+#define rTxAGC_B_MCS15_MCS12_Jaguar2 0xe38 -+#define rTxAGC_B_MCS19_MCS16_Jaguar2 0xed8 -+#define rTxAGC_B_MCS23_MCS20_Jaguar2 0xedc -+#define rTxAGC_B_Nss1Index3_Nss1Index0_Jaguar2 0xe3c -+#define rTxAGC_B_Nss1Index7_Nss1Index4_Jaguar2 0xe40 -+#define rTxAGC_B_Nss2Index1_Nss1Index8_Jaguar2 0xe44 -+#define rTxAGC_B_Nss2Index5_Nss2Index2_Jaguar2 0xe48 -+#define rTxAGC_B_Nss2Index9_Nss2Index6_Jaguar2 0xe4c -+#define rTxAGC_B_Nss3Index3_Nss3Index0_Jaguar2 0xee0 -+#define rTxAGC_B_Nss3Index7_Nss3Index4_Jaguar2 0xee4 -+#define rTxAGC_B_Nss3Index9_Nss3Index8_Jaguar2 0xee8 -+#define rTxAGC_C_CCK11_CCK1_Jaguar2 0x1820 -+#define rTxAGC_C_Ofdm18_Ofdm6_Jaguar2 0x1824 -+#define rTxAGC_C_Ofdm54_Ofdm24_Jaguar2 0x1828 -+#define rTxAGC_C_MCS3_MCS0_Jaguar2 0x182c -+#define rTxAGC_C_MCS7_MCS4_Jaguar2 0x1830 -+#define rTxAGC_C_MCS11_MCS8_Jaguar2 0x1834 -+#define rTxAGC_C_MCS15_MCS12_Jaguar2 0x1838 -+#define rTxAGC_C_MCS19_MCS16_Jaguar2 0x18d8 -+#define rTxAGC_C_MCS23_MCS20_Jaguar2 0x18dc -+#define rTxAGC_C_Nss1Index3_Nss1Index0_Jaguar2 0x183c -+#define rTxAGC_C_Nss1Index7_Nss1Index4_Jaguar2 0x1840 -+#define rTxAGC_C_Nss2Index1_Nss1Index8_Jaguar2 0x1844 -+#define rTxAGC_C_Nss2Index5_Nss2Index2_Jaguar2 0x1848 -+#define rTxAGC_C_Nss2Index9_Nss2Index6_Jaguar2 0x184c -+#define rTxAGC_C_Nss3Index3_Nss3Index0_Jaguar2 0x18e0 -+#define rTxAGC_C_Nss3Index7_Nss3Index4_Jaguar2 0x18e4 -+#define rTxAGC_C_Nss3Index9_Nss3Index8_Jaguar2 0x18e8 -+#define rTxAGC_D_CCK11_CCK1_Jaguar2 0x1a20 -+#define rTxAGC_D_Ofdm18_Ofdm6_Jaguar2 0x1a24 -+#define rTxAGC_D_Ofdm54_Ofdm24_Jaguar2 0x1a28 -+#define rTxAGC_D_MCS3_MCS0_Jaguar2 0x1a2c -+#define rTxAGC_D_MCS7_MCS4_Jaguar2 0x1a30 -+#define rTxAGC_D_MCS11_MCS8_Jaguar2 0x1a34 -+#define rTxAGC_D_MCS15_MCS12_Jaguar2 0x1a38 -+#define rTxAGC_D_MCS19_MCS16_Jaguar2 0x1ad8 -+#define rTxAGC_D_MCS23_MCS20_Jaguar2 0x1adc -+#define rTxAGC_D_Nss1Index3_Nss1Index0_Jaguar2 0x1a3c -+#define rTxAGC_D_Nss1Index7_Nss1Index4_Jaguar2 0x1a40 -+#define rTxAGC_D_Nss2Index1_Nss1Index8_Jaguar2 0x1a44 -+#define rTxAGC_D_Nss2Index5_Nss2Index2_Jaguar2 0x1a48 -+#define rTxAGC_D_Nss2Index9_Nss2Index6_Jaguar2 0x1a4c -+#define rTxAGC_D_Nss3Index3_Nss3Index0_Jaguar2 0x1ae0 -+#define rTxAGC_D_Nss3Index7_Nss3Index4_Jaguar2 0x1ae4 -+#define rTxAGC_D_Nss3Index9_Nss3Index8_Jaguar2 0x1ae8 -+// IQK YN: temporaily mask this part -+//#define rFPGA0_IQK 0xe28 -+//#define rTx_IQK_Tone_A 0xe30 -+//#define rRx_IQK_Tone_A 0xe34 -+//#define rTx_IQK_PI_A 0xe38 -+//#define rRx_IQK_PI_A 0xe3c -+ -+//#define rTx_IQK 0xe40 -+//#define rRx_IQK 0xe44 -+//#define rIQK_AGC_Pts 0xe48 -+//#define rIQK_AGC_Rsp 0xe4c -+//#define rTx_IQK_Tone_B 0xe50 -+//#define rRx_IQK_Tone_B 0xe54 -+//#define rTx_IQK_PI_B 0xe58 -+//#define rRx_IQK_PI_B 0xe5c -+//#define rIQK_AGC_Cont 0xe60 -+ -+ -+// AFE-related -+#define rA_AFEPwr1_Jaguar 0xc60 // dynamic AFE power control -+#define rA_AFEPwr2_Jaguar 0xc64 // dynamic AFE power control -+#define rA_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xc68 -+#define rA_Tx_CCKBBON_OFDMRFON_Jaguar 0xc6c -+#define rA_Tx_OFDMBBON_Tx2Rx_Jaguar 0xc70 -+#define rA_Tx2Tx_RXCCK_Jaguar 0xc74 -+#define rA_Rx_OFDM_WaitRIFS_Jaguar 0xc78 -+#define rA_Rx2Rx_BT_Jaguar 0xc7c -+#define rA_sleep_nav_Jaguar 0xc80 -+#define rA_pmpd_Jaguar 0xc84 -+#define rB_AFEPwr1_Jaguar 0xe60 // dynamic AFE power control -+#define rB_AFEPwr2_Jaguar 0xe64 // dynamic AFE power control -+#define rB_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xe68 -+#define rB_Tx_CCKBBON_OFDMRFON_Jaguar 0xe6c -+#define rB_Tx_OFDMBBON_Tx2Rx_Jaguar 0xe70 -+#define rB_Tx2Tx_RXCCK_Jaguar 0xe74 -+#define rB_Rx_OFDM_WaitRIFS_Jaguar 0xe78 -+#define rB_Rx2Rx_BT_Jaguar 0xe7c -+#define rB_sleep_nav_Jaguar 0xe80 -+#define rB_pmpd_Jaguar 0xe84 -+ -+ -+// YN: mask these registers temporaily -+//#define rTx_Power_Before_IQK_A 0xe94 -+//#define rTx_Power_After_IQK_A 0xe9c -+ -+//#define rRx_Power_Before_IQK_A 0xea0 -+//#define rRx_Power_Before_IQK_A_2 0xea4 -+//#define rRx_Power_After_IQK_A 0xea8 -+//#define rRx_Power_After_IQK_A_2 0xeac -+ -+//#define rTx_Power_Before_IQK_B 0xeb4 -+//#define rTx_Power_After_IQK_B 0xebc -+ -+//#define rRx_Power_Before_IQK_B 0xec0 -+//#define rRx_Power_Before_IQK_B_2 0xec4 -+//#define rRx_Power_After_IQK_B 0xec8 -+//#define rRx_Power_After_IQK_B_2 0xecc -+ -+ -+// RSSI Dump -+#define rA_RSSIDump_Jaguar 0xBF0 -+#define rB_RSSIDump_Jaguar 0xBF1 -+#define rS1_RXevmDump_Jaguar 0xBF4 -+#define rS2_RXevmDump_Jaguar 0xBF5 -+#define rA_RXsnrDump_Jaguar 0xBF6 -+#define rB_RXsnrDump_Jaguar 0xBF7 -+#define rA_CfoShortDump_Jaguar 0xBF8 -+#define rB_CfoShortDump_Jaguar 0xBFA -+#define rA_CfoLongDump_Jaguar 0xBEC -+#define rB_CfoLongDump_Jaguar 0xBEE -+ -+ -+// RF Register -+// -+#define RF_AC_Jaguar 0x00 // -+#define RF_RF_Top_Jaguar 0x07 // -+#define RF_TXLOK_Jaguar 0x08 // -+#define RF_TXAPK_Jaguar 0x0B -+#define RF_CHNLBW_Jaguar 0x18 // RF channel and BW switch -+#define RF_RCK1_Jaguar 0x1c // -+#define RF_RCK2_Jaguar 0x1d -+#define RF_RCK3_Jaguar 0x1e -+#define RF_ModeTableAddr 0x30 -+#define RF_ModeTableData0 0x31 -+#define RF_ModeTableData1 0x32 -+#define RF_TxLCTank_Jaguar 0x54 -+#define RF_APK_Jaguar 0x63 -+#define RF_LCK 0xB4 -+#define RF_WeLut_Jaguar 0xEF -+ -+#define bRF_CHNLBW_MOD_AG_Jaguar 0x70300 -+#define bRF_CHNLBW_BW 0xc00 -+ -+ -+// -+// RL6052 Register definition -+// -+#define RF_AC 0x00 // -+#define RF_IPA_A 0x0C // -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_MODE1 0x10 // -+#define RF_MODE2 0x11 // -+#define RF_CHNLBW 0x18 // RF channel and BW switch -+#define RF_RCK_OS 0x30 // RF TX PA control -+#define RF_TXPA_G1 0x31 // RF TX PA control -+#define RF_TXPA_G2 0x32 // RF TX PA control -+#define RF_TXPA_G3 0x33 // RF TX PA control -+#define RF_0x52 0x52 -+#define RF_WE_LUT 0xEF -+ -+// -+//Bit Mask -+// -+// 1. Page1(0x100) -+#define bBBResetB 0x100 // Useless now? -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+ -+// -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 1. Page1(0x100) -+// -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+// -+// 3. Page8(0x800) -+// -+#define rFPGA0_RFMOD 0x800 //RF mode & CCK TxSC // RF BW Setting?? -+ -+#define rFPGA0_TxInfo 0x804 // Status report?? -+#define rFPGA0_PSDFunction 0x808 -+#define rFPGA0_TxGainStage 0x80c // Set TX PWR init gain? -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 // RF 3 wire register -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 // RF Channel switch -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 -+#define rFPGA0_AdDaClockEn 0x888 // enable ad/da clock1 for dual-phy -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 // Tranceiver LSSI Readback -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_XCD_RFPara 0x8b4 -+#define rFPGA0_PSDReport 0x8b4 // Useless now -+#define TransceiverA_HSPI_Readback 0x8b8 // Transceiver A HSPI Readback -+#define TransceiverB_HSPI_Readback 0x8bc // Transceiver B HSPI Readback -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 // Useless now // RF Interface Readback Value -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 // Useless now -+ -+// -+// 4. Page9(0x900) -+// -+#define rFPGA1_RFMOD 0x900 //RF mode & OFDM TxSC // RF BW Setting?? -+ -+#define rFPGA1_TxBlock 0x904 // Useless now -+#define rFPGA1_DebugSelect 0x908 // Useless now -+#define rFPGA1_TxInfo 0x90c // Useless now // Status report?? -+ -+// -+// PageA(0xA00) -+// -+#define rCCK0_System 0xa00 -+#define rCCK0_AFESetting 0xa04 // Disable init gain now // Select RX path by RSSI -+#define rCCK0_DSPParameter2 0xa1c //SQ threshold -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 //debug port and Tx filter3 -+#define rCCK0_FalseAlarmReport 0xa2c //0xa2d useless now 0xa30-a4f channel report -+ -+// -+// PageB(0xB00) -+// -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rConfig_Pmpd_AntB 0xb98 -+#define rAPK 0xbd8 -+ -+// -+// 6. PageC(0xC00) -+// -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 //RxIQ DC offset, Rx digital filter, DC notch filter -+#define rOFDM0_XARxIQImbalance 0xc14 //RxIQ imblance matrix -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 //PD,BW & SBD // DM tune init gain -+#define rOFDM0_RxDetector2 0xc34 //SBD & Fame Sync. -+#define rOFDM0_RxDetector3 0xc38 //Frame Sync. -+#define rOFDM0_RxDetector4 0xc3c //PD, SBD, Frame Sync & Short-GI -+ -+#define rOFDM0_RxDSP 0xc40 //Rx Sync Path -+#define rOFDM0_CFOandDAGC 0xc44 //CFO & DAGC -+#define rOFDM0_CCADropThreshold 0xc48 //CCA Drop threshold -+#define rOFDM0_ECCAThreshold 0xc4c // energy CCA -+ -+#define rOFDM0_XAAGCCore1 0xc50 // DIG -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 // TX PWR TRACK and DIG -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+// -+// 7. PageD(0xD00) -+// -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+// -+// 8. PageE(0xE00) -+// -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+ -+// 2. Page8(0x800) -+#define bRFMOD 0x1 // Reg 0x800 rFPGA0_RFMOD -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+#define bXBTxAGC 0xf00 // Reg 80c rFPGA0_TxGainStage -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+// 4. PageA(0xA00) -+#define bCCKBBMode 0x3 // Useless -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 // Reg 0xa00 rCCK0_System 20/40 switch -+ -+#define bCCKScramble 0x8 // Useless -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 //r_rx_clk -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 //CCK Rx Iinital gain polarity -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f //AGCsamp_dly -+#define bCCKFixedRxAGC 0x8000 -+//#define bCCKRxAGCFormat 0x4000 //remove to HSSI register 0x824 -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+#define RF_T_METER_88E 0x42 // -+ -+// 6. PageE(0xE00) -+#define bSTBCEn 0x4 // Useless -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+ -+ -+// -+// Other Definition -+// -+ -+#define bEnable 0x1 // Useless -+#define bDisable 0x0 -+ -+//byte endable for srwrite -+#define bByte0 0x1 // Useless -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+//for PutRegsetting & GetRegSetting BitMask -+#define bMaskByte0 0xff // Reg 0xc50 rOFDM0_XAAGCCore~0xC6f -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8814PwrSeq.h linux/3rdparty/rtl8812au/include/Hal8814PwrSeq.h ---- linux.old/3rdparty/rtl8812au/include/Hal8814PwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8814PwrSeq.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,237 @@ -+ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL8814PWRSEQ_H__ -+#define __HAL8814PWRSEQ_H__ -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WB-110628-DZ-RTL8195 (Jaguar) Power Architecture-R04.pdf -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8814A_TRANS_CARDEMU_TO_ACT_STEPS 16 -+#define RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS 20 -+#define RTL8814A_TRANS_CARDEMU_TO_SUS_STEPS 17 -+#define RTL8814A_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8814A_TRANS_CARDEMU_TO_PDN_STEPS 17 -+#define RTL8814A_TRANS_PDN_TO_CARDEMU_STEPS 16 -+#define RTL8814A_TRANS_ACT_TO_LPS_STEPS 20 -+#define RTL8814A_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8814A_TRANS_END_STEPS 1 -+ -+ -+#define RTL8814A_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x002B, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0}, /* ??0x28[24]=1, enable pll phase select*/ \ -+ {0x0015, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT3|BIT2|BIT1), (BIT3|BIT2|BIT1)},/* 0x14[11:9]=3'b111,OCP current threshold=1.5A */ \ -+ {0x002D, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x0E, 0x08},/* 0x2C[11:9]=3'b100, select lpf R3 */ \ -+ {0x002D, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x70, 0x50},/* 0x2C[14:12]=3'b101, select lpf Rs*/ \ -+ {0x007B, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, BIT6},/* 0x78[30]=1'b1, SDM order select*/ \ -+ /*{0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0}, */ /* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0},/* disable WL suspend*/ \ -+ {0x00F0, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* */ \ -+ {0x0081, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x30, 0x20},/* */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ -+ -+#define RTL8814A_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ -+ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US}, /*Delay 1us*/ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ -+ {0x0002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US}, /*Delay 1us*/ \ -+ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*0x1F[7:0] = 0 turn off RF*/ \ -+ /*{0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},*/ /*0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x28}, /* 0x07[7:0] = 0x28 sps pwm mode 0x2a for BT coex*/ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x02, 0}, /*0x8[1] = 0 ANA clk =500k */ \ -+ /*{0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0|BIT1, 0},*/ /* 0x02[1:0] = 0 reset BB */ \ -+ {0x0066, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0}, /*0x66[7]=0, disable ckreq for gpio7 output SUS */ \ -+ {0x0041, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x41[4]=0, disable sic for gpio7 output SUS */ \ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /*0x42[1]=0, disable ckout for gpio7 output SUS */ \ -+ {0x004e, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5}, /*0x4E[5]=1, disable LED2 for gpio7 output SUS */ \ -+ {0x0041, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x41[0]=0, disable uart for gpio7 output SUS */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ -+ -+#define RTL8814A_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0061, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x0F, 0x0c},\ -+ {0x0061, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x0F, 0x0E},\ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x0F, 0x07},/* gpio11 input mode, gpio10~8 output mode */ \ -+ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ -+ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/* suspend option all off */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*0x14[13] = 1 turn on ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, BIT6},/* 0x14[14] =1 trun on ZCD */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*0x8[1] = 0 ANA clk =500k */ \ -+ {0x0091, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xA0, 0xA0}, /* 0x91[7]=1 0x91[5]=1 , disable sps,ldo sleep mode */ \ -+ {0x0070, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3}, /* 0x70[3]=1 enable mainbias polling */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 1 enable WL suspend */ -+ -+#define RTL8814A_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 0 enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x10, 0},/*0x23[4] = 0 hpon LDO sleep mode leave */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, 0},/* 0x14[14] =0 trun off ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, 0},/*0x14[13] = 0 turn off ZCD */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio11 input mode, gpio10~8 input mode */ -+ -+#define RTL8814A_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ /**{0x0194, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, //0x194[0]=0 , disable 32K clock*/ \ -+ /**{0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x94}, //0x93=0x94 , 90[30] =0 enable 500k ANA clock .switch clock from 12M to 500K , 90 [26] =0 disable EEprom loader clock*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0}, /*0x03[2] = 0, reset 3081*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x01}, /*0x80=05h if reload fw, fill the default value of host_CPU handshake field*/ \ -+ {0x0081, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x30}, /*0x80=05h if reload fw, fill the default value of host_CPU handshake field*/ \ -+ /*{0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xcc},*/ \ -+ /*{0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xEC},*/ \ -+ /*{0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x07},*/ /* gpio11 input mode, gpio10~8 output mode */ \ -+ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ -+ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, BIT6},/* 0x15[6] =1 trun on ZCD output */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*0x15[5] = 1 turn on ZCD */ \ -+ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, 0},/*0x12[6] = 0 force PFM mode */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*0x8[1] = 0 ANA clk =500k */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07=0x20 , SOP option to disable BG/MB*/ \ -+ {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* 0x01f[1]=0 , disable RFC_0 control REG_RF_CTRL_8814A */ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* 0x020[1]=0 , disable RFC_1 control REG_RF_CTRL_8814A */ \ -+ {0x0021, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* 0x021[1]=0 , disable RFC_2 control REG_RF_CTRL_8814A */ \ -+ {0x0076, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* 0x076[1]=0 , disable RFC_3 control REG_OPT_CTRL_8814A +2 */ \ -+ {0x0091, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xA0, 0xA0}, /* 0x91[7]=1 0x91[5]=1 , disable sps,ldo sleep mode */ \ -+ {0x0070, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3}, /* 0x70[3]=1 enable mainbias polling */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 1 enable WL suspend*/ -+ -+#define RTL8814A_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, BIT6},/*0x12[6] = 1 force PWM mode */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, 0},/*0x15[5] = 0 turn off ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, 0},/* 0x15[6] =0 trun off ZCD output */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0},/*0x23[4] = 0 hpon LDO leave sleep mode */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00}, /* gpio11 input mode, gpio10~8 input mode */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0}, /*0x04[10] = 0, enable SW LPS PCIE only*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 0, enable WL suspend*/ \ -+ /*{0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2},*/ /*0x03[2] = 1, enable 3081*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ \ -+ {0x0071, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0},/*0x70[10] = 0, CPHY_MBIAS_EN disable*/ -+ -+ -+#define RTL8814A_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8814A_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8814A_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x7F},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ -+ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated,and RF closed*/ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated,and RF closed*/ \ -+ {0x0002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x05F1, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*Respond TxOK to scheduler*/ -+ -+ -+#define RTL8814A_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/ \ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/ \ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /* Delay*/ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/ \ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /* Polling 0x109[7]=0 TSF in 40M*/ \ -+ /*{0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6|BIT7, 0}, */ /*. ??0x29[7:6] = 2b'00 enable BB clock*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/ \ -+ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x1002[1:0] = 2b'11 enable BB macro*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8814A_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // -+ -+ -+extern WLAN_PWR_CFG rtl8814A_power_on_flow[RTL8814A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_radio_off_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_card_disable_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8814A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_card_enable_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8814A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_suspend_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8814A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_resume_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8814A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_hwpdn_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8814A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_enter_lps_flow[RTL8814A_TRANS_ACT_TO_LPS_STEPS+RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_leave_lps_flow[RTL8814A_TRANS_LPS_TO_ACT_STEPS+RTL8814A_TRANS_END_STEPS]; -+ -+#endif //__HAL8814PWRSEQ_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/Hal8821APwrSeq.h linux/3rdparty/rtl8812au/include/Hal8821APwrSeq.h ---- linux.old/3rdparty/rtl8812au/include/Hal8821APwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/Hal8821APwrSeq.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,186 @@ -+#ifndef REALTEK_POWER_SEQUENCE_8821 -+#define REALTEK_POWER_SEQUENCE_8821 -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WM-20130516-JackieLau-RTL8821A_Power_Architecture-R10.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS 25 -+#define RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS 15 -+#define RTL8821A_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8821A_TRANS_CARDDIS_TO_CARDEMU_STEPS 15 -+#define RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8821A_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8821A_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8821A_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8821A_TRANS_END_STEPS 1 -+ -+ -+#define RTL8821A_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ -+ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT4|BIT3|BIT2), 0},/* disable SW LPS 0x04[10]=0 and WLSUS_EN 0x04[12:11]=0*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0 , BIT0},/* Disable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0 , 0},/* Enable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT4|BIT3), 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ {0x004F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*0x4C[24] = 0x4F[0] = 1, switch DPDT_SEL_P output from WL BB */\ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT5|BIT4), (BIT5|BIT4)},/*0x66[13] = 0x67[5] = 1, switch for PAPE_G/PAPE_A from WL BB ; 0x66[12] = 0x67[4] = 1, switch LNAON from WL BB */\ -+ {0x0025, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, 0},/*anapar_mac<118> , 0x25[6]=0 by wlan single function*/\ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable falling edge triggering interrupt*/\ -+ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable GPIO9 interrupt mode*/\ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 input mode*/\ -+ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*Enable HSISR GPIO[C:0] interrupt*/\ -+ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable HSISR GPIO9 interrupt*/\ -+ {0x007A, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x3A},/*0x7A = 0x3A start BT*/\ -+ {0x002E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF , 0x82 },/* 0x2C[23:12]=0x820 ; XTAL trim */ \ -+ {0x0010, PWR_CUT_A_MSK , PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6 , BIT6 },/* 0x10[6]=1 ; MPsW0x2CvA0x10[6]]1~WLAN */ \ -+ -+ -+#define RTL8821A_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x004F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*0x4C[24] = 0x4F[0] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Enable rising edge triggering interrupt*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/ \ -+ -+ -+#define RTL8821A_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4|BIT3, (BIT4|BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3|BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8821A_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8821A_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07=0x20 , SOP option to disable BG/MB*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8821A_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8821A_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK|PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8821A_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8821A_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8821A_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6|BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8821A_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // -+ -+ -+extern WLAN_PWR_CFG rtl8821A_power_on_flow[RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_radio_off_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_card_disable_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_card_enable_flow[RTL8821A_TRANS_CARDDIS_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_suspend_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_resume_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_hwpdn_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_enter_lps_flow[RTL8821A_TRANS_ACT_TO_LPS_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_leave_lps_flow[RTL8821A_TRANS_LPS_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]; -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_btcoex.h linux/3rdparty/rtl8812au/include/hal_btcoex.h ---- linux.old/3rdparty/rtl8812au/include/hal_btcoex.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_btcoex.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,93 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_BTCOEX_H__ -+#define __HAL_BTCOEX_H__ -+ -+#include -+ -+// Some variables can't get from outsrc BT-Coex, -+// so we need to save here -+typedef struct _BT_COEXIST -+{ -+ u8 bBtExist; -+ u8 btTotalAntNum; -+ u8 btChipType; -+ u8 bInitlized; -+ u8 btAntisolation; -+} BT_COEXIST, *PBT_COEXIST; -+ -+void DBG_BT_INFO(u8 *dbgmsg); -+ -+void hal_btcoex_SetBTCoexist(PADAPTER padapter, u8 bBtExist); -+u8 hal_btcoex_IsBtExist(PADAPTER padapter); -+u8 hal_btcoex_IsBtDisabled(PADAPTER); -+void hal_btcoex_SetChipType(PADAPTER padapter, u8 chipType); -+u8 hal_btcoex_GetChipType(PADAPTER padapter); -+void hal_btcoex_SetPgAntNum(PADAPTER padapter, u8 antNum); -+u8 hal_btcoex_GetPgAntNum(PADAPTER padapter); -+void hal_btcoex_SetSingleAntPath(PADAPTER padapter, u8 singleAntPath); -+ -+u8 hal_btcoex_Initialize(PADAPTER padapter); -+void hal_btcoex_PowerOnSetting(PADAPTER padapter); -+void hal_btcoex_PreLoadFirmware(PADAPTER padapter); -+void hal_btcoex_InitHwConfig(PADAPTER padapter, u8 bWifiOnly); -+ -+void hal_btcoex_IpsNotify(PADAPTER padapter, u8 type); -+void hal_btcoex_LpsNotify(PADAPTER padapter, u8 type); -+void hal_btcoex_ScanNotify(PADAPTER padapter, u8 type); -+void hal_btcoex_ConnectNotify(PADAPTER padapter, u8 action); -+void hal_btcoex_MediaStatusNotify(PADAPTER padapter, u8 mediaStatus); -+void hal_btcoex_SpecialPacketNotify(PADAPTER padapter, u8 pktType); -+void hal_btcoex_IQKNotify(PADAPTER padapter, u8 state); -+void hal_btcoex_BtInfoNotify(PADAPTER padapter, u8 length, u8 *tmpBuf); -+void hal_btcoex_SuspendNotify(PADAPTER padapter, u8 state); -+void hal_btcoex_HaltNotify(PADAPTER padapter); -+void hal_btcoex_SwitchBtTRxMask(PADAPTER padapter); -+ -+void hal_btcoex_Hanlder(PADAPTER padapter); -+ -+s32 hal_btcoex_IsBTCoexRejectAMPDU(PADAPTER padapter); -+s32 hal_btcoex_IsBTCoexCtrlAMPDUSize(PADAPTER padapter); -+u32 hal_btcoex_GetAMPDUSize(PADAPTER padapter); -+void hal_btcoex_SetManualControl(PADAPTER padapter, u8 bmanual); -+u8 hal_btcoex_1Ant(PADAPTER padapter); -+u8 hal_btcoex_IsBtControlLps(PADAPTER); -+u8 hal_btcoex_IsLpsOn(PADAPTER); -+u8 hal_btcoex_RpwmVal(PADAPTER); -+u8 hal_btcoex_LpsVal(PADAPTER); -+u32 hal_btcoex_GetRaMask(PADAPTER); -+void hal_btcoex_RecordPwrMode(PADAPTER padapter, u8 *pCmdBuf, u8 cmdLen); -+void hal_btcoex_DisplayBtCoexInfo(PADAPTER, u8 *pbuf, u32 bufsize); -+void hal_btcoex_SetDBG(PADAPTER, u32 *pDbgModule); -+u32 hal_btcoex_GetDBG(PADAPTER, u8 *pStrBuf, u32 bufSize); -+u8 hal_btcoex_IncreaseScanDeviceNum(PADAPTER); -+u8 hal_btcoex_IsBtLinkExist(PADAPTER); -+void hal_btcoex_SetBtPatchVersion(PADAPTER,u16 btHciVer,u16 btPatchVer); -+void hal_btcoex_SetHciVersion(PADAPTER, u16 hciVersion); -+void hal_btcoex_SendScanNotify(PADAPTER, u8 type); -+void hal_btcoex_StackUpdateProfileInfo(void); -+void hal_btcoex_PTAOffOnNotify(PADAPTER padapter, u8 bONOFF); -+void hal_btcoex_SetAntIsolationType(PADAPTER padapter, u8 anttype); -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+int hal_btcoex_AntIsolationConfig_ParaFile(IN PADAPTER Adapter,IN char* pFileName); -+int hal_btcoex_ParseAntIsolationConfigFile(PADAPTER Adapter, char* buffer); -+#endif // CONFIG_LOAD_PHY_PARA_FROM_FILE -+#endif // !__HAL_BTCOEX_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com.h linux/3rdparty/rtl8812au/include/hal_com.h ---- linux.old/3rdparty/rtl8812au/include/hal_com.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_com.h 2017-06-07 23:07:21.037689945 +0300 -@@ -0,0 +1,487 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -301079,11 +132212,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com.h linux/3rdparty/rtl8812 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __HAL_COMMON_H__ +#define __HAL_COMMON_H__ @@ -301095,7 +132223,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com.h linux/3rdparty/rtl8812 +#include "hal_com_reg.h" +#include "hal_com_phycfg.h" + -+/*------------------------------ Tx Desc definition Macro ------------------------*/ ++/*------------------------------ Tx Desc definition Macro ------------------------*/ +//#pragma mark -- Tx Desc related definition. -- +//---------------------------------------------------------------------------- +//----------------------------------------------------------- @@ -301134,26 +132262,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com.h linux/3rdparty/rtl8812 +#define DESC_RATEMCS13 0x19 +#define DESC_RATEMCS14 0x1a +#define DESC_RATEMCS15 0x1b -+#define DESC_RATEMCS16 0x1C -+#define DESC_RATEMCS17 0x1D -+#define DESC_RATEMCS18 0x1E -+#define DESC_RATEMCS19 0x1F -+#define DESC_RATEMCS20 0x20 -+#define DESC_RATEMCS21 0x21 -+#define DESC_RATEMCS22 0x22 -+#define DESC_RATEMCS23 0x23 -+#define DESC_RATEMCS24 0x24 -+#define DESC_RATEMCS25 0x25 -+#define DESC_RATEMCS26 0x26 -+#define DESC_RATEMCS27 0x27 -+#define DESC_RATEMCS28 0x28 -+#define DESC_RATEMCS29 0x29 -+#define DESC_RATEMCS30 0x2A -+#define DESC_RATEMCS31 0x2B -+#define DESC_RATEVHTSS1MCS0 0x2C -+#define DESC_RATEVHTSS1MCS1 0x2D -+#define DESC_RATEVHTSS1MCS2 0x2E -+#define DESC_RATEVHTSS1MCS3 0x2F ++#define DESC_RATEMCS15_SG 0x1c ++#define DESC_RATEMCS32 0x20 ++ ++#define DESC_RATEVHTSS1MCS0 0x2c ++#define DESC_RATEVHTSS1MCS1 0x2d ++#define DESC_RATEVHTSS1MCS2 0x2e ++#define DESC_RATEVHTSS1MCS3 0x2f +#define DESC_RATEVHTSS1MCS4 0x30 +#define DESC_RATEVHTSS1MCS5 0x31 +#define DESC_RATEVHTSS1MCS6 0x32 @@ -301164,87 +132279,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com.h linux/3rdparty/rtl8812 +#define DESC_RATEVHTSS2MCS1 0x37 +#define DESC_RATEVHTSS2MCS2 0x38 +#define DESC_RATEVHTSS2MCS3 0x39 -+#define DESC_RATEVHTSS2MCS4 0x3A -+#define DESC_RATEVHTSS2MCS5 0x3B -+#define DESC_RATEVHTSS2MCS6 0x3C -+#define DESC_RATEVHTSS2MCS7 0x3D -+#define DESC_RATEVHTSS2MCS8 0x3E -+#define DESC_RATEVHTSS2MCS9 0x3F -+#define DESC_RATEVHTSS3MCS0 0x40 -+#define DESC_RATEVHTSS3MCS1 0x41 -+#define DESC_RATEVHTSS3MCS2 0x42 -+#define DESC_RATEVHTSS3MCS3 0x43 -+#define DESC_RATEVHTSS3MCS4 0x44 -+#define DESC_RATEVHTSS3MCS5 0x45 -+#define DESC_RATEVHTSS3MCS6 0x46 -+#define DESC_RATEVHTSS3MCS7 0x47 -+#define DESC_RATEVHTSS3MCS8 0x48 -+#define DESC_RATEVHTSS3MCS9 0x49 -+#define DESC_RATEVHTSS4MCS0 0x4A -+#define DESC_RATEVHTSS4MCS1 0x4B -+#define DESC_RATEVHTSS4MCS2 0x4C -+#define DESC_RATEVHTSS4MCS3 0x4D -+#define DESC_RATEVHTSS4MCS4 0x4E -+#define DESC_RATEVHTSS4MCS5 0x4F -+#define DESC_RATEVHTSS4MCS6 0x50 -+#define DESC_RATEVHTSS4MCS7 0x51 -+#define DESC_RATEVHTSS4MCS8 0x52 -+#define DESC_RATEVHTSS4MCS9 0x53 -+ -+#define HDATA_RATE(rate)\ -+(rate==DESC_RATE1M)?"CCK_1M":\ -+(rate==DESC_RATE2M)?"CCK_2M":\ -+(rate==DESC_RATE5_5M)?"CCK5_5M":\ -+(rate==DESC_RATE11M)?"CCK_11M":\ -+(rate==DESC_RATE6M)?"OFDM_6M":\ -+(rate==DESC_RATE9M)?"OFDM_9M":\ -+(rate==DESC_RATE12M)?"OFDM_12M":\ -+(rate==DESC_RATE18M)?"OFDM_18M":\ -+(rate==DESC_RATE24M)?"OFDM_24M":\ -+(rate==DESC_RATE36M)?"OFDM_36M":\ -+(rate==DESC_RATE48M)?"OFDM_48M":\ -+(rate==DESC_RATE54M)?"OFDM_54M":\ -+(rate==DESC_RATEMCS0)?"MCS0":\ -+(rate==DESC_RATEMCS1)?"MCS1":\ -+(rate==DESC_RATEMCS2)?"MCS2":\ -+(rate==DESC_RATEMCS3)?"MCS3":\ -+(rate==DESC_RATEMCS4)?"MCS4":\ -+(rate==DESC_RATEMCS5)?"MCS5":\ -+(rate==DESC_RATEMCS6)?"MCS6":\ -+(rate==DESC_RATEMCS7)?"MCS7":\ -+(rate==DESC_RATEMCS8)?"MCS8":\ -+(rate==DESC_RATEMCS9)?"MCS9":\ -+(rate==DESC_RATEMCS10)?"MCS10":\ -+(rate==DESC_RATEMCS11)?"MCS11":\ -+(rate==DESC_RATEMCS12)?"MCS12":\ -+(rate==DESC_RATEMCS13)?"MCS13":\ -+(rate==DESC_RATEMCS14)?"MCS14":\ -+(rate==DESC_RATEMCS15)?"MCS15":\ -+(rate==DESC_RATEVHTSS1MCS0)?"VHTSS1MCS0":\ -+(rate==DESC_RATEVHTSS1MCS1)?"VHTSS1MCS1":\ -+(rate==DESC_RATEVHTSS1MCS2)?"VHTSS1MCS2":\ -+(rate==DESC_RATEVHTSS1MCS3)?"VHTSS1MCS3":\ -+(rate==DESC_RATEVHTSS1MCS4)?"VHTSS1MCS4":\ -+(rate==DESC_RATEVHTSS1MCS5)?"VHTSS1MCS5":\ -+(rate==DESC_RATEVHTSS1MCS6)?"VHTSS1MCS6":\ -+(rate==DESC_RATEVHTSS1MCS7)?"VHTSS1MCS7":\ -+(rate==DESC_RATEVHTSS1MCS8)?"VHTSS1MCS8":\ -+(rate==DESC_RATEVHTSS1MCS9)?"VHTSS1MCS9":\ -+(rate==DESC_RATEVHTSS2MCS0)?"VHTSS2MCS0":\ -+(rate==DESC_RATEVHTSS2MCS1)?"VHTSS2MCS1":\ -+(rate==DESC_RATEVHTSS2MCS2)?"VHTSS2MCS2":\ -+(rate==DESC_RATEVHTSS2MCS3)?"VHTSS2MCS3":\ -+(rate==DESC_RATEVHTSS2MCS4)?"VHTSS2MCS4":\ -+(rate==DESC_RATEVHTSS2MCS5)?"VHTSS2MCS5":\ -+(rate==DESC_RATEVHTSS2MCS6)?"VHTSS2MCS6":\ -+(rate==DESC_RATEVHTSS2MCS7)?"VHTSS2MCS7":\ -+(rate==DESC_RATEVHTSS2MCS8)?"VHTSS2MCS8":\ -+(rate==DESC_RATEVHTSS2MCS9)?"VHTSS2MCS9":"UNKNOW" -+ ++#define DESC_RATEVHTSS2MCS4 0x3a ++#define DESC_RATEVHTSS2MCS5 0x3b ++#define DESC_RATEVHTSS2MCS6 0x3c ++#define DESC_RATEVHTSS2MCS7 0x3d ++#define DESC_RATEVHTSS2MCS8 0x3e ++#define DESC_RATEVHTSS2MCS9 0x3f + +enum{ + UP_LINK, -+ DOWN_LINK, ++ DOWN_LINK, +}; +typedef enum _RT_MEDIA_STATUS { + RT_MEDIA_DISCONNECT = 0, @@ -301257,17 +132301,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com.h linux/3rdparty/rtl8812 + FW_SOURCE_HEADER_FILE = 1, //from header file +} FIRMWARE_SOURCE, *PFIRMWARE_SOURCE; + -+// -+// Queue Select Value in TxDesc -+// -+#define QSLT_BK 0x2//0x01 -+#define QSLT_BE 0x0 -+#define QSLT_VI 0x5//0x4 -+#define QSLT_VO 0x7//0x6 -+#define QSLT_BEACON 0x10 -+#define QSLT_HIGH 0x11 -+#define QSLT_MGNT 0x12 -+#define QSLT_CMD 0x13 + +// BK, BE, VI, VO, HCCA, MANAGEMENT, COMMAND, HIGH, BEACON. +//#define MAX_TX_QUEUE 9 @@ -301282,622 +132315,53 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com.h linux/3rdparty/rtl8812 +#define PageNum_512(_Len) (u32)(((_Len)>>9) + ((_Len)&0x1FF ? 1:0)) +#define PageNum(_Len, _Size) (u32)(((_Len)/(_Size)) + ((_Len)&((_Size) - 1) ? 1:0)) + -+struct dbg_rx_counter -+{ -+ u32 rx_pkt_ok; -+ u32 rx_pkt_crc_error; -+ u32 rx_pkt_drop; -+ u32 rx_ofdm_fa; -+ u32 rx_cck_fa; -+ u32 rx_ht_fa; -+}; -+void rtw_dump_mac_rx_counters(_adapter* padapter,struct dbg_rx_counter *rx_counter); -+void rtw_dump_phy_rx_counters(_adapter* padapter,struct dbg_rx_counter *rx_counter); -+void rtw_reset_mac_rx_counters(_adapter* padapter); -+void rtw_reset_phy_rx_counters(_adapter* padapter); -+ -+#ifdef DBG_RX_COUNTER_DUMP -+#define DUMP_DRV_RX_COUNTER BIT0 -+#define DUMP_MAC_RX_COUNTER BIT1 -+#define DUMP_PHY_RX_COUNTER BIT2 -+#define DUMP_DRV_TRX_COUNTER_DATA BIT3 -+ -+void rtw_dump_phy_rxcnts_preprocess(_adapter* padapter,u8 rx_cnt_mode); -+void rtw_dump_rx_counters(_adapter* padapter); -+#endif + +void dump_chip_info(HAL_VERSION ChipVersion); -+void rtw_hal_config_rftype(PADAPTER padapter); + +u8 //return the final channel plan decision -+hal_com_config_channel_plan( -+ IN PADAPTER padapter, -+ IN u8 hw_channel_plan, //channel plan from HW (efuse/eeprom) -+ IN u8 sw_channel_plan, //channel plan from SW (registry/module param) -+ IN u8 def_channel_plan, //channel plan used when the former two is invalid -+ IN BOOLEAN AutoLoadFail ++hal_com_get_channel_plan( ++ PADAPTER padapter, ++ u8 hw_channel_plan, //channel plan from HW (efuse/eeprom) ++ u8 sw_channel_plan, //channel plan from SW (registry/module param) ++ u8 def_channel_plan, //channel plan used when the former two is invalid ++ bool AutoLoadFail + ); + -+int hal_config_macaddr(_adapter *adapter, bool autoload_fail); -+ -+BOOLEAN ++bool +HAL_IsLegalChannel( -+ IN PADAPTER Adapter, -+ IN u32 Channel ++ PADAPTER Adapter, ++ u32 Channel + ); + +u8 MRateToHwRate(u8 rate); + -+u8 HwRateToMRate(u8 rate); -+ +void HalSetBrateCfg( -+ IN PADAPTER Adapter, -+ IN u8 *mBratesOS, -+ OUT u16 *pBrateCfg); ++ PADAPTER Adapter, ++ u8 *mBratesOS, ++ u16 *pBrateCfg); + -+BOOLEAN ++bool +Hal_MappingOutPipe( -+ IN PADAPTER pAdapter, -+ IN u8 NumOutPipe ++ PADAPTER pAdapter, ++ u8 NumOutPipe + ); + +void hal_init_macaddr(_adapter *adapter); + -+void rtw_init_hal_com_default_value(PADAPTER Adapter); -+ +void c2h_evt_clear(_adapter *adapter); +s32 c2h_evt_read(_adapter *adapter, u8 *buf); -+s32 c2h_evt_read_88xx(_adapter *adapter, u8 *buf); + -+u8 rtw_hal_networktype_to_raid(_adapter *adapter, struct sta_info *psta); ++u8 rtw_hal_networktype_to_raid(_adapter *adapter,unsigned char network_type); +u8 rtw_get_mgntframe_raid(_adapter *adapter,unsigned char network_type); -+void rtw_hal_update_sta_rate_mask(PADAPTER padapter, struct sta_info *psta); -+ -+/* access HW only */ -+u32 rtw_sec_read_cam(_adapter *adapter, u8 addr); -+void rtw_sec_write_cam(_adapter *adapter, u8 addr, u32 wdata); -+void rtw_sec_read_cam_ent(_adapter *adapter, u8 id, u8 *ctrl, u8 *mac, u8 *key); -+void rtw_sec_write_cam_ent(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key); -+bool rtw_sec_read_cam_is_gk(_adapter *adapter, u8 id); -+ -+void hw_var_port_switch(_adapter *adapter); -+ -+void SetHwReg(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg(PADAPTER padapter, u8 variable, u8 *val); -+void rtw_hal_check_rxfifo_full(_adapter *adapter); -+ -+u8 SetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value); -+u8 GetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value); -+ -+BOOLEAN -+eqNByte( -+ u8* str1, -+ u8* str2, -+ u32 num -+ ); -+ -+BOOLEAN -+IsHexDigit( -+ IN char chTmp -+ ); -+ -+u32 -+MapCharToHexDigit( -+ IN char chTmp -+); -+ -+BOOLEAN -+GetHexValueFromString( -+ IN char* szStr, -+ IN OUT u32* pu4bVal, -+ IN OUT u32* pu4bMove -+ ); -+ -+BOOLEAN -+GetFractionValueFromString( -+ IN char* szStr, -+ IN OUT u8* pInteger, -+ IN OUT u8* pFraction, -+ IN OUT u32* pu4bMove -+ ); -+ -+BOOLEAN -+IsCommentString( -+ IN char* szStr -+ ); -+ -+BOOLEAN -+ParseQualifiedString( -+ IN char* In, -+ IN OUT u32* Start, -+ OUT char* Out, -+ IN char LeftQualifier, -+ IN char RightQualifier -+ ); -+ -+BOOLEAN -+GetU1ByteIntegerFromStringInDecimal( -+ IN char* Str, -+ IN OUT u8* pInt -+ ); -+ -+BOOLEAN -+isAllSpaceOrTab( -+ u8* data, -+ u8 size -+ ); -+ -+void linked_info_dump(_adapter *padapter,u8 benable); -+#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+void rtw_get_raw_rssi_info(void *sel, _adapter *padapter); -+void rtw_store_phy_info(_adapter *padapter, union recv_frame *prframe); -+void rtw_dump_raw_rssi_info(_adapter *padapter); -+#endif -+ -+#define HWSET_MAX_SIZE 512 -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+#define EFUSE_FILE_COLUMN_NUM 16 -+u32 Hal_readPGDataFromConfigFile(PADAPTER padapter); -+u32 Hal_ReadMACAddrFromFile(PADAPTER padapter, u8 *mac_addr); -+#endif /* CONFIG_EFUSE_CONFIG_FILE */ -+ -+int check_phy_efuse_tx_power_info_valid(PADAPTER padapter); -+int hal_efuse_macaddr_offset(_adapter *adapter); -+int Hal_GetPhyEfuseMACAddr(PADAPTER padapter, u8 *mac_addr); -+ -+#ifdef CONFIG_RF_GAIN_OFFSET -+void rtw_bb_rf_gain_offset(_adapter *padapter); -+#endif //CONFIG_RF_GAIN_OFFSET -+ -+void dm_DynamicUsbTxAgg(_adapter *padapter, u8 from_timer); -+u8 rtw_hal_busagg_qsel_check(_adapter *padapter,u8 pre_qsel,u8 next_qsel); -+void GetHalODMVar( -+ PADAPTER Adapter, -+ HAL_ODM_VARIABLE eVariable, -+ PVOID pValue1, -+ PVOID pValue2); -+void SetHalODMVar( -+ PADAPTER Adapter, -+ HAL_ODM_VARIABLE eVariable, -+ PVOID pValue1, -+ BOOLEAN bSet); -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+struct noise_info -+{ -+ u8 bPauseDIG; -+ u8 IGIValue; -+ u32 max_time;//ms -+ u8 chan; -+}; -+#endif -+ -+void rtw_get_noise(_adapter* padapter); -+ -+void rtw_hal_set_fw_rsvd_page(_adapter* adapter, bool finished); -+ -+#ifdef CONFIG_GPIO_API -+u8 rtw_hal_get_gpio(_adapter* adapter, u8 gpio_num); -+int rtw_hal_set_gpio_output_value(_adapter* adapter, u8 gpio_num, bool isHigh); -+int rtw_hal_config_gpio(_adapter* adapter, u8 gpio_num, bool isOutput); -+int rtw_hal_register_gpio_interrupt(_adapter* adapter, int gpio_num, void(*callback)(u8 level)); -+int rtw_hal_disable_gpio_interrupt(_adapter* adapter, int gpio_num); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+void rtw_hal_set_output_gpio(_adapter *padapter, u8 index, u8 outputval); -+#endif -+ -+typedef enum _HAL_PHYDM_OPS { -+ HAL_PHYDM_DIS_ALL_FUNC, -+ HAL_PHYDM_FUNC_SET, -+ HAL_PHYDM_FUNC_CLR, -+ HAL_PHYDM_ABILITY_BK, -+ HAL_PHYDM_ABILITY_RESTORE, -+ HAL_PHYDM_ABILITY_SET, -+ HAL_PHYDM_ABILITY_GET, -+} HAL_PHYDM_OPS; -+ -+ -+#define DYNAMIC_FUNC_DISABLE (0x0) -+u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability); -+ -+#define rtw_phydm_func_disable_all(adapter) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_DIS_ALL_FUNC, 0) -+ -+#define rtw_phydm_func_for_offchannel(adapter) \ -+ do { \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_DIS_ALL_FUNC, 0); \ -+ if (rtw_odm_adaptivity_needed(adapter)) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_SET, ODM_BB_ADAPTIVITY); \ -+ } while (0) -+ -+#define rtw_phydm_func_set(adapter, ability) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_SET, ability) -+ -+#define rtw_phydm_func_clr(adapter, ability) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_CLR, ability) -+ -+#define rtw_phydm_ability_backup(adapter) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_BK, 0) -+ -+#define rtw_phydm_ability_restore(adapter) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_RESTORE, 0) -+ -+#define rtw_phydm_ability_set(adapter, ability) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_SET, ability) -+ -+static inline u32 rtw_phydm_ability_get(_adapter *adapter) -+{ -+ return rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_GET, 0); -+} -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+extern char *rtw_phy_file_path; -+extern char rtw_phy_para_file_path[PATH_LENGTH_MAX]; -+#define GetLineFromBuffer(buffer) strsep(&buffer, "\n") -+#endif -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+void Debug_FwC2H(PADAPTER padapter, u8 *pdata, u8 len); -+#endif -+/*CONFIG_FW_C2H_DEBUG*/ -+ -+void update_IOT_info(_adapter *padapter); -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+void rtw_acs_start(_adapter *padapter, bool bStart); -+#endif -+ -+void hal_set_crystal_cap(_adapter *adapter, u8 crystal_cap); -+ +#endif //__HAL_COMMON_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_h2c.h linux/3rdparty/rtl8812au/include/hal_com_h2c.h ---- linux.old/3rdparty/rtl8812au/include/hal_com_h2c.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_com_h2c.h 2017-06-07 23:07:21.037689945 +0300 -@@ -0,0 +1,333 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __COMMON_H2C_H__ -+#define __COMMON_H2C_H__ -+ -+//---------------------------------------------------------------------------------------------------------// -+//---------------------------------- H2C CMD DEFINITION ------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+// 88e, 8723b, 8812, 8821, 92e use the same FW code base -+enum h2c_cmd{ -+ //Common Class: 000 -+ H2C_RSVD_PAGE = 0x00, -+ H2C_MEDIA_STATUS_RPT = 0x01, -+ H2C_SCAN_ENABLE = 0x02, -+ H2C_KEEP_ALIVE = 0x03, -+ H2C_DISCON_DECISION = 0x04, -+ H2C_PSD_OFFLOAD = 0x05, -+ H2C_AP_OFFLOAD = 0x08, -+ H2C_BCN_RSVDPAGE = 0x09, -+ H2C_PROBERSP_RSVDPAGE = 0x0A, -+ H2C_FCS_RSVDPAGE = 0x10, -+ H2C_FCS_INFO = 0x11, -+ H2C_AP_WOW_GPIO_CTRL = 0x13, -+ -+ //PoweSave Class: 001 -+ H2C_SET_PWR_MODE = 0x20, -+ H2C_PS_TUNING_PARA = 0x21, -+ H2C_PS_TUNING_PARA2 = 0x22, -+ H2C_P2P_LPS_PARAM = 0x23, -+ H2C_P2P_PS_OFFLOAD = 0x24, -+ H2C_PS_SCAN_ENABLE = 0x25, -+ H2C_SAP_PS_ = 0x26, -+ H2C_INACTIVE_PS_ = 0x27, //Inactive_PS -+ H2C_FWLPS_IN_IPS_ = 0x28, -+ -+ //Dynamic Mechanism Class: 010 -+ H2C_MACID_CFG = 0x40, -+ H2C_TXBF = 0x41, -+ H2C_RSSI_SETTING = 0x42, -+ H2C_AP_REQ_TXRPT = 0x43, -+ H2C_INIT_RATE_COLLECT = 0x44, -+ H2C_IQ_CALIBRATION = 0x45, -+ -+ H2C_RA_MASK_3SS = 0x46,/* for 8814A */ -+ H2C_RA_PARA_ADJUST = 0x47,/* CONFIG_RA_DBG_CMD */ -+ H2C_DYNAMIC_TX_PATH = 0x48,/* for 8814A */ -+ -+ H2C_FW_TRACE_EN = 0x49, -+ -+ //BT Class: 011 -+ H2C_B_TYPE_TDMA = 0x60, -+ H2C_BT_INFO = 0x61, -+ H2C_FORCE_BT_TXPWR = 0x62, -+ H2C_BT_IGNORE_WLANACT = 0x63, -+ H2C_DAC_SWING_VALUE = 0x64, -+ H2C_ANT_SEL_RSV = 0x65, -+ H2C_WL_OPMODE = 0x66, -+ H2C_BT_MP_OPER = 0x67, -+ H2C_BT_CONTROL = 0x68, -+ H2C_BT_WIFI_CTRL = 0x69, -+ H2C_BT_FW_PATCH = 0x6A, -+ -+ //WOWLAN Class: 100 -+ H2C_WOWLAN = 0x80, -+ H2C_REMOTE_WAKE_CTRL = 0x81, -+ H2C_AOAC_GLOBAL_INFO = 0x82, -+ H2C_AOAC_RSVD_PAGE = 0x83, -+ H2C_AOAC_RSVD_PAGE2 = 0x84, -+ H2C_D0_SCAN_OFFLOAD_CTRL = 0x85, -+ H2C_D0_SCAN_OFFLOAD_INFO = 0x86, -+ H2C_CHNL_SWITCH_OFFLOAD = 0x87, -+ H2C_AOAC_RSVDPAGE3 = 0x88, -+ H2C_P2P_OFFLOAD_RSVD_PAGE = 0x8A, -+ H2C_P2P_OFFLOAD = 0x8B, -+ -+ H2C_RESET_TSF = 0xC0, -+ H2C_MAXID, -+}; -+ -+#define H2C_INACTIVE_PS_LEN 3 -+#define H2C_RSVDPAGE_LOC_LEN 5 -+#define H2C_MEDIA_STATUS_RPT_LEN 3 -+#define H2C_KEEP_ALIVE_CTRL_LEN 2 -+#define H2C_DISCON_DECISION_LEN 3 -+#define H2C_AP_OFFLOAD_LEN 3 -+#define H2C_AP_WOW_GPIO_CTRL_LEN 4 -+#define H2C_AP_PS_LEN 2 -+#define H2C_PWRMODE_LEN 7 -+#define H2C_PSTUNEPARAM_LEN 4 -+#define H2C_MACID_CFG_LEN 7 -+#define H2C_BTMP_OPER_LEN 5 -+#define H2C_WOWLAN_LEN 5 -+#define H2C_REMOTE_WAKE_CTRL_LEN 3 -+#define H2C_AOAC_GLOBAL_INFO_LEN 2 -+#define H2C_AOAC_RSVDPAGE_LOC_LEN 7 -+#define H2C_SCAN_OFFLOAD_CTRL_LEN 4 -+#define H2C_BT_FW_PATCH_LEN 6 -+#define H2C_RSSI_SETTING_LEN 4 -+#define H2C_AP_REQ_TXRPT_LEN 2 -+#define H2C_FORCE_BT_TXPWR_LEN 3 -+#define H2C_BCN_RSVDPAGE_LEN 5 -+#define H2C_PROBERSP_RSVDPAGE_LEN 5 -+#define H2C_P2PRSVDPAGE_LOC_LEN 5 -+#define H2C_P2P_OFFLOAD_LEN 3 -+ -+#define eqMacAddr(a,b) ( ((a)[0]==(b)[0] && (a)[1]==(b)[1] && (a)[2]==(b)[2] && (a)[3]==(b)[3] && (a)[4]==(b)[4] && (a)[5]==(b)[5]) ? 1:0 ) -+#define cpMacAddr(des,src) ((des)[0]=(src)[0],(des)[1]=(src)[1],(des)[2]=(src)[2],(des)[3]=(src)[3],(des)[4]=(src)[4],(des)[5]=(src)[5]) -+#define cpIpAddr(des,src) ((des)[0]=(src)[0],(des)[1]=(src)[1],(des)[2]=(src)[2],(des)[3]=(src)[3]) -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+// -+// ARP packet -+// -+// LLC Header -+#define GET_ARP_PKT_LLC_TYPE(__pHeader) ReadEF2Byte( ((u8*)(__pHeader)) + 6) -+ -+//ARP element -+#define GET_ARP_PKT_OPERATION(__pHeader) ReadEF2Byte(((u8*)(__pHeader)) + 6) -+#define GET_ARP_PKT_SENDER_MAC_ADDR(__pHeader, _val) cpMacAddr((u8*)(_val), ((u8*)(__pHeader))+8) -+#define GET_ARP_PKT_SENDER_IP_ADDR(__pHeader, _val) cpIpAddr((u8*)(_val), ((u8*)(__pHeader))+14) -+#define GET_ARP_PKT_TARGET_MAC_ADDR(__pHeader, _val) cpMacAddr((u8*)(_val), ((u8*)(__pHeader))+18) -+#define GET_ARP_PKT_TARGET_IP_ADDR(__pHeader, _val) cpIpAddr((u8*)(_val), ((u8*)(__pHeader))+24) -+ -+#define SET_ARP_PKT_HW(__pHeader, __Value) WriteEF2Byte( ((u8*)(__pHeader)) + 0, __Value) -+#define SET_ARP_PKT_PROTOCOL(__pHeader, __Value) WriteEF2Byte( ((u8*)(__pHeader)) + 2, __Value) -+#define SET_ARP_PKT_HW_ADDR_LEN(__pHeader, __Value) WriteEF1Byte( ((u8*)(__pHeader)) + 4, __Value) -+#define SET_ARP_PKT_PROTOCOL_ADDR_LEN(__pHeader, __Value) WriteEF1Byte( ((u8*)(__pHeader)) + 5, __Value) -+#define SET_ARP_PKT_OPERATION(__pHeader, __Value) WriteEF2Byte( ((u8*)(__pHeader)) + 6, __Value) -+#define SET_ARP_PKT_SENDER_MAC_ADDR(__pHeader, _val) cpMacAddr(((u8*)(__pHeader))+8, (u8*)(_val)) -+#define SET_ARP_PKT_SENDER_IP_ADDR(__pHeader, _val) cpIpAddr(((u8*)(__pHeader))+14, (u8*)(_val)) -+#define SET_ARP_PKT_TARGET_MAC_ADDR(__pHeader, _val) cpMacAddr(((u8*)(__pHeader))+18, (u8*)(_val)) -+#define SET_ARP_PKT_TARGET_IP_ADDR(__pHeader, _val) cpIpAddr(((u8*)(__pHeader))+24, (u8*)(_val)) -+ -+#define FW_WOWLAN_FUN_EN BIT(0) -+#define FW_WOWLAN_PATTERN_MATCH BIT(1) -+#define FW_WOWLAN_MAGIC_PKT BIT(2) -+#define FW_WOWLAN_UNICAST BIT(3) -+#define FW_WOWLAN_ALL_PKT_DROP BIT(4) -+#define FW_WOWLAN_GPIO_ACTIVE BIT(5) -+#define FW_WOWLAN_REKEY_WAKEUP BIT(6) -+#define FW_WOWLAN_DEAUTH_WAKEUP BIT(7) -+ -+#define FW_WOWLAN_GPIO_WAKEUP_EN BIT(0) -+#define FW_FW_PARSE_MAGIC_PKT BIT(1) -+ -+#define FW_REMOTE_WAKE_CTRL_EN BIT(0) -+#define FW_REALWOWLAN_EN BIT(5) -+ -+#define FW_WOWLAN_KEEP_ALIVE_EN BIT(0) -+#define FW_ADOPT_USER BIT(1) -+#define FW_WOWLAN_KEEP_ALIVE_PKT_TYPE BIT(2) -+ -+#define FW_REMOTE_WAKE_CTRL_EN BIT(0) -+#define FW_ARP_EN BIT(1) -+#define FW_REALWOWLAN_EN BIT(5) -+#define FW_WOW_FW_UNICAST_EN BIT(7) -+ -+#endif //CONFIG_WOWLAN -+ -+//_RSVDPAGE_LOC_CMD_0x00 -+#define SET_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value)SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+ -+//_MEDIA_STATUS_RPT_PARM_CMD_0x01 -+#define SET_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+#define SET_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+2, 0, 8, __Value) -+ -+//_KEEP_ALIVE_CMD_0x03 -+#define SET_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+ -+//_DISCONNECT_DECISION_CMD_0x04 -+#define SET_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+#define SET_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+2, 0, 8, __Value) -+ -+//_AP_Offload 0x08 -+#define SET_H2CCMD_AP_WOWLAN_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+//_BCN_RsvdPage 0x09 -+#define SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_BCN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+//_Probersp_RsvdPage 0x0a -+#define SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_ProbeRsp(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+//_Probersp_RsvdPage 0x13 -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_INDEX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_C2H_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_PLUS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_HIGH_ACTIVE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_C2H_DURATION(__pH2CCmd, __Value)SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+//_AP_PS 0x26 -+#define SET_H2CCMD_AP_WOW_PS_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_AP_WOW_PS_32K_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_AP_WOW_PS_RF(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_AP_WOW_PS_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+ -+// _WoWLAN PARAM_CMD_0x80 -+#define SET_H2CCMD_WOWLAN_FUNC_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_WOWLAN_MAGIC_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_WOWLAN_UNICAST_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_H2CCMD_WOWLAN_ALL_PKT_DROP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_H2CCMD_WOWLAN_GPIO_ACTIVE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+#define SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) -+#define SET_H2CCMD_WOWLAN_DISCONNECT_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) -+#define SET_H2CCMD_WOWLAN_GPIONUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 7, __Value) -+#define SET_H2CCMD_WOWLAN_DATAPIN_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 7, 1, __Value) -+#define SET_H2CCMD_WOWLAN_GPIO_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_WOWLAN_GPIO_PULSE_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 1, __Value) -+#define SET_H2CCMD_WOWLAN_GPIO_PULSE_COUNT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 1, 7, __Value) -+#define SET_H2CCMD_WOWLAN_LOWPR_RX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 1, __Value) -+#define SET_H2CCMD_WOWLAN_CHANGE_UNIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 2, 1, __Value) -+// _REMOTE_WAKEUP_CMD_0x81 -+#define SET_H2CCMD_REMOTE_WAKECTRL_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_NDP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_NLO_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_FW_UNICAST_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_NBNS_FILTER_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 2, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_FW_PARSING_UNTIL_WAKEUP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 4, 1, __Value) -+ -+// AOAC_GLOBAL_INFO_0x82 -+#define SET_H2CCMD_AOAC_GLOBAL_INFO_PAIRWISE_ENC_ALG(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_GLOBAL_INFO_GROUP_ENC_ALG(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+ -+// AOAC_RSVDPAGE_LOC_0x83 -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd), 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_NEIGHBOR_ADV(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+#ifdef CONFIG_GTK_OL -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_EXT_MEM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+5, 0, 8, __Value) -+#endif //CONFIG_GTK_OL -+#ifdef CONFIG_PNO_SUPPORT -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_NLO_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd), 0, 8, __Value) -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+// D0_Scan_Offload_Info_0x86 -+#define SET_H2CCMD_AOAC_NLO_FUN_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 3, 1, __Value) -+#define SET_H2CCMD_AOAC_NLO_IPS_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 4, 1, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_PROBE_PACKET(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_SCAN_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_SSID_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#endif //CONFIG_PNO_SUPPORT -+ -+#ifdef CONFIG_P2P_WOWLAN -+//P2P_RsvdPage_0x8a -+#define SET_H2CCMD_RSVDPAGE_LOC_P2P_BCN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_P2P_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_P2P_NEGO_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_P2P_INVITE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_P2P_PD_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+#endif //CONFIG_P2P_WOWLAN -+ -+//---------------------------------------------------------------------------------------------------------// -+//------------------------------------------- Structure --------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+typedef struct _RSVDPAGE_LOC { -+ u8 LocProbeRsp; -+ u8 LocPsPoll; -+ u8 LocNullData; -+ u8 LocQosNull; -+ u8 LocBTQosNull; -+#ifdef CONFIG_WOWLAN -+ u8 LocRemoteCtrlInfo; -+ u8 LocArpRsp; -+ u8 LocNbrAdv; -+ u8 LocGTKRsp; -+ u8 LocGTKInfo; -+ u8 LocProbeReq; -+ u8 LocNetList; -+#ifdef CONFIG_GTK_OL -+ u8 LocGTKEXTMEM; -+#endif //CONFIG_GTK_OL -+#ifdef CONFIG_PNO_SUPPORT -+ u8 LocPNOInfo; -+ u8 LocScanInfo; -+ u8 LocSSIDInfo; -+ u8 LocProbePacket; -+#endif //CONFIG_PNO_SUPPORT -+#endif //CONFIG_WOWLAN -+ u8 LocApOffloadBCN; -+#ifdef CONFIG_P2P_WOWLAN -+ u8 LocP2PBeacon; -+ u8 LocP2PProbeRsp; -+ u8 LocNegoRsp; -+ u8 LocInviteRsp; -+ u8 LocPDRsp; -+#endif //CONFIG_P2P_WOWLAN -+} RSVDPAGE_LOC, *PRSVDPAGE_LOC; -+ -+#endif -+void dump_TX_FIFO(PADAPTER padapter, u8 page_num, u16 page_size); -+u8 rtw_hal_set_fw_media_status_cmd(_adapter* adapter, u8 mstatus, u8 macid); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+//WOW command function -+void rtw_hal_set_fw_wow_related_cmd(_adapter* padapter, u8 enable); -+#ifdef CONFIG_P2P_WOWLAN -+//H2C 0x8A -+u8 rtw_hal_set_FwP2PRsvdPage_cmd(_adapter* adapter, PRSVDPAGE_LOC rsvdpageloc); -+//H2C 0x8B -+u8 rtw_hal_set_p2p_wowlan_offload_cmd(_adapter* adapter); -+#endif //CONFIG_P2P_WOWLAN -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_led.h linux/3rdparty/rtl8812au/include/hal_com_led.h ---- linux.old/3rdparty/rtl8812au/include/hal_com_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_com_led.h 2017-06-07 23:07:21.037689945 +0300 -@@ -0,0 +1,398 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_com_led.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com_led.h +--- linux-4.14.17/3rdparty/rtl8812au/include/hal_com_led.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com_led.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,264 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -301907,11 +132371,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_led.h linux/3rdparty/rtl + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __HAL_COMMON_LED_H_ +#define __HAL_COMMON_LED_H_ @@ -301952,7 +132411,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_led.h linux/3rdparty/rtl +#define LED_BLINK_NO_LINK_INTERVAL_ALPHA 1000 +#define LED_BLINK_NO_LINK_INTERVAL_ALPHA_500MS 500 //add by ylb 20121012 for customer led for alpha +#define LED_BLINK_LINK_INTERVAL_ALPHA 500 //500 -+#define LED_BLINK_SCAN_INTERVAL_ALPHA 180 //150 ++#define LED_BLINK_SCAN_INTERVAL_ALPHA 180 //150 +#define LED_BLINK_FASTER_INTERVAL_ALPHA 50 +#define LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA 5000 + @@ -301980,17 +132439,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_led.h linux/3rdparty/rtl +#define LED_CM12_BLINK_INTERVAL_80Mbps 30 +#define LED_CM12_BLINK_INTERVAL_MAXMbps 25 + -+//Dlink -+#define LED_BLINK_NO_LINK_INTERVAL 1000 -+#define LED_BLINK_LINK_IDEL_INTERVAL 100 -+ -+#define LED_BLINK_SCAN_ON_INTERVAL 30 -+#define LED_BLINK_SCAN_OFF_INTERVAL 300 -+ -+#define LED_WPS_BLINK_ON_INTERVAL_DLINK 30 -+#define LED_WPS_BLINK_OFF_INTERVAL_DLINK 300 -+#define LED_WPS_BLINK_LINKED_ON_INTERVAL_DLINK 5000 -+ +//================================================================================ +// LED object. +//================================================================================ @@ -302007,7 +132455,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_led.h linux/3rdparty/rtl + LED_CTL_START_WPS = 9, + LED_CTL_STOP_WPS = 10, + LED_CTL_START_WPS_BOTTON = 11, //added for runtop -+ LED_CTL_STOP_WPS_FAIL = 12, //added for ALPHA ++ LED_CTL_STOP_WPS_FAIL = 12, //added for ALPHA + LED_CTL_STOP_WPS_FAIL_OVERLAP = 13, //added for BELKIN + LED_CTL_CONNECTION_NO_TRANSFER = 14, +}LED_CTL_MODE; @@ -302019,14 +132467,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_led.h linux/3rdparty/rtl + LED_BLINK_NORMAL = 3, + LED_BLINK_SLOWLY = 4, + LED_BLINK_POWER_ON = 5, -+ LED_BLINK_SCAN = 6, // LED is blinking during scanning period, the # of times to blink is depend on time for scanning. ++ LED_BLINK_SCAN = 6, // LED is blinking during scanning period, the # of times to blink is depend on time for scanning. + LED_BLINK_NO_LINK = 7, // LED is blinking during no link state. + LED_BLINK_StartToBlink = 8, // Customzied for Sercomm Printer Server case + LED_BLINK_TXRX = 9, + LED_BLINK_WPS = 10, // LED is blinkg during WPS communication + LED_BLINK_WPS_STOP = 11, //for ALPHA + LED_BLINK_WPS_STOP_OVERLAP = 12, //for BELKIN -+ LED_BLINK_RUNTOP = 13, // Customized for RunTop ++ LED_BLINK_RUNTOP = 13, // Customized for RunTop + LED_BLINK_CAMEO = 14, + LED_BLINK_XAVI = 15, + LED_BLINK_ALWAYS_ON = 16, @@ -302038,8 +132486,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_led.h linux/3rdparty/rtl + LED_BLINK_Azurewave_40Mbps = 22, + LED_BLINK_Azurewave_80Mbps = 23, + LED_BLINK_Azurewave_MAXMbps = 24, -+ LED_BLINK_LINK_IDEL = 25, -+ LED_BLINK_WPS_LINKED = 26, +}LED_STATE; + +typedef enum _LED_PIN{ @@ -302053,65 +132499,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_led.h linux/3rdparty/rtl +//================================================================================ +// PCIE LED Definition. +//================================================================================ -+#ifdef CONFIG_PCI_HCI -+typedef enum _LED_STRATEGY_PCIE{ -+ SW_LED_MODE0, // SW control 1 LED via GPIO0. It is default option. -+ SW_LED_MODE1, // SW control for PCI Express -+ SW_LED_MODE2, // SW control for Cameo. -+ SW_LED_MODE3, // SW contorl for RunTop. -+ SW_LED_MODE4, // SW control for Netcore -+ SW_LED_MODE5, //added by vivi, for led new mode, DLINK -+ SW_LED_MODE6, //added by vivi, for led new mode, PRONET -+ SW_LED_MODE7, //added by chiyokolin, for Lenovo, PCI Express Minicard Spec Rev.1.2 spec -+ SW_LED_MODE8, //added by chiyokolin, for QMI -+ SW_LED_MODE9, //added by chiyokolin, for BITLAND-LENOVO, PCI Express Minicard Spec Rev.1.1 -+ SW_LED_MODE10, //added by chiyokolin, for Edimax-ASUS -+ SW_LED_MODE11, //added by hpfan, for Xavi -+ SW_LED_MODE12, //added by chiyokolin, for Azurewave -+ HW_LED, // HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes) -+}LED_STRATEGY_PCIE, *PLED_STRATEGY_PCIE; -+ -+typedef struct _LED_PCIE{ -+ PADAPTER padapter; -+ -+ LED_PIN LedPin; // Identify how to implement this SW led. -+ -+ LED_STATE CurrLedState; // Current LED state. -+ BOOLEAN bLedOn; // TRUE if LED is ON, FALSE if LED is OFF. -+ -+ BOOLEAN bLedBlinkInProgress; // TRUE if it is blinking, FALSE o.w.. -+ BOOLEAN bLedWPSBlinkInProgress; // TRUE if it is blinking, FALSE o.w.. -+ -+ BOOLEAN bLedSlowBlinkInProgress;//added by vivi, for led new mode -+ u32 BlinkTimes; // Number of times to toggle led state for blinking. -+ LED_STATE BlinkingLedState; // Next state for blinking, either LED_ON or LED_OFF are. -+ -+ _timer BlinkTimer; // Timer object for led blinking. -+} LED_PCIE, *PLED_PCIE; -+ -+typedef struct _LED_PCIE LED_DATA, *PLED_DATA; -+typedef enum _LED_STRATEGY_PCIE LED_STRATEGY, *PLED_STRATEGY; -+ -+VOID -+LedControlPCIE( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+ ); -+ -+VOID -+gen_RefreshLedState( -+ IN PADAPTER Adapter); -+ -+//================================================================================ -+// USB LED Definition. -+//================================================================================ -+#elif defined(CONFIG_USB_HCI) + +#define IS_LED_WPS_BLINKING(_LED_USB) (((PLED_USB)_LED_USB)->CurrLedState==LED_BLINK_WPS \ + || ((PLED_USB)_LED_USB)->CurrLedState==LED_BLINK_WPS_STOP \ + || ((PLED_USB)_LED_USB)->bLedWPSBlinkInProgress) + -+#define IS_LED_BLINKING(_LED_USB) (((PLED_USB)_LED_USB)->bLedWPSBlinkInProgress \ ++#define IS_LED_BLINKING(_LED_USB) (((PLED_USB)_LED_USB)->bLedWPSBlinkInProgress \ + ||((PLED_USB)_LED_USB)->bLedScanBlinkInProgress) + + @@ -302121,7 +132514,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_led.h linux/3rdparty/rtl + SW_LED_MODE2, // SW control 1 LED via GPIO0, customized for AzWave 8187 minicard. + SW_LED_MODE3, // SW control 1 LED via GPIO0, customized for Sercomm Printer Server case. + SW_LED_MODE4, //for Edimax / Belkin -+ SW_LED_MODE5, //for Sercomm / Belkin ++ SW_LED_MODE5, //for Sercomm / Belkin + SW_LED_MODE6, //for 88CU minicard, porting from ce SW_LED_MODE7 + SW_LED_MODE7, //for Netgear special requirement + SW_LED_MODE8, //for LC @@ -302130,111 +132523,45 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_led.h linux/3rdparty/rtl + SW_LED_MODE11, //for Edimax / ASUS + SW_LED_MODE12, //for WNC/NEC + SW_LED_MODE13, //for Netgear A6100, 8811Au -+ SW_LED_MODE14, //for Buffalo, DNI, 8811Au -+ SW_LED_MODE15, //for DLINK, 8811Au/8812AU + HW_LED, // HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes, see MAC.CONFIG1 for details.) +}LED_STRATEGY_USB, *PLED_STRATEGY_USB; + -+ +typedef struct _LED_USB{ + PADAPTER padapter; + + LED_PIN LedPin; // Identify how to implement this SW led. + + LED_STATE CurrLedState; // Current LED state. -+ BOOLEAN bLedOn; // TRUE if LED is ON, FALSE if LED is OFF. ++ bool bLedOn; // TRUE if LED is ON, FALSE if LED is OFF. + -+ BOOLEAN bSWLedCtrl; ++ bool bSWLedCtrl; + -+ BOOLEAN bLedBlinkInProgress; // TRUE if it is blinking, FALSE o.w.. ++ bool bLedBlinkInProgress; // TRUE if it is blinking, FALSE o.w.. + // ALPHA, added by chiyoko, 20090106 -+ BOOLEAN bLedNoLinkBlinkInProgress; -+ BOOLEAN bLedLinkBlinkInProgress; -+ BOOLEAN bLedStartToLinkBlinkInProgress; -+ BOOLEAN bLedScanBlinkInProgress; -+ BOOLEAN bLedWPSBlinkInProgress; -+ ++ bool bLedNoLinkBlinkInProgress; ++ bool bLedLinkBlinkInProgress; ++ bool bLedStartToLinkBlinkInProgress; ++ bool bLedScanBlinkInProgress; ++ bool bLedWPSBlinkInProgress; ++ + u32 BlinkTimes; // Number of times to toggle led state for blinking. + u8 BlinkCounter; //Added for turn off overlap led after blinking a while, by page, 20120821 + LED_STATE BlinkingLedState; // Next state for blinking, either LED_ON or LED_OFF are. + + _timer BlinkTimer; // Timer object for led blinking. + -+ _workitem BlinkWorkItem; // Workitem used by BlinkTimer to manipulate H/W to blink LED.' -+ ATOMIC_T bCancelWorkItem; //check if WorkItem is cancelled ++ _workitem BlinkWorkItem; // Workitem used by BlinkTimer to manipulate H/W to blink LED. +} LED_USB, *PLED_USB; + +typedef struct _LED_USB LED_DATA, *PLED_DATA; +typedef enum _LED_STRATEGY_USB LED_STRATEGY, *PLED_STRATEGY; + -+VOID ++void +LedControlUSB( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction ++ PADAPTER Adapter, ++ LED_CTL_MODE LedAction + ); + -+ -+//================================================================================ -+// SDIO LED Definition. -+//================================================================================ -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ -+#define IS_LED_WPS_BLINKING(_LED_SDIO) (((PLED_SDIO)_LED_SDIO)->CurrLedState==LED_BLINK_WPS \ -+ || ((PLED_SDIO)_LED_SDIO)->CurrLedState==LED_BLINK_WPS_STOP \ -+ || ((PLED_SDIO)_LED_SDIO)->bLedWPSBlinkInProgress) -+ -+#define IS_LED_BLINKING(_LED_SDIO) (((PLED_SDIO)_LED_SDIO)->bLedWPSBlinkInProgress \ -+ ||((PLED_SDIO)_LED_SDIO)->bLedScanBlinkInProgress) -+ -+ -+typedef enum _LED_STRATEGY_SDIO{ -+ SW_LED_MODE0, // SW control 1 LED via GPIO0. It is default option. -+ SW_LED_MODE1, // 2 LEDs, through LED0 and LED1. For ALPHA. -+ SW_LED_MODE2, // SW control 1 LED via GPIO0, customized for AzWave 8187 minicard. -+ SW_LED_MODE3, // SW control 1 LED via GPIO0, customized for Sercomm Printer Server case. -+ SW_LED_MODE4, //for Edimax / Belkin -+ SW_LED_MODE5, //for Sercomm / Belkin -+ SW_LED_MODE6, //for 88CU minicard, porting from ce SW_LED_MODE7 -+ HW_LED, // HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes, see MAC.CONFIG1 for details.) -+}LED_STRATEGY_SDIO, *PLED_STRATEGY_SDIO; -+ -+typedef struct _LED_SDIO{ -+ PADAPTER padapter; -+ -+ LED_PIN LedPin; // Identify how to implement this SW led. -+ -+ LED_STATE CurrLedState; // Current LED state. -+ BOOLEAN bLedOn; // TRUE if LED is ON, FALSE if LED is OFF. -+ -+ BOOLEAN bSWLedCtrl; -+ -+ BOOLEAN bLedBlinkInProgress; // TRUE if it is blinking, FALSE o.w.. -+ // ALPHA, added by chiyoko, 20090106 -+ BOOLEAN bLedNoLinkBlinkInProgress; -+ BOOLEAN bLedLinkBlinkInProgress; -+ BOOLEAN bLedStartToLinkBlinkInProgress; -+ BOOLEAN bLedScanBlinkInProgress; -+ BOOLEAN bLedWPSBlinkInProgress; -+ -+ u32 BlinkTimes; // Number of times to toggle led state for blinking. -+ LED_STATE BlinkingLedState; // Next state for blinking, either LED_ON or LED_OFF are. -+ -+ _timer BlinkTimer; // Timer object for led blinking. -+ -+ _workitem BlinkWorkItem; // Workitem used by BlinkTimer to manipulate H/W to blink LED. -+} LED_SDIO, *PLED_SDIO; -+ -+typedef struct _LED_SDIO LED_DATA, *PLED_DATA; -+typedef enum _LED_STRATEGY_SDIO LED_STRATEGY, *PLED_STRATEGY; -+ -+VOID -+LedControlSDIO( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+ ); -+ -+#endif -+ +struct led_priv{ + /* add for led controll */ + LED_DATA SwLed0; @@ -302270,7 +132597,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_led.h linux/3rdparty/rtl + (adapter)->ledpriv.SwLedOff((adapter), (pLed)); \ + } while(0) + ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) +void BlinkTimerCallback(void *data); ++#else ++void BlinkTimerCallback(struct timer_list *t); ++#endif +void BlinkWorkItemCallback(_workitem *work); + +void ResetLedStatus(PLED_DATA pLed); @@ -302291,15 +132622,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_led.h linux/3rdparty/rtl +extern void BlinkHandler(PLED_DATA pLed); + +#endif //__RTW_LED_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_phycfg.h linux/3rdparty/rtl8812au/include/hal_com_phycfg.h ---- linux.old/3rdparty/rtl8812au/include/hal_com_phycfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_com_phycfg.h 2017-06-07 23:07:21.037689945 +0300 -@@ -0,0 +1,267 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_com_phycfg.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com_phycfg.h +--- linux-4.14.17/3rdparty/rtl8812au/include/hal_com_phycfg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com_phycfg.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,68 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -302309,268 +132639,69 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_phycfg.h linux/3rdparty/ + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __HAL_COM_PHYCFG_H__ +#define __HAL_COM_PHYCFG_H__ + -+#define PathA 0x0 // Useless -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 + -+typedef enum _RF_TX_NUM { -+ RF_1TX = 0, -+ RF_2TX, -+ RF_3TX, -+ RF_4TX, -+ RF_MAX_TX_NUM, -+ RF_TX_NUM_NONIMPLEMENT, -+} RF_TX_NUM; -+ -+#define MAX_POWER_INDEX 0x3F ++#define MAX_POWER_INDEX 0x3F + +typedef enum _REGULATION_TXPWR_LMT { + TXPWR_LMT_FCC = 0, -+ TXPWR_LMT_MKK = 1, -+ TXPWR_LMT_ETSI = 2, -+ TXPWR_LMT_WW = 3, -+ -+ TXPWR_LMT_MAX_REGULATION_NUM = 4 ++ TXPWR_LMT_MKK, ++ TXPWR_LMT_ETSI, +} REGULATION_TXPWR_LMT; + -+/*------------------------------Define structure----------------------------*/ ++/*------------------------------Define structure----------------------------*/ +typedef struct _BB_REGISTER_DEFINITION{ -+ u32 rfintfs; // set software control: ++ u32 rfintfs; // set software control: + // 0x870~0x877[8 bytes] -+ -+ u32 rfintfo; // output data: ++ ++ u32 rfintfo; // output data: + // 0x860~0x86f [16 bytes] -+ -+ u32 rfintfe; // output enable: ++ ++ u32 rfintfe; // output enable: + // 0x860~0x86f [16 bytes] -+ ++ + u32 rf3wireOffset; // LSSI data: + // 0x840~0x84f [16 bytes] + -+ u32 rfHSSIPara2; // wire parameter control2 : ++ u32 rfHSSIPara2; // wire parameter control2 : + // 0x824~0x827,0x82c~0x82f, 0x834~0x837, 0x83c~0x83f [16 bytes] -+ -+ u32 rfLSSIReadBack; //LSSI RF readback data SI mode ++ ++ u32 rfLSSIReadBack; //LSSI RF readback data SI mode + // 0x8a0~0x8af [16 bytes] + -+ u32 rfLSSIReadBackPi; //LSSI RF readback data PI mode 0x8b8-8bc for Path A and B ++ u32 rfLSSIReadBackPi; //LSSI RF readback data PI mode 0x8b8-8bc for Path A and B + +}BB_REGISTER_DEFINITION_T, *PBB_REGISTER_DEFINITION_T; + ++#ifndef CONFIG_EMBEDDED_FWIMG ++int phy_ConfigMACWithParaFile(PADAPTER Adapter, u8* pFileName); + -+//---------------------------------------------------------------------- -+s32 -+phy_TxPwrIdxToDbm( -+ IN PADAPTER Adapter, -+ IN WIRELESS_MODE WirelessMode, -+ IN u8 TxPwrIdx -+ ); ++int PHY_ConfigBBWithPowerLimitTableParaFile(PADAPTER Adapter, s8* pFileName); + -+u8 -+PHY_GetTxPowerByRateBase( -+ IN PADAPTER Adapter, -+ IN u8 Band, -+ IN u8 RfPath, -+ IN u8 TxNum, -+ IN RATE_SECTION RateSection -+ ); ++int phy_ConfigBBWithParaFile(PADAPTER Adapter, u8* pFileName); + -+u8 -+PHY_GetRateSectionIndexOfTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u32 RegAddr, -+ IN u32 BitMask -+ ); ++int phy_ConfigBBWithPgParaFile(PADAPTER Adapter, u8* pFileName); + -+VOID -+PHY_GetRateValuesOfTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Value, -+ OUT u8 *Rate, -+ OUT s8 *PwrByRateVal, -+ OUT u8 *RateNum -+ ); ++int phy_ConfigBBWithMpParaFile(PADAPTER Adapter, u8* pFileName); + -+u8 -+PHY_GetRateIndexOfTxPowerByRate( -+ IN u8 Rate -+ ); ++int PHY_ConfigRFWithParaFile(IN PADAPTER Adapter, u8* pFileName, u8 eRFPath); + -+VOID -+PHY_SetTxPowerIndexByRateSection( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Channel, -+ IN u8 RateSection -+ ); -+ -+s8 -+PHY_GetTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u8 Band, -+ IN u8 RFPath, -+ IN u8 TxNum, -+ IN u8 RateIndex -+ ); -+ -+VOID -+PHY_SetTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u8 Band, -+ IN u8 RFPath, -+ IN u8 TxNum, -+ IN u8 Rate, -+ IN s8 Value -+ ); -+ -+VOID -+PHY_SetTxPowerLevelByPath( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN u8 path -+ ); -+ -+VOID -+PHY_SetTxPowerIndexByRateArray( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel, -+ IN u8* Rates, -+ IN u8 RateArraySize -+ ); -+ -+VOID -+PHY_InitTxPowerByRate( -+ IN PADAPTER pAdapter -+ ); -+ -+VOID -+PHY_StoreTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u32 Band, -+ IN u32 RfPath, -+ IN u32 TxNum, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+ ); -+ -+VOID -+PHY_TxPowerByRateConfiguration( -+ IN PADAPTER pAdapter -+ ); -+ -+u8 -+PHY_GetTxPowerIndexBase( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel, -+ OUT PBOOLEAN bIn24G -+ ); -+ -+s8 -+PHY_GetTxPowerLimit( -+ IN PADAPTER Adapter, -+ IN u32 RegPwrTblSel, -+ IN BAND_TYPE Band, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 RfPath, -+ IN u8 DataRate, -+ IN u8 Channel -+ ); -+ -+VOID -+PHY_ConvertTxPowerLimitToPowerIndex( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+PHY_InitTxPowerLimit( -+ IN PADAPTER Adapter -+ ); -+ -+s8 -+PHY_GetTxPowerTrackingOffset( -+ PADAPTER pAdapter, -+ u8 Rate, -+ u8 RFPath -+ ); -+ -+u8 -+PHY_GetTxPowerIndex( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel -+ ); -+ -+VOID -+PHY_SetTxPowerIndex( -+ IN PADAPTER pAdapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+ ); -+ -+void dump_tx_power_by_rate_base(void *sel, _adapter *adapter); -+void dump_tx_power_by_rate(void *sel, _adapter *adapter); -+void dump_tx_power_limit(void *sel, _adapter *adapter); -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+#define MAX_PARA_FILE_BUF_LEN 25600 -+ -+#define LOAD_MAC_PARA_FILE BIT0 -+#define LOAD_BB_PARA_FILE BIT1 -+#define LOAD_BB_PG_PARA_FILE BIT2 -+#define LOAD_BB_MP_PARA_FILE BIT3 -+#define LOAD_RF_PARA_FILE BIT4 -+#define LOAD_RF_TXPWR_TRACK_PARA_FILE BIT5 -+#define LOAD_RF_TXPWR_LMT_PARA_FILE BIT6 -+ -+int phy_ConfigMACWithParaFile(IN PADAPTER Adapter, IN char* pFileName); -+ -+int phy_ConfigBBWithParaFile(IN PADAPTER Adapter, IN char* pFileName, IN u32 ConfigType); -+ -+int phy_ConfigBBWithPgParaFile(IN PADAPTER Adapter, IN char* pFileName); -+ -+int phy_ConfigBBWithMpParaFile(IN PADAPTER Adapter, IN char* pFileName); -+ -+int PHY_ConfigRFWithParaFile(IN PADAPTER Adapter, IN char* pFileName, IN u8 eRFPath); -+ -+int PHY_ConfigRFWithTxPwrTrackParaFile(IN PADAPTER Adapter, IN char* pFileName); -+ -+int PHY_ConfigRFWithPowerLimitTableParaFile(IN PADAPTER Adapter, IN char* pFileName); -+ -+void phy_free_filebuf(_adapter *padapter); -+#endif //CONFIG_LOAD_PHY_PARA_FROM_FILE ++int PHY_ConfigRFWithTxPwrTrackParaFile(PADAPTER Adapter, u8* pFileName); ++#endif + + +#endif //__HAL_COMMON_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl8812au/include/hal_com_reg.h ---- linux.old/3rdparty/rtl8812au/include/hal_com_reg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_com_reg.h 2017-06-07 23:07:21.037689945 +0300 -@@ -0,0 +1,1780 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_com_reg.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com_reg.h +--- linux-4.14.17/3rdparty/rtl8812au/include/hal_com_reg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com_reg.h 2018-02-06 17:42:30.718967283 +0200 +@@ -0,0 +1,1697 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -302580,11 +132711,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __HAL_COMMON_REG_H__ +#define __HAL_COMMON_REG_H__ @@ -302612,14 +132738,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define REG_SYS_FUNC_EN 0x0002 +#define REG_APS_FSMCO 0x0004 +#define REG_SYS_CLKR 0x0008 -+#define REG_SYS_CLK_CTRL REG_SYS_CLKR +#define REG_9346CR 0x000A +#define REG_SYS_EEPROM_CTRL 0x000A +#define REG_EE_VPD 0x000C +#define REG_AFE_MISC 0x0010 +#define REG_SPS0_CTRL 0x0011 +#define REG_SPS0_CTRL_6 0x0016 -+#define REG_POWER_OFF_IN_PROCESS 0x0017 ++#define REG_POWER_OFF_IN_PROCESS 0x0017 +#define REG_SPS_OCP_CFG 0x0018 +#define REG_RSV_CTRL 0x001C +#define REG_RF_CTRL 0x001F @@ -302674,11 +132799,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define REG_GPIO_OUTSTS 0x00F4 // For RTL8723 only. +#define REG_TYPE_ID 0x00FC + -+// -+// 2010/12/29 MH Add for 92D -+// -+#define REG_MAC_PHY_CTRL_NORMAL 0x00f8 -+ + +//----------------------------------------------------- +// @@ -302727,10 +132847,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define REG_HMEBOX_2 0x01D8 +#define REG_HMEBOX_3 0x01DC +#define REG_LLT_INIT 0x01E0 -+#define REG_HMEBOX_EXT_0 0x01F0 -+#define REG_HMEBOX_EXT_1 0x01F4 -+#define REG_HMEBOX_EXT_2 0x01F8 -+#define REG_HMEBOX_EXT_3 0x01FC + + +//----------------------------------------------------- @@ -302744,7 +132860,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define REG_TXDMA_OFFSET_CHK 0x020C +#define REG_TXDMA_STATUS 0x0210 +#define REG_RQPN_NPQ 0x0214 -+#define REG_AUTO_LLT 0x0224 + + +//----------------------------------------------------- @@ -302753,7 +132868,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +// +//----------------------------------------------------- +#define REG_RXDMA_AGG_PG_TH 0x0280 -+#define REG_RXPKT_NUM 0x0284 ++#define REG_RXPKT_NUM 0x0284 +#define REG_RXDMA_STATUS 0x0288 + +//----------------------------------------------------- @@ -302762,29 +132877,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +// +//----------------------------------------------------- +#define REG_PCIE_CTRL_REG 0x0300 -+#define REG_INT_MIG 0x0304 /* Interrupt Migration */ -+#define REG_BCNQ_DESA 0x0308 /* TX Beacon Descriptor Address */ -+#define REG_HQ_DESA 0x0310 /* TX High Queue Descriptor Address */ -+#define REG_MGQ_DESA 0x0318 /* TX Manage Queue Descriptor Address */ -+#define REG_VOQ_DESA 0x0320 /* TX VO Queue Descriptor Address */ -+#define REG_VIQ_DESA 0x0328 /* TX VI Queue Descriptor Address */ -+#define REG_BEQ_DESA 0x0330 /* TX BE Queue Descriptor Address */ -+#define REG_BKQ_DESA 0x0338 /* TX BK Queue Descriptor Address */ -+#define REG_RX_DESA 0x0340 /* RX Queue Descriptor Address */ ++#define REG_INT_MIG 0x0304 // Interrupt Migration ++#define REG_BCNQ_DESA 0x0308 // TX Beacon Descriptor Address ++#define REG_HQ_DESA 0x0310 // TX High Queue Descriptor Address ++#define REG_MGQ_DESA 0x0318 // TX Manage Queue Descriptor Address ++#define REG_VOQ_DESA 0x0320 // TX VO Queue Descriptor Address ++#define REG_VIQ_DESA 0x0328 // TX VI Queue Descriptor Address ++#define REG_BEQ_DESA 0x0330 // TX BE Queue Descriptor Address ++#define REG_BKQ_DESA 0x0338 // TX BK Queue Descriptor Address ++#define REG_RX_DESA 0x0340 // RX Queue Descriptor Address +//sherry added for DBI Read/Write 20091126 -+#define REG_DBI_WDATA 0x0348 /* Backdoor REG for Access Configuration */ -+#define REG_DBI_RDATA 0x034C /* Backdoor REG for Access Configuration */ -+#define REG_DBI_CTRL 0x0350 /* Backdoor REG for Access Configuration */ -+#define REG_DBI_FLAG 0x0352 /* Backdoor REG for Access Configuration */ -+#define REG_MDIO 0x0354 /* MDIO for Access PCIE PHY */ -+#define REG_DBG_SEL 0x0360 /* Debug Selection Register */ -+#define REG_PCIE_HRPWM 0x0361 /* PCIe RPWM */ -+#define REG_PCIE_HCPWM 0x0363 /* PCIe CPWM */ ++#define REG_DBI_WDATA 0x0348 // Backdoor REG for Access Configuration ++#define REG_DBI_RDATA 0x034C //Backdoor REG for Access Configuration ++#define REG_DBI_CTRL 0x0350 //Backdoor REG for Access Configuration ++#define REG_DBI_FLAG 0x0352 //Backdoor REG for Access Configuration ++#define REG_MDIO 0x0354 // MDIO for Access PCIE PHY ++#define REG_DBG_SEL 0x0360 // Debug Selection Register ++#define REG_PCIE_HRPWM 0x0361 //PCIe RPWM ++#define REG_PCIE_HCPWM 0x0363 //PCIe CPWM +#define REG_WATCH_DOG 0x0368 -+#define REG_RX_RXBD_NUM 0x0382 + +// RTL8723 series ------------------------------- -+#define REG_PCIE_HISR_EN 0x0394 /* PCIE Local Interrupt Enable Register */ ++#define REG_PCIE_HISR_EN 0x0394 //PCIE Local Interrupt Enable Register +#define REG_PCIE_HISR 0x03A0 +#define REG_PCIE_HISRE 0x03A4 +#define REG_PCIE_HIMR 0x03A8 @@ -302801,22 +132915,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +// 0x0400h ~ 0x047Fh Protocol Configuration +// +//----------------------------------------------------- -+ -+/* 92C, 92D */ -+#define REG_VOQ_INFO 0x0400 -+#define REG_VIQ_INFO 0x0404 -+#define REG_BEQ_INFO 0x0408 -+#define REG_BKQ_INFO 0x040C -+ -+/* 88E, 8723A, 8812A, 8821A, 92E, 8723B */ -+#define REG_Q0_INFO 0x400 -+#define REG_Q1_INFO 0x404 -+#define REG_Q2_INFO 0x408 -+#define REG_Q3_INFO 0x40C -+ -+#define REG_MGQ_INFO 0x0410 -+#define REG_HGQ_INFO 0x0414 -+#define REG_BCNQ_INFO 0x0418 ++#define REG_VOQ_INFORMATION 0x0400 ++#define REG_VIQ_INFORMATION 0x0404 ++#define REG_BEQ_INFORMATION 0x0408 ++#define REG_BKQ_INFORMATION 0x040C ++#define REG_MGQ_INFORMATION 0x0410 ++#define REG_HGQ_INFORMATION 0x0414 ++#define REG_BCNQ_INFORMATION 0x0418 +#define REG_TXPKT_EMPTY 0x041A +#define REG_CPU_MGQ_INFORMATION 0x041C +#define REG_FWHW_TXQ_CTRL 0x0420 @@ -302842,44 +132947,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define REG_FAST_EDCA_CTRL 0x0460 +#define REG_RD_RESP_PKT_TH 0x0463 + -+/* 8723A, 8812A, 8821A, 92E, 8723B */ -+#define REG_Q4_INFO 0x468 -+#define REG_Q5_INFO 0x46C -+#define REG_Q6_INFO 0x470 -+#define REG_Q7_INFO 0x474 -+ +#define REG_INIRTS_RATE_SEL 0x0480 +#define REG_INIDATA_RATE_SEL 0x0484 + -+/* 8723B, 92E, 8812A, 8821A*/ -+#define REG_MACID_SLEEP_3 0x0484 -+#define REG_MACID_SLEEP_1 0x0488 -+ +#define REG_POWER_STAGE1 0x04B4 +#define REG_POWER_STAGE2 0x04B8 +#define REG_PKT_VO_VI_LIFE_TIME 0x04C0 +#define REG_PKT_BE_BK_LIFE_TIME 0x04C2 +#define REG_STBC_SETTING 0x04C4 +#define REG_QUEUE_CTRL 0x04C6 -+#define REG_SINGLE_AMPDU_CTRL 0x04c7 +#define REG_PROT_MODE_CTRL 0x04C8 +#define REG_MAX_AGGR_NUM 0x04CA +#define REG_RTS_MAX_AGGR_NUM 0x04CB +#define REG_BAR_MODE_CTRL 0x04CC +#define REG_RA_TRY_RATE_AGG_LMT 0x04CF -+ -+/* 8723A */ -+#define REG_MACID_DROP 0x04D0 -+ -+/* 88E */ -+#define REG_EARLY_MODE_CONTROL 0x04D0 -+ -+/* 8723B, 92E, 8812A, 8821A */ -+#define REG_MACID_SLEEP_2 0x04D0 -+ -+/* 8723A, 8723B, 92E, 8812A, 8821A */ -+#define REG_MACID_SLEEP 0x04D4 -+ ++#define REG_EARLY_MODE_CONTROL 0x04D0 +#define REG_NQOS_SEQ 0x04DC +#define REG_QOS_SEQ 0x04DE +#define REG_NEED_CPU_HANDLE 0x04E0 @@ -302939,7 +133021,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define REG_USTIME_TSF 0x055C +#define REG_BCN_MAX_ERR 0x055D +#define REG_RXTSF_OFFSET_CCK 0x055E -+#define REG_RXTSF_OFFSET_OFDM 0x055F ++#define REG_RXTSF_OFFSET_OFDM 0x055F +#define REG_TSFTR 0x0560 +#define REG_TSFTR1 0x0568 // HW Port 1 TSF Register +#define REG_ATIMWND_1 0x0570 @@ -302979,7 +133061,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define REG_MAR 0x0620 +#define REG_MBIDCAMCFG 0x0628 + -+#define REG_PNO_STATUS 0x0631 +#define REG_USTIME_EDCA 0x0638 +#define REG_MAC_SPEC_SIFS 0x063A +// 20100719 Joseph: Hardware register definition change. (HW datasheet v54) @@ -302993,19 +133074,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl + +//RXERR_RPT +#define RXERR_TYPE_OFDM_PPDU 0 -+#define RXERR_TYPE_OFDM_FALSE_ALARM 1 -+#define RXERR_TYPE_OFDM_MPDU_OK 2 ++#define RXERR_TYPE_OFDMfalse_ALARM 1 ++#define RXERR_TYPE_OFDM_MPDU_OK 2 +#define RXERR_TYPE_OFDM_MPDU_FAIL 3 -+#define RXERR_TYPE_CCK_PPDU 4 -+#define RXERR_TYPE_CCK_FALSE_ALARM 5 ++#define RXERR_TYPE_CCK_PPDU 4 ++#define RXERR_TYPE_CCKfalse_ALARM 5 +#define RXERR_TYPE_CCK_MPDU_OK 6 +#define RXERR_TYPE_CCK_MPDU_FAIL 7 +#define RXERR_TYPE_HT_PPDU 8 -+#define RXERR_TYPE_HT_FALSE_ALARM 9 ++#define RXERR_TYPE_HTfalse_ALARM 9 +#define RXERR_TYPE_HT_MPDU_TOTAL 10 +#define RXERR_TYPE_HT_MPDU_OK 11 -+#define RXERR_TYPE_HT_MPDU_FAIL 12 -+#define RXERR_TYPE_RX_FULL_DROP 15 ++#define RXERR_TYPE_HT_MPDU_FAIL 12 ++#define RXERR_TYPE_RX_FULL_DROP 15 + +#define RXERR_COUNTER_MASK 0xFFFFF +#define RXERR_RPT_RST BIT(27) @@ -303070,7 +133151,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define REG_USB_HRPWM 0xFE58 +#define REG_USB_HCPWM 0xFE57 + -+// for 92DU high_Queue low_Queue Normal_Queue select ++// for 92DU high_Queue low_Queue Normal_Queue select +#define REG_USB_High_NORMAL_Queue_Select_MAC0 0xFE44 +//#define REG_USB_LOW_Queue_Select_MAC0 0xFE45 +#define REG_USB_High_NORMAL_Queue_Select_MAC1 0xFE47 @@ -303140,14 +133221,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define PhyDataR UnusedRegister + +// Min Spacing related settings. -+#define MAX_MSS_DENSITY_2T 0x13 -+#define MAX_MSS_DENSITY_1T 0x0A ++#define MAX_MSS_DENSITY_2T 0x13 ++#define MAX_MSS_DENSITY_1T 0x0A + +//---------------------------------------------------------------------------- +// 8192C Cmd9346CR bits (Offset 0xA, 16bit) +//---------------------------------------------------------------------------- +#define CmdEEPROM_En BIT5 // EEPROM enable when set 1 -+#define CmdEERPOMSEL BIT4 // System EEPROM select, 0: boot from E-FUSE, 1: The EEPROM used is 9346 ++#define CmdEERPOMSEL BIT4 // System EEPROM select, 0: boot from E-FUSE, 1: The EEPROM used is 9346 +#define Cmd9346CR_9356SEL BIT4 + +//---------------------------------------------------------------------------- @@ -303191,7 +133272,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define HSISR_GPIO9_INT BIT25 + +//---------------------------------------------------------------------------- -+// 8192C (MSR) Media Status Register (Offset 0x4C, 8 bits) ++// 8192C (MSR) Media Status Register (Offset 0x4C, 8 bits) +//---------------------------------------------------------------------------- +/* +Network Type @@ -303224,16 +133305,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +// Response Rate Set Register (offset 0x440, 24bits) +//---------------------------------------------------------------------------- +#define RRSR_1M BIT0 -+#define RRSR_2M BIT1 -+#define RRSR_5_5M BIT2 -+#define RRSR_11M BIT3 -+#define RRSR_6M BIT4 -+#define RRSR_9M BIT5 -+#define RRSR_12M BIT6 -+#define RRSR_18M BIT7 -+#define RRSR_24M BIT8 -+#define RRSR_36M BIT9 -+#define RRSR_48M BIT10 ++#define RRSR_2M BIT1 ++#define RRSR_5_5M BIT2 ++#define RRSR_11M BIT3 ++#define RRSR_6M BIT4 ++#define RRSR_9M BIT5 ++#define RRSR_12M BIT6 ++#define RRSR_18M BIT7 ++#define RRSR_24M BIT8 ++#define RRSR_36M BIT9 ++#define RRSR_48M BIT10 +#define RRSR_54M BIT11 +#define RRSR_MCS0 BIT12 +#define RRSR_MCS1 BIT13 @@ -303244,9 +133325,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define RRSR_MCS6 BIT18 +#define RRSR_MCS7 BIT19 + -+#define RRSR_CCK_RATES (RRSR_11M|RRSR_5_5M|RRSR_2M|RRSR_1M) -+#define RRSR_OFDM_RATES (RRSR_54M|RRSR_48M|RRSR_36M|RRSR_24M|RRSR_18M|RRSR_12M|RRSR_9M|RRSR_6M) -+ +// WOL bit information +#define HAL92C_WOL_PTK_UPDATE_EVENT BIT0 +#define HAL92C_WOL_GTK_UPDATE_EVENT BIT1 @@ -303262,7 +133340,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define RATR_2M 0x00000002 +#define RATR_55M 0x00000004 +#define RATR_11M 0x00000008 -+//OFDM ++//OFDM +#define RATR_6M 0x00000010 +#define RATR_9M 0x00000020 +#define RATR_12M 0x00000040 @@ -303271,7 +133349,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define RATR_36M 0x00000200 +#define RATR_48M 0x00000400 +#define RATR_54M 0x00000800 -+//MCS 1 Spatial Stream ++//MCS 1 Spatial Stream +#define RATR_MCS0 0x00001000 +#define RATR_MCS1 0x00002000 +#define RATR_MCS2 0x00004000 @@ -303295,7 +133373,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define RATE_2M BIT(1) +#define RATE_5_5M BIT(2) +#define RATE_11M BIT(3) -+//OFDM ++//OFDM +#define RATE_6M BIT(4) +#define RATE_9M BIT(5) +#define RATE_12M BIT(6) @@ -303325,11 +133403,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl + + +// ALL CCK Rate -+#define RATE_ALL_CCK RATR_1M|RATR_2M|RATR_55M|RATR_11M ++#define RATE_ALL_CCK RATR_1M|RATR_2M|RATR_55M|RATR_11M +#define RATE_ALL_OFDM_AG RATR_6M|RATR_9M|RATR_12M|RATR_18M|RATR_24M|\ -+ RATR_36M|RATR_48M|RATR_54M ++ RATR_36M|RATR_48M|RATR_54M +#define RATE_ALL_OFDM_1SS RATR_MCS0|RATR_MCS1|RATR_MCS2|RATR_MCS3 |\ -+ RATR_MCS4|RATR_MCS5|RATR_MCS6 |RATR_MCS7 ++ RATR_MCS4|RATR_MCS5|RATR_MCS6 |RATR_MCS7 +#define RATE_ALL_OFDM_2SS RATR_MCS8|RATR_MCS9 |RATR_MCS10|RATR_MCS11|\ + RATR_MCS12|RATR_MCS13|RATR_MCS14|RATR_MCS15 + @@ -303347,12 +133425,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl + +//---------------------------------------------------------------------------- +// CAM Config Setting (offset 0x680, 1 byte) -+//---------------------------------------------------------------------------- ++//---------------------------------------------------------------------------- +#define CAM_VALID BIT15 +#define CAM_NOTVALID 0x0000 +#define CAM_USEDK BIT5 + -+#define CAM_CONTENT_COUNT 8 ++#define CAM_CONTENT_COUNT 8 + +#define CAM_NONE 0x0 +#define CAM_WEP40 0x01 @@ -303360,30 +133438,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define CAM_AES 0x04 +#define CAM_WEP104 0x05 +#define CAM_SMS4 0x6 -+ ++ +#define TOTAL_CAM_ENTRY 32 -+#define HALF_CAM_ENTRY 16 -+ -+#define CAM_CONFIG_USEDK _TRUE -+#define CAM_CONFIG_NO_USEDK _FALSE ++#define HALF_CAM_ENTRY 16 ++ ++#define CAM_CONFIG_USEDK true ++#define CAM_CONFIG_NO_USEDK false + +#define CAM_WRITE BIT16 +#define CAM_READ 0x00000000 +#define CAM_POLLINIG BIT31 + ++#define SCR_UseDK 0x01 ++#define SCR_TxSecEnable 0x02 ++#define SCR_RxSecEnable 0x04 ++ +// -+// 10. Power Save Control Registers ++// 10. Power Save Control Registers +// +#define WOW_PMEN BIT0 // Power management Enable. -+#define WOW_WOMEN BIT1 // WoW function on or off. ++#define WOW_WOMEN BIT1 // WoW function on or off. +#define WOW_MAGIC BIT2 // Magic packet +#define WOW_UWF BIT3 // Unicast Wakeup frame. + +// -+// 12. Host Interrupt Status Registers ++// 12. Host Interrupt Status Registers +// +//---------------------------------------------------------------------------- -+// 8190 IMR/ISR bits ++// 8190 IMR/ISR bits +//---------------------------------------------------------------------------- +#define IMR8190_DISABLED 0x0 +#define IMR_DISABLED 0x0 @@ -303405,7 +133487,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define IMR_TIMEOUT2 BIT17 // Timeout interrupt 2 +#define IMR_TIMEOUT1 BIT16 // Timeout interrupt 1 +#define IMR_TXFOVW BIT15 // Transmit FIFO Overflow -+#define IMR_PSTIMEOUT BIT14 // Power save time out interrupt ++#define IMR_PSTIMEOUT BIT14 // Power save time out interrupt +#define IMR_BcnInt BIT13 // Beacon DMA Interrupt 0 +#define IMR_RXFOVW BIT12 // Receive FIFO Overflow +#define IMR_RDU BIT11 // Receive Descriptor Unavailable @@ -303545,33 +133627,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define HAL_NIC_UNPLUG_PCI_ISR 0xEAEAEAEA // The value when the NIC is unplugged for PCI in PCI interrupt (page 3). + +//---------------------------------------------------------------------------- -+// 8188 IMR/ISR bits ++// 8188 IMR/ISR bits +//---------------------------------------------------------------------------- +#define IMR_DISABLED_88E 0x0 +// IMR DW0(0x0060-0063) Bit 0-31 -+#define IMR_TXCCK_88E BIT30 // TXRPT interrupt when CCX bit of the packet is set ++#define IMR_TXCCK_88E BIT30 // TXRPT interrupt when CCX bit of the packet is set +#define IMR_PSTIMEOUT_88E BIT29 // Power Save Time Out Interrupt -+#define IMR_GTINT4_88E BIT28 // When GTIMER4 expires, this bit is set to 1 -+#define IMR_GTINT3_88E BIT27 // When GTIMER3 expires, this bit is set to 1 -+#define IMR_TBDER_88E BIT26 // Transmit Beacon0 Error -+#define IMR_TBDOK_88E BIT25 // Transmit Beacon0 OK -+#define IMR_TSF_BIT32_TOGGLE_88E BIT24 // TSF Timer BIT32 toggle indication interrupt -+#define IMR_BCNDMAINT0_88E BIT20 // Beacon DMA Interrupt 0 ++#define IMR_GTINT4_88E BIT28 // When GTIMER4 expires, this bit is set to 1 ++#define IMR_GTINT3_88E BIT27 // When GTIMER3 expires, this bit is set to 1 ++#define IMR_TBDER_88E BIT26 // Transmit Beacon0 Error ++#define IMR_TBDOK_88E BIT25 // Transmit Beacon0 OK ++#define IMR_TSF_BIT32_TOGGLE_88E BIT24 // TSF Timer BIT32 toggle indication interrupt ++#define IMR_BCNDMAINT0_88E BIT20 // Beacon DMA Interrupt 0 +#define IMR_BCNDERR0_88E BIT16 // Beacon Queue DMA Error 0 -+#define IMR_HSISR_IND_ON_INT_88E BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) -+#define IMR_BCNDMAINT_E_88E BIT14 // Beacon DMA Interrupt Extension for Win7 ++#define IMR_HSISR_IND_ON_INT_88E BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) ++#define IMR_BCNDMAINT_E_88E BIT14 // Beacon DMA Interrupt Extension for Win7 +#define IMR_ATIMEND_88E BIT12 // CTWidnow End or ATIM Window End +#define IMR_HISR1_IND_INT_88E BIT11 // HISR1 Indicator (HISR1 & HIMR1 is true, this bit is set to 1) -+#define IMR_C2HCMD_88E BIT10 // CPU to Host Command INT Status, Write 1 clear -+#define IMR_CPWM2_88E BIT9 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_CPWM_88E BIT8 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_HIGHDOK_88E BIT7 // High Queue DMA OK -+#define IMR_MGNTDOK_88E BIT6 // Management Queue DMA OK -+#define IMR_BKDOK_88E BIT5 // AC_BK DMA OK -+#define IMR_BEDOK_88E BIT4 // AC_BE DMA OK -+#define IMR_VIDOK_88E BIT3 // AC_VI DMA OK -+#define IMR_VODOK_88E BIT2 // AC_VO DMA OK -+#define IMR_RDU_88E BIT1 // Rx Descriptor Unavailable ++#define IMR_C2HCMD_88E BIT10 // CPU to Host Command INT Status, Write 1 clear ++#define IMR_CPWM2_88E BIT9 // CPU power Mode exchange INT Status, Write 1 clear ++#define IMR_CPWM_88E BIT8 // CPU power Mode exchange INT Status, Write 1 clear ++#define IMR_HIGHDOK_88E BIT7 // High Queue DMA OK ++#define IMR_MGNTDOK_88E BIT6 // Management Queue DMA OK ++#define IMR_BKDOK_88E BIT5 // AC_BK DMA OK ++#define IMR_BEDOK_88E BIT4 // AC_BE DMA OK ++#define IMR_VIDOK_88E BIT3 // AC_VI DMA OK ++#define IMR_VODOK_88E BIT2 // AC_VO DMA OK ++#define IMR_RDU_88E BIT1 // Rx Descriptor Unavailable +#define IMR_ROK_88E BIT0 // Receive DMA OK + +// IMR DW1(0x00B4-00B7) Bit 0-31 @@ -303597,7 +133679,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl + +/*=================================================================== +===================================================================== -+Here the register defines are for 92C. When the define is as same with 92C, ++Here the register defines are for 92C. When the define is as same with 92C, +we will use the 92C's define for the consistency +So the following defines for 92C is not entire!!!!!! +===================================================================== @@ -303617,7 +133699,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +0x2000h ~ 0x3FFFh 8051 FW Download Region (8196 Bytes) +*/ + //---------------------------------------------------------------------------- -+ // 8192C (TXPAUSE) transmission pause (Offset 0x522, 8 bits) ++ // 8192C (TXPAUSE) transmission pause (Offset 0x522, 8 bits) + //---------------------------------------------------------------------------- +// Note: +// The the bits of stoping AC(VO/VI/BE/BK) queue in datasheet RTL8192S/RTL8192C are wrong, @@ -303636,37 +133718,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +// 8192C (RCR) Receive Configuration Register (Offset 0x608, 32 bits) +//---------------------------------------------------------------------------- +#define RCR_APPFCS BIT31 // WMAC append FCS after pauload -+#define RCR_APP_MIC BIT30 // MACRX will retain the MIC at the bottom of the packet. ++#define RCR_APP_MIC BIT30 // MACRX will retain the MIC at the bottom of the packet. +#define RCR_APP_ICV BIT29 // MACRX will retain the ICV at the bottom of the packet. +#define RCR_APP_PHYST_RXFF BIT28 // PHY Status is appended before RX packet in RXFF +#define RCR_APP_BA_SSN BIT27 // SSN of previous TXBA is appended as after original RXDESC as the 4-th DW of RXDESC. -+#define RCR_VHT_DACK BIT26 /* This bit to control response type for vht single mpdu data packet. 1. ACK as response 0. BA as response */ -+#define RCR_TCPOFLD_EN BIT25 /* Enable TCP checksum offload */ ++#define RCR_NONQOS_VHT BIT26 // Reserved ++#define RCR_RSVD_BIT25 BIT25 // Reserved +#define RCR_ENMBID BIT24 // Enable Multiple BssId. Only response ACK to the packets whose DID(A1) matching to the addresses in the MBSSID CAM Entries. +#define RCR_LSIGEN BIT23 // Enable LSIG TXOP Protection function. Search KEYCAM for each rx packet to check if LSIGEN bit is set. +#define RCR_MFBEN BIT22 // Enable immediate MCS Feedback function. When Rx packet with MRQ = 1'b1, then search KEYCAM to find sender's MCS Feedback function and send response. -+#define RCR_DISCHKPPDLLEN BIT21 /* Do not check PPDU while the PPDU length is smaller than 14 byte. */ -+#define RCR_PKTCTL_DLEN BIT20 /* While rx path dead lock occurs, reset rx path */ -+#define RCR_DISGCLK BIT19 /* Disable macrx clock gating control (no used) */ ++#define RCR_RSVD_BIT21 BIT21 // Reserved ++#define RCR_RSVD_BIT20 BIT20 // Reserved ++#define RCR_RSVD_BIT19 BIT19 // Reserved +#define RCR_TIM_PARSER_EN BIT18 // RX Beacon TIM Parser. -+#define RCR_BC_MD_EN BIT17 /* Broadcast data packet more data bit check interrupt enable.*/ -+#define RCR_UC_MD_EN BIT16 /* Unicast data packet more data bit check interrupt enable. */ -+#define RCR_RXSK_PERPKT BIT15 /* Executing key search per MPDU */ ++#define RCR_BM_DATA_EN BIT17 // Broadcast data packet interrupt enable. ++#define RCR_UC_DATA_EN BIT16 // Unicast data packet interrupt enable. ++#define RCR_RSVD_BIT15 BIT15 // Reserved +#define RCR_HTC_LOC_CTRL BIT14 // MFC<--HTC=1 MFC-->HTC=0 +#define RCR_AMF BIT13 // Accept management type frame +#define RCR_ACF BIT12 // Accept control type frame. Control frames BA, BAR, and PS-Poll (when in AP mode) are not controlled by this bit. They are controlled by ADF. +#define RCR_ADF BIT11 // Accept data type frame. This bit also regulates BA, BAR, and PS-Poll (AP mode only). -+#define RCR_DISDECMYPKT BIT10 /* This bit determines whether hw need to do decryption.1: If A1 match, do decryption.0: Do decryption. */ ++#define RCR_RSVD_BIT10 BIT10 // Reserved +#define RCR_AICV BIT9 // Accept ICV error packet -+#define RCR_ACRC32 BIT8 // Accept CRC32 error packet ++#define RCR_ACRC32 BIT8 // Accept CRC32 error packet +#define RCR_CBSSID_BCN BIT7 // Accept BSSID match packet (Rx beacon, probe rsp) +#define RCR_CBSSID_DATA BIT6 // Accept BSSID match packet (Data) ++#define RCR_CBSSID RCR_CBSSID_DATA // Accept BSSID match packet +#define RCR_APWRMGT BIT5 // Accept power management packet +#define RCR_ADD3 BIT4 // Accept address 3 match packet -+#define RCR_AB BIT3 // Accept broadcast packet -+#define RCR_AM BIT2 // Accept multicast packet ++#define RCR_AB BIT3 // Accept broadcast packet ++#define RCR_AM BIT2 // Accept multicast packet +#define RCR_APM BIT1 // Accept physical match packet -+#define RCR_AAP BIT0 // Accept all unicast packet ++#define RCR_AAP BIT0 // Accept all unicast packet + + +//----------------------------------------------------- @@ -303703,7 +133786,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define FEN_CPUEN BIT(10) +#define FEN_DCORE BIT(11) +#define FEN_ELDR BIT(12) -+#define FEN_EN_25_1 BIT(13) ++//#define FEN_DIO_RF BIT(13) +#define FEN_HWPDN BIT(14) +#define FEN_MREGEN BIT(15) + @@ -303785,7 +133868,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define RFINI_RDY BIT(5) +#define WINTINI_RDY BIT(6) +#define RAM_DL_SEL BIT(7) -+#define CPU_DL_READY BIT(15) /* add flag by gw for fw download ready 20130826 */ +#define ROM_DLEN BIT(19) +#define CPRST BIT(23) + @@ -303825,7 +133907,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +//2 REG_GPIO_OUTSTS (For RTL8723 only) +#define EFS_HCI_SEL (BIT(0)|BIT(1)) +#define PAD_HCI_SEL (BIT(2)|BIT(3)) -+#define HCI_SEL (BIT(4)|BIT(5)) ++#define HCI_SEL (BIT(4)|BIT(5)) +#define PKG_SEL_HCI BIT(6) +#define FEN_GPS BIT(7) +#define FEN_BT BIT(8) @@ -303907,13 +133989,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define HQSEL_HIQ BIT(5) + +// For normal driver, 0x10C -+#define _TXDMA_CMQ_MAP(x) (((x)&0x3) << 16) -+#define _TXDMA_HIQ_MAP(x) (((x)&0x3) << 14) -+#define _TXDMA_MGQ_MAP(x) (((x)&0x3) << 12) -+#define _TXDMA_BKQ_MAP(x) (((x)&0x3) << 10) -+#define _TXDMA_BEQ_MAP(x) (((x)&0x3) << 8 ) -+#define _TXDMA_VIQ_MAP(x) (((x)&0x3) << 6 ) -+#define _TXDMA_VOQ_MAP(x) (((x)&0x3) << 4 ) ++#define _TXDMA_CMQ_MAP(x) (((x)&0x3) << 16) ++#define _TXDMA_HIQ_MAP(x) (((x)&0x3) << 14) ++#define _TXDMA_MGQ_MAP(x) (((x)&0x3) << 12) ++#define _TXDMA_BKQ_MAP(x) (((x)&0x3) << 10) ++#define _TXDMA_BEQ_MAP(x) (((x)&0x3) << 8 ) ++#define _TXDMA_VIQ_MAP(x) (((x)&0x3) << 6 ) ++#define _TXDMA_VOQ_MAP(x) (((x)&0x3) << 4 ) + +#define QUEUE_EXTRA 0 +#define QUEUE_LOW 1 @@ -303961,19 +134043,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +//2 TXDMA_OFFSET_CHK +#define DROP_DATA_EN BIT(9) + -+//2 AUTO_LLT -+#define BIT_SHIFT_TXPKTNUM 24 -+#define BIT_MASK_TXPKTNUM 0xff -+#define BIT_TXPKTNUM(x) (((x) & BIT_MASK_TXPKTNUM) << BIT_SHIFT_TXPKTNUM) -+ -+#define BIT_TDE_DBG_SEL BIT(23) -+#define BIT_AUTO_INIT_LLT BIT(16) -+ -+#define BIT_SHIFT_Tx_OQT_free_space 8 -+#define BIT_MASK_Tx_OQT_free_space 0xff -+#define BIT_Tx_OQT_free_space(x) (((x) & BIT_MASK_Tx_OQT_free_space) << BIT_SHIFT_Tx_OQT_free_space) -+ -+ +//----------------------------------------------------- +// +// 0x0280h ~ 0x028Bh RX DMA Configuration @@ -303984,15 +134053,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +// Write only. When this bit is set, RXDMA will decrease RX PKT counter by one. Before +// this bit is polled, FW shall update RXFF_RD_PTR first. This register is write pulse and auto clear. +//#define RXPKT_RELEASE_POLL BIT(0) -+// Read only. When RXMA finishes on-going DMA operation, RXMDA will report idle state in ++// Read only. When RXMA finishes on-going DMA operation, RXMDA will report idle state in +// this bit. FW can start releasing packets after RXDMA entering idle mode. +//#define RXDMA_IDLE BIT(1) -+// When this bit is set, RXDMA will enter this mode after on-going RXDMA packet to host ++// When this bit is set, RXDMA will enter this mode after on-going RXDMA packet to host +// completed, and stop DMA packet to host. RXDMA will then report Default: 0; +//#define RW_RELEASE_EN BIT(2) + +//2 REG_RXPKT_NUM, 0x0284 -+#define RXPKT_RELEASE_POLL BIT(16) ++#define RXPKT_RELEASE_POLL BIT(16) +#define RXDMA_IDLE BIT(17) +#define RW_RELEASE_EN BIT(18) + @@ -304119,12 +134188,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define SCR_NoSKMC BIT(5) //No Key Search Multicast +#define SCR_TXBCUSEDK BIT(6) // Force Tx Broadcast packets Use Default Key +#define SCR_RXBCUSEDK BIT(7) // Force Rx Broadcast packets Use Default Key -+#define SCR_CHK_KEYID BIT(8) -+#define SCR_CHK_BMC BIT(9) /* add option to support a2+keyid+bcm */ + +//----------------------------------------------------- +// -+// SDIO Bus Specification ++// 0xFE00h ~ 0xFE55h RTL8723 SDIO Configuration +// +//----------------------------------------------------- + @@ -304135,29 +134202,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define TX_HIQ_BASE 0x10310000 +#define TX_MIQ_BASE 0x10320000 +#define TX_LOQ_BASE 0x10330000 -+#define TX_EPQ_BASE 0x10350000 +#define RX_RX0FF_BASE 0x10340000 + +//SDIO host local register space mapping. +#define SDIO_LOCAL_MSK 0x0FFF -+#define WLAN_IOREG_MSK 0x7FFF -+#define WLAN_FIFO_MSK 0x1FFF // Aggregation Length[12:0] -+#define WLAN_RX0FF_MSK 0x0003 ++#define WLAN_IOREG_MSK 0x7FFF ++#define WLAN_FIFO_MSK 0x1FFF // Aggregation Length[12:0] ++#define WLAN_RX0FF_MSK 0x0003 + +#define SDIO_WITHOUT_REF_DEVICE_ID 0 // Without reference to the SDIO Device ID -+#define SDIO_LOCAL_DEVICE_ID 0 // 0b[16], 000b[15:13] ++#define SDIO_LOCAL_DEVICE_ID 0 // 0b[16], 000b[15:13] +#define WLAN_TX_HIQ_DEVICE_ID 4 // 0b[16], 100b[15:13] -+#define WLAN_TX_MIQ_DEVICE_ID 5 // 0b[16], 101b[15:13] -+#define WLAN_TX_LOQ_DEVICE_ID 6 // 0b[16], 110b[15:13] -+#define WLAN_TX_EXQ_DEVICE_ID 3 // 0b[16], 011b[15:13] -+#define WLAN_RX0FF_DEVICE_ID 7 // 0b[16], 111b[15:13] -+#define WLAN_IOREG_DEVICE_ID 8 // 1b[16] ++#define WLAN_TX_MIQ_DEVICE_ID 5 // 0b[16], 101b[15:13] ++#define WLAN_TX_LOQ_DEVICE_ID 6 // 0b[16], 110b[15:13] ++#define WLAN_RX0FF_DEVICE_ID 7 // 0b[16], 111b[15:13] ++#define WLAN_IOREG_DEVICE_ID 8 // 1b[16] + +//SDIO Tx Free Page Index -+#define HI_QUEUE_IDX 0 -+#define MID_QUEUE_IDX 1 -+#define LOW_QUEUE_IDX 2 -+#define PUBLIC_QUEUE_IDX 3 ++#define HI_QUEUE_IDX 0 ++#define MID_QUEUE_IDX 1 ++#define LOW_QUEUE_IDX 2 ++#define PUBLIC_QUEUE_IDX 3 + +#define SDIO_MAX_TX_QUEUE 3 // HIQ, MIQ and LOQ +#define SDIO_MAX_RX_QUEUE 1 @@ -304167,11 +134232,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl +#define SDIO_REG_HISR 0x0018 // SDIO Host Interrupt Service Routine +#define SDIO_REG_HCPWM 0x0019 // HCI Current Power Mode +#define SDIO_REG_RX0_REQ_LEN 0x001C // RXDMA Request Length -+#define SDIO_REG_OQT_FREE_PG 0x001E // OQT Free Page +#define SDIO_REG_FREE_TXPG 0x0020 // Free Tx Buffer Page +#define SDIO_REG_HCPWM1 0x0024 // HCI Current Power Mode 1 +#define SDIO_REG_HCPWM2 0x0026 // HCI Current Power Mode 2 -+#define SDIO_REG_FREE_TXPG_SEQ 0x0028 // Free Tx Page Sequence +#define SDIO_REG_HTSFR_INFO 0x0030 // HTSF Informaion +#define SDIO_REG_HRPWM1 0x0080 // HCI Request Power Mode 1 +#define SDIO_REG_HRPWM2 0x0082 // HCI Request Power Mode 2 @@ -304255,14 +134318,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl + +// SDIO Tx FIFO related +#define SDIO_TX_FREE_PG_QUEUE 4 // The number of Tx FIFO free page -+#define SDIO_TX_FIFO_PAGE_SZ 128 ++#define SDIO_TX_FIFO_PAGE_SZ 128 + -+#ifdef CONFIG_SDIO_HCI -+ #define MAX_TX_AGG_PACKET_NUMBER 0x8 -+#else -+ #define MAX_TX_AGG_PACKET_NUMBER 0xFF -+ #define MAX_TX_AGG_PACKET_NUMBER_8812 64 -+#endif ++#define MAX_TX_AGG_PACKET_NUMBER 0xFF ++#define MAX_TX_AGG_PACKET_NUMBER_8812 64 + +//----------------------------------------------------- +// @@ -304313,48 +134372,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_com_reg.h linux/3rdparty/rtl + +//2 8192D PartNo. +#define PARTNO_92D_NIC (BIT7|BIT6) -+#define PARTNO_92D_NIC_REMARK (BIT5|BIT4) -+#define PARTNO_SINGLE_BAND_VS BIT3 -+#define PARTNO_SINGLE_BAND_VS_REMARK BIT1 -+#define PARTNO_CONCURRENT_BAND_VC (BIT3|BIT2) -+#define PARTNO_CONCURRENT_BAND_VC_REMARK (BIT1|BIT0) ++#define PARTNO_92D_NIC_REMARK (BIT5|BIT4) ++#define PARTNO_SINGLE_BAND_VS BIT3 ++#define PARTNO_SINGLE_BAND_VS_REMARK BIT1 ++#define PARTNO_CONCURRENT_BAND_VC (BIT3|BIT2) ++#define PARTNO_CONCURRENT_BAND_VC_REMARK (BIT1|BIT0) + +//======================================================== +// General definitions +//======================================================== + -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8188E(__Adapter) ( IS_VENDOR_8188E_I_CUT_SERIES(__Adapter) ? 255 : 175 ) ++#define LAST_ENTRY_OF_TX_PKT_BUFFER_8188E 176 +#define LAST_ENTRY_OF_TX_PKT_BUFFER_8812 255 +#define LAST_ENTRY_OF_TX_PKT_BUFFER_8723B 255 +#define LAST_ENTRY_OF_TX_PKT_BUFFER_8192C 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8703B 255 +#define LAST_ENTRY_OF_TX_PKT_BUFFER_DUAL_MAC 127 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8188F 255 + +#define POLLING_LLT_THRESHOLD 20 -+#if defined(CONFIG_RTL8723B) && defined(CONFIG_PCI_HCI) -+#define POLLING_READY_TIMEOUT_COUNT 6000 -+#else +#define POLLING_READY_TIMEOUT_COUNT 1000 -+#endif -+ + +// GPIO BIT -+#define HAL_8812A_HW_GPIO_WPS_BIT BIT2 -+#define HAL_8192C_HW_GPIO_WPS_BIT BIT2 -+#define HAL_8192EU_HW_GPIO_WPS_BIT BIT7 -+#define HAL_8188E_HW_GPIO_WPS_BIT BIT7 ++#define HAL_8192C_HW_GPIO_WPS_BIT BIT2 + +#endif //__HAL_COMMON_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_data.h linux/3rdparty/rtl8812au/include/hal_data.h ---- linux.old/3rdparty/rtl8812au/include/hal_data.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_data.h 2017-06-07 23:07:21.037689945 +0300 -@@ -0,0 +1,630 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_data.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_data.h +--- linux-4.14.17/3rdparty/rtl8812au/include/hal_data.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_data.h 2018-02-06 17:42:30.718967283 +0200 +@@ -0,0 +1,490 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -304364,49 +134412,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_data.h linux/3rdparty/rtl881 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __HAL_DATA_H__ +#define __HAL_DATA_H__ + +#if 1//def CONFIG_SINGLE_IMG + -+#include "../hal/phydm/phydm_precomp.h" -+#ifdef CONFIG_BT_COEXIST -+#include -+#endif ++#include "../hal/odm_precomp.h" + -+#ifdef CONFIG_SDIO_HCI -+#include -+#endif -+#ifdef CONFIG_GSPI_HCI -+#include -+#endif +// +// For RTL8723 WiFi/BT/GPS multi-function configuration. 2010.10.06. +// +typedef enum _RT_MULTI_FUNC{ + RT_MULTI_FUNC_NONE = 0x00, -+ RT_MULTI_FUNC_WIFI = 0x01, -+ RT_MULTI_FUNC_BT = 0x02, -+ RT_MULTI_FUNC_GPS = 0x04, ++ RT_MULTI_FUNC_WIFI = 0x01, ++ RT_MULTI_FUNC_BT = 0x02, ++ RT_MULTI_FUNC_GPS = 0x04, +}RT_MULTI_FUNC,*PRT_MULTI_FUNC; +// +// For RTL8723 WiFi PDn/GPIO polarity control configuration. 2010.10.08. +// +typedef enum _RT_POLARITY_CTL { -+ RT_POLARITY_LOW_ACT = 0, -+ RT_POLARITY_HIGH_ACT = 1, ++ RT_POLARITY_LOW_ACT = 0, ++ RT_POLARITY_HIGH_ACT = 1, +} RT_POLARITY_CTL, *PRT_POLARITY_CTL; + +// For RTL8723 regulator mode. by tynli. 2011.01.14. +typedef enum _RT_REGULATOR_MODE { -+ RT_SWITCHING_REGULATOR = 0, -+ RT_LDO_REGULATOR = 1, ++ RT_SWITCHING_REGULATOR = 0, ++ RT_LDO_REGULATOR = 1, +} RT_REGULATOR_MODE, *PRT_REGULATOR_MODE; + +// @@ -304420,54 +134454,57 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_data.h linux/3rdparty/rtl881 + + +typedef enum _INTERFACE_SELECT_USB{ -+ INTF_SEL0_USB = 0, // USB -+ INTF_SEL1_USB_High_Power = 1, // USB with high power PA -+ INTF_SEL2_MINICARD = 2, // Minicard -+ INTF_SEL3_USB_Solo = 3, // USB solo-Slim module ++ INTF_SEL0_USB = 0, // USB ++ INTF_SEL1_USB_High_Power = 1, // USB with high power PA ++ INTF_SEL2_MINICARD = 2, // Minicard ++ INTF_SEL3_USB_Solo = 3, // USB solo-Slim module + INTF_SEL4_USB_Combo = 4, // USB Combo-Slim module + INTF_SEL5_USB_Combo_MF = 5, // USB WiFi+BT Multi-Function Combo, i.e., Proprietary layout(AS-VAU) which is the same as SDIO card +} INTERFACE_SELECT_USB, *PINTERFACE_SELECT_USB; + +typedef enum _RT_AMPDU_BRUST_MODE{ -+ RT_AMPDU_BRUST_NONE = 0, -+ RT_AMPDU_BRUST_92D = 1, -+ RT_AMPDU_BRUST_88E = 2, -+ RT_AMPDU_BRUST_8812_4 = 3, -+ RT_AMPDU_BRUST_8812_8 = 4, -+ RT_AMPDU_BRUST_8812_12 = 5, ++ RT_AMPDU_BRUST_NONE = 0, ++ RT_AMPDU_BRUST_92D = 1, ++ RT_AMPDU_BRUST_88E = 2, ++ RT_AMPDU_BRUST_8812_4 = 3, ++ RT_AMPDU_BRUST_8812_8 = 4, ++ RT_AMPDU_BRUST_8812_12 = 5, + RT_AMPDU_BRUST_8812_15 = 6, -+ RT_AMPDU_BRUST_8723B = 7, ++ RT_AMPDU_BRUST_8723B = 7, +}RT_AMPDU_BRUST,*PRT_AMPDU_BRUST_MODE; + -+/* +#define CHANNEL_MAX_NUMBER 14+24+21 // 14 is the max channel number -+*/ -+#define CHANNEL_GROUP_MAX (3 + 9) /* ch1~3, ch4~9, ch10~14 total three groups */ -+#define MAX_PG_GROUP 13 ++#define CHANNEL_MAX_NUMBER_2G 14 ++#define CHANNEL_MAX_NUMBER_5G 54 // Please refer to "phy_GetChnlGroup8812A" and "Hal_ReadTxPowerInfo8812A" ++#define CHANNEL_MAX_NUMBER_5G_80M 7 ++#define CHANNEL_GROUP_MAX 3+9 // ch1~3, ch4~9, ch10~14 total three groups ++#define MAX_PG_GROUP 13 + -+// Tx Power Limit Table Size -+#define MAX_REGULATION_NUM 4 ++#define MAX_REGULATION_NUM 3 +#define MAX_RF_PATH_NUM_IN_POWER_LIMIT_TABLE 4 -+#define MAX_2_4G_BANDWIDTH_NUM 2 -+#define MAX_RATE_SECTION_NUM 10 -+#define MAX_5G_BANDWIDTH_NUM 4 ++#define MAX_2_4G_BANDWITH_NUM 2 ++#define MAX_2_4G_RATE_SECTION_NUM 3 ++#define MAX_2_4G_CHANNEL_NUM 5 // adopt channel group instead of individual channel ++#define MAX_5G_BANDWITH_NUM 4 ++#define MAX_5G_RATE_SECTION_NUM 4 ++#define MAX_5G_CHANNEL_NUM 14 // adopt channel group instead of individual channel + -+#define MAX_BASE_NUM_IN_PHY_REG_PG_2_4G 10 // CCK:1,OFDM:1, HT:4, VHT:4 -+#define MAX_BASE_NUM_IN_PHY_REG_PG_5G 9 // OFDM:1, HT:4, VHT:4 ++#define MAX_BASE_NUM_IN_PHY_REG_PG_2_4G 4 // CCK:1,OFDM:2, HT:2 ++#define MAX_BASE_NUM_IN_PHY_REG_PG_5G 5 // OFDM:1, HT:2, VHT:2 + + +//###### duplicate code,will move to ODM ######### -+//#define IQK_MAC_REG_NUM 4 -+//#define IQK_ADDA_REG_NUM 16 ++#define IQK_MAC_REG_NUM 4 ++#define IQK_ADDA_REG_NUM 16 + -+//#define IQK_BB_REG_NUM 10 ++#define IQK_BB_REG_NUM 10 +#define IQK_BB_REG_NUM_92C 9 +#define IQK_BB_REG_NUM_92D 10 +#define IQK_BB_REG_NUM_test 6 + +#define IQK_Matrix_Settings_NUM_92D 1+24+21 + -+//#define HP_THERMAL_NUM 8 ++#define HP_THERMAL_NUM 8 +//###### duplicate code,will move to ODM ######### + +#ifdef CONFIG_USB_RX_AGGREGATION @@ -304478,68 +134515,96 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_data.h linux/3rdparty/rtl881 + USB_RX_AGG_MIX +}USB_RX_AGG_MODE; + -+//#define MAX_RX_DMA_BUFFER_SIZE 10240 // 10K for 8192C RX DMA buffer -+ +#endif + -+/* For store initial value of BB register */ -+typedef struct _BB_INIT_REGISTER { -+ u16 offset; -+ u32 value; ++struct dm_priv ++{ ++ u8 DM_Type; ++ u8 DMFlag; ++ u8 InitDMFlag; ++ //u8 RSVD_1; + -+} BB_INIT_REGISTER, *PBB_INIT_REGISTER; ++ u32 InitODMFlag; ++ //* Upper and Lower Signal threshold for Rate Adaptive*/ ++ int UndecoratedSmoothedPWDB; ++ int UndecoratedSmoothedCCK; ++ int EntryMinUndecoratedSmoothedPWDB; ++ int EntryMaxUndecoratedSmoothedPWDB; ++ int MinUndecoratedPWDBForDM; ++ int LastMinUndecoratedPWDBForDM; + -+#define PAGE_SIZE_128 128 -+#define PAGE_SIZE_256 256 -+#define PAGE_SIZE_512 512 ++ s32 UndecoratedSmoothedBeacon; ++ #ifdef CONFIG_BT_COEXIST ++ s32 BT_EntryMinUndecoratedSmoothedPWDB; ++ s32 BT_EntryMaxUndecoratedSmoothedPWDB; ++ #endif + -+#define HCI_SUS_ENTER 0 -+#define HCI_SUS_LEAVING 1 -+#define HCI_SUS_LEAVE 2 -+#define HCI_SUS_ENTERING 3 -+#define HCI_SUS_ERR 4 ++//###### duplicate code,will move to ODM ######### ++ //for High Power ++ u8 bDynamicTxPowerEnable; ++ u8 LastDTPLvl; ++ u8 DynamicTxHighPowerLvl;//Add by Jacken Tx Power Control for Near/Far Range 2008/03/06 + -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+typedef enum _ACS_OP { -+ ACS_INIT, /*ACS - Variable init*/ -+ ACS_RESET, /*ACS - NHM Counter reset*/ -+ ACS_SELECT, /*ACS - NHM Counter Statistics */ -+} ACS_OP; ++ //for tx power tracking ++ u8 bTXPowerTracking; ++ u8 TXPowercount; ++ u8 bTXPowerTrackingInit; ++ u8 TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default ++ u8 TM_Trigger; + -+typedef enum _ACS_STATE { -+ ACS_DISABLE, -+ ACS_ENABLE, -+} ACS_STATE; ++ u8 ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 ++ u8 ThermalValue; ++ u8 ThermalValue_LCK; ++ u8 ThermalValue_IQK; ++ u8 ThermalValue_DPK; ++ u8 bRfPiEnable; ++ //u8 RSVD_2; + -+struct auto_chan_sel { -+ ATOMIC_T state; -+ u8 ch; /* previous channel*/ -+}; -+#endif /*CONFIG_AUTO_CHNL_SEL_NHM*/ ++ //for APK ++ u32 APKoutput[2][2]; //path A/B; output1_1a/output1_2a ++ u8 bAPKdone; ++ u8 bAPKThermalMeterIgnore; ++ u8 bDPdone; ++ u8 bDPPathAOK; ++ u8 bDPPathBOK; ++ //u8 RSVD_3; ++ //u8 RSVD_4; ++ //u8 RSVD_5; + -+#define EFUSE_FILE_UNUSED 0 -+#define EFUSE_FILE_FAILED 1 -+#define EFUSE_FILE_LOADED 2 ++ //for IQK ++ u32 ADDA_backup[IQK_ADDA_REG_NUM]; ++ u32 IQK_MAC_backup[IQK_MAC_REG_NUM]; ++ u32 IQK_BB_backup_recover[9]; ++ u32 IQK_BB_backup[IQK_BB_REG_NUM]; + -+#define MACADDR_FILE_UNUSED 0 -+#define MACADDR_FILE_FAILED 1 -+#define MACADDR_FILE_LOADED 2 ++ u8 PowerIndex_backup[6]; ++ u8 OFDM_index[2]; + -+#define KFREE_FLAG_ON BIT0 -+#define KFREE_FLAG_THERMAL_K_ON BIT1 ++ u8 bCCKinCH14; ++ u8 CCK_index; ++ u8 bDoneTxpower; ++ u8 CCK_index_HP; + -+struct kfree_data_t { -+ u8 flag; -+ s8 bb_gain[BB_GAIN_NUM][RF_PATH_MAX]; ++ u8 OFDM_index_HP[2]; ++ u8 ThermalValue_HP[HP_THERMAL_NUM]; ++ u8 ThermalValue_HP_index; ++ //u8 RSVD_6; + -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ s8 pa_bias_5g[RF_PATH_MAX]; -+ s8 pad_bias_5g[RF_PATH_MAX]; -+#endif -+ s8 thermal; ++ //for TxPwrTracking2 ++ s32 RegE94; ++ s32 RegE9C; ++ s32 RegEB4; ++ s32 RegEBC; ++ ++ u32 TXPowerTrackingCallbackCnt; //cosa add for debug ++ ++ u32 prv_traffic_idx; // edca turbo ++//###### duplicate code,will move to ODM ######### ++ ++ // Add for Reading Initial Data Rate SEL Register 0x484 during watchdog. Using for fill tx desc. 2011.3.21 by Thomas ++ u8 INIDATA_RATE[32]; +}; + -+bool kfree_data_is_bb_gain_empty(struct kfree_data_t *data); + +typedef struct hal_com_data +{ @@ -304547,111 +134612,76 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_data.h linux/3rdparty/rtl881 + RT_MULTI_FUNC MultiFunc; // For multi-function consideration. + RT_POLARITY_CTL PolarityCtl; // For Wifi PDn Polarity control. + RT_REGULATOR_MODE RegulatorMode; // switching regulator or LDO -+ u8 hw_init_completed; -+ /****** FW related ******/ ++ + u16 FirmwareVersion; + u16 FirmwareVersionRev; + u16 FirmwareSubVersion; + u16 FirmwareSignature; -+ u8 RegFWOffload; -+ u8 fw_ractrl; -+ u8 FwRsvdPageStartOffset; /* 2010.06.23. Added by tynli. Reserve page start offset except beacon in TxQ.*/ -+ u8 LastHMEBoxNum; /* H2C - for host message to fw */ + -+ /****** current WIFI_PHY values ******/ -+ WIRELESS_MODE CurrentWirelessMode; ++ //current WIFI_PHY values ++ WIRELESS_MODE CurrentWirelessMode; + CHANNEL_WIDTH CurrentChannelBW; -+ BAND_TYPE CurrentBandType; /* 0:2.4G, 1:5G */ -+ BAND_TYPE BandSet; -+ u8 CurrentChannel; -+ u8 CurrentCenterFrequencyIndex1; -+ u8 nCur40MhzPrimeSC; /* Control channel sub-carrier */ -+ u8 nCur80MhzPrimeSC; /* used for primary 40MHz of 80MHz mode */ -+ BOOLEAN bSwChnlAndSetBWInProgress; -+ u8 bDisableSWChannelPlan; /* flag of disable software change channel plan */ -+ u16 BasicRateSet; -+ u32 ReceiveConfig; -+ BOOLEAN bSwChnl; -+ BOOLEAN bSetChnlBW; -+ BOOLEAN bChnlBWInitialized; -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ struct auto_chan_sel acs; -+#endif -+ /****** rf_ctrl *****/ ++ BAND_TYPE CurrentBandType; //0:2.4G, 1:5G ++ BAND_TYPE BandSet; ++ u8 CurrentChannel; ++ u8 CurrentCenterFrequencyIndex1; ++ u8 nCur40MhzPrimeSC;// Control channel sub-carrier ++ u8 nCur80MhzPrimeSC; //used for primary 40MHz of 80MHz mode ++ ++ u16 CustomerID; ++ u16 BasicRateSet; ++ u16 ForcedDataRate;// Force Data Rate. 0: Auto, 0x02: 1M ~ 0x6C: 54M. ++ u32 ReceiveConfig; ++ ++ //rf_ctrl + u8 rf_chip; + u8 rf_type; -+ u8 PackageType; + u8 NumTotalRFPath; -+ u8 nss_num; + -+ /****** Debug ******/ -+ u16 ForcedDataRate; /* Force Data Rate. 0: Auto, 0x02: 1M ~ 0x6C: 54M. */ -+ u8 u1ForcedIgiLb; /* forced IGI lower bound */ -+ u8 bDumpRxPkt; -+ u8 bDumpTxPkt; -+ u8 bDisableTXPowerTraining; -+ -+ -+ /****** EEPROM setting.******/ -+ u8 bautoload_fail_flag; -+ u8 efuse_file_status; -+ u8 macaddr_file_status; -+ u8 EepromOrEfuse; -+ u8 efuse_eeprom_data[EEPROM_MAX_SIZE]; /*92C:256bytes, 88E:512bytes, we use union set (512bytes)*/ -+ u8 InterfaceSel; /* board type kept in eFuse */ -+ u16 CustomerID; -+ ++ u8 InterfaceSel; ++ u8 framesync; ++ u32 framesyncC34; ++ u8 framesyncMonitor; ++ u8 DefaultInitialGain[4]; ++ // ++ // EEPROM setting. ++ // + u16 EEPROMVID; + u16 EEPROMSVID; -+#ifdef CONFIG_USB_HCI -+ u8 EEPROMUsbSwitch; + u16 EEPROMPID; + u16 EEPROMSDID; -+#endif -+#ifdef CONFIG_PCI_HCI -+ u16 EEPROMDID; -+ u16 EEPROMSMID; -+#endif + + u8 EEPROMCustomerID; + u8 EEPROMSubCustomerID; + u8 EEPROMVersion; + u8 EEPROMRegulatory; + u8 EEPROMThermalMeter; -+ u8 EEPROMBluetoothCoexist; ++ u8 EEPROMBluetoothCoexist; + u8 EEPROMBluetoothType; + u8 EEPROMBluetoothAntNum; + u8 EEPROMBluetoothAntIsolation; + u8 EEPROMBluetoothRadioShared; + u8 bTXPowerDataReadFromEEPORM; -+ u8 EEPROMMACAddr[ETH_ALEN]; -+ -+#ifdef CONFIG_RF_GAIN_OFFSET -+ u8 EEPROMRFGainOffset; -+ u8 EEPROMRFGainVal; -+ struct kfree_data_t kfree_data; -+#endif /*CONFIG_RF_GAIN_OFFSET*/ ++ u8 bAPKThermalMeterIgnore; + -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) -+ u8 adjuseVoltageVal; -+#endif -+ u8 EfuseUsedPercentage; -+ u16 EfuseUsedBytes; -+ /*u8 EfuseMap[2][HWSET_MAX_SIZE_JAGUAR];*/ -+ EFUSE_HAL EfuseHal; ++ bool EepromOrEfuse; ++ u8 EfuseUsedPercentage; ++ u16 EfuseUsedBytes; ++ //u8 EfuseMap[2][HWSET_MAX_SIZE_JAGUAR]; ++ EFUSE_HAL EfuseHal; + -+ /*---------------------------------------------------------------------------------*/ ++ //---------------------------------------------------------------------------------// + //3 [2.4G] -+ u8 Index24G_CCK_Base[MAX_RF_PATH][CENTER_CH_2G_NUM]; -+ u8 Index24G_BW40_Base[MAX_RF_PATH][CENTER_CH_2G_NUM]; ++ u8 Index24G_CCK_Base[MAX_RF_PATH][CHANNEL_MAX_NUMBER]; ++ u8 Index24G_BW40_Base[MAX_RF_PATH][CHANNEL_MAX_NUMBER]; + //If only one tx, only BW20 and OFDM are used. -+ s8 CCK_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 CCK_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; + s8 OFDM_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; + s8 BW20_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; + s8 BW40_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; + //3 [5G] -+ u8 Index5G_BW40_Base[MAX_RF_PATH][CENTER_CH_5G_ALL_NUM]; -+ u8 Index5G_BW80_Base[MAX_RF_PATH][CENTER_CH_5G_80M_NUM]; ++ u8 Index5G_BW40_Base[MAX_RF_PATH][CHANNEL_MAX_NUMBER]; ++ u8 Index5G_BW80_Base[MAX_RF_PATH][CHANNEL_MAX_NUMBER_5G_80M]; + s8 OFDM_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; + s8 BW20_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; + s8 BW40_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; @@ -304662,75 +134692,75 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_data.h linux/3rdparty/rtl881 + + u8 TxPwrInPercentage; + -+ /******************************** -+ * TX power by rate table at most 4RF path. -+ * The register is -+ * -+ * VHT TX power by rate off setArray = -+ * Band:-2G&5G = 0 / 1 -+ * RF: at most 4*4 = ABCD=0/1/2/3 -+ * CCK=0 OFDM=1/2 HT-MCS 0-15=3/4/56 VHT=7/8/9/10/11 -+ **********************************/ ++ u8 TxPwrCalibrateRate; ++ // ++ // TX power by rate table at most 4RF path. ++ // The register is ++ // ++ // VHT TX power by rate off setArray = ++ // Band:-2G&5G = 0 / 1 ++ // RF: at most 4*4 = ABCD=0/1/2/3 ++ // CCK=0 OFDM=1/2 HT-MCS 0-15=3/4/56 VHT=7/8/9/10/11 ++ // + u8 TxPwrByRateTable; + u8 TxPwrByRateBand; -+ s8 TxPwrByRateOffset[TX_PWR_BY_RATE_NUM_BAND] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RATE]; ++ u32 TxPwrByRateOffset[TX_PWR_BY_RATE_NUM_BAND] ++ [TX_PWR_BY_RATE_NUM_RF] ++ [TX_PWR_BY_RATE_NUM_SECTION]; + //---------------------------------------------------------------------------------// + -+ /* -+ //2 Power Limit Table ++ //2 Power Limit Table + u8 TxPwrLevelCck[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; + u8 TxPwrLevelHT40_1S[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; // For HT 40MHZ pwr + u8 TxPwrLevelHT40_2S[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; // For HT 40MHZ pwr -+ s8 TxPwrHt20Diff[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER];// HT 20<->40 Pwr diff ++ u8 TxPwrHt20Diff[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER];// HT 20<->40 Pwr diff + u8 TxPwrLegacyHtDiff[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER];// For HT<->legacy pwr diff -+ */ + + // Power Limit Table for 2.4G -+ s8 TxPwrLimit_2_4G[MAX_REGULATION_NUM] -+ [MAX_2_4G_BANDWIDTH_NUM] -+ [MAX_RATE_SECTION_NUM] -+ [CENTER_CH_2G_NUM] -+ [MAX_RF_PATH]; ++ u8 TxPwrLimit_2_4G[MAX_REGULATION_NUM] ++ [MAX_2_4G_BANDWITH_NUM] ++ [MAX_2_4G_RATE_SECTION_NUM] ++ [MAX_2_4G_CHANNEL_NUM] ++ [MAX_RF_PATH_NUM]; + + // Power Limit Table for 5G -+ s8 TxPwrLimit_5G[MAX_REGULATION_NUM] -+ [MAX_5G_BANDWIDTH_NUM] -+ [MAX_RATE_SECTION_NUM] -+ [CENTER_CH_5G_ALL_NUM] -+ [MAX_RF_PATH]; ++ u8 TxPwrLimit_5G[MAX_REGULATION_NUM] ++ [MAX_5G_BANDWITH_NUM] ++ [MAX_5G_RATE_SECTION_NUM] ++ [MAX_5G_CHANNEL_NUM] ++ [MAX_RF_PATH_NUM]; ++ + -+ + // Store the original power by rate value of the base of each rate section of rf path A & B -+ u8 TxPwrByRateBase2_4G[TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RF] ++ u8 TxPwrByRateBase2_4G[MAX_RF_PATH_NUM_IN_POWER_LIMIT_TABLE] + [MAX_BASE_NUM_IN_PHY_REG_PG_2_4G]; -+ u8 TxPwrByRateBase5G[TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RF] ++ u8 TxPwrByRateBase5G[MAX_RF_PATH_NUM_IN_POWER_LIMIT_TABLE] + [MAX_BASE_NUM_IN_PHY_REG_PG_5G]; + + // For power group -+ /* + u8 PwrGroupHT20[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; + u8 PwrGroupHT40[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; -+ */ ++ ++ ++ ++ + u8 PGMaxGroup; -+ ++ u8 LegacyHTTxPowerDiff;// Legacy to HT rate power diff + // The current Tx Power Level + u8 CurrentCckTxPwrIdx; + u8 CurrentOfdm24GTxPwrIdx; + u8 CurrentBW2024GTxPwrIdx; + u8 CurrentBW4024GTxPwrIdx; -+ -+ // Read/write are allow for following hardware information variables ++ ++ // Read/write are allow for following hardware information variables + u8 pwrGroupCnt; + u32 MCSTxPowerLevelOriginalOffset[MAX_PG_GROUP][16]; + u32 CCKTxPowerLevelOriginalOffset; + + u8 CrystalCap; -+ ++ u32 AntennaTxPath; // Antenna path Tx ++ u32 AntennaRxPath; // Antenna path Rx ++ + u8 PAType_2G; + u8 PAType_5G; + u8 LNAType_2G; @@ -304739,22 +134769,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_data.h linux/3rdparty/rtl881 + u8 ExternalLNA_2G; + u8 ExternalPA_5G; + u8 ExternalLNA_5G; -+ u16 TypeGLNA; -+ u16 TypeGPA; -+ u16 TypeALNA; -+ u16 TypeAPA; -+ u16 RFEType; ++ u8 RFEType; ++ u8 BoardType; ++ u8 ExternalPA; ++ u8 bIQKInitialized; ++ bool bLCKInProgress; + -+ u8 bLedOpenDrain; /* Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. */ -+ u32 AcParam_BE; /* Original parameter for BE, use for EDCA turbo. */ ++ bool bSwChnl; ++ bool bSetChnlBW; ++ bool bChnlBWInitialzed; ++ bool bNeedIQK; + -+ BB_REGISTER_DEFINITION_T PHYRegDef[MAX_RF_PATH]; //Radio A/B/C/D ++ u8 bLedOpenDrain; // Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. ++ u8 TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default ++ u8 b1x1RecvCombine; // for 1T1R receive combining + -+ u32 RfRegChnlVal[MAX_RF_PATH]; ++ u32 AcParam_BE; //Original parameter for BE, use for EDCA turbo. ++ ++ BB_REGISTER_DEFINITION_T PHYRegDef[4]; //Radio A/B/C/D ++ ++ u32 RfRegChnlVal[2]; + + //RDG enable -+ BOOLEAN bRDGEnable; ++ bool bRDGEnable; + ++ //for host message to fw ++ u8 LastHMEBoxNum; ++ ++ u8 fw_ractrl; + u8 RegTxPause; + // Beacon function related global variable. + u8 RegBcnCtrlVal; @@ -304762,366 +134804,99 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_data.h linux/3rdparty/rtl881 + u8 RegReg542; + u8 RegCR_1; + u8 Reg837; ++ u8 RegRFPathS1; + u16 RegRRSR; -+ -+ /****** antenna diversity ******/ ++ + u8 CurAntenna; + u8 AntDivCfg; -+ u8 AntDetection; + u8 TRxAntDivType; -+ u8 ant_path; //for 8723B s0/s1 selection -+ u32 AntennaTxPath; /* Antenna path Tx */ -+ u32 AntennaRxPath; /* Antenna path Rx */ -+ -+ /******** PHY DM & DM Section **********/ -+ u8 DM_Type; -+ _lock IQKSpinLock; -+ u8 INIDATA_RATE[MACID_NUM_SW_LIMIT]; -+ /* Upper and Lower Signal threshold for Rate Adaptive*/ -+ int EntryMinUndecoratedSmoothedPWDB; -+ int EntryMaxUndecoratedSmoothedPWDB; -+ int MinUndecoratedPWDBForDM; -+ DM_ODM_T odmpriv; -+ u8 bIQKInitialized; -+ u8 bNeedIQK; -+ /******** PHY DM & DM Section **********/ -+ + ++ u8 bDumpRxPkt;//for debug ++ u8 bDumpTxPkt;//for debug ++ u8 FwRsvdPageStartOffset; //2010.06.23. Added by tynli. Reserve page start offset except beacon in TxQ. + + // 2010/08/09 MH Add CU power down mode. -+ BOOLEAN pwrdown; ++ bool pwrdown; + + // Add for dual MAC 0--Mac0 1--Mac1 + u32 interfaceIndex; + ++ u8 OutEpQueueSel; ++ u8 OutEpNumber; ++ ++ // 2010/12/10 MH Add for USB aggreation mode dynamic shceme. ++ bool UsbRxHighSpeedMode; ++ ++ // 2010/11/22 MH Add for slim combo debug mode selective. ++ // This is used for fix the drawback of CU TSMC-A/UMC-A cut. HW auto suspend ability. Close BT clock. ++ bool SlimComboDbg; ++ +#ifdef CONFIG_P2P + u8 p2p_ps_offload; +#endif -+ /* Auto FSM to Turn On, include clock, isolation, power control for MAC only */ ++ ++ u8 AMPDUDensity; ++ ++ // Auto FSM to Turn On, include clock, isolation, power control for MAC only + u8 bMacPwrCtrlOn; -+ u8 hci_sus_state; -+ -+ u8 RegIQKFWOffload; -+ struct submit_ctx iqk_sctx; + + RT_AMPDU_BRUST AMPDUBurstMode; //92C maybe not use, but for compile successfully + -+ u8 OutEpQueueSel; -+ u8 OutEpNumber; -+ -+#if defined (CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ // -+ // For SDIO Interface HAL related -+ // -+ -+ // -+ // SDIO ISR Related -+ // -+// u32 IntrMask[1]; -+// u32 IntrMaskToSet[1]; -+// LOG_INTERRUPT InterruptLog; -+ u32 sdio_himr; -+ u32 sdio_hisr; -+ -+ // -+ // SDIO Tx FIFO related. -+ // -+ // HIQ, MID, LOW, PUB free pages; padapter->xmitpriv.free_txpg -+ u8 SdioTxFIFOFreePage[SDIO_TX_FREE_PG_QUEUE]; -+ _lock SdioTxFIFOFreePageLock; -+ u8 SdioTxOQTMaxFreeSpace; -+ u8 SdioTxOQTFreeSpace; -+ -+ // -+ // SDIO Rx FIFO related. -+ // -+ u8 SdioRxFIFOCnt; -+ u16 SdioRxFIFOSize; -+ -+ u32 sdio_tx_max_len[SDIO_MAX_TX_QUEUE];// H, N, L, used for sdio tx aggregation max length per queue -+#endif //CONFIG_SDIO_HCI -+ -+#ifdef CONFIG_USB_HCI -+ -+ // 2010/12/10 MH Add for USB aggreation mode dynamic shceme. -+ BOOLEAN UsbRxHighSpeedMode; -+ BOOLEAN UsbTxVeryHighSpeedMode; -+ u32 UsbBulkOutSize; -+ BOOLEAN bSupportUSB3; ++ u32 UsbBulkOutSize; ++ bool bSupportUSB3; + + // Interrupt relatd register information. -+ u32 IntArray[3];//HISR0,HISR1,HSISR -+ u32 IntrMask[3]; -+ u8 C2hArray[16]; ++ u32 IntArray[3];//HISR0,HISR1,HSISR ++ u32 IntrMask[3]; ++ u8 C2hArray[16]; + #ifdef CONFIG_USB_TX_AGGREGATION -+ u8 UsbTxAggMode; -+ u8 UsbTxAggDescNum; ++ u8 UsbTxAggMode; ++ u8 UsbTxAggDescNum; + #endif // CONFIG_USB_TX_AGGREGATION -+ ++ + #ifdef CONFIG_USB_RX_AGGREGATION -+ u16 HwRxPageSize; // Hardware setting -+ u32 MaxUsbRxAggBlock; ++ u16 HwRxPageSize; // Hardware setting ++ u32 MaxUsbRxAggBlock; + + USB_RX_AGG_MODE UsbRxAggMode; -+ u8 UsbRxAggBlockCount; /* FOR USB Mode, USB Block count. Block size is 512-byte in hight speed and 64-byte in full speed */ -+ u8 UsbRxAggBlockTimeout; -+ u8 UsbRxAggPageCount; /* FOR DMA Mode, 8192C DMA page count*/ -+ u8 UsbRxAggPageTimeout; ++ u8 UsbRxAggBlockCount; // USB Block count. Block size is 512-byte in hight speed and 64-byte in full speed ++ u8 UsbRxAggBlockTimeout; ++ u8 UsbRxAggPageCount; // 8192C DMA page count ++ u8 UsbRxAggPageTimeout; + -+ u8 RegAcUsbDmaSize; -+ u8 RegAcUsbDmaTime; ++ u8 RegAcUsbDmaSize; ++ u8 RegAcUsbDmaTime; + #endif//CONFIG_USB_RX_AGGREGATION -+#endif //CONFIG_USB_HCI + -+ -+#ifdef CONFIG_PCI_HCI -+ // -+ // EEPROM setting. -+ // -+ u32 TransmitConfig; -+ u32 IntrMaskToSet[2]; -+ u32 IntArray[2]; -+ u32 IntrMask[2]; -+ u32 SysIntArray[1]; -+ u32 SysIntrMask[1]; -+ u32 IntrMaskReg[2]; -+ u32 IntrMaskDefault[2]; -+ -+ BOOLEAN bL1OffSupport; -+ BOOLEAN bSupportBackDoor; -+ -+ u8 bDefaultAntenna; -+ -+ u8 bInterruptMigration; -+ u8 bDisableTxInt; -+ -+ u16 RxTag; -+#endif //CONFIG_PCI_HCI -+ ++ struct dm_priv dmpriv; ++ DM_ODM_T odmpriv; + +#ifdef DBG_CONFIG_ERROR_DETECT + struct sreset_priv srestpriv; -+#endif //#ifdef DBG_CONFIG_ERROR_DETECT ++#endif + +#ifdef CONFIG_BT_COEXIST -+ // For bluetooth co-existance -+ BT_COEXIST bt_coexist; -+#endif // CONFIG_BT_COEXIST -+ -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) || defined(CONFIG_RTL8188F) -+ #ifndef CONFIG_PCI_HCI // mutual exclusive with PCI -- so they're SDIO and GSPI -+ // Interrupt relatd register information. -+ u32 SysIntrStatus; -+ u32 SysIntrMask; -+ #endif -+#endif /*endif CONFIG_RTL8723B */ -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ char para_file_buf[MAX_PARA_FILE_BUF_LEN]; -+ char *mac_reg; -+ u32 mac_reg_len; -+ char *bb_phy_reg; -+ u32 bb_phy_reg_len; -+ char *bb_agc_tab; -+ u32 bb_agc_tab_len; -+ char *bb_phy_reg_pg; -+ u32 bb_phy_reg_pg_len; -+ char *bb_phy_reg_mp; -+ u32 bb_phy_reg_mp_len; -+ char *rf_radio_a; -+ u32 rf_radio_a_len; -+ char *rf_radio_b; -+ u32 rf_radio_b_len; -+ char *rf_tx_pwr_track; -+ u32 rf_tx_pwr_track_len; -+ char *rf_tx_pwr_lmt; -+ u32 rf_tx_pwr_lmt_len; ++ struct btcoexist_priv bt_coexist; +#endif -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ s16 noise[ODM_MAX_CHANNEL_NUM]; -+#endif -+ -+ u8 macid_num; -+ u8 sec_cam_ent_num; -+ u8 sec_cap; -+ u8 RfKFreeEnable; -+ u8 RfKFree_ch_group; -+ BOOLEAN bCCKinCH14; -+ BB_INIT_REGISTER RegForRecover[5]; -+ +} HAL_DATA_COMMON, *PHAL_DATA_COMMON; + + -+ +typedef struct hal_com_data HAL_DATA_TYPE, *PHAL_DATA_TYPE; -+#define GET_HAL_DATA(__pAdapter) ((HAL_DATA_TYPE *)((__pAdapter)->HalData)) -+ -+#define GET_HAL_RFPATH_NUM(__pAdapter) (((HAL_DATA_TYPE *)((__pAdapter)->HalData))->NumTotalRFPath ) -+#define RT_GetInterfaceSelection(_Adapter) (GET_HAL_DATA(_Adapter)->InterfaceSel) -+#define GET_RF_TYPE(__pAdapter) (GET_HAL_DATA(__pAdapter)->rf_type) -+#define GET_KFREE_DATA(_adapter) (&(GET_HAL_DATA((_adapter))->kfree_data)) -+ -+#define SUPPORT_HW_RADIO_DETECT(Adapter) ( RT_GetInterfaceSelection(Adapter) == INTF_SEL2_MINICARD ||\ -+ RT_GetInterfaceSelection(Adapter) == INTF_SEL3_USB_Solo ||\ -+ RT_GetInterfaceSelection(Adapter) == INTF_SEL4_USB_Combo) -+ -+#define get_hal_mac_addr(adapter) (GET_HAL_DATA(adapter)->EEPROMMACAddr) -+#define is_boot_from_eeprom(adapter) (GET_HAL_DATA(adapter)->EepromOrEfuse) -+#define rtw_get_hw_init_completed(adapter) (GET_HAL_DATA(adapter)->hw_init_completed) -+#define rtw_is_hw_init_completed(adapter) (GET_HAL_DATA(adapter)->hw_init_completed == _TRUE) ++#define GET_HAL_DATA(__pAdapter) ((HAL_DATA_TYPE *)((__pAdapter)->HalData)) ++#define GET_HAL_RFPATH_NUM(__pAdapter) (((HAL_DATA_TYPE *)((__pAdapter)->HalData))->NumTotalRFPath ) ++#define RT_GetInterfaceSelection(_Adapter) (GET_HAL_DATA(_Adapter)->InterfaceSel) +#endif + -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+#define GET_ACS_STATE(padapter) (ATOMIC_READ(&GET_HAL_DATA(padapter)->acs.state)) -+#define SET_ACS_STATE(padapter, set_state) (ATOMIC_SET(&GET_HAL_DATA(padapter)->acs.state, set_state)) -+#define rtw_get_acs_channel(padapter) (GET_HAL_DATA(padapter)->acs.ch) -+#define rtw_set_acs_channel(padapter, survey_ch) (GET_HAL_DATA(padapter)->acs.ch = survey_ch) -+#endif /*CONFIG_AUTO_CHNL_SEL_NHM*/ + +#endif //__HAL_DATA_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_gspi.h linux/3rdparty/rtl8812au/include/hal_gspi.h ---- linux.old/3rdparty/rtl8812au/include/hal_gspi.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_gspi.h 2017-06-07 23:07:21.037689945 +0300 -@@ -0,0 +1,32 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_GSPI_H_ -+#define __HAL_GSPI_H_ -+ -+#define ffaddr2deviceId(pdvobj, addr) (pdvobj->Queue2Pipe[addr]) -+ -+u8 rtw_hal_gspi_max_txoqt_free_space(_adapter *padapter); -+u8 rtw_hal_gspi_query_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); -+void rtw_hal_gspi_update_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); -+void rtw_hal_set_gspi_tx_max_length(PADAPTER padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ); -+u32 rtw_hal_get_gspi_tx_max_length(PADAPTER padapter, u8 queue_idx); -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_ic_cfg.h linux/3rdparty/rtl8812au/include/hal_ic_cfg.h ---- linux.old/3rdparty/rtl8812au/include/hal_ic_cfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_ic_cfg.h 2017-06-07 23:07:21.037689945 +0300 -@@ -0,0 +1,93 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_IC_CFG_H__ -+#define __HAL_IC_CFG_H__ -+ -+#define RTL8188E_SUPPORT 0 -+#define RTL8812A_SUPPORT 0 -+#define RTL8821A_SUPPORT 0 -+#define RTL8723B_SUPPORT 0 -+#define RTL8192E_SUPPORT 0 -+#define RTL8814A_SUPPORT 0 -+#define RTL8195A_SUPPORT 0 -+#define RTL8703B_SUPPORT 0 -+#define RTL8188F_SUPPORT 0 -+#define RTL8822B_SUPPORT 0 -+#define RTL8821B_SUPPORT 0 -+ -+/*#if (RTL8188E_SUPPORT==1)*/ -+#define RATE_ADAPTIVE_SUPPORT 0 -+#define POWER_TRAINING_ACTIVE 0 -+ -+#ifdef CONFIG_MULTIDRV -+#endif -+ -+#ifdef CONFIG_RTL8188E -+#undef RTL8188E_SUPPORT -+#undef RATE_ADAPTIVE_SUPPORT -+#undef POWER_TRAINING_ACTIVE -+ -+#define RTL8188E_SUPPORT 1 -+#define RATE_ADAPTIVE_SUPPORT 1 -+#define POWER_TRAINING_ACTIVE 1 -+#endif -+ -+#ifdef CONFIG_RTL8812A -+#undef RTL8812A_SUPPORT -+#define RTL8812A_SUPPORT 1 -+#endif -+ -+#ifdef CONFIG_RTL8821A -+#undef RTL8821A_SUPPORT -+#define RTL8821A_SUPPORT 1 -+#endif -+ -+#ifdef CONFIG_RTL8192E -+#undef RTL8192E_SUPPORT -+#define RTL8192E_SUPPORT 1 -+#endif -+ -+#ifdef CONFIG_RTL8723B -+#undef RTL8723B_SUPPORT -+#define RTL8723B_SUPPORT 1 -+#endif -+ -+#ifdef CONFIG_RTL8814A -+#undef RTL8814A_SUPPORT -+#define RTL8814A_SUPPORT 1 -+#endif -+ -+#ifdef CONFIG_RTL8703B -+#undef RTL8703B_SUPPORT -+#define RTL8703B_SUPPORT 1 -+#endif -+ -+#ifdef CONFIG_RTL8188F -+#undef RTL8188F_SUPPORT -+#define RTL8188F_SUPPORT 1 -+#endif -+ -+#ifdef CONFIG_RTL8822B -+#undef RTL8822B_SUPPORT -+#define RTL8822B_SUPPORT 1 -+#endif -+ -+#endif /*__HAL_IC_CFG_H__*/ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl8812au/include/hal_intf.h ---- linux.old/3rdparty/rtl8812au/include/hal_intf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_intf.h 2017-06-07 23:07:21.037689945 +0300 -@@ -0,0 +1,682 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_intf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_intf.h +--- linux-4.14.17/3rdparty/rtl8812au/include/hal_intf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_intf.h 2018-02-06 17:42:30.718967283 +0200 +@@ -0,0 +1,536 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -305131,11 +134906,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __HAL_INTF_H__ +#define __HAL_INTF_H__ @@ -305143,31 +134913,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 + +enum RTL871X_HCI_TYPE { + RTW_PCIE = BIT0, -+ RTW_USB = BIT1, -+ RTW_SDIO = BIT2, ++ RTW_USB = BIT1, ++ RTW_SDIO = BIT2, + RTW_GSPI = BIT3, +}; + +enum _CHIP_TYPE { + + NULL_CHIP_TYPE, ++ RTL8188C_8192C, ++ RTL8192D, ++ RTL8723A, + RTL8188E, + RTL8192E, + RTL8812, + RTL8821, //RTL8811 + RTL8723B, -+ RTL8814A, -+ RTL8703B, -+ RTL8188F, + MAX_CHIP_TYPE +}; + -+typedef enum _HAL_HW_TIMER_TYPE { -+ HAL_TIMER_NONE = 0, -+ HAL_TIMER_TXBF = 1, -+ HAL_TIMER_EARLYMODE = 2, -+} HAL_HW_TIMER_TYPE, *PHAL_HW_TIMER_TYPE; -+ + +typedef enum _HW_VARIABLES{ + HW_VAR_MEDIA_STATUS, @@ -305191,12 +134955,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 + HW_VAR_RESP_SIFS, + HW_VAR_ACK_PREAMBLE, + HW_VAR_SEC_CFG, -+ HW_VAR_SEC_DK_CFG, + HW_VAR_BCN_VALID, + HW_VAR_RF_TYPE, -+ /* PHYDM odm->SupportAbility */ ++ HW_VAR_DM_FLAG, ++ HW_VAR_DM_FUNC_OP, ++ HW_VAR_DM_FUNC_SET, ++ HW_VAR_DM_FUNC_CLR, + HW_VAR_CAM_EMPTY_ENTRY, + HW_VAR_CAM_INVALID_ALL, ++ HW_VAR_CAM_WRITE, ++ HW_VAR_CAM_READ, + HW_VAR_AC_PARAM_VO, + HW_VAR_AC_PARAM_VI, + HW_VAR_AC_PARAM_BE, @@ -305206,17 +134974,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 + HW_VAR_AMPDU_FACTOR, + HW_VAR_RXDMA_AGG_PG_TH, + HW_VAR_SET_RPWM, -+ HW_VAR_CPWM, + HW_VAR_H2C_FW_PWRMODE, + HW_VAR_H2C_PS_TUNE_PARAM, + HW_VAR_H2C_FW_JOINBSSRPT, + HW_VAR_FWLPS_RF_ON, + HW_VAR_H2C_FW_P2P_PS_OFFLOAD, + HW_VAR_TDLS_WRCR, ++ HW_VAR_TDLS_INIT_CH_SEN, + HW_VAR_TDLS_RS_RCR, ++ HW_VAR_TDLS_DONE_CH_SEN, ++ HW_VAR_INITIAL_GAIN, + HW_VAR_TRIGGER_GPIO_0, + HW_VAR_BT_SET_COEXIST, -+ HW_VAR_BT_ISSUE_DELBA, ++ HW_VAR_BT_ISSUE_DELBA, + HW_VAR_CURRENT_ANTENNA, + HW_VAR_ANTENNA_DIVERSITY_LINK, + HW_VAR_ANTENNA_DIVERSITY_SELECT, @@ -305226,54 +134996,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 + HW_VAR_EFUSE_BT_USAGE, + HW_VAR_EFUSE_BT_BYTES, + HW_VAR_FIFO_CLEARN_UP, -+ HW_VAR_RESTORE_HW_SEQ, + HW_VAR_CHECK_TXBUF, -+ HW_VAR_PCIE_STOP_TX_DMA, + HW_VAR_APFM_ON_MAC, //Auto FSM to Turn On, include clock, isolation, power control for MAC only -+ HW_VAR_HCI_SUS_STATE, + // The valid upper nav range for the HW updating, if the true value is larger than the upper range, the HW won't update it. + // Unit in microsecond. 0 means disable this function. -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++#ifdef CONFIG_WOWLAN + HW_VAR_WOWLAN, -+ HW_VAR_WAKEUP_REASON, -+ HW_VAR_RPWM_TOG, +#endif -+#ifdef CONFIG_GPIO_WAKEUP -+ HW_SET_GPIO_WL_CTRL, -+#endif -+ HW_VAR_SYS_CLKR, + HW_VAR_NAV_UPPER, + HW_VAR_C2H_HANDLE, + HW_VAR_RPT_TIMER_SETTING, -+ HW_VAR_TX_RPT_MAX_MACID, ++ HW_VAR_TX_RPT_MAX_MACID, + HW_VAR_H2C_MEDIA_STATUS_RPT, + HW_VAR_CHK_HI_QUEUE_EMPTY, + HW_VAR_DL_BCN_SEL, + HW_VAR_AMPDU_MAX_TIME, + HW_VAR_WIRELESS_MODE, + HW_VAR_USB_MODE, -+ HW_VAR_PORT_SWITCH, -+ HW_VAR_DO_IQK, -+ HW_VAR_DM_IN_LPS, -+ HW_VAR_SET_REQ_FW_PS, -+ HW_VAR_FW_PS_STATE, -+ HW_VAR_SOUNDING_ENTER, -+ HW_VAR_SOUNDING_LEAVE, -+ HW_VAR_SOUNDING_RATE, -+ HW_VAR_SOUNDING_STATUS, -+ HW_VAR_SOUNDING_FW_NDPA, -+ HW_VAR_SOUNDING_CLK, -+/*Add by YuChen for TXBF HW timer*/ -+ HW_VAR_HW_REG_TIMER_INIT, -+ HW_VAR_HW_REG_TIMER_RESTART, -+ HW_VAR_HW_REG_TIMER_START, -+ HW_VAR_HW_REG_TIMER_STOP, -+/*Add by YuChen for TXBF HW timer*/ -+ HW_VAR_DL_RSVD_PAGE, -+ HW_VAR_MACID_SLEEP, -+ HW_VAR_MACID_WAKEUP, -+ HW_VAR_DUMP_MAC_QUEUE_INFO, -+ HW_VAR_ASIX_IOT, +}HW_VARIABLES; + +typedef enum _HAL_DEF_VARIABLE{ @@ -305283,54 +135022,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 + HAL_DEF_DRVINFO_SZ, + HAL_DEF_MAX_RECVBUF_SZ, + HAL_DEF_RX_PACKET_OFFSET, -+ HAL_DEF_RX_DMA_SZ_WOW, -+ HAL_DEF_RX_DMA_SZ, -+ HAL_DEF_RX_PAGE_SIZE, + HAL_DEF_DBG_DUMP_RXPKT,//for dbg ++ HAL_DEF_DBG_DM_FUNC,//for dbg + HAL_DEF_RA_DECISION_RATE, + HAL_DEF_RA_SGI, + HAL_DEF_PT_PWR_STATUS, -+ HAL_DEF_TX_LDPC, // LDPC support -+ HAL_DEF_RX_LDPC, // LDPC support -+ HAL_DEF_TX_STBC, // TX STBC support -+ HAL_DEF_RX_STBC, // RX STBC support -+ HAL_DEF_EXPLICIT_BEAMFORMER,// Explicit Compressed Steering Capable -+ HAL_DEF_EXPLICIT_BEAMFORMEE,// Explicit Compressed Beamforming Feedback Capable -+ HAL_DEF_BEAMFORMER_CAP, -+ HAL_DEF_BEAMFORMEE_CAP, ++ HAL_DEF_LDPC, // LDPC support ++ HAL_DEF_TX_STBC, // TX STBC support ++ HAL_DEF_RX_STBC, // RX STBC support + HW_VAR_MAX_RX_AMPDU_FACTOR, + HW_DEF_RA_INFO_DUMP, + HAL_DEF_DBG_DUMP_TXPKT, -+ -+ HAL_DEF_TX_PAGE_SIZE, ++ HW_DEF_FA_CNT_DUMP, ++ HW_DEF_ODM_DBG_FLAG, + HAL_DEF_TX_PAGE_BOUNDARY, + HAL_DEF_TX_PAGE_BOUNDARY_WOWLAN, + HAL_DEF_ANT_DETECT,//to do for 8723a -+ HAL_DEF_PCI_SUUPORT_L1_BACKDOOR, // Determine if the L1 Backdoor setting is turned on. -+ HAL_DEF_PCI_AMD_L1_SUPPORT, -+ HAL_DEF_PCI_ASPM_OSC, // Support for ASPM OSC, added by Roger, 2013.03.27. -+ HAL_DEF_MACID_SLEEP, // Support for MACID sleep -+ HAL_DEF_DBG_DIS_PWT, //disable Tx power training or not. -+ HAL_DEF_EFUSE_USAGE, /* Get current EFUSE utilization. 2008.12.19. Added by Roger. */ -+ HAL_DEF_EFUSE_BYTES, -+ HW_VAR_BEST_AMPDU_DENSITY, ++ +}HAL_DEF_VARIABLE; + +typedef enum _HAL_ODM_VARIABLE{ -+ HAL_ODM_STA_INFO, ++ HAL_ODM_STA_INFO, + HAL_ODM_P2P_STATE, + HAL_ODM_WIFI_DISPLAY_STATE, -+ HAL_ODM_NOISE_MONITOR, -+ HAL_ODM_REGULATION, -+ HAL_ODM_INITIAL_GAIN, -+ HAL_ODM_FA_CNT_DUMP, -+ HAL_ODM_DBG_FLAG, -+ HAL_ODM_DBG_LEVEL, -+ HAL_ODM_RX_INFO_DUMP, -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ HAL_ODM_AUTO_CHNL_SEL, -+#endif +}HAL_ODM_VARIABLE; + +typedef enum _HAL_INTF_PS_FUNC{ @@ -305338,95 +135052,65 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 + HAL_MAX_ID, +}HAL_INTF_PS_FUNC; + -+typedef s32 (*c2h_id_filter)(u8 *c2h_evt); ++typedef s32 (*c2h_id_filter)(u8 id); + +struct hal_ops { -+ /*** initialize section ***/ -+ void (*read_chip_version)(_adapter *padapter); -+ void (*init_default_value)(_adapter *padapter); -+ void (*intf_chip_configure)(_adapter *padapter); -+ void (*read_adapter_info)(_adapter *padapter); + u32 (*hal_power_on)(_adapter *padapter); -+ void (*hal_power_off)(_adapter *padapter); + u32 (*hal_init)(_adapter *padapter); + u32 (*hal_deinit)(_adapter *padapter); -+ void (*dm_init)(_adapter *padapter); -+ void (*dm_deinit)(_adapter *padapter); -+ -+ /*** xmit section ***/ -+ s32 (*init_xmit_priv)(_adapter *padapter); -+ void (*free_xmit_priv)(_adapter *padapter); -+ s32 (*hal_xmit)(_adapter *padapter, struct xmit_frame *pxmitframe); -+ /* -+ * mgnt_xmit should be implemented to run in interrupt context -+ */ -+ s32 (*mgnt_xmit)(_adapter *padapter, struct xmit_frame *pmgntframe); -+ s32 (*hal_xmitframe_enqueue)(_adapter *padapter, struct xmit_frame *pxmitframe); -+#ifdef CONFIG_XMIT_THREAD_MODE -+ s32 (*xmit_thread_handler)(_adapter *padapter); -+#endif -+ void (*run_thread)(_adapter *padapter); -+ void (*cancel_thread)(_adapter *padapter); + -+ /*** recv section ***/ -+ s32 (*init_recv_priv)(_adapter *padapter); -+ void (*free_recv_priv)(_adapter *padapter); -+#if defined(CONFIG_USB_HCI)||defined(CONFIG_PCI_HCI) ++ void (*free_hal_data)(_adapter *padapter); ++ + u32 (*inirp_init)(_adapter *padapter); + u32 (*inirp_deinit)(_adapter *padapter); -+#endif -+ /*** interrupt hdl section ***/ -+ void (*enable_interrupt)(_adapter *padapter); -+ void (*disable_interrupt)(_adapter *padapter); -+ u8 (*check_ips_status)(_adapter *padapter); -+#if defined(CONFIG_PCI_HCI) -+ s32 (*interrupt_handler)(_adapter *padapter); -+#endif + -+#if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) -+ void (*interrupt_handler)(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif ++ s32 (*init_xmit_priv)(_adapter *padapter); ++ void (*free_xmit_priv)(_adapter *padapter); ++ ++ s32 (*init_recv_priv)(_adapter *padapter); ++ void (*free_recv_priv)(_adapter *padapter); + -+#if defined(CONFIG_PCI_HCI) -+ void (*irp_reset)(_adapter *padapter); -+#endif -+ -+ /*** DM section ***/ -+ + void (*InitSwLeds)(_adapter *padapter); + void (*DeInitSwLeds)(_adapter *padapter); -+ ++ ++ void (*dm_init)(_adapter *padapter); ++ void (*dm_deinit)(_adapter *padapter); ++ void (*read_chip_version)(_adapter *padapter); ++ ++ void (*init_default_value)(_adapter *padapter); ++ ++ void (*intf_chip_configure)(_adapter *padapter); ++ ++ void (*read_adapter_info)(_adapter *padapter); ++ ++ void (*enable_interrupt)(_adapter *padapter); ++ void (*disable_interrupt)(_adapter *padapter); ++ s32 (*interrupt_handler)(_adapter *padapter); + + void (*set_bwmode_handler)(_adapter *padapter, CHANNEL_WIDTH Bandwidth, u8 Offset); + void (*set_channel_handler)(_adapter *padapter, u8 channel); + void (*set_chnl_bw_handler)(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80); + -+ void (*set_tx_power_level_handler)(_adapter *padapter, u8 channel); -+ void (*get_tx_power_level_handler)(_adapter *padapter, s32 *powerlevel); -+ + void (*hal_dm_watchdog)(_adapter *padapter); -+#ifdef CONFIG_LPS_LCLK_WD_TIMER -+ void (*hal_dm_watchdog_in_lps)(_adapter *padapter); -+#endif + + void (*SetHwRegHandler)(_adapter *padapter, u8 variable,u8* val); + void (*GetHwRegHandler)(_adapter *padapter, u8 variable,u8* val); + -+#ifdef CONFIG_C2H_PACKET_EN -+ void (*SetHwRegHandlerWithBuf)(_adapter *padapter, u8 variable, u8 * pbuf, int len); -+#endif ++ u8 (*GetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void * pValue); ++ u8 (*SetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void * pValue); + -+ u8 (*GetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); -+ u8 (*SetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); -+ -+ void (*GetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1,PVOID pValue2); -+ void (*SetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1,BOOLEAN bSet); ++ void (*GetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void * pValue1,bool bSet); ++ void (*SetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void * pValue1,bool bSet); + + void (*UpdateRAMaskHandler)(_adapter *padapter, u32 mac_id, u8 rssi_level); + void (*SetBeaconRelatedRegistersHandler)(_adapter *padapter); + -+ void (*Add_RateATid)(_adapter *padapter, u64 bitmap, u8 *arg, u8 rssi_level); -+ ++ void (*Add_RateATid)(_adapter *padapter, u32 bitmap, u8* arg, u8 rssi_level); ++#ifdef CONFIG_CONCURRENT_MODE ++ void (*clone_haldata)(_adapter *dst_padapter, _adapter *src_padapter); ++#endif ++ void (*run_thread)(_adapter *padapter); ++ void (*cancel_thread)(_adapter *padapter); + +#ifdef CONFIG_ANTENNA_DIVERSITY + u8 (*AntDivBeforeLinkHandler)(_adapter *padapter); @@ -305434,6 +135118,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 +#endif + u8 (*interface_ps_func)(_adapter *padapter,HAL_INTF_PS_FUNC efunc_id, u8* val); + ++ s32 (*hal_xmit)(_adapter *padapter, struct xmit_frame *pxmitframe); ++ s32 (*mgnt_xmit)(_adapter *padapter, struct xmit_frame *pmgntframe); ++ s32 (*hal_xmitframe_enqueue)(_adapter *padapter, struct xmit_frame *pxmitframe); + + u32 (*read_bbreg)(_adapter *padapter, u32 RegAddr, u32 BitMask); + void (*write_bbreg)(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); @@ -305445,18 +135132,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 +#endif + + void (*EfusePowerSwitch)(_adapter *padapter, u8 bWrite, u8 PwrState); -+ void (*BTEfusePowerSwitch)(_adapter *padapter, u8 bWrite, u8 PwrState); -+ void (*ReadEFuse)(_adapter *padapter, u8 efuseType, u16 _offset, u16 _size_byte, u8 *pbuf, BOOLEAN bPseudoTest); -+ void (*EFUSEGetEfuseDefinition)(_adapter *padapter, u8 efuseType, u8 type, void *pOut, BOOLEAN bPseudoTest); -+ u16 (*EfuseGetCurrentSize)(_adapter *padapter, u8 efuseType, BOOLEAN bPseudoTest); -+ int (*Efuse_PgPacketRead)(_adapter *padapter, u8 offset, u8 *data, BOOLEAN bPseudoTest); -+ int (*Efuse_PgPacketWrite)(_adapter *padapter, u8 offset, u8 word_en, u8 *data, BOOLEAN bPseudoTest); -+ u8 (*Efuse_WordEnableDataWrite)(_adapter *padapter, u16 efuse_addr, u8 word_en, u8 *data, BOOLEAN bPseudoTest); -+ BOOLEAN (*Efuse_PgPacketWrite_BT)(_adapter *padapter, u8 offset, u8 word_en, u8 *data, BOOLEAN bPseudoTest); -+ ++ void (*ReadEFuse)(_adapter *padapter, u8 efuseType, u16 _offset, u16 _size_byte, u8 *pbuf, bool bPseudoTest); ++ void (*EFUSEGetEfuseDefinition)(_adapter *padapter, u8 efuseType, u8 type, void *pOut, bool bPseudoTest); ++ u16 (*EfuseGetCurrentSize)(_adapter *padapter, u8 efuseType, bool bPseudoTest); ++ int (*Efuse_PgPacketRead)(_adapter *padapter, u8 offset, u8 *data, bool bPseudoTest); ++ int (*Efuse_PgPacketWrite)(_adapter *padapter, u8 offset, u8 word_en, u8 *data, bool bPseudoTest); ++ u8 (*Efuse_WordEnableDataWrite)(_adapter *padapter, u16 efuse_addr, u8 word_en, u8 *data, bool bPseudoTest); ++ bool (*Efuse_PgPacketWrite_BT)(_adapter *padapter, u8 offset, u8 word_en, u8 *data, bool bPseudoTest); ++ +#ifdef DBG_CONFIG_ERROR_DETECT + void (*sreset_init_value)(_adapter *padapter); -+ void (*sreset_reset_value)(_adapter *padapter); ++ void (*sreset_reset_value)(_adapter *padapter); + void (*silentreset)(_adapter *padapter); + void (*sreset_xmit_status_check)(_adapter *padapter); + void (*sreset_linked_status_check) (_adapter *padapter); @@ -305468,21 +135154,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 + int (*IOL_exec_cmds_sync)(_adapter *padapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt); +#endif + -+ void (*hal_notch_filter)(_adapter * adapter, bool enable); -+ s32 (*c2h_handler)(_adapter *padapter, u8 *c2h_evt); -+ c2h_id_filter c2h_id_filter_ccx; -+ s32 (*fill_h2c_cmd)(PADAPTER, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+ void (*fill_fake_txdesc)(PADAPTER, u8 *pDesc, u32 BufferLen, -+ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ void (*hal_set_wowlan_fw)(_adapter *adapter, u8 sleep); -+ void (*clear_interrupt)(_adapter *padapter); -+#endif -+ u8 (*hal_get_tx_buff_rsvd_page_num)(_adapter *adapter, bool wowlan); -+#ifdef CONFIG_GPIO_API -+ void (*update_hisr_hsisr_ind)(PADAPTER padapter, u32 flag); ++#ifdef CONFIG_XMIT_THREAD_MODE ++ s32 (*xmit_thread_handler)(_adapter *padapter); +#endif ++ void (*hal_notch_filter)(_adapter * adapter, bool enable); ++ void (*hal_reset_security_engine)(_adapter * adapter); ++ s32 (*c2h_handler)(_adapter *padapter, struct c2h_evt_hdr *c2h_evt); ++ c2h_id_filter c2h_id_filter_ccx; +}; + +typedef enum _RT_EEPROM_TYPE{ @@ -305494,12 +135172,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 + + +#define RF_CHANGE_BY_INIT 0 -+#define RF_CHANGE_BY_IPS BIT28 -+#define RF_CHANGE_BY_PS BIT29 -+#define RF_CHANGE_BY_HW BIT30 -+#define RF_CHANGE_BY_SW BIT31 ++#define RF_CHANGE_BY_IPS BIT28 ++#define RF_CHANGE_BY_PS BIT29 ++#define RF_CHANGE_BY_HW BIT30 ++#define RF_CHANGE_BY_SW BIT31 + +typedef enum _HARDWARE_TYPE{ ++ HARDWARE_TYPE_RTL8180, ++ HARDWARE_TYPE_RTL8185, ++ HARDWARE_TYPE_RTL8187, ++ HARDWARE_TYPE_RTL8188, ++ HARDWARE_TYPE_RTL8190P, ++ HARDWARE_TYPE_RTL8192E, ++ HARDWARE_TYPE_RTL819xU, ++ HARDWARE_TYPE_RTL8192SE, ++ HARDWARE_TYPE_RTL8192SU, ++ HARDWARE_TYPE_RTL8192CE, ++ HARDWARE_TYPE_RTL8192CU, ++ HARDWARE_TYPE_RTL8192DE, ++ HARDWARE_TYPE_RTL8192DU, ++ HARDWARE_TYPE_RTL8723AE, ++ HARDWARE_TYPE_RTL8723AU, ++ HARDWARE_TYPE_RTL8723AS, + HARDWARE_TYPE_RTL8188EE, + HARDWARE_TYPE_RTL8188EU, + HARDWARE_TYPE_RTL8188ES, @@ -305516,46 +135210,63 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 + HARDWARE_TYPE_RTL8723BE, + HARDWARE_TYPE_RTL8723BU, + HARDWARE_TYPE_RTL8723BS, -+ HARDWARE_TYPE_RTL8814AE, -+ HARDWARE_TYPE_RTL8814AU, -+ HARDWARE_TYPE_RTL8814AS, -+ HARDWARE_TYPE_RTL8821BE, -+ HARDWARE_TYPE_RTL8821BU, -+ HARDWARE_TYPE_RTL8821BS, -+ HARDWARE_TYPE_RTL8822BE, -+ HARDWARE_TYPE_RTL8822BU, -+ HARDWARE_TYPE_RTL8822BS, -+ HARDWARE_TYPE_RTL8703BE, -+ HARDWARE_TYPE_RTL8703BU, -+ HARDWARE_TYPE_RTL8703BS, -+ HARDWARE_TYPE_RTL8188FE, -+ HARDWARE_TYPE_RTL8188FU, -+ HARDWARE_TYPE_RTL8188FS, ++ + HARDWARE_TYPE_MAX, +}HARDWARE_TYPE; + -+#define IS_NEW_GENERATION_IC(_Adapter) (rtw_get_hw_type(_Adapter) >= HARDWARE_TYPE_RTL8192EE) ++#define IS_NEW_GENERATION_IC(_Adapter) (((PADAPTER)_Adapter)->HardwareType >=HARDWARE_TYPE_RTL8192EE) ++// ++// RTL8192C Series ++// ++#define IS_HARDWARE_TYPE_8192CE(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192CE) ++#define IS_HARDWARE_TYPE_8192CU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192CU) ++#define IS_HARDWARE_TYPE_8192C(_Adapter) \ ++(IS_HARDWARE_TYPE_8192CE(_Adapter) || IS_HARDWARE_TYPE_8192CU(_Adapter)) ++ ++// ++// RTL8192D Series ++// ++#define IS_HARDWARE_TYPE_8192DE(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192DE) ++#define IS_HARDWARE_TYPE_8192DU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192DU) ++#define IS_HARDWARE_TYPE_8192D(_Adapter) \ ++(IS_HARDWARE_TYPE_8192DE(_Adapter) || IS_HARDWARE_TYPE_8192DU(_Adapter)) ++ ++// ++// RTL8723A Series ++// ++#define IS_HARDWARE_TYPE_8723AE(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8723AE) ++#define IS_HARDWARE_TYPE_8723AU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8723AU) ++#define IS_HARDWARE_TYPE_8723AS(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8723AS) ++#define IS_HARDWARE_TYPE_8723A(_Adapter) \ ++(IS_HARDWARE_TYPE_8723AE(_Adapter) || IS_HARDWARE_TYPE_8723AU(_Adapter) || IS_HARDWARE_TYPE_8723AS(_Adapter)) ++ +// +// RTL8188E Series +// -+#define IS_HARDWARE_TYPE_8188EE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188EE) -+#define IS_HARDWARE_TYPE_8188EU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188EU) -+#define IS_HARDWARE_TYPE_8188ES(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188ES) ++#define IS_HARDWARE_TYPE_8188EE(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8188EE) ++#define IS_HARDWARE_TYPE_8188EU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8188EU) ++#define IS_HARDWARE_TYPE_8188ES(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8188ES) +#define IS_HARDWARE_TYPE_8188E(_Adapter) \ +(IS_HARDWARE_TYPE_8188EE(_Adapter) || IS_HARDWARE_TYPE_8188EU(_Adapter) || IS_HARDWARE_TYPE_8188ES(_Adapter)) + ++#define IS_HARDWARE_TYPE_OLDER_THAN_8812A(_Adapter) \ ++(IS_HARDWARE_TYPE_8192D(_Adapter) || IS_HARDWARE_TYPE_8192C(_Adapter) ||\ ++ IS_HARDWARE_TYPE_8723AE(_Adapter) || IS_HARDWARE_TYPE_8723AU(_Adapter) || IS_HARDWARE_TYPE_8723AS(_Adapter) ||\ ++ IS_HARDWARE_TYPE_8188EE(_Adapter) || IS_HARDWARE_TYPE_8188EU(_Adapter) || IS_HARDWARE_TYPE_8188ES(_Adapter)\ ++) ++ +// RTL8812 Series -+#define IS_HARDWARE_TYPE_8812E(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8812E) -+#define IS_HARDWARE_TYPE_8812AU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8812AU) ++#define IS_HARDWARE_TYPE_8812E(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8812E) ++#define IS_HARDWARE_TYPE_8812AU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8812AU) +#define IS_HARDWARE_TYPE_8812(_Adapter) \ +(IS_HARDWARE_TYPE_8812E(_Adapter) || IS_HARDWARE_TYPE_8812AU(_Adapter)) + +// RTL8821 Series -+#define IS_HARDWARE_TYPE_8821E(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821E) -+#define IS_HARDWARE_TYPE_8811AU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8811AU) -+#define IS_HARDWARE_TYPE_8821U(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821U || \ -+ rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8811AU) -+#define IS_HARDWARE_TYPE_8821S(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821S) ++#define IS_HARDWARE_TYPE_8821E(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8821E) ++#define IS_HARDWARE_TYPE_8811AU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8811AU) ++#define IS_HARDWARE_TYPE_8821U(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8821U ||\ ++ ((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8811AU) ++#define IS_HARDWARE_TYPE_8821S(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8821S) +#define IS_HARDWARE_TYPE_8821(_Adapter) \ +(IS_HARDWARE_TYPE_8821E(_Adapter) || IS_HARDWARE_TYPE_8821U(_Adapter)|| IS_HARDWARE_TYPE_8821S(_Adapter)) + @@ -305563,91 +135274,57 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 +(IS_HARDWARE_TYPE_8812(_Adapter) || IS_HARDWARE_TYPE_8821(_Adapter)) + +//RTL8192E Series -+#define IS_HARDWARE_TYPE_8192EE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192EE) -+#define IS_HARDWARE_TYPE_8192EU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192EU) -+#define IS_HARDWARE_TYPE_8192ES(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192ES) ++#define IS_HARDWARE_TYPE_8192EE(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192EE) ++#define IS_HARDWARE_TYPE_8192EU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192EU) ++#define IS_HARDWARE_TYPE_8192ES(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192ES) + +#define IS_HARDWARE_TYPE_8192E(_Adapter) \ +(IS_HARDWARE_TYPE_8192EE(_Adapter) || IS_HARDWARE_TYPE_8192EU(_Adapter) ||IS_HARDWARE_TYPE_8192ES(_Adapter)) + -+#define IS_HARDWARE_TYPE_8723BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723BE) -+#define IS_HARDWARE_TYPE_8723BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723BU) -+#define IS_HARDWARE_TYPE_8723BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723BS) ++#define IS_HARDWARE_TYPE_8723BE(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8723BE) ++#define IS_HARDWARE_TYPE_8723BU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8723BU) ++#define IS_HARDWARE_TYPE_8723BS(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8723BS) ++ + +#define IS_HARDWARE_TYPE_8723B(_Adapter) \ + (IS_HARDWARE_TYPE_8723BE(_Adapter) || IS_HARDWARE_TYPE_8723BU(_Adapter) ||IS_HARDWARE_TYPE_8723BS(_Adapter)) + -+/* RTL8814A Series */ -+#define IS_HARDWARE_TYPE_8814AE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814AE) -+#define IS_HARDWARE_TYPE_8814AU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814AU) -+#define IS_HARDWARE_TYPE_8814AS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814AS) ++typedef struct eeprom_priv EEPROM_EFUSE_PRIV, *PEEPROM_EFUSE_PRIV; ++#define GET_EEPROM_EFUSE_PRIV(adapter) (&adapter->eeprompriv) ++#define is_boot_from_eeprom(adapter) (adapter->eeprompriv.EepromOrEfuse) + -+#define IS_HARDWARE_TYPE_8814A(_Adapter) \ -+(IS_HARDWARE_TYPE_8814AE(_Adapter) || IS_HARDWARE_TYPE_8814AU(_Adapter) || IS_HARDWARE_TYPE_8814AS(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_JAGUAR2(_Adapter) \ -+(IS_HARDWARE_TYPE_8814A(_Adapter) || IS_HARDWARE_TYPE_8821B(_Adapter) || IS_HARDWARE_TYPE_8822B(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(_Adapter) \ -+(IS_HARDWARE_TYPE_JAGUAR(_Adapter) || IS_HARDWARE_TYPE_JAGUAR2(_Adapter)) -+ -+/* RTL8703B Series */ -+#define IS_HARDWARE_TYPE_8703BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8703BE) -+#define IS_HARDWARE_TYPE_8703BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8703BS) -+#define IS_HARDWARE_TYPE_8703BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8703BU) -+#define IS_HARDWARE_TYPE_8703B(_Adapter) \ -+(IS_HARDWARE_TYPE_8703BE(_Adapter) || IS_HARDWARE_TYPE_8703BU(_Adapter) || IS_HARDWARE_TYPE_8703BS(_Adapter)) -+ -+/* RTL8188F Series */ -+#define IS_HARDWARE_TYPE_8188FE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188FE) -+#define IS_HARDWARE_TYPE_8188FS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188FS) -+#define IS_HARDWARE_TYPE_8188FU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188FU) -+#define IS_HARDWARE_TYPE_8188F(_Adapter) \ -+(IS_HARDWARE_TYPE_8188FE(_Adapter) || IS_HARDWARE_TYPE_8188FU(_Adapter) || IS_HARDWARE_TYPE_8188FS(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_8821BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821BE) -+#define IS_HARDWARE_TYPE_8821BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821BU) -+#define IS_HARDWARE_TYPE_8821BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821BS) -+ -+#define IS_HARDWARE_TYPE_8821B(_Adapter) \ -+(IS_HARDWARE_TYPE_8821BE(_Adapter) || IS_HARDWARE_TYPE_8821BU(_Adapter) || IS_HARDWARE_TYPE_8821BS(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_8822BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822BE) -+#define IS_HARDWARE_TYPE_8822BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822BU) -+#define IS_HARDWARE_TYPE_8822BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822BS) -+#define IS_HARDWARE_TYPE_8822B(_Adapter) \ -+(IS_HARDWARE_TYPE_8822BE(_Adapter) || IS_HARDWARE_TYPE_8822BU(_Adapter) || IS_HARDWARE_TYPE_8822BS(_Adapter)) -+ -+ -+ -+typedef enum _wowlan_subcode { -+ WOWLAN_ENABLE = 0, -+ WOWLAN_DISABLE = 1, -+ WOWLAN_AP_ENABLE = 2, -+ WOWLAN_AP_DISABLE = 3, -+ WOWLAN_PATTERN_CLEAN = 4 -+} wowlan_subcode; ++#ifdef CONFIG_WOWLAN ++typedef enum _wowlan_subcode{ ++ WOWLAN_PATTERN_MATCH = 1, ++ WOWLAN_MAGIC_PACKET = 2, ++ WOWLAN_UNICAST = 3, ++ WOWLAN_SET_PATTERN = 4, ++ WOWLAN_DUMP_REG = 5, ++ WOWLAN_ENABLE = 6, ++ WOWLAN_DISABLE = 7, ++ WOWLAN_STATUS = 8, ++ WOWLAN_DEBUG_RELOAD_FW = 9, ++ WOWLAN_DEBUG_1 =10, ++ WOWLAN_DEBUG_2 =11 ++}wowlan_subcode; + +struct wowlan_ioctl_param{ + unsigned int subcode; + unsigned int subcode_value; + unsigned int wakeup_reason; ++ unsigned int len; ++ unsigned char pattern[0]; +}; + +#define Rx_Pairwisekey 0x01 +#define Rx_GTK 0x02 +#define Rx_DisAssoc 0x04 +#define Rx_DeAuth 0x08 -+#define Rx_ARPReq 0x09 +#define FWDecisionDisconnect 0x10 +#define Rx_MagicPkt 0x21 +#define Rx_UnicastPkt 0x22 +#define Rx_PatternPkt 0x23 -+#define RX_PNOWakeUp 0x55 -+#define AP_WakeUp 0x66 -+ -+u8 rtw_hal_data_init(_adapter *padapter); -+void rtw_hal_data_deinit(_adapter *padapter); ++#endif // CONFIG_WOWLAN + +void rtw_hal_def_value_init(_adapter *padapter); + @@ -305659,41 +135336,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 +void rtw_hal_sw_led_deinit(_adapter *padapter); + +u32 rtw_hal_power_on(_adapter *padapter); -+void rtw_hal_power_off(_adapter *padapter); -+ +uint rtw_hal_init(_adapter *padapter); +uint rtw_hal_deinit(_adapter *padapter); +void rtw_hal_stop(_adapter *padapter); +void rtw_hal_set_hwreg(PADAPTER padapter, u8 variable, u8 *val); +void rtw_hal_get_hwreg(PADAPTER padapter, u8 variable, u8 *val); + -+#ifdef CONFIG_C2H_PACKET_EN -+void rtw_hal_set_hwreg_with_buf(_adapter *padapter, u8 variable, u8 *pbuf, int len); -+#endif -+ +void rtw_hal_chip_configure(_adapter *padapter); +void rtw_hal_read_chip_info(_adapter *padapter); +void rtw_hal_read_chip_version(_adapter *padapter); + -+u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); -+u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); ++u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void * pValue); ++u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void * pValue); + -+void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1,BOOLEAN bSet); -+void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1,PVOID pValue2); ++void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void * pValue1,bool bSet); ++void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void * pValue1,bool bSet); + +void rtw_hal_enable_interrupt(_adapter *padapter); +void rtw_hal_disable_interrupt(_adapter *padapter); + -+u8 rtw_hal_check_ips_status(_adapter *padapter); -+ -+#if defined(CONFIG_USB_HCI)||defined(CONFIG_PCI_HCI) +u32 rtw_hal_inirp_init(_adapter *padapter); +u32 rtw_hal_inirp_deinit(_adapter *padapter); -+#endif -+ -+#if defined(CONFIG_PCI_HCI) -+void rtw_hal_irp_reset(_adapter *padapter); -+#endif + +u8 rtw_hal_intf_ps_func(_adapter *padapter,HAL_INTF_PS_FUNC efunc_id, u8* val); + @@ -305708,8 +135371,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 +void rtw_hal_free_recv_priv(_adapter *padapter); + +void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level); -+void rtw_hal_add_ra_tid(_adapter *padapter, u64 bitmap, u8 *arg, u8 rssi_level); -+ ++void rtw_hal_add_ra_tid(_adapter *padapter, u32 bitmap, u8* arg, u8 rssi_level); ++void rtw_hal_clone_data(_adapter *dst_padapter, _adapter *src_padapter); +void rtw_hal_start_thread(_adapter *padapter); +void rtw_hal_stop_thread(_adapter *padapter); + @@ -305725,24 +135388,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 +#define PHY_QueryRFReg(Adapter, eRFPath, RegAddr, BitMask) rtw_hal_read_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask)) +#define PHY_SetRFReg(Adapter, eRFPath, RegAddr, BitMask, Data) rtw_hal_write_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask), (Data)) + -+#define PHY_SetMacReg PHY_SetBBReg -+#define PHY_QueryMacReg PHY_QueryBBReg -+ -+#if defined(CONFIG_PCI_HCI) +s32 rtw_hal_interrupt_handler(_adapter *padapter); -+#endif -+#if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) -+void rtw_hal_interrupt_handler(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif + +void rtw_hal_set_bwmode(_adapter *padapter, CHANNEL_WIDTH Bandwidth, u8 Offset); +void rtw_hal_set_chan(_adapter *padapter, u8 channel); +void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80); +void rtw_hal_dm_watchdog(_adapter *padapter); -+void rtw_hal_dm_watchdog_in_lps(_adapter *padapter); -+ -+void rtw_hal_set_tx_power_level(_adapter *padapter, u8 channel); -+void rtw_hal_get_tx_power_level(_adapter *padapter, s32 *powerlevel); + +#ifdef CONFIG_ANTENNA_DIVERSITY +u8 rtw_hal_antdiv_before_linked(_adapter *padapter); @@ -305772,667 +135423,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_intf.h linux/3rdparty/rtl881 +#endif + +void rtw_hal_notch_filter(_adapter * adapter, bool enable); ++void rtw_hal_reset_security_engine(_adapter * adapter); + -+bool rtw_hal_c2h_valid(_adapter *adapter, u8 *buf); -+s32 rtw_hal_c2h_evt_read(_adapter *adapter, u8 *buf); -+s32 rtw_hal_c2h_handler(_adapter *adapter, u8 *c2h_evt); ++s32 rtw_hal_c2h_handler(_adapter *adapter, struct c2h_evt_hdr *c2h_evt); +c2h_id_filter rtw_hal_c2h_id_filter_ccx(_adapter *adapter); + -+s32 rtw_hal_is_disable_sw_channel_plan(PADAPTER padapter); -+ -+s32 rtw_hal_macid_sleep(PADAPTER padapter, u8 macid); -+s32 rtw_hal_macid_wakeup(PADAPTER padapter, u8 macid); -+ -+s32 rtw_hal_fill_h2c_cmd(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+void rtw_hal_fill_fake_txdesc(_adapter *padapter, u8 *pDesc, u32 BufferLen, -+ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+u8 rtw_hal_get_txbuff_rsvd_page_num(_adapter *adapter, bool wowlan); -+ -+#ifdef CONFIG_GPIO_API -+void rtw_hal_update_hisr_hsisr_ind(_adapter *padapter, u32 flag); -+#endif -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void rtw_hal_clear_interrupt(_adapter *padapter); -+void rtw_hal_set_wowlan_fw(_adapter *padapter, u8 sleep); -+#endif -+u8 rtw_hal_ops_check(_adapter *padapter); -+ +#endif //__HAL_INTF_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_pg.h linux/3rdparty/rtl8812au/include/hal_pg.h ---- linux.old/3rdparty/rtl8812au/include/hal_pg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_pg.h 2017-06-07 23:07:21.037689945 +0300 -@@ -0,0 +1,621 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL_PG_H__ -+#define __HAL_PG_H__ -+ -+#define PPG_BB_GAIN_2G_TX_OFFSET_MASK 0x0F -+#define PPG_BB_GAIN_2G_TXB_OFFSET_MASK 0xF0 -+ -+#define PPG_BB_GAIN_5G_TX_OFFSET_MASK 0x1F -+#define PPG_THERMAL_OFFSET_MASK 0x1F -+#define KFREE_BB_GAIN_2G_TX_OFFSET(_ppg_v) (((_ppg_v) == PPG_BB_GAIN_2G_TX_OFFSET_MASK) ? 0 : (((_ppg_v) & 0x01) ? ((_ppg_v) >> 1) : (-((_ppg_v) >> 1)))) -+#define KFREE_BB_GAIN_5G_TX_OFFSET(_ppg_v) (((_ppg_v) == PPG_BB_GAIN_5G_TX_OFFSET_MASK) ? 0 : (((_ppg_v) & 0x01) ? ((_ppg_v) >> 1) : (-((_ppg_v) >> 1)))) -+#define KFREE_THERMAL_OFFSET(_ppg_v) (((_ppg_v) == PPG_THERMAL_OFFSET_MASK) ? 0 : (((_ppg_v) & 0x01) ? ((_ppg_v) >> 1) : (-((_ppg_v) >> 1)))) -+ -+//==================================================== -+// EEPROM/Efuse PG Offset for 88EE/88EU/88ES -+//==================================================== -+#define EEPROM_TX_PWR_INX_88E 0x10 -+ -+#define EEPROM_ChannelPlan_88E 0xB8 -+#define EEPROM_XTAL_88E 0xB9 -+#define EEPROM_THERMAL_METER_88E 0xBA -+#define EEPROM_IQK_LCK_88E 0xBB -+ -+#define EEPROM_RF_BOARD_OPTION_88E 0xC1 -+#define EEPROM_RF_FEATURE_OPTION_88E 0xC2 -+#define EEPROM_RF_BT_SETTING_88E 0xC3 -+#define EEPROM_VERSION_88E 0xC4 -+#define EEPROM_CustomID_88E 0xC5 -+#define EEPROM_RF_ANTENNA_OPT_88E 0xC9 -+ -+// RTL88EE -+#define EEPROM_MAC_ADDR_88EE 0xD0 -+#define EEPROM_VID_88EE 0xD6 -+#define EEPROM_DID_88EE 0xD8 -+#define EEPROM_SVID_88EE 0xDA -+#define EEPROM_SMID_88EE 0xDC -+ -+//RTL88EU -+#define EEPROM_MAC_ADDR_88EU 0xD7 -+#define EEPROM_VID_88EU 0xD0 -+#define EEPROM_PID_88EU 0xD2 -+#define EEPROM_USB_OPTIONAL_FUNCTION0 0xD4 //8188EU,8192EU, 8812AU is the same -+#define EEPROM_USB_OPTIONAL_FUNCTION0_8811AU 0x104 -+ -+// RTL88ES -+#define EEPROM_MAC_ADDR_88ES 0x11A -+//==================================================== -+// EEPROM/Efuse PG Offset for 8192EE/8192EU/8192ES -+//==================================================== -+#define GET_PG_KFREE_ON_8192E(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8192E(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+ -+#define PPG_BB_GAIN_2G_TXA_OFFSET_8192E 0x1F6 -+#define PPG_THERMAL_OFFSET_8192E 0x1F5 -+ -+// 0x10 ~ 0x63 = TX power area. -+#define EEPROM_TX_PWR_INX_8192E 0x10 -+ -+#define EEPROM_ChannelPlan_8192E 0xB8 -+#define EEPROM_XTAL_8192E 0xB9 -+#define EEPROM_THERMAL_METER_8192E 0xBA -+#define EEPROM_IQK_LCK_8192E 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8192E 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8192E 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8192E 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8192E 0xC1 -+#define EEPROM_RF_FEATURE_OPTION_8192E 0xC2 -+#define EEPROM_RF_BT_SETTING_8192E 0xC3 -+#define EEPROM_VERSION_8192E 0xC4 -+#define EEPROM_CustomID_8192E 0xC5 -+#define EEPROM_TX_BBSWING_2G_8192E 0xC6 -+#define EEPROM_TX_BBSWING_5G_8192E 0xC7 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8192E 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8192E 0xC9 -+#define EEPROM_RFE_OPTION_8192E 0xCA -+ -+// RTL8192EE -+#define EEPROM_MAC_ADDR_8192EE 0xD0 -+#define EEPROM_VID_8192EE 0xD6 -+#define EEPROM_DID_8192EE 0xD8 -+#define EEPROM_SVID_8192EE 0xDA -+#define EEPROM_SMID_8192EE 0xDC -+ -+//RTL8192EU -+#define EEPROM_MAC_ADDR_8192EU 0xD7 -+#define EEPROM_VID_8192EU 0xD0 -+#define EEPROM_PID_8192EU 0xD2 -+#define EEPROM_PA_TYPE_8192EU 0xBC -+#define EEPROM_LNA_TYPE_2G_8192EU 0xBD -+#define EEPROM_LNA_TYPE_5G_8192EU 0xBF -+ -+// RTL8192ES -+#define EEPROM_MAC_ADDR_8192ES 0x11A -+//==================================================== -+// EEPROM/Efuse PG Offset for 8812AE/8812AU/8812AS -+//==================================================== -+// 0x10 ~ 0x63 = TX power area. -+#define EEPROM_USB_MODE_8812 0x08 -+#define EEPROM_TX_PWR_INX_8812 0x10 -+ -+#define EEPROM_ChannelPlan_8812 0xB8 -+#define EEPROM_XTAL_8812 0xB9 -+#define EEPROM_THERMAL_METER_8812 0xBA -+#define EEPROM_IQK_LCK_8812 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8812 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8812 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8812 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8812 0xC1 -+#define EEPROM_RF_FEATURE_OPTION_8812 0xC2 -+#define EEPROM_RF_BT_SETTING_8812 0xC3 -+#define EEPROM_VERSION_8812 0xC4 -+#define EEPROM_CustomID_8812 0xC5 -+#define EEPROM_TX_BBSWING_2G_8812 0xC6 -+#define EEPROM_TX_BBSWING_5G_8812 0xC7 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8812 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8812 0xC9 -+#define EEPROM_RFE_OPTION_8812 0xCA -+ -+// RTL8812AE -+#define EEPROM_MAC_ADDR_8812AE 0xD0 -+#define EEPROM_VID_8812AE 0xD6 -+#define EEPROM_DID_8812AE 0xD8 -+#define EEPROM_SVID_8812AE 0xDA -+#define EEPROM_SMID_8812AE 0xDC -+ -+//RTL8812AU -+#define EEPROM_MAC_ADDR_8812AU 0xD7 -+#define EEPROM_VID_8812AU 0xD0 -+#define EEPROM_PID_8812AU 0xD2 -+#define EEPROM_PA_TYPE_8812AU 0xBC -+#define EEPROM_LNA_TYPE_2G_8812AU 0xBD -+#define EEPROM_LNA_TYPE_5G_8812AU 0xBF -+ -+//RTL8814AU -+#define EEPROM_MAC_ADDR_8814AU 0xD8 -+#define EEPROM_VID_8814AU 0xD0 -+#define EEPROM_PID_8814AU 0xD2 -+#define EEPROM_PA_TYPE_8814AU 0xBC -+#define EEPROM_LNA_TYPE_2G_8814AU 0xBD -+#define EEPROM_LNA_TYPE_5G_8814AU 0xBF -+ -+/* RTL8814AE */ -+#define EEPROM_MAC_ADDR_8814AE 0xD0 -+#define EEPROM_VID_8814AE 0xD6 -+#define EEPROM_DID_8814AE 0xD8 -+#define EEPROM_SVID_8814AE 0xDA -+#define EEPROM_SMID_8814AE 0xDC -+ -+//==================================================== -+// EEPROM/Efuse PG Offset for 8814AU -+//==================================================== -+#define GET_PG_KFREE_ON_8814A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8814A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+ -+#define KFREE_GAIN_DATA_LENGTH_8814A 22 -+ -+#define PPG_BB_GAIN_2G_TXBA_OFFSET_8814A 0x3EE -+ -+#define PPG_THERMAL_OFFSET_8814A 0x3EF -+ -+#define EEPROM_TX_PWR_INX_8814 0x10 -+#define EEPROM_ChannelPlan_8814 0xB8 -+#define EEPROM_XTAL_8814 0xB9 -+#define EEPROM_THERMAL_METER_8814 0xBA -+#define EEPROM_IQK_LCK_8814 0xBB -+ -+ -+#define EEPROM_PA_TYPE_8814 0xBC -+#define EEPROM_LNA_TYPE_AB_2G_8814 0xBD -+#define EEPROM_LNA_TYPE_CD_2G_8814 0xBE -+#define EEPROM_LNA_TYPE_AB_5G_8814 0xBF -+#define EEPROM_LNA_TYPE_CD_5G_8814 0xC0 -+#define EEPROM_RF_BOARD_OPTION_8814 0xC1 -+#define EEPROM_RF_BT_SETTING_8814 0xC3 -+#define EEPROM_VERSION_8814 0xC4 -+#define EEPROM_CustomID_8814 0xC5 -+#define EEPROM_TX_BBSWING_2G_8814 0xC6 -+#define EEPROM_TX_BBSWING_5G_8814 0xC7 -+#define EEPROM_TRX_ANTENNA_OPTION_8814 0xC9 -+#define EEPROM_RFE_OPTION_8814 0xCA -+ -+//==================================================== -+// EEPROM/Efuse PG Offset for 8821AE/8821AU/8821AS -+//==================================================== -+ -+#define GET_PG_KFREE_ON_8821A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8821A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+ -+#define PPG_BB_GAIN_2G_TXA_OFFSET_8821A 0x1F6 -+#define PPG_THERMAL_OFFSET_8821A 0x1F5 -+#define PPG_BB_GAIN_5GLB1_TXA_OFFSET_8821A 0x1F4 -+#define PPG_BB_GAIN_5GLB2_TXA_OFFSET_8821A 0x1F3 -+#define PPG_BB_GAIN_5GMB1_TXA_OFFSET_8821A 0x1F2 -+#define PPG_BB_GAIN_5GMB2_TXA_OFFSET_8821A 0x1F1 -+#define PPG_BB_GAIN_5GHB_TXA_OFFSET_8821A 0x1F0 -+ -+#define EEPROM_TX_PWR_INX_8821 0x10 -+ -+#define EEPROM_ChannelPlan_8821 0xB8 -+#define EEPROM_XTAL_8821 0xB9 -+#define EEPROM_THERMAL_METER_8821 0xBA -+#define EEPROM_IQK_LCK_8821 0xBB -+ -+ -+#define EEPROM_RF_BOARD_OPTION_8821 0xC1 -+#define EEPROM_RF_FEATURE_OPTION_8821 0xC2 -+#define EEPROM_RF_BT_SETTING_8821 0xC3 -+#define EEPROM_VERSION_8821 0xC4 -+#define EEPROM_CustomID_8821 0xC5 -+#define EEPROM_RF_ANTENNA_OPT_8821 0xC9 -+ -+// RTL8821AE -+#define EEPROM_MAC_ADDR_8821AE 0xD0 -+#define EEPROM_VID_8821AE 0xD6 -+#define EEPROM_DID_8821AE 0xD8 -+#define EEPROM_SVID_8821AE 0xDA -+#define EEPROM_SMID_8821AE 0xDC -+ -+//RTL8821AU -+#define EEPROM_PA_TYPE_8821AU 0xBC -+#define EEPROM_LNA_TYPE_8821AU 0xBF -+ -+// RTL8821AS -+#define EEPROM_MAC_ADDR_8821AS 0x11A -+ -+//RTL8821AU -+#define EEPROM_MAC_ADDR_8821AU 0x107 -+#define EEPROM_VID_8821AU 0x100 -+#define EEPROM_PID_8821AU 0x102 -+ -+ -+//==================================================== -+// EEPROM/Efuse PG Offset for 8192 SE/SU -+//==================================================== -+#define EEPROM_VID_92SE 0x0A -+#define EEPROM_DID_92SE 0x0C -+#define EEPROM_SVID_92SE 0x0E -+#define EEPROM_SMID_92SE 0x10 -+ -+#define EEPROM_MAC_ADDR_92S 0x12 -+ -+#define EEPROM_TSSI_A_92SE 0x74 -+#define EEPROM_TSSI_B_92SE 0x75 -+ -+#define EEPROM_Version_92SE 0x7C -+ -+ -+#define EEPROM_VID_92SU 0x08 -+#define EEPROM_PID_92SU 0x0A -+ -+#define EEPROM_Version_92SU 0x50 -+#define EEPROM_TSSI_A_92SU 0x6b -+#define EEPROM_TSSI_B_92SU 0x6c -+ -+/* ==================================================== -+ EEPROM/Efuse PG Offset for 8188FE/8188FU/8188FS -+ ==================================================== -+ */ -+ -+#define GET_PG_KFREE_ON_8188F(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8188F(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+ -+#define PPG_BB_GAIN_2G_TXA_OFFSET_8188F 0xEE -+#define PPG_THERMAL_OFFSET_8188F 0xEF -+ -+/* 0x10 ~ 0x63 = TX power area. */ -+#define EEPROM_TX_PWR_INX_8188F 0x10 -+ -+#define EEPROM_ChannelPlan_8188F 0xB8 -+#define EEPROM_XTAL_8188F 0xB9 -+#define EEPROM_THERMAL_METER_8188F 0xBA -+#define EEPROM_IQK_LCK_8188F 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8188F 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8188F 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8188F 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8188F 0xC1 -+#define EEPROM_FEATURE_OPTION_8188F 0xC2 -+#define EEPROM_RF_BT_SETTING_8188F 0xC3 -+#define EEPROM_VERSION_8188F 0xC4 -+#define EEPROM_CustomID_8188F 0xC5 -+#define EEPROM_TX_BBSWING_2G_8188F 0xC6 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8188F 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8188F 0xC9 -+#define EEPROM_RFE_OPTION_8188F 0xCA -+#define EEPROM_CUSTOMER_ID_8188F 0x7F -+#define EEPROM_SUBCUSTOMER_ID_8188F 0x59 -+ -+/* RTL8188FU */ -+#define EEPROM_MAC_ADDR_8188FU 0xD7 -+#define EEPROM_VID_8188FU 0xD0 -+#define EEPROM_PID_8188FU 0xD2 -+#define EEPROM_PA_TYPE_8188FU 0xBC -+#define EEPROM_LNA_TYPE_2G_8188FU 0xBD -+#define EEPROM_USB_OPTIONAL_FUNCTION0_8188FU 0xD4 -+ -+/* RTL8188FS */ -+#define EEPROM_MAC_ADDR_8188FS 0x11A -+#define EEPROM_Voltage_ADDR_8188F 0x8 -+ -+//==================================================== -+// EEPROM/Efuse PG Offset for 8723BE/8723BU/8723BS -+//==================================================== -+// 0x10 ~ 0x63 = TX power area. -+#define EEPROM_TX_PWR_INX_8723B 0x10 -+ -+#define EEPROM_ChannelPlan_8723B 0xB8 -+#define EEPROM_XTAL_8723B 0xB9 -+#define EEPROM_THERMAL_METER_8723B 0xBA -+#define EEPROM_IQK_LCK_8723B 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8723B 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8723B 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8723B 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8723B 0xC1 -+#define EEPROM_FEATURE_OPTION_8723B 0xC2 -+#define EEPROM_RF_BT_SETTING_8723B 0xC3 -+#define EEPROM_VERSION_8723B 0xC4 -+#define EEPROM_CustomID_8723B 0xC5 -+#define EEPROM_TX_BBSWING_2G_8723B 0xC6 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8723B 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8723B 0xC9 -+#define EEPROM_RFE_OPTION_8723B 0xCA -+ -+// RTL8723BE -+#define EEPROM_MAC_ADDR_8723BE 0xD0 -+#define EEPROM_VID_8723BE 0xD6 -+#define EEPROM_DID_8723BE 0xD8 -+#define EEPROM_SVID_8723BE 0xDA -+#define EEPROM_SMID_8723BE 0xDC -+ -+//RTL8723BU -+#define EEPROM_MAC_ADDR_8723BU 0x107 -+#define EEPROM_VID_8723BU 0x100 -+#define EEPROM_PID_8723BU 0x102 -+#define EEPROM_PA_TYPE_8723BU 0xBC -+#define EEPROM_LNA_TYPE_2G_8723BU 0xBD -+ -+ -+//RTL8723BS -+#define EEPROM_MAC_ADDR_8723BS 0x11A -+#define EEPROM_Voltage_ADDR_8723B 0x8 -+ -+//==================================================== -+// EEPROM/Efuse PG Offset for 8703BS -+//==================================================== -+#define GET_PG_KFREE_ON_8703B(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8703B(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+ -+#define PPG_BB_GAIN_2G_TXA_OFFSET_8703B 0xEE -+#define PPG_THERMAL_OFFSET_8703B 0xEF -+ -+#define EEPROM_TX_PWR_INX_8703B 0x10 -+ -+#define EEPROM_ChannelPlan_8703B 0xB8 -+#define EEPROM_XTAL_8703B 0xB9 -+#define EEPROM_THERMAL_METER_8703B 0xBA -+#define EEPROM_IQK_LCK_8703B 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8703B 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8703B 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8703B 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8703B 0xC1 -+#define EEPROM_FEATURE_OPTION_8703B 0xC2 -+#define EEPROM_RF_BT_SETTING_8703B 0xC3 -+#define EEPROM_VERSION_8703B 0xC4 -+#define EEPROM_CustomID_8703B 0xC5 -+#define EEPROM_TX_BBSWING_2G_8703B 0xC6 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8703B 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8703B 0xC9 -+#define EEPROM_RFE_OPTION_8703B 0xCA -+ -+//RTL8703BS -+#define EEPROM_MAC_ADDR_8703BS 0x11A -+#define EEPROM_Voltage_ADDR_8703B 0x8 -+ -+//==================================================== -+// EEPROM/Efuse Value Type -+//==================================================== -+#define EETYPE_TX_PWR 0x0 -+//==================================================== -+// EEPROM/Efuse Default Value -+//==================================================== -+#define EEPROM_CID_DEFAULT 0x0 -+#define EEPROM_CID_DEFAULT_EXT 0xFF // Reserved for Realtek -+#define EEPROM_CID_TOSHIBA 0x4 -+#define EEPROM_CID_CCX 0x10 -+#define EEPROM_CID_QMI 0x0D -+#define EEPROM_CID_WHQL 0xFE -+ -+#define EEPROM_CHANNEL_PLAN_FCC 0x0 -+#define EEPROM_CHANNEL_PLAN_IC 0x1 -+#define EEPROM_CHANNEL_PLAN_ETSI 0x2 -+#define EEPROM_CHANNEL_PLAN_SPAIN 0x3 -+#define EEPROM_CHANNEL_PLAN_FRANCE 0x4 -+#define EEPROM_CHANNEL_PLAN_MKK 0x5 -+#define EEPROM_CHANNEL_PLAN_MKK1 0x6 -+#define EEPROM_CHANNEL_PLAN_ISRAEL 0x7 -+#define EEPROM_CHANNEL_PLAN_TELEC 0x8 -+#define EEPROM_CHANNEL_PLAN_GLOBAL_DOMAIN 0x9 -+#define EEPROM_CHANNEL_PLAN_WORLD_WIDE_13 0xA -+#define EEPROM_CHANNEL_PLAN_NCC_TAIWAN 0xB -+#define EEPROM_CHANNEL_PLAN_CHIAN 0XC -+#define EEPROM_CHANNEL_PLAN_SINGAPORE_INDIA_MEXICO 0XD -+#define EEPROM_CHANNEL_PLAN_KOREA 0xE -+#define EEPROM_CHANNEL_PLAN_TURKEY 0xF -+#define EEPROM_CHANNEL_PLAN_JAPAN 0x10 -+#define EEPROM_CHANNEL_PLAN_FCC_NO_DFS 0x11 -+#define EEPROM_CHANNEL_PLAN_JAPAN_NO_DFS 0x12 -+#define EEPROM_CHANNEL_PLAN_WORLD_WIDE_5G 0x13 -+#define EEPROM_CHANNEL_PLAN_TAIWAN_NO_DFS 0x14 -+ -+#define EEPROM_USB_OPTIONAL1 0xE -+#define EEPROM_CHANNEL_PLAN_BY_HW_MASK 0x80 -+ -+#define RTL_EEPROM_ID 0x8129 -+#define EEPROM_Default_TSSI 0x0 -+#define EEPROM_Default_BoardType 0x02 -+#define EEPROM_Default_ThermalMeter 0x12 -+#define EEPROM_Default_ThermalMeter_92SU 0x7 -+#define EEPROM_Default_ThermalMeter_88E 0x18 -+#define EEPROM_Default_ThermalMeter_8812 0x18 -+#define EEPROM_Default_ThermalMeter_8192E 0x1A -+#define EEPROM_Default_ThermalMeter_8723B 0x18 -+#define EEPROM_Default_ThermalMeter_8703B 0x18 -+#define EEPROM_Default_ThermalMeter_8188F 0x18 -+#define EEPROM_Default_ThermalMeter_8814A 0x18 -+ -+ -+#define EEPROM_Default_CrystalCap 0x0 -+#define EEPROM_Default_CrystalCap_8723A 0x20 -+#define EEPROM_Default_CrystalCap_88E 0x20 -+#define EEPROM_Default_CrystalCap_8812 0x20 -+#define EEPROM_Default_CrystalCap_8814 0x20 -+#define EEPROM_Default_CrystalCap_8192E 0x20 -+#define EEPROM_Default_CrystalCap_8723B 0x20 -+#define EEPROM_Default_CrystalCap_8703B 0x20 -+#define EEPROM_Default_CrystalCap_8188F 0x20 -+#define EEPROM_Default_CrystalFreq 0x0 -+#define EEPROM_Default_TxPowerLevel_92C 0x22 -+#define EEPROM_Default_TxPowerLevel_2G 0x2C -+#define EEPROM_Default_TxPowerLevel_5G 0x22 -+#define EEPROM_Default_TxPowerLevel 0x22 -+#define EEPROM_Default_HT40_2SDiff 0x0 -+#define EEPROM_Default_HT20_Diff 2 -+#define EEPROM_Default_LegacyHTTxPowerDiff 0x3 -+#define EEPROM_Default_LegacyHTTxPowerDiff_92C 0x3 -+#define EEPROM_Default_LegacyHTTxPowerDiff_92D 0x4 -+#define EEPROM_Default_HT40_PwrMaxOffset 0 -+#define EEPROM_Default_HT20_PwrMaxOffset 0 -+ -+#define EEPROM_Default_PID 0x1234 -+#define EEPROM_Default_VID 0x5678 -+#define EEPROM_Default_CustomerID 0xAB -+#define EEPROM_Default_CustomerID_8188E 0x00 -+#define EEPROM_Default_SubCustomerID 0xCD -+#define EEPROM_Default_Version 0 -+ -+#define EEPROM_Default_externalPA_C9 0x00 -+#define EEPROM_Default_externalPA_CC 0xFF -+#define EEPROM_Default_internalPA_SP3T_C9 0xAA -+#define EEPROM_Default_internalPA_SP3T_CC 0xAF -+#define EEPROM_Default_internalPA_SPDT_C9 0xAA -+#ifdef CONFIG_PCI_HCI -+#define EEPROM_Default_internalPA_SPDT_CC 0xA0 -+#else -+#define EEPROM_Default_internalPA_SPDT_CC 0xFA -+#endif -+#define EEPROM_Default_PAType 0 -+#define EEPROM_Default_LNAType 0 -+ -+//New EFUSE deafult value -+#define EEPROM_DEFAULT_24G_INDEX 0x2D -+#define EEPROM_DEFAULT_24G_HT20_DIFF 0X02 -+#define EEPROM_DEFAULT_24G_OFDM_DIFF 0X04 -+ -+#define EEPROM_DEFAULT_5G_INDEX 0X2A -+#define EEPROM_DEFAULT_5G_HT20_DIFF 0X00 -+#define EEPROM_DEFAULT_5G_OFDM_DIFF 0X04 -+ -+#define EEPROM_DEFAULT_DIFF 0XFE -+#define EEPROM_DEFAULT_CHANNEL_PLAN 0x7F -+#define EEPROM_DEFAULT_BOARD_OPTION 0x00 -+#define EEPROM_DEFAULT_RFE_OPTION_8192E 0xFF -+#define EEPROM_DEFAULT_RFE_OPTION 0x04 -+#define EEPROM_DEFAULT_FEATURE_OPTION 0x00 -+#define EEPROM_DEFAULT_BT_OPTION 0x10 -+ -+ -+#define EEPROM_DEFAULT_TX_CALIBRATE_RATE 0x00 -+ -+// PCIe related -+#define EEPROM_PCIE_DEV_CAP_01 0xE0 // Express device capability in PCIe configuration space, i.e., map to offset 0x74 -+#define EEPROM_PCIE_DEV_CAP_02 0xE1 // Express device capability in PCIe configuration space, i.e., map to offset 0x75 -+ -+ -+// -+// For VHT series TX power by rate table. -+// VHT TX power by rate off setArray = -+// Band:-2G&5G = 0 / 1 -+// RF: at most 4*4 = ABCD=0/1/2/3 -+// CCK=0 OFDM=1/2 HT-MCS 0-15=3/4/56 VHT=7/8/9/10/11 -+// -+#define TX_PWR_BY_RATE_NUM_BAND 2 -+#define TX_PWR_BY_RATE_NUM_RF 4 -+#define TX_PWR_BY_RATE_NUM_RATE 84 -+ -+#define TXPWR_LMT_MAX_RF 4 -+ -+//---------------------------------------------------------------------------- -+// EEPROM/EFUSE data structure definition. -+//---------------------------------------------------------------------------- -+ -+//For 88E new structure -+ -+/* -+2.4G: -+{ -+{1,2}, -+{3,4,5}, -+{6,7,8}, -+{9,10,11}, -+{12,13}, -+{14} -+} -+ -+5G: -+{ -+{36,38,40}, -+{44,46,48}, -+{52,54,56}, -+{60,62,64}, -+{100,102,104}, -+{108,110,112}, -+{116,118,120}, -+{124,126,128}, -+{132,134,136}, -+{140,142,144}, -+{149,151,153}, -+{157,159,161}, -+{173,175,177}, -+} -+*/ -+#define MAX_RF_PATH 4 -+#define RF_PATH_MAX MAX_RF_PATH -+#define MAX_CHNL_GROUP_24G 6 -+#define MAX_CHNL_GROUP_5G 14 -+ -+//It must always set to 4, otherwise read efuse table secquence will be wrong. -+#define MAX_TX_COUNT 4 -+ -+typedef struct _TxPowerInfo24G{ -+ u8 IndexCCK_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G]; -+ u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G]; -+ //If only one tx, only BW20 and OFDM are used. -+ s8 CCK_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+}TxPowerInfo24G, *PTxPowerInfo24G; -+ -+typedef struct _TxPowerInfo5G{ -+ u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_5G]; -+ //If only one tx, only BW20, OFDM, BW80 and BW160 are used. -+ s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW80_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW160_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+}TxPowerInfo5G, *PTxPowerInfo5G; -+ -+ -+typedef enum _BT_Ant_NUM{ -+ Ant_x2 = 0, -+ Ant_x1 = 1 -+} BT_Ant_NUM, *PBT_Ant_NUM; -+ -+typedef enum _BT_CoType{ -+ BT_2WIRE = 0, -+ BT_ISSC_3WIRE = 1, -+ BT_ACCEL = 2, -+ BT_CSR_BC4 = 3, -+ BT_CSR_BC8 = 4, -+ BT_RTL8756 = 5, -+ BT_RTL8723A = 6, -+ BT_RTL8821 = 7, -+ BT_RTL8723B = 8, -+ BT_RTL8192E = 9, -+ BT_RTL8814A = 10, -+ BT_RTL8812A = 11, -+ BT_RTL8703B = 12 -+} BT_CoType, *PBT_CoType; -+ -+typedef enum _BT_RadioShared{ -+ BT_Radio_Shared = 0, -+ BT_Radio_Individual = 1, -+} BT_RadioShared, *PBT_RadioShared; -+ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_phy.h linux/3rdparty/rtl8812au/include/hal_phy.h ---- linux.old/3rdparty/rtl8812au/include/hal_phy.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_phy.h 2017-06-07 23:07:21.037689945 +0300 -@@ -0,0 +1,254 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_pg.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_pg.h +--- linux-4.14.17/3rdparty/rtl8812au/include/hal_pg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_pg.h 2018-02-06 17:42:30.718967283 +0200 +@@ -0,0 +1,636 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -306442,10 +135446,645 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_phy.h linux/3rdparty/rtl8812 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++ ++#ifndef __HAL_PG_H__ ++#define __HAL_PG_H__ ++ ++//==================================================== ++// EEPROM/Efuse PG Offset for 8192 CE/CU ++//==================================================== ++#define EEPROM_VID_92C 0x0A ++#define EEPROM_PID_92C 0x0C ++#define EEPROM_DID_92C 0x0C ++#define EEPROM_SVID_92C 0x0E ++#define EEPROM_SMID_92C 0x10 ++#define EEPROM_MAC_ADDR_92C 0x16 ++ ++#define EEPROM_MAC_ADDR 0x16 ++#define EEPROM_TV_OPTION 0x50 ++#define EEPROM_SUBCUSTOMER_ID_92C 0x59 ++#define EEPROM_CCK_TX_PWR_INX 0x5A ++#define EEPROM_HT40_1S_TX_PWR_INX 0x60 ++#define EEPROM_HT40_2S_TX_PWR_INX_DIFF 0x66 ++#define EEPROM_HT20_TX_PWR_INX_DIFF 0x69 ++#define EEPROM_OFDM_TX_PWR_INX_DIFF 0x6C ++#define EEPROM_HT40_MAX_PWR_OFFSET 0x6F ++#define EEPROM_HT20_MAX_PWR_OFFSET 0x72 ++#define EEPROM_CHANNEL_PLAN_92C 0x75 ++#define EEPROM_TSSI_A 0x76 ++#define EEPROM_TSSI_B 0x77 ++#define EEPROM_THERMAL_METER_92C 0x78 ++#define EEPROM_RF_OPT1_92C 0x79 ++#define EEPROM_RF_OPT2_92C 0x7A ++#define EEPROM_RF_OPT3_92C 0x7B ++#define EEPROM_RF_OPT4_92C 0x7C ++#define EEPROM_VERSION_92C 0x7E ++#define EEPROM_CUSTOMER_ID_92C 0x7F ++ ++#define EEPROM_NORMAL_CHANNEL_PLAN 0x75 ++#define EEPROM_NORMAL_BoardType_92C EEPROM_RF_OPT1_92C ++#define BOARD_TYPE_NORMAL_MASK 0xE0 ++#define BOARD_TYPE_TEST_MASK 0xF ++#define EEPROM_TYPE_ID 0x7E ++ ++// EEPROM address for Test chip ++#define EEPROM_TEST_USB_OPT 0x0E ++ ++#define EEPROM_EASY_REPLACEMENT 0x50//BIT0 1 for build-in module, 0 for external dongle ++ ++//==================================================== ++// EEPROM/Efuse PG Offset for 8723AE/8723AU/8723AS ++//==================================================== ++#define EEPROM_CCK_TX_PWR_INX_8723A 0x10 ++#define EEPROM_HT40_1S_TX_PWR_INX_8723A 0x16 ++#define EEPROM_HT20_TX_PWR_INX_DIFF_8723A 0x1C ++#define EEPROM_OFDM_TX_PWR_INX_DIFF_8723A 0x1F ++#define EEPROM_HT40_MAX_PWR_OFFSET_8723A 0x22 ++#define EEPROM_HT20_MAX_PWR_OFFSET_8723A 0x25 ++ ++#define EEPROM_ChannelPlan_8723A 0x28 ++#define EEPROM_TSSI_A_8723A 0x29 ++#define EEPROM_THERMAL_METER_8723A 0x2A ++#define RF_OPTION1_8723A 0x2B ++#define RF_OPTION2_8723A 0x2C ++#define RF_OPTION3_8723A 0x2D ++#define RF_OPTION4_8723A 0x2E ++#define EEPROM_VERSION_8723A 0x30 ++#define EEPROM_CustomID_8723A 0x31 ++#define EEPROM_SubCustomID_8723A 0x32 ++#define EEPROM_XTAL_K_8723A 0x33 ++#define EEPROM_Chipset_8723A 0x34 ++ ++ ++// RTL8723AE ++#define EEPROM_VID_8723AE 0x49 ++#define EEPROM_DID_8723AE 0x4B ++#define EEPROM_SVID_8723AE 0x4D ++#define EEPROM_SMID_8723AE 0x4F ++#define EEPROM_MAC_ADDR_8723AE 0x67 ++ ++//RTL8723AU ++#define EEPROM_MAC_ADDR_8723AU 0xC6 ++#define EEPROM_VID_8723AU 0xB7 ++#define EEPROM_PID_8723AU 0xB9 ++ ++// RTL8723AS ++#define EEPROM_MAC_ADDR_8723AS 0xAA ++ ++//==================================================== ++// EEPROM/Efuse PG Offset for 8192 DE/DU ++//==================================================== ++// pcie ++#define RTL8190_EEPROM_ID 0x8129 // 0-1 ++#define EEPROM_HPON 0x02 // LDO settings.2-5 ++#define EEPROM_CLK 0x06 // Clock settings.6-7 ++#define EEPROM_MAC_FUNCTION 0x08 // SE Test mode.8 ++ ++#define EEPROM_MAC_ADDR_MAC0_92DE 0x55 ++#define EEPROM_MAC_ADDR_MAC1_92DE 0x5B ++ ++//usb ++#define EEPROM_ENDPOINT_SETTING 0x10 ++#define EEPROM_CHIRP_K 0x12 // Changed ++#define EEPROM_USB_PHY 0x13 // Changed ++#define EEPROM_STRING 0x1F ++#define EEPROM_SUBCUSTOMER_ID_92D 0x59 ++ ++#define EEPROM_MAC_ADDR_MAC0_92DU 0x19 ++#define EEPROM_MAC_ADDR_MAC1_92DU 0x5B ++//---------------------------------------------------------------- ++// 2.4G band Tx power index setting ++#define EEPROM_CCK_TX_PWR_INX_2G_92D 0x61 ++#define EEPROM_HT40_1S_TX_PWR_INX_2G_92D 0x67 ++#define EEPROM_HT40_2S_TX_PWR_INX_DIFF_2G_92D 0x6D ++#define EEPROM_HT20_TX_PWR_INX_DIFF_2G_92D 0x70 ++#define EEPROM_OFDM_TX_PWR_INX_DIFF_2G_92D 0x73 ++#define EEPROM_HT40_MAX_PWR_OFFSET_2G_92D 0x76 ++#define EEPROM_HT20_MAX_PWR_OFFSET_2G_92D 0x79 ++ ++//5GL channel 32-64 ++#define EEPROM_HT40_1S_TX_PWR_INX_5GL_92D 0x7C ++#define EEPROM_HT40_2S_TX_PWR_INX_DIFF_5GL_92D 0x82 ++#define EEPROM_HT20_TX_PWR_INX_DIFF_5GL_92D 0x85 ++#define EEPROM_OFDM_TX_PWR_INX_DIFF_5GL_92D 0x88 ++#define EEPROM_HT40_MAX_PWR_OFFSET_5GL_92D 0x8B ++#define EEPROM_HT20_MAX_PWR_OFFSET_5GL_92D 0x8E ++ ++//5GM channel 100-140 ++#define EEPROM_HT40_1S_TX_PWR_INX_5GM_92D 0x91 ++#define EEPROM_HT40_2S_TX_PWR_INX_DIFF_5GM_92D 0x97 ++#define EEPROM_HT20_TX_PWR_INX_DIFF_5GM_92D 0x9A ++#define EEPROM_OFDM_TX_PWR_INX_DIFF_5GM_92D 0x9D ++#define EEPROM_HT40_MAX_PWR_OFFSET_5GM_92D 0xA0 ++#define EEPROM_HT20_MAX_PWR_OFFSET_5GM_92D 0xA3 ++ ++//5GH channel 149-165 ++#define EEPROM_HT40_1S_TX_PWR_INX_5GH_92D 0xA6 ++#define EEPROM_HT40_2S_TX_PWR_INX_DIFF_5GH_92D 0xAC ++#define EEPROM_HT20_TX_PWR_INX_DIFF_5GH_92D 0xAF ++#define EEPROM_OFDM_TX_PWR_INX_DIFF_5GH_92D 0xB2 ++#define EEPROM_HT40_MAX_PWR_OFFSET_5GH_92D 0xB5 ++#define EEPROM_HT20_MAX_PWR_OFFSET_5GH_92D 0xB8 ++ ++ ++#define EEPROM_CHANNEL_PLAN_92D 0xBB // Map of supported channels. ++#define EEPROM_TEST_CHANNEL_PLAN_92D 0xBB ++#define EEPROM_THERMAL_METER_92D 0xC3 //[4:0] ++#define EEPROM_IQK_DELTA_92D 0xBC ++#define EEPROM_LCK_DELTA_92D 0xBC ++#define EEPROM_XTAL_K_92D 0xBD //[7:5] ++#define EEPROM_TSSI_A_5G_92D 0xBE ++#define EEPROM_TSSI_B_5G_92D 0xBF ++#define EEPROM_TSSI_AB_5G_92D 0xC0 ++ ++#define EEPROM_RF_OPT1_92D 0xC4 ++#define EEPROM_RF_OPT2_92D 0xC5 ++#define EEPROM_RF_OPT3_92D 0xC6 ++#define EEPROM_RF_OPT4_92D 0xC7 ++#define EEPROM_RF_OPT5_92D 0xC8 ++#define EEPROM_RF_OPT6_92D 0xC9 ++#define EEPROM_RF_OPT7_92D 0xCC ++ ++#define EEPROM_NORMAL_BoardType_92D EEPROM_RF_OPT1_92D //[7:5] ++ ++#define EEPROM_WIDIPAIRING_ADDR 0xF0 ++#define EEPROM_WIDIPAIRING_KEY 0xF6 ++ ++#define EEPROM_DEF_PART_NO 0x3FD //Byte ++#define EEPROME_CHIP_VERSION_L 0x3FF ++#define EEPROME_CHIP_VERSION_H 0x3FE ++ ++//---------------------------------------------------------------- ++ ++#define EEPROM_VID_92DE 0x28 ++#define EEPROM_PID_92DE 0x2A ++#define EEPROM_SVID_92DE 0x2C ++#define EEPROM_SMID_92DE 0x2E ++#define EEPROM_PATHDIV_92D 0xC4 ++ ++#define EEPROM_BOARD_OPTIONS_92D 0xC4 ++#define EEPROM_5G_LNA_GAIN_92D 0xC6 ++#define EEPROM_FEATURE_OPTIONS_92D 0xC7 ++#define EEPROM_BT_SETTING_92D 0xC8 ++ ++#define EEPROM_VERSION_92D 0xCA ++#define EEPROM_CUSTOMER_ID_92D 0xCB ++ ++#define EEPROM_VID_92DU 0xC ++#define EEPROM_PID_92DU 0xE ++ ++//==================================================== ++// EEPROM/Efuse PG Offset for 88EE/88EU/88ES ++//==================================================== ++#define EEPROM_TX_PWR_INX_88E 0x10 ++ ++#define EEPROM_ChannelPlan_88E 0xB8 ++#define EEPROM_XTAL_88E 0xB9 ++#define EEPROM_THERMAL_METER_88E 0xBA ++#define EEPROM_IQK_LCK_88E 0xBB ++ ++#define EEPROM_RF_BOARD_OPTION_88E 0xC1 ++#define EEPROM_RF_FEATURE_OPTION_88E 0xC2 ++#define EEPROM_RF_BT_SETTING_88E 0xC3 ++#define EEPROM_VERSION_88E 0xC4 ++#define EEPROM_CustomID_88E 0xC5 ++#define EEPROM_RF_ANTENNA_OPT_88E 0xC9 ++ ++// RTL88EE ++#define EEPROM_MAC_ADDR_88EE 0xD0 ++#define EEPROM_VID_88EE 0xD6 ++#define EEPROM_DID_88EE 0xD8 ++#define EEPROM_SVID_88EE 0xDA ++#define EEPROM_SMID_88EE 0xDC ++ ++//RTL88EU ++#define EEPROM_MAC_ADDR_88EU 0xD7 ++#define EEPROM_VID_88EU 0xD0 ++#define EEPROM_PID_88EU 0xD2 ++#define EEPROM_USB_OPTIONAL_FUNCTION0 0xD4 ++ ++// RTL88ES ++#define EEPROM_MAC_ADDR_88ES 0x11A ++//==================================================== ++// EEPROM/Efuse PG Offset for 8192EE/8192EU/8192ES ++//==================================================== ++// 0x10 ~ 0x63 = TX power area. ++#define EEPROM_TX_PWR_INX_8192E 0x10 ++ ++#define EEPROM_ChannelPlan_8192E 0xB8 ++#define EEPROM_XTAL_8192E 0xB9 ++#define EEPROM_THERMAL_METER_8192E 0xBA ++#define EEPROM_IQK_LCK_8192E 0xBB ++#define EEPROM_2G_5G_PA_TYPE_8192E 0xBC ++#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8192E 0xBD ++#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8192E 0xBF ++ ++#define EEPROM_RF_BOARD_OPTION_8192E 0xC1 ++#define EEPROM_RF_FEATURE_OPTION_8192E 0xC2 ++#define EEPROM_RF_BT_SETTING_8192E 0xC3 ++#define EEPROM_VERSION_8192E 0xC4 ++#define EEPROM_CustomID_8192E 0xC5 ++#define EEPROM_TX_BBSWING_2G_8192E 0xC6 ++#define EEPROM_TX_BBSWING_5G_8192E 0xC7 ++#define EEPROM_TX_PWR_CALIBRATE_RATE_8192E 0xC8 ++#define EEPROM_RF_ANTENNA_OPT_8192E 0xC9 ++ ++// RTL8192EE ++#define EEPROM_MAC_ADDR_8192EE 0xD0 ++#define EEPROM_VID_8192EE 0xD6 ++#define EEPROM_DID_8192EE 0xD8 ++#define EEPROM_SVID_8192EE 0xDA ++#define EEPROM_SMID_8192EE 0xDC ++ ++//RTL8192EU ++#define EEPROM_MAC_ADDR_8192EU 0xD7 ++#define EEPROM_VID_8192EU 0xD0 ++#define EEPROM_PID_8192EU 0xD2 ++#define EEPROM_PA_TYPE_8192EU 0xBC ++#define EEPROM_LNA_TYPE_2G_8192EU 0xBD ++#define EEPROM_LNA_TYPE_5G_8192EU 0xBF ++ ++// RTL8192ES ++#define EEPROM_MAC_ADDR_8192ES 0x11B ++//==================================================== ++// EEPROM/Efuse PG Offset for 8812AE/8812AU/8812AS ++//==================================================== ++// 0x10 ~ 0x63 = TX power area. ++#define EEPROM_USB_MODE_8812 0x08 ++#define EEPROM_TX_PWR_INX_8812 0x10 ++ ++#define EEPROM_ChannelPlan_8812 0xB8 ++#define EEPROM_XTAL_8812 0xB9 ++#define EEPROM_THERMAL_METER_8812 0xBA ++#define EEPROM_IQK_LCK_8812 0xBB ++#define EEPROM_2G_5G_PA_TYPE_8812 0xBC ++#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8812 0xBD ++#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8812 0xBF ++ ++#define EEPROM_RF_BOARD_OPTION_8812 0xC1 ++#define EEPROM_RF_FEATURE_OPTION_8812 0xC2 ++#define EEPROM_RF_BT_SETTING_8812 0xC3 ++#define EEPROM_VERSION_8812 0xC4 ++#define EEPROM_CustomID_8812 0xC5 ++#define EEPROM_TX_BBSWING_2G_8812 0xC6 ++#define EEPROM_TX_BBSWING_5G_8812 0xC7 ++#define EEPROM_TX_PWR_CALIBRATE_RATE_8812 0xC8 ++#define EEPROM_RF_ANTENNA_OPT_8812 0xC9 ++#define EEPROM_RFE_OPTION_8812 0xCA ++ ++// RTL8812AE ++#define EEPROM_MAC_ADDR_8812AE 0xD0 ++#define EEPROM_VID_8812AE 0xD6 ++#define EEPROM_DID_8812AE 0xD8 ++#define EEPROM_SVID_8812AE 0xDA ++#define EEPROM_SMID_8812AE 0xDC ++ ++//RTL8812AU ++#define EEPROM_MAC_ADDR_8812AU 0xD7 ++#define EEPROM_VID_8812AU 0xD0 ++#define EEPROM_PID_8812AU 0xD2 ++#define EEPROM_PA_TYPE_8812AU 0xBC ++#define EEPROM_LNA_TYPE_2G_8812AU 0xBD ++#define EEPROM_LNA_TYPE_5G_8812AU 0xBF ++ ++//==================================================== ++// EEPROM/Efuse PG Offset for 8821AE/8821AU/8821AS ++//==================================================== ++#define EEPROM_TX_PWR_INX_8821 0x10 ++ ++#define EEPROM_ChannelPlan_8821 0xB8 ++#define EEPROM_XTAL_8821 0xB9 ++#define EEPROM_THERMAL_METER_8821 0xBA ++#define EEPROM_IQK_LCK_8821 0xBB ++ ++ ++#define EEPROM_RF_BOARD_OPTION_8821 0xC1 ++#define EEPROM_RF_FEATURE_OPTION_8821 0xC2 ++#define EEPROM_RF_BT_SETTING_8821 0xC3 ++#define EEPROM_VERSION_8821 0xC4 ++#define EEPROM_CustomID_8821 0xC5 ++#define EEPROM_RF_ANTENNA_OPT_8821 0xC9 ++ ++// RTL8821AE ++#define EEPROM_MAC_ADDR_8821AE 0xD0 ++#define EEPROM_VID_8821AE 0xD6 ++#define EEPROM_DID_8821AE 0xD8 ++#define EEPROM_SVID_8821AE 0xDA ++#define EEPROM_SMID_8821AE 0xDC ++ ++//RTL8821AU ++#define EEPROM_PA_TYPE_8821AU 0xBC ++#define EEPROM_LNA_TYPE_8821AU 0xBF ++ ++// RTL8821AS ++#define EEPROM_MAC_ADDR_8821AS 0x11A ++ ++//RTL8821AU ++#define EEPROM_MAC_ADDR_8821AU 0x107 ++#define EEPROM_VID_8821AU 0x100 ++#define EEPROM_PID_8821AU 0x102 ++ ++ ++//==================================================== ++// EEPROM/Efuse PG Offset for 8192 SE/SU ++//==================================================== ++#define EEPROM_VID_92SE 0x0A ++#define EEPROM_DID_92SE 0x0C ++#define EEPROM_SVID_92SE 0x0E ++#define EEPROM_SMID_92SE 0x10 ++ ++#define EEPROM_MAC_ADDR_92S 0x12 ++ ++#define EEPROM_TSSI_A_92SE 0x74 ++#define EEPROM_TSSI_B_92SE 0x75 ++ ++#define EEPROM_Version_92SE 0x7C ++ ++ ++#define EEPROM_VID_92SU 0x08 ++#define EEPROM_PID_92SU 0x0A ++ ++#define EEPROM_Version_92SU 0x50 ++#define EEPROM_TSSI_A_92SU 0x6b ++#define EEPROM_TSSI_B_92SU 0x6c ++ ++//==================================================== ++// EEPROM/Efuse PG Offset for 8723BE/8723BU/8723BS ++//==================================================== ++// 0x10 ~ 0x63 = TX power area. ++#define EEPROM_TX_PWR_INX_8723B 0x10 ++ ++#define EEPROM_ChannelPlan_8723B 0xB8 ++#define EEPROM_XTAL_8723B 0xB9 ++#define EEPROM_THERMAL_METER_8723B 0xBA ++#define EEPROM_IQK_LCK_8723B 0xBB ++#define EEPROM_2G_5G_PA_TYPE_8723B 0xBC ++#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8723B 0xBD ++#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8723B 0xBF ++ ++#define EEPROM_RF_BOARD_OPTION_8723B 0xC1 ++#define EEPROM_FEATURE_OPTION_8723B 0xC2 ++#define EEPROM_RF_BT_SETTING_8723B 0xC3 ++#define EEPROM_VERSION_8723B 0xC4 ++#define EEPROM_CustomID_8723B 0xC5 ++#define EEPROM_TX_BBSWING_2G_8723B 0xC6 ++#define EEPROM_TX_PWR_CALIBRATE_RATE_8723B 0xC8 ++#define EEPROM_RF_ANTENNA_OPT_8723B 0xC9 ++#define EEPROM_RFE_OPTION_8723B 0xCA ++ ++// RTL8723BE ++#define EEPROM_MAC_ADDR_8723BE 0xD0 ++#define EEPROM_VID_8723BE 0xD6 ++#define EEPROM_DID_8723BE 0xD8 ++#define EEPROM_SVID_8723BE 0xDA ++#define EEPROM_SMID_8723BE 0xDC ++ ++//RTL8723BU ++#define EEPROM_MAC_ADDR_8723BU 0xD7 ++#define EEPROM_VID_8723BU 0xD0 ++#define EEPROM_PID_8723BU 0xD2 ++#define EEPROM_PA_TYPE_8723BU 0xBC ++#define EEPROM_LNA_TYPE_2G_8723BU 0xBD ++ ++//RTL8723BS ++#define EEPROM_MAC_ADDR_8723BS 0x11A ++ ++ ++//==================================================== ++// EEPROM/Efuse Value Type ++//==================================================== ++#define EETYPE_TX_PWR 0x0 ++//==================================================== ++// EEPROM/Efuse Default Value ++//==================================================== ++#define EEPROM_CID_DEFAULT 0x0 ++#define EEPROM_CID_DEFAULT_EXT 0xFF // Reserved for Realtek ++#define EEPROM_CID_TOSHIBA 0x4 ++#define EEPROM_CID_CCX 0x10 ++#define EEPROM_CID_QMI 0x0D ++#define EEPROM_CID_WHQL 0xFE ++ ++#define EEPROM_CHANNEL_PLAN_FCC 0x0 ++#define EEPROM_CHANNEL_PLAN_IC 0x1 ++#define EEPROM_CHANNEL_PLAN_ETSI 0x2 ++#define EEPROM_CHANNEL_PLAN_SPAIN 0x3 ++#define EEPROM_CHANNEL_PLAN_FRANCE 0x4 ++#define EEPROM_CHANNEL_PLAN_MKK 0x5 ++#define EEPROM_CHANNEL_PLAN_MKK1 0x6 ++#define EEPROM_CHANNEL_PLAN_ISRAEL 0x7 ++#define EEPROM_CHANNEL_PLAN_TELEC 0x8 ++#define EEPROM_CHANNEL_PLAN_GLOBAL_DOMAIN 0x9 ++#define EEPROM_CHANNEL_PLAN_WORLD_WIDE_13 0xA ++#define EEPROM_CHANNEL_PLAN_NCC_TAIWAN 0xB ++#define EEPROM_CHANNEL_PLAN_CHIAN 0XC ++#define EEPROM_CHANNEL_PLAN_SINGAPORE_INDIA_MEXICO 0XD ++#define EEPROM_CHANNEL_PLAN_KOREA 0xE ++#define EEPROM_CHANNEL_PLAN_TURKEY 0xF ++#define EEPROM_CHANNEL_PLAN_JAPAN 0x10 ++#define EEPROM_CHANNEL_PLAN_FCC_NO_DFS 0x11 ++#define EEPROM_CHANNEL_PLAN_JAPAN_NO_DFS 0x12 ++#define EEPROM_CHANNEL_PLAN_WORLD_WIDE_5G 0x13 ++#define EEPROM_CHANNEL_PLAN_TAIWAN_NO_DFS 0x14 ++ ++#define EEPROM_USB_OPTIONAL1 0xE ++#define EEPROM_CHANNEL_PLAN_BY_HW_MASK 0x80 ++ ++#define RTL_EEPROM_ID 0x8129 ++#define EEPROM_Default_TSSI 0x0 ++#define EEPROM_Default_BoardType 0x02 ++#define EEPROM_Default_ThermalMeter 0x12 ++#define EEPROM_Default_ThermalMeter_92SU 0x7 ++#define EEPROM_Default_ThermalMeter_88E 0x18 ++#define EEPROM_Default_ThermalMeter_8812 0x18 ++#define EEPROM_Default_ThermalMeter_8192E 0x1A ++#define EEPROM_Default_ThermalMeter_8723B 0x18 ++ ++ ++#define EEPROM_Default_CrystalCap 0x0 ++#define EEPROM_Default_CrystalCap_8723A 0x20 ++#define EEPROM_Default_CrystalCap_88E 0x20 ++#define EEPROM_Default_CrystalCap_8812 0x20 ++#define EEPROM_Default_CrystalCap_8192E 0x20 ++#define EEPROM_Default_CrystalCap_8723B 0x20 ++#define EEPROM_Default_CrystalFreq 0x0 ++#define EEPROM_Default_TxPowerLevel_92C 0x22 ++#define EEPROM_Default_TxPowerLevel_2G 0x2C ++#define EEPROM_Default_TxPowerLevel_5G 0x22 ++#define EEPROM_Default_TxPowerLevel 0x22 ++#define EEPROM_Default_HT40_2SDiff 0x0 ++#define EEPROM_Default_HT20_Diff 2 ++#define EEPROM_Default_LegacyHTTxPowerDiff 0x3 ++#define EEPROM_Default_LegacyHTTxPowerDiff_92C 0x3 ++#define EEPROM_Default_LegacyHTTxPowerDiff_92D 0x4 ++#define EEPROM_Default_HT40_PwrMaxOffset 0 ++#define EEPROM_Default_HT20_PwrMaxOffset 0 ++ ++#define EEPROM_Default_PID 0x1234 ++#define EEPROM_Default_VID 0x5678 ++#define EEPROM_Default_CustomerID 0xAB ++#define EEPROM_Default_CustomerID_8188E 0x00 ++#define EEPROM_Default_SubCustomerID 0xCD ++#define EEPROM_Default_Version 0 ++ ++#define EEPROM_Default_externalPA_C9 0x00 ++#define EEPROM_Default_externalPA_CC 0xFF ++#define EEPROM_Default_internalPA_SP3T_C9 0xAA ++#define EEPROM_Default_internalPA_SP3T_CC 0xAF ++#define EEPROM_Default_internalPA_SPDT_C9 0xAA ++#define EEPROM_Default_internalPA_SPDT_CC 0xFA ++#define EEPROM_Default_PAType 0 ++#define EEPROM_Default_LNAType 0 ++ ++//New EFUSE deafult value ++#define EEPROM_DEFAULT_24G_INDEX 0x2A ++#define EEPROM_DEFAULT_24G_HT20_DIFF 0X02 ++#define EEPROM_DEFAULT_24G_OFDM_DIFF 0X04 ++ ++#define EEPROM_DEFAULT_5G_INDEX 0X2A ++#define EEPROM_DEFAULT_5G_HT20_DIFF 0X00 ++#define EEPROM_DEFAULT_5G_OFDM_DIFF 0X04 ++ ++#define EEPROM_DEFAULT_DIFF 0XFE ++#define EEPROM_DEFAULT_CHANNEL_PLAN 0x7F ++#define EEPROM_DEFAULT_BOARD_OPTION 0x00 ++#define EEPROM_DEFAULT_RFE_OPTION 0x04 ++#define EEPROM_DEFAULT_FEATURE_OPTION 0x00 ++#define EEPROM_DEFAULT_BT_OPTION 0x10 ++ ++ ++#define EEPROM_DEFAULT_TX_CALIBRATE_RATE 0x00 ++ ++// ++// For VHT series TX power by rate table. ++// VHT TX power by rate off setArray = ++// Band:-2G&5G = 0 / 1 ++// RF: at most 4*4 = ABCD=0/1/2/3 ++// CCK=0 OFDM=1/2 HT-MCS 0-15=3/4/56 VHT=7/8/9/10/11 ++// ++#define TX_PWR_BY_RATE_NUM_BAND 2 ++#define TX_PWR_BY_RATE_NUM_RF 4 ++#define TX_PWR_BY_RATE_NUM_SECTION 12 ++ ++//---------------------------------------------------------------------------- ++// EEPROM/EFUSE data structure definition. ++//---------------------------------------------------------------------------- ++#define MAX_RF_PATH_NUM 2 ++#define MAX_CHNL_GROUP 3+9 ++typedef struct _TxPowerInfo{ ++ u8 CCKIndex[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; ++ u8 HT40_1SIndex[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; ++ u8 HT40_2SIndexDiff[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; ++ s8 HT20IndexDiff[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; ++ u8 OFDMIndexDiff[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; ++ u8 HT40MaxOffset[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; ++ u8 HT20MaxOffset[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; ++ u8 TSSI_A[3]; ++ u8 TSSI_B[3]; ++ u8 TSSI_A_5G[3]; //5GL/5GM/5GH ++ u8 TSSI_B_5G[3]; ++}TxPowerInfo, *PTxPowerInfo; ++ ++ ++//For 88E new structure ++ ++/* ++2.4G: ++{ ++{1,2}, ++{3,4,5}, ++{6,7,8}, ++{9,10,11}, ++{12,13}, ++{14} ++} ++ ++5G: ++{ ++{36,38,40}, ++{44,46,48}, ++{52,54,56}, ++{60,62,64}, ++{100,102,104}, ++{108,110,112}, ++{116,118,120}, ++{124,126,128}, ++{132,134,136}, ++{140,142,144}, ++{149,151,153}, ++{157,159,161}, ++{173,175,177}, ++} ++*/ ++#define MAX_RF_PATH 4 ++#define RF_PATH_MAX MAX_RF_PATH ++#define MAX_CHNL_GROUP_24G 6 ++#define MAX_CHNL_GROUP_5G 14 ++ ++//It must always set to 4, otherwise read efuse table secquence will be wrong. ++#define MAX_TX_COUNT 4 ++ ++typedef struct _TxPowerInfo24G{ ++ u8 IndexCCK_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G]; ++ u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G-1]; ++ //If only one tx, only BW20 and OFDM are used. ++ s8 CCK_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++}TxPowerInfo24G, *PTxPowerInfo24G; ++ ++typedef struct _TxPowerInfo5G{ ++ u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_5G]; ++ //If only one tx, only BW20, OFDM, BW80 and BW160 are used. ++ s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW80_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++ s8 BW160_Diff[MAX_RF_PATH][MAX_TX_COUNT]; ++}TxPowerInfo5G, *PTxPowerInfo5G; ++ ++ ++typedef enum _BT_Ant_NUM{ ++ Ant_x2 = 0, ++ Ant_x1 = 1 ++} BT_Ant_NUM, *PBT_Ant_NUM; ++ ++typedef enum _BT_CoType{ ++ BT_2Wire = 0, ++ BT_ISSC_3Wire = 1, ++ BT_ACCEL = 2, ++ BT_CSR_BC4 = 3, ++ BT_CSR_BC8 = 4, ++ BT_RTL8756 = 5, ++ BT_RTL8723A = 6, ++ BT_RTL8821 = 7, ++ BT_RTL8723B = 8, ++} BT_CoType, *PBT_CoType; ++ ++typedef enum _BT_RadioShared{ ++ BT_Radio_Shared = 0, ++ BT_Radio_Individual = 1, ++} BT_RadioShared, *PBT_RadioShared; ++ ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_phy.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_phy.h +--- linux-4.14.17/3rdparty/rtl8812au/include/hal_phy.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_phy.h 2018-02-06 17:42:30.718967283 +0200 +@@ -0,0 +1,243 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#ifndef __HAL_PHY_H__ @@ -306458,7 +136097,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_phy.h linux/3rdparty/rtl8812 +#define HAL_BB_ENABLE 0 +#define HAL_RF_ENABLE 0 +#else // FPGA_PHY and ASIC -+#define HAL_FW_ENABLE 1 ++#define HAL_FW_ENABLE 1 +#define HAL_MAC_ENABLE 1 +#define HAL_BB_ENABLE 1 +#define HAL_RF_ENABLE 1 @@ -306476,16 +136115,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_phy.h linux/3rdparty/rtl8812 + +#define RF6052_MAX_PATH 2 + -+// -+// Antenna detection method, i.e., using single tone detection or RSSI reported from each antenna detected. -+// Added by Roger, 2013.05.22. -+// -+#define ANT_DETECT_BY_SINGLE_TONE BIT0 -+#define ANT_DETECT_BY_RSSI BIT1 -+#define IS_ANT_DETECT_SUPPORT_SINGLE_TONE(__Adapter) ((GET_HAL_DATA(__Adapter)->AntDetection) & ANT_DETECT_BY_SINGLE_TONE) -+#define IS_ANT_DETECT_SUPPORT_RSSI(__Adapter) ((GET_HAL_DATA(__Adapter)->AntDetection) & ANT_DETECT_BY_RSSI) -+ -+ +/*--------------------------Define Parameters-------------------------------*/ +typedef enum _BAND_TYPE{ + BAND_ON_2_4G = 0, @@ -306495,25 +136124,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_phy.h linux/3rdparty/rtl8812 +}BAND_TYPE,*PBAND_TYPE; + +typedef enum _RF_TYPE{ -+ RF_TYPE_MIN = 0, // 0 ++ RF_TYPE_MIN = 0, // 0 + RF_8225=1, // 1 11b/g RF for verification only -+ RF_8256=2, // 2 11b/g/n ++ RF_8256=2, // 2 11b/g/n + RF_8258=3, // 3 11a/b/g/n RF + RF_6052=4, // 4 11b/g/n RF -+ RF_PSEUDO_11N=5, // 5, It is a temporality RF. ++ RF_PSEUDO_11N=5, // 5, It is a temporality RF. + RF_TYPE_MAX +}RF_TYPE_E,*PRF_TYPE_E; + -+#define TX_1S 0 -+#define TX_2S 1 -+#define TX_3S 2 ++typedef enum _RF_PATH{ ++ RF_PATH_A = 0, ++ RF_PATH_B, ++ RF_PATH_C, ++ RF_PATH_D ++}RF_PATH, *PRF_PATH; ++ ++#define TX_1S 0 ++#define TX_2S 1 ++#define TX_3S 2 +#define TX_4S 3 + -+#define RF_PATH_MAX_92C_88E 2 -+#define RF_PATH_MAX_90_8812 4 //Max RF number 90 support ++#define RF_PATH_MAX_92C_88E 2 ++#define RF_PATH_MAX_90_8812 4 //Max RF number 90 support + +typedef enum _ANTENNA_PATH{ -+ ANTENNA_NONE = 0, ++ ANTENNA_NONE = 0, + ANTENNA_D = 1, + ANTENNA_C = 2, + ANTENNA_CD = 3, @@ -306542,7 +136178,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_phy.h linux/3rdparty/rtl8812 + BaseBand_Config_PHY_REG = 0, //Radio Path A + BaseBand_Config_AGC_TAB = 1, //Radio Path B + BaseBand_Config_AGC_TAB_2G = 2, -+ BaseBand_Config_AGC_TAB_5G = 3, ++ BaseBand_Config_AGC_TAB_5G = 3, + BaseBand_Config_PHY_REG_PG +}BaseBand_Config_Type, *PBaseBand_Config_Type; + @@ -306562,9 +136198,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_phy.h linux/3rdparty/rtl8812 + WIRELESS_MODE_AUTO = 0x08, + WIRELESS_MODE_N_24G = 0x10, + WIRELESS_MODE_N_5G = 0x20, -+ WIRELESS_MODE_AC_5G = 0x40, -+ WIRELESS_MODE_AC_24G = 0x80, -+ WIRELESS_MODE_AC_ONLY = 0x100, ++ WIRELESS_MODE_AC_5G = 0x40 +} WIRELESS_MODE; + +typedef enum _SwChnlCmdID{ @@ -306584,10 +136218,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_phy.h linux/3rdparty/rtl8812 + u32 msDelay; +}SwChnlCmd; + -+typedef struct _R_ANTENNA_SELECT_OFDM{ -+ u32 r_tx_antenna:4; ++typedef struct _R_ANTENNA_SELECT_OFDM{ ++ u32 r_tx_antenna:4; + u32 r_ant_l:4; -+ u32 r_ant_non_ht:4; ++ u32 r_ant_non_ht:4; + u32 r_ant_ht1:4; + u32 r_ant_ht2:4; + u32 r_ant_ht_s1:4; @@ -306597,7 +136231,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_phy.h linux/3rdparty/rtl8812 +}R_ANTENNA_SELECT_OFDM; + +typedef struct _R_ANTENNA_SELECT_CCK{ -+ u8 r_cckrx_enable_2:2; ++ u8 r_cckrx_enable_2:2; + u8 r_cckrx_enable:2; + u8 r_ccktx_enable:4; +}R_ANTENNA_SELECT_CCK; @@ -306624,73 +136258,72 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_phy.h linux/3rdparty/rtl8812 + +u32 +PHY_RFShadowRead( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset); ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset); + -+VOID ++void +PHY_RFShadowWrite( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset, -+ IN u32 Data); ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset, ++ u32 Data); + -+BOOLEAN ++bool +PHY_RFShadowCompare( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset); ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset); + -+VOID ++void +PHY_RFShadowRecorver( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset); ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset); + -+VOID ++void +PHY_RFShadowCompareAll( -+ IN PADAPTER Adapter); ++ PADAPTER Adapter); + -+VOID ++void +PHY_RFShadowRecorverAll( -+ IN PADAPTER Adapter); ++ PADAPTER Adapter); + -+VOID ++void +PHY_RFShadowCompareFlagSet( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset, -+ IN u8 Type); ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset, ++ u8 Type); + -+VOID ++void +PHY_RFShadowRecorverFlagSet( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset, -+ IN u8 Type); ++ PADAPTER Adapter, ++ u8 eRFPath, ++ u32 Offset, ++ u8 Type); + -+VOID ++void +PHY_RFShadowCompareFlagSetAll( -+ IN PADAPTER Adapter); ++ PADAPTER Adapter); + -+VOID ++void +PHY_RFShadowRecorverFlagSetAll( -+ IN PADAPTER Adapter); ++ PADAPTER Adapter); + -+VOID ++void +PHY_RFShadowRefresh( -+ IN PADAPTER Adapter); ++ PADAPTER Adapter); + +#endif //__HAL_COMMON_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_phy_reg.h linux/3rdparty/rtl8812au/include/hal_phy_reg.h ---- linux.old/3rdparty/rtl8812au/include/hal_phy_reg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_phy_reg.h 2017-06-07 23:07:21.037689945 +0300 -@@ -0,0 +1,31 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_phy_reg.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_phy_reg.h +--- linux-4.14.17/3rdparty/rtl8812au/include/hal_phy_reg.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_phy_reg.h 2018-02-06 17:42:30.718967283 +0200 +@@ -0,0 +1,25 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -306700,174 +136333,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_phy_reg.h linux/3rdparty/rtl + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __HAL_PHY_REG_H__ +#define __HAL_PHY_REG_H__ + +//for PutRFRegsetting & GetRFRegSetting BitMask +//#if (RTL92SE_FPGA_VERIFY == 1) -+//#define bRFRegOffsetMask 0xfff ++//#define bRFRegOffsetMask 0xfff +//#else -+#define bRFRegOffsetMask 0xfffff ++#define bRFRegOffsetMask 0xfffff +//#endif + +#endif //__HAL_PHY_REG_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/HalPwrSeqCmd.h linux/3rdparty/rtl8812au/include/HalPwrSeqCmd.h ---- linux.old/3rdparty/rtl8812au/include/HalPwrSeqCmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/HalPwrSeqCmd.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,138 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HALPWRSEQCMD_H__ -+#define __HALPWRSEQCMD_H__ -+ -+#include -+ -+/*---------------------------------------------*/ -+//3 The value of cmd: 4 bits -+/*---------------------------------------------*/ -+#define PWR_CMD_READ 0x00 -+ // offset: the read register offset -+ // msk: the mask of the read value -+ // value: N/A, left by 0 -+ // note: dirver shall implement this function by read & msk -+ -+#define PWR_CMD_WRITE 0x01 -+ // offset: the read register offset -+ // msk: the mask of the write bits -+ // value: write value -+ // note: driver shall implement this cmd by read & msk after write -+ -+#define PWR_CMD_POLLING 0x02 -+ // offset: the read register offset -+ // msk: the mask of the polled value -+ // value: the value to be polled, masked by the msd field. -+ // note: driver shall implement this cmd by -+ // do{ -+ // if( (Read(offset) & msk) == (value & msk) ) -+ // break; -+ // } while(not timeout); -+ -+#define PWR_CMD_DELAY 0x03 -+ // offset: the value to delay -+ // msk: N/A -+ // value: the unit of delay, 0: us, 1: ms -+ -+#define PWR_CMD_END 0x04 -+ // offset: N/A -+ // msk: N/A -+ // value: N/A -+ -+/*---------------------------------------------*/ -+//3 The value of base: 4 bits -+/*---------------------------------------------*/ -+ // define the base address of each block -+#define PWR_BASEADDR_MAC 0x00 -+#define PWR_BASEADDR_USB 0x01 -+#define PWR_BASEADDR_PCIE 0x02 -+#define PWR_BASEADDR_SDIO 0x03 -+ -+/*---------------------------------------------*/ -+//3 The value of interface_msk: 4 bits -+/*---------------------------------------------*/ -+#define PWR_INTF_SDIO_MSK BIT(0) -+#define PWR_INTF_USB_MSK BIT(1) -+#define PWR_INTF_PCI_MSK BIT(2) -+#define PWR_INTF_ALL_MSK (BIT(0)|BIT(1)|BIT(2)|BIT(3)) -+ -+/*---------------------------------------------*/ -+//3 The value of fab_msk: 4 bits -+/*---------------------------------------------*/ -+#define PWR_FAB_TSMC_MSK BIT(0) -+#define PWR_FAB_UMC_MSK BIT(1) -+#define PWR_FAB_ALL_MSK (BIT(0)|BIT(1)|BIT(2)|BIT(3)) -+ -+/*---------------------------------------------*/ -+//3 The value of cut_msk: 8 bits -+/*---------------------------------------------*/ -+#define PWR_CUT_TESTCHIP_MSK BIT(0) -+#define PWR_CUT_A_MSK BIT(1) -+#define PWR_CUT_B_MSK BIT(2) -+#define PWR_CUT_C_MSK BIT(3) -+#define PWR_CUT_D_MSK BIT(4) -+#define PWR_CUT_E_MSK BIT(5) -+#define PWR_CUT_F_MSK BIT(6) -+#define PWR_CUT_G_MSK BIT(7) -+#define PWR_CUT_ALL_MSK 0xFF -+ -+ -+typedef enum _PWRSEQ_CMD_DELAY_UNIT_ -+{ -+ PWRSEQ_DELAY_US, -+ PWRSEQ_DELAY_MS, -+} PWRSEQ_DELAY_UNIT; -+ -+typedef struct _WL_PWR_CFG_ -+{ -+ u16 offset; -+ u8 cut_msk; -+ u8 fab_msk:4; -+ u8 interface_msk:4; -+ u8 base:4; -+ u8 cmd:4; -+ u8 msk; -+ u8 value; -+} WLAN_PWR_CFG, *PWLAN_PWR_CFG; -+ -+ -+#define GET_PWR_CFG_OFFSET(__PWR_CMD) __PWR_CMD.offset -+#define GET_PWR_CFG_CUT_MASK(__PWR_CMD) __PWR_CMD.cut_msk -+#define GET_PWR_CFG_FAB_MASK(__PWR_CMD) __PWR_CMD.fab_msk -+#define GET_PWR_CFG_INTF_MASK(__PWR_CMD) __PWR_CMD.interface_msk -+#define GET_PWR_CFG_BASE(__PWR_CMD) __PWR_CMD.base -+#define GET_PWR_CFG_CMD(__PWR_CMD) __PWR_CMD.cmd -+#define GET_PWR_CFG_MASK(__PWR_CMD) __PWR_CMD.msk -+#define GET_PWR_CFG_VALUE(__PWR_CMD) __PWR_CMD.value -+ -+ -+//================================================================================ -+// Prototype of protected function. -+//================================================================================ -+u8 HalPwrSeqCmdParsing( -+ PADAPTER padapter, -+ u8 CutVersion, -+ u8 FabVersion, -+ u8 InterfaceType, -+ WLAN_PWR_CFG PwrCfgCmd[]); -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_sdio.h linux/3rdparty/rtl8812au/include/hal_sdio.h ---- linux.old/3rdparty/rtl8812au/include/hal_sdio.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/hal_sdio.h 2017-06-07 23:07:21.037689945 +0300 -@@ -0,0 +1,32 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/HalPwrSeqCmd.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/HalPwrSeqCmd.h +--- linux-4.14.17/3rdparty/rtl8812au/include/HalPwrSeqCmd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/HalPwrSeqCmd.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,132 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -306877,33 +136362,133 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/hal_sdio.h linux/3rdparty/rtl881 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ -+#ifndef __HAL_SDIO_H_ -+#define __HAL_SDIO_H_ ++#ifndef __HALPWRSEQCMD_H__ ++#define __HALPWRSEQCMD_H__ + -+#define ffaddr2deviceId(pdvobj, addr) (pdvobj->Queue2Pipe[addr]) ++#include + -+u8 rtw_hal_sdio_max_txoqt_free_space(_adapter *padapter); -+u8 rtw_hal_sdio_query_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); -+void rtw_hal_sdio_update_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); -+void rtw_hal_set_sdio_tx_max_length(PADAPTER padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ); -+u32 rtw_hal_get_sdio_tx_max_length(PADAPTER padapter, u8 queue_idx); ++/*---------------------------------------------*/ ++//3 The value of cmd: 4 bits ++/*---------------------------------------------*/ ++#define PWR_CMD_READ 0x00 ++ // offset: the read register offset ++ // msk: the mask of the read value ++ // value: N/A, left by 0 ++ // note: dirver shall implement this function by read & msk + -+#endif //__RTW_LED_H_ ++#define PWR_CMD_WRITE 0x01 ++ // offset: the read register offset ++ // msk: the mask of the write bits ++ // value: write value ++ // note: driver shall implement this cmd by read & msk after write + -diff -Nurp linux.old/3rdparty/rtl8812au/include/HalVerDef.h linux/3rdparty/rtl8812au/include/HalVerDef.h ---- linux.old/3rdparty/rtl8812au/include/HalVerDef.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/HalVerDef.h 2017-06-07 23:07:21.036689854 +0300 -@@ -0,0 +1,202 @@ ++#define PWR_CMD_POLLING 0x02 ++ // offset: the read register offset ++ // msk: the mask of the polled value ++ // value: the value to be polled, masked by the msd field. ++ // note: driver shall implement this cmd by ++ // do{ ++ // if( (Read(offset) & msk) == (value & msk) ) ++ // break; ++ // } while(not timeout); ++ ++#define PWR_CMD_DELAY 0x03 ++ // offset: the value to delay ++ // msk: N/A ++ // value: the unit of delay, 0: us, 1: ms ++ ++#define PWR_CMD_END 0x04 ++ // offset: N/A ++ // msk: N/A ++ // value: N/A ++ ++/*---------------------------------------------*/ ++//3 The value of base: 4 bits ++/*---------------------------------------------*/ ++ // define the base address of each block ++#define PWR_BASEADDR_MAC 0x00 ++#define PWR_BASEADDR_USB 0x01 ++#define PWR_BASEADDR_PCIE 0x02 ++#define PWR_BASEADDR_SDIO 0x03 ++ ++/*---------------------------------------------*/ ++//3 The value of interface_msk: 4 bits ++/*---------------------------------------------*/ ++#define PWR_INTF_SDIO_MSK BIT(0) ++#define PWR_INTF_USB_MSK BIT(1) ++#define PWR_INTF_PCI_MSK BIT(2) ++#define PWR_INTF_ALL_MSK (BIT(0)|BIT(1)|BIT(2)|BIT(3)) ++ ++/*---------------------------------------------*/ ++//3 The value of fab_msk: 4 bits ++/*---------------------------------------------*/ ++#define PWR_FAB_TSMC_MSK BIT(0) ++#define PWR_FAB_UMC_MSK BIT(1) ++#define PWR_FAB_ALL_MSK (BIT(0)|BIT(1)|BIT(2)|BIT(3)) ++ ++/*---------------------------------------------*/ ++//3 The value of cut_msk: 8 bits ++/*---------------------------------------------*/ ++#define PWR_CUT_TESTCHIP_MSK BIT(0) ++#define PWR_CUT_A_MSK BIT(1) ++#define PWR_CUT_B_MSK BIT(2) ++#define PWR_CUT_C_MSK BIT(3) ++#define PWR_CUT_D_MSK BIT(4) ++#define PWR_CUT_E_MSK BIT(5) ++#define PWR_CUT_F_MSK BIT(6) ++#define PWR_CUT_G_MSK BIT(7) ++#define PWR_CUT_ALL_MSK 0xFF ++ ++ ++typedef enum _PWRSEQ_CMD_DELAY_UNIT_ ++{ ++ PWRSEQ_DELAY_US, ++ PWRSEQ_DELAY_MS, ++} PWRSEQ_DELAY_UNIT; ++ ++typedef struct _WL_PWR_CFG_ ++{ ++ u16 offset; ++ u8 cut_msk; ++ u8 fab_msk:4; ++ u8 interface_msk:4; ++ u8 base:4; ++ u8 cmd:4; ++ u8 msk; ++ u8 value; ++} WLAN_PWR_CFG, *PWLAN_PWR_CFG; ++ ++ ++#define GET_PWR_CFG_OFFSET(__PWR_CMD) __PWR_CMD.offset ++#define GET_PWR_CFG_CUT_MASK(__PWR_CMD) __PWR_CMD.cut_msk ++#define GET_PWR_CFG_FAB_MASK(__PWR_CMD) __PWR_CMD.fab_msk ++#define GET_PWR_CFG_INTF_MASK(__PWR_CMD) __PWR_CMD.interface_msk ++#define GET_PWR_CFG_BASE(__PWR_CMD) __PWR_CMD.base ++#define GET_PWR_CFG_CMD(__PWR_CMD) __PWR_CMD.cmd ++#define GET_PWR_CFG_MASK(__PWR_CMD) __PWR_CMD.msk ++#define GET_PWR_CFG_VALUE(__PWR_CMD) __PWR_CMD.value ++ ++ ++//================================================================================ ++// Prototype of protected function. ++//================================================================================ ++u8 HalPwrSeqCmdParsing( ++ PADAPTER padapter, ++ u8 CutVersion, ++ u8 FabVersion, ++ u8 InterfaceType, ++ WLAN_PWR_CFG PwrCfgCmd[]); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/HalVerDef.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/HalVerDef.h +--- linux-4.14.17/3rdparty/rtl8812au/include/HalVerDef.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/HalVerDef.h 2018-02-06 17:42:30.717967268 +0200 +@@ -0,0 +1,160 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -306913,18 +136498,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/HalVerDef.h linux/3rdparty/rtl88 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __HAL_VERSION_DEF_H__ +#define __HAL_VERSION_DEF_H__ + -+#define TRUE _TRUE -+#define FALSE _FALSE -+ +// HAL_IC_TYPE_E +typedef enum tag_HAL_IC_Type_Definition +{ @@ -306936,49 +136513,42 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/HalVerDef.h linux/3rdparty/rtl88 + CHIP_8188E = 5, + CHIP_8812 = 6, + CHIP_8821 = 7, -+ CHIP_8723B = 8, -+ CHIP_8192E = 9, -+ CHIP_8814A = 10, -+ CHIP_8703B = 11, -+ CHIP_8188F = 12, ++ CHIP_8723B = 8, ++ CHIP_8192E = 9, +}HAL_IC_TYPE_E; + +//HAL_CHIP_TYPE_E +typedef enum tag_HAL_CHIP_Type_Definition +{ -+ TEST_CHIP = 0, -+ NORMAL_CHIP = 1, ++ TEST_CHIP = 0, ++ NORMAL_CHIP = 1, + FPGA = 2, +}HAL_CHIP_TYPE_E; + +//HAL_CUT_VERSION_E +typedef enum tag_HAL_Cut_Version_Definition +{ -+ A_CUT_VERSION = 0, -+ B_CUT_VERSION = 1, -+ C_CUT_VERSION = 2, -+ D_CUT_VERSION = 3, -+ E_CUT_VERSION = 4, -+ F_CUT_VERSION = 5, -+ G_CUT_VERSION = 6, -+ H_CUT_VERSION = 7, -+ I_CUT_VERSION = 8, -+ J_CUT_VERSION = 9, -+ K_CUT_VERSION = 10, ++ A_CUT_VERSION = 0, ++ B_CUT_VERSION = 1, ++ C_CUT_VERSION = 2, ++ D_CUT_VERSION = 3, ++ E_CUT_VERSION = 4, ++ F_CUT_VERSION = 5, ++ G_CUT_VERSION = 6, +}HAL_CUT_VERSION_E; + +// HAL_Manufacturer +typedef enum tag_HAL_Manufacturer_Version_Definition +{ -+ CHIP_VENDOR_TSMC = 0, -+ CHIP_VENDOR_UMC = 1, -+ CHIP_VENDOR_SMIC = 2, ++ CHIP_VENDOR_TSMC = 0, ++ CHIP_VENDOR_UMC = 1, ++ CHIP_VENDOR_SMIC = 2, +}HAL_VENDOR_E; + +typedef enum tag_HAL_RF_Type_Definition +{ -+ RF_TYPE_1T1R = 0, -+ RF_TYPE_1T2R = 1, ++ RF_TYPE_1T1R = 0, ++ RF_TYPE_1T2R = 1, + RF_TYPE_2T2R = 2, + RF_TYPE_2T3R = 3, + RF_TYPE_2T4R = 4, @@ -306993,7 +136563,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/HalVerDef.h linux/3rdparty/rtl88 + HAL_CHIP_TYPE_E ChipType; + HAL_CUT_VERSION_E CUTVersion; + HAL_VENDOR_E VendorType; -+ HAL_RF_TYPE_E RFType; ++ HAL_RF_TYPE_E RFType; + u8 ROMVer; +}HAL_VERSION,*PHAL_VERSION; + @@ -307001,12 +136571,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/HalVerDef.h linux/3rdparty/rtl88 +//HAL_VERSION VersionID; + +// Get element -+#define GET_CVID_IC_TYPE(version) ((HAL_IC_TYPE_E)(((HAL_VERSION)version).ICType) ) -+#define GET_CVID_CHIP_TYPE(version) ((HAL_CHIP_TYPE_E)(((HAL_VERSION)version).ChipType) ) -+#define GET_CVID_RF_TYPE(version) ((HAL_RF_TYPE_E)(((HAL_VERSION)version).RFType)) -+#define GET_CVID_MANUFACTUER(version) ((HAL_VENDOR_E)(((HAL_VERSION)version).VendorType)) -+#define GET_CVID_CUT_VERSION(version) ((HAL_CUT_VERSION_E)(((HAL_VERSION)version).CUTVersion)) -+#define GET_CVID_ROM_VERSION(version) ((((HAL_VERSION)version).ROMVer) & ROM_VERSION_MASK) ++#define GET_CVID_IC_TYPE(version) (((version).ICType) ) ++#define GET_CVID_CHIP_TYPE(version) (((version).ChipType) ) ++#define GET_CVID_RF_TYPE(version) (((version).RFType)) ++#define GET_CVID_MANUFACTUER(version) (((version).VendorType)) ++#define GET_CVID_CUT_VERSION(version) (((version).CUTVersion)) ++#define GET_CVID_ROM_VERSION(version) (((version).ROMVer) & ROM_VERSION_MASK) + +//---------------------------------------------------------------------------- +//Common Macro. -- @@ -307014,102 +136584,75 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/HalVerDef.h linux/3rdparty/rtl88 +//HAL_VERSION VersionID + +// HAL_IC_TYPE_E -+#if 0 -+#define IS_81XXC(version) (((GET_CVID_IC_TYPE(version) == CHIP_8192C)||(GET_CVID_IC_TYPE(version) == CHIP_8188C))? TRUE : FALSE) -+#define IS_8723_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8723A)? TRUE : FALSE) -+#define IS_92D(version) ((GET_CVID_IC_TYPE(version) == CHIP_8192D)? TRUE : FALSE) -+#endif ++#define IS_81XXC(version) (((GET_CVID_IC_TYPE(version) == CHIP_8192C)||(GET_CVID_IC_TYPE(version) == CHIP_8188C))? true : false) ++#define IS_8723_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8723A)? true : false) ++#define IS_92D(version) ((GET_CVID_IC_TYPE(version) == CHIP_8192D)? true : false) ++#define IS_8188E(version) ((GET_CVID_IC_TYPE(version) == CHIP_8188E)? true : false) ++#define IS_8192E(version) ((GET_CVID_IC_TYPE(version) == CHIP_8192E)? true : false) ++#define IS_8812_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8812)? true : false) ++#define IS_8821_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8821)? true : false) ++#define IS_8723B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8723B)? true : false) + -+#define IS_8188E(version) ((GET_CVID_IC_TYPE(version) == CHIP_8188E)? TRUE : FALSE) -+#define IS_8188F(version) ((GET_CVID_IC_TYPE(version) == CHIP_8188F) ? TRUE : FALSE) -+#define IS_8192E(version) ((GET_CVID_IC_TYPE(version) == CHIP_8192E)? TRUE : FALSE) -+#define IS_8812_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8812)? TRUE : FALSE) -+#define IS_8821_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8821)? TRUE : FALSE) -+#define IS_8814A_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8814A) ? TRUE : FALSE) -+#define IS_8723B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8723B)? TRUE : FALSE) -+#define IS_8703B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8703B)? TRUE : FALSE) + +//HAL_CHIP_TYPE_E -+#define IS_TEST_CHIP(version) ((GET_CVID_CHIP_TYPE(version)==TEST_CHIP)? TRUE: FALSE) -+#define IS_NORMAL_CHIP(version) ((GET_CVID_CHIP_TYPE(version)==NORMAL_CHIP)? TRUE: FALSE) ++#define IS_TEST_CHIP(version) ((GET_CVID_CHIP_TYPE(version)==TEST_CHIP)? true: false) ++#define IS_NORMAL_CHIP(version) ((GET_CVID_CHIP_TYPE(version)==NORMAL_CHIP)? true: false) + +//HAL_CUT_VERSION_E -+#define IS_A_CUT(version) ((GET_CVID_CUT_VERSION(version) == A_CUT_VERSION) ? TRUE : FALSE) -+#define IS_B_CUT(version) ((GET_CVID_CUT_VERSION(version) == B_CUT_VERSION) ? TRUE : FALSE) -+#define IS_C_CUT(version) ((GET_CVID_CUT_VERSION(version) == C_CUT_VERSION) ? TRUE : FALSE) -+#define IS_D_CUT(version) ((GET_CVID_CUT_VERSION(version) == D_CUT_VERSION) ? TRUE : FALSE) -+#define IS_E_CUT(version) ((GET_CVID_CUT_VERSION(version) == E_CUT_VERSION) ? TRUE : FALSE) -+#define IS_F_CUT(version) ((GET_CVID_CUT_VERSION(version) == F_CUT_VERSION) ? TRUE : FALSE) -+#define IS_I_CUT(version) ((GET_CVID_CUT_VERSION(version) == I_CUT_VERSION) ? TRUE : FALSE) -+#define IS_J_CUT(version) ((GET_CVID_CUT_VERSION(version) == J_CUT_VERSION) ? TRUE : FALSE) -+#define IS_K_CUT(version) ((GET_CVID_CUT_VERSION(version) == K_CUT_VERSION) ? TRUE : FALSE) ++#define IS_A_CUT(version) ((GET_CVID_CUT_VERSION(version) == A_CUT_VERSION) ? true : false) ++#define IS_B_CUT(version) ((GET_CVID_CUT_VERSION(version) == B_CUT_VERSION) ? true : false) ++#define IS_C_CUT(version) ((GET_CVID_CUT_VERSION(version) == C_CUT_VERSION) ? true : false) ++#define IS_D_CUT(version) ((GET_CVID_CUT_VERSION(version) == D_CUT_VERSION) ? true : false) ++#define IS_E_CUT(version) ((GET_CVID_CUT_VERSION(version) == E_CUT_VERSION) ? true : false) ++ + +//HAL_VENDOR_E -+#define IS_CHIP_VENDOR_TSMC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_TSMC)? TRUE: FALSE) -+#define IS_CHIP_VENDOR_UMC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_UMC)? TRUE: FALSE) -+#define IS_CHIP_VENDOR_SMIC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_SMIC)? TRUE: FALSE) ++#define IS_CHIP_VENDOR_TSMC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_TSMC)? true: false) ++#define IS_CHIP_VENDOR_UMC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_UMC)? true: false) ++#define IS_CHIP_VENDOR_SMIC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_SMIC)? true: false) + +//HAL_RF_TYPE_E -+#define IS_1T1R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_1T1R)? TRUE : FALSE ) -+#define IS_1T2R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_1T2R)? TRUE : FALSE) -+#define IS_2T2R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_2T2R)? TRUE : FALSE) -+#define IS_3T3R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_3T3R)? TRUE : FALSE) -+#define IS_3T4R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_3T4R)? TRUE : FALSE) -+#define IS_4T4R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_4T4R)? TRUE : FALSE) -+ ++#define IS_1T1R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_1T1R)? true : false ) ++#define IS_1T2R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_1T2R)? true : false) ++#define IS_2T2R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_2T2R)? true : false) + + +//---------------------------------------------------------------------------- +//Chip version Macro. -- +//---------------------------------------------------------------------------- -+#if 0 -+#define IS_81XXC_TEST_CHIP(version) ((IS_81XXC(version) && (!IS_NORMAL_CHIP(version)))? TRUE: FALSE) ++#define IS_81XXC_TEST_CHIP(version) ((IS_81XXC(version) && (!IS_NORMAL_CHIP(version)))? true: false) + -+#define IS_92C_SERIAL(version) ((IS_81XXC(version) && IS_2T2R(version)) ? TRUE : FALSE) -+#define IS_81xxC_VENDOR_UMC_A_CUT(version) (IS_81XXC(version)?(IS_CHIP_VENDOR_UMC(version) ? (IS_A_CUT(version) ? TRUE : FALSE) : FALSE): FALSE) -+#define IS_81xxC_VENDOR_UMC_B_CUT(version) (IS_81XXC(version)?(IS_CHIP_VENDOR_UMC(version) ? (IS_B_CUT(version) ? TRUE : FALSE) : FALSE): FALSE) -+#define IS_81xxC_VENDOR_UMC_C_CUT(version) (IS_81XXC(version)?(IS_CHIP_VENDOR_UMC(version) ? (IS_C_CUT(version) ? TRUE : FALSE) : FALSE): FALSE) ++#define IS_92C_SERIAL(version) ((IS_81XXC(version) && IS_2T2R(version)) ? true : false) ++#define IS_81xxC_VENDOR_UMC_A_CUT(version) (IS_81XXC(version)?(IS_CHIP_VENDOR_UMC(version) ? (IS_A_CUT(version) ? true : false) : false): false) ++#define IS_81xxC_VENDOR_UMC_B_CUT(version) (IS_81XXC(version)?(IS_CHIP_VENDOR_UMC(version) ? (IS_B_CUT(version) ? true : false) : false): false) ++#define IS_81xxC_VENDOR_UMC_C_CUT(version) (IS_81XXC(version)?(IS_CHIP_VENDOR_UMC(version) ? (IS_C_CUT(version) ? true : false) : false): false) + -+#define IS_NORMAL_CHIP92D(version) (( IS_92D(version))?((GET_CVID_CHIP_TYPE(version)==NORMAL_CHIP)? TRUE: FALSE):FALSE) ++#define IS_NORMAL_CHIP92D(version) (( IS_92D(version))?((GET_CVID_CHIP_TYPE(version)==NORMAL_CHIP)? true: false):false) + -+#define IS_92D_SINGLEPHY(version) ((IS_92D(version)) ? (IS_2T2R(version) ? TRUE: FALSE) : FALSE) -+#define IS_92D_C_CUT(version) ((IS_92D(version)) ? (IS_C_CUT(version) ? TRUE : FALSE) : FALSE) -+#define IS_92D_D_CUT(version) ((IS_92D(version)) ? (IS_D_CUT(version) ? TRUE : FALSE) : FALSE) -+#define IS_92D_E_CUT(version) ((IS_92D(version)) ? (IS_E_CUT(version) ? TRUE : FALSE) : FALSE) ++#define IS_92D_SINGLEPHY(version) ((IS_92D(version)) ? (IS_2T2R(version) ? true: false) : false) ++#define IS_92D_C_CUT(version) ((IS_92D(version)) ? (IS_C_CUT(version) ? true : false) : false) ++#define IS_92D_D_CUT(version) ((IS_92D(version)) ? (IS_D_CUT(version) ? true : false) : false) ++#define IS_92D_E_CUT(version) ((IS_92D(version)) ? (IS_E_CUT(version) ? true : false) : false) + -+#define IS_8723A_A_CUT(version) ((IS_8723_SERIES(version)) ? ( IS_A_CUT(version)?TRUE : FALSE) : FALSE) -+#define IS_8723A_B_CUT(version) ((IS_8723_SERIES(version)) ? ( IS_B_CUT(version)?TRUE : FALSE) : FALSE) -+#endif ++#define IS_8723A_A_CUT(version) ((IS_8723_SERIES(version)) ? ( IS_A_CUT(version)?true : false) : false) ++#define IS_8723A_B_CUT(version) ((IS_8723_SERIES(version)) ? ( IS_B_CUT(version)?true : false) : false) + -+#define IS_VENDOR_8188E_I_CUT_SERIES(_Adapter) ((IS_8188E(GET_HAL_DATA(_Adapter)->VersionID)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) >= I_CUT_VERSION) ? TRUE : FALSE) : FALSE) ++#define IS_VENDOR_8812A_TEST_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? false : true) : false) ++#define IS_VENDOR_8812A_MP_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? true : false) : false) ++#define IS_VENDOR_8812A_C_CUT(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) == C_CUT_VERSION) ? true : false) : false) + -+#define IS_VENDOR_8812A_TEST_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8812A_MP_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) -+#define IS_VENDOR_8812A_C_CUT(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) == C_CUT_VERSION) ? TRUE : FALSE) : FALSE) -+ -+#define IS_VENDOR_8821A_TEST_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8821A_MP_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) -+ -+#define IS_VENDOR_8192E_B_CUT(_Adapter) ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) == B_CUT_VERSION) ? TRUE : FALSE) -+ -+#define IS_VENDOR_8723B_TEST_CHIP(_Adapter) ((IS_8723B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8723B_MP_CHIP(_Adapter) ((IS_8723B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) -+ -+#define IS_VENDOR_8703B_TEST_CHIP(_Adapter) ((IS_8703B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8703B_MP_CHIP(_Adapter) ((IS_8703B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) -+#define IS_VENDOR_8814A_TEST_CHIP(_Adapter) ((IS_8814A_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8814A_MP_CHIP(_Adapter) ((IS_8814A_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) ++#define IS_VENDOR_8821A_TEST_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? false : true) : false) ++#define IS_VENDOR_8821A_MP_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? true : false) : false) + +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211_ext.h linux/3rdparty/rtl8812au/include/ieee80211_ext.h ---- linux.old/3rdparty/rtl8812au/include/ieee80211_ext.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/ieee80211_ext.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,477 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/ieee80211_ext.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/ieee80211_ext.h +--- linux-4.14.17/3rdparty/rtl8812au/include/ieee80211_ext.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/ieee80211_ext.h 2018-02-06 17:42:30.718967283 +0200 +@@ -0,0 +1,281 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -307119,478 +136662,282 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211_ext.h linux/3rdparty/r + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __IEEE80211_EXT_H -+#define __IEEE80211_EXT_H -+ -+#include -+#include -+#include -+ -+#define WMM_OUI_TYPE 2 -+#define WMM_OUI_SUBTYPE_INFORMATION_ELEMENT 0 -+#define WMM_OUI_SUBTYPE_PARAMETER_ELEMENT 1 -+#define WMM_OUI_SUBTYPE_TSPEC_ELEMENT 2 -+#define WMM_VERSION 1 -+ -+#define WPA_PROTO_WPA BIT(0) -+#define WPA_PROTO_RSN BIT(1) -+ -+#define WPA_KEY_MGMT_IEEE8021X BIT(0) -+#define WPA_KEY_MGMT_PSK BIT(1) -+#define WPA_KEY_MGMT_NONE BIT(2) -+#define WPA_KEY_MGMT_IEEE8021X_NO_WPA BIT(3) -+#define WPA_KEY_MGMT_WPA_NONE BIT(4) -+ -+ -+#define WPA_CAPABILITY_PREAUTH BIT(0) -+#define WPA_CAPABILITY_MGMT_FRAME_PROTECTION BIT(6) -+#define WPA_CAPABILITY_PEERKEY_ENABLED BIT(9) -+ -+ -+#define PMKID_LEN 16 -+ -+ -+#ifdef PLATFORM_LINUX -+struct wpa_ie_hdr { -+ u8 elem_id; -+ u8 len; -+ u8 oui[4]; /* 24-bit OUI followed by 8-bit OUI type */ -+ u8 version[2]; /* little endian */ -+}__attribute__ ((packed)); -+ -+struct rsn_ie_hdr { -+ u8 elem_id; /* WLAN_EID_RSN */ -+ u8 len; -+ u8 version[2]; /* little endian */ -+}__attribute__ ((packed)); -+ -+struct wme_ac_parameter { -+#if defined(CONFIG_LITTLE_ENDIAN) -+ /* byte 1 */ -+ u8 aifsn:4, -+ acm:1, -+ aci:2, -+ reserved:1; -+ -+ /* byte 2 */ -+ u8 eCWmin:4, -+ eCWmax:4; -+#elif defined(CONFIG_BIG_ENDIAN) -+ /* byte 1 */ -+ u8 reserved:1, -+ aci:2, -+ acm:1, -+ aifsn:4; -+ -+ /* byte 2 */ -+ u8 eCWmax:4, -+ eCWmin:4; -+#else -+#error "Please fix " -+#endif -+ -+ /* bytes 3 & 4 */ -+ u16 txopLimit; -+} __attribute__ ((packed)); -+ -+struct wme_parameter_element { -+ /* required fields for WME version 1 */ -+ u8 oui[3]; -+ u8 oui_type; -+ u8 oui_subtype; -+ u8 version; -+ u8 acInfo; -+ u8 reserved; -+ struct wme_ac_parameter ac[4]; -+ -+} __attribute__ ((packed)); -+ -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+ -+struct wpa_ie_hdr { -+ u8 elem_id; -+ u8 len; -+ u8 oui[4]; /* 24-bit OUI followed by 8-bit OUI type */ -+ u8 version[2]; /* little endian */ -+}; -+ -+struct rsn_ie_hdr { -+ u8 elem_id; /* WLAN_EID_RSN */ -+ u8 len; -+ u8 version[2]; /* little endian */ -+}; -+ -+#pragma pack() -+ -+#endif -+ -+#define WPA_PUT_LE16(a, val) \ -+ do { \ -+ (a)[1] = ((u16) (val)) >> 8; \ -+ (a)[0] = ((u16) (val)) & 0xff; \ -+ } while (0) -+ -+#define WPA_PUT_BE32(a, val) \ -+ do { \ -+ (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[3] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define WPA_PUT_LE32(a, val) \ -+ do { \ -+ (a)[3] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[0] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define RSN_SELECTOR_PUT(a, val) WPA_PUT_BE32((u8 *) (a), (val)) -+//#define RSN_SELECTOR_PUT(a, val) WPA_PUT_LE32((u8 *) (a), (val)) -+ -+ -+ -+/* Action category code */ -+enum ieee80211_category { -+ WLAN_CATEGORY_SPECTRUM_MGMT = 0, -+ WLAN_CATEGORY_QOS = 1, -+ WLAN_CATEGORY_DLS = 2, -+ WLAN_CATEGORY_BACK = 3, -+ WLAN_CATEGORY_HT = 7, -+ WLAN_CATEGORY_WMM = 17, -+}; -+ -+/* SPECTRUM_MGMT action code */ -+enum ieee80211_spectrum_mgmt_actioncode { -+ WLAN_ACTION_SPCT_MSR_REQ = 0, -+ WLAN_ACTION_SPCT_MSR_RPRT = 1, -+ WLAN_ACTION_SPCT_TPC_REQ = 2, -+ WLAN_ACTION_SPCT_TPC_RPRT = 3, -+ WLAN_ACTION_SPCT_CHL_SWITCH = 4, -+ WLAN_ACTION_SPCT_EXT_CHL_SWITCH = 5, -+}; -+ -+/* BACK action code */ -+enum ieee80211_back_actioncode { -+ WLAN_ACTION_ADDBA_REQ = 0, -+ WLAN_ACTION_ADDBA_RESP = 1, -+ WLAN_ACTION_DELBA = 2, -+}; -+ -+/* HT features action code */ -+enum ieee80211_ht_actioncode { -+ WLAN_ACTION_NOTIFY_CH_WIDTH = 0, -+ WLAN_ACTION_SM_PS = 1, -+ WLAN_ACTION_PSPM = 2, -+ WLAN_ACTION_PCO_PHASE = 3, -+ WLAN_ACTION_MIMO_CSI_MX = 4, -+ WLAN_ACTION_MIMO_NONCP_BF = 5, -+ WLAN_ACTION_MIMP_CP_BF = 6, -+ WLAN_ACTION_ASEL_INDICATES_FB = 7, -+ WLAN_ACTION_HI_INFO_EXCHG = 8, -+}; -+ -+/* BACK (block-ack) parties */ -+enum ieee80211_back_parties { -+ WLAN_BACK_RECIPIENT = 0, -+ WLAN_BACK_INITIATOR = 1, -+ WLAN_BACK_TIMER = 2, -+}; -+ -+#ifdef PLATFORM_LINUX -+ -+struct ieee80211_mgmt { -+ u16 frame_control; -+ u16 duration; -+ u8 da[6]; -+ u8 sa[6]; -+ u8 bssid[6]; -+ u16 seq_ctrl; -+ union { -+ struct { -+ u16 auth_alg; -+ u16 auth_transaction; -+ u16 status_code; -+ /* possibly followed by Challenge text */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) auth; -+ struct { -+ u16 reason_code; -+ } __attribute__ ((packed)) deauth; -+ struct { -+ u16 capab_info; -+ u16 listen_interval; -+ /* followed by SSID and Supported rates */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) assoc_req; -+ struct { -+ u16 capab_info; -+ u16 status_code; -+ u16 aid; -+ /* followed by Supported rates */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) assoc_resp, reassoc_resp; -+ struct { -+ u16 capab_info; -+ u16 listen_interval; -+ u8 current_ap[6]; -+ /* followed by SSID and Supported rates */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) reassoc_req; -+ struct { -+ u16 reason_code; -+ } __attribute__ ((packed)) disassoc; -+ struct { -+ __le64 timestamp; -+ u16 beacon_int; -+ u16 capab_info; -+ /* followed by some of SSID, Supported rates, -+ * FH Params, DS Params, CF Params, IBSS Params, TIM */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) beacon; -+ struct { -+ /* only variable items: SSID, Supported rates */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) probe_req; -+ struct { -+ __le64 timestamp; -+ u16 beacon_int; -+ u16 capab_info; -+ /* followed by some of SSID, Supported rates, -+ * FH Params, DS Params, CF Params, IBSS Params */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) probe_resp; -+ struct { -+ u8 category; -+ union { -+ struct { -+ u8 action_code; -+ u8 dialog_token; -+ u8 status_code; -+ u8 variable[0]; -+ } __attribute__ ((packed)) wme_action; -+#if 0 -+ struct{ -+ u8 action_code; -+ u8 element_id; -+ u8 length; -+ struct ieee80211_channel_sw_ie sw_elem; -+ } __attribute__ ((packed)) chan_switch; -+ struct{ -+ u8 action_code; -+ u8 dialog_token; -+ u8 element_id; -+ u8 length; -+ struct ieee80211_msrment_ie msr_elem; -+ } __attribute__ ((packed)) measurement; -+#endif -+ struct{ -+ u8 action_code; -+ u8 dialog_token; -+ u16 capab; -+ u16 timeout; -+ u16 start_seq_num; -+ } __attribute__ ((packed)) addba_req; -+ struct{ -+ u8 action_code; -+ u8 dialog_token; -+ u16 status; -+ u16 capab; -+ u16 timeout; -+ } __attribute__ ((packed)) addba_resp; -+ struct{ -+ u8 action_code; -+ u16 params; -+ u16 reason_code; -+ } __attribute__ ((packed)) delba; -+ struct{ -+ u8 action_code; -+ /* capab_info for open and confirm, -+ * reason for close -+ */ -+ u16 aux; -+ /* Followed in plink_confirm by status -+ * code, AID and supported rates, -+ * and directly by supported rates in -+ * plink_open and plink_close -+ */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) plink_action; -+ struct{ -+ u8 action_code; -+ u8 variable[0]; -+ } __attribute__ ((packed)) mesh_action; -+ } __attribute__ ((packed)) u; -+ } __attribute__ ((packed)) action; -+ } __attribute__ ((packed)) u; -+}__attribute__ ((packed)); -+ -+#endif -+ -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+ -+struct ieee80211_mgmt { -+ u16 frame_control; -+ u16 duration; -+ u8 da[6]; -+ u8 sa[6]; -+ u8 bssid[6]; -+ u16 seq_ctrl; -+ union { -+ struct { -+ u16 auth_alg; -+ u16 auth_transaction; -+ u16 status_code; -+ /* possibly followed by Challenge text */ -+ u8 variable[0]; -+ } auth; -+ struct { -+ u16 reason_code; -+ } deauth; -+ struct { -+ u16 capab_info; -+ u16 listen_interval; -+ /* followed by SSID and Supported rates */ -+ u8 variable[0]; -+ } assoc_req; -+ struct { -+ u16 capab_info; -+ u16 status_code; -+ u16 aid; -+ /* followed by Supported rates */ -+ u8 variable[0]; -+ } assoc_resp, reassoc_resp; -+ struct { -+ u16 capab_info; -+ u16 listen_interval; -+ u8 current_ap[6]; -+ /* followed by SSID and Supported rates */ -+ u8 variable[0]; -+ } reassoc_req; -+ struct { -+ u16 reason_code; -+ } disassoc; -+#if 0 -+ struct { -+ __le64 timestamp; -+ u16 beacon_int; -+ u16 capab_info; -+ /* followed by some of SSID, Supported rates, -+ * FH Params, DS Params, CF Params, IBSS Params, TIM */ -+ u8 variable[0]; -+ } beacon; -+ struct { -+ /* only variable items: SSID, Supported rates */ -+ u8 variable[0]; -+ } probe_req; -+ -+ struct { -+ __le64 timestamp; -+ u16 beacon_int; -+ u16 capab_info; -+ /* followed by some of SSID, Supported rates, -+ * FH Params, DS Params, CF Params, IBSS Params */ -+ u8 variable[0]; -+ } probe_resp; -+#endif -+ struct { -+ u8 category; -+ union { -+ struct { -+ u8 action_code; -+ u8 dialog_token; -+ u8 status_code; -+ u8 variable[0]; -+ } wme_action; -+/* -+ struct{ -+ u8 action_code; -+ u8 element_id; -+ u8 length; -+ struct ieee80211_channel_sw_ie sw_elem; -+ } chan_switch; -+ struct{ -+ u8 action_code; -+ u8 dialog_token; -+ u8 element_id; -+ u8 length; -+ struct ieee80211_msrment_ie msr_elem; -+ } measurement; -+*/ -+ struct{ -+ u8 action_code; -+ u8 dialog_token; -+ u16 capab; -+ u16 timeout; -+ u16 start_seq_num; -+ } addba_req; -+ struct{ -+ u8 action_code; -+ u8 dialog_token; -+ u16 status; -+ u16 capab; -+ u16 timeout; -+ } addba_resp; -+ struct{ -+ u8 action_code; -+ u16 params; -+ u16 reason_code; -+ } delba; -+ struct{ -+ u8 action_code; -+ /* capab_info for open and confirm, -+ * reason for close -+ */ -+ u16 aux; -+ /* Followed in plink_confirm by status -+ * code, AID and supported rates, -+ * and directly by supported rates in -+ * plink_open and plink_close -+ */ -+ u8 variable[0]; -+ } plink_action; -+ struct{ -+ u8 action_code; -+ u8 variable[0]; -+ } mesh_action; -+ } u; -+ } action; -+ } u; -+} ; -+ -+#pragma pack() -+ -+#endif -+ -+/* mgmt header + 1 byte category code */ -+#define IEEE80211_MIN_ACTION_SIZE FIELD_OFFSET(struct ieee80211_mgmt, u.action.u) -+ -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl8812au/include/ieee80211.h ---- linux.old/3rdparty/rtl8812au/include/ieee80211.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/ieee80211.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,1823 @@ ++ ******************************************************************************/ ++#ifndef __IEEE80211_EXT_H ++#define __IEEE80211_EXT_H ++ ++#include ++#include ++#include ++ ++#define WMM_OUI_TYPE 2 ++#define WMM_OUI_SUBTYPE_INFORMATION_ELEMENT 0 ++#define WMM_OUI_SUBTYPE_PARAMETER_ELEMENT 1 ++#define WMM_OUI_SUBTYPE_TSPEC_ELEMENT 2 ++#define WMM_VERSION 1 ++ ++#define WPA_PROTO_WPA BIT(0) ++#define WPA_PROTO_RSN BIT(1) ++ ++#define WPA_KEY_MGMT_IEEE8021X BIT(0) ++#define WPA_KEY_MGMT_PSK BIT(1) ++#define WPA_KEY_MGMT_NONE BIT(2) ++#define WPA_KEY_MGMT_IEEE8021X_NO_WPA BIT(3) ++#define WPA_KEY_MGMT_WPA_NONE BIT(4) ++ ++ ++#define WPA_CAPABILITY_PREAUTH BIT(0) ++#define WPA_CAPABILITY_MGMT_FRAME_PROTECTION BIT(6) ++#define WPA_CAPABILITY_PEERKEY_ENABLED BIT(9) ++ ++#define PMKID_LEN 16 ++ ++struct wpa_ie_hdr { ++ u8 elem_id; ++ u8 len; ++ u8 oui[4]; /* 24-bit OUI followed by 8-bit OUI type */ ++ u8 version[2]; /* little endian */ ++}__attribute__ ((packed)); ++ ++struct rsn_ie_hdr { ++ u8 elem_id; /* WLAN_EID_RSN */ ++ u8 len; ++ u8 version[2]; /* little endian */ ++}__attribute__ ((packed)); ++ ++struct wme_ac_parameter { ++#if defined(__LITTLE_ENDIAN) ++ /* byte 1 */ ++ u8 aifsn:4, ++ acm:1, ++ aci:2, ++ reserved:1; ++ ++ /* byte 2 */ ++ u8 eCWmin:4, ++ eCWmax:4; ++#else ++ /* byte 1 */ ++ u8 reserved:1, ++ aci:2, ++ acm:1, ++ aifsn:4; ++ ++ /* byte 2 */ ++ u8 eCWmax:4, ++ eCWmin:4; ++#endif ++ ++ /* bytes 3 & 4 */ ++ u16 txopLimit; ++} __attribute__ ((packed)); ++ ++struct wme_parameter_element { ++ /* required fields for WME version 1 */ ++ u8 oui[3]; ++ u8 oui_type; ++ u8 oui_subtype; ++ u8 version; ++ u8 acInfo; ++ u8 reserved; ++ struct wme_ac_parameter ac[4]; ++ ++} __attribute__ ((packed)); ++ ++#define WPA_PUT_LE16(a, val) \ ++ do { \ ++ (a)[1] = ((u16) (val)) >> 8; \ ++ (a)[0] = ((u16) (val)) & 0xff; \ ++ } while (0) ++ ++#define WPA_PUT_BE32(a, val) \ ++ do { \ ++ (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ ++ (a)[1] = (u8) ((((u32) (val)) >> 16) & 0xff); \ ++ (a)[2] = (u8) ((((u32) (val)) >> 8) & 0xff); \ ++ (a)[3] = (u8) (((u32) (val)) & 0xff); \ ++ } while (0) ++ ++#define WPA_PUT_LE32(a, val) \ ++ do { \ ++ (a)[3] = (u8) ((((u32) (val)) >> 24) & 0xff); \ ++ (a)[2] = (u8) ((((u32) (val)) >> 16) & 0xff); \ ++ (a)[1] = (u8) ((((u32) (val)) >> 8) & 0xff); \ ++ (a)[0] = (u8) (((u32) (val)) & 0xff); \ ++ } while (0) ++ ++#define RSN_SELECTOR_PUT(a, val) WPA_PUT_BE32((u8 *) (a), (val)) ++ ++/* Action category code */ ++enum ieee80211_category { ++ WLAN_CATEGORY_SPECTRUM_MGMT = 0, ++ WLAN_CATEGORY_QOS = 1, ++ WLAN_CATEGORY_DLS = 2, ++ WLAN_CATEGORY_BACK = 3, ++ WLAN_CATEGORY_HT = 7, ++ WLAN_CATEGORY_WMM = 17, ++}; ++ ++/* SPECTRUM_MGMT action code */ ++enum ieee80211_spectrum_mgmt_actioncode { ++ WLAN_ACTION_SPCT_MSR_REQ = 0, ++ WLAN_ACTION_SPCT_MSR_RPRT = 1, ++ WLAN_ACTION_SPCT_TPC_REQ = 2, ++ WLAN_ACTION_SPCT_TPC_RPRT = 3, ++ WLAN_ACTION_SPCT_CHL_SWITCH = 4, ++ WLAN_ACTION_SPCT_EXT_CHL_SWITCH = 5, ++}; ++ ++/* BACK action code */ ++enum ieee80211_back_actioncode { ++ WLAN_ACTION_ADDBA_REQ = 0, ++ WLAN_ACTION_ADDBA_RESP = 1, ++ WLAN_ACTION_DELBA = 2, ++}; ++ ++/* HT features action code */ ++enum ieee80211_ht_actioncode { ++ WLAN_ACTION_NOTIFY_CH_WIDTH = 0, ++ WLAN_ACTION_SM_PS = 1, ++ WLAN_ACTION_PSPM = 2, ++ WLAN_ACTION_PCO_PHASE = 3, ++ WLAN_ACTION_MIMO_CSI_MX = 4, ++ WLAN_ACTION_MIMO_NONCP_BF = 5, ++ WLAN_ACTION_MIMP_CP_BF = 6, ++ WLAN_ACTION_ASEL_INDICATES_FB = 7, ++ WLAN_ACTION_HI_INFO_EXCHG = 8, ++}; ++ ++/* BACK (block-ack) parties */ ++enum ieee80211_back_parties { ++ WLAN_BACK_RECIPIENT = 0, ++ WLAN_BACK_INITIATOR = 1, ++ WLAN_BACK_TIMER = 2, ++}; ++ ++struct ieee80211_mgmt { ++ __le16 frame_control; ++ __le16 duration; ++ u8 da[6]; ++ u8 sa[6]; ++ u8 bssid[6]; ++ __le16 seq_ctrl; ++ union { ++ struct { ++ __le16 auth_alg; ++ __le16 auth_transaction; ++ __le16 status_code; ++ /* possibly followed by Challenge text */ ++ u8 variable[0]; ++ } __attribute__ ((packed)) auth; ++ struct { ++ __le16 reason_code; ++ } __attribute__ ((packed)) deauth; ++ struct { ++ __le16 capab_info; ++ __le16 listen_interval; ++ /* followed by SSID and Supported rates */ ++ u8 variable[0]; ++ } __attribute__ ((packed)) assoc_req; ++ struct { ++ __le16 capab_info; ++ __le16 status_code; ++ __le16 aid; ++ /* followed by Supported rates */ ++ u8 variable[0]; ++ } __attribute__ ((packed)) assoc_resp, reassoc_resp; ++ struct { ++ __le16 capab_info; ++ __le16 listen_interval; ++ u8 current_ap[6]; ++ /* followed by SSID and Supported rates */ ++ u8 variable[0]; ++ } __attribute__ ((packed)) reassoc_req; ++ struct { ++ __le16 reason_code; ++ } __attribute__ ((packed)) disassoc; ++ struct { ++ __le64 timestamp; ++ __le16 beacon_int; ++ __le16 capab_info; ++ /* followed by some of SSID, Supported rates, ++ * FH Params, DS Params, CF Params, IBSS Params, TIM */ ++ u8 variable[0]; ++ } __attribute__ ((packed)) beacon; ++ struct { ++ /* only variable items: SSID, Supported rates */ ++ u8 variable[0]; ++ } __attribute__ ((packed)) probe_req; ++ struct { ++ __le64 timestamp; ++ __le16 beacon_int; ++ __le16 capab_info; ++ /* followed by some of SSID, Supported rates, ++ * FH Params, DS Params, CF Params, IBSS Params */ ++ u8 variable[0]; ++ } __attribute__ ((packed)) probe_resp; ++ struct { ++ u8 category; ++ union { ++ struct { ++ u8 action_code; ++ u8 dialog_token; ++ u8 status_code; ++ u8 variable[0]; ++ } __attribute__ ((packed)) wme_action; ++ struct{ ++ u8 action_code; ++ u8 dialog_token; ++ __le16 capab; ++ __le16 timeout; ++ __le16 start_seq_num; ++ } __attribute__ ((packed)) addba_req; ++ struct{ ++ u8 action_code; ++ u8 dialog_token; ++ __le16 status; ++ __le16 capab; ++ __le16 timeout; ++ } __attribute__ ((packed)) addba_resp; ++ struct{ ++ u8 action_code; ++ __le16 params; ++ __le16 reason_code; ++ } __attribute__ ((packed)) delba; ++ struct{ ++ u8 action_code; ++ /* capab_info for open and confirm, ++ * reason for close ++ */ ++ __le16 aux; ++ /* Followed in plink_confirm by status ++ * code, AID and supported rates, ++ * and directly by supported rates in ++ * plink_open and plink_close ++ */ ++ u8 variable[0]; ++ } __attribute__ ((packed)) plink_action; ++ struct{ ++ u8 action_code; ++ u8 variable[0]; ++ } __attribute__ ((packed)) mesh_action; ++ } __attribute__ ((packed)) u; ++ } __attribute__ ((packed)) action; ++ } __attribute__ ((packed)) u; ++}__attribute__ ((packed)); ++ ++/* mgmt header + 1 byte category code */ ++#define IEEE80211_MIN_ACTION_SIZE FIELD_OFFSET(struct ieee80211_mgmt, u.action.u) ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/ieee80211.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/ieee80211.h +--- linux-4.14.17/3rdparty/rtl8812au/include/ieee80211.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/ieee80211.h 2018-02-06 17:42:30.718967283 +0200 +@@ -0,0 +1,1463 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -307600,25 +136947,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __IEEE80211_H +#define __IEEE80211_H + -+ -+#ifndef CONFIG_RTL8711FW -+ -+ #if defined PLATFORM_OS_XP -+ #include -+ #endif -+#else -+ -+#endif -+ +#define MGMT_QUEUE_NUM 5 + +#define ETH_ALEN 6 @@ -307707,11 +137039,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + +#define IEEE_CRYPT_ALG_NAME_LEN 16 + -+#define WPA_CIPHER_NONE BIT(0) -+#define WPA_CIPHER_WEP40 BIT(1) ++#define WPA_CIPHER_NONE BIT(0) ++#define WPA_CIPHER_WEP40 BIT(1) +#define WPA_CIPHER_WEP104 BIT(2) -+#define WPA_CIPHER_TKIP BIT(3) -+#define WPA_CIPHER_CCMP BIT(4) ++#define WPA_CIPHER_TKIP BIT(3) ++#define WPA_CIPHER_CCMP BIT(4) + + + @@ -307755,10 +137087,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + RATEID_IDX_B = 8, + RATEID_IDX_VHT_2SS = 9, + RATEID_IDX_VHT_1SS = 10, -+ RATEID_IDX_MIX1 = 11, -+ RATEID_IDX_MIX2 = 12, -+ RATEID_IDX_VHT_3SS = 13, -+ RATEID_IDX_BGN_3SS = 14, +} RATEID_IDX, *PRATEID_IDX; + +typedef enum _RATR_TABLE_MODE{ @@ -307783,8 +137111,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + WIRELESS_11A = BIT(2), // tx: ofdm only, rx: ofdm only, hw: ofdm only + WIRELESS_11_24N = BIT(3), // tx: MCS only, rx: MCS & cck, hw: MCS & cck + WIRELESS_11_5N = BIT(4), // tx: MCS only, rx: MCS & ofdm, hw: ofdm only -+ WIRELESS_AUTO = BIT(5), -+ WIRELESS_11AC = BIT(6), ++ WIRELESS_AUTO = BIT(5), ++ WIRELESS_11AC = BIT(6), + + //Combination + //Type for current wireless mode @@ -307800,31 +137128,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + //Type for registry default wireless mode + WIRELESS_11AGN = (WIRELESS_11A|WIRELESS_11G|WIRELESS_11_24N|WIRELESS_11_5N), // tx: ofdm & MCS, rx: ofdm & MCS, hw: ofdm only + WIRELESS_11ABGN = (WIRELESS_11A|WIRELESS_11B|WIRELESS_11G|WIRELESS_11_24N|WIRELESS_11_5N), -+ WIRELESS_MODE_24G = (WIRELESS_11B|WIRELESS_11G|WIRELESS_11_24N), ++ WIRELESS_MODE_24G = (WIRELESS_11B|WIRELESS_11G|WIRELESS_11_24N|WIRELESS_11AC), + WIRELESS_MODE_5G = (WIRELESS_11A|WIRELESS_11_5N|WIRELESS_11AC), + WIRELESS_MODE_MAX = (WIRELESS_11A|WIRELESS_11B|WIRELESS_11G|WIRELESS_11_24N|WIRELESS_11_5N|WIRELESS_11AC), +}; + -+#define SUPPORTED_24G_NETTYPE_MSK WIRELESS_MODE_24G -+#define SUPPORTED_5G_NETTYPE_MSK WIRELESS_MODE_5G ++#define SUPPORTED_24G_NETTYPE_MSK (WIRELESS_11B | WIRELESS_11G | WIRELESS_11_24N) ++#define SUPPORTED_5G_NETTYPE_MSK (WIRELESS_11A | WIRELESS_11_5N) + -+#define IsLegacyOnly(NetType) ((NetType) == ((NetType) & (WIRELESS_11BG|WIRELESS_11A))) -+ -+#define IsSupported24G(NetType) ((NetType) & SUPPORTED_24G_NETTYPE_MSK ? _TRUE : _FALSE) -+#define IsSupported5G(NetType) ((NetType) & SUPPORTED_5G_NETTYPE_MSK ? _TRUE : _FALSE) ++#define IsSupported24G(NetType) ((NetType) & SUPPORTED_24G_NETTYPE_MSK ? true : false) ++#define IsSupported5G(NetType) ((NetType) & SUPPORTED_5G_NETTYPE_MSK ? true : false) + +#define IsEnableHWCCK(NetType) IsSupported24G(NetType) -+#define IsEnableHWOFDM(NetType) ((NetType) & (WIRELESS_11G|WIRELESS_11_24N|SUPPORTED_5G_NETTYPE_MSK) ? _TRUE : _FALSE) ++#define IsEnableHWOFDM(NetType) ((NetType) & (WIRELESS_11G|WIRELESS_11_24N|SUPPORTED_5G_NETTYPE_MSK) ? true : false) + +#define IsSupportedRxCCK(NetType) IsEnableHWCCK(NetType) +#define IsSupportedRxOFDM(NetType) IsEnableHWOFDM(NetType) +#define IsSupportedRxHT(NetType) IsEnableHWOFDM(NetType) + -+#define IsSupportedTxCCK(NetType) ((NetType) & (WIRELESS_11B) ? _TRUE : _FALSE) -+#define IsSupportedTxOFDM(NetType) ((NetType) & (WIRELESS_11G|WIRELESS_11A) ? _TRUE : _FALSE) -+#define IsSupportedHT(NetType) ((NetType) & (WIRELESS_11_24N|WIRELESS_11_5N) ? _TRUE : _FALSE) ++#define IsSupportedTxCCK(NetType) ((NetType) & (WIRELESS_11B) ? true : false) ++#define IsSupportedTxOFDM(NetType) ((NetType) & (WIRELESS_11G|WIRELESS_11A) ? true : false) ++#define IsSupportedTxHT(NetType) ((NetType) & (WIRELESS_11_24N|WIRELESS_11_5N) ? true : false) + -+#define IsSupportedVHT(NetType) ((NetType) & (WIRELESS_11AC) ? _TRUE : _FALSE) ++#define IsSupportedVHT(NetType) ((NetType) & (WIRELESS_11AC) ? true : false) + + +typedef struct ieee_param { @@ -307842,7 +137168,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + } wpa_ie; + struct{ + int command; -+ int reason_code; ++ int reason_code; + } mlme; + struct { + u8 alg[IEEE_CRYPT_ALG_NAME_LEN]; @@ -307858,7 +137184,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + u16 aid; + u16 capability; + int flags; -+ u8 tx_supp_rates[16]; ++ u8 tx_supp_rates[16]; + struct rtw_ieee80211_ht_cap ht_cap; + } add_sta; + struct { @@ -307867,7 +137193,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + } bcn_ie; +#endif + -+ } u; ++ } u; +}ieee_param; + +#ifdef CONFIG_AP_MODE @@ -307882,7 +137208,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + u16 capability; + int flags; + u32 sta_set; -+ u8 tx_supp_rates[16]; ++ u8 tx_supp_rates[16]; + u32 tx_supp_rates_len; + struct rtw_ieee80211_ht_cap ht_cap; + u64 rx_pkts; @@ -307929,107 +137255,55 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + _list list; +}; + -+#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW)||defined(PLATFORM_FREEBSD) -+ +struct rtw_ieee80211_hdr { -+ u16 frame_ctl; -+ u16 duration_id; ++ __le16 frame_ctl; ++ __le16 duration_id; + u8 addr1[ETH_ALEN]; + u8 addr2[ETH_ALEN]; + u8 addr3[ETH_ALEN]; -+ u16 seq_ctl; ++ __le16 seq_ctl; + u8 addr4[ETH_ALEN]; +} __attribute__ ((packed)); + +struct rtw_ieee80211_hdr_3addr { -+ u16 frame_ctl; -+ u16 duration_id; ++ __le16 frame_ctl; ++ __le16 duration_id; + u8 addr1[ETH_ALEN]; + u8 addr2[ETH_ALEN]; + u8 addr3[ETH_ALEN]; -+ u16 seq_ctl; ++ __le16 seq_ctl; +} __attribute__ ((packed)); + + +struct rtw_ieee80211_hdr_qos { -+ u16 frame_ctl; -+ u16 duration_id; ++ __le16 frame_ctl; ++ __le16 duration_id; + u8 addr1[ETH_ALEN]; + u8 addr2[ETH_ALEN]; + u8 addr3[ETH_ALEN]; -+ u16 seq_ctl; ++ __le16 seq_ctl; + u8 addr4[ETH_ALEN]; -+ u16 qc; ++ __le16 qc; +} __attribute__ ((packed)); + +struct rtw_ieee80211_hdr_3addr_qos { -+ u16 frame_ctl; -+ u16 duration_id; ++ __le16 frame_ctl; ++ __le16 duration_id; + u8 addr1[ETH_ALEN]; + u8 addr2[ETH_ALEN]; + u8 addr3[ETH_ALEN]; -+ u16 seq_ctl; -+ u16 qc; ++ __le16 seq_ctl; ++ __le16 qc; +} __attribute__ ((packed)); + +struct eapol { + u8 snap[6]; -+ u16 ethertype; ++ __le16 ethertype; + u8 version; + u8 type; -+ u16 length; ++ __le16 length; +} __attribute__ ((packed)); + -+#endif -+ -+ -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+struct rtw_ieee80211_hdr { -+ u16 frame_ctl; -+ u16 duration_id; -+ u8 addr1[ETH_ALEN]; -+ u8 addr2[ETH_ALEN]; -+ u8 addr3[ETH_ALEN]; -+ u16 seq_ctl; -+ u8 addr4[ETH_ALEN]; -+}; -+ -+struct rtw_ieee80211_hdr_3addr { -+ u16 frame_ctl; -+ u16 duration_id; -+ u8 addr1[ETH_ALEN]; -+ u8 addr2[ETH_ALEN]; -+ u8 addr3[ETH_ALEN]; -+ u16 seq_ctl; -+}; -+ -+ -+struct rtw_ieee80211_hdr_qos { -+ struct rtw_ieee80211_hdr wlan_hdr; -+ u16 qc; -+}; -+ -+struct rtw_ieee80211_hdr_3addr_qos { -+ struct rtw_ieee80211_hdr_3addr wlan_hdr; -+ u16 qc; -+}; -+ -+struct eapol { -+ u8 snap[6]; -+ u16 ethertype; -+ u8 version; -+ u8 type; -+ u16 length; -+}; -+#pragma pack() -+ -+#endif -+ -+ -+ +enum eap_type { + EAP_PACKET = 0, + EAPOL_START, @@ -308066,7 +137340,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + +/* management */ +#define RTW_IEEE80211_STYPE_ASSOC_REQ 0x0000 -+#define RTW_IEEE80211_STYPE_ASSOC_RESP 0x0010 ++#define RTW_IEEE80211_STYPE_ASSOC_RESP 0x0010 +#define RTW_IEEE80211_STYPE_REASSOC_REQ 0x0020 +#define RTW_IEEE80211_STYPE_REASSOC_RESP 0x0030 +#define RTW_IEEE80211_STYPE_PROBE_REQ 0x0040 @@ -308138,8 +137412,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + +#define P80211_OUI_LEN 3 + -+#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) || defined(PLATFORM_FREEBSD) -+ +struct ieee80211_snap_hdr { + + u8 dsap; /* always 0xAA */ @@ -308149,24 +137421,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + +} __attribute__ ((packed)); + -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+struct ieee80211_snap_hdr { -+ -+ u8 dsap; /* always 0xAA */ -+ u8 ssap; /* always 0xAA */ -+ u8 ctrl; /* always 0x03 */ -+ u8 oui[P80211_OUI_LEN]; /* organizational universal id */ -+ -+}; -+#pragma pack() -+ -+#endif -+ -+ +#define SNAP_SIZE sizeof(struct ieee80211_snap_hdr) + +#define WLAN_FC_GET_TYPE(fc) ((fc) & RTW_IEEE80211_FCTL_FTYPE) @@ -308220,7 +137474,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 +#define WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA 7 +#define WLAN_REASON_DISASSOC_STA_HAS_LEFT 8 +#define WLAN_REASON_STA_REQ_ASSOC_WITHOUT_AUTH 9 -+#define WLAN_REASON_ACTIVE_ROAM 65533 +#define WLAN_REASON_JOIN_WRONG_CHANNEL 65534 +#define WLAN_REASON_EXPIRATION_CHK 65535 + @@ -308263,7 +137516,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 +#define WLAN_EID_GENERIC (WLAN_EID_VENDOR_SPECIFIC) +#define WLAN_EID_VHT_CAPABILITY 191 +#define WLAN_EID_VHT_OPERATION 192 -+#define WLAN_EID_VHT_OP_MODE_NOTIFY 199 ++#define WLAN_EID_VHT_OP_MODE_NOTIFY 193 + +#define IEEE80211_MGMT_HDR_LEN 24 +#define IEEE80211_DATA_HDR3_LEN 24 @@ -308283,7 +137536,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 +#define IEEE80211_24GHZ_BAND (1<<0) +#define IEEE80211_52GHZ_BAND (1<<1) + -+#define IEEE80211_CCK_RATE_LEN 4 ++#define IEEE80211_CCK_RATE_LEN 4 +#define IEEE80211_NUM_OFDM_RATESLEN 8 + + @@ -308291,7 +137544,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 +#define IEEE80211_CCK_RATE_2MB 0x04 +#define IEEE80211_CCK_RATE_5MB 0x0B +#define IEEE80211_CCK_RATE_11MB 0x16 -+#define IEEE80211_OFDM_RATE_LEN 8 ++#define IEEE80211_OFDM_RATE_LEN 8 +#define IEEE80211_OFDM_RATE_6MB 0x0C +#define IEEE80211_OFDM_RATE_9MB 0x12 +#define IEEE80211_OFDM_RATE_12MB 0x18 @@ -308340,170 +137593,80 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 +#define IEEE80211_OFDM_SHIFT_MASK_A 4 + + -+enum MGN_RATE{ -+ MGN_1M = 0x02, -+ MGN_2M = 0x04, -+ MGN_5_5M = 0x0B, -+ MGN_6M = 0x0C, -+ MGN_9M = 0x12, -+ MGN_11M = 0x16, -+ MGN_12M = 0x18, -+ MGN_18M = 0x24, -+ MGN_24M = 0x30, -+ MGN_36M = 0x48, -+ MGN_48M = 0x60, -+ MGN_54M = 0x6C, -+ MGN_MCS32 = 0x7F, -+ MGN_MCS0, -+ MGN_MCS1, -+ MGN_MCS2, -+ MGN_MCS3, -+ MGN_MCS4, -+ MGN_MCS5, -+ MGN_MCS6, -+ MGN_MCS7, -+ MGN_MCS8, -+ MGN_MCS9, -+ MGN_MCS10, -+ MGN_MCS11, -+ MGN_MCS12, -+ MGN_MCS13, -+ MGN_MCS14, -+ MGN_MCS15, -+ MGN_MCS16, -+ MGN_MCS17, -+ MGN_MCS18, -+ MGN_MCS19, -+ MGN_MCS20, -+ MGN_MCS21, -+ MGN_MCS22, -+ MGN_MCS23, -+ MGN_MCS24, -+ MGN_MCS25, -+ MGN_MCS26, -+ MGN_MCS27, -+ MGN_MCS28, -+ MGN_MCS29, -+ MGN_MCS30, -+ MGN_MCS31, -+ MGN_VHT1SS_MCS0, -+ MGN_VHT1SS_MCS1, -+ MGN_VHT1SS_MCS2, -+ MGN_VHT1SS_MCS3, -+ MGN_VHT1SS_MCS4, -+ MGN_VHT1SS_MCS5, -+ MGN_VHT1SS_MCS6, -+ MGN_VHT1SS_MCS7, -+ MGN_VHT1SS_MCS8, -+ MGN_VHT1SS_MCS9, -+ MGN_VHT2SS_MCS0, -+ MGN_VHT2SS_MCS1, -+ MGN_VHT2SS_MCS2, -+ MGN_VHT2SS_MCS3, -+ MGN_VHT2SS_MCS4, -+ MGN_VHT2SS_MCS5, -+ MGN_VHT2SS_MCS6, -+ MGN_VHT2SS_MCS7, -+ MGN_VHT2SS_MCS8, -+ MGN_VHT2SS_MCS9, -+ MGN_VHT3SS_MCS0, -+ MGN_VHT3SS_MCS1, -+ MGN_VHT3SS_MCS2, -+ MGN_VHT3SS_MCS3, -+ MGN_VHT3SS_MCS4, -+ MGN_VHT3SS_MCS5, -+ MGN_VHT3SS_MCS6, -+ MGN_VHT3SS_MCS7, -+ MGN_VHT3SS_MCS8, -+ MGN_VHT3SS_MCS9, -+ MGN_VHT4SS_MCS0, -+ MGN_VHT4SS_MCS1, -+ MGN_VHT4SS_MCS2, -+ MGN_VHT4SS_MCS3, -+ MGN_VHT4SS_MCS4, -+ MGN_VHT4SS_MCS5, -+ MGN_VHT4SS_MCS6, -+ MGN_VHT4SS_MCS7, -+ MGN_VHT4SS_MCS8, -+ MGN_VHT4SS_MCS9, -+ MGN_UNKNOWN -+}; ++/* BIT 7 HT Rate*/ ++// TxHT = 0 ++#define MGN_1M 0x02 ++#define MGN_2M 0x04 ++#define MGN_5_5M 0x0b ++#define MGN_11M 0x16 + -+#define IS_HT_RATE(_rate) ((_rate) >= MGN_MCS0 && (_rate) <= MGN_MCS31) -+#define IS_VHT_RATE(_rate) ((_rate) >= MGN_VHT1SS_MCS0 && (_rate) <= MGN_VHT4SS_MCS9) -+#define IS_CCK_RATE(_rate) ((_rate) == MGN_1M || (_rate) == MGN_2M || (_rate) == MGN_5_5M || (_rate) == MGN_11M) -+#define IS_OFDM_RATE(_rate) ((_rate) >= MGN_6M && (_rate) <= MGN_54M && (_rate) != MGN_11M) ++#define MGN_6M 0x0c ++#define MGN_9M 0x12 ++#define MGN_12M 0x18 ++#define MGN_18M 0x24 ++#define MGN_24M 0x30 ++#define MGN_36M 0x48 ++#define MGN_48M 0x60 ++#define MGN_54M 0x6c + -+#define IS_HT1SS_RATE(_rate) ((_rate) >= MGN_MCS0 && (_rate) <= MGN_MCS7) -+#define IS_HT2SS_RATE(_rate) ((_rate) >= MGN_MCS8 && (_rate) <= MGN_MCS15) -+#define IS_HT3SS_RATE(_rate) ((_rate) >= MGN_MCS16 && (_rate) <= MGN_MCS23) -+#define IS_HT4SS_RATE(_rate) ((_rate) >= MGN_MCS24 && (_rate) <= MGN_MCS31) ++// TxHT = 1 ++#define MGN_MCS0 0x80 ++#define MGN_MCS1 0x81 ++#define MGN_MCS2 0x82 ++#define MGN_MCS3 0x83 ++#define MGN_MCS4 0x84 ++#define MGN_MCS5 0x85 ++#define MGN_MCS6 0x86 ++#define MGN_MCS7 0x87 ++#define MGN_MCS8 0x88 ++#define MGN_MCS9 0x89 ++#define MGN_MCS10 0x8a ++#define MGN_MCS11 0x8b ++#define MGN_MCS12 0x8c ++#define MGN_MCS13 0x8d ++#define MGN_MCS14 0x8e ++#define MGN_MCS15 0x8f ++#define MGN_VHT1SS_MCS0 0x90 ++#define MGN_VHT1SS_MCS1 0x91 ++#define MGN_VHT1SS_MCS2 0x92 ++#define MGN_VHT1SS_MCS3 0x93 ++#define MGN_VHT1SS_MCS4 0x94 ++#define MGN_VHT1SS_MCS5 0x95 ++#define MGN_VHT1SS_MCS6 0x96 ++#define MGN_VHT1SS_MCS7 0x97 ++#define MGN_VHT1SS_MCS8 0x98 ++#define MGN_VHT1SS_MCS9 0x99 ++#define MGN_VHT2SS_MCS0 0x9a ++#define MGN_VHT2SS_MCS1 0x9b ++#define MGN_VHT2SS_MCS2 0x9c ++#define MGN_VHT2SS_MCS3 0x9d ++#define MGN_VHT2SS_MCS4 0x9e ++#define MGN_VHT2SS_MCS5 0x9f ++#define MGN_VHT2SS_MCS6 0xa0 ++#define MGN_VHT2SS_MCS7 0xa1 ++#define MGN_VHT2SS_MCS8 0xa2 ++#define MGN_VHT2SS_MCS9 0xa3 + -+#define IS_VHT1SS_RATE(_rate) ((_rate) >= MGN_VHT1SS_MCS0 && (_rate) <= MGN_VHT1SS_MCS9) -+#define IS_VHT2SS_RATE(_rate) ((_rate) >= MGN_VHT2SS_MCS0 && (_rate) <= MGN_VHT2SS_MCS9) -+#define IS_VHT3SS_RATE(_rate) ((_rate) >= MGN_VHT3SS_MCS0 && (_rate) <= MGN_VHT3SS_MCS9) -+#define IS_VHT4SS_RATE(_rate) ((_rate) >= MGN_VHT4SS_MCS0 && (_rate) <= MGN_VHT4SS_MCS9) ++#define MGN_MCS0_SG 0xc0 ++#define MGN_MCS1_SG 0xc1 ++#define MGN_MCS2_SG 0xc2 ++#define MGN_MCS3_SG 0xc3 ++#define MGN_MCS4_SG 0xc4 ++#define MGN_MCS5_SG 0xc5 ++#define MGN_MCS6_SG 0xc6 ++#define MGN_MCS7_SG 0xc7 ++#define MGN_MCS8_SG 0xc8 ++#define MGN_MCS9_SG 0xc9 ++#define MGN_MCS10_SG 0xca ++#define MGN_MCS11_SG 0xcb ++#define MGN_MCS12_SG 0xcc ++#define MGN_MCS13_SG 0xcd ++#define MGN_MCS14_SG 0xce ++#define MGN_MCS15_SG 0xcf + -+#define IS_1T_RATE(_rate) (IS_CCK_RATE((_rate)) || IS_OFDM_RATE((_rate)) || IS_HT1SS_RATE((_rate)) || IS_VHT1SS_RATE((_rate))) -+#define IS_2T_RATE(_rate) (IS_HT2SS_RATE((_rate)) || IS_VHT2SS_RATE((_rate))) -+#define IS_3T_RATE(_rate) (IS_HT3SS_RATE((_rate)) || IS_VHT3SS_RATE((_rate))) -+#define IS_4T_RATE(_rate) (IS_HT4SS_RATE((_rate)) || IS_VHT4SS_RATE((_rate))) ++#define IS_HT_RATE(rate) (((rate) & 0x80) ? true : false) ++#define IS_CCK_RATE(_rate) (_rate == MGN_1M || _rate == MGN_2M || _rate == MGN_5_5M || _rate == MGN_11M) + -+typedef enum _RATE_SECTION { -+ CCK = 0, -+ OFDM = 1, -+ HT_MCS0_MCS7 = 2, -+ HT_MCS8_MCS15 = 3, -+ HT_MCS16_MCS23 = 4, -+ HT_MCS24_MCS31 = 5, -+ HT_1SS = HT_MCS0_MCS7, -+ HT_2SS = HT_MCS8_MCS15, -+ HT_3SS = HT_MCS16_MCS23, -+ HT_4SS = HT_MCS24_MCS31, -+ VHT_1SSMCS0_1SSMCS9 = 6, -+ VHT_2SSMCS0_2SSMCS9 = 7, -+ VHT_3SSMCS0_3SSMCS9 = 8, -+ VHT_4SSMCS0_4SSMCS9 = 9, -+ VHT_1SS = VHT_1SSMCS0_1SSMCS9, -+ VHT_2SS = VHT_2SSMCS0_2SSMCS9, -+ VHT_3SS = VHT_3SSMCS0_3SSMCS9, -+ VHT_4SS = VHT_4SSMCS0_4SSMCS9, -+ RATE_SECTION_NUM, -+} RATE_SECTION; -+ -+const char *rate_section_str(u8 section); -+ -+#define IS_CCK_RATE_SECTION(section) ((section) == CCK) -+#define IS_OFDM_RATE_SECTION(section) ((section) == OFDM) -+#define IS_HT_RATE_SECTION(section) ((section) >= HT_1SS && (section) <= HT_4SS) -+#define IS_VHT_RATE_SECTION(section) ((section) >= VHT_1SS && (section) <= VHT_4SS) -+ -+#define IS_1T_RATE_SECTION(section) ((section) == CCK || (section) == OFDM || (section) == HT_1SS || (section) == VHT_1SS) -+#define IS_2T_RATE_SECTION(section) ((section) == HT_2SS || (section) == VHT_2SS) -+#define IS_3T_RATE_SECTION(section) ((section) == HT_3SS || (section) == VHT_3SS) -+#define IS_4T_RATE_SECTION(section) ((section) == HT_4SS || (section) == VHT_4SS) -+ -+extern u8 mgn_rates_cck[]; -+extern u8 mgn_rates_ofdm[]; -+extern u8 mgn_rates_mcs0_7[]; -+extern u8 mgn_rates_mcs8_15[]; -+extern u8 mgn_rates_mcs16_23[]; -+extern u8 mgn_rates_mcs24_31[]; -+extern u8 mgn_rates_vht1ss[]; -+extern u8 mgn_rates_vht2ss[]; -+extern u8 mgn_rates_vht3ss[]; -+extern u8 mgn_rates_vht4ss[]; -+ -+struct rate_section_ent { -+ u8 tx_num; /* value of RF_TX_NUM */ -+ u8 rate_num; -+ u8 *rates; -+}; -+ -+extern struct rate_section_ent rates_by_sections[]; -+ -+#define rate_section_to_tx_num(section) (rates_by_sections[(section)].tx_num) -+#define rate_section_rate_num(section) (rates_by_sections[(section)].rate_num) + +/* NOTE: This data is for statistical purposes; not all hardware provides this + * information for frames received. Not setting these will not cause @@ -308538,7 +137701,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + u8 dst_addr[ETH_ALEN]; +}; + -+#ifndef PLATFORM_FREEBSD //Baron BSD has already defined +struct ieee80211_stats { + uint tx_unicast_frames; + uint tx_multicast_frames; @@ -308562,7 +137724,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + uint rx_message_in_msg_fragments; + uint rx_message_in_bad_msg_fragments; +}; -+#endif //PLATFORM_FREEBSD ++ +struct ieee80211_softmac_stats{ + uint rx_ass_ok; + uint rx_ass_err; @@ -308602,13 +137764,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 +#define WEP_KEYS 4 +#define WEP_KEY_LEN 13 + -+#ifdef CONFIG_IEEE80211W -+#define BIP_MAX_KEYID 5 -+#define BIP_AAD_SIZE 20 -+#endif //CONFIG_IEEE80211W -+ -+#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) -+ +struct ieee80211_security { + u16 active_key:2, + enabled:1, @@ -308618,29 +137773,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + u8 key_sizes[WEP_KEYS]; + u8 keys[WEP_KEYS][WEP_KEY_LEN]; + u8 level; -+ u16 flags; ++ __le16 flags; +} __attribute__ ((packed)); + -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+struct ieee80211_security { -+ u16 active_key:2, -+ enabled:1, -+ auth_mode:2, -+ auth_algo:4, -+ unicast_uses_group:1; -+ u8 key_sizes[WEP_KEYS]; -+ u8 keys[WEP_KEYS][WEP_KEY_LEN]; -+ u8 level; -+ u16 flags; -+} ; -+#pragma pack() -+ -+#endif -+ +/* + + 802.11 data frame from AP @@ -308681,8 +137816,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 +#define MFIE_TYPE_RATES_EX 50 +#define MFIE_TYPE_GENERIC 221 + -+#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) -+ +struct ieee80211_info_element_hdr { + u8 id; + u8 len; @@ -308693,25 +137826,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + u8 len; + u8 data[0]; +} __attribute__ ((packed)); -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+struct ieee80211_info_element_hdr { -+ u8 id; -+ u8 len; -+} ; -+ -+struct ieee80211_info_element { -+ u8 id; -+ u8 len; -+ u8 data[0]; -+} ; -+#pragma pack() -+ -+#endif -+ + +/* + * These are the data types that can make up management packets @@ -308733,110 +137847,49 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 +#define IEEE80211_DEFAULT_TX_ESSID "Penguin" +#define IEEE80211_DEFAULT_BASIC_RATE 10 + -+ -+#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) -+ -+ +struct ieee80211_authentication { + struct ieee80211_header_data header; -+ u16 algorithm; -+ u16 transaction; -+ u16 status; ++ __le16 algorithm; ++ __le16 transaction; ++ __le16 status; + //struct ieee80211_info_element_hdr info_element; +} __attribute__ ((packed)); + -+ +struct ieee80211_probe_response { + struct ieee80211_header_data header; -+ u32 time_stamp[2]; -+ u16 beacon_interval; -+ u16 capability; ++ __le32 time_stamp[2]; ++ __le16 beacon_interval; ++ __le16 capability; + struct ieee80211_info_element info_element; +} __attribute__ ((packed)); + +struct ieee80211_probe_request { + struct ieee80211_header_data header; -+ /*struct ieee80211_info_element info_element;*/ +} __attribute__ ((packed)); + +struct ieee80211_assoc_request_frame { + struct rtw_ieee80211_hdr_3addr header; -+ u16 capability; -+ u16 listen_interval; -+ //u8 current_ap[ETH_ALEN]; ++ __le16 capability; ++ __le16 listen_interval; + struct ieee80211_info_element_hdr info_element; +} __attribute__ ((packed)); + +struct ieee80211_assoc_response_frame { + struct rtw_ieee80211_hdr_3addr header; -+ u16 capability; -+ u16 status; -+ u16 aid; -+// struct ieee80211_info_element info_element; /* supported rates */ ++ __le16 capability; ++ __le16 status; ++ __le16 aid; +} __attribute__ ((packed)); -+#endif -+ -+ -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+ -+struct ieee80211_authentication { -+ struct ieee80211_header_data header; -+ u16 algorithm; -+ u16 transaction; -+ u16 status; -+ //struct ieee80211_info_element_hdr info_element; -+} ; -+ -+ -+struct ieee80211_probe_response { -+ struct ieee80211_header_data header; -+ u32 time_stamp[2]; -+ u16 beacon_interval; -+ u16 capability; -+ struct ieee80211_info_element info_element; -+} ; -+ -+struct ieee80211_probe_request { -+ struct ieee80211_header_data header; -+ /*struct ieee80211_info_element info_element;*/ -+} ; -+ -+struct ieee80211_assoc_request_frame { -+ struct rtw_ieee80211_hdr_3addr header; -+ u16 capability; -+ u16 listen_interval; -+ //u8 current_ap[ETH_ALEN]; -+ struct ieee80211_info_element_hdr info_element; -+} ; -+ -+struct ieee80211_assoc_response_frame { -+ struct rtw_ieee80211_hdr_3addr header; -+ u16 capability; -+ u16 status; -+ u16 aid; -+// struct ieee80211_info_element info_element; /* supported rates */ -+}; -+ -+#pragma pack() -+ -+#endif -+ -+ -+ + +struct ieee80211_txb { + u8 nr_frags; + u8 encrypted; -+ u16 reserved; -+ u16 frag_size; -+ u16 payload_size; ++ __le16 reserved; ++ __le16 frag_size; ++ __le16 payload_size; + struct sk_buff *fragments[0]; +}; + -+ +/* SWEEP TABLE ENTRIES NUMBER*/ +#define MAX_SWEEP_TAB_ENTRIES 42 +#define MAX_SWEEP_TAB_ENTRIES_PER_PACKET 7 @@ -308891,9 +137944,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + u8 rates_len; + u8 rates_ex[MAX_RATES_EX_LENGTH]; + u8 rates_ex_len; -+ ++ + u8 edca_parmsets[18]; -+ ++ + u8 mode; + u8 flags; + u8 time_stamp[8]; @@ -308912,7 +137965,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + u8 qbssload[5]; + u8 network_type; + int join_res; -+ unsigned long last_scanned; ++ unsigned long last_scanned; +}; +#endif +/* @@ -308922,13 +137975,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 +> 0: TID +*/ + -+#ifndef PLATFORM_FREEBSD //Baron BSD has already defined -+ +enum ieee80211_state { -+ + /* the card is not linked at all */ + IEEE80211_NOLINK = 0, -+ ++ + /* IEEE80211_ASSOCIATING* are for BSS client mode + * the driver shall not perform RX filtering unless + * the state is LINKED. @@ -308936,47 +137986,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + * defaults to NOLINK for ALL the other states (including + * LINKED_SCANNING) + */ -+ ++ + /* the association procedure will start (wq scheduling)*/ + IEEE80211_ASSOCIATING, + IEEE80211_ASSOCIATING_RETRY, -+ ++ + /* the association procedure is sending AUTH request*/ + IEEE80211_ASSOCIATING_AUTHENTICATING, -+ ++ + /* the association procedure has successfully authentcated + * and is sending association request + */ + IEEE80211_ASSOCIATING_AUTHENTICATED, -+ ++ + /* the link is ok. the card associated to a BSS or linked + * to a ibss cell or acting as an AP and creating the bss + */ + IEEE80211_LINKED, -+ ++ + /* same as LINKED, but the driver shall apply RX filter + * rules as we are in NO_LINK mode. As the card is still + * logically linked, but it is doing a syncro site survey + * then it will be back to LINKED state. + */ + IEEE80211_LINKED_SCANNING, -+ ++ +}; -+#endif //PLATFORM_FREEBSD + +#define DEFAULT_MAX_SCAN_AGE (15 * HZ) +#define DEFAULT_FTS 2346 +#define MAC_FMT "%02x:%02x:%02x:%02x:%02x:%02x" +#define MAC_ARG(x) ((u8*)(x))[0],((u8*)(x))[1],((u8*)(x))[2],((u8*)(x))[3],((u8*)(x))[4],((u8*)(x))[5] -+#define IP_FMT "%d.%d.%d.%d" -+#define IP_ARG(x) ((u8*)(x))[0],((u8*)(x))[1],((u8*)(x))[2],((u8*)(x))[3] + -+#ifdef PLATFORM_FREEBSD //Baron change func to macro -+#define is_multicast_mac_addr(Addr) ((((Addr[0]) & 0x01) == 0x01) && ((Addr[0]) != 0xff)) -+#define is_broadcast_mac_addr(Addr) ((((Addr[0]) & 0xff) == 0xff) && (((Addr[1]) & 0xff) == 0xff) && \ -+(((Addr[2]) & 0xff) == 0xff) && (((Addr[3]) & 0xff) == 0xff) && (((Addr[4]) & 0xff) == 0xff) && \ -+(((Addr[5]) & 0xff) == 0xff)) -+#else +extern __inline int is_multicast_mac_addr(const u8 *addr) +{ + return ((addr[0] != 0xff) && (0x01 & addr[0])); @@ -308988,13 +138029,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + (addr[3] == 0xff) && (addr[4] == 0xff) && (addr[5] == 0xff)); +} + -+extern __inline int is_zero_mac_addr(const u8 *addr) -+{ -+ return ((addr[0] == 0x00) && (addr[1] == 0x00) && (addr[2] == 0x00) && \ -+ (addr[3] == 0x00) && (addr[4] == 0x00) && (addr[5] == 0x00)); -+} -+#endif //PLATFORM_FREEBSD -+ +#define CFG_IEEE80211_RESERVE_FCS (1<<0) +#define CFG_IEEE80211_COMPUTE_FCS (1<<1) + @@ -309005,7 +138039,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + + + -+#define TID_NUM 16 ++#define MAXTID 16 + +#define IEEE_A (1<<0) +#define IEEE_B (1<<1) @@ -309040,11 +138074,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + RTW_WLAN_CATEGORY_FT = 6, + RTW_WLAN_CATEGORY_HT = 7, + RTW_WLAN_CATEGORY_SA_QUERY = 8, -+ RTW_WLAN_CATEGORY_UNPROTECTED_WNM = 11, // add for CONFIG_IEEE80211W, none 11w also can use + RTW_WLAN_CATEGORY_TDLS = 12, -+ RTW_WLAN_CATEGORY_SELF_PROTECTED = 15, // add for CONFIG_IEEE80211W, none 11w also can use + RTW_WLAN_CATEGORY_WMM = 17, -+ RTW_WLAN_CATEGORY_VHT = 21, + RTW_WLAN_CATEGORY_P2P = 0x7f,//P2P action frames +}; + @@ -309107,14 +138138,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + +/* HT features action code */ +enum rtw_ieee80211_ht_actioncode { -+ RTW_WLAN_ACTION_HT_NOTI_CHNL_WIDTH = 0, -+ RTW_WLAN_ACTION_HT_SM_PS = 1, -+ RTW_WLAN_ACTION_HT_PSMP = 2, -+ RTW_WLAN_ACTION_HT_SET_PCO_PHASE = 3, -+ RTW_WLAN_ACTION_HT_CSI = 4, -+ RTW_WLAN_ACTION_HT_NON_COMPRESS_BEAMFORMING = 5, -+ RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING = 6, -+ RTW_WLAN_ACTION_HT_ASEL_FEEDBACK = 7, ++ RTW_WLAN_ACTION_NOTIFY_CH_WIDTH = 0, ++ RTW_WLAN_ACTION_SM_PS = 1, ++ RTW_WLAN_ACTION_PSPM = 2, ++ RTW_WLAN_ACTION_PCO_PHASE = 3, ++ RTW_WLAN_ACTION_MIMO_CSI_MX = 4, ++ RTW_WLAN_ACTION_MIMO_NONCP_BF = 5, ++ RTW_WLAN_ACTION_MIMP_CP_BF = 6, ++ RTW_WLAN_ACTION_ASEL_INDICATES_FB = 7, ++ RTW_WLAN_ACTION_HI_INFO_EXCHG = 8, +}; + +/* BACK (block-ack) parties */ @@ -309124,26 +138156,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + RTW_WLAN_BACK_TIMER = 2, +}; + -+/*20/40 BSS Coexistence element */ -+#define RTW_WLAN_20_40_BSS_COEX_INFO_REQ BIT(0) -+#define RTW_WLAN_20_40_BSS_COEX_40MHZ_INTOL BIT(1) -+#define RTW_WLAN_20_40_BSS_COEX_20MHZ_WIDTH_REQ BIT(2) -+#define RTW_WLAN_20_40_BSS_COEX_OBSS_EXEMPT_REQ BIT(3) -+#define RTW_WLAN_20_40_BSS_COEX_OBSS_EXEMPT_GRNT BIT(4) -+ -+/* VHT features action code */ -+enum rtw_ieee80211_vht_actioncode{ -+ RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING = 0, -+ RTW_WLAN_ACTION_VHT_GROUPID_MANAGEMENT = 1, -+ RTW_WLAN_ACTION_VHT_OPMODE_NOTIFICATION = 2, -+}; -+ + +#define OUI_MICROSOFT 0x0050f2 /* Microsoft (also used in Wi-Fi specs) + * 00:50:F2 */ -+#ifndef PLATFORM_FREEBSD //Baron BSD has defined +#define WME_OUI_TYPE 2 -+#endif //PLATFORM_FREEBSD +#define WME_OUI_SUBTYPE_INFORMATION_ELEMENT 0 +#define WME_OUI_SUBTYPE_PARAMETER_ELEMENT 1 +#define WME_OUI_SUBTYPE_TSPEC_ELEMENT 2 @@ -309189,7 +138205,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + RTW_IEEE80211_CHAN_NO_HT40PLUS = 1<<4, + RTW_IEEE80211_CHAN_NO_HT40MINUS = 1<<5, + }; -+ ++ + #define RTW_IEEE80211_CHAN_NO_HT40 \ + (RTW_IEEE80211_CHAN_NO_HT40PLUS | RTW_IEEE80211_CHAN_NO_HT40MINUS) + @@ -309206,7 +138222,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + //u32 orig_flags; + //int orig_mag; + //int orig_mpwr; -+}; ++}; + +#define CHAN_FMT \ + /*"band:%d, "*/ \ @@ -309219,7 +138235,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + /*"beacon_found:%u\n"*/ \ + /*"orig_flags:0x%08x\n"*/ \ + /*"orig_mag:%d\n"*/ \ -+ /*"orig_mpwr:%d\n"*/ ++ /*"orig_mpwr:%d\n"*/ + +#define CHAN_ARG(channel) \ + /*(channel)->band*/ \ @@ -309327,7 +138343,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 +int rtw_get_sec_ie(u8 *in_ie,uint in_len,u8 *rsn_ie,u16 *rsn_len,u8 *wpa_ie,u16 *wpa_len); + +u8 rtw_is_wps_ie(u8 *ie_ptr, uint *wps_ielen); -+u8 *rtw_get_wps_ie_from_scan_queue(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen, u8 frame_type); +u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen); +u8 *rtw_get_wps_attr(u8 *wps_ie, uint wps_ielen, u16 target_attr_id ,u8 *buf_attr, u32 *len_attr); +u8 *rtw_get_wps_attr_content(u8 *wps_ie, uint wps_ielen, u16 target_attr_id ,u8 *buf_content, uint *len_content); @@ -309341,29 +138356,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 +#define for_each_ie(ie, buf, buf_len) \ + for (ie = (void*)buf; (((u8*)ie) - ((u8*)buf) + 1) < buf_len; ie = (void*)(((u8*)ie) + *(((u8*)ie)+1) + 2)) + -+void dump_ies(void *sel, u8 *buf, u32 buf_len); -+ -+#ifdef CONFIG_80211N_HT -+void dump_ht_cap_ie_content(void *sel, u8 *buf, u32 buf_len); -+#endif -+ -+void dump_wps_ie(void *sel, u8 *ie, u32 ie_len); -+ -+void rtw_ies_get_chbw(u8 *ies, int ies_len, u8 *ch, u8 *bw, u8 *offset); -+ -+void rtw_bss_get_chbw(WLAN_BSSID_EX *bss, u8 *ch, u8 *bw, u8 *offset); -+ -+bool rtw_is_chbw_grouped(u8 ch_a, u8 bw_a, u8 offset_a -+ , u8 ch_b, u8 bw_b, u8 offset_b); -+void rtw_sync_chbw(u8 *req_ch, u8 *req_bw, u8 *req_offset -+ , u8 *g_ch, u8 *g_bw, u8 *g_offset); ++void dump_ies(u8 *buf, u32 buf_len); ++void dump_wps_ie(u8 *ie, u32 ie_len); + +#ifdef CONFIG_P2P -+u32 rtw_get_p2p_merged_ies_len(u8 *in_ie, u32 in_len); -+int rtw_p2p_merge_ies(u8 *in_ie, u32 in_len, u8 *merge_ie); -+void dump_p2p_ie(void *sel, u8 *ie, u32 ie_len); ++void dump_p2p_ie(u8 *ie, u32 ie_len); +u8 *rtw_get_p2p_ie(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen); -+u8 *rtw_get_p2p_ie_from_scan_queue(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen, u8 frame_type); +u8 *rtw_get_p2p_attr(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id ,u8 *buf_attr, u32 *len_attr); +u8 *rtw_get_p2p_attr_content(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id ,u8 *buf_content, uint *len_content); +u32 rtw_set_p2p_attr_content(u8 *pbuf, u8 attr_id, u16 attr_len, u8 *pdata_attr); @@ -309371,9 +138369,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 +#endif + +#ifdef CONFIG_WFD -+void dump_wfd_ie(void *sel, u8 *ie, u32 ie_len); +int rtw_get_wfd_ie(u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen); -+int rtw_get_wfd_ie_from_scan_queue(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen, u8 frame_type); +int rtw_get_wfd_attr_content(u8 *wfd_ie, uint wfd_ielen, u8 target_attr_id ,u8 *attr_content, uint *attr_contentlen); +#endif // CONFIG_WFD + @@ -309381,7 +138377,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + +struct registry_priv; +int rtw_generate_ie(struct registry_priv *pregistrypriv); -+bool rtw_regsty_adjust_chbw(struct registry_priv *regsty, u8 req_ch, u8 *req_bw, u8 *req_offset); ++ + +int rtw_get_bit_value_from_ieee_value(u8 val); + @@ -309393,31 +138389,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ieee80211.h linux/3rdparty/rtl88 + +void rtw_get_bcn_info(struct wlan_network *pnetwork); + -+u8 rtw_check_invalid_mac_address(u8 *mac_addr, u8 check_local_bit); -+void rtw_macaddr_cfg(u8 *out, const u8 *hw_mac_addr); ++void rtw_macaddr_cfg(u8 *mac_addr); + -+u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI, unsigned char * MCS_rate); -+u8 rtw_ht_mcsset_to_nss(u8 *supp_mcs_set); ++u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI_20, u8 short_GI_40, unsigned char * MCS_rate); + +int rtw_action_frame_parse(const u8 *frame, u32 frame_len, u8* category, u8 *action); +const char *action_public_str(u8 action); + -+u8 key_2char2num(u8 hch, u8 lch); -+u8 str_2char2num(u8 hch, u8 lch); -+void macstr2num(u8 *dst, u8 *src); -+u8 convert_ip_addr(u8 hch, u8 mch, u8 lch); -+int wifirate2_ratetbl_inx(unsigned char rate); -+ +#endif /* IEEE80211_H */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/if_ether.h linux/3rdparty/rtl8812au/include/if_ether.h ---- linux.old/3rdparty/rtl8812au/include/if_ether.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/if_ether.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,113 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/if_ether.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/if_ether.h +--- linux-4.14.17/3rdparty/rtl8812au/include/if_ether.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/if_ether.h 2018-02-06 17:42:30.718967283 +0200 +@@ -0,0 +1,107 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -309427,19 +138414,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/if_ether.h linux/3rdparty/rtl881 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ -+ ++ +#ifndef _LINUX_IF_ETHER_H +#define _LINUX_IF_ETHER_H + +/* + * IEEE 802.3 Ethernet magic constants. The frame sizes omit the preamble -+ * and FCS/CRC (frame check sequence). ++ * and FCS/CRC (frame check sequence). + */ + +#define ETH_ALEN 6 /* Octets in one ethernet addr */ @@ -309485,18 +138467,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/if_ether.h linux/3rdparty/rtl881 +/* + * Non DIX types. Won't clash for 1500 types. + */ -+ ++ +#define ETH_P_802_3 0x0001 /* Dummy type for 802.3 frames */ +#define ETH_P_AX25 0x0002 /* Dummy protocol id for AX.25 */ +#define ETH_P_ALL 0x0003 /* Every packet (be careful!!!) */ -+#define ETH_P_802_2 0x0004 /* 802.2 frames */ ++#define ETH_P_802_2 0x0004 /* 802.2 frames */ +#define ETH_P_SNAP 0x0005 /* Internal only */ +#define ETH_P_DDCMP 0x0006 /* DEC DDCMP: Internal only */ +#define ETH_P_WAN_PPP 0x0007 /* Dummy type for WAN PPP frames*/ +#define ETH_P_PPP_MP 0x0008 /* Dummy type for PPP MP frames */ -+#define ETH_P_LOCALTALK 0x0009 /* Localtalk pseudo type */ ++#define ETH_P_LOCALTALK 0x0009 /* Localtalk pseudo type */ +#define ETH_P_PPPTALK 0x0010 /* Dummy type for Atalk over PPP*/ -+#define ETH_P_TR_802_2 0x0011 /* 802.2 frames */ ++#define ETH_P_TR_802_2 0x0011 /* 802.2 frames */ +#define ETH_P_MOBITEX 0x0015 /* Mobitex (kaz@cafe.net) */ +#define ETH_P_CONTROL 0x0016 /* Card specific control frames */ +#define ETH_P_IRDA 0x0017 /* Linux-IrDA */ @@ -309505,8 +138487,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/if_ether.h linux/3rdparty/rtl881 +/* + * This is an Ethernet frame header. + */ -+ -+struct ethhdr ++ ++struct ethhdr +{ + unsigned char h_dest[ETH_ALEN]; /* destination eth addr */ + unsigned char h_source[ETH_ALEN]; /* source ether addr */ @@ -309526,15 +138508,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/if_ether.h linux/3rdparty/rtl881 + + +#endif /* _LINUX_IF_ETHER_H */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/ip.h linux/3rdparty/rtl8812au/include/ip.h ---- linux.old/3rdparty/rtl8812au/include/ip.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/ip.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,141 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/ioctl_cfg80211.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/ioctl_cfg80211.h +--- linux-4.14.17/3rdparty/rtl8812au/include/ioctl_cfg80211.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/ioctl_cfg80211.h 2018-02-06 17:42:30.718967283 +0200 +@@ -0,0 +1,132 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -309544,10 +138525,141 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ip.h linux/3rdparty/rtl8812au/in + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++#ifndef __IOCTL_CFG80211_H__ ++#define __IOCTL_CFG80211_H__ ++ ++ ++#if defined(RTW_USE_CFG80211_STA_EVENT) ++ #undef CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER ++#endif ++ ++struct rtw_wdev_invit_info { ++ u8 token; ++ u8 flags; ++ u8 status; ++ u8 req_op_ch; ++ u8 rsp_op_ch; ++}; ++ ++#define rtw_wdev_invit_info_init(invit_info) \ ++ do { \ ++ (invit_info)->token = 0; \ ++ (invit_info)->flags = 0x00; \ ++ (invit_info)->status = 0xff; \ ++ (invit_info)->req_op_ch = 0; \ ++ (invit_info)->rsp_op_ch = 0; \ ++ } while (0) ++ ++struct rtw_wdev_priv ++{ ++ struct wireless_dev *rtw_wdev; ++ ++ _adapter *padapter; ++ ++ struct cfg80211_scan_request *scan_request; ++ _lock scan_req_lock; ++ ++ struct net_device *pmon_ndev;//for monitor interface ++ char ifname_mon[IFNAMSIZ + 1]; //interface name for monitor interface ++ ++ u8 p2p_enabled; ++ ++ u8 provdisc_req_issued; ++ ++ struct rtw_wdev_invit_info invit_info; ++ ++ u8 bandroid_scan; ++ bool block; ++ bool power_mgmt; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ ATOMIC_T ro_ch_to; ++ ATOMIC_T switch_ch_to; ++#endif ++ ++}; ++ ++#define wdev_to_priv(w) ((struct rtw_wdev_priv *)(wdev_priv(w))) ++ ++#define wiphy_to_adapter(x) (_adapter *)(((struct rtw_wdev_priv*)wiphy_priv(x))->padapter) ++ ++#define wiphy_to_wdev(x) (struct wireless_dev *)(((struct rtw_wdev_priv*)wiphy_priv(x))->rtw_wdev) ++ ++int rtw_wdev_alloc(_adapter *padapter, struct device *dev); ++void rtw_wdev_free(struct wireless_dev *wdev); ++void rtw_wdev_unregister(struct wireless_dev *wdev); ++ ++void rtw_cfg80211_init_wiphy(_adapter *padapter); ++ ++void rtw_cfg80211_surveydone_event_callback(_adapter *padapter); ++ ++void rtw_cfg80211_indicate_connect(_adapter *padapter); ++void rtw_cfg80211_indicate_disconnect(_adapter *padapter); ++void rtw_cfg80211_indicate_scan_done(struct rtw_wdev_priv *pwdev_priv, bool aborted); ++ ++#ifdef CONFIG_AP_MODE ++void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint frame_len); ++void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, unsigned short reason); ++#endif //CONFIG_AP_MODE ++ ++void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, size_t len); ++void rtw_cfg80211_rx_p2p_action_public(_adapter *padapter, u8 *pmgmt_frame, uint frame_len); ++void rtw_cfg80211_rx_action_p2p(_adapter *padapter, u8 *pmgmt_frame, uint frame_len); ++void rtw_cfg80211_rx_action(_adapter *adapter, u8 *frame, uint frame_len, const char*msg); ++ ++int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, int type); ++ ++bool rtw_cfg80211_pwr_mgmt(_adapter *adapter); ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,4,0)) && !defined(COMPAT_KERNEL_RELEASE) ++#define rtw_cfg80211_rx_mgmt(adapter, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt((adapter)->pnetdev, freq, buf, len, gfp) ++#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3,6,0)) ++#define rtw_cfg80211_rx_mgmt(adapter, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt((adapter)->pnetdev, freq, sig_dbm, buf, len, gfp) ++#else ++#define rtw_cfg80211_rx_mgmt(adapter, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt((adapter)->rtw_wdev, freq, sig_dbm, buf, len, gfp) ++#endif ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,4,0)) && !defined(COMPAT_KERNEL_RELEASE) ++#define rtw_cfg80211_send_rx_assoc(adapter, bss, buf, len) cfg80211_send_rx_assoc((adapter)->pnetdev, buf, len) ++#else ++#define rtw_cfg80211_send_rx_assoc(adapter, bss, buf, len) cfg80211_send_rx_assoc((adapter)->pnetdev, bss, buf, len) ++#endif ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,6,0)) ++#define rtw_cfg80211_mgmt_tx_status(adapter, cookie, buf, len, ack, gfp) cfg80211_mgmt_tx_status((adapter)->pnetdev, cookie, buf, len, ack, gfp) ++#else ++#define rtw_cfg80211_mgmt_tx_status(adapter, cookie, buf, len, ack, gfp) cfg80211_mgmt_tx_status((adapter)->rtw_wdev, cookie, buf, len, ack, gfp) ++#endif ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,6,0)) ++#define rtw_cfg80211_ready_on_channel(adapter, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel((adapter)->pnetdev, cookie, chan, channel_type, duration, gfp) ++#define rtw_cfg80211_remain_on_channel_expired(adapter, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired((adapter)->pnetdev, cookie, chan, chan_type, gfp) ++#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) ++#define rtw_cfg80211_ready_on_channel(adapter, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel((adapter)->rtw_wdev, cookie, chan, channel_type, duration, gfp) ++#define rtw_cfg80211_remain_on_channel_expired(adapter, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired((adapter)->rtw_wdev, cookie, chan, chan_type, gfp) ++#else ++#define rtw_cfg80211_ready_on_channel(adapter, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel((adapter)->rtw_wdev, cookie, chan, duration, gfp) ++#define rtw_cfg80211_remain_on_channel_expired(adapter, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired((adapter)->rtw_wdev, cookie, chan, gfp) ++#endif ++ ++#endif //__IOCTL_CFG80211_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/ip.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/ip.h +--- linux-4.14.17/3rdparty/rtl8812au/include/ip.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/ip.h 2018-02-06 17:42:30.718967283 +0200 +@@ -0,0 +1,130 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#ifndef _LINUX_IP_H @@ -309623,8 +138735,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ip.h linux/3rdparty/rtl8812au/in +#define IPOPT_TS_TSANDADDR 1 /* timestamps and addresses */ +#define IPOPT_TS_PRESPEC 3 /* specified modules only */ + -+#ifdef PLATFORM_LINUX -+ +struct ip_options { + __u32 faddr; /* Saved first hop address */ + unsigned char optlen; @@ -309635,7 +138745,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ip.h linux/3rdparty/rtl8812au/in + is_data:1, /* Options in __data, rather than skb */ + is_strictroute:1, /* Strict source route */ + srr_is_hit:1, /* Packet destination addr was our one */ -+ is_changed:1, /* IP checksum more not valid */ ++ is_changed:1, /* IP checksum more not valid */ + rr_needaddr:1, /* Need to record addr of outgoing dev */ + ts_needtime:1, /* Need to record timestamp */ + ts_needaddr:1; /* Need to record addr of outgoing dev */ @@ -309646,17 +138756,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ip.h linux/3rdparty/rtl8812au/in +}; + +#define optlength(opt) (sizeof(struct ip_options) + opt->optlen) -+#endif + +struct iphdr { -+#if defined(__LITTLE_ENDIAN_BITFIELD) ++#if defined(__LITTLE_ENDIAN) + __u8 ihl:4, + version:4; -+#elif defined (__BIG_ENDIAN_BITFIELD) -+ __u8 version:4, -+ ihl:4; +#else -+#error "Please fix " ++ __u8 version:4, ++ ihl:4; +#endif + __u8 tos; + __u16 tot_len; @@ -309671,11 +138778,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/ip.h linux/3rdparty/rtl8812au/in +}; + +#endif /* _LINUX_IP_H */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/linux/wireless.h linux/3rdparty/rtl8812au/include/linux/wireless.h ---- linux.old/3rdparty/rtl8812au/include/linux/wireless.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/linux/wireless.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,97 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/linux/wireless.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/linux/wireless.h +--- linux-4.14.17/3rdparty/rtl8812au/include/linux/wireless.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/linux/wireless.h 2018-02-06 17:42:30.718967283 +0200 +@@ -0,0 +1,86 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -309689,11 +138795,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/linux/wireless.h linux/3rdparty/ + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ + +#ifndef _LINUX_WIRELESS_H @@ -309713,13 +138814,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/linux/wireless.h linux/3rdparty/ +#endif + +/****************************** TYPES ******************************/ -+#ifdef CONFIG_COMPAT -+struct compat_iw_point { -+ compat_caddr_t pointer; -+ __u16 length; -+ __u16 flags; -+}; -+#endif ++ +/* --------------------------- SUBTYPES --------------------------- */ +/* + * For all data larger than 16 octets, we need to use a @@ -309773,14 +138868,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/linux/wireless.h linux/3rdparty/ + +#endif /* _LINUX_WIRELESS_H */ + -diff -Nurp linux.old/3rdparty/rtl8812au/include/mlme_osdep.h linux/3rdparty/rtl8812au/include/mlme_osdep.h ---- linux.old/3rdparty/rtl8812au/include/mlme_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/mlme_osdep.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,37 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/mlme_osdep.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/mlme_osdep.h +--- linux-4.14.17/3rdparty/rtl8812au/include/mlme_osdep.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/mlme_osdep.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,28 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -309790,20 +138885,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mlme_osdep.h linux/3rdparty/rtl8 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __MLME_OSDEP_H_ +#define __MLME_OSDEP_H_ + -+ -+#if defined(PLATFORM_WINDOWS) || defined(PLATFORM_MPIXEL) -+extern int time_after(u32 now, u32 old); -+#endif -+ +extern void rtw_init_mlme_timer(_adapter *padapter); +extern void rtw_os_indicate_disconnect( _adapter *adapter ); +extern void rtw_os_indicate_connect( _adapter *adapter ); @@ -309812,16 +138897,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mlme_osdep.h linux/3rdparty/rtl8 + +void rtw_reset_securitypriv( _adapter *adapter ); + -+#endif //_MLME_OSDEP_H_ ++u8 rtw_handle_tkip_countermeasure(_adapter* padapter); + -diff -Nurp linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h linux/3rdparty/rtl8812au/include/mp_custom_oid.h ---- linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/mp_custom_oid.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,354 @@ ++#endif //_MLME_OSDEP_H_ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/mp_custom_oid.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/mp_custom_oid.h +--- linux-4.14.17/3rdparty/rtl8812au/include/mp_custom_oid.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/mp_custom_oid.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,348 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -309831,11 +138917,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h linux/3rdparty/r + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __CUSTOM_OID_H +#define __CUSTOM_OID_H @@ -309858,7 +138939,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h linux/3rdparty/r +#define OID_RT_PRO_RESET_DUT 0xFF818000 +#define OID_RT_PRO_SET_DATA_RATE 0xFF818001 +#define OID_RT_PRO_START_TEST 0xFF818002 -+#define OID_RT_PRO_STOP_TEST 0xFF818003 ++#define OID_RT_PRO_STOP_TEST 0xFF818003 +#define OID_RT_PRO_SET_PREAMBLE 0xFF818004 +#define OID_RT_PRO_SET_SCRAMBLER 0xFF818005 +#define OID_RT_PRO_SET_FILTER_BB 0xFF818006 @@ -309891,7 +138972,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h linux/3rdparty/r +#define OID_RT_PRO_READ_EEPROM 0xFF818022 +#define OID_RT_PRO_RESET_TX_PACKET_SENT 0xFF818023 +#define OID_RT_PRO_QUERY_TX_PACKET_SENT 0xFF818024 -+#define OID_RT_PRO_RESET_RX_PACKET_RECEIVED 0xFF818025 ++#define OID_RT_PRO_RESET_RX_PACKET_RECEIVED 0xFF818025 +#define OID_RT_PRO_QUERY_RX_PACKET_RECEIVED 0xFF818026 +#define OID_RT_PRO_QUERY_RX_PACKET_CRC32_ERROR 0xFF818027 +#define OID_RT_PRO_QUERY_CURRENT_ADDRESS 0xFF818028 @@ -309904,7 +138985,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h linux/3rdparty/r +#define OID_RT_PRO_SET_MODULATION 0xFF81802F +// + -+//Sean ++//Sean +#define OID_RT_DRIVER_OPTION 0xFF818080 +#define OID_RT_RF_OFF 0xFF818081 +#define OID_RT_AUTH_STATUS 0xFF818082 @@ -309918,7 +138999,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h linux/3rdparty/r + + +// by Owen for RTL8185 Phy Status Report Utility -+#define OID_RT_UTILITY_FALSE_ALARM_COUNTERS 0xFF818580 ++#define OID_RT_UTILITYfalse_ALARM_COUNTERS 0xFF818580 +#define OID_RT_UTILITY_SELECT_DEBUG_MODE 0xFF818581 +#define OID_RT_UTILITY_SELECT_SUBCARRIER_NUMBER 0xFF818582 +#define OID_RT_UTILITY_GET_RSSI_STATUS 0xFF818583 @@ -309934,15 +139015,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h linux/3rdparty/r +#define OID_RT_WIRELESS_MODE_STARTING_ADHOC 0xFF818503 +// + -+#define OID_RT_GET_CONNECT_STATE 0xFF030001 -+#define OID_RT_RESCAN 0xFF030002 ++#define OID_RT_GET_CONNECT_STATE 0xFF030001 ++#define OID_RT_RESCAN 0xFF030002 +#define OID_RT_SET_KEY_LENGTH 0xFF030003 +#define OID_RT_SET_DEFAULT_KEY_ID 0xFF030004 + +#define OID_RT_SET_CHANNEL 0xFF010182 -+#define OID_RT_SET_SNIFFER_MODE 0xFF010183 -+#define OID_RT_GET_SIGNAL_QUALITY 0xFF010184 -+#define OID_RT_GET_SMALL_PACKET_CRC 0xFF010185 ++#define OID_RT_SET_SNIFFER_MODE 0xFF010183 ++#define OID_RT_GET_SIGNAL_QUALITY 0xFF010184 ++#define OID_RT_GET_SMALL_PACKET_CRC 0xFF010185 +#define OID_RT_GET_MIDDLE_PACKET_CRC 0xFF010186 +#define OID_RT_GET_LARGE_PACKET_CRC 0xFF010187 +#define OID_RT_GET_TX_RETRY 0xFF010188 @@ -310059,8 +139140,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h linux/3rdparty/r +#define OID_RT_PRO_READ_REGISTER 0xFF871101 //Q +#define OID_RT_PRO_WRITE_REGISTER 0xFF871102 //S + -+#define OID_RT_PRO_BURST_READ_REGISTER 0xFF871103 //Q -+#define OID_RT_PRO_BURST_WRITE_REGISTER 0xFF871104 //S ++#define OID_RT_PRO_BURST_READ_REGISTER 0xFF871103 //Q ++#define OID_RT_PRO_BURST_WRITE_REGISTER 0xFF871104 //S + +#define OID_RT_PRO_WRITE_TXCMD 0xFF871105 //S + @@ -310103,9 +139184,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h linux/3rdparty/r +#define OID_RT_PRO_READ_TSSI 0xFF871123//S +#define OID_RT_PRO_SET_POWER_TRACKING 0xFF871124//S + -+ ++ +#define OID_RT_PRO_QRY_PWRSTATE 0xFF871150 //Q -+#define OID_RT_PRO_SET_PWRSTATE 0xFF871151 //S ++#define OID_RT_PRO_SET_PWRSTATE 0xFF871151 //S + +//Method 2 , using workitem +#define OID_RT_SET_READ_REG 0xFF871181 //S @@ -310119,7 +139200,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h linux/3rdparty/r + +//For SDIO INTERFACE only +#define OID_RT_PRO_SYNCPAGERW_SRAM 0xFF8711A0 //Q, S -+#define OID_RT_PRO_871X_DRV_EXT 0xFF8711A1 ++#define OID_RT_PRO_871X_DRV_EXT 0xFF8711A1 + +//For USB INTERFACE only +#define OID_RT_PRO_USB_VENDOR_REQ 0xFF8711B0 //Q, S @@ -310134,8 +139215,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h linux/3rdparty/r + +#define OID_RT_PRO_ENCRYPTION_CTRL 0xFF871200 //Q, S +#define OID_RT_PRO_ADD_STA_INFO 0xFF871201 //S -+#define OID_RT_PRO_DELE_STA_INFO 0xFF871202 //S -+#define OID_RT_PRO_QUERY_DR_VARIABLE 0xFF871203 //Q ++#define OID_RT_PRO_DELE_STA_INFO 0xFF871202 //S ++#define OID_RT_PRO_QUERY_DR_VARIABLE 0xFF871203 //Q + +#define OID_RT_PRO_RX_PACKET_TYPE 0xFF871204 //Q, S + @@ -310147,7 +139228,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h linux/3rdparty/r +#define OID_RT_SET_BANDWIDTH 0xFF871209 //S +#define OID_RT_SET_CRYSTAL_CAP 0xFF87120A //S + -+#define OID_RT_SET_RX_PACKET_TYPE 0xFF87120B //S ++#define OID_RT_SET_RX_PACKET_TYPE 0xFF87120B //S + +#define OID_RT_GET_EFUSE_MAX_SIZE 0xFF87120C //Q + @@ -310171,15 +139252,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/mp_custom_oid.h linux/3rdparty/r +#define OID_RT_PRO_EFUSE_MAP 0xFF871217 //Q, S + +#endif //#ifndef __CUSTOM_OID_H -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/nic_spec.h linux/3rdparty/rtl8812au/include/nic_spec.h ---- linux.old/3rdparty/rtl8812au/include/nic_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/nic_spec.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,47 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/nic_spec.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/nic_spec.h +--- linux-4.14.17/3rdparty/rtl8812au/include/nic_spec.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/nic_spec.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,41 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -310189,12 +139269,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/nic_spec.h linux/3rdparty/rtl881 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ ++ ******************************************************************************/ + + +#ifndef __NIC_SPEC_H__ @@ -310222,11 +139297,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/nic_spec.h linux/3rdparty/rtl881 + + +#endif // __RTL8711_SPEC_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_intf.h linux/3rdparty/rtl8812au/include/osdep_intf.h ---- linux.old/3rdparty/rtl8812au/include/osdep_intf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/osdep_intf.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,173 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/osdep_intf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_intf.h +--- linux-4.14.17/3rdparty/rtl8812au/include/osdep_intf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_intf.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,111 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -310240,11 +139314,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_intf.h linux/3rdparty/rtl8 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ + +#ifndef __OSDEP_INTF_H_ @@ -310254,7 +139323,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_intf.h linux/3rdparty/rtl8 +struct intf_priv { + + u8 *intf_dev; -+ u32 max_iosz; //USB2.0: 128, USB1.1: 64, SDIO:64 ++ u32 max_iosz; //USB2.0: 128, USB1.1: 64, SDIO:64 + u32 max_xmitsz; //USB2.0: unlimited, SDIO:512 + u32 max_recvsz; //USB2.0: unlimited, SDIO:512 + @@ -310276,11 +139345,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_intf.h linux/3rdparty/rtl8 + + _mutex ioctl_mutex; + -+ -+#ifdef PLATFORM_LINUX -+ #ifdef CONFIG_USB_HCI + // when in USB, IO is through interrupt in/out endpoints -+ struct usb_device *udev; ++ struct usb_device *udev; + PURB piorw_urb; + u8 io_irp_cnt; + u8 bio_irp_pending; @@ -310288,89 +139354,42 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_intf.h linux/3rdparty/rtl8 + _timer io_timer; + u8 bio_irp_timeout; + u8 bio_timer_cancel; -+ #endif -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ #ifdef CONFIG_SDIO_HCI -+ // below is for io_rwmem... -+ PMDL pmdl; -+ PSDBUS_REQUEST_PACKET sdrp; -+ PSDBUS_REQUEST_PACKET recv_sdrp; -+ PSDBUS_REQUEST_PACKET xmit_sdrp; -+ -+ PIRP piorw_irp; -+ -+ #endif -+ #ifdef CONFIG_USB_HCI -+ PURB piorw_urb; -+ PIRP piorw_irp; -+ u8 io_irp_cnt; -+ u8 bio_irp_pending; -+ _sema io_retevt; -+ #endif -+#endif -+ +}; + -+ +#ifdef CONFIG_R871X_TEST +int rtw_start_pseudo_adhoc(_adapter *padapter); +int rtw_stop_pseudo_adhoc(_adapter *padapter); +#endif + -+struct dvobj_priv *devobj_init(void); -+void devobj_deinit(struct dvobj_priv *pdvobj); -+ +u8 rtw_init_drv_sw(_adapter *padapter); +u8 rtw_free_drv_sw(_adapter *padapter); +u8 rtw_reset_drv_sw(_adapter *padapter); -+void rtw_dev_unload(PADAPTER padapter); + +u32 rtw_start_drv_threads(_adapter *padapter); +void rtw_stop_drv_threads (_adapter *padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) ++#ifdef CONFIG_WOWLAN +void rtw_cancel_dynamic_chk_timer(_adapter *padapter); +#endif +void rtw_cancel_all_timer(_adapter *padapter); + -+uint loadparam(_adapter *adapter); -+ -+#ifdef PLATFORM_LINUX +int rtw_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); + +int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname); +struct net_device *rtw_init_netdev(_adapter *padapter); + -+void rtw_os_ndev_free(_adapter *adapter); -+int rtw_os_ndev_init(_adapter *adapter, char *name); -+void rtw_os_ndev_deinit(_adapter *adapter); -+void rtw_os_ndevs_unregister(struct dvobj_priv *dvobj); -+int rtw_os_ndevs_init(struct dvobj_priv *dvobj); -+void rtw_os_ndevs_deinit(struct dvobj_priv *dvobj); -+ +#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) +u16 rtw_recv_select_queue(struct sk_buff *skb); +#endif //LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35) + -+int rtw_ndev_notifier_register(void); -+void rtw_ndev_notifier_unregister(void); -+ -+#include "../os_dep/linux/rtw_proc.h" -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+#include "../os_dep/linux/ioctl_cfg80211.h" -+#endif //CONFIG_IOCTL_CFG80211 -+ -+#endif //PLATFORM_LINUX -+ -+ -+#ifdef PLATFORM_FREEBSD -+extern int rtw_ioctl(struct ifnet * ifp, u_long cmd, caddr_t data); -+#endif ++#ifdef CONFIG_PROC_DEBUG ++void rtw_proc_init_one(struct net_device *dev); ++void rtw_proc_remove_one(struct net_device *dev); ++#else //!CONFIG_PROC_DEBUG ++static void rtw_proc_init_one(struct net_device *dev){} ++static void rtw_proc_remove_one(struct net_device *dev){} ++#endif //!CONFIG_PROC_DEBUG + +void rtw_ips_dev_unload(_adapter *padapter); -+ +#ifdef CONFIG_IPS +int rtw_ips_pwr_up(_adapter *padapter); +void rtw_ips_pwr_down(_adapter *padapter); @@ -310389,974 +139408,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_intf.h linux/3rdparty/rtl8 +#endif //CONFIG_MULTI_VIR_IFACES +#endif + ++int rtw_drv_register_netdev(_adapter *padapter); +void rtw_ndev_destructor(_nic_hdl ndev); + -+#ifdef CONFIG_ARP_KEEP_ALIVE -+int rtw_gw_addr_query(_adapter *padapter); -+#endif -+ -+int rtw_suspend_common(_adapter *padapter); -+int rtw_resume_common(_adapter *padapter); -+ +#endif //_OSDEP_INTF_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service_bsd.h linux/3rdparty/rtl8812au/include/osdep_service_bsd.h ---- linux.old/3rdparty/rtl8812au/include/osdep_service_bsd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/osdep_service_bsd.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,749 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __OSDEP_BSD_SERVICE_H_ -+#define __OSDEP_BSD_SERVICE_H_ -+ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+ -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include "usbdevs.h" -+ -+#define USB_DEBUG_VAR rum_debug -+#include -+ -+#if 1 //Baron porting from linux, it's all temp solution, needs to check again -+#include -+#include /* XXX for PCPU_GET */ -+// typedef struct semaphore _sema; -+ typedef struct sema _sema; -+// typedef spinlock_t _lock; -+ typedef struct mtx _lock; -+ typedef struct mtx _mutex; -+ typedef struct timer_list _timer; -+ struct list_head { -+ struct list_head *next, *prev; -+ }; -+ struct __queue { -+ struct list_head queue; -+ _lock lock; -+ }; -+ -+ //typedef struct sk_buff _pkt; -+ typedef struct mbuf _pkt; -+ typedef struct mbuf _buffer; -+ -+ typedef struct __queue _queue; -+ typedef struct list_head _list; -+ typedef int _OS_STATUS; -+ //typedef u32 _irqL; -+ typedef unsigned long _irqL; -+ typedef struct ifnet * _nic_hdl; -+ -+ typedef pid_t _thread_hdl_; -+// typedef struct thread _thread_hdl_; -+ typedef void thread_return; -+ typedef void* thread_context; -+ -+ //#define thread_exit() complete_and_exit(NULL, 0) -+ -+ #define thread_exit() do{printf("%s", "RTKTHREAD_exit");}while(0) -+ -+ typedef void timer_hdl_return; -+ typedef void* timer_hdl_context; -+ typedef struct work_struct _workitem; -+ -+#define KERNEL_VERSION(a,b,c) (((a) << 16) + ((b) << 8) + (c)) -+/* emulate a modern version */ -+#define LINUX_VERSION_CODE KERNEL_VERSION(2, 6, 35) -+ -+#define WIRELESS_EXT -1 -+#define HZ hz -+#define spin_lock_irqsave mtx_lock_irqsave -+#define spin_lock_bh mtx_lock_irqsave -+#define mtx_lock_irqsave(lock, x) mtx_lock(lock)//{local_irq_save((x)); mtx_lock_spin((lock));} -+//#define IFT_RTW 0xf9 //ifnet allocate type for RTW -+#define free_netdev if_free -+#define LIST_CONTAINOR(ptr, type, member) \ -+ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) -+#define container_of(p,t,n) (t*)((p)-&(((t*)0)->n)) -+/* -+ * Linux timers are emulated using FreeBSD callout functions -+ * (and taskqueue functionality). -+ * -+ * Currently no timer stats functionality. -+ * -+ * See (linux_compat) processes.c -+ * -+ */ -+struct timer_list { -+ -+ /* FreeBSD callout related fields */ -+ struct callout callout; -+ -+ //timeout function -+ void (*function)(void*); -+ //argument -+ void *arg; -+ -+}; -+struct workqueue_struct; -+struct work_struct; -+typedef void (*work_func_t)(struct work_struct *work); -+/* Values for the state of an item of work (work_struct) */ -+typedef enum work_state { -+ WORK_STATE_UNSET = 0, -+ WORK_STATE_CALLOUT_PENDING = 1, -+ WORK_STATE_TASK_PENDING = 2, -+ WORK_STATE_WORK_CANCELLED = 3 -+} work_state_t; -+ -+struct work_struct { -+ struct task task; /* FreeBSD task */ -+ work_state_t state; /* the pending or otherwise state of work. */ -+ work_func_t func; -+}; -+#define spin_unlock_irqrestore mtx_unlock_irqrestore -+#define spin_unlock_bh mtx_unlock_irqrestore -+#define mtx_unlock_irqrestore(lock,x) mtx_unlock(lock); -+extern void _rtw_spinlock_init(_lock *plock); -+ -+//modify private structure to match freebsd -+#define BITS_PER_LONG 32 -+union ktime { -+ s64 tv64; -+#if BITS_PER_LONG != 64 && !defined(CONFIG_KTIME_SCALAR) -+ struct { -+#ifdef __BIG_ENDIAN -+ s32 sec, nsec; -+#else -+ s32 nsec, sec; -+#endif -+ } tv; -+#endif -+}; -+#define kmemcheck_bitfield_begin(name) -+#define kmemcheck_bitfield_end(name) -+#define CHECKSUM_NONE 0 -+typedef unsigned char *sk_buff_data_t; -+typedef union ktime ktime_t; /* Kill this */ -+ -+void rtw_mtx_lock(_lock *plock); -+ -+void rtw_mtx_unlock(_lock *plock); -+ -+/** -+ * struct sk_buff - socket buffer -+ * @next: Next buffer in list -+ * @prev: Previous buffer in list -+ * @sk: Socket we are owned by -+ * @tstamp: Time we arrived -+ * @dev: Device we arrived on/are leaving by -+ * @transport_header: Transport layer header -+ * @network_header: Network layer header -+ * @mac_header: Link layer header -+ * @_skb_refdst: destination entry (with norefcount bit) -+ * @sp: the security path, used for xfrm -+ * @cb: Control buffer. Free for use by every layer. Put private vars here -+ * @len: Length of actual data -+ * @data_len: Data length -+ * @mac_len: Length of link layer header -+ * @hdr_len: writable header length of cloned skb -+ * @csum: Checksum (must include start/offset pair) -+ * @csum_start: Offset from skb->head where checksumming should start -+ * @csum_offset: Offset from csum_start where checksum should be stored -+ * @local_df: allow local fragmentation -+ * @cloned: Head may be cloned (check refcnt to be sure) -+ * @nohdr: Payload reference only, must not modify header -+ * @pkt_type: Packet class -+ * @fclone: skbuff clone status -+ * @ip_summed: Driver fed us an IP checksum -+ * @priority: Packet queueing priority -+ * @users: User count - see {datagram,tcp}.c -+ * @protocol: Packet protocol from driver -+ * @truesize: Buffer size -+ * @head: Head of buffer -+ * @data: Data head pointer -+ * @tail: Tail pointer -+ * @end: End pointer -+ * @destructor: Destruct function -+ * @mark: Generic packet mark -+ * @nfct: Associated connection, if any -+ * @ipvs_property: skbuff is owned by ipvs -+ * @peeked: this packet has been seen already, so stats have been -+ * done for it, don't do them again -+ * @nf_trace: netfilter packet trace flag -+ * @nfctinfo: Relationship of this skb to the connection -+ * @nfct_reasm: netfilter conntrack re-assembly pointer -+ * @nf_bridge: Saved data about a bridged frame - see br_netfilter.c -+ * @skb_iif: ifindex of device we arrived on -+ * @rxhash: the packet hash computed on receive -+ * @queue_mapping: Queue mapping for multiqueue devices -+ * @tc_index: Traffic control index -+ * @tc_verd: traffic control verdict -+ * @ndisc_nodetype: router type (from link layer) -+ * @dma_cookie: a cookie to one of several possible DMA operations -+ * done by skb DMA functions -+ * @secmark: security marking -+ * @vlan_tci: vlan tag control information -+ */ -+ -+struct sk_buff { -+ /* These two members must be first. */ -+ struct sk_buff *next; -+ struct sk_buff *prev; -+ -+ ktime_t tstamp; -+ -+ struct sock *sk; -+ //struct net_device *dev; -+ struct ifnet *dev; -+ -+ /* -+ * This is the control buffer. It is free to use for every -+ * layer. Please put your private variables there. If you -+ * want to keep them across layers you have to do a skb_clone() -+ * first. This is owned by whoever has the skb queued ATM. -+ */ -+ char cb[48] __aligned(8); -+ -+ unsigned long _skb_refdst; -+#ifdef CONFIG_XFRM -+ struct sec_path *sp; -+#endif -+ unsigned int len, -+ data_len; -+ u16 mac_len, -+ hdr_len; -+ union { -+ u32 csum; -+ struct { -+ u16 csum_start; -+ u16 csum_offset; -+ }smbol2; -+ }smbol1; -+ u32 priority; -+ kmemcheck_bitfield_begin(flags1); -+ u8 local_df:1, -+ cloned:1, -+ ip_summed:2, -+ nohdr:1, -+ nfctinfo:3; -+ u8 pkt_type:3, -+ fclone:2, -+ ipvs_property:1, -+ peeked:1, -+ nf_trace:1; -+ kmemcheck_bitfield_end(flags1); -+ u16 protocol; -+ -+ void (*destructor)(struct sk_buff *skb); -+#if defined(CONFIG_NF_CONNTRACK) || defined(CONFIG_NF_CONNTRACK_MODULE) -+ struct nf_conntrack *nfct; -+ struct sk_buff *nfct_reasm; -+#endif -+#ifdef CONFIG_BRIDGE_NETFILTER -+ struct nf_bridge_info *nf_bridge; -+#endif -+ -+ int skb_iif; -+#ifdef CONFIG_NET_SCHED -+ u16 tc_index; /* traffic control index */ -+#ifdef CONFIG_NET_CLS_ACT -+ u16 tc_verd; /* traffic control verdict */ -+#endif -+#endif -+ -+ u32 rxhash; -+ -+ kmemcheck_bitfield_begin(flags2); -+ u16 queue_mapping:16; -+#ifdef CONFIG_IPV6_NDISC_NODETYPE -+ u8 ndisc_nodetype:2, -+ deliver_no_wcard:1; -+#else -+ u8 deliver_no_wcard:1; -+#endif -+ kmemcheck_bitfield_end(flags2); -+ -+ /* 0/14 bit hole */ -+ -+#ifdef CONFIG_NET_DMA -+ dma_cookie_t dma_cookie; -+#endif -+#ifdef CONFIG_NETWORK_SECMARK -+ u32 secmark; -+#endif -+ union { -+ u32 mark; -+ u32 dropcount; -+ }symbol3; -+ -+ u16 vlan_tci; -+ -+ sk_buff_data_t transport_header; -+ sk_buff_data_t network_header; -+ sk_buff_data_t mac_header; -+ /* These elements must be at the end, see alloc_skb() for details. */ -+ sk_buff_data_t tail; -+ sk_buff_data_t end; -+ unsigned char *head, -+ *data; -+ unsigned int truesize; -+ atomic_t users; -+}; -+struct sk_buff_head { -+ /* These two members must be first. */ -+ struct sk_buff *next; -+ struct sk_buff *prev; -+ -+ u32 qlen; -+ _lock lock; -+}; -+#define skb_tail_pointer(skb) skb->tail -+static inline unsigned char *skb_put(struct sk_buff *skb, unsigned int len) -+{ -+ unsigned char *tmp = skb_tail_pointer(skb); -+ //SKB_LINEAR_ASSERT(skb); -+ skb->tail += len; -+ skb->len += len; -+ return tmp; -+} -+ -+static inline unsigned char *__skb_pull(struct sk_buff *skb, unsigned int len) -+{ -+ skb->len -= len; -+ if(skb->len < skb->data_len) -+ printf("%s(),%d,error!\n",__FUNCTION__,__LINE__); -+ return skb->data += len; -+} -+static inline unsigned char *skb_pull(struct sk_buff *skb, unsigned int len) -+{ -+ #ifdef PLATFORM_FREEBSD -+ return __skb_pull(skb, len); -+ #else -+ return unlikely(len > skb->len) ? NULL : __skb_pull(skb, len); -+ #endif //PLATFORM_FREEBSD -+} -+static inline u32 skb_queue_len(const struct sk_buff_head *list_) -+{ -+ return list_->qlen; -+} -+static inline void __skb_insert(struct sk_buff *newsk, -+ struct sk_buff *prev, struct sk_buff *next, -+ struct sk_buff_head *list) -+{ -+ newsk->next = next; -+ newsk->prev = prev; -+ next->prev = prev->next = newsk; -+ list->qlen++; -+} -+static inline void __skb_queue_before(struct sk_buff_head *list, -+ struct sk_buff *next, -+ struct sk_buff *newsk) -+{ -+ __skb_insert(newsk, next->prev, next, list); -+} -+static inline void skb_queue_tail(struct sk_buff_head *list, -+ struct sk_buff *newsk) -+{ -+ mtx_lock(&list->lock); -+ __skb_queue_before(list, (struct sk_buff *)list, newsk); -+ mtx_unlock(&list->lock); -+} -+static inline struct sk_buff *skb_peek(struct sk_buff_head *list_) -+{ -+ struct sk_buff *list = ((struct sk_buff *)list_)->next; -+ if (list == (struct sk_buff *)list_) -+ list = NULL; -+ return list; -+} -+static inline void __skb_unlink(struct sk_buff *skb, struct sk_buff_head *list) -+{ -+ struct sk_buff *next, *prev; -+ -+ list->qlen--; -+ next = skb->next; -+ prev = skb->prev; -+ skb->next = skb->prev = NULL; -+ next->prev = prev; -+ prev->next = next; -+} -+ -+static inline struct sk_buff *skb_dequeue(struct sk_buff_head *list) -+{ -+ mtx_lock(&list->lock); -+ -+ struct sk_buff *skb = skb_peek(list); -+ if (skb) -+ __skb_unlink(skb, list); -+ -+ mtx_unlock(&list->lock); -+ -+ return skb; -+} -+static inline void skb_reserve(struct sk_buff *skb, int len) -+{ -+ skb->data += len; -+ skb->tail += len; -+} -+static inline void __skb_queue_head_init(struct sk_buff_head *list) -+{ -+ list->prev = list->next = (struct sk_buff *)list; -+ list->qlen = 0; -+} -+/* -+ * This function creates a split out lock class for each invocation; -+ * this is needed for now since a whole lot of users of the skb-queue -+ * infrastructure in drivers have different locking usage (in hardirq) -+ * than the networking core (in softirq only). In the long run either the -+ * network layer or drivers should need annotation to consolidate the -+ * main types of usage into 3 classes. -+ */ -+static inline void skb_queue_head_init(struct sk_buff_head *list) -+{ -+ _rtw_spinlock_init(&list->lock); -+ __skb_queue_head_init(list); -+} -+unsigned long copy_from_user(void *to, const void *from, unsigned long n); -+unsigned long copy_to_user(void *to, const void *from, unsigned long n); -+struct sk_buff * dev_alloc_skb(unsigned int size); -+struct sk_buff *skb_clone(const struct sk_buff *skb); -+void dev_kfree_skb_any(struct sk_buff *skb); -+#endif //Baron porting from linux, it's all temp solution, needs to check again -+ -+ -+#if 1 // kenny add Linux compatibility code for Linux USB driver -+#include -+ -+#define __init // __attribute ((constructor)) -+#define __exit // __attribute ((destructor)) -+ -+/* -+ * Definitions for module_init and module_exit macros. -+ * -+ * These macros will use the SYSINIT framework to call a specified -+ * function (with no arguments) on module loading or unloading. -+ * -+ */ -+ -+void module_init_exit_wrapper(void *arg); -+ -+#define module_init(initfn) \ -+ SYSINIT(mod_init_ ## initfn, \ -+ SI_SUB_KLD, SI_ORDER_FIRST, \ -+ module_init_exit_wrapper, initfn) -+ -+#define module_exit(exitfn) \ -+ SYSUNINIT(mod_exit_ ## exitfn, \ -+ SI_SUB_KLD, SI_ORDER_ANY, \ -+ module_init_exit_wrapper, exitfn) -+ -+/* -+ * The usb_register and usb_deregister functions are used to register -+ * usb drivers with the usb subsystem. -+ */ -+int usb_register(struct usb_driver *driver); -+int usb_deregister(struct usb_driver *driver); -+ -+/* -+ * usb_get_dev and usb_put_dev - increment/decrement the reference count -+ * of the usb device structure. -+ * -+ * Original body of usb_get_dev: -+ * -+ * if (dev) -+ * get_device(&dev->dev); -+ * return dev; -+ * -+ * Reference counts are not currently used in this compatibility -+ * layer. So these functions will do nothing. -+ */ -+static inline struct usb_device * -+usb_get_dev(struct usb_device *dev) -+{ -+ return dev; -+} -+ -+static inline void -+usb_put_dev(struct usb_device *dev) -+{ -+ return; -+} -+ -+ -+// rtw_usb_compat_linux -+int rtw_usb_submit_urb(struct urb *urb, uint16_t mem_flags); -+int rtw_usb_unlink_urb(struct urb *urb); -+int rtw_usb_clear_halt(struct usb_device *dev, struct usb_host_endpoint *uhe); -+int rtw_usb_control_msg(struct usb_device *dev, struct usb_host_endpoint *uhe, -+ uint8_t request, uint8_t requesttype, -+ uint16_t value, uint16_t index, void *data, -+ uint16_t size, usb_timeout_t timeout); -+int rtw_usb_set_interface(struct usb_device *dev, uint8_t iface_no, uint8_t alt_index); -+int rtw_usb_setup_endpoint(struct usb_device *dev, -+ struct usb_host_endpoint *uhe, usb_size_t bufsize); -+struct urb *rtw_usb_alloc_urb(uint16_t iso_packets, uint16_t mem_flags); -+struct usb_host_endpoint *rtw_usb_find_host_endpoint(struct usb_device *dev, uint8_t type, uint8_t ep); -+struct usb_host_interface *rtw_usb_altnum_to_altsetting(const struct usb_interface *intf, uint8_t alt_index); -+struct usb_interface *rtw_usb_ifnum_to_if(struct usb_device *dev, uint8_t iface_no); -+void *rtw_usbd_get_intfdata(struct usb_interface *intf); -+void rtw_usb_linux_register(void *arg); -+void rtw_usb_linux_deregister(void *arg); -+void rtw_usb_linux_free_device(struct usb_device *dev); -+void rtw_usb_free_urb(struct urb *urb); -+void rtw_usb_init_urb(struct urb *urb); -+void rtw_usb_kill_urb(struct urb *urb); -+void rtw_usb_set_intfdata(struct usb_interface *intf, void *data); -+void rtw_usb_fill_bulk_urb(struct urb *urb, struct usb_device *udev, -+ struct usb_host_endpoint *uhe, void *buf, -+ int length, usb_complete_t callback, void *arg); -+int rtw_usb_bulk_msg(struct usb_device *udev, struct usb_host_endpoint *uhe, -+ void *data, int len, uint16_t *pactlen, usb_timeout_t timeout); -+void *usb_get_intfdata(struct usb_interface *intf); -+int usb_linux_init_endpoints(struct usb_device *udev); -+ -+ -+ -+typedef struct urb * PURB; -+ -+typedef unsigned gfp_t; -+#define __GFP_WAIT ((gfp_t)0x10u) /* Can wait and reschedule? */ -+#define __GFP_HIGH ((gfp_t)0x20u) /* Should access emergency pools? */ -+#define __GFP_IO ((gfp_t)0x40u) /* Can start physical IO? */ -+#define __GFP_FS ((gfp_t)0x80u) /* Can call down to low-level FS? */ -+#define __GFP_COLD ((gfp_t)0x100u) /* Cache-cold page required */ -+#define __GFP_NOWARN ((gfp_t)0x200u) /* Suppress page allocation failure warning */ -+#define __GFP_REPEAT ((gfp_t)0x400u) /* Retry the allocation. Might fail */ -+#define __GFP_NOFAIL ((gfp_t)0x800u) /* Retry for ever. Cannot fail */ -+#define __GFP_NORETRY ((gfp_t)0x1000u)/* Do not retry. Might fail */ -+#define __GFP_NO_GROW ((gfp_t)0x2000u)/* Slab internal usage */ -+#define __GFP_COMP ((gfp_t)0x4000u)/* Add compound page metadata */ -+#define __GFP_ZERO ((gfp_t)0x8000u)/* Return zeroed page on success */ -+#define __GFP_NOMEMALLOC ((gfp_t)0x10000u) /* Don't use emergency reserves */ -+#define __GFP_HARDWALL ((gfp_t)0x20000u) /* Enforce hardwall cpuset memory allocs */ -+ -+/* This equals 0, but use constants in case they ever change */ -+#define GFP_NOWAIT (GFP_ATOMIC & ~__GFP_HIGH) -+/* GFP_ATOMIC means both !wait (__GFP_WAIT not set) and use emergency pool */ -+#define GFP_ATOMIC (__GFP_HIGH) -+#define GFP_NOIO (__GFP_WAIT) -+#define GFP_NOFS (__GFP_WAIT | __GFP_IO) -+#define GFP_KERNEL (__GFP_WAIT | __GFP_IO | __GFP_FS) -+#define GFP_USER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL) -+#define GFP_HIGHUSER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL | \ -+ __GFP_HIGHMEM) -+ -+ -+#endif // kenny add Linux compatibility code for Linux USB -+ -+__inline static _list *get_next(_list *list) -+{ -+ return list->next; -+} -+ -+__inline static _list *get_list_head(_queue *queue) -+{ -+ return (&(queue->queue)); -+} -+ -+ -+#define LIST_CONTAINOR(ptr, type, member) \ -+ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) -+ -+ -+__inline static void _enter_critical(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_irqsave(plock, *pirqL); -+} -+ -+__inline static void _exit_critical(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_irqrestore(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_irqsave(plock, *pirqL); -+} -+ -+__inline static void _exit_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_irqrestore(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_bh(plock, *pirqL); -+} -+ -+__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_bh(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+ -+ mtx_lock(pmutex); -+ -+} -+ -+ -+__inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+ -+ mtx_unlock(pmutex); -+ -+} -+static inline void __list_del(struct list_head * prev, struct list_head * next) -+{ -+ next->prev = prev; -+ prev->next = next; -+} -+static inline void INIT_LIST_HEAD(struct list_head *list) -+{ -+ list->next = list; -+ list->prev = list; -+} -+__inline static void rtw_list_delete(_list *plist) -+{ -+ __list_del(plist->prev, plist->next); -+ INIT_LIST_HEAD(plist); -+} -+ -+__inline static void _init_timer(_timer *ptimer,_nic_hdl padapter,void *pfunc,void* cntx) -+{ -+ ptimer->function = pfunc; -+ ptimer->arg = cntx; -+ callout_init(&ptimer->callout, CALLOUT_MPSAFE); -+} -+ -+__inline static void _set_timer(_timer *ptimer,u32 delay_time) -+{ -+ // mod_timer(ptimer , (jiffies+(delay_time*HZ/1000))); -+ if(ptimer->function && ptimer->arg){ -+ rtw_mtx_lock(NULL); -+ callout_reset(&ptimer->callout, delay_time,ptimer->function, ptimer->arg); -+ rtw_mtx_unlock(NULL); -+ } -+} -+ -+__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) -+{ -+ // del_timer_sync(ptimer); -+ // *bcancelled= _TRUE;//TRUE ==1; FALSE==0 -+ rtw_mtx_lock(NULL); -+ callout_drain(&ptimer->callout); -+ rtw_mtx_unlock(NULL); -+} -+ -+__inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) -+{ -+ printf("%s Not implement yet! \n",__FUNCTION__); -+} -+ -+__inline static void _set_workitem(_workitem *pwork) -+{ -+ printf("%s Not implement yet! \n",__FUNCTION__); -+// schedule_work(pwork); -+} -+ -+// -+// Global Mutex: can only be used at PASSIVE level. -+// -+ -+#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+} -+ -+#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+} -+ -+#define ATOMIC_INIT(i) { (i) } -+ -+static __inline void thread_enter(char *name); -+ -+//Atomic integer operations -+typedef uint32_t ATOMIC_T ; -+ -+#define rtw_netdev_priv(netdev) (((struct ifnet *)netdev)->if_softc) -+ -+#define rtw_free_netdev(netdev) if_free((netdev)) -+ -+#define NDEV_FMT "%s" -+#define NDEV_ARG(ndev) "" -+#define ADPT_FMT "%s" -+#define ADPT_ARG(adapter) "" -+#define FUNC_NDEV_FMT "%s" -+#define FUNC_NDEV_ARG(ndev) __func__ -+#define FUNC_ADPT_FMT "%s" -+#define FUNC_ADPT_ARG(adapter) __func__ -+ -+#define STRUCT_PACKED -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service_ce.h linux/3rdparty/rtl8812au/include/osdep_service_ce.h ---- linux.old/3rdparty/rtl8812au/include/osdep_service_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/osdep_service_ce.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,192 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __OSDEP_CE_SERVICE_H_ -+#define __OSDEP_CE_SERVICE_H_ -+ -+ -+#include -+#include -+ -+#ifdef CONFIG_SDIO_HCI -+#include "SDCardDDK.h" -+#endif -+ -+#ifdef CONFIG_USB_HCI -+#include -+#endif -+ -+typedef HANDLE _sema; -+typedef LIST_ENTRY _list; -+typedef NDIS_STATUS _OS_STATUS; -+ -+typedef NDIS_SPIN_LOCK _lock; -+ -+typedef HANDLE _rwlock; //Mutex -+ -+typedef u32 _irqL; -+ -+typedef NDIS_HANDLE _nic_hdl; -+ -+ -+typedef NDIS_MINIPORT_TIMER _timer; -+ -+struct __queue { -+ LIST_ENTRY queue; -+ _lock lock; -+}; -+ -+typedef NDIS_PACKET _pkt; -+typedef NDIS_BUFFER _buffer; -+typedef struct __queue _queue; -+ -+typedef HANDLE _thread_hdl_; -+typedef DWORD thread_return; -+typedef void* thread_context; -+typedef NDIS_WORK_ITEM _workitem; -+ -+#define thread_exit() ExitThread(STATUS_SUCCESS); return 0; -+ -+ -+#define SEMA_UPBND (0x7FFFFFFF) //8192 -+ -+__inline static _list *get_prev(_list *list) -+{ -+ return list->Blink; -+} -+ -+__inline static _list *get_next(_list *list) -+{ -+ return list->Flink; -+} -+ -+__inline static _list *get_list_head(_queue *queue) -+{ -+ return (&(queue->queue)); -+} -+ -+#define LIST_CONTAINOR(ptr, type, member) CONTAINING_RECORD(ptr, type, member) -+ -+__inline static void _enter_critical(_lock *plock, _irqL *pirqL) -+{ -+ NdisAcquireSpinLock(plock); -+} -+ -+__inline static void _exit_critical(_lock *plock, _irqL *pirqL) -+{ -+ NdisReleaseSpinLock(plock); -+} -+ -+__inline static _enter_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprAcquireSpinLock(plock); -+} -+ -+__inline static _exit_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprReleaseSpinLock(plock); -+} -+ -+ -+__inline static void _enter_hwio_critical(_rwlock *prwlock, _irqL *pirqL) -+{ -+ WaitForSingleObject(*prwlock, INFINITE ); -+ -+} -+ -+__inline static void _exit_hwio_critical(_rwlock *prwlock, _irqL *pirqL) -+{ -+ ReleaseMutex(*prwlock); -+} -+ -+__inline static void rtw_list_delete(_list *plist) -+{ -+ RemoveEntryList(plist); -+ InitializeListHead(plist); -+} -+ -+#define RTW_TIMER_HDL_ARGS IN PVOID SystemSpecific1, IN PVOID FunctionContext, IN PVOID SystemSpecific2, IN PVOID SystemSpecific3 -+ -+__inline static void _init_timer(_timer *ptimer,_nic_hdl nic_hdl,void *pfunc,PVOID cntx) -+{ -+ NdisMInitializeTimer(ptimer, nic_hdl, pfunc, cntx); -+} -+ -+__inline static void _set_timer(_timer *ptimer,u32 delay_time) -+{ -+ NdisMSetTimer(ptimer,delay_time); -+} -+ -+__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) -+{ -+ NdisMCancelTimer(ptimer,bcancelled); -+} -+ -+__inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) -+{ -+ -+ NdisInitializeWorkItem(pwork, pfunc, cntx); -+} -+ -+__inline static void _set_workitem(_workitem *pwork) -+{ -+ NdisScheduleWorkItem(pwork); -+} -+ -+#define ATOMIC_INIT(i) { (i) } -+ -+// -+// Global Mutex: can only be used at PASSIVE level. -+// -+ -+#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ while (NdisInterlockedIncrement((PULONG)&(_MutexCounter)) != 1)\ -+ { \ -+ NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ -+ NdisMSleep(10000); \ -+ } \ -+} -+ -+#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ -+} -+ -+// limitation of path length -+#define PATH_LENGTH_MAX MAX_PATH -+ -+//Atomic integer operations -+#define ATOMIC_T LONG -+ -+#define NDEV_FMT "%s" -+#define NDEV_ARG(ndev) "" -+#define ADPT_FMT "%s" -+#define ADPT_ARG(adapter) "" -+#define FUNC_NDEV_FMT "%s" -+#define FUNC_NDEV_ARG(ndev) __func__ -+#define FUNC_ADPT_FMT "%s" -+#define FUNC_ADPT_ARG(adapter) __func__ -+ -+#define STRUCT_PACKED -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/rtl8812au/include/osdep_service.h ---- linux.old/3rdparty/rtl8812au/include/osdep_service.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/osdep_service.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,627 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/osdep_service_bsd.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service_bsd.h +--- linux-4.14.17/3rdparty/rtl8812au/include/osdep_service_bsd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service_bsd.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,742 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -311366,10 +139429,935 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++#ifndef __OSDEP_BSD_SERVICE_H_ ++#define __OSDEP_BSD_SERVICE_H_ ++ ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++ ++#include ++#include ++#include ++#include ++#include ++ ++#include ++#include ++#include ++#include ++ ++#include ++#include ++#include "usbdevs.h" ++ ++#define USB_DEBUG_VAR rum_debug ++#include ++ ++#if 1 //Baron porting from linux, it's all temp solution, needs to check again ++#include ++#include /* XXX for PCPU_GET */ ++// typedef struct semaphore _sema; ++ typedef struct sema _sema; ++// typedef spinlock_t _lock; ++ typedef struct mtx _lock; ++ typedef struct mtx _mutex; ++ typedef struct timer_list _timer; ++ struct list_head { ++ struct list_head *next, *prev; ++ }; ++ struct __queue { ++ struct list_head queue; ++ _lock lock; ++ }; ++ ++ //typedef struct sk_buff _pkt; ++ typedef struct mbuf _pkt; ++ typedef struct mbuf _buffer; ++ ++ typedef struct __queue _queue; ++ typedef struct list_head _list; ++ typedef int _OS_STATUS; ++ //typedef u32 _irqL; ++ typedef unsigned long _irqL; ++ typedef struct ifnet * _nic_hdl; ++ ++ typedef pid_t _thread_hdl_; ++// typedef struct thread _thread_hdl_; ++ typedef void thread_return; ++ typedef void* thread_context; ++ ++ //#define thread_exit() complete_and_exit(NULL, 0) ++ ++ #define thread_exit() do{printf("%s", "RTKTHREAD_exit");}while(0) ++ ++ typedef void timer_hdl_return; ++ typedef void* timer_hdl_context; ++ typedef struct work_struct _workitem; ++ ++#define KERNEL_VERSION(a,b,c) (((a) << 16) + ((b) << 8) + (c)) ++/* emulate a modern version */ ++#define LINUX_VERSION_CODE KERNEL_VERSION(2, 6, 35) ++ ++#define WIRELESS_EXT -1 ++#define HZ hz ++#define spin_lock_irqsave mtx_lock_irqsave ++#define spin_lock_bh mtx_lock_irqsave ++#define mtx_lock_irqsave(lock, x) mtx_lock(lock)//{local_irq_save((x)); mtx_lock_spin((lock));} ++//#define IFT_RTW 0xf9 //ifnet allocate type for RTW ++#define free_netdev if_free ++#define LIST_CONTAINOR(ptr, type, member) \ ++ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) ++#define container_of(p,t,n) (t*)((p)-&(((t*)0)->n)) ++/* ++ * Linux timers are emulated using FreeBSD callout functions ++ * (and taskqueue functionality). + * ++ * Currently no timer stats functionality. ++ * ++ * See (linux_compat) processes.c ++ * ++ */ ++struct timer_list { ++ ++ /* FreeBSD callout related fields */ ++ struct callout callout; ++ ++ //timeout function ++ void (*function)(void*); ++ //argument ++ void *arg; ++ ++}; ++struct workqueue_struct; ++struct work_struct; ++typedef void (*work_func_t)(struct work_struct *work); ++/* Values for the state of an item of work (work_struct) */ ++typedef enum work_state { ++ WORK_STATE_UNSET = 0, ++ WORK_STATE_CALLOUT_PENDING = 1, ++ WORK_STATE_TASK_PENDING = 2, ++ WORK_STATE_WORK_CANCELLED = 3 ++} work_state_t; ++ ++struct work_struct { ++ struct task task; /* FreeBSD task */ ++ work_state_t state; /* the pending or otherwise state of work. */ ++ work_func_t func; ++}; ++#define spin_unlock_irqrestore mtx_unlock_irqrestore ++#define spin_unlock_bh mtx_unlock_irqrestore ++#define mtx_unlock_irqrestore(lock,x) mtx_unlock(lock); ++extern void _rtw_spinlock_init(_lock *plock); ++ ++//modify private structure to match freebsd ++#define BITS_PER_LONG 32 ++union ktime { ++ s64 tv64; ++#if BITS_PER_LONG != 64 && !defined(CONFIG_KTIME_SCALAR) ++ struct { ++#ifdef __BIG_ENDIAN ++ s32 sec, nsec; ++#else ++ s32 nsec, sec; ++#endif ++ } tv; ++#endif ++}; ++#define kmemcheck_bitfield_begin(name) ++#define kmemcheck_bitfield_end(name) ++#define CHECKSUM_NONE 0 ++typedef unsigned char *sk_buff_data_t; ++typedef union ktime ktime_t; /* Kill this */ ++ ++void rtw_mtx_lock(_lock *plock); ++ ++void rtw_mtx_unlock(_lock *plock); ++ ++/** ++ * struct sk_buff - socket buffer ++ * @next: Next buffer in list ++ * @prev: Previous buffer in list ++ * @sk: Socket we are owned by ++ * @tstamp: Time we arrived ++ * @dev: Device we arrived on/are leaving by ++ * @transport_header: Transport layer header ++ * @network_header: Network layer header ++ * @mac_header: Link layer header ++ * @_skb_refdst: destination entry (with norefcount bit) ++ * @sp: the security path, used for xfrm ++ * @cb: Control buffer. Free for use by every layer. Put private vars here ++ * @len: Length of actual data ++ * @data_len: Data length ++ * @mac_len: Length of link layer header ++ * @hdr_len: writable header length of cloned skb ++ * @csum: Checksum (must include start/offset pair) ++ * @csum_start: Offset from skb->head where checksumming should start ++ * @csum_offset: Offset from csum_start where checksum should be stored ++ * @local_df: allow local fragmentation ++ * @cloned: Head may be cloned (check refcnt to be sure) ++ * @nohdr: Payload reference only, must not modify header ++ * @pkt_type: Packet class ++ * @fclone: skbuff clone status ++ * @ip_summed: Driver fed us an IP checksum ++ * @priority: Packet queueing priority ++ * @users: User count - see {datagram,tcp}.c ++ * @protocol: Packet protocol from driver ++ * @truesize: Buffer size ++ * @head: Head of buffer ++ * @data: Data head pointer ++ * @tail: Tail pointer ++ * @end: End pointer ++ * @destructor: Destruct function ++ * @mark: Generic packet mark ++ * @nfct: Associated connection, if any ++ * @ipvs_property: skbuff is owned by ipvs ++ * @peeked: this packet has been seen already, so stats have been ++ * done for it, don't do them again ++ * @nf_trace: netfilter packet trace flag ++ * @nfctinfo: Relationship of this skb to the connection ++ * @nfct_reasm: netfilter conntrack re-assembly pointer ++ * @nf_bridge: Saved data about a bridged frame - see br_netfilter.c ++ * @skb_iif: ifindex of device we arrived on ++ * @rxhash: the packet hash computed on receive ++ * @queue_mapping: Queue mapping for multiqueue devices ++ * @tc_index: Traffic control index ++ * @tc_verd: traffic control verdict ++ * @ndisc_nodetype: router type (from link layer) ++ * @dma_cookie: a cookie to one of several possible DMA operations ++ * done by skb DMA functions ++ * @secmark: security marking ++ * @vlan_tci: vlan tag control information ++ */ ++ ++struct sk_buff { ++ /* These two members must be first. */ ++ struct sk_buff *next; ++ struct sk_buff *prev; ++ ++ ktime_t tstamp; ++ ++ struct sock *sk; ++ //struct net_device *dev; ++ struct ifnet *dev; ++ ++ /* ++ * This is the control buffer. It is free to use for every ++ * layer. Please put your private variables there. If you ++ * want to keep them across layers you have to do a skb_clone() ++ * first. This is owned by whoever has the skb queued ATM. ++ */ ++ char cb[48] __aligned(8); ++ ++ unsigned long _skb_refdst; ++#ifdef CONFIG_XFRM ++ struct sec_path *sp; ++#endif ++ unsigned int len, ++ data_len; ++ u16 mac_len, ++ hdr_len; ++ union { ++ u32 csum; ++ struct { ++ u16 csum_start; ++ u16 csum_offset; ++ }smbol2; ++ }smbol1; ++ u32 priority; ++ kmemcheck_bitfield_begin(flags1); ++ u8 local_df:1, ++ cloned:1, ++ ip_summed:2, ++ nohdr:1, ++ nfctinfo:3; ++ u8 pkt_type:3, ++ fclone:2, ++ ipvs_property:1, ++ peeked:1, ++ nf_trace:1; ++ kmemcheck_bitfield_end(flags1); ++ u16 protocol; ++ ++ void (*destructor)(struct sk_buff *skb); ++#if defined(CONFIG_NF_CONNTRACK) || defined(CONFIG_NF_CONNTRACK_MODULE) ++ struct nf_conntrack *nfct; ++ struct sk_buff *nfct_reasm; ++#endif ++#ifdef CONFIG_BRIDGE_NETFILTER ++ struct nf_bridge_info *nf_bridge; ++#endif ++ ++ int skb_iif; ++#ifdef CONFIG_NET_SCHED ++ u16 tc_index; /* traffic control index */ ++#ifdef CONFIG_NET_CLS_ACT ++ u16 tc_verd; /* traffic control verdict */ ++#endif ++#endif ++ ++ u32 rxhash; ++ ++ kmemcheck_bitfield_begin(flags2); ++ u16 queue_mapping:16; ++#ifdef CONFIG_IPV6_NDISC_NODETYPE ++ u8 ndisc_nodetype:2, ++ deliver_no_wcard:1; ++#else ++ u8 deliver_no_wcard:1; ++#endif ++ kmemcheck_bitfield_end(flags2); ++ ++ /* 0/14 bit hole */ ++ ++#ifdef CONFIG_NET_DMA ++ dma_cookie_t dma_cookie; ++#endif ++#ifdef CONFIG_NETWORK_SECMARK ++ u32 secmark; ++#endif ++ union { ++ u32 mark; ++ u32 dropcount; ++ }symbol3; ++ ++ u16 vlan_tci; ++ ++ sk_buff_data_t transport_header; ++ sk_buff_data_t network_header; ++ sk_buff_data_t mac_header; ++ /* These elements must be at the end, see alloc_skb() for details. */ ++ sk_buff_data_t tail; ++ sk_buff_data_t end; ++ unsigned char *head, ++ *data; ++ unsigned int truesize; ++ atomic_t users; ++}; ++struct sk_buff_head { ++ /* These two members must be first. */ ++ struct sk_buff *next; ++ struct sk_buff *prev; ++ ++ u32 qlen; ++ _lock lock; ++}; ++#define skb_tail_pointer(skb) skb->tail ++static inline unsigned char *skb_put(struct sk_buff *skb, unsigned int len) ++{ ++ unsigned char *tmp = skb_tail_pointer(skb); ++ //SKB_LINEAR_ASSERT(skb); ++ skb->tail += len; ++ skb->len += len; ++ return tmp; ++} ++ ++static inline unsigned char *__skb_pull(struct sk_buff *skb, unsigned int len) ++{ ++ skb->len -= len; ++ if(skb->len < skb->data_len) ++ printf("%s(),%d,error!\n",__FUNCTION__,__LINE__); ++ return skb->data += len; ++} ++static inline unsigned char *skb_pull(struct sk_buff *skb, unsigned int len) ++{ ++ return unlikely(len > skb->len) ? NULL : __skb_pull(skb, len); ++} ++static inline u32 skb_queue_len(const struct sk_buff_head *list_) ++{ ++ return list_->qlen; ++} ++static inline void __skb_insert(struct sk_buff *newsk, ++ struct sk_buff *prev, struct sk_buff *next, ++ struct sk_buff_head *list) ++{ ++ newsk->next = next; ++ newsk->prev = prev; ++ next->prev = prev->next = newsk; ++ list->qlen++; ++} ++static inline void __skb_queue_before(struct sk_buff_head *list, ++ struct sk_buff *next, ++ struct sk_buff *newsk) ++{ ++ __skb_insert(newsk, next->prev, next, list); ++} ++static inline void skb_queue_tail(struct sk_buff_head *list, ++ struct sk_buff *newsk) ++{ ++ mtx_lock(&list->lock); ++ __skb_queue_before(list, (struct sk_buff *)list, newsk); ++ mtx_unlock(&list->lock); ++} ++static inline struct sk_buff *skb_peek(struct sk_buff_head *list_) ++{ ++ struct sk_buff *list = ((struct sk_buff *)list_)->next; ++ if (list == (struct sk_buff *)list_) ++ list = NULL; ++ return list; ++} ++static inline void __skb_unlink(struct sk_buff *skb, struct sk_buff_head *list) ++{ ++ struct sk_buff *next, *prev; ++ ++ list->qlen--; ++ next = skb->next; ++ prev = skb->prev; ++ skb->next = skb->prev = NULL; ++ next->prev = prev; ++ prev->next = next; ++} ++ ++static inline struct sk_buff *skb_dequeue(struct sk_buff_head *list) ++{ ++ mtx_lock(&list->lock); ++ ++ struct sk_buff *skb = skb_peek(list); ++ if (skb) ++ __skb_unlink(skb, list); ++ ++ mtx_unlock(&list->lock); ++ ++ return skb; ++} ++static inline void skb_reserve(struct sk_buff *skb, int len) ++{ ++ skb->data += len; ++ skb->tail += len; ++} ++static inline void __skb_queue_head_init(struct sk_buff_head *list) ++{ ++ list->prev = list->next = (struct sk_buff *)list; ++ list->qlen = 0; ++} ++/* ++ * This function creates a split out lock class for each invocation; ++ * this is needed for now since a whole lot of users of the skb-queue ++ * infrastructure in drivers have different locking usage (in hardirq) ++ * than the networking core (in softirq only). In the long run either the ++ * network layer or drivers should need annotation to consolidate the ++ * main types of usage into 3 classes. ++ */ ++static inline void skb_queue_head_init(struct sk_buff_head *list) ++{ ++ _rtw_spinlock_init(&list->lock); ++ __skb_queue_head_init(list); ++} ++unsigned long copy_from_user(void *to, const void *from, unsigned long n); ++unsigned long copy_to_user(void *to, const void *from, unsigned long n); ++struct sk_buff * dev_alloc_skb(unsigned int size); ++struct sk_buff *skb_clone(const struct sk_buff *skb); ++void dev_kfree_skb_any(struct sk_buff *skb); ++#endif //Baron porting from linux, it's all temp solution, needs to check again ++ ++ ++#if 1 // kenny add Linux compatibility code for Linux USB driver ++#include ++ ++#define __init // __attribute ((constructor)) ++#define __exit // __attribute ((destructor)) ++ ++/* ++ * Definitions for module_init and module_exit macros. ++ * ++ * These macros will use the SYSINIT framework to call a specified ++ * function (with no arguments) on module loading or unloading. ++ * ++ */ ++ ++void module_init_exit_wrapper(void *arg); ++ ++#define module_init(initfn) \ ++ SYSINIT(mod_init_ ## initfn, \ ++ SI_SUB_KLD, SI_ORDER_FIRST, \ ++ module_init_exit_wrapper, initfn) ++ ++#define module_exit(exitfn) \ ++ SYSUNINIT(mod_exit_ ## exitfn, \ ++ SI_SUB_KLD, SI_ORDER_ANY, \ ++ module_init_exit_wrapper, exitfn) ++ ++/* ++ * The usb_register and usb_deregister functions are used to register ++ * usb drivers with the usb subsystem. ++ */ ++int usb_register(struct usb_driver *driver); ++int usb_deregister(struct usb_driver *driver); ++ ++/* ++ * usb_get_dev and usb_put_dev - increment/decrement the reference count ++ * of the usb device structure. ++ * ++ * Original body of usb_get_dev: ++ * ++ * if (dev) ++ * get_device(&dev->dev); ++ * return dev; ++ * ++ * Reference counts are not currently used in this compatibility ++ * layer. So these functions will do nothing. ++ */ ++static inline struct usb_device * ++usb_get_dev(struct usb_device *dev) ++{ ++ return dev; ++} ++ ++static inline void ++usb_put_dev(struct usb_device *dev) ++{ ++ return; ++} ++ ++ ++// rtw_usb_compat_linux ++int rtw_usb_submit_urb(struct urb *urb, uint16_t mem_flags); ++int rtw_usb_unlink_urb(struct urb *urb); ++int rtw_usb_clear_halt(struct usb_device *dev, struct usb_host_endpoint *uhe); ++int rtw_usb_control_msg(struct usb_device *dev, struct usb_host_endpoint *uhe, ++ uint8_t request, uint8_t requesttype, ++ uint16_t value, uint16_t index, void *data, ++ uint16_t size, usb_timeout_t timeout); ++int rtw_usb_set_interface(struct usb_device *dev, uint8_t iface_no, uint8_t alt_index); ++int rtw_usb_setup_endpoint(struct usb_device *dev, ++ struct usb_host_endpoint *uhe, usb_size_t bufsize); ++struct urb *rtw_usb_alloc_urb(uint16_t iso_packets, uint16_t mem_flags); ++struct usb_host_endpoint *rtw_usb_find_host_endpoint(struct usb_device *dev, uint8_t type, uint8_t ep); ++struct usb_host_interface *rtw_usb_altnum_to_altsetting(const struct usb_interface *intf, uint8_t alt_index); ++struct usb_interface *rtw_usb_ifnum_to_if(struct usb_device *dev, uint8_t iface_no); ++void *rtw_usb_buffer_alloc(struct usb_device *dev, usb_size_t size, uint8_t *dma_addr); ++void *rtw_usbd_get_intfdata(struct usb_interface *intf); ++void rtw_usb_linux_register(void *arg); ++void rtw_usb_linux_deregister(void *arg); ++void rtw_usb_linux_free_device(struct usb_device *dev); ++void rtw_usb_buffer_free(struct usb_device *dev, usb_size_t size, ++ void *addr, uint8_t dma_addr); ++void rtw_usb_free_urb(struct urb *urb); ++void rtw_usb_init_urb(struct urb *urb); ++void rtw_usb_kill_urb(struct urb *urb); ++void rtw_usb_set_intfdata(struct usb_interface *intf, void *data); ++void rtw_usb_fill_bulk_urb(struct urb *urb, struct usb_device *udev, ++ struct usb_host_endpoint *uhe, void *buf, ++ int length, usb_complete_t callback, void *arg); ++int rtw_usb_bulk_msg(struct usb_device *udev, struct usb_host_endpoint *uhe, ++ void *data, int len, uint16_t *pactlen, usb_timeout_t timeout); ++void *usb_get_intfdata(struct usb_interface *intf); ++int usb_linux_init_endpoints(struct usb_device *udev); ++ ++ ++ ++typedef struct urb * PURB; ++ ++typedef unsigned gfp_t; ++#define __GFP_WAIT ((gfp_t)0x10u) /* Can wait and reschedule? */ ++#define __GFP_HIGH ((gfp_t)0x20u) /* Should access emergency pools? */ ++#define __GFP_IO ((gfp_t)0x40u) /* Can start physical IO? */ ++#define __GFP_FS ((gfp_t)0x80u) /* Can call down to low-level FS? */ ++#define __GFP_COLD ((gfp_t)0x100u) /* Cache-cold page required */ ++#define __GFP_NOWARN ((gfp_t)0x200u) /* Suppress page allocation failure warning */ ++#define __GFP_REPEAT ((gfp_t)0x400u) /* Retry the allocation. Might fail */ ++#define __GFP_NOFAIL ((gfp_t)0x800u) /* Retry for ever. Cannot fail */ ++#define __GFP_NORETRY ((gfp_t)0x1000u)/* Do not retry. Might fail */ ++#define __GFP_NO_GROW ((gfp_t)0x2000u)/* Slab internal usage */ ++#define __GFP_COMP ((gfp_t)0x4000u)/* Add compound page metadata */ ++#define __GFP_ZERO ((gfp_t)0x8000u)/* Return zeroed page on success */ ++#define __GFP_NOMEMALLOC ((gfp_t)0x10000u) /* Don't use emergency reserves */ ++#define __GFP_HARDWALL ((gfp_t)0x20000u) /* Enforce hardwall cpuset memory allocs */ ++ ++/* This equals 0, but use constants in case they ever change */ ++#define GFP_NOWAIT (GFP_ATOMIC & ~__GFP_HIGH) ++/* GFP_ATOMIC means both !wait (__GFP_WAIT not set) and use emergency pool */ ++#define GFP_ATOMIC (__GFP_HIGH) ++#define GFP_NOIO (__GFP_WAIT) ++#define GFP_NOFS (__GFP_WAIT | __GFP_IO) ++#define GFP_KERNEL (__GFP_WAIT | __GFP_IO | __GFP_FS) ++#define GFP_USER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL) ++#define GFP_HIGHUSER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL | \ ++ __GFP_HIGHMEM) ++ ++ ++#endif // kenny add Linux compatibility code for Linux USB ++ ++__inline static _list *get_next(_list *list) ++{ ++ return list->next; ++} ++ ++__inline static _list *get_list_head(_queue *queue) ++{ ++ return (&(queue->queue)); ++} ++ ++ ++#define LIST_CONTAINOR(ptr, type, member) \ ++ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) ++ ++ ++__inline static void _enter_critical(_lock *plock, _irqL *pirqL) ++{ ++ spin_lock_irqsave(plock, *pirqL); ++} ++ ++__inline static void _exit_critical(_lock *plock, _irqL *pirqL) ++{ ++ spin_unlock_irqrestore(plock, *pirqL); ++} ++ ++__inline static void _enter_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ spin_lock_irqsave(plock, *pirqL); ++} ++ ++__inline static void _exit_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ spin_unlock_irqrestore(plock, *pirqL); ++} ++ ++__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) ++{ ++ spin_lock_bh(plock, *pirqL); ++} ++ ++__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) ++{ ++ spin_unlock_bh(plock, *pirqL); ++} ++ ++__inline static void _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) ++{ ++ ++ mtx_lock(pmutex); ++ ++} ++ ++ ++__inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) ++{ ++ ++ mtx_unlock(pmutex); ++ ++} ++static inline void __list_del(struct list_head * prev, struct list_head * next) ++{ ++ next->prev = prev; ++ prev->next = next; ++} ++static inline void INIT_LIST_HEAD(struct list_head *list) ++{ ++ list->next = list; ++ list->prev = list; ++} ++__inline static void rtw_list_delete(_list *plist) ++{ ++ __list_del(plist->prev, plist->next); ++ INIT_LIST_HEAD(plist); ++} ++ ++__inline static void _init_timer(_timer *ptimer,_nic_hdl padapter,void *pfunc,void* cntx) ++{ ++ ptimer->function = pfunc; ++ ptimer->arg = cntx; ++ callout_init(&ptimer->callout, CALLOUT_MPSAFE); ++} ++ ++__inline static void _set_timer(_timer *ptimer,u32 delay_time) ++{ ++ // mod_timer(ptimer , (jiffies+(delay_time*HZ/1000))); ++ if(ptimer->function && ptimer->arg){ ++ rtw_mtx_lock(NULL); ++ callout_reset(&ptimer->callout, delay_time,ptimer->function, ptimer->arg); ++ rtw_mtx_unlock(NULL); ++ } ++} ++ ++__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) ++{ ++ // del_timer_sync(ptimer); ++ // *bcancelled= true;//TRUE ==1; FALSE==0 ++ rtw_mtx_lock(NULL); ++ callout_drain(&ptimer->callout); ++ rtw_mtx_unlock(NULL); ++} ++ ++__inline static void _init_workitem(_workitem *pwork, void *pfunc, void * cntx) ++{ ++ printf("%s Not implement yet! \n",__FUNCTION__); ++} ++ ++__inline static void _set_workitem(_workitem *pwork) ++{ ++ printf("%s Not implement yet! \n",__FUNCTION__); ++// schedule_work(pwork); ++} ++ ++// ++// Global Mutex: can only be used at PASSIVE level. ++// ++ ++#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ ++{ \ ++} ++ ++#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ ++{ \ ++} ++ ++#define ATOMIC_INIT(i) { (i) } ++ ++static __inline void thread_enter(char *name); ++ ++//Atomic integer operations ++typedef uint32_t ATOMIC_T ; ++ ++#define rtw_netdev_priv(netdev) (((struct ifnet *)netdev)->if_softc) ++ ++#define rtw_free_netdev(netdev) if_free((netdev)) ++ ++#define NDEV_FMT "%s" ++#define NDEV_ARG(ndev) "" ++#define ADPT_FMT "%s" ++#define ADPT_ARG(adapter) "" ++#define FUNC_NDEV_FMT "%s" ++#define FUNC_NDEV_ARG(ndev) __func__ ++#define FUNC_ADPT_FMT "%s" ++#define FUNC_ADPT_ARG(adapter) __func__ ++ ++#define STRUCT_PACKED ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/osdep_service_ce.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service_ce.h +--- linux-4.14.17/3rdparty/rtl8812au/include/osdep_service_ce.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service_ce.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,180 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++ ++#ifndef __OSDEP_CE_SERVICE_H_ ++#define __OSDEP_CE_SERVICE_H_ ++ ++ ++#include ++#include ++ ++#include ++ ++typedef HANDLE _sema; ++typedef LIST_ENTRY _list; ++typedef uint _OS_STATUS; ++ ++typedef NDIS_SPIN_LOCK _lock; ++ ++typedef HANDLE _rwlock; //Mutex ++ ++typedef u32 _irqL; ++ ++typedef NDIS_HANDLE _nic_hdl; ++ ++ ++typedef NDIS_MINIPORT_TIMER _timer; ++ ++struct __queue { ++ LIST_ENTRY queue; ++ _lock lock; ++}; ++ ++typedef NDIS_PACKET _pkt; ++typedef NDIS_BUFFER _buffer; ++typedef struct __queue _queue; ++ ++typedef HANDLE _thread_hdl_; ++typedef DWORD thread_return; ++typedef void* thread_context; ++typedef NDIS_WORK_ITEM _workitem; ++ ++#define thread_exit() ExitThread(STATUS_SUCCESS); return 0; ++ ++ ++#define SEMA_UPBND (0x7FFFFFFF) //8192 ++ ++__inline static _list *get_prev(_list *list) ++{ ++ return list->Blink; ++} ++ ++__inline static _list *get_next(_list *list) ++{ ++ return list->Flink; ++} ++ ++__inline static _list *get_list_head(_queue *queue) ++{ ++ return (&(queue->queue)); ++} ++ ++#define LIST_CONTAINOR(ptr, type, member) CONTAINING_RECORD(ptr, type, member) ++ ++__inline static void _enter_critical(_lock *plock, _irqL *pirqL) ++{ ++ NdisAcquireSpinLock(plock); ++} ++ ++__inline static void _exit_critical(_lock *plock, _irqL *pirqL) ++{ ++ NdisReleaseSpinLock(plock); ++} ++ ++__inline static _enter_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ NdisDprAcquireSpinLock(plock); ++} ++ ++__inline static _exit_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ NdisDprReleaseSpinLock(plock); ++} ++ ++ ++__inline static void _enter_hwio_critical(_rwlock *prwlock, _irqL *pirqL) ++{ ++ WaitForSingleObject(*prwlock, INFINITE ); ++ ++} ++ ++__inline static void _exit_hwio_critical(_rwlock *prwlock, _irqL *pirqL) ++{ ++ ReleaseMutex(*prwlock); ++} ++ ++__inline static void rtw_list_delete(_list *plist) ++{ ++ RemoveEntryList(plist); ++ InitializeListHead(plist); ++} ++ ++#define RTW_TIMER_HDL_ARGS IN void * SystemSpecific1, void * FunctionContext, void * SystemSpecific2, void * SystemSpecific3 ++ ++__inline static void _init_timer(_timer *ptimer,_nic_hdl nic_hdl,void *pfunc,void * cntx) ++{ ++ NdisMInitializeTimer(ptimer, nic_hdl, pfunc, cntx); ++} ++ ++__inline static void _set_timer(_timer *ptimer,u32 delay_time) ++{ ++ NdisMSetTimer(ptimer,delay_time); ++} ++ ++__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) ++{ ++ NdisMCancelTimer(ptimer,bcancelled); ++} ++ ++__inline static void _init_workitem(_workitem *pwork, void *pfunc, void * cntx) ++{ ++ ++ NdisInitializeWorkItem(pwork, pfunc, cntx); ++} ++ ++__inline static void _set_workitem(_workitem *pwork) ++{ ++ NdisScheduleWorkItem(pwork); ++} ++ ++#define ATOMIC_INIT(i) { (i) } ++ ++// ++// Global Mutex: can only be used at PASSIVE level. ++// ++ ++#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ ++{ \ ++ while (NdisInterlockedIncrement((Pu32)&(_MutexCounter)) != 1)\ ++ { \ ++ NdisInterlockedDecrement((Pu32)&(_MutexCounter)); \ ++ NdisMSleep(10000); \ ++ } \ ++} ++ ++#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ ++{ \ ++ NdisInterlockedDecrement((Pu32)&(_MutexCounter)); \ ++} ++ ++// limitation of path length ++#define PATH_LENGTH_MAX MAX_PATH ++ ++//Atomic integer operations ++#define ATOMIC_T LONG ++ ++#define NDEV_FMT "%s" ++#define NDEV_ARG(ndev) "" ++#define ADPT_FMT "%s" ++#define ADPT_ARG(adapter) "" ++#define FUNC_NDEV_FMT "%s" ++#define FUNC_NDEV_ARG(ndev) __func__ ++#define FUNC_ADPT_FMT "%s" ++#define FUNC_ADPT_ARG(adapter) __func__ ++ ++#define STRUCT_PACKED ++ ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/osdep_service.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service.h +--- linux-4.14.17/3rdparty/rtl8812au/include/osdep_service.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,434 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#ifndef __OSDEP_SERVICE_H_ @@ -311381,27 +140369,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r +#define RTW_RX_HANDLED 2 +//#define RTW_STATUS_TIMEDOUT -110 + -+#undef _TRUE -+#define _TRUE 1 ++#undef true ++#define true 1 + -+#undef _FALSE -+#define _FALSE 0 ++#undef false ++#define false 0 + -+ -+#ifdef PLATFORM_FREEBSD -+#include -+#endif -+ -+#ifdef PLATFORM_LINUX +#include -+#endif -+ -+#ifdef PLATFORM_OS_XP -+#include -+#endif -+ -+#ifdef PLATFORM_OS_CE -+#include ++#include ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 11, 0) ++#include +#endif + +#define RTW_TIMER_HDL_NAME(name) rtw_##name##_timer_hdl @@ -311453,165 +140430,73 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r + +extern int RTW_STATUS_CODE(int error_code); + -+#ifndef RTK_DMP_PLATFORM +#define CONFIG_USE_VMALLOC -+#endif + -+/* flags used for rtw_mstat_update() */ -+enum mstat_f { -+ /* type: 0x00ff */ -+ MSTAT_TYPE_VIR = 0x00, -+ MSTAT_TYPE_PHY= 0x01, -+ MSTAT_TYPE_SKB = 0x02, -+ MSTAT_TYPE_USB = 0x03, -+ MSTAT_TYPE_MAX = 0x04, -+ -+ /* func: 0xff00 */ -+ MSTAT_FUNC_UNSPECIFIED = 0x00<<8, -+ MSTAT_FUNC_IO = 0x01<<8, -+ MSTAT_FUNC_TX_IO = 0x02<<8, -+ MSTAT_FUNC_RX_IO = 0x03<<8, -+ MSTAT_FUNC_TX = 0x04<<8, -+ MSTAT_FUNC_RX = 0x05<<8, -+ MSTAT_FUNC_CFG_VENDOR = 0x06<<8, -+ MSTAT_FUNC_MAX = 0x07<<8, ++//flags used for rtw_update_mem_stat() ++enum { ++ MEM_STAT_VIR_ALLOC_SUCCESS, ++ MEM_STAT_VIR_ALLOC_FAIL, ++ MEM_STAT_VIR_FREE, ++ MEM_STAT_PHY_ALLOC_SUCCESS, ++ MEM_STAT_PHY_ALLOC_FAIL, ++ MEM_STAT_PHY_FREE, ++ MEM_STAT_TX, //used to distinguish TX/RX, asigned from caller ++ MEM_STAT_TX_ALLOC_SUCCESS, ++ MEM_STAT_TX_ALLOC_FAIL, ++ MEM_STAT_TX_FREE, ++ MEM_STAT_RX, //used to distinguish TX/RX, asigned from caller ++ MEM_STAT_RX_ALLOC_SUCCESS, ++ MEM_STAT_RX_ALLOC_FAIL, ++ MEM_STAT_RX_FREE +}; + -+#define mstat_tf_idx(flags) ((flags)&0xff) -+#define mstat_ff_idx(flags) (((flags)&0xff00) >> 8) -+ -+typedef enum mstat_status{ -+ MSTAT_ALLOC_SUCCESS = 0, -+ MSTAT_ALLOC_FAIL, -+ MSTAT_FREE -+} MSTAT_STATUS; -+ +#ifdef DBG_MEM_ALLOC -+void rtw_mstat_update(const enum mstat_f flags, const MSTAT_STATUS status, u32 sz); -+void rtw_mstat_dump (void *sel); -+u8* dbg_rtw_vmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -+u8* dbg_rtw_zvmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -+void dbg_rtw_vmfree(u8 *pbuf, const enum mstat_f flags, u32 sz, const char *func, const int line); -+u8* dbg_rtw_malloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -+u8* dbg_rtw_zmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -+void dbg_rtw_mfree(u8 *pbuf, const enum mstat_f flags, u32 sz, const char *func, const int line); -+ -+struct sk_buff * dbg_rtw_skb_alloc(unsigned int size, const enum mstat_f flags, const char *func, const int line); -+void dbg_rtw_skb_free(struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line); -+struct sk_buff *dbg_rtw_skb_copy(const struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line); -+struct sk_buff *dbg_rtw_skb_clone(struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line); -+int dbg_rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line); -+void dbg_rtw_skb_queue_purge(struct sk_buff_head *list, enum mstat_f flags, const char *func, int line); -+#ifdef CONFIG_USB_HCI -+void *dbg_rtw_usb_buffer_alloc(struct usb_device *dev, size_t size, dma_addr_t *dma, const enum mstat_f flags, const char *func, const int line); -+void dbg_rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dma_addr_t dma, const enum mstat_f flags, const char *func, const int line); -+#endif /* CONFIG_USB_HCI */ -+ ++void rtw_update_mem_stat(u8 flag, u32 sz); ++void rtw_dump_mem_stat (void); ++extern u8* dbg_rtw_vmalloc(u32 sz, const char *func, int line); ++extern u8* dbg_rtw_zvmalloc(u32 sz, const char *func, int line); ++extern void dbg_rtw_vmfree(u8 *pbuf, u32 sz, const char *func, int line); ++extern u8* dbg_rtw_malloc(u32 sz, const char *func, int line); ++extern u8* dbg_rtw_zmalloc(u32 sz, const char *func, int line); ++extern void dbg_rtw_mfree(u8 *pbuf, u32 sz, const char *func, int line); +#ifdef CONFIG_USE_VMALLOC -+#define rtw_vmalloc(sz) dbg_rtw_vmalloc((sz), MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) -+#define rtw_zvmalloc(sz) dbg_rtw_zvmalloc((sz), MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) -+#define rtw_vmfree(pbuf, sz) dbg_rtw_vmfree((pbuf), (sz), MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) -+#define rtw_vmalloc_f(sz, mstat_f) dbg_rtw_vmalloc((sz), ((mstat_f)&0xff00)|MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) -+#define rtw_zvmalloc_f(sz, mstat_f) dbg_rtw_zvmalloc((sz), ((mstat_f)&0xff00)|MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) -+#define rtw_vmfree_f(pbuf, sz, mstat_f) dbg_rtw_vmfree((pbuf), (sz), ((mstat_f)&0xff00)|MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) -+#else /* CONFIG_USE_VMALLOC */ -+#define rtw_vmalloc(sz) dbg_rtw_malloc((sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_zvmalloc(sz) dbg_rtw_zmalloc((sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_vmfree(pbuf, sz) dbg_rtw_mfree((pbuf), (sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_vmalloc_f(sz, mstat_f) dbg_rtw_malloc((sz), ((mstat_f)&0xff00)|MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_zvmalloc_f(sz, mstat_f) dbg_rtw_zmalloc((sz), ((mstat_f)&0xff00)|MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_vmfree_f(pbuf, sz, mstat_f) dbg_rtw_mfree((pbuf), (sz), ((mstat_f)&0xff00)|MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#endif /* CONFIG_USE_VMALLOC */ -+#define rtw_malloc(sz) dbg_rtw_malloc((sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_zmalloc(sz) dbg_rtw_zmalloc((sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_mfree(pbuf, sz) dbg_rtw_mfree((pbuf), (sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_malloc_f(sz, mstat_f) dbg_rtw_malloc((sz), ((mstat_f)&0xff00)|MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_zmalloc_f(sz, mstat_f) dbg_rtw_zmalloc((sz), ((mstat_f)&0xff00)|MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_mfree_f(pbuf, sz, mstat_f) dbg_rtw_mfree((pbuf), (sz), ((mstat_f)&0xff00)|MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+ -+#define rtw_skb_alloc(size) dbg_rtw_skb_alloc((size), MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_free(skb) dbg_rtw_skb_free((skb), MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_alloc_f(size, mstat_f) dbg_rtw_skb_alloc((size), ((mstat_f)&0xff00)|MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_free_f(skb, mstat_f) dbg_rtw_skb_free((skb), ((mstat_f)&0xff00)|MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_copy(skb) dbg_rtw_skb_copy((skb), MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_clone(skb) dbg_rtw_skb_clone((skb), MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_copy_f(skb, mstat_f) dbg_rtw_skb_copy((skb), ((mstat_f)&0xff00)|MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_clone_f(skb, mstat_f) dbg_rtw_skb_clone((skb), ((mstat_f)&0xff00)|MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_netif_rx(ndev, skb) dbg_rtw_netif_rx(ndev, skb, MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_queue_purge(sk_buff_head) dbg_rtw_skb_queue_purge(sk_buff_head, MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#ifdef CONFIG_USB_HCI -+#define rtw_usb_buffer_alloc(dev, size, dma) dbg_rtw_usb_buffer_alloc((dev), (size), (dma), MSTAT_TYPE_USB, __FUNCTION__, __LINE__) -+#define rtw_usb_buffer_free(dev, size, addr, dma) dbg_rtw_usb_buffer_free((dev), (size), (addr), (dma), MSTAT_TYPE_USB, __FUNCTION__, __LINE__) -+#define rtw_usb_buffer_alloc_f(dev, size, dma, mstat_f) dbg_rtw_usb_buffer_alloc((dev), (size), (dma), ((mstat_f)&0xff00)|MSTAT_TYPE_USB, __FUNCTION__, __LINE__) -+#define rtw_usb_buffer_free_f(dev, size, addr, dma, mstat_f) dbg_rtw_usb_buffer_free((dev), (size), (addr), (dma), ((mstat_f)&0xff00)|MSTAT_TYPE_USB, __FUNCTION__, __LINE__) -+#endif /* CONFIG_USB_HCI */ -+ -+#else /* DBG_MEM_ALLOC */ -+#define rtw_mstat_update(flag, status, sz) do {} while(0) -+#define rtw_mstat_dump(sel) do {} while(0) -+u8* _rtw_vmalloc(u32 sz); -+u8* _rtw_zvmalloc(u32 sz); -+void _rtw_vmfree(u8 *pbuf, u32 sz); -+u8* _rtw_zmalloc(u32 sz); -+u8* _rtw_malloc(u32 sz); -+void _rtw_mfree(u8 *pbuf, u32 sz); -+ -+struct sk_buff *_rtw_skb_alloc(u32 sz); -+void _rtw_skb_free(struct sk_buff *skb); -+struct sk_buff *_rtw_skb_copy(const struct sk_buff *skb); -+struct sk_buff *_rtw_skb_clone(struct sk_buff *skb); -+int _rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb); -+void _rtw_skb_queue_purge(struct sk_buff_head *list); -+ -+#ifdef CONFIG_USB_HCI -+void *_rtw_usb_buffer_alloc(struct usb_device *dev, size_t size, dma_addr_t *dma); -+void _rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dma_addr_t dma); -+#endif /* CONFIG_USB_HCI */ -+ ++#define rtw_vmalloc(sz) dbg_rtw_vmalloc((sz), __FUNCTION__, __LINE__) ++#define rtw_zvmalloc(sz) dbg_rtw_zvmalloc((sz), __FUNCTION__, __LINE__) ++#define rtw_vmfree(pbuf, sz) dbg_rtw_vmfree((pbuf), (sz), __FUNCTION__, __LINE__) ++#else //CONFIG_USE_VMALLOC ++#define rtw_vmalloc(sz) dbg_rtw_malloc((sz), __FUNCTION__, __LINE__) ++#define rtw_zvmalloc(sz) dbg_rtw_zmalloc((sz), __FUNCTION__, __LINE__) ++#define rtw_vmfree(pbuf, sz) dbg_rtw_mfree((pbuf), (sz), __FUNCTION__, __LINE__) ++#endif //CONFIG_USE_VMALLOC ++#define rtw_malloc(sz) dbg_rtw_malloc((sz), __FUNCTION__, __LINE__) ++#define rtw_zmalloc(sz) dbg_rtw_zmalloc((sz), __FUNCTION__, __LINE__) ++#define rtw_mfree(pbuf, sz) dbg_rtw_mfree((pbuf), (sz), __FUNCTION__, __LINE__) ++#else ++#define rtw_update_mem_stat(flag, sz) do {} while(0) ++extern u8* _rtw_vmalloc(u32 sz); ++extern u8* _rtw_zvmalloc(u32 sz); ++extern void _rtw_vmfree(u8 *pbuf, u32 sz); ++extern u8* _rtw_zmalloc(u32 sz); ++extern u8* _rtw_malloc(u32 sz); ++extern void _rtw_mfree(u8 *pbuf, u32 sz); +#ifdef CONFIG_USE_VMALLOC +#define rtw_vmalloc(sz) _rtw_vmalloc((sz)) +#define rtw_zvmalloc(sz) _rtw_zvmalloc((sz)) +#define rtw_vmfree(pbuf, sz) _rtw_vmfree((pbuf), (sz)) -+#define rtw_vmalloc_f(sz, mstat_f) _rtw_vmalloc((sz)) -+#define rtw_zvmalloc_f(sz, mstat_f) _rtw_zvmalloc((sz)) -+#define rtw_vmfree_f(pbuf, sz, mstat_f) _rtw_vmfree((pbuf), (sz)) -+#else /* CONFIG_USE_VMALLOC */ ++#else //CONFIG_USE_VMALLOC +#define rtw_vmalloc(sz) _rtw_malloc((sz)) +#define rtw_zvmalloc(sz) _rtw_zmalloc((sz)) +#define rtw_vmfree(pbuf, sz) _rtw_mfree((pbuf), (sz)) -+#define rtw_vmalloc_f(sz, mstat_f) _rtw_malloc((sz)) -+#define rtw_zvmalloc_f(sz, mstat_f) _rtw_zmalloc((sz)) -+#define rtw_vmfree_f(pbuf, sz, mstat_f) _rtw_mfree((pbuf), (sz)) -+#endif /* CONFIG_USE_VMALLOC */ ++#endif //CONFIG_USE_VMALLOC +#define rtw_malloc(sz) _rtw_malloc((sz)) +#define rtw_zmalloc(sz) _rtw_zmalloc((sz)) +#define rtw_mfree(pbuf, sz) _rtw_mfree((pbuf), (sz)) -+#define rtw_malloc_f(sz, mstat_f) _rtw_malloc((sz)) -+#define rtw_zmalloc_f(sz, mstat_f) _rtw_zmalloc((sz)) -+#define rtw_mfree_f(pbuf, sz, mstat_f) _rtw_mfree((pbuf), (sz)) ++#endif + -+#define rtw_skb_alloc(size) _rtw_skb_alloc((size)) -+#define rtw_skb_free(skb) _rtw_skb_free((skb)) -+#define rtw_skb_alloc_f(size, mstat_f) _rtw_skb_alloc((size)) -+#define rtw_skb_free_f(skb, mstat_f) _rtw_skb_free((skb)) -+#define rtw_skb_copy(skb) _rtw_skb_copy((skb)) -+#define rtw_skb_clone(skb) _rtw_skb_clone((skb)) -+#define rtw_skb_copy_f(skb, mstat_f) _rtw_skb_copy((skb)) -+#define rtw_skb_clone_f(skb, mstat_f) _rtw_skb_clone((skb)) -+#define rtw_netif_rx(ndev, skb) _rtw_netif_rx(ndev, skb) -+#define rtw_skb_queue_purge(sk_buff_head) _rtw_skb_queue_purge(sk_buff_head) -+#ifdef CONFIG_USB_HCI -+#define rtw_usb_buffer_alloc(dev, size, dma) _rtw_usb_buffer_alloc((dev), (size), (dma)) -+#define rtw_usb_buffer_free(dev, size, addr, dma) _rtw_usb_buffer_free((dev), (size), (addr), (dma)) -+#define rtw_usb_buffer_alloc_f(dev, size, dma, mstat_f) _rtw_usb_buffer_alloc((dev), (size), (dma)) -+#define rtw_usb_buffer_free_f(dev, size, addr, dma, mstat_f) _rtw_usb_buffer_free((dev), (size), (addr), (dma)) -+#endif /* CONFIG_USB_HCI */ -+#endif /* DBG_MEM_ALLOC */ -+ -+extern void* rtw_malloc2d(int h, int w, size_t size); ++extern void* rtw_malloc2d(int h, int w, int size); +extern void rtw_mfree2d(void *pbuf, int h, int w, int size); + -+extern void _rtw_memcpy(void *dec, const void *sour, u32 sz); ++extern void _rtw_memcpy(void* dec, void* sour, u32 sz); +extern int _rtw_memcmp(void *dst, void *src, u32 sz); +extern void _rtw_memset(void *pbuf, int c, u32 sz); + @@ -311619,9 +140504,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r +extern u32 rtw_is_list_empty(_list *phead); +extern void rtw_list_insert_head(_list *plist, _list *phead); +extern void rtw_list_insert_tail(_list *plist, _list *phead); -+#ifndef PLATFORM_FREEBSD +extern void rtw_list_delete(_list *plist); -+#endif //PLATFORM_FREEBSD + +extern void _rtw_init_sema(_sema *sema, int init_val); +extern void _rtw_free_sema(_sema *sema); @@ -311629,9 +140512,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r +extern u32 _rtw_down_sema(_sema *sema); +extern void _rtw_mutex_init(_mutex *pmutex); +extern void _rtw_mutex_free(_mutex *pmutex); -+#ifndef PLATFORM_FREEBSD +extern void _rtw_spinlock_init(_lock *plock); -+#endif //PLATFORM_FREEBSD +extern void _rtw_spinlock_free(_lock *plock); +extern void _rtw_spinlock(_lock *plock); +extern void _rtw_spinunlock(_lock *plock); @@ -311653,7 +140534,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r +extern void rtw_msleep_os(int ms); +extern void rtw_usleep_os(int us); + -+extern u32 rtw_atoi(u8* s); ++extern u32 rtw_atoi(u8* s); + +#ifdef DBG_DELAY_OS +#define rtw_mdelay_os(ms) _rtw_mdelay_os((ms), __FUNCTION__, __LINE__) @@ -311668,98 +140549,46 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r +extern void rtw_yield_os(void); + + ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) +extern void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc); -+ ++#endif + +__inline static unsigned char _cancel_timer_ex(_timer *ptimer) +{ -+#ifdef PLATFORM_LINUX + return del_timer_sync(ptimer); -+#endif -+#ifdef PLATFORM_FREEBSD -+ _cancel_timer(ptimer,0); -+ return 0; -+#endif -+#ifdef PLATFORM_WINDOWS -+ u8 bcancelled; -+ -+ _cancel_timer(ptimer, &bcancelled); -+ -+ return bcancelled; -+#endif +} + +static __inline void thread_enter(char *name) +{ -+#ifdef PLATFORM_LINUX + #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) + daemonize("%s", name); + #endif + allow_signal(SIGTERM); -+#endif -+#ifdef PLATFORM_FREEBSD -+ printf("%s", "RTKTHREAD_enter"); -+#endif +} + -+__inline static void flush_signals_thread(void) ++__inline static void flush_signals_thread(void) +{ -+#ifdef PLATFORM_LINUX -+ if (signal_pending (current)) ++ if (signal_pending (current)) + { + flush_signals(current); + } -+#endif +} + +__inline static _OS_STATUS res_to_status(sint res) +{ -+ -+#if defined (PLATFORM_LINUX) || defined (PLATFORM_MPIXEL) || defined (PLATFORM_FREEBSD) + return res; -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+ if (res == _SUCCESS) -+ return NDIS_STATUS_SUCCESS; -+ else -+ return NDIS_STATUS_FAILURE; -+ -+#endif -+ +} + +__inline static void rtw_dump_stack(void) +{ -+#ifdef PLATFORM_LINUX + dump_stack(); -+#endif +} + -+#ifdef PLATFORM_LINUX -+#define rtw_warn_on(condition) WARN_ON(condition) -+#else -+#define rtw_warn_on(condition) do {} while (0) -+#endif -+ +__inline static int rtw_bug_check(void *parg1, void *parg2, void *parg3, void *parg4) +{ -+ int ret = _TRUE; -+ -+#ifdef PLATFORM_WINDOWS -+ if ( ((uint)parg1) <= 0x7fffffff || -+ ((uint)parg2) <= 0x7fffffff || -+ ((uint)parg3) <= 0x7fffffff || -+ ((uint)parg4) <= 0x7fffffff) -+ { -+ ret = _FALSE; -+ KeBugCheckEx(0x87110000, (ULONG_PTR)parg1, (ULONG_PTR)parg2, (ULONG_PTR)parg3, (ULONG_PTR)parg4); -+ } -+#endif ++ int ret = true; + + return ret; -+ +} + +#define _RND(sz, r) ((((sz)+((r)-1))/(r))*(r)) @@ -311771,7 +140600,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r + u32 val; + + val = ((sz >> 2) + ((sz & 3) ? 1: 0)) << 2; -+ ++ + return val; + +} @@ -311782,7 +140611,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r + u32 val; + + val = ((sz >> 3) + ((sz & 7) ? 1: 0)) << 3; -+ ++ + return val; + +} @@ -311793,7 +140622,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r + u32 val; + + val = ((sz >> 7) + ((sz & 127) ? 1: 0)) << 7; -+ ++ + return val; + +} @@ -311804,7 +140633,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r + u32 val; + + val = ((sz >> 8) + ((sz & 255) ? 1: 0)) << 8; -+ ++ + return val; + +} @@ -311815,7 +140644,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r + u32 val; + + val = ((sz >> 9) + ((sz & 511) ? 1: 0)) << 9; -+ ++ + return val; + +} @@ -311830,10 +140659,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r + return i; +} + -+#define rtw_min(a, b) ((a>b)?b:a) -+#define rtw_is_range_a_in_b(hi_a, lo_a, hi_b, lo_b) (((hi_a) <= (hi_b)) && ((lo_a) >= (lo_b))) -+#define rtw_is_range_overlap(hi_a, lo_a, hi_b, lo_b) (((hi_a) > (lo_b)) && ((lo_a) < (hi_b))) -+ +#ifndef MAC_FMT +#define MAC_FMT "%02x:%02x:%02x:%02x:%02x:%02x" +#endif @@ -311846,17 +140671,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r +extern void rtw_suspend_lock_uninit(void); +extern void rtw_lock_suspend(void); +extern void rtw_unlock_suspend(void); -+extern void rtw_lock_suspend_timeout(u32 timeout_ms); -+extern void rtw_lock_ext_suspend_timeout(u32 timeout_ms); -+extern void rtw_lock_rx_suspend_timeout(u32 timeout_ms); -+extern void rtw_lock_traffic_suspend_timeout(u32 timeout_ms); -+extern void rtw_lock_resume_scan_timeout(u32 timeout_ms); -+extern void rtw_resume_lock_suspend(void); -+extern void rtw_resume_unlock_suspend(void); -+#ifdef CONFIG_AP_WOWLAN -+extern void rtw_softap_lock_suspend(void); -+extern void rtw_softap_unlock_suspend(void); -+#endif ++#ifdef CONFIG_WOWLAN ++extern void rtw_lock_suspend_timeout(long timeout); ++#endif //CONFIG_WOWLAN + +extern void ATOMIC_SET(ATOMIC_T *v, int i); +extern int ATOMIC_READ(ATOMIC_T *v); @@ -311871,18 +140688,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r + +//File operation APIs, just for linux now +extern int rtw_is_file_readable(char *path); -+extern int rtw_retrieve_from_file(char *path, u8 *buf, u32 sz); ++extern int rtw_retrive_from_file(char *path, u8* buf, u32 sz); +extern int rtw_store_to_file(char *path, u8* buf, u32 sz); + -+ -+#ifndef PLATFORM_FREEBSD +extern void rtw_free_netdev(struct net_device * netdev); -+#endif //PLATFORM_FREEBSD -+ + +extern u64 rtw_modular64(u64 x, u64 y); +extern u64 rtw_division64(u64 x, u64 y); -+extern u32 rtw_random32(void); + +/* Macros for handling unaligned memory accesses */ + @@ -311901,7 +140713,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r + } while (0) + +#define RTW_GET_BE24(a) ((((u32) (a)[0]) << 16) | (((u32) (a)[1]) << 8) | \ -+ ((u32) (a)[2])) ++ ((u32) (a)[2])) +#define RTW_PUT_BE24(a, val) \ + do { \ + (a)[0] = (u8) ((((u32) (val)) >> 16) & 0xff); \ @@ -311910,7 +140722,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r + } while (0) + +#define RTW_GET_BE32(a) ((((u32) (a)[0]) << 24) | (((u32) (a)[1]) << 16) | \ -+ (((u32) (a)[2]) << 8) | ((u32) (a)[3])) ++ (((u32) (a)[2]) << 8) | ((u32) (a)[3])) +#define RTW_PUT_BE32(a, val) \ + do { \ + (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ @@ -311920,7 +140732,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r + } while (0) + +#define RTW_GET_LE32(a) ((((u32) (a)[3]) << 24) | (((u32) (a)[2]) << 16) | \ -+ (((u32) (a)[1]) << 8) | ((u32) (a)[0])) ++ (((u32) (a)[1]) << 8) | ((u32) (a)[0])) +#define RTW_PUT_LE32(a, val) \ + do { \ + (a)[3] = (u8) ((((u32) (val)) >> 24) & 0xff); \ @@ -311932,7 +140744,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r +#define RTW_GET_BE64(a) ((((u64) (a)[0]) << 56) | (((u64) (a)[1]) << 48) | \ + (((u64) (a)[2]) << 40) | (((u64) (a)[3]) << 32) | \ + (((u64) (a)[4]) << 24) | (((u64) (a)[5]) << 16) | \ -+ (((u64) (a)[6]) << 8) | ((u64) (a)[7])) ++ (((u64) (a)[6]) << 8) | ((u64) (a)[7])) +#define RTW_PUT_BE64(a, val) \ + do { \ + (a)[0] = (u8) (((u64) (val)) >> 56); \ @@ -311967,662 +140779,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service.h linux/3rdparty/r +struct rtw_cbuf *rtw_cbuf_alloc(u32 size); +void rtw_cbuf_free(struct rtw_cbuf *cbuf); + -+// String handler -+/* -+ * Write formatted output to sized buffer -+ */ -+#ifdef PLATFORM_LINUX -+#define rtw_sprintf(buf, size, format, arg...) snprintf(buf, size, format, ##arg) -+#else // !PLATFORM_LINUX -+#error "NOT DEFINE \"rtw_sprintf\"!!" -+#endif // !PLATFORM_LINUX -+ +#endif -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service_linux.h linux/3rdparty/rtl8812au/include/osdep_service_linux.h ---- linux.old/3rdparty/rtl8812au/include/osdep_service_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/osdep_service_linux.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,425 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __OSDEP_LINUX_SERVICE_H_ -+#define __OSDEP_LINUX_SERVICE_H_ -+ -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,5)) -+ #include -+#endif -+ //#include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26)) -+ #include -+#else -+ #include -+#endif -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include // for struct tasklet_struct -+ #include -+ #include -+ #include -+ #include -+ -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,5,41)) -+ #include -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 7, 0)) -+ #include -+#else -+ #include -+#endif -+ -+#ifdef RTK_DMP_PLATFORM -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,12)) -+ #include -+#endif -+ #include -+#endif -+ -+#ifdef CONFIG_NET_RADIO -+ #define CONFIG_WIRELESS_EXT -+#endif -+ -+ /* Monitor mode */ -+ #include -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+/* #include */ -+ #include -+#endif //CONFIG_IOCTL_CFG80211 -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ #include -+ #include -+#endif -+ -+#ifdef CONFIG_HAS_EARLYSUSPEND -+ #include -+#endif //CONFIG_HAS_EARLYSUSPEND -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ #include -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ #include -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21)) -+ #include -+#else -+ #include -+#endif -+#endif -+ -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ #include -+ #include -+ #include -+ #include -+ #include -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+ -+#ifdef CONFIG_USB_HCI -+ typedef struct urb * PURB; -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,22)) -+#ifdef CONFIG_USB_SUSPEND -+#define CONFIG_AUTOSUSPEND 1 -+#endif -+#endif -+#endif -+ -+ typedef struct semaphore _sema; -+ typedef spinlock_t _lock; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ typedef struct mutex _mutex; -+#else -+ typedef struct semaphore _mutex; -+#endif -+ typedef struct timer_list _timer; -+ -+ struct __queue { -+ struct list_head queue; -+ _lock lock; -+ }; -+ -+ typedef struct sk_buff _pkt; -+ typedef unsigned char _buffer; -+ -+ typedef struct __queue _queue; -+ typedef struct list_head _list; -+ typedef int _OS_STATUS; -+ //typedef u32 _irqL; -+ typedef unsigned long _irqL; -+ typedef struct net_device * _nic_hdl; -+ -+ typedef void* _thread_hdl_; -+ typedef int thread_return; -+ typedef void* thread_context; -+ -+ #define thread_exit() complete_and_exit(NULL, 0) -+ -+ typedef void timer_hdl_return; -+ typedef void* timer_hdl_context; -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,41)) -+ typedef struct work_struct _workitem; -+#else -+ typedef struct tq_struct _workitem; -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) -+ #define DMA_BIT_MASK(n) (((n) == 64) ? ~0ULL : ((1ULL<<(n))-1)) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22)) -+// Porting from linux kernel, for compatible with old kernel. -+static inline unsigned char *skb_tail_pointer(const struct sk_buff *skb) -+{ -+ return skb->tail; -+} -+ -+static inline void skb_reset_tail_pointer(struct sk_buff *skb) -+{ -+ skb->tail = skb->data; -+} -+ -+static inline void skb_set_tail_pointer(struct sk_buff *skb, const int offset) -+{ -+ skb->tail = skb->data + offset; -+} -+ -+static inline unsigned char *skb_end_pointer(const struct sk_buff *skb) -+{ -+ return skb->end; -+} -+#endif -+ -+__inline static _list *get_next(_list *list) -+{ -+ return list->next; -+} -+ -+__inline static _list *get_list_head(_queue *queue) -+{ -+ return (&(queue->queue)); -+} -+ -+ -+#define LIST_CONTAINOR(ptr, type, member) \ -+ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) -+ -+ -+__inline static void _enter_critical(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_irqsave(plock, *pirqL); -+} -+ -+__inline static void _exit_critical(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_irqrestore(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_irqsave(plock, *pirqL); -+} -+ -+__inline static void _exit_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_irqrestore(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_bh(plock); -+} -+ -+__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_bh(plock); -+} -+ -+__inline static int _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+ int ret = 0; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ //mutex_lock(pmutex); -+ ret = mutex_lock_interruptible(pmutex); -+#else -+ ret = down_interruptible(pmutex); -+#endif -+ return ret; -+} -+ -+ -+__inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ mutex_unlock(pmutex); -+#else -+ up(pmutex); -+#endif -+} -+ -+__inline static void rtw_list_delete(_list *plist) -+{ -+ list_del_init(plist); -+} -+ -+#define RTW_TIMER_HDL_ARGS void *FunctionContext -+ -+__inline static void _init_timer(_timer *ptimer,_nic_hdl nic_hdl,void *pfunc,void* cntx) -+{ -+ //setup_timer(ptimer, pfunc,(u32)cntx); -+ ptimer->function = pfunc; -+ ptimer->data = (unsigned long)cntx; -+ init_timer(ptimer); -+} -+ -+__inline static void _set_timer(_timer *ptimer,u32 delay_time) -+{ -+ mod_timer(ptimer , (jiffies+(delay_time*HZ/1000))); -+} -+ -+__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) -+{ -+ del_timer_sync(ptimer); -+ *bcancelled= _TRUE;//TRUE ==1; FALSE==0 -+} -+ -+ -+__inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) -+ INIT_WORK(pwork, pfunc); -+#elif (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,41)) -+ INIT_WORK(pwork, pfunc,pwork); -+#else -+ INIT_TQUEUE(pwork, pfunc,pwork); -+#endif -+} -+ -+__inline static void _set_workitem(_workitem *pwork) -+{ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,41)) -+ schedule_work(pwork); -+#else -+ schedule_task(pwork); -+#endif -+} -+ -+__inline static void _cancel_workitem_sync(_workitem *pwork) -+{ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,22)) -+ cancel_work_sync(pwork); -+#elif (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,41)) -+ flush_scheduled_work(); -+#else -+ flush_scheduled_tasks(); -+#endif -+} -+// -+// Global Mutex: can only be used at PASSIVE level. -+// -+ -+#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ while (atomic_inc_return((atomic_t *)&(_MutexCounter)) != 1)\ -+ { \ -+ atomic_dec((atomic_t *)&(_MutexCounter)); \ -+ msleep(10); \ -+ } \ -+} -+ -+#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ atomic_dec((atomic_t *)&(_MutexCounter)); \ -+} -+ -+static inline int rtw_netif_queue_stopped(struct net_device *pnetdev) -+{ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ return (netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 0)) && -+ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 1)) && -+ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 2)) && -+ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 3)) ); -+#else -+ return netif_queue_stopped(pnetdev); -+#endif -+} -+ -+static inline void rtw_netif_wake_queue(struct net_device *pnetdev) -+{ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ netif_tx_wake_all_queues(pnetdev); -+#else -+ netif_wake_queue(pnetdev); -+#endif -+} -+ -+static inline void rtw_netif_start_queue(struct net_device *pnetdev) -+{ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ netif_tx_start_all_queues(pnetdev); -+#else -+ netif_start_queue(pnetdev); -+#endif -+} -+ -+static inline void rtw_netif_stop_queue(struct net_device *pnetdev) -+{ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ netif_tx_stop_all_queues(pnetdev); -+#else -+ netif_stop_queue(pnetdev); -+#endif -+} -+ -+static inline void rtw_merge_string(char *dst, int dst_len, char *src1, char *src2) -+{ -+ int len = 0; -+ len += snprintf(dst+len, dst_len - len, "%s", src1); -+ len += snprintf(dst+len, dst_len - len, "%s", src2); -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27)) -+#define rtw_signal_process(pid, sig) kill_pid(find_vpid((pid)),(sig), 1) -+#else //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27)) -+#define rtw_signal_process(pid, sig) kill_proc((pid), (sig), 1) -+#endif //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27)) -+ -+ -+// Suspend lock prevent system from going suspend -+#ifdef CONFIG_WAKELOCK -+#include -+#elif defined(CONFIG_ANDROID_POWER) -+#include -+#endif -+ -+// limitation of path length -+#define PATH_LENGTH_MAX PATH_MAX -+ -+//Atomic integer operations -+#define ATOMIC_T atomic_t -+ -+#define rtw_netdev_priv(netdev) ( ((struct rtw_netdev_priv_indicator *)netdev_priv(netdev))->priv ) -+ -+#define NDEV_FMT "%s" -+#define NDEV_ARG(ndev) ndev->name -+#define ADPT_FMT "%s" -+#define ADPT_ARG(adapter) adapter->pnetdev->name -+#define FUNC_NDEV_FMT "%s(%s)" -+#define FUNC_NDEV_ARG(ndev) __func__, ndev->name -+#define FUNC_ADPT_FMT "%s(%s)" -+#define FUNC_ADPT_ARG(adapter) __func__, adapter->pnetdev->name -+ -+struct rtw_netdev_priv_indicator { -+ void *priv; -+ u32 sizeof_priv; -+}; -+struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv); -+extern struct net_device * rtw_alloc_etherdev(int sizeof_priv); -+ -+#define STRUCT_PACKED __attribute__ ((packed)) -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/osdep_service_xp.h linux/3rdparty/rtl8812au/include/osdep_service_xp.h ---- linux.old/3rdparty/rtl8812au/include/osdep_service_xp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/osdep_service_xp.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,202 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __OSDEP_LINUX_SERVICE_H_ -+#define __OSDEP_LINUX_SERVICE_H_ -+ -+ #include -+ #include -+ #include -+ #include -+ -+#ifdef CONFIG_USB_HCI -+ #include -+ #include -+ #include -+#endif -+ -+ typedef KSEMAPHORE _sema; -+ typedef LIST_ENTRY _list; -+ typedef NDIS_STATUS _OS_STATUS; -+ -+ -+ typedef NDIS_SPIN_LOCK _lock; -+ -+ typedef KMUTEX _mutex; -+ -+ typedef KIRQL _irqL; -+ -+ // USB_PIPE for WINCE , but handle can be use just integer under windows -+ typedef NDIS_HANDLE _nic_hdl; -+ -+ -+ typedef NDIS_MINIPORT_TIMER _timer; -+ -+ struct __queue { -+ LIST_ENTRY queue; -+ _lock lock; -+ }; -+ -+ typedef NDIS_PACKET _pkt; -+ typedef NDIS_BUFFER _buffer; -+ typedef struct __queue _queue; -+ -+ typedef PKTHREAD _thread_hdl_; -+ typedef void thread_return; -+ typedef void* thread_context; -+ -+ typedef NDIS_WORK_ITEM _workitem; -+ -+ #define thread_exit() PsTerminateSystemThread(STATUS_SUCCESS); -+ -+ #define HZ 10000000 -+ #define SEMA_UPBND (0x7FFFFFFF) //8192 -+ -+__inline static _list *get_next(_list *list) -+{ -+ return list->Flink; -+} -+ -+__inline static _list *get_list_head(_queue *queue) -+{ -+ return (&(queue->queue)); -+} -+ -+ -+#define LIST_CONTAINOR(ptr, type, member) CONTAINING_RECORD(ptr, type, member) -+ -+ -+__inline static _enter_critical(_lock *plock, _irqL *pirqL) -+{ -+ NdisAcquireSpinLock(plock); -+} -+ -+__inline static _exit_critical(_lock *plock, _irqL *pirqL) -+{ -+ NdisReleaseSpinLock(plock); -+} -+ -+ -+__inline static _enter_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprAcquireSpinLock(plock); -+} -+ -+__inline static _exit_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprReleaseSpinLock(plock); -+} -+ -+__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprAcquireSpinLock(plock); -+} -+ -+__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprReleaseSpinLock(plock); -+} -+ -+__inline static _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+ KeWaitForSingleObject(pmutex, Executive, KernelMode, FALSE, NULL); -+} -+ -+ -+__inline static _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+ KeReleaseMutex(pmutex, FALSE); -+} -+ -+ -+__inline static void rtw_list_delete(_list *plist) -+{ -+ RemoveEntryList(plist); -+ InitializeListHead(plist); -+} -+ -+#define RTW_TIMER_HDL_ARGS IN PVOID SystemSpecific1, IN PVOID FunctionContext, IN PVOID SystemSpecific2, IN PVOID SystemSpecific3 -+ -+__inline static void _init_timer(_timer *ptimer,_nic_hdl nic_hdl,void *pfunc,PVOID cntx) -+{ -+ NdisMInitializeTimer(ptimer, nic_hdl, pfunc, cntx); -+} -+ -+__inline static void _set_timer(_timer *ptimer,u32 delay_time) -+{ -+ NdisMSetTimer(ptimer,delay_time); -+} -+ -+__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) -+{ -+ NdisMCancelTimer(ptimer,bcancelled); -+} -+ -+__inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) -+{ -+ -+ NdisInitializeWorkItem(pwork, pfunc, cntx); -+} -+ -+__inline static void _set_workitem(_workitem *pwork) -+{ -+ NdisScheduleWorkItem(pwork); -+} -+ -+ -+#define ATOMIC_INIT(i) { (i) } -+ -+// -+// Global Mutex: can only be used at PASSIVE level. -+// -+ -+#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ while (NdisInterlockedIncrement((PULONG)&(_MutexCounter)) != 1)\ -+ { \ -+ NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ -+ NdisMSleep(10000); \ -+ } \ -+} -+ -+#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ -+} -+ -+// limitation of path length -+#define PATH_LENGTH_MAX MAX_PATH -+ -+//Atomic integer operations -+#define ATOMIC_T LONG -+ -+ -+#define NDEV_FMT "%s" -+#define NDEV_ARG(ndev) "" -+#define ADPT_FMT "%s" -+#define ADPT_ARG(adapter) "" -+#define FUNC_NDEV_FMT "%s" -+#define FUNC_NDEV_ARG(ndev) __func__ -+#define FUNC_ADPT_FMT "%s" -+#define FUNC_ADPT_ARG(adapter) __func__ -+ -+#define STRUCT_PACKED -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/pci_hal.h linux/3rdparty/rtl8812au/include/pci_hal.h ---- linux.old/3rdparty/rtl8812au/include/pci_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/pci_hal.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,46 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/osdep_service_linux.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service_linux.h +--- linux-4.14.17/3rdparty/rtl8812au/include/osdep_service_linux.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service_linux.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,386 @@ +/****************************************************************************** + * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -312632,47 +140797,387 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/pci_hal.h linux/3rdparty/rtl8812 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ -+#ifndef __PCI_HAL_H__ -+#define __PCI_HAL_H__ ++#ifndef __OSDEP_LINUX_SERVICE_H_ ++#define __OSDEP_LINUX_SERVICE_H_ + -+#ifdef CONFIG_RTL8188E -+void rtl8188ee_set_hal_ops(_adapter *padapter); ++ #include ++ #include ++ #include ++ #include ++ #include ++ #include ++ #include ++ #include ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,5)) ++ #include ++#endif ++ //#include ++ #include ++ #include ++ #include ++ #include ++ #include ++ #include ++ #include ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26)) ++ #include ++#else ++ #include ++#endif ++ #include ++ #include ++ #include ++ #include ++ #include ++ #include ++ #include ++ #include ++ #include // Necessary because we use the proc fs ++ #include // for struct tasklet_struct ++ #include ++ #include ++ #include ++ #include ++ ++#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,5,41)) ++ #include +#endif + -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+void rtl8812ae_set_hal_ops(_adapter *padapter); ++ #include ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++// #include ++ #include ++ #include ++#endif //CONFIG_IOCTL_CFG80211 ++ ++#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX ++ #include ++ #include +#endif + -+#if defined(CONFIG_RTL8192E) -+void rtl8192ee_set_hal_ops(_adapter *padapter); ++#ifdef CONFIG_HAS_EARLYSUSPEND ++ #include ++#endif //CONFIG_HAS_EARLYSUSPEND ++ ++#ifdef CONFIG_EFUSE_CONFIG_FILE ++ #include ++#endif //CONFIG_EFUSE_CONFIG_FILE ++ ++ #include ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21)) ++ #include ++#else ++ #include +#endif + -+#ifdef CONFIG_RTL8723B -+void rtl8723be_set_hal_ops(_adapter *padapter); ++ typedef struct urb * PURB; ++#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,22)) ++#ifdef CONFIG_USB_SUSPEND ++#define CONFIG_AUTOSUSPEND 1 ++#endif +#endif + -+#ifdef CONFIG_RTL8814A -+void rtl8814ae_set_hal_ops(_adapter *padapter); ++ typedef struct semaphore _sema; ++ typedef spinlock_t _lock; ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) ++ typedef struct mutex _mutex; ++#else ++ typedef struct semaphore _mutex; ++#endif ++ typedef struct timer_list _timer; ++ ++ struct __queue { ++ struct list_head queue; ++ _lock lock; ++ }; ++ ++ typedef struct sk_buff _pkt; ++ typedef unsigned char _buffer; ++ ++ typedef struct __queue _queue; ++ typedef struct list_head _list; ++ typedef int _OS_STATUS; ++ //typedef u32 _irqL; ++ typedef unsigned long _irqL; ++ typedef struct net_device * _nic_hdl; ++ ++ typedef void* _thread_hdl_; ++ typedef int thread_return; ++ typedef void* thread_context; ++ ++ #define thread_exit() complete_and_exit(NULL, 0) ++ ++ typedef void timer_hdl_return; ++ typedef void* timer_hdl_context; ++ ++#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,41)) ++ typedef struct work_struct _workitem; ++#else ++ typedef struct tq_struct _workitem; +#endif + -+u8 rtw_set_hal_ops(_adapter *padapter); ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) ++ #define DMA_BIT_MASK(n) (((n) == 64) ? ~0ULL : ((1ULL<<(n))-1)) ++#endif + -+#endif //__PCIE_HAL_H__ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22)) ++// Porting from linux kernel, for compatible with old kernel. ++static inline unsigned char *skb_tail_pointer(const struct sk_buff *skb) ++{ ++ return skb->tail; ++} + -diff -Nurp linux.old/3rdparty/rtl8812au/include/pci_ops.h linux/3rdparty/rtl8812au/include/pci_ops.h ---- linux.old/3rdparty/rtl8812au/include/pci_ops.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/pci_ops.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,78 @@ ++static inline void skb_reset_tail_pointer(struct sk_buff *skb) ++{ ++ skb->tail = skb->data; ++} ++ ++static inline void skb_set_tail_pointer(struct sk_buff *skb, const int offset) ++{ ++ skb->tail = skb->data + offset; ++} ++ ++static inline unsigned char *skb_end_pointer(const struct sk_buff *skb) ++{ ++ return skb->end; ++} ++#endif ++ ++__inline static _list *get_next(_list *list) ++{ ++ return list->next; ++} ++ ++__inline static _list *get_list_head(_queue *queue) ++{ ++ return (&(queue->queue)); ++} ++ ++ ++#define LIST_CONTAINOR(ptr, type, member) \ ++ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) ++ ++ ++__inline static void _enter_critical(_lock *plock, _irqL *pirqL) ++{ ++ spin_lock_irqsave(plock, *pirqL); ++} ++ ++__inline static void _exit_critical(_lock *plock, _irqL *pirqL) ++{ ++ spin_unlock_irqrestore(plock, *pirqL); ++} ++ ++__inline static void _enter_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ spin_lock_irqsave(plock, *pirqL); ++} ++ ++__inline static void _exit_critical_ex(_lock *plock, _irqL *pirqL) ++{ ++ spin_unlock_irqrestore(plock, *pirqL); ++} ++ ++__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) ++{ ++ spin_lock_bh(plock); ++} ++ ++__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) ++{ ++ spin_unlock_bh(plock); ++} ++ ++__inline static int _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) ++{ ++ int ret = 0; ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) ++ //mutex_lock(pmutex); ++ ret = mutex_lock_interruptible(pmutex); ++#else ++ ret = down_interruptible(pmutex); ++#endif ++ return ret; ++} ++ ++ ++__inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) ++ mutex_unlock(pmutex); ++#else ++ up(pmutex); ++#endif ++} ++ ++__inline static void rtw_list_delete(_list *plist) ++{ ++ list_del_init(plist); ++} ++ ++#define RTW_TIMER_HDL_ARGS void *FunctionContext ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++__inline static void _init_timer(_timer *ptimer,_nic_hdl nic_hdl,void *pfunc,void* cntx) ++{ ++ //setup_timer(ptimer, pfunc,(u32)cntx); ++ ptimer->function = pfunc; ++ ptimer->data = (unsigned long)cntx; ++ init_timer(ptimer); ++} ++#endif ++ ++__inline static void _set_timer(_timer *ptimer,u32 delay_time) ++{ ++ mod_timer(ptimer , (jiffies+(delay_time*HZ/1000))); ++} ++ ++__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) ++{ ++ del_timer_sync(ptimer); ++ *bcancelled= true;//TRUE ==1; FALSE==0 ++} ++ ++ ++__inline static void _init_workitem(_workitem *pwork, void *pfunc, void * cntx) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) ++ INIT_WORK(pwork, pfunc); ++#elif (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,41)) ++ INIT_WORK(pwork, pfunc,pwork); ++#else ++ INIT_TQUEUE(pwork, pfunc,pwork); ++#endif ++} ++ ++__inline static void _set_workitem(_workitem *pwork) ++{ ++#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,41)) ++ schedule_work(pwork); ++#else ++ schedule_task(pwork); ++#endif ++} ++ ++__inline static void _cancel_workitem_sync(_workitem *pwork) ++{ ++#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,22)) ++ cancel_work_sync(pwork); ++#elif (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,41)) ++ flush_scheduled_work(); ++#else ++ flush_scheduled_tasks(); ++#endif ++} ++// ++// Global Mutex: can only be used at PASSIVE level. ++// ++ ++#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ ++{ \ ++ while (atomic_inc_return((atomic_t *)&(_MutexCounter)) != 1)\ ++ { \ ++ atomic_dec((atomic_t *)&(_MutexCounter)); \ ++ msleep(10); \ ++ } \ ++} ++ ++#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ ++{ \ ++ atomic_dec((atomic_t *)&(_MutexCounter)); \ ++} ++ ++static inline int rtw_netif_queue_stopped(struct net_device *pnetdev) ++{ ++#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) ++ return (netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 0)) && ++ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 1)) && ++ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 2)) && ++ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 3)) ); ++#else ++ return netif_queue_stopped(pnetdev); ++#endif ++} ++ ++static inline void rtw_netif_wake_queue(struct net_device *pnetdev) ++{ ++#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) ++ netif_tx_wake_all_queues(pnetdev); ++#else ++ netif_wake_queue(pnetdev); ++#endif ++} ++ ++static inline void rtw_netif_start_queue(struct net_device *pnetdev) ++{ ++#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) ++ netif_tx_start_all_queues(pnetdev); ++#else ++ netif_start_queue(pnetdev); ++#endif ++} ++ ++static inline void rtw_netif_stop_queue(struct net_device *pnetdev) ++{ ++#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) ++ netif_tx_stop_all_queues(pnetdev); ++#else ++ netif_stop_queue(pnetdev); ++#endif ++} ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27)) ++#define rtw_signal_process(pid, sig) kill_pid(find_vpid((pid)),(sig), 1) ++#else //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27)) ++#define rtw_signal_process(pid, sig) kill_proc((pid), (sig), 1) ++#endif //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27)) ++ ++ ++// Suspend lock prevent system from going suspend ++#ifdef CONFIG_WAKELOCK ++#include ++#elif defined(CONFIG_ANDROID_POWER) ++#include ++#endif ++ ++// limitation of path length ++#define PATH_LENGTH_MAX PATH_MAX ++ ++//Atomic integer operations ++#define ATOMIC_T atomic_t ++ ++#define rtw_netdev_priv(netdev) ( ((struct rtw_netdev_priv_indicator *)netdev_priv(netdev))->priv ) ++ ++#define NDEV_FMT "%s" ++#define NDEV_ARG(ndev) ndev->name ++#define ADPT_FMT "%s" ++#define ADPT_ARG(adapter) adapter->pnetdev->name ++#define FUNC_NDEV_FMT "%s(%s)" ++#define FUNC_NDEV_ARG(ndev) __func__, ndev->name ++#define FUNC_ADPT_FMT "%s(%s)" ++#define FUNC_ADPT_ARG(adapter) __func__, adapter->pnetdev->name ++ ++struct rtw_netdev_priv_indicator { ++ void *priv; ++ u32 sizeof_priv; ++}; ++struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv); ++extern struct net_device * rtw_alloc_etherdev(int sizeof_priv); ++ ++#define STRUCT_PACKED __attribute__ ((packed)) ++ ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/recv_osdep.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/recv_osdep.h +--- linux-4.14.17/3rdparty/rtl8812au/include/recv_osdep.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/recv_osdep.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,55 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -312682,129 +141187,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/pci_ops.h linux/3rdparty/rtl8812 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __PCI_OPS_H_ -+#define __PCI_OPS_H_ -+ -+ -+#ifdef CONFIG_RTL8188E -+u32 rtl8188ee_init_desc_ring(_adapter *padapter); -+u32 rtl8188ee_free_desc_ring(_adapter *padapter); -+void rtl8188ee_reset_desc_ring(_adapter *padapter); -+int rtl8188ee_interrupt(PADAPTER Adapter); -+void rtl8188ee_xmit_tasklet(void *priv); -+void rtl8188ee_recv_tasklet(void *priv); -+void rtl8188ee_prepare_bcn_tasklet(void *priv); -+void rtl8188ee_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+u32 rtl8812ae_init_desc_ring(_adapter *padapter); -+u32 rtl8812ae_free_desc_ring(_adapter *padapter); -+void rtl8812ae_reset_desc_ring(_adapter *padapter); -+int rtl8812ae_interrupt(PADAPTER Adapter); -+void rtl8812ae_xmit_tasklet(void *priv); -+void rtl8812ae_recv_tasklet(void *priv); -+void rtl8812ae_prepare_bcn_tasklet(void *priv); -+void rtl8812ae_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#ifdef CONFIG_RTL8192E -+u32 rtl8192ee_init_desc_ring(_adapter *padapter); -+u32 rtl8192ee_free_desc_ring(_adapter *padapter); -+void rtl8192ee_reset_desc_ring(_adapter *padapter); -+void rtl8192ee_recv_tasklet(void *priv); -+void rtl8192ee_prepare_bcn_tasklet(void *priv); -+int rtl8192ee_interrupt(PADAPTER Adapter); -+void rtl8192ee_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#ifdef CONFIG_RTL8723B -+u32 rtl8723be_init_desc_ring(_adapter *padapter); -+u32 rtl8723be_free_desc_ring(_adapter *padapter); -+void rtl8723be_reset_desc_ring(_adapter *padapter); -+int rtl8723be_interrupt(PADAPTER Adapter); -+void rtl8723be_recv_tasklet(void *priv); -+void rtl8723be_prepare_bcn_tasklet(void *priv); -+void rtl8723be_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#ifdef CONFIG_RTL8814A -+u32 rtl8814ae_init_desc_ring(_adapter *padapter); -+u32 rtl8814ae_free_desc_ring(_adapter *padapter); -+void rtl8814ae_reset_desc_ring(_adapter *padapter); -+int rtl8814ae_interrupt(PADAPTER Adapter); -+void rtl8814ae_xmit_tasklet(void *priv); -+void rtl8814ae_recv_tasklet(void *priv); -+void rtl8814ae_prepare_bcn_tasklet(void *priv); -+void rtl8814ae_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/pci_osintf.h linux/3rdparty/rtl8812au/include/pci_osintf.h ---- linux.old/3rdparty/rtl8812au/include/pci_osintf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/pci_osintf.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,32 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __PCI_OSINTF_H -+#define __PCI_OSINTF_H -+ -+ -+void rtw_pci_disable_aspm(_adapter *padapter); -+void rtw_pci_enable_aspm(_adapter *padapter); -+void PlatformClearPciPMEStatus(PADAPTER Adapter); -+#ifdef CONFIG_64BIT_DMA -+u8 PlatformEnableDMA64(PADAPTER Adapter); -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/recv_osdep.h linux/3rdparty/rtl8812au/include/recv_osdep.h ---- linux.old/3rdparty/rtl8812au/include/recv_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/recv_osdep.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,65 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __RECV_OSDEP_H_ +#define __RECV_OSDEP_H_ @@ -312814,17 +141196,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/recv_osdep.h linux/3rdparty/rtl8 +extern void _rtw_free_recv_priv (struct recv_priv *precvpriv); + + -+extern s32 rtw_recv_entry(union recv_frame *precv_frame); ++extern s32 rtw_recv_entry(union recv_frame *precv_frame); +extern int rtw_recv_indicatepkt(_adapter *adapter, union recv_frame *precv_frame); -+extern void rtw_recv_returnpacket(IN _nic_hdl cnxt, IN _pkt *preturnedpkt); -+ -+extern int rtw_recv_monitor(_adapter *padapter, union recv_frame *precv_frame); ++extern void rtw_recv_returnpacket(_nic_hdl cnxt, _pkt *preturnedpkt); + +extern void rtw_hostapd_mlme_rx(_adapter *padapter, union recv_frame *precv_frame); ++extern void rtw_handle_tkip_mic_err(_adapter *padapter,u8 bgroup); + -+struct sta_info; -+extern void rtw_handle_tkip_mic_err(_adapter *padapter, struct sta_info *sta, u8 bgroup); -+ + +int rtw_init_recv_priv(struct recv_priv *precvpriv, _adapter *padapter); +void rtw_free_recv_priv (struct recv_priv *precvpriv); @@ -312851,11 +141229,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/recv_osdep.h linux/3rdparty/rtl8 + + +#endif // -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188e_cmd.h linux/3rdparty/rtl8812au/include/rtl8188e_cmd.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188e_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188e_cmd.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,187 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_cmd.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_cmd.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_cmd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_cmd.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,163 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -312869,7640 +141246,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188e_cmd.h linux/3rdparty/rt + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_CMD_H__ -+#define __RTL8188E_CMD_H__ -+ -+#if 0 -+enum cmd_msg_element_id -+{ -+ NONE_CMDMSG_EID, -+ AP_OFFLOAD_EID = 0, -+ SET_PWRMODE_EID = 1, -+ JOINBSS_RPT_EID = 2, -+ RSVD_PAGE_EID = 3, -+ RSSI_4_EID = 4, -+ RSSI_SETTING_EID = 5, -+ MACID_CONFIG_EID = 6, -+ MACID_PS_MODE_EID = 7, -+ P2P_PS_OFFLOAD_EID = 8, -+ SELECTIVE_SUSPEND_ROF_CMD = 9, -+ P2P_PS_CTW_CMD_EID = 32, -+ MAX_CMDMSG_EID -+}; -+#else -+typedef enum _RTL8188E_H2C_CMD_ID -+{ -+ //Class Common -+ H2C_COM_RSVD_PAGE =0x00, -+ H2C_COM_MEDIA_STATUS_RPT =0x01, -+ H2C_COM_SCAN =0x02, -+ H2C_COM_KEEP_ALIVE =0x03, -+ H2C_COM_DISCNT_DECISION =0x04, -+#ifndef CONFIG_WOWLAN -+ H2C_COM_WWLAN =0x05, -+#endif -+ H2C_COM_INIT_OFFLOAD =0x06, -+ H2C_COM_REMOTE_WAKE_CTL =0x07, -+ H2C_COM_AP_OFFLOAD =0x08, -+ H2C_COM_BCN_RSVD_PAGE =0x09, -+ H2C_COM_PROB_RSP_RSVD_PAGE =0x0A, -+ -+ //Class PS -+ H2C_PS_PWR_MODE =0x20, -+ H2C_PS_TUNE_PARA =0x21, -+ H2C_PS_TUNE_PARA_2 =0x22, -+ H2C_PS_LPS_PARA =0x23, -+ H2C_PS_P2P_OFFLOAD =0x24, -+ -+ //Class DM -+ H2C_DM_MACID_CFG =0x40, -+ H2C_DM_TXBF =0x41, -+ H2C_RSSI_REPORT =0x42, -+ //Class BT -+ H2C_BT_COEX_MASK =0x60, -+ H2C_BT_COEX_GPIO_MODE =0x61, -+ H2C_BT_DAC_SWING_VAL =0x62, -+ H2C_BT_PSD_RST =0x63, -+ -+ //Class Remote WakeUp -+#ifdef CONFIG_WOWLAN -+ H2C_COM_WWLAN =0x80, -+ H2C_COM_REMOTE_WAKE_CTRL =0x81, -+ H2C_COM_AOAC_GLOBAL_INFO =0x82, -+ H2C_COM_AOAC_RSVD_PAGE =0x83, -+#endif -+ -+ //Class -+ //H2C_RESET_TSF =0xc0, -+}RTL8188E_H2C_CMD_ID; -+ -+#endif -+ -+ -+struct cmd_msg_parm { -+ u8 eid; //element id -+ u8 sz; // sz -+ u8 buf[6]; -+}; -+ -+enum{ -+ PWRS -+}; -+ -+typedef struct _SETPWRMODE_PARM { -+ u8 Mode;//0:Active,1:LPS,2:WMMPS -+ //u8 RLBM:4;//0:Min,1:Max,2: User define -+ u8 SmartPS_RLBM;//LPS=0:PS_Poll,1:PS_Poll,2:NullData,WMM=0:PS_Poll,1:NullData -+ u8 AwakeInterval; // unit: beacon interval -+ u8 bAllQueueUAPSD; -+ u8 PwrState;//AllON(0x0c),RFON(0x04),RFOFF(0x00) -+} SETPWRMODE_PARM, *PSETPWRMODE_PARM; -+ -+struct H2C_SS_RFOFF_PARAM{ -+ u8 ROFOn; // 1: on, 0:off -+ u16 gpio_period; // unit: 1024 us -+}__attribute__ ((packed)); -+ -+ -+typedef struct JOINBSSRPT_PARM_88E{ -+ u8 OpMode; // RT_MEDIA_STATUS -+#ifdef CONFIG_WOWLAN -+ u8 MacID; // MACID -+#endif //CONFIG_WOWLAN -+}JOINBSSRPT_PARM_88E, *PJOINBSSRPT_PARM_88E; -+ -+/* move to hal_com_h2c.h -+typedef struct _RSVDPAGE_LOC_88E { -+ u8 LocProbeRsp; -+ u8 LocPsPoll; -+ u8 LocNullData; -+ u8 LocQosNull; -+ u8 LocBTQosNull; -+#ifdef CONFIG_WOWLAN -+ u8 LocRemoteCtrlInfo; -+ u8 LocArpRsp; -+ u8 LocNbrAdv; -+ u8 LocGTKRsp; -+ u8 LocGTKInfo; -+ u8 LocProbeReq; -+ u8 LocNetList; -+#endif //CONFIG_WOWLAN -+} RSVDPAGE_LOC_88E, *PRSVDPAGE_LOC_88E; -+*/ -+ -+// host message to firmware cmd -+void rtl8188e_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); -+void rtl8188e_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); -+u8 rtl8188e_set_rssi_cmd(PADAPTER padapter, u8 *param); -+u8 rtl8188e_set_raid_cmd(_adapter *padapter, u32 bitmap, u8 *arg); -+void rtl8188e_Add_RateATid(PADAPTER padapter, u64 rate_bitmap, u8 *arg, u8 rssi_level); -+s32 FillH2CCmd_88E(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+//u8 rtl8192c_set_FwSelectSuspend_cmd(PADAPTER padapter, u8 bfwpoll, u16 period); -+u8 GetTxBufferRsvdPageNum8188E(_adapter *padapter, bool wowlan); -+ -+ -+#ifdef CONFIG_P2P -+void rtl8188e_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif //CONFIG_P2P -+ -+void CheckFwRsvdPageContent(PADAPTER padapter); -+void rtl8188e_set_FwMediaStatus_cmd(PADAPTER padapter, u16 mstatus_rpt ); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+//u8 rtl8188e_reset_tsf(_adapter *padapter, u8 reset_port); -+int reset_tsf(PADAPTER Adapter, u8 reset_port ); -+#endif // CONFIG_TSF_RESET_OFFLOAD -+ -+//#define H2C_8188E_RSVDPAGE_LOC_LEN 5 -+//#define H2C_8188E_AOAC_RSVDPAGE_LOC_LEN 7 -+ -+#ifdef CONFIG_WOWLAN -+void SetFwRelatedForWoWLAN8188ES(_adapter* padapter, u8 bHostIsGoingtoSleep); -+#endif//CONFIG_WOWLAN -+ -+//---------------------------------------------------------------------------------------------------------// -+//---------------------------------- H2C CMD CONTENT --------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+// -+/* move to hal_com_h2c.h -+//_RSVDPAGE_LOC_CMD_0x00 -+#define SET_8188E_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8188E_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8188E_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8188E_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+// AOAC_RSVDPAGE_LOC_0x83 -+#define SET_8188E_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 0, 8, __Value) -+#define SET_8188E_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+*/ -+#endif//__RTL8188E_CMD_H__ -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188e_dm.h linux/3rdparty/rtl8812au/include/rtl8188e_dm.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188e_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188e_dm.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,37 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_DM_H__ -+#define __RTL8188E_DM_H__ -+ -+void rtl8188e_init_dm_priv(IN PADAPTER Adapter); -+void rtl8188e_deinit_dm_priv(IN PADAPTER Adapter); -+void rtl8188e_InitHalDm(IN PADAPTER Adapter); -+void rtl8188e_HalDmWatchDog(IN PADAPTER Adapter); -+ -+//VOID rtl8192c_dm_CheckTXPowerTracking(IN PADAPTER Adapter); -+ -+//void rtl8192c_dm_RF_Saving(IN PADAPTER pAdapter, IN u8 bForceInNormal); -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+void AntDivCompare8188E(PADAPTER Adapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src); -+u8 AntDivBeforeLink8188E(PADAPTER Adapter ); -+#endif -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188e_hal.h linux/3rdparty/rtl8812au/include/rtl8188e_hal.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188e_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188e_hal.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,320 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_HAL_H__ -+#define __RTL8188E_HAL_H__ -+ -+//#include "hal_com.h" -+#include "hal_data.h" -+ -+//include HAL Related header after HAL Related compiling flags -+#include "rtl8188e_spec.h" -+#include "Hal8188EPhyReg.h" -+#include "Hal8188EPhyCfg.h" -+#include "rtl8188e_rf.h" -+#include "rtl8188e_dm.h" -+#include "rtl8188e_recv.h" -+#include "rtl8188e_xmit.h" -+#include "rtl8188e_cmd.h" -+#include "rtl8188e_led.h" -+#include "Hal8188EPwrSeq.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+#include "rtl8188e_sreset.h" -+#endif -+ -+#if 0 -+ // Fw Array -+ #define Rtl8188E_FwImageArray Rtl8188EFwImgArray -+ #define Rtl8188E_FWImgArrayLength Rtl8188EFWImgArrayLength -+#ifdef CONFIG_WOWLAN -+ #define Rtl8188E_FwWoWImageArray Array_MP_8188E_FW_WoWLAN -+ #define Rtl8188E_FwWoWImgArrayLength ArrayLength_MP_8188E_FW_WoWLAN -+#endif //CONFIG_WOWLAN -+#endif -+ -+ -+ #define RTL8188E_FW_IMG "rtl8188e/FW_NIC.bin" -+ #define RTL8188E_FW_WW_IMG "rtl8188e/FW_WoWLAN.bin" -+ #define RTL8188E_PHY_REG "rtl8188e/PHY_REG.txt" -+ #define RTL8188E_PHY_RADIO_A "rtl8188e/RadioA.txt" -+ #define RTL8188E_PHY_RADIO_B "rtl8188e/RadioB.txt" -+ #define RTL8188E_TXPWR_TRACK "rtl8188e/TxPowerTrack.txt" -+ #define RTL8188E_AGC_TAB "rtl8188e/AGC_TAB.txt" -+ #define RTL8188E_PHY_MACREG "rtl8188e/MAC_REG.txt" -+ #define RTL8188E_PHY_REG_PG "rtl8188e/PHY_REG_PG.txt" -+ #define RTL8188E_PHY_REG_MP "rtl8188e/PHY_REG_MP.txt" -+ #define RTL8188E_TXPWR_LMT "rtl8188e/TXPWR_LMT.txt" -+ -+ //--------------------------------------------------------------------- -+ // RTL8188E Power Configuration CMDs for USB/SDIO/PCIE interfaces -+ //--------------------------------------------------------------------- -+ #define Rtl8188E_NIC_PWR_ON_FLOW rtl8188E_power_on_flow -+ #define Rtl8188E_NIC_RF_OFF_FLOW rtl8188E_radio_off_flow -+ #define Rtl8188E_NIC_DISABLE_FLOW rtl8188E_card_disable_flow -+ #define Rtl8188E_NIC_ENABLE_FLOW rtl8188E_card_enable_flow -+ #define Rtl8188E_NIC_SUSPEND_FLOW rtl8188E_suspend_flow -+ #define Rtl8188E_NIC_RESUME_FLOW rtl8188E_resume_flow -+ #define Rtl8188E_NIC_PDN_FLOW rtl8188E_hwpdn_flow -+ #define Rtl8188E_NIC_LPS_ENTER_FLOW rtl8188E_enter_lps_flow -+ #define Rtl8188E_NIC_LPS_LEAVE_FLOW rtl8188E_leave_lps_flow -+ -+ -+#if 1 // download firmware related data structure -+#define MAX_FW_8188E_SIZE 0x8000 //32768,32k / 16384,16k -+ -+#define FW_8188E_SIZE 0x4000 //16384,16k -+#define FW_8188E_SIZE_2 0x8000 //32768,32k -+ -+#define FW_8188E_START_ADDRESS 0x1000 -+#define FW_8188E_END_ADDRESS 0x1FFF //0x5FFF -+ -+ -+#define IS_FW_HEADER_EXIST_88E(_pFwHdr) ((le16_to_cpu(_pFwHdr->Signature)&0xFFF0) == 0x88E0) -+ -+typedef struct _RT_FIRMWARE_8188E { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8* szFwBuffer; -+#else -+ u8 szFwBuffer[MAX_FW_8188E_SIZE]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8188E, *PRT_FIRMWARE_8188E; -+ -+// -+// This structure must be cared byte-ordering -+// -+ -+typedef struct _RT_8188E_FIRMWARE_HDR -+{ -+ // 8-byte alinment required -+ -+ //--- LONG WORD 0 ---- -+ u16 Signature; // 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut -+ u8 Category; // AP/NIC and USB/PCI -+ u8 Function; // Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions -+ u16 Version; // FW Version -+ u8 Subversion; // FW Subversion, default 0x00 -+ u16 Rsvd1; -+ -+ -+ //--- LONG WORD 1 ---- -+ u8 Month; // Release time Month field -+ u8 Date; // Release time Date field -+ u8 Hour; // Release time Hour field -+ u8 Minute; // Release time Minute field -+ u16 RamCodeSize; // The size of RAM code -+ u8 Foundry; -+ u8 Rsvd2; -+ -+ //--- LONG WORD 2 ---- -+ u32 SvnIdx; // The SVN entry index -+ u32 Rsvd3; -+ -+ //--- LONG WORD 3 ---- -+ u32 Rsvd4; -+ u32 Rsvd5; -+}RT_8188E_FIRMWARE_HDR, *PRT_8188E_FIRMWARE_HDR; -+#endif // download firmware related data structure -+ -+ -+#define DRIVER_EARLY_INT_TIME_8188E 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8188E 0x02 -+ -+ -+//#define MAX_RX_DMA_BUFFER_SIZE_88E 0x2400 //9k for 88E nornal chip , //MaxRxBuff=10k-max(TxReportSize(64*8), WOLPattern(16*24)) -+#define RX_DMA_SIZE_88E(__Adapter) ((!IS_VENDOR_8188E_I_CUT_SERIES(__Adapter))?0x2800:0x4000) -+ -+#ifdef CONFIG_WOWLAN -+#define RESV_FMWF WKFMCAM_SIZE*MAX_WKFM_NUM /* 16 entries, for each is 24 bytes*/ -+#else -+#define RESV_FMWF 0 -+#endif -+ -+#define RX_DMA_RESERVD_FW_FEATURE 0x200 /* for tx report (64*8) */ -+ -+#define MAX_RX_DMA_BUFFER_SIZE_88E(__Adapter) RX_DMA_SIZE_88E(__Adapter)-RX_DMA_RESERVD_FW_FEATURE -+ -+#define MAX_TX_REPORT_BUFFER_SIZE 0x0400 /* 1k */ -+ -+// Note: We will divide number of page equally for each queue other than public queue! -+// 22k = 22528 bytes = 176 pages (@page = 128 bytes) -+// must reserved about 7 pages for LPS => 176-7 = 169 (0xA9) -+// 2*BCN / 1*ps-poll / 1*null-data /1*prob_rsp /1*QOS null-data /1*BT QOS null-data -+ -+#define BCNQ_PAGE_NUM_88E 0x08 -+ -+//For WoWLan , more reserved page -+#ifdef CONFIG_WOWLAN -+#define WOWLAN_PAGE_NUM_88E 0x00 -+#else -+#define WOWLAN_PAGE_NUM_88E 0x00 -+#endif -+ -+/* Note: -+Tx FIFO Size : previous CUT:22K /I_CUT after:32KB -+Tx page Size : 128B -+Total page numbers : 176(0xB0) / 256(0x100) -+*/ -+#define TOTAL_PAGE_NUMBER_88E(_Adapter) ((IS_VENDOR_8188E_I_CUT_SERIES(_Adapter)?0x100:0xB0) - 1)/* must reserved 1 page for dma issue */ -+#define TX_TOTAL_PAGE_NUMBER_88E(_Adapter) (TOTAL_PAGE_NUMBER_88E(_Adapter) - BCNQ_PAGE_NUM_88E - WOWLAN_PAGE_NUM_88E) -+#define TX_PAGE_BOUNDARY_88E(_Adapter) (TX_TOTAL_PAGE_NUMBER_88E(_Adapter) + 1) /* beacon header start address */ -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_88E(_Adapter) TX_TOTAL_PAGE_NUMBER_88E(_Adapter) -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_88E(_Adapter) (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_88E(_Adapter) + 1) -+ -+// For Normal Chip Setting -+// (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8723B -+#define NORMAL_PAGE_NUM_HPQ_88E 0x0 -+#define NORMAL_PAGE_NUM_LPQ_88E 0x09 -+#define NORMAL_PAGE_NUM_NPQ_88E 0x0 -+ -+// Note: For Normal Chip Setting, modify later -+#define WMM_NORMAL_PAGE_NUM_HPQ_88E 0x29 -+#define WMM_NORMAL_PAGE_NUM_LPQ_88E 0x1C -+#define WMM_NORMAL_PAGE_NUM_NPQ_88E 0x1C -+ -+ -+//------------------------------------------------------------------------- -+// Chip specific -+//------------------------------------------------------------------------- -+#define CHIP_BONDING_IDENTIFIER(_value) (((_value)>>22)&0x3) -+#define CHIP_BONDING_92C_1T2R 0x1 -+#define CHIP_BONDING_88C_USB_MCARD 0x2 -+#define CHIP_BONDING_88C_USB_HP 0x1 -+ -+//------------------------------------------------------------------------- -+// Channel Plan -+//------------------------------------------------------------------------- -+ -+ -+#define EFUSE_REAL_CONTENT_LEN 512 -+#define EFUSE_MAP_LEN 128 -+#define EFUSE_MAX_SECTION 16 -+#define EFUSE_IC_ID_OFFSET 506 //For some inferiority IC purpose. added by Roger, 2009.09.02. -+#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN) -+// -+// -+// To prevent out of boundary programming case, -+// leave 1byte and program full section -+// 9bytes + 1byt + 5bytes and pre 1byte. -+// For worst case: -+// | 1byte|----8bytes----|1byte|--5bytes--| -+// | | Reserved(14bytes) | -+// -+#define EFUSE_OOB_PROTECT_BYTES 15 // PG data exclude header, dummy 6 bytes frome CP test and reserved 1byte. -+ -+#define EFUSE_REAL_CONTENT_LEN_88E 256 -+#define EFUSE_MAP_LEN_88E 512 -+#define EFUSE_MAX_SECTION_88E 64 -+#define EFUSE_MAX_WORD_UNIT_88E 4 -+#define EFUSE_IC_ID_OFFSET_88E 506 //For some inferiority IC purpose. added by Roger, 2009.09.02. -+#define AVAILABLE_EFUSE_ADDR_88E(addr) (addr < EFUSE_REAL_CONTENT_LEN_88E) -+// To prevent out of boundary programming case, leave 1byte and program full section -+// 9bytes + 1byt + 5bytes and pre 1byte. -+// For worst case: -+// | 2byte|----8bytes----|1byte|--7bytes--| //92D -+#define EFUSE_OOB_PROTECT_BYTES_88E 18 // PG data exclude header, dummy 7 bytes frome CP test and reserved 1byte. -+#define EFUSE_PROTECT_BYTES_BANK_88E 16 -+ -+ -+//======================================================== -+// EFUSE for BT definition -+//======================================================== -+#define EFUSE_BT_REAL_CONTENT_LEN 1536 // 512*3 -+#define EFUSE_BT_MAP_LEN 1024 // 1k bytes -+#define EFUSE_BT_MAX_SECTION 128 // 1024/8 -+ -+#define EFUSE_PROTECT_BYTES_BANK 16 -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+//#define IS_MULTI_FUNC_CHIP(_Adapter) (((((PHAL_DATA_TYPE)(_Adapter->HalData))->MultiFunc) & (RT_MULTI_FUNC_BT|RT_MULTI_FUNC_GPS)) ? _TRUE : _FALSE) -+ -+//#define RT_IS_FUNC_DISABLED(__pAdapter, __FuncBits) ( (__pAdapter)->DisabledFunctions & (__FuncBits) ) -+ -+#ifdef CONFIG_PCI_HCI -+void InterruptRecognized8188EE(PADAPTER Adapter, PRT_ISR_CONTENT pIsrContent); -+void UpdateInterruptMask8188EE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+#endif //CONFIG_PCI_HCI -+ -+// rtl8188e_hal_init.c -+ -+s32 rtl8188e_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); -+void _8051Reset88E(PADAPTER padapter); -+void rtl8188e_InitializeFirmwareVars(PADAPTER padapter); -+ -+ -+s32 InitLLTTable(PADAPTER padapter, u8 txpktbuf_bndy); -+ -+// EFuse -+u8 GetEEPROMSize8188E(PADAPTER padapter); -+void Hal_InitPGData88E(PADAPTER padapter); -+void Hal_EfuseParseIDCode88E(PADAPTER padapter, u8 *hwinfo); -+void Hal_ReadTxPowerInfo88E(PADAPTER padapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+ -+void Hal_EfuseParseEEPROMVer88E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void rtl8188e_EfuseParseChnlPlan(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseCustomerID88E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadAntennaDiversity88E (PADAPTER pAdapter,u8*PROMContent,BOOLEAN AutoLoadFail); -+void Hal_ReadThermalMeter_88E(PADAPTER Adapter,u8* PROMContent,BOOLEAN AutoloadFail); -+void Hal_EfuseParseXtal_8188E(PADAPTER pAdapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+void Hal_EfuseParseBoardType88E(PADAPTER pAdapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+void Hal_ReadPowerSavingMode88E(PADAPTER pAdapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+ -+BOOLEAN HalDetectPwrDownMode88E(PADAPTER Adapter); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif //CONFIG_WOWLAN -+ -+ -+#ifdef CONFIG_RF_GAIN_OFFSET -+void Hal_ReadRFGainOffset(PADAPTER pAdapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+#endif //CONFIG_RF_GAIN_OFFSET -+ -+void rtl8188e_init_default_value(_adapter *adapter); -+ -+void rtl8188e_set_hal_ops(struct hal_ops *pHalFunc); -+ -+// register -+void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); -+ -+void rtl8188e_start_thread(_adapter *padapter); -+void rtl8188e_stop_thread(_adapter *padapter); -+ -+void rtw_IOL_cmd_tx_pkt_buf_dump(ADAPTER *Adapter,int data_len); -+#ifdef CONFIG_IOL_EFUSE_PATCH -+s32 rtl8188e_iol_efuse_patch(PADAPTER padapter); -+#endif//CONFIG_IOL_EFUSE_PATCH -+void _InitTransferPageSize(PADAPTER padapter); -+ -+void SetHwReg8188E(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg8188E(PADAPTER padapter, u8 variable, u8 *val); -+void ResumeTxBeacon(PADAPTER padapter); -+void StopTxBeacon(PADAPTER padapter); -+u8 -+GetHalDefVar8188E( -+ IN PADAPTER Adapter, -+ IN HAL_DEF_VARIABLE eVariable, -+ IN PVOID pValue -+ ); -+#endif //__RTL8188E_HAL_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188e_led.h linux/3rdparty/rtl8812au/include/rtl8188e_led.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188e_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188e_led.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_LED_H__ -+#define __RTL8188E_LED_H__ -+ -+ -+//================================================================================ -+// Interface to manipulate LED objects. -+//================================================================================ -+#ifdef CONFIG_USB_HCI -+void rtl8188eu_InitSwLeds(PADAPTER padapter); -+void rtl8188eu_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+void rtl8188ee_InitSwLeds(PADAPTER padapter); -+void rtl8188ee_DeInitSwLeds(PADAPTER padapter); -+#endif -+#if defined (CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+void rtl8188es_InitSwLeds(PADAPTER padapter); -+void rtl8188es_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188e_recv.h linux/3rdparty/rtl8812au/include/rtl8188e_recv.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188e_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188e_recv.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,175 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_RECV_H__ -+#define __RTL8188E_RECV_H__ -+ -+#define RECV_BLK_SZ 512 -+#define RECV_BLK_CNT 16 -+#define RECV_BLK_TH RECV_BLK_CNT -+ -+#if defined(CONFIG_USB_HCI) -+ -+#ifndef MAX_RECVBUF_SZ -+#ifdef PLATFORM_OS_CE -+#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+#else -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ //#define MAX_RECVBUF_SZ (32768) // 32k -+ //#define MAX_RECVBUF_SZ (16384) //16K -+ //#define MAX_RECVBUF_SZ (10240) //10K -+ #ifdef CONFIG_PLATFORM_MSTAR -+ #define MAX_RECVBUF_SZ (8192) // 8K -+ #else -+ #define MAX_RECVBUF_SZ (15360) // 15k < 16k -+ #endif -+ //#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+ #else -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+ #endif -+#endif -+#endif //!MAX_RECVBUF_SZ -+ -+#elif defined(CONFIG_PCI_HCI) -+//#ifndef CONFIG_MINIMAL_MEMORY_USAGE -+// #define MAX_RECVBUF_SZ (9100) -+//#else -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+//#endif -+ -+ -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ -+#define MAX_RECVBUF_SZ (10240) -+ -+#endif -+ -+// Rx smooth factor -+#define Rx_Smooth_Factor (20) -+ -+#define TX_RPT1_PKT_LEN 8 -+ -+typedef struct rxreport_8188e -+{ -+ //Offset 0 -+ u32 pktlen:14; -+ u32 crc32:1; -+ u32 icverr:1; -+ u32 drvinfosize:4; -+ u32 security:3; -+ u32 qos:1; -+ u32 shift:2; -+ u32 physt:1; -+ u32 swdec:1; -+ u32 ls:1; -+ u32 fs:1; -+ u32 eor:1; -+ u32 own:1; -+ -+ //Offset 4 -+ u32 macid:5; -+ u32 tid:4; -+ u32 hwrsvd:4; -+ u32 amsdu:1; -+ u32 paggr:1; -+ u32 faggr:1; -+ u32 a1fit:4; -+ u32 a2fit:4; -+ u32 pam:1; -+ u32 pwr:1; -+ u32 md:1; -+ u32 mf:1; -+ u32 type:2; -+ u32 mc:1; -+ u32 bc:1; -+ -+ //Offset 8 -+ u32 seq:12; -+ u32 frag:4; -+ u32 nextpktlen:14; -+ u32 nextind:1; -+ u32 rsvd0831:1; -+ -+ //Offset 12 -+ u32 rxmcs:6; -+ u32 rxht:1; -+ u32 gf:1; -+ u32 splcp:1; -+ u32 bw:1; -+ u32 htc:1; -+ u32 eosp:1; -+ u32 bssidfit:2; -+ u32 rpt_sel:2; -+ u32 rsvd1216:13; -+ u32 pattern_match:1; -+ u32 unicastwake:1; -+ u32 magicwake:1; -+ -+ //Offset 16 -+ /* -+ u32 pattern0match:1; -+ u32 pattern1match:1; -+ u32 pattern2match:1; -+ u32 pattern3match:1; -+ u32 pattern4match:1; -+ u32 pattern5match:1; -+ u32 pattern6match:1; -+ u32 pattern7match:1; -+ u32 pattern8match:1; -+ u32 pattern9match:1; -+ u32 patternamatch:1; -+ u32 patternbmatch:1; -+ u32 patterncmatch:1; -+ u32 rsvd1613:19; -+ */ -+ u32 rsvd16; -+ -+ //Offset 20 -+ u32 tsfl; -+ -+ //Offset 24 -+ u32 bassn:12; -+ u32 bavld:1; -+ u32 rsvd2413:19; -+} RXREPORT, *PRXREPORT; -+ -+ -+#if defined (CONFIG_SDIO_HCI)||defined(CONFIG_GSPI_HCI) -+s32 rtl8188es_init_recv_priv(PADAPTER padapter); -+void rtl8188es_free_recv_priv(PADAPTER padapter); -+void rtl8188es_recv_hdl(PADAPTER padapter, struct recv_buf *precvbuf); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+void rtl8188eu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+s32 rtl8188eu_init_recv_priv(PADAPTER padapter); -+void rtl8188eu_free_recv_priv(PADAPTER padapter); -+void rtl8188eu_recv_hdl(PADAPTER padapter, struct recv_buf *precvbuf); -+void rtl8188eu_recv_tasklet(void *priv); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8188ee_init_recv_priv(PADAPTER padapter); -+void rtl8188ee_free_recv_priv(PADAPTER padapter); -+#endif -+ -+void rtl8188e_query_rx_desc_status(union recv_frame *precvframe, struct recv_stat *prxstat); -+ -+#endif /* __RTL8188E_RECV_H__ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188e_rf.h linux/3rdparty/rtl8812au/include/rtl8188e_rf.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188e_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188e_rf.h 2017-06-07 23:07:21.038690036 +0300 -@@ -0,0 +1,33 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_RF_H__ -+#define __RTL8188E_RF_H__ -+ -+ -+ -+int PHY_RF6052_Config8188E( IN PADAPTER Adapter ); -+void rtl8188e_RF_ChangeTxPath( IN PADAPTER Adapter, -+ IN u16 DataRate); -+void rtl8188e_PHY_RF6052SetBandwidth( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); -+ -+#endif//__RTL8188E_RF_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188e_spec.h linux/3rdparty/rtl8812au/include/rtl8188e_spec.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188e_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188e_spec.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,162 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8188E_SPEC_H__ -+#define __RTL8188E_SPEC_H__ -+ -+ -+//============================================================ -+// 8188E Regsiter offset definition -+//============================================================ -+ -+ -+//============================================================ -+// -+//============================================================ -+ -+//----------------------------------------------------- -+// -+// 0x0000h ~ 0x00FFh System Configuration -+// -+//----------------------------------------------------- -+#define REG_BB_PAD_CTRL 0x0064 -+#define REG_HMEBOX_E0 0x0088 -+#define REG_HMEBOX_E1 0x008A -+#define REG_HMEBOX_E2 0x008C -+#define REG_HMEBOX_E3 0x008E -+#define REG_HMEBOX_EXT_0 0x01F0 -+#define REG_HMEBOX_EXT_1 0x01F4 -+#define REG_HMEBOX_EXT_2 0x01F8 -+#define REG_HMEBOX_EXT_3 0x01FC -+#define REG_HIMR_88E 0x00B0 //RTL8188E -+#define REG_HISR_88E 0x00B4 //RTL8188E -+#define REG_HIMRE_88E 0x00B8 //RTL8188E -+#define REG_HISRE_88E 0x00BC //RTL8188E -+#define REG_MACID_NO_LINK_0 0x0484 -+#define REG_MACID_NO_LINK_1 0x0488 -+#define REG_MACID_PAUSE_0 0x048c -+#define REG_MACID_PAUSE_1 0x0490 -+ -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+#define REG_PKTBUF_DBG_ADDR (REG_PKTBUF_DBG_CTRL) -+#define REG_RXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+2) -+#define REG_TXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+3) -+#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN -+ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x02FFh RXDMA Configuration -+// -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// -+// 0x0300h ~ 0x03FFh PCIe -+// -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+#ifdef CONFIG_WOWLAN -+#define REG_TXPKTBUF_IV_LOW 0x01a4 -+#define REG_TXPKTBUF_IV_HIGH 0x01a8 -+#endif -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+#ifdef CONFIG_RF_GAIN_OFFSET -+#define EEPROM_RF_GAIN_OFFSET 0xC1 -+#define EEPROM_RF_GAIN_VAL 0xF6 -+#define EEPROM_THERMAL_OFFSET 0xF5 -+#endif //CONFIG_RF_GAIN_OFFSET -+//---------------------------------------------------------------------------- -+// 88E Driver Initialization Offload REG_FDHM0(Offset 0x88, 8 bits) -+//---------------------------------------------------------------------------- -+//IOL config for REG_FDHM0(Reg0x88) -+#define CMD_INIT_LLT BIT0 -+#define CMD_READ_EFUSE_MAP BIT1 -+#define CMD_EFUSE_PATCH BIT2 -+#define CMD_IOCONFIG BIT3 -+#define CMD_INIT_LLT_ERR BIT4 -+#define CMD_READ_EFUSE_MAP_ERR BIT5 -+#define CMD_EFUSE_PATCH_ERR BIT6 -+#define CMD_IOCONFIG_ERR BIT7 -+ -+//----------------------------------------------------- -+// -+// Redifine register definition for compatibility -+// -+//----------------------------------------------------- -+ -+// TODO: use these definition when using REG_xxx naming rule. -+// NOTE: DO NOT Remove these definition. Use later. -+#define ISR_88E REG_HISR_88E -+ -+#ifdef CONFIG_PCI_HCI -+//#define IMR_RX_MASK (IMR_ROK_88E|IMR_RDU_88E|IMR_RXFOVW_88E) -+#define IMR_TX_MASK (IMR_VODOK_88E|IMR_VIDOK_88E|IMR_BEDOK_88E|IMR_BKDOK_88E|IMR_MGNTDOK_88E|IMR_HIGHDOK_88E|IMR_BCNDERR0_88E) -+ -+#ifdef CONFIG_CONCURRENT_MODE -+#define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_88E | IMR_TBDOK_88E | IMR_TBDER_88E | IMR_BCNDMAINT_E_88E) -+#else -+#define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_88E | IMR_TBDOK_88E | IMR_TBDER_88E) -+#endif -+ -+#define RT_AC_INT_MASKS (IMR_VIDOK_88E | IMR_VODOK_88E | IMR_BEDOK_88E|IMR_BKDOK_88E) -+#endif -+ -+ -+//======================================================== -+// General definitions -+//======================================================== -+ -+#define MACID_NUM_88E 64 -+#define SEC_CAM_ENT_NUM_88E 32 -+#define NSS_NUM_88E 1 -+ -+//---------------------------------------------------------------------------- -+// 8192C EEPROM/EFUSE share register definition. -+//---------------------------------------------------------------------------- -+ -+#define EFUSE_ACCESS_ON 0x69 // For RTL8723 only. -+#define EFUSE_ACCESS_OFF 0x00 // For RTL8723 only. -+ -+#endif /* __RTL8188E_SPEC_H__ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188e_sreset.h linux/3rdparty/rtl8812au/include/rtl8188e_sreset.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188e_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188e_sreset.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8188E_SRESET_H_ -+#define _RTL8188E_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+extern void rtl8188e_sreset_xmit_status_check(_adapter *padapter); -+extern void rtl8188e_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188e_xmit.h linux/3rdparty/rtl8812au/include/rtl8188e_xmit.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188e_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188e_xmit.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,299 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_XMIT_H__ -+#define __RTL8188E_XMIT_H__ -+ -+ -+ -+ -+//For 88e early mode -+#define SET_EARLYMODE_PKTNUM(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 3, __Value) -+#define SET_EARLYMODE_LEN0(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 12, __Value) -+#define SET_EARLYMODE_LEN1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 16, 12, __Value) -+#define SET_EARLYMODE_LEN2_1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 28, 4, __Value) -+#define SET_EARLYMODE_LEN2_2(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 8, __Value) -+#define SET_EARLYMODE_LEN3(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 8, 12, __Value) -+#define SET_EARLYMODE_LEN4(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 20, 12, __Value) -+ -+// -+//defined for TX DESC Operation -+// -+ -+#define MAX_TID (15) -+ -+//OFFSET 0 -+#define OFFSET_SZ 0 -+#define OFFSET_SHT 16 -+#define BMC BIT(24) -+#define LSG BIT(26) -+#define FSG BIT(27) -+#define OWN BIT(31) -+ -+ -+//OFFSET 4 -+#define PKT_OFFSET_SZ 0 -+#define QSEL_SHT 8 -+#define RATE_ID_SHT 16 -+#define NAVUSEHDR BIT(20) -+#define SEC_TYPE_SHT 22 -+#define PKT_OFFSET_SHT 26 -+ -+//OFFSET 8 -+#define AGG_EN BIT(12) -+#define AGG_BK BIT(16) -+#define AMPDU_DENSITY_SHT 20 -+#define ANTSEL_A BIT(24) -+#define ANTSEL_B BIT(25) -+#define TX_ANT_CCK_SHT 26 -+#define TX_ANTL_SHT 28 -+#define TX_ANT_HT_SHT 30 -+ -+//OFFSET 12 -+#define SEQ_SHT 16 -+#define EN_HWSEQ BIT(31) -+ -+//OFFSET 16 -+#define QOS BIT(6) -+#define HW_SSN BIT(7) -+#define USERATE BIT(8) -+#define DISDATAFB BIT(10) -+#define CTS_2_SELF BIT(11) -+#define RTS_EN BIT(12) -+#define HW_RTS_EN BIT(13) -+#define DATA_SHORT BIT(24) -+#define PWR_STATUS_SHT 15 -+#define DATA_SC_SHT 20 -+#define DATA_BW BIT(25) -+ -+//OFFSET 20 -+#define RTY_LMT_EN BIT(17) -+ -+ -+//OFFSET 20 -+#define SGI BIT(6) -+#define USB_TXAGG_NUM_SHT 24 -+ -+typedef struct txdesc_88e -+{ -+ //Offset 0 -+ u32 pktlen:16; -+ u32 offset:8; -+ u32 bmc:1; -+ u32 htc:1; -+ u32 ls:1; -+ u32 fs:1; -+ u32 linip:1; -+ u32 noacm:1; -+ u32 gf:1; -+ u32 own:1; -+ -+ //Offset 4 -+ u32 macid:6; -+ u32 rsvd0406:2; -+ u32 qsel:5; -+ u32 rd_nav_ext:1; -+ u32 lsig_txop_en:1; -+ u32 pifs:1; -+ u32 rate_id:4; -+ u32 navusehdr:1; -+ u32 en_desc_id:1; -+ u32 sectype:2; -+ u32 rsvd0424:2; -+ u32 pkt_offset:5; // unit: 8 bytes -+ u32 rsvd0431:1; -+ -+ //Offset 8 -+ u32 rts_rc:6; -+ u32 data_rc:6; -+ u32 agg_en:1; -+ u32 rd_en:1; -+ u32 bar_rty_th:2; -+ u32 bk:1; -+ u32 morefrag:1; -+ u32 raw:1; -+ u32 ccx:1; -+ u32 ampdu_density:3; -+ u32 bt_null:1; -+ u32 ant_sel_a:1; -+ u32 ant_sel_b:1; -+ u32 tx_ant_cck:2; -+ u32 tx_antl:2; -+ u32 tx_ant_ht:2; -+ -+ //Offset 12 -+ u32 nextheadpage:8; -+ u32 tailpage:8; -+ u32 seq:12; -+ u32 cpu_handle:1; -+ u32 tag1:1; -+ u32 trigger_int:1; -+ u32 hwseq_en:1; -+ -+ //Offset 16 -+ u32 rtsrate:5; -+ u32 ap_dcfe:1; -+ u32 hwseq_sel:2; -+ u32 userate:1; -+ u32 disrtsfb:1; -+ u32 disdatafb:1; -+ u32 cts2self:1; -+ u32 rtsen:1; -+ u32 hw_rts_en:1; -+ u32 port_id:1; -+ u32 pwr_status:3; -+ u32 wait_dcts:1; -+ u32 cts2ap_en:1; -+ u32 data_sc:2; -+ u32 data_stbc:2; -+ u32 data_short:1; -+ u32 data_bw:1; -+ u32 rts_short:1; -+ u32 rts_bw:1; -+ u32 rts_sc:2; -+ u32 vcs_stbc:2; -+ -+ //Offset 20 -+ u32 datarate:6; -+ u32 sgi:1; -+ u32 try_rate:1; -+ u32 data_ratefb_lmt:5; -+ u32 rts_ratefb_lmt:4; -+ u32 rty_lmt_en:1; -+ u32 data_rt_lmt:6; -+ u32 usb_txagg_num:8; -+ -+ //Offset 24 -+ u32 txagg_a:5; -+ u32 txagg_b:5; -+ u32 use_max_len:1; -+ u32 max_agg_num:5; -+ u32 mcsg1_max_len:4; -+ u32 mcsg2_max_len:4; -+ u32 mcsg3_max_len:4; -+ u32 mcs7_sgi_max_len:4; -+ -+ //Offset 28 -+ u32 checksum:16; // TxBuffSize(PCIe)/CheckSum(USB) -+ u32 sw0:8; /* offset 30 */ -+ u32 sw1:4; -+ u32 mcs15_sgi_max_len:4; -+}TXDESC_8188E, *PTXDESC_8188E; -+ -+#define txdesc_set_ccx_sw_88e(txdesc, value) \ -+ do { \ -+ ((struct txdesc_88e *)(txdesc))->sw1 = (((value)>>8) & 0x0f); \ -+ ((struct txdesc_88e *)(txdesc))->sw0 = ((value) & 0xff); \ -+ } while (0) -+ -+struct txrpt_ccx_88e { -+ /* offset 0 */ -+ u8 tag1:1; -+ u8 pkt_num:3; -+ u8 txdma_underflow:1; -+ u8 int_bt:1; -+ u8 int_tri:1; -+ u8 int_ccx:1; -+ -+ /* offset 1 */ -+ u8 mac_id:6; -+ u8 pkt_ok:1; -+ u8 bmc:1; -+ -+ /* offset 2 */ -+ u8 retry_cnt:6; -+ u8 lifetime_over:1; -+ u8 retry_over:1; -+ -+ /* offset 3 */ -+ u8 ccx_qtime0; -+ u8 ccx_qtime1; -+ -+ /* offset 5 */ -+ u8 final_data_rate; -+ -+ /* offset 6 */ -+ u8 sw1:4; -+ u8 qsel:4; -+ -+ /* offset 7 */ -+ u8 sw0; -+}; -+ -+#define txrpt_ccx_sw_88e(txrpt_ccx) ((txrpt_ccx)->sw0 + ((txrpt_ccx)->sw1<<8)) -+#define txrpt_ccx_qtime_88e(txrpt_ccx) ((txrpt_ccx)->ccx_qtime0+((txrpt_ccx)->ccx_qtime1<<8)) -+ -+#define SET_TX_DESC_SEC_TYPE_8188E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+ -+void rtl8188e_fill_fake_txdesc(PADAPTER padapter,u8*pDesc,u32 BufferLen, -+ u8 IsPsPoll,u8 IsBTQosNull, u8 bDataFrame); -+void rtl8188e_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+ -+#if defined(CONFIG_SDIO_HCI)||defined (CONFIG_GSPI_HCI) -+s32 rtl8188es_init_xmit_priv(PADAPTER padapter); -+void rtl8188es_free_xmit_priv(PADAPTER padapter); -+s32 rtl8188es_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8188es_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8188es_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+thread_return rtl8188es_xmit_thread(thread_context context); -+s32 rtl8188es_xmit_buf_handler(PADAPTER padapter); -+ -+#ifdef CONFIG_SDIO_TX_TASKLET -+void rtl8188es_xmit_tasklet(void *priv); -+#endif -+#endif -+ -+#ifdef CONFIG_USB_HCI -+s32 rtl8188eu_init_xmit_priv(PADAPTER padapter); -+void rtl8188eu_free_xmit_priv(PADAPTER padapter); -+s32 rtl8188eu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8188eu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8188eu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtl8188eu_xmit_buf_handler(PADAPTER padapter); -+void rtl8188eu_xmit_tasklet(void *priv); -+s32 rtl8188eu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8188ee_init_xmit_priv(PADAPTER padapter); -+void rtl8188ee_free_xmit_priv(PADAPTER padapter); -+void rtl8188ee_xmitframe_resume(_adapter *padapter); -+s32 rtl8188ee_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8188ee_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8188ee_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+void rtl8188ee_xmit_tasklet(void *priv); -+#endif -+ -+ -+ -+#ifdef CONFIG_TX_EARLY_MODE -+void UpdateEarlyModeInfo8188E(struct xmit_priv *pxmitpriv,struct xmit_buf *pxmitbuf ); -+#endif -+ -+#ifdef CONFIG_XMIT_ACK -+void dump_txrpt_ccx_88e(void *buf); -+void handle_txrpt_ccx_88e(_adapter *adapter, u8 *buf); -+#else -+#define dump_txrpt_ccx_88e(buf) do {} while(0) -+#define handle_txrpt_ccx_88e(adapter, buf) do {} while(0) -+#endif //CONFIG_XMIT_ACK -+ -+void _dbg_dump_tx_info(_adapter *padapter,int frame_tag,struct tx_desc *ptxdesc); -+#endif //__RTL8188E_XMIT_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188f_cmd.h linux/3rdparty/rtl8812au/include/rtl8188f_cmd.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188f_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188f_cmd.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,225 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_CMD_H__ -+#define __RTL8188F_CMD_H__ -+ -+//---------------------------------------------------------------------------------------------------------// -+//---------------------------------- H2C CMD DEFINITION ------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+ -+enum h2c_cmd_8188F{ -+ //Common Class: 000 -+ H2C_8188F_RSVD_PAGE = 0x00, -+ H2C_8188F_MEDIA_STATUS_RPT = 0x01, -+ H2C_8188F_SCAN_ENABLE = 0x02, -+ H2C_8188F_KEEP_ALIVE = 0x03, -+ H2C_8188F_DISCON_DECISION = 0x04, -+ H2C_8188F_PSD_OFFLOAD = 0x05, -+ H2C_8188F_AP_OFFLOAD = 0x08, -+ H2C_8188F_BCN_RSVDPAGE = 0x09, -+ H2C_8188F_PROBERSP_RSVDPAGE = 0x0A, -+ H2C_8188F_FCS_RSVDPAGE = 0x10, -+ H2C_8188F_FCS_INFO = 0x11, -+ H2C_8188F_AP_WOW_GPIO_CTRL = 0x13, -+ -+ //PoweSave Class: 001 -+ H2C_8188F_SET_PWR_MODE = 0x20, -+ H2C_8188F_PS_TUNING_PARA = 0x21, -+ H2C_8188F_PS_TUNING_PARA2 = 0x22, -+ H2C_8188F_P2P_LPS_PARAM = 0x23, -+ H2C_8188F_P2P_PS_OFFLOAD = 0x24, -+ H2C_8188F_PS_SCAN_ENABLE = 0x25, -+ H2C_8188F_SAP_PS_ = 0x26, -+ H2C_8188F_INACTIVE_PS_ = 0x27, //Inactive_PS -+ H2C_8188F_FWLPS_IN_IPS_ = 0x28, -+ -+ //Dynamic Mechanism Class: 010 -+ H2C_8188F_MACID_CFG = 0x40, -+ H2C_8188F_TXBF = 0x41, -+ H2C_8188F_RSSI_SETTING = 0x42, -+ H2C_8188F_AP_REQ_TXRPT = 0x43, -+ H2C_8188F_INIT_RATE_COLLECT = 0x44, -+ H2C_8188F_RA_PARA_ADJUST = 0x46, -+ -+ //BT Class: 011 -+ H2C_8188F_B_TYPE_TDMA = 0x60, -+ H2C_8188F_BT_INFO = 0x61, -+ H2C_8188F_FORCE_BT_TXPWR = 0x62, -+ H2C_8188F_BT_IGNORE_WLANACT = 0x63, -+ H2C_8188F_DAC_SWING_VALUE = 0x64, -+ H2C_8188F_ANT_SEL_RSV = 0x65, -+ H2C_8188F_WL_OPMODE = 0x66, -+ H2C_8188F_BT_MP_OPER = 0x67, -+ H2C_8188F_BT_CONTROL = 0x68, -+ H2C_8188F_BT_WIFI_CTRL = 0x69, -+ H2C_8188F_BT_FW_PATCH = 0x6A, -+ H2C_8188F_BT_WLAN_CALIBRATION = 0x6D, -+ -+ //WOWLAN Class: 100 -+ H2C_8188F_WOWLAN = 0x80, -+ H2C_8188F_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8188F_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8188F_AOAC_RSVD_PAGE = 0x83, -+ H2C_8188F_AOAC_RSVD_PAGE2 = 0x84, -+ H2C_8188F_D0_SCAN_OFFLOAD_CTRL = 0x85, -+ H2C_8188F_D0_SCAN_OFFLOAD_INFO = 0x86, -+ H2C_8188F_CHNL_SWITCH_OFFLOAD = 0x87, -+ H2C_8188F_P2P_OFFLOAD_RSVD_PAGE = 0x8A, -+ H2C_8188F_P2P_OFFLOAD = 0x8B, -+ -+ H2C_8188F_RESET_TSF = 0xC0, -+ H2C_8188F_MAXID, -+}; -+ -+//---------------------------------------------------------------------------------------------------------// -+//---------------------------------- H2C CMD CONTENT --------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+//_RSVDPAGE_LOC_CMD_0x00 -+#define SET_8188F_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_8188F_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8188F_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8188F_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8188F_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+ -+//_MEDIA_STATUS_RPT_PARM_CMD_0x01 -+#define SET_8188F_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8188F_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8188F_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8188F_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+2, 0, 8, __Value) -+ -+//_KEEP_ALIVE_CMD_0x03 -+#define SET_8188F_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8188F_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8188F_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8188F_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+ -+//_DISCONNECT_DECISION_CMD_0x04 -+#define SET_8188F_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8188F_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8188F_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8188F_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+2, 0, 8, __Value) -+ -+// _PWR_MOD_CMD_0x20 -+#define SET_8188F_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_8188F_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8188F_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8188F_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8188F_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8188F_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8188F_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+5, 0, 8, __Value) -+ -+#define GET_8188F_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+// _PS_TUNE_PARAM_CMD_0x21 -+#define SET_8188F_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8188F_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8188F_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) -+#define SET_8188F_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) -+#define SET_8188F_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+//_MACID_CFG_CMD_0x40 -+#define SET_8188F_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) -+ -+//_RSSI_SETTING_CMD_0x42 -+#define SET_8188F_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8188F_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) -+#define SET_8188F_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+// _AP_REQ_TXRPT_CMD_0x43 -+#define SET_8188F_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8188F_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+// _FORCE_BT_TXPWR_CMD_0x62 -+#define SET_8188F_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+ -+// _FORCE_BT_MP_OPER_CMD_0x67 -+#define SET_8188F_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_8188F_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_8188F_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8188F_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+#define SET_8188F_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8188F_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+ -+// _BT_FW_PATCH_0x6A -+#define SET_8188F_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) -+#define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+ -+//---------------------------------------------------------------------------------------------------------// -+//------------------------------------------- Structure --------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+ -+ -+//---------------------------------------------------------------------------------------------------------// -+//---------------------------------- Function Statement --------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+ -+// host message to firmware cmd -+void rtl8188f_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); -+void rtl8188f_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); -+void rtl8188f_set_rssi_cmd(PADAPTER padapter, u8 *param); -+void rtl8188f_Add_RateATid(PADAPTER pAdapter, u64 bitmap, u8* arg, u8 rssi_level); -+void rtl8188f_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); -+//s32 rtl8188f_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); -+void rtl8188f_set_FwPsTuneParam_cmd(PADAPTER padapter); -+void rtl8188f_set_FwMacIdConfig_cmd(_adapter* padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); -+void rtl8188f_set_FwMediaStatusRpt_cmd(PADAPTER padapter, u8 mstatus, u8 macid); -+void rtl8188f_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); -+void rtl8188f_download_rsvd_page(PADAPTER padapter, u8 mstatus); -+#ifdef CONFIG_BT_COEXIST -+void rtl8188f_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif // CONFIG_BT_COEXIST -+#ifdef CONFIG_P2P -+void rtl8188f_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif //CONFIG_P2P -+ -+void CheckFwRsvdPageContent(PADAPTER padapter); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void SetFwRelatedForWoWLAN8188f(_adapter* padapter, u8 bHostIsGoingtoSleep); -+#endif//CONFIG_WOWLAN -+ -+#ifdef CONFIG_P2P_WOWLAN -+void rtl8188f_set_p2p_wowlan_offload_cmd(PADAPTER padapter); -+#endif -+ -+void rtl8188f_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+u8 rtl8188f_reset_tsf(_adapter *padapter, u8 reset_port); -+#endif // CONFIG_TSF_RESET_OFFLOAD -+s32 FillH2CCmd8188F(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8188F(_adapter *padapter, bool wowlan); -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188f_dm.h linux/3rdparty/rtl8812au/include/rtl8188f_dm.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188f_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188f_dm.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_DM_H__ -+#define __RTL8188F_DM_H__ -+//============================================================ -+// Description: -+// -+// This file is for 8188F dynamic mechanism only -+// -+// -+//============================================================ -+ -+//============================================================ -+// structure and define -+//============================================================ -+ -+//============================================================ -+// function prototype -+//============================================================ -+ -+void rtl8188f_init_dm_priv(PADAPTER padapter); -+void rtl8188f_deinit_dm_priv(PADAPTER padapter); -+ -+void rtl8188f_InitHalDm(PADAPTER padapter); -+void rtl8188f_HalDmWatchDog(PADAPTER padapter); -+void rtl8188f_HalDmWatchDog_in_LPS(PADAPTER padapter); -+void rtl8188f_hal_dm_in_lps(PADAPTER padapter); -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188f_hal.h linux/3rdparty/rtl8812au/include/rtl8188f_hal.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188f_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188f_hal.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,342 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_HAL_H__ -+#define __RTL8188F_HAL_H__ -+ -+#include "hal_data.h" -+ -+#include "rtl8188f_spec.h" -+#include "rtl8188f_rf.h" -+#include "rtl8188f_dm.h" -+#include "rtl8188f_recv.h" -+#include "rtl8188f_xmit.h" -+#include "rtl8188f_cmd.h" -+#include "rtl8188f_led.h" -+#include "Hal8188FPwrSeq.h" -+#include "Hal8188FPhyReg.h" -+#include "Hal8188FPhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+#include "rtl8188f_sreset.h" -+#endif -+ -+ -+//--------------------------------------------------------------------- -+// RTL8188F From file -+//--------------------------------------------------------------------- -+ #define RTL8188F_FW_IMG "rtl8188f/FW_NIC.bin" -+ #define RTL8188F_FW_WW_IMG "rtl8188f/FW_WoWLAN.bin" -+ #define RTL8188F_PHY_REG "rtl8188f/PHY_REG.txt" -+ #define RTL8188F_PHY_RADIO_A "rtl8188f/RadioA.txt" -+ #define RTL8188F_PHY_RADIO_B "rtl8188f/RadioB.txt" -+ #define RTL8188F_TXPWR_TRACK "rtl8188f/TxPowerTrack.txt" -+ #define RTL8188F_AGC_TAB "rtl8188f/AGC_TAB.txt" -+ #define RTL8188F_PHY_MACREG "rtl8188f/MAC_REG.txt" -+ #define RTL8188F_PHY_REG_PG "rtl8188f/PHY_REG_PG.txt" -+ #define RTL8188F_PHY_REG_MP "rtl8188f/PHY_REG_MP.txt" -+ #define RTL8188F_TXPWR_LMT "rtl8188f/TXPWR_LMT.txt" -+ -+//--------------------------------------------------------------------- -+// RTL8188F From header -+//--------------------------------------------------------------------- -+ -+#if MP_DRIVER == 1 -+ #define Rtl8188F_FwBTImgArray Rtl8188FFwBTImgArray -+ #define Rtl8188F_FwBTImgArrayLength Rtl8188FFwBTImgArrayLength -+ -+ #define Rtl8188F_FwMPImageArray Rtl8188FFwMPImgArray -+ #define Rtl8188F_FwMPImgArrayLength Rtl8188FMPImgArrayLength -+ -+ #define Rtl8188F_PHY_REG_Array_MP Rtl8188F_PHYREG_Array_MP -+ #define Rtl8188F_PHY_REG_Array_MPLength Rtl8188F_PHYREG_Array_MPLength -+#endif -+ -+ -+#define FW_8188F_SIZE 0x8000 -+#define FW_8188F_START_ADDRESS 0x1000 -+#define FW_8188F_END_ADDRESS 0x1FFF //0x5FFF -+ -+#define IS_FW_HEADER_EXIST_8188F(_pFwHdr) ((le16_to_cpu(_pFwHdr->Signature)&0xFFF0) == 0x88F0) -+ -+typedef struct _RT_FIRMWARE { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8* szFwBuffer; -+#else -+ u8 szFwBuffer[FW_8188F_SIZE]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8188F, *PRT_FIRMWARE_8188F; -+ -+// -+// This structure must be cared byte-ordering -+// -+// Added by tynli. 2009.12.04. -+typedef struct _RT_8188F_FIRMWARE_HDR -+{ -+ // 8-byte alinment required -+ -+ //--- LONG WORD 0 ---- -+ u16 Signature; // 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut -+ u8 Category; // AP/NIC and USB/PCI -+ u8 Function; // Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions -+ u16 Version; // FW Version -+ u16 Subversion; // FW Subversion, default 0x00 -+ -+ //--- LONG WORD 1 ---- -+ u8 Month; // Release time Month field -+ u8 Date; // Release time Date field -+ u8 Hour; // Release time Hour field -+ u8 Minute; // Release time Minute field -+ u16 RamCodeSize; // The size of RAM code -+ u16 Rsvd2; -+ -+ //--- LONG WORD 2 ---- -+ u32 SvnIdx; // The SVN entry index -+ u32 Rsvd3; -+ -+ //--- LONG WORD 3 ---- -+ u32 Rsvd4; -+ u32 Rsvd5; -+}RT_8188F_FIRMWARE_HDR, *PRT_8188F_FIRMWARE_HDR; -+ -+#define DRIVER_EARLY_INT_TIME_8188F 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8188F 0x02 -+ -+// for 8188F -+// TX 32K, RX 16K, Page size 128B for TX, 8B for RX -+#define PAGE_SIZE_TX_8188F 128 -+#define PAGE_SIZE_RX_8188F 8 -+ -+#define RX_DMA_SIZE_8188F 0x4000 // 16K -+#ifdef CONFIG_FW_C2H_DEBUG -+#define RX_DMA_RESERVED_SIZE_8188F 0x100 // 256B, reserved for c2h debug message -+#else -+#define RX_DMA_RESERVED_SIZE_8188F 0x80 // 128B, reserved for tx report -+#endif -+ -+#ifdef CONFIG_WOWLAN -+#define RESV_FMWF WKFMCAM_SIZE*MAX_WKFM_NUM /* 16 entries, for each is 24 bytes*/ -+#else -+#define RESV_FMWF 0 -+#endif -+ -+#define RX_DMA_BOUNDARY_8188F (RX_DMA_SIZE_8188F - RX_DMA_RESERVED_SIZE_8188F - 1) -+ -+// Note: We will divide number of page equally for each queue other than public queue! -+ -+//For General Reserved Page Number(Beacon Queue is reserved page) -+//Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 -+#define BCNQ_PAGE_NUM_8188F 0x08 -+#ifdef CONFIG_CONCURRENT_MODE -+#define BCNQ1_PAGE_NUM_8188F 0x08 // 0x04 -+#else -+#define BCNQ1_PAGE_NUM_8188F 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+#undef BCNQ1_PAGE_NUM_8188F -+#define BCNQ1_PAGE_NUM_8188F 0x00 // 0x04 -+#endif -+ -+//For WoWLan , more reserved page -+//ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 -+#ifdef CONFIG_WOWLAN -+#define WOWLAN_PAGE_NUM_8188F 0x07 -+#else -+#define WOWLAN_PAGE_NUM_8188F 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+#undef WOWLAN_PAGE_NUM_8188F -+#define WOWLAN_PAGE_NUM_8188F 0x15 -+#endif -+ -+#ifdef CONFIG_AP_WOWLAN -+#define AP_WOWLAN_PAGE_NUM_8188F 0x02 -+#endif -+ -+#define TX_TOTAL_PAGE_NUMBER_8188F (0xFF - BCNQ_PAGE_NUM_8188F - BCNQ1_PAGE_NUM_8188F - WOWLAN_PAGE_NUM_8188F) -+#define TX_PAGE_BOUNDARY_8188F (TX_TOTAL_PAGE_NUMBER_8188F + 1) -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8188F TX_TOTAL_PAGE_NUMBER_8188F -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8188F (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8188F + 1) -+ -+// For Normal Chip Setting -+// (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8188F -+#define NORMAL_PAGE_NUM_HPQ_8188F 0x0C -+#define NORMAL_PAGE_NUM_LPQ_8188F 0x02 -+#define NORMAL_PAGE_NUM_NPQ_8188F 0x02 -+ -+// Note: For Normal Chip Setting, modify later -+#define WMM_NORMAL_PAGE_NUM_HPQ_8188F 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8188F 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8188F 0x20 -+ -+ -+#include "HalVerDef.h" -+#include "hal_com.h" -+ -+#define EFUSE_OOB_PROTECT_BYTES 15 -+ -+#define HAL_EFUSE_MEMORY -+ -+#define HWSET_MAX_SIZE_8188F 512 -+#define EFUSE_REAL_CONTENT_LEN_8188F 512 -+#define EFUSE_MAP_LEN_8188F 512 -+#define EFUSE_MAX_SECTION_8188F 64 -+ -+#define EFUSE_IC_ID_OFFSET 506 //For some inferiority IC purpose. added by Roger, 2009.09.02. -+#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8188F) -+ -+#define EFUSE_ACCESS_ON 0x69 // For RTL8188 only. -+#define EFUSE_ACCESS_OFF 0x00 // For RTL8188 only. -+ -+//======================================================== -+// EFUSE for BT definition -+//======================================================== -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN 512 -+#define EFUSE_BT_REAL_CONTENT_LEN 1536 // 512*3 -+#define EFUSE_BT_MAP_LEN 1024 // 1k bytes -+#define EFUSE_BT_MAX_SECTION 128 // 1024/8 -+ -+#define EFUSE_PROTECT_BYTES_BANK 16 -+ -+// Description: Determine the types of C2H events that are the same in driver and Fw. -+// Fisrt constructed by tynli. 2009.10.09. -+typedef enum _C2H_EVT -+{ -+ C2H_DBG = 0, -+ C2H_TSF = 1, -+ C2H_AP_RPT_RSP = 2, -+ C2H_CCX_TX_RPT = 3, // The FW notify the report of the specific tx packet. -+ C2H_BT_RSSI = 4, -+ C2H_BT_OP_MODE = 5, -+ C2H_EXT_RA_RPT = 6, -+ C2H_8188F_BT_INFO = 9, -+ C2H_HW_INFO_EXCH = 10, -+ C2H_8188F_BT_MP_INFO = 11, -+ C2H_8188F_P2P_RPORT = 0x16, -+#ifdef CONFIG_FW_C2H_DEBUG -+ C2H_8188F_FW_DEBUG = 0xff, -+#endif //CONFIG_FW_C2H_DEBUG -+ MAX_C2HEVENT -+} C2H_EVT; -+ -+typedef struct _C2H_EVT_HDR -+{ -+ u8 CmdID; -+ u8 CmdLen; -+ u8 CmdSeq; -+} __attribute__((__packed__)) C2H_EVT_HDR, *PC2H_EVT_HDR; -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+// rtl8188a_hal_init.c -+s32 rtl8188f_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); -+void rtl8188f_FirmwareSelfReset(PADAPTER padapter); -+void rtl8188f_InitializeFirmwareVars(PADAPTER padapter); -+ -+void rtl8188f_InitAntenna_Selection(PADAPTER padapter); -+void rtl8188f_DeinitAntenna_Selection(PADAPTER padapter); -+void rtl8188f_CheckAntenna_Selection(PADAPTER padapter); -+void rtl8188f_init_default_value(PADAPTER padapter); -+ -+s32 rtl8188f_InitLLTTable(PADAPTER padapter); -+ -+s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU); -+s32 CardDisableWithoutHWSM(PADAPTER padapter); -+ -+// EFuse -+u8 GetEEPROMSize8188F(PADAPTER padapter); -+void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); -+void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); -+void Hal_EfuseParseTxPowerInfo_8188F(PADAPTER padapter, u8 *PROMContent, BOOLEAN AutoLoadFail); -+/* void Hal_EfuseParseBTCoexistInfo_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); */ -+void Hal_EfuseParseEEPROMVer_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseChnlPlan_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseCustomerID_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParsePowerSavingMode_8188F(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseAntennaDiversity_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseXtal_8188F(PADAPTER pAdapter, u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParseThermalMeter_8188F(PADAPTER padapter, u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParseKFreeData_8188F(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+VOID Hal_EfuseParseMacHidden_8188F(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+ -+#if 0 /* Do not need for rtl8188f */ -+VOID Hal_EfuseParseVoltage_8188F(PADAPTER pAdapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+#endif -+ -+#ifdef CONFIG_C2H_PACKET_EN -+void rtl8188f_c2h_packet_handler(PADAPTER padapter, u8 *pbuf, u16 length); -+#endif -+ -+void rtl8188f_set_pll_ref_clk_sel(_adapter *adapter, u8 sel); -+ -+void rtl8188f_set_hal_ops(struct hal_ops *pHalFunc); -+void SetHwReg8188F(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg8188F(PADAPTER padapter, u8 variable, u8 *val); -+#ifdef CONFIG_C2H_PACKET_EN -+void SetHwRegWithBuf8188F(PADAPTER padapter, u8 variable, u8 *pbuf, int len); -+#endif // CONFIG_C2H_PACKET_EN -+u8 SetHalDefVar8188F(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8188F(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+ -+// register -+void rtl8188f_InitBeaconParameters(PADAPTER padapter); -+void rtl8188f_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); -+void _InitBurstPktLen_8188FS(PADAPTER Adapter); -+void _8051Reset8188(PADAPTER padapter); -+#ifdef CONFIG_WOWLAN -+void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif //CONFIG_WOWLAN -+ -+void rtl8188f_start_thread(_adapter *padapter); -+void rtl8188f_stop_thread(_adapter *padapter); -+ -+#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) -+void rtl8188fs_init_checkbthang_workqueue(_adapter * adapter); -+void rtl8188fs_free_checkbthang_workqueue(_adapter * adapter); -+void rtl8188fs_cancle_checkbthang_workqueue(_adapter * adapter); -+void rtl8188fs_hal_check_bt_hang(_adapter * adapter); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); -+#endif -+ -+int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); -+ -+void CCX_FwC2HTxRpt_8188f(PADAPTER padapter, u8 *pdata, u8 len); -+#ifdef CONFIG_FW_C2H_DEBUG -+void Debug_FwC2H_8188f(PADAPTER padapter, u8 *pdata, u8 len); -+#endif //CONFIG_FW_C2H_DEBUG -+s32 c2h_id_filter_ccx_8188f(u8 *buf); -+s32 c2h_handler_8188f(PADAPTER padapter, u8 *pC2hEvent); -+u8 MRateToHwRate8188F(u8 rate); -+u8 HwRateToMRate8188F(u8 rate); -+ -+#ifdef CONFIG_PCI_HCI -+BOOLEAN InterruptRecognized8188FE(PADAPTER Adapter); -+VOID UpdateInterruptMask8188FE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188f_led.h linux/3rdparty/rtl8812au/include/rtl8188f_led.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188f_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188f_led.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_LED_H__ -+#define __RTL8188F_LED_H__ -+ -+#include -+#include -+#include -+ -+ -+//================================================================================ -+// Interface to manipulate LED objects. -+//================================================================================ -+#ifdef CONFIG_USB_HCI -+void rtl8188fu_InitSwLeds(PADAPTER padapter); -+void rtl8188fu_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_SDIO_HCI -+void rtl8188fs_InitSwLeds(PADAPTER padapter); -+void rtl8188fs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_GSPI_HCI -+void rtl8188fs_InitSwLeds(PADAPTER padapter); -+void rtl8188fs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+void rtl8188fe_InitSwLeds(PADAPTER padapter); -+void rtl8188fe_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188f_recv.h linux/3rdparty/rtl8812au/include/rtl8188f_recv.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188f_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188f_recv.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,73 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_RECV_H__ -+#define __RTL8188F_RECV_H__ -+ -+#if defined(CONFIG_USB_HCI) -+ #ifndef MAX_RECVBUF_SZ -+ #ifdef PLATFORM_OS_CE -+ #define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+ #else -+ #ifdef CONFIG_MINIMAL_MEMORY_USAGE -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+ #else -+ #ifdef CONFIG_PLATFORM_MSTAR -+ #define MAX_RECVBUF_SZ (8192) // 8K -+ #elif defined(CONFIG_PLATFORM_HISILICON) -+ #define MAX_RECVBUF_SZ (16384) /* 16k */ -+ #else -+ #define MAX_RECVBUF_SZ (32768) /* 32k */ -+ #endif -+ //#define MAX_RECVBUF_SZ (20480) //20K -+ //#define MAX_RECVBUF_SZ (10240) //10K -+ //#define MAX_RECVBUF_SZ (16384) // 16k - 92E RX BUF :16K -+ //#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+ #endif -+ #endif -+ #endif //!MAX_RECVBUF_SZ -+#elif defined(CONFIG_PCI_HCI) -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+#elif defined(CONFIG_SDIO_HCI) -+ #define MAX_RECVBUF_SZ (RX_DMA_BOUNDARY_8188F + 1) -+#endif /* CONFIG_SDIO_HCI */ -+ -+// Rx smooth factor -+#define Rx_Smooth_Factor (20) -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+s32 rtl8188fs_init_recv_priv(PADAPTER padapter); -+void rtl8188fs_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+int rtl8188fu_init_recv_priv(_adapter *padapter); -+void rtl8188fu_free_recv_priv (_adapter *padapter); -+void rtl8188fu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8188fe_init_recv_priv(PADAPTER padapter); -+void rtl8188fe_free_recv_priv(PADAPTER padapter); -+#endif -+ -+void rtl8188f_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8188F_RECV_H__ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188f_rf.h linux/3rdparty/rtl8812au/include/rtl8188f_rf.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188f_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188f_rf.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_RF_H__ -+#define __RTL8188F_RF_H__ -+ -+int PHY_RF6052_Config8188F( IN PADAPTER Adapter ); -+ -+VOID -+PHY_RF6052SetBandwidth8188F( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188f_spec.h linux/3rdparty/rtl8812au/include/rtl8188f_spec.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188f_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188f_spec.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,300 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8188F_SPEC_H__ -+#define __RTL8188F_SPEC_H__ -+ -+#include -+ -+ -+#define HAL_NAV_UPPER_UNIT_8188F 128 // micro-second -+ -+//----------------------------------------------------- -+// -+// 0x0000h ~ 0x00FFh System Configuration -+// -+//----------------------------------------------------- -+#define REG_RSV_CTRL_8188F 0x001C // 3 Byte -+#define REG_BT_WIFI_ANTENNA_SWITCH_8188F 0x0038 -+#define REG_HSISR_8188F 0x005c -+#define REG_PAD_CTRL1_8188F 0x0064 -+#define REG_AFE_CTRL_4_8188F 0x0078 -+#define REG_HMEBOX_DBG_0_8188F 0x0088 -+#define REG_HMEBOX_DBG_1_8188F 0x008A -+#define REG_HMEBOX_DBG_2_8188F 0x008C -+#define REG_HMEBOX_DBG_3_8188F 0x008E -+#define REG_HIMR0_8188F 0x00B0 -+#define REG_HISR0_8188F 0x00B4 -+#define REG_HIMR1_8188F 0x00B8 -+#define REG_HISR1_8188F 0x00BC -+#define REG_PMC_DBG_CTRL2_8188F 0x00CC -+ -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+#define REG_C2HEVT_CMD_ID_8188F 0x01A0 -+#define REG_C2HEVT_CMD_LEN_8188F 0x01AE -+#define REG_WOWLAN_WAKE_REASON 0x01C7 -+#define REG_WOWLAN_GTK_DBG1 0x630 -+#define REG_WOWLAN_GTK_DBG2 0x634 -+ -+#define REG_HMEBOX_EXT0_8188F 0x01F0 -+#define REG_HMEBOX_EXT1_8188F 0x01F4 -+#define REG_HMEBOX_EXT2_8188F 0x01F8 -+#define REG_HMEBOX_EXT3_8188F 0x01FC -+ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x02FFh RXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_RXDMA_CONTROL_8188F 0x0286 // Control the RX DMA. -+#define REG_RXDMA_MODE_CTRL_8188F 0x0290 -+ -+//----------------------------------------------------- -+// -+// 0x0300h ~ 0x03FFh PCIe -+// -+//----------------------------------------------------- -+#define REG_PCIE_CTRL_REG_8188F 0x0300 -+#define REG_INT_MIG_8188F 0x0304 // Interrupt Migration -+#define REG_BCNQ_DESA_8188F 0x0308 // TX Beacon Descriptor Address -+#define REG_HQ_DESA_8188F 0x0310 // TX High Queue Descriptor Address -+#define REG_MGQ_DESA_8188F 0x0318 // TX Manage Queue Descriptor Address -+#define REG_VOQ_DESA_8188F 0x0320 // TX VO Queue Descriptor Address -+#define REG_VIQ_DESA_8188F 0x0328 // TX VI Queue Descriptor Address -+#define REG_BEQ_DESA_8188F 0x0330 // TX BE Queue Descriptor Address -+#define REG_BKQ_DESA_8188F 0x0338 // TX BK Queue Descriptor Address -+#define REG_RX_DESA_8188F 0x0340 // RX Queue Descriptor Address -+#define REG_DBI_WDATA_8188F 0x0348 // DBI Write Data -+#define REG_DBI_RDATA_8188F 0x034C // DBI Read Data -+#define REG_DBI_ADDR_8188F 0x0350 // DBI Address -+#define REG_DBI_FLAG_8188F 0x0352 // DBI Read/Write Flag -+#define REG_MDIO_WDATA_8188F 0x0354 // MDIO for Write PCIE PHY -+#define REG_MDIO_RDATA_8188F 0x0356 // MDIO for Reads PCIE PHY -+#define REG_MDIO_CTL_8188F 0x0358 // MDIO for Control -+#define REG_DBG_SEL_8188F 0x0360 // Debug Selection Register -+#define REG_PCIE_HRPWM_8188F 0x0361 //PCIe RPWM -+#define REG_PCIE_HCPWM_8188F 0x0363 //PCIe CPWM -+#define REG_PCIE_MULTIFET_CTRL_8188F 0x036A //PCIE Multi-Fethc Control -+ -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+#define REG_TXPKTBUF_BCNQ_BDNY_8188F 0x0424 -+#define REG_TXPKTBUF_MGQ_BDNY_8188F 0x0425 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8188F 0x045D -+#ifdef CONFIG_WOWLAN -+#define REG_TXPKTBUF_IV_LOW 0x0484 -+#define REG_TXPKTBUF_IV_HIGH 0x0488 -+#endif -+#define REG_AMPDU_BURST_MODE_8188F 0x04BC -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+#define REG_SECONDARY_CCA_CTRL_8188F 0x0577 -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+ -+ -+//============================================================ -+// SDIO Bus Specification -+//============================================================ -+ -+//----------------------------------------------------- -+// SDIO CMD Address Mapping -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// I/O bus domain (Host) -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// SDIO register -+//----------------------------------------------------- -+#define SDIO_REG_HIQ_FREEPG_8188F 0x0020 -+#define SDIO_REG_MID_FREEPG_8188F 0x0022 -+#define SDIO_REG_LOW_FREEPG_8188F 0x0024 -+#define SDIO_REG_PUB_FREEPG_8188F 0x0026 -+#define SDIO_REG_EXQ_FREEPG_8188F 0x0028 -+#define SDIO_REG_AC_OQT_FREEPG_8188F 0x002A -+#define SDIO_REG_NOAC_OQT_FREEPG_8188F 0x002B -+ -+#define SDIO_REG_HCPWM1_8188F 0x0038 -+ -+/* indirect access */ -+#define SDIO_REG_INDIRECT_REG_CFG_8188F 0x40 -+#define SET_INDIRECT_REG_ADDR(_cmd, _addr) SET_BITS_TO_LE_2BYTE(((u8 *)(_cmd)) + 0, 0, 16, (_addr)) -+#define SET_INDIRECT_REG_SIZE_1BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 0) -+#define SET_INDIRECT_REG_SIZE_2BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 1) -+#define SET_INDIRECT_REG_SIZE_4BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 2) -+#define SET_INDIRECT_REG_WRITE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 2, 1, 1) -+#define SET_INDIRECT_REG_READ(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 3, 1, 1) -+#define GET_INDIRECT_REG_RDY(_cmd) LE_BITS_TO_1BYTE(((u8 *)(_cmd)) + 2, 4, 1) -+ -+#define SDIO_REG_INDIRECT_REG_DATA_8188F 0x44 -+ -+//============================================================================ -+// 8188 Regsiter Bit and Content definition -+//============================================================================ -+ -+//2 HSISR -+// interrupt mask which needs to clear -+#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ -+ HSISR_SPS_OCP_INT |\ -+ HSISR_RON_INT |\ -+ HSISR_PDNINT |\ -+ HSISR_GPIO9_INT) -+ -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+ -+ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x02FFh RXDMA Configuration -+// -+//----------------------------------------------------- -+#define BIT_USB_RXDMA_AGG_EN BIT(31) -+#define RXDMA_AGG_MODE_EN BIT(1) -+ -+#ifdef CONFIG_WOWLAN -+#define RXPKT_RELEASE_POLL BIT(16) -+#define RXDMA_IDLE BIT(17) -+#define RW_RELEASE_EN BIT(18) -+#endif -+ -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+ -+//---------------------------------------------------------------------------- -+// 8188F REG_CCK_CHECK (offset 0x454) -+//---------------------------------------------------------------------------- -+#define BIT_BCN_PORT_SEL BIT5 -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+ -+//---------------------------------------------------------------------------- -+// 8195 IMR/ISR bits (offset 0xB0, 8bits) -+//---------------------------------------------------------------------------- -+#define IMR_DISABLED_8188F 0 -+// IMR DW0(0x00B0-00B3) Bit 0-31 -+#define IMR_TIMER2_8188F BIT31 // Timeout interrupt 2 -+#define IMR_TIMER1_8188F BIT30 // Timeout interrupt 1 -+#define IMR_PSTIMEOUT_8188F BIT29 // Power Save Time Out Interrupt -+#define IMR_GTINT4_8188F BIT28 // When GTIMER4 expires, this bit is set to 1 -+#define IMR_GTINT3_8188F BIT27 // When GTIMER3 expires, this bit is set to 1 -+#define IMR_TXBCN0ERR_8188F BIT26 // Transmit Beacon0 Error -+#define IMR_TXBCN0OK_8188F BIT25 // Transmit Beacon0 OK -+#define IMR_TSF_BIT32_TOGGLE_8188F BIT24 // TSF Timer BIT32 toggle indication interrupt -+#define IMR_BCNDMAINT0_8188F BIT20 // Beacon DMA Interrupt 0 -+#define IMR_BCNDERR0_8188F BIT16 // Beacon Queue DMA OK0 -+#define IMR_HSISR_IND_ON_INT_8188F BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) -+#define IMR_BCNDMAINT_E_8188F BIT14 // Beacon DMA Interrupt Extension for Win7 -+#define IMR_ATIMEND_8188F BIT12 // CTWidnow End or ATIM Window End -+#define IMR_C2HCMD_8188F BIT10 // CPU to Host Command INT Status, Write 1 clear -+#define IMR_CPWM2_8188F BIT9 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_CPWM_8188F BIT8 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_HIGHDOK_8188F BIT7 // High Queue DMA OK -+#define IMR_MGNTDOK_8188F BIT6 // Management Queue DMA OK -+#define IMR_BKDOK_8188F BIT5 // AC_BK DMA OK -+#define IMR_BEDOK_8188F BIT4 // AC_BE DMA OK -+#define IMR_VIDOK_8188F BIT3 // AC_VI DMA OK -+#define IMR_VODOK_8188F BIT2 // AC_VO DMA OK -+#define IMR_RDU_8188F BIT1 // Rx Descriptor Unavailable -+#define IMR_ROK_8188F BIT0 // Receive DMA OK -+ -+// IMR DW1(0x00B4-00B7) Bit 0-31 -+#define IMR_BCNDMAINT7_8188F BIT27 // Beacon DMA Interrupt 7 -+#define IMR_BCNDMAINT6_8188F BIT26 // Beacon DMA Interrupt 6 -+#define IMR_BCNDMAINT5_8188F BIT25 // Beacon DMA Interrupt 5 -+#define IMR_BCNDMAINT4_8188F BIT24 // Beacon DMA Interrupt 4 -+#define IMR_BCNDMAINT3_8188F BIT23 // Beacon DMA Interrupt 3 -+#define IMR_BCNDMAINT2_8188F BIT22 // Beacon DMA Interrupt 2 -+#define IMR_BCNDMAINT1_8188F BIT21 // Beacon DMA Interrupt 1 -+#define IMR_BCNDOK7_8188F BIT20 // Beacon Queue DMA OK Interrup 7 -+#define IMR_BCNDOK6_8188F BIT19 // Beacon Queue DMA OK Interrup 6 -+#define IMR_BCNDOK5_8188F BIT18 // Beacon Queue DMA OK Interrup 5 -+#define IMR_BCNDOK4_8188F BIT17 // Beacon Queue DMA OK Interrup 4 -+#define IMR_BCNDOK3_8188F BIT16 // Beacon Queue DMA OK Interrup 3 -+#define IMR_BCNDOK2_8188F BIT15 // Beacon Queue DMA OK Interrup 2 -+#define IMR_BCNDOK1_8188F BIT14 // Beacon Queue DMA OK Interrup 1 -+#define IMR_ATIMEND_E_8188F BIT13 // ATIM Window End Extension for Win7 -+#define IMR_TXERR_8188F BIT11 // Tx Error Flag Interrupt Status, write 1 clear. -+#define IMR_RXERR_8188F BIT10 // Rx Error Flag INT Status, Write 1 clear -+#define IMR_TXFOVW_8188F BIT9 // Transmit FIFO Overflow -+#define IMR_RXFOVW_8188F BIT8 // Receive FIFO Overflow -+ -+#ifdef CONFIG_PCI_HCI -+//#define IMR_RX_MASK (IMR_ROK_8188F|IMR_RDU_8188F|IMR_RXFOVW_8188F) -+#define IMR_TX_MASK (IMR_VODOK_8188F|IMR_VIDOK_8188F|IMR_BEDOK_8188F|IMR_BKDOK_8188F|IMR_MGNTDOK_8188F|IMR_HIGHDOK_8188F) -+ -+#define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8188F | IMR_TXBCN0OK_8188F | IMR_TXBCN0ERR_8188F | IMR_BCNDERR0_8188F) -+ -+#define RT_AC_INT_MASKS (IMR_VIDOK_8188F | IMR_VODOK_8188F | IMR_BEDOK_8188F|IMR_BKDOK_8188F) -+#endif -+ -+//======================================================== -+// General definitions -+//======================================================== -+ -+#define MACID_NUM_8188F 16 -+#define SEC_CAM_ENT_NUM_8188F 16 -+#define NSS_NUM_8188F 1 -+ -+#endif /* __RTL8188F_SPEC_H__ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188f_sreset.h linux/3rdparty/rtl8812au/include/rtl8188f_sreset.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188f_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188f_sreset.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8188F_SRESET_H_ -+#define _RTL8188F_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+extern void rtl8188f_sreset_xmit_status_check(_adapter *padapter); -+extern void rtl8188f_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8188f_xmit.h linux/3rdparty/rtl8812au/include/rtl8188f_xmit.h ---- linux.old/3rdparty/rtl8812au/include/rtl8188f_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8188f_xmit.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,336 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_XMIT_H__ -+#define __RTL8188F_XMIT_H__ -+ -+ -+#define MAX_TID (15) -+ -+ -+#ifndef __INC_HAL8188FDESC_H -+#define __INC_HAL8188FDESC_H -+ -+#define RX_STATUS_DESC_SIZE_8188F 24 -+#define RX_DRV_INFO_SIZE_UNIT_8188F 8 -+ -+ -+//DWORD 0 -+#define SET_RX_STATUS_DESC_PKT_LEN_8188F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_8188F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_8188F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 31, 1, __Value) -+ -+#define GET_RX_STATUS_DESC_PKT_LEN_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICV_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_LAST_SEG_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 28, 1) -+#define GET_RX_STATUS_DESC_FIRST_SEG_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 29, 1) -+#define GET_RX_STATUS_DESC_EOR_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_OWN_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 31, 1) -+ -+//DWORD 1 -+#define GET_RX_STATUS_DESC_MACID_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_TID_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_AMSDU_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_A1_FIT_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 16, 4) -+#define GET_RX_STATUS_DESC_CHKERR_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_IPVER_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_IS_TCPUDP__8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_CHK_VLD_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_MC_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 31, 1) -+ -+//DWORD 2 -+#define GET_RX_STATUS_DESC_SEQ_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 12, 4) -+#define GET_RX_STATUS_DESC_RX_IS_QOS_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 16, 1) -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_RPT_SEL_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 28, 1) -+ -+//DWORD 3 -+#define GET_RX_STATUS_DESC_RX_RATE_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_HTC_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 12, 2) -+#ifdef CONFIG_USB_RX_AGGREGATION -+#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 16, 8) -+#endif -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_MATCH_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_MATCH_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 31, 1) -+ -+//DWORD 6 -+#define GET_RX_STATUS_DESC_SPLCP_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 0, 1) -+#define GET_RX_STATUS_DESC_LDPC_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 1, 1) -+#define GET_RX_STATUS_DESC_STBC_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 2, 1) -+#define GET_RX_STATUS_DESC_BW_8188F(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 4, 2) -+ -+//DWORD 5 -+#define GET_RX_STATUS_DESC_TSFL_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+20, 0, 32) -+ -+#define GET_RX_STATUS_DESC_BUFF_ADDR_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+#define GET_RX_STATUS_DESC_BUFF_ADDR64_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+#define SET_RX_STATUS_DESC_BUFF_ADDR_8188F(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) -+ -+ -+// Dword 0 -+#define GET_TX_DESC_OWN_8188F(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+#define SET_TX_DESC_PKT_SIZE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define SET_TX_DESC_OFFSET_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define SET_TX_DESC_BMC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_LAST_SEG_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+#define SET_TX_DESC_FIRST_SEG_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_LINIP_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+#define SET_TX_DESC_NO_ACM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+#define SET_TX_DESC_OWN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+// Dword 1 -+#define SET_TX_DESC_MACID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+ -+ -+// Dword 2 -+#define SET_TX_DESC_PAID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+#define SET_TX_DESC_CCA_RTS_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_AGG_BREAK_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define SET_TX_DESC_RAW_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define SET_TX_DESC_SPE_RPT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_INT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_GID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+ -+ -+// Dword 3 -+#define SET_TX_DESC_WHEADER_LEN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) -+#define SET_TX_DESC_CHK_EN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) -+#define SET_TX_DESC_EARLY_MODE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HWSEQ_SEL_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_NAV_USE_HDR_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_NDPA_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+// Dword 4 -+#define SET_TX_DESC_TX_RATE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+ -+ -+// Dword 5 -+#define SET_TX_DESC_DATA_SC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_LDPC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+#define SET_TX_DESC_DATA_STBC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_CTROL_STBC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+ -+ -+// Dword 6 -+#define SET_TX_DESC_SW_DEFINE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_MBSSID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+#define SET_TX_DESC_ANTSEL_A_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+#define SET_TX_DESC_ANTSEL_B_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) -+#define SET_TX_DESC_ANTSEL_C_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) -+#define SET_TX_DESC_ANTSEL_D_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) -+ -+// Dword 7 -+#if(DEV_BUS_TYPE == RT_PCI_INTERFACE) -+#define SET_TX_DESC_TX_BUFFER_SIZE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#else -+#define SET_TX_DESC_TX_DESC_CHECKSUM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+#define SET_TX_DESC_USB_TXAGG_NUM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+#if(DEV_BUS_TYPE == RT_SDIO_INTERFACE) -+#define SET_TX_DESC_SDIO_TXSEQ_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) -+#endif -+ -+// Dword 8 -+#define SET_TX_DESC_HWSEQ_EN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+ -+// Dword 9 -+#define SET_TX_DESC_SEQ_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+ -+// Dword 10 -+#define SET_TX_DESC_TX_BUFFER_ADDRESS_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) -+#define GET_TX_DESC_TX_BUFFER_ADDRESS_8188F(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+40, 0, 32) -+ -+// Dword 11 -+#define SET_TX_DESC_NEXT_DESC_ADDRESS_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) -+ -+ -+#define SET_EARLYMODE_PKTNUM_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+#endif -+//----------------------------------------------------------- -+// -+// Rate -+// -+//----------------------------------------------------------- -+// CCK Rates, TxHT = 0 -+#define DESC8188F_RATE1M 0x00 -+#define DESC8188F_RATE2M 0x01 -+#define DESC8188F_RATE5_5M 0x02 -+#define DESC8188F_RATE11M 0x03 -+ -+// OFDM Rates, TxHT = 0 -+#define DESC8188F_RATE6M 0x04 -+#define DESC8188F_RATE9M 0x05 -+#define DESC8188F_RATE12M 0x06 -+#define DESC8188F_RATE18M 0x07 -+#define DESC8188F_RATE24M 0x08 -+#define DESC8188F_RATE36M 0x09 -+#define DESC8188F_RATE48M 0x0a -+#define DESC8188F_RATE54M 0x0b -+ -+// MCS Rates, TxHT = 1 -+#define DESC8188F_RATEMCS0 0x0c -+#define DESC8188F_RATEMCS1 0x0d -+#define DESC8188F_RATEMCS2 0x0e -+#define DESC8188F_RATEMCS3 0x0f -+#define DESC8188F_RATEMCS4 0x10 -+#define DESC8188F_RATEMCS5 0x11 -+#define DESC8188F_RATEMCS6 0x12 -+#define DESC8188F_RATEMCS7 0x13 -+#define DESC8188F_RATEMCS8 0x14 -+#define DESC8188F_RATEMCS9 0x15 -+#define DESC8188F_RATEMCS10 0x16 -+#define DESC8188F_RATEMCS11 0x17 -+#define DESC8188F_RATEMCS12 0x18 -+#define DESC8188F_RATEMCS13 0x19 -+#define DESC8188F_RATEMCS14 0x1a -+#define DESC8188F_RATEMCS15 0x1b -+#define DESC8188F_RATEVHTSS1MCS0 0x2c -+#define DESC8188F_RATEVHTSS1MCS1 0x2d -+#define DESC8188F_RATEVHTSS1MCS2 0x2e -+#define DESC8188F_RATEVHTSS1MCS3 0x2f -+#define DESC8188F_RATEVHTSS1MCS4 0x30 -+#define DESC8188F_RATEVHTSS1MCS5 0x31 -+#define DESC8188F_RATEVHTSS1MCS6 0x32 -+#define DESC8188F_RATEVHTSS1MCS7 0x33 -+#define DESC8188F_RATEVHTSS1MCS8 0x34 -+#define DESC8188F_RATEVHTSS1MCS9 0x35 -+#define DESC8188F_RATEVHTSS2MCS0 0x36 -+#define DESC8188F_RATEVHTSS2MCS1 0x37 -+#define DESC8188F_RATEVHTSS2MCS2 0x38 -+#define DESC8188F_RATEVHTSS2MCS3 0x39 -+#define DESC8188F_RATEVHTSS2MCS4 0x3a -+#define DESC8188F_RATEVHTSS2MCS5 0x3b -+#define DESC8188F_RATEVHTSS2MCS6 0x3c -+#define DESC8188F_RATEVHTSS2MCS7 0x3d -+#define DESC8188F_RATEVHTSS2MCS8 0x3e -+#define DESC8188F_RATEVHTSS2MCS9 0x3f -+ -+ -+#define RX_HAL_IS_CCK_RATE_8188F(pDesc)\ -+ (GET_RX_STATUS_DESC_RX_RATE_8188F(pDesc) == DESC8188F_RATE1M ||\ -+ GET_RX_STATUS_DESC_RX_RATE_8188F(pDesc) == DESC8188F_RATE2M ||\ -+ GET_RX_STATUS_DESC_RX_RATE_8188F(pDesc) == DESC8188F_RATE5_5M ||\ -+ GET_RX_STATUS_DESC_RX_RATE_8188F(pDesc) == DESC8188F_RATE11M) -+ -+ -+void rtl8188f_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); -+void rtl8188f_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+s32 rtl8188fs_init_xmit_priv(PADAPTER padapter); -+void rtl8188fs_free_xmit_priv(PADAPTER padapter); -+s32 rtl8188fs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8188fs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8188fs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtl8188fs_xmit_buf_handler(PADAPTER padapter); -+thread_return rtl8188fs_xmit_thread(thread_context context); -+#define hal_xmit_handler rtl8188fs_xmit_buf_handler -+#endif -+ -+#ifdef CONFIG_USB_HCI -+s32 rtl8188fu_xmit_buf_handler(PADAPTER padapter); -+#define hal_xmit_handler rtl8188fu_xmit_buf_handler -+ -+ -+s32 rtl8188fu_init_xmit_priv(PADAPTER padapter); -+void rtl8188fu_free_xmit_priv(PADAPTER padapter); -+s32 rtl8188fu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8188fu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8188fu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+//s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); -+void rtl8188fu_xmit_tasklet(void *priv); -+s32 rtl8188fu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+void _dbg_dump_tx_info(_adapter *padapter,int frame_tag,struct tx_desc *ptxdesc); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8188fe_init_xmit_priv(PADAPTER padapter); -+void rtl8188fe_free_xmit_priv(PADAPTER padapter); -+struct xmit_buf *rtl8188fe_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+void rtl8188fe_xmitframe_resume(_adapter *padapter); -+s32 rtl8188fe_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8188fe_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8188fe_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+void rtl8188fe_xmit_tasklet(void *priv); -+#endif -+ -+u8 BWMapping_8188F(PADAPTER Adapter, struct pkt_attrib *pattrib); -+u8 SCMapping_8188F(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8192e_cmd.h linux/3rdparty/rtl8812au/include/rtl8192e_cmd.h ---- linux.old/3rdparty/rtl8812au/include/rtl8192e_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8192e_cmd.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,198 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_CMD_H__ -+#define __RTL8192E_CMD_H__ -+ -+typedef enum _RTL8192E_H2C_CMD -+{ -+ H2C_8192E_RSVDPAGE = 0x00, -+ H2C_8192E_MSRRPT = 0x01, -+ H2C_8192E_SCAN = 0x02, -+ H2C_8192E_KEEP_ALIVE_CTRL = 0x03, -+ H2C_8192E_DISCONNECT_DECISION = 0x04, -+ H2C_8192E_INIT_OFFLOAD = 0x06, -+ H2C_8192E_AP_OFFLOAD = 0x08, -+ H2C_8192E_BCN_RSVDPAGE = 0x09, -+ H2C_8192E_PROBERSP_RSVDPAGE = 0x0a, -+ -+ H2C_8192E_AP_WOW_GPIO_CTRL = 0x13, -+ -+ H2C_8192E_SETPWRMODE = 0x20, -+ H2C_8192E_PS_TUNING_PARA = 0x21, -+ H2C_8192E_PS_TUNING_PARA2 = 0x22, -+ H2C_8192E_PS_LPS_PARA = 0x23, -+ H2C_8192E_P2P_PS_OFFLOAD = 0x24, -+ H2C_8192E_SAP_PS = 0x26, -+ H2C_8192E_RA_MASK = 0x40, -+ H2C_8192E_RSSI_REPORT = 0x42, -+ H2C_8192E_RA_PARA_ADJUST = 0x46, -+ -+ H2C_8192E_WO_WLAN = 0x80, -+ H2C_8192E_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8192E_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8192E_AOAC_RSVDPAGE = 0x83, -+ -+ //Not defined in new 88E H2C CMD Format -+ H2C_8192E_SELECTIVE_SUSPEND_ROF_CMD, -+ H2C_8192E_P2P_PS_MODE, -+ H2C_8192E_PSD_RESULT, -+ MAX_8192E_H2CCMD -+}RTL8192E_H2C_CMD; -+ -+typedef enum _RTL8192E_C2H_EVT -+{ -+ C2H_8192E_DBG = 0, -+ C2H_8192E_LB = 1, -+ C2H_8192E_TXBF = 2, -+ C2H_8192E_TX_REPORT = 3, -+ C2H_8192E_BT_INFO = 9, -+ C2H_8192E_FW_SWCHNL = 0x10, -+ C2H_8192E_BT_MP = 11, -+ C2H_8192E_RA_RPT = 12, -+ C2H_8192E_RA_PARA_RPT = 14, -+#ifdef CONFIG_FW_C2H_DEBUG -+ C2H_8192E_EXTEND = 0xff, -+#endif -+ MAX_8192E_C2HEVENT -+}RTL8192E_C2H_EVT; -+ -+typedef enum _RTL8192E_EXTEND_C2H_EVT { -+ EXTEND_C2H_8192E_DBG_PRINT = 0 -+ -+} RTL8192E_EXTEND_C2H_EVT; -+ -+struct cmd_msg_parm { -+ u8 eid; //element id -+ u8 sz; // sz -+ u8 buf[6]; -+}; -+ -+enum{ -+ PWRS -+}; -+ -+typedef struct _SETPWRMODE_PARM { -+ u8 Mode;//0:Active,1:LPS,2:WMMPS -+ //u8 RLBM:4;//0:Min,1:Max,2: User define -+ u8 SmartPS_RLBM;//LPS=0:PS_Poll,1:PS_Poll,2:NullData,WMM=0:PS_Poll,1:NullData -+ u8 AwakeInterval; // unit: beacon interval -+ u8 bAllQueueUAPSD; -+ u8 PwrState;//AllON(0x0c),RFON(0x04),RFOFF(0x00) -+} SETPWRMODE_PARM, *PSETPWRMODE_PARM; -+ -+struct H2C_SS_RFOFF_PARAM{ -+ u8 ROFOn; // 1: on, 0:off -+ u16 gpio_period; // unit: 1024 us -+}__attribute__ ((packed)); -+ -+ -+typedef struct JOINBSSRPT_PARM_92E{ -+ u8 OpMode; // RT_MEDIA_STATUS -+#ifdef CONFIG_WOWLAN -+ u8 MacID; // MACID -+#endif //CONFIG_WOWLAN -+}JOINBSSRPT_PARM_92E, *PJOINBSSRPT_PARM_92E; -+ -+/* move to hal_com_h2c.h -+typedef struct _RSVDPAGE_LOC_92E { -+ u8 LocProbeRsp; -+ u8 LocPsPoll; -+ u8 LocNullData; -+ u8 LocQosNull; -+ u8 LocBTQosNull; -+} RSVDPAGE_LOC_92E, *PRSVDPAGE_LOC_92E; -+*/ -+ -+ -+//_SETPWRMODE_PARM -+#define SET_8192E_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_8192E_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8192E_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8192E_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8192E_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8192E_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8192E_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+5, 0, 8, __Value) -+#define GET_8192E_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+//_P2P_PS_OFFLOAD -+#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_CTWINDOW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+ -+ -+// host message to firmware cmd -+void rtl8192e_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); -+void rtl8192e_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); -+u8 rtl8192e_set_rssi_cmd(PADAPTER padapter, u8 *param); -+void rtl8192e_set_raid_cmd(PADAPTER padapter, u32 bitmap, u8* arg); -+void rtl8192e_Add_RateATid(PADAPTER padapter, u64 rate_bitmap, u8 *arg, u8 rssi_level); -+s32 FillH2CCmd_8192E(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8192E(_adapter *padapter, bool wowlan); -+//u8 rtl8192c_set_FwSelectSuspend_cmd(PADAPTER padapter, u8 bfwpoll, u16 period); -+s32 c2h_handler_8192e(PADAPTER padapter, u8 *buf); -+#ifdef CONFIG_BT_COEXIST -+void rtl8192e_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif // CONFIG_BT_COEXIST -+#ifdef CONFIG_P2P_PS -+void rtl8192e_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif //CONFIG_P2P -+ -+void CheckFwRsvdPageContent(PADAPTER padapter); -+void rtl8192e_set_FwMediaStatus_cmd(PADAPTER padapter, u16 mstatus_rpt ); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+int reset_tsf(PADAPTER Adapter, u8 reset_port ); -+#endif // CONFIG_TSF_RESET_OFFLOAD -+ -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void SetFwRelatedForWoWLAN8192E(_adapter* padapter, u8 bHostIsGoingtoSleep); -+#endif -+/// TX Feedback Content -+#define USEC_UNIT_FOR_8192E_C2H_TX_RPT_QUEUE_TIME 256 -+ -+#define GET_8192E_C2H_TX_RPT_QUEUE_SELECT(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 5) -+#define GET_8192E_C2H_TX_RPT_PKT_BROCAST(_Header) LE_BITS_TO_1BYTE((_Header + 0), 5, 1) -+#define GET_8192E_C2H_TX_RPT_LIFE_TIME_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 6, 1) -+#define GET_8192E_C2H_TX_RPT_RETRY_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 7, 1) -+#define GET_8192E_C2H_TX_RPT_MAC_ID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) -+#define GET_8192E_C2H_TX_RPT_DATA_RETRY_CNT(_Header) LE_BITS_TO_1BYTE((_Header + 2), 0, 6) -+#define GET_8192E_C2H_TX_RPT_QUEUE_TIME(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) // In unit of 256 microseconds. -+#define GET_8192E_C2H_TX_RPT_FINAL_DATA_RATE(_Header) LE_BITS_TO_1BYTE((_Header + 5), 0, 8) -+ -+ -+ -+void C2HContentParsing8192E( -+ IN PADAPTER Adapter, -+ IN u1Byte c2hCmdId, -+ IN u1Byte c2hCmdLen, -+ IN pu1Byte tmpBuf -+); -+VOID -+C2HPacketHandler_8192E( -+ IN PADAPTER Adapter, -+ IN pu1Byte Buffer, -+ IN u1Byte Length -+); -+ -+#endif//__RTL8192E_CMD_H__ -\ Ingen nyrad vid filslut -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8192e_dm.h linux/3rdparty/rtl8812au/include/rtl8192e_dm.h ---- linux.old/3rdparty/rtl8812au/include/rtl8192e_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8192e_dm.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,38 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_DM_H__ -+#define __RTL8192E_DM_H__ -+ -+ -+void rtl8192e_init_dm_priv(IN PADAPTER Adapter); -+void rtl8192e_deinit_dm_priv(IN PADAPTER Adapter); -+void rtl8192e_InitHalDm(IN PADAPTER Adapter); -+void rtl8192e_HalDmWatchDog(IN PADAPTER Adapter); -+ -+//VOID rtl8192c_dm_CheckTXPowerTracking(IN PADAPTER Adapter); -+ -+//void rtl8192c_dm_RF_Saving(IN PADAPTER pAdapter, IN u8 bForceInNormal); -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+void AntDivCompare8192e(PADAPTER Adapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src); -+u8 AntDivBeforeLink8192e(PADAPTER Adapter ); -+#endif -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8192e_hal.h linux/3rdparty/rtl8812au/include/rtl8192e_hal.h ---- linux.old/3rdparty/rtl8812au/include/rtl8192e_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8192e_hal.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,349 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_HAL_H__ -+#define __RTL8192E_HAL_H__ -+ -+//#include "hal_com.h" -+ -+#include "hal_data.h" -+ -+//include HAL Related header after HAL Related compiling flags -+#include "rtl8192e_spec.h" -+#include "rtl8192e_rf.h" -+#include "rtl8192e_dm.h" -+#include "rtl8192e_recv.h" -+#include "rtl8192e_xmit.h" -+#include "rtl8192e_cmd.h" -+#include "rtl8192e_led.h" -+#include "Hal8192EPwrSeq.h" -+#include "Hal8192EPhyReg.h" -+#include "Hal8192EPhyCfg.h" -+ -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+#include "rtl8192e_sreset.h" -+#endif -+ -+ -+//--------------------------------------------------------------------- -+// RTL8192E From header -+//--------------------------------------------------------------------- -+ #define RTL8192E_FW_IMG "rtl8192e/FW_NIC.bin" -+ #define RTL8192E_FW_WW_IMG "rtl8192e/FW_WoWLAN.bin" -+ #define RTL8192E_PHY_REG "rtl8192e/PHY_REG.txt" -+ #define RTL8192E_PHY_RADIO_A "rtl8192e/RadioA.txt" -+ #define RTL8192E_PHY_RADIO_B "rtl8192e/RadioB.txt" -+ #define RTL8192E_TXPWR_TRACK "rtl8192e/TxPowerTrack.txt" -+ #define RTL8192E_AGC_TAB "rtl8192e/AGC_TAB.txt" -+ #define RTL8192E_PHY_MACREG "rtl8192e/MAC_REG.txt" -+ #define RTL8192E_PHY_REG_PG "rtl8192e/PHY_REG_PG.txt" -+ #define RTL8192E_PHY_REG_MP "rtl8192e/PHY_REG_MP.txt" -+ #define RTL8192E_TXPWR_LMT "rtl8192e/TXPWR_LMT.txt" -+ #define RTL8192E_WIFI_ANT_ISOLATION "rtl8192e/wifi_ant_isolation.txt" -+ -+//--------------------------------------------------------------------- -+// RTL8192E Power Configuration CMDs for PCIe interface -+//--------------------------------------------------------------------- -+#define Rtl8192E_NIC_PWR_ON_FLOW rtl8192E_power_on_flow -+#define Rtl8192E_NIC_RF_OFF_FLOW rtl8192E_radio_off_flow -+#define Rtl8192E_NIC_DISABLE_FLOW rtl8192E_card_disable_flow -+#define Rtl8192E_NIC_ENABLE_FLOW rtl8192E_card_enable_flow -+#define Rtl8192E_NIC_SUSPEND_FLOW rtl8192E_suspend_flow -+#define Rtl8192E_NIC_RESUME_FLOW rtl8192E_resume_flow -+#define Rtl8192E_NIC_PDN_FLOW rtl8192E_hwpdn_flow -+#define Rtl8192E_NIC_LPS_ENTER_FLOW rtl8192E_enter_lps_flow -+#define Rtl8192E_NIC_LPS_LEAVE_FLOW rtl8192E_leave_lps_flow -+ -+ -+#if 1 // download firmware related data structure -+#define FW_SIZE_8192E 0x8000 // Compatible with RTL8192e Maximal RAM code size 32k -+#define FW_START_ADDRESS 0x1000 -+#define FW_END_ADDRESS 0x5FFF -+ -+ -+#define IS_FW_HEADER_EXIST_8192E(_pFwHdr) ((GET_FIRMWARE_HDR_SIGNATURE_8192E(_pFwHdr) &0xFFF0) == 0x92E0) -+ -+ -+ -+typedef struct _RT_FIRMWARE_8192E { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8* szFwBuffer; -+#else -+ u8 szFwBuffer[FW_SIZE_8192E]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8192E, *PRT_FIRMWARE_8192E; -+ -+// -+// This structure must be cared byte-ordering -+// -+// Added by tynli. 2009.12.04. -+ -+//===================================================== -+// Firmware Header(8-byte alinment required) -+//===================================================== -+//--- LONG WORD 0 ---- -+#define GET_FIRMWARE_HDR_SIGNATURE_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 0, 16) // 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut -+#define GET_FIRMWARE_HDR_CATEGORY_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 16, 8) // AP/NIC and USB/PCI -+#define GET_FIRMWARE_HDR_FUNCTION_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 24, 8) // Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions -+#define GET_FIRMWARE_HDR_VERSION_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 0, 16)// FW Version -+#define GET_FIRMWARE_HDR_SUB_VER_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 16, 8) // FW Subversion, default 0x00 -+#define GET_FIRMWARE_HDR_RSVD1_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 24, 8) -+ -+//--- LONG WORD 1 ---- -+#define GET_FIRMWARE_HDR_MONTH_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 0, 8) // Release time Month field -+#define GET_FIRMWARE_HDR_DATE_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 8, 8) // Release time Date field -+#define GET_FIRMWARE_HDR_HOUR_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 16, 8)// Release time Hour field -+#define GET_FIRMWARE_HDR_MINUTE_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 24, 8)// Release time Minute field -+#define GET_FIRMWARE_HDR_ROMCODE_SIZE_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 0, 16)// The size of RAM code -+#define GET_FIRMWARE_HDR_RSVD2_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 16, 16) -+ -+//--- LONG WORD 2 ---- -+#define GET_FIRMWARE_HDR_SVN_IDX_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 0, 32)// The SVN entry index -+#define GET_FIRMWARE_HDR_RSVD3_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 0, 32) -+ -+//--- LONG WORD 3 ---- -+#define GET_FIRMWARE_HDR_RSVD4_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 0, 32) -+#define GET_FIRMWARE_HDR_RSVD5_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+28, 0, 32) -+ -+#endif // download firmware related data structure -+ -+#define DRIVER_EARLY_INT_TIME_8192E 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8192E 0x02 -+#define RX_DMA_SIZE_8192E 0x4000 /* 16K*/ -+ -+#ifdef CONFIG_WOWLAN -+#define RESV_FMWF WKFMCAM_SIZE*MAX_WKFM_NUM /* 16 entries, for each is 24 bytes*/ -+#else -+#define RESV_FMWF 0 -+#endif -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+ #define RX_DMA_RESERVED_SIZE_8192E 0x100 /* 256B, reserved for c2h debug message*/ -+#else -+ #define RX_DMA_RESERVED_SIZE_8192E 0x40 /* 64B, reserved for c2h event(16bytes) or ccx(8 Bytes )*/ -+#endif -+#define MAX_RX_DMA_BUFFER_SIZE_8192E (RX_DMA_SIZE_8192E-RX_DMA_RESERVED_SIZE_8192E) /*RX 16K*/ -+ -+//For General Reserved Page Number(Beacon Queue is reserved page) -+//if (CONFIG_2BCN_EN) Beacon:4, PS-Poll:1, Null Data:1,Prob Rsp:1,Qos Null Data:1 -+//Beacon:2, PS-Poll:1, Null Data:1,Prob Rsp:1,Qos Null Data:1 -+#define RSVD_PAGE_NUM_8192E 0x08 -+//For WoWLan , more reserved page -+//ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 -+#ifdef CONFIG_WOWLAN -+#define WOWLAN_PAGE_NUM_8192E 0x07 -+#else -+#define WOWLAN_PAGE_NUM_8192E 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+#undef WOWLAN_PAGE_NUM_8192E -+#define WOWLAN_PAGE_NUM_8192E 0x0d -+#endif -+ -+/* Note: -+Tx FIFO Size : 64KB -+Tx page Size : 256B -+Total page numbers : 256(0x100) -+*/ -+ -+#define TOTAL_RSVD_PAGE_NUMBER_8192E (RSVD_PAGE_NUM_8192E+WOWLAN_PAGE_NUM_8192E) -+ -+#define TOTAL_PAGE_NUMBER_8192E (0x100) -+#define TX_TOTAL_PAGE_NUMBER_8192E (TOTAL_PAGE_NUMBER_8192E - TOTAL_RSVD_PAGE_NUMBER_8192E) -+ -+#define TX_PAGE_BOUNDARY_8192E ( TX_TOTAL_PAGE_NUMBER_8192E ) /* beacon header start address */ -+ -+ -+#define PAGE_SIZE_TX_92E PAGE_SIZE_256 -+#define RSVD_PKT_LEN_92E (TOTAL_RSVD_PAGE_NUMBER_8192E *PAGE_SIZE_TX_92E) -+ -+#define TX_PAGE_LOAD_FW_BOUNDARY_8192E 0x47 //0xA5 -+#define TX_PAGE_BOUNDARY_WOWLAN_8192E 0xE0 -+ -+// For Normal Chip Setting -+// (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_92C -+ -+#define NORMAL_PAGE_NUM_HPQ_8192E 0x10 -+#define NORMAL_PAGE_NUM_LPQ_8192E 0x10 -+#define NORMAL_PAGE_NUM_NPQ_8192E 0x10 -+#define NORMAL_PAGE_NUM_EPQ_8192E 0x00 -+ -+ -+//Note: For WMM Normal Chip Setting ,modify later -+#define WMM_NORMAL_PAGE_NUM_HPQ_8192E NORMAL_PAGE_NUM_HPQ_8192E -+#define WMM_NORMAL_PAGE_NUM_LPQ_8192E NORMAL_PAGE_NUM_LPQ_8192E -+#define WMM_NORMAL_PAGE_NUM_NPQ_8192E NORMAL_PAGE_NUM_NPQ_8192E -+ -+ -+//------------------------------------------------------------------------- -+// Chip specific -+//------------------------------------------------------------------------- -+ -+// pic buffer descriptor -+#define RTL8192EE_SEG_NUM TX_BUFFER_SEG_NUM -+#define TX_DESC_NUM_92E 128 -+#define RX_DESC_NUM_92E 128 -+ -+//------------------------------------------------------------------------- -+// Channel Plan -+//------------------------------------------------------------------------- -+ -+#define HWSET_MAX_SIZE_8192E 512 -+ -+#define EFUSE_REAL_CONTENT_LEN_8192E 512 -+ -+#define EFUSE_MAP_LEN_8192E 512 -+#define EFUSE_MAX_SECTION_8192E 64 -+#define EFUSE_MAX_WORD_UNIT_8192E 4 -+#define EFUSE_IC_ID_OFFSET_8192E 506 //For some inferiority IC purpose. added by Roger, 2009.09.02. -+#define AVAILABLE_EFUSE_ADDR_8192E(addr) (addr < EFUSE_REAL_CONTENT_LEN_8192E) -+// -+// To prevent out of boundary programming case, leave 1byte and program full section -+// 9bytes + 1byt + 5bytes and pre 1byte. -+// For worst case: -+// | 1byte|----8bytes----|1byte|--5bytes--| -+// | | Reserved(14bytes) | -+// -+#define EFUSE_OOB_PROTECT_BYTES_8192E 15 // PG data exclude header, dummy 6 bytes frome CP test and reserved 1byte. -+ -+ -+ -+//======================================================== -+// EFUSE for BT definition -+//======================================================== -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN_8192E 512 -+#define EFUSE_BT_REAL_CONTENT_LEN_8192E 1024 // 512*2 -+#define EFUSE_BT_MAP_LEN_8192E 1024 // 1k bytes -+#define EFUSE_BT_MAX_SECTION_8192E 128 // 1024/8 -+ -+#define EFUSE_PROTECT_BYTES_BANK_8192E 16 -+#define EFUSE_MAX_BANK_8192E 3 -+//=========================================================== -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+//#define IS_MULTI_FUNC_CHIP(_Adapter) (((((PHAL_DATA_TYPE)(_Adapter->HalData))->MultiFunc) & (RT_MULTI_FUNC_BT|RT_MULTI_FUNC_GPS)) ? _TRUE : _FALSE) -+ -+//#define RT_IS_FUNC_DISABLED(__pAdapter, __FuncBits) ( (__pAdapter)->DisabledFunctions & (__FuncBits) ) -+ -+// rtl8812_hal_init.c -+void _8051Reset8192E(PADAPTER padapter); -+s32 FirmwareDownload8192E(PADAPTER Adapter, BOOLEAN bUsedWoWLANFw); -+void InitializeFirmwareVars8192E(PADAPTER padapter); -+ -+s32 InitLLTTable8192E(PADAPTER padapter, u8 txpktbuf_bndy); -+ -+// EFuse -+u8 GetEEPROMSize8192E(PADAPTER padapter); -+void hal_InitPGData_8192E(PADAPTER padapter, u8* PROMContent); -+void Hal_EfuseParseIDCode8192E(PADAPTER padapter, u8 *hwinfo); -+void Hal_ReadPROMVersion8192E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadPowerSavingMode8192E(PADAPTER padapter, u8* hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadTxPowerInfo8192E(PADAPTER padapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+void Hal_ReadBoardType8192E(PADAPTER pAdapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+void Hal_ReadThermalMeter_8192E(PADAPTER Adapter,u8* PROMContent,BOOLEAN AutoloadFail); -+void Hal_ReadChannelPlan8192E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseXtal_8192E(PADAPTER pAdapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+void Hal_ReadAntennaDiversity8192E(PADAPTER pAdapter,u8* PROMContent,BOOLEAN AutoLoadFail); -+void Hal_ReadPAType_8192E(PADAPTER Adapter,u8* PROMContent, BOOLEAN AutoloadFail); -+void Hal_ReadAmplifierType_8192E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void Hal_ReadRFEType_8192E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void Hal_EfuseParseBTCoexistInfo8192E(PADAPTER Adapter, u8* hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseKFreeData_8192E(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+ -+u8 Hal_CrystalAFEAdjust(_adapter * Adapter); -+ -+BOOLEAN HalDetectPwrDownMode8192E(PADAPTER Adapter); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif //CONFIG_WOWLAN -+ -+/***********************************************************/ -+// RTL8192E-MAC Setting -+VOID _InitQueueReservedPage_8192E(IN PADAPTER Adapter); -+VOID _InitQueuePriority_8192E(IN PADAPTER Adapter); -+VOID _InitTxBufferBoundary_8192E(IN PADAPTER Adapter,IN u8 txpktbuf_bndy); -+VOID _InitPageBoundary_8192E(IN PADAPTER Adapter); -+//VOID _InitTransferPageSize_8192E(IN PADAPTER Adapter); -+VOID _InitDriverInfoSize_8192E(IN PADAPTER Adapter,IN u8 drvInfoSize); -+VOID _InitRDGSetting_8192E(PADAPTER Adapter); -+void _InitID_8192E(IN PADAPTER Adapter); -+VOID _InitNetworkType_8192E(IN PADAPTER Adapter); -+VOID _InitWMACSetting_8192E(IN PADAPTER Adapter); -+VOID _InitAdaptiveCtrl_8192E(IN PADAPTER Adapter); -+VOID _InitRateFallback_8192E(IN PADAPTER Adapter); -+VOID _InitEDCA_8192E( IN PADAPTER Adapter); -+VOID _InitRetryFunction_8192E( IN PADAPTER Adapter); -+VOID _BBTurnOnBlock_8192E(IN PADAPTER Adapter); -+VOID _InitBeaconParameters_8192E(IN PADAPTER Adapter); -+VOID _InitBeaconMaxError_8192E( -+ IN PADAPTER Adapter, -+ IN BOOLEAN InfraMode -+ ); -+void SetBeaconRelatedRegisters8192E(PADAPTER padapter); -+VOID hal_ReadRFType_8192E(PADAPTER Adapter); -+// RTL8192E-MAC Setting -+/***********************************************************/ -+ -+void SetHwReg8192E(PADAPTER Adapter, u8 variable, u8* val); -+void GetHwReg8192E(PADAPTER Adapter, u8 variable, u8* val); -+u8 -+SetHalDefVar8192E( -+ IN PADAPTER Adapter, -+ IN HAL_DEF_VARIABLE eVariable, -+ IN PVOID pValue -+ ); -+u8 -+GetHalDefVar8192E( -+ IN PADAPTER Adapter, -+ IN HAL_DEF_VARIABLE eVariable, -+ IN PVOID pValue -+ ); -+ -+void rtl8192e_set_hal_ops(struct hal_ops *pHalFunc); -+void rtl8192e_init_default_value(_adapter * padapter); -+// register -+void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); -+ -+void rtl8192e_start_thread(_adapter *padapter); -+void rtl8192e_stop_thread(_adapter *padapter); -+ -+#ifdef CONFIG_PCI_HCI -+BOOLEAN InterruptRecognized8192EE(PADAPTER Adapter); -+u16 get_txdesc_buf_addr(u16 ff_hwaddr); -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+void _init_available_page_threshold(PADAPTER padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ); -+#endif -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+void rtl8192e_combo_card_WifiOnlyHwInit(PADAPTER Adapter); -+#endif -+ -+#endif //__RTL8192E_HAL_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8192e_led.h linux/3rdparty/rtl8812au/include/rtl8192e_led.h ---- linux.old/3rdparty/rtl8812au/include/rtl8192e_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8192e_led.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_LED_H__ -+#define __RTL8192E_LED_H__ -+ -+ -+//================================================================================ -+// Interface to manipulate LED objects. -+//================================================================================ -+#ifdef CONFIG_USB_HCI -+void rtl8192eu_InitSwLeds(PADAPTER padapter); -+void rtl8192eu_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+void rtl8192ee_InitSwLeds(PADAPTER padapter); -+void rtl8192ee_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_SDIO_HCI -+void rtl8192es_InitSwLeds(PADAPTER padapter); -+void rtl8192es_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8192e_recv.h linux/3rdparty/rtl8812au/include/rtl8192e_recv.h ---- linux.old/3rdparty/rtl8812au/include/rtl8192e_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8192e_recv.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,178 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_RECV_H__ -+#define __RTL8192E_RECV_H__ -+ -+#if defined(CONFIG_USB_HCI) -+ -+#ifndef MAX_RECVBUF_SZ -+#ifdef PLATFORM_OS_CE -+#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+#else -+ #ifdef CONFIG_MINIMAL_MEMORY_USAGE -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+ #else -+ #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ #define MAX_RECVBUF_SZ (rtw_rtkm_get_buff_size()) /*depend rtkm*/ -+ #elif defined(CONFIG_PLATFORM_HISILICON) -+ #define MAX_RECVBUF_SZ (16384) /* 16k */ -+ #else -+ #define MAX_RECVBUF_SZ (32768) /* 32k */ -+ #endif -+ //#define MAX_RECVBUF_SZ (20480) //20K -+ //#define MAX_RECVBUF_SZ (10240) //10K -+ //#define MAX_RECVBUF_SZ (16384) // 16k - 92E RX BUF :16K -+ //#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+ #endif -+#endif -+#endif //!MAX_RECVBUF_SZ -+ -+#elif defined(CONFIG_PCI_HCI) -+//#ifndef CONFIG_MINIMAL_MEMORY_USAGE -+// #define MAX_RECVBUF_SZ (9100) -+//#else -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+//#endif -+ -+ -+#elif defined(CONFIG_SDIO_HCI) -+ -+#define MAX_RECVBUF_SZ (16384) -+ -+#endif -+ -+ -+// Rx smooth factor -+#define Rx_Smooth_Factor (20) -+ -+//============= -+// [1] Rx Buffer Descriptor (for PCIE) buffer descriptor architecture -+//DWORD 0 -+#define SET_RX_BUFFER_DESC_DATA_LENGTH_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_BUFFER_DESC_LS_92E(__pRxStatusDesc,__Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 15, 1, __Value) -+#define SET_RX_BUFFER_DESC_FS_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 16, 1, __Value) -+#define SET_RX_BUFFER_DESC_TOTAL_LENGTH_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 16, 15, __Value) -+ -+#define GET_RX_BUFFER_DESC_OWN_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 31, 1) -+#define GET_RX_BUFFER_DESC_LS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 15, 1) -+#define GET_RX_BUFFER_DESC_FS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 16, 1) -+#define GET_RX_BUFFER_DESC_TOTAL_LENGTH_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 16, 15) -+ -+ -+//DWORD 1 -+#define SET_RX_BUFFER_PHYSICAL_LOW_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc+4, 0, 32, __Value) -+#define GET_RX_BUFFER_PHYSICAL_LOW_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 0, 32) -+ -+//DWORD 2 -+#define SET_RX_BUFFER_PHYSICAL_HIGH_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc+8, 0, 32, __Value) -+ -+//============= -+// [2] Rx Descriptor -+//DWORD 0 -+#define GET_RX_STATUS_DESC_PKT_LEN_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICVERR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_EOR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_OWN_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 31, 1) -+ -+ -+#define SET_RX_STATUS_DESC_PKT_LEN_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 31, 1, __Value) -+ -+//DWORD 1 -+#define GET_RX_STATUS_DESC_MACID_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_TID_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_MACID_VLD_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 12, 1) -+#define GET_RX_STATUS_DESC_AMSDU_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_A1_FITS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 16, 4) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_CHKERR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_IPVER_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_IS_TCPUDP_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_CHK_VLD_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_MC_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 31, 1) -+ -+//DWORD 2 -+#define GET_RX_STATUS_DESC_SEQ_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 12, 4) -+#define GET_RX_STATUS_DESC_RX_IS_QOS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 16, 1) -+ -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_HWRSVD_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 24, 4) -+#define GET_RX_STATUS_DESC_FCS_OK_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 31, 1) -+#define GET_RX_STATUS_DESC_RPT_SEL_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 28, 1) -+ -+//DWORD 3 -+#define GET_RX_STATUS_DESC_RX_RATE_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_HTC_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 12, 2) -+#define GET_RX_STATUS_DESC_DMA_AGG_NUM_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 16, 8) -+ -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_92E(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_92E(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_WAKE_92E(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 31, 1) -+ -+ -+//DWORD 5 -+#define GET_RX_STATUS_DESC_TSFL_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+20, 0, 32) -+ -+#define GET_RX_STATUS_DESC_BUFF_ADDR_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+#define GET_RX_STATUS_DESC_BUFF_ADDR64_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+ -+#ifdef CONFIG_SDIO_HCI -+s32 rtl8192es_init_recv_priv(PADAPTER padapter); -+void rtl8192es_free_recv_priv(PADAPTER padapter); -+void rtl8192es_recv_hdl(PADAPTER padapter, struct recv_buf *precvbuf); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+void rtl8192eu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+s32 rtl8192eu_init_recv_priv(PADAPTER padapter); -+void rtl8192eu_free_recv_priv(PADAPTER padapter); -+void rtl8192eu_recv_hdl(PADAPTER padapter, struct recv_buf *precvbuf); -+void rtl8192eu_recv_tasklet(void *priv); -+ -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8192ee_init_recv_priv(PADAPTER padapter); -+void rtl8192ee_free_recv_priv(PADAPTER padapter); -+#endif -+ -+void rtl8192e_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8192E_RECV_H__ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8192e_rf.h linux/3rdparty/rtl8812au/include/rtl8192e_rf.h ---- linux.old/3rdparty/rtl8812au/include/rtl8192e_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8192e_rf.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,34 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_RF_H__ -+#define __RTL8192E_RF_H__ -+ -+VOID -+PHY_RF6052SetBandwidth8192E( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); -+ -+ -+int -+PHY_RF6052_Config_8192E( -+ IN PADAPTER Adapter ); -+ -+#endif//__RTL8192E_RF_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8192e_spec.h linux/3rdparty/rtl8812au/include/rtl8192e_spec.h ---- linux.old/3rdparty/rtl8812au/include/rtl8192e_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8192e_spec.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,325 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8192E_SPEC_H__ -+#define __RTL8192E_SPEC_H__ -+ -+#include -+ -+ -+//============================================================ -+// 8192E Regsiter offset definition -+//============================================================ -+ -+//============================================================ -+// -+//============================================================ -+ -+//----------------------------------------------------- -+// -+// 0x0000h ~ 0x00FFh System Configuration -+// -+//----------------------------------------------------- -+#define REG_SYS_SWR_CTRL1_8192E 0x0010 // 1 Byte -+#define REG_SYS_SWR_CTRL2_8192E 0x0014 // 1 Byte -+#define REG_AFE_CTRL1_8192E 0x0024 -+#define REG_AFE_CTRL2_8192E 0x0028 -+#define REG_AFE_CTRL3_8192E 0x002c -+ -+#define REG_PAD_CTRL1_8192E 0x0064 -+#define REG_SDIO_CTRL_8192E 0x0070 -+#define REG_OPT_CTRL_8192E 0x0074 -+#define REG_RF_B_CTRL_8192E 0x0076 -+#define REG_AFE_CTRL4_8192E 0x0078 -+#define REG_LDO_SWR_CTRL 0x007C -+#define REG_FW_DRV_MSG_8192E 0x0088 -+#define REG_HMEBOX_E2_E3_8192E 0x008C -+#define REG_HIMR0_8192E 0x00B0 -+#define REG_HISR0_8192E 0x00B4 -+#define REG_HIMR1_8192E 0x00B8 -+#define REG_HISR1_8192E 0x00BC -+ -+#define REG_SYS_CFG1_8192E 0x00F0 -+#define REG_SYS_CFG2_8192E 0x00FC -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+#define REG_PKTBUF_DBG_ADDR (REG_PKTBUF_DBG_CTRL) -+#define REG_RXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+2) -+#define REG_TXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+3) -+#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN -+ -+#define REG_RSVD3_8192E 0x0168 -+#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 -+#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 -+#define REG_C2HEVT_CMD_LEN_88XX 0x01AE -+ -+#define REG_HMEBOX_EXT0_8192E 0x01F0 -+#define REG_HMEBOX_EXT1_8192E 0x01F4 -+#define REG_HMEBOX_EXT2_8192E 0x01F8 -+#define REG_HMEBOX_EXT3_8192E 0x01FC -+ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_DWBCN0_CTRL 0x0208 -+#define REG_DWBCN1_CTRL 0x0228 -+ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x02FFh RXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_RXDMA_8192E 0x0290 -+#define REG_EARLY_MODE_CONTROL_8192E 0x02BC -+ -+#define REG_RSVD5_8192E 0x02F0 -+#define REG_RSVD6_8192E 0x02F4 -+#define REG_RSVD7_8192E 0x02F8 -+#define REG_RSVD8_8192E 0x02FC -+ -+//----------------------------------------------------- -+// -+// 0x0300h ~ 0x03FFh PCIe -+// -+//----------------------------------------------------- -+#define REG_PCIE_CTRL_REG_8192E 0x0300 -+#define REG_INT_MIG_8192E 0x0304 // Interrupt Migration -+#define REG_BCNQ_TXBD_DESA_8192E 0x0308 // TX Beacon Descriptor Address -+#define REG_MGQ_TXBD_DESA_8192E 0x0310 // TX Manage Queue Descriptor Address -+#define REG_VOQ_TXBD_DESA_8192E 0x0318 // TX VO Queue Descriptor Address -+#define REG_VIQ_TXBD_DESA_8192E 0x0320 // TX VI Queue Descriptor Address -+#define REG_BEQ_TXBD_DESA_8192E 0x0328 // TX BE Queue Descriptor Address -+#define REG_BKQ_TXBD_DESA_8192E 0x0330 // TX BK Queue Descriptor Address -+#define REG_RXQ_RXBD_DESA_8192E 0x0338 // RX Queue Descriptor Address -+#define REG_HI0Q_TXBD_DESA_8192E 0x0340 -+#define REG_HI1Q_TXBD_DESA_8192E 0x0348 -+#define REG_HI2Q_TXBD_DESA_8192E 0x0350 -+#define REG_HI3Q_TXBD_DESA_8192E 0x0358 -+#define REG_HI4Q_TXBD_DESA_8192E 0x0360 -+#define REG_HI5Q_TXBD_DESA_8192E 0x0368 -+#define REG_HI6Q_TXBD_DESA_8192E 0x0370 -+#define REG_HI7Q_TXBD_DESA_8192E 0x0378 -+#define REG_MGQ_TXBD_NUM_8192E 0x0380 -+#define REG_RX_RXBD_NUM_8192E 0x0382 -+#define REG_VOQ_TXBD_NUM_8192E 0x0384 -+#define REG_VIQ_TXBD_NUM_8192E 0x0386 -+#define REG_BEQ_TXBD_NUM_8192E 0x0388 -+#define REG_BKQ_TXBD_NUM_8192E 0x038A -+#define REG_HI0Q_TXBD_NUM_8192E 0x038C -+#define REG_HI1Q_TXBD_NUM_8192E 0x038E -+#define REG_HI2Q_TXBD_NUM_8192E 0x0390 -+#define REG_HI3Q_TXBD_NUM_8192E 0x0392 -+#define REG_HI4Q_TXBD_NUM_8192E 0x0394 -+#define REG_HI5Q_TXBD_NUM_8192E 0x0396 -+#define REG_HI6Q_TXBD_NUM_8192E 0x0398 -+#define REG_HI7Q_TXBD_NUM_8192E 0x039A -+#define REG_TSFTIMER_HCI_8192E 0x039C -+ -+//Read Write Point -+#define REG_VOQ_TXBD_IDX_8192E 0x03A0 -+#define REG_VIQ_TXBD_IDX_8192E 0x03A4 -+#define REG_BEQ_TXBD_IDX_8192E 0x03A8 -+#define REG_BKQ_TXBD_IDX_8192E 0x03AC -+#define REG_MGQ_TXBD_IDX_8192E 0x03B0 -+#define REG_RXQ_TXBD_IDX_8192E 0x03B4 -+#define REG_HI0Q_TXBD_IDX_8192E 0x03B8 -+#define REG_HI1Q_TXBD_IDX_8192E 0x03BC -+#define REG_HI2Q_TXBD_IDX_8192E 0x03C0 -+#define REG_HI3Q_TXBD_IDX_8192E 0x03C4 -+#define REG_HI4Q_TXBD_IDX_8192E 0x03C8 -+#define REG_HI5Q_TXBD_IDX_8192E 0x03CC -+#define REG_HI6Q_TXBD_IDX_8192E 0x03D0 -+#define REG_HI7Q_TXBD_IDX_8192E 0x03D4 -+ -+#define REG_PCIE_HCPWM_8192EE 0x03D8 // ?????? -+#define REG_PCIE_HRPWM_8192EE 0x03DC //PCIe RPWM // ?????? -+#define REG_DBI_WDATA_V1_8192E 0x03E8 -+#define REG_DBI_RDATA_V1_8192E 0x03EC -+#define REG_DBI_FLAG_V1_8192E 0x03F0 -+#define REG_MDIO_V1_8192E 0x3F4 -+#define REG_PCIE_MIX_CFG_8192E 0x3F8 -+ -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+#define REG_TXBF_CTRL_8192E 0x042C -+#define REG_ARFR0_8192E 0x0444 -+#define REG_ARFR1_8192E 0x044C -+#define REG_CCK_CHECK_8192E 0x0454 -+#define REG_AMPDU_MAX_TIME_8192E 0x0456 -+#define REG_BCNQ1_BDNY_8192E 0x0457 -+ -+#define REG_AMPDU_MAX_LENGTH_8192E 0x0458 -+#define REG_WMAC_LBK_BUF_HD_8192E 0x045D -+#define REG_NDPA_OPT_CTRL_8192E 0x045F -+#define REG_DATA_SC_8192E 0x0483 -+#ifdef CONFIG_WOWLAN -+#define REG_TXPKTBUF_IV_LOW 0x0484 -+#define REG_TXPKTBUF_IV_HIGH 0x0488 -+#endif -+#define REG_ARFR2_8192E 0x048C -+#define REG_ARFR3_8192E 0x0494 -+#define REG_TXRPT_START_OFFSET 0x04AC -+#define REG_AMPDU_BURST_MODE_8192E 0x04BC -+#define REG_HT_SINGLE_AMPDU_8192E 0x04C7 -+#define REG_MACID_PKT_DROP0_8192E 0x04D0 -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+#define REG_CTWND_8192E 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8192E 0x0577 -+#define REG_SCH_TXCMD_8192E 0x05F8 -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+#define REG_MAC_CR_8192E 0x0600 -+ -+#define REG_MAC_TX_SM_STATE_8192E 0x06B4 -+ -+// Power -+#define REG_BFMER0_INFO_8192E 0x06E4 -+#define REG_BFMER1_INFO_8192E 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8192E 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8192E 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8192E 0x06FC -+ -+// Hardware Port 2 -+#define REG_BFMEE_SEL_8192E 0x0714 -+#define REG_SND_PTCL_CTRL_8192E 0x0718 -+ -+ -+//----------------------------------------------------- -+// -+// Redifine register definition for compatibility -+// -+//----------------------------------------------------- -+ -+// TODO: use these definition when using REG_xxx naming rule. -+// NOTE: DO NOT Remove these definition. Use later. -+#define ISR_8192E REG_HISR0_8192E -+ -+//---------------------------------------------------------------------------- -+// 8192E IMR/ISR bits (offset 0xB0, 8bits) -+//---------------------------------------------------------------------------- -+#define IMR_DISABLED_8192E 0 -+// IMR DW0(0x00B0-00B3) Bit 0-31 -+#define IMR_TIMER2_8192E BIT31 // Timeout interrupt 2 -+#define IMR_TIMER1_8192E BIT30 // Timeout interrupt 1 -+#define IMR_PSTIMEOUT_8192E BIT29 // Power Save Time Out Interrupt -+#define IMR_GTINT4_8192E BIT28 // When GTIMER4 expires, this bit is set to 1 -+#define IMR_GTINT3_8192E BIT27 // When GTIMER3 expires, this bit is set to 1 -+#define IMR_TXBCN0ERR_8192E BIT26 // Transmit Beacon0 Error -+#define IMR_TXBCN0OK_8192E BIT25 // Transmit Beacon0 OK -+#define IMR_TSF_BIT32_TOGGLE_8192E BIT24 // TSF Timer BIT32 toggle indication interrupt -+#define IMR_BCNDMAINT0_8192E BIT20 // Beacon DMA Interrupt 0 -+#define IMR_BCNDERR0_8192E BIT16 // Beacon Queue DMA OK0 -+#define IMR_HSISR_IND_ON_INT_8192E BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) -+#define IMR_BCNDMAINT_E_8192E BIT14 // Beacon DMA Interrupt Extension for Win7 -+#define IMR_ATIMEND_8192E BIT12 // CTWidnow End or ATIM Window End -+#define IMR_C2HCMD_8192E BIT10 // CPU to Host Command INT Status, Write 1 clear -+#define IMR_CPWM2_8192E BIT9 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_CPWM_8192E BIT8 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_HIGHDOK_8192E BIT7 // High Queue DMA OK -+#define IMR_MGNTDOK_8192E BIT6 // Management Queue DMA OK -+#define IMR_BKDOK_8192E BIT5 // AC_BK DMA OK -+#define IMR_BEDOK_8192E BIT4 // AC_BE DMA OK -+#define IMR_VIDOK_8192E BIT3 // AC_VI DMA OK -+#define IMR_VODOK_8192E BIT2 // AC_VO DMA OK -+#define IMR_RDU_8192E BIT1 // Rx Descriptor Unavailable -+#define IMR_ROK_8192E BIT0 // Receive DMA OK -+ -+// IMR DW1(0x00B4-00B7) Bit 0-31 -+#define IMR_BCNDMAINT7_8192E BIT27 // Beacon DMA Interrupt 7 -+#define IMR_BCNDMAINT6_8192E BIT26 // Beacon DMA Interrupt 6 -+#define IMR_BCNDMAINT5_8192E BIT25 // Beacon DMA Interrupt 5 -+#define IMR_BCNDMAINT4_8192E BIT24 // Beacon DMA Interrupt 4 -+#define IMR_BCNDMAINT3_8192E BIT23 // Beacon DMA Interrupt 3 -+#define IMR_BCNDMAINT2_8192E BIT22 // Beacon DMA Interrupt 2 -+#define IMR_BCNDMAINT1_8192E BIT21 // Beacon DMA Interrupt 1 -+#define IMR_BCNDOK7_8192E BIT20 // Beacon Queue DMA OK Interrup 7 -+#define IMR_BCNDOK6_8192E BIT19 // Beacon Queue DMA OK Interrup 6 -+#define IMR_BCNDOK5_8192E BIT18 // Beacon Queue DMA OK Interrup 5 -+#define IMR_BCNDOK4_8192E BIT17 // Beacon Queue DMA OK Interrup 4 -+#define IMR_BCNDOK3_8192E BIT16 // Beacon Queue DMA OK Interrup 3 -+#define IMR_BCNDOK2_8192E BIT15 // Beacon Queue DMA OK Interrup 2 -+#define IMR_BCNDOK1_8192E BIT14 // Beacon Queue DMA OK Interrup 1 -+#define IMR_ATIMEND_E_8192E BIT13 // ATIM Window End Extension for Win7 -+#define IMR_TXERR_8192E BIT11 // Tx Error Flag Interrupt Status, write 1 clear. -+#define IMR_RXERR_8192E BIT10 // Rx Error Flag INT Status, Write 1 clear -+#define IMR_TXFOVW_8192E BIT9 // Transmit FIFO Overflow -+#define IMR_RXFOVW_8192E BIT8 // Receive FIFO Overflow -+ -+//---------------------------------------------------------------------------- -+// 8192E Auto LLT bits (offset 0x224, 8bits) -+//---------------------------------------------------------------------------- -+//224 REG_AUTO_LLT -+// move to hal_com_reg.h -+ -+//---------------------------------------------------------------------------- -+// 8192E Auto LLT bits (offset 0x290, 32bits) -+//---------------------------------------------------------------------------- -+#define BIT_DMA_MODE BIT1 -+#define BIT_USB_RXDMA_AGG_EN BIT31 -+ -+//---------------------------------------------------------------------------- -+// 8192E REG_SYS_CFG1 (offset 0xF0, 32bits) -+//---------------------------------------------------------------------------- -+#define BIT_SPSLDO_SEL BIT24 -+ -+ -+//---------------------------------------------------------------------------- -+// 8192E REG_CCK_CHECK (offset 0x454, 8bits) -+//---------------------------------------------------------------------------- -+#define BIT_BCN_PORT_SEL BIT5 -+ -+//============================================================================ -+// Regsiter Bit and Content definition -+//============================================================================ -+ -+//2 ACMHWCTRL 0x05C0 -+#define AcmHw_HwEn_8192E BIT(0) -+#define AcmHw_VoqEn_8192E BIT(1) -+#define AcmHw_ViqEn_8192E BIT(2) -+#define AcmHw_BeqEn_8192E BIT(3) -+#define AcmHw_VoqStatus_8192E BIT(5) -+#define AcmHw_ViqStatus_8192E BIT(6) -+#define AcmHw_BeqStatus_8192E BIT(7) -+ -+//======================================================== -+// General definitions -+//======================================================== -+ -+#define MACID_NUM_8192E 128 -+#define SEC_CAM_ENT_NUM_8192E 64 -+#define NSS_NUM_8192E 2 -+ -+#endif //__RTL8192E_SPEC_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8192e_sreset.h linux/3rdparty/rtl8812au/include/rtl8192e_sreset.h ---- linux.old/3rdparty/rtl8812au/include/rtl8192e_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8192e_sreset.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL88812A_SRESET_H_ -+#define _RTL8812A_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+extern void rtl8192e_sreset_xmit_status_check(_adapter *padapter); -+extern void rtl8192e_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8192e_xmit.h linux/3rdparty/rtl8812au/include/rtl8192e_xmit.h ---- linux.old/3rdparty/rtl8812au/include/rtl8192e_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8192e_xmit.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,451 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_XMIT_H__ -+#define __RTL8192E_XMIT_H__ -+ -+typedef struct txdescriptor_8192e -+{ -+ //Offset 0 -+ u32 pktlen:16; -+ u32 offset:8; -+ u32 bmc:1; -+ u32 htc:1; -+ u32 ls:1; -+ u32 fs:1; -+ u32 linip:1; -+ u32 noacm:1; -+ u32 gf:1; -+ u32 own:1; -+ -+ //Offset 4 -+ u32 macid:6; -+ u32 rsvd0406:2; -+ u32 qsel:5; -+ u32 rd_nav_ext:1; -+ u32 lsig_txop_en:1; -+ u32 pifs:1; -+ u32 rate_id:4; -+ u32 navusehdr:1; -+ u32 en_desc_id:1; -+ u32 sectype:2; -+ u32 rsvd0424:2; -+ u32 pkt_offset:5; // unit: 8 bytes -+ u32 rsvd0431:1; -+ -+ //Offset 8 -+ u32 rts_rc:6; -+ u32 data_rc:6; -+ u32 agg_en:1; -+ u32 rd_en:1; -+ u32 bar_rty_th:2; -+ u32 bk:1; -+ u32 morefrag:1; -+ u32 raw:1; -+ u32 ccx:1; -+ u32 ampdu_density:3; -+ u32 bt_null:1; -+ u32 ant_sel_a:1; -+ u32 ant_sel_b:1; -+ u32 tx_ant_cck:2; -+ u32 tx_antl:2; -+ u32 tx_ant_ht:2; -+ -+ //Offset 12 -+ u32 nextheadpage:8; -+ u32 tailpage:8; -+ u32 seq:12; -+ u32 cpu_handle:1; -+ u32 tag1:1; -+ u32 trigger_int:1; -+ u32 hwseq_en:1; -+ -+ //Offset 16 -+ u32 rtsrate:5; -+ u32 ap_dcfe:1; -+ u32 hwseq_sel:2; -+ u32 userate:1; -+ u32 disrtsfb:1; -+ u32 disdatafb:1; -+ u32 cts2self:1; -+ u32 rtsen:1; -+ u32 hw_rts_en:1; -+ u32 port_id:1; -+ u32 pwr_status:3; -+ u32 wait_dcts:1; -+ u32 cts2ap_en:1; -+ u32 data_sc:2; -+ u32 data_stbc:2; -+ u32 data_short:1; -+ u32 data_bw:1; -+ u32 rts_short:1; -+ u32 rts_bw:1; -+ u32 rts_sc:2; -+ u32 vcs_stbc:2; -+ -+ //Offset 20 -+ u32 datarate:6; -+ u32 sgi:1; -+ u32 try_rate:1; -+ u32 data_ratefb_lmt:5; -+ u32 rts_ratefb_lmt:4; -+ u32 rty_lmt_en:1; -+ u32 data_rt_lmt:6; -+ u32 usb_txagg_num:8; -+ -+ //Offset 24 -+ u32 txagg_a:5; -+ u32 txagg_b:5; -+ u32 use_max_len:1; -+ u32 max_agg_num:5; -+ u32 mcsg1_max_len:4; -+ u32 mcsg2_max_len:4; -+ u32 mcsg3_max_len:4; -+ u32 mcs7_sgi_max_len:4; -+ -+ //Offset 28 -+ u32 checksum:16; // TxBuffSize(PCIe)/CheckSum(USB) -+ u32 mcsg4_max_len:4; -+ u32 mcsg5_max_len:4; -+ u32 mcsg6_max_len:4; -+ u32 mcs15_sgi_max_len:4; -+}TXDESC_8192E, *PTXDESC_8192E; -+ -+ -+ -+//For 88e early mode -+#define SET_EARLYMODE_PKTNUM(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 3, __Value) -+#define SET_EARLYMODE_LEN0(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 12, __Value) -+#define SET_EARLYMODE_LEN1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 16, 12, __Value) -+#define SET_EARLYMODE_LEN2_1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 28, 4, __Value) -+#define SET_EARLYMODE_LEN2_2(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 8, __Value) -+#define SET_EARLYMODE_LEN3(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 8, 12, __Value) -+#define SET_EARLYMODE_LEN4(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 20, 12, __Value) -+ -+// -+//defined for TX DESC Operation -+// -+ -+#define MAX_TID (15) -+ -+//OFFSET 0 -+#define OFFSET_SZ 0 -+#define OFFSET_SHT 16 -+#define BMC BIT(24) -+#define LSG BIT(26) -+#define FSG BIT(27) -+#define OWN BIT(31) -+ -+ -+//OFFSET 4 -+#define PKT_OFFSET_SZ 0 -+#define QSEL_SHT 8 -+#define RATE_ID_SHT 16 -+#define NAVUSEHDR BIT(20) -+#define SEC_TYPE_SHT 22 -+#define PKT_OFFSET_SHT 26 -+ -+//OFFSET 8 -+#define AGG_EN BIT(12) -+#define AGG_BK BIT(16) -+#define AMPDU_DENSITY_SHT 20 -+#define ANTSEL_A BIT(24) -+#define ANTSEL_B BIT(25) -+#define TX_ANT_CCK_SHT 26 -+#define TX_ANTL_SHT 28 -+#define TX_ANT_HT_SHT 30 -+ -+//OFFSET 12 -+#define SEQ_SHT 16 -+#define EN_HWSEQ BIT(31) -+ -+//OFFSET 16 -+#define QOS BIT(6) -+#define HW_SSN BIT(7) -+#define USERATE BIT(8) -+#define DISDATAFB BIT(10) -+#define CTS_2_SELF BIT(11) -+#define RTS_EN BIT(12) -+#define HW_RTS_EN BIT(13) -+#define DATA_SHORT BIT(24) -+#define PWR_STATUS_SHT 15 -+#define DATA_SC_SHT 20 -+#define DATA_BW BIT(25) -+ -+//OFFSET 20 -+#define RTY_LMT_EN BIT(17) -+ -+ -+//OFFSET 20 -+#define SGI BIT(6) -+#define USB_TXAGG_NUM_SHT 24 -+ -+ -+//=====Tx Desc Buffer content -+ -+// config element for each tx buffer -+/* -+#define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16), 0, 16, __Valeu) -+#define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16), 31, 1, __Valeu) -+#define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16)+4, 0, 32, __Valeu) -+#define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16)+8, 0, 32, __Valeu) -+*/ -+#define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 0, 16, __Valeu) -+#define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 31, 1, __Valeu) -+#define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8)+4, 0, 32, __Valeu) -+#define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16)+8, 0, 32, __Valeu) -+ -+ -+// Dword 0 -+#define SET_TX_BUFF_DESC_LEN_0_92E(__pTxDesc, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 14, __Valeu) -+#define SET_TX_BUFF_DESC_PSB_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 15, __Value) -+#define SET_TX_BUFF_DESC_OWN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+// Dword 1 -+#define SET_TX_BUFF_DESC_ADDR_LOW_0_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 32, __Value) -+#define GET_TX_DESC_TX_BUFFER_ADDRESS_92E(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+4, 0,32) -+ -+ -+// Dword 2 -+#define SET_TX_BUFF_DESC_ADDR_HIGH_0_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 32, __Value) -+// Dword 3, RESERVED -+ -+ -+//=====Tx Desc content -+// Dword 0 -+#define SET_TX_DESC_PKT_SIZE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define SET_TX_DESC_OFFSET_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define SET_TX_DESC_BMC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_LAST_SEG_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+#define SET_TX_DESC_FIRST_SEG_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_LINIP_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+#define SET_TX_DESC_NO_ACM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+#define SET_TX_DESC_OWN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+#define GET_TX_DESC_OWN_92E(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+// Dword 1 -+#define SET_TX_DESC_MACID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+#define SET_TX_DESC_MORE_DATA_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 29, 1, __Value) -+#define SET_TX_DESC_TXOP_PS_CAP_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 30, 1, __Value) -+#define SET_TX_DESC_TXOP_PS_MODE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 31, 1, __Value) -+ -+ -+// Dword 2 -+#define SET_TX_DESC_PAID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+#define SET_TX_DESC_CCA_RTS_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_NULL_0_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 14, 1, __Value) -+#define SET_TX_DESC_NULL_1_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 15, 1, __Value) -+#define SET_TX_DESC_BK_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define SET_TX_DESC_RAW_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define GET_TX_DESC_MORE_FRAG_92E(__pTxDesc) LE_BITS_TO_4BYTE( __pTxDesc+8, 17, 1) -+#define SET_TX_DESC_SPE_RPT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_NULL_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_GID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+ -+ -+// Dword 3 -+#define SET_TX_DESC_WHEADER_LEN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) -+#define SET_TX_DESC_CHK_EN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) -+#define SET_TX_DESC_EARLY_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HWSEQ_SEL_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_HW_PORT_ID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 14, 1, __Value) -+#define SET_TX_DESC_NAV_USE_HDR_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_NDPA_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+// Dword 4 -+#define SET_TX_DESC_TX_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_TRY_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 7, 1, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+#define SET_TX_DESC_PCTS_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 29, 1, __Value) -+#define SET_TX_DESC_PCTS_MASK_IDX_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 30, 2, __Value) -+ -+ -+// Dword 5 -+#define SET_TX_DESC_DATA_SC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_LDPC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+#define SET_TX_DESC_DATA_STBC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_VCS_STBC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+#define SET_TX_DESC_TX_ANT_92E(__pTxDesc,__Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 4, __Value) -+#define SET_TX_DESC_TX_POWER_0_PSET_92E(__pTxDesc,__Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 28, 3, __Value) -+ -+// Dword 6 -+#define SET_TX_DESC_SW_DEFINE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_MBSSID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+#define SET_TX_DESC_ANTSEL_A_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+#define SET_TX_DESC_ANTSEL_B_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) -+#define SET_TX_DESC_ANTSEL_C_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) -+#define SET_TX_DESC_ANTSEL_D_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) -+ -+// Dword 7 -+#if(DEV_BUS_TYPE == RT_PCI_INTERFACE) -+#define SET_TX_DESC_TX_BUFFER_SIZE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#else -+#define SET_TX_DESC_TX_DESC_CHECKSUM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+#define SET_TX_DESC_USB_TXAGG_NUM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+ -+ -+//#define SET_TX_DESC_HWSEQ_EN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+// Dword 8 -+ -+#define SET_TX_DESC_RTS_RC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 6, __Value) -+#define SET_TX_DESC_BAR_RTY_TH_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 6, 2, __Value) -+#define SET_TX_DESC_DATA_RC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 8, 6, __Value) -+#define SET_TX_DESC_EN_HWSEQ_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+#define SET_TX_DESC_NEXT_HEAD_PAGE_92E(__pTxDesc,__Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) -+#define SET_TX_DESC_TAIL_PAGE_92E(__pTxDesc,__Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 24, 8, __Value) -+ -+// Dword 9 -+#define SET_TX_DESC_PADDING_LENGTH_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 11, __Value) -+#define SET_TX_DESC_TXBF_PATH_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 11, 1, __Value) -+#define SET_TX_DESC_SEQ_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+#define SET_TX_DESC_FINAL_DATA_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 24, 8, __Value) -+ -+ -+#define SET_EARLYMODE_PKTNUM_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+void rtl8192e_cal_txdesc_chksum(u8 *ptxdesc); -+ -+#ifdef CONFIG_USB_HCI -+s32 rtl8192eu_init_xmit_priv(PADAPTER padapter); -+void rtl8192eu_free_xmit_priv(PADAPTER padapter); -+s32 rtl8192eu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8192eu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8192eu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtl8192eu_xmit_buf_handler(PADAPTER padapter); -+#define hal_xmit_handler rtl8192eu_xmit_buf_handler -+void rtl8192eu_xmit_tasklet(void *priv); -+s32 rtl8192eu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8192ee_init_xmit_priv(PADAPTER padapter); -+void rtl8192ee_free_xmit_priv(PADAPTER padapter); -+struct xmit_buf *rtl8192ee_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+s32 rtl8192ee_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+void rtl8192ee_xmitframe_resume(_adapter *padapter); -+s32 rtl8192ee_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8192ee_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+void rtl8192ee_xmit_tasklet(void *priv); -+#endif -+ -+#if defined(CONFIG_SDIO_HCI)||defined (CONFIG_GSPI_HCI) -+s32 rtl8192es_init_xmit_priv(PADAPTER padapter); -+void rtl8192es_free_xmit_priv(PADAPTER padapter); -+ -+s32 rtl8192es_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8192es_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8192es_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+thread_return rtl8192es_xmit_thread(thread_context context); -+s32 rtl8192es_xmit_buf_handler(PADAPTER padapter); -+ -+#ifdef CONFIG_SDIO_TX_TASKLET -+void rtl8192es_xmit_tasklet(void *priv); -+#endif -+#endif -+ -+struct txrpt_ccx_92e { -+ /* offset 0 */ -+ u8 tag1:1; -+ u8 pkt_num:3; -+ u8 txdma_underflow:1; -+ u8 int_bt:1; -+ u8 int_tri:1; -+ u8 int_ccx:1; -+ -+ /* offset 1 */ -+ u8 mac_id:6; -+ u8 pkt_ok:1; -+ u8 bmc:1; -+ -+ /* offset 2 */ -+ u8 retry_cnt:6; -+ u8 lifetime_over:1; -+ u8 retry_over:1; -+ -+ /* offset 3 */ -+ u8 ccx_qtime0; -+ u8 ccx_qtime1; -+ -+ /* offset 5 */ -+ u8 final_data_rate; -+ -+ /* offset 6 */ -+ u8 sw1:4; -+ u8 qsel:4; -+ -+ /* offset 7 */ -+ u8 sw0; -+}; -+ -+#ifdef CONFIG_TX_EARLY_MODE -+void UpdateEarlyModeInfo8192E(struct xmit_priv *pxmitpriv,struct xmit_buf *pxmitbuf ); -+#endif -+ s32 rtl8192e_init_xmit_priv(_adapter *padapter); -+void _dbg_dump_tx_info(_adapter *padapter,int frame_tag,u8 *ptxdesc); -+ -+void rtl8192e_fill_fake_txdesc(PADAPTER padapter,u8*pDesc,u32 BufferLen, -+ u8 IsPsPoll,u8 IsBTQosNull, u8 bDataFrame); -+void rtl8192e_cal_txdesc_chksum(u8 *ptxdesc); -+ -+u8 BWMapping_92E(PADAPTER Adapter, struct pkt_attrib *pattrib); -+u8 SCMapping_92E(PADAPTER Adapter, struct pkt_attrib *pattrib); -+void fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); -+void fill_txdesc_vcs(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void rtl8192e_fixed_rate(_adapter *padapter,u8 *ptxdesc); -+ -+#endif //__RTL8192E_XMIT_H__ -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8703b_cmd.h linux/3rdparty/rtl8812au/include/rtl8703b_cmd.h ---- linux.old/3rdparty/rtl8812au/include/rtl8703b_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8703b_cmd.h 2017-06-07 23:07:21.039690127 +0300 -@@ -0,0 +1,224 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_CMD_H__ -+#define __RTL8703B_CMD_H__ -+ -+//---------------------------------------------------------------------------------------------------------// -+//---------------------------------- H2C CMD DEFINITION ------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+ -+enum h2c_cmd_8703B{ -+ //Common Class: 000 -+ H2C_8703B_RSVD_PAGE = 0x00, -+ H2C_8703B_MEDIA_STATUS_RPT = 0x01, -+ H2C_8703B_SCAN_ENABLE = 0x02, -+ H2C_8703B_KEEP_ALIVE = 0x03, -+ H2C_8703B_DISCON_DECISION = 0x04, -+ H2C_8703B_PSD_OFFLOAD = 0x05, -+ H2C_8703B_AP_OFFLOAD = 0x08, -+ H2C_8703B_BCN_RSVDPAGE = 0x09, -+ H2C_8703B_PROBERSP_RSVDPAGE = 0x0A, -+ H2C_8703B_FCS_RSVDPAGE = 0x10, -+ H2C_8703B_FCS_INFO = 0x11, -+ H2C_8703B_AP_WOW_GPIO_CTRL = 0x13, -+ -+ //PoweSave Class: 001 -+ H2C_8703B_SET_PWR_MODE = 0x20, -+ H2C_8703B_PS_TUNING_PARA = 0x21, -+ H2C_8703B_PS_TUNING_PARA2 = 0x22, -+ H2C_8703B_P2P_LPS_PARAM = 0x23, -+ H2C_8703B_P2P_PS_OFFLOAD = 0x24, -+ H2C_8703B_PS_SCAN_ENABLE = 0x25, -+ H2C_8703B_SAP_PS_ = 0x26, -+ H2C_8703B_INACTIVE_PS_ = 0x27, //Inactive_PS -+ H2C_8703B_FWLPS_IN_IPS_ = 0x28, -+ -+ //Dynamic Mechanism Class: 010 -+ H2C_8703B_MACID_CFG = 0x40, -+ H2C_8703B_TXBF = 0x41, -+ H2C_8703B_RSSI_SETTING = 0x42, -+ H2C_8703B_AP_REQ_TXRPT = 0x43, -+ H2C_8703B_INIT_RATE_COLLECT = 0x44, -+ H2C_8703B_RA_PARA_ADJUST = 0x46, -+ -+ //BT Class: 011 -+ H2C_8703B_B_TYPE_TDMA = 0x60, -+ H2C_8703B_BT_INFO = 0x61, -+ H2C_8703B_FORCE_BT_TXPWR = 0x62, -+ H2C_8703B_BT_IGNORE_WLANACT = 0x63, -+ H2C_8703B_DAC_SWING_VALUE = 0x64, -+ H2C_8703B_ANT_SEL_RSV = 0x65, -+ H2C_8703B_WL_OPMODE = 0x66, -+ H2C_8703B_BT_MP_OPER = 0x67, -+ H2C_8703B_BT_CONTROL = 0x68, -+ H2C_8703B_BT_WIFI_CTRL = 0x69, -+ H2C_8703B_BT_FW_PATCH = 0x6A, -+ H2C_8703B_BT_WLAN_CALIBRATION = 0x6D, -+ -+ //WOWLAN Class: 100 -+ H2C_8703B_WOWLAN = 0x80, -+ H2C_8703B_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8703B_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8703B_AOAC_RSVD_PAGE = 0x83, -+ H2C_8703B_AOAC_RSVD_PAGE2 = 0x84, -+ H2C_8703B_D0_SCAN_OFFLOAD_CTRL = 0x85, -+ H2C_8703B_D0_SCAN_OFFLOAD_INFO = 0x86, -+ H2C_8703B_CHNL_SWITCH_OFFLOAD = 0x87, -+ H2C_8703B_P2P_OFFLOAD_RSVD_PAGE = 0x8A, -+ H2C_8703B_P2P_OFFLOAD = 0x8B, -+ -+ H2C_8703B_RESET_TSF = 0xC0, -+ H2C_8703B_MAXID, -+}; -+ -+//---------------------------------------------------------------------------------------------------------// -+//---------------------------------- H2C CMD CONTENT --------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+//_RSVDPAGE_LOC_CMD_0x00 -+#define SET_8703B_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_8703B_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8703B_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8703B_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8703B_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+ -+//_MEDIA_STATUS_RPT_PARM_CMD_0x01 -+#define SET_8703B_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8703B_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8703B_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8703B_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+2, 0, 8, __Value) -+ -+//_KEEP_ALIVE_CMD_0x03 -+#define SET_8703B_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8703B_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8703B_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8703B_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+ -+//_DISCONNECT_DECISION_CMD_0x04 -+#define SET_8703B_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8703B_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8703B_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8703B_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+2, 0, 8, __Value) -+ -+// _PWR_MOD_CMD_0x20 -+#define SET_8703B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_8703B_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8703B_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8703B_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8703B_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8703B_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8703B_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+5, 0, 8, __Value) -+ -+#define GET_8703B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+// _PS_TUNE_PARAM_CMD_0x21 -+#define SET_8703B_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8703B_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8703B_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) -+#define SET_8703B_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) -+#define SET_8703B_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+//_MACID_CFG_CMD_0x40 -+#define SET_8703B_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) -+ -+//_RSSI_SETTING_CMD_0x42 -+#define SET_8703B_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8703B_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) -+#define SET_8703B_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+// _AP_REQ_TXRPT_CMD_0x43 -+#define SET_8703B_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8703B_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+// _FORCE_BT_TXPWR_CMD_0x62 -+#define SET_8703B_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+ -+// _FORCE_BT_MP_OPER_CMD_0x67 -+#define SET_8703B_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_8703B_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_8703B_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8703B_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+#define SET_8703B_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8703B_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+ -+// _BT_FW_PATCH_0x6A -+#define SET_8703B_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) -+#define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+//---------------------------------------------------------------------------------------------------------// -+//------------------------------------------- Structure --------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+ -+ -+//---------------------------------------------------------------------------------------------------------// -+//---------------------------------- Function Statement --------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+ -+// host message to firmware cmd -+void rtl8703b_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); -+void rtl8703b_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); -+void rtl8703b_set_rssi_cmd(PADAPTER padapter, u8 *param); -+void rtl8703b_Add_RateATid(PADAPTER pAdapter, u64 rate_bitmap, u8 *arg, u8 rssi_level); -+void rtl8703b_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); -+//s32 rtl8703b_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); -+void rtl8703b_set_FwPsTuneParam_cmd(PADAPTER padapter); -+void rtl8703b_set_FwMacIdConfig_cmd(_adapter* padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); -+void rtl8703b_set_FwMediaStatusRpt_cmd(PADAPTER padapter, u8 mstatus, u8 macid); -+void rtl8703b_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); -+void rtl8703b_download_rsvd_page(PADAPTER padapter, u8 mstatus); -+#ifdef CONFIG_BT_COEXIST -+void rtl8703b_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif // CONFIG_BT_COEXIST -+#ifdef CONFIG_P2P -+void rtl8703b_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif //CONFIG_P2P -+ -+void CheckFwRsvdPageContent(PADAPTER padapter); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void SetFwRelatedForWoWLAN8703b(_adapter* padapter, u8 bHostIsGoingtoSleep); -+#endif//CONFIG_WOWLAN -+ -+#ifdef CONFIG_P2P_WOWLAN -+void rtl8703b_set_p2p_wowlan_offload_cmd(PADAPTER padapter); -+#endif -+ -+void rtl8703b_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+u8 rtl8703b_reset_tsf(_adapter *padapter, u8 reset_port); -+#endif // CONFIG_TSF_RESET_OFFLOAD -+s32 FillH2CCmd8703B(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8703B(_adapter *padapter, bool wowlan); -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8703b_dm.h linux/3rdparty/rtl8812au/include/rtl8703b_dm.h ---- linux.old/3rdparty/rtl8812au/include/rtl8703b_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8703b_dm.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_DM_H__ -+#define __RTL8703B_DM_H__ -+//============================================================ -+// Description: -+// -+// This file is for 8703B dynamic mechanism only -+// -+// -+//============================================================ -+ -+//============================================================ -+// structure and define -+//============================================================ -+ -+//============================================================ -+// function prototype -+//============================================================ -+ -+void rtl8703b_init_dm_priv(PADAPTER padapter); -+void rtl8703b_deinit_dm_priv(PADAPTER padapter); -+ -+void rtl8703b_InitHalDm(PADAPTER padapter); -+void rtl8703b_HalDmWatchDog(PADAPTER padapter); -+void rtl8703b_HalDmWatchDog_in_LPS(PADAPTER padapter); -+void rtl8703b_hal_dm_in_lps(PADAPTER padapter); -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8703b_hal.h linux/3rdparty/rtl8812au/include/rtl8703b_hal.h ---- linux.old/3rdparty/rtl8812au/include/rtl8703b_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8703b_hal.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,345 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_HAL_H__ -+#define __RTL8703B_HAL_H__ -+ -+#include "hal_data.h" -+ -+#include "rtl8703b_spec.h" -+#include "rtl8703b_rf.h" -+#include "rtl8703b_dm.h" -+#include "rtl8703b_recv.h" -+#include "rtl8703b_xmit.h" -+#include "rtl8703b_cmd.h" -+#include "rtl8703b_led.h" -+#include "Hal8703BPwrSeq.h" -+#include "Hal8703BPhyReg.h" -+#include "Hal8703BPhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+#include "rtl8703b_sreset.h" -+#endif -+ -+ -+//--------------------------------------------------------------------- -+// RTL8703B From file -+//--------------------------------------------------------------------- -+ #define RTL8703B_FW_IMG "rtl8703b/FW_NIC.bin" -+ #define RTL8703B_FW_WW_IMG "rtl8703b/FW_WoWLAN.bin" -+ #define RTL8703B_PHY_REG "rtl8703b/PHY_REG.txt" -+ #define RTL8703B_PHY_RADIO_A "rtl8703b/RadioA.txt" -+ #define RTL8703B_PHY_RADIO_B "rtl8703b/RadioB.txt" -+ #define RTL8703B_TXPWR_TRACK "rtl8703b/TxPowerTrack.txt" -+ #define RTL8703B_AGC_TAB "rtl8703b/AGC_TAB.txt" -+ #define RTL8703B_PHY_MACREG "rtl8703b/MAC_REG.txt" -+ #define RTL8703B_PHY_REG_PG "rtl8703b/PHY_REG_PG.txt" -+ #define RTL8703B_PHY_REG_MP "rtl8703b/PHY_REG_MP.txt" -+ #define RTL8703B_TXPWR_LMT "rtl8703b/TXPWR_LMT.txt" -+ -+//--------------------------------------------------------------------- -+// RTL8703B From header -+//--------------------------------------------------------------------- -+ -+#if MP_DRIVER == 1 -+ #define Rtl8703B_FwBTImgArray Rtl8703BFwBTImgArray -+ #define Rtl8703B_FwBTImgArrayLength Rtl8703BFwBTImgArrayLength -+ -+ #define Rtl8703B_PHY_REG_Array_MP Rtl8703B_PHYREG_Array_MP -+ #define Rtl8703B_PHY_REG_Array_MPLength Rtl8703B_PHYREG_Array_MPLength -+#endif -+ -+ -+#define FW_8703B_SIZE 0x8000 -+#define FW_8703B_START_ADDRESS 0x1000 -+#define FW_8703B_END_ADDRESS 0x1FFF //0x5FFF -+ -+#define IS_FW_HEADER_EXIST_8703B(_pFwHdr) ((le16_to_cpu(_pFwHdr->Signature)&0xFFF0) == 0x03B0) -+ -+typedef struct _RT_FIRMWARE { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8* szFwBuffer; -+#else -+ u8 szFwBuffer[FW_8703B_SIZE]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8703B, *PRT_FIRMWARE_8703B; -+ -+// -+// This structure must be cared byte-ordering -+// -+// Added by tynli. 2009.12.04. -+typedef struct _RT_8703B_FIRMWARE_HDR -+{ -+ // 8-byte alinment required -+ -+ //--- LONG WORD 0 ---- -+ u16 Signature; // 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut -+ u8 Category; // AP/NIC and USB/PCI -+ u8 Function; // Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions -+ u16 Version; // FW Version -+ u16 Subversion; // FW Subversion, default 0x00 -+ -+ //--- LONG WORD 1 ---- -+ u8 Month; // Release time Month field -+ u8 Date; // Release time Date field -+ u8 Hour; // Release time Hour field -+ u8 Minute; // Release time Minute field -+ u16 RamCodeSize; // The size of RAM code -+ u16 Rsvd2; -+ -+ //--- LONG WORD 2 ---- -+ u32 SvnIdx; // The SVN entry index -+ u32 Rsvd3; -+ -+ //--- LONG WORD 3 ---- -+ u32 Rsvd4; -+ u32 Rsvd5; -+}RT_8703B_FIRMWARE_HDR, *PRT_8703B_FIRMWARE_HDR; -+ -+#define DRIVER_EARLY_INT_TIME_8703B 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8703B 0x02 -+ -+// for 8703B -+// TX 32K, RX 16K, Page size 128B for TX, 8B for RX -+#define PAGE_SIZE_TX_8703B 128 -+#define PAGE_SIZE_RX_8703B 8 -+ -+#define TX_DMA_SIZE_8703B 0x8000 /* 32K(TX) */ -+#define RX_DMA_SIZE_8703B 0x4000 /* 16K(RX) */ -+ -+#ifdef CONFIG_WOWLAN -+#define RESV_FMWF WKFMCAM_SIZE*MAX_WKFM_NUM /* 16 entries, for each is 24 bytes*/ -+#else -+#define RESV_FMWF 0 -+#endif -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+#define RX_DMA_RESERVED_SIZE_8703B 0x100 // 256B, reserved for c2h debug message -+#else -+#define RX_DMA_RESERVED_SIZE_8703B 0x80 // 128B, reserved for tx report -+#endif -+#define RX_DMA_BOUNDARY_8703B (RX_DMA_SIZE_8703B - RX_DMA_RESERVED_SIZE_8703B - 1) -+ -+ -+// Note: We will divide number of page equally for each queue other than public queue! -+ -+//For General Reserved Page Number(Beacon Queue is reserved page) -+//Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 -+#define BCNQ_PAGE_NUM_8703B 0x08 -+#ifdef CONFIG_CONCURRENT_MODE -+#define BCNQ1_PAGE_NUM_8703B 0x08 // 0x04 -+#else -+#define BCNQ1_PAGE_NUM_8703B 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+#undef BCNQ1_PAGE_NUM_8703B -+#define BCNQ1_PAGE_NUM_8703B 0x00 // 0x04 -+#endif -+ -+//For WoWLan , more reserved page -+//ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 -+#ifdef CONFIG_WOWLAN -+#define WOWLAN_PAGE_NUM_8703B 0x07 -+#else -+#define WOWLAN_PAGE_NUM_8703B 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+#undef WOWLAN_PAGE_NUM_8703B -+#define WOWLAN_PAGE_NUM_8703B 0x15 -+#endif -+ -+#ifdef CONFIG_AP_WOWLAN -+#define AP_WOWLAN_PAGE_NUM_8703B 0x02 -+#endif -+ -+#define TX_TOTAL_PAGE_NUMBER_8703B (0xFF - BCNQ_PAGE_NUM_8703B - BCNQ1_PAGE_NUM_8703B - WOWLAN_PAGE_NUM_8703B) -+#define TX_PAGE_BOUNDARY_8703B (TX_TOTAL_PAGE_NUMBER_8703B + 1) -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8703B TX_TOTAL_PAGE_NUMBER_8703B -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8703B (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8703B + 1) -+ -+// For Normal Chip Setting -+// (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8703B -+#define NORMAL_PAGE_NUM_HPQ_8703B 0x0C -+#define NORMAL_PAGE_NUM_LPQ_8703B 0x02 -+#define NORMAL_PAGE_NUM_NPQ_8703B 0x02 -+ -+// Note: For Normal Chip Setting, modify later -+#define WMM_NORMAL_PAGE_NUM_HPQ_8703B 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8703B 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8703B 0x20 -+ -+ -+#include "HalVerDef.h" -+#include "hal_com.h" -+ -+#define EFUSE_OOB_PROTECT_BYTES 15 -+ -+#define HAL_EFUSE_MEMORY -+ -+#define HWSET_MAX_SIZE_8703B 512 -+#define EFUSE_REAL_CONTENT_LEN_8703B 512 -+#define EFUSE_MAP_LEN_8703B 512 -+#define EFUSE_MAX_SECTION_8703B 64 -+ -+#define EFUSE_IC_ID_OFFSET 506 //For some inferiority IC purpose. added by Roger, 2009.09.02. -+#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8703B) -+ -+#define EFUSE_ACCESS_ON 0x69 -+#define EFUSE_ACCESS_OFF 0x00 -+ -+//======================================================== -+// EFUSE for BT definition -+//======================================================== -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN 512 -+#define EFUSE_BT_REAL_CONTENT_LEN 1536 // 512*3 -+#define EFUSE_BT_MAP_LEN 1024 // 1k bytes -+#define EFUSE_BT_MAX_SECTION 128 // 1024/8 -+ -+#define EFUSE_PROTECT_BYTES_BANK 16 -+ -+// Description: Determine the types of C2H events that are the same in driver and Fw. -+// Fisrt constructed by tynli. 2009.10.09. -+typedef enum _C2H_EVT -+{ -+ C2H_DBG = 0, -+ C2H_TSF = 1, -+ C2H_AP_RPT_RSP = 2, -+ C2H_CCX_TX_RPT = 3, // The FW notify the report of the specific tx packet. -+ C2H_BT_RSSI = 4, -+ C2H_BT_OP_MODE = 5, -+ C2H_EXT_RA_RPT = 6, -+ C2H_8703B_BT_INFO = 9, -+ C2H_HW_INFO_EXCH = 10, -+ C2H_8703B_BT_MP_INFO = 11, -+ C2H_8703B_P2P_RPORT = 0x16, -+#ifdef CONFIG_FW_C2H_DEBUG -+ C2H_8703B_FW_DEBUG = 0xff, -+#endif //CONFIG_FW_C2H_DEBUG -+ MAX_C2HEVENT -+} C2H_EVT; -+ -+typedef struct _C2H_EVT_HDR -+{ -+ u8 CmdID; -+ u8 CmdLen; -+ u8 CmdSeq; -+} __attribute__((__packed__)) C2H_EVT_HDR, *PC2H_EVT_HDR; -+ -+typedef enum tag_Package_Definition -+{ -+ PACKAGE_DEFAULT, -+ PACKAGE_QFN68, -+ PACKAGE_TFBGA90, -+ PACKAGE_TFBGA80, -+ PACKAGE_TFBGA79 -+}PACKAGE_TYPE_E; -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+// rtl8703b_hal_init.c -+s32 rtl8703b_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); -+void rtl8703b_FirmwareSelfReset(PADAPTER padapter); -+void rtl8703b_InitializeFirmwareVars(PADAPTER padapter); -+ -+void rtl8703b_InitAntenna_Selection(PADAPTER padapter); -+void rtl8703b_DeinitAntenna_Selection(PADAPTER padapter); -+void rtl8703b_CheckAntenna_Selection(PADAPTER padapter); -+void rtl8703b_init_default_value(PADAPTER padapter); -+ -+s32 rtl8703b_InitLLTTable(PADAPTER padapter); -+ -+s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU); -+s32 CardDisableWithoutHWSM(PADAPTER padapter); -+ -+// EFuse -+u8 GetEEPROMSize8703B(PADAPTER padapter); -+void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); -+void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); -+void Hal_EfuseParseTxPowerInfo_8703B(PADAPTER padapter, u8 *PROMContent, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseBTCoexistInfo_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseEEPROMVer_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseChnlPlan_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseCustomerID_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseAntennaDiversity_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseXtal_8703B(PADAPTER pAdapter, u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParseThermalMeter_8703B(PADAPTER padapter, u8 *hwinfo, u8 AutoLoadFail); -+VOID Hal_EfuseParsePackageType_8703B(PADAPTER pAdapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+VOID Hal_EfuseParseVoltage_8703B(PADAPTER pAdapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+VOID Hal_EfuseParseBoardType_8703B(PADAPTER Adapter, u8* PROMContent,BOOLEAN AutoloadFail); -+ -+#ifdef CONFIG_C2H_PACKET_EN -+void rtl8703b_c2h_packet_handler(PADAPTER padapter, u8 *pbuf, u16 length); -+#endif -+ -+ -+void rtl8703b_set_hal_ops(struct hal_ops *pHalFunc); -+void SetHwReg8703B(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg8703B(PADAPTER padapter, u8 variable, u8 *val); -+#ifdef CONFIG_C2H_PACKET_EN -+void SetHwRegWithBuf8703B(PADAPTER padapter, u8 variable, u8 *pbuf, int len); -+#endif // CONFIG_C2H_PACKET_EN -+u8 SetHalDefVar8703B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8703B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+ -+// register -+void rtl8703b_InitBeaconParameters(PADAPTER padapter); -+void rtl8703b_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); -+void _InitBurstPktLen_8703BS(PADAPTER Adapter); -+void _InitLTECoex_8703BS(PADAPTER Adapter); -+void _8051Reset8703(PADAPTER padapter); -+#ifdef CONFIG_WOWLAN -+void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif //CONFIG_WOWLAN -+ -+void rtl8703b_start_thread(_adapter *padapter); -+void rtl8703b_stop_thread(_adapter *padapter); -+ -+#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) -+void rtl8703bs_init_checkbthang_workqueue(_adapter * adapter); -+void rtl8703bs_free_checkbthang_workqueue(_adapter * adapter); -+void rtl8703bs_cancle_checkbthang_workqueue(_adapter * adapter); -+void rtl8703bs_hal_check_bt_hang(_adapter * adapter); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); -+#endif -+ -+int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); -+ -+void CCX_FwC2HTxRpt_8703b(PADAPTER padapter, u8 *pdata, u8 len); -+s32 c2h_id_filter_ccx_8703b(u8 *buf); -+s32 c2h_handler_8703b(PADAPTER padapter, u8 *pC2hEvent); -+u8 MRateToHwRate8703B(u8 rate); -+u8 HwRateToMRate8703B(u8 rate); -+ -+void Hal_ReadRFGainOffset(PADAPTER pAdapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+ -+#ifdef CONFIG_PCI_HCI -+BOOLEAN InterruptRecognized8703BE(PADAPTER Adapter); -+VOID UpdateInterruptMask8703BE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8703b_led.h linux/3rdparty/rtl8812au/include/rtl8703b_led.h ---- linux.old/3rdparty/rtl8812au/include/rtl8703b_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8703b_led.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_LED_H__ -+#define __RTL8703B_LED_H__ -+ -+#include -+#include -+#include -+ -+ -+//================================================================================ -+// Interface to manipulate LED objects. -+//================================================================================ -+#ifdef CONFIG_USB_HCI -+void rtl8703bu_InitSwLeds(PADAPTER padapter); -+void rtl8703bu_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_SDIO_HCI -+void rtl8703bs_InitSwLeds(PADAPTER padapter); -+void rtl8703bs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_GSPI_HCI -+void rtl8703bs_InitSwLeds(PADAPTER padapter); -+void rtl8703bs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+void rtl8703be_InitSwLeds(PADAPTER padapter); -+void rtl8703be_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8703b_recv.h linux/3rdparty/rtl8812au/include/rtl8703b_recv.h ---- linux.old/3rdparty/rtl8812au/include/rtl8703b_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8703b_recv.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,92 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_RECV_H__ -+#define __RTL8703B_RECV_H__ -+ -+#define RECV_BLK_SZ 512 -+#define RECV_BLK_CNT 16 -+#define RECV_BLK_TH RECV_BLK_CNT -+ -+#if defined(CONFIG_USB_HCI) -+ -+#ifndef MAX_RECVBUF_SZ -+#ifdef PLATFORM_OS_CE -+#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+#else -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ //#define MAX_RECVBUF_SZ (32768) // 32k -+ //#define MAX_RECVBUF_SZ (16384) //16K -+ //#define MAX_RECVBUF_SZ (10240) //10K -+ #ifdef CONFIG_PLATFORM_MSTAR -+ #define MAX_RECVBUF_SZ (8192) // 8K -+ #else -+ #define MAX_RECVBUF_SZ (15360) // 15k < 16k -+ #endif -+ //#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+ #else -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+ #endif -+#endif -+#endif //!MAX_RECVBUF_SZ -+ -+#elif defined(CONFIG_PCI_HCI) -+//#ifndef CONFIG_MINIMAL_MEMORY_USAGE -+// #define MAX_RECVBUF_SZ (9100) -+//#else -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+//#endif -+ -+ -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ -+#define MAX_RECVBUF_SZ (10240) -+ -+#endif -+ -+// Rx smooth factor -+#define Rx_Smooth_Factor (20) -+ -+#ifdef CONFIG_SDIO_HCI -+#ifndef CONFIG_SDIO_RX_COPY -+#undef MAX_RECVBUF_SZ -+#define MAX_RECVBUF_SZ (RX_DMA_SIZE_8703B - RX_DMA_RESERVED_SIZE_8703B) -+#endif // !CONFIG_SDIO_RX_COPY -+#endif // CONFIG_SDIO_HCI -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+s32 rtl8703bs_init_recv_priv(PADAPTER padapter); -+void rtl8703bs_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+int rtl8703bu_init_recv_priv(_adapter *padapter); -+void rtl8703bu_free_recv_priv (_adapter *padapter); -+void rtl8703bu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8703be_init_recv_priv(PADAPTER padapter); -+void rtl8703be_free_recv_priv(PADAPTER padapter); -+#endif -+ -+void rtl8703b_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8703B_RECV_H__ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8703b_rf.h linux/3rdparty/rtl8812au/include/rtl8703b_rf.h ---- linux.old/3rdparty/rtl8812au/include/rtl8703b_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8703b_rf.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_RF_H__ -+#define __RTL8703B_RF_H__ -+ -+int PHY_RF6052_Config8703B( IN PADAPTER Adapter ); -+ -+VOID -+PHY_RF6052SetBandwidth8703B( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8703b_spec.h linux/3rdparty/rtl8812au/include/rtl8703b_spec.h ---- linux.old/3rdparty/rtl8812au/include/rtl8703b_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8703b_spec.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,477 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8703B_SPEC_H__ -+#define __RTL8703B_SPEC_H__ -+ -+#include -+ -+ -+#define HAL_NAV_UPPER_UNIT_8703B 128 // micro-second -+ -+//----------------------------------------------------- -+// -+// 0x0000h ~ 0x00FFh System Configuration -+// -+//----------------------------------------------------- -+#define REG_SYS_ISO_CTRL_8703B 0x0000 // 2 Byte -+#define REG_SYS_FUNC_EN_8703B 0x0002 // 2 Byte -+#define REG_APS_FSMCO_8703B 0x0004 // 4 Byte -+#define REG_SYS_CLKR_8703B 0x0008 // 2 Byte -+#define REG_9346CR_8703B 0x000A // 2 Byte -+#define REG_EE_VPD_8703B 0x000C // 2 Byte -+#define REG_AFE_MISC_8703B 0x0010 // 1 Byte -+#define REG_SPS0_CTRL_8703B 0x0011 // 7 Byte -+#define REG_SPS_OCP_CFG_8703B 0x0018 // 4 Byte -+#define REG_RSV_CTRL_8703B 0x001C // 3 Byte -+#define REG_RF_CTRL_8703B 0x001F // 1 Byte -+#define REG_LPLDO_CTRL_8703B 0x0023 // 1 Byte -+#define REG_AFE_XTAL_CTRL_8703B 0x0024 // 4 Byte -+#define REG_AFE_PLL_CTRL_8703B 0x0028 // 4 Byte -+#define REG_MAC_PLL_CTRL_EXT_8703B 0x002c // 4 Byte -+#define REG_EFUSE_CTRL_8703B 0x0030 -+#define REG_EFUSE_TEST_8703B 0x0034 -+#define REG_PWR_DATA_8703B 0x0038 -+#define REG_CAL_TIMER_8703B 0x003C -+#define REG_ACLK_MON_8703B 0x003E -+#define REG_GPIO_MUXCFG_8703B 0x0040 -+#define REG_GPIO_IO_SEL_8703B 0x0042 -+#define REG_MAC_PINMUX_CFG_8703B 0x0043 -+#define REG_GPIO_PIN_CTRL_8703B 0x0044 -+#define REG_GPIO_INTM_8703B 0x0048 -+#define REG_LEDCFG0_8703B 0x004C -+#define REG_LEDCFG1_8703B 0x004D -+#define REG_LEDCFG2_8703B 0x004E -+#define REG_LEDCFG3_8703B 0x004F -+#define REG_FSIMR_8703B 0x0050 -+#define REG_FSISR_8703B 0x0054 -+#define REG_HSIMR_8703B 0x0058 -+#define REG_HSISR_8703B 0x005c -+#define REG_GPIO_EXT_CTRL 0x0060 -+#define REG_PAD_CTRL1_8703B 0x0064 -+#define REG_MULTI_FUNC_CTRL_8703B 0x0068 -+#define REG_GPIO_STATUS_8703B 0x006C -+#define REG_SDIO_CTRL_8703B 0x0070 -+#define REG_OPT_CTRL_8703B 0x0074 -+#define REG_AFE_CTRL_4_8703B 0x0078 -+#define REG_MCUFWDL_8703B 0x0080 -+#define REG_HMEBOX_DBG_0_8703B 0x0088 -+#define REG_HMEBOX_DBG_1_8703B 0x008A -+#define REG_HMEBOX_DBG_2_8703B 0x008C -+#define REG_HMEBOX_DBG_3_8703B 0x008E -+#define REG_HIMR0_8703B 0x00B0 -+#define REG_HISR0_8703B 0x00B4 -+#define REG_HIMR1_8703B 0x00B8 -+#define REG_HISR1_8703B 0x00BC -+#define REG_PMC_DBG_CTRL2_8703B 0x00CC -+#define REG_EFUSE_BURN_GNT_8703B 0x00CF -+#define REG_HPON_FSM_8703B 0x00EC -+#define REG_SYS_CFG_8703B 0x00F0 -+#define REG_SYS_CFG1_8703B 0x00FC -+#define REG_ROM_VERSION 0x00FD -+ -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+#define REG_C2HEVT_CMD_ID_8703B 0x01A0 -+#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 -+#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 -+#define REG_C2HEVT_CMD_LEN_8703B 0x01AE -+#define REG_C2HEVT_CMD_LEN_88XX REG_C2HEVT_CMD_LEN_8703B -+#define REG_C2HEVT_CLEAR_8703B 0x01AF -+#define REG_MCUTST_1_8703B 0x01C0 -+#define REG_WOWLAN_WAKE_REASON 0x01C7 -+#define REG_FMETHR_8703B 0x01C8 -+#define REG_HMETFR_8703B 0x01CC -+#define REG_HMEBOX_0_8703B 0x01D0 -+#define REG_HMEBOX_1_8703B 0x01D4 -+#define REG_HMEBOX_2_8703B 0x01D8 -+#define REG_HMEBOX_3_8703B 0x01DC -+#define REG_LLT_INIT_8703B 0x01E0 -+#define REG_HMEBOX_EXT0_8703B 0x01F0 -+#define REG_HMEBOX_EXT1_8703B 0x01F4 -+#define REG_HMEBOX_EXT2_8703B 0x01F8 -+#define REG_HMEBOX_EXT3_8703B 0x01FC -+ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_RQPN_8703B 0x0200 -+#define REG_FIFOPAGE_8703B 0x0204 -+#define REG_DWBCN0_CTRL_8703B REG_TDECTRL -+#define REG_TXDMA_OFFSET_CHK_8703B 0x020C -+#define REG_TXDMA_STATUS_8703B 0x0210 -+#define REG_RQPN_NPQ_8703B 0x0214 -+#define REG_DWBCN1_CTRL_8703B 0x0228 -+ -+ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x02FFh RXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_RXDMA_AGG_PG_TH_8703B 0x0280 -+#define REG_FW_UPD_RDPTR_8703B 0x0284 // FW shall update this register before FW write RXPKT_RELEASE_POLL to 1 -+#define REG_RXDMA_CONTROL_8703B 0x0286 // Control the RX DMA. -+#define REG_RXPKT_NUM_8703B 0x0287 // The number of packets in RXPKTBUF. -+#define REG_RXDMA_STATUS_8703B 0x0288 -+#define REG_RXDMA_MODE_CTRL_8703B 0x0290 -+#define REG_EARLY_MODE_CONTROL_8703B 0x02BC -+#define REG_RSVD5_8703B 0x02F0 -+#define REG_RSVD6_8703B 0x02F4 -+ -+//----------------------------------------------------- -+// -+// 0x0300h ~ 0x03FFh PCIe -+// -+//----------------------------------------------------- -+#define REG_PCIE_CTRL_REG_8703B 0x0300 -+#define REG_INT_MIG_8703B 0x0304 // Interrupt Migration -+#define REG_BCNQ_DESA_8703B 0x0308 // TX Beacon Descriptor Address -+#define REG_HQ_DESA_8703B 0x0310 // TX High Queue Descriptor Address -+#define REG_MGQ_DESA_8703B 0x0318 // TX Manage Queue Descriptor Address -+#define REG_VOQ_DESA_8703B 0x0320 // TX VO Queue Descriptor Address -+#define REG_VIQ_DESA_8703B 0x0328 // TX VI Queue Descriptor Address -+#define REG_BEQ_DESA_8703B 0x0330 // TX BE Queue Descriptor Address -+#define REG_BKQ_DESA_8703B 0x0338 // TX BK Queue Descriptor Address -+#define REG_RX_DESA_8703B 0x0340 // RX Queue Descriptor Address -+#define REG_DBI_WDATA_8703B 0x0348 // DBI Write Data -+#define REG_DBI_RDATA_8703B 0x034C // DBI Read Data -+#define REG_DBI_ADDR_8703B 0x0350 // DBI Address -+#define REG_DBI_FLAG_8703B 0x0352 // DBI Read/Write Flag -+#define REG_MDIO_WDATA_8703B 0x0354 // MDIO for Write PCIE PHY -+#define REG_MDIO_RDATA_8703B 0x0356 // MDIO for Reads PCIE PHY -+#define REG_MDIO_CTL_8703B 0x0358 // MDIO for Control -+#define REG_DBG_SEL_8703B 0x0360 // Debug Selection Register -+#define REG_PCIE_HRPWM_8703B 0x0361 //PCIe RPWM -+#define REG_PCIE_HCPWM_8703B 0x0363 //PCIe CPWM -+#define REG_PCIE_MULTIFET_CTRL_8703B 0x036A //PCIE Multi-Fethc Control -+ -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+#define REG_VOQ_INFORMATION_8703B 0x0400 -+#define REG_VIQ_INFORMATION_8703B 0x0404 -+#define REG_BEQ_INFORMATION_8703B 0x0408 -+#define REG_BKQ_INFORMATION_8703B 0x040C -+#define REG_MGQ_INFORMATION_8703B 0x0410 -+#define REG_HGQ_INFORMATION_8703B 0x0414 -+#define REG_BCNQ_INFORMATION_8703B 0x0418 -+#define REG_TXPKT_EMPTY_8703B 0x041A -+ -+#define REG_FWHW_TXQ_CTRL_8703B 0x0420 -+#define REG_HWSEQ_CTRL_8703B 0x0423 -+#define REG_TXPKTBUF_BCNQ_BDNY_8703B 0x0424 -+#define REG_TXPKTBUF_MGQ_BDNY_8703B 0x0425 -+#define REG_LIFECTRL_CTRL_8703B 0x0426 -+#define REG_MULTI_BCNQ_OFFSET_8703B 0x0427 -+#define REG_SPEC_SIFS_8703B 0x0428 -+#define REG_RL_8703B 0x042A -+#define REG_TXBF_CTRL_8703B 0x042C -+#define REG_DARFRC_8703B 0x0430 -+#define REG_RARFRC_8703B 0x0438 -+#define REG_RRSR_8703B 0x0440 -+#define REG_ARFR0_8703B 0x0444 -+#define REG_ARFR1_8703B 0x044C -+#define REG_CCK_CHECK_8703B 0x0454 -+#define REG_AMPDU_MAX_TIME_8703B 0x0456 -+#define REG_TXPKTBUF_BCNQ_BDNY1_8703B 0x0457 -+ -+#define REG_AMPDU_MAX_LENGTH_8703B 0x0458 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8703B 0x045D -+#define REG_NDPA_OPT_CTRL_8703B 0x045F -+#define REG_FAST_EDCA_CTRL_8703B 0x0460 -+#define REG_RD_RESP_PKT_TH_8703B 0x0463 -+#define REG_DATA_SC_8703B 0x0483 -+#ifdef CONFIG_WOWLAN -+#define REG_TXPKTBUF_IV_LOW 0x0484 -+#define REG_TXPKTBUF_IV_HIGH 0x0488 -+#endif -+#define REG_TXRPT_START_OFFSET 0x04AC -+#define REG_POWER_STAGE1_8703B 0x04B4 -+#define REG_POWER_STAGE2_8703B 0x04B8 -+#define REG_AMPDU_BURST_MODE_8703B 0x04BC -+#define REG_PKT_VO_VI_LIFE_TIME_8703B 0x04C0 -+#define REG_PKT_BE_BK_LIFE_TIME_8703B 0x04C2 -+#define REG_STBC_SETTING_8703B 0x04C4 -+#define REG_HT_SINGLE_AMPDU_8703B 0x04C7 -+#define REG_PROT_MODE_CTRL_8703B 0x04C8 -+#define REG_MAX_AGGR_NUM_8703B 0x04CA -+#define REG_RTS_MAX_AGGR_NUM_8703B 0x04CB -+#define REG_BAR_MODE_CTRL_8703B 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8703B 0x04CF -+#define REG_MACID_PKT_DROP0_8703B 0x04D0 -+#define REG_MACID_PKT_SLEEP_8703B 0x04D4 -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+#define REG_EDCA_VO_PARAM_8703B 0x0500 -+#define REG_EDCA_VI_PARAM_8703B 0x0504 -+#define REG_EDCA_BE_PARAM_8703B 0x0508 -+#define REG_EDCA_BK_PARAM_8703B 0x050C -+#define REG_BCNTCFG_8703B 0x0510 -+#define REG_PIFS_8703B 0x0512 -+#define REG_RDG_PIFS_8703B 0x0513 -+#define REG_SIFS_CTX_8703B 0x0514 -+#define REG_SIFS_TRX_8703B 0x0516 -+#define REG_AGGR_BREAK_TIME_8703B 0x051A -+#define REG_SLOT_8703B 0x051B -+#define REG_TX_PTCL_CTRL_8703B 0x0520 -+#define REG_TXPAUSE_8703B 0x0522 -+#define REG_DIS_TXREQ_CLR_8703B 0x0523 -+#define REG_RD_CTRL_8703B 0x0524 -+// -+// Format for offset 540h-542h: -+// [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. -+// [7:4]: Reserved. -+// [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. -+// [23:20]: Reserved -+// Description: -+// | -+// |<--Setup--|--Hold------------>| -+// --------------|---------------------- -+// | -+// TBTT -+// Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. -+// Described by Designer Tim and Bruce, 2011-01-14. -+// -+#define REG_TBTT_PROHIBIT_8703B 0x0540 -+#define REG_RD_NAV_NXT_8703B 0x0544 -+#define REG_NAV_PROT_LEN_8703B 0x0546 -+#define REG_BCN_CTRL_8703B 0x0550 -+#define REG_BCN_CTRL_1_8703B 0x0551 -+#define REG_MBID_NUM_8703B 0x0552 -+#define REG_DUAL_TSF_RST_8703B 0x0553 -+#define REG_BCN_INTERVAL_8703B 0x0554 -+#define REG_DRVERLYINT_8703B 0x0558 -+#define REG_BCNDMATIM_8703B 0x0559 -+#define REG_ATIMWND_8703B 0x055A -+#define REG_USTIME_TSF_8703B 0x055C -+#define REG_BCN_MAX_ERR_8703B 0x055D -+#define REG_RXTSF_OFFSET_CCK_8703B 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8703B 0x055F -+#define REG_TSFTR_8703B 0x0560 -+#define REG_CTWND_8703B 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8703B 0x0577 -+#define REG_PSTIMER_8703B 0x0580 -+#define REG_TIMER0_8703B 0x0584 -+#define REG_TIMER1_8703B 0x0588 -+#define REG_ACMHWCTRL_8703B 0x05C0 -+#define REG_SCH_TXCMD_8703B 0x05F8 -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+#define REG_MAC_CR_8703B 0x0600 -+#define REG_TCR_8703B 0x0604 -+#define REG_RCR_8703B 0x0608 -+#define REG_RX_PKT_LIMIT_8703B 0x060C -+#define REG_RX_DLK_TIME_8703B 0x060D -+#define REG_RX_DRVINFO_SZ_8703B 0x060F -+ -+#define REG_MACID_8703B 0x0610 -+#define REG_BSSID_8703B 0x0618 -+#define REG_MAR_8703B 0x0620 -+#define REG_MBIDCAMCFG_8703B 0x0628 -+#define REG_WOWLAN_GTK_DBG1 0x630 -+#define REG_WOWLAN_GTK_DBG2 0x634 -+ -+#define REG_USTIME_EDCA_8703B 0x0638 -+#define REG_MAC_SPEC_SIFS_8703B 0x063A -+#define REG_RESP_SIFP_CCK_8703B 0x063C -+#define REG_RESP_SIFS_OFDM_8703B 0x063E -+#define REG_ACKTO_8703B 0x0640 -+#define REG_CTS2TO_8703B 0x0641 -+#define REG_EIFS_8703B 0x0642 -+ -+#define REG_NAV_UPPER_8703B 0x0652 // unit of 128 -+#define REG_TRXPTCL_CTL_8703B 0x0668 -+ -+// Security -+#define REG_CAMCMD_8703B 0x0670 -+#define REG_CAMWRITE_8703B 0x0674 -+#define REG_CAMREAD_8703B 0x0678 -+#define REG_CAMDBG_8703B 0x067C -+#define REG_SECCFG_8703B 0x0680 -+ -+// Power -+#define REG_WOW_CTRL_8703B 0x0690 -+#define REG_PS_RX_INFO_8703B 0x0692 -+#define REG_UAPSD_TID_8703B 0x0693 -+#define REG_WKFMCAM_CMD_8703B 0x0698 -+#define REG_WKFMCAM_NUM_8703B 0x0698 -+#define REG_WKFMCAM_RWD_8703B 0x069C -+#define REG_RXFLTMAP0_8703B 0x06A0 -+#define REG_RXFLTMAP1_8703B 0x06A2 -+#define REG_RXFLTMAP2_8703B 0x06A4 -+#define REG_BCN_PSR_RPT_8703B 0x06A8 -+#define REG_BT_COEX_TABLE_8703B 0x06C0 -+#define REG_BFMER0_INFO_8703B 0x06E4 -+#define REG_BFMER1_INFO_8703B 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8703B 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8703B 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8703B 0x06FC -+ -+// Hardware Port 2 -+#define REG_MACID1_8703B 0x0700 -+#define REG_BSSID1_8703B 0x0708 -+#define REG_BFMEE_SEL_8703B 0x0714 -+#define REG_SND_PTCL_CTRL_8703B 0x0718 -+ -+// LTE_COEX -+#define REG_LTECOEX_CTRL 0x07C0 -+#define REG_LTECOEX_WRITE_DATA 0x07C4 -+#define REG_LTECOEX_READ_DATA 0x07C8 -+#define REG_LTECOEX_PATH_CONTROL 0x70 -+ -+//============================================================ -+// SDIO Bus Specification -+//============================================================ -+ -+//----------------------------------------------------- -+// SDIO CMD Address Mapping -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// I/O bus domain (Host) -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// SDIO register -+//----------------------------------------------------- -+#define SDIO_REG_HCPWM1_8703B 0x025 // HCI Current Power Mode 1 -+ -+ -+//============================================================================ -+// 8703 Regsiter Bit and Content definition -+//============================================================================ -+ -+#define BIT_USB_RXDMA_AGG_EN BIT(31) -+#define RXDMA_AGG_MODE_EN BIT(1) -+ -+#ifdef CONFIG_WOWLAN -+#define RXPKT_RELEASE_POLL BIT(16) -+#define RXDMA_IDLE BIT(17) -+#define RW_RELEASE_EN BIT(18) -+#endif -+ -+//2 HSISR -+// interrupt mask which needs to clear -+#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ -+ HSISR_SPS_OCP_INT |\ -+ HSISR_RON_INT |\ -+ HSISR_PDNINT |\ -+ HSISR_GPIO9_INT) -+ -+ -+//---------------------------------------------------------------------------- -+// 8703B REG_CCK_CHECK (offset 0x454) -+//---------------------------------------------------------------------------- -+#define BIT_BCN_PORT_SEL BIT5 -+ -+#ifdef CONFIG_RF_GAIN_OFFSET -+ -+#ifdef CONFIG_RTL8703B -+#define EEPROM_RF_GAIN_OFFSET 0xC1 -+#endif -+ -+#define EEPROM_RF_GAIN_VAL 0x1F6 -+#endif //CONFIG_RF_GAIN_OFFSET -+ -+ -+//---------------------------------------------------------------------------- -+// 8195 IMR/ISR bits (offset 0xB0, 8bits) -+//---------------------------------------------------------------------------- -+#define IMR_DISABLED_8703B 0 -+// IMR DW0(0x00B0-00B3) Bit 0-31 -+#define IMR_TIMER2_8703B BIT31 // Timeout interrupt 2 -+#define IMR_TIMER1_8703B BIT30 // Timeout interrupt 1 -+#define IMR_PSTIMEOUT_8703B BIT29 // Power Save Time Out Interrupt -+#define IMR_GTINT4_8703B BIT28 // When GTIMER4 expires, this bit is set to 1 -+#define IMR_GTINT3_8703B BIT27 // When GTIMER3 expires, this bit is set to 1 -+#define IMR_TXBCN0ERR_8703B BIT26 // Transmit Beacon0 Error -+#define IMR_TXBCN0OK_8703B BIT25 // Transmit Beacon0 OK -+#define IMR_TSF_BIT32_TOGGLE_8703B BIT24 // TSF Timer BIT32 toggle indication interrupt -+#define IMR_BCNDMAINT0_8703B BIT20 // Beacon DMA Interrupt 0 -+#define IMR_BCNDERR0_8703B BIT16 // Beacon Queue DMA OK0 -+#define IMR_HSISR_IND_ON_INT_8703B BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) -+#define IMR_BCNDMAINT_E_8703B BIT14 // Beacon DMA Interrupt Extension for Win7 -+#define IMR_ATIMEND_8703B BIT12 // CTWidnow End or ATIM Window End -+#define IMR_C2HCMD_8703B BIT10 // CPU to Host Command INT Status, Write 1 clear -+#define IMR_CPWM2_8703B BIT9 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_CPWM_8703B BIT8 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_HIGHDOK_8703B BIT7 // High Queue DMA OK -+#define IMR_MGNTDOK_8703B BIT6 // Management Queue DMA OK -+#define IMR_BKDOK_8703B BIT5 // AC_BK DMA OK -+#define IMR_BEDOK_8703B BIT4 // AC_BE DMA OK -+#define IMR_VIDOK_8703B BIT3 // AC_VI DMA OK -+#define IMR_VODOK_8703B BIT2 // AC_VO DMA OK -+#define IMR_RDU_8703B BIT1 // Rx Descriptor Unavailable -+#define IMR_ROK_8703B BIT0 // Receive DMA OK -+ -+// IMR DW1(0x00B4-00B7) Bit 0-31 -+#define IMR_BCNDMAINT7_8703B BIT27 // Beacon DMA Interrupt 7 -+#define IMR_BCNDMAINT6_8703B BIT26 // Beacon DMA Interrupt 6 -+#define IMR_BCNDMAINT5_8703B BIT25 // Beacon DMA Interrupt 5 -+#define IMR_BCNDMAINT4_8703B BIT24 // Beacon DMA Interrupt 4 -+#define IMR_BCNDMAINT3_8703B BIT23 // Beacon DMA Interrupt 3 -+#define IMR_BCNDMAINT2_8703B BIT22 // Beacon DMA Interrupt 2 -+#define IMR_BCNDMAINT1_8703B BIT21 // Beacon DMA Interrupt 1 -+#define IMR_BCNDOK7_8703B BIT20 // Beacon Queue DMA OK Interrup 7 -+#define IMR_BCNDOK6_8703B BIT19 // Beacon Queue DMA OK Interrup 6 -+#define IMR_BCNDOK5_8703B BIT18 // Beacon Queue DMA OK Interrup 5 -+#define IMR_BCNDOK4_8703B BIT17 // Beacon Queue DMA OK Interrup 4 -+#define IMR_BCNDOK3_8703B BIT16 // Beacon Queue DMA OK Interrup 3 -+#define IMR_BCNDOK2_8703B BIT15 // Beacon Queue DMA OK Interrup 2 -+#define IMR_BCNDOK1_8703B BIT14 // Beacon Queue DMA OK Interrup 1 -+#define IMR_ATIMEND_E_8703B BIT13 // ATIM Window End Extension for Win7 -+#define IMR_TXERR_8703B BIT11 // Tx Error Flag Interrupt Status, write 1 clear. -+#define IMR_RXERR_8703B BIT10 // Rx Error Flag INT Status, Write 1 clear -+#define IMR_TXFOVW_8703B BIT9 // Transmit FIFO Overflow -+#define IMR_RXFOVW_8703B BIT8 // Receive FIFO Overflow -+ -+#ifdef CONFIG_PCI_HCI -+//#define IMR_RX_MASK (IMR_ROK_8703B|IMR_RDU_8703B|IMR_RXFOVW_8703B) -+#define IMR_TX_MASK (IMR_VODOK_8703B|IMR_VIDOK_8703B|IMR_BEDOK_8703B|IMR_BKDOK_8703B|IMR_MGNTDOK_8703B|IMR_HIGHDOK_8703B) -+ -+#define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8703B | IMR_TXBCN0OK_8703B | IMR_TXBCN0ERR_8703B | IMR_BCNDERR0_8703B) -+ -+#define RT_AC_INT_MASKS (IMR_VIDOK_8703B | IMR_VODOK_8703B | IMR_BEDOK_8703B|IMR_BKDOK_8703B) -+#endif -+ -+//======================================================== -+// General definitions -+//======================================================== -+ -+#define MACID_NUM_8703B 128 -+#define SEC_CAM_ENT_NUM_8703B 16 -+#define NSS_NUM_8703B 1 -+ -+#endif /* __RTL8703B_SPEC_H__ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8703b_sreset.h linux/3rdparty/rtl8812au/include/rtl8703b_sreset.h ---- linux.old/3rdparty/rtl8812au/include/rtl8703b_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8703b_sreset.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8703B_SRESET_H_ -+#define _RTL8703B_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+extern void rtl8703b_sreset_xmit_status_check(_adapter *padapter); -+extern void rtl8703b_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8703b_xmit.h linux/3rdparty/rtl8812au/include/rtl8703b_xmit.h ---- linux.old/3rdparty/rtl8812au/include/rtl8703b_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8703b_xmit.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,336 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_XMIT_H__ -+#define __RTL8703B_XMIT_H__ -+ -+ -+#define MAX_TID (15) -+ -+ -+#ifndef __INC_HAL8703BDESC_H -+#define __INC_HAL8703BDESC_H -+ -+#define RX_STATUS_DESC_SIZE_8703B 24 -+#define RX_DRV_INFO_SIZE_UNIT_8703B 8 -+ -+ -+//DWORD 0 -+#define SET_RX_STATUS_DESC_PKT_LEN_8703B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_8703B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_8703B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 31, 1, __Value) -+ -+#define GET_RX_STATUS_DESC_PKT_LEN_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICV_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_LAST_SEG_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 28, 1) -+#define GET_RX_STATUS_DESC_FIRST_SEG_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 29, 1) -+#define GET_RX_STATUS_DESC_EOR_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_OWN_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 31, 1) -+ -+//DWORD 1 -+#define GET_RX_STATUS_DESC_MACID_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_TID_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_AMSDU_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_A1_FIT_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 16, 4) -+#define GET_RX_STATUS_DESC_CHKERR_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_IPVER_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_IS_TCPUDP__8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_CHK_VLD_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_MC_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 31, 1) -+ -+//DWORD 2 -+#define GET_RX_STATUS_DESC_SEQ_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 12, 4) -+#define GET_RX_STATUS_DESC_RX_IS_QOS_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 16, 1) -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_RPT_SEL_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 28, 1) -+ -+//DWORD 3 -+#define GET_RX_STATUS_DESC_RX_RATE_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_HTC_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 12, 2) -+#ifdef CONFIG_USB_RX_AGGREGATION -+#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 16, 8) -+#endif -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_MATCH_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_MATCH_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 31, 1) -+ -+//DWORD 6 -+#define GET_RX_STATUS_DESC_SPLCP_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 0, 1) -+#define GET_RX_STATUS_DESC_LDPC_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 1, 1) -+#define GET_RX_STATUS_DESC_STBC_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 2, 1) -+#define GET_RX_STATUS_DESC_BW_8703B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 4, 2) -+ -+//DWORD 5 -+#define GET_RX_STATUS_DESC_TSFL_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+20, 0, 32) -+ -+#define GET_RX_STATUS_DESC_BUFF_ADDR_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+#define GET_RX_STATUS_DESC_BUFF_ADDR64_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+#define SET_RX_STATUS_DESC_BUFF_ADDR_8703B(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) -+ -+ -+// Dword 0 -+#define GET_TX_DESC_OWN_8703B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+#define SET_TX_DESC_PKT_SIZE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define SET_TX_DESC_OFFSET_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define SET_TX_DESC_BMC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_LAST_SEG_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+#define SET_TX_DESC_FIRST_SEG_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_LINIP_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+#define SET_TX_DESC_NO_ACM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+#define SET_TX_DESC_OWN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+// Dword 1 -+#define SET_TX_DESC_MACID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+ -+ -+// Dword 2 -+#define SET_TX_DESC_PAID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+#define SET_TX_DESC_CCA_RTS_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_AGG_BREAK_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define SET_TX_DESC_RAW_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define SET_TX_DESC_SPE_RPT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_INT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_GID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+ -+ -+// Dword 3 -+#define SET_TX_DESC_WHEADER_LEN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) -+#define SET_TX_DESC_CHK_EN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) -+#define SET_TX_DESC_EARLY_MODE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HWSEQ_SEL_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_NAV_USE_HDR_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_NDPA_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+// Dword 4 -+#define SET_TX_DESC_TX_RATE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+ -+ -+// Dword 5 -+#define SET_TX_DESC_DATA_SC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_LDPC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+#define SET_TX_DESC_DATA_STBC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_CTROL_STBC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+ -+ -+// Dword 6 -+#define SET_TX_DESC_SW_DEFINE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_MBSSID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+#define SET_TX_DESC_ANTSEL_A_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+#define SET_TX_DESC_ANTSEL_B_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) -+#define SET_TX_DESC_ANTSEL_C_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) -+#define SET_TX_DESC_ANTSEL_D_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) -+ -+// Dword 7 -+#if(DEV_BUS_TYPE == RT_PCI_INTERFACE) -+#define SET_TX_DESC_TX_BUFFER_SIZE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#else -+#define SET_TX_DESC_TX_DESC_CHECKSUM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+#define SET_TX_DESC_USB_TXAGG_NUM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+#if(DEV_BUS_TYPE == RT_SDIO_INTERFACE) -+#define SET_TX_DESC_SDIO_TXSEQ_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) -+#endif -+ -+// Dword 8 -+#define SET_TX_DESC_HWSEQ_EN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+ -+// Dword 9 -+#define SET_TX_DESC_SEQ_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+ -+// Dword 10 -+#define SET_TX_DESC_TX_BUFFER_ADDRESS_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) -+#define GET_TX_DESC_TX_BUFFER_ADDRESS_8703B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+40, 0, 32) -+ -+// Dword 11 -+#define SET_TX_DESC_NEXT_DESC_ADDRESS_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) -+ -+ -+#define SET_EARLYMODE_PKTNUM_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+#endif -+//----------------------------------------------------------- -+// -+// Rate -+// -+//----------------------------------------------------------- -+// CCK Rates, TxHT = 0 -+#define DESC8703B_RATE1M 0x00 -+#define DESC8703B_RATE2M 0x01 -+#define DESC8703B_RATE5_5M 0x02 -+#define DESC8703B_RATE11M 0x03 -+ -+// OFDM Rates, TxHT = 0 -+#define DESC8703B_RATE6M 0x04 -+#define DESC8703B_RATE9M 0x05 -+#define DESC8703B_RATE12M 0x06 -+#define DESC8703B_RATE18M 0x07 -+#define DESC8703B_RATE24M 0x08 -+#define DESC8703B_RATE36M 0x09 -+#define DESC8703B_RATE48M 0x0a -+#define DESC8703B_RATE54M 0x0b -+ -+// MCS Rates, TxHT = 1 -+#define DESC8703B_RATEMCS0 0x0c -+#define DESC8703B_RATEMCS1 0x0d -+#define DESC8703B_RATEMCS2 0x0e -+#define DESC8703B_RATEMCS3 0x0f -+#define DESC8703B_RATEMCS4 0x10 -+#define DESC8703B_RATEMCS5 0x11 -+#define DESC8703B_RATEMCS6 0x12 -+#define DESC8703B_RATEMCS7 0x13 -+#define DESC8703B_RATEMCS8 0x14 -+#define DESC8703B_RATEMCS9 0x15 -+#define DESC8703B_RATEMCS10 0x16 -+#define DESC8703B_RATEMCS11 0x17 -+#define DESC8703B_RATEMCS12 0x18 -+#define DESC8703B_RATEMCS13 0x19 -+#define DESC8703B_RATEMCS14 0x1a -+#define DESC8703B_RATEMCS15 0x1b -+#define DESC8703B_RATEVHTSS1MCS0 0x2c -+#define DESC8703B_RATEVHTSS1MCS1 0x2d -+#define DESC8703B_RATEVHTSS1MCS2 0x2e -+#define DESC8703B_RATEVHTSS1MCS3 0x2f -+#define DESC8703B_RATEVHTSS1MCS4 0x30 -+#define DESC8703B_RATEVHTSS1MCS5 0x31 -+#define DESC8703B_RATEVHTSS1MCS6 0x32 -+#define DESC8703B_RATEVHTSS1MCS7 0x33 -+#define DESC8703B_RATEVHTSS1MCS8 0x34 -+#define DESC8703B_RATEVHTSS1MCS9 0x35 -+#define DESC8703B_RATEVHTSS2MCS0 0x36 -+#define DESC8703B_RATEVHTSS2MCS1 0x37 -+#define DESC8703B_RATEVHTSS2MCS2 0x38 -+#define DESC8703B_RATEVHTSS2MCS3 0x39 -+#define DESC8703B_RATEVHTSS2MCS4 0x3a -+#define DESC8703B_RATEVHTSS2MCS5 0x3b -+#define DESC8703B_RATEVHTSS2MCS6 0x3c -+#define DESC8703B_RATEVHTSS2MCS7 0x3d -+#define DESC8703B_RATEVHTSS2MCS8 0x3e -+#define DESC8703B_RATEVHTSS2MCS9 0x3f -+ -+ -+#define RX_HAL_IS_CCK_RATE_8703B(pDesc)\ -+ (GET_RX_STATUS_DESC_RX_RATE_8703B(pDesc) == DESC8703B_RATE1M ||\ -+ GET_RX_STATUS_DESC_RX_RATE_8703B(pDesc) == DESC8703B_RATE2M ||\ -+ GET_RX_STATUS_DESC_RX_RATE_8703B(pDesc) == DESC8703B_RATE5_5M ||\ -+ GET_RX_STATUS_DESC_RX_RATE_8703B(pDesc) == DESC8703B_RATE11M) -+ -+ -+void rtl8703b_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); -+void rtl8703b_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+s32 rtl8703bs_init_xmit_priv(PADAPTER padapter); -+void rtl8703bs_free_xmit_priv(PADAPTER padapter); -+s32 rtl8703bs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8703bs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8703bs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtl8703bs_xmit_buf_handler(PADAPTER padapter); -+thread_return rtl8703bs_xmit_thread(thread_context context); -+#define hal_xmit_handler rtl8703bs_xmit_buf_handler -+#endif -+ -+#ifdef CONFIG_USB_HCI -+s32 rtl8703bu_xmit_buf_handler(PADAPTER padapter); -+#define hal_xmit_handler rtl8703bu_xmit_buf_handler -+ -+ -+s32 rtl8703bu_init_xmit_priv(PADAPTER padapter); -+void rtl8703bu_free_xmit_priv(PADAPTER padapter); -+s32 rtl8703bu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8703bu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8703bu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+//s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); -+void rtl8703bu_xmit_tasklet(void *priv); -+s32 rtl8703bu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+void _dbg_dump_tx_info(_adapter *padapter,int frame_tag,struct tx_desc *ptxdesc); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8703be_init_xmit_priv(PADAPTER padapter); -+void rtl8703be_free_xmit_priv(PADAPTER padapter); -+struct xmit_buf *rtl8703be_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+void rtl8703be_xmitframe_resume(_adapter *padapter); -+s32 rtl8703be_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8703be_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8703be_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+void rtl8703be_xmit_tasklet(void *priv); -+#endif -+ -+u8 BWMapping_8703B(PADAPTER Adapter, struct pkt_attrib *pattrib); -+u8 SCMapping_8703B(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8723b_cmd.h linux/3rdparty/rtl8812au/include/rtl8723b_cmd.h ---- linux.old/3rdparty/rtl8812au/include/rtl8723b_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8723b_cmd.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,224 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_CMD_H__ -+#define __RTL8723B_CMD_H__ -+ -+//---------------------------------------------------------------------------------------------------------// -+//---------------------------------- H2C CMD DEFINITION ------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+ -+enum h2c_cmd_8723B{ -+ //Common Class: 000 -+ H2C_8723B_RSVD_PAGE = 0x00, -+ H2C_8723B_MEDIA_STATUS_RPT = 0x01, -+ H2C_8723B_SCAN_ENABLE = 0x02, -+ H2C_8723B_KEEP_ALIVE = 0x03, -+ H2C_8723B_DISCON_DECISION = 0x04, -+ H2C_8723B_PSD_OFFLOAD = 0x05, -+ H2C_8723B_AP_OFFLOAD = 0x08, -+ H2C_8723B_BCN_RSVDPAGE = 0x09, -+ H2C_8723B_PROBERSP_RSVDPAGE = 0x0A, -+ H2C_8723B_FCS_RSVDPAGE = 0x10, -+ H2C_8723B_FCS_INFO = 0x11, -+ H2C_8723B_AP_WOW_GPIO_CTRL = 0x13, -+ -+ //PoweSave Class: 001 -+ H2C_8723B_SET_PWR_MODE = 0x20, -+ H2C_8723B_PS_TUNING_PARA = 0x21, -+ H2C_8723B_PS_TUNING_PARA2 = 0x22, -+ H2C_8723B_P2P_LPS_PARAM = 0x23, -+ H2C_8723B_P2P_PS_OFFLOAD = 0x24, -+ H2C_8723B_PS_SCAN_ENABLE = 0x25, -+ H2C_8723B_SAP_PS_ = 0x26, -+ H2C_8723B_INACTIVE_PS_ = 0x27, //Inactive_PS -+ H2C_8723B_FWLPS_IN_IPS_ = 0x28, -+ -+ //Dynamic Mechanism Class: 010 -+ H2C_8723B_MACID_CFG = 0x40, -+ H2C_8723B_TXBF = 0x41, -+ H2C_8723B_RSSI_SETTING = 0x42, -+ H2C_8723B_AP_REQ_TXRPT = 0x43, -+ H2C_8723B_INIT_RATE_COLLECT = 0x44, -+ H2C_8723B_RA_PARA_ADJUST = 0x46, -+ -+ //BT Class: 011 -+ H2C_8723B_B_TYPE_TDMA = 0x60, -+ H2C_8723B_BT_INFO = 0x61, -+ H2C_8723B_FORCE_BT_TXPWR = 0x62, -+ H2C_8723B_BT_IGNORE_WLANACT = 0x63, -+ H2C_8723B_DAC_SWING_VALUE = 0x64, -+ H2C_8723B_ANT_SEL_RSV = 0x65, -+ H2C_8723B_WL_OPMODE = 0x66, -+ H2C_8723B_BT_MP_OPER = 0x67, -+ H2C_8723B_BT_CONTROL = 0x68, -+ H2C_8723B_BT_WIFI_CTRL = 0x69, -+ H2C_8723B_BT_FW_PATCH = 0x6A, -+ H2C_8723B_BT_WLAN_CALIBRATION = 0x6D, -+ -+ //WOWLAN Class: 100 -+ H2C_8723B_WOWLAN = 0x80, -+ H2C_8723B_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8723B_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8723B_AOAC_RSVD_PAGE = 0x83, -+ H2C_8723B_AOAC_RSVD_PAGE2 = 0x84, -+ H2C_8723B_D0_SCAN_OFFLOAD_CTRL = 0x85, -+ H2C_8723B_D0_SCAN_OFFLOAD_INFO = 0x86, -+ H2C_8723B_CHNL_SWITCH_OFFLOAD = 0x87, -+ H2C_8723B_P2P_OFFLOAD_RSVD_PAGE = 0x8A, -+ H2C_8723B_P2P_OFFLOAD = 0x8B, -+ -+ H2C_8723B_RESET_TSF = 0xC0, -+ H2C_8723B_MAXID, -+}; -+ -+//---------------------------------------------------------------------------------------------------------// -+//---------------------------------- H2C CMD CONTENT --------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+//_RSVDPAGE_LOC_CMD_0x00 -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+ -+//_MEDIA_STATUS_RPT_PARM_CMD_0x01 -+#define SET_8723B_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8723B_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8723B_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+2, 0, 8, __Value) -+ -+//_KEEP_ALIVE_CMD_0x03 -+#define SET_8723B_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8723B_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8723B_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8723B_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+ -+//_DISCONNECT_DECISION_CMD_0x04 -+#define SET_8723B_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8723B_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8723B_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+2, 0, 8, __Value) -+ -+// _PWR_MOD_CMD_0x20 -+#define SET_8723B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+5, 0, 8, __Value) -+ -+#define GET_8723B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+// _PS_TUNE_PARAM_CMD_0x21 -+#define SET_8723B_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) -+#define SET_8723B_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) -+#define SET_8723B_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+//_MACID_CFG_CMD_0x40 -+#define SET_8723B_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) -+ -+//_RSSI_SETTING_CMD_0x42 -+#define SET_8723B_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) -+#define SET_8723B_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+// _AP_REQ_TXRPT_CMD_0x43 -+#define SET_8723B_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+// _FORCE_BT_TXPWR_CMD_0x62 -+#define SET_8723B_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+ -+// _FORCE_BT_MP_OPER_CMD_0x67 -+#define SET_8723B_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+ -+// _BT_FW_PATCH_0x6A -+#define SET_8723B_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) -+#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+//---------------------------------------------------------------------------------------------------------// -+//------------------------------------------- Structure --------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+ -+ -+//---------------------------------------------------------------------------------------------------------// -+//---------------------------------- Function Statement --------------------------------------------------// -+//---------------------------------------------------------------------------------------------------------// -+ -+// host message to firmware cmd -+void rtl8723b_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); -+void rtl8723b_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); -+void rtl8723b_set_rssi_cmd(PADAPTER padapter, u8 *param); -+void rtl8723b_Add_RateATid(PADAPTER pAdapter, u64 rate_bitmap, u8 *arg, u8 rssi_level); -+void rtl8723b_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); -+//s32 rtl8723b_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); -+void rtl8723b_set_FwPsTuneParam_cmd(PADAPTER padapter); -+void rtl8723b_set_FwMacIdConfig_cmd(_adapter* padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); -+void rtl8723b_set_FwMediaStatusRpt_cmd(PADAPTER padapter, u8 mstatus, u8 macid); -+void rtl8723b_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); -+void rtl8723b_download_rsvd_page(PADAPTER padapter, u8 mstatus); -+#ifdef CONFIG_BT_COEXIST -+void rtl8723b_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif // CONFIG_BT_COEXIST -+#ifdef CONFIG_P2P -+void rtl8723b_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif //CONFIG_P2P -+ -+void CheckFwRsvdPageContent(PADAPTER padapter); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void SetFwRelatedForWoWLAN8723b(_adapter* padapter, u8 bHostIsGoingtoSleep); -+#endif//CONFIG_WOWLAN -+ -+#ifdef CONFIG_P2P_WOWLAN -+void rtl8723b_set_p2p_wowlan_offload_cmd(PADAPTER padapter); -+#endif -+ -+void rtl8723b_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+u8 rtl8723b_reset_tsf(_adapter *padapter, u8 reset_port); -+#endif // CONFIG_TSF_RESET_OFFLOAD -+s32 FillH2CCmd8723B(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8723B(_adapter *padapter, bool wowlan); -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8723b_dm.h linux/3rdparty/rtl8812au/include/rtl8723b_dm.h ---- linux.old/3rdparty/rtl8812au/include/rtl8723b_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8723b_dm.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_DM_H__ -+#define __RTL8723B_DM_H__ -+//============================================================ -+// Description: -+// -+// This file is for 8723B dynamic mechanism only -+// -+// -+//============================================================ -+ -+//============================================================ -+// structure and define -+//============================================================ -+ -+//============================================================ -+// function prototype -+//============================================================ -+ -+void rtl8723b_init_dm_priv(PADAPTER padapter); -+void rtl8723b_deinit_dm_priv(PADAPTER padapter); -+ -+void rtl8723b_InitHalDm(PADAPTER padapter); -+void rtl8723b_HalDmWatchDog(PADAPTER padapter); -+void rtl8723b_HalDmWatchDog_in_LPS(PADAPTER padapter); -+void rtl8723b_hal_dm_in_lps(PADAPTER padapter); -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8723b_hal.h linux/3rdparty/rtl8812au/include/rtl8723b_hal.h ---- linux.old/3rdparty/rtl8812au/include/rtl8723b_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8723b_hal.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,346 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_HAL_H__ -+#define __RTL8723B_HAL_H__ -+ -+#include "hal_data.h" -+ -+#include "rtl8723b_spec.h" -+#include "rtl8723b_rf.h" -+#include "rtl8723b_dm.h" -+#include "rtl8723b_recv.h" -+#include "rtl8723b_xmit.h" -+#include "rtl8723b_cmd.h" -+#include "rtl8723b_led.h" -+#include "Hal8723BPwrSeq.h" -+#include "Hal8723BPhyReg.h" -+#include "Hal8723BPhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+#include "rtl8723b_sreset.h" -+#endif -+ -+ -+//--------------------------------------------------------------------- -+// RTL8723B From file -+//--------------------------------------------------------------------- -+ #define RTL8723B_FW_IMG "rtl8723b/FW_NIC.bin" -+ #define RTL8723B_FW_WW_IMG "rtl8723b/FW_WoWLAN.bin" -+ #define RTL8723B_PHY_REG "rtl8723b/PHY_REG.txt" -+ #define RTL8723B_PHY_RADIO_A "rtl8723b/RadioA.txt" -+ #define RTL8723B_PHY_RADIO_B "rtl8723b/RadioB.txt" -+ #define RTL8723B_TXPWR_TRACK "rtl8723b/TxPowerTrack.txt" -+ #define RTL8723B_AGC_TAB "rtl8723b/AGC_TAB.txt" -+ #define RTL8723B_PHY_MACREG "rtl8723b/MAC_REG.txt" -+ #define RTL8723B_PHY_REG_PG "rtl8723b/PHY_REG_PG.txt" -+ #define RTL8723B_PHY_REG_MP "rtl8723b/PHY_REG_MP.txt" -+ #define RTL8723B_TXPWR_LMT "rtl8723b/TXPWR_LMT.txt" -+ -+//--------------------------------------------------------------------- -+// RTL8723B From header -+//--------------------------------------------------------------------- -+ -+#if MP_DRIVER == 1 -+ #define Rtl8723B_FwBTImgArray Rtl8723BFwBTImgArray -+ #define Rtl8723B_FwBTImgArrayLength Rtl8723BFwBTImgArrayLength -+ -+ #define Rtl8723B_PHY_REG_Array_MP Rtl8723B_PHYREG_Array_MP -+ #define Rtl8723B_PHY_REG_Array_MPLength Rtl8723B_PHYREG_Array_MPLength -+#endif -+ -+ -+#define FW_8723B_SIZE 0x8000 -+#define FW_8723B_START_ADDRESS 0x1000 -+#define FW_8723B_END_ADDRESS 0x1FFF //0x5FFF -+ -+#define IS_FW_HEADER_EXIST_8723B(_pFwHdr) ((le16_to_cpu(_pFwHdr->Signature)&0xFFF0) == 0x5300) -+ -+typedef struct _RT_FIRMWARE { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8* szFwBuffer; -+#else -+ u8 szFwBuffer[FW_8723B_SIZE]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8723B, *PRT_FIRMWARE_8723B; -+ -+// -+// This structure must be cared byte-ordering -+// -+// Added by tynli. 2009.12.04. -+typedef struct _RT_8723B_FIRMWARE_HDR -+{ -+ // 8-byte alinment required -+ -+ //--- LONG WORD 0 ---- -+ u16 Signature; // 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut -+ u8 Category; // AP/NIC and USB/PCI -+ u8 Function; // Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions -+ u16 Version; // FW Version -+ u16 Subversion; // FW Subversion, default 0x00 -+ -+ //--- LONG WORD 1 ---- -+ u8 Month; // Release time Month field -+ u8 Date; // Release time Date field -+ u8 Hour; // Release time Hour field -+ u8 Minute; // Release time Minute field -+ u16 RamCodeSize; // The size of RAM code -+ u16 Rsvd2; -+ -+ //--- LONG WORD 2 ---- -+ u32 SvnIdx; // The SVN entry index -+ u32 Rsvd3; -+ -+ //--- LONG WORD 3 ---- -+ u32 Rsvd4; -+ u32 Rsvd5; -+}RT_8723B_FIRMWARE_HDR, *PRT_8723B_FIRMWARE_HDR; -+ -+#define DRIVER_EARLY_INT_TIME_8723B 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8723B 0x02 -+ -+// for 8723B -+// TX 32K, RX 16K, Page size 128B for TX, 8B for RX -+#define PAGE_SIZE_TX_8723B 128 -+#define PAGE_SIZE_RX_8723B 8 -+ -+#define TX_DMA_SIZE_8723B 0x8000 /* 32K(TX) */ -+#define RX_DMA_SIZE_8723B 0x4000 /* 16K(RX) */ -+ -+#ifdef CONFIG_WOWLAN -+#define RESV_FMWF WKFMCAM_SIZE*MAX_WKFM_NUM /* 16 entries, for each is 24 bytes*/ -+#else -+#define RESV_FMWF 0 -+#endif -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+#define RX_DMA_RESERVED_SIZE_8723B 0x100 // 256B, reserved for c2h debug message -+#else -+#define RX_DMA_RESERVED_SIZE_8723B 0x80 // 128B, reserved for tx report -+#endif -+#define RX_DMA_BOUNDARY_8723B (RX_DMA_SIZE_8723B - RX_DMA_RESERVED_SIZE_8723B - 1) -+ -+ -+// Note: We will divide number of page equally for each queue other than public queue! -+ -+//For General Reserved Page Number(Beacon Queue is reserved page) -+//Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 -+#define BCNQ_PAGE_NUM_8723B 0x08 -+#ifdef CONFIG_CONCURRENT_MODE -+#define BCNQ1_PAGE_NUM_8723B 0x08 // 0x04 -+#else -+#define BCNQ1_PAGE_NUM_8723B 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+#undef BCNQ1_PAGE_NUM_8723B -+#define BCNQ1_PAGE_NUM_8723B 0x00 // 0x04 -+#endif -+ -+//For WoWLan , more reserved page -+//ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 -+#ifdef CONFIG_WOWLAN -+#define WOWLAN_PAGE_NUM_8723B 0x07 -+#else -+#define WOWLAN_PAGE_NUM_8723B 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+#undef WOWLAN_PAGE_NUM_8723B -+#define WOWLAN_PAGE_NUM_8723B 0x15 -+#endif -+ -+#ifdef CONFIG_AP_WOWLAN -+#define AP_WOWLAN_PAGE_NUM_8723B 0x02 -+#endif -+ -+#define TX_TOTAL_PAGE_NUMBER_8723B (0xFF - BCNQ_PAGE_NUM_8723B - BCNQ1_PAGE_NUM_8723B - WOWLAN_PAGE_NUM_8723B) -+#define TX_PAGE_BOUNDARY_8723B (TX_TOTAL_PAGE_NUMBER_8723B + 1) -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723B TX_TOTAL_PAGE_NUMBER_8723B -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8723B (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723B + 1) -+ -+// For Normal Chip Setting -+// (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8723B -+#define NORMAL_PAGE_NUM_HPQ_8723B 0x0C -+#define NORMAL_PAGE_NUM_LPQ_8723B 0x02 -+#define NORMAL_PAGE_NUM_NPQ_8723B 0x02 -+ -+// Note: For Normal Chip Setting, modify later -+#define WMM_NORMAL_PAGE_NUM_HPQ_8723B 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8723B 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8723B 0x20 -+ -+ -+#include "HalVerDef.h" -+#include "hal_com.h" -+ -+#define EFUSE_OOB_PROTECT_BYTES 15 -+ -+#define HAL_EFUSE_MEMORY -+ -+#define HWSET_MAX_SIZE_8723B 512 -+#define EFUSE_REAL_CONTENT_LEN_8723B 512 -+#define EFUSE_MAP_LEN_8723B 512 -+#define EFUSE_MAX_SECTION_8723B 64 -+ -+#define EFUSE_IC_ID_OFFSET 506 //For some inferiority IC purpose. added by Roger, 2009.09.02. -+#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8723B) -+ -+#define EFUSE_ACCESS_ON 0x69 // For RTL8723 only. -+#define EFUSE_ACCESS_OFF 0x00 // For RTL8723 only. -+ -+//======================================================== -+// EFUSE for BT definition -+//======================================================== -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN 512 -+#define EFUSE_BT_REAL_CONTENT_LEN 1536 // 512*3 -+#define EFUSE_BT_MAP_LEN 1024 // 1k bytes -+#define EFUSE_BT_MAX_SECTION 128 // 1024/8 -+ -+#define EFUSE_PROTECT_BYTES_BANK 16 -+ -+// Description: Determine the types of C2H events that are the same in driver and Fw. -+// Fisrt constructed by tynli. 2009.10.09. -+typedef enum _C2H_EVT -+{ -+ C2H_DBG = 0, -+ C2H_TSF = 1, -+ C2H_AP_RPT_RSP = 2, -+ C2H_CCX_TX_RPT = 3, // The FW notify the report of the specific tx packet. -+ C2H_BT_RSSI = 4, -+ C2H_BT_OP_MODE = 5, -+ C2H_EXT_RA_RPT = 6, -+ C2H_8723B_BT_INFO = 9, -+ C2H_HW_INFO_EXCH = 10, -+ C2H_8723B_BT_MP_INFO = 11, -+ C2H_8723B_P2P_RPORT = 0x16, -+#ifdef CONFIG_FW_C2H_DEBUG -+ C2H_8723B_FW_DEBUG = 0xff, -+#endif //CONFIG_FW_C2H_DEBUG -+ MAX_C2HEVENT -+} C2H_EVT; -+ -+typedef struct _C2H_EVT_HDR -+{ -+ u8 CmdID; -+ u8 CmdLen; -+ u8 CmdSeq; -+} __attribute__((__packed__)) C2H_EVT_HDR, *PC2H_EVT_HDR; -+ -+typedef enum tag_Package_Definition -+{ -+ PACKAGE_DEFAULT, -+ PACKAGE_QFN68, -+ PACKAGE_TFBGA90, -+ PACKAGE_TFBGA80, -+ PACKAGE_TFBGA79 -+}PACKAGE_TYPE_E; -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+// rtl8723a_hal_init.c -+s32 rtl8723b_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); -+void rtl8723b_FirmwareSelfReset(PADAPTER padapter); -+void rtl8723b_InitializeFirmwareVars(PADAPTER padapter); -+ -+void rtl8723b_InitAntenna_Selection(PADAPTER padapter); -+void rtl8723b_DeinitAntenna_Selection(PADAPTER padapter); -+void rtl8723b_CheckAntenna_Selection(PADAPTER padapter); -+void rtl8723b_init_default_value(PADAPTER padapter); -+ -+s32 rtl8723b_InitLLTTable(PADAPTER padapter); -+ -+s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU); -+s32 CardDisableWithoutHWSM(PADAPTER padapter); -+ -+// EFuse -+u8 GetEEPROMSize8723B(PADAPTER padapter); -+void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); -+void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); -+void Hal_EfuseParseTxPowerInfo_8723B(PADAPTER padapter, u8 *PROMContent, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseBTCoexistInfo_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseEEPROMVer_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseChnlPlan_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseCustomerID_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseAntennaDiversity_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseXtal_8723B(PADAPTER pAdapter, u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParseThermalMeter_8723B(PADAPTER padapter, u8 *hwinfo, u8 AutoLoadFail); -+VOID Hal_EfuseParsePackageType_8723B(PADAPTER pAdapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+VOID Hal_EfuseParseVoltage_8723B(PADAPTER pAdapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+VOID Hal_EfuseParseBoardType_8723B(PADAPTER Adapter, u8* PROMContent,BOOLEAN AutoloadFail); -+ -+#ifdef CONFIG_C2H_PACKET_EN -+void rtl8723b_c2h_packet_handler(PADAPTER padapter, u8 *pbuf, u16 length); -+#endif -+ -+ -+void rtl8723b_set_hal_ops(struct hal_ops *pHalFunc); -+void SetHwReg8723B(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg8723B(PADAPTER padapter, u8 variable, u8 *val); -+#ifdef CONFIG_C2H_PACKET_EN -+void SetHwRegWithBuf8723B(PADAPTER padapter, u8 variable, u8 *pbuf, int len); -+#endif // CONFIG_C2H_PACKET_EN -+u8 SetHalDefVar8723B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8723B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+ -+// register -+void rtl8723b_InitBeaconParameters(PADAPTER padapter); -+void rtl8723b_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); -+void _InitBurstPktLen_8723BS(PADAPTER Adapter); -+void _8051Reset8723(PADAPTER padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif //CONFIG_WOWLAN -+ -+void rtl8723b_start_thread(_adapter *padapter); -+void rtl8723b_stop_thread(_adapter *padapter); -+ -+#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) -+void rtl8723bs_init_checkbthang_workqueue(_adapter * adapter); -+void rtl8723bs_free_checkbthang_workqueue(_adapter * adapter); -+void rtl8723bs_cancle_checkbthang_workqueue(_adapter * adapter); -+void rtl8723bs_hal_check_bt_hang(_adapter * adapter); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); -+#endif -+ -+int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); -+ -+void CCX_FwC2HTxRpt_8723b(PADAPTER padapter, u8 *pdata, u8 len); -+s32 c2h_id_filter_ccx_8723b(u8 *buf); -+s32 c2h_handler_8723b(PADAPTER padapter, u8 *pC2hEvent); -+u8 MRateToHwRate8723B(u8 rate); -+u8 HwRateToMRate8723B(u8 rate); -+ -+#ifdef CONFIG_RF_GAIN_OFFSET -+void Hal_ReadRFGainOffset(PADAPTER pAdapter,u8* hwinfo,BOOLEAN AutoLoadFail); -+#endif //CONFIG_RF_GAIN_OFFSET -+ -+#ifdef CONFIG_PCI_HCI -+BOOLEAN InterruptRecognized8723BE(PADAPTER Adapter); -+VOID UpdateInterruptMask8723BE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8723b_led.h linux/3rdparty/rtl8812au/include/rtl8723b_led.h ---- linux.old/3rdparty/rtl8812au/include/rtl8723b_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8723b_led.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_LED_H__ -+#define __RTL8723B_LED_H__ -+ -+#include -+#include -+#include -+ -+ -+//================================================================================ -+// Interface to manipulate LED objects. -+//================================================================================ -+#ifdef CONFIG_USB_HCI -+void rtl8723bu_InitSwLeds(PADAPTER padapter); -+void rtl8723bu_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_SDIO_HCI -+void rtl8723bs_InitSwLeds(PADAPTER padapter); -+void rtl8723bs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_GSPI_HCI -+void rtl8723bs_InitSwLeds(PADAPTER padapter); -+void rtl8723bs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+void rtl8723be_InitSwLeds(PADAPTER padapter); -+void rtl8723be_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8723b_recv.h linux/3rdparty/rtl8812au/include/rtl8723b_recv.h ---- linux.old/3rdparty/rtl8812au/include/rtl8723b_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8723b_recv.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,92 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_RECV_H__ -+#define __RTL8723B_RECV_H__ -+ -+#define RECV_BLK_SZ 512 -+#define RECV_BLK_CNT 16 -+#define RECV_BLK_TH RECV_BLK_CNT -+ -+#if defined(CONFIG_USB_HCI) -+ -+#ifndef MAX_RECVBUF_SZ -+#ifdef PLATFORM_OS_CE -+#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+#else -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ //#define MAX_RECVBUF_SZ (32768) // 32k -+ //#define MAX_RECVBUF_SZ (16384) //16K -+ //#define MAX_RECVBUF_SZ (10240) //10K -+ #ifdef CONFIG_PLATFORM_MSTAR -+ #define MAX_RECVBUF_SZ (8192) // 8K -+ #else -+ #define MAX_RECVBUF_SZ (15360) // 15k < 16k -+ #endif -+ //#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+ #else -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+ #endif -+#endif -+#endif //!MAX_RECVBUF_SZ -+ -+#elif defined(CONFIG_PCI_HCI) -+//#ifndef CONFIG_MINIMAL_MEMORY_USAGE -+// #define MAX_RECVBUF_SZ (9100) -+//#else -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+//#endif -+ -+ -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ -+#define MAX_RECVBUF_SZ (10240) -+ -+#endif -+ -+// Rx smooth factor -+#define Rx_Smooth_Factor (20) -+ -+#ifdef CONFIG_SDIO_HCI -+#ifndef CONFIG_SDIO_RX_COPY -+#undef MAX_RECVBUF_SZ -+#define MAX_RECVBUF_SZ (RX_DMA_SIZE_8723B - RX_DMA_RESERVED_SIZE_8723B) -+#endif // !CONFIG_SDIO_RX_COPY -+#endif // CONFIG_SDIO_HCI -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+s32 rtl8723bs_init_recv_priv(PADAPTER padapter); -+void rtl8723bs_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+int rtl8723bu_init_recv_priv(_adapter *padapter); -+void rtl8723bu_free_recv_priv (_adapter *padapter); -+void rtl8723bu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8723be_init_recv_priv(PADAPTER padapter); -+void rtl8723be_free_recv_priv(PADAPTER padapter); -+#endif -+ -+void rtl8723b_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8723B_RECV_H__ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8723b_rf.h linux/3rdparty/rtl8812au/include/rtl8723b_rf.h ---- linux.old/3rdparty/rtl8812au/include/rtl8723b_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8723b_rf.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_RF_H__ -+#define __RTL8723B_RF_H__ -+ -+int PHY_RF6052_Config8723B( IN PADAPTER Adapter ); -+ -+VOID -+PHY_RF6052SetBandwidth8723B( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8723b_spec.h linux/3rdparty/rtl8812au/include/rtl8723b_spec.h ---- linux.old/3rdparty/rtl8812au/include/rtl8723b_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8723b_spec.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,293 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8723B_SPEC_H__ -+#define __RTL8723B_SPEC_H__ -+ -+#include -+ -+ -+#define HAL_NAV_UPPER_UNIT_8723B 128 // micro-second -+ -+//----------------------------------------------------- -+// -+// 0x0000h ~ 0x00FFh System Configuration -+// -+//----------------------------------------------------- -+#define REG_RSV_CTRL_8723B 0x001C // 3 Byte -+#define REG_BT_WIFI_ANTENNA_SWITCH_8723B 0x0038 -+#define REG_HSISR_8723B 0x005c -+#define REG_PAD_CTRL1_8723B 0x0064 -+#define REG_AFE_CTRL_4_8723B 0x0078 -+#define REG_HMEBOX_DBG_0_8723B 0x0088 -+#define REG_HMEBOX_DBG_1_8723B 0x008A -+#define REG_HMEBOX_DBG_2_8723B 0x008C -+#define REG_HMEBOX_DBG_3_8723B 0x008E -+#define REG_HIMR0_8723B 0x00B0 -+#define REG_HISR0_8723B 0x00B4 -+#define REG_HIMR1_8723B 0x00B8 -+#define REG_HISR1_8723B 0x00BC -+#define REG_PMC_DBG_CTRL2_8723B 0x00CC -+ -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+#define REG_C2HEVT_CMD_ID_8723B 0x01A0 -+#define REG_C2HEVT_CMD_LEN_8723B 0x01AE -+#define REG_WOWLAN_WAKE_REASON 0x01C7 -+#define REG_WOWLAN_GTK_DBG1 0x630 -+#define REG_WOWLAN_GTK_DBG2 0x634 -+ -+#define REG_HMEBOX_EXT0_8723B 0x01F0 -+#define REG_HMEBOX_EXT1_8723B 0x01F4 -+#define REG_HMEBOX_EXT2_8723B 0x01F8 -+#define REG_HMEBOX_EXT3_8723B 0x01FC -+ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x02FFh RXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_RXDMA_CONTROL_8723B 0x0286 // Control the RX DMA. -+#define REG_RXDMA_MODE_CTRL_8723B 0x0290 -+ -+//----------------------------------------------------- -+// -+// 0x0300h ~ 0x03FFh PCIe -+// -+//----------------------------------------------------- -+#define REG_PCIE_CTRL_REG_8723B 0x0300 -+#define REG_INT_MIG_8723B 0x0304 // Interrupt Migration -+#define REG_BCNQ_DESA_8723B 0x0308 // TX Beacon Descriptor Address -+#define REG_HQ_DESA_8723B 0x0310 // TX High Queue Descriptor Address -+#define REG_MGQ_DESA_8723B 0x0318 // TX Manage Queue Descriptor Address -+#define REG_VOQ_DESA_8723B 0x0320 // TX VO Queue Descriptor Address -+#define REG_VIQ_DESA_8723B 0x0328 // TX VI Queue Descriptor Address -+#define REG_BEQ_DESA_8723B 0x0330 // TX BE Queue Descriptor Address -+#define REG_BKQ_DESA_8723B 0x0338 // TX BK Queue Descriptor Address -+#define REG_RX_DESA_8723B 0x0340 // RX Queue Descriptor Address -+#define REG_DBI_WDATA_8723B 0x0348 // DBI Write Data -+#define REG_DBI_RDATA_8723B 0x034C // DBI Read Data -+#define REG_DBI_ADDR_8723B 0x0350 // DBI Address -+#define REG_DBI_FLAG_8723B 0x0352 // DBI Read/Write Flag -+#define REG_MDIO_WDATA_8723B 0x0354 // MDIO for Write PCIE PHY -+#define REG_MDIO_RDATA_8723B 0x0356 // MDIO for Reads PCIE PHY -+#define REG_MDIO_CTL_8723B 0x0358 // MDIO for Control -+#define REG_DBG_SEL_8723B 0x0360 // Debug Selection Register -+#define REG_PCIE_HRPWM_8723B 0x0361 //PCIe RPWM -+#define REG_PCIE_HCPWM_8723B 0x0363 //PCIe CPWM -+#define REG_PCIE_MULTIFET_CTRL_8723B 0x036A //PCIE Multi-Fethc Control -+ -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+#define REG_TXPKTBUF_BCNQ_BDNY_8723B 0x0424 -+#define REG_TXPKTBUF_MGQ_BDNY_8723B 0x0425 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8723B 0x045D -+#ifdef CONFIG_WOWLAN -+#define REG_TXPKTBUF_IV_LOW 0x0484 -+#define REG_TXPKTBUF_IV_HIGH 0x0488 -+#endif -+#define REG_AMPDU_BURST_MODE_8723B 0x04BC -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+#define REG_SECONDARY_CCA_CTRL_8723B 0x0577 -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+ -+ -+//============================================================ -+// SDIO Bus Specification -+//============================================================ -+ -+//----------------------------------------------------- -+// SDIO CMD Address Mapping -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// I/O bus domain (Host) -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// SDIO register -+//----------------------------------------------------- -+#define SDIO_REG_HCPWM1_8723B 0x025 // HCI Current Power Mode 1 -+ -+ -+//============================================================================ -+// 8723 Regsiter Bit and Content definition -+//============================================================================ -+ -+//2 HSISR -+// interrupt mask which needs to clear -+#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ -+ HSISR_SPS_OCP_INT |\ -+ HSISR_RON_INT |\ -+ HSISR_PDNINT |\ -+ HSISR_GPIO9_INT) -+ -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+#undef IS_E_CUT -+#define IS_E_CUT(version) FALSE -+#undef IS_F_CUT -+#define IS_F_CUT(version) ((GET_CVID_CUT_VERSION(version) == E_CUT_VERSION) ? TRUE : FALSE) -+ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x02FFh RXDMA Configuration -+// -+//----------------------------------------------------- -+#define BIT_USB_RXDMA_AGG_EN BIT(31) -+#define RXDMA_AGG_MODE_EN BIT(1) -+ -+#ifdef CONFIG_WOWLAN -+#define RXPKT_RELEASE_POLL BIT(16) -+#define RXDMA_IDLE BIT(17) -+#define RW_RELEASE_EN BIT(18) -+#endif -+ -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+ -+//---------------------------------------------------------------------------- -+// 8723B REG_CCK_CHECK (offset 0x454) -+//---------------------------------------------------------------------------- -+#define BIT_BCN_PORT_SEL BIT5 -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+#ifdef CONFIG_RF_GAIN_OFFSET -+ -+#ifdef CONFIG_RTL8723B -+#define EEPROM_RF_GAIN_OFFSET 0xC1 -+#endif -+ -+#define EEPROM_RF_GAIN_VAL 0x1F6 -+#endif //CONFIG_RF_GAIN_OFFSET -+ -+ -+//---------------------------------------------------------------------------- -+// 8195 IMR/ISR bits (offset 0xB0, 8bits) -+//---------------------------------------------------------------------------- -+#define IMR_DISABLED_8723B 0 -+// IMR DW0(0x00B0-00B3) Bit 0-31 -+#define IMR_TIMER2_8723B BIT31 // Timeout interrupt 2 -+#define IMR_TIMER1_8723B BIT30 // Timeout interrupt 1 -+#define IMR_PSTIMEOUT_8723B BIT29 // Power Save Time Out Interrupt -+#define IMR_GTINT4_8723B BIT28 // When GTIMER4 expires, this bit is set to 1 -+#define IMR_GTINT3_8723B BIT27 // When GTIMER3 expires, this bit is set to 1 -+#define IMR_TXBCN0ERR_8723B BIT26 // Transmit Beacon0 Error -+#define IMR_TXBCN0OK_8723B BIT25 // Transmit Beacon0 OK -+#define IMR_TSF_BIT32_TOGGLE_8723B BIT24 // TSF Timer BIT32 toggle indication interrupt -+#define IMR_BCNDMAINT0_8723B BIT20 // Beacon DMA Interrupt 0 -+#define IMR_BCNDERR0_8723B BIT16 // Beacon Queue DMA OK0 -+#define IMR_HSISR_IND_ON_INT_8723B BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) -+#define IMR_BCNDMAINT_E_8723B BIT14 // Beacon DMA Interrupt Extension for Win7 -+#define IMR_ATIMEND_8723B BIT12 // CTWidnow End or ATIM Window End -+#define IMR_C2HCMD_8723B BIT10 // CPU to Host Command INT Status, Write 1 clear -+#define IMR_CPWM2_8723B BIT9 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_CPWM_8723B BIT8 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_HIGHDOK_8723B BIT7 // High Queue DMA OK -+#define IMR_MGNTDOK_8723B BIT6 // Management Queue DMA OK -+#define IMR_BKDOK_8723B BIT5 // AC_BK DMA OK -+#define IMR_BEDOK_8723B BIT4 // AC_BE DMA OK -+#define IMR_VIDOK_8723B BIT3 // AC_VI DMA OK -+#define IMR_VODOK_8723B BIT2 // AC_VO DMA OK -+#define IMR_RDU_8723B BIT1 // Rx Descriptor Unavailable -+#define IMR_ROK_8723B BIT0 // Receive DMA OK -+ -+// IMR DW1(0x00B4-00B7) Bit 0-31 -+#define IMR_BCNDMAINT7_8723B BIT27 // Beacon DMA Interrupt 7 -+#define IMR_BCNDMAINT6_8723B BIT26 // Beacon DMA Interrupt 6 -+#define IMR_BCNDMAINT5_8723B BIT25 // Beacon DMA Interrupt 5 -+#define IMR_BCNDMAINT4_8723B BIT24 // Beacon DMA Interrupt 4 -+#define IMR_BCNDMAINT3_8723B BIT23 // Beacon DMA Interrupt 3 -+#define IMR_BCNDMAINT2_8723B BIT22 // Beacon DMA Interrupt 2 -+#define IMR_BCNDMAINT1_8723B BIT21 // Beacon DMA Interrupt 1 -+#define IMR_BCNDOK7_8723B BIT20 // Beacon Queue DMA OK Interrup 7 -+#define IMR_BCNDOK6_8723B BIT19 // Beacon Queue DMA OK Interrup 6 -+#define IMR_BCNDOK5_8723B BIT18 // Beacon Queue DMA OK Interrup 5 -+#define IMR_BCNDOK4_8723B BIT17 // Beacon Queue DMA OK Interrup 4 -+#define IMR_BCNDOK3_8723B BIT16 // Beacon Queue DMA OK Interrup 3 -+#define IMR_BCNDOK2_8723B BIT15 // Beacon Queue DMA OK Interrup 2 -+#define IMR_BCNDOK1_8723B BIT14 // Beacon Queue DMA OK Interrup 1 -+#define IMR_ATIMEND_E_8723B BIT13 // ATIM Window End Extension for Win7 -+#define IMR_TXERR_8723B BIT11 // Tx Error Flag Interrupt Status, write 1 clear. -+#define IMR_RXERR_8723B BIT10 // Rx Error Flag INT Status, Write 1 clear -+#define IMR_TXFOVW_8723B BIT9 // Transmit FIFO Overflow -+#define IMR_RXFOVW_8723B BIT8 // Receive FIFO Overflow -+ -+#ifdef CONFIG_PCI_HCI -+//#define IMR_RX_MASK (IMR_ROK_8723B|IMR_RDU_8723B|IMR_RXFOVW_8723B) -+#define IMR_TX_MASK (IMR_VODOK_8723B|IMR_VIDOK_8723B|IMR_BEDOK_8723B|IMR_BKDOK_8723B|IMR_MGNTDOK_8723B|IMR_HIGHDOK_8723B) -+ -+#define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8723B | IMR_TXBCN0OK_8723B | IMR_TXBCN0ERR_8723B | IMR_BCNDERR0_8723B) -+ -+#define RT_AC_INT_MASKS (IMR_VIDOK_8723B | IMR_VODOK_8723B | IMR_BEDOK_8723B|IMR_BKDOK_8723B) -+#endif -+ -+//======================================================== -+// General definitions -+//======================================================== -+ -+#define MACID_NUM_8723B 128 -+#define SEC_CAM_ENT_NUM_8723B 64 -+#define NSS_NUM_8723B 1 -+ -+#endif /* __RTL8723B_SPEC_H__ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8723b_sreset.h linux/3rdparty/rtl8812au/include/rtl8723b_sreset.h ---- linux.old/3rdparty/rtl8812au/include/rtl8723b_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8723b_sreset.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8723B_SRESET_H_ -+#define _RTL8723B_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+extern void rtl8723b_sreset_xmit_status_check(_adapter *padapter); -+extern void rtl8723b_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8723b_xmit.h linux/3rdparty/rtl8812au/include/rtl8723b_xmit.h ---- linux.old/3rdparty/rtl8812au/include/rtl8723b_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8723b_xmit.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,336 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_XMIT_H__ -+#define __RTL8723B_XMIT_H__ -+ -+ -+#define MAX_TID (15) -+ -+ -+#ifndef __INC_HAL8723BDESC_H -+#define __INC_HAL8723BDESC_H -+ -+#define RX_STATUS_DESC_SIZE_8723B 24 -+#define RX_DRV_INFO_SIZE_UNIT_8723B 8 -+ -+ -+//DWORD 0 -+#define SET_RX_STATUS_DESC_PKT_LEN_8723B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_8723B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_8723B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 31, 1, __Value) -+ -+#define GET_RX_STATUS_DESC_PKT_LEN_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICV_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_LAST_SEG_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 28, 1) -+#define GET_RX_STATUS_DESC_FIRST_SEG_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 29, 1) -+#define GET_RX_STATUS_DESC_EOR_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_OWN_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 31, 1) -+ -+//DWORD 1 -+#define GET_RX_STATUS_DESC_MACID_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_TID_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_AMSDU_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_A1_FIT_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 16, 4) -+#define GET_RX_STATUS_DESC_CHKERR_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_IPVER_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_IS_TCPUDP__8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_CHK_VLD_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_MC_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 31, 1) -+ -+//DWORD 2 -+#define GET_RX_STATUS_DESC_SEQ_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 12, 4) -+#define GET_RX_STATUS_DESC_RX_IS_QOS_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 16, 1) -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_RPT_SEL_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 28, 1) -+ -+//DWORD 3 -+#define GET_RX_STATUS_DESC_RX_RATE_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_HTC_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 12, 2) -+#ifdef CONFIG_USB_RX_AGGREGATION -+#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 16, 8) -+#endif -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 31, 1) -+ -+//DWORD 6 -+#define GET_RX_STATUS_DESC_SPLCP_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 0, 1) -+#define GET_RX_STATUS_DESC_LDPC_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 1, 1) -+#define GET_RX_STATUS_DESC_STBC_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 2, 1) -+#define GET_RX_STATUS_DESC_BW_8723B(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 4, 2) -+ -+//DWORD 5 -+#define GET_RX_STATUS_DESC_TSFL_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+20, 0, 32) -+ -+#define GET_RX_STATUS_DESC_BUFF_ADDR_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+#define GET_RX_STATUS_DESC_BUFF_ADDR64_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+#define SET_RX_STATUS_DESC_BUFF_ADDR_8723B(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) -+ -+ -+// Dword 0 -+#define GET_TX_DESC_OWN_8723B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+#define SET_TX_DESC_PKT_SIZE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define SET_TX_DESC_OFFSET_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define SET_TX_DESC_BMC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_LAST_SEG_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+#define SET_TX_DESC_FIRST_SEG_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_LINIP_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+#define SET_TX_DESC_NO_ACM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+#define SET_TX_DESC_OWN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+// Dword 1 -+#define SET_TX_DESC_MACID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+ -+ -+// Dword 2 -+#define SET_TX_DESC_PAID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+#define SET_TX_DESC_CCA_RTS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_AGG_BREAK_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define SET_TX_DESC_RAW_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define SET_TX_DESC_SPE_RPT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_INT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_GID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+ -+ -+// Dword 3 -+#define SET_TX_DESC_WHEADER_LEN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) -+#define SET_TX_DESC_CHK_EN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) -+#define SET_TX_DESC_EARLY_MODE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HWSEQ_SEL_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_NAV_USE_HDR_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_NDPA_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+// Dword 4 -+#define SET_TX_DESC_TX_RATE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+ -+ -+// Dword 5 -+#define SET_TX_DESC_DATA_SC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_LDPC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+#define SET_TX_DESC_DATA_STBC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_CTROL_STBC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+ -+ -+// Dword 6 -+#define SET_TX_DESC_SW_DEFINE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_MBSSID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+#define SET_TX_DESC_ANTSEL_A_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+#define SET_TX_DESC_ANTSEL_B_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) -+#define SET_TX_DESC_ANTSEL_C_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) -+#define SET_TX_DESC_ANTSEL_D_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) -+ -+// Dword 7 -+#if(DEV_BUS_TYPE == RT_PCI_INTERFACE) -+#define SET_TX_DESC_TX_BUFFER_SIZE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#else -+#define SET_TX_DESC_TX_DESC_CHECKSUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+#define SET_TX_DESC_USB_TXAGG_NUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+#if(DEV_BUS_TYPE == RT_SDIO_INTERFACE) -+#define SET_TX_DESC_SDIO_TXSEQ_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) -+#endif -+ -+// Dword 8 -+#define SET_TX_DESC_HWSEQ_EN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+ -+// Dword 9 -+#define SET_TX_DESC_SEQ_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+ -+// Dword 10 -+#define SET_TX_DESC_TX_BUFFER_ADDRESS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) -+#define GET_TX_DESC_TX_BUFFER_ADDRESS_8723B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+40, 0, 32) -+ -+// Dword 11 -+#define SET_TX_DESC_NEXT_DESC_ADDRESS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) -+ -+ -+#define SET_EARLYMODE_PKTNUM_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+#endif -+//----------------------------------------------------------- -+// -+// Rate -+// -+//----------------------------------------------------------- -+// CCK Rates, TxHT = 0 -+#define DESC8723B_RATE1M 0x00 -+#define DESC8723B_RATE2M 0x01 -+#define DESC8723B_RATE5_5M 0x02 -+#define DESC8723B_RATE11M 0x03 -+ -+// OFDM Rates, TxHT = 0 -+#define DESC8723B_RATE6M 0x04 -+#define DESC8723B_RATE9M 0x05 -+#define DESC8723B_RATE12M 0x06 -+#define DESC8723B_RATE18M 0x07 -+#define DESC8723B_RATE24M 0x08 -+#define DESC8723B_RATE36M 0x09 -+#define DESC8723B_RATE48M 0x0a -+#define DESC8723B_RATE54M 0x0b -+ -+// MCS Rates, TxHT = 1 -+#define DESC8723B_RATEMCS0 0x0c -+#define DESC8723B_RATEMCS1 0x0d -+#define DESC8723B_RATEMCS2 0x0e -+#define DESC8723B_RATEMCS3 0x0f -+#define DESC8723B_RATEMCS4 0x10 -+#define DESC8723B_RATEMCS5 0x11 -+#define DESC8723B_RATEMCS6 0x12 -+#define DESC8723B_RATEMCS7 0x13 -+#define DESC8723B_RATEMCS8 0x14 -+#define DESC8723B_RATEMCS9 0x15 -+#define DESC8723B_RATEMCS10 0x16 -+#define DESC8723B_RATEMCS11 0x17 -+#define DESC8723B_RATEMCS12 0x18 -+#define DESC8723B_RATEMCS13 0x19 -+#define DESC8723B_RATEMCS14 0x1a -+#define DESC8723B_RATEMCS15 0x1b -+#define DESC8723B_RATEVHTSS1MCS0 0x2c -+#define DESC8723B_RATEVHTSS1MCS1 0x2d -+#define DESC8723B_RATEVHTSS1MCS2 0x2e -+#define DESC8723B_RATEVHTSS1MCS3 0x2f -+#define DESC8723B_RATEVHTSS1MCS4 0x30 -+#define DESC8723B_RATEVHTSS1MCS5 0x31 -+#define DESC8723B_RATEVHTSS1MCS6 0x32 -+#define DESC8723B_RATEVHTSS1MCS7 0x33 -+#define DESC8723B_RATEVHTSS1MCS8 0x34 -+#define DESC8723B_RATEVHTSS1MCS9 0x35 -+#define DESC8723B_RATEVHTSS2MCS0 0x36 -+#define DESC8723B_RATEVHTSS2MCS1 0x37 -+#define DESC8723B_RATEVHTSS2MCS2 0x38 -+#define DESC8723B_RATEVHTSS2MCS3 0x39 -+#define DESC8723B_RATEVHTSS2MCS4 0x3a -+#define DESC8723B_RATEVHTSS2MCS5 0x3b -+#define DESC8723B_RATEVHTSS2MCS6 0x3c -+#define DESC8723B_RATEVHTSS2MCS7 0x3d -+#define DESC8723B_RATEVHTSS2MCS8 0x3e -+#define DESC8723B_RATEVHTSS2MCS9 0x3f -+ -+ -+#define RX_HAL_IS_CCK_RATE_8723B(pDesc)\ -+ (GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE1M ||\ -+ GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE2M ||\ -+ GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE5_5M ||\ -+ GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE11M) -+ -+ -+void rtl8723b_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); -+void rtl8723b_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+s32 rtl8723bs_init_xmit_priv(PADAPTER padapter); -+void rtl8723bs_free_xmit_priv(PADAPTER padapter); -+s32 rtl8723bs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8723bs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8723bs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtl8723bs_xmit_buf_handler(PADAPTER padapter); -+thread_return rtl8723bs_xmit_thread(thread_context context); -+#define hal_xmit_handler rtl8723bs_xmit_buf_handler -+#endif -+ -+#ifdef CONFIG_USB_HCI -+s32 rtl8723bu_xmit_buf_handler(PADAPTER padapter); -+#define hal_xmit_handler rtl8723bu_xmit_buf_handler -+ -+ -+s32 rtl8723bu_init_xmit_priv(PADAPTER padapter); -+void rtl8723bu_free_xmit_priv(PADAPTER padapter); -+s32 rtl8723bu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8723bu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8723bu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+//s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); -+void rtl8723bu_xmit_tasklet(void *priv); -+s32 rtl8723bu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+void _dbg_dump_tx_info(_adapter *padapter,int frame_tag,struct tx_desc *ptxdesc); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8723be_init_xmit_priv(PADAPTER padapter); -+void rtl8723be_free_xmit_priv(PADAPTER padapter); -+struct xmit_buf *rtl8723be_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+void rtl8723be_xmitframe_resume(_adapter *padapter); -+s32 rtl8723be_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8723be_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8723be_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+void rtl8723be_xmit_tasklet(void *priv); -+#endif -+ -+u8 BWMapping_8723B(PADAPTER Adapter, struct pkt_attrib *pattrib); -+u8 SCMapping_8723B(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_cmd.h linux/3rdparty/rtl8812au/include/rtl8812a_cmd.h ---- linux.old/3rdparty/rtl8812au/include/rtl8812a_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8812a_cmd.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,211 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __RTL8812A_CMD_H__ +#define __RTL8812A_CMD_H__ + -+typedef enum _RTL8812_H2C_CMD ++typedef enum _RTL8812_H2C_CMD +{ + H2C_8812_RSVDPAGE = 0, + H2C_8812_MSRRPT = 1, @@ -320510,29 +141258,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_cmd.h linux/3rdparty/rt + H2C_8812_KEEP_ALIVE_CTRL = 3, + H2C_8812_DISCONNECT_DECISION = 4, + -+ H2C_8812_INIT_OFFLOAD = 6, ++ H2C_8812_INIT_OFFLOAD = 6, + H2C_8812_AP_OFFLOAD = 8, + H2C_8812_BCN_RSVDPAGE = 9, + H2C_8812_PROBERSP_RSVDPAGE = 10, -+ -+ H2C_8812_SETPWRMODE = 0x20, ++ ++ H2C_8812_SETPWRMODE = 0x20, + H2C_8812_PS_TUNING_PARA = 0x21, + H2C_8812_PS_TUNING_PARA2 = 0x22, + H2C_8812_PS_LPS_PARA = 0x23, + H2C_8812_P2P_PS_OFFLOAD = 0x24, + H2C_8812_RA_MASK = 0x40, -+ H2C_8812_TxBF = 0x41, + H2C_8812_RSSI_REPORT = 0x42, -+ H2C_8812_IQ_CALIBRATION = 0x45, -+ H2C_8812_RA_PARA_ADJUST = 0x46, -+ -+ H2C_8812_BT_FW_PATCH = 0x6a, + + H2C_8812_WO_WLAN = 0x80, + H2C_8812_REMOTE_WAKE_CTRL = 0x81, + H2C_8812_AOAC_GLOBAL_INFO = 0x82, + H2C_8812_AOAC_RSVDPAGE = 0x83, -+ H2C_8812_FW_SWCHANNL = 0x87, + + H2C_8812_TSF_RESET = 0xC0, + @@ -320549,22 +141291,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_cmd.h linux/3rdparty/rt + C2H_8812_BT_INFO = 9, + C2H_8812_BT_MP = 11, + C2H_8812_RA_RPT=12, -+ C2H_8812_RA_PARA_RPT = 14, + + C2H_8812_FW_SWCHNL = 0x10, + C2H_8812_IQK_FINISH = 0x11, -+ C2H_8812_MAILBOX_STATUS = 0x15, -+#ifdef CONFIG_FW_C2H_DEBUG -+ C2H_8812_EXTEND = 0xff, -+#endif //CONFIG_FW_C2H_DEBUG + MAX_8812_C2HEVENT +}RTL8812_C2H_EVT; + -+typedef enum _RTL8812_EXTEND_C2H_EVT { -+ EXTEND_C2H_8812_DBG_PRINT = 0 -+ -+} RTL8812_EXTEND_C2H_EVT; -+ + +struct cmd_msg_parm { + u8 eid; //element id @@ -320584,55 +141316,48 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_cmd.h linux/3rdparty/rt + + +//_RSVDPAGE_LOC_CMD0 -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) ++#define SET_8812_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8812_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) ++#define SET_8812_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8812_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8812_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) + +//_MEDIA_STATUS_RPT_PARM_CMD1 -+#define SET_8812_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8812_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8812_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8812_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd+2, 0, 8, __Value) ++#define SET_8812_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8812_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8812_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) ++#define SET_8812_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) + +//_SETPWRMODE_PARM -+#define SET_8812_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT(__pH2CCmd, 0, 8, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE_8BIT((__pH2CCmd)+5, 0, 8, __Value) ++#define SET_8812_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) ++#define SET_8812_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) ++#define SET_8812_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) ++#define SET_8812_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++#define SET_8812_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++#define SET_8812_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) + -+#define GET_8812_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) ++#define GET_8812_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) + +//_P2P_PS_OFFLOAD -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) ++#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) ++#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) +#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_CTWINDOW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) ++#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) ++#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) ++#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) ++#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) + + -+void Set_RA_LDPC_8812(struct sta_info *psta, BOOLEAN bLDPC); ++void Set_RA_LDPC_8812(struct sta_info *psta, bool bLDPC); + +// host message to firmware cmd -+s32 FillH2CCmd_8812(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); +void rtl8812_set_FwPwrMode_cmd(PADAPTER padapter, u8 PSMode); +void rtl8812_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); +u8 rtl8812_set_rssi_cmd(PADAPTER padapter, u8 *param); +void rtl8812_set_raid_cmd(PADAPTER padapter, u32 bitmap, u8* arg); -+void rtl8812_Add_RateATid(PADAPTER padapter, u64 rate_bitmap, u8 *arg, u8 rssi_level); -+void rtl8812_set_wowlan_cmd(_adapter* padapter, u8 enable); -+s32 FillH2CCmd_8812(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8812(_adapter *padapter, bool wowlan); ++void rtl8812_Add_RateATid(PADAPTER padapter, u32 bitmap, u8* arg, u8 rssi_level); ++ + -+#ifdef CONFIG_BT_COEXIST -+void rtl8812a_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif // CONFIG_BT_COEXIST +#ifdef CONFIG_P2P_PS +void rtl8812_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); +#endif //CONFIG_P2P @@ -320645,56 +141370,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_cmd.h linux/3rdparty/rt +#endif // CONFIG_TSF_RESET_OFFLOAD + +#ifdef CONFIG_WOWLAN ++typedef struct _SETWOWLAN_PARM{ ++ u8 mode; ++ u8 gpio_index; ++ u8 gpio_duration; ++ u8 second_mode; ++ u8 reserve; ++}SETWOWLAN_PARM, *PSETWOWLAN_PARM; ++ ++#define FW_WOWLAN_FUN_EN BIT(0) ++#define FW_WOWLAN_PATTERN_MATCH BIT(1) ++#define FW_WOWLAN_MAGIC_PKT BIT(2) ++#define FW_WOWLAN_UNICAST BIT(3) ++#define FW_WOWLAN_ALL_PKT_DROP BIT(4) ++#define FW_WOWLAN_GPIO_ACTIVE BIT(5) ++#define FW_WOWLAN_REKEY_WAKEUP BIT(6) ++#define FW_WOWLAN_DEAUTH_WAKEUP BIT(7) ++ ++#define FW_WOWLAN_GPIO_WAKEUP_EN BIT(0) ++#define FW_FW_PARSE_MAGIC_PKT BIT(1) ++ ++#define FW_REMOTE_WAKE_CTRL_EN BIT(0) ++#define FW_REALWOWLAN_EN BIT(5) ++void rtl8812a_set_wowlan_cmd(_adapter* padapter, u8 enable); +void SetFwRelatedForWoWLAN8812(_adapter* padapter, u8 bHostIsGoingtoSleep); +#endif//CONFIG_WOWLAN -+ -+//------------------------------------ -+// C2H format -+//------------------------------------ -+ -+// TX Beamforming -+#define GET_8812_C2H_TXBF_ORIGINATE(_Header) LE_BITS_TO_1BYTE(_Header, 0, 8) -+#define GET_8812_C2H_TXBF_MACID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) -+ -+ -+ -+/// TX Feedback Content -+#define USEC_UNIT_FOR_8812_C2H_TX_RPT_QUEUE_TIME 256 -+ -+#define GET_8812_C2H_TX_RPT_QUEUE_SELECT(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 5) -+#define GET_8812_C2H_TX_RPT_PKT_BROCAST(_Header) LE_BITS_TO_1BYTE((_Header + 0), 5, 1) -+#define GET_8812_C2H_TX_RPT_LIFE_TIME_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 6, 1) -+#define GET_8812_C2H_TX_RPT_RETRY_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 7, 1) -+#define GET_8812_C2H_TX_RPT_MAC_ID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) -+#define GET_8812_C2H_TX_RPT_DATA_RETRY_CNT(_Header) LE_BITS_TO_1BYTE((_Header + 2), 0, 6) -+#define GET_8812_C2H_TX_RPT_QUEUE_TIME(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) // In unit of 256 microseconds. -+#define GET_8812_C2H_TX_RPT_FINAL_DATA_RATE(_Header) LE_BITS_TO_1BYTE((_Header + 5), 0, 8) -+ -+// BT_FW_PATCH -+#define SET_8812_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) -+#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+5, 0, 8, __Value) -+ -+int rtl8812_iqk_wait(_adapter* padapter, u32 timeout_ms); -+void rtl8812_iqk_done(_adapter* padapter); -+ -+s32 -+_C2HContentParsing8812( -+ IN PADAPTER Adapter, -+ IN u8 c2hCmdId, -+ IN u8 c2hCmdLen, -+ IN u8 *tmpBuf -+); -+void C2HPacketHandler_8812(PADAPTER Adapter, u8 *Buffer, u8 Length); -+ -+#endif//__RTL8812A_CMD_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_dm.h linux/3rdparty/rtl8812au/include/rtl8812a_dm.h ---- linux.old/3rdparty/rtl8812au/include/rtl8812a_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8812a_dm.h 2017-06-07 23:07:21.040690218 +0300 -@@ -0,0 +1,37 @@ ++#endif//__RTL8188E_CMD_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_dm.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_dm.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_dm.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_dm.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,31 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -320708,615 +141413,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_dm.h linux/3rdparty/rtl + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __RTL8812A_DM_H__ +#define __RTL8812A_DM_H__ + -+void rtl8812_init_dm_priv(IN PADAPTER Adapter); -+void rtl8812_deinit_dm_priv(IN PADAPTER Adapter); -+void rtl8812_InitHalDm(IN PADAPTER Adapter); -+void rtl8812_HalDmWatchDog(IN PADAPTER Adapter); ++void rtl8812_init_dm_priv(PADAPTER Adapter); ++void rtl8812_deinit_dm_priv(PADAPTER Adapter); ++void rtl8812_InitHalDm(PADAPTER Adapter); ++void rtl8812_HalDmWatchDog(PADAPTER Adapter); + -+//VOID rtl8192c_dm_CheckTXPowerTracking(IN PADAPTER Adapter); ++//void rtl8192c_dm_CheckTXPowerTracking(PADAPTER Adapter); + -+//void rtl8192c_dm_RF_Saving(IN PADAPTER pAdapter, IN u8 bForceInNormal); ++//void rtl8192c_dm_RF_Saving(PADAPTER pAdapter, u8 bForceInNormal); + +#ifdef CONFIG_ANTENNA_DIVERSITY +void AntDivCompare8812(PADAPTER Adapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src); +u8 AntDivBeforeLink8812(PADAPTER Adapter ); +#endif +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_hal.h linux/3rdparty/rtl8812au/include/rtl8812a_hal.h ---- linux.old/3rdparty/rtl8812au/include/rtl8812a_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8812a_hal.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,366 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_HAL_H__ -+#define __RTL8812A_HAL_H__ -+ -+//#include "hal_com.h" -+#include "hal_data.h" -+ -+//include HAL Related header after HAL Related compiling flags -+#include "rtl8812a_spec.h" -+#include "rtl8812a_rf.h" -+#include "rtl8812a_dm.h" -+#include "rtl8812a_recv.h" -+#include "rtl8812a_xmit.h" -+#include "rtl8812a_cmd.h" -+#include "rtl8812a_led.h" -+#include "Hal8812PwrSeq.h" -+#include "Hal8821APwrSeq.h" //for 8821A/8811A -+#include "Hal8812PhyReg.h" -+#include "Hal8812PhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+#include "rtl8812a_sreset.h" -+#endif -+ -+ -+//--------------------------------------------------------------------- -+// RTL8812AU From header -+//--------------------------------------------------------------------- -+ #define RTL8812_FW_IMG "rtl8812a/FW_NIC.bin" -+ #define RTL8812_FW_WW_IMG "rtl8812a/FW_WoWLAN.bin" -+ #define RTL8812_PHY_REG "rtl8812a/PHY_REG.txt" -+ #define RTL8812_PHY_RADIO_A "rtl8812a/RadioA.txt" -+ #define RTL8812_PHY_RADIO_B "rtl8812a/RadioB.txt" -+ #define RTL8812_TXPWR_TRACK "rtl8812a/TxPowerTrack.txt" -+ #define RTL8812_AGC_TAB "rtl8812a/AGC_TAB.txt" -+ #define RTL8812_PHY_MACREG "rtl8812a/MAC_REG.txt" -+ #define RTL8812_PHY_REG_PG "rtl8812a/PHY_REG_PG.txt" -+ #define RTL8812_PHY_REG_MP "rtl8812a/PHY_REG_MP.txt" -+ #define RTL8812_TXPWR_LMT "rtl8812a/TXPWR_LMT.txt" -+ #define RTL8812_WIFI_ANT_ISOLATION "rtl8812a/wifi_ant_isolation.txt" -+ -+//--------------------------------------------------------------------- -+// RTL8821U From file -+//--------------------------------------------------------------------- -+ #define RTL8821_FW_IMG "rtl8821a/FW_NIC.bin" -+ #define RTL8821_FW_WW_IMG "rtl8821a/FW_WoWLAN.bin" -+ #define RTL8821_PHY_REG "rtl8821a/PHY_REG.txt" -+ #define RTL8821_PHY_RADIO_A "rtl8821a/RadioA.txt" -+ #define RTL8821_PHY_RADIO_B "rtl8821a/RadioB.txt" -+ #define RTL8821_TXPWR_TRACK "rtl8821a/TxPowerTrack.txt" -+ #define RTL8821_AGC_TAB "rtl8821a/AGC_TAB.txt" -+ #define RTL8821_PHY_MACREG "rtl8821a/MAC_REG.txt" -+ #define RTL8821_PHY_REG_PG "rtl8821a/PHY_REG_PG.txt" -+ #define RTL8821_PHY_REG_MP "rtl8821a/PHY_REG_MP.txt" -+ #define RTL8821_TXPWR_LMT "rtl8821a/TXPWR_LMT.txt" -+ -+//--------------------------------------------------------------------- -+// RTL8812 Power Configuration CMDs for PCIe interface -+//--------------------------------------------------------------------- -+#define Rtl8812_NIC_PWR_ON_FLOW rtl8812_power_on_flow -+#define Rtl8812_NIC_RF_OFF_FLOW rtl8812_radio_off_flow -+#define Rtl8812_NIC_DISABLE_FLOW rtl8812_card_disable_flow -+#define Rtl8812_NIC_ENABLE_FLOW rtl8812_card_enable_flow -+#define Rtl8812_NIC_SUSPEND_FLOW rtl8812_suspend_flow -+#define Rtl8812_NIC_RESUME_FLOW rtl8812_resume_flow -+#define Rtl8812_NIC_PDN_FLOW rtl8812_hwpdn_flow -+#define Rtl8812_NIC_LPS_ENTER_FLOW rtl8812_enter_lps_flow -+#define Rtl8812_NIC_LPS_LEAVE_FLOW rtl8812_leave_lps_flow -+ -+//--------------------------------------------------------------------- -+// RTL8821 Power Configuration CMDs for PCIe interface -+//--------------------------------------------------------------------- -+#define Rtl8821A_NIC_PWR_ON_FLOW rtl8821A_power_on_flow -+#define Rtl8821A_NIC_RF_OFF_FLOW rtl8821A_radio_off_flow -+#define Rtl8821A_NIC_DISABLE_FLOW rtl8821A_card_disable_flow -+#define Rtl8821A_NIC_ENABLE_FLOW rtl8821A_card_enable_flow -+#define Rtl8821A_NIC_SUSPEND_FLOW rtl8821A_suspend_flow -+#define Rtl8821A_NIC_RESUME_FLOW rtl8821A_resume_flow -+#define Rtl8821A_NIC_PDN_FLOW rtl8821A_hwpdn_flow -+#define Rtl8821A_NIC_LPS_ENTER_FLOW rtl8821A_enter_lps_flow -+#define Rtl8821A_NIC_LPS_LEAVE_FLOW rtl8821A_leave_lps_flow -+ -+ -+#if 1 // download firmware related data structure -+#define FW_SIZE_8812 0x8000 // Compatible with RTL8723 Maximal RAM code size 24K. modified to 32k, TO compatible with 92d maximal fw size 32k -+#define FW_START_ADDRESS 0x1000 -+#define FW_END_ADDRESS 0x5FFF -+ -+ -+ -+typedef struct _RT_FIRMWARE_8812 { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8* szFwBuffer; -+#else -+ u8 szFwBuffer[FW_SIZE_8812]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8812, *PRT_FIRMWARE_8812; -+ -+// -+// This structure must be cared byte-ordering -+// -+// Added by tynli. 2009.12.04. -+#define IS_FW_HEADER_EXIST_8812(_pFwHdr) ((GET_FIRMWARE_HDR_SIGNATURE_8812(_pFwHdr) &0xFFF0) == 0x9500) -+ -+#define IS_FW_HEADER_EXIST_8821(_pFwHdr) ((GET_FIRMWARE_HDR_SIGNATURE_8812(_pFwHdr) &0xFFF0) == 0x2100) -+//===================================================== -+// Firmware Header(8-byte alinment required) -+//===================================================== -+//--- LONG WORD 0 ---- -+#define GET_FIRMWARE_HDR_SIGNATURE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 0, 16) // 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut -+#define GET_FIRMWARE_HDR_CATEGORY_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 16, 8) // AP/NIC and USB/PCI -+#define GET_FIRMWARE_HDR_FUNCTION_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 24, 8) // Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions -+#define GET_FIRMWARE_HDR_VERSION_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 0, 16)// FW Version -+#define GET_FIRMWARE_HDR_SUB_VER_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 16, 8) // FW Subversion, default 0x00 -+#define GET_FIRMWARE_HDR_RSVD1_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 24, 8) -+ -+//--- LONG WORD 1 ---- -+#define GET_FIRMWARE_HDR_MONTH_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 0, 8) // Release time Month field -+#define GET_FIRMWARE_HDR_DATE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 8, 8) // Release time Date field -+#define GET_FIRMWARE_HDR_HOUR_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 16, 8)// Release time Hour field -+#define GET_FIRMWARE_HDR_MINUTE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 24, 8)// Release time Minute field -+#define GET_FIRMWARE_HDR_ROMCODE_SIZE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 0, 16)// The size of RAM code -+#define GET_FIRMWARE_HDR_RSVD2_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 16, 16) -+ -+//--- LONG WORD 2 ---- -+#define GET_FIRMWARE_HDR_SVN_IDX_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 0, 32)// The SVN entry index -+#define GET_FIRMWARE_HDR_RSVD3_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 0, 32) -+ -+//--- LONG WORD 3 ---- -+#define GET_FIRMWARE_HDR_RSVD4_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 0, 32) -+#define GET_FIRMWARE_HDR_RSVD5_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+28, 0, 32) -+ -+#endif // download firmware related data structure -+ -+ -+#define DRIVER_EARLY_INT_TIME_8812 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8812 0x02 -+ -+//for 8812 -+// TX 128K, RX 16K, Page size 512B for TX, 128B for RX -+#define MAX_RX_DMA_BUFFER_SIZE_8812 0x3E80 /* RX 16K */ -+ -+#ifdef CONFIG_WOWLAN -+#define RESV_FMWF WKFMCAM_SIZE*MAX_WKFM_NUM /* 16 entries, for each is 24 bytes*/ -+#else -+#define RESV_FMWF 0 -+#endif -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+#define RX_DMA_RESERVED_SIZE_8812 0x100 // 256B, reserved for c2h debug message -+#else -+#define RX_DMA_RESERVED_SIZE_8812 0x0 // 0B -+#endif -+#define RX_DMA_BOUNDARY_8812 (MAX_RX_DMA_BUFFER_SIZE_8812 - RX_DMA_RESERVED_SIZE_8812 - 1) -+ -+#define BCNQ_PAGE_NUM_8812 0x07 -+ -+//For WoWLan , more reserved page -+//ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:1,GTK EXT MEM:1, PNO: 6 -+#ifdef CONFIG_WOWLAN -+#define WOWLAN_PAGE_NUM_8812 0x05 -+#else -+#define WOWLAN_PAGE_NUM_8812 0x00 -+#endif -+ -+ -+#ifdef CONFIG_BEAMFORMER_FW_NDPA -+#define FW_NDPA_PAGE_NUM 0x02 -+#else -+#define FW_NDPA_PAGE_NUM 0x00 -+#endif -+ -+#define TX_TOTAL_PAGE_NUMBER_8812 (0xFF - BCNQ_PAGE_NUM_8812 - WOWLAN_PAGE_NUM_8812-FW_NDPA_PAGE_NUM) -+#define TX_PAGE_BOUNDARY_8812 (TX_TOTAL_PAGE_NUMBER_8812 + 1) -+ -+#define TX_PAGE_BOUNDARY_WOWLAN_8812 (0xFF - BCNQ_PAGE_NUM_8812 - WOWLAN_PAGE_NUM_8812 + 1) -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8812 TX_TOTAL_PAGE_NUMBER_8812 -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8812 (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8812 + 1) -+ -+// For Normal Chip Setting -+// (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8812 -+#define NORMAL_PAGE_NUM_LPQ_8812 0x10 -+#define NORMAL_PAGE_NUM_HPQ_8812 0x10 -+#define NORMAL_PAGE_NUM_NPQ_8812 0x00 -+ -+#define WMM_NORMAL_PAGE_NUM_HPQ_8812 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8812 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8812 0x20 -+ -+ -+// for 8821A -+// TX 64K, RX 16K, Page size 256B for TX, 128B for RX -+#define PAGE_SIZE_TX_8821A 256 -+#define PAGE_SIZE_RX_8821A 128 -+ -+#define MAX_RX_DMA_BUFFER_SIZE_8821 0x3E80 /* RX 16K */ -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+#define RX_DMA_RESERVED_SIZE_8821 0x100 // 256B, reserved for c2h debug message -+#else -+#define RX_DMA_RESERVED_SIZE_8821 0x0 // 0B -+#endif -+#define RX_DMA_BOUNDARY_8821 (MAX_RX_DMA_BUFFER_SIZE_8821 - RX_DMA_RESERVED_SIZE_8821 - 1) -+ -+#define BCNQ_PAGE_NUM_8821 0x08 -+#ifdef CONFIG_CONCURRENT_MODE -+#define BCNQ1_PAGE_NUM_8821 0x04 -+#else -+#define BCNQ1_PAGE_NUM_8821 0x00 -+#endif -+ -+//For WoWLan , more reserved page -+//ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:1,GTK EXT MEM:1, PNO: 6 -+#ifdef CONFIG_WOWLAN -+#define WOWLAN_PAGE_NUM_8821 0x06 -+#else -+#define WOWLAN_PAGE_NUM_8821 0x00 -+#endif -+ -+#define TX_TOTAL_PAGE_NUMBER_8821 (0xFF - BCNQ_PAGE_NUM_8821 - BCNQ1_PAGE_NUM_8821 - WOWLAN_PAGE_NUM_8821) -+#define TX_PAGE_BOUNDARY_8821 (TX_TOTAL_PAGE_NUMBER_8821 + 1) -+//#define TX_PAGE_BOUNDARY_WOWLAN_8821 0xE0 -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8821 TX_TOTAL_PAGE_NUMBER_8821 -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8821 (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8821 + 1) -+ -+ -+// (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER -+#define NORMAL_PAGE_NUM_LPQ_8821 0x08//0x10 -+#define NORMAL_PAGE_NUM_HPQ_8821 0x08//0x10 -+#define NORMAL_PAGE_NUM_NPQ_8821 0x00 -+ -+#define WMM_NORMAL_PAGE_NUM_HPQ_8821 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8821 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8821 0x20 -+ -+ -+#define EFUSE_HIDDEN_812AU 0 -+#define EFUSE_HIDDEN_812AU_VS 1 -+#define EFUSE_HIDDEN_812AU_VL 2 -+#define EFUSE_HIDDEN_812AU_VN 3 -+ -+#if 0 -+#define EFUSE_REAL_CONTENT_LEN_JAGUAR 1024 -+#define HWSET_MAX_SIZE_JAGUAR 1024 -+#else -+#define EFUSE_REAL_CONTENT_LEN_JAGUAR 512 -+#define HWSET_MAX_SIZE_JAGUAR 512 -+#endif -+ -+#define EFUSE_MAX_BANK_8812A 2 -+#define EFUSE_MAP_LEN_JAGUAR 512 -+#define EFUSE_MAX_SECTION_JAGUAR 64 -+#define EFUSE_MAX_WORD_UNIT_JAGUAR 4 -+#define EFUSE_IC_ID_OFFSET_JAGUAR 506 //For some inferiority IC purpose. added by Roger, 2009.09.02. -+#define AVAILABLE_EFUSE_ADDR_8812(addr) (addr < EFUSE_REAL_CONTENT_LEN_JAGUAR) -+// To prevent out of boundary programming case, leave 1byte and program full section -+// 9bytes + 1byt + 5bytes and pre 1byte. -+// For worst case: -+// | 2byte|----8bytes----|1byte|--7bytes--| //92D -+#define EFUSE_OOB_PROTECT_BYTES_JAGUAR 18 // PG data exclude header, dummy 7 bytes frome CP test and reserved 1byte. -+#define EFUSE_PROTECT_BYTES_BANK_JAGUAR 16 -+// Added for different registry settings to adjust TxPwr index. added by Roger, 2010.03.09. -+typedef enum _TX_PWR_PERCENTAGE{ -+ TX_PWR_PERCENTAGE_0 = 0x01, // 12.5% -+ TX_PWR_PERCENTAGE_1 = 0x02, // 25% -+ TX_PWR_PERCENTAGE_2 = 0x04, // 50% -+ TX_PWR_PERCENTAGE_3 = 0x08, //100%, default target output power. -+} TX_PWR_PERCENTAGE; -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+//#define IS_MULTI_FUNC_CHIP(_Adapter) (((((PHAL_DATA_TYPE)(_Adapter->HalData))->MultiFunc) & (RT_MULTI_FUNC_BT|RT_MULTI_FUNC_GPS)) ? _TRUE : _FALSE) -+ -+//#define RT_IS_FUNC_DISABLED(__pAdapter, __FuncBits) ( (__pAdapter)->DisabledFunctions & (__FuncBits) ) -+ -+// rtl8812_hal_init.c -+void _8051Reset8812(PADAPTER padapter); -+s32 FirmwareDownload8812(PADAPTER Adapter, BOOLEAN bUsedWoWLANFw); -+void InitializeFirmwareVars8812(PADAPTER padapter); -+ -+s32 _LLTWrite_8812A(PADAPTER Adapter, u32 address, u32 data); -+s32 InitLLTTable8812A(PADAPTER padapter, u8 txpktbuf_bndy); -+void InitRDGSetting8812A(PADAPTER padapter); -+ -+void CheckAutoloadState8812A(PADAPTER padapter); -+ -+// EFuse -+u8 GetEEPROMSize8812A(PADAPTER padapter); -+void InitPGData8812A(PADAPTER padapter); -+void Hal_EfuseParseIDCode8812A(PADAPTER padapter, u8 *hwinfo); -+void Hal_ReadPROMVersion8812A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadTxPowerInfo8812A(PADAPTER padapter, u8* hwinfo,BOOLEAN AutoLoadFail); -+void Hal_ReadBoardType8812A(PADAPTER pAdapter, u8* hwinfo,BOOLEAN AutoLoadFail); -+void Hal_ReadThermalMeter_8812A(PADAPTER Adapter, u8* PROMContent,BOOLEAN AutoloadFail); -+void Hal_ReadChannelPlan8812A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseXtal_8812A(PADAPTER pAdapter, u8* hwinfo,BOOLEAN AutoLoadFail); -+void Hal_ReadAntennaDiversity8812A(PADAPTER pAdapter,u8* PROMContent,BOOLEAN AutoLoadFail); -+void Hal_ReadAntennaDiversity8821A(PADAPTER pAdapter, u8* PROMContent, BOOLEAN AutoLoadFail); -+void Hal_ReadAmplifierType_8812A(PADAPTER Adapter,u8* PROMContent, BOOLEAN AutoloadFail); -+void Hal_ReadPAType_8821A(PADAPTER Adapter,u8* PROMContent, BOOLEAN AutoloadFail); -+void Hal_ReadRFEType_8812A(PADAPTER Adapter,u8* PROMContent, BOOLEAN AutoloadFail); -+void Hal_EfuseParseBTCoexistInfo8812A(PADAPTER Adapter, u8* hwinfo, BOOLEAN AutoLoadFail); -+void hal_ReadUsbType_8812AU(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+int FirmwareDownloadBT(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); -+void Hal_ReadRemoteWakeup_8812A(PADAPTER padapter, u8* hwinfo, BOOLEAN AutoLoadFail); -+ -+BOOLEAN HalDetectPwrDownMode8812(PADAPTER Adapter); -+void Hal_EfuseParseKFreeData_8821A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+ -+#ifdef CONFIG_WOWLAN -+void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif //CONFIG_WOWLAN -+ -+void _InitBeaconParameters_8812A(PADAPTER padapter); -+void SetBeaconRelatedRegisters8812A(PADAPTER padapter); -+ -+void ReadRFType8812A(PADAPTER padapter); -+void InitDefaultValue8821A(PADAPTER padapter); -+ -+void SetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval); -+void GetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval); -+u8 SetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+s32 c2h_id_filter_ccx_8812a(u8 *buf); -+void rtl8812_set_hal_ops(struct hal_ops *pHalFunc); -+ -+// register -+void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); -+ -+void rtl8812_start_thread(PADAPTER padapter); -+void rtl8812_stop_thread(PADAPTER padapter); -+ -+#ifdef CONFIG_PCI_HCI -+BOOLEAN InterruptRecognized8812AE(PADAPTER Adapter); -+VOID UpdateInterruptMask8812AE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+void rtl8812a_combo_card_WifiOnlyHwInit(PADAPTER Adapter); -+#endif -+ -+ -+#endif //__RTL8188E_HAL_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_led.h linux/3rdparty/rtl8812au/include/rtl8812a_led.h ---- linux.old/3rdparty/rtl8812au/include/rtl8812a_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8812a_led.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_LED_H__ -+#define __RTL8812A_LED_H__ -+ -+ -+//================================================================================ -+// Interface to manipulate LED objects. -+//================================================================================ -+#ifdef CONFIG_USB_HCI -+void rtl8812au_InitSwLeds(PADAPTER padapter); -+void rtl8812au_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+void rtl8812ae_InitSwLeds(PADAPTER padapter); -+void rtl8812ae_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_SDIO_HCI -+void rtl8821as_InitSwLeds(PADAPTER padapter); -+void rtl8821as_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_recv.h linux/3rdparty/rtl8812au/include/rtl8812a_recv.h ---- linux.old/3rdparty/rtl8812au/include/rtl8812a_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8812a_recv.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,162 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_RECV_H__ -+#define __RTL8812A_RECV_H__ -+ -+#if defined(CONFIG_USB_HCI) -+ -+#ifndef MAX_RECVBUF_SZ -+#ifdef PLATFORM_OS_CE -+#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+#else -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ #define MAX_RECVBUF_SZ (rtw_rtkm_get_buff_size()) /*depend rtkm*/ -+ #else -+ #define MAX_RECVBUF_SZ (32768) /*32k*/ -+ #endif -+ //#define MAX_RECVBUF_SZ (24576) // 24k -+ //#define MAX_RECVBUF_SZ (20480) //20K -+ //#define MAX_RECVBUF_SZ (10240) //10K -+ //#define MAX_RECVBUF_SZ (15360) // 15k < 16k -+ //#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+ #ifdef CONFIG_PLATFORM_NOVATEK_NT72668 -+ #undef MAX_RECVBUF_SZ -+ #define MAX_RECVBUF_SZ (15360) // 15k < 16k -+ #endif //CONFIG_PLATFORM_NOVATEK_NT72668 -+ #else -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+ #endif -+#endif -+#endif //!MAX_RECVBUF_SZ -+ -+#elif defined(CONFIG_PCI_HCI) -+//#ifndef CONFIG_MINIMAL_MEMORY_USAGE -+// #define MAX_RECVBUF_SZ (9100) -+//#else -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+//#endif -+ -+ -+#elif defined(CONFIG_SDIO_HCI) -+ -+#define MAX_RECVBUF_SZ (RX_DMA_BOUNDARY_8821 + 1) -+ -+#endif -+ -+ -+// Rx smooth factor -+#define Rx_Smooth_Factor (20) -+ -+//DWORD 0 -+#define SET_RX_STATUS_DESC_PKT_LEN_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 31, 1, __Value) -+ -+#define GET_RX_STATUS_DESC_PKT_LEN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICV_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_LAST_SEG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 28, 1) -+#define GET_RX_STATUS_DESC_FIRST_SEG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 29, 1) -+#define GET_RX_STATUS_DESC_EOR_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_OWN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 31, 1) -+ -+//DWORD 1 -+#define GET_RX_STATUS_DESC_MACID_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_TID_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_AMSDU_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_A1_FIT_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 16, 4) -+#define GET_RX_STATUS_DESC_CHKERR_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_IPVER_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_IS_TCPUDP__8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_CHK_VLD_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_MC_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 31, 1) -+ -+//DWORD 2 -+#define GET_RX_STATUS_DESC_SEQ_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 12, 4) -+#define GET_RX_STATUS_DESC_RX_IS_QOS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 16, 1) -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_RPT_SEL_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 28, 1) -+ -+//DWORD 3 -+#define GET_RX_STATUS_DESC_RX_RATE_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_HTC_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 12, 2) -+#ifdef CONFIG_USB_RX_AGGREGATION -+#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 16, 8) -+#endif -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 31, 1) -+ -+//DWORD 6 -+#define GET_RX_STATUS_DESC_SPLCP_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 0, 1) -+#define GET_RX_STATUS_DESC_LDPC_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 1, 1) -+#define GET_RX_STATUS_DESC_STBC_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 2, 1) -+#define GET_RX_STATUS_DESC_BW_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 4, 2) -+ -+//DWORD 5 -+#define GET_RX_STATUS_DESC_TSFL_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+20, 0, 32) -+ -+#define GET_RX_STATUS_DESC_BUFF_ADDR_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+#define GET_RX_STATUS_DESC_BUFF_ADDR64_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+#define SET_RX_STATUS_DESC_BUFF_ADDR_8812(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) -+ -+ -+#ifdef CONFIG_SDIO_HCI -+s32 InitRecvPriv8821AS(PADAPTER padapter); -+void FreeRecvPriv8821AS(PADAPTER padapter); -+#endif // CONFIG_SDIO_HCI -+ -+#ifdef CONFIG_USB_HCI -+void rtl8812au_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+s32 rtl8812au_init_recv_priv(PADAPTER padapter); -+void rtl8812au_free_recv_priv(PADAPTER padapter); -+void rtl8812au_recv_hdl(PADAPTER padapter, struct recv_buf *precvbuf); -+void rtl8812au_recv_tasklet(void *priv); -+ -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8812ae_init_recv_priv(PADAPTER padapter); -+void rtl8812ae_free_recv_priv(PADAPTER padapter); -+#endif -+ -+void rtl8812_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8812A_RECV_H__ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_rf.h linux/3rdparty/rtl8812au/include/rtl8812a_rf.h ---- linux.old/3rdparty/rtl8812au/include/rtl8812a_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8812a_rf.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,34 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_hal.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_hal.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_hal.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,319 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -321330,312 +141448,510 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_rf.h linux/3rdparty/rtl + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++#ifndef __RTL8812A_HAL_H__ ++#define __RTL8812A_HAL_H__ ++ ++//#include "hal_com.h" ++#if 1 ++#include "hal_data.h" ++#else ++#include "../hal/OUTSRC/odm_precomp.h" ++#endif ++ ++//include HAL Related header after HAL Related compiling flags ++#include "rtl8812a_spec.h" ++#include "rtl8812a_rf.h" ++#include "rtl8812a_dm.h" ++#include "rtl8812a_recv.h" ++#include "rtl8812a_xmit.h" ++#include "rtl8812a_cmd.h" ++#include "rtl8812a_led.h" ++#include "Hal8812PwrSeq.h" ++#include "Hal8821APwrSeq.h" //for 8821A/8811A ++#include "Hal8812PhyReg.h" ++#include "Hal8812PhyCfg.h" ++#ifdef DBG_CONFIG_ERROR_DETECT ++#include "rtl8812a_sreset.h" ++#endif ++ ++ ++//--------------------------------------------------------------------- ++// RTL8812AU From header ++//--------------------------------------------------------------------- ++ #define RTL8812_FW_IMG "rtl8812AU\\rtl8812Ufw.bin" ++ #define RTL8812_FW_WW_IMG "rtl8812AU\\rtl8812Ufwww.bin" ++ #define RTL8812_PHY_REG "rtl8812AU\\PHY_REG.txt" ++ #define RTL8812_PHY_RADIO_A "rtl8812AU\\RadioA.txt" ++ #define RTL8812_PHY_RADIO_B "rtl8812AU\\RadioB.txt" ++ #define RTL8812_TXPWR_TRACK "rtl8812AU\\TxPowerTrack.txt" ++ #define RTL8812_AGC_TAB "rtl8812AU\\AGC_TAB.txt" ++ #define RTL8812_PHY_MACREG "rtl8812AU\\MAC_REG.txt" ++ #define RTL8812_PHY_REG_PG "rtl8812AU\\PHY_REG_PG.txt" ++ #define RTL8812_PHY_REG_MP "rtl8812AU\\PHY_REG_MP.txt" ++ #define RTL8812_TXPWR_LMT "rtl8812AU\\TXPWR_LMT.txt" ++ ++//--------------------------------------------------------------------- ++// RTL8821U From file ++//--------------------------------------------------------------------- ++ #define RTL8821_FW_IMG "rtl8821AU\\rtl8821Ufw.bin" ++ #define RTL8821_FW_WW_IMG "rtl8821AU\\rtl8821Ufwww.bin" ++ #define RTL8821_PHY_REG "rtl8821AU\\PHY_REG.txt" ++ #define RTL8821_PHY_RADIO_A "rtl8821AU\\RadioA.txt" ++ #define RTL8821_PHY_RADIO_B "rtl8821AU\\RadioB.txt" ++ #define RTL8821_TXPWR_TRACK "rtl8821AU\\TxPowerTrack.txt" ++ #define RTL8821_AGC_TAB "rtl8821AU\\AGC_TAB.txt" ++ #define RTL8821_PHY_MACREG "rtl8821AU\\MAC_REG.txt" ++ #define RTL8821_PHY_REG_PG "rtl8821AU\\PHY_REG_PG.txt" ++ #define RTL8821_PHY_REG_MP "rtl8821AU\\PHY_REG_MP.txt" ++ #define RTL8821_TXPWR_LMT "rtl8821AU\\TXPWR_LMT.txt" ++ ++//--------------------------------------------------------------------- ++// RTL8812 Power Configuration CMDs for PCIe interface ++//--------------------------------------------------------------------- ++#define Rtl8812_NIC_PWR_ON_FLOW rtl8812_power_on_flow ++#define Rtl8812_NIC_RF_OFF_FLOW rtl8812_radio_off_flow ++#define Rtl8812_NIC_DISABLE_FLOW rtl8812_card_disable_flow ++#define Rtl8812_NIC_ENABLE_FLOW rtl8812_card_enable_flow ++#define Rtl8812_NIC_SUSPEND_FLOW rtl8812_suspend_flow ++#define Rtl8812_NIC_RESUME_FLOW rtl8812_resume_flow ++#define Rtl8812_NIC_PDN_FLOW rtl8812_hwpdn_flow ++#define Rtl8812_NIC_LPS_ENTER_FLOW rtl8812_enter_lps_flow ++#define Rtl8812_NIC_LPS_LEAVE_FLOW rtl8812_leave_lps_flow ++ ++//--------------------------------------------------------------------- ++// RTL8821 Power Configuration CMDs for PCIe interface ++//--------------------------------------------------------------------- ++#define Rtl8821A_NIC_PWR_ON_FLOW rtl8821A_power_on_flow ++#define Rtl8821A_NIC_RF_OFF_FLOW rtl8821A_radio_off_flow ++#define Rtl8821A_NIC_DISABLE_FLOW rtl8821A_card_disable_flow ++#define Rtl8821A_NIC_ENABLE_FLOW rtl8821A_card_enable_flow ++#define Rtl8821A_NIC_SUSPEND_FLOW rtl8821A_suspend_flow ++#define Rtl8821A_NIC_RESUME_FLOW rtl8821A_resume_flow ++#define Rtl8821A_NIC_PDN_FLOW rtl8821A_hwpdn_flow ++#define Rtl8821A_NIC_LPS_ENTER_FLOW rtl8821A_enter_lps_flow ++#define Rtl8821A_NIC_LPS_LEAVE_FLOW rtl8821A_leave_lps_flow ++ ++ ++#if 1 // download firmware related data structure ++#define FW_SIZE_8812 0x8000 // Compatible with RTL8723 Maximal RAM code size 24K. modified to 32k, TO compatible with 92d maximal fw size 32k ++#define FW_START_ADDRESS 0x1000 ++#define FW_END_ADDRESS 0x5FFF ++ ++ ++ ++typedef struct _RT_FIRMWARE_8812 { ++ FIRMWARE_SOURCE eFWSource; ++#ifdef CONFIG_EMBEDDED_FWIMG ++ u8* szFwBuffer; ++#else ++ u8 szFwBuffer[FW_SIZE_8812]; ++#endif ++ u32 ulFwLength; ++ ++#ifdef CONFIG_WOWLAN ++ u8* szWoWLANFwBuffer; ++ u32 ulWoWLANFwLength; ++#endif //CONFIG_WOWLAN ++} RT_FIRMWARE_8812, *PRT_FIRMWARE_8812; ++ ++// ++// This structure must be cared byte-ordering ++// ++// Added by tynli. 2009.12.04. ++#define IS_FW_HEADER_EXIST_8812(_pFwHdr) ((GET_FIRMWARE_HDR_SIGNATURE_8812(_pFwHdr) &0xFFF0) == 0x9500) ++ ++#define IS_FW_HEADER_EXIST_8821(_pFwHdr) ((GET_FIRMWARE_HDR_SIGNATURE_8812(_pFwHdr) &0xFFF0) == 0x2100) ++//===================================================== ++// Firmware Header(8-byte alinment required) ++//===================================================== ++//--- LONG WORD 0 ---- ++#define GET_FIRMWARE_HDR_SIGNATURE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 0, 16) // 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut ++#define GET_FIRMWARE_HDR_CATEGORY_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 16, 8) // AP/NIC and USB/PCI ++#define GET_FIRMWARE_HDR_FUNCTION_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 24, 8) // Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions ++#define GET_FIRMWARE_HDR_VERSION_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 0, 16)// FW Version ++#define GET_FIRMWARE_HDR_SUB_VER_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 16, 8) // FW Subversion, default 0x00 ++#define GET_FIRMWARE_HDR_RSVD1_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 24, 8) ++ ++//--- LONG WORD 1 ---- ++#define GET_FIRMWARE_HDR_MONTH_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 0, 8) // Release time Month field ++#define GET_FIRMWARE_HDR_DATE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 8, 8) // Release time Date field ++#define GET_FIRMWARE_HDR_HOUR_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 16, 8)// Release time Hour field ++#define GET_FIRMWARE_HDR_MINUTE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 24, 8)// Release time Minute field ++#define GET_FIRMWARE_HDR_ROMCODE_SIZE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 0, 16)// The size of RAM code ++#define GET_FIRMWARE_HDR_RSVD2_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 16, 16) ++ ++//--- LONG WORD 2 ---- ++#define GET_FIRMWARE_HDR_SVN_IDX_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 0, 32)// The SVN entry index ++#define GET_FIRMWARE_HDR_RSVD3_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 0, 32) ++ ++//--- LONG WORD 3 ---- ++#define GET_FIRMWARE_HDR_RSVD4_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 0, 32) ++#define GET_FIRMWARE_HDR_RSVD5_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+28, 0, 32) ++ ++#endif // download firmware related data structure ++ ++ ++#define DRIVER_EARLY_INT_TIME_8812 0x05 ++#define BCN_DMA_ATIME_INT_TIME_8812 0x02 ++ ++//for 8812 ++#define MAX_RX_DMA_BUFFER_SIZE_8812 0x3E80 //0x3FFF // RX 16K ++ ++#define TX_TOTAL_PAGE_NUMBER_8812 0xF8 ++ ++#define TX_PAGE_BOUNDARY_8812 (TX_TOTAL_PAGE_NUMBER_8812 + 1) ++#define TX_PAGE_LOAD_FW_BOUNDARY_8812 0x47 //0xA5 ++#define TX_PAGE_BOUNDARY_WOWLAN_8812 0xE0 ++ ++// For Normal Chip Setting ++// (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_92C ++#define NORMAL_PAGE_NUM_PUBQ_8812 0xD8 ++#define NORMAL_PAGE_NUM_LPQ_8812 0x10 ++#define NORMAL_PAGE_NUM_HPQ_8812 0x10 ++#define NORMAL_PAGE_NUM_NPQ_8812 0x00 ++ ++//Note: For WMM Normal Chip Setting ,modify later ++#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8812 0xFB ++#define WMM_NORMAL_TX_PAGE_BOUNDARY_8812 (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8812 + 1) ++ ++#define WMM_NORMAL_PAGE_NUM_PUBQ_8812 0x8B ++#define WMM_NORMAL_PAGE_NUM_HPQ_8812 0x30 ++#define WMM_NORMAL_PAGE_NUM_LPQ_8812 0x20 ++#define WMM_NORMAL_PAGE_NUM_NPQ_8812 0x20 ++ ++ ++// for 8821A ++// TX 64K, RX 16K, Page size 256B for TX, 128B for RX ++#define PAGE_SIZE_TX_8821A 256 ++#define PAGE_SIZE_RX_8821A 128 ++ ++#define MAX_RX_DMA_BUFFER_SIZE_8821 0x3E80 // RX 16K ++ ++// For Normal Chip Setting ++#define TX_TOTAL_PAGE_NUMBER_8821 0xF7 ++#define TX_PAGE_BOUNDARY_8821 (TX_TOTAL_PAGE_NUMBER_8821 + 1) ++//#define TX_PAGE_BOUNDARY_WOWLAN_8821 0xE0 ++ ++// (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER ++#define NORMAL_PAGE_NUM_PUBQ_8821 0xE7 ++#define NORMAL_PAGE_NUM_LPQ_8821 0x08 ++#define NORMAL_PAGE_NUM_HPQ_8821 0x08 ++#define NORMAL_PAGE_NUM_NPQ_8821 0x00 ++ ++// For WMM Normal Chip Setting ++#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8821 0xFB ++#define WMM_NORMAL_TX_PAGE_BOUNDARY_8821 (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8821 + 1) ++ ++#define WMM_NORMAL_PAGE_NUM_PUBQ_8821 0x8B ++#define WMM_NORMAL_PAGE_NUM_HPQ_8821 0x30 ++#define WMM_NORMAL_PAGE_NUM_LPQ_8821 0x20 ++#define WMM_NORMAL_PAGE_NUM_NPQ_8821 0x20 ++ ++ ++#define EFUSE_HIDDEN_812AU 0 ++#define EFUSE_HIDDEN_812AU_VS 1 ++#define EFUSE_HIDDEN_812AU_VL 2 ++#define EFUSE_HIDDEN_812AU_VN 3 ++ ++#ifdef CONFIG_PCI_HCI ++#define EFUSE_REAL_CONTENT_LEN_JAGUAR 1024 ++#define HWSET_MAX_SIZE_JAGUAR 1024 ++#else ++#define EFUSE_REAL_CONTENT_LEN_JAGUAR 512 ++#define HWSET_MAX_SIZE_JAGUAR 512 ++#endif ++ ++#define EFUSE_MAX_BANK_8812A 2 ++#define EFUSE_MAP_LEN_JAGUAR 512 ++#define EFUSE_MAX_SECTION_JAGUAR 64 ++#define EFUSE_MAX_WORD_UNIT_JAGUAR 4 ++#define EFUSE_IC_ID_OFFSET_JAGUAR 506 //For some inferiority IC purpose. added by Roger, 2009.09.02. ++#define AVAILABLE_EFUSE_ADDR_8812(addr) (addr < EFUSE_REAL_CONTENT_LEN_JAGUAR) ++// To prevent out of boundary programming case, leave 1byte and program full section ++// 9bytes + 1byt + 5bytes and pre 1byte. ++// For worst case: ++// | 2byte|----8bytes----|1byte|--7bytes--| //92D ++#define EFUSE_OOB_PROTECT_BYTES_JAGUAR 18 // PG data exclude header, dummy 7 bytes frome CP test and reserved 1byte. ++#define EFUSE_PROTECT_BYTES_BANK_JAGUAR 16 ++// Added for different registry settings to adjust TxPwr index. added by Roger, 2010.03.09. ++typedef enum _TX_PWR_PERCENTAGE{ ++ TX_PWR_PERCENTAGE_0 = 0x01, // 12.5% ++ TX_PWR_PERCENTAGE_1 = 0x02, // 25% ++ TX_PWR_PERCENTAGE_2 = 0x04, // 50% ++ TX_PWR_PERCENTAGE_3 = 0x08, //100%, default target output power. ++} TX_PWR_PERCENTAGE; ++ ++#define GET_RF_TYPE(priv) (GET_HAL_DATA(priv)->rf_type) ++ ++#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) ++#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) ++ ++//#define IS_MULTI_FUNC_CHIP(_Adapter) (((((PHAL_DATA_TYPE)(_Adapter->HalData))->MultiFunc) & (RT_MULTI_FUNC_BT|RT_MULTI_FUNC_GPS)) ? true : false) ++ ++//#define RT_IS_FUNC_DISABLED(__pAdapter, __FuncBits) ( (__pAdapter)->DisabledFunctions & (__FuncBits) ) ++ ++#define GetRegTxBBSwing_2G(_Adapter) (_Adapter->registrypriv.TxBBSwing_2G) ++#define GetRegTxBBSwing_5G(_Adapter) (_Adapter->registrypriv.TxBBSwing_5G) ++ ++#define GetRegAmplifierType2G(_Adapter) (_Adapter->registrypriv.AmplifierType_2G) ++#define GetRegAmplifierType5G(_Adapter) (_Adapter->registrypriv.AmplifierType_5G) ++ ++#define GetRegbENRFEType(_Adapter) (_Adapter->registrypriv.bEn_RFE) ++#define GetRegRFEType(_Adapter) (_Adapter->registrypriv.RFE_Type) ++ ++#define GetDefaultAdapter(padapter) padapter ++ ++// rtl8812_hal_init.c ++void _8051Reset8812(PADAPTER padapter); ++s32 FirmwareDownload8812(PADAPTER Adapter, bool bUsedWoWLANFw); ++void InitializeFirmwareVars8812(PADAPTER padapter); ++ ++s32 InitLLTTable8812(PADAPTER padapter, u8 txpktbuf_bndy); ++void InitRDGSetting8812A(PADAPTER padapter); ++ ++void CheckAutoloadState8812A(PADAPTER padapter); ++ ++// EFuse ++u8 GetEEPROMSize8812A(PADAPTER padapter); ++void InitPGData8812A(PADAPTER padapter); ++void Hal_EfuseParseIDCode8812A(PADAPTER padapter, u8 *hwinfo); ++void Hal_ReadPROMVersion8812A(PADAPTER padapter, u8 *hwinfo, bool AutoLoadFail); ++void Hal_ReadTxPowerInfo8812A(PADAPTER padapter,u8* hwinfo,bool AutoLoadFail); ++void Hal_ReadBoardType8812A(PADAPTER pAdapter,u8* hwinfo,bool AutoLoadFail); ++void Hal_ReadThermalMeter_8812A(PADAPTER Adapter,u8* PROMContent,bool AutoloadFail); ++void Hal_ReadChannelPlan8812A(PADAPTER padapter, u8 *hwinfo, bool AutoLoadFail); ++void Hal_EfuseParseXtal_8812A(PADAPTER pAdapter,u8* hwinfo,bool AutoLoadFail); ++void Hal_ReadAntennaDiversity8812A(PADAPTER pAdapter,u8* PROMContent,bool AutoLoadFail); ++void Hal_ReadPAType_8812A(PADAPTER Adapter,u8* PROMContent, bool AutoloadFail); ++void Hal_ReadPAType_8821A(PADAPTER Adapter,u8* PROMContent, bool AutoloadFail); ++void Hal_ReadRFEType_8812A(PADAPTER Adapter,u8* PROMContent, bool AutoloadFail); ++void Hal_EfuseParseBTCoexistInfo8812A(PADAPTER Adapter, u8* hwinfo, bool AutoLoadFail); ++void hal_ReadUsbType_8812AU(PADAPTER Adapter, u8 *PROMContent, bool AutoloadFail); ++ ++bool HalDetectPwrDownMode8812(PADAPTER Adapter); ++ ++#ifdef CONFIG_WOWLAN ++void Hal_DetectWoWMode(PADAPTER pAdapter); ++#endif //CONFIG_WOWLAN ++ ++void _InitBeaconParameters_8812A(PADAPTER padapter); ++void SetBeaconRelatedRegisters8812A(PADAPTER padapter); ++ ++void ReadRFType8812A(PADAPTER padapter); ++void InitDefaultValue8821A(PADAPTER padapter); ++ ++void SetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval); ++void GetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval); ++u8 SetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++u8 GetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); ++void rtl8812_set_hal_ops(struct hal_ops *pHalFunc); ++ ++// register ++void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); ++ ++void rtl8812_clone_haldata(PADAPTER dst_adapter, PADAPTER src_adapter); ++void rtl8812_start_thread(PADAPTER padapter); ++void rtl8812_stop_thread(PADAPTER padapter); ++#endif //__RTL8188E_HAL_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_led.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_led.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_led.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_led.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,25 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++#ifndef __RTL8812A_LED_H__ ++#define __RTL8812A_LED_H__ ++ ++ ++//================================================================================ ++// Interface to manipulate LED objects. ++//================================================================================ ++void rtl8812au_InitSwLeds(PADAPTER padapter); ++void rtl8812au_DeInitSwLeds(PADAPTER padapter); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_recv.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_recv.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_recv.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_recv.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,112 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++#ifndef __RTL8812A_RECV_H__ ++#define __RTL8812A_RECV_H__ ++ ++ #ifndef CONFIG_MINIMAL_MEMORY_USAGE ++ #define MAX_RECVBUF_SZ (24576) // 24k ++ //#define MAX_RECVBUF_SZ (20480) //20K ++ //#define MAX_RECVBUF_SZ (10240) //10K ++ //#define MAX_RECVBUF_SZ (15360) // 15k < 16k ++ //#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k ++ #else ++ #define MAX_RECVBUF_SZ (4000) // about 4K ++ #endif ++ ++// Rx smooth factor ++#define Rx_Smooth_Factor (20) ++ ++//DWORD 0 ++#define SET_RX_STATUS_DESC_PKT_LEN_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 0, 14, __Value) ++#define SET_RX_STATUS_DESC_EOR_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 30, 1, __Value) ++#define SET_RX_STATUS_DESC_OWN_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 31, 1, __Value) ++ ++#define GET_RX_STATUS_DESC_PKT_LEN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 0, 14) ++#define GET_RX_STATUS_DESC_CRC32_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 14, 1) ++#define GET_RX_STATUS_DESC_ICV_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 15, 1) ++#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 16, 4) ++#define GET_RX_STATUS_DESC_SECURITY_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 20, 3) ++#define GET_RX_STATUS_DESC_QOS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 23, 1) ++#define GET_RX_STATUS_DESC_SHIFT_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 24, 2) ++#define GET_RX_STATUS_DESC_PHY_STATUS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 26, 1) ++#define GET_RX_STATUS_DESC_SWDEC_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 27, 1) ++#define GET_RX_STATUS_DESC_LAST_SEG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 28, 1) ++#define GET_RX_STATUS_DESC_FIRST_SEG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 29, 1) ++#define GET_RX_STATUS_DESC_EOR_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 30, 1) ++#define GET_RX_STATUS_DESC_OWN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 31, 1) ++ ++//DWORD 1 ++#define GET_RX_STATUS_DESC_MACID_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) ++#define GET_RX_STATUS_DESC_TID_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) ++#define GET_RX_STATUS_DESC_AMSDU_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) ++#define GET_RX_STATUS_DESC_RXID_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 14, 1) ++#define GET_RX_STATUS_DESC_PAGGR_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 15, 1) ++#define GET_RX_STATUS_DESC_A1_FIT_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 16, 4) ++#define GET_RX_STATUS_DESC_CHKERR_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 20, 1) ++#define GET_RX_STATUS_DESC_IPVER_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) ++#define GET_RX_STATUS_DESC_IS_TCPUDP__8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) ++#define GET_RX_STATUS_DESC_CHK_VLD_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) ++#define GET_RX_STATUS_DESC_PAM_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 24, 1) ++#define GET_RX_STATUS_DESC_PWR_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 25, 1) ++#define GET_RX_STATUS_DESC_MORE_DATA_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 26, 1) ++#define GET_RX_STATUS_DESC_MORE_FRAG_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 27, 1) ++#define GET_RX_STATUS_DESC_TYPE_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 28, 2) ++#define GET_RX_STATUS_DESC_MC_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 30, 1) ++#define GET_RX_STATUS_DESC_BC_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 31, 1) ++ ++//DWORD 2 ++#define GET_RX_STATUS_DESC_SEQ_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 0, 12) ++#define GET_RX_STATUS_DESC_FRAG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 12, 4) ++#define GET_RX_STATUS_DESC_RX_IS_QOS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 16, 1) ++#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 18, 6) ++#define GET_RX_STATUS_DESC_RPT_SEL_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 28, 1) ++ ++//DWORD 3 ++#define GET_RX_STATUS_DESC_RX_RATE_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 0, 7) ++#define GET_RX_STATUS_DESC_HTC_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 10, 1) ++#define GET_RX_STATUS_DESC_EOSP_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 11, 1) ++#define GET_RX_STATUS_DESC_BSSID_FIT_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 12, 2) ++#ifdef CONFIG_USB_RX_AGGREGATION ++#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 16, 8) ++#endif ++#define GET_RX_STATUS_DESC_PATTERN_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 29, 1) ++#define GET_RX_STATUS_DESC_UNICAST_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 30, 1) ++#define GET_RX_STATUS_DESC_MAGIC_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 31, 1) ++ ++//DWORD 6 ++#define GET_RX_STATUS_DESC_SPLCP_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 0, 1) ++#define GET_RX_STATUS_DESC_LDPC_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 1, 1) ++#define GET_RX_STATUS_DESC_STBC_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 2, 1) ++#define GET_RX_STATUS_DESC_BW_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 4, 2) ++ ++//DWORD 5 ++#define GET_RX_STATUS_DESC_TSFL_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+20, 0, 32) ++ ++#define GET_RX_STATUS_DESC_BUFF_ADDR_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) ++#define GET_RX_STATUS_DESC_BUFF_ADDR64_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) ++ ++#define SET_RX_STATUS_DESC_BUFF_ADDR_8812(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) ++ ++#define INTERRUPT_MSG_FORMAT_LEN 60 ++void rtl8812au_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); ++s32 rtl8812au_init_recv_priv(PADAPTER padapter); ++void rtl8812au_free_recv_priv(PADAPTER padapter); ++void rtl8812au_recv_hdl(PADAPTER padapter, struct recv_buf *precvbuf); ++void rtl8812au_recv_tasklet(void *priv); ++ ++void rtl8812_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); ++void rtl8812_query_rx_phy_status(union recv_frame *prframe, u8 *pphy_stat); ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_rf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_rf.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_rf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_rf.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,41 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#ifndef __RTL8812A_RF_H__ +#define __RTL8812A_RF_H__ + -+VOID ++void +PHY_RF6052SetBandwidth8812( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); ++ PADAPTER Adapter, ++ CHANNEL_WIDTH Bandwidth); + + +int +PHY_RF6052_Config_8812( -+ IN PADAPTER Adapter ); ++ PADAPTER Adapter ); ++ ++void ++PHY_RF6052SetCckTxPower8812( ++ PADAPTER Adapter, ++ u8* pPowerlevel); ++ ++void ++PHY_RF6052SetOFDMTxPower8812( ++ PADAPTER Adapter, ++ u8* pPowerLevelOFDM, ++ u8* pPowerLevelBW20, ++ u8* pPowerLevelBW40, ++ u8 Channel); + +#endif//__RTL8188E_RF_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_spec.h linux/3rdparty/rtl8812au/include/rtl8812a_spec.h ---- linux.old/3rdparty/rtl8812au/include/rtl8812a_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8812a_spec.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,273 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8812A_SPEC_H__ -+#define __RTL8812A_SPEC_H__ -+ -+#include -+ -+ -+//============================================================ -+// 8812 Regsiter offset definition -+//============================================================ -+ -+//============================================================ -+// -+//============================================================ -+ -+//----------------------------------------------------- -+// -+// 0x0000h ~ 0x00FFh System Configuration -+// -+//----------------------------------------------------- -+#define REG_SYS_CLKR_8812A 0x0008 -+#define REG_AFE_PLL_CTRL_8812A 0x0028 -+#define REG_HSIMR_8812 0x0058 -+#define REG_HSISR_8812 0x005c -+#define REG_GPIO_EXT_CTRL 0x0060 -+#define REG_GPIO_STATUS_8812 0x006C -+#define REG_SDIO_CTRL_8812 0x0070 -+#define REG_OPT_CTRL_8812 0x0074 -+#define REG_RF_B_CTRL_8812 0x0076 -+#define REG_FW_DRV_MSG_8812 0x0088 -+#define REG_HMEBOX_E2_E3_8812 0x008C -+#define REG_HIMR0_8812 0x00B0 -+#define REG_HISR0_8812 0x00B4 -+#define REG_HIMR1_8812 0x00B8 -+#define REG_HISR1_8812 0x00BC -+#define REG_EFUSE_BURN_GNT_8812 0x00CF -+#define REG_SYS_CFG1_8812 0x00FC -+ -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+#define REG_CR_8812A 0x100 -+#define REG_PKTBUF_DBG_ADDR (REG_PKTBUF_DBG_CTRL) -+#define REG_RXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+2) -+#define REG_TXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+3) -+#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN -+ -+#define REG_RSVD3_8812 0x0168 -+#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 -+#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 -+#define REG_C2HEVT_CMD_LEN_88XX 0x01AE -+ -+#define REG_HMEBOX_EXT0_8812 0x01F0 -+#define REG_HMEBOX_EXT1_8812 0x01F4 -+#define REG_HMEBOX_EXT2_8812 0x01F8 -+#define REG_HMEBOX_EXT3_8812 0x01FC -+ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_DWBCN0_CTRL_8812 REG_TDECTRL -+#define REG_DWBCN1_CTRL_8812 0x0228 -+ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x02FFh RXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_TDECTRL_8812A 0x0208 -+#define REG_RXDMA_CONTROL_8812A 0x0286 /*Control the RX DMA.*/ -+#define REG_RXDMA_PRO_8812 0x0290 -+#define REG_EARLY_MODE_CONTROL_8812 0x02BC -+#define REG_RSVD5_8812 0x02F0 -+#define REG_RSVD6_8812 0x02F4 -+#define REG_RSVD7_8812 0x02F8 -+#define REG_RSVD8_8812 0x02FC -+ -+ -+//----------------------------------------------------- -+// -+// 0x0300h ~ 0x03FFh PCIe -+// -+//----------------------------------------------------- -+#define REG_PCIE_CTRL_REG_8812A 0x0300 -+#define REG_DBI_WDATA_8812 0x0348 // DBI Write Data -+#define REG_DBI_RDATA_8812 0x034C // DBI Read Data -+#define REG_DBI_ADDR_8812 0x0350 // DBI Address -+#define REG_DBI_FLAG_8812 0x0352 // DBI Read/Write Flag -+#define REG_MDIO_WDATA_8812 0x0354 // MDIO for Write PCIE PHY -+#define REG_MDIO_RDATA_8812 0x0356 // MDIO for Reads PCIE PHY -+#define REG_MDIO_CTL_8812 0x0358 // MDIO for Control -+#define REG_PCIE_MULTIFET_CTRL_8812 0x036A //PCIE Multi-Fethc Control -+ -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+#define REG_TXPKT_EMPTY_8812A 0x041A -+#define REG_FWHW_TXQ_CTRL_8812A 0x0420 -+#define REG_TXBF_CTRL_8812A 0x042C -+#define REG_ARFR0_8812 0x0444 -+#define REG_ARFR1_8812 0x044C -+#define REG_CCK_CHECK_8812 0x0454 -+#define REG_AMPDU_MAX_TIME_8812 0x0456 -+#define REG_TXPKTBUF_BCNQ_BDNY1_8812 0x0457 -+ -+#define REG_AMPDU_MAX_LENGTH_8812 0x0458 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8812 0x045D -+#define REG_NDPA_OPT_CTRL_8812A 0x045F -+#define REG_DATA_SC_8812 0x0483 -+#ifdef CONFIG_WOWLAN -+#define REG_TXPKTBUF_IV_LOW 0x0484 -+#define REG_TXPKTBUF_IV_HIGH 0x0488 -+#endif -+#define REG_ARFR2_8812 0x048C -+#define REG_ARFR3_8812 0x0494 -+#define REG_TXRPT_START_OFFSET 0x04AC -+#define REG_AMPDU_BURST_MODE_8812 0x04BC -+#define REG_HT_SINGLE_AMPDU_8812 0x04C7 -+#define REG_MACID_PKT_DROP0_8812 0x04D0 -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+#define REG_TXPAUSE_8812A 0x0522 -+#define REG_CTWND_8812 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8812 0x0577 -+#define REG_SCH_TXCMD_8812A 0x05F8 -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+#define REG_MAC_CR_8812 0x0600 -+ -+#define REG_MAC_TX_SM_STATE_8812 0x06B4 -+ -+// Power -+#define REG_BFMER0_INFO_8812A 0x06E4 -+#define REG_BFMER1_INFO_8812A 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8812A 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8812A 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8812A 0x06FC -+ -+// Hardware Port 2 -+#define REG_BFMEE_SEL_8812A 0x0714 -+#define REG_SND_PTCL_CTRL_8812A 0x0718 -+ -+ -+//----------------------------------------------------- -+// -+// Redifine register definition for compatibility -+// -+//----------------------------------------------------- -+ -+// TODO: use these definition when using REG_xxx naming rule. -+// NOTE: DO NOT Remove these definition. Use later. -+#define ISR_8812 REG_HISR0_8812 -+ -+//---------------------------------------------------------------------------- -+// 8195 IMR/ISR bits (offset 0xB0, 8bits) -+//---------------------------------------------------------------------------- -+#define IMR_DISABLED_8812 0 -+// IMR DW0(0x00B0-00B3) Bit 0-31 -+#define IMR_TIMER2_8812 BIT31 // Timeout interrupt 2 -+#define IMR_TIMER1_8812 BIT30 // Timeout interrupt 1 -+#define IMR_PSTIMEOUT_8812 BIT29 // Power Save Time Out Interrupt -+#define IMR_GTINT4_8812 BIT28 // When GTIMER4 expires, this bit is set to 1 -+#define IMR_GTINT3_8812 BIT27 // When GTIMER3 expires, this bit is set to 1 -+#define IMR_TXBCN0ERR_8812 BIT26 // Transmit Beacon0 Error -+#define IMR_TXBCN0OK_8812 BIT25 // Transmit Beacon0 OK -+#define IMR_TSF_BIT32_TOGGLE_8812 BIT24 // TSF Timer BIT32 toggle indication interrupt -+#define IMR_BCNDMAINT0_8812 BIT20 // Beacon DMA Interrupt 0 -+#define IMR_BCNDERR0_8812 BIT16 // Beacon Queue DMA OK0 -+#define IMR_HSISR_IND_ON_INT_8812 BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) -+#define IMR_BCNDMAINT_E_8812 BIT14 // Beacon DMA Interrupt Extension for Win7 -+#define IMR_ATIMEND_8812 BIT12 // CTWidnow End or ATIM Window End -+#define IMR_C2HCMD_8812 BIT10 // CPU to Host Command INT Status, Write 1 clear -+#define IMR_CPWM2_8812 BIT9 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_CPWM_8812 BIT8 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_HIGHDOK_8812 BIT7 // High Queue DMA OK -+#define IMR_MGNTDOK_8812 BIT6 // Management Queue DMA OK -+#define IMR_BKDOK_8812 BIT5 // AC_BK DMA OK -+#define IMR_BEDOK_8812 BIT4 // AC_BE DMA OK -+#define IMR_VIDOK_8812 BIT3 // AC_VI DMA OK -+#define IMR_VODOK_8812 BIT2 // AC_VO DMA OK -+#define IMR_RDU_8812 BIT1 // Rx Descriptor Unavailable -+#define IMR_ROK_8812 BIT0 // Receive DMA OK -+ -+// IMR DW1(0x00B4-00B7) Bit 0-31 -+#define IMR_BCNDMAINT7_8812 BIT27 // Beacon DMA Interrupt 7 -+#define IMR_BCNDMAINT6_8812 BIT26 // Beacon DMA Interrupt 6 -+#define IMR_BCNDMAINT5_8812 BIT25 // Beacon DMA Interrupt 5 -+#define IMR_BCNDMAINT4_8812 BIT24 // Beacon DMA Interrupt 4 -+#define IMR_BCNDMAINT3_8812 BIT23 // Beacon DMA Interrupt 3 -+#define IMR_BCNDMAINT2_8812 BIT22 // Beacon DMA Interrupt 2 -+#define IMR_BCNDMAINT1_8812 BIT21 // Beacon DMA Interrupt 1 -+#define IMR_BCNDOK7_8812 BIT20 // Beacon Queue DMA OK Interrup 7 -+#define IMR_BCNDOK6_8812 BIT19 // Beacon Queue DMA OK Interrup 6 -+#define IMR_BCNDOK5_8812 BIT18 // Beacon Queue DMA OK Interrup 5 -+#define IMR_BCNDOK4_8812 BIT17 // Beacon Queue DMA OK Interrup 4 -+#define IMR_BCNDOK3_8812 BIT16 // Beacon Queue DMA OK Interrup 3 -+#define IMR_BCNDOK2_8812 BIT15 // Beacon Queue DMA OK Interrup 2 -+#define IMR_BCNDOK1_8812 BIT14 // Beacon Queue DMA OK Interrup 1 -+#define IMR_ATIMEND_E_8812 BIT13 // ATIM Window End Extension for Win7 -+#define IMR_TXERR_8812 BIT11 // Tx Error Flag Interrupt Status, write 1 clear. -+#define IMR_RXERR_8812 BIT10 // Rx Error Flag INT Status, Write 1 clear -+#define IMR_TXFOVW_8812 BIT9 // Transmit FIFO Overflow -+#define IMR_RXFOVW_8812 BIT8 // Receive FIFO Overflow -+ -+ -+#ifdef CONFIG_PCI_HCI -+//#define IMR_RX_MASK (IMR_ROK_8812|IMR_RDU_8812|IMR_RXFOVW_8812) -+#define IMR_TX_MASK (IMR_VODOK_8812|IMR_VIDOK_8812|IMR_BEDOK_8812|IMR_BKDOK_8812|IMR_MGNTDOK_8812|IMR_HIGHDOK_8812) -+ -+#define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8812 | IMR_TXBCN0OK_8812 | IMR_TXBCN0ERR_8812 | IMR_BCNDERR0_8812) -+ -+#define RT_AC_INT_MASKS (IMR_VIDOK_8812 | IMR_VODOK_8812 | IMR_BEDOK_8812|IMR_BKDOK_8812) -+#endif -+ -+ -+//============================================================================ -+// Regsiter Bit and Content definition -+//============================================================================ -+ -+//2 ACMHWCTRL 0x05C0 -+#define AcmHw_HwEn_8812 BIT(0) -+#define AcmHw_VoqEn_8812 BIT(1) -+#define AcmHw_ViqEn_8812 BIT(2) -+#define AcmHw_BeqEn_8812 BIT(3) -+#define AcmHw_VoqStatus_8812 BIT(5) -+#define AcmHw_ViqStatus_8812 BIT(6) -+#define AcmHw_BeqStatus_8812 BIT(7) -+ -+//======================================================== -+// General definitions -+//======================================================== -+ -+#define MACID_NUM_8812A 128 -+#define SEC_CAM_ENT_NUM_8812A 64 -+#define NSS_NUM_8812A 2 -+ -+#endif /* __RTL8812A_SPEC_H__ */ -+ -+#ifdef CONFIG_RTL8821A -+#include "rtl8821a_spec.h" -+#endif /* CONFIG_RTL8821A */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_sreset.h linux/3rdparty/rtl8812au/include/rtl8812a_sreset.h ---- linux.old/3rdparty/rtl8812au/include/rtl8812a_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8812a_sreset.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,30 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_spec.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_spec.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_spec.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_spec.h 2018-02-06 17:42:30.719967298 +0200 +@@ -0,0 +1,220 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -321645,10 +141961,229 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_sreset.h linux/3rdparty + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ *******************************************************************************/ ++#ifndef __RTL8812A_SPEC_H__ ++#define __RTL8812A_SPEC_H__ ++ ++#include ++ ++ ++//============================================================ ++// 8812 Regsiter offset definition ++//============================================================ ++ ++//============================================================ ++// ++//============================================================ ++ ++//----------------------------------------------------- ++// ++// 0x0000h ~ 0x00FFh System Configuration ++// ++//----------------------------------------------------- ++ ++#define REG_SDIO_CTRL_8812 0x0070 ++#define REG_OPT_CTRL_8812 0x0074 ++#define REG_RF_B_CTRL_8812 0x0076 ++#define REG_FW_DRV_MSG_8812 0x0088 ++#define REG_HMEBOX_E2_E3_8812 0x008C ++#define REG_HIMR0_8812 0x00B0 ++#define REG_HISR0_8812 0x00B4 ++#define REG_HIMR1_8812 0x00B8 ++#define REG_HISR1_8812 0x00BC ++#define REG_EFUSE_BURN_GNT_8812 0x00CF ++#define REG_SYS_CFG1_8812 0x00FC ++ ++//----------------------------------------------------- ++// ++// 0x0100h ~ 0x01FFh MACTOP General Configuration ++// ++//----------------------------------------------------- ++#define REG_PKTBUF_DBG_ADDR (REG_PKTBUF_DBG_CTRL) ++#define REG_RXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+2) ++#define REG_TXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+3) ++ ++#define REG_RSVD3_8812 0x0168 ++#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 ++#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 ++#define REG_C2HEVT_CMD_LEN_88XX 0x01AE ++ ++#define REG_HMEBOX_EXT0_8812 0x01F0 ++#define REG_HMEBOX_EXT1_8812 0x01F4 ++#define REG_HMEBOX_EXT2_8812 0x01F8 ++#define REG_HMEBOX_EXT3_8812 0x01FC ++ ++//----------------------------------------------------- ++// ++// 0x0200h ~ 0x027Fh TXDMA Configuration ++// ++//----------------------------------------------------- ++#define REG_TDECTRL1_8812 0x0228 ++ ++//----------------------------------------------------- ++// ++// 0x0280h ~ 0x02FFh RXDMA Configuration ++// ++//----------------------------------------------------- ++#define REG_RXDMA_PRO_8812 0x0290 ++#define REG_EARLY_MODE_CONTROL_8812 0x02BC ++#define REG_RSVD5_8812 0x02F0 ++#define REG_RSVD6_8812 0x02F4 ++#define REG_RSVD7_8812 0x02F8 ++#define REG_RSVD8_8812 0x02FC ++ ++ ++//----------------------------------------------------- ++// ++// 0x0300h ~ 0x03FFh PCIe ++// ++//----------------------------------------------------- ++#define REG_PCIE_MULTIFET_CTRL_8812 0x036A //PCIE Multi-Fethc Control ++ ++//----------------------------------------------------- ++// ++// 0x0400h ~ 0x047Fh Protocol Configuration ++// ++//----------------------------------------------------- ++#define REG_TXBF_CTRL_8812 0x042C ++#define REG_ARFR1_8812 0x044C ++#define REG_CCK_CHECK_8812 0x0454 ++#define REG_AMPDU_MAX_TIME_8812 0x0456 ++#define REG_TXPKTBUF_BCNQ_BDNY1_8812 0x0457 ++ ++#define REG_AMPDU_MAX_LENGTH_8812 0x0458 ++#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8812 0x045D ++#define REG_NDPA_OPT_CTRL_8812 0x045F ++#define REG_DATA_SC_8812 0x0483 ++#define REG_ARFR2_8812 0x048C ++#define REG_ARFR3_8812 0x0494 ++#define REG_TXRPT_START_OFFSET 0x04AC ++#define REG_AMPDU_BURST_MODE_8812 0x04BC ++#define REG_HT_SINGLE_AMPDU_8812 0x04C7 ++#define REG_MACID_PKT_DROP0_8812 0x04D0 ++ ++//----------------------------------------------------- ++// ++// 0x0500h ~ 0x05FFh EDCA Configuration ++// ++//----------------------------------------------------- ++#define REG_CTWND_8812 0x0572 ++#define REG_SECONDARY_CCA_CTRL_8812 0x0577 ++#define REG_SCH_TXCMD_8812 0x05F8 ++ ++//----------------------------------------------------- ++// ++// 0x0600h ~ 0x07FFh WMAC Configuration ++// ++//----------------------------------------------------- ++#define REG_MAC_CR_8812 0x0600 ++ ++#define REG_MAC_TX_SM_STATE_8812 0x06B4 ++ ++// Power ++#define REG_BFMER0_INFO_8812 0x06E4 ++#define REG_BFMER1_INFO_8812 0x06EC ++#define REG_CSI_RPT_PARAM_BW20_8812 0x06F4 ++#define REG_CSI_RPT_PARAM_BW40_8812 0x06F8 ++#define REG_CSI_RPT_PARAM_BW80_8812 0x06FC ++ ++// Hardware Port 2 ++#define REG_BFMEE_SEL_8812 0x0714 ++#define REG_SND_PTCL_CTRL_8812 0x0718 ++ ++ ++//----------------------------------------------------- ++// ++// Redifine register definition for compatibility ++// ++//----------------------------------------------------- ++ ++// TODO: use these definition when using REG_xxx naming rule. ++// NOTE: DO NOT Remove these definition. Use later. ++#define ISR_8812 REG_HISR0_8812 ++ ++//---------------------------------------------------------------------------- ++// 8195 IMR/ISR bits (offset 0xB0, 8bits) ++//---------------------------------------------------------------------------- ++#define IMR_DISABLED_8812 0 ++// IMR DW0(0x00B0-00B3) Bit 0-31 ++#define IMR_TIMER2_8812 BIT31 // Timeout interrupt 2 ++#define IMR_TIMER1_8812 BIT30 // Timeout interrupt 1 ++#define IMR_PSTIMEOUT_8812 BIT29 // Power Save Time Out Interrupt ++#define IMR_GTINT4_8812 BIT28 // When GTIMER4 expires, this bit is set to 1 ++#define IMR_GTINT3_8812 BIT27 // When GTIMER3 expires, this bit is set to 1 ++#define IMR_TXBCN0ERR_8812 BIT26 // Transmit Beacon0 Error ++#define IMR_TXBCN0OK_8812 BIT25 // Transmit Beacon0 OK ++#define IMR_TSF_BIT32_TOGGLE_8812 BIT24 // TSF Timer BIT32 toggle indication interrupt ++#define IMR_BCNDMAINT0_8812 BIT20 // Beacon DMA Interrupt 0 ++#define IMR_BCNDERR0_8812 BIT16 // Beacon Queue DMA OK0 ++#define IMR_HSISR_IND_ON_INT_8812 BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) ++#define IMR_BCNDMAINT_E_8812 BIT14 // Beacon DMA Interrupt Extension for Win7 ++#define IMR_ATIMEND_8812 BIT12 // CTWidnow End or ATIM Window End ++#define IMR_C2HCMD_8812 BIT10 // CPU to Host Command INT Status, Write 1 clear ++#define IMR_CPWM2_8812 BIT9 // CPU power Mode exchange INT Status, Write 1 clear ++#define IMR_CPWM_8812 BIT8 // CPU power Mode exchange INT Status, Write 1 clear ++#define IMR_HIGHDOK_8812 BIT7 // High Queue DMA OK ++#define IMR_MGNTDOK_8812 BIT6 // Management Queue DMA OK ++#define IMR_BKDOK_8812 BIT5 // AC_BK DMA OK ++#define IMR_BEDOK_8812 BIT4 // AC_BE DMA OK ++#define IMR_VIDOK_8812 BIT3 // AC_VI DMA OK ++#define IMR_VODOK_8812 BIT2 // AC_VO DMA OK ++#define IMR_RDU_8812 BIT1 // Rx Descriptor Unavailable ++#define IMR_ROK_8812 BIT0 // Receive DMA OK ++ ++// IMR DW1(0x00B4-00B7) Bit 0-31 ++#define IMR_BCNDMAINT7_8812 BIT27 // Beacon DMA Interrupt 7 ++#define IMR_BCNDMAINT6_8812 BIT26 // Beacon DMA Interrupt 6 ++#define IMR_BCNDMAINT5_8812 BIT25 // Beacon DMA Interrupt 5 ++#define IMR_BCNDMAINT4_8812 BIT24 // Beacon DMA Interrupt 4 ++#define IMR_BCNDMAINT3_8812 BIT23 // Beacon DMA Interrupt 3 ++#define IMR_BCNDMAINT2_8812 BIT22 // Beacon DMA Interrupt 2 ++#define IMR_BCNDMAINT1_8812 BIT21 // Beacon DMA Interrupt 1 ++#define IMR_BCNDOK7_8812 BIT20 // Beacon Queue DMA OK Interrup 7 ++#define IMR_BCNDOK6_8812 BIT19 // Beacon Queue DMA OK Interrup 6 ++#define IMR_BCNDOK5_8812 BIT18 // Beacon Queue DMA OK Interrup 5 ++#define IMR_BCNDOK4_8812 BIT17 // Beacon Queue DMA OK Interrup 4 ++#define IMR_BCNDOK3_8812 BIT16 // Beacon Queue DMA OK Interrup 3 ++#define IMR_BCNDOK2_8812 BIT15 // Beacon Queue DMA OK Interrup 2 ++#define IMR_BCNDOK1_8812 BIT14 // Beacon Queue DMA OK Interrup 1 ++#define IMR_ATIMEND_E_8812 BIT13 // ATIM Window End Extension for Win7 ++#define IMR_TXERR_8812 BIT11 // Tx Error Flag Interrupt Status, write 1 clear. ++#define IMR_RXERR_8812 BIT10 // Rx Error Flag INT Status, Write 1 clear ++#define IMR_TXFOVW_8812 BIT9 // Transmit FIFO Overflow ++#define IMR_RXFOVW_8812 BIT8 // Receive FIFO Overflow ++ ++ ++//============================================================================ ++// Regsiter Bit and Content definition ++//============================================================================ ++ ++//2 ACMHWCTRL 0x05C0 ++#define AcmHw_HwEn_8812 BIT(0) ++#define AcmHw_VoqEn_8812 BIT(1) ++#define AcmHw_ViqEn_8812 BIT(2) ++#define AcmHw_BeqEn_8812 BIT(3) ++#define AcmHw_VoqStatus_8812 BIT(5) ++#define AcmHw_ViqStatus_8812 BIT(6) ++#define AcmHw_BeqStatus_8812 BIT(7) ++ ++#endif //__RTL8188E_SPEC_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_sreset.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_sreset.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_sreset.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_sreset.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,24 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#ifndef _RTL88812A_SRESET_H_ @@ -321661,383 +142196,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_sreset.h linux/3rdparty +extern void rtl8812_sreset_linked_status_check(_adapter *padapter); +#endif +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8812a_xmit.h linux/3rdparty/rtl8812au/include/rtl8812a_xmit.h ---- linux.old/3rdparty/rtl8812au/include/rtl8812a_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8812a_xmit.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,368 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_XMIT_H__ -+#define __RTL8812A_XMIT_H__ -+ -+ -+//For 88e early mode -+#define SET_EARLYMODE_PKTNUM(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 3, __Value) -+#define SET_EARLYMODE_LEN0(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 12, __Value) -+#define SET_EARLYMODE_LEN1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 16, 12, __Value) -+#define SET_EARLYMODE_LEN2_1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 28, 4, __Value) -+#define SET_EARLYMODE_LEN2_2(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 8, __Value) -+#define SET_EARLYMODE_LEN3(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 8, 12, __Value) -+#define SET_EARLYMODE_LEN4(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 20, 12, __Value) -+ -+// -+//defined for TX DESC Operation -+// -+ -+#define MAX_TID (15) -+ -+//OFFSET 0 -+#define OFFSET_SZ 0 -+#define OFFSET_SHT 16 -+#define BMC BIT(24) -+#define LSG BIT(26) -+#define FSG BIT(27) -+#define OWN BIT(31) -+ -+ -+//OFFSET 4 -+#define PKT_OFFSET_SZ 0 -+#define QSEL_SHT 8 -+#define RATE_ID_SHT 16 -+#define NAVUSEHDR BIT(20) -+#define SEC_TYPE_SHT 22 -+#define PKT_OFFSET_SHT 26 -+ -+//OFFSET 8 -+#define AGG_EN BIT(12) -+#define AGG_BK BIT(16) -+#define AMPDU_DENSITY_SHT 20 -+#define ANTSEL_A BIT(24) -+#define ANTSEL_B BIT(25) -+#define TX_ANT_CCK_SHT 26 -+#define TX_ANTL_SHT 28 -+#define TX_ANT_HT_SHT 30 -+ -+//OFFSET 12 -+#define SEQ_SHT 16 -+#define EN_HWSEQ BIT(31) -+ -+//OFFSET 16 -+#define QOS BIT(6) -+#define HW_SSN BIT(7) -+#define USERATE BIT(8) -+#define DISDATAFB BIT(10) -+#define CTS_2_SELF BIT(11) -+#define RTS_EN BIT(12) -+#define HW_RTS_EN BIT(13) -+#define DATA_SHORT BIT(24) -+#define PWR_STATUS_SHT 15 -+#define DATA_SC_SHT 20 -+#define DATA_BW BIT(25) -+ -+//OFFSET 20 -+#define RTY_LMT_EN BIT(17) -+ -+//OFFSET 20 -+#define SGI BIT(6) -+#define USB_TXAGG_NUM_SHT 24 -+ -+typedef struct txdescriptor_8812 -+{ -+ // Offset 0 -+ u32 pktlen:16; -+ u32 offset:8; -+ u32 bmc:1; -+ u32 htc:1; -+ u32 ls:1; -+ u32 fs:1; -+ u32 linip:1; -+ u32 noacm:1; -+ u32 gf:1; -+ u32 own:1; -+ -+ // Offset 4 -+ u32 macid:6; -+ u32 rsvd0406:2; -+ u32 qsel:5; -+ u32 rd_nav_ext:1; -+ u32 lsig_txop_en:1; -+ u32 pifs:1; -+ u32 rate_id:4; -+ u32 navusehdr:1; -+ u32 en_desc_id:1; -+ u32 sectype:2; -+ u32 rsvd0424:2; -+ u32 pkt_offset:5; // unit: 8 bytes -+ u32 rsvd0431:1; -+ -+ // Offset 8 -+ u32 rts_rc:6; -+ u32 data_rc:6; -+ u32 agg_en:1; -+ u32 rd_en:1; -+ u32 bar_rty_th:2; -+ u32 bk:1; -+ u32 morefrag:1; -+ u32 raw:1; -+ u32 ccx:1; -+ u32 ampdu_density:3; -+ u32 bt_null:1; -+ u32 ant_sel_a:1; -+ u32 ant_sel_b:1; -+ u32 tx_ant_cck:2; -+ u32 tx_antl:2; -+ u32 tx_ant_ht:2; -+ -+ // Offset 12 -+ u32 nextheadpage:8; -+ u32 tailpage:8; -+ u32 seq:12; -+ u32 cpu_handle:1; -+ u32 tag1:1; -+ u32 trigger_int:1; -+ u32 hwseq_en:1; -+ -+ // Offset 16 -+ u32 rtsrate:5; -+ u32 ap_dcfe:1; -+ u32 hwseq_sel:2; -+ u32 userate:1; -+ u32 disrtsfb:1; -+ u32 disdatafb:1; -+ u32 cts2self:1; -+ u32 rtsen:1; -+ u32 hw_rts_en:1; -+ u32 port_id:1; -+ u32 pwr_status:3; -+ u32 wait_dcts:1; -+ u32 cts2ap_en:1; -+ u32 data_sc:2; -+ u32 data_stbc:2; -+ u32 data_short:1; -+ u32 data_bw:1; -+ u32 rts_short:1; -+ u32 rts_bw:1; -+ u32 rts_sc:2; -+ u32 vcs_stbc:2; -+ -+ // Offset 20 -+ u32 datarate:6; -+ u32 sgi:1; -+ u32 try_rate:1; -+ u32 data_ratefb_lmt:5; -+ u32 rts_ratefb_lmt:4; -+ u32 rty_lmt_en:1; -+ u32 data_rt_lmt:6; -+ u32 usb_txagg_num:8; -+ -+ // Offset 24 -+ u32 txagg_a:5; -+ u32 txagg_b:5; -+ u32 use_max_len:1; -+ u32 max_agg_num:5; -+ u32 mcsg1_max_len:4; -+ u32 mcsg2_max_len:4; -+ u32 mcsg3_max_len:4; -+ u32 mcs7_sgi_max_len:4; -+ -+ // Offset 28 -+ u32 checksum:16; // TxBuffSize(PCIe)/CheckSum(USB) -+ u32 mcsg4_max_len:4; -+ u32 mcsg5_max_len:4; -+ u32 mcsg6_max_len:4; -+ u32 mcs15_sgi_max_len:4; -+ -+ // Offset 32 -+ u32 rsvd32; -+ -+ // Offset 36 -+ u32 rsvd36; -+}TXDESC_8812, *PTXDESC_8812; -+ -+ -+// Dword 0 -+#define GET_TX_DESC_OWN_8812(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+#define SET_TX_DESC_PKT_SIZE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define SET_TX_DESC_OFFSET_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define SET_TX_DESC_BMC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_LAST_SEG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+#define SET_TX_DESC_FIRST_SEG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_LINIP_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+#define SET_TX_DESC_NO_ACM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+#define SET_TX_DESC_OWN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+// Dword 1 -+#define SET_TX_DESC_MACID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+ -+// Dword 2 -+#define SET_TX_DESC_PAID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+#define SET_TX_DESC_CCA_RTS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_AGG_BREAK_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define SET_TX_DESC_RAW_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define SET_TX_DESC_SPE_RPT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_INT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_GID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+ -+// Dword 3 -+#define SET_TX_DESC_WHEADER_LEN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) -+#define SET_TX_DESC_CHK_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) -+#define SET_TX_DESC_EARLY_MODE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HWSEQ_SEL_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_NAV_USE_HDR_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_NDPA_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+// Dword 4 -+#define SET_TX_DESC_TX_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+ -+// Dword 5 -+#define SET_TX_DESC_DATA_SC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_LDPC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+#define SET_TX_DESC_DATA_STBC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_CTROL_STBC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+#define SET_TX_DESC_TX_ANT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 4, __Value) -+ -+// Dword 6 -+#define SET_TX_DESC_SW_DEFINE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_ANTSEL_A_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+#define SET_TX_DESC_ANTSEL_B_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) -+#define SET_TX_DESC_ANTSEL_C_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) -+#define SET_TX_DESC_ANTSEL_D_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) -+#define SET_TX_DESC_MBSSID_8821(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+ -+// Dword 7 -+#define SET_TX_DESC_TX_BUFFER_SIZE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#define SET_TX_DESC_TX_DESC_CHECKSUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#define SET_TX_DESC_USB_TXAGG_NUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+#ifdef CONFIG_SDIO_HCI -+#define SET_TX_DESC_SDIO_TXSEQ_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) -+#endif -+ -+// Dword 8 -+#define SET_TX_DESC_HWSEQ_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+ -+// Dword 9 -+#define SET_TX_DESC_SEQ_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+ -+// Dword 10 -+#define SET_TX_DESC_TX_BUFFER_ADDRESS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) -+#define GET_TX_DESC_TX_BUFFER_ADDRESS_8812(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+40, 0, 32) -+ -+// Dword 11 -+#define SET_TX_DESC_NEXT_DESC_ADDRESS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) -+ -+ -+#define SET_EARLYMODE_PKTNUM_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+#ifdef CONFIG_TX_EARLY_MODE -+#define USB_DUMMY_OFFSET 2 -+#else -+#define USB_DUMMY_OFFSET 1 -+#endif -+#define USB_DUMMY_LENGTH (USB_DUMMY_OFFSET * PACKET_OFFSET_SZ) -+ -+ -+void rtl8812a_cal_txdesc_chksum(u8 *ptxdesc); -+void rtl8812a_fill_fake_txdesc(PADAPTER padapter,u8*pDesc,u32 BufferLen,u8 IsPsPoll,u8 IsBTQosNull, u8 bDataFrame); -+void rtl8812a_fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void rtl8812a_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); -+void rtl8812a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); -+ -+#ifdef CONFIG_USB_HCI -+s32 rtl8812au_init_xmit_priv(PADAPTER padapter); -+void rtl8812au_free_xmit_priv(PADAPTER padapter); -+s32 rtl8812au_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8812au_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8812au_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); -+void rtl8812au_xmit_tasklet(void *priv); -+s32 rtl8812au_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8812ae_init_xmit_priv(PADAPTER padapter); -+void rtl8812ae_free_xmit_priv(PADAPTER padapter); -+struct xmit_buf *rtl8812ae_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+void rtl8812ae_xmitframe_resume(_adapter *padapter); -+s32 rtl8812ae_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8812ae_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+#ifdef CONFIG_XMIT_THREAD_MODE -+s32 rtl8812ae_xmit_buf_handler(_adapter *padapter); -+#endif -+s32 rtl8812ae_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+void rtl8812ae_xmit_tasklet(void *priv); -+#endif -+ -+#ifdef CONFIG_TX_EARLY_MODE -+void UpdateEarlyModeInfo8812(struct xmit_priv *pxmitpriv,struct xmit_buf *pxmitbuf ); -+#endif -+ -+void _dbg_dump_tx_info(_adapter *padapter,int frame_tag,u8 *ptxdesc); -+ -+u8 BWMapping_8812(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+u8 SCMapping_8812(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+#endif //__RTL8812_XMIT_H__ -+ -+#ifdef CONFIG_RTL8821A -+#include "rtl8821a_xmit.h" -+#endif // CONFIG_RTL8821A -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8814a_cmd.h linux/3rdparty/rtl8812au/include/rtl8814a_cmd.h ---- linux.old/3rdparty/rtl8812au/include/rtl8814a_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8814a_cmd.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,166 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_xmit.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_xmit.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_xmit.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_xmit.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,344 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -322051,776 +142213,484 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8814a_cmd.h linux/3rdparty/rt + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ -+#ifndef __RTL8814A_CMD_H__ -+#define __RTL8814A_CMD_H__ -+#include "hal_com_h2c.h" ++#ifndef __RTL8812A_XMIT_H__ ++#define __RTL8812A_XMIT_H__ + -+//_RSVDPAGE_LOC_CMD0 -+#define SET_8814A_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8814A_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8814A_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8814A_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8814A_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) ++#include "rtl8821a_xmit.h" + -+//_MEDIA_STATUS_RPT_PARM_CMD1 -+#define SET_8814A_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8814A_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8814A_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8814A_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) ++// ++// Queue Select Value in TxDesc ++// ++#define QSLT_BK 0x2//0x01 ++#define QSLT_BE 0x0 ++#define QSLT_VI 0x5//0x4 ++#define QSLT_VO 0x7//0x6 ++#define QSLT_BEACON 0x10 ++#define QSLT_HIGH 0x11 ++#define QSLT_MGNT 0x12 ++#define QSLT_CMD 0x13 + -+//_SETPWRMODE_PARM -+#define SET_8814A_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8814A_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8814A_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8814A_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8814A_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8814A_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8814A_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) ++//For 88e early mode ++#define SET_EARLYMODE_PKTNUM(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 3, __Value) ++#define SET_EARLYMODE_LEN0(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 12, __Value) ++#define SET_EARLYMODE_LEN1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 16, 12, __Value) ++#define SET_EARLYMODE_LEN2_1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 28, 4, __Value) ++#define SET_EARLYMODE_LEN2_2(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 8, __Value) ++#define SET_EARLYMODE_LEN3(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 8, 12, __Value) ++#define SET_EARLYMODE_LEN4(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 20, 12, __Value) + -+#define GET_8814A_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) ++// ++//defined for TX DESC Operation ++// ++ ++#define MAX_TID (15) ++ ++//OFFSET 0 ++#define OFFSET_SZ 0 ++#define OFFSET_SHT 16 ++#define BMC BIT(24) ++#define LSG BIT(26) ++#define FSG BIT(27) ++#define OWN BIT(31) + + -+// _WoWLAN PARAM_CMD5 -+#define SET_8814A_H2CCMD_WOWLAN_FUNC_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_MAGIC_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_UNICAST_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_ALL_PKT_DROP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_GPIO_ACTIVE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_REKEY_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_DISCONNECT_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_GPIONUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_GPIO_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++//OFFSET 4 ++#define PKT_OFFSET_SZ 0 ++#define QSEL_SHT 8 ++#define RATE_ID_SHT 16 ++#define NAVUSEHDR BIT(20) ++#define SEC_TYPE_SHT 22 ++#define PKT_OFFSET_SHT 26 + ++//OFFSET 8 ++#define AGG_EN BIT(12) ++#define AGG_BK BIT(16) ++#define AMPDU_DENSITY_SHT 20 ++#define ANTSEL_A BIT(24) ++#define ANTSEL_B BIT(25) ++#define TX_ANT_CCK_SHT 26 ++#define TX_ANTL_SHT 28 ++#define TX_ANT_HT_SHT 30 + -+//WLANINFO_PARM -+#define SET_8814A_H2CCMD_WLANINFO_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8814A_H2CCMD_WLANINFO_PARM_CHANNEL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8814A_H2CCMD_WLANINFO_PARM_BW40MHZ(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) ++//OFFSET 12 ++#define SEQ_SHT 16 ++#define EN_HWSEQ BIT(31) + -+// _REMOTE_WAKEUP_CMD7 -+#define SET_8814A_H2CCMD_REMOTE_WAKECTRL_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8814A_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8814A_H2CCMD_REMOTE_WAKE_CTRL_NDP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8814A_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) ++//OFFSET 16 ++#define QOS BIT(6) ++#define HW_SSN BIT(7) ++#define USERATE BIT(8) ++#define DISDATAFB BIT(10) ++#define CTS_2_SELF BIT(11) ++#define RTS_EN BIT(12) ++#define HW_RTS_EN BIT(13) ++#define DATA_SHORT BIT(24) ++#define PWR_STATUS_SHT 15 ++#define DATA_SC_SHT 20 ++#define DATA_BW BIT(25) + ++//OFFSET 20 ++#define RTY_LMT_EN BIT(17) + -+// _AP_OFFLOAD_CMD8 -+#define SET_8814A_H2CCMD_AP_OFFLOAD_ON(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8814A_H2CCMD_AP_OFFLOAD_HIDDEN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8814A_H2CCMD_AP_OFFLOAD_DENYANY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8814A_H2CCMD_AP_OFFLOAD_WAKEUP_EVT_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) ++//OFFSET 20 ++#define SGI BIT(6) ++#define USB_TXAGG_NUM_SHT 24 + -+// _PWR_MOD_CMD20 -+#define SET_88E_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_88E_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_88E_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_88E_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_88E_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_88E_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+ -+// TX Beamforming -+#define GET_8814A_C2H_TXBF_ORIGINATE(_Header) LE_BITS_TO_1BYTE(_Header, 0, 8) -+#define GET_8814A_C2H_TXBF_MACID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) -+ -+ -+ -+/// TX Feedback Content -+#define USEC_UNIT_FOR_8814A_C2H_TX_RPT_QUEUE_TIME 256 -+ -+#define GET_8814A_C2H_TX_RPT_QUEUE_SELECT(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 5) -+#define GET_8814A_C2H_TX_RPT_PKT_BROCAST(_Header) LE_BITS_TO_1BYTE((_Header + 0), 5, 1) -+#define GET_8814A_C2H_TX_RPT_LIFE_TIME_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 6, 1) -+#define GET_8814A_C2H_TX_RPT_RETRY_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 7, 1) -+#define GET_8814A_C2H_TX_RPT_MAC_ID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) -+#define GET_8814A_C2H_TX_RPT_DATA_RETRY_CNT(_Header) LE_BITS_TO_1BYTE((_Header + 2), 0, 6) -+#define GET_8814A_C2H_TX_RPT_QUEUE_TIME(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) // In unit of 256 microseconds. -+#define GET_8814A_C2H_TX_RPT_FINAL_DATA_RATE(_Header) LE_BITS_TO_1BYTE((_Header + 5), 0, 8) -+ -+ -+//_P2P_PS_OFFLOAD -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_CTWINDOW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) -+ -+ -+typedef enum _RTL8814A_C2H_EVT ++typedef struct txdescriptor_8812 +{ -+ C2H_8814A_DBG = 0, -+ C2H_8814A_LB = 1, -+ C2H_8814A_TXBF = 2, -+ C2H_8814A_TX_REPORT = 3, -+ C2H_8814A_BT_INFO = 9, -+ C2H_8814A_BT_MP = 11, -+ C2H_8814A_RA_PARA_RPT = 14, -+ MAX_8814A_C2HEVENT -+}RTL8814A_C2H_EVT; ++ // Offset 0 ++ u32 pktlen:16; ++ u32 offset:8; ++ u32 bmc:1; ++ u32 htc:1; ++ u32 ls:1; ++ u32 fs:1; ++ u32 linip:1; ++ u32 noacm:1; ++ u32 gf:1; ++ u32 own:1; + -+s32 FillH2CCmd_8814(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+void rtl8814_set_raid_cmd(PADAPTER padapter, u64 bitmap, u8* arg); -+void rtl8814_Add_RateATid(PADAPTER padapter, u64 rate_bitmap, u8 *arg, u8 rssi_level); -+void rtl8814_set_wowlan_cmd(_adapter* padapter, u8 enable); -+void rtl8814_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); -+void rtl8814_set_FwMediaStatus_cmd(PADAPTER padapter, u16 mstatus_rpt ); -+void rtl8814_set_FwPwrMode_cmd(PADAPTER padapter, u8 PSMode); -+u8 GetTxBufferRsvdPageNum8814(_adapter *padapter, bool wowlan); -+u8 rtl8814_set_rssi_cmd(_adapter*padapter, u8 *param); ++ // Offset 4 ++ u32 macid:6; ++ u32 rsvd0406:2; ++ u32 qsel:5; ++ u32 rd_nav_ext:1; ++ u32 lsig_txop_en:1; ++ u32 pifs:1; ++ u32 rate_id:4; ++ u32 navusehdr:1; ++ u32 en_desc_id:1; ++ u32 sectype:2; ++ u32 rsvd0424:2; ++ u32 pkt_offset:5; // unit: 8 bytes ++ u32 rsvd0431:1; + -+void -+Set_RA_LDPC_8814( -+ struct sta_info *psta, -+ BOOLEAN bLDPC -+ ); -+int rtl8814_iqk_wait(_adapter* padapter, u32 timeout_ms); -+void rtl8814_iqk_done(_adapter* padapter); -+VOID -+C2HPacketHandler_8814( -+ IN PADAPTER Adapter, -+ IN u8 *Buffer, -+ IN u8 Length -+ ); -+#ifdef CONFIG_P2P_PS -+void rtl8814_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif //CONFIG_P2P ++ // Offset 8 ++ u32 rts_rc:6; ++ u32 data_rc:6; ++ u32 agg_en:1; ++ u32 rd_en:1; ++ u32 bar_rty_th:2; ++ u32 bk:1; ++ u32 morefrag:1; ++ u32 raw:1; ++ u32 ccx:1; ++ u32 ampdu_density:3; ++ u32 bt_null:1; ++ u32 ant_sel_a:1; ++ u32 ant_sel_b:1; ++ u32 tx_ant_cck:2; ++ u32 tx_antl:2; ++ u32 tx_ant_ht:2; + -+s32 -+_C2HContentParsing8814( -+ IN PADAPTER Adapter, -+ IN u8 c2hCmdId, -+ IN u8 c2hCmdLen, -+ IN u8 *tmpBuf -+); ++ // Offset 12 ++ u32 nextheadpage:8; ++ u32 tailpage:8; ++ u32 seq:12; ++ u32 cpu_handle:1; ++ u32 tag1:1; ++ u32 trigger_int:1; ++ u32 hwseq_en:1; + -+#endif/* __RTL8814A_CMD_H__ */ ++ // Offset 16 ++ u32 rtsrate:5; ++ u32 ap_dcfe:1; ++ u32 hwseq_sel:2; ++ u32 userate:1; ++ u32 disrtsfb:1; ++ u32 disdatafb:1; ++ u32 cts2self:1; ++ u32 rtsen:1; ++ u32 hw_rts_en:1; ++ u32 port_id:1; ++ u32 pwr_status:3; ++ u32 wait_dcts:1; ++ u32 cts2ap_en:1; ++ u32 data_sc:2; ++ u32 data_stbc:2; ++ u32 data_short:1; ++ u32 data_bw:1; ++ u32 rts_short:1; ++ u32 rts_bw:1; ++ u32 rts_sc:2; ++ u32 vcs_stbc:2; + -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8814a_dm.h linux/3rdparty/rtl8812au/include/rtl8814a_dm.h ---- linux.old/3rdparty/rtl8812au/include/rtl8814a_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8814a_dm.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,34 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8814A_DM_H__ -+#define __RTL8814A_DM_H__ ++ // Offset 20 ++ u32 datarate:6; ++ u32 sgi:1; ++ u32 try_rate:1; ++ u32 data_ratefb_lmt:5; ++ u32 rts_ratefb_lmt:4; ++ u32 rty_lmt_en:1; ++ u32 data_rt_lmt:6; ++ u32 usb_txagg_num:8; + -+void rtl8814_init_dm_priv(IN PADAPTER Adapter); -+void rtl8814_deinit_dm_priv(IN PADAPTER Adapter); -+void rtl8814_InitHalDm(IN PADAPTER Adapter); -+void rtl8814_HalDmWatchDog(IN PADAPTER Adapter); ++ // Offset 24 ++ u32 txagg_a:5; ++ u32 txagg_b:5; ++ u32 use_max_len:1; ++ u32 max_agg_num:5; ++ u32 mcsg1_max_len:4; ++ u32 mcsg2_max_len:4; ++ u32 mcsg3_max_len:4; ++ u32 mcs7_sgi_max_len:4; + -+#ifdef CONFIG_ANTENNA_DIVERSITY -+void AntDivCompare8814(PADAPTER Adapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src); -+u8 AntDivBeforeLink8814(PADAPTER Adapter ); -+#endif //CONFIG_ANTENNA_DIVERSITY ++ // Offset 28 ++ u32 checksum:16; // TxBuffSize(PCIe)/CheckSum(USB) ++ u32 mcsg4_max_len:4; ++ u32 mcsg5_max_len:4; ++ u32 mcsg6_max_len:4; ++ u32 mcs15_sgi_max_len:4; + ++ // Offset 32 ++ u32 rsvd32; ++ ++ // Offset 36 ++ u32 rsvd36; ++}TXDESC_8812, *PTXDESC_8812; ++ ++ ++// Dword 0 ++#define GET_TX_DESC_OWN_8812(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) ++#define SET_TX_DESC_PKT_SIZE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) ++#define SET_TX_DESC_OFFSET_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) ++#define SET_TX_DESC_BMC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) ++#define SET_TX_DESC_HTC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) ++#define SET_TX_DESC_LAST_SEG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) ++#define SET_TX_DESC_FIRST_SEG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) ++#define SET_TX_DESC_LINIP_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) ++#define SET_TX_DESC_NO_ACM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) ++#define SET_TX_DESC_GF_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) ++#define SET_TX_DESC_OWN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) ++ ++// Dword 1 ++#define SET_TX_DESC_MACID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) ++#define SET_TX_DESC_QUEUE_SEL_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) ++#define SET_TX_DESC_RDG_NAV_EXT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) ++#define SET_TX_DESC_LSIG_TXOP_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) ++#define SET_TX_DESC_PIFS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) ++#define SET_TX_DESC_RATE_ID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) ++#define SET_TX_DESC_EN_DESC_ID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) ++#define SET_TX_DESC_SEC_TYPE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) ++#define SET_TX_DESC_PKT_OFFSET_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) ++ ++// Dword 2 ++#define SET_TX_DESC_PAID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) ++#define SET_TX_DESC_CCA_RTS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) ++#define SET_TX_DESC_AGG_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) ++#define SET_TX_DESC_RDG_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) ++#define SET_TX_DESC_AGG_BREAK_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) ++#define SET_TX_DESC_MORE_FRAG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) ++#define SET_TX_DESC_RAW_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) ++#define SET_TX_DESC_SPE_RPT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) ++#define SET_TX_DESC_AMPDU_DENSITY_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) ++#define SET_TX_DESC_BT_INT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) ++#define SET_TX_DESC_GID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) ++ ++// Dword 3 ++#define SET_TX_DESC_WHEADER_LEN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) ++#define SET_TX_DESC_CHK_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) ++#define SET_TX_DESC_EARLY_MODE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) ++#define SET_TX_DESC_HWSEQ_SEL_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) ++#define SET_TX_DESC_USE_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) ++#define SET_TX_DESC_DISABLE_RTS_FB_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) ++#define SET_TX_DESC_DISABLE_FB_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) ++#define SET_TX_DESC_CTS2SELF_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) ++#define SET_TX_DESC_RTS_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) ++#define SET_TX_DESC_HW_RTS_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) ++#define SET_TX_DESC_NAV_USE_HDR_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) ++#define SET_TX_DESC_USE_MAX_LEN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) ++#define SET_TX_DESC_MAX_AGG_NUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) ++#define SET_TX_DESC_NDPA_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) ++#define SET_TX_DESC_AMPDU_MAX_TIME_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) ++ ++// Dword 4 ++#define SET_TX_DESC_TX_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) ++#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) ++#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) ++#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) ++#define SET_TX_DESC_DATA_RETRY_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) ++#define SET_TX_DESC_RTS_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) ++ ++// Dword 5 ++#define SET_TX_DESC_DATA_SC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) ++#define SET_TX_DESC_DATA_SHORT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) ++#define SET_TX_DESC_DATA_BW_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) ++#define SET_TX_DESC_DATA_LDPC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) ++#define SET_TX_DESC_DATA_STBC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) ++#define SET_TX_DESC_CTROL_STBC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) ++#define SET_TX_DESC_RTS_SHORT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) ++#define SET_TX_DESC_RTS_SC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) ++ ++// Dword 6 ++#define SET_TX_DESC_MBSSID_8821(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) ++ ++// Dword 7 ++#define SET_TX_DESC_TX_BUFFER_SIZE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++#define SET_TX_DESC_TX_DESC_CHECKSUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) ++#define SET_TX_DESC_USB_TXAGG_NUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) ++// Dword 8 ++#define SET_TX_DESC_HWSEQ_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) ++ ++// Dword 9 ++#define SET_TX_DESC_SEQ_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) ++ ++// Dword 10 ++#define SET_TX_DESC_TX_BUFFER_ADDRESS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) ++ ++// Dword 11 ++#define SET_TX_DESC_NEXT_DESC_ADDRESS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) ++ ++ ++#define SET_EARLYMODE_PKTNUM_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) ++#define SET_EARLYMODE_LEN0_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) ++#define SET_EARLYMODE_LEN1_1_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) ++#define SET_EARLYMODE_LEN1_2_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) ++#define SET_EARLYMODE_LEN2_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) ++#define SET_EARLYMODE_LEN3_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) ++ ++#ifdef CONFIG_TX_EARLY_MODE ++#define USB_DUMMY_OFFSET 2 ++#else ++#define USB_DUMMY_OFFSET 1 ++#endif ++#define USB_DUMMY_LENGTH (USB_DUMMY_OFFSET * PACKET_OFFSET_SZ) ++ ++ ++void rtl8812a_cal_txdesc_chksum(u8 *ptxdesc); ++void rtl8812a_fill_fake_txdesc(PADAPTER padapter,u8*pDesc,u32 BufferLen,u8 IsPsPoll,u8 IsBTQosNull); ++void rtl8812a_fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc); ++void rtl8812a_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); ++void rtl8812a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); ++ ++s32 rtl8812au_init_xmit_priv(PADAPTER padapter); ++void rtl8812au_free_xmit_priv(PADAPTER padapter); ++s32 rtl8812au_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); ++s32 rtl8812au_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); ++s32 rtl8812au_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); ++s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); ++void rtl8812au_xmit_tasklet(void *priv); ++s32 rtl8812au_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); ++ ++#ifdef CONFIG_TX_EARLY_MODE ++void UpdateEarlyModeInfo8812(struct xmit_priv *pxmitpriv,struct xmit_buf *pxmitbuf ); +#endif + -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8814a_hal.h linux/3rdparty/rtl8812au/include/rtl8814a_hal.h ---- linux.old/3rdparty/rtl8812au/include/rtl8814a_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8814a_hal.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,334 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8814A_HAL_H__ -+#define __RTL8814A_HAL_H__ -+ -+//#include "hal_com.h" -+#include "hal_data.h" -+ -+//include HAL Related header after HAL Related compiling flags -+#include "rtl8814a_spec.h" -+#include "rtl8814a_rf.h" -+#include "rtl8814a_dm.h" -+#include "rtl8814a_recv.h" -+#include "rtl8814a_xmit.h" -+#include "rtl8814a_cmd.h" -+#include "rtl8814a_led.h" -+#include "Hal8814PwrSeq.h" -+#include "Hal8814PhyReg.h" -+#include "Hal8814PhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+#include "rtl8814a_sreset.h" -+#endif //DBG_CONFIG_ERROR_DETECT -+ -+ -+typedef enum _TX_PWR_PERCENTAGE{ -+ TX_PWR_PERCENTAGE_0 = 0x01, // 12.5% -+ TX_PWR_PERCENTAGE_1 = 0x02, // 25% -+ TX_PWR_PERCENTAGE_2 = 0x04, // 50% -+ TX_PWR_PERCENTAGE_3 = 0x08, //100%, default target output power. -+} TX_PWR_PERCENTAGE; -+ -+ -+enum{ -+ VOLTAGE_V25 = 0x03, -+ LDOE25_SHIFT = 28 , -+ }; -+#define FW_SIZE 0x10000 // Compatible with RTL8723 Maximal RAM code size 24K. modified to 32k, TO compatible with 92d maximal fw size 32k -+#define FW_START_ADDRESS 0x1000 -+typedef struct _RT_FIRMWARE_8814 { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8* szFwBuffer; -+#else -+ u8 szFwBuffer[FW_SIZE]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8814, *PRT_FIRMWARE_8814; -+ -+#define PAGE_SIZE_TX_8814 PAGE_SIZE_128 -+#define BCNQ_PAGE_NUM_8814 0x08 -+ -+//--------------------------------------------------------------------- -+// RTL8814AU From header -+//--------------------------------------------------------------------- -+ #define RTL8814A_FW_IMG "rtl8814a/FW_NIC.bin" -+ #define RTL8814A_FW_WW_IMG "rtl8814a/FW_WoWLAN.bin" -+ #define RTL8814A_PHY_REG "rtl8814a/PHY_REG.txt" -+ #define RTL8814A_PHY_RADIO_A "rtl8814a/RadioA.txt" -+ #define RTL8814A_PHY_RADIO_B "rtl8814a/RadioB.txt" -+ #define RTL8814A_PHY_RADIO_C "rtl8814a/RadioC.txt" -+ #define RTL8814A_PHY_RADIO_D "rtl8814a/RadioD.txt" -+ #define RTL8814A_TXPWR_TRACK "rtl8814a/TxPowerTrack.txt" -+ #define RTL8814A_AGC_TAB "rtl8814a/AGC_TAB.txt" -+ #define RTL8814A_PHY_MACREG "rtl8814a/MAC_REG.txt" -+ #define RTL8814A_PHY_REG_PG "rtl8814a/PHY_REG_PG.txt" -+ #define RTL8814A_PHY_REG_MP "rtl8814a/PHY_REG_MP.txt" -+ #define RTL8814A_TXPWR_LMT "rtl8814a/TXPWR_LMT.txt" -+ #define RTL8814A_WIFI_ANT_ISOLATION "rtl8814a/wifi_ant_isolation.txt" -+ -+#define Rtl8814A_NIC_PWR_ON_FLOW rtl8814A_power_on_flow -+#define Rtl8814A_NIC_RF_OFF_FLOW rtl8814A_radio_off_flow -+#define Rtl8814A_NIC_DISABLE_FLOW rtl8814A_card_disable_flow -+#define Rtl8814A_NIC_ENABLE_FLOW rtl8814A_card_enable_flow -+#define Rtl8814A_NIC_SUSPEND_FLOW rtl8814A_suspend_flow -+#define Rtl8814A_NIC_RESUME_FLOW rtl8814A_resume_flow -+#define Rtl8814A_NIC_PDN_FLOW rtl8814A_hwpdn_flow -+#define Rtl8814A_NIC_LPS_ENTER_FLOW rtl8814A_enter_lps_flow -+#define Rtl8814A_NIC_LPS_LEAVE_FLOW rtl8814A_leave_lps_flow -+ -+//===================================================== -+// New Firmware Header(8-byte alinment required) -+//===================================================== -+//--- LONG WORD 0 ---- -+#define GET_FIRMWARE_HDR_SIGNATURE_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 0, 16) -+#define GET_FIRMWARE_HDR_CATEGORY_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 16, 8) // AP/NIC and USB/PCI -+#define GET_FIRMWARE_HDR_FUNCTION_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 24, 8) // Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions -+#define GET_FIRMWARE_HDR_VERSION_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 0, 16)// FW Version -+#define GET_FIRMWARE_HDR_SUB_VER_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 16, 8) // FW Subversion, default 0x00 -+#define GET_FIRMWARE_HDR_SUB_IDX_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 24, 8) // FW Subversion Index -+ -+//--- LONG WORD 1 ---- -+#define GET_FIRMWARE_HDR_SVN_IDX_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 0, 32)// The SVN entry index -+#define GET_FIRMWARE_HDR_RSVD1_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 0, 32) -+ -+//--- LONG WORD 2 ---- -+#define GET_FIRMWARE_HDR_MONTH_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 0, 8) // Release time Month field -+#define GET_FIRMWARE_HDR_DATE_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 8, 8) // Release time Date field -+#define GET_FIRMWARE_HDR_HOUR_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 16, 8)// Release time Hour field -+#define GET_FIRMWARE_HDR_MINUTE_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 24, 8)// Release time Minute field -+#define GET_FIRMWARE_HDR_YEAR_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 0, 16)// Release time Year field -+#define GET_FIRMWARE_HDR_FOUNDRY_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 16, 8)// Release time Foundry field -+#define GET_FIRMWARE_HDR_RSVD2_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 24, 8) -+ -+//--- LONG WORD 3 ---- -+#define GET_FIRMWARE_HDR_MEM_UASGE_DL_FROM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 0, 1) -+#define GET_FIRMWARE_HDR_MEM_UASGE_BOOT_FROM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 1, 1) -+#define GET_FIRMWARE_HDR_MEM_UASGE_BOOT_LOADER_3081(__FwHdr)LE_BITS_TO_4BYTE(__FwHdr+24, 2, 1) -+#define GET_FIRMWARE_HDR_MEM_UASGE_IRAM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 3, 1) -+#define GET_FIRMWARE_HDR_MEM_UASGE_ERAM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 4, 1) -+#define GET_FIRMWARE_HDR_MEM_UASGE_RSVD4_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 5, 3) -+#define GET_FIRMWARE_HDR_RSVD3_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 8, 8) -+#define GET_FIRMWARE_HDR_BOOT_LOADER_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 16, 16) -+#define GET_FIRMWARE_HDR_RSVD5_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+28, 0, 32) -+ -+//--- LONG WORD 4 ---- -+#define GET_FIRMWARE_HDR_TOTAL_DMEM_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+36, 0, 32) -+#define GET_FIRMWARE_HDR_FW_CFG_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+36, 0, 16) -+#define GET_FIRMWARE_HDR_FW_ATTR_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+36, 16, 16) -+ -+//--- LONG WORD 5 ---- -+#define GET_FIRMWARE_HDR_IROM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+40, 0, 32) -+#define GET_FIRMWARE_HDR_EROM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+44, 0, 32) -+ -+//--- LONG WORD 6 ---- -+#define GET_FIRMWARE_HDR_IRAM_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+48, 0, 32) -+#define GET_FIRMWARE_HDR_ERAM_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+52, 0, 32) -+ -+//--- LONG WORD 7 ---- -+#define GET_FIRMWARE_HDR_RSVD6_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+56, 0, 32) -+#define GET_FIRMWARE_HDR_RSVD7_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+60, 0, 32) -+ -+ -+ -+// -+// 2013/08/16 MH MOve from SDIO.h for common use. -+// -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) -+#define TRX_SHARE_MODE_8814A 0 //TRX Buffer Share Index -+#define BASIC_RXFF_SIZE_8814A 24576//Basic RXFF Size is 24K = 24*1024 Unit: Byte -+#define TRX_SHARE_BUFF_UNIT_8814A 65536//TRX Share Buffer unit Size 64K = 64*1024 Unit: Byte -+#define TRX_SHARE_BUFF_UNIT_PAGE_8814A TRX_SHARE_BUFF_UNIT_8814A/PAGE_SIZE_8814A//512 Pages -+ -+//Origin: -+#define HPQ_PGNUM_8814A 0x20 //High Queue -+#define LPQ_PGNUM_8814A 0x20 //Low Queue -+#define NPQ_PGNUM_8814A 0x20 //Normal Queue -+#define EPQ_PGNUM_8814A 0x20 //Extra Queue -+ -+#else // #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) -+ -+#define HPQ_PGNUM_8814A 20 -+#define NPQ_PGNUM_8814A 20 -+#define LPQ_PGNUM_8814A 20 //1972 -+#define EPQ_PGNUM_8814A 20 -+#define BCQ_PGNUM_8814A 32 -+ -+#endif //#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) -+ -+#ifdef CONFIG_WOWLAN -+#define WOWLAN_PAGE_NUM_8814 0x00 -+#else -+#define WOWLAN_PAGE_NUM_8814 0x00 -+#endif -+ -+#define PAGE_SIZE_8814A 128//TXFF Page Size, Unit: Byte -+#define MAX_RX_DMA_BUFFER_SIZE_8814A 0x5C00 //BASIC_RXFF_SIZE_8814A+TRX_SHARE_MODE_8814A*TRX_SHARE_BUFF_UNIT_8814A //Basic RXFF Size + ShareBuffer Size -+#define TX_PAGE_BOUNDARY_8814A TXPKT_PGNUM_8814A // Need to enlarge boundary, by KaiYuan -+#define TX_PAGE_BOUNDARY_WOWLAN_8814A TXPKT_PGNUM_8814A //TODO: 20130415 KaiYuan Check this value later -+ -+ -+#define TOTAL_PGNUM_8814A 2048 -+#define TXPKT_PGNUM_8814A (2048 - BCNQ_PAGE_NUM_8814-WOWLAN_PAGE_NUM_8814) -+#define PUB_PGNUM_8814A (TXPKT_PGNUM_8814A-HPQ_PGNUM_8814A-NPQ_PGNUM_8814A-LPQ_PGNUM_8814A-EPQ_PGNUM_8814A) -+ -+//Note: For WMM Normal Chip Setting ,modify later -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8814A TX_PAGE_BOUNDARY_8814A -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8814A (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8814A + 1) -+ -+#define DRIVER_EARLY_INT_TIME_8814 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8814 0x02 -+ -+ -+#define MAX_PAGE_SIZE 4096 // @ page : 4k bytes -+ -+#define EFUSE_MAX_SECTION_JAGUAR 64 -+ -+#define HWSET_MAX_SIZE_8814A 512 -+ -+#define EFUSE_REAL_CONTENT_LEN_8814A 1024 -+#define EFUSE_MAX_BANK_8814A 2 -+ -+#define EFUSE_MAP_LEN_8814A 512 -+#define EFUSE_MAX_SECTION_8814A 64 -+#define EFUSE_MAX_WORD_UNIT_8814A 4 -+#define EFUSE_PROTECT_BYTES_BANK_8814A 16 -+ -+#define EFUSE_IC_ID_OFFSET_8814A 506 //For some inferiority IC purpose. added by Roger, 2009.09.02. -+#define AVAILABLE_EFUSE_ADDR_8814A(addr) (addr < EFUSE_REAL_CONTENT_LEN_8814A) -+ -+/*------------------------------------------------------------------------- -+Chip specific -+-------------------------------------------------------------------------*/ -+ -+/* pic buffer descriptor */ -+#if 1 /* according to the define in the rtw_xmit.h, rtw_recv.h */ -+#define RTL8814AE_SEG_NUM TX_BUFFER_SEG_NUM /* 0:2 seg, 1: 4 seg, 2: 8 seg */ -+#define TX_DESC_NUM_8814A TXDESC_NUM /* 128 */ -+#define RX_DESC_NUM_8814A PCI_MAX_RX_COUNT /* 128 */ -+#ifdef CONFIG_CONCURRENT_MODE -+#define BE_QUEUE_TX_DESC_NUM_8814A (TXDESC_NUM<<1) /* 256 */ -+#else -+#define BE_QUEUE_TX_DESC_NUM_8814A (TXDESC_NUM+(TXDESC_NUM>>1)) /* 192 */ -+#endif -+#else -+#define RTL8814AE_SEG_NUM TX_BUFFER_SEG_NUM /* 0:2 seg, 1: 4 seg, 2: 8 seg */ -+#define TX_DESC_NUM_8814A 128 /* 1024//2048 change by ylb 20130624 */ -+#define RX_DESC_NUM_8814A 128 /* 1024 //512 change by ylb 20130624 */ -+#endif -+ -+// To prevent out of boundary programming case, leave 1byte and program full section -+// 9bytes + 1byt + 5bytes and pre 1byte. -+// For worst case: -+// | 1byte|----8bytes----|1byte|--5bytes--| -+// | | Reserved(14bytes) | -+// -+#define EFUSE_OOB_PROTECT_BYTES 15 // PG data exclude header, dummy 6 bytes frome CP test and reserved 1byte. -+ -+/* rtl8814_hal_init.c */ -+s32 FirmwareDownload8814A( PADAPTER Adapter, BOOLEAN bUsedWoWLANFw); -+void InitializeFirmwareVars8814(PADAPTER padapter); -+ -+VOID -+Hal_InitEfuseVars_8814A( -+ IN PADAPTER Adapter -+ ); -+ -+s32 InitLLTTable8814A( -+ IN PADAPTER Adapter -+ ); -+ -+ -+void InitRDGSetting8814A(PADAPTER padapter); -+ -+//void CheckAutoloadState8812A(PADAPTER padapter); -+ -+// EFuse -+u8 GetEEPROMSize8814A(PADAPTER padapter); -+void InitPGData8814A(PADAPTER padapter); -+ -+void hal_ReadPROMVersion8814A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void hal_ReadTxPowerInfo8814A(PADAPTER padapter, u8* hwinfo,BOOLEAN AutoLoadFail); -+void hal_ReadBoardType8814A(PADAPTER pAdapter, u8* hwinfo,BOOLEAN AutoLoadFail); -+void hal_ReadThermalMeter_8814A(PADAPTER Adapter, u8* PROMContent,BOOLEAN AutoloadFail); -+void hal_ReadChannelPlan8814A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void hal_EfuseParseXtal_8814A(PADAPTER pAdapter, u8* hwinfo,BOOLEAN AutoLoadFail); -+void hal_ReadAntennaDiversity8814A(PADAPTER pAdapter,u8* PROMContent,BOOLEAN AutoLoadFail); -+void hal_Read_TRX_antenna_8814A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+VOID hal_ReadAmplifierType_8814A( -+ IN PADAPTER Adapter -+ ); -+VOID hal_ReadPAType_8814A( -+ IN PADAPTER Adapter, -+ IN u8* PROMContent, -+ IN BOOLEAN AutoloadFail, -+ OUT u8* pPAType, -+ OUT u8* pLNAType -+ ); -+void Hal_EfuseParseKFreeData_8814A( -+ IN PADAPTER Adapter, -+ IN u8 *PROMContent, -+ IN BOOLEAN AutoloadFail); -+void hal_ReadRFEType_8814A(PADAPTER Adapter,u8* PROMContent, BOOLEAN AutoloadFail); -+void hal_EfuseParseBTCoexistInfo8814A(PADAPTER Adapter, u8* hwinfo, BOOLEAN AutoLoadFail); -+ -+//void hal_ReadUsbType_8812AU(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+//int FirmwareDownloadBT(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); -+void hal_ReadRemoteWakeup_8814A(PADAPTER padapter, u8* hwinfo, BOOLEAN AutoLoadFail); -+u8 MgntQuery_NssTxRate(u16 Rate); -+ -+//BOOLEAN HalDetectPwrDownMode8812(PADAPTER Adapter); -+ -+#ifdef CONFIG_WOWLAN -+void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif //CONFIG_WOWLAN -+ -+void _InitBeaconParameters_8814A(PADAPTER padapter); -+void SetBeaconRelatedRegisters8814A(PADAPTER padapter); -+ -+void ReadRFType8814A(PADAPTER padapter); -+void InitDefaultValue8814A(PADAPTER padapter); -+ -+void SetHwReg8814A(PADAPTER padapter, u8 variable, u8 *pval); -+void GetHwReg8814A(PADAPTER padapter, u8 variable, u8 *pval); -+u8 SetHalDefVar8814A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8814A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+s32 c2h_id_filter_ccx_8814a(u8 *buf); -+void rtl8814_set_hal_ops(struct hal_ops *pHalFunc); -+ -+// register -+void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); -+void SetBcnCtrlReg(PADAPTER Adapter, u8 SetBits, u8 ClearBits); -+void rtl8814_start_thread(PADAPTER padapter); -+void rtl8814_stop_thread(PADAPTER padapter); -+ -+ -+#ifdef CONFIG_PCI_HCI -+BOOLEAN InterruptRecognized8814AE(PADAPTER Adapter); -+VOID UpdateInterruptMask8814AE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+u16 get_txbd_idx_addr(u16 ff_hwaddr); -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+void rtl8812a_combo_card_WifiOnlyHwInit(PADAPTER Adapter); -+#endif -+ -+#endif //__RTL8188E_HAL_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8814a_led.h linux/3rdparty/rtl8812au/include/rtl8814a_led.h ---- linux.old/3rdparty/rtl8812au/include/rtl8814a_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8814a_led.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8814A_LED_H__ -+#define __RTL8814A_LED_H__ -+ -+ -+//================================================================================ -+// Interface to manipulate LED objects. -+//================================================================================ -+#ifdef CONFIG_USB_HCI -+void rtl8814au_InitSwLeds(PADAPTER padapter); -+void rtl8814au_DeInitSwLeds(PADAPTER padapter); -+#endif //CONFIG_USB_HCI -+#ifdef CONFIG_PCI_HCI -+void rtl8814ae_InitSwLeds(PADAPTER padapter); -+void rtl8814ae_DeInitSwLeds(PADAPTER padapter); -+#endif //CONFIG_PCI_HCI -+#ifdef CONFIG_SDIO_HCI -+void rtl8814s_InitSwLeds(PADAPTER padapter); -+void rtl8814s_DeInitSwLeds(PADAPTER padapter); -+#endif //CONFIG_SDIO_HCI -+ -+#endif //__RTL8814A_LED_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8814a_recv.h linux/3rdparty/rtl8812au/include/rtl8814a_recv.h ---- linux.old/3rdparty/rtl8812au/include/rtl8814a_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8814a_recv.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,188 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8814A_RECV_H__ -+#define __RTL8814A_RECV_H__ -+ -+#if defined(CONFIG_USB_HCI) -+ -+#ifndef MAX_RECVBUF_SZ -+#ifdef PLATFORM_OS_CE -+#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+#else -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ #ifdef CONFIG_PLATFORM_MSTAR -+ #define MAX_RECVBUF_SZ (8192) // 8K -+ #else -+ #define MAX_RECVBUF_SZ (32768) // 32k -+ #endif -+ //#define MAX_RECVBUF_SZ (24576) // 24k -+ //#define MAX_RECVBUF_SZ (20480) //20K -+ //#define MAX_RECVBUF_SZ (10240) //10K -+ //#define MAX_RECVBUF_SZ (15360) // 15k < 16k -+ //#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+ #else -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+ #endif -+#endif -+#endif //!MAX_RECVBUF_SZ -+ -+#elif defined(CONFIG_PCI_HCI) -+//#ifndef CONFIG_MINIMAL_MEMORY_USAGE -+// #define MAX_RECVBUF_SZ (9100) -+//#else -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+//#endif -+ -+ -+#elif defined(CONFIG_SDIO_HCI) -+/* temp solution -+#ifdef CONFIG_SDIO_RX_COPY -+#define MAX_RECVBUF_SZ (10240) -+#else // !CONFIG_SDIO_RX_COPY -+#define MAX_RECVBUF_SZ MAX_RX_DMA_BUFFER_SIZE_8821 -+#endif // !CONFIG_SDIO_RX_COPY -+*/ -+#endif -+ -+ -+/* RX buffer descriptor */ -+/* DWORD 0 */ -+#define SET_RX_BUFFER_DESC_DATA_LENGTH_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_BUFFER_DESC_LS_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 14, 1, __Value) -+#define SET_RX_BUFFER_DESC_FS_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 15, 1, __Value) -+#define SET_RX_BUFFER_DESC_TOTAL_LENGTH_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 16, __Value) -+ -+#define GET_RX_BUFFER_DESC_OWN_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+#define GET_RX_BUFFER_DESC_LS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) -+#define GET_RX_BUFFER_DESC_FS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_BUFFER_DESC_TOTAL_LENGTH_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 15) -+ -+/* DWORD 1 */ -+#define SET_RX_BUFFER_PHYSICAL_LOW_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+4, 0, 32, __Value) -+#define GET_RX_BUFFER_PHYSICAL_LOW_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 0, 32) -+ -+/* DWORD 2 */ -+#define SET_RX_BUFFER_PHYSICAL_HIGH_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+8, 0, 32, __Value) -+ -+/* DWORD 3*/ /* RESERVED */ -+ -+ -+/*============= -+//RX Info -+==============*/ -+//DWORD 0 -+#define SET_RX_STATUS_DESC_PKT_LEN_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_8814AE(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 31, 1, __Value) -+ -+#define GET_RX_STATUS_DESC_PKT_LEN_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICV_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_LAST_SEG_8814AE(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 28, 1) -+#define GET_RX_STATUS_DESC_EOR_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 30, 1) -+ -+//DWORD 1 -+#define GET_RX_STATUS_DESC_MACID_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_EXT_SECTYPE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 7, 1)/* 20130415 KaiYuan add for 8814 */ -+#define GET_RX_STATUS_DESC_TID_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_MACID_VLD_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 12, 1) -+#define GET_RX_STATUS_DESC_AMSDU_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_CHKERR_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_IPVER_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_IS_TCPUDP_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_CHK_VLD_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_FIRST_SEG_8814AE(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 29, 1) -+#define GET_RX_STATUS_DESC_EOR_8814AE(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_MC_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+4, 31, 1) -+ -+//DWORD 2 -+#define GET_RX_STATUS_DESC_SEQ_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 12, 4) -+#ifdef CONFIG_USB_RX_AGGREGATION -+#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 16, 8) -+#else -+#define GET_RX_STATUS_DESC_RX_IS_QOS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 16, 1) -+#endif -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_HWRSVD_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 24, 4) -+#define GET_RX_STATUS_C2H_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 28, 1) -+#define GET_RX_STATUS_DESC_FCS_OK_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 31, 1) -+ -+//DWORD 3 -+#define GET_RX_STATUS_DESC_RX_RATE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_BSSID_FIT_H_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 7, 3)//20130415 KaiYuan add for 8814 -+#define GET_RX_STATUS_DESC_HTC_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_L_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 12, 2) -+#define GET_RX_STATUS_DESC_DMA_AGG_NUM_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 16, 8)//20130415 KaiYuan Check if it exist anymore -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_WAKE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 31, 1) -+ -+//DWORD 4 -+#define GET_RX_STATUS_DESC_PATTERN_IDX_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+16, 0, 8) -+#define GET_RX_STATUS_DESC_RX_EOF_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+16, 8, 1) -+#define GET_RX_STATUS_DESC_RX_SCRAMBLER_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+16, 9, 7) -+#define GET_RX_STATUS_DESC_RX_PRE_NDP_VLD_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+16, 16, 1) -+#define GET_RX_STATUS_DESC_A1_FIT_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+16, 24, 5) -+ -+ -+//DWORD 5 -+#define GET_RX_STATUS_DESC_TSFL_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+20, 0, 32) -+ -+ -+// Rx smooth factor -+#define Rx_Smooth_Factor (20) -+ -+#ifdef CONFIG_USB_HCI -+s32 rtl8814au_init_recv_priv(PADAPTER padapter); -+void rtl8814au_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8814ae_init_recv_priv(PADAPTER padapter); -+void rtl8814ae_free_recv_priv(PADAPTER padapter); -+#endif -+ -+/* temp solution -+#ifdef CONFIG_SDIO_HCI -+s32 InitRecvPriv8821AS(PADAPTER padapter); -+void FreeRecvPriv8821AS(PADAPTER padapter); -+#endif // CONFIG_SDIO_HCI -+*/ -+ -+void rtl8814_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8814A_RECV_H__ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8814a_rf.h linux/3rdparty/rtl8812au/include/rtl8814a_rf.h ---- linux.old/3rdparty/rtl8812au/include/rtl8814a_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8814a_rf.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,34 @@ ++void _dbg_dump_tx_info(_adapter *padapter,int frame_tag,u8 *ptxdesc); ++ ++u8 BWMapping_8812(PADAPTER Adapter, struct pkt_attrib *pattrib); ++ ++u8 SCMapping_8812(PADAPTER Adapter, struct pkt_attrib *pattrib); ++ ++#endif //__RTL8812_XMIT_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8821a_xmit.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8821a_xmit.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtl8821a_xmit.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8821a_xmit.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,139 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2013 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ ++#ifndef __RTL8821A_XMIT_H__ ++#define __RTL8821A_XMIT_H__ ++ ++#include ++ ++typedef struct txdescriptor_8821a ++{ ++ // Offset 0 ++ u32 pktlen:16; ++ u32 offset:8; ++ u32 bmc:1; ++ u32 htc:1; ++ u32 rsvd0026:1; ++ u32 rsvd0027:1; ++ u32 linip:1; ++ u32 noacm:1; ++ u32 gf:1; ++ u32 rsvd0031:1; ++ ++ // Offset 4 ++ u32 macid:7; ++ u32 rsvd0407:1; ++ u32 qsel:5; ++ u32 rdg_nav_ext:1; ++ u32 lsig_txop_en:1; ++ u32 pifs:1; ++ u32 rate_id:5; ++ u32 en_desc_id:1; ++ u32 sectype:2; ++ u32 pkt_offset:5; // unit: 8 bytes ++ u32 moredata:1; ++ u32 txop_ps_cap:1; ++ u32 txop_ps_mode:1; ++ ++ // Offset 8 ++ u32 p_aid:9; ++ u32 rsvd0809:1; ++ u32 cca_rts:2; ++ u32 agg_en:1; ++ u32 rdg_en:1; ++ u32 null_0:1; ++ u32 null_1:1; ++ u32 bk:1; ++ u32 morefrag:1; ++ u32 raw:1; ++ u32 spe_rpt:1; ++ u32 ampdu_density:3; ++ u32 bt_null:1; ++ u32 g_id:6; ++ u32 rsvd0830:2; ++ ++ // Offset 12 ++ u32 wheader_len:4; ++ u32 chk_en:1; ++ u32 early_rate:1; ++ u32 hw_ssn_sel:2; ++ u32 userate:1; ++ u32 disrtsfb:1; ++ u32 disdatafb:1; ++ u32 cts2self:1; ++ u32 rtsen:1; ++ u32 hw_rts_en:1; ++ u32 port_id:1; ++ u32 navusehdr:1; ++ u32 use_max_len:1; ++ u32 max_agg_num:5; ++ u32 ndpa:2; ++ u32 ampdu_max_time:8; ++ ++ // Offset 16 ++ u32 datarate:7; ++ u32 try_rate:1; ++ u32 data_ratefb_lmt:5; ++ u32 rts_ratefb_lmt:4; ++ u32 rty_lmt_en:1; ++ u32 data_rt_lmt:6; ++ u32 rtsrate:5; ++ u32 pcts_en:1; ++ u32 pcts_mask_idx:2; ++ ++ // Offset 20 ++ u32 data_sc:4; ++ u32 data_short:1; ++ u32 data_bw:2; ++ u32 data_ldpc:1; ++ u32 data_stbc:2; ++ u32 vcs_stbc:2; ++ u32 rts_short:1; ++ u32 rts_sc:4; ++ u32 rsvd2016:7; ++ u32 tx_ant:4; ++ u32 txpwr_offset:3; ++ u32 rsvd2031:1; ++ ++ // Offset 24 ++ u32 sw_define:12; ++ u32 mbssid:4; ++ u32 antsel_A:3; ++ u32 antsel_B:3; ++ u32 antsel_C:3; ++ u32 antsel_D:3; ++ u32 rsvd2428:4; ++ ++ // Offset 28 ++ u32 checksum:16; ++ u32 rsvd2816:8; ++ u32 usb_txagg_num:8; ++ ++ // Offset 32 ++ u32 rts_rc:6; ++ u32 bar_rty_th:2; ++ u32 data_rc:6; ++ u32 rsvd3214:1; ++ u32 en_hwseq:1; ++ u32 nextneadpage:8; ++ u32 tailpage:8; ++ ++ // Offset 36 ++ u32 padding_len:11; ++ u32 txbf_path:1; ++ u32 seq:12; ++ u32 final_data_rate:8; ++}TXDESC_8821A, *PTXDESC_8821A; ++ ++#endif //__RTL8821_XMIT_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_android.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_android.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_android.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_android.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,81 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -322834,1363 +142704,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8814a_rf.h linux/3rdparty/rtl + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ -+#ifndef __RTL8814A_RF_H__ -+#define __RTL8814A_RF_H__ + -+VOID -+PHY_RF6052SetBandwidth8814A( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); -+ -+ -+int -+PHY_RF6052_Config_8814A( -+ IN PADAPTER Adapter ); -+ -+#endif//__RTL8188E_RF_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8814a_spec.h linux/3rdparty/rtl8812au/include/rtl8814a_spec.h ---- linux.old/3rdparty/rtl8812au/include/rtl8814a_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8814a_spec.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,639 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8814A_SPEC_H__ -+#define __RTL8814A_SPEC_H__ -+ -+#include -+ -+ -+//============================================================ -+// -+//============================================================ -+ -+//----------------------------------------------------- -+// -+// 0x0000h ~ 0x00FFh System Configuration -+// -+//----------------------------------------------------- -+#define REG_SYS_ISO_CTRL_8814A 0x0000 // 2 Byte -+#define REG_SYS_FUNC_EN_8814A 0x0002 // 2 Byte -+#define REG_SYS_PW_CTRL_8814A 0x0004 // 4 Byte -+#define REG_SYS_CLKR_8814A 0x0008 // 2 Byte -+#define REG_SYS_EEPROM_CTRL_8814A 0x000A // 2 Byte -+#define REG_EE_VPD_8814A 0x000C // 2 Byte -+#define REG_SYS_SWR_CTRL1_8814A 0x0010 // 1 Byte -+#define REG_SPS0_CTRL_8814A 0x0011 // 7 Byte -+#define REG_SYS_SWR_CTRL3_8814A 0x0018 // 4 Byte -+#define REG_RSV_CTRL_8814A 0x001C // 3 Byte -+#define REG_RF_CTRL0_8814A 0x001F // 1 Byte -+#define REG_RF_CTRL1_8814A 0x0020 // 1 Byte -+#define REG_RF_CTRL2_8814A 0x0021 // 1 Byte -+#define REG_LPLDO_CTRL_8814A 0x0023 // 1 Byte -+#define REG_AFE_CTRL1_8814A 0x0024 // 4 Byte -+#define REG_AFE_CTRL2_8814A 0x0028 // 4 Byte -+#define REG_AFE_CTRL3_8814A 0x002c // 4 Byte -+#define REG_EFUSE_CTRL_8814A 0x0030 -+#define REG_LDO_EFUSE_CTRL_8814A 0x0034 -+#define REG_PWR_DATA_8814A 0x0038 -+#define REG_CAL_TIMER_8814A 0x003C -+#define REG_ACLK_MON_8814A 0x003E -+#define REG_GPIO_MUXCFG_8814A 0x0040 -+#define REG_GPIO_IO_SEL_8814A 0x0042 -+#define REG_MAC_PINMUX_CFG_8814A 0x0043 -+#define REG_GPIO_PIN_CTRL_8814A 0x0044 -+#define REG_GPIO_INTM_8814A 0x0048 -+#define REG_LEDCFG0_8814A 0x004C -+#define REG_LEDCFG1_8814A 0x004D -+#define REG_LEDCFG2_8814A 0x004E -+#define REG_LEDCFG3_8814A 0x004F -+#define REG_FSIMR_8814A 0x0050 -+#define REG_FSISR_8814A 0x0054 -+#define REG_HSIMR_8814A 0x0058 -+#define REG_HSISR_8814A 0x005c -+#define REG_GPIO_EXT_CTRL_8814A 0x0060 -+#define REG_GPIO_STATUS_8814A 0x006C -+#define REG_SDIO_CTRL_8814A 0x0070 -+#define REG_HCI_OPT_CTRL_8814A 0x0074 -+#define REG_RF_CTRL3_8814A 0x0076 // 1 Byte -+#define REG_AFE_CTRL4_8814A 0x0078 -+#define REG_8051FW_CTRL_8814A 0x0080 -+#define REG_HIMR0_8814A 0x00B0 -+#define REG_HISR0_8814A 0x00B4 -+#define REG_HIMR1_8814A 0x00B8 -+#define REG_HISR1_8814A 0x00BC -+#define REG_SYS_CFG1_8814A 0x00F0 -+#define REG_SYS_CFG2_8814A 0x00FC -+ -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+#define REG_CR_8814A 0x0100 -+#define REG_PBP_8814A 0x0104 -+#define REG_PKT_BUFF_ACCESS_CTRL_8814A 0x0106 -+#define REG_TRXDMA_CTRL_8814A 0x010C -+#define REG_TRXFF_BNDY_8814A 0x0114 -+#define REG_TRXFF_STATUS_8814A 0x0118 -+#define REG_RXFF_PTR_8814A 0x011C -+#define REG_CPWM_8814A 0x012F -+#define REG_FWIMR_8814A 0x0130 -+#define REG_FWISR_8814A 0x0134 -+#define REG_FTIMR_8814A 0x0138 -+#define REG_PKTBUF_DBG_CTRL_8814A 0x0140 -+#define REG_RXPKTBUF_CTRL_8814A 0x0142 -+#define REG_PKTBUF_DBG_DATA_L_8814A 0x0144 -+#define REG_PKTBUF_DBG_DATA_H_8814A 0x0148 -+ -+#define REG_TC0_CTRL_8814A 0x0150 -+#define REG_TC1_CTRL_8814A 0x0154 -+#define REG_TC2_CTRL_8814A 0x0158 -+#define REG_TC3_CTRL_8814A 0x015C -+#define REG_TC4_CTRL_8814A 0x0160 -+#define REG_TCUNIT_BASE_8814A 0x0164 -+#define REG_RSVD3_8814A 0x0168 -+#define REG_C2HEVT_MSG_NORMAL_8814A 0x01A0 -+#define REG_C2HEVT_CLEAR_8814A 0x01AF -+#define REG_MCUTST_1_8814A 0x01C0 -+#define REG_MCUTST_WOWLAN_8814A 0x01C7 -+#define REG_FMETHR_8814A 0x01C8 -+#define REG_HMETFR_8814A 0x01CC -+#define REG_HMEBOX_0_8814A 0x01D0 -+#define REG_HMEBOX_1_8814A 0x01D4 -+#define REG_HMEBOX_2_8814A 0x01D8 -+#define REG_HMEBOX_3_8814A 0x01DC -+#define REG_LLT_INIT_8814A 0x01E0 -+#define REG_LLT_ADDR_8814A 0x01E4 //20130415 KaiYuan add for 8814 -+#define REG_HMEBOX_EXT0_8814A 0x01F0 -+#define REG_HMEBOX_EXT1_8814A 0x01F4 -+#define REG_HMEBOX_EXT2_8814A 0x01F8 -+#define REG_HMEBOX_EXT3_8814A 0x01FC -+ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_FIFOPAGE_CTRL_1_8814A 0x0200 -+#define REG_FIFOPAGE_CTRL_2_8814A 0x0204 -+#define REG_AUTO_LLT_8814A 0x0208 -+#define REG_TXDMA_OFFSET_CHK_8814A 0x020C -+#define REG_TXDMA_STATUS_8814A 0x0210 -+#define REG_RQPN_NPQ_8814A 0x0214 -+#define REG_TQPNT1_8814A 0x0218 -+#define REG_TQPNT2_8814A 0x021C -+#define REG_TQPNT3_8814A 0x0220 -+#define REG_TQPNT4_8814A 0x0224 -+#define REG_RQPN_CTRL_1_8814A 0x0228 -+#define REG_RQPN_CTRL_2_8814A 0x022C -+#define REG_FIFOPAGE_INFO_1_8814A 0x0230 -+#define REG_FIFOPAGE_INFO_2_8814A 0x0234 -+#define REG_FIFOPAGE_INFO_3_8814A 0x0238 -+#define REG_FIFOPAGE_INFO_4_8814A 0x023C -+#define REG_FIFOPAGE_INFO_5_8814A 0x0240 -+ -+ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x02FFh RXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_RXDMA_AGG_PG_TH_8814A 0x0280 -+#define REG_RXPKT_NUM_8814A 0x0284 // The number of packets in RXPKTBUF. -+#define REG_RXDMA_CONTROL_8814A 0x0286 // ?????? Control the RX DMA. -+#define REG_RXDMA_STATUS_8814A 0x0288 -+#define REG_RXDMA_MODE_8814A 0x0290 // ?????? -+#define REG_EARLY_MODE_CONTROL_8814A 0x02BC // ?????? -+#define REG_RSVD5_8814A 0x02F0 // ?????? -+ -+ -+//----------------------------------------------------- -+// -+// 0x0300h ~ 0x03FFh PCIe -+// -+//----------------------------------------------------- -+#define REG_PCIE_CTRL_REG_8814A 0x0300 -+#define REG_INT_MIG_8814A 0x0304 // Interrupt Migration -+#define REG_BCNQ_TXBD_DESA_8814A 0x0308 // TX Beacon Descriptor Address -+#define REG_MGQ_TXBD_DESA_8814A 0x0310 // TX Manage Queue Descriptor Address -+#define REG_VOQ_TXBD_DESA_8814A 0x0318 // TX VO Queue Descriptor Address -+#define REG_VIQ_TXBD_DESA_8814A 0x0320 // TX VI Queue Descriptor Address -+#define REG_BEQ_TXBD_DESA_8814A 0x0328 // TX BE Queue Descriptor Address -+#define REG_BKQ_TXBD_DESA_8814A 0x0330 // TX BK Queue Descriptor Address -+#define REG_RXQ_RXBD_DESA_8814A 0x0338 // RX Queue Descriptor Address -+#define REG_HI0Q_TXBD_DESA_8814A 0x0340 -+#define REG_HI1Q_TXBD_DESA_8814A 0x0348 -+#define REG_HI2Q_TXBD_DESA_8814A 0x0350 -+#define REG_HI3Q_TXBD_DESA_8814A 0x0358 -+#define REG_HI4Q_TXBD_DESA_8814A 0x0360 -+#define REG_HI5Q_TXBD_DESA_8814A 0x0368 -+#define REG_HI6Q_TXBD_DESA_8814A 0x0370 -+#define REG_HI7Q_TXBD_DESA_8814A 0x0378 -+#define REG_MGQ_TXBD_NUM_8814A 0x0380 -+#define REG_RX_RXBD_NUM_8814A 0x0382 -+#define REG_VOQ_TXBD_NUM_8814A 0x0384 -+#define REG_VIQ_TXBD_NUM_8814A 0x0386 -+#define REG_BEQ_TXBD_NUM_8814A 0x0388 -+#define REG_BKQ_TXBD_NUM_8814A 0x038A -+#define REG_HI0Q_TXBD_NUM_8814A 0x038C -+#define REG_HI1Q_TXBD_NUM_8814A 0x038E -+#define REG_HI2Q_TXBD_NUM_8814A 0x0390 -+#define REG_HI3Q_TXBD_NUM_8814A 0x0392 -+#define REG_HI4Q_TXBD_NUM_8814A 0x0394 -+#define REG_HI5Q_TXBD_NUM_8814A 0x0396 -+#define REG_HI6Q_TXBD_NUM_8814A 0x0398 -+#define REG_HI7Q_TXBD_NUM_8814A 0x039A -+#define REG_TSFTIMER_HCI_8814A 0x039C -+ -+//Read Write Point -+#define REG_VOQ_TXBD_IDX_8814A 0x03A0 -+#define REG_VIQ_TXBD_IDX_8814A 0x03A4 -+#define REG_BEQ_TXBD_IDX_8814A 0x03A8 -+#define REG_BKQ_TXBD_IDX_8814A 0x03AC -+#define REG_MGQ_TXBD_IDX_8814A 0x03B0 -+#define REG_RXQ_TXBD_IDX_8814A 0x03B4 -+#define REG_HI0Q_TXBD_IDX_8814A 0x03B8 -+#define REG_HI1Q_TXBD_IDX_8814A 0x03BC -+#define REG_HI2Q_TXBD_IDX_8814A 0x03C0 -+#define REG_HI3Q_TXBD_IDX_8814A 0x03C4 -+#define REG_HI4Q_TXBD_IDX_8814A 0x03C8 -+#define REG_HI5Q_TXBD_IDX_8814A 0x03CC -+#define REG_HI6Q_TXBD_IDX_8814A 0x03D0 -+#define REG_HI7Q_TXBD_IDX_8814A 0x03D4 -+#define REG_DBG_SEL_V1_8814A 0x03D8 -+#define REG_PCIE_HRPWM1_V1_8814A 0x03D9 -+#define REG_PCIE_HCPWM1_V1_8814A 0x03DA -+#define REG_PCIE_CTRL2_8814A 0x03DB -+#define REG_PCIE_HRPWM2_V1_8814A 0x03DC -+#define REG_PCIE_HCPWM2_V1_8814A 0x03DE -+#define REG_PCIE_H2C_MSG_V1_8814A 0x03E0 -+#define REG_PCIE_C2H_MSG_V1_8814A 0x03E4 -+#define REG_DBI_WDATA_V1_8814A 0x03E8 -+#define REG_DBI_RDATA_V1_8814A 0x03EC -+#define REG_DBI_FLAG_V1_8814A 0x03F0 -+#define REG_MDIO_V1_8814A 0x03F4 -+#define REG_PCIE_MIX_CFG_8814A 0x03F8 -+#define REG_DBG_8814A 0x03FC -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+#define REG_VOQ_INFORMATION_8814A 0x0400 -+#define REG_VIQ_INFORMATION_8814A 0x0404 -+#define REG_BEQ_INFORMATION_8814A 0x0408 -+#define REG_BKQ_INFORMATION_8814A 0x040C -+#define REG_MGQ_INFORMATION_8814A 0x0410 -+#define REG_HGQ_INFORMATION_8814A 0x0414 -+#define REG_BCNQ_INFORMATION_8814A 0x0418 -+#define REG_TXPKT_EMPTY_8814A 0x041A -+#define REG_CPU_MGQ_INFORMATION_8814A 0x041C -+#define REG_FWHW_TXQ_CTRL_8814A 0x0420 -+#define REG_HWSEQ_CTRL_8814A 0x0423 -+#define REG_TXPKTBUF_BCNQ_BDNY_8814A 0x0424 -+//#define REG_MGQ_BDNY_8814A 0x0425 -+#define REG_LIFETIME_EN_8814A 0x0426 -+//#define REG_FW_FREE_TAIL_8814A 0x0427 -+#define REG_SPEC_SIFS_8814A 0x0428 -+#define REG_RETRY_LIMIT_8814A 0x042A -+#define REG_TXBF_CTRL_8814A 0x042C -+#define REG_DARFRC_8814A 0x0430 -+#define REG_RARFRC_8814A 0x0438 -+#define REG_RRSR_8814A 0x0440 -+#define REG_ARFR0_8814A 0x0444 -+#define REG_ARFR1_8814A 0x044C -+#define REG_CCK_CHECK_8814A 0x0454 -+#define REG_AMPDU_MAX_TIME_8814A 0x0455 -+#define REG_TXPKTBUF_BCNQ1_BDNY_8814A 0x0456 -+#define REG_AMPDU_MAX_LENGTH_8814A 0x0458 -+#define REG_ACQ_STOP_8814A 0x045C -+#define REG_NDPA_RATE_8814A 0x045D -+#define REG_TX_HANG_CTRL_8814A 0x045E -+#define REG_NDPA_OPT_CTRL_8814A 0x045F -+#define REG_FAST_EDCA_CTRL_8814A 0x0460 -+#define REG_RD_RESP_PKT_TH_8814A 0x0463 -+#define REG_CMDQ_INFO_8814A 0x0464 -+#define REG_Q4_INFO_8814A 0x0468 -+#define REG_Q5_INFO_8814A 0x046C -+#define REG_Q6_INFO_8814A 0x0470 -+#define REG_Q7_INFO_8814A 0x0474 -+#define REG_WMAC_LBK_BUF_HD_8814A 0x0478 -+#define REG_MGQ_PGBNDY_8814A 0x047A -+#define REG_INIRTS_RATE_SEL_8814A 0x0480 -+#define REG_BASIC_CFEND_RATE_8814A 0x0481 -+#define REG_STBC_CFEND_RATE_8814A 0x0482 -+#define REG_DATA_SC_8814A 0x0483 -+#define REG_MACID_SLEEP3_8814A 0x0484 -+#define REG_MACID_SLEEP1_8814A 0x0488 -+#define REG_ARFR2_8814A 0x048C -+#define REG_ARFR3_8814A 0x0494 -+#define REG_ARFR4_8814A 0x049C -+#define REG_ARFR5_8814A 0x04A4 -+#define REG_TXRPT_START_OFFSET_8814A 0x04AC -+#define REG_TRYING_CNT_TH_8814A 0x04B0 -+#define REG_POWER_STAGE1_8814A 0x04B4 -+#define REG_POWER_STAGE2_8814A 0x04B8 -+#define REG_SW_AMPDU_BURST_MODE_CTRL_8814A 0x04BC -+#define REG_PKT_LIFE_TIME_8814A 0x04C0 -+#define REG_PKT_BE_BK_LIFE_TIME_8814A 0x04C2 // ?????? -+#define REG_STBC_SETTING_8814A 0x04C4 -+#define REG_STBC_8814A 0x04C5 -+#define REG_QUEUE_CTRL_8814A 0x04C6 -+#define REG_SINGLE_AMPDU_CTRL_8814A 0x04C7 -+#define REG_PROT_MODE_CTRL_8814A 0x04C8 -+#define REG_MAX_AGGR_NUM_8814A 0x04CA -+#define REG_RTS_MAX_AGGR_NUM_8814A 0x04CB -+#define REG_BAR_MODE_CTRL_8814A 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8814A 0x04CF -+#define REG_MACID_SLEEP2_8814A 0x04D0 -+#define REG_MACID_SLEEP0_8814A 0x04D4 -+#define REG_HW_SEQ0_8814A 0x04D8 -+#define REG_HW_SEQ1_8814A 0x04DA -+#define REG_HW_SEQ2_8814A 0x04DC -+#define REG_HW_SEQ3_8814A 0x04DE -+#define REG_NULL_PKT_STATUS_8814A 0x04E0 -+#define REG_PTCL_ERR_STATUS_8814A 0x04E2 -+#define REG_DROP_PKT_NUM_8814A 0x04EC -+#define REG_PTCL_TX_RPT_8814A 0x04F0 -+#define REG_Dummy_8814A 0x04FC -+ -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+#define REG_EDCA_VO_PARAM_8814A 0x0500 -+#define REG_EDCA_VI_PARAM_8814A 0x0504 -+#define REG_EDCA_BE_PARAM_8814A 0x0508 -+#define REG_EDCA_BK_PARAM_8814A 0x050C -+#define REG_BCNTCFG_8814A 0x0510 -+#define REG_PIFS_8814A 0x0512 -+#define REG_RDG_PIFS_8814A 0x0513 -+#define REG_SIFS_CTX_8814A 0x0514 -+#define REG_SIFS_TRX_8814A 0x0516 -+#define REG_AGGR_BREAK_TIME_8814A 0x051A -+#define REG_SLOT_8814A 0x051B -+#define REG_TX_PTCL_CTRL_8814A 0x0520 -+#define REG_TXPAUSE_8814A 0x0522 -+#define REG_DIS_TXREQ_CLR_8814A 0x0523 -+#define REG_RD_CTRL_8814A 0x0524 -+// -+// Format for offset 540h-542h: -+// [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. -+// [7:4]: Reserved. -+// [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. -+// [23:20]: Reserved -+// Description: -+// | -+// |<--Setup--|--Hold------------>| -+// --------------|---------------------- -+// | -+// TBTT -+// Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. -+// Described by Designer Tim and Bruce, 2011-01-14. -+// -+#define REG_TBTT_PROHIBIT_8814A 0x0540 -+#define REG_RD_NAV_NXT_8814A 0x0544 -+#define REG_NAV_PROT_LEN_8814A 0x0546 -+#define REG_BCN_CTRL_8814A 0x0550 -+#define REG_BCN_CTRL_1_8814A 0x0551 -+#define REG_MBID_NUM_8814A 0x0552 -+#define REG_DUAL_TSF_RST_8814A 0x0553 -+#define REG_MBSSID_BCN_SPACE_8814A 0x0554 -+#define REG_DRVERLYINT_8814A 0x0558 -+#define REG_BCNDMATIM_8814A 0x0559 -+#define REG_ATIMWND_8814A 0x055A -+#define REG_USTIME_TSF_8814A 0x055C -+#define REG_BCN_MAX_ERR_8814A 0x055D -+#define REG_RXTSF_OFFSET_CCK_8814A 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8814A 0x055F -+#define REG_TSFTR_8814A 0x0560 -+#define REG_CTWND_8814A 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8814A 0x0577 // ?????? -+#define REG_PSTIMER_8814A 0x0580 -+#define REG_TIMER0_8814A 0x0584 -+#define REG_TIMER1_8814A 0x0588 -+#define REG_BCN_PREDL_ITV_8814A 0x058F //Pre download beacon interval -+#define REG_ACMHWCTRL_8814A 0x05C0 -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+#define REG_MAC_CR_8814A 0x0600 -+#define REG_TCR_8814A 0x0604 -+#define REG_RCR_8814A 0x0608 -+#define REG_RX_PKT_LIMIT_8814A 0x060C -+#define REG_RX_DLK_TIME_8814A 0x060D -+#define REG_RX_DRVINFO_SZ_8814A 0x060F -+ -+#define REG_MACID_8814A 0x0610 -+#define REG_BSSID_8814A 0x0618 -+#define REG_MAR_8814A 0x0620 -+#define REG_MBIDCAMCFG_8814A 0x0628 -+ -+#define REG_USTIME_EDCA_8814A 0x0638 -+#define REG_MAC_SPEC_SIFS_8814A 0x063A -+#define REG_RESP_SIFP_CCK_8814A 0x063C -+#define REG_RESP_SIFS_OFDM_8814A 0x063E -+#define REG_ACKTO_8814A 0x0640 -+#define REG_CTS2TO_8814A 0x0641 -+#define REG_EIFS_8814A 0x0642 -+ -+#define REG_NAV_UPPER_8814A 0x0652 // unit of 128 -+#define REG_TRXPTCL_CTL_8814A 0x0668 -+ -+// Security -+#define REG_CAMCMD_8814A 0x0670 -+#define REG_CAMWRITE_8814A 0x0674 -+#define REG_CAMREAD_8814A 0x0678 -+#define REG_CAMDBG_8814A 0x067C -+#define REG_SECCFG_8814A 0x0680 -+ -+// Power -+#define REG_WOW_CTRL_8814A 0x0690 -+#define REG_PS_RX_INFO_8814A 0x0692 -+#define REG_UAPSD_TID_8814A 0x0693 -+#define REG_WKFMCAM_NUM_8814A 0x0698 -+#define REG_RXFLTMAP0_8814A 0x06A0 -+#define REG_RXFLTMAP1_8814A 0x06A2 -+#define REG_RXFLTMAP2_8814A 0x06A4 -+#define REG_BCN_PSR_RPT_8814A 0x06A8 -+#define REG_BT_COEX_TABLE_8814A 0x06C0 -+#define REG_TX_DATA_RSP_RATE_8814A 0x06DE -+#define REG_ASSOCIATED_BFMER0_INFO_8814A 0x06E4 -+#define REG_ASSOCIATED_BFMER1_INFO_8814A 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8814A 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8814A 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8814A 0x06FC -+ -+// Hardware Port 2 -+#define REG_MACID1_8814A 0x0700 -+#define REG_BSSID1_8814A 0x0708 -+// Hardware Port 3 -+#define REG_MACID2_8814A 0x1620 -+#define REG_BSSID2_8814A 0x1628 -+// Hardware Port 4 -+#define REG_MACID3_8814A 0x1630 -+#define REG_BSSID3_8814A 0x1638 -+// Hardware Port 5 -+#define REG_MACID4_8814A 0x1640 -+#define REG_BSSID4_8814A 0x1648 -+ -+#define REG_ASSOCIATED_BFMEE_SEL_8814A 0x0714 -+#define REG_SND_PTCL_CTRL_8814A 0x0718 -+#define REG_IQ_DUMP_8814A 0x07C0 -+ -+/**** page 19 ****/ -+//TX BeamForming -+#define REG_BB_TXBF_ANT_SET_BF1 0x19ac -+#define REG_BB_TXBF_ANT_SET_BF0 0x19b4 -+ -+// 0x1200h ~ 0x12FFh DDMA CTRL -+// -+//----------------------------------------------------- -+#define REG_DDMA_CH0SA 0x1200 -+#define REG_DDMA_CH0DA 0x1204 -+#define REG_DDMA_CH0CTRL 0x1208 -+#define REG_DDMA_CH1SA 0x1210 -+#define REG_DDMA_CH1DA 0x1214 -+#define REG_DDMA_CH1CTRL 0x1218 -+#define REG_DDMA_CH2SA 0x1220 -+#define REG_DDMA_CH2DA 0x1224 -+#define REG_DDMA_CH2CTRL 0x1228 -+#define REG_DDMA_CH3SA 0x1230 -+#define REG_DDMA_CH3DA 0x1234 -+#define REG_DDMA_CH3CTRL 0x1238 -+#define REG_DDMA_CH4SA 0x1240 -+#define REG_DDMA_CH4DA 0x1244 -+#define REG_DDMA_CH4CTRL 0x1248 -+#define REG_DDMA_CH5SA 0x1250 -+#define REG_DDMA_CH5DA 0x1254 -+#define REG_DDMA_CH5CTRL 0x1258 -+#define REG_DDMA_INT_MSK 0x12E0 -+#define REG_DDMA_CHSTATUS 0x12E8 -+#define REG_DDMA_CHKSUM 0x12F0 -+#define REG_DDMA_MONITER 0x12FC -+ -+#define DDMA_LEN_MASK 0x0001FFFF -+#define FW_CHKSUM_DUMMY_SZ 8 -+#define DDMA_CH_CHKSUM_CNT BIT(24) -+#define DDMA_RST_CHKSUM_STS BIT(25) -+#define DDMA_MODE_BLOCK_CPU BIT(26) -+#define DDMA_CHKSUM_FAIL BIT(27) -+#define DDMA_DA_W_DISABLE BIT(28) -+#define DDMA_CHKSUM_EN BIT(29) -+#define DDMA_CH_OWN BIT(31) -+ -+ -+//3081 FWDL -+#define FWDL_EN BIT0 -+#define IMEM_BOOT_DL_RDY BIT1 -+#define IMEM_BOOT_CHKSUM_FAIL BIT2 -+#define IMEM_DL_RDY BIT3 -+#define IMEM_CHKSUM_OK BIT4 -+#define DMEM_DL_RDY BIT5 -+#define DMEM_CHKSUM_OK BIT6 -+#define EMEM_DL_RDY BIT7 -+#define EMEM_CHKSUM_FAIL BIT8 -+#define EMEM_TXBUF_DL_RDY BIT9 -+#define EMEM_TXBUF_CHKSUM_FAIL BIT10 -+#define CPU_CLK_SWITCH_BUSY BIT11 -+#define CPU_CLK_SEL (BIT12|BIT13) -+#define FWDL_OK BIT14 -+#define FW_INIT_RDY BIT15 -+#define R_EN_BOOT_FLASH BIT20 -+ -+#define OCPBASE_IMEM_3081 0x00000000 -+#define OCPBASE_DMEM_3081 0x00200000 -+#define OCPBASE_RPTBUF_3081 0x18660000 -+#define OCPBASE_RXBUF2_3081 0x18680000 -+#define OCPBASE_RXBUF_3081 0x18700000 -+#define OCPBASE_TXBUF_3081 0x18780000 -+ -+ -+#define REG_FAST_EDCA_VOVI_SETTING_8814A 0x1448 -+#define REG_FAST_EDCA_BEBK_SETTING_8814A 0x144C -+ -+ -+//----------------------------------------------------- -+// -+ -+ -+//----------------------------------------------------- -+// -+// Redifine 8192C register definition for compatibility -+// -+//----------------------------------------------------- -+ -+// TODO: use these definition when using REG_xxx naming rule. -+// NOTE: DO NOT Remove these definition. Use later. -+#define EFUSE_CTRL_8814A REG_EFUSE_CTRL_8814A // E-Fuse Control. -+#define EFUSE_TEST_8814A REG_LDO_EFUSE_CTRL_8814A // E-Fuse Test. -+#define MSR_8814A (REG_CR_8814A + 2) // Media Status register -+#define ISR_8814A REG_HISR0_8814A -+#define TSFR_8814A REG_TSFTR_8814A // Timing Sync Function Timer Register. -+ -+#define PBP_8814A REG_PBP_8814A -+ -+// Redifine MACID register, to compatible prior ICs. -+#define IDR0_8814A REG_MACID_8814A // MAC ID Register, Offset 0x0050-0x0053 -+#define IDR4_8814A (REG_MACID_8814A + 4) // MAC ID Register, Offset 0x0054-0x0055 -+ -+ -+// -+// 9. Security Control Registers (Offset: ) -+// -+#define RWCAM_8814A REG_CAMCMD_8814A //IN 8190 Data Sheet is called CAMcmd -+#define WCAMI_8814A REG_CAMWRITE_8814A // Software write CAM input content -+#define RCAMO_8814A REG_CAMREAD_8814A // Software read/write CAM config -+#define CAMDBG_8814A REG_CAMDBG_8814A -+#define SECR_8814A REG_SECCFG_8814A //Security Configuration Register -+ -+ -+//---------------------------------------------------------------------------- -+// 8195 IMR/ISR bits (offset 0xB0, 8bits) -+//---------------------------------------------------------------------------- -+#define IMR_DISABLED_8814A 0 -+// IMR DW0(0x00B0-00B3) Bit 0-31 -+#define IMR_TIMER2_8814A BIT31 // Timeout interrupt 2 -+#define IMR_TIMER1_8814A BIT30 // Timeout interrupt 1 -+#define IMR_PSTIMEOUT_8814A BIT29 // Power Save Time Out Interrupt -+#define IMR_GTINT4_8814A BIT28 // When GTIMER4 expires, this bit is set to 1 -+#define IMR_GTINT3_8814A BIT27 // When GTIMER3 expires, this bit is set to 1 -+#define IMR_TXBCN0ERR_8814A BIT26 // Transmit Beacon0 Error -+#define IMR_TXBCN0OK_8814A BIT25 // Transmit Beacon0 OK -+#define IMR_TSF_BIT32_TOGGLE_8814A BIT24 // TSF Timer BIT32 toggle indication interrupt -+#define IMR_BCNDMAINT0_8814A BIT20 // Beacon DMA Interrupt 0 -+#define IMR_BCNDERR0_8814A BIT16 // Beacon Queue DMA OK0 -+#define IMR_HSISR_IND_ON_INT_8814A BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) -+#define IMR_BCNDMAINT_E_8814A BIT14 // Beacon DMA Interrupt Extension for Win7 -+#define IMR_ATIMEND_8814A BIT12 // CTWidnow End or ATIM Window End -+#define IMR_C2HCMD_8814A BIT10 // CPU to Host Command INT Status, Write 1 clear -+#define IMR_CPWM2_8814A BIT9 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_CPWM_8814A BIT8 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_HIGHDOK_8814A BIT7 // High Queue DMA OK -+#define IMR_MGNTDOK_8814A BIT6 // Management Queue DMA OK -+#define IMR_BKDOK_8814A BIT5 // AC_BK DMA OK -+#define IMR_BEDOK_8814A BIT4 // AC_BE DMA OK -+#define IMR_VIDOK_8814A BIT3 // AC_VI DMA OK -+#define IMR_VODOK_8814A BIT2 // AC_VO DMA OK -+#define IMR_RDU_8814A BIT1 // Rx Descriptor Unavailable -+#define IMR_ROK_8814A BIT0 // Receive DMA OK -+ -+// IMR DW1(0x00B4-00B7) Bit 0-31 -+#define IMR_MCUERR_8814A BIT28 // Beacon DMA Interrupt 7 -+#define IMR_BCNDMAINT7_8814A BIT27 // Beacon DMA Interrupt 7 -+#define IMR_BCNDMAINT6_8814A BIT26 // Beacon DMA Interrupt 6 -+#define IMR_BCNDMAINT5_8814A BIT25 // Beacon DMA Interrupt 5 -+#define IMR_BCNDMAINT4_8814A BIT24 // Beacon DMA Interrupt 4 -+#define IMR_BCNDMAINT3_8814A BIT23 // Beacon DMA Interrupt 3 -+#define IMR_BCNDMAINT2_8814A BIT22 // Beacon DMA Interrupt 2 -+#define IMR_BCNDMAINT1_8814A BIT21 // Beacon DMA Interrupt 1 -+#define IMR_BCNDOK7_8814A BIT20 // Beacon Queue DMA OK Interrup 7 -+#define IMR_BCNDOK6_8814A BIT19 // Beacon Queue DMA OK Interrup 6 -+#define IMR_BCNDOK5_8814A BIT18 // Beacon Queue DMA OK Interrup 5 -+#define IMR_BCNDOK4_8814A BIT17 // Beacon Queue DMA OK Interrup 4 -+#define IMR_BCNDOK3_8814A BIT16 // Beacon Queue DMA OK Interrup 3 -+#define IMR_BCNDOK2_8814A BIT15 // Beacon Queue DMA OK Interrup 2 -+#define IMR_BCNDOK1_8814A BIT14 // Beacon Queue DMA OK Interrup 1 -+#define IMR_ATIMEND_E_8814A BIT13 // ATIM Window End Extension for Win7 -+#define IMR_TXERR_8814A BIT11 // Tx Error Flag Interrupt Status, write 1 clear. -+#define IMR_RXERR_8814A BIT10 // Rx Error Flag INT Status, Write 1 clear -+#define IMR_TXFOVW_8814A BIT9 // Transmit FIFO Overflow -+#define IMR_RXFOVW_8814A BIT8 // Receive FIFO Overflow -+ -+ -+#ifdef CONFIG_PCI_HCI -+#define IMR_TX_MASK (IMR_VODOK_8814A | IMR_VIDOK_8814A | IMR_BEDOK_8814A | IMR_BKDOK_8814A | IMR_MGNTDOK_8814A | IMR_HIGHDOK_8814A) -+ -+#define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8814A | IMR_TXBCN0OK_8814A | IMR_TXBCN0ERR_8814A | IMR_BCNDERR0_8814A) -+ -+#define RT_AC_INT_MASKS (IMR_VIDOK_8814A | IMR_VODOK_8814A | IMR_BEDOK_8814A | IMR_BKDOK_8814A) -+#endif -+ -+ -+/*=================================================================== -+===================================================================== -+Here the register defines are for 92C. When the define is as same with 92C, -+we will use the 92C's define for the consistency -+So the following defines for 92C is not entire!!!!!! -+===================================================================== -+=====================================================================*/ -+ -+ -+//----------------------------------------------------- -+// -+// 0xFE00h ~ 0xFE55h USB Configuration -+// -+//----------------------------------------------------- -+ -+//2 Special Option -+#define USB_AGG_EN_8814A BIT(7) -+#define REG_USB_HRPWM_U3 0xF052 -+ -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8814A 2048-1 //20130415 KaiYuan add for 8814 -+ -+#define MACID_NUM_8814A 128 -+#define SEC_CAM_ENT_NUM_8814A 64 -+#define NSS_NUM_8814A 3 -+ -+#endif //__RTL8814A_SPEC_H__ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8814a_sreset.h linux/3rdparty/rtl8812au/include/rtl8814a_sreset.h ---- linux.old/3rdparty/rtl8812au/include/rtl8814a_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8814a_sreset.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL88814A_SRESET_H_ -+#define _RTL8814A_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+extern void rtl8814_sreset_xmit_status_check(_adapter *padapter); -+extern void rtl8814_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8814a_xmit.h linux/3rdparty/rtl8812au/include/rtl8814a_xmit.h ---- linux.old/3rdparty/rtl8812au/include/rtl8814a_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8814a_xmit.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,307 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8814A_XMIT_H__ -+#define __RTL8814A_XMIT_H__ -+ -+typedef struct txdescriptor_8814 -+{ -+ // Offset 0 -+ u32 pktlen:16; -+ u32 offset:8; -+ u32 bmc:1; -+ u32 htc:1; -+ u32 ls:1; -+}TXDESC_8814, *PTXDESC_8814; -+ -+ -+#define OFFSET_SZ 0 -+#define OFFSET_SHT 16 -+ -+ -+ -+#ifdef CONFIG_SDIO_HCI -+#define SET_TX_DESC_SDIO_TXSEQ_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) -+#endif //CONFIG_SDIO_HCI -+ -+//----------------------------------------------------------------- -+// RTL8814A TX BUFFER DESC -+//----------------------------------------------------------------- -+/* -+- Each TXBD has 4 segment. -+ -- For 32 bit, each segment is 8 bytes. -+ -- For 64 bit, each segment is 16 bytes. -+*/ -+#if 0 -+#if 1 /* 32 bit */ -+#define SET_TX_EXTBUFF_DESC_LEN_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*8), 0, 16, __Value) -+#define SET_TX_EXTBUFF_DESC_ADDR_LOW_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*8)+4, 0, 32, __Value) -+#else /* 64 bit */ -+#define SET_TX_EXTBUFF_DESC_LEN_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*16), 0, 16, __Value) -+#define SET_TX_EXTBUFF_DESC_ADDR_LOW_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*16)+4, 0, 32, __Value) -+#endif -+#define SET_TX_EXTBUFF_DESC_ADDR_HIGH_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*16)+8, 0, 32, __Value) -+#endif -+ -+//========================================================= -+// for Txfilldescroptor8814Ae, fill the desc content. -+#if 1 /* 32 bit */ -+#define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*8), 0, 16, __Valeu) -+#define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*8), 31, 1, __Valeu) -+#define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*8)+4, 0, 32, __Valeu) -+#else /* 64 bit */ -+#define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 0, 16, __Valeu) -+#define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 31, 1, __Valeu) -+#define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+4, 0, 32, __Valeu) -+#endif -+#define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+8, 0, 32, __Valeu) -+ -+//========================================================= -+ -+//TX buffer -+//============= -+// Dword 0 -+#define SET_TX_BUFF_DESC_LEN_0_8814A(__pTxDesc, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Valeu) -+#define SET_TX_BUFF_DESC_PSB_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 15, __Value) -+#define SET_TX_BUFF_DESC_OWN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+#define GET_TX_BUFF_DESC_OWN_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+// Dword 1 -+#define SET_TX_BUFF_DESC_ADDR_LOW_0_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 32, __Value) -+#define GET_TX_BUFF_DESC_ADDR_LOW_0_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+4, 0, 32) -+// Dword 2 -+#define SET_TX_BUFF_DESC_ADDR_HIGH_0_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 32, __Value) -+#define GET_TX_BUFF_DESC_ADDR_HIGH_0_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+8, 0, 32) -+// Dword 3 //RESERVED 0 -+ -+#if 0 /* 64 bit */ -+// Dword 4 -+#define SET_TX_BUFF_DESC_LEN_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 16, __Value) -+#define SET_TX_BUFF_DESC_AMSDU_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 31, 1, __Value) -+// Dword 5 -+#define SET_TX_BUFF_DESC_ADDR_LOW_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 32, __Value) -+// Dword 6 -+#define SET_TX_BUFF_DESC_ADDR_HIGH_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 32, __Value) -+// Dword 7 //RESERVED 0 -+// Dword 8 -+#define SET_TX_BUFF_DESC_LEN_2_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 16, __Value) -+#define SET_TX_BUFF_DESC_AMSDU_2_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 31, 1, __Value) -+// Dword 9 -+#define SET_TX_BUFF_DESC_ADDR_LOW_2_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 32, __Value) -+// Dword 10 -+#define SET_TX_BUFF_DESC_ADDR_HIGH_2_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) -+// Dword 11 //RESERVED 0 -+// Dword 12 -+#define SET_TX_BUFF_DESC_LEN_3_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 16, __Value) -+#define SET_TX_BUFF_DESC_AMSDU_3_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 31, 1, __Value) -+// Dword 13 -+#define SET_TX_BUFF_DESC_ADDR_LOW_3_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+52, 0, 32, __Value) -+// Dword 14 -+#define SET_TX_BUFF_DESC_ADDR_HIGH_3_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+56, 0, 32, __Value) -+// Dword 15 //RESERVED 0 -+#endif -+ -+//=====Desc content -+//TX Info -+//============= -+// Dword 0 -+#define SET_TX_DESC_PKT_SIZE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define GET_TX_DESC_PKT_SIZE_8814A(__pTxDesc) LE_BITS_TO_4BYTE( __pTxDesc, 0, 16) -+#define SET_TX_DESC_OFFSET_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define GET_TX_DESC_OFFSET_8814A(__pTxDesc) LE_BITS_TO_4BYTE( __pTxDesc, 16, 8) -+#define SET_TX_DESC_BMC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_LAST_SEG_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+#define SET_TX_DESC_LINIP_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+#define SET_TX_DESC_AMSDU_PAD_EN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_NO_ACM_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+#define SET_TX_DESC_DISQSELSEQ_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+// Dword 1 -+#define SET_TX_DESC_MACID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+#define SET_TX_DESC_MORE_DATA_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 29, 1, __Value) -+#define SET_TX_DESC_TXOP_PS_CAP_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 30, 1, __Value) -+#define SET_TX_DESC_TXOP_PS_MODE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 31, 1, __Value) -+ -+ -+// Dword 2 -+#define SET_TX_DESC_PAID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+#define SET_TX_DESC_CCA_RTS_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_NULL_0_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 14, 1, __Value) -+#define SET_TX_DESC_NULL_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 15, 1, __Value) -+#define SET_TX_DESC_BK_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define GET_TX_DESC_MORE_FRAG_8814A(__pTxDesc) LE_BITS_TO_4BYTE( __pTxDesc+8, 17, 1) -+#define SET_TX_DESC_RAW_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define SET_TX_DESC_SPE_RPT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_NULL_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_GID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+#define SET_TX_DESC_HW_AES_IV_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 31, 1, __Value) -+ -+ -+// Dword 3 -+#define SET_TX_DESC_WHEADER_LEN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 5, __Value) -+#define SET_TX_DESC_EARLY_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HW_SSN_SEL_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_CHECK_EN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 14, 1, __Value) -+#define SET_TX_DESC_NAV_USE_HDR_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_NDPA_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+// Dword 4 -+#define SET_TX_DESC_TX_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_TRY_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 7, 1, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+#define SET_TX_DESC_PCTS_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 29, 1, __Value) -+#define SET_TX_DESC_PCTS_MASK_IDX_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 30, 2, __Value) -+ -+ -+// Dword 5 -+#define SET_TX_DESC_DATA_SC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_LDPC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+#define SET_TX_DESC_DATA_STBC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_CTROL_STBC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+#define SET_TX_DESC_SIGNALING_TA_PKT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 17, 1, __Value) -+#define SET_TX_DESC_PORT_ID_8814A(__pTxDesc,__Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 21, 3, __Value)//20130415 KaiYuan add for 8814 -+#define SET_TX_DESC_TX_ANT_8814A(__pTxDesc,__Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 4, __Value) -+#define SET_TX_DESC_TX_POWER_OFFSET_8814A(__pTxDesc,__Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 28, 3, __Value) -+ -+// Dword 6 -+#define SET_TX_DESC_SW_DEFINE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_MBSSID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+#define SET_TX_DESC_ANTSEL_A_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+#define SET_TX_DESC_ANTSEL_B_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) -+#define SET_TX_DESC_ANT_MAPA_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 2, __Value) -+#define SET_TX_DESC_ANT_MAPB_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 24, 2, __Value) -+#define SET_TX_DESC_ANT_MAPC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 26, 2, __Value) -+#define SET_TX_DESC_ANT_MAPD_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 28, 2, __Value) -+ -+ -+// Dword 7 -+#if(DEV_BUS_TYPE == RT_PCI_INTERFACE) -+#define SET_TX_DESC_TX_BUFFER_SIZE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#else -+#define SET_TX_DESC_TX_DESC_CHECKSUM_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+#define SET_TX_DESC_NTX_MAP_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 20, 4, __Value) -+#define SET_TX_DESC_USB_TXAGG_NUM_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+ -+ -+// Dword 8 -+#define SET_TX_DESC_RTS_RC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 6, __Value) -+#define SET_TX_DESC_BAR_RTY_TH_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 6, 2, __Value) -+#define SET_TX_DESC_DATA_RC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 8, 6, __Value) -+#define SET_TX_DESC_EN_HWEXSEQ_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 14, 1, __Value) -+#define SET_TX_DESC_HWSEQ_EN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+#if(DEV_BUS_TYPE != RT_SDIO_INTERFACE) -+#define SET_TX_DESC_NEXT_HEAD_PAGE_L_8814A(__pTxDesc,__Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) -+#else -+#define SET_TX_DESC_SDIO_SEQ_8814A(__pTxDesc,__Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) //20130415 KaiYuan add for 8814AS -+#endif -+#define SET_TX_DESC_TAIL_PAGE_L_8814A(__pTxDesc,__Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 24, 8, __Value) -+ -+// Dword 9 -+#define SET_TX_DESC_PADDING_LENGTH_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 11, __Value) -+#define SET_TX_DESC_TXBF_PATH_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 11, 1, __Value) -+#define SET_TX_DESC_SEQ_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+#define SET_TX_DESC_NEXT_HEAD_PAGE_H_8814A(__pTxDesc,__Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 24, 4, __Value) -+#define SET_TX_DESC_TAIL_PAGE_H_8814A(__pTxDesc,__Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 28, 4, __Value) -+ -+ -+ -+#define SET_EARLYMODE_PKTNUM_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+ -+void rtl8814a_cal_txdesc_chksum(u8 *ptxdesc); -+void rtl8814a_fill_fake_txdesc(PADAPTER padapter,u8*pDesc,u32 BufferLen,u8 IsPsPoll,u8 IsBTQosNull, u8 bDataFrame); -+void rtl8814a_fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void rtl8814a_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); -+void rtl8814a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); -+ -+#ifdef CONFIG_USB_HCI -+s32 rtl8814au_init_xmit_priv(PADAPTER padapter); -+void rtl8814au_free_xmit_priv(PADAPTER padapter); -+s32 rtl8814au_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8814au_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8814au_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtl8814au_xmit_buf_handler(PADAPTER padapter); -+void rtl8814au_xmit_tasklet(void *priv); -+s32 rtl8814au_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+#endif //CONFIG_USB_HCI -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8814ae_init_xmit_priv(PADAPTER padapter); -+void rtl8814ae_free_xmit_priv(PADAPTER padapter); -+struct xmit_buf *rtl8814ae_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+void rtl8814ae_xmitframe_resume(_adapter *padapter); -+s32 rtl8814ae_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8814ae_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8814ae_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+void rtl8814ae_xmit_tasklet(void *priv); -+#endif -+ -+void _dbg_dump_tx_info(_adapter *padapter,int frame_tag, u8 *ptxdesc); -+u8 -+SCMapping_8814( -+ IN PADAPTER Adapter, -+ IN struct pkt_attrib *pattrib -+); -+ -+u8 -+BWMapping_8814( -+ IN PADAPTER Adapter, -+ IN struct pkt_attrib *pattrib -+); -+ -+ -+#endif /* __RTL8814_XMIT_H__ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8821a_spec.h linux/3rdparty/rtl8812au/include/rtl8821a_spec.h ---- linux.old/3rdparty/rtl8812au/include/rtl8821a_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8821a_spec.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,105 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8821A_SPEC_H__ -+#define __RTL8821A_SPEC_H__ -+ -+#include -+// This file should based on "hal_com_reg.h" -+#include -+// Because 8812a and 8821a is the same serial, -+// most of 8821a register definitions are the same as 8812a. -+#include -+ -+ -+//============================================================ -+// 8821A Regsiter offset definition -+//============================================================ -+ -+//============================================================ -+// MAC register -+//============================================================ -+ -+//----------------------------------------------------- -+// 0x0000h ~ 0x00FFh System Configuration -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+//----------------------------------------------------- -+#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN -+ -+//----------------------------------------------------- -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// 0x0280h ~ 0x02FFh RXDMA Configuration -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// 0x0300h ~ 0x03FFh PCIe -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// 0x0400h ~ 0x047Fh Protocol Configuration -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// 0x0500h ~ 0x05FFh EDCA Configuration -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// 0x0600h ~ 0x07FFh WMAC Configuration -+//----------------------------------------------------- -+ -+ -+//============================================================ -+// SDIO Bus Specification -+//============================================================ -+ -+//----------------------------------------------------- -+// SDIO CMD Address Mapping -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// I/O bus domain (Host) -+//----------------------------------------------------- -+ -+//----------------------------------------------------- -+// SDIO register -+//----------------------------------------------------- -+#undef SDIO_REG_HCPWM1 -+#define SDIO_REG_FREE_TXPG2 0x024 -+#define SDIO_REG_HCPWM1 0x025 -+ -+ -+//============================================================ -+// Regsiter Bit and Content definition -+//============================================================ -+ -+//======================================================== -+// General definitions -+//======================================================== -+ -+#define MACID_NUM_8821A 128 -+#define SEC_CAM_ENT_NUM_8821A 64 -+#define NSS_NUM_8821A 1 -+ -+#endif /* __RTL8821A_SPEC_H__ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtl8821a_xmit.h linux/3rdparty/rtl8812au/include/rtl8821a_xmit.h ---- linux.old/3rdparty/rtl8812au/include/rtl8821a_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtl8821a_xmit.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,180 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8821A_XMIT_H__ -+#define __RTL8821A_XMIT_H__ -+ -+#include -+ -+typedef struct txdescriptor_8821a -+{ -+ // Offset 0 -+ u32 pktlen:16; -+ u32 offset:8; -+ u32 bmc:1; -+ u32 htc:1; -+ u32 rsvd0026:1; -+ u32 rsvd0027:1; -+ u32 linip:1; -+ u32 noacm:1; -+ u32 gf:1; -+ u32 rsvd0031:1; -+ -+ // Offset 4 -+ u32 macid:7; -+ u32 rsvd0407:1; -+ u32 qsel:5; -+ u32 rdg_nav_ext:1; -+ u32 lsig_txop_en:1; -+ u32 pifs:1; -+ u32 rate_id:5; -+ u32 en_desc_id:1; -+ u32 sectype:2; -+ u32 pkt_offset:5; // unit: 8 bytes -+ u32 moredata:1; -+ u32 txop_ps_cap:1; -+ u32 txop_ps_mode:1; -+ -+ // Offset 8 -+ u32 p_aid:9; -+ u32 rsvd0809:1; -+ u32 cca_rts:2; -+ u32 agg_en:1; -+ u32 rdg_en:1; -+ u32 null_0:1; -+ u32 null_1:1; -+ u32 bk:1; -+ u32 morefrag:1; -+ u32 raw:1; -+ u32 spe_rpt:1; -+ u32 ampdu_density:3; -+ u32 bt_null:1; -+ u32 g_id:6; -+ u32 rsvd0830:2; -+ -+ // Offset 12 -+ u32 wheader_len:4; -+ u32 chk_en:1; -+ u32 early_rate:1; -+ u32 hw_ssn_sel:2; -+ u32 userate:1; -+ u32 disrtsfb:1; -+ u32 disdatafb:1; -+ u32 cts2self:1; -+ u32 rtsen:1; -+ u32 hw_rts_en:1; -+ u32 port_id:1; -+ u32 navusehdr:1; -+ u32 use_max_len:1; -+ u32 max_agg_num:5; -+ u32 ndpa:2; -+ u32 ampdu_max_time:8; -+ -+ // Offset 16 -+ u32 datarate:7; -+ u32 try_rate:1; -+ u32 data_ratefb_lmt:5; -+ u32 rts_ratefb_lmt:4; -+ u32 rty_lmt_en:1; -+ u32 data_rt_lmt:6; -+ u32 rtsrate:5; -+ u32 pcts_en:1; -+ u32 pcts_mask_idx:2; -+ -+ // Offset 20 -+ u32 data_sc:4; -+ u32 data_short:1; -+ u32 data_bw:2; -+ u32 data_ldpc:1; -+ u32 data_stbc:2; -+ u32 vcs_stbc:2; -+ u32 rts_short:1; -+ u32 rts_sc:4; -+ u32 rsvd2016:7; -+ u32 tx_ant:4; -+ u32 txpwr_offset:3; -+ u32 rsvd2031:1; -+ -+ // Offset 24 -+ u32 sw_define:12; -+ u32 mbssid:4; -+ u32 antsel_A:3; -+ u32 antsel_B:3; -+ u32 antsel_C:3; -+ u32 antsel_D:3; -+ u32 rsvd2428:4; -+ -+ // Offset 28 -+ u32 checksum:16; -+ u32 rsvd2816:8; -+ u32 usb_txagg_num:8; -+ -+ // Offset 32 -+ u32 rts_rc:6; -+ u32 bar_rty_th:2; -+ u32 data_rc:6; -+ u32 rsvd3214:1; -+ u32 en_hwseq:1; -+ u32 nextneadpage:8; -+ u32 tailpage:8; -+ -+ // Offset 36 -+ u32 padding_len:11; -+ u32 txbf_path:1; -+ u32 seq:12; -+ u32 final_data_rate:8; -+}TXDESC_8821A, *PTXDESC_8821A; -+ -+#ifdef CONFIG_SDIO_HCI -+s32 InitXmitPriv8821AS(PADAPTER padapter); -+void FreeXmitPriv8821AS(PADAPTER padapter); -+s32 XmitBufHandler8821AS(PADAPTER padapter); -+s32 MgntXmit8821AS(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 HalXmitNoLock8821AS(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 HalXmit8821AS(PADAPTER padapter, struct xmit_frame *pxmitframe); -+#ifndef CONFIG_SDIO_TX_TASKLET -+thread_return XmitThread8821AS(thread_context context); -+#endif // !CONFIG_SDIO_TX_TASKLET -+#endif // CONFIG_SDIO_HCI -+ -+#if 0 -+#ifdef CONFIG_USB_HCI -+s32 rtl8821au_init_xmit_priv(PADAPTER padapter); -+void rtl8821au_free_xmit_priv(PADAPTER padapter); -+s32 rtl8821au_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8821au_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8821au_hal_xmitframe_enqueue(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8821au_xmit_buf_handler(PADAPTER padapter); -+void rtl8821au_xmit_tasklet(void *priv); -+s32 rtl8821au_xmitframe_complete(PADAPTER padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+#endif // CONFIG_USB_HCI -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8821e_init_xmit_priv(PADAPTER padapter); -+void rtl8821e_free_xmit_priv(PADAPTER padapter); -+struct xmit_buf* rtl8821e_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+void rtl8821e_xmitframe_resume(PADAPTER padapter); -+s32 rtl8821e_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8821e_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+void rtl8821e_xmit_tasklet(void *priv); -+#endif // CONFIG_PCI_HCI -+#endif -+ -+#endif //__RTL8821_XMIT_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_android.h linux/3rdparty/rtl8812au/include/rtw_android.h ---- linux.old/3rdparty/rtl8812au/include/rtw_android.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_android.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,113 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ +#ifndef __RTW_ANDROID_H__ +#define __RTW_ANDROID_H__ + +enum ANDROID_WIFI_CMD { -+ ANDROID_WIFI_CMD_START, -+ ANDROID_WIFI_CMD_STOP, ++ ANDROID_WIFI_CMD_START, ++ ANDROID_WIFI_CMD_STOP, + ANDROID_WIFI_CMD_SCAN_ACTIVE, -+ ANDROID_WIFI_CMD_SCAN_PASSIVE, -+ ANDROID_WIFI_CMD_RSSI, ++ ANDROID_WIFI_CMD_SCAN_PASSIVE, ++ ANDROID_WIFI_CMD_RSSI, + ANDROID_WIFI_CMD_LINKSPEED, + ANDROID_WIFI_CMD_RXFILTER_START, -+ ANDROID_WIFI_CMD_RXFILTER_STOP, -+ ANDROID_WIFI_CMD_RXFILTER_ADD, ++ ANDROID_WIFI_CMD_RXFILTER_STOP, ++ ANDROID_WIFI_CMD_RXFILTER_ADD, + ANDROID_WIFI_CMD_RXFILTER_REMOVE, + ANDROID_WIFI_CMD_BTCOEXSCAN_START, + ANDROID_WIFI_CMD_BTCOEXSCAN_STOP, + ANDROID_WIFI_CMD_BTCOEXMODE, + ANDROID_WIFI_CMD_SETSUSPENDOPT, -+ ANDROID_WIFI_CMD_P2P_DEV_ADDR, -+ ANDROID_WIFI_CMD_SETFWPATH, -+ ANDROID_WIFI_CMD_SETBAND, -+ ANDROID_WIFI_CMD_GETBAND, -+ ANDROID_WIFI_CMD_COUNTRY, ++ ANDROID_WIFI_CMD_P2P_DEV_ADDR, ++ ANDROID_WIFI_CMD_SETFWPATH, ++ ANDROID_WIFI_CMD_SETBAND, ++ ANDROID_WIFI_CMD_GETBAND, ++ ANDROID_WIFI_CMD_COUNTRY, + ANDROID_WIFI_CMD_P2P_SET_NOA, -+ ANDROID_WIFI_CMD_P2P_GET_NOA, -+ ANDROID_WIFI_CMD_P2P_SET_PS, ++ ANDROID_WIFI_CMD_P2P_GET_NOA, ++ ANDROID_WIFI_CMD_P2P_SET_PS, + ANDROID_WIFI_CMD_SET_AP_WPS_P2P_IE, -+ -+ ANDROID_WIFI_CMD_MIRACAST, -+ -+#ifdef CONFIG_PNO_SUPPORT ++#ifdef PNO_SUPPORT + ANDROID_WIFI_CMD_PNOSSIDCLR_SET, + ANDROID_WIFI_CMD_PNOSETUP_SET, + ANDROID_WIFI_CMD_PNOENABLE_SET, @@ -324199,36 +142742,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_android.h linux/3rdparty/rtl + + ANDROID_WIFI_CMD_MACADDR, + -+ ANDROID_WIFI_CMD_BLOCK_SCAN, + ANDROID_WIFI_CMD_BLOCK, + + ANDROID_WIFI_CMD_WFD_ENABLE, + ANDROID_WIFI_CMD_WFD_DISABLE, -+ ++ + ANDROID_WIFI_CMD_WFD_SET_TCPPORT, + ANDROID_WIFI_CMD_WFD_SET_MAX_TPUT, + ANDROID_WIFI_CMD_WFD_SET_DEVTYPE, -+ ANDROID_WIFI_CMD_CHANGE_DTIM, -+ ANDROID_WIFI_CMD_HOSTAPD_SET_MACADDR_ACL, -+ ANDROID_WIFI_CMD_HOSTAPD_ACL_ADD_STA, -+ ANDROID_WIFI_CMD_HOSTAPD_ACL_REMOVE_STA, -+#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 1, 0)) -+ ANDROID_WIFI_CMD_GTK_REKEY_OFFLOAD, -+#endif //CONFIG_GTK_OL -+ ANDROID_WIFI_CMD_P2P_DISABLE, -+ ANDROID_WIFI_CMD_DRIVERVERSION, ++ + ANDROID_WIFI_CMD_MAX +}; + +int rtw_android_cmdstr_to_num(char *cmdstr); +int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd); + -+#if defined(CONFIG_PNO_SUPPORT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3,0,0)) -+int rtw_android_pno_enable(struct net_device *net, int pno_enable); -+int rtw_android_cfg80211_pno_setup(struct net_device *net, -+ struct cfg80211_ssid *ssid, int n_ssids, int interval); -+#endif -+ +#if defined(RTW_ENABLE_WIFI_CONTROL_FUNC) +int rtw_android_wifictrl_func_add(void); +void rtw_android_wifictrl_func_del(void); @@ -324243,262 +142771,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_android.h linux/3rdparty/rtl +static void rtw_android_wifictrl_func_del(void) {} +#endif /* defined(RTW_ENABLE_WIFI_CONTROL_FUNC) */ + -+#ifdef CONFIG_GPIO_WAKEUP -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+int wifi_configure_gpio(void); -+#endif //CONFIG_PLATFORM_INTEL_BYT -+void wifi_free_gpio(unsigned int gpio); -+#endif //CONFIG_GPIO_WAKEUP -+ -+ +#endif //__RTW_ANDROID_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ap.h linux/3rdparty/rtl8812au/include/rtw_ap.h ---- linux.old/3rdparty/rtl8812au/include/rtw_ap.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_ap.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,80 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_AP_H_ -+#define __RTW_AP_H_ -+ -+ -+#ifdef CONFIG_AP_MODE -+ -+//external function -+extern void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta); -+extern void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta); -+ -+ -+void init_mlme_ap_info(_adapter *padapter); -+void free_mlme_ap_info(_adapter *padapter); -+//void update_BCNTIM(_adapter *padapter); -+void rtw_add_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index, u8 *data, u8 len); -+void rtw_remove_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index); -+void _update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx, const char *tag); -+#define update_beacon(adapter, ie_id, oui, tx) _update_beacon((adapter), (ie_id), (oui), (tx), __func__) -+void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level); -+void expire_timeout_chk(_adapter *padapter); -+void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta); -+void rtw_start_bss_hdl_after_chbw_decided(_adapter *adapter); -+void start_bss_network(_adapter *padapter, struct createbss_parm *parm); -+int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len); -+void rtw_ap_restore_network(_adapter *padapter); -+void rtw_set_macaddr_acl(_adapter *padapter, int mode); -+int rtw_acl_add_sta(_adapter *padapter, u8 *addr); -+int rtw_acl_remove_sta(_adapter *padapter, u8 *addr); -+ -+u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta); -+int rtw_ap_set_group_key(_adapter *padapter, u8 *key, u8 alg, int keyid); -+int rtw_ap_set_wep_key(_adapter *padapter, u8 *key, u8 keylen, int keyid, u8 set_tx); -+ -+#ifdef CONFIG_NATIVEAP_MLME -+void associated_clients_update(_adapter *padapter, u8 updated, u32 sta_info_type); -+void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta); -+u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta); -+void sta_info_update(_adapter *padapter, struct sta_info *psta); -+void ap_sta_info_defer_update(_adapter *padapter, struct sta_info *psta); -+u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reason, bool enqueue); -+int rtw_sta_flush(_adapter *padapter, bool enqueue); -+int rtw_ap_inform_ch_switch(_adapter *padapter, u8 new_ch, u8 ch_offset); -+void start_ap_mode(_adapter *padapter); -+void stop_ap_mode(_adapter *padapter); -+#endif -+ -+void rtw_ap_update_bss_chbw(_adapter *adapter, WLAN_BSSID_EX *bss, u8 ch, u8 bw, u8 offset); -+bool rtw_ap_chbw_decision(_adapter *adapter, u8 req_ch, u8 req_bw, u8 req_offset, u8 *ch, u8 *bw, u8 *offset); -+ -+#ifdef CONFIG_AUTO_AP_MODE -+extern void rtw_start_auto_ap(_adapter *adapter); -+#endif //CONFIG_AUTO_AP_MODE -+ -+#endif //end of CONFIG_AP_MODE -+ -+#endif -+void update_bmc_sta(_adapter *padapter); -+ -+void rtw_process_ht_action_smps(_adapter *padapter, u8 *ta, u8 ctrl_field); -+void rtw_process_public_act_bsscoex(_adapter *padapter, u8 *pframe, uint frame_len); -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_beamforming.h linux/3rdparty/rtl8812au/include/rtw_beamforming.h ---- linux.old/3rdparty/rtl8812au/include/rtw_beamforming.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_beamforming.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,150 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_BEAMFORMING_H_ -+#define __RTW_BEAMFORMING_H_ -+ -+#ifdef CONFIG_BEAMFORMING -+ -+#if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ -+#define BEAMFORMING_ENTRY_NUM 2 -+#define GET_BEAMFORM_INFO(_pmlmepriv) ((struct beamforming_info *)(&(_pmlmepriv)->beamforming_info)) -+ -+ -+typedef enum _BEAMFORMING_ENTRY_STATE -+{ -+ BEAMFORMING_ENTRY_STATE_UNINITIALIZE, -+ BEAMFORMING_ENTRY_STATE_INITIALIZEING, -+ BEAMFORMING_ENTRY_STATE_INITIALIZED, -+ BEAMFORMING_ENTRY_STATE_PROGRESSING, -+ BEAMFORMING_ENTRY_STATE_PROGRESSED, -+}BEAMFORMING_ENTRY_STATE, *PBEAMFORMING_ENTRY_STATE; -+ -+ -+typedef enum _BEAMFORMING_STATE -+{ -+ BEAMFORMING_STATE_IDLE, -+ BEAMFORMING_STATE_START, -+ BEAMFORMING_STATE_END, -+}BEAMFORMING_STATE, *PBEAMFORMING_STATE; -+ -+ -+typedef enum _BEAMFORMING_CAP -+{ -+ BEAMFORMING_CAP_NONE = 0x0, -+ BEAMFORMER_CAP_HT_EXPLICIT = 0x1, -+ BEAMFORMEE_CAP_HT_EXPLICIT = 0x2, -+ BEAMFORMER_CAP_VHT_SU = 0x4, // Self has er Cap, because Reg er & peer ee -+ BEAMFORMEE_CAP_VHT_SU = 0x8, // Self has ee Cap, because Reg ee & peer er -+ BEAMFORMER_CAP = 0x10, -+ BEAMFORMEE_CAP = 0x20, -+}BEAMFORMING_CAP, *PBEAMFORMING_CAP; -+ -+ -+typedef enum _SOUNDING_MODE -+{ -+ SOUNDING_SW_VHT_TIMER = 0x0, -+ SOUNDING_SW_HT_TIMER = 0x1, -+ SOUNDING_STOP_All_TIMER = 0x2, -+ SOUNDING_HW_VHT_TIMER = 0x3, -+ SOUNDING_HW_HT_TIMER = 0x4, -+ SOUNDING_STOP_OID_TIMER = 0x5, -+ SOUNDING_AUTO_VHT_TIMER = 0x6, -+ SOUNDING_AUTO_HT_TIMER = 0x7, -+ SOUNDING_FW_VHT_TIMER = 0x8, -+ SOUNDING_FW_HT_TIMER = 0x9, -+}SOUNDING_MODE, *PSOUNDING_MODE; -+ -+struct beamforming_entry { -+ BOOLEAN bUsed; -+ BOOLEAN bSound; -+ u16 aid; // Used to construct AID field of NDPA packet. -+ u16 mac_id; // Used to Set Reg42C in IBSS mode. -+ u16 p_aid; // Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. -+ u16 g_id; -+ u8 mac_addr[6];// Used to fill Reg6E4 to fill Mac address of CSI report frame. -+ CHANNEL_WIDTH sound_bw; // Sounding BandWidth -+ u16 sound_period; -+ BEAMFORMING_CAP beamforming_entry_cap; -+ BEAMFORMING_ENTRY_STATE beamforming_entry_state; -+ u8 ClockResetTimes; /*Modified by Jeffery @2015-04-10*/ -+ u8 PreLogSeq; /*Modified by Jeffery @2015-03-30*/ -+ u8 LogSeq; /*Modified by Jeffery @2014-10-29*/ -+ u16 LogRetryCnt:3; /*Modified by Jeffery @2014-10-29*/ -+ u16 LogSuccess:2; /*Modified by Jeffery @2014-10-29*/ -+ -+ u8 LogStatusFailCnt; -+ u8 PreCsiReport[327]; -+ u8 DefaultCsiCnt; -+ BOOLEAN bDefaultCSI; -+}; -+ -+struct sounding_info { -+ u8 sound_idx; -+ CHANNEL_WIDTH sound_bw; -+ SOUNDING_MODE sound_mode; -+ u16 sound_period; -+}; -+ -+struct beamforming_info { -+ BEAMFORMING_CAP beamforming_cap; -+ BEAMFORMING_STATE beamforming_state; -+ struct beamforming_entry beamforming_entry[BEAMFORMING_ENTRY_NUM]; -+ u8 beamforming_cur_idx; -+ u8 beamforming_in_progress; -+ u8 sounding_sequence; -+ struct sounding_info sounding_info; -+}; -+ -+struct rtw_ndpa_sta_info { -+ u16 aid:12; -+ u16 feedback_type:1; -+ u16 nc_index:3; -+}; -+ -+BEAMFORMING_CAP beamforming_get_entry_beam_cap_by_mac_id(PVOID pmlmepriv ,u8 mac_id); -+void beamforming_notify(PADAPTER adapter); -+BEAMFORMING_CAP beamforming_get_beamform_cap(struct beamforming_info *pBeamInfo); -+ -+BOOLEAN beamforming_send_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx); -+BOOLEAN beamforming_send_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx); -+ -+void beamforming_check_sounding_success(PADAPTER Adapter,BOOLEAN status); -+ -+void beamforming_watchdog(PADAPTER Adapter); -+#endif /*#if (BEAMFORMING_SUPPORT ==0)- for diver defined beamforming*/ -+ -+enum BEAMFORMING_CTRL_TYPE { -+ BEAMFORMING_CTRL_ENTER = 0, -+ BEAMFORMING_CTRL_LEAVE = 1, -+ BEAMFORMING_CTRL_START_PERIOD = 2, -+ BEAMFORMING_CTRL_END_PERIOD = 3, -+ BEAMFORMING_CTRL_SOUNDING_FAIL = 4, -+ BEAMFORMING_CTRL_SOUNDING_CLK = 5, -+}; -+u32 beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_frame); -+void beamforming_get_ndpa_frame(PADAPTER Adapter, union recv_frame *precv_frame); -+ -+void beamforming_wk_hdl(_adapter *padapter, u8 type, u8 *pbuf); -+u8 beamforming_wk_cmd(_adapter*padapter, s32 type, u8 *pbuf, s32 size, u8 enqueue); -+void update_attrib_txbf_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta); -+ -+#endif /*#ifdef CONFIG_BEAMFORMING */ -+ -+#endif /*__RTW_BEAMFORMING_H_*/ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_br_ext.h linux/3rdparty/rtl8812au/include/rtw_br_ext.h ---- linux.old/3rdparty/rtl8812au/include/rtw_br_ext.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_br_ext.h 2017-06-07 23:07:21.041690310 +0300 -@@ -0,0 +1,76 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_ap.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ap.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_ap.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ap.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,64 @@ +/****************************************************************************** + * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -324508,17 +142789,80 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_br_ext.h linux/3rdparty/rtl8 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++#ifndef __RTW_AP_H_ ++#define __RTW_AP_H_ ++ ++ ++#ifdef CONFIG_AP_MODE ++ ++//external function ++extern void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta); ++extern void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta); ++ ++ ++void init_mlme_ap_info(_adapter *padapter); ++void free_mlme_ap_info(_adapter *padapter); ++//void update_BCNTIM(_adapter *padapter); ++void rtw_add_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index, u8 *data, u8 len); ++void rtw_remove_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index); ++void update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx); ++void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level); ++void expire_timeout_chk(_adapter *padapter); ++void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta); ++int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len); ++void rtw_ap_restore_network(_adapter *padapter); ++void rtw_set_macaddr_acl(_adapter *padapter, int mode); ++int rtw_acl_add_sta(_adapter *padapter, u8 *addr); ++int rtw_acl_remove_sta(_adapter *padapter, u8 *addr); ++ ++u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta); ++int rtw_ap_set_group_key(_adapter *padapter, u8 *key, u8 alg, int keyid); ++int rtw_ap_set_wep_key(_adapter *padapter, u8 *key, u8 keylen, int keyid, u8 set_tx); ++ ++#ifdef CONFIG_NATIVEAP_MLME ++void associated_clients_update(_adapter *padapter, u8 updated); ++void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta); ++u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta); ++void sta_info_update(_adapter *padapter, struct sta_info *psta); ++void ap_sta_info_defer_update(_adapter *padapter, struct sta_info *psta); ++u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reason); ++int rtw_sta_flush(_adapter *padapter); ++int rtw_ap_inform_ch_switch(_adapter *padapter, u8 new_ch, u8 ch_offset); ++void start_ap_mode(_adapter *padapter); ++void stop_ap_mode(_adapter *padapter); ++#endif ++ ++#ifdef CONFIG_AUTO_AP_MODE ++extern void rtw_start_auto_ap(_adapter *adapter); ++#endif //CONFIG_AUTO_AP_MODE ++ ++#endif //end of CONFIG_AP_MODE ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_br_ext.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_br_ext.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_br_ext.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_br_ext.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,70 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#ifndef _RTW_BR_EXT_H_ +#define _RTW_BR_EXT_H_ + +#if 1 // rtw_wifi_driver -+#define CL_IPV6_PASS 1 ++#define CL_IPV6_PASS 1 +#define MACADDRLEN 6 +#define _DEBUG_ERR DBG_8192C +#define _DEBUG_INFO //DBG_8192C @@ -324526,7 +142870,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_br_ext.h linux/3rdparty/rtl8 +#define DEBUG_INFO //DBG_8192C +#define DEBUG_ERR DBG_8192C +//#define GET_MY_HWADDR ((GET_MIB(priv))->dot11OperationEntry.hwaddr) -+#define GET_MY_HWADDR(padapter) (adapter_mac_addr(padapter)) ++#define GET_MY_HWADDR(padapter) ((padapter)->eeprompriv.mac_addr) +#endif // rtw_wifi_driver + +#define NAT25_HASH_BITS 4 @@ -324546,7 +142890,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_br_ext.h linux/3rdparty/rtl8 + atomic_t use_count; + unsigned char macAddr[6]; + unsigned long ageing_timer; -+ unsigned char networkAddr[MAX_NETWORK_ADDR_LEN]; ++ unsigned char networkAddr[MAX_NETWORK_ADDR_LEN]; +}; + +enum NAT25_METHOD { @@ -324570,738 +142914,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_br_ext.h linux/3rdparty/rtl8 +void nat25_db_cleanup(_adapter *priv); + +#endif // _RTW_BR_EXT_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_btcoex.h linux/3rdparty/rtl8812au/include/rtw_btcoex.h ---- linux.old/3rdparty/rtl8812au/include/rtw_btcoex.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_btcoex.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,396 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_BTCOEX_H__ -+#define __RTW_BTCOEX_H__ -+ -+#include -+ -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ -+#define NETLINK_USER 31 -+#define CONNECT_PORT 30000 -+#define CONNECT_PORT_BT 30001 -+#define KERNEL_SOCKET_OK 0x01 -+#define NETLINK_SOCKET_OK 0x02 -+ -+#define OTHER 0 -+#define RX_ATTEND_ACK 1 -+#define RX_LEAVE_ACK 2 -+#define RX_BT_LEAVE 3 -+#define RX_INVITE_REQ 4 -+#define RX_ATTEND_REQ 5 -+#define RX_INVITE_RSP 6 -+ -+#define invite_req "INVITE_REQ" -+#define invite_rsp "INVITE_RSP" -+#define attend_req "ATTEND_REQ" -+#define attend_ack "ATTEND_ACK" -+#define wifi_leave "WIFI_LEAVE" -+#define leave_ack "LEAVE_ACK" -+#define bt_leave "BT_LEAVE" -+ -+#define BT_INFO_NOTIFY_CMD 0x0106 -+#define BT_INFO_LEN 8 -+ -+typedef struct _HCI_LINK_INFO{ -+ u2Byte ConnectHandle; -+ u1Byte IncomingTrafficMode; -+ u1Byte OutgoingTrafficMode; -+ u1Byte BTProfile; -+ u1Byte BTCoreSpec; -+ s1Byte BT_RSSI; -+ u1Byte TrafficProfile; -+ u1Byte linkRole; -+}HCI_LINK_INFO, *PHCI_LINK_INFO; -+ -+#define MAX_BT_ACL_LINK_NUM 8 -+ -+typedef struct _HCI_EXT_CONFIG{ -+ HCI_LINK_INFO aclLink[MAX_BT_ACL_LINK_NUM]; -+ u1Byte btOperationCode; -+ u2Byte CurrentConnectHandle; -+ u1Byte CurrentIncomingTrafficMode; -+ u1Byte CurrentOutgoingTrafficMode; -+ -+ u1Byte NumberOfACL; -+ u1Byte NumberOfSCO; -+ u1Byte CurrentBTStatus; -+ u2Byte HCIExtensionVer; -+ -+ BOOLEAN bEnableWifiScanNotify; -+}HCI_EXT_CONFIG, *PHCI_EXT_CONFIG; -+ -+typedef struct _HCI_PHY_LINK_BSS_INFO{ -+ u2Byte bdCap; // capability information -+ -+ // Qos related. Added by Annie, 2005-11-01. -+ //BSS_QOS BssQos; -+ -+}HCI_PHY_LINK_BSS_INFO, *PHCI_PHY_LINK_BSS_INFO; -+ -+typedef enum _BT_CONNECT_TYPE{ -+ BT_CONNECT_AUTH_REQ =0x00, -+ BT_CONNECT_AUTH_RSP =0x01, -+ BT_CONNECT_ASOC_REQ =0x02, -+ BT_CONNECT_ASOC_RSP =0x03, -+ BT_DISCONNECT =0x04 -+}BT_CONNECT_TYPE,*PBT_CONNECT_TYPE; -+ -+ -+typedef struct _PACKET_IRP_HCIEVENT_DATA { -+ u8 EventCode; -+ u8 Length; //total cmd length = extension event length+1(extension event code length) -+ u8 Data[1]; // byte1 is extension event code -+} rtw_HCI_event; -+ -+ -+struct btinfo_8761ATV { -+ u8 cid; -+ u8 len; -+ -+ u8 bConnection:1; -+ u8 bSCOeSCO:1; -+ u8 bInQPage:1; -+ u8 bACLBusy:1; -+ u8 bSCOBusy:1; -+ u8 bHID:1; -+ u8 bA2DP:1; -+ u8 bFTP:1; -+ -+ u8 retry_cnt:4; -+ u8 rsvd_34:1; -+ u8 bPage:1; -+ u8 TRxMask:1; -+ u8 Sniff_attempt:1; -+ -+ u8 rssi; -+ -+ u8 A2dp_rate:1; -+ u8 ReInit:1; -+ u8 MaxPower:1; -+ u8 bEnIgnoreWlanAct:1; -+ u8 TxPowerLow:1; -+ u8 TxPowerHigh:1; -+ u8 eSCO_SCO:1; -+ u8 Master_Slave:1; -+ -+ u8 ACL_TRx_TP_low; -+ u8 ACL_TRx_TP_high; -+}; -+ -+#define HCIOPCODE(_OCF, _OGF) ((_OGF)<<10|(_OCF)) -+#define HCIOPCODELOW(_OCF, _OGF) (u8)(HCIOPCODE(_OCF, _OGF)&0x00ff) -+#define HCIOPCODEHIGHT(_OCF, _OGF) (u8)(HCIOPCODE(_OCF, _OGF)>>8) -+#define HCI_OGF(opCode) (unsigned char)((0xFC00 & (opCode)) >> 10) -+#define HCI_OCF(opCode) ( 0x3FF & (opCode)) -+ -+ -+typedef enum _HCI_STATUS{ -+ HCI_STATUS_SUCCESS =0x00, //Success -+ HCI_STATUS_UNKNOW_HCI_CMD =0x01, //Unknown HCI Command -+ HCI_STATUS_UNKNOW_CONNECT_ID =0X02, //Unknown Connection Identifier -+ HCI_STATUS_HW_FAIL =0X03, //Hardware Failure -+ HCI_STATUS_PAGE_TIMEOUT =0X04, //Page Timeout -+ HCI_STATUS_AUTH_FAIL =0X05, //Authentication Failure -+ HCI_STATUS_PIN_OR_KEY_MISSING =0X06, //PIN or Key Missing -+ HCI_STATUS_MEM_CAP_EXCEED =0X07, //Memory Capacity Exceeded -+ HCI_STATUS_CONNECT_TIMEOUT =0X08, //Connection Timeout -+ HCI_STATUS_CONNECT_LIMIT =0X09, //Connection Limit Exceeded -+ HCI_STATUS_SYN_CONNECT_LIMIT =0X0a, //Synchronous Connection Limit To A Device Exceeded -+ HCI_STATUS_ACL_CONNECT_EXISTS =0X0b, //ACL Connection Already Exists -+ HCI_STATUS_CMD_DISALLOW =0X0c, //Command Disallowed -+ HCI_STATUS_CONNECT_RJT_LIMIT_RESOURCE =0X0d, //Connection Rejected due to Limited Resources -+ HCI_STATUS_CONNECT_RJT_SEC_REASON =0X0e, //Connection Rejected Due To Security Reasons -+ HCI_STATUS_CONNECT_RJT_UNACCEPT_BD_ADDR =0X0f, //Connection Rejected due to Unacceptable BD_ADDR -+ HCI_STATUS_CONNECT_ACCEPT_TIMEOUT =0X10, //Connection Accept Timeout Exceeded -+ HCI_STATUS_UNSUPPORT_FEATURE_PARA_VALUE =0X11, //Unsupported Feature or Parameter Value -+ HCI_STATUS_INVALID_HCI_CMD_PARA_VALUE =0X12, //Invalid HCI Command Parameters -+ HCI_STATUS_REMOTE_USER_TERMINATE_CONNECT =0X13, //Remote User Terminated Connection -+ HCI_STATUS_REMOTE_DEV_TERMINATE_LOW_RESOURCE =0X14, //Remote Device Terminated Connection due to Low Resources -+ HCI_STATUS_REMOTE_DEV_TERMINATE_CONNECT_POWER_OFF =0X15, //Remote Device Terminated Connection due to Power Off -+ HCI_STATUS_CONNECT_TERMINATE_LOCAL_HOST =0X16, //Connection Terminated By Local Host -+ HCI_STATUS_REPEATE_ATTEMPT =0X17, //Repeated Attempts -+ HCI_STATUS_PAIR_NOT_ALLOW =0X18, //Pairing Not Allowed -+ HCI_STATUS_UNKNOW_LMP_PDU =0X19, //Unknown LMP PDU -+ HCI_STATUS_UNSUPPORT_REMOTE_LMP_FEATURE =0X1a, //Unsupported Remote Feature / Unsupported LMP Feature -+ HCI_STATUS_SOC_OFFSET_REJECT =0X1b, //SCO Offset Rejected -+ HCI_STATUS_SOC_INTERVAL_REJECT =0X1c, //SCO Interval Rejected -+ HCI_STATUS_SOC_AIR_MODE_REJECT =0X1d,//SCO Air Mode Rejected -+ HCI_STATUS_INVALID_LMP_PARA =0X1e, //Invalid LMP Parameters -+ HCI_STATUS_UNSPECIFIC_ERROR =0X1f, //Unspecified Error -+ HCI_STATUS_UNSUPPORT_LMP_PARA_VALUE =0X20, //Unsupported LMP Parameter Value -+ HCI_STATUS_ROLE_CHANGE_NOT_ALLOW =0X21, //Role Change Not Allowed -+ HCI_STATUS_LMP_RESPONSE_TIMEOUT =0X22, //LMP Response Timeout -+ HCI_STATUS_LMP_ERROR_TRANSACTION_COLLISION =0X23, //LMP Error Transaction Collision -+ HCI_STATUS_LMP_PDU_NOT_ALLOW =0X24, //LMP PDU Not Allowed -+ HCI_STATUS_ENCRYPTION_MODE_NOT_ALLOW =0X25, //Encryption Mode Not Acceptable -+ HCI_STATUS_LINK_KEY_CAN_NOT_CHANGE =0X26, //Link Key Can Not be Changed -+ HCI_STATUS_REQUEST_QOS_NOT_SUPPORT =0X27, //Requested QoS Not Supported -+ HCI_STATUS_INSTANT_PASSED =0X28, //Instant Passed -+ HCI_STATUS_PAIRING_UNIT_KEY_NOT_SUPPORT =0X29, //Pairing With Unit Key Not Supported -+ HCI_STATUS_DIFFERENT_TRANSACTION_COLLISION =0X2a, //Different Transaction Collision -+ HCI_STATUS_RESERVE_1 =0X2b, //Reserved -+ HCI_STATUS_QOS_UNACCEPT_PARA =0X2c, //QoS Unacceptable Parameter -+ HCI_STATUS_QOS_REJECT =0X2d, //QoS Rejected -+ HCI_STATUS_CHNL_CLASSIFICATION_NOT_SUPPORT =0X2e, //Channel Classification Not Supported -+ HCI_STATUS_INSUFFICIENT_SECURITY =0X2f, //Insufficient Security -+ HCI_STATUS_PARA_OUT_OF_RANGE =0x30, //Parameter Out Of Mandatory Range -+ HCI_STATUS_RESERVE_2 =0X31, //Reserved -+ HCI_STATUS_ROLE_SWITCH_PENDING =0X32, //Role Switch Pending -+ HCI_STATUS_RESERVE_3 =0X33, //Reserved -+ HCI_STATUS_RESERVE_SOLT_VIOLATION =0X34, //Reserved Slot Violation -+ HCI_STATUS_ROLE_SWITCH_FAIL =0X35, //Role Switch Failed -+ HCI_STATUS_EXTEND_INQUIRY_RSP_TOO_LARGE =0X36, //Extended Inquiry Response Too Large -+ HCI_STATUS_SEC_SIMPLE_PAIRING_NOT_SUPPORT =0X37, //Secure Simple Pairing Not Supported By Host. -+ HCI_STATUS_HOST_BUSY_PAIRING =0X38, //Host Busy - Pairing -+ HCI_STATUS_CONNECT_REJ_NOT_SUIT_CHNL_FOUND =0X39, //Connection Rejected due to No Suitable Channel Found -+ HCI_STATUS_CONTROLLER_BUSY =0X3a //CONTROLLER BUSY -+}RTW_HCI_STATUS; -+ -+#define HCI_EVENT_COMMAND_COMPLETE 0x0e -+ -+#define OGF_EXTENSION 0X3f -+typedef enum HCI_EXTENSION_COMMANDS{ -+ HCI_SET_ACL_LINK_DATA_FLOW_MODE =0x0010, -+ HCI_SET_ACL_LINK_STATUS =0x0020, -+ HCI_SET_SCO_LINK_STATUS =0x0030, -+ HCI_SET_RSSI_VALUE =0x0040, -+ HCI_SET_CURRENT_BLUETOOTH_STATUS =0x0041, -+ -+ //The following is for RTK8723 -+ HCI_EXTENSION_VERSION_NOTIFY =0x0100, -+ HCI_LINK_STATUS_NOTIFY =0x0101, -+ HCI_BT_OPERATION_NOTIFY =0x0102, -+ HCI_ENABLE_WIFI_SCAN_NOTIFY =0x0103, -+ HCI_QUERY_RF_STATUS =0x0104, -+ HCI_BT_ABNORMAL_NOTIFY =0x0105, -+ HCI_BT_INFO_NOTIFY =0x0106, -+ HCI_BT_COEX_NOTIFY =0x0107, -+ HCI_BT_PATCH_VERSION_NOTIFY =0x0108, -+ HCI_BT_AFH_MAP_NOTIFY =0x0109, -+ HCI_BT_REGISTER_VALUE_NOTIFY =0x010a, -+ -+ //The following is for IVT -+ HCI_WIFI_CURRENT_CHANNEL =0x0300, -+ HCI_WIFI_CURRENT_BANDWIDTH =0x0301, -+ HCI_WIFI_CONNECTION_STATUS =0x0302 -+}RTW_HCI_EXT_CMD; -+ -+#define HCI_EVENT_EXTENSION_RTK 0xfe -+typedef enum HCI_EXTENSION_EVENT_RTK{ -+ HCI_EVENT_EXT_WIFI_SCAN_NOTIFY =0x01, -+ HCI_EVENT_EXT_WIFI_RF_STATUS_NOTIFY =0x02, -+ HCI_EVENT_EXT_BT_INFO_CONTROL =0x03, -+ HCI_EVENT_EXT_BT_COEX_CONTROL =0x04 -+}RTW_HCI_EXT_EVENT; -+ -+typedef enum _BT_TRAFFIC_MODE{ -+ BT_MOTOR_EXT_BE = 0x00, //Best Effort. Default. for HCRP, PAN, SDP, RFCOMM-based profiles like FTP,OPP, SPP, DUN, etc. -+ BT_MOTOR_EXT_GUL = 0x01, //Guaranteed Latency. This type of traffic is used e.g. for HID and AVRCP. -+ BT_MOTOR_EXT_GUB = 0X02, //Guaranteed Bandwidth. -+ BT_MOTOR_EXT_GULB = 0X03 //Guaranteed Latency and Bandwidth. for A2DP and VDP. -+} BT_TRAFFIC_MODE; -+ -+typedef enum _BT_TRAFFIC_MODE_PROFILE{ -+ BT_PROFILE_NONE, -+ BT_PROFILE_A2DP, -+ BT_PROFILE_PAN , -+ BT_PROFILE_HID, -+ BT_PROFILE_SCO -+} BT_TRAFFIC_MODE_PROFILE; -+ -+typedef enum _HCI_EXT_BT_OPERATION { -+ HCI_BT_OP_NONE = 0x0, -+ HCI_BT_OP_INQUIRY_START = 0x1, -+ HCI_BT_OP_INQUIRY_FINISH = 0x2, -+ HCI_BT_OP_PAGING_START = 0x3, -+ HCI_BT_OP_PAGING_SUCCESS = 0x4, -+ HCI_BT_OP_PAGING_UNSUCCESS = 0x5, -+ HCI_BT_OP_PAIRING_START = 0x6, -+ HCI_BT_OP_PAIRING_FINISH = 0x7, -+ HCI_BT_OP_BT_DEV_ENABLE = 0x8, -+ HCI_BT_OP_BT_DEV_DISABLE = 0x9, -+ HCI_BT_OP_MAX -+} HCI_EXT_BT_OPERATION, *PHCI_EXT_BT_OPERATION; -+ -+typedef struct _BT_MGNT{ -+ BOOLEAN bBTConnectInProgress; -+ BOOLEAN bLogLinkInProgress; -+ BOOLEAN bPhyLinkInProgress; -+ BOOLEAN bPhyLinkInProgressStartLL; -+ u1Byte BtCurrentPhyLinkhandle; -+ u2Byte BtCurrentLogLinkhandle; -+ u1Byte CurrentConnectEntryNum; -+ u1Byte DisconnectEntryNum; -+ u1Byte CurrentBTConnectionCnt; -+ BT_CONNECT_TYPE BTCurrentConnectType; -+ BT_CONNECT_TYPE BTReceiveConnectPkt; -+ u1Byte BTAuthCount; -+ u1Byte BTAsocCount; -+ BOOLEAN bStartSendSupervisionPkt; -+ BOOLEAN BtOperationOn; -+ BOOLEAN BTNeedAMPStatusChg; -+ BOOLEAN JoinerNeedSendAuth; -+ HCI_PHY_LINK_BSS_INFO bssDesc; -+ HCI_EXT_CONFIG ExtConfig; -+ BOOLEAN bNeedNotifyAMPNoCap; -+ BOOLEAN bCreateSpportQos; -+ BOOLEAN bSupportProfile; -+ u1Byte BTChannel; -+ BOOLEAN CheckChnlIsSuit; -+ BOOLEAN bBtScan; -+ BOOLEAN btLogoTest; -+ BOOLEAN bRfStatusNotified; -+ BOOLEAN bBtRsvedPageDownload; -+}BT_MGNT, *PBT_MGNT; -+ -+struct bt_coex_info { -+ /* For Kernel Socket */ -+ struct socket *udpsock; -+ struct sockaddr_in wifi_sockaddr; /*wifi socket*/ -+ struct sockaddr_in bt_sockaddr;/* BT socket */ -+ struct sock *sk_store;/*back up socket for UDP RX int*/ -+ -+ /* store which socket is OK */ -+ u8 sock_open; -+ -+ u8 BT_attend; -+ u8 is_exist; /* socket exist */ -+ BT_MGNT BtMgnt; -+ struct workqueue_struct *btcoex_wq; -+ struct delayed_work recvmsg_work; -+}; -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+ -+#define PACKET_NORMAL 0 -+#define PACKET_DHCP 1 -+#define PACKET_ARP 2 -+#define PACKET_EAPOL 3 -+ -+void rtw_btcoex_Initialize(PADAPTER); -+void rtw_btcoex_PowerOnSetting(PADAPTER padapter); -+void rtw_btcoex_PreLoadFirmware(PADAPTER padapter); -+void rtw_btcoex_HAL_Initialize(PADAPTER padapter, u8 bWifiOnly); -+void rtw_btcoex_IpsNotify(PADAPTER, u8 type); -+void rtw_btcoex_LpsNotify(PADAPTER, u8 type); -+void rtw_btcoex_ScanNotify(PADAPTER, u8 type); -+void rtw_btcoex_ConnectNotify(PADAPTER, u8 action); -+void rtw_btcoex_MediaStatusNotify(PADAPTER, u8 mediaStatus); -+void rtw_btcoex_SpecialPacketNotify(PADAPTER, u8 pktType); -+void rtw_btcoex_IQKNotify(PADAPTER padapter, u8 state); -+void rtw_btcoex_BtInfoNotify(PADAPTER, u8 length, u8 *tmpBuf); -+void rtw_btcoex_SuspendNotify(PADAPTER, u8 state); -+void rtw_btcoex_HaltNotify(PADAPTER); -+void rtw_btcoex_SwitchBtTRxMask(PADAPTER); -+void rtw_btcoex_Switch(PADAPTER, u8 enable); -+u8 rtw_btcoex_IsBtDisabled(PADAPTER); -+void rtw_btcoex_Handler(PADAPTER); -+s32 rtw_btcoex_IsBTCoexRejectAMPDU(PADAPTER padapter); -+s32 rtw_btcoex_IsBTCoexCtrlAMPDUSize(PADAPTER); -+u32 rtw_btcoex_GetAMPDUSize(PADAPTER); -+void rtw_btcoex_SetManualControl(PADAPTER, u8 bmanual); -+u8 rtw_btcoex_1Ant(PADAPTER); -+u8 rtw_btcoex_IsBtControlLps(PADAPTER); -+u8 rtw_btcoex_IsLpsOn(PADAPTER); -+u8 rtw_btcoex_RpwmVal(PADAPTER); -+u8 rtw_btcoex_LpsVal(PADAPTER); -+void rtw_btcoex_SetBTCoexist(PADAPTER, u8 bBtExist); -+void rtw_btcoex_SetChipType(PADAPTER, u8 chipType); -+void rtw_btcoex_SetPGAntNum(PADAPTER, u8 antNum); -+u8 rtw_btcoex_GetPGAntNum(PADAPTER); -+void rtw_btcoex_SetSingleAntPath(PADAPTER padapter, u8 singleAntPath); -+u32 rtw_btcoex_GetRaMask(PADAPTER); -+void rtw_btcoex_RecordPwrMode(PADAPTER, u8 *pCmdBuf, u8 cmdLen); -+void rtw_btcoex_DisplayBtCoexInfo(PADAPTER, u8 *pbuf, u32 bufsize); -+void rtw_btcoex_SetDBG(PADAPTER, u32 *pDbgModule); -+u32 rtw_btcoex_GetDBG(PADAPTER, u8 *pStrBuf, u32 bufSize); -+u8 rtw_btcoex_IncreaseScanDeviceNum(PADAPTER); -+u8 rtw_btcoex_IsBtLinkExist(PADAPTER); -+void rtw_btcoex_BTOffOnNotify(PADAPTER padapter, u8 bBTON); -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+void rtw_btcoex_SetBtPatchVersion(PADAPTER padapter,u16 btHciVer, u16 btPatchVer); -+void rtw_btcoex_SetHciVersion(PADAPTER padapter, u16 hciVersion); -+void rtw_btcoex_StackUpdateProfileInfo(void); -+void rtw_btcoex_init_socket(_adapter *padapter); -+void rtw_btcoex_close_socket(_adapter *padapter); -+void rtw_btcoex_dump_tx_msg(u8 *tx_msg, u8 len, u8 *msg_name); -+u8 rtw_btcoex_sendmsgbysocket(_adapter *padapter, u8 *msg, u8 msg_size, bool force); -+u8 rtw_btcoex_create_kernel_socket(_adapter *padapter); -+void rtw_btcoex_close_kernel_socket(_adapter *padapter); -+void rtw_btcoex_recvmsgbysocket(void *data); -+u16 rtw_btcoex_parse_recv_data(u8 *msg, u8 msg_size); -+u8 rtw_btcoex_btinfo_cmd(PADAPTER padapter, u8 *pbuf, u16 length); -+void rtw_btcoex_parse_hci_cmd(_adapter *padapter, u8 *cmd, u16 len); -+void rtw_btcoex_SendEventExtBtCoexControl(PADAPTER Adapter, u8 bNeedDbgRsp, u8 dataLen, void *pData); -+void rtw_btcoex_SendEventExtBtInfoControl(PADAPTER Adapter, u8 dataLen, void *pData); -+void rtw_btcoex_SendScanNotify(PADAPTER padapter, u8 scanType); -+#define BT_SendEventExtBtCoexControl(Adapter, bNeedDbgRsp, dataLen, pData) rtw_btcoex_SendEventExtBtCoexControl(Adapter, bNeedDbgRsp, dataLen, pData) -+#define BT_SendEventExtBtInfoControl(Adapter, dataLen, pData) rtw_btcoex_SendEventExtBtInfoControl(Adapter, dataLen, pData) -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+ -+// ================================================== -+// Below Functions are called by BT-Coex -+// ================================================== -+void rtw_btcoex_rx_ampdu_apply(PADAPTER); -+void rtw_btcoex_LPS_Enter(PADAPTER); -+void rtw_btcoex_LPS_Leave(PADAPTER); -+ -+#endif // __RTW_BTCOEX_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_bt_mp.h linux/3rdparty/rtl8812au/include/rtw_bt_mp.h ---- linux.old/3rdparty/rtl8812au/include/rtw_bt_mp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_bt_mp.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,319 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __RTW_BT_MP_H -+#define __RTW_BT_MP_H -+ -+ -+#if(MP_DRIVER == 1) -+ -+#pragma pack(1) -+ -+// definition for BT_UP_OP_BT_READY -+#define MP_BT_NOT_READY 0 -+#define MP_BT_READY 1 -+ -+// definition for BT_UP_OP_BT_SET_MODE -+typedef enum _MP_BT_MODE{ -+ MP_BT_MODE_RF_TXRX_TEST_MODE = 0, -+ MP_BT_MODE_BT20_DUT_TEST_MODE = 1, -+ MP_BT_MODE_BT40_DIRECT_TEST_MODE = 2, -+ MP_BT_MODE_CONNECT_TEST_MODE = 3, -+ MP_BT_MODE_MAX -+}MP_BT_MODE,*PMP_BT_MODE; -+ -+ -+// definition for BT_UP_OP_BT_SET_TX_RX_PARAMETER -+typedef struct _BT_TXRX_PARAMETERS{ -+ u1Byte txrxChannel; -+ u4Byte txrxTxPktCnt; -+ u1Byte txrxTxPktInterval; -+ u1Byte txrxPayloadType; -+ u1Byte txrxPktType; -+ u2Byte txrxPayloadLen; -+ u4Byte txrxPktHeader; -+ u1Byte txrxWhitenCoeff; -+ u1Byte txrxBdaddr[6]; -+ u1Byte txrxTxGainIndex; -+} BT_TXRX_PARAMETERS, *PBT_TXRX_PARAMETERS; -+ -+// txrxPktType -+typedef enum _MP_BT_PKT_TYPE{ -+ MP_BT_PKT_DH1 = 0, -+ MP_BT_PKT_DH3 = 1, -+ MP_BT_PKT_DH5 = 2, -+ MP_BT_PKT_2DH1 = 3, -+ MP_BT_PKT_2DH3 = 4, -+ MP_BT_PKT_2DH5 = 5, -+ MP_BT_PKT_3DH1 = 6, -+ MP_BT_PKT_3DH3 = 7, -+ MP_BT_PKT_3DH5 = 8, -+ MP_BT_PKT_LE = 9, -+ MP_BT_PKT_MAX -+}MP_BT_PKT_TYPE,*PMP_BT_PKT_TYPE; -+// txrxPayloadType -+typedef enum _MP_BT_PAYLOAD_TYPE{ -+ MP_BT_PAYLOAD_01010101 = 0, -+ MP_BT_PAYLOAD_ALL_1 = 1, -+ MP_BT_PAYLOAD_ALL_0 = 2, -+ MP_BT_PAYLOAD_11110000 = 3, -+ MP_BT_PAYLOAD_PRBS9 = 4, -+ MP_BT_PAYLOAD_MAX = 8, -+}MP_BT_PAYLOAD_TYPE,*PMP_BT_PAYLOAD_TYPE; -+ -+ -+// definition for BT_UP_OP_BT_TEST_CTRL -+typedef enum _MP_BT_TEST_CTRL{ -+ MP_BT_TEST_STOP_ALL_TESTS = 0, -+ MP_BT_TEST_START_RX_TEST = 1, -+ MP_BT_TEST_START_PACKET_TX_TEST = 2, -+ MP_BT_TEST_START_CONTINUOUS_TX_TEST = 3, -+ MP_BT_TEST_START_INQUIRY_SCAN_TEST = 4, -+ MP_BT_TEST_START_PAGE_SCAN_TEST = 5, -+ MP_BT_TEST_START_INQUIRY_PAGE_SCAN_TEST = 6, -+ MP_BT_TEST_START_LEGACY_CONNECT_TEST = 7, -+ MP_BT_TEST_START_LE_CONNECT_TEST_INITIATOR = 8, -+ MP_BT_TEST_START_LE_CONNECT_TEST_ADVERTISER = 9, -+ MP_BT_TEST_MAX -+}MP_BT_TEST_CTRL,*PMP_BT_TEST_CTRL; -+ -+ -+typedef enum _RTL_EXT_C2H_EVT -+{ -+ EXT_C2H_WIFI_FW_ACTIVE_RSP = 0, -+ EXT_C2H_TRIG_BY_BT_FW = 1, -+ MAX_EXT_C2HEVENT -+}RTL_EXT_C2H_EVT; -+ -+ -+// return status definition to the user layer -+typedef enum _BT_CTRL_STATUS{ -+ BT_STATUS_SUCCESS = 0x00, // Success -+ BT_STATUS_BT_OP_SUCCESS = 0x01, // bt fw op execution success -+ BT_STATUS_H2C_SUCCESS = 0x02, // H2c success -+ BT_STATUS_H2C_TIMTOUT = 0x03, // H2c timeout -+ BT_STATUS_H2C_BT_NO_RSP = 0x04, // H2c sent, bt no rsp -+ BT_STATUS_C2H_SUCCESS = 0x05, // C2h success -+ BT_STATUS_C2H_REQNUM_MISMATCH = 0x06, // bt fw wrong rsp -+ BT_STATUS_OPCODE_U_VERSION_MISMATCH = 0x07, // Upper layer OP code version mismatch. -+ BT_STATUS_OPCODE_L_VERSION_MISMATCH = 0x08, // Lower layer OP code version mismatch. -+ BT_STATUS_UNKNOWN_OPCODE_U = 0x09, // Unknown Upper layer OP code -+ BT_STATUS_UNKNOWN_OPCODE_L = 0x0a, // Unknown Lower layer OP code -+ BT_STATUS_PARAMETER_FORMAT_ERROR_U = 0x0b, // Wrong parameters sent by upper layer. -+ BT_STATUS_PARAMETER_FORMAT_ERROR_L = 0x0c, // bt fw parameter format is not consistency -+ BT_STATUS_PARAMETER_OUT_OF_RANGE_U = 0x0d, // uppery layer parameter value is out of range -+ BT_STATUS_PARAMETER_OUT_OF_RANGE_L = 0x0e, // bt fw parameter value is out of range -+ BT_STATUS_UNKNOWN_STATUS_L = 0x0f, // bt returned an defined status code -+ BT_STATUS_UNKNOWN_STATUS_H = 0x10, // driver need to do error handle or not handle-well. -+ BT_STATUS_WRONG_LEVEL = 0x11, // should be under passive level -+ BT_STATUS_MAX -+}BT_CTRL_STATUS,*PBT_CTRL_STATUS; -+ -+// OP codes definition between the user layer and driver -+typedef enum _BT_CTRL_OPCODE_UPPER{ -+ BT_UP_OP_BT_READY = 0x00, -+ BT_UP_OP_BT_SET_MODE = 0x01, -+ BT_UP_OP_BT_SET_TX_RX_PARAMETER = 0x02, -+ BT_UP_OP_BT_SET_GENERAL = 0x03, -+ BT_UP_OP_BT_GET_GENERAL = 0x04, -+ BT_UP_OP_BT_TEST_CTRL = 0x05, -+ BT_UP_OP_TEST_BT = 0x06, -+ BT_UP_OP_MAX -+}BT_CTRL_OPCODE_UPPER,*PBT_CTRL_OPCODE_UPPER; -+ -+ -+typedef enum _BT_SET_GENERAL{ -+ BT_GSET_REG = 0x00, -+ BT_GSET_RESET = 0x01, -+ BT_GSET_TARGET_BD_ADDR = 0x02, -+ BT_GSET_TX_PWR_FINETUNE = 0x03, -+ BT_SET_TRACKING_INTERVAL = 0x04, -+ BT_SET_THERMAL_METER = 0x05, -+ BT_ENABLE_CFO_TRACKING = 0x06, -+ BT_GSET_UPDATE_BT_PATCH = 0x07, -+ BT_GSET_MAX -+}BT_SET_GENERAL,*PBT_SET_GENERAL; -+ -+typedef enum _BT_GET_GENERAL{ -+ BT_GGET_REG = 0x00, -+ BT_GGET_STATUS = 0x01, -+ BT_GGET_REPORT = 0x02, -+ BT_GGET_AFH_MAP = 0x03, -+ BT_GGET_AFH_STATUS = 0x04, -+ BT_GGET_MAX -+}BT_GET_GENERAL,*PBT_GET_GENERAL; -+ -+// definition for BT_UP_OP_BT_SET_GENERAL -+typedef enum _BT_REG_TYPE{ -+ BT_REG_RF = 0, -+ BT_REG_MODEM = 1, -+ BT_REG_BLUEWIZE = 2, -+ BT_REG_VENDOR = 3, -+ BT_REG_LE = 4, -+ BT_REG_MAX -+}BT_REG_TYPE,*PBT_REG_TYPE; -+ -+// definition for BT_LO_OP_GET_AFH_MAP -+typedef enum _BT_AFH_MAP_TYPE{ -+ BT_AFH_MAP_RESULT = 0, -+ BT_AFH_MAP_WIFI_PSD_ONLY = 1, -+ BT_AFH_MAP_WIFI_CH_BW_ONLY = 2, -+ BT_AFH_MAP_BT_PSD_ONLY = 3, -+ BT_AFH_MAP_HOST_CLASSIFICATION_ONLY = 4, -+ BT_AFH_MAP_MAX -+}BT_AFH_MAP_TYPE,*PBT_AFH_MAP_TYPE; -+ -+// definition for BT_UP_OP_BT_GET_GENERAL -+typedef enum _BT_REPORT_TYPE{ -+ BT_REPORT_RX_PACKET_CNT = 0, -+ BT_REPORT_RX_ERROR_BITS = 1, -+ BT_REPORT_RSSI = 2, -+ BT_REPORT_CFO_HDR_QUALITY = 3, -+ BT_REPORT_CONNECT_TARGET_BD_ADDR = 4, -+ BT_REPORT_MAX -+}BT_REPORT_TYPE,*PBT_REPORT_TYPE; -+ -+VOID -+MPTBT_Test( -+ IN PADAPTER Adapter, -+ IN u1Byte opCode, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3 -+ ); -+ -+NDIS_STATUS -+MPTBT_SendOidBT( -+ IN PADAPTER pAdapter, -+ IN PVOID InformationBuffer, -+ IN ULONG InformationBufferLength, -+ OUT PULONG BytesRead, -+ OUT PULONG BytesNeeded -+ ); -+ -+VOID -+MPTBT_FwC2hBtMpCtrl( -+ PADAPTER Adapter, -+ pu1Byte tmpBuf, -+ u1Byte length -+ ); -+ -+void MPh2c_timeout_handle(void *FunctionContext); -+ -+VOID mptbt_BtControlProcess( -+ PADAPTER Adapter, -+ PVOID pInBuf -+ ); -+ -+#define BT_H2C_MAX_RETRY 1 -+#define BT_MAX_C2H_LEN 20 -+ -+typedef struct _BT_REQ_CMD{ -+ UCHAR opCodeVer; -+ UCHAR OpCode; -+ USHORT paraLength; -+ UCHAR pParamStart[100]; -+} BT_REQ_CMD, *PBT_REQ_CMD; -+ -+typedef struct _BT_RSP_CMD{ -+ USHORT status; -+ USHORT paraLength; -+ UCHAR pParamStart[100]; -+} BT_RSP_CMD, *PBT_RSP_CMD; -+ -+ -+typedef struct _BT_H2C{ -+ u1Byte opCodeVer:4; -+ u1Byte reqNum:4; -+ u1Byte opCode; -+ u1Byte buf[100]; -+}BT_H2C, *PBT_H2C; -+ -+ -+ -+typedef struct _BT_EXT_C2H{ -+ u1Byte extendId; -+ u1Byte statusCode:4; -+ u1Byte retLen:4; -+ u1Byte opCodeVer:4; -+ u1Byte reqNum:4; -+ u1Byte buf[100]; -+}BT_EXT_C2H, *PBT_EXT_C2H; -+ -+ -+typedef enum _BT_OPCODE_STATUS{ -+ BT_OP_STATUS_SUCCESS = 0x00, // Success -+ BT_OP_STATUS_VERSION_MISMATCH = 0x01, -+ BT_OP_STATUS_UNKNOWN_OPCODE = 0x02, -+ BT_OP_STATUS_ERROR_PARAMETER = 0x03, -+ BT_OP_STATUS_MAX -+}BT_OPCODE_STATUS,*PBT_OPCODE_STATUS; -+ -+ -+ -+//OP codes definition between driver and bt fw -+typedef enum _BT_CTRL_OPCODE_LOWER{ -+ BT_LO_OP_GET_BT_VERSION = 0x00, -+ BT_LO_OP_RESET = 0x01, -+ BT_LO_OP_TEST_CTRL = 0x02, -+ BT_LO_OP_SET_BT_MODE = 0x03, -+ BT_LO_OP_SET_CHNL_TX_GAIN = 0x04, -+ BT_LO_OP_SET_PKT_TYPE_LEN = 0x05, -+ BT_LO_OP_SET_PKT_CNT_L_PL_TYPE = 0x06, -+ BT_LO_OP_SET_PKT_CNT_H_PKT_INTV = 0x07, -+ BT_LO_OP_SET_PKT_HEADER = 0x08, -+ BT_LO_OP_SET_WHITENCOEFF = 0x09, -+ BT_LO_OP_SET_BD_ADDR_L = 0x0a, -+ BT_LO_OP_SET_BD_ADDR_H = 0x0b, -+ BT_LO_OP_WRITE_REG_ADDR = 0x0c, -+ BT_LO_OP_WRITE_REG_VALUE = 0x0d, -+ BT_LO_OP_GET_BT_STATUS = 0x0e, -+ BT_LO_OP_GET_BD_ADDR_L = 0x0f, -+ BT_LO_OP_GET_BD_ADDR_H = 0x10, -+ BT_LO_OP_READ_REG = 0x11, -+ BT_LO_OP_SET_TARGET_BD_ADDR_L = 0x12, -+ BT_LO_OP_SET_TARGET_BD_ADDR_H = 0x13, -+ BT_LO_OP_SET_TX_POWER_CALIBRATION = 0x14, -+ BT_LO_OP_GET_RX_PKT_CNT_L = 0x15, -+ BT_LO_OP_GET_RX_PKT_CNT_H = 0x16, -+ BT_LO_OP_GET_RX_ERROR_BITS_L = 0x17, -+ BT_LO_OP_GET_RX_ERROR_BITS_H = 0x18, -+ BT_LO_OP_GET_RSSI = 0x19, -+ BT_LO_OP_GET_CFO_HDR_QUALITY_L = 0x1a, -+ BT_LO_OP_GET_CFO_HDR_QUALITY_H = 0x1b, -+ BT_LO_OP_GET_TARGET_BD_ADDR_L = 0x1c, -+ BT_LO_OP_GET_TARGET_BD_ADDR_H = 0x1d, -+ BT_LO_OP_GET_AFH_MAP_L = 0x1e, -+ BT_LO_OP_GET_AFH_MAP_M = 0x1f, -+ BT_LO_OP_GET_AFH_MAP_H = 0x20, -+ BT_LO_OP_GET_AFH_STATUS = 0x21, -+ BT_LO_OP_SET_TRACKING_INTERVAL = 0x22, -+ BT_LO_OP_SET_THERMAL_METER = 0x23, -+ BT_LO_OP_ENABLE_CFO_TRACKING = 0x24, -+ BT_LO_OP_MAX -+}BT_CTRL_OPCODE_LOWER,*PBT_CTRL_OPCODE_LOWER; -+ -+ -+ -+ -+#endif /* #if(MP_DRIVER == 1) */ -+ -+#endif // #ifndef __INC_MPT_BT_H -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_byteorder.h linux/3rdparty/rtl8812au/include/rtw_byteorder.h ---- linux.old/3rdparty/rtl8812au/include/rtw_byteorder.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_byteorder.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,39 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_bt_mp.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_bt_mp.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_bt_mp.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_bt_mp.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,291 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -325311,40 +142931,320 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_byteorder.h linux/3rdparty/r + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++ ++#ifndef __RTW_BT_MP_H ++#define __RTW_BT_MP_H ++ ++ ++#if(MP_DRIVER == 1) ++ ++#pragma pack(1) ++ ++// definition for BT_UP_OP_BT_READY ++#define MP_BT_NOT_READY 0 ++#define MP_BT_READY 1 ++ ++// definition for BT_UP_OP_BT_SET_MODE ++typedef enum _MP_BT_MODE{ ++ MP_BT_MODE_RF_TXRX_TEST_MODE = 0, ++ MP_BT_MODE_BT20_DUT_TEST_MODE = 1, ++ MP_BT_MODE_BT40_DIRECT_TEST_MODE = 2, ++ MP_BT_MODE_CONNECT_TEST_MODE = 3, ++ MP_BT_MODE_MAX ++}MP_BT_MODE,*PMP_BT_MODE; ++ ++ ++// definition for BT_UP_OP_BT_SET_TX_RX_PARAMETER ++typedef struct _BT_TXRX_PARAMETERS{ ++ u1Byte txrxChannel; ++ u4Byte txrxTxPktCnt; ++ u1Byte txrxTxPktInterval; ++ u1Byte txrxPayloadType; ++ u1Byte txrxPktType; ++ u2Byte txrxPayloadLen; ++ u4Byte txrxPktHeader; ++ u1Byte txrxWhitenCoeff; ++ u1Byte txrxBdaddr[6]; ++ u1Byte txrxTxGainIndex; ++} BT_TXRX_PARAMETERS, *PBT_TXRX_PARAMETERS; ++ ++// txrxPktType ++typedef enum _MP_BT_PKT_TYPE{ ++ MP_BT_PKT_DH1 = 0, ++ MP_BT_PKT_DH3 = 1, ++ MP_BT_PKT_DH5 = 2, ++ MP_BT_PKT_2DH1 = 3, ++ MP_BT_PKT_2DH3 = 4, ++ MP_BT_PKT_2DH5 = 5, ++ MP_BT_PKT_3DH1 = 6, ++ MP_BT_PKT_3DH3 = 7, ++ MP_BT_PKT_3DH5 = 8, ++ MP_BT_PKT_LE = 9, ++ MP_BT_PKT_MAX ++}MP_BT_PKT_TYPE,*PMP_BT_PKT_TYPE; ++// txrxPayloadType ++typedef enum _MP_BT_PAYLOAD_TYPE{ ++ MP_BT_PAYLOAD_01010101 = 0, ++ MP_BT_PAYLOAD_ALL_1 = 1, ++ MP_BT_PAYLOAD_ALL_0 = 2, ++ MP_BT_PAYLOAD_11110000 = 3, ++ MP_BT_PAYLOAD_PRBS9 = 4, ++ MP_BT_PAYLOAD_MAX ++}MP_BT_PAYLOAD_TYPE,*PMP_BT_PAYLOAD_TYPE; ++ ++ ++// definition for BT_UP_OP_BT_TEST_CTRL ++typedef enum _MP_BT_TEST_CTRL{ ++ MP_BT_TEST_STOP_ALL_TESTS = 0, ++ MP_BT_TEST_START_RX_TEST = 1, ++ MP_BT_TEST_START_PACKET_TX_TEST = 2, ++ MP_BT_TEST_START_CONTINUOUS_TX_TEST = 3, ++ MP_BT_TEST_START_INQUIRY_SCAN_TEST = 4, ++ MP_BT_TEST_START_PAGE_SCAN_TEST = 5, ++ MP_BT_TEST_START_INQUIRY_PAGE_SCAN_TEST = 6, ++ MP_BT_TEST_START_LEGACY_CONNECT_TEST = 7, ++ MP_BT_TEST_START_LE_CONNECT_TEST_INITIATOR = 8, ++ MP_BT_TEST_START_LE_CONNECT_TEST_ADVERTISER = 9, ++ MP_BT_TEST_MAX ++}MP_BT_TEST_CTRL,*PMP_BT_TEST_CTRL; ++ ++ ++typedef enum _RTL_EXT_C2H_EVT ++{ ++ EXT_C2H_WIFI_FW_ACTIVE_RSP = 0, ++ EXT_C2H_TRIG_BY_BT_FW = 1, ++ MAX_EXT_C2HEVENT ++}RTL_EXT_C2H_EVT; ++ ++ ++// return status definition to the user layer ++typedef enum _BT_CTRL_STATUS{ ++ BT_STATUS_SUCCESS = 0x00, // Success ++ BT_STATUS_BT_OP_SUCCESS = 0x01, // bt fw op execution success ++ BT_STATUS_H2C_SUCCESS = 0x02, // H2c success ++ BT_STATUS_H2C_TIMTOUT = 0x03, // H2c timeout ++ BT_STATUS_H2C_BT_NO_RSP = 0x04, // H2c sent, bt no rsp ++ BT_STATUS_C2H_SUCCESS = 0x05, // C2h success ++ BT_STATUS_C2H_REQNUM_MISMATCH = 0x06, // bt fw wrong rsp ++ BT_STATUS_OPCODE_U_VERSION_MISMATCH = 0x07, // Upper layer OP code version mismatch. ++ BT_STATUS_OPCODE_L_VERSION_MISMATCH = 0x08, // Lower layer OP code version mismatch. ++ BT_STATUS_UNKNOWN_OPCODE_U = 0x09, // Unknown Upper layer OP code ++ BT_STATUS_UNKNOWN_OPCODE_L = 0x0a, // Unknown Lower layer OP code ++ BT_STATUS_PARAMETER_FORMAT_ERROR_U = 0x0b, // Wrong parameters sent by upper layer. ++ BT_STATUS_PARAMETER_FORMAT_ERROR_L = 0x0c, // bt fw parameter format is not consistency ++ BT_STATUS_PARAMETER_OUT_OF_RANGE_U = 0x0d, // uppery layer parameter value is out of range ++ BT_STATUS_PARAMETER_OUT_OF_RANGE_L = 0x0e, // bt fw parameter value is out of range ++ BT_STATUS_UNKNOWN_STATUS_L = 0x0f, // bt returned an defined status code ++ BT_STATUS_UNKNOWN_STATUS_H = 0x10, // driver need to do error handle or not handle-well. ++ BT_STATUS_WRONG_LEVEL = 0x11, // should be under passive level ++ BT_STATUS_MAX ++}BT_CTRL_STATUS,*PBT_CTRL_STATUS; ++ ++// OP codes definition between the user layer and driver ++typedef enum _BT_CTRL_OPCODE_UPPER{ ++ BT_UP_OP_BT_READY = 0x00, ++ BT_UP_OP_BT_SET_MODE = 0x01, ++ BT_UP_OP_BT_SET_TX_RX_PARAMETER = 0x02, ++ BT_UP_OP_BT_SET_GENERAL = 0x03, ++ BT_UP_OP_BT_GET_GENERAL = 0x04, ++ BT_UP_OP_BT_TEST_CTRL = 0x05, ++ BT_UP_OP_TEST_BT = 0x06, ++ BT_UP_OP_MAX ++}BT_CTRL_OPCODE_UPPER,*PBT_CTRL_OPCODE_UPPER; ++ ++ ++typedef enum _BT_SET_GENERAL{ ++ BT_GSET_REG = 0x00, ++ BT_GSET_RESET = 0x01, ++ BT_GSET_TARGET_BD_ADDR = 0x02, ++ BT_GSET_TX_PWR_FINETUNE = 0x03, ++ BT_GSET_UPDATE_BT_PATCH = 0x04, ++ BT_GSET_MAX ++}BT_SET_GENERAL,*PBT_SET_GENERAL; ++ ++typedef enum _BT_GET_GENERAL{ ++ BT_GGET_REG = 0x00, ++ BT_GGET_STATUS = 0x01, ++ BT_GGET_REPORT = 0x02, ++ BT_GGET_MAX ++}BT_GET_GENERAL,*PBT_GET_GENERAL; ++ ++// definition for BT_UP_OP_BT_SET_GENERAL ++typedef enum _BT_REG_TYPE{ ++ BT_REG_RF = 0, ++ BT_REG_MODEM = 1, ++ BT_REG_BLUEWIZE = 2, ++ BT_REG_VENDOR = 3, ++ BT_REG_LE = 4, ++ BT_REG_MAX ++}BT_REG_TYPE,*PBT_REG_TYPE; ++ ++ ++// definition for BT_UP_OP_BT_GET_GENERAL ++typedef enum _BT_REPORT_TYPE{ ++ BT_REPORT_RX_PACKET_CNT = 0, ++ BT_REPORT_RX_ERROR_BITS = 1, ++ BT_REPORT_RSSI = 2, ++ BT_REPORT_CFO_HDR_QUALITY = 3, ++ BT_REPORT_CONNECT_TARGET_BD_ADDR = 4, ++ BT_REPORT_MAX ++}BT_REPORT_TYPE,*PBT_REPORT_TYPE; ++ ++void ++MPTBT_Test( ++ PADAPTER Adapter, ++ u1Byte opCode, ++ u1Byte byte1, ++ u1Byte byte2, ++ u1Byte byte3 ++ ); ++ ++uint ++MPTBT_SendOidBT( ++ PADAPTER pAdapter, ++ void * InformationBuffer, ++ u32 InformationBufferLength, ++ Pu32 BytesRead, ++ Pu32 BytesNeeded ++ ); ++ ++void ++MPTBT_FwC2hBtMpCtrl( ++ PADAPTER Adapter, ++ pu1Byte tmpBuf, ++ u1Byte length ++ ); ++ ++void MPh2c_timeout_handle(void *FunctionContext); ++ ++void mptbt_BtControlProcess( ++ PADAPTER Adapter, ++ void * pInBuf ++ ); ++ ++#define BT_H2C_MAX_RETRY 1 ++#define BT_MAX_C2H_LEN 20 ++ ++typedef struct _BT_REQ_CMD{ ++ u8 opCodeVer; ++ u8 OpCode; ++ u16 paraLength; ++ u8 pParamStart[100]; ++} BT_REQ_CMD, *PBT_REQ_CMD; ++ ++typedef struct _BT_RSP_CMD{ ++ u16 status; ++ u16 paraLength; ++ u8 pParamStart[100]; ++} BT_RSP_CMD, *PBT_RSP_CMD; ++ ++ ++typedef struct _BT_H2C{ ++ u1Byte opCodeVer:4; ++ u1Byte reqNum:4; ++ u1Byte opCode; ++ u1Byte buf[100]; ++}BT_H2C, *PBT_H2C; ++ ++ ++ ++typedef struct _BT_EXT_C2H{ ++ u1Byte extendId; ++ u1Byte statusCode:4; ++ u1Byte retLen:4; ++ u1Byte opCodeVer:4; ++ u1Byte reqNum:4; ++ u1Byte buf[100]; ++}BT_EXT_C2H, *PBT_EXT_C2H; ++ ++ ++typedef enum _BT_OPCODE_STATUS{ ++ BT_OP_STATUS_SUCCESS = 0x00, // Success ++ BT_OP_STATUS_VERSION_MISMATCH = 0x01, ++ BT_OP_STATUS_UNKNOWN_OPCODE = 0x02, ++ BT_OP_STATUS_ERROR_PARAMETER = 0x03, ++ BT_OP_STATUS_MAX ++}BT_OPCODE_STATUS,*PBT_OPCODE_STATUS; ++ ++ ++ ++//OP codes definition between driver and bt fw ++typedef enum _BT_CTRL_OPCODE_LOWER{ ++ BT_LO_OP_GET_BT_VERSION = 0x00, ++ BT_LO_OP_RESET = 0x01, ++ BT_LO_OP_TEST_CTRL = 0x02, ++ BT_LO_OP_SET_BT_MODE = 0x03, ++ BT_LO_OP_SET_CHNL_TX_GAIN = 0x04, ++ BT_LO_OP_SET_PKT_TYPE_LEN = 0x05, ++ BT_LO_OP_SET_PKT_CNT_L_PL_TYPE = 0x06, ++ BT_LO_OP_SET_PKT_CNT_H_PKT_INTV = 0x07, ++ BT_LO_OP_SET_PKT_HEADER = 0x08, ++ BT_LO_OP_SET_WHITENCOEFF = 0x09, ++ BT_LO_OP_SET_BD_ADDR_L = 0x0a, ++ BT_LO_OP_SET_BD_ADDR_H = 0x0b, ++ BT_LO_OP_WRITE_REG_ADDR = 0x0c, ++ BT_LO_OP_WRITE_REG_VALUE = 0x0d, ++ BT_LO_OP_GET_BT_STATUS = 0x0e, ++ BT_LO_OP_GET_BD_ADDR_L = 0x0f, ++ BT_LO_OP_GET_BD_ADDR_H = 0x10, ++ BT_LO_OP_READ_REG = 0x11, ++ BT_LO_OP_SET_TARGET_BD_ADDR_L = 0x12, ++ BT_LO_OP_SET_TARGET_BD_ADDR_H = 0x13, ++ BT_LO_OP_SET_TX_POWER_CALIBRATION = 0x14, ++ BT_LO_OP_GET_RX_PKT_CNT_L = 0x15, ++ BT_LO_OP_GET_RX_PKT_CNT_H = 0x16, ++ BT_LO_OP_GET_RX_ERROR_BITS_L = 0x17, ++ BT_LO_OP_GET_RX_ERROR_BITS_H = 0x18, ++ BT_LO_OP_GET_RSSI = 0x19, ++ BT_LO_OP_GET_CFO_HDR_QUALITY_L = 0x1a, ++ BT_LO_OP_GET_CFO_HDR_QUALITY_H = 0x1b, ++ BT_LO_OP_GET_TARGET_BD_ADDR_L = 0x1c, ++ BT_LO_OP_GET_TARGET_BD_ADDR_H = 0x1d, ++ BT_LO_OP_MAX ++}BT_CTRL_OPCODE_LOWER,*PBT_CTRL_OPCODE_LOWER; ++ ++ ++ ++#endif /* #if(MP_DRIVER == 1) */ ++ ++#endif // #ifndef __INC_MPT_BT_H +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_byteorder.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_byteorder.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_byteorder.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_byteorder.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,24 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#ifndef _RTL871X_BYTEORDER_H_ +#define _RTL871X_BYTEORDER_H_ + -+ -+#if defined (CONFIG_LITTLE_ENDIAN) && defined (CONFIG_BIG_ENDIAN) -+#error "Shall be CONFIG_LITTLE_ENDIAN or CONFIG_BIG_ENDIAN, but not both!\n" -+#endif -+ -+#if defined (CONFIG_LITTLE_ENDIAN) -+#ifndef CONFIG_PLATFORM_MSTAR389 ++#if defined (__LITTLE_ENDIAN) +# include -+#endif -+#elif defined (CONFIG_BIG_ENDIAN) -+# include +#else -+# error "Must be LITTLE/BIG Endian Host" ++# include +#endif + +#endif /* _RTL871X_BYTEORDER_H_ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812au/include/rtw_cmd.h ---- linux.old/3rdparty/rtl8812au/include/rtw_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_cmd.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,1308 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_cmd.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_cmd.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_cmd.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_cmd.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,1148 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -325354,11 +143254,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __RTW_CMD_H_ +#define __RTW_CMD_H_ @@ -325366,19 +143261,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + +#define C2H_MEM_SZ (16*1024) + -+#ifndef CONFIG_RTL8711FW -+ + #define FREE_CMDOBJ_SZ 128 -+ ++ + #define MAX_CMDSZ 1024 + #define MAX_RSPSZ 512 + #define MAX_EVTSZ 1024 + -+#ifdef PLATFORM_OS_CE -+ #define CMDBUFF_ALIGN_SZ 4 -+#else + #define CMDBUFF_ALIGN_SZ 512 -+#endif + + struct cmd_obj { + _adapter *padapter; @@ -325388,35 +143277,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + u32 cmdsz; + u8 *rsp; + u32 rspsz; -+ struct submit_ctx *sctx; -+ //_sema cmd_sem; ++ //_sema cmd_sem; + _list list; + }; + -+ /* cmd flags */ -+ enum { -+ RTW_CMDF_DIRECTLY = BIT0, -+ RTW_CMDF_WAIT_ACK = BIT1, -+ }; -+ + struct cmd_priv { + _sema cmd_queue_sema; + //_sema cmd_done_sema; -+ _sema terminate_cmdthread_sema; ++ _sema terminate_cmdthread_sema; + _queue cmd_queue; + u8 cmd_seq; + u8 *cmd_buf; //shall be non-paged, and 4 bytes aligned + u8 *cmd_allocated_buf; -+ u8 *rsp_buf; //shall be non-paged, and 4 bytes aligned ++ u8 *rsp_buf; //shall be non-paged, and 4 bytes aligned + u8 *rsp_allocated_buf; + u32 cmd_issued_cnt; + u32 cmd_done_cnt; + u32 rsp_cnt; -+ ATOMIC_T cmdthd_running; -+ //u8 cmdthd_running; -+ u8 stop_req; ++ u8 cmdthd_running; + _adapter *padapter; -+ _mutex sctx_mutex; + }; + +#ifdef CONFIG_EVENT_THREAD_MODE @@ -325424,7 +143303,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + u16 evtcode; + u8 res; + u8 *parmbuf; -+ u32 evtsz; ++ u32 evtsz; + _list list; + }; +#endif @@ -325443,25 +143322,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + struct rtw_cbuf *c2h_queue; + #define C2H_QUEUE_MAX_LEN 10 +#endif -+ ++ +#ifdef CONFIG_H2CLBK + _sema lbkevt_done; + u8 lbkevt_limit; + u8 lbkevt_num; -+ u8 *cmdevt_parm; ++ u8 *cmdevt_parm; +#endif + ATOMIC_T event_seq; -+ u8 *evt_buf; //shall be non-paged, and 4 bytes aligned ++ u8 *evt_buf; //shall be non-paged, and 4 bytes aligned + u8 *evt_allocated_buf; + u32 evt_done_cnt; -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ u8 *c2h_mem; -+ u8 *allocated_c2h_mem; -+#ifdef PLATFORM_OS_XP -+ PMDL pc2h_mdl; -+#endif -+#endif -+ + }; + +#define init_h2fwcmd_w_parm_no_rsp(pcmd, pparm, code) \ @@ -325474,16 +143345,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + pcmd->rspsz = 0;\ +} while(0) + -+#define init_h2fwcmd_w_parm_no_parm_rsp(pcmd, code) \ -+do {\ -+ _rtw_init_listhead(&pcmd->list);\ -+ pcmd->cmdcode = code;\ -+ pcmd->parmbuf = NULL;\ -+ pcmd->cmdsz = 0;\ -+ pcmd->rsp = NULL;\ -+ pcmd->rspsz = 0;\ -+} while(0) -+ +struct c2h_evt_hdr { + u8 id:4; + u8 plen:4; @@ -325491,16 +143352,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + u8 payload[0]; +}; + -+struct c2h_evt_hdr_88xx { -+ u8 id; -+ u8 seq; -+ u8 payload[12]; -+ u8 plen; -+ u8 trigger; -+}; -+ -+#define c2h_evt_valid(c2h_evt) ((c2h_evt)->id || (c2h_evt)->plen) -+ +struct P2P_PS_Offload_t { + u8 Offload_En:1; + u8 role:1; // 1: Owner, 0: Client @@ -325516,15 +143367,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + u8 CTWPeriod; //TU +}; + -+#ifdef CONFIG_P2P_WOWLAN -+ -+struct P2P_WoWlan_Offload_t{ -+ u8 Disconnect_Wkup_Drv:1; -+ u8 role:2; -+ u8 Wps_Config[2]; -+}; -+ -+#endif //CONFIG_P2P_WOWLAN ++#define c2h_evt_exist(c2h_evt) ((c2h_evt)->id || (c2h_evt)->plen) + +extern u32 rtw_enqueue_cmd(struct cmd_priv *pcmdpriv, struct cmd_obj *obj); +extern struct cmd_obj *rtw_dequeue_cmd(struct cmd_priv *pcmdpriv); @@ -325536,7 +143379,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 +extern void rtw_free_evt_obj(struct evt_obj *pcmd); +#endif + -+void rtw_stop_cmd_thread(_adapter *adapter); +thread_return rtw_cmd_thread(thread_context context); + +extern u32 rtw_init_cmd_priv (struct cmd_priv *pcmdpriv); @@ -325550,12 +143392,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 +u8 p2p_protocol_wk_cmd(_adapter*padapter, int intCmdType ); +#endif //CONFIG_P2P + -+#else -+ //#include -+#endif /* CONFIG_RTL8711FW */ -+ +enum rtw_drvextra_cmd_id -+{ ++{ + NONE_WK_CID, + DYNAMIC_CHK_WK_CID, + DM_CTRL_WK_CID, @@ -325569,14 +143407,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + INTEl_WIDI_WK_CID, + C2H_WK_CID, + RTP_TIMER_CFG_WK_CID, -+ RESET_SECURITYPRIV, // add for CONFIG_IEEE80211W, none 11w also can use -+ FREE_ASSOC_RESOURCES, // add for CONFIG_IEEE80211W, none 11w also can use -+ DM_IN_LPS_WK_CID, -+ DM_RA_MSK_WK_CID, //add for STA update RAMask when bandwith change. -+ BEAMFORMING_WK_CID, -+ LPS_CHANGE_DTIM_CID, -+ BTINFO_WK_CID, -+ DFS_MASTER_WK_CID, + MAX_WK_CID +}; + @@ -325588,17 +143418,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + LPS_CTRL_DISCONNECT=3, + LPS_CTRL_SPECIAL_PACKET=4, + LPS_CTRL_LEAVE=5, -+ LPS_CTRL_TRAFFIC_BUSY = 6, -+ LPS_CTRL_TX_TRAFFIC_LEAVE = 7, -+ LPS_CTRL_RX_TRAFFIC_LEAVE = 8, -+ LPS_CTRL_ENTER = 9, -+}; -+ -+enum STAKEY_TYPE -+{ -+ GROUP_KEY =0, -+ UNICAST_KEY =1, -+ TDLS_KEY =2, +}; + +enum RFINTFS { @@ -325660,12 +143479,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 +Command Mode +*/ +struct createbss_parm { -+ bool adhoc; -+ -+ /* used by AP mode now */ -+ s16 req_ch; -+ u8 req_bw; -+ u8 req_offset; ++ WLAN_BSSID_EX network; +}; + +/* @@ -325696,14 +143510,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + +Notes: To ask RTL8711 performing site-survey + -+Command-Event Mode ++Command-Event Mode + +*/ + +#define RTW_SSID_SCAN_AMOUNT 9 // for WEXT_CSCAN_AMOUNT 9 +#define RTW_CHANNEL_SCAN_AMOUNT (14+37) +struct sitesurvey_parm { -+ sint scan_mode; //active: 1, passive: 0 ++ sint scan_mode; //active: 1, passive: 0 + /* sint bsslimit; // 1 ~ 48 */ + u8 ssid_num; + u8 ch_num; @@ -325739,25 +143553,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 +*/ +struct setkey_parm { + u8 algorithm; // encryption algorithm, could be none, wep40, TKIP, CCMP, wep104 -+ u8 keyid; -+ u8 grpkey; // 1: this is the grpkey for 802.1x. 0: this is the unicast key for 802.1x -+ u8 set_tx; // 1: main tx key for wep. 0: other key. ++ u8 keyid; ++ u8 grpkey; // 1: this is the grpkey for 802.1x. 0: this is the unicast key for 802.1x ++ u8 set_tx; // 1: main tx key for wep. 0: other key. + u8 key[16]; // this could be 40 or 104 +}; + +/* -+When in AP or Ad-Hoc mode, this is used to ++When in AP or Ad-Hoc mode, this is used to +allocate an sw/hw entry for a newly associated sta. + +Command + -+when shared key ==> algorithm/keyid ++when shared key ==> algorithm/keyid + +*/ +struct set_stakey_parm { + u8 addr[ETH_ALEN]; + u8 algorithm; -+ u8 keyid; ++ u8 id;// currently for erasing cam entry if algorithm == _NO_PRIVACY_ + u8 key[16]; +}; + @@ -325788,16 +143602,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + +/* + Caller Ad-Hoc/AP -+ ++ + Command mode -+ ++ + This is to force fw to del an sta_data entry per driver's request -+ ++ + FW will invalidate the cam entry associated with it. + +*/ +struct del_assocsta_parm { -+ u8 addr[ETH_ALEN]; ++ u8 addr[ETH_ALEN]; +}; + +/* @@ -325869,7 +143683,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 +*/ +struct getdatarate_parm { + u32 rsvd; -+ ++ +}; +struct getdatarate_rsp { + u8 datarates[NumRates]; @@ -325949,11 +143763,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + u8 value; +}; + -+struct readMAC_parm { -+ u8 len; -+ u32 addr; -+}; -+ +struct writeBB_parm { + u8 offset; + u8 value; @@ -325984,18 +143793,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 +/* + Notes: This command is used for H2C/C2H loopback testing + -+ mac[0] == 0 ++ mac[0] == 0 + ==> CMD mode, return H2C_SUCCESS. + The following condition must be ture under CMD mode + mac[1] == mac[4], mac[2] == mac[3], mac[0]=mac[5]= 0; + s0 == 0x1234, s1 == 0xabcd, w0 == 0x78563412, w1 == 0x5aa5def7; + s2 == (b1 << 8 | b0); -+ ++ + mac[0] == 1 + ==> CMD_RSP mode, return H2C_SUCCESS_RSP -+ ++ + The rsp layout shall be: -+ rsp: parm: ++ rsp: parm: + mac[0] = mac[5]; + mac[1] = mac[4]; + mac[2] = mac[3]; @@ -326004,14 +143813,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + mac[5] = mac[0]; + s0 = s1; + s1 = swap16(s0); -+ w0 = swap32(w1); -+ b0 = b1 -+ s2 = s0 + s1 -+ b1 = b0 ++ w0 = swap32(w1); ++ b0 = b1 ++ s2 = s0 + s1 ++ b1 = b0 + w1 = w0 -+ -+ mac[0] == 2 -+ ==> CMD_EVENT mode, return H2C_SUCCESS ++ ++ mac[0] == 2 ++ ==> CMD_EVENT mode, return H2C_SUCCESS + The event layout shall be: + event: parm: + mac[0] = mac[5]; @@ -326022,17 +143831,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + mac[5] = mac[0]; + s0 = swap16(s0) - event.mac[2]; + s1 = s1 + event.mac[2]; -+ w0 = swap32(w0); -+ b0 = b1 -+ s2 = s0 + event.mac[2] -+ b1 = b0 -+ w1 = swap32(w1) - event.mac[2]; -+ ++ w0 = swap32(w0); ++ b0 = b1 ++ s2 = s0 + event.mac[2] ++ b1 = b0 ++ w1 = swap32(w1) - event.mac[2]; ++ + parm->mac[3] is the total event counts that host requested. -+ -+ ++ ++ + event will be the same with the cmd's param. -+ ++ +*/ + +#ifdef CONFIG_H2CLBK @@ -326049,7 +143858,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 +}; + +struct geth2clbk_parm { -+ u32 rsv; ++ u32 rsv; +}; + +struct geth2clbk_rsp { @@ -326068,18 +143877,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 +// CMD param Formart for driver extra cmd handler +struct drvextra_cmd_parm { + int ec_id; //extra cmd id -+ int type; // Can use this field as the type id or command size -+ int size; //buffer size ++ int type_size; // Can use this field as the type id or command size + unsigned char *pbuf; +}; + +/*------------------- Below are used for RF/BB tunning ---------------------*/ + +struct setantenna_parm { -+ u8 tx_antset; ++ u8 tx_antset; + u8 rx_antset; -+ u8 tx_antenna; -+ u8 rx_antenna; ++ u8 tx_antenna; ++ u8 rx_antenna; +}; + +struct enrateadaptive_parm { @@ -326232,16 +144040,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + +struct addBaReq_parm +{ -+ unsigned int tid; -+ u8 addr[ETH_ALEN]; -+}; -+ -+struct addBaRsp_parm { + unsigned int tid; -+ unsigned int start_seq; -+ u8 addr[ETH_ALEN]; -+ u8 status; -+ u8 size; ++ u8 addr[ETH_ALEN]; +}; + +/*H2C Handler index: 46 */ @@ -326309,45 +144109,37 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + +#endif /* MP_FIRMWARE_OFFLOAD */ + -+/*H2C Handler index: 59 */ ++/*H2C Handler index: 59 */ +struct SetChannelPlan_param +{ + u8 channel_plan; +}; + -+/*H2C Handler index: 60 */ ++/*H2C Handler index: 60 */ +struct LedBlink_param +{ -+ PVOID pLed; ++ void * pLed; +}; + -+/*H2C Handler index: 61 */ ++/*H2C Handler index: 61 */ +struct SetChannelSwitch_param +{ + u8 new_ch_no; +}; + -+/*H2C Handler index: 62 */ ++/*H2C Handler index: 62 */ +struct TDLSoption_param +{ + u8 addr[ETH_ALEN]; + u8 option; +}; + -+/*H2C Handler index: 64 */ -+struct RunInThread_param -+{ -+ void (*func)(void*); -+ void *context; -+}; -+ -+ +#define GEN_CMD_CODE(cmd) cmd ## _CMD_ + + +/* + -+Result: ++Result: +0x00: success +0x01: sucess, and check Response. +0x02: cmd ignored due to duplicated sequcne number @@ -326370,24 +144162,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 +extern u8 rtw_setassocsta_cmd(_adapter *padapter, u8 *mac_addr); +extern u8 rtw_setstandby_cmd(_adapter *padapter, uint action); +u8 rtw_sitesurvey_cmd(_adapter *padapter, NDIS_802_11_SSID *ssid, int ssid_num, struct rtw_ieee80211_channel *ch, int ch_num); -+ -+u8 rtw_create_ibss_cmd(_adapter *adapter, int flags); -+u8 rtw_startbss_cmd(_adapter *adapter, int flags); -+u8 rtw_change_bss_chbw_cmd(_adapter *adapter, int flags, u8 req_ch, u8 req_bw, u8 req_offset); -+ ++extern u8 rtw_createbss_cmd(_adapter *padapter); ++extern u8 rtw_createbss_cmd_ex(_adapter *padapter, unsigned char *pbss, unsigned int sz); +extern u8 rtw_setphy_cmd(_adapter *padapter, u8 modem, u8 ch); -+ -+struct sta_info; -+extern u8 rtw_setstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 key_type, bool enqueue); -+extern u8 rtw_clearstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 enqueue); -+ ++extern u8 rtw_setstakey_cmd(_adapter *padapter, u8 *psta, u8 unicast_key); ++extern u8 rtw_clearstakey_cmd(_adapter *padapter, u8 *psta, u8 entry, u8 enqueue); +extern u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network* pnetwork); +u8 rtw_disassoc_cmd(_adapter *padapter, u32 deauth_timeout_ms, bool enqueue); -+extern u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, bool enqueue); ++extern u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype); +extern u8 rtw_setdatarate_cmd(_adapter *padapter, u8 *rateset); +extern u8 rtw_setbasicrate_cmd(_adapter *padapter, u8 *rateset); -+extern u8 rtw_getmacreg_cmd(_adapter *padapter, u8 len, u32 addr); -+extern void rtw_usb_catc_trigger_cmd(_adapter *padapter, const char *caller); +extern u8 rtw_setbbreg_cmd(_adapter * padapter, u8 offset, u8 val); +extern u8 rtw_setrfreg_cmd(_adapter * padapter, u8 offset, u32 val); +extern u8 rtw_getbbreg_cmd(_adapter * padapter, u8 offset, u8 * pval); @@ -326401,16 +144185,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 +extern u8 rtw_setfwra_cmd(_adapter*padapter, u8 type); + +extern u8 rtw_addbareq_cmd(_adapter*padapter, u8 tid, u8 *addr); -+extern u8 rtw_addbarsp_cmd(_adapter *padapter, u8 *addr, u16 tid, u8 status, u8 size, u16 start_seq); -+// add for CONFIG_IEEE80211W, none 11w also can use -+extern u8 rtw_reset_securitypriv_cmd(_adapter*padapter); -+extern u8 rtw_free_assoc_resources_cmd(_adapter *padapter); ++ +extern u8 rtw_dynamic_chk_wk_cmd(_adapter *adapter); + +u8 rtw_lps_ctrl_wk_cmd(_adapter*padapter, u8 lps_ctrl_type, u8 enqueue); -+u8 rtw_dm_in_lps_wk_cmd(_adapter*padapter); -+u8 rtw_lps_change_dtim_cmd(_adapter*padapter, u8 dtim); -+ +#if (RATE_ADAPTIVE_SUPPORT==1) +u8 rtw_rpt_timer_cfg_cmd(_adapter*padapter, u16 minRptTime); +#endif @@ -326419,59 +144197,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 +extern u8 rtw_antenna_select_cmd(_adapter*padapter, u8 antenna,u8 enqueue); +#endif + -+u8 rtw_dm_ra_mask_wk_cmd(_adapter*padapter, u8 *psta); -+ +extern u8 rtw_ps_cmd(_adapter*padapter); + +#ifdef CONFIG_AP_MODE +u8 rtw_chk_hi_queue_cmd(_adapter*padapter); -+#ifdef CONFIG_DFS_MASTER -+u8 rtw_dfs_master_cmd(_adapter *adapter, bool enqueue); -+void rtw_dfs_master_timer_hdl(RTW_TIMER_HDL_ARGS); -+void rtw_dfs_master_enable(_adapter *adapter, u8 ch, u8 bw, u8 offset); -+void rtw_dfs_master_disable(_adapter *adapter, bool ld_sta_in_dfs); -+enum { -+ MLME_STA_CONNECTING, -+ MLME_STA_CONNECTED, -+ MLME_STA_DISCONNECTED, -+ MLME_AP_STARTED, -+ MLME_AP_STOPPED, -+}; -+void rtw_dfs_master_status_apply(_adapter *adapter, u8 self_action); -+#endif /* CONFIG_DFS_MASTER */ -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_BT_COEXIST -+u8 rtw_btinfo_cmd(PADAPTER padapter, u8 *pbuf, u16 length); +#endif + +u8 rtw_set_ch_cmd(_adapter*padapter, u8 ch, u8 bw, u8 ch_offset, u8 enqueue); -+u8 rtw_set_chplan_cmd(_adapter *adapter, int flags, u8 chplan, u8 swconfig); -+extern u8 rtw_led_blink_cmd(_adapter*padapter, PVOID pLed); ++extern u8 rtw_set_chplan_cmd(_adapter*padapter, u8 chplan, u8 enqueue); ++extern u8 rtw_led_blink_cmd(_adapter*padapter, void * pLed); +extern u8 rtw_set_csa_cmd(_adapter*padapter, u8 new_ch_no); +extern u8 rtw_tdls_cmd(_adapter*padapter, u8 *addr, u8 option); + -+//#ifdef CONFIG_C2H_PACKET_EN -+extern u8 rtw_c2h_packet_wk_cmd(PADAPTER padapter, u8 *pbuf, u16 length); -+//#else +extern u8 rtw_c2h_wk_cmd(PADAPTER padapter, u8 *c2h_evt); -+//#endif -+ -+u8 rtw_run_in_thread_cmd(PADAPTER padapter, void (*func)(void*), void* context); + +u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf); + +extern void rtw_survey_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); +extern void rtw_disassoc_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); +extern void rtw_joinbss_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); -+void rtw_create_ibss_post_hdl(_adapter *padapter, int status); ++extern void rtw_createbss_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); +extern void rtw_getbbrfreg_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); +extern void rtw_readtssi_cmdrsp_callback(_adapter* padapter, struct cmd_obj *pcmd); + +extern void rtw_setstaKey_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); +extern void rtw_setassocsta_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); +extern void rtw_getrttbl_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_getmacreg_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); + + +struct _cmd_callback { @@ -326482,96 +144233,90 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 +enum rtw_h2c_cmd +{ + GEN_CMD_CODE(_Read_MACREG) , /*0*/ -+ GEN_CMD_CODE(_Write_MACREG) , -+ GEN_CMD_CODE(_Read_BBREG) , -+ GEN_CMD_CODE(_Write_BBREG) , -+ GEN_CMD_CODE(_Read_RFREG) , -+ GEN_CMD_CODE(_Write_RFREG) , /*5*/ -+ GEN_CMD_CODE(_Read_EEPROM) , -+ GEN_CMD_CODE(_Write_EEPROM) , -+ GEN_CMD_CODE(_Read_EFUSE) , -+ GEN_CMD_CODE(_Write_EFUSE) , -+ -+ GEN_CMD_CODE(_Read_CAM) , /*10*/ -+ GEN_CMD_CODE(_Write_CAM) , -+ GEN_CMD_CODE(_setBCNITV), -+ GEN_CMD_CODE(_setMBIDCFG), -+ GEN_CMD_CODE(_JoinBss), /*14*/ -+ GEN_CMD_CODE(_DisConnect) , /*15*/ -+ GEN_CMD_CODE(_CreateBss) , -+ GEN_CMD_CODE(_SetOpMode) , ++ GEN_CMD_CODE(_Write_MACREG) , ++ GEN_CMD_CODE(_Read_BBREG) , ++ GEN_CMD_CODE(_Write_BBREG) , ++ GEN_CMD_CODE(_Read_RFREG) , ++ GEN_CMD_CODE(_Write_RFREG) , /*5*/ ++ GEN_CMD_CODE(_Read_EEPROM) , ++ GEN_CMD_CODE(_Write_EEPROM) , ++ GEN_CMD_CODE(_Read_EFUSE) , ++ GEN_CMD_CODE(_Write_EFUSE) , ++ ++ GEN_CMD_CODE(_Read_CAM) , /*10*/ ++ GEN_CMD_CODE(_Write_CAM) , ++ GEN_CMD_CODE(_setBCNITV), ++ GEN_CMD_CODE(_setMBIDCFG), ++ GEN_CMD_CODE(_JoinBss), /*14*/ ++ GEN_CMD_CODE(_DisConnect) , /*15*/ ++ GEN_CMD_CODE(_CreateBss) , ++ GEN_CMD_CODE(_SetOpMode) , + GEN_CMD_CODE(_SiteSurvey), /*18*/ -+ GEN_CMD_CODE(_SetAuth) , -+ -+ GEN_CMD_CODE(_SetKey) , /*20*/ -+ GEN_CMD_CODE(_SetStaKey) , -+ GEN_CMD_CODE(_SetAssocSta) , -+ GEN_CMD_CODE(_DelAssocSta) , -+ GEN_CMD_CODE(_SetStaPwrState) , -+ GEN_CMD_CODE(_SetBasicRate) , /*25*/ -+ GEN_CMD_CODE(_GetBasicRate) , -+ GEN_CMD_CODE(_SetDataRate) , -+ GEN_CMD_CODE(_GetDataRate) , ++ GEN_CMD_CODE(_SetAuth) , ++ ++ GEN_CMD_CODE(_SetKey) , /*20*/ ++ GEN_CMD_CODE(_SetStaKey) , ++ GEN_CMD_CODE(_SetAssocSta) , ++ GEN_CMD_CODE(_DelAssocSta) , ++ GEN_CMD_CODE(_SetStaPwrState) , ++ GEN_CMD_CODE(_SetBasicRate) , /*25*/ ++ GEN_CMD_CODE(_GetBasicRate) , ++ GEN_CMD_CODE(_SetDataRate) , ++ GEN_CMD_CODE(_GetDataRate) , + GEN_CMD_CODE(_SetPhyInfo) , -+ -+ GEN_CMD_CODE(_GetPhyInfo) , /*30*/ ++ ++ GEN_CMD_CODE(_GetPhyInfo) , /*30*/ + GEN_CMD_CODE(_SetPhy) , -+ GEN_CMD_CODE(_GetPhy) , -+ GEN_CMD_CODE(_readRssi) , -+ GEN_CMD_CODE(_readGain) , -+ GEN_CMD_CODE(_SetAtim) , /*35*/ -+ GEN_CMD_CODE(_SetPwrMode) , -+ GEN_CMD_CODE(_JoinbssRpt), -+ GEN_CMD_CODE(_SetRaTable) , -+ GEN_CMD_CODE(_GetRaTable) , -+ -+ GEN_CMD_CODE(_GetCCXReport), /*40*/ -+ GEN_CMD_CODE(_GetDTMReport), -+ GEN_CMD_CODE(_GetTXRateStatistics), -+ GEN_CMD_CODE(_SetUsbSuspend), -+ GEN_CMD_CODE(_SetH2cLbk), -+ GEN_CMD_CODE(_AddBAReq) , /*45*/ ++ GEN_CMD_CODE(_GetPhy) , ++ GEN_CMD_CODE(_readRssi) , ++ GEN_CMD_CODE(_readGain) , ++ GEN_CMD_CODE(_SetAtim) , /*35*/ ++ GEN_CMD_CODE(_SetPwrMode) , ++ GEN_CMD_CODE(_JoinbssRpt), ++ GEN_CMD_CODE(_SetRaTable) , ++ GEN_CMD_CODE(_GetRaTable) , ++ ++ GEN_CMD_CODE(_GetCCXReport), /*40*/ ++ GEN_CMD_CODE(_GetDTMReport), ++ GEN_CMD_CODE(_GetTXRateStatistics), ++ GEN_CMD_CODE(_SetUsbSuspend), ++ GEN_CMD_CODE(_SetH2cLbk), ++ GEN_CMD_CODE(_AddBAReq) , /*45*/ + GEN_CMD_CODE(_SetChannel), /*46*/ -+ GEN_CMD_CODE(_SetTxPower), ++ GEN_CMD_CODE(_SetTxPower), + GEN_CMD_CODE(_SwitchAntenna), + GEN_CMD_CODE(_SetCrystalCap), + GEN_CMD_CODE(_SetSingleCarrierTx), /*50*/ -+ ++ + GEN_CMD_CODE(_SetSingleToneTx),/*51*/ + GEN_CMD_CODE(_SetCarrierSuppressionTx), + GEN_CMD_CODE(_SetContinuousTx), + GEN_CMD_CODE(_SwitchBandwidth), /*54*/ + GEN_CMD_CODE(_TX_Beacon), /*55*/ -+ ++ + GEN_CMD_CODE(_Set_MLME_EVT), /*56*/ + GEN_CMD_CODE(_Set_Drv_Extra), /*57*/ + GEN_CMD_CODE(_Set_H2C_MSG), /*58*/ -+ ++ + GEN_CMD_CODE(_SetChannelPlan), /*59*/ + GEN_CMD_CODE(_LedBlink), /*60*/ + + GEN_CMD_CODE(_SetChannelSwitch), /*61*/ + GEN_CMD_CODE(_TDLS), /*62*/ -+ GEN_CMD_CODE(_ChkBMCSleepq), /*63*/ -+ -+ GEN_CMD_CODE(_RunInThreadCMD), /*64*/ -+ GEN_CMD_CODE(_AddBARsp) , /*65*/ + + MAX_H2CCMD +}; + -+#define _GetMACReg_CMD_ _Read_MACREG_CMD_ -+#define _SetMACReg_CMD_ _Write_MACREG_CMD_ +#define _GetBBReg_CMD_ _Read_BBREG_CMD_ -+#define _SetBBReg_CMD_ _Write_BBREG_CMD_ -+#define _GetRFReg_CMD_ _Read_RFREG_CMD_ -+#define _SetRFReg_CMD_ _Write_RFREG_CMD_ ++#define _SetBBReg_CMD_ _Write_BBREG_CMD_ ++#define _GetRFReg_CMD_ _Read_RFREG_CMD_ ++#define _SetRFReg_CMD_ _Write_RFREG_CMD_ + +#ifdef _RTW_CMD_C_ -+struct _cmd_callback rtw_cmd_callback[] = ++static struct _cmd_callback rtw_cmd_callback[] = +{ -+ {GEN_CMD_CODE(_Read_MACREG), &rtw_getmacreg_cmdrsp_callback}, /*0*/ -+ {GEN_CMD_CODE(_Write_MACREG), NULL}, ++ {GEN_CMD_CODE(_Read_MACREG), NULL}, /*0*/ ++ {GEN_CMD_CODE(_Write_MACREG), NULL}, + {GEN_CMD_CODE(_Read_BBREG), &rtw_getbbrfreg_cmdrsp_callback}, + {GEN_CMD_CODE(_Write_BBREG), NULL}, + {GEN_CMD_CODE(_Read_RFREG), &rtw_getbbrfreg_cmdrsp_callback}, @@ -326580,32 +144325,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + {GEN_CMD_CODE(_Write_EEPROM), NULL}, + {GEN_CMD_CODE(_Read_EFUSE), NULL}, + {GEN_CMD_CODE(_Write_EFUSE), NULL}, -+ ++ + {GEN_CMD_CODE(_Read_CAM), NULL}, /*10*/ -+ {GEN_CMD_CODE(_Write_CAM), NULL}, ++ {GEN_CMD_CODE(_Write_CAM), NULL}, + {GEN_CMD_CODE(_setBCNITV), NULL}, -+ {GEN_CMD_CODE(_setMBIDCFG), NULL}, ++ {GEN_CMD_CODE(_setMBIDCFG), NULL}, + {GEN_CMD_CODE(_JoinBss), &rtw_joinbss_cmd_callback}, /*14*/ + {GEN_CMD_CODE(_DisConnect), &rtw_disassoc_cmd_callback}, /*15*/ -+ {GEN_CMD_CODE(_CreateBss), NULL}, ++ {GEN_CMD_CODE(_CreateBss), &rtw_createbss_cmd_callback}, + {GEN_CMD_CODE(_SetOpMode), NULL}, + {GEN_CMD_CODE(_SiteSurvey), &rtw_survey_cmd_callback}, /*18*/ + {GEN_CMD_CODE(_SetAuth), NULL}, -+ ++ + {GEN_CMD_CODE(_SetKey), NULL}, /*20*/ + {GEN_CMD_CODE(_SetStaKey), &rtw_setstaKey_cmdrsp_callback}, + {GEN_CMD_CODE(_SetAssocSta), &rtw_setassocsta_cmdrsp_callback}, -+ {GEN_CMD_CODE(_DelAssocSta), NULL}, -+ {GEN_CMD_CODE(_SetStaPwrState), NULL}, ++ {GEN_CMD_CODE(_DelAssocSta), NULL}, ++ {GEN_CMD_CODE(_SetStaPwrState), NULL}, + {GEN_CMD_CODE(_SetBasicRate), NULL}, /*25*/ + {GEN_CMD_CODE(_GetBasicRate), NULL}, + {GEN_CMD_CODE(_SetDataRate), NULL}, + {GEN_CMD_CODE(_GetDataRate), NULL}, + {GEN_CMD_CODE(_SetPhyInfo), NULL}, -+ ++ + {GEN_CMD_CODE(_GetPhyInfo), NULL}, /*30*/ + {GEN_CMD_CODE(_SetPhy), NULL}, -+ {GEN_CMD_CODE(_GetPhy), NULL}, ++ {GEN_CMD_CODE(_GetPhy), NULL}, + {GEN_CMD_CODE(_readRssi), NULL}, + {GEN_CMD_CODE(_readGain), NULL}, + {GEN_CMD_CODE(_SetAtim), NULL}, /*35*/ @@ -326613,19 +144358,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + {GEN_CMD_CODE(_JoinbssRpt), NULL}, + {GEN_CMD_CODE(_SetRaTable), NULL}, + {GEN_CMD_CODE(_GetRaTable) , NULL}, -+ ++ + {GEN_CMD_CODE(_GetCCXReport), NULL}, /*40*/ -+ {GEN_CMD_CODE(_GetDTMReport), NULL}, -+ {GEN_CMD_CODE(_GetTXRateStatistics), NULL}, -+ {GEN_CMD_CODE(_SetUsbSuspend), NULL}, -+ {GEN_CMD_CODE(_SetH2cLbk), NULL}, -+ {GEN_CMD_CODE(_AddBAReq), NULL}, /*45*/ ++ {GEN_CMD_CODE(_GetDTMReport), NULL}, ++ {GEN_CMD_CODE(_GetTXRateStatistics), NULL}, ++ {GEN_CMD_CODE(_SetUsbSuspend), NULL}, ++ {GEN_CMD_CODE(_SetH2cLbk), NULL}, ++ {GEN_CMD_CODE(_AddBAReq), NULL}, /*45*/ + {GEN_CMD_CODE(_SetChannel), NULL}, /*46*/ + {GEN_CMD_CODE(_SetTxPower), NULL}, + {GEN_CMD_CODE(_SwitchAntenna), NULL}, + {GEN_CMD_CODE(_SetCrystalCap), NULL}, + {GEN_CMD_CODE(_SetSingleCarrierTx), NULL}, /*50*/ -+ ++ + {GEN_CMD_CODE(_SetSingleToneTx), NULL}, /*51*/ + {GEN_CMD_CODE(_SetCarrierSuppressionTx), NULL}, + {GEN_CMD_CODE(_SetContinuousTx), NULL}, @@ -326637,22 +144382,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_cmd.h linux/3rdparty/rtl8812 + {GEN_CMD_CODE(_Set_H2C_MSG), NULL},/*58*/ + {GEN_CMD_CODE(_SetChannelPlan), NULL},/*59*/ + {GEN_CMD_CODE(_LedBlink), NULL},/*60*/ -+ ++ + {GEN_CMD_CODE(_SetChannelSwitch), NULL},/*61*/ + {GEN_CMD_CODE(_TDLS), NULL},/*62*/ -+ {GEN_CMD_CODE(_ChkBMCSleepq), NULL}, /*63*/ -+ -+ {GEN_CMD_CODE(_RunInThreadCMD), NULL},/*64*/ -+ {GEN_CMD_CODE(_AddBARsp), NULL}, /*65*/ +}; +#endif + +#endif // _CMD_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_debug.h linux/3rdparty/rtl8812au/include/rtw_debug.h ---- linux.old/3rdparty/rtl8812au/include/rtw_debug.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_debug.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,538 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_debug.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_debug.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_debug.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_debug.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,412 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -326666,11 +144406,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_debug.h linux/3rdparty/rtl88 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __RTW_DEBUG_H__ +#define __RTW_DEBUG_H__ @@ -326802,108 +144537,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_debug.h linux/3rdparty/rtl88 + #define _MODULE_DEFINE_ _module_efuse_ +#endif + -+#ifdef PLATFORM_OS_CE -+extern void rtl871x_cedbg(const char *fmt, ...); -+#endif -+ +#define RT_TRACE(_Comp, _Level, Fmt) do{}while(0) -+#define _func_enter_ do{}while(0) -+#define _func_exit_ do{}while(0) +#define RT_PRINT_DATA(_Comp, _Level, _TitleString, _HexData, _HexDataLen) do{}while(0) + -+#ifdef PLATFORM_WINDOWS -+ #define DBG_871X do {} while(0) -+ #define MSG_8192C do {} while(0) -+ #define DBG_8192C do {} while(0) -+ #define DBG_871X_LEVEL do {} while(0) -+#else + #define DBG_871X(x, ...) do {} while(0) + #define MSG_8192C(x, ...) do {} while(0) + #define DBG_8192C(x,...) do {} while(0) + #define DBG_871X_LEVEL(x,...) do {} while(0) -+#endif + -+#undef _dbgdump -+#undef _seqdump ++#undef _dbgdump ++ #define _dbgdump printk + -+#ifndef _RTL871X_DEBUG_C_ -+ extern u32 GlobalDebugLevel; -+ extern u64 GlobalDebugComponents; -+#endif -+ -+#if defined(PLATFORM_WINDOWS) && defined(PLATFORM_OS_XP) -+ #define _dbgdump DbgPrint -+ #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) -+#elif defined(PLATFORM_WINDOWS) && defined(PLATFORM_OS_CE) -+ #define _dbgdump rtl871x_cedbg -+ #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) -+#elif defined PLATFORM_LINUX -+ #define _dbgdump printk -+ #define _seqdump seq_printf -+#elif defined PLATFORM_FREEBSD -+ #define _dbgdump printf -+ #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) -+#endif -+ -+#define DRIVER_PREFIX "RTL871X: " -+ -+#if defined(_dbgdump) -+ -+#define DBG_871X_EXP(level, EXP) do { if (level <= GlobalDebugLevel) EXP; } while (0) -+ -+/* with driver-defined prefix */ -+#undef DBG_871X_LEVEL -+#define DBG_871X_LEVEL(level, fmt, arg...) \ ++#define DRIVER_PREFIX "RTL8812: " ++#define DEBUG_LEVEL (_drv_err_) ++#if defined (_dbgdump) ++ #undef DBG_871X_LEVEL ++ #define DBG_871X_LEVEL(level, fmt, arg...) \ + do {\ -+ if (level <= GlobalDebugLevel) {\ ++ if (level <= DEBUG_LEVEL) {\ + if (level <= _drv_err_ && level > _drv_always_) \ + _dbgdump(DRIVER_PREFIX"ERROR " fmt, ##arg);\ + else \ + _dbgdump(DRIVER_PREFIX fmt, ##arg);\ + }\ + }while(0) -+ -+/* without driver-defined prefix */ -+#undef _DBG_871X_LEVEL -+#define _DBG_871X_LEVEL(level, fmt, arg...) \ -+ do {\ -+ if (level <= GlobalDebugLevel) {\ -+ if (level <= _drv_err_ && level > _drv_always_) \ -+ _dbgdump("ERROR " fmt, ##arg);\ -+ else \ -+ _dbgdump(fmt, ##arg);\ -+ }\ -+ }while(0) -+ -+#if defined(_seqdump) -+#define RTW_DBGDUMP 0 /* 'stream' for _dbgdump */ -+ -+/* dump message to selected 'stream' */ -+#define DBG_871X_SEL(sel, fmt, arg...) \ -+ do {\ -+ if (sel == RTW_DBGDUMP)\ -+ _DBG_871X_LEVEL(_drv_always_, fmt, ##arg); \ -+ else {\ -+ _seqdump(sel, fmt, ##arg); \ -+ } \ -+ }while(0) -+ -+/* dump message to selected 'stream' with driver-defined prefix */ -+#define DBG_871X_SEL_NL(sel, fmt, arg...) \ -+ do {\ -+ if (sel == RTW_DBGDUMP)\ -+ DBG_871X_LEVEL(_drv_always_, fmt, ##arg); \ -+ else {\ -+ _seqdump(sel, fmt, ##arg); \ -+ } \ -+ }while(0) -+ -+#endif /* defined(_seqdump) */ -+ -+#endif /* defined(_dbgdump) */ ++#endif + +#ifdef CONFIG_DEBUG -+#if defined(_dbgdump) ++#if defined (_dbgdump) + #undef DBG_871X + #define DBG_871X(...) do {\ + _dbgdump(DRIVER_PREFIX __VA_ARGS__);\ @@ -326918,287 +144579,240 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_debug.h linux/3rdparty/rtl88 + #define DBG_8192C(...) do {\ + _dbgdump(DRIVER_PREFIX __VA_ARGS__);\ + }while(0) -+#endif /* defined(_dbgdump) */ ++#endif +#endif /* CONFIG_DEBUG */ + +#ifdef CONFIG_DEBUG_RTL871X ++#ifndef _RTL871X_DEBUG_C_ ++ extern u32 GlobalDebugLevel; ++ extern u64 GlobalDebugComponents; ++#endif + -+#if defined(_dbgdump) && defined(_MODULE_DEFINE_) ++#if defined (_dbgdump) && defined (_MODULE_DEFINE_) + -+ #undef RT_TRACE -+ #define RT_TRACE(_Comp, _Level, Fmt)\ -+ do {\ -+ if((_Comp & GlobalDebugComponents) && (_Level <= GlobalDebugLevel)) {\ -+ _dbgdump("%s [0x%08x,%d]", DRIVER_PREFIX, (unsigned int)_Comp, _Level);\ -+ _dbgdump Fmt;\ -+ }\ -+ }while(0) ++ #undef RT_TRACE ++ #define RT_TRACE(_Comp, _Level, Fmt)\ ++ do {\ ++ if((_Comp & GlobalDebugComponents) && (_Level <= GlobalDebugLevel)) {\ ++ _dbgdump("%s [0x%08x,%d]", DRIVER_PREFIX, (unsigned int)_Comp, _Level);\ ++ _dbgdump Fmt;\ ++ }\ ++ }while(0) + -+#endif /* defined(_dbgdump) && defined(_MODULE_DEFINE_) */ ++#endif + + -+#if defined(_dbgdump) -+ #undef _func_enter_ -+ #define _func_enter_ \ -+ do { \ -+ if (GlobalDebugLevel >= _drv_debug_) \ -+ { \ -+ _dbgdump("\n %s : %s enters at %d\n", DRIVER_PREFIX, __FUNCTION__, __LINE__);\ -+ } \ -+ } while(0) -+ -+ #undef _func_exit_ -+ #define _func_exit_ \ -+ do { \ -+ if (GlobalDebugLevel >= _drv_debug_) \ -+ { \ -+ _dbgdump("\n %s : %s exits at %d\n", DRIVER_PREFIX, __FUNCTION__, __LINE__); \ -+ } \ -+ } while(0) -+ -+ #undef RT_PRINT_DATA -+ #define RT_PRINT_DATA(_Comp, _Level, _TitleString, _HexData, _HexDataLen) \ -+ if(((_Comp) & GlobalDebugComponents) && (_Level <= GlobalDebugLevel)) \ -+ { \ -+ int __i; \ -+ u8 *ptr = (u8 *)_HexData; \ -+ _dbgdump("%s", DRIVER_PREFIX); \ -+ _dbgdump(_TitleString); \ -+ for( __i=0; __i<(int)_HexDataLen; __i++ ) \ -+ { \ -+ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0)?" ":" "); \ -+ if (((__i + 1) % 16) == 0) _dbgdump("\n"); \ -+ } \ -+ _dbgdump("\n"); \ -+ } -+#endif /* defined(_dbgdump) */ ++#if defined (_dbgdump) ++ #undef RT_PRINT_DATA ++ #define RT_PRINT_DATA(_Comp, _Level, _TitleString, _HexData, _HexDataLen) \ ++ if(((_Comp) & GlobalDebugComponents) && (_Level <= GlobalDebugLevel)) \ ++ { \ ++ int __i; \ ++ u8 *ptr = (u8 *)_HexData; \ ++ _dbgdump("%s", DRIVER_PREFIX); \ ++ _dbgdump(_TitleString); \ ++ for( __i=0; __i<(int)_HexDataLen; __i++ ) \ ++ { \ ++ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0)?" ":" "); \ ++ if (((__i + 1) % 16) == 0) _dbgdump("\n"); \ ++ } \ ++ _dbgdump("\n"); \ ++ } ++#endif +#endif /* CONFIG_DEBUG_RTL871X */ + -+#ifdef CONFIG_DBG_COUNTER -+#define DBG_COUNTER(counter) counter++ -+#else -+#define DBG_COUNTER(counter) -+#endif -+ -+void dump_drv_version(void *sel); -+void dump_log_level(void *sel); -+void dump_drv_cfg(void *sel); -+ -+#ifdef CONFIG_SDIO_HCI -+void sd_f0_reg_dump(void *sel, _adapter *adapter); -+void sdio_local_reg_dump(void *sel, _adapter *adapter); -+#endif /* CONFIG_SDIO_HCI */ -+ -+void mac_reg_dump(void *sel, _adapter *adapter); -+void bb_reg_dump(void *sel, _adapter *adapter); -+void rf_reg_dump(void *sel, _adapter *adapter); -+ -+bool rtw_fwdl_test_trigger_chksum_fail(void); -+bool rtw_fwdl_test_trigger_wintint_rdy_fail(void); -+bool rtw_del_rx_ampdu_test_trigger_no_tx_fail(void); -+ -+u32 rtw_get_wait_hiq_empty_ms(void); -+void rtw_sink_rtp_seq_dbg( _adapter *adapter,_pkt *pkt); -+ -+struct sta_info; -+void sta_rx_reorder_ctl_dump(void *sel, struct sta_info *sta); -+ -+struct dvobj_priv; -+void dump_adapters_status(void *sel, struct dvobj_priv *dvobj); -+ -+struct sec_cam_ent; -+void dump_sec_cam_ent(void *sel, struct sec_cam_ent *ent, int id); -+void dump_sec_cam_ent_title(void *sel, u8 has_id); -+void dump_sec_cam(void *sel, _adapter *adapter); + +#ifdef CONFIG_PROC_DEBUG -+ssize_t proc_set_write_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_read_reg(struct seq_file *m, void *v); -+ssize_t proc_set_read_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); + -+int proc_get_fwstate(struct seq_file *m, void *v); -+int proc_get_sec_info(struct seq_file *m, void *v); -+int proc_get_mlmext_state(struct seq_file *m, void *v); -+#ifdef CONFIG_LAYER2_ROAMING -+int proc_get_roam_flags(struct seq_file *m, void *v); -+ssize_t proc_set_roam_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_roam_param(struct seq_file *m, void *v); -+ssize_t proc_set_roam_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_roam_tgt_addr(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* CONFIG_LAYER2_ROAMING */ -+int proc_get_qos_option(struct seq_file *m, void *v); -+int proc_get_ht_option(struct seq_file *m, void *v); -+int proc_get_rf_info(struct seq_file *m, void *v); -+int proc_get_scan_param(struct seq_file *m, void *v); -+ssize_t proc_set_scan_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_scan_abort(struct seq_file *m, void *v); -+#ifdef CONFIG_SCAN_BACKOP -+int proc_get_backop_flags_sta(struct seq_file *m, void *v); -+ssize_t proc_set_backop_flags_sta(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_backop_flags_ap(struct seq_file *m, void *v); -+ssize_t proc_set_backop_flags_ap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* CONFIG_SCAN_BACKOP */ -+int proc_get_survey_info(struct seq_file *m, void *v); -+ssize_t proc_set_survey_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_ap_info(struct seq_file *m, void *v); -+ssize_t proc_reset_trx_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_trx_info(struct seq_file *m, void *v); -+int proc_get_rate_ctl(struct seq_file *m, void *v); -+int proc_get_wifi_spec(struct seq_file *m, void *v); -+ssize_t proc_set_rate_ctl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#ifdef DBG_RX_COUNTER_DUMP -+int proc_get_rx_cnt_dump(struct seq_file *m, void *v); -+ssize_t proc_set_rx_cnt_dump(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+int proc_get_dis_pwt(struct seq_file *m, void *v); -+ssize_t proc_set_dis_pwt(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ int proc_get_drv_version(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); + -+int proc_get_suspend_resume_info(struct seq_file *m, void *v); ++ int proc_get_write_reg(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); + -+ssize_t proc_set_fwdl_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_del_rx_ampdu_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#ifdef CONFIG_DFS_MASTER -+int proc_get_dfs_master_test_case(struct seq_file *m, void *v); -+ssize_t proc_set_dfs_master_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* CONFIG_DFS_MASTER */ -+ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ int proc_set_write_reg(struct file *file, const char *buffer, ++ unsigned long count, void *data); ++ ++ int proc_get_read_reg(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_set_read_reg(struct file *file, const char *buffer, ++ unsigned long count, void *data); ++ ++ ++ int proc_get_fwstate(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_sec_info(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_mlmext_state(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_qos_option(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_ht_option(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_rf_info(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_ap_info(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_adapter_state(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_trx_info(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_mac_reg_dump1(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_mac_reg_dump2(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_mac_reg_dump3(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_bb_reg_dump1(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_bb_reg_dump2(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_bb_reg_dump3(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_rf_reg_dump1(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_rf_reg_dump2(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_rf_reg_dump3(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_get_rf_reg_dump4(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); + +#ifdef CONFIG_AP_MODE -+int proc_get_all_sta_info(struct seq_file *m, void *v); -+#endif /* CONFIG_AP_MODE */ ++ ++ int proc_get_all_sta_info(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++#endif + +#ifdef DBG_MEMORY_LEAK -+int proc_get_malloc_cnt(struct seq_file *m, void *v); -+#endif /* DBG_MEMORY_LEAK */ ++ int proc_get_malloc_cnt(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++#endif + +#ifdef CONFIG_FIND_BEST_CHANNEL -+int proc_get_best_channel(struct seq_file *m, void *v); -+ssize_t proc_set_best_channel(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* CONFIG_FIND_BEST_CHANNEL */ ++ int proc_get_best_channel(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++#endif + -+int proc_get_rx_signal(struct seq_file *m, void *v); -+ssize_t proc_set_rx_signal(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_hw_status(struct seq_file *m, void *v); ++ int proc_get_rx_signal(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); + ++ int proc_set_rx_signal(struct file *file, const char *buffer, ++ unsigned long count, void *data); +#ifdef CONFIG_80211N_HT -+int proc_get_ht_enable(struct seq_file *m, void *v); -+ssize_t proc_set_ht_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); + -+int proc_get_bw_mode(struct seq_file *m, void *v); -+ssize_t proc_set_bw_mode(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ int proc_get_ht_enable(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); + -+int proc_get_ampdu_enable(struct seq_file *m, void *v); -+ssize_t proc_set_ampdu_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ int proc_set_ht_enable(struct file *file, const char *buffer, ++ unsigned long count, void *data); + -+int proc_get_mac_rptbuf(struct seq_file *m, void *v); ++ int proc_get_bw_mode(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); + -+int proc_get_rx_ampdu(struct seq_file *m, void *v); -+ssize_t proc_set_rx_ampdu(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ int proc_set_bw_mode(struct file *file, const char *buffer, ++ unsigned long count, void *data); + -+int proc_get_rx_stbc(struct seq_file *m, void *v); -+ssize_t proc_set_rx_stbc(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ int proc_get_ampdu_enable(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); + ++ int proc_set_ampdu_enable(struct file *file, const char *buffer, ++ unsigned long count, void *data); + -+int proc_get_rx_ampdu_factor(struct seq_file *m, void *v); -+ssize_t proc_set_rx_ampdu_factor(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ int proc_get_rx_stbc(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); + -+int proc_get_rx_ampdu_density(struct seq_file *m, void *v); -+ssize_t proc_set_rx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ int proc_set_rx_stbc(struct file *file, const char *buffer, ++ unsigned long count, void *data); ++#endif //CONFIG_80211N_HT + -+int proc_get_tx_ampdu_density(struct seq_file *m, void *v); -+ssize_t proc_set_tx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* CONFIG_80211N_HT */ ++ int proc_get_two_path_rssi(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); + -+int proc_get_en_fwps(struct seq_file *m, void *v); -+ssize_t proc_set_en_fwps(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ int proc_get_rssi_disp(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); + -+//int proc_get_two_path_rssi(struct seq_file *m, void *v); -+//int proc_get_rssi_disp(struct seq_file *m, void *v); -+//ssize_t proc_set_rssi_disp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++ int proc_set_rssi_disp(struct file *file, const char *buffer, ++ unsigned long count, void *data); + +#ifdef CONFIG_BT_COEXIST -+int proc_get_btcoex_dbg(struct seq_file *m, void *v); -+ssize_t proc_set_btcoex_dbg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_btcoex_info(struct seq_file *m, void *v); -+#endif /* CONFIG_BT_COEXIST */ ++ int proc_get_btcoex_dbg(char *page, char **start, ++ off_t offset, int count, ++ int *eof, void *data); ++ ++ int proc_set_btcoex_dbg(struct file *file, const char *buffer, ++ unsigned long count, void *data); ++ ++#endif //CONFIG_BT_COEXIST + +#if defined(DBG_CONFIG_ERROR_DETECT) -+int proc_get_sreset(struct seq_file *m, void *v); -+ssize_t proc_set_sreset(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++int proc_get_sreset(char *page, char **start, off_t offset, int count, int *eof, void *data); ++int proc_set_sreset(struct file *file, const char *buffer, unsigned long count, void *data); +#endif /* DBG_CONFIG_ERROR_DETECT */ + -+int proc_get_odm_dbg_comp(struct seq_file *m, void *v); -+ssize_t proc_set_odm_dbg_comp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_odm_dbg_level(struct seq_file *m, void *v); -+ssize_t proc_set_odm_dbg_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_odm_adaptivity(struct seq_file *m, void *v); -+ssize_t proc_set_odm_adaptivity(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+#ifdef CONFIG_DBG_COUNTER -+int proc_get_rx_logs(struct seq_file *m, void *v); -+int proc_get_tx_logs(struct seq_file *m, void *v); -+int proc_get_int_logs(struct seq_file *m, void *v); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+int proc_get_rx_ring(struct seq_file *m, void *v); -+int proc_get_tx_ring(struct seq_file *m, void *v); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+int proc_get_wowlan_gpio_info(struct seq_file *m, void *v); -+ssize_t proc_set_wowlan_gpio_info(struct file *file, const char __user *buffer, -+ size_t count, loff_t *pos, void *data); -+#endif /*CONFIG_GPIO_WAKEUP*/ -+ -+#ifdef CONFIG_P2P_WOWLAN -+int proc_get_p2p_wowlan_info(struct seq_file *m, void *v); -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+int proc_get_new_bcn_max(struct seq_file *m, void *v); -+ssize_t proc_set_new_bcn_max(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+#ifdef CONFIG_POWER_SAVING -+int proc_get_ps_info(struct seq_file *m, void *v); -+#endif //CONFIG_POWER_SAVING -+ -+#ifdef CONFIG_TDLS -+int proc_get_tdls_info(struct seq_file *m, void *v); -+#endif -+ -+int proc_get_monitor(struct seq_file *m, void *v); -+ssize_t proc_set_monitor(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+ -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+int proc_get_rtkm_info(struct seq_file *m, void *v); -+#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ -+#ifdef CONFIG_IEEE80211W -+ssize_t proc_set_tx_sa_query(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_tx_sa_query(struct seq_file *m, void *v); -+ssize_t proc_set_tx_deauth(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_tx_deauth(struct seq_file *m, void *v); -+ssize_t proc_set_tx_auth(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_tx_auth(struct seq_file *m, void *v); -+#endif /* CONFIG_IEEE80211W */ -+ -+#endif /* CONFIG_PROC_DEBUG */ -+ -+int proc_get_efuse_map(struct seq_file *m, void *v); -+ssize_t proc_set_efuse_map(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ++#endif //CONFIG_PROC_DEBUG + +#endif //__RTW_DEBUG_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_eeprom.h linux/3rdparty/rtl8812au/include/rtw_eeprom.h ---- linux.old/3rdparty/rtl8812au/include/rtw_eeprom.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_eeprom.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,123 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_eeprom.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_eeprom.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_eeprom.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_eeprom.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,128 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -327208,11 +144822,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_eeprom.h linux/3rdparty/rtl8 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __RTW_EEPROM_H__ +#define __RTW_EEPROM_H__ @@ -327224,11 +144833,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_eeprom.h linux/3rdparty/rtl8 +#define HWSET_MAX_SIZE_128 128 +#define HWSET_MAX_SIZE_256 256 +#define HWSET_MAX_SIZE_512 512 -+#define HWSET_MAX_SIZE_1024 1024 + -+#define EEPROM_MAX_SIZE HWSET_MAX_SIZE_1024 ++#define EEPROM_MAX_SIZE HWSET_MAX_SIZE_512 + -+#define CLOCK_RATE 50 //100us ++#define CLOCK_RATE 50 //100us + +//- EEPROM opcodes +#define EEPROM_READ_OPCODE 06 @@ -327239,13 +144847,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_eeprom.h linux/3rdparty/rtl8 + +//Country codes +#define USA 0x555320 -+#define EUROPE 0x1 //temp, should be provided later ++#define EUROPE 0x1 //temp, should be provided later +#define JAPAN 0x2 //temp, should be provided later + +// -+// Customer ID, note that: -+// This variable is initiailzed through EEPROM or registry, -+// however, its definition may be different with that in EEPROM for ++// Customer ID, note that: ++// This variable is initiailzed through EEPROM or registry, ++// however, its definition may be different with that in EEPROM for +// EEPROM size consideration. So, we have to perform proper translation between them. +// Besides, CustomerID of registry has precedence of that of EEPROM. +// defined below. 060703, by rcnjko. @@ -327298,34 +144906,45 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_eeprom.h linux/3rdparty/rtl8 + RT_CID_819x_Sercomm_Netgear = 43, + RT_CID_819x_ALPHA_Dlink = 44,//add by ylb 20121012 for customer led for alpha + RT_CID_WNC_NEC = 45,//add by page for NEC -+ RT_CID_DNI_BUFFALO = 46,//add by page for NEC +}RT_CUSTOMER_ID, *PRT_CUSTOMER_ID; + ++struct eeprom_priv ++{ ++ u8 bautoload_fail_flag; ++ u8 bloadfile_fail_flag; ++ u8 bloadmac_fail_flag; ++ u8 EepromOrEfuse; ++ ++ u8 mac_addr[6]; //PermanentAddress ++ ++ u16 channel_plan; ++ u16 CustomerID; ++ ++ u8 efuse_eeprom_data[EEPROM_MAX_SIZE]; //92C:256bytes, 88E:512bytes, we use union set (512bytes) ++}; ++ +extern void eeprom_write16(_adapter *padapter, u16 reg, u16 data); +extern u16 eeprom_read16(_adapter *padapter, u16 reg); +extern void read_eeprom_content(_adapter *padapter); -+extern void eeprom_read_sz(_adapter * padapter, u16 reg,u8* data, u32 sz); ++extern void eeprom_read_sz(_adapter * padapter, u16 reg,u8* data, u32 sz); + +extern void read_eeprom_content_by_attrib(_adapter * padapter ); + -+#ifdef PLATFORM_LINUX +#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE +extern int isAdaptorInfoFileValid(void); -+extern int storeAdaptorInfoFile(char *path, u8 *efuse_data); -+extern int retriveAdaptorInfoFile(char *path, u8 *efuse_data); ++extern int storeAdaptorInfoFile(char *path, struct eeprom_priv * eeprom_priv); ++extern int retriveAdaptorInfoFile(char *path, struct eeprom_priv * eeprom_priv); +#endif //CONFIG_ADAPTOR_INFO_CACHING_FILE -+#endif //PLATFORM_LINUX + +#endif //__RTL871X_EEPROM_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_efuse.h linux/3rdparty/rtl8812au/include/rtw_efuse.h ---- linux.old/3rdparty/rtl8812au/include/rtw_efuse.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_efuse.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,208 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_efuse.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_efuse.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_efuse.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_efuse.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,137 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -327335,11 +144954,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_efuse.h linux/3rdparty/rtl88 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __RTW_EFUSE_H__ +#define __RTW_EFUSE_H__ @@ -327347,7 +144961,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_efuse.h linux/3rdparty/rtl88 + +#define EFUSE_ERROE_HANDLE 1 + -+#define PG_STATE_HEADER 0x01 ++#define PG_STATE_HEADER 0x01 +#define PG_STATE_WORD_0 0x02 +#define PG_STATE_WORD_1 0x04 +#define PG_STATE_WORD_2 0x08 @@ -327372,8 +144986,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_efuse.h linux/3rdparty/rtl88 + TYPE_EFUSE_CONTENT_LEN_BANK = 6, +}; + -+#define EFUSE_MAX_MAP_LEN 512 -+ ++#define EFUSE_MAX_MAP_LEN 256 +#define EFUSE_MAX_HW_SIZE 512 +#define EFUSE_MAX_SECTION_BASE 16 + @@ -327383,18 +144996,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_efuse.h linux/3rdparty/rtl88 + +#define EFUSE_REPEAT_THRESHOLD_ 3 + -+#define IS_MASKED_MP(ic, txt, offset) (EFUSE_IsAddressMasked_MP_##ic##txt(offset)) -+#define IS_MASKED_TC(ic, txt, offset) (EFUSE_IsAddressMasked_TC_##ic##txt(offset)) -+#define GET_MASK_ARRAY_LEN_MP(ic, txt) (EFUSE_GetArrayLen_MP_##ic##txt()) -+#define GET_MASK_ARRAY_LEN_TC(ic, txt) (EFUSE_GetArrayLen_TC_##ic##txt()) -+#define GET_MASK_ARRAY_MP(ic, txt, offset) (EFUSE_GetMaskArray_MP_##ic##txt(offset)) -+#define GET_MASK_ARRAY_TC(ic, txt, offset) (EFUSE_GetMaskArray_TC_##ic##txt(offset)) -+ -+ -+#define IS_MASKED(ic, txt, offset) ( IS_MASKED_MP(ic,txt, offset) ) -+#define GET_MASK_ARRAY_LEN(ic, txt) ( GET_MASK_ARRAY_LEN_MP(ic,txt) ) -+#define GET_MASK_ARRAY(ic, txt, out) do { GET_MASK_ARRAY_MP(ic,txt, out);} while(0) -+ +//============================================= +// The following is for BT Efuse definition +//============================================= @@ -327405,39 +145006,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_efuse.h linux/3rdparty/rtl88 +/*--------------------------Define Parameters-------------------------------*/ +#define EFUSE_MAX_WORD_UNIT 4 + -+/*------------------------------Define structure----------------------------*/ ++/*------------------------------Define structure----------------------------*/ +typedef struct PG_PKT_STRUCT_A{ + u8 offset; + u8 word_en; -+ u8 data[8]; ++ u8 data[8]; + u8 word_cnts; +}PGPKT_STRUCT,*PPGPKT_STRUCT; + -+typedef enum -+{ -+ ERR_SUCCESS = 0, -+ ERR_DRIVER_FAILURE, -+ ERR_IO_FAILURE, -+ ERR_WI_TIMEOUT, -+ ERR_WI_BUSY, -+ ERR_BAD_FORMAT, -+ ERR_INVALID_DATA, -+ ERR_NOT_ENOUGH_SPACE, -+ ERR_WRITE_PROTECT, -+ ERR_READ_BACK_FAIL, -+ ERR_OUT_OF_RANGE -+} ERROR_CODE; -+ -+/*------------------------------Define structure----------------------------*/ ++/*------------------------------Define structure----------------------------*/ +typedef struct _EFUSE_HAL{ + u8 fakeEfuseBank; + u32 fakeEfuseUsedBytes; + u8 fakeEfuseContent[EFUSE_MAX_HW_SIZE]; + u8 fakeEfuseInitMap[EFUSE_MAX_MAP_LEN]; + u8 fakeEfuseModifiedMap[EFUSE_MAX_MAP_LEN]; -+ u32 EfuseUsedBytes; -+ u8 EfuseUsedPercentage; -+ ++ + u16 BTEfuseUsedBytes; + u8 BTEfuseUsedPercentage; + u8 BTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; @@ -327448,32 +145032,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_efuse.h linux/3rdparty/rtl88 + u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; + u8 fakeBTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN]; + u8 fakeBTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN]; -+ -+ // EFUSE Configuration, initialized in HAL_CmnInitPGData(). -+ const u16 MaxSecNum_WiFi; -+ const u16 MaxSecNum_BT; -+ const u16 WordUnit; -+ const u16 PhysicalLen_WiFi; -+ const u16 PhysicalLen_BT; -+ const u16 LogicalLen_WiFi; -+ const u16 LogicalLen_BT; -+ const u16 BankSize; -+ const u16 TotalBankNum; -+ const u16 BankNum_WiFi; -+ const u16 BankNum_BT; -+ const u16 OOBProtectBytes; -+ const u16 ProtectBytes; -+ const u16 BankAvailBytes; -+ const u16 TotalAvailBytes_WiFi; -+ const u16 TotalAvailBytes_BT; -+ const u16 HeaderRetry; -+ const u16 DataRetry; -+ -+ ERROR_CODE Status; -+ +}EFUSE_HAL, *PEFUSE_HAL; + -+extern u8 maskfileBuffer[32]; + +/*------------------------Export global variable----------------------------*/ +extern u8 fakeEfuseBank; @@ -327496,48 +145056,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_efuse.h linux/3rdparty/rtl88 +u8 efuse_GetCurrentSize(PADAPTER padapter, u16 *size); +u16 efuse_GetMaxSize(PADAPTER padapter); +u8 rtw_efuse_access(PADAPTER padapter, u8 bRead, u16 start_addr, u16 cnts, u8 *data); -+u8 rtw_efuse_mask_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); +u8 rtw_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); +u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); +u8 rtw_BT_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); -+u8 rtw_BT_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); ++u8 rtw_BT_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); + -+u16 Efuse_GetCurrentSize(PADAPTER pAdapter, u8 efuseType, BOOLEAN bPseudoTest); ++u16 Efuse_GetCurrentSize(PADAPTER pAdapter, u8 efuseType, bool bPseudoTest); +u8 Efuse_CalculateWordCnts(u8 word_en); -+void ReadEFuseByte(PADAPTER Adapter, u16 _offset, u8 *pbuf, BOOLEAN bPseudoTest) ; -+void EFUSE_GetEfuseDefinition(PADAPTER pAdapter, u8 efuseType, u8 type, void *pOut, BOOLEAN bPseudoTest); -+u8 efuse_OneByteRead(PADAPTER pAdapter, u16 addr, u8 *data, BOOLEAN bPseudoTest); -+u8 efuse_OneByteWrite(PADAPTER pAdapter, u16 addr, u8 data, BOOLEAN bPseudoTest); ++void ReadEFuseByte(PADAPTER Adapter, u16 _offset, u8 *pbuf, bool bPseudoTest) ; ++void EFUSE_GetEfuseDefinition(PADAPTER pAdapter, u8 efuseType, u8 type, void *pOut, bool bPseudoTest); ++u8 efuse_OneByteRead(PADAPTER pAdapter, u16 addr, u8 *data, bool bPseudoTest); ++u8 efuse_OneByteWrite(PADAPTER pAdapter, u16 addr, u8 data, bool bPseudoTest); + -+void BTEfuse_PowerSwitch(PADAPTER pAdapter,u8 bWrite,u8 PwrState); +void Efuse_PowerSwitch(PADAPTER pAdapter,u8 bWrite,u8 PwrState); -+int Efuse_PgPacketRead(PADAPTER pAdapter, u8 offset, u8 *data, BOOLEAN bPseudoTest); -+int Efuse_PgPacketWrite(PADAPTER pAdapter, u8 offset, u8 word_en, u8 *data, BOOLEAN bPseudoTest); ++int Efuse_PgPacketRead(PADAPTER pAdapter, u8 offset, u8 *data, bool bPseudoTest); ++int Efuse_PgPacketWrite(PADAPTER pAdapter, u8 offset, u8 word_en, u8 *data, bool bPseudoTest); +void efuse_WordEnableDataRead(u8 word_en, u8 *sourdata, u8 *targetdata); -+u8 Efuse_WordEnableDataWrite(PADAPTER pAdapter, u16 efuse_addr, u8 word_en, u8 *data, BOOLEAN bPseudoTest); ++u8 Efuse_WordEnableDataWrite(PADAPTER pAdapter, u16 efuse_addr, u8 word_en, u8 *data, bool bPseudoTest); + +u8 EFUSE_Read1Byte(PADAPTER pAdapter, u16 Address); -+void EFUSE_ShadowMapUpdate(PADAPTER pAdapter, u8 efuseType, BOOLEAN bPseudoTest); ++void EFUSE_ShadowMapUpdate(PADAPTER pAdapter, u8 efuseType, bool bPseudoTest); +void EFUSE_ShadowRead(PADAPTER pAdapter, u8 Type, u16 Offset, u32 *Value); -+u8 rtw_efuse_file_read(PADAPTER padapter,u8 *filepatch,u8 *buf, u32 len); -+ -+#ifdef PLATFORM_LINUX -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+u32 rtw_read_efuse_from_file(const char *path, u8 *buf); -+u32 rtw_read_macaddr_from_file(const char *path, u8 *buf); -+#endif /* CONFIG_EFUSE_CONFIG_FILE */ -+#endif /* PLATFORM_LINUX */ -+ +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_event.h linux/3rdparty/rtl8812au/include/rtw_event.h ---- linux.old/3rdparty/rtl8812au/include/rtw_event.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_event.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,140 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_event.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_event.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_event.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_event.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,130 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -327547,11 +145095,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_event.h linux/3rdparty/rtl88 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef _RTW_EVENT_H_ +#define _RTW_EVENT_H_ @@ -327576,8 +145119,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_event.h linux/3rdparty/rtl88 + +*/ +struct surveydone_event { -+ unsigned int bss_cnt; -+ ++ unsigned int bss_cnt; ++ +}; + +/* @@ -327604,7 +145147,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_event.h linux/3rdparty/rtl88 + unsigned char macaddr[6]; + unsigned char rsvd[2]; + int cam_id; -+ ++ +}; + +struct stadel_event { @@ -327615,13 +145158,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_event.h linux/3rdparty/rtl88 + +struct addba_event +{ -+ unsigned int tid; ++ unsigned int tid; +}; + -+struct wmm_event -+{ -+ unsigned char wmm; -+}; + +#ifdef CONFIG_H2CLBK +struct c2hlbk_event{ @@ -327632,7 +145171,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_event.h linux/3rdparty/rtl88 + unsigned char b0; + unsigned short s2; + unsigned char b1; -+ unsigned int w1; ++ unsigned int w1; +}; +#endif//CONFIG_H2CLBK + @@ -327646,7 +145185,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_event.h linux/3rdparty/rtl88 +}; + + -+#define C2HEVENT_SZ 32 ++#define C2HEVENT_SZ 32 + +struct event_node{ + unsigned char *node; @@ -327668,20 +145207,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_event.h linux/3rdparty/rtl88 +struct network_queue { + volatile int head; + volatile int tail; -+ WLAN_BSSID_EX networks[NETWORK_QUEUE_SZ]; ++ WLAN_BSSID_EX networks[NETWORK_QUEUE_SZ]; +}; + + +#endif // _WLANEVENT_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ht.h linux/3rdparty/rtl8812au/include/rtw_ht.h ---- linux.old/3rdparty/rtl8812au/include/rtw_ht.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_ht.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,221 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_ht.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ht.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_ht.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ht.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,87 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -327691,11 +145229,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ht.h linux/3rdparty/rtl8812a + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef _RTW_HT_H_ +#define _RTW_HT_H_ @@ -327703,20 +145236,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ht.h linux/3rdparty/rtl8812a + +struct ht_priv +{ -+ u8 ht_option; -+ u8 ampdu_enable;//for enable Tx A-MPDU -+ u8 tx_amsdu_enable;//for enable Tx A-MSDU -+ u8 bss_coexist;//for 20/40 Bss coexist -+ ++ u32 ht_option; ++ u32 ampdu_enable;//for enable Tx A-MPDU + //u8 baddbareq_issued[16]; ++ u32 tx_amsdu_enable;//for enable Tx A-MSDU + u32 tx_amsdu_maxlen; // 1: 8k, 0:4k ; default:8k, for tx + u32 rx_ampdu_maxlen; //for rx reordering ctrl win_sz, updated when join_callback. -+ -+ u8 rx_ampdu_min_spacing; -+ ++ ++ u8 bwmode;// + u8 ch_offset;//PRIME_CHNL_OFFSET -+ u8 sgi_20m; -+ u8 sgi_40m; ++ u8 sgi;//short GI + + //for processing Tx A-MPDU + u8 agg_enable_bitmap; @@ -327726,10 +145255,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ht.h linux/3rdparty/rtl8812a + u8 ldpc_cap; + u8 stbc_cap; + u8 beamform_cap; -+ u8 smps_cap; /*spatial multiplexing power save mode. 0:static SMPS, 1:dynamic SMPS, 3:SMPS disabled, 2:reserved*/ + + struct rtw_ieee80211_ht_cap ht_cap; -+ ++ +}; + +typedef enum AGGRE_SIZE{ @@ -327747,8 +145275,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ht.h linux/3rdparty/rtl8812a + RT_HT_CAP_USE_TURBO_AGGR = 0x01, + RT_HT_CAP_USE_LONG_PREAMBLE = 0x02, + RT_HT_CAP_USE_AMPDU = 0x04, -+ RT_HT_CAP_USE_WOW = 0x8, -+ RT_HT_CAP_USE_SOFTAP = 0x10, ++ RT_HT_CAP_USE_WOW = 0x8, ++ RT_HT_CAP_USE_SOFTAP = 0x10, + RT_HT_CAP_USE_92SE = 0x20, + RT_HT_CAP_USE_88C_92C = 0x40, + RT_HT_CAP_USE_AP_CLIENT_MODE = 0x80, // AP team request to reserve this bit, by Emily @@ -327773,140 +145301,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ht.h linux/3rdparty/rtl8812a +#define BEAMFORMING_HT_BEAMFORMER_ENABLE BIT0 // Declare our NIC supports beamformer +#define BEAMFORMING_HT_BEAMFORMEE_ENABLE BIT1 // Declare our NIC supports beamformee +#define BEAMFORMING_HT_BEAMFORMER_TEST BIT2 // Transmiting Beamforming no matter the target supports it or not -+#define BEAMFORMING_HT_BEAMFORMER_STEER_NUM (BIT4|BIT5) -+#define BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP (BIT6|BIT7) -+ -+//------------------------------------------------------------ -+// The HT Control field -+//------------------------------------------------------------ -+#define SET_HT_CTRL_CSI_STEERING(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart))+2, 6, 2, _val) -+#define SET_HT_CTRL_NDP_ANNOUNCEMENT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart))+3, 0, 1, _val) -+#define GET_HT_CTRL_NDP_ANNOUNCEMENT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+3, 0, 1) -+ -+// 20/40 BSS Coexist -+#define SET_EXT_CAPABILITY_ELE_BSS_COEXIST(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 0, 1, _val) -+#define GET_EXT_CAPABILITY_ELE_BSS_COEXIST(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 0, 1) -+ -+/* HT Capabilities Info field */ -+#define HT_CAP_ELE_CAP_INFO(_pEleStart) ((u8 *)(_pEleStart)) -+#define GET_HT_CAP_ELE_LDPC_CAP(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 0, 1) -+#define GET_HT_CAP_ELE_CHL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 1, 1) -+#define GET_HT_CAP_ELE_SM_PS(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 2, 2) -+#define GET_HT_CAP_ELE_GREENFIELD(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 4, 1) -+#define GET_HT_CAP_ELE_SHORT_GI20M(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 5, 1) -+#define GET_HT_CAP_ELE_SHORT_GI40M(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 6, 1) -+#define GET_HT_CAP_ELE_TX_STBC(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 7, 1) -+#define GET_HT_CAP_ELE_RX_STBC(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 0, 2) -+#define GET_HT_CAP_ELE_DELAYED_BA(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 2, 1) -+#define GET_HT_CAP_ELE_MAX_AMSDU_LENGTH(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 3, 1) -+#define GET_HT_CAP_ELE_DSSS_CCK_40M(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 4, 1) -+#define GET_HT_CAP_ELE_FORTY_INTOLERANT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 6, 1) -+#define GET_HT_CAP_ELE_LSIG_TXOP_PROTECT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 7, 1) -+ -+#define SET_HT_CAP_ELE_LDPC_CAP(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 0, 1, _val) -+#define SET_HT_CAP_ELE_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 1, 1, _val) -+#define SET_HT_CAP_ELE_SM_PS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 2, 2, _val) -+#define SET_HT_CAP_ELE_GREENFIELD(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 4, 1, _val) -+#define SET_HT_CAP_ELE_SHORT_GI20M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 5, 1, _val) -+#define SET_HT_CAP_ELE_SHORT_GI40M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 6, 1, _val) -+#define SET_HT_CAP_ELE_TX_STBC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 7, 1, _val) -+#define SET_HT_CAP_ELE_RX_STBC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 0, 2, _val) -+#define SET_HT_CAP_ELE_DELAYED_BA(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 2, 1, _val) -+#define SET_HT_CAP_ELE_MAX_AMSDU_LENGTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 3, 1, _val) -+#define SET_HT_CAP_ELE_DSSS_CCK_40M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 4, 1, _val) -+#define SET_HT_CAP_ELE_FORTY_INTOLERANT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 6, 1, _val) -+#define SET_HT_CAP_ELE_LSIG_TXOP_PROTECT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 7, 1, _val) -+ -+/* A-MPDU Parameters field */ -+#define HT_CAP_ELE_AMPDU_PARA(_pEleStart) (((u8 *)(_pEleStart))+2) -+#define GET_HT_CAP_ELE_MAX_AMPDU_LEN_EXP(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+2, 0, 2) -+#define GET_HT_CAP_ELE_MIN_MPDU_S_SPACE(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+2, 2, 3) -+ -+#define HT_AMPDU_PARA_FMT "%02x " \ -+ "MAX AMPDU len:%u bytes, MIN MPDU Start Spacing:%u" -+ -+#define HT_AMPDU_PARA_ARG(x) \ -+ *((u8*)(x)) \ -+ , (1 << (13+GET_HT_CAP_ELE_MAX_AMPDU_LEN_EXP(((u8*)x)-2)))-1 \ -+ , GET_HT_CAP_ELE_MIN_MPDU_S_SPACE(((u8*)x)-2) -+ -+/* Supported MCS Set field */ -+#define HT_CAP_ELE_SUP_MCS_SET(_pEleStart) (((u8 *)(_pEleStart))+3) -+#define HT_CAP_ELE_RX_MCS_MAP(_pEleStart) HT_CAP_ELE_SUP_MCS_SET(_pEleStart) -+#define GET_HT_CAP_ELE_RX_HIGHEST_DATA_RATE(_pEleStart) LE_BITS_TO_2BYTE(((u8 *)(_pEleStart))+13, 0, 10) -+#define GET_HT_CAP_ELE_TX_MCS_DEF(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 0, 1) -+#define GET_HT_CAP_ELE_TRX_MCS_NEQ(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 1, 1) -+#define GET_HT_CAP_ELE_TX_MAX_SS(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 2, 2) -+#define GET_HT_CAP_ELE_TX_UEQM(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 4, 1) -+ -+#define HT_SUP_MCS_SET_FMT "%02x %02x %02x %02x %02x%02x%02x%02x%02x%02x" \ -+ /* "\n%02x%02x%02x%02x%02x%02x" */\ -+ " %uMbps %s%s%s" -+#define HT_SUP_MCS_SET_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5], \ -+ ((u8 *)(x))[6], ((u8 *)(x))[7], ((u8 *)(x))[8], ((u8 *)(x))[9] \ -+ /*,((u8 *)(x))[10],((u8 *)(x))[11], ((u8 *)(x))[12],((u8 *)(x))[13],((u8 *)(x))[14],((u8 *)(x))[15] */\ -+ , GET_HT_CAP_ELE_RX_HIGHEST_DATA_RATE(((u8 *)x)-3) \ -+ , GET_HT_CAP_ELE_TX_MCS_DEF(((u8 *)x)-3) ? "TX_MCS_DEF " : "" \ -+ , GET_HT_CAP_ELE_TRX_MCS_NEQ(((u8 *)x)-3) ? "TRX_MCS_NEQ " : "" \ -+ , GET_HT_CAP_ELE_TX_UEQM(((u8 *)x)-3) ? "TX_UEQM " : "" -+ -+//TXBF Capabilities -+#define SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 3, 1, ((u8)_val)) -+#define SET_HT_CAP_TXBF_TRANSMIT_NDP_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 4, 1, ((u8)_val)) -+#define SET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 10, 1, ((u8)_val)) -+#define SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 15, 2, ((u8)_val)) -+#define SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 23, 2, ((u8)_val)) -+#define SET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 27, 2, ((u8)_val)) -+ -+ -+#define GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(_pEleStart) LE_BITS_TO_4BYTE(((u8 *)(_pEleStart))+21, 10, 1) -+#define GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(_pEleStart) LE_BITS_TO_4BYTE(((u8 *)(_pEleStart))+21, 15, 2) -+#define GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(_pEleStart) LE_BITS_TO_4BYTE(((u8 *)(_pEleStart))+21, 23, 2) -+#define GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(_pEleStart) LE_BITS_TO_4BYTE(((u8 *)(_pEleStart))+21, 27, 2) -+ -+/* HT Operation element */ -+ -+#define GET_HT_OP_ELE_PRI_CHL(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 0, 8) -+#define SET_HT_OP_ELE_PRI_CHL(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 0, 8, _val) -+ -+/* HT Operation Info field */ -+#define HT_OP_ELE_OP_INFO(_pEleStart) (((u8 *)(_pEleStart)) + 1) -+#define GET_HT_OP_ELE_2ND_CHL_OFFSET(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 1, 0, 2) -+#define GET_HT_OP_ELE_STA_CHL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 1, 2, 1) -+#define GET_HT_OP_ELE_RIFS_MODE(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 1, 3, 1) -+#define GET_HT_OP_ELE_HT_PROTECT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 2, 0, 2) -+#define GET_HT_OP_ELE_NON_GREEN_PRESENT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 2, 2, 1) -+#define GET_HT_OP_ELE_OBSS_NON_HT_PRESENT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 2, 4, 1) -+#define GET_HT_OP_ELE_DUAL_BEACON(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 4, 6, 1) -+#define GET_HT_OP_ELE_DUAL_CTS(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 4, 7, 1) -+#define GET_HT_OP_ELE_STBC_BEACON(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 5, 0, 1) -+#define GET_HT_OP_ELE_LSIG_TXOP_PROTECT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 5, 1, 1) -+#define GET_HT_OP_ELE_PCO_ACTIVE(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 5, 2, 1) -+#define GET_HT_OP_ELE_PCO_PHASE(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 5, 3, 1) -+ -+#define SET_HT_OP_ELE_2ND_CHL_OFFSET(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 0, 2, _val) -+#define SET_HT_OP_ELE_STA_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 2, 1, _val) -+#define SET_HT_OP_ELE_RIFS_MODE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 3, 1, _val) -+#define SET_HT_OP_ELE_HT_PROTECT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 2, 0, 2, _val) -+#define SET_HT_OP_ELE_NON_GREEN_PRESENT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 2, 2, 1, _val) -+#define SET_HT_OP_ELE_OBSS_NON_HT_PRESENT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 2, 4, 1, _val) -+#define SET_HT_OP_ELE_DUAL_BEACON(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 4, 6, 1, _val) -+#define SET_HT_OP_ELE_DUAL_CTS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 4, 7, 1, _val) -+#define SET_HT_OP_ELE_STBC_BEACON(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 5, 0, 1, _val) -+#define SET_HT_OP_ELE_LSIG_TXOP_PROTECT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 5, 1, 1, _val) -+#define SET_HT_OP_ELE_PCO_ACTIVE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 5, 2, 1, _val) -+#define SET_HT_OP_ELE_PCO_PHASE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 5, 3, 1, _val) + +#endif //_RTL871X_HT_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl.h linux/3rdparty/rtl8812au/include/rtw_ioctl.h ---- linux.old/3rdparty/rtl8812au/include/rtw_ioctl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_ioctl.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,329 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,187 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -327916,16 +145320,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl.h linux/3rdparty/rtl88 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef _RTW_IOCTL_H_ +#define _RTW_IOCTL_H_ + -+#ifndef PLATFORM_WINDOWS +// 00 - Success +// 11 - Error +#define STATUS_SUCCESS (0x00000000L) @@ -327935,58 +145333,56 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl.h linux/3rdparty/rtl88 +#define STATUS_INSUFFICIENT_RESOURCES (0xC000009AL) +#define STATUS_NOT_SUPPORTED (0xC00000BBL) + -+#define NDIS_STATUS_SUCCESS ((NDIS_STATUS)STATUS_SUCCESS) -+#define NDIS_STATUS_PENDING ((NDIS_STATUS)STATUS_PENDING) -+#define NDIS_STATUS_NOT_RECOGNIZED ((NDIS_STATUS)0x00010001L) -+#define NDIS_STATUS_NOT_COPIED ((NDIS_STATUS)0x00010002L) -+#define NDIS_STATUS_NOT_ACCEPTED ((NDIS_STATUS)0x00010003L) -+#define NDIS_STATUS_CALL_ACTIVE ((NDIS_STATUS)0x00010007L) ++#define uint_SUCCESS ((uint)STATUS_SUCCESS) ++#define uint_PENDING ((uint)STATUS_PENDING) ++#define uint_NOT_RECOGNIZED ((uint)0x00010001L) ++#define uint_NOT_COPIED ((uint)0x00010002L) ++#define uint_NOT_ACCEPTED ((uint)0x00010003L) ++#define uint_CALL_ACTIVE ((uint)0x00010007L) + -+#define NDIS_STATUS_FAILURE ((NDIS_STATUS)STATUS_UNSUCCESSFUL) -+#define NDIS_STATUS_RESOURCES ((NDIS_STATUS)STATUS_INSUFFICIENT_RESOURCES) -+#define NDIS_STATUS_CLOSING ((NDIS_STATUS)0xC0010002L) -+#define NDIS_STATUS_BAD_VERSION ((NDIS_STATUS)0xC0010004L) -+#define NDIS_STATUS_BAD_CHARACTERISTICS ((NDIS_STATUS)0xC0010005L) -+#define NDIS_STATUS_ADAPTER_NOT_FOUND ((NDIS_STATUS)0xC0010006L) -+#define NDIS_STATUS_OPEN_FAILED ((NDIS_STATUS)0xC0010007L) -+#define NDIS_STATUS_DEVICE_FAILED ((NDIS_STATUS)0xC0010008L) -+#define NDIS_STATUS_MULTICAST_FULL ((NDIS_STATUS)0xC0010009L) -+#define NDIS_STATUS_MULTICAST_EXISTS ((NDIS_STATUS)0xC001000AL) -+#define NDIS_STATUS_MULTICAST_NOT_FOUND ((NDIS_STATUS)0xC001000BL) -+#define NDIS_STATUS_REQUEST_ABORTED ((NDIS_STATUS)0xC001000CL) -+#define NDIS_STATUS_RESET_IN_PROGRESS ((NDIS_STATUS)0xC001000DL) -+#define NDIS_STATUS_CLOSING_INDICATING ((NDIS_STATUS)0xC001000EL) -+#define NDIS_STATUS_NOT_SUPPORTED ((NDIS_STATUS)STATUS_NOT_SUPPORTED) -+#define NDIS_STATUS_INVALID_PACKET ((NDIS_STATUS)0xC001000FL) -+#define NDIS_STATUS_OPEN_LIST_FULL ((NDIS_STATUS)0xC0010010L) -+#define NDIS_STATUS_ADAPTER_NOT_READY ((NDIS_STATUS)0xC0010011L) -+#define NDIS_STATUS_ADAPTER_NOT_OPEN ((NDIS_STATUS)0xC0010012L) -+#define NDIS_STATUS_NOT_INDICATING ((NDIS_STATUS)0xC0010013L) -+#define NDIS_STATUS_INVALID_LENGTH ((NDIS_STATUS)0xC0010014L) -+#define NDIS_STATUS_INVALID_DATA ((NDIS_STATUS)0xC0010015L) -+#define NDIS_STATUS_BUFFER_TOO_SHORT ((NDIS_STATUS)0xC0010016L) -+#define NDIS_STATUS_INVALID_OID ((NDIS_STATUS)0xC0010017L) -+#define NDIS_STATUS_ADAPTER_REMOVED ((NDIS_STATUS)0xC0010018L) -+#define NDIS_STATUS_UNSUPPORTED_MEDIA ((NDIS_STATUS)0xC0010019L) -+#define NDIS_STATUS_GROUP_ADDRESS_IN_USE ((NDIS_STATUS)0xC001001AL) -+#define NDIS_STATUS_FILE_NOT_FOUND ((NDIS_STATUS)0xC001001BL) -+#define NDIS_STATUS_ERROR_READING_FILE ((NDIS_STATUS)0xC001001CL) -+#define NDIS_STATUS_ALREADY_MAPPED ((NDIS_STATUS)0xC001001DL) -+#define NDIS_STATUS_RESOURCE_CONFLICT ((NDIS_STATUS)0xC001001EL) -+#define NDIS_STATUS_NO_CABLE ((NDIS_STATUS)0xC001001FL) -+ -+#define NDIS_STATUS_INVALID_SAP ((NDIS_STATUS)0xC0010020L) -+#define NDIS_STATUS_SAP_IN_USE ((NDIS_STATUS)0xC0010021L) -+#define NDIS_STATUS_INVALID_ADDRESS ((NDIS_STATUS)0xC0010022L) -+#define NDIS_STATUS_VC_NOT_ACTIVATED ((NDIS_STATUS)0xC0010023L) -+#define NDIS_STATUS_DEST_OUT_OF_ORDER ((NDIS_STATUS)0xC0010024L) // cause 27 -+#define NDIS_STATUS_VC_NOT_AVAILABLE ((NDIS_STATUS)0xC0010025L) // cause 35,45 -+#define NDIS_STATUS_CELLRATE_NOT_AVAILABLE ((NDIS_STATUS)0xC0010026L) // cause 37 -+#define NDIS_STATUS_INCOMPATABLE_QOS ((NDIS_STATUS)0xC0010027L) // cause 49 -+#define NDIS_STATUS_AAL_PARAMS_UNSUPPORTED ((NDIS_STATUS)0xC0010028L) // cause 93 -+#define NDIS_STATUS_NO_ROUTE_TO_DESTINATION ((NDIS_STATUS)0xC0010029L) // cause 3 -+#endif /* #ifndef PLATFORM_WINDOWS */ ++#define uint_FAILURE ((uint)STATUS_UNSUCCESSFUL) ++#define uint_RESOURCES ((uint)STATUS_INSUFFICIENT_RESOURCES) ++#define uint_CLOSING ((uint)0xC0010002L) ++#define uint_BAD_VERSION ((uint)0xC0010004L) ++#define uint_BAD_CHARACTERISTICS ((uint)0xC0010005L) ++#define uint_ADAPTER_NOT_FOUND ((uint)0xC0010006L) ++#define uint_OPEN_FAILED ((uint)0xC0010007L) ++#define uint_DEVICE_FAILED ((uint)0xC0010008L) ++#define uint_MULTICAST_FULL ((uint)0xC0010009L) ++#define uint_MULTICAST_EXISTS ((uint)0xC001000AL) ++#define uint_MULTICAST_NOT_FOUND ((uint)0xC001000BL) ++#define uint_REQUEST_ABORTED ((uint)0xC001000CL) ++#define uint_RESET_IN_PROGRESS ((uint)0xC001000DL) ++#define uint_CLOSING_INDICATING ((uint)0xC001000EL) ++#define uint_NOT_SUPPORTED ((uint)STATUS_NOT_SUPPORTED) ++#define uint_INVALID_PACKET ((uint)0xC001000FL) ++#define uint_OPEN_LIST_FULL ((uint)0xC0010010L) ++#define uint_ADAPTER_NOT_READY ((uint)0xC0010011L) ++#define uint_ADAPTER_NOT_OPEN ((uint)0xC0010012L) ++#define uint_NOT_INDICATING ((uint)0xC0010013L) ++#define uint_INVALID_LENGTH ((uint)0xC0010014L) ++#define uint_INVALID_DATA ((uint)0xC0010015L) ++#define uint_BUFFER_TOO_SHORT ((uint)0xC0010016L) ++#define uint_INVALID_OID ((uint)0xC0010017L) ++#define uint_ADAPTER_REMOVED ((uint)0xC0010018L) ++#define uint_UNSUPPORTED_MEDIA ((uint)0xC0010019L) ++#define uint_GROUP_ADDRESS_IN_USE ((uint)0xC001001AL) ++#define uint_FILE_NOT_FOUND ((uint)0xC001001BL) ++#define uint_ERROR_READING_FILE ((uint)0xC001001CL) ++#define uint_ALREADY_MAPPED ((uint)0xC001001DL) ++#define uint_RESOURCE_CONFLICT ((uint)0xC001001EL) ++#define uint_NO_CABLE ((uint)0xC001001FL) + ++#define uint_INVALID_SAP ((uint)0xC0010020L) ++#define uint_SAP_IN_USE ((uint)0xC0010021L) ++#define uint_INVALID_ADDRESS ((uint)0xC0010022L) ++#define uint_VC_NOT_ACTIVATED ((uint)0xC0010023L) ++#define uint_DEST_OUT_OF_ORDER ((uint)0xC0010024L) // cause 27 ++#define uint_VC_NOT_AVAILABLE ((uint)0xC0010025L) // cause 35,45 ++#define uint_CELLRATE_NOT_AVAILABLE ((uint)0xC0010026L) // cause 37 ++#define uint_INCOMPATABLE_QOS ((uint)0xC0010027L) // cause 49 ++#define uint_AAL_PARAMS_UNSUPPORTED ((uint)0xC0010028L) // cause 93 ++#define uint_NO_ROUTE_TO_DESTINATION ((uint)0xC0010029L) // cause 3 + +#ifndef OID_802_11_CAPABILITY + #define OID_802_11_CAPABILITY 0x0d010122 @@ -328027,11 +145423,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl.h linux/3rdparty/rtl88 +#define OID_MP_SEG3 0xFF818700 +#define OID_MP_SEG4 0xFF011100 + -+#define DEBUG_OID(dbg, str) \ -+ if((!dbg)) \ -+ { \ ++#define DEBUG_OID(dbg, str) \ ++ if((!dbg)) \ ++ { \ + RT_TRACE(_module_rtl871x_ioctl_c_,_drv_info_,("%s(%d): %s", __FUNCTION__, __LINE__, str)); \ -+ } ++ } + + +enum oid_type @@ -328043,16 +145439,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl.h linux/3rdparty/rtl88 +struct oid_funs_node { + unsigned int oid_start; //the starting number for OID + unsigned int oid_end; //the ending number for OID -+ struct oid_obj_priv *node_array; ++ struct oid_obj_priv *node_array; + unsigned int array_sz; //the size of node_array -+ int query_counter; //count the number of query hits for this segment -+ int set_counter; //count the number of set hits for this segment ++ int query_counter; //count the number of query hits for this segment ++ int set_counter; //count the number of set hits for this segment +}; + +struct oid_par_priv +{ + void *adapter_context; -+ NDIS_OID oid; ++ uint oid; + void *information_buf; + u32 information_buf_len; + u32 *bytes_rw; @@ -328062,184 +145458,50 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl.h linux/3rdparty/rtl88 +}; + +struct oid_obj_priv { -+ unsigned char dbg; // 0: without OID debug message 1: with OID debug message -+ NDIS_STATUS (*oidfuns)(struct oid_par_priv *poid_par_priv); ++ unsigned char dbg; // 0: without OID debug message 1: with OID debug message ++ uint (*oidfuns)(struct oid_par_priv *poid_par_priv); +}; + -+#if (defined(CONFIG_MP_INCLUDED) && defined(_RTW_MP_IOCTL_C_)) || \ -+ (defined(PLATFORM_WINDOWS) && defined(_RTW_IOCTL_RTL_C_)) -+static NDIS_STATUS oid_null_function(struct oid_par_priv* poid_par_priv) ++#if (defined(CONFIG_MP_INCLUDED) && defined(_RTW_MP_IOCTL_C_)) ++static uint oid_null_function(struct oid_par_priv* poid_par_priv) +{ -+ _func_enter_; -+ _func_exit_; -+ return NDIS_STATUS_SUCCESS; ++ return uint_SUCCESS; +} +#endif + -+#ifdef PLATFORM_WINDOWS -+ -+int TranslateNdisPsToRtPs(IN NDIS_802_11_POWER_MODE ndisPsMode); -+ -+//OID Handler for Segment 1 -+NDIS_STATUS oid_gen_supported_list_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_hardware_status_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_media_supported_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_media_in_use_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_maximum_lookahead_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_maximum_frame_size_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_link_speed_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_transmit_buffer_space_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_receive_buffer_space_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_transmit_block_size_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_receive_block_size_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_vendor_id_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_vendor_description_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_current_packet_filter_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_current_lookahead_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_driver_version_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_maximum_total_size_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_protocol_options_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_mac_options_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_media_connect_status_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_maximum_send_packets_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_vendor_driver_version_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+//OID Handler for Segment 2 -+NDIS_STATUS oid_gen_physical_medium_hdl(struct oid_par_priv* poid_par_priv); -+ -+//OID Handler for Segment 3 -+NDIS_STATUS oid_gen_xmit_ok_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_rcv_ok_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_xmit_error_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_rcv_error_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_gen_rcv_no_buffer_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+//OID Handler for Segment 4 -+NDIS_STATUS oid_802_3_permanent_address_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_3_current_address_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_3_multicast_list_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_3_maximum_list_size_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_3_mac_options_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+ -+//OID Handler for Segment 5 -+NDIS_STATUS oid_802_3_rcv_error_alignment_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_one_collision_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_more_collisions_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+//OID Handler for Segment 6 -+NDIS_STATUS oid_802_3_xmit_deferred_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_max_collisions_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_3_rcv_overrun_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_underrun_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_heartbeat_failure_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_times_crs_lost_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_late_collisions_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+ -+//OID Handler for Segment 7 -+NDIS_STATUS oid_pnp_capabilities_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_pnp_set_power_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_pnp_query_power_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_pnp_add_wake_up_pattern_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_pnp_remove_wake_up_pattern_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_pnp_wake_up_pattern_list_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_pnp_enable_wake_up_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+ -+//OID Handler for Segment 8 -+NDIS_STATUS oid_802_11_bssid_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_ssid_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_infrastructure_mode_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_add_wep_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_remove_wep_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_disassociate_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_authentication_mode_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_privacy_filter_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_bssid_list_scan_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_encryption_status_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_reload_defaults_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_add_key_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_remove_key_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_association_information_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_test_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_media_stream_mode_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_capability_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_pmkid_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+ -+ -+ -+//OID Handler for Segment 9 -+NDIS_STATUS oid_802_11_network_types_supported_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_network_type_in_use_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_tx_power_level_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_rssi_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_rssi_trigger_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_fragmentation_threshold_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_rts_threshold_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_number_of_antennas_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_rx_antenna_selected_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_tx_antenna_selected_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_supported_rates_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_desired_rates_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_configuration_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_power_mode_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_802_11_bssid_list_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+//OID Handler for Segment 10 -+NDIS_STATUS oid_802_11_statistics_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+//OID Handler for Segment ED -+NDIS_STATUS oid_rt_mh_vender_id_hdl(struct oid_par_priv* poid_par_priv); -+ -+void Set_802_3_MULTICAST_LIST(ADAPTER *pAdapter, UCHAR *MCListbuf, ULONG MCListlen, BOOLEAN bAcceptAllMulticast); -+ -+#endif// end of PLATFORM_WINDOWS -+ -+#if defined(PLATFORM_LINUX) && defined(CONFIG_WIRELESS_EXT) ++#if defined(CONFIG_WIRELESS_EXT) +extern struct iw_handler_def rtw_handlers_def; +#endif + +extern void rtw_request_wps_pbc_event(_adapter *padapter); + -+extern NDIS_STATUS drv_query_info( -+ IN _nic_hdl MiniportAdapterContext, -+ IN NDIS_OID Oid, -+ IN void * InformationBuffer, -+ IN u32 InformationBufferLength, -+ OUT u32* BytesWritten, -+ OUT u32* BytesNeeded ++extern uint drv_query_info( ++ _nic_hdl MiniportAdapterContext, ++ uint Oid, ++ void * InformationBuffer, ++ u32 InformationBufferLength, ++ u32* BytesWritten, ++ u32* BytesNeeded + ); + -+extern NDIS_STATUS drv_set_info( -+ IN _nic_hdl MiniportAdapterContext, -+ IN NDIS_OID Oid, -+ IN void * InformationBuffer, -+ IN u32 InformationBufferLength, -+ OUT u32* BytesRead, -+ OUT u32* BytesNeeded ++extern uint drv_set_info( ++ _nic_hdl MiniportAdapterContext, ++ uint Oid, ++ void * InformationBuffer, ++ u32 InformationBufferLength, ++ u32* BytesRead, ++ u32* BytesNeeded + ); + +#endif // #ifndef __INC_CEINFO_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl_query.h linux/3rdparty/rtl8812au/include/rtw_ioctl_query.h ---- linux.old/3rdparty/rtl8812au/include/rtw_ioctl_query.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_ioctl_query.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,33 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl_query.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl_query.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl_query.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl_query.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,18 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -328249,34 +145511,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl_query.h linux/3rdparty + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef _RTW_IOCTL_QUERY_H_ +#define _RTW_IOCTL_QUERY_H_ + -+ -+#ifdef PLATFORM_WINDOWS -+ -+u8 query_802_11_capability(_adapter* padapter,u8* pucBuf,u32 * pulOutLen); -+u8 query_802_11_association_information (_adapter * padapter, PNDIS_802_11_ASSOCIATION_INFORMATION pAssocInfo); -+ +#endif -+ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl_rtl.h linux/3rdparty/rtl8812au/include/rtw_ioctl_rtl.h ---- linux.old/3rdparty/rtl8812au/include/rtw_ioctl_rtl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_ioctl_rtl.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,81 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl_rtl.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl_rtl.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl_rtl.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl_rtl.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,75 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -328286,82 +145533,76 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl_rtl.h linux/3rdparty/r + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef _RTW_IOCTL_RTL_H_ +#define _RTW_IOCTL_RTL_H_ + + -+//************** oid_rtl_seg_01_01 ************** -+NDIS_STATUS oid_rt_get_signal_quality_hdl(struct oid_par_priv* poid_par_priv);//84 -+NDIS_STATUS oid_rt_get_small_packet_crc_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_middle_packet_crc_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_large_packet_crc_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_tx_retry_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_rx_retry_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_rx_total_packet_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_tx_beacon_ok_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_tx_beacon_err_hdl(struct oid_par_priv* poid_par_priv); ++//************** oid_rtl_seg_01_01 ************** ++uint oid_rt_get_signal_quality_hdl(struct oid_par_priv* poid_par_priv);//84 ++uint oid_rt_get_small_packet_crc_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_middle_packet_crc_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_large_packet_crc_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_tx_retry_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_rx_retry_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_rx_total_packet_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_tx_beacon_ok_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_tx_beacon_err_hdl(struct oid_par_priv* poid_par_priv); + -+NDIS_STATUS oid_rt_pro_set_fw_dig_state_hdl(struct oid_par_priv* poid_par_priv); //8a -+NDIS_STATUS oid_rt_pro_set_fw_ra_state_hdl(struct oid_par_priv* poid_par_priv); //8b ++uint oid_rt_pro_set_fw_dig_state_hdl(struct oid_par_priv* poid_par_priv); //8a ++uint oid_rt_pro_set_fw_ra_state_hdl(struct oid_par_priv* poid_par_priv); //8b + -+NDIS_STATUS oid_rt_get_rx_icv_err_hdl(struct oid_par_priv* poid_par_priv);//93 -+NDIS_STATUS oid_rt_set_encryption_algorithm_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_preamble_mode_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_ap_ip_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_channelplan_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_set_channelplan_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_set_preamble_mode_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_set_bcn_intvl_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_dedicate_probe_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_total_tx_bytes_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_total_rx_bytes_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_current_tx_power_level_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_enc_key_mismatch_count_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_enc_key_match_count_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_channel_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_hardware_radio_off_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_key_mismatch_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_supported_wireless_mode_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_channel_list_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_scan_in_progress_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_forced_data_rate_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_wireless_mode_for_scan_list_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_bss_wireless_mode_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_scan_with_magic_packet_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_rx_icv_err_hdl(struct oid_par_priv* poid_par_priv);//93 ++uint oid_rt_set_encryption_algorithm_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_preamble_mode_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_ap_ip_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_channelplan_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_set_channelplan_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_set_preamble_mode_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_set_bcn_intvl_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_dedicate_probe_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_total_tx_bytes_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_total_rx_bytes_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_current_tx_power_level_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_enc_key_mismatch_count_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_enc_key_match_count_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_channel_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_hardware_radio_off_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_key_mismatch_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_supported_wireless_mode_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_channel_list_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_scan_in_progress_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_forced_data_rate_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_wireless_mode_for_scan_list_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_bss_wireless_mode_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_scan_with_magic_packet_hdl(struct oid_par_priv* poid_par_priv); + -+//************** oid_rtl_seg_01_03 section start ************** -+NDIS_STATUS oid_rt_ap_get_associated_station_list_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_ap_switch_into_ap_mode_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_ap_supported_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_ap_set_passphrase_hdl(struct oid_par_priv* poid_par_priv); ++//************** oid_rtl_seg_01_03 section start ************** ++uint oid_rt_ap_get_associated_station_list_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_ap_switch_into_ap_mode_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_ap_supported_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_ap_set_passphrase_hdl(struct oid_par_priv* poid_par_priv); + -+// oid_rtl_seg_01_11 -+NDIS_STATUS oid_rt_pro_rf_write_registry_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_rf_read_registry_hdl(struct oid_par_priv* poid_par_priv); ++// oid_rtl_seg_01_11 ++uint oid_rt_pro_rf_write_registry_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_rf_read_registry_hdl(struct oid_par_priv* poid_par_priv); + -+//************** oid_rtl_seg_03_00 section start ************** -+NDIS_STATUS oid_rt_get_connect_state_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_set_default_key_id_hdl(struct oid_par_priv* poid_par_priv); ++//************** oid_rtl_seg_03_00 section start ************** ++uint oid_rt_get_connect_state_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_set_default_key_id_hdl(struct oid_par_priv* poid_par_priv); + + + + +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl_set.h linux/3rdparty/rtl8812au/include/rtw_ioctl_set.h ---- linux.old/3rdparty/rtl8812au/include/rtw_ioctl_set.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_ioctl_set.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,76 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl_set.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl_set.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl_set.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl_set.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,45 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -328371,11 +145612,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl_set.h linux/3rdparty/r + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __RTW_IOCTL_SET_H_ +#define __RTW_IOCTL_SET_H_ @@ -328388,29 +145624,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl_set.h linux/3rdparty/r + NDIS_802_11_PMKID_VALUE PMKID; +} BSSIDInfo, *PBSSIDInfo; + -+ -+#ifdef PLATFORM_OS_XP -+typedef struct _NDIS_802_11_PMKID { -+ u32 Length; -+ u32 BSSIDInfoCount; -+ BSSIDInfo BSSIDInfo[1]; -+} NDIS_802_11_PMKID, *PNDIS_802_11_PMKID; -+#endif -+ -+ -+#ifdef PLATFORM_WINDOWS -+u8 rtw_set_802_11_reload_defaults(_adapter * padapter, NDIS_802_11_RELOAD_DEFAULTS reloadDefaults); -+u8 rtw_set_802_11_test(_adapter * padapter, NDIS_802_11_TEST * test); -+u8 rtw_set_802_11_pmkid(_adapter *pdapter, NDIS_802_11_PMKID *pmkid); -+ -+u8 rtw_pnp_set_power_sleep(_adapter* padapter); -+u8 rtw_pnp_set_power_wakeup(_adapter* padapter); -+ -+void rtw_pnp_resume_wk(void *context); -+void rtw_pnp_sleep_wk(void * context); -+ -+#endif -+ +u8 rtw_set_802_11_add_key(_adapter * padapter, NDIS_802_11_KEY * key); +u8 rtw_set_802_11_authentication_mode(_adapter *pdapter, NDIS_802_11_AUTHENTICATION_MODE authmode); +u8 rtw_set_802_11_bssid(_adapter* padapter, u8 *bssid); @@ -328420,28 +145633,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_ioctl_set.h linux/3rdparty/r +u8 rtw_set_802_11_infrastructure_mode(_adapter * padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype); +u8 rtw_set_802_11_remove_wep(_adapter * padapter, u32 keyindex); +u8 rtw_set_802_11_ssid(_adapter * padapter, NDIS_802_11_SSID * ssid); -+u8 rtw_set_802_11_connect(_adapter* padapter, u8 *bssid, NDIS_802_11_SSID *ssid); +u8 rtw_set_802_11_remove_key(_adapter * padapter, NDIS_802_11_REMOVE_KEY * key); + -+u8 rtw_validate_bssid(u8 *bssid); ++ +u8 rtw_validate_ssid(NDIS_802_11_SSID *ssid); + +u16 rtw_get_cur_max_rate(_adapter *adapter); +int rtw_set_scan_mode(_adapter *adapter, RT_SCAN_TYPE scan_mode); +int rtw_set_channel_plan(_adapter *adapter, u8 channel_plan); +int rtw_set_country(_adapter *adapter, const char *country_code); -+int rtw_set_band(_adapter *adapter, u8 band); + +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812au/include/rtw_io.h ---- linux.old/3rdparty/rtl8812au/include/rtw_io.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_io.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,578 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_io.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_io.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_io.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_io.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,448 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -328451,24 +145661,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ + +#ifndef _RTW_IO_H_ +#define _RTW_IO_H_ + ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) ++#define rtw_usb_buffer_alloc(dev, size, dma) usb_alloc_coherent((dev), (size), (in_interrupt() ? GFP_ATOMIC : GFP_KERNEL), (dma)) ++#define rtw_usb_buffer_free(dev, size, addr, dma) usb_free_coherent((dev), (size), (addr), (dma)) ++#else ++#define rtw_usb_buffer_alloc(dev, size, dma) usb_buffer_alloc((dev), (size), (in_interrupt() ? GFP_ATOMIC : GFP_KERNEL), (dma)) ++#define rtw_usb_buffer_free(dev, size, addr, dma) usb_buffer_free((dev), (size), (addr), (dma)) ++#endif ++ +#define NUM_IOREQ 8 + -+#ifdef PLATFORM_WINDOWS -+#define MAX_PROT_SZ 64 -+#endif -+#ifdef PLATFORM_LINUX +#define MAX_PROT_SZ (64-16) -+#endif + +#define _IOREADY 0 +#define _IO_WAIT_COMPLETE 1 @@ -328486,7 +145694,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a +#define _IO_CMDMASK_ (0x1F80) + + -+/* ++/* + For prompt mode accessing, caller shall free io_req + Otherwise, io_handler will free io_req +*/ @@ -328534,8 +145742,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a +struct intf_hdl; +struct io_queue; + -+struct _io_ops -+{ ++struct _io_ops { + u8 (*_read8)(struct intf_hdl *pintfhdl, u32 addr); + u16 (*_read16)(struct intf_hdl *pintfhdl, u32 addr); + u32 (*_read32)(struct intf_hdl *pintfhdl, u32 addr); @@ -328564,71 +145771,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a + void (*_read_port_cancel)(struct intf_hdl *pintfhdl); + void (*_write_port_cancel)(struct intf_hdl *pintfhdl); + -+#ifdef CONFIG_SDIO_HCI -+ u8 (*_sd_f0_read8)(struct intf_hdl *pintfhdl, u32 addr); -+ #ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ u8 (*_sd_iread8)(struct intf_hdl *pintfhdl, u32 addr); -+ u16 (*_sd_iread16)(struct intf_hdl *pintfhdl, u32 addr); -+ u32 (*_sd_iread32)(struct intf_hdl *pintfhdl, u32 addr); -+ int (*_sd_iwrite8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int (*_sd_iwrite16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int (*_sd_iwrite32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ #endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+#endif -+ +}; + -+struct io_req { ++struct io_req { + _list list; -+ u32 addr; ++ u32 addr; + volatile u32 val; + u32 command; + u32 status; -+ u8 *pbuf; ++ u8 *pbuf; + _sema sema; + -+#ifdef PLATFORM_OS_CE -+#ifdef CONFIG_USB_HCI -+ // URB handler for rtw_write_mem -+ USB_TRANSFER usb_transfer_write_mem; -+#endif -+#endif -+ + void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt); -+ u8 *cnxt; -+ -+#ifdef PLATFORM_OS_XP -+ PMDL pmdl; -+ PIRP pirp; -+ -+#ifdef CONFIG_SDIO_HCI -+ PSDBUS_REQUEST_PACKET sdrp; -+#endif -+ -+#endif -+ -+ ++ u8 *cnxt; +}; + +struct intf_hdl { -+ -+/* -+ u32 intf_option; -+ u32 bus_status; -+ u32 do_flush; -+ u8 *adapter; -+ u8 *intf_dev; -+ struct intf_priv *pintfpriv; -+ u8 cnt; -+ void (*intf_hdl_init)(u8 *priv); -+ void (*intf_hdl_unload)(u8 *priv); -+ void (*intf_hdl_open)(u8 *priv); -+ void (*intf_hdl_close)(u8 *priv); -+ struct _io_ops io_ops; -+ //u8 intf_status;//moved to struct intf_priv -+ u16 len; -+ u16 done_len; -+*/ + _adapter *padapter; + struct dvobj_priv *pintf_dev;// pointer to &(padapter->dvobjpriv); + @@ -328638,7 +145796,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a + +struct reg_protocol_rd { + -+#ifdef CONFIG_LITTLE_ENDIAN ++#ifdef __LITTLE_ENDIAN + + //DW1 + u32 NumOfTrans:4; @@ -328663,22 +145821,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a + +//DW1 + u32 Reserved1 :4; -+ u32 NumOfTrans :4; ++ u32 NumOfTrans :4; + -+ u32 Reserved2 :24; ++ u32 Reserved2 :24; + + //DW2 + u32 WriteEnable : 1; -+ u32 ByteCount :7; ++ u32 ByteCount :7; + + + u32 Reserved3 : 3; -+ u32 Byte4Access : 1; ++ u32 Byte4Access : 1; + + u32 Byte2Access : 1; -+ u32 Byte1Access : 1; -+ u32 BurstMode :1 ; -+ u32 FixOrContinuous : 1; ++ u32 Byte1Access : 1; ++ u32 BurstMode :1 ; ++ u32 FixOrContinuous : 1; + + u32 Reserved4 : 16; + @@ -328689,14 +145847,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a + //u32 Value; + +#endif -+ ++ +}; + + +struct reg_protocol_wt { -+ + -+#ifdef CONFIG_LITTLE_ENDIAN ++ ++#ifdef __LITTLE_ENDIAN + + //DW1 + u32 NumOfTrans:4; @@ -328720,21 +145878,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a +#else + //DW1 + u32 Reserved1 :4; -+ u32 NumOfTrans :4; ++ u32 NumOfTrans :4; + -+ u32 Reserved2 :24; ++ u32 Reserved2 :24; + + //DW2 + u32 WriteEnable : 1; -+ u32 ByteCount :7; -+ ++ u32 ByteCount :7; ++ + u32 Reserved3 : 3; -+ u32 Byte4Access : 1; ++ u32 Byte4Access : 1; + + u32 Byte2Access : 1; -+ u32 Byte1Access : 1; -+ u32 BurstMode :1 ; -+ u32 FixOrContinuous : 1; ++ u32 Byte1Access : 1; ++ u32 BurstMode :1 ; ++ u32 FixOrContinuous : 1; + + u32 Reserved4 : 16; + @@ -328747,37 +145905,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a +#endif + +}; -+#ifdef CONFIG_PCI_HCI -+#define MAX_CONTINUAL_IO_ERR 4 -+#endif -+ -+#ifdef CONFIG_USB_HCI -+#define MAX_CONTINUAL_IO_ERR 4 -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+#define SD_IO_TRY_CNT (8) -+#define MAX_CONTINUAL_IO_ERR SD_IO_TRY_CNT -+#endif -+ -+#ifdef CONFIG_GSPI_HCI -+#define SD_IO_TRY_CNT (8) -+#define MAX_CONTINUAL_IO_ERR SD_IO_TRY_CNT -+#endif -+ -+ -+int rtw_inc_and_chk_continual_io_error(struct dvobj_priv *dvobj); -+void rtw_reset_continual_io_error(struct dvobj_priv *dvobj); + +/* +Below is the data structure used by _io_handler + +*/ + -+struct io_queue { -+ _lock lock; -+ _list free_ioreqs; -+ _list pending; //The io_req list that will be served in the single protocol read/write. ++struct io_queue { ++ _lock lock; ++ _list free_ioreqs; ++ _list pending; //The io_req list that will be served in the single protocol read/write. + _list processing; + u8 *free_ioreqs_buf; // 4-byte aligned + u8 *pallocated_free_ioreqs_buf; @@ -328785,9 +145922,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a +}; + +struct io_priv{ -+ -+ _adapter *padapter; -+ ++ ++ _adapter *padapter; ++ + struct intf_hdl intf; + +}; @@ -328819,18 +145956,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a +extern int _rtw_write32(_adapter *adapter, u32 addr, u32 val); +extern int _rtw_writeN(_adapter *adapter, u32 addr, u32 length, u8 *pdata); + -+#ifdef CONFIG_SDIO_HCI -+u8 _rtw_sd_f0_read8(_adapter *adapter, u32 addr); -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+u8 _rtw_sd_iread8(_adapter *adapter, u32 addr); -+u16 _rtw_sd_iread16(_adapter *adapter, u32 addr); -+u32 _rtw_sd_iread32(_adapter *adapter, u32 addr); -+int _rtw_sd_iwrite8(_adapter *adapter, u32 addr, u8 val); -+int _rtw_sd_iwrite16(_adapter *adapter, u32 addr, u16 val); -+int _rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val); -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+#endif /* CONFIG_SDIO_HCI */ -+ +extern int _rtw_write8_async(_adapter *adapter, u32 addr, u8 val); +extern int _rtw_write16_async(_adapter *adapter, u32 addr, u16 val); +extern int _rtw_write32_async(_adapter *adapter, u32 addr, u32 val); @@ -328841,10 +145966,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a +extern void _rtw_write_port_cancel(_adapter *adapter); + +#ifdef DBG_IO -+bool match_read_sniff_ranges(u32 addr, u16 len); -+bool match_write_sniff_ranges(u32 addr, u16 len); -+bool match_rf_read_sniff_ranges(u8 path, u32 addr, u32 mask); -+bool match_rf_write_sniff_ranges(u8 path, u32 addr, u32 mask); ++bool match_read_sniff_ranges(u16 addr, u16 len); ++bool match_write_sniff_ranges(u16 addr, u16 len); + +extern u8 dbg_rtw_read8(_adapter *adapter, u32 addr, const char *caller, const int line); +extern u16 dbg_rtw_read16(_adapter *adapter, u32 addr, const char *caller, const int line); @@ -328855,18 +145978,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a +extern int dbg_rtw_write32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line); +extern int dbg_rtw_writeN(_adapter *adapter, u32 addr ,u32 length , u8 *data, const char *caller, const int line); + -+#ifdef CONFIG_SDIO_HCI -+u8 dbg_rtw_sd_f0_read8(_adapter *adapter, u32 addr, const char *caller, const int line); -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+u8 dbg_rtw_sd_iread8(_adapter *adapter, u32 addr, const char *caller, const int line); -+u16 dbg_rtw_sd_iread16(_adapter *adapter, u32 addr, const char *caller, const int line); -+u32 dbg_rtw_sd_iread32(_adapter *adapter, u32 addr, const char *caller, const int line); -+int dbg_rtw_sd_iwrite8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line); -+int dbg_rtw_sd_iwrite16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line); -+int dbg_rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line); -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+#endif /* CONFIG_SDIO_HCI */ -+ +#define rtw_read8(adapter, addr) dbg_rtw_read8((adapter), (addr), __FUNCTION__, __LINE__) +#define rtw_read16(adapter, addr) dbg_rtw_read16((adapter), (addr), __FUNCTION__, __LINE__) +#define rtw_read32(adapter, addr) dbg_rtw_read32((adapter), (addr), __FUNCTION__, __LINE__) @@ -328887,24 +145998,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a +#define rtw_write_port(adapter, addr, cnt, mem) _rtw_write_port(adapter, addr, cnt, mem) +#define rtw_write_port_and_wait(adapter, addr, cnt, mem, timeout_ms) _rtw_write_port_and_wait((adapter), (addr), (cnt), (mem), (timeout_ms)) +#define rtw_write_port_cancel(adapter) _rtw_write_port_cancel(adapter) -+ -+#ifdef CONFIG_SDIO_HCI -+#define rtw_sd_f0_read8(adapter, addr) dbg_rtw_sd_f0_read8((adapter), (addr), __func__, __LINE__) -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+#define rtw_sd_iread8(adapter, addr) dbg_rtw_sd_iread8((adapter), (addr), __func__, __LINE__) -+#define rtw_sd_iread16(adapter, addr) dbg_rtw_sd_iread16((adapter), (addr), __func__, __LINE__) -+#define rtw_sd_iread32(adapter, addr) dbg_rtw_sd_iread32((adapter), (addr), __func__, __LINE__) -+#define rtw_sd_iwrite8(adapter, addr, val) dbg_rtw_sd_iwrite8((adapter), (addr), (val), __func__, __LINE__) -+#define rtw_sd_iwrite16(adapter, addr, val) dbg_rtw_sd_iwrite16((adapter), (addr), (val), __func__, __LINE__) -+#define rtw_sd_iwrite32(adapter, addr, val) dbg_rtw_sd_iwrite32((adapter), (addr), (val), __func__, __LINE__) -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+#else /* DBG_IO */ -+#define match_read_sniff_ranges(addr, len) _FALSE -+#define match_write_sniff_ranges(addr, len) _FALSE -+#define match_rf_read_sniff_ranges(path, addr, mask) _FALSE -+#define match_rf_write_sniff_ranges(path, addr, mask) _FALSE ++#else //DBG_IO +#define rtw_read8(adapter, addr) _rtw_read8((adapter), (addr)) +#define rtw_read16(adapter, addr) _rtw_read16((adapter), (addr)) +#define rtw_read32(adapter, addr) _rtw_read32((adapter), (addr)) @@ -328925,26 +146019,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a +#define rtw_write_port(adapter, addr, cnt, mem) _rtw_write_port((adapter), (addr), (cnt), (mem)) +#define rtw_write_port_and_wait(adapter, addr, cnt, mem, timeout_ms) _rtw_write_port_and_wait((adapter), (addr), (cnt), (mem), (timeout_ms)) +#define rtw_write_port_cancel(adapter) _rtw_write_port_cancel((adapter)) -+ -+#ifdef CONFIG_SDIO_HCI -+#define rtw_sd_f0_read8(adapter, addr) _rtw_sd_f0_read8((adapter), (addr)) -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+#define rtw_sd_iread8(adapter, addr) _rtw_sd_iread8((adapter), (addr)) -+#define rtw_sd_iread16(adapter, addr) _rtw_sd_iread16((adapter), (addr)) -+#define rtw_sd_iread32(adapter, addr) _rtw_sd_iread32((adapter), (addr)) -+#define rtw_sd_iwrite8(adapter, addr, val) _rtw_sd_iwrite8((adapter), (addr), (val)) -+#define rtw_sd_iwrite16(adapter, addr, val) _rtw_sd_iwrite16((adapter), (addr), (val)) -+#define rtw_sd_iwrite32(adapter, addr, val) _rtw_sd_iwrite32((adapter), (addr), (val)) -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+#endif /* DBG_IO */ ++#endif //DBG_IO + +extern void rtw_write_scsi(_adapter *adapter, u32 cnt, u8 *pmem); + -+//ioreq ++//ioreq +extern void ioreq_read8(_adapter *adapter, u32 addr, u8 *pval); -+extern void ioreq_read16(_adapter *adapter, u32 addr, u16 *pval); ++extern void ioreq_read16(_adapter *adapter, u32 addr, u16 *pval); +extern void ioreq_read32(_adapter *adapter, u32 addr, u32 *pval); +extern void ioreq_write8(_adapter *adapter, u32 addr, u8 val); +extern void ioreq_write16(_adapter *adapter, u32 addr, u16 val); @@ -328952,11 +146033,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a + + +extern uint async_read8(_adapter *adapter, u32 addr, u8 *pbuff, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); ++ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); +extern uint async_read16(_adapter *adapter, u32 addr, u8 *pbuff, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); ++ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); +extern uint async_read32(_adapter *adapter, u32 addr, u8 *pbuff, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); ++ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); + +extern void async_read_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); +extern void async_read_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); @@ -329015,202 +146096,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_io.h linux/3rdparty/rtl8812a + rtw_read32(_a,_b) + +#endif //_RTL8711_IO_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_iol.h linux/3rdparty/rtl8812au/include/rtw_iol.h ---- linux.old/3rdparty/rtl8812au/include/rtw_iol.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_iol.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,137 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_IOL_H_ -+#define __RTW_IOL_H_ -+ -+ -+struct xmit_frame *rtw_IOL_accquire_xmit_frame(ADAPTER *adapter); -+int rtw_IOL_append_cmds(struct xmit_frame *xmit_frame, u8 *IOL_cmds, u32 cmd_len); -+int rtw_IOL_append_LLT_cmd(struct xmit_frame *xmit_frame, u8 page_boundary); -+int rtw_IOL_exec_cmds_sync(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt); -+bool rtw_IOL_applied(ADAPTER *adapter); -+int rtw_IOL_append_DELAY_US_cmd(struct xmit_frame *xmit_frame, u16 us); -+int rtw_IOL_append_DELAY_MS_cmd(struct xmit_frame *xmit_frame, u16 ms); -+int rtw_IOL_append_END_cmd(struct xmit_frame *xmit_frame); -+ -+ -+#ifdef CONFIG_IOL_NEW_GENERATION -+#define IOREG_CMD_END_LEN 4 -+ -+struct ioreg_cfg{ -+ u8 length; -+ u8 cmd_id; -+ u16 address; -+ u32 data; -+ u32 mask; -+}; -+enum ioreg_cmd{ -+ IOREG_CMD_LLT = 0x01, -+ IOREG_CMD_REFUSE = 0x02, -+ IOREG_CMD_EFUSE_PATH = 0x03, -+ IOREG_CMD_WB_REG = 0x04, -+ IOREG_CMD_WW_REG = 0x05, -+ IOREG_CMD_WD_REG = 0x06, -+ IOREG_CMD_W_RF = 0x07, -+ IOREG_CMD_DELAY_US = 0x10, -+ IOREG_CMD_DELAY_MS = 0x11, -+ IOREG_CMD_END = 0xFF, -+}; -+void read_efuse_from_txpktbuf(ADAPTER *adapter, int bcnhead, u8 *content, u16 *size); -+ -+int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, u8 mask); -+int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, u16 mask); -+int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, u32 mask); -+int _rtw_IOL_append_WRF_cmd(struct xmit_frame *xmit_frame, u8 rf_path, u16 addr, u32 value, u32 mask); -+#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value,mask) _rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value) ,(mask)) -+#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value,mask) _rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value),(mask)) -+#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value,mask) _rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value),(mask)) -+#define rtw_IOL_append_WRF_cmd(xmit_frame, rf_path, addr, value,mask) _rtw_IOL_append_WRF_cmd((xmit_frame),(rf_path), (addr), (value),(mask)) -+ -+u8 rtw_IOL_cmd_boundary_handle(struct xmit_frame *pxmit_frame); -+void rtw_IOL_cmd_buf_dump(ADAPTER *Adapter,int buf_len,u8 *pbuf); -+ -+#ifdef CONFIG_IOL_IOREG_CFG_DBG -+ struct cmd_cmp{ -+ u16 addr; -+ u32 value; -+ }; -+#endif -+ -+#else //CONFIG_IOL_NEW_GENERATION -+ -+typedef struct _io_offload_cmd { -+ u8 rsvd0; -+ u8 cmd; -+ u16 address; -+ u32 value; -+} IO_OFFLOAD_CMD, IOL_CMD; -+ -+#define IOL_CMD_LLT 0x00 -+//#define IOL_CMD_R_EFUSE 0x01 -+#define IOL_CMD_WB_REG 0x02 -+#define IOL_CMD_WW_REG 0x03 -+#define IOL_CMD_WD_REG 0x04 -+//#define IOL_CMD_W_RF 0x05 -+#define IOL_CMD_DELAY_US 0x80 -+#define IOL_CMD_DELAY_MS 0x81 -+//#define IOL_CMD_DELAY_S 0x82 -+#define IOL_CMD_END 0x83 -+ -+/***************************************************** -+CMD Address Value -+(B1) (B2/B3:H/L addr) (B4:B7 : MSB:LSB) -+****************************************************** -+IOL_CMD_LLT - B7: PGBNDY -+//IOL_CMD_R_EFUSE - - -+IOL_CMD_WB_REG 0x0~0xFFFF B7 -+IOL_CMD_WW_REG 0x0~0xFFFF B6~B7 -+IOL_CMD_WD_REG 0x0~0xFFFF B4~B7 -+//IOL_CMD_W_RF RF Reg B5~B7 -+IOL_CMD_DELAY_US - B6~B7 -+IOL_CMD_DELAY_MS - B6~B7 -+//IOL_CMD_DELAY_S - B6~B7 -+IOL_CMD_END - - -+******************************************************/ -+int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value); -+int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value); -+int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value); -+ -+ -+int rtw_IOL_exec_cmd_array_sync(PADAPTER adapter, u8 *IOL_cmds, u32 cmd_num, u32 max_wating_ms); -+int rtw_IOL_exec_empty_cmds_sync(ADAPTER *adapter, u32 max_wating_ms); -+ -+#ifdef DBG_IO -+int dbg_rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, const char *caller, const int line); -+int dbg_rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, const char *caller, const int line); -+int dbg_rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, const char *caller, const int line); -+#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) -+#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) -+#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) -+#else -+#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value) _rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value)) -+#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value) _rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value)) -+#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value) _rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value)) -+#endif // DBG_IO -+#endif // CONFIG_IOL_NEW_GENERATION -+ -+ -+ -+#endif //__RTW_IOL_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mem.h linux/3rdparty/rtl8812au/include/rtw_mem.h ---- linux.old/3rdparty/rtl8812au/include/rtw_mem.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_mem.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,42 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_MEM_H__ -+#define __RTW_MEM_H__ -+ -+#include -+#include -+#include -+ -+#ifdef CONFIG_PLATFORM_MSTAR_HIGH -+#define MAX_RTKM_RECVBUF_SZ (31744) /* 31k */ -+#else -+#define MAX_RTKM_RECVBUF_SZ (15360) /* 15k */ -+#endif /* CONFIG_PLATFORM_MSTAR_HIGH */ -+#define MAX_RTKM_NR_PREALLOC_RECV_SKB 16 -+ -+u16 rtw_rtkm_get_buff_size(void); -+u8 rtw_rtkm_get_nr_recv_skb(void); -+struct u8* rtw_alloc_revcbuf_premem(void); -+struct sk_buff *rtw_alloc_skb_premem(u16 in_size); -+int rtw_free_skb_premem(struct sk_buff *pskb); -+ -+ -+#endif //__RTW_MEM_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rtl8812au/include/rtw_mlme_ext.h ---- linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_mlme_ext.h 2017-06-07 23:07:21.043690492 +0300 -@@ -0,0 +1,1235 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_iol.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_iol.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_iol.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_iol.h 2018-02-06 17:42:30.720967312 +0200 +@@ -0,0 +1,131 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -329220,10 +146113,140 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++#ifndef __RTW_IOL_H_ ++#define __RTW_IOL_H_ ++ ++ ++struct xmit_frame *rtw_IOL_accquire_xmit_frame(ADAPTER *adapter); ++int rtw_IOL_append_cmds(struct xmit_frame *xmit_frame, u8 *IOL_cmds, u32 cmd_len); ++int rtw_IOL_append_LLT_cmd(struct xmit_frame *xmit_frame, u8 page_boundary); ++int rtw_IOL_exec_cmds_sync(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt); ++bool rtw_IOL_applied(ADAPTER *adapter); ++int rtw_IOL_append_DELAY_US_cmd(struct xmit_frame *xmit_frame, u16 us); ++int rtw_IOL_append_DELAY_MS_cmd(struct xmit_frame *xmit_frame, u16 ms); ++int rtw_IOL_append_END_cmd(struct xmit_frame *xmit_frame); ++ ++ ++#ifdef CONFIG_IOL_NEW_GENERATION ++#define IOREG_CMD_END_LEN 4 ++ ++struct ioreg_cfg{ ++ u8 length; ++ u8 cmd_id; ++ u16 address; ++ u32 data; ++ u32 mask; ++}; ++enum ioreg_cmd{ ++ IOREG_CMD_LLT = 0x01, ++ IOREG_CMD_REFUSE = 0x02, ++ IOREG_CMD_EFUSE_PATH = 0x03, ++ IOREG_CMD_WB_REG = 0x04, ++ IOREG_CMD_WW_REG = 0x05, ++ IOREG_CMD_WD_REG = 0x06, ++ IOREG_CMD_W_RF = 0x07, ++ IOREG_CMD_DELAY_US = 0x10, ++ IOREG_CMD_DELAY_MS = 0x11, ++ IOREG_CMD_END = 0xFF, ++}; ++void read_efuse_from_txpktbuf(ADAPTER *adapter, int bcnhead, u8 *content, u16 *size); ++ ++int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, u8 mask); ++int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, u16 mask); ++int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, u32 mask); ++int _rtw_IOL_append_WRF_cmd(struct xmit_frame *xmit_frame, u8 rf_path, u16 addr, u32 value, u32 mask); ++#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value,mask) _rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value) ,(mask)) ++#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value,mask) _rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value),(mask)) ++#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value,mask) _rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value),(mask)) ++#define rtw_IOL_append_WRF_cmd(xmit_frame, rf_path, addr, value,mask) _rtw_IOL_append_WRF_cmd((xmit_frame),(rf_path), (addr), (value),(mask)) ++ ++u8 rtw_IOL_cmd_boundary_handle(struct xmit_frame *pxmit_frame); ++void rtw_IOL_cmd_buf_dump(ADAPTER *Adapter,int buf_len,u8 *pbuf); ++ ++#ifdef CONFIG_IOL_IOREG_CFG_DBG ++ struct cmd_cmp{ ++ u16 addr; ++ u32 value; ++ }; ++#endif ++ ++#else //CONFIG_IOL_NEW_GENERATION ++ ++typedef struct _io_offload_cmd { ++ u8 rsvd0; ++ u8 cmd; ++ u16 address; ++ u32 value; ++} IO_OFFLOAD_CMD, IOL_CMD; ++ ++#define IOL_CMD_LLT 0x00 ++//#define IOL_CMD_R_EFUSE 0x01 ++#define IOL_CMD_WB_REG 0x02 ++#define IOL_CMD_WW_REG 0x03 ++#define IOL_CMD_WD_REG 0x04 ++//#define IOL_CMD_W_RF 0x05 ++#define IOL_CMD_DELAY_US 0x80 ++#define IOL_CMD_DELAY_MS 0x81 ++//#define IOL_CMD_DELAY_S 0x82 ++#define IOL_CMD_END 0x83 ++ ++/***************************************************** ++CMD Address Value ++(B1) (B2/B3:H/L addr) (B4:B7 : MSB:LSB) ++****************************************************** ++IOL_CMD_LLT - B7: PGBNDY ++//IOL_CMD_R_EFUSE - - ++IOL_CMD_WB_REG 0x0~0xFFFF B7 ++IOL_CMD_WW_REG 0x0~0xFFFF B6~B7 ++IOL_CMD_WD_REG 0x0~0xFFFF B4~B7 ++//IOL_CMD_W_RF RF Reg B5~B7 ++IOL_CMD_DELAY_US - B6~B7 ++IOL_CMD_DELAY_MS - B6~B7 ++//IOL_CMD_DELAY_S - B6~B7 ++IOL_CMD_END - - ++******************************************************/ ++int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value); ++int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value); ++int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value); ++ ++ ++int rtw_IOL_exec_cmd_array_sync(PADAPTER adapter, u8 *IOL_cmds, u32 cmd_num, u32 max_wating_ms); ++int rtw_IOL_exec_empty_cmds_sync(ADAPTER *adapter, u32 max_wating_ms); ++ ++#ifdef DBG_IO ++int dbg_rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, const char *caller, const int line); ++int dbg_rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, const char *caller, const int line); ++int dbg_rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, const char *caller, const int line); ++#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) ++#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) ++#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) ++#else ++#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value) _rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value)) ++#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value) _rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value)) ++#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value) _rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value)) ++#endif // DBG_IO ++#endif // CONFIG_IOL_NEW_GENERATION ++ ++ ++ ++#endif //__RTW_IOL_H_ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mlme_ext.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_mlme_ext.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mlme_ext.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,966 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#ifndef __RTW_MLME_EXT_H_ @@ -329248,26 +146271,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt +#define REASSOC_LIMIT (4) +#define READDBA_LIMIT (2) + -+#ifdef CONFIG_GSPI_HCI -+ #define ROAMING_LIMIT 5 -+#else -+ #define ROAMING_LIMIT 8 -+#endif -+//#define IOCMD_REG0 0x10250370 -+//#define IOCMD_REG1 0x10250374 -+//#define IOCMD_REG2 0x10250378 ++#define ROAMING_LIMIT 8 ++#define DYNAMIC_FUNC_DISABLE (0x0) + -+//#define FW_DYNAMIC_FUN_SWITCH 0x10250364 ++// ====== ODM_ABILITY_E ======== ++// BB ODM section BIT 0-15 ++#define DYNAMIC_BB_DIG BIT(0) ++#define DYNAMIC_BB_RA_MASK BIT(1) ++#define DYNAMIC_BB_DYNAMIC_TXPWR BIT(2) ++#define DYNAMIC_BB_BB_FA_CNT BIT(3) + -+//#define WRITE_BB_CMD 0xF0000001 -+//#define SET_CHANNEL_CMD 0xF3000000 -+//#define UPDATE_RA_CMD 0xFD0000A2 ++#define DYNAMIC_BB_RSSI_MONITOR BIT(4) ++#define DYNAMIC_BB_CCK_PD BIT(5) ++#define DYNAMIC_BB_ANT_DIV BIT(6) ++#define DYNAMIC_BB_PWR_SAVE BIT(7) ++#define DYNAMIC_BB_PWR_TRAIN BIT(8) ++#define DYNAMIC_BB_RATE_ADAPTIVE BIT(9) ++#define DYNAMIC_BB_PATH_DIV BIT(10) ++#define DYNAMIC_BB_PSD BIT(11) ++ ++// MAC DM section BIT 16-23 ++#define DYNAMIC_MAC_EDCA_TURBO BIT(16) ++#define DYNAMIC_MAC_EARLY_MODE BIT(17) ++ ++// RF ODM section BIT 24-31 ++#define DYNAMIC_RF_TX_PWR_TRACK BIT(24) ++#define DYNAMIC_RF_RX_GAIN_TRACK BIT(25) ++#define DYNAMIC_RF_CALIBRATION BIT(26) ++ ++#define DYNAMIC_ALL_FUNC_ENABLE 0xFFFFFFF + +#define _HW_STATE_NOLINK_ 0x00 +#define _HW_STATE_ADHOC_ 0x01 -+#define _HW_STATE_STATION_ 0x02 ++#define _HW_STATE_STATION_ 0x02 +#define _HW_STATE_AP_ 0x03 -+#define _HW_STATE_MONITOR_ 0x04 + + +#define _1M_RATE_ 0 @@ -329283,15 +146320,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt +#define _48M_RATE_ 10 +#define _54M_RATE_ 11 + -+/******************************************************** -+MCS rate definitions -+*********************************************************/ -+#define MCS_RATE_1R (0x000000ff) -+#define MCS_RATE_2R (0x0000ffff) -+#define MCS_RATE_3R (0x00ffffff) -+#define MCS_RATE_4R (0xffffffff) -+#define MCS_RATE_2R_13TO15_OFF (0x00001fff) -+ + +extern unsigned char RTW_WPA_OUI[]; +extern unsigned char WMM_OUI[]; @@ -329302,139 +146330,108 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt +extern unsigned char WMM_INFO_OUI[]; +extern unsigned char WMM_PARA_OUI[]; + ++ ++// ++// Channel Plan Type. ++// Note: ++// We just add new channel plan when the new channel plan is different from any of the following ++// channel plan. ++// If you just wnat to customize the acitions(scan period or join actions) about one of the channel plan, ++// customize them in RT_CHANNEL_INFO in the RT_CHANNEL_LIST. ++// +typedef enum _RT_CHANNEL_DOMAIN +{ -+ /* ===== 0x00 ~ 0x1F, legacy channel plan ===== */ -+ RTW_CHPLAN_FCC = 0x00, -+ RTW_CHPLAN_IC = 0x01, -+ RTW_CHPLAN_ETSI = 0x02, -+ RTW_CHPLAN_SPAIN = 0x03, -+ RTW_CHPLAN_FRANCE = 0x04, -+ RTW_CHPLAN_MKK = 0x05, -+ RTW_CHPLAN_MKK1 = 0x06, -+ RTW_CHPLAN_ISRAEL = 0x07, -+ RTW_CHPLAN_TELEC = 0x08, -+ RTW_CHPLAN_GLOBAL_DOAMIN = 0x09, -+ RTW_CHPLAN_WORLD_WIDE_13 = 0x0A, -+ RTW_CHPLAN_TAIWAN = 0x0B, -+ RTW_CHPLAN_CHINA = 0x0C, -+ RTW_CHPLAN_SINGAPORE_INDIA_MEXICO = 0x0D, -+ RTW_CHPLAN_KOREA = 0x0E, -+ RTW_CHPLAN_TURKEY = 0x0F, -+ RTW_CHPLAN_JAPAN = 0x10, -+ RTW_CHPLAN_FCC_NO_DFS = 0x11, -+ RTW_CHPLAN_JAPAN_NO_DFS = 0x12, -+ RTW_CHPLAN_WORLD_WIDE_5G = 0x13, -+ RTW_CHPLAN_TAIWAN_NO_DFS = 0x14, ++ //===== old channel plan mapping =====// ++ RT_CHANNEL_DOMAIN_FCC = 0x00, ++ RT_CHANNEL_DOMAIN_IC = 0x01, ++ RT_CHANNEL_DOMAIN_ETSI = 0x02, ++ RT_CHANNEL_DOMAIN_SPAIN = 0x03, ++ RT_CHANNEL_DOMAIN_FRANCE = 0x04, ++ RT_CHANNEL_DOMAIN_MKK = 0x05, ++ RT_CHANNEL_DOMAIN_MKK1 = 0x06, ++ RT_CHANNEL_DOMAIN_ISRAEL = 0x07, ++ RT_CHANNEL_DOMAIN_TELEC = 0x08, ++ RT_CHANNEL_DOMAIN_GLOBAL_DOAMIN = 0x09, ++ RT_CHANNEL_DOMAIN_WORLD_WIDE_13 = 0x0A, ++ RT_CHANNEL_DOMAIN_TAIWAN = 0x0B, ++ RT_CHANNEL_DOMAIN_CHINA = 0x0C, ++ RT_CHANNEL_DOMAIN_SINGAPORE_INDIA_MEXICO = 0x0D, ++ RT_CHANNEL_DOMAIN_KOREA = 0x0E, ++ RT_CHANNEL_DOMAIN_TURKEY = 0x0F, ++ RT_CHANNEL_DOMAIN_JAPAN = 0x10, ++ RT_CHANNEL_DOMAIN_FCC_NO_DFS = 0x11, ++ RT_CHANNEL_DOMAIN_JAPAN_NO_DFS = 0x12, ++ RT_CHANNEL_DOMAIN_WORLD_WIDE_5G = 0x13, ++ RT_CHANNEL_DOMAIN_TAIWAN_NO_DFS = 0x14, + -+ /* ===== 0x20 ~ 0x7F, new channel plan ===== */ -+ RTW_CHPLAN_WORLD_NULL = 0x20, -+ RTW_CHPLAN_ETSI1_NULL = 0x21, -+ RTW_CHPLAN_FCC1_NULL = 0x22, -+ RTW_CHPLAN_MKK1_NULL = 0x23, -+ RTW_CHPLAN_ETSI2_NULL = 0x24, -+ RTW_CHPLAN_FCC1_FCC1 = 0x25, -+ RTW_CHPLAN_WORLD_ETSI1 = 0x26, -+ RTW_CHPLAN_MKK1_MKK1 = 0x27, -+ RTW_CHPLAN_WORLD_KCC1 = 0x28, -+ RTW_CHPLAN_WORLD_FCC2 = 0x29, -+ RTW_CHPLAN_WORLD_FCC3 = 0x30, -+ RTW_CHPLAN_WORLD_FCC4 = 0x31, -+ RTW_CHPLAN_WORLD_FCC5 = 0x32, -+ RTW_CHPLAN_WORLD_FCC6 = 0x33, -+ RTW_CHPLAN_FCC1_FCC7 = 0x34, -+ RTW_CHPLAN_WORLD_ETSI2 = 0x35, -+ RTW_CHPLAN_WORLD_ETSI3 = 0x36, -+ RTW_CHPLAN_MKK1_MKK2 = 0x37, -+ RTW_CHPLAN_MKK1_MKK3 = 0x38, -+ RTW_CHPLAN_FCC1_NCC1 = 0x39, -+ RTW_CHPLAN_FCC1_NCC2 = 0x40, -+ RTW_CHPLAN_GLOBAL_NULL = 0x41, -+ RTW_CHPLAN_ETSI1_ETSI4 = 0x42, -+ RTW_CHPLAN_FCC1_FCC2 = 0x43, -+ RTW_CHPLAN_FCC1_NCC3 = 0x44, -+ RTW_CHPLAN_WORLD_ETSI5 = 0x45, -+ RTW_CHPLAN_FCC1_FCC8 = 0x46, -+ RTW_CHPLAN_WORLD_ETSI6 = 0x47, -+ RTW_CHPLAN_WORLD_ETSI7 = 0x48, -+ RTW_CHPLAN_WORLD_ETSI8 = 0x49, -+ RTW_CHPLAN_WORLD_ETSI9 = 0x50, -+ RTW_CHPLAN_WORLD_ETSI10 = 0x51, -+ RTW_CHPLAN_WORLD_ETSI11 = 0x52, -+ RTW_CHPLAN_FCC1_NCC4 = 0x53, -+ RTW_CHPLAN_WORLD_ETSI12 = 0x54, -+ RTW_CHPLAN_FCC1_FCC9 = 0x55, -+ RTW_CHPLAN_WORLD_ETSI13 = 0x56, -+ RTW_CHPLAN_FCC1_FCC10 = 0x57, -+ RTW_CHPLAN_MKK2_MKK4 = 0x58, -+ RTW_CHPLAN_WORLD_ETSI14 = 0x59, -+ -+ RTW_CHPLAN_MAX, -+ RTW_CHPLAN_REALTEK_DEFINE = 0x7F, ++ //===== new channel plan mapping, (2GDOMAIN_5GDOMAIN) =====// ++ RT_CHANNEL_DOMAIN_WORLD_NULL = 0x20, ++ RT_CHANNEL_DOMAIN_ETSI1_NULL = 0x21, ++ RT_CHANNEL_DOMAIN_FCC1_NULL = 0x22, ++ RT_CHANNEL_DOMAIN_MKK1_NULL = 0x23, ++ RT_CHANNEL_DOMAIN_ETSI2_NULL = 0x24, ++ RT_CHANNEL_DOMAIN_FCC1_FCC1 = 0x25, ++ RT_CHANNEL_DOMAIN_WORLD_ETSI1 = 0x26, ++ RT_CHANNEL_DOMAIN_MKK1_MKK1 = 0x27, ++ RT_CHANNEL_DOMAIN_WORLD_KCC1 = 0x28, ++ RT_CHANNEL_DOMAIN_WORLD_FCC2 = 0x29, ++ RT_CHANNEL_DOMAIN_WORLD_FCC3 = 0x30, ++ RT_CHANNEL_DOMAIN_WORLD_FCC4 = 0x31, ++ RT_CHANNEL_DOMAIN_WORLD_FCC5 = 0x32, ++ RT_CHANNEL_DOMAIN_WORLD_FCC6 = 0x33, ++ RT_CHANNEL_DOMAIN_FCC1_FCC7 = 0x34, ++ RT_CHANNEL_DOMAIN_WORLD_ETSI2 = 0x35, ++ RT_CHANNEL_DOMAIN_WORLD_ETSI3 = 0x36, ++ RT_CHANNEL_DOMAIN_MKK1_MKK2 = 0x37, ++ RT_CHANNEL_DOMAIN_MKK1_MKK3 = 0x38, ++ RT_CHANNEL_DOMAIN_FCC1_NCC1 = 0x39, ++ RT_CHANNEL_DOMAIN_FCC1_NCC2 = 0x40, ++ RT_CHANNEL_DOMAIN_GLOBAL_DOAMIN_2G = 0x41, ++ //===== Add new channel plan above this line===============// ++ RT_CHANNEL_DOMAIN_MAX, ++ RT_CHANNEL_DOMAIN_REALTEK_DEFINE = 0x7F, +}RT_CHANNEL_DOMAIN, *PRT_CHANNEL_DOMAIN; + +typedef enum _RT_CHANNEL_DOMAIN_2G +{ -+ RTW_RD_2G_NULL = 0, -+ RTW_RD_2G_WORLD = 1, /* Worldwird 13 */ -+ RTW_RD_2G_ETSI1 = 2, /* Europe */ -+ RTW_RD_2G_FCC1 = 3, /* US */ -+ RTW_RD_2G_MKK1 = 4, /* Japan */ -+ RTW_RD_2G_ETSI2 = 5, /* France */ -+ RTW_RD_2G_GLOBAL = 6, /* Global domain */ -+ RTW_RD_2G_MKK2 = 7, /* Japan */ -+ -+ RTW_RD_2G_MAX, ++ RT_CHANNEL_DOMAIN_2G_WORLD = 0x00, //Worldwird 13 ++ RT_CHANNEL_DOMAIN_2G_ETSI1 = 0x01, //Europe ++ RT_CHANNEL_DOMAIN_2G_FCC1 = 0x02, //US ++ RT_CHANNEL_DOMAIN_2G_MKK1 = 0x03, //Japan ++ RT_CHANNEL_DOMAIN_2G_ETSI2 = 0x04, //France ++ RT_CHANNEL_DOMAIN_2G_NULL = 0x05, ++ //===== Add new channel plan above this line===============// ++ RT_CHANNEL_DOMAIN_2G_MAX, +}RT_CHANNEL_DOMAIN_2G, *PRT_CHANNEL_DOMAIN_2G; + +typedef enum _RT_CHANNEL_DOMAIN_5G +{ -+ RTW_RD_5G_NULL = 0, /* */ -+ RTW_RD_5G_ETSI1 = 1, /* Europe */ -+ RTW_RD_5G_ETSI2 = 2, /* Australia, New Zealand */ -+ RTW_RD_5G_ETSI3 = 3, /* Russia */ -+ RTW_RD_5G_FCC1 = 4, /* US */ -+ RTW_RD_5G_FCC2 = 5, /* FCC w/o DFS Channels */ -+ RTW_RD_5G_FCC3 = 6, /* Bolivia, Chile, El Salvador, Venezuela */ -+ RTW_RD_5G_FCC4 = 7, /* Venezuela */ -+ RTW_RD_5G_FCC5 = 8, /* China */ -+ RTW_RD_5G_FCC6 = 9, /* */ -+ RTW_RD_5G_FCC7 = 10, /* US Canada(w/o Weather radar) */ -+ RTW_RD_5G_KCC1 = 11, /* Korea */ -+ RTW_RD_5G_MKK1 = 12, /* Japan */ -+ RTW_RD_5G_MKK2 = 13, /* Japan (W52, W53) */ -+ RTW_RD_5G_MKK3 = 14, /* Japan (W56) */ -+ RTW_RD_5G_NCC1 = 15, /* Taiwan, (w/o Weather radar) */ -+ RTW_RD_5G_NCC2 = 16, /* Taiwan, Band2, Band4 */ -+ RTW_RD_5G_NCC3 = 17, /* Taiwan w/o DFS, Band4 only */ -+ RTW_RD_5G_ETSI4 = 18, /* Europe w/o DFS, Band1 only */ -+ RTW_RD_5G_ETSI5 = 19, /* Australia, New Zealand(w/o Weather radar) */ -+ RTW_RD_5G_FCC8 = 20, /* Latin America */ -+ RTW_RD_5G_ETSI6 = 21, /* Israel, Bahrain, Egypt, India, China, Malaysia */ -+ RTW_RD_5G_ETSI7 = 22, /* China */ -+ RTW_RD_5G_ETSI8 = 23, /* Jordan */ -+ RTW_RD_5G_ETSI9 = 24, /* Lebanon */ -+ RTW_RD_5G_ETSI10 = 25, /* Qatar */ -+ RTW_RD_5G_ETSI11 = 26, /* Russia */ -+ RTW_RD_5G_NCC4 = 27, /* Taiwan, (w/o Weather radar) */ -+ RTW_RD_5G_ETSI12 = 28, /* Indonesia */ -+ RTW_RD_5G_FCC9 = 29, /* (w/o Weather radar) */ -+ RTW_RD_5G_ETSI13 = 30, /* (w/o Weather radar) */ -+ RTW_RD_5G_FCC10 = 31, /* Argentina(w/o Weather radar) */ -+ RTW_RD_5G_MKK4 = 32, /* Japan (W52) */ -+ RTW_RD_5G_ETSI14 = 33, /* Russia */ -+ -+ /* === Below are driver defined for legacy channel plan compatible, DON'T assign index ==== */ -+ RTW_RD_5G_OLD_FCC1, -+ RTW_RD_5G_OLD_NCC1, -+ RTW_RD_5G_OLD_KCC1, -+ -+ RTW_RD_5G_MAX, ++ RT_CHANNEL_DOMAIN_5G_NULL = 0x00, ++ RT_CHANNEL_DOMAIN_5G_ETSI1 = 0x01, //Europe ++ RT_CHANNEL_DOMAIN_5G_ETSI2 = 0x02, //Australia, New Zealand ++ RT_CHANNEL_DOMAIN_5G_ETSI3 = 0x03, //Russia ++ RT_CHANNEL_DOMAIN_5G_FCC1 = 0x04, //US ++ RT_CHANNEL_DOMAIN_5G_FCC2 = 0x05, //FCC o/w DFS Channels ++ RT_CHANNEL_DOMAIN_5G_FCC3 = 0x06, //India, Mexico ++ RT_CHANNEL_DOMAIN_5G_FCC4 = 0x07, //Venezuela ++ RT_CHANNEL_DOMAIN_5G_FCC5 = 0x08, //China ++ RT_CHANNEL_DOMAIN_5G_FCC6 = 0x09, //Israel ++ RT_CHANNEL_DOMAIN_5G_FCC7_IC1 = 0x0A, //US, Canada ++ RT_CHANNEL_DOMAIN_5G_KCC1 = 0x0B, //Korea ++ RT_CHANNEL_DOMAIN_5G_MKK1 = 0x0C, //Japan ++ RT_CHANNEL_DOMAIN_5G_MKK2 = 0x0D, //Japan (W52, W53) ++ RT_CHANNEL_DOMAIN_5G_MKK3 = 0x0E, //Japan (W56) ++ RT_CHANNEL_DOMAIN_5G_NCC1 = 0x0F, //Taiwan ++ RT_CHANNEL_DOMAIN_5G_NCC2 = 0x10, //Taiwan o/w DFS ++ //===== Add new channel plan above this line===============// ++ //===== Driver Self Defined =====// ++ RT_CHANNEL_DOMAIN_5G_FCC = 0x11, ++ RT_CHANNEL_DOMAIN_5G_JAPAN_NO_DFS = 0x12, ++ RT_CHANNEL_DOMAIN_5G_FCC4_NO_DFS = 0x13, ++ RT_CHANNEL_DOMAIN_5G_MAX, +}RT_CHANNEL_DOMAIN_5G, *PRT_CHANNEL_DOMAIN_5G; + -+#define rtw_is_channel_plan_valid(chplan) ((chplan) < RTW_CHPLAN_MAX || (chplan) == RTW_CHPLAN_REALTEK_DEFINE) -+#define rtw_is_legacy_channel_plan(chplan) ((chplan) < 0x20) -+bool rtw_chplan_is_empty(u8 id); ++#define rtw_is_channel_plan_valid(chplan) (chplannon_ocp_end_time > rtw_get_current_time()) -+void rtw_rfctl_reset_cac(struct rf_ctl_t *rfctl); -+bool rtw_is_cac_reset_needed(_adapter *adapter); -+bool _rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset); -+bool rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl); -+bool rtw_rfctl_is_tx_blocked_by_cac(struct rf_ctl_t *rfctl); -+bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); -+void rtw_chset_update_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); -+void rtw_chset_update_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset, int ms); -+#else -+#define CH_IS_NON_OCP(rt_ch_info) 0 -+#define rtw_chset_is_ch_non_ocp(ch_set, ch, bw, offset) _FALSE -+#define rtw_rfctl_is_tx_blocked_by_cac(rfctl) _FALSE -+#endif -+ -+enum { -+ RTW_CHF_2G = BIT0, -+ RTW_CHF_5G = BIT1, -+ RTW_CHF_DFS = BIT2, -+ RTW_CHF_LONG_CAC = BIT3, -+ RTW_CHF_NON_DFS = BIT4, -+ RTW_CHF_NON_LONG_CAC = BIT5, -+}; -+bool rtw_choose_available_chbw(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 *dec_bw, u8 *dec_offset, u8 d_flags); -+void dump_chplan_id_list(void *sel); -+void dump_chplan_test(void *sel); -+void dump_chset(void *sel, RT_CHANNEL_INFO *ch_set); -+void dump_cur_chset(void *sel, _adapter *adapter); -+ +int rtw_ch_set_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch); -+bool rtw_mlme_band_check(_adapter *adapter, const u32 ch); + +// P2P_MAX_REG_CLASSES - Maximum number of regulatory classes +#define P2P_MAX_REG_CLASSES 10 @@ -329781,125 +146719,55 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt + u8 mlmeext_init; + ATOMIC_T event_seq; + u16 mgnt_seq; -+#ifdef CONFIG_IEEE80211W -+ u16 sa_query_seq; -+ u64 mgnt_80211w_IPN; -+ u64 mgnt_80211w_IPN_rx; -+#endif //CONFIG_IEEE80211W -+ //struct fw_priv fwpriv; -+ ++ ++ //struct fw_priv fwpriv; ++ + unsigned char cur_channel; + unsigned char cur_bwmode; + unsigned char cur_ch_offset;//PRIME_CHNL_OFFSET + unsigned char cur_wireless_mode; // NETWORK_TYPE -+ ++ + unsigned char max_chan_nums; + RT_CHANNEL_INFO channel_set[MAX_CHANNEL_NUM]; + struct p2p_channels channel_list; + unsigned char basicrate[NumRates]; + unsigned char datarate[NumRates]; -+#ifdef CONFIG_80211N_HT -+ unsigned char default_supported_mcs_set[16]; -+#endif -+ -+ struct ss_res sitesurvey_res; ++ ++ struct ss_res sitesurvey_res; + struct mlme_ext_info mlmext_info;//for sta/adhoc mode, including current scanning/connecting/connected related info. + //for ap mode, network includes ap's cap_info + _timer survey_timer; + _timer link_timer; -+ + //_timer ADDBA_timer; -+ u32 last_scan_time; ++ u16 chan_scan_time; ++ + u8 scan_abort; + u8 tx_rate; // TXRATE when USERATE is set. + + u32 retry; //retry for issue probereq -+ ++ + u64 TSFValue; + -+ //for LPS-32K to adaptive bcn early and timeout -+ u8 adaptive_tsf_done; -+ u32 bcn_delay_cnt[9]; -+ u32 bcn_delay_ratio[9]; -+ u32 bcn_cnt; -+ u8 DrvBcnEarly; -+ u8 DrvBcnTimeOut; -+ -+#ifdef CONFIG_AP_MODE ++#ifdef CONFIG_AP_MODE + unsigned char bstart_bss; +#endif + +#ifdef CONFIG_80211D + u8 update_channel_plan_by_ap_done; +#endif -+ //recv_decache check for Action_public frame ++ //recv_decache check for Action_public frame + u8 action_public_dialog_token; -+ u16 action_public_rxseq; ++ u16 action_public_rxseq; + -+//#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK ++#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK + u8 active_keep_alive_check; -+//#endif ++#endif +#ifdef DBG_FIXED_CHAN + u8 fixed_chan; +#endif -+ ++ +}; + -+#define mlmeext_msr(mlmeext) ((mlmeext)->mlmext_info.state & 0x03) -+#define mlmeext_scan_state(mlmeext) ((mlmeext)->sitesurvey_res.state) -+#define mlmeext_scan_state_str(mlmeext) scan_state_str((mlmeext)->sitesurvey_res.state) -+#define mlmeext_chk_scan_state(mlmeext, _state) ((mlmeext)->sitesurvey_res.state == (_state)) -+#define mlmeext_set_scan_state(mlmeext, _state) \ -+ do { \ -+ ((mlmeext)->sitesurvey_res.state = (_state)); \ -+ ((mlmeext)->sitesurvey_res.next_state = (_state)); \ -+ /* DBG_871X("set_scan_state:%s\n", scan_state_str(_state)); */ \ -+ } while (0) -+ -+#define mlmeext_scan_next_state(mlmeext) ((mlmeext)->sitesurvey_res.next_state) -+#define mlmeext_set_scan_next_state(mlmeext, _state) \ -+ do { \ -+ ((mlmeext)->sitesurvey_res.next_state = (_state)); \ -+ /* DBG_871X("set_scan_next_state:%s\n", scan_state_str(_state)); */ \ -+ } while (0) -+ -+#ifdef CONFIG_SCAN_BACKOP -+#define mlmeext_scan_backop_flags(mlmeext) ((mlmeext)->sitesurvey_res.backop_flags) -+#define mlmeext_chk_scan_backop_flags(mlmeext, flags) ((mlmeext)->sitesurvey_res.backop_flags & (flags)) -+#define mlmeext_assign_scan_backop_flags(mlmeext, flags) \ -+ do { \ -+ ((mlmeext)->sitesurvey_res.backop_flags = (flags)); \ -+ DBG_871X("assign_scan_backop_flags:0x%02x\n", (mlmeext)->sitesurvey_res.backop_flags); \ -+ } while (0) -+ -+#define mlmeext_scan_backop_flags_sta(mlmeext) ((mlmeext)->sitesurvey_res.backop_flags_sta) -+#define mlmeext_chk_scan_backop_flags_sta(mlmeext, flags) ((mlmeext)->sitesurvey_res.backop_flags_sta & (flags)) -+#define mlmeext_assign_scan_backop_flags_sta(mlmeext, flags) \ -+ do { \ -+ ((mlmeext)->sitesurvey_res.backop_flags_sta = (flags)); \ -+ } while (0) -+ -+#define mlmeext_scan_backop_flags_ap(mlmeext) ((mlmeext)->sitesurvey_res.backop_flags_ap) -+#define mlmeext_chk_scan_backop_flags_ap(mlmeext, flags) ((mlmeext)->sitesurvey_res.backop_flags_ap & (flags)) -+#define mlmeext_assign_scan_backop_flags_ap(mlmeext, flags) \ -+ do { \ -+ ((mlmeext)->sitesurvey_res.backop_flags_ap = (flags)); \ -+ } while (0) -+#else -+#define mlmeext_scan_backop_flags(mlmeext) (0) -+#define mlmeext_chk_scan_backop_flags(mlmeext, flags) (0) -+#define mlmeext_assign_scan_backop_flags(mlmeext, flags) do {} while (0) -+ -+#define mlmeext_scan_backop_flags_sta(mlmeext) (0) -+#define mlmeext_chk_scan_backop_flags_sta(mlmeext, flags) (0) -+#define mlmeext_assign_scan_backop_flags_sta(mlmeext, flags) do {} while (0) -+ -+#define mlmeext_scan_backop_flags_ap(mlmeext) (0) -+#define mlmeext_chk_scan_backop_flags_ap(mlmeext, flags) (0) -+#define mlmeext_assign_scan_backop_flags_ap(mlmeext, flags) do {} while (0) -+#endif -+ -+void init_mlme_default_rate_set(_adapter* padapter); +int init_mlme_ext_priv(_adapter* padapter); +int init_hw_mlme_ext(_adapter *padapter); +void free_mlme_ext_priv (struct mlme_ext_priv *pmlmeext); @@ -329910,15 +146778,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt + +//void fill_fwpriv(_adapter * padapter, struct fw_priv *pfwpriv); + -+unsigned char networktype_to_raid(_adapter *adapter,struct sta_info *psta); -+unsigned char networktype_to_raid_ex(_adapter *adapter, struct sta_info *psta); ++unsigned char networktype_to_raid(_adapter *adapter,unsigned char network_type); ++unsigned char networktype_to_raid_ex(_adapter *adapter,unsigned char network_type); + +u8 judge_network_type(_adapter *padapter, unsigned char *rate, int ratelen); +void get_rate_set(_adapter *padapter, unsigned char *pbssrate, int *bssrate_len); -+void set_mcs_rate_by_mask(u8 *mcs_set, u32 mask); +void UpdateBrateTbl(_adapter *padapter,u8 *mBratesOS); +void UpdateBrateTblForSoftAP(u8 *bssrateset, u32 bssratelen); -+void change_band_update_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 ch); ++void change_band_update_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork); ++ ++void Save_DM_Func_Flag(_adapter *padapter); ++void Restore_DM_Func_Flag(_adapter *padapter); ++void Switch_DM_Func(_adapter *padapter, u32 mode, u8 enable); + +//void Set_NETYPE1_MSR(_adapter *padapter, u8 type); +//void Set_NETYPE0_MSR(_adapter *padapter, u8 type); @@ -329931,10 +146802,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt +u8 rtw_get_oper_choffset(_adapter *adapter); +void rtw_set_oper_choffset(_adapter *adapter, u8 offset); +u8 rtw_get_center_ch(u8 channel, u8 chnl_bw, u8 chnl_offset); -+u32 rtw_get_on_oper_ch_time(_adapter *adapter); -+u32 rtw_get_on_cur_ch_time(_adapter *adapter); -+ -+u8 rtw_get_offset_by_ch(u8 channel); + +void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char channel_offset, unsigned short bwmode); +void SelectChannel(_adapter *padapter, unsigned char channel); @@ -329942,16 +146809,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt + +unsigned int decide_wait_for_beacon_timeout(unsigned int bcn_interval); + -+void _clear_cam_entry(_adapter *padapter, u8 entry); -+void write_cam_from_cache(_adapter *adapter, u8 id); -+ -+/* modify both HW and cache */ -+void write_cam(_adapter *padapter, u8 id, u16 ctrl, u8 *mac, u8 *key); -+void clear_cam_entry(_adapter *padapter, u8 id); -+ -+/* modify cache only */ -+void write_cam_cache(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key); -+void clear_cam_cache(_adapter *adapter, u8 id); ++void write_cam(_adapter *padapter, u8 entry, u16 ctrl, u8 *mac, u8 *key); ++void clear_cam_entry(_adapter *padapter, u8 entry); + +void invalidate_cam_all(_adapter *padapter); +void CAM_empty_entry(PADAPTER Adapter, u8 ucIndex); @@ -329960,9 +146819,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt +int allocate_fw_sta_entry(_adapter *padapter); +void flush_all_cam_entry(_adapter *padapter); + -+BOOLEAN IsLegal5GChannel(PADAPTER Adapter, u8 channel); ++bool IsLegal5GChannel(PADAPTER Adapter, u8 channel); + -+void site_survey(_adapter *padapter, u8 survey_channel, RT_SCAN_TYPE ScanType); ++void site_survey(_adapter *padapter); +u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSID_EX *bssid); +void update_network(WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src, _adapter * padapter, bool update_ie); + @@ -329988,20 +146847,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt + +void ERP_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); +void VCS_update(_adapter *padapter, struct sta_info *psta); -+void update_ldpc_stbc_cap(struct sta_info *psta); + -+int rtw_get_bcn_keys(ADAPTER *Adapter, u8 *pframe, u32 packet_len, -+ struct beacon_keys *recv_beacon); -+void rtw_dump_bcn_keys(struct beacon_keys *recv_beacon); -+int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len); +void update_beacon_info(_adapter *padapter, u8 *pframe, uint len, struct sta_info *psta); ++int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len); +#ifdef CONFIG_DFS +void process_csa_ie(_adapter *padapter, u8 *pframe, uint len); +#endif //CONFIG_DFS ++void update_IOT_info(_adapter *padapter); +void update_capinfo(PADAPTER Adapter, u16 updateCap); +void update_wireless_mode(_adapter * padapter); +void update_tx_basic_rate(_adapter *padapter, u8 modulation); -+void update_sta_basic_rate(struct sta_info *psta, u8 wireless_mode); ++void update_bmc_sta_support_rate(_adapter *padapter, u32 mac_id); +int update_sta_support_rate(_adapter *padapter, u8* pvar_ie, uint var_ie_len, int cam_idx); + +//for sta/adhoc mode @@ -330015,53 +146871,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt +unsigned int receive_disconnect(_adapter *padapter, unsigned char *MacAddr, unsigned short reason); + +unsigned char get_highest_rate_idx(u32 mask); -+int support_short_GI(_adapter *padapter, struct HT_caps_element *pHT_caps, u8 bwmode); ++int support_short_GI(_adapter *padapter, struct HT_caps_element *pHT_caps); +unsigned int is_ap_in_tkip(_adapter *padapter); +unsigned int is_ap_in_wep(_adapter *padapter); +unsigned int should_forbid_n_rate(_adapter * padapter); + -+s16 rtw_get_camid(_adapter *adapter, struct sta_info* sta, s16 kid); -+bool _rtw_camctl_chk_cap(_adapter *adapter, u8 cap); -+void _rtw_camctl_set_flags(_adapter *adapter, u32 flags); -+void rtw_camctl_set_flags(_adapter *adapter, u32 flags); -+void _rtw_camctl_clr_flags(_adapter *adapter, u32 flags); -+void rtw_camctl_clr_flags(_adapter *adapter, u32 flags); -+bool _rtw_camctl_chk_flags(_adapter *adapter, u32 flags); -+ -+struct sec_cam_bmp; -+void dump_sec_cam_map(void *sel, struct sec_cam_bmp *map, u8 max_num); -+void rtw_sec_cam_map_clr_all(struct sec_cam_bmp *map); -+ -+bool _rtw_camid_is_gk(_adapter *adapter, u8 cam_id); -+bool rtw_camid_is_gk(_adapter *adapter, u8 cam_id); -+s16 rtw_camid_search(_adapter *adapter, u8 *addr, s16 kid, s8 gk); -+s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, bool *used); -+void rtw_camid_free(_adapter *adapter, u8 cam_id); -+ -+struct macid_bmp; -+struct macid_ctl_t; -+void dump_macid_map(void *sel, struct macid_bmp *map, u8 max_num); -+bool rtw_macid_is_set(struct macid_bmp *map, u8 id); -+bool rtw_macid_is_used(struct macid_ctl_t *macid_ctl, u8 id); -+bool rtw_macid_is_bmc(struct macid_ctl_t *macid_ctl, u8 id); -+s8 rtw_macid_get_if_g(struct macid_ctl_t *macid_ctl, u8 id); -+s8 rtw_macid_get_ch_g(struct macid_ctl_t *macid_ctl, u8 id); -+void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta); -+void rtw_release_macid(_adapter *padapter, struct sta_info *psta); -+u8 rtw_search_max_mac_id(_adapter *padapter); -+void rtw_macid_ctl_init(struct macid_ctl_t *macid_ctl); -+void rtw_macid_ctl_deinit(struct macid_ctl_t *macid_ctl); ++extern uint rtw_get_camid(uint macid); ++extern void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta); ++extern void rtw_release_macid(_adapter *padapter, struct sta_info *psta); + +void report_join_res(_adapter *padapter, int res); +void report_survey_event(_adapter *padapter, union recv_frame *precv_frame); +void report_surveydone_event(_adapter *padapter); -+void report_del_sta_event(_adapter *padapter, unsigned char *MacAddr, unsigned short reason, bool enqueue); ++void report_del_sta_event(_adapter *padapter, unsigned char* MacAddr, unsigned short reason); +void report_add_sta_event(_adapter *padapter, unsigned char* MacAddr, int cam_idx); -+bool rtw_port_switch_chk(_adapter *adapter); -+void report_wmm_edca_update(_adapter *padapter); + +void beacon_timing_control(_adapter *padapter); -+u8 chk_bmc_sleepq_cmd(_adapter* padapter); +extern u8 set_tx_beacon_cmd(_adapter*padapter); +unsigned int setup_beacon_frame(_adapter *padapter, unsigned char *beacon_frame); +void update_mgnt_tx_rate(_adapter *padapter, u8 rate); @@ -330086,30 +146911,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt +void issue_asocrsp(_adapter *padapter, unsigned short status, struct sta_info *pstat, int pkt_type); +void issue_auth(_adapter *padapter, struct sta_info *psta, unsigned short status); +void issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da); -+s32 issue_probereq_ex(_adapter *padapter, NDIS_802_11_SSID *pssid, u8* da, u8 ch, bool append_wps, int try_cnt, int wait_ms); ++s32 issue_probereq_ex(_adapter *padapter, NDIS_802_11_SSID *pssid, u8* da, int try_cnt, int wait_ms); +int issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); -+s32 issue_nulldata_in_interrupt(PADAPTER padapter, u8 *da, unsigned int power_mode); +int issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int try_cnt, int wait_ms); +int issue_deauth(_adapter *padapter, unsigned char *da, unsigned short reason); +int issue_deauth_ex(_adapter *padapter, u8 *da, unsigned short reason, int try_cnt, int wait_ms); +void issue_action_spct_ch_switch(_adapter *padapter, u8 *ra, u8 new_ch, u8 ch_offset); -+void issue_addba_req(_adapter *adapter, unsigned char *ra, u8 tid); -+void issue_addba_rsp(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u8 size); -+u8 issue_addba_rsp_wait_ack(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u8 size, int try_cnt, int wait_ms); -+void issue_del_ba(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator); -+int issue_del_ba_ex(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator, int try_cnt, int wait_ms); -+ -+#ifdef CONFIG_IEEE80211W -+void issue_action_SA_Query(_adapter *padapter, unsigned char *raddr, unsigned char action, unsigned short tid, u8 key_type); -+int issue_deauth_11w(_adapter *padapter, unsigned char *da, unsigned short reason, u8 key_type); -+extern void init_dot11w_expire_timer(_adapter *padapter, struct sta_info *psta); -+#endif //CONFIG_IEEE80211W -+int issue_action_SM_PS(_adapter *padapter , unsigned char *raddr , u8 NewMimoPsMode); -+int issue_action_SM_PS_wait_ack(_adapter *padapter, unsigned char *raddr, u8 NewMimoPsMode, int try_cnt, int wait_ms); -+ -+unsigned int send_delba_sta_tid(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid, u8 force); -+unsigned int send_delba_sta_tid_wait_ack(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid, u8 force); -+ ++void issue_action_BA(_adapter *padapter, unsigned char *raddr, unsigned char action, unsigned short status); +unsigned int send_delba(_adapter *padapter, u8 initiator, u8 *addr); +unsigned int send_beacon(_adapter *padapter); + @@ -330134,31 +146942,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt +unsigned int on_action_spct(_adapter *padapter, union recv_frame *precv_frame); +unsigned int OnAction_qos(_adapter *padapter, union recv_frame *precv_frame); +unsigned int OnAction_dls(_adapter *padapter, union recv_frame *precv_frame); -+ -+#define RX_AMPDU_ACCEPT_INVALID 0xFF -+#define RX_AMPDU_SIZE_INVALID 0xFF -+ -+enum rx_ampdu_reason { -+ RX_AMPDU_DRV_FIXED = 1, -+ RX_AMPDU_BTCOEX = 2, /* not used, because BTCOEX has its own variable management */ -+ RX_AMPDU_DRV_SCAN = 3, -+}; -+u8 rtw_rx_ampdu_size(_adapter *adapter); -+bool rtw_rx_ampdu_is_accept(_adapter *adapter); -+bool rtw_rx_ampdu_set_size(_adapter *adapter, u8 size, u8 reason); -+bool rtw_rx_ampdu_set_accept(_adapter *adapter, u8 accept, u8 reason); -+u8 rx_ampdu_apply_sta_tid(_adapter *adapter, struct sta_info *sta, u8 tid, u8 accept, u8 size); -+u8 rx_ampdu_apply_sta(_adapter *adapter, struct sta_info *sta, u8 accept, u8 size); -+u16 rtw_rx_ampdu_apply(_adapter *adapter); -+ +unsigned int OnAction_back(_adapter *padapter, union recv_frame *precv_frame); +unsigned int on_action_public(_adapter *padapter, union recv_frame *precv_frame); +unsigned int OnAction_ht(_adapter *padapter, union recv_frame *precv_frame); -+#ifdef CONFIG_IEEE80211W -+unsigned int OnAction_sa_query(_adapter *padapter, union recv_frame *precv_frame); -+#endif //CONFIG_IEEE80211W +unsigned int OnAction_wmm(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnAction_vht(_adapter *padapter, union recv_frame *precv_frame); +unsigned int OnAction_p2p(_adapter *padapter, union recv_frame *precv_frame); + + @@ -330166,16 +146953,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt +void mlmeext_sta_del_event_callback(_adapter *padapter); +void mlmeext_sta_add_event_callback(_adapter *padapter, struct sta_info *psta); + -+void linked_status_chk(_adapter *padapter, u8 from_timer); -+ -+void _linked_info_dump(_adapter *padapter); ++void linked_status_chk(_adapter *padapter); + +void survey_timer_hdl (_adapter *padapter); +void link_timer_hdl (_adapter *padapter); +void addba_timer_hdl(struct sta_info *psta); -+#ifdef CONFIG_IEEE80211W -+void sa_query_timer_hdl(struct sta_info *psta); -+#endif //CONFIG_IEEE80211W +//void reauth_timer_hdl(_adapter *padapter); +//void reassoc_timer_hdl(_adapter *padapter); + @@ -330198,28 +146980,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt + +extern void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len); +extern void correct_TSF(_adapter *padapter, struct mlme_ext_priv *pmlmeext); -+extern void adaptive_early_32k(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len); -+extern u8 traffic_status_watchdog(_adapter *padapter, u8 from_timer); + + +#ifdef CONFIG_CONCURRENT_MODE -+sint check_buddy_mlmeinfo_state(_adapter *padapter, u32 state); ++ sint check_buddy_mlmeinfo_state(_adapter *padapter, u32 state); ++int concurrent_chk_start_clnt_join(_adapter *padapter); ++void concurrent_chk_joinbss_done(_adapter *padapter, int join_res); ++#endif //CONFIG_CONCURRENT_MODE ++ ++#ifdef CONFIG_DUALMAC_CONCURRENT ++void dc_SelectChannel(_adapter *padapter, unsigned char channel); ++void dc_SetBWMode(_adapter *padapter, unsigned short bwmode, unsigned char channel_offset); ++void dc_set_channel_bwmode_disconnect(_adapter *padapter); ++u8 dc_handle_join_request(_adapter *padapter); ++void dc_handle_join_done(_adapter *padapter, u8 join_res); ++sint dc_check_fwstate(_adapter *padapter, sint fw_state); ++u8 dc_handle_site_survey(_adapter *padapter); ++void dc_report_survey_event(_adapter *padapter, union recv_frame *precv_frame); ++void dc_set_channel_bwmode_survey_done(_adapter *padapter); ++void dc_set_ap_channel_bandwidth(_adapter *padapter, u8 channel, u8 channel_offset, u8 bwmode); ++void dc_resume_xmit(_adapter *padapter); ++u8 dc_check_xmit(_adapter *padapter); +#endif + -+void rtw_join_done_chk_ch(_adapter *padapter, int join_res); -+ -+int rtw_chk_start_clnt_join(_adapter *padapter, u8 *ch, u8 *bw, u8 *offset); -+int rtw_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset); -+int rtw_get_ch_setting_union_no_self(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset); -+ -+void rtw_dev_iface_status(_adapter *adapter, u8 *sta_num, u8 *ld_sta_num, u8 *lg_sta_num -+ , u8 *ap_num, u8 *ld_ap_num); -+void rtw_dev_iface_status_no_self(_adapter *adapter, u8 *sta_num, u8 *ld_sta_num, u8 *lg_sta_num -+ , u8 *ap_num, u8 *ld_ap_num); -+ +struct cmd_hdl { + uint parmsize; -+ u8 (*h2cfuns)(struct _ADAPTER *padapter, u8 *pbuf); ++ u8 (*h2cfuns)(struct _ADAPTER *padapter, u8 *pbuf); +}; + + @@ -330236,35 +147022,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt +u8 disconnect_hdl(_adapter *padapter, u8 *pbuf); +u8 createbss_hdl(_adapter *padapter, u8 *pbuf); +u8 setopmode_hdl(_adapter *padapter, u8 *pbuf); -+u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf); ++u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf); +u8 setauth_hdl(_adapter *padapter, u8 *pbuf); +u8 setkey_hdl(_adapter *padapter, u8 *pbuf); +u8 set_stakey_hdl(_adapter *padapter, u8 *pbuf); +u8 set_assocsta_hdl(_adapter *padapter, u8 *pbuf); +u8 del_assocsta_hdl(_adapter *padapter, u8 *pbuf); +u8 add_ba_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 add_ba_rsp_hdl(_adapter *padapter, unsigned char *pbuf); + +u8 mlme_evt_hdl(_adapter *padapter, unsigned char *pbuf); +u8 h2c_msg_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 chk_bmc_sleepq_hdl(_adapter *padapter, unsigned char *pbuf); +u8 tx_beacon_hdl(_adapter *padapter, unsigned char *pbuf); +u8 set_ch_hdl(_adapter *padapter, u8 *pbuf); +u8 set_chplan_hdl(_adapter *padapter, unsigned char *pbuf); +u8 led_blink_hdl(_adapter *padapter, unsigned char *pbuf); +u8 set_csa_hdl(_adapter *padapter, unsigned char *pbuf); //Kurt: Handling DFS channel switch announcement ie. +u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 run_in_thread_hdl(_adapter *padapter, u8 *pbuf); -+u8 rtw_getmacreg_hdl(_adapter *padapter, u8 *pbuf); ++ + +#define GEN_DRV_CMD_HANDLER(size, cmd) {size, &cmd ## _hdl}, +#define GEN_MLME_EXT_HANDLER(size, cmd) {size, cmd}, + +#ifdef _RTW_CMD_C_ + -+struct cmd_hdl wlancmds[] = ++static struct cmd_hdl wlancmds[] = +{ -+ GEN_DRV_CMD_HANDLER(sizeof(struct readMAC_parm), rtw_getmacreg) /*0*/ ++ GEN_DRV_CMD_HANDLER(0, NULL) /*0*/ + GEN_DRV_CMD_HANDLER(0, NULL) + GEN_DRV_CMD_HANDLER(0, NULL) + GEN_DRV_CMD_HANDLER(0, NULL) @@ -330277,7 +147060,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt + GEN_MLME_EXT_HANDLER(0, NULL) /*10*/ + GEN_MLME_EXT_HANDLER(0, NULL) + GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) + GEN_MLME_EXT_HANDLER(sizeof (struct joinbss_parm), join_cmd_hdl) /*14*/ + GEN_MLME_EXT_HANDLER(sizeof (struct disconnect_parm), disconnect_hdl) + GEN_MLME_EXT_HANDLER(sizeof (struct createbss_parm), createbss_hdl) @@ -330309,7 +147092,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt + GEN_MLME_EXT_HANDLER(0, NULL) + GEN_MLME_EXT_HANDLER(0, NULL) + GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct addBaReq_parm), add_ba_hdl) ++ GEN_MLME_EXT_HANDLER(sizeof(struct addBaReq_parm), add_ba_hdl) + GEN_MLME_EXT_HANDLER(sizeof(struct set_ch_parm), set_ch_hdl) /* 46 */ + GEN_MLME_EXT_HANDLER(0, NULL) + GEN_MLME_EXT_HANDLER(0, NULL) @@ -330318,7 +147101,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt + GEN_MLME_EXT_HANDLER(0, NULL) + GEN_MLME_EXT_HANDLER(0, NULL) + GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) ++ GEN_MLME_EXT_HANDLER(0, NULL) + GEN_MLME_EXT_HANDLER(sizeof(struct Tx_Beacon_param), tx_beacon_hdl) /*55*/ + + GEN_MLME_EXT_HANDLER(0, mlme_evt_hdl) /*56*/ @@ -330330,9 +147113,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt + + GEN_MLME_EXT_HANDLER(sizeof(struct SetChannelSwitch_param), set_csa_hdl) /*61*/ + GEN_MLME_EXT_HANDLER(sizeof(struct TDLSoption_param), tdls_hdl) /*62*/ -+ GEN_MLME_EXT_HANDLER(0, chk_bmc_sleepq_hdl) /*63*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct RunInThread_param), run_in_thread_hdl) /*64*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct addBaRsp_parm), add_ba_rsp_hdl) /* 65 */ +}; + +#endif @@ -330340,26 +147120,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt +struct C2HEvent_Header +{ + -+#ifdef CONFIG_LITTLE_ENDIAN -+ ++#ifdef __LITTLE_ENDIAN + unsigned int len:16; + unsigned int ID:8; + unsigned int seq:8; -+ -+#elif defined(CONFIG_BIG_ENDIAN) -+ -+ unsigned int seq:8; -+ unsigned int ID:8; -+ unsigned int len:16; -+ +#else -+ -+# error "Must be LITTLE or BIG Endian" -+ ++ unsigned int seq:8; ++ unsigned int ID:8; ++ unsigned int len:16; +#endif -+ + unsigned int rsvd; -+ +}; + +void rtw_dummy_event_callback(_adapter *adapter , u8 *pbuf); @@ -330369,43 +147139,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt +{ + GEN_EVT_CODE(_Read_MACREG)=0, /*0*/ + GEN_EVT_CODE(_Read_BBREG), -+ GEN_EVT_CODE(_Read_RFREG), -+ GEN_EVT_CODE(_Read_EEPROM), -+ GEN_EVT_CODE(_Read_EFUSE), ++ GEN_EVT_CODE(_Read_RFREG), ++ GEN_EVT_CODE(_Read_EEPROM), ++ GEN_EVT_CODE(_Read_EFUSE), + GEN_EVT_CODE(_Read_CAM), /*5*/ -+ GEN_EVT_CODE(_Get_BasicRate), -+ GEN_EVT_CODE(_Get_DataRate), -+ GEN_EVT_CODE(_Survey), /*8*/ -+ GEN_EVT_CODE(_SurveyDone), /*9*/ -+ -+ GEN_EVT_CODE(_JoinBss) , /*10*/ -+ GEN_EVT_CODE(_AddSTA), -+ GEN_EVT_CODE(_DelSTA), -+ GEN_EVT_CODE(_AtimDone) , -+ GEN_EVT_CODE(_TX_Report), ++ GEN_EVT_CODE(_Get_BasicRate), ++ GEN_EVT_CODE(_Get_DataRate), ++ GEN_EVT_CODE(_Survey), /*8*/ ++ GEN_EVT_CODE(_SurveyDone), /*9*/ ++ ++ GEN_EVT_CODE(_JoinBss) , /*10*/ ++ GEN_EVT_CODE(_AddSTA), ++ GEN_EVT_CODE(_DelSTA), ++ GEN_EVT_CODE(_AtimDone) , ++ GEN_EVT_CODE(_TX_Report), + GEN_EVT_CODE(_CCX_Report), /*15*/ -+ GEN_EVT_CODE(_DTM_Report), -+ GEN_EVT_CODE(_TX_Rate_Statistics), -+ GEN_EVT_CODE(_C2HLBK), -+ GEN_EVT_CODE(_FWDBG), ++ GEN_EVT_CODE(_DTM_Report), ++ GEN_EVT_CODE(_TX_Rate_Statistics), ++ GEN_EVT_CODE(_C2HLBK), ++ GEN_EVT_CODE(_FWDBG), + GEN_EVT_CODE(_C2HFEEDBACK), /*20*/ + GEN_EVT_CODE(_ADDBA), + GEN_EVT_CODE(_C2HBCN), -+ GEN_EVT_CODE(_ReportPwrState), //filen: only for PCIE, USB ++ GEN_EVT_CODE(_ReportPwrState), //filen: only for PCIE, USB + GEN_EVT_CODE(_CloseRF), //filen: only for PCIE, work around ASPM -+ GEN_EVT_CODE(_WMM), /*25*/ -+#ifdef CONFIG_IEEE80211W -+ GEN_EVT_CODE(_TimeoutSTA), -+#endif /* CONFIG_IEEE80211W */ -+ MAX_C2HEVT ++ MAX_C2HEVT +}; + + -+#ifdef _RTW_MLME_EXT_C_ ++#ifdef _RTW_MLME_EXT_C_ + -+static struct fwevent wlanevents[] = ++static struct fwevent wlanevents[] = +{ -+ {0, rtw_dummy_event_callback}, /*0*/ ++ {0, rtw_dummy_event_callback}, /*0*/ + {0, NULL}, + {0, NULL}, + {0, NULL}, @@ -330415,10 +147181,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt + {0, NULL}, + {0, &rtw_survey_event_callback}, /*8*/ + {sizeof (struct surveydone_event), &rtw_surveydone_event_callback}, /*9*/ -+ ++ + {0, &rtw_joinbss_event_callback}, /*10*/ + {sizeof(struct stassoc_event), &rtw_stassoc_event_callback}, -+ {sizeof(struct stadel_event), &rtw_stadel_event_callback}, ++ {sizeof(struct stadel_event), &rtw_stadel_event_callback}, + {0, &rtw_atimdone_event_callback}, + {0, rtw_dummy_event_callback}, + {0, NULL}, /*15*/ @@ -330430,26 +147196,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux/3rdparty/rt + {0, NULL}, + {0, NULL}, + {0, &rtw_cpwm_event_callback}, -+ {0, NULL}, -+ {0, &rtw_wmm_event_callback}, /*25*/ -+#ifdef CONFIG_IEEE80211W -+ {sizeof(struct stadel_event), &rtw_sta_timeout_event_callback}, -+#endif /* CONFIG_IEEE80211W */ -+ +}; + -+#endif//_RTW_MLME_EXT_C_ ++#endif//_RTL8192C_CMD_C_ + +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl8812au/include/rtw_mlme.h ---- linux.old/3rdparty/rtl8812au/include/rtw_mlme.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_mlme.h 2017-06-07 23:07:21.042690401 +0300 -@@ -0,0 +1,1015 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_mlme.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mlme.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_mlme.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mlme.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,811 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -330459,11 +147218,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __RTW_MLME_H_ +#define __RTW_MLME_H_ @@ -330477,11 +147231,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 +// Commented by Albert 20101105 +// Increase the scanning timeout because of increasing the SURVEY_TO value. + -+#define SCANNING_TIMEOUT 8000 -+#ifdef CONFIG_SCAN_BACKOP -+#define CONC_SCANNING_TIMEOUT_SINGLE_BAND 10000 -+#define CONC_SCANNING_TIMEOUT_DUAL_BAND 15000 -+#endif ++#define SCANNING_TIMEOUT 8000 ++ ++#define SCAN_INTERVAL (30) // unit:2sec, 30*2=60sec + +#ifdef PALTFORM_OS_WINCE +#define SCANQUEUE_LIFETIME 12000000 // unit:us @@ -330489,61 +147241,62 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 +#define SCANQUEUE_LIFETIME 20000 // 20sec, unit:msec +#endif + -+#define WIFI_NULL_STATE 0x00000000 -+#define WIFI_ASOC_STATE 0x00000001 /* Linked */ -+#define WIFI_REASOC_STATE 0x00000002 -+#define WIFI_SLEEP_STATE 0x00000004 -+#define WIFI_STATION_STATE 0x00000008 -+#define WIFI_AP_STATE 0x00000010 -+#define WIFI_ADHOC_STATE 0x00000020 -+#define WIFI_ADHOC_MASTER_STATE 0x00000040 -+#define WIFI_UNDER_LINKING 0x00000080 -+#define WIFI_UNDER_WPS 0x00000100 -+/*#define WIFI_UNDEFINED_STATE 0x00000200*/ -+#define WIFI_STA_ALIVE_CHK_STATE 0x00000400 -+#define WIFI_SITE_MONITOR 0x00000800 /* under site surveying */ -+#define WIFI_WDS 0x00001000 -+#define WIFI_WDS_RX_BEACON 0x00002000 /* already rx WDS AP beacon */ -+#define WIFI_AUTOCONF 0x00004000 -+#define WIFI_AUTOCONF_IND 0x00008000 -+#define WIFI_MP_STATE 0x00010000 -+#define WIFI_MP_CTX_BACKGROUND 0x00020000 /* in continuous tx background */ -+#define WIFI_MP_CTX_ST 0x00040000 /* in continuous tx with single-tone */ -+#define WIFI_MP_CTX_BACKGROUND_PENDING 0x00080000 /* pending in continuous tx background due to out of skb */ -+#define WIFI_MP_CTX_CCK_HW 0x00100000 /* in continuous tx */ -+#define WIFI_MP_CTX_CCK_CS 0x00200000 /* in continuous tx with carrier suppression */ -+#define WIFI_MP_LPBK_STATE 0x00400000 -+#define WIFI_OP_CH_SWITCHING 0x00800000 -+/*#define WIFI_UNDEFINED_STATE 0x01000000*/ -+/*#define WIFI_UNDEFINED_STATE 0x02000000*/ -+/*#define WIFI_UNDEFINED_STATE 0x04000000*/ -+/*#define WIFI_UNDEFINED_STATE 0x08000000*/ -+/*#define WIFI_UNDEFINED_STATE 0x10000000*/ -+/*#define WIFI_UNDEFINED_STATE 0x20000000*/ -+/*#define WIFI_UNDEFINED_STATE 0x40000000*/ -+#define WIFI_MONITOR_STATE 0x80000000 ++#define WIFI_NULL_STATE 0x00000000 ++#define WIFI_ASOC_STATE 0x00000001 // Under Linked state... ++#define WIFI_REASOC_STATE 0x00000002 ++#define WIFI_SLEEP_STATE 0x00000004 ++#define WIFI_STATION_STATE 0x00000008 ++#define WIFI_AP_STATE 0x00000010 ++#define WIFI_ADHOC_STATE 0x00000020 ++#define WIFI_ADHOC_MASTER_STATE 0x00000040 ++#define WIFI_UNDER_LINKING 0x00000080 + -+#define MLME_STATE_FMT "%s%s%s%s%s%s%s%s%s%s%s%s" -+#define MLME_STATE_ARG(state) \ -+ ((state) & WIFI_STATION_STATE)?" STA":"", \ -+ ((state) & WIFI_AP_STATE)?" AP":"", \ -+ ((state) & WIFI_ADHOC_STATE)?" ADHOC":"", \ -+ ((state) & WIFI_ADHOC_MASTER_STATE)?" ADHOC_M":"", \ -+ ((state) & WIFI_MONITOR_STATE)?" MONITOR":"", \ -+ ((state) & WIFI_MP_STATE)?" MP":"", \ -+ ((state) & WIFI_SITE_MONITOR)?" SCAN":"", \ -+ ((state) & WIFI_UNDER_LINKING)?" LINKING":"", \ -+ ((state) & WIFI_ASOC_STATE)?" ASOC":"", \ -+ ((state) & WIFI_OP_CH_SWITCHING)?" OP_CH_SW":"", \ -+ ((state) & WIFI_UNDER_WPS)?" WPS":"", \ -+ ((state) & WIFI_SLEEP_STATE)?" SLEEP":"" ++#define WIFI_UNDER_WPS 0x00000100 ++//#define WIFI_UNDER_CMD 0x00000200 ++//#define WIFI_UNDER_P2P 0x00000400 ++#define WIFI_STA_ALIVE_CHK_STATE 0x00000400 ++#define WIFI_SITE_MONITOR 0x00000800 //to indicate the station is under site surveying ++#ifdef WDS ++#define WIFI_WDS 0x00001000 ++#define WIFI_WDS_RX_BEACON 0x00002000 // already rx WDS AP beacon ++#endif ++#ifdef AUTO_CONFIG ++#define WIFI_AUTOCONF 0x00004000 ++#define WIFI_AUTOCONF_IND 0x00008000 ++#endif + -+#define ADPT_MLME_S_ARG(adapter) MLME_STATE_ARG(get_fwstate(&((adapter)->mlmepriv))) ++/* ++// ========== P2P Section Start =============== ++#define WIFI_P2P_LISTEN_STATE 0x00010000 ++#define WIFI_P2P_GROUP_FORMATION_STATE 0x00020000 ++// ========== P2P Section End =============== ++*/ + ++//#ifdef UNDER_MPTEST ++#define WIFI_MP_STATE 0x00010000 ++#define WIFI_MP_CTX_BACKGROUND 0x00020000 // in continous tx background ++#define WIFI_MP_CTX_ST 0x00040000 // in continous tx with single-tone ++#define WIFI_MP_CTX_BACKGROUND_PENDING 0x00080000 // pending in continous tx background due to out of skb ++#define WIFI_MP_CTX_CCK_HW 0x00100000 // in continous tx ++#define WIFI_MP_CTX_CCK_CS 0x00200000 // in continous tx with carrier suppression ++#define WIFI_MP_LPBK_STATE 0x00400000 ++//#endif ++ ++//#define _FW_UNDER_CMD WIFI_UNDER_CMD +#define _FW_UNDER_LINKING WIFI_UNDER_LINKING +#define _FW_LINKED WIFI_ASOC_STATE +#define _FW_UNDER_SURVEY WIFI_SITE_MONITOR + ++extern unsigned char WPA_TKIP_CIPHER[4]; ++extern unsigned char RSN_TKIP_CIPHER[4]; ++#ifdef CONFIG_DISABLE_MCS13TO15 ++extern unsigned char MCS_rate_2R_MCS13TO15_OFF[16]; ++extern unsigned char MCS_rate_2R[16]; ++#else //CONFIG_DISABLE_MCS13TO15 ++extern unsigned char MCS_rate_2R[16]; ++#endif //CONFIG_DISABLE_MCS13TO15 ++extern unsigned char MCS_rate_1R[16]; ++ + +enum dot11AuthAlgrthmNum { + dot11AuthAlgrthm_Open = 0, @@ -330562,11 +147315,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + SCAN_MIX, +}RT_SCAN_TYPE, *PRT_SCAN_TYPE; + -+#define WIFI_FREQUENCY_BAND_AUTO 0 -+#define WIFI_FREQUENCY_BAND_5GHZ 1 -+#define WIFI_FREQUENCY_BAND_2GHZ 2 -+ -+#define rtw_band_valid(band) ((band) <= WIFI_FREQUENCY_BAND_2GHZ) ++enum _BAND ++{ ++ GHZ24_50 = 0, ++ GHZ_50, ++ GHZ_24, ++}; + +enum DriverInterface { + DRIVER_WEXT = 1, @@ -330611,15 +147365,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + u32 NumTxOkInPeriod; + u32 NumRxOkInPeriod; + u32 NumRxUnicastOkInPeriod; -+ BOOLEAN bBusyTraffic; -+ BOOLEAN bTxBusyTraffic; -+ BOOLEAN bRxBusyTraffic; -+ BOOLEAN bHigherBusyTraffic; // For interrupt migration purpose. -+ BOOLEAN bHigherBusyRxTraffic; // We may disable Tx interrupt according as Rx traffic. -+ BOOLEAN bHigherBusyTxTraffic; // We may disable Tx interrupt according as Tx traffic. -+ //u8 TrafficBusyState; -+ u8 TrafficTransitionCount; -+ u32 LowPowerTransitionCount; ++ bool bBusyTraffic; ++ bool bTxBusyTraffic; ++ bool bRxBusyTraffic; ++ bool bHigherBusyTraffic; // For interrupt migration purpose. ++ bool bHigherBusyRxTraffic; // We may disable Tx interrupt according as Rx traffic. ++ bool bHigherBusyTxTraffic; // We may disable Tx interrupt according as Tx traffic. +}RT_LINK_DETECT_T, *PRT_LINK_DETECT_T; + +struct profile_info { @@ -330644,16 +147395,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + u8 token; // Used to record the dialog token of p2p invitation request frame. +}; + -+#define MIRACAST_DISABLED 0 -+#define MIRACAST_SOURCE 1 -+#define MIRACAST_SINK 2 -+#define MIRACAST_INVALID 3 -+ -+#define is_miracast_enabled(mode) \ -+ (mode == MIRACAST_SOURCE || mode == MIRACAST_SINK) -+ -+const char *get_miracast_mode_str(int mode); -+ +#ifdef CONFIG_WFD + +struct wifi_display_info{ @@ -330670,12 +147411,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + u8 wfd_pc; // WFD preferred connection + // 0 -> Prefer to use the P2P for WFD connection on peer side. + // 1 -> Prefer to use the TDLS for WFD connection on peer side. -+ ++ + u8 wfd_device_type; // WFD Device Type + // 0 -> WFD Source Device + // 1 -> WFD Primary Sink Device + enum SCAN_RESULT_TYPE scan_result_type; // Used when P2P is enable. This parameter will impact the scan result. -+ u8 stack_wfd_mode; ++ +}; +#endif //CONFIG_WFD + @@ -330690,7 +147431,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + +struct rx_provdisc_req_info{ //When peer device issue prov_disc_req first, we should store the following informations + u8 peerDevAddr[ ETH_ALEN ]; // Peer device address -+ u8 strconfig_method_desc_of_prov_disc_req[4]; // description for the config method located in the provisioning discovery request frame. ++ u8 strconfig_method_desc_of_prov_disc_req[4]; // description for the config method located in the provisioning discovery request frame. + // The UI must know this information to know which config method the remote p2p device is requiring. +}; + @@ -330698,7 +147439,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + u16 peer_channel_num[2]; // The channel number which the receiver stands. + u8 peerDevAddr[ ETH_ALEN ]; // Peer device address + u8 benable; // This negoitation request frame is trigger to send or not -+ u8 peer_ch; /* The listen channel for peer P2P device */ +}; + +struct group_id_info{ @@ -330708,11 +147448,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + +struct scan_limit_info{ + u8 scan_op_ch_only; // When this flag is set, the driver should just scan the operation channel -+#ifndef CONFIG_P2P_OP_CHK_SOCIAL_CH + u8 operation_ch[2]; // Store the operation channel of invitation request frame -+#else -+ u8 operation_ch[5]; // Store additional channel 1,6,11 for Android 4.2 IOT & Nexus 4 -+#endif //CONFIG_P2P_OP_CHK_SOCIAL_CH +}; + +#ifdef CONFIG_IOCTL_CFG80211 @@ -330721,39 +147457,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + u8 restore_channel; + struct ieee80211_channel remain_on_ch_channel; + enum nl80211_channel_type remain_on_ch_type; -+ ATOMIC_T ro_ch_cookie_gen; -+ u64 remain_on_ch_cookie; ++ u64 remain_on_ch_cookie; + bool is_ro_ch; -+ u32 last_ro_ch_time; /* this will be updated at the beginning and end of ro_ch */ +}; +#endif //CONFIG_IOCTL_CFG80211 + -+#ifdef CONFIG_P2P_WOWLAN -+ -+enum P2P_WOWLAN_RECV_FRAME_TYPE -+{ -+ P2P_WOWLAN_RECV_NEGO_REQ = 0, -+ P2P_WOWLAN_RECV_INVITE_REQ = 1, -+ P2P_WOWLAN_RECV_PROVISION_REQ = 2, -+}; -+ -+struct p2p_wowlan_info{ -+ -+ u8 is_trigger; -+ enum P2P_WOWLAN_RECV_FRAME_TYPE wowlan_recv_frame_type; -+ u8 wowlan_peer_addr[ETH_ALEN]; -+ u16 wowlan_peer_wpsconfig; -+ u8 wowlan_peer_is_persistent; -+ u8 wowlan_peer_invitation_type; -+}; -+ -+#endif //CONFIG_P2P_WOWLAN -+ +struct wifidirect_info{ + _adapter* padapter; + _timer find_phase_timer; + _timer restore_p2p_state_timer; -+ ++ + // Used to do the scanning. After confirming the peer is availalble, the driver transmits the P2P frame to peer. + _timer pre_tx_scan_timer; + _timer reset_ch_sitesurvey; @@ -330773,16 +147486,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + struct scan_limit_info p2p_info; // Used for get the limit scan channel from the P2P negotiation handshake +#ifdef CONFIG_WFD + struct wifi_display_info *wfd_info; -+#endif -+ -+#ifdef CONFIG_P2P_WOWLAN -+ struct p2p_wowlan_info p2p_wow_info; -+#endif //CONFIG_P2P_WOWLAN -+ ++#endif + enum P2P_ROLE role; + enum P2P_STATE pre_p2p_state; + enum P2P_STATE p2p_state; -+ u8 device_addr[ETH_ALEN]; // The device address should be the mac address of this device. ++ u8 device_addr[ETH_ALEN]; // The device address should be the mac address of this device. + u8 interface_addr[ETH_ALEN]; + u8 social_chan[4]; + u8 listen_channel; @@ -330803,8 +147511,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + u8 negotiation_dialog_token; + u8 nego_ssid[ WLAN_SSID_MAXLEN ]; // SSID information for group negotitation + u8 nego_ssidlen; -+ u8 p2p_group_ssid[WLAN_SSID_MAXLEN]; -+ u8 p2p_group_ssid_len; ++ u8 p2p_group_ssid[WLAN_SSID_MAXLEN]; ++ u8 p2p_group_ssid_len; + u8 persistent_supported; // Flag to know the persistent function should be supported or not. + // In the Sigma test, the Sigma will provide this enable from the sta_set_p2p CAPI. + // 0: disable @@ -330826,9 +147534,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + + enum P2P_WPSINFO ui_got_wps_info; // This field will store the WPS value (PIN value or PBC) that UI had got from the user. + u16 supported_wps_cm; // This field describes the WPS config method which this driver supported. -+ // The value should be the combination of config method defined in page104 of WPS v2.0 spec. -+ u8 external_uuid; // UUID flag -+ u8 uuid[16]; // UUID ++ // The value should be the combination of config method defined in page104 of WPS v2.0 spec. + uint channel_list_attr_len; // This field will contain the length of body of P2P Channel List attribute of group negotitation response frame. + u8 channel_list_attr[100]; // This field will contain the body of P2P Channel List attribute of group negotitation response frame. + // We will use the channel_cnt and channel_list fields when constructing the group negotitation confirm frame. @@ -330855,80 +147561,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 +struct tdls_ss_record{ //signal strength record + u8 macaddr[ETH_ALEN]; + u8 RxPWDBAll; -+ u8 is_tdls_sta; // _TRUE: direct link sta, _FALSE: else ++ u8 is_tdls_sta; // true: direct link sta, false: else +}; + -+struct tdls_temp_mgmt{ -+ u8 initiator; // 0: None, 1: we initiate, 2: peer initiate -+ u8 peer_addr[ETH_ALEN]; -+}; -+ -+#ifdef CONFIG_TDLS_CH_SW -+struct tdls_ch_switch{ -+ u32 ch_sw_state; -+ ATOMIC_T chsw_on; -+ u8 addr[ETH_ALEN]; -+ u8 off_ch_num; -+ u8 ch_offset; -+ u32 cur_time; -+ u8 delay_switch_back; -+ u8 dump_stack; -+}; -+#endif -+ +struct tdls_info{ + u8 ap_prohibited; -+ u8 ch_switch_prohibited; -+ u8 link_established; ++ uint setup_state; + u8 sta_cnt; -+ u8 sta_maximum; /* 1:tdls sta is equal (NUM_STA-1), reach max direct link number; 0: else; */ ++ u8 sta_maximum; // 1:tdls sta is equal (NUM_STA-1), reach max direct link number; 0: else; + struct tdls_ss_record ss_record; -+#ifdef CONFIG_TDLS_CH_SW -+ struct tdls_ch_switch chsw_info; -+#endif -+ ++ u8 macid_index; //macid entry that is ready to write ++ u8 clear_cam; //cam entry that is trying to clear, using it in direct link teardown + u8 ch_sensing; + u8 cur_channel; ++ u8 candidate_ch; + u8 collect_pkt_num[MAX_CHANNEL_NUM]; + _lock cmd_lock; + _lock hdl_lock; + u8 watchdog_count; -+ u8 dev_discovered; /* WFD_TDLS: for sigma test */ -+ u8 tdls_enable; -+ -+ /* Let wpa_supplicant to setup*/ -+ u8 driver_setup; ++ u8 dev_discovered; //WFD_TDLS: for sigma test ++ u8 enable; +#ifdef CONFIG_WFD + struct wifi_display_info *wfd_info; -+#endif -+}; -+ -+struct tdls_txmgmt { -+ u8 peer[ETH_ALEN]; -+ u8 action_code; -+ u8 dialog_token; -+ u16 status_code; -+ u8 *buf; -+ size_t len; -+}; -+ -+/* used for mlme_priv.roam_flags */ -+enum { -+ RTW_ROAM_ON_EXPIRED = BIT0, -+ RTW_ROAM_ON_RESUME = BIT1, -+ RTW_ROAM_ACTIVE = BIT2, -+}; -+ -+struct beacon_keys { -+ u8 ssid[IW_ESSID_MAX_SIZE]; -+ u32 ssid_len; -+ u8 bcn_channel; -+ u16 ht_cap_info; -+ u8 ht_info_infos_0_sco; // bit0 & bit1 in infos[0] is second channel offset -+ int encryp_protocol; -+ int pairwise_cipher; -+ int group_cipher; -+ int is_8021x; ++#endif +}; + +struct mlme_priv { @@ -330938,13 +147593,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + u8 bScanInProcess; + u8 to_join; //flag + #ifdef CONFIG_LAYER2_ROAMING -+ u8 to_roam; /* roaming trying times */ -+ struct wlan_network *roam_network; /* the target of active roam */ -+ u8 roam_flags; -+ u8 roam_rssi_diff_th; /* rssi difference threshold for active scan candidate selection */ -+ u32 roam_scan_int_ms; /* scan interval for active roam */ -+ u32 roam_scanr_exp_ms; /* scan result expire time in ms for roam */ -+ u8 roam_tgt_addr[ETH_ALEN]; /* request to roam to speicific target without other consideration */ ++ u8 to_roaming; // roaming trying times + #endif + + u8 *nic_hdl; @@ -330960,23 +147609,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + u8 assoc_bssid[6]; + + struct wlan_network cur_network; -+ struct wlan_network *cur_network_scanned; -+ -+ // bcn check info -+ struct beacon_keys cur_beacon_keys; // save current beacon keys -+ struct beacon_keys new_beacon_keys; // save new beacon keys -+ u8 new_beacon_cnts; // if new_beacon_cnts >= threshold, ap beacon is changed -+ -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ // for arp offload keep alive -+ u8 bGetGateway; -+ u8 gw_mac_addr[6]; -+ u8 gw_ip[4]; -+#endif + + //uint wireless_mode; no used, remove it + -+ u32 auto_scan_int_ms; ++ u32 scan_interval; + + _timer assoc_timer; + @@ -330999,7 +147635,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + int num_sta_no_ht; + + /* Number of HT AP/stations 20 MHz */ -+ //int num_sta_ht_20mhz; ++ //int num_sta_ht_20mhz; + + + int num_FortyMHzIntolerant; @@ -331011,33 +147647,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 +#ifdef CONFIG_80211AC_VHT + struct vht_priv vhtpriv; +#endif -+#ifdef CONFIG_BEAMFORMING -+#if (BEAMFORMING_SUPPORT == 0)/*for driver beamforming*/ -+ struct beamforming_info beamforming_info; -+#endif -+#endif -+ -+#ifdef CONFIG_DFS -+ u8 handle_dfs; -+#endif -+#ifdef CONFIG_DFS_MASTER -+ /* TODO: move to rfctl */ -+ _timer dfs_master_timer; -+#endif + + RT_LINK_DETECT_T LinkDetectInfo; + _timer dynamic_chk_timer; //dynamic/periodic check timer + ++ u8 key_mask; //use for ips to set wep key after ips_leave + u8 acm_mask; // for wmm acm mask + u8 ChannelPlan; -+ RT_SCAN_TYPE scan_mode; // active: 1, passive: 0 ++ RT_SCAN_TYPE scan_mode; // active: 1, passive: 0 + ++ //u8 probereq_wpsie[MAX_WPS_IE_LEN];//added in probe req ++ //int probereq_wpsie_len; + u8 *wps_probe_req_ie; + u32 wps_probe_req_ie_len; + -+ u8 ext_capab_ie_data[8];/*currently for ap mode only*/ -+ u8 ext_capab_ie_len; -+ +#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) + /* Number of associated Non-ERP stations (i.e., stations using 802.11b + * in 802.11g BSS) */ @@ -331049,7 +147672,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + /* Number of associated stations that do not support Short Preamble */ + int num_sta_no_short_preamble; + -+ int olbc; /* Overlapping Legacy BSS Condition (Legacy b/g)*/ ++ int olbc; /* Overlapping Legacy BSS Condition */ + + /* Number of HT associated stations that do not support greenfield */ + int num_sta_ht_no_gf; @@ -331060,25 +147683,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + /* Number of HT associated stations 20 MHz */ + int num_sta_ht_20mhz; + -+ /* number of associated stations 40MHz intolerant */ -+ int num_sta_40mhz_intolerant; -+ + /* Overlapping BSS information */ + int olbc_ht; -+ ++ +#ifdef CONFIG_80211N_HT -+ int ht_20mhz_width_req; -+ int ht_intolerant_ch_reported; + u16 ht_op_mode; -+ u8 sw_to_20mhz; /*switch to 20Mhz BW*/ -+#endif /* CONFIG_80211N_HT */ ++#endif /* CONFIG_80211N_HT */ + + u8 *assoc_req; + u32 assoc_req_len; + u8 *assoc_rsp; + u32 assoc_rsp_len; + -+ u8 *wps_beacon_ie; ++ u8 *wps_beacon_ie; + //u8 *wps_probe_req_ie; + u8 *wps_probe_resp_ie; + u8 *wps_assoc_resp_ie; // for CONFIG_IOCTL_CFG80211, this IE could include p2p ie / wfd ie @@ -331087,11 +147704,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + //u32 wps_probe_req_ie_len; + u32 wps_probe_resp_ie_len; + u32 wps_assoc_resp_ie_len; // for CONFIG_IOCTL_CFG80211, this IE len could include p2p ie / wfd ie -+ ++ + u8 *p2p_beacon_ie; + u8 *p2p_probe_req_ie; -+ u8 *p2p_probe_resp_ie; -+ u8 *p2p_go_probe_resp_ie; //for GO ++ u8 *p2p_probe_resp_ie; ++ u8 *p2p_go_probe_resp_ie; //for GO + u8 *p2p_assoc_req_ie; + + u32 p2p_beacon_ie_len; @@ -331111,21 +147728,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + u32 wps_p2p_assoc_resp_ie_len; +#endif +*/ -+ ++ + _lock bcn_update_lock; + u8 update_bcn; -+ -+ u8 ori_ch; -+ u8 ori_bw; -+ u8 ori_offset; ++ ++ +#endif //#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) + +#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) -+ ++ + u8 *wfd_beacon_ie; + u8 *wfd_probe_req_ie; -+ u8 *wfd_probe_resp_ie; -+ u8 *wfd_go_probe_resp_ie; //for GO ++ u8 *wfd_probe_resp_ie; ++ u8 *wfd_go_probe_resp_ie; //for GO + u8 *wfd_assoc_req_ie; + + u32 wfd_beacon_ie_len; @@ -331136,12 +147751,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + +#endif + -+#ifdef RTK_DMP_PLATFORM -+ // DMP kobject_hotplug function signal need in passive level -+ _workitem Linkup_workitem; -+ _workitem Linkdown_workitem; -+#endif -+ +#ifdef CONFIG_INTEL_WIDI + int widi_state; + int listen_state; @@ -331151,45 +147760,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + u8 channel_idx; + u8 group_cnt; //In WiDi 3.5, they specified another scan algo. for WFD/RDS co-existed + u8 sa_ext[L2SDTA_SERVICE_VE_LEN]; -+ -+ u8 widi_enable; -+ /** -+ * For WiDi 4; upper layer would set -+ * p2p_primary_device_type_category_id -+ * p2p_primary_device_type_sub_category_id -+ * p2p_secondary_device_type_category_id -+ * p2p_secondary_device_type_sub_category_id -+ */ -+ u16 p2p_pdt_cid; -+ u16 p2p_pdt_scid; -+ u8 num_p2p_sdt; -+ u16 p2p_sdt_cid[MAX_NUM_P2P_SDT]; -+ u16 p2p_sdt_scid[MAX_NUM_P2P_SDT]; -+ u8 p2p_reject_disable; //When starting NL80211 wpa_supplicant/hostapd, it will call netdev_close -+ //such that it will cause p2p disabled. Use this flag to reject. +#endif // CONFIG_INTEL_WIDI + +#ifdef CONFIG_CONCURRENT_MODE + u8 scanning_via_buddy_intf; +#endif + -+// u8 NumOfBcnInfoChkFail; -+// u32 timeBcnInfoChkStart; ++#ifdef CONFIG_FTP_PROTECT ++ u8 ftp_lock_flag; ++#endif //CONFIG_FTP_PROTECT +}; + -+#define mlme_set_scan_to_timer(mlme, ms) \ -+ do { \ -+ /* DBG_871X("%s set_scan_to_timer(%p, %d)\n", __FUNCTION__, (mlme), (ms)); */ \ -+ _set_timer(&(mlme)->scan_to_timer, (ms)); \ -+ } while(0) -+ -+#define rtw_mlme_set_auto_scan_int(adapter, ms) \ -+ do { \ -+ adapter->mlmepriv.auto_scan_int_ms = ms; \ -+ } while (0) -+ -+void rtw_mlme_reset_auto_scan_int(_adapter *adapter); -+ +#ifdef CONFIG_AP_MODE + +struct hostapd_priv @@ -331199,8 +147780,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 +#ifdef CONFIG_HOSTAPD_MLME + struct net_device *pmgnt_netdev; + struct usb_anchor anchored; -+#endif -+ ++#endif ++ +}; + +extern int hostapd_mode_init(_adapter *padapter); @@ -331216,12 +147797,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 +extern void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf); +extern void rtw_atimdone_event_callback(_adapter *adapter, u8 *pbuf); +extern void rtw_cpwm_event_callback(_adapter *adapter, u8 *pbuf); -+extern void rtw_wmm_event_callback(PADAPTER padapter, u8 *pbuf); -+#ifdef CONFIG_IEEE80211W -+void rtw_sta_timeout_event_callback(_adapter *adapter, u8 *pbuf); -+#endif /* CONFIG_IEEE80211W */ -+extern void rtw_join_timeout_handler(RTW_TIMER_HDL_ARGS); -+extern void _rtw_scan_timeout_handler(RTW_TIMER_HDL_ARGS); ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++void rtw_join_timeout_handler(void *FunctionContext); ++void _rtw_scan_timeout_handler(RTW_TIMER_HDL_ARGS); ++#else ++void rtw_join_timeout_handler(struct timer_list *t); ++void _rtw_scan_timeout_handler(struct timer_list *t); ++#endif + +thread_return event_thread(thread_context context); + @@ -331232,7 +147815,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + + +extern sint rtw_select_and_join_from_scanned_queue(struct mlme_priv *pmlmepriv); -+extern sint rtw_set_key(_adapter *adapter,struct security_priv *psecuritypriv,sint keyid, u8 set_tx, bool enqueue); ++extern sint rtw_set_key(_adapter *adapter,struct security_priv *psecuritypriv,sint keyid, u8 set_tx); +extern sint rtw_set_auth(_adapter *adapter,struct security_priv *psecuritypriv); + +__inline static u8 *get_bssid(struct mlme_priv *pmlmepriv) @@ -331244,9 +147827,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 +__inline static sint check_fwstate(struct mlme_priv *pmlmepriv, sint state) +{ + if (pmlmepriv->fw_state & state) -+ return _TRUE; ++ return true; + -+ return _FALSE; ++ return false; +} + +__inline static sint get_fwstate(struct mlme_priv *pmlmepriv) @@ -331266,7 +147849,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + pmlmepriv->fw_state |= state; + //FOR HW integration + if(_FW_UNDER_SURVEY==state){ -+ pmlmepriv->bScanInProcess = _TRUE; ++ pmlmepriv->bScanInProcess = true; + } +} + @@ -331275,7 +147858,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + pmlmepriv->fw_state &= ~state; + //FOR HW integration + if(_FW_UNDER_SURVEY==state){ -+ pmlmepriv->bScanInProcess = _FALSE; ++ pmlmepriv->bScanInProcess = false; + } +} + @@ -331288,6 +147871,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 + _irqL irqL; + + _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ if (check_fwstate(pmlmepriv, state) == true) ++ pmlmepriv->fw_state ^= state; ++ _exit_critical_bh(&pmlmepriv->lock, &irqL); ++} ++ ++__inline static void clr_fwstate_ex(struct mlme_priv *pmlmepriv, sint state) ++{ ++ _irqL irqL; ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); + _clr_fwstate_(pmlmepriv, state); + _exit_critical_bh(&pmlmepriv->lock, &irqL); +} @@ -331304,7 +147897,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 +#ifdef CONFIG_CONCURRENT_MODE +sint rtw_buddy_adapter_up(_adapter *padapter); +sint check_buddy_fwstate(_adapter *padapter, sint state); -+u8 rtw_get_buddy_bBusyTraffic(_adapter *padapter); +#endif //CONFIG_CONCURRENT_MODE + +__inline static void down_scanned_network(struct mlme_priv *pmlmepriv) @@ -331331,18 +147923,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 +extern void rtw_generate_random_ibss(u8 *pibss); +extern struct wlan_network* rtw_find_network(_queue *scanned_queue, u8 *addr); +extern struct wlan_network* rtw_get_oldest_wlan_network(_queue *scanned_queue); -+struct wlan_network *_rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network); -+struct wlan_network *rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network); + +extern void rtw_free_assoc_resources(_adapter* adapter, int lock_scanned_queue); +extern void rtw_indicate_disconnect(_adapter* adapter); +extern void rtw_indicate_connect(_adapter* adapter); +void rtw_indicate_scan_done( _adapter *padapter, bool aborted); -+ -+void rtw_drv_scan_by_self(_adapter *padapter); -+void rtw_scan_wait_completed(_adapter *adapter); -+u32 rtw_scan_abort_timeout(_adapter *adapter, u32 timeout_ms); -+void rtw_scan_abort_no_wait(_adapter *adapter); +void rtw_scan_abort(_adapter *adapter); + +extern int rtw_restruct_sec_ie(_adapter *adapter,u8 *in_ie,u8 *out_ie,uint in_len); @@ -331363,7 +147948,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 +void rtw_set_scan_deny_timer_hdl(_adapter *adapter); +void rtw_set_scan_deny(_adapter *adapter, u32 ms); +#else -+#define rtw_is_scan_deny(adapter) _FALSE ++#define rtw_is_scan_deny(adapter) false +#define rtw_clear_scan_deny(adapter) do {} while (0) +#define rtw_set_scan_deny_timer_hdl(adapter) do {} while (0) +#define rtw_set_scan_deny(adapter, ms) do {} while (0) @@ -331403,56 +147988,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 +void rtw_joinbss_reset(_adapter *padapter); + +#ifdef CONFIG_80211N_HT -+void rtw_ht_use_default_setting(_adapter *padapter); -+void rtw_build_wmm_ie_ht(_adapter *padapter, u8 *out_ie, uint *pout_len); -+unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len, u8 channel); ++unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len); +void rtw_update_ht_cap(_adapter *padapter, u8 *pie, uint ie_len, u8 channel); +void rtw_issue_addbareq_cmd(_adapter *padapter, struct xmit_frame *pxmitframe); -+void rtw_append_exented_cap(_adapter *padapter, u8 *out_ie, uint *pout_len); +#endif + +int rtw_is_same_ibss(_adapter *adapter, struct wlan_network *pnetwork); -+int is_same_network(WLAN_BSSID_EX *src, WLAN_BSSID_EX *dst, u8 feature); ++int is_same_network(WLAN_BSSID_EX *src, WLAN_BSSID_EX *dst); + +#ifdef CONFIG_LAYER2_ROAMING -+#define rtw_roam_flags(adapter) ((adapter)->mlmepriv.roam_flags) -+#define rtw_chk_roam_flags(adapter, flags) ((adapter)->mlmepriv.roam_flags & flags) -+#define rtw_clr_roam_flags(adapter, flags) \ -+ do { \ -+ ((adapter)->mlmepriv.roam_flags &= ~flags); \ -+ } while (0) -+ -+#define rtw_set_roam_flags(adapter, flags) \ -+ do { \ -+ ((adapter)->mlmepriv.roam_flags |= flags); \ -+ } while (0) -+ -+#define rtw_assign_roam_flags(adapter, flags) \ -+ do { \ -+ ((adapter)->mlmepriv.roam_flags = flags); \ -+ } while (0) -+ +void _rtw_roaming(_adapter *adapter, struct wlan_network *tgt_network); +void rtw_roaming(_adapter *adapter, struct wlan_network *tgt_network); -+void rtw_set_to_roam(_adapter *adapter, u8 to_roam); -+u8 rtw_dec_to_roam(_adapter *adapter); -+u8 rtw_to_roam(_adapter *adapter); -+int rtw_select_roaming_candidate(struct mlme_priv *pmlmepriv); ++void rtw_set_roaming(_adapter *adapter, u8 to_roaming); ++u8 rtw_to_roaming(_adapter *adapter); +#else -+#define rtw_roam_flags(adapter) 0 -+#define rtw_chk_roam_flags(adapter, flags) 0 -+#define rtw_clr_roam_flags(adapter, flags) do {} while (0) -+#define rtw_set_roam_flags(adapter, flags) do {} while (0) -+#define rtw_assign_roam_flags(adapter, flags) do {} while (0) +#define _rtw_roaming(adapter, tgt_network) do {} while(0) +#define rtw_roaming(adapter, tgt_network) do {} while(0) -+#define rtw_set_to_roam(adapter, to_roam) do {} while(0) -+#define rtw_dec_to_roam(adapter) 0 -+#define rtw_to_roam(adapter) 0 -+#define rtw_select_roaming_candidate(mlme) _FAIL -+#endif /* CONFIG_LAYER2_ROAMING */ ++#define rtw_set_roaming(adapter, to_roaming) do {} while(0) ++#define rtw_to_roaming(adapter) 0 ++#endif + -+void rtw_sta_media_status_rpt(_adapter *adapter,struct sta_info *psta, u32 mstatus); ++void rtw_stassoc_hw_rpt(_adapter *adapter,struct sta_info *psta); + +#ifdef CONFIG_INTEL_PROXIM +void rtw_proxim_enable(_adapter *padapter); @@ -331460,15 +148016,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mlme.h linux/3rdparty/rtl881 +void rtw_proxim_send_packet(_adapter *padapter,u8 *pbuf,u16 len,u8 hw_rate); +#endif //CONFIG_INTEL_PROXIM +#endif //__RTL871X_MLME_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812au/include/rtw_mp.h ---- linux.old/3rdparty/rtl8812au/include/rtw_mp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_mp.h 2017-06-07 23:07:21.043690492 +0300 -@@ -0,0 +1,860 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_mp.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mp.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_mp.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mp.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,591 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -331478,54 +148033,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef _RTW_MP_H_ +#define _RTW_MP_H_ + -+#define RTWPRIV_VER_INFO 1 -+ -+#define MAX_MP_XMITBUF_SZ 2048 ++#define MAX_MP_XMITBUF_SZ 2048 +#define NR_MP_XMITFRAME 8 + +struct mp_xmit_frame +{ + _list list; -+ + struct pkt_attrib attrib; -+ + _pkt *pkt; -+ + int frame_tag; -+ + _adapter *padapter; + -+#ifdef CONFIG_USB_HCI -+ + //insert urb, irp, and irpcnt info below... -+ //max frag_cnt = 8 -+ + u8 *mem_addr; + u32 sz[8]; + -+#if defined(PLATFORM_OS_XP) || defined(PLATFORM_LINUX) + PURB pxmit_urb[8]; -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ PIRP pxmit_irp[8]; -+#endif + + u8 bpending[8]; + sint ac_tag[8]; + sint last[8]; + uint irpcnt; + uint fragcnt; -+#endif /* CONFIG_USB_HCI */ + + uint mem[(MAX_MP_XMITBUF_SZ >> 2)]; +}; @@ -331540,31 +148073,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a + +typedef void(*wi_act_func)(void* padapter); + -+#ifdef PLATFORM_WINDOWS -+struct mp_wi_cntx -+{ -+ u8 bmpdrv_unload; -+ -+ // Work Item -+ NDIS_WORK_ITEM mp_wi; -+ NDIS_EVENT mp_wi_evt; -+ _lock mp_wi_lock; -+ u8 bmp_wi_progress; -+ wi_act_func curractfunc; -+ // Variable needed in each implementation of CurrActFunc. -+ struct mp_wiparam param; -+}; -+#endif -+ +struct mp_tx +{ + u8 stop; + u32 count, sended; + u8 payload; + struct pkt_attrib attrib; -+ //struct tx_desc desc; -+ //u8 resvdtx[7]; -+ u8 desc[TXDESC_SIZE]; ++ struct tx_desc desc; ++ u8 resvdtx[7]; + u8 *pallocated_buf; + u8 *buf; + u32 buf_size, write_size; @@ -331578,54 +148094,52 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a +#define u4Byte u32 +#define s4Byte s32 +#define u1Byte u8 -+#define pu1Byte u8* ++#define pu1Byte u8* + +#define u2Byte u16 -+#define pu2Byte u16* ++#define pu2Byte u16* + +#define u4Byte u32 -+#define pu4Byte u32* ++#define pu4Byte u32* + +#define u8Byte u64 -+#define pu8Byte u64* ++#define pu8Byte u64* + +#define s1Byte s8 -+#define ps1Byte s8* ++#define ps1Byte s8* + +#define s2Byte s16 -+#define ps2Byte s16* ++#define ps2Byte s16* + +#define s4Byte s32 -+#define ps4Byte s32* ++#define ps4Byte s32* + +#define s8Byte s64 -+#define ps8Byte s64* ++#define ps8Byte s64* + -+#define UCHAR u8 -+#define USHORT u16 -+#define UINT u32 -+#define ULONG u32 -+#define PULONG u32* ++#define u8 u8 ++#define u16 u16 ++#define u32 u32 ++#define u32 u32 ++#define Pu32 u32* + -+ -+ -+typedef VOID (*MPT_WORK_ITEM_HANDLER)(IN PVOID Adapter); ++typedef void (*MPT_WORK_ITEM_HANDLER)(void * Adapter); +typedef struct _MPT_CONTEXT +{ + // Indicate if we have started Mass Production Test. -+ BOOLEAN bMassProdTest; ++ bool bMassProdTest; + + // Indicate if the driver is unloading or unloaded. -+ BOOLEAN bMptDrvUnload; ++ bool bMptDrvUnload; + + _sema MPh2c_Sema; + _timer MPh2c_timeout_timer; +// Event used to sync H2c for BT control + -+ BOOLEAN MptH2cRspEvent; -+ BOOLEAN MptBtC2hEvent; -+ BOOLEAN bMPh2c_timeout; -+ ++ bool MptH2cRspEvent; ++ bool MptBtC2hEvent; ++ bool bMPh2c_timeout; ++ + /* 8190 PCI does not support NDIS_WORK_ITEM. */ + // Work Item for Mass Production Test. + //NDIS_WORK_ITEM MptWorkItem; @@ -331635,58 +148149,58 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a + // To protect the following variables. +// NDIS_SPIN_LOCK MptWorkItemSpinLock; + // Indicate a MptWorkItem is scheduled and not yet finished. -+ BOOLEAN bMptWorkItemInProgress; ++ bool bMptWorkItemInProgress; + // An instance which implements function and context of MptWorkItem. + MPT_WORK_ITEM_HANDLER CurrMptAct; + + // 1=Start, 0=Stop from UI. -+ ULONG MptTestStart; ++ u32 MptTestStart; + // _TEST_MODE, defined in MPT_Req2.h -+ ULONG MptTestItem; ++ u32 MptTestItem; + // Variable needed in each implementation of CurrMptAct. -+ ULONG MptActType; // Type of action performed in CurrMptAct. ++ u32 MptActType; // Type of action performed in CurrMptAct. + // The Offset of IO operation is depend of MptActType. -+ ULONG MptIoOffset; ++ u32 MptIoOffset; + // The Value of IO operation is depend of MptActType. -+ ULONG MptIoValue; ++ u32 MptIoValue; + // The RfPath of IO operation is depend of MptActType. -+ ULONG MptRfPath; ++ u32 MptRfPath; + + WIRELESS_MODE MptWirelessModeToSw; // Wireless mode to switch. -+ u8 MptChannelToSw; // Channel to switch. -+ u8 MptInitGainToSet; // Initial gain to set. -+ //ULONG bMptAntennaA; // TRUE if we want to use antenna A. -+ ULONG MptBandWidth; // bandwidth to switch. -+ ULONG MptRateIndex; // rate index. ++ u8 MptChannelToSw; // Channel to switch. ++ u8 MptInitGainToSet; // Initial gain to set. ++ //u32 bMptAntennaA; // TRUE if we want to use antenna A. ++ u32 MptBandWidth; // bandwidth to switch. ++ u32 MptRateIndex; // rate index. + // Register value kept for Single Carrier Tx test. + u8 btMpCckTxPower; + // Register value kept for Single Carrier Tx test. + u8 btMpOfdmTxPower; + // For MP Tx Power index -+ u8 TxPwrLevel[4]; /* rf-A, rf-B*/ ++ u8 TxPwrLevel[2]; // rf-A, rf-B + u32 RegTxPwrLimit; + // Content of RCR Regsiter for Mass Production Test. -+ ULONG MptRCR; ++ u32 MptRCR; + // TRUE if we only receive packets with specific pattern. -+ BOOLEAN bMptFilterPattern; -+ // Rx OK count, statistics used in Mass Production Test. -+ ULONG MptRxOkCnt; -+ // Rx CRC32 error count, statistics used in Mass Production Test. -+ ULONG MptRxCrcErrCnt; ++ bool bMptFilterPattern; ++ // Rx OK count, statistics used in Mass Production Test. ++ u32 MptRxOkCnt; ++ // Rx CRC32 error count, statistics used in Mass Production Test. ++ u32 MptRxCrcErrCnt; + -+ BOOLEAN bCckContTx; // TRUE if we are in CCK Continuous Tx test. -+ BOOLEAN bOfdmContTx; // TRUE if we are in OFDM Continuous Tx test. -+ BOOLEAN bStartContTx; // TRUE if we have start Continuous Tx test. ++ bool bCckContTx; // TRUE if we are in CCK Continuous Tx test. ++ bool bOfdmContTx; // TRUE if we are in OFDM Continuous Tx test. ++ bool bStartContTx; // TRUE if we have start Continuous Tx test. + // TRUE if we are in Single Carrier Tx test. -+ BOOLEAN bSingleCarrier; ++ bool bSingleCarrier; + // TRUE if we are in Carrier Suppression Tx Test. -+ BOOLEAN bCarrierSuppression; ++ bool bCarrierSuppression; + //TRUE if we are in Single Tone Tx test. -+ BOOLEAN bSingleTone; ++ bool bSingleTone; + + // ACK counter asked by K.Y.. -+ BOOLEAN bMptEnableAckCounter; -+ ULONG MptAckCounter; ++ bool bMptEnableAckCounter; ++ u32 MptAckCounter; + + // SD3 Willis For 8192S to save 1T/2T RF table for ACUT Only fro ACUT delete later ~~~! + //s1Byte BufOfLines[2][MAX_LINES_HWCONFIG_TXT][MAX_BYTES_LINE_HWCONFIG_TXT]; @@ -331694,61 +148208,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a + //s4Byte RfReadLine[2]; + + u8 APK_bound[2]; //for APK path A/path B -+ BOOLEAN bMptIndexEven; ++ bool bMptIndexEven; + + u8 backup0xc50; + u8 backup0xc58; + u8 backup0xc30; -+ u8 backup0x52_RF_A; -+ u8 backup0x52_RF_B; -+ -+ u4Byte backup0x58_RF_A; -+ u4Byte backup0x58_RF_B; -+ ++ u8 backup0x52_RF_A; ++ u8 backup0x52_RF_B; ++ + u1Byte h2cReqNum; -+ u1Byte c2hBuf[32]; ++ u1Byte c2hBuf[20]; + + u1Byte btInBuf[100]; -+ ULONG mptOutLen; ++ u32 mptOutLen; + u1Byte mptOutBuf[100]; -+ ++ +}MPT_CONTEXT, *PMPT_CONTEXT; +//#endif + +/* E-Fuse */ -+#ifdef CONFIG_RTL8188E +#define EFUSE_MAP_SIZE 512 -+#endif -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) -+#define EFUSE_MAP_SIZE 512 -+#endif -+#ifdef CONFIG_RTL8192E -+#define EFUSE_MAP_SIZE 512 -+#endif -+#ifdef CONFIG_RTL8723B -+#define EFUSE_MAP_SIZE 512 -+#endif -+#ifdef CONFIG_RTL8814A -+#define EFUSE_MAP_SIZE 512 -+#endif -+#ifdef CONFIG_RTL8703B -+#define EFUSE_MAP_SIZE 512 -+#endif -+#ifdef CONFIG_RTL8188F -+#define EFUSE_MAP_SIZE 512 -+#endif + -+#if defined(CONFIG_RTL8814A) +#define EFUSE_MAX_SIZE 1024 -+#elif defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8703B) -+#define EFUSE_MAX_SIZE 256 -+#else -+#define EFUSE_MAX_SIZE 512 -+#endif +/* end of E-Fuse */ + -+//#define RTPRIV_IOCTL_MP ( SIOCIWFIRSTPRIV + 0x17) -+enum { ++//#define RTPRIV_IOCTL_MP ( SIOCIWFIRSTPRIV + 0x17) ++enum { + WRITE_REG = 1, + READ_REG, + WRITE_RF, @@ -331777,26 +148262,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a + MP_QueryDrvStats, + MP_SetBT, + CTA_TEST, -+ MP_DISABLE_BT_COEXIST, -+ MP_PwrCtlDM, -+ MP_GETVER, -+ MP_MON, -+ EFUSE_MASK, -+ EFUSE_FILE, -+ MP_TX, -+ MP_RX, -+#ifdef CONFIG_WOWLAN -+ MP_WOW_ENABLE, -+ MP_WOW_SET_PATTERN, -+#endif -+#ifdef CONFIG_AP_WOWLAN -+ MP_AP_WOW_ENABLE, -+#endif + MP_NULL, + MP_GET_TXPOWER_INX, -+ -+ MP_SD_IREAD, -+ MP_SD_IWRITE, +}; + +struct mp_priv @@ -331815,16 +148282,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a + //Tx Section + u8 TID; + u32 tx_pktcount; -+ u32 pktInterval; + struct mp_tx tx; + + //Rx Section -+ u32 rx_bssidpktcount; + u32 rx_pktcount; -+ u32 rx_pktcount_filter_out; + u32 rx_crcerrpktcount; + u32 rx_pktloss; -+ BOOLEAN rx_bindicatePkt; ++ + struct recv_stat rxstat; + + //RF/BB relative @@ -331832,6 +148296,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a + u8 bandwidth; + u8 prime_channel_offset; + u8 txpoweridx; ++ u8 txpoweridx_b; + u8 rateidx; + u32 preamble; +// u8 modem; @@ -331841,53 +148306,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a + u16 antenna_tx; + u16 antenna_rx; +// u8 curr_rfpath; -+ ++ + u8 check_mp_pkt; + + u8 bSetTxPower; +// uint ForcedDataRate; -+ u8 mp_dm; -+ u8 mac_filter[ETH_ALEN]; -+ u8 bmac_filter; -+ ++ + struct wlan_network mp_network; + NDIS_802_11_MAC_ADDRESS network_macaddr; + -+#ifdef PLATFORM_WINDOWS -+ u32 rx_testcnt; -+ u32 rx_testcnt1; -+ u32 rx_testcnt2; -+ u32 tx_testcnt; -+ u32 tx_testcnt1; -+ -+ struct mp_wi_cntx wi_cntx; -+ -+ u8 h2c_result; -+ u8 h2c_seqnum; -+ u16 h2c_cmdcode; -+ u8 h2c_resp_parambuf[512]; -+ _lock h2c_lock; -+ _lock wkitm_lock; -+ u32 h2c_cmdcnt; -+ NDIS_EVENT h2c_cmd_evt; -+ NDIS_EVENT c2h_set; -+ NDIS_EVENT h2c_clr; -+ NDIS_EVENT cpwm_int; -+ -+ NDIS_EVENT scsir_full_evt; -+ NDIS_EVENT scsiw_empty_evt; -+#endif -+ + u8 *pallocated_mp_xmitframe_buf; + u8 *pmp_xmtframe_buf; + _queue free_mp_xmitqueue; + u32 free_mp_xmitframe_cnt; -+ BOOLEAN bSetRxBssid; -+ BOOLEAN bTxBufCkFail; -+ BOOLEAN bRTWSmbCfg; -+ MPT_CONTEXT MptCtx; + -+ u8 *TXradomBuffer; ++ MPT_CONTEXT MptCtx; +}; + +typedef struct _IOCMD_STRUCT_ { @@ -331906,24 +148339,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a + u32 offset; + u32 value; +}; -+ -+typedef struct _MP_FIRMWARE { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8* szFwBuffer; -+#else -+ u8 szFwBuffer[0x8000]; -+#endif -+ u32 ulFwLength; -+} RT_MP_FIRMWARE, *PRT_MP_FIRMWARE; -+ -+ -+ -+ +//======================================================================= + -+#define LOWER _TRUE -+#define RAISE _FALSE ++#define LOWER true ++#define RAISE false + +/* Hardware Registers */ +#if 0 @@ -331962,20 +148381,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a + MP_PACKET_RX +} MP_MODE; + -+typedef enum _MPT_BANDWIDTH { -+ MPT_BW_20MHZ = 0, -+ MPT_BW_40MHZ_DUPLICATE = 1, -+ MPT_BW_40MHZ_ABOVE = 2, -+ MPT_BW_40MHZ_BELOW = 3, -+ MPT_BW_40MHZ = 4, -+ MPT_BW_80MHZ = 5, -+ MPT_BW_80MHZ_20_ABOVE = 6, -+ MPT_BW_80MHZ_20_BELOW = 7, -+ MPT_BW_80MHZ_20_BOTTOM = 8, -+ MPT_BW_80MHZ_20_TOP = 9, -+ MPT_BW_80MHZ_40_ABOVE = 10, -+ MPT_BW_80MHZ_40_BELOW = 11, -+} MPT_BANDWIDTHE, *PMPT_BANDWIDTH; + +#define MAX_RF_PATH_NUMS RF_PATH_MAX + @@ -331986,7 +148391,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a +typedef enum _MPT_RATE_INDEX +{ + /* CCK rate. */ -+ MPT_RATE_1M =0 , /* 0 */ ++ MPT_RATE_1M =1 , /* 0 */ + MPT_RATE_2M, + MPT_RATE_55M, + MPT_RATE_11M, /* 3 */ @@ -332018,63 +148423,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a + MPT_RATE_MCS13, + MPT_RATE_MCS14, + MPT_RATE_MCS15, /* 27 */ -+ MPT_RATE_MCS16, -+ MPT_RATE_MCS17, // #29 -+ MPT_RATE_MCS18, -+ MPT_RATE_MCS19, -+ MPT_RATE_MCS20, -+ MPT_RATE_MCS21, -+ MPT_RATE_MCS22, // #34 -+ MPT_RATE_MCS23, -+ MPT_RATE_MCS24, -+ MPT_RATE_MCS25, -+ MPT_RATE_MCS26, -+ MPT_RATE_MCS27, // #39 -+ MPT_RATE_MCS28, // #40 -+ MPT_RATE_MCS29, // #41 -+ MPT_RATE_MCS30, // #42 -+ MPT_RATE_MCS31, // #43 + /* VHT rate. Total: 20*/ -+ MPT_RATE_VHT1SS_MCS0,// #44 -+ MPT_RATE_VHT1SS_MCS1, // # ++ MPT_RATE_VHT1SS_MCS0 = 100,// To reserve MCS16~MCS31, the index starts from #100. ++ MPT_RATE_VHT1SS_MCS1, // #101 + MPT_RATE_VHT1SS_MCS2, + MPT_RATE_VHT1SS_MCS3, + MPT_RATE_VHT1SS_MCS4, + MPT_RATE_VHT1SS_MCS5, -+ MPT_RATE_VHT1SS_MCS6, // # ++ MPT_RATE_VHT1SS_MCS6, // #106 + MPT_RATE_VHT1SS_MCS7, + MPT_RATE_VHT1SS_MCS8, -+ MPT_RATE_VHT1SS_MCS9, //#53 -+ MPT_RATE_VHT2SS_MCS0, //#54 -+ MPT_RATE_VHT2SS_MCS1, ++ MPT_RATE_VHT1SS_MCS9, ++ MPT_RATE_VHT2SS_MCS0, ++ MPT_RATE_VHT2SS_MCS1, // #111 + MPT_RATE_VHT2SS_MCS2, + MPT_RATE_VHT2SS_MCS3, + MPT_RATE_VHT2SS_MCS4, + MPT_RATE_VHT2SS_MCS5, -+ MPT_RATE_VHT2SS_MCS6, ++ MPT_RATE_VHT2SS_MCS6, // #116 + MPT_RATE_VHT2SS_MCS7, + MPT_RATE_VHT2SS_MCS8, -+ MPT_RATE_VHT2SS_MCS9, //#63 -+ MPT_RATE_VHT3SS_MCS0, -+ MPT_RATE_VHT3SS_MCS1, -+ MPT_RATE_VHT3SS_MCS2, -+ MPT_RATE_VHT3SS_MCS3, -+ MPT_RATE_VHT3SS_MCS4, -+ MPT_RATE_VHT3SS_MCS5, -+ MPT_RATE_VHT3SS_MCS6, // #126 -+ MPT_RATE_VHT3SS_MCS7, -+ MPT_RATE_VHT3SS_MCS8, -+ MPT_RATE_VHT3SS_MCS9, -+ MPT_RATE_VHT4SS_MCS0, -+ MPT_RATE_VHT4SS_MCS1, // #131 -+ MPT_RATE_VHT4SS_MCS2, -+ MPT_RATE_VHT4SS_MCS3, -+ MPT_RATE_VHT4SS_MCS4, -+ MPT_RATE_VHT4SS_MCS5, -+ MPT_RATE_VHT4SS_MCS6, // #136 -+ MPT_RATE_VHT4SS_MCS7, -+ MPT_RATE_VHT4SS_MCS8, -+ MPT_RATE_VHT4SS_MCS9, ++ MPT_RATE_VHT2SS_MCS9, + MPT_RATE_LAST +}MPT_RATE_E, *PMPT_RATE_E; + @@ -332087,10 +148456,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a + +// The following enumeration is used to define the value of Reg0xD00[30:28] or JaguarReg0x914[18:16]. +typedef enum _OFDM_TX_MODE { -+ OFDM_ALL_OFF = 0, ++ OFDM_ALL_OFF = 0, + OFDM_ContinuousTx = 1, + OFDM_SingleCarrier = 2, -+ OFDM_SingleTone = 4, ++ OFDM_SingleTone = 4, +} OFDM_TX_MODE; + + @@ -332098,16 +148467,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a +#define RX_PKT_DEST_ADDR 2 +#define RX_PKT_PHY_MATCH 3 + -+#define Mac_OFDM_OK 0x00000000 -+#define Mac_OFDM_Fail 0x10000000 -+#define Mac_OFDM_FasleAlarm 0x20000000 -+#define Mac_CCK_OK 0x30000000 -+#define Mac_CCK_Fail 0x40000000 -+#define Mac_CCK_FasleAlarm 0x50000000 -+#define Mac_HT_OK 0x60000000 -+#define Mac_HT_Fail 0x70000000 -+#define Mac_HT_FasleAlarm 0x90000000 -+#define Mac_DropPacket 0xA0000000 ++#if 0 ++#define RPTMaxCount 0x000FFFFF; ++ ++// parameter 1 : BitMask ++// bit 0 : OFDM PPDU ++// bit 1 : OFDM False Alarm ++// bit 2 : OFDM MPDU OK ++// bit 3 : OFDM MPDU Fail ++// bit 4 : CCK PPDU ++// bit 5 : CCK False Alarm ++// bit 6 : CCK MPDU ok ++// bit 7 : CCK MPDU fail ++// bit 8 : HT PPDU counter ++// bit 9 : HT false alarm ++// bit 10 : HT MPDU total ++// bit 11 : HT MPDU OK ++// bit 12 : HT MPDU fail ++// bit 15 : RX full drop ++typedef enum _RXPHY_BITMASK_ ++{ ++ OFDM_PPDU_BIT = 0, ++ OFDMfalse_BIT, ++ OFDM_MPDU_OK_BIT, ++ OFDM_MPDU_FAIL_BIT, ++ CCK_PPDU_BIT, ++ CCKfalse_BIT, ++ CCK_MPDU_OK_BIT, ++ CCK_MPDU_FAIL_BIT, ++ HT_PPDU_BIT, ++ HTfalse_BIT, ++ HT_MPDU_BIT, ++ HT_MPDU_OK_BIT, ++ HT_MPDU_FAIL_BIT, ++} RXPHY_BITMASK; ++#endif + +typedef enum _ENCRY_CTRL_STATE_ { + HW_CONTROL, //hw encryption& decryption @@ -332116,28 +148510,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a + SW_ENCRY_HW_DECRY //sw encryption & hw decryption +}ENCRY_CTRL_STATE; + -+typedef enum _MPT_TXPWR_DEF{ -+ MPT_CCK, -+ MPT_OFDM, // L and HT OFDM -+ MPT_OFDM_AND_HT, -+ MPT_HT, -+ MPT_VHT -+}MPT_TXPWR_DEF; -+ -+#ifdef CONFIG_RF_GAIN_OFFSET -+ -+#if defined(CONFIG_RTL8723B) -+ #define REG_RF_BB_GAIN_OFFSET 0x7f -+ #define RF_GAIN_OFFSET_MASK 0xfffff -+#elif defined(CONFIG_RTL8188E) -+ #define REG_RF_BB_GAIN_OFFSET 0x55 -+ #define RF_GAIN_OFFSET_MASK 0xfffff -+#else -+ #define REG_RF_BB_GAIN_OFFSET 0x55 -+ #define RF_GAIN_OFFSET_MASK 0xfffff -+#endif //CONFIG_RTL8723B -+ -+#endif //CONFIG_RF_GAIN_OFFSET + +//======================================================================= +//extern struct mp_xmit_frame *alloc_mp_xmitframe(struct mp_priv *pmp_priv); @@ -332150,6 +148522,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a +extern s32 mp_start_test(PADAPTER padapter); +extern void mp_stop_test(PADAPTER padapter); + ++//======================================================================= ++//extern void IQCalibrateBcut(PADAPTER pAdapter); ++ ++//extern u32 bb_reg_read(PADAPTER Adapter, u16 offset); ++//extern u8 bb_reg_write(PADAPTER Adapter, u16 offset, u32 value); ++//extern u32 rf_reg_read(PADAPTER Adapter, u8 path, u8 offset); ++//extern u8 rf_reg_write(PADAPTER Adapter, u8 path, u8 offset, u32 value); ++ ++//extern u32 get_bb_reg(PADAPTER Adapter, u16 offset, u32 bitmask); ++//extern u8 set_bb_reg(PADAPTER Adapter, u16 offset, u32 bitmask, u32 value); ++//extern u32 get_rf_reg(PADAPTER Adapter, u8 path, u8 offset, u32 bitmask); ++//extern u8 set_rf_reg(PADAPTER Adapter, u8 path, u8 offset, u32 bitmask, u32 value); ++ +extern u32 _read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask); +extern void _write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask, u32 val); + @@ -332160,179 +148545,80 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp.h linux/3rdparty/rtl8812a +extern u32 read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr); +extern void write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 val); + -+void SetChannel(PADAPTER pAdapter); -+void SetBandwidth(PADAPTER pAdapter); -+int SetTxPower(PADAPTER pAdapter); -+void SetAntenna(PADAPTER pAdapter); -+void SetDataRate(PADAPTER pAdapter); -+void SetAntenna(PADAPTER pAdapter); -+s32 SetThermalMeter(PADAPTER pAdapter, u8 target_ther); -+void GetThermalMeter(PADAPTER pAdapter, u8 *value); -+void SetContinuousTx(PADAPTER pAdapter, u8 bStart); -+void SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart); -+void SetSingleToneTx(PADAPTER pAdapter, u8 bStart); -+void SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart); -+void PhySetTxPowerLevel(PADAPTER pAdapter); -+void fill_txdesc_for_mp(PADAPTER padapter, u8 *ptxdesc); -+void SetPacketTx(PADAPTER padapter); -+void SetPacketRx(PADAPTER pAdapter, u8 bStartRx, u8 bAB); -+void ResetPhyRxPktCount(PADAPTER pAdapter); -+u32 GetPhyRxPktReceived(PADAPTER pAdapter); -+u32 GetPhyRxPktCRC32Error(PADAPTER pAdapter); -+s32 SetPowerTracking(PADAPTER padapter, u8 enable); -+void GetPowerTracking(PADAPTER padapter, u8 *enable); -+u32 mp_query_psd(PADAPTER pAdapter, u8 *data); ++extern void SetChannel(PADAPTER pAdapter); ++extern void SetBandwidth(PADAPTER pAdapter); ++extern int SetTxPower(PADAPTER pAdapter); ++extern void SetAntennaPathPower(PADAPTER pAdapter); ++//extern void SetTxAGCOffset(PADAPTER pAdapter, u32 ulTxAGCOffset); ++extern void SetDataRate(PADAPTER pAdapter); ++ ++extern void SetAntenna(PADAPTER pAdapter); ++ ++//extern void SetCrystalCap(PADAPTER pAdapter); ++ ++extern s32 SetThermalMeter(PADAPTER pAdapter, u8 target_ther); ++extern void GetThermalMeter(PADAPTER pAdapter, u8 *value); ++ ++extern void SetContinuousTx(PADAPTER pAdapter, u8 bStart); ++extern void SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart); ++extern void SetSingleToneTx(PADAPTER pAdapter, u8 bStart); ++extern void SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart); ++extern void PhySetTxPowerLevel(PADAPTER pAdapter); ++ ++extern void fill_txdesc_for_mp(PADAPTER padapter, struct tx_desc *ptxdesc); ++extern void SetPacketTx(PADAPTER padapter); ++extern void SetPacketRx(PADAPTER pAdapter, u8 bStartRx); ++ ++extern void ResetPhyRxPktCount(PADAPTER pAdapter); ++extern u32 GetPhyRxPktReceived(PADAPTER pAdapter); ++extern u32 GetPhyRxPktCRC32Error(PADAPTER pAdapter); ++ ++extern s32 SetPowerTracking(PADAPTER padapter, u8 enable); ++extern void GetPowerTracking(PADAPTER padapter, u8 *enable); ++ ++extern u32 mp_query_psd(PADAPTER pAdapter, u8 *data); + + ++extern void Hal_SetAntenna(PADAPTER pAdapter); ++extern void Hal_SetBandwidth(PADAPTER pAdapter); + -+void hal_mpt_SwitchRfSetting(PADAPTER pAdapter); -+s32 hal_mpt_SetPowerTracking(PADAPTER padapter, u8 enable); -+void hal_mpt_GetPowerTracking(PADAPTER padapter, u8 *enable); -+void hal_mpt_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14); -+void hal_mpt_SetChannel(PADAPTER pAdapter); -+void hal_mpt_SetBandwidth(PADAPTER pAdapter); -+void hal_mpt_SetTxPower(PADAPTER pAdapter); -+void hal_mpt_SetDataRate(PADAPTER pAdapter); -+void hal_mpt_SetAntenna(PADAPTER pAdapter); -+s32 hal_mpt_SetThermalMeter(PADAPTER pAdapter, u8 target_ther); -+void hal_mpt_TriggerRFThermalMeter(PADAPTER pAdapter); -+u8 hal_mpt_ReadRFThermalMeter(PADAPTER pAdapter); -+void hal_mpt_GetThermalMeter(PADAPTER pAdapter, u8 *value); -+void hal_mpt_CCKTxPowerAdjustbyIndex(PADAPTER pAdapter, BOOLEAN beven); -+void hal_mpt_SetContinuousTx(PADAPTER pAdapter, u8 bStart); -+void hal_mpt_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart); -+void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart); -+void hal_mpt_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart); -+void hal_mpt_SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart); -+void hal_mpt_SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart); ++extern void Hal_SetTxPower(PADAPTER pAdapter); ++extern void Hal_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart); ++extern void Hal_SetSingleToneTx ( PADAPTER pAdapter , u8 bStart ); ++extern void Hal_SetSingleCarrierTx (PADAPTER pAdapter, u8 bStart); ++extern void Hal_SetContinuousTx (PADAPTER pAdapter, u8 bStart); ++extern void Hal_SetBandwidth(PADAPTER pAdapter); + -+void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter , BOOLEAN bMain); -+ULONG mpt_ProQueryCalTxPower(PADAPTER pAdapter, u8 RfPath); -+void MPT_PwrCtlDM(PADAPTER padapter, u32 bstart); -+u8 MptToMgntRate(u32 MptRateIdx); -+u8 rtw_mpRateParseFunc(PADAPTER pAdapter, u8 *targetStr); -+u32 mp_join(PADAPTER padapter, u8 mode); -+ -+int rtw_mp_write_reg(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_read_reg(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_write_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_read_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_start(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_stop(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_rate(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_channel(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_bandwidth(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_txpower_index(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_txpower(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_txpower(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_ant_tx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_ant_rx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_set_ctx_destAddr(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_ctx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_disable_bt_coexist(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_disable_bt_coexist(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_arx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_trx_query(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_pwrtrk(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_psd(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_thermal(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_reset_stats(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_dump(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_phypara(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_SetRFPath(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_QueryDrv(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_PwrCtlDM(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_getver(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_mon(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_efuse_mask_file(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_efuse_file_map(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_SetBT(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_pretx_proc(PADAPTER padapter, u8 bStartTest, char *extra); -+int rtw_mp_tx(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_rx(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); ++extern void Hal_SetDataRate(PADAPTER pAdapter); ++extern void Hal_SetChannel(PADAPTER pAdapter); ++extern void Hal_SetAntennaPathPower(PADAPTER pAdapter); ++extern s32 Hal_SetThermalMeter(PADAPTER pAdapter, u8 target_ther); ++extern s32 Hal_SetPowerTracking(PADAPTER padapter, u8 enable); ++extern void Hal_GetPowerTracking(PADAPTER padapter, u8 * enable); ++extern void Hal_GetThermalMeter(PADAPTER pAdapter, u8 *value); ++extern void Hal_mpt_SwitchRfSetting(PADAPTER pAdapter); ++extern void Hal_MPT_CCKTxPowerAdjust(PADAPTER Adapter, bool bInCH14); ++extern void Hal_MPT_CCKTxPowerAdjustbyIndex(PADAPTER pAdapter, bool beven); ++extern void Hal_SetCCKTxPower(PADAPTER pAdapter, u8 * TxPower); ++extern void Hal_SetOFDMTxPower(PADAPTER pAdapter, u8 * TxPower); ++extern void Hal_TriggerRFThermalMeter(PADAPTER pAdapter); ++extern u8 Hal_ReadRFThermalMeter(PADAPTER pAdapter); ++extern void Hal_SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart); ++extern void Hal_SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart); ++extern void Hal_ProSetCrystalCap (PADAPTER pAdapter , u32 CrystalCapVal); ++extern void _rtw_mp_xmit_priv(struct xmit_priv *pxmitpriv); ++extern void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter ,bool bMain); ++extern u32 mpt_ProQueryCalTxPower(PADAPTER pAdapter,u8 RfPath); + +#endif //_RTW_MP_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rtl8812au/include/rtw_mp_ioctl.h ---- linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_mp_ioctl.h 2017-06-07 23:07:21.043690492 +0300 -@@ -0,0 +1,591 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mp_ioctl.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_mp_ioctl.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mp_ioctl.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,555 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -332342,11 +148628,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef _RTW_MP_IOCTL_H_ +#define _RTW_MP_IOCTL_H_ @@ -332354,13 +148635,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt +#include +#include + -+#if 0 -+#define TESTFWCMDNUMBER 1000000 -+#define TEST_H2CINT_WAIT_TIME 500 -+#define TEST_C2HINT_WAIT_TIME 500 -+#define HCI_TEST_SYSCFG_HWMASK 1 -+#define _BUSCLK_40M (4 << 2) -+#endif +//------------------------------------------------------------------------------ +typedef struct CFG_DBG_MSG_STRUCT { + u32 DebugLevel; @@ -332408,128 +148682,109 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt + +//int mp_start_joinbss(_adapter *padapter, NDIS_802_11_SSID *pssid); + -+//void _irqlevel_changed_(_irqL *irqlevel, /*BOOLEAN*/unsigned char bLower); -+#ifdef PLATFORM_OS_XP -+static void _irqlevel_changed_(_irqL *irqlevel, u8 bLower) -+{ -+ -+ if (bLower == LOWER) { -+ *irqlevel = KeGetCurrentIrql(); -+ -+ if (*irqlevel > PASSIVE_LEVEL) { -+ KeLowerIrql(PASSIVE_LEVEL); -+ } -+ } else { -+ if (KeGetCurrentIrql() == PASSIVE_LEVEL) { -+ KeRaiseIrql(DISPATCH_LEVEL, irqlevel); -+ } -+ } -+ -+} -+#else ++//void _irqlevel_changed_(_irqL *irqlevel, /*bool*/unsigned char bLower); +#define _irqlevel_changed_(a,b) -+#endif + +//oid_rtl_seg_81_80_00 -+NDIS_STATUS oid_rt_pro_set_data_rate_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_start_test_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_stop_test_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_data_rate_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_start_test_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_stop_test_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv* poid_par_priv); +//oid_rtl_seg_81_80_20 -+NDIS_STATUS oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv* poid_par_priv); + -+NDIS_STATUS oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_modulation_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_modulation_hdl(struct oid_par_priv* poid_par_priv); + -+NDIS_STATUS oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv* poid_par_priv); + + +//oid_rtl_seg_81_87 -+NDIS_STATUS oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv* poid_par_priv); + -+NDIS_STATUS oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv* poid_par_priv); + + +//oid_rtl_seg_81_85 -+NDIS_STATUS oid_rt_wireless_mode_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_wireless_mode_hdl(struct oid_par_priv* poid_par_priv); + + +// oid_rtl_seg_87_11_00 -+NDIS_STATUS oid_rt_pro8711_join_bss_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_read_register_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_write_register_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_burst_read_register_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_burst_write_register_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_write_txcmd_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_write16_eeprom_hdl (struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_rd_attrib_mem_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_wr_attrib_mem_hdl (struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_poll_rx_status_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro8711_join_bss_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_read_register_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_write_register_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_burst_read_register_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_burst_write_register_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_write_txcmd_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_write16_eeprom_hdl (struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_rd_attrib_mem_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_wr_attrib_mem_hdl (struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_poll_rx_status_hdl(struct oid_par_priv* poid_par_priv); +// oid_rtl_seg_87_11_20 -+NDIS_STATUS oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_read_tssi_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_read_tssi_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv* poid_par_priv); +//oid_rtl_seg_87_11_50 -+NDIS_STATUS oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv* poid_par_priv); +//oid_rtl_seg_87_11_F0 -+NDIS_STATUS oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv* poid_par_priv); + + +//oid_rtl_seg_87_12_00 -+NDIS_STATUS oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_add_sta_info_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_add_sta_info_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv* poid_par_priv); + -+NDIS_STATUS oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv); ++uint oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv); ++uint oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv); ++uint oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv); ++uint oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv); ++uint oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv); ++uint oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv); + -+NDIS_STATUS oid_rt_set_bandwidth_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_set_crystal_cap_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_set_rx_packet_type_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_efuse_max_size_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_set_bandwidth_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_set_crystal_cap_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_set_rx_packet_type_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_efuse_max_size_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv* poid_par_priv); + -+NDIS_STATUS oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv* poid_par_priv); + -+NDIS_STATUS oid_rt_get_thermal_meter_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_thermal_meter_hdl(struct oid_par_priv* poid_par_priv); + -+NDIS_STATUS oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv* poid_par_priv); -+NDIS_STATUS oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv* poid_par_priv); + -+NDIS_STATUS oid_rt_set_power_down_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_set_power_down_hdl(struct oid_par_priv* poid_par_priv); + -+NDIS_STATUS oid_rt_get_power_mode_hdl(struct oid_par_priv* poid_par_priv); ++uint oid_rt_get_power_mode_hdl(struct oid_par_priv* poid_par_priv); + -+NDIS_STATUS oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv); ++uint oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv); + +#ifdef _RTW_MP_IOCTL_C_ + -+const struct oid_obj_priv oid_rtl_seg_81_80_00[] = ++static const struct oid_obj_priv oid_rtl_seg_81_80_00[] = +{ + {1, &oid_null_function}, //0x00 OID_RT_PRO_RESET_DUT + {1, &oid_rt_pro_set_data_rate_hdl}, //0x01 @@ -332566,7 +148821,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt + +}; + -+const struct oid_obj_priv oid_rtl_seg_81_80_20[] = ++static const struct oid_obj_priv oid_rtl_seg_81_80_20[] = +{ + {1, &oid_null_function}, //0x20 OID_RT_PRO_READ_POWER_CONTROL + {1, &oid_null_function}, //0x21 OID_RT_PRO_WRITE_EEPROM @@ -332587,7 +148842,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt + +}; + -+const struct oid_obj_priv oid_rtl_seg_81_80_40[] = ++static const struct oid_obj_priv oid_rtl_seg_81_80_40[] = +{ + {1, &oid_null_function}, //0x40 + {1, &oid_null_function}, //0x41 @@ -332597,7 +148852,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt + {1, &oid_null_function} //0x45 +}; + -+const struct oid_obj_priv oid_rtl_seg_81_80_80[] = ++static const struct oid_obj_priv oid_rtl_seg_81_80_80[] = +{ + {1, &oid_null_function}, //0x80 OID_RT_DRIVER_OPTION + {1, &oid_null_function}, //0x81 OID_RT_RF_OFF @@ -332605,12 +148860,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt + +}; + -+const struct oid_obj_priv oid_rtl_seg_81_85[] = ++static const struct oid_obj_priv oid_rtl_seg_81_85[] = +{ + {1, &oid_rt_wireless_mode_hdl} //0x00 OID_RT_WIRELESS_MODE +}; + -+struct oid_obj_priv oid_rtl_seg_81_87[] = ++static struct oid_obj_priv oid_rtl_seg_81_87[] = +{ + {1, &oid_null_function}, //0x80 OID_RT_PRO8187_WI_POLL + {1, &oid_rt_pro_write_bb_reg_hdl}, //0x81 @@ -332619,7 +148874,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt + {1, &oid_rt_pro_read_rf_reg_hdl} //0x83 +}; + -+struct oid_obj_priv oid_rtl_seg_87_11_00[] = ++static struct oid_obj_priv oid_rtl_seg_87_11_00[] = +{ + {1, &oid_rt_pro8711_join_bss_hdl}, //0x00 //S + {1, &oid_rt_pro_read_register_hdl}, //0x01 @@ -332655,7 +148910,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt + {1, &oid_rt_poll_rx_status_hdl} //0X1F +}; + -+struct oid_obj_priv oid_rtl_seg_87_11_20[] = ++static struct oid_obj_priv oid_rtl_seg_87_11_20[] = +{ + {1, &oid_rt_pro_cfg_debug_message_hdl}, //0x20 + {1, &oid_rt_pro_set_data_rate_ex_hdl}, //0x21 @@ -332665,23 +148920,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt +}; + + -+struct oid_obj_priv oid_rtl_seg_87_11_50[] = ++static struct oid_obj_priv oid_rtl_seg_87_11_50[] = +{ + {1, &oid_rt_pro_qry_pwrstate_hdl}, //0x50 + {1, &oid_rt_pro_set_pwrstate_hdl} //0x51 +}; + -+struct oid_obj_priv oid_rtl_seg_87_11_80[] = ++static struct oid_obj_priv oid_rtl_seg_87_11_80[] = +{ + {1, &oid_null_function} //0x80 +}; + -+struct oid_obj_priv oid_rtl_seg_87_11_B0[] = ++static struct oid_obj_priv oid_rtl_seg_87_11_B0[] = +{ + {1, &oid_null_function} //0xB0 +}; + -+struct oid_obj_priv oid_rtl_seg_87_11_F0[] = ++static struct oid_obj_priv oid_rtl_seg_87_11_F0[] = +{ + {1, &oid_null_function}, //0xF0 + {1, &oid_null_function}, //0xF1 @@ -332702,7 +148957,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt + +}; + -+struct oid_obj_priv oid_rtl_seg_87_12_00[]= ++static struct oid_obj_priv oid_rtl_seg_87_12_00[]= +{ + {1, &oid_rt_pro_encryption_ctrl_hdl}, //0x00 Q&S + {1, &oid_rt_pro_add_sta_info_hdl}, //0x01 S @@ -332712,7 +148967,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt + {1, &oid_rt_pro_read_efuse_hdl}, //0x05 Q OID_RT_PRO_READ_EFUSE + {1, &oid_rt_pro_write_efuse_hdl}, //0x06 S OID_RT_PRO_WRITE_EFUSE + {1, &oid_rt_pro_rw_efuse_pgpkt_hdl}, //0x07 Q,S -+ {1, &oid_rt_get_efuse_current_size_hdl}, //0x08 Q ++ {1, &oid_rt_get_efuse_current_size_hdl}, //0x08 Q + {1, &oid_rt_set_bandwidth_hdl}, //0x09 + {1, &oid_rt_set_crystal_cap_hdl}, //0x0a + {1, &oid_rt_set_rx_packet_type_hdl}, //0x0b S @@ -332851,9 +149106,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt + GEN_MP_IOCTL_SUBCODE(SET_PTM), + GEN_MP_IOCTL_SUBCODE(SET_POWER_DOWN), /*30*/ + GEN_MP_IOCTL_SUBCODE(TRIGGER_GPIO), -+ GEN_MP_IOCTL_SUBCODE(SET_DM_BT), /*32*/ -+ GEN_MP_IOCTL_SUBCODE(DEL_BA), /*33*/ -+ GEN_MP_IOCTL_SUBCODE(GET_WIFI_STATUS), /*34*/ ++ GEN_MP_IOCTL_SUBCODE(SET_DM_BT), /*35*/ ++ GEN_MP_IOCTL_SUBCODE(DEL_BA), /*36*/ ++ GEN_MP_IOCTL_SUBCODE(GET_WIFI_STATUS), /*37*/ + MAX_MP_IOCTL_SUBCODE, +}; + @@ -332867,7 +149122,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt + + +struct mp_ioctl_handler mp_ioctl_hdl[] = { -+ +/*0*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_start_test_hdl, OID_RT_PRO_START_TEST) + GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_stop_test_hdl, OID_RT_PRO_STOP_TEST) + @@ -332907,27 +149161,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux/3rdparty/rt + GEN_MP_IOCTL_HANDLER(sizeof(u8), oid_rt_pro_set_power_tracking_hdl, OID_RT_PRO_SET_POWER_TRACKING) +/*30*/ GEN_MP_IOCTL_HANDLER(sizeof(u8), oid_rt_set_power_down_hdl, OID_RT_SET_POWER_DOWN) +/*31*/ GEN_MP_IOCTL_HANDLER(0, oid_rt_pro_trigger_gpio_hdl, 0) -+ GEN_MP_IOCTL_HANDLER(0, NULL, 0) -+ GEN_MP_IOCTL_HANDLER(0, NULL, 0) -+ GEN_MP_IOCTL_HANDLER(0, NULL, 0) ++ ++ +}; + -+#else /* _RTW_MP_IOCTL_C_ */ -+ ++#else +extern struct mp_ioctl_handler mp_ioctl_hdl[]; -+ -+#endif /* _RTW_MP_IOCTL_C_ */ -+ +#endif + -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h ---- linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h 2017-06-07 23:07:21.043690492 +0300 -@@ -0,0 +1,1100 @@ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,1092 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -332937,11 +149187,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +/***************************************************************************** + * @@ -332953,18 +149198,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar + * 3. PMAC/BB register bit mask. + * 4. RF reg bit mask. + * 5. Other BB/RF relative definition. -+ * ++ * + * + * Export: Constants, macro, functions(API), global variables(None). + * -+ * Abbrev: ++ * Abbrev: + * + * History: -+ * Data Who Remark ++ * Data Who Remark + * 08/07/2007 MHC 1. Porting from 9x series PHYCFG.h. + * 2. Reorganize code architecture. + * 09/25/2008 MH 1. Add RL6052 register definition -+ * ++ * + *****************************************************************************/ +#ifndef __RTW_MP_PHY_REGDEF_H_ +#define __RTW_MP_PHY_REGDEF_H_ @@ -333037,8 +149282,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar + +#define rFPGA0_RFTiming1 0x810 // Useless now +#define rFPGA0_RFTiming2 0x814 -+//#define rFPGA0_XC_RFTiming 0x818 -+//#define rFPGA0_XD_RFTiming 0x81c ++//#define rFPGA0_XC_RFTiming 0x818 ++//#define rFPGA0_XD_RFTiming 0x81c + +#define rFPGA0_XA_HSSIParameter1 0x820 // RF 3 wire register +#define rFPGA0_XA_HSSIParameter2 0x824 @@ -333092,7 +149337,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define rFPGA1_TxBlock 0x904 // Useless now +#define rFPGA1_DebugSelect 0x908 // Useless now +#define rFPGA1_TxInfo 0x90c // Useless now // Status report?? -+#define rS0S1_PathSwitch 0x948 + +// +// 5. PageA(0xA00) @@ -333103,8 +149347,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define rCCK0_AFESetting 0xa04 // Disable init gain now // Select RX path by RSSI +#define rCCK0_CCA 0xa08 // Disable init gain now // Init gain + -+#define rCCK0_RxAGC1 0xa0c //AGC default value, saturation level // Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series -+#define rCCK0_RxAGC2 0xa10 //AGC & DAGC ++#define rCCK0_RxAGC1 0xa0c //AGC default value, saturation level // Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series ++#define rCCK0_RxAGC2 0xa10 //AGC & DAGC + +#define rCCK0_RxHP 0xa14 + @@ -333115,10 +149359,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define rCCK0_TxFilter2 0xa24 +#define rCCK0_DebugPort 0xa28 //debug port and Tx filter3 +#define rCCK0_FalseAlarmReport 0xa2c //0xa2d useless now 0xa30-a4f channel report -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 //0xa57 -+#define rCCK0_FACounterLower 0xa5c //0xa5b -+#define rCCK0_FACounterUpper 0xa58 //0xa5c ++#define rCCK0_TRSSIReport 0xa50 ++#define rCCK0_RxReport 0xa54 //0xa57 ++#define rCCK0_FACounterLower 0xa5c //0xa5b ++#define rCCK0_FACounterUpper 0xa58 //0xa5c + +// +// 6. PageC(0xC00) @@ -333130,16 +149374,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define rOFDM0_TRSWIsolation 0xc0c + +#define rOFDM0_XARxAFE 0xc10 //RxIQ DC offset, Rx digital filter, DC notch filter -+#define rOFDM0_XARxIQImbalance 0xc14 //RxIQ imblance matrix -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c ++#define rOFDM0_XARxIQImbalance 0xc14 //RxIQ imblance matrix ++#define rOFDM0_XBRxAFE 0xc18 ++#define rOFDM0_XBRxIQImbalance 0xc1c ++#define rOFDM0_XCRxAFE 0xc20 ++#define rOFDM0_XCRxIQImbalance 0xc24 ++#define rOFDM0_XDRxAFE 0xc28 ++#define rOFDM0_XDRxIQImbalance 0xc2c + +#define rOFDM0_RxDetector1 0xc30 //PD,BW & SBD // DM tune init gain -+#define rOFDM0_RxDetector2 0xc34 //SBD & Fame Sync. ++#define rOFDM0_RxDetector2 0xc34 //SBD & Fame Sync. +#define rOFDM0_RxDetector3 0xc38 //Frame Sync. +#define rOFDM0_RxDetector4 0xc3c //PD, SBD, Frame Sync & Short-GI + @@ -333148,7 +149392,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define rOFDM0_CCADropThreshold 0xc48 //CCA Drop threshold +#define rOFDM0_ECCAThreshold 0xc4c // energy CCA + -+#define rOFDM0_XAAGCCore1 0xc50 // DIG ++#define rOFDM0_XAAGCCore1 0xc50 // DIG +#define rOFDM0_XAAGCCore2 0xc54 +#define rOFDM0_XBAGCCore1 0xc58 +#define rOFDM0_XBAGCCore2 0xc5c @@ -333167,7 +149411,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define rOFDM0_XBTxIQImbalance 0xc88 +#define rOFDM0_XBTxAFE 0xc8c +#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 ++#define rOFDM0_XCTxAFE 0xc94 +#define rOFDM0_XDTxIQImbalance 0xc98 +#define rOFDM0_XDTxAFE 0xc9c +#define rOFDM0_RxIQExtAnta 0xca0 @@ -333211,8 +149455,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define rOFDM_LongCFOCD 0xdb8 +#define rOFDM_TailCFOAB 0xdbc +#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 ++#define rOFDM_PWMeasure1 0xdc4 ++#define rOFDM_PWMeasure2 0xdc8 +#define rOFDM_BWReport 0xdcc +#define rOFDM_AGCReport 0xdd0 +#define rOFDM_RxSNR 0xdd4 @@ -333232,7 +149476,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define rTxAGC_Mcs15_Mcs12 0xe1c + +// Analog- control in RX_WAIT_CCA : REG: EE0 [Analog- Power & Control Register] -+#define rRx_Wait_CCCA 0xe70 ++#define rRx_Wait_CCCA 0xe70 +#define rAnapar_Ctrl_BB 0xee0 + +// @@ -333269,48 +149513,48 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +// +// RL6052 Register definition +// -+#define RF_AC 0x00 // ++#define RF_AC 0x00 // + -+#define RF_IQADJ_G1 0x01 // -+#define RF_IQADJ_G2 0x02 // -+#define RF_POW_TRSW 0x05 // ++#define RF_IQADJ_G1 0x01 // ++#define RF_IQADJ_G2 0x02 // ++#define RF_POW_TRSW 0x05 // + -+#define RF_GAIN_RX 0x06 // -+#define RF_GAIN_TX 0x07 // ++#define RF_GAIN_RX 0x06 // ++#define RF_GAIN_TX 0x07 // + -+#define RF_TXM_IDAC 0x08 // -+#define RF_BS_IQGEN 0x0F // ++#define RF_TXM_IDAC 0x08 // ++#define RF_BS_IQGEN 0x0F // + -+#define RF_MODE1 0x10 // -+#define RF_MODE2 0x11 // ++#define RF_MODE1 0x10 // ++#define RF_MODE2 0x11 // + -+#define RF_RX_AGC_HP 0x12 // -+#define RF_TX_AGC 0x13 // -+#define RF_BIAS 0x14 // -+#define RF_IPA 0x15 // ++#define RF_RX_AGC_HP 0x12 // ++#define RF_TX_AGC 0x13 // ++#define RF_BIAS 0x14 // ++#define RF_IPA 0x15 // +#define RF_TXBIAS 0x16 // -+#define RF_POW_ABILITY 0x17 // -+#define RF_MODE_AG 0x18 // ++#define RF_POW_ABILITY 0x17 // ++#define RF_MODE_AG 0x18 // +#define rRfChannel 0x18 // RF channel and BW switch +#define RF_CHNLBW 0x18 // RF channel and BW switch -+#define RF_TOP 0x19 // ++#define RF_TOP 0x19 // + -+#define RF_RX_G1 0x1A // -+#define RF_RX_G2 0x1B // ++#define RF_RX_G1 0x1A // ++#define RF_RX_G2 0x1B // + -+#define RF_RX_BB2 0x1C // -+#define RF_RX_BB1 0x1D // ++#define RF_RX_BB2 0x1C // ++#define RF_RX_BB1 0x1D // + -+#define RF_RCK1 0x1E // -+#define RF_RCK2 0x1F // ++#define RF_RCK1 0x1E // ++#define RF_RCK2 0x1F // + -+#define RF_TX_G1 0x20 // -+#define RF_TX_G2 0x21 // -+#define RF_TX_G3 0x22 // ++#define RF_TX_G1 0x20 // ++#define RF_TX_G2 0x21 // ++#define RF_TX_G3 0x22 // + -+#define RF_TX_BB1 0x23 // ++#define RF_TX_BB1 0x23 // + -+#define RF_T_METER 0x24 // ++#define RF_T_METER 0x24 // + +#define RF_SYN_G1 0x25 // RF TX Power control +#define RF_SYN_G2 0x26 // RF TX Power control @@ -333376,7 +149620,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define bCCKTxStatus 0x1 +#define bOFDMTxStatus 0x2 + -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) ++#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) + +// 2. Page8(0x800) +#define bRFMOD 0x1 // Reg 0x800 rFPGA0_RFMOD @@ -333385,317 +149629,317 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define bCCKEn 0x1000000 +#define bOFDMEn 0x2000000 + -+#define bOFDMRxADCPhase 0x10000 // Useless now -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f ++#define bOFDMRxADCPhase 0x10000 // Useless now ++#define bOFDMTxDACPhase 0x40000 ++#define bXATxAGC 0x3f + -+#define bXBTxAGC 0xf00 // Reg 80c rFPGA0_TxGainStage -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 // Useless now -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf //Reg0x814 -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 //T2R -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 //chane gain at continue Tx -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 ++#define bXBTxAGC 0xf00 // Reg 80c rFPGA0_TxGainStage ++#define bXCTxAGC 0xf000 ++#define bXDTxAGC 0xf0000 + -+#define b3WireDataLength 0x800 // Reg 0x820~84f rFPGA0_XA_HSSIParameter1 -+#define b3WireAddressLength 0x400 ++#define bPAStart 0xf0000000 // Useless now ++#define bTRStart 0x00f00000 ++#define bRFStart 0x0000f000 ++#define bBBStart 0x000000f0 ++#define bBBCCKStart 0x0000000f ++#define bPAEnd 0xf //Reg0x814 ++#define bTREnd 0x0f000000 ++#define bRFEnd 0x000f0000 ++#define bCCAMask 0x000000f0 //T2R ++#define bR2RCCAMask 0x00000f00 ++#define bHSSI_R2TDelay 0xf8000000 ++#define bHSSI_T2RDelay 0xf80000 ++#define bContTxHSSI 0x400 //chane gain at continue Tx ++#define bIGFromCCK 0x200 ++#define bAGCAddress 0x3f ++#define bRxHPTx 0x7000 ++#define bRxHPT2R 0x38000 ++#define bRxHPCCKIni 0xc0000 ++#define bAGCTxCode 0xc00000 ++#define bAGCRxCode 0x300000 + -+#define b3WireRFPowerDown 0x1 // Useless now -+//#define bHWSISelect 0x8 -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf ++#define b3WireDataLength 0x800 // Reg 0x820~84f rFPGA0_XA_HSSIParameter1 ++#define b3WireAddressLength 0x400 + -+#define bRFSI_RFENV 0x10 // Reg 0x870 rFPGA0_XAB_RFInterfaceSW ++#define b3WireRFPowerDown 0x1 // Useless now ++//#define bHWSISelect 0x8 ++#define b5GPAPEPolarity 0x40000000 ++#define b2GPAPEPolarity 0x80000000 ++#define bRFSW_TxDefaultAnt 0x3 ++#define bRFSW_TxOptionAnt 0x30 ++#define bRFSW_RxDefaultAnt 0x300 ++#define bRFSW_RxOptionAnt 0x3000 ++#define bRFSI_3WireData 0x1 ++#define bRFSI_3WireClock 0x2 ++#define bRFSI_3WireLoad 0x4 ++#define bRFSI_3WireRW 0x8 ++#define bRFSI_3Wire 0xf + -+#define bRFSI_TRSW 0x20 // Useless now -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 ++#define bRFSI_RFENV 0x10 // Reg 0x870 rFPGA0_XAB_RFInterfaceSW ++ ++#define bRFSI_TRSW 0x20 // Useless now ++#define bRFSI_TRSWB 0x40 ++#define bRFSI_ANTSW 0x100 ++#define bRFSI_ANTSWB 0x200 ++#define bRFSI_PAPE 0x400 ++#define bRFSI_PAPE5G 0x800 ++#define bBandSelect 0x1 ++#define bHTSIG2_GI 0x80 ++#define bHTSIG2_Smoothing 0x01 ++#define bHTSIG2_Sounding 0x02 ++#define bHTSIG2_Aggreaton 0x08 ++#define bHTSIG2_STBC 0x30 ++#define bHTSIG2_AdvCoding 0x40 ++#define bHTSIG2_NumOfHTLTF 0x300 ++#define bHTSIG2_CRC8 0x3fc ++#define bHTSIG1_MCS 0x7f ++#define bHTSIG1_BandWidth 0x80 ++#define bHTSIG1_HTLength 0xffff ++#define bLSIG_Rate 0xf ++#define bLSIG_Reserved 0x10 ++#define bLSIG_Length 0x1fffe ++#define bLSIG_Parity 0x20 ++#define bCCKRxPhase 0x4 +#if (RTL92SE_FPGA_VERIFY == 1) -+#define bLSSIReadAddress 0x3f000000 //LSSI "Read" Address // Reg 0x824 rFPGA0_XA_HSSIParameter2 ++#define bLSSIReadAddress 0x3f000000 //LSSI "Read" Address // Reg 0x824 rFPGA0_XA_HSSIParameter2 +#else -+#define bLSSIReadAddress 0x7f800000 // T65 RF ++#define bLSSIReadAddress 0x7f800000 // T65 RF +#endif -+#define bLSSIReadEdge 0x80000000 //LSSI "Read" edge signal ++#define bLSSIReadEdge 0x80000000 //LSSI "Read" edge signal +#if (RTL92SE_FPGA_VERIFY == 1) -+#define bLSSIReadBackData 0xfff // Reg 0x8a0 rFPGA0_XA_LSSIReadBack ++#define bLSSIReadBackData 0xfff // Reg 0x8a0 rFPGA0_XA_LSSIReadBack +#else -+#define bLSSIReadBackData 0xfffff // T65 RF ++#define bLSSIReadBackData 0xfffff // T65 RF +#endif -+#define bLSSIReadOKFlag 0x1000 // Useless now -+#define bCCKSampleRate 0x8 //0: 44MHz, 1:88MHz -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 ++#define bLSSIReadOKFlag 0x1000 // Useless now ++#define bCCKSampleRate 0x8 //0: 44MHz, 1:88MHz ++#define bRegulator0Standby 0x1 ++#define bRegulatorPLLStandby 0x2 ++#define bRegulator1Standby 0x4 ++#define bPLLPowerUp 0x8 ++#define bDPLLPowerUp 0x10 ++#define bDA10PowerUp 0x20 ++#define bAD7PowerUp 0x200 ++#define bDA6PowerUp 0x2000 ++#define bXtalPowerUp 0x4000 ++#define b40MDClkPowerUP 0x8000 ++#define bDA6DebugMode 0x20000 ++#define bDA6Swing 0x380000 + -+#define bADClkPhase 0x4000000 // Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ ++#define bADClkPhase 0x4000000 // Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ + -+#define b80MClkDelay 0x18000000 // Useless -+#define bAFEWatchDogEnable 0x20000000 ++#define b80MClkDelay 0x18000000 // Useless ++#define bAFEWatchDogEnable 0x20000000 + -+#define bXtalCap01 0xc0000000 // Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap -+#define bXtalCap23 0x3 ++#define bXtalCap01 0xc0000000 // Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap ++#define bXtalCap23 0x3 +#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 ++#define bXtalCap 0x0f000000 + -+#define bIntDifClkEnable 0x400 // Useless -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff ++#define bIntDifClkEnable 0x400 // Useless ++#define bExtSigClkEnable 0x800 ++#define bBandgapMbiasPowerUp 0x10000 ++#define bAD11SHGain 0xc0000 ++#define bAD11InputRange 0x700000 ++#define bAD11OPCurrent 0x3800000 ++#define bIPathLoopback 0x4000000 ++#define bQPathLoopback 0x8000000 ++#define bAFELoopback 0x10000000 ++#define bDA10Swing 0x7e0 ++#define bDA10Reverse 0x800 ++#define bDAClkSource 0x1000 ++#define bAD7InputRange 0x6000 ++#define bAD7Gain 0x38000 ++#define bAD7OutputCMMode 0x40000 ++#define bAD7InputCMMode 0x380000 ++#define bAD7Current 0xc00000 ++#define bRegulatorAdjust 0x7000000 ++#define bAD11PowerUpAtTx 0x1 ++#define bDA10PSAtTx 0x10 ++#define bAD11PowerUpAtRx 0x100 ++#define bDA10PSAtRx 0x1000 ++#define bCCKRxAGCFormat 0x200 ++#define bPSDFFTSamplepPoint 0xc000 ++#define bPSDAverageNum 0x3000 ++#define bIQPathControl 0xc00 ++#define bPSDFreq 0x3ff ++#define bPSDAntennaPath 0x30 ++#define bPSDIQSwitch 0x40 ++#define bPSDRxTrigger 0x400000 ++#define bPSDTxTrigger 0x80000000 ++#define bPSDSineToneScale 0x7f000000 ++#define bPSDReport 0xffff + +// 3. Page9(0x900) -+#define bOFDMTxSC 0x30000000 // Useless -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff //reset debug page and also HWord, LWord -+#define bDebugItem 0xff //reset debug page and LWord -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 ++#define bOFDMTxSC 0x30000000 // Useless ++#define bCCKTxOn 0x1 ++#define bOFDMTxOn 0x2 ++#define bDebugPage 0xfff //reset debug page and also HWord, LWord ++#define bDebugItem 0xff //reset debug page and LWord ++#define bAntL 0x10 ++#define bAntNonHT 0x100 ++#define bAntHT1 0x1000 ++#define bAntHT2 0x10000 ++#define bAntHT1S1 0x100000 ++#define bAntNonHTS1 0x1000000 + +// 4. PageA(0xA00) -+#define bCCKBBMode 0x3 // Useless -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 ++#define bCCKBBMode 0x3 // Useless ++#define bCCKTxPowerSaving 0x80 ++#define bCCKRxPowerSaving 0x40 + -+#define bCCKSideBand 0x10 // Reg 0xa00 rCCK0_System 20/40 switch ++#define bCCKSideBand 0x10 // Reg 0xa00 rCCK0_System 20/40 switch + -+#define bCCKScramble 0x8 // Useless -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 //r_rx_clk -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 //CCK Rx Iinital gain polarity -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f //AGCsamp_dly -+#define bCCKFixedRxAGC 0x8000 -+//#define bCCKRxAGCFormat 0x4000 //remove to HSSI register 0x824 -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 ++#define bCCKScramble 0x8 // Useless ++#define bCCKAntDiversity 0x8000 ++#define bCCKCarrierRecovery 0x4000 ++#define bCCKTxRate 0x3000 ++#define bCCKDCCancel 0x0800 ++#define bCCKISICancel 0x0400 ++#define bCCKMatchFilter 0x0200 ++#define bCCKEqualizer 0x0100 ++#define bCCKPreambleDetect 0x800000 ++#define bCCKFastFalseCCA 0x400000 ++#define bCCKChEstStart 0x300000 ++#define bCCKCCACount 0x080000 ++#define bCCKcs_lim 0x070000 ++#define bCCKBistMode 0x80000000 ++#define bCCKCCAMask 0x40000000 ++#define bCCKTxDACPhase 0x4 ++#define bCCKRxADCPhase 0x20000000 //r_rx_clk ++#define bCCKr_cp_mode0 0x0100 ++#define bCCKTxDCOffset 0xf0 ++#define bCCKRxDCOffset 0xf ++#define bCCKCCAMode 0xc000 ++#define bCCKFalseCS_lim 0x3f00 ++#define bCCKCS_ratio 0xc00000 ++#define bCCKCorgBit_sel 0x300000 ++#define bCCKPD_lim 0x0f0000 ++#define bCCKNewCCA 0x80000000 ++#define bCCKRxHPofIG 0x8000 ++#define bCCKRxIG 0x7f00 ++#define bCCKLNAPolarity 0x800000 ++#define bCCKRx1stGain 0x7f0000 ++#define bCCKRFExtend 0x20000000 //CCK Rx Iinital gain polarity ++#define bCCKRxAGCSatLevel 0x1f000000 ++#define bCCKRxAGCSatCount 0xe0 ++#define bCCKRxRFSettle 0x1f //AGCsamp_dly ++#define bCCKFixedRxAGC 0x8000 ++//#define bCCKRxAGCFormat 0x4000 //remove to HSSI register 0x824 ++#define bCCKAntennaPolarity 0x2000 ++#define bCCKTxFilterType 0x0c00 ++#define bCCKRxAGCReportType 0x0300 ++#define bCCKRxDAGCEn 0x80000000 ++#define bCCKRxDAGCPeriod 0x20000000 ++#define bCCKRxDAGCSatLevel 0x1f000000 ++#define bCCKTimingRecovery 0x800000 ++#define bCCKTxC0 0x3f0000 ++#define bCCKTxC1 0x3f000000 ++#define bCCKTxC2 0x3f ++#define bCCKTxC3 0x3f00 ++#define bCCKTxC4 0x3f0000 ++#define bCCKTxC5 0x3f000000 ++#define bCCKTxC6 0x3f ++#define bCCKTxC7 0x3f00 ++#define bCCKDebugPort 0xff0000 ++#define bCCKDACDebug 0x0f000000 ++#define bCCKFalseAlarmEnable 0x8000 ++#define bCCKFalseAlarmRead 0x4000 ++#define bCCKTRSSI 0x7f ++#define bCCKRxAGCReport 0xfe ++#define bCCKRxReport_AntSel 0x80000000 ++#define bCCKRxReport_MFOff 0x40000000 ++#define bCCKRxRxReport_SQLoss 0x20000000 ++#define bCCKRxReport_Pktloss 0x10000000 ++#define bCCKRxReport_Lockedbit 0x08000000 ++#define bCCKRxReport_RateError 0x04000000 ++#define bCCKRxReport_RxRate 0x03000000 ++#define bCCKRxFACounterLower 0xff ++#define bCCKRxFACounterUpper 0xff000000 ++#define bCCKRxHPAGCStart 0xe000 ++#define bCCKRxHPAGCFinal 0x1c00 ++#define bCCKRxFalseAlarmEnable 0x8000 ++#define bCCKFACounterFreeze 0x4000 ++#define bCCKTxPathSel 0x10000000 ++#define bCCKDefaultRxPath 0xc000000 ++#define bCCKOptionRxPath 0x3000000 + +// 5. PageC(0xC00) -+#define bNumOfSTF 0x3 // Useless -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 ++#define bNumOfSTF 0x3 // Useless ++#define bShift_L 0xc0 ++#define bGI_TH 0xc ++#define bRxPathA 0x1 ++#define bRxPathB 0x2 ++#define bRxPathC 0x4 ++#define bRxPathD 0x8 ++#define bTxPathA 0x1 ++#define bTxPathB 0x2 ++#define bTxPathC 0x4 ++#define bTxPathD 0x8 ++#define bTRSSIFreq 0x200 ++#define bADCBackoff 0x3000 ++#define bDFIRBackoff 0xc000 ++#define bTRSSILatchPhase 0x10000 ++#define bRxIDCOffset 0xff ++#define bRxQDCOffset 0xff00 ++#define bRxDFIRMode 0x1800000 ++#define bRxDCNFType 0xe000000 ++#define bRXIQImb_A 0x3ff ++#define bRXIQImb_B 0xfc00 ++#define bRXIQImb_C 0x3f0000 ++#define bRXIQImb_D 0xffc00000 ++#define bDC_dc_Notch 0x60000 ++#define bRxNBINotch 0x1f000000 ++#define bPD_TH 0xf ++#define bPD_TH_Opt2 0xc000 ++#define bPWED_TH 0x700 ++#define bIfMF_Win_L 0x800 ++#define bPD_Option 0x1000 ++#define bMF_Win_L 0xe000 ++#define bBW_Search_L 0x30000 ++#define bwin_enh_L 0xc0000 ++#define bBW_TH 0x700000 ++#define bED_TH2 0x3800000 ++#define bBW_option 0x4000000 ++#define bRatio_TH 0x18000000 ++#define bWindow_L 0xe0000000 ++#define bSBD_Option 0x1 ++#define bFrame_TH 0x1c ++#define bFS_Option 0x60 ++#define bDC_Slope_check 0x80 ++#define bFGuard_Counter_DC_L 0xe00 ++#define bFrame_Weight_Short 0x7000 ++#define bSub_Tune 0xe00000 ++#define bFrame_DC_Length 0xe000000 ++#define bSBD_start_offset 0x30000000 ++#define bFrame_TH_2 0x7 ++#define bFrame_GI2_TH 0x38 ++#define bGI2_Sync_en 0x40 ++#define bSarch_Short_Early 0x300 ++#define bSarch_Short_Late 0xc00 ++#define bSarch_GI2_Late 0x70000 ++#define bCFOAntSum 0x1 ++#define bCFOAcc 0x2 ++#define bCFOStartOffset 0xc ++#define bCFOLookBack 0x70 ++#define bCFOSumWeight 0x80 ++#define bDAGCEnable 0x10000 ++#define bTXIQImb_A 0x3ff ++#define bTXIQImb_B 0xfc00 ++#define bTXIQImb_C 0x3f0000 ++#define bTXIQImb_D 0xffc00000 ++#define bTxIDCOffset 0xff ++#define bTxQDCOffset 0xff00 ++#define bTxDFIRMode 0x10000 ++#define bTxPesudoNoiseOn 0x4000000 ++#define bTxPesudoNoise_A 0xff ++#define bTxPesudoNoise_B 0xff00 ++#define bTxPesudoNoise_C 0xff0000 ++#define bTxPesudoNoise_D 0xff000000 ++#define bCCADropOption 0x20000 ++#define bCCADropThres 0xfff00000 ++#define bEDCCA_H 0xf ++#define bEDCCA_L 0xf0 +#define bLambda_ED 0x300 +#define bRxInitialGain 0x7f +#define bRxAntDivEn 0x80 @@ -333767,16 +150011,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define bRxSGI_TH 0xc0000000 +#define bDFSCnt0 0xff +#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 ++#define bDFSFlag 0xf0000 +#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 ++#define bMinIdxTH 0x7f000000 ++#define bDAFormat 0x40000 ++#define bTxChEmuEnable 0x01000000 +#define bTRSWIsolation_A 0x7f +#define bTRSWIsolation_B 0x7f00 +#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 ++#define bTRSWIsolation_D 0x7f000000 ++#define bExtLNAGain 0x7c00 + +// 6. PageE(0xE00) +#define bSTBCEn 0x4 // Useless @@ -333813,7 +150057,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define bLongCFOFLength 11 +#define bTailCFO 0x1fff +#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 ++#define bTailCFOFLength 12 +#define bmax_en_pwdB 0xffff +#define bCC_power_dB 0xffff0000 +#define bnoise_pwdB 0xffff @@ -333821,27 +150065,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define bPowerMeasFLength 3 +#define bRx_HT_BW 0x1 +#define bRxSC 0x6 -+#define bRx_HT 0x8 ++#define bRx_HT 0x8 +#define bNB_intf_det_on 0x1 +#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 ++#define bNB_Intf_TH_cfg 0x1c0 +#define bRFGain 0x3f +#define bTableSel 0x40 -+#define bTRSW 0x80 ++#define bTRSW 0x80 +#define bRxSNR_A 0xff +#define bRxSNR_B 0xff00 +#define bRxSNR_C 0xff0000 +#define bRxSNR_D 0xff000000 +#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 ++#define bSNREVMFLength 1 +#define bCSI1st 0xff +#define bCSI2nd 0xff00 +#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 ++#define bRxEVM2nd 0xff000000 +#define bSIGEVM 0xff +#define bPWDB 0xff00 +#define bSGIEN 0x10000 -+ ++ +#define bSFactorQAM1 0xf // Useless +#define bSFactorQAM2 0xf0 +#define bSFactorQAM3 0xf00 @@ -333852,7 +150096,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define bSFactorQAM8 0xf000000 +#define bSFactorQAM9 0xf0000000 +#define bCSIScheme 0x100000 -+ ++ +#define bNoiseLvlTopSet 0x3 // Useless +#define bChSmooth 0x4 +#define bChSmoothCfg1 0x38 @@ -333861,7 +150105,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define bChSmoothCfg4 0x7000 +#define bMRCMode 0x800000 +#define bTHEVMCfg 0x7000000 -+ ++ +#define bLoopFitType 0x1 // Useless +#define bUpdCFO 0x40 +#define bUpdCFOOffData 0x80 @@ -333940,12 +150184,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define bMaskByte1 0xff00 +#define bMaskByte2 0xff0000 +#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 ++#define bMaskHWord 0xffff0000 +#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff ++#define bMaskDWord 0xffffffff +#define bMaskH4Bits 0xf0000000 -+#define bMaskH3Bytes 0xffffff00 -+#define bMaskOFDM_D 0xffc00000 ++#define bMaskOFDM_D 0xffc00000 +#define bMaskCCK 0x3f3f3f3f +#define bMask12Bits 0xfff + @@ -333953,21 +150196,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#if (RTL92SE_FPGA_VERIFY == 1) +//#define bMask12Bits 0xfff // RF Reg mask bits +//#define bMask20Bits 0xfff // RF Reg mask bits T65 RF -+#define bRFRegOffsetMask 0xfff ++#define bRFRegOffsetMask 0xfff +#else +//#define bMask12Bits 0xfffff // RF Reg mask bits +//#define bMask20Bits 0xfffff // RF Reg mask bits T65 RF -+#define bRFRegOffsetMask 0xfffff -+#endif ++#define bRFRegOffsetMask 0xfffff ++#endif +#define bEnable 0x1 // Useless +#define bDisable 0x0 -+ ++ +#define LeftAntenna 0x0 // Useless +#define RightAntenna 0x1 -+ ++ +#define tCheckTxStatus 500 //500ms // Useless +#define tUpdateRxCounter 100 //100ms -+ ++ +#define rateCCK 0 // Useless +#define rateOFDM 1 +#define rateHT 2 @@ -334006,7 +150249,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar +#define RCR_AB BIT(3) // accept broadcast +#define RCR_ACRC32 BIT(5) // accept error packet +#define RCR_9356SEL BIT(6) -+#define RCR_AICV BIT(9) // Accept ICV error packet ++#define RCR_AICV BIT(12) // Accept ICV error packet +#define RCR_RXFTH0 (BIT(13)|BIT(14)|BIT(15)) // Rx FIFO threshold +#define RCR_ADF BIT(18) // Accept Data(frame type) frame +#define RCR_ACF BIT(19) // Accept control frame @@ -334023,72 +150266,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux/3rdpar + + +#endif //__INC_HAL8192SPHYREG_H -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_odm.h linux/3rdparty/rtl8812au/include/rtw_odm.h ---- linux.old/3rdparty/rtl8812au/include/rtw_odm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_odm.h 2017-06-07 23:07:21.043690492 +0300 -@@ -0,0 +1,53 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_ODM_H__ -+#define __RTW_ODM_H__ -+ -+#include -+#include "../hal/phydm/phydm_types.h" -+/* -+* This file provides utilities/wrappers for rtw driver to use ODM -+*/ -+ -+void rtw_odm_dbg_comp_msg(void *sel,_adapter *adapter); -+void rtw_odm_dbg_comp_set(_adapter *adapter, u64 comps); -+void rtw_odm_dbg_level_msg(void *sel,_adapter *adapter); -+void rtw_odm_dbg_level_set(_adapter *adapter, u32 level); -+ -+void rtw_odm_ability_msg(void *sel, _adapter *adapter); -+void rtw_odm_ability_set(_adapter *adapter, u32 ability); -+ -+void rtw_odm_adaptivity_config_msg(void *sel, _adapter *adapter); -+ -+bool rtw_odm_adaptivity_needed(_adapter *adapter); -+void rtw_odm_adaptivity_parm_msg(void *sel,_adapter *adapter); -+void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 TH_L2H_ini, s8 TH_EDCCA_HL_diff, s8 TH_L2H_ini_mode2, s8 TH_EDCCA_HL_diff_mode2, u8 EDCCA_enable); -+void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter); -+void rtw_odm_acquirespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type); -+void rtw_odm_releasespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type); -+ -+#ifdef CONFIG_DFS_MASTER -+VOID rtw_odm_radar_detect_reset(_adapter *adapter); -+VOID rtw_odm_radar_detect_disable(_adapter *adapter); -+VOID rtw_odm_radar_detect_enable(_adapter *adapter); -+BOOLEAN rtw_odm_radar_detect(_adapter *adapter); -+#endif /* CONFIG_DFS_MASTER */ -+#endif // __RTW_ODM_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_p2p.h linux/3rdparty/rtl8812au/include/rtw_p2p.h ---- linux.old/3rdparty/rtl8812au/include/rtw_p2p.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_p2p.h 2017-06-07 23:07:21.043690492 +0300 -@@ -0,0 +1,168 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_p2p.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_p2p.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_p2p.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_p2p.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,154 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -334098,11 +150283,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_p2p.h linux/3rdparty/rtl8812 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __RTW_P2P_H_ +#define __RTW_P2P_H_ @@ -334138,7 +150318,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_p2p.h linux/3rdparty/rtl8812 +u8 process_p2p_group_negotation_resp( struct wifidirect_info *pwdinfo, u8 *pframe, uint len ); +u8 process_p2p_group_negotation_confirm( struct wifidirect_info *pwdinfo, u8 *pframe, uint len ); +u8 process_p2p_presence_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+int process_p2p_cross_connect_ie(PADAPTER padapter, u8 *IEs, u32 IELength); + +void p2p_protocol_wk_hdl(_adapter *padapter, int intCmdType); + @@ -334235,7 +150414,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_p2p.h linux/3rdparty/rtl8812 +#define rtw_p2p_findphase_ex_set(wdinfo, value) \ + (wdinfo)->find_phase_state_exchange_cnt = (value) + -+#ifdef CONFIG_P2P +//is this find phase exchange for social channel scan? +#define rtw_p2p_findphase_ex_is_social(wdinfo) \ + (wdinfo)->find_phase_state_exchange_cnt >= P2P_FINDPHASE_EX_SOCIAL_FIRST @@ -334243,20 +150421,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_p2p.h linux/3rdparty/rtl8812 +//should we need find phase exchange anymore? +#define rtw_p2p_findphase_ex_is_needed(wdinfo) \ + ((wdinfo)->find_phase_state_exchange_cnt < P2P_FINDPHASE_EX_MAX && \ -+ (wdinfo)->find_phase_state_exchange_cnt != P2P_FINDPHASE_EX_NONE && \ -+ !(wdinfo)->rx_invitereq_info.scan_op_ch_only && \ -+ !(wdinfo)->p2p_info.scan_op_ch_only) -+#else -+#define rtw_p2p_findphase_ex_is_social(wdinfo) 0 -+#define rtw_p2p_findphase_ex_is_needed(wdinfo) 0 -+#endif /* CONFIG_P2P */ ++ (wdinfo)->find_phase_state_exchange_cnt != P2P_FINDPHASE_EX_NONE) + +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl8812au/include/rtw_pwrctrl.h ---- linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_pwrctrl.h 2017-06-07 23:07:21.043690492 +0300 -@@ -0,0 +1,514 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_pwrctrl.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_pwrctrl.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_pwrctrl.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,356 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. @@ -334270,25 +150441,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __RTW_PWRCTRL_H_ +#define __RTW_PWRCTRL_H_ + + -+#define FW_PWR0 0 -+#define FW_PWR1 1 -+#define FW_PWR2 2 -+#define FW_PWR3 3 ++#define FW_PWR0 0 ++#define FW_PWR1 1 ++#define FW_PWR2 2 ++#define FW_PWR3 3 + + -+#define HW_PWR0 7 -+#define HW_PWR1 6 -+#define HW_PWR2 2 ++#define HW_PWR0 7 ++#define HW_PWR1 6 ++#define HW_PWR2 2 +#define HW_PWR3 0 +#define HW_PWR4 8 + @@ -334299,43 +150465,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl +#define RECV_ALIVE BIT(1) +#define CMD_ALIVE BIT(2) +#define EVT_ALIVE BIT(3) -+#ifdef CONFIG_BT_COEXIST -+#define BTCOEX_ALIVE BIT(4) -+#endif // CONFIG_BT_COEXIST + -+#ifdef CONFIG_WOWLAN -+#define MAX_WKFM_NUM 16 /* Frame Mask Cam number for pattern match */ -+#define MAX_WKFM_SIZE 16 /* (16 bytes for WKFM bit mask, 16*8 = 128 bits) */ -+#define MAX_WKFM_PATTERN_SIZE 128 -+#define WKFMCAM_ADDR_NUM 6 -+#define WKFMCAM_SIZE 24 /* each entry need 6*4 bytes */ -+enum pattern_type { -+ PATTERN_BROADCAST = 0, -+ PATTERN_MULTICAST, -+ PATTERN_UNICAST, -+ PATTERN_VALID, -+ PATTERN_INVALID, -+}; -+ -+typedef struct rtl_priv_pattern { -+ int len; -+ char content[MAX_WKFM_PATTERN_SIZE]; -+ char mask[MAX_WKFM_SIZE]; -+} rtl_priv_pattern_t; -+ -+struct rtl_wow_pattern { -+ u16 crc; -+ u8 type; -+ u32 mask[4]; -+}; -+#endif /* CONFIG_WOWLAN */ + +enum Power_Mgnt +{ + PS_MODE_ACTIVE = 0 , + PS_MODE_MIN , + PS_MODE_MAX , -+ PS_MODE_DTIM , //PS_MODE_SELF_DEFINED ++ PS_MODE_DTIM , + PS_MODE_VOIP , + PS_MODE_UAPSD_WMM , + PS_MODE_UAPSD , @@ -334346,12 +150483,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl + PS_MODE_NUM, +}; + -+#ifdef CONFIG_PNO_SUPPORT -+#define MAX_PNO_LIST_COUNT 16 -+#define MAX_SCAN_LIST_COUNT 14 //2.4G only -+#define MAX_HIDDEN_AP 8 //8 hidden AP -+#endif -+ +/* + BIT[2:0] = HW state + BIT[3] = Protocol PS state, 0: register active state , 1: register sleep state @@ -334393,7 +150524,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl + unsigned char mode; + unsigned char state; //the CPWM value + unsigned short rsvd; -+}; ++}; + + +typedef _sema _pwrlock; @@ -334448,15 +150579,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl +#define RT_RF_LPS_DISALBE_2R BIT(30) // When LPS is on, disable 2R if no packet is received or transmittd. +#define RT_RF_LPS_LEVEL_ASPM BIT(31) // LPS with ASPM + -+#define RT_IN_PS_LEVEL(ppsc, _PS_FLAG) ((ppsc->cur_ps_level & _PS_FLAG) ? _TRUE : _FALSE) ++#define RT_IN_PS_LEVEL(ppsc, _PS_FLAG) ((ppsc->cur_ps_level & _PS_FLAG) ? true : false) +#define RT_CLEAR_PS_LEVEL(ppsc, _PS_FLAG) (ppsc->cur_ps_level &= (~(_PS_FLAG))) +#define RT_SET_PS_LEVEL(ppsc, _PS_FLAG) (ppsc->cur_ps_level |= _PS_FLAG) + -+// ASPM OSC Control bit, added by Roger, 2013.03.29. -+#define RT_PCI_ASPM_OSC_IGNORE 0 // PCI ASPM ignore OSC control in default -+#define RT_PCI_ASPM_OSC_ENABLE BIT0 // PCI ASPM controlled by OS according to ACPI Spec 5.0 -+#define RT_PCI_ASPM_OSC_DISABLE BIT1 // PCI ASPM controlled by driver or BIOS, i.e., force enable ASPM -+ + +enum _PS_BBRegBackup_ { + PSBBREG_RF0 = 0, @@ -334469,74 +150595,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl +enum { // for ips_mode + IPS_NONE=0, + IPS_NORMAL, -+ IPS_LEVEL_2, -+ IPS_NUM ++ IPS_LEVEL_2, +}; + -+// Design for pwrctrl_priv.ips_deny, 32 bits for 32 reasons at most -+typedef enum _PS_DENY_REASON -+{ -+ PS_DENY_DRV_INITIAL = 0, -+ PS_DENY_SCAN, -+ PS_DENY_JOIN, -+ PS_DENY_DISCONNECT, -+ PS_DENY_SUSPEND, -+ PS_DENY_IOCTL, -+ PS_DENY_MGNT_TX, -+ PS_DENY_DRV_REMOVE = 30, -+ PS_DENY_OTHERS = 31 -+} PS_DENY_REASON; -+ -+#ifdef CONFIG_PNO_SUPPORT -+typedef struct pno_nlo_info -+{ -+ u32 fast_scan_period; //Fast scan period -+ u8 ssid_num; //number of entry -+ u8 hidden_ssid_num; -+ u32 slow_scan_period; //slow scan period -+ u32 fast_scan_iterations; //Fast scan iterations -+ u8 ssid_length[MAX_PNO_LIST_COUNT]; //SSID Length Array -+ u8 ssid_cipher_info[MAX_PNO_LIST_COUNT]; //Cipher information for security -+ u8 ssid_channel_info[MAX_PNO_LIST_COUNT]; //channel information -+ u8 loc_probe_req[MAX_HIDDEN_AP]; //loc_probeReq -+}pno_nlo_info_t; -+ -+typedef struct pno_ssid { -+ u32 SSID_len; -+ u8 SSID[32]; -+} pno_ssid_t; -+ -+typedef struct pno_ssid_list { -+ pno_ssid_t node[MAX_PNO_LIST_COUNT]; -+}pno_ssid_list_t; -+ -+typedef struct pno_scan_channel_info -+{ -+ u8 channel; -+ u8 tx_power; -+ u8 timeout; -+ u8 active; //set 1 means active scan, or pasivite scan. -+}pno_scan_channel_info_t; -+ -+typedef struct pno_scan_info -+{ -+ u8 enableRFE; //Enable RFE -+ u8 period_scan_time; //exclusive with fast_scan_period and slow_scan_period -+ u8 periodScan; //exclusive with fast_scan_period and slow_scan_period -+ u8 orig_80_offset; //original channel 80 offset -+ u8 orig_40_offset; //original channel 40 offset -+ u8 orig_bw; //original bandwidth -+ u8 orig_ch; //original channel -+ u8 channel_num; //number of channel -+ u64 rfe_type; //rfe_type && 0x00000000000000ff -+ pno_scan_channel_info_t ssid_channel_info[MAX_SCAN_LIST_COUNT]; -+}pno_scan_info_t; -+#endif //CONFIG_PNO_SUPPORT -+ +struct pwrctrl_priv +{ + _pwrlock lock; -+ _pwrlock check_32k_lock; + volatile u8 rpwm; // requested power state for fw + volatile u8 cpwm; // fw current power state. updated when 1. read from HCPWM 2. driver lowers power level + volatile u8 tog; // toggling @@ -334545,7 +150609,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl + u8 pwr_mode; + u8 smart_ps; + u8 bcn_ant_mode; -+ u8 dtim; + + u32 alives; + _workitem cpwm_event; @@ -334554,7 +150617,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl + _workitem rpwmtimeoutwi; + _timer pwr_rpwm_timer; +#endif // CONFIG_LPS_RPWM_TIMER -+ u8 bpower_saving; //for LPS/IPS ++ u8 bpower_saving; + + u8 b_hw_radio_off; + u8 reg_rfoff; @@ -334565,33 +150628,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl + u32 cur_ps_level; + u32 reg_rfps_level; + -+ uint ips_enter_cnts; -+ uint ips_leave_cnts; -+ uint lps_enter_cnts; -+ uint lps_leave_cnts; ++ uint ips_enter_cnts; ++ uint ips_leave_cnts; + -+ u8 ips_mode; -+ u8 ips_org_mode; ++ u8 ips_mode; + u8 ips_mode_req; // used to accept the mode setting request, will update to ipsmode later + uint bips_processing; + u32 ips_deny_time; /* will deny IPS when system time is smaller than this */ -+ u8 pre_ips_type;// 0: default flow, 1: carddisbale flow -+ -+ // ps_deny: if 0, power save is free to go; otherwise deny all kinds of power save. -+ // Use PS_DENY_REASON to decide reason. -+ // Don't access this variable directly without control function, -+ // and this variable should be protected by lock. -+ u32 ps_deny; -+ + u8 ps_processing; /* temporarily used to mark whether in rtw_ps_processor */ + -+ u8 fw_psmode_iface_id; + u8 bLeisurePs; + u8 LpsIdleCount; + u8 power_mgnt; -+ u8 org_power_mgnt; + u8 bFwCurrentInPSMode; + u32 DelayLPSLastTimeStamp; ++ u8 btcoex_rfon; + s32 pnp_current_pwr_state; + u8 pnp_bstop_trx; + @@ -334602,41 +150653,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl + u8 bAutoResume; + u8 autopm_cnt; +#endif -+ u8 bSupportRemoteWakeup; -+ u8 wowlan_wake_reason; -+ u8 wowlan_ap_mode; -+ u8 wowlan_mode; -+ u8 wowlan_p2p_mode; -+ u8 wowlan_pno_enable; -+#ifdef CONFIG_GPIO_WAKEUP -+ u8 is_high_active; -+#endif /* CONFIG_GPIO_WAKEUP */ ++ u8 bSupportRemoteWakeup; +#ifdef CONFIG_WOWLAN -+ u8 wowlan_txpause_status; ++ u8 wowlan_mode; + u8 wowlan_pattern; ++ u8 wowlan_magic; ++ u8 wowlan_unicast; + u8 wowlan_pattern_idx; -+ u64 wowlan_fw_iv; -+ struct rtl_priv_pattern patterns[MAX_WKFM_NUM]; -+#ifdef CONFIG_PNO_SUPPORT -+ u8 pno_in_resume; -+ u8 pno_inited; -+ pno_nlo_info_t *pnlo_info; -+ pno_scan_info_t *pscan_info; -+ pno_ssid_list_t *pno_ssid_list; -+#endif /* CONFIG_PNO_SUPPORT */ -+#endif /* CONFIG_WOWLAN */ -+ _timer pwr_state_check_timer; ++ u8 wowlan_wake_reason; ++ u32 wowlan_pattern_context[8][5]; ++#endif // CONFIG_WOWLAN ++ _timer pwr_state_check_timer; + int pwr_state_check_interval; + u8 pwr_state_check_cnts; + -+ int ps_flag; /* used by autosuspend */ -+ -+ rt_rf_power_state rf_pwrstate;//cur power state, only for IPS -+ //rt_rf_power_state current_rfpwrstate; ++ int ps_flag; ++ ++ rt_rf_power_state rf_pwrstate;//cur power state ++ //rt_rf_power_state current_rfpwrstate; + rt_rf_power_state change_rfpwrstate; + -+ u8 bHWPowerdown; /* power down mode selection. 0:radio off, 1:power down */ -+ u8 bHWPwrPindetect; /* come from registrypriv.hwpwrp_detect. enable power down function. 0:disable, 1:enable */ ++ u8 wepkeymask; ++ u8 bHWPowerdown;//if support hw power down ++ u8 bHWPwrPindetect; + u8 bkeepfwalive; + u8 brfoffbyhw; + unsigned long PS_BBRegBackup[PSBBREG_TOTALCNT]; @@ -334650,7 +150689,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl + struct early_suspend early_suspend; + u8 do_late_resume; + #endif //CONFIG_HAS_EARLYSUSPEND -+ ++ + #ifdef CONFIG_ANDROID_POWER + android_early_suspend_t early_suspend; + u8 do_late_resume; @@ -334661,29 +150700,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl + #endif +}; + -+#define rtw_get_ips_mode_req(pwrctl) \ -+ (pwrctl)->ips_mode_req ++#define rtw_get_ips_mode_req(pwrctrlpriv) \ ++ (pwrctrlpriv)->ips_mode_req + -+#define rtw_ips_mode_req(pwrctl, ips_mode) \ -+ (pwrctl)->ips_mode_req = (ips_mode) ++#define rtw_ips_mode_req(pwrctrlpriv, ips_mode) \ ++ (pwrctrlpriv)->ips_mode_req = (ips_mode) + +#define RTW_PWR_STATE_CHK_INTERVAL 2000 + -+#define _rtw_set_pwr_state_check_timer(pwrctl, ms) \ ++#define _rtw_set_pwr_state_check_timer(pwrctrlpriv, ms) \ + do { \ -+ /*DBG_871X("%s _rtw_set_pwr_state_check_timer(%p, %d)\n", __FUNCTION__, (pwrctl), (ms));*/ \ -+ _set_timer(&(pwrctl)->pwr_state_check_timer, (ms)); \ ++ /*DBG_871X("%s _rtw_set_pwr_state_check_timer(%p, %d)\n", __FUNCTION__, (pwrctrlpriv), (ms));*/ \ ++ _set_timer(&(pwrctrlpriv)->pwr_state_check_timer, (ms)); \ + } while(0) -+ -+#define rtw_set_pwr_state_check_timer(pwrctl) \ -+ _rtw_set_pwr_state_check_timer((pwrctl), (pwrctl)->pwr_state_check_interval) ++ ++#define rtw_set_pwr_state_check_timer(pwrctrlpriv) \ ++ _rtw_set_pwr_state_check_timer((pwrctrlpriv), (pwrctrlpriv)->pwr_state_check_interval) + +extern void rtw_init_pwrctrl_priv(_adapter *adapter); +extern void rtw_free_pwrctrl_priv(_adapter * adapter); + +#ifdef CONFIG_LPS_LCLK -+s32 rtw_register_task_alive(PADAPTER, u32 task); -+void rtw_unregister_task_alive(PADAPTER, u32 task); +extern s32 rtw_register_tx_alive(PADAPTER padapter); +extern void rtw_unregister_tx_alive(PADAPTER padapter); +extern s32 rtw_register_rx_alive(PADAPTER padapter); @@ -334696,12 +150733,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl +extern void LPS_Leave_check(PADAPTER padapter); +#endif + ++extern void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode); ++extern void rtw_set_rpwm(_adapter * padapter, u8 val8); +extern void LeaveAllPowerSaveMode(PADAPTER Adapter); -+extern void LeaveAllPowerSaveModeDirect(PADAPTER Adapter); +#ifdef CONFIG_IPS -+void _ips_enter(_adapter * padapter); +void ips_enter(_adapter * padapter); -+int _ips_leave(_adapter * padapter); +int ips_leave(_adapter * padapter); +#endif + @@ -334715,16 +150751,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl +#endif + + -+int rtw_fw_ps_state(PADAPTER padapter); -+ +#ifdef CONFIG_LPS +s32 LPS_RF_ON_check(PADAPTER padapter, u32 delay_ms); -+void LPS_Enter(PADAPTER padapter, const char *msg); -+void LPS_Leave(PADAPTER padapter, const char *msg); -+void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets); -+void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode, const char *msg); -+void rtw_set_fw_in_ips_mode(PADAPTER padapter, u8 enable); -+void rtw_set_rpwm(_adapter * padapter, u8 val8); ++void LPS_Enter(PADAPTER padapter); ++void LPS_Leave(PADAPTER padapter); +#endif + +#ifdef CONFIG_RESUME_IN_WORKQUEUE @@ -334738,8 +150768,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl +void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv); +void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv); +#else -+#define rtw_is_earlysuspend_registered(pwrpriv) _FALSE -+#define rtw_is_do_late_resume(pwrpriv) _FALSE ++#define rtw_is_earlysuspend_registered(pwrpriv) false ++#define rtw_is_do_late_resume(pwrpriv) false +#define rtw_set_do_late_resume(pwrpriv, enable) do {} while (0) +#define rtw_register_early_suspend(pwrpriv) do {} while (0) +#define rtw_unregister_early_suspend(pwrpriv) do {} while (0) @@ -334753,32 +150783,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux/3rdparty/rtl +int rtw_pm_set_ips(_adapter *padapter, u8 mode); +int rtw_pm_set_lps(_adapter *padapter, u8 mode); + -+void rtw_ps_deny(PADAPTER padapter, PS_DENY_REASON reason); -+void rtw_ps_deny_cancel(PADAPTER padapter, PS_DENY_REASON reason); -+u32 rtw_ps_deny_get(PADAPTER padapter); -+ -+#if defined(CONFIG_WOWLAN) -+void rtw_get_current_ip_address(PADAPTER padapter, u8 *pcurrentip); -+void rtw_get_sec_iv(PADAPTER padapter, u8 *pcur_dot11txpn, u8 *StaAddr); -+void rtw_set_sec_pn(_adapter *padapter); -+bool rtw_check_pattern_valid(u8 *input, u8 len); -+bool rtw_write_to_frame_mask(_adapter *adapter, u8 idx, -+ struct rtl_wow_pattern *content); -+ -+bool rtw_read_from_frame_mask(_adapter *adapter, u8 idx); -+void rtw_dump_priv_pattern(_adapter *adapter, u8 idx); -+void rtw_clean_pattern(_adapter *adapter); -+#endif /* CONFIG_WOWLAN */ +#endif //__RTL871X_PWRCTRL_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_qos.h linux/3rdparty/rtl8812au/include/rtw_qos.h ---- linux.old/3rdparty/rtl8812au/include/rtw_qos.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_qos.h 2017-06-07 23:07:21.043690492 +0300 -@@ -0,0 +1,35 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_qos.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_qos.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_qos.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_qos.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,29 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -334788,11 +150801,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_qos.h linux/3rdparty/rtl8812 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ + + @@ -334802,18 +150810,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_qos.h linux/3rdparty/rtl8812 + + +struct qos_priv { -+ -+ unsigned int qos_option; //bit mask option: u-apsd, s-apsd, ts, block ack... ++ ++ unsigned int qos_option; //bit mask option: u-apsd, s-apsd, ts, block ack... + +}; + + +#endif //_RTL871X_QOS_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl8812au/include/rtw_recv.h ---- linux.old/3rdparty/rtl8812au/include/rtw_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_recv.h 2017-06-07 23:07:21.043690492 +0300 -@@ -0,0 +1,877 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_recv.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_recv.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_recv.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_recv.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,676 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. @@ -334827,47 +150834,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef _RTW_RECV_H_ +#define _RTW_RECV_H_ + -+#ifdef PLATFORM_OS_XP -+ #ifdef CONFIG_SDIO_HCI -+ #define NR_RECVBUFF 1024//512//128 -+ #else -+ #define NR_RECVBUFF (16) -+ #endif -+#elif defined(PLATFORM_OS_CE) -+ #ifdef CONFIG_SDIO_HCI -+ #define NR_RECVBUFF (128) -+ #else -+ #define NR_RECVBUFF (4) -+ #endif -+#else //PLATFORM_LINUX /PLATFORM_BSD ++#ifdef CONFIG_SINGLE_RECV_BUF ++ #define NR_RECVBUFF (1) ++#else ++ #define NR_RECVBUFF (4) ++#endif //CONFIG_SINGLE_RECV_BUF + -+ #ifdef CONFIG_SINGLE_RECV_BUF -+ #define NR_RECVBUFF (1) -+ #else -+ #if defined(CONFIG_GSPI_HCI) -+ #define NR_RECVBUFF (32) -+ #elif defined(CONFIG_SDIO_HCI) -+ #define NR_RECVBUFF (8) -+ #else -+ #define NR_RECVBUFF (8) -+ #endif -+ #endif //CONFIG_SINGLE_RECV_BUF -+ #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ #define NR_PREALLOC_RECV_SKB (rtw_rtkm_get_nr_recv_skb()>>1) -+ #else /*!CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ #define NR_PREALLOC_RECV_SKB 8 -+ #endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ -+#endif ++#define NR_PREALLOC_RECV_SKB (8) + +#define NR_RECVFRAME 256 + @@ -334879,7 +150856,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 +#define MAX_RXFRAME_CNT 512 +#define MAX_RX_NUMBLKS (32) +#define RECVFRAME_HDR_ALIGN 128 -+#define MAX_CONTINUAL_NORXPACKET_COUNT 1 /* In MAX_CONTINUAL_NORXPACKET_COUNT*2 sec , no rx traffict would issue DELBA*/ ++ + +#define PHY_RSSI_SLID_WIN_MAX 100 +#define PHY_LINKQUALITY_SLID_WIN_MAX 20 @@ -334916,30 +150893,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + u16 indicate_seq;//=wstart_b, init_value=0xffff + u16 wend_b; + u8 wsize_b; -+ u8 ampdu_size; + _queue pending_recvframe_queue; + _timer reordering_ctrl_timer; +}; + +struct stainfo_rxcache { -+ u16 tid_rxseq[16]; ++ u16 tid_rxseq[16]; +/* -+ unsigned short tid0_rxseq; -+ unsigned short tid1_rxseq; -+ unsigned short tid2_rxseq; -+ unsigned short tid3_rxseq; -+ unsigned short tid4_rxseq; -+ unsigned short tid5_rxseq; -+ unsigned short tid6_rxseq; -+ unsigned short tid7_rxseq; -+ unsigned short tid8_rxseq; -+ unsigned short tid9_rxseq; -+ unsigned short tid10_rxseq; -+ unsigned short tid11_rxseq; -+ unsigned short tid12_rxseq; -+ unsigned short tid13_rxseq; -+ unsigned short tid14_rxseq; -+ unsigned short tid15_rxseq; ++ unsigned short tid0_rxseq; ++ unsigned short tid1_rxseq; ++ unsigned short tid2_rxseq; ++ unsigned short tid3_rxseq; ++ unsigned short tid4_rxseq; ++ unsigned short tid5_rxseq; ++ unsigned short tid6_rxseq; ++ unsigned short tid7_rxseq; ++ unsigned short tid8_rxseq; ++ unsigned short tid9_rxseq; ++ unsigned short tid10_rxseq; ++ unsigned short tid11_rxseq; ++ unsigned short tid12_rxseq; ++ unsigned short tid13_rxseq; ++ unsigned short tid14_rxseq; ++ unsigned short tid15_rxseq; +*/ +}; + @@ -334952,92 +150928,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 +}; + +struct signal_stat { -+ u8 update_req; //used to indicate ++ u8 update_req; //used to indicate + u8 avg_val; //avg of valid elements + u32 total_num; //num of valid elements -+ u32 total_val; //sum of valid elements ++ u32 total_val; //sum of valid elements +}; -+/* -+typedef struct _ODM_Phy_Status_Info_ -+{ -+ // -+ // Be care, if you want to add any element please insert between -+ // RxPWDBAll & SignalStrength. -+ // -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ u4Byte RxPWDBAll; -+#else -+ u1Byte RxPWDBAll; -+#endif -+ -+ u1Byte SignalQuality; // in 0-100 index. -+ s1Byte RxMIMOSignalQuality[4]; //per-path's EVM -+ u1Byte RxMIMOEVMdbm[4]; //per-path's EVM dbm -+ -+ u1Byte RxMIMOSignalStrength[4];// in 0~100 index -+ -+ u2Byte Cfo_short[4]; // per-path's Cfo_short -+ u2Byte Cfo_tail[4]; // per-path's Cfo_tail -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ s1Byte RxPower; // in dBm Translate from PWdB -+ s1Byte RecvSignalPower; // Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. -+ u1Byte BTRxRSSIPercentage; -+ u1Byte SignalStrength; // in 0-100 index. -+ -+ u1Byte RxPwr[4]; //per-path's pwdb -+#endif -+ u1Byte RxSNR[4]; //per-path's SNR -+ u1Byte BandWidth; -+ u1Byte btCoexPwrAdjust; -+}ODM_PHY_INFO_T,*PODM_PHY_INFO_T; -+*/ + +struct phy_info -+{ -+ u8 RxPWDBAll; -+ u8 SignalQuality; /* in 0-100 index. */ -+ s8 RxMIMOSignalQuality[4]; /* per-path's EVM */ -+ u8 RxMIMOEVMdbm[4]; /* per-path's EVM dbm */ -+ u8 RxMIMOSignalStrength[4]; /* in 0~100 index */ -+ s16 Cfo_short[4]; /* per-path's Cfo_short */ -+ s16 Cfo_tail[4]; /* per-path's Cfo_tail */ -+ s8 RxPower; /* in dBm Translate from PWdB */ -+ s8 RecvSignalPower; /* Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. */ -+ u8 BTRxRSSIPercentage; -+ u8 SignalStrength; /* in 0-100 index. */ -+ s8 RxPwr[4]; /* per-path's pwdb */ -+ s8 RxSNR[4]; -+#if (RTL8822B_SUPPORT == 1) -+ u8 RxCount:2; -+ u8 BandWidth:2; -+ u8 rxsc:4; -+#else -+ u8 BandWidth; -+#endif -+ u8 btCoexPwrAdjust; -+#if (RTL8822B_SUPPORT == 1) -+ u8 channel; /* channel number---*/ -+ BOOLEAN bMuPacket; /* is MU packet or not---*/ -+ BOOLEAN bBeamformed; -+#endif -+}; -+ -+#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+struct rx_raw_rssi +{ -+ u8 data_rate; -+ u8 pwdball; -+ s8 pwr_all; -+ -+ u8 mimo_signal_strength[4];/* in 0~100 index */ -+ u8 mimo_signal_quality[4]; -+ -+ s8 ofdm_pwr[4]; -+ u8 ofdm_snr[4]; ++ u8 RxPWDBAll; + ++ u8 SignalQuality; // in 0-100 index. ++ s8 RxMIMOSignalQuality[4]; //per-path's EVM ++ u8 RxMIMOEVMdbm[4]; //per-path's EVM dbm ++ ++ u8 RxMIMOSignalStrength[4];// in 0~100 index ++ ++ u16 Cfo_short[4]; // per-path's Cfo_short ++ u16 Cfo_tail[4]; // per-path's Cfo_tail ++ ++ s8 RxPower; // in dBm Translate from PWdB ++ s8 RecvSignalPower;// Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. ++ u8 BTRxRSSIPercentage; ++ u8 SignalStrength; // in 0-100 index. ++ ++ u8 RxPwr[4]; //per-path's pwdb ++ u8 RxSNR[4]; //per-path's SNR ++ u8 BandWidth; ++ u8 btCoexPwrAdjust; +}; -+#endif ++ + +struct rx_pkt_attrib { + u16 pkt_len; @@ -335045,8 +150965,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + u8 drvinfo_sz; + u8 shift_sz; + u8 hdrlen; //the WLAN Header Len -+ u8 to_fr_ds; -+ u8 amsdu; ++ u8 to_fr_ds; ++ u8 amsdu; + u8 qos; + u8 priority; + u8 pw_save; @@ -335065,35 +150985,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + + u16 eth_type; + -+ u8 dst[ETH_ALEN]; -+ u8 src[ETH_ALEN]; -+ u8 ta[ETH_ALEN]; -+ u8 ra[ETH_ALEN]; -+ u8 bssid[ETH_ALEN]; -+ ++ u8 dst[ETH_ALEN]; ++ u8 src[ETH_ALEN]; ++ u8 ta[ETH_ALEN]; ++ u8 ra[ETH_ALEN]; ++ u8 bssid[ETH_ALEN]; ++ + u8 ack_policy; -+ ++ +//#ifdef CONFIG_TCP_CSUM_OFFLOAD_RX + u8 tcpchk_valid; // 0: invalid, 1: valid + u8 ip_chkrpt; //0: incorrect, 1: correct + u8 tcp_chkrpt; //0: incorrect, 1: correct +//#endif -+ u8 key_index; ++ u8 key_index; + + u8 data_rate; -+ u8 bw; -+ u8 stbc; -+ u8 ldpc; -+ u8 sgi; -+ u8 pkt_rpt_type; -+ u32 tsfl; ++ u8 sgi; ++ u8 pkt_rpt_type; + u32 MacIDValidEntry[2]; // 64 bits present 64 entry. + +/* + u8 signal_qual; + s8 rx_mimo_signal_qual[2]; + u8 signal_strength; -+ u32 RxPWDBAll; ++ u32 RxPWDBAll; + s32 RecvSignalPower; +*/ + struct phy_info phy_info; @@ -335109,16 +151025,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + +#define RECVBUFF_ALIGN_SZ 8 + -+#if defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A) -+ #ifdef CONFIG_PCI_HCI -+ #define RXDESC_SIZE 16 -+ #define RX_WIFI_INFO_SIZE 24 -+ #else -+ #define RXDESC_SIZE 24 -+ #endif -+#else +#define RXDESC_SIZE 24 -+#endif +#define RXDESC_OFFSET RXDESC_SIZE + +struct recv_stat @@ -335127,41 +151034,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + + unsigned int rxdw1; + -+#if !((defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A)) && defined(CONFIG_PCI_HCI)) /* exclude 8192ee, 8814ae */ + unsigned int rxdw2; + + unsigned int rxdw3; -+#endif + -+#ifndef BUF_DESC_ARCH + unsigned int rxdw4; + + unsigned int rxdw5; -+ -+#ifdef CONFIG_PCI_HCI -+ unsigned int rxdw6; -+ -+ unsigned int rxdw7; -+#endif -+#endif //if BUF_DESC_ARCH is defined, rx_buf_desc occupy 4 double words +}; + +#define EOR BIT(30) + -+#ifdef CONFIG_PCI_HCI -+#define PCI_MAX_RX_QUEUE 1// MSDU packet queue, Rx Command Queue -+#define PCI_MAX_RX_COUNT 128 -+ -+struct rtw_rx_ring { -+ struct recv_stat *desc; -+ dma_addr_t dma; -+ unsigned int idx; -+ struct sk_buff *rx_buf[PCI_MAX_RX_COUNT]; -+}; -+#endif -+ -+ -+ +/* +accesser of recv_priv: rtw_recv_entry(dispatch / passive level); recv_thread(passive) ; returnpkt(dispatch) +; halt(passive) ; @@ -335190,50 +151073,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + + _adapter *adapter; + -+#ifdef PLATFORM_WINDOWS -+ _nic_hdl RxPktPoolHdl; -+ _nic_hdl RxBufPoolHdl; -+ -+#ifdef PLATFORM_OS_XP -+ PMDL pbytecnt_mdl; -+#endif -+ uint counter; //record the number that up-layer will return to drv; only when counter==0 can we release recv_priv -+ NDIS_EVENT recv_resource_evt ; -+#endif -+ + u32 bIsAnyNonBEPkts; + u64 rx_bytes; + u64 rx_pkts; + u64 rx_drop; ++ u64 last_rx_bytes; + + uint rx_icv_err; + uint rx_largepacket_crcerr; + uint rx_smallpacket_crcerr; + uint rx_middlepacket_crcerr; + -+#ifdef CONFIG_USB_HCI -+ //u8 *pallocated_urb_buf; + _sema allrxreturnevt; + uint ff_hwaddr; -+ ATOMIC_T rx_pending_cnt; ++ u8 rx_pending_cnt; + +#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+#ifdef PLATFORM_LINUX + PURB int_in_urb; -+#endif + + u8 *int_in_buf; +#endif //CONFIG_USB_INTERRUPT_IN_PIPE + -+#endif -+#if defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) -+#ifdef PLATFORM_FREEBSD -+ struct task irq_prepare_beacon_tasklet; -+ struct task recv_tasklet; -+#else //PLATFORM_FREEBSD + struct tasklet_struct irq_prepare_beacon_tasklet; + struct tasklet_struct recv_tasklet; -+#endif //PLATFORM_FREEBSD + struct sk_buff_head free_recv_skb_queue; + struct sk_buff_head rx_skb_queue; +#ifdef CONFIG_RX_INDICATE_QUEUE @@ -335241,40 +151103,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + struct ifqueue rx_indicate_queue; +#endif // CONFIG_RX_INDICATE_QUEUE + -+#endif //defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX ++ _queue recv_buf_pending_queue; ++#endif // CONFIG_USE_USB_BUFFER_ALLOC_RX + + u8 *pallocated_recv_buf; + u8 *precv_buf; // 4 alignment + _queue free_recv_buf_queue; + u32 free_recv_buf_queue_cnt; -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) || defined(CONFIG_USB_HCI) -+ _queue recv_buf_pending_queue; -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ // Rx -+ struct rtw_rx_ring rx_ring[PCI_MAX_RX_QUEUE]; -+ int rxringcount; -+ u16 rxbuffersize; -+#endif -+ + //For display the phy informatiom + u8 is_signal_dbg; // for debug + u8 signal_strength_dbg; // for debug -+ ++ s8 rssi; ++ s8 rxpwdb; + u8 signal_strength; + u8 signal_qual; -+ s8 rssi; //translate_percentage_to_dbm(ptarget_wlan->network.PhyInfo.SignalStrength); -+ #ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ struct rx_raw_rssi raw_rssi_info; -+ #endif -+ //s8 rxpwdb; -+ s16 noise; -+ //int RxSNRdB[2]; -+ //s8 RxRssi[2]; -+ //int FalseAlmCnt_all; -+ ++ u8 noise; ++ int RxSNRdB[2]; ++ s8 RxRssi[2]; ++ int FalseAlmCnt_all; + +#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS + _timer signal_stat_timer; @@ -335286,7 +151133,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + struct smooth_rssi_data signal_qual_data; + struct smooth_rssi_data signal_strength_data; +#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ u16 sink_udpport,pre_rtp_rxseq,cur_rtp_rxseq; ++ +}; + +#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS @@ -335329,33 +151176,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + u8 *ptail; + u8 *pend; + -+#ifdef CONFIG_USB_HCI -+ -+ #if defined(PLATFORM_OS_XP)||defined(PLATFORM_LINUX)||defined(PLATFORM_FREEBSD) + PURB purb; + dma_addr_t dma_transfer_addr; /* (in) dma addr for transfer_buffer */ + u32 alloc_sz; -+ #endif -+ -+ #ifdef PLATFORM_OS_XP -+ PIRP pirp; -+ #endif -+ -+ #ifdef PLATFORM_OS_CE -+ USB_TRANSFER usb_transfer_read_port; -+ #endif + + u8 irp_pending; + int transfer_len; + -+#endif -+ -+#ifdef PLATFORM_LINUX + _pkt *pskb; -+#endif -+#ifdef PLATFORM_FREEBSD //skb solution -+ struct sk_buff *pskb; -+#endif //PLATFORM_FREEBSD //skb solution ++ u8 reuse; +}; + + @@ -335457,10 +151286,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + +void rtw_reordering_ctrl_timeout_handler(void *pcontext); + -+void rx_query_phy_status(union recv_frame *rframe, u8 *phy_stat); -+int rtw_inc_and_chk_continual_no_rx_packet(struct sta_info *sta, int tid_index); -+void rtw_reset_continual_no_rx_packet(struct sta_info *sta, int tid_index); -+ +__inline static u8 *get_rxmem(union recv_frame *precvframe) +{ + //always return rx_head... @@ -335547,9 +151372,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + + //used for append sz bytes from ptr to rx_tail, update rx_tail and return the updated rx_tail to the caller + //after putting, rx_tail must be still larger than rx_end. -+ unsigned char * prev_rx_tail; -+ -+ /* DBG_871X("recvframe_put: len=%d\n", sz); */ ++ unsigned char * prev_rx_tail; + + if(precvframe==NULL) + return NULL; @@ -335604,10 +151427,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + + if(precvframe==NULL) + return NULL; -+#ifdef PLATFORM_WINDOWS -+ NdisQueryPacket(precvframe->u.hdr.pkt, NULL, NULL, &buf_desc, NULL); -+#endif -+ + return buf_desc; +} + @@ -335627,13 +151446,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + + u8 * buf_star; + union recv_frame * precv_frame; -+#ifdef PLATFORM_WINDOWS -+ _buffer * buf_desc; -+ uint len; -+ -+ NdisQueryPacket(pkt, NULL, NULL, &buf_desc, &len); -+ NdisQueryBufferSafe(buf_desc, &buf_star, &len, HighPagePriority); -+#endif + precv_frame = rxmem_to_recvframe((unsigned char*)buf_star); + + return precv_frame; @@ -335645,7 +151457,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + + union recv_frame * precv_frame = pkt_to_recvframe(pkt); + -+ return precv_frame->u.hdr.rx_head; ++ return precv_frame->u.hdr.rx_head; + +} + @@ -335655,7 +151467,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 + + union recv_frame * precv_frame =pkt_to_recvframe(pkt); + -+ return precv_frame->u.hdr.rx_data; ++ return precv_frame->u.hdr.rx_data; + +} + @@ -335670,14 +151482,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 +{ + s32 SignalPower; // in dBm. + -+#ifdef CONFIG_SIGNAL_SCALE_MAPPING -+ /* Translate to dBm (x=0.5y-95). */ -+ SignalPower = (s32)((SignalStrengthIndex + 1) >> 1); -+ SignalPower -= 95; -+#else -+ /* Translate to dBm (x=y-100) */ -+ SignalPower = SignalStrengthIndex - 100; -+#endif ++ // Translate to dBm (x=0.5y-95). ++ SignalPower = (s32)((SignalStrengthIndex + 1) >> 1); ++ SignalPower -= 95; + + return SignalPower; +} @@ -335690,15 +151497,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_recv.h linux/3rdparty/rtl881 +extern void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame); + +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_rf.h linux/3rdparty/rtl8812au/include/rtw_rf.h ---- linux.old/3rdparty/rtl8812au/include/rtw_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_rf.h 2017-06-07 23:07:21.043690492 +0300 -@@ -0,0 +1,217 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_rf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_rf.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_rf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_rf.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,183 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -335708,13 +151514,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_rf.h linux/3rdparty/rtl8812a + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ -+#ifndef __RTW_RF_H_ ++#ifndef __RTW_RF_H_ +#define __RTW_RF_H_ + + @@ -335741,31 +151542,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_rf.h linux/3rdparty/rtl8812a +#define MAX_CHANNEL_NUM_5G 24 +#define MAX_CHANNEL_NUM 38//14+24 + -+#define CENTER_CH_2G_NUM 14 -+#define CENTER_CH_5G_20M_NUM 28 /* 20M center channels */ -+#define CENTER_CH_5G_40M_NUM 14 /* 40M center channels */ -+#define CENTER_CH_5G_80M_NUM 7 /* 80M center channels */ -+#define CENTER_CH_5G_ALL_NUM (CENTER_CH_5G_20M_NUM + CENTER_CH_5G_40M_NUM + CENTER_CH_5G_80M_NUM) -+ -+extern u8 center_ch_5g_20m[CENTER_CH_5G_20M_NUM]; -+extern u8 center_ch_5g_40m[CENTER_CH_5G_40M_NUM]; -+extern u8 center_ch_5g_80m[CENTER_CH_5G_80M_NUM]; -+extern u8 center_ch_5g_all[CENTER_CH_5G_ALL_NUM]; -+ +//#define NUM_REGULATORYS 21 +#define NUM_REGULATORYS 1 + +//Country codes +#define USA 0x555320 -+#define EUROPE 0x1 //temp, should be provided later -+#define JAPAN 0x2 //temp, should be provided later ++#define EUROPE 0x1 //temp, should be provided later ++#define JAPAN 0x2 //temp, should be provided later + +struct regulatory_class { -+ u32 starting_freq; //MHz, ++ u32 starting_freq; //MHz, + u8 channel_set[MAX_CHANNEL_NUM]; + u8 channel_cck_power[MAX_CHANNEL_NUM];//dbm + u8 channel_ofdm_power[MAX_CHANNEL_NUM];//dbm -+ u8 txpower_limit; //dbm ++ u8 txpower_limit; //dbm + u8 channel_spacing; //MHz + u8 modem; +}; @@ -335807,14 +151597,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_rf.h linux/3rdparty/rtl8812a + RTL8712_RFCONFIG_2T2R=0x22 +}; + -+typedef enum _RF_PATH { -+ RF_PATH_A = 0, -+ RF_PATH_B = 1, -+ RF_PATH_C = 2, -+ RF_PATH_D = 3, -+} RF_PATH, *PRF_PATH; + -+const char rf_path_char(u8 path); ++typedef enum _RF90_RADIO_PATH{ ++ RF90_PATH_A = 0, //Radio Path A ++ RF90_PATH_B = 1, //Radio Path B ++ RF90_PATH_C = 2, //Radio Path C ++ RF90_PATH_D = 3 //Radio Path D ++ //RF90_PATH_MAX //Max RF number 90 support ++}RF90_RADIO_PATH_E, *PRF90_RADIO_PATH_E; + +// Bandwidth Offset +#define HAL_PRIME_CHNL_OFFSET_DONT_CARE 0 @@ -335832,8 +151622,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_rf.h linux/3rdparty/rtl8812a + CHANNEL_WIDTH_MAX = 5, +}CHANNEL_WIDTH, *PCHANNEL_WIDTH; + -+const char *ch_width_str(u8 bw); -+ +// +// Represent Extention Channel Offset in HT Capabilities +// This is available only in 40Mhz mode. @@ -335865,6 +151653,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_rf.h linux/3rdparty/rtl8812a + PROTECTION_MODE_FORCE_DISABLE = 2, +}PROTECTION_MODE, *PPROTECTION_MODE; + ++#define LDPC_VHT_ENABLE_RX BIT0 ++#define LDPC_VHT_ENABLE_TX BIT1 ++#define LDPC_VHT_TEST_TX_ENABLE BIT2 ++#define LDPC_VHT_CAP_TX BIT3 ++ ++#define STBC_VHT_ENABLE_RX BIT0 ++#define STBC_VHT_ENABLE_TX BIT1 ++#define STBC_VHT_TEST_TX_ENABLE BIT2 ++#define STBC_VHT_CAP_TX BIT3 ++ ++#define BEAMFORMING_VHT_BEAMFORMER_ENABLE BIT0 // Declare our NIC supports beamformer ++#define BEAMFORMING_VHT_BEAMFORMEE_ENABLE BIT1 // Declare our NIC supports beamformee ++#define BEAMFORMING_VHT_BEAMFORMER_TEST BIT2 // Transmiting Beamforming no matter the target supports it or not ++ ++/* 2007/11/15 MH Define different RF type. */ +typedef enum _RT_RF_TYPE_DEFINITION +{ + RF_1T2R = 0, @@ -335872,54 +151675,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_rf.h linux/3rdparty/rtl8812a + RF_2T2R = 2, + RF_1T1R = 3, + RF_2T2R_GREEN = 4, -+ RF_2T3R = 5, -+ RF_3T3R = 6, -+ RF_3T4R = 7, -+ RF_4T4R = 8, -+ -+ RF_MAX_TYPE = 0xF, /* u1Byte */ ++ RF_MAX_TYPE = 5, +}RT_RF_TYPE_DEF_E; + -+int rtw_ch2freq(int chan); -+int rtw_freq2ch(int freq); -+bool rtw_chbw_to_freq_range(u8 ch, u8 bw, u8 offset, u32 *hi, u32 *lo); + -+int rtw_get_chplan_from_country(const char *country_code); ++u32 rtw_ch2freq(u32 ch); ++u32 rtw_freq2ch(u32 freq); + -+#define BB_GAIN_2G 0 -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+#define BB_GAIN_5GLB1 1 -+#define BB_GAIN_5GLB2 2 -+#define BB_GAIN_5GMB1 3 -+#define BB_GAIN_5GMB2 4 -+#define BB_GAIN_5GHB 5 -+#endif -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+#define BB_GAIN_NUM 6 -+#else -+#define BB_GAIN_NUM 1 -+#endif -+ -+int rtw_ch_to_bb_gain_sel(int ch); -+void rtw_rf_set_tx_gain_offset(_adapter *adapter, u8 path, s8 offset); -+void rtw_rf_apply_tx_gain_offset(_adapter *adapter, u8 ch); -+ -+bool rtw_is_dfs_range(u32 hi, u32 lo); -+bool rtw_is_dfs_ch(u8 ch, u8 bw, u8 offset); -+bool rtw_is_long_cac_range(u32 hi, u32 lo); -+bool rtw_is_long_cac_ch(u8 ch, u8 bw, u8 offset); + +#endif //_RTL8711_RF_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rtl8812au/include/rtw_security.h ---- linux.old/3rdparty/rtl8812au/include/rtw_security.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_security.h 2017-06-07 23:07:21.043690492 +0300 -@@ -0,0 +1,490 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_security.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_security.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_security.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_security.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,420 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -335929,11 +151701,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __RTW_SECURITY_H_ +#define __RTW_SECURITY_H_ @@ -335947,18 +151714,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt +#define _WEP104_ 0x5 +#define _WEP_WPA_MIXED_ 0x07 // WEP + WPA +#define _SMS4_ 0x06 -+#ifdef CONFIG_IEEE80211W -+#define _BIP_ 0x8 -+#endif //CONFIG_IEEE80211W -+/* 802.11W use wrong key */ -+#define IEEE80211W_RIGHT_KEY 0x0 -+#define IEEE80211W_WRONG_KEY 0x1 -+#define IEEE80211W_NO_KEY 0x2 + +#define is_wep_enc(alg) (((alg) == _WEP40_) || ((alg) == _WEP104_)) + -+const char *security_type_str(u8 value); -+ +#define _WPA_IE_ID_ 0xdd +#define _WPA2_IE_ID_ 0x30 + @@ -335966,10 +151724,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt +#define AES_BLOCK_SIZE 16 +#define AES_PRIV_SIZE (4 * 44) + -+#define RTW_KEK_LEN 16 -+#define RTW_KCK_LEN 16 -+#define RTW_REPLAY_CTR_LEN 8 -+ +typedef enum { + ENCRYP_PROTOCOL_OPENSYS, //open system + ENCRYP_PROTOCOL_WEP, //WEP @@ -335989,10 +151743,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt +#endif + +union pn48 { -+ ++ + u64 val; -+ -+#ifdef CONFIG_LITTLE_ENDIAN ++ ++#ifdef __LITTLE_ENDIAN + +struct { + u8 TSC0; @@ -336004,8 +151758,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt + u8 TSC6; + u8 TSC7; +} _byte_; -+ -+#elif defined(CONFIG_BIG_ENDIAN) ++ ++#else + +struct { + u8 TSC7; @@ -336017,7 +151771,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt + u8 TSC1; + u8 TSC0; +} _byte_; -+ ++ +#endif + +}; @@ -336031,80 +151785,67 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt +typedef struct _RT_PMKID_LIST +{ + u8 bUsed; -+ u8 Bssid[6]; ++ u8 Bssid[6]; + u8 PMKID[16]; + u8 SsidBuf[33]; + u8* ssid_octet; -+ u16 ssid_length; ++ u16 ssid_length; +} RT_PMKID_LIST, *PRT_PMKID_LIST; + + +struct security_priv +{ -+ u32 dot11AuthAlgrthm; // 802.11 auth, could be open, shared, 8021x and authswitch ++ u32 dot11AuthAlgrthm; // 802.11 auth, could be open, shared, 8021x and authswitch + u32 dot11PrivacyAlgrthm; // This specify the privacy for shared auth. algorithm. + + /* WEP */ + u32 dot11PrivacyKeyIndex; // this is only valid for legendary wep, 0~3 for key id. (tx key index) -+ union Keytype dot11DefKey[4]; // this is only valid for def. key -+ u32 dot11DefKeylen[4]; -+ u8 key_mask; /* use to restore wep key after hal_init */ ++ union Keytype dot11DefKey[4]; // this is only valid for def. key ++ u32 dot11DefKeylen[4]; + -+ u32 dot118021XGrpPrivacy; // This specify the privacy algthm. used for Grp key ++ u32 dot118021XGrpPrivacy; // This specify the privacy algthm. used for Grp key + u32 dot118021XGrpKeyid; // key id used for Grp Key ( tx key index) -+ union Keytype dot118021XGrpKey[4]; // 802.1x Group Key, for inx0 and inx1 ++ union Keytype dot118021XGrpKey[4]; // 802.1x Group Key, for inx0 and inx1 + union Keytype dot118021XGrptxmickey[4]; + union Keytype dot118021XGrprxmickey[4]; + union pn48 dot11Grptxpn; // PN48 used for Grp Key xmit. + union pn48 dot11Grprxpn; // PN48 used for Grp Key recv. -+#ifdef CONFIG_IEEE80211W -+ u32 dot11wBIPKeyid; // key id used for BIP Key ( tx key index) -+ union Keytype dot11wBIPKey[6]; // BIP Key, for index4 and index5 -+ union pn48 dot11wBIPtxpn; // PN48 used for Grp Key xmit. -+ union pn48 dot11wBIPrxpn; // PN48 used for Grp Key recv. -+#endif //CONFIG_IEEE80211W ++ +#ifdef CONFIG_AP_MODE -+ //extend security capabilities for AP_MODE ++ //extend security capabilities for AP_MODE + unsigned int dot8021xalg;//0:disable, 1:psk, 2:802.1x + unsigned int wpa_psk;//0:disable, bit(0): WPA, bit(1):WPA2 + unsigned int wpa_group_cipher; + unsigned int wpa2_group_cipher; + unsigned int wpa_pairwise_cipher; -+ unsigned int wpa2_pairwise_cipher; ++ unsigned int wpa2_pairwise_cipher; +#endif + + u8 wps_ie[MAX_WPS_IE_LEN];//added in assoc req + int wps_ie_len; -+ -+ ++ ++ + u8 binstallGrpkey; -+#ifdef CONFIG_GTK_OL -+ u8 binstallKCK_KEK; -+#endif //CONFIG_GTK_OL -+#ifdef CONFIG_IEEE80211W -+ u8 binstallBIPkey; -+#endif //CONFIG_IEEE80211W + u8 busetkipkey; + //_timer tkip_timer; + u8 bcheck_grpkey; + u8 bgrpkey_handshake; -+ ++ + //u8 packet_cnt;//unused, removed -+ ++ + s32 sw_encrypt;//from registry_priv + s32 sw_decrypt;//from registry_priv -+ -+ s32 hw_decrypted;//if the rx packets is hw_decrypted==_FALSE, it means the hw has not been ready. ++ ++ s32 hw_decrypted;//if the rx packets is hw_decrypted==false, it means the hw has not been ready. + + + //keeps the auth_type & enc_status from upper layer ioctl(wpa_supplicant or wzc) + u32 ndisauthtype; // NDIS_802_11_AUTHENTICATION_MODE + u32 ndisencryptstatus; // NDIS_802_11_ENCRYPTION_STATUS + ++ WLAN_BSSID_EX sec_bss; //for joinbss (h2c buffer) usage ++ + NDIS_802_11_WEP ndiswep; -+#ifdef PLATFORM_WINDOWS -+ u8 KeyMaterial[16];// variable length depending on above field. -+#endif + + u8 assoc_info[600]; + u8 szofcapability[256]; //for wpa2 usage @@ -336114,7 +151855,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt + + + //for tkip countermeasure -+ u32 last_mic_err_time; ++ u32 last_mic_err_time; + u8 btkip_countermeasure; + u8 btkip_wait_report; + u32 btkip_countermeasure_time; @@ -336130,30 +151871,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt + //u8 szCapability[256]; // For WPA2-PSK using zero-config, by Annie, 2005-09-20. + + u8 bWepDefaultKeyIdxSet; -+ -+#define DBG_SW_SEC_CNT -+#ifdef DBG_SW_SEC_CNT -+ u64 wep_sw_enc_cnt_bc; -+ u64 wep_sw_enc_cnt_mc; -+ u64 wep_sw_enc_cnt_uc; -+ u64 wep_sw_dec_cnt_bc; -+ u64 wep_sw_dec_cnt_mc; -+ u64 wep_sw_dec_cnt_uc; -+ -+ u64 tkip_sw_enc_cnt_bc; -+ u64 tkip_sw_enc_cnt_mc; -+ u64 tkip_sw_enc_cnt_uc; -+ u64 tkip_sw_dec_cnt_bc; -+ u64 tkip_sw_dec_cnt_mc; -+ u64 tkip_sw_dec_cnt_uc; -+ -+ u64 aes_sw_enc_cnt_bc; -+ u64 aes_sw_enc_cnt_mc; -+ u64 aes_sw_enc_cnt_uc; -+ u64 aes_sw_dec_cnt_bc; -+ u64 aes_sw_dec_cnt_mc; -+ u64 aes_sw_dec_cnt_uc; -+#endif /* DBG_SW_SEC_CNT */ +}; + +struct sha256_state { @@ -336183,7 +151900,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt + }\ +}while(0) + -+#define _AES_IV_LEN_ 8 + +#define SET_ICE_IV_LEN( iv_len, icv_len, encrypt)\ +do{\ @@ -336226,7 +151942,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt + + +#define ROL32( A, n ) ( ((A) << (n)) | ( ((A)>>(32-(n))) & ( (1UL << (n)) - 1 ) ) ) -+#define ROR32( A, n ) ROL32( (A), 32-(n) ) ++#define ROR32( A, n ) ROL32( (A), 32-(n) ) + +struct mic_data +{ @@ -336319,7 +152035,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt + (a)[6] = (u8) (((u64) (val)) >> 8); \ + (a)[7] = (u8) (((u64) (val)) & 0xff); \ + } while (0) -+ ++ +/* ===== start - public domain SHA256 implementation ===== */ + +/* This is based on SHA256 implementation in LibTomCrypt that was released into @@ -336348,7 +152064,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt +( ((((unsigned long) (x) & 0xFFFFFFFFUL) >> (unsigned long) ((y) & 31)) | \ + ((unsigned long) (x) << (unsigned long) (32 - ((y) & 31)))) & 0xFFFFFFFFUL) +#define Ch(x,y,z) (z ^ (x & (y ^ z))) -+#define Maj(x,y,z) (((x | y) & z) | (x & y)) ++#define Maj(x,y,z) (((x | y) & z) | (x & y)) +#define S(x, n) RORc((x), (n)) +#define R(x, n) (((x)&0xFFFFFFFFUL)>>(n)) +#define Sigma0(x) (S(x, 2) ^ S(x, 13) ^ S(x, 22)) @@ -336358,9 +152074,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt +#ifndef MIN +#define MIN(x, y) (((x) < (y)) ? (x) : (y)) +#endif -+#ifdef CONFIG_IEEE80211W -+int omac1_aes_128(u8 *key, u8 *data, size_t data_len, u8 *mac); -+#endif //CONFIG_IEEE80211W ++ +void rtw_secmicsetkey(struct mic_data *pmicdata, u8 * key ); +void rtw_secmicappendbyte(struct mic_data *pmicdata, u8 b ); +void rtw_secmicappend(struct mic_data *pmicdata, u8 * src, u32 nBytes ); @@ -336381,39 +152095,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_security.h linux/3rdparty/rt +u32 rtw_aes_decrypt(_adapter *padapter, u8 *precvframe); +u32 rtw_tkip_decrypt(_adapter *padapter, u8 *precvframe); +void rtw_wep_decrypt(_adapter *padapter, u8 *precvframe); -+#ifdef CONFIG_IEEE80211W -+u32 rtw_BIP_verify(_adapter *padapter, u8 *precvframe); -+#endif //CONFIG_IEEE80211W ++ +#ifdef CONFIG_TDLS -+void wpa_tdls_generate_tpk(_adapter *padapter, PVOID sta); -+int wpa_tdls_ftie_mic(u8 *kck, u8 trans_seq, ++void wpa_tdls_generate_tpk(_adapter *padapter, struct sta_info *psta); ++int wpa_tdls_ftie_mic(u8 *kck, u8 trans_seq, + u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie, + u8 *mic); -+int wpa_tdls_teardown_ftie_mic(u8 *kck, u8 *lnkid, u16 reason, -+ u8 dialog_token, u8 trans_seq, u8 *ftie, u8 *mic); -+int tdls_verify_mic(u8 *kck, u8 trans_seq, ++int tdls_verify_mic(u8 *kck, u8 trans_seq, + u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie); +#endif //CONFIG_TDLS + +void rtw_use_tkipkey_handler(RTW_TIMER_HDL_ARGS); + -+void rtw_sec_restore_wep_key(_adapter *adapter); -+u8 rtw_handle_tkip_countermeasure(_adapter* adapter, const char *caller); -+ -+#ifdef CONFIG_WOWLAN -+u16 rtw_calc_crc(u8 *pdata, int length); -+#endif /*CONFIG_WOWLAN*/ -+ +#endif //__RTL871X_SECURITY_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_sreset.h linux/3rdparty/rtl8812au/include/rtw_sreset.h ---- linux.old/3rdparty/rtl8812au/include/rtw_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_sreset.h 2017-06-07 23:07:21.043690492 +0300 -@@ -0,0 +1,61 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_sreset.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_sreset.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_sreset.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_sreset.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,55 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -336423,11 +152125,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_sreset.h linux/3rdparty/rtl8 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef _RTW_SRESET_H_ +#define _RTW_SRESET_H_ @@ -336441,8 +152138,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_sreset.h linux/3rdparty/rtl8 +}; + +struct sreset_priv { -+ _mutex silentreset_mutex; -+ u8 silent_reset_inprogress; ++ _mutex silentreset_mutex; ++ u8 silent_reset_inprogress; + u8 Wifi_Error_Status; + unsigned long last_tx_time; + unsigned long last_tx_complete_time; @@ -336452,14 +152149,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_sreset.h linux/3rdparty/rtl8 + + + -+#define WIFI_STATUS_SUCCESS 0 -+#define USB_VEN_REQ_CMD_FAIL BIT0 -+#define USB_READ_PORT_FAIL BIT1 ++#define WIFI_STATUS_SUCCESS 0 ++#define USB_VEN_REQ_CMD_FAIL BIT0 ++#define USB_READ_PORT_FAIL BIT1 +#define USB_WRITE_PORT_FAIL BIT2 -+#define WIFI_MAC_TXDMA_ERROR BIT3 ++#define WIFI_MAC_TXDMA_ERROR BIT3 +#define WIFI_TX_HANG BIT4 +#define WIFI_RX_HANG BIT5 -+#define WIFI_IF_NOT_EXIST BIT6 ++#define WIFI_IF_NOT_EXIST BIT6 + +void sreset_init_value(_adapter *padapter); +void sreset_reset_value(_adapter *padapter); @@ -336470,173 +152167,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_sreset.h linux/3rdparty/rtl8 +void sreset_reset(_adapter *padapter); + +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_tdls.h linux/3rdparty/rtl8812au/include/rtw_tdls.h ---- linux.old/3rdparty/rtl8812au/include/rtw_tdls.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_tdls.h 2017-06-07 23:07:21.043690492 +0300 -@@ -0,0 +1,149 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_TDLS_H_ -+#define __RTW_TDLS_H_ -+ -+ -+#ifdef CONFIG_TDLS -+/* TDLS STA state */ -+ -+ -+/* TDLS Diect Link Establishment */ -+#define TDLS_STATE_NONE 0x00000000 /* Default state */ -+#define TDLS_INITIATOR_STATE BIT(28) /* 0x10000000 */ -+#define TDLS_RESPONDER_STATE BIT(29) /* 0x20000000 */ -+#define TDLS_LINKED_STATE BIT(30) /* 0x40000000 */ -+/* TDLS PU Buffer STA */ -+#define TDLS_WAIT_PTR_STATE BIT(24) /* 0x01000000 */ /* Waiting peer's TDLS_PEER_TRAFFIC_RESPONSE frame */ -+/* TDLS Check ALive */ -+#define TDLS_ALIVE_STATE BIT(20) /* 0x00100000 */ /* Check if peer sta is alived. */ -+/* TDLS Channel Switch */ -+#define TDLS_CH_SWITCH_ON_STATE BIT(16) /* 0x00010000 */ -+#define TDLS_PEER_AT_OFF_STATE BIT(17) /* 0x00020000 */ /* Could send pkt on target ch */ -+#define TDLS_CH_SW_INITIATOR_STATE BIT(18) /* 0x00040000 */ /* Avoid duplicated or unconditional ch. switch rsp. */ -+#define TDLS_WAIT_CH_RSP_STATE BIT(19) /* 0x00080000 */ /* Wait Ch. response as we are TDLS channel switch initiator */ -+ -+ -+#define TPK_RESEND_COUNT 1800 /*Unit: seconds */ -+#define CH_SWITCH_TIME 5 -+#define CH_SWITCH_TIMEOUT 20 -+#define TDLS_SIGNAL_THRESH 0x20 -+#define TDLS_WATCHDOG_PERIOD 10 /* Periodically sending tdls discovery request in TDLS_WATCHDOG_PERIOD * 2 sec */ -+#define TDLS_HANDSHAKE_TIME 3000 -+#define TDLS_PTI_TIME 7000 -+ -+#define TDLS_MIC_LEN 16 -+#define WPA_NONCE_LEN 32 -+#define TDLS_TIMEOUT_LEN 4 -+ -+struct wpa_tdls_ftie { -+ u8 ie_type; /* FTIE */ -+ u8 ie_len; -+ u8 mic_ctrl[2]; -+ u8 mic[TDLS_MIC_LEN]; -+ u8 Anonce[WPA_NONCE_LEN]; /* Responder Nonce in TDLS */ -+ u8 Snonce[WPA_NONCE_LEN]; /* Initiator Nonce in TDLS */ -+ /* followed by optional elements */ -+} ; -+ -+struct wpa_tdls_lnkid { -+ u8 ie_type; /* Link Identifier IE */ -+ u8 ie_len; -+ u8 bssid[ETH_ALEN]; -+ u8 init_sta[ETH_ALEN]; -+ u8 resp_sta[ETH_ALEN]; -+} ; -+ -+static u8 TDLS_RSNIE[20]={ 0x01, 0x00, /* Version shall be set to 1 */ -+ 0x00, 0x0f, 0xac, 0x07, /* Group sipher suite */ -+ 0x01, 0x00, /* Pairwise cipher suite count */ -+ 0x00, 0x0f, 0xac, 0x04, /* Pairwise cipher suite list; CCMP only */ -+ 0x01, 0x00, /* AKM suite count */ -+ 0x00, 0x0f, 0xac, 0x07, /* TPK Handshake */ -+ 0x0c, 0x02, -+ /* PMKID shall not be present */ -+ }; -+ -+static u8 TDLS_WMMIE[]={0x00, 0x50, 0xf2, 0x02, 0x00, 0x01, 0x00}; /* Qos info all set zero */ -+ -+static u8 TDLS_WMM_PARAM_IE[] = {0x00, 0x00, 0x03, 0xa4, 0x00, 0x00, 0x27, 0xa4, 0x00, 0x00, 0x42, 0x43, 0x5e, 0x00, 0x62, 0x32, 0x2f, 0x00}; -+ -+static u8 TDLS_EXT_CAPIE[] = {0x00, 0x00, 0x00, 0x50, 0x20, 0x00, 0x00, 0x00}; /* bit(28), bit(30), bit(37) */ -+ -+/* SRC: Supported Regulatory Classes */ -+static u8 TDLS_SRC[] = { 0x01, 0x01, 0x02, 0x03, 0x04, 0x0c, 0x16, 0x17, 0x18, 0x19, 0x1b, 0x1c, 0x1d, 0x1e, 0x20, 0x21 }; -+ -+int check_ap_tdls_prohibited(u8 *pframe, u8 pkt_len); -+int check_ap_tdls_ch_switching_prohibited(u8 *pframe, u8 pkt_len); -+void rtw_reset_tdls_info(_adapter* padapter); -+int rtw_init_tdls_info(_adapter* padapter); -+void rtw_free_tdls_info(struct tdls_info *ptdlsinfo); -+int issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); -+void rtw_init_tdls_timer(_adapter *padapter, struct sta_info *psta); -+void rtw_free_tdls_timer(struct sta_info *psta); -+void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta); -+#ifdef CONFIG_WFD -+int issue_tunneled_probe_req(_adapter *padapter); -+int issue_tunneled_probe_rsp(_adapter *padapter, union recv_frame *precv_frame); -+#endif /* CONFIG_WFD */ -+int issue_tdls_dis_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt); -+int issue_tdls_setup_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack); -+int issue_tdls_setup_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt); -+int issue_tdls_setup_cfm(_adapter *padapter, struct tdls_txmgmt *ptxmgmt); -+int issue_tdls_dis_rsp(_adapter * padapter, struct tdls_txmgmt *ptxmgmt, u8 privacy); -+int issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack); -+int issue_tdls_peer_traffic_rsp(_adapter *padapter, struct sta_info *psta, struct tdls_txmgmt *ptxmgmt); -+int issue_tdls_peer_traffic_indication(_adapter *padapter, struct sta_info *psta); -+int issue_tdls_ch_switch_req(_adapter *padapter, struct sta_info *ptdls_sta); -+int issue_tdls_ch_switch_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack); -+sint On_TDLS_Dis_Rsp(_adapter *adapter, union recv_frame *precv_frame); -+sint On_TDLS_Setup_Req(_adapter *adapter, union recv_frame *precv_frame); -+int On_TDLS_Setup_Rsp(_adapter *adapter, union recv_frame *precv_frame); -+int On_TDLS_Setup_Cfm(_adapter *adapter, union recv_frame *precv_frame); -+int On_TDLS_Dis_Req(_adapter *adapter, union recv_frame *precv_frame); -+int On_TDLS_Teardown(_adapter *adapter, union recv_frame *precv_frame); -+int On_TDLS_Peer_Traffic_Indication(_adapter *adapter, union recv_frame *precv_frame); -+int On_TDLS_Peer_Traffic_Rsp(_adapter *adapter, union recv_frame *precv_frame); -+#ifdef CONFIG_TDLS_CH_SW -+sint On_TDLS_Ch_Switch_Req(_adapter *adapter, union recv_frame *precv_frame); -+sint On_TDLS_Ch_Switch_Rsp(_adapter *adapter, union recv_frame *precv_frame); -+void rtw_build_tdls_ch_switch_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_ch_switch_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+#endif -+void rtw_build_tdls_setup_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_setup_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_setup_cfm_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_teardown_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_dis_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_dis_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, u8 privacy); -+void rtw_build_tdls_peer_traffic_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_peer_traffic_indication_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tunneled_probe_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); -+void rtw_build_tunneled_probe_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); -+ -+u8 update_sgi_tdls(_adapter *padapter, struct sta_info *psta); -+u32 update_mask_tdls(_adapter *padapter, struct sta_info *psta); -+int rtw_tdls_is_driver_setup(_adapter *padapter); -+void rtw_tdls_set_key(_adapter *padapter, struct sta_info *ptdls_sta); -+const char * rtw_tdls_action_txt(enum TDLS_ACTION_FIELD action); -+#endif /* CONFIG_TDLS */ -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_version.h linux/3rdparty/rtl8812au/include/rtw_version.h ---- linux.old/3rdparty/rtl8812au/include/rtw_version.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_version.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1 @@ -+#define DRIVERVERSION "v4.3.20_16317.20160108" -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_vht.h linux/3rdparty/rtl8812au/include/rtw_vht.h ---- linux.old/3rdparty/rtl8812au/include/rtw_vht.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_vht.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,143 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_tdls.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_tdls.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_tdls.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_tdls.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,136 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -336646,33 +152184,155 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_vht.h linux/3rdparty/rtl8812 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++#ifndef __RTW_TDLS_H_ ++#define __RTW_TDLS_H_ ++ ++ ++#ifdef CONFIG_TDLS ++/* TDLS STA state */ ++#define TDLS_STATE_NONE 0x00000000 //default state ++#define TDLS_INITIATOR_STATE 0x10000000 ++#define TDLS_RESPONDER_STATE 0x20000000 ++#define TDLS_LINKED_STATE 0x40000000 ++#define TDLS_CH_SWITCH_ON_STATE 0x01000000 ++#define TDLS_PEER_AT_OFF_STATE 0x02000000 //could send pkt on target ch ++#define TDLS_AT_OFF_CH_STATE 0x04000000 ++#define TDLS_CH_SW_INITIATOR_STATE 0x08000000 //avoiding duplicated or unconditional ch. switch rsp. ++#define TDLS_APSD_CHSW_STATE 0x00100000 //in APSD and want to setup channel switch ++#define TDLS_PEER_SLEEP_STATE 0x00200000 //peer sta is sleeping ++#define TDLS_SW_OFF_STATE 0x00400000 //terminate channel swithcing ++#define TDLS_ALIVE_STATE 0x00010000 //Check if peer sta is alived. ++ ++#define TPK_RESEND_COUNT 301 ++#define CH_SWITCH_TIME 10 ++#define CH_SWITCH_TIMEOUT 30 ++#define TDLS_STAY_TIME 500 ++#define TDLS_SIGNAL_THRESH 0x20 ++#define TDLS_WATCHDOG_PERIOD 10 //Periodically sending tdls discovery request in TDLS_WATCHDOG_PERIOD * 2 sec ++#define TDLS_ALIVE_TIMER_PH1 5000 ++#define TDLS_ALIVE_TIMER_PH2 2000 ++#define TDLS_STAY_TIME 500 ++#define TDLS_HANDSHAKE_TIME 8000 ++#define TDLS_ALIVE_COUNT 3 ++#define TDLS_INI_MACID_ENTRY 6 ++ ++/* TDLS */ ++#define TDLS_MIC_LEN 16 ++#define WPA_NONCE_LEN 32 ++#define TDLS_TIMEOUT_LEN 4 ++ ++struct wpa_tdls_ftie { ++ u8 ie_type; /* FTIE */ ++ u8 ie_len; ++ u8 mic_ctrl[2]; ++ u8 mic[TDLS_MIC_LEN]; ++ u8 Anonce[WPA_NONCE_LEN]; /* Responder Nonce in TDLS */ ++ u8 Snonce[WPA_NONCE_LEN]; /* Initiator Nonce in TDLS */ ++ /* followed by optional elements */ ++} ; ++ ++struct wpa_tdls_lnkid { ++ u8 ie_type; /* Link Identifier IE */ ++ u8 ie_len; ++ u8 bssid[ETH_ALEN]; ++ u8 init_sta[ETH_ALEN]; ++ u8 resp_sta[ETH_ALEN]; ++} ; ++ ++static u8 TDLS_RSNIE[]={ 0x01, 0x00, //version shall be set to 1 ++ 0x00, 0x0f, 0xac, 0x07, //group sipher suite ++ 0x01, 0x00, //pairwise cipher suite count ++ 0x00, 0x0f, 0xac, 0x04, //pairwise cipher suite list; CCMP only ++ 0x01, 0x00, //AKM suite count ++ 0x00, 0x0f, 0xac, 0x07, //TPK Handshake ++ 0x00, 0x02, ++ //PMKID shall not be present ++ }; ++ ++static u8 TDLS_WMMIE[]={0x00, 0x50, 0xf2, 0x02, 0x00, 0x01, 0x00}; //Qos info all set zero ++ ++static u8 TDLS_EXT_CAPIE[] = {0x00, 0x00, 0x00, 0x50, 0x20}; //bit(28), bit(30), bit(37) ++ ++// SRC: Supported Regulatory Classes ++static u8 TDLS_SRC[] = { 0x01, 0x01, 0x02, 0x03, 0x04, 0x0c, 0x16, 0x17, 0x18, 0x19, 0x1b, 0x1c, 0x1d, 0x1e, 0x20, 0x21 }; ++ ++void rtw_reset_tdls_info(_adapter* padapter); ++int rtw_init_tdls_info(_adapter* padapter); ++void rtw_free_tdls_info(struct tdls_info *ptdlsinfo); ++void issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, struct sta_info *ptdls_sta, unsigned int power_mode); ++void init_TPK_timer(_adapter *padapter, struct sta_info *psta); ++void init_ch_switch_timer(_adapter *padapter, struct sta_info *psta); ++void init_base_ch_timer(_adapter *padapter, struct sta_info *psta); ++void init_off_ch_timer(_adapter *padapter, struct sta_info *psta); ++void init_tdls_alive_timer(_adapter *padapter, struct sta_info *psta); ++void init_handshake_timer(_adapter *padapter, struct sta_info *psta); ++void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta); ++#ifdef CONFIG_WFD ++void issue_tunneled_probe_req(_adapter *padapter); ++void issue_tunneled_probe_rsp(_adapter *padapter, union recv_frame *precv_frame); ++#endif //CONFIG_WFD ++void issue_tdls_dis_req(_adapter *padapter, u8 *mac_addr); ++void issue_tdls_setup_req(_adapter *padapter, u8 *mac_addr); ++void issue_tdls_setup_rsp(_adapter *padapter, union recv_frame *precv_frame); ++void issue_tdls_setup_cfm(_adapter *padapter, union recv_frame *precv_frame); ++void issue_tdls_dis_rsp(_adapter * padapter, union recv_frame * precv_frame, u8 dialog); ++void issue_tdls_teardown(_adapter *padapter, u8 *mac_addr); ++void issue_tdls_peer_traffic_indication(_adapter *padapter, struct sta_info *psta); ++void issue_tdls_ch_switch_req(_adapter *padapter, u8 *mac_addr); ++void issue_tdls_ch_switch_rsp(_adapter *padapter, u8 *mac_addr); ++sint On_TDLS_Dis_Rsp(_adapter *adapter, union recv_frame *precv_frame); ++sint On_TDLS_Setup_Req(_adapter *adapter, union recv_frame *precv_frame); ++sint On_TDLS_Setup_Rsp(_adapter *adapter, union recv_frame *precv_frame); ++sint On_TDLS_Setup_Cfm(_adapter *adapter, union recv_frame *precv_frame); ++sint On_TDLS_Dis_Req(_adapter *adapter, union recv_frame *precv_frame); ++sint On_TDLS_Teardown(_adapter *adapter, union recv_frame *precv_frame); ++sint On_TDLS_Peer_Traffic_Rsp(_adapter *adapter, union recv_frame *precv_frame); ++sint On_TDLS_Ch_Switch_Req(_adapter *adapter, union recv_frame *precv_frame); ++sint On_TDLS_Ch_Switch_Rsp(_adapter *adapter, union recv_frame *precv_frame); ++void rtw_build_tdls_setup_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); ++void rtw_build_tdls_setup_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); ++void rtw_build_tdls_setup_cfm_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); ++void rtw_build_tdls_teardown_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); ++void rtw_build_tdls_dis_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); ++void rtw_build_tdls_dis_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, u8 dialog); ++void rtw_build_tdls_peer_traffic_indication_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); ++void rtw_build_tdls_ch_switch_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); ++void rtw_build_tdls_ch_switch_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); ++void rtw_build_tunneled_probe_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); ++void rtw_build_tunneled_probe_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); ++ ++int update_sgi_tdls(_adapter *padapter, struct sta_info *psta); ++u32 update_mask_tdls(_adapter *padapter, struct sta_info *psta); ++#endif //CONFIG_TDLS ++ ++#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_version.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_version.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_version.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_version.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1 @@ ++#define DRIVERVERSION "v4.2.2_7502.20130517" +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_vht.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_vht.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_vht.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_vht.h 2018-02-06 17:42:30.721967327 +0200 +@@ -0,0 +1,120 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#ifndef _RTW_VHT_H_ +#define _RTW_VHT_H_ + -+#define LDPC_VHT_ENABLE_RX BIT0 -+#define LDPC_VHT_ENABLE_TX BIT1 -+#define LDPC_VHT_TEST_TX_ENABLE BIT2 -+#define LDPC_VHT_CAP_TX BIT3 -+ -+#define STBC_VHT_ENABLE_RX BIT0 -+#define STBC_VHT_ENABLE_TX BIT1 -+#define STBC_VHT_TEST_TX_ENABLE BIT2 -+#define STBC_VHT_CAP_TX BIT3 -+ -+#define BEAMFORMING_VHT_BEAMFORMER_ENABLE BIT0 // Declare our NIC supports beamformer -+#define BEAMFORMING_VHT_BEAMFORMEE_ENABLE BIT1 // Declare our NIC supports beamformee -+#define BEAMFORMING_VHT_MU_MIMO_AP_ENABLE BIT2 /*Declare our NIC support MU-MIMO AP mode*/ -+#define BEAMFORMING_VHT_MU_MIMO_STA_ENABLE BIT3 /*Declare our NIC support MU-MIMO STA mode*/ -+#define BEAMFORMING_VHT_BEAMFORMER_TEST BIT4 /*Transmiting Beamforming no matter the target supports it or not*/ -+#define BEAMFORMING_VHT_BEAMFORMER_STS_CAP (BIT8|BIT9|BIT10) /*Asoc rsp cap*/ -+#define BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM (BIT12|BIT13|BIT14) /*Asoc rsp cap*/ -+ + +//VHT capability info +#define SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 0, 2, _val) @@ -336686,17 +152346,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_vht.h linux/3rdparty/rtl8812 +#define SET_VHT_CAPABILITY_ELE_SU_BFEE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 4, 1, _val) +#define SET_VHT_CAPABILITY_ELE_BFER_ANT_SUPP(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 5, 3, _val) +#define SET_VHT_CAPABILITY_ELE_SOUNDING_DIMENSIONS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 0, 3, _val) -+ +#define SET_VHT_CAPABILITY_ELE_MU_BFER(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 3, 1, _val) +#define SET_VHT_CAPABILITY_ELE_MU_BFEE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 4, 1, _val) +#define SET_VHT_CAPABILITY_ELE_TXOP_PS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 5, 1, _val) +#define SET_VHT_CAPABILITY_ELE_HTC_VHT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 6, 1, _val) +#define SET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+2, 7, 3, _val) //B23~B25 +#define SET_VHT_CAPABILITY_ELE_LINK_ADAPTION(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 2, 2, _val) -+#define SET_VHT_CAPABILITY_ELE_MCS_RX_MAP(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+4, 0, 16, _val) /* B0~B15 indicate Rx MCS MAP, we write 0 to indicate MCS0~7. by page */ -+#define SET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+6, 0, 13, _val) -+#define SET_VHT_CAPABILITY_ELE_MCS_TX_MAP(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+8, 0, 16, _val) /* B0~B15 indicate Tx MCS MAP, we write 0 to indicate MCS0~7. by page */ -+#define SET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+10, 0, 13, _val) ++#define SET_VHT_CAPABILITY_ELE_MCS_RX_MAP(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+4, 0, 16, _val) //B0~B15 indicate Rx MCS MAP, we write 0 to indicate MCS0~7. by page ++#define SET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+6, 0, 13, _val) ++#define SET_VHT_CAPABILITY_ELE_MCS_TX_MAP(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+8, 0, 16, _val) //B0~B15 indicate Tx MCS MAP, we write 0 to indicate MCS0~7. by page ++#define SET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+10, 0, 13, _val) + + +#define GET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 0, 2) @@ -336708,28 +152367,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_vht.h linux/3rdparty/rtl8812 +#define GET_VHT_CAPABILITY_ELE_RX_STBC(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 0, 3) +#define GET_VHT_CAPABILITY_ELE_SU_BFER(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 3, 1) +#define GET_VHT_CAPABILITY_ELE_SU_BFEE(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 4, 1) -+/*phydm-beamforming*/ -+#define GET_VHT_CAPABILITY_ELE_SU_BFEE_STS_CAP(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+1, 5, 3) -+#define GET_VHT_CAPABILITY_ELE_SU_BFER_SOUND_DIM_NUM(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+2, 0, 3) +#define GET_VHT_CAPABILITY_ELE_TXOP_PS(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+2, 5, 1) +#define GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+2, 7, 3) +#define GET_VHT_CAPABILITY_ELE_RX_MCS(_pEleStart) ((_pEleStart)+4) -+#define GET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+6, 0, 13) ++#define GET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+6, 0, 13) +#define GET_VHT_CAPABILITY_ELE_TX_MCS(_pEleStart) ((_pEleStart)+8) -+#define GET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+10, 0, 13) ++#define GET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+10, 0, 13) + + +//VHT Operation Information Element +#define SET_VHT_OPERATION_ELE_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 0, 8, _val) -+#define SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart+1, 0, 8, _val) -+#define SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart+2, 0, 8, _val) -+#define SET_VHT_OPERATION_ELE_BASIC_MCS_SET(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+3, 0, 16, _val) ++#define SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(_pEleStart, _val) SET_BITS_TO_LE_2BYTE(_pEleStart+1, 0, 8, _val) ++#define SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(_pEleStart, _val) SET_BITS_TO_LE_2BYTE(_pEleStart+2, 0, 8, _val) ++#define SET_VHT_OPERATION_ELE_BASIC_MCS_SET(_pEleStart, _val) SET_BITS_TO_LE_2BYTE(_pEleStart+3, 0, 16, _val) + +#define GET_VHT_OPERATION_ELE_CHL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart,0,8) +#define GET_VHT_OPERATION_ELE_CENTER_FREQ1(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1,0,8) +#define GET_VHT_OPERATION_ELE_CENTER_FREQ2(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+2,0,8) + -+//VHT Operating Mode ++//VHT Operating Mode +#define SET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 0, 2, _val) +#define SET_VHT_OPERATING_MODE_FIELD_RX_NSS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 4, 3, _val) +#define SET_VHT_OPERATING_MODE_FIELD_RX_NSS_TYPE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 7, 1, _val) @@ -336740,309 +152396,276 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_vht.h linux/3rdparty/rtl8812 +#define SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+7, 6, 1, _val) +#define GET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+7, 6, 1) + ++ ++#define TEST_FLAG(__Flag,__testFlag) (((__Flag) & (__testFlag)) != 0) ++#define SET_FLAG(__Flag, __setFlag) ((__Flag) |= __setFlag) ++#define CLEAR_FLAG(__Flag, __clearFlag) ((__Flag) &= ~(__clearFlag)) ++#define CLEAR_FLAGS(__Flag) ((__Flag) = 0) ++#define TEST_FLAGS(__Flag, __testFlags) (((__Flag) & (__testFlags)) == (__testFlags)) ++ +struct vht_priv +{ + u8 vht_option; + + u8 ldpc_cap; + u8 stbc_cap; -+ u16 beamform_cap; ++ u8 beamform_cap; + -+ u8 sgi_80m;//short GI ++ u8 bwmode; ++ u8 sgi;//short GI + u8 ampdu_len; + -+ u8 vht_op_mode_notify; + u8 vht_highest_rate; + u8 vht_mcs_map[2]; + + u8 vht_cap[32]; +}; + -+u8 rtw_get_vht_highest_rate(u8 *pvht_mcs_map); -+u16 rtw_vht_mcs_to_data_rate(u8 bw, u8 short_GI, u8 vht_mcs_rate); -+u64 rtw_vht_rate_to_bitmap(u8 *pVHTRate); ++u8 rtw_get_vht_highest_rate(_adapter *padapter, u8 *pvht_mcs_map); ++u16 rtw_vht_data_rate(u8 bw, u8 short_GI, u8 vht_mcs_rate); ++u32 rtw_vht_rate_to_bitmap(u8 *pVHTRate); +void rtw_vht_use_default_setting(_adapter *padapter); +u32 rtw_build_vht_operation_ie(_adapter *padapter, u8 *pbuf, u8 channel); -+u32 rtw_build_vht_op_mode_notify_ie(_adapter *padapter, u8 *pbuf, u8 bw); ++u32 rtw_build_vht_op_mode_notify_ie(_adapter *padapter, u8 *pbuf); +u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf); -+void update_sta_vht_info_apmode(_adapter *padapter, PVOID psta); ++void update_sta_vht_info_apmode(_adapter *padapter, void * psta); +void update_hw_vht_param(_adapter *padapter); +void VHT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); +void VHT_operation_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, PVOID sta); +u32 rtw_restructure_vht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len); +void VHTOnAssocRsp(_adapter *padapter); -+u8 rtw_vht_mcsmap_to_nss(u8 *pvht_mcs_map); + +#endif //_RTW_VHT_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_wapi.h linux/3rdparty/rtl8812au/include/rtw_wapi.h ---- linux.old/3rdparty/rtl8812au/include/rtw_wapi.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/rtw_wapi.h 2017-06-07 23:07:21.044690583 +0300 +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_wapi.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_wapi.h +--- linux-4.14.17/3rdparty/rtl8812au/include/rtw_wapi.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_wapi.h 2018-02-06 17:42:30.722967342 +0200 @@ -0,0 +1,222 @@ -+#ifndef __INC_WAPI_H -+#define __INC_WAPI_H -+ -+ -+#define CONFIG_WAPI_SW_SMS4 -+#define WAPI_DEBUG -+ -+#define SMS4_MIC_LEN 16 -+#define WAPI_EXT_LEN 18 -+#define MAX_WAPI_IE_LEN 256 -+#define sMacHdrLng 24 // octets in data header, no WEP -+ -+#ifdef WAPI_DEBUG -+ -+/* WAPI trace debug */ -+extern u32 wapi_debug_component; -+ -+static inline void dump_buf(u8 *buf, u32 len) -+{ -+ u32 i; -+ printk("-----------------Len %d----------------\n", len); -+ for(i=0; i= KERNEL_VERSION(4, 7, 0)) -+#define ieee80211_band nl80211_band -+#define IEEE80211_BAND_2GHZ NL80211_BAND_2GHZ -+#define IEEE80211_BAND_5GHZ NL80211_BAND_5GHZ -+#define IEEE80211_NUM_BANDS NUM_NL80211_BANDS ++static inline void dump_buf(u8 *buf, u32 len) ++{ ++ u32 i; ++ printk("-----------------Len %d----------------\n", len); ++ for(i=0; i>2]; +}; + -+#ifdef CONFIG_PCI_HCI -+#define PCI_MAX_TX_QUEUE_COUNT 8 -+ -+struct rtw_tx_ring { -+ unsigned char qid; -+ struct tx_desc *desc; -+ dma_addr_t dma; -+ unsigned int idx; -+ unsigned int entries; -+ _queue queue; -+ u32 qlen; -+}; -+#endif -+ +struct hw_xmit { + //_lock xmit_lock; + //_list pending; @@ -337332,57 +152821,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + int accnt; +}; + -+#if 0 -+struct pkt_attrib -+{ -+ u8 type; -+ u8 subtype; -+ u8 bswenc; -+ u8 dhcp_pkt; -+ u16 ether_type; -+ int pktlen; //the original 802.3 pkt raw_data len (not include ether_hdr data) -+ int pkt_hdrlen; //the original 802.3 pkt header len -+ int hdrlen; //the WLAN Header Len -+ int nr_frags; -+ int last_txcmdsz; -+ int encrypt; //when 0 indicate no encrypt. when non-zero, indicate the encrypt algorith -+ u8 iv[8]; -+ int iv_len; -+ u8 icv[8]; -+ int icv_len; -+ int priority; -+ int ack_policy; -+ int mac_id; -+ int vcs_mode; //virtual carrier sense method -+ -+ u8 dst[ETH_ALEN]; -+ u8 src[ETH_ALEN]; -+ u8 ta[ETH_ALEN]; -+ u8 ra[ETH_ALEN]; -+ -+ u8 key_idx; -+ -+ u8 qos_en; -+ u8 ht_en; -+ u8 raid;//rate adpative id -+ u8 bwmode; -+ u8 ch_offset;//PRIME_CHNL_OFFSET -+ u8 sgi;//short GI -+ u8 ampdu_en;//tx ampdu enable -+ u8 mdata;//more data bit -+ u8 eosp; -+ -+ u8 triggered;//for ap mode handling Power Saving sta -+ -+ u32 qsel; -+ u16 seqnum; -+ -+ struct sta_info * psta; -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ u8 hw_tcp_csum; -+#endif -+}; -+#else +//reduce size +struct pkt_attrib +{ @@ -337392,7 +152830,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + u8 dhcp_pkt; + u16 ether_type; + u16 seqnum; -+ u8 hw_ssn_sel; //for HW_SEQ0,1,2,3 + u16 pkt_hdrlen; //the original 802.3 pkt header len + u16 hdrlen; //the WLAN Header Len + u32 pktlen; //the original 802.3 pkt raw_data len (not include ether_hdr data) @@ -337407,10 +152844,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + u8 ack_policy; + u8 mac_id; + u8 vcs_mode; //virtual carrier sense method -+ u8 dst[ETH_ALEN]; ++ u8 dst[ETH_ALEN]; + u8 src[ETH_ALEN]; + u8 ta[ETH_ALEN]; -+ u8 ra[ETH_ALEN]; ++ u8 ra[ETH_ALEN]; + u8 key_idx; + u8 qos_en; + u8 ht_en; @@ -337419,16 +152856,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + u8 ch_offset;//PRIME_CHNL_OFFSET + u8 sgi;//short GI + u8 ampdu_en;//tx ampdu enable -+ u8 ampdu_spacing; //ampdu_min_spacing for peer sta's rx + u8 mdata;//more data bit + u8 pctrl;//per packet txdesc control enable + u8 triggered;//for ap mode handling Power Saving sta + u8 qsel; -+ u8 order;//order bit + u8 eosp; + u8 rate; + u8 intel_proxim; -+ u8 retry_ctrl; ++ u8 retry_ctrl; + u8 mbssid; + u8 ldpc; + u8 stbc; @@ -337443,34 +152878,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + //union Keytype dot11tkiprxmickey; + union Keytype dot118021x_UncstKey; + -+#ifdef CONFIG_TDLS -+ u8 direct_link; -+ struct sta_info *ptdls_sta; -+#endif //CONFIG_TDLS -+ u8 key_type; + -+ u8 icmp_pkt; -+ u16 txbf_p_aid;/*beamforming Partial_AID*/ -+ u16 txbf_g_id;/*beamforming Group ID*/ -+ +}; -+#endif -+ -+#ifdef PLATFORM_FREEBSD -+#define ETH_ALEN 6 /* Octets in one ethernet addr */ -+#define ETH_HLEN 14 /* Total octets in header. */ -+#define ETH_P_IP 0x0800 /* Internet Protocol packet */ -+ -+/*struct rtw_ieee80211_hdr { -+ uint16_t frame_control; -+ uint16_t duration_id; -+ u8 addr1[6]; -+ u8 addr2[6]; -+ u8 addr3[6]; -+ uint16_t seq_ctrl; -+ u8 addr4[6]; -+} ;*/ -+#endif //PLATFORM_FREEBSD + +#define WLANHDR_OFFSET 64 + @@ -337485,7 +152894,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + +#define MP_FRAMETAG 0x07 + -+#define TXAGG_FRAMETAG 0x08 ++#define TXAGG_FRAMETAG 0x08 + +enum { + XMITBUF_DATA = 0, @@ -337493,15 +152902,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + XMITBUF_CMD = 2, +}; + -+bool rtw_xmit_ac_blocked(_adapter *adapter); -+ +struct submit_ctx{ + u32 submit_time; /* */ + u32 timeout_ms; /* <0: not synchronous, 0: wait forever, >0: up to ms waiting */ + int status; /* status for operation */ -+#ifdef PLATFORM_LINUX + struct completion done; -+#endif +}; + +enum { @@ -337517,12 +152922,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + RTW_SCTX_DONE_CCX_PKT_FAIL, + RTW_SCTX_DONE_DRV_STOP, + RTW_SCTX_DONE_DEV_REMOVE, -+ RTW_SCTX_DONE_CMD_ERROR, +}; + + +void rtw_sctx_init(struct submit_ctx *sctx, int timeout_ms); -+int rtw_sctx_wait(struct submit_ctx *sctx, const char *msg); ++int rtw_sctx_wait(struct submit_ctx *sctx); +void rtw_sctx_done_err(struct submit_ctx **sctx, int status); +void rtw_sctx_done(struct submit_ctx **sctx); + @@ -337546,56 +152950,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + + struct submit_ctx *sctx; + -+#ifdef CONFIG_USB_HCI -+ -+ //u32 sz[8]; + u32 ff_hwaddr; + -+#if defined(PLATFORM_OS_XP)||defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) + PURB pxmit_urb[8]; + dma_addr_t dma_transfer_addr; /* (in) dma addr for transfer_buffer */ -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ PIRP pxmit_irp[8]; -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ USB_TRANSFER usb_transfer_write_port; -+#endif + + u8 bpending[8]; + + sint last[8]; + -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ u8 *phead; -+ u8 *pdata; -+ u8 *ptail; -+ u8 *pend; -+ u32 ff_hwaddr; -+ u8 pg_num; -+ u8 agg_num; -+#ifdef PLATFORM_OS_XP -+ PMDL pxmitbuf_mdl; -+ PIRP pxmitbuf_irp; -+ PSDBUS_REQUEST_PACKET pxmitbuf_sdrp; -+#endif -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ struct tx_desc *desc; -+#endif -+ +#if defined(DBG_XMIT_BUF )|| defined(DBG_XMIT_BUF_EXT) + u8 no; +#endif -+ +}; + -+ +struct xmit_frame +{ + _list list; @@ -337612,17 +152980,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + + struct xmit_buf *pxmitbuf; + -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ u8 pg_num; -+ u8 agg_num; -+#endif -+ -+#ifdef CONFIG_USB_HCI +#ifdef CONFIG_USB_TX_AGGREGATION + u8 agg_num; +#endif + s8 pkt_offset; -+#endif + +#ifdef CONFIG_XMIT_ACK + u8 ack_report; @@ -337652,7 +153013,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + struct tx_servq bk_q; //priority == 1,2 + struct tx_servq vi_q; //priority == 4,5 + struct tx_servq vo_q; //priority == 6,7 -+ _list legacy_dz; ++ _list legacy_dz; + _list apsd; + + u16 txseq_tid[16]; @@ -337668,7 +153029,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 +struct hw_txqueue { + volatile sint head; + volatile sint tail; -+ volatile sint free_sz; //in units of 64 bytes ++ volatile sint free_sz; //in units of 64 bytes + volatile sint free_cmdsz; + volatile sint txsz[8]; + uint ff_hwaddr; @@ -337681,14 +153042,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + u16 pkt_len; +}; + -+enum cmdbuf_type { -+ CMDBUF_BEACON = 0x00, -+ CMDBUF_RSVD, -+ CMDBUF_MAX -+}; -+ -+u8 rtw_get_hwseq_no(_adapter *padapter); -+ +struct xmit_priv { + + _lock lock; @@ -337737,6 +153090,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + u64 tx_bytes; + u64 tx_pkts; + u64 tx_drop; ++ u64 last_tx_bytes; + u64 last_tx_pkts; + + struct hw_xmit *hwxmits; @@ -337744,50 +153098,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + + u8 wmm_para_seq[4];//sequence for wmm ac parameter strength from large to small. it's value is 0->vo, 1->vi, 2->be, 3->bk. + -+#ifdef CONFIG_USB_HCI + _sema tx_retevt;//all tx return event; + u8 txirp_cnt;// + -+#ifdef PLATFORM_OS_CE -+ USB_TRANSFER usb_transfer_write_port; -+// USB_TRANSFER usb_transfer_write_mem; -+#endif -+#ifdef PLATFORM_LINUX + struct tasklet_struct xmit_tasklet; -+#endif -+#ifdef PLATFORM_FREEBSD -+ struct task xmit_tasklet; -+#endif + //per AC pending irp + int beq_cnt; + int bkq_cnt; + int viq_cnt; + int voq_cnt; + -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ // Tx -+ struct rtw_tx_ring tx_ring[PCI_MAX_TX_QUEUE_COUNT]; -+ int txringcount[PCI_MAX_TX_QUEUE_COUNT]; -+ u8 beaconDMAing; //flag of indicating beacon is transmiting to HW by DMA -+#ifdef PLATFORM_LINUX -+ struct tasklet_struct xmit_tasklet; -+#endif -+#endif -+ -+#if defined (CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#ifdef CONFIG_SDIO_TX_TASKLET -+ #ifdef PLATFORM_LINUX -+ struct tasklet_struct xmit_tasklet; -+ #endif /* PLATFORM_LINUX */ -+#else -+ _thread_hdl_ SdioXmitThread; -+ _sema SdioXmitSema; -+ _sema SdioXmitTerminateSema; -+#endif /* CONFIG_SDIO_TX_TASKLET */ -+#endif /* CONFIG_SDIO_HCI */ -+ + _queue free_xmitbuf_queue; + _queue pending_xmitbuf_queue; + u8 *pallocated_xmitbuf; @@ -337799,17 +153119,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + u8 *pxmit_extbuf; + uint free_xmit_extbuf_cnt; + -+ struct xmit_buf pcmd_xmitbuf[CMDBUF_MAX]; -+ u8 hw_ssn_seq_no;//mapping to REG_HW_SEQ 0,1,2,3 ++ struct xmit_buf pcmd_xmitbuf; ++ + u16 nqos_ssn; + #ifdef CONFIG_TX_EARLY_MODE + -+ #ifdef CONFIG_SDIO_HCI -+ #define MAX_AGG_PKT_NUM 20 -+ #else -+ #define MAX_AGG_PKT_NUM 256 //Max tx ampdu coounts -+ #endif -+ ++ #define MAX_AGG_PKT_NUM 256 //Max tx ampdu coounts ++ + struct agg_pkt_info agg_pkt[MAX_AGG_PKT_NUM]; + #endif + @@ -337817,21 +153133,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + int ack_tx; + _mutex ack_tx_mutex; + struct submit_ctx ack_tx_ops; -+ u8 seq_no; +#endif + _lock lock_sctx; +}; + -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_cmdxmitframe(p) __rtw_alloc_cmdxmitframe(p, CMDBUF_RSVD) -+#if defined(CONFIG_RTL8192E) && defined(CONFIG_PCI_HCI) -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8192ee(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8192ee(p, CMDBUF_BEACON) -+#else -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe(p, CMDBUF_BEACON) -+#endif ++extern struct xmit_frame *rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, u32 buffsize); ++extern void rtw_free_cmdxmitframe(struct xmit_priv *pxmitpriv, struct xmit_frame *pxmitframe); ++extern struct xmit_buf *rtw_alloc_cmd_xmitbuf(struct xmit_priv *pxmitpriv, u32 buffsize); ++extern s32 rtw_free_cmd_xmitbuf(struct xmit_priv *pxmitpriv); + +extern struct xmit_buf *rtw_alloc_xmitbuf_ext(struct xmit_priv *pxmitpriv); +extern s32 rtw_free_xmitbuf_ext(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); @@ -337841,8 +153150,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + +void rtw_count_tx_stats(_adapter *padapter, struct xmit_frame *pxmitframe, int sz); +extern void rtw_update_protection(_adapter *padapter, u8 *ie, uint ie_len); -+static s32 update_attrib_sec_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta); -+static void update_attrib_phy_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta); +extern s32 rtw_make_wlanhdr(_adapter *padapter, u8 *hdr, struct pkt_attrib *pattrib); +extern s32 rtw_put_snap(u8 *data, u16 h_proto); + @@ -337859,13 +153166,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 +extern u32 rtw_calculate_wlan_pkt_size_by_attribue(struct pkt_attrib *pattrib); +#define rtw_wlan_pkt_size(f) rtw_calculate_wlan_pkt_size_by_attribue(&f->attrib) +extern s32 rtw_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe); -+#ifdef CONFIG_IEEE80211W -+extern s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe); -+#endif //CONFIG_IEEE80211W +#ifdef CONFIG_TDLS -+extern struct tdls_txmgmt *ptxmgmt; -+s32 rtw_xmit_tdls_coalesce(_adapter *padapter, struct xmit_frame *pxmitframe, struct tdls_txmgmt *ptxmgmt); -+s32 update_tdls_attrib(_adapter *padapter, struct pkt_attrib *pattrib); ++s32 rtw_xmit_tdls_coalesce(_adapter *padapter, struct xmit_frame *pxmitframe, u8 action); +#endif +s32 _rtw_init_hw_txqueue(struct hw_txqueue* phw_txqueue, u8 ac_tag); +void _rtw_init_sta_xmit_priv(struct sta_xmit_priv *psta_xmitpriv); @@ -337885,7 +153187,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 + + +s32 rtw_xmit(_adapter *padapter, _pkt **pkt); -+bool xmitframe_hiq_filter(struct xmit_frame *xmitframe); ++ +#if defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) +sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe); +void stop_sta_xmit(_adapter *padapter, struct sta_info *psta); @@ -337893,20 +153195,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 +void xmit_delivery_enabled_frames(_adapter *padapter, struct sta_info *psta); +#endif + -+u8 query_ra_short_GI(struct sta_info *psta); -+ +u8 qos_acm(u8 acm_mask, u8 priority); + +#ifdef CONFIG_XMIT_THREAD_MODE +void enqueue_pending_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+void enqueue_pending_xmitbuf_to_head(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); +struct xmit_buf* dequeue_pending_xmitbuf(struct xmit_priv *pxmitpriv); +struct xmit_buf* dequeue_pending_xmitbuf_under_survey(struct xmit_priv *pxmitpriv); +sint check_pending_xmitbuf(struct xmit_priv *pxmitpriv); +thread_return rtw_xmit_thread(thread_context context); +#endif + -+static void do_queue_select(_adapter * padapter, struct pkt_attrib * pattrib); +u32 rtw_get_ff_hwaddr(struct xmit_frame *pxmitframe); + +#ifdef CONFIG_XMIT_ACK @@ -337919,15 +153217,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/rtw_xmit.h linux/3rdparty/rtl881 +#include + +#endif //_RTL871X_XMIT_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/sdio_hal.h linux/3rdparty/rtl8812au/include/sdio_hal.h ---- linux.old/3rdparty/rtl8812au/include/sdio_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/sdio_hal.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,56 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/sta_info.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/sta_info.h +--- linux-4.14.17/3rdparty/rtl8812au/include/sta_info.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/sta_info.h 2018-02-06 17:42:30.722967342 +0200 +@@ -0,0 +1,456 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -337937,458 +153234,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sdio_hal.h linux/3rdparty/rtl881 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_HAL_H__ -+#define __SDIO_HAL_H__ -+ -+ -+extern u8 sd_hal_bus_init(PADAPTER padapter); -+extern u8 sd_hal_bus_deinit(PADAPTER padapter); -+ -+u8 sd_int_isr(PADAPTER padapter); -+void sd_int_dpc(PADAPTER padapter); -+u8 rtw_set_hal_ops(_adapter *padapter); -+ -+#ifdef CONFIG_RTL8188E -+void rtl8188es_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8723B -+void rtl8723bs_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8821A -+void rtl8821as_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8192E -+void rtl8192es_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8703B -+void rtl8703bs_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8188F -+void rtl8188fs_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#endif //__SDIO_HAL_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/sdio_ops_ce.h linux/3rdparty/rtl8812au/include/sdio_ops_ce.h ---- linux.old/3rdparty/rtl8812au/include/sdio_ops_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/sdio_ops_ce.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,55 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _SDIO_OPS_WINCE_H_ -+#define _SDIO_OPS_WINCE_H_ -+ -+#include -+#include -+#include -+#include -+ -+ -+#ifdef PLATFORM_OS_CE -+ -+ -+extern u8 sdbus_cmd52r_ce(struct intf_priv *pintfpriv, u32 addr); -+ -+ -+extern void sdbus_cmd52w_ce(struct intf_priv *pintfpriv, u32 addr,u8 val8); -+ -+ -+uint sdbus_read_blocks_to_membuf_ce(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); -+ -+extern uint sdbus_read_bytes_to_membuf_ce(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); -+ -+ -+extern uint sdbus_write_blocks_from_membuf_ce(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf,u8 async); -+ -+extern uint sdbus_write_bytes_from_membuf_ce(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); -+extern u8 sdbus_func1cmd52r_ce(struct intf_priv *pintfpriv, u32 addr); -+extern void sdbus_func1cmd52w_ce(struct intf_priv *pintfpriv, u32 addr, u8 val8); -+extern uint sdbus_read_reg(struct intf_priv *pintfpriv, u32 addr, u32 cnt,void *pdata); -+extern uint sdbus_write_reg(struct intf_priv *pintfpriv, u32 addr, u32 cnt,void *pdata); -+extern void sdio_read_int(_adapter *padapter, u32 addr,u8 sz,void *pdata); -+ -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/sdio_ops.h linux/3rdparty/rtl8812au/include/sdio_ops.h ---- linux.old/3rdparty/rtl8812au/include/sdio_ops.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/sdio_ops.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,140 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_OPS_H__ -+#define __SDIO_OPS_H__ -+ -+ -+#ifdef PLATFORM_LINUX -+#include -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+#ifdef PLATFORM_OS_XP -+#include -+struct async_context -+{ -+ PMDL pmdl; -+ PSDBUS_REQUEST_PACKET sdrp; -+ unsigned char* r_buf; -+ unsigned char* padapter; -+}; -+#endif -+ -+#ifdef PLATFORM_OS_CE -+#include -+#endif -+ -+#endif // PLATFORM_WINDOWS -+ -+ -+extern void sdio_set_intf_ops(_adapter *padapter,struct _io_ops *pops); -+ -+//extern void sdio_func1cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem); -+//extern void sdio_func1cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem); -+extern u8 SdioLocalCmd52Read1Byte(PADAPTER padapter, u32 addr); -+extern void SdioLocalCmd52Write1Byte(PADAPTER padapter, u32 addr, u8 v); -+extern s32 _sdio_local_read(PADAPTER padapter, u32 addr, u32 cnt, u8 *pbuf); -+extern s32 sdio_local_read(PADAPTER padapter, u32 addr, u32 cnt, u8 *pbuf); -+extern s32 _sdio_local_write(PADAPTER padapter, u32 addr, u32 cnt, u8 *pbuf); -+extern s32 sdio_local_write(PADAPTER padapter, u32 addr, u32 cnt, u8 *pbuf); -+ -+u32 _sdio_read32(PADAPTER padapter, u32 addr); -+s32 _sdio_write32(PADAPTER padapter, u32 addr, u32 val); -+ -+extern void sd_int_hdl(PADAPTER padapter); -+extern u8 CheckIPSStatus(PADAPTER padapter); -+ -+#ifdef CONFIG_RTL8188E -+extern void InitInterrupt8188ESdio(PADAPTER padapter); -+extern void EnableInterrupt8188ESdio(PADAPTER padapter); -+extern void DisableInterrupt8188ESdio(PADAPTER padapter); -+extern void UpdateInterruptMask8188ESdio(PADAPTER padapter, u32 AddMSR, u32 RemoveMSR); -+extern u8 HalQueryTxBufferStatus8189ESdio(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8189ESdio(PADAPTER padapter); -+extern void ClearInterrupt8188ESdio(PADAPTER padapter); -+#endif // CONFIG_RTL8188E -+ -+#ifdef CONFIG_RTL8821A -+extern void InitInterrupt8821AS(PADAPTER padapter); -+extern void EnableInterrupt8821AS(PADAPTER padapter); -+extern void DisableInterrupt8821AS(PADAPTER padapter); -+extern u8 HalQueryTxBufferStatus8821AS(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8821ASdio(PADAPTER padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void ClearInterrupt8821AS(PADAPTER padapter); -+#endif /* defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) */ -+#endif /* CONFIG_RTL8821A */ -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+extern u8 RecvOnePkt(PADAPTER padapter, u32 size); -+#endif // CONFIG_WOWLAN -+#ifdef CONFIG_RTL8723B -+extern void InitInterrupt8723BSdio(PADAPTER padapter); -+extern void InitSysInterrupt8723BSdio(PADAPTER padapter); -+extern void EnableInterrupt8723BSdio(PADAPTER padapter); -+extern void DisableInterrupt8723BSdio(PADAPTER padapter); -+extern u8 HalQueryTxBufferStatus8723BSdio(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8723BSdio(PADAPTER padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+extern void DisableInterruptButCpwm28723BSdio(PADAPTER padapter); -+extern void ClearInterrupt8723BSdio(PADAPTER padapter); -+#endif //CONFIG_WOWLAN -+#endif -+ -+ -+#ifdef CONFIG_RTL8192E -+extern void InitInterrupt8192ESdio(PADAPTER padapter); -+extern void EnableInterrupt8192ESdio(PADAPTER padapter); -+extern void DisableInterrupt8192ESdio(PADAPTER padapter); -+extern void UpdateInterruptMask8192ESdio(PADAPTER padapter, u32 AddMSR, u32 RemoveMSR); -+extern u8 HalQueryTxBufferStatus8192ESdio(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8192ESdio(PADAPTER padapter); -+extern void ClearInterrupt8192ESdio(PADAPTER padapter); -+#endif // CONFIG_RTL8192E -+ -+#ifdef CONFIG_RTL8703B -+extern void InitInterrupt8703BSdio(PADAPTER padapter); -+extern void InitSysInterrupt8703BSdio(PADAPTER padapter); -+extern void EnableInterrupt8703BSdio(PADAPTER padapter); -+extern void DisableInterrupt8703BSdio(PADAPTER padapter); -+extern u8 HalQueryTxBufferStatus8703BSdio(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8703BSdio(PADAPTER padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+extern void DisableInterruptButCpwm28703BSdio(PADAPTER padapter); -+extern void ClearInterrupt8703BSdio(PADAPTER padapter); -+#endif //CONFIG_WOWLAN -+#endif -+ -+#ifdef CONFIG_RTL8188F -+extern void InitInterrupt8188FSdio(PADAPTER padapter); -+extern void InitSysInterrupt8188FSdio(PADAPTER padapter); -+extern void EnableInterrupt8188FSdio(PADAPTER padapter); -+extern void DisableInterrupt8188FSdio(PADAPTER padapter); -+extern u8 HalQueryTxBufferStatus8188FSdio(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8188FSdio(PADAPTER padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+extern void DisableInterruptButCpwm28188FSdio(PADAPTER padapter); -+extern void ClearInterrupt8188FSdio(PADAPTER padapter); -+#endif /* defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) */ -+#endif -+ -+#endif // !__SDIO_OPS_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/sdio_ops_linux.h linux/3rdparty/rtl8812au/include/sdio_ops_linux.h ---- linux.old/3rdparty/rtl8812au/include/sdio_ops_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/sdio_ops_linux.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,52 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_OPS_LINUX_H__ -+#define __SDIO_OPS_LINUX_H__ -+ -+#define SDIO_ERR_VAL8 0xEA -+#define SDIO_ERR_VAL16 0xEAEA -+#define SDIO_ERR_VAL32 0xEAEAEAEA -+ -+u8 sd_f0_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+void sd_f0_write8(struct intf_hdl *pintfhdl, u32 addr, u8 v, s32 *err); -+ -+s32 _sd_cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); -+s32 _sd_cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); -+s32 sd_cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); -+s32 sd_cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); -+ -+u8 _sd_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+u8 sd_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+u16 sd_read16(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+u32 _sd_read32(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+u32 sd_read32(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+s32 _sd_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); -+s32 sd_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); -+void sd_write8(struct intf_hdl *pintfhdl, u32 addr, u8 v, s32 *err); -+void sd_write16(struct intf_hdl *pintfhdl, u32 addr, u16 v, s32 *err); -+void _sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err); -+void sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err); -+s32 _sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); -+s32 sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); -+ -+ -+void rtw_sdio_set_irq_thd(struct dvobj_priv *dvobj, _thread_hdl_ thd_hdl); -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/sdio_ops_xp.h linux/3rdparty/rtl8812au/include/sdio_ops_xp.h ---- linux.old/3rdparty/rtl8812au/include/sdio_ops_xp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/sdio_ops_xp.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,55 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _SDIO_OPS_XP_H_ -+#define _SDIO_OPS_XP_H_ -+ -+#include -+#include -+#include -+#include -+ -+ -+#ifdef PLATFORM_OS_XP -+ -+ -+extern u8 sdbus_cmd52r_xp(struct intf_priv *pintfpriv, u32 addr); -+ -+ -+extern void sdbus_cmd52w_xp(struct intf_priv *pintfpriv, u32 addr,u8 val8); -+ -+ -+uint sdbus_read_blocks_to_membuf_xp(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); -+ -+extern uint sdbus_read_bytes_to_membuf_xp(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); -+ -+ -+extern uint sdbus_write_blocks_from_membuf_xp(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf,u8 async); -+ -+extern uint sdbus_write_bytes_from_membuf_xp(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); -+extern u8 sdbus_func1cmd52r_xp(struct intf_priv *pintfpriv, u32 addr); -+extern void sdbus_func1cmd52w_xp(struct intf_priv *pintfpriv, u32 addr, u8 val8); -+extern uint sdbus_read_reg(struct intf_priv *pintfpriv, u32 addr, u32 cnt,void *pdata); -+extern uint sdbus_write_reg(struct intf_priv *pintfpriv, u32 addr, u32 cnt,void *pdata); -+extern void sdio_read_int(_adapter *padapter, u32 addr,u8 sz,void *pdata); -+ -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/sdio_osintf.h linux/3rdparty/rtl8812au/include/sdio_osintf.h ---- linux.old/3rdparty/rtl8812au/include/sdio_osintf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/sdio_osintf.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,36 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_OSINTF_H__ -+#define __SDIO_OSINTF_H__ -+ -+ -+ -+u8 sd_hal_bus_init(PADAPTER padapter); -+u8 sd_hal_bus_deinit(PADAPTER padapter); -+void sd_c2h_hdl(PADAPTER padapter); -+ -+#ifdef PLATFORM_OS_CE -+extern NDIS_STATUS ce_sd_get_dev_hdl(PADAPTER padapter); -+SD_API_STATUS ce_sd_int_callback(SD_DEVICE_HANDLE hDevice, PADAPTER padapter); -+extern void sd_setup_irs(PADAPTER padapter); -+#endif -+ -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl8812au/include/sta_info.h ---- linux.old/3rdparty/rtl8812au/include/sta_info.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/sta_info.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,515 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __STA_INFO_H_ +#define __STA_INFO_H_ + + +#define IBSS_START_MAC_ID 2 -+#define NUM_STA MACID_NUM_SW_LIMIT ++#define NUM_STA 32 +#define NUM_ACL 16 + -+#ifdef CONFIG_TDLS -+#define MAX_ALLOWED_TDLS_STA_NUM 4 -+#endif -+ -+enum sta_info_update_type { -+ STA_INFO_UPDATE_NONE = 0, -+ STA_INFO_UPDATE_BW = BIT(0), -+ STA_INFO_UPDATE_RATE = BIT(1), -+ STA_INFO_UPDATE_PROTECTION_MODE = BIT(2), -+ STA_INFO_UPDATE_CAP = BIT(3), -+ STA_INFO_UPDATE_HT_CAP = BIT(4), -+ STA_INFO_UPDATE_VHT_CAP = BIT(5), -+ STA_INFO_UPDATE_ALL = STA_INFO_UPDATE_BW -+ |STA_INFO_UPDATE_RATE -+ |STA_INFO_UPDATE_PROTECTION_MODE -+ |STA_INFO_UPDATE_CAP -+ |STA_INFO_UPDATE_HT_CAP -+ |STA_INFO_UPDATE_VHT_CAP, -+ STA_INFO_UPDATE_MAX -+}; + +//if mode ==0, then the sta is allowed once the addr is hit. +//if mode ==1, then the sta is rejected once the addr is non-hit. @@ -338412,7 +153266,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + s32 UndecoratedSmoothedPWDB; + s32 UndecoratedSmoothedCCK; + s32 UndecoratedSmoothedOFDM; -+ u32 OFDM_pkt; + u64 PacketMap; + u8 ValidBit; +}RSSI_STA, *PRSSI_STA; @@ -338427,7 +153280,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + u64 rx_probersp_uo_pkts; + u64 rx_ctrl_pkts; + u64 rx_data_pkts; -+ u64 rx_data_qos_pkts[TID_NUM]; ++ + u64 last_rx_mgnt_pkts; + u64 last_rx_beacon_pkts; + u64 last_rx_probereq_pkts; @@ -338436,17 +153289,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + u64 last_rx_probersp_uo_pkts; + u64 last_rx_ctrl_pkts; + u64 last_rx_data_pkts; -+ u64 last_rx_data_qos_pkts[TID_NUM]; -+#ifdef CONFIG_TDLS -+ u64 rx_tdls_disc_rsp_pkts; -+ u64 last_rx_tdls_disc_rsp_pkts; -+#endif ++ + u64 rx_bytes; + u64 rx_drops; + + u64 tx_pkts; + u64 tx_bytes; + u64 tx_drops; ++ +}; + +#ifdef CONFIG_TDLS @@ -338465,35 +153315,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + //_list sleep_list;//sleep_q + //_list wakeup_list;//wakeup_q + _adapter *padapter; -+ ++ + struct sta_xmit_priv sta_xmitpriv; + struct sta_recv_priv sta_recvpriv; -+ ++ + _queue sleep_q; + unsigned int sleepq_len; -+ ++ + uint state; + uint aid; + uint mac_id; + uint qos_option; + u8 hwaddr[ETH_ALEN]; -+ u16 hwseq; + -+ uint ieee8021x_blocked; //0: allowed, 1:blocked ++ uint ieee8021x_blocked; //0: allowed, 1:blocked + uint dot118021XPrivacy; //aes, tkip... + union Keytype dot11tkiptxmickey; + union Keytype dot11tkiprxmickey; -+ union Keytype dot118021x_UncstKey; -+ union pn48 dot11txpn; // PN48 used for Unicast xmit -+#ifdef CONFIG_GTK_OL -+ u8 kek[RTW_KEK_LEN]; -+ u8 kck[RTW_KCK_LEN]; -+ u8 replay_ctr[RTW_REPLAY_CTR_LEN]; -+#endif //CONFIG_GTK_OL -+#ifdef CONFIG_IEEE80211W -+ union pn48 dot11wtxpn; // PN48 used for Unicast mgmt xmit. -+ _timer dot11w_expire_timer; -+#endif //CONFIG_IEEE80211W ++ union Keytype dot118021x_UncstKey; ++ union pn48 dot11txpn; // PN48 used for Unicast xmit. + union pn48 dot11rxpn; // PN48 used for Unicast recv. + + @@ -338501,57 +153341,52 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + u32 bssratelen; + s32 rssi; + s32 signal_quality; -+ ++ + u8 cts2self; + u8 rtsen; + + u8 raid; -+ u8 init_rate; -+ u64 ra_mask; ++ u8 init_rate; ++ u32 ra_mask; + u8 wireless_mode; // NETWORK_TYPE -+ u8 bw_mode; + -+ u8 ldpc; -+ u8 stbc; -+ -+#ifdef CONFIG_BEAMFORMING -+ u16 txbf_paid; -+ u16 txbf_gid; -+#endif -+ + struct stainfo_stats sta_stats; + +#ifdef CONFIG_TDLS + u32 tdls_sta_state; ++ u8 dialog; + u8 SNonce[32]; + u8 ANonce[32]; + u32 TDLS_PeerKey_Lifetime; + u16 TPK_count; + _timer TPK_timer; + struct TDLS_PeerKey tpk; -+#ifdef CONFIG_TDLS_CH_SW ++ u16 stat_code; ++ u8 off_ch; + u16 ch_switch_time; + u16 ch_switch_timeout; -+ //u8 option; -+ _timer ch_sw_timer; -+ _timer delay_timer; -+#endif -+ _timer handshake_timer; -+ u8 alive_count; -+ _timer pti_timer; -+ u8 TDLS_RSNIE[20]; /* Save peer's RSNIE, used for sending TDLS_SETUP_RSP */ -+#endif /* CONFIG_TDLS */ ++ u8 option; ++ _timer option_timer; ++ _timer base_ch_timer; ++ _timer off_ch_timer; + -+ //for A-MPDU TX, ADDBA timeout check ++ _timer handshake_timer; ++ _timer alive_timer1; ++ _timer alive_timer2; ++ u8 timer_flag; ++ u8 alive_count; ++#endif //CONFIG_TDLS ++ ++ //for A-MPDU TX, ADDBA timeout check + _timer addba_retry_timer; -+ -+ //for A-MPDU Rx reordering buffer control -+ struct recv_reorder_ctrl recvreorder_ctrl[TID_NUM]; -+ ATOMIC_T continual_no_rx_packet[TID_NUM]; ++ ++ //for A-MPDU Rx reordering buffer control ++ struct recv_reorder_ctrl recvreorder_ctrl[16]; ++ + //for A-MPDU Tx + //unsigned char ampdu_txen_bitmap; + u16 BA_starting_seqctrl[16]; -+ ++ + +#ifdef CONFIG_80211N_HT + struct ht_priv htpriv; @@ -338561,34 +153396,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + struct vht_priv vhtpriv; +#endif + -+ //Notes: ++ //Notes: + //STA_Mode: -+ //curr_network(mlme_priv/security_priv/qos/ht) + sta_info: (STA & AP) CAP/INFO ++ //curr_network(mlme_priv/security_priv/qos/ht) + sta_info: (STA & AP) CAP/INFO + //scan_q: AP CAP/INFO + + //AP_Mode: + //curr_network(mlme_priv/security_priv/qos/ht) : AP CAP/INFO + //sta_info: (AP & STA) CAP/INFO -+ ++ +#ifdef CONFIG_AP_MODE + + _list asoc_list; + _list auth_list; -+ ++ + unsigned int expire_to; + unsigned int auth_seq; + unsigned int authalg; + unsigned char chg_txt[128]; + -+ u16 capability; -+ int flags; ++ u16 capability; ++ int flags; + + int dot8021xalg;//0:disable, 1:psk, 2:802.1x + int wpa_psk;//0:disable, bit(0): WPA, bit(1):WPA2 + int wpa_group_cipher; + int wpa2_group_cipher; + int wpa_pairwise_cipher; -+ int wpa2_pairwise_cipher; ++ int wpa2_pairwise_cipher; + + u8 bpairwise_key_installed; + @@ -338601,20 +153436,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + u8 no_ht_gf_set; + u8 no_ht_set; + u8 ht_20mhz_set; -+ u8 ht_40mhz_intolerant; +#endif // CONFIG_NATIVEAP_MLME + -+#ifdef CONFIG_ATMEL_RC_PATCH -+ u8 flag_atmel_rc; -+#endif -+ ++ unsigned int tx_ra_bitmap; + u8 qos_info; + + u8 max_sp_len; + u8 uapsd_bk;//BIT(0): Delivery enabled, BIT(1): Trigger enabled + u8 uapsd_be; + u8 uapsd_vi; -+ u8 uapsd_vo; ++ u8 uapsd_vo; + + u8 has_legacy_ac; + unsigned int sleepq_ac_len; @@ -338633,13 +153464,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + u8 num_of_secdev_type; + u8 secdev_types_list[32];// 32/8 == 4; + u16 dev_name_len; -+ u8 dev_name[32]; ++ u8 dev_name[32]; +#endif //CONFIG_P2P + +#ifdef CONFIG_TX_MCAST2UNI + u8 under_exist_checking; +#endif // CONFIG_TX_MCAST2UNI -+ ++ + u8 keep_alive_trycnt; + +#ifdef CONFIG_AUTO_AP_MODE @@ -338647,7 +153478,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + u16 pid; // pairing id +#endif + -+#endif // CONFIG_AP_MODE ++#endif // CONFIG_AP_MODE + +#ifdef CONFIG_IOCTL_CFG80211 + u8 *passoc_req; @@ -338656,26 +153487,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + + //for DM + RSSI_STA rssi_stat; -+ -+ //ODM_STA_INFO_T ++ ++ // + // ================ODM Relative Info======================= + // Please be care, dont declare too much structure here. It will cost memory * STA support num. + // + // -+ // 2011/10/20 MH Add for ODM STA info. ++ // 2011/10/20 MH Add for ODM STA info. + // + // Driver Write + u8 bValid; // record the sta status link or not? -+ //u8 WirelessMode; // ++ //u8 WirelessMode; // + u8 IOTPeer; // Enum value. HT_IOT_PEER_E ++ u8 rssi_level; //for Refresh RA mask + // ODM Write + //1 PHY_STATUS_INFO -+ u8 RSSI_Path[4]; // ++ u8 RSSI_Path[4]; // + u8 RSSI_Ave; + u8 RXEVM[4]; + u8 RXSNR[4]; + -+ u8 rssi_level; //for Refresh RA mask + // ODM Write + //1 TX_INFO (may changed by IC) + //TX_INFO_T pTxInfo; // Define in IC folder. Move lower layer. @@ -338700,15 +153531,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 +#define sta_rx_data_pkts(sta) \ + (sta->sta_stats.rx_data_pkts) + -+#define sta_rx_data_qos_pkts(sta, i) \ -+ (sta->sta_stats.rx_data_qos_pkts[i]) -+ +#define sta_last_rx_data_pkts(sta) \ + (sta->sta_stats.last_rx_data_pkts) + -+#define sta_last_rx_data_qos_pkts(sta, i) \ -+ (sta->sta_stats.last_rx_data_qos_pkts[i]) -+ +#define sta_rx_mgnt_pkts(sta) \ + (sta->sta_stats.rx_mgnt_pkts) + @@ -338773,21 +153598,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + , sta->sta_stats.rx_data_pkts -sta->sta_stats.last_rx_data_pkts + +#define STA_PKTS_FMT "(m:%llu, c:%llu, d:%llu)" -+ ++ +struct sta_priv { -+ ++ + u8 *pallocated_stainfo_buf; + u8 *pstainfo_buf; + _queue free_sta_queue; -+ ++ + _lock sta_hash_lock; + _list sta_hash[NUM_STA]; + int asoc_sta_count; + _queue sleep_q; + _queue wakeup_q; -+ ++ + _adapter *padapter; -+ ++ + +#ifdef CONFIG_AP_MODE + _list asoc_list; @@ -338800,7 +153625,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + unsigned int auth_to; //sec, time to expire in authenticating. + unsigned int assoc_to; //sec, time to expire before associating. + unsigned int expire_to; //sec , time to expire after associated. -+ ++ + /* pointers to STA info; based on allocated AID or NULL if AID free + * AID is in the range 1-2007, so sta_aid[0] corresponders to AID 1 + * and so on @@ -338808,17 +153633,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + struct sta_info *sta_aid[NUM_STA]; + + u16 sta_dz_bitmap;//only support 15 stations, staion aid bitmap for sleeping sta. -+ u16 tim_bitmap;//only support 15 stations, aid=0~15 mapping bit0~bit15 ++ u16 tim_bitmap;//only support 15 stations, aid=0~15 mapping bit0~bit15 + + u16 max_num_sta; + + struct wlan_acl_pool acl_list; +#endif + -+#ifdef CONFIG_ATMEL_RC_PATCH -+ u8 atmel_rc_pattern [6]; -+#endif -+ +}; + + @@ -338835,7 +153656,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 + + x ^= x >> 8; + x = x & (NUM_STA - 1); -+ ++ + return x; +} + @@ -338856,15 +153677,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/sta_info.h linux/3rdparty/rtl881 +extern u8 rtw_access_ctrl(_adapter *padapter, u8 *mac_addr); + +#endif //_STA_INFO_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_hal.h linux/3rdparty/rtl8812au/include/usb_hal.h ---- linux.old/3rdparty/rtl8812au/include/usb_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/usb_hal.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,57 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/usb_hal.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_hal.h +--- linux-4.14.17/3rdparty/rtl8812au/include/usb_hal.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_hal.h 2018-02-06 17:42:30.722967342 +0200 +@@ -0,0 +1,24 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -338874,58 +153694,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_hal.h linux/3rdparty/rtl8812 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __USB_HAL_H__ +#define __USB_HAL_H__ + -+int usb_init_recv_priv(_adapter *padapter, u16 ini_in_buf_sz); -+void usb_free_recv_priv (_adapter *padapter, u16 ini_in_buf_sz); -+ -+u8 rtw_set_hal_ops(_adapter *padapter); -+ -+#ifdef CONFIG_RTL8188E -+void rtl8188eu_set_hal_ops(_adapter * padapter); -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ++void rtw_set_hal_ops(_adapter *padapter); +void rtl8812au_set_hal_ops(_adapter * padapter); -+#endif -+ -+#ifdef CONFIG_RTL8192E -+void rtl8192eu_set_hal_ops(_adapter * padapter); -+#endif -+ -+ -+#ifdef CONFIG_RTL8723B -+void rtl8723bu_set_hal_ops(_adapter * padapter); -+#endif -+ -+#ifdef CONFIG_RTL8814A -+void rtl8814au_set_hal_ops(_adapter * padapter); -+#endif /* CONFIG_RTL8814A */ -+ -+#ifdef CONFIG_RTL8188F -+void rtl8188fu_set_hal_ops(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_INTEL_PROXIM ++#ifdef CONFIG_INTEL_PROXIM +extern _adapter *rtw_usb_get_sw_pointer(void); +#endif //CONFIG_INTEL_PROXIM -+#endif //__USB_HAL_H__ + -diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_ops.h linux/3rdparty/rtl8812au/include/usb_ops.h ---- linux.old/3rdparty/rtl8812au/include/usb_ops.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/usb_ops.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,139 @@ ++#endif //__USB_HAL_H__ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/usb_ops.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_ops.h +--- linux-4.14.17/3rdparty/rtl8812au/include/usb_ops.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_ops.h 2018-02-06 17:42:30.722967342 +0200 +@@ -0,0 +1,105 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -338935,21 +153722,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_ops.h linux/3rdparty/rtl8812 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __USB_OPS_H_ +#define __USB_OPS_H_ + + +#define REALTEK_USB_VENQT_READ 0xC0 -+#define REALTEK_USB_VENQT_WRITE 0x40 ++#define REALTEK_USB_VENQT_WRITE 0x40 +#define REALTEK_USB_VENQT_CMD_REQ 0x05 +#define REALTEK_USB_VENQT_CMD_IDX 0x00 -+#define REALTEK_USB_IN_INT_EP_IDX 1 + +enum{ + VENDOR_WRITE = 0x00, @@ -338959,76 +153740,49 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_ops.h linux/3rdparty/rtl8812 +#define MAX_VENDOR_REQ_CMD_SIZE 254 //8188cu SIE Support +#define MAX_USB_IO_CTL_SIZE (MAX_VENDOR_REQ_CMD_SIZE +ALIGNMENT_UNIT) + -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,12)) ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,12)) +#define rtw_usb_control_msg(dev, pipe, request, requesttype, value, index, data, size, timeout_ms) \ -+ usb_control_msg((dev), (pipe), (request), (requesttype), (value), (index), (data), (size), (timeout_ms)) ++ usb_control_msg((dev), (pipe), (request), (requesttype), (value), (index), (data), (size), (timeout_ms)) +#define rtw_usb_bulk_msg(usb_dev, pipe, data, len, actual_length, timeout_ms) \ + usb_bulk_msg((usb_dev), (pipe), (data), (len), (actual_length), (timeout_ms)) +#else +#define rtw_usb_control_msg(dev, pipe, request, requesttype, value, index, data, size,timeout_ms) \ + usb_control_msg((dev), (pipe), (request), (requesttype), (value), (index), (data), (size), \ -+ ((timeout_ms) == 0) ||((timeout_ms)*HZ/1000>0)?((timeout_ms)*HZ/1000):1) ++ ((timeout_ms) == 0) ||((timeout_ms)*HZ/1000>0)?((timeout_ms)*HZ/1000):1) +#define rtw_usb_bulk_msg(usb_dev, pipe, data, len, actual_length, timeout_ms) \ + usb_bulk_msg((usb_dev), (pipe), (data), (len), (actual_length), \ -+ ((timeout_ms) == 0) ||((timeout_ms)*HZ/1000>0)?((timeout_ms)*HZ/1000):1) ++ ((timeout_ms) == 0) ||((timeout_ms)*HZ/1000>0)?((timeout_ms)*HZ/1000):1) +#endif +#include -+#endif //PLATFORM_LINUX + -+#ifdef CONFIG_RTL8188E -+void rtl8188eu_set_hw_type(struct dvobj_priv *pdvobj); -+void rtl8188eu_set_intf_ops(struct _io_ops *pops); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8188eu(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+void rtl8812au_set_hw_type(struct dvobj_priv *pdvobj); ++void rtl8812au_set_hw_type(_adapter *padapter); +void rtl8812au_set_intf_ops(struct _io_ops *pops); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8812au(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+#endif + -+#ifdef CONFIG_RTL8814A -+void rtl8814au_set_hw_type(struct dvobj_priv *pdvobj); -+void rtl8814au_set_intf_ops(struct _io_ops *pops); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8814au(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+#endif /* CONFIG_RTL8814 */ -+ -+#ifdef CONFIG_RTL8192E -+void rtl8192eu_set_hw_type(struct dvobj_priv *pdvobj); -+void rtl8192eu_set_intf_ops(struct _io_ops *pops); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8192eu(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+ -+#endif -+ -+#ifdef CONFIG_RTL8188F -+void rtl8188fu_set_hw_type(struct dvobj_priv *pdvobj); -+void rtl8188fu_set_intf_ops(struct _io_ops *pops); -+void rtl8188fu_recv_tasklet(void *priv); -+void rtl8188fu_xmit_tasklet(void *priv); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8188fu(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+#endif -+ -+#ifdef CONFIG_RTL8723B -+void rtl8723bu_set_hw_type(struct dvobj_priv *pdvobj); -+void rtl8723bu_set_intf_ops(struct _io_ops *pops); -+void rtl8723bu_recv_tasklet(void *priv); -+void rtl8723bu_xmit_tasklet(void *priv); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8723bu(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+#endif ++/* ++* Increase and check if the continual_urb_error of this @param dvobjprive is larger than MAX_CONTINUAL_URB_ERR ++* @return true: ++* @return false: ++*/ ++static inline int rtw_inc_and_chk_continual_urb_error(struct dvobj_priv *dvobj) ++{ ++ int ret = false; ++ int value; ++ if( (value=ATOMIC_INC_RETURN(&dvobj->continual_urb_error)) > MAX_CONTINUAL_URB_ERR) { ++ DBG_871X("[dvobj:%p][ERROR] continual_urb_error:%d > %d\n", dvobj, value, MAX_CONTINUAL_URB_ERR); ++ ret = true; ++ } else { ++ //DBG_871X("[dvobj:%p] continual_urb_error:%d\n", dvobj, value); ++ } ++ return ret; ++} + ++/* ++* Set the continual_urb_error of this @param dvobjprive to 0 ++*/ ++static inline void rtw_reset_continual_urb_error(struct dvobj_priv *dvobj) ++{ ++ ATOMIC_SET(&dvobj->continual_urb_error, 0); ++} + +enum RTW_USB_SPEED { + RTW_USB_SPEED_UNKNOWN = 0, @@ -339047,28 +153801,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_ops.h linux/3rdparty/rtl8812 + +static inline u8 rtw_usb_bulk_size_boundary(_adapter * padapter,int buf_len) +{ -+ u8 rst = _TRUE; ++ u8 rst = true; + + if (IS_SUPER_SPEED_USB(padapter)) -+ rst = (0 == (buf_len) % USB_SUPER_SPEED_BULK_SIZE)?_TRUE:_FALSE; ++ rst = (0 == (buf_len) % USB_SUPER_SPEED_BULK_SIZE)?true:false; + if (IS_HIGH_SPEED_USB(padapter)) -+ rst = (0 == (buf_len) % USB_HIGH_SPEED_BULK_SIZE)?_TRUE:_FALSE; -+ else -+ rst = (0 == (buf_len) % USB_FULL_SPEED_BULK_SIZE)?_TRUE:_FALSE; ++ rst = (0 == (buf_len) % USB_HIGH_SPEED_BULK_SIZE)?true:false; ++ else ++ rst = (0 == (buf_len) % USB_FULL_SPEED_BULK_SIZE)?true:false; + return rst; +} + + +#endif //__USB_OPS_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_ops_linux.h linux/3rdparty/rtl8812au/include/usb_ops_linux.h ---- linux.old/3rdparty/rtl8812au/include/usb_ops_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/usb_ops_linux.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,89 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/usb_ops_linux.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_ops_linux.h +--- linux-4.14.17/3rdparty/rtl8812au/include/usb_ops_linux.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_ops_linux.h 2018-02-06 17:42:30.722967342 +0200 +@@ -0,0 +1,63 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -339078,11 +153831,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_ops_linux.h linux/3rdparty/r + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __USB_OPS_LINUX_H__ +#define __USB_OPS_LINUX_H__ @@ -339093,10 +153841,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_ops_linux.h linux/3rdparty/r +#define RTW_USB_CONTROL_MSG_TIMEOUT_TEST 10//ms +#define RTW_USB_CONTROL_MSG_TIMEOUT 500//ms + -+#define RECV_BULK_IN_ADDR 0x80//assign by drv,not real address -+#define RECV_INT_IN_ADDR 0x81//assign by drv,not real address ++#define RECV_BULK_IN_ADDR 0x80//assign by drv,not real address ++#define RECV_INT_IN_ADDR 0x81//assign by drv,not real address + -+#define INTERRUPT_MSG_FORMAT_LEN 60 + +#if defined(CONFIG_VENDOR_REQ_RETRY) && defined(CONFIG_USB_VENDOR_REQ_MUTEX) +/* vendor req retry should be in the situation when each vendor req is atomically submitted from others */ @@ -339133,35 +153880,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_ops_linux.h linux/3rdparty/r +void usb_write_port_cancel(struct intf_hdl *pintfhdl); + +int usbctrl_vendorreq(struct intf_hdl *pintfhdl, u8 request, u16 value, u16 index, void *pdata, u16 len, u8 requesttype); -+#ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ -+int _usbctrl_vendorreq_async_write(struct usb_device *udev, u8 request, -+ u16 value, u16 index, void *pdata, u16 len, u8 requesttype); -+#endif /* CONFIG_USB_SUPPORT_ASYNC_VDN_REQ */ -+ -+u8 usb_read8(struct intf_hdl *pintfhdl, u32 addr); -+u16 usb_read16(struct intf_hdl *pintfhdl, u32 addr); -+u32 usb_read32(struct intf_hdl *pintfhdl, u32 addr); -+int usb_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+int usb_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+int usb_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+int usb_writeN(struct intf_hdl *pintfhdl, u32 addr, u32 length, u8 *pdata); -+u32 usb_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem); -+void usb_recv_tasklet(void *priv); -+ -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+void usb_read_interrupt_complete(struct urb *purb, struct pt_regs *regs); -+u32 usb_read_interrupt(struct intf_hdl *pintfhdl, u32 addr); +#endif -+#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_osintf.h linux/3rdparty/rtl8812au/include/usb_osintf.h ---- linux.old/3rdparty/rtl8812au/include/usb_osintf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/usb_osintf.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,32 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/usb_osintf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_osintf.h +--- linux-4.14.17/3rdparty/rtl8812au/include/usb_osintf.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_osintf.h 2018-02-06 17:42:30.722967342 +0200 +@@ -0,0 +1,29 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -339171,33 +153898,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_osintf.h linux/3rdparty/rtl8 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __USB_OSINTF_H +#define __USB_OSINTF_H + +#include + -+#define USBD_HALTED(Status) ((ULONG)(Status) >> 30 == 3) ++#define USBD_HALTED(Status) ((u32)(Status) >> 30 == 3) + + ++//uint usb_dvobj_init(_adapter * adapter); ++//void usb_dvobj_deinit(_adapter * adapter); ++ +u8 usbvendorrequest(struct dvobj_priv *pdvobjpriv, RT_USB_BREQUEST brequest, RT_USB_WVALUE wvalue, u8 windex, void* data, u8 datalen, u8 isdirectionin); + + +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_vendor_req.h linux/3rdparty/rtl8812au/include/usb_vendor_req.h ---- linux.old/3rdparty/rtl8812au/include/usb_vendor_req.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/usb_vendor_req.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,60 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/usb_vendor_req.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_vendor_req.h +--- linux-4.14.17/3rdparty/rtl8812au/include/usb_vendor_req.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_vendor_req.h 2018-02-06 17:42:30.722967342 +0200 +@@ -0,0 +1,54 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -339207,11 +153931,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_vendor_req.h linux/3rdparty/ + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef _USB_VENDOR_REQUEST_H_ +#define _USB_VENDOR_REQUEST_H_ @@ -339247,21 +153966,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/usb_vendor_req.h linux/3rdparty/ +} RT_USB_WVALUE; + + -+//BOOLEAN usbvendorrequest(PCE_USB_DEVICE CEdevice, RT_USB_BREQUEST bRequest, RT_USB_WVALUE wValue, UCHAR wIndex, PVOID Data, UCHAR DataLength, BOOLEAN isDirectionIn); -+//BOOLEAN CEusbGetStatusRequest(PCE_USB_DEVICE CEdevice, IN USHORT Op, IN USHORT Index, PVOID Data); -+//BOOLEAN CEusbFeatureRequest(PCE_USB_DEVICE CEdevice, IN USHORT Op, IN USHORT FeatureSelector, IN USHORT Index); -+//BOOLEAN CEusbGetDescriptorRequest(PCE_USB_DEVICE CEdevice, IN short urbLength, IN UCHAR DescriptorType, IN UCHAR Index, IN USHORT LanguageId, IN PVOID TransferBuffer, IN ULONG TransferBufferLength); ++//bool usbvendorrequest(PCE_USB_DEVICE CEdevice, RT_USB_BREQUEST bRequest, RT_USB_WVALUE wValue, u8 wIndex, void * Data, u8 DataLength, bool isDirectionIn); ++//bool CEusbGetStatusRequest(PCE_USB_DEVICE CEdevice, u16 Op, u16 Index, void * Data); ++//bool CEusbFeatureRequest(PCE_USB_DEVICE CEdevice, u16 Op, u16 FeatureSelector, u16 Index); ++//bool CEusbGetDescriptorRequest(PCE_USB_DEVICE CEdevice, short urbLength, u8 DescriptorType, u8 Index, u16 LanguageId, void * TransferBuffer, u32 TransferBufferLength); + +#endif -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/include/wifi.h ---- linux.old/3rdparty/rtl8812au/include/wifi.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/wifi.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,1397 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/wifi.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/wifi.h +--- linux-4.14.17/3rdparty/rtl8812au/include/wifi.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/wifi.h 2018-02-06 17:42:30.722967342 +0200 +@@ -0,0 +1,1214 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -339271,11 +153989,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef _WIFI_H_ +#define _WIFI_H_ @@ -339308,7 +154021,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ +#define WLAN_MIN_ETHFRM_LEN 60 +#define WLAN_MAX_ETHFRM_LEN 1514 +#define WLAN_ETHHDR_LEN 14 -+#define WLAN_WMM_LEN 24 + +#define P80211CAPTURE_VERSION 0x80211001 + @@ -339324,7 +154036,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + WIFI_MGT_TYPE = (0), + WIFI_CTRL_TYPE = (BIT(2)), + WIFI_DATA_TYPE = (BIT(3)), -+ WIFI_QOS_DATA_TYPE = (BIT(7)|BIT(3)), //!< QoS Data ++ WIFI_QOS_DATA_TYPE = (BIT(7)|BIT(3)), //!< QoS Data +}; + +enum WIFI_FRAME_SUBTYPE { @@ -339342,10 +154054,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + WIFI_AUTH = (BIT(7) | BIT(5) | BIT(4) | WIFI_MGT_TYPE), + WIFI_DEAUTH = (BIT(7) | BIT(6) | WIFI_MGT_TYPE), + WIFI_ACTION = (BIT(7) | BIT(6) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_ACTION_NOACK = (BIT(7) | BIT(6) | BIT(5) | WIFI_MGT_TYPE), + + // below is for control frame -+ WIFI_NDPA = (BIT(6) | BIT(4) | WIFI_CTRL_TYPE), + WIFI_PSPOLL = (BIT(7) | BIT(5) | WIFI_CTRL_TYPE), + WIFI_RTS = (BIT(7) | BIT(5) | BIT(4) | WIFI_CTRL_TYPE), + WIFI_CTS = (BIT(7) | BIT(6) | WIFI_CTRL_TYPE), @@ -339430,8 +154140,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ +enum WIFI_STATUS_CODE { + _STATS_SUCCESSFUL_ = 0, + _STATS_FAILURE_ = 1, -+ _STATS_SEC_DISABLED_ = 5, -+ _STATS_NOT_IN_SAME_BSS_ = 7, + _STATS_CAP_FAIL_ = 10, + _STATS_NO_ASOC_ = 11, + _STATS_OTHER_ = 12, @@ -339441,10 +154149,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + _STATS_AUTH_TIMEOUT_ = 16, + _STATS_UNABLE_HANDLE_STA_ = 17, + _STATS_RATE_FAIL_ = 18, -+ _STATS_REFUSED_TEMPORARILY_ = 30, -+ _STATS_DECLINE_REQ_ = 37, -+ _STATS_INVALID_PARAMETERS_ = 38, -+ _STATS_INVALID_RSNIE_ = 72, +}; + +/* Status codes (IEEE 802.11-2007, 7.3.1.9, Table 7-23) */ @@ -339461,7 +154165,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ +#define WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA 17 +#define WLAN_STATUS_ASSOC_DENIED_RATES 18 +#endif -+//entended ++//entended +/* IEEE 802.11b */ +#define WLAN_STATUS_ASSOC_DENIED_NOSHORT 19 +#define WLAN_STATUS_ASSOC_DENIED_NOPBCC 20 @@ -339521,206 +154225,167 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ +#define _ORDER_ BIT(15) + +#define SetToDs(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_TO_DS_); \ -+ } while(0) ++ *(__le16 *)(pbuf) |= cpu_to_le16(_TO_DS_) + -+#define GetToDs(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_TO_DS_)) != 0) ++#define GetToDs(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_TO_DS_)) != 0) + +#define ClearToDs(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_TO_DS_)); \ -+ } while(0) ++ *(__le16 *)(pbuf) &= (~cpu_to_le16(_TO_DS_)) + +#define SetFrDs(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_FROM_DS_); \ -+ } while(0) ++ *(__le16 *)(pbuf) |= cpu_to_le16(_FROM_DS_) + -+#define GetFrDs(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_FROM_DS_)) != 0) ++#define GetFrDs(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_FROM_DS_)) != 0) + +#define ClearFrDs(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_FROM_DS_)); \ -+ } while(0) ++ *(__le16 *)(pbuf) &= (~cpu_to_le16(_FROM_DS_)) + +#define get_tofr_ds(pframe) ((GetToDs(pframe) << 1) | GetFrDs(pframe)) + + +#define SetMFrag(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_MORE_FRAG_); \ -+ } while(0) ++ *(__le16 *)(pbuf) |= cpu_to_le16(_MORE_FRAG_) + -+#define GetMFrag(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_MORE_FRAG_)) != 0) ++#define GetMFrag(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_MORE_FRAG_)) != 0) + +#define ClearMFrag(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_MORE_FRAG_)); \ -+ } while(0) ++ *(__le16 *)(pbuf) &= (~cpu_to_le16(_MORE_FRAG_)) + +#define SetRetry(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_RETRY_); \ -+ } while(0) ++ *(__le16 *)(pbuf) |= cpu_to_le16(_RETRY_) + -+#define GetRetry(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_RETRY_)) != 0) ++#define GetRetry(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_RETRY_)) != 0) + +#define ClearRetry(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_RETRY_)); \ -+ } while(0) ++ *(__le16 *)(pbuf) &= (~cpu_to_le16(_RETRY_)) + +#define SetPwrMgt(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_PWRMGT_); \ -+ } while(0) ++ *(__le16 *)(pbuf) |= cpu_to_le16(_PWRMGT_) + -+#define GetPwrMgt(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_PWRMGT_)) != 0) ++#define GetPwrMgt(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_PWRMGT_)) != 0) + +#define ClearPwrMgt(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_PWRMGT_)); \ -+ } while(0) ++ *(__le16 *)(pbuf) &= (~cpu_to_le16(_PWRMGT_)) + +#define SetMData(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_MORE_DATA_); \ -+ } while(0) ++ *(__le16 *)(pbuf) |= cpu_to_le16(_MORE_DATA_) + -+#define GetMData(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_MORE_DATA_)) != 0) ++#define GetMData(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_MORE_DATA_)) != 0) + +#define ClearMData(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_MORE_DATA_)); \ -+ } while(0) ++ *(__le16 *)(pbuf) &= (~cpu_to_le16(_MORE_DATA_)) + +#define SetPrivacy(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_PRIVACY_); \ -+ } while(0) ++ *(__le16 *)(pbuf) |= cpu_to_le16(_PRIVACY_) + -+#define GetPrivacy(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_PRIVACY_)) != 0) ++#define GetPrivacy(pbuf) \ ++ (((*(__le16 *)(pbuf)) & cpu_to_le16(_PRIVACY_)) != 0) + +#define ClearPrivacy(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_PRIVACY_)); \ -+ } while(0) ++ *(__le16 *)(pbuf) &= (~cpu_to_le16(_PRIVACY_)) + + -+#define GetOrder(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_ORDER_)) != 0) ++#define GetOrder(pbuf) \ ++ (((*(__le16 *)(pbuf)) & cpu_to_le16(_ORDER_)) != 0) + -+#define GetFrameType(pbuf) (le16_to_cpu(*(unsigned short *)(pbuf)) & (BIT(3) | BIT(2))) ++#define GetFrameType(pbuf) \ ++ (le16_to_cpu(*(__le16 *)(pbuf)) & (BIT(3) | BIT(2))) + -+#define SetFrameType(pbuf,type) \ -+ do { \ ++#define SetFrameType(pbuf, type) \ ++ do { \ + *(unsigned short *)(pbuf) &= __constant_cpu_to_le16(~(BIT(3) | BIT(2))); \ + *(unsigned short *)(pbuf) |= __constant_cpu_to_le16(type); \ -+ } while(0) ++ } while (0) + -+#define GetFrameSubType(pbuf) (cpu_to_le16(*(unsigned short *)(pbuf)) & (BIT(7) | BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2))) ++#define GetFrameSubType(pbuf) (le16_to_cpu(*(__le16 *)(pbuf)) & (BIT(7) |\ ++ BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2))) + -+#define SetFrameSubType(pbuf,type) \ ++#define SetFrameSubType(pbuf, type) \ + do { \ -+ *(unsigned short *)(pbuf) &= cpu_to_le16(~(BIT(7) | BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2))); \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(type); \ -+ } while(0) ++ *(__le16 *)(pbuf) &= cpu_to_le16(~(BIT(7) | BIT(6) | \ ++ BIT(5) | BIT(4) | BIT(3) | BIT(2))); \ ++ *(__le16 *)(pbuf) |= cpu_to_le16(type); \ ++ } while (0) + -+#define GetSequence(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) >> 4) ++#define GetSequence(pbuf) \ ++ (le16_to_cpu(*(__le16 *)((size_t)(pbuf) + 22)) >> 4) + -+#define GetFragNum(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) & 0x0f) ++#define GetFragNum(pbuf) \ ++ (le16_to_cpu(*(__le16 *)((size_t)(pbuf) + 22)) & 0x0f) + -+#define GetTupleCache(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 22))) ++#define GetTupleCache(pbuf) \ ++ (cpu_to_le16(*(unsigned short *)((size_t)(pbuf) + 22))) + +#define SetFragNum(pbuf, num) \ + do { \ -+ *(unsigned short *)((SIZE_PTR)(pbuf) + 22) = \ -+ ((*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) & le16_to_cpu(~(0x000f))) | \ ++ *(unsigned short *)((size_t)(pbuf) + 22) = \ ++ ((*(unsigned short *)((size_t)(pbuf) + 22)) & \ ++ le16_to_cpu(~(0x000f))) | \ + cpu_to_le16(0x0f & (num)); \ -+ } while(0) ++ } while (0) + +#define SetSeqNum(pbuf, num) \ + do { \ -+ *(unsigned short *)((SIZE_PTR)(pbuf) + 22) = \ -+ ((*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) & le16_to_cpu((unsigned short)~0xfff0)) | \ -+ le16_to_cpu((unsigned short)(0xfff0 & (num << 4))); \ -+ } while(0) ++ *(__le16 *)((size_t)(pbuf) + 22) = \ ++ ((*(__le16 *)((size_t)(pbuf) + 22)) & cpu_to_le16((unsigned short)0x000f)) | \ ++ cpu_to_le16((unsigned short)(0xfff0 & (num << 4))); \ ++ } while (0) + +#define SetDuration(pbuf, dur) \ -+ do { \ -+ *(unsigned short *)((SIZE_PTR)(pbuf) + 2) = cpu_to_le16(0xffff & (dur)); \ -+ } while(0) ++ *(__le16 *)((size_t)(pbuf) + 2) = cpu_to_le16(0xffff & (dur)) + + +#define SetPriority(pbuf, tid) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(tid & 0xf); \ -+ } while(0) ++ *(__le16 *)(pbuf) |= cpu_to_le16(tid & 0xf) + -+#define GetPriority(pbuf) ((le16_to_cpu(*(unsigned short *)(pbuf))) & 0xf) ++#define GetPriority(pbuf) ((le16_to_cpu(*(__le16 *)(pbuf))) & 0xf) + +#define SetEOSP(pbuf, eosp) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16( (eosp & 1) << 4); \ -+ } while(0) ++ *(__le16 *)(pbuf) |= cpu_to_le16((eosp & 1) << 4) + +#define SetAckpolicy(pbuf, ack) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16( (ack & 3) << 5); \ -+ } while(0) ++ *(__le16 *)(pbuf) |= cpu_to_le16((ack & 3) << 5) + -+#define GetAckpolicy(pbuf) (((le16_to_cpu(*(unsigned short *)pbuf)) >> 5) & 0x3) ++#define GetAckpolicy(pbuf) (((le16_to_cpu(*(__le16 *)pbuf)) >> 5) & 0x3) + -+#define GetAMsdu(pbuf) (((le16_to_cpu(*(unsigned short *)pbuf)) >> 7) & 0x1) ++#define GetAMsdu(pbuf) (((le16_to_cpu(*(__le16 *)pbuf)) >> 7) & 0x1) + +#define SetAMsdu(pbuf, amsdu) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16( (amsdu & 1) << 7); \ -+ } while(0) ++ *(__le16 *)(pbuf) |= cpu_to_le16((amsdu & 1) << 7) + -+#define GetAid(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 2)) & 0x3fff) ++#define GetAid(pbuf) (le16_to_cpu(*(__le16 *)((size_t)(pbuf) + 2)) & 0x3fff) + -+#define GetTid(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + (((GetToDs(pbuf)<<1)|GetFrDs(pbuf))==3?30:24))) & 0x000f) ++#define GetTid(pbuf) (le16_to_cpu(*(__le16 *)((size_t)(pbuf) + \ ++ (((GetToDs(pbuf)<<1) | GetFrDs(pbuf)) == 3 ? \ ++ 30 : 24))) & 0x000f) + -+#define GetAddr1Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 4)) ++#define GetAddr1Ptr(pbuf) ((unsigned char *)((size_t)(pbuf) + 4)) + -+#define GetAddr2Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 10)) ++#define GetAddr2Ptr(pbuf) ((unsigned char *)((size_t)(pbuf) + 10)) + -+#define GetAddr3Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 16)) ++#define GetAddr3Ptr(pbuf) ((unsigned char *)((size_t)(pbuf) + 16)) + -+#define GetAddr4Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 24)) ++#define GetAddr4Ptr(pbuf) ((unsigned char *)((size_t)(pbuf) + 24)) + +#define MacAddr_isBcst(addr) \ +( \ + ( (addr[0] == 0xff) && (addr[1] == 0xff) && \ + (addr[2] == 0xff) && (addr[3] == 0xff) && \ -+ (addr[4] == 0xff) && (addr[5] == 0xff) ) ? _TRUE : _FALSE \ ++ (addr[4] == 0xff) && (addr[5] == 0xff) ) ? true : false \ +) + +__inline static int IS_MCAST(unsigned char *da) +{ + if ((*da) & 0x01) -+ return _TRUE; ++ return true; + else -+ return _FALSE; ++ return false; +} + -+__inline static unsigned char * get_ra(unsigned char *pframe) -+{ -+ unsigned char *ra; -+ ra = GetAddr1Ptr(pframe); -+ return ra; -+} -+__inline static unsigned char * get_ta(unsigned char *pframe) -+{ -+ unsigned char *ta; -+ ta = GetAddr2Ptr(pframe); -+ return ta; -+} + +__inline static unsigned char * get_da(unsigned char *pframe) +{ -+ unsigned char *da; ++ unsigned char *da; + unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); + + switch (to_fr_ds) { @@ -339744,7 +154409,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + +__inline static unsigned char * get_sa(unsigned char *pframe) +{ -+ unsigned char *sa; ++ unsigned char *sa; + unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); + + switch (to_fr_ds) { @@ -339767,7 +154432,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + +__inline static unsigned char * get_hdr_bssid(unsigned char *pframe) +{ -+ unsigned char *sa = NULL; ++ unsigned char *sa; + unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); + + switch (to_fr_ds) { @@ -339783,6 +154448,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + case 0x03: // ToDs=1, FromDs=1 + sa = GetAddr1Ptr(pframe); + break; ++ default: ++ sa =NULL; //??????? ++ break; + } + + return sa; @@ -339792,9 +154460,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ +__inline static int IsFrameTypeCtrl(unsigned char *pframe) +{ + if(WIFI_CTRL_TYPE == GetFrameType(pframe)) -+ return _TRUE; ++ return true; + else -+ return _FALSE; ++ return false; +} +/*----------------------------------------------------------------------------- + Below is for the security related definition @@ -339850,9 +154518,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ +//#define EID_BSSCoexistence 72 // 20/40 BSS Coexistence +//#define EID_BSSIntolerantChlReport 73 +#define _RIC_Descriptor_IE_ 75 -+#ifdef CONFIG_IEEE80211W -+#define _MME_IE_ 76 //802.11w Management MIC element -+#endif //CONFIG_IEEE80211W ++ +#define _LINK_ID_IE_ 101 +#define _CH_SWITCH_TIMING_ 104 +#define _PTI_BUFFER_STATUS_ 106 @@ -339878,7 +154544,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + EID_TClass = 14, + EID_Schedule = 15, + // -+ ++ + EID_Ctext = 16, /* challenge text*/ + EID_POWER_CONSTRAINT = 32, /* Power Constraint*/ + @@ -339890,8 +154556,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + + EID_MeasureRequest = 38, // Measurement Request + EID_MeasureReport = 39, // Measurement Report -+ -+ EID_ERPInfo = 42, ++ ++ EID_ERPInfo = 42, + + // Form 7.3.2: Information elements in 802.11E/D13.0, page 46. + EID_TSDelay = 43, @@ -339899,27 +154565,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + EID_HTCapability = 45, + EID_QoSCap = 46, + // -+ ++ + EID_WPA2 = 48, + EID_ExtSupRates = 50, + + EID_FTIE = 55, // Defined in 802.11r + EID_Timeout = 56, // Defined in 802.11r -+ ++ + EID_SupRegulatory = 59, // Supported Requlatory Classes 802.11y -+ EID_HTInfo = 61, ++ EID_HTInfo = 61, + EID_SecondaryChnlOffset = 62, -+ ++ + EID_BSSCoexistence = 72, // 20/40 BSS Coexistence + EID_BSSIntolerantChlReport = 73, + EID_OBSS = 74, // Overlapping BSS Scan Parameters -+ ++ + EID_LinkIdentifier = 101, // Defined in 802.11z + EID_WakeupSchedule = 102, // Defined in 802.11z + EID_ChnlSwitchTimeing = 104, // Defined in 802.11z + EID_PTIControl = 105, // Defined in 802.11z + EID_PUBufferStatus = 106, // Defined in 802.11z -+ ++ + EID_EXTCapability = 127, // Extended Capabilities + // From S19:Aironet IE and S21:AP IP address IE in CCX v1.13, p16 and p18. + EID_Aironet = 133, // 0x85: Aironet Element for Cisco CCX @@ -339927,14 +154593,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + + EID_CellPwr = 150, // 0x96: Cell Power Limit IE. Ref. 0x96. + -+ EID_CCKM = 156, ++ EID_CCKM = 156, + + EID_Vendor = 221, // 0xDD: Vendor Specific + + EID_WAPI = 68, -+ EID_VHTCapability = 191, // Based on 802.11ac D2.0 -+ EID_VHTOperation = 192, // Based on 802.11ac D2.0 -+ EID_AID = 197, /* Based on 802.11ac D4.0 */ ++ EID_VHTCapability = 191, // Based on 802.11ac D2.0 ++ EID_VHTOperation = 192, // Based on 802.11ac D2.0 + EID_OpModeNotification = 199, // Based on 802.11ac D3.0 +}ELEMENT_ID, *PELEMENT_ID; + @@ -339987,9 +154652,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ +#define _WEP_WPA_MIXED_PRIVACY_ 6 // WEP + WPA +*/ + -+#ifdef CONFIG_IEEE80211W -+#define _MME_IE_LENGTH_ 18 -+#endif //CONFIG_IEEE80211W +/*----------------------------------------------------------------------------- + Below is the definition for WMM +------------------------------------------------------------------------------*/ @@ -339998,7 +154660,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + + +/*----------------------------------------------------------------------------- -+ Below is the definition for 802.11n ++ Below is the definition for 802.11n +------------------------------------------------------------------------------*/ + +//#ifdef CONFIG_80211N_HT @@ -340010,7 +154672,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + +#define GetOrderBit(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_ORDER_)) != 0) + -+#define ACT_CAT_VENDOR 0x7F/* 127 */ + +/** + * struct rtw_ieee80211_bar - HT Block Ack Request @@ -340018,39 +154679,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + * This structure refers to "HT BlockAckReq" as + * described in 802.11n draft section 7.2.1.7.1 + */ -+ #if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8712FW) +struct rtw_ieee80211_bar { -+ unsigned short frame_control; -+ unsigned short duration; ++ __le16 frame_control; ++ __le16 duration; + unsigned char ra[6]; + unsigned char ta[6]; -+ unsigned short control; -+ unsigned short start_seq_num; ++ __le16 control; ++ __le16 start_seq_num; +} __attribute__((packed)); -+ #endif + +/* 802.11 BAR control masks */ +#define IEEE80211_BAR_CTRL_ACK_POLICY_NORMAL 0x0000 +#define IEEE80211_BAR_CTRL_CBMTID_COMPRESSED_BA 0x0004 + -+ -+ #if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8712FW) || defined(PLATFORM_FREEBSD) -+ -+ -+ + /** + * struct rtw_ieee80211_ht_cap - HT capabilities + * + * This structure refers to "HT capabilities element" as + * described in 802.11n draft section 7.3.2.52 + */ -+ ++ +struct rtw_ieee80211_ht_cap { -+ unsigned short cap_info; -+ unsigned char ampdu_params_info; -+ unsigned char supp_mcs_set[16]; -+ unsigned short extended_ht_cap_info; -+ unsigned int tx_BF_cap_info; ++ __le16 cap_info; ++ unsigned char ampdu_params_info; ++ unsigned char supp_mcs_set[16]; ++ __le16 extended_ht_cap_info; ++ __le16 tx_BF_cap_info; + unsigned char antenna_selection_info; +} __attribute__ ((packed)); + @@ -340061,25 +154715,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + * described in 802.11n draft section 7.3.2.53 + */ +struct ieee80211_ht_addt_info { -+ unsigned char control_chan; ++ unsigned char control_chan; + unsigned char ht_param; -+ unsigned short operation_mode; -+ unsigned short stbc_param; ++ __le16 operation_mode; ++ __le16 stbc_param; + unsigned char basic_set[16]; +} __attribute__ ((packed)); + -+ +struct HT_caps_element +{ + union -+ { -+ struct -+ { -+ unsigned short HT_caps_info; ++ { ++ struct ++ { ++ __le16 HT_caps_info; + unsigned char AMPDU_para; + unsigned char MCS_rate[16]; -+ unsigned short HT_ext_caps; -+ unsigned int Beamforming_caps; ++ __le16 HT_ext_caps; ++ __le16 Beamforming_caps; + unsigned char ASEL_caps; + } HT_cap_element; + unsigned char HT_cap[26]; @@ -340097,7 +154750,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ +{ + unsigned char ACI_AIFSN; + unsigned char CW; -+ unsigned short TXOP_limit; ++ __le16 TXOP_limit; +} __attribute__ ((packed)); + +struct WMM_para_element @@ -340110,123 +154763,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ +struct ADDBA_request +{ + unsigned char dialog_token; -+ unsigned short BA_para_set; -+ unsigned short BA_timeout_value; -+ unsigned short BA_starting_seqctrl; ++ __le16 BA_para_set; ++ __le16 BA_timeout_value; ++ __le16 BA_starting_seqctrl; +} __attribute__ ((packed)); + -+ -+ -+#endif -+ -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+ -+struct rtw_ieee80211_ht_cap { -+ unsigned short cap_info; -+ unsigned char ampdu_params_info; -+ unsigned char supp_mcs_set[16]; -+ unsigned short extended_ht_cap_info; -+ unsigned int tx_BF_cap_info; -+ unsigned char antenna_selection_info; -+}; -+ -+ -+struct ieee80211_ht_addt_info { -+ unsigned char control_chan; -+ unsigned char ht_param; -+ unsigned short operation_mode; -+ unsigned short stbc_param; -+ unsigned char basic_set[16]; -+}; -+ -+struct HT_caps_element -+{ -+ union -+ { -+ struct -+ { -+ unsigned short HT_caps_info; -+ unsigned char AMPDU_para; -+ unsigned char MCS_rate[16]; -+ unsigned short HT_ext_caps; -+ unsigned int Beamforming_caps; -+ unsigned char ASEL_caps; -+ } HT_cap_element; -+ unsigned char HT_cap[26]; -+ }; -+}; -+ -+struct HT_info_element -+{ -+ unsigned char primary_channel; -+ unsigned char infos[5]; -+ unsigned char MCS_rate[16]; -+}; -+ -+struct AC_param -+{ -+ unsigned char ACI_AIFSN; -+ unsigned char CW; -+ unsigned short TXOP_limit; -+}; -+ -+struct WMM_para_element -+{ -+ unsigned char QoS_info; -+ unsigned char reserved; -+ struct AC_param ac_param[4]; -+}; -+ -+struct ADDBA_request -+{ -+ unsigned char dialog_token; -+ unsigned short BA_para_set; -+ unsigned short BA_timeout_value; -+ unsigned short BA_starting_seqctrl; -+}; -+ -+ -+#pragma pack() -+ -+#endif -+ +typedef enum _HT_CAP_AMPDU_FACTOR { + MAX_AMPDU_FACTOR_8K = 0, + MAX_AMPDU_FACTOR_16K = 1, + MAX_AMPDU_FACTOR_32K = 2, -+ MAX_AMPDU_FACTOR_64K = 3, ++ MAX_AMPDU_FACTOR_64K = 3, +}HT_CAP_AMPDU_FACTOR; + -+ -+typedef enum _HT_CAP_AMPDU_DENSITY { -+ AMPDU_DENSITY_VALUE_0 = 0 , /* For no restriction */ -+ AMPDU_DENSITY_VALUE_1 = 1 , /* For 1/4 us */ -+ AMPDU_DENSITY_VALUE_2 = 2 , /* For 1/2 us */ -+ AMPDU_DENSITY_VALUE_3 = 3 , /* For 1 us */ -+ AMPDU_DENSITY_VALUE_4 = 4 , /* For 2 us */ -+ AMPDU_DENSITY_VALUE_5 = 5 , /* For 4 us */ -+ AMPDU_DENSITY_VALUE_6 = 6 , /* For 8 us */ -+ AMPDU_DENSITY_VALUE_7 = 7 , /* For 16 us */ -+} HT_CAP_AMPDU_DENSITY; -+ +/* 802.11n HT capabilities masks */ -+#define IEEE80211_HT_CAP_LDPC_CODING 0x0001 +#define IEEE80211_HT_CAP_SUP_WIDTH 0x0002 +#define IEEE80211_HT_CAP_SM_PS 0x000C +#define IEEE80211_HT_CAP_GRN_FLD 0x0010 +#define IEEE80211_HT_CAP_SGI_20 0x0020 +#define IEEE80211_HT_CAP_SGI_40 0x0040 +#define IEEE80211_HT_CAP_TX_STBC 0x0080 -+#define IEEE80211_HT_CAP_RX_STBC_1R 0x0100 -+#define IEEE80211_HT_CAP_RX_STBC_2R 0x0200 -+#define IEEE80211_HT_CAP_RX_STBC_3R 0x0300 ++#define IEEE80211_HT_CAP_RX_STBC 0x0300 +#define IEEE80211_HT_CAP_DELAY_BA 0x0400 +#define IEEE80211_HT_CAP_MAX_AMSDU 0x0800 +#define IEEE80211_HT_CAP_DSSSCCK40 0x1000 -+#define RTW_IEEE80211_HT_CAP_40MHZ_INTOLERANT ((u16) BIT(14)) +/* 802.11n HT capability AMPDU settings */ +#define IEEE80211_HT_CAP_AMPDU_FACTOR 0x03 +#define IEEE80211_HT_CAP_AMPDU_DENSITY 0x1C @@ -340239,16 +154798,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ +#define IEEE80211_HT_CAP_MCS_TX_RX_DIFF 0x02 +#define IEEE80211_HT_CAP_MCS_TX_STREAMS 0x0C +#define IEEE80211_HT_CAP_MCS_TX_UEQM 0x10 -+/* 802.11n HT capability TXBF capability */ -+#define IEEE80211_HT_CAP_TXBF_RX_NDP 0x00000008 -+#define IEEE80211_HT_CAP_TXBF_TX_NDP 0x00000010 -+#define IEEE80211_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP 0x00000400 -+ +/* 802.11n HT IE masks */ +#define IEEE80211_HT_IE_CHA_SEC_OFFSET 0x03 -+#define IEEE80211_HT_IE_CHA_SEC_NONE 0x00 -+#define IEEE80211_HT_IE_CHA_SEC_ABOVE 0x01 -+#define IEEE80211_HT_IE_CHA_SEC_BELOW 0x03 ++#define IEEE80211_HT_IE_CHA_SEC_NONE 0x00 ++#define IEEE80211_HT_IE_CHA_SEC_ABOVE 0x01 ++#define IEEE80211_HT_IE_CHA_SEC_BELOW 0x03 +#define IEEE80211_HT_IE_CHA_WIDTH 0x04 +#define IEEE80211_HT_IE_HT_PROTECTION 0x0003 +#define IEEE80211_HT_IE_NON_GF_STA_PRSNT 0x0004 @@ -340491,7 +155045,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + +#define P2P_FINDPHASE_EX_NONE 0 // default value, used when: (1)p2p disabed or (2)p2p enabled but only do 1 scan phase +#define P2P_FINDPHASE_EX_FULL 1 // used when p2p enabled and want to do 1 scan phase and P2P_FINDPHASE_EX_MAX-1 find phase -+#define P2P_FINDPHASE_EX_SOCIAL_FIRST (P2P_FINDPHASE_EX_FULL+1) ++#define P2P_FINDPHASE_EX_SOCIAL_FIRST (P2P_FINDPHASE_EX_FULL+1) +#define P2P_FINDPHASE_EX_MAX 4 +#define P2P_FINDPHASE_EX_SOCIAL_LAST P2P_FINDPHASE_EX_MAX + @@ -340525,7 +155079,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + P2P_ROLE_DISABLE = 0, + P2P_ROLE_DEVICE = 1, + P2P_ROLE_CLIENT = 2, -+ P2P_ROLE_GO = 3 ++ P2P_ROLE_GO = 3 +}; + +enum P2P_STATE { @@ -340537,7 +155091,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + P2P_STATE_FIND_PHASE_SEARCH = 5, // In the search state of find phase + P2P_STATE_TX_PROVISION_DIS_REQ = 6, // In P2P provisioning discovery + P2P_STATE_RX_PROVISION_DIS_RSP = 7, -+ P2P_STATE_RX_PROVISION_DIS_REQ = 8, ++ P2P_STATE_RX_PROVISION_DIS_REQ = 8, + P2P_STATE_GONEGO_ING = 9, // Doing the group owner negoitation handshake + P2P_STATE_GONEGO_OK = 10, // finish the group negoitation handshake with success + P2P_STATE_GONEGO_FAIL = 11, // finish the group negoitation handshake with failure @@ -340550,8 +155104,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + P2P_STATE_RECV_INVITE_REQ_GO = 18, // receiving the P2P Inviation request and this wifi is GO. + P2P_STATE_RECV_INVITE_REQ_JOIN = 19, // receiving the P2P Inviation request to join an existing P2P Group. + P2P_STATE_RX_INVITE_RESP_FAIL = 20, // recveing the P2P Inviation response with failure -+ P2P_STATE_RX_INFOR_NOREADY = 21, // receiving p2p negoitation response with information is not available -+ P2P_STATE_TX_INFOR_NOREADY = 22, // sending p2p negoitation response with information is not available ++ P2P_STATE_RX_INFOR_NOREADY = 21, // receiving p2p negoitation response with information is not available ++ P2P_STATE_TX_INFOR_NOREADY = 22, // sending p2p negoitation response with information is not available +}; + +enum P2P_WPSINFO { @@ -340568,7 +155122,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ + P2P_FIND_PHASE_WK = 0, + P2P_RESTORE_STATE_WK = 1, + P2P_PRE_TX_PROVDISC_PROCESS_WK = 2, -+ P2P_PRE_TX_NEGOREQ_PROCESS_WK = 3, ++ P2P_PRE_TX_NEGOREQ_PROCESS_WK = 3, + P2P_PRE_TX_INVITEREQ_PROCESS_WK = 4, + P2P_AP_P2P_CH_SWITCH_PROCESS_WK =5, + P2P_RO_CH_WK = 6, @@ -340606,7 +155160,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ +#define WFD_DEVINFO_SOURCE 0x0000 +#define WFD_DEVINFO_PSINK 0x0001 +#define WFD_DEVINFO_SSINK 0x0002 -+#define WFD_DEVINFO_DUAL 0x0003 ++#define WFD_DEVINFO_DUAL 0x0003 + +#define WFD_DEVINFO_SESSION_AVAIL 0x0010 +#define WFD_DEVINFO_WSD 0x0040 @@ -340618,25 +155172,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ +#define ICMPV6_MCAST_MAC(mac) ((mac[0]==0x33)&&(mac[1]==0x33)&&(mac[2]!=0xff)) +#endif // CONFIG_TX_MCAST2UNI + -+#ifdef CONFIG_IOCTL_CFG80211 -+/* Regulatroy Domain */ -+struct regd_pair_mapping { -+ u16 reg_dmnenum; -+ u16 reg_5ghz_ctl; -+ u16 reg_2ghz_ctl; -+}; + -+struct rtw_regulatory { -+ char alpha2[2]; -+ u16 country_code; -+ u16 max_power_level; -+ u32 tp_scale; -+ u16 current_rd; -+ u16 current_rd_ext; -+ int16_t power_limit; -+ struct regd_pair_mapping *regpair; -+}; -+#endif + +#ifdef CONFIG_WAPI_SUPPORT +#ifndef IW_AUTH_WAPI_VERSION_1 @@ -340654,15 +155190,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wifi.h linux/3rdparty/rtl8812au/ +#endif + +#endif // _WIFI_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h linux/3rdparty/rtl8812au/include/wlan_bssdef.h ---- linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/wlan_bssdef.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,742 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/wlan_bssdef.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/wlan_bssdef.h +--- linux-4.14.17/3rdparty/rtl8812au/include/wlan_bssdef.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/wlan_bssdef.h 2018-02-06 17:42:30.722967342 +0200 +@@ -0,0 +1,381 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -340672,11 +155207,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h linux/3rdparty/rtl + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __WLAN_BSSDEF_H__ +#define __WLAN_BSSDEF_H__ @@ -340684,27 +155214,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h linux/3rdparty/rtl + +#define MAX_IE_SZ 768 + -+ -+#ifdef PLATFORM_LINUX -+ +#define NDIS_802_11_LENGTH_SSID 32 +#define NDIS_802_11_LENGTH_RATES 8 +#define NDIS_802_11_LENGTH_RATES_EX 16 + +typedef unsigned char NDIS_802_11_MAC_ADDRESS[6]; -+typedef long NDIS_802_11_RSSI; // in dBm ++typedef long NDIS_802_11_RSSI; // in dBm +typedef unsigned char NDIS_802_11_RATES[NDIS_802_11_LENGTH_RATES]; // Set of 8 data rates +typedef unsigned char NDIS_802_11_RATES_EX[NDIS_802_11_LENGTH_RATES_EX]; // Set of 16 data rates + -+ -+typedef ULONG NDIS_802_11_KEY_INDEX; ++typedef u32 NDIS_802_11_KEY_INDEX; +typedef unsigned long long NDIS_802_11_KEY_RSC; + -+ +typedef struct _NDIS_802_11_SSID +{ -+ ULONG SsidLength; -+ UCHAR Ssid[32]; ++ u32 SsidLength; ++ u8 Ssid[32]; +} NDIS_802_11_SSID, *PNDIS_802_11_SSID; + +typedef enum _NDIS_802_11_NETWORK_TYPE @@ -340718,66 +155243,51 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h linux/3rdparty/rtl + +typedef struct _NDIS_802_11_CONFIGURATION_FH +{ -+ ULONG Length; // Length of structure -+ ULONG HopPattern; // As defined by 802.11, MSB set -+ ULONG HopSet; // to one if non-802.11 -+ ULONG DwellTime; // units are Kusec ++ u32 Length; // Length of structure ++ u32 HopPattern; // As defined by 802.11, MSB set ++ u32 HopSet; // to one if non-802.11 ++ u32 DwellTime; // units are Kusec +} NDIS_802_11_CONFIGURATION_FH, *PNDIS_802_11_CONFIGURATION_FH; -+ + +/* + FW will only save the channel number in DSConfig. -+ ODI Handler will convert the channel number to freq. number. ++ ODI Handler will convert the channel number to freq. number. +*/ +typedef struct _NDIS_802_11_CONFIGURATION +{ -+ ULONG Length; // Length of structure -+ ULONG BeaconPeriod; // units are Kusec -+ ULONG ATIMWindow; // units are Kusec -+ ULONG DSConfig; /* channel number */ ++ u32 Length; // Length of structure ++ u32 BeaconPeriod; // units are Kusec ++ u32 ATIMWindow; // units are Kusec ++ u32 DSConfig; // Frequency, units are kHz + NDIS_802_11_CONFIGURATION_FH FHConfig; +} NDIS_802_11_CONFIGURATION, *PNDIS_802_11_CONFIGURATION; + -+ -+ +typedef enum _NDIS_802_11_NETWORK_INFRASTRUCTURE +{ + Ndis802_11IBSS, + Ndis802_11Infrastructure, + Ndis802_11AutoUnknown, + Ndis802_11InfrastructureMax, // Not a real value, defined as upper bound -+ Ndis802_11APMode, -+ Ndis802_11Monitor, ++ Ndis802_11APMode +} NDIS_802_11_NETWORK_INFRASTRUCTURE, *PNDIS_802_11_NETWORK_INFRASTRUCTURE; + -+ -+ -+ -+ +typedef struct _NDIS_802_11_FIXED_IEs +{ -+ UCHAR Timestamp[8]; -+ USHORT BeaconInterval; -+ USHORT Capabilities; ++ u8 Timestamp[8]; ++ u16 BeaconInterval; ++ u16 Capabilities; +} NDIS_802_11_FIXED_IEs, *PNDIS_802_11_FIXED_IEs; + -+ -+ +typedef struct _NDIS_802_11_VARIABLE_IEs +{ -+ UCHAR ElementID; -+ UCHAR Length; -+ UCHAR data[1]; ++ u8 ElementID; ++ u8 Length; ++ u8 data[1]; +} NDIS_802_11_VARIABLE_IEs, *PNDIS_802_11_VARIABLE_IEs; + -+ -+ +/* -+ -+ -+ +Length is the 4 bytes multiples of the sume of -+ sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + sizeof (NDIS_802_11_SSID) + sizeof (ULONG) ++ sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + sizeof (NDIS_802_11_SSID) + sizeof (u32) ++ sizeof (NDIS_802_11_RSSI) + sizeof (NDIS_802_11_NETWORK_TYPE) + sizeof (NDIS_802_11_CONFIGURATION) ++ sizeof (NDIS_802_11_RATES_EX) + IELength + @@ -340785,30 +155295,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h linux/3rdparty/rtl +partial sum. + +*/ -+#if 0 -+typedef struct _NDIS_WLAN_BSSID_EX -+{ -+ ULONG Length; -+ NDIS_802_11_MAC_ADDRESS MacAddress; -+ UCHAR Reserved[2];//[0]: IS beacon frame, [1]:optimum_antenna=>For antenna diversity; -+ NDIS_802_11_SSID Ssid; -+ ULONG Privacy; -+ NDIS_802_11_RSSI Rssi; -+ NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; -+ NDIS_802_11_CONFIGURATION Configuration; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; -+ NDIS_802_11_RATES_EX SupportedRates; -+ ULONG IELength; -+ UCHAR IEs[MAX_IE_SZ]; //(timestamp, beacon interval, and capability information) -+} NDIS_WLAN_BSSID_EX, *PNDIS_WLAN_BSSID_EX; -+ -+ -+typedef struct _NDIS_802_11_BSSID_LIST_EX -+{ -+ ULONG NumberOfItems; -+ NDIS_WLAN_BSSID_EX Bssid[1]; -+} NDIS_802_11_BSSID_LIST_EX, *PNDIS_802_11_BSSID_LIST_EX; -+#endif + +typedef enum _NDIS_802_11_AUTHENTICATION_MODE +{ @@ -340851,29 +155337,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h linux/3rdparty/rtl + +typedef struct _NDIS_802_11_AI_REQFI +{ -+ USHORT Capabilities; -+ USHORT ListenInterval; ++ u16 Capabilities; ++ u16 ListenInterval; + NDIS_802_11_MAC_ADDRESS CurrentAPAddress; +} NDIS_802_11_AI_REQFI, *PNDIS_802_11_AI_REQFI; + +typedef struct _NDIS_802_11_AI_RESFI +{ -+ USHORT Capabilities; -+ USHORT StatusCode; -+ USHORT AssociationId; ++ u16 Capabilities; ++ u16 StatusCode; ++ u16 AssociationId; +} NDIS_802_11_AI_RESFI, *PNDIS_802_11_AI_RESFI; + +typedef struct _NDIS_802_11_ASSOCIATION_INFORMATION +{ -+ ULONG Length; -+ USHORT AvailableRequestFixedIEs; ++ u32 Length; ++ u16 AvailableRequestFixedIEs; + NDIS_802_11_AI_REQFI RequestFixedIEs; -+ ULONG RequestIELength; -+ ULONG OffsetRequestIEs; -+ USHORT AvailableResponseFixedIEs; ++ u32 RequestIELength; ++ u32 OffsetRequestIEs; ++ u16 AvailableResponseFixedIEs; + NDIS_802_11_AI_RESFI ResponseFixedIEs; -+ ULONG ResponseIELength; -+ ULONG OffsetResponseIEs; ++ u32 ResponseIELength; ++ u32 OffsetResponseIEs; +} NDIS_802_11_ASSOCIATION_INFORMATION, *PNDIS_802_11_ASSOCIATION_INFORMATION; + +typedef enum _NDIS_802_11_RELOAD_DEFAULTS @@ -340885,41 +155371,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h linux/3rdparty/rtl +// Key mapping keys require a BSSID +typedef struct _NDIS_802_11_KEY +{ -+ ULONG Length; // Length of this structure -+ ULONG KeyIndex; -+ ULONG KeyLength; // length of key in bytes ++ u32 Length; // Length of this structure ++ u32 KeyIndex; ++ u32 KeyLength; // length of key in bytes + NDIS_802_11_MAC_ADDRESS BSSID; + NDIS_802_11_KEY_RSC KeyRSC; -+ UCHAR KeyMaterial[32]; // variable length depending on above field ++ u8 KeyMaterial[32]; // variable length depending on above field +} NDIS_802_11_KEY, *PNDIS_802_11_KEY; + +typedef struct _NDIS_802_11_REMOVE_KEY +{ -+ ULONG Length; // Length of this structure -+ ULONG KeyIndex; -+ NDIS_802_11_MAC_ADDRESS BSSID; ++ u32 Length; // Length of this structure ++ u32 KeyIndex; ++ NDIS_802_11_MAC_ADDRESS BSSID; +} NDIS_802_11_REMOVE_KEY, *PNDIS_802_11_REMOVE_KEY; + +typedef struct _NDIS_802_11_WEP +{ -+ ULONG Length; // Length of this structure -+ ULONG KeyIndex; // 0 is the per-client key, 1-N are the global keys -+ ULONG KeyLength; // length of key in bytes -+ UCHAR KeyMaterial[16];// variable length depending on above field ++ u32 Length; // Length of this structure ++ u32 KeyIndex; // 0 is the per-client key, 1-N are the global keys ++ u32 KeyLength; // length of key in bytes ++ u8 KeyMaterial[16];// variable length depending on above field +} NDIS_802_11_WEP, *PNDIS_802_11_WEP; + +typedef struct _NDIS_802_11_AUTHENTICATION_REQUEST +{ -+ ULONG Length; // Length of structure ++ u32 Length; // Length of structure + NDIS_802_11_MAC_ADDRESS Bssid; -+ ULONG Flags; ++ u32 Flags; +} NDIS_802_11_AUTHENTICATION_REQUEST, *PNDIS_802_11_AUTHENTICATION_REQUEST; + +typedef enum _NDIS_802_11_STATUS_TYPE +{ + Ndis802_11StatusType_Authentication, + Ndis802_11StatusType_MediaStreamMode, -+ Ndis802_11StatusType_PMKID_CandidateList, ++ Ndis802_11StatusType_PMKID_CandidateList, + Ndis802_11StatusTypeMax // not a real type, defined as an upper bound +} NDIS_802_11_STATUS_TYPE, *PNDIS_802_11_STATUS_TYPE; + @@ -340943,11 +155429,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h linux/3rdparty/rtl + NDIS_802_11_STATUS_INDICATION Status; + NDIS_802_11_AUTHENTICATION_REQUEST Request[1]; +} NDIS_802_11_AUTHENTICATION_EVENT, *PNDIS_802_11_AUTHENTICATION_EVENT; -+ ++ +typedef struct _NDIS_802_11_TEST +{ -+ ULONG Length; -+ ULONG Type; ++ u32 Length; ++ u32 Type; + union + { + NDIS_802_11_AUTHENTICATION_EVENT AuthenticationEvent; @@ -340955,278 +155441,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h linux/3rdparty/rtl + }tt; +} NDIS_802_11_TEST, *PNDIS_802_11_TEST; + -+ -+#endif //end of #ifdef PLATFORM_LINUX -+ -+#ifdef PLATFORM_FREEBSD -+ -+#define NDIS_802_11_LENGTH_SSID 32 -+#define NDIS_802_11_LENGTH_RATES 8 -+#define NDIS_802_11_LENGTH_RATES_EX 16 -+ -+typedef unsigned char NDIS_802_11_MAC_ADDRESS[6]; -+typedef long NDIS_802_11_RSSI; // in dBm -+typedef unsigned char NDIS_802_11_RATES[NDIS_802_11_LENGTH_RATES]; // Set of 8 data rates -+typedef unsigned char NDIS_802_11_RATES_EX[NDIS_802_11_LENGTH_RATES_EX]; // Set of 16 data rates -+ -+ -+typedef ULONG NDIS_802_11_KEY_INDEX; -+typedef unsigned long long NDIS_802_11_KEY_RSC; -+ -+ -+typedef struct _NDIS_802_11_SSID -+{ -+ ULONG SsidLength; -+ UCHAR Ssid[32]; -+} NDIS_802_11_SSID, *PNDIS_802_11_SSID; -+ -+typedef enum _NDIS_802_11_NETWORK_TYPE -+{ -+ Ndis802_11FH, -+ Ndis802_11DS, -+ Ndis802_11OFDM5, -+ Ndis802_11OFDM24, -+ Ndis802_11NetworkTypeMax // not a real type, defined as an upper bound -+} NDIS_802_11_NETWORK_TYPE, *PNDIS_802_11_NETWORK_TYPE; -+ -+typedef struct _NDIS_802_11_CONFIGURATION_FH -+{ -+ ULONG Length; // Length of structure -+ ULONG HopPattern; // As defined by 802.11, MSB set -+ ULONG HopSet; // to one if non-802.11 -+ ULONG DwellTime; // units are Kusec -+} NDIS_802_11_CONFIGURATION_FH, *PNDIS_802_11_CONFIGURATION_FH; -+ -+ -+/* -+ FW will only save the channel number in DSConfig. -+ ODI Handler will convert the channel number to freq. number. -+*/ -+typedef struct _NDIS_802_11_CONFIGURATION -+{ -+ ULONG Length; // Length of structure -+ ULONG BeaconPeriod; // units are Kusec -+ ULONG ATIMWindow; // units are Kusec -+ ULONG DSConfig; /* channel number */ -+ NDIS_802_11_CONFIGURATION_FH FHConfig; -+} NDIS_802_11_CONFIGURATION, *PNDIS_802_11_CONFIGURATION; -+ -+ -+ -+typedef enum _NDIS_802_11_NETWORK_INFRASTRUCTURE -+{ -+ Ndis802_11IBSS, -+ Ndis802_11Infrastructure, -+ Ndis802_11AutoUnknown, -+ Ndis802_11InfrastructureMax, // Not a real value, defined as upper bound -+ Ndis802_11APMode -+} NDIS_802_11_NETWORK_INFRASTRUCTURE, *PNDIS_802_11_NETWORK_INFRASTRUCTURE; -+ -+ -+ -+ -+ -+typedef struct _NDIS_802_11_FIXED_IEs -+{ -+ UCHAR Timestamp[8]; -+ USHORT BeaconInterval; -+ USHORT Capabilities; -+} NDIS_802_11_FIXED_IEs, *PNDIS_802_11_FIXED_IEs; -+ -+ -+ -+typedef struct _NDIS_802_11_VARIABLE_IEs -+{ -+ UCHAR ElementID; -+ UCHAR Length; -+ UCHAR data[1]; -+} NDIS_802_11_VARIABLE_IEs, *PNDIS_802_11_VARIABLE_IEs; -+ -+ -+ -+/* -+ -+ -+ -+Length is the 4 bytes multiples of the sume of -+ sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + sizeof (NDIS_802_11_SSID) + sizeof (ULONG) -++ sizeof (NDIS_802_11_RSSI) + sizeof (NDIS_802_11_NETWORK_TYPE) + sizeof (NDIS_802_11_CONFIGURATION) -++ sizeof (NDIS_802_11_RATES_EX) + IELength -+ -+Except the IELength, all other fields are fixed length. Therefore, we can define a marco to present the -+partial sum. -+ -+*/ -+#if 0 -+typedef struct _NDIS_WLAN_BSSID_EX -+{ -+ ULONG Length; -+ NDIS_802_11_MAC_ADDRESS MacAddress; -+ UCHAR Reserved[2];//[0]: IS beacon frame, [1]:optimum_antenna=>For antenna diversity; -+ NDIS_802_11_SSID Ssid; -+ ULONG Privacy; -+ NDIS_802_11_RSSI Rssi; -+ NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; -+ NDIS_802_11_CONFIGURATION Configuration; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; -+ NDIS_802_11_RATES_EX SupportedRates; -+ ULONG IELength; -+ UCHAR IEs[MAX_IE_SZ]; //(timestamp, beacon interval, and capability information) -+} NDIS_WLAN_BSSID_EX, *PNDIS_WLAN_BSSID_EX; -+ -+ -+typedef struct _NDIS_802_11_BSSID_LIST_EX -+{ -+ ULONG NumberOfItems; -+ NDIS_WLAN_BSSID_EX Bssid[1]; -+} NDIS_802_11_BSSID_LIST_EX, *PNDIS_802_11_BSSID_LIST_EX; -+#endif -+ -+typedef enum _NDIS_802_11_AUTHENTICATION_MODE -+{ -+ Ndis802_11AuthModeOpen, -+ Ndis802_11AuthModeShared, -+ Ndis802_11AuthModeAutoSwitch, -+ Ndis802_11AuthModeWPA, -+ Ndis802_11AuthModeWPAPSK, -+ Ndis802_11AuthModeWPANone, -+ Ndis802_11AuthModeMax // Not a real mode, defined as upper bound -+} NDIS_802_11_AUTHENTICATION_MODE, *PNDIS_802_11_AUTHENTICATION_MODE; -+ -+typedef enum _NDIS_802_11_WEP_STATUS -+{ -+ Ndis802_11WEPEnabled, -+ Ndis802_11Encryption1Enabled = Ndis802_11WEPEnabled, -+ Ndis802_11WEPDisabled, -+ Ndis802_11EncryptionDisabled = Ndis802_11WEPDisabled, -+ Ndis802_11WEPKeyAbsent, -+ Ndis802_11Encryption1KeyAbsent = Ndis802_11WEPKeyAbsent, -+ Ndis802_11WEPNotSupported, -+ Ndis802_11EncryptionNotSupported = Ndis802_11WEPNotSupported, -+ Ndis802_11Encryption2Enabled, -+ Ndis802_11Encryption2KeyAbsent, -+ Ndis802_11Encryption3Enabled, -+ Ndis802_11Encryption3KeyAbsent -+} NDIS_802_11_WEP_STATUS, *PNDIS_802_11_WEP_STATUS, -+ NDIS_802_11_ENCRYPTION_STATUS, *PNDIS_802_11_ENCRYPTION_STATUS; -+ -+ -+#define NDIS_802_11_AI_REQFI_CAPABILITIES 1 -+#define NDIS_802_11_AI_REQFI_LISTENINTERVAL 2 -+#define NDIS_802_11_AI_REQFI_CURRENTAPADDRESS 4 -+ -+#define NDIS_802_11_AI_RESFI_CAPABILITIES 1 -+#define NDIS_802_11_AI_RESFI_STATUSCODE 2 -+#define NDIS_802_11_AI_RESFI_ASSOCIATIONID 4 -+ -+typedef struct _NDIS_802_11_AI_REQFI -+{ -+ USHORT Capabilities; -+ USHORT ListenInterval; -+ NDIS_802_11_MAC_ADDRESS CurrentAPAddress; -+} NDIS_802_11_AI_REQFI, *PNDIS_802_11_AI_REQFI; -+ -+typedef struct _NDIS_802_11_AI_RESFI -+{ -+ USHORT Capabilities; -+ USHORT StatusCode; -+ USHORT AssociationId; -+} NDIS_802_11_AI_RESFI, *PNDIS_802_11_AI_RESFI; -+ -+typedef struct _NDIS_802_11_ASSOCIATION_INFORMATION -+{ -+ ULONG Length; -+ USHORT AvailableRequestFixedIEs; -+ NDIS_802_11_AI_REQFI RequestFixedIEs; -+ ULONG RequestIELength; -+ ULONG OffsetRequestIEs; -+ USHORT AvailableResponseFixedIEs; -+ NDIS_802_11_AI_RESFI ResponseFixedIEs; -+ ULONG ResponseIELength; -+ ULONG OffsetResponseIEs; -+} NDIS_802_11_ASSOCIATION_INFORMATION, *PNDIS_802_11_ASSOCIATION_INFORMATION; -+ -+typedef enum _NDIS_802_11_RELOAD_DEFAULTS -+{ -+ Ndis802_11ReloadWEPKeys -+} NDIS_802_11_RELOAD_DEFAULTS, *PNDIS_802_11_RELOAD_DEFAULTS; -+ -+ -+// Key mapping keys require a BSSID -+typedef struct _NDIS_802_11_KEY -+{ -+ ULONG Length; // Length of this structure -+ ULONG KeyIndex; -+ ULONG KeyLength; // length of key in bytes -+ NDIS_802_11_MAC_ADDRESS BSSID; -+ NDIS_802_11_KEY_RSC KeyRSC; -+ UCHAR KeyMaterial[32]; // variable length depending on above field -+} NDIS_802_11_KEY, *PNDIS_802_11_KEY; -+ -+typedef struct _NDIS_802_11_REMOVE_KEY -+{ -+ ULONG Length; // Length of this structure -+ ULONG KeyIndex; -+ NDIS_802_11_MAC_ADDRESS BSSID; -+} NDIS_802_11_REMOVE_KEY, *PNDIS_802_11_REMOVE_KEY; -+ -+typedef struct _NDIS_802_11_WEP -+{ -+ ULONG Length; // Length of this structure -+ ULONG KeyIndex; // 0 is the per-client key, 1-N are the global keys -+ ULONG KeyLength; // length of key in bytes -+ UCHAR KeyMaterial[16];// variable length depending on above field -+} NDIS_802_11_WEP, *PNDIS_802_11_WEP; -+ -+typedef struct _NDIS_802_11_AUTHENTICATION_REQUEST -+{ -+ ULONG Length; // Length of structure -+ NDIS_802_11_MAC_ADDRESS Bssid; -+ ULONG Flags; -+} NDIS_802_11_AUTHENTICATION_REQUEST, *PNDIS_802_11_AUTHENTICATION_REQUEST; -+ -+typedef enum _NDIS_802_11_STATUS_TYPE -+{ -+ Ndis802_11StatusType_Authentication, -+ Ndis802_11StatusType_MediaStreamMode, -+ Ndis802_11StatusType_PMKID_CandidateList, -+ Ndis802_11StatusTypeMax // not a real type, defined as an upper bound -+} NDIS_802_11_STATUS_TYPE, *PNDIS_802_11_STATUS_TYPE; -+ -+typedef struct _NDIS_802_11_STATUS_INDICATION -+{ -+ NDIS_802_11_STATUS_TYPE StatusType; -+} NDIS_802_11_STATUS_INDICATION, *PNDIS_802_11_STATUS_INDICATION; -+ -+// mask for authentication/integrity fields -+#define NDIS_802_11_AUTH_REQUEST_AUTH_FIELDS 0x0f -+#define NDIS_802_11_AUTH_REQUEST_REAUTH 0x01 -+#define NDIS_802_11_AUTH_REQUEST_KEYUPDATE 0x02 -+#define NDIS_802_11_AUTH_REQUEST_PAIRWISE_ERROR 0x06 -+#define NDIS_802_11_AUTH_REQUEST_GROUP_ERROR 0x0E -+ -+// MIC check time, 60 seconds. -+#define MIC_CHECK_TIME 60000000 -+ -+typedef struct _NDIS_802_11_AUTHENTICATION_EVENT -+{ -+ NDIS_802_11_STATUS_INDICATION Status; -+ NDIS_802_11_AUTHENTICATION_REQUEST Request[1]; -+} NDIS_802_11_AUTHENTICATION_EVENT, *PNDIS_802_11_AUTHENTICATION_EVENT; -+ -+typedef struct _NDIS_802_11_TEST -+{ -+ ULONG Length; -+ ULONG Type; -+ union -+ { -+ NDIS_802_11_AUTHENTICATION_EVENT AuthenticationEvent; -+ NDIS_802_11_RSSI RssiTrigger; -+ }tt; -+} NDIS_802_11_TEST, *PNDIS_802_11_TEST; -+ -+ -+#endif //PLATFORM_FREEBSD +#ifndef Ndis802_11APMode +#define Ndis802_11APMode (Ndis802_11InfrastructureMax+1) +#endif @@ -341234,84 +155448,51 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h linux/3rdparty/rtl +typedef struct _WLAN_PHY_INFO +{ + u8 SignalStrength;//(in percentage) -+ u8 SignalQuality;//(in percentage) -+ u8 Optimum_antenna; //for Antenna diversity -+ u8 Reserved_0; ++ u8 SignalQuality;//(in percentage) ++ u8 Optimum_antenna; //for Antenna diversity ++ u8 Reserved_0; +}WLAN_PHY_INFO,*PWLAN_PHY_INFO; + +typedef struct _WLAN_BCN_INFO +{ + /* these infor get from rtw_get_encrypt_info when -+ * * translate scan to UI */ ++ * * translate scan to UI */ + u8 encryp_protocol;//ENCRYP_PROTOCOL_E: OPEN/WEP/WPA/WPA2/WAPI + int group_cipher; //WPA/WPA2 group cipher + int pairwise_cipher;////WPA/WPA2/WEP pairwise cipher + int is_8021x; + + /* bwmode 20/40 and ch_offset UP/LOW */ -+ unsigned short ht_cap_info; ++ unsigned short ht_cap_info; + unsigned char ht_info_infos_0; +}WLAN_BCN_INFO,*PWLAN_BCN_INFO; + -+/* temporally add #pragma pack for structure alignment issue of -+* WLAN_BSSID_EX and get_WLAN_BSSID_EX_sz() -+*/ -+#ifdef PLATFORM_WINDOWS -+#pragma pack(push) -+#pragma pack(1) -+#endif +typedef struct _WLAN_BSSID_EX +{ -+ ULONG Length; ++ u32 Length; + NDIS_802_11_MAC_ADDRESS MacAddress; -+ UCHAR Reserved[2];//[0]: IS beacon frame ++ u8 Reserved[2];//[0]: IS beacon frame + NDIS_802_11_SSID Ssid; -+ ULONG Privacy; ++ u32 Privacy; + NDIS_802_11_RSSI Rssi;//(in dBM,raw data ,get from PHY) + NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; + NDIS_802_11_CONFIGURATION Configuration; + NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; + NDIS_802_11_RATES_EX SupportedRates; + WLAN_PHY_INFO PhyInfo; -+ ULONG IELength; -+ UCHAR IEs[MAX_IE_SZ]; //(timestamp, beacon interval, and capability information) -+} -+#ifndef PLATFORM_WINDOWS ++ u32 IELength; ++ u8 IEs[MAX_IE_SZ]; //(timestamp, beacon interval, and capability information) ++} +__attribute__((packed)) -+#endif +WLAN_BSSID_EX, *PWLAN_BSSID_EX; -+#ifdef PLATFORM_WINDOWS -+#pragma pack(pop) -+#endif + +__inline static uint get_WLAN_BSSID_EX_sz(WLAN_BSSID_EX *bss) +{ -+#if 0 -+ uint t_len; -+ -+ t_len = sizeof (ULONG) -+ + sizeof (NDIS_802_11_MAC_ADDRESS) -+ + 2 -+ + sizeof (NDIS_802_11_SSID) -+ + sizeof (ULONG) -+ + sizeof (NDIS_802_11_RSSI) -+ + sizeof (NDIS_802_11_NETWORK_TYPE) -+ + sizeof (NDIS_802_11_CONFIGURATION) -+ + sizeof (NDIS_802_11_NETWORK_INFRASTRUCTURE) -+ + sizeof (NDIS_802_11_RATES_EX) -+ //all new member add here -+ + sizeof(WLAN_PHY_INFO) -+ //all new member add here -+ + sizeof (ULONG) -+ + bss->IELength; -+ return t_len; -+#else + return (sizeof(WLAN_BSSID_EX) -MAX_IE_SZ + bss->IELength); -+#endif +} + +struct wlan_network { -+ _list list; ++ _list list; + int network_type; //refer to ieee80211.h for WIRELESS_11A/B/G + int fixed; // set to fixed when not to be removed as site-surveying + unsigned long last_scanned; //timestamp for the network @@ -341319,24 +155500,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h linux/3rdparty/rtl + int join_res; + WLAN_BSSID_EX network; //must be the last item + WLAN_BCN_INFO BcnInfo; -+#ifdef PLATFORM_WINDOWS -+ unsigned char iebuf[MAX_IE_SZ]; -+#endif -+ +}; + +enum VRTL_CARRIER_SENSE +{ -+ DISABLE_VCS, -+ ENABLE_VCS, ++ DISABLE_VCS, ++ ENABLE_VCS, + AUTO_VCS +}; + +enum VCS_TYPE +{ -+ NONE_VCS, ++ NONE_VCS, + RTS_CTS, -+ CTS_TO_SELF ++ CTS_TO_SELF +}; + + @@ -341363,19 +155540,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h linux/3rdparty/rtl +#define NUM_PMKID_CACHE NUM_PRE_AUTH_KEY + +/* -+* WPA2 ++* WPA2 +*/ + -+#ifndef PLATFORM_OS_CE +typedef struct _PMKID_CANDIDATE { + NDIS_802_11_MAC_ADDRESS BSSID; -+ ULONG Flags; ++ u32 Flags; +} PMKID_CANDIDATE, *PPMKID_CANDIDATE; + +typedef struct _NDIS_802_11_PMKID_CANDIDATE_LIST +{ -+ ULONG Version; // Version of the structure -+ ULONG NumCandidates; // No. of pmkid candidates ++ u32 Version; // Version of the structure ++ u32 NumCandidates; // No. of pmkid candidates + PMKID_CANDIDATE CandidateList[1]; +} NDIS_802_11_PMKID_CANDIDATE_LIST, *PNDIS_802_11_PMKID_CANDIDATE_LIST; + @@ -341384,31 +155560,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/wlan_bssdef.h linux/3rdparty/rtl +{ + NDIS_802_11_AUTHENTICATION_MODE AuthModeSupported; + NDIS_802_11_ENCRYPTION_STATUS EncryptStatusSupported; -+ ++ +} NDIS_802_11_AUTHENTICATION_ENCRYPTION, *PNDIS_802_11_AUTHENTICATION_ENCRYPTION; + -+typedef struct _NDIS_802_11_CAPABILITY ++typedef struct _NDIS_802_11_CAPABILITY +{ -+ ULONG Length; -+ ULONG Version; -+ ULONG NoOfPMKIDs; -+ ULONG NoOfAuthEncryptPairsSupported; ++ u32 Length; ++ u32 Version; ++ u32 NoOfPMKIDs; ++ u32 NoOfAuthEncryptPairsSupported; + NDIS_802_11_AUTHENTICATION_ENCRYPTION AuthenticationEncryptionSupported[1]; -+ ++ +} NDIS_802_11_CAPABILITY, *PNDIS_802_11_CAPABILITY; -+#endif + + +#endif //#ifndef WLAN_BSSDEF_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/include/xmit_osdep.h linux/3rdparty/rtl8812au/include/xmit_osdep.h ---- linux.old/3rdparty/rtl8812au/include/xmit_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/include/xmit_osdep.h 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,100 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/xmit_osdep.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/xmit_osdep.h +--- linux-4.14.17/3rdparty/rtl8812au/include/xmit_osdep.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/xmit_osdep.h 2018-02-06 17:42:30.722967342 +0200 +@@ -0,0 +1,53 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -341418,11 +155592,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/xmit_osdep.h linux/3rdparty/rtl8 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#ifndef __XMIT_OSDEP_H_ +#define __XMIT_OSDEP_H_ @@ -341437,40 +155606,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/xmit_osdep.h linux/3rdparty/rtl8 + SIZE_T buf_len; +}; + -+#ifdef PLATFORM_WINDOWS -+ -+#ifdef PLATFORM_OS_XP -+#ifdef CONFIG_USB_HCI -+#include -+#include -+#include -+#endif -+#endif -+ -+#ifdef CONFIG_GSPI_HCI -+#define NR_XMITFRAME 64 -+#else -+#define NR_XMITFRAME 128 -+#endif -+ -+#define ETH_ALEN 6 -+ -+extern NDIS_STATUS rtw_xmit_entry( -+IN _nic_hdl cnxt, -+IN NDIS_PACKET *pkt, -+IN UINT flags -+); -+ -+#endif -+ -+#ifdef PLATFORM_FREEBSD -+#define NR_XMITFRAME 256 -+extern int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); -+extern void rtw_xmit_entry_wrap (struct ifnet * pifp); -+#endif //PLATFORM_FREEBSD -+ -+#ifdef PLATFORM_LINUX -+ +#define NR_XMITFRAME 256 + +struct xmit_priv; @@ -341479,11 +155614,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/xmit_osdep.h linux/3rdparty/rtl8 +struct xmit_frame; +struct xmit_buf; + -+extern int _rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); +extern int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); + -+#endif -+ +void rtw_os_xmit_schedule(_adapter *padapter); + +int rtw_os_xmit_resource_alloc(_adapter *padapter, struct xmit_buf *pxmitbuf, u32 alloc_sz, u8 flag); @@ -341499,35 +155631,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/include/xmit_osdep.h linux/3rdparty/rtl8 +extern void rtw_os_pkt_complete(_adapter *padapter, _pkt *pkt); +extern void rtw_os_xmit_complete(_adapter *padapter, struct xmit_frame *pxframe); + -+void rtw_os_wake_queue_at_free_stainfo(_adapter *padapter, int *qcnt_freed); -+ -+void dump_os_queue(void *sel, _adapter *padapter); -+ +#endif //__XMIT_OSDEP_H_ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/Kconfig linux/3rdparty/rtl8812au/Kconfig ---- linux.old/3rdparty/rtl8812au/Kconfig 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/Kconfig 2017-06-07 23:07:20.997686300 +0300 +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/Kconfig linux-4.14.17-3rd/3rdparty/rtl8812au/Kconfig +--- linux-4.14.17/3rdparty/rtl8812au/Kconfig 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/Kconfig 2018-02-06 17:42:30.692966898 +0200 @@ -0,0 +1,6 @@ +config RTL8812AU -+ tristate "Realtek 8812A USB WiFi" ++ tristate "Realtek 8812 USB WiFi" + depends on USB + ---help--- + Help message of RTL8812AU + -diff -Nurp linux.old/3rdparty/rtl8812au/Makefile linux/3rdparty/rtl8812au/Makefile ---- linux.old/3rdparty/rtl8812au/Makefile 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/Makefile 2017-06-07 23:19:36.823785461 +0300 -@@ -0,0 +1,1706 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/Makefile linux-4.14.17-3rd/3rdparty/rtl8812au/Makefile +--- linux-4.14.17/3rdparty/rtl8812au/Makefile 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/Makefile 2018-02-06 17:42:30.692966898 +0200 +@@ -0,0 +1,276 @@ +EXTRA_CFLAGS += $(USER_EXTRA_CFLAGS) +EXTRA_CFLAGS += -O1 +#EXTRA_CFLAGS += -O3 -+EXTRA_CFLAGS += -Wall ++#EXTRA_CFLAGS += -Wall +#EXTRA_CFLAGS += -Wextra +#EXTRA_CFLAGS += -Werror +#EXTRA_CFLAGS += -pedantic +#EXTRA_CFLAGS += -Wshadow -Wpointer-arith -Wcast-qual -Wstrict-prototypes -Wmissing-prototypes -+EXTRA_CFLAGS += -Werror=incompatible-pointer-types + +EXTRA_CFLAGS += -Wno-unused-variable +EXTRA_CFLAGS += -Wno-unused-value @@ -341535,32 +155661,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/Makefile linux/3rdparty/rtl8812au/Makefi +EXTRA_CFLAGS += -Wno-unused-parameter +EXTRA_CFLAGS += -Wno-unused-function +EXTRA_CFLAGS += -Wno-unused -+#EXTRA_CFLAGS += -Wno-uninitialized -+EXTRA_CFLAGS += -Wno-error=date-time # Fix compile error on gcc 4.9 and later ++ ++EXTRA_CFLAGS += -Wno-uninitialized ++EXTRA_CFLAGS += -Wno-int-to-pointer-cast + +EXTRA_CFLAGS += -I$(src)/include -+EXTRA_CFLAGS += -I$(src)/hal/phydm -+ -+EXTRA_LDFLAGS += --strip-debug + +CONFIG_AUTOCFG_CP = n + -+########################## WIFI IC ############################ +CONFIG_MULTIDRV = n -+CONFIG_RTL8188E = n -+CONFIG_RTL8812A = y -+CONFIG_RTL8821A = y -+CONFIG_RTL8192E = n -+CONFIG_RTL8723B = n -+CONFIG_RTL8814A = n -+CONFIG_RTL8703B = n -+CONFIG_RTL8188F = n -+######################### Interface ########################### ++ +CONFIG_USB_HCI = y +CONFIG_PCI_HCI = n +CONFIG_SDIO_HCI = n +CONFIG_GSPI_HCI = n -+########################## Features ########################### ++ +CONFIG_MP_INCLUDED = y +CONFIG_POWER_SAVING = y +CONFIG_USB_AUTOSUSPEND = n @@ -341571,672 +155686,100 @@ diff -Nurp linux.old/3rdparty/rtl8812au/Makefile linux/3rdparty/rtl8812au/Makefi +CONFIG_WAPI_SUPPORT = n +CONFIG_EFUSE_CONFIG_FILE = n +CONFIG_EXT_CLK = n -+CONFIG_TRAFFIC_PROTECT = y -+CONFIG_LOAD_PHY_PARA_FROM_FILE = y -+CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY = n -+CONFIG_CALIBRATE_TX_POWER_TO_MAX = n -+CONFIG_RTW_ADAPTIVITY_EN = disable -+CONFIG_RTW_ADAPTIVITY_MODE = normal -+CONFIG_SIGNAL_SCALE_MAPPING = n -+CONFIG_80211W = n -+CONFIG_REDUCE_TX_CPU_LOADING = n -+CONFIG_BR_EXT = y -+CONFIG_ANTENNA_DIVERSITY = n -+CONFIG_TDLS = n -+CONFIG_WIFI_MONITOR = y -+######################## Wake On Lan ########################## ++CONFIG_FTP_PROTECT = n +CONFIG_WOWLAN = n -+CONFIG_GPIO_WAKEUP = n -+CONFIG_WAKEUP_GPIO_IDX = default -+CONFIG_HIGH_ACTIVE = n -+CONFIG_PNO_SUPPORT = n -+CONFIG_PNO_SET_DEBUG = n -+CONFIG_AP_WOWLAN = n -+######### Notify SDIO Host Keep Power During Syspend ########## -+CONFIG_RTW_SDIO_PM_KEEP_POWER = y -+###################### Platform Related ####################### -+CONFIG_PLATFORM_GENERIC = y -+CONFIG_PLATFORM_I386_PC = n -+CONFIG_PLATFORM_ANDROID_X86 = n -+CONFIG_PLATFORM_ANDROID_INTEL_X86 = n -+CONFIG_PLATFORM_JB_X86 = n -+CONFIG_PLATFORM_ARM_S3C2K4 = n -+CONFIG_PLATFORM_ARM_PXA2XX = n -+CONFIG_PLATFORM_ARM_S3C6K4 = n -+CONFIG_PLATFORM_MIPS_RMI = n -+CONFIG_PLATFORM_RTD2880B = n -+CONFIG_PLATFORM_MIPS_AR9132 = n -+CONFIG_PLATFORM_RTK_DMP = n -+CONFIG_PLATFORM_MIPS_PLM = n -+CONFIG_PLATFORM_MSTAR389 = n -+CONFIG_PLATFORM_MT53XX = n -+CONFIG_PLATFORM_ARM_MX51_241H = n -+CONFIG_PLATFORM_FS_MX61 = n -+CONFIG_PLATFORM_ACTIONS_ATJ227X = n -+CONFIG_PLATFORM_TEGRA3_CARDHU = n -+CONFIG_PLATFORM_TEGRA4_DALMORE = n -+CONFIG_PLATFORM_ARM_TCC8900 = n -+CONFIG_PLATFORM_ARM_TCC8920 = n -+CONFIG_PLATFORM_ARM_TCC8920_JB42 = n -+CONFIG_PLATFORM_ARM_RK2818 = n -+CONFIG_PLATFORM_ARM_RK3066 = n -+CONFIG_PLATFORM_ARM_RK3188 = n -+CONFIG_PLATFORM_ARM_URBETTER = n -+CONFIG_PLATFORM_ARM_TI_PANDA = n -+CONFIG_PLATFORM_MIPS_JZ4760 = n -+CONFIG_PLATFORM_DMP_PHILIPS = n -+CONFIG_PLATFORM_MSTAR_TITANIA12 = n -+CONFIG_PLATFORM_MSTAR = n -+CONFIG_PLATFORM_SZEBOOK = n -+CONFIG_PLATFORM_ARM_SUNxI = n -+CONFIG_PLATFORM_ARM_SUN6I = n -+CONFIG_PLATFORM_ARM_SUN7I = n -+CONFIG_PLATFORM_ARM_SUN8I_W3P1 = n -+CONFIG_PLATFORM_ARM_SUN8I_W5P1 = n -+CONFIG_PLATFORM_ACTIONS_ATM702X = n -+CONFIG_PLATFORM_ACTIONS_ATV5201 = n -+CONFIG_PLATFORM_ACTIONS_ATM705X = n -+CONFIG_PLATFORM_ARM_SUN50IW1P1 = n -+CONFIG_PLATFORM_ARM_RTD299X = n -+CONFIG_PLATFORM_ARM_SPREADTRUM_6820 = n -+CONFIG_PLATFORM_ARM_SPREADTRUM_8810 = n -+CONFIG_PLATFORM_ARM_WMT = n -+CONFIG_PLATFORM_TI_DM365 = n -+CONFIG_PLATFORM_MOZART = n -+CONFIG_PLATFORM_RTK119X = n -+CONFIG_PLATFORM_NOVATEK_NT72668 = n -+CONFIG_PLATFORM_HISILICON = n -+############################################################### + +CONFIG_DRVEXT_MODULE = n + +export TopDIR ?= $(shell pwd) + +########### COMMON ################################# -+ifeq ($(CONFIG_GSPI_HCI), y) -+HCI_NAME = gspi -+endif -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+HCI_NAME = sdio -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) +HCI_NAME = usb -+endif + -+ifeq ($(CONFIG_PCI_HCI), y) -+HCI_NAME = pci -+endif + + +_OS_INTFS_FILES := os_dep/osdep_service.o \ -+ os_dep/linux/os_intfs.o \ -+ os_dep/linux/$(HCI_NAME)_intf.o \ -+ os_dep/linux/$(HCI_NAME)_ops_linux.o \ -+ os_dep/linux/ioctl_linux.o \ -+ os_dep/linux/xmit_linux.o \ -+ os_dep/linux/mlme_linux.o \ -+ os_dep/linux/recv_linux.o \ -+ os_dep/linux/ioctl_cfg80211.o \ -+ os_dep/linux/rtw_cfgvendor.o \ -+ os_dep/linux/wifi_regd.o \ -+ os_dep/linux/rtw_android.o \ -+ os_dep/linux/rtw_proc.o -+ -+ifeq ($(CONFIG_MP_INCLUDED), y) -+_OS_INTFS_FILES += os_dep/linux/ioctl_mp.o -+endif -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+_OS_INTFS_FILES += os_dep/linux/custom_gpio_linux.o -+_OS_INTFS_FILES += os_dep/linux/$(HCI_NAME)_ops_linux.o -+endif -+ -+ifeq ($(CONFIG_GSPI_HCI), y) -+_OS_INTFS_FILES += os_dep/linux/custom_gpio_linux.o -+_OS_INTFS_FILES += os_dep/linux/$(HCI_NAME)_ops_linux.o -+endif -+ ++ os_dep/os_intfs.o \ ++ os_dep/usb_intf.o \ ++ os_dep/usb_ops_linux.o \ ++ os_dep/ioctl_linux.o \ ++ os_dep/xmit_linux.o \ ++ os_dep/mlme_linux.o \ ++ os_dep/recv_linux.o \ ++ os_dep/ioctl_cfg80211.o \ ++ os_dep/rtw_android.o + +_HAL_INTFS_FILES := hal/hal_intf.o \ + hal/hal_com.o \ + hal/hal_com_phycfg.o \ + hal/hal_phy.o \ -+ hal/hal_dm.o \ -+ hal/hal_btcoex.o \ -+ hal/hal_mp.o \ -+ hal/hal_hci/hal_$(HCI_NAME).o \ -+ hal/led/hal_$(HCI_NAME)_led.o ++ hal/hal_usb_led.o + -+ -+_OUTSRC_FILES := hal/phydm/phydm_debug.o \ -+ hal/phydm/phydm_antdiv.o\ -+ hal/phydm/phydm_antdect.o\ -+ hal/phydm/phydm_interface.o\ -+ hal/phydm/phydm_hwconfig.o\ -+ hal/phydm/phydm.o\ -+ hal/phydm/halphyrf_ce.o\ -+ hal/phydm/phydm_edcaturbocheck.o\ -+ hal/phydm/phydm_dig.o\ -+ hal/phydm/phydm_pathdiv.o\ -+ hal/phydm/phydm_rainfo.o\ -+ hal/phydm/phydm_dynamicbbpowersaving.o\ -+ hal/phydm/phydm_powertracking_ce.o\ -+ hal/phydm/phydm_dynamictxpower.o\ -+ hal/phydm/phydm_adaptivity.o\ -+ hal/phydm/phydm_cfotracking.o\ -+ hal/phydm/phydm_noisemonitor.o\ -+ hal/phydm/phydm_acs.o\ -+ hal/phydm/phydm_beamforming.o\ -+ hal/phydm/txbf/halcomtxbf.o\ -+ hal/phydm/txbf/haltxbfinterface.o -+ -+ -+EXTRA_CFLAGS += -I$(src)/platform -+_PLATFORM_FILES := platform/platform_ops.o -+ -+ifeq ($(CONFIG_BT_COEXIST), y) -+EXTRA_CFLAGS += -I$(src)/hal/btc -+_OUTSRC_FILES += hal/btc/HalBtc8192e1Ant.o \ -+ hal/btc/HalBtc8192e2Ant.o \ -+ hal/btc/HalBtc8723b1Ant.o \ -+ hal/btc/HalBtc8723b2Ant.o \ -+ hal/btc/HalBtc8812a1Ant.o \ -+ hal/btc/HalBtc8812a2Ant.o \ -+ hal/btc/HalBtc8821a1Ant.o \ -+ hal/btc/HalBtc8821a2Ant.o \ -+ hal/btc/HalBtc8821aCsr2Ant.o \ -+ hal/btc/HalBtc8703b1Ant.o \ -+ hal/btc/HalBtc8703b2Ant.o -+endif -+ -+ -+########### HAL_RTL8188E ################################# -+ifeq ($(CONFIG_RTL8188E), y) -+ -+RTL871X = rtl8188e -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8189es -+endif -+ -+ifeq ($(CONFIG_GSPI_HCI), y) -+MODULE_NAME = 8189es -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8188eu -+endif -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8188ee -+endif -+EXTRA_CFLAGS += -DCONFIG_RTL8188E -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8188EPwrSeq.o\ -+ hal/$(RTL871X)/$(RTL871X)_xmit.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+ifeq ($(CONFIG_GSPI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+endif -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188E_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188E_PCIE.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188E_SDIO.o -+endif -+ -+#hal/OUTSRC/$(RTL871X)/Hal8188EFWImg_CE.o -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8188e_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188e_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188e_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188e_t_fw.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188e_s_fw.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8188e_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8188e.o\ -+ hal/phydm/$(RTL871X)/hal8188erateadaptive.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8188e.o -+ -+endif -+ -+########### HAL_RTL8192E ################################# -+ifeq ($(CONFIG_RTL8192E), y) -+ -+RTL871X = rtl8192e -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8192es -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8192eu -+endif -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8192ee -+endif -+EXTRA_CFLAGS += -DCONFIG_RTL8192E -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8192EPwrSeq.o\ -+ hal/$(RTL871X)/$(RTL871X)_xmit.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+ifeq ($(CONFIG_GSPI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+endif -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8192E_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8192E_PCIE.o -+endif -+ -+#hal/OUTSRC/$(RTL871X)/HalHWImg8188E_FW.o -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8192e_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8192e_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8192e_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8192e_fw.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8192e_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8192e.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8192e.o -+ -+endif ++_OUTSRC_FILES := hal/odm_debug.o \ ++ hal/odm_interface.o\ ++ hal/odm_HWConfig.o\ ++ hal/odm.o\ ++ hal/HalPhyRf.o + ++ +########### HAL_RTL8812A_RTL8821A ################################# + -+ifneq ($(CONFIG_RTL8812A)_$(CONFIG_RTL8821A), n_n) -+ -+RTL871X = rtl8812a -+ifeq ($(CONFIG_USB_HCI), y) ++rtl8812a = rtl8812a +MODULE_NAME = 8812au -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8812ae -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8812as -+endif + +_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8812PwrSeq.o \ -+ hal/$(RTL871X)/Hal8821APwrSeq.o\ -+ hal/$(RTL871X)/$(RTL871X)_xmit.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o ++ hal/Hal8812PwrSeq.o \ ++ hal/Hal8821APwrSeq.o\ ++ hal/$(rtl8812a)_xmit.o\ ++ hal/$(rtl8812a)_sreset.o + -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o ++_HAL_INTFS_FILES += hal/$(rtl8812a)_hal_init.o \ ++ hal/$(rtl8812a)_phycfg.o \ ++ hal/$(rtl8812a)_rf6052.o \ ++ hal/$(rtl8812a)_dm.o \ ++ hal/$(rtl8812a)_rxdesc.o \ ++ hal/$(rtl8812a)_cmd.o \ ++ hal/usb_halinit.o \ ++ hal/rtl$(MODULE_NAME)_led.o \ ++ hal/rtl$(MODULE_NAME)_xmit.o \ ++ hal/rtl$(MODULE_NAME)_recv.o + -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+ifeq ($(CONFIG_GSPI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+endif ++_HAL_INTFS_FILES += hal/usb_ops_linux.o ++ ++ifeq ($(CONFIG_MP_INCLUDED), y) ++_HAL_INTFS_FILES += hal/$(rtl8812a)_mp.o +endif + -+ifeq ($(CONFIG_RTL8812A), y) -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8812A_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8812A_PCIE.o -+endif -+endif -+ifeq ($(CONFIG_RTL8821A), y) -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8821A_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8821A_PCIE.o -+endif -+endif ++_OUTSRC_FILES += hal/HalHWImg8812A_FW.o\ ++ hal/HalHWImg8812A_MAC.o\ ++ hal/HalHWImg8812A_BB.o\ ++ hal/HalHWImg8812A_RF.o\ ++ hal/HalHWImg8812A_TestChip_FW.o\ ++ hal/HalHWImg8812A_TestChip_MAC.o\ ++ hal/HalHWImg8812A_TestChip_BB.o\ ++ hal/HalHWImg8812A_TestChip_RF.o\ ++ hal/HalPhyRf_8812A.o\ ++ hal/odm_RegConfig8812A.o + -+ifeq ($(CONFIG_RTL8812A), y) -+EXTRA_CFLAGS += -DCONFIG_RTL8812A -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8812a_fw.o\ -+ hal/phydm/$(RTL871X)/halhwimg8812a_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8812a_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8812a_rf.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8812a_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8812a.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8812a.o\ -+ hal/phydm/txbf/haltxbfjaguar.o -+endif ++_OUTSRC_FILES += hal/HalHWImg8821A_FW.o\ ++ hal/HalHWImg8821A_MAC.o\ ++ hal/HalHWImg8821A_BB.o\ ++ hal/HalHWImg8821A_RF.o\ ++ hal/HalHWImg8821A_TestChip_MAC.o\ ++ hal/HalHWImg8821A_TestChip_BB.o\ ++ hal/HalHWImg8821A_TestChip_RF.o\ ++ hal/HalPhyRf_8812A.o\ ++ hal/HalPhyRf_8821A.o\ ++ hal/odm_RegConfig8821A.o + -+ifeq ($(CONFIG_RTL8821A), y) -+ -+ifeq ($(CONFIG_RTL8812A), n) -+ -+RTL871X = rtl8821a -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME := 8821au -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME := 8821ae -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME := 8821as -+endif -+ -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8821A -+_OUTSRC_FILES += hal/phydm/rtl8821a/halhwimg8821a_fw.o\ -+ hal/phydm/rtl8821a/halhwimg8821a_mac.o\ -+ hal/phydm/rtl8821a/halhwimg8821a_bb.o\ -+ hal/phydm/rtl8821a/halhwimg8821a_rf.o\ -+ hal/phydm/rtl8812a/halphyrf_8812a_ce.o\ -+ hal/phydm/rtl8821a/halphyrf_8821a_ce.o\ -+ hal/phydm/rtl8821a/phydm_regconfig8821a.o\ -+ hal/phydm/rtl8821a/phydm_rtl8821a.o\ -+ hal/phydm/rtl8821a/phydm_iqk_8821a_ce.o\ -+ hal/phydm/txbf/haltxbfjaguar.o ++########### AUTO_CFG ################################# + -+endif -+ -+ -+endif -+ -+########### HAL_RTL8723B ################################# -+ifeq ($(CONFIG_RTL8723B), y) -+ -+RTL871X = rtl8723b -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8723bu -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8723be -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8723bs -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8723B -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8723BPwrSeq.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ -+ -+_HAL_INTFS_FILES += \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723B_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723B_PCIE.o -+endif -+ -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8723b_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_fw.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_mp.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8723b.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8723b_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8723b.o -+ -+endif -+ -+########### HAL_RTL8814A ################################# -+ifeq ($(CONFIG_RTL8814A), y) -+ -+RTL871X = rtl8814a -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8814au -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8814ae -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8814as -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8814A -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8814PwrSeq.o \ -+ hal/$(RTL871X)/$(RTL871X)_xmit.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ -+ -+_HAL_INTFS_FILES += \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+ifeq ($(CONFIG_GSPI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+endif -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8814A_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8814A_PCIE.o -+endif -+ -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8814a_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8814a_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8814a_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8814a_fw.o\ -+ hal/phydm/$(RTL871X)/phydm_iqk_8814a.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8814a.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8814a_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8814a.o\ -+ hal/phydm/txbf/haltxbf8814a.o -+ -+endif -+ -+ -+########### HAL_RTL8703B ################################# -+ifeq ($(CONFIG_RTL8703B), y) -+ -+RTL871X = rtl8703b -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8703bu -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8703be -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8703bs -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8703B -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8703BPwrSeq.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ -+ -+_HAL_INTFS_FILES += \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8703B_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8703B_PCIE.o -+endif -+ -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8703b_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8703b_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8703b_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8703b_fw.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8703b.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8703b.o -+endif -+ -+########### HAL_RTL8188F ################################# -+ifeq ($(CONFIG_RTL8188F), y) -+ -+RTL871X = rtl8188f -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8188fu -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8188fe -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8189fs -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8188F -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8188FPwrSeq.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ -+ -+_HAL_INTFS_FILES += \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188F_USB.o -+endif -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188F_SDIO.o -+endif -+ -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8188f_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188f_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188f_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188f_fw.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8188f.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8188f.o \ -+ hal/phydm/$(RTL871X)/phydm_rtl8188f.o -+ -+endif -+ -+########### AUTO_CFG ################################# -+ +ifeq ($(CONFIG_AUTOCFG_CP), y) + -+ifeq ($(CONFIG_MULTIDRV), y) -+$(shell cp $(TopDIR)/autoconf_multidrv_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) ++ifeq ($(CONFIG_MULTIDRV), y) ++$(shell cp $(TopDIR)/autoconf_multidrv_usb_linux.h $(TopDIR)/include/autoconf.h) +else -+ifeq ($(CONFIG_RTL8188E)$(CONFIG_SDIO_HCI),yy) -+$(shell cp $(TopDIR)/autoconf_rtl8189e_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) -+else ifeq ($(CONFIG_RTL8188F)$(CONFIG_SDIO_HCI),yy) -+$(shell cp $(TopDIR)/autoconf_rtl8189f_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) -+else -+$(shell cp $(TopDIR)/autoconf_$(RTL871X)_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) -+endif ++$(shell cp $(TopDIR)/autoconf_$(rtl8812a)_usb_linux.h $(TopDIR)/include/autoconf.h) +endif + +endif @@ -342244,11 +155787,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/Makefile linux/3rdparty/rtl8812au/Makefi +########### END OF PATH ################################# + + -+ifeq ($(CONFIG_USB_HCI), y) +ifeq ($(CONFIG_USB_AUTOSUSPEND), y) +EXTRA_CFLAGS += -DCONFIG_USB_AUTOSUSPEND +endif -+endif + +ifeq ($(CONFIG_MP_INCLUDED), y) +#MODULE_NAME := $(MODULE_NAME)_mp @@ -342279,153 +155820,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/Makefile linux/3rdparty/rtl8812au/Makefi +EXTRA_CFLAGS += -DCONFIG_WAPI_SUPPORT +endif + -+ +ifeq ($(CONFIG_EFUSE_CONFIG_FILE), y) +EXTRA_CFLAGS += -DCONFIG_EFUSE_CONFIG_FILE -+ -+#EFUSE_MAP_PATH -+USER_EFUSE_MAP_PATH ?= -+ifneq ($(USER_EFUSE_MAP_PATH),) -+EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"$(USER_EFUSE_MAP_PATH)\" -+else ifeq ($(MODULE_NAME), 8189es) -+EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"/system/etc/wifi/wifi_efuse_8189e.map\" -+else ifeq ($(MODULE_NAME), 8723bs) -+EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"/system/etc/wifi/wifi_efuse_8723bs.map\" -+else -+EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"/system/etc/wifi/wifi_efuse_$(MODULE_NAME).map\" -+endif -+ -+#WIFIMAC_PATH -+USER_WIFIMAC_PATH ?= -+ifneq ($(USER_WIFIMAC_PATH),) -+EXTRA_CFLAGS += -DWIFIMAC_PATH=\"$(USER_WIFIMAC_PATH)\" -+else -+EXTRA_CFLAGS += -DWIFIMAC_PATH=\"/data/wifimac.txt\" -+endif -+ +endif + +ifeq ($(CONFIG_EXT_CLK), y) +EXTRA_CFLAGS += -DCONFIG_EXT_CLK +endif + -+ifeq ($(CONFIG_TRAFFIC_PROTECT), y) -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT ++ifeq ($(CONFIG_FTP_PROTECT), y) ++EXTRA_CFLAGS += -DCONFIG_FTP_PROTECT +endif + -+ifeq ($(CONFIG_LOAD_PHY_PARA_FROM_FILE), y) -+EXTRA_CFLAGS += -DCONFIG_LOAD_PHY_PARA_FROM_FILE -+#EXTRA_CFLAGS += -DREALTEK_CONFIG_PATH=\"/lib/firmware/\" -+EXTRA_CFLAGS += -DREALTEK_CONFIG_PATH=\"\" -+endif -+ -+ifeq ($(CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY), y) -+EXTRA_CFLAGS += -DCONFIG_CALIBRATE_TX_POWER_BY_REGULATORY -+endif -+ -+ifeq ($(CONFIG_CALIBRATE_TX_POWER_TO_MAX), y) -+EXTRA_CFLAGS += -DCONFIG_CALIBRATE_TX_POWER_TO_MAX -+endif -+ -+ifeq ($(CONFIG_RTW_ADAPTIVITY_EN), disable) -+EXTRA_CFLAGS += -DCONFIG_RTW_ADAPTIVITY_EN=0 -+else ifeq ($(CONFIG_RTW_ADAPTIVITY_EN), enable) -+EXTRA_CFLAGS += -DCONFIG_RTW_ADAPTIVITY_EN=1 -+endif -+ -+ifeq ($(CONFIG_RTW_ADAPTIVITY_MODE), normal) -+EXTRA_CFLAGS += -DCONFIG_RTW_ADAPTIVITY_MODE=0 -+else ifeq ($(CONFIG_RTW_ADAPTIVITY_MODE), carrier_sense) -+EXTRA_CFLAGS += -DCONFIG_RTW_ADAPTIVITY_MODE=1 -+endif -+ -+ifeq ($(CONFIG_SIGNAL_SCALE_MAPPING), y) -+EXTRA_CFLAGS += -DCONFIG_SIGNAL_SCALE_MAPPING -+endif -+ -+ifeq ($(CONFIG_80211W), y) -+EXTRA_CFLAGS += -DCONFIG_IEEE80211W -+endif -+ -+ifeq ($(CONFIG_WOWLAN), y) -+EXTRA_CFLAGS += -DCONFIG_WOWLAN -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER -+endif -+endif -+ -+ifeq ($(CONFIG_AP_WOWLAN), y) -+EXTRA_CFLAGS += -DCONFIG_AP_WOWLAN -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER -+endif -+endif -+ -+ifeq ($(CONFIG_PNO_SUPPORT), y) -+EXTRA_CFLAGS += -DCONFIG_PNO_SUPPORT -+ifeq ($(CONFIG_PNO_SET_DEBUG), y) -+EXTRA_CFLAGS += -DCONFIG_PNO_SET_DEBUG -+endif -+endif -+ -+ifeq ($(CONFIG_GPIO_WAKEUP), y) -+EXTRA_CFLAGS += -DCONFIG_GPIO_WAKEUP -+ifeq ($(CONFIG_HIGH_ACTIVE), y) -+EXTRA_CFLAGS += -DHIGH_ACTIVE=1 -+else -+EXTRA_CFLAGS += -DHIGH_ACTIVE=0 -+endif -+endif -+ -+ifneq ($(CONFIG_WAKEUP_GPIO_IDX), default) -+EXTRA_CFLAGS += -DWAKEUP_GPIO_IDX=$(CONFIG_WAKEUP_GPIO_IDX) -+endif -+ -+ifeq ($(CONFIG_RTW_SDIO_PM_KEEP_POWER), y) -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER -+endif -+endif -+ -+ifeq ($(CONFIG_REDUCE_TX_CPU_LOADING), y) -+EXTRA_CFLAGS += -DCONFIG_REDUCE_TX_CPU_LOADING -+endif -+ -+ifeq ($(CONFIG_BR_EXT), y) -+BR_NAME = br0 -+EXTRA_CFLAGS += -DCONFIG_BR_EXT -+EXTRA_CFLAGS += '-DCONFIG_BR_EXT_BRNAME="'$(BR_NAME)'"' -+endif -+ -+ifeq ($(CONFIG_ANTENNA_DIVERSITY), y) -+EXTRA_CFLAGS += -DCONFIG_ANTENNA_DIVERSITY -+endif -+ -+ifeq ($(CONFIG_TDLS), y) -+EXTRA_CFLAGS += -DCONFIG_TDLS -+endif -+ -+ifeq ($(CONFIG_WIFI_MONITOR), y) -+EXTRA_CFLAGS += -DCONFIG_WIFI_MONITOR -+endif -+ -+EXTRA_CFLAGS += -DDM_ODM_SUPPORT_TYPE=0x04 -+ -+ifeq ($(CONFIG_PLATFORM_GENERIC), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+SUBARCH := $(shell uname -m | sed -e s/i.86/i386/ -e s/armv.*/arm/) -+ARCH ?= $(SUBARCH) -+CROSS_COMPILE ?= -+KVER := $(shell uname -r) -+KSRC := /lib/modules/$(KVER)/build -+MODDESTDIR := /lib/modules/$(KVER)/kernel/drivers/net/wireless/ -+INSTALL_PREFIX := -+endif -+ -+ifeq ($(CONFIG_PLATFORM_I386_PC), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT +SUBARCH := $(shell uname -m | sed -e s/i.86/i386/) +ARCH ?= $(SUBARCH) +CROSS_COMPILE ?= @@ -342433,697 +155839,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/Makefile linux/3rdparty/rtl8812au/Makefi +KSRC := /lib/modules/$(KVER)/build +MODDESTDIR := /lib/modules/$(KVER)/kernel/drivers/net/wireless/ +INSTALL_PREFIX := -+endif + -+ifeq ($(CONFIG_PLATFORM_ACTIONS_ATM702X), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -DCONFIG_PLATFORM_ACTIONS_ATM702X -+#ARCH := arm -+ARCH := $(R_ARCH) -+#CROSS_COMPILE := arm-none-linux-gnueabi- -+CROSS_COMPILE := $(R_CROSS_COMPILE) -+KVER:= 3.4.0 -+#KSRC := ../../../../build/out/kernel -+KSRC := $(KERNEL_BUILD_PATH) -+MODULE_NAME :=wlan -+endif -+ -+ -+ifeq ($(CONFIG_PLATFORM_ACTIONS_ATM705X), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+#EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC -+# default setting for Android 4.1, 4.2, 4.3, 4.4 -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ACTIONS_ATM705X -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -+ -+# Enable this for Android 5.0 -+EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+_PLATFORM_FILES += platform/platform_arm_act_sdio.o -+endif -+ -+ARCH := arm -+CROSS_COMPILE := /opt/arm-2011.09/bin/arm-none-linux-gnueabi- -+KSRC := /home/android_sdk/Action-semi/705a_android_L/android/kernel -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SUN50IW1P1), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN50IW1P1 -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -+EXTRA_CFLAGS += -DCONFIG_RESUME_IN_WORKQUEUE -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ -+# Enable this for Android 5.0 -+EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -+ -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+_PLATFORM_FILES += platform/platform_ARM_SUN50IW1P1_sdio.o -+endif -+ -+ARCH := arm64 -+# ===Cross compile setting for Android 5.1(64) SDK === -+CROSS_COMPILE := /home/android_sdk/Allwinner/a64/android-51/lichee/out/sun50iw1p1/android/common/buildroot/external-toolchain/bin/aarch64-linux-gnueabihf- -+KSRC :=/home/android_sdk/Allwinner/a64/android-51/lichee/linux-3.10/ -+endif -+ -+ifeq ($(CONFIG_PLATFORM_TI_AM3517), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -DCONFIG_PLATFORM_SHUTTLE -+CROSS_COMPILE := arm-eabi- -+KSRC := $(shell pwd)/../../../Android/kernel -+ARCH := arm -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MSTAR_TITANIA12), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MSTAR -DCONFIG_PLATFORM_MSTAR_TITANIA12 -+ARCH:=mips -+CROSS_COMPILE:= /usr/src/Mstar_kernel/mips-4.3/bin/mips-linux-gnu- -+KVER:= 2.6.28.9 -+KSRC:= /usr/src/Mstar_kernel/2.6.28.9/ -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MSTAR), y) -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MSTAR -DCONFIG_USE_USB_BUFFER_ALLOC_TX -DCONFIG_FIX_NR_BULKIN_BUFFER -DCONFIG_PREALLOC_RX_SKB_BUFFER -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_MSTAR_HIGH -+ARCH:=arm -+CROSS_COMPILE:= /usr/src/bin/arm-none-linux-gnueabi- -+KVER:= 3.1.10 -+KSRC:= /usr/src/Mstar_kernel/3.1.10/ -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ANDROID_X86), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+SUBARCH := $(shell uname -m | sed -e s/i.86/i386/) -+ARCH := $(SUBARCH) -+CROSS_COMPILE := /media/DATA-2/android-x86/ics-x86_20120130/prebuilt/linux-x86/toolchain/i686-unknown-linux-gnu-4.2.1/bin/i686-unknown-linux-gnu- -+KSRC := /media/DATA-2/android-x86/ics-x86_20120130/out/target/product/generic_x86/obj/kernel -+MODULE_NAME :=wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ANDROID_INTEL_X86), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ANDROID_INTEL_X86 -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_INTEL_BYT -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -+EXTRA_CFLAGS += -DCONFIG_SKIP_SIGNAL_SCALE_MAPPING -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_RESUME_IN_WORKQUEUE -+endif -+endif -+ -+ifeq ($(CONFIG_PLATFORM_JB_X86), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -+SUBARCH := $(shell uname -m | sed -e s/i.86/i386/) -+ARCH := $(SUBARCH) -+CROSS_COMPILE := /home/android_sdk/android-x86_JB/prebuilts/gcc/linux-x86/x86/i686-linux-android-4.7/bin/i686-linux-android- -+KSRC := /home/android_sdk/android-x86_JB/out/target/product/x86/obj/kernel/ -+MODULE_NAME :=wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_PXA2XX), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH := arm -+CROSS_COMPILE := arm-none-linux-gnueabi- -+KVER := 2.6.34.1 -+KSRC ?= /usr/src/linux-2.6.34.1 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_S3C2K4), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH := arm -+CROSS_COMPILE := arm-linux- -+KVER := 2.6.24.7_$(ARCH) -+KSRC := /usr/src/kernels/linux-$(KVER) -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_S3C6K4), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH := arm -+CROSS_COMPILE := arm-none-linux-gnueabi- -+KVER := 2.6.34.1 -+KSRC ?= /usr/src/linux-2.6.34.1 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_RTD2880B), y) -+EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN -DCONFIG_PLATFORM_RTD2880B -+ARCH:= -+CROSS_COMPILE:= -+KVER:= -+KSRC:= -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MIPS_RMI), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH:=mips -+CROSS_COMPILE:=mipsisa32r2-uclibc- -+KVER:= -+KSRC:= /root/work/kernel_realtek -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MIPS_PLM), y) -+EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN -+ARCH:=mips -+CROSS_COMPILE:=mipsisa32r2-uclibc- -+KVER:= -+KSRC:= /root/work/kernel_realtek -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MSTAR389), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MSTAR389 -+ARCH:=mips -+CROSS_COMPILE:= mips-linux-gnu- -+KVER:= 2.6.28.10 -+KSRC:= /home/mstar/mstar_linux/2.6.28.9/ -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MIPS_AR9132), y) -+EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN -+ARCH := mips -+CROSS_COMPILE := mips-openwrt-linux- -+KSRC := /home/alex/test_openwrt/tmp/linux-2.6.30.9 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_DMP_PHILIPS), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DRTK_DMP_PLATFORM -+ARCH := mips -+#CROSS_COMPILE:=/usr/local/msdk-4.3.6-mips-EL-2.6.12.6-0.9.30.3/bin/mipsel-linux- -+CROSS_COMPILE:=/usr/local/toolchain_mipsel/bin/mipsel-linux- -+KSRC ?=/usr/local/Jupiter/linux-2.6.12 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_RTK_DMP), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DRTK_DMP_PLATFORM -DCONFIG_WIRELESS_EXT -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+_PLATFORM_FILES += platform/platform_RTK_DMP_usb.o -+endif -+ARCH:=mips -+CROSS_COMPILE:=mipsel-linux- -+KVER:= -+KSRC ?= /usr/src/DMP_Kernel/jupiter/linux-2.6.12 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MT53XX), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MT53XX -+ARCH:= arm -+CROSS_COMPILE:= arm11_mtk_le- -+KVER:= 2.6.27 -+KSRC?= /proj/mtk00802/BD_Compare/BDP/Dev/BDP_V301/BDP_Linux/linux-2.6.27 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_MX51_241H), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_WISTRON_PLATFORM -+ARCH := arm -+CROSS_COMPILE := /opt/freescale/usr/local/gcc-4.1.2-glibc-2.5-nptl-3/arm-none-linux-gnueabi/bin/arm-none-linux-gnueabi- -+KVER := 2.6.31 -+KSRC ?= /lib/modules/2.6.31-770-g0e46b52/source -+endif -+ -+ifeq ($(CONFIG_PLATFORM_FS_MX61), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH := arm -+CROSS_COMPILE := /home/share/CusEnv/FreeScale/arm-eabi-4.4.3/bin/arm-eabi- -+KSRC ?= /home/share/CusEnv/FreeScale/FS_kernel_env -+endif -+ -+ -+ -+ifeq ($(CONFIG_PLATFORM_ACTIONS_ATJ227X), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ACTIONS_ATJ227X -+ARCH := mips -+CROSS_COMPILE := /home/cnsd4/project/actions/tools-2.6.27/bin/mipsel-linux-gnu- -+KVER := 2.6.27 -+KSRC := /home/cnsd4/project/actions/linux-2.6.27.28 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_TI_DM365), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_TI_DM365 -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_RX -+EXTRA_CFLAGS += -DCONFIG_SINGLE_XMIT_BUF -DCONFIG_SINGLE_RECV_BUF -+ARCH := arm -+#CROSS_COMPILE := /home/cnsd4/Appro/mv_pro_5.0/montavista/pro/devkit/arm/v5t_le/bin/arm_v5t_le- -+#KSRC := /home/cnsd4/Appro/mv_pro_5.0/montavista/pro/devkit/lsp/ti-davinci/linux-dm365 -+CROSS_COMPILE := /opt/montavista/pro5.0/devkit/arm/v5t_le/bin/arm-linux- -+KSRC:= /home/vivotek/lsp/DM365/kernel_platform/kernel/linux-2.6.18 -+KERNELOUTPUT := ${PRODUCTDIR}/tmp -+KVER := 2.6.18 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MOZART), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MOZART -+ARCH := arm -+CROSS_COMPILE := /home/vivotek/lsp/mozart3v2/Mozart3e_Toolchain/build_arm_nofpu/usr/bin/arm-linux- -+KVER := $(shell uname -r) -+KSRC:= /opt/Vivotek/lsp/mozart3v2/kernel_platform/kernel/mozart_kernel-1.17 -+KERNELOUTPUT := /home/pink/sample/ODM/IP8136W-VINT/tmp/kernel -+endif -+ -+ifeq ($(CONFIG_PLATFORM_TEGRA3_CARDHU), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/nvidia/tegra-16r3-partner-android-4.1_20120723/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- -+KSRC := /home/android_sdk/nvidia/tegra-16r3-partner-android-4.1_20120723/out/target/product/cardhu/obj/KERNEL -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_TEGRA4_DALMORE), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/nvidia/tegra-17r9-partner-android-4.2-dalmore_20130131/prebuilts/gcc/linux-x86/arm/arm-eabi-4.6/bin/arm-eabi- -+KSRC := /home/android_sdk/nvidia/tegra-17r9-partner-android-4.2-dalmore_20130131/out/target/product/dalmore/obj/KERNEL -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_TCC8900), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/Telechips/SDK_2304_20110613/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- -+KSRC := /home/android_sdk/Telechips/SDK_2304_20110613/kernel -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_TCC8920), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/Telechips/v12.06_r1-tcc-android-4.0.4/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- -+KSRC := /home/android_sdk/Telechips/v12.06_r1-tcc-android-4.0.4/kernel -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_TCC8920_JB42), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/Telechips/v13.03_r1-tcc-android-4.2.2_ds_patched/prebuilts/gcc/linux-x86/arm/arm-eabi-4.6/bin/arm-eabi- -+KSRC := /home/android_sdk/Telechips/v13.03_r1-tcc-android-4.2.2_ds_patched/kernel -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_RK2818), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -DCONFIG_PLATFORM_ROCKCHIPS -+ARCH := arm -+CROSS_COMPILE := /usr/src/release_fae_version/toolchain/arm-eabi-4.4.0/bin/arm-eabi- -+KSRC := /usr/src/release_fae_version/kernel25_A7_281x -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_RK3188), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -DCONFIG_PLATFORM_ROCKCHIPS -+# default setting for Android 4.1, 4.2, 4.3, 4.4 -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+# default setting for Power control -+EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC -+EXTRA_CFLAGS += -DRTW_SUPPORT_PLATFORM_SHUTDOWN -+# default setting for Special function -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/Rockchip/Rk3188/prebuilts/gcc/linux-x86/arm/arm-eabi-4.6/bin/arm-eabi- -+KSRC := /home/android_sdk/Rockchip/Rk3188/kernel -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_RK3066), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_RK3066 -+EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DRTW_SUPPORT_PLATFORM_SHUTDOWN -+endif -+EXTRA_CFLAGS += -fno-pic -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/Rockchip/rk3066_20130607/prebuilts/gcc/linux-x86/arm/arm-linux-androideabi-4.6/bin/arm-linux-androideabi- -+#CROSS_COMPILE := /home/android_sdk/Rockchip/Rk3066sdk/prebuilts/gcc/linux-x86/arm/arm-linux-androideabi-4.6/bin/arm-linux-androideabi- -+KSRC := /home/android_sdk/Rockchip/Rk3066sdk/kernel -+MODULE_NAME :=wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_URBETTER), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN #-DCONFIG_MINIMAL_MEMORY_USAGE -+ARCH := arm -+CROSS_COMPILE := /media/DATA-1/urbetter/arm-2009q3/bin/arm-none-linux-gnueabi- -+KSRC := /media/DATA-1/urbetter/ics-urbetter/kernel -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_TI_PANDA), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN #-DCONFIG_MINIMAL_MEMORY_USAGE -+ARCH := arm -+#CROSS_COMPILE := /media/DATA-1/aosp/ics-aosp_20111227/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- -+#KSRC := /media/DATA-1/aosp/android-omap-panda-3.0_20120104 -+CROSS_COMPILE := /media/DATA-1/android-4.0/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- -+KSRC := /media/DATA-1/android-4.0/panda_kernel/omap -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MIPS_JZ4760), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_MINIMAL_MEMORY_USAGE -+ARCH ?= mips -+CROSS_COMPILE ?= /mnt/sdb5/Ingenic/Umido/mips-4.3/bin/mips-linux-gnu- -+KSRC ?= /mnt/sdb5/Ingenic/Umido/kernel -+endif -+ -+ifeq ($(CONFIG_PLATFORM_SZEBOOK), y) -+EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN -+ARCH:=arm -+CROSS_COMPILE:=/opt/crosstool2/bin/armeb-unknown-linux-gnueabi- -+KVER:= 2.6.31.6 -+KSRC:= ../code/linux-2.6.31.6-2020/ -+endif -+ -+#Add setting for MN10300 -+ifeq ($(CONFIG_PLATFORM_MN10300), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MN10300 -+ARCH := mn10300 -+CROSS_COMPILE := mn10300-linux- -+KVER := 2.6.32.2 -+KSRC := /home/winuser/work/Plat_sLD2T_V3010/usr/src/linux-2.6.32.2 -+INSTALL_PREFIX := -+endif -+ -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SUNxI), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUNxI -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DDCONFIG_P2P_IPS -+ -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+# default setting for A10-EVB mmc0 -+#EXTRA_CFLAGS += -DCONFIG_WITS_EVB_V13 -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_sdio.o -+endif -+ -+ARCH := arm -+#CROSS_COMPILE := arm-none-linux-gnueabi- -+CROSS_COMPILE=/home/android_sdk/Allwinner/a10/android-jb42/lichee-jb42/buildroot/output/external-toolchain/bin/arm-none-linux-gnueabi- -+KVER := 3.0.8 -+#KSRC:= ../lichee/linux-3.0/ -+KSRC=/home/android_sdk/Allwinner/a10/android-jb42/lichee-jb42/linux-3.0 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SUN6I), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN6I -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2, 4.3, 4.4 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -DCONFIG_QOS_OPTIMIZATION -+ -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+# default setting for A31-EVB mmc0 -+EXTRA_CFLAGS += -DCONFIG_A31_EVB -+_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o -+endif -+ -+ARCH := arm -+#Android-JB42 -+#CROSS_COMPILE := /home/android_sdk/Allwinner/a31/android-jb42/lichee/buildroot/output/external-toolchain/bin/arm-linux-gnueabi- -+#KSRC :=/home/android_sdk/Allwinner/a31/android-jb42/lichee/linux-3.3 -+#ifeq ($(CONFIG_USB_HCI), y) -+#MODULE_NAME := 8188eu_sw -+#endif -+# ==== Cross compile setting for kitkat-a3x_v4.5 ===== -+CROSS_COMPILE := /home/android_sdk/Allwinner/a31/kitkat-a3x_v4.5/lichee/buildroot/output/external-toolchain/bin/arm-linux-gnueabi- -+KSRC :=/home/android_sdk/Allwinner/a31/kitkat-a3x_v4.5/lichee/linux-3.3 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SUN7I), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN7I -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2, 4.3, 4.4 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -DCONFIG_QOS_OPTIMIZATION -+ -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o -+endif -+ -+ARCH := arm -+# ===Cross compile setting for Android 4.2 SDK === -+#CROSS_COMPILE := /home/android_sdk/Allwinner/a20_evb/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- -+#KSRC := /home/android_sdk/Allwinner/a20_evb/lichee/linux-3.3 -+# ==== Cross compile setting for Android 4.3 SDK ===== -+#CROSS_COMPILE := /home/android_sdk/Allwinner/a20/android-jb43/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- -+#KSRC := /home/android_sdk/Allwinner/a20/android-jb43/lichee/linux-3.4 -+# ==== Cross compile setting for kitkat-a20_v4.4 ===== -+CROSS_COMPILE := /home/android_sdk/Allwinner/a20/kitkat-a20_v4.4/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- -+KSRC := /home/android_sdk/Allwinner/a20/kitkat-a20_v4.4/lichee/linux-3.4 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SUN8I_W3P1), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN8I -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN8I_W3P1 -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -+ -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o -+endif -+ -+ARCH := arm -+# ===Cross compile setting for Android 4.2 SDK === -+#CROSS_COMPILE := /home/android_sdk/Allwinner/a23/android-jb42/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- -+#KSRC :=/home/android_sdk/Allwinner/a23/android-jb42/lichee/linux-3.4 -+# ===Cross compile setting for Android 4.4 SDK === -+CROSS_COMPILE := /home/android_sdk/Allwinner/a23/android-kk44/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- -+KSRC :=/home/android_sdk/Allwinner/a23/android-kk44/lichee/linux-3.4 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SUN8I_W5P1), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN8I -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN8I_W5P1 -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -+ -+# Enable this for Android 5.0 -+EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -+ -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o -+endif -+ -+ARCH := arm -+# ===Cross compile setting for Android L SDK === -+CROSS_COMPILE := /home/android_sdk/Allwinner/a33/android-L/lichee/out/sun8iw5p1/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- -+KSRC :=/home/android_sdk/Allwinner/a33/android-L/lichee/linux-3.4 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ACTIONS_ATV5201), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ACTIONS_ATV5201 -+EXTRA_CFLAGS += -DCONFIG_SDIO_DISABLE_RXFIFO_POLLING_LOOP -+ARCH := mips -+CROSS_COMPILE := mipsel-linux-gnu- -+KVER := $(KERNEL_VER) -+KSRC:= $(CFGDIR)/../../kernel/linux-$(KERNEL_VER) -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_RTD299X), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DUSB_XMITBUF_ALIGN_SZ=1024 -DUSB_PACKET_OFFSET_SZ=0 -+#ARCH, CROSS_COMPILE, KSRC,and MODDESTDIR are provided by external makefile -+INSTALL_PREFIX := -+endif -+ -+ifeq ($(CONFIG_PLATFORM_HISILICON), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_HISILICON -+ifeq ($(SUPPORT_CONCURRENT),y) -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+endif -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -+ARCH := arm -+ifeq ($(CROSS_COMPILE),) -+ CROSS_COMPILE = arm-hisiv200-linux- -+endif -+MODULE_NAME := rtl8192eu -+ifeq ($(KSRC),) -+ KSRC := ../../../../../../kernel/linux-3.4.y -+endif -+endif -+ -+# Platform setting -+ifeq ($(CONFIG_PLATFORM_ARM_SPREADTRUM_6820), y) -+ifeq ($(CONFIG_ANDROID_2X), y) -+EXTRA_CFLAGS += -DANDROID_2X -+endif -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_SPRD -+EXTRA_CFLAGS += -DPLATFORM_SPREADTRUM_6820 -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ifeq ($(RTL871X), rtl8188e) -+EXTRA_CFLAGS += -DSOFTAP_PS_DURATION=50 -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+_PLATFORM_FILES += platform/platform_sprd_sdio.o -+endif -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SPREADTRUM_8810), y) -+ifeq ($(CONFIG_ANDROID_2X), y) -+EXTRA_CFLAGS += -DANDROID_2X -+endif -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_SPRD -+EXTRA_CFLAGS += -DPLATFORM_SPREADTRUM_8810 -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ifeq ($(RTL871X), rtl8188e) -+EXTRA_CFLAGS += -DSOFTAP_PS_DURATION=50 -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+_PLATFORM_FILES += platform/platform_sprd_sdio.o -+endif -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_WMT), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_SDIO_HCI), y) -+_PLATFORM_FILES += platform/platform_ARM_WMT_sdio.o -+endif -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/WonderMedia/wm8880-android4.4/toolchain/arm_201103_gcc4.5.2/mybin/arm_1103_le- -+KSRC := /home/android_sdk/WonderMedia/wm8880-android4.4/kernel4.4/ -+MODULE_NAME :=8189es_kk -+endif -+ -+ifeq ($(CONFIG_PLATFORM_RTK119X), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+#EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN7I -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+#EXTRA_CFLAGS += -DCONFIG_P2P_IPS -DCONFIG_QOS_OPTIMIZATION -+EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION -+ -+#EXTRA_CFLAGS += -DCONFIG_#PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+#_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o -+endif -+ -+ARCH := arm -+ -+# ==== Cross compile setting for Android 4.4 SDK ===== -+#CROSS_COMPILE := arm-linux-gnueabihf- -+KVER := 3.10.24 -+#KSRC :=/home/android_sdk/Allwinner/a20/android-kitkat44/lichee/linux-3.4 -+CROSS_COMPILE := /home/realtek/software_phoenix/phoenix/toolchain/usr/local/arm-2013.11/bin/arm-linux-gnueabihf- -+KSRC := /home/realtek/software_phoenix/linux-kernel -+MODULE_NAME := 8192eu -+ -+endif -+ -+ifeq ($(CONFIG_PLATFORM_NOVATEK_NT72668), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_NOVATEK_NT72668 -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DDCONFIG_P2P_IPS -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_RX -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+ARCH ?= arm -+CROSS_COMPILE := arm-linux-gnueabihf- -+KVER := 3.8.0 -+KSRC := /Custom/Novatek/TCL/linux-3.8_header -+#KSRC := $(KERNELDIR) -+endif -+ -+ifeq ($(CONFIG_MULTIDRV), y) -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME := rtw_sdio -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME := rtw_usb -+endif -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME := rtw_pci -+endif -+ -+ -+endif -+ -+USER_MODULE_NAME ?= +ifneq ($(USER_MODULE_NAME),) +MODULE_NAME := $(USER_MODULE_NAME) +endif @@ -343151,11 +155867,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/Makefile linux/3rdparty/rtl8812au/Makefi + core/rtw_tdls.o \ + core/rtw_br_ext.o \ + core/rtw_iol.o \ -+ core/rtw_sreset.o \ -+ core/rtw_btcoex.o \ -+ core/rtw_beamforming.o \ -+ core/rtw_odm.o \ -+ core/efuse/rtw_efuse.o ++ core/rtw_sreset.o\ ++ core/efuse/rtw_efuse.o + +$(MODULE_NAME)-y += $(rtk_core) + @@ -343163,32 +155876,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/Makefile linux/3rdparty/rtl8812au/Makefi + +$(MODULE_NAME)-$(CONFIG_WAPI_SUPPORT) += core/rtw_wapi.o \ + core/rtw_wapi_sms4.o -+ ++ +$(MODULE_NAME)-y += $(_OS_INTFS_FILES) +$(MODULE_NAME)-y += $(_HAL_INTFS_FILES) +$(MODULE_NAME)-y += $(_OUTSRC_FILES) -+$(MODULE_NAME)-y += $(_PLATFORM_FILES) + +$(MODULE_NAME)-$(CONFIG_MP_INCLUDED) += core/rtw_mp.o \ + core/rtw_mp_ioctl.o + -+ifeq ($(CONFIG_RTL8723B), y) -+$(MODULE_NAME)-$(CONFIG_MP_INCLUDED)+= core/rtw_bt_mp.o -+endif -+ifeq ($(CONFIG_RTL8821A), y) -+$(MODULE_NAME)-$(CONFIG_MP_INCLUDED)+= core/rtw_bt_mp.o -+endif -+ -+obj-$(CONFIG_RTL8812AU) := $(MODULE_NAME).o ++obj-m := $(MODULE_NAME).o + +else + -+export CONFIG_RTL8812AU = m -+ +all: modules + +modules: -+ $(MAKE) ARCH=$(ARCH) CROSS_COMPILE=$(CROSS_COMPILE) -C $(KSRC) M=$(shell pwd) modules ++ $(MAKE) CROSS_COMPILE=$(CROSS_COMPILE) -C $(KSRC) M=$(shell pwd) modules + +strip: + $(CROSS_COMPILE)strip $(MODULE_NAME).ko --strip-unneeded @@ -343205,30 +155908,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/Makefile linux/3rdparty/rtl8812au/Makefi + @echo "make config" + /bin/bash script/Configure script/config.in + -+ +.PHONY: modules clean + +clean: -+ cd hal/phydm/ ; rm -fr */*.mod.c */*.mod */*.o */.*.cmd */*.ko -+ cd hal/phydm/ ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ cd hal/led ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ cd hal ; rm -fr */*/*.mod.c */*/*.mod */*/*.o */*/.*.cmd */*/*.ko + cd hal ; rm -fr */*.mod.c */*.mod */*.o */.*.cmd */*.ko + cd hal ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko + cd core/efuse ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko + cd core ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko + cd os_dep/linux ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko + cd os_dep ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ cd platform ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko + rm -fr Module.symvers ; rm -fr Module.markers ; rm -fr modules.order + rm -fr *.mod.c *.mod *.o .*.cmd *.ko *~ + rm -fr .tmp_versions +endif + -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/custom_gpio_linux.c linux/3rdparty/rtl8812au/os_dep/linux/custom_gpio_linux.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/custom_gpio_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/custom_gpio_linux.c 2017-06-07 23:07:21.044690583 +0300 -@@ -0,0 +1,356 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/custom_gpio_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/custom_gpio_linux.c +--- linux-4.14.17/3rdparty/rtl8812au/os_dep/custom_gpio_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/custom_gpio_linux.c 2018-02-06 17:42:30.722967342 +0200 +@@ -0,0 +1,25 @@ +/****************************************************************************** + * Customer code to add GPIO control during WLAN start/stop + * @@ -343243,339 +155940,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/custom_gpio_linux.c linux/3 + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#include "drv_types.h" + -+#ifdef CONFIG_PLATFORM_SPRD -+ -+//gspi func & GPIO define -+#include //0915 -+#include -+ -+#if !(defined ANDROID_2X) -+ -+#ifdef CONFIG_RTL8188E -+#include -+#include -+#endif // CONFIG_RTL8188E -+ -+#ifndef GPIO_WIFI_POWER -+#define GPIO_WIFI_POWER -1 -+#endif // !GPIO_WIFI_POWER -+ -+#ifndef GPIO_WIFI_RESET -+#define GPIO_WIFI_RESET -1 -+#endif // !GPIO_WIFI_RESET -+ -+#ifndef GPIO_WIFI_PWDN -+#define GPIO_WIFI_PWDN -1 -+#endif // !GPIO_WIFI_RESET -+#ifdef CONFIG_GSPI_HCI -+extern unsigned int oob_irq; -+#endif // CONFIG_GSPI_HCI -+ -+#ifdef CONFIG_SDIO_HCI -+extern int rtw_mp_mode; -+#else // !CONFIG_SDIO_HCI -+#endif // !CONFIG_SDIO_HCI -+ -+int rtw_wifi_gpio_init(void) -+{ -+#ifdef CONFIG_GSPI_HCI -+ if (GPIO_WIFI_IRQ > 0) { -+ gpio_request(GPIO_WIFI_IRQ, "oob_irq"); -+ gpio_direction_input(GPIO_WIFI_IRQ); -+ -+ oob_irq = gpio_to_irq(GPIO_WIFI_IRQ); -+ -+ DBG_8192C("%s oob_irq:%d\n", __func__, oob_irq); -+ } -+#endif -+ if (GPIO_WIFI_RESET > 0) -+ gpio_request(GPIO_WIFI_RESET , "wifi_rst"); -+ if (GPIO_WIFI_POWER > 0) -+ gpio_request(GPIO_WIFI_POWER, "wifi_power"); -+ -+#ifdef CONFIG_SDIO_HCI -+#if (defined(CONFIG_RTL8723B)) && (MP_DRIVER == 1) -+ if(rtw_mp_mode==1){ -+ DBG_871X("%s GPIO_BT_RESET pin special for mp_test\n", __func__); -+ if (GPIO_BT_RESET > 0) -+ gpio_request(GPIO_BT_RESET , "bt_rst"); -+ } -+#endif -+#endif -+ return 0; -+} -+ -+int rtw_wifi_gpio_deinit(void) -+{ -+#ifdef CONFIG_GSPI_HCI -+ if (GPIO_WIFI_IRQ > 0) -+ gpio_free(GPIO_WIFI_IRQ); -+#endif -+ if (GPIO_WIFI_RESET > 0) -+ gpio_free(GPIO_WIFI_RESET ); -+ if (GPIO_WIFI_POWER > 0) -+ gpio_free(GPIO_WIFI_POWER); -+ -+#ifdef CONFIG_SDIO_HCI -+#if ( defined(CONFIG_RTL8723B)) && (MP_DRIVER == 1) -+ if(rtw_mp_mode==1){ -+ DBG_871X("%s GPIO_BT_RESET pin special for mp_test\n", __func__); -+ if (GPIO_BT_RESET > 0) -+ gpio_free(GPIO_BT_RESET); -+ } -+#endif -+#endif -+ return 0; -+} -+ -+/* Customer function to control hw specific wlan gpios */ -+void rtw_wifi_gpio_wlan_ctrl(int onoff) -+{ -+ switch (onoff) -+ { -+ case WLAN_PWDN_OFF: -+ DBG_8192C("%s: call customer specific GPIO(%d) to set wifi power down pin to 0\n", -+ __FUNCTION__, GPIO_WIFI_RESET); -+ -+#ifndef CONFIG_DONT_BUS_SCAN -+ if (GPIO_WIFI_RESET > 0) -+ gpio_direction_output(GPIO_WIFI_RESET , 0); -+#endif -+ break; -+ -+ case WLAN_PWDN_ON: -+ DBG_8192C("%s: callc customer specific GPIO(%d) to set wifi power down pin to 1\n", -+ __FUNCTION__, GPIO_WIFI_RESET); -+ -+ if (GPIO_WIFI_RESET > 0) -+ gpio_direction_output(GPIO_WIFI_RESET , 1); -+ break; -+ -+ case WLAN_POWER_OFF: -+ break; -+ -+ case WLAN_POWER_ON: -+ break; -+#ifdef CONFIG_SDIO_HCI -+#if ( defined(CONFIG_RTL8723B)) && (MP_DRIVER == 1) -+ case WLAN_BT_PWDN_OFF: -+ if(rtw_mp_mode==1) -+ { -+ DBG_871X("%s: call customer specific GPIO to set wifi power down pin to 0\n", -+ __FUNCTION__); -+ if (GPIO_BT_RESET > 0) -+ gpio_direction_output(GPIO_BT_RESET , 0); -+ } -+ break; -+ -+ case WLAN_BT_PWDN_ON: -+ if(rtw_mp_mode==1) -+ { -+ DBG_871X("%s: callc customer specific GPIO to set wifi power down pin to 1 %x\n", -+ __FUNCTION__, GPIO_BT_RESET); -+ -+ if (GPIO_BT_RESET > 0) -+ gpio_direction_output(GPIO_BT_RESET , 1); -+ } -+ break; -+#endif -+#endif -+ } -+} -+ -+#else //ANDROID_2X -+ -+#include -+ -+#ifdef CONFIG_RTL8188E -+extern int sprd_3rdparty_gpio_wifi_power; -+#endif -+extern int sprd_3rdparty_gpio_wifi_pwd; -+#if defined(CONFIG_RTL8723B) -+extern int sprd_3rdparty_gpio_bt_reset; -+#endif -+ -+int rtw_wifi_gpio_init(void) -+{ -+#if defined(CONFIG_RTL8723B) -+ if (sprd_3rdparty_gpio_bt_reset > 0) -+ gpio_direction_output(sprd_3rdparty_gpio_bt_reset, 1); -+#endif -+ -+ return 0; -+} -+ -+int rtw_wifi_gpio_deinit(void) -+{ -+ return 0; -+} -+ -+/* Customer function to control hw specific wlan gpios */ -+void rtw_wifi_gpio_wlan_ctrl(int onoff) -+{ -+ switch (onoff) -+ { -+ case WLAN_PWDN_OFF: -+ DBG_8192C("%s: call customer specific GPIO to set wifi power down pin to 0\n", -+ __FUNCTION__); -+ if (sprd_3rdparty_gpio_wifi_pwd > 0) -+ { -+ gpio_set_value(sprd_3rdparty_gpio_wifi_pwd, 0); -+ } -+ -+ if (sprd_3rdparty_gpio_wifi_pwd == 60) { -+ DBG_8192C("%s: turn off VSIM2 2.8V\n", __func__); -+ LDO_TurnOffLDO(LDO_LDO_SIM2); -+ } -+ break; -+ -+ case WLAN_PWDN_ON: -+ DBG_8192C("%s: callc customer specific GPIO to set wifi power down pin to 1\n", -+ __FUNCTION__); -+ if (sprd_3rdparty_gpio_wifi_pwd == 60) { -+ DBG_8192C("%s: turn on VSIM2 2.8V\n", __func__); -+ LDO_SetVoltLevel(LDO_LDO_SIM2, LDO_VOLT_LEVEL0); -+ LDO_TurnOnLDO(LDO_LDO_SIM2); -+ } -+ if (sprd_3rdparty_gpio_wifi_pwd > 0) -+ { -+ gpio_set_value(sprd_3rdparty_gpio_wifi_pwd, 1); -+ } -+ break; -+ -+ case WLAN_POWER_OFF: -+#ifdef CONFIG_RTL8188E -+#ifdef CONFIG_WIF1_LDO -+ DBG_8192C("%s: turn off VDD-WIFI0 1.2V\n", __FUNCTION__); -+ LDO_TurnOffLDO(LDO_LDO_WIF1); -+#endif //CONFIG_WIF1_LDO -+ -+ DBG_8192C("%s: turn off VDD-WIFI0 3.3V\n", __FUNCTION__); -+ LDO_TurnOffLDO(LDO_LDO_WIF0); -+ -+ DBG_8192C("%s: call customer specific GPIO(%d) to turn off wifi power\n", -+ __FUNCTION__, sprd_3rdparty_gpio_wifi_power); -+ if (sprd_3rdparty_gpio_wifi_power != 65535) -+ gpio_set_value(sprd_3rdparty_gpio_wifi_power, 0); -+#endif -+ break; -+ -+ case WLAN_POWER_ON: -+#ifdef CONFIG_RTL8188E -+ DBG_8192C("%s: call customer specific GPIO(%d) to turn on wifi power\n", -+ __FUNCTION__, sprd_3rdparty_gpio_wifi_power); -+ if (sprd_3rdparty_gpio_wifi_power != 65535) -+ gpio_set_value(sprd_3rdparty_gpio_wifi_power, 1); -+ -+ DBG_8192C("%s: turn on VDD-WIFI0 3.3V\n", __FUNCTION__); -+ LDO_TurnOnLDO(LDO_LDO_WIF0); -+ LDO_SetVoltLevel(LDO_LDO_WIF0,LDO_VOLT_LEVEL1); -+ -+#ifdef CONFIG_WIF1_LDO -+ DBG_8192C("%s: turn on VDD-WIFI1 1.2V\n", __func__); -+ LDO_TurnOnLDO(LDO_LDO_WIF1); -+ LDO_SetVoltLevel(LDO_LDO_WIF1,LDO_VOLT_LEVEL3); -+#endif //CONFIG_WIF1_LDO -+#endif -+ break; -+ -+ case WLAN_BT_PWDN_OFF: -+ DBG_8192C("%s: call customer specific GPIO to set bt power down pin to 0\n", -+ __FUNCTION__); -+#if defined(CONFIG_RTL8723B) -+ if (sprd_3rdparty_gpio_bt_reset > 0) -+ gpio_set_value(sprd_3rdparty_gpio_bt_reset, 0); -+#endif -+ break; -+ -+ case WLAN_BT_PWDN_ON: -+ DBG_8192C("%s: callc customer specific GPIO to set bt power down pin to 1\n", -+ __FUNCTION__); -+#if defined(CONFIG_RTL8723B) -+ if (sprd_3rdparty_gpio_bt_reset > 0) -+ gpio_set_value(sprd_3rdparty_gpio_bt_reset, 1); -+#endif -+ break; -+ } -+} -+#endif //ANDROID_2X -+ -+#elif defined(CONFIG_PLATFORM_ARM_RK3066) -+#include -+ -+#define GPIO_WIFI_IRQ RK30_PIN2_PC2 -+extern unsigned int oob_irq; -+int rtw_wifi_gpio_init(void) -+{ -+#ifdef CONFIG_GSPI_HCI -+ if (GPIO_WIFI_IRQ > 0) { -+ rk30_mux_api_set(GPIO2C2_LCDC1DATA18_SMCBLSN1_HSADCDATA5_NAME, GPIO2C_GPIO2C2);//jacky_test -+ gpio_request(GPIO_WIFI_IRQ, "oob_irq"); -+ gpio_direction_input(GPIO_WIFI_IRQ); -+ -+ oob_irq = gpio_to_irq(GPIO_WIFI_IRQ); -+ -+ DBG_8192C("%s oob_irq:%d\n", __func__, oob_irq); -+ } -+#endif -+ return 0; -+} -+ -+ -+int rtw_wifi_gpio_deinit(void) -+{ -+#ifdef CONFIG_GSPI_HCI -+ if (GPIO_WIFI_IRQ > 0) -+ gpio_free(GPIO_WIFI_IRQ); -+#endif -+ return 0; -+} -+ -+void rtw_wifi_gpio_wlan_ctrl(int onoff) -+{ -+} -+ -+#ifdef CONFIG_GPIO_API -+//this is a demo for extending GPIO pin[7] as interrupt mode -+struct net_device * rtl_net; -+extern int rtw_register_gpio_interrupt(struct net_device *netdev, int gpio_num, void(*callback)(u8 level)); -+extern int rtw_disable_gpio_interrupt(struct net_device *netdev, int gpio_num); -+void gpio_int(u8 is_high) -+{ -+ DBG_8192C("%s level=%d\n",__func__, is_high); -+} -+int register_net_gpio_init(void) -+{ -+ rtl_net = dev_get_by_name(&init_net,"wlan0"); -+ if(!rtl_net) -+ { -+ DBG_871X_LEVEL(_drv_always_, "rtl_net init fail!\n"); -+ return -1; -+ } -+ return rtw_register_gpio_interrupt(rtl_net,7, gpio_int); -+} -+int unregister_net_gpio_init(void) -+{ -+ rtl_net = dev_get_by_name(&init_net,"wlan0"); -+ if(!rtl_net) -+ { -+ DBG_871X_LEVEL(_drv_always_, "rtl_net init fail!\n"); -+ return -1; -+ } -+ return rtw_disable_gpio_interrupt(rtl_net,7); -+} -+#endif -+ -+#else -+ +int rtw_wifi_gpio_init(void) +{ + return 0; @@ -343584,7029 +155951,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/custom_gpio_linux.c linux/3 +void rtw_wifi_gpio_wlan_ctrl(int onoff) +{ +} -+#endif //CONFIG_PLATFORM_SPRD -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_cfg80211.c linux/3rdparty/rtl8812au/os_dep/linux/ioctl_cfg80211.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_cfg80211.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/ioctl_cfg80211.c 2017-06-07 23:07:21.045690674 +0300 -@@ -0,0 +1,6798 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _IOCTL_CFG80211_C_ -+ -+#include -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) -+#define STATION_INFO_SIGNAL BIT(NL80211_STA_INFO_SIGNAL) -+#define STATION_INFO_TX_BITRATE BIT(NL80211_STA_INFO_TX_BITRATE) -+#define STATION_INFO_RX_PACKETS BIT(NL80211_STA_INFO_RX_PACKETS) -+#define STATION_INFO_TX_PACKETS BIT(NL80211_STA_INFO_TX_PACKETS) -+#define STATION_INFO_ASSOC_REQ_IES 0 -+#endif /* Linux kernel >= 4.0.0 */ -+ -+#include -+ -+#define RTW_MAX_MGMT_TX_CNT (8) -+#define RTW_MAX_MGMT_TX_MS_GAS (500) -+ -+#define RTW_SCAN_IE_LEN_MAX 2304 -+#define RTW_MAX_REMAIN_ON_CHANNEL_DURATION 5000 //ms -+#define RTW_MAX_NUM_PMKIDS 4 -+ -+#define RTW_CH_MAX_2G_CHANNEL 14 /* Max channel in 2G band */ -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ -+#ifndef WLAN_CIPHER_SUITE_SMS4 -+#define WLAN_CIPHER_SUITE_SMS4 0x00147201 -+#endif -+ -+#ifndef WLAN_AKM_SUITE_WAPI_PSK -+#define WLAN_AKM_SUITE_WAPI_PSK 0x000FAC04 -+#endif -+ -+#ifndef WLAN_AKM_SUITE_WAPI_CERT -+#define WLAN_AKM_SUITE_WAPI_CERT 0x000FAC12 -+#endif -+ -+#ifndef NL80211_WAPI_VERSION_1 -+#define NL80211_WAPI_VERSION_1 (1 << 2) -+#endif -+ -+#endif -+ -+#ifdef CONFIG_PLATFORM_ARM_SUN8I -+#define BUSY_TRAFFIC_SCAN_DENY_PERIOD 8000 -+#else -+#define BUSY_TRAFFIC_SCAN_DENY_PERIOD 12000 -+#endif -+ -+static const u32 rtw_cipher_suites[] = { -+ WLAN_CIPHER_SUITE_WEP40, -+ WLAN_CIPHER_SUITE_WEP104, -+ WLAN_CIPHER_SUITE_TKIP, -+ WLAN_CIPHER_SUITE_CCMP, -+#ifdef CONFIG_WAPI_SUPPORT -+ WLAN_CIPHER_SUITE_SMS4, -+#endif // CONFIG_WAPI_SUPPORT -+#ifdef CONFIG_IEEE80211W -+ WLAN_CIPHER_SUITE_AES_CMAC, -+#endif //CONFIG_IEEE80211W -+}; -+ -+#define RATETAB_ENT(_rate, _rateid, _flags) \ -+ { \ -+ .bitrate = (_rate), \ -+ .hw_value = (_rateid), \ -+ .flags = (_flags), \ -+ } -+ -+#define CHAN2G(_channel, _freq, _flags) { \ -+ .band = IEEE80211_BAND_2GHZ, \ -+ .center_freq = (_freq), \ -+ .hw_value = (_channel), \ -+ .flags = (_flags), \ -+ .max_antenna_gain = 0, \ -+ .max_power = 30, \ -+} -+ -+#define CHAN5G(_channel, _flags) { \ -+ .band = IEEE80211_BAND_5GHZ, \ -+ .center_freq = 5000 + (5 * (_channel)), \ -+ .hw_value = (_channel), \ -+ .flags = (_flags), \ -+ .max_antenna_gain = 0, \ -+ .max_power = 30, \ -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+/* if wowlan is not supported, kernel generate a disconnect at each suspend -+ * cf: /net/wireless/sysfs.c, so register a stub wowlan. -+ * Moreover wowlan has to be enabled via a the nl80211_set_wowlan callback. -+ * (from user space, e.g. iw phy0 wowlan enable) -+ */ -+static const struct wiphy_wowlan_support wowlan_stub = { -+ .flags = WIPHY_WOWLAN_ANY, -+ .n_patterns = 0, -+ .pattern_max_len = 0, -+ .pattern_min_len = 0, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) -+ .max_pkt_offset = 0, -+#endif -+}; -+#endif -+ -+static struct ieee80211_rate rtw_rates[] = { -+ RATETAB_ENT(10, 0x1, 0), -+ RATETAB_ENT(20, 0x2, 0), -+ RATETAB_ENT(55, 0x4, 0), -+ RATETAB_ENT(110, 0x8, 0), -+ RATETAB_ENT(60, 0x10, 0), -+ RATETAB_ENT(90, 0x20, 0), -+ RATETAB_ENT(120, 0x40, 0), -+ RATETAB_ENT(180, 0x80, 0), -+ RATETAB_ENT(240, 0x100, 0), -+ RATETAB_ENT(360, 0x200, 0), -+ RATETAB_ENT(480, 0x400, 0), -+ RATETAB_ENT(540, 0x800, 0), -+}; -+ -+#define rtw_a_rates (rtw_rates + 4) -+#define RTW_A_RATES_NUM 8 -+#define rtw_g_rates (rtw_rates + 0) -+#define RTW_G_RATES_NUM 12 -+ -+#define RTW_2G_CHANNELS_NUM 14 -+#define RTW_5G_CHANNELS_NUM 37 -+ -+static struct ieee80211_channel rtw_2ghz_channels[] = { -+ CHAN2G(1, 2412, 0), -+ CHAN2G(2, 2417, 0), -+ CHAN2G(3, 2422, 0), -+ CHAN2G(4, 2427, 0), -+ CHAN2G(5, 2432, 0), -+ CHAN2G(6, 2437, 0), -+ CHAN2G(7, 2442, 0), -+ CHAN2G(8, 2447, 0), -+ CHAN2G(9, 2452, 0), -+ CHAN2G(10, 2457, 0), -+ CHAN2G(11, 2462, 0), -+ CHAN2G(12, 2467, 0), -+ CHAN2G(13, 2472, 0), -+ CHAN2G(14, 2484, 0), -+}; -+ -+static struct ieee80211_channel rtw_5ghz_a_channels[] = { -+ CHAN5G(34, 0), CHAN5G(36, 0), -+ CHAN5G(38, 0), CHAN5G(40, 0), -+ CHAN5G(42, 0), CHAN5G(44, 0), -+ CHAN5G(46, 0), CHAN5G(48, 0), -+ CHAN5G(52, 0), CHAN5G(56, 0), -+ CHAN5G(60, 0), CHAN5G(64, 0), -+ CHAN5G(100, 0), CHAN5G(104, 0), -+ CHAN5G(108, 0), CHAN5G(112, 0), -+ CHAN5G(116, 0), CHAN5G(120, 0), -+ CHAN5G(124, 0), CHAN5G(128, 0), -+ CHAN5G(132, 0), CHAN5G(136, 0), -+ CHAN5G(140, 0), CHAN5G(149, 0), -+ CHAN5G(153, 0), CHAN5G(157, 0), -+ CHAN5G(161, 0), CHAN5G(165, 0), -+ CHAN5G(184, 0), CHAN5G(188, 0), -+ CHAN5G(192, 0), CHAN5G(196, 0), -+ CHAN5G(200, 0), CHAN5G(204, 0), -+ CHAN5G(208, 0), CHAN5G(212, 0), -+ CHAN5G(216, 0), -+}; -+ -+ -+void rtw_2g_channels_init(struct ieee80211_channel *channels) -+{ -+ _rtw_memcpy((void*)channels, (void*)rtw_2ghz_channels, -+ sizeof(struct ieee80211_channel)*RTW_2G_CHANNELS_NUM -+ ); -+} -+ -+void rtw_5g_channels_init(struct ieee80211_channel *channels) -+{ -+ _rtw_memcpy((void*)channels, (void*)rtw_5ghz_a_channels, -+ sizeof(struct ieee80211_channel)*RTW_5G_CHANNELS_NUM -+ ); -+} -+ -+void rtw_2g_rates_init(struct ieee80211_rate *rates) -+{ -+ _rtw_memcpy(rates, rtw_g_rates, -+ sizeof(struct ieee80211_rate)*RTW_G_RATES_NUM -+ ); -+} -+ -+void rtw_5g_rates_init(struct ieee80211_rate *rates) -+{ -+ _rtw_memcpy(rates, rtw_a_rates, -+ sizeof(struct ieee80211_rate)*RTW_A_RATES_NUM -+ ); -+} -+ -+struct ieee80211_supported_band *rtw_spt_band_alloc( -+ enum ieee80211_band band -+ ) -+{ -+ struct ieee80211_supported_band *spt_band = NULL; -+ int n_channels, n_bitrates; -+ -+ if(band == IEEE80211_BAND_2GHZ) -+ { -+ n_channels = RTW_2G_CHANNELS_NUM; -+ n_bitrates = RTW_G_RATES_NUM; -+ } -+ else if(band == IEEE80211_BAND_5GHZ) -+ { -+ n_channels = RTW_5G_CHANNELS_NUM; -+ n_bitrates = RTW_A_RATES_NUM; -+ } -+ else -+ { -+ goto exit; -+ } -+ -+ spt_band = (struct ieee80211_supported_band *)rtw_zmalloc( -+ sizeof(struct ieee80211_supported_band) -+ + sizeof(struct ieee80211_channel)*n_channels -+ + sizeof(struct ieee80211_rate)*n_bitrates -+ ); -+ if(!spt_band) -+ goto exit; -+ -+ spt_band->channels = (struct ieee80211_channel*)(((u8*)spt_band)+sizeof(struct ieee80211_supported_band)); -+ spt_band->bitrates= (struct ieee80211_rate*)(((u8*)spt_band->channels)+sizeof(struct ieee80211_channel)*n_channels); -+ spt_band->band = band; -+ spt_band->n_channels = n_channels; -+ spt_band->n_bitrates = n_bitrates; -+ -+ if(band == IEEE80211_BAND_2GHZ) -+ { -+ rtw_2g_channels_init(spt_band->channels); -+ rtw_2g_rates_init(spt_band->bitrates); -+ } -+ else if(band == IEEE80211_BAND_5GHZ) -+ { -+ rtw_5g_channels_init(spt_band->channels); -+ rtw_5g_rates_init(spt_band->bitrates); -+ } -+ -+ //spt_band.ht_cap -+ -+exit: -+ -+ return spt_band; -+} -+ -+void rtw_spt_band_free(struct ieee80211_supported_band *spt_band) -+{ -+ u32 size = 0; -+ -+ if(!spt_band) -+ return; -+ -+ if(spt_band->band == IEEE80211_BAND_2GHZ) -+ { -+ size = sizeof(struct ieee80211_supported_band) -+ + sizeof(struct ieee80211_channel)*RTW_2G_CHANNELS_NUM -+ + sizeof(struct ieee80211_rate)*RTW_G_RATES_NUM; -+ } -+ else if(spt_band->band == IEEE80211_BAND_5GHZ) -+ { -+ size = sizeof(struct ieee80211_supported_band) -+ + sizeof(struct ieee80211_channel)*RTW_5G_CHANNELS_NUM -+ + sizeof(struct ieee80211_rate)*RTW_A_RATES_NUM; -+ } -+ else -+ { -+ -+ } -+ rtw_mfree((u8*)spt_band, size); -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+static const struct ieee80211_txrx_stypes -+rtw_cfg80211_default_mgmt_stypes[NUM_NL80211_IFTYPES] = { -+ [NL80211_IFTYPE_ADHOC] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+ [NL80211_IFTYPE_STATION] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) -+ }, -+ [NL80211_IFTYPE_AP] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | -+ BIT(IEEE80211_STYPE_DISASSOC >> 4) | -+ BIT(IEEE80211_STYPE_AUTH >> 4) | -+ BIT(IEEE80211_STYPE_DEAUTH >> 4) | -+ BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+ [NL80211_IFTYPE_AP_VLAN] = { -+ /* copy AP */ -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | -+ BIT(IEEE80211_STYPE_DISASSOC >> 4) | -+ BIT(IEEE80211_STYPE_AUTH >> 4) | -+ BIT(IEEE80211_STYPE_DEAUTH >> 4) | -+ BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+ [NL80211_IFTYPE_P2P_CLIENT] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) -+ }, -+ [NL80211_IFTYPE_P2P_GO] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | -+ BIT(IEEE80211_STYPE_DISASSOC >> 4) | -+ BIT(IEEE80211_STYPE_AUTH >> 4) | -+ BIT(IEEE80211_STYPE_DEAUTH >> 4) | -+ BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+}; -+#endif -+ -+static u64 rtw_get_systime_us(void) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,39)) -+ struct timespec ts; -+ get_monotonic_boottime(&ts); -+ return ((u64)ts.tv_sec*1000000) + ts.tv_nsec / 1000; -+#else -+ struct timeval tv; -+ do_gettimeofday(&tv); -+ return ((u64)tv.tv_sec*1000000) + tv.tv_usec; -+#endif -+} -+ -+#define MAX_BSSINFO_LEN 1000 -+struct cfg80211_bss *rtw_cfg80211_inform_bss(_adapter *padapter, struct wlan_network *pnetwork) -+{ -+ struct ieee80211_channel *notify_channel; -+ struct cfg80211_bss *bss = NULL; -+ //struct ieee80211_supported_band *band; -+ u16 channel; -+ u32 freq; -+ u64 notify_timestamp; -+ u16 notify_capability; -+ u16 notify_interval; -+ u8 *notify_ie; -+ size_t notify_ielen; -+ s32 notify_signal; -+ //u8 buf[MAX_BSSINFO_LEN]; -+ -+ u8 *pbuf; -+ size_t buf_size = MAX_BSSINFO_LEN; -+ size_t len,bssinf_len=0; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ struct wireless_dev *wdev = padapter->rtw_wdev; -+ struct wiphy *wiphy = wdev->wiphy; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ pbuf = rtw_zmalloc(buf_size); -+ if(pbuf == NULL){ -+ DBG_871X("%s pbuf allocate failed !! \n",__FUNCTION__); -+ return bss; -+ } -+ -+ //DBG_8192C("%s\n", __func__); -+ -+ bssinf_len = pnetwork->network.IELength+sizeof (struct rtw_ieee80211_hdr_3addr); -+ if(bssinf_len > buf_size){ -+ DBG_871X("%s IE Length too long > %zu byte \n",__FUNCTION__,buf_size); -+ goto exit; -+ } -+ -+#ifndef CONFIG_WAPI_SUPPORT -+ { -+ u16 wapi_len = 0; -+ -+ if(rtw_get_wapi_ie(pnetwork->network.IEs, pnetwork->network.IELength, NULL, &wapi_len)>0) -+ { -+ if(wapi_len > 0) -+ { -+ DBG_871X("%s, no support wapi!\n",__FUNCTION__); -+ goto exit; -+ } -+ } -+ } -+#endif //!CONFIG_WAPI_SUPPORT -+ -+ //To reduce PBC Overlap rate -+ //_enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ if(adapter_wdev_data(padapter)->scan_request != NULL) -+ { -+ u8 *psr=NULL, sr = 0; -+ NDIS_802_11_SSID *pssid = &pnetwork->network.Ssid; -+ struct cfg80211_scan_request *request = adapter_wdev_data(padapter)->scan_request; -+ struct cfg80211_ssid *ssids = request->ssids; -+ u32 wpsielen=0; -+ u8 *wpsie=NULL; -+ -+ wpsie = rtw_get_wps_ie(pnetwork->network.IEs+_FIXED_IE_LENGTH_, pnetwork->network.IELength-_FIXED_IE_LENGTH_, NULL, &wpsielen); -+ -+ if(wpsie && wpsielen>0) -+ psr = rtw_get_wps_attr_content(wpsie, wpsielen, WPS_ATTR_SELECTED_REGISTRAR, (u8*)(&sr), NULL); -+ -+ if (sr != 0) -+ { -+ if(request->n_ssids == 1 && request->n_channels == 1) // it means under processing WPS -+ { -+ DBG_8192C("ssid=%s, len=%d\n", pssid->Ssid, pssid->SsidLength); -+ -+ if (ssids[0].ssid_len == 0) { -+ } -+ else if(pssid->SsidLength == ssids[0].ssid_len && -+ _rtw_memcmp(pssid->Ssid, ssids[0].ssid, ssids[0].ssid_len)) -+ { -+ DBG_871X("%s, got sr and ssid match!\n", __func__); -+ } -+ else -+ { -+ if(psr !=NULL) -+ *psr = 0; //clear sr -+ -+#if 0 -+ WLAN_BSSID_EX *pselect_network = &pnetwork->network; -+ struct cfg80211_bss *pselect_bss = NULL; -+ struct ieee80211_channel *notify_channel = NULL; -+ u32 freq; -+ -+ DBG_871X("%s, got sr, but ssid mismatch, to remove this bss\n", __func__); -+ -+ freq = rtw_ch2freq(pselect_network->Configuration.DSConfig); -+ notify_channel = ieee80211_get_channel(wiphy, freq); -+ pselect_bss = cfg80211_get_bss(wiphy, NULL/*notify_channel*/, -+ pselect_network->MacAddress, pselect_network->Ssid.Ssid, -+ pselect_network->Ssid.SsidLength, 0/*WLAN_CAPABILITY_ESS*/, -+ 0/*WLAN_CAPABILITY_ESS*/); -+ -+ if(pselect_bss) -+ { -+ DBG_871X("%s, got bss for cfg80211 for unlinking bss\n", __func__); -+ -+ cfg80211_unlink_bss(wiphy, pselect_bss); -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0) -+ cfg80211_put_bss(wiphy, pselect_bss); -+#else -+ cfg80211_put_bss(pselect_bss); -+#endif -+ -+ } -+ -+ goto exit; -+#endif -+ } -+ } -+ } -+ } -+ //_exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ -+ -+ channel = pnetwork->network.Configuration.DSConfig; -+ freq = rtw_ch2freq(channel); -+ notify_channel = ieee80211_get_channel(wiphy, freq); -+ -+ if (0) -+ notify_timestamp = le64_to_cpu(*(u64*)rtw_get_timestampe_from_ie(pnetwork->network.IEs)); -+ else -+ notify_timestamp = rtw_get_systime_us(); -+ -+ notify_interval = le16_to_cpu(*(u16*)rtw_get_beacon_interval_from_ie(pnetwork->network.IEs)); -+ notify_capability = le16_to_cpu(*(u16*)rtw_get_capability_from_ie(pnetwork->network.IEs)); -+ -+ notify_ie = pnetwork->network.IEs+_FIXED_IE_LENGTH_; -+ notify_ielen = pnetwork->network.IELength-_FIXED_IE_LENGTH_; -+ -+ //We've set wiphy's signal_type as CFG80211_SIGNAL_TYPE_MBM: signal strength in mBm (100*dBm) -+ if ( check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE && -+ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { -+ notify_signal = 100*translate_percentage_to_dbm(padapter->recvpriv.signal_strength);//dbm -+ } else { -+ notify_signal = 100*translate_percentage_to_dbm(pnetwork->network.PhyInfo.SignalStrength);//dbm -+ } -+ -+ #if 0 -+ DBG_8192C("bssid: "MAC_FMT"\n", MAC_ARG(pnetwork->network.MacAddress)); -+ DBG_8192C("Channel: %d(%d)\n", channel, freq); -+ DBG_8192C("Capability: %X\n", notify_capability); -+ DBG_8192C("Beacon interval: %d\n", notify_interval); -+ DBG_8192C("Signal: %d\n", notify_signal); -+ DBG_8192C("notify_timestamp: %llu\n", notify_timestamp); -+ #endif -+ -+ //pbuf = buf; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pbuf; -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ //pmlmeext->mgnt_seq++; -+ -+ if (pnetwork->network.Reserved[0] == 1) { // WIFI_BEACON -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ SetFrameSubType(pbuf, WIFI_BEACON); -+ } else { -+ _rtw_memcpy(pwlanhdr->addr1, adapter_mac_addr(padapter), ETH_ALEN); -+ SetFrameSubType(pbuf, WIFI_PROBERSP); -+ } -+ -+ _rtw_memcpy(pwlanhdr->addr2, pnetwork->network.MacAddress, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pnetwork->network.MacAddress, ETH_ALEN); -+ -+ -+ //pbuf += sizeof(struct rtw_ieee80211_hdr_3addr); -+ len = sizeof (struct rtw_ieee80211_hdr_3addr); -+ _rtw_memcpy((pbuf+len), pnetwork->network.IEs, pnetwork->network.IELength); -+ *((u64*)(pbuf+len)) = cpu_to_le64(notify_timestamp); -+ -+ len += pnetwork->network.IELength; -+ -+ //#ifdef CONFIG_P2P -+ //if(rtw_get_p2p_ie(pnetwork->network.IEs+12, pnetwork->network.IELength-12, NULL, NULL)) -+ //{ -+ // DBG_8192C("%s, got p2p_ie\n", __func__); -+ //} -+ //#endif -+ -+#if 1 -+ bss = cfg80211_inform_bss_frame(wiphy, notify_channel, (struct ieee80211_mgmt *)pbuf, -+ len, notify_signal, GFP_ATOMIC); -+#else -+ -+ bss = cfg80211_inform_bss(wiphy, notify_channel, (const u8 *)pnetwork->network.MacAddress, -+ notify_timestamp, notify_capability, notify_interval, notify_ie, -+ notify_ielen, notify_signal, GFP_ATOMIC/*GFP_KERNEL*/); -+#endif -+ -+ if (unlikely(!bss)) { -+ DBG_8192C(FUNC_ADPT_FMT" bss NULL\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38)) -+#ifndef COMPAT_KERNEL_RELEASE -+ //patch for cfg80211, update beacon ies to information_elements -+ if (pnetwork->network.Reserved[0] == 1) { // WIFI_BEACON -+ -+ if(bss->len_information_elements != bss->len_beacon_ies) -+ { -+ bss->information_elements = bss->beacon_ies; -+ bss->len_information_elements = bss->len_beacon_ies; -+ } -+ } -+#endif //COMPAT_KERNEL_RELEASE -+#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38) -+ -+/* -+ { -+ if( bss->information_elements == bss->proberesp_ies) -+ { -+ if( bss->len_information_elements != bss->len_proberesp_ies) -+ { -+ DBG_8192C("error!, len_information_elements != bss->len_proberesp_ies\n"); -+ } -+ -+ } -+ else if(bss->len_information_elements < bss->len_beacon_ies) -+ { -+ bss->information_elements = bss->beacon_ies; -+ bss->len_information_elements = bss->len_beacon_ies; -+ } -+ } -+*/ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0) -+ cfg80211_put_bss(wiphy, bss); -+#else -+ cfg80211_put_bss(bss); -+#endif -+ -+exit: -+ if(pbuf) -+ rtw_mfree(pbuf, buf_size); -+ return bss; -+ -+} -+ -+/* -+ Check the given bss is valid by kernel API cfg80211_get_bss() -+ @padapter : the given adapter -+ -+ return _TRUE if bss is valid, _FALSE for not found. -+*/ -+int rtw_cfg80211_check_bss(_adapter *padapter) -+{ -+ WLAN_BSSID_EX *pnetwork = &(padapter->mlmeextpriv.mlmext_info.network); -+ struct cfg80211_bss *bss = NULL; -+ struct ieee80211_channel *notify_channel = NULL; -+ u32 freq; -+ -+ if (!(pnetwork) || !(padapter->rtw_wdev)) -+ return _FALSE; -+ -+ freq = rtw_ch2freq(pnetwork->Configuration.DSConfig); -+ notify_channel = ieee80211_get_channel(padapter->rtw_wdev->wiphy, freq); -+ bss = cfg80211_get_bss(padapter->rtw_wdev->wiphy, notify_channel, -+ pnetwork->MacAddress, pnetwork->Ssid.Ssid, -+ pnetwork->Ssid.SsidLength, -+ WLAN_CAPABILITY_ESS, WLAN_CAPABILITY_ESS); -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0) -+ cfg80211_put_bss(padapter->rtw_wdev->wiphy, bss); -+#else -+ cfg80211_put_bss(bss); -+#endif -+ -+ return (bss!=NULL); -+} -+ -+void rtw_cfg80211_ibss_indicate_connect(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct cfg80211_bss *bss = NULL; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) -+ struct wiphy *wiphy = pwdev->wiphy; -+ int freq = 2412; -+ struct ieee80211_channel *notify_channel; -+#endif -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) -+ freq = rtw_ch2freq(cur_network->network.Configuration.DSConfig); -+ -+ if (0) -+ DBG_871X("chan: %d, freq: %d\n", cur_network->network.Configuration.DSConfig, freq); -+#endif -+ -+ if (pwdev->iftype != NL80211_IFTYPE_ADHOC) -+ { -+ return; -+ } -+ -+ if (!rtw_cfg80211_check_bss(padapter)) { -+ WLAN_BSSID_EX *pnetwork = &(padapter->mlmeextpriv.mlmext_info.network); -+ struct wlan_network *scanned = pmlmepriv->cur_network_scanned; -+ -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)==_TRUE) -+ { -+ -+ _rtw_memcpy(&cur_network->network, pnetwork, sizeof(WLAN_BSSID_EX)); -+ if(cur_network) -+ { -+ if (!rtw_cfg80211_inform_bss(padapter,cur_network)) -+ DBG_871X(FUNC_ADPT_FMT" inform fail !!\n", FUNC_ADPT_ARG(padapter)); -+ else -+ DBG_871X(FUNC_ADPT_FMT" inform success !!\n", FUNC_ADPT_ARG(padapter)); -+ } -+ else -+ { -+ DBG_871X("cur_network is not exist!!!\n"); -+ return ; -+ } -+ } -+ else -+ { -+ if(scanned == NULL) -+ rtw_warn_on(1); -+ -+ if (_rtw_memcmp(&(scanned->network.Ssid), &(pnetwork->Ssid), sizeof(NDIS_802_11_SSID)) == _TRUE -+ && _rtw_memcmp(scanned->network.MacAddress, pnetwork->MacAddress, sizeof(NDIS_802_11_MAC_ADDRESS)) == _TRUE -+ ) { -+ if (!rtw_cfg80211_inform_bss(padapter,scanned)) { -+ DBG_871X(FUNC_ADPT_FMT" inform fail !!\n", FUNC_ADPT_ARG(padapter)); -+ } else { -+ //DBG_871X(FUNC_ADPT_FMT" inform success !!\n", FUNC_ADPT_ARG(padapter)); -+ } -+ } else { -+ DBG_871X("scanned & pnetwork compare fail\n"); -+ rtw_warn_on(1); -+ } -+ } -+ -+ if (!rtw_cfg80211_check_bss(padapter)) -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" BSS not found !!\n", FUNC_ADPT_ARG(padapter)); -+ } -+ //notify cfg80211 that device joined an IBSS -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) -+ notify_channel = ieee80211_get_channel(wiphy, freq); -+ cfg80211_ibss_joined(padapter->pnetdev, cur_network->network.MacAddress, notify_channel, GFP_ATOMIC); -+#else -+ cfg80211_ibss_joined(padapter->pnetdev, cur_network->network.MacAddress, GFP_ATOMIC); -+#endif -+} -+ -+void rtw_cfg80211_indicate_connect(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif -+ struct cfg80211_bss *bss = NULL; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ if (pwdev->iftype != NL80211_IFTYPE_STATION -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ && pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT -+ #endif -+ ) { -+ return; -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ return; -+ -+#ifdef CONFIG_P2P -+ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ DBG_8192C("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), rtw_p2p_pre_state(pwdinfo)); -+ } -+ } -+#endif //CONFIG_P2P -+ -+ { -+ WLAN_BSSID_EX *pnetwork = &(padapter->mlmeextpriv.mlmext_info.network); -+ struct wlan_network *scanned = pmlmepriv->cur_network_scanned; -+ -+ //DBG_871X(FUNC_ADPT_FMT" BSS not found\n", FUNC_ADPT_ARG(padapter)); -+ -+ if(scanned == NULL) { -+ rtw_warn_on(1); -+ goto check_bss; -+ } -+ -+ if (_rtw_memcmp(scanned->network.MacAddress, pnetwork->MacAddress, sizeof(NDIS_802_11_MAC_ADDRESS)) == _TRUE -+ && _rtw_memcmp(&(scanned->network.Ssid), &(pnetwork->Ssid), sizeof(NDIS_802_11_SSID)) == _TRUE -+ ) { -+ if (!rtw_cfg80211_inform_bss(padapter,scanned)) { -+ DBG_871X(FUNC_ADPT_FMT" inform fail !!\n", FUNC_ADPT_ARG(padapter)); -+ } else { -+ //DBG_871X(FUNC_ADPT_FMT" inform success !!\n", FUNC_ADPT_ARG(padapter)); -+ } -+ } else { -+ DBG_871X("scanned: %s("MAC_FMT"), cur: %s("MAC_FMT")\n", -+ scanned->network.Ssid.Ssid, MAC_ARG(scanned->network.MacAddress), -+ pnetwork->Ssid.Ssid, MAC_ARG(pnetwork->MacAddress) -+ ); -+ rtw_warn_on(1); -+ } -+ } -+ -+check_bss: -+ if (!rtw_cfg80211_check_bss(padapter)) -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" BSS not found !!\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (rtw_to_roam(padapter) > 0) { -+ #if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 39) || defined(COMPAT_KERNEL_RELEASE) -+ struct wiphy *wiphy = pwdev->wiphy; -+ struct ieee80211_channel *notify_channel; -+ u32 freq; -+ u16 channel = cur_network->network.Configuration.DSConfig; -+ -+ freq = rtw_ch2freq(channel); -+ notify_channel = ieee80211_get_channel(wiphy, freq); -+ #endif -+ -+ DBG_871X(FUNC_ADPT_FMT" call cfg80211_roamed\n", FUNC_ADPT_ARG(padapter)); -+ cfg80211_roamed(padapter->pnetdev -+ #if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 39) || defined(COMPAT_KERNEL_RELEASE) -+ , notify_channel -+ #endif -+ , cur_network->network.MacAddress -+ , pmlmepriv->assoc_req+sizeof(struct rtw_ieee80211_hdr_3addr)+2 -+ , pmlmepriv->assoc_req_len-sizeof(struct rtw_ieee80211_hdr_3addr)-2 -+ , pmlmepriv->assoc_rsp+sizeof(struct rtw_ieee80211_hdr_3addr)+6 -+ , pmlmepriv->assoc_rsp_len-sizeof(struct rtw_ieee80211_hdr_3addr)-6 -+ , GFP_ATOMIC); -+ } -+ else -+ { -+ #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) || defined(COMPAT_KERNEL_RELEASE) -+ DBG_8192C("pwdev->sme_state(b)=%d\n", pwdev->sme_state); -+ #endif -+ cfg80211_connect_result(padapter->pnetdev, cur_network->network.MacAddress -+ , pmlmepriv->assoc_req+sizeof(struct rtw_ieee80211_hdr_3addr)+2 -+ , pmlmepriv->assoc_req_len-sizeof(struct rtw_ieee80211_hdr_3addr)-2 -+ , pmlmepriv->assoc_rsp+sizeof(struct rtw_ieee80211_hdr_3addr)+6 -+ , pmlmepriv->assoc_rsp_len-sizeof(struct rtw_ieee80211_hdr_3addr)-6 -+ , WLAN_STATUS_SUCCESS, GFP_ATOMIC); -+ #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) || defined(COMPAT_KERNEL_RELEASE) -+ DBG_8192C("pwdev->sme_state(a)=%d\n", pwdev->sme_state); -+ #endif -+ } -+} -+ -+void rtw_cfg80211_indicate_disconnect(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (pwdev->iftype != NL80211_IFTYPE_STATION -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ && pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT -+ #endif -+ ) { -+ return; -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ return; -+ -+#ifdef CONFIG_P2P -+ if( pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ -+ DBG_8192C("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), rtw_p2p_pre_state(pwdinfo)); -+ } -+ } -+#endif //CONFIG_P2P -+ -+ if (!padapter->mlmepriv.not_indic_disco || padapter->ndev_unregistering) { -+ #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) || defined(COMPAT_KERNEL_RELEASE) -+ DBG_8192C("pwdev->sme_state(b)=%d\n", pwdev->sme_state); -+ -+ if(pwdev->sme_state==CFG80211_SME_CONNECTING) -+ cfg80211_connect_result(padapter->pnetdev, NULL, NULL, 0, NULL, 0, -+ WLAN_STATUS_UNSPECIFIED_FAILURE, GFP_ATOMIC/*GFP_KERNEL*/); -+ else if(pwdev->sme_state==CFG80211_SME_CONNECTED) -+ cfg80211_disconnected(padapter->pnetdev, 0, NULL, 0, GFP_ATOMIC); -+ //else -+ //DBG_8192C("pwdev->sme_state=%d\n", pwdev->sme_state); -+ -+ DBG_8192C("pwdev->sme_state(a)=%d\n", pwdev->sme_state); -+ #else -+ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0)) -+ u8 locally_generated = 1; -+ DBG_871X(FUNC_ADPT_FMT" call cfg80211_disconnected\n", FUNC_ADPT_ARG(padapter)); -+ cfg80211_disconnected(padapter->pnetdev, 0, NULL, 0, locally_generated, GFP_ATOMIC); -+#else -+ DBG_871X(FUNC_ADPT_FMT" call cfg80211_disconnected\n", FUNC_ADPT_ARG(padapter)); -+ cfg80211_disconnected(padapter->pnetdev, 0, NULL, 0, GFP_ATOMIC); -+#endif -+ } else { -+ DBG_871X(FUNC_ADPT_FMT" call cfg80211_connect_result\n", FUNC_ADPT_ARG(padapter)); -+ cfg80211_connect_result(padapter->pnetdev, NULL, NULL, 0, NULL, 0, -+ WLAN_STATUS_UNSPECIFIED_FAILURE, GFP_ATOMIC); -+ } -+ #endif -+ } -+} -+ -+ -+#ifdef CONFIG_AP_MODE -+static int rtw_cfg80211_ap_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len,wep_total_len; -+ struct sta_info *psta = NULL, *pbcmc_sta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_8192C("%s\n", __FUNCTION__); -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ //sizeof(struct ieee_param) = 64 bytes; -+ //if (param_len != (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) -+ if (param_len != sizeof(struct ieee_param) + param->u.crypt.key_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ if (param->u.crypt.idx >= WEP_KEYS -+#ifdef CONFIG_IEEE80211W -+ && param->u.crypt.idx > BIP_MAX_KEYID -+#endif /* CONFIG_IEEE80211W */ -+ ) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ else -+ { -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if(!psta) -+ { -+ //ret = -EINVAL; -+ DBG_8192C("rtw_set_encryption(), sta has already been removed or never been added\n"); -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "none") == 0 && (psta==NULL)) -+ { -+ //todo:clear default encryption keys -+ -+ DBG_8192C("clear default encryption keys, keyid=%d\n", param->u.crypt.idx); -+ -+ goto exit; -+ } -+ -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0 && (psta==NULL)) -+ { -+ DBG_8192C("r871x_set_encryption, crypt.alg = WEP\n"); -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ DBG_8192C("r871x_set_encryption, wep_key_idx=%d, len=%d\n", wep_key_idx, wep_key_len); -+ -+ if((wep_key_idx >= WEP_KEYS) || (wep_key_len<=0)) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (wep_key_len > 0) -+ { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ } -+ -+ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) -+ { -+ //wep default key has not been set, so use this key index as default key. -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ psecuritypriv->dot11PrivacyAlgrthm=_WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy=_WEP40_; -+ -+ if(wep_key_len == 13) -+ { -+ psecuritypriv->dot11PrivacyAlgrthm=_WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy=_WEP104_; -+ } -+ -+ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; -+ } -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; -+ -+ rtw_ap_set_wep_key(padapter, param->u.crypt.key, wep_key_len, wep_key_idx, 1); -+ -+ goto exit; -+ -+ } -+ -+ -+ if(!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) // //group key -+ { -+ if(param->u.crypt.set_tx == 0) //group key -+ { -+ if(strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ DBG_8192C("%s, set group_key, WEP\n", __FUNCTION__); -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if(param->u.crypt.key_len==13) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ } -+ else if(strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ DBG_8192C("%s, set group_key, TKIP\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); -+ //set mic key -+ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = _TRUE; -+ -+ } -+ else if(strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ DBG_8192C("%s, set group_key, CCMP\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ } -+#ifdef CONFIG_IEEE80211W -+ else if (strcmp(param->u.crypt.alg, "BIP") == 0) { -+ int no; -+ -+ DBG_871X("BIP key_len=%d , index=%d\n", param->u.crypt.key_len, param->u.crypt.idx); -+ /* save the IGTK key, length 16 bytes */ -+ _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16:param->u.crypt.key_len)); -+ /* DBG_871X("IGTK key below:\n"); -+ for(no=0;no<16;no++) -+ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); -+ DBG_871X("\n"); */ -+ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; -+ padapter->securitypriv.binstallBIPkey = _TRUE; -+ DBG_871X(" ~~~~set sta key:IGKT\n"); -+ goto exit; -+ } -+#endif /* CONFIG_IEEE80211W */ -+ else -+ { -+ DBG_8192C("%s, set group_key, none\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = _TRUE; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;//!!! -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta=rtw_get_bcmc_stainfo(padapter); -+ if(pbcmc_sta) -+ { -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy -+ } -+ -+ } -+ -+ goto exit; -+ -+ } -+ -+ if(psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) // psk/802_1x -+ { -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ { -+ if(param->u.crypt.set_tx ==1) //pairwise key -+ { -+ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ if(strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ DBG_8192C("%s, set pairwise key, WEP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _WEP40_; -+ if(param->u.crypt.key_len==13) -+ { -+ psta->dot118021XPrivacy = _WEP104_; -+ } -+ } -+ else if(strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ DBG_8192C("%s, set pairwise key, TKIP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _TKIP_; -+ -+ //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); -+ //set mic key -+ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = _TRUE; -+ -+ } -+ else if(strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ -+ DBG_8192C("%s, set pairwise key, CCMP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _AES_; -+ } -+ else -+ { -+ DBG_8192C("%s, set pairwise key, none\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _NO_PRIVACY_; -+ } -+ -+ rtw_ap_set_pairwise_key(padapter, psta); -+ -+ psta->ieee8021x_blocked = _FALSE; -+ -+ psta->bpairwise_key_installed = _TRUE; -+ -+ } -+ else//group key??? -+ { -+ if(strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if(param->u.crypt.key_len==13) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ } -+ else if(strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); -+ //set mic key -+ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = _TRUE; -+ -+ } -+ else if(strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ } -+ else -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = _TRUE; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;//!!! -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta=rtw_get_bcmc_stainfo(padapter); -+ if(pbcmc_sta) -+ { -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy -+ } -+ -+ } -+ -+ } -+ -+ } -+ -+exit: -+ -+ return ret; -+ -+} -+#endif -+ -+static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len,wep_total_len; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info* pwdinfo = &padapter->wdinfo; -+#endif //CONFIG_P2P -+ -+_func_enter_; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ if (param_len < (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ if (param->u.crypt.idx >= WEP_KEYS -+#ifdef CONFIG_IEEE80211W -+ && param->u.crypt.idx > BIP_MAX_KEYID -+#endif //CONFIG_IEEE80211W -+ ) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } else { -+#ifdef CONFIG_WAPI_SUPPORT -+ if (strcmp(param->u.crypt.alg, "SMS4")) -+#endif -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("wpa_set_encryption, crypt.alg = WEP\n")); -+ DBG_8192C("wpa_set_encryption, crypt.alg = WEP\n"); -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ if ((wep_key_idx > WEP_KEYS) || (wep_key_len <= 0)) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) -+ { -+ //wep default key has not been set, so use this key index as default key. -+ -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ -+ if(wep_key_len==13) -+ { -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; -+ } -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; -+ -+ rtw_set_key(padapter, psecuritypriv, wep_key_idx, 0, _TRUE); -+ -+ goto exit; -+ } -+ -+ if(padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) // 802_1x -+ { -+ struct sta_info * psta,*pbcmc_sta; -+ struct sta_priv * pstapriv = &padapter->stapriv; -+ -+ //DBG_8192C("%s, : dot11AuthAlgrthm == dot11AuthAlgrthm_8021X \n", __func__); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == _TRUE) //sta mode -+ { -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ //DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail \n")); -+ DBG_8192C("%s, : Obtain Sta_info fail \n", __func__); -+ } -+ else -+ { -+ //Jeff: don't disable ieee8021x_blocked while clearing key -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ psta->ieee8021x_blocked = _FALSE; -+ -+ -+ if((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ { -+ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ -+ if(param->u.crypt.set_tx ==1)//pairwise key -+ { -+ -+ DBG_8192C("%s, : param->u.crypt.set_tx ==1 \n", __func__); -+ -+ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ if(strcmp(param->u.crypt.alg, "TKIP") == 0)//set mic key -+ { -+ //DEBUG_ERR(("\nset key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); -+ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ padapter->securitypriv.busetkipkey=_FALSE; -+ //_set_timer(&padapter->securitypriv.tkip_timer, 50); -+ } -+ psta->bpairwise_key_installed = _TRUE; -+ //DEBUG_ERR((" param->u.crypt.key_len=%d\n",param->u.crypt.key_len)); -+ DBG_871X(" ~~~~set sta key:unicastkey\n"); -+ -+ rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _TRUE); -+ } -+ else//group key -+ { -+ if(strcmp(param->u.crypt.alg, "TKIP") == 0 || strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key,(param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[16]),8); -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[24]),8); -+ padapter->securitypriv.binstallGrpkey = _TRUE; -+ //DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); -+ DBG_871X(" ~~~~set sta key:groupkey\n"); -+ -+ padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; -+ rtw_set_key(padapter,&padapter->securitypriv,param->u.crypt.idx, 1, _TRUE); -+ } -+#ifdef CONFIG_IEEE80211W -+ else if(strcmp(param->u.crypt.alg, "BIP") == 0) -+ { -+ int no; -+ //DBG_871X("BIP key_len=%d , index=%d @@@@@@@@@@@@@@@@@@\n", param->u.crypt.key_len, param->u.crypt.idx); -+ //save the IGTK key, length 16 bytes -+ _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key,(param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ /*DBG_871X("IGTK key below:\n"); -+ for(no=0;no<16;no++) -+ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); -+ DBG_871X("\n");*/ -+ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; -+ padapter->securitypriv.binstallBIPkey = _TRUE; -+ DBG_871X(" ~~~~set sta key:IGKT\n"); -+ } -+#endif //CONFIG_IEEE80211W -+ -+#ifdef CONFIG_P2P -+ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) -+ { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_DONE); -+ } -+ } -+#endif //CONFIG_P2P -+ -+ } -+ } -+ -+ pbcmc_sta=rtw_get_bcmc_stainfo(padapter); -+ if(pbcmc_sta==NULL) -+ { -+ //DEBUG_ERR( ("Set OID_802_11_ADD_KEY: bcmc stainfo is null \n")); -+ } -+ else -+ { -+ //Jeff: don't disable ieee8021x_blocked while clearing key -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ -+ if((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ { -+ pbcmc_sta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ } -+ } -+ else if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) //adhoc mode -+ { -+ } -+ } -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (strcmp(param->u.crypt.alg, "SMS4") == 0) -+ { -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_STA_INFO pWapiSta; -+ u8 WapiASUEPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ -+ if(param->u.crypt.set_tx == 1) -+ { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if(_rtw_memcmp(pWapiSta->PeerMacAddr,param->sta_addr,6)) -+ { -+ _rtw_memcpy(pWapiSta->lastTxUnicastPN,WapiASUEPNInitialValueSrc,16); -+ -+ pWapiSta->wapiUsk.bSet = true; -+ _rtw_memcpy(pWapiSta->wapiUsk.dataKey,param->u.crypt.key,16); -+ _rtw_memcpy(pWapiSta->wapiUsk.micKey,param->u.crypt.key+16,16); -+ pWapiSta->wapiUsk.keyId = param->u.crypt.idx ; -+ pWapiSta->wapiUsk.bTxEnable = true; -+ -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPN,WapiAEPNInitialValueSrc,16); -+ pWapiSta->wapiUskUpdate.bTxEnable = false; -+ pWapiSta->wapiUskUpdate.bSet = false; -+ -+ if (psecuritypriv->sw_encrypt== false || psecuritypriv->sw_decrypt == false) -+ { -+ //set unicast key for ASUE -+ rtw_wapi_set_key(padapter, &pWapiSta->wapiUsk, pWapiSta, false, false); -+ } -+ } -+ } -+ } -+ else -+ { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if(_rtw_memcmp(pWapiSta->PeerMacAddr,get_bssid(pmlmepriv),6)) -+ { -+ pWapiSta->wapiMsk.bSet = true; -+ _rtw_memcpy(pWapiSta->wapiMsk.dataKey,param->u.crypt.key,16); -+ _rtw_memcpy(pWapiSta->wapiMsk.micKey,param->u.crypt.key+16,16); -+ pWapiSta->wapiMsk.keyId = param->u.crypt.idx ; -+ pWapiSta->wapiMsk.bTxEnable = false; -+ if(!pWapiSta->bSetkeyOk) -+ pWapiSta->bSetkeyOk = true; -+ pWapiSta->bAuthenticateInProgress = false; -+ -+ _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); -+ -+ if (psecuritypriv->sw_decrypt == false) -+ { -+ //set rx broadcast key for ASUE -+ rtw_wapi_set_key(padapter, &pWapiSta->wapiMsk, pWapiSta, true, false); -+ } -+ } -+ -+ } -+ } -+ } -+#endif -+ -+ -+exit: -+ -+ DBG_8192C("%s, ret=%d\n", __func__, ret); -+ -+ _func_exit_; -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_add_key(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ u8 key_index, bool pairwise, const u8 *mac_addr, -+#else // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ u8 key_index, const u8 *mac_addr, -+#endif // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ struct key_params *params) -+{ -+ char *alg_name; -+ u32 param_len; -+ struct ieee_param *param = NULL; -+ int ret=0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct wireless_dev *rtw_wdev = padapter->rtw_wdev; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#ifdef CONFIG_TDLS -+ struct sta_info *ptdls_sta; -+#endif /* CONFIG_TDLS */ -+ -+ DBG_871X(FUNC_NDEV_FMT" adding key for %pM\n", FUNC_NDEV_ARG(ndev), mac_addr); -+ DBG_871X("cipher=0x%x\n", params->cipher); -+ DBG_871X("key_len=0x%x\n", params->key_len); -+ DBG_871X("seq_len=0x%x\n", params->seq_len); -+ DBG_871X("key_index=%d\n", key_index); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ DBG_871X("pairwise=%d\n", pairwise); -+#endif // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ -+ param_len = sizeof(struct ieee_param) + params->key_len; -+ param = (struct ieee_param *)rtw_malloc(param_len); -+ if (param == NULL) -+ return -1; -+ -+ _rtw_memset(param, 0, param_len); -+ -+ param->cmd = IEEE_CMD_SET_ENCRYPTION; -+ _rtw_memset(param->sta_addr, 0xff, ETH_ALEN); -+ -+ switch (params->cipher) { -+ case IW_AUTH_CIPHER_NONE: -+ //todo: remove key -+ //remove = 1; -+ alg_name = "none"; -+ break; -+ case WLAN_CIPHER_SUITE_WEP40: -+ case WLAN_CIPHER_SUITE_WEP104: -+ alg_name = "WEP"; -+ break; -+ case WLAN_CIPHER_SUITE_TKIP: -+ alg_name = "TKIP"; -+ break; -+ case WLAN_CIPHER_SUITE_CCMP: -+ alg_name = "CCMP"; -+ break; -+#ifdef CONFIG_IEEE80211W -+ case WLAN_CIPHER_SUITE_AES_CMAC: -+ alg_name = "BIP"; -+ break; -+#endif //CONFIG_IEEE80211W -+#ifdef CONFIG_WAPI_SUPPORT -+ case WLAN_CIPHER_SUITE_SMS4: -+ alg_name= "SMS4"; -+ if(pairwise == NL80211_KEYTYPE_PAIRWISE) { -+ if (key_index != 0 && key_index != 1) { -+ ret = -ENOTSUPP; -+ goto addkey_end; -+ } -+ _rtw_memcpy((void*)param->sta_addr, (void*)mac_addr, ETH_ALEN); -+ } else { -+ DBG_871X("mac_addr is null \n"); -+ } -+ DBG_871X("rtw_wx_set_enc_ext: SMS4 case \n"); -+ break; -+#endif -+ -+ default: -+ ret = -ENOTSUPP; -+ goto addkey_end; -+ } -+ -+ strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN); -+ -+ -+ if (!mac_addr || is_broadcast_ether_addr(mac_addr)) -+ { -+ param->u.crypt.set_tx = 0; //for wpa/wpa2 group key -+ } else { -+ param->u.crypt.set_tx = 1; //for wpa/wpa2 pairwise key -+ } -+ -+ -+ //param->u.crypt.idx = key_index - 1; -+ param->u.crypt.idx = key_index; -+ -+ if (params->seq_len && params->seq) -+ { -+ _rtw_memcpy(param->u.crypt.seq, (u8 *)params->seq, params->seq_len); -+ } -+ -+ if(params->key_len && params->key) -+ { -+ param->u.crypt.key_len = params->key_len; -+ _rtw_memcpy(param->u.crypt.key, (u8 *)params->key, params->key_len); -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ { -+#ifdef CONFIG_TDLS -+ if (rtw_tdls_is_driver_setup(padapter) == _FALSE && mac_addr) { -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, (void *)mac_addr); -+ if (ptdls_sta != NULL && ptdls_sta->tdls_sta_state) { -+ _rtw_memcpy(ptdls_sta->tpk.tk, params->key, params->key_len); -+ rtw_tdls_set_key(padapter, ptdls_sta); -+ goto addkey_end; -+ } -+ } -+#endif /* CONFIG_TDLS */ -+ -+ ret = rtw_cfg80211_set_encryption(ndev, param, param_len); -+ } -+ else if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ { -+#ifdef CONFIG_AP_MODE -+ if(mac_addr) -+ _rtw_memcpy(param->sta_addr, (void*)mac_addr, ETH_ALEN); -+ -+ ret = rtw_cfg80211_ap_set_encryption(ndev, param, param_len); -+#endif -+ } -+ else if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE -+ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) -+ { -+ //DBG_8192C("@@@@@@@@@@ fw_state=0x%x, iftype=%d\n", pmlmepriv->fw_state, rtw_wdev->iftype); -+ ret = rtw_cfg80211_set_encryption(ndev, param, param_len); -+ } -+ else -+ { -+ DBG_8192C("error! fw_state=0x%x, iftype=%d\n", pmlmepriv->fw_state, rtw_wdev->iftype); -+ -+ } -+ -+addkey_end: -+ if(param) -+ { -+ rtw_mfree((u8*)param, param_len); -+ } -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_get_key(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ u8 key_index, bool pairwise, const u8 *mac_addr, -+#else // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ u8 key_index, const u8 *mac_addr, -+#endif // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ void *cookie, -+ void (*callback)(void *cookie, -+ struct key_params*)) -+{ -+#if 0 -+ struct iwm_priv *iwm = ndev_to_iwm(ndev); -+ struct iwm_key *key = &iwm->keys[key_index]; -+ struct key_params params; -+ -+ IWM_DBG_WEXT(iwm, DBG, "Getting key %d\n", key_index); -+ -+ memset(¶ms, 0, sizeof(params)); -+ -+ params.cipher = key->cipher; -+ params.key_len = key->key_len; -+ params.seq_len = key->seq_len; -+ params.seq = key->seq; -+ params.key = key->key; -+ -+ callback(cookie, ¶ms); -+ -+ return key->key_len ? 0 : -ENOENT; -+#endif -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+static int cfg80211_rtw_del_key(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ u8 key_index, bool pairwise, const u8 *mac_addr) -+#else // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ u8 key_index, const u8 *mac_addr) -+#endif // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ DBG_871X(FUNC_NDEV_FMT" key_index=%d\n", FUNC_NDEV_ARG(ndev), key_index); -+ -+ if (key_index == psecuritypriv->dot11PrivacyKeyIndex) -+ { -+ //clear the flag of wep default key set. -+ psecuritypriv->bWepDefaultKeyIdxSet = 0; -+ } -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_set_default_key(struct wiphy *wiphy, -+ struct net_device *ndev, u8 key_index -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+ , bool unicast, bool multicast -+ #endif -+ ) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+#define SET_DEF_KEY_PARAM_FMT " key_index=%d" -+#define SET_DEF_KEY_PARAM_ARG , key_index -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) -+ #define SET_DEF_KEY_PARAM_FMT_2_6_38 ", unicast=%d, multicast=%d" -+ #define SET_DEF_KEY_PARAM_ARG_2_6_38 , unicast, multicast -+#else -+ #define SET_DEF_KEY_PARAM_FMT_2_6_38 "" -+ #define SET_DEF_KEY_PARAM_ARG_2_6_38 -+#endif -+ -+ DBG_871X(FUNC_NDEV_FMT -+ SET_DEF_KEY_PARAM_FMT -+ SET_DEF_KEY_PARAM_FMT_2_6_38 -+ "\n", FUNC_NDEV_ARG(ndev) -+ SET_DEF_KEY_PARAM_ARG -+ SET_DEF_KEY_PARAM_ARG_2_6_38 -+ ); -+ -+ if ((key_index < WEP_KEYS) && ((psecuritypriv->dot11PrivacyAlgrthm == _WEP40_) || (psecuritypriv->dot11PrivacyAlgrthm == _WEP104_))) //set wep default key -+ { -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+ psecuritypriv->dot11PrivacyKeyIndex = key_index; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if (psecuritypriv->dot11DefKeylen[key_index] == 13) -+ { -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ psecuritypriv->bWepDefaultKeyIdxSet = 1; //set the flag to represent that wep default key has been set -+ } -+ -+ return 0; -+ -+} -+#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 1, 0)) -+static int cfg80211_rtw_set_rekey_data(struct wiphy *wiphy, -+ struct net_device *ndev, -+ struct cfg80211_gtk_rekey_data *data) -+{ -+ /*int i;*/ -+ struct sta_info *psta; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ DBG_871X("%s, : Obtain Sta_info fail\n", __func__); -+ return -1; -+ } -+ -+ _rtw_memcpy(psta->kek, data->kek, NL80211_KEK_LEN); -+ /*printk("\ncfg80211_rtw_set_rekey_data KEK:"); -+ for(i=0;ikek[i]);*/ -+ _rtw_memcpy(psta->kck, data->kck, NL80211_KCK_LEN); -+ /*printk("\ncfg80211_rtw_set_rekey_data KCK:"); -+ for(i=0;ikck[i]);*/ -+ _rtw_memcpy(psta->replay_ctr, data->replay_ctr, NL80211_REPLAY_CTR_LEN); -+ psecuritypriv->binstallKCK_KEK = _TRUE; -+ /*printk("\nREPLAY_CTR: "); -+ for(i=0;ireplay_ctr[i]);*/ -+ -+ return 0; -+} -+#endif /*CONFIG_GTK_OL*/ -+static int cfg80211_rtw_get_station(struct wiphy *wiphy, -+ struct net_device *ndev, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,16,0)) -+ u8 *mac, -+#else -+ const u8 *mac, -+#endif -+ struct station_info *sinfo) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ sinfo->filled = 0; -+ -+ if (!mac) { -+ DBG_871X(FUNC_NDEV_FMT" mac==%p\n", FUNC_NDEV_ARG(ndev), mac); -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ psta = rtw_get_stainfo(pstapriv, (u8 *)mac); -+ if (psta == NULL) { -+ DBG_8192C("%s, sta_info is null\n", __func__); -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X(FUNC_NDEV_FMT" mac="MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(mac)); -+#endif -+ -+ //for infra./P2PClient mode -+ if( check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, _FW_LINKED) -+ ) -+ { -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ -+ if (_rtw_memcmp((u8 *)mac, cur_network->network.MacAddress, ETH_ALEN) == _FALSE) { -+ DBG_871X("%s, mismatch bssid="MAC_FMT"\n", __func__, MAC_ARG(cur_network->network.MacAddress)); -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ sinfo->filled |= STATION_INFO_SIGNAL; -+ sinfo->signal = translate_percentage_to_dbm(padapter->recvpriv.signal_strength); -+ -+ sinfo->filled |= STATION_INFO_TX_BITRATE; -+ sinfo->txrate.legacy = rtw_get_cur_max_rate(padapter); -+ -+ sinfo->filled |= STATION_INFO_RX_PACKETS; -+ sinfo->rx_packets = sta_rx_data_pkts(psta); -+ -+ sinfo->filled |= STATION_INFO_TX_PACKETS; -+ sinfo->tx_packets = psta->sta_stats.tx_pkts; -+ -+ } -+ -+ //for Ad-Hoc/AP mode -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) -+ ||check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) -+ ||check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ && check_fwstate(pmlmepriv, _FW_LINKED) -+ ) -+ { -+ //TODO: should acquire station info... -+ } -+ -+exit: -+ return ret; -+} -+ -+extern int netdev_open(struct net_device *pnetdev); -+#ifdef CONFIG_CONCURRENT_MODE -+extern int netdev_if2_open(struct net_device *pnetdev); -+#endif -+ -+/* -+enum nl80211_iftype { -+ NL80211_IFTYPE_UNSPECIFIED, -+ NL80211_IFTYPE_ADHOC, //1 -+ NL80211_IFTYPE_STATION, //2 -+ NL80211_IFTYPE_AP, //3 -+ NL80211_IFTYPE_AP_VLAN, -+ NL80211_IFTYPE_WDS, -+ NL80211_IFTYPE_MONITOR, //6 -+ NL80211_IFTYPE_MESH_POINT, -+ NL80211_IFTYPE_P2P_CLIENT, //8 -+ NL80211_IFTYPE_P2P_GO, //9 -+ //keep last -+ NUM_NL80211_IFTYPES, -+ NL80211_IFTYPE_MAX = NUM_NL80211_IFTYPES - 1 -+}; -+*/ -+static int cfg80211_rtw_change_iface(struct wiphy *wiphy, -+ struct net_device *ndev, -+ enum nl80211_iftype type, u32 *flags, -+ struct vif_params *params) -+{ -+ enum nl80211_iftype old_type; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct wireless_dev *rtw_wdev = padapter->rtw_wdev; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif -+ int ret = 0; -+ u8 change = _FALSE; -+ -+ DBG_871X(FUNC_NDEV_FMT" type=%d\n", FUNC_NDEV_ARG(ndev), type); -+ -+ if(adapter_to_dvobj(padapter)->processing_dev_remove == _TRUE) -+ { -+ ret= -EPERM; -+ goto exit; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->adapter_type == SECONDARY_ADAPTER) -+ { -+ DBG_871X(FUNC_NDEV_FMT" call netdev_if2_open\n", FUNC_NDEV_ARG(ndev)); -+ if(netdev_if2_open(ndev) != 0) { -+ DBG_871X(FUNC_NDEV_FMT" call netdev_if2_open fail\n", FUNC_NDEV_ARG(ndev)); -+ ret= -EPERM; -+ goto exit; -+ } -+ } -+ else if(padapter->adapter_type == PRIMARY_ADAPTER) -+#endif //CONFIG_CONCURRENT_MODE -+ { -+ DBG_871X(FUNC_NDEV_FMT" call netdev_open\n", FUNC_NDEV_ARG(ndev)); -+ if(netdev_open(ndev) != 0) { -+ DBG_871X(FUNC_NDEV_FMT" call netdev_open fail\n", FUNC_NDEV_ARG(ndev)); -+ ret= -EPERM; -+ goto exit; -+ } -+ } -+ -+ if(_FAIL == rtw_pwr_wakeup(padapter)) { -+ DBG_871X(FUNC_NDEV_FMT" call rtw_pwr_wakeup fail\n", FUNC_NDEV_ARG(ndev)); -+ ret= -EPERM; -+ goto exit; -+ } -+ -+ old_type = rtw_wdev->iftype; -+ DBG_871X(FUNC_NDEV_FMT" old_iftype=%d, new_iftype=%d\n", -+ FUNC_NDEV_ARG(ndev), old_type, type); -+ -+ if(old_type != type) -+ { -+ change = _TRUE; -+ pmlmeext->action_public_rxseq = 0xffff; -+ pmlmeext->action_public_dialog_token = 0xff; -+ } -+ -+ /* initial default type */ -+ ndev->type = ARPHRD_ETHER; -+ -+ switch (type) { -+ case NL80211_IFTYPE_ADHOC: -+ networkType = Ndis802_11IBSS; -+ break; -+#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE)) -+ case NL80211_IFTYPE_P2P_CLIENT: -+#endif -+ case NL80211_IFTYPE_STATION: -+ networkType = Ndis802_11Infrastructure; -+ #ifdef CONFIG_P2P -+ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(change && rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ //it means remove GO and change mode from AP(GO) to station(P2P DEVICE) -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ -+ DBG_8192C("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), rtw_p2p_pre_state(pwdinfo)); -+ } -+ } -+ #endif //CONFIG_P2P -+ break; -+#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE)) -+ case NL80211_IFTYPE_P2P_GO: -+#endif -+ case NL80211_IFTYPE_AP: -+ networkType = Ndis802_11APMode; -+ #ifdef CONFIG_P2P -+ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(change && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ //it means P2P Group created, we will be GO and change mode from P2P DEVICE to AP(GO) -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ } -+ } -+ #endif //CONFIG_P2P -+ break; -+ case NL80211_IFTYPE_MONITOR: -+ networkType = Ndis802_11Monitor; -+#if 0 -+ ndev->type = ARPHRD_IEEE80211; /* IEEE 802.11 : 801 */ -+#endif -+ ndev->type = ARPHRD_IEEE80211_RADIOTAP; /* IEEE 802.11 + radiotap header : 803 */ -+ break; -+ default: -+ ret = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+ rtw_wdev->iftype = type; -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, networkType) ==_FALSE) -+ { -+ rtw_wdev->iftype = old_type; -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ rtw_setopmode_cmd(padapter, networkType, _TRUE); -+ -+exit: -+ -+ DBG_871X(FUNC_NDEV_FMT" ret:%d\n", FUNC_NDEV_ARG(ndev), ret); -+ return ret; -+} -+ -+void rtw_cfg80211_indicate_scan_done(_adapter *adapter, bool aborted) -+{ -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); -+ _irqL irqL; -+ -+ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ if (pwdev_priv->scan_request != NULL) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("%s with scan req\n", __FUNCTION__); -+ #endif -+ -+ /* avoid WARN_ON(request != wiphy_to_dev(request->wiphy)->scan_req); */ -+ if(pwdev_priv->scan_request->wiphy != pwdev_priv->rtw_wdev->wiphy) -+ { -+ DBG_8192C("error wiphy compare\n"); -+ } -+ else -+ { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 8, 0)) -+ struct cfg80211_scan_info info = { .aborted = aborted }; -+ cfg80211_scan_done(pwdev_priv->scan_request, &info); -+#else -+ cfg80211_scan_done(pwdev_priv->scan_request, aborted); -+#endif -+ } -+ -+ pwdev_priv->scan_request = NULL; -+ } else { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("%s without scan req\n", __FUNCTION__); -+ #endif -+ } -+ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+} -+ -+u32 rtw_cfg80211_wait_scan_req_empty(_adapter *adapter, u32 timeout_ms) -+{ -+ struct rtw_wdev_priv *wdev_priv = adapter_wdev_data(adapter); -+ u8 empty = _FALSE; -+ u32 start; -+ u32 pass_ms; -+ -+ start = rtw_get_current_time(); -+ -+ while (rtw_get_passing_time_ms(start) <= timeout_ms) { -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ break; -+ -+ if (!wdev_priv->scan_request) { -+ empty = _TRUE; -+ break; -+ } -+ -+ rtw_msleep_os(10); -+ } -+ -+ pass_ms = rtw_get_passing_time_ms(start); -+ -+ if (empty == _FALSE && pass_ms > timeout_ms) -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" pass_ms:%u, timeout\n" -+ , FUNC_ADPT_ARG(adapter), pass_ms); -+ -+ return pass_ms; -+} -+ -+void rtw_cfg80211_unlink_bss(_adapter *padapter, struct wlan_network *pnetwork) -+{ -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct wiphy *wiphy = pwdev->wiphy; -+ struct cfg80211_bss *bss = NULL; -+ WLAN_BSSID_EX select_network = pnetwork->network; -+ -+ bss = cfg80211_get_bss(wiphy, NULL/*notify_channel*/, -+ select_network.MacAddress, select_network.Ssid.Ssid, -+ select_network.Ssid.SsidLength, 0/*WLAN_CAPABILITY_ESS*/, -+ 0/*WLAN_CAPABILITY_ESS*/); -+ -+ if (bss) { -+ cfg80211_unlink_bss(wiphy, bss); -+ DBG_8192C("%s(): cfg80211_unlink %s!! () ",__func__,select_network.Ssid.Ssid ); -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0) -+ cfg80211_put_bss(padapter->rtw_wdev->wiphy, bss); -+#else -+ cfg80211_put_bss(bss); -+#endif -+ } -+ return; -+} -+ -+void rtw_cfg80211_surveydone_event_callback(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u32 cnt=0; -+ u32 wait_for_surveydone; -+ sint wait_status; -+#ifdef CONFIG_P2P -+ struct wifidirect_info* pwdinfo = &padapter->wdinfo; -+#endif //CONFIG_P2P -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s\n", __func__); -+#endif -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while(1) -+ { -+ if (rtw_end_of_queue_search(phead,plist)== _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ //report network only if the current channel set contains the channel to which this network belongs -+ if(rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 -+ && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE -+ && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid)) -+ ) -+ { -+ //ev=translate_scan(padapter, a, pnetwork, ev, stop); -+ rtw_cfg80211_inform_bss(padapter, pnetwork); -+ } -+ /* //check ralink testbed RSN IE length -+ { -+ if(_rtw_memcmp(pnetwork->network.Ssid.Ssid, "Ralink_11n_AP",13)) -+ { -+ uint ie_len=0; -+ u8 *p=NULL; -+ p = rtw_get_ie(pnetwork->network.IEs + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pnetwork->network.IELength - _BEACON_IE_OFFSET_)); -+ DBG_871X("ie_len=%d\n", ie_len); -+ } -+ }*/ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+} -+ -+static int rtw_cfg80211_set_probe_req_wpsp2pie(_adapter *padapter, char *buf, int len) -+{ -+ int ret = 0; -+ uint wps_ielen = 0; -+ u8 *wps_ie; -+ u32 p2p_ielen = 0; -+ u8 *p2p_ie; -+ u32 wfd_ielen = 0; -+ u8 *wfd_ie; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ielen=%d\n", __func__, len); -+#endif -+ -+ if(len>0) -+ { -+ if((wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen))) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("probe_req_wps_ielen=%d\n", wps_ielen); -+ #endif -+ -+ if(pmlmepriv->wps_probe_req_ie) -+ { -+ u32 free_len = pmlmepriv->wps_probe_req_ie_len; -+ pmlmepriv->wps_probe_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len); -+ pmlmepriv->wps_probe_req_ie = NULL; -+ } -+ -+ pmlmepriv->wps_probe_req_ie = rtw_malloc(wps_ielen); -+ if ( pmlmepriv->wps_probe_req_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->wps_probe_req_ie, wps_ie, wps_ielen); -+ pmlmepriv->wps_probe_req_ie_len = wps_ielen; -+ } -+ -+ //buf += wps_ielen; -+ //len -= wps_ielen; -+ -+ #ifdef CONFIG_P2P -+ if((p2p_ie=rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen))) -+ { -+ struct wifidirect_info *wdinfo = &padapter->wdinfo; -+ u32 attr_contentlen = 0; -+ u8 listen_ch_attr[5]; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("probe_req_p2p_ielen=%d\n", p2p_ielen); -+ #endif -+ -+ if(pmlmepriv->p2p_probe_req_ie) -+ { -+ u32 free_len = pmlmepriv->p2p_probe_req_ie_len; -+ pmlmepriv->p2p_probe_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_probe_req_ie, free_len); -+ pmlmepriv->p2p_probe_req_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_probe_req_ie = rtw_malloc(p2p_ielen); -+ if ( pmlmepriv->p2p_probe_req_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->p2p_probe_req_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_probe_req_ie_len = p2p_ielen; -+ -+ if(rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_LISTEN_CH, (u8*)listen_ch_attr, (uint*) &attr_contentlen) -+ && attr_contentlen == 5) -+ { -+ if (wdinfo->listen_channel != listen_ch_attr[4]) { -+ DBG_871X(FUNC_ADPT_FMT" listen channel - country:%c%c%c, class:%u, ch:%u\n", -+ FUNC_ADPT_ARG(padapter), listen_ch_attr[0], listen_ch_attr[1], listen_ch_attr[2], -+ listen_ch_attr[3], listen_ch_attr[4]); -+ wdinfo->listen_channel = listen_ch_attr[4]; -+ } -+ } -+ } -+ #endif //CONFIG_P2P -+ -+ //buf += p2p_ielen; -+ //len -= p2p_ielen; -+ -+ #ifdef CONFIG_WFD -+ if(rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen)) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("probe_req_wfd_ielen=%d\n", wfd_ielen); -+ #endif -+ -+ if(pmlmepriv->wfd_probe_req_ie) -+ { -+ u32 free_len = pmlmepriv->wfd_probe_req_ie_len; -+ pmlmepriv->wfd_probe_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->wfd_probe_req_ie, free_len); -+ pmlmepriv->wfd_probe_req_ie = NULL; -+ } -+ -+ pmlmepriv->wfd_probe_req_ie = rtw_malloc(wfd_ielen); -+ if ( pmlmepriv->wfd_probe_req_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ rtw_get_wfd_ie(buf, len, pmlmepriv->wfd_probe_req_ie, &pmlmepriv->wfd_probe_req_ie_len); -+ } -+ #endif //CONFIG_WFD -+ -+ } -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_scan(struct wiphy *wiphy -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) -+ , struct net_device *ndev -+ #endif -+ , struct cfg80211_scan_request *request) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct net_device *ndev = wdev_to_ndev(request->wdev); -+#endif -+ int i; -+ u8 _status = _FALSE; -+ int ret = 0; -+ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; -+ struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; -+ _irqL irqL; -+ u8 *wps_ie=NULL; -+ uint wps_ielen=0; -+ u8 *p2p_ie=NULL; -+ uint p2p_ielen=0; -+ u8 survey_times=3; -+ u8 survey_times_for_one_ch=6; -+ struct cfg80211_ssid *ssids = request->ssids; -+ int social_channel = 0, j = 0; -+ bool need_indicate_scan_done = _FALSE; -+ bool ps_denied = _FALSE; -+ -+ _adapter *padapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ struct mlme_priv *pmlmepriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo; -+#endif //CONFIG_P2P -+#ifdef CONFIG_CONCURRENT_MODE -+ PADAPTER pbuddy_adapter = NULL; -+ struct mlme_priv *pbuddy_mlmepriv = NULL; -+#endif //CONFIG_CONCURRENT_MODE -+ -+ if (ndev == NULL) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ padapter = (_adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(padapter); -+ pmlmepriv= &padapter->mlmepriv; -+#ifdef CONFIG_P2P -+ pwdinfo= &(padapter->wdinfo); -+#endif //CONFIG_P2P -+ -+//#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+//#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->pbuddy_adapter) { -+ pbuddy_adapter = padapter->pbuddy_adapter; -+ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); -+ } -+#endif //CONFIG_CONCURRENT_MODE -+ -+#ifdef CONFIG_MP_INCLUDED -+if (padapter->registrypriv.mp_mode == 1) -+{ -+ DBG_871X(FUNC_ADPT_FMT ": MP mode block Scan request\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EPERM; -+ goto exit; -+} -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->pbuddy_adapter) { -+ if (padapter->pbuddy_adapter->registrypriv.mp_mode == 1) -+ { -+ DBG_871X(FUNC_ADPT_FMT ": MP mode block Scan request\n", FUNC_ADPT_ARG(padapter->pbuddy_adapter)); -+ ret = -EPERM; -+ goto exit; -+ } -+ } -+#endif //CONFIG_CONCURRENT_MODE -+#endif -+ -+ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ pwdev_priv->scan_request = request; -+ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ -+ if (adapter_wdev_data(padapter)->block_scan == _TRUE) { -+ DBG_871X(FUNC_ADPT_FMT" wdev_priv.block_scan is set\n", FUNC_ADPT_ARG(padapter)); -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ { -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("%s under WIFI_AP_STATE\n", __FUNCTION__); -+#endif -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS|_FW_UNDER_SURVEY|_FW_UNDER_LINKING) == _TRUE) -+ { -+ DBG_8192C("%s, fwstate=0x%x\n", __func__, pmlmepriv->fw_state); -+ -+ if(check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) -+ { -+ DBG_8192C("AP mode process WPS \n"); -+ } -+ -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } -+ } -+ -+ rtw_ps_deny(padapter, PS_DENY_SCAN); -+ ps_denied = _TRUE; -+ if(_FAIL == rtw_pwr_wakeup(padapter)) { -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } -+ -+ #ifdef CONFIG_P2P -+ if( pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(ssids->ssid != NULL -+ && _rtw_memcmp(ssids->ssid, "DIRECT-", 7) -+ && rtw_get_p2p_ie((u8 *)request->ie, request->ie_len, NULL, NULL) -+ ) -+ { -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); -+ adapter_wdev_data(padapter)->p2p_enabled = _TRUE; -+ } -+ else -+ { -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); -+ #endif -+ } -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); -+ -+ if(request->n_channels == 3 && -+ request->channels[0]->hw_value == 1 && -+ request->channels[1]->hw_value == 6 && -+ request->channels[2]->hw_value == 11 -+ ) -+ { -+ social_channel = 1; -+ } -+ } -+ } -+ #endif //CONFIG_P2P -+ -+ if(request->ie && request->ie_len>0) -+ { -+ rtw_cfg80211_set_probe_req_wpsp2pie(padapter, (u8 *)request->ie, request->ie_len ); -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { -+ DBG_8192C("%s, fwstate=0x%x\n", __func__, pmlmepriv->fw_state); -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { -+ DBG_8192C("%s, fwstate=0x%x\n", __func__, pmlmepriv->fw_state); -+ ret = -EBUSY; -+ goto check_need_indicate_scan_done; -+ } -+ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE) -+ { -+#if 1 // Miracast can't do AP scan -+ static u32 lastscantime = 0; -+ u32 passtime; -+ -+ passtime = rtw_get_passing_time_ms(lastscantime); -+ lastscantime = rtw_get_current_time(); -+ if (passtime > BUSY_TRAFFIC_SCAN_DENY_PERIOD) -+#endif -+ { -+ DBG_871X("%s: bBusyTraffic == _TRUE\n", __FUNCTION__); -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } -+ } -+ -+ if (rtw_is_scan_deny(padapter)){ -+ DBG_871X(FUNC_ADPT_FMT ": scan deny\n", FUNC_ADPT_ARG(padapter)); -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(pbuddy_mlmepriv && (pbuddy_mlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE)) -+ { -+#if 1 // Miracast can't do AP scan -+ static u32 buddylastscantime = 0; -+ u32 passtime; -+ -+ passtime = rtw_get_passing_time_ms(buddylastscantime); -+ buddylastscantime = rtw_get_current_time(); -+ if ((passtime > BUSY_TRAFFIC_SCAN_DENY_PERIOD) -+//#ifdef CONFIG_P2P -+// ||(!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE)) -+//#endif //CONFIG_P2P -+ ) -+#endif -+ { -+ DBG_871X("%s: bBusyTraffic == _TRUE at buddy_intf\n", __FUNCTION__); -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } -+ } -+ -+ if (check_buddy_fwstate(padapter, _FW_UNDER_LINKING|WIFI_UNDER_WPS) == _TRUE) { -+ DBG_871X("buddy_intf's mlme state:0x%x\n", pbuddy_mlmepriv->fw_state); -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ -+ } else if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY)) { -+ bool scan_via_buddy = _FALSE; -+ struct rtw_wdev_priv *buddy_wdev_priv = adapter_wdev_data(pbuddy_adapter); -+ -+ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ _enter_critical_bh(&buddy_wdev_priv->scan_req_lock, &irqL); -+ if (buddy_wdev_priv->scan_request) { -+ DBG_871X("scan via buddy\n"); -+ pmlmepriv->scanning_via_buddy_intf = _TRUE; -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ set_fwstate(pmlmepriv, _FW_UNDER_SURVEY); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ scan_via_buddy = _TRUE; -+ } -+ _exit_critical_bh(&buddy_wdev_priv->scan_req_lock, &irqL); -+ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ -+ if (scan_via_buddy == _FALSE) -+ need_indicate_scan_done = _TRUE; -+ -+ goto check_need_indicate_scan_done; -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+#ifdef CONFIG_P2P -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) -+ { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ rtw_free_network_queue(padapter, _TRUE); -+ -+ if(social_channel == 0) -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); -+ else -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_SOCIAL_LAST); -+ } -+#endif //CONFIG_P2P -+ -+ -+ _rtw_memset(ssid, 0, sizeof(NDIS_802_11_SSID)*RTW_SSID_SCAN_AMOUNT); -+ //parsing request ssids, n_ssids -+ for (i = 0; i < request->n_ssids && i < RTW_SSID_SCAN_AMOUNT; i++) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("ssid=%s, len=%d\n", ssids[i].ssid, ssids[i].ssid_len); -+ #endif -+ _rtw_memcpy(ssid[i].Ssid, ssids[i].ssid, ssids[i].ssid_len); -+ ssid[i].SsidLength = ssids[i].ssid_len; -+ } -+ -+ /* parsing channels, n_channels */ -+ _rtw_memset(ch, 0, sizeof(struct rtw_ieee80211_channel)*RTW_CHANNEL_SCAN_AMOUNT); -+ for (i=0;in_channels && ichannels[i])); -+ #endif -+ ch[i].hw_value = request->channels[i]->hw_value; -+ ch[i].flags = request->channels[i]->flags; -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ if (request->n_channels == 1) { -+ for(i=1;in_channels <= 4) { -+ for(j=request->n_channels-1;j>=0;j--) -+ for(i=0;in_channels); -+ } else { -+ _status = rtw_sitesurvey_cmd(padapter, ssid, RTW_SSID_SCAN_AMOUNT, NULL, 0); -+ } -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+ if(_status == _FALSE) -+ { -+ ret = -1; -+ } -+ -+check_need_indicate_scan_done: -+ if (_TRUE == need_indicate_scan_done) -+ { -+ rtw_cfg80211_surveydone_event_callback(padapter); -+ rtw_cfg80211_indicate_scan_done(padapter, _FALSE); -+ } -+ -+cancel_ps_deny: -+ if (ps_denied == _TRUE) -+ rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); -+ -+exit: -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_set_wiphy_params(struct wiphy *wiphy, u32 changed) -+{ -+#if 0 -+ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); -+ -+ if (changed & WIPHY_PARAM_RTS_THRESHOLD && -+ (iwm->conf.rts_threshold != wiphy->rts_threshold)) { -+ int ret; -+ -+ iwm->conf.rts_threshold = wiphy->rts_threshold; -+ -+ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_CFG_FIX, -+ CFG_RTS_THRESHOLD, -+ iwm->conf.rts_threshold); -+ if (ret < 0) -+ return ret; -+ } -+ -+ if (changed & WIPHY_PARAM_FRAG_THRESHOLD && -+ (iwm->conf.frag_threshold != wiphy->frag_threshold)) { -+ int ret; -+ -+ iwm->conf.frag_threshold = wiphy->frag_threshold; -+ -+ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_FA_CFG_FIX, -+ CFG_FRAG_THRESHOLD, -+ iwm->conf.frag_threshold); -+ if (ret < 0) -+ return ret; -+ } -+#endif -+ DBG_8192C("%s\n", __func__); -+ return 0; -+} -+ -+ -+ -+static int rtw_cfg80211_set_wpa_version(struct security_priv *psecuritypriv, u32 wpa_version) -+{ -+ DBG_8192C("%s, wpa_version=%d\n", __func__, wpa_version); -+ -+ if (!wpa_version) { -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ return 0; -+ } -+ -+ -+ if (wpa_version & (NL80211_WPA_VERSION_1 | NL80211_WPA_VERSION_2)) -+ { -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPAPSK; -+ } -+ -+/* -+ if (wpa_version & NL80211_WPA_VERSION_2) -+ { -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPA2PSK; -+ } -+*/ -+ -+ #ifdef CONFIG_WAPI_SUPPORT -+ if (wpa_version & NL80211_WAPI_VERSION_1) -+ { -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWAPI; -+ } -+ #endif -+ -+ return 0; -+ -+} -+ -+static int rtw_cfg80211_set_auth_type(struct security_priv *psecuritypriv, -+ enum nl80211_auth_type sme_auth_type) -+{ -+ DBG_8192C("%s, nl80211_auth_type=%d\n", __func__, sme_auth_type); -+ -+ -+ switch (sme_auth_type) { -+ case NL80211_AUTHTYPE_AUTOMATIC: -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ -+ break; -+ case NL80211_AUTHTYPE_OPEN_SYSTEM: -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ -+ if(psecuritypriv->ndisauthtype>Ndis802_11AuthModeWPA) -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if(psecuritypriv->ndisauthtype == Ndis802_11AuthModeWAPI) -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; -+#endif -+ -+ break; -+ case NL80211_AUTHTYPE_SHARED_KEY: -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+ -+ break; -+ default: -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ //return -ENOTSUPP; -+ } -+ -+ return 0; -+ -+} -+ -+static int rtw_cfg80211_set_cipher(struct security_priv *psecuritypriv, u32 cipher, bool ucast) -+{ -+ u32 ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ -+ u32 *profile_cipher = ucast ? &psecuritypriv->dot11PrivacyAlgrthm : -+ &psecuritypriv->dot118021XGrpPrivacy; -+ -+ DBG_8192C("%s, ucast=%d, cipher=0x%x\n", __func__, ucast, cipher); -+ -+ -+ if (!cipher) { -+ *profile_cipher = _NO_PRIVACY_; -+ psecuritypriv->ndisencryptstatus = ndisencryptstatus; -+ return 0; -+ } -+ -+ switch (cipher) { -+ case IW_AUTH_CIPHER_NONE: -+ *profile_cipher = _NO_PRIVACY_; -+ ndisencryptstatus = Ndis802_11EncryptionDisabled; -+#ifdef CONFIG_WAPI_SUPPORT -+ if(psecuritypriv->dot11PrivacyAlgrthm ==_SMS4_ ) -+ { -+ *profile_cipher = _SMS4_; -+ } -+#endif -+ break; -+ case WLAN_CIPHER_SUITE_WEP40: -+ *profile_cipher = _WEP40_; -+ ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WLAN_CIPHER_SUITE_WEP104: -+ *profile_cipher = _WEP104_; -+ ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WLAN_CIPHER_SUITE_TKIP: -+ *profile_cipher = _TKIP_; -+ ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WLAN_CIPHER_SUITE_CCMP: -+ *profile_cipher = _AES_; -+ ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case WLAN_CIPHER_SUITE_SMS4: -+ *profile_cipher = _SMS4_; -+ ndisencryptstatus = Ndis802_11_EncrypteionWAPI; -+ break; -+#endif -+ default: -+ DBG_8192C("Unsupported cipher: 0x%x\n", cipher); -+ return -ENOTSUPP; -+ } -+ -+ if(ucast) -+ { -+ psecuritypriv->ndisencryptstatus = ndisencryptstatus; -+ -+ //if(psecuritypriv->dot11PrivacyAlgrthm >= _AES_) -+ // psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPA2PSK; -+ } -+ -+ return 0; -+} -+ -+static int rtw_cfg80211_set_key_mgt(struct security_priv *psecuritypriv, u32 key_mgt) -+{ -+ DBG_8192C("%s, key_mgt=0x%x\n", __func__, key_mgt); -+ -+ if (key_mgt == WLAN_AKM_SUITE_8021X) -+ //*auth_type = UMAC_AUTH_TYPE_8021X; -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ else if (key_mgt == WLAN_AKM_SUITE_PSK) { -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ } -+#ifdef CONFIG_WAPI_SUPPORT -+ else if(key_mgt ==WLAN_AKM_SUITE_WAPI_PSK){ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; -+ } -+ else if(key_mgt ==WLAN_AKM_SUITE_WAPI_CERT){ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; -+ } -+#endif -+ -+ -+ else { -+ DBG_8192C("Invalid key mgt: 0x%x\n", key_mgt); -+ //return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int rtw_cfg80211_set_wpa_ie(_adapter *padapter, u8 *pie, size_t ielen) -+{ -+ u8 *buf=NULL, *pos=NULL; -+ u32 left; -+ int group_cipher = 0, pairwise_cipher = 0; -+ int ret = 0; -+ int wpa_ielen=0; -+ int wpa2_ielen=0; -+ u8 *pwpa, *pwpa2; -+ u8 null_addr[]= {0,0,0,0,0,0}; -+ -+ if (pie == NULL || !ielen) { -+ /* Treat this as normal case, but need to clear WIFI_UNDER_WPS */ -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ goto exit; -+ } -+ -+ if (ielen > MAX_WPA_IE_LEN+MAX_WPS_IE_LEN+MAX_P2P_IE_LEN) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ buf = rtw_zmalloc(ielen); -+ if (buf == NULL){ -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ _rtw_memcpy(buf, pie , ielen); -+ -+ //dump -+ { -+ int i; -+ DBG_8192C("set wpa_ie(length:%zu):\n", ielen); -+ for(i=0;i0) -+ { -+ if(rtw_parse_wpa_ie(pwpa, wpa_ielen+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeWPAPSK; -+ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &pwpa[0], wpa_ielen+2); -+ -+ DBG_8192C("got wpa_ie, wpa_ielen:%u\n", wpa_ielen); -+ } -+ } -+ -+ pwpa2 = rtw_get_wpa2_ie(buf, &wpa2_ielen, ielen); -+ if(pwpa2 && wpa2_ielen>0) -+ { -+ if(rtw_parse_wpa2_ie(pwpa2, wpa2_ielen+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeWPA2PSK; -+ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &pwpa2[0], wpa2_ielen+2); -+ -+ DBG_8192C("got wpa2_ie, wpa2_ielen:%u\n", wpa2_ielen); -+ } -+ } -+ -+ if (group_cipher == 0) -+ { -+ group_cipher = WPA_CIPHER_NONE; -+ } -+ if (pairwise_cipher == 0) -+ { -+ pairwise_cipher = WPA_CIPHER_NONE; -+ } -+ -+ switch(group_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus=Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot118021XGrpPrivacy=_WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot118021XGrpPrivacy=_TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot118021XGrpPrivacy=_AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot118021XGrpPrivacy=_WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ switch(pairwise_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus=Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ {/* handle wps_ie */ -+ uint wps_ielen; -+ u8 *wps_ie; -+ -+ wps_ie = rtw_get_wps_ie(buf, ielen, NULL, &wps_ielen); -+ if (wps_ie && wps_ielen > 0) { -+ DBG_8192C("got wps_ie, wps_ielen:%u\n", wps_ielen); -+ padapter->securitypriv.wps_ie_len = wps_ielensecuritypriv.wps_ie, wps_ie, padapter->securitypriv.wps_ie_len); -+ set_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ } else { -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ } -+ } -+ -+ #ifdef CONFIG_P2P -+ {//check p2p_ie for assoc req; -+ uint p2p_ielen=0; -+ u8 *p2p_ie; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if((p2p_ie=rtw_get_p2p_ie(buf, ielen, NULL, &p2p_ielen))) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s p2p_assoc_req_ielen=%d\n", __FUNCTION__, p2p_ielen); -+ #endif -+ -+ if(pmlmepriv->p2p_assoc_req_ie) -+ { -+ u32 free_len = pmlmepriv->p2p_assoc_req_ie_len; -+ pmlmepriv->p2p_assoc_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_assoc_req_ie, free_len); -+ pmlmepriv->p2p_assoc_req_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_assoc_req_ie = rtw_malloc(p2p_ielen); -+ if ( pmlmepriv->p2p_assoc_req_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ goto exit; -+ } -+ _rtw_memcpy(pmlmepriv->p2p_assoc_req_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_assoc_req_ie_len = p2p_ielen; -+ } -+ } -+ #endif //CONFIG_P2P -+ -+ #ifdef CONFIG_WFD -+ {//check wfd_ie for assoc req; -+ uint wfd_ielen=0; -+ u8 *wfd_ie; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if(rtw_get_wfd_ie(buf, ielen, NULL, &wfd_ielen)) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s wfd_assoc_req_ielen=%d\n", __FUNCTION__, wfd_ielen); -+ #endif -+ -+ if(pmlmepriv->wfd_assoc_req_ie) -+ { -+ u32 free_len = pmlmepriv->wfd_assoc_req_ie_len; -+ pmlmepriv->wfd_assoc_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->wfd_assoc_req_ie, free_len); -+ pmlmepriv->wfd_assoc_req_ie = NULL; -+ } -+ -+ pmlmepriv->wfd_assoc_req_ie = rtw_malloc(wfd_ielen); -+ if ( pmlmepriv->wfd_assoc_req_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ goto exit; -+ } -+ rtw_get_wfd_ie(buf, ielen, pmlmepriv->wfd_assoc_req_ie, &pmlmepriv->wfd_assoc_req_ie_len); -+ } -+ } -+ #endif //CONFIG_WFD -+ -+ //TKIP and AES disallow multicast packets until installing group key -+ if(padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) -+ //WPS open need to enable multicast -+ //|| check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == _TRUE) -+ rtw_hal_set_hwreg(padapter, HW_VAR_OFF_RCR_AM, null_addr); -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("rtw_set_wpa_ie: pairwise_cipher=0x%08x padapter->securitypriv.ndisencryptstatus=%d padapter->securitypriv.ndisauthtype=%d\n", -+ pairwise_cipher, padapter->securitypriv.ndisencryptstatus, padapter->securitypriv.ndisauthtype)); -+ -+exit: -+ if (buf) -+ rtw_mfree(buf, ielen); -+ if (ret) -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ return ret; -+} -+ -+static int cfg80211_rtw_join_ibss(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_ibss_params *params) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ NDIS_802_11_SSID ndis_ssid; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ struct cfg80211_chan_def *pch_def; -+#endif -+ struct ieee80211_channel *pch; -+ int ret=0; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ pch_def = (struct cfg80211_chan_def *)(¶ms->chandef); -+ pch = (struct ieee80211_channel *) pch_def->chan; -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 31)) -+ pch = (struct ieee80211_channel *)(params->channel); -+#endif -+ -+ if(_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret= -EPERM; -+ goto exit; -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, _FW_UNDER_LINKING) == _TRUE) { -+ DBG_8192C("%s, but buddy_intf is under linking\n", __FUNCTION__); -+ ret = -EINVAL; -+ goto exit; -+ } -+ if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY) == _TRUE) { -+ rtw_scan_abort(padapter->pbuddy_adapter); -+ } -+#endif //CONFIG_CONCURRENT_MODE -+ -+ if (!params->ssid || !params->ssid_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (params->ssid_len > IW_ESSID_MAX_SIZE){ -+ -+ ret= -E2BIG; -+ goto exit; -+ } -+ -+ _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID)); -+ ndis_ssid.SsidLength = params->ssid_len; -+ _rtw_memcpy(ndis_ssid.Ssid, (u8 *)params->ssid, params->ssid_len); -+ -+ //DBG_8192C("ssid=%s, len=%zu\n", ndis_ssid.Ssid, params->ssid_len); -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; //open system -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ -+ ret = rtw_cfg80211_set_auth_type(psecuritypriv, NL80211_AUTHTYPE_OPEN_SYSTEM); -+ rtw_set_802_11_authentication_mode(padapter, psecuritypriv->ndisauthtype); -+ -+ DBG_871X("%s: center_freq = %d\n", __func__, pch->center_freq); -+ pmlmeext->cur_channel = rtw_freq2ch(pch->center_freq); -+ -+ if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == _FALSE) -+ { -+ ret = -1; -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+static int cfg80211_rtw_leave_ibss(struct wiphy *wiphy, struct net_device *ndev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct wireless_dev *rtw_wdev = padapter->rtw_wdev; -+ enum nl80211_iftype old_type; -+ int ret = 0; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ padapter->mlmepriv.not_indic_disco = _TRUE; -+ -+ old_type = rtw_wdev->iftype; -+ -+ rtw_set_to_roam(padapter, 0); -+ -+ if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)) -+ { -+ rtw_scan_abort(padapter); -+ LeaveAllPowerSaveMode(padapter); -+ -+ rtw_wdev->iftype = NL80211_IFTYPE_STATION; -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, Ndis802_11Infrastructure) ==_FALSE) -+ { -+ rtw_wdev->iftype = old_type; -+ ret = -EPERM; -+ goto leave_ibss; -+ } -+ rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure,_TRUE); -+ } -+ -+leave_ibss: -+ padapter->mlmepriv.not_indic_disco = _FALSE; -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_connect_params *sme) -+{ -+ int ret=0; -+ _irqL irqL; -+ _list *phead; -+ struct wlan_network *pnetwork = NULL; -+ NDIS_802_11_AUTHENTICATION_MODE authmode; -+ NDIS_802_11_SSID ndis_ssid; -+ u8 *dst_ssid, *src_ssid; -+ u8 *dst_bssid, *src_bssid; -+ //u8 matched_by_bssid=_FALSE; -+ //u8 matched_by_ssid=_FALSE; -+ u8 matched=_FALSE; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ _queue *queue = &pmlmepriv->scanned_queue; -+ -+ padapter->mlmepriv.not_indic_disco = _TRUE; -+ -+ DBG_871X("=>"FUNC_NDEV_FMT" - Start to Connection\n", FUNC_NDEV_ARG(ndev)); -+ DBG_871X("privacy=%d, key=%p, key_len=%d, key_idx=%d\n", -+ sme->privacy, sme->key, sme->key_len, sme->key_idx); -+ -+ -+ if(adapter_wdev_data(padapter)->block == _TRUE) -+ { -+ ret = -EBUSY; -+ DBG_871X("%s wdev_priv.block is set\n", __FUNCTION__); -+ goto exit; -+ } -+ -+#ifdef CONFIG_PLATFORM_MSTAR_SCAN_BEFORE_CONNECT -+ printk("MStar Android!\n"); -+ if(adapter_wdev_data(padapter)->bandroid_scan == _FALSE) -+ { -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+#endif //CONFIG_P2P -+ { -+ ret = -EBUSY; -+ printk("Android hasn't attached yet!\n"); -+ goto exit; -+ } -+ } -+#endif -+ -+ rtw_ps_deny(padapter, PS_DENY_JOIN); -+ if(_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret= -EPERM; -+ goto exit; -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, _FW_UNDER_LINKING) == _TRUE) { -+ DBG_8192C("%s, but buddy_intf is under linking\n", __FUNCTION__); -+ ret = -EINVAL; -+ goto exit; -+ } -+ if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY) == _TRUE) { -+ rtw_scan_abort(padapter->pbuddy_adapter); -+ } -+#endif -+ -+ if (!sme->ssid || !sme->ssid_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (sme->ssid_len > IW_ESSID_MAX_SIZE){ -+ -+ ret= -E2BIG; -+ goto exit; -+ } -+ -+ _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID)); -+ ndis_ssid.SsidLength = sme->ssid_len; -+ _rtw_memcpy(ndis_ssid.Ssid, (u8 *)sme->ssid, sme->ssid_len); -+ -+ DBG_8192C("ssid=%s, len=%zu\n", ndis_ssid.Ssid, sme->ssid_len); -+ -+ -+ if (sme->bssid) -+ DBG_8192C("bssid="MAC_FMT"\n", MAC_ARG(sme->bssid)); -+ -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { -+ ret = -EBUSY; -+ DBG_8192C("%s, fw_state=0x%x, goto exit\n", __FUNCTION__, pmlmepriv->fw_state); -+ goto exit; -+ } -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { -+ rtw_scan_abort(padapter); -+ } -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; //open system -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ padapter->wapiInfo.bWapiEnable = false; -+#endif -+ -+ ret = rtw_cfg80211_set_wpa_version(psecuritypriv, sme->crypto.wpa_versions); -+ if (ret < 0) -+ goto exit; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if(sme->crypto.wpa_versions & NL80211_WAPI_VERSION_1) -+ { -+ padapter->wapiInfo.bWapiEnable = true; -+ padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN; -+ padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN; -+ } -+#endif -+ -+ ret = rtw_cfg80211_set_auth_type(psecuritypriv, sme->auth_type); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if(psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_WAPI) -+ padapter->mlmeextpriv.mlmext_info.auth_algo = psecuritypriv->dot11AuthAlgrthm; -+#endif -+ -+ -+ if (ret < 0) -+ goto exit; -+ -+ DBG_8192C("%s, ie_len=%zu\n", __func__, sme->ie_len); -+ -+ ret = rtw_cfg80211_set_wpa_ie(padapter, (u8 *)sme->ie, sme->ie_len); -+ if (ret < 0) -+ goto exit; -+ -+ if (sme->crypto.n_ciphers_pairwise) { -+ ret = rtw_cfg80211_set_cipher(psecuritypriv, sme->crypto.ciphers_pairwise[0], _TRUE); -+ if (ret < 0) -+ goto exit; -+ } -+ -+ //For WEP Shared auth -+ if((psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_Shared -+ || psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_Auto) && sme->key -+ ) -+ { -+ u32 wep_key_idx, wep_key_len,wep_total_len; -+ NDIS_802_11_WEP *pwep = NULL; -+ DBG_871X("%s(): Shared/Auto WEP\n",__FUNCTION__); -+ -+ wep_key_idx = sme->key_idx; -+ wep_key_len = sme->key_len; -+ -+ if (sme->key_idx > WEP_KEYS) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (wep_key_len > 0) -+ { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); -+ pwep =(NDIS_802_11_WEP *) rtw_malloc(wep_total_len); -+ if(pwep == NULL){ -+ DBG_871X(" wpa_set_encryption: pwep allocate fail !!!\n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ _rtw_memset(pwep, 0, wep_total_len); -+ -+ pwep->KeyLength = wep_key_len; -+ pwep->Length = wep_total_len; -+ -+ if(wep_key_len==13) -+ { -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_; -+ padapter->securitypriv.dot118021XGrpPrivacy=_WEP104_; -+ } -+ } -+ else { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ pwep->KeyIndex = wep_key_idx; -+ pwep->KeyIndex |= 0x80000000; -+ -+ _rtw_memcpy(pwep->KeyMaterial, (void *)sme->key, pwep->KeyLength); -+ -+ if(rtw_set_802_11_add_wep(padapter, pwep) == (u8)_FAIL) -+ { -+ ret = -EOPNOTSUPP ; -+ } -+ -+ if (pwep) { -+ rtw_mfree((u8 *)pwep,wep_total_len); -+ } -+ -+ if(ret < 0) -+ goto exit; -+ } -+ -+ ret = rtw_cfg80211_set_cipher(psecuritypriv, sme->crypto.cipher_group, _FALSE); -+ if (ret < 0) -+ return ret; -+ -+ if (sme->crypto.n_akm_suites) { -+ ret = rtw_cfg80211_set_key_mgt(psecuritypriv, sme->crypto.akm_suites[0]); -+ if (ret < 0) -+ goto exit; -+ } -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if(sme->crypto.akm_suites[0] ==WLAN_AKM_SUITE_WAPI_PSK){ -+ padapter->wapiInfo.bWapiPSK = true; -+ } -+ else if(sme->crypto.akm_suites[0] ==WLAN_AKM_SUITE_WAPI_CERT){ -+ padapter->wapiInfo.bWapiPSK = false; -+ } -+#endif -+ -+ authmode = psecuritypriv->ndisauthtype; -+ rtw_set_802_11_authentication_mode(padapter, authmode); -+ -+ //rtw_set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); -+ -+ if (rtw_set_802_11_connect(padapter, (u8 *)sme->bssid, &ndis_ssid) == _FALSE) { -+ ret = -1; -+ goto exit; -+ } -+ -+ DBG_8192C("set ssid:dot11AuthAlgrthm=%d, dot11PrivacyAlgrthm=%d, dot118021XGrpPrivacy=%d\n", psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, psecuritypriv->dot118021XGrpPrivacy); -+ -+exit: -+ -+ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); -+ -+ DBG_8192C("<=%s, ret %d\n",__FUNCTION__, ret); -+ -+ padapter->mlmepriv.not_indic_disco = _FALSE; -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_disconnect(struct wiphy *wiphy, struct net_device *ndev, -+ u16 reason_code) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ DBG_871X(FUNC_NDEV_FMT" - Start to Disconnect\n", FUNC_NDEV_ARG(ndev)); -+ -+ padapter->mlmepriv.not_indic_disco = _TRUE; -+ -+ rtw_set_to_roam(padapter, 0); -+ -+ //if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)) -+ { -+ rtw_scan_abort(padapter); -+ LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, _FALSE); -+ -+ DBG_871X("%s...call rtw_indicate_disconnect\n", __FUNCTION__); -+ -+ rtw_indicate_disconnect(padapter); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ rtw_pwr_wakeup(padapter); -+ } -+ -+ padapter->mlmepriv.not_indic_disco = _FALSE; -+ -+ DBG_871X(FUNC_NDEV_FMT" return 0\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+static int cfg80211_rtw_set_txpower(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,8,0)) -+ struct wireless_dev *wdev, -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,36)) || defined(COMPAT_KERNEL_RELEASE) -+ enum nl80211_tx_power_setting type, int mbm) -+#else -+ enum tx_power_setting type, int dbm) -+#endif -+{ -+#if 0 -+ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); -+ int ret; -+ -+ switch (type) { -+ case NL80211_TX_POWER_AUTOMATIC: -+ return 0; -+ case NL80211_TX_POWER_FIXED: -+ if (mbm < 0 || (mbm % 100)) -+ return -EOPNOTSUPP; -+ -+ if (!test_bit(IWM_STATUS_READY, &iwm->status)) -+ return 0; -+ -+ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_CFG_FIX, -+ CFG_TX_PWR_LIMIT_USR, -+ MBM_TO_DBM(mbm) * 2); -+ if (ret < 0) -+ return ret; -+ -+ return iwm_tx_power_trigger(iwm); -+ default: -+ IWM_ERR(iwm, "Unsupported power type: %d\n", type); -+ return -EOPNOTSUPP; -+ } -+#endif -+ DBG_8192C("%s\n", __func__); -+ return 0; -+} -+ -+static int cfg80211_rtw_get_txpower(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,8,0)) -+ struct wireless_dev *wdev, -+#endif -+ int *dbm) -+{ -+ DBG_8192C("%s\n", __func__); -+ -+ *dbm = (12); -+ -+ return 0; -+} -+ -+inline bool rtw_cfg80211_pwr_mgmt(_adapter *adapter) -+{ -+ struct rtw_wdev_priv *rtw_wdev_priv = adapter_wdev_data(adapter); -+ return rtw_wdev_priv->power_mgmt; -+} -+ -+static int cfg80211_rtw_set_power_mgmt(struct wiphy *wiphy, -+ struct net_device *ndev, -+ bool enabled, int timeout) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct rtw_wdev_priv *rtw_wdev_priv = adapter_wdev_data(padapter); -+ -+ DBG_871X(FUNC_NDEV_FMT" enabled:%u, timeout:%d\n", FUNC_NDEV_ARG(ndev), -+ enabled, timeout); -+ -+ rtw_wdev_priv->power_mgmt = enabled; -+ -+ #ifdef CONFIG_LPS -+ if (!enabled) -+ LPS_Leave(padapter, "CFG80211_PWRMGMT"); -+ #endif -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_set_pmksa(struct wiphy *wiphy, -+ struct net_device *ndev, -+ struct cfg80211_pmksa *pmksa) -+{ -+ u8 index,blInserted = _FALSE; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *mlme = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ u8 strZeroMacAddress[ ETH_ALEN ] = { 0x00 }; -+ -+ DBG_871X(FUNC_NDEV_FMT" "MAC_FMT" "KEY_FMT"\n", FUNC_NDEV_ARG(ndev) -+ , MAC_ARG(pmksa->bssid), KEY_ARG(pmksa->pmkid)); -+ -+ if ( _rtw_memcmp((u8 *)pmksa->bssid, strZeroMacAddress, ETH_ALEN ) == _TRUE ) -+ { -+ return -EINVAL; -+ } -+ -+ if (check_fwstate(mlme, _FW_LINKED) == _FALSE) { -+ DBG_871X(FUNC_NDEV_FMT" not set pmksa cause not in linked state\n", FUNC_NDEV_ARG(ndev)); -+ return -EINVAL; -+ } -+ -+ blInserted = _FALSE; -+ -+ //overwrite PMKID -+ for(index=0 ; indexPMKIDList[index].Bssid, (u8 *)pmksa->bssid, ETH_ALEN) ==_TRUE ) -+ { // BSSID is matched, the same AP => rewrite with new PMKID. -+ DBG_871X(FUNC_NDEV_FMT" BSSID exists in the PMKList.\n", FUNC_NDEV_ARG(ndev)); -+ -+ _rtw_memcpy( psecuritypriv->PMKIDList[index].PMKID, (u8 *)pmksa->pmkid, WLAN_PMKID_LEN); -+ psecuritypriv->PMKIDList[index].bUsed = _TRUE; -+ psecuritypriv->PMKIDIndex = index+1; -+ blInserted = _TRUE; -+ break; -+ } -+ } -+ -+ if(!blInserted) -+ { -+ // Find a new entry -+ DBG_871X(FUNC_NDEV_FMT" Use the new entry index = %d for this PMKID.\n", -+ FUNC_NDEV_ARG(ndev), psecuritypriv->PMKIDIndex ); -+ -+ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, (u8 *)pmksa->bssid, ETH_ALEN); -+ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, (u8 *)pmksa->pmkid, WLAN_PMKID_LEN); -+ -+ psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].bUsed = _TRUE; -+ psecuritypriv->PMKIDIndex++ ; -+ if(psecuritypriv->PMKIDIndex==16) -+ { -+ psecuritypriv->PMKIDIndex =0; -+ } -+ } -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_del_pmksa(struct wiphy *wiphy, -+ struct net_device *ndev, -+ struct cfg80211_pmksa *pmksa) -+{ -+ u8 index, bMatched = _FALSE; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ DBG_871X(FUNC_NDEV_FMT" "MAC_FMT" "KEY_FMT"\n", FUNC_NDEV_ARG(ndev) -+ , MAC_ARG(pmksa->bssid), KEY_ARG(pmksa->pmkid)); -+ -+ for(index=0 ; indexPMKIDList[index].Bssid, (u8 *)pmksa->bssid, ETH_ALEN) ==_TRUE ) -+ { // BSSID is matched, the same AP => Remove this PMKID information and reset it. -+ _rtw_memset(psecuritypriv->PMKIDList[index].Bssid, 0x00, ETH_ALEN ); -+ _rtw_memset(psecuritypriv->PMKIDList[index].PMKID, 0x00, WLAN_PMKID_LEN ); -+ psecuritypriv->PMKIDList[index].bUsed = _FALSE; -+ bMatched = _TRUE; -+ DBG_871X(FUNC_NDEV_FMT" clear id:%hhu\n", FUNC_NDEV_ARG(ndev), index); -+ break; -+ } -+ } -+ -+ if(_FALSE == bMatched) -+ { -+ DBG_871X(FUNC_NDEV_FMT" do not have matched BSSID\n" -+ , FUNC_NDEV_ARG(ndev)); -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_flush_pmksa(struct wiphy *wiphy, -+ struct net_device *ndev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ _rtw_memset( &psecuritypriv->PMKIDList[ 0 ], 0x00, sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE ); -+ psecuritypriv->PMKIDIndex = 0; -+ -+ return 0; -+} -+ -+#ifdef CONFIG_AP_MODE -+void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint frame_len) -+{ -+ s32 freq; -+ int channel; -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct net_device *ndev = padapter->pnetdev; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+#if defined(RTW_USE_CFG80211_STA_EVENT) || defined(COMPAT_KERNEL_RELEASE) -+ { -+ struct station_info sinfo; -+ u8 ie_offset; -+ if (GetFrameSubType(pmgmt_frame) == WIFI_ASSOCREQ) -+ ie_offset = _ASOCREQ_IE_OFFSET_; -+ else // WIFI_REASSOCREQ -+ ie_offset = _REASOCREQ_IE_OFFSET_; -+ -+ memset(&sinfo, 0, sizeof(sinfo)); -+ sinfo.filled = 0; -+ sinfo.filled = STATION_INFO_ASSOC_REQ_IES; -+ sinfo.assoc_req_ies = pmgmt_frame + WLAN_HDR_A3_LEN + ie_offset; -+ sinfo.assoc_req_ies_len = frame_len - WLAN_HDR_A3_LEN - ie_offset; -+ cfg80211_new_sta(ndev, GetAddr2Ptr(pmgmt_frame), &sinfo, GFP_ATOMIC); -+ } -+#else /* defined(RTW_USE_CFG80211_STA_EVENT) */ -+ channel = pmlmeext->cur_channel; -+ freq = rtw_ch2freq(channel); -+ -+ #ifdef COMPAT_KERNEL_RELEASE -+ rtw_cfg80211_rx_mgmt(padapter, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); -+ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ rtw_cfg80211_rx_mgmt(padapter, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); -+ #else //COMPAT_KERNEL_RELEASE -+ { -+ //to avoid WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION) when calling cfg80211_send_rx_assoc() -+ #ifndef CONFIG_PLATFORM_MSTAR -+ pwdev->iftype = NL80211_IFTYPE_STATION; -+ #endif //CONFIG_PLATFORM_MSTAR -+ DBG_8192C("iftype=%d before call cfg80211_send_rx_assoc()\n", pwdev->iftype); -+ rtw_cfg80211_send_rx_assoc(padapter, NULL, pmgmt_frame, frame_len); -+ DBG_8192C("iftype=%d after call cfg80211_send_rx_assoc()\n", pwdev->iftype); -+ pwdev->iftype = NL80211_IFTYPE_AP; -+ //cfg80211_rx_action(padapter->pnetdev, freq, pmgmt_frame, frame_len, GFP_ATOMIC); -+ } -+ #endif //COMPAT_KERNEL_RELEASE -+#endif /* defined(RTW_USE_CFG80211_STA_EVENT) */ -+ -+} -+ -+void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, unsigned short reason) -+{ -+ s32 freq; -+ int channel; -+ u8 *pmgmt_frame; -+ uint frame_len; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ u8 mgmt_buf[128] = {0}; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct net_device *ndev = padapter->pnetdev; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+#if defined(RTW_USE_CFG80211_STA_EVENT) || defined(COMPAT_KERNEL_RELEASE) -+ cfg80211_del_sta(ndev, da, GFP_ATOMIC); -+#else /* defined(RTW_USE_CFG80211_STA_EVENT) */ -+ channel = pmlmeext->cur_channel; -+ freq = rtw_ch2freq(channel); -+ -+ pmgmt_frame = mgmt_buf; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pmgmt_frame; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pmgmt_frame, WIFI_DEAUTH); -+ -+ pmgmt_frame += sizeof(struct rtw_ieee80211_hdr_3addr); -+ frame_len = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ reason = cpu_to_le16(reason); -+ pmgmt_frame = rtw_set_fixed_ie(pmgmt_frame, _RSON_CODE_ , (unsigned char *)&reason, &frame_len); -+ -+ #ifdef COMPAT_KERNEL_RELEASE -+ rtw_cfg80211_rx_mgmt(padapter, freq, 0, mgmt_buf, frame_len, GFP_ATOMIC); -+ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ rtw_cfg80211_rx_mgmt(padapter, freq, 0, mgmt_buf, frame_len, GFP_ATOMIC); -+ #else //COMPAT_KERNEL_RELEASE -+ cfg80211_send_disassoc(padapter->pnetdev, mgmt_buf, frame_len); -+ //cfg80211_rx_action(padapter->pnetdev, freq, mgmt_buf, frame_len, GFP_ATOMIC); -+ #endif //COMPAT_KERNEL_RELEASE -+#endif /* defined(RTW_USE_CFG80211_STA_EVENT) */ -+} -+ -+static int rtw_cfg80211_monitor_if_open(struct net_device *ndev) -+{ -+ int ret = 0; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ return ret; -+} -+ -+static int rtw_cfg80211_monitor_if_close(struct net_device *ndev) -+{ -+ int ret = 0; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ return ret; -+} -+ -+static int rtw_cfg80211_monitor_if_xmit_entry(struct sk_buff *skb, struct net_device *ndev) -+{ -+ int ret = 0; -+ int rtap_len; -+ int qos_len = 0; -+ int dot11_hdr_len = 24; -+ int snap_len = 6; -+ unsigned char *pdata; -+ u16 frame_ctl; -+ unsigned char src_mac_addr[6]; -+ unsigned char dst_mac_addr[6]; -+ struct ieee80211_hdr *dot11_hdr; -+ struct ieee80211_radiotap_header *rtap_hdr; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ if (skb) -+ rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, skb->truesize); -+ -+ if (unlikely(skb->len < sizeof(struct ieee80211_radiotap_header))) -+ goto fail; -+ -+ rtap_hdr = (struct ieee80211_radiotap_header *)skb->data; -+ if (unlikely(rtap_hdr->it_version)) -+ goto fail; -+ -+ rtap_len = ieee80211_get_radiotap_len(skb->data); -+ if (unlikely(skb->len < rtap_len)) -+ goto fail; -+ -+ if(rtap_len != 14) -+ { -+ DBG_8192C("radiotap len (should be 14): %d\n", rtap_len); -+ goto fail; -+ } -+ -+ /* Skip the ratio tap header */ -+ skb_pull(skb, rtap_len); -+ -+ dot11_hdr = (struct ieee80211_hdr *)skb->data; -+ frame_ctl = le16_to_cpu(dot11_hdr->frame_control); -+ /* Check if the QoS bit is set */ -+ if ((frame_ctl & RTW_IEEE80211_FCTL_FTYPE) == RTW_IEEE80211_FTYPE_DATA) { -+ /* Check if this ia a Wireless Distribution System (WDS) frame -+ * which has 4 MAC addresses -+ */ -+ if (dot11_hdr->frame_control & 0x0080) -+ qos_len = 2; -+ if ((dot11_hdr->frame_control & 0x0300) == 0x0300) -+ dot11_hdr_len += 6; -+ -+ memcpy(dst_mac_addr, dot11_hdr->addr1, sizeof(dst_mac_addr)); -+ memcpy(src_mac_addr, dot11_hdr->addr2, sizeof(src_mac_addr)); -+ -+ /* Skip the 802.11 header, QoS (if any) and SNAP, but leave spaces for -+ * for two MAC addresses -+ */ -+ skb_pull(skb, dot11_hdr_len + qos_len + snap_len - sizeof(src_mac_addr) * 2); -+ pdata = (unsigned char*)skb->data; -+ memcpy(pdata, dst_mac_addr, sizeof(dst_mac_addr)); -+ memcpy(pdata + sizeof(dst_mac_addr), src_mac_addr, sizeof(src_mac_addr)); -+ -+ DBG_8192C("should be eapol packet\n"); -+ -+ /* Use the real net device to transmit the packet */ -+ ret = _rtw_xmit_entry(skb, padapter->pnetdev); -+ -+ return ret; -+ -+ } -+ else if ((frame_ctl & (RTW_IEEE80211_FCTL_FTYPE|RTW_IEEE80211_FCTL_STYPE)) -+ == (RTW_IEEE80211_FTYPE_MGMT|RTW_IEEE80211_STYPE_ACTION) -+ ) -+ { -+ //only for action frames -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ //u8 category, action, OUI_Subtype, dialogToken=0; -+ //unsigned char *frame_body; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ u8 *buf = skb->data; -+ u32 len = skb->len; -+ u8 category, action; -+ int type = -1; -+ -+ if (rtw_action_frame_parse(buf, len, &category, &action) == _FALSE) { -+ DBG_8192C(FUNC_NDEV_FMT" frame_control:0x%x\n", FUNC_NDEV_ARG(ndev), -+ le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl)); -+ goto fail; -+ } -+ -+ DBG_8192C("RTW_Tx:da="MAC_FMT" via "FUNC_NDEV_FMT"\n", -+ MAC_ARG(GetAddr1Ptr(buf)), FUNC_NDEV_ARG(ndev)); -+ #ifdef CONFIG_P2P -+ if((type = rtw_p2p_check_frames(padapter, buf, len, _TRUE)) >= 0) -+ goto dump; -+ #endif -+ if (category == RTW_WLAN_CATEGORY_PUBLIC) -+ DBG_871X("RTW_Tx:%s\n", action_public_str(action)); -+ else -+ DBG_871X("RTW_Tx:category(%u), action(%u)\n", category, action); -+ -+dump: -+ //starting alloc mgmt frame to dump it -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ goto fail; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = _FALSE; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ _rtw_memcpy(pframe, (void*)buf, len); -+ #ifdef CONFIG_WFD -+ if (type >= 0) -+ { -+ struct wifi_display_info *pwfd_info; -+ -+ pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if ( _TRUE == pwfd_info->wfd_enable ) -+ { -+ rtw_append_wfd_ie( padapter, pframe, &len ); -+ } -+ } -+ #endif // CONFIG_WFD -+ pattrib->pktlen = len; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ //update seq number -+ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ pmlmeext->mgnt_seq++; -+ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ } -+ else -+ { -+ DBG_8192C("frame_ctl=0x%x\n", frame_ctl & (RTW_IEEE80211_FCTL_FTYPE|RTW_IEEE80211_FCTL_STYPE)); -+ } -+ -+ -+fail: -+ -+ rtw_skb_free(skb); -+ -+ return 0; -+ -+} -+ -+static void rtw_cfg80211_monitor_if_set_multicast_list(struct net_device *ndev) -+{ -+ DBG_8192C("%s\n", __func__); -+} -+ -+static int rtw_cfg80211_monitor_if_set_mac_address(struct net_device *ndev, void *addr) -+{ -+ int ret = 0; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) -+static const struct net_device_ops rtw_cfg80211_monitor_if_ops = { -+ .ndo_open = rtw_cfg80211_monitor_if_open, -+ .ndo_stop = rtw_cfg80211_monitor_if_close, -+ .ndo_start_xmit = rtw_cfg80211_monitor_if_xmit_entry, -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,2,0)) -+ .ndo_set_multicast_list = rtw_cfg80211_monitor_if_set_multicast_list, -+ #endif -+ .ndo_set_mac_address = rtw_cfg80211_monitor_if_set_mac_address, -+}; -+#endif -+ -+static int rtw_cfg80211_add_monitor_if(_adapter *padapter, char *name, struct net_device **ndev) -+{ -+ int ret = 0; -+ struct net_device* mon_ndev = NULL; -+ struct wireless_dev* mon_wdev = NULL; -+ struct rtw_netdev_priv_indicator *pnpi; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ -+ if (!name) { -+ DBG_871X(FUNC_ADPT_FMT" without specific name\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ if (pwdev_priv->pmon_ndev) { -+ DBG_871X(FUNC_ADPT_FMT" monitor interface exist: "NDEV_FMT"\n", -+ FUNC_ADPT_ARG(padapter), NDEV_ARG(pwdev_priv->pmon_ndev)); -+ ret = -EBUSY; -+ goto out; -+ } -+ -+ mon_ndev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); -+ if (!mon_ndev) { -+ DBG_871X(FUNC_ADPT_FMT" allocate ndev fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ mon_ndev->type = ARPHRD_IEEE80211_RADIOTAP; -+ strncpy(mon_ndev->name, name, IFNAMSIZ); -+ mon_ndev->name[IFNAMSIZ - 1] = 0; -+ mon_ndev->destructor = rtw_ndev_destructor; -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) -+ mon_ndev->netdev_ops = &rtw_cfg80211_monitor_if_ops; -+#else -+ mon_ndev->open = rtw_cfg80211_monitor_if_open; -+ mon_ndev->stop = rtw_cfg80211_monitor_if_close; -+ mon_ndev->hard_start_xmit = rtw_cfg80211_monitor_if_xmit_entry; -+ mon_ndev->set_mac_address = rtw_cfg80211_monitor_if_set_mac_address; -+#endif -+ -+ pnpi = netdev_priv(mon_ndev); -+ pnpi->priv = padapter; -+ pnpi->sizeof_priv = sizeof(_adapter); -+ -+ /* wdev */ -+ mon_wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); -+ if (!mon_wdev) { -+ DBG_871X(FUNC_ADPT_FMT" allocate mon_wdev fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ mon_wdev->wiphy = padapter->rtw_wdev->wiphy; -+ mon_wdev->netdev = mon_ndev; -+ mon_wdev->iftype = NL80211_IFTYPE_MONITOR; -+ mon_ndev->ieee80211_ptr = mon_wdev; -+ -+ ret = register_netdevice(mon_ndev); -+ if (ret) { -+ goto out; -+ } -+ -+ *ndev = pwdev_priv->pmon_ndev = mon_ndev; -+ _rtw_memcpy(pwdev_priv->ifname_mon, name, IFNAMSIZ+1); -+ -+out: -+ if (ret && mon_wdev) { -+ rtw_mfree((u8*)mon_wdev, sizeof(struct wireless_dev)); -+ mon_wdev = NULL; -+ } -+ -+ if (ret && mon_ndev) { -+ free_netdev(mon_ndev); -+ *ndev = mon_ndev = NULL; -+ } -+ -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+static struct wireless_dev * -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+static struct net_device * -+#else -+static int -+#endif -+ cfg80211_rtw_add_virtual_intf( -+ struct wiphy *wiphy, -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,0)) -+ const char *name, -+ #else -+ char *name, -+ #endif -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) -+ unsigned char name_assign_type, -+ #endif -+ enum nl80211_iftype type, u32 *flags, struct vif_params *params) -+{ -+ int ret = 0; -+ struct net_device* ndev = NULL; -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ -+ DBG_871X("%s wiphy:%s, name:%s, type:%d\n", -+ __func__, wiphy_name(wiphy), name, type); -+ -+ switch (type) { -+ case NL80211_IFTYPE_ADHOC: -+ case NL80211_IFTYPE_AP_VLAN: -+ case NL80211_IFTYPE_WDS: -+ case NL80211_IFTYPE_MESH_POINT: -+ ret = -ENODEV; -+ break; -+ case NL80211_IFTYPE_MONITOR: -+ ret = rtw_cfg80211_add_monitor_if(padapter, (char *)name, &ndev); -+ break; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ case NL80211_IFTYPE_P2P_CLIENT: -+#endif -+ case NL80211_IFTYPE_STATION: -+ ret = -ENODEV; -+ break; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ case NL80211_IFTYPE_P2P_GO: -+#endif -+ case NL80211_IFTYPE_AP: -+ ret = -ENODEV; -+ break; -+ default: -+ ret = -ENODEV; -+ DBG_871X("Unsupported interface type\n"); -+ break; -+ } -+ -+ DBG_871X("%s ndev:%p, ret:%d\n", __func__, ndev, ret); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ return ndev ? ndev->ieee80211_ptr : ERR_PTR(ret); -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+ return ndev ? ndev : ERR_PTR(ret); -+#else -+ return ret; -+#endif -+} -+ -+static int cfg80211_rtw_del_virtual_intf(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct wireless_dev *wdev -+#else -+ struct net_device *ndev -+#endif -+) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct net_device *ndev = wdev_to_ndev(wdev); -+#endif -+ int ret = 0; -+ _adapter *adapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ if (!ndev) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ adapter = (_adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(adapter); -+ -+ unregister_netdevice(ndev); -+ -+ if (ndev == pwdev_priv->pmon_ndev) { -+ pwdev_priv->pmon_ndev = NULL; -+ pwdev_priv->ifname_mon[0] = '\0'; -+ DBG_871X(FUNC_NDEV_FMT" remove monitor interface\n", FUNC_NDEV_ARG(ndev)); -+ } -+ -+exit: -+ return ret; -+} -+ -+static int rtw_add_beacon(_adapter *adapter, const u8 *head, size_t head_len, const u8 *tail, size_t tail_len) -+{ -+ int ret=0; -+ u8 *pbuf = NULL; -+ uint len, wps_ielen=0; -+ uint p2p_ielen=0; -+ u8 *p2p_ie; -+ u8 got_p2p_ie = _FALSE; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ //struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ -+ DBG_8192C("%s beacon_head_len=%zu, beacon_tail_len=%zu\n", __FUNCTION__, head_len, tail_len); -+ -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return -EINVAL; -+ -+ if(head_len<24) -+ return -EINVAL; -+ -+ -+ pbuf = rtw_zmalloc(head_len+tail_len); -+ if(!pbuf) -+ return -ENOMEM; -+ -+ -+ //_rtw_memcpy(&pstapriv->max_num_sta, param->u.bcn_ie.reserved, 2); -+ -+ //if((pstapriv->max_num_sta>NUM_STA) || (pstapriv->max_num_sta<=0)) -+ // pstapriv->max_num_sta = NUM_STA; -+ -+ -+ _rtw_memcpy(pbuf, (void *)head+24, head_len-24);// 24=beacon header len. -+ _rtw_memcpy(pbuf+head_len-24, (void *)tail, tail_len); -+ -+ len = head_len+tail_len-24; -+ -+ //check wps ie if inclued -+ if(rtw_get_wps_ie(pbuf+_FIXED_IE_LENGTH_, len-_FIXED_IE_LENGTH_, NULL, &wps_ielen)) -+ DBG_8192C("add bcn, wps_ielen=%d\n", wps_ielen); -+ -+#ifdef CONFIG_P2P -+ if( adapter->wdinfo.driver_interface == DRIVER_CFG80211 ) -+ { -+ //check p2p if enable -+ if(rtw_get_p2p_ie(pbuf+_FIXED_IE_LENGTH_, len-_FIXED_IE_LENGTH_, NULL, &p2p_ielen)) -+ { -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct wifidirect_info *pwdinfo= &(adapter->wdinfo); -+ -+ DBG_8192C("got p2p_ie, len=%d\n", p2p_ielen); -+ -+ got_p2p_ie = _TRUE; -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ DBG_8192C("Enable P2P function for the first time\n"); -+ rtw_p2p_enable(adapter, P2P_ROLE_GO); -+ adapter_wdev_data(adapter)->p2p_enabled = _TRUE; -+ -+ adapter->stapriv.expire_to = 3; // 3x2 = 6 sec in p2p mode -+ } -+ else -+ { -+ DBG_8192C("enter GO Mode, p2p_ielen=%d\n", p2p_ielen); -+ -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ pwdinfo->intent = 15; -+ } -+ } -+ } -+#endif // CONFIG_P2P -+ -+ /* pbss_network->IEs will not include p2p_ie, wfd ie */ -+ rtw_ies_remove_ie(pbuf, &len, _BEACON_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, P2P_OUI, 4); -+ rtw_ies_remove_ie(pbuf, &len, _BEACON_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, WFD_OUI, 4); -+ -+ if (rtw_check_beacon_data(adapter, pbuf, len) == _SUCCESS) -+ { -+#ifdef CONFIG_P2P -+ //check p2p if enable -+ if(got_p2p_ie == _TRUE) -+ { -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct wifidirect_info *pwdinfo= &(adapter->wdinfo); -+ pwdinfo->operating_channel = pmlmeext->cur_channel; -+ } -+#endif //CONFIG_P2P -+ ret = 0; -+ } -+ else -+ { -+ ret = -EINVAL; -+ } -+ -+ -+ rtw_mfree(pbuf, head_len+tail_len); -+ -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,4,0)) && !defined(COMPAT_KERNEL_RELEASE) -+static int cfg80211_rtw_add_beacon(struct wiphy *wiphy, struct net_device *ndev, -+ struct beacon_parameters *info) -+{ -+ int ret=0; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ ret = rtw_add_beacon(adapter, info->head, info->head_len, info->tail, info->tail_len); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_set_beacon(struct wiphy *wiphy, struct net_device *ndev, -+ struct beacon_parameters *info) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ pmlmeext->bstart_bss = _TRUE; -+ -+ cfg80211_rtw_add_beacon(wiphy, ndev, info); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_del_beacon(struct wiphy *wiphy, struct net_device *ndev) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+#else -+static int cfg80211_rtw_start_ap(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_ap_settings *settings) -+{ -+ int ret = 0; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ DBG_871X(FUNC_NDEV_FMT" hidden_ssid:%d, auth_type:%d\n", FUNC_NDEV_ARG(ndev), -+ settings->hidden_ssid, settings->auth_type); -+ -+ ret = rtw_add_beacon(adapter, settings->beacon.head, settings->beacon.head_len, -+ settings->beacon.tail, settings->beacon.tail_len); -+ -+ adapter->mlmeextpriv.mlmext_info.hidden_ssid_mode = settings->hidden_ssid; -+ -+ if (settings->ssid && settings->ssid_len) { -+ WLAN_BSSID_EX *pbss_network = &adapter->mlmepriv.cur_network.network; -+ WLAN_BSSID_EX *pbss_network_ext = &adapter->mlmeextpriv.mlmext_info.network; -+ -+ if(0) -+ DBG_871X(FUNC_ADPT_FMT" ssid:(%s,%zu), from ie:(%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ settings->ssid, settings->ssid_len, -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength); -+ -+ _rtw_memcpy(pbss_network->Ssid.Ssid, (void *)settings->ssid, settings->ssid_len); -+ pbss_network->Ssid.SsidLength = settings->ssid_len; -+ _rtw_memcpy(pbss_network_ext->Ssid.Ssid, (void *)settings->ssid, settings->ssid_len); -+ pbss_network_ext->Ssid.SsidLength = settings->ssid_len; -+ -+ if(0) -+ DBG_871X(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, -+ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); -+ } -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_change_beacon(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_beacon_data *info) -+{ -+ int ret = 0; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ ret = rtw_add_beacon(adapter, info->head, info->head_len, info->tail, info->tail_len); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_stop_ap(struct wiphy *wiphy, struct net_device *ndev) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+#endif //(LINUX_VERSION_CODE < KERNEL_VERSION(3,4,0)) -+ -+static int cfg80211_rtw_add_station(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,16,0)) -+ u8 *mac, -+#else -+ const u8 *mac, -+#endif -+ struct station_parameters *params) -+{ -+ int ret = 0; -+#ifdef CONFIG_TDLS -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+#endif /* CONFIG_TDLS */ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+#ifdef CONFIG_TDLS -+ psta = rtw_get_stainfo(pstapriv, mac); -+ if (psta == NULL) { -+ psta = rtw_alloc_stainfo(pstapriv, mac); -+ if (psta ==NULL) { -+ DBG_871X("[%s] Alloc station for "MAC_FMT" fail\n", __FUNCTION__, MAC_ARG(mac)); -+ ret =-EOPNOTSUPP; -+ goto exit; -+ } -+ } -+#endif /* CONFIG_TDLS */ -+ -+exit: -+ return ret; -+} -+ -+static int cfg80211_rtw_del_station(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,16,0)) -+ u8 *mac -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 0)) -+ const u8 *mac -+#else -+ struct station_del_parameters *params -+#endif -+ ) -+{ -+ int ret=0; -+ _irqL irqL; -+ _list *phead, *plist; -+ u8 updated = _FALSE; -+ const u8 *target_mac; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("+"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 0)) -+ target_mac = mac; -+#else -+ target_mac = params->mac; -+#endif -+ -+ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != _TRUE) -+ { -+ DBG_8192C("%s, fw_state != FW_LINKED|WIFI_AP_STATE\n", __func__); -+ return -EINVAL; -+ } -+ -+ -+ if (!target_mac) -+ { -+ DBG_8192C("flush all sta, and cam_entry\n"); -+ -+ flush_all_cam_entry(padapter); //clear CAM -+ -+ ret = rtw_sta_flush(padapter, _TRUE); -+ -+ return ret; -+ } -+ -+ -+ DBG_8192C("free sta macaddr =" MAC_FMT "\n", MAC_ARG(target_mac)); -+ -+ if (target_mac[0] == 0xff && target_mac[1] == 0xff && -+ target_mac[2] == 0xff && target_mac[3] == 0xff && -+ target_mac[4] == 0xff && target_mac[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ //check asoc_queue -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ if (_rtw_memcmp((u8 *)target_mac, psta->hwaddr, ETH_ALEN)) -+ { -+ if(psta->dot8021xalg == 1 && psta->bpairwise_key_installed == _FALSE) -+ { -+ DBG_8192C("%s, sta's dot8021xalg = 1 and key_installed = _FALSE\n", __func__); -+ } -+ else -+ { -+ DBG_8192C("free psta=%p, aid=%d\n", psta, psta->aid); -+ -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ -+ //_exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (check_fwstate(pmlmepriv, (WIFI_AP_STATE)) == _TRUE) -+ updated = ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_PREV_AUTH_NOT_VALID, _TRUE); -+ else -+ updated = ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); -+ //_enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ psta = NULL; -+ -+ break; -+ } -+ -+ } -+ -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); -+ -+ DBG_871X("-"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_change_station(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,16,0)) -+ u8 *mac, -+#else -+ const u8 *mac, -+#endif -+ struct station_parameters *params) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+ -+struct sta_info *rtw_sta_info_get_by_idx(const int idx, struct sta_priv *pstapriv) -+ -+{ -+ _list *phead, *plist; -+ struct sta_info *psta = NULL; -+ int i = 0; -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ //check asoc_queue -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) -+ { -+ if(idx == i) psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ i++; -+ } -+ return psta; -+} -+ -+static int cfg80211_rtw_dump_station(struct wiphy *wiphy, struct net_device *ndev, -+ int idx, u8 *mac, struct station_info *sinfo) -+{ -+ -+ int ret = 0; -+ _irqL irqL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ psta = rtw_sta_info_get_by_idx(idx, pstapriv); -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if(NULL == psta) -+ { -+ DBG_871X("Station is not found\n"); -+ ret = -ENOENT; -+ goto exit; -+ } -+ _rtw_memcpy(mac, psta->hwaddr, ETH_ALEN); -+ sinfo->filled = 0; -+ sinfo->filled |= STATION_INFO_SIGNAL; -+ sinfo->signal = psta->rssi; -+ -+exit: -+ return ret; -+} -+ -+static int cfg80211_rtw_change_bss(struct wiphy *wiphy, struct net_device *ndev, -+ struct bss_parameters *params) -+{ -+ u8 i; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+/* -+ DBG_8192C("use_cts_prot=%d\n", params->use_cts_prot); -+ DBG_8192C("use_short_preamble=%d\n", params->use_short_preamble); -+ DBG_8192C("use_short_slot_time=%d\n", params->use_short_slot_time); -+ DBG_8192C("ap_isolate=%d\n", params->ap_isolate); -+ -+ DBG_8192C("basic_rates_len=%d\n", params->basic_rates_len); -+ for(i=0; ibasic_rates_len; i++) -+ { -+ DBG_8192C("basic_rates=%d\n", params->basic_rates[i]); -+ -+ } -+*/ -+ return 0; -+ -+} -+ -+static int cfg80211_rtw_set_channel(struct wiphy *wiphy -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ , struct net_device *ndev -+ #endif -+ , struct ieee80211_channel *chan, enum nl80211_channel_type channel_type) -+{ -+ int chan_target = (u8) ieee80211_frequency_to_channel(chan->center_freq); -+ int chan_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ int chan_width = CHANNEL_WIDTH_20; -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ #endif -+ -+ switch (channel_type) { -+ case NL80211_CHAN_NO_HT: -+ case NL80211_CHAN_HT20: -+ chan_width = CHANNEL_WIDTH_20; -+ chan_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case NL80211_CHAN_HT40MINUS: -+ chan_width = CHANNEL_WIDTH_40; -+ chan_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ case NL80211_CHAN_HT40PLUS: -+ chan_width = CHANNEL_WIDTH_40; -+ chan_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ default: -+ chan_width = CHANNEL_WIDTH_20; -+ chan_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ -+ set_channel_bwmode(padapter, chan_target, chan_offset, chan_width); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_auth(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_auth_request *req) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_assoc(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_assoc_request *req) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+#endif //CONFIG_AP_MODE -+ -+void rtw_cfg80211_rx_probe_request(_adapter *adapter, u8 *frame, uint frame_len) -+{ -+ s32 freq; -+ int channel; -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); -+ u8 category, action; -+ -+ channel = rtw_get_oper_ch(adapter); -+ freq = rtw_ch2freq(channel); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("RTW_Rx: probe request, cur_ch=%d\n", channel); -+#endif /* CONFIG_DEBUG_CFG80211 */ -+ rtw_cfg80211_rx_mgmt(adapter, freq, 0, frame, frame_len, GFP_ATOMIC); -+} -+ -+void rtw_cfg80211_rx_action_p2p(_adapter *padapter, u8 *pmgmt_frame, uint frame_len) -+{ -+ int type; -+ s32 freq; -+ int channel; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ u8 category, action; -+ -+ channel = rtw_get_oper_ch(padapter); -+ -+ DBG_8192C("RTW_Rx:cur_ch=%d\n", channel); -+ #ifdef CONFIG_P2P -+ type = rtw_p2p_check_frames(padapter, pmgmt_frame, frame_len, _FALSE); -+ if (type >= 0) -+ goto indicate; -+ #endif -+ rtw_action_frame_parse(pmgmt_frame, frame_len, &category, &action); -+ DBG_871X("RTW_Rx:category(%u), action(%u)\n", category, action); -+ -+indicate: -+ freq = rtw_ch2freq(channel); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ rtw_cfg80211_rx_mgmt(padapter, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); -+#else -+ cfg80211_rx_action(padapter->pnetdev, freq, pmgmt_frame, frame_len, GFP_ATOMIC); -+#endif -+} -+ -+void rtw_cfg80211_rx_p2p_action_public(_adapter *padapter, u8 *pmgmt_frame, uint frame_len) -+{ -+ int type; -+ s32 freq; -+ int channel; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ u8 category, action; -+ -+ channel = rtw_get_oper_ch(padapter); -+ -+ DBG_8192C("RTW_Rx:cur_ch=%d\n", channel); -+ #ifdef CONFIG_P2P -+ type = rtw_p2p_check_frames(padapter, pmgmt_frame, frame_len, _FALSE); -+ if (type >= 0) { -+ switch (type) { -+ case P2P_GO_NEGO_CONF: -+ case P2P_PROVISION_DISC_RESP: -+ case P2P_INVIT_RESP: -+ rtw_set_scan_deny(padapter, 2000); -+ rtw_clear_scan_deny(padapter); -+ } -+ goto indicate; -+ } -+ #endif -+ rtw_action_frame_parse(pmgmt_frame, frame_len, &category, &action); -+ DBG_871X("RTW_Rx:category(%u), action(%u)\n", category, action); -+ -+indicate: -+ freq = rtw_ch2freq(channel); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ rtw_cfg80211_rx_mgmt(padapter, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); -+#else -+ cfg80211_rx_action(padapter->pnetdev, freq, pmgmt_frame, frame_len, GFP_ATOMIC); -+#endif -+} -+ -+void rtw_cfg80211_rx_action(_adapter *adapter, u8 *frame, uint frame_len, const char*msg) -+{ -+ s32 freq; -+ int channel; -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); -+ u8 category, action; -+ -+ channel = rtw_get_oper_ch(adapter); -+ -+ rtw_action_frame_parse(frame, frame_len, &category, &action); -+ -+ if (action == ACT_PUBLIC_GAS_INITIAL_REQ) { -+ rtw_set_scan_deny(adapter, 200); -+ rtw_scan_abort_no_wait(adapter); -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(adapter)) -+ rtw_scan_abort_no_wait(adapter->pbuddy_adapter); -+ #endif -+ } -+ -+ freq = rtw_ch2freq(channel); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ rtw_cfg80211_rx_mgmt(adapter, freq, 0, frame, frame_len, GFP_ATOMIC); -+#else -+ cfg80211_rx_action(adapter->pnetdev, freq, frame, frame_len, GFP_ATOMIC); -+#endif -+ -+ DBG_8192C("RTW_Rx:cur_ch=%d\n", channel); -+ if (msg) -+ DBG_871X("RTW_Rx:%s\n", msg); -+ else -+ DBG_871X("RTW_Rx:category(%u), action(%u)\n", category, action); -+} -+ -+#ifdef CONFIG_P2P -+void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, size_t len) -+{ -+ u16 wps_devicepassword_id = 0x0000; -+ uint wps_devicepassword_id_len = 0; -+ u8 wpsie[ 255 ] = { 0x00 }, p2p_ie[ 255 ] = { 0x00 }; -+ uint p2p_ielen = 0; -+ uint wpsielen = 0; -+ u32 devinfo_contentlen = 0; -+ u8 devinfo_content[64] = { 0x00 }; -+ u16 capability = 0; -+ uint capability_len = 0; -+ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u8 dialogToken = 1; -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_PROVISION_DISC_REQ; -+ u32 p2pielen = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 *frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ size_t frame_body_len = len - sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ -+ DBG_871X( "[%s] In\n", __FUNCTION__ ); -+ -+ //prepare for building provision_request frame -+ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerIFAddr, GetAddr1Ptr(buf), ETH_ALEN); -+ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerDevAddr, GetAddr1Ptr(buf), ETH_ALEN); -+ -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON; -+ -+ rtw_get_wps_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, wpsie, &wpsielen); -+ rtw_get_wps_attr_content( wpsie, wpsielen, WPS_ATTR_DEVICE_PWID, (u8*) &wps_devicepassword_id, &wps_devicepassword_id_len); -+ wps_devicepassword_id = be16_to_cpu( wps_devicepassword_id ); -+ -+ switch(wps_devicepassword_id) -+ { -+ case WPS_DPID_PIN: -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_LABEL; -+ break; -+ case WPS_DPID_USER_SPEC: -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_DISPLYA; -+ break; -+ case WPS_DPID_MACHINE_SPEC: -+ break; -+ case WPS_DPID_REKEY: -+ break; -+ case WPS_DPID_PBC: -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON; -+ break; -+ case WPS_DPID_REGISTRAR_SPEC: -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_KEYPAD; -+ break; -+ default: -+ break; -+ } -+ -+ -+ if ( rtw_get_p2p_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, p2p_ie, &p2p_ielen ) ) -+ { -+ -+ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO, devinfo_content, &devinfo_contentlen); -+ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8*)&capability, &capability_len); -+ -+ } -+ -+ -+ //start to build provision_request frame -+ _rtw_memset(wpsie, 0, sizeof(wpsie)); -+ _rtw_memset(p2p_ie, 0, sizeof(p2p_ie)); -+ p2p_ielen = 0; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, pwdinfo->tx_prov_disc_info.peerDevAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->tx_prov_disc_info.peerDevAddr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ -+ //build_prov_disc_request_p2p_ie -+ // P2P OUI -+ p2pielen = 0; -+ p2p_ie[ p2pielen++ ] = 0x50; -+ p2p_ie[ p2pielen++ ] = 0x6F; -+ p2p_ie[ p2pielen++ ] = 0x9A; -+ p2p_ie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // Commented by Albert 20110301 -+ // According to the P2P Specification, the provision discovery request frame should contain 3 P2P attributes -+ // 1. P2P Capability -+ // 2. Device Info -+ // 3. Group ID ( When joining an operating P2P Group ) -+ -+ // P2P Capability ATTR -+ // Type: -+ p2p_ie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; -+ -+ // Length: -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ RTW_PUT_LE16(p2p_ie + p2pielen, 0x0002); -+ p2pielen += 2; -+ -+ // Value: -+ // Device Capability Bitmap, 1 byte -+ // Group Capability Bitmap, 1 byte -+ _rtw_memcpy(p2p_ie + p2pielen, &capability, 2); -+ p2pielen += 2; -+ -+ -+ // Device Info ATTR -+ // Type: -+ p2p_ie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) -+ // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); -+ RTW_PUT_LE16(p2p_ie + p2pielen, devinfo_contentlen); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy(p2p_ie + p2pielen, devinfo_content, devinfo_contentlen); -+ p2pielen += devinfo_contentlen; -+ -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2p_ie, &p2p_ielen); -+ //p2pielen = build_prov_disc_request_p2p_ie( pwdinfo, pframe, NULL, 0, pwdinfo->tx_prov_disc_info.peerDevAddr); -+ //pframe += p2pielen; -+ pattrib->pktlen += p2p_ielen; -+ -+ wpsielen = 0; -+ // WPS OUI -+ *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); -+ wpsielen += 4; -+ -+ // WPS version -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_VERSION_1; // Version 1.0 -+ -+ // Config Method -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); -+ wpsielen += 2; -+ -+ // Value: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->tx_prov_disc_info.wps_config_method_request ); -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); -+ -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_provdisc_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif //CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ //dump_mgntframe(padapter, pmgntframe); -+ if (dump_mgntframe_and_wait_ack(padapter, pmgntframe) != _SUCCESS) -+ DBG_8192C("%s, ack to\n", __func__); -+ -+ //if(wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC) -+ //{ -+ // DBG_8192C("waiting for p2p peer key-in PIN CODE\n"); -+ // rtw_msleep_os(15000); // 15 sec for key in PIN CODE, workaround for GS2 before issuing Nego Req. -+ //} -+ -+} -+ -+static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct wireless_dev *wdev, -+#else -+ struct net_device *ndev, -+#endif -+ struct ieee80211_channel * channel, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) -+ enum nl80211_channel_type channel_type, -+#endif -+ unsigned int duration, u64 *cookie) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct net_device *ndev = wdev_to_ndev(wdev); -+#endif -+ s32 err = 0; -+ u8 remain_ch = (u8) ieee80211_frequency_to_channel(channel->center_freq); -+ u8 ready_on_channel = _FALSE; -+ _adapter *padapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ struct mlme_ext_priv *pmlmeext; -+ struct wifidirect_info *pwdinfo; -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo; -+ u8 is_p2p_find = _FALSE; -+ -+#ifndef CONFIG_RADIO_WORK -+ #define RTW_ROCH_DURATION_ENLARGE -+ #define RTW_ROCH_BACK_OP -+#endif -+ -+ if (ndev == NULL) { -+ return -EINVAL; -+ } -+ -+ padapter = (_adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(padapter); -+ pmlmeext = &padapter->mlmeextpriv; -+ pwdinfo = &padapter->wdinfo; -+ pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+ #ifdef CONFIG_CONCURRENT_MODE -+ is_p2p_find=(duration < (pwdinfo->ext_listen_interval))? _TRUE : _FALSE; -+ #endif -+ -+ *cookie = ATOMIC_INC_RETURN(&pcfg80211_wdinfo->ro_ch_cookie_gen); -+ -+ DBG_871X(FUNC_ADPT_FMT" ch:%u duration:%d, cookie:0x%llx\n", FUNC_ADPT_ARG(padapter), remain_ch, duration, *cookie); -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) { -+ DBG_871X(FUNC_ADPT_FMT ": MP mode block remain_on_channel request\n", FUNC_ADPT_ARG(padapter)); -+ err = -EFAULT; -+ goto exit; -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->pbuddy_adapter) { -+ if (padapter->pbuddy_adapter->registrypriv.mp_mode == 1) { -+ DBG_871X(FUNC_ADPT_FMT ": MP mode block remain_on_channel request\n", FUNC_ADPT_ARG(padapter->pbuddy_adapter)); -+ err = -EFAULT; -+ goto exit; -+ } -+ } -+#endif -+#endif -+ -+ if(pcfg80211_wdinfo->is_ro_ch == _TRUE) -+ { -+ DBG_8192C("%s, cancel ro ch timer\n", __func__); -+ _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); -+ #ifdef CONFIG_CONCURRENT_MODE -+ ATOMIC_SET(&pwdev_priv->ro_ch_to, 1); -+ #endif //CONFIG_CONCURRENT_MODE -+ p2p_protocol_wk_hdl(padapter, P2P_RO_CH_WK); -+ } -+ -+ pcfg80211_wdinfo->is_ro_ch = _TRUE; -+ pcfg80211_wdinfo->last_ro_ch_time = rtw_get_current_time(); -+ -+ if(_FAIL == rtw_pwr_wakeup(padapter)) { -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ _rtw_memcpy(&pcfg80211_wdinfo->remain_on_ch_channel, channel, sizeof(struct ieee80211_channel)); -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) -+ pcfg80211_wdinfo->remain_on_ch_type= channel_type; -+ #endif -+ pcfg80211_wdinfo->remain_on_ch_cookie= *cookie; -+ -+ rtw_scan_abort(padapter); -+#ifdef CONFIG_CONCURRENT_MODE -+ if ((rtw_buddy_adapter_up(padapter)) && is_p2p_find) //don't scan_abort during p2p_listen. -+ rtw_scan_abort(padapter->pbuddy_adapter); -+#endif //CONFIG_CONCURRENT_MODE -+ -+ if (check_fwstate(&padapter->mlmepriv, _FW_UNDER_LINKING|WIFI_UNDER_WPS) == _TRUE) -+ { -+ DBG_871X("mlme state:0x%x\n", get_fwstate(&padapter->mlmepriv)); -+ remain_ch = padapter->mlmeextpriv.cur_channel; -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, _FW_UNDER_LINKING|WIFI_UNDER_WPS) == _TRUE) -+ { -+ DBG_871X("buddy_intf's mlme state:0x%x\n", get_fwstate(&(padapter->pbuddy_adapter->mlmepriv))); -+ remain_ch = padapter->pbuddy_adapter->mlmeextpriv.cur_channel; -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ //if(!rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) && !rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); -+ adapter_wdev_data(padapter)->p2p_enabled = _TRUE; -+ padapter->wdinfo.listen_channel = remain_ch; -+ } else if (rtw_p2p_chk_state(pwdinfo , P2P_STATE_LISTEN)) { -+ padapter->wdinfo.listen_channel = remain_ch; -+ } else { -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); -+#endif -+ } -+ -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); -+ -+ #ifdef RTW_ROCH_DURATION_ENLARGE -+ if (duration < 400) -+ duration = duration * 3; /* extend from exper */ -+ #endif -+ -+#ifdef RTW_ROCH_BACK_OP -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, _FW_LINKED)) { -+ if (is_p2p_find) /* p2p_find , duration<1000 */ -+ duration = duration + pwdinfo->ext_listen_interval; -+ else /* p2p_listen, duration=5000 */ -+ duration = pwdinfo->ext_listen_interval + (pwdinfo->ext_listen_interval / 4); -+ } -+#endif -+#endif /* RTW_ROCH_BACK_OP */ -+ -+ pcfg80211_wdinfo->restore_channel = rtw_get_oper_ch(padapter); -+ -+ if(rtw_ch_set_search_ch(pmlmeext->channel_set, remain_ch) >= 0) { -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED) ) -+ { -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ if((remain_ch != pbuddy_mlmeext->cur_channel) && !check_fwstate(&padapter->mlmepriv, _FW_LINKED)) -+ { -+ if(ATOMIC_READ(&pwdev_priv->switch_ch_to)==1 || -+ (remain_ch != pmlmeext->cur_channel)) -+ { -+ if (check_buddy_fwstate(padapter, WIFI_FW_STATION_STATE)) { -+ DBG_8192C("%s, issue nulldata pwrbit=1\n", __func__); -+ issue_nulldata(padapter->pbuddy_adapter, NULL, 1, 3, 500); -+ } -+ -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); -+ -+ #ifdef RTW_ROCH_BACK_OP -+ DBG_8192C("%s, set switch ch timer, duration=%d\n", __func__, duration-pwdinfo->ext_listen_interval); -+ _set_timer(&pwdinfo->ap_p2p_switch_timer, duration-pwdinfo->ext_listen_interval); -+ #endif -+ } -+ } -+ -+ ready_on_channel = _TRUE; -+ //pmlmeext->cur_channel = remain_ch; -+ //set_channel_bwmode(padapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ }else -+#endif //CONFIG_CONCURRENT_MODE -+ if(remain_ch != rtw_get_oper_ch(padapter) ) -+ { -+ ready_on_channel = _TRUE; -+ //pmlmeext->cur_channel = remain_ch; -+ //set_channel_bwmode(padapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ } else { -+ DBG_871X("%s remain_ch:%u not in channel plan!!!!\n", __FUNCTION__, remain_ch); -+ } -+ -+ -+ //call this after other things have been done -+#ifdef CONFIG_CONCURRENT_MODE -+ if(ATOMIC_READ(&pwdev_priv->ro_ch_to)==1 || -+ (remain_ch != rtw_get_oper_ch(padapter))) -+ { -+ u8 co_channel = 0xff; -+ ATOMIC_SET(&pwdev_priv->ro_ch_to, 0); -+#endif -+ -+ if(ready_on_channel == _TRUE) -+ { -+ if ( !check_fwstate(&padapter->mlmepriv, _FW_LINKED ) ) -+ { -+ pmlmeext->cur_channel = remain_ch; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ co_channel = rtw_get_oper_ch(padapter); -+ -+ if(co_channel !=remain_ch) -+#endif -+ { -+ //if (!padapter->mlmepriv.LinkDetectInfo.bBusyTraffic) -+ set_channel_bwmode(padapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ } -+ } -+ DBG_8192C("%s, set ro ch timer, duration=%d\n", __func__, duration); -+ _set_timer( &pcfg80211_wdinfo->remain_on_ch_timer, duration); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ } -+#endif -+ -+ rtw_cfg80211_ready_on_channel(padapter, *cookie, channel, channel_type, duration, GFP_KERNEL); -+ -+exit: -+ if (err) { -+ pcfg80211_wdinfo->is_ro_ch = _FALSE; -+ pcfg80211_wdinfo->last_ro_ch_time = rtw_get_current_time(); -+ } -+ -+ return err; -+} -+ -+static s32 cfg80211_rtw_cancel_remain_on_channel(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct wireless_dev *wdev, -+#else -+ struct net_device *ndev, -+#endif -+ u64 cookie) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct net_device *ndev = wdev_to_ndev(wdev); -+#endif -+ s32 err = 0; -+ _adapter *padapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ struct wifidirect_info *pwdinfo; -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo; -+ -+ if (ndev == NULL) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ padapter = (_adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(padapter); -+ pwdinfo = &padapter->wdinfo; -+ pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+ -+ DBG_871X(FUNC_ADPT_FMT" cookie:0x%llx\n", FUNC_ADPT_ARG(padapter), cookie); -+ -+ if (pcfg80211_wdinfo->is_ro_ch == _TRUE) { -+ DBG_8192C("%s, cancel ro ch timer\n", __func__); -+ _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); -+ #ifdef CONFIG_CONCURRENT_MODE -+ ATOMIC_SET(&pwdev_priv->ro_ch_to, 1); -+ #endif -+ p2p_protocol_wk_hdl(padapter, P2P_RO_CH_WK); -+ } -+ -+ #if 0 -+ // Disable P2P Listen State -+ if(!rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) && !rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE); -+ _rtw_memset(pwdinfo, 0x00, sizeof(struct wifidirect_info)); -+ } -+ } -+ else -+ #endif -+ { -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); -+#endif -+ } -+ -+ pcfg80211_wdinfo->is_ro_ch = _FALSE; -+ pcfg80211_wdinfo->last_ro_ch_time = rtw_get_current_time(); -+ -+exit: -+ return err; -+} -+ -+#endif //CONFIG_P2P -+ -+static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, const u8 *buf, size_t len, int wait_ack) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ int ret = _FAIL; -+ bool ack = _TRUE; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif //CONFIG_P2P -+ //struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+ -+ rtw_set_scan_deny(padapter, 1000); -+ -+ rtw_scan_abort(padapter); -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(rtw_buddy_adapter_up(padapter)) -+ rtw_scan_abort(padapter->pbuddy_adapter); -+ #endif /* CONFIG_CONCURRENT_MODE */ -+#ifdef CONFIG_P2P -+ if (padapter->cfg80211_wdinfo.is_ro_ch == _TRUE) { -+ //DBG_8192C("%s, cancel ro ch timer\n", __func__); -+ //_cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); -+ //padapter->cfg80211_wdinfo.is_ro_ch = _FALSE; -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED )) -+ { -+ DBG_8192C("%s, extend ro ch time\n", __func__); -+ _set_timer( &padapter->cfg80211_wdinfo.remain_on_ch_timer, pwdinfo->ext_listen_period); -+ } -+ #endif //CONFIG_CONCURRENT_MODE -+ } -+#endif //CONFIG_P2P -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, _FW_LINKED )) { -+ u8 co_channel=0xff; -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ co_channel = rtw_get_oper_ch(padapter); -+ -+ if (tx_ch != pbuddy_mlmeext->cur_channel) { -+ -+ u16 ext_listen_period; -+ -+ if (ATOMIC_READ(&pwdev_priv->switch_ch_to)==1) { -+ if (check_buddy_fwstate(padapter, WIFI_FW_STATION_STATE)) { -+ DBG_8192C("%s, issue nulldata pwrbit=1\n", __func__); -+ issue_nulldata(padapter->pbuddy_adapter, NULL, 1, 3, 500); -+ } -+ -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); -+ -+ //DBG_8192C("%s, set switch ch timer, period=%d\n", __func__, pwdinfo->ext_listen_period); -+ //_set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_period); -+ } -+ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED )) -+ { -+ ext_listen_period = 500;// 500ms -+ } -+ else -+ { -+ ext_listen_period = pwdinfo->ext_listen_period; -+ } -+ -+ DBG_8192C("%s, set switch ch timer, period=%d\n", __func__, ext_listen_period); -+ _set_timer(&pwdinfo->ap_p2p_switch_timer, ext_listen_period); -+ -+ } -+ -+ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED )) -+ pmlmeext->cur_channel = tx_ch; -+ -+ if (tx_ch != co_channel) -+ set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ }else -+#endif //CONFIG_CONCURRENT_MODE -+ //if (tx_ch != pmlmeext->cur_channel) { -+ if(tx_ch != rtw_get_oper_ch(padapter)) { -+ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED )) -+ pmlmeext->cur_channel = tx_ch; -+ set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ -+ //starting alloc mgmt frame to dump it -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ //ret = -ENOMEM; -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = _FALSE; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ _rtw_memcpy(pframe, (void*)buf, len); -+ pattrib->pktlen = len; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ //update seq number -+ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ pmlmeext->mgnt_seq++; -+ -+#ifdef CONFIG_WFD -+ { -+ struct wifi_display_info *pwfd_info; -+ -+ pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if ( _TRUE == pwfd_info->wfd_enable ) -+ { -+ rtw_append_wfd_ie( padapter, pframe, &pattrib->pktlen ); -+ } -+ } -+#endif // CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if (wait_ack) { -+ if (dump_mgntframe_and_wait_ack(padapter, pmgntframe) != _SUCCESS) { -+ ack = _FALSE; -+ ret = _FAIL; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ack == _FAIL\n", __func__); -+#endif -+ } else { -+ -+#ifdef CONFIG_XMIT_ACK -+ rtw_msleep_os(50); -+#endif -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ack=%d, ok!\n", __func__, ack); -+#endif -+ ret = _SUCCESS; -+ } -+ } else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+exit: -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ret=%d\n", __func__, ret); -+ #endif -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct wireless_dev *wdev, -+#else -+ struct net_device *ndev, -+#endif -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,14,0)) || defined(COMPAT_KERNEL_RELEASE) -+ struct ieee80211_channel *chan, -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+ bool offchan, -+ #endif -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) -+ enum nl80211_channel_type channel_type, -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ bool channel_type_valid, -+ #endif -+ #endif -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+ unsigned int wait, -+ #endif -+ const u8 *buf, size_t len, -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,2,0)) -+ bool no_cck, -+ #endif -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,3,0)) -+ bool dont_wait_for_ack, -+ #endif -+#else -+ struct cfg80211_mgmt_tx_params *params, -+#endif -+ u64 *cookie) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct net_device *ndev = wdev_to_ndev(wdev); -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,14,0)) || defined(COMPAT_KERNEL_RELEASE) -+ struct ieee80211_channel *chan = params->chan; -+ bool offchan = params->offchan; -+ unsigned int wait = params->wait; -+ const u8 *buf = params->buf; -+ size_t len = params->len; -+ bool no_cck = params->no_cck; -+ bool dont_wait_for_ack = params->dont_wait_for_ack; -+#endif -+ int ret = 0; -+ int tx_ret; -+ int wait_ack = 1; -+ u32 dump_limit = RTW_MAX_MGMT_TX_CNT; -+ u32 dump_cnt = 0; -+ bool ack = _TRUE; -+ u8 tx_ch; -+ u8 category, action; -+ u8 frame_styp; -+ int type = (-1); -+ u32 start = rtw_get_current_time(); -+ _adapter *padapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ if ((ndev == NULL) || (chan == NULL)) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ tx_ch = (u8)ieee80211_frequency_to_channel(chan->center_freq); -+ -+ padapter = (_adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(padapter); -+ -+ /* cookie generation */ -+ *cookie = (unsigned long) buf; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X(FUNC_ADPT_FMT" len=%zu, ch=%d" -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) -+ ", ch_type=%d" -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ ", channel_type_valid=%d" -+ #endif -+ #endif -+ "\n", FUNC_ADPT_ARG(padapter), -+ len, tx_ch -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) -+ , channel_type -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ , channel_type_valid -+ #endif -+ #endif -+ ); -+#endif /* CONFIG_DEBUG_CFG80211 */ -+ -+ /* indicate ack before issue frame to avoid racing with rsp frame */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ rtw_cfg80211_mgmt_tx_status(padapter, *cookie, buf, len, ack, GFP_KERNEL); -+#elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,34) && LINUX_VERSION_CODE<=KERNEL_VERSION(2,6,35)) -+ cfg80211_action_tx_status(ndev, *cookie, buf, len, ack, GFP_KERNEL); -+#endif -+ -+ frame_styp = le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl) & IEEE80211_FCTL_STYPE; -+ if (IEEE80211_STYPE_PROBE_RESP == frame_styp) { -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("RTW_Tx: probe_resp tx_ch=%d, da="MAC_FMT"\n", tx_ch, MAC_ARG(GetAddr1Ptr(buf))); -+#endif /* CONFIG_DEBUG_CFG80211 */ -+ wait_ack = 0; -+ goto dump; -+ } -+ -+ if (rtw_action_frame_parse(buf, len, &category, &action) == _FALSE) { -+ DBG_8192C(FUNC_ADPT_FMT" frame_control:0x%x\n", FUNC_ADPT_ARG(padapter), -+ le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl)); -+ goto exit; -+ } -+ -+ DBG_8192C("RTW_Tx:tx_ch=%d, da="MAC_FMT"\n", tx_ch, MAC_ARG(GetAddr1Ptr(buf))); -+ #ifdef CONFIG_P2P -+ if((type = rtw_p2p_check_frames(padapter, buf, len, _TRUE)) >= 0) { -+ goto dump; -+ } -+ #endif -+ if (category == RTW_WLAN_CATEGORY_PUBLIC) -+ DBG_871X("RTW_Tx:%s\n", action_public_str(action)); -+ else -+ DBG_871X("RTW_Tx:category(%u), action(%u)\n", category, action); -+ -+dump: -+ -+ rtw_ps_deny(padapter, PS_DENY_MGNT_TX); -+ if(_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = -EFAULT; -+ goto cancel_ps_deny; -+ } -+ -+ while (1) { -+ u32 sleep_ms = 0; -+ u32 retry_guarantee_ms = 0; -+ -+ dump_cnt++; -+ tx_ret = _cfg80211_rtw_mgmt_tx(padapter, tx_ch, buf, len, wait_ack); -+ -+ switch (action) { -+ case ACT_PUBLIC_GAS_INITIAL_REQ: -+ case ACT_PUBLIC_GAS_INITIAL_RSP: -+ sleep_ms = 50; -+ retry_guarantee_ms = RTW_MAX_MGMT_TX_MS_GAS; -+ } -+ -+ if (tx_ret == _SUCCESS -+ || (dump_cnt >= dump_limit && rtw_get_passing_time_ms(start) >= retry_guarantee_ms)) -+ break; -+ -+ if (sleep_ms > 0) -+ rtw_msleep_os(sleep_ms); -+ } -+ -+ if (tx_ret != _SUCCESS || dump_cnt > 1) { -+ DBG_871X(FUNC_ADPT_FMT" %s (%d/%d) in %d ms\n", FUNC_ADPT_ARG(padapter), -+ tx_ret==_SUCCESS?"OK":"FAIL", dump_cnt, dump_limit, rtw_get_passing_time_ms(start)); -+ } -+ -+ switch (type) { -+ case P2P_GO_NEGO_CONF: -+ rtw_clear_scan_deny(padapter); -+ break; -+ case P2P_INVIT_RESP: -+ if (pwdev_priv->invit_info.flags & BIT(0) -+ && pwdev_priv->invit_info.status == 0) -+ { -+ DBG_871X(FUNC_ADPT_FMT" agree with invitation of persistent group\n", -+ FUNC_ADPT_ARG(padapter)); -+ rtw_set_scan_deny(padapter, 5000); -+ rtw_pwr_wakeup_ex(padapter, 5000); -+ rtw_clear_scan_deny(padapter); -+ } -+ break; -+ } -+ -+cancel_ps_deny: -+ rtw_ps_deny_cancel(padapter, PS_DENY_MGNT_TX); -+exit: -+ return ret; -+} -+ -+static void cfg80211_rtw_mgmt_frame_register(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ struct wireless_dev *wdev, -+#else -+ struct net_device *ndev, -+#endif -+ u16 frame_type, bool reg) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct net_device *ndev = wdev_to_ndev(wdev); -+#endif -+ _adapter *adapter; -+ -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ if (ndev == NULL) -+ goto exit; -+ -+ adapter = (_adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(adapter); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X(FUNC_ADPT_FMT" frame_type:%x, reg:%d\n", FUNC_ADPT_ARG(adapter), -+ frame_type, reg); -+#endif -+ -+ /* Wait QC Verify */ -+ return; -+ -+ switch (frame_type) { -+ case IEEE80211_STYPE_PROBE_REQ: /* 0x0050 */ -+ SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_PROBE_REQ, reg); -+ break; -+ case IEEE80211_STYPE_ACTION: /* 0x00D0 */ -+ SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_ACTION, reg); -+ break; -+ default: -+ break; -+ } -+ -+exit: -+ return; -+} -+ -+#if defined(CONFIG_TDLS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3,2,0)) -+static int cfg80211_rtw_tdls_mgmt(struct wiphy *wiphy, -+ struct net_device *ndev, -+ u8 *peer, -+ u8 action_code, -+ u8 dialog_token, -+ u16 status_code, -+ const u8 *buf, -+ size_t len) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ int ret = 0; -+ struct tdls_txmgmt txmgmt; -+ -+ if (rtw_tdls_is_driver_setup(padapter)) { -+ DBG_871X("Discard tdls action:%d, let driver to set up direct link\n", action_code); -+ goto discard; -+ } -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ _rtw_memcpy(txmgmt.peer, peer, ETH_ALEN); -+ txmgmt.action_code = action_code; -+ txmgmt.dialog_token= dialog_token; -+ txmgmt.status_code = status_code; -+ txmgmt.len = len; -+ txmgmt.buf = (u8 *)rtw_malloc(txmgmt.len); -+ if (txmgmt.buf == NULL) { -+ ret = -ENOMEM; -+ goto bad; -+ } -+ _rtw_memcpy(txmgmt.buf, (void*)buf, txmgmt.len); -+ -+/* Debug purpose */ -+#if 1 -+ DBG_871X("%s %d\n", __FUNCTION__, __LINE__); -+ DBG_871X("peer:"MAC_FMT", action code:%d, dialog:%d, status code:%d\n", -+ MAC_ARG(txmgmt.peer), txmgmt.action_code, -+ txmgmt.dialog_token, txmgmt.status_code); -+ if (txmgmt.len > 0) { -+ int i=0; -+ for(;i < len; i++) -+ printk("%02x ", *(txmgmt.buf+i)); -+ DBG_871X("len:%d\n", txmgmt.len); -+ } -+#endif -+ -+ switch (txmgmt.action_code) { -+ case TDLS_SETUP_REQUEST: -+ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); -+ break; -+ case TDLS_SETUP_RESPONSE: -+ issue_tdls_setup_rsp(padapter, &txmgmt); -+ break; -+ case TDLS_SETUP_CONFIRM: -+ issue_tdls_setup_cfm(padapter, &txmgmt); -+ break; -+ case TDLS_TEARDOWN: -+ issue_tdls_teardown(padapter, &txmgmt, _TRUE); -+ break; -+ case TDLS_DISCOVERY_REQUEST: -+ issue_tdls_dis_req(padapter, &txmgmt); -+ break; -+ case TDLS_DISCOVERY_RESPONSE: -+ issue_tdls_dis_rsp(padapter, &txmgmt, pmlmeinfo->enc_algo? _TRUE : _FALSE); -+ break; -+ } -+ -+bad: -+ if (txmgmt.buf) -+ rtw_mfree(txmgmt.buf, txmgmt.len); -+ -+discard: -+ return ret; -+} -+ -+static int cfg80211_rtw_tdls_oper(struct wiphy *wiphy, -+ struct net_device *ndev, -+ u8 *peer, -+ enum nl80211_tdls_operation oper) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct tdls_txmgmt txmgmt; -+ struct sta_info *ptdls_sta = NULL; -+ -+ DBG_871X(FUNC_NDEV_FMT", nl80211_tdls_operation:%d\n", FUNC_NDEV_ARG(ndev), oper); -+ -+#ifdef CONFIG_LPS -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); -+#endif //CONFIG_LPS -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ if (peer) -+ _rtw_memcpy(txmgmt.peer, peer, ETH_ALEN); -+ -+ if (rtw_tdls_is_driver_setup(padapter)) { -+ /* these two cases are done by driver itself */ -+ if (oper == NL80211_TDLS_ENABLE_LINK || oper == NL80211_TDLS_DISABLE_LINK) -+ return 0; -+ } -+ -+ switch (oper) { -+ case NL80211_TDLS_DISCOVERY_REQ: -+ issue_tdls_dis_req(padapter, &txmgmt); -+ break; -+ case NL80211_TDLS_SETUP: -+#ifdef CONFIG_WFD -+ if ( _AES_ != padapter->securitypriv.dot11PrivacyAlgrthm ) { -+ if ( padapter->wdinfo.wfd_tdls_weaksec == _TRUE) -+ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); -+ else -+ DBG_871X( "[%s] Current link is not AES, SKIP sending the tdls setup request!!\n", __FUNCTION__ ); -+ } else -+#endif // CONFIG_WFD -+ { -+ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); -+ } -+ break; -+ case NL80211_TDLS_TEARDOWN: -+ ptdls_sta = rtw_get_stainfo( &(padapter->stapriv), txmgmt.peer); -+ if (ptdls_sta != NULL) { -+ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; -+ issue_tdls_teardown(padapter, &txmgmt, _TRUE); -+ }else { -+ DBG_871X( "TDLS peer not found\n"); -+ } -+ break; -+ case NL80211_TDLS_ENABLE_LINK: -+ DBG_871X(FUNC_NDEV_FMT", NL80211_TDLS_ENABLE_LINK;mac:"MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(peer)); -+ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), peer); -+ if (ptdls_sta != NULL) { -+ ptdlsinfo->link_established = _TRUE; -+ ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; -+ ptdls_sta->state |= _FW_LINKED; -+ rtw_tdls_cmd(padapter, txmgmt.peer, TDLS_ESTABLISHED); -+ } -+ break; -+ case NL80211_TDLS_DISABLE_LINK: -+ DBG_871X(FUNC_NDEV_FMT", NL80211_TDLS_DISABLE_LINK;mac:"MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(peer)); -+ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), peer); -+ if (ptdls_sta != NULL) { -+ rtw_tdls_cmd(padapter, peer, TDLS_TEAR_STA ); -+ } -+ break; -+ } -+ return 0; -+} -+#endif /* CONFIG_TDLS */ -+ -+#if defined(CONFIG_PNO_SUPPORT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3,0,0)) -+static int cfg80211_rtw_sched_scan_start(struct wiphy *wiphy, -+ struct net_device *dev, -+ struct cfg80211_sched_scan_request *request) { -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 ret; -+ -+ if (padapter->bup == _FALSE) { -+ DBG_871X("%s: net device is down.\n", __func__); -+ return -EIO; -+ } -+ -+ if(check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE || -+ check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE || -+ check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { -+ DBG_871X("%s: device is busy.\n", __func__); -+ rtw_scan_abort(padapter); -+ } -+ -+ if (request == NULL) { -+ DBG_871X("%s: invalid cfg80211_requests parameters.\n", __func__); -+ return -EINVAL; -+ } -+ -+ ret = rtw_android_cfg80211_pno_setup(dev, request->ssids, -+ request->n_ssids, request->interval); -+ -+ if (ret < 0) { -+ DBG_871X("%s ret: %d\n", __func__, ret); -+ goto exit; -+ } -+ -+ ret = rtw_android_pno_enable(dev, _TRUE); -+ if (ret < 0) { -+ DBG_871X("%s ret: %d\n", __func__, ret); -+ goto exit; -+ } -+exit: -+ return ret; -+} -+ -+static int cfg80211_rtw_sched_scan_stop(struct wiphy *wiphy, -+ struct net_device *dev) { -+ return rtw_android_pno_enable(dev, _FALSE); -+} -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+static int rtw_cfg80211_set_beacon_wpsp2pie(struct net_device *ndev, char *buf, int len) -+{ -+ int ret = 0; -+ uint wps_ielen = 0; -+ u8 *wps_ie; -+ u32 p2p_ielen = 0; -+ u8 wps_oui[8]={0x0,0x50,0xf2,0x04}; -+ u8 *p2p_ie; -+ u32 wfd_ielen = 0; -+ u8 *wfd_ie; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ DBG_871X(FUNC_NDEV_FMT" ielen=%d\n", FUNC_NDEV_ARG(ndev), len); -+ -+ if(len>0) -+ { -+ if((wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen))) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("bcn_wps_ielen=%d\n", wps_ielen); -+ #endif -+ -+ if(pmlmepriv->wps_beacon_ie) -+ { -+ u32 free_len = pmlmepriv->wps_beacon_ie_len; -+ pmlmepriv->wps_beacon_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_beacon_ie, free_len); -+ pmlmepriv->wps_beacon_ie = NULL; -+ } -+ -+ pmlmepriv->wps_beacon_ie = rtw_malloc(wps_ielen); -+ if ( pmlmepriv->wps_beacon_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ -+ _rtw_memcpy(pmlmepriv->wps_beacon_ie, wps_ie, wps_ielen); -+ pmlmepriv->wps_beacon_ie_len = wps_ielen; -+ -+ update_beacon(padapter, _VENDOR_SPECIFIC_IE_, wps_oui, _TRUE); -+ -+ } -+ -+ //buf += wps_ielen; -+ //len -= wps_ielen; -+ -+ #ifdef CONFIG_P2P -+ if((p2p_ie=rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen))) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("bcn_p2p_ielen=%d\n", p2p_ielen); -+ #endif -+ -+ if(pmlmepriv->p2p_beacon_ie) -+ { -+ u32 free_len = pmlmepriv->p2p_beacon_ie_len; -+ pmlmepriv->p2p_beacon_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_beacon_ie, free_len); -+ pmlmepriv->p2p_beacon_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_beacon_ie = rtw_malloc(p2p_ielen); -+ if ( pmlmepriv->p2p_beacon_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ -+ _rtw_memcpy(pmlmepriv->p2p_beacon_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_beacon_ie_len = p2p_ielen; -+ -+ } -+ #endif //CONFIG_P2P -+ -+ //buf += p2p_ielen; -+ //len -= p2p_ielen; -+ -+ #ifdef CONFIG_WFD -+ if(rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen)) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("bcn_wfd_ielen=%d\n", wfd_ielen); -+ #endif -+ -+ if(pmlmepriv->wfd_beacon_ie) -+ { -+ u32 free_len = pmlmepriv->wfd_beacon_ie_len; -+ pmlmepriv->wfd_beacon_ie_len = 0; -+ rtw_mfree(pmlmepriv->wfd_beacon_ie, free_len); -+ pmlmepriv->wfd_beacon_ie = NULL; -+ } -+ -+ pmlmepriv->wfd_beacon_ie = rtw_malloc(wfd_ielen); -+ if ( pmlmepriv->wfd_beacon_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ rtw_get_wfd_ie(buf, len, pmlmepriv->wfd_beacon_ie, &pmlmepriv->wfd_beacon_ie_len); -+ } -+ #endif //CONFIG_WFD -+ -+ pmlmeext->bstart_bss = _TRUE; -+ -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_cfg80211_set_probe_resp_wpsp2pie(struct net_device *net, char *buf, int len) -+{ -+ int ret = 0; -+ uint wps_ielen = 0; -+ u8 *wps_ie; -+ u32 p2p_ielen = 0; -+ u8 *p2p_ie; -+ u32 wfd_ielen = 0; -+ u8 *wfd_ie; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ielen=%d\n", __func__, len); -+#endif -+ -+ if(len>0) -+ { -+ if((wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen))) -+ { -+ uint attr_contentlen = 0; -+ u16 uconfig_method, *puconfig_method = NULL; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("probe_resp_wps_ielen=%d\n", wps_ielen); -+ #endif -+ -+ if(check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) -+ { -+ u8 sr = 0; -+ rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8*)(&sr), NULL); -+ -+ if (sr != 0) -+ { -+ DBG_871X("%s, got sr\n", __func__); -+ } -+ else -+ { -+ DBG_8192C("GO mode process WPS under site-survey, sr no set\n"); -+ return ret; -+ } -+ } -+ -+ if(pmlmepriv->wps_probe_resp_ie) -+ { -+ u32 free_len = pmlmepriv->wps_probe_resp_ie_len; -+ pmlmepriv->wps_probe_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_probe_resp_ie, free_len); -+ pmlmepriv->wps_probe_resp_ie = NULL; -+ } -+ -+ pmlmepriv->wps_probe_resp_ie = rtw_malloc(wps_ielen); -+ if ( pmlmepriv->wps_probe_resp_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ -+ //add PUSH_BUTTON config_method by driver self in wpsie of probe_resp at GO Mode -+ if ( (puconfig_method = (u16*)rtw_get_wps_attr_content( wps_ie, wps_ielen, WPS_ATTR_CONF_METHOD , NULL, &attr_contentlen)) != NULL ) -+ { -+ //struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct wireless_dev *wdev = padapter->rtw_wdev; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ //printk("config_method in wpsie of probe_resp = 0x%x\n", be16_to_cpu(*puconfig_method)); -+ #endif -+ -+ //if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ if(wdev->iftype != NL80211_IFTYPE_P2P_GO) //for WIFI-DIRECT LOGO 4.2.2, AUTO GO can't set PUSH_BUTTON flags -+ { -+ uconfig_method = WPS_CM_PUSH_BUTTON; -+ uconfig_method = cpu_to_be16( uconfig_method ); -+ -+ *puconfig_method |= uconfig_method; -+ } -+ #endif -+ } -+ -+ _rtw_memcpy(pmlmepriv->wps_probe_resp_ie, wps_ie, wps_ielen); -+ pmlmepriv->wps_probe_resp_ie_len = wps_ielen; -+ -+ } -+ -+ //buf += wps_ielen; -+ //len -= wps_ielen; -+ -+ #ifdef CONFIG_P2P -+ if((p2p_ie=rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen))) -+ { -+ u8 is_GO = _FALSE; -+ u32 attr_contentlen = 0; -+ u16 cap_attr=0; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("probe_resp_p2p_ielen=%d\n", p2p_ielen); -+ #endif -+ -+ //Check P2P Capability ATTR -+ if( rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8*)&cap_attr, (uint*) &attr_contentlen) ) -+ { -+ u8 grp_cap=0; -+ //DBG_8192C( "[%s] Got P2P Capability Attr!!\n", __FUNCTION__ ); -+ cap_attr = le16_to_cpu(cap_attr); -+ grp_cap = (u8)((cap_attr >> 8)&0xff); -+ -+ is_GO = (grp_cap&BIT(0)) ? _TRUE:_FALSE; -+ -+ if(is_GO) -+ DBG_8192C("Got P2P Capability Attr, grp_cap=0x%x, is_GO\n", grp_cap); -+ } -+ -+ -+ if(is_GO == _FALSE) -+ { -+ if(pmlmepriv->p2p_probe_resp_ie) -+ { -+ u32 free_len = pmlmepriv->p2p_probe_resp_ie_len; -+ pmlmepriv->p2p_probe_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_probe_resp_ie, free_len); -+ pmlmepriv->p2p_probe_resp_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_probe_resp_ie = rtw_malloc(p2p_ielen); -+ if ( pmlmepriv->p2p_probe_resp_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->p2p_probe_resp_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_probe_resp_ie_len = p2p_ielen; -+ } -+ else -+ { -+ if(pmlmepriv->p2p_go_probe_resp_ie) -+ { -+ u32 free_len = pmlmepriv->p2p_go_probe_resp_ie_len; -+ pmlmepriv->p2p_go_probe_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_go_probe_resp_ie, free_len); -+ pmlmepriv->p2p_go_probe_resp_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_go_probe_resp_ie = rtw_malloc(p2p_ielen); -+ if ( pmlmepriv->p2p_go_probe_resp_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->p2p_go_probe_resp_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_go_probe_resp_ie_len = p2p_ielen; -+ } -+ -+ } -+ #endif //CONFIG_P2P -+ -+ //buf += p2p_ielen; -+ //len -= p2p_ielen; -+ -+ #ifdef CONFIG_WFD -+ if(rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen)) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("probe_resp_wfd_ielen=%d\n", wfd_ielen); -+ #endif -+ -+ if(pmlmepriv->wfd_probe_resp_ie) -+ { -+ u32 free_len = pmlmepriv->wfd_probe_resp_ie_len; -+ pmlmepriv->wfd_probe_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->wfd_probe_resp_ie, free_len); -+ pmlmepriv->wfd_probe_resp_ie = NULL; -+ } -+ -+ pmlmepriv->wfd_probe_resp_ie = rtw_malloc(wfd_ielen); -+ if ( pmlmepriv->wfd_probe_resp_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ rtw_get_wfd_ie(buf, len, pmlmepriv->wfd_probe_resp_ie, &pmlmepriv->wfd_probe_resp_ie_len); -+ } -+ #endif //CONFIG_WFD -+ -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_cfg80211_set_assoc_resp_wpsp2pie(struct net_device *net, char *buf, int len) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ DBG_8192C("%s, ielen=%d\n", __func__, len); -+ -+ if(len>0) -+ { -+ if(pmlmepriv->wps_assoc_resp_ie) -+ { -+ u32 free_len = pmlmepriv->wps_assoc_resp_ie_len; -+ pmlmepriv->wps_assoc_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_assoc_resp_ie, free_len); -+ pmlmepriv->wps_assoc_resp_ie = NULL; -+ } -+ -+ pmlmepriv->wps_assoc_resp_ie = rtw_malloc(len); -+ if ( pmlmepriv->wps_assoc_resp_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->wps_assoc_resp_ie, buf, len); -+ pmlmepriv->wps_assoc_resp_ie_len = len; -+ } -+ -+ return ret; -+ -+} -+ -+int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, -+ int type) -+{ -+ int ret = 0; -+ uint wps_ielen = 0; -+ u32 p2p_ielen = 0; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ielen=%d\n", __func__, len); -+#endif -+ -+ if( (rtw_get_wps_ie(buf, len, NULL, &wps_ielen) && (wps_ielen>0)) -+ #ifdef CONFIG_P2P -+ || (rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen) && (p2p_ielen>0)) -+ #endif -+ ) -+ { -+ if (net != NULL) -+ { -+ switch (type) -+ { -+ case 0x1: //BEACON -+ ret = rtw_cfg80211_set_beacon_wpsp2pie(net, buf, len); -+ break; -+ case 0x2: //PROBE_RESP -+ ret = rtw_cfg80211_set_probe_resp_wpsp2pie(net, buf, len); -+ break; -+ case 0x4: //ASSOC_RESP -+ ret = rtw_cfg80211_set_assoc_resp_wpsp2pie(net, buf, len); -+ break; -+ } -+ } -+ } -+ -+ return ret; -+ -+} -+ -+static void rtw_cfg80211_init_ht_capab_ex(_adapter *padapter, struct ieee80211_sta_ht_cap *ht_cap, enum ieee80211_band band, u8 rf_type) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ u8 stbc_rx_enable = _FALSE; -+ -+ rtw_ht_use_default_setting(padapter); -+ -+ /* RX LDPC */ -+ if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_RX)) -+ ht_cap->cap |= IEEE80211_HT_CAP_LDPC_CODING; -+ -+ /* TX STBC */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX)) -+ ht_cap->cap |= IEEE80211_HT_CAP_TX_STBC; -+ -+ /* RX STBC */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX)) { -+ /*rtw_rx_stbc 0: disable, bit(0):enable 2.4g, bit(1):enable 5g*/ -+ if (IEEE80211_BAND_2GHZ == band) -+ stbc_rx_enable = (pregistrypriv->rx_stbc & BIT(0))?_TRUE:_FALSE; -+ if (IEEE80211_BAND_5GHZ == band) -+ stbc_rx_enable = (pregistrypriv->rx_stbc & BIT(1))?_TRUE:_FALSE; -+ -+ if (stbc_rx_enable) { -+ switch (rf_type) { -+ case RF_1T1R: -+ ht_cap->cap |= IEEE80211_HT_CAP_RX_STBC_1R;/*RX STBC One spatial stream*/ -+ break; -+ -+ case RF_2T2R: -+ case RF_1T2R: -+ ht_cap->cap |= IEEE80211_HT_CAP_RX_STBC_1R;/* Only one spatial-stream STBC RX is supported */ -+ break; -+ case RF_3T3R: -+ case RF_3T4R: -+ case RF_4T4R: -+ ht_cap->cap |= IEEE80211_HT_CAP_RX_STBC_1R;/* Only one spatial-stream STBC RX is supported */ -+ break; -+ default: -+ DBG_871X("[warning] rf_type %d is not expected\n", rf_type); -+ break; -+ } -+ } -+ } -+} -+ -+static void rtw_cfg80211_init_ht_capab(_adapter *padapter, struct ieee80211_sta_ht_cap *ht_cap, enum ieee80211_band band, u8 rf_type) -+{ -+#define MAX_BIT_RATE_40MHZ_MCS23 450 /* Mbps */ -+#define MAX_BIT_RATE_40MHZ_MCS15 300 /* Mbps */ -+#define MAX_BIT_RATE_40MHZ_MCS7 150 /* Mbps */ -+ -+ ht_cap->ht_supported = _TRUE; -+ -+ ht_cap->cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 | -+ IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_SGI_20 | -+ IEEE80211_HT_CAP_DSSSCCK40 | IEEE80211_HT_CAP_MAX_AMSDU; -+ rtw_cfg80211_init_ht_capab_ex(padapter, ht_cap, band, rf_type); -+ -+ /* -+ *Maximum length of AMPDU that the STA can receive. -+ *Length = 2 ^ (13 + max_ampdu_length_exp) - 1 (octets) -+ */ -+ ht_cap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K; -+ -+ /*Minimum MPDU start spacing , */ -+ ht_cap->ampdu_density = IEEE80211_HT_MPDU_DENSITY_16; -+ -+ ht_cap->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED; -+ -+ /* -+ *hw->wiphy->bands[IEEE80211_BAND_2GHZ] -+ *base on ant_num -+ *rx_mask: RX mask -+ *if rx_ant =1 rx_mask[0]=0xff;==>MCS0-MCS7 -+ *if rx_ant =2 rx_mask[1]=0xff;==>MCS8-MCS15 -+ *if rx_ant >=3 rx_mask[2]=0xff; -+ *if BW_40 rx_mask[4]=0x01; -+ *highest supported RX rate -+ */ -+ if (rf_type == RF_1T1R) { -+ ht_cap->mcs.rx_mask[0] = 0xFF; -+ -+ ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS7; -+ } else if ((rf_type == RF_1T2R) || (rf_type == RF_2T2R) || (rf_type == RF_2T2R_GREEN)) { -+ ht_cap->mcs.rx_mask[0] = 0xFF; -+ ht_cap->mcs.rx_mask[1] = 0xFF; -+ -+ ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS15; -+ } else if ((rf_type == RF_2T3R) || (rf_type == RF_3T3R)) { -+ ht_cap->mcs.rx_mask[0] = 0xFF; -+ ht_cap->mcs.rx_mask[1] = 0xFF; -+ ht_cap->mcs.rx_mask[2] = 0xFF; -+ -+ ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS23; -+ } else { -+ rtw_warn_on(1); -+ DBG_8192C("%s, error rf_type=%d\n", __func__, rf_type); -+ } -+ -+} -+ -+void rtw_cfg80211_init_wiphy(_adapter *padapter) -+{ -+ u8 rf_type; -+ struct ieee80211_supported_band *bands; -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct wiphy *wiphy = pwdev->wiphy; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ DBG_8192C("%s:rf_type=%d\n", __func__, rf_type); -+ -+ if (IsSupported24G(padapter->registrypriv.wireless_mode)) { -+ bands = wiphy->bands[IEEE80211_BAND_2GHZ]; -+ if(bands) -+ rtw_cfg80211_init_ht_capab(padapter, &bands->ht_cap, IEEE80211_BAND_2GHZ, rf_type); -+ } -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ if (IsSupported5G(padapter->registrypriv.wireless_mode)) { -+ bands = wiphy->bands[IEEE80211_BAND_5GHZ]; -+ if(bands) -+ rtw_cfg80211_init_ht_capab(padapter, &bands->ht_cap, IEEE80211_BAND_5GHZ, rf_type); -+ } -+#endif -+ /* init regulary domain */ -+ rtw_regd_init(padapter); -+ -+ /* copy mac_addr to wiphy */ -+ _rtw_memcpy(wiphy->perm_addr, adapter_mac_addr(padapter), ETH_ALEN); -+ -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+struct ieee80211_iface_limit rtw_limits[] = { -+ { .max = 2, -+ .types = BIT(NL80211_IFTYPE_STATION) -+ #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) -+ | BIT(NL80211_IFTYPE_P2P_CLIENT) -+ #endif -+ }, -+ #ifdef CONFIG_AP_MODE -+ { .max = 1, -+ .types = BIT(NL80211_IFTYPE_AP) -+ #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) -+ | BIT(NL80211_IFTYPE_P2P_GO) -+ #endif -+ }, -+ #endif -+}; -+ -+struct ieee80211_iface_combination rtw_combinations[] = { -+ { .limits = rtw_limits, -+ .n_limits = ARRAY_SIZE(rtw_limits), -+ .max_interfaces = 2, -+ .num_different_channels = 1, -+ }, -+}; -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) */ -+ -+static void rtw_cfg80211_preinit_wiphy(_adapter *adapter, struct wiphy *wiphy) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct registry_priv *regsty = dvobj_to_regsty(dvobj); -+ -+ wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; -+ -+ wiphy->max_scan_ssids = RTW_SSID_SCAN_AMOUNT; -+ wiphy->max_scan_ie_len = RTW_SCAN_IE_LEN_MAX; -+ wiphy->max_num_pmkids = RTW_MAX_NUM_PMKIDS; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+ wiphy->max_remain_on_channel_duration = RTW_MAX_REMAIN_ON_CHANNEL_DURATION; -+#endif -+ -+ wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) -+ | BIT(NL80211_IFTYPE_ADHOC) -+#ifdef CONFIG_AP_MODE -+ | BIT(NL80211_IFTYPE_AP) -+ #ifdef CONFIG_WIFI_MONITOR -+ | BIT(NL80211_IFTYPE_MONITOR) -+ #endif -+#endif -+#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE)) -+ | BIT(NL80211_IFTYPE_P2P_CLIENT) -+ | BIT(NL80211_IFTYPE_P2P_GO) -+#endif -+ ; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+#ifdef CONFIG_AP_MODE -+ wiphy->mgmt_stypes = rtw_cfg80211_default_mgmt_stypes; -+#endif //CONFIG_AP_MODE -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,0,0)) -+ #ifdef CONFIG_WIFI_MONITOR -+ wiphy->software_iftypes |= BIT(NL80211_IFTYPE_MONITOR); -+ #endif -+#endif -+ -+ #if defined(RTW_SINGLE_WIPHY) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+ wiphy->iface_combinations = rtw_combinations; -+ wiphy->n_iface_combinations = ARRAY_SIZE(rtw_combinations); -+ #endif -+ -+ wiphy->cipher_suites = rtw_cipher_suites; -+ wiphy->n_cipher_suites = ARRAY_SIZE(rtw_cipher_suites); -+ -+ if (IsSupported24G(adapter->registrypriv.wireless_mode)) -+ wiphy->bands[IEEE80211_BAND_2GHZ] = rtw_spt_band_alloc(IEEE80211_BAND_2GHZ); -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ if (IsSupported5G(adapter->registrypriv.wireless_mode)) -+ wiphy->bands[IEEE80211_BAND_5GHZ] = rtw_spt_band_alloc(IEEE80211_BAND_5GHZ); -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38) && LINUX_VERSION_CODE < KERNEL_VERSION(3,0,0)) -+ wiphy->flags |= WIPHY_FLAG_SUPPORTS_SEPARATE_DEFAULT_KEYS; -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,3,0)) -+ wiphy->flags |= WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL; -+ wiphy->flags |= WIPHY_FLAG_HAVE_AP_SME; -+ /* remove WIPHY_FLAG_OFFCHAN_TX, because we not support this feature */ -+ /* wiphy->flags |= WIPHY_FLAG_OFFCHAN_TX | WIPHY_FLAG_HAVE_AP_SME; */ -+#endif -+ -+#if defined(CONFIG_PM) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+ wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; -+#ifdef CONFIG_PNO_SUPPORT -+ wiphy->max_sched_scan_ssids = MAX_PNO_LIST_COUNT; -+#endif -+#endif -+ -+#if defined(CONFIG_PM) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,11,0)) -+ wiphy->wowlan = wowlan_stub; -+#else -+ wiphy->wowlan = &wowlan_stub; -+#endif -+#endif -+ -+#if defined(CONFIG_TDLS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3,2,0)) -+ wiphy->flags |= WIPHY_FLAG_SUPPORTS_TDLS; -+#ifndef CONFIG_TDLS_DRIVER_SETUP -+ wiphy->flags |= WIPHY_FLAG_TDLS_EXTERNAL_SETUP; //Driver handles key exchange -+ wiphy->flags |= NL80211_ATTR_HT_CAPABILITY; -+#endif //CONFIG_TDLS_DRIVER_SETUP -+#endif /* CONFIG_TDLS */ -+ -+ if (regsty->power_mgnt != PS_MODE_ACTIVE) -+ wiphy->flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT; -+ else -+ wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,2,0)) -+ //wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM; -+#endif -+} -+ -+static struct cfg80211_ops rtw_cfg80211_ops = { -+ .change_virtual_intf = cfg80211_rtw_change_iface, -+ .add_key = cfg80211_rtw_add_key, -+ .get_key = cfg80211_rtw_get_key, -+ .del_key = cfg80211_rtw_del_key, -+ .set_default_key = cfg80211_rtw_set_default_key, -+#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 1, 0)) -+ .set_rekey_data = cfg80211_rtw_set_rekey_data, -+#endif /*CONFIG_GTK_OL*/ -+ .get_station = cfg80211_rtw_get_station, -+ .scan = cfg80211_rtw_scan, -+ .set_wiphy_params = cfg80211_rtw_set_wiphy_params, -+ .connect = cfg80211_rtw_connect, -+ .disconnect = cfg80211_rtw_disconnect, -+ .join_ibss = cfg80211_rtw_join_ibss, -+ .leave_ibss = cfg80211_rtw_leave_ibss, -+ .set_tx_power = cfg80211_rtw_set_txpower, -+ .get_tx_power = cfg80211_rtw_get_txpower, -+ .set_power_mgmt = cfg80211_rtw_set_power_mgmt, -+ .set_pmksa = cfg80211_rtw_set_pmksa, -+ .del_pmksa = cfg80211_rtw_del_pmksa, -+ .flush_pmksa = cfg80211_rtw_flush_pmksa, -+ -+#ifdef CONFIG_AP_MODE -+ .add_virtual_intf = cfg80211_rtw_add_virtual_intf, -+ .del_virtual_intf = cfg80211_rtw_del_virtual_intf, -+ -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) && !defined(COMPAT_KERNEL_RELEASE) -+ .add_beacon = cfg80211_rtw_add_beacon, -+ .set_beacon = cfg80211_rtw_set_beacon, -+ .del_beacon = cfg80211_rtw_del_beacon, -+ #else -+ .start_ap = cfg80211_rtw_start_ap, -+ .change_beacon = cfg80211_rtw_change_beacon, -+ .stop_ap = cfg80211_rtw_stop_ap, -+ #endif -+ -+ .add_station = cfg80211_rtw_add_station, -+ .del_station = cfg80211_rtw_del_station, -+ .change_station = cfg80211_rtw_change_station, -+ .dump_station = cfg80211_rtw_dump_station, -+ .change_bss = cfg80211_rtw_change_bss, -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) -+ .set_channel = cfg80211_rtw_set_channel, -+ #endif -+ //.auth = cfg80211_rtw_auth, -+ //.assoc = cfg80211_rtw_assoc, -+#endif //CONFIG_AP_MODE -+ -+#ifdef CONFIG_P2P -+ .remain_on_channel = cfg80211_rtw_remain_on_channel, -+ .cancel_remain_on_channel = cfg80211_rtw_cancel_remain_on_channel, -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ .mgmt_tx = cfg80211_rtw_mgmt_tx, -+ .mgmt_frame_register = cfg80211_rtw_mgmt_frame_register, -+#elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,34) && LINUX_VERSION_CODE<=KERNEL_VERSION(2,6,35)) -+ .action = cfg80211_rtw_mgmt_tx, -+#endif -+ -+#if defined(CONFIG_TDLS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3,2,0)) -+ .tdls_mgmt = cfg80211_rtw_tdls_mgmt, -+ .tdls_oper = cfg80211_rtw_tdls_oper, -+#endif /* CONFIG_TDLS */ -+ -+#if defined(CONFIG_PNO_SUPPORT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3,0,0)) -+ .sched_scan_start = cfg80211_rtw_sched_scan_start, -+ .sched_scan_stop = cfg80211_rtw_sched_scan_stop, -+#endif /* CONFIG_PNO_SUPPORT */ -+}; -+ -+struct wiphy *rtw_wiphy_alloc(_adapter *padapter, struct device *dev) -+{ -+ struct wiphy *wiphy; -+ struct rtw_wiphy_data *wiphy_data; -+ -+ /* wiphy */ -+ wiphy = wiphy_new(&rtw_cfg80211_ops, sizeof(_adapter*)); -+ if (!wiphy) { -+ DBG_8192C("Couldn't allocate wiphy device\n"); -+ goto exit; -+ } -+ set_wiphy_dev(wiphy, dev); -+ *((_adapter**)wiphy_priv(wiphy)) = padapter; -+ -+ rtw_cfg80211_preinit_wiphy(padapter, wiphy); -+ -+ DBG_871X(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); -+ -+exit: -+ return wiphy; -+} -+ -+void rtw_wiphy_free(struct wiphy *wiphy) -+{ -+ if (!wiphy) -+ return; -+ -+ DBG_871X(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); -+ -+ if (wiphy->bands[IEEE80211_BAND_2GHZ]) { -+ rtw_spt_band_free(wiphy->bands[IEEE80211_BAND_2GHZ]); -+ wiphy->bands[IEEE80211_BAND_2GHZ] = NULL; -+ } -+ if (wiphy->bands[IEEE80211_BAND_5GHZ]) { -+ rtw_spt_band_free(wiphy->bands[IEEE80211_BAND_5GHZ]); -+ wiphy->bands[IEEE80211_BAND_5GHZ] = NULL; -+ } -+ -+ wiphy_free(wiphy); -+} -+ -+int rtw_wiphy_register(struct wiphy *wiphy) -+{ -+ DBG_871X(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) -+ rtw_cfgvendor_attach(wiphy); -+#endif -+ -+ return wiphy_register(wiphy); -+} -+ -+void rtw_wiphy_unregister(struct wiphy *wiphy) -+{ -+ DBG_871X(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) -+ rtw_cfgvendor_detach(wiphy); -+#endif -+ -+ return wiphy_unregister(wiphy); -+} -+ -+int rtw_wdev_alloc(_adapter *padapter, struct wiphy *wiphy) -+{ -+ int ret = 0; -+ struct net_device *pnetdev = padapter->pnetdev; -+ struct wireless_dev *wdev; -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ DBG_8192C("%s(padapter=%p)\n", __func__, padapter); -+ -+ /* wdev */ -+ wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); -+ if (!wdev) { -+ DBG_8192C("Couldn't allocate wireless device\n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ wdev->wiphy = wiphy; -+ wdev->netdev = pnetdev; -+ -+ wdev->iftype = NL80211_IFTYPE_STATION; // will be init in rtw_hal_init() -+ // Must sync with _rtw_init_mlme_priv() -+ // pmlmepriv->fw_state = WIFI_STATION_STATE -+ //wdev->iftype = NL80211_IFTYPE_MONITOR; // for rtw_setopmode_cmd() in cfg80211_rtw_change_iface() -+ padapter->rtw_wdev = wdev; -+ pnetdev->ieee80211_ptr = wdev; -+ -+ //init pwdev_priv -+ pwdev_priv = adapter_wdev_data(padapter); -+ pwdev_priv->rtw_wdev = wdev; -+ pwdev_priv->pmon_ndev = NULL; -+ pwdev_priv->ifname_mon[0] = '\0'; -+ pwdev_priv->padapter = padapter; -+ pwdev_priv->scan_request = NULL; -+ _rtw_spinlock_init(&pwdev_priv->scan_req_lock); -+ -+ pwdev_priv->p2p_enabled = _FALSE; -+ pwdev_priv->provdisc_req_issued = _FALSE; -+ rtw_wdev_invit_info_init(&pwdev_priv->invit_info); -+ rtw_wdev_nego_info_init(&pwdev_priv->nego_info); -+ -+ pwdev_priv->bandroid_scan = _FALSE; -+ -+ if(padapter->registrypriv.power_mgnt != PS_MODE_ACTIVE) -+ pwdev_priv->power_mgmt = _TRUE; -+ else -+ pwdev_priv->power_mgmt = _FALSE; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); -+ ATOMIC_SET(&pwdev_priv->ro_ch_to, 1); -+#endif -+ -+exit: -+ return ret; -+} -+ -+void rtw_wdev_free(struct wireless_dev *wdev) -+{ -+ DBG_8192C("%s(wdev=%p)\n", __func__, wdev); -+ -+ if (!wdev) -+ return; -+ -+ rtw_mfree((u8*)wdev, sizeof(struct wireless_dev)); -+} -+ -+void rtw_wdev_unregister(struct wireless_dev *wdev) -+{ -+ struct net_device *ndev; -+ _adapter *adapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ DBG_8192C("%s(wdev=%p)\n", __func__, wdev); -+ -+ if (!wdev) -+ return; -+ -+ if(!(ndev = wdev_to_ndev(wdev))) -+ return; -+ -+ adapter = (_adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(adapter); -+ -+ rtw_cfg80211_indicate_scan_done(adapter, _TRUE); -+ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0)) -+ if (wdev->current_bss) { -+ u8 locally_generated = 1; -+ DBG_871X(FUNC_ADPT_FMT" clear current_bss by cfg80211_disconnected\n", FUNC_ADPT_ARG(adapter)); -+ cfg80211_disconnected(adapter->pnetdev, 0, NULL, 0, locally_generated, GFP_ATOMIC); -+ } -+ #elif ((LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) && (LINUX_VERSION_CODE < KERNEL_VERSION(4, 2, 0))) || defined(COMPAT_KERNEL_RELEASE) -+ if (wdev->current_bss) { -+ DBG_871X(FUNC_ADPT_FMT" clear current_bss by cfg80211_disconnected\n", FUNC_ADPT_ARG(adapter)); -+ cfg80211_disconnected(adapter->pnetdev, 0, NULL, 0, GFP_ATOMIC); -+ } -+ #endif -+ -+ if (pwdev_priv->pmon_ndev) { -+ DBG_8192C("%s, unregister monitor interface\n", __func__); -+ unregister_netdev(pwdev_priv->pmon_ndev); -+ } -+} -+ -+int rtw_cfg80211_ndev_res_alloc(_adapter *adapter) -+{ -+ int ret = _FAIL; -+ -+#if !defined(RTW_SINGLE_WIPHY) -+ struct wiphy *wiphy; -+ struct device *dev = dvobj_to_dev(adapter_to_dvobj(adapter)); -+ -+ wiphy = rtw_wiphy_alloc(adapter, dev); -+ if (wiphy == NULL) -+ goto exit; -+ -+ adapter->wiphy = wiphy; -+#endif -+ -+ if (rtw_wdev_alloc(adapter, adapter_to_wiphy(adapter)) == 0) -+ ret = _SUCCESS; -+ -+#if !defined(RTW_SINGLE_WIPHY) -+ if (ret != _SUCCESS) { -+ rtw_wiphy_free(wiphy); -+ adapter->wiphy = NULL; -+ } -+#endif -+ -+exit: -+ return ret; -+} -+ -+void rtw_cfg80211_ndev_res_free(_adapter *adapter) -+{ -+ rtw_wdev_free(adapter->rtw_wdev); -+#if !defined(RTW_SINGLE_WIPHY) -+ rtw_wiphy_free(adapter_to_wiphy(adapter)); -+ adapter->wiphy = NULL; -+#endif -+} -+ -+int rtw_cfg80211_ndev_res_register(_adapter *adapter) -+{ -+ int ret = _FAIL; -+ -+#if !defined(RTW_SINGLE_WIPHY) -+ if (rtw_wiphy_register(adapter_to_wiphy(adapter)) < 0) { -+ DBG_871X("%s rtw_wiphy_register fail for if%d\n", __func__, (adapter->iface_id+1)); -+ goto exit; -+ } -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+void rtw_cfg80211_ndev_res_unregister(_adapter *adapter) -+{ -+ rtw_wdev_unregister(adapter->rtw_wdev); -+} -+ -+int rtw_cfg80211_dev_res_alloc(struct dvobj_priv *dvobj) -+{ -+ int ret = _FAIL; -+ -+#if defined(RTW_SINGLE_WIPHY) -+ struct wiphy *wiphy; -+ struct device *dev = dvobj_to_dev(dvobj); -+ -+ wiphy = rtw_wiphy_alloc(dvobj->padapters[IFACE_ID0], dev); -+ if (wiphy == NULL) -+ goto exit; -+ -+ dvobj->wiphy = wiphy; -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+void rtw_cfg80211_dev_res_free(struct dvobj_priv *dvobj) -+{ -+#if defined(RTW_SINGLE_WIPHY) -+ rtw_wiphy_free(dvobj_to_wiphy(dvobj)); -+ dvobj->wiphy = NULL; -+#endif -+} -+ -+int rtw_cfg80211_dev_res_register(struct dvobj_priv *dvobj) -+{ -+ int ret = _FAIL; -+ -+#if defined(RTW_SINGLE_WIPHY) -+ if (rtw_wiphy_register(dvobj_to_wiphy(dvobj)) != 0) -+ goto exit; -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+void rtw_cfg80211_dev_res_unregister(struct dvobj_priv *dvobj) -+{ -+#if defined(RTW_SINGLE_WIPHY) -+ rtw_wiphy_unregister(dvobj_to_wiphy(dvobj)); -+#endif -+} -+ -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_cfg80211.h linux/3rdparty/rtl8812au/os_dep/linux/ioctl_cfg80211.h ---- linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_cfg80211.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/ioctl_cfg80211.h 2017-06-07 23:07:21.045690674 +0300 -@@ -0,0 +1,212 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __IOCTL_CFG80211_H__ -+#define __IOCTL_CFG80211_H__ -+ -+ -+#if defined(RTW_USE_CFG80211_STA_EVENT) -+ #undef CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER -+#endif -+ -+struct rtw_wdev_invit_info { -+ u8 state; /* 0: req, 1:rep */ -+ u8 peer_mac[ETH_ALEN]; -+ u8 active; -+ u8 token; -+ u8 flags; -+ u8 status; -+ u8 req_op_ch; -+ u8 rsp_op_ch; -+}; -+ -+#define rtw_wdev_invit_info_init(invit_info) \ -+ do { \ -+ (invit_info)->state = 0xff; \ -+ _rtw_memset((invit_info)->peer_mac, 0, ETH_ALEN); \ -+ (invit_info)->active = 0xff; \ -+ (invit_info)->token = 0; \ -+ (invit_info)->flags = 0x00; \ -+ (invit_info)->status = 0xff; \ -+ (invit_info)->req_op_ch = 0; \ -+ (invit_info)->rsp_op_ch = 0; \ -+ } while (0) -+ -+struct rtw_wdev_nego_info { -+ u8 state; /* 0: req, 1:rep, 2:conf */ -+ u8 peer_mac[ETH_ALEN]; -+ u8 active; -+ u8 token; -+ u8 status; -+ u8 req_intent; -+ u8 req_op_ch; -+ u8 req_listen_ch; -+ u8 rsp_intent; -+ u8 rsp_op_ch; -+ u8 conf_op_ch; -+}; -+ -+#define rtw_wdev_nego_info_init(nego_info) \ -+ do { \ -+ (nego_info)->state = 0xff; \ -+ _rtw_memset((nego_info)->peer_mac, 0, ETH_ALEN); \ -+ (nego_info)->active = 0xff; \ -+ (nego_info)->token = 0; \ -+ (nego_info)->status = 0xff; \ -+ (nego_info)->req_intent = 0xff; \ -+ (nego_info)->req_op_ch = 0; \ -+ (nego_info)->req_listen_ch = 0; \ -+ (nego_info)->rsp_intent = 0xff; \ -+ (nego_info)->rsp_op_ch = 0; \ -+ (nego_info)->conf_op_ch = 0; \ -+ } while (0) -+ -+struct rtw_wdev_priv -+{ -+ struct wireless_dev *rtw_wdev; -+ -+ _adapter *padapter; -+ -+ struct cfg80211_scan_request *scan_request; -+ _lock scan_req_lock; -+ -+ struct net_device *pmon_ndev;//for monitor interface -+ char ifname_mon[IFNAMSIZ + 1]; //interface name for monitor interface -+ -+ u8 p2p_enabled; -+ -+ u8 provdisc_req_issued; -+ -+ struct rtw_wdev_invit_info invit_info; -+ struct rtw_wdev_nego_info nego_info; -+ -+ u8 bandroid_scan; -+ bool block; -+ bool block_scan; -+ bool power_mgmt; -+ -+ /* report mgmt_frame registered */ -+ u16 report_mgmt; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ ATOMIC_T ro_ch_to; -+ ATOMIC_T switch_ch_to; -+#endif -+ -+}; -+ -+#define wiphy_to_adapter(x) (*((_adapter**)wiphy_priv(x))) -+ -+#define wdev_to_ndev(w) ((w)->netdev) -+#define wdev_to_wiphy(w) ((w)->wiphy) -+#define ndev_to_wdev(n) ((n)->ieee80211_ptr) -+ -+#define WIPHY_FMT "%s" -+#define WIPHY_ARG(wiphy) wiphy_name(wiphy) -+#define FUNC_WIPHY_FMT "%s("WIPHY_FMT")" -+#define FUNC_WIPHY_ARG(wiphy) __func__, WIPHY_ARG(wiphy) -+ -+#define SET_CFG80211_REPORT_MGMT(w, t, v) (w->report_mgmt |= (v?BIT(t >> 4):0)) -+#define GET_CFG80211_REPORT_MGMT(w, t) ((w->report_mgmt & BIT(t >> 4)) > 0) -+ -+struct wiphy *rtw_wiphy_alloc(_adapter *padapter, struct device *dev); -+void rtw_wiphy_free(struct wiphy *wiphy); -+int rtw_wiphy_register(struct wiphy *wiphy); -+void rtw_wiphy_unregister(struct wiphy *wiphy); -+ -+int rtw_wdev_alloc(_adapter *padapter, struct wiphy *wiphy); -+void rtw_wdev_free(struct wireless_dev *wdev); -+void rtw_wdev_unregister(struct wireless_dev *wdev); -+ -+int rtw_cfg80211_ndev_res_alloc(_adapter *adapter); -+void rtw_cfg80211_ndev_res_free(_adapter *adapter); -+int rtw_cfg80211_ndev_res_register(_adapter *adapter); -+void rtw_cfg80211_ndev_res_unregister(_adapter *adapter); -+ -+int rtw_cfg80211_dev_res_alloc(struct dvobj_priv *dvobj); -+void rtw_cfg80211_dev_res_free(struct dvobj_priv *dvobj); -+int rtw_cfg80211_dev_res_register(struct dvobj_priv *dvobj); -+void rtw_cfg80211_dev_res_unregister(struct dvobj_priv *dvobj); -+ -+void rtw_cfg80211_init_wiphy(_adapter *padapter); -+ -+void rtw_cfg80211_unlink_bss(_adapter *padapter, struct wlan_network *pnetwork); -+void rtw_cfg80211_surveydone_event_callback(_adapter *padapter); -+struct cfg80211_bss *rtw_cfg80211_inform_bss(_adapter *padapter, struct wlan_network *pnetwork); -+int rtw_cfg80211_check_bss(_adapter *padapter); -+void rtw_cfg80211_ibss_indicate_connect(_adapter *padapter); -+void rtw_cfg80211_indicate_connect(_adapter *padapter); -+void rtw_cfg80211_indicate_disconnect(_adapter *padapter); -+void rtw_cfg80211_indicate_scan_done(_adapter *adapter, bool aborted); -+u32 rtw_cfg80211_wait_scan_req_empty(_adapter *adapter, u32 timeout_ms); -+ -+#ifdef CONFIG_AP_MODE -+void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint frame_len); -+void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, unsigned short reason); -+#endif //CONFIG_AP_MODE -+ -+void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, size_t len); -+void rtw_cfg80211_rx_p2p_action_public(_adapter *padapter, u8 *pmgmt_frame, uint frame_len); -+void rtw_cfg80211_rx_action_p2p(_adapter *padapter, u8 *pmgmt_frame, uint frame_len); -+void rtw_cfg80211_rx_action(_adapter *adapter, u8 *frame, uint frame_len, const char*msg); -+void rtw_cfg80211_rx_probe_request(_adapter *padapter, u8 *pmgmt_frame, uint frame_len); -+ -+int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, int type); -+ -+bool rtw_cfg80211_pwr_mgmt(_adapter *adapter); -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,4,0)) && !defined(COMPAT_KERNEL_RELEASE) -+#define rtw_cfg80211_rx_mgmt(adapter, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt((adapter)->pnetdev, freq, buf, len, gfp) -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3,6,0)) -+#define rtw_cfg80211_rx_mgmt(adapter, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt((adapter)->pnetdev, freq, sig_dbm, buf, len, gfp) -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3,12,0)) -+#define rtw_cfg80211_rx_mgmt(adapter, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt((adapter)->rtw_wdev, freq, sig_dbm, buf, len, gfp) -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3 , 18 , 0)) -+#define rtw_cfg80211_rx_mgmt(adapter , freq , sig_dbm , buf , len , gfp) cfg80211_rx_mgmt((adapter)->rtw_wdev , freq , sig_dbm , buf , len , 0 , gfp) -+#else -+#define rtw_cfg80211_rx_mgmt(adapter , freq , sig_dbm , buf , len , gfp) cfg80211_rx_mgmt((adapter)->rtw_wdev , freq , sig_dbm , buf , len , 0) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,4,0)) && !defined(COMPAT_KERNEL_RELEASE) -+#define rtw_cfg80211_send_rx_assoc(adapter, bss, buf, len) cfg80211_send_rx_assoc((adapter)->pnetdev, buf, len) -+#else -+#define rtw_cfg80211_send_rx_assoc(adapter, bss, buf, len) cfg80211_send_rx_assoc((adapter)->pnetdev, bss, buf, len) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,6,0)) -+#define rtw_cfg80211_mgmt_tx_status(adapter, cookie, buf, len, ack, gfp) cfg80211_mgmt_tx_status((adapter)->pnetdev, cookie, buf, len, ack, gfp) -+#else -+#define rtw_cfg80211_mgmt_tx_status(adapter, cookie, buf, len, ack, gfp) cfg80211_mgmt_tx_status((adapter)->rtw_wdev, cookie, buf, len, ack, gfp) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,6,0)) -+#define rtw_cfg80211_ready_on_channel(adapter, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel((adapter)->pnetdev, cookie, chan, channel_type, duration, gfp) -+#define rtw_cfg80211_remain_on_channel_expired(adapter, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired((adapter)->pnetdev, cookie, chan, chan_type, gfp) -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) -+#define rtw_cfg80211_ready_on_channel(adapter, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel((adapter)->rtw_wdev, cookie, chan, channel_type, duration, gfp) -+#define rtw_cfg80211_remain_on_channel_expired(adapter, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired((adapter)->rtw_wdev, cookie, chan, chan_type, gfp) -+#else -+#define rtw_cfg80211_ready_on_channel(adapter, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel((adapter)->rtw_wdev, cookie, chan, duration, gfp) -+#define rtw_cfg80211_remain_on_channel_expired(adapter, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired((adapter)->rtw_wdev, cookie, chan, gfp) -+#endif -+ -+#include "rtw_cfgvendor.h" -+ -+#endif //__IOCTL_CFG80211_H__ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c 2017-06-07 23:07:21.046690765 +0300 -@@ -0,0 +1,13924 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/ioctl_cfg80211.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/ioctl_cfg80211.c +--- linux-4.14.17/3rdparty/rtl8812au/os_dep/ioctl_cfg80211.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/ioctl_cfg80211.c 2018-02-06 17:42:30.723967357 +0200 +@@ -0,0 +1,5346 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. @@ -350620,28 +155968,5371 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++#define _IOCTL_CFG80211_C_ ++ ++#include ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ ++#define RTW_MAX_MGMT_TX_CNT (8) ++ ++#define RTW_SCAN_IE_LEN_MAX 2304 ++#define RTW_MAX_REMAIN_ON_CHANNEL_DURATION 65535 //ms ++#define RTW_MAX_NUM_PMKIDS 4 ++ ++#define RTW_CH_MAX_2G_CHANNEL 14 /* Max channel in 2G band */ ++ ++static const u32 rtw_cipher_suites[] = { ++ WLAN_CIPHER_SUITE_WEP40, ++ WLAN_CIPHER_SUITE_WEP104, ++ WLAN_CIPHER_SUITE_TKIP, ++ WLAN_CIPHER_SUITE_CCMP, ++#ifdef CONFIG_WAPI_SUPPORT ++ WLAN_CIPHER_SUITE_SMS4, ++#endif // CONFIG_WAPI_SUPPORT ++}; ++ ++#define RATETAB_ENT(_rate, _rateid, _flags) \ ++ { \ ++ .bitrate = (_rate), \ ++ .hw_value = (_rateid), \ ++ .flags = (_flags), \ ++ } ++ ++#define CHAN2G(_channel, _freq, _flags) { \ ++ .band = IEEE80211_BAND_2GHZ, \ ++ .center_freq = (_freq), \ ++ .hw_value = (_channel), \ ++ .flags = (_flags), \ ++ .max_antenna_gain = 0, \ ++ .max_power = 30, \ ++} ++ ++#define CHAN5G(_channel, _flags) { \ ++ .band = IEEE80211_BAND_5GHZ, \ ++ .center_freq = 5000 + (5 * (_channel)), \ ++ .hw_value = (_channel), \ ++ .flags = (_flags), \ ++ .max_antenna_gain = 0, \ ++ .max_power = 30, \ ++} ++ ++static struct ieee80211_rate rtw_rates[] = { ++ RATETAB_ENT(10, 0x1, 0), ++ RATETAB_ENT(20, 0x2, 0), ++ RATETAB_ENT(55, 0x4, 0), ++ RATETAB_ENT(110, 0x8, 0), ++ RATETAB_ENT(60, 0x10, 0), ++ RATETAB_ENT(90, 0x20, 0), ++ RATETAB_ENT(120, 0x40, 0), ++ RATETAB_ENT(180, 0x80, 0), ++ RATETAB_ENT(240, 0x100, 0), ++ RATETAB_ENT(360, 0x200, 0), ++ RATETAB_ENT(480, 0x400, 0), ++ RATETAB_ENT(540, 0x800, 0), ++}; ++ ++#define rtw_a_rates (rtw_rates + 4) ++#define RTW_A_RATES_NUM 8 ++#define rtw_g_rates (rtw_rates + 0) ++#define RTW_G_RATES_NUM 12 ++ ++#define RTW_2G_CHANNELS_NUM 14 ++#define RTW_5G_CHANNELS_NUM 37 ++ ++static struct ieee80211_channel rtw_2ghz_channels[] = { ++ CHAN2G(1, 2412, 0), ++ CHAN2G(2, 2417, 0), ++ CHAN2G(3, 2422, 0), ++ CHAN2G(4, 2427, 0), ++ CHAN2G(5, 2432, 0), ++ CHAN2G(6, 2437, 0), ++ CHAN2G(7, 2442, 0), ++ CHAN2G(8, 2447, 0), ++ CHAN2G(9, 2452, 0), ++ CHAN2G(10, 2457, 0), ++ CHAN2G(11, 2462, 0), ++ CHAN2G(12, 2467, 0), ++ CHAN2G(13, 2472, 0), ++ CHAN2G(14, 2484, 0), ++}; ++ ++static struct ieee80211_channel rtw_5ghz_a_channels[] = { ++ CHAN5G(34, 0), CHAN5G(36, 0), ++ CHAN5G(38, 0), CHAN5G(40, 0), ++ CHAN5G(42, 0), CHAN5G(44, 0), ++ CHAN5G(46, 0), CHAN5G(48, 0), ++ CHAN5G(52, 0), CHAN5G(56, 0), ++ CHAN5G(60, 0), CHAN5G(64, 0), ++ CHAN5G(100, 0), CHAN5G(104, 0), ++ CHAN5G(108, 0), CHAN5G(112, 0), ++ CHAN5G(116, 0), CHAN5G(120, 0), ++ CHAN5G(124, 0), CHAN5G(128, 0), ++ CHAN5G(132, 0), CHAN5G(136, 0), ++ CHAN5G(140, 0), CHAN5G(149, 0), ++ CHAN5G(153, 0), CHAN5G(157, 0), ++ CHAN5G(161, 0), CHAN5G(165, 0), ++ CHAN5G(184, 0), CHAN5G(188, 0), ++ CHAN5G(192, 0), CHAN5G(196, 0), ++ CHAN5G(200, 0), CHAN5G(204, 0), ++ CHAN5G(208, 0), CHAN5G(212, 0), ++ CHAN5G(216, 0), ++}; ++ ++ ++void rtw_2g_channels_init(struct ieee80211_channel *channels) ++{ ++ _rtw_memcpy((void*)channels, (void*)rtw_2ghz_channels, ++ sizeof(struct ieee80211_channel)*RTW_2G_CHANNELS_NUM ++ ); ++} ++ ++void rtw_5g_channels_init(struct ieee80211_channel *channels) ++{ ++ _rtw_memcpy((void*)channels, (void*)rtw_5ghz_a_channels, ++ sizeof(struct ieee80211_channel)*RTW_5G_CHANNELS_NUM ++ ); ++} ++ ++void rtw_2g_rates_init(struct ieee80211_rate *rates) ++{ ++ _rtw_memcpy(rates, rtw_g_rates, ++ sizeof(struct ieee80211_rate)*RTW_G_RATES_NUM ++ ); ++} ++ ++void rtw_5g_rates_init(struct ieee80211_rate *rates) ++{ ++ _rtw_memcpy(rates, rtw_a_rates, ++ sizeof(struct ieee80211_rate)*RTW_A_RATES_NUM ++ ); ++} ++ ++struct ieee80211_supported_band *rtw_spt_band_alloc( ++ enum ieee80211_band band ++ ) ++{ ++ struct ieee80211_supported_band *spt_band = NULL; ++ int n_channels, n_bitrates; ++ ++ if(band == IEEE80211_BAND_2GHZ) ++ { ++ n_channels = RTW_2G_CHANNELS_NUM; ++ n_bitrates = RTW_G_RATES_NUM; ++ } ++ else if(band == IEEE80211_BAND_5GHZ) ++ { ++ n_channels = RTW_5G_CHANNELS_NUM; ++ n_bitrates = RTW_A_RATES_NUM; ++ } ++ else ++ { ++ goto exit; ++ } ++ ++ spt_band = (struct ieee80211_supported_band *)rtw_zmalloc( ++ sizeof(struct ieee80211_supported_band) ++ + sizeof(struct ieee80211_channel)*n_channels ++ + sizeof(struct ieee80211_rate)*n_bitrates ++ ); ++ if(!spt_band) ++ goto exit; ++ ++ spt_band->channels = (struct ieee80211_channel*)(((u8*)spt_band)+sizeof(struct ieee80211_supported_band)); ++ spt_band->bitrates= (struct ieee80211_rate*)(((u8*)spt_band->channels)+sizeof(struct ieee80211_channel)*n_channels); ++ spt_band->band = band; ++ spt_band->n_channels = n_channels; ++ spt_band->n_bitrates = n_bitrates; ++ ++ if(band == IEEE80211_BAND_2GHZ) ++ { ++ rtw_2g_channels_init(spt_band->channels); ++ rtw_2g_rates_init(spt_band->bitrates); ++ } ++ else if(band == IEEE80211_BAND_5GHZ) ++ { ++ rtw_5g_channels_init(spt_band->channels); ++ rtw_5g_rates_init(spt_band->bitrates); ++ } ++ ++ //spt_band.ht_cap ++ ++exit: ++ ++ return spt_band; ++} ++ ++void rtw_spt_band_free(struct ieee80211_supported_band *spt_band) ++{ ++ u32 size; ++ ++ if(!spt_band) ++ return; ++ ++ if(spt_band->band == IEEE80211_BAND_2GHZ) ++ { ++ size = sizeof(struct ieee80211_supported_band) ++ + sizeof(struct ieee80211_channel)*RTW_2G_CHANNELS_NUM ++ + sizeof(struct ieee80211_rate)*RTW_G_RATES_NUM; ++ } ++ else if(spt_band->band == IEEE80211_BAND_5GHZ) ++ { ++ size = sizeof(struct ieee80211_supported_band) ++ + sizeof(struct ieee80211_channel)*RTW_5G_CHANNELS_NUM ++ + sizeof(struct ieee80211_rate)*RTW_A_RATES_NUM; ++ } ++ else ++ { ++ ++ } ++ rtw_mfree((u8*)spt_band, size); ++} ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++static const struct ieee80211_txrx_stypes ++rtw_cfg80211_default_mgmt_stypes[NUM_NL80211_IFTYPES] = { ++ [NL80211_IFTYPE_ADHOC] = { ++ .tx = 0xffff, ++ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) ++ }, ++ [NL80211_IFTYPE_STATION] = { ++ .tx = 0xffff, ++ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | ++ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) ++ }, ++ [NL80211_IFTYPE_AP] = { ++ .tx = 0xffff, ++ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | ++ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | ++ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | ++ BIT(IEEE80211_STYPE_DISASSOC >> 4) | ++ BIT(IEEE80211_STYPE_AUTH >> 4) | ++ BIT(IEEE80211_STYPE_DEAUTH >> 4) | ++ BIT(IEEE80211_STYPE_ACTION >> 4) ++ }, ++ [NL80211_IFTYPE_AP_VLAN] = { ++ /* copy AP */ ++ .tx = 0xffff, ++ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | ++ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | ++ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | ++ BIT(IEEE80211_STYPE_DISASSOC >> 4) | ++ BIT(IEEE80211_STYPE_AUTH >> 4) | ++ BIT(IEEE80211_STYPE_DEAUTH >> 4) | ++ BIT(IEEE80211_STYPE_ACTION >> 4) ++ }, ++ [NL80211_IFTYPE_P2P_CLIENT] = { ++ .tx = 0xffff, ++ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | ++ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) ++ }, ++ [NL80211_IFTYPE_P2P_GO] = { ++ .tx = 0xffff, ++ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | ++ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | ++ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | ++ BIT(IEEE80211_STYPE_DISASSOC >> 4) | ++ BIT(IEEE80211_STYPE_AUTH >> 4) | ++ BIT(IEEE80211_STYPE_DEAUTH >> 4) | ++ BIT(IEEE80211_STYPE_ACTION >> 4) ++ }, ++}; ++#endif ++ ++static int rtw_ieee80211_channel_to_frequency(int chan, int band) ++{ ++ /* see 802.11 17.3.8.3.2 and Annex J ++ * there are overlapping channel numbers in 5GHz and 2GHz bands */ ++ ++ if (band == IEEE80211_BAND_5GHZ) { ++ if (chan >= 182 && chan <= 196) ++ return 4000 + chan * 5; ++ else ++ return 5000 + chan * 5; ++ } else { /* IEEE80211_BAND_2GHZ */ ++ if (chan == 14) ++ return 2484; ++ else if (chan < 14) ++ return 2407 + chan * 5; ++ else ++ return 0; /* not supported */ ++ } ++} ++ ++#define MAX_BSSINFO_LEN 1000 ++static int rtw_cfg80211_inform_bss(_adapter *padapter, struct wlan_network *pnetwork) ++{ ++ int ret=0; ++ struct ieee80211_channel *notify_channel; ++ struct cfg80211_bss *bss; ++ //struct ieee80211_supported_band *band; ++ u16 channel; ++ u32 freq; ++ u64 notify_timestamp; ++ u16 notify_capability; ++ u16 notify_interval; ++ u8 *notify_ie; ++ size_t notify_ielen; ++ s32 notify_signal; ++ u8 buf[MAX_BSSINFO_LEN], *pbuf; ++ size_t len,bssinf_len=0; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; ++ ++ struct wireless_dev *wdev = padapter->rtw_wdev; ++ struct wiphy *wiphy = wdev->wiphy; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ ++ //DBG_8192C("%s\n", __func__); ++ ++ bssinf_len = pnetwork->network.IELength+sizeof (struct rtw_ieee80211_hdr_3addr); ++ if(bssinf_len > MAX_BSSINFO_LEN){ ++ DBG_871X("%s IE Length too long > %d byte \n",__FUNCTION__,MAX_BSSINFO_LEN); ++ goto exit; ++ } ++ ++ channel = pnetwork->network.Configuration.DSConfig; ++ if (channel <= RTW_CH_MAX_2G_CHANNEL) ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); ++ else ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); ++ ++ notify_channel = ieee80211_get_channel(wiphy, freq); ++ ++ //rtw_get_timestampe_from_ie() ++ notify_timestamp = jiffies_to_msecs(jiffies)*1000; /* uSec */ ++ ++ notify_interval = le16_to_cpu(*(u16*)rtw_get_beacon_interval_from_ie(pnetwork->network.IEs)); ++ notify_capability = le16_to_cpu(*(u16*)rtw_get_capability_from_ie(pnetwork->network.IEs)); ++ ++ ++ notify_ie = pnetwork->network.IEs+_FIXED_IE_LENGTH_; ++ notify_ielen = pnetwork->network.IELength-_FIXED_IE_LENGTH_; ++ ++ //We've set wiphy's signal_type as CFG80211_SIGNAL_TYPE_MBM: signal strength in mBm (100*dBm) ++ if ( check_fwstate(pmlmepriv, _FW_LINKED)== true && ++ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network)) { ++ notify_signal = 100*translate_percentage_to_dbm(padapter->recvpriv.signal_strength);//dbm ++ } else { ++ notify_signal = 100*translate_percentage_to_dbm(pnetwork->network.PhyInfo.SignalStrength);//dbm ++ } ++ ++/* ++ DBG_8192C("bssid: %2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X\n", ++ pnetwork->network.MacAddress[0], pnetwork->network.MacAddress[1], pnetwork->network.MacAddress[2], ++ pnetwork->network.MacAddress[3], pnetwork->network.MacAddress[4], pnetwork->network.MacAddress[5]); ++ DBG_8192C("Channel: %d(%d)\n", channel, freq); ++ DBG_8192C("Capability: %X\n", notify_capability); ++ DBG_8192C("Beacon interval: %d\n", notify_interval); ++ DBG_8192C("Signal: %d\n", notify_signal); ++ DBG_8192C("notify_timestamp: %#018llx\n", notify_timestamp); ++*/ ++ ++ pbuf = buf; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pbuf; ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); ++ //pmlmeext->mgnt_seq++; ++ ++ if (pnetwork->network.Reserved[0] == 1) { // WIFI_BEACON ++ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); ++ SetFrameSubType(pbuf, WIFI_BEACON); ++ } else { ++ _rtw_memcpy(pwlanhdr->addr1, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ SetFrameSubType(pbuf, WIFI_PROBERSP); ++ } ++ ++ _rtw_memcpy(pwlanhdr->addr2, pnetwork->network.MacAddress, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pnetwork->network.MacAddress, ETH_ALEN); ++ ++ ++ pbuf += sizeof(struct rtw_ieee80211_hdr_3addr); ++ len = sizeof (struct rtw_ieee80211_hdr_3addr); ++ ++ _rtw_memcpy(pbuf, pnetwork->network.IEs, pnetwork->network.IELength); ++ len += pnetwork->network.IELength; ++ ++ //#ifdef CONFIG_P2P ++ //if(rtw_get_p2p_ie(pnetwork->network.IEs+12, pnetwork->network.IELength-12, NULL, NULL)) ++ //{ ++ // DBG_8192C("%s, got p2p_ie\n", __func__); ++ //} ++ //#endif ++ ++ ++#if 1 ++ bss = cfg80211_inform_bss_frame(wiphy, notify_channel, (struct ieee80211_mgmt *)buf, ++ len, notify_signal, GFP_ATOMIC); ++#else ++ ++ bss = cfg80211_inform_bss(wiphy, notify_channel, (const u8 *)pnetwork->network.MacAddress, ++ notify_timestamp, notify_capability, notify_interval, notify_ie, ++ notify_ielen, notify_signal, GFP_ATOMIC/*GFP_KERNEL*/); ++#endif ++ ++ if (unlikely(!bss)) { ++ DBG_8192C("rtw_cfg80211_inform_bss error\n"); ++ return -EINVAL; ++ } ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38)) ++#ifndef COMPAT_KERNEL_RELEASE ++ //patch for cfg80211, update beacon ies to information_elements ++ if (pnetwork->network.Reserved[0] == 1) { // WIFI_BEACON ++ ++ if(bss->len_information_elements != bss->len_beacon_ies) ++ { ++ bss->information_elements = bss->beacon_ies; ++ bss->len_information_elements = bss->len_beacon_ies; ++ } ++ } ++#endif //COMPAT_KERNEL_RELEASE ++#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38) ++ ++/* ++ { ++ if( bss->information_elements == bss->proberesp_ies) ++ { ++ if( bss->len_information_elements != bss->len_proberesp_ies) ++ { ++ DBG_8192C("error!, len_information_elements != bss->len_proberesp_ies\n"); ++ } ++ ++ } ++ else if(bss->len_information_elements < bss->len_beacon_ies) ++ { ++ bss->information_elements = bss->beacon_ies; ++ bss->len_information_elements = bss->len_beacon_ies; ++ } ++ } ++*/ ++ ++ cfg80211_put_bss(bss); ++ ++exit: ++ return ret; ++ ++} ++ ++void rtw_cfg80211_indicate_connect(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ struct wireless_dev *pwdev = padapter->rtw_wdev; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); ++#endif ++ ++ ++ DBG_8192C("%s(padapter=%p)\n", __func__, padapter); ++ ++ if (pwdev->iftype != NL80211_IFTYPE_STATION ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ && pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT ++ #endif ++ ) { ++ return; ++ } ++ ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) ++ return; ++ ++#ifdef CONFIG_P2P ++ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ { ++ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ { ++ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ DBG_8192C("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), rtw_p2p_pre_state(pwdinfo)); ++ } ++ } ++#endif //CONFIG_P2P ++ ++ #ifdef CONFIG_LAYER2_ROAMING ++ if (rtw_to_roaming(padapter) > 0) { ++ #if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 39) || defined(COMPAT_KERNEL_RELEASE) ++ struct wiphy *wiphy = pwdev->wiphy; ++ struct ieee80211_channel *notify_channel; ++ u32 freq; ++ u16 channel = cur_network->network.Configuration.DSConfig; ++ ++ if (channel <= RTW_CH_MAX_2G_CHANNEL) ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); ++ else ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); ++ ++ notify_channel = ieee80211_get_channel(wiphy, freq); ++ #endif ++ ++ DBG_871X("%s call cfg80211_roamed\n", __FUNCTION__); ++ cfg80211_roamed(padapter->pnetdev ++ #if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 39) || defined(COMPAT_KERNEL_RELEASE) ++ , notify_channel ++ #endif ++ , cur_network->network.MacAddress ++ , pmlmepriv->assoc_req+sizeof(struct rtw_ieee80211_hdr_3addr)+2 ++ , pmlmepriv->assoc_req_len-sizeof(struct rtw_ieee80211_hdr_3addr)-2 ++ , pmlmepriv->assoc_rsp+sizeof(struct rtw_ieee80211_hdr_3addr)+6 ++ , pmlmepriv->assoc_rsp_len-sizeof(struct rtw_ieee80211_hdr_3addr)-6 ++ , GFP_ATOMIC); ++ } ++ else ++ #endif ++ { ++ DBG_8192C("pwdev->sme_state(b)=%d\n", pwdev->sme_state); ++ cfg80211_connect_result(padapter->pnetdev, cur_network->network.MacAddress ++ , pmlmepriv->assoc_req+sizeof(struct rtw_ieee80211_hdr_3addr)+2 ++ , pmlmepriv->assoc_req_len-sizeof(struct rtw_ieee80211_hdr_3addr)-2 ++ , pmlmepriv->assoc_rsp+sizeof(struct rtw_ieee80211_hdr_3addr)+6 ++ , pmlmepriv->assoc_rsp_len-sizeof(struct rtw_ieee80211_hdr_3addr)-6 ++ , WLAN_STATUS_SUCCESS, GFP_ATOMIC); ++ DBG_8192C("pwdev->sme_state(a)=%d\n", pwdev->sme_state); ++ } ++} ++ ++void rtw_cfg80211_indicate_disconnect(_adapter *padapter) ++{ ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct wireless_dev *pwdev = padapter->rtw_wdev; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); ++#endif ++ ++ DBG_8192C("%s(padapter=%p)\n", __func__, padapter); ++ ++ if (pwdev->iftype != NL80211_IFTYPE_STATION ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ && pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT ++ #endif ++ ) { ++ return; ++ } ++ ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) ++ return; ++ ++#ifdef CONFIG_P2P ++ if( pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ { ++ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ { ++ _cancel_timer_ex( &pwdinfo->find_phase_timer ); ++ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); ++ _cancel_timer_ex( &pwdinfo->pre_tx_scan_timer); ++ ++ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ ++ DBG_8192C("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), rtw_p2p_pre_state(pwdinfo)); ++ } ++ } ++#endif //CONFIG_P2P ++ ++ if (!padapter->mlmepriv.not_indic_disco) { ++ DBG_8192C("pwdev->sme_state(b)=%d\n", pwdev->sme_state); ++ ++ if(pwdev->sme_state==CFG80211_SME_CONNECTING) ++ cfg80211_connect_result(padapter->pnetdev, NULL, NULL, 0, NULL, 0, ++ WLAN_STATUS_UNSPECIFIED_FAILURE, GFP_ATOMIC/*GFP_KERNEL*/); ++ else if(pwdev->sme_state==CFG80211_SME_CONNECTED) ++ cfg80211_disconnected(padapter->pnetdev, 0, NULL, 0, GFP_ATOMIC); ++ //else ++ //DBG_8192C("pwdev->sme_state=%d\n", pwdev->sme_state); ++ ++ DBG_8192C("pwdev->sme_state(a)=%d\n", pwdev->sme_state); ++ } ++} ++ ++ ++#ifdef CONFIG_AP_MODE ++static int rtw_cfg80211_ap_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) ++{ ++ int ret = 0; ++ u32 wep_key_idx, wep_key_len,wep_total_len; ++ struct sta_info *psta = NULL, *pbcmc_sta = NULL; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv* psecuritypriv=&(padapter->securitypriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ DBG_8192C("%s\n", __FUNCTION__); ++ ++ param->u.crypt.err = 0; ++ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; ++ ++ //sizeof(struct ieee_param) = 64 bytes; ++ //if (param_len != (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) ++ if (param_len != sizeof(struct ieee_param) + param->u.crypt.key_len) ++ { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && ++ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ { ++ if (param->u.crypt.idx >= WEP_KEYS) ++ { ++ ret = -EINVAL; ++ goto exit; ++ } ++ } ++ else ++ { ++ psta = rtw_get_stainfo(pstapriv, param->sta_addr); ++ if(!psta) ++ { ++ //ret = -EINVAL; ++ DBG_8192C("rtw_set_encryption(), sta has already been removed or never been added\n"); ++ goto exit; ++ } ++ } ++ ++ if (strcmp(param->u.crypt.alg, "none") == 0 && (psta==NULL)) ++ { ++ //todo:clear default encryption keys ++ ++ DBG_8192C("clear default encryption keys, keyid=%d\n", param->u.crypt.idx); ++ ++ goto exit; ++ } ++ ++ ++ if (strcmp(param->u.crypt.alg, "WEP") == 0 && (psta==NULL)) ++ { ++ DBG_8192C("r871x_set_encryption, crypt.alg = WEP\n"); ++ ++ wep_key_idx = param->u.crypt.idx; ++ wep_key_len = param->u.crypt.key_len; ++ ++ DBG_8192C("r871x_set_encryption, wep_key_idx=%d, len=%d\n", wep_key_idx, wep_key_len); ++ ++ if((wep_key_idx >= WEP_KEYS) || (wep_key_len<=0)) ++ { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (wep_key_len > 0) ++ { ++ wep_key_len = wep_key_len <= 5 ? 5 : 13; ++ } ++ ++ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) ++ { ++ //wep default key has not been set, so use this key index as default key. ++ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; ++ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ psecuritypriv->dot11PrivacyAlgrthm=_WEP40_; ++ psecuritypriv->dot118021XGrpPrivacy=_WEP40_; ++ ++ if(wep_key_len == 13) ++ { ++ psecuritypriv->dot11PrivacyAlgrthm=_WEP104_; ++ psecuritypriv->dot118021XGrpPrivacy=_WEP104_; ++ } ++ ++ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; ++ } ++ ++ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); ++ ++ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; ++ ++ rtw_ap_set_wep_key(padapter, param->u.crypt.key, wep_key_len, wep_key_idx, 1); ++ ++ goto exit; ++ ++ } ++ ++ ++ if(!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) // //group key ++ { ++ if(param->u.crypt.set_tx == 0) //group key ++ { ++ if(strcmp(param->u.crypt.alg, "WEP") == 0) ++ { ++ DBG_8192C("%s, set group_key, WEP\n", __FUNCTION__); ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; ++ if(param->u.crypt.key_len==13) ++ { ++ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; ++ } ++ ++ } ++ else if(strcmp(param->u.crypt.alg, "TKIP") == 0) ++ { ++ DBG_8192C("%s, set group_key, TKIP\n", __FUNCTION__); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); ++ ++ //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); ++ //set mic key ++ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); ++ ++ psecuritypriv->busetkipkey = true; ++ ++ } ++ else if(strcmp(param->u.crypt.alg, "CCMP") == 0) ++ { ++ DBG_8192C("%s, set group_key, CCMP\n", __FUNCTION__); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _AES_; ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); ++ } ++ else ++ { ++ DBG_8192C("%s, set group_key, none\n", __FUNCTION__); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; ++ } ++ ++ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; ++ ++ psecuritypriv->binstallGrpkey = true; ++ ++ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;//!!! ++ ++ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); ++ ++ pbcmc_sta=rtw_get_bcmc_stainfo(padapter); ++ if(pbcmc_sta) ++ { ++ pbcmc_sta->ieee8021x_blocked = false; ++ pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy ++ } ++ ++ } ++ ++ goto exit; ++ ++ } ++ ++ if(psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) // psk/802_1x ++ { ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) ++ { ++ if(param->u.crypt.set_tx ==1) //pairwise key ++ { ++ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); ++ ++ if(strcmp(param->u.crypt.alg, "WEP") == 0) ++ { ++ DBG_8192C("%s, set pairwise key, WEP\n", __FUNCTION__); ++ ++ psta->dot118021XPrivacy = _WEP40_; ++ if(param->u.crypt.key_len==13) ++ { ++ psta->dot118021XPrivacy = _WEP104_; ++ } ++ } ++ else if(strcmp(param->u.crypt.alg, "TKIP") == 0) ++ { ++ DBG_8192C("%s, set pairwise key, TKIP\n", __FUNCTION__); ++ ++ psta->dot118021XPrivacy = _TKIP_; ++ ++ //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); ++ //set mic key ++ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); ++ ++ psecuritypriv->busetkipkey = true; ++ ++ } ++ else if(strcmp(param->u.crypt.alg, "CCMP") == 0) ++ { ++ ++ DBG_8192C("%s, set pairwise key, CCMP\n", __FUNCTION__); ++ ++ psta->dot118021XPrivacy = _AES_; ++ } ++ else ++ { ++ DBG_8192C("%s, set pairwise key, none\n", __FUNCTION__); ++ ++ psta->dot118021XPrivacy = _NO_PRIVACY_; ++ } ++ ++ rtw_ap_set_pairwise_key(padapter, psta); ++ ++ psta->ieee8021x_blocked = false; ++ ++ psta->bpairwise_key_installed = true; ++ ++ } ++ else//group key??? ++ { ++ if(strcmp(param->u.crypt.alg, "WEP") == 0) ++ { ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); ++ ++ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; ++ if(param->u.crypt.key_len==13) ++ { ++ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; ++ } ++ } ++ else if(strcmp(param->u.crypt.alg, "TKIP") == 0) ++ { ++ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); ++ ++ //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); ++ //set mic key ++ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); ++ ++ psecuritypriv->busetkipkey = true; ++ ++ } ++ else if(strcmp(param->u.crypt.alg, "CCMP") == 0) ++ { ++ psecuritypriv->dot118021XGrpPrivacy = _AES_; ++ ++ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); ++ } ++ else ++ { ++ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; ++ } ++ ++ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; ++ ++ psecuritypriv->binstallGrpkey = true; ++ ++ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;//!!! ++ ++ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); ++ ++ pbcmc_sta=rtw_get_bcmc_stainfo(padapter); ++ if(pbcmc_sta) ++ { ++ pbcmc_sta->ieee8021x_blocked = false; ++ pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy ++ } ++ ++ } ++ ++ } ++ ++ } ++ ++exit: ++ ++ return ret; ++ ++} ++#endif ++ ++static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) ++{ ++ int ret = 0; ++ u32 wep_key_idx, wep_key_len,wep_total_len; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++#ifdef CONFIG_P2P ++ struct wifidirect_info* pwdinfo = &padapter->wdinfo; ++#endif //CONFIG_P2P ++ ++ ++ ++ DBG_8192C("%s\n", __func__); ++ ++ param->u.crypt.err = 0; ++ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; ++ ++ if (param_len < (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) ++ { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && ++ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ { ++ if (param->u.crypt.idx >= WEP_KEYS) ++ { ++ ret = -EINVAL; ++ goto exit; ++ } ++ } else { ++#ifdef CONFIG_WAPI_SUPPORT ++ if (strcmp(param->u.crypt.alg, "SMS4")) ++#endif ++ { ++ ret = -EINVAL; ++ goto exit; ++ } ++ } ++ ++ if (strcmp(param->u.crypt.alg, "WEP") == 0) ++ { ++ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("wpa_set_encryption, crypt.alg = WEP\n")); ++ DBG_8192C("wpa_set_encryption, crypt.alg = WEP\n"); ++ ++ wep_key_idx = param->u.crypt.idx; ++ wep_key_len = param->u.crypt.key_len; ++ ++ if ((wep_key_idx > WEP_KEYS) || (wep_key_len <= 0)) ++ { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) ++ { ++ //wep default key has not been set, so use this key index as default key. ++ ++ wep_key_len = wep_key_len <= 5 ? 5 : 13; ++ ++ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; ++ ++ if(wep_key_len==13) ++ { ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; ++ } ++ ++ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; ++ } ++ ++ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); ++ ++ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; ++ ++ rtw_set_key(padapter, psecuritypriv, wep_key_idx, 0); ++ ++ goto exit; ++ } ++ ++ if(padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) // 802_1x ++ { ++ struct sta_info * psta,*pbcmc_sta; ++ struct sta_priv * pstapriv = &padapter->stapriv; ++ ++ //DBG_8192C("%s, : dot11AuthAlgrthm == dot11AuthAlgrthm_8021X \n", __func__); ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == true) //sta mode ++ { ++ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); ++ if (psta == NULL) { ++ //DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail \n")); ++ DBG_8192C("%s, : Obtain Sta_info fail \n", __func__); ++ } ++ else ++ { ++ //Jeff: don't disable ieee8021x_blocked while clearing key ++ if (strcmp(param->u.crypt.alg, "none") != 0) ++ psta->ieee8021x_blocked = false; ++ ++ ++ if((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| ++ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) ++ { ++ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; ++ } ++ ++ if(param->u.crypt.set_tx ==1)//pairwise key ++ { ++ ++ DBG_8192C("%s, : param->u.crypt.set_tx ==1 \n", __func__); ++ ++ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); ++ ++ if(strcmp(param->u.crypt.alg, "TKIP") == 0)//set mic key ++ { ++ //DEBUG_ERR(("\nset key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); ++ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); ++ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); ++ ++ padapter->securitypriv.busetkipkey=false; ++ //_set_timer(&padapter->securitypriv.tkip_timer, 50); ++ } ++ ++ //DEBUG_ERR((" param->u.crypt.key_len=%d\n",param->u.crypt.key_len)); ++ DBG_871X(" ~~~~set sta key:unicastkey\n"); ++ ++ rtw_setstakey_cmd(padapter, (unsigned char *)psta, true); ++ } ++ else//group key ++ { ++ _rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key,(param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); ++ _rtw_memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[16]),8); ++ _rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[24]),8); ++ padapter->securitypriv.binstallGrpkey = true; ++ //DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); ++ DBG_871X(" ~~~~set sta key:groupkey\n"); ++ ++ padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; ++ ++ rtw_set_key(padapter,&padapter->securitypriv,param->u.crypt.idx, 1); ++#ifdef CONFIG_P2P ++ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ { ++ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) ++ { ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_DONE); ++ } ++ } ++#endif //CONFIG_P2P ++ ++ } ++ } ++ ++ pbcmc_sta=rtw_get_bcmc_stainfo(padapter); ++ if(pbcmc_sta==NULL) ++ { ++ //DEBUG_ERR( ("Set OID_802_11_ADD_KEY: bcmc stainfo is null \n")); ++ } ++ else ++ { ++ //Jeff: don't disable ieee8021x_blocked while clearing key ++ if (strcmp(param->u.crypt.alg, "none") != 0) ++ pbcmc_sta->ieee8021x_blocked = false; ++ ++ if((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| ++ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) ++ { ++ pbcmc_sta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; ++ } ++ } ++ } ++ else if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) //adhoc mode ++ { ++ } ++ } ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if (strcmp(param->u.crypt.alg, "SMS4") == 0) ++ { ++ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; ++ PRT_WAPI_STA_INFO pWapiSta; ++ u8 WapiASUEPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; ++ u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; ++ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; ++ ++ if(param->u.crypt.set_tx == 1) ++ { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if(_rtw_memcmp(pWapiSta->PeerMacAddr,param->sta_addr,6)) ++ { ++ _rtw_memcpy(pWapiSta->lastTxUnicastPN,WapiASUEPNInitialValueSrc,16); ++ ++ pWapiSta->wapiUsk.bSet = true; ++ _rtw_memcpy(pWapiSta->wapiUsk.dataKey,param->u.crypt.key,16); ++ _rtw_memcpy(pWapiSta->wapiUsk.micKey,param->u.crypt.key+16,16); ++ pWapiSta->wapiUsk.keyId = param->u.crypt.idx ; ++ pWapiSta->wapiUsk.bTxEnable = true; ++ ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue,WapiAEPNInitialValueSrc,16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue,WapiAEPNInitialValueSrc,16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue,WapiAEPNInitialValueSrc,16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue,WapiAEPNInitialValueSrc,16); ++ _rtw_memcpy(pWapiSta->lastRxUnicastPN,WapiAEPNInitialValueSrc,16); ++ pWapiSta->wapiUskUpdate.bTxEnable = false; ++ pWapiSta->wapiUskUpdate.bSet = false; ++ ++ if (psecuritypriv->sw_encrypt== false || psecuritypriv->sw_decrypt == false) ++ { ++ //set unicast key for ASUE ++ rtw_wapi_set_key(padapter, &pWapiSta->wapiUsk, pWapiSta, false, false); ++ } ++ } ++ } ++ } ++ else ++ { ++ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { ++ if(_rtw_memcmp(pWapiSta->PeerMacAddr,get_bssid(pmlmepriv),6)) ++ { ++ pWapiSta->wapiMsk.bSet = true; ++ _rtw_memcpy(pWapiSta->wapiMsk.dataKey,param->u.crypt.key,16); ++ _rtw_memcpy(pWapiSta->wapiMsk.micKey,param->u.crypt.key+16,16); ++ pWapiSta->wapiMsk.keyId = param->u.crypt.idx ; ++ pWapiSta->wapiMsk.bTxEnable = false; ++ if(!pWapiSta->bSetkeyOk) ++ pWapiSta->bSetkeyOk = true; ++ pWapiSta->bAuthenticateInProgress = false; ++ ++ _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); ++ ++ if (psecuritypriv->sw_decrypt == false) ++ { ++ //set rx broadcast key for ASUE ++ rtw_wapi_set_key(padapter, &pWapiSta->wapiMsk, pWapiSta, true, false); ++ } ++ } ++ ++ } ++ } ++ } ++#endif ++ ++ ++exit: ++ ++ DBG_8192C("%s, ret=%d\n", __func__, ret); ++ ++ ++ ++ return ret; ++} ++ ++static int cfg80211_rtw_add_key(struct wiphy *wiphy, struct net_device *ndev, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ u8 key_index, bool pairwise, const u8 *mac_addr, ++#else // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) ++ u8 key_index, const u8 *mac_addr, ++#endif // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) ++ struct key_params *params) ++{ ++ char *alg_name; ++ u32 param_len; ++ struct ieee_param *param = NULL; ++ int ret=0; ++ struct wireless_dev *rtw_wdev = wiphy_to_wdev(wiphy); ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ DBG_871X(FUNC_NDEV_FMT" adding key for %pM\n", FUNC_NDEV_ARG(ndev), mac_addr); ++ DBG_871X("cipher=0x%x\n", params->cipher); ++ DBG_871X("key_len=0x%x\n", params->key_len); ++ DBG_871X("seq_len=0x%x\n", params->seq_len); ++ DBG_871X("key_index=%d\n", key_index); ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ DBG_871X("pairwise=%d\n", pairwise); ++#endif // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) ++ ++ param_len = sizeof(struct ieee_param) + params->key_len; ++ param = (struct ieee_param *)rtw_malloc(param_len); ++ if (param == NULL) ++ return -1; ++ ++ _rtw_memset(param, 0, param_len); ++ ++ param->cmd = IEEE_CMD_SET_ENCRYPTION; ++ _rtw_memset(param->sta_addr, 0xff, ETH_ALEN); ++ ++ switch (params->cipher) { ++ case IW_AUTH_CIPHER_NONE: ++ //todo: remove key ++ //remove = 1; ++ alg_name = "none"; ++ break; ++ case WLAN_CIPHER_SUITE_WEP40: ++ case WLAN_CIPHER_SUITE_WEP104: ++ alg_name = "WEP"; ++ break; ++ case WLAN_CIPHER_SUITE_TKIP: ++ alg_name = "TKIP"; ++ break; ++ case WLAN_CIPHER_SUITE_CCMP: ++ alg_name = "CCMP"; ++ break; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ case WLAN_CIPHER_SUITE_SMS4: ++ alg_name= "SMS4"; ++ if(pairwise == NL80211_KEYTYPE_PAIRWISE) { ++ if (key_index != 0 && key_index != 1) { ++ ret = -ENOTSUPP; ++ goto addkey_end; ++ } ++ _rtw_memcpy((void*)param->sta_addr, (void*)mac_addr, ETH_ALEN); ++ } else { ++ DBG_871X("mac_addr is null \n"); ++ } ++ DBG_871X("rtw_wx_set_enc_ext: SMS4 case \n"); ++ break; ++#endif ++ ++ default: ++ ret = -ENOTSUPP; ++ goto addkey_end; ++ } ++ ++ strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN); ++ ++ ++ if (!mac_addr || is_broadcast_ether_addr(mac_addr)) ++ { ++ param->u.crypt.set_tx = 0; //for wpa/wpa2 group key ++ } else { ++ param->u.crypt.set_tx = 1; //for wpa/wpa2 pairwise key ++ } ++ ++ ++ //param->u.crypt.idx = key_index - 1; ++ param->u.crypt.idx = key_index; ++ ++ if (params->seq_len && params->seq) ++ { ++ _rtw_memcpy(param->u.crypt.seq, params->seq, params->seq_len); ++ } ++ ++ if(params->key_len && params->key) ++ { ++ param->u.crypt.key_len = params->key_len; ++ _rtw_memcpy(param->u.crypt.key, params->key, params->key_len); ++ } ++ ++ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) ++ { ++ ret = rtw_cfg80211_set_encryption(ndev, param, param_len); ++ } ++ else if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) ++ { ++#ifdef CONFIG_AP_MODE ++ if(mac_addr) ++ _rtw_memcpy(param->sta_addr, (void*)mac_addr, ETH_ALEN); ++ ++ ret = rtw_cfg80211_ap_set_encryption(ndev, param, param_len); ++#endif ++ } ++ else ++ { ++ DBG_8192C("error! fw_state=0x%x, iftype=%d\n", pmlmepriv->fw_state, rtw_wdev->iftype); ++ ++ } ++ ++addkey_end: ++ if(param) ++ { ++ rtw_mfree((u8*)param, param_len); ++ } ++ ++ return ret; ++ ++} ++ ++static int cfg80211_rtw_get_key(struct wiphy *wiphy, struct net_device *ndev, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ u8 key_index, bool pairwise, const u8 *mac_addr, ++#else // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) ++ u8 key_index, const u8 *mac_addr, ++#endif // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) ++ void *cookie, ++ void (*callback)(void *cookie, ++ struct key_params*)) ++{ ++#if 0 ++ struct iwm_priv *iwm = ndev_to_iwm(ndev); ++ struct iwm_key *key = &iwm->keys[key_index]; ++ struct key_params params; ++ ++ IWM_DBG_WEXT(iwm, DBG, "Getting key %d\n", key_index); ++ ++ memset(¶ms, 0, sizeof(params)); ++ ++ params.cipher = key->cipher; ++ params.key_len = key->key_len; ++ params.seq_len = key->seq_len; ++ params.seq = key->seq; ++ params.key = key->key; ++ ++ callback(cookie, ¶ms); ++ ++ return key->key_len ? 0 : -ENOENT; ++#endif ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ return 0; ++} ++ ++static int cfg80211_rtw_del_key(struct wiphy *wiphy, struct net_device *ndev, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ u8 key_index, bool pairwise, const u8 *mac_addr) ++#else // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) ++ u8 key_index, const u8 *mac_addr) ++#endif // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++ DBG_871X(FUNC_NDEV_FMT" key_index=%d\n", FUNC_NDEV_ARG(ndev), key_index); ++ ++ if (key_index == psecuritypriv->dot11PrivacyKeyIndex) ++ { ++ //clear the flag of wep default key set. ++ psecuritypriv->bWepDefaultKeyIdxSet = 0; ++ } ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_set_default_key(struct wiphy *wiphy, ++ struct net_device *ndev, u8 key_index ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) ++ , bool unicast, bool multicast ++ #endif ++ ) ++{ ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++ DBG_871X(FUNC_NDEV_FMT" key_index=%d" ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) ++ ", unicast=%d, multicast=%d" ++ #endif ++ ".\n", FUNC_NDEV_ARG(ndev), key_index ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) ++ , unicast, multicast ++ #endif ++ ); ++ ++ if ((key_index < WEP_KEYS) && ((psecuritypriv->dot11PrivacyAlgrthm == _WEP40_) || (psecuritypriv->dot11PrivacyAlgrthm == _WEP104_))) //set wep default key ++ { ++ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ ++ psecuritypriv->dot11PrivacyKeyIndex = key_index; ++ ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; ++ if (psecuritypriv->dot11DefKeylen[key_index] == 13) ++ { ++ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; ++ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; ++ } ++ ++ psecuritypriv->bWepDefaultKeyIdxSet = 1; //set the flag to represent that wep default key has been set ++ } ++ ++ return 0; ++ ++} ++ ++static int cfg80211_rtw_get_station(struct wiphy *wiphy, ++ struct net_device *ndev, ++ u8 *mac, struct station_info *sinfo) ++{ ++ int ret = 0; ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ sinfo->filled = 0; ++ ++ if (!mac) { ++ DBG_871X(FUNC_NDEV_FMT" mac==%p\n", FUNC_NDEV_ARG(ndev), mac); ++ ret = -ENOENT; ++ goto exit; ++ } ++ ++ psta = rtw_get_stainfo(pstapriv, mac); ++ if (psta == NULL) { ++ DBG_8192C("%s, sta_info is null\n", __func__); ++ ret = -ENOENT; ++ goto exit; ++ } ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ DBG_871X(FUNC_NDEV_FMT" mac="MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(mac)); ++#endif ++ ++ //for infra./P2PClient mode ++ if( check_fwstate(pmlmepriv, WIFI_STATION_STATE) ++ && check_fwstate(pmlmepriv, _FW_LINKED) ++ ) ++ { ++ struct wlan_network *cur_network = &(pmlmepriv->cur_network); ++ ++ if (_rtw_memcmp(mac, cur_network->network.MacAddress, ETH_ALEN) == false) { ++ DBG_871X("%s, mismatch bssid="MAC_FMT"\n", __func__, MAC_ARG(cur_network->network.MacAddress)); ++ ret = -ENOENT; ++ goto exit; ++ } ++ ++ sinfo->filled |= STATION_INFO_SIGNAL; ++ sinfo->signal = translate_percentage_to_dbm(padapter->recvpriv.signal_strength); ++ ++ sinfo->filled |= STATION_INFO_TX_BITRATE; ++ sinfo->txrate.legacy = rtw_get_cur_max_rate(padapter); ++ ++ sinfo->filled |= STATION_INFO_RX_PACKETS; ++ sinfo->rx_packets = sta_rx_data_pkts(psta); ++ ++ sinfo->filled |= STATION_INFO_TX_PACKETS; ++ sinfo->tx_packets = psta->sta_stats.tx_pkts; ++ ++ } ++ ++ //for Ad-Hoc/AP mode ++ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) ++ ||check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) ++ ||check_fwstate(pmlmepriv, WIFI_AP_STATE)) ++ && check_fwstate(pmlmepriv, _FW_LINKED) ++ ) ++ { ++ //TODO: should acquire station info... ++ } ++ ++exit: ++ return ret; ++} ++ ++extern int netdev_open(struct net_device *pnetdev); ++#ifdef CONFIG_CONCURRENT_MODE ++extern int netdev_if2_open(struct net_device *pnetdev); ++#endif ++ ++/* ++enum nl80211_iftype { ++ NL80211_IFTYPE_UNSPECIFIED, ++ NL80211_IFTYPE_ADHOC, //1 ++ NL80211_IFTYPE_STATION, //2 ++ NL80211_IFTYPE_AP, //3 ++ NL80211_IFTYPE_AP_VLAN, ++ NL80211_IFTYPE_WDS, ++ NL80211_IFTYPE_MONITOR, //6 ++ NL80211_IFTYPE_MESH_POINT, ++ NL80211_IFTYPE_P2P_CLIENT, //8 ++ NL80211_IFTYPE_P2P_GO, //9 ++ //keep last ++ NUM_NL80211_IFTYPES, ++ NL80211_IFTYPE_MAX = NUM_NL80211_IFTYPES - 1 ++}; ++*/ ++static int cfg80211_rtw_change_iface(struct wiphy *wiphy, ++ struct net_device *ndev, ++ enum nl80211_iftype type, u32 *flags, ++ struct vif_params *params) ++{ ++ enum nl80211_iftype old_type; ++ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType ; ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct wireless_dev *rtw_wdev = wiphy_to_wdev(wiphy); ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); ++#endif ++ int ret = 0; ++ u8 change = false; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if(padapter->adapter_type == SECONDARY_ADAPTER) ++ { ++ DBG_871X(FUNC_NDEV_FMT" call netdev_if2_open\n", FUNC_NDEV_ARG(ndev)); ++ if(netdev_if2_open(ndev) != 0) { ++ ret= -EPERM; ++ goto exit; ++ } ++ } ++ else if(padapter->adapter_type == PRIMARY_ADAPTER) ++#endif //CONFIG_CONCURRENT_MODE ++ { ++ DBG_871X(FUNC_NDEV_FMT" call netdev_open\n", FUNC_NDEV_ARG(ndev)); ++ if(netdev_open(ndev) != 0) { ++ ret= -EPERM; ++ goto exit; ++ } ++ } ++ ++ if(_FAIL == rtw_pwr_wakeup(padapter)) { ++ ret= -EPERM; ++ goto exit; ++ } ++ ++ old_type = rtw_wdev->iftype; ++ DBG_871X(FUNC_NDEV_FMT" old_iftype=%d, new_iftype=%d\n", ++ FUNC_NDEV_ARG(ndev), old_type, type); ++ ++ if(old_type != type) ++ { ++ change = true; ++ pmlmeext->action_public_rxseq = 0xffff; ++ pmlmeext->action_public_dialog_token = 0xff; ++ } ++ ++ switch (type) { ++ case NL80211_IFTYPE_ADHOC: ++ networkType = Ndis802_11IBSS; ++ break; ++#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE)) ++ case NL80211_IFTYPE_P2P_CLIENT: ++#endif ++ case NL80211_IFTYPE_STATION: ++ networkType = Ndis802_11Infrastructure; ++ #ifdef CONFIG_P2P ++ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ { ++ if(change && rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) ++ { ++ _cancel_timer_ex( &pwdinfo->find_phase_timer ); ++ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); ++ _cancel_timer_ex( &pwdinfo->pre_tx_scan_timer); ++ ++ //it means remove GO and change mode from AP(GO) to station(P2P DEVICE) ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); ++ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); ++ ++ DBG_8192C("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), rtw_p2p_pre_state(pwdinfo)); ++ } ++ } ++ #endif //CONFIG_P2P ++ break; ++#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE)) ++ case NL80211_IFTYPE_P2P_GO: ++#endif ++ case NL80211_IFTYPE_AP: ++ networkType = Ndis802_11APMode; ++ #ifdef CONFIG_P2P ++ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ { ++ if(change && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ { ++ //it means P2P Group created, we will be GO and change mode from P2P DEVICE to AP(GO) ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); ++ } ++ } ++ #endif //CONFIG_P2P ++ break; ++ default: ++ return -EOPNOTSUPP; ++ } ++ ++ rtw_wdev->iftype = type; ++ ++ if (rtw_set_802_11_infrastructure_mode(padapter, networkType) ==false) ++ { ++ rtw_wdev->iftype = old_type; ++ ret = -EPERM; ++ goto exit; ++ } ++ ++ rtw_setopmode_cmd(padapter, networkType); ++ ++exit: ++ ++ return ret; ++} ++ ++void rtw_cfg80211_indicate_scan_done(struct rtw_wdev_priv *pwdev_priv, bool aborted) ++{ ++ _irqL irqL; ++ ++ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); ++ if(pwdev_priv->scan_request != NULL) ++ { ++ //struct cfg80211_scan_request *scan_request = pwdev_priv->scan_request; ++ ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_871X("%s with scan req\n", __FUNCTION__); ++ #endif ++ ++ //avoid WARN_ON(request != wiphy_to_dev(request->wiphy)->scan_req); ++ //if(scan_request == wiphy_to_dev(scan_request->wiphy)->scan_req) ++ if(pwdev_priv->scan_request->wiphy != pwdev_priv->rtw_wdev->wiphy) ++ { ++ DBG_8192C("error wiphy compare\n"); ++ } ++ else ++ { ++ cfg80211_scan_done(pwdev_priv->scan_request, aborted); ++ } ++ ++ pwdev_priv->scan_request = NULL; ++ ++ } else { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_871X("%s without scan req\n", __FUNCTION__); ++ #endif ++ } ++ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); ++} ++ ++void rtw_cfg80211_surveydone_event_callback(_adapter *padapter) ++{ ++ _irqL irqL; ++ _list *plist, *phead; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ _queue *queue = &(pmlmepriv->scanned_queue); ++ struct wlan_network *pnetwork = NULL; ++ u32 cnt=0; ++ u32 wait_for_surveydone; ++ sint wait_status; ++#ifdef CONFIG_P2P ++ struct wifidirect_info* pwdinfo = &padapter->wdinfo; ++#endif //CONFIG_P2P ++ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("%s\n", __func__); ++#endif ++ ++ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ phead = get_list_head(queue); ++ plist = get_next(phead); ++ ++ while(1) ++ { ++ if (rtw_end_of_queue_search(phead,plist)== true) ++ break; ++ ++ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); ++ ++ //report network only if the current channel set contains the channel to which this network belongs ++ if(rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 ++ #ifdef CONFIG_VALIDATE_SSID ++ && true == rtw_validate_ssid(&(pnetwork->network.Ssid)) ++ #endif ++ ) ++ { ++ //ev=translate_scan(padapter, a, pnetwork, ev, stop); ++ rtw_cfg80211_inform_bss(padapter, pnetwork); ++ } ++ ++ plist = get_next(plist); ++ ++ } ++ ++ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); ++ ++ //call this after other things have been done ++ rtw_cfg80211_indicate_scan_done(wdev_to_priv(padapter->rtw_wdev), false); ++} ++ ++static int rtw_cfg80211_set_probe_req_wpsp2pie(_adapter *padapter, char *buf, int len) ++{ ++ int ret = 0; ++ uint wps_ielen = 0; ++ u8 *wps_ie; ++ u32 p2p_ielen = 0; ++ u8 *p2p_ie; ++ u32 wfd_ielen = 0; ++ u8 *wfd_ie; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("%s, ielen=%d\n", __func__, len); ++#endif ++ ++ if(len>0) ++ { ++ if((wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen))) ++ { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("probe_req_wps_ielen=%d\n", wps_ielen); ++ #endif ++ ++ if(pmlmepriv->wps_probe_req_ie) ++ { ++ u32 free_len = pmlmepriv->wps_probe_req_ie_len; ++ pmlmepriv->wps_probe_req_ie_len = 0; ++ rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len); ++ pmlmepriv->wps_probe_req_ie = NULL; ++ } ++ ++ pmlmepriv->wps_probe_req_ie = rtw_malloc(wps_ielen); ++ if ( pmlmepriv->wps_probe_req_ie == NULL) { ++ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ _rtw_memcpy(pmlmepriv->wps_probe_req_ie, wps_ie, wps_ielen); ++ pmlmepriv->wps_probe_req_ie_len = wps_ielen; ++ } ++ ++ //buf += wps_ielen; ++ //len -= wps_ielen; ++ ++ #ifdef CONFIG_P2P ++ if((p2p_ie=rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen))) ++ { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("probe_req_p2p_ielen=%d\n", p2p_ielen); ++ #endif ++ ++ if(pmlmepriv->p2p_probe_req_ie) ++ { ++ u32 free_len = pmlmepriv->p2p_probe_req_ie_len; ++ pmlmepriv->p2p_probe_req_ie_len = 0; ++ rtw_mfree(pmlmepriv->p2p_probe_req_ie, free_len); ++ pmlmepriv->p2p_probe_req_ie = NULL; ++ } ++ ++ pmlmepriv->p2p_probe_req_ie = rtw_malloc(p2p_ielen); ++ if ( pmlmepriv->p2p_probe_req_ie == NULL) { ++ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ _rtw_memcpy(pmlmepriv->p2p_probe_req_ie, p2p_ie, p2p_ielen); ++ pmlmepriv->p2p_probe_req_ie_len = p2p_ielen; ++ } ++ #endif //CONFIG_P2P ++ ++ //buf += p2p_ielen; ++ //len -= p2p_ielen; ++ ++ #ifdef CONFIG_WFD ++ if(rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen)) ++ { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("probe_req_wfd_ielen=%d\n", wfd_ielen); ++ #endif ++ ++ if(pmlmepriv->wfd_probe_req_ie) ++ { ++ u32 free_len = pmlmepriv->wfd_probe_req_ie_len; ++ pmlmepriv->wfd_probe_req_ie_len = 0; ++ rtw_mfree(pmlmepriv->wfd_probe_req_ie, free_len); ++ pmlmepriv->wfd_probe_req_ie = NULL; ++ } ++ ++ pmlmepriv->wfd_probe_req_ie = rtw_malloc(wfd_ielen); ++ if ( pmlmepriv->wfd_probe_req_ie == NULL) { ++ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ rtw_get_wfd_ie(buf, len, pmlmepriv->wfd_probe_req_ie, &pmlmepriv->wfd_probe_req_ie_len); ++ } ++ #endif //CONFIG_WFD ++ ++ } ++ ++ return ret; ++ ++} ++ ++static int cfg80211_rtw_scan(struct wiphy *wiphy ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) ++ , struct net_device *ndev ++ #endif ++ , struct cfg80211_scan_request *request) ++{ ++ int i; ++ u8 _status = false; ++ int ret = 0; ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ struct mlme_priv *pmlmepriv= &padapter->mlmepriv; ++ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; ++ struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; ++ _irqL irqL; ++ u8 *wps_ie=NULL; ++ uint wps_ielen=0; ++ u8 *p2p_ie=NULL; ++ uint p2p_ielen=0; ++ u8 survey_times=3; ++#ifdef CONFIG_P2P ++ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); ++#endif //CONFIG_P2P ++ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); ++ struct cfg80211_ssid *ssids = request->ssids; ++ int social_channel = 0, j = 0; ++ bool need_indicate_scan_done = false; ++#ifdef CONFIG_CONCURRENT_MODE ++ PADAPTER pbuddy_adapter = NULL; ++ struct mlme_priv *pbuddy_mlmepriv = NULL; ++#endif //CONFIG_CONCURRENT_MODE ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++#endif ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (padapter->pbuddy_adapter) { ++ pbuddy_adapter = padapter->pbuddy_adapter; ++ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); ++ } ++#endif //CONFIG_CONCURRENT_MODE ++ ++#ifdef CONFIG_MP_INCLUDED ++if (padapter->registrypriv.mp_mode == 1) ++{ ++ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) ++ { ++ ret = -EPERM; ++ goto exit; ++ } ++} ++#endif ++ ++ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); ++ pwdev_priv->scan_request = request; ++ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); ++ ++ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) ++ { ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ DBG_871X("%s under WIFI_AP_STATE\n", __FUNCTION__); ++#endif ++ //need_indicate_scan_done = true; ++ //goto check_need_indicate_scan_done; ++ } ++ ++ if(_FAIL == rtw_pwr_wakeup(padapter)) { ++ need_indicate_scan_done = true; ++ goto check_need_indicate_scan_done; ++ } ++ ++ #ifdef CONFIG_P2P ++ if( pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ { ++ if(ssids->ssid != NULL ++ && _rtw_memcmp(ssids->ssid, "DIRECT-", 7) ++ && rtw_get_p2p_ie((u8 *)request->ie, request->ie_len, NULL, NULL) ++ ) ++ { ++ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ { ++ rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); ++ wdev_to_priv(padapter->rtw_wdev)->p2p_enabled = true; ++ } ++ else ++ { ++ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); ++ #endif ++ } ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); ++ ++ if(request->n_channels == 3 && ++ request->channels[0]->hw_value == 1 && ++ request->channels[1]->hw_value == 6 && ++ request->channels[2]->hw_value == 11 ++ ) ++ { ++ social_channel = 1; ++ } ++ } ++ } ++ #endif //CONFIG_P2P ++ ++ if(request->ie && request->ie_len>0) ++ { ++ rtw_cfg80211_set_probe_req_wpsp2pie(padapter, (u8 *)request->ie, request->ie_len ); ++ } ++ ++ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == true) ++ { ++ DBG_8192C("%s, bBusyTraffic == true\n", __func__); ++ need_indicate_scan_done = true; ++ goto check_need_indicate_scan_done; ++ } ++ if (rtw_is_scan_deny(padapter)){ ++ DBG_871X(FUNC_ADPT_FMT ": scan deny\n", FUNC_ADPT_ARG(padapter)); ++ need_indicate_scan_done = true; ++ goto check_need_indicate_scan_done; ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if(pbuddy_mlmepriv && (pbuddy_mlmepriv->LinkDetectInfo.bBusyTraffic == true)) ++ { ++ DBG_8192C("%s, bBusyTraffic == true at buddy_intf\n", __func__); ++ need_indicate_scan_done = true; ++ goto check_need_indicate_scan_done; ++ } ++#endif //CONFIG_CONCURRENT_MODE ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) ++ { ++ DBG_8192C("%s, fwstate=0x%x\n", __func__, pmlmepriv->fw_state); ++ need_indicate_scan_done = true; ++ goto check_need_indicate_scan_done; ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (check_buddy_fwstate(padapter, ++ _FW_UNDER_SURVEY|_FW_UNDER_LINKING|WIFI_UNDER_WPS) == true) ++ { ++ if(check_buddy_fwstate(padapter, _FW_UNDER_SURVEY)) ++ { ++ DBG_8192C("scanning_via_buddy_intf\n"); ++ pmlmepriv->scanning_via_buddy_intf = true; ++ } ++ ++ DBG_8192C("buddy_intf's mlme state:0x%x\n", pbuddy_mlmepriv->fw_state); ++ ++ need_indicate_scan_done = true; ++ goto check_need_indicate_scan_done; ++ } ++#endif ++ ++ ++#ifdef CONFIG_P2P ++ if( pwdinfo->driver_interface == DRIVER_CFG80211 ) ++ { ++ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) ++ { ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); ++ rtw_free_network_queue(padapter, true); ++ ++ if(social_channel == 0) ++ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); ++ else ++ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_SOCIAL_LAST); ++ } ++ } ++#endif //CONFIG_P2P ++ ++ ++ _rtw_memset(ssid, 0, sizeof(NDIS_802_11_SSID)*RTW_SSID_SCAN_AMOUNT); ++ //parsing request ssids, n_ssids ++ for (i = 0; i < request->n_ssids && i < RTW_SSID_SCAN_AMOUNT; i++) { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("ssid=%s, len=%d\n", ssids[i].ssid, ssids[i].ssid_len); ++ #endif ++ _rtw_memcpy(ssid[i].Ssid, ssids[i].ssid, ssids[i].ssid_len); ++ ssid[i].SsidLength = ssids[i].ssid_len; ++ } ++ ++ ++ /* parsing channels, n_channels */ ++ _rtw_memset(ch, 0, sizeof(struct rtw_ieee80211_channel)*RTW_CHANNEL_SCAN_AMOUNT); ++ for (i=0;in_channels && ichannels[i])); ++ #endif ++ ch[i].hw_value = request->channels[i]->hw_value; ++ ch[i].flags = request->channels[i]->flags; ++ } ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ if (request->n_channels == 1) { ++ for(i=1;in_channels == 2) { ++ _rtw_memcpy(&ch[survey_times], &ch[1], sizeof(struct rtw_ieee80211_channel)); ++ for(i=1;ilock, &irqL); ++ ++ ++ if(_status == false) ++ { ++ ret = -1; ++ } ++ ++check_need_indicate_scan_done: ++ if(need_indicate_scan_done) ++ rtw_cfg80211_surveydone_event_callback(padapter); ++ ++exit: ++ ++ return ret; ++ ++} ++ ++static int cfg80211_rtw_set_wiphy_params(struct wiphy *wiphy, u32 changed) ++{ ++#if 0 ++ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); ++ ++ if (changed & WIPHY_PARAM_RTS_THRESHOLD && ++ (iwm->conf.rts_threshold != wiphy->rts_threshold)) { ++ int ret; ++ ++ iwm->conf.rts_threshold = wiphy->rts_threshold; ++ ++ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_CFG_FIX, ++ CFG_RTS_THRESHOLD, ++ iwm->conf.rts_threshold); ++ if (ret < 0) ++ return ret; ++ } ++ ++ if (changed & WIPHY_PARAM_FRAG_THRESHOLD && ++ (iwm->conf.frag_threshold != wiphy->frag_threshold)) { ++ int ret; ++ ++ iwm->conf.frag_threshold = wiphy->frag_threshold; ++ ++ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_FA_CFG_FIX, ++ CFG_FRAG_THRESHOLD, ++ iwm->conf.frag_threshold); ++ if (ret < 0) ++ return ret; ++ } ++#endif ++ DBG_8192C("%s\n", __func__); ++ return 0; ++} ++ ++static int cfg80211_rtw_join_ibss(struct wiphy *wiphy, struct net_device *ndev, ++ struct cfg80211_ibss_params *params) ++{ ++#if 0 ++ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); ++ struct ieee80211_channel *chan = params->channel; ++ ++ if (!test_bit(IWM_STATUS_READY, &iwm->status)) ++ return -EIO; ++ ++ /* UMAC doesn't support creating or joining an IBSS network ++ * with specified bssid. */ ++ if (params->bssid) ++ return -EOPNOTSUPP; ++ ++ iwm->channel = ieee80211_frequency_to_channel(chan->center_freq); ++ iwm->umac_profile->ibss.band = chan->band; ++ iwm->umac_profile->ibss.channel = iwm->channel; ++ iwm->umac_profile->ssid.ssid_len = params->ssid_len; ++ memcpy(iwm->umac_profile->ssid.ssid, params->ssid, params->ssid_len); ++ ++ return iwm_send_mlme_profile(iwm); ++#endif ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ return 0; ++} ++ ++static int cfg80211_rtw_leave_ibss(struct wiphy *wiphy, struct net_device *ndev) ++{ ++#if 0 ++ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); ++ ++ if (iwm->umac_profile_active) ++ return iwm_invalidate_mlme_profile(iwm); ++#endif ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ return 0; ++} ++ ++static int rtw_cfg80211_set_wpa_version(struct security_priv *psecuritypriv, u32 wpa_version) ++{ ++ DBG_8192C("%s, wpa_version=%d\n", __func__, wpa_version); ++ ++ if (!wpa_version) { ++ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; ++ return 0; ++ } ++ ++ ++ if (wpa_version & (NL80211_WPA_VERSION_1 | NL80211_WPA_VERSION_2)) ++ { ++ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPAPSK; ++ } ++ ++/* ++ if (wpa_version & NL80211_WPA_VERSION_2) ++ { ++ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPA2PSK; ++ } ++*/ ++ ++ return 0; ++ ++} ++ ++static int rtw_cfg80211_set_auth_type(struct security_priv *psecuritypriv, ++ enum nl80211_auth_type sme_auth_type) ++{ ++ DBG_8192C("%s, nl80211_auth_type=%d\n", __func__, sme_auth_type); ++ ++ ++ switch (sme_auth_type) { ++ case NL80211_AUTHTYPE_AUTOMATIC: ++ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; ++ ++ break; ++ case NL80211_AUTHTYPE_OPEN_SYSTEM: ++ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; ++ ++ if(psecuritypriv->ndisauthtype>Ndis802_11AuthModeWPA) ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if(psecuritypriv->ndisauthtype == Ndis802_11AuthModeWAPI) ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; ++#endif ++ ++ break; ++ case NL80211_AUTHTYPE_SHARED_KEY: ++ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; ++ ++ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ ++ ++ break; ++ default: ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; ++ //return -ENOTSUPP; ++ } ++ ++ return 0; ++ ++} ++ ++static int rtw_cfg80211_set_cipher(struct security_priv *psecuritypriv, u32 cipher, bool ucast) ++{ ++ u32 ndisencryptstatus = Ndis802_11EncryptionDisabled; ++ ++ u32 *profile_cipher = ucast ? &psecuritypriv->dot11PrivacyAlgrthm : ++ &psecuritypriv->dot118021XGrpPrivacy; ++ ++ DBG_8192C("%s, ucast=%d, cipher=0x%x\n", __func__, ucast, cipher); ++ ++ ++ if (!cipher) { ++ *profile_cipher = _NO_PRIVACY_; ++ psecuritypriv->ndisencryptstatus = ndisencryptstatus; ++ return 0; ++ } ++ ++ switch (cipher) { ++ case IW_AUTH_CIPHER_NONE: ++ *profile_cipher = _NO_PRIVACY_; ++ ndisencryptstatus = Ndis802_11EncryptionDisabled; ++#ifdef CONFIG_WAPI_SUPPORT ++ if(psecuritypriv->dot11PrivacyAlgrthm ==_SMS4_ ) ++ { ++ *profile_cipher = _SMS4_; ++ } ++#endif ++ break; ++ case WLAN_CIPHER_SUITE_WEP40: ++ *profile_cipher = _WEP40_; ++ ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ case WLAN_CIPHER_SUITE_WEP104: ++ *profile_cipher = _WEP104_; ++ ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ case WLAN_CIPHER_SUITE_TKIP: ++ *profile_cipher = _TKIP_; ++ ndisencryptstatus = Ndis802_11Encryption2Enabled; ++ break; ++ case WLAN_CIPHER_SUITE_CCMP: ++ *profile_cipher = _AES_; ++ ndisencryptstatus = Ndis802_11Encryption3Enabled; ++ break; ++#ifdef CONFIG_WAPI_SUPPORT ++ case WLAN_CIPHER_SUITE_SMS4: ++ *profile_cipher = _SMS4_; ++ ndisencryptstatus = Ndis802_11_EncrypteionWAPI; ++ break; ++#endif ++ default: ++ DBG_8192C("Unsupported cipher: 0x%x\n", cipher); ++ return -ENOTSUPP; ++ } ++ ++ if(ucast) ++ { ++ psecuritypriv->ndisencryptstatus = ndisencryptstatus; ++ ++ //if(psecuritypriv->dot11PrivacyAlgrthm >= _AES_) ++ // psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPA2PSK; ++ } ++ ++ return 0; ++} ++ ++static int rtw_cfg80211_set_key_mgt(struct security_priv *psecuritypriv, u32 key_mgt) ++{ ++ DBG_8192C("%s, key_mgt=0x%x\n", __func__, key_mgt); ++ ++ if (key_mgt == WLAN_AKM_SUITE_8021X) ++ //*auth_type = UMAC_AUTH_TYPE_8021X; ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ else if (key_mgt == WLAN_AKM_SUITE_PSK) { ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; ++ } ++#ifdef CONFIG_WAPI_SUPPORT ++ else if(key_mgt ==WLAN_AKM_SUITE_WAPI_PSK){ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; ++ } ++ else if(key_mgt ==WLAN_AKM_SUITE_WAPI_CERT){ ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; ++ } ++#endif ++ ++ ++ else { ++ DBG_8192C("Invalid key mgt: 0x%x\n", key_mgt); ++ //return -EINVAL; ++ } ++ ++ return 0; ++} ++ ++static int rtw_cfg80211_set_wpa_ie(_adapter *padapter, u8 *pie, size_t ielen) ++{ ++ u8 *buf=NULL, *pos=NULL; ++ u32 left; ++ int group_cipher = 0, pairwise_cipher = 0; ++ int ret = 0; ++ int wpa_ielen=0; ++ int wpa2_ielen=0; ++ u8 *pwpa, *pwpa2; ++ u8 null_addr[]= {0,0,0,0,0,0}; ++ ++ if (pie == NULL || !ielen) { ++ /* Treat this as normal case, but need to clear WIFI_UNDER_WPS */ ++ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); ++ goto exit; ++ } ++ ++ if (ielen > MAX_WPA_IE_LEN+MAX_WPS_IE_LEN+MAX_P2P_IE_LEN) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ buf = rtw_zmalloc(ielen); ++ if (buf == NULL){ ++ ret = -ENOMEM; ++ goto exit; ++ } ++ ++ _rtw_memcpy(buf, pie , ielen); ++ ++ //dump ++ { ++ int i; ++ DBG_8192C("set wpa_ie(length:%zu):\n", ielen); ++ for(i=0;i0) ++ { ++ if(rtw_parse_wpa_ie(pwpa, wpa_ielen+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) ++ { ++ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; ++ padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeWPAPSK; ++ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &pwpa[0], wpa_ielen+2); ++ ++ DBG_8192C("got wpa_ie, wpa_ielen:%u\n", wpa_ielen); ++ } ++ } ++ ++ pwpa2 = rtw_get_wpa2_ie(buf, &wpa2_ielen, ielen); ++ if(pwpa2 && wpa2_ielen>0) ++ { ++ if(rtw_parse_wpa2_ie(pwpa2, wpa2_ielen+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) ++ { ++ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; ++ padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeWPA2PSK; ++ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &pwpa2[0], wpa2_ielen+2); ++ ++ DBG_8192C("got wpa2_ie, wpa2_ielen:%u\n", wpa2_ielen); ++ } ++ } ++ ++ if (group_cipher == 0) ++ { ++ group_cipher = WPA_CIPHER_NONE; ++ } ++ if (pairwise_cipher == 0) ++ { ++ pairwise_cipher = WPA_CIPHER_NONE; ++ } ++ ++ switch(group_cipher) ++ { ++ case WPA_CIPHER_NONE: ++ padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_; ++ padapter->securitypriv.ndisencryptstatus=Ndis802_11EncryptionDisabled; ++ break; ++ case WPA_CIPHER_WEP40: ++ padapter->securitypriv.dot118021XGrpPrivacy=_WEP40_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ case WPA_CIPHER_TKIP: ++ padapter->securitypriv.dot118021XGrpPrivacy=_TKIP_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; ++ break; ++ case WPA_CIPHER_CCMP: ++ padapter->securitypriv.dot118021XGrpPrivacy=_AES_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; ++ break; ++ case WPA_CIPHER_WEP104: ++ padapter->securitypriv.dot118021XGrpPrivacy=_WEP104_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ } ++ ++ switch(pairwise_cipher) ++ { ++ case WPA_CIPHER_NONE: ++ padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; ++ padapter->securitypriv.ndisencryptstatus=Ndis802_11EncryptionDisabled; ++ break; ++ case WPA_CIPHER_WEP40: ++ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ case WPA_CIPHER_TKIP: ++ padapter->securitypriv.dot11PrivacyAlgrthm=_TKIP_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; ++ break; ++ case WPA_CIPHER_CCMP: ++ padapter->securitypriv.dot11PrivacyAlgrthm=_AES_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; ++ break; ++ case WPA_CIPHER_WEP104: ++ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_; ++ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; ++ break; ++ } ++ ++ {/* handle wps_ie */ ++ uint wps_ielen; ++ u8 *wps_ie; ++ ++ wps_ie = rtw_get_wps_ie(buf, ielen, NULL, &wps_ielen); ++ if (wps_ie && wps_ielen > 0) { ++ DBG_8192C("got wps_ie, wps_ielen:%u\n", wps_ielen); ++ padapter->securitypriv.wps_ie_len = wps_ielensecuritypriv.wps_ie, wps_ie, padapter->securitypriv.wps_ie_len); ++ set_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS); ++ } else { ++ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); ++ } ++ } ++ ++ #ifdef CONFIG_P2P ++ {//check p2p_ie for assoc req; ++ uint p2p_ielen=0; ++ u8 *p2p_ie; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ if((p2p_ie=rtw_get_p2p_ie(buf, ielen, NULL, &p2p_ielen))) ++ { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("%s p2p_assoc_req_ielen=%d\n", __FUNCTION__, p2p_ielen); ++ #endif ++ ++ if(pmlmepriv->p2p_assoc_req_ie) ++ { ++ u32 free_len = pmlmepriv->p2p_assoc_req_ie_len; ++ pmlmepriv->p2p_assoc_req_ie_len = 0; ++ rtw_mfree(pmlmepriv->p2p_assoc_req_ie, free_len); ++ pmlmepriv->p2p_assoc_req_ie = NULL; ++ } ++ ++ pmlmepriv->p2p_assoc_req_ie = rtw_malloc(p2p_ielen); ++ if ( pmlmepriv->p2p_assoc_req_ie == NULL) { ++ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ goto exit; ++ } ++ _rtw_memcpy(pmlmepriv->p2p_assoc_req_ie, p2p_ie, p2p_ielen); ++ pmlmepriv->p2p_assoc_req_ie_len = p2p_ielen; ++ } ++ } ++ #endif //CONFIG_P2P ++ ++ #ifdef CONFIG_WFD ++ {//check wfd_ie for assoc req; ++ uint wfd_ielen=0; ++ u8 *wfd_ie; ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ if(rtw_get_wfd_ie(buf, ielen, NULL, &wfd_ielen)) ++ { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("%s wfd_assoc_req_ielen=%d\n", __FUNCTION__, wfd_ielen); ++ #endif ++ ++ if(pmlmepriv->wfd_assoc_req_ie) ++ { ++ u32 free_len = pmlmepriv->wfd_assoc_req_ie_len; ++ pmlmepriv->wfd_assoc_req_ie_len = 0; ++ rtw_mfree(pmlmepriv->wfd_assoc_req_ie, free_len); ++ pmlmepriv->wfd_assoc_req_ie = NULL; ++ } ++ ++ pmlmepriv->wfd_assoc_req_ie = rtw_malloc(wfd_ielen); ++ if ( pmlmepriv->wfd_assoc_req_ie == NULL) { ++ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ goto exit; ++ } ++ rtw_get_wfd_ie(buf, ielen, pmlmepriv->wfd_assoc_req_ie, &pmlmepriv->wfd_assoc_req_ie_len); ++ } ++ } ++ #endif //CONFIG_WFD ++ ++ //TKIP and AES disallow multicast packets until installing group key ++ if(padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_ ++ || padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_ ++ || padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) ++ //WPS open need to enable multicast ++ //|| check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == true) ++ rtw_hal_set_hwreg(padapter, HW_VAR_OFF_RCR_AM, null_addr); ++ ++ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, ++ ("rtw_set_wpa_ie: pairwise_cipher=0x%08x padapter->securitypriv.ndisencryptstatus=%d padapter->securitypriv.ndisauthtype=%d\n", ++ pairwise_cipher, padapter->securitypriv.ndisencryptstatus, padapter->securitypriv.ndisauthtype)); ++ ++exit: ++ if (buf) ++ rtw_mfree(buf, ielen); ++ if (ret) ++ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); ++ return ret; ++} ++ ++static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, ++ struct cfg80211_connect_params *sme) ++{ ++ int ret=0; ++ _irqL irqL; ++ _list *phead; ++ struct wlan_network *pnetwork = NULL; ++ NDIS_802_11_AUTHENTICATION_MODE authmode; ++ NDIS_802_11_SSID ndis_ssid; ++ u8 *dst_ssid, *src_ssid; ++ u8 *dst_bssid, *src_bssid; ++ //u8 matched_by_bssid=false; ++ //u8 matched_by_ssid=false; ++ u8 matched=false; ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ _queue *queue = &pmlmepriv->scanned_queue; ++ ++ DBG_871X("=>"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ DBG_871X("privacy=%d, key=%p, key_len=%d, key_idx=%d\n", ++ sme->privacy, sme->key, sme->key_len, sme->key_idx); ++ ++ ++ if(wdev_to_priv(padapter->rtw_wdev)->block == true) ++ { ++ ret = -EBUSY; ++ DBG_871X("%s wdev_priv.block is set\n", __FUNCTION__); ++ goto exit; ++ } ++ ++ if(_FAIL == rtw_pwr_wakeup(padapter)) { ++ ret= -EPERM; ++ goto exit; ++ } ++ ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) { ++ ret = -EPERM; ++ goto exit; ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (check_buddy_fwstate(padapter, _FW_UNDER_LINKING) == true) { ++ DBG_8192C("%s, but buddy_intf is under linking\n", __FUNCTION__); ++ ret = -EINVAL; ++ goto exit; ++ } ++ if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY) == true) { ++ rtw_scan_abort(padapter->pbuddy_adapter); ++ } ++#endif ++ ++ if (!sme->ssid || !sme->ssid_len) ++ { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (sme->ssid_len > IW_ESSID_MAX_SIZE){ ++ ++ ret= -E2BIG; ++ goto exit; ++ } ++ ++ ++ _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID)); ++ ndis_ssid.SsidLength = sme->ssid_len; ++ _rtw_memcpy(ndis_ssid.Ssid, sme->ssid, sme->ssid_len); ++ ++ DBG_8192C("ssid=%s, len=%zu\n", ndis_ssid.Ssid, sme->ssid_len); ++ ++ ++ if (sme->bssid) ++ DBG_8192C("bssid="MAC_FMT"\n", MAC_ARG(sme->bssid)); ++ ++ ++ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) { ++ ret = -EBUSY; ++ DBG_8192C("%s, fw_state=0x%x, goto exit\n", __FUNCTION__, pmlmepriv->fw_state); ++ goto exit; ++ } ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { ++ rtw_scan_abort(padapter); ++ } ++ ++ _enter_critical_bh(&queue->lock, &irqL); ++ ++ phead = get_list_head(queue); ++ pmlmepriv->pscanned = get_next(phead); ++ ++ while (1) ++ { ++ if (rtw_end_of_queue_search(phead, pmlmepriv->pscanned) == true) ++ { ++ break; ++ } ++ ++ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); ++ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); ++ ++ dst_ssid = pnetwork->network.Ssid.Ssid; ++ dst_bssid = pnetwork->network.MacAddress; ++ ++ if(sme->bssid) { ++ if(_rtw_memcmp(pnetwork->network.MacAddress, sme->bssid, ETH_ALEN) == false) ++ continue; ++ } ++ ++ if(sme->ssid && sme->ssid_len) { ++ if( pnetwork->network.Ssid.SsidLength != sme->ssid_len ++ || _rtw_memcmp(pnetwork->network.Ssid.Ssid, sme->ssid, sme->ssid_len) == false ++ ) ++ continue; ++ } ++ ++ ++ if (sme->bssid) ++ { ++ src_bssid = sme->bssid; ++ ++ if ((_rtw_memcmp(dst_bssid, src_bssid, ETH_ALEN)) == true) ++ { ++ DBG_8192C("matched by bssid\n"); ++ ++ ndis_ssid.SsidLength = pnetwork->network.Ssid.SsidLength; ++ _rtw_memcpy(ndis_ssid.Ssid, pnetwork->network.Ssid.Ssid, pnetwork->network.Ssid.SsidLength); ++ ++ matched=true; ++ break; ++ } ++ ++ } ++ else if (sme->ssid && sme->ssid_len) ++ { ++ src_ssid = ndis_ssid.Ssid; ++ ++ if ((_rtw_memcmp(dst_ssid, src_ssid, ndis_ssid.SsidLength) == true) && ++ (pnetwork->network.Ssid.SsidLength==ndis_ssid.SsidLength)) ++ { ++ DBG_8192C("matched by ssid\n"); ++ matched=true; ++ break; ++ } ++ } ++ ++ } ++ ++ _exit_critical_bh(&queue->lock, &irqL); ++ ++ if((matched == false) || (pnetwork== NULL)) ++ { ++ ret = -ENOENT; ++ DBG_8192C("connect, matched == false, goto exit\n"); ++ goto exit; ++ } ++ ++ ++ if (rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode) == false) ++ { ++ ret = -EPERM; ++ goto exit; ++ } ++ ++ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; ++ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; ++ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; ++ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; //open system ++ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ padapter->wapiInfo.bWapiEnable = false; ++#endif ++ ++ ret = rtw_cfg80211_set_wpa_version(psecuritypriv, sme->crypto.wpa_versions); ++ if (ret < 0) ++ goto exit; ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if(sme->crypto.wpa_versions & NL80211_WAPI_VERSION_1) ++ { ++ padapter->wapiInfo.bWapiEnable = true; ++ padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN; ++ padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN; ++ } ++#endif ++ ++ ret = rtw_cfg80211_set_auth_type(psecuritypriv, sme->auth_type); ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if(psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_WAPI) ++ padapter->mlmeextpriv.mlmext_info.auth_algo = psecuritypriv->dot11AuthAlgrthm; ++#endif ++ ++ ++ if (ret < 0) ++ goto exit; ++ ++ DBG_8192C("%s, ie_len=%zu\n", __func__, sme->ie_len); ++ ++ ret = rtw_cfg80211_set_wpa_ie(padapter, sme->ie, sme->ie_len); ++ if (ret < 0) ++ goto exit; ++ ++ if (sme->crypto.n_ciphers_pairwise) { ++ ret = rtw_cfg80211_set_cipher(psecuritypriv, sme->crypto.ciphers_pairwise[0], true); ++ if (ret < 0) ++ goto exit; ++ } ++ ++ //For WEP Shared auth ++ if((psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_Shared ++ || psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_Auto) && sme->key ++ ) ++ { ++ u32 wep_key_idx, wep_key_len,wep_total_len; ++ NDIS_802_11_WEP *pwep = NULL; ++ DBG_871X("%s(): Shared/Auto WEP\n",__FUNCTION__); ++ ++ wep_key_idx = sme->key_idx; ++ wep_key_len = sme->key_len; ++ ++ if (sme->key_idx > WEP_KEYS) { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ if (wep_key_len > 0) ++ { ++ wep_key_len = wep_key_len <= 5 ? 5 : 13; ++ wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); ++ pwep =(NDIS_802_11_WEP *) rtw_malloc(wep_total_len); ++ if(pwep == NULL){ ++ DBG_871X(" wpa_set_encryption: pwep allocate fail !!!\n"); ++ ret = -ENOMEM; ++ goto exit; ++ } ++ ++ _rtw_memset(pwep, 0, wep_total_len); ++ ++ pwep->KeyLength = wep_key_len; ++ pwep->Length = wep_total_len; ++ ++ if(wep_key_len==13) ++ { ++ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_; ++ padapter->securitypriv.dot118021XGrpPrivacy=_WEP104_; ++ } ++ } ++ else { ++ ret = -EINVAL; ++ goto exit; ++ } ++ ++ pwep->KeyIndex = wep_key_idx; ++ pwep->KeyIndex |= 0x80000000; ++ ++ _rtw_memcpy(pwep->KeyMaterial, (void *)sme->key, pwep->KeyLength); ++ ++ if(rtw_set_802_11_add_wep(padapter, pwep) == (u8)_FAIL) ++ { ++ ret = -EOPNOTSUPP ; ++ } ++ ++ if (pwep) { ++ rtw_mfree((u8 *)pwep,wep_total_len); ++ } ++ ++ if(ret < 0) ++ goto exit; ++ } ++ ++ ret = rtw_cfg80211_set_cipher(psecuritypriv, sme->crypto.cipher_group, false); ++ if (ret < 0) ++ return ret; ++ ++ if (sme->crypto.n_akm_suites) { ++ ret = rtw_cfg80211_set_key_mgt(psecuritypriv, sme->crypto.akm_suites[0]); ++ if (ret < 0) ++ goto exit; ++ } ++ ++#ifdef CONFIG_WAPI_SUPPORT ++ if(sme->crypto.akm_suites[0] ==WLAN_AKM_SUITE_WAPI_PSK){ ++ padapter->wapiInfo.bWapiPSK = true; ++ } ++ else if(sme->crypto.akm_suites[0] ==WLAN_AKM_SUITE_WAPI_CERT){ ++ padapter->wapiInfo.bWapiPSK = false; ++ } ++#endif ++ ++ authmode = psecuritypriv->ndisauthtype; ++ rtw_set_802_11_authentication_mode(padapter, authmode); ++ ++ //rtw_set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); ++ ++ if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == false) { ++ ret = -1; ++ goto exit; ++ } ++ ++ ++ DBG_8192C("set ssid:dot11AuthAlgrthm=%d, dot11PrivacyAlgrthm=%d, dot118021XGrpPrivacy=%d\n", psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, psecuritypriv->dot118021XGrpPrivacy); ++ ++exit: ++ ++ DBG_8192C("<=%s, ret %d\n",__FUNCTION__, ret); ++ ++ return ret; ++} ++ ++static int cfg80211_rtw_disconnect(struct wiphy *wiphy, struct net_device *ndev, ++ u16 reason_code) ++{ ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ rtw_set_roaming(padapter, 0); ++ ++ if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)) ++ { ++ rtw_scan_abort(padapter); ++ LeaveAllPowerSaveMode(padapter); ++ rtw_disassoc_cmd(padapter, 500, false); ++ ++ DBG_871X("%s...call rtw_indicate_disconnect\n", __FUNCTION__); ++ ++ padapter->mlmepriv.not_indic_disco = true; ++ rtw_indicate_disconnect(padapter); ++ padapter->mlmepriv.not_indic_disco = false; ++ ++ rtw_free_assoc_resources(padapter, 1); ++ rtw_pwr_wakeup(padapter); ++ } ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_set_txpower(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,8,0)) ++ struct wireless_dev *wdev, ++#endif ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,36)) || defined(COMPAT_KERNEL_RELEASE) ++ enum nl80211_tx_power_setting type, int mbm) ++#else ++ enum tx_power_setting type, int dbm) ++#endif ++{ ++#if 0 ++ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); ++ int ret; ++ ++ switch (type) { ++ case NL80211_TX_POWER_AUTOMATIC: ++ return 0; ++ case NL80211_TX_POWER_FIXED: ++ if (mbm < 0 || (mbm % 100)) ++ return -EOPNOTSUPP; ++ ++ if (!test_bit(IWM_STATUS_READY, &iwm->status)) ++ return 0; ++ ++ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_CFG_FIX, ++ CFG_TX_PWR_LIMIT_USR, ++ MBM_TO_DBM(mbm) * 2); ++ if (ret < 0) ++ return ret; ++ ++ return iwm_tx_power_trigger(iwm); ++ default: ++ IWM_ERR(iwm, "Unsupported power type: %d\n", type); ++ return -EOPNOTSUPP; ++ } ++#endif ++ DBG_8192C("%s\n", __func__); ++ return 0; ++} ++ ++static int cfg80211_rtw_get_txpower(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,8,0)) ++ struct wireless_dev *wdev, ++#endif ++ int *dbm) ++{ ++ //_adapter *padapter = wiphy_to_adapter(wiphy); ++ ++ DBG_8192C("%s\n", __func__); ++ ++ *dbm = (12); ++ ++ return 0; ++} ++ ++inline bool rtw_cfg80211_pwr_mgmt(_adapter *adapter) ++{ ++ struct rtw_wdev_priv *rtw_wdev_priv = wdev_to_priv(adapter->rtw_wdev); ++ return rtw_wdev_priv->power_mgmt; ++} ++ ++static int cfg80211_rtw_set_power_mgmt(struct wiphy *wiphy, ++ struct net_device *ndev, ++ bool enabled, int timeout) ++{ ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ struct rtw_wdev_priv *rtw_wdev_priv = wdev_to_priv(padapter->rtw_wdev); ++ ++ DBG_871X(FUNC_NDEV_FMT" enabled:%u, timeout:%d\n", FUNC_NDEV_ARG(ndev), ++ enabled, timeout); ++ ++ rtw_wdev_priv->power_mgmt = enabled; ++ ++ #ifdef CONFIG_LPS ++ if (!enabled) ++ LPS_Leave(padapter); ++ #endif ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_set_pmksa(struct wiphy *wiphy, ++ struct net_device *netdev, ++ struct cfg80211_pmksa *pmksa) ++{ ++ u8 index,blInserted = false; ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ u8 strZeroMacAddress[ ETH_ALEN ] = { 0x00 }; ++ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(netdev)); ++ ++ if ( _rtw_memcmp( pmksa->bssid, strZeroMacAddress, ETH_ALEN ) == true ) ++ { ++ return -EINVAL; ++ } ++ ++ blInserted = false; ++ ++ //overwrite PMKID ++ for(index=0 ; indexPMKIDList[index].Bssid, pmksa->bssid, ETH_ALEN) ==true ) ++ { // BSSID is matched, the same AP => rewrite with new PMKID. ++ DBG_871X(FUNC_NDEV_FMT" BSSID exists in the PMKList.\n", FUNC_NDEV_ARG(netdev)); ++ ++ _rtw_memcpy( psecuritypriv->PMKIDList[index].PMKID, pmksa->pmkid, WLAN_PMKID_LEN); ++ psecuritypriv->PMKIDList[index].bUsed = true; ++ psecuritypriv->PMKIDIndex = index+1; ++ blInserted = true; ++ break; ++ } ++ } ++ ++ if(!blInserted) ++ { ++ // Find a new entry ++ DBG_871X(FUNC_NDEV_FMT" Use the new entry index = %d for this PMKID.\n", ++ FUNC_NDEV_ARG(netdev), psecuritypriv->PMKIDIndex ); ++ ++ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, pmksa->bssid, ETH_ALEN); ++ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, pmksa->pmkid, WLAN_PMKID_LEN); ++ ++ psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].bUsed = true; ++ psecuritypriv->PMKIDIndex++ ; ++ if(psecuritypriv->PMKIDIndex==16) ++ { ++ psecuritypriv->PMKIDIndex =0; ++ } ++ } ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_del_pmksa(struct wiphy *wiphy, ++ struct net_device *netdev, ++ struct cfg80211_pmksa *pmksa) ++{ ++ u8 index, bMatched = false; ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(netdev)); ++ ++ for(index=0 ; indexPMKIDList[index].Bssid, pmksa->bssid, ETH_ALEN) ==true ) ++ { // BSSID is matched, the same AP => Remove this PMKID information and reset it. ++ _rtw_memset( psecuritypriv->PMKIDList[index].Bssid, 0x00, ETH_ALEN ); ++ _rtw_memset( psecuritypriv->PMKIDList[index].PMKID, 0x00, WLAN_PMKID_LEN ); ++ psecuritypriv->PMKIDList[index].bUsed = false; ++ bMatched = true; ++ break; ++ } ++ } ++ ++ if(false == bMatched) ++ { ++ DBG_871X(FUNC_NDEV_FMT" do not have matched BSSID\n" ++ , FUNC_NDEV_ARG(netdev)); ++ return -EINVAL; ++ } ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_flush_pmksa(struct wiphy *wiphy, ++ struct net_device *netdev) ++{ ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(netdev)); ++ ++ _rtw_memset( &psecuritypriv->PMKIDList[ 0 ], 0x00, sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE ); ++ psecuritypriv->PMKIDIndex = 0; ++ ++ return 0; ++} ++ ++#ifdef CONFIG_AP_MODE ++void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint frame_len) ++{ ++ s32 freq; ++ int channel; ++ struct wireless_dev *pwdev = padapter->rtw_wdev; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct net_device *ndev = padapter->pnetdev; ++ ++ DBG_8192C("%s(padapter=%p,%s)\n", __func__, padapter, ndev->name); ++ ++#if defined(RTW_USE_CFG80211_STA_EVENT) || defined(COMPAT_KERNEL_RELEASE) ++ { ++ struct station_info sinfo; ++ u8 ie_offset; ++ if (GetFrameSubType(pmgmt_frame) == WIFI_ASSOCREQ) ++ ie_offset = _ASOCREQ_IE_OFFSET_; ++ else // WIFI_REASSOCREQ ++ ie_offset = _REASOCREQ_IE_OFFSET_; ++ ++ sinfo.filled = 0; ++ sinfo.filled = STATION_INFO_ASSOC_REQ_IES; ++ sinfo.assoc_req_ies = pmgmt_frame + WLAN_HDR_A3_LEN + ie_offset; ++ sinfo.assoc_req_ies_len = frame_len - WLAN_HDR_A3_LEN - ie_offset; ++ cfg80211_new_sta(ndev, GetAddr2Ptr(pmgmt_frame), &sinfo, GFP_ATOMIC); ++ } ++#else /* defined(RTW_USE_CFG80211_STA_EVENT) */ ++ channel = pmlmeext->cur_channel; ++ if (channel <= RTW_CH_MAX_2G_CHANNEL) ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); ++ else ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); ++ ++ #ifdef COMPAT_KERNEL_RELEASE ++ rtw_cfg80211_rx_mgmt(padapter, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); ++ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) ++ rtw_cfg80211_rx_mgmt(padapter, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); ++ #else //COMPAT_KERNEL_RELEASE ++ { ++ //to avoid WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION) when calling cfg80211_send_rx_assoc() ++ pwdev->iftype = NL80211_IFTYPE_STATION; ++ DBG_8192C("iftype=%d before call cfg80211_send_rx_assoc()\n", pwdev->iftype); ++ rtw_cfg80211_send_rx_assoc(padapter, NULL, pmgmt_frame, frame_len); ++ DBG_8192C("iftype=%d after call cfg80211_send_rx_assoc()\n", pwdev->iftype); ++ pwdev->iftype = NL80211_IFTYPE_AP; ++ } ++ #endif //COMPAT_KERNEL_RELEASE ++#endif /* defined(RTW_USE_CFG80211_STA_EVENT) */ ++} ++ ++void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, unsigned short reason) ++{ ++ s32 freq; ++ int channel; ++ u8 *pmgmt_frame; ++ uint frame_len; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ u8 mgmt_buf[128] = {0}; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ struct net_device *ndev = padapter->pnetdev; ++ ++ DBG_8192C("%s(padapter=%p,%s)\n", __func__, padapter, ndev->name); ++ ++#if defined(RTW_USE_CFG80211_STA_EVENT) || defined(COMPAT_KERNEL_RELEASE) ++ cfg80211_del_sta(ndev, da, GFP_ATOMIC); ++#else /* defined(RTW_USE_CFG80211_STA_EVENT) */ ++ channel = pmlmeext->cur_channel; ++ if (channel <= RTW_CH_MAX_2G_CHANNEL) ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); ++ else ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); ++ ++ pmgmt_frame = mgmt_buf; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pmgmt_frame; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ //_rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); ++ //_rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr1, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, da, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pmgmt_frame, WIFI_DEAUTH); ++ ++ pmgmt_frame += sizeof(struct rtw_ieee80211_hdr_3addr); ++ frame_len = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ reason = cpu_to_le16(reason); ++ pmgmt_frame = rtw_set_fixed_ie(pmgmt_frame, _RSON_CODE_ , (unsigned char *)&reason, &frame_len); ++ ++ #ifdef COMPAT_KERNEL_RELEASE ++ rtw_cfg80211_rx_mgmt(padapter, freq, 0, mgmt_buf, frame_len, GFP_ATOMIC); ++ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) ++ rtw_cfg80211_rx_mgmt(padapter, freq, 0, mgmt_buf, frame_len, GFP_ATOMIC); ++ #else //COMPAT_KERNEL_RELEASE ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0)) // TODO: Fix ++ cfg80211_send_disassoc(padapter->pnetdev, mgmt_buf, frame_len); ++ #endif ++ #endif //COMPAT_KERNEL_RELEASE ++#endif /* defined(RTW_USE_CFG80211_STA_EVENT) */ ++} ++ ++static int rtw_cfg80211_monitor_if_open(struct net_device *ndev) ++{ ++ int ret = 0; ++ ++ DBG_8192C("%s\n", __func__); ++ ++ return ret; ++} ++ ++static int rtw_cfg80211_monitor_if_close(struct net_device *ndev) ++{ ++ int ret = 0; ++ ++ DBG_8192C("%s\n", __func__); ++ ++ return ret; ++} ++ ++static int rtw_cfg80211_monitor_if_xmit_entry(struct sk_buff *skb, struct net_device *ndev) ++{ ++ int ret = 0; ++ int rtap_len; ++ int qos_len = 0; ++ int dot11_hdr_len = 24; ++ int snap_len = 6; ++ unsigned char *pdata; ++ u16 frame_ctl; ++ unsigned char src_mac_addr[6]; ++ unsigned char dst_mac_addr[6]; ++ struct ieee80211_hdr *dot11_hdr; ++ struct ieee80211_radiotap_header *rtap_hdr; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ if (unlikely(skb->len < sizeof(struct ieee80211_radiotap_header))) ++ goto fail; ++ ++ rtap_hdr = (struct ieee80211_radiotap_header *)skb->data; ++ if (unlikely(rtap_hdr->it_version)) ++ goto fail; ++ ++ rtap_len = ieee80211_get_radiotap_len(skb->data); ++ if (unlikely(skb->len < rtap_len)) ++ goto fail; ++ ++ if(rtap_len != 14) ++ { ++ DBG_8192C("radiotap len (should be 14): %d\n", rtap_len); ++ goto fail; ++ } ++ ++ /* Skip the ratio tap header */ ++ skb_pull(skb, rtap_len); ++ ++ dot11_hdr = (struct ieee80211_hdr *)skb->data; ++ frame_ctl = le16_to_cpu(dot11_hdr->frame_control); ++ /* Check if the QoS bit is set */ ++ if ((frame_ctl & RTW_IEEE80211_FCTL_FTYPE) == RTW_IEEE80211_FTYPE_DATA) { ++ /* Check if this ia a Wireless Distribution System (WDS) frame ++ * which has 4 MAC addresses ++ */ ++ if (dot11_hdr->frame_control & 0x0080) ++ qos_len = 2; ++ if ((dot11_hdr->frame_control & 0x0300) == 0x0300) ++ dot11_hdr_len += 6; ++ ++ memcpy(dst_mac_addr, dot11_hdr->addr1, sizeof(dst_mac_addr)); ++ memcpy(src_mac_addr, dot11_hdr->addr2, sizeof(src_mac_addr)); ++ ++ /* Skip the 802.11 header, QoS (if any) and SNAP, but leave spaces for ++ * for two MAC addresses ++ */ ++ skb_pull(skb, dot11_hdr_len + qos_len + snap_len - sizeof(src_mac_addr) * 2); ++ pdata = (unsigned char*)skb->data; ++ memcpy(pdata, dst_mac_addr, sizeof(dst_mac_addr)); ++ memcpy(pdata + sizeof(dst_mac_addr), src_mac_addr, sizeof(src_mac_addr)); ++ ++ DBG_8192C("should be eapol packet\n"); ++ ++ /* Use the real net device to transmit the packet */ ++ ret = rtw_xmit_entry(skb, padapter->pnetdev); ++ ++ return ret; ++ ++ } ++ else if ((frame_ctl & (RTW_IEEE80211_FCTL_FTYPE|RTW_IEEE80211_FCTL_STYPE)) ++ == (RTW_IEEE80211_FTYPE_MGMT|RTW_IEEE80211_STYPE_ACTION) ++ ) ++ { ++ //only for action frames ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ //u8 category, action, OUI_Subtype, dialogToken=0; ++ //unsigned char *frame_body; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ u8 *buf = skb->data; ++ u32 len = skb->len; ++ u8 category, action; ++ int type = -1; ++ ++ if (rtw_action_frame_parse(buf, len, &category, &action) == false) { ++ DBG_8192C(FUNC_NDEV_FMT" frame_control:0x%x\n", FUNC_NDEV_ARG(ndev), ++ le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl)); ++ goto fail; ++ } ++ ++ DBG_8192C("RTW_Tx:da="MAC_FMT" via "FUNC_NDEV_FMT"\n", ++ MAC_ARG(GetAddr1Ptr(buf)), FUNC_NDEV_ARG(ndev)); ++ #ifdef CONFIG_P2P ++ if((type = rtw_p2p_check_frames(padapter, buf, len, true)) >= 0) ++ goto dump; ++ #endif ++ if (category == RTW_WLAN_CATEGORY_PUBLIC) ++ DBG_871X("RTW_Tx:%s\n", action_public_str(action)); ++ else ++ DBG_871X("RTW_Tx:category(%u), action(%u)\n", category, action); ++ ++dump: ++ //starting alloc mgmt frame to dump it ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ goto fail; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ pattrib->retry_ctrl = false; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ _rtw_memcpy(pframe, (void*)buf, len); ++ #ifdef CONFIG_WFD ++ if (type >= 0) ++ { ++ struct wifi_display_info *pwfd_info; ++ ++ pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if ( true == pwfd_info->wfd_enable ) ++ { ++ rtw_append_wfd_ie( padapter, pframe, &len ); ++ } ++ } ++ #endif // CONFIG_WFD ++ pattrib->pktlen = len; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ //update seq number ++ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); ++ pattrib->seqnum = pmlmeext->mgnt_seq; ++ pmlmeext->mgnt_seq++; ++ ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ dump_mgntframe(padapter, pmgntframe); ++ ++ } ++ else ++ { ++ DBG_8192C("frame_ctl=0x%x\n", frame_ctl & (RTW_IEEE80211_FCTL_FTYPE|RTW_IEEE80211_FCTL_STYPE)); ++ } ++ ++ ++fail: ++ ++ dev_kfree_skb(skb); ++ ++ return 0; ++ ++} ++ ++static void rtw_cfg80211_monitor_if_set_multicast_list(struct net_device *ndev) ++{ ++ DBG_8192C("%s\n", __func__); ++} ++ ++static int rtw_cfg80211_monitor_if_set_mac_address(struct net_device *ndev, void *addr) ++{ ++ int ret = 0; ++ ++ DBG_8192C("%s\n", __func__); ++ ++ return ret; ++} ++ ++#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) ++static const struct net_device_ops rtw_cfg80211_monitor_if_ops = { ++ .ndo_open = rtw_cfg80211_monitor_if_open, ++ .ndo_stop = rtw_cfg80211_monitor_if_close, ++ .ndo_start_xmit = rtw_cfg80211_monitor_if_xmit_entry, ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,2,0)) ++ .ndo_set_multicast_list = rtw_cfg80211_monitor_if_set_multicast_list, ++ #endif ++ .ndo_set_mac_address = rtw_cfg80211_monitor_if_set_mac_address, ++}; ++#endif ++ ++static int rtw_cfg80211_add_monitor_if(_adapter *padapter, char *name, struct net_device **ndev) ++{ ++ int ret = 0; ++ struct net_device* mon_ndev = NULL; ++ struct wireless_dev* mon_wdev = NULL; ++ struct rtw_netdev_priv_indicator *pnpi; ++ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); ++ ++ if (!name ) { ++ DBG_871X(FUNC_ADPT_FMT" without specific name\n", FUNC_ADPT_ARG(padapter)); ++ ret = -EINVAL; ++ goto out; ++ } ++ ++ if (pwdev_priv->pmon_ndev) { ++ DBG_871X(FUNC_ADPT_FMT" monitor interface exist: "NDEV_FMT"\n", ++ FUNC_ADPT_ARG(padapter), NDEV_ARG(pwdev_priv->pmon_ndev)); ++ ret = -EBUSY; ++ goto out; ++ } ++ ++ mon_ndev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); ++ if (!mon_ndev) { ++ DBG_871X(FUNC_ADPT_FMT" allocate ndev fail\n", FUNC_ADPT_ARG(padapter)); ++ ret = -ENOMEM; ++ goto out; ++ } ++ ++ mon_ndev->type = ARPHRD_IEEE80211_RADIOTAP; ++ strncpy(mon_ndev->name, name, IFNAMSIZ); ++ mon_ndev->name[IFNAMSIZ - 1] = 0; ++ mon_ndev->destructor = rtw_ndev_destructor; ++ ++#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) ++ mon_ndev->netdev_ops = &rtw_cfg80211_monitor_if_ops; ++#else ++ mon_ndev->open = rtw_cfg80211_monitor_if_open; ++ mon_ndev->stop = rtw_cfg80211_monitor_if_close; ++ mon_ndev->hard_start_xmit = rtw_cfg80211_monitor_if_xmit_entry; ++ mon_ndev->set_mac_address = rtw_cfg80211_monitor_if_set_mac_address; ++#endif ++ ++ pnpi = netdev_priv(mon_ndev); ++ pnpi->priv = padapter; ++ pnpi->sizeof_priv = sizeof(_adapter); ++ ++ /* wdev */ ++ mon_wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); ++ if (!mon_wdev) { ++ DBG_871X(FUNC_ADPT_FMT" allocate mon_wdev fail\n", FUNC_ADPT_ARG(padapter)); ++ ret = -ENOMEM; ++ goto out; ++ } ++ ++ mon_wdev->wiphy = padapter->rtw_wdev->wiphy; ++ mon_wdev->netdev = mon_ndev; ++ mon_wdev->iftype = NL80211_IFTYPE_MONITOR; ++ mon_ndev->ieee80211_ptr = mon_wdev; ++ ++ ret = register_netdevice(mon_ndev); ++ if (ret) { ++ goto out; ++ } ++ ++ *ndev = pwdev_priv->pmon_ndev = mon_ndev; ++ _rtw_memcpy(pwdev_priv->ifname_mon, name, IFNAMSIZ+1); ++ ++out: ++ if (ret && mon_wdev) { ++ rtw_mfree((u8*)mon_wdev, sizeof(struct wireless_dev)); ++ mon_wdev = NULL; ++ } ++ ++ if (ret && mon_ndev) { ++ free_netdev(mon_ndev); ++ *ndev = mon_ndev = NULL; ++ } ++ ++ return ret; ++} ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) ++static struct wireless_dev * ++#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) ++static struct net_device * ++#else ++static int ++#endif ++ cfg80211_rtw_add_virtual_intf( ++ struct wiphy *wiphy, ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,0)) ++ const char *name, ++ #else ++ char *name, ++ #endif ++ enum nl80211_iftype type, u32 *flags, struct vif_params *params) ++{ ++ int ret = 0; ++ struct net_device* ndev = NULL; ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ ++ DBG_871X(FUNC_ADPT_FMT " wiphy:%s, name:%s, type:%d\n", ++ FUNC_ADPT_ARG(padapter), wiphy_name(wiphy), name, type); ++ ++ switch (type) { ++ case NL80211_IFTYPE_ADHOC: ++ case NL80211_IFTYPE_AP_VLAN: ++ case NL80211_IFTYPE_WDS: ++ case NL80211_IFTYPE_MESH_POINT: ++ ret = -ENODEV; ++ break; ++ case NL80211_IFTYPE_MONITOR: ++ ret = rtw_cfg80211_add_monitor_if(padapter, (char *)name, &ndev); ++ break; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ case NL80211_IFTYPE_P2P_CLIENT: ++#endif ++ case NL80211_IFTYPE_STATION: ++ ret = -ENODEV; ++ break; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ case NL80211_IFTYPE_P2P_GO: ++#endif ++ case NL80211_IFTYPE_AP: ++ ret = -ENODEV; ++ break; ++ default: ++ ret = -ENODEV; ++ DBG_871X("Unsupported interface type\n"); ++ break; ++ } ++ ++ DBG_871X(FUNC_ADPT_FMT" ndev:%p, ret:%d\n", FUNC_ADPT_ARG(padapter), ndev, ret); ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) ++ return ndev ? ndev->ieee80211_ptr : ERR_PTR(ret); ++#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) ++ return ndev ? ndev : ERR_PTR(ret); ++#else ++ return ret; ++#endif ++} ++ ++static int cfg80211_rtw_del_virtual_intf(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) ++ struct wireless_dev *wdev ++#else ++ struct net_device *ndev ++#endif ++) ++{ ++ struct rtw_wdev_priv *pwdev_priv = (struct rtw_wdev_priv *)wiphy_priv(wiphy); ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) ++ struct net_device *ndev; ++ ndev = wdev ? wdev->netdev : NULL; ++#endif ++ ++ if (!ndev) ++ goto exit; ++ ++ unregister_netdevice(ndev); ++ ++ if (ndev == pwdev_priv->pmon_ndev) { ++ pwdev_priv->pmon_ndev = NULL; ++ pwdev_priv->ifname_mon[0] = '\0'; ++ DBG_871X(FUNC_NDEV_FMT" remove monitor interface\n", FUNC_NDEV_ARG(ndev)); ++ } ++ ++exit: ++ return 0; ++} ++ ++static int rtw_add_beacon(_adapter *adapter, const u8 *head, size_t head_len, const u8 *tail, size_t tail_len) ++{ ++ int ret=0; ++ u8 *pbuf = NULL; ++ uint len, wps_ielen=0; ++ uint p2p_ielen=0; ++ u8 *p2p_ie; ++ u8 got_p2p_ie = false; ++ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); ++ //struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ ++ DBG_8192C("%s beacon_head_len=%zu, beacon_tail_len=%zu\n", __FUNCTION__, head_len, tail_len); ++ ++ ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) ++ return -EINVAL; ++ ++ if(head_len<24) ++ return -EINVAL; ++ ++ ++ pbuf = rtw_zmalloc(head_len+tail_len); ++ if(!pbuf) ++ return -ENOMEM; ++ ++ ++ //_rtw_memcpy(&pstapriv->max_num_sta, param->u.bcn_ie.reserved, 2); ++ ++ //if((pstapriv->max_num_sta>NUM_STA) || (pstapriv->max_num_sta<=0)) ++ // pstapriv->max_num_sta = NUM_STA; ++ ++ ++ _rtw_memcpy(pbuf, (void *)head+24, head_len-24);// 24=beacon header len. ++ _rtw_memcpy(pbuf+head_len-24, (void *)tail, tail_len); ++ ++ len = head_len+tail_len-24; ++ ++ //check wps ie if inclued ++ if(rtw_get_wps_ie(pbuf+_FIXED_IE_LENGTH_, len-_FIXED_IE_LENGTH_, NULL, &wps_ielen)) ++ DBG_8192C("add bcn, wps_ielen=%d\n", wps_ielen); ++ ++#ifdef CONFIG_P2P ++ if( adapter->wdinfo.driver_interface == DRIVER_CFG80211 ) ++ { ++ if(rtw_get_p2p_ie(pbuf+_FIXED_IE_LENGTH_, len-_FIXED_IE_LENGTH_, NULL, &p2p_ielen)) ++ { ++ DBG_8192C("got p2p_ie, len=%d\n", p2p_ielen); ++ got_p2p_ie = true; ++ } ++ } ++#endif ++ ++ /* pbss_network->IEs will not include p2p_ie, wfd ie */ ++ rtw_ies_remove_ie(pbuf, &len, _BEACON_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, P2P_OUI, 4); ++ rtw_ies_remove_ie(pbuf, &len, _BEACON_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, WFD_OUI, 4); ++ ++ if (rtw_check_beacon_data(adapter, pbuf, len) == _SUCCESS) { ++#ifdef CONFIG_P2P ++ //check p2p if enable ++ if(got_p2p_ie == true) ++ { ++ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; ++ struct wifidirect_info *pwdinfo= &(adapter->wdinfo); ++ ++ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ { ++ DBG_8192C("Enable P2P function for the first time\n"); ++ rtw_p2p_enable(adapter, P2P_ROLE_GO); ++ wdev_to_priv(adapter->rtw_wdev)->p2p_enabled = true; ++ } ++ else ++ { ++ _cancel_timer_ex( &pwdinfo->find_phase_timer ); ++ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); ++ _cancel_timer_ex( &pwdinfo->pre_tx_scan_timer); ++ ++ DBG_8192C("enter GO Mode, p2p_ielen=%d\n", p2p_ielen); ++ ++ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); ++ pwdinfo->intent = 15; ++ } ++ ++ pwdinfo->operating_channel = pmlmeext->cur_channel; ++ ++ } ++#endif //CONFIG_P2P ++ ++ ret = 0; ++ ++ } ++ else ++ { ++ ret = -EINVAL; ++ } ++ ++ ++ rtw_mfree(pbuf, head_len+tail_len); ++ ++ return ret; ++} ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,4,0)) && !defined(COMPAT_KERNEL_RELEASE) ++static int cfg80211_rtw_add_beacon(struct wiphy *wiphy, struct net_device *ndev, ++ struct beacon_parameters *info) ++{ ++ int ret=0; ++ _adapter *adapter = wiphy_to_adapter(wiphy); ++ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ret = rtw_add_beacon(adapter, info->head, info->head_len, info->tail, info->tail_len); ++ ++ return ret; ++} ++ ++static int cfg80211_rtw_set_beacon(struct wiphy *wiphy, struct net_device *ndev, ++ struct beacon_parameters *info) ++{ ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ pmlmeext->bstart_bss = true; ++ ++ cfg80211_rtw_add_beacon(wiphy, ndev, info); ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_del_beacon(struct wiphy *wiphy, struct net_device *ndev) ++{ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ return 0; ++} ++#else ++static int cfg80211_rtw_start_ap(struct wiphy *wiphy, struct net_device *ndev, ++ struct cfg80211_ap_settings *settings) ++{ ++ int ret = 0; ++ _adapter *adapter = wiphy_to_adapter(wiphy); ++ ++ DBG_871X(FUNC_NDEV_FMT" hidden_ssid:%d, auth_type:%d\n", FUNC_NDEV_ARG(ndev), ++ settings->hidden_ssid, settings->auth_type); ++ ++ ret = rtw_add_beacon(adapter, settings->beacon.head, settings->beacon.head_len, ++ settings->beacon.tail, settings->beacon.tail_len); ++ ++ adapter->mlmeextpriv.mlmext_info.hidden_ssid_mode = settings->hidden_ssid; ++ ++ if (settings->ssid && settings->ssid_len) { ++ WLAN_BSSID_EX *pbss_network = &adapter->mlmepriv.cur_network.network; ++ WLAN_BSSID_EX *pbss_network_ext = &adapter->mlmeextpriv.mlmext_info.network; ++ ++ if(0) ++ DBG_871X(FUNC_ADPT_FMT" ssid:(%s,%d), from ie:(%s,%d)\n", FUNC_ADPT_ARG(adapter), ++ settings->ssid, (int)settings->ssid_len, ++ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength); ++ ++ _rtw_memcpy(pbss_network->Ssid.Ssid, (void *)settings->ssid, settings->ssid_len); ++ pbss_network->Ssid.SsidLength = settings->ssid_len; ++ _rtw_memcpy(pbss_network_ext->Ssid.Ssid, (void *)settings->ssid, settings->ssid_len); ++ pbss_network_ext->Ssid.SsidLength = settings->ssid_len; ++ ++ if(0) ++ DBG_871X(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), ++ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, ++ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); ++ } ++ ++ return ret; ++} ++ ++static int cfg80211_rtw_change_beacon(struct wiphy *wiphy, struct net_device *ndev, ++ struct cfg80211_beacon_data *info) ++{ ++ int ret = 0; ++ _adapter *adapter = wiphy_to_adapter(wiphy); ++ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ ret = rtw_add_beacon(adapter, info->head, info->head_len, info->tail, info->tail_len); ++ ++ return ret; ++} ++ ++static int cfg80211_rtw_stop_ap(struct wiphy *wiphy, struct net_device *ndev) ++{ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ return 0; ++} ++ ++#endif //(LINUX_VERSION_CODE < KERNEL_VERSION(3,4,0)) ++ ++static int cfg80211_rtw_add_station(struct wiphy *wiphy, struct net_device *ndev, ++ u8 *mac, struct station_parameters *params) ++{ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_del_station(struct wiphy *wiphy, struct net_device *ndev, ++ u8 *mac) ++{ ++ int ret=0; ++ _irqL irqL; ++ _list *phead, *plist; ++ u8 updated; ++ struct sta_info *psta = NULL; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct sta_priv *pstapriv = &padapter->stapriv; ++ ++ DBG_871X("+"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) ++ { ++ DBG_8192C("%s, fw_state != FW_LINKED|WIFI_AP_STATE\n", __func__); ++ return -EINVAL; ++ } ++ ++ ++ if(!mac) ++ { ++ DBG_8192C("flush all sta, and cam_entry\n"); ++ ++ flush_all_cam_entry(padapter); //clear CAM ++ ++ ret = rtw_sta_flush(padapter); ++ ++ return ret; ++ } ++ ++ ++ DBG_8192C("free sta macaddr =" MAC_FMT "\n", MAC_ARG(mac)); ++ ++ if (mac[0] == 0xff && mac[1] == 0xff && ++ mac[2] == 0xff && mac[3] == 0xff && ++ mac[4] == 0xff && mac[5] == 0xff) ++ { ++ return -EINVAL; ++ } ++ ++ ++ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ phead = &pstapriv->asoc_list; ++ plist = get_next(phead); ++ ++ //check asoc_queue ++ while ((rtw_end_of_queue_search(phead, plist)) == false) ++ { ++ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); ++ ++ plist = get_next(plist); ++ ++ if(_rtw_memcmp(mac, psta->hwaddr, ETH_ALEN)) ++ { ++ if(psta->dot8021xalg == 1 && psta->bpairwise_key_installed == false) ++ { ++ DBG_8192C("%s, sta's dot8021xalg = 1 and key_installed = false\n", __func__); ++ } ++ else ++ { ++ DBG_8192C("free psta=%p, aid=%d\n", psta, psta->aid); ++ ++ rtw_list_delete(&psta->asoc_list); ++ pstapriv->asoc_list_cnt--; ++ ++ //_exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ updated = ap_free_sta(padapter, psta, true, WLAN_REASON_DEAUTH_LEAVING); ++ //_enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ psta = NULL; ++ ++ break; ++ } ++ ++ } ++ ++ } ++ ++ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); ++ ++ associated_clients_update(padapter, updated); ++ ++ DBG_871X("-"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ return ret; ++ ++} ++ ++static int cfg80211_rtw_change_station(struct wiphy *wiphy, struct net_device *ndev, ++ u8 *mac, struct station_parameters *params) ++{ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_dump_station(struct wiphy *wiphy, struct net_device *ndev, ++ int idx, u8 *mac, struct station_info *sinfo) ++{ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ //TODO: dump scanned queue ++ ++ return -ENOENT; ++} ++ ++static int cfg80211_rtw_change_bss(struct wiphy *wiphy, struct net_device *ndev, ++ struct bss_parameters *params) ++{ ++ u8 i; ++ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++/* ++ DBG_8192C("use_cts_prot=%d\n", params->use_cts_prot); ++ DBG_8192C("use_short_preamble=%d\n", params->use_short_preamble); ++ DBG_8192C("use_short_slot_time=%d\n", params->use_short_slot_time); ++ DBG_8192C("ap_isolate=%d\n", params->ap_isolate); ++ ++ DBG_8192C("basic_rates_len=%d\n", params->basic_rates_len); ++ for(i=0; ibasic_rates_len; i++) ++ { ++ DBG_8192C("basic_rates=%d\n", params->basic_rates[i]); ++ ++ } ++*/ ++ return 0; ++ ++} ++ ++static int cfg80211_rtw_set_channel(struct wiphy *wiphy ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) ++ , struct net_device *ndev ++ #endif ++ , struct ieee80211_channel *chan, enum nl80211_channel_type channel_type) ++{ ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ #endif ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_auth(struct wiphy *wiphy, struct net_device *ndev, ++ struct cfg80211_auth_request *req) ++{ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ return 0; ++} ++ ++static int cfg80211_rtw_assoc(struct wiphy *wiphy, struct net_device *ndev, ++ struct cfg80211_assoc_request *req) ++{ ++ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); ++ ++ return 0; ++} ++#endif //CONFIG_AP_MODE ++ ++void rtw_cfg80211_rx_action_p2p(_adapter *padapter, u8 *pmgmt_frame, uint frame_len) ++{ ++ int type; ++ s32 freq; ++ int channel; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ u8 category, action; ++ ++ channel = rtw_get_oper_ch(padapter); ++ ++ DBG_8192C("RTW_Rx:cur_ch=%d\n", channel); ++ #ifdef CONFIG_P2P ++ type = rtw_p2p_check_frames(padapter, pmgmt_frame, frame_len, false); ++ if (type >= 0) ++ goto indicate; ++ #endif ++ rtw_action_frame_parse(pmgmt_frame, frame_len, &category, &action); ++ DBG_871X("RTW_Rx:category(%u), action(%u)\n", category, action); ++ ++indicate: ++ if (channel <= RTW_CH_MAX_2G_CHANNEL) ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); ++ else ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ rtw_cfg80211_rx_mgmt(padapter, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); ++#else ++ cfg80211_rx_action(padapter->pnetdev, freq, pmgmt_frame, frame_len, GFP_ATOMIC); ++#endif ++} ++ ++void rtw_cfg80211_rx_p2p_action_public(_adapter *padapter, u8 *pmgmt_frame, uint frame_len) ++{ ++ int type; ++ s32 freq; ++ int channel; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ u8 category, action; ++ ++ channel = rtw_get_oper_ch(padapter); ++ ++ DBG_8192C("RTW_Rx:cur_ch=%d\n", channel); ++ #ifdef CONFIG_P2P ++ type = rtw_p2p_check_frames(padapter, pmgmt_frame, frame_len, false); ++ if (type >= 0) { ++ switch (type) { ++ case P2P_GO_NEGO_CONF: ++ case P2P_PROVISION_DISC_RESP: ++ rtw_clear_scan_deny(padapter); ++ } ++ goto indicate; ++ } ++ #endif ++ rtw_action_frame_parse(pmgmt_frame, frame_len, &category, &action); ++ DBG_871X("RTW_Rx:category(%u), action(%u)\n", category, action); ++ ++indicate: ++ if (channel <= RTW_CH_MAX_2G_CHANNEL) ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); ++ else ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ rtw_cfg80211_rx_mgmt(padapter, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); ++#else ++ cfg80211_rx_action(padapter->pnetdev, freq, pmgmt_frame, frame_len, GFP_ATOMIC); ++#endif ++} ++ ++void rtw_cfg80211_rx_action(_adapter *adapter, u8 *frame, uint frame_len, const char*msg) ++{ ++ s32 freq; ++ int channel; ++ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); ++ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(adapter->rtw_wdev); ++ u8 category, action; ++ ++ channel = rtw_get_oper_ch(adapter); ++ ++ rtw_action_frame_parse(frame, frame_len, &category, &action); ++ ++ DBG_8192C("RTW_Rx:cur_ch=%d\n", channel); ++ if (msg) ++ DBG_871X("RTW_Rx:%s\n", msg); ++ else ++ DBG_871X("RTW_Rx:category(%u), action(%u)\n", category, action); ++ ++ if (channel <= RTW_CH_MAX_2G_CHANNEL) ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); ++ else ++ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ rtw_cfg80211_rx_mgmt(adapter, freq, 0, frame, frame_len, GFP_ATOMIC); ++#else ++ cfg80211_rx_action(adapter->pnetdev, freq, frame, frame_len, GFP_ATOMIC); ++#endif ++ ++} ++ ++#ifdef CONFIG_P2P ++void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, size_t len) ++{ ++ u16 wps_devicepassword_id = 0x0000; ++ uint wps_devicepassword_id_len = 0; ++ u8 wpsie[ 255 ] = { 0x00 }, p2p_ie[ 255 ] = { 0x00 }; ++ uint p2p_ielen = 0; ++ uint wpsielen = 0; ++ u32 devinfo_contentlen = 0; ++ u8 devinfo_content[64] = { 0x00 }; ++ u16 capability = 0; ++ uint capability_len = 0; ++ ++ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; ++ u8 action = P2P_PUB_ACTION_ACTION; ++ u8 dialogToken = 1; ++ u32 p2poui = cpu_to_be32(P2POUI); ++ u8 oui_subtype = P2P_PROVISION_DISC_REQ; ++ u32 p2pielen = 0; ++#ifdef CONFIG_WFD ++ u32 wfdielen = 0; ++#endif //CONFIG_WFD ++ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ unsigned short *fctrl; ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); ++ ++ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); ++ u8 *frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); ++ size_t frame_body_len = len - sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ ++ DBG_871X( "[%s] In\n", __FUNCTION__ ); ++ ++ //prepare for building provision_request frame ++ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerIFAddr, GetAddr1Ptr(buf), ETH_ALEN); ++ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerDevAddr, GetAddr1Ptr(buf), ETH_ALEN); ++ ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON; ++ ++ rtw_get_wps_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, wpsie, &wpsielen); ++ rtw_get_wps_attr_content( wpsie, wpsielen, WPS_ATTR_DEVICE_PWID, (u8*) &wps_devicepassword_id, &wps_devicepassword_id_len); ++ wps_devicepassword_id = be16_to_cpu( wps_devicepassword_id ); ++ ++ switch(wps_devicepassword_id) ++ { ++ case WPS_DPID_PIN: ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_LABEL; ++ break; ++ case WPS_DPID_USER_SPEC: ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_DISPLYA; ++ break; ++ case WPS_DPID_MACHINE_SPEC: ++ break; ++ case WPS_DPID_REKEY: ++ break; ++ case WPS_DPID_PBC: ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON; ++ break; ++ case WPS_DPID_REGISTRAR_SPEC: ++ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_KEYPAD; ++ break; ++ default: ++ break; ++ } ++ ++ ++ if ( rtw_get_p2p_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, p2p_ie, &p2p_ielen ) ) ++ { ++ ++ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO, devinfo_content, &devinfo_contentlen); ++ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8*)&capability, &capability_len); ++ ++ } ++ ++ ++ //start to build provision_request frame ++ _rtw_memset(wpsie, 0, sizeof(wpsie)); ++ _rtw_memset(p2p_ie, 0, sizeof(p2p_ie)); ++ p2p_ielen = 0; ++ ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ return; ++ } ++ ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ ++ fctrl = &(pwlanhdr->frame_ctl); ++ *(fctrl) = 0; ++ ++ _rtw_memcpy(pwlanhdr->addr1, pwdinfo->tx_prov_disc_info.peerDevAddr, ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); ++ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->tx_prov_disc_info.peerDevAddr, ETH_ALEN); ++ ++ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); ++ pmlmeext->mgnt_seq++; ++ SetFrameSubType(pframe, WIFI_ACTION); ++ ++ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); ++ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); ++ ++ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); ++ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); ++ ++ ++ //build_prov_disc_request_p2p_ie ++ // P2P OUI ++ p2pielen = 0; ++ p2p_ie[ p2pielen++ ] = 0x50; ++ p2p_ie[ p2pielen++ ] = 0x6F; ++ p2p_ie[ p2pielen++ ] = 0x9A; ++ p2p_ie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 ++ ++ // Commented by Albert 20110301 ++ // According to the P2P Specification, the provision discovery request frame should contain 3 P2P attributes ++ // 1. P2P Capability ++ // 2. Device Info ++ // 3. Group ID ( When joining an operating P2P Group ) ++ ++ // P2P Capability ATTR ++ // Type: ++ p2p_ie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; ++ ++ // Length: ++ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); ++ RTW_PUT_LE16(p2p_ie + p2pielen, 0x0002); ++ p2pielen += 2; ++ ++ // Value: ++ // Device Capability Bitmap, 1 byte ++ // Group Capability Bitmap, 1 byte ++ _rtw_memcpy(p2p_ie + p2pielen, &capability, 2); ++ p2pielen += 2; ++ ++ ++ // Device Info ATTR ++ // Type: ++ p2p_ie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; ++ ++ // Length: ++ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) ++ // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) ++ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); ++ RTW_PUT_LE16(p2p_ie + p2pielen, devinfo_contentlen); ++ p2pielen += 2; ++ ++ // Value: ++ _rtw_memcpy(p2p_ie + p2pielen, devinfo_content, devinfo_contentlen); ++ p2pielen += devinfo_contentlen; ++ ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2p_ie, &p2p_ielen); ++ //p2pielen = build_prov_disc_request_p2p_ie( pwdinfo, pframe, NULL, 0, pwdinfo->tx_prov_disc_info.peerDevAddr); ++ //pframe += p2pielen; ++ pattrib->pktlen += p2p_ielen; ++ ++ wpsielen = 0; ++ // WPS OUI ++ *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); ++ wpsielen += 4; ++ ++ // WPS version ++ // Type: ++ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); ++ wpsielen += 2; ++ ++ // Length: ++ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); ++ wpsielen += 2; ++ ++ // Value: ++ wpsie[wpsielen++] = WPS_VERSION_1; // Version 1.0 ++ ++ // Config Method ++ // Type: ++ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); ++ wpsielen += 2; ++ ++ // Length: ++ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); ++ wpsielen += 2; ++ ++ // Value: ++ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->tx_prov_disc_info.wps_config_method_request ); ++ wpsielen += 2; ++ ++ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); ++ ++ ++#ifdef CONFIG_WFD ++ wfdielen = build_provdisc_req_wfd_ie(pwdinfo, pframe); ++ pframe += wfdielen; ++ pattrib->pktlen += wfdielen; ++#endif //CONFIG_WFD ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ //dump_mgntframe(padapter, pmgntframe); ++ if (dump_mgntframe_and_wait_ack(padapter, pmgntframe) != _SUCCESS) ++ DBG_8192C("%s, ack to\n", __func__); ++ ++ //if(wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC) ++ //{ ++ // DBG_8192C("waiting for p2p peer key-in PIN CODE\n"); ++ // rtw_msleep_os(15000); // 15 sec for key in PIN CODE, workaround for GS2 before issuing Nego Req. ++ //} ++ ++} ++ ++static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) ++ struct wireless_dev *wdev, ++#else ++ struct net_device *ndev, ++#endif ++ struct ieee80211_channel * channel, ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) ++ enum nl80211_channel_type channel_type, ++#endif ++ unsigned int duration, u64 *cookie) ++{ ++ s32 err = 0; ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); ++ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; ++ u8 remain_ch = (u8) ieee80211_frequency_to_channel(channel->center_freq); ++ u8 ready_on_channel = false; ++ ++ DBG_871X(FUNC_ADPT_FMT" ch:%u duration:%d\n", FUNC_ADPT_ARG(padapter), remain_ch, duration); ++ ++ if(pcfg80211_wdinfo->is_ro_ch == true) ++ { ++ DBG_8192C("%s, cancel ro ch timer\n", __func__); ++ ++ _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ ATOMIC_SET(&pwdev_priv->ro_ch_to, 1); ++#endif //CONFIG_CONCURRENT_MODE ++ ++ p2p_protocol_wk_hdl(padapter, P2P_RO_CH_WK); ++ } ++ ++ pcfg80211_wdinfo->is_ro_ch = true; ++ ++ if(_FAIL == rtw_pwr_wakeup(padapter)) { ++ err = -EFAULT; ++ goto exit; ++ } ++ ++ _rtw_memcpy(&pcfg80211_wdinfo->remain_on_ch_channel, channel, sizeof(struct ieee80211_channel)); ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) ++ pcfg80211_wdinfo->remain_on_ch_type= channel_type; ++ #endif ++ pcfg80211_wdinfo->remain_on_ch_cookie= *cookie; ++ ++ rtw_scan_abort(padapter); ++#ifdef CONFIG_CONCURRENT_MODE ++ if(rtw_buddy_adapter_up(padapter)) ++ rtw_scan_abort(padapter->pbuddy_adapter); ++#endif //CONFIG_CONCURRENT_MODE ++ ++ //if(!rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) && !rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) ++ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ { ++ rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); ++ wdev_to_priv(padapter->rtw_wdev)->p2p_enabled = true; ++ } ++ else ++ { ++ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); ++#ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); ++#endif ++ } ++ ++ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); ++ ++ ++ if(duration < 400) ++ duration = duration*3;//extend from exper. ++ ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if(check_buddy_fwstate(padapter, _FW_LINKED) && ++ (durationext_listen_interval)) ++ { ++ duration = duration + pwdinfo->ext_listen_interval; ++ } ++#endif ++ ++ pcfg80211_wdinfo->restore_channel = pmlmeext->cur_channel; ++ ++ if(rtw_ch_set_search_ch(pmlmeext->channel_set, remain_ch) >= 0) { ++#ifdef CONFIG_CONCURRENT_MODE ++ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) ++ { ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; ++ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; ++ ++ if(remain_ch != pbuddy_mlmeext->cur_channel) ++ { ++ if(ATOMIC_READ(&pwdev_priv->switch_ch_to)==1 || ++ (remain_ch != pmlmeext->cur_channel)) ++ { ++ DBG_8192C("%s, issue nulldata pwrbit=1\n", __func__); ++ issue_nulldata(padapter->pbuddy_adapter, NULL, 1, 3, 500); ++ ++ ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); ++ ++ DBG_8192C("%s, set switch ch timer, duration=%d\n", __func__, duration-pwdinfo->ext_listen_interval); ++ _set_timer(&pwdinfo->ap_p2p_switch_timer, duration-pwdinfo->ext_listen_interval); ++ } ++ } ++ ++ ready_on_channel = true; ++ //pmlmeext->cur_channel = remain_ch; ++ //set_channel_bwmode(padapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ }else ++#endif //CONFIG_CONCURRENT_MODE ++ if(remain_ch != pmlmeext->cur_channel ) ++ { ++ ready_on_channel = true; ++ //pmlmeext->cur_channel = remain_ch; ++ //set_channel_bwmode(padapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ } ++ } else { ++ DBG_871X("%s remain_ch:%u not in channel plan!!!!\n", __FUNCTION__, remain_ch); ++ } ++ ++ ++ //call this after other things have been done ++#ifdef CONFIG_CONCURRENT_MODE ++ if(ATOMIC_READ(&pwdev_priv->ro_ch_to)==1 || ++ (remain_ch != pmlmeext->cur_channel)) ++ { ++ u8 co_channel = 0xff; ++ ATOMIC_SET(&pwdev_priv->ro_ch_to, 0); ++#endif ++ ++ if(ready_on_channel == true) ++ { ++ if ( !check_fwstate(&padapter->mlmepriv, _FW_LINKED ) ) ++ pmlmeext->cur_channel = remain_ch; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ co_channel = rtw_get_oper_ch(padapter); ++ ++ if(co_channel !=remain_ch) ++#endif ++ { ++ if (!padapter->mlmepriv.LinkDetectInfo.bBusyTraffic) ++ set_channel_bwmode(padapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ } ++ } ++ DBG_8192C("%s, set ro ch timer, duration=%d\n", __func__, duration); ++ _set_timer( &pcfg80211_wdinfo->remain_on_ch_timer, duration); ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ } ++#endif ++ ++ rtw_cfg80211_ready_on_channel(padapter, *cookie, channel, channel_type, duration, GFP_KERNEL); ++ ++ pwdinfo->listen_channel = pmlmeext->cur_channel; ++ ++exit: ++ if (err) ++ pcfg80211_wdinfo->is_ro_ch = false; ++ ++ return err; ++} ++ ++static s32 cfg80211_rtw_cancel_remain_on_channel(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) ++ struct wireless_dev *wdev, ++#else ++ struct net_device *ndev, ++#endif ++ u64 cookie) ++{ ++ s32 err = 0; ++ _adapter *padapter = wiphy_to_adapter(wiphy); ++ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; ++ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; ++ ++ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); ++ ++ if (pcfg80211_wdinfo->is_ro_ch == true) { ++ DBG_8192C("%s, cancel ro ch timer\n", __func__); ++ _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); ++ #ifdef CONFIG_CONCURRENT_MODE ++ ATOMIC_SET(&pwdev_priv->ro_ch_to, 1); ++ #endif ++ p2p_protocol_wk_hdl(padapter, P2P_RO_CH_WK); ++ } ++ ++ #if 0 ++ // Disable P2P Listen State ++ if(!rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) && !rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) ++ { ++ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) ++ { ++ _cancel_timer_ex( &pwdinfo->find_phase_timer ); ++ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); ++ _cancel_timer_ex( &pwdinfo->pre_tx_scan_timer); ++ ++ rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE); ++ _rtw_memset(pwdinfo, 0x00, sizeof(struct wifidirect_info)); ++ } ++ } ++ else ++ #endif ++ { ++ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); ++#ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); ++#endif ++ } ++ pcfg80211_wdinfo->is_ro_ch = false; ++ ++ return err; ++} ++ ++#endif //CONFIG_P2P ++ ++static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, const u8 *buf, size_t len) ++{ ++ struct xmit_frame *pmgntframe; ++ struct pkt_attrib *pattrib; ++ unsigned char *pframe; ++ int ret = _FAIL; ++ bool ack = true; ++ struct rtw_ieee80211_hdr *pwlanhdr; ++ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); ++ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++ //struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; ++ ++ if(_FAIL == rtw_pwr_wakeup(padapter)) { ++ ret = -EFAULT; ++ goto exit; ++ } ++ ++ rtw_set_scan_deny(padapter, 1000); ++ ++ rtw_scan_abort(padapter); ++ #ifdef CONFIG_CONCURRENT_MODE ++ if(rtw_buddy_adapter_up(padapter)) ++ rtw_scan_abort(padapter->pbuddy_adapter); ++ #endif /* CONFIG_CONCURRENT_MODE */ ++ ++ if (padapter->cfg80211_wdinfo.is_ro_ch == true) { ++ //DBG_8192C("%s, cancel ro ch timer\n", __func__); ++ //_cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); ++ //padapter->cfg80211_wdinfo.is_ro_ch = false; ++ #ifdef CONFIG_CONCURRENT_MODE ++ DBG_8192C("%s, extend ro ch time\n", __func__); ++ _set_timer( &padapter->cfg80211_wdinfo.remain_on_ch_timer, pwdinfo->ext_listen_period); ++ #endif //CONFIG_CONCURRENT_MODE ++ } ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if (check_buddy_fwstate(padapter, _FW_LINKED )) { ++ u8 co_channel=0xff; ++ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; ++ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; ++ ++ co_channel = rtw_get_oper_ch(padapter); ++ ++ if (tx_ch != pbuddy_mlmeext->cur_channel) { ++ if (ATOMIC_READ(&pwdev_priv->switch_ch_to)==1) { ++ DBG_8192C("%s, issue nulldata pwrbit=1\n", __func__); ++ issue_nulldata(padapter->pbuddy_adapter, NULL, 1, 3, 500); ++ ++ ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); ++ ++ //DBG_8192C("%s, set switch ch timer, period=%d\n", __func__, pwdinfo->ext_listen_period); ++ //_set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_period); ++ } ++ ++ DBG_8192C("%s, set switch ch timer, period=%d\n", __func__, pwdinfo->ext_listen_period); ++ _set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_period); ++ } ++ ++ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED )) ++ pmlmeext->cur_channel = tx_ch; ++ ++ if (tx_ch != co_channel) ++ set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ }else ++#endif //CONFIG_CONCURRENT_MODE ++ //if (tx_ch != pmlmeext->cur_channel) { ++ if(tx_ch != rtw_get_oper_ch(padapter)) { ++ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED )) ++ pmlmeext->cur_channel = tx_ch; ++ set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); ++ } ++ ++ //starting alloc mgmt frame to dump it ++ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) ++ { ++ //ret = -ENOMEM; ++ ret = _FAIL; ++ goto exit; ++ } ++ ++ //update attribute ++ pattrib = &pmgntframe->attrib; ++ update_mgntframe_attrib(padapter, pattrib); ++ pattrib->retry_ctrl = false; ++ ++ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); ++ ++ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; ++ ++ _rtw_memcpy(pframe, (void*)buf, len); ++ pattrib->pktlen = len; ++ ++ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; ++ //update seq number ++ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); ++ pattrib->seqnum = pmlmeext->mgnt_seq; ++ pmlmeext->mgnt_seq++; ++ ++#ifdef CONFIG_WFD ++ { ++ struct wifi_display_info *pwfd_info; ++ ++ pwfd_info = padapter->wdinfo.wfd_info; ++ ++ if ( true == pwfd_info->wfd_enable ) ++ { ++ rtw_append_wfd_ie( padapter, pframe, &pattrib->pktlen ); ++ } ++ } ++#endif // CONFIG_WFD ++ ++ pattrib->last_txcmdsz = pattrib->pktlen; ++ ++ if (dump_mgntframe_and_wait_ack(padapter, pmgntframe) != _SUCCESS) ++ { ++ ack = false; ++ ret = _FAIL; ++ ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("%s, ack == _FAIL\n", __func__); ++ #endif ++ } ++ else ++ { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("%s, ack=%d, ok!\n", __func__, ack); ++ #endif ++ ret = _SUCCESS; ++ } ++ ++exit: ++ ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("%s, ret=%d\n", __func__, ret); ++ #endif ++ ++ return ret; ++ ++} ++ ++static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) ++ struct wireless_dev *wdev, ++#else ++ struct net_device *ndev, ++#endif ++ struct ieee80211_channel *chan, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) ++ bool offchan, ++#endif ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) ++ enum nl80211_channel_type channel_type, ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ bool channel_type_valid, ++ #endif ++#endif ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) ++ unsigned int wait, ++#endif ++ const u8 *buf, size_t len, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,2,0)) ++ bool no_cck, ++#endif ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,3,0)) ++ bool dont_wait_for_ack, ++#endif ++ u64 *cookie) ++{ ++ _adapter *padapter = (_adapter *)wiphy_to_adapter(wiphy); ++ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); ++ int ret = 0; ++ int tx_ret; ++ u32 dump_limit = RTW_MAX_MGMT_TX_CNT; ++ u32 dump_cnt = 0; ++ bool ack = true; ++ u8 tx_ch = (u8)ieee80211_frequency_to_channel(chan->center_freq); ++ u8 category, action; ++ int type = (-1); ++ u32 start = rtw_get_current_time(); ++ ++ /* cookie generation */ ++ *cookie = (unsigned long) buf; ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ DBG_871X(FUNC_ADPT_FMT" len=%zu, ch=%d" ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) ++ ", ch_type=%d" ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ ", channel_type_valid=%d" ++ #endif ++ #endif ++ "\n", FUNC_ADPT_ARG(padapter), ++ len, tx_ch ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) ++ , channel_type ++ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ , channel_type_valid ++ #endif ++ #endif ++ ); ++#endif /* CONFIG_DEBUG_CFG80211 */ ++ ++ /* indicate ack before issue frame to avoid racing with rsp frame */ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ rtw_cfg80211_mgmt_tx_status(padapter, *cookie, buf, len, ack, GFP_KERNEL); ++#elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,34) && LINUX_VERSION_CODE<=KERNEL_VERSION(2,6,35)) ++ cfg80211_action_tx_status(ndev, *cookie, buf, len, ack, GFP_KERNEL); ++#endif ++ ++ if (rtw_action_frame_parse(buf, len, &category, &action) == false) { ++ DBG_8192C(FUNC_ADPT_FMT" frame_control:0x%x\n", FUNC_ADPT_ARG(padapter), ++ le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl)); ++ goto exit; ++ } ++ ++ DBG_8192C("RTW_Tx:tx_ch=%d, da="MAC_FMT"\n", tx_ch, MAC_ARG(GetAddr1Ptr(buf))); ++ #ifdef CONFIG_P2P ++ if((type = rtw_p2p_check_frames(padapter, buf, len, true)) >= 0) ++ goto dump; ++ #endif ++ if (category == RTW_WLAN_CATEGORY_PUBLIC) ++ DBG_871X("RTW_Tx:%s\n", action_public_str(action)); ++ else ++ DBG_871X("RTW_Tx:category(%u), action(%u)\n", category, action); ++ ++dump: ++ do { ++ dump_cnt++; ++ tx_ret = _cfg80211_rtw_mgmt_tx(padapter, tx_ch, buf, len); ++ } while (dump_cnt < dump_limit && tx_ret != _SUCCESS); ++ ++ if (tx_ret != _SUCCESS || dump_cnt > 1) { ++ DBG_871X(FUNC_ADPT_FMT" %s (%d/%d) in %d ms\n", FUNC_ADPT_ARG(padapter), ++ tx_ret==_SUCCESS?"OK":"FAIL", dump_cnt, dump_limit, rtw_get_passing_time_ms(start)); ++ } ++ ++ switch (type) { ++ case P2P_GO_NEGO_CONF: ++ rtw_clear_scan_deny(padapter); ++ break; ++ case P2P_INVIT_RESP: ++ if (pwdev_priv->invit_info.flags & BIT(0) ++ && pwdev_priv->invit_info.status == 0) ++ { ++ DBG_871X(FUNC_ADPT_FMT" agree with invitation of persistent group\n", ++ FUNC_ADPT_ARG(padapter)); ++ rtw_set_scan_deny(padapter, 5000); ++ rtw_pwr_wakeup_ex(padapter, 5000); ++ rtw_clear_scan_deny(padapter); ++ } ++ break; ++ } ++ ++exit: ++ return ret; ++} ++ ++static void cfg80211_rtw_mgmt_frame_register(struct wiphy *wiphy, ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) ++ struct wireless_dev *wdev, ++#else ++ struct net_device *ndev, ++#endif ++ u16 frame_type, bool reg) ++{ ++ _adapter *adapter = wiphy_to_adapter(wiphy); ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ DBG_871X(FUNC_ADPT_FMT" frame_type:%x, reg:%d\n", FUNC_ADPT_ARG(adapter), ++ frame_type, reg); ++#endif ++ ++ if (frame_type != (IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_PROBE_REQ)) ++ return; ++ ++ return; ++} ++ ++static int rtw_cfg80211_set_beacon_wpsp2pie(struct net_device *ndev, char *buf, int len) ++{ ++ int ret = 0; ++ uint wps_ielen = 0; ++ u8 *wps_ie; ++ u32 p2p_ielen = 0; ++ u8 wps_oui[8]={0x0,0x50,0xf2,0x04}; ++ u8 *p2p_ie; ++ u32 wfd_ielen = 0; ++ u8 *wfd_ie; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ ++ DBG_871X(FUNC_NDEV_FMT" ielen=%d\n", FUNC_NDEV_ARG(ndev), len); ++ ++ if(len>0) ++ { ++ if((wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen))) ++ { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("bcn_wps_ielen=%d\n", wps_ielen); ++ #endif ++ ++ if(pmlmepriv->wps_beacon_ie) ++ { ++ u32 free_len = pmlmepriv->wps_beacon_ie_len; ++ pmlmepriv->wps_beacon_ie_len = 0; ++ rtw_mfree(pmlmepriv->wps_beacon_ie, free_len); ++ pmlmepriv->wps_beacon_ie = NULL; ++ } ++ ++ pmlmepriv->wps_beacon_ie = rtw_malloc(wps_ielen); ++ if ( pmlmepriv->wps_beacon_ie == NULL) { ++ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ ++ _rtw_memcpy(pmlmepriv->wps_beacon_ie, wps_ie, wps_ielen); ++ pmlmepriv->wps_beacon_ie_len = wps_ielen; ++ ++ update_beacon(padapter, _VENDOR_SPECIFIC_IE_, wps_oui, true); ++ ++ } ++ ++ //buf += wps_ielen; ++ //len -= wps_ielen; ++ ++ #ifdef CONFIG_P2P ++ if((p2p_ie=rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen))) ++ { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("bcn_p2p_ielen=%d\n", p2p_ielen); ++ #endif ++ ++ if(pmlmepriv->p2p_beacon_ie) ++ { ++ u32 free_len = pmlmepriv->p2p_beacon_ie_len; ++ pmlmepriv->p2p_beacon_ie_len = 0; ++ rtw_mfree(pmlmepriv->p2p_beacon_ie, free_len); ++ pmlmepriv->p2p_beacon_ie = NULL; ++ } ++ ++ pmlmepriv->p2p_beacon_ie = rtw_malloc(p2p_ielen); ++ if ( pmlmepriv->p2p_beacon_ie == NULL) { ++ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ ++ _rtw_memcpy(pmlmepriv->p2p_beacon_ie, p2p_ie, p2p_ielen); ++ pmlmepriv->p2p_beacon_ie_len = p2p_ielen; ++ ++ } ++ #endif //CONFIG_P2P ++ ++ //buf += p2p_ielen; ++ //len -= p2p_ielen; ++ ++ #ifdef CONFIG_WFD ++ if(rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen)) ++ { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("bcn_wfd_ielen=%d\n", wfd_ielen); ++ #endif ++ ++ if(pmlmepriv->wfd_beacon_ie) ++ { ++ u32 free_len = pmlmepriv->wfd_beacon_ie_len; ++ pmlmepriv->wfd_beacon_ie_len = 0; ++ rtw_mfree(pmlmepriv->wfd_beacon_ie, free_len); ++ pmlmepriv->wfd_beacon_ie = NULL; ++ } ++ ++ pmlmepriv->wfd_beacon_ie = rtw_malloc(wfd_ielen); ++ if ( pmlmepriv->wfd_beacon_ie == NULL) { ++ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ rtw_get_wfd_ie(buf, len, pmlmepriv->wfd_beacon_ie, &pmlmepriv->wfd_beacon_ie_len); ++ } ++ #endif //CONFIG_WFD ++ ++ pmlmeext->bstart_bss = true; ++ ++ } ++ ++ return ret; ++ ++} ++ ++static int rtw_cfg80211_set_probe_resp_wpsp2pie(struct net_device *net, char *buf, int len) ++{ ++ int ret = 0; ++ uint wps_ielen = 0; ++ u8 *wps_ie; ++ u32 p2p_ielen = 0; ++ u8 *p2p_ie; ++ u32 wfd_ielen = 0; ++ u8 *wfd_ie; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("%s, ielen=%d\n", __func__, len); ++#endif ++ ++ if(len>0) ++ { ++ if((wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen))) ++ { ++ uint attr_contentlen = 0; ++ u16 uconfig_method, *puconfig_method = NULL; ++ ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("probe_resp_wps_ielen=%d\n", wps_ielen); ++ #endif ++ ++ if(pmlmepriv->wps_probe_resp_ie) ++ { ++ u32 free_len = pmlmepriv->wps_probe_resp_ie_len; ++ pmlmepriv->wps_probe_resp_ie_len = 0; ++ rtw_mfree(pmlmepriv->wps_probe_resp_ie, free_len); ++ pmlmepriv->wps_probe_resp_ie = NULL; ++ } ++ ++ pmlmepriv->wps_probe_resp_ie = rtw_malloc(wps_ielen); ++ if ( pmlmepriv->wps_probe_resp_ie == NULL) { ++ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ ++ //add PUSH_BUTTON config_method by driver self in wpsie of probe_resp at GO Mode ++ if ( (puconfig_method = (u16*)rtw_get_wps_attr_content( wps_ie, wps_ielen, WPS_ATTR_CONF_METHOD , NULL, &attr_contentlen)) != NULL ) ++ { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ //printk("config_method in wpsie of probe_resp = 0x%x\n", be16_to_cpu(*puconfig_method)); ++ #endif ++ ++ uconfig_method = WPS_CM_PUSH_BUTTON; ++ uconfig_method = cpu_to_be16( uconfig_method ); ++ ++ *puconfig_method |= uconfig_method; ++ } ++ ++ _rtw_memcpy(pmlmepriv->wps_probe_resp_ie, wps_ie, wps_ielen); ++ pmlmepriv->wps_probe_resp_ie_len = wps_ielen; ++ ++ } ++ ++ //buf += wps_ielen; ++ //len -= wps_ielen; ++ ++ #ifdef CONFIG_P2P ++ if((p2p_ie=rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen))) ++ { ++ u8 is_GO = false; ++ u32 attr_contentlen = 0; ++ u16 cap_attr=0; ++ ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("probe_resp_p2p_ielen=%d\n", p2p_ielen); ++ #endif ++ ++ //Check P2P Capability ATTR ++ if( rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8*)&cap_attr, (uint*) &attr_contentlen) ) ++ { ++ u8 grp_cap=0; ++ //DBG_8192C( "[%s] Got P2P Capability Attr!!\n", __FUNCTION__ ); ++ cap_attr = le16_to_cpu(cap_attr); ++ grp_cap = (u8)((cap_attr >> 8)&0xff); ++ ++ is_GO = (grp_cap&BIT(0)) ? true:false; ++ ++ if(is_GO) ++ DBG_8192C("Got P2P Capability Attr, grp_cap=0x%x, is_GO\n", grp_cap); ++ } ++ ++ ++ if(is_GO == false) ++ { ++ if(pmlmepriv->p2p_probe_resp_ie) ++ { ++ u32 free_len = pmlmepriv->p2p_probe_resp_ie_len; ++ pmlmepriv->p2p_probe_resp_ie_len = 0; ++ rtw_mfree(pmlmepriv->p2p_probe_resp_ie, free_len); ++ pmlmepriv->p2p_probe_resp_ie = NULL; ++ } ++ ++ pmlmepriv->p2p_probe_resp_ie = rtw_malloc(p2p_ielen); ++ if ( pmlmepriv->p2p_probe_resp_ie == NULL) { ++ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ _rtw_memcpy(pmlmepriv->p2p_probe_resp_ie, p2p_ie, p2p_ielen); ++ pmlmepriv->p2p_probe_resp_ie_len = p2p_ielen; ++ } ++ else ++ { ++ if(pmlmepriv->p2p_go_probe_resp_ie) ++ { ++ u32 free_len = pmlmepriv->p2p_go_probe_resp_ie_len; ++ pmlmepriv->p2p_go_probe_resp_ie_len = 0; ++ rtw_mfree(pmlmepriv->p2p_go_probe_resp_ie, free_len); ++ pmlmepriv->p2p_go_probe_resp_ie = NULL; ++ } ++ ++ pmlmepriv->p2p_go_probe_resp_ie = rtw_malloc(p2p_ielen); ++ if ( pmlmepriv->p2p_go_probe_resp_ie == NULL) { ++ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ _rtw_memcpy(pmlmepriv->p2p_go_probe_resp_ie, p2p_ie, p2p_ielen); ++ pmlmepriv->p2p_go_probe_resp_ie_len = p2p_ielen; ++ } ++ ++ } ++ #endif //CONFIG_P2P ++ ++ //buf += p2p_ielen; ++ //len -= p2p_ielen; ++ ++ #ifdef CONFIG_WFD ++ if(rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen)) ++ { ++ #ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("probe_resp_wfd_ielen=%d\n", wfd_ielen); ++ #endif ++ ++ if(pmlmepriv->wfd_probe_resp_ie) ++ { ++ u32 free_len = pmlmepriv->wfd_probe_resp_ie_len; ++ pmlmepriv->wfd_probe_resp_ie_len = 0; ++ rtw_mfree(pmlmepriv->wfd_probe_resp_ie, free_len); ++ pmlmepriv->wfd_probe_resp_ie = NULL; ++ } ++ ++ pmlmepriv->wfd_probe_resp_ie = rtw_malloc(wfd_ielen); ++ if ( pmlmepriv->wfd_probe_resp_ie == NULL) { ++ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ rtw_get_wfd_ie(buf, len, pmlmepriv->wfd_probe_resp_ie, &pmlmepriv->wfd_probe_resp_ie_len); ++ } ++ #endif //CONFIG_WFD ++ ++ } ++ ++ return ret; ++ ++} ++ ++static int rtw_cfg80211_set_assoc_resp_wpsp2pie(struct net_device *net, char *buf, int len) ++{ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ ++ DBG_8192C("%s, ielen=%d\n", __func__, len); ++ ++ if(len>0) ++ { ++ if(pmlmepriv->wps_assoc_resp_ie) ++ { ++ u32 free_len = pmlmepriv->wps_assoc_resp_ie_len; ++ pmlmepriv->wps_assoc_resp_ie_len = 0; ++ rtw_mfree(pmlmepriv->wps_assoc_resp_ie, free_len); ++ pmlmepriv->wps_assoc_resp_ie = NULL; ++ } ++ ++ pmlmepriv->wps_assoc_resp_ie = rtw_malloc(len); ++ if ( pmlmepriv->wps_assoc_resp_ie == NULL) { ++ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); ++ return -EINVAL; ++ ++ } ++ _rtw_memcpy(pmlmepriv->wps_assoc_resp_ie, buf, len); ++ pmlmepriv->wps_assoc_resp_ie_len = len; ++ } ++ ++ return ret; ++ ++} ++ ++int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, ++ int type) ++{ ++ int ret = 0; ++ uint wps_ielen = 0; ++ u32 p2p_ielen = 0; ++ ++#ifdef CONFIG_DEBUG_CFG80211 ++ DBG_8192C("%s, ielen=%d\n", __func__, len); ++#endif ++ ++ if( (rtw_get_wps_ie(buf, len, NULL, &wps_ielen) && (wps_ielen>0)) ++ #ifdef CONFIG_P2P ++ || (rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen) && (p2p_ielen>0)) ++ #endif ++ ) ++ { ++ if (net != NULL) ++ { ++ switch (type) ++ { ++ case 0x1: //BEACON ++ ret = rtw_cfg80211_set_beacon_wpsp2pie(net, buf, len); ++ break; ++ case 0x2: //PROBE_RESP ++ ret = rtw_cfg80211_set_probe_resp_wpsp2pie(net, buf, len); ++ break; ++ case 0x4: //ASSOC_RESP ++ ret = rtw_cfg80211_set_assoc_resp_wpsp2pie(net, buf, len); ++ break; ++ } ++ } ++ } ++ ++ return ret; ++ ++} ++ ++static struct cfg80211_ops rtw_cfg80211_ops = { ++ .change_virtual_intf = cfg80211_rtw_change_iface, ++ .add_key = cfg80211_rtw_add_key, ++ .get_key = cfg80211_rtw_get_key, ++ .del_key = cfg80211_rtw_del_key, ++ .set_default_key = cfg80211_rtw_set_default_key, ++ .get_station = cfg80211_rtw_get_station, ++ .scan = cfg80211_rtw_scan, ++ .set_wiphy_params = cfg80211_rtw_set_wiphy_params, ++ .connect = cfg80211_rtw_connect, ++ .disconnect = cfg80211_rtw_disconnect, ++ .join_ibss = cfg80211_rtw_join_ibss, ++ .leave_ibss = cfg80211_rtw_leave_ibss, ++ .set_tx_power = cfg80211_rtw_set_txpower, ++ .get_tx_power = cfg80211_rtw_get_txpower, ++ .set_power_mgmt = cfg80211_rtw_set_power_mgmt, ++ .set_pmksa = cfg80211_rtw_set_pmksa, ++ .del_pmksa = cfg80211_rtw_del_pmksa, ++ .flush_pmksa = cfg80211_rtw_flush_pmksa, ++ ++#ifdef CONFIG_AP_MODE ++ .add_virtual_intf = cfg80211_rtw_add_virtual_intf, ++ .del_virtual_intf = cfg80211_rtw_del_virtual_intf, ++ ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) && !defined(COMPAT_KERNEL_RELEASE) ++ .add_beacon = cfg80211_rtw_add_beacon, ++ .set_beacon = cfg80211_rtw_set_beacon, ++ .del_beacon = cfg80211_rtw_del_beacon, ++ #else ++ .start_ap = cfg80211_rtw_start_ap, ++ .change_beacon = cfg80211_rtw_change_beacon, ++ .stop_ap = cfg80211_rtw_stop_ap, ++ #endif ++ ++ .add_station = cfg80211_rtw_add_station, ++ .del_station = cfg80211_rtw_del_station, ++ .change_station = cfg80211_rtw_change_station, ++ .dump_station = cfg80211_rtw_dump_station, ++ .change_bss = cfg80211_rtw_change_bss, ++ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) ++ .set_channel = cfg80211_rtw_set_channel, ++ #endif ++ //.auth = cfg80211_rtw_auth, ++ //.assoc = cfg80211_rtw_assoc, ++#endif //CONFIG_AP_MODE ++ ++#ifdef CONFIG_P2P ++ .remain_on_channel = cfg80211_rtw_remain_on_channel, ++ .cancel_remain_on_channel = cfg80211_rtw_cancel_remain_on_channel, ++#endif ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++ .mgmt_tx = cfg80211_rtw_mgmt_tx, ++ .mgmt_frame_register = cfg80211_rtw_mgmt_frame_register, ++#elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,34) && LINUX_VERSION_CODE<=KERNEL_VERSION(2,6,35)) ++ .action = cfg80211_rtw_mgmt_tx, ++#endif ++}; ++ ++static void rtw_cfg80211_init_ht_capab(struct ieee80211_sta_ht_cap *ht_cap, enum ieee80211_band band, u8 rf_type) ++{ ++ ++#define MAX_BIT_RATE_40MHZ_MCS15 300 /* Mbps */ ++#define MAX_BIT_RATE_40MHZ_MCS7 150 /* Mbps */ ++ ++ ht_cap->ht_supported = true; ++ ++ ht_cap->cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 | ++ IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_SGI_20 | ++ IEEE80211_HT_CAP_DSSSCCK40 | IEEE80211_HT_CAP_MAX_AMSDU; ++ ++ /* ++ *Maximum length of AMPDU that the STA can receive. ++ *Length = 2 ^ (13 + max_ampdu_length_exp) - 1 (octets) ++ */ ++ ht_cap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K; ++ ++ /*Minimum MPDU start spacing , */ ++ ht_cap->ampdu_density = IEEE80211_HT_MPDU_DENSITY_16; ++ ++ ht_cap->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED; ++ ++ /* ++ *hw->wiphy->bands[IEEE80211_BAND_2GHZ] ++ *base on ant_num ++ *rx_mask: RX mask ++ *if rx_ant =1 rx_mask[0]=0xff;==>MCS0-MCS7 ++ *if rx_ant =2 rx_mask[1]=0xff;==>MCS8-MCS15 ++ *if rx_ant >=3 rx_mask[2]=0xff; ++ *if BW_40 rx_mask[4]=0x01; ++ *highest supported RX rate ++ */ ++ if(rf_type == RF_1T1R) ++ { ++ ht_cap->mcs.rx_mask[0] = 0xFF; ++ ht_cap->mcs.rx_mask[1] = 0x00; ++ ht_cap->mcs.rx_mask[4] = 0x01; ++ ++ ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS7; ++ } ++ else if((rf_type == RF_1T2R) || (rf_type==RF_2T2R)) ++ { ++ ht_cap->mcs.rx_mask[0] = 0xFF; ++ ht_cap->mcs.rx_mask[1] = 0xFF; ++ ht_cap->mcs.rx_mask[4] = 0x01; ++ ++ ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS15; ++ } ++ else ++ { ++ DBG_8192C("%s, error rf_type=%d\n", __func__, rf_type); ++ } ++ ++} ++ ++void rtw_cfg80211_init_wiphy(_adapter *padapter) ++{ ++ u8 rf_type; ++ struct ieee80211_supported_band *bands; ++ struct wireless_dev *pwdev = padapter->rtw_wdev; ++ struct wiphy *wiphy = pwdev->wiphy; ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ DBG_8192C("%s:rf_type=%d\n", __func__, rf_type); ++ ++ /* if (padapter->registrypriv.wireless_mode & WIRELESS_11G) */ ++ { ++ bands = wiphy->bands[IEEE80211_BAND_2GHZ]; ++ if(bands) ++ rtw_cfg80211_init_ht_capab(&bands->ht_cap, IEEE80211_BAND_2GHZ, rf_type); ++ } ++ ++ /* if (padapter->registrypriv.wireless_mode & WIRELESS_11A) */ ++ { ++ bands = wiphy->bands[IEEE80211_BAND_5GHZ]; ++ if(bands) ++ rtw_cfg80211_init_ht_capab(&bands->ht_cap, IEEE80211_BAND_5GHZ, rf_type); ++ } ++} ++ ++/* ++struct ieee80211_iface_limit rtw_limits[] = { ++ { .max = 1, .types = BIT(NL80211_IFTYPE_STATION) ++ | BIT(NL80211_IFTYPE_ADHOC) ++#ifdef CONFIG_AP_MODE ++ | BIT(NL80211_IFTYPE_AP) ++#endif ++#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE)) ++ | BIT(NL80211_IFTYPE_P2P_CLIENT) ++ | BIT(NL80211_IFTYPE_P2P_GO) ++#endif ++ }, ++ {.max = 1, .types = BIT(NL80211_IFTYPE_MONITOR)}, ++}; ++ ++struct ieee80211_iface_combination rtw_combinations = { ++ .limits = rtw_limits, ++ .n_limits = ARRAY_SIZE(rtw_limits), ++ .max_interfaces = 2, ++ .num_different_channels = 1, ++}; ++*/ ++ ++static void rtw_cfg80211_preinit_wiphy(_adapter *padapter, struct wiphy *wiphy) ++{ ++ ++ wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; ++ ++ wiphy->max_scan_ssids = RTW_SSID_SCAN_AMOUNT; ++ wiphy->max_scan_ie_len = RTW_SCAN_IE_LEN_MAX; ++ wiphy->max_num_pmkids = RTW_MAX_NUM_PMKIDS; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) ++ wiphy->max_remain_on_channel_duration = RTW_MAX_REMAIN_ON_CHANNEL_DURATION; ++#endif ++ ++ wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) ++ | BIT(NL80211_IFTYPE_ADHOC) ++#ifdef CONFIG_AP_MODE ++ | BIT(NL80211_IFTYPE_AP) ++ | BIT(NL80211_IFTYPE_MONITOR) ++#endif ++#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE)) ++ | BIT(NL80211_IFTYPE_P2P_CLIENT) ++ | BIT(NL80211_IFTYPE_P2P_GO) ++#endif ++ ; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) ++#ifdef CONFIG_AP_MODE ++ wiphy->mgmt_stypes = rtw_cfg80211_default_mgmt_stypes; ++#endif //CONFIG_AP_MODE ++#endif ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,0,0)) ++ wiphy->software_iftypes |= BIT(NL80211_IFTYPE_MONITOR); ++#endif ++ ++ /* ++ wiphy->iface_combinations = &rtw_combinations; ++ wiphy->n_iface_combinations = 1; ++ */ ++ ++ wiphy->cipher_suites = rtw_cipher_suites; ++ wiphy->n_cipher_suites = ARRAY_SIZE(rtw_cipher_suites); ++ ++ /* if (padapter->registrypriv.wireless_mode & WIRELESS_11G) */ ++ wiphy->bands[IEEE80211_BAND_2GHZ] = rtw_spt_band_alloc(IEEE80211_BAND_2GHZ); ++ /* if (padapter->registrypriv.wireless_mode & WIRELESS_11A) */ ++ wiphy->bands[IEEE80211_BAND_5GHZ] = rtw_spt_band_alloc(IEEE80211_BAND_5GHZ); ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38) && LINUX_VERSION_CODE < KERNEL_VERSION(3,0,0)) ++ wiphy->flags |= WIPHY_FLAG_SUPPORTS_SEPARATE_DEFAULT_KEYS; ++#endif ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,3,0)) ++ wiphy->flags |= WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL; ++ wiphy->flags |= WIPHY_FLAG_OFFCHAN_TX | WIPHY_FLAG_HAVE_AP_SME; ++#endif ++ ++ if(padapter->registrypriv.power_mgnt != PS_MODE_ACTIVE) ++ wiphy->flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT; ++ else ++ wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT; ++} ++ ++int rtw_wdev_alloc(_adapter *padapter, struct device *dev) ++{ ++ int ret = 0; ++ struct wiphy *wiphy; ++ struct wireless_dev *wdev; ++ struct rtw_wdev_priv *pwdev_priv; ++ struct net_device *pnetdev = padapter->pnetdev; ++ ++ DBG_8192C("%s(padapter=%p)\n", __func__, padapter); ++ ++ /* wiphy */ ++ wiphy = wiphy_new(&rtw_cfg80211_ops, sizeof(struct rtw_wdev_priv)); ++ if (!wiphy) { ++ DBG_8192C("Couldn't allocate wiphy device\n"); ++ ret = -ENOMEM; ++ goto exit; ++ } ++ set_wiphy_dev(wiphy, dev); ++ rtw_cfg80211_preinit_wiphy(padapter, wiphy); ++ ++ ret = wiphy_register(wiphy); ++ if (ret < 0) { ++ DBG_8192C("Couldn't register wiphy device\n"); ++ goto free_wiphy; ++ } ++ ++ /* wdev */ ++ wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); ++ if (!wdev) { ++ DBG_8192C("Couldn't allocate wireless device\n"); ++ ret = -ENOMEM; ++ goto unregister_wiphy; ++ } ++ wdev->wiphy = wiphy; ++ wdev->netdev = pnetdev; ++ //wdev->iftype = NL80211_IFTYPE_STATION; ++ wdev->iftype = NL80211_IFTYPE_MONITOR; // for rtw_setopmode_cmd() in cfg80211_rtw_change_iface() ++ padapter->rtw_wdev = wdev; ++ pnetdev->ieee80211_ptr = wdev; ++ ++ //init pwdev_priv ++ pwdev_priv = wdev_to_priv(wdev); ++ pwdev_priv->rtw_wdev = wdev; ++ pwdev_priv->pmon_ndev = NULL; ++ pwdev_priv->ifname_mon[0] = '\0'; ++ pwdev_priv->padapter = padapter; ++ pwdev_priv->scan_request = NULL; ++ _rtw_spinlock_init(&pwdev_priv->scan_req_lock); ++ ++ pwdev_priv->p2p_enabled = false; ++ pwdev_priv->provdisc_req_issued = false; ++ rtw_wdev_invit_info_init(&pwdev_priv->invit_info); ++ ++ pwdev_priv->bandroid_scan = false; ++ ++ if(padapter->registrypriv.power_mgnt != PS_MODE_ACTIVE) ++ pwdev_priv->power_mgmt = true; ++ else ++ pwdev_priv->power_mgmt = false; ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); ++ ATOMIC_SET(&pwdev_priv->ro_ch_to, 1); ++#endif ++ ++ return ret; ++ ++ rtw_mfree((u8*)wdev, sizeof(struct wireless_dev)); ++unregister_wiphy: ++ wiphy_unregister(wiphy); ++ free_wiphy: ++ wiphy_free(wiphy); ++exit: ++ return ret; ++ ++} ++ ++void rtw_wdev_free(struct wireless_dev *wdev) ++{ ++ struct rtw_wdev_priv *pwdev_priv; ++ ++ DBG_8192C("%s(wdev=%p)\n", __func__, wdev); ++ ++ if (!wdev) ++ return; ++ ++ pwdev_priv = wdev_to_priv(wdev); ++ ++ rtw_spt_band_free(wdev->wiphy->bands[IEEE80211_BAND_2GHZ]); ++ rtw_spt_band_free(wdev->wiphy->bands[IEEE80211_BAND_5GHZ]); ++ ++ wiphy_free(wdev->wiphy); ++ ++ rtw_mfree((u8*)wdev, sizeof(struct wireless_dev)); ++} ++ ++void rtw_wdev_unregister(struct wireless_dev *wdev) ++{ ++ struct rtw_wdev_priv *pwdev_priv; ++ ++ DBG_8192C("%s(wdev=%p)\n", __func__, wdev); ++ ++ if (!wdev) ++ return; ++ ++ pwdev_priv = wdev_to_priv(wdev); ++ ++ rtw_cfg80211_indicate_scan_done(pwdev_priv, true); ++ ++ if (pwdev_priv->pmon_ndev) { ++ DBG_8192C("%s, unregister monitor interface\n", __func__); ++ unregister_netdev(pwdev_priv->pmon_ndev); ++ } ++ ++ wiphy_unregister(wdev->wiphy); ++} ++ ++#endif //CONFIG_IOCTL_CFG80211 +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/ioctl_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/ioctl_linux.c +--- linux-4.14.17/3rdparty/rtl8812au/os_dep/ioctl_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/ioctl_linux.c 2018-02-06 17:42:30.724967372 +0200 +@@ -0,0 +1,12843 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#define _IOCTL_LINUX_C_ + +#include -+#include ++ ++//#ifdef CONFIG_MP_INCLUDED +#include -+#include "../../hal/phydm/phydm_precomp.h" ++#include "../hal/odm_precomp.h" ++//#endif + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,27)) +#define iwe_stream_add_event(a, b, c, d, e) iwe_stream_add_event(b, c, d, e) +#define iwe_stream_add_point(a, b, c, d, e) iwe_stream_add_point(b, c, d, e) +#endif + -+#ifdef CONFIG_80211N_HT -+extern int rtw_ht_enable; -+#endif -+ + +#define RTL_IOCTL_WPA_SUPPLICANT SIOCIWFIRSTPRIV+30 + @@ -350669,15 +161360,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + +extern u8 key_2char2num(u8 hch, u8 lch); +extern u8 str_2char2num(u8 hch, u8 lch); -+extern void macstr2num(u8 *dst, u8 *src); +extern u8 convert_ip_addr(u8 hch, u8 mch, u8 lch); + -+u32 rtw_rates[] = {1000000,2000000,5500000,11000000, ++static u32 rtw_rates[] = {1000000,2000000,5500000,11000000, + 6000000,9000000,12000000,18000000,24000000,36000000,48000000,54000000}; + -+static const char * const iw_operation_mode[] = -+{ -+ "Auto", "Ad-Hoc", "Managed", "Master", "Repeater", "Secondary", "Monitor" ++static const char * const iw_operation_mode[] = ++{ ++ "Auto", "Ad-Hoc", "Managed", "Master", "Repeater", "Secondary", "Monitor" +}; + +static int hex2num_i(char c) @@ -350745,11 +161435,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + return; + + _rtw_memcpy(buff, msg, strlen(msg)); -+ ++ + _rtw_memset(&wrqu,0,sizeof(wrqu)); + wrqu.data.length = strlen(msg); + -+ DBG_871X("%s %s\n", __FUNCTION__, buff); ++ DBG_871X("%s %s\n", __FUNCTION__, buff); +#ifndef CONFIG_IOCTL_CFG80211 + wireless_send_event(padapter->pnetdev, IWEVCUSTOM, &wrqu, buff); +#endif @@ -350768,21 +161458,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + buff = rtw_malloc(IW_CUSTOM_MAX); + if(!buff) + return; -+ ++ + _rtw_memset(buff, 0, IW_CUSTOM_MAX); -+ ++ + p=buff; -+ ++ + p+=sprintf(p, "WPS_PBC_START.request=TRUE"); -+ ++ + _rtw_memset(&wrqu,0,sizeof(wrqu)); -+ ++ + wrqu.data.length = p-buff; -+ ++ + wrqu.data.length = (wrqu.data.lengthpnetdev, IWEVCUSTOM, &wrqu, buff); +#endif @@ -350794,17 +161484,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + +} + -+#ifdef CONFIG_SUPPORT_HW_WPS_PBC +void rtw_request_wps_pbc_event(_adapter *padapter) +{ -+#ifdef RTK_DMP_PLATFORM -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,12)) -+ kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_NET_PBC); -+#else -+ kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_NET_PBC); -+#endif -+#else -+ + if ( padapter->pid[0] == 0 ) + { // 0 is the default value and it means the application monitors the HW PBC doesn't privde its pid to driver. + return; @@ -350812,16 +161493,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + rtw_signal_process(padapter->pid[0], SIGUSR1); + -+#endif -+ + rtw_led_control(padapter, LED_CTL_START_WPS_BOTTON); +} -+#endif//#ifdef CONFIG_SUPPORT_HW_WPS_PBC + +void indicate_wx_scan_complete_event(_adapter *padapter) -+{ ++{ + union iwreq_data wrqu; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + + _rtw_memset(&wrqu, 0, sizeof(union iwreq_data)); + @@ -350831,24 +161509,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#endif +} + -+ +void rtw_indicate_wx_assoc_event(_adapter *padapter) -+{ ++{ + union iwreq_data wrqu; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX*)(&(pmlmeinfo->network)); + + _rtw_memset(&wrqu, 0, sizeof(union iwreq_data)); -+ -+ wrqu.ap_addr.sa_family = ARPHRD_ETHER; -+ -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)==_TRUE ) -+ _rtw_memcpy(wrqu.ap_addr.sa_data, pnetwork->MacAddress, ETH_ALEN); -+ else -+ _rtw_memcpy(wrqu.ap_addr.sa_data, pmlmepriv->cur_network.network.MacAddress, ETH_ALEN); + ++ wrqu.ap_addr.sa_family = ARPHRD_ETHER; ++ ++ _rtw_memcpy(wrqu.ap_addr.sa_data, pmlmepriv->cur_network.network.MacAddress, ETH_ALEN); ++ DBG_871X("BSSID:" MAC_FMT "\n", MAC_ARG(pmlmepriv->cur_network.network.MacAddress)); + DBG_871X_LEVEL(_drv_always_, "assoc success\n"); +#ifndef CONFIG_IOCTL_CFG80211 + wireless_send_event(padapter->pnetdev, SIOCGIWAP, &wrqu, NULL); @@ -350856,7 +161527,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +} + +void rtw_indicate_wx_disassoc_event(_adapter *padapter) -+{ ++{ + union iwreq_data wrqu; + + _rtw_memset(&wrqu, 0, sizeof(union iwreq_data)); @@ -350872,18 +161543,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + +/* +uint rtw_is_cckrates_included(u8 *rate) -+{ -+ u32 i = 0; ++{ ++ u32 i = 0; + + while(rate[i]!=0) -+ { -+ if ( (((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || -+ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22) ) -+ return _TRUE; ++ { ++ if ( (((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || ++ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22) ) ++ return true; + i++; + } -+ -+ return _FALSE; ++ ++ return false; +} + +uint rtw_is_cckratesonly_included(u8 *rate) @@ -350894,33 +161565,49 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + if ( (((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && + (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22) ) -+ return _FALSE; ++ return false; + i++; + } -+ -+ return _TRUE; ++ ++ return true; +} +*/ + -+static int search_p2p_wfd_ie(_adapter *padapter, ++static char *translate_scan(_adapter *padapter, + struct iw_request_info* info, struct wlan_network *pnetwork, + char *start, char *stop) +{ ++ struct iw_event iwe; ++ u16 cap; ++ __le16 le_tmp; ++ u32 ht_ielen = 0, vht_ielen = 0; ++ char custom[MAX_CUSTOM_LEN]; ++ char *p; ++ u16 max_rate=0, rate, ht_cap=false, vht_cap = false; ++ u32 i = 0; ++ char *current_val; ++ long rssi; ++ u8 bw_40MHz=0, short_GI=0, bw_160MHz=0, vht_highest_rate = 0; ++ u16 mcs_rate=0, vht_data_rate=0; ++ struct registry_priv *pregpriv = &padapter->registrypriv; +#ifdef CONFIG_P2P + struct wifidirect_info *pwdinfo = &padapter->wdinfo; ++#endif //CONFIG_P2P ++ ++#ifdef CONFIG_P2P +#ifdef CONFIG_WFD + if ( SCAN_RESULT_ALL == pwdinfo->wfd_info->scan_result_type ) + { + + } -+ else if ( ( SCAN_RESULT_P2P_ONLY == pwdinfo->wfd_info->scan_result_type ) || ++ else if ( ( SCAN_RESULT_P2P_ONLY == pwdinfo->wfd_info->scan_result_type ) || + ( SCAN_RESULT_WFD_TYPE == pwdinfo->wfd_info->scan_result_type ) ) +#endif // CONFIG_WFD + { + if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) + { -+ u32 blnGotP2PIE = _FALSE; -+ ++ u32 blnGotP2PIE = false; ++ + // User is doing the P2P device discovery + // The prefix of SSID should be "DIRECT-" and the IE should contains the P2P IE. + // If not, the driver should ignore this AP and go to the next AP. @@ -350931,32 +161618,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + u32 p2pielen = 0; + + // Verifying the P2P IE -+ if (rtw_get_p2p_ie_from_scan_queue(&pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &p2pielen, pnetwork->network.Reserved[0])) ++ if ( rtw_get_p2p_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen) ) + { -+ blnGotP2PIE = _TRUE; ++ blnGotP2PIE = true; + } + } + -+ if ( blnGotP2PIE == _FALSE ) ++ if ( blnGotP2PIE == false ) + { -+ return _FALSE; ++ return start; + } -+ ++ + } + } + +#ifdef CONFIG_WFD + if ( SCAN_RESULT_WFD_TYPE == pwdinfo->wfd_info->scan_result_type ) + { -+ u32 blnGotWFD = _FALSE; ++ u32 blnGotWFD = false; + u8 wfd_ie[ 128 ] = { 0x00 }; + uint wfd_ielen = 0; -+ -+ if ( rtw_get_wfd_ie_from_scan_queue( &pnetwork->network.IEs[0], pnetwork->network.IELength, wfd_ie, &wfd_ielen, pnetwork->network.Reserved[0]) ) ++ ++ if ( rtw_get_wfd_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, wfd_ie, &wfd_ielen ) ) + { + u8 wfd_devinfo[ 6 ] = { 0x00 }; + uint wfd_devlen = 6; -+ ++ + if ( rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, wfd_devinfo, &wfd_devlen) ) + { + if ( pwdinfo->wfd_info->wfd_device_type == WFD_DEVINFO_PSINK ) @@ -350965,7 +161652,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if ( ( wfd_devinfo[ 1 ] & 0x03 ) == WFD_DEVINFO_SOURCE ) + { + // If this device is Miracast PSink device, the scan reuslt should just provide the Miracast source. -+ blnGotWFD = _TRUE; ++ blnGotWFD = true; + } + } + else if ( pwdinfo->wfd_info->wfd_device_type == WFD_DEVINFO_SOURCE ) @@ -350975,555 +161662,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + // If this device is Miracast source device, the scan reuslt should just provide the Miracast PSink. + // Todo: How about the SSink?! -+ blnGotWFD = _TRUE; ++ blnGotWFD = true; + } + } + } + } -+ -+ if ( blnGotWFD == _FALSE ) ++ ++ if ( blnGotWFD == false ) + { -+ return _FALSE; ++ return start; + } + } +#endif // CONFIG_WFD + +#endif //CONFIG_P2P -+ return _TRUE; -+} -+ static inline char *iwe_stream_mac_addr_proess(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop,struct iw_event *iwe) -+{ -+ /* AP MAC address */ -+ iwe->cmd = SIOCGIWAP; -+ iwe->u.ap_addr.sa_family = ARPHRD_ETHER; -+ -+ _rtw_memcpy(iwe->u.ap_addr.sa_data, pnetwork->network.MacAddress, ETH_ALEN); -+ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_ADDR_LEN); -+ return start; -+} -+ static inline char * iwe_stream_essid_proess(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop,struct iw_event *iwe) -+{ -+ -+ /* Add the ESSID */ -+ iwe->cmd = SIOCGIWESSID; -+ iwe->u.data.flags = 1; -+ iwe->u.data.length = min((u16)pnetwork->network.Ssid.SsidLength, (u16)32); -+ start = iwe_stream_add_point(info, start, stop, iwe, pnetwork->network.Ssid.Ssid); -+ return start; -+} -+ -+ static inline char * iwe_stream_chan_process(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop,struct iw_event *iwe) -+{ -+ if(pnetwork->network.Configuration.DSConfig<1 /*|| pnetwork->network.Configuration.DSConfig>14*/) -+ pnetwork->network.Configuration.DSConfig = 1; -+ -+ /* Add frequency/channel */ -+ iwe->cmd = SIOCGIWFREQ; -+ iwe->u.freq.m = rtw_ch2freq(pnetwork->network.Configuration.DSConfig) * 100000; -+ iwe->u.freq.e = 1; -+ iwe->u.freq.i = pnetwork->network.Configuration.DSConfig; -+ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_FREQ_LEN); -+ return start; -+} -+ static inline char * iwe_stream_mode_process(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop,struct iw_event *iwe,u16 cap) -+{ -+ /* Add mode */ -+ if(cap & (WLAN_CAPABILITY_IBSS |WLAN_CAPABILITY_BSS)){ -+ iwe->cmd = SIOCGIWMODE; -+ if (cap & WLAN_CAPABILITY_BSS) -+ iwe->u.mode = IW_MODE_MASTER; -+ else -+ iwe->u.mode = IW_MODE_ADHOC; -+ -+ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_UINT_LEN); -+ } -+ return start; -+ } -+ static inline char * iwe_stream_encryption_process(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop,struct iw_event *iwe,u16 cap) -+{ -+ -+ /* Add encryption capability */ -+ iwe->cmd = SIOCGIWENCODE; -+ if (cap & WLAN_CAPABILITY_PRIVACY) -+ iwe->u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; -+ else -+ iwe->u.data.flags = IW_ENCODE_DISABLED; -+ iwe->u.data.length = 0; -+ start = iwe_stream_add_point(info, start, stop, iwe, pnetwork->network.Ssid.Ssid); -+ return start; -+ -+} -+ -+ static inline char * iwe_stream_protocol_process(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop,struct iw_event *iwe) -+ { -+ u16 ht_cap=_FALSE,vht_cap = _FALSE; -+ u32 ht_ielen = 0, vht_ielen = 0; -+ char *p; -+ u8 ie_offset = (pnetwork->network.Reserved[0] == 2? 0:12);// Probe Request -+ -+ //parsing HT_CAP_IE -+ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength-ie_offset); -+ if(p && ht_ielen>0) -+ ht_cap = _TRUE; -+ -+ #ifdef CONFIG_80211AC_VHT -+ //parsing VHT_CAP_IE -+ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength-ie_offset); -+ if(p && vht_ielen>0) -+ vht_cap = _TRUE; -+ #endif -+ /* Add the protocol name */ -+ iwe->cmd = SIOCGIWNAME; -+ if ((rtw_is_cckratesonly_included((u8*)&pnetwork->network.SupportedRates)) == _TRUE) -+ { -+ if(ht_cap == _TRUE) -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11bn"); -+ else -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11b"); -+ } -+ else if ((rtw_is_cckrates_included((u8*)&pnetwork->network.SupportedRates)) == _TRUE) -+ { -+ if(ht_cap == _TRUE) -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11bgn"); -+ else -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11bg"); -+ } -+ else -+ { -+ if(pnetwork->network.Configuration.DSConfig > 14) -+ { -+ #ifdef CONFIG_80211AC_VHT -+ if(vht_cap == _TRUE){ -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11AC"); -+ } -+ else -+ #endif -+ { -+ if(ht_cap == _TRUE) -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11an"); -+ else -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11a"); -+ } -+ } -+ else -+ { -+ if(ht_cap == _TRUE) -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11gn"); -+ else -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11g"); -+ } -+ } -+ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_CHAR_LEN); -+ return start; -+ } -+ -+ static inline char * iwe_stream_rate_process(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop,struct iw_event *iwe) -+{ -+ u32 ht_ielen = 0, vht_ielen = 0; -+ char *p; -+ u16 max_rate=0, rate, ht_cap=_FALSE, vht_cap = _FALSE; -+ u32 i = 0; -+ u8 bw_40MHz=0, short_GI=0, bw_160MHz=0, vht_highest_rate = 0; -+ u16 mcs_rate=0, vht_data_rate=0; -+ char custom[MAX_CUSTOM_LEN]={0}; -+ u8 ie_offset = (pnetwork->network.Reserved[0] == 2? 0:12);// Probe Request -+ -+ //parsing HT_CAP_IE -+ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength-ie_offset); -+ if(p && ht_ielen>0) -+ { -+ struct rtw_ieee80211_ht_cap *pht_capie; -+ ht_cap = _TRUE; -+ pht_capie = (struct rtw_ieee80211_ht_cap *)(p+2); -+ _rtw_memcpy(&mcs_rate , pht_capie->supp_mcs_set, 2); -+ bw_40MHz = (pht_capie->cap_info&IEEE80211_HT_CAP_SUP_WIDTH) ? 1:0; -+ short_GI = (pht_capie->cap_info&(IEEE80211_HT_CAP_SGI_20|IEEE80211_HT_CAP_SGI_40)) ? 1:0; -+ } -+ -+#ifdef CONFIG_80211AC_VHT -+ //parsing VHT_CAP_IE -+ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength-ie_offset); -+ if(p && vht_ielen>0) -+ { -+ u8 mcs_map[2]; -+ -+ vht_cap = _TRUE; -+ bw_160MHz = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p+2); -+ if(bw_160MHz) -+ short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI160M(p+2); -+ else -+ short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI80M(p+2); -+ -+ _rtw_memcpy(mcs_map, GET_VHT_CAPABILITY_ELE_TX_MCS(p+2), 2); -+ -+ vht_highest_rate = rtw_get_vht_highest_rate(mcs_map); -+ vht_data_rate = rtw_vht_mcs_to_data_rate(CHANNEL_WIDTH_80, short_GI, vht_highest_rate); -+ } -+#endif -+ -+ /*Add basic and extended rates */ -+ p = custom; -+ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): "); -+ while(pnetwork->network.SupportedRates[i]!=0) -+ { -+ rate = pnetwork->network.SupportedRates[i]&0x7F; -+ if (rate > max_rate) -+ max_rate = rate; -+ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), -+ "%d%s ", rate >> 1, (rate & 1) ? ".5" : ""); -+ i++; -+ } -+#ifdef CONFIG_80211AC_VHT -+ if(vht_cap == _TRUE) { -+ max_rate = vht_data_rate; -+ } -+ else -+#endif -+ if(ht_cap == _TRUE) -+ { -+ if(mcs_rate&0x8000)//MCS15 -+ { -+ max_rate = (bw_40MHz) ? ((short_GI)?300:270):((short_GI)?144:130); -+ -+ } -+ else if(mcs_rate&0x0080)//MCS7 -+ { -+ max_rate = (bw_40MHz) ? ((short_GI)?150:135):((short_GI)?72:65); -+ } -+ else//default MCS7 -+ { -+ //DBG_871X("wx_get_scan, mcs_rate_bitmap=0x%x\n", mcs_rate); -+ max_rate = (bw_40MHz) ? ((short_GI)?150:135):((short_GI)?72:65); -+ } -+ -+ max_rate = max_rate*2;//Mbps/2; -+ } -+ -+ iwe->cmd = SIOCGIWRATE; -+ iwe->u.bitrate.fixed = iwe->u.bitrate.disabled = 0; -+ iwe->u.bitrate.value = max_rate * 500000; -+ start =iwe_stream_add_event(info, start, stop, iwe, IW_EV_PARAM_LEN); -+ return start ; -+} -+ -+static inline char * iwe_stream_wpa_wpa2_process(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop,struct iw_event *iwe) -+{ -+ int buf_size = MAX_WPA_IE_LEN*2; -+ //u8 pbuf[buf_size]={0}; -+ u8 *pbuf = rtw_zmalloc(buf_size); -+ -+ u8 wpa_ie[255]={0},rsn_ie[255]={0}; -+ u16 i, wpa_len=0,rsn_len=0; -+ u8 *p; -+ sint out_len=0; -+ -+ -+ if(pbuf){ -+ p=pbuf; -+ -+ //parsing WPA/WPA2 IE -+ if (pnetwork->network.Reserved[0] != 2) // Probe Request -+ { -+ out_len=rtw_get_sec_ie(pnetwork->network.IEs ,pnetwork->network.IELength,rsn_ie,&rsn_len,wpa_ie,&wpa_len); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_scan: ssid=%s\n",pnetwork->network.Ssid.Ssid)); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_scan: wpa_len=%d rsn_len=%d\n",wpa_len,rsn_len)); -+ -+ if (wpa_len > 0){ -+ -+ _rtw_memset(pbuf, 0, buf_size); -+ p += sprintf(p, "wpa_ie="); -+ for (i = 0; i < wpa_len; i++) { -+ p += sprintf(p, "%02x", wpa_ie[i]); -+ } -+ -+ if (wpa_len > 100) { -+ printk("-----------------Len %d----------------\n", wpa_len); -+ for (i = 0; i < wpa_len; i++) { -+ printk("%02x ", wpa_ie[i]); -+ } -+ printk("\n"); -+ printk("-----------------Len %d----------------\n", wpa_len); -+ } -+ -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd = IWEVCUSTOM; -+ iwe->u.data.length = strlen(pbuf); -+ start = iwe_stream_add_point(info, start, stop, iwe,pbuf); -+ -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd =IWEVGENIE; -+ iwe->u.data.length = wpa_len; -+ start = iwe_stream_add_point(info, start, stop, iwe, wpa_ie); -+ } -+ if (rsn_len > 0){ -+ -+ _rtw_memset(pbuf, 0, buf_size); -+ p += sprintf(p, "rsn_ie="); -+ for (i = 0; i < rsn_len; i++) { -+ p += sprintf(p, "%02x", rsn_ie[i]); -+ } -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd = IWEVCUSTOM; -+ iwe->u.data.length = strlen(pbuf); -+ start = iwe_stream_add_point(info, start, stop, iwe,pbuf); -+ -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd =IWEVGENIE; -+ iwe->u.data.length = rsn_len; -+ start = iwe_stream_add_point(info, start, stop, iwe, rsn_ie); -+ } -+ } -+ -+ rtw_mfree(pbuf, buf_size); -+ } -+ return start; -+} -+ -+static inline char * iwe_stream_wps_process(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop,struct iw_event *iwe) -+{ -+ //parsing WPS IE -+ uint cnt = 0,total_ielen; -+ u8 *wpsie_ptr=NULL; -+ uint wps_ielen = 0; -+ u8 ie_offset = (pnetwork->network.Reserved[0] == 2? 0:12); -+ -+ u8 *ie_ptr = pnetwork->network.IEs + ie_offset; -+ total_ielen= pnetwork->network.IELength - ie_offset; -+ -+ if (pnetwork->network.Reserved[0] == 2) // Probe Request -+ { -+ ie_ptr = pnetwork->network.IEs; -+ total_ielen = pnetwork->network.IELength; -+ } -+ else // Beacon or Probe Respones -+ { -+ ie_ptr = pnetwork->network.IEs + _FIXED_IE_LENGTH_; -+ total_ielen = pnetwork->network.IELength - _FIXED_IE_LENGTH_; -+ } -+ while(cnt < total_ielen) -+ { -+ if(rtw_is_wps_ie(&ie_ptr[cnt], &wps_ielen) && (wps_ielen>2)) -+ { -+ wpsie_ptr = &ie_ptr[cnt]; -+ iwe->cmd =IWEVGENIE; -+ iwe->u.data.length = (u16)wps_ielen; -+ start = iwe_stream_add_point(info, start, stop,iwe, wpsie_ptr); -+ } -+ cnt+=ie_ptr[cnt+1]+2; //goto next -+ } -+ return start; -+} -+ -+static inline char * iwe_stream_wapi_process(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop,struct iw_event *iwe) -+{ -+#ifdef CONFIG_WAPI_SUPPORT -+ char *p; -+ -+ if (pnetwork->network.Reserved[0] != 2) // Probe Request -+ { -+ sint out_len_wapi=0; -+ /* here use static for stack size */ -+ static u8 buf_wapi[MAX_WAPI_IE_LEN*2]={0}; -+ static u8 wapi_ie[MAX_WAPI_IE_LEN]={0}; -+ u16 wapi_len=0; -+ u16 i; -+ -+ out_len_wapi=rtw_get_wapi_ie(pnetwork->network.IEs ,pnetwork->network.IELength,wapi_ie,&wapi_len); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_scan: ssid=%s\n",pnetwork->network.Ssid.Ssid)); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_scan: wapi_len=%d \n",wapi_len)); -+ -+ DBG_871X("rtw_wx_get_scan: %s ",pnetwork->network.Ssid.Ssid); -+ DBG_871X("rtw_wx_get_scan: ssid = %d ",wapi_len); -+ -+ -+ if (wapi_len > 0) -+ { -+ p=buf_wapi; -+ //_rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN*2); -+ p += sprintf(p, "wapi_ie="); -+ for (i = 0; i < wapi_len; i++) { -+ p += sprintf(p, "%02x", wapi_ie[i]); -+ } -+ -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd = IWEVCUSTOM; -+ iwe->u.data.length = strlen(buf_wapi); -+ start = iwe_stream_add_point(info, start, stop, iwe,buf_wapi); -+ -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd =IWEVGENIE; -+ iwe->u.data.length = wapi_len; -+ start = iwe_stream_add_point(info, start, stop, iwe, wapi_ie); -+ } -+ } -+#endif//#ifdef CONFIG_WAPI_SUPPORT -+ return start; -+} -+ -+static inline char * iwe_stream_rssi_process(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop,struct iw_event *iwe) -+{ -+ u8 ss, sq; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ /* Add quality statistics */ -+ iwe->cmd = IWEVQUAL; -+ iwe->u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED -+ #if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ | IW_QUAL_NOISE_UPDATED -+ #else -+ | IW_QUAL_NOISE_INVALID -+ #endif -+ #ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ | IW_QUAL_DBM -+ #endif -+ ; -+ -+ if ( check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE && -+ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)){ -+ ss = padapter->recvpriv.signal_strength; -+ sq = padapter->recvpriv.signal_qual; -+ } else { -+ ss = pnetwork->network.PhyInfo.SignalStrength; -+ sq = pnetwork->network.PhyInfo.SignalQuality; -+ } -+ -+ -+ #ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ iwe->u.qual.level = (u8) translate_percentage_to_dbm(ss); /* dbm */ -+ #else -+ #ifdef CONFIG_SIGNAL_SCALE_MAPPING -+ iwe->u.qual.level = (u8)ss; /* % */ -+ #else -+ { -+ /* Do signal scale mapping when using percentage as the unit of signal strength, since the scale mapping is skipped in odm */ -+ -+ HAL_DATA_TYPE *pHal = GET_HAL_DATA(padapter); -+ -+ iwe->u.qual.level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, ss); -+ } -+ #endif -+ #endif -+ -+ iwe->u.qual.qual = (u8)sq; // signal quality -+ -+ #ifdef CONFIG_PLATFORM_ROCKCHIPS -+ iwe->u.qual.noise = -100; // noise level suggest by zhf@rockchips -+ #else -+ #if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ { -+ s16 tmp_noise=0; -+ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR,&(pnetwork->network.Configuration.DSConfig), &(tmp_noise)); -+ iwe->u.qual.noise = tmp_noise ; -+ } -+ #else -+ iwe->u.qual.noise = 0; // noise level -+ #endif -+ #endif //CONFIG_PLATFORM_ROCKCHIPS -+ -+ //DBG_871X("iqual=%d, ilevel=%d, inoise=%d, iupdated=%d\n", iwe.u.qual.qual, iwe.u.qual.level , iwe.u.qual.noise, iwe.u.qual.updated); -+ -+ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_QUAL_LEN); -+ return start; -+} -+ -+static inline char * iwe_stream_net_rsv_process(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop,struct iw_event *iwe) -+{ -+ u8 buf[32] = {0}; -+ u8 * p,*pos; -+ int len; -+ p = buf; -+ pos = pnetwork->network.Reserved; -+ -+ p += sprintf(p, "fm=%02X%02X", pos[1], pos[0]); -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd = IWEVCUSTOM; -+ iwe->u.data.length = strlen(buf); -+ start = iwe_stream_add_point(info, start, stop,iwe, buf); -+ return start; -+} -+ -+#if 1 -+static char *translate_scan(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop) -+{ -+ struct iw_event iwe; -+ u16 cap = 0; -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ -+ if(_FALSE == search_p2p_wfd_ie(padapter,info,pnetwork,start,stop)) -+ return start; -+ -+ start = iwe_stream_mac_addr_proess(padapter,info,pnetwork,start,stop,&iwe); -+ start = iwe_stream_essid_proess(padapter,info,pnetwork,start,stop,&iwe); -+ start = iwe_stream_protocol_process(padapter,info,pnetwork,start,stop,&iwe); -+ if (pnetwork->network.Reserved[0] == 2) // Probe Request -+ { -+ cap = 0; -+ } -+ else -+ { -+ _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); -+ cap = le16_to_cpu(cap); -+ } -+ -+ start = iwe_stream_mode_process(padapter,info,pnetwork,start,stop,&iwe,cap); -+ start = iwe_stream_chan_process(padapter,info,pnetwork,start,stop,&iwe); -+ start = iwe_stream_encryption_process(padapter,info,pnetwork,start,stop,&iwe,cap); -+ start = iwe_stream_rate_process(padapter,info,pnetwork,start,stop,&iwe); -+ start = iwe_stream_wpa_wpa2_process(padapter,info,pnetwork,start,stop,&iwe); -+ start = iwe_stream_wps_process(padapter,info,pnetwork,start,stop,&iwe); -+ start = iwe_stream_wapi_process(padapter,info,pnetwork,start,stop,&iwe); -+ start = iwe_stream_rssi_process(padapter,info,pnetwork,start,stop,&iwe); -+ start = iwe_stream_net_rsv_process(padapter,info,pnetwork,start,stop,&iwe); -+ -+ return start; -+} -+#else -+static char *translate_scan(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop) -+{ -+ struct iw_event iwe; -+ u16 cap; -+ u32 ht_ielen = 0, vht_ielen = 0; -+ char custom[MAX_CUSTOM_LEN]; -+ char *p; -+ u16 max_rate=0, rate, ht_cap=_FALSE, vht_cap = _FALSE; -+ u32 i = 0; -+ char *current_val; -+ long rssi; -+ u8 bw_40MHz=0, short_GI=0, bw_160MHz=0, vht_highest_rate = 0; -+ u16 mcs_rate=0, vht_data_rate=0; -+ u8 ie_offset = (pnetwork->network.Reserved[0] == 2? 0:12); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ if(_FALSE == search_p2p_wfd_ie(padapter,info,pnetwork,start,stop)) -+ return start; + + /* AP MAC address */ + iwe.cmd = SIOCGIWAP; @@ -351531,40 +161683,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + _rtw_memcpy(iwe.u.ap_addr.sa_data, pnetwork->network.MacAddress, ETH_ALEN); + start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_ADDR_LEN); -+ ++ + /* Add the ESSID */ + iwe.cmd = SIOCGIWESSID; -+ iwe.u.data.flags = 1; ++ iwe.u.data.flags = 1; + iwe.u.data.length = min((u16)pnetwork->network.Ssid.SsidLength, (u16)32); + start = iwe_stream_add_point(info, start, stop, &iwe, pnetwork->network.Ssid.Ssid); + + //parsing HT_CAP_IE -+ if (pnetwork->network.Reserved[0] == 2) // Probe Request -+ { -+ p = rtw_get_ie(&pnetwork->network.IEs[0], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength); -+ } -+ else -+ { -+ p = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength-12); -+ } ++ p = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength-12); ++ + if(p && ht_ielen>0) + { + struct rtw_ieee80211_ht_cap *pht_capie; -+ ht_cap = _TRUE; -+ pht_capie = (struct rtw_ieee80211_ht_cap *)(p+2); ++ ht_cap = true; ++ pht_capie = (struct rtw_ieee80211_ht_cap *)(p+2); + _rtw_memcpy(&mcs_rate , pht_capie->supp_mcs_set, 2); -+ bw_40MHz = (pht_capie->cap_info&IEEE80211_HT_CAP_SUP_WIDTH) ? 1:0; -+ short_GI = (pht_capie->cap_info&(IEEE80211_HT_CAP_SGI_20|IEEE80211_HT_CAP_SGI_40)) ? 1:0; ++ bw_40MHz = (le16_to_cpu(pht_capie->cap_info)&IEEE80211_HT_CAP_SUP_WIDTH) ? 1:0; ++ short_GI = (le16_to_cpu(pht_capie->cap_info)&(IEEE80211_HT_CAP_SGI_20|IEEE80211_HT_CAP_SGI_40)) ? 1:0; + } + +#ifdef CONFIG_80211AC_VHT + //parsing VHT_CAP_IE -+ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength-ie_offset); ++ p = rtw_get_ie(&pnetwork->network.IEs[12], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength-12); + if(p && vht_ielen>0) + { + u8 mcs_map[2]; + -+ vht_cap = _TRUE; ++ vht_cap = true; + bw_160MHz = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p+2); + if(bw_160MHz) + short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI160M(p+2); @@ -351573,60 +161719,55 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + _rtw_memcpy(mcs_map, GET_VHT_CAPABILITY_ELE_TX_MCS(p+2), 2); + -+ vht_highest_rate = rtw_get_vht_highest_rate(mcs_map); -+ vht_data_rate = rtw_vht_mcs_to_data_rate(CHANNEL_WIDTH_80, short_GI, vht_highest_rate); ++ vht_highest_rate = rtw_get_vht_highest_rate(padapter, mcs_map); ++ vht_data_rate = rtw_vht_data_rate(CHANNEL_WIDTH_80, short_GI, vht_highest_rate); + } +#endif + + /* Add the protocol name */ + iwe.cmd = SIOCGIWNAME; -+ if ((rtw_is_cckratesonly_included((u8*)&pnetwork->network.SupportedRates)) == _TRUE) ++ if ((rtw_is_cckratesonly_included((u8*)&pnetwork->network.SupportedRates)) == true) + { -+ if(ht_cap == _TRUE) ++ if(ht_cap == true) + snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bn"); + else + snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11b"); -+ } -+ else if ((rtw_is_cckrates_included((u8*)&pnetwork->network.SupportedRates)) == _TRUE) ++ } ++ else if ((rtw_is_cckrates_included((u8*)&pnetwork->network.SupportedRates)) == true) + { -+ if(ht_cap == _TRUE) ++ if(ht_cap == true) + snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bgn"); + else + snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bg"); -+ } ++ } + else + { + if(pnetwork->network.Configuration.DSConfig > 14) + { -+ if(vht_cap == _TRUE) ++ if(vht_cap == true) + snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11AC"); -+ else if(ht_cap == _TRUE) ++ else if(ht_cap == true) + snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11an"); + else + snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11a"); + } + else + { -+ if(ht_cap == _TRUE) ++ if(ht_cap == true) + snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11gn"); + else + snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11g"); + } -+ } ++ } + + start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_CHAR_LEN); + + /* Add mode */ -+ if (pnetwork->network.Reserved[0] == 2) // Probe Request -+ { -+ cap = 0; -+ } -+ else -+ { + iwe.cmd = SIOCGIWMODE; -+ _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); -+ cap = le16_to_cpu(cap); -+ } ++ _rtw_memcpy(&le_tmp, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); ++ ++ ++ cap = le16_to_cpu(le_tmp); + + if(cap & (WLAN_CAPABILITY_IBSS |WLAN_CAPABILITY_BSS)){ + if (cap & WLAN_CAPABILITY_BSS) @@ -351662,7 +161803,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): "); + while(pnetwork->network.SupportedRates[i]!=0) + { -+ rate = pnetwork->network.SupportedRates[i]&0x7F; ++ rate = pnetwork->network.SupportedRates[i]&0x7F; + if (rate > max_rate) + max_rate = rate; + p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), @@ -351670,15 +161811,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + i++; + } + -+ if(vht_cap == _TRUE) { ++ if(vht_cap == true) { + max_rate = vht_data_rate; + } -+ else if(ht_cap == _TRUE) ++ else if(ht_cap == true) + { + if(mcs_rate&0x8000)//MCS15 + { + max_rate = (bw_40MHz) ? ((short_GI)?300:270):((short_GI)?144:130); -+ ++ + } + else if(mcs_rate&0x0080)//MCS7 + { @@ -351690,7 +161831,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + max_rate = (bw_40MHz) ? ((short_GI)?150:135):((short_GI)?72:65); + } + -+ max_rate = max_rate*2;//Mbps/2; ++ max_rate = max_rate*2;//Mbps/2; + } + + iwe.cmd = SIOCGIWRATE; @@ -351699,9 +161840,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_PARAM_LEN); + + //parsing WPA/WPA2 IE -+ if (pnetwork->network.Reserved[0] != 2) // Probe Request + { -+ u8 buf[MAX_WPA_IE_LEN*2]; ++ u8 buf[MAX_WPA_IE_LEN]; + u8 wpa_ie[255],rsn_ie[255]; + u16 wpa_len=0,rsn_len=0; + u8 *p; @@ -351713,35 +161853,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if (wpa_len > 0) + { + p=buf; -+ _rtw_memset(buf, 0, MAX_WPA_IE_LEN*2); ++ _rtw_memset(buf, 0, MAX_WPA_IE_LEN); + p += sprintf(p, "wpa_ie="); + for (i = 0; i < wpa_len; i++) { + p += sprintf(p, "%02x", wpa_ie[i]); + } + -+ if (wpa_len > 100) { -+ printk("-----------------Len %d----------------\n", wpa_len); -+ for (i = 0; i < wpa_len; i++) { -+ printk("%02x ", wpa_ie[i]); -+ } -+ printk("\n"); -+ printk("-----------------Len %d----------------\n", wpa_len); -+ } -+ + _rtw_memset(&iwe, 0, sizeof(iwe)); + iwe.cmd = IWEVCUSTOM; + iwe.u.data.length = strlen(buf); + start = iwe_stream_add_point(info, start, stop, &iwe,buf); -+ ++ + _rtw_memset(&iwe, 0, sizeof(iwe)); + iwe.cmd =IWEVGENIE; + iwe.u.data.length = wpa_len; -+ start = iwe_stream_add_point(info, start, stop, &iwe, wpa_ie); ++ start = iwe_stream_add_point(info, start, stop, &iwe, wpa_ie); + } + if (rsn_len > 0) + { + p = buf; -+ _rtw_memset(buf, 0, MAX_WPA_IE_LEN*2); ++ _rtw_memset(buf, 0, MAX_WPA_IE_LEN); + p += sprintf(p, "rsn_ie="); + for (i = 0; i < rsn_len; i++) { + p += sprintf(p, "%02x", rsn_ie[i]); @@ -351750,52 +161881,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + iwe.cmd = IWEVCUSTOM; + iwe.u.data.length = strlen(buf); + start = iwe_stream_add_point(info, start, stop, &iwe,buf); -+ ++ + _rtw_memset(&iwe, 0, sizeof(iwe)); + iwe.cmd =IWEVGENIE; + iwe.u.data.length = rsn_len; -+ start = iwe_stream_add_point(info, start, stop, &iwe, rsn_ie); ++ start = iwe_stream_add_point(info, start, stop, &iwe, rsn_ie); + } + } + + { //parsing WPS IE -+ uint cnt = 0,total_ielen; ++ uint cnt = 0,total_ielen; + u8 *wpsie_ptr=NULL; -+ uint wps_ielen = 0; ++ uint wps_ielen = 0; + -+ u8 *ie_ptr = pnetwork->network.IEs + ie_offset; -+ total_ielen= pnetwork->network.IELength - ie_offset; ++ u8 *ie_ptr = pnetwork->network.IEs +_FIXED_IE_LENGTH_; ++ total_ielen= pnetwork->network.IELength - _FIXED_IE_LENGTH_; + -+ if (pnetwork->network.Reserved[0] == 2) // Probe Request -+ { -+ ie_ptr = pnetwork->network.IEs; -+ total_ielen = pnetwork->network.IELength; -+ } -+ else // Beacon or Probe Respones -+ { -+ ie_ptr = pnetwork->network.IEs + _FIXED_IE_LENGTH_; -+ total_ielen = pnetwork->network.IELength - _FIXED_IE_LENGTH_; -+ } -+ + while(cnt < total_ielen) + { -+ if(rtw_is_wps_ie(&ie_ptr[cnt], &wps_ielen) && (wps_ielen>2)) ++ if(rtw_is_wps_ie(&ie_ptr[cnt], &wps_ielen) && (wps_ielen>2)) + { + wpsie_ptr = &ie_ptr[cnt]; + iwe.cmd =IWEVGENIE; + iwe.u.data.length = (u16)wps_ielen; -+ start = iwe_stream_add_point(info, start, stop, &iwe, wpsie_ptr); -+ } ++ start = iwe_stream_add_point(info, start, stop, &iwe, wpsie_ptr); ++ } + cnt+=ie_ptr[cnt+1]+2; //goto next + } + } + +#ifdef CONFIG_WAPI_SUPPORT -+ if (pnetwork->network.Reserved[0] != 2) // Probe Request + { + sint out_len_wapi=0; + /* here use static for stack size */ -+ static u8 buf_wapi[MAX_WAPI_IE_LEN*2]; ++ static u8 buf_wapi[MAX_WAPI_IE_LEN]; + static u8 wapi_ie[MAX_WAPI_IE_LEN]; + u16 wapi_len=0; + u16 i; @@ -351814,7 +161933,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if (wapi_len > 0) + { + p=buf_wapi; -+ _rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN*2); ++ _rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN); + p += sprintf(p, "wapi_ie="); + for (i = 0; i < wapi_len; i++) { + p += sprintf(p, "%02x", wapi_ie[i]); @@ -351836,87 +161955,48 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +{ + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + u8 ss, sq; -+ ++ + /* Add quality statistics */ + iwe.cmd = IWEVQUAL; -+ iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED -+ #if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ | IW_QUAL_NOISE_UPDATED -+ #else -+ | IW_QUAL_NOISE_INVALID -+ #endif ++ iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED | IW_QUAL_NOISE_INVALID + #ifdef CONFIG_SIGNAL_DISPLAY_DBM + | IW_QUAL_DBM + #endif + ; + -+ if ( check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE && -+ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)){ ++ if ( check_fwstate(pmlmepriv, _FW_LINKED)== true && ++ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network)) { + ss = padapter->recvpriv.signal_strength; + sq = padapter->recvpriv.signal_qual; + } else { + ss = pnetwork->network.PhyInfo.SignalStrength; + sq = pnetwork->network.PhyInfo.SignalQuality; + } -+ -+ ++ ++ + #ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ iwe.u.qual.level = (u8) translate_percentage_to_dbm(ss); /* dbm */ ++ iwe.u.qual.level = (u8) translate_percentage_to_dbm(ss);//dbm + #else -+ #ifdef CONFIG_SIGNAL_SCALE_MAPPING -+ iwe.u.qual.level = (u8)ss; /* % */ -+ #else -+ { -+ /* Do signal scale mapping when using percentage as the unit of signal strength, since the scale mapping is skipped in odm */ -+ -+ HAL_DATA_TYPE *pHal = GET_HAL_DATA(padapter); -+ -+ iwe.u.qual.level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, ss); -+ } ++ iwe.u.qual.level = (u8)ss;//% ++ #ifdef CONFIG_BT_COEXIST ++ BT_SignalCompensation(padapter, &iwe.u.qual.level, NULL); ++ #endif // CONFIG_BT_COEXIST + #endif -+ #endif -+ ++ + iwe.u.qual.qual = (u8)sq; // signal quality + -+ #ifdef CONFIG_PLATFORM_ROCKCHIPS -+ iwe.u.qual.noise = -100; // noise level suggest by zhf@rockchips -+ #else -+ #if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ { -+ s16 tmp_noise=0; -+ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR,&(pnetwork->network.Configuration.DSConfig), &(tmp_noise)); -+ iwe.u.qual.noise = tmp_noise ; -+ } -+ #else + iwe.u.qual.noise = 0; // noise level -+ #endif -+ #endif //CONFIG_PLATFORM_ROCKCHIPS -+ ++ + //DBG_871X("iqual=%d, ilevel=%d, inoise=%d, iupdated=%d\n", iwe.u.qual.qual, iwe.u.qual.level , iwe.u.qual.noise, iwe.u.qual.updated); + + start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_QUAL_LEN); +} + -+ { -+ u8 buf[MAX_WPA_IE_LEN]; -+ u8 * p,*pos; -+ int len; -+ p = buf; -+ pos = pnetwork->network.Reserved; -+ _rtw_memset(buf, 0, MAX_WPA_IE_LEN); -+ p += sprintf(p, "fm=%02X%02X", pos[1], pos[0]); -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVCUSTOM; -+ iwe.u.data.length = strlen(buf); -+ start = iwe_stream_add_point(info, start, stop, &iwe, buf); -+ } -+ -+ return start; ++ return start; +} -+#endif + +static int wpa_set_auth_algs(struct net_device *dev, u32 value) -+{ ++{ + _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); + int ret = 0; + @@ -351926,35 +162006,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; + padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch; + padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ } ++ } + else if (value & AUTH_ALG_SHARED_KEY) + { + DBG_871X("wpa_set_auth_algs, AUTH_ALG_SHARED_KEY [value:0x%x]\n",value); + padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; + -+#ifdef CONFIG_PLATFORM_MT53XX -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+#else + padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeShared; + padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; -+#endif -+ } ++ } + else if(value & AUTH_ALG_OPEN_SYSTEM) + { + DBG_871X("wpa_set_auth_algs, AUTH_ALG_OPEN_SYSTEM\n"); + //padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; + if(padapter->securitypriv.ndisauthtype < Ndis802_11AuthModeWPAPSK) + { -+#ifdef CONFIG_PLATFORM_MT53XX -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+#else + padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+#endif ++ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; + } -+ ++ + } + else if(value & AUTH_ALG_LEAP) + { @@ -351967,22 +162037,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + + return ret; -+ ++ +} + +static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) +{ + int ret = 0; + u32 wep_key_idx, wep_key_len,wep_total_len; -+ NDIS_802_11_WEP *pwep = NULL; ++ NDIS_802_11_WEP *pwep = NULL; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct security_priv *psecuritypriv = &padapter->securitypriv; +#ifdef CONFIG_P2P + struct wifidirect_info* pwdinfo = &padapter->wdinfo; +#endif //CONFIG_P2P + -+_func_enter_; ++ + + param->u.crypt.err = 0; + param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; @@ -351995,28 +162065,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && + param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) + { -+ -+ if (param->u.crypt.idx >= WEP_KEYS -+#ifdef CONFIG_IEEE80211W -+ && param->u.crypt.idx > BIP_MAX_KEYID -+#endif //CONFIG_IEEE80211W -+ ) ++ if (param->u.crypt.idx >= WEP_KEYS) + { + ret = -EINVAL; + goto exit; + } -+ } -+ else -+ { ++ } else { +#ifdef CONFIG_WAPI_SUPPORT -+ if (strcmp(param->u.crypt.alg, "SMS4")) ++ if (strcmp(param->u.crypt.alg, "SMS4")) +#endif -+ { -+ ret = -EINVAL; -+ goto exit; -+ } ++ { ++ ++ ret = -EINVAL; ++ goto exit; ++ } + } + + if (strcmp(param->u.crypt.alg, "WEP") == 0) @@ -352039,19 +162103,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("(2)wep_key_idx=%d\n", wep_key_idx)); + -+ if (wep_key_len > 0) ++ if (wep_key_len > 0) + { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; ++ wep_key_len = wep_key_len <= 5 ? 5 : 13; + wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); -+ pwep =(NDIS_802_11_WEP *) rtw_malloc(wep_total_len); ++ pwep =(NDIS_802_11_WEP *) rtw_malloc(wep_total_len); + if(pwep == NULL){ + RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,(" wpa_set_encryption: pwep allocate fail !!!\n")); + goto exit; + } + -+ _rtw_memset(pwep, 0, wep_total_len); ++ _rtw_memset(pwep, 0, wep_total_len); + -+ pwep->KeyLength = wep_key_len; ++ pwep->KeyLength = wep_key_len; + pwep->Length = wep_total_len; + + if(wep_key_len==13) @@ -352060,7 +162124,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + padapter->securitypriv.dot118021XGrpPrivacy=_WEP104_; + } + } -+ else { ++ else { + ret = -EINVAL; + goto exit; + } @@ -352082,21 +162146,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + else + { + DBG_871X("wep, set_tx=0\n"); -+ -+ //don't update "psecuritypriv->dot11PrivacyAlgrthm" and ++ ++ //don't update "psecuritypriv->dot11PrivacyAlgrthm" and + //"psecuritypriv->dot11PrivacyKeyIndex=keyid", but can rtw_set_key to fw/cam -+ ++ + if (wep_key_idx >= WEP_KEYS) { + ret = -EOPNOTSUPP ; + goto exit; -+ } -+ ++ } ++ + _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength); -+ psecuritypriv->dot11DefKeylen[wep_key_idx]=pwep->KeyLength; -+ rtw_set_key(padapter, psecuritypriv, wep_key_idx, 0, _TRUE); ++ psecuritypriv->dot11DefKeylen[wep_key_idx]=pwep->KeyLength; ++ rtw_set_key(padapter, psecuritypriv, wep_key_idx, 0); + } + -+ goto exit; ++ goto exit; + } + + if(padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) // 802_1x @@ -352104,90 +162168,63 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct sta_info * psta,*pbcmc_sta; + struct sta_priv * pstapriv = &padapter->stapriv; + -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == _TRUE) //sta mode ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == true) //sta mode + { -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); ++ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); + if (psta == NULL) { + //DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail \n")); + } + else + { + //Jeff: don't disable ieee8021x_blocked while clearing key -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ psta->ieee8021x_blocked = _FALSE; -+ ++ if (strcmp(param->u.crypt.alg, "none") != 0) ++ psta->ieee8021x_blocked = false; ++ + if((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| + (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) + { + psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } ++ } + + if(param->u.crypt.set_tx ==1)//pairwise key -+ { ++ { + _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ ++ + if(strcmp(param->u.crypt.alg, "TKIP") == 0)//set mic key -+ { ++ { + //DEBUG_ERR(("\nset key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); + _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); + _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); + -+ padapter->securitypriv.busetkipkey=_FALSE; -+ //_set_timer(&padapter->securitypriv.tkip_timer, 50); ++ padapter->securitypriv.busetkipkey=false; ++ //_set_timer(&padapter->securitypriv.tkip_timer, 50); + } + + //DEBUG_ERR((" param->u.crypt.key_len=%d\n",param->u.crypt.key_len)); + DBG_871X(" ~~~~set sta key:unicastkey\n"); -+ -+ rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _TRUE); -+ -+ psta->bpairwise_key_installed = _TRUE; -+ ++ ++ rtw_setstakey_cmd(padapter, (unsigned char *)psta, true); + } + else//group key -+ { -+ if(strcmp(param->u.crypt.alg, "TKIP") == 0 || strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key,(param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ //only TKIP group key need to install this -+ if(param->u.crypt.key_len > 16) -+ { -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[16]),8); -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[24]),8); -+ } -+ padapter->securitypriv.binstallGrpkey = _TRUE; -+ //DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); -+ DBG_871X(" ~~~~set sta key:groupkey\n"); -+ -+ padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ rtw_set_key(padapter,&padapter->securitypriv,param->u.crypt.idx, 1, _TRUE); -+ } -+#ifdef CONFIG_IEEE80211W -+ else if(strcmp(param->u.crypt.alg, "BIP") == 0) -+ { -+ int no; -+ //printk("BIP key_len=%d , index=%d @@@@@@@@@@@@@@@@@@\n", param->u.crypt.key_len, param->u.crypt.idx); -+ //save the IGTK key, length 16 bytes -+ _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key,(param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ /*printk("IGTK key below:\n"); -+ for(no=0;no<16;no++) -+ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); -+ printk("\n");*/ -+ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; -+ padapter->securitypriv.binstallBIPkey = _TRUE; -+ DBG_871X(" ~~~~set sta key:IGKT\n"); -+ } -+#endif //CONFIG_IEEE80211W -+ ++ { ++ _rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key,(param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); ++ _rtw_memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[16]),8); ++ _rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[24]),8); ++ padapter->securitypriv.binstallGrpkey = true; ++ //DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); ++ DBG_871X(" ~~~~set sta key:groupkey\n"); ++ ++ padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; ++ ++ rtw_set_key(padapter,&padapter->securitypriv,param->u.crypt.idx, 1); +#ifdef CONFIG_P2P + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) + { + rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_DONE); + } +#endif //CONFIG_P2P -+ -+ } ++ ++ } + } + + pbcmc_sta=rtw_get_bcmc_stainfo(padapter); @@ -352198,19 +162235,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + else + { + //Jeff: don't disable ieee8021x_blocked while clearing key -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ ++ if (strcmp(param->u.crypt.alg, "none") != 0) ++ pbcmc_sta->ieee8021x_blocked = false; ++ + if((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| + (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ { ++ { + pbcmc_sta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ } ++ } ++ } + } + else if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) //adhoc mode -+ { -+ } ++ { ++ } + } + +#ifdef CONFIG_WAPI_SUPPORT @@ -352220,7 +162257,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + PRT_WAPI_STA_INFO pWapiSta; + u8 WapiASUEPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; + u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; ++ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; + + if(param->u.crypt.set_tx == 1) + { @@ -352280,20 +162317,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#endif + +exit: -+ -+ if (pwep) { -+ rtw_mfree((u8 *)pwep, wep_total_len); -+ } -+ -+_func_exit_; + -+ return ret; ++ if (pwep) { ++ rtw_mfree((u8 *)pwep, wep_total_len); ++ } ++ ++ ++ ++ return ret; +} + +static int rtw_set_wpa_ie(_adapter *padapter, char *pie, unsigned short ielen) +{ -+ u8 *buf=NULL, *pos=NULL; -+ u32 left; ++ u8 *buf=NULL, *pos=NULL; ++ u32 left; + int group_cipher = 0, pairwise_cipher = 0; + int ret = 0; + u8 null_addr[]= {0,0,0,0,0,0}; @@ -352303,20 +162340,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + if((ielen > MAX_WPA_IE_LEN) || (pie == NULL)){ + _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ if(pie == NULL) ++ if(pie == NULL) + return ret; + else + return -EINVAL; + } + + if(ielen) -+ { ++ { + buf = rtw_zmalloc(ielen); + if (buf == NULL){ + ret = -ENOMEM; + goto exit; + } -+ ++ + _rtw_memcpy(buf, pie , ielen); + + //dump @@ -352326,7 +162363,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + for(i=0;i= RSN_SELECTOR_LEN){ + pos += RSN_SELECTOR_LEN; + left -= RSN_SELECTOR_LEN; -+ } ++ } + else if (left > 0){ + RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("Ie length mismatch, %u too much \n", left)); + ret =-1; + goto exit; + } -+#endif -+ ++#endif ++ + if(rtw_parse_wpa_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) + { + padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; + padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeWPAPSK; -+ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); ++ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); + } -+ ++ + if(rtw_parse_wpa2_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) + { + padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeWPA2PSK; -+ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); ++ padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeWPA2PSK; ++ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); + } -+ ++ + if (group_cipher == 0) + { + group_cipher = WPA_CIPHER_NONE; @@ -352371,7 +162408,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + pairwise_cipher = WPA_CIPHER_NONE; + } -+ ++ + switch(group_cipher) + { + case WPA_CIPHER_NONE: @@ -352390,7 +162427,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + padapter->securitypriv.dot118021XGrpPrivacy=_AES_; + padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; + break; -+ case WPA_CIPHER_WEP104: ++ case WPA_CIPHER_WEP104: + padapter->securitypriv.dot118021XGrpPrivacy=_WEP104_; + padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; + break; @@ -352414,31 +162451,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + padapter->securitypriv.dot11PrivacyAlgrthm=_AES_; + padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; + break; -+ case WPA_CIPHER_WEP104: ++ case WPA_CIPHER_WEP104: + padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_; + padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; + break; + } -+ ++ + _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ {//set wps_ie -+ u16 cnt = 0; ++ {//set wps_ie ++ u16 cnt = 0; + u8 eid, wps_oui[4]={0x0,0x50,0xf2,0x04}; -+ ++ + while( cnt < ielen ) + { + eid = buf[cnt]; -+ -+ if((eid==_VENDOR_SPECIFIC_IE_)&&(_rtw_memcmp(&buf[cnt+2], wps_oui, 4)==_TRUE)) ++ ++ if((eid==_VENDOR_SPECIFIC_IE_)&&(_rtw_memcmp(&buf[cnt+2], wps_oui, 4)==true)) + { + DBG_871X("SET WPS_IE\n"); + -+ padapter->securitypriv.wps_ie_len = ((buf[cnt+1]+2) < MAX_WPS_IE_LEN) ? (buf[cnt+1]+2):MAX_WPS_IE_LEN; ++ padapter->securitypriv.wps_ie_len = ( (buf[cnt+1]+2) < (MAX_WPA_IE_LEN<<2)) ? (buf[cnt+1]+2):(MAX_WPA_IE_LEN<<2); + + _rtw_memcpy(padapter->securitypriv.wps_ie, &buf[cnt], padapter->securitypriv.wps_ie_len); -+ ++ + set_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ ++ +#ifdef CONFIG_P2P + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_OK)) + { @@ -352446,27 +162483,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } +#endif //CONFIG_P2P + cnt += buf[cnt+1]+2; -+ ++ + break; + } else { -+ cnt += buf[cnt+1]+2; //goto next -+ } -+ } -+ } ++ cnt += buf[cnt+1]+2; //goto next ++ } ++ } ++ } + } -+ ++ + //TKIP and AES disallow multicast packets until installing group key + if(padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_ + || padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_ + || padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) + //WPS open need to enable multicast -+ //|| check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == _TRUE) ++ //|| check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == true) + rtw_hal_set_hwreg(padapter, HW_VAR_OFF_RCR_AM, null_addr); -+ ++ + RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, + ("rtw_set_wpa_ie: pairwise_cipher=0x%08x padapter->securitypriv.ndisencryptstatus=%d padapter->securitypriv.ndisauthtype=%d\n", + pairwise_cipher, padapter->securitypriv.ndisencryptstatus, padapter->securitypriv.ndisauthtype)); -+ ++ +exit: + + if (buf) rtw_mfree(buf, ielen); @@ -352474,49 +162511,49 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + return ret; +} + -+static int rtw_wx_get_name(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_get_name(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + u16 cap; + u32 ht_ielen = 0; + char *p; -+ u8 ht_cap=_FALSE, vht_cap=_FALSE; ++ u8 ht_cap=false, vht_cap=false; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; + NDIS_802_11_RATES_EX* prates = NULL; + + RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("cmd_code=%x\n", info->cmd)); + -+ _func_enter_; + -+ if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == _TRUE) ++ ++ if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) + { + //parsing HT_CAP_IE + p = rtw_get_ie(&pcur_bss->IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pcur_bss->IELength-12); + if(p && ht_ielen>0) + { -+ ht_cap = _TRUE; ++ ht_cap = true; + } + +#ifdef CONFIG_80211AC_VHT -+ if(pmlmepriv->vhtpriv.vht_option == _TRUE) -+ vht_cap = _TRUE; ++ if(pmlmepriv->vhtpriv.vht_option == true) ++ vht_cap = true; +#endif + + prates = &pcur_bss->SupportedRates; + -+ if (rtw_is_cckratesonly_included((u8*)prates) == _TRUE) ++ if (rtw_is_cckratesonly_included((u8*)prates) == true) + { -+ if(ht_cap == _TRUE) ++ if(ht_cap == true) + snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bn"); + else + snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11b"); + } -+ else if ((rtw_is_cckrates_included((u8*)prates)) == _TRUE) ++ else if ((rtw_is_cckrates_included((u8*)prates)) == true) + { -+ if(ht_cap == _TRUE) ++ if(ht_cap == true) + snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bgn"); + else + snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bg"); @@ -352525,22 +162562,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + if(pcur_bss->Configuration.DSConfig > 14) + { -+ #ifdef CONFIG_80211AC_VHT -+ if(vht_cap == _TRUE){ ++ if(vht_cap == true) + snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11AC"); -+ } ++ else if(ht_cap == true) ++ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11an"); + else -+ #endif -+ { -+ if(ht_cap == _TRUE) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11an"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11a"); -+ } ++ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11a"); + } + else + { -+ if(ht_cap == _TRUE) ++ if(ht_cap == true) + snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11gn"); + else + snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11g"); @@ -352554,74 +162585,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + snprintf(wrqu->name, IFNAMSIZ, "unassociated"); + } + -+ _func_exit_; ++ + + return 0; +} + -+static int rtw_wx_set_freq(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_set_freq(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) -+{ ++{ + -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ int exp = 1, freq = 0, div = 0; -+ -+ _func_enter_; + + RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, ("+rtw_wx_set_freq\n")); + -+ if (wrqu->freq.m <= 1000) { -+ if (wrqu->freq.flags == IW_FREQ_AUTO) { -+ padapter->mlmeextpriv.cur_channel = 1; -+ DBG_871X("%s: channel is auto, set to channel 1\n", __func__); -+ } else { -+ padapter->mlmeextpriv.cur_channel = wrqu->freq.m; -+ DBG_871X("%s: set to channel %d\n", __func__, padapter->mlmeextpriv.cur_channel); -+ } -+ } else { -+ while (wrqu->freq.e) { -+ exp *= 10; -+ wrqu->freq.e--; -+ } + -+ freq = wrqu->freq.m; -+ while (!(freq%10)) { -+ freq /= 10; -+ exp *= 10; -+ } + -+ /* freq unit is MHz here */ -+ div = 1000000/exp; -+ -+ if (div) -+ freq /= div; -+ else { -+ div = exp/1000000; -+ freq *= div; -+ } -+ -+ /* If freq is invalid, rtw_freq2ch() will return channel 1 */ -+ padapter->mlmeextpriv.cur_channel = rtw_freq2ch(freq); -+ DBG_871X("%s: set to channel %d\n", __func__, padapter->mlmeextpriv.cur_channel); -+ } -+ -+ _func_exit_; -+ + return 0; +} + -+static int rtw_wx_get_freq(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_get_freq(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ++ ++ if(check_fwstate(pmlmepriv, _FW_LINKED) == true) + { + //wrqu->freq.m = ieee80211_wlan_frequencies[pcur_bss->Configuration.DSConfig-1] * 100000; + wrqu->freq.m = rtw_ch2freq(pcur_bss->Configuration.DSConfig) * 100000; @@ -352644,83 +162634,71 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + NDIS_802_11_NETWORK_INFRASTRUCTURE networkType ; + int ret = 0; -+ -+ _func_enter_; -+ ++ ++ ++ + if(_FAIL == rtw_pwr_wakeup(padapter)) { + ret= -EPERM; + goto exit; + } + -+ if (!rtw_is_hw_init_completed(padapter)) { ++ if (padapter->hw_init_completed==false){ + ret = -EPERM; + goto exit; + } + -+ /* initial default type */ -+ dev->type = ARPHRD_ETHER; -+ + switch(wrqu->mode) + { -+ case IW_MODE_MONITOR: -+ networkType = Ndis802_11Monitor; -+#if 0 -+ dev->type = ARPHRD_IEEE80211; /* IEEE 802.11 : 801 */ -+#endif -+ dev->type = ARPHRD_IEEE80211_RADIOTAP; /* IEEE 802.11 + radiotap header : 803 */ -+ DBG_871X("set_mode = IW_MODE_MONITOR\n"); -+ break; -+ + case IW_MODE_AUTO: + networkType = Ndis802_11AutoUnknown; -+ DBG_871X("set_mode = IW_MODE_AUTO\n"); -+ break; -+ case IW_MODE_ADHOC: -+ networkType = Ndis802_11IBSS; -+ DBG_871X("set_mode = IW_MODE_ADHOC\n"); ++ DBG_871X("set_mode = IW_MODE_AUTO\n"); + break; -+ case IW_MODE_MASTER: ++ case IW_MODE_ADHOC: ++ networkType = Ndis802_11IBSS; ++ DBG_871X("set_mode = IW_MODE_ADHOC\n"); ++ break; ++ case IW_MODE_MASTER: + networkType = Ndis802_11APMode; + DBG_871X("set_mode = IW_MODE_MASTER\n"); -+ //rtw_setopmode_cmd(padapter, networkType,_TRUE); -+ break; ++ //rtw_setopmode_cmd(padapter, networkType); ++ break; + case IW_MODE_INFRA: + networkType = Ndis802_11Infrastructure; -+ DBG_871X("set_mode = IW_MODE_INFRA\n"); ++ DBG_871X("set_mode = IW_MODE_INFRA\n"); + break; -+ ++ + default : + ret = -EINVAL;; + RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("\n Mode: %s is not supported \n", iw_operation_mode[wrqu->mode])); + goto exit; + } -+ -+/* ++ ++/* + if(Ndis802_11APMode == networkType) + { -+ rtw_setopmode_cmd(padapter, networkType,_TRUE); -+ } ++ rtw_setopmode_cmd(padapter, networkType); ++ } + else + { -+ rtw_setopmode_cmd(padapter, Ndis802_11AutoUnknown,_TRUE); ++ rtw_setopmode_cmd(padapter, Ndis802_11AutoUnknown); + } +*/ -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, networkType) ==_FALSE){ ++ ++ if (rtw_set_802_11_infrastructure_mode(padapter, networkType) ==false){ + + ret = -EPERM; + goto exit; + + } + -+ rtw_setopmode_cmd(padapter, networkType,_TRUE); ++ rtw_setopmode_cmd(padapter, networkType); + +exit: -+ -+ _func_exit_; -+ ++ ++ ++ + return ret; -+ ++ +} + +static int rtw_wx_get_mode(struct net_device *dev, struct iw_request_info *a, @@ -352728,22 +162706,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ ++ + RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,(" rtw_wx_get_mode \n")); + -+ _func_enter_; -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) ++ ++ ++ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) + { + wrqu->mode = IW_MODE_INFRA; + } -+ else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) -+ ++ else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true)) ++ + { + wrqu->mode = IW_MODE_ADHOC; + } -+ else if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ else if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) + { + wrqu->mode = IW_MODE_MASTER; + } @@ -352752,10 +162730,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + wrqu->mode = IW_MODE_AUTO; + } + -+ _func_exit_; -+ ++ ++ + return 0; -+ ++ +} + + @@ -352764,14 +162742,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + union iwreq_data *wrqu, char *extra) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 j,blInserted = _FALSE; -+ int intReturn = _FALSE; ++ u8 j,blInserted = false; ++ int intReturn = false; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct security_priv *psecuritypriv = &padapter->securitypriv; + struct iw_pmksa* pPMK = ( struct iw_pmksa* ) extra; + u8 strZeroMacAddress[ ETH_ALEN ] = { 0x00 }; + u8 strIssueBssid[ ETH_ALEN ] = { 0x00 }; -+ ++ +/* + struct iw_pmksa + { @@ -352789,30 +162767,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if ( pPMK->cmd == IW_PMKSA_ADD ) + { + DBG_871X( "[rtw_wx_set_pmkid] IW_PMKSA_ADD!\n" ); -+ if ( _rtw_memcmp( strIssueBssid, strZeroMacAddress, ETH_ALEN ) == _TRUE ) ++ if ( _rtw_memcmp( strIssueBssid, strZeroMacAddress, ETH_ALEN ) == true ) + { + return( intReturn ); + } + else + { -+ intReturn = _TRUE; ++ intReturn = true; + } -+ blInserted = _FALSE; -+ ++ blInserted = false; ++ + //overwrite PMKID + for(j=0 ; jPMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) ==_TRUE ) ++ if( _rtw_memcmp( psecuritypriv->PMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) ==true ) + { // BSSID is matched, the same AP => rewrite with new PMKID. -+ ++ + DBG_871X( "[rtw_wx_set_pmkid] BSSID exists in the PMKList.\n" ); + + _rtw_memcpy( psecuritypriv->PMKIDList[j].PMKID, pPMK->pmkid, IW_PMKID_LEN); -+ psecuritypriv->PMKIDList[ j ].bUsed = _TRUE; ++ psecuritypriv->PMKIDList[ j ].bUsed = true; + psecuritypriv->PMKIDIndex = j+1; -+ blInserted = _TRUE; ++ blInserted = true; + break; -+ } ++ } + } + + if(!blInserted) @@ -352824,7 +162802,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, strIssueBssid, ETH_ALEN); + _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, pPMK->pmkid, IW_PMKID_LEN); + -+ psecuritypriv->PMKIDList[ psecuritypriv->PMKIDIndex ].bUsed = _TRUE; ++ psecuritypriv->PMKIDList[ psecuritypriv->PMKIDIndex ].bUsed = true; + psecuritypriv->PMKIDIndex++ ; + if(psecuritypriv->PMKIDIndex==16) + { @@ -352835,56 +162813,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + else if ( pPMK->cmd == IW_PMKSA_REMOVE ) + { + DBG_871X( "[rtw_wx_set_pmkid] IW_PMKSA_REMOVE!\n" ); -+ intReturn = _TRUE; ++ intReturn = true; + for(j=0 ; jPMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) ==_TRUE ) -+ { // BSSID is matched, the same AP => Remove this PMKID information and reset it. ++ if( _rtw_memcmp( psecuritypriv->PMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) ==true ) ++ { // BSSID is matched, the same AP => Remove this PMKID information and reset it. + _rtw_memset( psecuritypriv->PMKIDList[ j ].Bssid, 0x00, ETH_ALEN ); -+ psecuritypriv->PMKIDList[ j ].bUsed = _FALSE; ++ psecuritypriv->PMKIDList[ j ].bUsed = false; + break; -+ } ++ } + } + } -+ else if ( pPMK->cmd == IW_PMKSA_FLUSH ) ++ else if ( pPMK->cmd == IW_PMKSA_FLUSH ) + { + DBG_871X( "[rtw_wx_set_pmkid] IW_PMKSA_FLUSH!\n" ); + _rtw_memset( &psecuritypriv->PMKIDList[ 0 ], 0x00, sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE ); + psecuritypriv->PMKIDIndex = 0; -+ intReturn = _TRUE; ++ intReturn = true; + } + return( intReturn ); +} + -+static int rtw_wx_get_sens(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_get_sens(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ #ifdef CONFIG_PLATFORM_ROCKCHIPS -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ /* -+ * 20110311 Commented by Jeff -+ * For rockchip platform's wpa_driver_wext_get_rssi -+ */ -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ //wrqu->sens.value=-padapter->recvpriv.signal_strength; -+ wrqu->sens.value=-padapter->recvpriv.rssi; -+ //DBG_871X("%s: %d\n", __FUNCTION__, wrqu->sens.value); -+ wrqu->sens.fixed = 0; /* no auto select */ -+ } else -+ #endif -+ { -+ wrqu->sens.value = 0; -+ wrqu->sens.fixed = 0; /* no auto select */ -+ wrqu->sens.disabled = 1; -+ } ++ wrqu->sens.value = 0; ++ wrqu->sens.fixed = 0; /* no auto select */ ++ wrqu->sens.disabled = 1; + return 0; +} + -+static int rtw_wx_get_range(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_get_range(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + struct iw_range *range = (struct iw_range *)extra; @@ -352893,9 +162854,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + u16 val; + int i; -+ -+ _func_enter_; -+ ++ ++ ++ + RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_range. cmd_code=%x\n", info->cmd)); + + wrqu->data.length = sizeof(*range); @@ -352910,7 +162871,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + */ + + /* ~5 Mb/s real (802.11b) */ -+ range->throughput = 5 * 1000 * 1000; ++ range->throughput = 5 * 1000 * 1000; + + // TODO: Not used in 802.11b? +// range->min_nwid; /* Minimal NWID we are able to set */ @@ -352918,58 +162879,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +// range->max_nwid; /* Maximal NWID we are able to set */ + + /* Old Frequency (backward compat - moved lower ) */ -+// range->old_num_channels; ++// range->old_num_channels; +// range->old_num_frequency; +// range->old_freq[6]; /* Filler to keep "version" at the same offset */ + + /* signal level threshold range */ + -+ /* Quality of link & SNR stuff */ -+ /* Quality range (link, level, noise) -+ * If the quality is absolute, it will be in the range [0 ; max_qual], -+ * if the quality is dBm, it will be in the range [max_qual ; 0]. -+ * Don't forget that we use 8 bit arithmetics... -+ * -+ * If percentage range is 0~100 -+ * Signal strength dbm range logical is -100 ~ 0 -+ * but usually value is -90 ~ -20 -+ * When CONFIG_SIGNAL_SCALE_MAPPING is defined, dbm range is -95 ~ -45 -+ */ -+ range->max_qual.qual = 100; -+#ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ range->max_qual.level = (u8)-100; -+ range->max_qual.noise = (u8)-100; -+ range->max_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */ -+ range->max_qual.updated |= IW_QUAL_DBM; -+#else /* !CONFIG_SIGNAL_DISPLAY_DBM */ + //percent values between 0 and 100. ++ range->max_qual.qual = 100; + range->max_qual.level = 100; + range->max_qual.noise = 100; -+ range->max_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */ -+#endif /* !CONFIG_SIGNAL_DISPLAY_DBM */ ++ range->max_qual.updated = 7; /* Updated all three */ ++ + -+ /* This should contain the average/typical values of the quality -+ * indicator. This should be the threshold between a "good" and -+ * a "bad" link (example : monitor going from green to orange). -+ * Currently, user space apps like quality monitors don't have any -+ * way to calibrate the measurement. With this, they can split -+ * the range between 0 and max_qual in different quality level -+ * (using a geometric subdivision centered on the average). -+ * I expect that people doing the user space apps will feedback -+ * us on which value we need to put in each driver... */ + range->avg_qual.qual = 92; /* > 8% missed beacons is 'bad' */ -+#ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ /* TODO: Find real 'good' to 'bad' threshold value for RSSI */ -+ range->avg_qual.level = (u8)-70; -+ range->avg_qual.noise = 0; -+ range->avg_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */ -+ range->avg_qual.updated |= IW_QUAL_DBM; -+#else /* !CONFIG_SIGNAL_DISPLAY_DBM */ + /* TODO: Find real 'good' to 'bad' threshol value for RSSI */ -+ range->avg_qual.level = 30; -+ range->avg_qual.noise = 100; -+ range->avg_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */ -+#endif /* !CONFIG_SIGNAL_DISPLAY_DBM */ ++ range->avg_qual.level = 20 + -98; ++ range->avg_qual.noise = 0; ++ range->avg_qual.updated = 7; /* Updated all three */ + + range->num_bitrates = RATE_COUNT; + @@ -353038,7 +162965,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#endif + + -+ _func_exit_; ++ + + return 0; + @@ -353065,7 +162992,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct wlan_network *pnetwork = NULL; + NDIS_802_11_AUTHENTICATION_MODE authmode; + -+ _func_enter_; ++ +/* +#ifdef CONFIG_CONCURRENT_MODE + if(padapter->iface_type > PRIMARY_IFACE) @@ -353073,11 +163000,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ret = -EINVAL; + goto exit; + } -+#endif -+*/ ++#endif ++*/ + +#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == _TRUE) ++ if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) + { + DBG_871X("set bssid, but buddy_intf is under scanning or linking\n"); + @@ -353087,19 +163014,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } +#endif + -+ rtw_ps_deny(padapter, PS_DENY_JOIN); ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ if (dc_check_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)== true) ++ { ++ DBG_871X("set bssid, but buddy_intf is under scanning or linking\n"); ++ ret = -EINVAL; ++ goto exit; ++ } ++#endif ++ + if(_FAIL == rtw_pwr_wakeup(padapter)) + { + ret= -1; + goto exit; + } -+ ++ + if(!padapter->bup){ + ret = -1; + goto exit; + } + -+ ++ + if (temp->sa_family != ARPHRD_ETHER){ + ret = -EINVAL; + goto exit; @@ -353112,17 +163047,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + while (1) + { -+ -+ if ((rtw_end_of_queue_search(phead, pmlmepriv->pscanned)) == _TRUE) ++ ++ if ((rtw_end_of_queue_search(phead, pmlmepriv->pscanned)) == true) + { -+#if 0 ++#if 0 + ret = -EINVAL; + goto exit; + -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) + { -+ rtw_set_802_11_bssid(padapter, temp->sa_data); -+ goto exit; ++ rtw_set_802_11_bssid(padapter, temp->sa_data); ++ goto exit; + } + else + { @@ -353133,7 +163068,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + break; + } -+ ++ + pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); + + pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); @@ -353142,8 +163077,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + src_bssid = temp->sa_data; + -+ if ((_rtw_memcmp(dst_bssid, src_bssid, ETH_ALEN)) == _TRUE) -+ { ++ if ((_rtw_memcmp(dst_bssid, src_bssid, ETH_ALEN)) == true) ++ { + if(!rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode)) + { + ret = -1; @@ -353151,104 +163086,90 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + goto exit; + } + -+ break; ++ break; + } + -+ } ++ } + _exit_critical_bh(&queue->lock, &irqL); -+ ++ + rtw_set_802_11_authentication_mode(padapter, authmode); + //set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); -+ if (rtw_set_802_11_bssid(padapter, temp->sa_data) == _FALSE) { ++ if (rtw_set_802_11_bssid(padapter, temp->sa_data) == false) { + ret = -1; -+ goto exit; -+ } -+ -+exit: -+ -+ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); ++ goto exit; ++ } + -+ _func_exit_; -+ -+ return ret; ++exit: ++ ++ ++ ++ return ret; +} + -+static int rtw_wx_get_wap(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_get_wap(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+ ++ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; ++ + wrqu->ap_addr.sa_family = ARPHRD_ETHER; -+ ++ + _rtw_memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN); -+ ++ + RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_wap\n")); + -+ _func_enter_; + -+ if ( ((check_fwstate(pmlmepriv, _FW_LINKED)) == _TRUE) || -+ ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == _TRUE) || -+ ((check_fwstate(pmlmepriv, WIFI_AP_STATE)) == _TRUE) ) ++ ++ if ( ((check_fwstate(pmlmepriv, _FW_LINKED)) == true) || ++ ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == true) || ++ ((check_fwstate(pmlmepriv, WIFI_AP_STATE)) == true) ) + { + + _rtw_memcpy(wrqu->ap_addr.sa_data, pcur_bss->MacAddress, ETH_ALEN); + } + else + { -+ _rtw_memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN); -+ } ++ _rtw_memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN); ++ } ++ ++ + -+ _func_exit_; -+ + return 0; -+ ++ +} + -+static int rtw_wx_set_mlme(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_set_mlme(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+#if 0 -+/* SIOCSIWMLME data */ -+struct iw_mlme -+{ -+ __u16 cmd; /* IW_MLME_* */ -+ __u16 reason_code; -+ struct sockaddr addr; -+}; -+#endif -+ + int ret=0; + u16 reason; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_mlme *mlme = (struct iw_mlme *) extra; + -+ + if(mlme==NULL) + return -1; + + DBG_871X("%s\n", __FUNCTION__); + -+ reason = cpu_to_le16(mlme->reason_code); -+ ++ reason = mlme->reason_code; + + DBG_871X("%s, cmd=%d, reason=%d\n", __FUNCTION__, mlme->cmd, reason); -+ + -+ switch (mlme->cmd) ++ ++ switch (mlme->cmd) + { + case IW_MLME_DEAUTH: + if(!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; ++ ret = -1; + break; + + case IW_MLME_DISASSOC: + if(!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; ++ ret = -1; + + break; + @@ -353262,18 +163183,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, + union iwreq_data *wrqu, char *extra) +{ -+ u8 _status = _FALSE; -+ int ret = 0; ++ u8 _status = false; ++ int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv= &padapter->mlmepriv; + NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; + _irqL irqL; +#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); ++ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); +#endif //CONFIG_P2P + RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_set_scan\n")); + -+_func_enter_; ++ + + #ifdef DBG_IOCTL + DBG_871X("DBG_IOCTL %s:%d\n",__FUNCTION__, __LINE__); @@ -353287,122 +163208,139 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } +#endif +*/ -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) -+ { -+ DBG_871X(FUNC_ADPT_FMT ": MP mode block Scan request\n", FUNC_ADPT_ARG(padapter)); -+ ret = -1; -+ goto exit; -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->pbuddy_adapter) { -+ if (padapter->pbuddy_adapter->registrypriv.mp_mode == 1) -+ { -+ DBG_871X(FUNC_ADPT_FMT ": MP mode block Scan request\n", FUNC_ADPT_ARG(padapter->pbuddy_adapter)); -+ ret = -1; -+ goto exit; -+ } -+ } -+#endif //CONFIG_CONCURRENT_MODE -+#endif + -+ rtw_ps_deny(padapter, PS_DENY_SCAN); ++#ifdef CONFIG_MP_INCLUDED ++if (padapter->registrypriv.mp_mode == 1) ++{ ++ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) ++ { ++ ret = -1; ++ goto exit; ++ } ++} ++#endif + if(_FAIL == rtw_pwr_wakeup(padapter)) + { + ret= -1; + goto exit; + } + -+ if (rtw_is_drv_stopped(padapter)) { -+ DBG_871X("%s bDriverStopped=_TRUE\n", __func__); ++ if(padapter->bDriverStopped){ ++ DBG_871X("bDriverStopped=%d\n", padapter->bDriverStopped); + ret= -1; + goto exit; + } -+ ++ + if(!padapter->bup){ + ret = -1; + goto exit; + } -+ -+ if (!rtw_is_hw_init_completed(padapter)) { ++ ++ if (padapter->hw_init_completed==false){ + ret = -1; + goto exit; + } + -+#ifndef CONFIG_DOSCAN_IN_BUSYTRAFFIC + // When Busy Traffic, driver do not site survey. So driver return success. + // wpa_supplicant will not issue SIOCSIWSCAN cmd again after scan timeout. + // modify by thomas 2011-02-22. -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE -+#ifdef CONFIG_CONCURRENT_MODE -+ || rtw_get_buddy_bBusyTraffic(padapter) == _TRUE -+#endif //CONFIG_CONCURRENT_MODE -+ ) ++ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == true) + { + indicate_wx_scan_complete_event(padapter); + goto exit; + } -+#endif + -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == _TRUE) ++ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) + { + indicate_wx_scan_complete_event(padapter); + goto exit; -+ } ++ } + +#ifdef CONFIG_CONCURRENT_MODE + if (check_buddy_fwstate(padapter, -+ _FW_UNDER_SURVEY|_FW_UNDER_LINKING|WIFI_UNDER_WPS) == _TRUE) ++ _FW_UNDER_SURVEY|_FW_UNDER_LINKING|WIFI_UNDER_WPS) == true) ++ { ++ if(check_buddy_fwstate(padapter, _FW_UNDER_SURVEY)) ++ { ++ DBG_871X("scanning_via_buddy_intf\n"); ++ pmlmepriv->scanning_via_buddy_intf = true; ++ } ++ ++ indicate_wx_scan_complete_event(padapter); ++ ++ goto exit; ++ } ++#endif ++ ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ if (dc_check_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)== true) + { + indicate_wx_scan_complete_event(padapter); + goto exit; + } +#endif + ++// Mareded by Albert 20101103 ++// For the DMP WiFi Display project, the driver won't to scan because ++// the pmlmepriv->scan_interval is always equal to 3. ++// So, the wpa_supplicant won't find out the WPS SoftAP. ++ ++/* ++ if(pmlmepriv->scan_interval>10) ++ pmlmepriv->scan_interval = 0; ++ ++ if(pmlmepriv->scan_interval > 0) ++ { ++ DBG_871X("scan done\n"); ++ ret = 0; ++ goto exit; ++ } ++ ++*/ +#ifdef CONFIG_P2P + if ( pwdinfo->p2p_state != P2P_STATE_NONE ) + { + rtw_p2p_set_pre_state( pwdinfo, rtw_p2p_state( pwdinfo ) ); + rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); + rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_FULL); -+ rtw_free_network_queue(padapter, _TRUE); ++ rtw_free_network_queue(padapter, true); + } +#endif //CONFIG_P2P + + _rtw_memset(ssid, 0, sizeof(NDIS_802_11_SSID)*RTW_SSID_SCAN_AMOUNT); + +#if WIRELESS_EXT >= 17 -+ if (wrqu->data.length == sizeof(struct iw_scan_req)) ++ if (wrqu->data.length == sizeof(struct iw_scan_req)) + { + struct iw_scan_req *req = (struct iw_scan_req *)extra; -+ ++ + if (wrqu->data.flags & IW_SCAN_THIS_ESSID) + { + int len = min((int)req->essid_len, IW_ESSID_MAX_SIZE); + + _rtw_memcpy(ssid[0].Ssid, req->essid, len); -+ ssid[0].SsidLength = len; ++ ssid[0].SsidLength = len; + + DBG_871X("IW_SCAN_THIS_ESSID, ssid=%s, len=%d\n", req->essid, req->essid_len); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ ++ ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ + _status = rtw_sitesurvey_cmd(padapter, ssid, 1, NULL, 0); -+ ++ + _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ ++ + } + else if (req->scan_type == IW_SCAN_TYPE_PASSIVE) + { + DBG_871X("rtw_wx_set_scan, req->scan_type == IW_SCAN_TYPE_PASSIVE\n"); + } -+ ++ + } + else +#endif + + if( wrqu->data.length >= WEXT_CSCAN_HEADER_SIZE -+ && _rtw_memcmp(extra, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == _TRUE ++ && _rtw_memcmp(extra, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == true + ) + { + int len = wrqu->data.length -WEXT_CSCAN_HEADER_SIZE; @@ -353412,7 +163350,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + int ssid_index = 0; + + //DBG_871X("%s COMBO_SCAN header is recognized\n", __FUNCTION__); -+ ++ + while(len >= 1) { + section = *(pos++); len-=1; + @@ -353423,7 +163361,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + len = 0; + break; + } -+ ++ + sec_len = *(pos++); len-=1; + + if(sec_len>0 && sec_len<=len) { @@ -353433,11 +163371,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + // , ssid[ssid_index].Ssid, ssid[ssid_index].SsidLength); + ssid_index++; + } -+ ++ + pos+=sec_len; len-=sec_len; + break; -+ -+ ++ ++ + case WEXT_CSCAN_CHANNEL_SECTION: + //DBG_871X("WEXT_CSCAN_CHANNEL_SECTION\n"); + pos+=1; len-=1; @@ -353448,7 +163386,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + break; + case WEXT_CSCAN_PASV_DWELL_SECTION: + //DBG_871X("WEXT_CSCAN_PASV_DWELL_SECTION\n"); -+ pos+=2; len-=2; ++ pos+=2; len-=2; + break; + case WEXT_CSCAN_HOME_DWELL_SECTION: + //DBG_871X("WEXT_CSCAN_HOME_DWELL_SECTION\n"); @@ -353463,38 +163401,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("WEXT_CSCAN_NPROBE_SECTION\n"); + break; + #endif -+ ++ + default: + //DBG_871X("Unknown CSCAN section %c\n", section); + len = 0; // stop parsing + } + //DBG_871X("len:%d\n", len); -+ ++ + } -+ ++ + //jeff: it has still some scan paramater to parse, we only do this now... + _status = rtw_set_802_11_bssid_list_scan(padapter, ssid, RTW_SSID_SCAN_AMOUNT); -+ ++ + } else -+ ++ + { + _status = rtw_set_802_11_bssid_list_scan(padapter, NULL, 0); + } + -+ if(_status == _FALSE) ++ if(_status == false) + ret = -1; + +exit: -+ -+ rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); -+ + #ifdef DBG_IOCTL + DBG_871X("DBG_IOCTL %s:%d return %d\n",__FUNCTION__, __LINE__, ret); + #endif + -+_func_exit_; + -+ return ret; ++ ++ return ret; +} + +static int rtw_wx_get_scan(struct net_device *dev, struct iw_request_info *a, @@ -353514,7 +163449,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + sint wait_status; +#ifdef CONFIG_CONCURRENT_MODE + //PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ //struct mlme_priv *pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); ++ //struct mlme_priv *pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); +#endif +#ifdef CONFIG_P2P + struct wifidirect_info* pwdinfo = &padapter->wdinfo; @@ -353522,11 +163457,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_scan\n")); + RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_, (" Start of Query SIOCGIWSCAN .\n")); + -+ _func_enter_; ++ + + #ifdef DBG_IOCTL + DBG_871X("DBG_IOCTL %s:%d\n",__FUNCTION__, __LINE__); + #endif ++ +/* +#ifdef CONFIG_CONCURRENT_MODE + if(padapter->iface_type > PRIMARY_IFACE) @@ -353535,16 +163471,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + goto exit; + } +#endif -+*/ -+ if (adapter_to_pwrctl(padapter)->brfoffbyhw && rtw_is_drv_stopped(padapter)) { ++*/ ++ if(padapter->pwrctrlpriv.brfoffbyhw && padapter->bDriverStopped) ++ { + ret = -EINVAL; + goto exit; + } -+ ++ +#ifdef CONFIG_P2P + if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) + { -+ wait_for_surveydone = 200; ++ // P2P is enabled ++ if ( padapter->chip_type == RTL8192D ) ++ wait_for_surveydone = 300; // Because the 8192du supports more channels. ++ else ++ wait_for_surveydone = 200; + } + else + { @@ -353557,40 +163498,53 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } +#endif //CONFIG_P2P + -+#if 1 // Wireless Extension use EAGAIN to try -+ wait_status = _FW_UNDER_SURVEY -+#ifndef CONFIG_ANDROID -+ | _FW_UNDER_LINKING -+#endif -+ ; -+ -+ while (check_fwstate(pmlmepriv, wait_status) == _TRUE) ++/* ++#ifdef CONFIG_CONCURRENT_MODE ++ if(pmlmepriv->scanning_via_buddy_intf == true) + { -+ return -EAGAIN; ++ pmlmepriv->scanning_via_buddy_intf = false;//reset ++ ++ // change pointers to buddy interface ++ padapter = pbuddy_adapter; ++ pmlmepriv = pbuddy_mlmepriv; ++ queue = &(pbuddy_mlmepriv->scanned_queue); ++ + } -+#else ++#endif // CONFIG_CONCURRENT_MODE ++*/ ++ + wait_status = _FW_UNDER_SURVEY + #ifndef CONFIG_ANDROID + |_FW_UNDER_LINKING + #endif + ; + -+ while(check_fwstate(pmlmepriv, wait_status) == _TRUE) -+ { ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ while(dc_check_fwstate(padapter, wait_status)== true) ++ { + rtw_msleep_os(30); + cnt++; + if(cnt > wait_for_surveydone ) + break; + } -+#endif ++#endif // CONFIG_DUALMAC_CONCURRENT ++ ++ while(check_fwstate(pmlmepriv, wait_status) == true) ++ { ++ rtw_msleep_os(30); ++ cnt++; ++ if(cnt > wait_for_surveydone ) ++ break; ++ } ++ + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + + phead = get_list_head(queue); + plist = get_next(phead); -+ ++ + while(1) + { -+ if (rtw_end_of_queue_search(phead,plist)== _TRUE) ++ if (rtw_end_of_queue_search(phead,plist)== true) + break; + + if((stop - ev) < SCAN_ITEM_SIZE) { @@ -353602,32 +163556,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + //report network only if the current channel set contains the channel to which this network belongs + if(rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 -+ && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE -+ && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid)) ++ #ifdef CONFIG_VALIDATE_SSID ++ && true == rtw_validate_ssid(&(pnetwork->network.Ssid)) ++ #endif + ) + { + ev=translate_scan(padapter, a, pnetwork, ev, stop); + } + + plist = get_next(plist); -+ -+ } ++ ++ } + + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + + wrqu->data.length = ev-extra; + wrqu->data.flags = 0; -+ -+exit: -+ -+ _func_exit_; -+ ++ ++exit: ++ ++ ++ + #ifdef DBG_IOCTL + DBG_871X("DBG_IOCTL %s:%d return %d\n",__FUNCTION__, __LINE__, ret); + #endif -+ ++ + return ret ; -+ ++ +} + +//set ssid flow @@ -353635,7 +163590,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +//s2. set_802_11_authenticaion_mode() +//s3. set_802_11_encryption_mode() +//s4. rtw_set_802_11_ssid() -+static int rtw_wx_set_essid(struct net_device *dev, ++static int rtw_wx_set_essid(struct net_device *dev, + struct iw_request_info *a, + union iwreq_data *wrqu, char *extra) +{ @@ -353643,24 +163598,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + _queue *queue = &pmlmepriv->scanned_queue; ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + _list *phead; -+ s8 status = _TRUE; ++ s8 status = true; + struct wlan_network *pnetwork = NULL; -+ NDIS_802_11_AUTHENTICATION_MODE authmode; -+ NDIS_802_11_SSID ndis_ssid; ++ NDIS_802_11_AUTHENTICATION_MODE authmode; ++ NDIS_802_11_SSID ndis_ssid; + u8 *dst_ssid, *src_ssid; + + uint ret = 0, len; + -+ _func_enter_; -+ ++ ++ + #ifdef DBG_IOCTL + DBG_871X("DBG_IOCTL %s:%d\n",__FUNCTION__, __LINE__); + #endif -+ #ifdef CONFIG_WEXT_DONT_JOIN_BYSSID -+ DBG_871X("%s: CONFIG_WEXT_DONT_JOIN_BYSSID be defined!! only allow bssid joining\n", __func__); -+ return -EPERM; -+ #endif ++ +/* +#ifdef CONFIG_CONCURRENT_MODE + if(padapter->iface_type > PRIMARY_IFACE) @@ -353672,22 +163625,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +*/ + +#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == _TRUE) -+ { ++ if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) ++ { + DBG_871X("set ssid, but buddy_intf is under scanning or linking\n"); -+ ++ ++ ret = -EINVAL; ++ ++ goto exit; ++ } ++#endif ++ ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ if (dc_check_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)== true) ++ { ++ DBG_871X("set bssid, but buddy_intf is under scanning or linking\n"); + ret = -EINVAL; -+ + goto exit; + } +#endif + + RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, + ("+rtw_wx_set_essid: fw_state=0x%08x\n", get_fwstate(pmlmepriv))); -+ -+ rtw_ps_deny(padapter, PS_DENY_JOIN); + if(_FAIL == rtw_pwr_wakeup(padapter)) -+ { ++ { + ret = -1; + goto exit; + } @@ -353705,12 +163665,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ret= -E2BIG; + goto exit; + } -+ ++ + if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) { + ret = -1; + goto exit; -+ } -+ ++ } ++ + authmode = padapter->securitypriv.ndisauthtype; + DBG_871X("=>%s\n",__FUNCTION__); + if (wrqu->essid.flags && wrqu->essid.length) @@ -353719,7 +163679,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + // We got the codes in "set_info" function of iwconfig source code. + // ========================================= + // wrq.u.essid.length = strlen(essid) + 1; -+ // if(we_kernel_version > 20) ++ // if(we_kernel_version > 20) + // wrq.u.essid.length--; + // ========================================= + // That means, if the WIRELESS_EXT less than or equal to 20, the correct ssid len should subtract 1. @@ -353734,24 +163694,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID)); + ndis_ssid.SsidLength = len; -+ _rtw_memcpy(ndis_ssid.Ssid, extra, len); ++ _rtw_memcpy(ndis_ssid.Ssid, extra, len); + src_ssid = ndis_ssid.Ssid; -+ ++ + RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, ("rtw_wx_set_essid: ssid=[%s]\n", src_ssid)); + _enter_critical_bh(&queue->lock, &irqL); + phead = get_list_head(queue); + pmlmepriv->pscanned = get_next(phead); + + while (1) -+ { -+ if (rtw_end_of_queue_search(phead, pmlmepriv->pscanned) == _TRUE) ++ { ++ if (rtw_end_of_queue_search(phead, pmlmepriv->pscanned) == true) + { -+#if 0 -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) ++#if 0 ++ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) + { -+ rtw_set_802_11_ssid(padapter, &ndis_ssid); ++ rtw_set_802_11_ssid(padapter, &ndis_ssid); + -+ goto exit; ++ goto exit; + } + else + { @@ -353759,13 +163719,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ret = -EINVAL; + goto exit; + } -+#endif ++#endif + RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_warning_, + ("rtw_wx_set_essid: scan_q is empty, set ssid to check if scanning again!\n")); + + break; + } -+ ++ + pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); + + pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); @@ -353776,26 +163736,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ("rtw_wx_set_essid: dst_ssid=%s\n", + pnetwork->network.Ssid.Ssid)); + -+ if ((_rtw_memcmp(dst_ssid, src_ssid, ndis_ssid.SsidLength) == _TRUE) && ++ if ((_rtw_memcmp(dst_ssid, src_ssid, ndis_ssid.SsidLength) == true) && + (pnetwork->network.Ssid.SsidLength==ndis_ssid.SsidLength)) + { + RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, + ("rtw_wx_set_essid: find match, set infra mode\n")); -+ -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) ++ ++ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) + { + if(pnetwork->network.InfrastructureMode != pmlmepriv->cur_network.network.InfrastructureMode) + continue; -+ } -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode) == _FALSE) ++ } ++ ++ if (rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode) == false) + { + ret = -1; + _exit_critical_bh(&queue->lock, &irqL); + goto exit; + } + -+ break; ++ break; + } + } + _exit_critical_bh(&queue->lock, &irqL); @@ -353803,28 +163763,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ("set ssid: set_802_11_auth. mode=%d\n", authmode)); + rtw_set_802_11_authentication_mode(padapter, authmode); + //set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); -+ if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == _FALSE) { ++ if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == false) { + ret = -1; + goto exit; -+ } -+ } -+ ++ } ++ } ++ +exit: + -+ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); -+ + DBG_871X("<=%s, ret %d\n",__FUNCTION__, ret); -+ ++ + #ifdef DBG_IOCTL + DBG_871X("DBG_IOCTL %s:%d return %d\n",__FUNCTION__, __LINE__, ret); + #endif -+ -+ _func_exit_; -+ -+ return ret; ++ ++ ++ ++ return ret; +} + -+static int rtw_wx_get_essid(struct net_device *dev, ++static int rtw_wx_get_essid(struct net_device *dev, + struct iw_request_info *a, + union iwreq_data *wrqu, char *extra) +{ @@ -353835,15 +163793,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_essid\n")); + -+ _func_enter_; + -+ if ( (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) ++ ++ if ( (check_fwstate(pmlmepriv, _FW_LINKED) == true) || ++ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) + { + len = pcur_bss->Ssid.SsidLength; + + wrqu->essid.length = len; -+ ++ + _rtw_memcpy(extra, pcur_bss->Ssid.Ssid, len); + + wrqu->essid.flags = 1; @@ -353856,13 +163814,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + +exit: + -+ _func_exit_; -+ ++ ++ + return ret; -+ ++ +} + -+static int rtw_wx_set_rate(struct net_device *dev, ++static int rtw_wx_set_rate(struct net_device *dev, + struct iw_request_info *a, + union iwreq_data *wrqu, char *extra) +{ @@ -353874,11 +163832,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + u32 ratevalue = 0; + u8 mpdatarate[NumRates]={11, 10, 9, 8, 7, 6, 5, 4, 3, 2, 1, 0, 0xff}; + -+_func_enter_; ++ + + RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,(" rtw_wx_set_rate \n")); + RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("target_rate = %d, fixed = %d\n",target_rate,fixed)); -+ ++ + if(target_rate == -1){ + ratevalue = 11; + goto set_rate; @@ -353949,132 +163907,132 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ret = -1; + } + -+_func_exit_; ++ + + return ret; +} + -+static int rtw_wx_get_rate(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_get_rate(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) -+{ ++{ + u16 max_rate = 0; + + max_rate = rtw_get_cur_max_rate((_adapter *)rtw_netdev_priv(dev)); + + if(max_rate == 0) + return -EPERM; -+ ++ + wrqu->bitrate.fixed = 0; /* no auto select */ + wrqu->bitrate.value = max_rate * 100000; + + return 0; +} + -+static int rtw_wx_set_rts(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_set_rts(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + -+ _func_enter_; -+ ++ ++ + if (wrqu->rts.disabled) + padapter->registrypriv.rts_thresh = 2347; + else { + if (wrqu->rts.value < 0 || + wrqu->rts.value > 2347) + return -EINVAL; -+ ++ + padapter->registrypriv.rts_thresh = wrqu->rts.value; + } + + DBG_871X("%s, rts_thresh=%d\n", __func__, padapter->registrypriv.rts_thresh); -+ -+ _func_exit_; -+ ++ ++ ++ + return 0; + +} + -+static int rtw_wx_get_rts(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_get_rts(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ _func_enter_; + -+ DBG_871X("%s, rts_thresh=%d\n", __func__, padapter->registrypriv.rts_thresh); -+ ++ ++ ++ DBG_871X("%s, rts_thresh=%d\n", __func__, padapter->registrypriv.rts_thresh); ++ + wrqu->rts.value = padapter->registrypriv.rts_thresh; + wrqu->rts.fixed = 0; /* no auto select */ + //wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD); -+ -+ _func_exit_; -+ ++ ++ ++ + return 0; +} + -+static int rtw_wx_set_frag(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_set_frag(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + -+ _func_enter_; -+ ++ ++ + if (wrqu->frag.disabled) + padapter->xmitpriv.frag_len = MAX_FRAG_THRESHOLD; + else { + if (wrqu->frag.value < MIN_FRAG_THRESHOLD || + wrqu->frag.value > MAX_FRAG_THRESHOLD) + return -EINVAL; -+ ++ + padapter->xmitpriv.frag_len = wrqu->frag.value & ~0x1; + } + + DBG_871X("%s, frag_len=%d\n", __func__, padapter->xmitpriv.frag_len); -+ -+ _func_exit_; -+ ++ ++ ++ + return 0; -+ ++ +} + -+static int rtw_wx_get_frag(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_get_frag(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ _func_enter_; ++ ++ + + DBG_871X("%s, frag_len=%d\n", __func__, padapter->xmitpriv.frag_len); -+ ++ + wrqu->frag.value = padapter->xmitpriv.frag_len; + wrqu->frag.fixed = 0; /* no auto select */ + //wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FRAG_THRESHOLD); -+ -+ _func_exit_; -+ ++ ++ ++ + return 0; +} + -+static int rtw_wx_get_retry(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_get_retry(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + //_adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + -+ ++ + wrqu->retry.value = 7; + wrqu->retry.fixed = 0; /* no auto select */ + wrqu->retry.disabled = 1; -+ ++ + return 0; + -+} ++} + +#if 0 +#define IW_ENCODE_INDEX 0x00FF /* Token index (if needed) */ @@ -354099,25 +164057,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +*/ +#endif + -+static int rtw_wx_set_enc(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_set_enc(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *keybuf) -+{ ++{ + u32 key, ret = 0; + u32 keyindex_provided; -+ NDIS_802_11_WEP wep; ++ NDIS_802_11_WEP wep; + NDIS_802_11_AUTHENTICATION_MODE authmode; + + struct iw_point *erq = &(wrqu->encoding); + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + DBG_871X("+rtw_wx_set_enc, flags=0x%x\n", erq->flags); + + _rtw_memset(&wep, 0, sizeof(NDIS_802_11_WEP)); -+ ++ + key = erq->flags & IW_ENCODE_INDEX; -+ -+ _func_enter_; ++ ++ + + if (erq->flags & IW_ENCODE_DISABLED) + { @@ -354126,9 +164084,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; + padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_; + padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Open; //open system -+ authmode = Ndis802_11AuthModeOpen; ++ authmode = Ndis802_11AuthModeOpen; + padapter->securitypriv.ndisauthtype=authmode; -+ ++ + goto exit; + } + @@ -354137,44 +164095,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + return -EINVAL; + key--; + keyindex_provided = 1; -+ } ++ } + else + { + keyindex_provided = 0; + key = padapter->securitypriv.dot11PrivacyKeyIndex; + DBG_871X("rtw_wx_set_enc, key=%d\n", key); + } -+ -+ //set authentication mode ++ ++ //set authentication mode + if(erq->flags & IW_ENCODE_OPEN) + { + DBG_871X("rtw_wx_set_enc():IW_ENCODE_OPEN\n"); + padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;//Ndis802_11EncryptionDisabled; + -+#ifdef CONFIG_PLATFORM_MT53XX -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+#else + padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Open; -+#endif + + padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; + padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_; -+ authmode = Ndis802_11AuthModeOpen; ++ authmode = Ndis802_11AuthModeOpen; + padapter->securitypriv.ndisauthtype=authmode; -+ } ++ } + else if(erq->flags & IW_ENCODE_RESTRICTED) -+ { ++ { + DBG_871X("rtw_wx_set_enc():IW_ENCODE_RESTRICTED\n"); + padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; + -+#ifdef CONFIG_PLATFORM_MT53XX -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+#else + padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Shared; -+#endif + + padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_; -+ padapter->securitypriv.dot118021XGrpPrivacy=_WEP40_; ++ padapter->securitypriv.dot118021XGrpPrivacy=_WEP40_; + authmode = Ndis802_11AuthModeShared; + padapter->securitypriv.ndisauthtype=authmode; + } @@ -354186,10 +164136,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Open; //open system + padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; + padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_; -+ authmode = Ndis802_11AuthModeOpen; ++ authmode = Ndis802_11AuthModeOpen; + padapter->securitypriv.ndisauthtype=authmode; + } -+ ++ + wep.KeyIndex = key; + if (erq->length > 0) + { @@ -354200,7 +164150,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + else + { + wep.KeyLength = 0 ; -+ ++ + if(keyindex_provided == 1)// set key_id only, no given KeyMaterial(erq->length==0). + { + padapter->securitypriv.dot11PrivacyKeyIndex = key; @@ -354210,42 +164160,42 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + switch(padapter->securitypriv.dot11DefKeylen[key]) + { + case 5: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_; ++ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_; + break; + case 13: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_; ++ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_; + break; + default: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; ++ padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; + break; + } -+ ++ + goto exit; -+ ++ + } -+ ++ + } + + wep.KeyIndex |= 0x80000000; + + _rtw_memcpy(wep.KeyMaterial, keybuf, wep.KeyLength); -+ -+ if (rtw_set_802_11_add_wep(padapter, &wep) == _FALSE) { ++ ++ if (rtw_set_802_11_add_wep(padapter, &wep) == false) { + if(rf_on == pwrpriv->rf_pwrstate ) + ret = -EOPNOTSUPP; + goto exit; -+ } ++ } + +exit: -+ -+ _func_exit_; -+ ++ ++ ++ + return ret; -+ ++ +} + -+static int rtw_wx_get_enc(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_get_enc(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *keybuf) +{ + uint key, ret =0; @@ -354253,19 +164203,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_point *erq = &(wrqu->encoding); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + -+ _func_enter_; -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED) != _TRUE) ++ ++ ++ if(check_fwstate(pmlmepriv, _FW_LINKED) != true) + { -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != true) + { + erq->length = 0; + erq->flags |= IW_ENCODE_DISABLED; + return 0; -+ } -+ } ++ } ++ } ++ + -+ + key = erq->flags & IW_ENCODE_INDEX; + + if (key) { @@ -354275,15 +164225,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } else + { + key = padapter->securitypriv.dot11PrivacyKeyIndex; -+ } ++ } + + erq->flags = key + 1; + + //if(padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen) + //{ + // erq->flags |= IW_ENCODE_OPEN; -+ //} -+ ++ //} ++ + switch(padapter->securitypriv.ndisencryptstatus) + { + case Ndis802_11EncryptionNotSupported: @@ -354291,28 +164241,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + erq->length = 0; + erq->flags |= IW_ENCODE_DISABLED; -+ ++ + break; -+ -+ case Ndis802_11Encryption1Enabled: -+ -+ erq->length = padapter->securitypriv.dot11DefKeylen[key]; ++ ++ case Ndis802_11Encryption1Enabled: ++ ++ erq->length = padapter->securitypriv.dot11DefKeylen[key]; + + if(erq->length) + { + _rtw_memcpy(keybuf, padapter->securitypriv.dot11DefKey[key].skey, padapter->securitypriv.dot11DefKeylen[key]); -+ ++ + erq->flags |= IW_ENCODE_ENABLED; + + if(padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen) + { -+ erq->flags |= IW_ENCODE_OPEN; ++ erq->flags |= IW_ENCODE_OPEN; + } + else if(padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeShared) + { + erq->flags |= IW_ENCODE_RESTRICTED; -+ } -+ } ++ } ++ } + else + { + erq->length = 0; @@ -354328,60 +164278,60 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + erq->flags |= (IW_ENCODE_ENABLED | IW_ENCODE_OPEN | IW_ENCODE_NOKEY); + + break; -+ ++ + default: + erq->length = 0; + erq->flags |= IW_ENCODE_DISABLED; + + break; -+ -+ } -+ -+ _func_exit_; -+ -+ return ret; -+ -+} + -+static int rtw_wx_get_power(struct net_device *dev, -+ struct iw_request_info *info, ++ } ++ ++ ++ ++ return ret; ++ ++} ++ ++static int rtw_wx_get_power(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + //_adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ ++ + wrqu->power.value = 0; + wrqu->power.fixed = 0; /* no auto select */ + wrqu->power.disabled = 1; -+ ++ + return 0; + +} + -+static int rtw_wx_set_gen_ie(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_set_gen_ie(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + int ret; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ ret = rtw_set_wpa_ie(padapter, extra, wrqu->data.length); -+ -+ return ret; -+} + -+static int rtw_wx_set_auth(struct net_device *dev, -+ struct iw_request_info *info, ++ ret = rtw_set_wpa_ie(padapter, extra, wrqu->data.length); ++ ++ return ret; ++} ++ ++static int rtw_wx_set_auth(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_param *param = (struct iw_param*)&(wrqu->param); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct security_priv *psecuritypriv = &padapter->securitypriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u32 value = param->value; + int ret = 0; -+ ++ + switch (param->flags & IW_AUTH_INDEX) { + + case IW_AUTH_WPA_VERSION: @@ -354402,10 +164352,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#endif + break; + case IW_AUTH_CIPHER_PAIRWISE: -+ ++ + break; + case IW_AUTH_CIPHER_GROUP: -+ ++ + break; + case IW_AUTH_KEY_MGMT: +#ifdef CONFIG_WAPI_SUPPORT @@ -354427,11 +164377,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + if ( param->value ) + { // wpa_supplicant is enabling the tkip countermeasure. -+ padapter->securitypriv.btkip_countermeasure = _TRUE; ++ padapter->securitypriv.btkip_countermeasure = true; + } + else + { // wpa_supplicant is disabling the tkip countermeasure. -+ padapter->securitypriv.btkip_countermeasure = _FALSE; ++ padapter->securitypriv.btkip_countermeasure = false; + } + break; + } @@ -354451,10 +164401,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + if(padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption1Enabled) + { -+ break;//it means init value, or using wep, ndisencryptstatus = Ndis802_11Encryption1Enabled, ++ break;//it means init value, or using wep, ndisencryptstatus = Ndis802_11Encryption1Enabled, + // then it needn't reset it; + } -+ ++ + if(param->value){ + padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; + padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; @@ -354462,7 +164412,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Open; //open system + padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeOpen; + } -+ ++ + break; + } + @@ -354474,7 +164424,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + */ + if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { + LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, _FALSE); ++ rtw_disassoc_cmd(padapter, 500, false); + DBG_871X("%s...call rtw_indicate_disconnect\n ",__FUNCTION__); + rtw_indicate_disconnect(padapter); + rtw_free_assoc_resources(padapter, 1); @@ -354482,8 +164432,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + #endif + + -+ ret = wpa_set_auth_algs(dev, (u32)param->value); -+ ++ ret = wpa_set_auth_algs(dev, (u32)param->value); ++ + break; + + case IW_AUTH_WPA_ENABLED: @@ -354492,9 +164442,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + // padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; //802.1x + //else + // padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open;//open system -+ ++ + //_disassociate(priv); -+ ++ + break; + + case IW_AUTH_RX_UNENCRYPTED_EAPOL: @@ -354514,29 +164464,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + default: + return -EOPNOTSUPP; -+ ++ + } -+ ++ + return ret; -+ ++ +} + -+static int rtw_wx_set_enc_ext(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_set_enc_ext(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + char *alg_name; + u32 param_len; + struct ieee_param *param = NULL; + struct iw_point *pencoding = &wrqu->encoding; -+ struct iw_encode_ext *pext = (struct iw_encode_ext *)extra; ++ struct iw_encode_ext *pext = (struct iw_encode_ext *)extra; + int ret=0; + + param_len = sizeof(struct ieee_param) + pext->key_len; + param = (struct ieee_param *)rtw_malloc(param_len); + if (param == NULL) + return -1; -+ ++ + _rtw_memset(param, 0, param_len); + + param->cmd = IEEE_CMD_SET_ENCRYPTION; @@ -354545,8 +164495,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + switch (pext->alg) { + case IW_ENCODE_ALG_NONE: -+ //todo: remove key -+ //remove = 1; ++ //todo: remove key ++ //remove = 1; + alg_name = "none"; + break; + case IW_ENCODE_ALG_WEP: @@ -354558,11 +164508,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + case IW_ENCODE_ALG_CCMP: + alg_name = "CCMP"; + break; -+#ifdef CONFIG_IEEE80211W -+ case IW_ENCODE_ALG_AES_CMAC: -+ alg_name = "BIP"; -+ break; -+#endif //CONFIG_IEEE80211W +#ifdef CONFIG_WAPI_SUPPORT +#ifndef CONFIG_IOCTL_CFG80211 + case IW_ENCODE_ALG_SM4: @@ -354573,8 +164518,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#endif +#endif + default: -+ ret = -1; -+ goto exit; ++ return -1; + } + + strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN); @@ -354585,14 +164529,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + + /* cliW: WEP does not have group key -+ * just not checking GROUP key setting ++ * just not checking GROUP key setting + */ + if ((pext->alg != IW_ENCODE_ALG_WEP) && -+ ((pext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) -+#ifdef CONFIG_IEEE80211W -+ || (pext->ext_flags & IW_ENCODE_ALG_AES_CMAC) -+#endif //CONFIG_IEEE80211W -+ )) ++ (pext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)) + { + param->u.crypt.set_tx = 0; + } @@ -354606,8 +164546,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if(pext->alg == IW_ENCODE_ALG_SM4) + _rtw_memcpy(param->u.crypt.seq, pext->rx_seq, 16); + else -+#endif //CONFIG_IOCTL_CFG80211 -+#endif //CONFIG_WAPI_SUPPORT ++#endif ++#endif + _rtw_memcpy(param->u.crypt.seq, pext->rx_seq, 8); + } + @@ -354620,13 +164560,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + if (pencoding->flags & IW_ENCODE_DISABLED) + { -+ //todo: remove key ++ //todo: remove key + //remove = 1; + } + + ret = wpa_set_encryption(dev, param, param_len); + -+exit: + if(param) + { + rtw_mfree((u8*)param, param_len); @@ -354636,10 +164575,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +} + + -+static int rtw_wx_get_nick(struct net_device *dev, -+ struct iw_request_info *info, ++static int rtw_wx_get_nick(struct net_device *dev, ++ struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) -+{ ++{ + //_adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + //struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + //struct security_priv *psecuritypriv = &padapter->securitypriv; @@ -354653,19 +164592,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + //rtw_signal_process(pid, SIGUSR1); //for test + -+ //dump debug info here ++ //dump debug info here +/* + u32 dot11AuthAlgrthm; // 802.11 auth, could be open, shared, and 8021x + u32 dot11PrivacyAlgrthm; // This specify the privacy for shared auth. algorithm. -+ u32 dot118021XGrpPrivacy; // This specify the privacy algthm. used for Grp key ++ u32 dot118021XGrpPrivacy; // This specify the privacy algthm. used for Grp key + u32 ndisauthtype; + u32 ndisencryptstatus; +*/ + -+ //DBG_871X("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", ++ //DBG_871X("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", + // psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, + // psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus); -+ ++ + //DBG_871X("enc_alg=0x%x\n", psecuritypriv->dot11PrivacyAlgrthm); + //DBG_871X("auth_type=0x%x\n", psecuritypriv->ndisauthtype); + //DBG_871X("enc_type=0x%x\n", psecuritypriv->ndisencryptstatus); @@ -354676,7 +164615,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("dbg(0x280)=0x%x\n", rtw_read32(padapter, 0x280)); + DBG_871X("dbg(0x284)=0x%x\n", rtw_read32(padapter, 0x284)); + DBG_871X("dbg(0x288)=0x%x\n", rtw_read32(padapter, 0x288)); -+ ++ + DBG_871X("dbg(0x664)=0x%x\n", rtw_read32(padapter, 0x664)); + + @@ -354686,18 +164625,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("dbg(0x438)=0x%x\n", rtw_read32(padapter, 0x438)); + + DBG_871X("dbg(0x440)=0x%x\n", rtw_read32(padapter, 0x440)); -+ ++ + DBG_871X("dbg(0x458)=0x%x\n", rtw_read32(padapter, 0x458)); -+ ++ + DBG_871X("dbg(0x484)=0x%x\n", rtw_read32(padapter, 0x484)); + DBG_871X("dbg(0x488)=0x%x\n", rtw_read32(padapter, 0x488)); -+ ++ + DBG_871X("dbg(0x444)=0x%x\n", rtw_read32(padapter, 0x444)); + DBG_871X("dbg(0x448)=0x%x\n", rtw_read32(padapter, 0x448)); + DBG_871X("dbg(0x44c)=0x%x\n", rtw_read32(padapter, 0x44c)); + DBG_871X("dbg(0x450)=0x%x\n", rtw_read32(padapter, 0x450)); +#endif -+ ++ + return 0; + +} @@ -354713,23 +164652,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + u32 data32; + u32 bytes; + u8 *ptmp; -+ int ret; + + -+ ret = 0; + padapter = (PADAPTER)rtw_netdev_priv(dev); + p = &wrqu->data; + len = p->length; -+ if (0 == len) -+ return -EINVAL; -+ + ptmp = (u8*)rtw_malloc(len); + if (NULL == ptmp) + return -ENOMEM; + + if (copy_from_user(ptmp, p->pointer, len)) { -+ ret = -EFAULT; -+ goto exit; ++ rtw_mfree(ptmp, len); ++ return -EFAULT; + } + + bytes = 0; @@ -354751,12 +164685,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + break; + default: + DBG_871X(KERN_INFO "%s: usage> read [bytes],[address(hex)]\n", __func__); -+ ret = -EINVAL; -+ goto exit; ++ return -EINVAL; + } + DBG_871X(KERN_INFO "%s: addr=0x%08X data=%s\n", __func__, addr, extra); + -+exit: + rtw_mfree(ptmp, len); + + return 0; @@ -354847,13 +164779,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +static int dummy(struct net_device *dev, struct iw_request_info *a, + union iwreq_data *wrqu, char *b) +{ -+ //_adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ //_adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + //struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + + //DBG_871X("cmd_code=%x, fwstate=0x%x\n", a->cmd, get_fwstate(pmlmepriv)); -+ ++ + return -1; -+ ++ +} + +static int rtw_wx_set_channel_plan(struct net_device *dev, @@ -354861,10 +164793,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + union iwreq_data *wrqu, char *extra) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct registry_priv *pregistrypriv = &padapter->registrypriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ extern int rtw_channel_plan; + u8 channel_plan_req = (u8) (*((int *)wrqu)); + -+ if (_SUCCESS != rtw_set_channel_plan(padapter, channel_plan_req)) ++ #if 0 ++ rtw_channel_plan = (int)wrqu->data.pointer; ++ pregistrypriv->channel_plan = rtw_channel_plan; ++ pmlmepriv->ChannelPlan = pregistrypriv->channel_plan; ++ #endif ++ ++ if( _SUCCESS == rtw_set_chplan_cmd(padapter, channel_plan_req, 1) ) { ++ DBG_871X("%s set channel_plan = 0x%02X\n", __func__, pmlmepriv->ChannelPlan); ++ } else + return -EPERM; + + return 0; @@ -354874,14 +164816,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *a, + union iwreq_data *wrqu, char *b) +{ -+#ifdef CONFIG_PLATFORM_MT53XX -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_notice_, -+ ("WLAN IOCTL: cmd_code=%x, fwstate=0x%x\n", -+ a->cmd, get_fwstate(pmlmepriv))); -+#endif + return 0; +} + @@ -354889,14 +164823,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *buf) +{ -+#ifdef CONFIG_PLATFORM_MT53XX -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ // Modified by Albert 20110914 -+ // This is in dbm format for MTK platform. -+ wrqu->qual.level = padapter->recvpriv.rssi; -+ DBG_871X(" level = %u\n", wrqu->qual.level ); -+#endif + return 0; +} + @@ -354904,13 +164830,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+#ifdef CONFIG_PLATFORM_MT53XX -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ return rtw_set_wpa_ie(padapter, wrqu->data.pointer, wrqu->data.length); -+#else + return 0; -+#endif +} + +/* @@ -354936,8 +164856,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + +#ifdef CONFIG_DRVEXT_MODULE + u8 res; -+ struct drvext_handler *phandler; -+ struct drvext_oidparam *poidparam; ++ struct drvext_handler *phandler; ++ struct drvext_oidparam *poidparam; + int ret; + u16 len; + u8 *pparmbuf, bset; @@ -354948,8 +164868,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ret = -EINVAL; + goto _rtw_drvext_hdl_exit; + } -+ -+ ++ ++ + bset = (u8)(p->flags&0xFFFF); + len = p->length; + pparmbuf = (u8*)rtw_malloc(len); @@ -354957,32 +164877,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ret = -ENOMEM; + goto _rtw_drvext_hdl_exit; + } -+ ++ + if(bset)//set info + { + if (copy_from_user(pparmbuf, p->pointer,len)) { + rtw_mfree(pparmbuf, len); + ret = -EFAULT; + goto _rtw_drvext_hdl_exit; -+ } ++ } + } + else//query info + { -+ ++ + } + -+ ++ + // -+ poidparam = (struct drvext_oidparam *)pparmbuf; -+ ++ poidparam = (struct drvext_oidparam *)pparmbuf; ++ + RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("drvext set oid subcode [%d], len[%d], InformationBufferLength[%d]\r\n", -+ poidparam->subcode, poidparam->len, len)); ++ poidparam->subcode, poidparam->len, len)); + + -+ //check subcode ++ //check subcode + if ( poidparam->subcode >= MAX_DRVEXT_HANDLERS) + { -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("no matching drvext handlers\r\n")); ++ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("no matching drvext handlers\r\n")); + ret = -EINVAL; + goto _rtw_drvext_hdl_exit; + } @@ -354990,7 +164910,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + if ( poidparam->subcode >= MAX_DRVEXT_OID_SUBCODES) + { -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("no matching drvext subcodes\r\n")); ++ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("no matching drvext subcodes\r\n")); + ret = -EINVAL; + goto _rtw_drvext_hdl_exit; + } @@ -355000,9 +164920,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + if (poidparam->len != phandler->parmsize) + { -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("no matching drvext param size %d vs %d\r\n", -+ poidparam->len , phandler->parmsize)); -+ ret = -EINVAL; ++ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("no matching drvext param size %d vs %d\r\n", ++ poidparam->len , phandler->parmsize)); ++ ret = -EINVAL; + goto _rtw_drvext_hdl_exit; + } + @@ -355012,21 +164932,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if(res==0) + { + ret = 0; -+ ++ + if (bset == 0x00) {//query info + //_rtw_memcpy(p->pointer, pparmbuf, len); + if (copy_to_user(p->pointer, pparmbuf, len)) + ret = -EFAULT; -+ } -+ } ++ } ++ } + else + ret = -EFAULT; + -+ -+_rtw_drvext_hdl_exit: -+ -+ return ret; -+ ++ ++_rtw_drvext_hdl_exit: ++ ++ return ret; ++ +#endif + + return 0; @@ -355035,7 +164955,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + +static void rtw_dbg_mode_hdl(_adapter *padapter, u32 id, u8 *pdata, u32 len) +{ -+ pRW_Reg RegRWStruct; ++ pRW_Reg RegRWStruct; + struct rf_reg_param *prfreg; + u8 path; + u8 offset; @@ -355064,7 +164984,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + default: + break; + } -+ ++ + break; + case GEN_MP_IOCTL_SUBCODE(WRITE_REG): + RegRWStruct = (pRW_Reg)pdata; @@ -355079,40 +164999,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + case 4: + rtw_write32(padapter, RegRWStruct->offset, (u32)RegRWStruct->value); + break; -+ default: ++ default: + break; + } -+ ++ + break; + case GEN_MP_IOCTL_SUBCODE(READ_RF_REG): + + prfreg = (struct rf_reg_param *)pdata; + -+ path = (u8)prfreg->path; -+ offset = (u8)prfreg->offset; ++ path = (u8)prfreg->path; ++ offset = (u8)prfreg->offset; + + value = rtw_hal_read_rfreg(padapter, path, offset, 0xffffffff); + + prfreg->value = value; + -+ break; ++ break; + case GEN_MP_IOCTL_SUBCODE(WRITE_RF_REG): + + prfreg = (struct rf_reg_param *)pdata; + + path = (u8)prfreg->path; -+ offset = (u8)prfreg->offset; ++ offset = (u8)prfreg->offset; + value = prfreg->value; + + rtw_hal_write_rfreg(padapter, path, offset, 0xffffffff, value); -+ -+ break; ++ ++ break; + case GEN_MP_IOCTL_SUBCODE(TRIGGER_GPIO): + DBG_871X("==> trigger gpio 0\n"); -+ rtw_hal_set_hwreg(padapter, HW_VAR_TRIGGER_GPIO_0, 0); -+ break; ++ rtw_hal_set_hwreg(padapter, HW_VAR_TRIGGER_GPIO_0, NULL); ++ break; +#ifdef CONFIG_BT_COEXIST -+ case GEN_MP_IOCTL_SUBCODE(SET_DM_BT): ++ case GEN_MP_IOCTL_SUBCODE(SET_DM_BT): + DBG_871X("==> set dm_bt_coexist:%x\n",*(u8 *)pdata); + rtw_hal_set_hwreg(padapter, HW_VAR_BT_SET_COEXIST, pdata); + break; @@ -355122,15 +165042,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + break; +#endif +#ifdef DBG_CONFIG_ERROR_DETECT -+ case GEN_MP_IOCTL_SUBCODE(GET_WIFI_STATUS): -+ *pdata = rtw_hal_sreset_get_wifi_status(padapter); ++ case GEN_MP_IOCTL_SUBCODE(GET_WIFI_STATUS): ++ *pdata = rtw_hal_sreset_get_wifi_status(padapter); + break; +#endif -+ ++ + default: + break; + } -+ ++ +} + +static int rtw_mp_ioctl_hdl(struct net_device *dev, struct iw_request_info *info, @@ -355182,9 +165102,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + + //DBG_871X("%s: %d\n", __func__, poidparam->subcode); -+#ifdef CONFIG_MP_INCLUDED ++#ifdef CONFIG_MP_INCLUDED +if (padapter->registrypriv.mp_mode == 1) -+{ ++{ + phandler = mp_ioctl_hdl + poidparam->subcode; + + if ((phandler->paramsize != 0) && (poidparam->len < phandler->paramsize)) @@ -355222,7 +165142,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + //todo:check status, BytesNeeded, etc. + } + else { -+ DBG_871X("rtw_mp_ioctl_hdl(): err!, subcode=%d, oid=%d, handler=%p\n", ++ DBG_871X("rtw_mp_ioctl_hdl(): err!, subcode=%d, oid=%d, handler=%p\n", + poidparam->subcode, phandler->oid, phandler->handler); + ret = -EFAULT; + goto _rtw_mp_ioctl_hdl_exit; @@ -355266,28 +165186,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + u8 bssid[ETH_ALEN]; + char data[32]; + struct wlan_network *pnetwork = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + _queue *queue = &(pmlmepriv->scanned_queue); -+ struct iw_point *pdata = &wrqu->data; ++ struct iw_point *pdata = &wrqu->data; + + DBG_871X("+rtw_get_aplist_info\n"); + -+ if (rtw_is_drv_stopped(padapter) || (pdata == NULL)) { ++ if((padapter->bDriverStopped) || (pdata==NULL)) ++ { + ret= -EINVAL; + goto exit; -+ } -+ -+ while((check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING))) == _TRUE) -+ { ++ } ++ ++ while((check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING))) == true) ++ { + rtw_msleep_os(30); + cnt++; + if(cnt > 100) + break; + } -+ + -+ //pdata->length = 0;//? ++ ++ //pdata->length = 0;//? + pdata->flags = 0; + if(pdata->length>=32) + { @@ -355296,40 +165217,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ret= -EINVAL; + goto exit; + } -+ } ++ } + else + { + ret= -EINVAL; + goto exit; -+ } ++ } + + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ ++ + phead = get_list_head(queue); + plist = get_next(phead); -+ ++ + while(1) + { -+ if (rtw_end_of_queue_search(phead,plist)== _TRUE) ++ if (rtw_end_of_queue_search(phead,plist)== true) + break; + + + pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); + -+ //if(hwaddr_aton_i(pdata->pointer, bssid)) -+ if(hwaddr_aton_i(data, bssid)) -+ { ++ //if(hwaddr_aton_i(pdata->pointer, bssid)) ++ if(hwaddr_aton_i(data, bssid)) ++ { + DBG_871X("Invalid BSSID '%s'.\n", (u8*)data); + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + return -EINVAL; -+ } -+ -+ -+ if(_rtw_memcmp(bssid, pnetwork->network.MacAddress, ETH_ALEN) == _TRUE)//BSSID match, then check if supporting wpa/wpa2 ++ } ++ ++ ++ if(_rtw_memcmp(bssid, pnetwork->network.MacAddress, ETH_ALEN) == true)//BSSID match, then check if supporting wpa/wpa2 + { + DBG_871X("BSSID:" MAC_FMT "\n", MAC_ARG(bssid)); -+ -+ pbuf = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength-12); ++ ++ pbuf = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength-12); + if(pbuf && (wpa_ielen>0)) + { + pdata->flags = 1; @@ -355342,45 +165263,46 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + pdata->flags = 2; + break; + } -+ ++ + } + -+ plist = get_next(plist); -+ -+ } ++ plist = get_next(plist); ++ ++ } + + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + + if(pdata->length>=34) + { -+ if(copy_to_user((u8*)pdata->pointer+32, (u8*)&pdata->flags, 1)) ++ if(copy_to_user((u8 __user *)pdata->pointer+32, (u8*)&pdata->flags, 1)) + { + ret= -EINVAL; + goto exit; + } -+ } -+ ++ } ++ +exit: -+ ++ + return ret; -+ ++ +} + +static int rtw_set_pid(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = rtw_netdev_priv(dev); + int *pdata = (int *)wrqu; + int selector; + -+ if (rtw_is_drv_stopped(padapter) || (pdata == NULL)) { ++ if((padapter->bDriverStopped) || (pdata==NULL)) ++ { + ret= -EINVAL; + goto exit; -+ } -+ ++ } ++ + selector = *pdata; + if(selector < 3 && selector >=0) { + padapter->pid[selector] = *(pdata+1); @@ -355393,28 +165315,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("%s selector %d error\n", __FUNCTION__, selector); + +exit: -+ ++ + return ret; -+ ++ +} + +static int rtw_wps_start(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_point *pdata = &wrqu->data; + u32 u32wps_start = 0; + unsigned int uintRet = 0; + -+ if (RTW_CANNOT_RUN(padapter) || (NULL == pdata)) { ++ uintRet = copy_from_user( ( void* ) &u32wps_start, pdata->pointer, 4 ); ++ ++ if((padapter->bDriverStopped) || (pdata==NULL)) ++ { + ret= -EINVAL; + goto exit; -+ } ++ } + -+ uintRet = copy_from_user( ( void* ) &u32wps_start, pdata->pointer, 4 ); + if ( u32wps_start == 0 ) + { + u32wps_start = *extra; @@ -355438,11 +165362,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#ifdef CONFIG_INTEL_WIDI + process_intel_widi_wps_status(padapter, u32wps_start); +#endif //CONFIG_INTEL_WIDI -+ ++ +exit: -+ ++ + return ret; -+ ++ +} + +#ifdef CONFIG_P2P @@ -355450,13 +165374,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; ++ ++ int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + enum P2P_ROLE init_role = P2P_ROLE_DISABLE; + + if(*extra == '0' ) @@ -355475,8 +165400,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + + //set channel/bandwidth -+ if(init_role != P2P_ROLE_DISABLE) -+ { ++ if(init_role != P2P_ROLE_DISABLE) ++ { + u8 channel, ch_offset; + u16 bwmode; + @@ -355495,7 +165420,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + //struct wifidirect_info *pbuddy_wdinfo = &pbuddy_adapter->wdinfo; + struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; + struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ ++ + _set_timer( &pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_interval ); + if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) + { @@ -355515,10 +165440,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + else + { + pwdinfo->operating_channel = pmlmeext->cur_channel; -+ ++ + channel = pwdinfo->operating_channel; + ch_offset = pmlmeext->cur_ch_offset; -+ bwmode = pmlmeext->cur_bwmode; ++ bwmode = pmlmeext->cur_bwmode; + } + + set_channel_bwmode(padapter, channel, ch_offset, bwmode); @@ -355526,26 +165451,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + +exit: + return ret; -+ ++ +} + +static int rtw_p2p_set_go_nego_ssid(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; ++ ++ int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); + + DBG_871X( "[%s] ssid = %s, len = %zu\n", __FUNCTION__, extra, strlen( extra ) ); + _rtw_memcpy( pwdinfo->nego_ssid, extra, strlen( extra ) ); + pwdinfo->nego_ssidlen = strlen( extra ); -+ ++ + return ret; -+ ++ +} + + @@ -355553,14 +165478,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); + u8 intent = pwdinfo->intent; + -+ extra[ wrqu->data.length ] = 0x00; -+ -+ intent = rtw_atoi( extra ); ++ switch( wrqu->data.length ) ++ { ++ case 1: ++ { ++ intent = extra[ 0 ] - '0'; ++ break; ++ } ++ case 2: ++ { ++ intent = str_2char2num( extra[ 0 ], extra[ 1 ]); ++ break; ++ } ++ } + + if ( intent <= 15 ) + { @@ -355570,25 +165505,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + ret = -1; + } -+ ++ + DBG_871X( "[%s] intent = %d\n", __FUNCTION__, intent); + + return ret; -+ ++ +} + +static int rtw_p2p_set_listen_ch(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; ++ ++ int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); + u8 listen_ch = pwdinfo->listen_channel; // Listen channel number + -+ extra[ wrqu->data.length ] = 0x00; -+ listen_ch = rtw_atoi( extra ); ++ switch( wrqu->data.length ) ++ { ++ case 1: ++ { ++ listen_ch = extra[ 0 ] - '0'; ++ break; ++ } ++ case 2: ++ { ++ listen_ch = str_2char2num( extra[ 0 ], extra[ 1 ]); ++ break; ++ } ++ } + + if ( ( listen_ch == 1 ) || ( listen_ch == 6 ) || ( listen_ch == 11 ) ) + { @@ -355599,11 +165545,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + ret = -1; + } -+ ++ + DBG_871X( "[%s] listen_ch = %d\n", __FUNCTION__, pwdinfo->listen_channel ); -+ ++ + return ret; -+ ++ +} + +static int rtw_p2p_set_op_ch(struct net_device *dev, @@ -355613,14 +165559,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +// Commented by Albert 20110524 +// This function is used to set the operating channel if the driver will become the group owner + -+ int ret = 0; ++ int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); + u8 op_ch = pwdinfo->operating_channel; // Operating channel number + -+ extra[ wrqu->data.length ] = 0x00; ++ switch( wrqu->data.length ) ++ { ++ case 1: ++ { ++ op_ch = extra[ 0 ] - '0'; ++ break; ++ } ++ case 2: ++ { ++ op_ch = str_2char2num( extra[ 0 ], extra[ 1 ]); ++ break; ++ } ++ } + -+ op_ch = ( u8 ) rtw_atoi( extra ); + if ( op_ch > 0 ) + { + pwdinfo->operating_channel = op_ch; @@ -355629,9 +165586,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + ret = -1; + } -+ ++ + DBG_871X( "[%s] op_ch = %d\n", __FUNCTION__, pwdinfo->operating_channel ); -+ ++ + return ret; + +} @@ -355641,8 +165598,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; ++ ++ int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); + @@ -355658,7 +165615,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + DBG_871X( "[%s] In value = %s, len = %d \n", __FUNCTION__, extra, wrqu->data.length -1); + -+ ++ + // The upper application should pass the SSID to driver by using this rtw_p2p_profilefound function. + if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) + { @@ -355677,7 +165634,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + else + { + int jj, kk; -+ ++ + // Add this profile information into pwdinfo->profileinfo + // Ex: 1XX:XX:XX:XX:XX:XXYYSSID + for( jj = 0, kk = 1; jj < ETH_ALEN; jj++, kk += 3 ) @@ -355690,18 +165647,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + pwdinfo->profileindex++; + } + } -+ } -+ ++ } ++ + return ret; -+ ++ +} + +static int rtw_p2p_setDN(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; ++ ++ int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); + @@ -355712,7 +165669,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + pwdinfo->device_name_len = wrqu->data.length - 1; + + return ret; -+ ++ +} + + @@ -355720,18 +165677,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); +#ifdef CONFIG_CONCURRENT_MODE + _adapter *pbuddy_adapter = padapter->pbuddy_adapter; + struct wifidirect_info *pbuddy_wdinfo = &pbuddy_adapter->wdinfo; + struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; ++ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; +#endif -+ ++ + if ( padapter->bShowGetP2PState ) + { + DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), @@ -355746,11 +165703,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + wrqu->data.length = strlen( extra ); + + return ret; -+ ++ +} + +// Commented by Albert 20110520 -+// This function will return the config method description ++// This function will return the config method description +// This config method description will show us which config method the remote P2P device is intented to use +// by sending the provisioning discovery request frame. + @@ -355758,8 +165715,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; ++ ++ int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); @@ -355767,7 +165724,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + sprintf( extra, "\n\nCM=%s\n", pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req ); + wrqu->data.length = strlen( extra ); + return ret; -+ ++ +} + + @@ -355775,13 +165732,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + -+ ++ + DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), + pwdinfo->p2p_peer_interface_addr[ 0 ], pwdinfo->p2p_peer_interface_addr[ 1 ], pwdinfo->p2p_peer_interface_addr[ 2 ], + pwdinfo->p2p_peer_interface_addr[ 3 ], pwdinfo->p2p_peer_interface_addr[ 4 ], pwdinfo->p2p_peer_interface_addr[ 5 ]); @@ -355789,7 +165746,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + sprintf( extra, "\n\nRole=%.2d\n", rtw_p2p_role(pwdinfo) ); + wrqu->data.length = strlen( extra ); + return ret; -+ ++ +} + + @@ -355797,9 +165754,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + @@ -355813,7 +165770,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + pwdinfo->p2p_peer_interface_addr[ 3 ], pwdinfo->p2p_peer_interface_addr[ 4 ], pwdinfo->p2p_peer_interface_addr[ 5 ]); + wrqu->data.length = strlen( extra ); + return ret; -+ ++ +} + +static int rtw_p2p_get_peer_devaddr(struct net_device *dev, @@ -355821,23 +165778,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + union iwreq_data *wrqu, char *extra) + +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + + DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), -+ pwdinfo->rx_prov_disc_info.peerDevAddr[ 0 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 1 ], ++ pwdinfo->rx_prov_disc_info.peerDevAddr[ 0 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 1 ], + pwdinfo->rx_prov_disc_info.peerDevAddr[ 2 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 3 ], + pwdinfo->rx_prov_disc_info.peerDevAddr[ 4 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 5 ]); + sprintf( extra, "\n%.2X%.2X%.2X%.2X%.2X%.2X", -+ pwdinfo->rx_prov_disc_info.peerDevAddr[ 0 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 1 ], ++ pwdinfo->rx_prov_disc_info.peerDevAddr[ 0 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 1 ], + pwdinfo->rx_prov_disc_info.peerDevAddr[ 2 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 3 ], + pwdinfo->rx_prov_disc_info.peerDevAddr[ 4 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 5 ]); -+ wrqu->data.length = strlen( extra ); ++ wrqu->data.length = strlen( extra ); + return ret; -+ ++ +} + +static int rtw_p2p_get_peer_devaddr_by_invitation(struct net_device *dev, @@ -355845,23 +165802,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + union iwreq_data *wrqu, char *extra) + +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + + DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), -+ pwdinfo->p2p_peer_device_addr[ 0 ], pwdinfo->p2p_peer_device_addr[ 1 ], ++ pwdinfo->p2p_peer_device_addr[ 0 ], pwdinfo->p2p_peer_device_addr[ 1 ], + pwdinfo->p2p_peer_device_addr[ 2 ], pwdinfo->p2p_peer_device_addr[ 3 ], + pwdinfo->p2p_peer_device_addr[ 4 ], pwdinfo->p2p_peer_device_addr[ 5 ]); + sprintf( extra, "\nMAC %.2X:%.2X:%.2X:%.2X:%.2X:%.2X", -+ pwdinfo->p2p_peer_device_addr[ 0 ], pwdinfo->p2p_peer_device_addr[ 1 ], ++ pwdinfo->p2p_peer_device_addr[ 0 ], pwdinfo->p2p_peer_device_addr[ 1 ], + pwdinfo->p2p_peer_device_addr[ 2 ], pwdinfo->p2p_peer_device_addr[ 3 ], + pwdinfo->p2p_peer_device_addr[ 4 ], pwdinfo->p2p_peer_device_addr[ 5 ]); -+ wrqu->data.length = strlen( extra ); ++ wrqu->data.length = strlen( extra ); + return ret; -+ ++ +} + +static int rtw_p2p_get_groupid(struct net_device *dev, @@ -355869,20 +165826,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + union iwreq_data *wrqu, char *extra) + +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + + sprintf( extra, "\n%.2X:%.2X:%.2X:%.2X:%.2X:%.2X %s", -+ pwdinfo->groupid_info.go_device_addr[ 0 ], pwdinfo->groupid_info.go_device_addr[ 1 ], ++ pwdinfo->groupid_info.go_device_addr[ 0 ], pwdinfo->groupid_info.go_device_addr[ 1 ], + pwdinfo->groupid_info.go_device_addr[ 2 ], pwdinfo->groupid_info.go_device_addr[ 3 ], + pwdinfo->groupid_info.go_device_addr[ 4 ], pwdinfo->groupid_info.go_device_addr[ 5 ], + pwdinfo->groupid_info.ssid); -+ wrqu->data.length = strlen( extra ); ++ wrqu->data.length = strlen( extra ); + return ret; -+ ++ +} + +static int rtw_p2p_get_op_ch(struct net_device *dev, @@ -355890,26 +165847,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + union iwreq_data *wrqu, char *extra) + +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + -+ ++ + DBG_871X( "[%s] Op_ch = %02x\n", __FUNCTION__, pwdinfo->operating_channel); -+ ++ + sprintf( extra, "\n\nOp_ch=%.2d\n", pwdinfo->operating_channel ); + wrqu->data.length = strlen( extra ); + return ret; -+ ++ ++} ++ ++inline static void macstr2num(u8 *dst, u8 *src) ++{ ++ int jj, kk; ++ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) ++ { ++ dst[jj] = key_2char2num(src[kk], src[kk + 1]); ++ } +} + +static int rtw_p2p_get_wps_configmethod(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra, char *subcmd) -+{ -+ ++{ ++ + int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + u8 peerMAC[ETH_ALEN] = { 0x00 }; @@ -355920,6 +165886,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct wlan_network *pnetwork = NULL; + u8 blnMatch = 0; + u16 attr_content = 0; ++ __be16 be_tmp; + uint attr_contentlen = 0; + u8 attr_content_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; + @@ -355939,7 +165906,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + while (1) + { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) break; ++ if (rtw_end_of_queue_search(phead, plist) == true) break; + + pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); + if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) @@ -355949,12 +165916,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + // The mac address is matched. + -+ if ( (wpsie=rtw_get_wps_ie_from_scan_queue( &pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &wpsie_len, pnetwork->network.Reserved[0])) ) ++ if ((wpsie = rtw_get_wps_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &wpsie_len))) + { -+ rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_CONF_METHOD, (u8 *)&attr_content, &attr_contentlen); ++ rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_CONF_METHOD, (u8 *)&be_tmp, &attr_contentlen); + if (attr_contentlen) + { -+ attr_content = be16_to_cpu(attr_content); ++ attr_content = be16_to_cpu(be_tmp); + sprintf(attr_content_str, "\n\nM=%.4d", attr_content); + blnMatch = 1; + } @@ -355977,8 +165944,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + wrqu->data.length = strlen(attr_content_str); + _rtw_memcpy(extra, attr_content_str, wrqu->data.length); + -+ return ret; -+ ++ return ret; ++ +} + +#ifdef CONFIG_WFD @@ -355986,9 +165953,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + @@ -355996,19 +165963,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + sprintf( extra, "\n\nPort=%d\n", pwdinfo->wfd_info->peer_rtsp_ctrlport ); + DBG_871X( "[%s] remote port = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_rtsp_ctrlport ); -+ ++ + wrqu->data.length = strlen( extra ); + return ret; -+ ++ +} + +static int rtw_p2p_get_peer_wfd_preferred_connection(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + @@ -356016,18 +165983,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X( "[%s] wfd_pc = %d\n", __FUNCTION__, pwdinfo->wfd_info->wfd_pc ); + + wrqu->data.length = strlen( extra ); -+ pwdinfo->wfd_info->wfd_pc = _FALSE; // Reset the WFD preferred connection to P2P ++ pwdinfo->wfd_info->wfd_pc = false; // Reset the WFD preferred connection to P2P + return ret; -+ ++ +} + +static int rtw_p2p_get_peer_wfd_session_available(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + @@ -356035,9 +166002,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X( "[%s] wfd_sa = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_session_avail ); + + wrqu->data.length = strlen( extra ); -+ pwdinfo->wfd_info->peer_session_avail = _TRUE; // Reset the WFD session available ++ pwdinfo->wfd_info->peer_session_avail = true; // Reset the WFD session available + return ret; -+ ++ +} + +#endif // CONFIG_WFD @@ -356047,7 +166014,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + union iwreq_data *wrqu, char *extra, char *subcmd) +{ + -+ int ret = 0; ++ int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + u8 peerMAC[ETH_ALEN] = { 0x00 }; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -356076,7 +166043,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + while (1) + { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) break; ++ if (rtw_end_of_queue_search(phead, plist) == true) break; + + pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); + if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) @@ -356085,7 +166052,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + // Match the device address located in the P2P IE + // This is for the case that the P2P device address is not the same as the P2P interface address. + -+ if ((p2pie = rtw_get_p2p_ie_from_scan_queue( &pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &p2pielen, pnetwork->network.Reserved[0]))) ++ if ((p2pie = rtw_get_p2p_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen))) + { + while (p2pie) + { @@ -356130,15 +166097,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + wrqu->data.length = strlen(go_devadd_str); + _rtw_memcpy(extra, go_devadd_str, wrqu->data.length); + -+ return ret; -+ ++ return ret; ++ +} + +static int rtw_p2p_get_device_type(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra, char *subcmd) -+{ -+ ++{ ++ + int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + u8 peerMAC[ETH_ALEN] = { 0x00 }; @@ -356168,7 +166135,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + while (1) + { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) break; ++ if (rtw_end_of_queue_search(phead, plist) == true) break; + + pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); + if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) @@ -356178,15 +166145,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + // The mac address is matched. + -+ if ( (wpsie=rtw_get_wps_ie_from_scan_queue( &pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &wpsie_len, pnetwork->network.Reserved[0])) ) ++ if ((wpsie = rtw_get_wps_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &wpsie_len))) + { + rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_PRIMARY_DEV_TYPE, dev_type, &dev_type_len); + if (dev_type_len) + { -+ u16 type = 0; ++ u16 type; ++ __be16 be_tmp; + -+ _rtw_memcpy(&type, dev_type, 2); -+ type = be16_to_cpu(type); ++ _rtw_memcpy(&be_tmp, dev_type, 2); ++ type = be16_to_cpu(be_tmp); + sprintf(dev_type_str, "\n\nN=%.2d", type); + blnMatch = 1; + } @@ -356208,15 +166176,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + wrqu->data.length = strlen(dev_type_str); + _rtw_memcpy(extra, dev_type_str, wrqu->data.length); + -+ return ret; -+ ++ return ret; ++ +} + +static int rtw_p2p_get_device_name(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra, char *subcmd) -+{ -+ ++{ ++ + int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + u8 peerMAC[ETH_ALEN] = { 0x00 }; @@ -356246,7 +166214,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + while (1) + { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) break; ++ if (rtw_end_of_queue_search(phead, plist) == true) break; + + pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); + if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) @@ -356256,7 +166224,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + // The mac address is matched. + -+ if ( (wpsie=rtw_get_wps_ie_from_scan_queue( &pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &wpsie_len, pnetwork->network.Reserved[0])) ) ++ if ((wpsie = rtw_get_wps_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &wpsie_len))) + { + rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_DEVICE_NAME, dev_name, &dev_len); + if (dev_len) @@ -356282,8 +166250,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + wrqu->data.length = strlen(dev_name_str); + _rtw_memcpy(extra, dev_name_str, wrqu->data.length); + -+ return ret; -+ ++ return ret; ++ +} + +static int rtw_p2p_get_invitation_procedure(struct net_device *dev, @@ -356291,7 +166259,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + union iwreq_data *wrqu, char *extra, char *subcmd) +{ + -+ int ret = 0; ++ int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + u8 peerMAC[ETH_ALEN] = { 0x00 }; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -356320,7 +166288,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + while (1) + { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) break; ++ if (rtw_end_of_queue_search(phead, plist) == true) break; + + pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); + if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) @@ -356329,7 +166297,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + // Match the device address located in the P2P IE + // This is for the case that the P2P device address is not the same as the P2P interface address. + -+ if ((p2pie = rtw_get_p2p_ie_from_scan_queue( &pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &p2pielen, pnetwork->network.Reserved[0]))) ++ if ((p2pie = rtw_get_p2p_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen))) + { + while (p2pie) + { @@ -356359,30 +166327,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + sprintf(inv_proc_str, "\nIP=-1"); + } else + { -+ if ((attr_content[0] & 0x20) == 0x20) ++ if (attr_content[0] && 0x20) ++ { + sprintf(inv_proc_str, "\nIP=1"); -+ else ++ } else ++ { + sprintf(inv_proc_str, "\nIP=0"); ++ } + } + + wrqu->data.length = strlen(inv_proc_str); + _rtw_memcpy(extra, inv_proc_str, wrqu->data.length); + -+ return ret; -+ ++ return ret; ++ +} + +static int rtw_p2p_connect(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + u8 peerMAC[ ETH_ALEN ] = { 0x00 }; -+ int jj,kk; -+ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; ++ int jj,kk; ++ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + _irqL irqL; + _list *plist, *phead; @@ -356393,7 +166364,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + _adapter *pbuddy_adapter = padapter->pbuddy_adapter; + struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; + struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif // CONFIG_CONCURRENT_MODE ++#endif // CONFIG_CONCURRENT_MODE + + // Commented by Albert 20110304 + // The input data contains two informations. @@ -356410,18 +166381,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + return ret; + } + -+#ifdef CONFIG_INTEL_WIDI -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { -+ DBG_871X( "[%s] WiFi is under survey!\n", __FUNCTION__ ); -+ return ret; -+ } -+#endif //CONFIG_INTEL_WIDI -+ + if ( pwdinfo->ui_got_wps_info == P2P_NO_WPSINFO ) + { + return -1; + } -+ ++ + for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 ) + { + peerMAC[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] ); @@ -356431,29 +166395,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + phead = get_list_head(queue); + plist = get_next(phead); -+ ++ + while(1) + { -+ if (rtw_end_of_queue_search(phead,plist)== _TRUE) ++ if (rtw_end_of_queue_search(phead,plist)== true) + break; + + pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); + if ( _rtw_memcmp( pnetwork->network.MacAddress, peerMAC, ETH_ALEN ) ) + { -+ if (pnetwork->network.Configuration.DSConfig != 0) -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ else if (pwdinfo->nego_req_info.peer_ch != 0) -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig = pwdinfo->nego_req_info.peer_ch; -+ else{ -+ /* Unexpected case */ -+ uintPeerChannel = 0; -+ DBG_871X("%s uintPeerChannel = 0\n", __func__); -+ } ++ uintPeerChannel = pnetwork->network.Configuration.DSConfig; + break; + } + + plist = get_next(plist); -+ ++ + } + + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); @@ -356469,10 +166425,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + _rtw_memset( &pwdinfo->nego_req_info, 0x00, sizeof( struct tx_nego_req_info ) ); + _rtw_memset( &pwdinfo->groupid_info, 0x00, sizeof( struct group_id_info ) ); -+ ++ + pwdinfo->nego_req_info.peer_channel_num[ 0 ] = uintPeerChannel; + _rtw_memcpy( pwdinfo->nego_req_info.peerDevAddr, pnetwork->network.MacAddress, ETH_ALEN ); -+ pwdinfo->nego_req_info.benable = _TRUE; ++ pwdinfo->nego_req_info.benable = true; + + _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); + if ( rtw_p2p_state(pwdinfo) != P2P_STATE_GONEGO_OK ) @@ -356489,7 +166445,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + // Have to enter the power saving with the AP + set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ ++ + issue_nulldata(pbuddy_adapter, NULL, 1, 3, 500); + } +#endif // CONFIG_CONCURRENT_MODE @@ -356507,28 +166463,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } +#else + _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_GO_NEGO_TIMEOUT ); -+#endif // CONFIG_CONCURRENT_MODE ++#endif // CONFIG_CONCURRENT_MODE + + } + else + { + DBG_871X( "[%s] Not Found in Scanning Queue~\n", __FUNCTION__ ); -+#ifdef CONFIG_INTEL_WIDI -+ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); -+ rtw_free_network_queue(padapter, _TRUE); -+ /** -+ * For WiDi, if we can't find candidate device in scanning queue, -+ * driver will do scanning itself -+ */ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ rtw_sitesurvey_cmd(padapter, NULL, 0, NULL, 0); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+#endif //CONFIG_INTEL_WIDI + ret = -1; + } -+exit: ++exit: + return ret; +} + @@ -356536,24 +166479,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ int jj,kk; -+ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; ++ int jj,kk; ++ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + _list *plist, *phead; + _queue *queue = &(pmlmepriv->scanned_queue); + struct wlan_network *pnetwork = NULL; + uint uintPeerChannel = 0; + u8 attr_content[50] = { 0x00 }, _status = 0; -+ u8 *p2pie; ++ u8 *p2pie; + uint p2pielen = 0, attr_contentlen = 0; + _irqL irqL; + struct tx_invite_req_info* pinvite_req_info = &pwdinfo->invitereq_info; -+ u8 ie_offset = 12; +#ifdef CONFIG_CONCURRENT_MODE + _adapter *pbuddy_adapter = padapter->pbuddy_adapter; + struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; @@ -356563,10 +166505,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#ifdef CONFIG_WFD + struct wifi_display_info* pwfd_info = pwdinfo->wfd_info; +#endif // CONFIG_WFD -+ ++ + // Commented by Albert 20120321 + // The input data contains two informations. -+ // 1. First information is the P2P device address which you want to send to. ++ // 1. First information is the P2P device address which you want to send to. + // 2. Second information is the group id which combines with GO's mac address, space and GO's ssid. + // Command line sample: iwpriv wlan0 p2p_set invite="00:11:22:33:44:55 00:E0:4C:00:00:05 DIRECT-xy" + // Format: 00:11:22:33:44:55 00:E0:4C:00:00:05 DIRECT-xy @@ -356587,7 +166529,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + else + { + // Reset the content of struct tx_invite_req_info -+ pinvite_req_info->benable = _FALSE; ++ pinvite_req_info->benable = false; + _rtw_memset( pinvite_req_info->go_bssid, 0x00, ETH_ALEN ); + _rtw_memset( pinvite_req_info->go_ssid, 0x00, WLAN_SSID_MAXLEN ); + pinvite_req_info->ssidlen = 0x00; @@ -356595,7 +166537,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + _rtw_memset( pinvite_req_info->peer_macaddr, 0x00, ETH_ALEN ); + pinvite_req_info->token = 3; + } -+ ++ + for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 ) + { + pinvite_req_info->peer_macaddr[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] ); @@ -356605,10 +166547,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + phead = get_list_head(queue); + plist = get_next(phead); -+ ++ + while(1) + { -+ if (rtw_end_of_queue_search(phead,plist)== _TRUE) ++ if (rtw_end_of_queue_search(phead,plist)== true) + break; + + pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); @@ -356617,8 +166559,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + // Match the device address located in the P2P IE + // This is for the case that the P2P device address is not the same as the P2P interface address. + -+ ie_offset = (pnetwork->network.Reserved[0] == 2? 0:12); -+ if ( (p2pie=rtw_get_p2p_ie_from_scan_queue( &pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &p2pielen, pnetwork->network.Reserved[0]))) ++ if ( (p2pie=rtw_get_p2p_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen)) ) + { + // The P2P Device ID attribute is included in the Beacon frame. + // The P2P Device Info attribute is included in the probe response frame. @@ -356639,13 +166580,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + uintPeerChannel = pnetwork->network.Configuration.DSConfig; + break; -+ } ++ } + } + + } + + plist = get_next(plist); -+ ++ + } + + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); @@ -356655,8 +166596,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + u8 wfd_ie[ 128 ] = { 0x00 }; + uint wfd_ielen = 0; -+ -+ if ( rtw_get_wfd_ie_from_scan_queue( &pnetwork->network.IEs[0], pnetwork->network.IELength, wfd_ie, &wfd_ielen, pnetwork->network.Reserved[0]) ) ++ ++ if ( rtw_get_wfd_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, wfd_ie, &wfd_ielen ) ) + { + u8 wfd_devinfo[ 6 ] = { 0x00 }; + uint wfd_devlen = 6; @@ -356665,23 +166606,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if ( rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, wfd_devinfo, &wfd_devlen ) ) + { + u16 wfd_devinfo_field = 0; -+ ++ + // Commented by Albert 20120319 + // The first two bytes are the WFD device information field of WFD device information subelement. + // In big endian format. + wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo); + if ( wfd_devinfo_field & WFD_DEVINFO_SESSION_AVAIL ) + { -+ pwfd_info->peer_session_avail = _TRUE; ++ pwfd_info->peer_session_avail = true; + } + else + { -+ pwfd_info->peer_session_avail = _FALSE; ++ pwfd_info->peer_session_avail = false; + } + } + } -+ -+ if ( _FALSE == pwfd_info->peer_session_avail ) ++ ++ if ( false == pwfd_info->peer_session_avail ) + { + DBG_871X( "[%s] WFD Session not avaiable!\n", __FUNCTION__ ); + goto exit; @@ -356707,7 +166648,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + // Store the GO's ssid + pinvite_req_info->ssidlen = wrqu->data.length - 36; + _rtw_memcpy( pinvite_req_info->go_ssid, &extra[ 36 ], (u32) pinvite_req_info->ssidlen ); -+ pinvite_req_info->benable = _TRUE; ++ pinvite_req_info->benable = true; + pinvite_req_info->peer_ch = uintPeerChannel; + + rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); @@ -356718,7 +166659,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + // Have to enter the power saving with the AP + set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ ++ + issue_nulldata(pbuddy_adapter, NULL, 1, 3, 500); + } + else @@ -356730,7 +166671,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#endif + + _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ ++ +#ifdef CONFIG_CONCURRENT_MODE + if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) + { @@ -356742,38 +166683,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } +#else + _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_INVITE_TIMEOUT ); -+#endif // CONFIG_CONCURRENT_MODE ++#endif // CONFIG_CONCURRENT_MODE ++ + -+ + } + else + { + DBG_871X( "[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__ ); + } +exit: -+ ++ + return ret; -+ ++ +} + +static int rtw_p2p_set_persistent(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ int jj,kk; -+ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; ++ int jj,kk; ++ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + _list *plist, *phead; + _queue *queue = &(pmlmepriv->scanned_queue); + struct wlan_network *pnetwork = NULL; + uint uintPeerChannel = 0; + u8 attr_content[50] = { 0x00 }, _status = 0; -+ u8 *p2pie; ++ u8 *p2pie; + uint p2pielen = 0, attr_contentlen = 0; + _irqL irqL; + struct tx_invite_req_info* pinvite_req_info = &pwdinfo->invitereq_info; @@ -356786,12 +166727,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#ifdef CONFIG_WFD + struct wifi_display_info* pwfd_info = pwdinfo->wfd_info; +#endif // CONFIG_WFD -+ ++ + // Commented by Albert 20120328 + // The input data is 0 or 1 + // 0: disable persistent group functionality + // 1: enable persistent group founctionality -+ ++ + DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra ); + + if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) @@ -356803,111 +166744,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + if ( extra[ 0 ] == '0' ) // Disable the persistent group function. + { -+ pwdinfo->persistent_supported = _FALSE; ++ pwdinfo->persistent_supported = false; + } + else if ( extra[ 0 ] == '1' ) // Enable the persistent group function. + { -+ pwdinfo->persistent_supported = _TRUE; ++ pwdinfo->persistent_supported = true; + } + else + { -+ pwdinfo->persistent_supported = _FALSE; ++ pwdinfo->persistent_supported = false; + } + } + printk( "[%s] persistent_supported = %d\n", __FUNCTION__, pwdinfo->persistent_supported ); -+ ++ +exit: -+ -+ return ret; -+ -+} -+ -+static int hexstr2bin(const char *hex, u8 *buf, size_t len) -+{ -+ size_t i; -+ int a; -+ const char *ipos = hex; -+ u8 *opos = buf; -+ -+ for (i = 0; i < len; i++) { -+ a = hex2byte_i(ipos); -+ if (a < 0) -+ return -1; -+ *opos++ = a; -+ ipos += 2; -+ } -+ return 0; -+} -+ -+static int uuid_str2bin(const char *str, u8 *bin) -+{ -+ const char *pos; -+ u8 *opos; -+ -+ pos = str; -+ opos = bin; -+ -+ if (hexstr2bin(pos, opos, 4)) -+ return -1; -+ pos += 8; -+ opos += 4; -+ -+ if (*pos++ != '-' || hexstr2bin(pos, opos, 2)) -+ return -1; -+ pos += 4; -+ opos += 2; -+ -+ if (*pos++ != '-' || hexstr2bin(pos, opos, 2)) -+ return -1; -+ pos += 4; -+ opos += 2; -+ -+ if (*pos++ != '-' || hexstr2bin(pos, opos, 2)) -+ return -1; -+ pos += 4; -+ opos += 2; -+ -+ if (*pos++ != '-' || hexstr2bin(pos, opos, 6)) -+ return -1; -+ -+ return 0; -+} -+ -+static int rtw_p2p_set_wps_uuid(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ DBG_871X("[%s] data = %s\n", __FUNCTION__, extra); -+ -+ if ((36 == strlen(extra)) && (uuid_str2bin(extra, pwdinfo->uuid) == 0)) -+ { -+ pwdinfo->external_uuid = 1; -+ } else { -+ pwdinfo->external_uuid = 0; -+ ret = -EINVAL; -+ } + + return ret; + +} ++ +#ifdef CONFIG_WFD +static int rtw_p2p_set_pc(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + u8 peerMAC[ ETH_ALEN ] = { 0x00 }; -+ int jj,kk; -+ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; ++ int jj,kk; ++ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + _list *plist, *phead; + _queue *queue = &(pmlmepriv->scanned_queue); @@ -356920,10 +166788,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#ifdef CONFIG_CONCURRENT_MODE + _adapter *pbuddy_adapter = padapter->pbuddy_adapter; + struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif // CONFIG_CONCURRENT_MODE -+ ++#endif // CONFIG_CONCURRENT_MODE ++ + struct wifi_display_info* pwfd_info = pwdinfo->wfd_info; -+ ++ + // Commented by Albert 20120512 + // 1. Input information is the MAC address which wants to know the Preferred Connection bit (PC bit) + // Format: 00:E0:4C:00:00:05 @@ -356935,7 +166803,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X( "[%s] WiFi Direct is disable!\n", __FUNCTION__ ); + return ret; + } -+ ++ + for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 ) + { + peerMAC[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] ); @@ -356945,10 +166813,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + phead = get_list_head(queue); + plist = get_next(phead); -+ ++ + while(1) + { -+ if (rtw_end_of_queue_search(phead,plist)== _TRUE) ++ if (rtw_end_of_queue_search(phead,plist)== true) + break; + + pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); @@ -356957,7 +166825,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + // Match the device address located in the P2P IE + // This is for the case that the P2P device address is not the same as the P2P interface address. + -+ if ( (p2pie=rtw_get_p2p_ie_from_scan_queue( &pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &p2pielen, pnetwork->network.Reserved[0]))) ++ if ( (p2pie=rtw_get_p2p_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen)) ) + { + // The P2P Device ID attribute is included in the Beacon frame. + // The P2P Device Info attribute is included in the probe response frame. @@ -356980,13 +166848,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + uintPeerChannel = pnetwork->network.Configuration.DSConfig; + break; -+ } ++ } + } + + } + + plist = get_next(plist); -+ ++ + } + + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); @@ -356996,9 +166864,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + u8 wfd_ie[ 128 ] = { 0x00 }; + uint wfd_ielen = 0; -+ u8 ie_offset = (pnetwork->network.Reserved[0] == 2 ? 0:12); + -+ if ( rtw_get_wfd_ie_from_scan_queue( &pnetwork->network.IEs[0], pnetwork->network.IELength, wfd_ie, &wfd_ielen, pnetwork->network.Reserved[0]) ) ++ if ( rtw_get_wfd_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, wfd_ie, &wfd_ielen ) ) + { + u8 wfd_devinfo[ 6 ] = { 0x00 }; + uint wfd_devlen = 6; @@ -357007,49 +166874,49 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if ( rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, wfd_devinfo, &wfd_devlen ) ) + { + u16 wfd_devinfo_field = 0; -+ ++ + // Commented by Albert 20120319 + // The first two bytes are the WFD device information field of WFD device information subelement. + // In big endian format. + wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo); + if ( wfd_devinfo_field & WFD_DEVINFO_PC_TDLS ) + { -+ pwfd_info->wfd_pc = _TRUE; ++ pwfd_info->wfd_pc = true; + } + else + { -+ pwfd_info->wfd_pc = _FALSE; ++ pwfd_info->wfd_pc = false; + } + } + } -+ } ++ } + else + { + DBG_871X( "[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__ ); + } + +exit: -+ ++ + return ret; -+ ++ +} + +static int rtw_p2p_set_wfd_device_type(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; -+ ++ + // Commented by Albert 20120328 + // The input data is 0 or 1 + // 0: specify to Miracast source device + // 1 or others: specify to Miracast sink device (display device) -+ ++ + DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra ); + + if ( extra[ 0 ] == '0' ) // Set to Miracast source device. @@ -357062,9 +166929,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + +exit: -+ ++ + return ret; -+ ++ +} + +static int rtw_p2p_set_wfd_enable(struct net_device *dev, @@ -357074,19 +166941,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +// Commented by Kurt 20121206 +// This function is used to set wfd enabled + -+ int ret = 0; ++ int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); + + if(*extra == '0' ) -+ pwdinfo->wfd_info->wfd_enable = _FALSE; ++ pwdinfo->wfd_info->wfd_enable = false; + else if(*extra == '1') -+ pwdinfo->wfd_info->wfd_enable = _TRUE; ++ pwdinfo->wfd_info->wfd_enable = true; + + DBG_871X( "[%s] wfd_enable = %d\n", __FUNCTION__, pwdinfo->wfd_info->wfd_enable ); -+ ++ + return ret; -+ ++ +} + +static int rtw_p2p_set_driver_iface(struct net_device *dev, @@ -357095,7 +166962,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +{ +// Commented by Kurt 20121206 +// This function is used to set driver iface is WEXT or CFG80211 -+ int ret = 0; ++ int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); + @@ -357109,9 +166976,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + pwdinfo->driver_interface = DRIVER_CFG80211; + DBG_871X( "[%s] driver_interface = CFG80211\n", __FUNCTION__); + } -+ ++ + return ret; -+ ++ +} + +// To set the WFD session available to enable or disable @@ -357119,13 +166986,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; -+ ++ + DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra ); + + if( 0 ) @@ -357137,23 +167004,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + if ( extra[ 0 ] == '0' ) // Disable the session available. + { -+ pwdinfo->session_available = _FALSE; ++ pwdinfo->session_available = false; + } + else if ( extra[ 0 ] == '1' ) // Enable the session available. + { -+ pwdinfo->session_available = _TRUE; ++ pwdinfo->session_available = true; + } + else + { -+ pwdinfo->session_available = _FALSE; ++ pwdinfo->session_available = false; + } + } + printk( "[%s] session available = %d\n", __FUNCTION__, pwdinfo->session_available ); -+ ++ +exit: -+ ++ + return ret; -+ ++ +} +#endif // CONFIG_WFD + @@ -357161,12 +167028,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); + u8 peerMAC[ ETH_ALEN ] = { 0x00 }; -+ int jj,kk; -+ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; ++ int jj,kk; ++ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + _list *plist, *phead; + _queue *queue = &(pmlmepriv->scanned_queue); @@ -357176,12 +167043,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + u8 *p2pie; + uint p2pielen = 0, attr_contentlen = 0; + _irqL irqL; -+ u8 ie_offset = 12; ++ u8 ie_offset; +#ifdef CONFIG_CONCURRENT_MODE + _adapter *pbuddy_adapter = padapter->pbuddy_adapter; + struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; + struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif // CONFIG_CONCURRENT_MODE ++#endif // CONFIG_CONCURRENT_MODE +#ifdef CONFIG_WFD + struct wifi_display_info* pwfd_info = pwdinfo->wfd_info; +#endif // CONFIG_WFD @@ -357205,7 +167072,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + else + { +#ifdef CONFIG_INTEL_WIDI -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { ++ if(check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true){ + DBG_871X( "[%s] WiFi is under survey!\n", __FUNCTION__ ); + return ret; + } @@ -357214,12 +167081,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + // Reset the content of struct tx_provdisc_req_info excluded the wps_config_method_request. + _rtw_memset( pwdinfo->tx_prov_disc_info.peerDevAddr, 0x00, ETH_ALEN ); + _rtw_memset( pwdinfo->tx_prov_disc_info.peerIFAddr, 0x00, ETH_ALEN ); -+ _rtw_memset( &pwdinfo->tx_prov_disc_info.ssid, 0x00, sizeof( NDIS_802_11_SSID ) ); ++ _rtw_memset( &pwdinfo->tx_prov_disc_info.ssid, 0x00, sizeof( NDIS_802_11_SSID ) ); + pwdinfo->tx_prov_disc_info.peer_channel_num[ 0 ] = 0; + pwdinfo->tx_prov_disc_info.peer_channel_num[ 1 ] = 0; -+ pwdinfo->tx_prov_disc_info.benable = _FALSE; ++ pwdinfo->tx_prov_disc_info.benable = false; + } -+ ++ + for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 ) + { + peerMAC[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] ); @@ -357251,10 +167118,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + phead = get_list_head(queue); + plist = get_next(phead); -+ ++ + while(1) + { -+ if (rtw_end_of_queue_search(phead,plist)== _TRUE) ++ if (rtw_end_of_queue_search(phead,plist)== true) + break; + + if( uintPeerChannel != 0 ) @@ -357266,8 +167133,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + // Match the device address located in the P2P IE + // This is for the case that the P2P device address is not the same as the P2P interface address. + -+ ie_offset = (pnetwork->network.Reserved[0] == 2? 0:12); -+ if ( (p2pie=rtw_get_p2p_ie_from_scan_queue( &pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &p2pielen, pnetwork->network.Reserved[0]))) ++ if (pnetwork->network.Reserved[0] == 2) { // Probe Request ++ ie_offset = 0; ++ } else { // Beacon or Probe Respones ++ ie_offset = 12; ++ } ++ if ( (p2pie=rtw_get_p2p_ie( &pnetwork->network.IEs[ie_offset], pnetwork->network.IELength - ie_offset, NULL, &p2pielen)) ) + { + while ( p2pie ) + { @@ -357290,7 +167161,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + uintPeerChannel = pnetwork->network.Configuration.DSConfig; + break; -+ } ++ } + } + + //Get the next P2P IE @@ -357300,9 +167171,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + +#ifdef CONFIG_INTEL_WIDI -+ // Some Intel WiDi source may not provide P2P IE, ++ // Some Intel WiDi source may not provide P2P IE, + // so we could only compare mac addr by 802.11 Source Address -+ if( pmlmepriv->widi_state == INTEL_WIDI_STATE_WFD_CONNECTION ++ if( pmlmepriv->widi_state == INTEL_WIDI_STATE_WFD_CONNECTION + && uintPeerChannel == 0 ) + { + if ( _rtw_memcmp( pnetwork->network.MacAddress, peerMAC, ETH_ALEN ) ) @@ -357314,7 +167185,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#endif //CONFIG_INTEL_WIDI + + plist = get_next(plist); -+ ++ + } + + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); @@ -357325,8 +167196,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + u8 wfd_ie[ 128 ] = { 0x00 }; + uint wfd_ielen = 0; -+ -+ if ( rtw_get_wfd_ie_from_scan_queue( &pnetwork->network.IEs[0], pnetwork->network.IELength, wfd_ie, &wfd_ielen, pnetwork->network.Reserved[0]) ) ++ ++ if ( rtw_get_wfd_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, wfd_ie, &wfd_ielen ) ) + { + u8 wfd_devinfo[ 6 ] = { 0x00 }; + uint wfd_devlen = 6; @@ -357335,30 +167206,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if ( rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, wfd_devinfo, &wfd_devlen ) ) + { + u16 wfd_devinfo_field = 0; -+ ++ + // Commented by Albert 20120319 + // The first two bytes are the WFD device information field of WFD device information subelement. + // In big endian format. + wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo); + if ( wfd_devinfo_field & WFD_DEVINFO_SESSION_AVAIL ) + { -+ pwfd_info->peer_session_avail = _TRUE; ++ pwfd_info->peer_session_avail = true; + } + else + { -+ pwfd_info->peer_session_avail = _FALSE; ++ pwfd_info->peer_session_avail = false; + } + } + } -+ -+ if ( _FALSE == pwfd_info->peer_session_avail ) ++ ++ if ( false == pwfd_info->peer_session_avail ) + { + DBG_871X( "[%s] WFD Session not avaiable!\n", __FUNCTION__ ); + goto exit; + } + } +#endif // CONFIG_WFD -+ ++ + DBG_871X( "[%s] peer channel: %d!\n", __FUNCTION__, uintPeerChannel ); +#ifdef CONFIG_CONCURRENT_MODE + if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) @@ -357369,7 +167240,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + _rtw_memcpy( pwdinfo->tx_prov_disc_info.peerIFAddr, pnetwork->network.MacAddress, ETH_ALEN ); + _rtw_memcpy( pwdinfo->tx_prov_disc_info.peerDevAddr, peerMAC, ETH_ALEN ); + pwdinfo->tx_prov_disc_info.peer_channel_num[0] = ( u16 ) uintPeerChannel; -+ pwdinfo->tx_prov_disc_info.benable = _TRUE; ++ pwdinfo->tx_prov_disc_info.benable = true; + rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); + rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ); + @@ -357388,7 +167259,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + // Have to enter the power saving with the AP + set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ ++ + issue_nulldata(pbuddy_adapter, NULL, 1, 3, 500); + } + else @@ -357400,7 +167271,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#endif + + _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ ++ +#ifdef CONFIG_CONCURRENT_MODE + if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) + { @@ -357412,26 +167283,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } +#else + _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT ); -+#endif // CONFIG_CONCURRENT_MODE -+ ++#endif // CONFIG_CONCURRENT_MODE ++ + } + else + { + DBG_871X( "[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__ ); +#ifdef CONFIG_INTEL_WIDI -+ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); + rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); + rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); -+ rtw_free_network_queue(padapter, _TRUE); -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); ++ rtw_free_network_queue(padapter, true); ++ _enter_critical_bh(&pmlmepriv->lock, &irqL); + rtw_sitesurvey_cmd(padapter, NULL, 0, NULL, 0); + _exit_critical_bh(&pmlmepriv->lock, &irqL); +#endif //CONFIG_INTEL_WIDI + } +exit: -+ ++ + return ret; -+ ++ +} + +// Added by Albert 20110328 @@ -357442,11 +167312,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ ++ int ret = 0; ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ ++ + + DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra ); + // Added by Albert 20110328 @@ -357454,7 +167324,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + // if the input data is P2P_GOT_WPSINFO_PEER_DISPLAY_PIN -> the utility just input the PIN code got from the peer P2P device. + // if the input data is P2P_GOT_WPSINFO_SELF_DISPLAY_PIN -> the utility just got the PIN code from itself. + // if the input data is P2P_GOT_WPSINFO_PBC -> the utility just determine to use the PBC -+ ++ + if ( *extra == '0' ) + { + pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO; @@ -357475,9 +167345,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO; + } -+ ++ + return ret; -+ ++ +} + +#endif //CONFIG_P2P @@ -357486,12 +167356,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ ++ + int ret = 0; +#ifdef CONFIG_P2P + + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; @@ -357544,7 +167414,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + // Commented by Albert 2011/05/24 + // The wrqu->data.length will include the null character -+ // So, we will decrease (10 + 1) ++ // So, we will decrease (10 + 1) + wrqu->data.length -= 11; + rtw_p2p_set_listen_ch( dev, info, wrqu, &extra[10] ); + } @@ -357552,7 +167422,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + // Commented by Albert 2011/05/24 + // The wrqu->data.length will include the null character -+ // So, we will decrease (6 + 1) ++ // So, we will decrease (6 + 1) + wrqu->data.length -= 7; + rtw_p2p_set_op_ch( dev, info, wrqu, &extra[6] ); + } @@ -357566,11 +167436,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + wrqu->data.length -= 11; + rtw_p2p_set_persistent( dev, info, wrqu, &extra[11] ); + } -+ else if ( _rtw_memcmp ( extra, "uuid=", 5) ) -+ { -+ wrqu->data.length -= 5; -+ ret = rtw_p2p_set_wps_uuid( dev, info, wrqu, &extra[5] ); -+ } +#ifdef CONFIG_WFD + else if ( _rtw_memcmp( extra, "sa=", 3 ) ) + { @@ -357605,20 +167470,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#endif //CONFIG_P2P + + return ret; -+ ++ +} + +static int rtw_p2p_get(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; -+ ++ ++ int ret = 0; ++ +#ifdef CONFIG_P2P + + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct iw_point *pdata = &wrqu->data; + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; @@ -357628,59 +167493,59 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X( "[%s] extra = %s\n", __FUNCTION__, (char*) wrqu->data.pointer ); + } + -+ if ( _rtw_memcmp( wrqu->data.pointer, "status", 6 ) ) ++ if (_rtw_memcmp((__force void *)wrqu->data.pointer, "status", 6 ) ) + { + rtw_p2p_get_status( dev, info, wrqu, extra ); + } -+ else if ( _rtw_memcmp( wrqu->data.pointer, "role", 4 ) ) ++ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "role", 4 ) ) + { + rtw_p2p_get_role( dev, info, wrqu, extra); + } -+ else if ( _rtw_memcmp( wrqu->data.pointer, "peer_ifa", 8 ) ) ++ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "peer_ifa", 8 ) ) + { + rtw_p2p_get_peer_ifaddr( dev, info, wrqu, extra); + } -+ else if ( _rtw_memcmp( wrqu->data.pointer, "req_cm", 6 ) ) ++ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "req_cm", 6 ) ) + { + rtw_p2p_get_req_cm( dev, info, wrqu, extra); + } -+ else if ( _rtw_memcmp( wrqu->data.pointer, "peer_deva", 9 ) ) ++ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "peer_deva", 9 ) ) + { + // Get the P2P device address when receiving the provision discovery request frame. + rtw_p2p_get_peer_devaddr( dev, info, wrqu, extra); + } -+ else if ( _rtw_memcmp( wrqu->data.pointer, "group_id", 8 ) ) ++ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "group_id", 8 ) ) + { + rtw_p2p_get_groupid( dev, info, wrqu, extra); + } -+ else if ( _rtw_memcmp( wrqu->data.pointer, "inv_peer_deva", 13 ) ) ++ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "inv_peer_deva", 13 ) ) + { + // Get the P2P device address when receiving the P2P Invitation request frame. + rtw_p2p_get_peer_devaddr_by_invitation( dev, info, wrqu, extra); + } -+ else if ( _rtw_memcmp( wrqu->data.pointer, "op_ch", 5 ) ) ++ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "op_ch", 5 ) ) + { + rtw_p2p_get_op_ch( dev, info, wrqu, extra); + } +#ifdef CONFIG_WFD -+ else if ( _rtw_memcmp( wrqu->data.pointer, "peer_port", 9 ) ) ++ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "peer_port", 9 ) ) + { + rtw_p2p_get_peer_wfd_port( dev, info, wrqu, extra ); + } -+ else if ( _rtw_memcmp( wrqu->data.pointer, "wfd_sa", 6 ) ) ++ else if ( _rtw_memcmp((__force void *)wrqu->data.pointer, "wfd_sa", 6 ) ) + { + rtw_p2p_get_peer_wfd_session_available( dev, info, wrqu, extra ); + } -+ else if ( _rtw_memcmp( wrqu->data.pointer, "wfd_pc", 6 ) ) ++ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "wfd_pc", 6 ) ) + { + rtw_p2p_get_peer_wfd_preferred_connection( dev, info, wrqu, extra ); + } -+#endif // CONFIG_WFD -+ ++#endif // CONFIG_WFD ++ +#endif //CONFIG_P2P + + return ret; -+ ++ +} + +static int rtw_p2p_get2(struct net_device *dev, @@ -357703,7 +167568,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + if (copy_from_user(buffer, wrqu->data.pointer, wrqu->data.length)) + { -+ ret = -EFAULT; ++ ret - EFAULT; + goto bad; + } + @@ -357733,7 +167598,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +bad: + if (buffer) + { -+ rtw_mfree(buffer, length); ++ _rtw_mfree(buffer, length); + } + +#endif //CONFIG_P2P @@ -357772,19 +167637,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +} + + -+extern int rtw_change_ifname(_adapter *padapter, const char *ifname); +static int rtw_rereg_nd_name(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ int ret = 0; ++ int ret = 0; + _adapter *padapter = rtw_netdev_priv(dev); + struct rereg_nd_name_data *rereg_priv = &padapter->rereg_nd_name_priv; + char new_ifname[IFNAMSIZ]; + + if(rereg_priv->old_ifname[0] == 0) { + char *reg_ifname; -+#ifdef CONFIG_CONCURRENT_MODE ++#ifdef CONFIG_CONCURRENT_MODE + if (padapter->isprimary) + reg_ifname = padapter->registrypriv.ifname; + else @@ -357812,53 +167676,157 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + goto exit; + } + -+ if(_rtw_memcmp(rereg_priv->old_ifname, "disable%d", 9) == _TRUE) { ++ if(_rtw_memcmp(rereg_priv->old_ifname, "disable%d", 9) == true) { + padapter->ledpriv.bRegUseLed= rereg_priv->old_bRegUseLed; + rtw_hal_sw_led_init(padapter); -+ //rtw_ips_mode_req(&padapter->pwrctrlpriv, rereg_priv->old_ips_mode); ++ rtw_ips_mode_req(&padapter->pwrctrlpriv, rereg_priv->old_ips_mode); + } + + strncpy(rereg_priv->old_ifname, new_ifname, IFNAMSIZ); + rereg_priv->old_ifname[IFNAMSIZ-1] = 0; -+ -+ if(_rtw_memcmp(new_ifname, "disable%d", 9) == _TRUE) { ++ ++ if(_rtw_memcmp(new_ifname, "disable%d", 9) == true) { + + DBG_871X("%s disable\n", __FUNCTION__); + // free network queue for Android's timming issue -+ rtw_free_network_queue(padapter, _TRUE); -+ ++ rtw_free_network_queue(padapter, true); ++ + // close led + rtw_led_control(padapter, LED_CTL_POWER_OFF); + rereg_priv->old_bRegUseLed = padapter->ledpriv.bRegUseLed; -+ padapter->ledpriv.bRegUseLed= _FALSE; ++ padapter->ledpriv.bRegUseLed= false; + rtw_hal_sw_led_deinit(padapter); -+ ++ + // the interface is being "disabled", we can do deeper IPS -+ //rereg_priv->old_ips_mode = rtw_get_ips_mode_req(&padapter->pwrctrlpriv); -+ //rtw_ips_mode_req(&padapter->pwrctrlpriv, IPS_NORMAL); ++ rereg_priv->old_ips_mode = rtw_get_ips_mode_req(&padapter->pwrctrlpriv); ++ rtw_ips_mode_req(&padapter->pwrctrlpriv, IPS_NORMAL); + } +exit: + return ret; + +} + -+#ifdef CONFIG_IOL -+#include ++#if 0 ++void mac_reg_dump(_adapter *padapter) ++{ ++ int i,j=1; ++ DBG_871X("\n======= MAC REG =======\n"); ++ for(i=0x0;i<0x300;i+=4) ++ { ++ if(j%4==1) DBG_871X("0x%02x",i); ++ DBG_871X(" 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) DBG_871X("\n"); ++ } ++ for(i=0x400;i<0x800;i+=4) ++ { ++ if(j%4==1) DBG_871X("0x%02x",i); ++ DBG_871X(" 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) DBG_871X("\n"); ++ } ++} ++void bb_reg_dump(_adapter *padapter) ++{ ++ int i,j=1; ++ DBG_871X("\n======= BB REG =======\n"); ++ for(i=0x800;i<0x1000;i+=4) ++ { ++ if(j%4==1) DBG_871X("0x%02x",i); ++ ++ DBG_871X(" 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) DBG_871X("\n"); ++ } ++} ++void rf_reg_dump(_adapter *padapter) ++{ ++ int i,j=1,path; ++ u32 value; ++ DBG_871X("\n======= RF REG =======\n"); ++ for(path=0;path<2;path++) ++ { ++ DBG_871X("\nRF_Path(%x)\n",path); ++ for(i=0;i<0x100;i++) ++ { ++ value = PHY_QueryRFReg(padapter, path,i, bMaskDWord); ++ if(j%4==1) DBG_871X("0x%02x ",i); ++ DBG_871X(" 0x%08x ",value); ++ if((j++)%4==0) DBG_871X("\n"); ++ } ++ } ++} ++ +#endif + -+#ifdef DBG_CMD_QUEUE -+u8 dump_cmd_id=0; ++static void mac_reg_dump(_adapter *padapter) ++{ ++ int i,j=1; ++ printk("\n======= MAC REG =======\n"); ++ for(i=0x0;i<0x300;i+=4) ++ { ++ if(j%4==1) printk("0x%02x",i); ++ printk(" 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) printk("\n"); ++ } ++ for(i=0x400;i<0x800;i+=4) ++ { ++ if(j%4==1) printk("0x%02x",i); ++ printk(" 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) printk("\n"); ++ } ++} ++ ++static void bb_reg_dump(_adapter *padapter) ++{ ++ int i,j=1; ++ printk("\n======= BB REG =======\n"); ++ for(i=0x800;i<0x1000;i+=4) ++ { ++ if(j%4==1) printk("0x%02x",i); ++ ++ printk(" 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) printk("\n"); ++ } ++} ++ ++static void rf_reg_dump(_adapter *padapter) ++{ ++ int i,j=1,path; ++ u32 value; ++ u8 rf_type,path_nums = 0; ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ printk("\n======= RF REG =======\n"); ++ if((RF_1T2R == rf_type) ||(RF_1T1R ==rf_type )) ++ path_nums = 1; ++ else ++ path_nums = 2; ++ ++ for(path=0;path +#endif +static int rtw_dbg_port(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) -+{ ++{ + _irqL irqL; + int ret = 0; + u8 major_cmd, minor_cmd; + u16 arg; + u32 extra_arg, *pdata, val32; -+ struct sta_info *psta; ++ struct sta_info *psta; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; @@ -357866,9 +167834,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct security_priv *psecuritypriv = &padapter->securitypriv; + struct wlan_network *cur_network = &(pmlmepriv->cur_network); + struct sta_priv *pstapriv = &padapter->stapriv; -+ + -+ pdata = (u32*)&wrqu->data; ++ ++ pdata = (u32*)&wrqu->data; + + val32 = *pdata; + arg = (u16)(val32&0x0000ffff); @@ -357876,7 +167844,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + minor_cmd = (u8)((val32>>16)&0x00ff); + + extra_arg = *(pdata+1); -+ ++ + switch(major_cmd) + { + case 0x70://read_reg @@ -357891,7 +167859,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + case 4: + DBG_871X("rtw_read32(0x%x)=0x%08x\n", arg, rtw_read32(padapter, arg)); + break; -+ } ++ } + break; + case 0x71://write_reg + switch(minor_cmd) @@ -357908,7 +167876,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + rtw_write32(padapter, arg, extra_arg); + DBG_871X("rtw_write32(0x%x)=0x%08x\n", arg, rtw_read32(padapter, arg)); + break; -+ } ++ } + break; + case 0x72://read_bb + DBG_871X("read_bbreg(0x%x)=0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff)); @@ -357918,30 +167886,31 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("write_bbreg(0x%x)=0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff)); + break; + case 0x74://read_rf -+ DBG_871X("read RF_reg path(0x%02x),offset(0x%x),value(0x%08x)\n",minor_cmd,arg,rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff)); ++ DBG_871X("read RF_reg path(0x%02x),offset(0x%x),value(0x%08x)\n",minor_cmd,arg,rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff)); + break; + case 0x75://write_rf + rtw_hal_write_rfreg(padapter, minor_cmd, arg, 0xffffffff, extra_arg); + DBG_871X("write RF_reg path(0x%02x),offset(0x%x),value(0x%08x)\n",minor_cmd,arg, rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff)); -+ break; ++ break; + + case 0x76: + switch(minor_cmd) + { -+ case 0x00: //normal mode, ++ case 0x00: //normal mode, + padapter->recvpriv.is_signal_dbg = 0; + break; + case 0x01: //dbg mode + padapter->recvpriv.is_signal_dbg = 1; + extra_arg = extra_arg>100?100:extra_arg; ++ extra_arg = extra_arg<0?0:extra_arg; + padapter->recvpriv.signal_strength_dbg=extra_arg; + break; + } + break; + case 0x78: //IOL test ++ #ifdef CONFIG_IOL + switch(minor_cmd) + { -+ #ifdef CONFIG_IOL + case 0x04: //LLT table initialization test + { + u8 page_boundary = 0xf9; @@ -357949,10 +167918,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct xmit_frame *xmit_frame; + + if((xmit_frame=rtw_IOL_accquire_xmit_frame(padapter)) == NULL) { -+ ret = -ENOMEM; ++ ret = -ENOMEM; + break; + } -+ ++ + rtw_IOL_append_LLT_cmd(xmit_frame, page_boundary); + + @@ -357967,12 +167936,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + u32 blink_num = 50; + u32 blink_delay_ms = 200; + int i; -+ ++ + { + struct xmit_frame *xmit_frame; + + if((xmit_frame=rtw_IOL_accquire_xmit_frame(padapter)) == NULL) { -+ ret = -ENOMEM; ++ ret = -ENOMEM; + break; + } + @@ -357994,7 +167963,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + } + break; -+ ++ + case 0x06: //continuous wirte byte test + { + u16 reg = arg; @@ -358002,12 +167971,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + u32 write_num = extra_arg; + int i; + u8 final; -+ ++ + { + struct xmit_frame *xmit_frame; + + if((xmit_frame=rtw_IOL_accquire_xmit_frame(padapter)) == NULL) { -+ ret = -ENOMEM; ++ ret = -ENOMEM; + break; + } + @@ -358029,13 +167998,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + } + break; -+ ++ + case 0x07: //continuous wirte word test + { + u16 reg = arg; + u16 start_value = 200; + u32 write_num = extra_arg; -+ ++ + int i; + u16 final; + @@ -358043,7 +168012,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct xmit_frame *xmit_frame; + + if((xmit_frame=rtw_IOL_accquire_xmit_frame(padapter)) == NULL) { -+ ret = -ENOMEM; ++ ret = -ENOMEM; + break; + } + @@ -358065,13 +168034,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + } + break; -+ ++ + case 0x08: //continuous wirte dword test + { + u16 reg = arg; + u32 start_value = 0x110000c7; + u32 write_num = extra_arg; -+ ++ + int i; + u32 final; + @@ -358079,7 +168048,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct xmit_frame *xmit_frame; + + if((xmit_frame=rtw_IOL_accquire_xmit_frame(padapter)) == NULL) { -+ ret = -ENOMEM; ++ ret = -ENOMEM; + break; + } + @@ -358092,7 +168061,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + if(_SUCCESS !=rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 5000,0)) + ret = -EPERM; -+ ++ + } + + if(start_value+write_num-1 == (final=rtw_read32(padapter, reg)) ) { @@ -358102,8 +168071,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + } + break; -+ #endif //CONFIG_IOL + } ++ #endif //CONFIG_IOL + break; + case 0x79: + { @@ -358135,14 +168104,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("fwstate=0x%x\n", get_fwstate(pmlmepriv)); + break; + case 0x01: -+ DBG_871X("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", ++ DBG_871X("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", + psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, + psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus); + break; + case 0x02: + DBG_871X("pmlmeinfo->state=0x%x\n", pmlmeinfo->state); -+ DBG_871X("DrvBcnEarly=%d\n", pmlmeext->DrvBcnEarly); -+ DBG_871X("DrvBcnTimeOut=%d\n", pmlmeext->DrvBcnTimeOut); + break; + case 0x03: + DBG_871X("qos_option=%d\n", pmlmepriv->qospriv.qos_option); @@ -358154,16 +168121,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("cur_ch=%d\n", pmlmeext->cur_channel); + DBG_871X("cur_bw=%d\n", pmlmeext->cur_bwmode); + DBG_871X("cur_ch_off=%d\n", pmlmeext->cur_ch_offset); -+ -+ DBG_871X("oper_ch=%d\n", rtw_get_oper_ch(padapter)); -+ DBG_871X("oper_bw=%d\n", rtw_get_oper_bw(padapter)); -+ DBG_871X("oper_ch_offet=%d\n", rtw_get_oper_choffset(padapter)); -+ + break; + case 0x05: + psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); + if(psta) + { ++ int i; ++ struct recv_reorder_ctrl *preorder_ctrl; ++ + DBG_871X("SSID=%s\n", cur_network->network.Ssid.Ssid); + DBG_871X("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); + DBG_871X("cur_channel=%d, cur_bwmode=%d, cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); @@ -358171,59 +168136,71 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); +#ifdef CONFIG_80211N_HT + DBG_871X("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ DBG_871X("bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); -+ DBG_871X("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); ++ DBG_871X("bwmode=%d, ch_offset=%d, sgi=%d\n", psta->htpriv.bwmode, psta->htpriv.ch_offset, psta->htpriv.sgi); ++ DBG_871X("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); + DBG_871X("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); +#endif //CONFIG_80211N_HT + -+ sta_rx_reorder_ctl_dump(RTW_DBGDUMP, psta); ++ for(i=0;i<16;i++) ++ { ++ preorder_ctrl = &psta->recvreorder_ctrl[i]; ++ if(preorder_ctrl->enable) ++ { ++ DBG_871X("tid=%d, indicate_seq=%d\n", i, preorder_ctrl->indicate_seq); ++ } ++ } ++ + } + else -+ { ++ { + DBG_871X("can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); -+ } ++ } + break; + case 0x06: -+ { ++ { ++ u32 ODMFlag; ++ rtw_hal_get_hwreg(padapter, HW_VAR_DM_FLAG, (u8*)(&ODMFlag)); ++ DBG_871X("(B)DMFlag=0x%x, arg=0x%x\n", ODMFlag, arg); ++ ODMFlag = (u32)(0x0f&arg); ++ DBG_871X("(A)DMFlag=0x%x\n", ODMFlag); ++ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FLAG, (u8 *)(&ODMFlag)); + } + break; + case 0x07: -+ DBG_871X("bSurpriseRemoved=%s, bDriverStopped=%s\n" -+ , rtw_is_surprise_removed(padapter)?"True":"False" -+ , rtw_is_drv_stopped(padapter)?"True":"False"); ++ DBG_871X("bSurpriseRemoved=%d, bDriverStopped=%d\n", ++ padapter->bSurpriseRemoved, padapter->bDriverStopped); + break; + case 0x08: + { + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + struct recv_priv *precvpriv = &padapter->recvpriv; -+ ++ + DBG_871X("free_xmitbuf_cnt=%d, free_xmitframe_cnt=%d" + ", free_xmit_extbuf_cnt=%d, free_xframe_ext_cnt=%d" + ", free_recvframe_cnt=%d\n", + pxmitpriv->free_xmitbuf_cnt, pxmitpriv->free_xmitframe_cnt, + pxmitpriv->free_xmit_extbuf_cnt, pxmitpriv->free_xframe_ext_cnt, + precvpriv->free_recvframe_cnt); -+ #ifdef CONFIG_USB_HCI -+ DBG_871X("rx_urb_pending_cn=%d\n", ATOMIC_READ(&(precvpriv->rx_pending_cnt))); -+ #endif ++ DBG_871X("rx_urb_pending_cn=%d\n", precvpriv->rx_pending_cnt); + } -+ break; ++ break; + case 0x09: + { -+ int i; ++ int i, j; + _list *plist, *phead; -+ ++ struct recv_reorder_ctrl *preorder_ctrl; ++ +#ifdef CONFIG_AP_MODE + DBG_871X("sta_dz_bitmap=0x%x, tim_bitmap=0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap); -+#endif ++#endif + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); + + for(i=0; i< NUM_STA; i++) + { + phead = &(pstapriv->sta_hash[i]); + plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == false) + { + psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); + @@ -358235,12 +168212,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); + DBG_871X("state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); +#ifdef CONFIG_80211N_HT -+ DBG_871X("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ DBG_871X("bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); -+ DBG_871X("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); ++ DBG_871X("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); ++ DBG_871X("bwmode=%d, ch_offset=%d, sgi=%d\n", psta->htpriv.bwmode, psta->htpriv.ch_offset, psta->htpriv.sgi); ++ DBG_871X("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); + DBG_871X("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); +#endif //CONFIG_80211N_HT -+ ++ +#ifdef CONFIG_AP_MODE + DBG_871X("capability=0x%x\n", psta->capability); + DBG_871X("flags=0x%x\n", psta->flags); @@ -358251,118 +168228,84 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#endif + DBG_871X("dot118021XPrivacy=0x%x\n", psta->dot118021XPrivacy); + -+ sta_rx_reorder_ctl_dump(RTW_DBGDUMP, psta); -+ } -+ ++ ++ ++ for(j=0;j<16;j++) ++ { ++ preorder_ctrl = &psta->recvreorder_ctrl[j]; ++ if(preorder_ctrl->enable) ++ { ++ DBG_871X("tid=%d, indicate_seq=%d\n", j, preorder_ctrl->indicate_seq); ++ } ++ } ++ ++ } ++ + } + } -+ ++ + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); + + } + break; -+ case 0x0a: -+ { -+ int max_mac_id = 0; -+ max_mac_id = rtw_search_max_mac_id( padapter); -+ printk("%s ==> max_mac_id = %d \n",__FUNCTION__,max_mac_id); -+ } -+ break; -+ case 0x0b: //Enable=1, Disable=0 driver control vrtl_carrier_sense. -+ { -+ //u8 driver_vcs_en; //Enable=1, Disable=0 driver control vrtl_carrier_sense. -+ //u8 driver_vcs_type;//force 0:disable VCS, 1:RTS-CTS, 2:CTS-to-self when vcs_en=1. + -+ if(arg == 0){ -+ DBG_871X("disable driver ctrl vcs\n"); -+ padapter->driver_vcs_en = 0; -+ } -+ else if(arg == 1){ -+ DBG_871X("enable driver ctrl vcs = %d\n", extra_arg); -+ padapter->driver_vcs_en = 1; -+ -+ if(extra_arg>2) -+ padapter->driver_vcs_type = 1; -+ else -+ padapter->driver_vcs_type = extra_arg; -+ } -+ } -+ break; + case 0x0c://dump rx/tx packet + { + if(arg == 0){ -+ DBG_871X("dump rx packet (%d)\n",extra_arg); -+ //pHalData->bDumpRxPkt =extra_arg; ++ DBG_871X("dump rx packet (%d)\n",extra_arg); ++ //pHalData->bDumpRxPkt =extra_arg; + rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DUMP_RXPKT, &(extra_arg)); + } + else if(arg==1){ -+ DBG_871X("dump tx packet (%d)\n",extra_arg); ++ DBG_871X("dump tx packet (%d)\n",extra_arg); + rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DUMP_TXPKT, &(extra_arg)); + } + } + break; -+ case 0x0e: ++#if 0 ++ case 0x0d://dump cam + { -+ if(arg == 0){ -+ DBG_871X("disable driver ctrl rx_ampdu_factor\n"); -+ padapter->driver_rx_ampdu_factor = 0xFF; -+ } -+ else if(arg == 1){ -+ -+ DBG_871X("enable driver ctrl rx_ampdu_factor = %d\n", extra_arg); -+ -+ if(extra_arg > 0x03) -+ padapter->driver_rx_ampdu_factor = 0xFF; -+ else -+ padapter->driver_rx_ampdu_factor = extra_arg; -+ } ++ //u8 entry = (u8) extra_arg; ++ u8 entry=0; ++ //dump cam ++ for(entry=0;entry<32;entry++) ++ read_cam(padapter,entry); + } + break; ++#endif + #ifdef DBG_CONFIG_ERROR_DETECT + case 0x0f: + { -+ if(extra_arg == 0){ ++ if(extra_arg == 0){ + DBG_871X("###### silent reset test.......#####\n"); -+ rtw_hal_sreset_reset(padapter); ++ rtw_hal_sreset_reset(padapter); + } else { + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + struct sreset_priv *psrtpriv = &pHalData->srestpriv; + psrtpriv->dbg_trigger_point = extra_arg; + } -+ ++ + } + break; + case 0x15: + { -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + DBG_871X("==>silent resete cnts:%d\n",pwrpriv->ips_enter_cnts); + } -+ break; -+ -+ #endif ++ break; ++ ++ #endif + + case 0x10:// driver version display -+ dump_drv_version(RTW_DBGDUMP); ++ DBG_871X("rtw driver version=%s\n", DRIVERVERSION); + break; -+ case 0x11://dump linked status ++ case 0x11: + { -+ int pre_mode; -+ pre_mode=padapter->bLinkInfoDump; -+ // linked_info_dump(padapter,extra_arg); -+ if(extra_arg==1 || (extra_arg==0 && pre_mode==1) ) //not consider pwr_saving 0: -+ { -+ padapter->bLinkInfoDump = extra_arg; -+ -+ } -+ else if( (extra_arg==2 ) || (extra_arg==0 && pre_mode==2))//consider power_saving -+ { -+ //DBG_871X("linked_info_dump =%s \n", (padapter->bLinkInfoDump)?"enable":"disable") -+ linked_info_dump(padapter,extra_arg); -+ } ++ DBG_871X("linked info dump func %s \n",(extra_arg>=1)?"enable":"disable"); ++ DBG_871X("extra_arg_ID: RA Info BIT-0 ,DIG Info BIT-1, FA Info BIT-2 \n"); ++ padapter->bLinkInfoDump = extra_arg ; + -+ -+ -+ } ++ } + break; +#ifdef CONFIG_80211N_HT + case 0x12: //set rx_stbc @@ -358377,21 +168320,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + else + DBG_871X("get rx_stbc=%d\n",pregpriv->rx_stbc); -+ ++ + } + break; + case 0x13: //set ampdu_enable + { + struct registry_priv *pregpriv = &padapter->registrypriv; + // 0: disable, 0x1:enable (but wifi_spec should be 0), 0x2: force enable (don't care wifi_spec) -+ if( pregpriv && extra_arg < 3 ) ++ if( pregpriv && extra_arg >= 0 && extra_arg < 3 ) + { + pregpriv->ampdu_enable= extra_arg; + DBG_871X("set ampdu_enable=%d\n",pregpriv->ampdu_enable); + } + else + DBG_871X("get ampdu_enable=%d\n",pregpriv->ampdu_enable); -+ ++ + } + break; +#endif @@ -358399,27 +168342,45 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + struct registry_priv *pregpriv = &padapter->registrypriv; + DBG_871X("get wifi_spec=%d\n",pregpriv->wifi_spec); -+ ++ + } + break; + case 0x16: + { + if(arg == 0xff){ -+ rtw_odm_dbg_comp_msg(RTW_DBGDUMP,padapter); ++ printk("ODM_COMP_DIG\t\tBIT0\n"); ++ printk("ODM_COMP_RA_MASK\t\tBIT1\n"); ++ printk("ODM_COMP_DYNAMIC_TXPWR\tBIT2\n"); ++ printk("ODM_COMP_FA_CNT\t\tBIT3\n"); ++ printk("ODM_COMP_RSSI_MONITOR\tBIT4\n"); ++ printk("ODM_COMP_CCK_PD\t\tBIT5\n"); ++ printk("ODM_COMP_ANT_DIV\t\tBIT6\n"); ++ printk("ODM_COMP_PWR_SAVE\t\tBIT7\n"); ++ printk("ODM_COMP_PWR_TRAIN\tBIT8\n"); ++ printk("ODM_COMP_RATE_ADAPTIVE\tBIT9\n"); ++ printk("ODM_COMP_PATH_DIV\t\tBIT10\n"); ++ printk("ODM_COMP_PSD \tBIT11\n"); ++ printk("ODM_COMP_DYNAMIC_PRICCA\tBIT12\n"); ++ printk("ODM_COMP_RXHP\t\tBIT13\n"); ++ printk("ODM_COMP_EDCA_TURBO\tBIT16\n"); ++ printk("ODM_COMP_EARLY_MODE\tBIT17\n"); ++ printk("ODM_COMP_TX_PWR_TRACK\tBIT24\n"); ++ printk("ODM_COMP_RX_GAIN_TRACK\tBIT25\n"); ++ printk("ODM_COMP_CALIBRATION\tBIT26\n"); ++ rtw_hal_get_def_var(padapter, HW_DEF_ODM_DBG_FLAG,&extra_arg); + } + else{ -+ u64 dbg_comp = (u64)extra_arg; -+ rtw_odm_dbg_comp_set(padapter, dbg_comp); ++ rtw_hal_set_def_var(padapter, HW_DEF_ODM_DBG_FLAG,&extra_arg); + } + } + break; +#ifdef DBG_FIXED_CHAN + case 0x17: + { -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + printk("===> Fixed channel to %d \n",extra_arg); -+ pmlmeext->fixed_chan = extra_arg; -+ ++ pmlmeext->fixed_chan = extra_arg; ++ + } + break; +#endif @@ -358429,120 +168390,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + rtw_hal_set_hwreg(padapter, HW_VAR_USB_MODE, (u8 *)&extra_arg); + } + break; -+#ifdef CONFIG_80211N_HT -+ case 0x19: -+ { -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ // extra_arg : -+ // BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, -+ // BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx -+ if(arg == 0){ -+ DBG_871X("driver disable LDPC\n"); -+ pregistrypriv->ldpc_cap = 0x00; -+ } -+ else if(arg == 1){ -+ DBG_871X("driver set LDPC cap = 0x%x\n", extra_arg); -+ pregistrypriv->ldpc_cap = (u8)(extra_arg&0x33); -+ } -+ } -+ break; -+ case 0x1a: -+ { -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ // extra_arg : -+ // BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, -+ // BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx -+ if(arg == 0){ -+ DBG_871X("driver disable STBC\n"); -+ pregistrypriv->stbc_cap = 0x00; -+ } -+ else if(arg == 1){ -+ DBG_871X("driver set STBC cap = 0x%x\n", extra_arg); -+ pregistrypriv->stbc_cap = (u8)(extra_arg&0x33); -+ } -+ } -+ break; -+#endif //CONFIG_80211N_HT -+ case 0x1b: -+ { -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ if(arg == 0){ -+ DBG_871X("disable driver ctrl max_rx_rate, reset to default_rate_set\n"); -+ init_mlme_default_rate_set(padapter); -+#ifdef CONFIG_80211N_HT -+ pregistrypriv->ht_enable = (u8)rtw_ht_enable; -+#endif //CONFIG_80211N_HT -+ } -+ else if(arg == 1){ -+ -+ int i; -+ u8 max_rx_rate; -+ -+ DBG_871X("enable driver ctrl max_rx_rate = 0x%x\n", extra_arg); -+ -+ max_rx_rate = (u8)extra_arg; -+ -+ if(max_rx_rate < 0xc) // max_rx_rate < MSC0 -> B or G -> disable HT -+ { -+#ifdef CONFIG_80211N_HT -+ pregistrypriv->ht_enable = 0; -+#endif //CONFIG_80211N_HT -+ for(i=0; idatarate[i] > max_rx_rate) -+ pmlmeext->datarate[i] = 0xff; -+ } -+ -+ } -+#ifdef CONFIG_80211N_HT -+ else if(max_rx_rate < 0x1c) // mcs0~mcs15 -+ { -+ u32 mcs_bitmap=0x0; -+ -+ for(i=0; i<((max_rx_rate+1)-0xc); i++) -+ mcs_bitmap |= BIT(i); -+ -+ set_mcs_rate_by_mask(pmlmeext->default_supported_mcs_set, mcs_bitmap); -+ } -+#endif //CONFIG_80211N_HT -+ } -+ } -+ break; -+ case 0x1c: //enable/disable driver control AMPDU Density for peer sta's rx -+ { -+ if(arg == 0){ -+ DBG_871X("disable driver ctrl ampdu density\n"); -+ padapter->driver_ampdu_spacing = 0xFF; -+ } -+ else if(arg == 1){ -+ -+ DBG_871X("enable driver ctrl ampdu density = %d\n", extra_arg); -+ -+ if(extra_arg > 0x07) -+ padapter->driver_ampdu_spacing = 0xFF; -+ else -+ padapter->driver_ampdu_spacing = extra_arg; -+ } -+ } -+ break; -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ case 0x1e: -+ { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ u8 chan = rtw_get_oper_ch(padapter); -+ DBG_871X("===========================================\n"); -+ ODM_InbandNoise_Monitor(pDM_Odm,_TRUE,0x1e,100); -+ DBG_871X("channel(%d),noise_a = %d, noise_b = %d , noise_all:%d \n", -+ chan,pDM_Odm->noise_level.noise[ODM_RF_PATH_A], -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_B], -+ pDM_Odm->noise_level.noise_all); -+ DBG_871X("===========================================\n"); -+ -+ } -+ break; -+#endif + case 0x23: + { + DBG_871X("turn %s the bNotifyChannelChange Variable\n",(extra_arg==1)?"on":"off"); @@ -358555,80 +168402,55 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("turn %s the bShowGetP2PState Variable\n",(extra_arg==1)?"on":"off"); + padapter->bShowGetP2PState = extra_arg; +#endif // CONFIG_P2P -+ break; -+ } -+#ifdef CONFIG_GPIO_API -+ case 0x25: //Get GPIO register -+ { -+ /* -+ * dbg 0x7f250000 [gpio_num], Get gpio value, gpio_num:0~7 -+ */ -+ -+ u8 value; -+ DBG_871X("Read GPIO Value extra_arg = %d\n",extra_arg); -+ value = rtw_hal_get_gpio(padapter,extra_arg); -+ DBG_871X("Read GPIO Value = %d\n",value); -+ break; -+ } -+ case 0x26: //Set GPIO direction -+ { -+ -+ /* dbg 0x7f26000x [y], Set gpio direction, -+ * x: gpio_num,4~7 y: indicate direction, 0~1 -+ */ -+ -+ int value; -+ DBG_871X("Set GPIO Direction! arg = %d ,extra_arg=%d\n",arg ,extra_arg); -+ value = rtw_hal_config_gpio(padapter, arg, extra_arg); -+ DBG_871X("Set GPIO Direction %s \n",(value==-1)?"Fail!!!":"Success"); -+ break; -+ } -+ case 0x27: //Set GPIO output direction value -+ { -+ /* -+ * dbg 0x7f27000x [y], Set gpio output direction value, -+ * x: gpio_num,4~7 y: indicate direction, 0~1 -+ */ -+ -+ int value; -+ DBG_871X("Set GPIO Value! arg = %d ,extra_arg=%d\n",arg ,extra_arg); -+ value = rtw_hal_set_gpio_output_value(padapter,arg,extra_arg); -+ DBG_871X("Set GPIO Value %s \n",(value==-1)?"Fail!!!":"Success"); + break; + } -+#endif -+#ifdef DBG_CMD_QUEUE -+ case 0x28: -+ { -+ dump_cmd_id = extra_arg; -+ DBG_871X("dump_cmd_id:%d\n",dump_cmd_id); -+ } -+ break; -+#endif //DBG_CMD_QUEUE + case 0xaa: + { -+ if((extra_arg & 0x7F)> 0x3F) extra_arg = 0xFF; ++ if(extra_arg> 0x3F) extra_arg = 0xFF; + DBG_871X("chang data rate to :0x%02x\n",extra_arg); + padapter->fix_rate = extra_arg; + } -+ break; ++ break; + case 0xdd://registers dump , 0 for mac reg,1 for bb reg, 2 for rf reg + { + if(extra_arg==0){ -+ mac_reg_dump(RTW_DBGDUMP, padapter); ++ mac_reg_dump(padapter); + } + else if(extra_arg==1){ -+ bb_reg_dump(RTW_DBGDUMP, padapter); ++ bb_reg_dump(padapter); + } + else if(extra_arg==2){ -+ rf_reg_dump(RTW_DBGDUMP, padapter); ++ rf_reg_dump(padapter); + } -+ } -+ break; + -+ case 0xee: ++ } ++ break; ++ ++ case 0xee://turn on/off dynamic funcs + { -+ DBG_871X(" === please control /proc to trun on/off PHYDM func === \n"); ++ u32 odm_flag; ++ ++ if(0xf==extra_arg){ ++ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DM_FUNC,&odm_flag); ++ DBG_871X(" === DMFlag(0x%08x) === \n",odm_flag); ++ DBG_871X("extra_arg = 0 - disable all dynamic func \n"); ++ DBG_871X("extra_arg = 1 - disable DIG- BIT(0)\n"); ++ DBG_871X("extra_arg = 2 - disable High power - BIT(1)\n"); ++ DBG_871X("extra_arg = 3 - disable tx power tracking - BIT(2)\n"); ++ DBG_871X("extra_arg = 4 - disable BT coexistence - BIT(3)\n"); ++ DBG_871X("extra_arg = 5 - disable antenna diversity - BIT(4)\n"); ++ DBG_871X("extra_arg = 6 - enable all dynamic func \n"); ++ } ++ else{ ++ /* extra_arg = 0 - disable all dynamic func ++ extra_arg = 1 - disable DIG ++ extra_arg = 2 - disable tx power tracking ++ extra_arg = 3 - turn on all dynamic func ++ */ ++ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DM_FUNC, &(extra_arg)); ++ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DM_FUNC,&odm_flag); ++ DBG_871X(" === DMFlag(0x%08x) === \n",odm_flag); ++ } + } + break; + @@ -358649,35 +168471,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("dbg(0x280)=0x%x\n", rtw_read32(padapter, 0x280)); + DBG_871X("dbg(0x284)=0x%x\n", rtw_read32(padapter, 0x284)); + DBG_871X("dbg(0x288)=0x%x\n", rtw_read32(padapter, 0x288)); -+ ++ + DBG_871X("dbg(0x664)=0x%x\n", rtw_read32(padapter, 0x664)); + + + DBG_871X("\n"); -+ ++ + DBG_871X("dbg(0x430)=0x%x\n", rtw_read32(padapter, 0x430)); + DBG_871X("dbg(0x438)=0x%x\n", rtw_read32(padapter, 0x438)); + + DBG_871X("dbg(0x440)=0x%x\n", rtw_read32(padapter, 0x440)); -+ ++ + DBG_871X("dbg(0x458)=0x%x\n", rtw_read32(padapter, 0x458)); -+ ++ + DBG_871X("dbg(0x484)=0x%x\n", rtw_read32(padapter, 0x484)); + DBG_871X("dbg(0x488)=0x%x\n", rtw_read32(padapter, 0x488)); -+ ++ + DBG_871X("dbg(0x444)=0x%x\n", rtw_read32(padapter, 0x444)); + DBG_871X("dbg(0x448)=0x%x\n", rtw_read32(padapter, 0x448)); + DBG_871X("dbg(0x44c)=0x%x\n", rtw_read32(padapter, 0x44c)); + DBG_871X("dbg(0x450)=0x%x\n", rtw_read32(padapter, 0x450)); + } + break; -+ } ++ } + break; + default: + DBG_871X("error dbg cmd!\n"); -+ break; ++ break; + } -+ ++ + + return ret; + @@ -358688,14 +168510,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + uint ret=0; + u32 flags; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ ++ + switch (name){ + case IEEE_PARAM_WPA_ENABLED: + + padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; //802.1x -+ ++ + //ret = ieee80211_wpa_enable(ieee, value); -+ ++ + switch((value)&0xff) + { + case 1 : //WPA @@ -358707,16 +168529,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; + break; + } -+ ++ + RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("wpa_set_param:padapter->securitypriv.ndisauthtype=%d\n", padapter->securitypriv.ndisauthtype)); -+ ++ + break; + + case IEEE_PARAM_TKIP_COUNTERMEASURES: + //ieee->tkip_countermeasures=value; + break; + -+ case IEEE_PARAM_DROP_UNENCRYPTED: ++ case IEEE_PARAM_DROP_UNENCRYPTED: + { + /* HACK: + * @@ -358729,13 +168551,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + * can use this to determine if the CAP_PRIVACY_ON bit should + * be set. + */ -+ -+#if 0 ++ ++#if 0 + struct ieee80211_security sec = { + .flags = SEC_ENABLED, + .enabled = value, + }; -+ ieee->drop_unencrypted = value; ++ ieee->drop_unencrypted = value; + /* We only change SEC_LEVEL for open mode. Others + * are set by ipw_wpa_set_encryption. + */ @@ -358749,30 +168571,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + if (ieee->set_security) + ieee->set_security(ieee->dev, &sec); -+#endif ++#endif + break; + + } -+ case IEEE_PARAM_PRIVACY_INVOKED: -+ ++ case IEEE_PARAM_PRIVACY_INVOKED: ++ + //ieee->privacy_invoked=value; -+ ++ + break; + + case IEEE_PARAM_AUTH_ALGS: -+ ++ + ret = wpa_set_auth_algs(dev, value); -+ ++ + break; + + case IEEE_PARAM_IEEE_802_1X: -+ -+ //ieee->ieee802_1x=value; -+ ++ ++ //ieee->ieee802_1x=value; ++ + break; -+ ++ + case IEEE_PARAM_WPAX_SELECT: -+ ++ + // added for WPA2 mixed mode + //DBG_871X(KERN_WARNING "------------------------>wpax value = %x\n", value); + /* @@ -358781,26 +168603,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ieee->wpax_type_notify = value; + spin_unlock_irqrestore(&ieee->wpax_suitlist_lock,flags); + */ -+ ++ + break; + -+ default: ++ default: ++ + + -+ + ret = -EOPNOTSUPP; + -+ ++ + break; -+ ++ + } + + return ret; -+ ++ +} + +static int wpa_mlme(struct net_device *dev, u32 command, u32 reason) -+{ ++{ + int ret = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + @@ -358809,15 +168631,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + case IEEE_MLME_STA_DEAUTH: + + if(!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ ++ ret = -1; ++ + break; + + case IEEE_MLME_STA_DISASSOC: -+ ++ + if(!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ ++ ret = -1; ++ + break; + + default: @@ -358826,7 +168648,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + + return ret; -+ ++ +} + +static int wpa_supplicant_ioctl(struct net_device *dev, struct iw_point *p) @@ -358834,20 +168656,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct ieee_param *param; + uint ret=0; + -+ //down(&ieee->wx_sem); ++ //down(&ieee->wx_sem); + + if (p->length < sizeof(struct ieee_param) || !p->pointer){ + ret = -EINVAL; + goto out; + } -+ ++ + param = (struct ieee_param *)rtw_malloc(p->length); + if (param == NULL) + { + ret = -ENOMEM; + goto out; + } -+ ++ + if (copy_from_user(param, p->pointer, p->length)) + { + rtw_mfree((u8*)param, p->length); @@ -358878,20 +168700,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("Unknown WPA supplicant request: %d\n", param->cmd); + ret = -EOPNOTSUPP; + break; -+ ++ + } + + if (ret == 0 && copy_to_user(p->pointer, param, p->length)) + ret = -EFAULT; + + rtw_mfree((u8 *)param, p->length); -+ ++ +out: -+ ++ + //up(&ieee->wx_sem); -+ ++ + return ret; -+ ++ +} + +#ifdef CONFIG_AP_MODE @@ -358900,9 +168722,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + int ret = 0; + u32 wep_key_idx, wep_key_len,wep_total_len; + NDIS_802_11_WEP *pwep = NULL; -+ struct sta_info *psta = NULL, *pbcmc_sta = NULL; ++ struct sta_info *psta = NULL, *pbcmc_sta = NULL; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct security_priv* psecuritypriv=&(padapter->securitypriv); + struct sta_priv *pstapriv = &padapter->stapriv; + @@ -358921,27 +168743,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && + param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) + { -+ if (param->u.crypt.idx >= WEP_KEYS -+#ifdef CONFIG_IEEE80211W -+ && param->u.crypt.idx > BIP_MAX_KEYID -+#endif /* CONFIG_IEEE80211W */ -+ ) ++ if (param->u.crypt.idx >= WEP_KEYS) + { + ret = -EINVAL; + goto exit; -+ } ++ } + } -+ else -+ { ++ else ++ { + psta = rtw_get_stainfo(pstapriv, param->sta_addr); + if(!psta) + { + //ret = -EINVAL; + DBG_871X("rtw_set_encryption(), sta has already been removed or never been added\n"); + goto exit; -+ } ++ } + } + + if (strcmp(param->u.crypt.alg, "none") == 0 && (psta==NULL)) @@ -358954,18 +168772,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; + + DBG_871X("clear default encryption keys, keyid=%d\n", param->u.crypt.idx); -+ ++ + goto exit; + } + + + if (strcmp(param->u.crypt.alg, "WEP") == 0 && (psta==NULL)) -+ { ++ { + DBG_871X("r871x_set_encryption, crypt.alg = WEP\n"); -+ ++ + wep_key_idx = param->u.crypt.idx; + wep_key_len = param->u.crypt.key_len; -+ ++ + DBG_871X("r871x_set_encryption, wep_key_idx=%d, len=%d\n", wep_key_idx, wep_key_len); + + if((wep_key_idx >= WEP_KEYS) || (wep_key_len<=0)) @@ -358973,25 +168791,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ret = -EINVAL; + goto exit; + } -+ + -+ if (wep_key_len > 0) -+ { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; ++ ++ if (wep_key_len > 0) ++ { ++ wep_key_len = wep_key_len <= 5 ? 5 : 13; + wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); -+ pwep =(NDIS_802_11_WEP *)rtw_malloc(wep_total_len); ++ pwep =(NDIS_802_11_WEP *)rtw_malloc(wep_total_len); + if(pwep == NULL){ + DBG_871X(" r871x_set_encryption: pwep allocate fail !!!\n"); + goto exit; + } -+ -+ _rtw_memset(pwep, 0, wep_total_len); -+ -+ pwep->KeyLength = wep_key_len; ++ ++ _rtw_memset(pwep, 0, wep_total_len); ++ ++ pwep->KeyLength = wep_key_len; + pwep->Length = wep_total_len; -+ ++ + } -+ ++ + pwep->KeyIndex = wep_key_idx; + + _rtw_memcpy(pwep->KeyMaterial, param->u.crypt.key, pwep->KeyLength); @@ -359004,16 +168822,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; + psecuritypriv->dot11PrivacyAlgrthm=_WEP40_; + psecuritypriv->dot118021XGrpPrivacy=_WEP40_; -+ ++ + if(pwep->KeyLength==13) + { + psecuritypriv->dot11PrivacyAlgrthm=_WEP104_; + psecuritypriv->dot118021XGrpPrivacy=_WEP104_; + } + -+ ++ + psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; -+ ++ + _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength); + + psecuritypriv->dot11DefKeylen[wep_key_idx]=pwep->KeyLength; @@ -359023,22 +168841,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + else + { + DBG_871X("wep, set_tx=0\n"); -+ -+ //don't update "psecuritypriv->dot11PrivacyAlgrthm" and ++ ++ //don't update "psecuritypriv->dot11PrivacyAlgrthm" and + //"psecuritypriv->dot11PrivacyKeyIndex=keyid", but can rtw_set_key to cam -+ ++ + _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength); + -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = pwep->KeyLength; ++ psecuritypriv->dot11DefKeylen[wep_key_idx] = pwep->KeyLength; + + rtw_ap_set_wep_key(padapter, pwep->KeyMaterial, pwep->KeyLength, wep_key_idx, 0); + } + + goto exit; -+ ++ + } + -+ ++ + if(!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) // //group key + { + if(param->u.crypt.set_tx ==1) @@ -359046,163 +168864,144 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if(strcmp(param->u.crypt.alg, "WEP") == 0) + { + DBG_871X("%s, set group_key, WEP\n", __FUNCTION__); -+ ++ + _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ ++ + psecuritypriv->dot118021XGrpPrivacy = _WEP40_; + if(param->u.crypt.key_len==13) -+ { ++ { + psecuritypriv->dot118021XGrpPrivacy = _WEP104_; + } -+ ++ + } + else if(strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { ++ { + DBG_871X("%s, set group_key, TKIP\n", __FUNCTION__); -+ ++ + psecuritypriv->dot118021XGrpPrivacy = _TKIP_; + + _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ ++ + //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); + //set mic key + _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); + _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); + -+ psecuritypriv->busetkipkey = _TRUE; -+ ++ psecuritypriv->busetkipkey = true; ++ + } + else if(strcmp(param->u.crypt.alg, "CCMP") == 0) + { + DBG_871X("%s, set group_key, CCMP\n", __FUNCTION__); -+ ++ + psecuritypriv->dot118021XGrpPrivacy = _AES_; + + _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); + } -+#ifdef CONFIG_IEEE80211W -+ else if (strcmp(param->u.crypt.alg, "BIP") == 0) { -+ int no; -+ -+ DBG_871X("BIP key_len=%d , index=%d\n", param->u.crypt.key_len, param->u.crypt.idx); -+ /* save the IGTK key, length 16 bytes */ -+ _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16:param->u.crypt.key_len)); -+ /* DBG_871X("IGTK key below:\n"); -+ for(no=0;no<16;no++) -+ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); -+ DBG_871X("\n"); */ -+ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; -+ padapter->securitypriv.binstallBIPkey = _TRUE; -+ DBG_871X(" ~~~~set sta key:IGKT\n"); -+ goto exit; -+ } -+#endif /* CONFIG_IEEE80211W */ + else + { + DBG_871X("%s, set group_key, none\n", __FUNCTION__); -+ ++ + psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; + } + + psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; + -+ psecuritypriv->binstallGrpkey = _TRUE; ++ psecuritypriv->binstallGrpkey = true; + + psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;//!!! -+ ++ + rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ ++ + pbcmc_sta=rtw_get_bcmc_stainfo(padapter); + if(pbcmc_sta) + { -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy -+ } -+ ++ pbcmc_sta->ieee8021x_blocked = false; ++ pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy ++ } ++ + } + + goto exit; -+ -+ } ++ ++ } + + if(psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) // psk/802_1x + { + if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) + { + if(param->u.crypt.set_tx ==1) -+ { ++ { + _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ ++ + if(strcmp(param->u.crypt.alg, "WEP") == 0) + { + DBG_871X("%s, set pairwise key, WEP\n", __FUNCTION__); -+ ++ + psta->dot118021XPrivacy = _WEP40_; + if(param->u.crypt.key_len==13) -+ { ++ { + psta->dot118021XPrivacy = _WEP104_; + } + } + else if(strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { ++ { + DBG_871X("%s, set pairwise key, TKIP\n", __FUNCTION__); -+ ++ + psta->dot118021XPrivacy = _TKIP_; -+ ++ + //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); + //set mic key + _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); + _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); + -+ psecuritypriv->busetkipkey = _TRUE; -+ ++ psecuritypriv->busetkipkey = true; ++ + } + else if(strcmp(param->u.crypt.alg, "CCMP") == 0) + { + + DBG_871X("%s, set pairwise key, CCMP\n", __FUNCTION__); -+ ++ + psta->dot118021XPrivacy = _AES_; + } + else + { + DBG_871X("%s, set pairwise key, none\n", __FUNCTION__); -+ ++ + psta->dot118021XPrivacy = _NO_PRIVACY_; + } -+ ++ + rtw_ap_set_pairwise_key(padapter, psta); -+ -+ psta->ieee8021x_blocked = _FALSE; -+ -+ psta->bpairwise_key_installed = _TRUE; -+ -+ } ++ ++ psta->ieee8021x_blocked = false; ++ ++ } + else//group key??? -+ { ++ { + if(strcmp(param->u.crypt.alg, "WEP") == 0) + { + _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ ++ + psecuritypriv->dot118021XGrpPrivacy = _WEP40_; + if(param->u.crypt.key_len==13) -+ { ++ { + psecuritypriv->dot118021XGrpPrivacy = _WEP104_; + } + } + else if(strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { ++ { + psecuritypriv->dot118021XGrpPrivacy = _TKIP_; + + _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ ++ + //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); + //set mic key + _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); + _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); + -+ psecuritypriv->busetkipkey = _TRUE; -+ ++ psecuritypriv->busetkipkey = true; ++ + } + else if(strcmp(param->u.crypt.alg, "CCMP") == 0) + { @@ -359217,39 +169016,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; + -+ psecuritypriv->binstallGrpkey = _TRUE; -+ ++ psecuritypriv->binstallGrpkey = true; ++ + psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;//!!! -+ ++ + rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ ++ + pbcmc_sta=rtw_get_bcmc_stainfo(padapter); + if(pbcmc_sta) + { -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy -+ } ++ pbcmc_sta->ieee8021x_blocked = false; ++ pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy ++ } + + } -+ ++ + } -+ ++ + } + +exit: + + if(pwep) + { -+ rtw_mfree((u8 *)pwep, wep_total_len); -+ } -+ ++ rtw_mfree((u8 *)pwep, wep_total_len); ++ } ++ + return ret; -+ ++ +} + +static int rtw_set_beacon(struct net_device *dev, struct ieee_param *param, int len) +{ -+ int ret=0; ++ int ret=0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct sta_priv *pstapriv = &padapter->stapriv; @@ -359258,7 +169057,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + DBG_871X("%s, len=%d\n", __FUNCTION__, len); + -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) + return -EINVAL; + + _rtw_memcpy(&pstapriv->max_num_sta, param->u.bcn_ie.reserved, 2); @@ -359271,26 +169070,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ret = 0; + else + ret = -EINVAL; -+ ++ + + return ret; -+ ++ +} + +static int rtw_hostapd_sta_flush(struct net_device *dev) +{ + //_irqL irqL; + //_list *phead, *plist; -+ int ret=0; ++ int ret=0; + //struct sta_info *psta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + //struct sta_priv *pstapriv = &padapter->stapriv; + + DBG_871X("%s\n", __FUNCTION__); + + flush_all_cam_entry(padapter); //clear CAM + -+ ret = rtw_sta_flush(padapter, _TRUE); ++ ret = rtw_sta_flush(padapter); + + return ret; + @@ -359299,24 +169098,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +static int rtw_add_sta(struct net_device *dev, struct ieee_param *param) +{ + _irqL irqL; -+ int ret=0; ++ int ret=0; + struct sta_info *psta = NULL; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct sta_priv *pstapriv = &padapter->stapriv; + + DBG_871X("rtw_add_sta(aid=%d)=" MAC_FMT "\n", param->u.add_sta.aid, MAC_ARG(param->sta_addr)); -+ -+ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != _TRUE) ++ ++ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) + { -+ return -EINVAL; ++ return -EINVAL; + } + + if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && + param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) + { -+ return -EINVAL; ++ return -EINVAL; + } + +/* @@ -359324,127 +169123,127 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if(psta) + { + DBG_871X("rtw_add_sta(), free has been added psta=%p\n", psta); -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ rtw_free_stainfo(padapter, psta); -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); ++ rtw_free_stainfo(padapter, psta); ++ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); + + psta = NULL; -+ } ++ } +*/ + //psta = rtw_alloc_stainfo(pstapriv, param->sta_addr); + psta = rtw_get_stainfo(pstapriv, param->sta_addr); + if(psta) + { -+ int flags = param->u.add_sta.flags; -+ ++ int flags = param->u.add_sta.flags; ++ + //DBG_871X("rtw_add_sta(), init sta's variables, psta=%p\n", psta); -+ ++ + psta->aid = param->u.add_sta.aid;//aid=1~2007 + + _rtw_memcpy(psta->bssrateset, param->u.add_sta.tx_supp_rates, 16); -+ -+ ++ ++ + //check wmm cap. + if(WLAN_STA_WME&flags) + psta->qos_option = 1; + else + psta->qos_option = 0; + -+ if(pmlmepriv->qospriv.qos_option == 0) ++ if(pmlmepriv->qospriv.qos_option == 0) + psta->qos_option = 0; + -+ -+#ifdef CONFIG_80211N_HT ++ ++#ifdef CONFIG_80211N_HT + //chec 802.11n ht cap. + if(WLAN_STA_HT&flags) + { -+ psta->htpriv.ht_option = _TRUE; ++ psta->htpriv.ht_option = true; + psta->qos_option = 1; + _rtw_memcpy((void*)&psta->htpriv.ht_cap, (void*)¶m->u.add_sta.ht_cap, sizeof(struct rtw_ieee80211_ht_cap)); + } -+ else ++ else + { -+ psta->htpriv.ht_option = _FALSE; ++ psta->htpriv.ht_option = false; + } -+ -+ if(pmlmepriv->htpriv.ht_option == _FALSE) -+ psta->htpriv.ht_option = _FALSE; -+#endif ++ ++ if(pmlmepriv->htpriv.ht_option == false) ++ psta->htpriv.ht_option = false; ++#endif + + + update_sta_info_apmode(padapter, psta); -+ -+ ++ ++ + } + else + { + ret = -ENOMEM; -+ } -+ ++ } ++ + return ret; -+ ++ +} + +static int rtw_del_sta(struct net_device *dev, struct ieee_param *param) +{ + _irqL irqL; -+ int ret=0; ++ int ret=0; + struct sta_info *psta = NULL; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct sta_priv *pstapriv = &padapter->stapriv; + + DBG_871X("rtw_del_sta=" MAC_FMT "\n", MAC_ARG(param->sta_addr)); -+ -+ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != _TRUE) ++ ++ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) + { -+ return -EINVAL; ++ return -EINVAL; + } + + if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && + param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) + { -+ return -EINVAL; ++ return -EINVAL; + } + + psta = rtw_get_stainfo(pstapriv, param->sta_addr); + if(psta) + { -+ u8 updated=_FALSE; -+ ++ u8 updated; ++ + //DBG_871X("free psta=%p, aid=%d\n", psta, psta->aid); + + _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if(rtw_is_list_empty(&psta->asoc_list)==_FALSE) -+ { ++ if(rtw_is_list_empty(&psta->asoc_list)==false) ++ { + rtw_list_delete(&psta->asoc_list); + pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); ++ updated = ap_free_sta(padapter, psta, true, WLAN_REASON_DEAUTH_LEAVING); + + } + _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); -+ ++ ++ associated_clients_update(padapter, updated); ++ + psta = NULL; -+ ++ + } + else + { + DBG_871X("rtw_del_sta(), sta has already been removed or never been added\n"); -+ ++ + //ret = -1; + } -+ -+ ++ ++ + return ret; -+ ++ +} + +static int rtw_ioctl_get_sta_data(struct net_device *dev, struct ieee_param *param, int len) +{ -+ int ret=0; ++ int ret=0; + struct sta_info *psta = NULL; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); @@ -359454,16 +169253,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + DBG_871X("rtw_ioctl_get_sta_info, sta_addr: " MAC_FMT "\n", MAC_ARG(param_ex->sta_addr)); + -+ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != _TRUE) ++ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) + { -+ return -EINVAL; ++ return -EINVAL; + } + + if (param_ex->sta_addr[0] == 0xff && param_ex->sta_addr[1] == 0xff && + param_ex->sta_addr[2] == 0xff && param_ex->sta_addr[3] == 0xff && -+ param_ex->sta_addr[4] == 0xff && param_ex->sta_addr[5] == 0xff) ++ param_ex->sta_addr[4] == 0xff && param_ex->sta_addr[5] == 0xff) + { -+ return -EINVAL; ++ return -EINVAL; + } + + psta = rtw_get_stainfo(pstapriv, param_ex->sta_addr); @@ -359475,7 +169274,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + u16 capability; + int flags; + u32 sta_set; -+ u8 tx_supp_rates[16]; ++ u8 tx_supp_rates[16]; + u32 tx_supp_rates_len; + struct rtw_ieee80211_ht_cap ht_cap; + u64 rx_pkts; @@ -359484,7 +169283,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + u64 tx_pkts; + u64 tx_bytes; + u64 tx_drops; -+ } get_sta; ++ } get_sta; +#endif + psta_data->aid = (u16)psta->aid; + psta_data->capability = psta->capability; @@ -359518,7 +169317,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + psta_data->tx_pkts = psta->sta_stats.tx_pkts; + psta_data->tx_bytes = psta->sta_stats.tx_bytes; + psta_data->tx_drops = psta->sta_stats.tx_drops; -+ ++ + + } + else @@ -359532,7 +169331,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + +static int rtw_get_sta_wpaie(struct net_device *dev, struct ieee_param *param) +{ -+ int ret=0; ++ int ret=0; + struct sta_info *psta = NULL; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); @@ -359540,16 +169339,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + DBG_871X("rtw_get_sta_wpaie, sta_addr: " MAC_FMT "\n", MAC_ARG(param->sta_addr)); + -+ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != _TRUE) ++ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) + { -+ return -EINVAL; ++ return -EINVAL; + } + + if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && + param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) + { -+ return -EINVAL; ++ return -EINVAL; + } + + psta = rtw_get_stainfo(pstapriv, param->sta_addr); @@ -359561,9 +169360,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + int copy_len; + + wpa_ie_len = psta->wpa_ie[1]; -+ ++ + copy_len = ((wpa_ie_len+2) > sizeof(psta->wpa_ie)) ? (sizeof(psta->wpa_ie)):(wpa_ie_len+2); -+ ++ + param->u.wpa_ie.len = copy_len; + + _rtw_memcpy(param->u.wpa_ie.reserved, psta->wpa_ie, copy_len); @@ -359572,7 +169371,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + //ret = -1; + DBG_871X("sta's wpa_ie is NONE\n"); -+ } ++ } + } + else + { @@ -359587,7 +169386,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +{ + int ret=0; + unsigned char wps_oui[4]={0x0,0x50,0xf2,0x04}; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -359595,7 +169394,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + DBG_871X("%s, len=%d\n", __FUNCTION__, len); + -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) + return -EINVAL; + + ie_len = len-12-2;// 12 = param header, 2:no packed @@ -359604,8 +169403,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if(pmlmepriv->wps_beacon_ie) + { + rtw_mfree(pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len); -+ pmlmepriv->wps_beacon_ie = NULL; -+ } ++ pmlmepriv->wps_beacon_ie = NULL; ++ } + + if(ie_len>0) + { @@ -359618,27 +169417,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + _rtw_memcpy(pmlmepriv->wps_beacon_ie, param->u.bcn_ie.buf, ie_len); + -+ update_beacon(padapter, _VENDOR_SPECIFIC_IE_, wps_oui, _TRUE); -+ -+ pmlmeext->bstart_bss = _TRUE; -+ ++ update_beacon(padapter, _VENDOR_SPECIFIC_IE_, wps_oui, true); ++ ++ pmlmeext->bstart_bss = true; ++ + } -+ -+ -+ return ret; ++ ++ ++ return ret; + +} + +static int rtw_set_wps_probe_resp(struct net_device *dev, struct ieee_param *param, int len) +{ + int ret=0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + int ie_len; + + DBG_871X("%s, len=%d\n", __FUNCTION__, len); + -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) + return -EINVAL; + + ie_len = len-12-2;// 12 = param header, 2:no packed @@ -359647,8 +169446,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if(pmlmepriv->wps_probe_resp_ie) + { + rtw_mfree(pmlmepriv->wps_probe_resp_ie, pmlmepriv->wps_probe_resp_ie_len); -+ pmlmepriv->wps_probe_resp_ie = NULL; -+ } ++ pmlmepriv->wps_probe_resp_ie = NULL; ++ } + + if(ie_len>0) + { @@ -359658,10 +169457,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); + return -EINVAL; + } -+ _rtw_memcpy(pmlmepriv->wps_probe_resp_ie, param->u.bcn_ie.buf, ie_len); ++ _rtw_memcpy(pmlmepriv->wps_probe_resp_ie, param->u.bcn_ie.buf, ie_len); + } -+ -+ ++ ++ + return ret; + +} @@ -359669,13 +169468,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +static int rtw_set_wps_assoc_resp(struct net_device *dev, struct ieee_param *param, int len) +{ + int ret=0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + int ie_len; + + DBG_871X("%s, len=%d\n", __FUNCTION__, len); + -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) + return -EINVAL; + + ie_len = len-12-2;// 12 = param header, 2:no packed @@ -359684,8 +169483,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if(pmlmepriv->wps_assoc_resp_ie) + { + rtw_mfree(pmlmepriv->wps_assoc_resp_ie, pmlmepriv->wps_assoc_resp_ie_len); -+ pmlmepriv->wps_assoc_resp_ie = NULL; -+ } ++ pmlmepriv->wps_assoc_resp_ie = NULL; ++ } + + if(ie_len>0) + { @@ -359695,11 +169494,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); + return -EINVAL; + } -+ -+ _rtw_memcpy(pmlmepriv->wps_assoc_resp_ie, param->u.bcn_ie.buf, ie_len); ++ ++ _rtw_memcpy(pmlmepriv->wps_assoc_resp_ie, param->u.bcn_ie.buf, ie_len); + } -+ -+ ++ ++ + return ret; + +} @@ -359714,10 +169513,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + int ie_len; + u8 *ssid_ie; + char ssid[NDIS_802_11_LENGTH_SSID + 1]; -+ sint ssid_len = 0; ++ sint ssid_len; + u8 ignore_broadcast_ssid; + -+ if(check_fwstate(mlmepriv, WIFI_AP_STATE) != _TRUE) ++ if(check_fwstate(mlmepriv, WIFI_AP_STATE) != true) + return -EPERM; + + if (param->u.bcn_ie.reserved[0] != 0xea) @@ -359728,18 +169527,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ie_len = len-12-2;// 12 = param header, 2:no packed + ssid_ie = rtw_get_ie(param->u.bcn_ie.buf, WLAN_EID_SSID, &ssid_len, ie_len); + -+ if (ssid_ie && ssid_len > 0 && ssid_len <= NDIS_802_11_LENGTH_SSID) { ++ if (ssid_ie && ssid_len) { + WLAN_BSSID_EX *pbss_network = &mlmepriv->cur_network.network; + WLAN_BSSID_EX *pbss_network_ext = &mlmeinfo->network; + + _rtw_memcpy(ssid, ssid_ie+2, ssid_len); -+ ssid[ssid_len] = 0x0; ++ ssid[ssid_len>NDIS_802_11_LENGTH_SSID?NDIS_802_11_LENGTH_SSID:ssid_len] = 0x0; + + if(0) -+ DBG_871X(FUNC_ADPT_FMT" ssid:(%s,%d), from ie:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ ssid, ssid_len, -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, -+ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); ++ DBG_871X(FUNC_ADPT_FMT" ssid:(%s,%d), from ie:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), ++ ssid, ssid_len, ++ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, ++ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); + + _rtw_memcpy(pbss_network->Ssid.Ssid, (void *)ssid, ssid_len); + pbss_network->Ssid.SsidLength = ssid_len; @@ -359747,9 +169546,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + pbss_network_ext->Ssid.SsidLength = ssid_len; + + if(0) -+ DBG_871X(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, -+ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); ++ DBG_871X(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), ++ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, ++ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); + } + + DBG_871X(FUNC_ADPT_FMT" ignore_broadcast_ssid:%d, %s,%d\n", FUNC_ADPT_ARG(adapter), @@ -359761,57 +169560,57 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +static int rtw_ioctl_acl_remove_sta(struct net_device *dev, struct ieee_param *param, int len) +{ + int ret=0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) + return -EINVAL; + + if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && + param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) + { -+ return -EINVAL; ++ return -EINVAL; + } + -+ ret = rtw_acl_remove_sta(padapter, param->sta_addr); ++ ret = rtw_acl_remove_sta(padapter, param->sta_addr); + -+ return ret; ++ return ret; + +} + +static int rtw_ioctl_acl_add_sta(struct net_device *dev, struct ieee_param *param, int len) +{ + int ret=0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) ++ ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) + return -EINVAL; + + if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && + param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) ++ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) + { -+ return -EINVAL; ++ return -EINVAL; + } + -+ ret = rtw_acl_add_sta(padapter, param->sta_addr); ++ ret = rtw_acl_add_sta(padapter, param->sta_addr); + -+ return ret; ++ return ret; + +} + +static int rtw_ioctl_set_macaddr_acl(struct net_device *dev, struct ieee_param *param, int len) +{ + int ret=0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return -EINVAL; -+ -+ rtw_set_macaddr_acl(padapter, param->u.mlme.command); ++ ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) ++ return -EINVAL; ++ ++ rtw_set_macaddr_acl(padapter, param->u.mlme.command); + + return ret; +} @@ -359829,7 +169628,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + * so, we just check hw_init_completed + */ + -+ if (!rtw_is_hw_init_completed(padapter)) { ++ if (padapter->hw_init_completed==false){ + ret = -EPERM; + goto out; + } @@ -359840,14 +169639,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ret = -EINVAL; + goto out; + } -+ ++ + param = (struct ieee_param *)rtw_malloc(p->length); + if (param == NULL) + { + ret = -ENOMEM; + goto out; + } -+ ++ + if (copy_from_user(param, p->pointer, p->length)) + { + rtw_mfree((u8*)param, p->length); @@ -359857,18 +169656,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + //DBG_871X("%s, cmd=%d\n", __FUNCTION__, param->cmd); + -+ switch (param->cmd) -+ { ++ switch (param->cmd) ++ { + case RTL871X_HOSTAPD_FLUSH: + + ret = rtw_hostapd_sta_flush(dev); + + break; -+ -+ case RTL871X_HOSTAPD_ADD_STA: -+ -+ ret = rtw_add_sta(dev, param); -+ ++ ++ case RTL871X_HOSTAPD_ADD_STA: ++ ++ ret = rtw_add_sta(dev, param); ++ + break; + + case RTL871X_HOSTAPD_REMOVE_STA: @@ -359876,25 +169675,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ret = rtw_del_sta(dev, param); + + break; -+ ++ + case RTL871X_HOSTAPD_SET_BEACON: + + ret = rtw_set_beacon(dev, param, p->length); + + break; -+ ++ + case RTL871X_SET_ENCRYPTION: + + ret = rtw_set_encryption(dev, param, p->length); -+ ++ + break; -+ ++ + case RTL871X_HOSTAPD_GET_WPAIE_STA: + + ret = rtw_get_sta_wpaie(dev, param); -+ ++ + break; -+ ++ + case RTL871X_HOSTAPD_SET_WPS_BEACON: + + ret = rtw_set_wps_beacon(dev, param, p->length); @@ -359904,14 +169703,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + case RTL871X_HOSTAPD_SET_WPS_PROBE_RESP: + + ret = rtw_set_wps_probe_resp(dev, param, p->length); -+ -+ break; -+ ++ ++ break; ++ + case RTL871X_HOSTAPD_SET_WPS_ASSOC_RESP: + + ret = rtw_set_wps_assoc_resp(dev, param, p->length); -+ -+ break; ++ ++ break; + + case RTL871X_HOSTAPD_SET_HIDDEN_SSID: + @@ -359924,7 +169723,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ret = rtw_ioctl_get_sta_data(dev, param, p->length); + + break; -+ ++ + case RTL871X_HOSTAPD_SET_MACADDR_ACL: + + ret = rtw_ioctl_set_macaddr_acl(dev, param, p->length); @@ -359942,12 +169741,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + ret = rtw_ioctl_acl_remove_sta(dev, param, p->length); + + break; -+ ++ + default: + DBG_871X("Unknown hostapd request: %d\n", param->cmd); + ret = -EOPNOTSUPP; + break; -+ ++ + } + + if (ret == 0 && copy_to_user(p->pointer, param, p->length)) @@ -359955,11 +169754,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + + rtw_mfree((u8 *)param, p->length); -+ ++ +out: -+ ++ + return ret; -+ ++ +} +#endif + @@ -359984,7 +169783,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + //RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_notice_, ("+rtw_wx_set_priv\n")); + if(dwrq->length == 0) + return -EFAULT; -+ ++ + len = dwrq->length; + if (!(ext = rtw_vmalloc(len))) + return -ENOMEM; @@ -359999,62 +169798,64 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + // ("rtw_wx_set_priv: %s req=%s\n", + // dev->name, ext)); + -+ #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV ++ #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV + if (!(ext_dbg = rtw_vmalloc(len))) + { + rtw_vmfree(ext, len); + return -ENOMEM; -+ } -+ ++ } ++ + _rtw_memcpy(ext_dbg, ext, len); + #endif + + //added for wps2.0 @20110524 + if(dwrq->flags == 0x8766 && len > 8) + { -+ u32 cp_sz; ++ u32 cp_sz; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + u8 *probereq_wpsie = ext; + int probereq_wpsie_len = len; -+ u8 wps_oui[4]={0x0,0x50,0xf2,0x04}; -+ ++ u8 wps_oui[4]={0x0,0x50,0xf2,0x04}; ++ + if((_VENDOR_SPECIFIC_IE_ == probereq_wpsie[0]) && -+ (_rtw_memcmp(&probereq_wpsie[2], wps_oui, 4) ==_TRUE)) ++ (_rtw_memcmp(&probereq_wpsie[2], wps_oui, 4) ==true)) + { + cp_sz = probereq_wpsie_len>MAX_WPS_IE_LEN ? MAX_WPS_IE_LEN:probereq_wpsie_len; + ++ //_rtw_memcpy(pmlmepriv->probereq_wpsie, probereq_wpsie, cp_sz); ++ //pmlmepriv->probereq_wpsie_len = cp_sz; + if(pmlmepriv->wps_probe_req_ie) + { + u32 free_len = pmlmepriv->wps_probe_req_ie_len; + pmlmepriv->wps_probe_req_ie_len = 0; + rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len); -+ pmlmepriv->wps_probe_req_ie = NULL; -+ } ++ pmlmepriv->wps_probe_req_ie = NULL; ++ } + + pmlmepriv->wps_probe_req_ie = rtw_malloc(cp_sz); + if ( pmlmepriv->wps_probe_req_ie == NULL) { + printk("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); + ret = -EINVAL; + goto FREE_EXT; -+ ++ + } -+ ++ + _rtw_memcpy(pmlmepriv->wps_probe_req_ie, probereq_wpsie, cp_sz); -+ pmlmepriv->wps_probe_req_ie_len = cp_sz; -+ -+ } -+ ++ pmlmepriv->wps_probe_req_ie_len = cp_sz; ++ ++ } ++ + goto FREE_EXT; -+ ++ + } + + if( len >= WEXT_CSCAN_HEADER_SIZE -+ && _rtw_memcmp(ext, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == _TRUE ++ && _rtw_memcmp(ext, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == true + ){ + ret = rtw_wx_set_scan(dev, info, awrq, ext); + goto FREE_EXT; + } -+ ++ +#ifdef CONFIG_ANDROID + //DBG_871X("rtw_wx_set_priv: %s req=%s\n", dev->name, ext); + @@ -360069,10 +169870,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + break; + case ANDROID_WIFI_CMD_RSSI : + { -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct wlan_network *pcur_network = &pmlmepriv->cur_network; + -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { ++ if(check_fwstate(pmlmepriv, _FW_LINKED) == true) { + sprintf(ext, "%s rssi %d", pcur_network->network.Ssid.Ssid, padapter->recvpriv.rssi); + } else { + sprintf(ext, "OK"); @@ -360116,7 +169917,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + #endif + + sprintf(ext, "OK"); -+ ++ + } + + if (copy_to_user(dwrq->pointer, ext, min(dwrq->length, (u16)(strlen(ext)+1)) ) ) @@ -360136,285 +169937,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + rtw_vmfree(ext_dbg, len); + #endif + -+ //DBG_871X("rtw_wx_set_priv: (SIOCSIWPRIV) %s ret=%d\n", ++ //DBG_871X("rtw_wx_set_priv: (SIOCSIWPRIV) %s ret=%d\n", + // dev->name, ret); + + return ret; -+ ++ +} -+#ifdef CONFIG_WOWLAN -+static int rtw_wowlan_ctrl(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wowlan_ioctl_param poidparam; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct net_device *pnetdev = padapter->pnetdev; -+#ifdef CONFIG_CONCURRENT_MODE -+ struct net_device *pbuddy_netdev = padapter->pbuddy_adapter->pnetdev; -+#endif -+ struct sta_info *psta = NULL; -+ int ret = 0; -+ u32 start_time = rtw_get_current_time(); -+ poidparam.subcode = 0; -+ -+ DBG_871X("+rtw_wowlan_ctrl: %s\n", extra); -+ -+ if (!check_fwstate(pmlmepriv, _FW_LINKED) && -+ check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+#ifdef CONFIG_PNO_SUPPORT -+ pwrctrlpriv->wowlan_pno_enable = _TRUE; -+#else -+ DBG_871X("[%s] WARNING: Please Connect With AP First!!\n", __func__); -+ goto _rtw_wowlan_ctrl_exit_free; -+#endif //CONFIG_PNO_SUPPORT -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) -+ rtw_scan_abort(padapter); -+ -+ if (_rtw_memcmp(extra, "enable", 6)) { -+ -+ padapter->registrypriv.mp_mode = 1; -+ -+ rtw_suspend_common(padapter); -+ -+ } else if (_rtw_memcmp(extra, "disable", 7)) { -+#ifdef CONFIG_USB_HCI -+ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); -+#endif -+ rtw_resume_common(padapter); -+ -+#ifdef CONFIG_PNO_SUPPORT -+ pwrctrlpriv->wowlan_pno_enable = _FALSE; -+#endif //CONFIG_PNO_SUPPORT -+ -+ padapter->registrypriv.mp_mode = 0; -+ } else { -+ DBG_871X("[%s] Invalid Parameter.\n", __func__); -+ goto _rtw_wowlan_ctrl_exit_free; -+ } -+ //mutex_lock(&ioctl_mutex); -+_rtw_wowlan_ctrl_exit_free: -+ DBG_871X("-rtw_wowlan_ctrl( subcode = %d)\n", poidparam.subcode); -+ DBG_871X_LEVEL(_drv_always_, "%s in %d ms\n", __func__, -+ rtw_get_passing_time_ms(start_time)); -+_rtw_wowlan_ctrl_exit: -+ return ret; -+} -+ -+static bool rtw_wowlan_parser_pattern_cmd(u8 *input, char *pattern, -+ int *pattern_len, char *bit_mask) -+{ -+ char *cp = NULL, *end = NULL; -+ size_t len = 0; -+ int pos = 0, temp = 0, mask_pos = 0, res = 0; -+ u8 member[2] = {0}; -+ -+ cp = strchr(input, '='); -+ if (cp) { -+ *cp = 0; -+ cp++; -+ } -+ -+ input = cp; -+ -+ while (1) { -+ cp = strchr(input, ':'); -+ -+ if (cp) { -+ len = strlen(input) - strlen(cp); -+ *cp = 0; -+ cp++; -+ } else { -+ len = 2; -+ } -+ -+ if (bit_mask && (strcmp(input, "-") == 0 || -+ strcmp(input, "xx") == 0 || -+ strcmp(input, "--") == 0)) { -+ /* skip this byte and leave mask bit unset */ -+ } else { -+ strncpy(member, input, len); -+ if (!rtw_check_pattern_valid(member, sizeof(member))) { -+ DBG_871X("%s:[ERROR] pattern is invalid!!\n", -+ __func__); -+ goto error; -+ } -+ res = sscanf(member, "%02x", &temp); -+ if (temp < 0 || temp > 256) -+ goto error; -+ pattern[pos] = temp; -+ mask_pos = pos / 8; -+ if (bit_mask) -+ bit_mask[mask_pos] |= 1 << (pos % 8); -+ } -+ -+ pos++; -+ if (!cp) -+ break; -+ input = cp; -+ } -+ -+ (*pattern_len) = pos; -+ -+ return _TRUE; -+error: -+ return _FALSE; -+} -+ -+/* -+ * IP filter This pattern if for a frame containing a ip packet: -+ * AA:AA:AA:AA:AA:AA:BB:BB:BB:BB:BB:BB:CC:CC:DD:-:-:-:-:-:-:-:-:EE:-:-:FF:FF:FF:FF:GG:GG:GG:GG:HH:HH:II:II -+ * -+ * A: Ethernet destination address -+ * B: Ethernet source address -+ * C: Ethernet protocol type -+ * D: IP header VER+Hlen, use: 0x45 (4 is for ver 4, 5 is for len 20) -+ * E: IP protocol -+ * F: IP source address ( 192.168.0.4: C0:A8:00:2C ) -+ * G: IP destination address ( 192.168.0.4: C0:A8:00:2C ) -+ * H: Source port (1024: 04:00) -+ * I: Destination port (1024: 04:00) -+ */ -+ -+static int rtw_wowlan_set_pattern(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wowlan_ioctl_param poidparam; -+ int ret = 0, len = 0, i = 0; -+ u32 start_time = rtw_get_current_time(); -+ u8 input[wrqu->data.length]; -+ u8 index = 0; -+ -+ poidparam.subcode = 0; -+ -+ if (!check_fwstate(pmlmepriv, _FW_LINKED) && -+ check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ ret = -EFAULT; -+ DBG_871X("Please Connect With AP First!!\n"); -+ goto _rtw_wowlan_set_pattern_exit; -+ } -+ -+ if (wrqu->data.length <= 0) { -+ ret = -EFAULT; -+ DBG_871X("ERROR: parameter length <= 0\n"); -+ goto _rtw_wowlan_set_pattern_exit; -+ } else { -+ /* set pattern */ -+ if (copy_from_user(input, -+ wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ /* leave PS first */ -+ rtw_ps_deny(padapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(padapter); -+ if (strncmp(input, "pattern=", 8) == 0) { -+ if (pwrpriv->wowlan_pattern_idx >= MAX_WKFM_NUM) { -+ DBG_871X("WARNING: priv-pattern is full(%d)\n", -+ MAX_WKFM_NUM); -+ DBG_871X("WARNING: please clean priv-pattern first\n"); -+ ret = -EINVAL; -+ goto _rtw_wowlan_set_pattern_exit; -+ } else { -+ index = pwrpriv->wowlan_pattern_idx; -+ -+ ret = rtw_wowlan_parser_pattern_cmd(input, -+ pwrpriv->patterns[index].content, -+ &pwrpriv->patterns[index].len, -+ pwrpriv->patterns[index].mask); -+ -+ if (ret) { -+ pwrpriv->wowlan_pattern_idx++; -+ pwrpriv->wowlan_pattern = _TRUE; -+ } else { -+ goto _rtw_wowlan_set_pattern_exit; -+ } -+ } -+ } else if (strncmp(input, "clean", 5) == 0) { -+ poidparam.subcode = WOWLAN_PATTERN_CLEAN; -+ rtw_hal_set_hwreg(padapter, -+ HW_VAR_WOWLAN, (u8 *)&poidparam); -+ pwrpriv->wowlan_pattern = _FALSE; -+ } else if (strncmp(input, "show", 4) == 0) { -+ for (i = 0 ; i < MAX_WKFM_NUM ; i++) { -+ DBG_871X("=======[%d]=======\n", i); -+ rtw_read_from_frame_mask(padapter, i); -+ } -+ -+ DBG_871X("********[RTK priv-patterns]*********\n"); -+ for (i = 0 ; i < MAX_WKFM_NUM ; i++) -+ rtw_dump_priv_pattern(padapter, i); -+ } else { -+ DBG_871X("ERROR: incorrect parameter!\n"); -+ ret = -EINVAL; -+ } -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+ } -+_rtw_wowlan_set_pattern_exit: -+ return ret; -+} -+#endif //CONFIG_WOWLAN -+ -+#ifdef CONFIG_AP_WOWLAN -+static int rtw_ap_wowlan_ctrl(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wowlan_ioctl_param poidparam; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_info *psta = NULL; -+ int ret = 0; -+ u32 start_time = rtw_get_current_time(); -+ poidparam.subcode = 0; -+ -+ DBG_871X("+rtw_ap_wowlan_ctrl: %s\n", extra); -+ -+#ifndef CONFIG_USB_HCI -+ if(pwrctrlpriv->bSupportRemoteWakeup==_FALSE){ -+ ret = -EPERM; -+ DBG_871X("+rtw_wowlan_ctrl: Device didn't support the remote wakeup!!\n"); -+ goto _rtw_ap_wowlan_ctrl_exit_free; -+ } -+#endif -+ -+ if (!check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ DBG_871X("[%s] It is not AP mode!!\n", __func__); -+ goto _rtw_ap_wowlan_ctrl_exit_free; -+ } -+ -+ if (_rtw_memcmp(extra, "enable", 6)) { -+ -+ pwrctrlpriv->wowlan_ap_mode = _TRUE; -+ -+ rtw_suspend_common(padapter); -+ } else if (_rtw_memcmp(extra, "disable", 7)) { -+#ifdef CONFIG_USB_HCI -+ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); -+#endif -+ rtw_resume_common(padapter); -+ } else { -+ DBG_871X("[%s] Invalid Parameter.\n", __func__); -+ goto _rtw_ap_wowlan_ctrl_exit_free; -+ } -+ //mutex_lock(&ioctl_mutex); -+_rtw_ap_wowlan_ctrl_exit_free: -+ DBG_871X("-rtw_ap_wowlan_ctrl( subcode = %d)\n", poidparam.subcode); -+ DBG_871X_LEVEL(_drv_always_, "%s in %d ms\n", __func__, -+ rtw_get_passing_time_ms(start_time)); -+_rtw_ap_wowlan_ctrl_exit: -+ return ret; -+} -+#endif //CONFIG_AP_WOWLAN + +static int rtw_pm_set(struct net_device *dev, + struct iw_request_info *info, @@ -360428,7 +169956,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + if ( _rtw_memcmp( extra, "lps=", 4 ) ) + { -+ sscanf(extra+4, "%u", &mode); ++ sscanf(extra+4, "%u", &mode); + ret = rtw_pm_set_lps(padapter,mode); + } + else if ( _rtw_memcmp( extra, "ips=", 4 ) ) @@ -360448,37 +169976,36 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + union iwreq_data *wdata, char *extra) +{ + PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); ++ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); + PEFUSE_HAL pEfuseHal; + struct iw_point *wrqu; -+ -+ u8 *PROMContent = pHalData->efuse_eeprom_data; -+ u8 ips_mode = IPS_NUM; // init invalid value -+ u8 lps_mode = PS_MODE_NUM; // init invalid value ++ ++ u8 *PROMContent = pEEPROM->efuse_eeprom_data; ++ u8 ips_mode,lps_mode; + struct pwrctrl_priv *pwrctrlpriv ; + u8 *data = NULL; + u8 *rawdata = NULL; -+ char *pch, *ptmp, *token, *tmp[3]={0x00,0x00,0x00}; ++ char *pch, *ptmp, *token, *tmp[3]={NULL, NULL, NULL}; + u16 i=0, j=0, mapLen=0, addr=0, cnts=0; + u16 max_available_size=0, raw_cursize=0, raw_maxsize=0; + int err; + #ifdef CONFIG_IOL + u8 org_fw_iol = padapter->registrypriv.fw_iol;// 0:Disable, 1:enable, 2:by usb speed + #endif -+ ++ + wrqu = (struct iw_point*)wdata; -+ pwrctrlpriv = adapter_to_pwrctl(padapter); ++ pwrctrlpriv = &padapter->pwrctrlpriv; + pEfuseHal = &pHalData->EfuseHal; + + err = 0; -+ data = rtw_zmalloc(EFUSE_BT_MAX_MAP_LEN); ++ data = _rtw_zmalloc(EFUSE_BT_MAX_MAP_LEN); + if (data == NULL) + { + err = -ENOMEM; + goto exit; + } -+ rawdata = rtw_zmalloc(EFUSE_BT_MAX_MAP_LEN); ++ rawdata = _rtw_zmalloc(EFUSE_BT_MAX_MAP_LEN); + if (rawdata == NULL) + { + err = -ENOMEM; @@ -360493,13 +170020,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + #ifdef CONFIG_LPS + lps_mode = pwrctrlpriv->power_mgnt;//keep org value + rtw_pm_set_lps(padapter,PS_MODE_ACTIVE); -+ #endif -+ -+ #ifdef CONFIG_IPS ++ #endif ++ ++ #ifdef CONFIG_IPS + ips_mode = pwrctrlpriv->ips_mode;//keep org value + rtw_pm_set_ips(padapter,IPS_NONE); -+ #endif -+ ++ #endif ++ + pch = extra; + DBG_871X("%s: in=%s\n", __FUNCTION__, extra); + @@ -360514,18 +170041,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + #ifdef CONFIG_IOL + padapter->registrypriv.fw_iol = 0;// 0:Disable, 1:enable, 2:by usb speed + #endif -+ ++ + if(strcmp(tmp[0], "status") == 0){ -+ sprintf(extra, "Load File efuse=%s,Load File MAC=%s" -+ , pHalData->efuse_file_status == EFUSE_FILE_FAILED ? "FAIL" : "OK" -+ , pHalData->macaddr_file_status == MACADDR_FILE_FAILED ? "FAIL" : "OK" -+ ); ++ sprintf(extra, "Load File efuse=%s,Load File MAC=%s",(pEEPROM->bloadfile_fail_flag? "FAIL" : "OK"),(pEEPROM->bloadmac_fail_flag? "FAIL" : "OK")); ++ + goto exit; + } -+ else if (strcmp(tmp[0], "drvmap") == 0) ++ else if (strcmp(tmp[0], "filemap") == 0) + { + mapLen = EFUSE_MAP_SIZE; -+ ++ + sprintf(extra, "\n"); + for (i = 0; i < EFUSE_MAP_SIZE; i += 16) + { @@ -360549,7 +170074,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + else if (strcmp(tmp[0], "realmap") == 0) + { + mapLen = EFUSE_MAP_SIZE; -+ if (rtw_efuse_mask_map_read(padapter, EFUSE_WIFI , mapLen, pEfuseHal->fakeEfuseInitMap) == _FAIL) ++ if (rtw_efuse_map_read(padapter, 0, mapLen, pEfuseHal->fakeEfuseInitMap) == _FAIL) + { + DBG_871X("%s: read realmap Fail!!\n", __FUNCTION__); + err = -EFAULT; @@ -360562,13 +170087,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { +// DBG_871X("0x%02x\t", i); + sprintf(extra, "%s0x%02x\t", extra, i); -+ for (j=0; j<8; j++) { ++ for (j=0; j<8 && i+jfakeEfuseInitMap[i+j]); + } +// DBG_871X("\t"); + sprintf(extra, "%s\t", extra); -+ for (; j<16; j++) { ++ for (; j<16 && i+jfakeEfuseInitMap[i+j]); + } @@ -360599,17 +170124,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); + -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (PVOID)&max_available_size, _FALSE); -+ if ((addr+ cnts) > max_available_size) ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); ++ if ((addr + cnts) > max_available_size) + { + DBG_871X("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); + err = -EINVAL; + goto exit; + } + -+ if (rtw_efuse_mask_map_read(padapter, addr, cnts, data) == _FAIL) ++ if (rtw_efuse_map_read(padapter, addr, cnts, data) == _FAIL) + { -+ DBG_871X("%s: rtw_efuse_mask_map_read error!\n", __func__); ++ DBG_871X("%s: rtw_efuse_map_read error!\n", __FUNCTION__); + err = -EFAULT; + goto exit; + } @@ -360626,98 +170151,58 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + addr = 0; + mapLen = EFUSE_MAX_SIZE; -+ DBG_871X("EFUSE_MAX_SIZE = %d\n", EFUSE_MAX_SIZE); -+ -+ if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) { -+ DBG_871X("%s: rtw_efuse_access Fail!!\n", __func__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (mapLen >= 512) -+ mapLen = 512; -+ -+ _rtw_memset(extra,'\0',strlen(extra)); -+ -+ sprintf(extra, "\n0x00\t"); -+ -+ for (i = 0; i < mapLen ; i++) { -+ sprintf(extra, "%s%02X", extra, rawdata[i]); -+ if ((i & 0xF) == 0xF) { -+ sprintf(extra, "%s\n", extra); -+ sprintf(extra, "%s0x%02x\t", extra, i+1); -+ } else if ((i & 0x7) == 0x7) { -+ sprintf(extra, "%s \t", extra); -+ } else { -+ sprintf(extra, "%s ", extra); -+ } -+ } -+ -+ } else if (strcmp(tmp[0], "realrawb") == 0) { -+ addr = 0; -+ mapLen = EFUSE_MAX_SIZE; -+ DBG_871X("EFUSE_MAX_SIZE =%d\n", EFUSE_MAX_SIZE); -+ if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) ++ if (rtw_efuse_access(padapter, false, addr, mapLen, rawdata) == _FAIL) + { + DBG_871X("%s: rtw_efuse_access Fail!!\n", __FUNCTION__); + err = -EFAULT; + goto exit; + } -+ _rtw_memset(extra,'\0',strlen(extra)); -+ // DBG_871X("%s: realraw={\n", __FUNCTION__); -+ sprintf(extra, "\n0x00\t"); -+ for (i= 512; i< mapLen; i++) -+ { -+ // DBG_871X("%02X", rawdata[i]); -+ sprintf(extra, "%s%02X", extra, rawdata[i]); -+ if ((i & 0xF) == 0xF) { -+ // DBG_871X("\n"); -+ sprintf(extra, "%s\n", extra); -+ sprintf(extra, "%s0x%02x\t", extra, i+1); -+ } -+ else if ((i & 0x7) == 0x7){ -+ // DBG_871X("\t"); -+ sprintf(extra, "%s \t", extra); -+ } else { -+ // DBG_871X(" "); -+ sprintf(extra, "%s ", extra); -+ } -+ } -+ // DBG_871X("}\n"); ++ ++// DBG_871X("%s: realraw={\n", __FUNCTION__); ++ sprintf(extra, "\n"); ++ for (i=0; i max_available_size) { + DBG_871X("%s: addr(0x%02x)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); + err = -EFAULT; + goto exit; + } + -+ if (rtw_efuse_mask_map_read(padapter, addr, cnts, data) == _FAIL) ++ if (rtw_efuse_map_read(padapter, addr, cnts, data) == _FAIL) + { -+ DBG_871X("%s: rtw_efuse_mask_map_read error!\n", __func__); ++ DBG_871X("%s: rtw_efuse_map_read error!\n", __FUNCTION__); + err = -EFAULT; + goto exit; + } + -+// DBG_871X("%s: MAC address={", __FUNCTION__); + *extra = 0; + for (i=0; i max_available_size) + { + DBG_871X("%s: addr(0x%02x)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); + err = -EFAULT; + goto exit; + } -+ if (rtw_efuse_mask_map_read(padapter, addr, cnts, data) == _FAIL) ++ if (rtw_efuse_map_read(padapter, addr, cnts, data) == _FAIL) + { + DBG_871X("%s: rtw_efuse_access error!!\n", __FUNCTION__); + err = -EFAULT; + goto exit; + } + -+// DBG_871X("%s: {VID,PID}={", __FUNCTION__); + *extra = 0; + for (i=0; iBTEfuseInitMap) == _FAIL) + { @@ -360821,8 +170277,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + else if (strcmp(tmp[0],"btbmap") == 0) + { -+ BTEfuse_PowerSwitch(padapter,1,_TRUE); -+ + mapLen = EFUSE_BT_MAX_MAP_LEN; + if (rtw_BT_efuse_map_read(padapter, 0, mapLen, pEfuseHal->BTEfuseInitMap) == _FAIL) + { @@ -360861,8 +170315,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + goto exit; + } + -+ BTEfuse_PowerSwitch(padapter,1,_TRUE); -+ + // rmap addr cnts + addr = simple_strtoul(tmp[1], &ptmp, 16); + DBG_871X("%s: addr=0x%X\n", __FUNCTION__, addr); @@ -360876,7 +170328,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); + -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); + if ((addr + cnts) > max_available_size) + { + DBG_871X("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); @@ -360884,7 +170336,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + goto exit; + } + -+ if (rtw_BT_efuse_map_read(padapter, addr, cnts, data) == _FAIL) ++ if (rtw_BT_efuse_map_read(padapter, addr, cnts, data) == _FAIL) + { + DBG_871X("%s: rtw_BT_efuse_map_read error!!\n", __FUNCTION__); + err = -EFAULT; @@ -360899,7 +170351,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + sprintf(extra, "%s 0x%02X ", extra, data[i]); + } +// DBG_871X("}\n"); -+ DBG_871X(FUNC_ADPT_FMT ": BT MAC=[%s]\n", FUNC_ADPT_ARG(padapter), extra); + } + else if (strcmp(tmp[0], "btffake") == 0) + { @@ -360955,13 +170406,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { +// DBG_871X("\t0x%02x\t", i); + sprintf(extra, "%s0x%02x\t", extra, i); -+ for (j=0; j<8; j++) { ++ for (j=0; j<8 && i+jfakeEfuseModifiedMap[i+j]); + sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeEfuseModifiedMap[i+j]); + } +// DBG_871X("\t"); + sprintf(extra, "%s\t", extra); -+ for (; j<16; j++) { ++ for (; j<16 && i+jfakeEfuseModifiedMap[i+j]); + sprintf(extra, "%s %02X", extra, pEfuseHal->fakeEfuseModifiedMap[i+j]); + } @@ -360969,63 +170420,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + sprintf(extra, "%s\n", extra); + } +// DBG_871X("\n"); -+ -+ } -+ else if (strcmp(tmp[0],"wlrfkrmap")== 0) -+ { -+ if ((tmp[1]==NULL) || (tmp[2]==NULL)) -+ { -+ DBG_871X("%s: rmap Fail!! Parameters error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ // rmap addr cnts -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ DBG_871X("%s: addr=%x\n", __FUNCTION__, addr); -+ -+ cnts = simple_strtoul(tmp[2], &ptmp, 10); -+ if (cnts == 0) -+ { -+ DBG_871X("%s: rmap Fail!! cnts error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); -+ -+ // DBG_871X("%s: data={", __FUNCTION__); -+ *extra = 0; -+ for (i=0; ifakeEfuseModifiedMap[addr+i]); -+ sprintf(extra, "%s0x%02X ", extra, pEfuseHal->fakeEfuseModifiedMap[addr+i]); -+ } -+ } -+ else if (strcmp(tmp[0],"btrfkrmap")== 0) -+ { -+ if ((tmp[1]==NULL) || (tmp[2]==NULL)) -+ { -+ DBG_871X("%s: rmap Fail!! Parameters error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ // rmap addr cnts -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ DBG_871X("%s: addr=%x\n", __FUNCTION__, addr); -+ -+ cnts = simple_strtoul(tmp[2], &ptmp, 10); -+ if (cnts == 0) -+ { -+ DBG_871X("%s: rmap Fail!! cnts error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); -+ -+ // DBG_871X("%s: data={", __FUNCTION__); -+ *extra = 0; -+ for (i=0; ifakeBTEfuseModifiedMap[addr+i]); -+ sprintf(extra, "%s0x%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[addr+i]); -+ } + } + else + { @@ -361034,23 +170428,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + +exit: + if (data) -+ rtw_mfree(data, EFUSE_BT_MAX_MAP_LEN); ++ _rtw_mfree(data, EFUSE_BT_MAX_MAP_LEN); + if (rawdata) -+ rtw_mfree(rawdata, EFUSE_BT_MAX_MAP_LEN); ++ _rtw_mfree(rawdata, EFUSE_BT_MAX_MAP_LEN); + if (!err) + wrqu->length = strlen(extra); -+ -+ if (padapter->registrypriv.mp_mode == 0) -+ { -+ #ifdef CONFIG_IPS ++ ++ #ifdef CONFIG_IPS + rtw_pm_set_ips(padapter, ips_mode); -+#endif // CONFIG_IPS -+ -+ #ifdef CONFIG_LPS ++ #endif ++ #ifdef CONFIG_LPS + rtw_pm_set_lps(padapter, lps_mode); -+#endif // CONFIG_LPS -+ } -+ ++ #endif + #ifdef CONFIG_IOL + padapter->registrypriv.fw_iol = org_fw_iol;// 0:Disable, 1:enable, 2:by usb speed + #endif @@ -361067,46 +170456,42 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + PHAL_DATA_TYPE pHalData; + PEFUSE_HAL pEfuseHal; + -+ u8 ips_mode = IPS_NUM; // init invalid value -+ u8 lps_mode = PS_MODE_NUM; // init invalid value -+ u32 i=0,j=0, jj, kk; ++ u8 ips_mode,lps_mode; ++ u32 i, jj, kk; + u8 *setdata = NULL; + u8 *ShadowMapBT = NULL; + u8 *ShadowMapWiFi = NULL; + u8 *setrawdata = NULL; -+ char *pch, *ptmp, *token, *tmp[3]={0x00,0x00,0x00}; -+ u16 addr=0xFF, cnts=0, BTStatus=0 , max_available_size=0; ++ char *pch, *ptmp, *token, *tmp[3]={NULL, NULL, NULL}; ++ u16 addr=0, cnts=0, max_available_size=0; + int err; + ++ + wrqu = (struct iw_point*)wdata; + padapter = rtw_netdev_priv(dev); -+ pwrctrlpriv = adapter_to_pwrctl(padapter); ++ pwrctrlpriv = &padapter->pwrctrlpriv; + pHalData = GET_HAL_DATA(padapter); + pEfuseHal = &pHalData->EfuseHal; + err = 0; -+ -+ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ setdata = rtw_zmalloc(1024); ++ setdata = _rtw_zmalloc(1024); + if (setdata == NULL) + { + err = -ENOMEM; + goto exit; + } -+ ShadowMapBT = rtw_malloc(EFUSE_BT_MAX_MAP_LEN); ++ ShadowMapBT = _rtw_malloc(EFUSE_BT_MAX_MAP_LEN); + if (ShadowMapBT == NULL) + { + err = -ENOMEM; + goto exit; + } -+ ShadowMapWiFi = rtw_malloc(EFUSE_MAP_SIZE); ++ ShadowMapWiFi = _rtw_malloc(EFUSE_MAP_SIZE); + if (ShadowMapWiFi == NULL) + { + err = -ENOMEM; + goto exit; + } -+ setrawdata = rtw_malloc(EFUSE_MAX_SIZE); ++ setrawdata = _rtw_malloc(EFUSE_MAX_SIZE); + if (setrawdata == NULL) + { + err = -ENOMEM; @@ -361116,16 +170501,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + #ifdef CONFIG_LPS + lps_mode = pwrctrlpriv->power_mgnt;//keep org value + rtw_pm_set_lps(padapter,PS_MODE_ACTIVE); -+ #endif -+ -+ #ifdef CONFIG_IPS ++ #endif ++ ++ #ifdef CONFIG_IPS + ips_mode = pwrctrlpriv->ips_mode;//keep org value + rtw_pm_set_ips(padapter,IPS_NONE); -+ #endif -+ ++ #endif ++ + pch = extra; + DBG_871X("%s: in=%s\n", __FUNCTION__, extra); -+ ++ + i = 0; + while ((token = strsep(&pch, ",")) != NULL) + { @@ -361144,18 +170529,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + goto exit; + } + -+#if 1 -+ // unknown bug workaround, need to fix later -+ addr=0x1ff; -+ rtw_write8(padapter, EFUSE_CTRL+1, (addr & 0xff)); -+ rtw_msleep_os(10); -+ rtw_write8(padapter, EFUSE_CTRL+2, ((addr >> 8) & 0x03)); -+ rtw_msleep_os(10); -+ rtw_write8(padapter, EFUSE_CTRL+3, 0x72); -+ rtw_msleep_os(10); -+ rtw_read8(padapter, EFUSE_CTRL); -+#endif -+ + addr = simple_strtoul(tmp[1], &ptmp, 16); + addr &= 0xFFF; + @@ -361175,17 +170548,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("%s: addr=0x%X\n", __FUNCTION__, addr); + DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); + DBG_871X("%s: map data=%s\n", __FUNCTION__, tmp[2]); -+ ++ + for (jj=0, kk=0; jj max_available_size) + { + DBG_871X("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); @@ -361199,25 +170568,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + err = -EFAULT; + goto exit; + } -+ *extra = 0; -+ DBG_871X("%s: after rtw_efuse_map_write to _rtw_memcmp\n", __func__); -+ if (rtw_efuse_mask_map_read(padapter, addr, cnts, ShadowMapWiFi) == _SUCCESS) -+ { -+ if (_rtw_memcmp((void*)ShadowMapWiFi ,(void*)setdata,cnts)) -+ { -+ DBG_871X("%s: WiFi write map afterf compare success\n", __FUNCTION__); -+ sprintf(extra, "WiFi write map compare OK\n"); -+ err = 0; -+ goto exit; -+ } -+ else -+ { -+ sprintf(extra, "WiFi write map compare FAIL\n"); -+ DBG_871X("%s: WiFi write map compare Fail\n", __FUNCTION__); -+ err = 0; -+ goto exit; -+ } -+ } + } + else if (strcmp(tmp[0], "wraw") == 0) + { @@ -361252,7 +170602,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + setrawdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk+1]); + } + -+ if (rtw_efuse_access(padapter, _TRUE, addr, cnts, setrawdata) == _FAIL) ++ if (rtw_efuse_access(padapter, true, addr, cnts, setrawdata) == _FAIL) + { + DBG_871X("%s: rtw_efuse_access error!!\n", __FUNCTION__); + err = -EFAULT; @@ -361267,14 +170617,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + goto exit; + } + -+ //mac,00e04c871200 -+ -+ if (hal_efuse_macaddr_offset(padapter) == -1) { -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ addr = hal_efuse_macaddr_offset(padapter); + cnts = strlen(tmp[1]); + if (cnts%2) + { @@ -361302,12 +170644,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + setdata[jj] = key_2char2num(tmp[1][kk], tmp[1][kk+1]); + } -+#ifndef CONFIG_RTL8188E -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); -+#else -+ //Change to check TYPE_EFUSE_MAP_LEN ,beacuse 8188E raw 256,logic map over 256. -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_size, _FALSE); -+#endif ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); + if ((addr+cnts) > max_available_size) + { + DBG_871X("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); @@ -361330,33 +170667,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + goto exit; + } + -+ // pidvid,da0b7881 -+ #ifdef CONFIG_RTL8188E -+ #ifdef CONFIG_USB_HCI -+ addr = EEPROM_VID_88EU; -+ #endif -+ #ifdef CONFIG_PCI_HCI -+ addr = EEPROM_VID_88EE; -+ #endif -+ #endif // CONFIG_RTL8188E -+ -+ #ifdef CONFIG_RTL8192E -+ #ifdef CONFIG_USB_HCI -+ addr = EEPROM_VID_8192EU; -+ #endif -+ #ifdef CONFIG_PCI_HCI -+ addr = EEPROM_VID_8192EE; -+ #endif -+ #endif // CONFIG_RTL8188E -+ -+ #ifdef CONFIG_RTL8723B -+ addr = EEPROM_VID_8723BU; -+ #endif -+ -+ #ifdef CONFIG_RTL8188F -+ addr = EEPROM_VID_8188FU; -+ #endif -+ ++ // pidvid,da0b7881 + cnts = strlen(tmp[1]); + if (cnts%2) + { @@ -361379,7 +170690,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + setdata[jj] = key_2char2num(tmp[1][kk], tmp[1][kk+1]); + } + -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); + if ((addr+cnts) > max_available_size) + { + DBG_871X("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); @@ -361394,41 +170705,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + goto exit; + } + } -+ else if (strcmp(tmp[0], "wldumpfake") == 0) -+ { -+ if (rtw_efuse_mask_map_read(padapter, 0, EFUSE_MAP_SIZE, pEfuseHal->fakeEfuseModifiedMap) == _SUCCESS) { -+ DBG_871X("%s: WiFi hw efuse dump to Fake map success\n", __func__); -+ } else { -+ DBG_871X("%s: WiFi hw efuse dump to Fake map Fail\n", __func__); -+ err = -EFAULT; -+ } -+ } + else if (strcmp(tmp[0], "btwmap") == 0) + { -+ rtw_write8(padapter, 0xa3, 0x05); //For 8723AB ,8821S ? -+ BTStatus=rtw_read8(padapter, 0xa0); -+ DBG_871X("%s: btwmap before read 0xa0 BT Status =0x%x \n", __FUNCTION__,BTStatus); -+ if (BTStatus != 0x04) -+ { -+ sprintf(extra, "BT Status not Active Write FAIL\n"); -+ goto exit; -+ } -+ + if ((tmp[1]==NULL) || (tmp[2]==NULL)) + { + err = -EINVAL; + goto exit; + } -+ BTEfuse_PowerSwitch(padapter,1,_TRUE); -+ -+ addr=0x1ff; -+ rtw_write8(padapter, EFUSE_CTRL+1, (addr & 0xff)); -+ rtw_msleep_os(10); -+ rtw_write8(padapter, EFUSE_CTRL+2, ((addr >> 8) & 0x03)); -+ rtw_msleep_os(10); -+ rtw_write8(padapter, EFUSE_CTRL+3, 0x72); -+ rtw_msleep_os(10); -+ rtw_read8(padapter, EFUSE_CTRL); + + addr = simple_strtoul(tmp[1], &ptmp, 16); + addr &= 0xFFF; @@ -361455,7 +170738,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + setdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk+1]); + } + -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); + if ((addr+cnts) > max_available_size) + { + DBG_871X("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); @@ -361469,25 +170752,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + err = -EFAULT; + goto exit; + } -+ *extra = 0; -+ DBG_871X("%s: after rtw_BT_efuse_map_write to _rtw_memcmp \n", __FUNCTION__); -+ if ( (rtw_BT_efuse_map_read(padapter, addr, cnts, ShadowMapBT ) == _SUCCESS ) ) -+ { -+ if (_rtw_memcmp((void*)ShadowMapBT ,(void*)setdata,cnts)) -+ { -+ DBG_871X("%s: BT write map compare OK BTStatus=0x%x\n", __FUNCTION__,BTStatus); -+ sprintf(extra, "BT write map compare OK"); -+ err = 0; -+ goto exit; -+ } -+ else -+ { -+ sprintf(extra, "BT write map compare FAIL"); -+ DBG_871X("%s: BT write map compare FAIL BTStatus=0x%x\n", __FUNCTION__,BTStatus); -+ err = 0; -+ goto exit; -+ } -+ } + } + else if (strcmp(tmp[0], "btwfake") == 0) + { @@ -361516,7 +170780,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("%s: addr=0x%X\n", __FUNCTION__, addr); + DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); + DBG_871X("%s: BT tmp data=%s\n", __FUNCTION__, tmp[2]); -+ ++ + for (jj=0, kk=0; jjfakeBTEfuseModifiedMap[addr+jj] = key_2char2num(tmp[2][kk], tmp[2][kk+1]); @@ -361531,31 +170795,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + err = -EFAULT; + } + } ++ else if (strcmp(tmp[0], "wldumpfake") == 0) ++ { ++ if (rtw_efuse_map_read(padapter, 0, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeEfuseModifiedMap) == _SUCCESS) { ++ DBG_871X("%s: BT read all map success \n", __FUNCTION__); ++ } else { ++ DBG_871X("%s: BT read all map Fail \n", __FUNCTION__); ++ err = -EFAULT; ++ } ++ } + else if (strcmp(tmp[0], "btfk2map") == 0) + { -+ rtw_write8(padapter, 0xa3, 0x05); -+ BTStatus=rtw_read8(padapter, 0xa0); -+ DBG_871X("%s: btwmap before read 0xa0 BT Status =0x%x \n", __FUNCTION__,BTStatus); -+ if (BTStatus != 0x04) -+ { -+ sprintf(extra, "BT Status not Active Write FAIL\n"); -+ goto exit; -+ } -+ -+ BTEfuse_PowerSwitch(padapter,1,_TRUE); -+ -+ addr=0x1ff; -+ rtw_write8(padapter, EFUSE_CTRL+1, (addr & 0xff)); -+ rtw_msleep_os(10); -+ rtw_write8(padapter, EFUSE_CTRL+2, ((addr >> 8) & 0x03)); -+ rtw_msleep_os(10); -+ rtw_write8(padapter, EFUSE_CTRL+3, 0x72); -+ rtw_msleep_os(10); -+ rtw_read8(padapter, EFUSE_CTRL); -+ + _rtw_memcpy(pEfuseHal->BTEfuseModifiedMap, pEfuseHal->fakeBTEfuseModifiedMap, EFUSE_BT_MAX_MAP_LEN); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); ++ ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); + if (max_available_size < 1) + { + err = -EFAULT; @@ -361568,100 +170821,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + err = -EFAULT; + goto exit; + } -+ -+ DBG_871X("pEfuseHal->fakeBTEfuseModifiedMap OFFSET\tVALUE(hex)\n"); -+ for (i = 0; i < EFUSE_BT_MAX_MAP_LEN; i += 16) -+ { -+ printk("0x%02x\t", i); -+ for (j=0; j<8; j++) { -+ printk("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); -+ } -+ printk("\t"); -+ -+ for (; j<16; j++) { -+ printk("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); -+ } -+ printk("\n"); -+ } -+ printk("\n"); -+#if 1 -+ err = -EFAULT; -+ DBG_871X("%s: rtw_BT_efuse_map_read _rtw_memcmp \n", __FUNCTION__); -+ if ( (rtw_BT_efuse_map_read(padapter, 0x00, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseInitMap) == _SUCCESS ) ) -+ { -+ if (_rtw_memcmp((void*)pEfuseHal->fakeBTEfuseModifiedMap,(void*)pEfuseHal->fakeBTEfuseInitMap,EFUSE_BT_MAX_MAP_LEN)) -+ { -+ sprintf(extra, "BT write map compare OK"); -+ DBG_871X("%s: BT write map afterf compare success BTStatus=0x%x \n", __FUNCTION__,BTStatus); -+ err = 0; -+ goto exit; -+ } -+ else -+ { -+ sprintf(extra, "BT write map compare FAIL"); -+ if (rtw_BT_efuse_map_write(padapter, 0x00, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseModifiedMap) == _FAIL) -+ { -+ DBG_871X("%s: rtw_BT_efuse_map_write compare error,retry = %d!\n", __FUNCTION__,i); -+ } -+ -+ if (rtw_BT_efuse_map_read(padapter, EFUSE_BT, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseInitMap) == _SUCCESS) -+ { -+ DBG_871X("pEfuseHal->fakeBTEfuseInitMap OFFSET\tVALUE(hex)\n"); -+ -+ for (i = 0; i < EFUSE_BT_MAX_MAP_LEN; i += 16) -+ { -+ printk("0x%02x\t", i); -+ for (j=0; j<8; j++) { -+ printk("%02X ", pEfuseHal->fakeBTEfuseInitMap[i+j]); -+ } -+ printk("\t"); -+ for (; j<16; j++) { -+ printk("%02X ", pEfuseHal->fakeBTEfuseInitMap[i+j]); -+ } -+ printk("\n"); -+ } -+ printk("\n"); -+ } -+ DBG_871X("%s: BT write map afterf compare not match to write efuse try write Map again , BTStatus=0x%x\n", __FUNCTION__,BTStatus); -+ goto exit; -+ } -+ } -+#endif -+ + } + else if (strcmp(tmp[0], "wlfk2map") == 0) + { -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); + if (max_available_size < 1) + { + err = -EFAULT; + goto exit; + } -+ if (rtw_efuse_map_write(padapter, 0x00, EFUSE_MAP_SIZE, pEfuseHal->fakeEfuseModifiedMap) == _FAIL) ++ ++ if (rtw_efuse_map_write(padapter, 0x00, EFUSE_MAX_MAP_LEN, pEfuseHal->fakeEfuseModifiedMap) == _FAIL) + { -+ DBG_871X("%s: rtw_efuse_map_write fakeEfuseModifiedMap error!\n", __FUNCTION__); ++ DBG_871X("%s: rtw_efuse_map_write error!\n", __FUNCTION__); + err = -EFAULT; + goto exit; + } -+ *extra = 0; -+ DBG_871X("%s: after rtw_BT_efuse_map_write to _rtw_memcmp\n", __func__); -+ if (rtw_efuse_mask_map_read(padapter, 0x00, EFUSE_MAP_SIZE, ShadowMapWiFi) == _SUCCESS) -+ { -+ if (_rtw_memcmp((void*)ShadowMapWiFi ,(void*)setdata,cnts)) -+ { -+ DBG_871X("%s: WiFi write map afterf compare OK\n", __FUNCTION__); -+ sprintf(extra, "WiFi write map compare OK\n"); -+ err = 0; -+ goto exit; -+ } -+ else -+ { -+ sprintf(extra, "WiFi write map compare FAIL\n"); -+ DBG_871X("%s: WiFi write map compare Fail\n", __FUNCTION__); -+ err = 0; -+ goto exit; -+ } -+ } + } + else if (strcmp(tmp[0], "wlwfake") == 0) + { @@ -361695,172 +170870,1115 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + pEfuseHal->fakeEfuseModifiedMap[addr+jj] = key_2char2num(tmp[2][kk], tmp[2][kk+1]); + } -+ _rtw_memset(extra, '\0', strlen(extra)); -+ sprintf(extra, "wlwfake OK\n"); + } + +exit: + if (setdata) -+ rtw_mfree(setdata, 1024); ++ _rtw_mfree(setdata, 1024); + if (ShadowMapBT) -+ rtw_mfree(ShadowMapBT, EFUSE_BT_MAX_MAP_LEN); ++ _rtw_mfree(ShadowMapBT, EFUSE_BT_MAX_MAP_LEN); + if (ShadowMapWiFi) -+ rtw_mfree(ShadowMapWiFi, EFUSE_MAP_SIZE); ++ _rtw_mfree(ShadowMapWiFi, EFUSE_MAP_SIZE); + if (setrawdata) -+ rtw_mfree(setrawdata, EFUSE_MAX_SIZE); -+ -+ wrqu->length = strlen(extra); ++ _rtw_mfree(setrawdata, EFUSE_MAX_SIZE); + -+ if (padapter->registrypriv.mp_mode == 0) -+ { -+ #ifdef CONFIG_IPS ++ #ifdef CONFIG_IPS + rtw_pm_set_ips(padapter, ips_mode); -+ #endif // CONFIG_IPS -+ -+ #ifdef CONFIG_LPS ++ #endif ++ #ifdef CONFIG_LPS + rtw_pm_set_lps(padapter, lps_mode); -+ #endif // CONFIG_LPS -+ } ++ #endif + + return err; +} + -+ -+#ifdef CONFIG_MP_INCLUDED -+ -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+#define DBG_MP_SDIO_INDIRECT_ACCESS 1 -+static int rtw_mp_sd_iread(struct net_device *dev -+ , struct iw_request_info *info -+ , struct iw_point *wrqu -+ , char *extra) ++#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_MP_IWPRIV_SUPPORT) ++/* ++ * Input Format: %s,%d,%d ++ * %s is width, could be ++ * "b" for 1 byte ++ * "w" for WORD (2 bytes) ++ * "dw" for DWORD (4 bytes) ++ * 1st %d is address(offset) ++ * 2st %d is data to write ++ */ ++static int rtw_mp_write_reg(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) +{ -+ char input[16]; -+ u8 width; -+ unsigned long addr; -+ u32 ret = 0; ++ char *pch, *pnext, *ptmp; ++ char *width_str; ++ char width; ++ u32 addr, data; ++ int ret; + PADAPTER padapter = rtw_netdev_priv(dev); + -+ if (wrqu->length > 16) { -+ DBG_871X(FUNC_ADPT_FMT" wrqu->length:%d\n", FUNC_ADPT_ARG(padapter), wrqu->length); -+ ret = -EINVAL; -+ goto exit; ++ ++ pch = extra; ++ pnext = strpbrk(pch, " ,.-"); ++ if (pnext == NULL) return -EINVAL; ++ *pnext = 0; ++ width_str = pch; ++ ++ pch = pnext + 1; ++ pnext = strpbrk(pch, " ,.-"); ++ if (pnext == NULL) return -EINVAL; ++ *pnext = 0; ++ addr = simple_strtoul(pch, &ptmp, 16); ++ if (addr > 0x3FFF) return -EINVAL; ++ ++ pch = pnext + 1; ++ if ((pch - extra) >= wrqu->length) return -EINVAL; ++ data = simple_strtoul(pch, &ptmp, 16); ++ ++ ret = 0; ++ width = width_str[0]; ++ switch (width) { ++ case 'b': ++ // 1 byte ++ if (data > 0xFF) { ++ ret = -EINVAL; ++ break; ++ } ++ rtw_write8(padapter, addr, data); ++ break; ++ case 'w': ++ // 2 bytes ++ if (data > 0xFFFF) { ++ ret = -EINVAL; ++ break; ++ } ++ rtw_write16(padapter, addr, data); ++ break; ++ case 'd': ++ // 4 bytes ++ rtw_write32(padapter, addr, data); ++ break; ++ default: ++ ret = -EINVAL; ++ break; + } + -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) { -+ DBG_871X(FUNC_ADPT_FMT" copy_from_user fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EFAULT; -+ goto exit; ++ return ret; ++} ++ ++/* ++ * Input Format: %s,%d ++ * %s is width, could be ++ * "b" for 1 byte ++ * "w" for WORD (2 bytes) ++ * "dw" for DWORD (4 bytes) ++ * %d is address(offset) ++ * ++ * Return: ++ * %d for data readed ++ */ ++static int rtw_mp_read_reg(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ char input[wrqu->length]; ++ char *pch, *pnext, *ptmp; ++ char *width_str; ++ char width; ++ char data[20],tmp[20]; ++ u32 addr; ++ //u32 *data = (u32*)extra; ++ u32 ret, i=0, j=0, strtout=0; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ ++ if (wrqu->length > 128) ++ return -EFAULT; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ _rtw_memset(data, 0, 20); ++ _rtw_memset(tmp, 0, 20); ++ _rtw_memset(extra, 0, wrqu->length); ++ ++ pch = input; ++ pnext = strpbrk(pch, " ,.-"); ++ if (pnext == NULL) return -EINVAL; ++ *pnext = 0; ++ width_str = pch; ++ ++ pch = pnext + 1; ++ if ((pch - input) >= wrqu->length) return -EINVAL; ++ ++ addr = simple_strtoul(pch, &ptmp, 16); ++ if (addr > 0x3FFF) return -EINVAL; ++ ++ ret = 0; ++ width = width_str[0]; ++ switch (width) ++ { ++ case 'b': ++ // 1 byte ++ // *(u8*)data = rtw_read8(padapter, addr); ++ sprintf(extra, "%d\n", rtw_read8(padapter, addr)); ++ wrqu->length = strlen(extra); ++ break; ++ case 'w': ++ // 2 bytes ++ //*(u16*)data = rtw_read16(padapter, addr); ++ sprintf(data, "%04x\n", rtw_read16(padapter, addr)); ++ for (i = 0; i <= strlen(data); i++) { ++ if (i % 2 == 0) { ++ tmp[j] = ' '; ++ j++; ++ } ++ if (data[i] != '\0') { ++ tmp[j] = data[i]; ++ j++; ++ } ++ } ++ pch = tmp; ++ DBG_871X("pch=%s",pch); ++ ++ while( *pch != '\0' ) { ++ pnext = strpbrk(pch, " "); ++ if (!pnext) ++ break; ++ ++ pnext++; ++ if ( *pnext != '\0' ) { ++ strtout = simple_strtoul (pnext , &ptmp, 16); ++ sprintf( extra, "%s %d" ,extra ,strtout ); ++ } else { ++ break; ++ } ++ pch = pnext; ++ } ++ wrqu->length = 6; ++ break; ++ case 'd': ++ // 4 bytes ++ //*data = rtw_read32(padapter, addr); ++ sprintf(data, "%08x", rtw_read32(padapter, addr)); ++ //add read data format blank ++ for( i=0 ; i <= strlen(data) ; i++) ++ { ++ if( i%2==0 ) ++ { ++ tmp[j]=' '; ++ j++; ++ } ++ if ( data[i] != '\0' ) ++ tmp[j] = data[i]; ++ ++ j++; ++ } ++ pch = tmp; ++ DBG_871X("pch=%s",pch); ++ ++ while( *pch != '\0' ) ++ { ++ pnext = strpbrk(pch, " "); ++ if (!pnext) ++ break; ++ ++ pnext++; ++ if ( *pnext != '\0' ) ++ { ++ strtout = simple_strtoul (pnext , &ptmp, 16); ++ sprintf( extra, "%s %d" ,extra ,strtout ); ++ } ++ else{ ++ break; ++ } ++ pch = pnext; ++ } ++ wrqu->length = strlen(extra); ++ break; ++ ++ default: ++ wrqu->length = 0; ++ ret = -EINVAL; ++ break; ++ + } + ++ return ret; ++} ++ ++/* ++ * Input Format: %d,%x,%x ++ * %d is RF path, should be smaller than MAX_RF_PATH_NUMS ++ * 1st %x is address(offset) ++ * 2st %x is data to write ++ */ ++ static int rtw_mp_write_rf(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++/*static int rtw_mp_write_rf(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++*/ ++ u32 path, addr, data; ++ int ret; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ ++ ret = sscanf(extra, "%d,%x,%x", &path, &addr, &data); ++ if (ret < 3) return -EINVAL; ++ ++ if (path >= GET_HAL_RFPATH_NUM(padapter)) return -EINVAL; ++ if (addr > 0xFF) return -EINVAL; ++ if (data > 0xFFFFF) return -EINVAL; ++ + _rtw_memset(extra, 0, wrqu->length); + -+ if (sscanf(input, "%hhu,%lx", &width, &addr) != 2) { -+ DBG_871X(FUNC_ADPT_FMT" sscanf fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EINVAL; -+ goto exit; -+ } ++ write_rfreg(padapter, path, addr, data); + -+ if (addr > 0x3FFF) { -+ DBG_871X(FUNC_ADPT_FMT" addr:0x%lx\n", FUNC_ADPT_ARG(padapter), addr); -+ ret = -EINVAL; -+ goto exit; -+ } ++ sprintf(extra, "write_rf completed \n"); ++ wrqu->length = strlen(extra); + -+ if (DBG_MP_SDIO_INDIRECT_ACCESS) -+ DBG_871X(FUNC_ADPT_FMT" width:%u, addr:0x%lx\n", FUNC_ADPT_ARG(padapter), width, addr); -+ -+ switch (width) { -+ case 1: -+ sprintf(extra, "0x%02x", rtw_sd_iread8(padapter, addr)); -+ wrqu->length = strlen(extra); -+ break; -+ case 2: -+ sprintf(extra, "0x%04x", rtw_sd_iread16(padapter, addr)); -+ wrqu->length = strlen(extra); -+ break; -+ case 4: -+ sprintf(extra, "0x%08x", rtw_sd_iread32(padapter, addr)); -+ wrqu->length = strlen(extra); -+ break; -+ default: -+ wrqu->length = 0; -+ ret = -EINVAL; -+ break; -+ } -+ -+exit: -+ return ret; ++ return 0; +} + -+static int rtw_mp_sd_iwrite(struct net_device *dev -+ , struct iw_request_info *info -+ , struct iw_point *wrqu -+ , char *extra) ++/* ++ * Input Format: %d,%x ++ * %d is RF path, should be smaller than MAX_RF_PATH_NUMS ++ * %x is address(offset) ++ * ++ * Return: ++ * %d for data readed ++ */ ++static int rtw_mp_read_rf(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) +{ -+ char width; -+ unsigned long addr, data; -+ int ret = 0; ++ char input[wrqu->length]; ++ char *pch, *pnext, *ptmp; ++ char data[20],tmp[20]; ++ //u32 *data = (u32*)extra; ++ u32 path, addr; ++ u32 ret,i=0 ,j=0,strtou=0; + PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[32]; + -+ if (wrqu->length > 32) { -+ DBG_871X(FUNC_ADPT_FMT" wrqu->length:%d\n", FUNC_ADPT_ARG(padapter), wrqu->length); -+ ret = -EINVAL; -+ goto exit; -+ } + -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) { -+ DBG_871X(FUNC_ADPT_FMT" copy_from_user fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EFAULT; -+ goto exit; -+ } -+ -+ _rtw_memset(extra, 0, wrqu->length); ++ if (wrqu->length > 128) return -EFAULT; ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; + -+ if (sscanf(input, "%hhu,%lx,%lx", &width, &addr, &data) != 3) { -+ DBG_871X(FUNC_ADPT_FMT" sscanf fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EINVAL; -+ goto exit; -+ } ++ ret = sscanf(input, "%d,%x", &path, &addr); ++ if (ret < 2) return -EINVAL; + -+ if (addr > 0x3FFF) { -+ DBG_871X(FUNC_ADPT_FMT" addr:0x%lx\n", FUNC_ADPT_ARG(padapter), addr); -+ ret = -EINVAL; -+ goto exit; -+ } ++ if (path >= GET_HAL_RFPATH_NUM(padapter)) return -EINVAL; ++ if (addr > 0xFF) return -EINVAL; + -+ if (DBG_MP_SDIO_INDIRECT_ACCESS) -+ DBG_871X(FUNC_ADPT_FMT" width:%u, addr:0x%lx, data:0x%lx\n", FUNC_ADPT_ARG(padapter), width, addr, data); ++ _rtw_memset(extra, 0, wrqu->length); + -+ switch (width) { -+ case 1: -+ if (data > 0xFF) { -+ ret = -EINVAL; -+ break; -+ } -+ rtw_sd_iwrite8(padapter, addr, data); -+ break; -+ case 2: -+ if (data > 0xFFFF) { -+ ret = -EINVAL; -+ break; -+ } -+ rtw_sd_iwrite16(padapter, addr, data); -+ break; -+ case 4: -+ rtw_sd_iwrite32(padapter, addr, data); -+ break; -+ default: -+ wrqu->length = 0; -+ ret = -EINVAL; -+ break; -+ } ++ //*data = read_rfreg(padapter, path, addr); ++ sprintf(data, "%08x", read_rfreg(padapter, path, addr)); ++ //add read data format blank ++ for( i=0 ; i <= strlen(data) ; i++) ++ { ++ if( i%2==0 ) ++ { ++ tmp[j]=' '; ++ j++; ++ } ++ tmp[j] = data[i]; ++ j++; ++ } ++ pch = tmp; ++ DBG_871X("pch=%s",pch); + -+exit: -+ return ret; ++ while( *pch != '\0' ) ++ { ++ pnext = strpbrk(pch, " "); ++ pnext++; ++ if ( *pnext != '\0' ) ++ { ++ strtou = simple_strtoul (pnext , &ptmp, 16); ++ sprintf( extra, "%s %d" ,extra ,strtou ); ++ } ++ else{ ++ break; ++ } ++ pch = pnext; ++ } ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++static int rtw_mp_start(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u8 val8; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ if(padapter->registrypriv.mp_mode ==0) ++ { ++ padapter->registrypriv.mp_mode =1; ++ ++ rtw_pm_set_ips(padapter,IPS_NONE); ++ LeaveAllPowerSaveMode(padapter); ++ ++ MPT_InitializeAdapter(padapter, 1); ++ } ++ ++ if (padapter->registrypriv.mp_mode == 0) ++ return -EPERM; ++ ++ if (padapter->mppriv.mode == MP_OFF) { ++ if (mp_start_test(padapter) == _FAIL) ++ return -EPERM; ++ padapter->mppriv.mode = MP_ON; ++ } ++ ++ return 0; ++} ++ ++static int rtw_mp_stop(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ if(padapter->registrypriv.mp_mode ==1) ++ { ++ MPT_DeInitAdapter(padapter); ++ padapter->registrypriv.mp_mode=0; ++ } ++ ++ if (padapter->mppriv.mode != MP_OFF) { ++ mp_stop_test(padapter); ++ padapter->mppriv.mode = MP_OFF; ++ } ++ ++ return 0; ++} ++ ++extern int wifirate2_ratetbl_inx(unsigned char rate); ++ ++static int rtw_mp_rate(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u32 rate = MPT_RATE_1M; ++ u8 input[wrqu->length]; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ rate = rtw_atoi(input); ++ sprintf( extra, "Set data rate to %d" , rate ); ++ ++ if(rate <= 0x7f) ++ rate = wifirate2_ratetbl_inx( (u8)rate); ++ else ++ rate =(rate-0x80+MPT_RATE_MCS0); ++ ++ //DBG_871X("%s: rate=%d\n", __func__, rate); ++ ++ if (rate >= MPT_RATE_LAST ) ++ return -EINVAL; ++ ++ padapter->mppriv.rateidx = rate; ++ Hal_SetDataRate(padapter); ++ ++ wrqu->length = strlen(extra) + 1; ++ return 0; ++} ++ ++static int rtw_mp_channel(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ u8 input[wrqu->length]; ++ u32 channel = 1; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ channel = rtw_atoi(input); ++ //DBG_871X("%s: channel=%d\n", __func__, channel); ++ sprintf( extra, "Change channel %d to channel %d", padapter->mppriv.channel , channel ); ++ padapter->mppriv.channel = channel; ++ Hal_SetChannel(padapter); ++ ++ wrqu->length = strlen(extra) + 1; ++ return 0; ++} ++ ++static int rtw_mp_bandwidth(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u32 bandwidth=0, sg=0; ++ //u8 buffer[40]; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ //if (copy_from_user(buffer, (void*)wrqu->data.pointer, wrqu->data.length)) ++ // return -EFAULT; ++ ++ //DBG_871X("%s:iwpriv in=%s\n", __func__, extra); ++ ++ sscanf(extra, "40M=%d,shortGI=%d", &bandwidth, &sg); ++ ++ if (bandwidth == 1) ++ bandwidth=CHANNEL_WIDTH_40; ++ else if (bandwidth == 2) ++ bandwidth=CHANNEL_WIDTH_80; ++ DBG_871X("%s: bw=%d sg=%d \n", __func__, bandwidth , sg); ++ ++ padapter->mppriv.bandwidth = (u8)bandwidth; ++ padapter->mppriv.preamble = sg; ++ ++ SetBandwidth(padapter); ++ ++ return 0; ++} ++ ++ ++static int rtw_mp_txpower_index(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ char input[wrqu->length]; ++ u32 rfpath; ++ u32 txpower_inx; ++ ++ if (wrqu->length > 128) ++ return -EFAULT; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ rfpath = rtw_atoi(input); ++ txpower_inx = mpt_ProQueryCalTxPower(padapter, rfpath); ++ sprintf(extra, " %d", txpower_inx); ++ wrqu->length = strlen(extra) + 1; ++ ++ return 0; ++} ++ ++ ++static int rtw_mp_txpower(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u32 idx_a=0,idx_b=0; ++ u8 input[wrqu->length]; ++ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ sscanf(input,"patha=%d,pathb=%d",&idx_a,&idx_b); ++ //DBG_871X("%s: tx_pwr_idx_a=%x b=%x\n", __func__, idx_a, idx_b); ++ ++ sprintf( extra, "Set power level path_A:%d path_B:%d", idx_a , idx_b ); ++ padapter->mppriv.txpoweridx = (u8)idx_a; ++ padapter->mppriv.txpoweridx_b = (u8)idx_b; ++ padapter->mppriv.bSetTxPower = 1; ++ //Hal_SetAntennaPathPower(padapter); ++ SetTxPower(padapter); ++ ++ wrqu->length = strlen(extra) + 1; ++ return 0; ++} ++ ++static int rtw_mp_ant_tx(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u8 i; ++ u8 input[wrqu->length]; ++ u16 antenna = 0; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ //DBG_871X("%s: input=%s\n", __func__, input); ++ ++ sprintf( extra, "switch Tx antenna to %s", input ); ++ ++ for (i=0; i < strlen(input); i++) ++ { ++ switch(input[i]) ++ { ++ case 'a' : ++ antenna|=ANTENNA_A; ++ break; ++ case 'b': ++ antenna|=ANTENNA_B; ++ break; ++ } ++ } ++ //antenna |= BIT(extra[i]-'a'); ++ //DBG_871X("%s: antenna=0x%x\n", __func__, antenna); ++ padapter->mppriv.antenna_tx = antenna; ++ //DBG_871X("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_tx); ++ ++ Hal_SetAntenna(padapter); ++ ++ wrqu->length = strlen(extra) + 1; ++ return 0; ++} ++ ++static int rtw_mp_ant_rx(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u8 i; ++ u16 antenna = 0; ++ u8 input[wrqu->length]; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ //DBG_871X("%s: input=%s\n", __func__, input); ++ _rtw_memset(extra, 0, wrqu->length); ++ ++ sprintf( extra, "switch Rx antenna to %s", input ); ++ ++ for (i=0; i < strlen(input); i++) { ++ switch( input[i] ) ++ { ++ case 'a' : ++ antenna|=ANTENNA_A; ++ break; ++ case 'b': ++ antenna|=ANTENNA_B; ++ break; ++ case 'c' : ++ antenna|=ANTENNA_C; ++ break; ++ } ++ } ++ ++ //DBG_871X("%s: antenna=0x%x\n", __func__, antenna); ++ padapter->mppriv.antenna_rx = antenna; ++ //DBG_871X("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_rx); ++ Hal_SetAntenna(padapter); ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++static int rtw_mp_ctx(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u32 pkTx = 1, countPkTx = 1, cotuTx = 1, CarrSprTx = 1, scTx = 1, sgleTx = 1, stop = 1; ++ u32 bStartTest = 1; ++ u32 count = 0; ++ struct mp_priv *pmp_priv; ++ struct pkt_attrib *pattrib; ++ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ ++ pmp_priv = &padapter->mppriv; ++ ++ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ DBG_871X("%s: in=%s\n", __func__, extra); ++ ++ countPkTx = strncmp(extra, "count=", 5); // strncmp TRUE is 0 ++ cotuTx = strncmp(extra, "background", 20); ++ CarrSprTx = strncmp(extra, "background,cs", 20); ++ scTx = strncmp(extra, "background,sc", 20); ++ sgleTx = strncmp(extra, "background,stone", 20); ++ pkTx = strncmp(extra, "background,pkt", 20); ++ stop = strncmp(extra, "stop", 4); ++ sscanf(extra, "count=%d,pkt", &count); ++ ++ //DBG_871X("%s: count=%d countPkTx=%d cotuTx=%d CarrSprTx=%d scTx=%d sgleTx=%d pkTx=%d stop=%d\n", __func__, count, countPkTx, cotuTx, CarrSprTx, pkTx, sgleTx, scTx, stop); ++ _rtw_memset(extra, '\0', sizeof(extra)); ++ ++ if (stop == 0) { ++ bStartTest = 0; // To set Stop ++ pmp_priv->tx.stop = 1; ++ sprintf( extra, "Stop continuous Tx"); ++ } else { ++ bStartTest = 1; ++ if (pmp_priv->mode != MP_ON) { ++ if (pmp_priv->tx.stop != 1) { ++ DBG_871X("%s: MP_MODE != ON %d\n", __func__, pmp_priv->mode); ++ return -EFAULT; ++ } ++ } ++ } ++ ++ if (pkTx == 0 || countPkTx == 0) ++ pmp_priv->mode = MP_PACKET_TX; ++ if (sgleTx == 0) ++ pmp_priv->mode = MP_SINGLE_TONE_TX; ++ if (cotuTx == 0) ++ pmp_priv->mode = MP_CONTINUOUS_TX; ++ if (CarrSprTx == 0) ++ pmp_priv->mode = MP_CARRIER_SUPPRISSION_TX; ++ if (scTx == 0) ++ pmp_priv->mode = MP_SINGLE_CARRIER_TX; ++ ++ switch (pmp_priv->mode) ++ { ++ case MP_PACKET_TX: ++ ++ //DBG_871X("%s:pkTx %d\n", __func__,bStartTest); ++ if (bStartTest == 0) ++ { ++ pmp_priv->tx.stop = 1; ++ pmp_priv->mode = MP_ON; ++ sprintf( extra, "Stop continuous Tx"); ++ } ++ else if (pmp_priv->tx.stop == 1) ++ { ++ sprintf( extra, "Start continuous DA=ffffffffffff len=1500 count=%u,\n",count); ++ //DBG_871X("%s:countPkTx %d\n", __func__,count); ++ pmp_priv->tx.stop = 0; ++ pmp_priv->tx.count = count; ++ pmp_priv->tx.payload = 2; ++ pattrib = &pmp_priv->tx.attrib; ++ pattrib->pktlen = 1000; ++ _rtw_memset(pattrib->dst, 0xFF, ETH_ALEN); ++ SetPacketTx(padapter); ++ } ++ else { ++ //DBG_871X("%s: pkTx not stop\n", __func__); ++ return -EFAULT; ++ } ++ wrqu->length = strlen(extra); ++ return 0; ++ ++ case MP_SINGLE_TONE_TX: ++ //DBG_871X("%s: sgleTx %d \n", __func__, bStartTest); ++ if (bStartTest != 0){ ++ sprintf( extra, "Start continuous DA=ffffffffffff len=1500 \n infinite=yes."); ++ } ++ Hal_SetSingleToneTx(padapter, (u8)bStartTest); ++ break; ++ ++ case MP_CONTINUOUS_TX: ++ //DBG_871X("%s: cotuTx %d\n", __func__, bStartTest); ++ if (bStartTest != 0){ ++ sprintf( extra, "Start continuous DA=ffffffffffff len=1500 \n infinite=yes."); ++ } ++ Hal_SetContinuousTx(padapter, (u8)bStartTest); ++ break; ++ ++ case MP_CARRIER_SUPPRISSION_TX: ++ //DBG_871X("%s: CarrSprTx %d\n", __func__, bStartTest); ++ if (bStartTest != 0){ ++ if( pmp_priv->rateidx <= MPT_RATE_11M ) ++ { ++ sprintf( extra, "Start continuous DA=ffffffffffff len=1500 \n infinite=yes."); ++ Hal_SetCarrierSuppressionTx(padapter, (u8)bStartTest); ++ }else ++ sprintf( extra, "Specify carrier suppression but not CCK rate"); ++ } ++ break; ++ ++ case MP_SINGLE_CARRIER_TX: ++ //DBG_871X("%s: scTx %d\n", __func__, bStartTest); ++ if (bStartTest != 0){ ++ sprintf( extra, "Start continuous DA=ffffffffffff len=1500 \n infinite=yes."); ++ } ++ Hal_SetSingleCarrierTx(padapter, (u8)bStartTest); ++ break; ++ ++ default: ++ //DBG_871X("%s:No Match MP_MODE\n", __func__); ++ sprintf( extra, "Error! Continuous-Tx is not on-going."); ++ return -EFAULT; ++ } ++ ++ if ( bStartTest==1 && pmp_priv->mode != MP_ON) { ++ struct mp_priv *pmp_priv = &padapter->mppriv; ++ if (pmp_priv->tx.stop == 0) { ++ pmp_priv->tx.stop = 1; ++ //DBG_871X("%s: pkt tx is running...\n", __func__); ++ rtw_msleep_os(5); ++ } ++ pmp_priv->tx.stop = 0; ++ pmp_priv->tx.count = 1; ++ SetPacketTx(padapter); ++ } else { ++ pmp_priv->mode = MP_ON; ++ } ++ ++ wrqu->length = strlen(extra); ++ return 0; ++} ++ ++static int rtw_mp_arx(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u8 bStartRx=0,bStopRx=0,bQueryPhy; ++ u32 cckok=0,cckcrc=0,ofdmok=0,ofdmcrc=0,htok=0,htcrc=0,OFDM_FA=0,CCK_FA=0; ++ u8 input[wrqu->length]; ++ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ DBG_871X("%s: %s\n", __func__, input); ++ ++ bStartRx = (strncmp(input, "start", 5)==0)?1:0; // strncmp TRUE is 0 ++ bStopRx = (strncmp(input, "stop", 5)==0)?1:0; // strncmp TRUE is 0 ++ bQueryPhy = (strncmp(input, "phy", 3)==0)?1:0; // strncmp TRUE is 0 ++ ++ if(bStartRx) ++ { ++ sprintf( extra, "start"); ++ SetPacketRx(padapter, bStartRx); ++ } ++ else if(bStopRx) ++ { ++ SetPacketRx(padapter, 0); ++ sprintf( extra, "Received packet OK:%d CRC error:%d",padapter->mppriv.rx_pktcount,padapter->mppriv.rx_crcerrpktcount); ++ } ++ else if(bQueryPhy) ++ { ++ /* ++ OFDM FA ++ RegCF0[15:0] ++ RegCF2[31:16] ++ RegDA0[31:16] ++ RegDA4[15:0] ++ RegDA4[31:16] ++ RegDA8[15:0] ++ CCK FA ++ (RegA5B<<8) | RegA5C ++ */ ++ cckok = read_bbreg(padapter, 0xf88, 0xffffffff ); ++ cckcrc = read_bbreg(padapter, 0xf84, 0xffffffff ); ++ ofdmok = read_bbreg(padapter, 0xf94, 0x0000FFFF ); ++ ofdmcrc = read_bbreg(padapter, 0xf94 , 0xFFFF0000 ); ++ htok = read_bbreg(padapter, 0xf90, 0x0000FFFF ); ++ htcrc = read_bbreg(padapter,0xf90, 0xFFFF0000 ); ++ ++ OFDM_FA=+read_bbreg(padapter, 0xcf0, 0x0000FFFF ); ++ OFDM_FA=+read_bbreg(padapter, 0xcf2, 0xFFFF0000 ); ++ OFDM_FA=+read_bbreg(padapter, 0xda0, 0xFFFF0000 ); ++ OFDM_FA=+read_bbreg(padapter, 0xda4, 0x0000FFFF ); ++ OFDM_FA=+read_bbreg(padapter, 0xda4, 0xFFFF0000 ); ++ OFDM_FA=+read_bbreg(padapter, 0xda8, 0x0000FFFF ); ++ CCK_FA=(rtw_read8(padapter, 0xa5b )<<8 ) | (rtw_read8(padapter, 0xa5c)); ++ ++ sprintf( extra, "Phy Received packet OK:%d CRC error:%d FA Counter: %d",cckok+ofdmok+htok,cckcrc+ofdmcrc+htcrc,OFDM_FA+CCK_FA); ++ } ++ wrqu->length = strlen(extra) + 1; ++ return 0; ++} ++ ++static int rtw_mp_trx_query(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u32 txok,txfail,rxok,rxfail; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ //if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) ++ // return -EFAULT; ++ ++ txok=padapter->mppriv.tx.sended; ++ txfail=0; ++ rxok = padapter->mppriv.rx_pktcount; ++ rxfail = padapter->mppriv.rx_crcerrpktcount; ++ ++ _rtw_memset(extra, '\0', 128); ++ ++ sprintf(extra, "Tx OK:%d, Tx Fail:%d, Rx OK:%d, CRC error:%d ", txok, txfail,rxok,rxfail); ++ ++ wrqu->length=strlen(extra)+1; ++ ++ return 0; ++} ++ ++static int rtw_mp_pwrtrk(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u8 enable; ++ u32 thermal; ++ s32 ret; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ u8 input[wrqu->length]; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ _rtw_memset(extra, 0, wrqu->length); ++ ++ enable = 1; ++ if (wrqu->length > 1) { // not empty string ++ if (strncmp(input, "stop", 4) == 0) ++ { ++ enable = 0; ++ sprintf(extra, "mp tx power tracking stop"); ++ pHalData->TxPowerTrackControl = false; ++ } ++ else if (sscanf(input, "ther=%d", &thermal)) { ++ pHalData->TxPowerTrackControl = true; ++ ret = Hal_SetThermalMeter(padapter, (u8)thermal); ++ if (ret == _FAIL) return -EPERM; ++ sprintf(extra, "mp tx power tracking start,target value=%d ok ",thermal); ++ }else { ++ return -EINVAL; ++ } ++ } ++ ++ ret = Hal_SetPowerTracking(padapter, enable); ++ if (ret == _FAIL) return -EPERM; ++ ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++static int rtw_mp_psd(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ u8 input[wrqu->length]; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ strcpy(extra,input); ++ ++ wrqu->length = mp_query_psd(padapter, extra); ++ ++ return 0; ++} ++ ++static int rtw_mp_thermal(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ u8 val; ++ u16 bwrite=1; ++ u16 addr=EEPROM_THERMAL_METER_8812; ++ u16 cnt=1; ++ u16 max_available_size=0; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ bwrite = strncmp(extra, "write", 6); // strncmp TRUE is 0 ++ ++ Hal_GetThermalMeter(padapter, &val); ++ ++ if( bwrite == 0 ) ++ { ++ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); ++ if( 2 > max_available_size ) ++ { ++ DBG_871X("no available efuse!\n"); ++ return -EFAULT; ++ } ++ if ( rtw_efuse_map_write(padapter, addr, cnt, &val) == _FAIL ) ++ { ++ DBG_871X("rtw_efuse_map_write error \n"); ++ return -EFAULT; ++ } ++ else ++ { ++ sprintf(extra, " efuse write ok :%d", val); ++ } ++ } ++ else ++ { ++ sprintf(extra, "%d", val); ++ } ++ wrqu->length = strlen(extra); ++ ++ return 0; ++} ++ ++static int rtw_mp_reset_stats(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ struct mp_priv *pmp_priv; ++ struct pkt_attrib *pattrib; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ pmp_priv = &padapter->mppriv; ++ ++ pmp_priv->tx.sended = 0; ++ pmp_priv->tx_pktcount = 0; ++ pmp_priv->rx_pktcount = 0; ++ pmp_priv->rx_crcerrpktcount = 0; ++ ++ //reset phy counter ++ write_bbreg(padapter,0xf14,BIT16,0x1); ++ rtw_msleep_os(10); ++ write_bbreg(padapter,0xf14,BIT16,0x0); ++ ++ return 0; ++} ++ ++static int rtw_mp_dump(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ struct mp_priv *pmp_priv; ++ struct pkt_attrib *pattrib; ++ u32 value; ++ u8 rf_type,path_nums = 0; ++ u32 i,j=1,path; ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ ++ pmp_priv = &padapter->mppriv; ++ ++ ++ //if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) ++ // return -EFAULT; ++ ++ if ( strncmp(extra, "all", 4)==0 ) ++ { ++ DBG_871X("\n======= MAC REG =======\n"); ++ for ( i=0x0;i<0x300;i+=4 ) ++ { ++ if(j%4==1) DBG_871X("0x%02x",i); ++ DBG_871X(" 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) DBG_871X("\n"); ++ } ++ for( i=0x400;i<0x1000;i+=4 ) ++ { ++ if(j%4==1) DBG_871X("0x%02x",i); ++ DBG_871X(" 0x%08x ",rtw_read32(padapter,i)); ++ if((j++)%4 == 0) DBG_871X("\n"); ++ } ++ ++ i,j=1; ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ ++ DBG_871X("\n======= RF REG =======\n"); ++ if(( RF_1T2R == rf_type ) ||( RF_1T1R ==rf_type )) ++ path_nums = 1; ++ else ++ path_nums = 2; ++ ++ for(path=0;pathlength]; ++ u32 valxcap; ++ ++ if (copy_from_user(input, wrqu->pointer, wrqu->length)) ++ return -EFAULT; ++ ++ DBG_871X("%s:iwpriv in=%s\n", __func__, input); ++ ++ sscanf(input, "xcap=%d", &valxcap); ++ ++ Hal_ProSetCrystalCap( padapter , valxcap ); ++ ++ sprintf( extra, "Set xcap=%d",valxcap ); ++ wrqu->length = strlen(extra) + 1; ++ ++return 0; ++ ++} ++ ++static int rtw_mp_SetRFPath(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ char input[wrqu->data.length]; ++ u8 bMain=1,bTurnoff=1; ++ ++ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) ++ return -EFAULT; ++ DBG_871X("%s:iwpriv in=%s\n", __func__, input); ++ ++ bMain = strncmp(input, "1", 2); // strncmp TRUE is 0 ++ bTurnoff = strncmp(input, "0", 3); // strncmp TRUE is 0 ++ ++ if(bMain==0) ++ { ++ MP_PHY_SetRFPathSwitch(padapter,true); ++ DBG_871X("%s:PHY_SetRFPathSwitch=TRUE\n", __func__); ++ } ++ else if(bTurnoff==0) ++ { ++ MP_PHY_SetRFPathSwitch(padapter,false); ++ DBG_871X("%s:PHY_SetRFPathSwitch=FALSE\n", __func__); ++ } ++ ++ return 0; ++} ++ ++static int rtw_mp_QueryDrv(struct net_device *dev, ++ struct iw_request_info *info, ++ union iwreq_data *wrqu, char *extra) ++{ ++ PADAPTER padapter = rtw_netdev_priv(dev); ++ char input[wrqu->data.length]; ++ u8 qAutoLoad=1; ++ ++ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); ++ ++ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) ++ return -EFAULT; ++ DBG_871X("%s:iwpriv in=%s\n", __func__, input); ++ ++ qAutoLoad = strncmp(input, "autoload", 8); // strncmp TRUE is 0 ++ ++ if(qAutoLoad==0) ++ { ++ DBG_871X("%s:qAutoLoad\n", __func__); ++ ++ if(pEEPROM->bautoload_fail_flag) ++ sprintf(extra, "fail"); ++ else ++ sprintf(extra, "ok"); ++ } ++ wrqu->data.length = strlen(extra) + 1; ++ return 0; ++} ++ ++/* update Tx AGC offset */ ++static int rtw_mp_antBdiff(struct net_device *dev, ++ struct iw_request_info *info, ++ struct iw_point *wrqu, char *extra) ++{ ++ ++ ++ // MPT_ProSetTxAGCOffset ++ return 0; +} -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ + +static int rtw_mp_set(struct net_device *dev, + struct iw_request_info *info, @@ -361875,20 +171993,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + return -ENETDOWN; + } + -+ if((padapter->bup == _FALSE )) -+ { -+ DBG_871X(" %s fail =>(padapter->bup == _FALSE )\n",__FUNCTION__); -+ return -ENETDOWN; -+ } -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ DBG_871X("%s fail =>(bSurpriseRemoved == _TRUE) || ( bDriverStopped == _TRUE)\n", __func__); -+ return -ENETDOWN; -+ } -+ -+ -+ //_rtw_memset(extra, 0x00, IW_PRIV_SIZE_MASK); -+ + if (extra == NULL) + { + wrqu->length = 0; @@ -361900,23 +172004,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + case MP_START: + DBG_871X("set case mp_start \n"); + rtw_mp_start (dev,info,wrqu,extra); -+ break; -+ ++ break; ++ + case MP_STOP: + DBG_871X("set case mp_stop \n"); + rtw_mp_stop (dev,info,wrqu,extra); -+ break; -+ ++ break; ++ + case MP_BANDWIDTH: + DBG_871X("set case mp_bandwidth \n"); + rtw_mp_bandwidth (dev,info,wrqu,extra); + break; -+ ++ + case MP_RESET_STATS: + DBG_871X("set case MP_RESET_STATS \n"); + rtw_mp_reset_stats (dev,info,wrqu,extra); + break; -+ case MP_SetRFPathSwh: ++ ++ ++ case MP_SetRFPathSwh: + DBG_871X("set MP_SetRFPathSwitch \n"); + rtw_mp_SetRFPath (dev,info,wdata,extra); + break; @@ -361924,31 +172030,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X("set CTA_TEST\n"); + rtw_cta_test_start (dev, info, wdata, extra); + break; -+ case MP_DISABLE_BT_COEXIST: -+ DBG_871X("set case MP_DISABLE_BT_COEXIST \n"); -+ rtw_mp_disable_bt_coexist(dev, info, wdata, extra); -+ break; -+#ifdef CONFIG_WOWLAN -+ case MP_WOW_ENABLE: -+ DBG_871X("set case MP_WOW_ENABLE: %s\n", extra); -+ -+ rtw_wowlan_ctrl(dev, info, wdata, extra); -+ break; -+ case MP_WOW_SET_PATTERN: -+ DBG_871X("set case MP_WOW_SET_PATTERN: %s\n", extra); -+ rtw_wowlan_set_pattern(dev, info, wdata, extra); -+ break; -+#endif -+#ifdef CONFIG_AP_WOWLAN -+ case MP_AP_WOW_ENABLE: -+ DBG_871X("set case MP_AP_WOW_ENABLE: %s\n", extra); -+ rtw_ap_wowlan_ctrl(dev, info, wdata, extra); -+ break; -+#endif + } + -+ -+ return 0; ++ ++ return 0; +} + + @@ -361966,166 +172051,118 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + return -ENETDOWN; + } -+ if((padapter->bup == _FALSE )) ++ if (extra == NULL) + { -+ DBG_871X(" %s fail =>(padapter->bup == _FALSE )\n",__FUNCTION__); -+ return -ENETDOWN; -+ } -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ DBG_871X("%s fail =>(padapter->bSurpriseRemoved == _TRUE) || ( padapter->bDriverStopped == _TRUE)\n", __func__); -+ return -ENETDOWN; -+ } -+ -+ if (extra == NULL) { + wrqu->length = 0; + return -EIO; + } -+ -+ switch (subcmd) { -+ case WRITE_REG: -+ rtw_mp_write_reg(dev, info, wrqu, extra); ++ ++ switch(subcmd) ++ { ++ case WRITE_REG : ++ rtw_mp_write_reg (dev,info,wrqu,extra); + break; -+ ++ + case WRITE_RF: -+ rtw_mp_write_rf(dev, info, wrqu, extra); -+ break; -+ ++ rtw_mp_write_rf (dev,info,wrqu,extra); ++ break; ++ + case MP_PHYPARA: -+ DBG_871X("mp_get MP_PHYPARA\n"); -+ rtw_mp_phypara(dev, info, wrqu, extra); ++ DBG_871X("mp_get MP_PHYPARA \n"); ++ rtw_mp_phypara(dev,info,wrqu,extra); + break; + + case MP_CHANNEL: -+ DBG_871X("set case mp_channel\n"); -+ rtw_mp_channel(dev , info, wrqu, extra); ++ DBG_871X("set case mp_channel \n"); ++ rtw_mp_channel (dev,info,wrqu,extra); + break; -+ ++ + case READ_REG: -+ DBG_871X("mp_get READ_REG\n"); -+ rtw_mp_read_reg(dev, info, wrqu, extra); -+ break; ++ DBG_871X("mp_get READ_REG \n"); ++ rtw_mp_read_reg (dev,info,wrqu,extra); ++ break; + case READ_RF: -+ DBG_871X("mp_get READ_RF\n"); -+ rtw_mp_read_rf(dev, info, wrqu, extra); -+ break; -+ ++ DBG_871X("mp_get READ_RF \n"); ++ rtw_mp_read_rf (dev,info,wrqu,extra); ++ break; ++ + case MP_RATE: -+ DBG_871X("set case mp_rate\n"); -+ rtw_mp_rate(dev, info, wrqu, extra); ++ DBG_871X("set case mp_rate \n"); ++ rtw_mp_rate (dev,info,wrqu,extra); + break; -+ ++ + case MP_TXPOWER: -+ DBG_871X("set case MP_TXPOWER\n"); -+ rtw_mp_txpower(dev, info, wrqu, extra); ++ DBG_871X("set case MP_TXPOWER \n"); ++ rtw_mp_txpower (dev,info,wrqu,extra); + break; -+ ++ + case MP_ANT_TX: -+ DBG_871X("set case MP_ANT_TX\n"); -+ rtw_mp_ant_tx(dev, info, wrqu, extra); ++ DBG_871X("set case MP_ANT_TX \n"); ++ rtw_mp_ant_tx (dev,info,wrqu,extra); + break; -+ ++ + case MP_ANT_RX: -+ DBG_871X("set case MP_ANT_RX\n"); -+ rtw_mp_ant_rx(dev, info, wrqu, extra); ++ DBG_871X("set case MP_ANT_RX \n"); ++ rtw_mp_ant_rx (dev,info,wrqu,extra); + break; -+ ++ + case MP_QUERY: -+ rtw_mp_trx_query(dev, info, wrqu, extra); ++ //DBG_871X("mp_get mp_query MP_QUERY \n"); ++ rtw_mp_trx_query(dev,info,wrqu,extra); + break; -+ ++ + case MP_CTX: -+ DBG_871X("set case MP_CTX\n"); -+ rtw_mp_ctx(dev, info, wrqu, extra); ++ DBG_871X("set case MP_CTX \n"); ++ rtw_mp_ctx (dev,info,wrqu,extra); + break; -+ ++ + case MP_ARX: -+ DBG_871X("set case MP_ARX\n"); -+ rtw_mp_arx(dev, info, wrqu, extra); ++ DBG_871X("set case MP_ARX \n"); ++ rtw_mp_arx (dev,info,wrqu,extra); + break; -+ ++ + case EFUSE_GET: -+ DBG_871X("efuse get EFUSE_GET\n"); -+ rtw_mp_efuse_get(dev, info, wdata, extra); -+ break; -+ -+ case MP_DUMP: -+ DBG_871X("set case MP_DUMP\n"); -+ rtw_mp_dump(dev, info, wrqu, extra); -+ break; -+ case MP_PSD: -+ DBG_871X("set case MP_PSD\n"); -+ rtw_mp_psd(dev, info, wrqu, extra); ++ DBG_871X("efuse get EFUSE_GET \n"); ++ rtw_mp_efuse_get(dev,info,wdata,extra); + break; ++ ++ case MP_DUMP: ++ DBG_871X("set case MP_DUMP \n"); ++ rtw_mp_dump (dev,info,wrqu,extra); ++ break; ++ case MP_PSD: ++ DBG_871X("set case MP_PSD \n"); ++ rtw_mp_psd (dev,info,wrqu,extra); ++ break; ++ + case MP_THER: -+ DBG_871X("set case MP_THER\n"); -+ rtw_mp_thermal(dev, info, wrqu, extra); ++ DBG_871X("set case MP_THER \n"); ++ rtw_mp_thermal (dev,info,wrqu,extra); + break; -+ case MP_PwrCtlDM: -+ DBG_871X("set MP_PwrCtlDM\n"); -+ rtw_mp_PwrCtlDM(dev, info, wrqu, extra); -+ break; -+ case MP_QueryDrvStats: -+ DBG_871X("mp_get MP_QueryDrvStats\n"); -+ rtw_mp_QueryDrv(dev, info, wdata, extra); ++ ++ case MP_QueryDrvStats: ++ DBG_871X("mp_get MP_QueryDrvStats \n"); ++ rtw_mp_QueryDrv (dev,info,wdata,extra); ++ break; ++ case MP_PWRTRK: ++ DBG_871X("set case MP_PWRTRK \n"); ++ rtw_mp_pwrtrk (dev,info,wrqu,extra); + break; -+ case MP_PWRTRK: -+ DBG_871X("set case MP_PWRTRK\n"); -+ rtw_mp_pwrtrk(dev, info, wrqu, extra); -+ break; + case EFUSE_SET: -+ DBG_871X("set case efuse set\n"); -+ rtw_mp_efuse_set(dev, info, wdata, extra); -+ break; ++ DBG_871X("set case efuse set \n"); ++ rtw_mp_efuse_set (dev,info,wdata,extra); ++ break; + case MP_GET_TXPOWER_INX: -+ DBG_871X("mp_get MP_GET_TXPOWER_INX\n"); -+ rtw_mp_txpower_index(dev, info, wrqu, extra); -+ break; -+ case MP_GETVER: -+ DBG_871X("mp_get MP_GETVER\n"); -+ rtw_mp_getver(dev, info, wdata, extra); -+ break; -+ case MP_MON: -+ DBG_871X("mp_get MP_MON\n"); -+ rtw_mp_mon(dev, info, wdata, extra); -+ break; -+ case EFUSE_MASK: -+ DBG_871X("mp_get EFUSE_MASK\n"); -+ rtw_efuse_mask_file(dev, info, wdata, extra); -+ break; -+ case EFUSE_FILE: -+ DBG_871X("mp_get EFUSE_FILE\n"); -+ rtw_efuse_file_map(dev, info, wdata, extra); -+ break; -+ case MP_TX: -+ DBG_871X("mp_get MP_TX\n"); -+ rtw_mp_tx(dev, info, wdata, extra); -+ break; -+ case MP_RX: -+ DBG_871X("mp_get MP_RX\n"); -+ rtw_mp_rx(dev, info, wdata, extra); -+ break; -+#if defined(CONFIG_RTL8723B) -+ case MP_SetBT: -+ DBG_871X("set MP_SetBT\n"); -+ rtw_mp_SetBT(dev, info, wdata, extra); -+ break; -+#endif -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ case MP_SD_IREAD: -+ rtw_mp_sd_iread(dev, info, wrqu, extra); ++ DBG_871X("mp_get MP_GET_TXPOWER_INX \n"); ++ rtw_mp_txpower_index (dev,info,wrqu,extra); + break; -+ case MP_SD_IWRITE: -+ rtw_mp_sd_iwrite(dev, info, wrqu, extra); -+ break; -+#endif + } + + rtw_msleep_os(10); //delay 5ms for sending pkt before exit adb shell operation -+return 0; ++return 0; +} + -+#endif /*#if defined(CONFIG_MP_INCLUDED)*/ ++#endif //#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_MP_IWPRIV_SUPPORT) + +static int rtw_wfd_tdls_enable(struct net_device *dev, + struct iw_request_info *info, @@ -362138,16 +172175,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + -+ DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); ++ printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); + + if ( extra[ 0 ] == '0' ) ++ { + padapter->wdinfo.wfd_tdls_enable = 0; ++ } + else ++ { + padapter->wdinfo.wfd_tdls_enable = 1; ++ } ++ ++#endif //CONFIG_WFD ++#endif //CONFIG_TDLS + -+#endif /* CONFIG_WFD */ -+#endif /* CONFIG_TDLS */ -+ + return ret; +} + @@ -362165,12 +172206,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); + + if ( extra[ 0 ] == '0' ) ++ { + padapter->wdinfo.wfd_tdls_weaksec = 0; ++ } + else ++ { + padapter->wdinfo.wfd_tdls_weaksec = 1; ++ } ++#endif + -+#endif /* CONFIG_TDLS */ -+ + return ret; +} + @@ -362192,51 +172236,55 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct sta_priv *pstapriv = &padapter->stapriv; + u8 tdls_sta[NUM_STA][ETH_ALEN]; + u8 empty_hwaddr[ETH_ALEN] = { 0x00 }; -+ struct tdls_txmgmt txmgmt; + -+ DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); ++ printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); + + _rtw_memset(tdls_sta, 0x00, sizeof(tdls_sta)); -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); + -+ if (extra[ 0 ] == '0') { -+ ptdlsinfo->tdls_enable = 0; ++ if ( extra[ 0 ] == '0' ) ++ { ++ ptdlsinfo->enable = 0; + + if(pstapriv->asoc_sta_count==1) + return ret; + + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for (index=0; index< NUM_STA; index++) { ++ for(index=0; index< NUM_STA; index++) ++ { + phead = &(pstapriv->sta_hash[index]); + plist = get_next(phead); -+ -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { ++ ++ while ((rtw_end_of_queue_search(phead, plist)) == false) ++ { + psta = LIST_CONTAINOR(plist, struct sta_info ,hash_list); + + plist = get_next(plist); + -+ if (psta->tdls_sta_state != TDLS_STATE_NONE) { ++ if(psta->tdls_sta_state != TDLS_STATE_NONE) ++ { + _rtw_memcpy(tdls_sta[index], psta->hwaddr, ETH_ALEN); + } + } + } + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); + -+ for (index=0; index< NUM_STA; index++) { -+ if (!_rtw_memcmp(tdls_sta[index], empty_hwaddr, ETH_ALEN)) { -+ DBG_871X("issue tear down to "MAC_FMT"\n", MAC_ARG(tdls_sta[index])); -+ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; -+ _rtw_memcpy(txmgmt.peer, tdls_sta[index], ETH_ALEN); -+ issue_tdls_teardown(padapter, &txmgmt, _TRUE); ++ for(index=0; index< NUM_STA; index++) ++ { ++ if( !_rtw_memcmp(tdls_sta[index], empty_hwaddr, ETH_ALEN) ) ++ { ++ printk("issue tear down to "MAC_FMT"\n", MAC_ARG(tdls_sta[index])); ++ issue_tdls_teardown(padapter, tdls_sta[index]); + } + } -+ rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR); ++ rtw_tdls_cmd(padapter, myid(&(padapter->eeprompriv)), TDLS_RS_RCR); + rtw_reset_tdls_info(padapter); -+ } else if (extra[0] == '1') { -+ ptdlsinfo->tdls_enable = 1; + } -+#endif /* CONFIG_TDLS */ -+ ++ else if ( extra[ 0 ] == '1' ) ++ { ++ ptdlsinfo->enable = 1; ++ } ++#endif //CONFIG_TDLS ++ + return ret; +} + @@ -362245,43 +172293,44 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + union iwreq_data *wrqu, char *extra) +{ + int ret = 0; ++ +#ifdef CONFIG_TDLS ++ + u8 i, j; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_txmgmt txmgmt; ++ u8 mac_addr[ETH_ALEN]; ++ +#ifdef CONFIG_WFD + struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif /* CONFIG_WFD */ ++#endif // CONFIG_WFD + -+ DBG_871X("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1); ++ printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); + -+ if (wrqu->data.length - 1 != 17) { -+ DBG_871X("[%s] length:%d != 17\n", __FUNCTION__, (wrqu->data.length -1)); -+ return ret; -+ } -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); + for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){ -+ txmgmt.peer[i]=key_2char2num(*(extra+j), *(extra+j+1)); ++ mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1)); + } + +#ifdef CONFIG_WFD -+ if (_AES_ != padapter->securitypriv.dot11PrivacyAlgrthm) { -+ /* Weak Security situation with AP. */ -+ if (0 == pwdinfo->wfd_tdls_weaksec) { -+ /* Can't send the tdls setup request out!! */ -+ DBG_871X("[%s] Current link is not AES, " -+ "SKIP sending the tdls setup request!!\n", __FUNCTION__); -+ } else { -+ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); -+ } -+ } else -+#endif /* CONFIG_WFD */ ++ if ( _AES_ != padapter->securitypriv.dot11PrivacyAlgrthm ) + { -+ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); ++ // Weak Security situation with AP. ++ if ( 0 == pwdinfo->wfd_tdls_weaksec ) ++ { ++ // Can't send the tdls setup request out!! ++ DBG_871X( "[%s] Current link is not AES, SKIP sending the tdls setup request!!\n", __FUNCTION__ ); ++ } ++ else ++ { ++ issue_tdls_setup_req(padapter, mac_addr); ++ } + } -+#endif /* CONFIG_TDLS */ -+ ++ else ++#endif // CONFIG_WFD ++ { ++ issue_tdls_setup_req(padapter, mac_addr); ++ } ++#endif ++ + return ret; +} + @@ -362296,33 +172345,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + u8 i,j; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct sta_info *ptdls_sta = NULL; -+ struct tdls_txmgmt txmgmt; ++ u8 mac_addr[ETH_ALEN]; + + DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); + -+ if (wrqu->data.length - 1 != 17 && wrqu->data.length - 1 != 19) { -+ DBG_871X("[%s] length:%d != 17 or 19\n", -+ __FUNCTION__, (wrqu->data.length -1)); -+ return ret; ++ for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){ ++ mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1)); + } + -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ for (i=0, j=0; i < ETH_ALEN; i++, j+=3) -+ txmgmt.peer[i]=key_2char2num(*(extra+j), *(extra+j+1)); ++ ptdls_sta = rtw_get_stainfo( &(padapter->stapriv), mac_addr); + -+ ptdls_sta = rtw_get_stainfo( &(padapter->stapriv), txmgmt.peer); -+ -+ if (ptdls_sta != NULL) { -+ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; -+ if (wrqu->data.length - 1 == 19) -+ issue_tdls_teardown(padapter, &txmgmt, _FALSE); -+ else -+ issue_tdls_teardown(padapter, &txmgmt, _TRUE); -+ } else { -+ DBG_871X( "TDLS peer not found\n"); ++ if(ptdls_sta != NULL) ++ { ++ ptdls_sta->stat_code = _RSON_TDLS_TEAR_UN_RSN_; ++ issue_tdls_teardown(padapter, mac_addr); + } -+#endif /* CONFIG_TDLS */ -+ ++ ++#endif //CONFIG_TDLS ++ + return ret; +} + @@ -362333,21 +172373,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + int ret = 0; + +#ifdef CONFIG_TDLS -+ ++ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_txmgmt txmgmt; -+ int i = 0, j=0; ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + + DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); + -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){ -+ txmgmt.peer[i]=key_2char2num(*(extra+j), *(extra+j+1)); -+ } ++ issue_tdls_dis_req(padapter, NULL); + -+ issue_tdls_dis_req(padapter, &txmgmt); -+ -+#endif /* CONFIG_TDLS */ ++#endif //CONFIG_TDLS + + return ret; +} @@ -362359,173 +172394,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + int ret = 0; + +#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW ++ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ u8 i, j; ++ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ u8 i, j, mac_addr[ETH_ALEN]; + struct sta_info *ptdls_sta = NULL; + + DBG_8192C( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); + -+ if (padapter->tdlsinfo.ch_switch_prohibited == _TRUE) -+ { -+ DBG_871X("Can't do TDLS channel switch since ch_switch_prohibited = _TRUE\n"); -+ return ret; -+ } -+ + for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){ -+ pchsw_info->addr[i] = key_2char2num(*(extra+j), *(extra+j+1)); ++ mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1)); + } + -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pchsw_info->addr); ++ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); + if( ptdls_sta == NULL ) + return ret; ++ ptdlsinfo->ch_sensing=1; + -+ pchsw_info->ch_sw_state |= TDLS_CH_SW_INITIATOR_STATE; ++ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_INIT_CH_SEN); + -+ if (ptdls_sta != NULL) { -+ if (pchsw_info->off_ch_num == 0) -+ pchsw_info->off_ch_num = 11; -+ }else { -+ DBG_871X( "TDLS peer not found\n"); -+ } -+ -+ -+ //issue_tdls_ch_switch_req(padapter, ptdls_sta); -+ /* DBG_871X("issue tdls ch switch req\n"); */ -+ -+#endif /* CONFIG_TDLS_CH_SW */ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_ch_switch_off(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ u8 i, j, mac_addr[ETH_ALEN]; -+ struct sta_info *ptdls_sta = NULL; -+ struct tdls_txmgmt txmgmt; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ -+ DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); -+ -+ if (padapter->tdlsinfo.ch_switch_prohibited == _TRUE) -+ { -+ DBG_871X("Can't do TDLS channel switch since ch_switch_prohibited = _TRUE\n"); -+ return ret; -+ } -+ -+ if (wrqu->data.length >= 17) { -+ for (i=0, j=0 ; i < ETH_ALEN; i++, j+=3) -+ mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1)); -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); -+ } -+ -+ if (padapter->mlmeextpriv.cur_channel != rtw_get_oper_ch(padapter)) { -+ SelectChannel(padapter, padapter->mlmeextpriv.cur_channel); -+ } -+ -+ pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE | -+ TDLS_CH_SWITCH_ON_STATE | -+ TDLS_PEER_AT_OFF_STATE); -+ ATOMIC_SET(&pchsw_info->chsw_on, _FALSE); -+ _rtw_memset(pchsw_info->addr, 0x00, ETH_ALEN); -+ -+ if (ptdls_sta != NULL) { -+ ptdls_sta->ch_switch_time = 0; -+ ptdls_sta->ch_switch_timeout = 0; -+ _cancel_timer_ex(&ptdls_sta->ch_sw_timer); -+ _cancel_timer_ex(&ptdls_sta->delay_timer); -+ } -+ -+#endif /* CONFIG_TDLS_CH_SW */ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_dump_ch(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ DBG_8192C("[%s] dump_stack:%s\n", __FUNCTION__, extra); -+ -+ extra[ wrqu->data.length ] = 0x00; -+ ptdlsinfo->chsw_info.dump_stack = rtw_atoi( extra ); -+ -+ return ret; -+ -+#endif -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_off_ch_num(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ DBG_8192C("[%s] off_ch_num:%s\n", __FUNCTION__, extra); -+ -+ extra[ wrqu->data.length ] = 0x00; -+ ptdlsinfo->chsw_info.off_ch_num = rtw_atoi(extra); -+ -+ return ret; -+ -+#endif -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_ch_offset(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ DBG_8192C("[%s] ch_offset:%s\n", __FUNCTION__, extra); -+ -+ extra[ wrqu->data.length ] = 0x00; -+ ptdlsinfo->chsw_info.ch_offset = rtw_atoi( extra ); -+ -+ return ret; -+ -+#endif -+#endif /* CONFIG_TDLS */ ++#endif //CONFIG_TDLS + + return ret; +} -+ ++ +static int rtw_tdls_pson(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) @@ -362533,25 +172425,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + int ret = 0; + +#ifdef CONFIG_TDLS -+ ++ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u8 i, j, mac_addr[ETH_ALEN]; + struct sta_info *ptdls_sta = NULL; + + DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); + -+ for (i=0, j=0; i < ETH_ALEN; i++, j+=3) ++ for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){ + mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1)); ++ } + + ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); + -+ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 1, 3, 500); ++ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta, 1); + -+#endif /* CONFIG_TDLS */ ++#endif //CONFIG_TDLS + + return ret; +} -+ ++ +static int rtw_tdls_psoff(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) @@ -362559,22 +172454,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + int ret = 0; + +#ifdef CONFIG_TDLS -+ ++ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); ++ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); ++ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u8 i, j, mac_addr[ETH_ALEN]; + struct sta_info *ptdls_sta = NULL; -+ ++ + DBG_8192C( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); + -+ for (i=0, j=0; i < ETH_ALEN; i++, j+=3) ++ for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){ + mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1)); ++ } + + ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); + -+ if(ptdls_sta) -+ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 0, 3, 500); ++ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta, 0); + -+#endif /* CONFIG_TDLS */ ++#endif //CONFIG_TDLS + + return ret; +} @@ -362587,23 +172484,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + +#ifdef CONFIG_TDLS +#ifdef CONFIG_WFD -+ ++ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; + struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; -+ u8 i=0, j=0, k=0, tag=0; ++ u8 i=0, j=0, k=0, tag=0, ip[3] = { 0xff }, *ptr = extra; + -+ DBG_871X("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); ++ printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1 ); + -+ while (i < 4) { -+ for (j=0; j < 4; j++) { -+ if (*( extra + j + tag ) == '.' || *( extra + j + tag ) == '\0') { ++ ++ while( i < 4 ) ++ { ++ for( j=0; j < 4; j++) ++ { ++ if( *( extra + j + tag ) == '.' || *( extra + j + tag ) == '\0' ) ++ { + if( j == 1 ) + pwfd_info->ip_address[i]=convert_ip_addr( '0', '0', *(extra+(j-1)+tag)); + if( j == 2 ) + pwfd_info->ip_address[i]=convert_ip_addr( '0', *(extra+(j-2)+tag), *(extra+(j-1)+tag)); + if( j == 3 ) -+ pwfd_info->ip_address[i]=convert_ip_addr( *(extra+(j-3)+tag), *(extra+(j-2)+tag), *(extra+(j-1)+tag)); ++ pwfd_info->ip_address[i]=convert_ip_addr( *(extra+(j-3)+tag), *(extra+(j-2)+tag), *(extra+(j-1)+tag)); + + tag += j + 1; + break; @@ -362612,14 +172513,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + i++; + } + -+ DBG_871X( "[%s] Set IP = %u.%u.%u.%u \n", __FUNCTION__, -+ ptdlsinfo->wfd_info->ip_address[0], -+ ptdlsinfo->wfd_info->ip_address[1], -+ ptdlsinfo->wfd_info->ip_address[2], -+ ptdlsinfo->wfd_info->ip_address[3]); ++ printk( "[%s] Set IP = %u.%u.%u.%u \n", __FUNCTION__, ++ ptdlsinfo->wfd_info->ip_address[0], ptdlsinfo->wfd_info->ip_address[1], ++ ptdlsinfo->wfd_info->ip_address[2], ptdlsinfo->wfd_info->ip_address[3] ++ ); + -+#endif /* CONFIG_WFD */ -+#endif /* CONFIG_TDLS */ ++#endif //CONFIG_WFD ++#endif //CONFIG_TDLS + + return ret; +} @@ -362632,25 +172532,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + +#ifdef CONFIG_TDLS +#ifdef CONFIG_WFD -+ ++ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; + struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; -+ -+ DBG_871X( "[%s]\n", __FUNCTION__); + -+ sprintf( extra, "\n\n%u.%u.%u.%u\n", -+ pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1], -+ pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3]); ++ printk( "[%s]\n", __FUNCTION__); ++ ++ sprintf( extra, "\n\n%u.%u.%u.%u\n", ++ pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1], ++ pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3] ++ ); ++ ++ printk( "[%s] IP=%u.%u.%u.%u\n", __FUNCTION__, ++ pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1], ++ pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3] ++ ); + -+ DBG_871X( "[%s] IP=%u.%u.%u.%u\n", __FUNCTION__, -+ pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1], -+ pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3]); -+ + wrqu->data.length = strlen( extra ); + -+#endif /* CONFIG_WFD */ -+#endif /* CONFIG_TDLS */ ++#endif //CONFIG_WFD ++#endif //CONFIG_TDLS + + return ret; +} @@ -362659,8 +172561,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; ++ ++ int ret = 0; + +#ifdef CONFIG_TDLS +#ifdef CONFIG_WFD @@ -362669,211 +172571,119 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; + struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; + -+ DBG_871X( "[%s]\n", __FUNCTION__); ++ printk( "[%s]\n", __FUNCTION__); + + sprintf( extra, "\n\n%d\n", pwfd_info->peer_rtsp_ctrlport ); -+ DBG_871X( "[%s] remote port = %d\n", -+ __FUNCTION__, pwfd_info->peer_rtsp_ctrlport ); -+ ++ printk( "[%s] remote port = %d\n", __FUNCTION__, pwfd_info->peer_rtsp_ctrlport ); ++ + wrqu->data.length = strlen( extra ); + -+#endif /* CONFIG_WFD */ -+#endif /* CONFIG_TDLS */ ++#endif //CONFIG_WFD ++#endif //CONFIG_TDLS + + return ret; -+ ++ +} + -+/* WFDTDLS, for sigma test */ ++//WFDTDLS, for sigma test +static int rtw_tdls_dis_result(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; ++ ++ int ret = 0; + +#ifdef CONFIG_TDLS +#ifdef CONFIG_WFD + + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; + -+ DBG_871X( "[%s]\n", __FUNCTION__); ++ printk( "[%s]\n", __FUNCTION__); + -+ if (ptdlsinfo->dev_discovered == _TRUE) { ++ if(ptdlsinfo->dev_discovered == 1 ) ++ { + sprintf( extra, "\n\nDis=1\n" ); -+ ptdlsinfo->dev_discovered = _FALSE; ++ ptdlsinfo->dev_discovered = 0; + } -+ ++ + wrqu->data.length = strlen( extra ); + -+#endif /* CONFIG_WFD */ -+#endif /* CONFIG_TDLS */ ++#endif //CONFIG_WFD ++#endif //CONFIG_TDLS + + return ret; -+ ++ +} + -+/* WFDTDLS, for sigma test */ ++//WFDTDLS, for sigma test +static int rtw_wfd_tdls_status(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+ -+ int ret = 0; ++ ++ int ret = 0; + +#ifdef CONFIG_TDLS ++#ifdef CONFIG_WFD + + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; ++ struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; + -+ DBG_871X("[%s]\n", __FUNCTION__); ++ printk( "[%s]\n", __FUNCTION__); + -+ sprintf( extra, "\nlink_established:%d \n" -+ "sta_cnt:%d \n" -+ "sta_maximum:%d \n" -+ "cur_channel:%d \n" -+ "tdls_enable:%d" -+#ifdef CONFIG_TDLS_CH_SW -+ "ch_sw_state:%08x\n" -+ "chsw_on:%d\n" -+ "off_ch_num:%d\n" -+ "cur_time:%d\n" -+ "ch_offset:%d\n" -+ "delay_swtich_back:%d" -+#endif -+ , -+ ptdlsinfo->link_established, ptdlsinfo->sta_cnt, -+ ptdlsinfo->sta_maximum, ptdlsinfo->cur_channel, -+ ptdlsinfo->tdls_enable -+#ifdef CONFIG_TDLS_CH_SW -+, -+ ptdlsinfo->chsw_info.ch_sw_state, -+ ATOMIC_READ(&padapter->tdlsinfo.chsw_info.chsw_on), -+ ptdlsinfo->chsw_info.off_ch_num, -+ ptdlsinfo->chsw_info.cur_time, -+ ptdlsinfo->chsw_info.ch_offset, -+ ptdlsinfo->chsw_info.delay_switch_back -+#endif -+); -+ -+ wrqu->data.length = strlen( extra ); -+ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+ -+ } -+ -+static int rtw_tdls_getsta(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) ++ if(ptdlsinfo->setup_state == TDLS_LINKED_STATE ) + { -+ -+ int ret = 0; -+#ifdef CONFIG_TDLS -+ u8 i, j; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 addr[ETH_ALEN] = {0}; -+ char charmac[17]; -+ struct sta_info *ptdls_sta = NULL; -+ -+ DBG_871X("[%s] %s %d\n", __FUNCTION__, -+ (char *)wrqu->data.pointer, wrqu->data.length -1); -+ -+ if(copy_from_user(charmac, wrqu->data.pointer+9, 17)){ -+ ret = -EFAULT; -+ goto exit; ++ sprintf( extra, "\n\nStatus=1\n" ); + } -+ -+ DBG_871X("[%s] %d, charmac:%s\n", __FUNCTION__, __LINE__, charmac); -+ for (i=0, j=0 ; i < ETH_ALEN; i++, j+=3) -+ addr[i]=key_2char2num(*(charmac+j), *(charmac+j+1)); -+ -+ DBG_871X("[%s] %d, charmac:%s, addr:"MAC_FMT"\n", -+ __FUNCTION__, __LINE__, charmac, MAC_ARG(addr)); -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, addr); -+ if(ptdls_sta) { -+ sprintf(extra, "\n\ntdls_sta_state=0x%08x\n", ptdls_sta->tdls_sta_state); -+ DBG_871X("\n\ntdls_sta_state=%d\n", ptdls_sta->tdls_sta_state); -+ } else { -+ sprintf(extra, "\n\nNot found this sta\n"); -+ DBG_871X("\n\nNot found this sta\n"); ++ else ++ { ++ sprintf( extra, "\n\nStatus=0\n" ); + } ++ + wrqu->data.length = strlen( extra ); + -+#endif /* CONFIG_TDLS */ -+exit: ++#endif //CONFIG_WFD ++#endif //CONFIG_TDLS ++ + return ret; -+ ++ +} + -+static int rtw_tdls_get_best_ch(struct net_device *dev, ++static int rtw_tdls_ch_switch_off(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ -+#ifdef CONFIG_FIND_BEST_CHANNEL ++ int ret = 0; ++ ++#ifdef CONFIG_TDLS ++ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u32 i, best_channel_24G = 1, best_channel_5G = 36, index_24G = 0, index_5G = 0; ++ u8 i, j, mac_addr[ETH_ALEN]; ++ struct sta_info *ptdls_sta = NULL; + -+ for (i=0; pmlmeext->channel_set[i].ChannelNum !=0; i++) { -+ if (pmlmeext->channel_set[i].ChannelNum == 1) -+ index_24G = i; -+ if (pmlmeext->channel_set[i].ChannelNum == 36) -+ index_5G = i; -+ } -+ -+ for (i=0; pmlmeext->channel_set[i].ChannelNum !=0; i++) { -+ /* 2.4G */ -+ if (pmlmeext->channel_set[i].ChannelNum == 6 || pmlmeext->channel_set[i].ChannelNum == 11) { -+ if (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_24G].rx_count) { -+ index_24G = i; -+ best_channel_24G = pmlmeext->channel_set[i].ChannelNum; -+ } -+ } ++ DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); + -+ /* 5G */ -+ if (pmlmeext->channel_set[i].ChannelNum >= 36 -+ && pmlmeext->channel_set[i].ChannelNum < 140) { -+ /* Find primary channel */ -+ if (((pmlmeext->channel_set[i].ChannelNum - 36) % 8 == 0) -+ && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { -+ index_5G = i; -+ best_channel_5G = pmlmeext->channel_set[i].ChannelNum; -+ } -+ } -+ -+ if (pmlmeext->channel_set[i].ChannelNum >= 149 -+ && pmlmeext->channel_set[i].ChannelNum < 165) { -+ /* Find primary channel */ -+ if (((pmlmeext->channel_set[i].ChannelNum - 149) % 8 == 0) -+ && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { -+ index_5G = i; -+ best_channel_5G = pmlmeext->channel_set[i].ChannelNum; -+ } -+ } -+#if 1 /* debug */ -+ DBG_871X("The rx cnt of channel %3d = %d\n", -+ pmlmeext->channel_set[i].ChannelNum, -+ pmlmeext->channel_set[i].rx_count); -+#endif -+ } -+ -+ sprintf( extra, "\nbest_channel_24G = %d\n", best_channel_24G ); -+ DBG_871X("best_channel_24G = %d\n", best_channel_24G); -+ -+ if (index_5G != 0) { -+ sprintf(extra, "best_channel_5G = %d\n", best_channel_5G); -+ DBG_871X("best_channel_5G = %d\n", best_channel_5G); ++ for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){ ++ mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1)); + } + -+ wrqu->data.length = strlen( extra ); ++ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); + -+#endif ++ ptdls_sta->tdls_sta_state |= TDLS_SW_OFF_STATE; ++/* ++ if((ptdls_sta->tdls_sta_state & TDLS_AT_OFF_CH_STATE) && (ptdls_sta->tdls_sta_state & TDLS_PEER_AT_OFF_STATE)){ ++ pmlmeinfo->tdls_candidate_ch= pmlmeext->cur_channel; ++ issue_tdls_ch_switch_req(padapter, mac_addr); ++ DBG_871X("issue tdls ch switch req back to base channel\n"); ++ } ++*/ + -+ return 0; ++#endif //CONFIG_TDLS + ++ return ret; +} + +static int rtw_tdls(struct net_device *dev, @@ -362883,72 +172693,84 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + int ret = 0; + +#ifdef CONFIG_TDLS -+ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + + DBG_871X( "[%s] extra = %s\n", __FUNCTION__, extra ); -+ /* WFD Sigma will use the tdls enable command to let the driver know we want to test the tdls now! */ -+ if (_rtw_memcmp(extra, "wfdenable=", 10)) { ++ // WFD Sigma will use the tdls enable command to let the driver know we want to test the tdls now! ++ if ( _rtw_memcmp( extra, "wfdenable=", 10 ) ) ++ { + wrqu->data.length -=10; + rtw_wfd_tdls_enable( dev, info, wrqu, &extra[10] ); + return ret; -+ } else if (_rtw_memcmp(extra, "weaksec=", 8)) { ++ } ++ else if ( _rtw_memcmp( extra, "weaksec=", 8 ) ) ++ { + wrqu->data.length -=8; + rtw_tdls_weaksec( dev, info, wrqu, &extra[8] ); + return ret; -+ } else if (_rtw_memcmp( extra, "tdlsenable=", 11)) { ++ } ++ else if ( _rtw_memcmp( extra, "tdlsenable=", 11 ) ) ++ { + wrqu->data.length -=11; + rtw_tdls_enable( dev, info, wrqu, &extra[11] ); + return ret; + } + -+ if (padapter->tdlsinfo.tdls_enable == 0) { -+ DBG_871X("tdls haven't enabled\n"); ++ if( padapter->tdlsinfo.enable == 0 ) ++ { ++ printk("tdls haven't enabled\n"); + return 0; + } + -+ if (_rtw_memcmp(extra, "setup=", 6)) { ++ if ( _rtw_memcmp( extra, "setup=", 6 ) ) ++ { + wrqu->data.length -=6; + rtw_tdls_setup( dev, info, wrqu, &extra[6] ); -+ } else if (_rtw_memcmp(extra, "tear=", 5)) { ++ } ++ else if (_rtw_memcmp( extra, "tear=", 5 ) ) ++ { + wrqu->data.length -= 5; + rtw_tdls_teardown( dev, info, wrqu, &extra[5] ); -+ } else if (_rtw_memcmp(extra, "dis=", 4)) { ++ } ++ else if (_rtw_memcmp( extra, "dis=", 4 ) ) ++ { + wrqu->data.length -= 4; + rtw_tdls_discovery( dev, info, wrqu, &extra[4] ); -+ } else if (_rtw_memcmp(extra, "swoff=", 6)) { -+ wrqu->data.length -= 6; -+ rtw_tdls_ch_switch_off(dev, info, wrqu, &extra[6]); -+ } else if (_rtw_memcmp(extra, "sw=", 3)) { ++ } ++ else if (_rtw_memcmp( extra, "sw=", 3 ) ) ++ { + wrqu->data.length -= 3; + rtw_tdls_ch_switch( dev, info, wrqu, &extra[3] ); -+ } else if (_rtw_memcmp(extra, "dumpstack=", 10)) { -+ wrqu->data.length -= 10; -+ rtw_tdls_dump_ch(dev, info, wrqu, &extra[10]); -+ } else if (_rtw_memcmp(extra, "offchnum=", 9)) { -+ wrqu->data.length -= 9; -+ rtw_tdls_off_ch_num(dev, info, wrqu, &extra[9]); -+ } else if (_rtw_memcmp(extra, "choffset=", 9)) { -+ wrqu->data.length -= 9; -+ rtw_tdls_ch_offset(dev, info, wrqu, &extra[9]); -+ } else if (_rtw_memcmp(extra, "pson=", 5)) { ++ } ++ else if (_rtw_memcmp( extra, "swoff=", 6 ) ) ++ { ++ wrqu->data.length -= 6; ++ rtw_tdls_ch_switch_off( dev, info, wrqu, &extra[6] ); ++ } ++ else if (_rtw_memcmp( extra, "pson=", 5 ) ) ++ { + wrqu->data.length -= 5; + rtw_tdls_pson( dev, info, wrqu, &extra[5] ); -+ } else if (_rtw_memcmp(extra, "psoff=", 6)) { ++ } ++ else if (_rtw_memcmp( extra, "psoff=", 6 ) ) ++ { + wrqu->data.length -= 6; + rtw_tdls_psoff( dev, info, wrqu, &extra[6] ); + } +#ifdef CONFIG_WFD -+ else if (_rtw_memcmp(extra, "setip=", 6)) { ++ else if (_rtw_memcmp( extra, "setip=", 6 ) ) ++ { + wrqu->data.length -= 6; + rtw_tdls_setip( dev, info, wrqu, &extra[6] ); -+ } else if (_rtw_memcmp(extra, "tprobe=", 6)) { ++ } ++ else if (_rtw_memcmp( extra, "tprobe=", 6 ) ) ++ { + issue_tunneled_probe_req((_adapter *)rtw_netdev_priv(dev)); + } -+#endif /* CONFIG_WFD */ ++#endif //CONFIG_WFD ++ ++#endif //CONFIG_TDLS + -+#endif /* CONFIG_TDLS */ -+ + return ret; +} + @@ -362959,24 +172781,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +{ + int ret = 0; + -+#ifdef CONFIG_TDLS ++#ifdef CONFIG_WFD + + DBG_871X( "[%s] extra = %s\n", __FUNCTION__, (char*) wrqu->data.pointer ); + -+ if ( _rtw_memcmp( wrqu->data.pointer, "ip", 2 ) ) ++ if ( _rtw_memcmp((__force void *)wrqu->data.pointer, "ip", 2 ) ) ++ { + rtw_tdls_getip( dev, info, wrqu, extra ); -+ else if (_rtw_memcmp(wrqu->data.pointer, "port", 4)) ++ } ++ if ( _rtw_memcmp((__force void *)wrqu->data.pointer, "port", 4 ) ) ++ { + rtw_tdls_getport( dev, info, wrqu, extra ); -+ /* WFDTDLS, for sigma test */ -+ else if ( _rtw_memcmp(wrqu->data.pointer, "dis", 3)) ++ } ++ //WFDTDLS, for sigma test ++ if ( _rtw_memcmp((__force void *)wrqu->data.pointer, "dis", 3 ) ) ++ { + rtw_tdls_dis_result( dev, info, wrqu, extra ); -+ else if ( _rtw_memcmp(wrqu->data.pointer, "status", 6)) ++ } ++ if ( _rtw_memcmp((__force void *)wrqu->data.pointer, "status", 6 ) ) ++ { + rtw_wfd_tdls_status( dev, info, wrqu, extra ); -+ else if ( _rtw_memcmp(wrqu->data.pointer, "tdls_sta=", 9)) -+ rtw_tdls_getsta( dev, info, wrqu, extra ); -+ else if (_rtw_memcmp(wrqu->data.pointer, "best_ch", 7)) -+ rtw_tdls_get_best_ch(dev, info, wrqu, extra); -+#endif /* CONFIG_TDLS */ ++ } ++ ++#endif //CONFIG_WFD + + return ret; +} @@ -363009,12 +172836,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + pbuf = rtw_malloc(sizeof(l2_msg_t)); + if(pbuf) + { -+ if ( copy_from_user(pbuf, wrqu->data.pointer, wrqu->data.length) ) -+ ret = -EFAULT; ++ copy_from_user(pbuf, wrqu->data.pointer, wrqu->data.length); + //_rtw_memcpy(pbuf, wrqu->data.pointer, wrqu->data.length); + + if( wrqu->data.flags == 0 ) -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_ISSUE_PROB_WK, pbuf, sizeof(l2_msg_t)); ++ intel_widi_wk_cmd(padapter, INTEL_WIDI_ISSUE_PROB_WK, pbuf); + else if( wrqu->data.flags == 1 ) + rtw_set_wfd_rds_sink_info( padapter, (l2_msg_t *)pbuf ); + } @@ -363024,38 +172850,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + +#ifdef CONFIG_MAC_LOOPBACK_DRIVER + -+#if defined(CONFIG_RTL8188E) -+#include -+extern void rtl8188e_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+#define cal_txdesc_chksum rtl8188e_cal_txdesc_chksum -+#ifdef CONFIG_SDIO_HCI || defined(CONFIG_GSPI_HCI) -+extern void rtl8188es_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); -+#define fill_default_txdesc rtl8188es_fill_default_txdesc -+#endif // CONFIG_SDIO_HCI -+#endif // CONFIG_RTL8188E -+#if defined(CONFIG_RTL8723B) -+extern void rtl8723b_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+#define cal_txdesc_chksum rtl8723b_cal_txdesc_chksum -+extern void rtl8723b_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); -+#define fill_default_txdesc rtl8723b_fill_default_txdesc -+#endif // CONFIG_RTL8723B -+ -+#if defined(CONFIG_RTL8703B) -+/* extern void rtl8703b_cal_txdesc_chksum(struct tx_desc *ptxdesc); */ -+#define cal_txdesc_chksum rtl8703b_cal_txdesc_chksum -+/* extern void rtl8703b_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); */ -+#define fill_default_txdesc rtl8703b_fill_default_txdesc -+#endif /* CONFIG_RTL8703B */ -+ -+#if defined(CONFIG_RTL8192E) -+extern void rtl8192e_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+#define cal_txdesc_chksum rtl8192e_cal_txdesc_chksum -+#ifdef CONFIG_SDIO_HCI || defined(CONFIG_GSPI_HCI) -+extern void rtl8192es_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); -+#define fill_default_txdesc rtl8192es_fill_default_txdesc -+#endif // CONFIG_SDIO_HCI -+#endif //CONFIG_RTL8192E -+ +static s32 initLoopback(PADAPTER padapter) +{ + PLOOPBACKDATA ploopback; @@ -363066,7 +172860,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if (ploopback == NULL) return -ENOMEM; + + _rtw_init_sema(&ploopback->sema, 0); -+ ploopback->bstop = _TRUE; ++ ploopback->bstop = true; + ploopback->cnt = 0; + ploopback->size = 300; + _rtw_memset(ploopback->msg, 0, sizeof(ploopback->msg)); @@ -363096,9 +172890,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + networkType = Ndis802_11IBSS; + err = rtw_set_802_11_infrastructure_mode(padapter, networkType); -+ if (err == _FALSE) return _FAIL; ++ if (err == false) return _FAIL; + -+ err = rtw_setopmode_cmd(padapter, networkType,_TRUE); ++ err = rtw_setopmode_cmd(padapter, networkType); + if (err == _FAIL) return _FAIL; + + return _SUCCESS; @@ -363120,7 +172914,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + authmode = Ndis802_11AuthModeOpen; + err = rtw_set_802_11_authentication_mode(padapter, authmode); -+ if (err == _FALSE) return _FAIL; ++ if (err == false) return _FAIL; + + passoc_ssid = &pmlmepriv->assoc_ssid; + _rtw_memset(passoc_ssid, 0, sizeof(NDIS_802_11_SSID)); @@ -363139,7 +172933,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + _exit_critical_bh(&pmlmepriv->lock, &irqL); + +#if 0 -+ err = rtw_create_ibss_cmd(padapter, 0); ++ err = rtw_createbss_cmd(padapter); + if (err == _FAIL) return _FAIL; +#else +{ @@ -363162,9 +172956,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + _rtw_memcpy(&pcur_network->network, pdev_network, get_WLAN_BSSID_EX_sz(pdev_network)); + + // set msr to WIFI_FW_ADHOC_STATE -+#if 0 -+ Set_NETYPE0_MSR(padapter, WIFI_FW_ADHOC_STATE); -+#else + { + u8 val8; + @@ -363173,7 +172964,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + val8 |= WIFI_FW_ADHOC_STATE & 0x3; + rtw_write8(padapter, MSR, val8); + } -+#endif +} +#endif + @@ -363223,7 +173013,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + _rtw_memset(pattrib, 0, sizeof(struct pkt_attrib)); + + pattrib->ether_type = 0x8723; -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); ++ _rtw_memcpy(pattrib->src, padapter->eeprompriv.mac_addr, ETH_ALEN); + _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); + _rtw_memset(pattrib->dst, 0xFF, ETH_ALEN); + _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); @@ -363239,8 +173029,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +// do_queue_select(padapter, pattrib); + pattrib->nr_frags = 1; + pattrib->encrypt = 0; -+ pattrib->bswenc = _FALSE; -+ pattrib->qos_en = _FALSE; ++ pattrib->bswenc = false; ++ pattrib->qos_en = false; + + bmcast = IS_MCAST(pattrib->ra); + if (bmcast) { @@ -363275,16 +173065,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + desc->txdw5 = cpu_to_le32(desc->txdw5); + desc->txdw6 = cpu_to_le32(desc->txdw6); + desc->txdw7 = cpu_to_le32(desc->txdw7); -+#ifdef CONFIG_PCI_HCI -+ desc->txdw8 = cpu_to_le32(desc->txdw8); -+ desc->txdw9 = cpu_to_le32(desc->txdw9); -+ desc->txdw10 = cpu_to_le32(desc->txdw10); -+ desc->txdw11 = cpu_to_le32(desc->txdw11); -+ desc->txdw12 = cpu_to_le32(desc->txdw12); -+ desc->txdw13 = cpu_to_le32(desc->txdw13); -+ desc->txdw14 = cpu_to_le32(desc->txdw14); -+ desc->txdw15 = cpu_to_le32(desc->txdw15); -+#endif + + cal_txdesc_chksum(desc); + @@ -363335,15 +173115,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + if (i < len) + { -+#ifdef CONFIG_BIG_ENDIAN ++#ifdef __BIG_ENDIAN + for (; i < len, i++) + printk("%02X", pbuf+i); -+#else // CONFIG_LITTLE_ENDIAN -+#if 0 -+ val = 0; -+ _rtw_memcpy(&val, pbuf + i, len - i); -+ printk("%8X", val); -+#else ++#else // __LITTLE_ENDIAN + u8 str[9]; + u8 n; + val = 0; @@ -363352,8 +173127,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + sprintf(str, "%08X", val); + n = (4 - n) * 2; + printk("%8s", str+n); -+#endif -+#endif // CONFIG_LITTLE_ENDIAN ++#endif // __LITTLE_ENDIAN + } + printk("\n"); +} @@ -363367,7 +173141,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + u32 drvinfosize; + u32 rxpktsize; + u8 fcssize; -+ u8 ret = _FALSE; ++ u8 ret = false; + + prxstat = (struct recv_stat*)rxbuf; + report.rxdw0 = le32_to_cpu(prxstat->rxdw0); @@ -363388,17 +173162,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + if ((txsz - TXDESC_SIZE) != (rxpktsize - fcssize)) { + DBG_8192C("%s: ERROR! size not match tx/rx=%d/%d !\n", + __func__, txsz - TXDESC_SIZE, rxpktsize - fcssize); -+ ret = _FALSE; ++ ret = false; + } else { + ret = _rtw_memcmp(txbuf + TXDESC_SIZE,\ + rxbuf + RXDESC_SIZE + drvinfosize,\ + txsz - TXDESC_SIZE); -+ if (ret == _FALSE) { ++ if (ret == false) { + DBG_8192C("%s: ERROR! pkt content mismatch!\n", __func__); + } + } + -+ if (ret == _FALSE) ++ if (ret == false) + { + DBG_8192C("\n%s: TX PKT total=%d, desc=%d, content=%d\n", + __func__, txsz, TXDESC_SIZE, txsz - TXDESC_SIZE); @@ -363453,7 +173227,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + pktsize = (pktsize % 1535) + 1; // 1~1535 + } else + pktsize = ploopback->size; -+ ++ + pxmitframe = createloopbackpkt(padapter, pktsize); + if (pxmitframe == NULL) { + sprintf(ploopback->msg, "loopback FAIL! 3. create Packet FAIL!"); @@ -363472,7 +173246,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + _rtw_down_sema(&ploopback->sema); + + err = pktcmp(padapter, ploopback->txbuf, ploopback->txsize, ploopback->rxbuf, ploopback->rxsize); -+ if (err == _TRUE) ++ if (err == true) + ok++; + else + fail++; @@ -363489,7 +173263,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + flush_signals(current); + } + -+ if ((ploopback->bstop == _TRUE) || ++ if ((ploopback->bstop == true) || + ((ploopback->cnt != 0) && (ploopback->cnt == cnt))) + { + u32 ok_rate, fail_rate, all; @@ -363503,7 +173277,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + } while (1); + -+ ploopback->bstop = _TRUE; ++ ploopback->bstop = true; + + thread_exit(); +} @@ -363519,8 +173293,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + if (ploopback) + { -+ if (ploopback->bstop == _FALSE) { -+ ploopback->bstop = _TRUE; ++ if (ploopback->bstop == false) { ++ ploopback->bstop = true; + _rtw_up_sema(&ploopback->sema); + } + len = 0; @@ -363535,9 +173309,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + return; + } + -+ // disable dynamic algorithm -+ rtw_phydm_ability_backup(padapter); -+ rtw_phydm_func_disable_all(padapter); ++ // disable dynamic algorithm ++ { ++ u32 DMFlag = DYNAMIC_FUNC_DISABLE; ++ rtw_hal_get_hwreg(padapter, HW_VAR_DM_FLAG, (u8*)&DMFlag); ++ } + + // create pseudo ad-hoc connection + err = initpseudoadhoc(padapter); @@ -363560,7 +173336,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + ploopback = padapter->ploopback; + -+ ploopback->bstop = _FALSE; ++ ploopback->bstop = false; + ploopback->cnt = cnt; + ploopback->size = size; + ploopback->lbkthread = kthread_run(lbk_thread, padapter, "RTW_LBK_THREAD"); @@ -363645,55 +173421,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } +#endif + -+ -+#ifdef CONFIG_BT_COEXIST -+ if (strcmp(pch, "bton") == 0) -+ { -+ rtw_btcoex_SetManualControl(padapter, _FALSE); -+ } -+ else if (strcmp(pch, "btoff") == 0) -+ { -+ rtw_btcoex_SetManualControl(padapter, _TRUE); -+ } -+ else if (strcmp(pch, "h2c") == 0) -+ { -+ u8 param[8]; -+ u8 count = 0; -+ u32 tmp; -+ u8 i; -+ u32 pos; -+ s32 ret; -+ -+ -+ do { -+ pch = strsep(&ptmp, delim); -+ if ((pch == NULL) || (strlen(pch) == 0)) -+ break; -+ -+ sscanf(pch, "%x", &tmp); -+ param[count++] = (u8)tmp; -+ } while (count < 8); -+ -+ if (count == 0) { -+ rtw_mfree(pbuf, len); -+ DBG_871X("%s: parameter error(level 2)!\n", __func__); -+ return -EFAULT; -+ } -+ -+ ret = rtw_hal_fill_h2c_cmd(padapter, param[0], count-1, ¶m[1]); -+ -+ pos = sprintf(extra, "H2C ID=0x%02x content=", param[0]); -+ for (i=1; idata.length = strlen(extra) + 1; -+ } -+#endif // CONFIG_BT_COEXIST -+ + rtw_mfree(pbuf, len); + return 0; +} @@ -363756,8 +173483,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + NULL, /* SIOCGIWENCODEEXT */ + rtw_wx_set_pmkid, /* SIOCSIWPMKSA */ + NULL, /*---hole---*/ -+}; -+ ++}; + +static const struct iw_priv_args rtw_private_args[] = { + { @@ -363787,7 +173513,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + SIOCIWFIRSTPRIV + 0x6, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_start" + }, -+//for PLATFORM_MT53XX + { + SIOCIWFIRSTPRIV + 0x7, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "get_sensitivity" @@ -363801,7 +173526,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_assoc_req_ie" + }, + -+//for RTK_DMP_PLATFORM + { + SIOCIWFIRSTPRIV + 0xA, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "channel_plan" @@ -363810,7 +173534,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + SIOCIWFIRSTPRIV + 0xB, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "dbg" -+ }, ++ }, + { + SIOCIWFIRSTPRIV + 0xC, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 3, 0, "rfw" @@ -363819,14 +173543,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + SIOCIWFIRSTPRIV + 0xD, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ, "rfr" + }, -+#if 0 -+ { -+ SIOCIWFIRSTPRIV + 0xE,0,0, "wowlan_ctrl" -+ }, -+#endif + { + SIOCIWFIRSTPRIV + 0x10, -+ IW_PRIV_TYPE_CHAR | 1024, 0, "p2p_set" ++ IW_PRIV_TYPE_CHAR | P2P_PRIVATE_IOCTL_SET_LEN, 0, "p2p_set" + }, + { + SIOCIWFIRSTPRIV + 0x11, @@ -363838,28 +173557,24 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { + SIOCIWFIRSTPRIV + 0x13, + IW_PRIV_TYPE_CHAR | 64, IW_PRIV_TYPE_CHAR | 64 , "p2p_get2" -+ }, ++ }, + { + SIOCIWFIRSTPRIV + 0x14, + IW_PRIV_TYPE_CHAR | 64, 0, "tdls" + }, + { + SIOCIWFIRSTPRIV + 0x15, -+ IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | 1024 , "tdls_get" -+ }, ++ IW_PRIV_TYPE_CHAR | P2P_PRIVATE_IOCTL_SET_LEN, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | P2P_PRIVATE_IOCTL_SET_LEN , "tdls_get" ++ }, + { + SIOCIWFIRSTPRIV + 0x16, + IW_PRIV_TYPE_CHAR | 64, 0, "pm_set" + }, + + {SIOCIWFIRSTPRIV + 0x18, IW_PRIV_TYPE_CHAR | IFNAMSIZ , 0 , "rereg_nd_name"}, -+#ifdef CONFIG_MP_INCLUDED -+ {SIOCIWFIRSTPRIV + 0x1A, IW_PRIV_TYPE_CHAR | 1024, 0, "NULL"}, -+ {SIOCIWFIRSTPRIV + 0x1B, IW_PRIV_TYPE_CHAR | 128, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "NULL"}, -+#else ++ + {SIOCIWFIRSTPRIV + 0x1A, IW_PRIV_TYPE_CHAR | 1024, 0, "efuse_set"}, + {SIOCIWFIRSTPRIV + 0x1B, IW_PRIV_TYPE_CHAR | 128, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_get"}, -+#endif + { + SIOCIWFIRSTPRIV + 0x1D, + IW_PRIV_TYPE_CHAR | 40, IW_PRIV_TYPE_CHAR | 0x7FF, "test" @@ -363868,7 +173583,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#ifdef CONFIG_INTEL_WIDI + { + SIOCIWFIRSTPRIV + 0x1E, -+ IW_PRIV_TYPE_CHAR | 1024, 0, "widi_set" ++ IW_PRIV_TYPE_CHAR | 64, 0, "widi_set" + }, + { + SIOCIWFIRSTPRIV + 0x1F, @@ -363877,9 +173592,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#endif // CONFIG_INTEL_WIDI + +#ifdef CONFIG_MP_INCLUDED -+ { SIOCIWFIRSTPRIV + 0x0E, IW_PRIV_TYPE_CHAR | 1024, 0 , ""}, //set ++ { SIOCIWFIRSTPRIV + 0x0E, IW_PRIV_TYPE_CHAR | 1024, 0 , ""}, //set + { SIOCIWFIRSTPRIV + 0x0F, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , ""},//get -+/* --- sub-ioctls definitions --- */ ++/* --- sub-ioctls definitions --- */ + { MP_START , IW_PRIV_TYPE_CHAR | 1024, 0, "mp_start" }, //set + { MP_PHYPARA, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_phypara" },//get + { MP_STOP , IW_PRIV_TYPE_CHAR | 1024, 0, "mp_stop" }, //set @@ -363891,7 +173606,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { READ_REG , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "read_reg" }, + { MP_RATE , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rate" }, + { READ_RF , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "read_rf" }, -+ { MP_PSD , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_psd"}, ++ { MP_PSD , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_psd"}, + { MP_DUMP, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_dump" }, + { MP_TXPOWER , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_txpower"}, + { MP_ANT_TX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ant_tx"}, @@ -363905,36 +173620,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + { EFUSE_GET, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_get" }, + { MP_PWRTRK , IW_PRIV_TYPE_CHAR | 1024, 0, "mp_pwrtrk"}, + { MP_QueryDrvStats, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_drvquery" }, -+ { MP_IOCTL, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_ioctl"}, // mp_ioctl -+ { MP_SetRFPathSwh, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_setrfpath" }, -+ { MP_PwrCtlDM, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_pwrctldm" }, ++ { MP_IOCTL, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_ioctl"}, // mp_ioctl ++ { MP_SetRFPathSwh, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_setrfpath" }, + { MP_GET_TXPOWER_INX, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_get_txpower" }, -+ { MP_GETVER, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_priv_ver" }, -+ { MP_MON, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_mon" }, -+ { EFUSE_MASK, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_mask" }, -+ { EFUSE_FILE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_file" }, -+ { MP_TX, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_tx" }, -+ { MP_RX, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rx" }, -+#if defined(CONFIG_RTL8723B) -+ { MP_SetBT, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_setbt" }, -+ { MP_DISABLE_BT_COEXIST, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_disa_btcoex"}, -+#endif + { CTA_TEST, IW_PRIV_TYPE_CHAR | 1024, 0, "cta_test"}, -+#endif -+#ifdef CONFIG_WOWLAN -+ { MP_WOW_ENABLE , IW_PRIV_TYPE_CHAR | 1024, 0, "wow_mode" }, -+ { MP_WOW_SET_PATTERN , IW_PRIV_TYPE_CHAR | 1024, 0, "wow_set_pattern" }, -+#endif -+#ifdef CONFIG_AP_WOWLAN -+ { MP_AP_WOW_ENABLE , IW_PRIV_TYPE_CHAR | 1024, 0, "ap_wow_mode" }, //set -+#endif -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ { MP_SD_IREAD, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "sd_iread" }, -+ { MP_SD_IWRITE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "sd_iwrite" }, -+#endif +}; + -+static iw_handler rtw_private_handler[] = ++static iw_handler rtw_private_handler[] = +{ + rtw_wx_write32, //0x00 + rtw_wx_read32, //0x01 @@ -363947,24 +173639,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + rtw_set_pid, //0x05 + rtw_wps_start, //0x06 + -+// for PLATFORM_MT53XX + rtw_wx_get_sensitivity, //0x07 + rtw_wx_set_mtk_wps_probe_ie, //0x08 + rtw_wx_set_mtk_wps_ie, //0x09 + -+// for RTK_DMP_PLATFORM +// Set Channel depend on the country code + rtw_wx_set_channel_plan, //0x0A + + rtw_dbg_port, //0x0B + rtw_wx_write_rf, //0x0C + rtw_wx_read_rf, //0x0D -+#ifdef CONFIG_MP_INCLUDED -+ rtw_mp_set, //0x0E -+ rtw_mp_get, //0x0F -+#else ++ ++#ifndef CONFIG_MP_INCLUDED + rtw_wx_priv_null, //0x0E + rtw_wx_priv_null, //0x0F ++#else ++ rtw_mp_set, //0x0E ++ rtw_mp_get, //0x0F +#endif + rtw_p2p_set, //0x10 + rtw_p2p_get, //0x11 @@ -363978,13 +173669,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + rtw_wx_priv_null, //0x17 + rtw_rereg_nd_name, //0x18 + rtw_wx_priv_null, //0x19 -+#ifdef CONFIG_MP_INCLUDED -+ rtw_wx_priv_null, //0x1A -+ rtw_wx_priv_null, //0x1B -+#else ++ + rtw_mp_efuse_set, //0x1A + rtw_mp_efuse_get, //0x1B -+#endif + NULL, // 0x1C is reserved for hostapd + rtw_test, // 0x1D +#ifdef CONFIG_INTEL_WIDI @@ -363993,8 +173680,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#endif // CONFIG_INTEL_WIDI +}; + ++#endif // #if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_MP_IWPRIV_SUPPORT) + -+#if WIRELESS_EXT >= 17 ++#if WIRELESS_EXT >= 17 +static struct iw_statistics *rtw_get_wireless_stats(struct net_device *dev) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); @@ -364003,7 +173691,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + int tmp_qual = 0; + int tmp_noise = 0; + -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) != _TRUE) ++ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) != true) + { + piwstats->qual.qual = 0; + piwstats->qual.level = 0; @@ -364012,24 +173700,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + } + else{ + #ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ tmp_level = translate_percentage_to_dbm(padapter->recvpriv.signal_strength); ++ tmp_level = translate_percentage_to_dbm(padapter->recvpriv.signal_strength); + #else -+ #ifdef CONFIG_SIGNAL_SCALE_MAPPING + tmp_level = padapter->recvpriv.signal_strength; -+ #else ++ #ifdef CONFIG_BT_COEXIST + { -+ /* Do signal scale mapping when using percentage as the unit of signal strength, since the scale mapping is skipped in odm */ -+ -+ HAL_DATA_TYPE *pHal = GET_HAL_DATA(padapter); -+ -+ tmp_level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, padapter->recvpriv.signal_strength); ++ u8 signal = (u8)tmp_level; ++ BT_SignalCompensation(padapter, &signal, NULL); ++ tmp_level= signal; + } ++ #endif // CONFIG_BT_COEXIST + #endif -+ #endif -+ ++ + tmp_qual = padapter->recvpriv.signal_qual; -+ rtw_get_noise(padapter); -+ tmp_noise = padapter->recvpriv.noise; ++ tmp_noise =padapter->recvpriv.noise; + //DBG_871X("level:%d, qual:%d, noise:%d, rssi (%d)\n", tmp_level, tmp_qual, tmp_noise,padapter->recvpriv.rssi); + + piwstats->qual.level = tmp_level; @@ -364039,14 +173723,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,14)) + piwstats->qual.updated = IW_QUAL_ALL_UPDATED ;//|IW_QUAL_DBM; +#else -+#ifdef RTK_DMP_PLATFORM -+ //IW_QUAL_DBM= 0x8, if driver use this flag, wireless extension will show value of dbm. -+ //remove this flag for show percentage 0~100 -+ piwstats->qual.updated = 0x07; -+#else + piwstats->qual.updated = 0x0f; +#endif -+#endif + + #ifdef CONFIG_SIGNAL_DISPLAY_DBM + piwstats->qual.updated = piwstats->qual.updated | IW_QUAL_DBM; @@ -364065,7 +173743,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + .private = rtw_private_handler, + .private_args = (struct iw_priv_args *)rtw_private_args, + .num_private = sizeof(rtw_private_handler) / sizeof(iw_handler), -+ .num_private_args = sizeof(rtw_private_args) / sizeof(struct iw_priv_args), ++ .num_private_args = sizeof(rtw_private_args) / sizeof(struct iw_priv_args), +#endif +#if WIRELESS_EXT >= 17 + .get_wireless_stats = rtw_get_wireless_stats, @@ -364098,8 +173776,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart +} +// copy from net/wireless/wext.c end + -+ -+static int _rtw_ioctl_wext_private(struct net_device *dev, union iwreq_data *wrq_data) ++static int rtw_ioctl_wext_private(struct net_device *dev, union iwreq_data *wrq_data) +{ + int err = 0; + u8 *input = NULL; @@ -364129,29 +173806,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + union iwreq_data wdata; + ++ + _rtw_memcpy(&wdata, wrq_data, sizeof(wdata)); + + input_len = wdata.data.length; + input = rtw_zmalloc(input_len); -+ if (NULL == input || input_len == 0) ++ if (NULL == input) + return -ENOMEM; + if (copy_from_user(input, wdata.data.pointer, input_len)) { + err = -EFAULT; + goto exit; + } -+ input[input_len - 1] = '\0'; + ptr = input; + len = input_len; ++ + sscanf(ptr, "%16s", cmdname); + cmdlen = strlen(cmdname); -+ DBG_871X("%s: cmd=%s\n", __func__, cmdname); ++ DBG_8192C("%s: cmd=%s\n", __func__, cmdname); + + // skip command string + if (cmdlen > 0) + cmdlen += 1; // skip one space + ptr += cmdlen; + len -= cmdlen; -+ DBG_871X("%s: parameters=%s\n", __func__, ptr); ++ DBG_8192C("%s: parameters=%s\n", __func__, ptr); + + priv = rtw_private_handler; + priv_args = rtw_private_args; @@ -364437,65 +174115,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + return err; +} + -+#ifdef CONFIG_COMPAT -+static int rtw_ioctl_compat_wext_private(struct net_device *dev, struct ifreq *rq) -+{ -+ struct compat_iw_point iwp_compat; -+ union iwreq_data wrq_data; -+ int err = 0; -+ DBG_871X("%s:...\n", __func__); -+ if (copy_from_user(&iwp_compat, rq->ifr_ifru.ifru_data, sizeof(struct compat_iw_point))) -+ return -EFAULT; -+ -+ wrq_data.data.pointer = compat_ptr(iwp_compat.pointer); -+ wrq_data.data.length = iwp_compat.length; -+ wrq_data.data.flags = iwp_compat.flags; -+ -+ err = _rtw_ioctl_wext_private(dev, &wrq_data); -+ -+ iwp_compat.pointer = ptr_to_compat(wrq_data.data.pointer); -+ iwp_compat.length = wrq_data.data.length; -+ iwp_compat.flags = wrq_data.data.flags; -+ if (copy_to_user(rq->ifr_ifru.ifru_data, &iwp_compat, sizeof(struct compat_iw_point))) -+ return -EFAULT; -+ -+ return err; -+} -+#endif // CONFIG_COMPAT -+ -+static int rtw_ioctl_standard_wext_private(struct net_device *dev, struct ifreq *rq) -+{ -+ struct iw_point *iwp; -+ struct ifreq ifrq; -+ union iwreq_data wrq_data; -+ int err = 0; -+ iwp = &wrq_data.data; -+ DBG_871X("%s:...\n", __func__); -+ if (copy_from_user(iwp, rq->ifr_ifru.ifru_data, sizeof(struct iw_point))) -+ return -EFAULT; -+ -+ err = _rtw_ioctl_wext_private(dev, &wrq_data); -+ -+ if (copy_to_user(rq->ifr_ifru.ifru_data, iwp, sizeof(struct iw_point))) -+ return -EFAULT; -+ -+ return err; -+} -+ -+static int rtw_ioctl_wext_private(struct net_device *dev, struct ifreq *rq) -+{ -+#ifdef CONFIG_COMPAT -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4,6,0)) -+ if(is_compat_task()) -+#else -+ if(in_compat_syscall()) -+#endif -+ return rtw_ioctl_compat_wext_private( dev, rq ); -+ else -+#endif // CONFIG_COMPAT -+ return rtw_ioctl_standard_wext_private( dev, rq ); -+} -+ +int rtw_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) +{ + struct iwreq *wrq = (struct iwreq *)rq; @@ -364510,14 +174129,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + case RTL_IOCTL_HOSTAPD: + ret = rtw_hostapd_ioctl(dev, &wrq->u.data); + break; -+#ifdef CONFIG_WIRELESS_EXT ++#ifdef CONFIG_NO_WIRELESS_HANDLERS + case SIOCSIWMODE: + ret = rtw_wx_set_mode(dev, NULL, &wrq->u, NULL); + break; +#endif +#endif // CONFIG_AP_MODE -+ case SIOCDEVPRIVATE: -+ ret = rtw_ioctl_wext_private(dev, rq); ++ case SIOCDEVPRIVATE: ++ ret = rtw_ioctl_wext_private(dev, &wrq->u); + break; + case (SIOCDEVPRIVATE+1): + ret = rtw_android_priv_cmd(dev, rq, cmd); @@ -364529,2167 +174148,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_linux.c linux/3rdpart + + return ret; +} -+ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_mp.c linux/3rdparty/rtl8812au/os_dep/linux/ioctl_mp.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/ioctl_mp.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/ioctl_mp.c 2017-06-07 23:07:21.046690765 +0300 -@@ -0,0 +1,2147 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#if defined(CONFIG_MP_INCLUDED) -+ -+#include -+#include -+#include -+#include "../../hal/phydm/phydm_precomp.h" -+ -+ -+#if defined(CONFIG_RTL8723B) -+#include -+#endif -+ -+/* -+ * Input Format: %s,%d,%d -+ * %s is width, could be -+ * "b" for 1 byte -+ * "w" for WORD (2 bytes) -+ * "dw" for DWORD (4 bytes) -+ * 1st %d is address(offset) -+ * 2st %d is data to write -+ */ -+int rtw_mp_write_reg(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ char *pch, *pnext, *ptmp; -+ char *width_str; -+ char width, buf[5]; -+ u32 addr, data; -+ int ret; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[wrqu->length]; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ pch = input; -+ -+ pnext = strpbrk(pch, " ,.-"); -+ if (pnext == NULL) -+ return -EINVAL; -+ *pnext = 0; -+ width_str = pch; -+ -+ pch = pnext + 1; -+ pnext = strpbrk(pch, " ,.-"); -+ if (pnext == NULL) -+ return -EINVAL; -+ *pnext = 0; -+ /*addr = simple_strtoul(pch, &ptmp, 16); -+ _rtw_memset(buf, '\0', sizeof(buf)); -+ _rtw_memcpy(buf, pch, pnext-pch); -+ ret = kstrtoul(buf, 16, &addr);*/ -+ ret = sscanf(pch, "%x", &addr); -+ if (addr > 0x3FFF) -+ return -EINVAL; -+ -+ pch = pnext + 1; -+ pnext = strpbrk(pch, " ,.-"); -+ if ((pch - input) >= wrqu->length) -+ return -EINVAL; -+ /*data = simple_strtoul(pch, &ptmp, 16);*/ -+ ret = sscanf(pch, "%x", &data); -+ DBG_871X("data=%x,addr=%x\n", (u32)data, (u32)addr); -+ ret = 0; -+ width = width_str[0]; -+ switch (width) { -+ case 'b': -+ /* 1 byte*/ -+ if (data > 0xFF) { -+ ret = -EINVAL; -+ break; -+ } -+ rtw_write8(padapter, addr, data); -+ break; -+ case 'w': -+ /* 2 bytes*/ -+ if (data > 0xFFFF) { -+ ret = -EINVAL; -+ break; -+ } -+ rtw_write16(padapter, addr, data); -+ break; -+ case 'd': -+ /* 4 bytes*/ -+ rtw_write32(padapter, addr, data); -+ break; -+ default: -+ ret = -EINVAL; -+ break; -+ } -+ -+ return ret; -+} -+ -+ -+/* -+ * Input Format: %s,%d -+ * %s is width, could be -+ * "b" for 1 byte -+ * "w" for WORD (2 bytes) -+ * "dw" for DWORD (4 bytes) -+ * %d is address(offset) -+ * -+ * Return: -+ * %d for data readed -+ */ -+int rtw_mp_read_reg(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ char input[wrqu->length]; -+ char *pch, *pnext, *ptmp; -+ char *width_str; -+ char width; -+ char data[20], tmp[20], buf[3]; -+ u32 addr = 0, strtout = 0; -+ u32 i = 0, j = 0, ret = 0, data32 = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ -+ if (wrqu->length > 128) -+ return -EFAULT; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ _rtw_memset(data, '\0', sizeof(data)); -+ _rtw_memset(tmp, '\0', sizeof(tmp)); -+ pch = input; -+ pnext = strpbrk(pch, " ,.-"); -+ if (pnext == NULL) -+ return -EINVAL; -+ *pnext = 0; -+ width_str = pch; -+ -+ pch = pnext + 1; -+ -+ ret = sscanf(pch, "%x", &addr); -+ if (addr > 0x3FFF) -+ return -EINVAL; -+ -+ ret = 0; -+ width = width_str[0]; -+ -+ switch (width) { -+ case 'b': -+ data32 = rtw_read8(padapter, addr); -+ DBG_871X("%x\n", data32); -+ sprintf(extra, "%d", data32); -+ wrqu->length = strlen(extra); -+ break; -+ case 'w': -+ /* 2 bytes*/ -+ sprintf(data, "%04x\n", rtw_read16(padapter, addr)); -+ -+ for (i = 0 ; i <= strlen(data) ; i++) { -+ if (i % 2 == 0) { -+ tmp[j] = ' '; -+ j++; -+ } -+ if (data[i] != '\0') -+ tmp[j] = data[i]; -+ -+ j++; -+ } -+ pch = tmp; -+ DBG_871X("pch=%s", pch); -+ -+ while (*pch != '\0') { -+ pnext = strpbrk(pch, " "); -+ if (!pnext || ((pnext - tmp) > 4)) -+ break; -+ -+ pnext++; -+ if (*pnext != '\0') { -+ /*strtout = simple_strtoul(pnext , &ptmp, 16);*/ -+ ret = sscanf(pnext, "%x", &strtout); -+ sprintf(extra, "%s %d" , extra , strtout); -+ } else -+ break; -+ pch = pnext; -+ } -+ wrqu->length = strlen(extra); -+ break; -+ case 'd': -+ /* 4 bytes */ -+ sprintf(data, "%08x", rtw_read32(padapter, addr)); -+ /*add read data format blank*/ -+ for (i = 0 ; i <= strlen(data) ; i++) { -+ if (i % 2 == 0) { -+ tmp[j] = ' '; -+ j++; -+ } -+ if (data[i] != '\0') -+ tmp[j] = data[i]; -+ -+ j++; -+ } -+ pch = tmp; -+ DBG_871X("pch=%s", pch); -+ -+ while (*pch != '\0') { -+ pnext = strpbrk(pch, " "); -+ if (!pnext) -+ break; -+ -+ pnext++; -+ if (*pnext != '\0') { -+ ret = sscanf(pnext, "%x", &strtout); -+ sprintf(extra, "%s %d" , extra , strtout); -+ } else -+ break; -+ pch = pnext; -+ } -+ wrqu->length = strlen(extra); -+ break; -+ -+ default: -+ wrqu->length = 0; -+ ret = -EINVAL; -+ break; -+ } -+ -+ return ret; -+} -+ -+ -+/* -+ * Input Format: %d,%x,%x -+ * %d is RF path, should be smaller than MAX_RF_PATH_NUMS -+ * 1st %x is address(offset) -+ * 2st %x is data to write -+ */ -+int rtw_mp_write_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ -+ u32 path, addr, data; -+ int ret; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[wrqu->length]; -+ -+ -+ _rtw_memset(input, 0, wrqu->length); -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ -+ ret = sscanf(input, "%d,%x,%x", &path, &addr, &data); -+ if (ret < 3) -+ return -EINVAL; -+ -+ if (path >= GET_HAL_RFPATH_NUM(padapter)) -+ return -EINVAL; -+ if (addr > 0xFF) -+ return -EINVAL; -+ if (data > 0xFFFFF) -+ return -EINVAL; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ write_rfreg(padapter, path, addr, data); -+ -+ sprintf(extra, "write_rf completed\n"); -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+/* -+ * Input Format: %d,%x -+ * %d is RF path, should be smaller than MAX_RF_PATH_NUMS -+ * %x is address(offset) -+ * -+ * Return: -+ * %d for data readed -+ */ -+int rtw_mp_read_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ char input[wrqu->length]; -+ char *pch, *pnext, *ptmp; -+ char data[20], tmp[20], buf[3]; -+ u32 path, addr, strtou; -+ u32 ret, i = 0 , j = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if (wrqu->length > 128) -+ return -EFAULT; -+ _rtw_memset(input, 0, wrqu->length); -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ ret = sscanf(input, "%d,%x", &path, &addr); -+ if (ret < 2) -+ return -EINVAL; -+ -+ if (path >= GET_HAL_RFPATH_NUM(padapter)) -+ return -EINVAL; -+ if (addr > 0xFF) -+ return -EINVAL; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ sprintf(data, "%08x", read_rfreg(padapter, path, addr)); -+ /*add read data format blank*/ -+ for (i = 0 ; i <= strlen(data) ; i++) { -+ if (i % 2 == 0) { -+ tmp[j] = ' '; -+ j++; -+ } -+ tmp[j] = data[i]; -+ j++; -+ } -+ pch = tmp; -+ DBG_871X("pch=%s", pch); -+ -+ while (*pch != '\0') { -+ pnext = strpbrk(pch, " "); -+ if (!pnext) -+ break; -+ pnext++; -+ if (*pnext != '\0') { -+ /*strtou =simple_strtoul(pnext , &ptmp, 16);*/ -+ ret = sscanf(pnext, "%x", &strtou); -+ sprintf(extra, "%s %d" , extra , strtou); -+ } else -+ break; -+ pch = pnext; -+ } -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+int rtw_mp_start(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 val8; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ LeaveAllPowerSaveMode(padapter); -+ -+ if (padapter->registrypriv.mp_mode == 0) { -+ rtw_hal_deinit(padapter); -+ padapter->registrypriv.mp_mode = 1; -+ #ifdef CONFIG_RF_GAIN_OFFSET -+ if (!IS_HARDWARE_TYPE_8814A(padapter)) -+ padapter->registrypriv.RegRfKFreeEnable = 1; -+ rtw_hal_read_chip_info(padapter); -+ #endif /*CONFIG_RF_GAIN_OFFSET*/ -+ rtw_hal_init(padapter); -+ } -+ -+ if (padapter->registrypriv.mp_mode == 0) -+ return -EPERM; -+ -+ if (padapter->mppriv.mode == MP_OFF) { -+ if (mp_start_test(padapter) == _FAIL) -+ return -EPERM; -+ padapter->mppriv.mode = MP_ON; -+ MPT_PwrCtlDM(padapter, 0); -+ } -+ padapter->mppriv.bmac_filter = _FALSE; -+#ifdef CONFIG_RTL8723B -+#ifdef CONFIG_USB_HCI -+ rtw_write32(padapter, 0x765, 0x0000); -+ rtw_write32(padapter, 0x948, 0x0280); -+#else -+ rtw_write32(padapter, 0x765, 0x0000); -+ rtw_write32(padapter, 0x948, 0x0000); -+#endif -+#ifdef CONFIG_FOR_RTL8723BS_VQ0 -+ rtw_write32(padapter, 0x765, 0x0000); -+ rtw_write32(padapter, 0x948, 0x0280); -+#endif -+ rtw_write8(padapter, 0x66, 0x27); /*Open BT uart Log*/ -+ rtw_write8(padapter, 0xc50, 0x20); /*for RX init Gain*/ -+#endif -+ ODM_Write_DIG(&pHalData->odmpriv, 0x20); -+ -+ return 0; -+} -+ -+ -+ -+int rtw_mp_stop(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ -+ if (padapter->registrypriv.mp_mode == 1) { -+ -+ MPT_DeInitAdapter(padapter); -+ pHalFunc->hal_deinit(padapter); -+ padapter->registrypriv.mp_mode = 0; -+ pHalFunc->hal_init(padapter); -+ } -+ -+ if (padapter->mppriv.mode != MP_OFF) { -+ mp_stop_test(padapter); -+ padapter->mppriv.mode = MP_OFF; -+ } -+ -+ return 0; -+} -+ -+ -+int rtw_mp_rate(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 rate = MPT_RATE_1M; -+ u8 input[wrqu->length]; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ rate = rtw_mpRateParseFunc(padapter, input); -+ -+ if (rate == 0 && strcmp(input, "1M") != 0) { -+ rate = rtw_atoi(input); -+ if (rate <= 0x7f) -+ rate = wifirate2_ratetbl_inx((u8)rate); -+ else if (rate < 0xC8) -+ rate = (rate - 0x80 + MPT_RATE_MCS0); -+ /*HT rate 0x80(MCS0) ~ 0x8F(MCS15) ~ 0x9F(MCS31) 128~159 -+ VHT1SS~2SS rate 0xA0 (VHT1SS_MCS0 44) ~ 0xB3 (VHT2SS_MCS9 #63) 160~179 -+ VHT rate 0xB4 (VHT3SS_MCS0 64) ~ 0xC7 (VHT2SS_MCS9 #83) 180~199 -+ else -+ VHT rate 0x90(VHT1SS_MCS0) ~ 0x99(VHT1SS_MCS9) 144~153 -+ rate =(rate - MPT_RATE_VHT1SS_MCS0); -+ */ -+ } -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ sprintf(extra, "Set data rate to %s index %d" , input, rate); -+ DBG_871X("%s: %s rate index=%d\n", __func__, input, rate); -+ -+ if (rate >= MPT_RATE_LAST) -+ return -EINVAL; -+ -+ padapter->mppriv.rateidx = rate; -+ pMptCtx->MptRateIndex = rate; -+ SetDataRate(padapter); -+ -+ wrqu->length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_mp_channel(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 input[wrqu->length]; -+ u32 channel = 1; -+ int cur_ch_offset; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ channel = rtw_atoi(input); -+ /*DBG_871X("%s: channel=%d\n", __func__, channel);*/ -+ _rtw_memset(extra, 0, wrqu->length); -+ sprintf(extra, "Change channel %d to channel %d", padapter->mppriv.channel , channel); -+ padapter->mppriv.channel = channel; -+ SetChannel(padapter); -+ pHalData->CurrentChannel = channel; -+ -+ wrqu->length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_mp_bandwidth(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 bandwidth = 0, sg = 0; -+ int cur_ch_offset; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (sscanf(extra, "40M=%d,shortGI=%d", &bandwidth, &sg) > 0) -+ DBG_871X("%s: bw=%d sg=%d\n", __func__, bandwidth , sg); -+ -+ if (bandwidth == 1) -+ bandwidth = CHANNEL_WIDTH_40; -+ else if (bandwidth == 2) -+ bandwidth = CHANNEL_WIDTH_80; -+ -+ padapter->mppriv.bandwidth = (u8)bandwidth; -+ padapter->mppriv.preamble = sg; -+ -+ SetBandwidth(padapter); -+ pHalData->CurrentChannelBW = bandwidth; -+ /*cur_ch_offset = rtw_get_offset_by_ch(padapter->mppriv.channel);*/ -+ /*set_channel_bwmode(padapter, padapter->mppriv.channel, cur_ch_offset, bandwidth);*/ -+ -+ return 0; -+} -+ -+ -+int rtw_mp_txpower_index(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[wrqu->length]; -+ u32 rfpath; -+ u32 txpower_inx; -+ -+ if (wrqu->length > 128) -+ return -EFAULT; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ rfpath = rtw_atoi(input); -+ txpower_inx = mpt_ProQueryCalTxPower(padapter, rfpath); -+ sprintf(extra, " %d", txpower_inx); -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+int rtw_mp_txpower(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 idx_a = 0, idx_b = 0, idx_c = 0, idx_d = 0, status = 0; -+ int MsetPower = 1; -+ u8 input[wrqu->length]; -+ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ MsetPower = strncmp(input, "off", 3); -+ if (MsetPower == 0) { -+ padapter->mppriv.bSetTxPower = 0; -+ sprintf(extra, "MP Set power off"); -+ } else { -+ if (sscanf(input, "patha=%d,pathb=%d,pathc=%d,pathd=%d", &idx_a, &idx_b, &idx_c, &idx_d) < 3) -+ DBG_871X("Invalid format on line %s ,patha=%d,pathb=%d,pathc=%d,pathd=%d\n", input , idx_a , idx_b , idx_c , idx_d); -+ -+ sprintf(extra, "Set power level path_A:%d path_B:%d path_C:%d path_D:%d", idx_a , idx_b , idx_c , idx_d); -+ padapter->mppriv.txpoweridx = (u8)idx_a; -+ -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_A] = (u8)idx_a; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_B] = (u8)idx_b; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_C] = (u8)idx_c; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_D] = (u8)idx_d; -+ padapter->mppriv.bSetTxPower = 1; -+ -+ SetTxPower(padapter); -+ } -+ -+ wrqu->length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_mp_ant_tx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 i; -+ u8 input[wrqu->length]; -+ u16 antenna = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ sprintf(extra, "switch Tx antenna to %s", input); -+ -+ for (i = 0; i < strlen(input); i++) { -+ switch (input[i]) { -+ case 'a': -+ antenna |= ANTENNA_A; -+ break; -+ case 'b': -+ antenna |= ANTENNA_B; -+ break; -+ case 'c': -+ antenna |= ANTENNA_C; -+ break; -+ case 'd': -+ antenna |= ANTENNA_D; -+ break; -+ } -+ } -+ /*antenna |= BIT(extra[i]-'a');*/ -+ DBG_871X("%s: antenna=0x%x\n", __func__, antenna); -+ padapter->mppriv.antenna_tx = antenna; -+ padapter->mppriv.antenna_rx = antenna; -+ /*DBG_871X("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_tx);*/ -+ pHalData->AntennaTxPath = antenna; -+ -+ SetAntenna(padapter); -+ -+ wrqu->length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_mp_ant_rx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 i; -+ u16 antenna = 0; -+ u8 input[wrqu->length]; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ /*DBG_871X("%s: input=%s\n", __func__, input);*/ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ sprintf(extra, "switch Rx antenna to %s", input); -+ -+ for (i = 0; i < strlen(input); i++) { -+ switch (input[i]) { -+ case 'a': -+ antenna |= ANTENNA_A; -+ break; -+ case 'b': -+ antenna |= ANTENNA_B; -+ break; -+ case 'c': -+ antenna |= ANTENNA_C; -+ break; -+ case 'd': -+ antenna |= ANTENNA_D; -+ break; -+ } -+ } -+ -+ DBG_871X("%s: antenna=0x%x\n", __func__, antenna); -+ padapter->mppriv.antenna_tx = antenna; -+ padapter->mppriv.antenna_rx = antenna; -+ pHalData->AntennaRxPath = antenna; -+ /*DBG_871X("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_rx);*/ -+ SetAntenna(padapter); -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+int rtw_set_ctx_destAddr(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ int jj, kk = 0; -+ -+ struct pkt_attrib *pattrib; -+ struct mp_priv *pmp_priv; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ pmp_priv = &padapter->mppriv; -+ pattrib = &pmp_priv->tx.attrib; -+ -+ if (strlen(extra) < 5) -+ return _FAIL; -+ -+ DBG_871X("%s: in=%s\n", __func__, extra); -+ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) -+ pattrib->dst[jj] = key_2char2num(extra[kk], extra[kk + 1]); -+ -+ DBG_871X("pattrib->dst:%x %x %x %x %x %x\n", pattrib->dst[0], pattrib->dst[1], pattrib->dst[2], pattrib->dst[3], pattrib->dst[4], pattrib->dst[5]); -+ return 0; -+} -+ -+ -+ -+int rtw_mp_ctx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 pkTx = 1; -+ int countPkTx = 1, cotuTx = 1, CarrSprTx = 1, scTx = 1, sgleTx = 1, stop = 1; -+ u32 bStartTest = 1; -+ u32 count = 0, pktinterval = 0, pktlen = 0; -+ u8 status; -+ struct mp_priv *pmp_priv; -+ struct pkt_attrib *pattrib; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ pmp_priv = &padapter->mppriv; -+ pattrib = &pmp_priv->tx.attrib; -+ -+ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ DBG_871X("%s: in=%s\n", __func__, extra); -+ -+ countPkTx = strncmp(extra, "count=", 5); /* strncmp TRUE is 0*/ -+ cotuTx = strncmp(extra, "background", 20); -+ CarrSprTx = strncmp(extra, "background,cs", 20); -+ scTx = strncmp(extra, "background,sc", 20); -+ sgleTx = strncmp(extra, "background,stone", 20); -+ pkTx = strncmp(extra, "background,pkt", 20); -+ stop = strncmp(extra, "stop", 4); -+ if (sscanf(extra, "count=%d,pkt", &count) > 0) -+ DBG_871X("count= %d\n", count); -+ if (sscanf(extra, "pktinterval=%d", &pktinterval) > 0) -+ DBG_871X("pktinterval= %d\n", pktinterval); -+ -+ if (sscanf(extra, "pktlen=%d", &pktlen) > 0) -+ DBG_871X("pktlen= %d\n", pktlen); -+ -+ if (_rtw_memcmp(extra, "destmac=", 8)) { -+ wrqu->length -= 8; -+ rtw_set_ctx_destAddr(dev, info, wrqu, &extra[8]); -+ sprintf(extra, "Set dest mac OK !\n"); -+ return 0; -+ } -+ -+ /*DBG_871X("%s: count=%d countPkTx=%d cotuTx=%d CarrSprTx=%d scTx=%d sgleTx=%d pkTx=%d stop=%d\n", __func__, count, countPkTx, cotuTx, CarrSprTx, pkTx, sgleTx, scTx, stop);*/ -+ _rtw_memset(extra, '\0', strlen(extra)); -+ -+ if (pktinterval != 0) { -+ sprintf(extra, "Pkt Interval = %d", pktinterval); -+ padapter->mppriv.pktInterval = pktinterval; -+ wrqu->length = strlen(extra); -+ return 0; -+ } -+ if (pktlen != 0) { -+ sprintf(extra, "Pkt len = %d", pktlen); -+ pattrib->pktlen = pktlen; -+ wrqu->length = strlen(extra); -+ return 0; -+ } -+ if (stop == 0) { -+ bStartTest = 0; /* To set Stop*/ -+ pmp_priv->tx.stop = 1; -+ sprintf(extra, "Stop continuous Tx"); -+ } else { -+ bStartTest = 1; -+ if (pmp_priv->mode != MP_ON) { -+ if (pmp_priv->tx.stop != 1) { -+ DBG_871X("%s: MP_MODE != ON %d\n", __func__, pmp_priv->mode); -+ return -EFAULT; -+ } -+ } -+ } -+ -+ pmp_priv->tx.count = count; -+ -+ if (pkTx == 0 || countPkTx == 0) -+ pmp_priv->mode = MP_PACKET_TX; -+ if (sgleTx == 0) -+ pmp_priv->mode = MP_SINGLE_TONE_TX; -+ if (cotuTx == 0) -+ pmp_priv->mode = MP_CONTINUOUS_TX; -+ if (CarrSprTx == 0) -+ pmp_priv->mode = MP_CARRIER_SUPPRISSION_TX; -+ if (scTx == 0) -+ pmp_priv->mode = MP_SINGLE_CARRIER_TX; -+ -+ status = rtw_mp_pretx_proc(padapter, bStartTest, extra); -+ -+ wrqu->length = strlen(extra); -+ return status; -+} -+ -+ -+ -+int rtw_mp_disable_bt_coexist(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ -+ u8 input[wrqu->data.length]; -+ u32 bt_coexist; -+ -+ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ bt_coexist = rtw_atoi(input); -+ -+ if (bt_coexist == 0) { -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("Set OID_RT_SET_DISABLE_BT_COEXIST: disable BT_COEXIST\n")); -+ DBG_871X("Set OID_RT_SET_DISABLE_BT_COEXIST: disable BT_COEXIST\n"); -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_HaltNotify(padapter); -+ rtw_btcoex_SetManualControl(padapter, _TRUE); -+ /* Force to switch Antenna to WiFi*/ -+ rtw_write16(padapter, 0x870, 0x300); -+ rtw_write16(padapter, 0x860, 0x110); -+#endif -+ /* CONFIG_BT_COEXIST */ -+ } else { -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("Set OID_RT_SET_DISABLE_BT_COEXIST: enable BT_COEXIST\n")); -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SetManualControl(padapter, _FALSE); -+#endif -+ } -+ -+ return 0; -+} -+ -+ -+int rtw_mp_arx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ int bStartRx = 0, bStopRx = 0, bQueryPhy = 0, bQueryMac = 0, bSetBssid = 0; -+ int bmac_filter = 0, bfilter_init = 0, bmon = 0, bSmpCfg = 0; -+ u8 input[wrqu->length]; -+ char *pch, *ptmp, *token, *tmp[2] = {0x00, 0x00}; -+ u32 i = 0, ii = 0, jj = 0, kk = 0, cnts = 0, ret; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ struct dbg_rx_counter rx_counter; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ DBG_871X("%s: %s\n", __func__, input); -+ -+ bStartRx = (strncmp(input, "start", 5) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ bStopRx = (strncmp(input, "stop", 5) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ bQueryPhy = (strncmp(input, "phy", 3) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ bQueryMac = (strncmp(input, "mac", 3) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ bSetBssid = (strncmp(input, "setbssid=", 8) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ /*bfilter_init = (strncmp(input, "filter_init",11)==0)?1:0;*/ -+ bmac_filter = (strncmp(input, "accept_mac", 10) == 0) ? 1 : 0; -+ bmon = (strncmp(input, "mon=", 4) == 0) ? 1 : 0; -+ bSmpCfg = (strncmp(input , "smpcfg=" , 7) == 0) ? 1 : 0; -+ -+ if (bSetBssid == 1) { -+ pch = input; -+ while ((token = strsep(&pch, "=")) != NULL) { -+ if (i > 1) -+ break; -+ tmp[i] = token; -+ i++; -+ } -+ if ((tmp[0] != NULL) && (tmp[1] != NULL)) { -+ cnts = strlen(tmp[1]) / 2; -+ if (cnts < 1) -+ return -EFAULT; -+ DBG_871X("%s: cnts=%d\n", __func__, cnts); -+ DBG_871X("%s: data=%s\n", __func__, tmp[1]); -+ for (jj = 0, kk = 0; jj < cnts ; jj++, kk += 2) { -+ pmppriv->network_macaddr[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); -+ DBG_871X("network_macaddr[%d]=%x\n", jj, pmppriv->network_macaddr[jj]); -+ } -+ } else -+ return -EFAULT; -+ -+ pmppriv->bSetRxBssid = _TRUE; -+ } -+ -+ if (bmac_filter) { -+ pmppriv->bmac_filter = bmac_filter; -+ pch = input; -+ while ((token = strsep(&pch, "=")) != NULL) { -+ if (i > 1) -+ break; -+ tmp[i] = token; -+ i++; -+ } -+ if ((tmp[0] != NULL) && (tmp[1] != NULL)) { -+ cnts = strlen(tmp[1]) / 2; -+ if (cnts < 1) -+ return -EFAULT; -+ DBG_871X("%s: cnts=%d\n", __func__, cnts); -+ DBG_871X("%s: data=%s\n", __func__, tmp[1]); -+ for (jj = 0, kk = 0; jj < cnts ; jj++, kk += 2) { -+ pmppriv->mac_filter[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); -+ DBG_871X("%s mac_filter[%d]=%x\n", __func__, jj, pmppriv->mac_filter[jj]); -+ } -+ } else -+ return -EFAULT; -+ -+ } -+ -+ if (bStartRx) { -+ sprintf(extra, "start"); -+ SetPacketRx(padapter, bStartRx, _FALSE); -+ } else if (bStopRx) { -+ SetPacketRx(padapter, bStartRx, _FALSE); -+ pmppriv->bmac_filter = _FALSE; -+ sprintf(extra, "Received packet OK:%d CRC error:%d ,Filter out:%d", padapter->mppriv.rx_pktcount, padapter->mppriv.rx_crcerrpktcount, padapter->mppriv.rx_pktcount_filter_out); -+ } else if (bQueryPhy) { -+ _rtw_memset(&rx_counter, 0, sizeof(struct dbg_rx_counter)); -+ rtw_dump_phy_rx_counters(padapter, &rx_counter); -+ -+ DBG_871X("%s: OFDM_FA =%d\n", __func__, rx_counter.rx_ofdm_fa); -+ DBG_871X("%s: CCK_FA =%d\n", __func__, rx_counter.rx_cck_fa); -+ sprintf(extra, "Phy Received packet OK:%d CRC error:%d FA Counter: %d", rx_counter.rx_pkt_ok, rx_counter.rx_pkt_crc_error, rx_counter.rx_cck_fa + rx_counter.rx_ofdm_fa); -+ -+ -+ } else if (bQueryMac) { -+ _rtw_memset(&rx_counter, 0, sizeof(struct dbg_rx_counter)); -+ rtw_dump_mac_rx_counters(padapter, &rx_counter); -+ sprintf(extra, "Mac Received packet OK: %d , CRC error: %d , Drop Packets: %d\n", -+ rx_counter.rx_pkt_ok, rx_counter.rx_pkt_crc_error, rx_counter.rx_pkt_drop); -+ -+ } -+ -+ if (bmon == 1) { -+ ret = sscanf(input, "mon=%d", &bmon); -+ -+ if (bmon == 1) { -+ pmppriv->rx_bindicatePkt = _TRUE; -+ sprintf(extra, "Indicating Receive Packet to network start\n"); -+ } else { -+ pmppriv->rx_bindicatePkt = _FALSE; -+ sprintf(extra, "Indicating Receive Packet to network Stop\n"); -+ } -+ } -+ if (bSmpCfg == 1) { -+ ret = sscanf(input, "smpcfg=%d", &bSmpCfg); -+ -+ if (bSmpCfg == 1) { -+ pmppriv->bRTWSmbCfg = _TRUE; -+ sprintf(extra , "Indicate By Simple Config Format\n"); -+ SetPacketRx(padapter, _TRUE, _TRUE); -+ } else { -+ pmppriv->bRTWSmbCfg = _FALSE; -+ sprintf(extra , "Indicate By Normal Format\n"); -+ SetPacketRx(padapter, _TRUE, _FALSE); -+ } -+ } -+ -+ wrqu->length = strlen(extra) + 1; -+ -+ return 0; -+} -+ -+ -+int rtw_mp_trx_query(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 txok, txfail, rxok, rxfail, rxfilterout; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ txok = padapter->mppriv.tx.sended; -+ txfail = 0; -+ rxok = padapter->mppriv.rx_pktcount; -+ rxfail = padapter->mppriv.rx_crcerrpktcount; -+ rxfilterout = padapter->mppriv.rx_pktcount_filter_out; -+ -+ _rtw_memset(extra, '\0', 128); -+ -+ sprintf(extra, "Tx OK:%d, Tx Fail:%d, Rx OK:%d, CRC error:%d ,Rx Filter out:%d\n", txok, txfail, rxok, rxfail, rxfilterout); -+ -+ wrqu->length = strlen(extra) + 1; -+ -+ return 0; -+} -+ -+ -+int rtw_mp_pwrtrk(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 enable; -+ u32 thermal; -+ s32 ret; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 input[wrqu->length]; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ enable = 1; -+ if (wrqu->length > 1) { -+ /* not empty string*/ -+ if (strncmp(input, "stop", 4) == 0) { -+ enable = 0; -+ sprintf(extra, "mp tx power tracking stop"); -+ } else if (sscanf(input, "ther=%d", &thermal) == 1) { -+ ret = SetThermalMeter(padapter, (u8)thermal); -+ if (ret == _FAIL) -+ return -EPERM; -+ sprintf(extra, "mp tx power tracking start,target value=%d ok", thermal); -+ } else -+ return -EINVAL; -+ } -+ -+ ret = SetPowerTracking(padapter, enable); -+ if (ret == _FAIL) -+ return -EPERM; -+ -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+ -+int rtw_mp_psd(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ u8 input[wrqu->length]; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ strcpy(extra, input); -+ -+ wrqu->length = mp_query_psd(padapter, extra); -+ -+ return 0; -+} -+ -+ -+int rtw_mp_thermal(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 val; -+ int bwrite = 1; -+ -+#ifdef CONFIG_RTL8188E -+ u16 addr = EEPROM_THERMAL_METER_88E; -+#endif -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) -+ u16 addr = EEPROM_THERMAL_METER_8812; -+#endif -+#ifdef CONFIG_RTL8192E -+ u16 addr = EEPROM_THERMAL_METER_8192E; -+#endif -+#ifdef CONFIG_RTL8723B -+ u16 addr = EEPROM_THERMAL_METER_8723B; -+#endif -+#ifdef CONFIG_RTL8703B -+ u16 addr = EEPROM_THERMAL_METER_8703B; -+#endif -+#ifdef CONFIG_RTL8188F -+ u16 addr = EEPROM_THERMAL_METER_8188F; -+#endif -+ u16 cnt = 1; -+ u16 max_available_size = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ bwrite = strncmp(extra, "write", 6);/* strncmp TRUE is 0*/ -+ -+ GetThermalMeter(padapter, &val); -+ -+ if (bwrite == 0) { -+ /*DBG_871X("to write val:%d",val);*/ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); -+ if (2 > max_available_size) { -+ DBG_871X("no available efuse!\n"); -+ return -EFAULT; -+ } -+ if (rtw_efuse_map_write(padapter, addr, cnt, &val) == _FAIL) { -+ DBG_871X("rtw_efuse_map_write error\n"); -+ return -EFAULT; -+ } -+ sprintf(extra, " efuse write ok :%d", val); -+ } else -+ sprintf(extra, "%d", val); -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+ -+int rtw_mp_reset_stats(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ struct mp_priv *pmp_priv; -+ struct pkt_attrib *pattrib; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ pmp_priv = &padapter->mppriv; -+ -+ pmp_priv->tx.sended = 0; -+ pmp_priv->tx_pktcount = 0; -+ pmp_priv->rx_pktcount = 0; -+ pmp_priv->rx_pktcount_filter_out = 0; -+ pmp_priv->rx_crcerrpktcount = 0; -+ -+ rtw_reset_phy_rx_counters(padapter); -+ rtw_reset_mac_rx_counters(padapter); -+ -+ return 0; -+} -+ -+ -+int rtw_mp_dump(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ struct mp_priv *pmp_priv; -+ struct pkt_attrib *pattrib; -+ u32 value; -+ u8 input[wrqu->length]; -+ u8 rf_type, path_nums = 0; -+ u32 i, j = 1, path; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ pmp_priv = &padapter->mppriv; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ if (strncmp(input, "all", 4) == 0) { -+ mac_reg_dump(RTW_DBGDUMP, padapter); -+ bb_reg_dump(RTW_DBGDUMP, padapter); -+ rf_reg_dump(RTW_DBGDUMP, padapter); -+ } -+ return 0; -+} -+ -+ -+int rtw_mp_phypara(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ char input[wrqu->length]; -+ u32 valxcap, ret; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ DBG_871X("%s:iwpriv in=%s\n", __func__, input); -+ -+ ret = sscanf(input, "xcap=%d", &valxcap); -+ -+ pHalData->CrystalCap = (u8)valxcap; -+ hal_set_crystal_cap(padapter , valxcap); -+ -+ sprintf(extra, "Set xcap=%d", valxcap); -+ wrqu->length = strlen(extra) + 1; -+ -+ return 0; -+ -+} -+ -+ -+int rtw_mp_SetRFPath(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[wrqu->data.length]; -+ int bMain = 1, bTurnoff = 1; -+ -+ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ DBG_871X("%s:iwpriv in=%s\n", __func__, input); -+ -+ bMain = strncmp(input, "1", 2); /* strncmp TRUE is 0*/ -+ bTurnoff = strncmp(input, "0", 3); /* strncmp TRUE is 0*/ -+ -+ if (bMain == 0) { -+ MP_PHY_SetRFPathSwitch(padapter, _TRUE); -+ DBG_871X("%s:PHY_SetRFPathSwitch=TRUE\n", __func__); -+ } else if (bTurnoff == 0) { -+ MP_PHY_SetRFPathSwitch(padapter, _FALSE); -+ DBG_871X("%s:PHY_SetRFPathSwitch=FALSE\n", __func__); -+ } -+ -+ return 0; -+} -+ -+ -+int rtw_mp_QueryDrv(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[wrqu->data.length]; -+ int qAutoLoad = 1; -+ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ DBG_871X("%s:iwpriv in=%s\n", __func__, input); -+ -+ qAutoLoad = strncmp(input, "autoload", 8); /* strncmp TRUE is 0*/ -+ -+ if (qAutoLoad == 0) { -+ DBG_871X("%s:qAutoLoad\n", __func__); -+ -+ if (pHalData->bautoload_fail_flag) -+ sprintf(extra, "fail"); -+ else -+ sprintf(extra, "ok"); -+ } -+ wrqu->data.length = strlen(extra) + 1; -+ return 0; -+} -+ -+ -+int rtw_mp_PwrCtlDM(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ u8 input[wrqu->length]; -+ int bstart = 1; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ bstart = strncmp(input, "start", 5); /* strncmp TRUE is 0*/ -+ if (bstart == 0) { -+ sprintf(extra, "PwrCtlDM start\n"); -+ MPT_PwrCtlDM(padapter, 1); -+ } else { -+ sprintf(extra, "PwrCtlDM stop\n"); -+ MPT_PwrCtlDM(padapter, 0); -+ } -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+int rtw_mp_getver(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct mp_priv *pmp_priv; -+ -+ pmp_priv = &padapter->mppriv; -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ sprintf(extra, "rtwpriv=%d\n", RTWPRIV_VER_INFO); -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_mp_mon(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType; -+ int bstart = 1, bstop = 1; -+ -+ networkType = Ndis802_11Infrastructure; -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ LeaveAllPowerSaveMode(padapter); -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (init_mp_priv(padapter) == _FAIL) -+ DBG_871X("%s: initialize MP private data Fail!\n", __func__); -+ padapter->mppriv.channel = 6; -+ -+ bstart = strncmp(extra, "start", 5); /* strncmp TRUE is 0*/ -+ bstop = strncmp(extra, "stop", 4); /* strncmp TRUE is 0*/ -+ if (bstart == 0) { -+ mp_join(padapter, WIFI_FW_ADHOC_STATE); -+ SetPacketRx(padapter, _TRUE, _FALSE); -+ SetChannel(padapter); -+ pmp_priv->rx_bindicatePkt = _TRUE; -+ pmp_priv->bRTWSmbCfg = _TRUE; -+ sprintf(extra, "monitor mode start\n"); -+ } else if (bstop == 0) { -+ SetPacketRx(padapter, _FALSE, _FALSE); -+ pmp_priv->rx_bindicatePkt = _FALSE; -+ pmp_priv->bRTWSmbCfg = _FALSE; -+ padapter->registrypriv.mp_mode = 1; -+ pHalFunc->hal_deinit(padapter); -+ padapter->registrypriv.mp_mode = 0; -+ pHalFunc->hal_init(padapter); -+ /*rtw_disassoc_cmd(padapter, 0, _TRUE);*/ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ rtw_disassoc_cmd(padapter, 500, _TRUE); -+ rtw_indicate_disconnect(padapter); -+ /*rtw_free_assoc_resources(padapter, 1);*/ -+ } -+ rtw_pm_set_ips(padapter, IPS_NORMAL); -+ sprintf(extra, "monitor mode Stop\n"); -+ } -+#endif -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+int rtw_mp_pretx_proc(PADAPTER padapter, u8 bStartTest, char *extra) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ -+ switch (pmp_priv->mode) { -+ -+ case MP_PACKET_TX: -+ if (bStartTest == 0) { -+ pmp_priv->tx.stop = 1; -+ pmp_priv->mode = MP_ON; -+ sprintf(extra, "Stop continuous Tx"); -+ } else if (pmp_priv->tx.stop == 1) { -+ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500 count=%u\n", extra, pmp_priv->tx.count); -+ pmp_priv->tx.stop = 0; -+ SetPacketTx(padapter); -+ } else { -+ return -EFAULT; -+ } -+ return 0; -+ case MP_SINGLE_TONE_TX: -+ if (bStartTest != 0) -+ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); -+ SetSingleToneTx(padapter, (u8)bStartTest); -+ break; -+ case MP_CONTINUOUS_TX: -+ if (bStartTest != 0) -+ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); -+ SetContinuousTx(padapter, (u8)bStartTest); -+ break; -+ case MP_CARRIER_SUPPRISSION_TX: -+ if (bStartTest != 0) { -+ if (pmp_priv->rateidx <= MPT_RATE_11M) -+ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); -+ else -+ sprintf(extra, "%s\nSpecify carrier suppression but not CCK rate", extra); -+ } -+ SetCarrierSuppressionTx(padapter, (u8)bStartTest); -+ break; -+ case MP_SINGLE_CARRIER_TX: -+ if (bStartTest != 0) -+ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); -+ SetSingleCarrierTx(padapter, (u8)bStartTest); -+ break; -+ -+ default: -+ sprintf(extra, "Error! Continuous-Tx is not on-going."); -+ return -EFAULT; -+ } -+ -+ if (bStartTest == 1 && pmp_priv->mode != MP_ON) { -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ -+ if (pmp_priv->tx.stop == 0) { -+ pmp_priv->tx.stop = 1; -+ rtw_msleep_os(5); -+ } -+#ifdef CONFIG_80211N_HT -+ pmp_priv->tx.attrib.ht_en = 1; -+#endif -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx.count = 1; -+ SetPacketTx(padapter); -+ } else -+ pmp_priv->mode = MP_ON; -+ -+#if defined(CONFIG_RTL8812A) -+ if (IS_HARDWARE_TYPE_8812AU(padapter)) { -+ /* <20130425, Kordan> Turn off OFDM Rx to prevent from CCA causing Tx hang.*/ -+ if (pmp_priv->mode == MP_PACKET_TX) -+ PHY_SetBBReg(padapter, rCCAonSec_Jaguar, BIT3, 1); -+ else -+ PHY_SetBBReg(padapter, rCCAonSec_Jaguar, BIT3, 0); -+ } -+#endif -+ -+ return 0; -+} -+ -+ -+int rtw_mp_tx(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ -+ u32 bandwidth = 0, sg = 0, channel = 6, txpower = 40, rate = 108, ant = 0, txmode = 1, count = 0; -+ u8 i = 0, j = 0, bStartTest = 1, status = 0; -+ u16 antenna = 0; -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ DBG_871X("extra = %s\n", extra); -+ -+ if (strncmp(extra, "stop", 3) == 0) { -+ bStartTest = 0; /* To set Stop*/ -+ pmp_priv->tx.stop = 1; -+ sprintf(extra, "Stop continuous Tx"); -+ status = rtw_mp_pretx_proc(padapter, bStartTest, extra); -+ wrqu->data.length = strlen(extra); -+ return status; -+ } else if (strncmp(extra, "count", 5) == 0) { -+ if (sscanf(extra, "count=%d", &count) < 1) -+ DBG_871X("Got Count=%d]\n", count); -+ pmp_priv->tx.count = count; -+ return 0; -+ } else if (strncmp(extra, "setting", 5) == 0) { -+ _rtw_memset(extra, 0, wrqu->data.length); -+ sprintf(extra, "Current Setting :\n Channel:%d", pmp_priv->channel); -+ sprintf(extra, "%s\n Bandwidth:%d", extra, pmp_priv->bandwidth); -+ sprintf(extra, "%s\n Rate index:%d", extra, pmp_priv->rateidx); -+ sprintf(extra, "%s\n TxPower index:%d", extra, pmp_priv->txpoweridx); -+ sprintf(extra, "%s\n Antenna TxPath:%d", extra, pmp_priv->antenna_tx); -+ sprintf(extra, "%s\n Antenna RxPath:%d", extra, pmp_priv->antenna_rx); -+ sprintf(extra, "%s\n MP Mode:%d", extra, pmp_priv->mode); -+ wrqu->data.length = strlen(extra); -+ return 0; -+ } else { -+ -+ if (sscanf(extra, "ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d", &channel, &bandwidth, &rate, &txpower, &ant, &txmode) < 6) { -+ DBG_871X("Invalid format [ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d]\n", channel, bandwidth, rate, txpower, ant, txmode); -+ _rtw_memset(extra, 0, wrqu->data.length); -+ sprintf(extra, "\n Please input correct format as bleow:\n"); -+ sprintf(extra, "%s\t ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d\n", extra, channel, bandwidth, rate, txpower, ant, txmode); -+ sprintf(extra, "%s\n [ ch : BGN = <1~14> , A or AC = <36~165> ]", extra); -+ sprintf(extra, "%s\n [ bw : Bandwidth: 0 = 20M, 1 = 40M, 2 = 80M ]", extra); -+ sprintf(extra, "%s\n [ rate : CCK: 1 2 5.5 11M X 2 = < 2 4 11 22 >]", extra); -+ sprintf(extra, "%s\n [ OFDM: 6 9 12 18 24 36 48 54M X 2 = < 12 18 24 36 48 72 96 108>", extra); -+ sprintf(extra, "%s\n [ HT 1S2SS MCS0 ~ MCS15 : < [MCS0]=128 ~ [MCS7]=135 ~ [MCS15]=143 >", extra); -+ sprintf(extra, "%s\n [ HT 3SS MCS16 ~ MCS32 : < [MCS16]=144 ~ [MCS23]=151 ~ [MCS32]=159 >", extra); -+ sprintf(extra, "%s\n [ VHT 1SS MCS0 ~ MCS9 : < [MCS0]=160 ~ [MCS9]=169 >", extra); -+ sprintf(extra, "%s\n [ txpower : 1~63 power index", extra); -+ sprintf(extra, "%s\n [ ant : ,2T ex: AB=3 BC=6 CD=12", extra); -+ sprintf(extra, "%s\n [ txmode : < 0 = CONTINUOUS_TX, 1 = PACKET_TX, 2 = SINGLE_TONE_TX, 3 = CARRIER_SUPPRISSION_TX, 4 = SINGLE_CARRIER_TX>\n", extra); -+ wrqu->data.length = strlen(extra); -+ return status; -+ -+ } else { -+ DBG_871X("Got format [ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d]\n", channel, bandwidth, rate, txpower, ant, txmode); -+ _rtw_memset(extra, 0, wrqu->data.length); -+ sprintf(extra, "Change Current channel %d to channel %d", padapter->mppriv.channel , channel); -+ padapter->mppriv.channel = channel; -+ SetChannel(padapter); -+ pHalData->CurrentChannel = channel; -+ -+ if (bandwidth == 1) -+ bandwidth = CHANNEL_WIDTH_40; -+ else if (bandwidth == 2) -+ bandwidth = CHANNEL_WIDTH_80; -+ sprintf(extra, "%s\nChange Current Bandwidth %d to Bandwidth %d", extra, padapter->mppriv.bandwidth , bandwidth); -+ padapter->mppriv.bandwidth = (u8)bandwidth; -+ padapter->mppriv.preamble = sg; -+ SetBandwidth(padapter); -+ pHalData->CurrentChannelBW = bandwidth; -+ -+ sprintf(extra, "%s\nSet power level :%d", extra, txpower); -+ padapter->mppriv.txpoweridx = (u8)txpower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_A] = (u8)txpower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_B] = (u8)txpower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_C] = (u8)txpower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_D] = (u8)txpower; -+ -+ DBG_871X("%s: bw=%d sg=%d\n", __func__, bandwidth, sg); -+ -+ if (rate <= 0x7f) -+ rate = wifirate2_ratetbl_inx((u8)rate); -+ else if (rate < 0xC8) -+ rate = (rate - 0x80 + MPT_RATE_MCS0); -+ /*HT rate 0x80(MCS0) ~ 0x8F(MCS15) ~ 0x9F(MCS31) 128~159 -+ VHT1SS~2SS rate 0xA0 (VHT1SS_MCS0 44) ~ 0xB3 (VHT2SS_MCS9 #63) 160~179 -+ VHT rate 0xB4 (VHT3SS_MCS0 64) ~ 0xC7 (VHT2SS_MCS9 #83) 180~199 -+ else -+ VHT rate 0x90(VHT1SS_MCS0) ~ 0x99(VHT1SS_MCS9) 144~153 -+ rate =(rate - MPT_RATE_VHT1SS_MCS0); -+ */ -+ DBG_871X("%s: rate index=%d\n", __func__, rate); -+ if (rate >= MPT_RATE_LAST) -+ return -EINVAL; -+ sprintf(extra, "%s\nSet data rate to %d index %d", extra, padapter->mppriv.rateidx, rate); -+ -+ padapter->mppriv.rateidx = rate; -+ pMptCtx->MptRateIndex = rate; -+ SetDataRate(padapter); -+ -+ sprintf(extra, "%s\nSet Antenna Path :%d", extra, ant); -+ switch (ant) { -+ case 1: -+ antenna = ANTENNA_A; -+ break; -+ case 2: -+ antenna = ANTENNA_B; -+ break; -+ case 4: -+ antenna = ANTENNA_C; -+ break; -+ case 8: -+ antenna = ANTENNA_D; -+ break; -+ case 3: -+ antenna = ANTENNA_AB; -+ break; -+ case 5: -+ antenna = ANTENNA_AC; -+ break; -+ case 9: -+ antenna = ANTENNA_AD; -+ break; -+ case 6: -+ antenna = ANTENNA_BC; -+ break; -+ case 10: -+ antenna = ANTENNA_BD; -+ break; -+ case 12: -+ antenna = ANTENNA_CD; -+ break; -+ case 7: -+ antenna = ANTENNA_ABC; -+ break; -+ case 14: -+ antenna = ANTENNA_BCD; -+ break; -+ case 11: -+ antenna = ANTENNA_ABD; -+ break; -+ case 15: -+ antenna = ANTENNA_ABCD; -+ break; -+ } -+ DBG_871X("%s: antenna=0x%x\n", __func__, antenna); -+ padapter->mppriv.antenna_tx = antenna; -+ padapter->mppriv.antenna_rx = antenna; -+ pHalData->AntennaTxPath = antenna; -+ SetAntenna(padapter); -+ -+ if (txmode == 0) { -+ pmp_priv->mode = MP_CONTINUOUS_TX; -+ } else if (txmode == 1) { -+ pmp_priv->mode = MP_PACKET_TX; -+ pmp_priv->tx.count = count; -+ } else if (txmode == 2) { -+ pmp_priv->mode = MP_SINGLE_TONE_TX; -+ } else if (txmode == 3) { -+ pmp_priv->mode = MP_CARRIER_SUPPRISSION_TX; -+ } else if (txmode == 4) { -+ pmp_priv->mode = MP_SINGLE_CARRIER_TX; -+ } -+ -+ status = rtw_mp_pretx_proc(padapter, bStartTest, extra); -+ } -+ -+ } -+ -+ wrqu->data.length = strlen(extra); -+ return status; -+} -+ -+ -+int rtw_mp_rx(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ -+ u32 bandwidth = 0, sg = 0, channel = 6, ant = 0; -+ u16 antenna = 0; -+ u8 bStartRx = 0; -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ if (strncmp(extra, "stop", 4) == 0) { -+ _rtw_memset(extra, 0, wrqu->data.length); -+ SetPacketRx(padapter, bStartRx, _FALSE); -+ pmp_priv->bmac_filter = _FALSE; -+ sprintf(extra, "Received packet OK:%d CRC error:%d ,Filter out:%d", padapter->mppriv.rx_pktcount, padapter->mppriv.rx_crcerrpktcount, padapter->mppriv.rx_pktcount_filter_out); -+ wrqu->data.length = strlen(extra); -+ return 0; -+ -+ } else if (sscanf(extra, "ch=%d,bw=%d,ant=%d", &channel, &bandwidth, &ant) < 3) { -+ DBG_871X("Invalid format [ch=%d,bw=%d,ant=%d]\n", channel, bandwidth, ant); -+ _rtw_memset(extra, 0, wrqu->data.length); -+ sprintf(extra, "\n Please input correct format as bleow:\n"); -+ sprintf(extra, "%s\t ch=%d,bw=%d,ant=%d\n", extra, channel, bandwidth, ant); -+ sprintf(extra, "%s\n [ ch : BGN = <1~14> , A or AC = <36~165> ]", extra); -+ sprintf(extra, "%s\n [ bw : Bandwidth: 0 = 20M, 1 = 40M, 2 = 80M ]", extra); -+ sprintf(extra, "%s\n [ ant : ,2T ex: AB=3 BC=6 CD=12", extra); -+ wrqu->data.length = strlen(extra); -+ return 0; -+ -+ } else { -+ bStartRx = 1; -+ DBG_871X("Got format [ch=%d,bw=%d,ant=%d]\n", channel, bandwidth, ant); -+ _rtw_memset(extra, 0, wrqu->data.length); -+ sprintf(extra, "Change Current channel %d to channel %d", padapter->mppriv.channel , channel); -+ padapter->mppriv.channel = channel; -+ SetChannel(padapter); -+ pHalData->CurrentChannel = channel; -+ -+ if (bandwidth == 1) -+ bandwidth = CHANNEL_WIDTH_40; -+ else if (bandwidth == 2) -+ bandwidth = CHANNEL_WIDTH_80; -+ sprintf(extra, "%s\nChange Current Bandwidth %d to Bandwidth %d", extra, padapter->mppriv.bandwidth , bandwidth); -+ padapter->mppriv.bandwidth = (u8)bandwidth; -+ padapter->mppriv.preamble = sg; -+ SetBandwidth(padapter); -+ pHalData->CurrentChannelBW = bandwidth; -+ -+ sprintf(extra, "%s\nSet Antenna Path :%d", extra, ant); -+ switch (ant) { -+ case 1: -+ antenna = ANTENNA_A; -+ break; -+ case 2: -+ antenna = ANTENNA_B; -+ break; -+ case 4: -+ antenna = ANTENNA_C; -+ break; -+ case 8: -+ antenna = ANTENNA_D; -+ break; -+ case 3: -+ antenna = ANTENNA_AB; -+ break; -+ case 5: -+ antenna = ANTENNA_AC; -+ break; -+ case 9: -+ antenna = ANTENNA_AD; -+ break; -+ case 6: -+ antenna = ANTENNA_BC; -+ break; -+ case 10: -+ antenna = ANTENNA_BD; -+ break; -+ case 12: -+ antenna = ANTENNA_CD; -+ break; -+ case 7: -+ antenna = ANTENNA_ABC; -+ break; -+ case 14: -+ antenna = ANTENNA_BCD; -+ break; -+ case 11: -+ antenna = ANTENNA_ABD; -+ break; -+ case 15: -+ antenna = ANTENNA_ABCD; -+ break; -+ } -+ DBG_871X("%s: antenna=0x%x\n", __func__, antenna); -+ padapter->mppriv.antenna_tx = antenna; -+ padapter->mppriv.antenna_rx = antenna; -+ pHalData->AntennaTxPath = antenna; -+ SetAntenna(padapter); -+ -+ sprintf(extra, "%s\nstart Rx", extra); -+ SetPacketRx(padapter, bStartRx, _FALSE); -+ } -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_efuse_mask_file(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ char *rtw_efuse_mask_file_path; -+ u8 Status; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ _rtw_memset(maskfileBuffer, 0x00, sizeof(maskfileBuffer)); -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ if (strncmp(extra, "off", 3) == 0 && strlen(extra) < 4) { -+ padapter->registrypriv.boffefusemask = 1; -+ sprintf(extra, "Turn off Efuse Mask\n"); -+ wrqu->data.length = strlen(extra); -+ return 0; -+ } -+ if (strncmp(extra, "on", 2) == 0 && strlen(extra) < 3) { -+ padapter->registrypriv.boffefusemask = 0; -+ sprintf(extra, "Turn on Efuse Mask\n"); -+ wrqu->data.length = strlen(extra); -+ return 0; -+ } -+ rtw_efuse_mask_file_path = extra; -+ -+ if (rtw_is_file_readable(rtw_efuse_mask_file_path) == _TRUE) { -+ DBG_871X("%s do rtw_efuse_mask_file_read = %s! ,sizeof maskfileBuffer %zu\n", __func__, rtw_efuse_mask_file_path, sizeof(maskfileBuffer)); -+ Status = rtw_efuse_file_read(padapter, rtw_efuse_mask_file_path, maskfileBuffer, sizeof(maskfileBuffer)); -+ if (Status == _TRUE) -+ padapter->registrypriv.bFileMaskEfuse = _TRUE; -+ sprintf(extra, "efuse mask file read OK\n"); -+ } else { -+ padapter->registrypriv.bFileMaskEfuse = _FALSE; -+ sprintf(extra, "efuse mask file readable FAIL\n"); -+ DBG_871X("%s rtw_is_file_readable fail!\n", __func__); -+ } -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_efuse_file_map(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ char *rtw_efuse_file_map_path; -+ u8 Status; -+ PEFUSE_HAL pEfuseHal; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ pEfuseHal = &pHalData->EfuseHal; -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ rtw_efuse_file_map_path = extra; -+ -+ if (rtw_is_file_readable(rtw_efuse_file_map_path) == _TRUE) { -+ DBG_871X("%s do rtw_efuse_mask_file_read = %s!\n", __func__, rtw_efuse_file_map_path); -+ Status = rtw_efuse_file_read(padapter, rtw_efuse_file_map_path, pEfuseHal->fakeEfuseModifiedMap, sizeof(pEfuseHal->fakeEfuseModifiedMap)); -+ if (Status == _TRUE) -+ sprintf(extra, "efuse file file_read OK\n"); -+ else -+ sprintf(extra, "efuse file file_read FAIL\n"); -+ } else { -+ sprintf(extra, "efuse file readable FAIL\n"); -+ DBG_871X("%s rtw_is_file_readable fail!\n", __func__); -+ } -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+#if defined(CONFIG_RTL8723B) -+int rtw_mp_SetBT(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ BT_REQ_CMD BtReq; -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ PBT_RSP_CMD pBtRsp = (PBT_RSP_CMD)&pMptCtx->mptOutBuf[0]; -+ char input[128]; -+ char *pch, *ptmp, *token, *tmp[2] = {0x00, 0x00}; -+ u8 setdata[100]; -+ u8 resetbt = 0x00; -+ u8 tempval, BTStatus; -+ u8 H2cSetbtmac[6]; -+ u8 u1H2CBtMpOperParm[4] = {0x01}; -+ int testmode = 1, ready = 1, trxparam = 1, setgen = 1, getgen = 1, testctrl = 1, testbt = 1, readtherm = 1, setbtmac = 1; -+ u32 i = 0, ii = 0, jj = 0, kk = 0, cnts = 0, status = 0; -+ PRT_MP_FIRMWARE pBTFirmware = NULL; -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ if (strlen(extra) < 1) -+ return -EFAULT; -+ -+ DBG_871X("%s:iwpriv in=%s\n", __func__, extra); -+ ready = strncmp(extra, "ready", 5); -+ testmode = strncmp(extra, "testmode", 8); /* strncmp TRUE is 0*/ -+ trxparam = strncmp(extra, "trxparam", 8); -+ setgen = strncmp(extra, "setgen", 6); -+ getgen = strncmp(extra, "getgen", 6); -+ testctrl = strncmp(extra, "testctrl", 8); -+ testbt = strncmp(extra, "testbt", 6); -+ readtherm = strncmp(extra, "readtherm", 9); -+ setbtmac = strncmp(extra, "setbtmac", 8); -+ -+ if (strncmp(extra, "dlbt", 4) == 0) { -+ pHalData->LastHMEBoxNum = 0; -+ padapter->bBTFWReady = _FALSE; -+ rtw_write8(padapter, 0xa3, 0x05); -+ BTStatus = rtw_read8(padapter, 0xa0); -+ DBG_871X("%s: btwmap before read 0xa0 BT Status =0x%x\n", __func__, BTStatus); -+ if (BTStatus != 0x04) { -+ sprintf(extra, "BT Status not Active DLFW FAIL\n"); -+ goto exit; -+ } -+ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval |= BIT7; -+ rtw_write8(padapter, 0x6B, tempval); -+ -+ /* Attention!! Between 0x6A[14] and 0x6A[15] setting need 100us delay*/ -+ /* So don't write 0x6A[14]=1 and 0x6A[15]=0 together!*/ -+ rtw_usleep_os(100); -+ /* disable BT power cut*/ -+ /* 0x6A[14] = 0*/ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval &= ~BIT6; -+ rtw_write8(padapter, 0x6B, tempval); -+ rtw_usleep_os(100); -+ MPT_PwrCtlDM(padapter, 0); -+ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) | 0x00000004)); -+ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) & 0xFFFFFFEF)); -+ rtw_msleep_os(600); -+ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) | 0x00000010)); -+ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) & 0xFFFFFFFB)); -+ rtw_msleep_os(1200); -+ pBTFirmware = (PRT_MP_FIRMWARE)rtw_zmalloc(sizeof(RT_MP_FIRMWARE)); -+ if (pBTFirmware == NULL) -+ goto exit; -+ padapter->bBTFWReady = _FALSE; -+ FirmwareDownloadBT(padapter, pBTFirmware); -+ if (pBTFirmware) -+ rtw_mfree((u8 *)pBTFirmware, sizeof(RT_MP_FIRMWARE)); -+ -+ DBG_871X("Wait for FirmwareDownloadBT fw boot!\n"); -+ rtw_msleep_os(2000); -+ _rtw_memset(extra, '\0', wrqu->data.length); -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 0; -+ BtReq.paraLength = 0; -+ mptbt_BtControlProcess(padapter, &BtReq); -+ rtw_msleep_os(100); -+ -+ DBG_8192C("FirmwareDownloadBT ready = 0x%x 0x%x", pMptCtx->mptOutBuf[4], pMptCtx->mptOutBuf[5]); -+ if ((pMptCtx->mptOutBuf[4] == 0x00) && (pMptCtx->mptOutBuf[5] == 0x00)) { -+ -+ if (padapter->mppriv.bTxBufCkFail == _TRUE) -+ sprintf(extra, "check TxBuf Fail.\n"); -+ else -+ sprintf(extra, "download FW Fail.\n"); -+ } else { -+ sprintf(extra, "download FW OK.\n"); -+ goto exit; -+ } -+ goto exit; -+ } -+ if (strncmp(extra, "dlfw", 4) == 0) { -+ pHalData->LastHMEBoxNum = 0; -+ padapter->bBTFWReady = _FALSE; -+ rtw_write8(padapter, 0xa3, 0x05); -+ BTStatus = rtw_read8(padapter, 0xa0); -+ DBG_871X("%s: btwmap before read 0xa0 BT Status =0x%x\n", __func__, BTStatus); -+ if (BTStatus != 0x04) { -+ sprintf(extra, "BT Status not Active DLFW FAIL\n"); -+ goto exit; -+ } -+ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval |= BIT7; -+ rtw_write8(padapter, 0x6B, tempval); -+ -+ /* Attention!! Between 0x6A[14] and 0x6A[15] setting need 100us delay*/ -+ /* So don't write 0x6A[14]=1 and 0x6A[15]=0 together!*/ -+ rtw_usleep_os(100); -+ /* disable BT power cut*/ -+ /* 0x6A[14] = 0*/ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval &= ~BIT6; -+ rtw_write8(padapter, 0x6B, tempval); -+ rtw_usleep_os(100); -+ -+ MPT_PwrCtlDM(padapter, 0); -+ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) | 0x00000004)); -+ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) & 0xFFFFFFEF)); -+ rtw_msleep_os(600); -+ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) | 0x00000010)); -+ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) & 0xFFFFFFFB)); -+ rtw_msleep_os(1200); -+ -+#if defined(CONFIG_PLATFORM_SPRD) && (MP_DRIVER == 1) -+ /* Pull up BT reset pin.*/ -+ DBG_871X("%s: pull up BT reset pin when bt start mp test\n", __func__); -+ rtw_wifi_gpio_wlan_ctrl(WLAN_BT_PWDN_ON); -+#endif -+ DBG_871X(" FirmwareDownload!\n"); -+ -+#if defined(CONFIG_RTL8723B) -+ status = rtl8723b_FirmwareDownload(padapter, _FALSE); -+#endif -+ DBG_871X("Wait for FirmwareDownloadBT fw boot!\n"); -+ rtw_msleep_os(1000); -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_HaltNotify(padapter); -+ DBG_871X("SetBT btcoex HaltNotify !\n"); -+ /*hal_btcoex1ant_SetAntPath(padapter);*/ -+ rtw_btcoex_SetManualControl(padapter, _TRUE); -+#endif -+ _rtw_memset(extra, '\0', wrqu->data.length); -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 0; -+ BtReq.paraLength = 0; -+ mptbt_BtControlProcess(padapter, &BtReq); -+ rtw_msleep_os(200); -+ -+ DBG_8192C("FirmwareDownloadBT ready = 0x%x 0x%x", pMptCtx->mptOutBuf[4], pMptCtx->mptOutBuf[5]); -+ if ((pMptCtx->mptOutBuf[4] == 0x00) && (pMptCtx->mptOutBuf[5] == 0x00)) { -+ if (padapter->mppriv.bTxBufCkFail == _TRUE) -+ sprintf(extra, "check TxBuf Fail.\n"); -+ else -+ sprintf(extra, "download FW Fail.\n"); -+ } else { -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SwitchBtTRxMask(padapter); -+#endif -+ rtw_msleep_os(200); -+ sprintf(extra, "download FW OK.\n"); -+ goto exit; -+ } -+ goto exit; -+ } -+ -+ if (strncmp(extra, "down", 4) == 0) { -+ DBG_871X("SetBT down for to hal_init !\n"); -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SetManualControl(padapter, _FALSE); -+ rtw_btcoex_Initialize(padapter); -+#endif -+ pHalFunc->read_adapter_info(padapter); -+ pHalFunc->hal_deinit(padapter); -+ pHalFunc->hal_init(padapter); -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ LeaveAllPowerSaveMode(padapter); -+ MPT_PwrCtlDM(padapter, 0); -+ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) | 0x00000004)); -+ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) & 0xFFFFFFEF)); -+ rtw_msleep_os(600); -+ /*rtw_write32(padapter, 0x6a, (rtw_read32(padapter, 0x6a)& 0xFFFFFFFE));*/ -+ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) | 0x00000010)); -+ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) & 0xFFFFFFFB)); -+ rtw_msleep_os(1200); -+ goto exit; -+ } -+ if (strncmp(extra, "disable", 7) == 0) { -+ DBG_871X("SetBT disable !\n"); -+ rtw_write32(padapter, 0x6a, (rtw_read32(padapter, 0x6a) & 0xFFFFFFFB)); -+ rtw_msleep_os(500); -+ goto exit; -+ } -+ if (strncmp(extra, "enable", 6) == 0) { -+ DBG_871X("SetBT enable !\n"); -+ rtw_write32(padapter, 0x6a, (rtw_read32(padapter, 0x6a) | 0x00000004)); -+ rtw_msleep_os(500); -+ goto exit; -+ } -+ if (strncmp(extra, "h2c", 3) == 0) { -+ DBG_871X("SetBT h2c !\n"); -+ padapter->bBTFWReady = _TRUE; -+ rtw_hal_fill_h2c_cmd(padapter, 0x63, 1, u1H2CBtMpOperParm); -+ goto exit; -+ } -+ if (strncmp(extra, "2ant", 4) == 0) { -+ DBG_871X("Set BT 2ant use!\n"); -+ PHY_SetMacReg(padapter, 0x67, BIT5, 0x1); -+ rtw_write32(padapter, 0x948, 0000); -+ -+ goto exit; -+ } -+ -+ if (ready != 0 && testmode != 0 && trxparam != 0 && setgen != 0 && getgen != 0 && testctrl != 0 && testbt != 0 && readtherm != 0 && setbtmac != 0) -+ return -EFAULT; -+ -+ if (testbt == 0) { -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 6; -+ BtReq.paraLength = cnts / 2; -+ goto todo; -+ } -+ if (ready == 0) { -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 0; -+ BtReq.paraLength = 0; -+ goto todo; -+ } -+ -+ pch = extra; -+ i = 0; -+ while ((token = strsep(&pch, ",")) != NULL) { -+ if (i > 1) -+ break; -+ tmp[i] = token; -+ i++; -+ } -+ -+ if ((tmp[0] != NULL) && (tmp[1] != NULL)) { -+ cnts = strlen(tmp[1]); -+ if (cnts < 1) -+ return -EFAULT; -+ -+ DBG_871X("%s: cnts=%d\n", __func__, cnts); -+ DBG_871X("%s: data=%s\n", __func__, tmp[1]); -+ -+ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) { -+ BtReq.pParamStart[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); -+ /* DBG_871X("BtReq.pParamStart[%d]=0x%02x\n", jj, BtReq.pParamStart[jj]);*/ -+ } -+ } else -+ return -EFAULT; -+ -+ if (testmode == 0) { -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 1; -+ BtReq.paraLength = 1; -+ } -+ if (trxparam == 0) { -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 2; -+ BtReq.paraLength = cnts / 2; -+ } -+ if (setgen == 0) { -+ DBG_871X("%s: BT_SET_GENERAL\n", __func__); -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 3;/*BT_SET_GENERAL 3*/ -+ BtReq.paraLength = cnts / 2; -+ } -+ if (getgen == 0) { -+ DBG_871X("%s: BT_GET_GENERAL\n", __func__); -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 4;/*BT_GET_GENERAL 4*/ -+ BtReq.paraLength = cnts / 2; -+ } -+ if (readtherm == 0) { -+ DBG_871X("%s: BT_GET_GENERAL\n", __func__); -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 4;/*BT_GET_GENERAL 4*/ -+ BtReq.paraLength = cnts / 2; -+ } -+ -+ if (testctrl == 0) { -+ DBG_871X("%s: BT_TEST_CTRL\n", __func__); -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 5;/*BT_TEST_CTRL 5*/ -+ BtReq.paraLength = cnts / 2; -+ } -+ -+ DBG_871X("%s: Req opCodeVer=%d OpCode=%d paraLength=%d\n", -+ __func__, BtReq.opCodeVer, BtReq.OpCode, BtReq.paraLength); -+ -+ if (BtReq.paraLength < 1) -+ goto todo; -+ for (i = 0; i < BtReq.paraLength; i++) { -+ DBG_871X("%s: BtReq.pParamStart[%d] = 0x%02x\n", -+ __func__, i, BtReq.pParamStart[i]); -+ } -+ -+todo: -+ _rtw_memset(extra, '\0', wrqu->data.length); -+ -+ if (padapter->bBTFWReady == _FALSE) { -+ sprintf(extra, "BTFWReady = FALSE.\n"); -+ goto exit; -+ } -+ -+ mptbt_BtControlProcess(padapter, &BtReq); -+ -+ if (readtherm == 0) { -+ sprintf(extra, "BT thermal="); -+ for (i = 4; i < pMptCtx->mptOutLen; i++) { -+ if ((pMptCtx->mptOutBuf[i] == 0x00) && (pMptCtx->mptOutBuf[i + 1] == 0x00)) -+ goto exit; -+ -+ sprintf(extra, "%s %d ", extra, (pMptCtx->mptOutBuf[i] & 0x1f)); -+ } -+ } else { -+ for (i = 4; i < pMptCtx->mptOutLen; i++) -+ sprintf(extra, "%s 0x%x ", extra, pMptCtx->mptOutBuf[i]); -+ } -+ -+exit: -+ wrqu->data.length = strlen(extra) + 1; -+ DBG_871X("-%s: output len=%d data=%s\n", __func__, wrqu->data.length, extra); -+ -+ return status; -+} -+ -+#endif /*#ifdef CONFIG_RTL8723B*/ -+ -+#endif -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c 2017-06-07 23:07:21.047690856 +0300 -@@ -0,0 +1,618 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/mlme_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/mlme_linux.c +--- linux-4.14.17/3rdparty/rtl8812au/os_dep/mlme_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/mlme_linux.c 2018-02-06 17:42:30.724967372 +0200 +@@ -0,0 +1,567 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -366699,11 +174165,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ + + @@ -366711,98 +174172,71 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + +#include + -+ -+#ifdef RTK_DMP_PLATFORM -+void Linkup_workitem_callback(struct work_struct *work) -+{ -+ struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkup_workitem); -+ _adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv); -+ -+_func_enter_; -+ -+ RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("+ Linkup_workitem_callback\n")); -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,12)) -+ kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKUP); ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++void rtw_join_timeout_handler(void *FunctionContext) +#else -+ kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKUP); ++void rtw_join_timeout_handler(struct timer_list *t) +#endif -+ -+_func_exit_; -+} -+ -+void Linkdown_workitem_callback(struct work_struct *work) +{ -+ struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkdown_workitem); -+ _adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv); -+ -+_func_enter_; -+ -+ RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("+ Linkdown_workitem_callback\n")); -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,12)) -+ kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKDOWN); ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++ _adapter *adapter = (_adapter *)FunctionContext; +#else -+ kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKDOWN); ++ _adapter *adapter = from_timer(adapter, t, mlmepriv.assoc_timer); +#endif + -+_func_exit_; -+} -+#endif -+ -+ -+/* -+void sitesurvey_ctrl_handler(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ -+ _sitesurvey_ctrl_handler(adapter); -+ -+ _set_timer(&adapter->mlmepriv.sitesurveyctrl.sitesurvey_ctrl_timer, 3000); -+} -+*/ -+ -+void rtw_join_timeout_handler (void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; + _rtw_join_timeout_handler(adapter); +} + + -+void _rtw_scan_timeout_handler (void *FunctionContext) ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++void _rtw_scan_timeout_handler(void *FunctionContext) ++#else ++void _rtw_scan_timeout_handler(struct timer_list *t) ++#endif +{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _adapter *adapter = (_adapter *)FunctionContext; ++#else ++ _adapter *adapter = from_timer(adapter, t, mlmepriv.scan_to_timer); ++#endif + rtw_scan_timeout_handler(adapter); +} + + -+void _dynamic_check_timer_handlder (void *FunctionContext) ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++static void _dynamic_check_timer_handlder(void *FunctionContext) ++#else ++static void _dynamic_check_timer_handlder(struct timer_list *t) ++#endif +{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _adapter *adapter = (_adapter *)FunctionContext; -+ -+#if (MP_DRIVER == 1) -+ if (adapter->registrypriv.mp_mode == 1 && adapter->mppriv.mp_dm ==0) //for MP ODM dynamic Tx power tracking -+ { -+ //DBG_871X("_dynamic_check_timer_handlder mp_dm =0 return \n"); -+ _set_timer(&adapter->mlmepriv.dynamic_chk_timer, 2000); -+ return; -+ } ++#else ++ _adapter *adapter = from_timer(adapter, t, mlmepriv.dynamic_chk_timer); +#endif + -+#ifdef CONFIG_CONCURRENT_MODE -+ if(adapter->pbuddy_adapter) -+ rtw_dynamic_check_timer_handlder(adapter->pbuddy_adapter); -+#endif //CONFIG_CONCURRENT_MODE -+ ++#if (MP_DRIVER == 1) ++ if (adapter->registrypriv.mp_mode == 1) ++ return; ++#endif + rtw_dynamic_check_timer_handlder(adapter); -+ ++ + _set_timer(&adapter->mlmepriv.dynamic_chk_timer, 2000); +} + +#ifdef CONFIG_SET_SCAN_DENY_TIMER ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) +void _rtw_set_scan_deny_timer_hdl(void *FunctionContext) ++#else ++void _rtw_set_scan_deny_timer_hdl(struct timer_list *t) ++#endif +{ -+ _adapter *adapter = (_adapter *)FunctionContext; ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++ _adapter *adapter = (_adapter *)FunctionContext; ++#else ++ _adapter *adapter = from_timer(adapter, t, mlmepriv.set_scan_deny_timer); ++#endif ++ + rtw_set_scan_deny_timer_hdl(adapter); +} +#endif @@ -366812,43 +174246,27 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty +{ + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _init_timer(&(pmlmepriv->assoc_timer), padapter->pnetdev, rtw_join_timeout_handler, padapter); -+ //_init_timer(&(pmlmepriv->sitesurveyctrl.sitesurvey_ctrl_timer), padapter->pnetdev, sitesurvey_ctrl_handler, padapter); + _init_timer(&(pmlmepriv->scan_to_timer), padapter->pnetdev, _rtw_scan_timeout_handler, padapter); -+ -+ #ifdef CONFIG_DFS_MASTER -+ _init_timer(&(pmlmepriv->dfs_master_timer), padapter->pnetdev, rtw_dfs_master_timer_hdl, padapter); -+ #endif -+ + _init_timer(&(pmlmepriv->dynamic_chk_timer), padapter->pnetdev, _dynamic_check_timer_handlder, padapter); -+ + #ifdef CONFIG_SET_SCAN_DENY_TIMER + _init_timer(&(pmlmepriv->set_scan_deny_timer), padapter->pnetdev, _rtw_set_scan_deny_timer_hdl, padapter); + #endif -+ -+#ifdef RTK_DMP_PLATFORM -+ _init_workitem(&(pmlmepriv->Linkup_workitem), Linkup_workitem_callback, padapter); -+ _init_workitem(&(pmlmepriv->Linkdown_workitem), Linkdown_workitem_callback, padapter); ++#else ++ timer_setup(&pmlmepriv->assoc_timer, rtw_join_timeout_handler, 0); ++ timer_setup(&pmlmepriv->scan_to_timer, _rtw_scan_timeout_handler, 0); ++ timer_setup(&pmlmepriv->dynamic_chk_timer, _dynamic_check_timer_handlder, 0); ++ #ifdef CONFIG_SET_SCAN_DENY_TIMER ++ timer_setup(&pmlmepriv->set_scan_deny_timer, _rtw_set_scan_deny_timer_hdl, 0); ++ #endif +#endif -+ +} + -+extern void rtw_indicate_wx_assoc_event(_adapter *padapter); -+extern void rtw_indicate_wx_disassoc_event(_adapter *padapter); -+ +void rtw_os_indicate_connect(_adapter *adapter) +{ -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+_func_enter_; -+ +#ifdef CONFIG_IOCTL_CFG80211 -+ if ( (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)==_TRUE ) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==_TRUE ) ) -+ { -+ rtw_cfg80211_ibss_indicate_connect(adapter); -+ } -+ else -+ rtw_cfg80211_indicate_connect(adapter); ++ rtw_cfg80211_indicate_connect(adapter); +#endif //CONFIG_IOCTL_CFG80211 + + rtw_indicate_wx_assoc_event(adapter); @@ -366856,20 +174274,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + + if(adapter->pid[2] !=0) + rtw_signal_process(adapter->pid[2], SIGALRM); -+ -+#ifdef RTK_DMP_PLATFORM -+ _set_workitem(&adapter->mlmepriv.Linkup_workitem); -+#endif -+ -+_func_exit_; -+ +} + +extern void indicate_wx_scan_complete_event(_adapter *padapter); +void rtw_os_indicate_scan_done( _adapter *padapter, bool aborted) +{ +#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_indicate_scan_done(padapter, aborted); ++ rtw_cfg80211_indicate_scan_done(wdev_to_priv(padapter->rtw_wdev), aborted); +#endif + indicate_wx_scan_complete_event(padapter); +} @@ -366880,14 +174291,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + u8 backupPMKIDIndex = 0; + u8 backupTKIPCountermeasure = 0x00; + u32 backupTKIPcountermeasure_time = 0; -+ // add for CONFIG_IEEE80211W, none 11w also can use -+ _irqL irqL; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ -+ _enter_critical_bh(&adapter->security_key_mutex, &irqL); -+ ++ + if(adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X)//802.1x -+ { ++ { + // Added by Albert 2009/02/18 + // We have to backup the PMK information for WiFi PMK Caching test item. + // @@ -366899,11 +174305,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + _rtw_memcpy( &backupPMKIDList[ 0 ], &adapter->securitypriv.PMKIDList[ 0 ], sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE ); + backupPMKIDIndex = adapter->securitypriv.PMKIDIndex; + backupTKIPCountermeasure = adapter->securitypriv.btkip_countermeasure; -+ backupTKIPcountermeasure_time = adapter->securitypriv.btkip_countermeasure_time; -+#ifdef CONFIG_IEEE80211W -+ //reset RX BIP packet number -+ pmlmeext->mgnt_80211w_IPN_rx = 0; -+#endif //CONFIG_IEEE80211W ++ backupTKIPcountermeasure_time = adapter->securitypriv.btkip_countermeasure_time; ++ + _rtw_memset((unsigned char *)&adapter->securitypriv, 0, sizeof (struct security_priv)); + //_init_timer(&(adapter->securitypriv.tkip_timer),adapter->pnetdev, rtw_use_tkipkey_handler, adapter); + @@ -366912,13 +174315,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + _rtw_memcpy( &adapter->securitypriv.PMKIDList[ 0 ], &backupPMKIDList[ 0 ], sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE ); + adapter->securitypriv.PMKIDIndex = backupPMKIDIndex; + adapter->securitypriv.btkip_countermeasure = backupTKIPCountermeasure; -+ adapter->securitypriv.btkip_countermeasure_time = backupTKIPcountermeasure_time; ++ adapter->securitypriv.btkip_countermeasure_time = backupTKIPcountermeasure_time; + + adapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; + adapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled; + + } -+ else //reset values in securitypriv ++ else //reset values in securitypriv + { + //if(adapter->mlmepriv.fw_state & WIFI_STATION_STATE) + //{ @@ -366935,17 +174338,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + psec_priv->ndisencryptstatus = Ndis802_11WEPDisabled; + //} + } -+ // add for CONFIG_IEEE80211W, none 11w also can use -+ _exit_critical_bh(&adapter->security_key_mutex, &irqL); -+ -+ DBG_871X(FUNC_ADPT_FMT" - End to Disconnect\n", FUNC_ADPT_ARG(adapter)); +} + +void rtw_os_indicate_disconnect( _adapter *adapter ) +{ -+ //RT_PMKID_LIST backupPMKIDList[ NUM_PMKID_CACHE ]; ++ //RT_PMKID_LIST backupPMKIDList[ NUM_PMKID_CACHE ]; ++ + -+_func_enter_; + + netif_carrier_off(adapter->pnetdev); // Do it first for tx broadcast pkt after disconnection issue! + @@ -366955,14 +174354,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + + rtw_indicate_wx_disassoc_event(adapter); + -+#ifdef RTK_DMP_PLATFORM -+ _set_workitem(&adapter->mlmepriv.Linkdown_workitem); -+#endif -+ //modify for CONFIG_IEEE80211W, none 11w also can use the same command -+ rtw_reset_securitypriv_cmd(adapter); -+ -+_func_exit_; -+ ++ rtw_reset_securitypriv( adapter ); +} + +void rtw_report_sec_ie(_adapter *adapter,u8 authmode,u8 *sec_ie) @@ -366971,7 +174363,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + u8 *buff,*p,i; + union iwreq_data wrqu; + -+_func_enter_; ++ + + RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("+rtw_report_sec_ie, authmode=%d\n", authmode)); + @@ -366980,19 +174372,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + { + RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("rtw_report_sec_ie, authmode=%d\n", authmode)); + -+ buff = rtw_zmalloc(IW_CUSTOM_MAX); -+ if (NULL == buff) { -+ DBG_871X(FUNC_ADPT_FMT ": alloc memory FAIL!!\n", -+ FUNC_ADPT_ARG(adapter)); -+ return; -+ } -+ p = buff; ++ buff = rtw_malloc(IW_CUSTOM_MAX); ++ ++ _rtw_memset(buff,0,IW_CUSTOM_MAX); ++ ++ p=buff; + + p+=sprintf(p,"ASSOCINFO(ReqIEs="); + + len = sec_ie[1]+2; -+ len = (len < IW_CUSTOM_MAX) ? len:IW_CUSTOM_MAX; -+ ++ len = (len < IW_CUSTOM_MAX) ? len:IW_CUSTOM_MAX; ++ + for(i=0;ipnetdev,IWEVCUSTOM,&wrqu,buff); +#endif + -+ rtw_mfree(buff, IW_CUSTOM_MAX); ++ if(buff) ++ rtw_mfree(buff, IW_CUSTOM_MAX); ++ + } + -+exit: + -+_func_exit_; + +} + -+void _survey_timer_hdl (void *FunctionContext) ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++static void _survey_timer_hdl(void *FunctionContext) ++#else ++static void _survey_timer_hdl(struct timer_list *t) ++#endif +{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _adapter *padapter = (_adapter *)FunctionContext; -+ ++#else ++ _adapter *padapter = from_timer(padapter, t, mlmeextpriv.survey_timer); ++#endif ++ + survey_timer_hdl(padapter); +} + -+void _link_timer_hdl (void *FunctionContext) ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++static void _link_timer_hdl (void *FunctionContext) ++#else ++static void _link_timer_hdl(struct timer_list *t) ++#endif +{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _adapter *padapter = (_adapter *)FunctionContext; ++#else ++ _adapter *padapter = from_timer(padapter, t, mlmeextpriv.link_timer); ++#endif + link_timer_hdl(padapter); +} + -+void _addba_timer_hdl(void *FunctionContext) ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++static void _addba_timer_hdl(void *FunctionContext) ++#else ++static void _addba_timer_hdl(struct timer_list *t) ++#endif +{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + struct sta_info *psta = (struct sta_info *)FunctionContext; ++#else ++ struct sta_info *psta = from_timer(psta, t, addba_retry_timer); ++#endif + addba_timer_hdl(psta); +} + -+#ifdef CONFIG_IEEE80211W -+ -+void _sa_query_timer_hdl (void *FunctionContext) -+{ -+ struct sta_info *psta = (struct sta_info *)FunctionContext; -+ -+ sa_query_timer_hdl(psta); -+} -+ -+void init_dot11w_expire_timer(_adapter *padapter, struct sta_info *psta) -+{ -+ _init_timer(&psta->dot11w_expire_timer, padapter->pnetdev, _sa_query_timer_hdl, psta); -+} -+ -+#endif //CONFIG_IEEE80211W -+ +void init_addba_retry_timer(_adapter *padapter, struct sta_info *psta) +{ + ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _init_timer(&psta->addba_retry_timer, padapter->pnetdev, _addba_timer_hdl, psta); ++#else ++ timer_setup(&psta->addba_retry_timer, _addba_timer_hdl, 0); ++#endif +} + -+/* -+void _reauth_timer_hdl(void *FunctionContext) -+{ -+ _adapter *padapter = (_adapter *)FunctionContext; -+ reauth_timer_hdl(padapter); -+} -+ -+void _reassoc_timer_hdl(void *FunctionContext) -+{ -+ _adapter *padapter = (_adapter *)FunctionContext; -+ reassoc_timer_hdl(padapter); -+} -+*/ -+ +void init_mlme_ext_timer(_adapter *padapter) -+{ ++{ + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _init_timer(&pmlmeext->survey_timer, padapter->pnetdev, _survey_timer_hdl, padapter); + _init_timer(&pmlmeext->link_timer, padapter->pnetdev, _link_timer_hdl, padapter); ++#else ++ timer_setup(&pmlmeext->survey_timer, _survey_timer_hdl, 0); ++ timer_setup(&pmlmeext->link_timer, _link_timer_hdl, 0); ++#endif ++} + -+ //_init_timer(&pmlmeext->ADDBA_timer, padapter->pnetdev, _addba_timer_hdl, padapter); ++u8 rtw_handle_tkip_countermeasure(_adapter* padapter) ++{ ++ u8 status = _SUCCESS; ++ u32 cur_time = 0; ++ ++ if (padapter->securitypriv.btkip_countermeasure == true) { ++ cur_time = rtw_get_current_time(); ++ ++ if( (cur_time - padapter->securitypriv.btkip_countermeasure_time) > 60 * HZ ) ++ { ++ padapter->securitypriv.btkip_countermeasure = false; ++ padapter->securitypriv.btkip_countermeasure_time = 0; ++ } ++ else ++ { ++ status = _FAIL; ++ } ++ } ++ ++ return status; + -+ //_init_timer(&pmlmeext->reauth_timer, padapter->pnetdev, _reauth_timer_hdl, padapter); -+ //_init_timer(&pmlmeext->reassoc_timer, padapter->pnetdev, _reassoc_timer_hdl, padapter); +} + +#ifdef CONFIG_AP_MODE @@ -367101,14 +174512,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + + if(pstapriv->sta_aid[psta->aid - 1] != psta) + return; -+ -+ -+ wrqu.addr.sa_family = ARPHRD_ETHER; -+ ++ ++ ++ wrqu.addr.sa_family = ARPHRD_ETHER; ++ + _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN); + + DBG_871X("+rtw_indicate_sta_assoc_event\n"); -+ ++ +#ifndef CONFIG_IOCTL_CFG80211 + wireless_send_event(padapter->pnetdev, IWEVREGISTERED, &wrqu, NULL); +#endif @@ -367128,18 +174539,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + + if(pstapriv->sta_aid[psta->aid - 1] != psta) + return; -+ -+ -+ wrqu.addr.sa_family = ARPHRD_ETHER; -+ ++ ++ ++ wrqu.addr.sa_family = ARPHRD_ETHER; ++ + _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN); + + DBG_871X("+rtw_indicate_sta_disassoc_event\n"); -+ ++ +#ifndef CONFIG_IOCTL_CFG80211 + wireless_send_event(padapter->pnetdev, IWEVEXPIRED, &wrqu, NULL); +#endif -+ ++ +} + + @@ -367163,14 +174574,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + + + init_usb_anchor(&phostapdpriv->anchored); -+ -+ rtw_netif_wake_queue(pnetdev); ++ ++ if(!rtw_netif_queue_stopped(pnetdev)) ++ rtw_netif_start_queue(pnetdev); ++ else ++ rtw_netif_wake_queue(pnetdev); ++ + + netif_carrier_on(pnetdev); -+ -+ //rtw_write16(phostapdpriv->padapter, 0x0116, 0x0100);//only excluding beacon -+ -+ return 0; ++ ++ //rtw_write16(phostapdpriv->padapter, 0x0116, 0x0100);//only excluding beacon ++ ++ return 0; +} +static int mgnt_netdev_close(struct net_device *pnetdev) +{ @@ -367182,11 +174597,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + + netif_carrier_off(pnetdev); + -+ rtw_netif_stop_queue(pnetdev); ++ if (!rtw_netif_queue_stopped(pnetdev)) ++ rtw_netif_stop_queue(pnetdev); + + //rtw_write16(phostapdpriv->padapter, 0x0116, 0x3f3f); -+ -+ return 0; ++ ++ return 0; +} + +#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) @@ -367205,8 +174621,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + unsigned char mac[ETH_ALEN]; + struct hostapd_priv *phostapdpriv; + struct net_device *pnetdev; -+ -+ pnetdev = rtw_alloc_etherdev(sizeof(struct hostapd_priv)); ++ ++ pnetdev = rtw_alloc_etherdev(sizeof(struct hostapd_priv)); + if (!pnetdev) + return -ENOMEM; + @@ -367214,49 +174630,49 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + ether_setup(pnetdev); + + //pnetdev->type = ARPHRD_IEEE80211; -+ ++ + phostapdpriv = rtw_netdev_priv(pnetdev); + phostapdpriv->pmgnt_netdev = pnetdev; + phostapdpriv->padapter= padapter; + padapter->phostapdpriv = phostapdpriv; -+ ++ + //pnetdev->init = NULL; -+ ++ +#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) + + DBG_871X("register rtl871x_mgnt_netdev_ops to netdev_ops\n"); + + pnetdev->netdev_ops = &rtl871x_mgnt_netdev_ops; -+ ++ +#else + + pnetdev->open = mgnt_netdev_open; + -+ pnetdev->stop = mgnt_netdev_close; -+ ++ pnetdev->stop = mgnt_netdev_close; ++ + pnetdev->hard_start_xmit = mgnt_xmit_entry; -+ ++ + //pnetdev->set_mac_address = r871x_net_set_mac_address; -+ ++ + //pnetdev->get_stats = r871x_net_get_stats; + + //pnetdev->do_ioctl = r871x_mp_ioctl; -+ ++ +#endif + -+ pnetdev->watchdog_timeo = HZ; /* 1 second timeout */ ++ pnetdev->watchdog_timeo = HZ; /* 1 second timeout */ + + //pnetdev->wireless_handlers = NULL; + +#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX + pnetdev->features |= NETIF_F_IP_CSUM; -+#endif ++#endif ++ ++ + -+ -+ + if(dev_alloc_name(pnetdev,"mgnt.wlan%d") < 0) + { -+ DBG_871X("hostapd_mode_init(): dev_alloc_name, fail! \n"); ++ DBG_871X("hostapd_mode_init(): dev_alloc_name, fail! \n"); + } + + @@ -367269,9 +174685,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + mac[3]=0x87; + mac[4]=0x11; + mac[5]=0x12; -+ ++ + _rtw_memcpy(pnetdev->dev_addr, mac, ETH_ALEN); -+ ++ + + netif_carrier_off(pnetdev); + @@ -367280,15 +174696,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + if (register_netdev(pnetdev) != 0) + { + DBG_871X("hostapd_mode_init(): register_netdev fail!\n"); -+ ++ + if(pnetdev) -+ { ++ { + rtw_free_netdev(pnetdev); -+ } ++ } + } -+ ++ + return 0; -+ ++ +} + +void hostapd_mode_unload(_adapter *padapter) @@ -367298,16 +174714,1255 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/mlme_linux.c linux/3rdparty + + unregister_netdev(pnetdev); + rtw_free_netdev(pnetdev); -+ ++ +} + +#endif +#endif +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/osdep_service.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/osdep_service.c +--- linux-4.14.17/3rdparty/rtl8812au/os_dep/osdep_service.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/osdep_service.c 2018-02-06 17:42:30.725967387 +0200 +@@ -0,0 +1,1236 @@ ++/****************************************************************************** ++ * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. ++ * ++ ******************************************************************************/ + -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/rtl8812au/os_dep/linux/os_intfs.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/os_intfs.c 2017-06-07 23:07:21.047690856 +0300 -@@ -0,0 +1,4417 @@ ++ ++#define _OSDEP_SERVICE_C_ ++ ++#include ++ ++#define RT_TAG '1178' ++ ++#ifdef DBG_MEMORY_LEAK ++atomic_t _malloc_cnt = ATOMIC_INIT(0); ++atomic_t _malloc_size = ATOMIC_INIT(0); ++#endif /* DBG_MEMORY_LEAK */ ++ ++/* ++* Translate the OS dependent @param error_code to OS independent RTW_STATUS_CODE ++* @return: one of RTW_STATUS_CODE ++*/ ++inline int RTW_STATUS_CODE(int error_code){ ++ if(error_code >=0) ++ return _SUCCESS; ++ ++ switch(error_code) { ++ //case -ETIMEDOUT: ++ // return RTW_STATUS_TIMEDOUT; ++ default: ++ return _FAIL; ++ } ++} ++ ++u32 rtw_atoi(u8* s) ++{ ++ ++ int num=0,flag=0; ++ int i; ++ for(i=0;i<=strlen(s);i++) ++ { ++ if(s[i] >= '0' && s[i] <= '9') ++ num = num * 10 + s[i] -'0'; ++ else if(s[0] == '-' && i==0) ++ flag =1; ++ else ++ break; ++ } ++ ++ if(flag == 1) ++ num = num * -1; ++ ++ return(num); ++ ++} ++ ++inline u8* _rtw_vmalloc(u32 sz) ++{ ++ u8 *pbuf; ++ pbuf = vmalloc(sz); ++#ifdef DBG_MEMORY_LEAK ++ if ( pbuf != NULL) { ++ atomic_inc(&_malloc_cnt); ++ atomic_add(sz, &_malloc_size); ++ } ++#endif /* DBG_MEMORY_LEAK */ ++ ++ return pbuf; ++} ++ ++inline u8* _rtw_zvmalloc(u32 sz) ++{ ++ u8 *pbuf; ++ pbuf = _rtw_vmalloc(sz); ++ if (pbuf != NULL) ++ memset(pbuf, 0, sz); ++ return pbuf; ++} ++ ++inline void _rtw_vmfree(u8 *pbuf, u32 sz) ++{ ++ vfree(pbuf); ++#ifdef DBG_MEMORY_LEAK ++ atomic_dec(&_malloc_cnt); ++ atomic_sub(sz, &_malloc_size); ++#endif /* DBG_MEMORY_LEAK */ ++} ++ ++u8* _rtw_malloc(u32 sz) ++{ ++ ++ u8 *pbuf=NULL; ++ ++ pbuf = kmalloc(sz,in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); ++ ++#ifdef DBG_MEMORY_LEAK ++ if ( pbuf != NULL) { ++ atomic_inc(&_malloc_cnt); ++ atomic_add(sz, &_malloc_size); ++ } ++#endif /* DBG_MEMORY_LEAK */ ++ ++ return pbuf; ++} ++ ++u8* _rtw_zmalloc(u32 sz) ++{ ++ u8 *pbuf = _rtw_malloc(sz); ++ ++ if (pbuf != NULL) { ++ memset(pbuf, 0, sz); ++ } ++ return pbuf; ++} ++ ++void _rtw_mfree(u8 *pbuf, u32 sz) ++{ ++ kfree(pbuf); ++#ifdef DBG_MEMORY_LEAK ++ atomic_dec(&_malloc_cnt); ++ atomic_sub(sz, &_malloc_size); ++#endif /* DBG_MEMORY_LEAK */ ++} ++ ++#ifdef DBG_MEM_ALLOC ++ ++struct rtw_dbg_mem_stat { ++ ATOMIC_T vir_alloc; // the memory bytes we allocate now ++ ATOMIC_T vir_peak; // the peak memory bytes we allocate ++ ATOMIC_T vir_alloc_err; // the error times we fail to allocate memory ++ ++ ATOMIC_T phy_alloc; ++ ATOMIC_T phy_peak; ++ ATOMIC_T phy_alloc_err; ++ ++ ATOMIC_T tx_alloc; ++ ATOMIC_T tx_peak; ++ ATOMIC_T tx_alloc_err; ++ ++ ATOMIC_T rx_alloc; ++ ATOMIC_T rx_peak; ++ ATOMIC_T rx_alloc_err; ++} rtw_dbg_mem_stat; ++ ++void rtw_dump_mem_stat (void) ++{ ++ int vir_alloc, vir_peak, vir_alloc_err, phy_alloc, phy_peak, phy_alloc_err; ++ int tx_alloc, tx_peak, tx_alloc_err, rx_alloc, rx_peak, rx_alloc_err; ++ ++ vir_alloc=ATOMIC_READ(&rtw_dbg_mem_stat.vir_alloc); ++ vir_peak=ATOMIC_READ(&rtw_dbg_mem_stat.vir_peak); ++ vir_alloc_err=ATOMIC_READ(&rtw_dbg_mem_stat.vir_alloc_err); ++ ++ phy_alloc=ATOMIC_READ(&rtw_dbg_mem_stat.phy_alloc); ++ phy_peak=ATOMIC_READ(&rtw_dbg_mem_stat.phy_peak); ++ phy_alloc_err=ATOMIC_READ(&rtw_dbg_mem_stat.phy_alloc_err); ++ ++ tx_alloc=ATOMIC_READ(&rtw_dbg_mem_stat.tx_alloc); ++ tx_peak=ATOMIC_READ(&rtw_dbg_mem_stat.tx_peak); ++ tx_alloc_err=ATOMIC_READ(&rtw_dbg_mem_stat.tx_alloc_err); ++ ++ rx_alloc=ATOMIC_READ(&rtw_dbg_mem_stat.rx_alloc); ++ rx_peak=ATOMIC_READ(&rtw_dbg_mem_stat.rx_peak); ++ rx_alloc_err=ATOMIC_READ(&rtw_dbg_mem_stat.rx_alloc_err); ++ ++ DBG_871X( "vir_alloc:%d, vir_peak:%d, vir_alloc_err:%d\n" ++ "phy_alloc:%d, phy_peak:%d, phy_alloc_err:%d\n" ++ "tx_alloc:%d, tx_peak:%d, tx_alloc_err:%d\n" ++ "rx_alloc:%d, rx_peak:%d, rx_alloc_err:%d\n" ++ , vir_alloc, vir_peak, vir_alloc_err ++ , phy_alloc, phy_peak, phy_alloc_err ++ , tx_alloc, tx_peak, tx_alloc_err ++ , rx_alloc, rx_peak, rx_alloc_err ++ ); ++} ++ ++void rtw_update_mem_stat(u8 flag, u32 sz) ++{ ++ static u32 update_time = 0; ++ int peak, alloc; ++ ++ if(!update_time) { ++ ATOMIC_SET(&rtw_dbg_mem_stat.vir_alloc,0); ++ ATOMIC_SET(&rtw_dbg_mem_stat.vir_peak,0); ++ ATOMIC_SET(&rtw_dbg_mem_stat.vir_alloc_err,0); ++ ATOMIC_SET(&rtw_dbg_mem_stat.phy_alloc,0); ++ ATOMIC_SET(&rtw_dbg_mem_stat.phy_peak,0); ++ ATOMIC_SET(&rtw_dbg_mem_stat.phy_alloc_err,0); ++ } ++ ++ switch(flag) { ++ case MEM_STAT_VIR_ALLOC_SUCCESS: ++ alloc = ATOMIC_ADD_RETURN(&rtw_dbg_mem_stat.vir_alloc, sz); ++ peak=ATOMIC_READ(&rtw_dbg_mem_stat.vir_peak); ++ if (peak 5000) { ++ rtw_dump_mem_stat(); ++ update_time=rtw_get_current_time(); ++ } ++ ++ ++} ++ ++ ++inline u8* dbg_rtw_vmalloc(u32 sz, const char *func, int line) ++{ ++ u8 *p; ++ //DBG_871X("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); ++ ++ p=_rtw_vmalloc((sz)); ++ ++ rtw_update_mem_stat( ++ p ? MEM_STAT_VIR_ALLOC_SUCCESS : MEM_STAT_VIR_ALLOC_FAIL ++ , sz ++ ); ++ ++ return p; ++} ++ ++inline u8* dbg_rtw_zvmalloc(u32 sz, const char *func, int line) ++{ ++ u8 *p; ++ //DBG_871X("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); ++ ++ p=_rtw_zvmalloc((sz)); ++ ++ rtw_update_mem_stat( ++ p ? MEM_STAT_VIR_ALLOC_SUCCESS : MEM_STAT_VIR_ALLOC_FAIL ++ , sz ++ ); ++ ++ return p; ++} ++ ++inline void dbg_rtw_vmfree(u8 *pbuf, u32 sz, const char *func, int line) ++{ ++ //DBG_871X("DBG_MEM_ALLOC %s:%d %s(%p,%d)\n", func, line, __FUNCTION__, (pbuf), (sz)); ++ ++ _rtw_vmfree((pbuf), (sz)); ++ ++ rtw_update_mem_stat( ++ MEM_STAT_VIR_FREE ++ , sz ++ ); ++ ++} ++ ++inline u8* dbg_rtw_malloc(u32 sz, const char *func, int line) ++{ ++ u8 *p; ++ ++ if((sz)>4096) ++ DBG_871X("DBG_MEM_ALLOC !!!!!!!!!!!!!! %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); ++ ++ p=_rtw_malloc((sz)); ++ ++ rtw_update_mem_stat( ++ p ? MEM_STAT_PHY_ALLOC_SUCCESS : MEM_STAT_PHY_ALLOC_FAIL ++ , sz ++ ); ++ ++ return p; ++} ++ ++inline u8* dbg_rtw_zmalloc(u32 sz, const char *func, int line) ++{ ++ u8 *p; ++ ++ if((sz)>4096) ++ DBG_871X("DBG_MEM_ALLOC !!!!!!!!!!!!!! %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); ++ ++ p = _rtw_zmalloc((sz)); ++ ++ rtw_update_mem_stat( ++ p ? MEM_STAT_PHY_ALLOC_SUCCESS : MEM_STAT_PHY_ALLOC_FAIL ++ , sz ++ ); ++ ++ return p; ++ ++} ++ ++inline void dbg_rtw_mfree(u8 *pbuf, u32 sz, const char *func, int line) ++{ ++ if((sz)>4096) ++ DBG_871X("DBG_MEM_ALLOC !!!!!!!!!!!!!! %s:%d %s(%p,%d)\n", func, line, __FUNCTION__, (pbuf), (sz)); ++ ++ _rtw_mfree((pbuf), (sz)); ++ ++ rtw_update_mem_stat( ++ MEM_STAT_PHY_FREE ++ , sz ++ ); ++} ++#endif ++ ++void* rtw_malloc2d(int h, int w, int size) ++{ ++ int j; ++ ++ void **a = (void **) rtw_zmalloc( h*sizeof(void *) + h*w*size ); ++ if(a == NULL) ++ { ++ DBG_871X("%s: alloc memory fail!\n", __FUNCTION__); ++ return NULL; ++ } ++ ++ for( j=0; jpnetdev, pfunc, adapter); ++} ++#endif ++ ++/* ++ ++Caller must check if the list is empty before calling rtw_list_delete ++ ++*/ ++ ++ ++void _rtw_init_sema(_sema *sema, int init_val) ++{ ++ sema_init(sema, init_val); ++} ++ ++void _rtw_free_sema(_sema *sema) ++{ ++} ++ ++void _rtw_up_sema(_sema *sema) ++{ ++ up(sema); ++} ++ ++u32 _rtw_down_sema(_sema *sema) ++{ ++ if (down_interruptible(sema)) ++ return _FAIL; ++ else ++ return _SUCCESS; ++} ++ ++void _rtw_mutex_init(_mutex *pmutex) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) ++ mutex_init(pmutex); ++#else ++ init_MUTEX(pmutex); ++#endif ++} ++ ++void _rtw_mutex_free(_mutex *pmutex) ++{ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) ++ mutex_destroy(pmutex); ++#endif ++} ++ ++void _rtw_spinlock_init(_lock *plock) ++{ ++ spin_lock_init(plock); ++} ++ ++void _rtw_spinlock_free(_lock *plock) ++{ ++} ++ ++void _rtw_spinlock(_lock *plock) ++{ ++ spin_lock(plock); ++} ++ ++void _rtw_spinunlock(_lock *plock) ++{ ++ spin_unlock(plock); ++} ++ ++void _rtw_spinlock_ex(_lock *plock) ++{ ++ spin_lock(plock); ++} ++ ++void _rtw_spinunlock_ex(_lock *plock) ++{ ++ spin_unlock(plock); ++} ++ ++void _rtw_init_queue(_queue *pqueue) ++{ ++ ++ _rtw_init_listhead(&(pqueue->queue)); ++ ++ _rtw_spinlock_init(&(pqueue->lock)); ++ ++} ++ ++u32 _rtw_queue_empty(_queue *pqueue) ++{ ++ return (rtw_is_list_empty(&(pqueue->queue))); ++} ++ ++ ++u32 rtw_end_of_queue_search(_list *head, _list *plist) ++{ ++ if (head == plist) ++ return true; ++ else ++ return false; ++} ++ ++ ++u32 rtw_get_current_time(void) ++{ ++ return jiffies; ++} ++ ++inline u32 rtw_systime_to_ms(u32 systime) ++{ ++ return systime * 1000 / HZ; ++} ++ ++inline u32 rtw_ms_to_systime(u32 ms) ++{ ++ return ms * HZ / 1000; ++} ++ ++// the input parameter start use the same unit as returned by rtw_get_current_time ++inline s32 rtw_get_passing_time_ms(u32 start) ++{ ++ return rtw_systime_to_ms(jiffies-start); ++} ++ ++inline s32 rtw_get_time_interval_ms(u32 start, u32 end) ++{ ++ return rtw_systime_to_ms(end-start); ++} ++ ++void rtw_sleep_schedulable(int ms) ++{ ++ u32 delta; ++ ++ delta = (ms * HZ)/1000;//(ms) ++ if (delta == 0) { ++ delta = 1;// 1 ms ++ } ++ set_current_state(TASK_INTERRUPTIBLE); ++ if (schedule_timeout(delta) != 0) { ++ return ; ++ } ++} ++ ++void rtw_msleep_os(int ms) ++{ ++ msleep((unsigned int)ms); ++} ++ ++void rtw_usleep_os(int us) ++{ ++ if ( 1 < (us/1000) ) ++ msleep(1); ++ else ++ msleep( (us/1000) + 1); ++} ++ ++#ifdef DBG_DELAY_OS ++void _rtw_mdelay_os(int ms, const char *func, const int line) ++{ ++ DBG_871X("%s:%d %s(%d)\n", func, line, __FUNCTION__, ms); ++ ++ mdelay((unsigned long)ms); ++} ++ ++void _rtw_udelay_os(int us, const char *func, const int line) ++{ ++ DBG_871X("%s:%d %s(%d)\n", func, line, __FUNCTION__, us); ++ ++ udelay((unsigned long)us); ++} ++#else ++void rtw_mdelay_os(int ms) ++{ ++ mdelay((unsigned long)ms); ++} ++ ++void rtw_udelay_os(int us) ++{ ++ udelay((unsigned long)us); ++} ++#endif ++ ++void rtw_yield_os(void) ++{ ++ yield(); ++} ++ ++#define RTW_SUSPEND_LOCK_NAME "rtw_wifi" ++ ++#ifdef CONFIG_WAKELOCK ++static struct wake_lock rtw_suspend_lock; ++#elif defined(CONFIG_ANDROID_POWER) ++static android_suspend_lock_t rtw_suspend_lock ={ ++ .name = RTW_SUSPEND_LOCK_NAME ++}; ++#endif ++ ++void rtw_suspend_lock_init(void) ++{ ++ #ifdef CONFIG_WAKELOCK ++ wake_lock_init(&rtw_suspend_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_LOCK_NAME); ++ #elif defined(CONFIG_ANDROID_POWER) ++ android_init_suspend_lock(&rtw_suspend_lock); ++ #endif ++} ++ ++void rtw_suspend_lock_uninit(void) ++{ ++ #ifdef CONFIG_WAKELOCK ++ wake_lock_destroy(&rtw_suspend_lock); ++ #elif defined(CONFIG_ANDROID_POWER) ++ android_uninit_suspend_lock(&rtw_suspend_lock); ++ #endif ++} ++ ++void rtw_lock_suspend(void) ++{ ++ #ifdef CONFIG_WAKELOCK ++ wake_lock(&rtw_suspend_lock); ++ #elif defined(CONFIG_ANDROID_POWER) ++ android_lock_suspend(&rtw_suspend_lock); ++ #endif ++ ++ #if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) ++ //DBG_871X("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); ++ #endif ++} ++ ++void rtw_unlock_suspend(void) ++{ ++ #ifdef CONFIG_WAKELOCK ++ wake_unlock(&rtw_suspend_lock); ++ #elif defined(CONFIG_ANDROID_POWER) ++ android_unlock_suspend(&rtw_suspend_lock); ++ #endif ++ ++ #if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) ++ //DBG_871X("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); ++ #endif ++} ++ ++#ifdef CONFIG_WOWLAN ++void rtw_lock_suspend_timeout(long timeout) ++{ ++ #ifdef CONFIG_WAKELOCK ++ wake_lock_timeout(&rtw_suspend_lock, timeout); ++ #elif defined(CONFIG_ANDROID_POWER) ++ android_lock_suspend_auto_expire(&rtw_suspend_lock, timeout); ++ #endif ++} ++#endif //CONFIG_WOWLAN ++ ++inline void ATOMIC_SET(ATOMIC_T *v, int i) ++{ ++ atomic_set(v,i); ++} ++ ++inline int ATOMIC_READ(ATOMIC_T *v) ++{ ++ return atomic_read(v); ++} ++ ++inline void ATOMIC_ADD(ATOMIC_T *v, int i) ++{ ++ atomic_add(i,v); ++} ++ ++inline void ATOMIC_SUB(ATOMIC_T *v, int i) ++{ ++ atomic_sub(i,v); ++} ++ ++inline void ATOMIC_INC(ATOMIC_T *v) ++{ ++ atomic_inc(v); ++} ++ ++inline void ATOMIC_DEC(ATOMIC_T *v) ++{ ++ atomic_dec(v); ++} ++ ++inline int ATOMIC_ADD_RETURN(ATOMIC_T *v, int i) ++{ ++ return atomic_add_return(i,v); ++} ++ ++inline int ATOMIC_SUB_RETURN(ATOMIC_T *v, int i) ++{ ++ return atomic_sub_return(i,v); ++} ++ ++inline int ATOMIC_INC_RETURN(ATOMIC_T *v) ++{ ++ return atomic_inc_return(v); ++} ++ ++inline int ATOMIC_DEC_RETURN(ATOMIC_T *v) ++{ ++ return atomic_dec_return(v); ++} ++ ++/* ++* Open a file with the specific @param path, @param flag, @param mode ++* @param fpp the pointer of struct file pointer to get struct file pointer while file opening is success ++* @param path the path of the file to open ++* @param flag file operation flags, please refer to linux document ++* @param mode please refer to linux document ++* @return Linux specific error code ++*/ ++static int openFile(struct file **fpp, char *path, int flag, int mode) ++{ ++ struct file *fp; ++ ++ fp=filp_open(path, flag, mode); ++ if(IS_ERR(fp)) { ++ *fpp=NULL; ++ return PTR_ERR(fp); ++ } ++ else { ++ *fpp=fp; ++ return 0; ++ } ++} ++ ++/* ++* Close the file with the specific @param fp ++* @param fp the pointer of struct file to close ++* @return always 0 ++*/ ++static int closeFile(struct file *fp) ++{ ++ filp_close(fp,NULL); ++ return 0; ++} ++ ++static int readFile(struct file *fp,char *buf,int len) ++{ ++ int rlen=0, sum=0; ++ ++ if (!fp->f_op || !fp->f_op->read) ++ return -EPERM; ++ ++ while(sumf_op->read(fp,buf+sum,len-sum, &fp->f_pos); ++ if(rlen>0) ++ sum+=rlen; ++ else if(0 != rlen) ++ return rlen; ++ else ++ break; ++ } ++ ++ return sum; ++ ++} ++ ++static int writeFile(struct file *fp,char *buf,int len) ++{ ++ int wlen=0, sum=0; ++ ++ if (!fp->f_op || !fp->f_op->write) ++ return -EPERM; ++ ++ while(sumf_op->write(fp,buf+sum,len-sum, &fp->f_pos); ++ if(wlen>0) ++ sum+=wlen; ++ else if(0 != wlen) ++ return wlen; ++ else ++ break; ++ } ++ ++ return sum; ++ ++} ++ ++/* ++* Test if the specifi @param path is a file and readable ++* @param path the path of the file to test ++* @return Linux specific error code ++*/ ++static int isFileReadable(char *path) ++{ ++ struct file *fp; ++ int ret = 0; ++ mm_segment_t oldfs; ++ char buf; ++ ++ fp=filp_open(path, O_RDONLY, 0); ++ if(IS_ERR(fp)) { ++ ret = PTR_ERR(fp); ++ } ++ else { ++ oldfs = get_fs(); set_fs(get_ds()); ++ ++ if(1!=readFile(fp, &buf, 1)) ++ ret = PTR_ERR(fp); ++ ++ set_fs(oldfs); ++ filp_close(fp,NULL); ++ } ++ return ret; ++} ++ ++/* ++* Open the file with @param path and retrive the file content into memory starting from @param buf for @param sz at most ++* @param path the path of the file to open and read ++* @param buf the starting address of the buffer to store file content ++* @param sz how many bytes to read at most ++* @return the byte we've read, or Linux specific error code ++*/ ++static int retriveFromFile(char *path, u8* buf, u32 sz) ++{ ++ int ret =-1; ++ mm_segment_t oldfs; ++ struct file *fp; ++ ++ if(path && buf) { ++ if( 0 == (ret=openFile(&fp,path, O_RDONLY, 0)) ){ ++ DBG_871X("%s openFile path:%s fp=%p\n",__FUNCTION__, path ,fp); ++ ++ oldfs = get_fs(); set_fs(get_ds()); ++ ret=readFile(fp, buf, sz); ++ set_fs(oldfs); ++ closeFile(fp); ++ ++ DBG_871X("%s readFile, ret:%d\n",__FUNCTION__, ret); ++ ++ } else { ++ DBG_871X("%s openFile path:%s Fail, ret:%d\n",__FUNCTION__, path, ret); ++ } ++ } else { ++ DBG_871X("%s NULL pointer\n",__FUNCTION__); ++ ret = -EINVAL; ++ } ++ return ret; ++} ++ ++/* ++* Open the file with @param path and wirte @param sz byte of data starting from @param buf into the file ++* @param path the path of the file to open and write ++* @param buf the starting address of the data to write into file ++* @param sz how many bytes to write at most ++* @return the byte we've written, or Linux specific error code ++*/ ++static int storeToFile(char *path, u8* buf, u32 sz) ++{ ++ int ret =0; ++ mm_segment_t oldfs; ++ struct file *fp; ++ ++ if(path && buf) { ++ if( 0 == (ret=openFile(&fp, path, O_CREAT|O_WRONLY, 0666)) ) { ++ DBG_871X("%s openFile path:%s fp=%p\n",__FUNCTION__, path ,fp); ++ ++ oldfs = get_fs(); set_fs(get_ds()); ++ ret=writeFile(fp, buf, sz); ++ set_fs(oldfs); ++ closeFile(fp); ++ ++ DBG_871X("%s writeFile, ret:%d\n",__FUNCTION__, ret); ++ ++ } else { ++ DBG_871X("%s openFile path:%s Fail, ret:%d\n",__FUNCTION__, path, ret); ++ } ++ } else { ++ DBG_871X("%s NULL pointer\n",__FUNCTION__); ++ ret = -EINVAL; ++ } ++ return ret; ++} ++ ++/* ++* Test if the specifi @param path is a file and readable ++* @param path the path of the file to test ++* @return true or false ++*/ ++int rtw_is_file_readable(char *path) ++{ ++ if(isFileReadable(path) == 0) ++ return true; ++ else ++ return false; ++} ++ ++/* ++* Open the file with @param path and retrive the file content into memory starting from @param buf for @param sz at most ++* @param path the path of the file to open and read ++* @param buf the starting address of the buffer to store file content ++* @param sz how many bytes to read at most ++* @return the byte we've read ++*/ ++int rtw_retrive_from_file(char *path, u8* buf, u32 sz) ++{ ++ int ret =retriveFromFile(path, buf, sz); ++ return ret>=0?ret:0; ++} ++ ++/* ++* Open the file with @param path and wirte @param sz byte of data starting from @param buf into the file ++* @param path the path of the file to open and write ++* @param buf the starting address of the data to write into file ++* @param sz how many bytes to write at most ++* @return the byte we've written ++*/ ++int rtw_store_to_file(char *path, u8* buf, u32 sz) ++{ ++ int ret =storeToFile(path, buf, sz); ++ return ret>=0?ret:0; ++} ++ ++struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv) ++{ ++ struct net_device *pnetdev; ++ struct rtw_netdev_priv_indicator *pnpi; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) ++ pnetdev = alloc_etherdev_mq(sizeof(struct rtw_netdev_priv_indicator), 4); ++#else ++ pnetdev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); ++#endif ++ if (!pnetdev) ++ goto RETURN; ++ ++ pnpi = netdev_priv(pnetdev); ++ pnpi->priv=old_priv; ++ pnpi->sizeof_priv=sizeof_priv; ++ ++RETURN: ++ return pnetdev; ++} ++ ++struct net_device *rtw_alloc_etherdev(int sizeof_priv) ++{ ++ struct net_device *pnetdev; ++ struct rtw_netdev_priv_indicator *pnpi; ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) ++ pnetdev = alloc_etherdev_mq(sizeof(struct rtw_netdev_priv_indicator), 4); ++#else ++ pnetdev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); ++#endif ++ if (!pnetdev) ++ goto RETURN; ++ ++ pnpi = netdev_priv(pnetdev); ++ ++ pnpi->priv = rtw_zvmalloc(sizeof_priv); ++ if (!pnpi->priv) { ++ free_netdev(pnetdev); ++ pnetdev = NULL; ++ goto RETURN; ++ } ++ ++ pnpi->sizeof_priv=sizeof_priv; ++RETURN: ++ return pnetdev; ++} ++ ++void rtw_free_netdev(struct net_device * netdev) ++{ ++ struct rtw_netdev_priv_indicator *pnpi; ++ ++ if(!netdev) ++ goto RETURN; ++ ++ pnpi = netdev_priv(netdev); ++ ++ if(!pnpi->priv) ++ goto RETURN; ++ ++ rtw_vmfree(pnpi->priv, pnpi->sizeof_priv); ++ free_netdev(netdev); ++ ++RETURN: ++ return; ++} ++ ++/* ++* Jeff: this function should be called under ioctl (rtnl_lock is accquired) while ++* LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26) ++*/ ++int rtw_change_ifname(_adapter *padapter, const char *ifname) ++{ ++ struct net_device *pnetdev; ++ struct net_device *cur_pnetdev = padapter->pnetdev; ++ struct rereg_nd_name_data *rereg_priv; ++ int ret; ++ ++ if(!padapter) ++ goto error; ++ ++ rereg_priv = &padapter->rereg_nd_name_priv; ++ ++ //free the old_pnetdev ++ if(rereg_priv->old_pnetdev) { ++ free_netdev(rereg_priv->old_pnetdev); ++ rereg_priv->old_pnetdev = NULL; ++ } ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,26)) ++ if(!rtnl_is_locked()) ++ unregister_netdev(cur_pnetdev); ++ else ++#endif ++ unregister_netdevice(cur_pnetdev); ++ ++ rtw_proc_remove_one(cur_pnetdev); ++ ++ rereg_priv->old_pnetdev=cur_pnetdev; ++ ++ pnetdev = rtw_init_netdev(padapter); ++ if (!pnetdev) { ++ ret = -1; ++ goto error; ++ } ++ ++ SET_NETDEV_DEV(pnetdev, dvobj_to_dev(adapter_to_dvobj(padapter))); ++ ++ rtw_init_netdev_name(pnetdev, ifname); ++ ++ _rtw_memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN); ++ ++#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,26)) ++ if(!rtnl_is_locked()) ++ ret = register_netdev(pnetdev); ++ else ++#endif ++ ret = register_netdevice(pnetdev); ++ ++ if ( ret != 0) { ++ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("register_netdev() failed\n")); ++ goto error; ++ } ++ ++ rtw_proc_init_one(pnetdev); ++ ++ return 0; ++ ++error: ++ ++ return -1; ++ ++} ++ ++u64 rtw_modular64(u64 x, u64 y) ++{ ++ return do_div(x, y); ++} ++ ++u64 rtw_division64(u64 x, u64 y) ++{ ++ do_div(x, y); ++ return x; ++} ++ ++void rtw_buf_free(u8 **buf, u32 *buf_len) ++{ ++ u32 ori_len; ++ ++ if (!buf || !buf_len) ++ return; ++ ++ ori_len = *buf_len; ++ ++ if (*buf) { ++ *buf_len = 0; ++ _rtw_mfree(*buf, *buf_len); ++ *buf = NULL; ++ } ++} ++ ++void rtw_buf_update(u8 **buf, u32 *buf_len, u8 *src, u32 src_len) ++{ ++ u32 ori_len = 0, dup_len = 0; ++ u8 *ori = NULL; ++ u8 *dup = NULL; ++ ++ if (!buf || !buf_len) ++ return; ++ ++ if (!src || !src_len) ++ goto keep_ori; ++ ++ /* duplicate src */ ++ dup = rtw_malloc(src_len); ++ if (dup) { ++ dup_len = src_len; ++ _rtw_memcpy(dup, src, dup_len); ++ } ++ ++keep_ori: ++ ori = *buf; ++ ori_len = *buf_len; ++ ++ /* replace buf with dup */ ++ *buf_len = 0; ++ *buf = dup; ++ *buf_len = dup_len; ++ ++ /* free ori */ ++ if (ori && ori_len > 0) ++ _rtw_mfree(ori, ori_len); ++} ++ ++ ++/** ++ * rtw_cbuf_full - test if cbuf is full ++ * @cbuf: pointer of struct rtw_cbuf ++ * ++ * Returns: true if cbuf is full ++ */ ++inline bool rtw_cbuf_full(struct rtw_cbuf *cbuf) ++{ ++ return (cbuf->write == cbuf->read-1)? true : false; ++} ++ ++/** ++ * rtw_cbuf_empty - test if cbuf is empty ++ * @cbuf: pointer of struct rtw_cbuf ++ * ++ * Returns: true if cbuf is empty ++ */ ++inline bool rtw_cbuf_empty(struct rtw_cbuf *cbuf) ++{ ++ return (cbuf->write == cbuf->read)? true : false; ++} ++ ++/** ++ * rtw_cbuf_push - push a pointer into cbuf ++ * @cbuf: pointer of struct rtw_cbuf ++ * @buf: pointer to push in ++ * ++ * Lock free operation, be careful of the use scheme ++ * Returns: true push success ++ */ ++bool rtw_cbuf_push(struct rtw_cbuf *cbuf, void *buf) ++{ ++ if (rtw_cbuf_full(cbuf)) ++ return _FAIL; ++ ++ if (0) ++ DBG_871X("%s on %u\n", __func__, cbuf->write); ++ cbuf->bufs[cbuf->write] = buf; ++ cbuf->write = (cbuf->write+1)%cbuf->size; ++ ++ return _SUCCESS; ++} ++ ++/** ++ * rtw_cbuf_pop - pop a pointer from cbuf ++ * @cbuf: pointer of struct rtw_cbuf ++ * ++ * Lock free operation, be careful of the use scheme ++ * Returns: pointer popped out ++ */ ++void *rtw_cbuf_pop(struct rtw_cbuf *cbuf) ++{ ++ void *buf; ++ if (rtw_cbuf_empty(cbuf)) ++ return NULL; ++ ++ if (0) ++ DBG_871X("%s on %u\n", __func__, cbuf->read); ++ buf = cbuf->bufs[cbuf->read]; ++ cbuf->read = (cbuf->read+1)%cbuf->size; ++ ++ return buf; ++} ++ ++/** ++ * rtw_cbuf_alloc - allocte a rtw_cbuf with given size and do initialization ++ * @size: size of pointer ++ * ++ * Returns: pointer of srtuct rtw_cbuf, NULL for allocation failure ++ */ ++struct rtw_cbuf *rtw_cbuf_alloc(u32 size) ++{ ++ struct rtw_cbuf *cbuf; ++ ++ cbuf = (struct rtw_cbuf *)rtw_malloc(sizeof(*cbuf) + sizeof(void*)*size); ++ ++ if (cbuf) { ++ cbuf->write = cbuf->read = 0; ++ cbuf->size = size; ++ } ++ ++ return cbuf; ++} ++ ++/** ++ * rtw_cbuf_free - free the given rtw_cbuf ++ * @cbuf: pointer of struct rtw_cbuf to free ++ */ ++void rtw_cbuf_free(struct rtw_cbuf *cbuf) ++{ ++ rtw_mfree((u8*)cbuf, sizeof(*cbuf) + sizeof(void*)*cbuf->size); ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/os_intfs.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/os_intfs.c +--- linux-4.14.17/3rdparty/rtl8812au/os_dep/os_intfs.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/os_intfs.c 2018-02-06 17:42:30.725967387 +0200 +@@ -0,0 +1,2756 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -367321,23 +175976,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _OS_INTFS_C_ + +#include -+#include -+ -+#if defined (PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+ -+#error "Shall be Linux or Windows, but not both!\n" -+ -+#endif -+ + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Realtek Wireless Lan Driver"); @@ -367345,172 +175987,157 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +MODULE_VERSION(DRIVERVERSION); + +/* module param defaults */ -+int rtw_chip_version = 0x00; -+int rtw_rfintfs = HWPI; -+int rtw_lbkmode = 0;//RTL8712_AIR_TRX; ++static int rtw_chip_version = 0x00; ++static int rtw_rfintfs = HWPI; ++static int rtw_lbkmode = 0;//RTL8712_AIR_TRX; + + -+int rtw_network_mode = Ndis802_11IBSS;//Ndis802_11Infrastructure;//infra, ad-hoc, auto ++static int rtw_network_mode = Ndis802_11IBSS;//Ndis802_11Infrastructure;//infra, ad-hoc, auto +//NDIS_802_11_SSID ssid; -+int rtw_channel = 1;//ad-hoc support requirement -+int rtw_wireless_mode = WIRELESS_MODE_MAX; -+int rtw_vrtl_carrier_sense = AUTO_VCS; -+int rtw_vcs_type = RTS_CTS;//* -+int rtw_rts_thresh = 2347;//* -+int rtw_frag_thresh = 2346;//* -+int rtw_preamble = PREAMBLE_LONG;//long, short, auto -+int rtw_scan_mode = 1;//active, passive -+int rtw_adhoc_tx_pwr = 1; -+int rtw_soft_ap = 0; ++static int rtw_channel = 1;//ad-hoc support requirement ++static int rtw_wireless_mode = WIRELESS_MODE_MAX; ++static int rtw_vrtl_carrier_sense = AUTO_VCS; ++static int rtw_vcs_type = RTS_CTS;//* ++static int rtw_rts_thresh = 2347;//* ++static int rtw_frag_thresh = 2346;//* ++static int rtw_preamble = PREAMBLE_LONG;//long, short, auto ++static int rtw_scan_mode = 1;//active, passive ++static int rtw_adhoc_tx_pwr = 1; ++static int rtw_soft_ap = 0; +//int smart_ps = 1; +#ifdef CONFIG_POWER_SAVING -+int rtw_power_mgnt = PS_MODE_MAX; ++static int rtw_power_mgnt = 1; +#ifdef CONFIG_IPS_LEVEL_2 -+int rtw_ips_mode = IPS_LEVEL_2; ++static int rtw_ips_mode = IPS_LEVEL_2; +#else -+int rtw_ips_mode = IPS_NORMAL; ++static int rtw_ips_mode = IPS_NORMAL; +#endif +#else -+int rtw_power_mgnt = PS_MODE_ACTIVE; -+int rtw_ips_mode = IPS_NONE; ++static int rtw_power_mgnt = PS_MODE_ACTIVE; ++static int rtw_ips_mode = IPS_NONE; ++#endif ++ ++static int rtw_smart_ps = 2; ++ ++#ifdef CONFIG_TX_EARLY_MODE ++static int rtw_early_mode=1; +#endif +module_param(rtw_ips_mode, int, 0644); +MODULE_PARM_DESC(rtw_ips_mode,"The default IPS mode"); + -+int rtw_smart_ps = 2; -+ -+int rtw_check_fw_ps = 1; -+ -+#ifdef CONFIG_TX_EARLY_MODE -+int rtw_early_mode=1; -+#endif -+ -+int rtw_usb_rxagg_mode = 2;//USB_RX_AGG_DMA =1,USB_RX_AGG_USB=2 -+module_param(rtw_usb_rxagg_mode, int, 0644); -+ -+int rtw_radio_enable = 1; -+int rtw_long_retry_lmt = 7; -+int rtw_short_retry_lmt = 7; -+int rtw_busy_thresh = 40; ++static int rtw_radio_enable = 1; ++static int rtw_long_retry_lmt = 7; ++static int rtw_short_retry_lmt = 7; ++static int rtw_busy_thresh = 40; +//int qos_enable = 0; //* -+int rtw_ack_policy = NORMAL_ACK; ++static int rtw_ack_policy = NORMAL_ACK; + -+int rtw_mp_mode = 0; ++static int rtw_mp_mode = 0; + -+int rtw_software_encrypt = 0; -+int rtw_software_decrypt = 0; ++static int rtw_software_encrypt = 0; ++static int rtw_software_decrypt = 0; + -+int rtw_acm_method = 0;// 0:By SW 1:By HW. ++static int rtw_acm_method = 0;// 0:By SW 1:By HW. ++ ++static int rtw_wmm_enable = 1;// default is set to enable the wmm. ++static int rtw_uapsd_enable = 0; ++static int rtw_uapsd_max_sp = NO_LIMIT; ++static int rtw_uapsd_acbk_en = 0; ++static int rtw_uapsd_acbe_en = 0; ++static int rtw_uapsd_acvi_en = 0; ++static int rtw_uapsd_acvo_en = 0; + -+int rtw_wmm_enable = 1;// default is set to enable the wmm. -+int rtw_uapsd_enable = 0; -+int rtw_uapsd_max_sp = NO_LIMIT; -+int rtw_uapsd_acbk_en = 0; -+int rtw_uapsd_acbe_en = 0; -+int rtw_uapsd_acvi_en = 0; -+int rtw_uapsd_acvo_en = 0; -+#ifdef CONFIG_RTL8814A -+int rtw_rfkfree_enable = 2; /* disable kfree */ -+#else -+int rtw_rfkfree_enable = 0; /* Default Enalbe kfree by efuse config */ -+#endif +#ifdef CONFIG_80211N_HT +int rtw_ht_enable = 1; +// 0: 20 MHz, 1: 40 MHz, 2: 80 MHz, 3: 160MHz, 4: 80+80MHz +// 2.4G use bit 0 ~ 3, 5G use bit 4 ~ 7 +// 0x21 means enable 2.4G 40MHz & 5G 80MHz +int rtw_bw_mode = 0x21; -+int rtw_cbw40_enable = 3; // 0 :diable, bit(0): enable 2.4g, bit(1): enable 5g -+int rtw_ampdu_enable = 1;//for enable tx_ampdu ,// 0: disable, 0x1:enable (but wifi_spec should be 0), 0x2: force enable (don't care wifi_spec) -+int rtw_rx_stbc = 1;// 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ -+int rtw_ampdu_amsdu = 0;// 0: disabled, 1:enabled, 2:auto . There is an IOT issu with DLINK DIR-629 when the flag turn on ++static int rtw_cbw40_enable = 3; // 0 :diable, bit(0): enable 2.4g, bit(1): enable 5g ++int rtw_ampdu_enable = 1;//for enable tx_ampdu ++static int rtw_rx_stbc = 1;// 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ ++static int rtw_ampdu_amsdu = 0;// 0: disabled, 1:enabled, 2:auto +// Short GI support Bit Map -+// BIT0 - 20MHz, 0: non-support, 1: support -+// BIT1 - 40MHz, 0: non-support, 1: support -+// BIT2 - 80MHz, 0: non-support, 1: support -+// BIT3 - 160MHz, 0: non-support, 1: support -+int rtw_short_gi = 0xf; -+// BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx -+int rtw_ldpc_cap = 0x00; -+// BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx -+int rtw_stbc_cap = 0x13; -+// BIT0: Enable VHT Beamformer, BIT1: Enable VHT Beamformee, BIT4: Enable HT Beamformer, BIT5: Enable HT Beamformee -+int rtw_beamform_cap = 0x2; -+int rtw_bfer_rf_number = 0; /*BeamformerCapRfNum Rf path number, 0 for auto, others for manual*/ -+int rtw_bfee_rf_number = 0; /*BeamformeeCapRfNum Rf path number, 0 for auto, others for manual*/ -+ ++// BIT0 - 20MHz, 0: support, 1: non-support ++// BIT1 - 40MHz, 0: support, 1: non-support ++// BIT2 - 80MHz, 0: support, 1: non-support ++// BIT3 - 160MHz, 0: support, 1: non-support ++static int rtw_short_gi = 0xf; +#endif //CONFIG_80211N_HT + +#ifdef CONFIG_80211AC_VHT -+int rtw_vht_enable = 1; //0:disable, 1:enable, 2:force auto enable -+int rtw_ampdu_factor = 7; -+int rtw_vht_rate_sel = 0; ++static int rtw_vht_enable = 1; ++static int rtw_ampdu_factor = 7; ++static int rtw_vht_rate_sel = 0; ++// BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx ++static int rtw_ldpc_cap = 0x33; ++// BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx ++static int rtw_stbc_cap = 0x3; ++// BIT0: Enable VHT Beamformer, BIT1: Enable VHT Beamformee, BIT4: Enable HT Beamformer, BIT5: Enable HT Beamformee ++static int rtw_beamform_cap = 0; +#endif //CONFIG_80211AC_VHT + -+int rtw_lowrate_two_xmit = 1;//Use 2 path Tx to transmit MCS0~7 and legacy mode ++static int rtw_lowrate_two_xmit = 1;//Use 2 path Tx to transmit MCS0~7 and legacy mode + +//int rf_config = RF_1T2R; // 1T2R -+int rtw_rf_config = RF_MAX_TYPE; //auto -+ -+int rtw_low_power = 0; ++static int rtw_rf_config = RF_MAX_TYPE; //auto ++static int rtw_low_power = 0; +#ifdef CONFIG_WIFI_TEST -+int rtw_wifi_spec = 1;//for wifi test ++static int rtw_wifi_spec = 1;//for wifi test +#else -+int rtw_wifi_spec = 0; ++static int rtw_wifi_spec = 0; +#endif -+ -+int rtw_special_rf_path = 0; //0: 2T2R ,1: only turn on path A 1T1R -+ -+int rtw_channel_plan = RTW_CHPLAN_MAX; ++static int rtw_channel_plan = RT_CHANNEL_DOMAIN_MAX; + +#ifdef CONFIG_BT_COEXIST +int rtw_btcoex_enable = 1; -+module_param(rtw_btcoex_enable, int, 0644); -+MODULE_PARM_DESC(rtw_btcoex_enable, "Enable BT co-existence mechanism"); +int rtw_bt_iso = 2;// 0:Low, 1:High, 2:From Efuse +int rtw_bt_sco = 3;// 0:Idle, 1:None-SCO, 2:SCO, 3:From Counter, 4.Busy, 5.OtherBusy +int rtw_bt_ampdu =1 ;// 0:Disable BT control A-MPDU, 1:Enable BT control A-MPDU. -+int rtw_ant_num = -1; // <0: undefined, >0: Antenna number -+module_param(rtw_ant_num, int, 0644); -+MODULE_PARM_DESC(rtw_ant_num, "Antenna number setting"); +#endif + -+int rtw_AcceptAddbaReq = _TRUE;// 0:Reject AP's Add BA req, 1:Accept AP's Add BA req. ++static int rtw_AcceptAddbaReq = true;// 0:Reject AP's Add BA req, 1:Accept AP's Add BA req. + -+int rtw_antdiv_cfg = 2; // 0:OFF , 1:ON, 2:decide by Efuse config -+int rtw_antdiv_type = 0 ; //0:decide by efuse 1: for 88EE, 1Tx and 1RxCG are diversity.(2 Ant with SPDT), 2: for 88EE, 1Tx and 2Rx are diversity.( 2 Ant, Tx and RxCG are both on aux port, RxCS is on main port ), 3: for 88EE, 1Tx and 1RxCG are fixed.(1Ant, Tx and RxCG are both on aux port) ++static int rtw_antdiv_cfg = 2; // 0:OFF , 1:ON, 2:decide by Efuse config ++static int rtw_antdiv_type = 0 ; //0:decide by efuse 1: for 88EE, 1Tx and 1RxCG are diversity.(2 Ant with SPDT), 2: for 88EE, 1Tx and 2Rx are diversity.( 2 Ant, Tx and RxCG are both on aux port, RxCS is on main port ), 3: for 88EE, 1Tx and 1RxCG are fixed.(1Ant, Tx and RxCG are both on aux port) + -+/* 0: doesn't switch, 1: switch from usb2.0 to usb 3.0 2: switch from usb3.0 to usb 2.0 */ -+int rtw_switch_usb_mode = 0; + +#ifdef CONFIG_USB_AUTOSUSPEND -+int rtw_enusbss = 1;//0:disable,1:enable ++static int rtw_enusbss = 1;//0:disable,1:enable +#else -+int rtw_enusbss = 0;//0:disable,1:enable ++static int rtw_enusbss = 0;//0:disable,1:enable +#endif + -+int rtw_hwpdn_mode=2;//0:disable,1:enable,2: by EFUSE config ++static int rtw_hwpdn_mode=2;//0:disable,1:enable,2: by EFUSE config + +#ifdef CONFIG_HW_PWRP_DETECTION -+int rtw_hwpwrp_detect = 1; ++static int rtw_hwpwrp_detect = 1; +#else -+int rtw_hwpwrp_detect = 0; //HW power ping detect 0:disable , 1:enable ++static int rtw_hwpwrp_detect = 0; //HW power ping detect 0:disable , 1:enable +#endif + -+#ifdef CONFIG_USB_HCI -+int rtw_hw_wps_pbc = 1; -+#else -+int rtw_hw_wps_pbc = 0; -+#endif ++static int rtw_hw_wps_pbc = 1; + +#ifdef CONFIG_TX_MCAST2UNI +int rtw_mc2u_disable = 0; +#endif // CONFIG_TX_MCAST2UNI + ++#ifdef CONFIG_DUALMAC_CONCURRENT ++int rtw_dmsp = 0; ++#endif // CONFIG_DUALMAC_CONCURRENT ++ +#ifdef CONFIG_80211D -+int rtw_80211d = 0; ++static int rtw_80211d = 0; +#endif + ++#ifdef CONFIG_REGULATORY_CTRL ++static int rtw_regulatory_id =2; ++#else ++static int rtw_regulatory_id = 0xff;// Regulatory tab id, 0xff = follow efuse's setting ++#endif ++module_param(rtw_regulatory_id, int, 0644); ++ ++ +#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV +int rtw_force_ant = 2;//0 :normal, 1:Main ant, 2:Aux ant +int rtw_force_igi =0;//0 :normal @@ -367518,45 +176145,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +module_param(rtw_force_igi, int, 0644); +#endif + -+#ifdef CONFIG_QOS_OPTIMIZATION -+int rtw_qos_opt_enable=1;//0: disable,1:enable -+#else -+int rtw_qos_opt_enable=0;//0: disable,1:enable -+#endif -+module_param(rtw_qos_opt_enable,int,0644); -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+int rtw_acs_mode = 1; /*0:disable, 1:enable*/ -+module_param(rtw_acs_mode, int, 0644); -+ -+int rtw_acs_auto_scan = 0; /*0:disable, 1:enable*/ -+module_param(rtw_acs_auto_scan, int, 0644); -+ -+#endif -+ -+char* ifname = "wlan%d"; ++static char* ifname = "wlan%d"; +module_param(ifname, charp, 0644); +MODULE_PARM_DESC(ifname, "The default name to allocate for first interface"); + -+#ifdef CONFIG_PLATFORM_ANDROID -+char* if2name = "p2p%d"; -+#else //CONFIG_PLATFORM_ANDROID -+char* if2name = "wlan%d"; -+#endif //CONFIG_PLATFORM_ANDROID ++static char* if2name = "wlan%d"; +module_param(if2name, charp, 0644); +MODULE_PARM_DESC(if2name, "The default name to allocate for second interface"); + -+char* rtw_initmac = 0; // temp mac address if users want to use instead of the mac address in Efuse ++char* rtw_initmac = NULL; // temp mac address if users want to use instead of the mac address in Efuse + +#ifdef CONFIG_MULTI_VIR_IFACES +int rtw_ext_iface_num = 1;//primary/secondary iface is excluded +module_param(rtw_ext_iface_num, int, 0644); +#endif //CONFIG_MULTI_VIR_IFACES + -+module_param(rtw_rfkfree_enable, int, 0644); +module_param(rtw_initmac, charp, 0644); +module_param(rtw_channel_plan, int, 0644); -+module_param(rtw_special_rf_path, int, 0644); +module_param(rtw_chip_version, int, 0644); +module_param(rtw_rfintfs, int, 0644); +module_param(rtw_lbkmode, int, 0644); @@ -367578,9 +176183,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +#ifdef CONFIG_80211AC_VHT +module_param(rtw_vht_enable, int, 0644); +#endif //CONFIG_80211AC_VHT -+#ifdef CONFIG_BEAMFORMING -+module_param(rtw_beamform_cap, int, 0644); -+#endif ++ +module_param(rtw_lowrate_two_xmit, int, 0644); + +module_param(rtw_rf_config, int, 0644); @@ -367592,8 +176195,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +module_param(rtw_antdiv_cfg, int, 0644); +module_param(rtw_antdiv_type, int, 0644); + -+module_param(rtw_switch_usb_mode, int, 0644); -+ +module_param(rtw_enusbss, int, 0644); +module_param(rtw_hwpdn_mode, int, 0644); +module_param(rtw_hwpwrp_detect, int, 0644); @@ -367610,169 +176211,523 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +#endif //CONFIG_ADAPTOR_INFO_CACHING_FILE + +#ifdef CONFIG_LAYER2_ROAMING -+uint rtw_max_roaming_times=2; ++static uint rtw_max_roaming_times=2; +module_param(rtw_max_roaming_times, uint, 0644); +MODULE_PARM_DESC(rtw_max_roaming_times,"The max roaming times to try"); +#endif //CONFIG_LAYER2_ROAMING + +#ifdef CONFIG_IOL -+int rtw_fw_iol=1; ++int rtw_fw_iol=1;// 0:Disable, 1:enable, 2:by usb speed +module_param(rtw_fw_iol, int, 0644); -+MODULE_PARM_DESC(rtw_fw_iol, "FW IOL. 0:Disable, 1:enable, 2:by usb speed"); ++MODULE_PARM_DESC(rtw_fw_iol,"FW IOL"); +#endif //CONFIG_IOL + +#ifdef CONFIG_FILE_FWIMG -+char *rtw_fw_file_path = "/system/etc/firmware/rtlwifi/FW_NIC.BIN"; ++char *rtw_fw_file_path= ""; +module_param(rtw_fw_file_path, charp, 0644); +MODULE_PARM_DESC(rtw_fw_file_path, "The path of fw image"); -+ -+char *rtw_fw_wow_file_path = "/system/etc/firmware/rtlwifi/FW_WoWLAN.BIN"; -+module_param(rtw_fw_wow_file_path, charp, 0644); -+MODULE_PARM_DESC(rtw_fw_wow_file_path, "The path of fw for Wake on Wireless image"); -+ -+#ifdef CONFIG_MP_INCLUDED -+char *rtw_fw_mp_bt_file_path = ""; -+module_param(rtw_fw_mp_bt_file_path, charp, 0644); -+MODULE_PARM_DESC(rtw_fw_mp_bt_file_path, "The path of fw for MP-BT image"); -+#endif // CONFIG_MP_INCLUDED -+#endif // CONFIG_FILE_FWIMG ++#endif //CONFIG_FILE_FWIMG + +#ifdef CONFIG_TX_MCAST2UNI +module_param(rtw_mc2u_disable, int, 0644); +#endif // CONFIG_TX_MCAST2UNI + ++#ifdef CONFIG_DUALMAC_CONCURRENT ++module_param(rtw_dmsp, int, 0644); ++#endif // CONFIG_DUALMAC_CONCURRENT ++ +#ifdef CONFIG_80211D +module_param(rtw_80211d, int, 0644); +MODULE_PARM_DESC(rtw_80211d, "Enable 802.11d mechanism"); +#endif + -+uint rtw_notch_filter = RTW_NOTCH_FILTER; ++#ifdef CONFIG_BT_COEXIST ++module_param(rtw_btcoex_enable, int, 0644); ++MODULE_PARM_DESC(rtw_btcoex_enable, "Enable BT co-existence mechanism"); ++#endif ++ ++static uint rtw_notch_filter = RTW_NOTCH_FILTER; +module_param(rtw_notch_filter, uint, 0644); +MODULE_PARM_DESC(rtw_notch_filter, "0:Disable, 1:Enable, 2:Enable only for P2P"); + -+uint rtw_hiq_filter = CONFIG_RTW_HIQ_FILTER; -+module_param(rtw_hiq_filter, uint, 0644); -+MODULE_PARM_DESC(rtw_hiq_filter, "0:allow all, 1:allow special, 2:deny all"); -+ -+uint rtw_adaptivity_en = CONFIG_RTW_ADAPTIVITY_EN; -+module_param(rtw_adaptivity_en, uint, 0644); -+MODULE_PARM_DESC(rtw_adaptivity_en, "0:disable, 1:enable"); -+ -+uint rtw_adaptivity_mode = CONFIG_RTW_ADAPTIVITY_MODE; -+module_param(rtw_adaptivity_mode, uint, 0644); -+MODULE_PARM_DESC(rtw_adaptivity_mode, "0:normal, 1:carrier sense"); -+ -+uint rtw_adaptivity_dml = CONFIG_RTW_ADAPTIVITY_DML; -+module_param(rtw_adaptivity_dml, uint, 0644); -+MODULE_PARM_DESC(rtw_adaptivity_dml, "0:disable, 1:enable"); -+ -+uint rtw_adaptivity_dc_backoff = CONFIG_RTW_ADAPTIVITY_DC_BACKOFF; -+module_param(rtw_adaptivity_dc_backoff, uint, 0644); -+MODULE_PARM_DESC(rtw_adaptivity_dc_backoff, "DC backoff for Adaptivity"); -+ -+int rtw_adaptivity_th_l2h_ini = CONFIG_RTW_ADAPTIVITY_TH_L2H_INI; -+module_param(rtw_adaptivity_th_l2h_ini, int, 0644); -+MODULE_PARM_DESC(rtw_adaptivity_th_l2h_ini, "TH_L2H_ini for Adaptivity"); -+ -+int rtw_adaptivity_th_edcca_hl_diff = CONFIG_RTW_ADAPTIVITY_TH_EDCCA_HL_DIFF; -+module_param(rtw_adaptivity_th_edcca_hl_diff, int, 0644); -+MODULE_PARM_DESC(rtw_adaptivity_th_edcca_hl_diff, "TH_EDCCA_HL_diff for Adaptivity"); -+ -+uint rtw_amplifier_type_2g = CONFIG_RTW_AMPLIFIER_TYPE_2G; -+module_param(rtw_amplifier_type_2g, uint, 0644); -+MODULE_PARM_DESC(rtw_amplifier_type_2g, "BIT3:2G ext-PA, BIT4:2G ext-LNA"); -+ -+uint rtw_amplifier_type_5g = CONFIG_RTW_AMPLIFIER_TYPE_5G; -+module_param(rtw_amplifier_type_5g, uint, 0644); -+MODULE_PARM_DESC(rtw_amplifier_type_5g, "BIT6:5G ext-PA, BIT7:5G ext-LNA"); -+ -+uint rtw_RFE_type = CONFIG_RTW_RFE_TYPE; -+module_param(rtw_RFE_type, uint, 0644); -+MODULE_PARM_DESC(rtw_RFE_type, "default init value:64"); -+ -+uint rtw_GLNA_type = CONFIG_RTW_GLNA_TYPE; -+module_param(rtw_GLNA_type, uint, 0644); -+MODULE_PARM_DESC(rtw_GLNA_type, "default init value:0"); -+ -+uint rtw_TxBBSwing_2G = 0xFF; -+module_param(rtw_TxBBSwing_2G, uint, 0644); -+MODULE_PARM_DESC(rtw_TxBBSwing_2G, "default init value:0xFF"); -+ -+uint rtw_TxBBSwing_5G = 0xFF; -+module_param(rtw_TxBBSwing_5G, uint, 0644); -+MODULE_PARM_DESC(rtw_TxBBSwing_5G, "default init value:0xFF"); -+ -+uint rtw_OffEfuseMask = 0; -+module_param(rtw_OffEfuseMask, uint, 0644); -+MODULE_PARM_DESC(rtw_OffEfuseMask, "default open Efuse Mask value:0"); -+ -+uint rtw_FileMaskEfuse = 0; -+module_param(rtw_FileMaskEfuse, uint, 0644); -+MODULE_PARM_DESC(rtw_FileMaskEfuse, "default drv Mask Efuse value:0"); -+ -+uint rtw_kfree = 0; -+module_param(rtw_kfree, uint, 0644); -+MODULE_PARM_DESC(rtw_kfree, "default kfree config value:0"); -+ -+uint rtw_pll_ref_clk_sel = CONFIG_RTW_PLL_REF_CLK_SEL; -+module_param(rtw_pll_ref_clk_sel, uint, 0644); -+MODULE_PARM_DESC(rtw_pll_ref_clk_sel, "force pll_ref_clk_sel, 0xF:use autoload value"); -+ -+#if defined(CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY) //eFuse: Regulatory selection=1 -+int rtw_tx_pwr_lmt_enable = 1; -+int rtw_tx_pwr_by_rate = 1; -+#elif defined(CONFIG_CALIBRATE_TX_POWER_TO_MAX)//eFuse: Regulatory selection=0 -+int rtw_tx_pwr_lmt_enable = 0; -+int rtw_tx_pwr_by_rate = 1; -+#else //eFuse: Regulatory selection=2 -+#ifdef CONFIG_PCI_HCI -+int rtw_tx_pwr_lmt_enable = 2; // 2- Depend on efuse -+int rtw_tx_pwr_by_rate = 2;// 2- Depend on efuse -+#else // USB & SDIO -+int rtw_tx_pwr_lmt_enable = 0; -+int rtw_tx_pwr_by_rate = 0; -+#endif -+#endif -+ -+module_param(rtw_tx_pwr_lmt_enable, int, 0644); -+MODULE_PARM_DESC(rtw_tx_pwr_lmt_enable,"0:Disable, 1:Enable, 2: Depend on efuse"); -+ -+module_param(rtw_tx_pwr_by_rate, int, 0644); -+MODULE_PARM_DESC(rtw_tx_pwr_by_rate,"0:Disable, 1:Enable, 2: Depend on efuse"); -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+char *rtw_phy_file_path = REALTEK_CONFIG_PATH; -+module_param(rtw_phy_file_path, charp, 0644); -+MODULE_PARM_DESC(rtw_phy_file_path, "The path of phy parameter"); -+// PHY FILE Bit Map -+// BIT0 - MAC, 0: non-support, 1: support -+// BIT1 - BB, 0: non-support, 1: support -+// BIT2 - BB_PG, 0: non-support, 1: support -+// BIT3 - BB_MP, 0: non-support, 1: support -+// BIT4 - RF, 0: non-support, 1: support -+// BIT5 - RF_TXPWR_TRACK, 0: non-support, 1: support -+// BIT6 - RF_TXPWR_LMT, 0: non-support, 1: support -+int rtw_load_phy_file = (BIT2|BIT6); -+module_param(rtw_load_phy_file, int, 0644); -+MODULE_PARM_DESC(rtw_load_phy_file,"PHY File Bit Map"); -+int rtw_decrypt_phy_file = 0; -+module_param(rtw_decrypt_phy_file, int, 0644); -+MODULE_PARM_DESC(rtw_decrypt_phy_file,"Enable Decrypt PHY File"); -+#endif -+ ++static uint loadparam(PADAPTER padapter, _nic_hdl pnetdev); +int _netdev_open(struct net_device *pnetdev); +int netdev_open (struct net_device *pnetdev); +static int netdev_close (struct net_device *pnetdev); -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+extern int rtw_sdio_set_power(int on); -+#endif //CONFIG_PLATFORM_INTEL_BYT + -+uint loadparam(_adapter *padapter) ++#ifdef CONFIG_PROC_DEBUG ++#define RTL8192C_PROC_NAME "rtl819xC" ++#define RTL8192D_PROC_NAME "rtl819xD" ++static char rtw_proc_name[IFNAMSIZ]; ++static struct proc_dir_entry *rtw_proc = NULL; ++static int rtw_proc_cnt = 0; ++ ++#define RTW_PROC_NAME DRV_NAME ++ ++#if(LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,0)) ++typedef ssize_t (*read_proc_t) (struct file *, char __user *, size_t, loff_t *); ++static inline struct proc_dir_entry *create_proc_read_entry(const char *name, ++ mode_t mode, struct proc_dir_entry *base, ++ read_proc_t *read_proc, void * data) +{ ++ struct file_operations fops = { ++ owner: THIS_MODULE, ++ read: read_proc ++ }; ++ struct proc_dir_entry *res = proc_create_data(name, mode, base, &fops, data); ++ return res; ++} ++typedef ssize_t (*write_proc_t) (struct file *, const char __user *, ssize_t, loff_t *); ++static inline struct proc_dir_entry *create_proc_read_write_entry(const char *name, ++ mode_t mode, struct proc_dir_entry *base, ++ read_proc_t *read_proc, void * data, write_proc_t *write_proc) ++{ ++ struct file_operations fops = { ++ owner: THIS_MODULE, ++ read: read_proc, ++ write: write_proc ++ }; ++ struct proc_dir_entry *res = proc_create_data(name, mode, base, &fops, data); ++ return res; ++} ++#endif ++ ++void rtw_proc_init_one(struct net_device *dev) ++{ ++ struct proc_dir_entry *dir_dev = NULL; ++ struct proc_dir_entry *entry=NULL; ++ _adapter *padapter = rtw_netdev_priv(dev); ++ u8 rf_type; ++ ++ if(rtw_proc == NULL) ++ { ++ if(padapter->chip_type == RTL8188C_8192C) ++ { ++ _rtw_memcpy(rtw_proc_name, RTL8192C_PROC_NAME, sizeof(RTL8192C_PROC_NAME)); ++ } ++ else if(padapter->chip_type == RTL8192D) ++ { ++ _rtw_memcpy(rtw_proc_name, RTL8192D_PROC_NAME, sizeof(RTL8192D_PROC_NAME)); ++ } ++ else if(padapter->chip_type == RTL8723A) ++ { ++ _rtw_memcpy(rtw_proc_name, RTW_PROC_NAME, sizeof(RTW_PROC_NAME)); ++ } ++ else if(padapter->chip_type == RTL8188E) ++ { ++ _rtw_memcpy(rtw_proc_name, RTW_PROC_NAME, sizeof(RTW_PROC_NAME)); ++ } ++ else ++ { ++ _rtw_memcpy(rtw_proc_name, RTW_PROC_NAME, sizeof(RTW_PROC_NAME)); ++ } ++ ++#if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) ++ rtw_proc=create_proc_entry(rtw_proc_name, S_IFDIR, proc_net); ++#elif(LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0)) ++ rtw_proc=create_proc_entry(rtw_proc_name, S_IFDIR, init_net.proc_net); ++#else ++ rtw_proc=proc_create(rtw_proc_name, S_IFDIR, init_net.proc_net, NULL); ++#endif ++ if (rtw_proc == NULL) { ++ DBG_871X(KERN_ERR "Unable to create rtw_proc directory\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("ver_info", S_IFREG | S_IRUGO, rtw_proc, proc_get_drv_version, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ } ++ ++ ++ ++ if(padapter->dir_dev == NULL) ++ { ++#if(LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0)) ++ padapter->dir_dev = create_proc_entry(dev->name, ++ S_IFDIR | S_IRUGO | S_IXUGO, ++ rtw_proc); ++#else ++ padapter->dir_dev = proc_create(dev->name, ++ S_IFDIR | S_IRUGO | S_IXUGO, ++ rtw_proc, NULL); ++#endif ++ ++ dir_dev = padapter->dir_dev; ++ ++ if(dir_dev==NULL) ++ { ++ if(rtw_proc_cnt == 0) ++ { ++ if(rtw_proc){ ++#if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) ++ remove_proc_entry(rtw_proc_name, proc_net); ++#else ++ remove_proc_entry(rtw_proc_name, init_net.proc_net); ++#endif ++ rtw_proc = NULL; ++ } ++ } ++ ++ DBG_871X("Unable to create dir_dev directory\n"); ++ return; ++ } ++ } ++ else ++ { ++ return; ++ } ++ ++ rtw_proc_cnt++; ++ ++ entry = create_proc_read_write_entry("write_reg", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_write_reg, dev, proc_set_write_reg); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_write_entry("read_reg", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_read_reg, dev, proc_set_read_reg); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("fwstate", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_fwstate, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("sec_info", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_sec_info, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("mlmext_state", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_mlmext_state, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("qos_option", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_qos_option, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("ht_option", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_ht_option, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("rf_info", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_rf_info, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("ap_info", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_ap_info, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("adapter_state", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_adapter_state, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("trx_info", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_trx_info, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("mac_reg_dump1", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_mac_reg_dump1, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("mac_reg_dump2", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_mac_reg_dump2, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("mac_reg_dump3", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_mac_reg_dump3, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("bb_reg_dump1", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_bb_reg_dump1, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("bb_reg_dump2", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_bb_reg_dump2, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("bb_reg_dump3", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_bb_reg_dump3, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("rf_reg_dump1", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_rf_reg_dump1, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("rf_reg_dump2", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_rf_reg_dump2, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ if((RF_1T2R == rf_type) ||(RF_1T1R ==rf_type )) { ++ entry = create_proc_read_entry("rf_reg_dump3", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_rf_reg_dump3, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_entry("rf_reg_dump4", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_rf_reg_dump4, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ } ++ ++#ifdef CONFIG_AP_MODE ++ ++ entry = create_proc_read_entry("all_sta_info", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_all_sta_info, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++#endif ++ ++#ifdef DBG_MEMORY_LEAK ++ entry = create_proc_read_entry("_malloc_cnt", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_malloc_cnt, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++#endif ++ ++#ifdef CONFIG_FIND_BEST_CHANNEL ++ entry = create_proc_read_entry("best_channel", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_best_channel, dev); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++#endif ++ ++ entry = create_proc_read_write_entry("rx_signal", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_rx_signal, dev, proc_set_rx_signal); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++#ifdef CONFIG_80211N_HT ++ entry = create_proc_read_write_entry("ht_enable", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_ht_enable, dev, proc_set_ht_enable); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_write_entry("bw_mode", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_bw_mode, dev, proc_set_bw_mode); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_write_entry("ampdu_enable", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_ampdu_enable, dev, proc_set_ampdu_enable); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++ ++ entry = create_proc_read_write_entry("rx_stbc", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_rx_stbc, dev, proc_set_rx_stbc); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++#endif //CONFIG_80211N_HT ++ ++ entry = create_proc_read_entry("path_rssi", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_two_path_rssi, dev); ++ ++ entry = create_proc_read_write_entry("rssi_disp", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_rssi_disp, dev, proc_set_rssi_disp); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++#ifdef CONFIG_BT_COEXIST ++ entry = create_proc_read_write_entry("btcoex_dbg", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_btcoex_dbg, dev, proc_set_btcoex_dbg); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++#endif /*CONFIG_BT_COEXIST*/ ++ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++ entry = create_proc_read_write_entry("sreset", S_IFREG | S_IRUGO, ++ dir_dev, proc_get_sreset, dev, proc_set_sreset); ++ if (!entry) { ++ DBG_871X("Unable to create_proc_read_entry!\n"); ++ return; ++ } ++#endif /* DBG_CONFIG_ERROR_DETECT */ ++ ++} ++ ++void rtw_proc_remove_one(struct net_device *dev) ++{ ++ struct proc_dir_entry *dir_dev = NULL; ++ _adapter *padapter = rtw_netdev_priv(dev); ++ u8 rf_type; ++ ++ dir_dev = padapter->dir_dev; ++ padapter->dir_dev = NULL; ++ ++ if (dir_dev) { ++ ++ remove_proc_entry("write_reg", dir_dev); ++ remove_proc_entry("read_reg", dir_dev); ++ remove_proc_entry("fwstate", dir_dev); ++ remove_proc_entry("sec_info", dir_dev); ++ remove_proc_entry("mlmext_state", dir_dev); ++ remove_proc_entry("qos_option", dir_dev); ++ remove_proc_entry("ht_option", dir_dev); ++ remove_proc_entry("rf_info", dir_dev); ++ remove_proc_entry("ap_info", dir_dev); ++ remove_proc_entry("adapter_state", dir_dev); ++ remove_proc_entry("trx_info", dir_dev); ++ ++ remove_proc_entry("mac_reg_dump1", dir_dev); ++ remove_proc_entry("mac_reg_dump2", dir_dev); ++ remove_proc_entry("mac_reg_dump3", dir_dev); ++ remove_proc_entry("bb_reg_dump1", dir_dev); ++ remove_proc_entry("bb_reg_dump2", dir_dev); ++ remove_proc_entry("bb_reg_dump3", dir_dev); ++ remove_proc_entry("rf_reg_dump1", dir_dev); ++ remove_proc_entry("rf_reg_dump2", dir_dev); ++ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); ++ if((RF_1T2R == rf_type) ||(RF_1T1R ==rf_type )) { ++ remove_proc_entry("rf_reg_dump3", dir_dev); ++ remove_proc_entry("rf_reg_dump4", dir_dev); ++ } ++#ifdef CONFIG_AP_MODE ++ remove_proc_entry("all_sta_info", dir_dev); ++#endif ++ ++#ifdef DBG_MEMORY_LEAK ++ remove_proc_entry("_malloc_cnt", dir_dev); ++#endif ++ ++#ifdef CONFIG_FIND_BEST_CHANNEL ++ remove_proc_entry("best_channel", dir_dev); ++#endif ++ remove_proc_entry("rx_signal", dir_dev); ++#ifdef CONFIG_80211N_HT ++ remove_proc_entry("bw_mode", dir_dev); ++ ++ remove_proc_entry("ht_enable", dir_dev); ++ ++ remove_proc_entry("ampdu_enable", dir_dev); ++ ++ remove_proc_entry("rx_stbc", dir_dev); ++#endif //CONFIG_80211N_HT ++ remove_proc_entry("path_rssi", dir_dev); ++ ++ remove_proc_entry("rssi_disp", dir_dev); ++ ++#ifdef CONFIG_BT_COEXIST ++ remove_proc_entry("btcoex_dbg", dir_dev); ++#endif //CONFIG_BT_COEXIST ++ ++#if defined(DBG_CONFIG_ERROR_DETECT) ++ remove_proc_entry("sreset", dir_dev); ++#endif /* DBG_CONFIG_ERROR_DETECT */ ++ ++ remove_proc_entry(dev->name, rtw_proc); ++ dir_dev = NULL; ++ ++ } ++ else ++ { ++ return; ++ } ++ ++ rtw_proc_cnt--; ++ ++ if(rtw_proc_cnt == 0) ++ { ++ if(rtw_proc){ ++ remove_proc_entry("ver_info", rtw_proc); ++ ++#if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) ++ remove_proc_entry(rtw_proc_name, proc_net); ++#else ++ remove_proc_entry(rtw_proc_name, init_net.proc_net); ++#endif ++ rtw_proc = NULL; ++ } ++ } ++} ++#endif ++ ++static uint loadparam( _adapter *padapter, _nic_hdl pnetdev) ++{ ++ + uint status = _SUCCESS; + struct registry_priv *registry_par = &padapter->registrypriv; + -+_func_enter_; ++ + + registry_par->chip_version = (u8)rtw_chip_version; + registry_par->rfintfs = (u8)rtw_rfintfs; @@ -367794,7 +176749,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + && (registry_par->channel <= 14)) { + registry_par->channel = 36; + } -+ ++ + registry_par->vrtl_carrier_sense = (u8)rtw_vrtl_carrier_sense ; + registry_par->vcs_type = (u8)rtw_vcs_type; + registry_par->rts_thresh=(u16)rtw_rts_thresh; @@ -367804,21 +176759,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + registry_par->adhoc_tx_pwr = (u8)rtw_adhoc_tx_pwr; + registry_par->soft_ap= (u8)rtw_soft_ap; + registry_par->smart_ps = (u8)rtw_smart_ps; -+ registry_par->check_fw_ps = (u8)rtw_check_fw_ps; + registry_par->power_mgnt = (u8)rtw_power_mgnt; + registry_par->ips_mode = (u8)rtw_ips_mode; + registry_par->radio_enable = (u8)rtw_radio_enable; + registry_par->long_retry_lmt = (u8)rtw_long_retry_lmt; + registry_par->short_retry_lmt = (u8)rtw_short_retry_lmt; -+ registry_par->busy_thresh = (u16)rtw_busy_thresh; -+ //registry_par->qos_enable = (u8)rtw_qos_enable; ++ registry_par->busy_thresh = (u16)rtw_busy_thresh; ++ //registry_par->qos_enable = (u8)rtw_qos_enable; + registry_par->ack_policy = (u8)rtw_ack_policy; + registry_par->mp_mode = (u8)rtw_mp_mode; + registry_par->software_encrypt = (u8)rtw_software_encrypt; + registry_par->software_decrypt = (u8)rtw_software_decrypt; + + registry_par->acm_method = (u8)rtw_acm_method; -+ registry_par->usb_rxagg_mode = (u8)rtw_usb_rxagg_mode; + + //UAPSD + registry_par->wmm_enable = (u8)rtw_wmm_enable; @@ -367829,8 +176782,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + registry_par->uapsd_acvi_en = (u8)rtw_uapsd_acvi_en; + registry_par->uapsd_acvo_en = (u8)rtw_uapsd_acvo_en; + -+ registry_par->RegRfKFreeEnable = (u8)rtw_rfkfree_enable; -+ +#ifdef CONFIG_80211N_HT + registry_par->ht_enable = (u8)rtw_ht_enable; + registry_par->bw_mode = (u8)rtw_bw_mode; @@ -367838,17 +176789,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + registry_par->rx_stbc = (u8)rtw_rx_stbc; + registry_par->ampdu_amsdu = (u8)rtw_ampdu_amsdu; + registry_par->short_gi = (u8)rtw_short_gi; -+ registry_par->ldpc_cap = (u8)rtw_ldpc_cap; -+ registry_par->stbc_cap = (u8)rtw_stbc_cap; -+ registry_par->beamform_cap = (u8)rtw_beamform_cap; -+ registry_par->beamformer_rf_num = (u8)rtw_bfer_rf_number; -+ registry_par->beamformee_rf_num = (u8)rtw_bfee_rf_number; +#endif + +#ifdef CONFIG_80211AC_VHT + registry_par->vht_enable = (u8)rtw_vht_enable; + registry_par->ampdu_factor = (u8)rtw_ampdu_factor; + registry_par->vht_rate_sel = (u8)rtw_vht_rate_sel; ++ registry_par->ldpc_cap = (u8)rtw_ldpc_cap; ++ registry_par->stbc_cap = (u8)rtw_stbc_cap; ++ registry_par->beamform_cap = (u8)rtw_beamform_cap; +#endif + +#ifdef CONFIG_TX_EARLY_MODE @@ -367862,22 +176811,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + registry_par->wifi_spec = (u8)rtw_wifi_spec; + + registry_par->channel_plan = (u8)rtw_channel_plan; -+ registry_par->special_rf_path = (u8)rtw_special_rf_path; + +#ifdef CONFIG_BT_COEXIST + registry_par->btcoex = (u8)rtw_btcoex_enable; + registry_par->bt_iso = (u8)rtw_bt_iso; + registry_par->bt_sco = (u8)rtw_bt_sco; + registry_par->bt_ampdu = (u8)rtw_bt_ampdu; -+ registry_par->ant_num = (s8)rtw_ant_num; +#endif + + registry_par->bAcceptAddbaReq = (u8)rtw_AcceptAddbaReq; + + registry_par->antdiv_cfg = (u8)rtw_antdiv_cfg; + registry_par->antdiv_type = (u8)rtw_antdiv_type; -+ -+ registry_par->switch_usb_mode = (u8)rtw_switch_usb_mode; + +#ifdef CONFIG_AUTOSUSPEND + registry_par->usbss_enable = (u8)rtw_enusbss;//0:disable,1:enable @@ -367905,6 +176850,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + registry_par->fw_iol = rtw_fw_iol; +#endif + ++#ifdef CONFIG_DUALMAC_CONCURRENT ++ registry_par->dmsp= (u8)rtw_dmsp; ++#endif ++ +#ifdef CONFIG_80211D + registry_par->enable80211d = (u8)rtw_80211d; +#endif @@ -367919,112 +176868,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + registry_par->force_igi = (u8)rtw_force_igi; +#endif + ++ registry_par->regulatory_tid = (u8)rtw_regulatory_id; ++ +#ifdef CONFIG_MULTI_VIR_IFACES + registry_par->ext_iface_num = (u8)rtw_ext_iface_num; +#endif //CONFIG_MULTI_VIR_IFACES + -+ registry_par->pll_ref_clk_sel = (u8)rtw_pll_ref_clk_sel; + -+ registry_par->RegEnableTxPowerLimit = (u8)rtw_tx_pwr_lmt_enable; -+ registry_par->RegEnableTxPowerByRate = (u8)rtw_tx_pwr_by_rate; -+ -+ registry_par->RegPowerBase = 14; -+ registry_par->TxBBSwing_2G = (s8)rtw_TxBBSwing_2G; -+ registry_par->TxBBSwing_5G = (s8)rtw_TxBBSwing_5G; -+ registry_par->bEn_RFE = 1; -+ registry_par->RFE_Type = (u8)rtw_RFE_type; -+ registry_par->AmplifierType_2G = (u8)rtw_amplifier_type_2g; -+ registry_par->AmplifierType_5G = (u8)rtw_amplifier_type_5g; -+ registry_par->GLNA_Type = (u8)rtw_GLNA_type; -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ registry_par->load_phy_file = (u8)rtw_load_phy_file; -+ registry_par->RegDecryptCustomFile = (u8)rtw_decrypt_phy_file; -+#endif -+ registry_par->qos_opt_enable = (u8)rtw_qos_opt_enable; -+ -+ registry_par->hiq_filter = (u8)rtw_hiq_filter; -+ -+ registry_par->adaptivity_en = (u8)rtw_adaptivity_en; -+ registry_par->adaptivity_mode = (u8)rtw_adaptivity_mode; -+ registry_par->adaptivity_dml = (u8)rtw_adaptivity_dml; -+ registry_par->adaptivity_dc_backoff = (u8)rtw_adaptivity_dc_backoff; -+ registry_par->adaptivity_th_l2h_ini = (s8)rtw_adaptivity_th_l2h_ini; -+ registry_par->adaptivity_th_edcca_hl_diff = (s8)rtw_adaptivity_th_edcca_hl_diff; -+ -+ registry_par->boffefusemask = (u8)rtw_OffEfuseMask; -+ registry_par->bFileMaskEfuse = (u8)rtw_FileMaskEfuse; -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ registry_par->acs_mode = (u8)rtw_acs_mode; -+ registry_par->acs_auto_scan = (u8)rtw_acs_auto_scan; -+#endif -+_func_exit_; + + return status; +} + -+/** -+ * rtw_net_set_mac_address -+ * This callback function is used for the Media Access Control address -+ * of each net_device needs to be changed. -+ * -+ * Arguments: -+ * @pnetdev: net_device pointer. -+ * @addr: new MAC address. -+ * -+ * Return: -+ * ret = 0: Permit to change net_device's MAC address. -+ * ret = -1 (Default): Operation not permitted. -+ * -+ * Auther: Arvin Liu -+ * Date: 2015/05/29 -+ */ -+static int rtw_net_set_mac_address(struct net_device *pnetdev, void *addr) ++static int rtw_net_set_mac_address(struct net_device *pnetdev, void *p) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sockaddr *sa = (struct sockaddr *)addr; -+ int ret = -1; ++ struct sockaddr *addr = p; + -+ /* only the net_device is in down state to permit modifying mac addr */ -+ if ((pnetdev->flags & IFF_UP) == _TRUE) { -+ DBG_871X(FUNC_ADPT_FMT": The net_device's is not in down state\n" -+ , FUNC_ADPT_ARG(padapter)); -+ -+ return ret; ++ if(padapter->bup == false) ++ { ++ //DBG_871X("r8711_net_set_mac_address(), MAC=%x:%x:%x:%x:%x:%x\n", addr->sa_data[0], addr->sa_data[1], addr->sa_data[2], addr->sa_data[3], ++ //addr->sa_data[4], addr->sa_data[5]); ++ _rtw_memcpy(padapter->eeprompriv.mac_addr, addr->sa_data, ETH_ALEN); ++ //_rtw_memcpy(pnetdev->dev_addr, addr->sa_data, ETH_ALEN); ++ //padapter->bset_hwaddr = true; + } + -+ /* if the net_device is linked, it's not permit to modify mac addr */ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) || -+ check_fwstate(pmlmepriv, _FW_LINKED) || -+ check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { -+ DBG_871X(FUNC_ADPT_FMT": The net_device's is not idle currently\n" -+ , FUNC_ADPT_ARG(padapter)); -+ -+ return ret; -+ } -+ -+ /* check whether the input mac address is valid to permit modifying mac addr */ -+ if (rtw_check_invalid_mac_address(sa->sa_data, _FALSE) == _TRUE) { -+ DBG_871X(FUNC_ADPT_FMT": Invalid Mac Addr for "MAC_FMT"\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(sa->sa_data)); -+ -+ return ret; -+ } -+ -+ _rtw_memcpy(adapter_mac_addr(padapter), sa->sa_data, ETH_ALEN); /* set mac addr to adapter */ -+ _rtw_memcpy(pnetdev->dev_addr, sa->sa_data, ETH_ALEN); /* set mac addr to net_device */ -+ -+ rtw_ps_deny(padapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(padapter); /* leave PS mode for guaranteeing to access hw register successfully */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, sa->sa_data); /* set mac addr to mac register */ -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+ -+ DBG_871X(FUNC_ADPT_FMT": Set Mac Addr to "MAC_FMT" Successfully\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(sa->sa_data)); -+ -+ ret = 0; -+ -+ return ret; ++ return 0; +} + +static struct net_device_stats *rtw_net_get_stats(struct net_device *pnetdev) @@ -368055,7 +176924,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +static const u16 rtw_1d_to_queue[8] = { 2, 3, 3, 2, 1, 1, 0, 0 }; + +/* Given a data frame determine the 802.1p/1d tag to use. */ -+unsigned int rtw_classify8021d(struct sk_buff *skb) ++static unsigned int rtw_classify8021d(struct sk_buff *skb) +{ + unsigned int dscp; + @@ -368078,16 +176947,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + return dscp >> 5; +} + -+ -+static u16 rtw_select_queue(struct net_device *dev, struct sk_buff *skb -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0) -+ , void *accel_priv -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0) -+ , select_queue_fallback_t fallback -+#endif -+ -+#endif -+) ++static u16 rtw_select_queue(struct net_device *dev, struct sk_buff *skb, void *accel_priv, select_queue_fallback_t fallback) +{ + _adapter *padapter = rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -368113,17 +176973,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + _rtw_memcpy(ð_type, pdata+(ETH_ALEN<<1), 2); + + switch (eth_type) { -+ case htons(ETH_P_IP): ++ case be16_to_cpu(htons(ETH_P_IP)): ++ piphdr = (struct iphdr *)(pdata+ETH_HLEN); + -+ piphdr = (struct iphdr *)(pdata+ETH_HLEN); ++ dscp = piphdr->tos & 0xfc; + -+ dscp = piphdr->tos & 0xfc; ++ priority = dscp >> 5; + -+ priority = dscp >> 5; -+ -+ break; -+ default: -+ priority = 0; ++ break; ++ default: ++ priority = 0; + } + + return rtw_1d_to_queue[priority]; @@ -368131,73 +176990,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +} + +#endif -+static int rtw_ndev_notifier_call(struct notifier_block * nb, unsigned long state, void *ptr) -+{ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(3,11,0)) -+ struct net_device *dev = netdev_notifier_info_to_dev(ptr); -+#else -+ struct net_device *dev = ptr; -+#endif -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) -+ if (dev->netdev_ops->ndo_do_ioctl != rtw_ioctl) -+#else -+ if (dev->do_ioctl != rtw_ioctl) -+#endif -+ return NOTIFY_DONE; -+ -+ DBG_871X_LEVEL(_drv_info_, FUNC_NDEV_FMT" state:%lu\n", FUNC_NDEV_ARG(dev), state); -+ -+ switch (state) { -+ case NETDEV_CHANGENAME: -+ rtw_adapter_proc_replace(dev); -+ break; -+ } -+ -+ return NOTIFY_DONE; -+} -+ -+static struct notifier_block rtw_ndev_notifier = { -+ .notifier_call = rtw_ndev_notifier_call, -+}; -+ -+int rtw_ndev_notifier_register(void) -+{ -+ return register_netdevice_notifier(&rtw_ndev_notifier); -+} -+ -+void rtw_ndev_notifier_unregister(void) -+{ -+ unregister_netdevice_notifier(&rtw_ndev_notifier); -+} -+ -+ -+int rtw_ndev_init(struct net_device *dev) -+{ -+ _adapter *adapter = rtw_netdev_priv(dev); -+ -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" if%d mac_addr="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), (adapter->iface_id+1), MAC_ARG(dev->dev_addr)); -+ strncpy(adapter->old_ifname, dev->name, IFNAMSIZ); -+ adapter->old_ifname[IFNAMSIZ-1] = '\0'; -+ rtw_adapter_proc_init(dev); -+ -+ return 0; -+} -+ -+void rtw_ndev_uninit(struct net_device *dev) -+{ -+ _adapter *adapter = rtw_netdev_priv(dev); -+ -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" if%d\n" -+ , FUNC_ADPT_ARG(adapter), (adapter->iface_id+1)); -+ rtw_adapter_proc_deinit(dev); -+} + +#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) +static const struct net_device_ops rtw_netdev_ops = { -+ .ndo_init = rtw_ndev_init, -+ .ndo_uninit = rtw_ndev_uninit, + .ndo_open = netdev_open, + .ndo_stop = netdev_close, + .ndo_start_xmit = rtw_xmit_entry, @@ -368217,7 +177012,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +#ifdef CONFIG_EASY_REPLACEMENT + struct net_device *TargetNetdev = NULL; + _adapter *TargetAdapter = NULL; -+ struct net *devnet = NULL; ++ struct net *devnet = NULL; + + if(padapter->bDongle == 1) + { @@ -368243,6 +177038,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + dev_put(TargetNetdev); + unregister_netdev(TargetNetdev); + ++ if(TargetAdapter->chip_type == padapter->chip_type) ++ rtw_proc_remove_one(TargetNetdev); ++ + padapter->DriverState = DRIVER_REPLACE_DONGLE; + } + } @@ -368259,22 +177057,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + return 0; +} + -+void rtw_hook_if_ops(struct net_device *ndev) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+ ndev->netdev_ops = &rtw_netdev_ops; -+#else -+ ndev->init = rtw_ndev_init; -+ ndev->uninit = rtw_ndev_uninit; -+ ndev->open = netdev_open; -+ ndev->stop = netdev_close; -+ ndev->hard_start_xmit = rtw_xmit_entry; -+ ndev->set_mac_address = rtw_net_set_mac_address; -+ ndev->get_stats = rtw_net_get_stats; -+ ndev->do_ioctl = rtw_ioctl; -+#endif -+} -+ +struct net_device *rtw_init_netdev(_adapter *old_padapter) +{ + _adapter *padapter; @@ -368297,15 +177079,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + SET_MODULE_OWNER(pnetdev); +#endif + -+ rtw_hook_if_ops(pnetdev); ++ //pnetdev->init = NULL; ++ ++#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) ++ DBG_871X("register rtw_netdev_ops to netdev_ops\n"); ++ pnetdev->netdev_ops = &rtw_netdev_ops; ++#else ++ pnetdev->open = netdev_open; ++ pnetdev->stop = netdev_close; ++ pnetdev->hard_start_xmit = rtw_xmit_entry; ++ pnetdev->set_mac_address = rtw_net_set_mac_address; ++ pnetdev->get_stats = rtw_net_get_stats; ++ pnetdev->do_ioctl = rtw_ioctl; ++#endif ++ + +#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX + pnetdev->features |= NETIF_F_IP_CSUM; +#endif -+ + //pnetdev->tx_timeout = NULL; + pnetdev->watchdog_timeo = HZ*3; /* 3 second timeout */ -+ +#ifdef CONFIG_WIRELESS_EXT + pnetdev->wireless_handlers = (struct iw_handler_def *)&rtw_handlers_def; +#endif @@ -368315,227 +177108,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + //pnetdev->wireless_data = &priv->wireless_data; +#endif + ++ //step 2. ++ loadparam(padapter, pnetdev); ++ + return pnetdev; -+} + -+int rtw_os_ndev_alloc(_adapter *adapter) -+{ -+ int ret = _FAIL; -+ struct net_device *ndev = NULL; -+ -+ ndev = rtw_init_netdev(adapter); -+ if (ndev == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ #if LINUX_VERSION_CODE > KERNEL_VERSION(2, 5, 0) -+ SET_NETDEV_DEV(ndev, dvobj_to_dev(adapter_to_dvobj(adapter))); -+ #endif -+ -+ #ifdef CONFIG_PCI_HCI -+ if (adapter_to_dvobj(adapter)->bdma64) -+ ndev->features |= NETIF_F_HIGHDMA; -+ ndev->irq = adapter_to_dvobj(adapter)->irq; -+ #endif -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (rtw_cfg80211_ndev_res_alloc(adapter) != _SUCCESS) { -+ rtw_warn_on(1); -+ goto free_ndev; -+ } -+#endif -+ -+ ret = _SUCCESS; -+ -+free_ndev: -+ if (ret != _SUCCESS && ndev) -+ rtw_free_netdev(ndev); -+exit: -+ return ret; -+} -+ -+void rtw_os_ndev_free(_adapter *adapter) -+{ -+#if defined(CONFIG_IOCTL_CFG80211) -+ rtw_cfg80211_ndev_res_free(adapter); -+#endif -+ -+ if (adapter->pnetdev) { -+ rtw_free_netdev(adapter->pnetdev); -+ adapter->pnetdev = NULL; -+ } -+} -+ -+int rtw_os_ndev_register(_adapter *adapter, char *name) -+{ -+ int ret = _SUCCESS; -+ struct net_device *ndev = adapter->pnetdev; -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (rtw_cfg80211_ndev_res_register(adapter) != _SUCCESS) { -+ rtw_warn_on(1); -+ ret = _FAIL; -+ goto exit; -+ } -+#endif -+ -+ /* alloc netdev name */ -+ rtw_init_netdev_name(ndev, name); -+ -+ _rtw_memcpy(ndev->dev_addr, adapter_mac_addr(adapter), ETH_ALEN); -+ -+ /* Tell the network stack we exist */ -+ if (register_netdev(ndev) != 0) { -+ DBG_871X(FUNC_NDEV_FMT" if%d Failed!\n", FUNC_NDEV_ARG(ndev), (adapter->iface_id+1)); -+ ret = _FAIL; -+ } -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (ret != _SUCCESS) { -+ rtw_cfg80211_ndev_res_unregister(adapter); -+ #if !defined(RTW_SINGLE_WIPHY) -+ rtw_wiphy_unregister(adapter_to_wiphy(adapter)); -+ #endif -+ } -+#endif -+ -+exit: -+ return ret; -+} -+ -+void rtw_os_ndev_unregister(_adapter *adapter) -+{ -+ struct net_device *netdev = NULL; -+ -+ if (adapter == NULL) -+ return; -+ -+ adapter->ndev_unregistering = 1; -+ -+ netdev = adapter->pnetdev; -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ rtw_cfg80211_ndev_res_unregister(adapter); -+#endif -+ -+ if ((adapter->DriverState != DRIVER_DISAPPEAR) && netdev) -+ unregister_netdev(netdev); /* will call netdev_close() */ -+ -+#if defined(CONFIG_IOCTL_CFG80211) && !defined(RTW_SINGLE_WIPHY) -+ rtw_wiphy_unregister(adapter_to_wiphy(adapter)); -+#endif -+ -+ adapter->ndev_unregistering = 0; -+} -+ -+/** -+ * rtw_os_ndev_init - Allocate and register OS layer net device and relating structures for @adapter -+ * @adapter: the adapter on which this function applies -+ * @name: the requesting net device name -+ * -+ * Returns: -+ * _SUCCESS or _FAIL -+ */ -+int rtw_os_ndev_init(_adapter *adapter, char *name) -+{ -+ int ret = _FAIL; -+ -+ if (rtw_os_ndev_alloc(adapter) != _SUCCESS) -+ goto exit; -+ -+ if (rtw_os_ndev_register(adapter, name) != _SUCCESS) -+ goto os_ndev_free; -+ -+ ret = _SUCCESS; -+ -+os_ndev_free: -+ if (ret != _SUCCESS) -+ rtw_os_ndev_free(adapter); -+exit: -+ return ret; -+} -+ -+/** -+ * rtw_os_ndev_deinit - Unregister and free OS layer net device and relating structures for @adapter -+ * @adapter: the adapter on which this function applies -+ */ -+void rtw_os_ndev_deinit(_adapter *adapter) -+{ -+ rtw_os_ndev_unregister(adapter); -+ rtw_os_ndev_free(adapter); -+} -+ -+int rtw_os_ndevs_alloc(struct dvobj_priv *dvobj) -+{ -+ int i, status = _SUCCESS; -+ _adapter *adapter; -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (rtw_cfg80211_dev_res_alloc(dvobj) != _SUCCESS) { -+ rtw_warn_on(1); -+ status = _FAIL; -+ goto exit; -+ } -+#endif -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ -+ if (i >= IFACE_ID_MAX) { -+ DBG_871X_LEVEL(_drv_err_, "%s %d >= IFACE_ID_MAX\n", __func__, i); -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ adapter = dvobj->padapters[i]; -+ if (adapter && !adapter->pnetdev) { -+ status = rtw_os_ndev_alloc(adapter); -+ if (status != _SUCCESS) { -+ rtw_warn_on(1); -+ break; -+ } -+ } -+ } -+ -+ if (status != _SUCCESS) { -+ for (; i >= 0; i--) { -+ adapter = dvobj->padapters[i]; -+ if (adapter && adapter->pnetdev) -+ rtw_os_ndev_free(adapter); -+ } -+ } -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (status != _SUCCESS) -+ rtw_cfg80211_dev_res_free(dvobj); -+#endif -+exit: -+ return status; -+} -+ -+void rtw_os_ndevs_free(struct dvobj_priv *dvobj) -+{ -+ int i; -+ _adapter *adapter = NULL; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ -+ if (i >= IFACE_ID_MAX) { -+ DBG_871X_LEVEL(_drv_err_, "%s %d >= IFACE_ID_MAX\n", __func__, i); -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ adapter = dvobj->padapters[i]; -+ -+ if (adapter == NULL) -+ continue; -+ -+ rtw_os_ndev_free(adapter); -+ } -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ rtw_cfg80211_dev_res_free(dvobj); -+#endif +} + +u32 rtw_start_drv_threads(_adapter *padapter) @@ -368543,17 +177120,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + u32 _status = _SUCCESS; + + RT_TRACE(_module_os_intfs_c_,_drv_info_,("+rtw_start_drv_threads\n")); -+ +#ifdef CONFIG_XMIT_THREAD_MODE -+#if defined(CONFIG_SDIO_HCI) -+ if (is_primary_adapter(padapter)) -+#endif -+ { -+ padapter->xmitThread = kthread_run(rtw_xmit_thread, padapter, "RTW_XMIT_THREAD"); -+ if(IS_ERR(padapter->xmitThread)) -+ _status = _FAIL; -+ } -+#endif //#ifdef CONFIG_XMIT_THREAD_MODE ++ padapter->xmitThread = kthread_run(rtw_xmit_thread, padapter, "RTW_XMIT_THREAD"); ++ if(IS_ERR(padapter->xmitThread)) ++ _status = _FAIL; ++#endif + +#ifdef CONFIG_RECV_THREAD_MODE + padapter->recvThread = kthread_run(rtw_recv_thread, padapter, "RTW_RECV_THREAD"); @@ -368561,7 +177132,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + _status = _FAIL; +#endif + -+ if (is_primary_adapter(padapter)) { ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if(padapter->isprimary == true) ++#endif //CONFIG_CONCURRENT_MODE ++ { + padapter->cmdThread = kthread_run(rtw_cmd_thread, padapter, "RTW_CMD_THREAD"); + if(IS_ERR(padapter->cmdThread)) + _status = _FAIL; @@ -368585,8 +177160,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +{ + RT_TRACE(_module_os_intfs_c_,_drv_info_,("+rtw_stop_drv_threads\n")); + -+ if (is_primary_adapter(padapter)) -+ rtw_stop_cmd_thread(padapter); ++#ifdef CONFIG_CONCURRENT_MODE ++ if(padapter->isprimary == true) ++#endif //CONFIG_CONCURRENT_MODE ++ { ++ //Below is to termindate rtw_cmd_thread & event_thread... ++ _rtw_up_sema(&padapter->cmdpriv.cmd_queue_sema); ++ //_rtw_up_sema(&padapter->cmdpriv.cmd_done_sema); ++ if(padapter->cmdThread){ ++ _rtw_down_sema(&padapter->cmdpriv.terminate_cmdthread_sema); ++ } ++ } + +#ifdef CONFIG_EVENT_THREAD_MODE + _rtw_up_sema(&padapter->evtpriv.evt_notify); @@ -368597,15 +177181,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + +#ifdef CONFIG_XMIT_THREAD_MODE + // Below is to termindate tx_thread... -+#if defined(CONFIG_SDIO_HCI) -+ // Only wake-up primary adapter -+ if (is_primary_adapter(padapter)) -+#endif /*SDIO_HCI */ -+ { -+ _rtw_up_sema(&padapter->xmitpriv.xmit_sema); -+ _rtw_down_sema(&padapter->xmitpriv.terminate_xmitthread_sema); -+ } -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("\n drv_halt: rtw_xmit_thread can be terminated !\n")); ++ _rtw_up_sema(&padapter->xmitpriv.xmit_sema); ++ _rtw_down_sema(&padapter->xmitpriv.terminate_xmitthread_sema); ++ RT_TRACE(_module_os_intfs_c_,_drv_info_,("\n drv_halt: rtw_xmit_thread can be terminated ! \n")); +#endif + +#ifdef CONFIG_RECV_THREAD_MODE @@ -368637,6 +177215,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + //recv_priv + + //mlme_priv ++ pmlmepriv->scan_interval = SCAN_INTERVAL;// 30*2 sec = 60sec + pmlmepriv->scan_mode = SCAN_ACTIVE; + + //qos_priv @@ -368644,15 +177223,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + + //ht_priv +#ifdef CONFIG_80211N_HT -+ pmlmepriv->htpriv.ampdu_enable = _FALSE;//set to disabled ++ pmlmepriv->htpriv.ampdu_enable = false;//set to disabled +#endif + + //security_priv + //rtw_get_encrypt_decrypt_from_registrypriv(padapter); + psecuritypriv->binstallGrpkey = _FAIL; -+#ifdef CONFIG_GTK_OL -+ psecuritypriv->binstallKCK_KEK = _FAIL; -+#endif //CONFIG_GTK_OL + psecuritypriv->sw_encrypt=pregistrypriv->software_encrypt; + psecuritypriv->sw_decrypt=pregistrypriv->software_decrypt; + @@ -368680,109 +177256,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + rtw_hal_def_value_init(padapter); + + //misc. -+ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); ++ padapter->bReadPortCancel = false; ++ padapter->bWritePortCancel = false; + padapter->bLinkInfoDump = 0; -+ padapter->bNotifyChannelChange = _FALSE; ++ padapter->bNotifyChannelChange = 0; +#ifdef CONFIG_P2P + padapter->bShowGetP2PState = 1; +#endif + -+ //for debug purpose -+ padapter->fix_rate = 0xFF; -+ padapter->data_fb = 0; -+ padapter->driver_ampdu_spacing = 0xFF; -+ padapter->driver_rx_ampdu_factor = 0xFF; -+ padapter->driver_rx_ampdu_spacing = 0xFF; -+ padapter->fix_rx_ampdu_accept = RX_AMPDU_ACCEPT_INVALID; -+ padapter->fix_rx_ampdu_size = RX_AMPDU_SIZE_INVALID; -+#ifdef DBG_RX_COUNTER_DUMP -+ padapter->dump_rx_cnt_mode = 0; -+ padapter->drv_rx_cnt_ok = 0; -+ padapter->drv_rx_cnt_crcerror = 0; -+ padapter->drv_rx_cnt_drop = 0; -+#endif + return ret; +} + -+struct dvobj_priv *devobj_init(void) -+{ -+ struct dvobj_priv *pdvobj = NULL; -+ -+ if ((pdvobj = (struct dvobj_priv*)rtw_zmalloc(sizeof(*pdvobj))) == NULL) -+ { -+ return NULL; -+ } -+ -+ _rtw_mutex_init(&pdvobj->hw_init_mutex); -+ _rtw_mutex_init(&pdvobj->h2c_fwcmd_mutex); -+ _rtw_mutex_init(&pdvobj->setch_mutex); -+ _rtw_mutex_init(&pdvobj->setbw_mutex); -+ _rtw_mutex_init(&pdvobj->rf_read_reg_mutex); -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ _rtw_mutex_init(&pdvobj->sd_indirect_access_mutex); -+#endif -+ -+ pdvobj->processing_dev_remove = _FALSE; -+ -+ ATOMIC_SET(&pdvobj->disable_func, 0); -+ -+ rtw_macid_ctl_init(&pdvobj->macid_ctl); -+ _rtw_spinlock_init(&pdvobj->cam_ctl.lock); -+ _rtw_mutex_init(&pdvobj->cam_ctl.sec_cam_access_mutex); -+ -+ return pdvobj; -+ -+} -+ -+void devobj_deinit(struct dvobj_priv *pdvobj) -+{ -+ if(!pdvobj) -+ return; -+ -+ /* TODO: use rtw_os_ndevs_deinit instead at the first stage of driver's dev deinit function */ -+#if defined(CONFIG_IOCTL_CFG80211) -+ rtw_cfg80211_dev_res_free(pdvobj); -+#endif -+ -+ _rtw_mutex_free(&pdvobj->hw_init_mutex); -+ _rtw_mutex_free(&pdvobj->h2c_fwcmd_mutex); -+ _rtw_mutex_free(&pdvobj->setch_mutex); -+ _rtw_mutex_free(&pdvobj->setbw_mutex); -+ _rtw_mutex_free(&pdvobj->rf_read_reg_mutex); -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ _rtw_mutex_free(&pdvobj->sd_indirect_access_mutex); -+#endif -+ -+ rtw_macid_ctl_deinit(&pdvobj->macid_ctl); -+ _rtw_spinlock_free(&pdvobj->cam_ctl.lock); -+ _rtw_mutex_free(&pdvobj->cam_ctl.sec_cam_access_mutex); -+ -+ rtw_mfree((u8*)pdvobj, sizeof(*pdvobj)); -+} -+ +u8 rtw_reset_drv_sw(_adapter *padapter) +{ + u8 ret8=_SUCCESS; + struct mlme_priv *pmlmepriv= &padapter->mlmepriv; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); ++ struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; + + //hal_priv -+ if( is_primary_adapter(padapter)) -+ rtw_hal_def_value_init(padapter); -+ -+ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); ++ rtw_hal_def_value_init(padapter); ++ padapter->bReadPortCancel = false; ++ padapter->bWritePortCancel = false; + padapter->bLinkInfoDump = 0; ++ pmlmepriv->scan_interval = SCAN_INTERVAL;// 30*2 sec = 60sec + + padapter->xmitpriv.tx_pkts = 0; + padapter->recvpriv.rx_pkts = 0; + -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; -+ -+ //pmlmepriv->LinkDetectInfo.TrafficBusyState = _FALSE; -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; ++ pmlmepriv->LinkDetectInfo.bBusyTraffic = false; + + _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY |_FW_UNDER_LINKING); + @@ -368793,13 +177294,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +#endif + +#ifdef DBG_CONFIG_ERROR_DETECT -+ if (is_primary_adapter(padapter)) -+ rtw_hal_sreset_reset_value(padapter); ++ rtw_hal_sreset_reset_value(padapter); +#endif + pwrctrlpriv->pwr_state_check_cnts = 0; + + //mlmeextpriv -+ mlmeext_set_scan_state(&padapter->mlmeextpriv, SCAN_DISABLE); ++ padapter->mlmeextpriv.sitesurvey_res.state= SCAN_DISABLE; + +#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS + rtw_set_signal_stat_timer(&padapter->recvpriv); @@ -368814,7 +177314,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + + u8 ret8=_SUCCESS; + -+_func_enter_; ++ + + RT_TRACE(_module_os_intfs_c_,_drv_info_,("+rtw_init_drv_sw\n")); + @@ -368886,9 +177386,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + ret8=_FAIL; + goto exit; + } -+ // add for CONFIG_IEEE80211W, none 11w also can use -+ _rtw_spinlock_init(&padapter->security_key_mutex); -+ ++ + // We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). + //_rtw_memset((unsigned char *)&padapter->securitypriv, 0, sizeof (struct security_priv)); + @@ -368902,17 +177400,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + } + + padapter->stapriv.padapter = padapter; -+ padapter->setband = WIFI_FREQUENCY_BAND_AUTO; -+ padapter->fix_rate = 0xFF; -+ padapter->data_fb = 0; -+ padapter->fix_rx_ampdu_accept = RX_AMPDU_ACCEPT_INVALID; -+ padapter->fix_rx_ampdu_size = RX_AMPDU_SIZE_INVALID; -+#ifdef DBG_RX_COUNTER_DUMP -+ padapter->dump_rx_cnt_mode = 0; -+ padapter->drv_rx_cnt_ok = 0; -+ padapter->drv_rx_cnt_crcerror = 0; -+ padapter->drv_rx_cnt_drop = 0; -+#endif ++ padapter->setband = GHZ24_50; + rtw_init_bcmc_stainfo(padapter); + + rtw_init_pwrctrl_priv(padapter); @@ -368954,7 +177442,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + + RT_TRACE(_module_os_intfs_c_,_drv_info_,("-rtw_init_drv_sw\n")); + -+ _func_exit_; ++ + + return ret8; + @@ -368973,28 +177461,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + RT_TRACE(_module_os_intfs_c_,_drv_info_,("+rtw_cancel_all_timer\n")); + + _cancel_timer_ex(&padapter->mlmepriv.assoc_timer); -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel association timer complete!\n")); ++ RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel association timer complete! \n")); + -+ #if 0 -+ _cancel_timer_ex(&padapter->securitypriv.tkip_timer); -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel tkip_timer!\n")); -+ #endif ++ //_cancel_timer_ex(&padapter->securitypriv.tkip_timer); ++ //RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel tkip_timer! \n")); + + _cancel_timer_ex(&padapter->mlmepriv.scan_to_timer); -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel scan_to_timer!\n")); -+ -+ #ifdef CONFIG_DFS_MASTER -+ _cancel_timer_ex(&padapter->mlmepriv.dfs_master_timer); -+ #endif ++ RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel scan_to_timer! \n")); + + _cancel_timer_ex(&padapter->mlmepriv.dynamic_chk_timer); -+ RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel dynamic_chk_timer!\n")); ++ RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel dynamic_chk_timer! \n")); + + // cancel sw led timer + rtw_hal_sw_led_deinit(padapter); + RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel DeInitSwLeds! \n")); + -+ _cancel_timer_ex(&(adapter_to_pwrctl(padapter)->pwr_state_check_timer)); ++ _cancel_timer_ex(&padapter->pwrctrlpriv.pwr_state_check_timer); + +#ifdef CONFIG_IOCTL_CFG80211 +#ifdef CONFIG_P2P @@ -369013,14 +177495,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +#endif + //cancel dm timer + rtw_hal_dm_deinit(padapter); -+ -+#ifdef CONFIG_PLATFORM_FS_MX61 -+ msleep(50); -+#endif +} + +u8 rtw_free_drv_sw(_adapter *padapter) +{ ++ struct net_device *pnetdev = (struct net_device*)padapter->pnetdev; ++ + RT_TRACE(_module_os_intfs_c_,_drv_info_,("==>rtw_free_drv_sw")); + +#ifdef CONFIG_WAPI_SUPPORT @@ -369045,9 +177525,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + } + } + #endif -+ // add for CONFIG_IEEE80211W, none 11w also can use -+ _rtw_spinlock_free(&padapter->security_key_mutex); -+ ++ ++ +#ifdef CONFIG_BR_EXT + _rtw_spinlock_free(&padapter->br_ext_lock); +#endif // CONFIG_BR_EXT @@ -369117,12 +177596,22 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + if(!primary_padapter) + goto _netdev_virtual_iface_open_error; + -+ if (primary_padapter->bup == _FALSE || !rtw_is_hw_init_completed(primary_padapter)) -+ _netdev_open(primary_padapter->pnetdev); -+ -+ if(padapter->bup == _FALSE && primary_padapter->bup == _TRUE && -+ rtw_is_hw_init_completed(primary_padapter)) ++ if(primary_padapter->bup == false || primary_padapter->hw_init_completed == false) + { ++ _netdev_open(primary_padapter->pnetdev); ++ } ++ ++ if(padapter->bup == false && primary_padapter->bup == true && ++ primary_padapter->hw_init_completed == true) ++ { ++ int i; ++ ++ padapter->bDriverStopped = false; ++ padapter->bSurpriseRemoved = false; ++ padapter->bCardDisableWOHSM = false; ++ ++ rtw_hal_clone_data(padapter, primary_padapter); ++ + padapter->bFWReady = primary_padapter->bFWReady; + + if(rtw_start_drv_threads(padapter) == _FAIL) @@ -369130,26 +177619,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + goto _netdev_virtual_iface_open_error; + } + ++ padapter->dir_dev = NULL; ++ rtw_proc_init_one(pnetdev); ++ +#ifdef CONFIG_IOCTL_CFG80211 + rtw_cfg80211_init_wiphy(padapter); +#endif + -+ padapter->bup = _TRUE; ++ padapter->bup = true; ++ padapter->hw_init_completed = true; + + } + -+ padapter->net_closed = _FALSE; ++ padapter->net_closed = false; + + _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); + -+ rtw_netif_wake_queue(pnetdev); ++ if(!rtw_netif_queue_stopped(pnetdev)) ++ rtw_netif_start_queue(pnetdev); ++ else ++ rtw_netif_wake_queue(pnetdev); ++ + + DBG_871X(FUNC_NDEV_FMT" exit\n", FUNC_NDEV_ARG(pnetdev)); + return 0; + +_netdev_virtual_iface_open_error: + -+ padapter->bup = _FALSE; ++ padapter->bup = false; + + netif_carrier_off(pnetdev); + rtw_netif_stop_queue(pnetdev); @@ -369179,17 +177676,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); + -+ padapter->net_closed = _TRUE; ++ padapter->net_closed = true; + + if(pnetdev) + { -+ rtw_netif_stop_queue(pnetdev); ++ if (!rtw_netif_queue_stopped(pnetdev)) ++ rtw_netif_stop_queue(pnetdev); + } + +#ifdef CONFIG_IOCTL_CFG80211 + rtw_scan_abort(padapter); -+ rtw_cfg80211_wait_scan_req_empty(padapter, 200); -+ adapter_wdev_data(padapter)->bandroid_scan = _FALSE; ++ wdev_to_priv(padapter->rtw_wdev)->bandroid_scan = false; +#endif + + return 0; @@ -369209,50 +177706,53 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +}; +#endif + -+void rtw_hook_vir_if_ops(struct net_device *ndev) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+ ndev->netdev_ops = &rtw_netdev_vir_if_ops; -+#else -+ ndev->open = netdev_vir_if_open; -+ ndev->stop = netdev_vir_if_close; -+ ndev->set_mac_address = rtw_net_set_mac_address; -+#endif -+} -+ +_adapter *rtw_drv_add_vir_if(_adapter *primary_padapter, + void (*set_intf_ops)(_adapter *primary_padapter,struct _io_ops *pops)) +{ ++ + int res = _FAIL; ++ struct net_device *pnetdev=NULL; + _adapter *padapter = NULL; + struct dvobj_priv *pdvobjpriv; + u8 mac[ETH_ALEN]; + +/* -+ if((primary_padapter->bup == _FALSE) || -+ (rtw_buddy_adapter_up(primary_padapter) == _FALSE)) -+ goto exit; ++ if((primary_padapter->bup == false) || ++ (rtw_buddy_adapter_up(primary_padapter) == false)) ++ { ++ goto error_rtw_drv_add_iface; ++ } ++ +*/ ++ /****** init netdev ******/ ++ pnetdev = rtw_init_netdev(NULL); ++ if (!pnetdev) ++ goto error_rtw_drv_add_iface; ++ ++#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) ++ DBG_871X("register rtw_netdev_virtual_iface_ops to netdev_ops\n"); ++ pnetdev->netdev_ops = &rtw_netdev_vir_if_ops; ++#else ++ pnetdev->open = netdev_vir_if_open; ++ pnetdev->stop = netdev_vir_if_close; ++#endif ++ ++#ifdef CONFIG_NO_WIRELESS_HANDLERS ++ pnetdev->wireless_handlers = NULL; ++#endif + + /****** init adapter ******/ -+ padapter = (_adapter *)rtw_zvmalloc(sizeof(*padapter)); -+ if (padapter == NULL) -+ goto exit; -+ -+ if (loadparam(padapter) != _SUCCESS) -+ goto free_adapter; -+ ++ padapter = rtw_netdev_priv(pnetdev); + _rtw_memcpy(padapter, primary_padapter, sizeof(_adapter)); + + // -+ padapter->bup = _FALSE; -+ padapter->net_closed = _TRUE; -+ padapter->dir_dev = NULL; -+ padapter->dir_odm = NULL; ++ padapter->bup = false; ++ padapter->net_closed = true; ++ padapter->hw_init_completed = false; + + + //set adapter_type/iface type -+ padapter->isprimary = _FALSE; ++ padapter->isprimary = false; + padapter->adapter_type = MAX_ADAPTER; + padapter->pbuddy_adapter = primary_padapter; +#if 0 @@ -369265,52 +177765,94 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + //extended virtual interfaces always are set to port0 + padapter->iface_type = IFACE_PORT0; +#endif ++ // ++ padapter->pnetdev = pnetdev; + -+ /****** hook vir if into dvobj ******/ ++ /****** setup dvobj ******/ + pdvobjpriv = adapter_to_dvobj(padapter); + padapter->iface_id = pdvobjpriv->iface_nums; + pdvobjpriv->padapters[pdvobjpriv->iface_nums++] = padapter; + ++ SET_NETDEV_DEV(pnetdev, dvobj_to_dev(pdvobjpriv)); ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_wdev_alloc(padapter, dvobj_to_dev(pdvobjpriv)); ++#endif //CONFIG_IOCTL_CFG80211 ++ ++ //set interface_type/chip_type/HardwareType ++ padapter->interface_type = primary_padapter->interface_type; ++ padapter->chip_type = primary_padapter->chip_type; ++ padapter->HardwareType = primary_padapter->HardwareType; ++ ++ //step 2. hook HalFunc, allocate HalData ++ //hal_set_hal_ops(padapter); ++ rtw_set_hal_ops(padapter); ++ ++ padapter->HalFunc.inirp_init = NULL; ++ padapter->HalFunc.inirp_deinit = NULL; + padapter->intf_start = NULL; + padapter->intf_stop = NULL; + + //step init_io_priv + if ((rtw_init_io_priv(padapter, set_intf_ops)) == _FAIL) { -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("\n Can't init io_reqs\n")); -+ goto free_adapter; ++ RT_TRACE(_module_hci_intfs_c_,_drv_err_,(" \n Can't init io_reqs\n")); + } + ++ //step read_chip_version ++ rtw_hal_read_chip_version(padapter); ++ ++ //step usb endpoint mapping ++ rtw_hal_chip_configure(padapter); ++ ++ + //init drv data + if(rtw_init_drv_sw(padapter)!= _SUCCESS) -+ goto free_drv_sw; ++ goto error_rtw_drv_add_iface; + + + //get mac address from primary_padapter -+ _rtw_memcpy(mac, adapter_mac_addr(primary_padapter), ETH_ALEN); ++ _rtw_memcpy(mac, primary_padapter->eeprompriv.mac_addr, ETH_ALEN); + -+ /* -+ * If the BIT1 is 0, the address is universally administered. -+ * If it is 1, the address is locally administered -+ */ -+#if 1 /* needs enable MBSSID CAM */ -+ mac[0] |= BIT(1); -+ mac[0] |= (padapter->iface_id-1)<<4; ++ if (((mac[0]==0xff) &&(mac[1]==0xff) && (mac[2]==0xff) && ++ (mac[3]==0xff) && (mac[4]==0xff) &&(mac[5]==0xff)) || ++ ((mac[0]==0x0) && (mac[1]==0x0) && (mac[2]==0x0) && ++ (mac[3]==0x0) && (mac[4]==0x0) &&(mac[5]==0x0))) ++ { ++ mac[0] = 0x00; ++ mac[1] = 0xe0; ++ mac[2] = 0x4c; ++ mac[3] = 0x87; ++ mac[4] = 0x11; ++ mac[5] = 0x22; ++ } ++ else ++ { ++ //If the BIT1 is 0, the address is universally administered. ++ //If it is 1, the address is locally administered ++#if 1 //needs enable MBSSID CAM ++ mac[0] |= BIT(1); // locally administered ++ mac[0] |= (padapter->iface_id-1)<<4; +#endif ++ } + -+ _rtw_memcpy(adapter_mac_addr(padapter), mac, ETH_ALEN); ++ _rtw_memcpy(padapter->eeprompriv.mac_addr, mac, ETH_ALEN); ++ ++ padapter->dir_dev = NULL; + + res = _SUCCESS; + -+free_drv_sw: -+ if (res != _SUCCESS && padapter) -+ rtw_free_drv_sw(padapter); -+free_adapter: -+ if (res != _SUCCESS && padapter) { -+ rtw_vmfree((u8 *)padapter, sizeof(*padapter)); -+ padapter = NULL; -+ } -+exit: + return padapter; ++ ++ ++error_rtw_drv_add_iface: ++ ++ if(padapter) ++ rtw_free_drv_sw(padapter); ++ ++ if (pnetdev) ++ rtw_free_netdev(pnetdev); ++ ++ return NULL; ++ +} + +void rtw_drv_stop_vir_if(_adapter *padapter) @@ -369322,41 +177864,57 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + + pnetdev = padapter->pnetdev; + -+ -+ if (padapter->bup == _TRUE) ++ if(pnetdev) + { ++ unregister_netdev(pnetdev); //will call netdev_close() ++ rtw_proc_remove_one(pnetdev); ++ } ++ ++ rtw_cancel_all_timer(padapter); ++ ++ if(padapter->bup == true) ++ { ++ padapter->bDriverStopped = true; ++ + #ifdef CONFIG_XMIT_ACK + if (padapter->xmitpriv.ack_tx) + rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP); + #endif + -+ if (padapter->intf_stop) ++ if(padapter->intf_stop) + { + padapter->intf_stop(padapter); + } + + rtw_stop_drv_threads(padapter); + -+ padapter->bup = _FALSE; ++ padapter->bup = false; + } + -+ /* cancel timer after thread stop */ -+ rtw_cancel_all_timer(padapter); ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_wdev_unregister(padapter->rtw_wdev); ++#endif //CONFIG_IOCTL_CFG80211 ++ +} + +void rtw_drv_free_vir_if(_adapter *padapter) +{ ++ struct net_device *pnetdev=NULL; ++ + if (padapter == NULL) + return; + + padapter->pbuddy_adapter = NULL; + ++ pnetdev = padapter->pnetdev; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_wdev_free(padapter->rtw_wdev); ++#endif //CONFIG_IOCTL_CFG80211 ++ + rtw_free_drv_sw(padapter); + -+ /* TODO: use rtw_os_ndevs_deinit instead at the first stage of driver's dev deinit function */ -+ rtw_os_ndev_free(padapter); -+ -+ rtw_vmfree((u8 *)padapter, sizeof(_adapter)); ++ rtw_free_netdev(pnetdev); +} + +void rtw_drv_stop_vir_ifaces(struct dvobj_priv *dvobj) @@ -369406,74 +177964,70 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + + DBG_871X("+871x_drv - if2_open, bup=%d\n", padapter->bup); + -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ if (padapter->bup == _FALSE) ++ if(primary_padapter->bup == false || primary_padapter->hw_init_completed == false) + { -+ u8 mac[ETH_ALEN]; -+ -+ /* get mac address from primary_padapter */ -+ if (primary_padapter->bup == _FALSE) -+ rtw_macaddr_cfg(adapter_mac_addr(primary_padapter), get_hal_mac_addr(primary_padapter)); -+ -+ _rtw_memcpy(mac, adapter_mac_addr(primary_padapter), ETH_ALEN); -+ -+ /* -+ * If the BIT1 is 0, the address is universally administered. -+ * If it is 1, the address is locally administered -+ */ -+ mac[0] |= BIT(1); -+ -+ _rtw_memcpy(adapter_mac_addr(padapter), mac, ETH_ALEN); -+ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); -+ _rtw_memcpy(pnetdev->dev_addr, adapter_mac_addr(padapter), ETH_ALEN); -+ } -+#endif //CONFIG_PLATFORM_INTEL_BYT -+ -+ if (primary_padapter->bup == _FALSE || !rtw_is_hw_init_completed(primary_padapter)) + _netdev_open(primary_padapter->pnetdev); ++ } + -+ if(padapter->bup == _FALSE && primary_padapter->bup == _TRUE && -+ rtw_is_hw_init_completed(primary_padapter)) ++ if(padapter->bup == false && primary_padapter->bup == true && ++ primary_padapter->hw_init_completed == true) + { ++ int i; ++ ++ padapter->bDriverStopped = false; ++ padapter->bSurpriseRemoved = false; ++ padapter->bCardDisableWOHSM = false; ++ ++// _rtw_memcpy(padapter->HalData, primary_padapter->HalData, padapter->hal_data_sz); ++ rtw_hal_clone_data(padapter, primary_padapter); ++ + padapter->bFWReady = primary_padapter->bFWReady; + + //if (init_mlme_ext_priv(padapter) == _FAIL) + // goto netdev_if2_open_error; + + -+ if (rtw_start_drv_threads(padapter) == _FAIL) ++ if(rtw_start_drv_threads(padapter) == _FAIL) + { + goto netdev_if2_open_error; + } + + -+ if (padapter->intf_start) ++ if(padapter->intf_start) + { + padapter->intf_start(padapter); + } + ++ ++ padapter->hw_init_completed = true; ++ ++ padapter->dir_dev = NULL; ++ rtw_proc_init_one(pnetdev); ++ ++ +#ifdef CONFIG_IOCTL_CFG80211 + rtw_cfg80211_init_wiphy(padapter); +#endif + -+ padapter->bup = _TRUE; ++ padapter->bup = true; + + } + -+ padapter->net_closed = _FALSE; ++ padapter->net_closed = false; + -+ //execute dynamic_chk_timer only on primary interface -+ // secondary interface shares the timer with primary interface. -+ //_set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); ++ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); + -+ rtw_netif_wake_queue(pnetdev); ++ if(!rtw_netif_queue_stopped(pnetdev)) ++ rtw_netif_start_queue(pnetdev); ++ else ++ rtw_netif_wake_queue(pnetdev); + + DBG_871X("-871x_drv - if2_open, bup=%d\n", padapter->bup); + return 0; + +netdev_if2_open_error: + -+ padapter->bup = _FALSE; ++ padapter->bup = false; + + netif_carrier_off(pnetdev); + rtw_netif_stop_queue(pnetdev); @@ -369486,13 +178040,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +{ + int ret; + _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if (pwrctrlpriv->bInSuspend == _TRUE) -+ { -+ DBG_871X("+871x_drv - netdev_if2_open, bInSuspend=%d\n", pwrctrlpriv->bInSuspend); -+ return 0; -+ } + + _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); + ret = _netdev_if2_open(pnetdev); @@ -369509,25 +178056,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +static int netdev_if2_close(struct net_device *pnetdev) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + -+ padapter->net_closed = _TRUE; -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; ++ padapter->net_closed = true; + + if(pnetdev) + { -+ rtw_netif_stop_queue(pnetdev); ++ if (!rtw_netif_queue_stopped(pnetdev)) ++ rtw_netif_stop_queue(pnetdev); + } + -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_role(&padapter->wdinfo, P2P_ROLE_DISABLE)) -+ rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); -+#endif -+ +#ifdef CONFIG_IOCTL_CFG80211 + rtw_scan_abort(padapter); -+ rtw_cfg80211_wait_scan_req_empty(padapter, 200); -+ adapter_wdev_data(padapter)->bandroid_scan = _FALSE; ++ wdev_to_priv(padapter->rtw_wdev)->bandroid_scan = false; +#endif + + return 0; @@ -369535,59 +178075,55 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + +#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) +static const struct net_device_ops rtw_netdev_if2_ops = { -+ .ndo_init = rtw_ndev_init, -+ .ndo_uninit = rtw_ndev_uninit, + .ndo_open = netdev_if2_open, -+ .ndo_stop = netdev_if2_close, -+ .ndo_start_xmit = rtw_xmit_entry, -+ .ndo_set_mac_address = rtw_net_set_mac_address, -+ .ndo_get_stats = rtw_net_get_stats, -+ .ndo_do_ioctl = rtw_ioctl, ++ .ndo_stop = netdev_if2_close, ++ .ndo_start_xmit = rtw_xmit_entry, ++ .ndo_set_mac_address = rtw_net_set_mac_address, ++ .ndo_get_stats = rtw_net_get_stats, ++ .ndo_do_ioctl = rtw_ioctl, +#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) + .ndo_select_queue = rtw_select_queue, +#endif +}; +#endif + -+void rtw_hook_if2_ops(struct net_device *ndev) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+ ndev->netdev_ops = &rtw_netdev_if2_ops; -+#else -+ ndev->init = rtw_ndev_init; -+ ndev->uninit = rtw_ndev_uninit; -+ ndev->open = netdev_if2_open; -+ ndev->stop = netdev_if2_close; -+ ndev->set_mac_address = rtw_net_set_mac_address; -+#endif -+} -+ -+_adapter *rtw_drv_if2_init(_adapter *primary_padapter, ++_adapter *rtw_drv_if2_init(_adapter *primary_padapter, + void (*set_intf_ops)(_adapter *primary_padapter,struct _io_ops *pops)) +{ + int res = _FAIL; ++ struct net_device *pnetdev = NULL; + _adapter *padapter = NULL; + struct dvobj_priv *pdvobjpriv; + u8 mac[ETH_ALEN]; + ++ /****** init netdev ******/ ++ pnetdev = rtw_init_netdev(NULL); ++ if (!pnetdev) ++ goto error_rtw_drv_if2_init; ++ ++#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) ++ DBG_871X("register rtw_netdev_if2_ops to netdev_ops\n"); ++ pnetdev->netdev_ops = &rtw_netdev_if2_ops; ++#else ++ pnetdev->open = netdev_if2_open; ++ pnetdev->stop = netdev_if2_close; ++#endif ++ ++#ifdef CONFIG_NO_WIRELESS_HANDLERS ++ pnetdev->wireless_handlers = NULL; ++#endif ++ + /****** init adapter ******/ -+ padapter = (_adapter *)rtw_zvmalloc(sizeof(*padapter)); -+ if (padapter == NULL) -+ goto exit; -+ -+ if (loadparam(padapter) != _SUCCESS) -+ goto free_adapter; -+ -+ _rtw_memcpy(padapter, primary_padapter, sizeof(*padapter)); ++ padapter = rtw_netdev_priv(pnetdev); ++ _rtw_memcpy(padapter, primary_padapter, sizeof(_adapter)); + + // -+ padapter->bup = _FALSE; -+ padapter->net_closed = _TRUE; -+ padapter->dir_dev = NULL; -+ padapter->dir_odm = NULL; ++ padapter->bup = false; ++ padapter->net_closed = true; ++ padapter->hw_init_completed = false; + + //set adapter_type/iface type -+ padapter->isprimary = _FALSE; ++ padapter->isprimary = false; + padapter->adapter_type = SECONDARY_ADAPTER; + padapter->pbuddy_adapter = primary_padapter; + padapter->iface_id = IFACE_ID1; @@ -369596,67 +178132,119 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +#else + padapter->iface_type = IFACE_PORT0; +#endif //CONFIG_HWPORT_SWAP ++ // ++ padapter->pnetdev = pnetdev; + -+ /****** hook if2 into dvobj ******/ ++ /****** setup dvobj ******/ + pdvobjpriv = adapter_to_dvobj(padapter); ++ pdvobjpriv->if2 = padapter; + pdvobjpriv->padapters[pdvobjpriv->iface_nums++] = padapter; + ++ SET_NETDEV_DEV(pnetdev, dvobj_to_dev(pdvobjpriv)); ++ #ifdef CONFIG_IOCTL_CFG80211 ++ rtw_wdev_alloc(padapter, dvobj_to_dev(pdvobjpriv)); ++ #endif //CONFIG_IOCTL_CFG80211 ++ ++ //set interface_type/chip_type/HardwareType ++ padapter->interface_type = primary_padapter->interface_type; ++ padapter->chip_type = primary_padapter->chip_type; ++ padapter->HardwareType = primary_padapter->HardwareType; ++ ++ //step 2. hook HalFunc, allocate HalData ++ //hal_set_hal_ops(padapter); ++ rtw_set_hal_ops(padapter); ++ ++ padapter->HalFunc.inirp_init = NULL; ++ padapter->HalFunc.inirp_deinit = NULL; ++ + // + padapter->intf_start = primary_padapter->intf_start; + padapter->intf_stop = primary_padapter->intf_stop; + + //step init_io_priv + if ((rtw_init_io_priv(padapter, set_intf_ops)) == _FAIL) { -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("\n Can't init io_reqs\n")); -+ goto free_adapter; ++ RT_TRACE(_module_hci_intfs_c_,_drv_err_,(" \n Can't init io_reqs\n")); + } + ++ //step read_chip_version ++ rtw_hal_read_chip_version(padapter); ++ ++ //step usb endpoint mapping ++ rtw_hal_chip_configure(padapter); ++ ++ + //init drv data + if(rtw_init_drv_sw(padapter)!= _SUCCESS) -+ goto free_drv_sw; ++ goto error_rtw_drv_if2_init; + + -+ /* get mac address from primary_padapter */ -+ _rtw_memcpy(mac, adapter_mac_addr(primary_padapter), ETH_ALEN); ++ //get mac address from primary_padapter ++ _rtw_memcpy(mac, primary_padapter->eeprompriv.mac_addr, ETH_ALEN); + -+ /* -+ * If the BIT1 is 0, the address is universally administered. -+ * If it is 1, the address is locally administered -+ */ -+ mac[0] |= BIT(1); ++ if (((mac[0]==0xff) &&(mac[1]==0xff) && (mac[2]==0xff) && ++ (mac[3]==0xff) && (mac[4]==0xff) &&(mac[5]==0xff)) || ++ ((mac[0]==0x0) && (mac[1]==0x0) && (mac[2]==0x0) && ++ (mac[3]==0x0) && (mac[4]==0x0) &&(mac[5]==0x0))) ++ { ++ mac[0] = 0x00; ++ mac[1] = 0xe0; ++ mac[2] = 0x4c; ++ mac[3] = 0x87; ++ mac[4] = 0x11; ++ mac[5] = 0x22; ++ } ++ else ++ { ++ //If the BIT1 is 0, the address is universally administered. ++ //If it is 1, the address is locally administered ++ mac[0] |= BIT(1); // locally administered + -+ _rtw_memcpy(adapter_mac_addr(padapter), mac, ETH_ALEN); -+ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); ++ } ++ ++ _rtw_memcpy(padapter->eeprompriv.mac_addr, mac, ETH_ALEN); ++ rtw_init_wifidirect_addrs(padapter, padapter->eeprompriv.mac_addr, padapter->eeprompriv.mac_addr); + + primary_padapter->pbuddy_adapter = padapter; + ++ padapter->dir_dev = NULL; ++ ++ + res = _SUCCESS; + -+free_drv_sw: -+ if (res != _SUCCESS && padapter) -+ rtw_free_drv_sw(padapter); -+free_adapter: -+ if (res != _SUCCESS && padapter) { -+ rtw_vmfree((u8 *)padapter, sizeof(*padapter)); -+ padapter = NULL; -+ } -+exit: + return padapter; ++ ++ ++error_rtw_drv_if2_init: ++ ++ if(padapter) ++ rtw_free_drv_sw(padapter); ++ ++ if (pnetdev) ++ rtw_free_netdev(pnetdev); ++ ++ return NULL; ++ +} + +void rtw_drv_if2_free(_adapter *if2) +{ + _adapter *padapter = if2; ++ struct net_device *pnetdev = NULL; + + if (padapter == NULL) + return; + ++ pnetdev = padapter->pnetdev; ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ rtw_wdev_free(padapter->rtw_wdev); ++#endif /* CONFIG_IOCTL_CFG80211 */ ++ ++ + rtw_free_drv_sw(padapter); + -+ /* TODO: use rtw_os_ndevs_deinit instead at the first stage of driver's dev deinit function */ -+ rtw_os_ndev_free(padapter); ++ rtw_free_netdev(pnetdev); + -+ rtw_vmfree((u8 *)padapter, sizeof(_adapter)); +} + +void rtw_drv_if2_stop(_adapter *if2) @@ -369667,154 +178255,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + if (padapter == NULL) + return; + ++ pnetdev = padapter->pnetdev; + -+ if (padapter->bup == _TRUE) { ++ if (pnetdev) { ++ unregister_netdev(pnetdev); //will call netdev_close() ++ rtw_proc_remove_one(pnetdev); ++ } ++ ++ rtw_cancel_all_timer(padapter); ++ ++ if (padapter->bup == true) { ++ padapter->bDriverStopped = true; + #ifdef CONFIG_XMIT_ACK + if (padapter->xmitpriv.ack_tx) + rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP); + #endif + -+ if (padapter->intf_stop) ++ if(padapter->intf_stop) + { + padapter->intf_stop(padapter); + } + + rtw_stop_drv_threads(padapter); + -+ padapter->bup = _FALSE; ++ padapter->bup = false; + } + -+ /* cancel timer after thread stop */ -+ rtw_cancel_all_timer(padapter); ++ #ifdef CONFIG_IOCTL_CFG80211 ++ rtw_wdev_unregister(padapter->rtw_wdev); ++ #endif ++ +} +#endif //end of CONFIG_CONCURRENT_MODE + -+int rtw_os_ndevs_register(struct dvobj_priv *dvobj) -+{ -+ int i, status = _SUCCESS; -+ struct registry_priv *regsty = dvobj_to_regsty(dvobj); -+ _adapter *adapter; -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (rtw_cfg80211_dev_res_register(dvobj) != _SUCCESS) { -+ rtw_warn_on(1); -+ status = _FAIL; -+ goto exit; -+ } -+#endif -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ -+ if (i >= IFACE_ID_MAX) { -+ DBG_871X_LEVEL(_drv_err_, "%s %d >= IFACE_ID_MAX\n", __func__, i); -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ adapter = dvobj->padapters[i]; -+ if (adapter) { -+ char *name; -+ -+ if (adapter->iface_id == IFACE_ID0) -+ name = regsty->ifname; -+ else if (adapter->iface_id == IFACE_ID1) -+ name = regsty->if2name; -+ else -+ name = "wlan%d"; -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ switch (adapter->adapter_type) { -+ case SECONDARY_ADAPTER: -+ rtw_hook_if2_ops(adapter->pnetdev); -+ break; -+ #ifdef CONFIG_MULTI_VIR_IFACES -+ case MAX_ADAPTER: -+ rtw_hook_vir_if_ops(adapter->pnetdev); -+ break; -+ #endif -+ } -+ #endif /* CONFIG_CONCURRENT_MODE */ -+ -+ status = rtw_os_ndev_register(adapter, name); -+ -+ if (status != _SUCCESS) { -+ rtw_warn_on(1); -+ break; -+ } -+ } -+ } -+ -+ if (status != _SUCCESS) { -+ for (; i >= 0; i--) { -+ adapter = dvobj->padapters[i]; -+ if (adapter) -+ rtw_os_ndev_unregister(adapter); -+ } -+ } -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (status != _SUCCESS) -+ rtw_cfg80211_dev_res_unregister(dvobj); -+#endif -+exit: -+ return status; -+} -+ -+void rtw_os_ndevs_unregister(struct dvobj_priv *dvobj) -+{ -+ int i; -+ _adapter *adapter = NULL; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ adapter = dvobj->padapters[i]; -+ -+ if (adapter == NULL) -+ continue; -+ -+ rtw_os_ndev_unregister(adapter); -+ } -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ rtw_cfg80211_dev_res_unregister(dvobj); -+#endif -+} -+ -+/** -+ * rtw_os_ndevs_init - Allocate and register OS layer net devices and relating structures for @dvobj -+ * @dvobj: the dvobj on which this function applies -+ * -+ * Returns: -+ * _SUCCESS or _FAIL -+ */ -+int rtw_os_ndevs_init(struct dvobj_priv *dvobj) -+{ -+ int ret = _FAIL; -+ -+ if (rtw_os_ndevs_alloc(dvobj) != _SUCCESS) -+ goto exit; -+ -+ if (rtw_os_ndevs_register(dvobj) != _SUCCESS) -+ goto os_ndevs_free; -+ -+ ret = _SUCCESS; -+ -+os_ndevs_free: -+ if (ret != _SUCCESS) -+ rtw_os_ndevs_free(dvobj); -+exit: -+ return ret; -+} -+ -+/** -+ * rtw_os_ndevs_deinit - Unregister and free OS layer net devices and relating structures for @dvobj -+ * @dvobj: the dvobj on which this function applies -+ */ -+void rtw_os_ndevs_deinit(struct dvobj_priv *dvobj) -+{ -+ rtw_os_ndevs_unregister(dvobj); -+ rtw_os_ndevs_free(dvobj); -+} -+ +#ifdef CONFIG_BR_EXT +void netdev_br_init(struct net_device *netdev) +{ @@ -369824,7 +178297,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + rcu_read_lock(); +#endif // (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) + -+ //if(check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == _TRUE) ++ //if(check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == true) + { + //struct net_bridge *br = netdev->br_port->br;//->dev->dev_addr; +#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) @@ -369864,39 +178337,90 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +} +#endif //CONFIG_BR_EXT + ++static int _rtw_drv_register_netdev(_adapter *padapter, char *name) ++{ ++ int ret = _SUCCESS; ++ struct net_device *pnetdev = padapter->pnetdev; ++ ++ /* alloc netdev name */ ++ rtw_init_netdev_name(pnetdev, name); ++ ++ _rtw_memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN); ++ ++ /* Tell the network stack we exist */ ++ if (register_netdev(pnetdev) != 0) { ++ DBG_871X(FUNC_NDEV_FMT "Failed!\n", FUNC_NDEV_ARG(pnetdev)); ++ ret = _FAIL; ++ goto error_register_netdev; ++ } ++ ++ DBG_871X("%s, MAC Address (if%d) = " MAC_FMT "\n", __FUNCTION__, (padapter->iface_id+1), MAC_ARG(pnetdev->dev_addr)); ++ ++ return ret; ++ ++error_register_netdev: ++ ++ if(padapter->iface_id > IFACE_ID0) ++ { ++ rtw_free_drv_sw(padapter); ++ ++ rtw_free_netdev(pnetdev); ++ } ++ ++ return ret; ++} ++ ++int rtw_drv_register_netdev(_adapter *if1) ++{ ++ int i, status = _SUCCESS; ++ struct dvobj_priv *dvobj = if1->dvobj; ++ ++ if(dvobj->iface_nums < IFACE_ID_MAX) ++ { ++ for(i=0; iiface_nums; i++) ++ { ++ _adapter *padapter = dvobj->padapters[i]; ++ ++ if(padapter) ++ { ++ char *name; ++ ++ if(padapter->iface_id == IFACE_ID0) ++ name = if1->registrypriv.ifname; ++ else if(padapter->iface_id == IFACE_ID1) ++ name = if1->registrypriv.if2name; ++ else ++ name = "wlan%d"; ++ ++ if((status = _rtw_drv_register_netdev(padapter, name)) != _SUCCESS) { ++ break; ++ } ++ } ++ } ++ } ++ ++ return status; ++} ++ +int _netdev_open(struct net_device *pnetdev) +{ + uint status; + _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX ++ struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; + + RT_TRACE(_module_os_intfs_c_,_drv_info_,("+871x_drv - dev_open\n")); + DBG_871X("+871x_drv - drv_open, bup=%d\n", padapter->bup); + -+ padapter->netif_up = _TRUE; -+ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ rtw_sdio_set_power(1); -+#endif //CONFIG_PLATFORM_INTEL_BYT -+ -+ if(pwrctrlpriv->ps_flag == _TRUE){ -+ padapter->net_closed = _FALSE; ++ if(pwrctrlpriv->ps_flag == true){ ++ padapter->net_closed = false; + goto netdev_open_normal_process; + } + -+ if(padapter->bup == _FALSE) ++ if(padapter->bup == false) + { -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ rtw_macaddr_cfg(adapter_mac_addr(padapter), get_hal_mac_addr(padapter)); -+ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); -+ _rtw_memcpy(pnetdev->dev_addr, adapter_mac_addr(padapter), ETH_ALEN); -+#endif //CONFIG_PLATFORM_INTEL_BYT -+ -+ rtw_clr_surprise_removed(padapter); -+ rtw_clr_drv_stopped(padapter); ++ padapter->bDriverStopped = false; ++ padapter->bSurpriseRemoved = false; ++ padapter->bCardDisableWOHSM = false; + + status = rtw_hal_init(padapter); + if (status ==_FAIL) @@ -369914,63 +178438,54 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + goto netdev_open_error; + } + ++ if (init_hw_mlme_ext(padapter) == _FAIL) ++ { ++ DBG_871X("can't init mlme_ext_priv\n"); ++ goto netdev_open_error; ++ } ++ +#ifdef CONFIG_DRVEXT_MODULE + init_drvext(padapter); +#endif + -+ if (padapter->intf_start) ++ if(padapter->intf_start) + { + padapter->intf_start(padapter); + } + ++ rtw_proc_init_one(pnetdev); ++ +#ifdef CONFIG_IOCTL_CFG80211 + rtw_cfg80211_init_wiphy(padapter); +#endif + + rtw_led_control(padapter, LED_CTL_NO_LINK); + -+ padapter->bup = _TRUE; -+ pwrctrlpriv->bips_processing = _FALSE; -+ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_IpsNotify(padapter, IPS_NONE); -+#endif // CONFIG_BT_COEXIST -+#endif //CONFIG_PLATFORM_INTEL_BYT ++ padapter->bup = true; + } -+ padapter->net_closed = _FALSE; ++ padapter->net_closed = false; + + _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); + -+#ifndef CONFIG_IPS_CHECK_IN_WD -+ rtw_set_pwr_state_check_timer(pwrctrlpriv); -+#endif ++ padapter->pwrctrlpriv.bips_processing = false; ++ rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv); + + //netif_carrier_on(pnetdev);//call this func when rtw_joinbss_event_callback return success -+ rtw_netif_wake_queue(pnetdev); ++ if(!rtw_netif_queue_stopped(pnetdev)) ++ rtw_netif_start_queue(pnetdev); ++ else ++ rtw_netif_wake_queue(pnetdev); + +#ifdef CONFIG_BR_EXT + netdev_br_init(pnetdev); +#endif // CONFIG_BR_EXT + -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ if(is_primary_adapter(padapter) && _TRUE == pHalData->EEPROMBluetoothCoexist) -+ { -+ rtw_btcoex_init_socket(padapter); -+ padapter->coex_info.BtMgnt.ExtConfig.HCIExtensionVer = 0x04; -+ rtw_btcoex_SetHciVersion(padapter,0x04); -+ } -+ else -+ DBG_871X("CONFIG_BT_COEXIST: SECONDARY_ADAPTER\n"); -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+ -+ +netdev_open_normal_process: + + #ifdef CONFIG_CONCURRENT_MODE + { + _adapter *sec_adapter = padapter->pbuddy_adapter; -+ if(sec_adapter && (sec_adapter->bup == _FALSE)) ++ if(sec_adapter && (sec_adapter->bup == false || sec_adapter->hw_init_completed == false)) + _netdev_if2_open(sec_adapter->pnetdev); + } + #endif @@ -369982,7 +178497,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + +netdev_open_error: + -+ padapter->bup = _FALSE; ++ padapter->bup = false; + + netif_carrier_off(pnetdev); + rtw_netif_stop_queue(pnetdev); @@ -369998,13 +178513,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +{ + int ret; + _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if (pwrctrlpriv->bInSuspend == _TRUE) -+ { -+ DBG_871X("+871x_drv - drv_open, bInSuspend=%d\n", pwrctrlpriv->bInSuspend); -+ return 0; -+ } + + _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); + ret = _netdev_open(pnetdev); @@ -370014,18 +178522,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +} + +#ifdef CONFIG_IPS -+int ips_netdrv_open(_adapter *padapter) ++static int ips_netdrv_open(_adapter *padapter) +{ + int status = _SUCCESS; -+ //struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ -+ padapter->net_closed = _FALSE; -+ ++ padapter->net_closed = false; + DBG_871X("===> %s.........\n",__FUNCTION__); + + -+ rtw_clr_drv_stopped(padapter); -+ //padapter->bup = _TRUE; ++ padapter->bDriverStopped = false; ++ padapter->bSurpriseRemoved = false; ++ padapter->bCardDisableWOHSM = false; ++ //padapter->bup = true; + + status = rtw_hal_init(padapter); + if (status ==_FAIL) @@ -370034,20 +178541,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + goto netdev_open_error; + } + -+ if (padapter->intf_start) ++ if(padapter->intf_start) + { + padapter->intf_start(padapter); + } + -+#ifndef CONFIG_IPS_CHECK_IN_WD -+ rtw_set_pwr_state_check_timer(adapter_to_pwrctl(padapter)); -+#endif -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer,2000); ++ rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv); ++ _set_timer(&padapter->mlmepriv.dynamic_chk_timer,5000); + + return _SUCCESS; + +netdev_open_error: -+ //padapter->bup = _FALSE; ++ //padapter->bup = false; + DBG_871X("-ips_netdrv_open - drv_open failure, bup=%d\n", padapter->bup); + + return _FAIL; @@ -370057,25 +178562,15 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +int rtw_ips_pwr_up(_adapter *padapter) +{ + int result; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+#ifdef DBG_CONFIG_ERROR_DETECT -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+#endif//#ifdef DBG_CONFIG_ERROR_DETECT + u32 start_time = rtw_get_current_time(); + DBG_871X("===> rtw_ips_pwr_up..............\n"); -+ -+#if defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) -+#ifdef DBG_CONFIG_ERROR_DETECT -+ if (psrtpriv->silent_reset_inprogress == _TRUE) -+#endif//#ifdef DBG_CONFIG_ERROR_DETECT -+#endif //defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) -+ rtw_reset_drv_sw(padapter); ++ rtw_reset_drv_sw(padapter); + + result = ips_netdrv_open(padapter); + + rtw_led_control(padapter, LED_CTL_NO_LINK); + -+ DBG_871X("<=== rtw_ips_pwr_up.............. in %dms\n", rtw_get_passing_time_ms(start_time)); ++ DBG_871X("<=== rtw_ips_pwr_up.............. in %dms\n", rtw_get_passing_time_ms(start_time)); + return result; + +} @@ -370085,58 +178580,46 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + u32 start_time = rtw_get_current_time(); + DBG_871X("===> rtw_ips_pwr_down...................\n"); + -+ padapter->net_closed = _TRUE; ++ padapter->bCardDisableWOHSM = true; ++ padapter->net_closed = true; + + rtw_ips_dev_unload(padapter); ++ padapter->bCardDisableWOHSM = false; + DBG_871X("<=== rtw_ips_pwr_down..................... in %dms\n", rtw_get_passing_time_ms(start_time)); +} +#endif ++ +void rtw_ips_dev_unload(_adapter *padapter) +{ + struct net_device *pnetdev= (struct net_device*)padapter->pnetdev; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+#ifdef DBG_CONFIG_ERROR_DETECT -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+#endif//#ifdef DBG_CONFIG_ERROR_DETECT + DBG_871X("====> %s...\n",__FUNCTION__); + ++ rtw_hal_set_hwreg(padapter, HW_VAR_FIFO_CLEARN_UP, NULL); + -+#if defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) -+#ifdef DBG_CONFIG_ERROR_DETECT -+ if (psrtpriv->silent_reset_inprogress == _TRUE) -+#endif //#ifdef DBG_CONFIG_ERROR_DETECT -+#endif //defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) ++ if(padapter->intf_stop) + { -+ rtw_hal_set_hwreg(padapter, HW_VAR_FIFO_CLEARN_UP, 0); -+ -+ if (padapter->intf_stop) -+ { -+ padapter->intf_stop(padapter); -+ } ++ padapter->intf_stop(padapter); + } + -+ if (!rtw_is_surprise_removed(padapter)) ++ //s5. ++ if(padapter->bSurpriseRemoved == false) ++ { + rtw_hal_deinit(padapter); ++ } + +} + -+ +int pm_netdev_open(struct net_device *pnetdev,u8 bnormal) +{ -+ int status = 0; ++ int status; + -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); + -+ if (_TRUE == bnormal) -+ { -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ status = _netdev_open(pnetdev); -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ } ++ if (true == bnormal) ++ status = netdev_open(pnetdev); +#ifdef CONFIG_IPS + else -+ status = (_SUCCESS == ips_netdrv_open(padapter))?(0):(-1); ++ status = (_SUCCESS == ips_netdrv_open((_adapter *)rtw_netdev_priv(pnetdev)))?(0):(-1); +#endif + + return status; @@ -370145,52 +178628,46 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +static int netdev_close(struct net_device *pnetdev) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX + + RT_TRACE(_module_os_intfs_c_,_drv_info_,("+871x_drv - drv_close\n")); + -+#ifndef CONFIG_PLATFORM_INTEL_BYT -+ if(pwrctl->bInternalAutoSuspend == _TRUE) ++ if(padapter->pwrctrlpriv.bInternalAutoSuspend == true) + { + //rtw_pwr_wakeup(padapter); -+ if(pwrctl->rf_pwrstate == rf_off) -+ pwrctl->ps_flag = _TRUE; ++ if(padapter->pwrctrlpriv.rf_pwrstate == rf_off) ++ padapter->pwrctrlpriv.ps_flag = true; + } -+ padapter->net_closed = _TRUE; -+ padapter->netif_up = _FALSE; -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; ++ padapter->net_closed = true; + -+/* if (!rtw_is_hw_init_completed(padapter)) { -+ DBG_871X("(1)871x_drv - drv_close, bup=%d, hw_init_completed=%s\n", padapter->bup, rtw_is_hw_init_completed(padapter)?"_TRUE":"_FALSE"); ++/* if(!padapter->hw_init_completed) ++ { ++ DBG_871X("(1)871x_drv - drv_close, bup=%d, hw_init_completed=%d\n", padapter->bup, padapter->hw_init_completed); + -+ rtw_set_drv_stopped(padapter); ++ padapter->bDriverStopped = true; + + rtw_dev_unload(padapter); + } + else*/ -+ if(pwrctl->rf_pwrstate == rf_on){ -+ DBG_871X("(2)871x_drv - drv_close, bup=%d, hw_init_completed=%s\n", padapter->bup, rtw_is_hw_init_completed(padapter)?"_TRUE":"_FALSE"); ++ if(padapter->pwrctrlpriv.rf_pwrstate == rf_on){ ++ DBG_871X("(2)871x_drv - drv_close, bup=%d, hw_init_completed=%d\n", padapter->bup, padapter->hw_init_completed); + + //s1. + if(pnetdev) + { -+ rtw_netif_stop_queue(pnetdev); ++ if (!rtw_netif_queue_stopped(pnetdev)) ++ rtw_netif_stop_queue(pnetdev); + } + +#ifndef CONFIG_ANDROID + //s2. + LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, _FALSE); ++ rtw_disassoc_cmd(padapter, 500, false); + //s2-2. indicate disconnect to os + rtw_indicate_disconnect(padapter); + //s2-3. + rtw_free_assoc_resources(padapter, 1); + //s2-4. -+ rtw_free_network_queue(padapter,_TRUE); ++ rtw_free_network_queue(padapter,true); +#endif + // Close LED + rtw_led_control(padapter, LED_CTL_POWER_OFF); @@ -370205,47 +178682,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +#endif // CONFIG_BR_EXT + +#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_role(&padapter->wdinfo, P2P_ROLE_DISABLE)) -+ rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); ++#ifdef CONFIG_IOCTL_CFG80211 ++ if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 ) ++ { ++ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled == true) ++ wdev_to_priv(padapter->rtw_wdev)->p2p_enabled = false; ++ } ++#endif //CONFIG_IOCTL_CFG80211 ++ rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); +#endif //CONFIG_P2P + +#ifdef CONFIG_IOCTL_CFG80211 + rtw_scan_abort(padapter); -+ rtw_cfg80211_wait_scan_req_empty(padapter, 200); -+ adapter_wdev_data(padapter)->bandroid_scan = _FALSE; -+ //padapter->rtw_wdev->iftype = NL80211_IFTYPE_MONITOR; //set this at the end ++ wdev_to_priv(padapter->rtw_wdev)->bandroid_scan = false; ++ padapter->rtw_wdev->iftype = NL80211_IFTYPE_MONITOR; //set this at the end +#endif //CONFIG_IOCTL_CFG80211 + +#ifdef CONFIG_WAPI_SUPPORT + rtw_wapi_disable_tx(padapter); +#endif -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ if(is_primary_adapter(padapter) && _TRUE == pHalData->EEPROMBluetoothCoexist) -+ rtw_btcoex_close_socket(padapter); -+ else -+ DBG_871X("CONFIG_BT_COEXIST: SECONDARY_ADAPTER\n"); -+#endif //CONFIG_BT_COEXIST_SOCKET_TRX -+#else //!CONFIG_PLATFORM_INTEL_BYT -+ -+ if (pwrctl->bInSuspend == _TRUE) -+ { -+ DBG_871X("+871x_drv - drv_close, bInSuspend=%d\n", pwrctl->bInSuspend); -+ return 0; -+ } -+ -+ rtw_scan_abort(padapter); // stop scanning process before wifi is going to down -+ #ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_wait_scan_req_empty(padapter, 200); -+ #endif -+ -+ DBG_871X("netdev_close, bips_processing=%d\n", pwrctl->bips_processing); -+ while (pwrctl->bips_processing == _TRUE) // waiting for ips_processing done before call rtw_dev_unload() -+ rtw_msleep_os(1); -+ -+ rtw_dev_unload(padapter); -+ rtw_sdio_set_power(0); -+ -+#endif //!CONFIG_PLATFORM_INTEL_BYT + + RT_TRACE(_module_os_intfs_c_,_drv_info_,("-871x_drv - drv_close\n")); + DBG_871X("-871x_drv - drv_close, bup=%d\n", padapter->bup); @@ -370254,15 +178709,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r + +} + -+int pm_netdev_close(struct net_device *pnetdev,u8 bnormal) -+{ -+ int status = 0; -+ -+ status = netdev_close(pnetdev); -+ -+ return status; -+} -+ +void rtw_ndev_destructor(struct net_device *ndev) +{ + DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); @@ -370273,1462 +178719,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/os_intfs.c linux/3rdparty/r +#endif + free_netdev(ndev); +} -+ -+#ifdef CONFIG_ARP_KEEP_ALIVE -+struct route_info { -+ struct in_addr dst_addr; -+ struct in_addr src_addr; -+ struct in_addr gateway; -+ unsigned int dev_index; -+}; -+ -+static void parse_routes(struct nlmsghdr *nl_hdr, struct route_info *rt_info) -+{ -+ struct rtmsg *rt_msg; -+ struct rtattr *rt_attr; -+ int rt_len; -+ -+ rt_msg = (struct rtmsg *) NLMSG_DATA(nl_hdr); -+ if ((rt_msg->rtm_family != AF_INET) || (rt_msg->rtm_table != RT_TABLE_MAIN)) -+ return; -+ -+ rt_attr = (struct rtattr *) RTM_RTA(rt_msg); -+ rt_len = RTM_PAYLOAD(nl_hdr); -+ -+ for (; RTA_OK(rt_attr, rt_len); rt_attr = RTA_NEXT(rt_attr, rt_len)) -+ { -+ switch (rt_attr->rta_type) { -+ case RTA_OIF: -+ rt_info->dev_index = *(int *) RTA_DATA(rt_attr); -+ break; -+ case RTA_GATEWAY: -+ rt_info->gateway.s_addr = *(u_int *) RTA_DATA(rt_attr); -+ break; -+ case RTA_PREFSRC: -+ rt_info->src_addr.s_addr = *(u_int *) RTA_DATA(rt_attr); -+ break; -+ case RTA_DST: -+ rt_info->dst_addr.s_addr = *(u_int *) RTA_DATA(rt_attr); -+ break; -+ } -+ } -+} -+ -+static int route_dump(u32 *gw_addr ,int* gw_index) -+{ -+ int err = 0; -+ struct socket *sock; -+ struct { -+ struct nlmsghdr nlh; -+ struct rtgenmsg g; -+ } req; -+ struct msghdr msg; -+ struct iovec iov; -+ struct sockaddr_nl nladdr; -+ mm_segment_t oldfs; -+ char *pg; -+ int size = 0; -+ -+ err = sock_create(AF_NETLINK, SOCK_DGRAM, NETLINK_ROUTE, &sock); -+ if (err) -+ { -+ printk( ": Could not create a datagram socket, error = %d\n", -ENXIO); -+ return err; -+ } -+ -+ memset(&nladdr, 0, sizeof(nladdr)); -+ nladdr.nl_family = AF_NETLINK; -+ -+ req.nlh.nlmsg_len = sizeof(req); -+ req.nlh.nlmsg_type = RTM_GETROUTE; -+ req.nlh.nlmsg_flags = NLM_F_ROOT | NLM_F_MATCH | NLM_F_REQUEST; -+ req.nlh.nlmsg_pid = 0; -+ req.g.rtgen_family = AF_INET; -+ -+ iov.iov_base = &req; -+ iov.iov_len = sizeof(req); -+ -+ msg.msg_name = &nladdr; -+ msg.msg_namelen = sizeof(nladdr); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+ /* referece:sock_xmit in kernel code -+ * WRITE for sock_sendmsg, READ for sock_recvmsg -+ * third parameter for msg_iovlen -+ * last parameter for iov_len -+ */ -+ iov_iter_init(&msg.msg_iter, WRITE, &iov, 1, sizeof(req)); -+#else -+ msg.msg_iov = &iov; -+ msg.msg_iovlen = 1; -+#endif -+ msg.msg_control = NULL; -+ msg.msg_controllen = 0; -+ msg.msg_flags = MSG_DONTWAIT; -+ -+ oldfs = get_fs(); set_fs(KERNEL_DS); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) -+ err = sock_sendmsg(sock, &msg); -+#else -+ err = sock_sendmsg(sock, &msg, sizeof(req)); -+#endif -+ set_fs(oldfs); -+ -+ if (err < 0) -+ goto out_sock; -+ -+ pg = (char *) __get_free_page(GFP_KERNEL); -+ if (pg == NULL) { -+ err = -ENOMEM; -+ goto out_sock; -+ } -+ -+#if defined(CONFIG_IPV6) || defined (CONFIG_IPV6_MODULE) -+restart: -+#endif -+ -+ for (;;) -+ { -+ struct nlmsghdr *h; -+ -+ iov.iov_base = pg; -+ iov.iov_len = PAGE_SIZE; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+ iov_iter_init(&msg.msg_iter, READ, &iov, 1, PAGE_SIZE); -+#endif -+ -+ oldfs = get_fs(); set_fs(KERNEL_DS); -+ err = sock_recvmsg(sock, &msg, PAGE_SIZE, MSG_DONTWAIT); -+ set_fs(oldfs); -+ -+ if (err < 0) -+ goto out_sock_pg; -+ -+ if (msg.msg_flags & MSG_TRUNC) { -+ err = -ENOBUFS; -+ goto out_sock_pg; -+ } -+ -+ h = (struct nlmsghdr*) pg; -+ -+ while (NLMSG_OK(h, err)) -+ { -+ struct route_info rt_info; -+ if (h->nlmsg_type == NLMSG_DONE) { -+ err = 0; -+ goto done; -+ } -+ -+ if (h->nlmsg_type == NLMSG_ERROR) { -+ struct nlmsgerr *errm = (struct nlmsgerr*) NLMSG_DATA(h); -+ err = errm->error; -+ printk( "NLMSG error: %d\n", errm->error); -+ goto done; -+ } -+ -+ if (h->nlmsg_type == RTM_GETROUTE) -+ { -+ printk( "RTM_GETROUTE: NLMSG: %d\n", h->nlmsg_type); -+ } -+ if (h->nlmsg_type != RTM_NEWROUTE) { -+ printk( "NLMSG: %d\n", h->nlmsg_type); -+ err = -EINVAL; -+ goto done; -+ } -+ -+ memset(&rt_info, 0, sizeof(struct route_info)); -+ parse_routes(h, &rt_info); -+ if(!rt_info.dst_addr.s_addr && rt_info.gateway.s_addr && rt_info.dev_index) -+ { -+ *gw_addr = rt_info.gateway.s_addr; -+ *gw_index = rt_info.dev_index; -+ -+ } -+ h = NLMSG_NEXT(h, err); -+ } -+ -+ if (err) -+ { -+ printk( "!!!Remnant of size %d %d %d\n", err, h->nlmsg_len, h->nlmsg_type); -+ err = -EINVAL; -+ break; -+ } -+ } -+ -+done: -+#if defined(CONFIG_IPV6) || defined (CONFIG_IPV6_MODULE) -+ if (!err && req.g.rtgen_family == AF_INET) { -+ req.g.rtgen_family = AF_INET6; -+ -+ iov.iov_base = &req; -+ iov.iov_len = sizeof(req); -+ -+ msg.msg_name = &nladdr; -+ msg.msg_namelen = sizeof(nladdr); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+ iov_iter_init(&msg.msg_iter, WRITE, &iov, 1, sizeof(req)); -+#else -+ msg.msg_iov = &iov; -+ msg.msg_iovlen = 1; -+#endif -+ msg.msg_control = NULL; -+ msg.msg_controllen = 0; -+ msg.msg_flags=MSG_DONTWAIT; -+ -+ oldfs = get_fs(); set_fs(KERNEL_DS); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) -+ err = sock_sendmsg(sock, &msg); -+#else -+ err = sock_sendmsg(sock, &msg, sizeof(req)); -+#endif -+ set_fs(oldfs); -+ -+ if (err > 0) -+ goto restart; -+ } -+#endif -+ -+out_sock_pg: -+ free_page((unsigned long) pg); -+ -+out_sock: -+ sock_release(sock); -+ return err; -+} -+ -+static int arp_query(unsigned char *haddr, u32 paddr, -+ struct net_device *dev) -+{ -+ struct neighbour *neighbor_entry; -+ int ret = 0; -+ -+ neighbor_entry = neigh_lookup(&arp_tbl, &paddr, dev); -+ -+ if (neighbor_entry != NULL) { -+ neighbor_entry->used = jiffies; -+ if (neighbor_entry->nud_state & NUD_VALID) { -+ _rtw_memcpy(haddr, neighbor_entry->ha, dev->addr_len); -+ ret = 1; -+ } -+ neigh_release(neighbor_entry); -+ } -+ return ret; -+} -+ -+static int get_defaultgw(u32 *ip_addr ,char mac[]) -+{ -+ int gw_index = 0; // oif device index -+ struct net_device *gw_dev = NULL; //oif device -+ -+ route_dump(ip_addr, &gw_index); -+ -+ if( !(*ip_addr) || !gw_index ) -+ { -+ //DBG_871X("No default GW \n"); -+ return -1; -+ } -+ -+ gw_dev = dev_get_by_index(&init_net, gw_index); -+ -+ if(gw_dev == NULL) -+ { -+ //DBG_871X("get Oif Device Fail \n"); -+ return -1; -+ } -+ -+ if(!arp_query(mac, *ip_addr, gw_dev)) -+ { -+ //DBG_871X( "arp query failed\n"); -+ dev_put(gw_dev); -+ return -1; -+ -+ } -+ dev_put(gw_dev); -+ -+ return 0; -+} -+ -+int rtw_gw_addr_query(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ u32 gw_addr = 0; // default gw address -+ unsigned char gw_mac[32] = {0}; // default gw mac -+ int i; -+ int res; -+ -+ res = get_defaultgw(&gw_addr, gw_mac); -+ if(!res) -+ { -+ pmlmepriv->gw_ip[0] = gw_addr&0xff; -+ pmlmepriv->gw_ip[1] = (gw_addr&0xff00)>>8; -+ pmlmepriv->gw_ip[2] = (gw_addr&0xff0000)>>16; -+ pmlmepriv->gw_ip[3] = (gw_addr&0xff000000)>>24; -+ _rtw_memcpy(pmlmepriv->gw_mac_addr, gw_mac, 6); -+ DBG_871X("%s Gateway Mac:\t" MAC_FMT "\n", __FUNCTION__, MAC_ARG(pmlmepriv->gw_mac_addr)); -+ DBG_871X("%s Gateway IP:\t" IP_FMT "\n", __FUNCTION__, IP_ARG(pmlmepriv->gw_ip)); -+ } -+ else -+ { -+ DBG_871X("Get Gateway IP/MAC fail!\n"); -+ } -+ -+ return res; -+} -+#endif -+ -+void rtw_dev_unload(PADAPTER padapter) -+{ -+ struct net_device *pnetdev = (struct net_device*)padapter->pnetdev; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *pobjpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &pobjpriv->drv_dbg; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 cnt = 0; -+ -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("+%s\n",__FUNCTION__)); -+ -+ if (padapter->bup == _TRUE) -+ { -+ DBG_871X("===> %s\n",__FUNCTION__); -+ -+ rtw_set_drv_stopped(padapter); -+ #ifdef CONFIG_XMIT_ACK -+ if (padapter->xmitpriv.ack_tx) -+ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP); -+ #endif -+ -+ if (padapter->intf_stop) -+ padapter->intf_stop(padapter); -+ -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("@ rtw_dev_unload: stop intf complete!\n")); -+ -+ if (!pwrctl->bInternalAutoSuspend) -+ rtw_stop_drv_threads(padapter); -+ -+ while(ATOMIC_READ(&(pcmdpriv->cmdthd_running)) == _TRUE){ -+ if (cnt > 5) { -+ DBG_871X("stop cmdthd timeout\n"); -+ break; -+ } else { -+ cnt ++; -+ DBG_871X("cmdthd is running(%d)\n", cnt); -+ rtw_msleep_os(10); -+ } -+ } -+ -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("@ %s: stop thread complete!\n",__FUNCTION__)); -+ -+ //check the status of IPS -+ if(rtw_hal_check_ips_status(padapter) == _TRUE || pwrctl->rf_pwrstate == rf_off) { //check HW status and SW state -+ DBG_871X_LEVEL(_drv_always_, "%s: driver in IPS-FWLPS\n", __func__); -+ pdbgpriv->dbg_dev_unload_inIPS_cnt++; -+ LeaveAllPowerSaveMode(padapter); -+ } else { -+ DBG_871X_LEVEL(_drv_always_, "%s: driver not in IPS\n", __func__); -+ } -+ -+ if (!rtw_is_surprise_removed(padapter)) { -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_IpsNotify(padapter, pwrctl->ips_mode_req); -+#endif -+#ifdef CONFIG_WOWLAN -+ if (pwrctl->bSupportRemoteWakeup == _TRUE && -+ pwrctl->wowlan_mode ==_TRUE) { -+ DBG_871X_LEVEL(_drv_always_, "%s bSupportRemoteWakeup==_TRUE do not run rtw_hal_deinit()\n",__FUNCTION__); -+ } -+ else -+#endif -+ { -+ //amy modify 20120221 for power seq is different between driver open and ips -+ rtw_hal_deinit(padapter); -+ } -+ rtw_set_surprise_removed(padapter); -+ } -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("@ %s: deinit hal complelt!\n",__FUNCTION__)); -+ -+ padapter->bup = _FALSE; -+ -+ DBG_871X("<=== %s\n",__FUNCTION__); -+ } -+ else { -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("%s: bup==_FALSE\n",__FUNCTION__)); -+ DBG_871X("%s: bup==_FALSE\n",__FUNCTION__); -+ } -+ -+ /* cancel timer after thread stop */ -+ rtw_cancel_all_timer(padapter); -+ RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("-%s\n",__FUNCTION__)); -+} -+ -+int rtw_suspend_free_assoc_resource(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct net_device *pnetdev = padapter->pnetdev; -+#ifdef CONFIG_P2P -+ struct wifidirect_info* pwdinfo = &padapter->wdinfo; -+#endif // CONFIG_P2P -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, _FW_LINKED) -+#ifdef CONFIG_P2P -+ && rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) -+#endif // CONFIG_P2P -+ ) -+ { -+ DBG_871X("%s %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n",__FUNCTION__, -+ pmlmepriv->cur_network.network.Ssid.Ssid, -+ MAC_ARG(pmlmepriv->cur_network.network.MacAddress), -+ pmlmepriv->cur_network.network.Ssid.SsidLength, -+ pmlmepriv->assoc_ssid.SsidLength); -+ rtw_set_to_roam(padapter, 1); -+ } -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) && check_fwstate(pmlmepriv, _FW_LINKED)) -+ { -+ rtw_disassoc_cmd(padapter, 0, _FALSE); -+ //s2-2. indicate disconnect to os -+ rtw_indicate_disconnect(padapter); -+ } -+ #ifdef CONFIG_AP_MODE -+ else if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ { -+ rtw_sta_flush(padapter, _TRUE); -+ } -+ #endif -+ -+ //s2-3. -+ rtw_free_assoc_resources(padapter, 1); -+ -+ //s2-4. -+#ifdef CONFIG_AUTOSUSPEND -+ if(is_primary_adapter(padapter) && (!adapter_to_pwrctl(padapter)->bInternalAutoSuspend )) -+#endif -+ rtw_free_network_queue(padapter, _TRUE); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { -+ DBG_871X_LEVEL(_drv_always_, "%s: fw_under_survey\n", __func__); -+ rtw_indicate_scan_done(padapter, 1); -+ clr_fwstate(pmlmepriv, _FW_UNDER_SURVEY); -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) -+ { -+ DBG_871X_LEVEL(_drv_always_, "%s: fw_under_linking\n", __FUNCTION__); -+ rtw_indicate_disconnect(padapter); -+ } -+ -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_WOWLAN -+int rtw_suspend_wow(_adapter *padapter) -+{ -+ u8 ch, bw, offset; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct net_device *pnetdev = padapter->pnetdev; -+ #ifdef CONFIG_CONCURRENT_MODE -+ struct net_device *pbuddy_netdev = padapter->pbuddy_adapter->pnetdev; -+ #endif -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct wowlan_ioctl_param poidparam; -+ u8 ps_mode; -+ int ret = _SUCCESS; -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ -+ DBG_871X("wowlan_mode: %d\n", pwrpriv->wowlan_mode); -+ DBG_871X("wowlan_pno_enable: %d\n", pwrpriv->wowlan_pno_enable); -+#ifdef CONFIG_P2P_WOWLAN -+ DBG_871X("wowlan_p2p_enable: %d\n", pwrpriv->wowlan_p2p_enable); -+#endif -+ -+ if (pwrpriv->wowlan_mode == _TRUE) { -+ -+ if(pnetdev) -+ rtw_netif_stop_queue(pnetdev); -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(pbuddy_netdev){ -+ netif_carrier_off(pbuddy_netdev); -+ rtw_netif_stop_queue(pbuddy_netdev); -+ } -+ #endif//CONFIG_CONCURRENT_MODE -+ // 0. Power off LED -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ // 1. stop thread -+ rtw_set_drv_stopped(padapter); /*for stop thread*/ -+ rtw_stop_drv_threads(padapter); -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) -+ rtw_stop_drv_threads(padapter->pbuddy_adapter); -+ #endif /*CONFIG_CONCURRENT_MODE*/ -+ rtw_clr_drv_stopped(padapter); /*for 32k command*/ -+ -+ //#ifdef CONFIG_LPS -+ //rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "WOWLAN"); -+ //#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ // 2. disable interrupt -+ if (padapter->intf_stop) { -+ padapter->intf_stop(padapter); -+ } -+ -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) { //free buddy adapter's resource -+ padapter->pbuddy_adapter->intf_stop(padapter->pbuddy_adapter); -+ } -+ #endif -+ -+ // 2.1 clean interupt -+ rtw_hal_clear_interrupt(padapter); -+#endif //CONFIG_SDIO_HCI -+ -+ // 2.2 free irq -+ //sdio_free_irq(adapter_to_dvobj(padapter)); -+ if(padapter->intf_free_irq) -+ padapter->intf_free_irq(adapter_to_dvobj(padapter)); -+ -+ #ifdef CONFIG_RUNTIME_PORT_SWITCH -+ if (rtw_port_switch_chk(padapter)) { -+ DBG_871X(" ### PORT SWITCH ### \n"); -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); -+ } -+ #endif -+ -+ poidparam.subcode = WOWLAN_ENABLE; -+ rtw_hal_set_hwreg(padapter,HW_VAR_WOWLAN,(u8 *)&poidparam); -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, _FW_LINKED)) -+ { -+ DBG_871X("%s %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n",__FUNCTION__, -+ pmlmepriv->cur_network.network.Ssid.Ssid, -+ MAC_ARG(pmlmepriv->cur_network.network.MacAddress), -+ pmlmepriv->cur_network.network.Ssid.SsidLength, -+ pmlmepriv->assoc_ssid.SsidLength); -+ -+ rtw_set_to_roam(padapter, 0); -+ } -+ } -+ -+ DBG_871X_LEVEL(_drv_always_, "%s: wowmode suspending\n", __func__); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) -+ { -+ DBG_871X_LEVEL(_drv_always_, "%s: fw_under_survey\n", __func__); -+ rtw_indicate_scan_done(padapter, 1); -+ clr_fwstate(pmlmepriv, _FW_UNDER_SURVEY); -+ } -+ -+ if (rtw_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { -+ DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ set_channel_bwmode(padapter, ch, offset, bw); -+ } -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(rtw_buddy_adapter_up(padapter)){ //free buddy adapter's resource -+ rtw_suspend_free_assoc_resource(padapter->pbuddy_adapter); -+ } -+ #endif -+ -+ if(pwrpriv->wowlan_pno_enable) { -+ DBG_871X_LEVEL(_drv_always_, "%s: pno: %d\n", __func__, -+ pwrpriv->wowlan_pno_enable); -+#ifdef CONFIG_FWLPS_IN_IPS -+ rtw_set_fw_in_ips_mode(padapter, _TRUE); -+#endif -+ } -+ #ifdef CONFIG_LPS -+ else -+ rtw_set_ps_mode(padapter, PS_MODE_MAX, 0, 0, "WOWLAN"); -+ #endif //#ifdef CONFIG_LPS -+ -+ } -+ else -+ { -+ DBG_871X_LEVEL(_drv_always_, "%s: ### ERROR ### wowlan_mode=%d\n", __FUNCTION__, pwrpriv->wowlan_mode); -+ } -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+#endif //#ifdef CONFIG_WOWLAN -+ -+#ifdef CONFIG_AP_WOWLAN -+int rtw_suspend_ap_wow(_adapter *padapter) -+{ -+ u8 ch, bw, offset; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct net_device *pnetdev = padapter->pnetdev; -+ #ifdef CONFIG_CONCURRENT_MODE -+ struct net_device *pbuddy_netdev; -+ #endif -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct wowlan_ioctl_param poidparam; -+ u8 ps_mode; -+ int ret = _SUCCESS; -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ pwrpriv->wowlan_ap_mode = _TRUE; -+ -+ DBG_871X("wowlan_ap_mode: %d\n", pwrpriv->wowlan_ap_mode); -+ -+ if(pnetdev) -+ rtw_netif_stop_queue(pnetdev); -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) { -+ pbuddy_netdev = padapter->pbuddy_adapter->pnetdev; -+ if (pbuddy_netdev) -+ rtw_netif_stop_queue(pbuddy_netdev); -+ } -+ #endif//CONFIG_CONCURRENT_MODE -+ // 0. Power off LED -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ // 1. stop thread -+ rtw_set_drv_stopped(padapter); /*for stop thread*/ -+ rtw_stop_drv_threads(padapter); -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) -+ rtw_stop_drv_threads(padapter->pbuddy_adapter); -+ #endif /* CONFIG_CONCURRENT_MODE */ -+ rtw_clr_drv_stopped(padapter); /*for 32k command*/ -+ -+#ifdef CONFIG_SDIO_HCI -+ // 2. disable interrupt -+ rtw_hal_disable_interrupt(padapter); // It need wait for leaving 32K. -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) { //free buddy adapter's resource -+ padapter->pbuddy_adapter->intf_stop(padapter->pbuddy_adapter); -+ } -+ #endif -+ -+ // 2.1 clean interupt -+ rtw_hal_clear_interrupt(padapter); -+#endif //CONFIG_SDIO_HCI -+ -+ // 2.2 free irq -+ if(padapter->intf_free_irq) -+ padapter->intf_free_irq(adapter_to_dvobj(padapter)); -+ -+ #ifdef CONFIG_RUNTIME_PORT_SWITCH -+ if (rtw_port_switch_chk(padapter)) { -+ DBG_871X(" ### PORT SWITCH ### \n"); -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); -+ } -+ #endif -+ -+ poidparam.subcode = WOWLAN_AP_ENABLE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); -+ -+ DBG_871X_LEVEL(_drv_always_, "%s: wowmode suspending\n", __func__); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, WIFI_AP_STATE) == _TRUE) { -+ if (rtw_get_ch_setting_union(padapter->pbuddy_adapter, &ch, &bw, &offset) != 0) { -+ DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter->pbuddy_adapter), ch, bw, offset); -+ set_channel_bwmode(padapter->pbuddy_adapter, ch, offset, bw); -+ } -+ rtw_suspend_free_assoc_resource(padapter); -+ } else { -+ if (rtw_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { -+ DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ set_channel_bwmode(padapter, ch, offset, bw); -+ } -+ rtw_suspend_free_assoc_resource(padapter->pbuddy_adapter); -+ } -+#else -+ if (rtw_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { -+ DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ set_channel_bwmode(padapter, ch, offset, bw); -+ } -+#endif -+ -+#ifdef CONFIG_LPS -+ rtw_set_ps_mode(padapter, PS_MODE_MIN, 0, 0, "AP-WOWLAN"); -+#endif -+ -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+#endif //#ifdef CONFIG_AP_WOWLAN -+ -+ -+int rtw_suspend_normal(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct net_device *pnetdev = padapter->pnetdev; -+ #ifdef CONFIG_CONCURRENT_MODE -+ struct net_device *pbuddy_netdev = padapter->pbuddy_adapter->pnetdev; -+ #endif -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ int ret = _SUCCESS; -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ if(pnetdev){ -+ netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ if(rtw_buddy_adapter_up(padapter)){ -+ pbuddy_netdev = padapter->pbuddy_adapter->pnetdev; -+ netif_carrier_off(pbuddy_netdev); -+ rtw_netif_stop_queue(pbuddy_netdev); -+ } -+#endif -+ -+ rtw_suspend_free_assoc_resource(padapter); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(rtw_buddy_adapter_up(padapter)){ -+ rtw_suspend_free_assoc_resource(padapter->pbuddy_adapter); -+ } -+#endif -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ -+ if ((rtw_hal_check_ips_status(padapter) == _TRUE) -+ || (adapter_to_pwrctl(padapter)->rf_pwrstate == rf_off)) -+ { -+ DBG_871X_LEVEL(_drv_always_, "%s: ### ERROR #### driver in IPS ####ERROR###!!!\n", __FUNCTION__); -+ -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(rtw_buddy_adapter_up(padapter)){ -+ rtw_dev_unload(padapter->pbuddy_adapter); -+ } -+#endif -+ rtw_dev_unload(padapter); -+ -+ //sdio_deinit(adapter_to_dvobj(padapter)); -+ if(padapter->intf_deinit) -+ padapter->intf_deinit(adapter_to_dvobj(padapter)); -+ -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+ -+int rtw_suspend_common(_adapter *padapter) -+{ -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(psdpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ int ret = 0; -+ u32 start_time = rtw_get_current_time(); -+ -+ DBG_871X_LEVEL(_drv_always_, " suspend start\n"); -+ DBG_871X("==> %s (%s:%d)\n",__FUNCTION__, current->comm, current->pid); -+ -+ pdbgpriv->dbg_suspend_cnt++; -+ -+ pwrpriv->bInSuspend = _TRUE; -+ -+ while (pwrpriv->bips_processing == _TRUE) -+ rtw_msleep_os(1); -+ -+#ifdef CONFIG_IOL_READ_EFUSE_MAP -+ if(!padapter->bup){ -+ u8 bMacPwrCtrlOn = _FALSE; -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if(bMacPwrCtrlOn) -+ rtw_hal_power_off(padapter); -+ } -+#endif -+ -+ if ((!padapter->bup) || RTW_CANNOT_RUN(padapter)) { -+ DBG_871X("%s bup=%d bDriverStopped=%s bSurpriseRemoved = %s\n", __func__ -+ , padapter->bup -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False"); -+ pdbgpriv->dbg_suspend_error_cnt++; -+ goto exit; -+ } -+ rtw_ps_deny(padapter, PS_DENY_SUSPEND); -+ -+ rtw_cancel_all_timer(padapter); -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->pbuddy_adapter){ -+ rtw_cancel_all_timer(padapter->pbuddy_adapter); -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ -+ LeaveAllPowerSaveModeDirect(padapter); -+ -+ rtw_stop_cmd_thread(padapter); -+ -+#ifdef CONFIG_BT_COEXIST -+ // wait for the latest FW to remove this condition. -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+ rtw_btcoex_SuspendNotify(padapter, 0); -+ DBG_871X("WIFI_AP_STATE\n"); -+#ifdef CONFIG_CONCURRENT_MODE -+ } else if (check_buddy_fwstate(padapter, WIFI_AP_STATE)) { -+ rtw_btcoex_SuspendNotify(padapter, 0); -+ DBG_871X("P2P_ROLE_GO\n"); -+#endif //CONFIG_CONCURRENT_MODE -+ } else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { -+ rtw_btcoex_SuspendNotify(padapter, 1); -+ DBG_871X("STATION\n"); -+ } -+#endif // CONFIG_BT_COEXIST -+ -+ rtw_ps_deny_cancel(padapter, PS_DENY_SUSPEND); -+ -+ if (check_fwstate(pmlmepriv,WIFI_STATION_STATE) == _TRUE -+#ifdef CONFIG_CONCURRENT_MODE -+ && check_buddy_fwstate(padapter, WIFI_AP_STATE) == _FALSE -+#endif -+ ) { -+ #ifdef CONFIG_WOWLAN -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) { -+ pwrpriv->wowlan_mode = _TRUE; -+ } else if (pwrpriv->wowlan_pno_enable == _TRUE) { -+ pwrpriv->wowlan_mode |= pwrpriv->wowlan_pno_enable; -+ } -+ -+ #ifdef CONFIG_P2P_WOWLAN -+ if(!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE) || P2P_ROLE_DISABLE != padapter->wdinfo.role) -+ { -+ pwrpriv->wowlan_p2p_mode = _TRUE; -+ } -+ if(_TRUE == pwrpriv->wowlan_p2p_mode) -+ pwrpriv->wowlan_mode |= pwrpriv->wowlan_p2p_mode; -+ #endif //CONFIG_P2P_WOWLAN -+ -+ if (pwrpriv->wowlan_mode == _TRUE) -+ rtw_suspend_wow(padapter); -+ else -+ rtw_suspend_normal(padapter); -+ -+ #else //CONFIG_WOWLAN -+ rtw_suspend_normal(padapter); -+ #endif //CONFIG_WOWLAN -+ } else if (check_fwstate(pmlmepriv,WIFI_AP_STATE) == _TRUE -+#ifdef CONFIG_CONCURRENT_MODE -+ && check_buddy_fwstate(padapter, WIFI_AP_STATE) == _FALSE -+#endif -+ ) { -+ #ifdef CONFIG_AP_WOWLAN -+ rtw_suspend_ap_wow(padapter); -+ #else -+ rtw_suspend_normal(padapter); -+ #endif //CONFIG_AP_WOWLAN -+#ifdef CONFIG_CONCURRENT_MODE -+ } else if (check_fwstate(pmlmepriv,WIFI_STATION_STATE) == _TRUE -+ && check_buddy_fwstate(padapter, WIFI_AP_STATE) == _TRUE) { -+ #ifdef CONFIG_AP_WOWLAN -+ rtw_suspend_ap_wow(padapter); -+ #else -+ rtw_suspend_normal(padapter); -+ #endif //CONFIG_AP_WOWLAN -+#endif -+ } else { -+ rtw_suspend_normal(padapter); -+ } -+ -+ -+ DBG_871X_LEVEL(_drv_always_, "rtw suspend success in %d ms\n", -+ rtw_get_passing_time_ms(start_time)); -+ -+exit: -+ DBG_871X("<=== %s return %d.............. in %dms\n", __FUNCTION__ -+ , ret, rtw_get_passing_time_ms(start_time)); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_WOWLAN -+int rtw_resume_process_wow(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct net_device *pnetdev = padapter->pnetdev; -+ #ifdef CONFIG_CONCURRENT_MODE -+ struct net_device *pbuddy_netdev; -+ #endif -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct wowlan_ioctl_param poidparam; -+ struct sta_info *psta = NULL; -+ int ret = _SUCCESS; -+_func_enter_; -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (padapter) { -+ pnetdev = padapter->pnetdev; -+ pwrpriv = adapter_to_pwrctl(padapter); -+ } else { -+ pdbgpriv->dbg_resume_error_cnt++; -+ ret = -1; -+ goto exit; -+ } -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ DBG_871X("%s pdapter %p bDriverStopped %s bSurpriseRemoved %s\n" -+ , __func__, padapter -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False"); -+ goto exit; -+ } -+ -+#ifdef CONFIG_PNO_SUPPORT -+ pwrpriv->pno_in_resume = _TRUE; -+#ifdef CONFIG_FWLPS_IN_IPS -+ if(pwrpriv->wowlan_pno_enable) -+ rtw_set_fw_in_ips_mode(padapter, _FALSE); -+#endif //CONFIG_FWLPS_IN_IPS -+#endif//CONFIG_PNO_SUPPORT -+ -+ if (pwrpriv->wowlan_mode == _TRUE){ -+#ifdef CONFIG_LPS -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "WOWLAN"); -+#endif //CONFIG_LPS -+ -+ pwrpriv->bFwCurrentInPSMode = _FALSE; -+ -+#ifdef CONFIG_SDIO_HCI -+ if (padapter->intf_stop) { -+ padapter->intf_stop(padapter); -+ } -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) { //free buddy adapter's resource -+ padapter->pbuddy_adapter->intf_stop(padapter->pbuddy_adapter); -+ } -+ #endif -+ -+ rtw_hal_clear_interrupt(padapter); -+#endif //CONFIG_SDIO_HCI -+ -+ //if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { -+ if((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)){ -+ ret = -1; -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: sdio_alloc_irq Failed!!\n", __FUNCTION__)); -+ goto exit; -+ } -+ -+ //Disable WOW, set H2C command -+ poidparam.subcode=WOWLAN_DISABLE; -+ rtw_hal_set_hwreg(padapter,HW_VAR_WOWLAN,(u8 *)&poidparam); -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ rtw_reset_drv_sw(padapter->pbuddy_adapter); -+ #endif -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); -+ if (psta) { -+ set_sta_rate(padapter, psta); -+ } -+ -+ -+ rtw_clr_drv_stopped(padapter); -+ DBG_871X("%s: wowmode resuming, DriverStopped:%s\n", __func__, rtw_is_drv_stopped(padapter)?"True":"False"); -+ rtw_start_drv_threads(padapter); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->pbuddy_adapter) -+ rtw_start_drv_threads(padapter->pbuddy_adapter); -+#endif /* CONFIG_CONCURRENT_MODE*/ -+ -+ if (padapter->intf_start) { -+ padapter->intf_start(padapter); -+ } -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) { //free buddy adapter's resource -+ padapter->pbuddy_adapter->intf_start(padapter->pbuddy_adapter); -+ } -+ -+ if (rtw_buddy_adapter_up(padapter)) { -+ pbuddy_netdev = padapter->pbuddy_adapter->pnetdev; -+ -+ if(pbuddy_netdev){ -+ netif_device_attach(pbuddy_netdev); -+ netif_carrier_on(pbuddy_netdev); -+ } -+ } -+ #endif -+ -+ // start netif queue -+ if (pnetdev) { -+ rtw_netif_wake_queue(pnetdev); -+ } -+ } -+ else{ -+ -+ DBG_871X_LEVEL(_drv_always_, "%s: ### ERROR ### wowlan_mode=%d\n", __FUNCTION__, pwrpriv->wowlan_mode); -+ } -+ -+ if( padapter->pid[1]!=0) { -+ DBG_871X("pid[1]:%d\n",padapter->pid[1]); -+ rtw_signal_process(padapter->pid[1], SIGUSR2); -+ } -+ -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { -+ if (pwrpriv->wowlan_wake_reason == FWDecisionDisconnect || -+ pwrpriv->wowlan_wake_reason == Rx_DisAssoc || -+ pwrpriv->wowlan_wake_reason == Rx_DeAuth) { -+ -+ DBG_871X("%s: disconnect reason: %02x\n", __func__, -+ pwrpriv->wowlan_wake_reason); -+ rtw_indicate_disconnect(padapter); -+ -+ rtw_sta_media_status_rpt(padapter, -+ rtw_get_stainfo(&padapter->stapriv, -+ get_bssid(&padapter->mlmepriv)), 0); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+ } else { -+ DBG_871X("%s: do roaming\n", __func__); -+ rtw_roaming(padapter, NULL); -+ } -+ } -+ -+ if (pwrpriv->wowlan_wake_reason == FWDecisionDisconnect) { -+ rtw_lock_ext_suspend_timeout(2000); -+ } -+ -+ if (pwrpriv->wowlan_wake_reason == Rx_GTK || -+ pwrpriv->wowlan_wake_reason == Rx_DisAssoc || -+ pwrpriv->wowlan_wake_reason == Rx_DeAuth) { -+ rtw_lock_ext_suspend_timeout(8000); -+ } -+ -+ if (pwrpriv->wowlan_wake_reason == RX_PNOWakeUp) { -+#ifdef CONFIG_IOCTL_CFG80211 -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0)) -+ u8 locally_generated = 1; -+ cfg80211_disconnected(padapter->pnetdev, 0, NULL, 0, locally_generated, GFP_ATOMIC); -+#else -+ cfg80211_disconnected(padapter->pnetdev, 0, NULL, 0, GFP_ATOMIC); -+#endif -+#endif -+ rtw_lock_ext_suspend_timeout(10000); -+ } -+ -+ if (pwrpriv->wowlan_mode == _TRUE) { -+ pwrpriv->bips_processing = _FALSE; -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); -+#ifndef CONFIG_IPS_CHECK_IN_WD -+ rtw_set_pwr_state_check_timer(pwrpriv); -+#endif -+ } else { -+ DBG_871X_LEVEL(_drv_always_, "do not reset timer\n"); -+ } -+ -+ pwrpriv->wowlan_mode =_FALSE; -+ -+ // Power On LED -+ rtw_hal_sw_led_init(padapter); -+ if(pwrpriv->wowlan_wake_reason == Rx_DisAssoc || -+ pwrpriv->wowlan_wake_reason == Rx_DeAuth || -+ pwrpriv->wowlan_wake_reason == FWDecisionDisconnect) -+ rtw_led_control(padapter, LED_CTL_NO_LINK); -+ else -+ rtw_led_control(padapter, LED_CTL_LINK); -+ -+ //clean driver side wake up reason. -+ pwrpriv->wowlan_wake_reason = 0; -+ -+exit: -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+_func_exit_; -+ return ret; -+} -+#endif //#ifdef CONFIG_WOWLAN -+ -+#ifdef CONFIG_AP_WOWLAN -+int rtw_resume_process_ap_wow(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct net_device *pnetdev = padapter->pnetdev; -+ #ifdef CONFIG_CONCURRENT_MODE -+ struct net_device *pbuddy_netdev; -+ #endif -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct wowlan_ioctl_param poidparam; -+ struct sta_info *psta = NULL; -+ int ret = _SUCCESS; -+ u8 ch, bw, offset; -+_func_enter_; -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (padapter) { -+ pnetdev = padapter->pnetdev; -+ pwrpriv = adapter_to_pwrctl(padapter); -+ } else { -+ pdbgpriv->dbg_resume_error_cnt++; -+ ret = -1; -+ goto exit; -+ } -+ -+ -+#ifdef CONFIG_LPS -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "AP-WOWLAN"); -+#endif //CONFIG_LPS -+ -+ pwrpriv->bFwCurrentInPSMode = _FALSE; -+ -+ rtw_hal_disable_interrupt(padapter); -+ -+ rtw_hal_clear_interrupt(padapter); -+ -+ //if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { -+ if((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)){ -+ ret = -1; -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: sdio_alloc_irq Failed!!\n", __FUNCTION__)); -+ goto exit; -+ } -+ -+ //Disable WOW, set H2C command -+ poidparam.subcode = WOWLAN_AP_DISABLE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); -+ pwrpriv->wowlan_ap_mode = _FALSE; -+ -+ rtw_clr_drv_stopped(padapter); -+ DBG_871X("%s: wowmode resuming, DriverStopped:%s\n", __func__, rtw_is_drv_stopped(padapter)?"True":"False"); -+ rtw_start_drv_threads(padapter); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) -+ rtw_start_drv_threads(padapter->pbuddy_adapter); -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) { -+ if (rtw_get_ch_setting_union(padapter->pbuddy_adapter, &ch, &bw, &offset) != 0) { -+ DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter->pbuddy_adapter), ch, bw, offset); -+ set_channel_bwmode(padapter->pbuddy_adapter, ch, offset, bw); -+ } -+ } else { -+ DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ set_channel_bwmode(padapter, ch, offset, bw); -+ rtw_reset_drv_sw(padapter->pbuddy_adapter); -+ } -+#else -+ if (rtw_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { -+ DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ set_channel_bwmode(padapter, ch, offset, bw); -+ } -+#endif -+ -+ if (padapter->intf_start) { -+ padapter->intf_start(padapter); -+ } -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) { //free buddy adapter's resource -+ padapter->pbuddy_adapter->intf_start(padapter->pbuddy_adapter); -+ } -+ #endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) { -+ pbuddy_netdev = padapter->pbuddy_adapter->pnetdev; -+ if(pbuddy_netdev){ -+ rtw_netif_wake_queue(pbuddy_netdev); -+ } -+ } -+#endif -+ -+ // start netif queue -+ if (pnetdev) { -+ rtw_netif_wake_queue(pnetdev); -+ } -+ -+ if( padapter->pid[1]!=0) { -+ DBG_871X("pid[1]:%d\n",padapter->pid[1]); -+ rtw_signal_process(padapter->pid[1], SIGUSR2); -+ } -+ -+ #ifdef CONFIG_RESUME_IN_WORKQUEUE -+ //rtw_unlock_suspend(); -+ #endif //CONFIG_RESUME_IN_WORKQUEUE -+ -+ if (pwrpriv->wowlan_wake_reason == AP_WakeUp) -+ rtw_lock_ext_suspend_timeout(8000); -+ -+ pwrpriv->bips_processing = _FALSE; -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); -+#ifndef CONFIG_IPS_CHECK_IN_WD -+ rtw_set_pwr_state_check_timer(pwrpriv); -+#endif -+ //clean driver side wake up reason. -+ pwrpriv->wowlan_wake_reason = 0; -+ -+ // Power On LED -+ rtw_hal_sw_led_init(padapter); -+ rtw_led_control(padapter, LED_CTL_LINK); -+exit: -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+_func_exit_; -+ return ret; -+} -+#endif //#ifdef CONFIG_APWOWLAN -+ -+int rtw_resume_process_normal(_adapter *padapter) -+{ -+ struct net_device *pnetdev; -+ #ifdef CONFIG_CONCURRENT_MODE -+ struct net_device *pbuddy_netdev; -+ #endif -+ struct pwrctrl_priv *pwrpriv; -+ struct mlme_priv *pmlmepriv; -+ struct dvobj_priv *psdpriv; -+ struct debug_priv *pdbgpriv; -+ -+ int ret = _SUCCESS; -+_func_enter_; -+ -+ if (!padapter) { -+ ret = -1; -+ goto exit; -+ } -+ -+ pnetdev = padapter->pnetdev; -+ pwrpriv = adapter_to_pwrctl(padapter); -+ pmlmepriv = &padapter->mlmepriv; -+ psdpriv = padapter->dvobj; -+ pdbgpriv = &psdpriv->drv_dbg; -+ -+ DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ // interface init -+ //if (sdio_init(adapter_to_dvobj(padapter)) != _SUCCESS) -+ if((padapter->intf_init)&& (padapter->intf_init(adapter_to_dvobj(padapter)) != _SUCCESS)) -+ { -+ ret = -1; -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: initialize SDIO Failed!!\n", __FUNCTION__)); -+ goto exit; -+ } -+ rtw_hal_disable_interrupt(padapter); -+ //if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) -+ if ((padapter->intf_alloc_irq)&&(padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) -+ { -+ ret = -1; -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: sdio_alloc_irq Failed!!\n", __FUNCTION__)); -+ goto exit; -+ } -+ -+ rtw_reset_drv_sw(padapter); -+ #ifdef CONFIG_CONCURRENT_MODE -+ rtw_reset_drv_sw(padapter->pbuddy_adapter); -+ #endif -+ -+ pwrpriv->bkeepfwalive = _FALSE; -+ -+ DBG_871X("bkeepfwalive(%x)\n",pwrpriv->bkeepfwalive); -+ if(pm_netdev_open(pnetdev,_TRUE) != 0) { -+ ret = -1; -+ pdbgpriv->dbg_resume_error_cnt++; -+ goto exit; -+ } -+ -+ netif_device_attach(pnetdev); -+ netif_carrier_on(pnetdev); -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(rtw_buddy_adapter_up(padapter)){ -+ pbuddy_netdev = padapter->pbuddy_adapter->pnetdev; -+ -+ netif_device_attach(pbuddy_netdev); -+ netif_carrier_on(pbuddy_netdev); -+ } -+ #endif -+ -+ -+ if( padapter->pid[1]!=0) { -+ DBG_871X("pid[1]:%d\n",padapter->pid[1]); -+ rtw_signal_process(padapter->pid[1], SIGUSR2); -+ } -+ -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) -+ rtw_roaming(padapter, NULL); -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ rtw_ap_restore_network(padapter); -+ } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ } else { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ } -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(rtw_buddy_adapter_up(padapter)) -+ { -+ _adapter *buddy = padapter->pbuddy_adapter; -+ struct mlme_priv *buddy_mlme = &padapter->pbuddy_adapter->mlmepriv; -+ if (check_fwstate(buddy_mlme, WIFI_STATION_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(buddy), get_fwstate(buddy_mlme)); -+ -+ if (rtw_chk_roam_flags(buddy, RTW_ROAM_ON_RESUME)) -+ rtw_roaming(buddy, NULL); -+ -+ } else if (check_fwstate(buddy_mlme, WIFI_AP_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(buddy), get_fwstate(buddy_mlme)); -+ rtw_ap_restore_network(buddy); -+ } else if (check_fwstate(buddy_mlme, WIFI_ADHOC_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(buddy), get_fwstate(buddy_mlme)); -+ } else { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(buddy), get_fwstate(buddy_mlme)); -+ } -+ } -+ #endif -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+ //rtw_unlock_suspend(); -+#endif //CONFIG_RESUME_IN_WORKQUEUE -+ DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ -+exit: -+_func_exit_; -+ return ret; -+} -+ -+int rtw_resume_common(_adapter *padapter) -+{ -+ int ret = 0; -+ u32 start_time = rtw_get_current_time(); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ _func_enter_; -+ -+ if (pwrpriv->bInSuspend == _FALSE) -+ return 0; -+ -+ DBG_871X_LEVEL(_drv_always_, "resume start\n"); -+ DBG_871X("==> %s (%s:%d)\n",__FUNCTION__, current->comm, current->pid); -+ -+ if (check_fwstate(pmlmepriv,WIFI_STATION_STATE) == _TRUE -+#ifdef CONFIG_CONCURRENT_MODE -+ && check_buddy_fwstate(padapter, WIFI_AP_STATE) == _FALSE -+#endif -+ ) { -+ #ifdef CONFIG_WOWLAN -+ if (pwrpriv->wowlan_mode == _TRUE) -+ rtw_resume_process_wow(padapter); -+ else -+ rtw_resume_process_normal(padapter); -+ #else -+ rtw_resume_process_normal(padapter); -+ #endif -+ -+ } else if (check_fwstate(pmlmepriv,WIFI_AP_STATE) == _TRUE -+#ifdef CONFIG_CONCURRENT_MODE -+ && check_buddy_fwstate(padapter, WIFI_AP_STATE) == _FALSE -+#endif -+ ) { -+ #ifdef CONFIG_AP_WOWLAN -+ rtw_resume_process_ap_wow(padapter); -+ #else -+ rtw_resume_process_normal(padapter); -+ #endif //CONFIG_AP_WOWLAN -+#ifdef CONFIG_CONCURRENT_MODE -+ } else if (check_fwstate(pmlmepriv,WIFI_STATION_STATE) == _TRUE -+ && check_buddy_fwstate(padapter, WIFI_AP_STATE) == _TRUE) { -+ #ifdef CONFIG_AP_WOWLAN -+ rtw_resume_process_ap_wow(padapter); -+ #else -+ rtw_resume_process_normal(padapter); -+ #endif //CONFIG_AP_WOWLAN -+#endif -+ } else { -+ rtw_resume_process_normal(padapter); -+ } -+ -+ #ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SuspendNotify(padapter, 0); -+ #endif // CONFIG_BT_COEXIST -+ -+ if (pwrpriv) { -+ pwrpriv->bInSuspend = _FALSE; -+ #ifdef CONFIG_PNO_SUPPORT -+ pwrpriv->pno_in_resume = _FALSE; -+ #endif -+ } -+ DBG_871X_LEVEL(_drv_always_, "%s:%d in %d ms\n", __FUNCTION__ ,ret, -+ rtw_get_passing_time_ms(start_time)); -+ -+ _func_exit_; -+ -+ return ret; -+} -+ -+#ifdef CONFIG_GPIO_API -+u8 rtw_get_gpio(struct net_device *netdev, u8 gpio_num) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); -+ return rtw_hal_get_gpio(adapter, gpio_num); -+} -+EXPORT_SYMBOL(rtw_get_gpio); -+ -+int rtw_set_gpio_output_value(struct net_device *netdev, u8 gpio_num, bool isHigh) -+{ -+ u8 direction = 0; -+ u8 res = -1; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); -+ return rtw_hal_set_gpio_output_value(adapter, gpio_num,isHigh); -+} -+EXPORT_SYMBOL(rtw_set_gpio_output_value); -+ -+int rtw_config_gpio(struct net_device *netdev, u8 gpio_num, bool isOutput) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); -+ return rtw_hal_config_gpio(adapter,gpio_num,isOutput); -+} -+EXPORT_SYMBOL(rtw_config_gpio); -+int rtw_register_gpio_interrupt(struct net_device *netdev, int gpio_num, void(*callback)(u8 level)) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); -+ return rtw_hal_register_gpio_interrupt(adapter,gpio_num,callback); -+} -+EXPORT_SYMBOL(rtw_register_gpio_interrupt); -+ -+int rtw_disable_gpio_interrupt(struct net_device *netdev, int gpio_num) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); -+ return rtw_hal_disable_gpio_interrupt(adapter,gpio_num); -+} -+EXPORT_SYMBOL(rtw_disable_gpio_interrupt); -+ -+#endif //#ifdef CONFIG_GPIO_API -+ -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty/rtl8812au/os_dep/linux/recv_linux.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/recv_linux.c 2017-06-07 23:07:21.047690856 +0300 -@@ -0,0 +1,769 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/recv_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/recv_linux.c +--- linux-4.14.17/3rdparty/rtl8812au/os_dep/recv_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/recv_linux.c 2018-02-06 17:42:30.725967387 +0200 +@@ -0,0 +1,667 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -371742,11 +178736,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _RECV_OSDEP_C_ + @@ -371757,16 +178746,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + int res = _SUCCESS; + u8 shift_sz = 0; + u32 skb_len, alloc_sz; -+ _pkt *pkt_copy = NULL; ++ _pkt *pkt_copy = NULL; + struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; + + + if(pdata == NULL) -+ { ++ { + precvframe->u.hdr.pkt = NULL; + res = _FAIL; + return res; -+ } ++ } + + + // Modified by Albert 20101213 @@ -371780,17 +178769,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + if((pattrib->mfrag == 1)&&(pattrib->frag_num == 0)) + { + //alloc_sz = 1664; //1664 is 128 alignment. -+ alloc_sz = (skb_len <= 1650) ? 1664:(skb_len + 14); ++ alloc_sz = (skb_len <= 1650) ? 1664:(skb_len + 14); + } -+ else ++ else + { + alloc_sz = skb_len; + // 6 is for IP header 8 bytes alignment in QoS packet case. + // 8 is for skb->data 4 bytes alignment. + alloc_sz += 14; -+ } ++ } + -+ pkt_copy = rtw_skb_alloc(alloc_sz); ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18)) // http://www.mail-archive.com/netdev@vger.kernel.org/msg17214.html ++ pkt_copy = dev_alloc_skb(alloc_sz); ++#else ++ pkt_copy = netdev_alloc_skb(padapter->pnetdev, alloc_sz); ++#endif + + if(pkt_copy) + { @@ -371813,10 +178806,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + //rtw_free_recvframe(precvframe, pfree_recv_queue); + //goto _exit_recvbuf2recvframe; + -+ res = _FAIL; ++ res = _FAIL; +#else + if((pattrib->mfrag == 1)&&(pattrib->frag_num == 0)) -+ { ++ { + DBG_871X("%s: alloc_skb fail , drop frag frame \n", __FUNCTION__); + //rtw_free_recvframe(precvframe, pfree_recv_queue); + res = _FAIL; @@ -371828,8 +178821,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + res = _FAIL; + goto exit_rtw_os_recv_resource_alloc; + } -+ -+ precvframe->u.hdr.pkt = rtw_skb_clone(pskb); ++ ++ precvframe->u.hdr.pkt = skb_clone(pskb, GFP_ATOMIC); + if(precvframe->u.hdr.pkt) + { + precvframe->u.hdr.rx_head = precvframe->u.hdr.rx_data = precvframe->u.hdr.rx_tail = pdata; @@ -371837,13 +178830,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + } + else + { -+ DBG_871X("%s: rtw_skb_clone fail\n", __FUNCTION__); ++ DBG_871X("%s: skb_clone fail\n", __FUNCTION__); + //rtw_free_recvframe(precvframe, pfree_recv_queue); + //goto _exit_recvbuf2recvframe; + res = _FAIL; + } -+#endif -+ } ++#endif ++ } + +exit_rtw_os_recv_resource_alloc: + @@ -371855,7 +178848,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty +{ + if(precvframe->u.hdr.pkt) + { -+ rtw_skb_free(precvframe->u.hdr.pkt);//free skb by driver ++ dev_kfree_skb_any(precvframe->u.hdr.pkt);//free skb by driver + + precvframe->u.hdr.pkt = NULL; + } @@ -371873,7 +178866,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty +int rtw_os_recv_resource_alloc(_adapter *padapter, union recv_frame *precvframe) +{ + int res=_SUCCESS; -+ ++ + precvframe->u.hdr.pkt_newalloc = precvframe->u.hdr.pkt = NULL; + + return res; @@ -371882,19 +178875,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty +//free os related resource in union recv_frame +void rtw_os_recv_resource_free(struct recv_priv *precvpriv) +{ -+ sint i; -+ union recv_frame *precvframe; -+ precvframe = (union recv_frame*) precvpriv->precv_frame_buf; + -+ for(i=0; i < NR_RECVFRAME; i++) -+ { -+ if(precvframe->u.hdr.pkt) -+ { -+ rtw_skb_free(precvframe->u.hdr.pkt);//free skb by driver -+ precvframe->u.hdr.pkt = NULL; -+ } -+ precvframe++; -+ } +} + +//alloc os related resource in struct recv_buf @@ -371902,11 +178883,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty +{ + int res=_SUCCESS; + -+#ifdef CONFIG_USB_HCI + struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); + struct usb_device *pusbd = pdvobjpriv->pusbdev; + -+ precvbuf->irp_pending = _FALSE; ++ precvbuf->irp_pending = false; + precvbuf->purb = usb_alloc_urb(0, GFP_KERNEL); + if(precvbuf->purb == NULL){ + res = _FAIL; @@ -371914,6 +178894,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + + precvbuf->pskb = NULL; + ++ precvbuf->reuse = false; ++ + precvbuf->pallocated_buf = precvbuf->pbuf = NULL; + + precvbuf->pdata = precvbuf->phead = precvbuf->ptail = precvbuf->pend = NULL; @@ -371928,8 +178910,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + if(precvbuf->pallocated_buf == NULL) + return _FAIL; + #endif //CONFIG_USE_USB_BUFFER_ALLOC_RX -+ -+#endif //CONFIG_USB_HCI + + return res; +} @@ -371939,8 +178919,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty +{ + int ret = _SUCCESS; + -+#ifdef CONFIG_USB_HCI -+ +#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX + + struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); @@ -371958,18 +178936,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + usb_free_urb(precvbuf->purb); + } + -+#endif //CONFIG_USB_HCI -+ -+ + if(precvbuf->pskb) -+ { -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ if(rtw_free_skb_premem(precvbuf->pskb)!=0) -+#endif -+ rtw_skb_free(precvbuf->pskb); -+ } -+ return ret; ++ dev_kfree_skb_any(precvbuf->pskb); + ++ return ret; +} + +_pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, u16 nSubframe_Length, u8 *pdata) @@ -371982,7 +178952,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + pattrib = &prframe->u.hdr.attrib; + +#ifdef CONFIG_SKB_COPY -+ sub_skb = rtw_skb_alloc(nSubframe_Length + 12); ++ sub_skb = dev_alloc_skb(nSubframe_Length + 12); + if(sub_skb) + { + skb_reserve(sub_skb, 12); @@ -371992,7 +178962,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + else +#endif // CONFIG_SKB_COPY + { -+ sub_skb = rtw_skb_clone(prframe->u.hdr.pkt); ++ sub_skb = skb_clone(prframe->u.hdr.pkt, GFP_ATOMIC); + if(sub_skb) + { + sub_skb->data = pdata + ETH_HLEN; @@ -372001,7 +178971,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + } + else + { -+ DBG_871X("%s(): rtw_skb_clone() Fail!!!\n",__FUNCTION__); ++ DBG_871X("%s(): skb_clone() Fail!!!\n",__FUNCTION__); + return NULL; + } + } @@ -372017,7 +178987,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->src, ETH_ALEN); + _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->dst, ETH_ALEN); + } else { -+ u16 len; ++ __be16 len; + /* Leave Ethernet header part of hdr and full payload */ + len = htons(sub_skb->len); + _rtw_memcpy(skb_push(sub_skb, 2), &len, 2); @@ -372028,61 +178998,53 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + return sub_skb; +} + -+#ifdef DBG_UDP_PKT_LOSE_11AC -+#define PAYLOAD_LEN_LOC_OF_IP_HDR 0x10 /*ethernet payload length location of ip header (DA+SA+eth_type+(version&hdr_len)) */ -+#endif -+ +void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, struct rx_pkt_attrib *pattrib) +{ + struct mlme_priv*pmlmepriv = &padapter->mlmepriv; -+ struct recv_priv *precvpriv = &(padapter->recvpriv); +#ifdef CONFIG_BR_EXT + void *br_port = NULL; +#endif -+ int ret; + + /* Indicat the packets to upper layer */ + if (pkt) { -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) ++ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) + { -+ _pkt *pskb2=NULL; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; ++ _pkt *pskb2=NULL; ++ struct sta_info *psta = NULL; ++ struct sta_priv *pstapriv = &padapter->stapriv; + int bmcast = IS_MCAST(pattrib->dst); + + //DBG_871X("bmcast=%d\n", bmcast); + -+ if (_rtw_memcmp(pattrib->dst, adapter_mac_addr(padapter), ETH_ALEN) == _FALSE) ++ if(_rtw_memcmp(pattrib->dst, myid(&padapter->eeprompriv), ETH_ALEN)==false) + { + //DBG_871X("not ap psta=%p, addr=%pM\n", psta, pattrib->dst); + + if(bmcast) + { + psta = rtw_get_bcmc_stainfo(padapter); -+ pskb2 = rtw_skb_clone(pkt); ++ pskb2 = skb_clone(pkt, GFP_ATOMIC); + } else { + psta = rtw_get_stainfo(pstapriv, pattrib->dst); + } + + if(psta) + { -+ struct net_device *pnetdev= (struct net_device*)padapter->pnetdev; ++ struct net_device *pnetdev= (struct net_device*)padapter->pnetdev; + + //DBG_871X("directly forwarding to the rtw_xmit_entry\n"); + + //skb->ip_summed = CHECKSUM_NONE; -+ pkt->dev = pnetdev; ++ pkt->dev = pnetdev; +#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) + skb_set_queue_mapping(pkt, rtw_recv_select_queue(pkt)); +#endif //LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35) + -+ _rtw_xmit_entry(pkt, pnetdev); ++ rtw_xmit_entry(pkt, pnetdev); + + if(bmcast && (pskb2 != NULL) ) { + pkt = pskb2; -+ DBG_COUNTER(padapter->rx_logs.os_indicate_ap_mcast); + } else { -+ DBG_COUNTER(padapter->rx_logs.os_indicate_ap_forward); + return; + } + } @@ -372090,10 +179052,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + else// to APself + { + //DBG_871X("to APSelf\n"); -+ DBG_COUNTER(padapter->rx_logs.os_indicate_ap_self); + } + } -+ ++ +#ifdef CONFIG_BR_EXT + // Insert NAT2.5 RX here! +#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) @@ -372105,42 +179066,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty +#endif // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) + + -+ if( br_port && (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == _TRUE) ) ++ if( br_port && (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == true) ) + { -+ int nat25_handle_frame(_adapter *priv, struct sk_buff *skb); + if (nat25_handle_frame(padapter, pkt) == -1) { + //priv->ext_stats.rx_data_drops++; + //DEBUG_ERR("RX DROP: nat25_handle_frame fail!\n"); + //return FAIL; -+ ++ +#if 1 + // bypass this frame to upper layer!! +#else -+ rtw_skb_free(sub_skb); ++ dev_kfree_skb_any(sub_skb); + continue; +#endif -+ } ++ } + } +#endif // CONFIG_BR_EXT -+ if( precvpriv->sink_udpport > 0) -+ rtw_sink_rtp_seq_dbg(padapter,pkt); -+#ifdef DBG_UDP_PKT_LOSE_11AC -+ /* After eth_type_trans process , pkt->data pointer will move from ethrnet header to ip header , -+ * we have to check ethernet type , so this debug must be print before eth_type_trans -+ */ -+ if (*((unsigned short *)(pkt->data+ETH_ALEN*2)) == htons(ETH_P_ARP)) { -+ /* ARP Payload length will be 42bytes or 42+18(tailer)=60bytes*/ -+ if (pkt->len != 42 && pkt->len != 60) -+ DBG_871X("Error !!%s,ARP Payload length %u not correct\n" , __func__ , pkt->len); -+ } else if (*((unsigned short *)(pkt->data+ETH_ALEN*2)) == htons(ETH_P_IP)) { -+ if (be16_to_cpu(*((u16 *)(pkt->data+PAYLOAD_LEN_LOC_OF_IP_HDR))) != (pkt->len)-ETH_HLEN) { -+ DBG_871X("Error !!%s,Payload length not correct\n" , __func__); -+ DBG_871X("%s, IP header describe Total length=%u\n" , __func__ , be16_to_cpu(*((u16 *)(pkt->data+PAYLOAD_LEN_LOC_OF_IP_HDR)))); -+ DBG_871X("%s, Pkt real length=%u\n" , __func__ , (pkt->len)-ETH_HLEN); -+ } -+ } -+#endif -+ /* After eth_type_trans process , pkt->data pointer will move from ethrnet header to ip header */ ++ + pkt->protocol = eth_type_trans(pkt, padapter->pnetdev); + pkt->dev = padapter->pnetdev; + @@ -372154,23 +179096,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + pkt->ip_summed = CHECKSUM_NONE; +#endif //CONFIG_TCP_CSUM_OFFLOAD_RX + -+ ret = rtw_netif_rx(padapter->pnetdev, pkt); -+ if (ret == NET_RX_SUCCESS) -+ DBG_COUNTER(padapter->rx_logs.os_netif_ok); -+ else -+ DBG_COUNTER(padapter->rx_logs.os_netif_err); ++ netif_rx(pkt); + } +} + -+void rtw_handle_tkip_mic_err(_adapter *padapter, struct sta_info *sta, u8 bgroup) ++void rtw_handle_tkip_mic_err(_adapter *padapter,u8 bgroup) +{ +#ifdef CONFIG_IOCTL_CFG80211 -+ enum nl80211_key_type key_type = 0; ++ enum nl80211_key_type key_type; +#endif + union iwreq_data wrqu; + struct iw_michaelmicfailure ev; + struct mlme_priv* pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; ++ struct security_priv *psecuritypriv = &padapter->securitypriv; + u32 cur_time = 0; + + if( psecuritypriv->last_mic_err_time == 0 ) @@ -372183,7 +179121,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + + if( cur_time - psecuritypriv->last_mic_err_time < 60*HZ ) + { -+ psecuritypriv->btkip_countermeasure = _TRUE; ++ psecuritypriv->btkip_countermeasure = true; + psecuritypriv->last_mic_err_time = 0; + psecuritypriv->btkip_countermeasure_time = cur_time; + } @@ -372203,7 +179141,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + key_type |= NL80211_KEYTYPE_PAIRWISE; + } + -+ cfg80211_michael_mic_failure(padapter->pnetdev, sta->hwaddr, key_type, -1, NULL, GFP_ATOMIC); ++ cfg80211_michael_mic_failure(padapter->pnetdev, (u8 *)&pmlmepriv->assoc_bssid[ 0 ], key_type, -1, ++ NULL, GFP_ATOMIC); +#endif + + _rtw_memset( &ev, 0x00, sizeof( ev ) ); @@ -372217,7 +179156,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + } + + ev.src_addr.sa_family = ARPHRD_ETHER; -+ _rtw_memcpy(ev.src_addr.sa_data, sta->hwaddr, ETH_ALEN); ++ _rtw_memcpy( ev.src_addr.sa_data, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); + + _rtw_memset( &wrqu, 0x00, sizeof( wrqu ) ); + wrqu.data.length = sizeof( ev ); @@ -372245,7 +179184,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + skb->tail = precv_frame->u.hdr.rx_tail; + skb->len = precv_frame->u.hdr.len; + -+ //pskb_copy = rtw_skb_copy(skb); ++ //pskb_copy = skb_copy(skb, GFP_ATOMIC); +// if(skb == NULL) goto _exit; + + skb->dev = pmgnt_netdev; @@ -372262,28 +179201,28 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + //skb_pull(skb, 24); + _rtw_memset(skb->cb, 0, sizeof(skb->cb)); + -+ rtw_netif_rx(pmgnt_netdev, skb); ++ netif_rx(skb); + -+ precv_frame->u.hdr.pkt = NULL; // set pointer to NULL before rtw_free_recvframe() if call rtw_netif_rx() ++ precv_frame->u.hdr.pkt = NULL; // set pointer to NULL before rtw_free_recvframe() if call netif_rx() +#endif +} + +#ifdef CONFIG_AUTO_AP_MODE +static void rtw_os_ksocket_send(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ _pkt *skb = precv_frame->u.hdr.pkt; ++{ ++ _pkt *skb = precv_frame->u.hdr.pkt; + struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; + struct sta_info *psta = precv_frame->u.hdr.psta; -+ -+ DBG_871X("eth rx: got eth_type=0x%x\n", pattrib->eth_type); -+ ++ ++ DBG_871X("eth rx: got eth_type=0x%x\n", pattrib->eth_type); ++ + if (psta && psta->isrc && psta->pid>0) + { + u16 rx_pid; + + rx_pid = *(u16*)(skb->data+ETH_HLEN); -+ -+ DBG_871X("eth rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", ++ ++ DBG_871X("eth rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", + rx_pid, MAC_ARG(psta->hwaddr), psta->pid); + + if(rx_pid == psta->pid) @@ -372292,87 +179231,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + u16 len = *(u16*)(skb->data+ETH_HLEN+2); + //u16 ctrl_type = *(u16*)(skb->data+ETH_HLEN+4); + -+ //DBG_871X("eth, RC: len=0x%x, ctrl_type=0x%x\n", len, ctrl_type); ++ //DBG_871X("eth, RC: len=0x%x, ctrl_type=0x%x\n", len, ctrl_type); + DBG_871X("eth, RC: len=0x%x\n", len); + + for(i=0;idata+ETH_HLEN+4+i)); + //DBG_871X("0x%x\n", *(skb->data+ETH_HLEN+6+i)); + -+ DBG_871X("eth, RC-end\n"); ++ DBG_871X("eth, RC-end\n"); + +#if 0 -+ //send_sz = ksocket_send(padapter->ksock_send, &padapter->kaddr_send, (skb->data+ETH_HLEN+2), len); ++ //send_sz = ksocket_send(padapter->ksock_send, &padapter->kaddr_send, (skb->data+ETH_HLEN+2), len); + rtw_recv_ksocket_send_cmd(padapter, (skb->data+ETH_HLEN+2), len); + -+ //DBG_871X("ksocket_send size=%d\n", send_sz); -+#endif ++ //DBG_871X("ksocket_send size=%d\n", send_sz); ++#endif + } -+ -+ } ++ ++ } + +} +#endif //CONFIG_AUTO_AP_MODE + -+int rtw_recv_monitor(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ int ret = _FAIL; -+ struct recv_priv *precvpriv; -+ _queue *pfree_recv_queue; -+ _pkt *skb; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct rx_pkt_attrib *pattrib; -+ -+ if (NULL == precv_frame) -+ goto _recv_drop; -+ -+ pattrib = &precv_frame->u.hdr.attrib; -+ precvpriv = &(padapter->recvpriv); -+ pfree_recv_queue = &(precvpriv->free_recv_queue); -+ -+ skb = precv_frame->u.hdr.pkt; -+ if (skb == NULL) { -+ DBG_871X("%s :skb==NULL something wrong!!!!\n", __func__); -+ goto _recv_drop; -+ } -+ -+ skb->data = precv_frame->u.hdr.rx_data; -+ skb_set_tail_pointer(skb, precv_frame->u.hdr.len); -+ skb->len = precv_frame->u.hdr.len; -+ skb->ip_summed = CHECKSUM_NONE; -+ skb->pkt_type = PACKET_OTHERHOST; -+ skb->protocol = htons(0x0019); /* ETH_P_80211_RAW */ -+ -+ rtw_netif_rx(padapter->pnetdev, skb); -+ -+ /* pointers to NULL before rtw_free_recvframe() */ -+ precv_frame->u.hdr.pkt = NULL; -+ -+ ret = _SUCCESS; -+ -+_recv_drop: -+ -+ /* enqueue back to free_recv_queue */ -+ if (precv_frame) -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ -+ return ret; -+ -+} -+ +int rtw_recv_indicatepkt(_adapter *padapter, union recv_frame *precv_frame) +{ + struct recv_priv *precvpriv; + _queue *pfree_recv_queue; + _pkt *skb; + struct mlme_priv*pmlmepriv = &padapter->mlmepriv; -+ struct rx_pkt_attrib *pattrib; -+ -+ if(NULL == precv_frame) -+ goto _recv_indicatepkt_drop; ++ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; ++ ++ + -+ DBG_COUNTER(padapter->rx_logs.os_indicate); -+ pattrib = &precv_frame->u.hdr.attrib; + precvpriv = &(padapter->recvpriv); + pfree_recv_queue = &(precvpriv->free_recv_queue); + @@ -372398,7 +179288,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + goto _recv_indicatepkt_drop; + } + -+ RT_TRACE(_module_recv_osdep_c_,_drv_info_,("rtw_recv_indicatepkt():skb != NULL !!!\n")); ++ RT_TRACE(_module_recv_osdep_c_,_drv_info_,("rtw_recv_indicatepkt():skb != NULL !!!\n")); + RT_TRACE(_module_recv_osdep_c_,_drv_info_,("rtw_recv_indicatepkt():precv_frame->u.hdr.rx_head=%p precv_frame->hdr.rx_data=%p\n", precv_frame->u.hdr.rx_head, precv_frame->u.hdr.rx_data)); + RT_TRACE(_module_recv_osdep_c_,_drv_info_,("precv_frame->hdr.rx_tail=%p precv_frame->u.hdr.rx_end=%p precv_frame->hdr.len=%d \n", precv_frame->u.hdr.rx_tail, precv_frame->u.hdr.rx_end, precv_frame->u.hdr.len)); + @@ -372408,12 +179298,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + + skb->len = precv_frame->u.hdr.len; + -+ RT_TRACE(_module_recv_osdep_c_,_drv_info_,("\n skb->head=%p skb->data=%p skb->tail=%p skb->end=%p skb->len=%d\n", skb->head, skb->data, skb_tail_pointer(skb), skb_end_pointer(skb), skb->len)); ++ RT_TRACE(_module_recv_osdep_c_,_drv_info_,("\n skb->head=%p skb->data=%p skb->tail=%p skb->end=%p skb->len=%d\n", skb->head, skb->data, skb->tail, skb->end, skb->len)); + -+ if (pattrib->eth_type == 0x888e) -+ DBG_871X_LEVEL(_drv_always_, "recv eapol packet\n"); -+ -+#ifdef CONFIG_AUTO_AP_MODE ++#ifdef CONFIG_AUTO_AP_MODE +#if 1 //for testing +#if 1 + if (0x8899 == pattrib->eth_type) @@ -372426,7 +179313,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + if (0x8899 == pattrib->eth_type) + { + rtw_auto_ap_mode_rx(padapter, precv_frame); -+ ++ + goto _recv_indicatepkt_end; + } +#endif @@ -372441,7 +179328,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + + rtw_free_recvframe(precv_frame, pfree_recv_queue); + -+ RT_TRACE(_module_recv_osdep_c_,_drv_info_,("\n rtw_recv_indicatepkt :after rtw_os_recv_indicate_pkt!!!!\n")); ++ RT_TRACE(_module_recv_osdep_c_,_drv_info_,("\n rtw_recv_indicatepkt :after netif_rx!!!!\n")); ++ + + + return _SUCCESS; @@ -372452,60 +179340,64 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/recv_linux.c linux/3rdparty + if(precv_frame) + rtw_free_recvframe(precv_frame, pfree_recv_queue); + -+ DBG_COUNTER(padapter->rx_logs.os_indicate_err); -+ + return _FAIL; + ++ ++ +} + +void rtw_os_read_port(_adapter *padapter, struct recv_buf *precvbuf) +{ + struct recv_priv *precvpriv = &padapter->recvpriv; + -+#ifdef CONFIG_USB_HCI -+ + precvbuf->ref_cnt--; + + //free skb in recv_buf -+ rtw_skb_free(precvbuf->pskb); ++ dev_kfree_skb_any(precvbuf->pskb); + + precvbuf->pskb = NULL; ++ precvbuf->reuse = false; + -+ if(precvbuf->irp_pending == _FALSE) ++ if(precvbuf->irp_pending == false) + { + rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); + } -+ -+ -+#endif -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ precvbuf->pskb = NULL; -+#endif -+ +} -+void _rtw_reordering_ctrl_timeout_handler (void *FunctionContext); -+void _rtw_reordering_ctrl_timeout_handler (void *FunctionContext) ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++static void _rtw_reordering_ctrl_timeout_handler(void *FunctionContext) ++#else ++static void _rtw_reordering_ctrl_timeout_handler(struct timer_list *t) ++#endif +{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + struct recv_reorder_ctrl *preorder_ctrl = (struct recv_reorder_ctrl *)FunctionContext; ++#else ++ struct recv_reorder_ctrl *preorder_ctrl = from_timer(preorder_ctrl, t, reordering_ctrl_timer); ++#endif ++ + rtw_reordering_ctrl_timeout_handler(preorder_ctrl); +} + +void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl) +{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) + _adapter *padapter = preorder_ctrl->padapter; + + _init_timer(&(preorder_ctrl->reordering_ctrl_timer), padapter->pnetdev, _rtw_reordering_ctrl_timeout_handler, preorder_ctrl); ++#else + ++ timer_setup(&preorder_ctrl->reordering_ctrl_timer, _rtw_reordering_ctrl_timeout_handler, 0); ++#endif +} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdparty/rtl8812au/os_dep/linux/rtw_android.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/rtw_android.c 2017-06-07 23:07:21.047690856 +0300 -@@ -0,0 +1,1276 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/rtw_android.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/rtw_android.c +--- linux-4.14.17/3rdparty/rtl8812au/os_dep/rtw_android.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/rtw_android.c 2018-02-06 17:42:30.725967387 +0200 +@@ -0,0 +1,810 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -372515,19 +179407,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ + -+#ifdef CONFIG_GPIO_WAKEUP -+#include -+#endif -+ +#include + ++ +#if defined(RTW_ENABLE_WIFI_CONTROL_FUNC) +#include +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) @@ -372538,18 +179422,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart +#endif /* defined(RTW_ENABLE_WIFI_CONTROL_FUNC) */ + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) -+#define strnicmp strncasecmp -+#endif /* Linux kernel >= 4.0.0 */ -+ -+#ifdef CONFIG_GPIO_WAKEUP -+#include -+#include ++#define strnicmp strncasecmp +#endif + -+#include "rtw_version.h" -+ -+extern void macstr2num(u8 *dst, u8 *src); -+ +const char *android_wifi_cmd_str[ANDROID_WIFI_CMD_MAX] = { + "START", + "STOP", @@ -372574,46 +179449,32 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + "P2P_GET_NOA", + "P2P_SET_PS", + "SET_AP_WPS_P2P_IE", -+ -+ "MIRACAST", -+ -+#ifdef CONFIG_PNO_SUPPORT ++#ifdef PNO_SUPPORT + "PNOSSIDCLR", -+ "PNOSETUP", ++ "PNOSETUP ", + "PNOFORCE", + "PNODEBUG", +#endif + + "MACADDR", + -+ "BLOCK_SCAN", + "BLOCK", + "WFD-ENABLE", + "WFD-DISABLE", + "WFD-SET-TCPPORT", + "WFD-SET-MAXTPUT", + "WFD-SET-DEVTYPE", -+ "SET_DTIM", -+ "HOSTAPD_SET_MACADDR_ACL", -+ "HOSTAPD_ACL_ADD_STA", -+ "HOSTAPD_ACL_REMOVE_STA", -+#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 1, 0)) -+ "GTK_REKEY_OFFLOAD", -+#endif //CONFIG_GTK_OL -+/* Private command for P2P disable*/ -+ "P2P_DISABLE", -+ "DRIVER_VERSION" +}; + -+#ifdef CONFIG_PNO_SUPPORT ++#ifdef PNO_SUPPORT +#define PNO_TLV_PREFIX 'S' +#define PNO_TLV_VERSION '1' -+#define PNO_TLV_SUBVERSION '2' ++#define PNO_TLV_SUBVERSION '2' +#define PNO_TLV_RESERVED '0' -+#define PNO_TLV_TYPE_SSID_IE 'S' ++#define PNO_TLV_TYPE_SSID_IE 'S' +#define PNO_TLV_TYPE_TIME 'T' +#define PNO_TLV_FREQ_REPEAT 'R' -+#define PNO_TLV_FREQ_EXPO_MAX 'M' ++#define PNO_TLV_FREQ_EXPO_MAX 'M' + +typedef struct cmd_tlv { + char prefix; @@ -372621,48 +179482,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + char subver; + char reserved; +} cmd_tlv_t; -+ -+#ifdef CONFIG_PNO_SET_DEBUG -+char pno_in_example[] = { -+ 'P', 'N', 'O', 'S', 'E', 'T', 'U', 'P', ' ', -+ 'S', '1', '2', '0', -+ 'S', //1 -+ 0x05, -+ 'd', 'l', 'i', 'n', 'k', -+ 'S', //2 -+ 0x06, -+ 'B', 'U', 'F', 'B', 'U','F', -+ 'S', //3 -+ 0x20, -+ 'a', 'b', 'c', 'd', 'e', 'f', 'g', 'h', 'i', 'j', 'k', 'l', 'm', 'n', 'o', 'p', 'q', 'r', 's', 't', 'u', 'v', 'w', 'x', 'y', 'z', '!', '@', '#', '$', '%', '^', -+ 'S', //4 -+ 0x0a, -+ '!', '@', '#', '$', '%', '^', '&', '*', '(', ')', -+ 'T', -+ '0', '5', -+ 'R', -+ '2', -+ 'M', -+ '2', -+ 0x00 -+ }; -+#endif /* CONFIG_PNO_SET_DEBUG */ +#endif /* PNO_SUPPORT */ + +typedef struct android_wifi_priv_cmd { ++ ++#ifdef CONFIG_COMPAT ++ compat_uptr_t buf; ++#else + char *buf; ++#endif ++ + int used_len; + int total_len; +} android_wifi_priv_cmd; + -+#ifdef CONFIG_COMPAT -+typedef struct compat_android_wifi_priv_cmd { -+ compat_uptr_t buf; -+ int used_len; -+ int total_len; -+} compat_android_wifi_priv_cmd; -+#endif /* CONFIG_COMPAT */ -+ +/** + * Local (static) functions and variables + */ @@ -372671,25 +179504,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + * time (only) in dhd_open, subsequential wifi on will be handled by + * wl_android_wifi_on + */ -+static int g_wifi_on = _TRUE; ++static int g_wifi_on = true; + -+unsigned int oob_irq = 0; -+unsigned int oob_gpio = 0; + -+#ifdef CONFIG_PNO_SUPPORT -+/* -+ * rtw_android_pno_setup -+ * Description: -+ * This is used for private command. -+ * -+ * Parameter: -+ * net: net_device -+ * command: parameters from private command -+ * total_len: the length of the command. -+ * -+ * */ -+static int rtw_android_pno_setup(struct net_device *net, char *command, int total_len) { -+ pno_ssid_t pno_ssids_local[MAX_PNO_LIST_COUNT]; ++#ifdef PNO_SUPPORT ++static int wl_android_set_pno_setup(struct net_device *dev, char *command, int total_len) ++{ ++ wlc_ssid_t ssids_local[MAX_PFN_LIST_COUNT]; + int res = -1; + int nssid = 0; + cmd_tlv_t *cmd_tlv_temp; @@ -372698,28 +179519,48 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + int pno_time = 0; + int pno_repeat = 0; + int pno_freq_expo_max = 0; -+ int cmdlen = strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_PNOSETUP_SET]) + 1; + -+#ifdef CONFIG_PNO_SET_DEBUG ++#ifdef PNO_SET_DEBUG + int i; -+ char *p; -+ p = pno_in_example; ++ char pno_in_example[] = { ++ 'P', 'N', 'O', 'S', 'E', 'T', 'U', 'P', ' ', ++ 'S', '1', '2', '0', ++ 'S', ++ 0x05, ++ 'd', 'l', 'i', 'n', 'k', ++ 'S', ++ 0x04, ++ 'G', 'O', 'O', 'G', ++ 'T', ++ '0', 'B', ++ 'R', ++ '2', ++ 'M', ++ '2', ++ 0x00 ++ }; ++#endif /* PNO_SET_DEBUG */ + -+ total_len = sizeof(pno_in_example); -+ str_ptr = p + cmdlen; -+#else -+ str_ptr = command + cmdlen; -+#endif ++ DHD_INFO(("%s: command=%s, len=%d\n", __FUNCTION__, command, total_len)); + -+ if (total_len < (cmdlen + sizeof(cmd_tlv_t))) { -+ DBG_871X("%s argument=%d less min size\n", __func__, total_len); ++ if (total_len < (strlen(CMD_PNOSETUP_SET) + sizeof(cmd_tlv_t))) { ++ DBG_871X("%s argument=%d less min size\n", __FUNCTION__, total_len); + goto exit_proc; + } + -+ tlv_size_left = total_len - cmdlen; ++#ifdef PNO_SET_DEBUG ++ memcpy(command, pno_in_example, sizeof(pno_in_example)); ++ for (i = 0; i < sizeof(pno_in_example); i++) ++ printf("%02X ", command[i]); ++ printf("\n"); ++ total_len = sizeof(pno_in_example); ++#endif ++ ++ str_ptr = command + strlen(CMD_PNOSETUP_SET); ++ tlv_size_left = total_len - strlen(CMD_PNOSETUP_SET); + + cmd_tlv_temp = (cmd_tlv_t *)str_ptr; -+ memset(pno_ssids_local, 0, sizeof(pno_ssids_local)); ++ memset(ssids_local, 0, sizeof(ssids_local)); + + if ((cmd_tlv_temp->prefix == PNO_TLV_PREFIX) && + (cmd_tlv_temp->version == PNO_TLV_VERSION) && @@ -372728,38 +179569,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + str_ptr += sizeof(cmd_tlv_t); + tlv_size_left -= sizeof(cmd_tlv_t); + -+ if ((nssid = rtw_parse_ssid_list_tlv(&str_ptr, pno_ssids_local, -+ MAX_PNO_LIST_COUNT, &tlv_size_left)) <= 0) { ++ if ((nssid = wl_iw_parse_ssid_list_tlv(&str_ptr, ssids_local, ++ MAX_PFN_LIST_COUNT, &tlv_size_left)) <= 0) { + DBG_871X("SSID is not presented or corrupted ret=%d\n", nssid); + goto exit_proc; + } else { + if ((str_ptr[0] != PNO_TLV_TYPE_TIME) || (tlv_size_left <= 1)) { + DBG_871X("%s scan duration corrupted field size %d\n", -+ __func__, tlv_size_left); ++ __FUNCTION__, tlv_size_left); + goto exit_proc; + } + str_ptr++; + pno_time = simple_strtoul(str_ptr, &str_ptr, 16); -+ DBG_871X("%s: pno_time=%d\n", __func__, pno_time); ++ DHD_INFO(("%s: pno_time=%d\n", __FUNCTION__, pno_time)); + + if (str_ptr[0] != 0) { + if ((str_ptr[0] != PNO_TLV_FREQ_REPEAT)) { + DBG_871X("%s pno repeat : corrupted field\n", -+ __func__); ++ __FUNCTION__); + goto exit_proc; + } + str_ptr++; + pno_repeat = simple_strtoul(str_ptr, &str_ptr, 16); -+ DBG_871X("%s :got pno_repeat=%d\n", __FUNCTION__, pno_repeat); ++ DHD_INFO(("%s :got pno_repeat=%d\n", __FUNCTION__, pno_repeat)); + if (str_ptr[0] != PNO_TLV_FREQ_EXPO_MAX) { + DBG_871X("%s FREQ_EXPO_MAX corrupted field size\n", -+ __func__); ++ __FUNCTION__); + goto exit_proc; + } + str_ptr++; + pno_freq_expo_max = simple_strtoul(str_ptr, &str_ptr, 16); -+ DBG_871X("%s: pno_freq_expo_max=%d\n", -+ __func__, pno_freq_expo_max); ++ DHD_INFO(("%s: pno_freq_expo_max=%d\n", ++ __FUNCTION__, pno_freq_expo_max)); + } + } + } else { @@ -372767,95 +179608,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + goto exit_proc; + } + -+ res = rtw_dev_pno_set(net, pno_ssids_local, nssid, pno_time, pno_repeat, pno_freq_expo_max); -+ -+#ifdef CONFIG_PNO_SET_DEBUG -+ rtw_dev_pno_debug(net); -+#endif ++ res = dhd_dev_pno_set(dev, ssids_local, nssid, pno_time, pno_repeat, pno_freq_expo_max); + +exit_proc: + return res; +} -+ -+/* -+ * rtw_android_cfg80211_pno_setup -+ * Description: -+ * This is used for cfg80211 sched_scan. -+ * -+ * Parameter: -+ * net: net_device -+ * request: cfg80211_request -+ * */ -+ -+int rtw_android_cfg80211_pno_setup(struct net_device *net, -+ struct cfg80211_ssid *ssids, int n_ssids, int interval) { -+ int res = -1; -+ int nssid = 0; -+ int pno_time = 0; -+ int pno_repeat = 0; -+ int pno_freq_expo_max = 0; -+ int index = 0; -+ pno_ssid_t pno_ssids_local[MAX_PNO_LIST_COUNT]; -+ -+ if (n_ssids > MAX_PNO_LIST_COUNT || n_ssids < 0) { -+ DBG_871X("%s: nssids(%d) is invalid.\n", __func__, n_ssids); -+ return -EINVAL; -+ } -+ -+ memset(pno_ssids_local, 0, sizeof(pno_ssids_local)); -+ -+ nssid = n_ssids; -+ -+ for (index = 0 ; index < nssid ; index++) { -+ pno_ssids_local[index].SSID_len = ssids[index].ssid_len; -+ memcpy(pno_ssids_local[index].SSID, ssids[index].ssid, -+ ssids[index].ssid_len); -+ } -+ -+ pno_time = (interval / 1000); -+ -+ DBG_871X("%s: nssids: %d, pno_time=%d\n", __func__, nssid, pno_time); -+ -+ res = rtw_dev_pno_set(net, pno_ssids_local, nssid, pno_time, -+ pno_repeat, pno_freq_expo_max); -+ -+exit_proc: -+ return res; -+} -+ -+int rtw_android_pno_enable(struct net_device *net, int pno_enable) { -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ -+ if (pwrctl) { -+ pwrctl->wowlan_pno_enable = pno_enable; -+ DBG_871X("%s: wowlan_pno_enable: %d\n", __func__, pwrctl->wowlan_pno_enable); -+ if (pwrctl->wowlan_pno_enable == 0) { -+ if (pwrctl->pnlo_info != NULL) { -+ rtw_mfree((u8 *)pwrctl->pnlo_info, sizeof(pno_nlo_info_t)); -+ pwrctl->pnlo_info = NULL; -+ } -+ if (pwrctl->pno_ssid_list != NULL) { -+ rtw_mfree((u8 *)pwrctl->pno_ssid_list, sizeof(pno_ssid_list_t)); -+ pwrctl->pno_ssid_list = NULL; -+ } -+ if (pwrctl->pscan_info != NULL) { -+ rtw_mfree((u8 *)pwrctl->pscan_info, sizeof(pno_scan_info_t)); -+ pwrctl->pscan_info = NULL; -+ } -+ } -+ return 0; -+ } else { -+ return -1; -+ } -+} -+#endif //CONFIG_PNO_SUPPORT ++#endif /* PNO_SUPPORT */ + +int rtw_android_cmdstr_to_num(char *cmdstr) +{ + int cmd_num; + for(cmd_num=0 ; cmd_nummlmepriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct wlan_network *pcur_network = &pmlmepriv->cur_network; + int bytes_written = 0; + -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ bytes_written += snprintf(&command[bytes_written], total_len, "%s rssi %d", ++ if(check_fwstate(pmlmepriv, _FW_LINKED) == true) { ++ bytes_written += snprintf(&command[bytes_written], total_len, "%s rssi %d", + pcur_network->network.Ssid.Ssid, padapter->recvpriv.rssi); + } + @@ -372879,7 +179643,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart +int rtw_android_get_link_speed(struct net_device *net, char *command, int total_len) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); ++ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct wlan_network *pcur_network = &pmlmepriv->cur_network; + int bytes_written = 0; + u16 link_speed = 0; @@ -372894,7 +179658,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(net); + int bytes_written = 0; -+ ++ + bytes_written = snprintf(command, total_len, "Macaddr = "MAC_FMT, MAC_ARG(net->dev_addr)); + return bytes_written; +} @@ -372903,8 +179667,8 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(net); + char *country_code = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_COUNTRY]) + 1; -+ int ret = _FAIL; -+ ++ int ret; ++ + ret = rtw_set_country(adapter, country_code); + + return (ret==_SUCCESS)?0:-1; @@ -372912,84 +179676,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + +int rtw_android_get_p2p_dev_addr(struct net_device *net, char *command, int total_len) +{ ++ int ret; + int bytes_written = 0; + + //We use the same address as our HW MAC address + _rtw_memcpy(command, net->dev_addr, ETH_ALEN); -+ ++ + bytes_written = ETH_ALEN; + return bytes_written; +} + -+int rtw_android_set_block_scan(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ char *block_value = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_BLOCK_SCAN]) + 1; -+ -+ #ifdef CONFIG_IOCTL_CFG80211 -+ adapter_wdev_data(adapter)->block_scan = (*block_value == '0')?_FALSE:_TRUE; -+ #endif -+ -+ return 0; -+} -+ +int rtw_android_set_block(struct net_device *net, char *command, int total_len) +{ ++ int ret; + _adapter *adapter = (_adapter *)rtw_netdev_priv(net); + char *block_value = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_BLOCK]) + 1; + + #ifdef CONFIG_IOCTL_CFG80211 -+ adapter_wdev_data(adapter)->block = (*block_value=='0')?_FALSE:_TRUE; ++ wdev_to_priv(adapter->rtw_wdev)->block = (*block_value=='0')?false:true; + #endif -+ ++ + return 0; +} + -+int rtw_android_setband(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ char *arg = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_SETBAND]) + 1; -+ u32 band = WIFI_FREQUENCY_BAND_AUTO; -+ int ret = _FAIL; -+ -+ if (sscanf(arg, "%u", &band) >= 1) -+ ret = rtw_set_band(adapter, band); -+ -+ return (ret==_SUCCESS)?0:-1; -+} -+ -+int rtw_android_getband(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ int bytes_written = 0; -+ -+ bytes_written = snprintf(command, total_len, "%u", adapter->setband); -+ -+ return bytes_written; -+} -+ -+#ifdef CONFIG_WFD -+int rtw_android_set_miracast_mode(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ struct wifi_display_info *wfd_info = &adapter->wfd_info; -+ char *arg = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_MIRACAST]) + 1; -+ u8 mode; -+ int num; -+ int ret = _FAIL; -+ -+ num = sscanf(arg, "%hhu", &mode); -+ -+ if (num >= 1) { -+ wfd_info->stack_wfd_mode = mode; -+ DBG_871X("Miracast mode: %s(%u)\n", get_miracast_mode_str(wfd_info->stack_wfd_mode), wfd_info->stack_wfd_mode); -+ ret = _SUCCESS; -+ } -+ -+ return (ret == _SUCCESS)?0:-1; -+} -+#endif /* CONFIG_WFD */ -+ +int get_int_from_command( char* pcmd ) +{ + int i = 0; @@ -373006,69 +179715,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + return ( rtw_atoi( pcmd + i ) ); +} + -+#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 1, 0)) -+int rtw_gtk_offload(struct net_device *net, u8 *cmd_ptr) -+{ -+ int i; -+ //u8 *cmd_ptr = priv_cmd.buf; -+ struct sta_info * psta; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ -+ -+ if (psta == NULL) -+ { -+ DBG_8192C("%s, : Obtain Sta_info fail \n", __func__); -+ } -+ else -+ { -+ //string command length of "GTK_REKEY_OFFLOAD" -+ cmd_ptr += 18; -+ -+ _rtw_memcpy(psta->kek, cmd_ptr, RTW_KEK_LEN); -+ cmd_ptr += RTW_KEK_LEN; -+ /* -+ printk("supplicant KEK: "); -+ for(i=0;ikek[i]); -+ printk("\n supplicant KCK: "); -+ */ -+ _rtw_memcpy(psta->kck, cmd_ptr, RTW_KCK_LEN); -+ cmd_ptr += RTW_KCK_LEN; -+ /* -+ for(i=0;ikck[i]); -+ */ -+ _rtw_memcpy(psta->replay_ctr, cmd_ptr, RTW_REPLAY_CTR_LEN); -+ psecuritypriv->binstallKCK_KEK = _TRUE; -+ -+ //printk("\nREPLAY_CTR: "); -+ //for(i=0;ireplay_ctr[i]); -+ } -+ -+ return _SUCCESS; -+} -+#endif //CONFIG_GTK_OL -+ +int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) +{ + int ret = 0; + char *command = NULL; + int cmd_num; + int bytes_written = 0; -+#ifdef CONFIG_PNO_SUPPORT -+ uint cmdlen = 0; -+ uint pno_enable = 0; -+#endif + android_wifi_priv_cmd priv_cmd; -+ _adapter* padapter = ( _adapter * ) rtw_netdev_priv(net); -+#ifdef CONFIG_WFD -+ struct wifi_display_info *pwfd_info; -+#endif + + rtw_lock_suspend(); + @@ -373076,37 +179729,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + ret = -EINVAL; + goto exit; + } -+ if (padapter->registrypriv.mp_mode == 1) { -+ ret = -EINVAL; -+ goto exit; -+ } -+#ifdef CONFIG_COMPAT -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4,6,0)) -+ if (is_compat_task()) { -+#else -+ if (in_compat_syscall()) { -+#endif -+ /* User space is 32-bit, use compat ioctl */ -+ compat_android_wifi_priv_cmd compat_priv_cmd; -+ -+ if (copy_from_user(&compat_priv_cmd, ifr->ifr_data, sizeof(compat_android_wifi_priv_cmd))) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ priv_cmd.buf = compat_ptr(compat_priv_cmd.buf); -+ priv_cmd.used_len = compat_priv_cmd.used_len; -+ priv_cmd.total_len = compat_priv_cmd.total_len; -+ } else -+#endif /* CONFIG_COMPAT */ + if (copy_from_user(&priv_cmd, ifr->ifr_data, sizeof(android_wifi_priv_cmd))) { + ret = -EFAULT; + goto exit; + } -+ if ( padapter->registrypriv.mp_mode == 1) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ /*DBG_871X("%s priv_cmd.buf=%p priv_cmd.total_len=%d priv_cmd.used_len=%d\n",__func__,priv_cmd.buf,priv_cmd.total_len,priv_cmd.used_len);*/ ++ ++ //DBG_871X("%s priv_cmd.buf=%p priv_cmd.total_len=%d priv_cmd.used_len=%d\n",__func__,priv_cmd.buf,priv_cmd.total_len,priv_cmd.used_len); + command = rtw_zmalloc(priv_cmd.total_len); + if (!command) + { @@ -373116,7 +179744,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + } + + if (!access_ok(VERIFY_READ, priv_cmd.buf, priv_cmd.total_len)){ -+ DBG_871X("%s: failed to access memory\n", __FUNCTION__); ++ DBG_871X("%s: failed to access memory\n", __FUNCTION__); + ret = -EFAULT; + goto exit; + } @@ -373129,7 +179757,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + , __FUNCTION__, command, ifr->ifr_name); + + cmd_num = rtw_android_cmdstr_to_num(command); -+ ++ + switch(cmd_num) { + case ANDROID_WIFI_CMD_START: + //bytes_written = wl_android_wifi_on(net); @@ -373150,19 +179778,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + case ANDROID_WIFI_CMD_STOP: + //bytes_written = wl_android_wifi_off(net); + break; -+ ++ + case ANDROID_WIFI_CMD_SCAN_ACTIVE: -+ //rtw_set_scan_mode((_adapter *)rtw_netdev_priv(net), SCAN_ACTIVE); -+#ifdef CONFIG_PLATFORM_MSTAR -+#ifdef CONFIG_IOCTL_CFG80211 -+ adapter_wdev_data((_adapter *)rtw_netdev_priv(net))->bandroid_scan = _TRUE; -+#endif //CONFIG_IOCTL_CFG80211 -+#endif //CONFIG_PLATFORM_MSTAR + break; + case ANDROID_WIFI_CMD_SCAN_PASSIVE: -+ //rtw_set_scan_mode((_adapter *)rtw_netdev_priv(net), SCAN_PASSIVE); + break; -+ ++ + case ANDROID_WIFI_CMD_RSSI: + bytes_written = rtw_android_get_rssi(net, command, priv_cmd.total_len); + break; @@ -373174,14 +179795,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + bytes_written = rtw_android_get_macaddr(net, command, priv_cmd.total_len); + break; + -+ case ANDROID_WIFI_CMD_BLOCK_SCAN: -+ bytes_written = rtw_android_set_block_scan(net, command, priv_cmd.total_len); -+ break; -+ + case ANDROID_WIFI_CMD_BLOCK: + bytes_written = rtw_android_set_block(net, command, priv_cmd.total_len); + break; -+ ++ + case ANDROID_WIFI_CMD_RXFILTER_START: + //bytes_written = net_os_set_packet_filter(net, 1); + break; @@ -373196,7 +179813,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + //int filter_num = *(command + strlen(CMD_RXFILTER_REMOVE) + 1) - '0'; + //bytes_written = net_os_rxfilter_add_remove(net, FALSE, filter_num); + break; -+ ++ + case ANDROID_WIFI_CMD_BTCOEXSCAN_START: + /* TBD: BTCOEXSCAN-START */ + break; @@ -373215,34 +179832,39 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart +#endif + #endif + break; -+ ++ + case ANDROID_WIFI_CMD_SETSUSPENDOPT: + //bytes_written = wl_android_set_suspendopt(net, command, priv_cmd.total_len); + break; -+ -+ case ANDROID_WIFI_CMD_SETBAND: -+ bytes_written = rtw_android_setband(net, command, priv_cmd.total_len); -+ break; + ++ case ANDROID_WIFI_CMD_SETBAND: ++ { ++ uint band = *(command + strlen("SETBAND") + 1) - '0'; ++ _adapter* padapter = ( _adapter * ) rtw_netdev_priv(net); ++ ++ if (padapter->chip_type == RTL8192D) ++ padapter->setband = band; ++ ++ break; ++ } + case ANDROID_WIFI_CMD_GETBAND: -+ bytes_written = rtw_android_getband(net, command, priv_cmd.total_len); ++ //bytes_written = wl_android_get_band(net, command, priv_cmd.total_len); + break; + + case ANDROID_WIFI_CMD_COUNTRY: + bytes_written = rtw_android_set_country(net, command, priv_cmd.total_len); + break; -+ -+#ifdef CONFIG_PNO_SUPPORT ++ ++#ifdef PNO_SUPPORT + case ANDROID_WIFI_CMD_PNOSSIDCLR_SET: + //bytes_written = dhd_dev_pno_reset(net); + break; + case ANDROID_WIFI_CMD_PNOSETUP_SET: -+ bytes_written = rtw_android_pno_setup(net, command, priv_cmd.total_len); ++ //bytes_written = wl_android_set_pno_setup(net, command, priv_cmd.total_len); + break; + case ANDROID_WIFI_CMD_PNOENABLE_SET: -+ cmdlen = strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_PNOENABLE_SET]); -+ pno_enable = *(command + cmdlen + 1) - '0'; -+ bytes_written = rtw_android_pno_enable(net, pno_enable); ++ //uint pfn_enabled = *(command + strlen(CMD_PNOENABLE_SET) + 1) - '0'; ++ //bytes_written = dhd_dev_pno_enable(net, pfn_enabled); + break; +#endif + @@ -373260,7 +179882,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + //int skip = strlen(CMD_P2P_SET_PS) + 1; + //bytes_written = wl_cfg80211_set_p2p_ps(net, command + skip, priv_cmd.total_len - skip); + break; -+ ++ +#ifdef CONFIG_IOCTL_CFG80211 + case ANDROID_WIFI_CMD_SET_AP_WPS_P2P_IE: + { @@ -373271,20 +179893,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart +#endif //CONFIG_IOCTL_CFG80211 + +#ifdef CONFIG_WFD -+ -+ case ANDROID_WIFI_CMD_MIRACAST: -+ bytes_written = rtw_android_set_miracast_mode(net, command, priv_cmd.total_len); -+ break; -+ + case ANDROID_WIFI_CMD_WFD_ENABLE: + { + // Commented by Albert 2012/07/24 + // We can enable the WFD function by using the following command: + // wpa_cli driver wfd-enable + ++ struct wifi_display_info *pwfd_info; ++ _adapter* padapter = ( _adapter * ) rtw_netdev_priv(net); ++ + pwfd_info = &padapter->wfd_info; + if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 ) -+ pwfd_info->wfd_enable = _TRUE; ++ pwfd_info->wfd_enable = true; + break; + } + @@ -373294,9 +179914,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + // We can disable the WFD function by using the following command: + // wpa_cli driver wfd-disable + ++ struct wifi_display_info *pwfd_info; ++ _adapter* padapter = ( _adapter * ) rtw_netdev_priv(net); ++ + pwfd_info = &padapter->wfd_info; + if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 ) -+ pwfd_info->wfd_enable = _FALSE; ++ pwfd_info->wfd_enable = false; + break; + } + case ANDROID_WIFI_CMD_WFD_SET_TCPPORT: @@ -373305,15 +179928,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + // We can set the tcp port number by using the following command: + // wpa_cli driver wfd-set-tcpport = 554 + ++ struct wifi_display_info *pwfd_info; ++ _adapter* padapter = ( _adapter * ) rtw_netdev_priv(net); ++ + pwfd_info = &padapter->wfd_info; + if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 ) -+ { -+ pwfd_info->rtsp_ctrlport = ( u16 ) get_int_from_command( priv_cmd.buf ); -+ } ++ pwfd_info->rtsp_ctrlport = ( u16 ) get_int_from_command( (char*)priv_cmd.buf ); + break; + } + case ANDROID_WIFI_CMD_WFD_SET_MAX_TPUT: + { ++ ++ + break; + } + case ANDROID_WIFI_CMD_WFD_SET_DEVTYPE: @@ -373321,73 +179947,19 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + // Commented by Albert 2012/08/28 + // Specify the WFD device type ( WFD source/primary sink ) + ++ struct wifi_display_info *pwfd_info; ++ _adapter* padapter = ( _adapter * ) rtw_netdev_priv(net); ++ + pwfd_info = &padapter->wfd_info; + if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 ) + { -+ pwfd_info->wfd_device_type = ( u8 ) get_int_from_command( priv_cmd.buf ); ++ pwfd_info->wfd_device_type = ( u8 ) get_int_from_command( (char*)priv_cmd.buf ); ++ + pwfd_info->wfd_device_type &= WFD_DEVINFO_DUAL; + } + break; + } +#endif -+ case ANDROID_WIFI_CMD_CHANGE_DTIM: -+ { -+#ifdef CONFIG_LPS -+ u8 dtim; -+ u8 *ptr =(u8 *) &priv_cmd.buf; -+ -+ ptr += 9;//string command length of "SET_DTIM"; -+ -+ dtim = rtw_atoi(ptr); -+ -+ DBG_871X("DTIM=%d\n", dtim); -+ -+ rtw_lps_change_dtim_cmd(padapter, dtim); -+#endif -+ } -+ break; -+ case ANDROID_WIFI_CMD_HOSTAPD_SET_MACADDR_ACL: -+ { -+ padapter->stapriv.acl_list.mode = ( u8 ) get_int_from_command(command); -+ DBG_871X("%s ANDROID_WIFI_CMD_HOSTAPD_SET_MACADDR_ACL mode:%d\n", __FUNCTION__, padapter->stapriv.acl_list.mode); -+ break; -+ } -+ case ANDROID_WIFI_CMD_HOSTAPD_ACL_ADD_STA: -+ { -+ u8 addr[ETH_ALEN] = {0x00}; -+ macstr2num(addr, command+strlen("HOSTAPD_ACL_ADD_STA")+3); // 3 is space bar + "=" + space bar these 3 chars -+ rtw_acl_add_sta(padapter, addr); -+ break; -+ } -+ case ANDROID_WIFI_CMD_HOSTAPD_ACL_REMOVE_STA: -+ { -+ u8 addr[ETH_ALEN] = {0x00}; -+ macstr2num(addr, command+strlen("HOSTAPD_ACL_REMOVE_STA")+3); // 3 is space bar + "=" + space bar these 3 chars -+ rtw_acl_remove_sta(padapter, addr); -+ break; -+ } -+#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 1, 0)) -+ case ANDROID_WIFI_CMD_GTK_REKEY_OFFLOAD: -+ rtw_gtk_offload(net, (u8*)command); -+ break; -+#endif //CONFIG_GTK_OL -+ case ANDROID_WIFI_CMD_P2P_DISABLE: -+ { -+#ifdef CONFIG_P2P -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u8 channel, ch_offset; -+ u16 bwmode; -+ -+ rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); -+#endif // CONFIG_P2P -+ break; -+ } -+ case ANDROID_WIFI_CMD_DRIVERVERSION: -+ { -+ bytes_written = strlen(DRIVERVERSION); -+ snprintf(command, bytes_written+1, DRIVERVERSION); -+ break; -+ } + default: + DBG_871X("Unknown PRIVATE command %s - ignored\n", command); + snprintf(command, 3, "OK"); @@ -373417,7 +179989,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart +exit: + rtw_unlock_suspend(); + if (command) { -+ rtw_mfree(command, priv_cmd.total_len); ++ kfree(command); + } + + return ret; @@ -373547,37 +180119,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart +{ + struct wifi_platform_data *wifi_ctrl = + (struct wifi_platform_data *)(pdev->dev.platform_data); -+ int wifi_wake_gpio = 0; + + DBG_871X("## %s\n", __FUNCTION__); + wifi_irqres = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "bcmdhd_wlan_irq"); -+ + if (wifi_irqres == NULL) + wifi_irqres = platform_get_resource_byname(pdev, + IORESOURCE_IRQ, "bcm4329_wlan_irq"); -+ else -+ wifi_wake_gpio = wifi_irqres->start; -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ printk("%s: gpio:%d wifi_wake_gpio:%d\n", __func__, -+ wifi_irqres->start, wifi_wake_gpio); -+ -+ if (wifi_wake_gpio > 0) { -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ wifi_configure_gpio(); -+#else //CONFIG_PLATFORM_INTEL_BYT -+ gpio_request(wifi_wake_gpio, "oob_irq"); -+ gpio_direction_input(wifi_wake_gpio); -+ oob_irq = gpio_to_irq(wifi_wake_gpio); -+#endif //CONFIG_PLATFORM_INTEL_BYT -+ printk("%s oob_irq:%d\n", __func__, oob_irq); -+ } -+ else if(wifi_irqres) -+ { -+ oob_irq = wifi_irqres->start; -+ printk("%s oob_irq:%d\n", __func__, oob_irq); -+ } -+#endif + wifi_control_data = wifi_ctrl; + + wifi_set_power(1, 0); /* Power On */ @@ -373587,75 +180134,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + return 0; +} + -+#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN -+extern PADAPTER g_test_adapter; -+ -+static void shutdown_card(void) -+{ -+ u32 addr; -+ u8 tmp8, cnt=0; -+ -+ if (NULL == g_test_adapter) -+ { -+ DBG_871X("%s: padapter==NULL\n", __FUNCTION__); -+ return; -+ } -+ -+#ifdef CONFIG_FWLPS_IN_IPS -+ LeaveAllPowerSaveMode(g_test_adapter); -+#endif // CONFIG_FWLPS_IN_IPS -+ -+ // Leave SDIO HCI Suspend -+ addr = 0x10250086; -+ rtw_write8(g_test_adapter, addr, 0); -+ do { -+ tmp8 = rtw_read8(g_test_adapter, addr); -+ cnt++; -+ DBG_871X(FUNC_ADPT_FMT ": polling SDIO_HSUS_CTRL(0x%x)=0x%x, cnt=%d\n", -+ FUNC_ADPT_ARG(g_test_adapter), addr, tmp8, cnt); -+ -+ if (tmp8 & BIT(1)) -+ break; -+ -+ if (cnt >= 100) -+ { -+ DBG_871X(FUNC_ADPT_FMT ": polling 0x%x[1]==1 FAIL!!\n", -+ FUNC_ADPT_ARG(g_test_adapter), addr); -+ break; -+ } -+ -+ rtw_mdelay_os(10); -+ } while (1); -+ -+ // unlock register I/O -+ rtw_write8(g_test_adapter, 0x1C, 0); -+ -+ // enable power down function -+ // 0x04[4] = 1 -+ // 0x05[7] = 1 -+ addr = 0x04; -+ tmp8 = rtw_read8(g_test_adapter, addr); -+ tmp8 |= BIT(4); -+ rtw_write8(g_test_adapter, addr, tmp8); -+ DBG_871X(FUNC_ADPT_FMT ": read after write 0x%x=0x%x\n", -+ FUNC_ADPT_ARG(g_test_adapter), addr, rtw_read8(g_test_adapter, addr)); -+ -+ addr = 0x05; -+ tmp8 = rtw_read8(g_test_adapter, addr); -+ tmp8 |= BIT(7); -+ rtw_write8(g_test_adapter, addr, tmp8); -+ DBG_871X(FUNC_ADPT_FMT ": read after write 0x%x=0x%x\n", -+ FUNC_ADPT_ARG(g_test_adapter), addr, rtw_read8(g_test_adapter, addr)); -+ -+ // lock register page0 0x0~0xB read/write -+ rtw_write8(g_test_adapter, 0x1C, 0x0E); -+ -+ rtw_set_surprise_removed(g_test_adapter); -+ DBG_871X(FUNC_ADPT_FMT ": bSurpriseRemoved=%s\n", -+ FUNC_ADPT_ARG(g_test_adapter), rtw_is_surprise_removed(g_test_adapter)?"True":"False"); -+} -+#endif // RTW_SUPPORT_PLATFORM_SHUTDOWN -+ +static int wifi_remove(struct platform_device *pdev) +{ + struct wifi_platform_data *wifi_ctrl = @@ -373671,23 +180149,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + return 0; +} + -+#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN -+static void wifi_shutdown(struct platform_device *pdev) -+{ -+ struct wifi_platform_data *wifi_ctrl = -+ (struct wifi_platform_data *)(pdev->dev.platform_data); -+ -+ -+ DBG_871X("## %s\n", __FUNCTION__); -+ -+ wifi_control_data = wifi_ctrl; -+ -+ shutdown_card(); -+ wifi_set_power(0, 0); /* Power Off */ -+ wifi_set_carddetect(0); /* CardDetect (1->0) */ -+} -+#endif // RTW_SUPPORT_PLATFORM_SHUTDOWN -+ +static int wifi_suspend(struct platform_device *pdev, pm_message_t state) +{ + DBG_871X("##> %s\n", __FUNCTION__); @@ -373713,9 +180174,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + .remove = wifi_remove, + .suspend = wifi_suspend, + .resume = wifi_resume, -+#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN -+ .shutdown = wifi_shutdown, -+#endif // RTW_SUPPORT_PLATFORM_SHUTDOWN + .driver = { + .name = "bcmdhd_wlan", + } @@ -373746,3419 +180204,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_android.c linux/3rdpart + platform_driver_unregister(&wifi_device_legacy); +} +#endif /* defined(RTW_ENABLE_WIFI_CONTROL_FUNC) */ -+ -+#ifdef CONFIG_GPIO_WAKEUP -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+int wifi_configure_gpio(void) -+{ -+ if (gpio_request(oob_gpio, "oob_irq")) { -+ DBG_871X("## %s Cannot request GPIO\n", __FUNCTION__); -+ return -1; -+ } -+ gpio_export(oob_gpio, 0); -+ if (gpio_direction_input(oob_gpio)) { -+ DBG_871X("## %s Cannot set GPIO direction input\n", __FUNCTION__); -+ return -1; -+ } -+ if ((oob_irq = gpio_to_irq(oob_gpio)) < 0) { -+ DBG_871X("## %s Cannot convert GPIO to IRQ\n", __FUNCTION__); -+ return -1; -+ } -+ -+ DBG_871X("## %s OOB_IRQ=%d\n", __FUNCTION__, oob_irq); -+ -+ return 0; -+} -+#endif //CONFIG_PLATFORM_INTEL_BYT -+void wifi_free_gpio(unsigned int gpio) -+{ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ if(gpio) -+ gpio_free(gpio); -+#endif //CONFIG_PLATFORM_INTEL_BYT -+} -+#endif //CONFIG_GPIO_WAKEUP -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_cfgvendor.c linux/3rdparty/rtl8812au/os_dep/linux/rtw_cfgvendor.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_cfgvendor.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/rtw_cfgvendor.c 2017-06-07 23:07:21.047690856 +0300 -@@ -0,0 +1,1340 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2014 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) -+ -+/* -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+*/ -+ -+#include -+ -+#ifdef DBG_MEM_ALLOC -+extern bool match_mstat_sniff_rules(const enum mstat_f flags, const size_t size); -+struct sk_buff *dbg_rtw_cfg80211_vendor_event_alloc(struct wiphy *wiphy, int len, int event_id, gfp_t gfp -+ , const enum mstat_f flags, const char *func, const int line) -+{ -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct wireless_dev *wdev = padapter->rtw_wdev; -+ -+ struct sk_buff *skb; -+ unsigned int truesize = 0; -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 1, 0)) -+ skb = cfg80211_vendor_event_alloc(wiphy, len, event_id, gfp); -+#else -+ skb = cfg80211_vendor_event_alloc(wiphy, wdev, len, event_id, gfp); -+#endif -+ -+ if(skb) -+ truesize = skb->truesize; -+ -+ if(!skb || truesize < len || match_mstat_sniff_rules(flags, truesize)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s(%d), skb:%p, truesize=%u\n", func, line, __FUNCTION__, len, skb, truesize); -+ -+ rtw_mstat_update( -+ flags -+ , skb ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , truesize -+ ); -+ -+ return skb; -+} -+ -+void dbg_rtw_cfg80211_vendor_event(struct sk_buff *skb, gfp_t gfp -+ , const enum mstat_f flags, const char *func, const int line) -+{ -+ unsigned int truesize = skb->truesize; -+ -+ if(match_mstat_sniff_rules(flags, truesize)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); -+ -+ cfg80211_vendor_event(skb, gfp); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , truesize -+ ); -+} -+ -+struct sk_buff *dbg_rtw_cfg80211_vendor_cmd_alloc_reply_skb(struct wiphy *wiphy, int len -+ , const enum mstat_f flags, const char *func, const int line) -+{ -+ struct sk_buff *skb; -+ unsigned int truesize = 0; -+ -+ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len); -+ -+ if(skb) -+ truesize = skb->truesize; -+ -+ if(!skb || truesize < len || match_mstat_sniff_rules(flags, truesize)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s(%d), skb:%p, truesize=%u\n", func, line, __FUNCTION__, len, skb, truesize); -+ -+ rtw_mstat_update( -+ flags -+ , skb ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , truesize -+ ); -+ -+ return skb; -+} -+ -+int dbg_rtw_cfg80211_vendor_cmd_reply(struct sk_buff *skb -+ , const enum mstat_f flags, const char *func, const int line) -+{ -+ unsigned int truesize = skb->truesize; -+ int ret; -+ -+ if(match_mstat_sniff_rules(flags, truesize)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); -+ -+ ret = cfg80211_vendor_cmd_reply(skb); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , truesize -+ ); -+ -+ return ret; -+} -+ -+#define rtw_cfg80211_vendor_event_alloc(wiphy, len, event_id, gfp) \ -+ dbg_rtw_cfg80211_vendor_event_alloc(wiphy, len, event_id, gfp, MSTAT_FUNC_CFG_VENDOR|MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+ -+#define rtw_cfg80211_vendor_event(skb, gfp) \ -+ dbg_rtw_cfg80211_vendor_event(skb, gfp, MSTAT_FUNC_CFG_VENDOR|MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+ -+#define rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len) \ -+ dbg_rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len, MSTAT_FUNC_CFG_VENDOR|MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+ -+#define rtw_cfg80211_vendor_cmd_reply(skb) \ -+ dbg_rtw_cfg80211_vendor_cmd_reply(skb, MSTAT_FUNC_CFG_VENDOR|MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#else -+ -+struct sk_buff *rtw_cfg80211_vendor_event_alloc( -+ struct wiphy *wiphy, int len, int event_id, gfp_t gfp) -+{ -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct wireless_dev *wdev = padapter->rtw_wdev; -+ struct sk_buff *skb; -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 1, 0)) -+ skb = cfg80211_vendor_event_alloc(wiphy, len, event_id, gfp); -+#else -+ skb = cfg80211_vendor_event_alloc(wiphy, wdev, len, event_id, gfp); -+#endif -+ return skb; -+} -+ -+#define rtw_cfg80211_vendor_event(skb, gfp) \ -+ cfg80211_vendor_event(skb, gfp) -+ -+#define rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len) \ -+ cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len) -+ -+#define rtw_cfg80211_vendor_cmd_reply(skb) \ -+ cfg80211_vendor_cmd_reply(skb) -+#endif /* DBG_MEM_ALLOC */ -+ -+/* -+ * This API is to be used for asynchronous vendor events. This -+ * shouldn't be used in response to a vendor command from its -+ * do_it handler context (instead rtw_cfgvendor_send_cmd_reply should -+ * be used). -+ */ -+int rtw_cfgvendor_send_async_event(struct wiphy *wiphy, -+ struct net_device *dev, int event_id, const void *data, int len) -+{ -+ u16 kflags; -+ struct sk_buff *skb; -+ -+ kflags = in_atomic() ? GFP_ATOMIC : GFP_KERNEL; -+ -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_event_alloc(wiphy, len, event_id, kflags); -+ if (!skb) { -+ DBG_871X_LEVEL(_drv_err_, FUNC_NDEV_FMT" skb alloc failed", FUNC_NDEV_ARG(dev)); -+ return -ENOMEM; -+ } -+ -+ /* Push the data to the skb */ -+ nla_put_nohdr(skb, len, data); -+ -+ rtw_cfg80211_vendor_event(skb, kflags); -+ -+ return 0; -+} -+ -+static int rtw_cfgvendor_send_cmd_reply(struct wiphy *wiphy, -+ struct net_device *dev, const void *data, int len) -+{ -+ struct sk_buff *skb; -+ -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len); -+ if (unlikely(!skb)) { -+ DBG_871X_LEVEL(_drv_err_, FUNC_NDEV_FMT" skb alloc failed", FUNC_NDEV_ARG(dev)); -+ return -ENOMEM; -+ } -+ -+ /* Push the data to the skb */ -+ nla_put_nohdr(skb, len, data); -+ -+ return rtw_cfg80211_vendor_cmd_reply(skb); -+} -+ -+#define WIFI_FEATURE_INFRA 0x0001 /* Basic infrastructure mode */ -+#define WIFI_FEATURE_INFRA_5G 0x0002 /* Support for 5 GHz Band */ -+#define WIFI_FEATURE_HOTSPOT 0x0004 /* Support for GAS/ANQP */ -+#define WIFI_FEATURE_P2P 0x0008 /* Wifi-Direct */ -+#define WIFI_FEATURE_SOFT_AP 0x0010 /* Soft AP */ -+#define WIFI_FEATURE_GSCAN 0x0020 /* Google-Scan APIs */ -+#define WIFI_FEATURE_NAN 0x0040 /* Neighbor Awareness Networking */ -+#define WIFI_FEATURE_D2D_RTT 0x0080 /* Device-to-device RTT */ -+#define WIFI_FEATURE_D2AP_RTT 0x0100 /* Device-to-AP RTT */ -+#define WIFI_FEATURE_BATCH_SCAN 0x0200 /* Batched Scan (legacy) */ -+#define WIFI_FEATURE_PNO 0x0400 /* Preferred network offload */ -+#define WIFI_FEATURE_ADDITIONAL_STA 0x0800 /* Support for two STAs */ -+#define WIFI_FEATURE_TDLS 0x1000 /* Tunnel directed link setup */ -+#define WIFI_FEATURE_TDLS_OFFCHANNEL 0x2000 /* Support for TDLS off channel */ -+#define WIFI_FEATURE_EPR 0x4000 /* Enhanced power reporting */ -+#define WIFI_FEATURE_AP_STA 0x8000 /* Support for AP STA Concurrency */ -+ -+#define MAX_FEATURE_SET_CONCURRRENT_GROUPS 3 -+ -+#include -+int rtw_dev_get_feature_set(struct net_device *dev) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); -+ HAL_VERSION *hal_ver = &HalData->VersionID; -+ -+ int feature_set = 0; -+ -+ feature_set |= WIFI_FEATURE_INFRA; -+ -+ if (IS_8814A_SERIES(*hal_ver) || IS_8812_SERIES(*hal_ver) || -+ IS_8821_SERIES(*hal_ver)) -+ feature_set |= WIFI_FEATURE_INFRA_5G; -+ -+ feature_set |= WIFI_FEATURE_P2P; -+ feature_set |= WIFI_FEATURE_SOFT_AP; -+ -+ feature_set |= WIFI_FEATURE_ADDITIONAL_STA; -+ -+ return feature_set; -+} -+ -+int *rtw_dev_get_feature_set_matrix(struct net_device *dev, int *num) -+{ -+ int feature_set_full, mem_needed; -+ int *ret; -+ -+ *num = 0; -+ mem_needed = sizeof(int) * MAX_FEATURE_SET_CONCURRRENT_GROUPS; -+ ret = (int *)rtw_malloc(mem_needed); -+ -+ if (!ret) { -+ DBG_871X_LEVEL(_drv_err_, FUNC_NDEV_FMT" failed to allocate %d bytes\n" -+ , FUNC_NDEV_ARG(dev), mem_needed); -+ return ret; -+ } -+ -+ feature_set_full = rtw_dev_get_feature_set(dev); -+ -+ ret[0] = (feature_set_full & WIFI_FEATURE_INFRA) | -+ (feature_set_full & WIFI_FEATURE_INFRA_5G) | -+ (feature_set_full & WIFI_FEATURE_NAN) | -+ (feature_set_full & WIFI_FEATURE_D2D_RTT) | -+ (feature_set_full & WIFI_FEATURE_D2AP_RTT) | -+ (feature_set_full & WIFI_FEATURE_PNO) | -+ (feature_set_full & WIFI_FEATURE_BATCH_SCAN) | -+ (feature_set_full & WIFI_FEATURE_GSCAN) | -+ (feature_set_full & WIFI_FEATURE_HOTSPOT) | -+ (feature_set_full & WIFI_FEATURE_ADDITIONAL_STA) | -+ (feature_set_full & WIFI_FEATURE_EPR); -+ -+ ret[1] = (feature_set_full & WIFI_FEATURE_INFRA) | -+ (feature_set_full & WIFI_FEATURE_INFRA_5G) | -+ /* Not yet verified NAN with P2P */ -+ /* (feature_set_full & WIFI_FEATURE_NAN) | */ -+ (feature_set_full & WIFI_FEATURE_P2P) | -+ (feature_set_full & WIFI_FEATURE_D2AP_RTT) | -+ (feature_set_full & WIFI_FEATURE_D2D_RTT) | -+ (feature_set_full & WIFI_FEATURE_EPR); -+ -+ ret[2] = (feature_set_full & WIFI_FEATURE_INFRA) | -+ (feature_set_full & WIFI_FEATURE_INFRA_5G) | -+ (feature_set_full & WIFI_FEATURE_NAN) | -+ (feature_set_full & WIFI_FEATURE_D2D_RTT) | -+ (feature_set_full & WIFI_FEATURE_D2AP_RTT) | -+ (feature_set_full & WIFI_FEATURE_TDLS) | -+ (feature_set_full & WIFI_FEATURE_TDLS_OFFCHANNEL) | -+ (feature_set_full & WIFI_FEATURE_EPR); -+ *num = MAX_FEATURE_SET_CONCURRRENT_GROUPS; -+ -+ return ret; -+} -+ -+static int rtw_cfgvendor_get_feature_set(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ int reply; -+ -+ reply = rtw_dev_get_feature_set(wdev_to_ndev(wdev)); -+ -+ err = rtw_cfgvendor_send_cmd_reply(wiphy, wdev_to_ndev(wdev), &reply, sizeof(int)); -+ -+ if (unlikely(err)) -+ DBG_871X_LEVEL(_drv_err_, FUNC_NDEV_FMT" Vendor Command reply failed ret:%d \n" -+ , FUNC_NDEV_ARG(wdev_to_ndev(wdev)), err); -+ -+ return err; -+} -+ -+static int rtw_cfgvendor_get_feature_set_matrix(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct sk_buff *skb; -+ int *reply; -+ int num, mem_needed, i; -+ -+ reply = rtw_dev_get_feature_set_matrix(wdev_to_ndev(wdev), &num); -+ -+ if (!reply) { -+ DBG_871X_LEVEL(_drv_err_, FUNC_NDEV_FMT" Could not get feature list matrix\n" -+ , FUNC_NDEV_ARG(wdev_to_ndev(wdev))); -+ err = -EINVAL; -+ return err; -+ } -+ -+ mem_needed = VENDOR_REPLY_OVERHEAD + (ATTRIBUTE_U32_LEN * num) + -+ ATTRIBUTE_U32_LEN; -+ -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, mem_needed); -+ if (unlikely(!skb)) { -+ DBG_871X_LEVEL(_drv_err_, FUNC_NDEV_FMT" skb alloc failed", FUNC_NDEV_ARG(wdev_to_ndev(wdev))); -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ nla_put_u32(skb, ANDR_WIFI_ATTRIBUTE_NUM_FEATURE_SET, num); -+ for (i = 0; i < num; i++) { -+ nla_put_u32(skb, ANDR_WIFI_ATTRIBUTE_FEATURE_SET, reply[i]); -+ } -+ -+ err = rtw_cfg80211_vendor_cmd_reply(skb); -+ -+ if (unlikely(err)) -+ DBG_871X_LEVEL(_drv_err_, FUNC_NDEV_FMT" Vendor Command reply failed ret:%d \n" -+ , FUNC_NDEV_ARG(wdev_to_ndev(wdev)), err); -+exit: -+ rtw_mfree((u8*)reply, sizeof(int)*num); -+ return err; -+} -+ -+#if defined(GSCAN_SUPPORT) && 0 -+int wl_cfgvendor_send_hotlist_event(struct wiphy *wiphy, -+ struct net_device *dev, void *data, int len, wl_vendor_event_t event) -+{ -+ u16 kflags; -+ const void *ptr; -+ struct sk_buff *skb; -+ int malloc_len, total, iter_cnt_to_send, cnt; -+ gscan_results_cache_t *cache = (gscan_results_cache_t *)data; -+ -+ total = len/sizeof(wifi_gscan_result_t); -+ while (total > 0) { -+ malloc_len = (total * sizeof(wifi_gscan_result_t)) + VENDOR_DATA_OVERHEAD; -+ if (malloc_len > NLMSG_DEFAULT_SIZE) { -+ malloc_len = NLMSG_DEFAULT_SIZE; -+ } -+ iter_cnt_to_send = -+ (malloc_len - VENDOR_DATA_OVERHEAD)/sizeof(wifi_gscan_result_t); -+ total = total - iter_cnt_to_send; -+ -+ kflags = in_atomic() ? GFP_ATOMIC : GFP_KERNEL; -+ -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_event_alloc(wiphy, malloc_len, event, kflags); -+ if (!skb) { -+ WL_ERR(("skb alloc failed")); -+ return -ENOMEM; -+ } -+ -+ while (cache && iter_cnt_to_send) { -+ ptr = (const void *) &cache->results[cache->tot_consumed]; -+ -+ if (iter_cnt_to_send < (cache->tot_count - cache->tot_consumed)) -+ cnt = iter_cnt_to_send; -+ else -+ cnt = (cache->tot_count - cache->tot_consumed); -+ -+ iter_cnt_to_send -= cnt; -+ cache->tot_consumed += cnt; -+ /* Push the data to the skb */ -+ nla_append(skb, cnt * sizeof(wifi_gscan_result_t), ptr); -+ if (cache->tot_consumed == cache->tot_count) -+ cache = cache->next; -+ -+ } -+ -+ rtw_cfg80211_vendor_event(skb, kflags); -+ } -+ -+ return 0; -+} -+ -+ -+static int wl_cfgvendor_gscan_get_capabilities(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ dhd_pno_gscan_capabilities_t *reply = NULL; -+ uint32 reply_len = 0; -+ -+ -+ reply = dhd_dev_pno_get_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_GET_CAPABILITIES, NULL, &reply_len); -+ if (!reply) { -+ WL_ERR(("Could not get capabilities\n")); -+ err = -EINVAL; -+ return err; -+ } -+ -+ err = rtw_cfgvendor_send_cmd_reply(wiphy, bcmcfg_to_prmry_ndev(cfg), -+ reply, reply_len); -+ -+ if (unlikely(err)) -+ WL_ERR(("Vendor Command reply failed ret:%d \n", err)); -+ -+ kfree(reply); -+ return err; -+} -+ -+static int wl_cfgvendor_gscan_get_channel_list(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0, type, band; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ uint16 *reply = NULL; -+ uint32 reply_len = 0, num_channels, mem_needed; -+ struct sk_buff *skb; -+ -+ type = nla_type(data); -+ -+ if (type == GSCAN_ATTRIBUTE_BAND) { -+ band = nla_get_u32(data); -+ } else { -+ return -1; -+ } -+ -+ reply = dhd_dev_pno_get_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_GET_CHANNEL_LIST, &band, &reply_len); -+ -+ if (!reply) { -+ WL_ERR(("Could not get channel list\n")); -+ err = -EINVAL; -+ return err; -+ } -+ num_channels = reply_len/ sizeof(uint32); -+ mem_needed = reply_len + VENDOR_REPLY_OVERHEAD + (ATTRIBUTE_U32_LEN * 2); -+ -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, mem_needed); -+ if (unlikely(!skb)) { -+ WL_ERR(("skb alloc failed")); -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ nla_put_u32(skb, GSCAN_ATTRIBUTE_NUM_CHANNELS, num_channels); -+ nla_put(skb, GSCAN_ATTRIBUTE_CHANNEL_LIST, reply_len, reply); -+ -+ err = rtw_cfg80211_vendor_cmd_reply(skb); -+ -+ if (unlikely(err)) -+ WL_ERR(("Vendor Command reply failed ret:%d \n", err)); -+exit: -+ kfree(reply); -+ return err; -+} -+ -+static int wl_cfgvendor_gscan_get_batch_results(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ gscan_results_cache_t *results, *iter; -+ uint32 reply_len, complete = 0, num_results_iter; -+ int32 mem_needed; -+ wifi_gscan_result_t *ptr; -+ uint16 num_scan_ids, num_results; -+ struct sk_buff *skb; -+ struct nlattr *scan_hdr; -+ -+ dhd_dev_wait_batch_results_complete(bcmcfg_to_prmry_ndev(cfg)); -+ dhd_dev_pno_lock_access_batch_results(bcmcfg_to_prmry_ndev(cfg)); -+ results = dhd_dev_pno_get_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_GET_BATCH_RESULTS, NULL, &reply_len); -+ -+ if (!results) { -+ WL_ERR(("No results to send %d\n", err)); -+ err = rtw_cfgvendor_send_cmd_reply(wiphy, bcmcfg_to_prmry_ndev(cfg), -+ results, 0); -+ -+ if (unlikely(err)) -+ WL_ERR(("Vendor Command reply failed ret:%d \n", err)); -+ dhd_dev_pno_unlock_access_batch_results(bcmcfg_to_prmry_ndev(cfg)); -+ return err; -+ } -+ num_scan_ids = reply_len & 0xFFFF; -+ num_results = (reply_len & 0xFFFF0000) >> 16; -+ mem_needed = (num_results * sizeof(wifi_gscan_result_t)) + -+ (num_scan_ids * GSCAN_BATCH_RESULT_HDR_LEN) + -+ VENDOR_REPLY_OVERHEAD + SCAN_RESULTS_COMPLETE_FLAG_LEN; -+ -+ if (mem_needed > (int32)NLMSG_DEFAULT_SIZE) { -+ mem_needed = (int32)NLMSG_DEFAULT_SIZE; -+ complete = 0; -+ } else { -+ complete = 1; -+ } -+ -+ WL_TRACE(("complete %d mem_needed %d max_mem %d\n", complete, mem_needed, -+ (int)NLMSG_DEFAULT_SIZE)); -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, mem_needed); -+ if (unlikely(!skb)) { -+ WL_ERR(("skb alloc failed")); -+ dhd_dev_pno_unlock_access_batch_results(bcmcfg_to_prmry_ndev(cfg)); -+ return -ENOMEM; -+ } -+ iter = results; -+ -+ nla_put_u32(skb, GSCAN_ATTRIBUTE_SCAN_RESULTS_COMPLETE, complete); -+ -+ mem_needed = mem_needed - (SCAN_RESULTS_COMPLETE_FLAG_LEN + VENDOR_REPLY_OVERHEAD); -+ -+ while (iter && ((mem_needed - GSCAN_BATCH_RESULT_HDR_LEN) > 0)) { -+ scan_hdr = nla_nest_start(skb, GSCAN_ATTRIBUTE_SCAN_RESULTS); -+ nla_put_u32(skb, GSCAN_ATTRIBUTE_SCAN_ID, iter->scan_id); -+ nla_put_u8(skb, GSCAN_ATTRIBUTE_SCAN_FLAGS, iter->flag); -+ num_results_iter = -+ (mem_needed - GSCAN_BATCH_RESULT_HDR_LEN)/sizeof(wifi_gscan_result_t); -+ -+ if ((iter->tot_count - iter->tot_consumed) < num_results_iter) -+ num_results_iter = iter->tot_count - iter->tot_consumed; -+ -+ nla_put_u32(skb, GSCAN_ATTRIBUTE_NUM_OF_RESULTS, num_results_iter); -+ if (num_results_iter) { -+ ptr = &iter->results[iter->tot_consumed]; -+ iter->tot_consumed += num_results_iter; -+ nla_put(skb, GSCAN_ATTRIBUTE_SCAN_RESULTS, -+ num_results_iter * sizeof(wifi_gscan_result_t), ptr); -+ } -+ nla_nest_end(skb, scan_hdr); -+ mem_needed -= GSCAN_BATCH_RESULT_HDR_LEN + -+ (num_results_iter * sizeof(wifi_gscan_result_t)); -+ iter = iter->next; -+ } -+ -+ dhd_dev_gscan_batch_cache_cleanup(bcmcfg_to_prmry_ndev(cfg)); -+ dhd_dev_pno_unlock_access_batch_results(bcmcfg_to_prmry_ndev(cfg)); -+ -+ return rtw_cfg80211_vendor_cmd_reply(skb); -+} -+ -+static int wl_cfgvendor_initiate_gscan(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ int type, tmp = len; -+ int run = 0xFF; -+ int flush = 0; -+ const struct nlattr *iter; -+ -+ nla_for_each_attr(iter, data, len, tmp) { -+ type = nla_type(iter); -+ if (type == GSCAN_ATTRIBUTE_ENABLE_FEATURE) -+ run = nla_get_u32(iter); -+ else if (type == GSCAN_ATTRIBUTE_FLUSH_FEATURE) -+ flush = nla_get_u32(iter); -+ } -+ -+ if (run != 0xFF) { -+ err = dhd_dev_pno_run_gscan(bcmcfg_to_prmry_ndev(cfg), run, flush); -+ -+ if (unlikely(err)) -+ WL_ERR(("Could not run gscan:%d \n", err)); -+ return err; -+ } else { -+ return -1; -+ } -+ -+ -+} -+ -+static int wl_cfgvendor_enable_full_scan_result(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ int type; -+ bool real_time = FALSE; -+ -+ type = nla_type(data); -+ -+ if (type == GSCAN_ATTRIBUTE_ENABLE_FULL_SCAN_RESULTS) { -+ real_time = nla_get_u32(data); -+ -+ err = dhd_dev_pno_enable_full_scan_result(bcmcfg_to_prmry_ndev(cfg), real_time); -+ -+ if (unlikely(err)) -+ WL_ERR(("Could not run gscan:%d \n", err)); -+ -+ } else { -+ err = -1; -+ } -+ -+ return err; -+} -+ -+static int wl_cfgvendor_set_scan_cfg(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ gscan_scan_params_t *scan_param; -+ int j = 0; -+ int type, tmp, tmp1, tmp2, k = 0; -+ const struct nlattr *iter, *iter1, *iter2; -+ struct dhd_pno_gscan_channel_bucket *ch_bucket; -+ -+ scan_param = kzalloc(sizeof(gscan_scan_params_t), GFP_KERNEL); -+ if (!scan_param) { -+ WL_ERR(("Could not set GSCAN scan cfg, mem alloc failure\n")); -+ err = -EINVAL; -+ return err; -+ -+ } -+ -+ scan_param->scan_fr = PNO_SCAN_MIN_FW_SEC; -+ nla_for_each_attr(iter, data, len, tmp) { -+ type = nla_type(iter); -+ -+ if (j >= GSCAN_MAX_CH_BUCKETS) -+ break; -+ -+ switch (type) { -+ case GSCAN_ATTRIBUTE_BASE_PERIOD: -+ scan_param->scan_fr = nla_get_u32(iter)/1000; -+ break; -+ case GSCAN_ATTRIBUTE_NUM_BUCKETS: -+ scan_param->nchannel_buckets = nla_get_u32(iter); -+ break; -+ case GSCAN_ATTRIBUTE_CH_BUCKET_1: -+ case GSCAN_ATTRIBUTE_CH_BUCKET_2: -+ case GSCAN_ATTRIBUTE_CH_BUCKET_3: -+ case GSCAN_ATTRIBUTE_CH_BUCKET_4: -+ case GSCAN_ATTRIBUTE_CH_BUCKET_5: -+ case GSCAN_ATTRIBUTE_CH_BUCKET_6: -+ case GSCAN_ATTRIBUTE_CH_BUCKET_7: -+ nla_for_each_nested(iter1, iter, tmp1) { -+ type = nla_type(iter1); -+ ch_bucket = -+ scan_param->channel_bucket; -+ -+ switch (type) { -+ case GSCAN_ATTRIBUTE_BUCKET_ID: -+ break; -+ case GSCAN_ATTRIBUTE_BUCKET_PERIOD: -+ ch_bucket[j].bucket_freq_multiple = -+ nla_get_u32(iter1)/1000; -+ break; -+ case GSCAN_ATTRIBUTE_BUCKET_NUM_CHANNELS: -+ ch_bucket[j].num_channels = -+ nla_get_u32(iter1); -+ break; -+ case GSCAN_ATTRIBUTE_BUCKET_CHANNELS: -+ nla_for_each_nested(iter2, iter1, tmp2) { -+ if (k >= PFN_SWC_RSSI_WINDOW_MAX) -+ break; -+ ch_bucket[j].chan_list[k] = -+ nla_get_u32(iter2); -+ k++; -+ } -+ k = 0; -+ break; -+ case GSCAN_ATTRIBUTE_BUCKETS_BAND: -+ ch_bucket[j].band = (uint16) -+ nla_get_u32(iter1); -+ break; -+ case GSCAN_ATTRIBUTE_REPORT_EVENTS: -+ ch_bucket[j].report_flag = (uint8) -+ nla_get_u32(iter1); -+ break; -+ } -+ } -+ j++; -+ break; -+ } -+ } -+ -+ if (dhd_dev_pno_set_cfg_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_SCAN_CFG_ID, scan_param, 0) < 0) { -+ WL_ERR(("Could not set GSCAN scan cfg\n")); -+ err = -EINVAL; -+ } -+ -+ kfree(scan_param); -+ return err; -+ -+} -+ -+static int wl_cfgvendor_hotlist_cfg(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ gscan_hotlist_scan_params_t *hotlist_params; -+ int tmp, tmp1, tmp2, type, j = 0, dummy; -+ const struct nlattr *outer, *inner, *iter; -+ uint8 flush = 0; -+ struct bssid_t *pbssid; -+ -+ hotlist_params = (gscan_hotlist_scan_params_t *)kzalloc(len, GFP_KERNEL); -+ if (!hotlist_params) { -+ WL_ERR(("Cannot Malloc mem to parse config commands size - %d bytes \n", len)); -+ return -1; -+ } -+ -+ hotlist_params->lost_ap_window = GSCAN_LOST_AP_WINDOW_DEFAULT; -+ -+ nla_for_each_attr(iter, data, len, tmp2) { -+ type = nla_type(iter); -+ switch (type) { -+ case GSCAN_ATTRIBUTE_HOTLIST_BSSIDS: -+ pbssid = hotlist_params->bssid; -+ nla_for_each_nested(outer, iter, tmp) { -+ nla_for_each_nested(inner, outer, tmp1) { -+ type = nla_type(inner); -+ -+ switch (type) { -+ case GSCAN_ATTRIBUTE_BSSID: -+ memcpy(&(pbssid[j].macaddr), -+ nla_data(inner), ETHER_ADDR_LEN); -+ break; -+ case GSCAN_ATTRIBUTE_RSSI_LOW: -+ pbssid[j].rssi_reporting_threshold = -+ (int8) nla_get_u8(inner); -+ break; -+ case GSCAN_ATTRIBUTE_RSSI_HIGH: -+ dummy = (int8) nla_get_u8(inner); -+ break; -+ } -+ } -+ j++; -+ } -+ hotlist_params->nbssid = j; -+ break; -+ case GSCAN_ATTRIBUTE_HOTLIST_FLUSH: -+ flush = nla_get_u8(iter); -+ break; -+ case GSCAN_ATTRIBUTE_LOST_AP_SAMPLE_SIZE: -+ hotlist_params->lost_ap_window = nla_get_u32(iter); -+ break; -+ } -+ -+ } -+ -+ if (dhd_dev_pno_set_cfg_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_GEOFENCE_SCAN_CFG_ID, hotlist_params, flush) < 0) { -+ WL_ERR(("Could not set GSCAN HOTLIST cfg\n")); -+ err = -EINVAL; -+ goto exit; -+ } -+exit: -+ kfree(hotlist_params); -+ return err; -+} -+static int wl_cfgvendor_set_batch_scan_cfg(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0, tmp, type; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ gscan_batch_params_t batch_param; -+ const struct nlattr *iter; -+ -+ batch_param.mscan = batch_param.bestn = 0; -+ batch_param.buffer_threshold = GSCAN_BATCH_NO_THR_SET; -+ -+ nla_for_each_attr(iter, data, len, tmp) { -+ type = nla_type(iter); -+ -+ switch (type) { -+ case GSCAN_ATTRIBUTE_NUM_AP_PER_SCAN: -+ batch_param.bestn = nla_get_u32(iter); -+ break; -+ case GSCAN_ATTRIBUTE_NUM_SCANS_TO_CACHE: -+ batch_param.mscan = nla_get_u32(iter); -+ break; -+ case GSCAN_ATTRIBUTE_REPORT_THRESHOLD: -+ batch_param.buffer_threshold = nla_get_u32(iter); -+ break; -+ } -+ } -+ -+ if (dhd_dev_pno_set_cfg_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_BATCH_SCAN_CFG_ID, &batch_param, 0) < 0) { -+ WL_ERR(("Could not set batch cfg\n")); -+ err = -EINVAL; -+ return err; -+ } -+ -+ return err; -+} -+ -+static int wl_cfgvendor_significant_change_cfg(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ gscan_swc_params_t *significant_params; -+ int tmp, tmp1, tmp2, type, j = 0; -+ const struct nlattr *outer, *inner, *iter; -+ uint8 flush = 0; -+ wl_pfn_significant_bssid_t *pbssid; -+ -+ significant_params = (gscan_swc_params_t *) kzalloc(len, GFP_KERNEL); -+ if (!significant_params) { -+ WL_ERR(("Cannot Malloc mem to parse config commands size - %d bytes \n", len)); -+ return -1; -+ } -+ -+ -+ nla_for_each_attr(iter, data, len, tmp2) { -+ type = nla_type(iter); -+ -+ switch (type) { -+ case GSCAN_ATTRIBUTE_SIGNIFICANT_CHANGE_FLUSH: -+ flush = nla_get_u8(iter); -+ break; -+ case GSCAN_ATTRIBUTE_RSSI_SAMPLE_SIZE: -+ significant_params->rssi_window = nla_get_u16(iter); -+ break; -+ case GSCAN_ATTRIBUTE_LOST_AP_SAMPLE_SIZE: -+ significant_params->lost_ap_window = nla_get_u16(iter); -+ break; -+ case GSCAN_ATTRIBUTE_MIN_BREACHING: -+ significant_params->swc_threshold = nla_get_u16(iter); -+ break; -+ case GSCAN_ATTRIBUTE_SIGNIFICANT_CHANGE_BSSIDS: -+ pbssid = significant_params->bssid_elem_list; -+ nla_for_each_nested(outer, iter, tmp) { -+ nla_for_each_nested(inner, outer, tmp1) { -+ switch (nla_type(inner)) { -+ case GSCAN_ATTRIBUTE_BSSID: -+ memcpy(&(pbssid[j].macaddr), -+ nla_data(inner), -+ ETHER_ADDR_LEN); -+ break; -+ case GSCAN_ATTRIBUTE_RSSI_HIGH: -+ pbssid[j].rssi_high_threshold = -+ (int8) nla_get_u8(inner); -+ break; -+ case GSCAN_ATTRIBUTE_RSSI_LOW: -+ pbssid[j].rssi_low_threshold = -+ (int8) nla_get_u8(inner); -+ break; -+ } -+ } -+ j++; -+ } -+ break; -+ } -+ } -+ significant_params->nbssid = j; -+ -+ if (dhd_dev_pno_set_cfg_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_SIGNIFICANT_SCAN_CFG_ID, significant_params, flush) < 0) { -+ WL_ERR(("Could not set GSCAN significant cfg\n")); -+ err = -EINVAL; -+ goto exit; -+ } -+exit: -+ kfree(significant_params); -+ return err; -+} -+#endif /* GSCAN_SUPPORT */ -+ -+#if defined(RTT_SUPPORT) && 0 -+void wl_cfgvendor_rtt_evt(void *ctx, void *rtt_data) -+{ -+ struct wireless_dev *wdev = (struct wireless_dev *)ctx; -+ struct wiphy *wiphy; -+ struct sk_buff *skb; -+ uint32 tot_len = NLMSG_DEFAULT_SIZE, entry_len = 0; -+ gfp_t kflags; -+ rtt_report_t *rtt_report = NULL; -+ rtt_result_t *rtt_result = NULL; -+ struct list_head *rtt_list; -+ wiphy = wdev->wiphy; -+ -+ WL_DBG(("In\n")); -+ /* Push the data to the skb */ -+ if (!rtt_data) { -+ WL_ERR(("rtt_data is NULL\n")); -+ goto exit; -+ } -+ rtt_list = (struct list_head *)rtt_data; -+ kflags = in_atomic() ? GFP_ATOMIC : GFP_KERNEL; -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_event_alloc(wiphy, tot_len, GOOGLE_RTT_COMPLETE_EVENT, kflags); -+ if (!skb) { -+ WL_ERR(("skb alloc failed")); -+ goto exit; -+ } -+ /* fill in the rtt results on each entry */ -+ list_for_each_entry(rtt_result, rtt_list, list) { -+ entry_len = 0; -+ if (rtt_result->TOF_type == TOF_TYPE_ONE_WAY) { -+ entry_len = sizeof(rtt_report_t); -+ rtt_report = kzalloc(entry_len, kflags); -+ if (!rtt_report) { -+ WL_ERR(("rtt_report alloc failed")); -+ goto exit; -+ } -+ rtt_report->addr = rtt_result->peer_mac; -+ rtt_report->num_measurement = 1; /* ONE SHOT */ -+ rtt_report->status = rtt_result->err_code; -+ rtt_report->type = (rtt_result->TOF_type == TOF_TYPE_ONE_WAY) ? RTT_ONE_WAY: RTT_TWO_WAY; -+ rtt_report->peer = rtt_result->target_info->peer; -+ rtt_report->channel = rtt_result->target_info->channel; -+ rtt_report->rssi = rtt_result->avg_rssi; -+ /* tx_rate */ -+ rtt_report->tx_rate = rtt_result->tx_rate; -+ /* RTT */ -+ rtt_report->rtt = rtt_result->meanrtt; -+ rtt_report->rtt_sd = rtt_result->sdrtt; -+ /* convert to centi meter */ -+ if (rtt_result->distance != 0xffffffff) -+ rtt_report->distance = (rtt_result->distance >> 2) * 25; -+ else /* invalid distance */ -+ rtt_report->distance = -1; -+ -+ rtt_report->ts = rtt_result->ts; -+ nla_append(skb, entry_len, rtt_report); -+ kfree(rtt_report); -+ } -+ } -+ rtw_cfg80211_vendor_event(skb, kflags); -+exit: -+ return; -+} -+ -+static int wl_cfgvendor_rtt_set_config(struct wiphy *wiphy, struct wireless_dev *wdev, -+ const void *data, int len) { -+ int err = 0, rem, rem1, rem2, type; -+ rtt_config_params_t rtt_param; -+ rtt_target_info_t* rtt_target = NULL; -+ const struct nlattr *iter, *iter1, *iter2; -+ int8 eabuf[ETHER_ADDR_STR_LEN]; -+ int8 chanbuf[CHANSPEC_STR_LEN]; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ -+ WL_DBG(("In\n")); -+ err = dhd_dev_rtt_register_noti_callback(wdev->netdev, wdev, wl_cfgvendor_rtt_evt); -+ if (err < 0) { -+ WL_ERR(("failed to register rtt_noti_callback\n")); -+ goto exit; -+ } -+ memset(&rtt_param, 0, sizeof(rtt_param)); -+ nla_for_each_attr(iter, data, len, rem) { -+ type = nla_type(iter); -+ switch (type) { -+ case RTT_ATTRIBUTE_TARGET_CNT: -+ rtt_param.rtt_target_cnt = nla_get_u8(iter); -+ if (rtt_param.rtt_target_cnt > RTT_MAX_TARGET_CNT) { -+ WL_ERR(("exceed max target count : %d\n", -+ rtt_param.rtt_target_cnt)); -+ err = BCME_RANGE; -+ } -+ break; -+ case RTT_ATTRIBUTE_TARGET_INFO: -+ rtt_target = rtt_param.target_info; -+ nla_for_each_nested(iter1, iter, rem1) { -+ nla_for_each_nested(iter2, iter1, rem2) { -+ type = nla_type(iter2); -+ switch (type) { -+ case RTT_ATTRIBUTE_TARGET_MAC: -+ memcpy(&rtt_target->addr, nla_data(iter2), ETHER_ADDR_LEN); -+ break; -+ case RTT_ATTRIBUTE_TARGET_TYPE: -+ rtt_target->type = nla_get_u8(iter2); -+ break; -+ case RTT_ATTRIBUTE_TARGET_PEER: -+ rtt_target->peer= nla_get_u8(iter2); -+ break; -+ case RTT_ATTRIBUTE_TARGET_CHAN: -+ memcpy(&rtt_target->channel, nla_data(iter2), -+ sizeof(rtt_target->channel)); -+ break; -+ case RTT_ATTRIBUTE_TARGET_MODE: -+ rtt_target->continuous = nla_get_u8(iter2); -+ break; -+ case RTT_ATTRIBUTE_TARGET_INTERVAL: -+ rtt_target->interval = nla_get_u32(iter2); -+ break; -+ case RTT_ATTRIBUTE_TARGET_NUM_MEASUREMENT: -+ rtt_target->measure_cnt = nla_get_u32(iter2); -+ break; -+ case RTT_ATTRIBUTE_TARGET_NUM_PKT: -+ rtt_target->ftm_cnt = nla_get_u32(iter2); -+ break; -+ case RTT_ATTRIBUTE_TARGET_NUM_RETRY: -+ rtt_target->retry_cnt = nla_get_u32(iter2); -+ } -+ } -+ /* convert to chanspec value */ -+ rtt_target->chanspec = dhd_rtt_convert_to_chspec(rtt_target->channel); -+ if (rtt_target->chanspec == 0) { -+ WL_ERR(("Channel is not valid \n")); -+ goto exit; -+ } -+ WL_INFORM(("Target addr %s, Channel : %s for RTT \n", -+ bcm_ether_ntoa((const struct ether_addr *)&rtt_target->addr, eabuf), -+ wf_chspec_ntoa(rtt_target->chanspec, chanbuf))); -+ rtt_target++; -+ } -+ break; -+ } -+ } -+ WL_DBG(("leave :target_cnt : %d\n", rtt_param.rtt_target_cnt)); -+ if (dhd_dev_rtt_set_cfg(bcmcfg_to_prmry_ndev(cfg), &rtt_param) < 0) { -+ WL_ERR(("Could not set RTT configuration\n")); -+ err = -EINVAL; -+ } -+exit: -+ return err; -+} -+ -+static int wl_cfgvendor_rtt_cancel_config(struct wiphy *wiphy, struct wireless_dev *wdev, -+ const void *data, int len) -+{ -+ int err = 0, rem, type, target_cnt = 0; -+ const struct nlattr *iter; -+ struct ether_addr *mac_list = NULL, *mac_addr = NULL; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ -+ nla_for_each_attr(iter, data, len, rem) { -+ type = nla_type(iter); -+ switch (type) { -+ case RTT_ATTRIBUTE_TARGET_CNT: -+ target_cnt = nla_get_u8(iter); -+ mac_list = (struct ether_addr *)kzalloc(target_cnt * ETHER_ADDR_LEN , GFP_KERNEL); -+ if (mac_list == NULL) { -+ WL_ERR(("failed to allocate mem for mac list\n")); -+ goto exit; -+ } -+ mac_addr = &mac_list[0]; -+ break; -+ case RTT_ATTRIBUTE_TARGET_MAC: -+ if (mac_addr) -+ memcpy(mac_addr++, nla_data(iter), ETHER_ADDR_LEN); -+ else { -+ WL_ERR(("mac_list is NULL\n")); -+ goto exit; -+ } -+ break; -+ } -+ if (dhd_dev_rtt_cancel_cfg(bcmcfg_to_prmry_ndev(cfg), mac_list, target_cnt) < 0) { -+ WL_ERR(("Could not cancel RTT configuration\n")); -+ err = -EINVAL; -+ goto exit; -+ } -+ } -+exit: -+ if (mac_list) -+ kfree(mac_list); -+ return err; -+} -+static int wl_cfgvendor_rtt_get_capability(struct wiphy *wiphy, struct wireless_dev *wdev, -+ const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ rtt_capabilities_t capability; -+ -+ err = dhd_dev_rtt_capability(bcmcfg_to_prmry_ndev(cfg), &capability); -+ if (unlikely(err)) { -+ WL_ERR(("Vendor Command reply failed ret:%d \n", err)); -+ goto exit; -+ } -+ err = rtw_cfgvendor_send_cmd_reply(wiphy, bcmcfg_to_prmry_ndev(cfg), -+ &capability, sizeof(capability)); -+ -+ if (unlikely(err)) { -+ WL_ERR(("Vendor Command reply failed ret:%d \n", err)); -+ } -+exit: -+ return err; -+} -+ -+#endif /* RTT_SUPPORT */ -+static int wl_cfgvendor_priv_string_handler(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ u8 resp[1] = {'\0'}; -+ -+ DBG_871X_LEVEL(_drv_always_, FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(wdev_to_ndev(wdev)), (char*)data); -+ err = rtw_cfgvendor_send_cmd_reply(wiphy, wdev_to_ndev(wdev), resp, 1); -+ if (unlikely(err)) -+ DBG_871X_LEVEL(_drv_err_, FUNC_NDEV_FMT"Vendor Command reply failed ret:%d \n" -+ , FUNC_NDEV_ARG(wdev_to_ndev(wdev)), err); -+ -+ return err; -+#if 0 -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ int err = 0; -+ int data_len = 0; -+ -+ bzero(cfg->ioctl_buf, WLC_IOCTL_MAXLEN); -+ -+ if (strncmp((char *)data, BRCM_VENDOR_SCMD_CAPA, strlen(BRCM_VENDOR_SCMD_CAPA)) == 0) { -+ err = wldev_iovar_getbuf(bcmcfg_to_prmry_ndev(cfg), "cap", NULL, 0, -+ cfg->ioctl_buf, WLC_IOCTL_MAXLEN, &cfg->ioctl_buf_sync); -+ if (unlikely(err)) { -+ WL_ERR(("error (%d)\n", err)); -+ return err; -+ } -+ data_len = strlen(cfg->ioctl_buf); -+ cfg->ioctl_buf[data_len] = '\0'; -+ } -+ -+ err = rtw_cfgvendor_send_cmd_reply(wiphy, bcmcfg_to_prmry_ndev(cfg), -+ cfg->ioctl_buf, data_len+1); -+ if (unlikely(err)) -+ WL_ERR(("Vendor Command reply failed ret:%d \n", err)); -+ else -+ WL_INFORM(("Vendor Command reply sent successfully!\n")); -+ -+ return err; -+#endif -+} -+ -+static const struct wiphy_vendor_command rtw_vendor_cmds [] = { -+ { -+ { -+ .vendor_id = OUI_BRCM, -+ .subcmd = BRCM_VENDOR_SCMD_PRIV_STR -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_priv_string_handler -+ }, -+#if defined(GSCAN_SUPPORT) && 0 -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_GET_CAPABILITIES -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_gscan_get_capabilities -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_SET_CONFIG -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_set_scan_cfg -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_SET_SCAN_CONFIG -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_set_batch_scan_cfg -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_ENABLE_GSCAN -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_initiate_gscan -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_ENABLE_FULL_SCAN_RESULTS -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_enable_full_scan_result -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_SET_HOTLIST -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_hotlist_cfg -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_SET_SIGNIFICANT_CHANGE_CONFIG -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_significant_change_cfg -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_GET_SCAN_RESULTS -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_gscan_get_batch_results -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_GET_CHANNEL_LIST -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_gscan_get_channel_list -+ }, -+#endif /* GSCAN_SUPPORT */ -+#if defined(RTT_SUPPORT) && 0 -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = RTT_SUBCMD_SET_CONFIG -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_rtt_set_config -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = RTT_SUBCMD_CANCEL_CONFIG -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_rtt_cancel_config -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = RTT_SUBCMD_GETCAPABILITY -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_rtt_get_capability -+ }, -+#endif /* RTT_SUPPORT */ -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = ANDR_WIFI_SUBCMD_GET_FEATURE_SET -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = rtw_cfgvendor_get_feature_set -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = ANDR_WIFI_SUBCMD_GET_FEATURE_SET_MATRIX -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = rtw_cfgvendor_get_feature_set_matrix -+ } -+}; -+ -+static const struct nl80211_vendor_cmd_info rtw_vendor_events [] = { -+ { OUI_BRCM, BRCM_VENDOR_EVENT_UNSPEC }, -+ { OUI_BRCM, BRCM_VENDOR_EVENT_PRIV_STR }, -+#if defined(GSCAN_SUPPORT) && 0 -+ { OUI_GOOGLE, GOOGLE_GSCAN_SIGNIFICANT_EVENT }, -+ { OUI_GOOGLE, GOOGLE_GSCAN_GEOFENCE_FOUND_EVENT }, -+ { OUI_GOOGLE, GOOGLE_GSCAN_BATCH_SCAN_EVENT }, -+ { OUI_GOOGLE, GOOGLE_SCAN_FULL_RESULTS_EVENT }, -+#endif /* GSCAN_SUPPORT */ -+#if defined(RTT_SUPPORT) && 0 -+ { OUI_GOOGLE, GOOGLE_RTT_COMPLETE_EVENT }, -+#endif /* RTT_SUPPORT */ -+#if defined(GSCAN_SUPPORT) && 0 -+ { OUI_GOOGLE, GOOGLE_SCAN_COMPLETE_EVENT }, -+ { OUI_GOOGLE, GOOGLE_GSCAN_GEOFENCE_LOST_EVENT } -+#endif /* GSCAN_SUPPORT */ -+}; -+ -+int rtw_cfgvendor_attach(struct wiphy *wiphy) -+{ -+ -+ DBG_871X("Register RTW cfg80211 vendor cmd(0x%x) interface \n", NL80211_CMD_VENDOR); -+ -+ wiphy->vendor_commands = rtw_vendor_cmds; -+ wiphy->n_vendor_commands = ARRAY_SIZE(rtw_vendor_cmds); -+ wiphy->vendor_events = rtw_vendor_events; -+ wiphy->n_vendor_events = ARRAY_SIZE(rtw_vendor_events); -+ -+ return 0; -+} -+ -+int rtw_cfgvendor_detach(struct wiphy *wiphy) -+{ -+ DBG_871X("Vendor: Unregister RTW cfg80211 vendor interface \n"); -+ -+ wiphy->vendor_commands = NULL; -+ wiphy->vendor_events = NULL; -+ wiphy->n_vendor_commands = 0; -+ wiphy->n_vendor_events = 0; -+ -+ return 0; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) */ -+ -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_cfgvendor.h linux/3rdparty/rtl8812au/os_dep/linux/rtw_cfgvendor.h ---- linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_cfgvendor.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/rtw_cfgvendor.h 2017-06-07 23:07:21.047690856 +0300 -@@ -0,0 +1,246 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2014 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef _RTW_CFGVENDOR_H_ -+#define _RTW_CFGVENDOR_H_ -+ -+#define OUI_BRCM 0x001018 -+#define OUI_GOOGLE 0x001A11 -+#define BRCM_VENDOR_SUBCMD_PRIV_STR 1 -+#define ATTRIBUTE_U32_LEN (NLA_HDRLEN + 4) -+#define VENDOR_ID_OVERHEAD ATTRIBUTE_U32_LEN -+#define VENDOR_SUBCMD_OVERHEAD ATTRIBUTE_U32_LEN -+#define VENDOR_DATA_OVERHEAD (NLA_HDRLEN) -+ -+#define SCAN_RESULTS_COMPLETE_FLAG_LEN ATTRIBUTE_U32_LEN -+#define SCAN_INDEX_HDR_LEN (NLA_HDRLEN) -+#define SCAN_ID_HDR_LEN ATTRIBUTE_U32_LEN -+#define SCAN_FLAGS_HDR_LEN ATTRIBUTE_U32_LEN -+#define GSCAN_NUM_RESULTS_HDR_LEN ATTRIBUTE_U32_LEN -+#define GSCAN_RESULTS_HDR_LEN (NLA_HDRLEN) -+#define GSCAN_BATCH_RESULT_HDR_LEN (SCAN_INDEX_HDR_LEN + SCAN_ID_HDR_LEN + \ -+ SCAN_FLAGS_HDR_LEN + \ -+ GSCAN_NUM_RESULTS_HDR_LEN + \ -+ GSCAN_RESULTS_HDR_LEN) -+ -+#define VENDOR_REPLY_OVERHEAD (VENDOR_ID_OVERHEAD + \ -+ VENDOR_SUBCMD_OVERHEAD + \ -+ VENDOR_DATA_OVERHEAD) -+typedef enum { -+ /* don't use 0 as a valid subcommand */ -+ VENDOR_NL80211_SUBCMD_UNSPECIFIED, -+ -+ /* define all vendor startup commands between 0x0 and 0x0FFF */ -+ VENDOR_NL80211_SUBCMD_RANGE_START = 0x0001, -+ VENDOR_NL80211_SUBCMD_RANGE_END = 0x0FFF, -+ -+ /* define all GScan related commands between 0x1000 and 0x10FF */ -+ ANDROID_NL80211_SUBCMD_GSCAN_RANGE_START = 0x1000, -+ ANDROID_NL80211_SUBCMD_GSCAN_RANGE_END = 0x10FF, -+ -+ /* define all NearbyDiscovery related commands between 0x1100 and 0x11FF */ -+ ANDROID_NL80211_SUBCMD_NBD_RANGE_START = 0x1100, -+ ANDROID_NL80211_SUBCMD_NBD_RANGE_END = 0x11FF, -+ -+ /* define all RTT related commands between 0x1100 and 0x11FF */ -+ ANDROID_NL80211_SUBCMD_RTT_RANGE_START = 0x1100, -+ ANDROID_NL80211_SUBCMD_RTT_RANGE_END = 0x11FF, -+ -+ ANDROID_NL80211_SUBCMD_LSTATS_RANGE_START = 0x1200, -+ ANDROID_NL80211_SUBCMD_LSTATS_RANGE_END = 0x12FF, -+ -+ ANDROID_NL80211_SUBCMD_TDLS_RANGE_START = 0x1300, -+ ANDROID_NL80211_SUBCMD_TDLS_RANGE_END = 0x13FF, -+ /* This is reserved for future usage */ -+ -+} ANDROID_VENDOR_SUB_COMMAND; -+ -+enum wl_vendor_subcmd { -+ BRCM_VENDOR_SCMD_UNSPEC, -+ BRCM_VENDOR_SCMD_PRIV_STR, -+ GSCAN_SUBCMD_GET_CAPABILITIES = ANDROID_NL80211_SUBCMD_GSCAN_RANGE_START, -+ GSCAN_SUBCMD_SET_CONFIG, -+ GSCAN_SUBCMD_SET_SCAN_CONFIG, -+ GSCAN_SUBCMD_ENABLE_GSCAN, -+ GSCAN_SUBCMD_GET_SCAN_RESULTS, -+ GSCAN_SUBCMD_SCAN_RESULTS, -+ GSCAN_SUBCMD_SET_HOTLIST, -+ GSCAN_SUBCMD_SET_SIGNIFICANT_CHANGE_CONFIG, -+ GSCAN_SUBCMD_ENABLE_FULL_SCAN_RESULTS, -+ GSCAN_SUBCMD_GET_CHANNEL_LIST, -+ ANDR_WIFI_SUBCMD_GET_FEATURE_SET, -+ ANDR_WIFI_SUBCMD_GET_FEATURE_SET_MATRIX, -+ RTT_SUBCMD_SET_CONFIG = ANDROID_NL80211_SUBCMD_RTT_RANGE_START, -+ RTT_SUBCMD_CANCEL_CONFIG, -+ RTT_SUBCMD_GETCAPABILITY, -+ /* Add more sub commands here */ -+ VENDOR_SUBCMD_MAX -+}; -+ -+enum gscan_attributes { -+ GSCAN_ATTRIBUTE_NUM_BUCKETS = 10, -+ GSCAN_ATTRIBUTE_BASE_PERIOD, -+ GSCAN_ATTRIBUTE_BUCKETS_BAND, -+ GSCAN_ATTRIBUTE_BUCKET_ID, -+ GSCAN_ATTRIBUTE_BUCKET_PERIOD, -+ GSCAN_ATTRIBUTE_BUCKET_NUM_CHANNELS, -+ GSCAN_ATTRIBUTE_BUCKET_CHANNELS, -+ GSCAN_ATTRIBUTE_NUM_AP_PER_SCAN, -+ GSCAN_ATTRIBUTE_REPORT_THRESHOLD, -+ GSCAN_ATTRIBUTE_NUM_SCANS_TO_CACHE, -+ GSCAN_ATTRIBUTE_BAND = GSCAN_ATTRIBUTE_BUCKETS_BAND, -+ -+ GSCAN_ATTRIBUTE_ENABLE_FEATURE = 20, -+ GSCAN_ATTRIBUTE_SCAN_RESULTS_COMPLETE, -+ GSCAN_ATTRIBUTE_FLUSH_FEATURE, -+ GSCAN_ATTRIBUTE_ENABLE_FULL_SCAN_RESULTS, -+ GSCAN_ATTRIBUTE_REPORT_EVENTS, -+ /* remaining reserved for additional attributes */ -+ GSCAN_ATTRIBUTE_NUM_OF_RESULTS = 30, -+ GSCAN_ATTRIBUTE_FLUSH_RESULTS, -+ GSCAN_ATTRIBUTE_SCAN_RESULTS, /* flat array of wifi_scan_result */ -+ GSCAN_ATTRIBUTE_SCAN_ID, /* indicates scan number */ -+ GSCAN_ATTRIBUTE_SCAN_FLAGS, /* indicates if scan was aborted */ -+ GSCAN_ATTRIBUTE_AP_FLAGS, /* flags on significant change event */ -+ GSCAN_ATTRIBUTE_NUM_CHANNELS, -+ GSCAN_ATTRIBUTE_CHANNEL_LIST, -+ -+ /* remaining reserved for additional attributes */ -+ -+ GSCAN_ATTRIBUTE_SSID = 40, -+ GSCAN_ATTRIBUTE_BSSID, -+ GSCAN_ATTRIBUTE_CHANNEL, -+ GSCAN_ATTRIBUTE_RSSI, -+ GSCAN_ATTRIBUTE_TIMESTAMP, -+ GSCAN_ATTRIBUTE_RTT, -+ GSCAN_ATTRIBUTE_RTTSD, -+ -+ /* remaining reserved for additional attributes */ -+ -+ GSCAN_ATTRIBUTE_HOTLIST_BSSIDS = 50, -+ GSCAN_ATTRIBUTE_RSSI_LOW, -+ GSCAN_ATTRIBUTE_RSSI_HIGH, -+ GSCAN_ATTRIBUTE_HOSTLIST_BSSID_ELEM, -+ GSCAN_ATTRIBUTE_HOTLIST_FLUSH, -+ -+ /* remaining reserved for additional attributes */ -+ GSCAN_ATTRIBUTE_RSSI_SAMPLE_SIZE = 60, -+ GSCAN_ATTRIBUTE_LOST_AP_SAMPLE_SIZE, -+ GSCAN_ATTRIBUTE_MIN_BREACHING, -+ GSCAN_ATTRIBUTE_SIGNIFICANT_CHANGE_BSSIDS, -+ GSCAN_ATTRIBUTE_SIGNIFICANT_CHANGE_FLUSH, -+ GSCAN_ATTRIBUTE_MAX -+}; -+ -+enum gscan_bucket_attributes { -+ GSCAN_ATTRIBUTE_CH_BUCKET_1, -+ GSCAN_ATTRIBUTE_CH_BUCKET_2, -+ GSCAN_ATTRIBUTE_CH_BUCKET_3, -+ GSCAN_ATTRIBUTE_CH_BUCKET_4, -+ GSCAN_ATTRIBUTE_CH_BUCKET_5, -+ GSCAN_ATTRIBUTE_CH_BUCKET_6, -+ GSCAN_ATTRIBUTE_CH_BUCKET_7 -+}; -+ -+enum gscan_ch_attributes { -+ GSCAN_ATTRIBUTE_CH_ID_1, -+ GSCAN_ATTRIBUTE_CH_ID_2, -+ GSCAN_ATTRIBUTE_CH_ID_3, -+ GSCAN_ATTRIBUTE_CH_ID_4, -+ GSCAN_ATTRIBUTE_CH_ID_5, -+ GSCAN_ATTRIBUTE_CH_ID_6, -+ GSCAN_ATTRIBUTE_CH_ID_7 -+}; -+ -+enum rtt_attributes { -+ RTT_ATTRIBUTE_TARGET_CNT, -+ RTT_ATTRIBUTE_TARGET_INFO, -+ RTT_ATTRIBUTE_TARGET_MAC, -+ RTT_ATTRIBUTE_TARGET_TYPE, -+ RTT_ATTRIBUTE_TARGET_PEER, -+ RTT_ATTRIBUTE_TARGET_CHAN, -+ RTT_ATTRIBUTE_TARGET_MODE, -+ RTT_ATTRIBUTE_TARGET_INTERVAL, -+ RTT_ATTRIBUTE_TARGET_NUM_MEASUREMENT, -+ RTT_ATTRIBUTE_TARGET_NUM_PKT, -+ RTT_ATTRIBUTE_TARGET_NUM_RETRY -+}; -+ -+typedef enum wl_vendor_event { -+ BRCM_VENDOR_EVENT_UNSPEC, -+ BRCM_VENDOR_EVENT_PRIV_STR, -+ GOOGLE_GSCAN_SIGNIFICANT_EVENT, -+ GOOGLE_GSCAN_GEOFENCE_FOUND_EVENT, -+ GOOGLE_GSCAN_BATCH_SCAN_EVENT, -+ GOOGLE_SCAN_FULL_RESULTS_EVENT, -+ GOOGLE_RTT_COMPLETE_EVENT, -+ GOOGLE_SCAN_COMPLETE_EVENT, -+ GOOGLE_GSCAN_GEOFENCE_LOST_EVENT -+} wl_vendor_event_t; -+ -+enum andr_wifi_feature_set_attr { -+ ANDR_WIFI_ATTRIBUTE_NUM_FEATURE_SET, -+ ANDR_WIFI_ATTRIBUTE_FEATURE_SET -+}; -+ -+typedef enum wl_vendor_gscan_attribute { -+ ATTR_START_GSCAN, -+ ATTR_STOP_GSCAN, -+ ATTR_SET_SCAN_BATCH_CFG_ID, /* set batch scan params */ -+ ATTR_SET_SCAN_GEOFENCE_CFG_ID, /* set list of bssids to track */ -+ ATTR_SET_SCAN_SIGNIFICANT_CFG_ID, /* set list of bssids, rssi threshold etc.. */ -+ ATTR_SET_SCAN_CFG_ID, /* set common scan config params here */ -+ ATTR_GET_GSCAN_CAPABILITIES_ID, -+ /* Add more sub commands here */ -+ ATTR_GSCAN_MAX -+} wl_vendor_gscan_attribute_t; -+ -+typedef enum gscan_batch_attribute { -+ ATTR_GSCAN_BATCH_BESTN, -+ ATTR_GSCAN_BATCH_MSCAN, -+ ATTR_GSCAN_BATCH_BUFFER_THRESHOLD -+} gscan_batch_attribute_t; -+ -+typedef enum gscan_geofence_attribute { -+ ATTR_GSCAN_NUM_HOTLIST_BSSID, -+ ATTR_GSCAN_HOTLIST_BSSID -+} gscan_geofence_attribute_t; -+ -+typedef enum gscan_complete_event { -+ WIFI_SCAN_BUFFER_FULL, -+ WIFI_SCAN_COMPLETE -+} gscan_complete_event_t; -+ -+/* Capture the BRCM_VENDOR_SUBCMD_PRIV_STRINGS* here */ -+#define BRCM_VENDOR_SCMD_CAPA "cap" -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) -+extern int rtw_cfgvendor_attach(struct wiphy *wiphy); -+extern int rtw_cfgvendor_detach(struct wiphy *wiphy); -+extern int rtw_cfgvendor_send_async_event(struct wiphy *wiphy, -+ struct net_device *dev, int event_id, const void *data, int len); -+#if defined(GSCAN_SUPPORT) && 0 -+extern int wl_cfgvendor_send_hotlist_event(struct wiphy *wiphy, -+ struct net_device *dev, void *data, int len, wl_vendor_event_t event); -+#endif -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) */ -+ -+#endif /* _RTW_CFGVENDOR_H_ */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_proc.c linux/3rdparty/rtl8812au/os_dep/linux/rtw_proc.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_proc.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/rtw_proc.c 2017-06-07 23:07:21.047690856 +0300 -@@ -0,0 +1,1723 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+#include "rtw_proc.h" -+ -+#ifdef CONFIG_PROC_DEBUG -+ -+static struct proc_dir_entry *rtw_proc = NULL; -+ -+inline struct proc_dir_entry *get_rtw_drv_proc(void) -+{ -+ return rtw_proc; -+} -+ -+#define RTW_PROC_NAME DRV_NAME -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,9,0)) -+#define file_inode(file) ((file)->f_dentry->d_inode) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0)) -+#define PDE_DATA(inode) PDE((inode))->data -+#define proc_get_parent_data(inode) PDE((inode))->parent->data -+#endif -+ -+#if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) -+#define get_proc_net proc_net -+#else -+#define get_proc_net init_net.proc_net -+#endif -+ -+inline struct proc_dir_entry *rtw_proc_create_dir(const char *name, struct proc_dir_entry *parent, void *data) -+{ -+ struct proc_dir_entry *entry; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,0)) -+ entry = proc_mkdir_data(name, S_IRUGO|S_IXUGO, parent, data); -+#else -+ //entry = proc_mkdir_mode(name, S_IRUGO|S_IXUGO, parent); -+ entry = proc_mkdir(name, parent); -+ if (entry) -+ entry->data = data; -+#endif -+ -+ return entry; -+} -+ -+inline struct proc_dir_entry *rtw_proc_create_entry(const char *name, struct proc_dir_entry *parent, -+ const struct file_operations *fops, void * data) -+{ -+ struct proc_dir_entry *entry; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,26)) -+ entry = proc_create_data(name, S_IFREG|S_IRUGO|S_IWUGO, parent, fops, data); -+#else -+ entry = create_proc_entry(name, S_IFREG|S_IRUGO|S_IWUGO, parent); -+ if (entry) { -+ entry->data = data; -+ entry->proc_fops = fops; -+ } -+#endif -+ -+ return entry; -+} -+ -+static int proc_get_dummy(struct seq_file *m, void *v) -+{ -+ return 0; -+} -+ -+static int proc_get_drv_version(struct seq_file *m, void *v) -+{ -+ dump_drv_version(m); -+ return 0; -+} -+ -+static int proc_get_log_level(struct seq_file *m, void *v) -+{ -+ dump_log_level(m); -+ return 0; -+} -+ -+static int proc_get_drv_cfg(struct seq_file *m, void *v) -+{ -+ dump_drv_cfg(m); -+ return 0; -+} -+ -+static ssize_t proc_set_log_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ char tmp[32]; -+ int log_level; -+ -+ if (count < 1) -+ return -EINVAL; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &log_level); -+ -+ if( log_level >= _drv_always_ && log_level <= _drv_debug_ ) -+ { -+ GlobalDebugLevel= log_level; -+ printk("%d\n", GlobalDebugLevel); -+ } -+ } else { -+ return -EFAULT; -+ } -+ -+ return count; -+} -+ -+#ifdef DBG_MEM_ALLOC -+static int proc_get_mstat(struct seq_file *m, void *v) -+{ -+ rtw_mstat_dump(m); -+ return 0; -+} -+#endif /* DBG_MEM_ALLOC */ -+ -+static int proc_get_chplan_id_list(struct seq_file *m, void *v) -+{ -+ dump_chplan_id_list(m); -+ return 0; -+} -+ -+static int proc_get_chplan_test(struct seq_file *m, void *v) -+{ -+ dump_chplan_test(m); -+ return 0; -+} -+ -+/* -+* rtw_drv_proc: -+* init/deinit when register/unregister driver -+*/ -+const struct rtw_proc_hdl drv_proc_hdls [] = { -+ {"ver_info", proc_get_drv_version, NULL}, -+ {"log_level", proc_get_log_level, proc_set_log_level}, -+ {"drv_cfg", proc_get_drv_cfg, NULL}, -+#ifdef DBG_MEM_ALLOC -+ {"mstat", proc_get_mstat, NULL}, -+#endif /* DBG_MEM_ALLOC */ -+ {"chplan_id_list", proc_get_chplan_id_list, NULL}, -+ {"chplan_test", proc_get_chplan_test, NULL}, -+}; -+ -+const int drv_proc_hdls_num = sizeof(drv_proc_hdls) / sizeof(struct rtw_proc_hdl); -+ -+static int rtw_drv_proc_open(struct inode *inode, struct file *file) -+{ -+ //struct net_device *dev = proc_get_parent_data(inode); -+ ssize_t index = (ssize_t)PDE_DATA(inode); -+ const struct rtw_proc_hdl *hdl = drv_proc_hdls+index; -+ return single_open(file, hdl->show, NULL); -+} -+ -+static ssize_t rtw_drv_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); -+ const struct rtw_proc_hdl *hdl = drv_proc_hdls+index; -+ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; -+ -+ if (write) -+ return write(file, buffer, count, pos, NULL); -+ -+ return -EROFS; -+} -+ -+static const struct file_operations rtw_drv_proc_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_drv_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_drv_proc_write, -+}; -+ -+int rtw_drv_proc_init(void) -+{ -+ int ret = _FAIL; -+ ssize_t i; -+ struct proc_dir_entry *entry = NULL; -+ -+ if (rtw_proc != NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ rtw_proc = rtw_proc_create_dir(RTW_PROC_NAME, get_proc_net, NULL); -+ -+ if (rtw_proc == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ for (i=0;iprivate; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ sd_f0_reg_dump(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_sdio_local_reg_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ sdio_local_reg_dump(m, adapter); -+ -+ return 0; -+} -+#endif /* CONFIG_SDIO_HCI */ -+ -+static int proc_get_mac_reg_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ mac_reg_dump(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_bb_reg_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ bb_reg_dump(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_rf_reg_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rf_reg_dump(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_dump_adapters_status(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_adapters_status(m, adapter_to_dvobj(adapter)); -+ -+ return 0; -+} -+ -+//gpio setting -+#ifdef CONFIG_GPIO_API -+static ssize_t proc_set_config_gpio(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]={0}; -+ int num=0,gpio_pin=0,gpio_mode=0;//gpio_mode:0 input 1:output; -+ -+ if (count < 2) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ num =sscanf(tmp, "%d %d",&gpio_pin,&gpio_mode); -+ DBG_871X("num=%d gpio_pin=%d mode=%d\n",num,gpio_pin,gpio_mode); -+ padapter->pre_gpio_pin=gpio_pin; -+ -+ if(gpio_mode==0 || gpio_mode==1 ) -+ rtw_hal_config_gpio(padapter, gpio_pin,gpio_mode); -+ } -+ return count; -+ -+} -+static ssize_t proc_set_gpio_output_value(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]={0}; -+ int num=0,gpio_pin=0,pin_mode=0;//pin_mode: 1 high 0:low -+ -+ if (count < 2) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ num =sscanf(tmp, "%d %d",&gpio_pin,&pin_mode); -+ DBG_871X("num=%d gpio_pin=%d pin_high=%d\n",num,gpio_pin,pin_mode); -+ padapter->pre_gpio_pin=gpio_pin; -+ -+ if(pin_mode==0 || pin_mode==1 ) -+ rtw_hal_set_gpio_output_value(padapter, gpio_pin,pin_mode); -+ } -+ return count; -+} -+static int proc_get_gpio(struct seq_file *m, void *v) -+{ -+ u8 gpioreturnvalue=0; -+ struct net_device *dev = m->private; -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ if(!padapter) -+ return -EFAULT; -+ gpioreturnvalue = rtw_hal_get_gpio(padapter, padapter->pre_gpio_pin); -+ DBG_871X_SEL_NL(m, "get_gpio %d:%d \n",padapter->pre_gpio_pin ,gpioreturnvalue); -+ -+ return 0; -+ -+} -+static ssize_t proc_set_gpio(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]={0}; -+ int num=0,gpio_pin=0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ num =sscanf(tmp, "%d",&gpio_pin); -+ DBG_871X("num=%d gpio_pin=%d\n",num,gpio_pin); -+ padapter->pre_gpio_pin=gpio_pin; -+ -+ } -+ return count; -+} -+#endif -+ -+ -+static int proc_get_linked_info_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ if(padapter) -+ DBG_871X_SEL_NL(m, "linked_info_dump :%s \n", (padapter->bLinkInfoDump)?"enable":"disable"); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_linked_info_dump(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ char tmp[32]={0}; -+ int mode=0,pre_mode=0; -+ int num=0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ pre_mode=padapter->bLinkInfoDump; -+ DBG_871X("pre_mode=%d\n", pre_mode); -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ num =sscanf(tmp, "%d ", &mode); -+ DBG_871X("num=%d mode=%d\n",num,mode); -+ -+ if(num!=1) -+ { -+ DBG_871X("argument number is wrong\n"); -+ return -EFAULT; -+ } -+ -+ if(mode==1 || (mode==0 && pre_mode==1) ) //not consider pwr_saving 0: -+ { -+ padapter->bLinkInfoDump = mode; -+ -+ } -+ else if( (mode==2 ) || (mode==0 && pre_mode==2))//consider power_saving -+ { -+ //DBG_871X("linked_info_dump =%s \n", (padapter->bLinkInfoDump)?"enable":"disable") -+ linked_info_dump(padapter,mode); -+ } -+ } -+ return count; -+} -+ -+static int proc_get_mac_qinfo(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_DUMP_MAC_QUEUE_INFO, (u8 *)m); -+ -+ return 0; -+} -+ -+int proc_get_wifi_spec(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ DBG_871X_SEL_NL(m,"wifi_spec=%d\n",pregpriv->wifi_spec); -+ return 0; -+} -+ -+static int proc_get_chan_plan(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_cur_chset(m, adapter); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_chan_plan(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 chan_plan = RTW_CHPLAN_MAX; -+ -+ if (!padapter) -+ return -EFAULT; -+ -+ if (count < 1) -+ { -+ DBG_871X("argument size is less than 1\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx", &chan_plan); -+ -+ if (num != 1) { -+ DBG_871X("invalid read_reg parameter!\n"); -+ return count; -+ } -+ -+ } -+ -+ rtw_set_channel_plan(padapter, chan_plan); -+ -+ return count; -+} -+ -+#ifdef CONFIG_DFS_MASTER -+ssize_t proc_set_update_non_ocp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ char tmp[32]; -+ u8 ch, bw = CHANNEL_WIDTH_20, offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ int ms = -1; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhu %hhu %hhu %d", &ch, &bw, &offset, &ms); -+ -+ if (num < 1 || (bw != CHANNEL_WIDTH_20 && num < 3)) -+ goto exit; -+ -+ if (bw == CHANNEL_WIDTH_20) -+ rtw_chset_update_non_ocp_ms(mlmeext->channel_set -+ , ch, bw, HAL_PRIME_CHNL_OFFSET_DONT_CARE, ms); -+ else -+ rtw_chset_update_non_ocp_ms(mlmeext->channel_set -+ , ch, bw, offset, ms); -+ } -+ -+exit: -+ return count; -+} -+ -+ssize_t proc_set_radar_detect(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ char tmp[32]; -+ u8 fake_radar_detect_cnt = 0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhu", &fake_radar_detect_cnt); -+ -+ if (num < 1) -+ goto exit; -+ -+ rfctl->dbg_dfs_master_fake_radar_detect_cnt = fake_radar_detect_cnt; -+ } -+ -+exit: -+ return count; -+} -+#endif /* CONFIG_DFS_MASTER */ -+ -+static int proc_get_udpport(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ -+ DBG_871X_SEL_NL(m,"%d\n",precvpriv->sink_udpport); -+ return 0; -+} -+static ssize_t proc_set_udpport(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ int sink_udpport = 0; -+ char tmp[32]; -+ -+ -+ if (!padapter) -+ return -EFAULT; -+ -+ if (count < 1) -+ { -+ DBG_871X("argument size is less than 1\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d", &sink_udpport); -+ -+ if (num != 1) { -+ DBG_871X("invalid input parameter number!\n"); -+ return count; -+ } -+ -+ } -+ precvpriv->sink_udpport = sink_udpport; -+ -+ return count; -+ -+} -+ -+static int proc_get_macid_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u8 i; -+ -+ DBG_871X_SEL_NL(m, "max_num:%u\n", macid_ctl->num); -+ DBG_871X_SEL_NL(m, "\n"); -+ -+ DBG_871X_SEL_NL(m, "used:\n"); -+ dump_macid_map(m, &macid_ctl->used, macid_ctl->num); -+ DBG_871X_SEL_NL(m, "\n"); -+ -+ DBG_871X_SEL_NL(m, "%-3s %-3s %-4s %-4s" -+ "\n" -+ , "id", "bmc", "if_g", "ch_g" -+ ); -+ -+ for (i=0;inum;i++) { -+ if (rtw_macid_is_used(macid_ctl, i)) -+ DBG_871X_SEL_NL(m, "%3u %3u %4d %4d" -+ "\n" -+ , i -+ , rtw_macid_is_bmc(macid_ctl, i) -+ , rtw_macid_get_if_g(macid_ctl, i) -+ , rtw_macid_get_ch_g(macid_ctl, i) -+ ); -+ } -+ -+ return 0; -+} -+ -+static int proc_get_sec_cam(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ DBG_871X_SEL_NL(m, "sec_cap:0x%02x\n", cam_ctl->sec_cap); -+ DBG_871X_SEL_NL(m, "flags:0x%08x\n", cam_ctl->flags); -+ DBG_871X_SEL_NL(m, "\n"); -+ -+ DBG_871X_SEL_NL(m, "max_num:%u\n", cam_ctl->num); -+ DBG_871X_SEL_NL(m, "used:\n"); -+ dump_sec_cam_map(m, &cam_ctl->used, cam_ctl->num); -+ DBG_871X_SEL_NL(m, "\n"); -+ -+ DBG_871X_SEL_NL(m, "reg_scr:0x%04x\n", rtw_read16(adapter, 0x680)); -+ DBG_871X_SEL_NL(m, "\n"); -+ -+ dump_sec_cam(m, adapter); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_sec_cam(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ char tmp[32] = {0}; -+ char cmd[4]; -+ u8 id; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ /* c : clear specific cam entry */ -+ /* wfc : write specific cam entry from cam cache */ -+ -+ int num = sscanf(tmp, "%s %hhu", cmd, &id); -+ -+ if (num < 2) -+ return count; -+ -+ if (id >= cam_ctl->num) { -+ DBG_871X_LEVEL(_drv_err_, FUNC_ADPT_FMT" invalid id:%u\n", FUNC_ADPT_ARG(adapter), id); -+ return count; -+ } -+ -+ if (strcmp("c", cmd) == 0) { -+ _clear_cam_entry(adapter, id); -+ adapter->securitypriv.hw_decrypted = _FALSE; /* temporarily set this for TX path to use SW enc */ -+ } else if (strcmp("wfc", cmd) == 0) { -+ write_cam_from_cache(adapter, id); -+ } -+ } -+ -+ return count; -+} -+ -+static int proc_get_sec_cam_cache(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ u8 i; -+ -+ DBG_871X_SEL_NL(m, "SW sec cam cache:\n"); -+ dump_sec_cam_ent_title(m, 1); -+ for (i = 0; i < cam_ctl->num; i++) { -+ if (dvobj->cam_cache[i].ctrl != 0) -+ dump_sec_cam_ent(m, &dvobj->cam_cache[i], i); -+ } -+ -+ return 0; -+} -+ -+static ssize_t proc_set_change_bss_chbw(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlme = &(adapter->mlmepriv); -+ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); -+ char tmp[32]; -+ u8 ch, bw = CHANNEL_WIDTH_20, offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhu %hhu %hhu", &ch, &bw, &offset); -+ -+ if (num < 1 || (bw != CHANNEL_WIDTH_20 && num < 3)) -+ goto exit; -+ -+ if (check_fwstate(mlme, WIFI_AP_STATE) && check_fwstate(mlme, WIFI_ASOC_STATE)) -+ rtw_change_bss_chbw_cmd(adapter, RTW_CMDF_WAIT_ACK, ch, bw, offset); -+ } -+ -+exit: -+ return count; -+} -+ -+static int proc_get_tx_power_by_rate_base(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_tx_power_by_rate_base(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_tx_power_by_rate(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_tx_power_by_rate(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_tx_power_limit(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_tx_power_limit(m, adapter); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_RF_GAIN_OFFSET -+static int proc_get_kfree_flag(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); -+ -+ DBG_871X_SEL_NL(m, "0x%02x\n", kfree_data->flag); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_kfree_flag(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); -+ char tmp[32] = {0}; -+ u8 flag; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx", &flag); -+ -+ if (num < 1) -+ return count; -+ -+ kfree_data->flag = flag; -+ } -+ -+ return count; -+} -+ -+static int proc_get_kfree_bb_gain(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); -+ u8 i, j; -+ -+ for (i = 0; i < BB_GAIN_NUM; i++) { -+ if (i == 0) -+ DBG_871X_SEL(m, "2G: "); -+ else if (i == 1) -+ DBG_871X_SEL(m, "5GLB1: "); -+ else if (i == 2) -+ DBG_871X_SEL(m, "5GLB2: "); -+ else if (i == 3) -+ DBG_871X_SEL(m, "5GMB1: "); -+ else if (i == 4) -+ DBG_871X_SEL(m, "5GMB2: "); -+ else if (i == 5) -+ DBG_871X_SEL(m, "5GHB: "); -+ -+ for (j = 0; j < hal_data->NumTotalRFPath; j++) -+ DBG_871X_SEL(m, "%d ", kfree_data->bb_gain[i][j]); -+ DBG_871X_SEL(m, "\n"); -+ } -+ -+ return 0; -+} -+ -+static ssize_t proc_set_kfree_bb_gain(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); -+ char tmp[BB_GAIN_NUM * RF_PATH_MAX] = {0}; -+ u8 path, chidx; -+ s8 bb_gain[BB_GAIN_NUM]; -+ char ch_band_Group[6]; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ char *c, *next; -+ int i = 0; -+ -+ next = tmp; -+ c = strsep(&next, " \t"); -+ -+ if (sscanf(c, "%s", ch_band_Group) != 1) { -+ DBG_871X("Error Head Format, channel Group select\n,Please input:\t 2G , 5GLB1 , 5GLB2 , 5GMB1 , 5GMB2 , 5GHB\n"); -+ return count; -+ } -+ if (strcmp("2G", ch_band_Group) == 0) -+ chidx = BB_GAIN_2G; -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ else if (strcmp("5GLB1", ch_band_Group) == 0) -+ chidx = BB_GAIN_5GLB1; -+ else if (strcmp("5GLB2", ch_band_Group) == 0) -+ chidx = BB_GAIN_5GLB2; -+ else if (strcmp("5GMB1", ch_band_Group) == 0) -+ chidx = BB_GAIN_5GMB1; -+ else if (strcmp("5GMB2", ch_band_Group) == 0) -+ chidx = BB_GAIN_5GMB2; -+ else if (strcmp("5GHB", ch_band_Group) == 0) -+ chidx = BB_GAIN_5GHB; -+#endif /*CONFIG_IEEE80211_BAND_5GHZ*/ -+ else { -+ DBG_871X("Error Head Format, channel Group select\n,Please input:\t 2G , 5GLB1 , 5GLB2 , 5GMB1 , 5GMB2 , 5GHB\n"); -+ return count; -+ } -+ c = strsep(&next, " \t"); -+ -+ while (c != NULL) { -+ if (sscanf(c, "%hhx", &bb_gain[i]) != 1) -+ break; -+ -+ kfree_data->bb_gain[chidx][i] = bb_gain[i]; -+ DBG_871X("%s,kfree_data->bb_gain[%d][%d]=%x\n", __func__, chidx, i, kfree_data->bb_gain[chidx][i]); -+ -+ c = strsep(&next, " \t"); -+ i++; -+ } -+ -+ } -+ -+ return count; -+ -+} -+ -+static int proc_get_kfree_thermal(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); -+ -+ DBG_871X_SEL(m, "%d\n", kfree_data->thermal); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_kfree_thermal(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); -+ char tmp[32] = {0}; -+ s8 thermal; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhd", &thermal); -+ -+ if (num < 1) -+ return count; -+ -+ kfree_data->thermal = thermal; -+ } -+ -+ return count; -+} -+ -+static ssize_t proc_set_tx_gain_offset(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter; -+ char tmp[32] = {0}; -+ u8 rf_path; -+ s8 offset; -+ -+ adapter = (_adapter *)rtw_netdev_priv(dev); -+ if (!adapter) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ u8 write_value; -+ int num = sscanf(tmp, "%hhu %hhd", &rf_path, &offset); -+ -+ if (num < 2) -+ return count; -+ -+ DBG_871X("write rf_path:%u tx gain offset:%d\n", rf_path, offset); -+ rtw_rf_set_tx_gain_offset(adapter, rf_path, offset); -+ } -+ -+ return count; -+} -+#endif /* CONFIG_RF_GAIN_OFFSET */ -+ -+#ifdef CONFIG_BT_COEXIST -+ssize_t proc_set_btinfo_evt(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 btinfo[8]; -+ -+ if (count < 6) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = 0; -+ -+ _rtw_memset(btinfo, 0, 8); -+ -+ num = sscanf(tmp, "%hhx %hhx %hhx %hhx %hhx %hhx %hhx %hhx" -+ , &btinfo[0], &btinfo[1], &btinfo[2], &btinfo[3] -+ , &btinfo[4], &btinfo[5], &btinfo[6], &btinfo[7]); -+ -+ if (num < 6) -+ return -EINVAL; -+ -+ btinfo[1] = num-2; -+ -+ rtw_btinfo_cmd(padapter, btinfo, btinfo[1]+2); -+ } -+ -+ return count; -+} -+#endif -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+static int proc_get_best_chan(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 best_24g_ch = 0, best_5g_ch = 0; -+ -+ rtw_hal_get_odm_var(adapter, HAL_ODM_AUTO_CHNL_SEL, &(best_24g_ch), &(best_5g_ch)); -+ -+ DBG_871X_SEL_NL(m, "Best 2.4G CH:%u\n", best_24g_ch); -+ DBG_871X_SEL_NL(m, "Best 5G CH:%u\n", best_5g_ch); -+ return 0; -+} -+ -+static ssize_t proc_set_acs(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 acs_satae = 0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhu", &acs_satae); -+ -+ if (num < 1) -+ return -EINVAL; -+ -+ if (1 == acs_satae) -+ rtw_acs_start(padapter, _TRUE); -+ else -+ rtw_acs_start(padapter, _FALSE); -+ -+ } -+ return count; -+} -+#endif -+ -+/* -+* rtw_adapter_proc: -+* init/deinit when register/unregister net_device -+*/ -+const struct rtw_proc_hdl adapter_proc_hdls [] = { -+ {"write_reg", proc_get_dummy, proc_set_write_reg}, -+ {"read_reg", proc_get_read_reg, proc_set_read_reg}, -+ {"adapters_status", proc_get_dump_adapters_status, NULL}, -+ {"fwstate", proc_get_fwstate, NULL}, -+ {"sec_info", proc_get_sec_info, NULL}, -+ {"mlmext_state", proc_get_mlmext_state, NULL}, -+ {"qos_option", proc_get_qos_option, NULL}, -+ {"ht_option", proc_get_ht_option, NULL}, -+ {"rf_info", proc_get_rf_info, NULL}, -+ {"scan_param", proc_get_scan_param, proc_set_scan_param}, -+ {"scan_abort", proc_get_scan_abort, NULL}, -+#ifdef CONFIG_SCAN_BACKOP -+ {"backop_flags_sta", proc_get_backop_flags_sta, proc_set_backop_flags_sta}, -+ {"backop_flags_ap", proc_get_backop_flags_ap, proc_set_backop_flags_ap}, -+#endif -+ {"survey_info", proc_get_survey_info, proc_set_survey_info}, -+ {"ap_info", proc_get_ap_info, NULL}, -+ {"trx_info", proc_get_trx_info, proc_reset_trx_info}, -+ {"rate_ctl", proc_get_rate_ctl, proc_set_rate_ctl}, -+ {"dis_pwt_ctl", proc_get_dis_pwt, proc_set_dis_pwt}, -+ {"mac_qinfo", proc_get_mac_qinfo, NULL}, -+ {"macid_info", proc_get_macid_info, NULL}, -+ {"sec_cam", proc_get_sec_cam, proc_set_sec_cam}, -+ {"sec_cam_cache", proc_get_sec_cam_cache, NULL}, -+ {"suspend_info", proc_get_suspend_resume_info, NULL}, -+ {"wifi_spec",proc_get_wifi_spec,NULL}, -+#ifdef CONFIG_LAYER2_ROAMING -+ {"roam_flags", proc_get_roam_flags, proc_set_roam_flags}, -+ {"roam_param", proc_get_roam_param, proc_set_roam_param}, -+ {"roam_tgt_addr", proc_get_dummy, proc_set_roam_tgt_addr}, -+#endif /* CONFIG_LAYER2_ROAMING */ -+ -+#ifdef CONFIG_SDIO_HCI -+ {"sd_f0_reg_dump", proc_get_sd_f0_reg_dump, NULL}, -+ {"sdio_local_reg_dump", proc_get_sdio_local_reg_dump, NULL}, -+#endif /* CONFIG_SDIO_HCI */ -+ -+ {"fwdl_test_case", proc_get_dummy, proc_set_fwdl_test_case}, -+ {"del_rx_ampdu_test_case", proc_get_dummy, proc_set_del_rx_ampdu_test_case}, -+ {"wait_hiq_empty", proc_get_dummy, proc_set_wait_hiq_empty}, -+ -+ {"mac_reg_dump", proc_get_mac_reg_dump, NULL}, -+ {"bb_reg_dump", proc_get_bb_reg_dump, NULL}, -+ {"rf_reg_dump", proc_get_rf_reg_dump, NULL}, -+ -+#ifdef CONFIG_AP_MODE -+ {"all_sta_info", proc_get_all_sta_info, NULL}, -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef DBG_MEMORY_LEAK -+ {"_malloc_cnt", proc_get_malloc_cnt, NULL}, -+#endif /* DBG_MEMORY_LEAK */ -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ {"best_channel", proc_get_best_channel, proc_set_best_channel}, -+#endif -+ -+ {"rx_signal", proc_get_rx_signal, proc_set_rx_signal}, -+ {"hw_info", proc_get_hw_status, NULL}, -+ -+#ifdef CONFIG_80211N_HT -+ {"ht_enable", proc_get_ht_enable, proc_set_ht_enable}, -+ {"bw_mode", proc_get_bw_mode, proc_set_bw_mode}, -+ {"ampdu_enable", proc_get_ampdu_enable, proc_set_ampdu_enable}, -+ {"rx_stbc", proc_get_rx_stbc, proc_set_rx_stbc}, -+ {"rx_ampdu", proc_get_rx_ampdu, proc_set_rx_ampdu}, -+ {"rx_ampdu_factor",proc_get_rx_ampdu_factor,proc_set_rx_ampdu_factor}, -+ {"rx_ampdu_density",proc_get_rx_ampdu_density,proc_set_rx_ampdu_density}, -+ {"tx_ampdu_density",proc_get_tx_ampdu_density,proc_set_tx_ampdu_density}, -+#endif /* CONFIG_80211N_HT */ -+ -+ {"en_fwps", proc_get_en_fwps, proc_set_en_fwps}, -+ {"mac_rptbuf", proc_get_mac_rptbuf, NULL}, -+ -+ //{"path_rssi", proc_get_two_path_rssi, NULL}, -+// {"rssi_disp",proc_get_rssi_disp, proc_set_rssi_disp}, -+ -+#ifdef CONFIG_BT_COEXIST -+ {"btcoex_dbg", proc_get_btcoex_dbg, proc_set_btcoex_dbg}, -+ {"btcoex", proc_get_btcoex_info, NULL}, -+ {"btinfo_evt", proc_get_dummy, proc_set_btinfo_evt}, -+#endif /* CONFIG_BT_COEXIST */ -+ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ {"sreset", proc_get_sreset, proc_set_sreset}, -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ {"linked_info_dump",proc_get_linked_info_dump,proc_set_linked_info_dump}, -+ -+#ifdef CONFIG_GPIO_API -+ {"gpio_info",proc_get_gpio,proc_set_gpio}, -+ {"gpio_set_output_value",proc_get_dummy,proc_set_gpio_output_value}, -+ {"gpio_set_direction",proc_get_dummy,proc_set_config_gpio}, -+#endif -+ -+#ifdef CONFIG_DBG_COUNTER -+ {"rx_logs", proc_get_rx_logs, NULL}, -+ {"tx_logs", proc_get_tx_logs, NULL}, -+ {"int_logs", proc_get_int_logs, NULL}, -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ {"rx_ring", proc_get_rx_ring, NULL}, -+ {"tx_ring", proc_get_tx_ring, NULL}, -+#endif -+#ifdef CONFIG_GPIO_WAKEUP -+ {"wowlan_gpio_info", proc_get_wowlan_gpio_info, -+ proc_set_wowlan_gpio_info}, -+#endif -+#ifdef CONFIG_P2P_WOWLAN -+ {"p2p_wowlan_info", proc_get_p2p_wowlan_info, NULL}, -+#endif -+ {"chan_plan",proc_get_chan_plan,proc_set_chan_plan}, -+#ifdef CONFIG_DFS_MASTER -+ {"dfs_master_test_case", proc_get_dfs_master_test_case, proc_set_dfs_master_test_case}, -+ {"update_non_ocp", proc_get_dummy, proc_set_update_non_ocp}, -+ {"radar_detect", proc_get_dummy, proc_set_radar_detect}, -+#endif -+ {"new_bcn_max", proc_get_new_bcn_max, proc_set_new_bcn_max}, -+ {"sink_udpport",proc_get_udpport,proc_set_udpport}, -+#ifdef DBG_RX_COUNTER_DUMP -+ {"dump_rx_cnt_mode",proc_get_rx_cnt_dump,proc_set_rx_cnt_dump}, -+#endif -+ {"change_bss_chbw", NULL, proc_set_change_bss_chbw}, -+ {"tx_power_by_rate_base", proc_get_tx_power_by_rate_base, NULL}, -+ {"tx_power_by_rate", proc_get_tx_power_by_rate, NULL}, -+ {"tx_power_limit", proc_get_tx_power_limit, NULL}, -+#ifdef CONFIG_RF_GAIN_OFFSET -+ {"tx_gain_offset", proc_get_dummy, proc_set_tx_gain_offset}, -+ {"kfree_flag", proc_get_kfree_flag, proc_set_kfree_flag}, -+ {"kfree_bb_gain", proc_get_kfree_bb_gain, proc_set_kfree_bb_gain}, -+ {"kfree_thermal", proc_get_kfree_thermal, proc_set_kfree_thermal}, -+#endif -+#ifdef CONFIG_POWER_SAVING -+ {"ps_info",proc_get_ps_info, NULL}, -+#endif -+#ifdef CONFIG_TDLS -+ {"tdls_info", proc_get_tdls_info, NULL}, -+#endif -+ {"monitor", proc_get_monitor, proc_set_monitor}, -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ {"acs", proc_get_best_chan, proc_set_acs}, -+#endif -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ {"rtkm_info", proc_get_rtkm_info, NULL} -+#endif -+ {"efuse_map", proc_get_efuse_map, NULL}, -+#ifdef CONFIG_IEEE80211W -+ {"11w_tx_sa_query", proc_get_tx_sa_query, proc_set_tx_sa_query}, -+ {"11w_tx_deauth", proc_get_tx_deauth, proc_set_tx_deauth}, -+ {"11w_tx_auth", proc_get_tx_auth, proc_set_tx_auth}, -+#endif /* CONFIG_IEEE80211W */ -+}; -+ -+const int adapter_proc_hdls_num = sizeof(adapter_proc_hdls) / sizeof(struct rtw_proc_hdl); -+ -+static int rtw_adapter_proc_open(struct inode *inode, struct file *file) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(inode); -+ const struct rtw_proc_hdl *hdl = adapter_proc_hdls+index; -+ -+ return single_open(file, hdl->show, proc_get_parent_data(inode)); -+} -+ -+static ssize_t rtw_adapter_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); -+ const struct rtw_proc_hdl *hdl = adapter_proc_hdls+index; -+ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; -+ -+ if (write) -+ return write(file, buffer, count, pos, ((struct seq_file *)file->private_data)->private); -+ -+ return -EROFS; -+} -+ -+static const struct file_operations rtw_adapter_proc_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_adapter_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_adapter_proc_write, -+}; -+ -+int proc_get_odm_dbg_comp(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_odm_dbg_comp_msg(m, adapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_odm_dbg_comp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ -+ u64 dbg_comp; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%llx", &dbg_comp); -+ -+ if (num != 1) -+ return count; -+ -+ rtw_odm_dbg_comp_set(adapter, dbg_comp); -+ } -+ -+ return count; -+} -+ -+int proc_get_odm_dbg_level(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_odm_dbg_level_msg(m, adapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_odm_dbg_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ -+ u32 dbg_level; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%u", &dbg_level); -+ -+ if (num != 1) -+ return count; -+ -+ rtw_odm_dbg_level_set(adapter, dbg_level); -+ } -+ -+ return count; -+} -+ -+int proc_get_odm_ability(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_odm_ability_msg(m, adapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_odm_ability(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ -+ u32 ability; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%x", &ability); -+ -+ if (num != 1) -+ return count; -+ -+ rtw_odm_ability_set(adapter, ability); -+ } -+ -+ return count; -+} -+ -+int proc_get_odm_adaptivity(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_odm_adaptivity_parm_msg(m, padapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_odm_adaptivity(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 TH_L2H_ini; -+ u32 TH_L2H_ini_mode2; -+ s8 TH_EDCCA_HL_diff; -+ s8 TH_EDCCA_HL_diff_mode2; -+ u8 EDCCA_enable; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%x %hhd %x %hhd %hhu", &TH_L2H_ini, &TH_EDCCA_HL_diff, &TH_L2H_ini_mode2, &TH_EDCCA_HL_diff_mode2, &EDCCA_enable); -+ -+ if (num != 5) -+ return count; -+ -+ rtw_odm_adaptivity_parm_set(padapter, (s8)TH_L2H_ini, TH_EDCCA_HL_diff, (s8)TH_L2H_ini_mode2, TH_EDCCA_HL_diff_mode2, EDCCA_enable); -+ } -+ -+ return count; -+} -+ -+static char *phydm_msg = NULL; -+#define PHYDM_MSG_LEN 80*24 -+ -+int proc_get_phydm_cmd(struct seq_file *m, void *v) -+{ -+ struct net_device *netdev; -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ PDM_ODM_T phydm; -+ -+ -+ netdev = m->private; -+ padapter = (PADAPTER)rtw_netdev_priv(netdev); -+ pHalData = GET_HAL_DATA(padapter); -+ phydm = &pHalData->odmpriv; -+ -+ if (NULL == phydm_msg) { -+ phydm_msg = rtw_zmalloc(PHYDM_MSG_LEN); -+ if (NULL == phydm_msg) -+ return -ENOMEM; -+ -+ phydm_cmd(phydm, NULL, 0, 0, phydm_msg, PHYDM_MSG_LEN); -+ } -+ -+ DBG_871X_SEL(m, "%s\n", phydm_msg); -+ -+ rtw_mfree(phydm_msg, PHYDM_MSG_LEN); -+ phydm_msg = NULL; -+ -+ return 0; -+} -+ -+ssize_t proc_set_phydm_cmd(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *netdev; -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ PDM_ODM_T phydm; -+ char tmp[64] = {0}; -+ -+ -+ netdev = (struct net_device*)data; -+ padapter = (PADAPTER)rtw_netdev_priv(netdev); -+ pHalData = GET_HAL_DATA(padapter); -+ phydm = &pHalData->odmpriv; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ if (NULL == phydm_msg) { -+ phydm_msg = rtw_zmalloc(PHYDM_MSG_LEN); -+ if (NULL == phydm_msg) -+ return -ENOMEM; -+ } else { -+ _rtw_memset(phydm_msg, 0, PHYDM_MSG_LEN); -+ } -+ -+ phydm_cmd(phydm, tmp, count, 1, phydm_msg, PHYDM_MSG_LEN); -+ -+ if (strlen(phydm_msg) == 0) { -+ rtw_mfree(phydm_msg, PHYDM_MSG_LEN); -+ phydm_msg = NULL; -+ } -+ } -+ -+ return count; -+} -+ -+/* -+* rtw_odm_proc: -+* init/deinit when register/unregister net_device, along with rtw_adapter_proc -+*/ -+const struct rtw_proc_hdl odm_proc_hdls [] = { -+ {"dbg_comp", proc_get_odm_dbg_comp, proc_set_odm_dbg_comp}, -+ {"dbg_level", proc_get_odm_dbg_level, proc_set_odm_dbg_level}, -+ {"ability", proc_get_odm_ability, proc_set_odm_ability}, -+ {"adaptivity", proc_get_odm_adaptivity, proc_set_odm_adaptivity}, -+ {"cmd", proc_get_phydm_cmd, proc_set_phydm_cmd}, -+}; -+ -+const int odm_proc_hdls_num = sizeof(odm_proc_hdls) / sizeof(struct rtw_proc_hdl); -+ -+static int rtw_odm_proc_open(struct inode *inode, struct file *file) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(inode); -+ const struct rtw_proc_hdl *hdl = odm_proc_hdls+index; -+ -+ return single_open(file, hdl->show, proc_get_parent_data(inode)); -+} -+ -+static ssize_t rtw_odm_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); -+ const struct rtw_proc_hdl *hdl = odm_proc_hdls+index; -+ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; -+ -+ if (write) -+ return write(file, buffer, count, pos, ((struct seq_file *)file->private_data)->private); -+ -+ return -EROFS; -+} -+ -+static const struct file_operations rtw_odm_proc_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_odm_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_odm_proc_write, -+}; -+ -+struct proc_dir_entry *rtw_odm_proc_init(struct net_device *dev) -+{ -+ struct proc_dir_entry *dir_odm = NULL; -+ struct proc_dir_entry *entry = NULL; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ ssize_t i; -+ -+ if (adapter->dir_dev == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (adapter->dir_odm != NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ dir_odm = rtw_proc_create_dir("odm", adapter->dir_dev, dev); -+ if (dir_odm == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ adapter->dir_odm = dir_odm; -+ -+ for (i=0;idir_odm; -+ -+ if (dir_odm == NULL) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ for (i=0;idir_dev); -+ -+ adapter->dir_odm = NULL; -+ -+ if (phydm_msg) { -+ rtw_mfree(phydm_msg, PHYDM_MSG_LEN); -+ phydm_msg = NULL; -+ } -+} -+ -+struct proc_dir_entry *rtw_adapter_proc_init(struct net_device *dev) -+{ -+ struct proc_dir_entry *drv_proc = get_rtw_drv_proc(); -+ struct proc_dir_entry *dir_dev = NULL; -+ struct proc_dir_entry *entry = NULL; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ u8 rf_type; -+ ssize_t i; -+ -+ if (drv_proc == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (adapter->dir_dev != NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ dir_dev = rtw_proc_create_dir(dev->name, drv_proc, dev); -+ if (dir_dev == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ adapter->dir_dev = dir_dev; -+ -+ for (i=0;idir_dev; -+ -+ if (dir_dev == NULL) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ for (i=0;iname, drv_proc); -+ -+ adapter->dir_dev = NULL; -+} -+ -+void rtw_adapter_proc_replace(struct net_device *dev) -+{ -+ struct proc_dir_entry *drv_proc = get_rtw_drv_proc(); -+ struct proc_dir_entry *dir_dev = NULL; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ int i; -+ -+ dir_dev = adapter->dir_dev; -+ -+ if (dir_dev == NULL) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ for (i=0;iold_ifname, drv_proc); -+ -+ adapter->dir_dev = NULL; -+ -+ rtw_adapter_proc_init(dev); -+ -+} -+ -+#endif /* CONFIG_PROC_DEBUG */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_proc.h linux/3rdparty/rtl8812au/os_dep/linux/rtw_proc.h ---- linux.old/3rdparty/rtl8812au/os_dep/linux/rtw_proc.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/rtw_proc.h 2017-06-07 23:07:21.047690856 +0300 -@@ -0,0 +1,52 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_PROC_H__ -+#define __RTW_PROC_H__ -+ -+#include -+#include -+ -+struct rtw_proc_hdl { -+ char *name; -+ int (*show)(struct seq_file *, void *); -+ ssize_t (*write)(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+}; -+ -+#ifdef CONFIG_PROC_DEBUG -+ -+struct proc_dir_entry *get_rtw_drv_proc(void); -+int rtw_drv_proc_init(void); -+void rtw_drv_proc_deinit(void); -+struct proc_dir_entry *rtw_adapter_proc_init(struct net_device *dev); -+void rtw_adapter_proc_deinit(struct net_device *dev); -+void rtw_adapter_proc_replace(struct net_device *dev); -+ -+#else //!CONFIG_PROC_DEBUG -+ -+#define get_rtw_drv_proc() NULL -+#define rtw_drv_proc_init() 0 -+#define rtw_drv_proc_deinit() do {} while (0) -+#define rtw_adapter_proc_init(dev) NULL -+#define rtw_adapter_proc_deinit(dev) do {} while (0) -+#define rtw_adapter_proc_replace(dev) do {} while (0) -+ -+#endif //!CONFIG_PROC_DEBUG -+ -+#endif //__RTW_PROC_H__ -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/rtl8812au/os_dep/linux/usb_intf.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/usb_intf.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,1682 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/usb_intf.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/usb_intf.c +--- linux-4.14.17/3rdparty/rtl8812au/os_dep/usb_intf.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/usb_intf.c 2018-02-06 17:42:30.725967387 +0200 +@@ -0,0 +1,1704 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. @@ -377172,26 +180221,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * + ******************************************************************************/ +#define _HCI_INTF_C_ + +#include -+#include -+ -+#include -+ -+#ifndef CONFIG_USB_HCI -+#error "CONFIG_USB_HCI shall be on!\n" -+#endif -+ -+#if defined (PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+#error "Shall be Linux or Windows, but not both!\n" -+#endif + +#ifdef CONFIG_80211N_HT +extern int rtw_ht_enable; @@ -377207,44 +180240,25 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r +extern int pm_netdev_open(struct net_device *pnetdev,u8 bnormal); +static int rtw_suspend(struct usb_interface *intf, pm_message_t message); +static int rtw_resume(struct usb_interface *intf); ++int rtw_resume_process(_adapter *padapter); + + +static int rtw_drv_init(struct usb_interface *pusb_intf,const struct usb_device_id *pdid); +static void rtw_dev_remove(struct usb_interface *pusb_intf); + -+static void rtw_dev_shutdown(struct device *dev) -+{ -+ struct usb_interface *usb_intf = container_of(dev, struct usb_interface, dev); -+ struct dvobj_priv *dvobj = NULL; -+ _adapter *adapter = NULL; -+ int i; -+ -+ DBG_871X("%s\n", __func__); -+ -+ if(usb_intf) -+ { -+ dvobj = usb_get_intfdata(usb_intf); -+ if (dvobj) -+ { -+ rtw_set_surprise_removed(dvobj->padapters[IFACE_ID0]); -+ ATOMIC_SET(&dvobj->continual_io_error, MAX_CONTINUAL_IO_ERR+1); -+ } -+ } -+} -+ +#if (LINUX_VERSION_CODE<=KERNEL_VERSION(2,6,23)) +/* Some useful macros to use to create struct usb_device_id */ -+ #define USB_DEVICE_ID_MATCH_VENDOR 0x0001 ++ #define USB_DEVICE_ID_MATCH_VENDOR 0x0001 + #define USB_DEVICE_ID_MATCH_PRODUCT 0x0002 -+ #define USB_DEVICE_ID_MATCH_DEV_LO 0x0004 -+ #define USB_DEVICE_ID_MATCH_DEV_HI 0x0008 ++ #define USB_DEVICE_ID_MATCH_DEV_LO 0x0004 ++ #define USB_DEVICE_ID_MATCH_DEV_HI 0x0008 + #define USB_DEVICE_ID_MATCH_DEV_CLASS 0x0010 + #define USB_DEVICE_ID_MATCH_DEV_SUBCLASS 0x0020 + #define USB_DEVICE_ID_MATCH_DEV_PROTOCOL 0x0040 + #define USB_DEVICE_ID_MATCH_INT_CLASS 0x0080 + #define USB_DEVICE_ID_MATCH_INT_SUBCLASS 0x0100 + #define USB_DEVICE_ID_MATCH_INT_PROTOCOL 0x0200 -+ #define USB_DEVICE_ID_MATCH_INT_NUMBER 0x0400 ++ #define USB_DEVICE_ID_MATCH_INT_NUMBER 0x0400 + + +#define USB_DEVICE_ID_MATCH_INT_INFO \ @@ -377292,21 +180306,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + +/* DID_USB_v916_20130116 */ +static struct usb_device_id rtw_usb_id_tbl[] ={ -+#ifdef CONFIG_RTL8188E -+ /*=== Realtek demoboard ===*/ -+ {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x8179),.driver_info = RTL8188E}, /* 8188EUS */ -+ {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x0179),.driver_info = RTL8188E}, /* 8188ETV */ -+ /*=== Customer ID ===*/ -+ /****** 8188EUS ********/ -+ {USB_DEVICE(0x07B8, 0x8179),.driver_info = RTL8188E}, /* Abocom - Abocom */ -+#endif + -+#ifdef CONFIG_RTL8812A + /*=== Realtek demoboard ===*/ + {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x8812),.driver_info = RTL8812},/* Default ID */ + {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x881A),.driver_info = RTL8812},/* Default ID */ + {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x881B),.driver_info = RTL8812},/* Default ID */ + {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x881C),.driver_info = RTL8812},/* Default ID */ ++ {USB_DEVICE(USB_VENDER_ID_REALTEK, 0xA811),.driver_info = RTL8812},/* Default ID */ + /*=== Customer ID ===*/ + {USB_DEVICE(0x050D, 0x1106),.driver_info = RTL8812}, /* Belkin - sercomm */ + {USB_DEVICE(0x2001, 0x330E),.driver_info = RTL8812}, /* D-Link - ALPHA */ @@ -377320,62 +180326,29 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + {USB_DEVICE(0x0586, 0x3426),.driver_info = RTL8812}, /* ZyXEL - */ + {USB_DEVICE(0x2001, 0x3313),.driver_info = RTL8812}, /* D-Link - ALPHA */ + {USB_DEVICE(0x1058, 0x0632),.driver_info = RTL8812}, /* WD - Cybertan*/ ++ {USB_DEVICE(0x13b1, 0x003f),.driver_info = RTL8812}, /* Linksys WUSB6300 */ + {USB_DEVICE(0x1740, 0x0100),.driver_info = RTL8812}, /* EnGenius - EnGenius */ + {USB_DEVICE(0x2019, 0xAB30),.driver_info = RTL8812}, /* Planex - Abocom */ + {USB_DEVICE(0x07B8, 0x8812),.driver_info = RTL8812}, /* Abocom - Abocom */ + {USB_DEVICE(0x2001, 0x3315),.driver_info = RTL8812}, /* D-Link - Cameo */ + {USB_DEVICE(0x2001, 0x3316),.driver_info = RTL8812}, /* D-Link - Cameo */ -+ {USB_DEVICE(0x13b1, 0x003f),.driver_info = RTL8812}, /* Linksys - WUSB6300 */ -+ {USB_DEVICE(0x2357, 0x0101),.driver_info = RTL8812}, /* TP-Link - T4U */ -+ {USB_DEVICE(0x2357, 0x0103),.driver_info = RTL8812}, /* TP-Link - T4UH */ -+#endif ++ {USB_DEVICE(0x20f4, 0x805b),.driver_info = RTL8812}, /* TRENDnet - */ ++ {USB_DEVICE(0x2357, 0x0101),.driver_info = RTL8812}, /* TP-Link - Archer T4U */ ++ {USB_DEVICE(0x0411, 0x025d),.driver_info = RTL8812}, /* Buffalo - WI-U3-866D */ + -+#ifdef CONFIG_RTL8821A + /*=== Realtek demoboard ===*/ + {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x0811),.driver_info = RTL8821},/* Default ID */ + {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x0821),.driver_info = RTL8821},/* Default ID */ + {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x8822),.driver_info = RTL8821},/* Default ID */ -+ {USB_DEVICE(USB_VENDER_ID_REALTEK, 0xA811) , .driver_info = RTL8821},/* Default ID */ -+ {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x0820,0xff,0xff,0xff),.driver_info = RTL8821}, /* 8821AU */ -+ {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x0823,0xff,0xff,0xff),.driver_info = RTL8821}, /* 8821AU */ + /*=== Customer ID ===*/ + {USB_DEVICE(0x7392, 0xA811),.driver_info = RTL8821}, /* Edimax - Edimax */ -+ {USB_DEVICE(0x7392, 0xA812),.driver_info = RTL8821}, /* Edimax - Edimax */ -+ {USB_DEVICE(0x04BB, 0x0953),.driver_info = RTL8821}, /* I-O DATA - Edimax */ ++ {USB_DEVICE(0x7392, 0xA812),.driver_info = RTL8821}, /* Edimax - EW-7811UTC */ ++ {USB_DEVICE(0x7392, 0xA813),.driver_info = RTL8821}, /* Edimax - EW-7811UAC */ + {USB_DEVICE(0x2001, 0x3314),.driver_info = RTL8821}, /* D-Link - Cameo */ -+ {USB_DEVICE(0x2001, 0x3318),.driver_info = RTL8821}, /* D-Link - Cameo */ -+ {USB_DEVICE(0x0E66, 0x0023),.driver_info = RTL8821}, /* HAWKING - Edimax */ -+ {USB_DEVICE(0x056E, 0x400E) , .driver_info = RTL8821}, /* ELECOM - ELECOM */ -+ {USB_DEVICE(0x056E, 0x400F) , .driver_info = RTL8821}, /* ELECOM - ELECOM */ + {USB_DEVICE(0x0846, 0x9052),.driver_info = RTL8821}, /* Netgear - A6100 */ -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ /*=== Realtek demoboard ===*/ -+ {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x818B,0xff,0xff,0xff),.driver_info = RTL8192E},/* Default ID */ -+ {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x818C,0xff,0xff,0xff),.driver_info = RTL8192E},/* Default ID */ -+#endif -+ -+#ifdef CONFIG_RTL8723B -+ //*=== Realtek demoboard ===*/ -+ {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xB720,0xff,0xff,0xff),.driver_info = RTL8723B}, /* 8723BU 1*1 */ -+ //{USB_DEVICE(USB_VENDER_ID_REALTEK, 0xB720),.driver_info = RTL8723B}, /* 8723BU */ -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ -+ {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x8813),.driver_info = RTL8814A}, -+ {USB_DEVICE(0x2001, 0x331a), .driver_info = RTL8814A}, /* D-Link - D-Link */ -+ {USB_DEVICE(0x0b05, 0x1817), .driver_info = RTL8814A}, /* ASUS - ASUSTeK */ -+ {USB_DEVICE(0x056E, 0x400B), .driver_info = RTL8814A}, /* ELECOM - ELECOM */ -+ {USB_DEVICE(0x056E, 0x400D), .driver_info = RTL8814A}, /* ELECOM - ELECOM */ -+ {USB_DEVICE(0x7392, 0xA834), .driver_info = RTL8814A}, /* Edimax - Edimax */ -+#endif /* CONFIG_RTL8814A */ -+ -+#ifdef CONFIG_RTL8188F -+ /*=== Realtek demoboard ===*/ -+ {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xF179, 0xff, 0xff, 0xff), .driver_info = RTL8188F}, /* 8188FU 1*1 */ -+#endif ++ {USB_DEVICE(0x2019, 0xAB32),.driver_info = RTL8821}, /* Planex - GW-450S */ ++ {USB_DEVICE(0x0411, 0x0242),.driver_info = RTL8821}, /* BUFFALO - Edimax */ ++ {USB_DEVICE(0x056E, 0x4007),.driver_info = RTL8821}, /* ELECOM - WDC-433DU2H */ + + {} /* Terminating entry */ +}; @@ -377390,10 +180363,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + {.idVendor=0x0b05, .idProduct=0x1791, .flags=SPEC_DEV_ID_DISABLE_HT}, + {.idVendor=0x13D3, .idProduct=0x3311, .flags=SPEC_DEV_ID_DISABLE_HT}, + {.idVendor=0x13D3, .idProduct=0x3359, .flags=SPEC_DEV_ID_DISABLE_HT},//Russian customer -Azwave (8188CE-VAU g mode) -+#ifdef RTK_DMP_PLATFORM -+ {.idVendor=USB_VENDER_ID_REALTEK, .idProduct=0x8111, .flags=SPEC_DEV_ID_ASSIGN_IFNAME}, // Realtek 5G dongle for WiFi Display -+ {.idVendor=0x2019, .idProduct=0xAB2D, .flags=SPEC_DEV_ID_ASSIGN_IFNAME}, // PCI-Abocom 5G dongle for WiFi Display -+#endif /* RTK_DMP_PLATFORM */ + {} +}; + @@ -377411,17 +180380,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + .usbdrv.suspend = rtw_suspend, + .usbdrv.resume = rtw_resume, + #if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 22)) -+ .usbdrv.reset_resume = rtw_resume, ++ .usbdrv.reset_resume = rtw_resume, + #endif + #ifdef CONFIG_AUTOSUSPEND + .usbdrv.supports_autosuspend = 1, + #endif -+ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 19)) -+ .usbdrv.drvwrap.driver.shutdown = rtw_dev_shutdown, -+ #else -+ .usbdrv.driver.shutdown = rtw_dev_shutdown, -+ #endif +}; + +static inline int RT_usb_endpoint_dir_in(const struct usb_endpoint_descriptor *epd) @@ -377441,7 +180404,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + +static inline int RT_usb_endpoint_xfer_bulk(const struct usb_endpoint_descriptor *epd) +{ -+ return ((epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_BULK); ++ return ((epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_BULK); +} + +static inline int RT_usb_endpoint_is_bulk_in(const struct usb_endpoint_descriptor *epd) @@ -377504,49 +180467,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + + return rst; +} -+static void rtw_decide_chip_type_by_usb_info(struct dvobj_priv *pdvobjpriv, const struct usb_device_id *pdid) -+{ -+ pdvobjpriv->chip_type = pdid->driver_info; + -+ #ifdef CONFIG_RTL8188E -+ if (pdvobjpriv->chip_type == RTL8188E) -+ rtl8188eu_set_hw_type(pdvobjpriv); -+ #endif -+ -+ #if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ if (pdvobjpriv->chip_type == RTL8812 || pdvobjpriv->chip_type == RTL8821) -+ rtl8812au_set_hw_type(pdvobjpriv); -+ #endif -+ -+ #ifdef CONFIG_RTL8192E -+ if (pdvobjpriv->chip_type == RTL8192E) -+ rtl8192eu_set_hw_type(pdvobjpriv); -+ #endif -+ -+ #ifdef CONFIG_RTL8723B -+ if (pdvobjpriv->chip_type == RTL8723B) -+ rtl8723bu_set_hw_type(pdvobjpriv); -+ #endif -+ -+ #ifdef CONFIG_RTL8814A -+ if (pdvobjpriv->chip_type == RTL8814A) -+ rtl8814au_set_hw_type(pdvobjpriv); -+ #endif /* CONFIG_RTL8814A */ -+ -+ #ifdef CONFIG_RTL8188F -+ if (pdvobjpriv->chip_type == RTL8188F) -+ rtl8188fu_set_hw_type(pdvobjpriv); -+ #endif -+ -+} -+ -+static struct dvobj_priv *usb_dvobj_init(struct usb_interface *usb_intf, const struct usb_device_id *pdid) ++static struct dvobj_priv *usb_dvobj_init(struct usb_interface *usb_intf) +{ + int i; + u8 val8; + int status = _FAIL; + struct dvobj_priv *pdvobjpriv; -+ struct usb_device_descriptor *pdev_desc; ++ struct usb_device_descriptor *pdev_desc; + struct usb_host_config *phost_conf; + struct usb_config_descriptor *pconf_desc; + struct usb_host_interface *phost_iface; @@ -377555,13 +180483,21 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + struct usb_endpoint_descriptor *pendp_desc; + struct usb_device *pusbd; + -+_func_enter_; + + -+ if((pdvobjpriv = devobj_init()) == NULL) { ++ if ((pdvobjpriv = (struct dvobj_priv*)rtw_zmalloc(sizeof(*pdvobjpriv))) == NULL) { + goto exit; + } + ++ _rtw_mutex_init(&pdvobjpriv->hw_init_mutex); ++ _rtw_mutex_init(&pdvobjpriv->h2c_fwcmd_mutex); ++ _rtw_mutex_init(&pdvobjpriv->setch_mutex); ++ _rtw_mutex_init(&pdvobjpriv->setbw_mutex); ++ ++ _rtw_spinlock_init(&pdvobjpriv->lock); ++ ++ pdvobjpriv->macid[1] = true; //macid=1 for bc/mc stainfo ++ + + pdvobjpriv->pusbintf = usb_intf ; + pusbd = pdvobjpriv->pusbdev = interface_to_usbdev(usb_intf); @@ -377708,13 +180644,9 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + goto free_dvobj; + } + -+ /*step 1-1., decide the chip_type via driver_info*/ -+ pdvobjpriv->interface_type = RTW_USB; -+ rtw_decide_chip_type_by_usb_info(pdvobjpriv, pdid); -+ + //.3 misc + _rtw_init_sema(&(pdvobjpriv->usb_suspend_sema), 0); -+ rtw_reset_continual_io_error(pdvobjpriv); ++ rtw_reset_continual_urb_error(pdvobjpriv); + + usb_get_dev(pusbd); + @@ -377723,13 +180655,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r +free_dvobj: + if (status != _SUCCESS && pdvobjpriv) { + usb_set_intfdata(usb_intf, NULL); -+ -+ devobj_deinit(pdvobjpriv); -+ ++ _rtw_spinlock_free(&pdvobjpriv->lock); ++ _rtw_mutex_free(&pdvobjpriv->hw_init_mutex); ++ _rtw_mutex_free(&pdvobjpriv->h2c_fwcmd_mutex); ++ _rtw_mutex_free(&pdvobjpriv->setch_mutex); ++ _rtw_mutex_free(&pdvobjpriv->setbw_mutex); ++ rtw_mfree((u8*)pdvobjpriv, sizeof(*pdvobjpriv)); + pdvobjpriv = NULL; + } +exit: -+_func_exit_; ++ + return pdvobjpriv; +} + @@ -377737,7 +180672,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r +{ + struct dvobj_priv *dvobj = usb_get_intfdata(usb_intf); + -+_func_enter_; ++ + + usb_set_intfdata(usb_intf, NULL); + if (dvobj) { @@ -377751,145 +180686,40 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + usb_reset_device(interface_to_usbdev(usb_intf)); + } + } -+ + rtw_deinit_intf_priv(dvobj); -+ -+ devobj_deinit(dvobj); ++ _rtw_spinlock_free(&dvobj->lock); ++ _rtw_mutex_free(&dvobj->hw_init_mutex); ++ _rtw_mutex_free(&dvobj->h2c_fwcmd_mutex); ++ _rtw_mutex_free(&dvobj->setch_mutex); ++ _rtw_mutex_free(&dvobj->setbw_mutex); ++ rtw_mfree((u8*)dvobj, sizeof(*dvobj)); + } + + //DBG_871X("%s %d\n", __func__, ATOMIC_READ(&usb_intf->dev.kobj.kref.refcount)); + usb_put_dev(interface_to_usbdev(usb_intf)); + -+_func_exit_; ++ +} + -+static int usb_reprobe_switch_usb_mode(PADAPTER Adapter) ++static void rtw_decide_chip_type_by_usb_info(_adapter *padapter, const struct usb_device_id *pdid) +{ -+ struct registry_priv *registry_par = &Adapter->registrypriv; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int ret = _FALSE; ++ padapter->chip_type = pdid->driver_info; + -+ /* efuse not allow driver to switch usb mode */ -+ if (pHalData->EEPROMUsbSwitch == _FALSE) -+ goto exit; -+ -+ /* registry not allow driver to switch usb mode */ -+ if (registry_par->switch_usb_mode == 0) -+ goto exit; -+ -+ /* U2 to U3 */ -+ if (registry_par->switch_usb_mode == 1) { -+ if (IS_HIGH_SPEED_USB(Adapter)) { -+ if ((rtw_read8(Adapter, 0x74) & (BIT(2)|BIT(3))) != BIT(3)) { -+ rtw_write8(Adapter, 0x74, 0x8); -+ rtw_write8(Adapter, 0x70, 0x2); -+ rtw_write8(Adapter, 0x3e, 0x1); -+ rtw_write8(Adapter, 0x3d, 0x3); -+ /* usb disconnect */ -+ rtw_write8(Adapter, 0x5, 0x80); -+ ret = _TRUE; -+ } -+ -+ } else if (IS_SUPER_SPEED_USB(Adapter)) { -+ rtw_write8(Adapter, 0x70, rtw_read8(Adapter, 0x70) & (~BIT(1))); -+ rtw_write8(Adapter, 0x3e, rtw_read8(Adapter, 0x3e) & (~BIT(0))); -+ } -+ } else if (registry_par->switch_usb_mode == 2) { -+ /* U3 to U2 */ -+ if (IS_SUPER_SPEED_USB(Adapter)) { -+ if ((rtw_read8(Adapter, 0x74) & (BIT(2)|BIT(3))) != BIT(2)) { -+ rtw_write8(Adapter, 0x74, 0x4); -+ rtw_write8(Adapter, 0x70, 0x2); -+ rtw_write8(Adapter, 0x3e, 0x1); -+ rtw_write8(Adapter, 0x3d, 0x3); -+ /* usb disconnect */ -+ rtw_write8(Adapter, 0x5, 0x80); -+ ret = _TRUE; -+ } -+ } else if (IS_HIGH_SPEED_USB(Adapter)) { -+ rtw_write8(Adapter, 0x70, rtw_read8(Adapter, 0x70) & (~BIT(1))); -+ rtw_write8(Adapter, 0x3e, rtw_read8(Adapter, 0x3e) & (~BIT(0))); -+ } -+ } -+ -+exit: -+ return ret; ++ if(padapter->chip_type == RTL8812 || padapter->chip_type == RTL8821) ++ rtl8812au_set_hw_type(padapter); +} -+ -+u8 rtw_set_hal_ops(_adapter *padapter) ++void rtw_set_hal_ops(_adapter *padapter) +{ -+ //alloc memory for HAL DATA -+ if (rtw_hal_data_init(padapter) == _FAIL) -+ return _FAIL; -+ -+ #ifdef CONFIG_RTL8188E -+ if (rtw_get_chip_type(padapter) == RTL8188E) -+ rtl8188eu_set_hal_ops(padapter); -+ #endif -+ -+ #if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ if (rtw_get_chip_type(padapter) == RTL8812 || rtw_get_chip_type(padapter) == RTL8821) ++ if(padapter->chip_type == RTL8812 || padapter->chip_type == RTL8821) + rtl8812au_set_hal_ops(padapter); -+ #endif -+ -+ #ifdef CONFIG_RTL8192E -+ if (rtw_get_chip_type(padapter) == RTL8192E) -+ rtl8192eu_set_hal_ops(padapter); -+ #endif -+ #ifdef CONFIG_RTL8723B -+ if (rtw_get_chip_type(padapter) == RTL8723B) -+ rtl8723bu_set_hal_ops(padapter); -+ #endif -+ #ifdef CONFIG_RTL8814A -+ if (rtw_get_chip_type(padapter) == RTL8814A) -+ rtl8814au_set_hal_ops(padapter); -+ #endif /* CONFIG_RTL8814A */ -+ -+ #ifdef CONFIG_RTL8188F -+ if (rtw_get_chip_type(padapter) == RTL8188F) -+ rtl8188fu_set_hal_ops(padapter); -+ #endif -+ -+ if (_FAIL == rtw_hal_ops_check(padapter) ) -+ return _FAIL; -+ -+ return _SUCCESS; +} + +void usb_set_intf_ops(_adapter *padapter,struct _io_ops *pops) +{ -+ #ifdef CONFIG_RTL8188E -+ if (rtw_get_chip_type(padapter) == RTL8188E) -+ rtl8188eu_set_intf_ops(pops); -+ #endif -+ -+ #if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ if (rtw_get_chip_type(padapter) == RTL8812 || rtw_get_chip_type(padapter) == RTL8821) ++ if(padapter->chip_type == RTL8812 || padapter->chip_type == RTL8821) + rtl8812au_set_intf_ops(pops); -+ #endif -+ -+ #ifdef CONFIG_RTL8192E -+ if (rtw_get_chip_type(padapter) == RTL8192E) -+ rtl8192eu_set_intf_ops(pops); -+ #endif -+ -+ #ifdef CONFIG_RTL8723B -+ if (rtw_get_chip_type(padapter) == RTL8723B) -+ rtl8723bu_set_intf_ops(pops); -+ #endif -+ -+ #ifdef CONFIG_RTL8814A -+ if (rtw_get_chip_type(padapter) == RTL8814A) -+ rtl8814au_set_intf_ops(pops); -+ #endif /* CONFIG_RTL8814A */ -+ -+ #ifdef CONFIG_RTL8188F -+ if (rtw_get_chip_type(padapter) == RTL8188F) -+ rtl8188fu_set_intf_ops(pops); -+ #endif +} + -+ +static void usb_intf_start(_adapter *padapter) +{ + @@ -377907,10 +180737,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + RT_TRACE(_module_hci_intfs_c_,_drv_err_,("+usb_intf_stop\n")); + + //disabel_hw_interrupt -+ if (!rtw_is_surprise_removed(padapter)) { ++ if(padapter->bSurpriseRemoved == false) ++ { + //device still exists, so driver can do i/o operation + //TODO: -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("SurpriseRemoved==_FALSE\n")); ++ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("SurpriseRemoved==false\n")); + } + + //cancel in irp @@ -377925,6 +180756,65 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + +} + ++static void rtw_dev_unload(_adapter *padapter) ++{ ++ struct net_device *pnetdev= (struct net_device*)padapter->pnetdev; ++ u8 val8; ++ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("+rtw_dev_unload\n")); ++ ++ if(padapter->bup == true) ++ { ++ DBG_871X("===> rtw_dev_unload\n"); ++ ++ padapter->bDriverStopped = true; ++ #ifdef CONFIG_XMIT_ACK ++ if (padapter->xmitpriv.ack_tx) ++ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP); ++ #endif ++ ++ //s3. ++ if(padapter->intf_stop) ++ { ++ padapter->intf_stop(padapter); ++ } ++ ++ //s4. ++ if(!padapter->pwrctrlpriv.bInternalAutoSuspend ) ++ rtw_stop_drv_threads(padapter); ++ ++ ++ //s5. ++ if(padapter->bSurpriseRemoved == false) ++ { ++ //DBG_871X("r871x_dev_unload()->rtl871x_hal_deinit()\n"); ++#ifdef CONFIG_WOWLAN ++ if((padapter->pwrctrlpriv.bSupportRemoteWakeup==true)&&(padapter->pwrctrlpriv.wowlan_mode==true)){ ++ DBG_871X("%s bSupportWakeOnWlan==true do not run rtw_hal_deinit()\n",__FUNCTION__); ++ } ++ else ++#endif //CONFIG_WOWLAN ++ { ++ rtw_hal_deinit(padapter); ++ } ++ padapter->bSurpriseRemoved = true; ++ } ++ ++ padapter->bup = false; ++#ifdef CONFIG_WOWLAN ++ padapter->hw_init_completed=false; ++#endif //CONFIG_WOWLAN ++ } ++ else ++ { ++ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("r871x_dev_unload():padapter->bup == false\n" )); ++ } ++ ++ DBG_871X("<=== rtw_dev_unload\n"); ++ ++ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("-rtw_dev_unload\n")); ++ ++} ++ +static void process_spec_devid(const struct usb_device_id *pdid) +{ + u16 vid, pid; @@ -377947,89 +180837,80 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + } +#endif + -+#ifdef RTK_DMP_PLATFORM -+ // Change the ifname to wlan10 when PC side WFD dongle plugin on DMP platform. -+ // It is used to distinguish between normal and PC-side wifi dongle/module. -+ if((pdid->idVendor==vid) && (pdid->idProduct==pid) && (flags&SPEC_DEV_ID_ASSIGN_IFNAME)) -+ { -+ extern char* ifname; -+ strncpy(ifname, "wlan10", 6); -+ //DBG_871X("%s()-%d: ifname=%s, vid=%04X, pid=%04X\n", __FUNCTION__, __LINE__, ifname, vid, pid); -+ } -+#endif /* RTK_DMP_PLATFORM */ -+ + } +} + +#ifdef SUPPORT_HW_RFOFF_DETECTED +int rtw_hw_suspend(_adapter *padapter ) +{ -+ struct pwrctrl_priv *pwrpriv; -+ struct usb_interface *pusb_intf; -+ struct net_device *pnetdev; ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; ++ struct usb_interface *pusb_intf = adapter_to_dvobj(padapter)->pusbintf; ++ struct net_device *pnetdev = padapter->pnetdev; + -+ _func_enter_; -+ if(NULL==padapter) -+ goto error_exit; + -+ if ((_FALSE == padapter->bup) || RTW_CANNOT_RUN(padapter)) { -+ DBG_871X("padapter->bup=%d bDriverStopped=%s bSurpriseRemoved = %s\n" -+ , padapter->bup -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False"); ++ ++ if((!padapter->bup) || (padapter->bDriverStopped)||(padapter->bSurpriseRemoved)) ++ { ++ DBG_871X("padapter->bup=%d bDriverStopped=%d bSurpriseRemoved = %d\n", ++ padapter->bup, padapter->bDriverStopped,padapter->bSurpriseRemoved); + goto error_exit; + } -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ pusb_intf = adapter_to_dvobj(padapter)->pusbintf; -+ pnetdev = padapter->pnetdev; -+ -+ LeaveAllPowerSaveMode(padapter); + -+ DBG_871X("==> rtw_hw_suspend\n"); -+ _enter_pwrlock(&pwrpriv->lock); -+ pwrpriv->bips_processing = _TRUE; -+ //padapter->net_closed = _TRUE; -+ //s1. -+ if(pnetdev) ++ if(padapter)//system suspend + { -+ netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ } ++ LeaveAllPowerSaveMode(padapter); + -+ //s2. -+ rtw_disassoc_cmd(padapter, 500, _FALSE); -+ -+ //s2-2. indicate disconnect to os -+ //rtw_indicate_disconnect(padapter); -+ { -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ if(check_fwstate(pmlmepriv, _FW_LINKED)) ++ DBG_871X("==> rtw_hw_suspend\n"); ++ _enter_pwrlock(&pwrpriv->lock); ++ pwrpriv->bips_processing = true; ++ //padapter->net_closed = true; ++ //s1. ++ if(pnetdev) + { -+ _clr_fwstate_(pmlmepriv, _FW_LINKED); -+ rtw_led_control(padapter, LED_CTL_NO_LINK); -+ -+ rtw_os_indicate_disconnect(padapter); -+ -+ #ifdef CONFIG_LPS -+ //donnot enqueue cmd -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_DISCONNECT, 0); -+ #endif ++ netif_carrier_off(pnetdev); ++ rtw_netif_stop_queue(pnetdev); + } -+ } -+ //s2-3. -+ rtw_free_assoc_resources(padapter, 1); + -+ //s2-4. -+ rtw_free_network_queue(padapter,_TRUE); -+ #ifdef CONFIG_IPS -+ rtw_ips_dev_unload(padapter); -+ #endif -+ pwrpriv->rf_pwrstate = rf_off; -+ pwrpriv->bips_processing = _FALSE; -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ _func_exit_; ++ //s2. ++ rtw_disassoc_cmd(padapter, 500, false); ++ ++ //s2-2. indicate disconnect to os ++ //rtw_indicate_disconnect(padapter); ++ { ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ ++ if(check_fwstate(pmlmepriv, _FW_LINKED)) ++ { ++ _clr_fwstate_(pmlmepriv, _FW_LINKED); ++ ++ rtw_led_control(padapter, LED_CTL_NO_LINK); ++ ++ rtw_os_indicate_disconnect(padapter); ++ ++ #ifdef CONFIG_LPS ++ //donnot enqueue cmd ++ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_DISCONNECT, 0); ++ #endif ++ } ++ ++ } ++ //s2-3. ++ rtw_free_assoc_resources(padapter, 1); ++ ++ //s2-4. ++ rtw_free_network_queue(padapter,true); ++ #ifdef CONFIG_IPS ++ rtw_ips_dev_unload(padapter); ++ #endif ++ pwrpriv->rf_pwrstate = rf_off; ++ pwrpriv->bips_processing = false; ++ ++ _exit_pwrlock(&pwrpriv->lock); ++ } ++ else ++ goto error_exit; ++ ++ + return 0; + +error_exit: @@ -378040,35 +180921,47 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + +int rtw_hw_resume(_adapter *padapter) +{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + struct usb_interface *pusb_intf = adapter_to_dvobj(padapter)->pusbintf; + struct net_device *pnetdev = padapter->pnetdev; + -+ _func_enter_; -+ DBG_871X("==> rtw_hw_resume\n"); -+ _enter_pwrlock(&pwrpriv->lock); -+ pwrpriv->bips_processing = _TRUE; -+ rtw_reset_drv_sw(padapter); + -+ if(pm_netdev_open(pnetdev,_FALSE) != 0) ++ ++ if(padapter)//system resume + { ++ DBG_871X("==> rtw_hw_resume\n"); ++ _enter_pwrlock(&pwrpriv->lock); ++ pwrpriv->bips_processing = true; ++ rtw_reset_drv_sw(padapter); ++ ++ if(pm_netdev_open(pnetdev,false) != 0) ++ { ++ _exit_pwrlock(&pwrpriv->lock); ++ goto error_exit; ++ } ++ ++ netif_device_attach(pnetdev); ++ netif_carrier_on(pnetdev); ++ ++ if(!rtw_netif_queue_stopped(pnetdev)) ++ rtw_netif_start_queue(pnetdev); ++ else ++ rtw_netif_wake_queue(pnetdev); ++ ++ pwrpriv->bkeepfwalive = false; ++ pwrpriv->brfoffbyhw = false; ++ ++ pwrpriv->rf_pwrstate = rf_on; ++ pwrpriv->bips_processing = false; ++ + _exit_pwrlock(&pwrpriv->lock); ++ } ++ else ++ { + goto error_exit; + } + -+ netif_device_attach(pnetdev); -+ netif_carrier_on(pnetdev); + -+ rtw_netif_wake_queue(pnetdev); -+ -+ pwrpriv->bkeepfwalive = _FALSE; -+ pwrpriv->brfoffbyhw = _FALSE; -+ -+ pwrpriv->rf_pwrstate = rf_on; -+ pwrpriv->bips_processing = _FALSE; -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ _func_exit_; + + return 0; +error_exit: @@ -378079,117 +180972,117 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + +static int rtw_suspend(struct usb_interface *pusb_intf, pm_message_t message) +{ -+ struct dvobj_priv *dvobj; -+ struct pwrctrl_priv *pwrpriv; -+ struct debug_priv *pdbgpriv; -+ PADAPTER padapter; ++ struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf); ++ _adapter *padapter = dvobj->if1; ++ struct net_device *pnetdev = padapter->pnetdev; ++ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; ++ struct usb_device *usb_dev = interface_to_usbdev(pusb_intf); ++#ifdef CONFIG_WOWLAN ++ struct wowlan_ioctl_param poidparam; ++#endif // CONFIG_WOWLAN ++ + int ret = 0; ++ u32 start_time = rtw_get_current_time(); + + -+ dvobj = usb_get_intfdata(pusb_intf); -+ pwrpriv = dvobj_to_pwrctl(dvobj); -+ pdbgpriv = &dvobj->drv_dbg; -+ padapter = dvobj->padapters[IFACE_ID0]; + -+ if (pwrpriv->bInSuspend == _TRUE) { -+ DBG_871X("%s bInSuspend = %d\n", __FUNCTION__, pwrpriv->bInSuspend); -+ pdbgpriv->dbg_suspend_error_cnt++; ++ DBG_871X("==> %s (%s:%d)\n",__FUNCTION__, current->comm, current->pid); ++ ++#ifdef CONFIG_WOWLAN ++ if (check_fwstate(pmlmepriv, _FW_LINKED)) ++ padapter->pwrctrlpriv.wowlan_mode = true; ++ else ++ padapter->pwrctrlpriv.wowlan_mode = false; ++#endif ++ ++ if((!padapter->bup) || (padapter->bDriverStopped)||(padapter->bSurpriseRemoved)) ++ { ++ DBG_871X("padapter->bup=%d bDriverStopped=%d bSurpriseRemoved = %d\n", ++ padapter->bup, padapter->bDriverStopped,padapter->bSurpriseRemoved); + goto exit; + } + -+ if ((padapter->bup) || !rtw_is_drv_stopped(padapter) || !rtw_is_surprise_removed(padapter)) { -+#ifdef CONFIG_AUTOSUSPEND -+ if(pwrpriv->bInternalAutoSuspend ){ -+ -+ #ifdef SUPPORT_HW_RFOFF_DETECTED -+ // The FW command register update must after MAC and FW init ready. -+ if((padapter->bFWReady) && (pwrpriv->bHWPwrPindetect ) && (padapter->registrypriv.usbss_enable )) -+ { -+ u8 bOpen = _TRUE; -+ rtw_interface_ps_func(padapter,HAL_USB_SELECT_SUSPEND,&bOpen); -+ } -+ #endif//SUPPORT_HW_RFOFF_DETECTED -+ } -+#endif//CONFIG_AUTOSUSPEND -+ } -+ -+ ret = rtw_suspend_common(padapter); -+ -+exit: -+ return ret; -+} -+ -+int rtw_resume_process(_adapter *padapter) -+{ -+ int ret,pm_cnt = 0; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *pdvobj = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &pdvobj->drv_dbg; -+ -+ -+ if (pwrpriv->bInSuspend == _FALSE) -+ { -+ pdbgpriv->dbg_resume_error_cnt++; -+ DBG_871X("%s bInSuspend = %d\n", __FUNCTION__, pwrpriv->bInSuspend); -+ return -1; -+ } -+ -+#if defined(CONFIG_BT_COEXIST) && defined(CONFIG_AUTOSUSPEND) //add by amy for 8723as-vau -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,32)) -+ DBG_871X("%s...pm_usage_cnt(%d) pwrpriv->bAutoResume=%x. ....\n",__func__,atomic_read(&(adapter_to_dvobj(padapter)->pusbintf->pm_usage_cnt)),pwrpriv->bAutoResume); -+ pm_cnt=atomic_read(&(adapter_to_dvobj(padapter)->pusbintf->pm_usage_cnt)); -+#else // kernel < 2.6.32 -+ DBG_871X("...pm_usage_cnt(%d).....\n", adapter_to_dvobj(padapter)->pusbintf->pm_usage_cnt); -+ pm_cnt = adapter_to_dvobj(padapter)->pusbintf->pm_usage_cnt; -+#endif // kernel < 2.6.32 -+ -+ DBG_871X("pwrpriv->bAutoResume (%x)\n",pwrpriv->bAutoResume ); -+ if( _TRUE == pwrpriv->bAutoResume ){ -+ pwrpriv->bInternalAutoSuspend = _FALSE; -+ pwrpriv->bAutoResume=_FALSE; -+ DBG_871X("pwrpriv->bAutoResume (%x) pwrpriv->bInternalAutoSuspend(%x)\n",pwrpriv->bAutoResume,pwrpriv->bInternalAutoSuspend ); -+ -+ } -+#endif //#ifdef CONFIG_BT_COEXIST &CONFIG_AUTOSUSPEND& -+ -+#if defined (CONFIG_WOWLAN) || defined (CONFIG_AP_WOWLAN) -+ /* -+ * Due to usb wow suspend flow will cancel read/write port via intf_stop and -+ * bReadPortCancel and bWritePortCancel are set _TRUE in intf_stop. -+ * But they will not be clear in intf_start during wow resume flow. -+ * It should move to os_intf in the feature. -+ */ -+ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); -+#endif -+ -+ ret = rtw_resume_common(padapter); -+ -+ #ifdef CONFIG_AUTOSUSPEND + if(pwrpriv->bInternalAutoSuspend ) + { -+ #ifdef SUPPORT_HW_RFOFF_DETECTED -+ // The FW command register update must after MAC and FW init ready. -+ if((padapter->bFWReady) && (pwrpriv->bHWPwrPindetect) && (padapter->registrypriv.usbss_enable )) ++ #ifdef CONFIG_AUTOSUSPEND ++ #ifdef SUPPORT_HW_RFOFF_DETECTED ++ // The FW command register update must after MAC and FW init ready. ++ if((padapter->bFWReady) && ( padapter->pwrctrlpriv.bHWPwrPindetect ) && (padapter->registrypriv.usbss_enable )) + { -+ u8 bOpen = _FALSE; ++ u8 bOpen = true; + rtw_interface_ps_func(padapter,HAL_USB_SELECT_SUSPEND,&bOpen); -+ } -+ #endif -+ #ifdef CONFIG_BT_COEXIST // for 8723as-vau -+ DBG_871X("pwrpriv->bAutoResume (%x)\n",pwrpriv->bAutoResume ); -+ if( _TRUE == pwrpriv->bAutoResume ){ -+ pwrpriv->bInternalAutoSuspend = _FALSE; -+ pwrpriv->bAutoResume=_FALSE; -+ DBG_871X("pwrpriv->bAutoResume (%x) pwrpriv->bInternalAutoSuspend(%x)\n",pwrpriv->bAutoResume,pwrpriv->bInternalAutoSuspend ); ++ //rtl8192c_set_FwSelectSuspend_cmd(padapter,true ,500);//note fw to support hw power down ping detect + } -+ -+ #else //#ifdef CONFIG_BT_COEXIST -+ pwrpriv->bInternalAutoSuspend = _FALSE; -+ #endif //#ifdef CONFIG_BT_COEXIST -+ pwrpriv->brfoffbyhw = _FALSE; ++ #endif ++ #endif + } -+ #endif//CONFIG_AUTOSUSPEND ++ pwrpriv->bInSuspend = true; ++ rtw_cancel_all_timer(padapter); ++ LeaveAllPowerSaveMode(padapter); ++ ++ _enter_pwrlock(&pwrpriv->lock); ++ //padapter->net_closed = true; ++ //s1. ++ if(pnetdev) ++ { ++ netif_carrier_off(pnetdev); ++ rtw_netif_stop_queue(pnetdev); ++ } ++ ++#ifdef CONFIG_WOWLAN ++ if(padapter->pwrctrlpriv.bSupportRemoteWakeup==true&&padapter->pwrctrlpriv.wowlan_mode==true){ ++ //set H2C command ++ poidparam.subcode=WOWLAN_ENABLE; ++ padapter->HalFunc.SetHwRegHandler(padapter,HW_VAR_WOWLAN,(u8 *)&poidparam); ++ } ++ else ++#else ++ { ++ //s2. ++ rtw_disassoc_cmd(padapter, 0, false); ++ } ++#endif //CONFIG_WOWLAN ++ ++#ifdef CONFIG_LAYER2_ROAMING_RESUME ++ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) && check_fwstate(pmlmepriv, _FW_LINKED) ) ++ { ++ //DBG_871X("%s:%d assoc_ssid:%s\n", __FUNCTION__, __LINE__, pmlmepriv->assoc_ssid.Ssid); ++ DBG_871X("%s:%d %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n",__FUNCTION__, __LINE__, ++ pmlmepriv->cur_network.network.Ssid.Ssid, ++ MAC_ARG(pmlmepriv->cur_network.network.MacAddress), ++ pmlmepriv->cur_network.network.Ssid.SsidLength, ++ pmlmepriv->assoc_ssid.SsidLength); ++ ++ rtw_set_roaming(padapter, 1); ++ } ++#endif ++ //s2-2. indicate disconnect to os ++ rtw_indicate_disconnect(padapter); ++ //s2-3. ++ rtw_free_assoc_resources(padapter, 1); ++#ifdef CONFIG_AUTOSUSPEND ++ if(!pwrpriv->bInternalAutoSuspend ) ++#endif ++ //s2-4. ++ rtw_free_network_queue(padapter, true); ++ ++ rtw_dev_unload(padapter); ++#ifdef CONFIG_AUTOSUSPEND ++ pwrpriv->rf_pwrstate = rf_off; ++ pwrpriv->bips_processing = false; ++#endif ++ _exit_pwrlock(&pwrpriv->lock); ++ ++ if(check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) ++ rtw_indicate_scan_done(padapter, 1); ++ ++ if(check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) ++ rtw_indicate_disconnect(padapter); ++ ++exit: ++ DBG_871X("<=== %s return %d.............. in %dms\n", __FUNCTION__ ++ , ret, rtw_get_passing_time_ms(start_time)); + + + return ret; @@ -378197,73 +181090,169 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + +static int rtw_resume(struct usb_interface *pusb_intf) +{ -+ struct dvobj_priv *dvobj; -+ struct pwrctrl_priv *pwrpriv; -+ struct debug_priv *pdbgpriv; -+ PADAPTER padapter; -+ struct mlme_ext_priv *pmlmeext; -+ int ret = 0; ++ struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf); ++ _adapter *padapter = dvobj->if1; ++ struct net_device *pnetdev = padapter->pnetdev; ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; ++ int ret = 0; + -+ -+ dvobj = usb_get_intfdata(pusb_intf); -+ pwrpriv = dvobj_to_pwrctl(dvobj); -+ pdbgpriv = &dvobj->drv_dbg; -+ padapter = dvobj->padapters[IFACE_ID0]; -+ pmlmeext = &padapter->mlmeextpriv; -+ -+ DBG_871X("==> %s (%s:%d)\n", __FUNCTION__, current->comm, current->pid); -+ pdbgpriv->dbg_resume_cnt++; -+ -+ if(pwrpriv->bInternalAutoSuspend) -+ { -+ ret = rtw_resume_process(padapter); -+ } -+ else -+ { -+ if(pwrpriv->wowlan_mode || pwrpriv->wowlan_ap_mode) -+ { -+ rtw_resume_lock_suspend(); -+ ret = rtw_resume_process(padapter); -+ rtw_resume_unlock_suspend(); -+ } -+ else -+ { ++ if(pwrpriv->bInternalAutoSuspend ){ ++ ret = rtw_resume_process(padapter); ++ } else { +#ifdef CONFIG_RESUME_IN_WORKQUEUE -+ rtw_resume_in_workqueue(pwrpriv); -+#else -+ if (rtw_is_earlysuspend_registered(pwrpriv)) -+ { -+ /* jeff: bypass resume here, do in late_resume */ -+ rtw_set_do_late_resume(pwrpriv, _TRUE); -+ } -+ else -+ { -+ rtw_resume_lock_suspend(); -+ ret = rtw_resume_process(padapter); -+ rtw_resume_unlock_suspend(); -+ } -+#endif ++ rtw_resume_in_workqueue(pwrpriv); ++#else ++ if (rtw_is_earlysuspend_registered(pwrpriv) ++ #ifdef CONFIG_WOWLAN ++ && !padapter->pwrctrlpriv.wowlan_mode ++ #endif /* CONFIG_WOWLAN */ ++ ) { ++ /* jeff: bypass resume here, do in late_resume */ ++ rtw_set_do_late_resume(pwrpriv, true); ++ } else { ++ ret = rtw_resume_process(padapter); + } ++#endif /* CONFIG_RESUME_IN_WORKQUEUE */ + } + -+ pmlmeext->last_scan_time = rtw_get_current_time(); -+ DBG_871X("<======== %s return %d\n", __FUNCTION__, ret); ++ return ret; ++ ++} ++ ++int rtw_resume_process(_adapter *padapter) ++{ ++ struct net_device *pnetdev; ++ struct pwrctrl_priv *pwrpriv; ++ int ret = -1; ++ u32 start_time = rtw_get_current_time(); ++#ifdef CONFIG_BT_COEXIST ++ u8 pm_cnt; ++#endif //#ifdef CONFIG_BT_COEXIST ++ ++ ++ DBG_871X("==> %s (%s:%d)\n",__FUNCTION__, current->comm, current->pid); ++ ++ if(padapter) { ++ pnetdev= padapter->pnetdev; ++ pwrpriv = &padapter->pwrctrlpriv; ++ } else { ++ goto exit; ++ } ++ ++ _enter_pwrlock(&pwrpriv->lock); ++#ifdef CONFIG_BT_COEXIST ++#ifdef CONFIG_AUTOSUSPEND ++ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,32)) ++ DBG_871X("%s...pm_usage_cnt(%d) pwrpriv->bAutoResume=%x. ....\n",__func__,atomic_read(&(adapter_to_dvobj(padapter)->pusbintf->pm_usage_cnt)),pwrpriv->bAutoResume); ++ pm_cnt=atomic_read(&(adapter_to_dvobj(padapter)->pusbintf->pm_usage_cnt)); ++ #else ++ DBG_871X("...pm_usage_cnt(%d).....\n", adapter_to_dvobj(padapter)->pusbintf->pm_usage_cnt); ++ pm_cnt = adapter_to_dvobj(padapter)->pusbintf->pm_usage_cnt; ++ #endif ++ ++ DBG_871X("pwrpriv->bAutoResume (%x)\n",pwrpriv->bAutoResume ); ++ if( true == pwrpriv->bAutoResume ){ ++ pwrpriv->bInternalAutoSuspend = false; ++ pwrpriv->bAutoResume=false; ++ DBG_871X("pwrpriv->bAutoResume (%x) pwrpriv->bInternalAutoSuspend(%x)\n",pwrpriv->bAutoResume,pwrpriv->bInternalAutoSuspend ); ++ ++ } ++#endif //#ifdef CONFIG_AUTOSUSPEND ++#endif //#ifdef CONFIG_BT_COEXIST ++ rtw_reset_drv_sw(padapter); ++ pwrpriv->bkeepfwalive = false; ++ ++ DBG_871X("bkeepfwalive(%x)\n",pwrpriv->bkeepfwalive); ++ if(pm_netdev_open(pnetdev,true) != 0){ ++ _exit_pwrlock(&pwrpriv->lock); ++ goto exit; ++ } ++ ++ netif_device_attach(pnetdev); ++ netif_carrier_on(pnetdev); ++ ++#ifdef CONFIG_AUTOSUSPEND ++ if(pwrpriv->bInternalAutoSuspend ) ++ { ++ #ifdef CONFIG_AUTOSUSPEND ++ #ifdef SUPPORT_HW_RFOFF_DETECTED ++ // The FW command register update must after MAC and FW init ready. ++ if((padapter->bFWReady) && ( padapter->pwrctrlpriv.bHWPwrPindetect ) && (padapter->registrypriv.usbss_enable )) ++ { ++ //rtl8192c_set_FwSelectSuspend_cmd(padapter,false ,500);//note fw to support hw power down ping detect ++ u8 bOpen = false; ++ rtw_interface_ps_func(padapter,HAL_USB_SELECT_SUSPEND,&bOpen); ++ } ++ #endif ++ #endif ++#ifdef CONFIG_BT_COEXIST ++ DBG_871X("pwrpriv->bAutoResume (%x)\n",pwrpriv->bAutoResume ); ++ if( true == pwrpriv->bAutoResume ){ ++ pwrpriv->bInternalAutoSuspend = false; ++ pwrpriv->bAutoResume=false; ++ DBG_871X("pwrpriv->bAutoResume (%x) pwrpriv->bInternalAutoSuspend(%x)\n",pwrpriv->bAutoResume,pwrpriv->bInternalAutoSuspend ); ++ } ++ ++#else //#ifdef CONFIG_BT_COEXIST ++ pwrpriv->bInternalAutoSuspend = false; ++#endif //#ifdef CONFIG_BT_COEXIST ++ pwrpriv->brfoffbyhw = false; ++ { ++ DBG_871X("enc_algorithm(%x),wepkeymask(%x)\n", ++ padapter->securitypriv.dot11PrivacyAlgrthm,pwrpriv->wepkeymask); ++ if( (_WEP40_ == padapter->securitypriv.dot11PrivacyAlgrthm) || ++ (_WEP104_ == padapter->securitypriv.dot11PrivacyAlgrthm)) ++ { ++ sint keyid; ++ ++ for(keyid=0;keyid<4;keyid++){ ++ if(pwrpriv->wepkeymask & BIT(keyid)) { ++ if(keyid == padapter->securitypriv.dot11PrivacyKeyIndex) ++ rtw_set_key(padapter,&padapter->securitypriv, keyid, 1); ++ else ++ rtw_set_key(padapter,&padapter->securitypriv, keyid, 0); ++ } ++ } ++ } ++ } ++ } ++#endif ++ _exit_pwrlock(&pwrpriv->lock); ++ ++ if( padapter->pid[1]!=0) { ++ DBG_871X("pid[1]:%d\n",padapter->pid[1]); ++ rtw_signal_process(padapter->pid[1], SIGUSR2); ++ } ++ ++ #ifdef CONFIG_LAYER2_ROAMING_RESUME ++ rtw_roaming(padapter, NULL); ++ #endif ++ ++ ret = 0; ++exit: ++ #ifdef CONFIG_RESUME_IN_WORKQUEUE ++ rtw_unlock_suspend(); ++ #endif //CONFIG_RESUME_IN_WORKQUEUE ++ ++ pwrpriv->bInSuspend = false; ++ DBG_871X("<=== %s return %d.............. in %dms\n", __FUNCTION__ ++ , ret, rtw_get_passing_time_ms(start_time)); ++ ++ + + return ret; +} + -+ -+ +#ifdef CONFIG_AUTOSUSPEND +void autosuspend_enter(_adapter* padapter) +{ ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); + + DBG_871X("==>autosuspend_enter...........\n"); + -+ pwrpriv->bInternalAutoSuspend = _TRUE; -+ pwrpriv->bips_processing = _TRUE; ++ pwrpriv->bInternalAutoSuspend = true; ++ pwrpriv->bips_processing = true; + + if(rf_off == pwrpriv->change_rfpwrstate ) + { @@ -378310,21 +181299,20 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + #endif + +} -+ +int autoresume_enter(_adapter* padapter) +{ + int result = _SUCCESS; ++ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; + struct security_priv* psecuritypriv=&(padapter->securitypriv); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); + + DBG_871X("====> autoresume_enter \n"); + + if(rf_off == pwrpriv->rf_pwrstate ) + { -+ pwrpriv->ps_flag = _FALSE; ++ pwrpriv->ps_flag = false; +#ifndef CONFIG_BT_COEXIST + #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,33)) + if (usb_autopm_get_interface(dvobj->pusbintf) < 0) @@ -378345,7 +181333,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + DBG_871X("...pm_usage_cnt(%d).....\n", dvobj->pusbintf->pm_usage_cnt); + #endif +#else //#ifndef CONFIG_BT_COEXIST -+ pwrpriv->bAutoResume=_TRUE; ++ pwrpriv->bAutoResume=true; + if(0==pwrpriv->autopm_cnt){ + #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,33)) + if (usb_autopm_get_interface(dvobj->pusbintf) < 0) @@ -378377,10 +181365,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r +} +#endif + -+#ifdef CONFIG_PLATFORM_RTD2880B -+extern void rtd2885_wlan_netlink_sendMsg(char *action_string, char *name); -+#endif -+ +/* + * drv_init() - a device potentially for us + * @@ -378391,29 +181375,26 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r +_adapter *rtw_sw_export = NULL; + +_adapter *rtw_usb_if1_init(struct dvobj_priv *dvobj, -+ struct usb_interface *pusb_intf) ++ struct usb_interface *pusb_intf, const struct usb_device_id *pdid) +{ + _adapter *padapter = NULL; ++ struct net_device *pnetdev = NULL; + int status = _FAIL; + -+ padapter = (_adapter *)rtw_zvmalloc(sizeof(*padapter)); -+ if (padapter == NULL) ++ if ((padapter = (_adapter *)rtw_zvmalloc(sizeof(*padapter))) == NULL) { + goto exit; -+ -+ if (loadparam(padapter) != _SUCCESS) -+ goto free_adapter; -+ ++ } + padapter->dvobj = dvobj; ++ dvobj->if1 = padapter; + -+ -+ rtw_set_drv_stopped(padapter);/*init*/ ++ padapter->bDriverStopped=true; + + dvobj->padapters[dvobj->iface_nums++] = padapter; + padapter->iface_id = IFACE_ID0; + -+#if defined(CONFIG_CONCURRENT_MODE) ++#if defined(CONFIG_CONCURRENT_MODE) || defined(CONFIG_DUALMAC_CONCURRENT) + //set adapter_type/iface type for primary padapter -+ padapter->isprimary = _TRUE; ++ padapter->isprimary = true; + padapter->adapter_type = PRIMARY_ADAPTER; + #ifndef CONFIG_HWPORT_SWAP + padapter->iface_type = IFACE_PORT0; @@ -378422,18 +181403,34 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + #endif +#endif + ++ //step 1-1., decide the chip_type via driver_info ++ padapter->interface_type = RTW_USB; ++ rtw_decide_chip_type_by_usb_info(padapter, pdid); ++ ++ if (rtw_handle_dualmac(padapter, 1) != _SUCCESS) ++ goto free_adapter; ++ ++ if((pnetdev = rtw_init_netdev(padapter)) == NULL) { ++ goto handle_dualmac; ++ } ++ SET_NETDEV_DEV(pnetdev, dvobj_to_dev(dvobj)); ++ padapter = rtw_netdev_priv(pnetdev); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if(rtw_wdev_alloc(padapter, dvobj_to_dev(dvobj)) != 0) { ++ goto handle_dualmac; ++ } ++#endif ++ + //step 2. hook HalFunc, allocate HalData + //hal_set_hal_ops(padapter); -+ if(rtw_set_hal_ops(padapter) ==_FAIL) -+ goto free_hal_data; -+ ++ rtw_set_hal_ops(padapter); + + padapter->intf_start=&usb_intf_start; + padapter->intf_stop=&usb_intf_stop; + + //step init_io_priv -+ if( rtw_init_io_priv(padapter,usb_set_intf_ops) ==_FAIL) -+ goto free_hal_data; ++ rtw_init_io_priv(padapter,usb_set_intf_ops); + + //step read_chip_version + rtw_hal_read_chip_version(padapter); @@ -378441,10 +181438,6 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + //step usb endpoint mapping + rtw_hal_chip_configure(padapter); + -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_Initialize(padapter); -+#endif // CONFIG_BT_COEXIST -+ + //step read efuse/eeprom data and get mac_addr + rtw_hal_read_chip_info(padapter); + @@ -378456,13 +181449,13 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + +#ifdef CONFIG_PM +#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,18)) -+ if(dvobj_to_pwrctl(dvobj)->bSupportRemoteWakeup) ++ if(padapter->pwrctrlpriv.bSupportRemoteWakeup) + { + dvobj->pusbdev->do_remote_wakeup=1; + pusb_intf->needs_remote_wakeup = 1; + device_init_wakeup(&pusb_intf->dev, 1); -+ DBG_871X("pwrctrlpriv.bSupportRemoteWakeup~~~~~~\n"); -+ DBG_871X("pwrctrlpriv.bSupportRemoteWakeup~~~[%d]~~~\n",device_may_wakeup(&pusb_intf->dev)); ++ DBG_871X("\n padapter->pwrctrlpriv.bSupportRemoteWakeup~~~~~~\n"); ++ DBG_871X("\n padapter->pwrctrlpriv.bSupportRemoteWakeup~~~[%d]~~~\n",device_may_wakeup(&pusb_intf->dev)); + } +#endif +#endif @@ -378470,7 +181463,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r +#ifdef CONFIG_AUTOSUSPEND + if( padapter->registrypriv.power_mgnt != PS_MODE_ACTIVE ) + { -+ if(padapter->registrypriv.usbss_enable ){ /* autosuspend (2s delay) */ ++ if(padapter->registrypriv.usbss_enable ){ /* autosuspend (2s delay) */ + #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,38)) + dvobj->pusbdev->dev.power.autosuspend_delay = 0 * HZ;//15 * HZ; idle-delay time + #else @@ -378502,29 +181495,41 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + } + #endif +#ifdef CONFIG_BT_COEXIST -+ dvobj_to_pwrctl(dvobj)->autopm_cnt=1; ++ padapter->pwrctrlpriv.autopm_cnt=1; +#endif + + // set mac addr -+ rtw_macaddr_cfg(adapter_mac_addr(padapter), get_hal_mac_addr(padapter)); -+#ifdef CONFIG_P2P -+ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); -+#endif // CONFIG_P2P -+ DBG_871X("bDriverStopped:%s, bSurpriseRemoved:%s, bup:%d, hw_init_completed:%d\n" -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False" ++ rtw_macaddr_cfg(padapter->eeprompriv.mac_addr); ++ rtw_init_wifidirect_addrs(padapter, padapter->eeprompriv.mac_addr, padapter->eeprompriv.mac_addr); ++ ++ DBG_871X("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n" ++ , padapter->bDriverStopped ++ , padapter->bSurpriseRemoved + , padapter->bup -+ , rtw_get_hw_init_completed(padapter) ++ , padapter->hw_init_completed + ); + + status = _SUCCESS; + +free_hal_data: -+ if (status != _SUCCESS && padapter->HalData) -+ rtw_hal_free_data(padapter); ++ if(status != _SUCCESS && padapter->HalData) ++ rtw_mfree(padapter->HalData, sizeof(*(padapter->HalData))); ++free_wdev: ++ if(status != _SUCCESS) { ++ #ifdef CONFIG_IOCTL_CFG80211 ++ rtw_wdev_unregister(padapter->rtw_wdev); ++ rtw_wdev_free(padapter->rtw_wdev); ++ #endif ++ } ++handle_dualmac: ++ if (status != _SUCCESS) ++ rtw_handle_dualmac(padapter, 0); +free_adapter: -+ if (status != _SUCCESS && padapter) { -+ rtw_vmfree((u8 *)padapter, sizeof(*padapter)); ++ if (status != _SUCCESS) { ++ if (pnetdev) ++ rtw_free_netdev(pnetdev); ++ else if (padapter) ++ rtw_vmfree((u8*)padapter, sizeof(*padapter)); + padapter = NULL; + } +exit: @@ -378533,11 +181538,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + +static void rtw_usb_if1_deinit(_adapter *if1) +{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(if1); ++ struct net_device *pnetdev = if1->pnetdev; + struct mlme_priv *pmlmepriv= &if1->mlmepriv; + + if(check_fwstate(pmlmepriv, _FW_LINKED)) -+ rtw_disassoc_cmd(if1, 0, _FALSE); ++ rtw_disassoc_cmd(if1, 0, false); + + +#ifdef CONFIG_AP_MODE @@ -378547,16 +181552,35 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + #endif +#endif + ++ if(if1->DriverState != DRIVER_DISAPPEAR) { ++ if(pnetdev) { ++ unregister_netdev(pnetdev); //will call netdev_close() ++ rtw_proc_remove_one(pnetdev); ++ } ++ } ++ ++ rtw_cancel_all_timer(if1); ++ +#ifdef CONFIG_WOWLAN -+ pwrctl->wowlan_mode=_FALSE; ++ if1->pwrctrlpriv.wowlan_mode=false; +#endif //CONFIG_WOWLAN + + rtw_dev_unload(if1); + -+ DBG_871X("+r871xu_dev_remove, hw_init_completed=%d\n", rtw_get_hw_init_completed(if1)); ++ DBG_871X("+r871xu_dev_remove, hw_init_completed=%d\n", if1->hw_init_completed); ++ ++ rtw_handle_dualmac(if1, 0); ++ ++#ifdef CONFIG_IOCTL_CFG80211 ++ if(if1->rtw_wdev) ++ { ++ rtw_wdev_unregister(if1->rtw_wdev); ++ rtw_wdev_free(if1->rtw_wdev); ++ } ++#endif + +#ifdef CONFIG_BT_COEXIST -+ if(1 == pwrctl->autopm_cnt){ ++ if(1 == if1->pwrctrlpriv.autopm_cnt){ + #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,33)) + usb_autopm_put_interface(adapter_to_dvobj(if1)->pusbintf); + #elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,20)) @@ -378564,28 +181588,138 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + #else + usb_autosuspend_device(adapter_to_dvobj(if1)->pusbdev, 1); + #endif -+ pwrctl->autopm_cnt --; ++ if1->pwrctrlpriv.autopm_cnt --; + } +#endif + + rtw_free_drv_sw(if1); + -+ /* TODO: use rtw_os_ndevs_deinit instead at the first stage of driver's dev deinit function */ -+ rtw_os_ndev_free(if1); ++ if(pnetdev) ++ rtw_free_netdev(pnetdev); ++} + -+ rtw_vmfree((u8 *)if1, sizeof(_adapter)); ++static void dump_usb_interface(struct usb_interface *usb_intf) ++{ ++ int i; ++ u8 val8; + -+#ifdef CONFIG_PLATFORM_RTD2880B -+ DBG_871X("wlan link down\n"); -+ rtd2885_wlan_netlink_sendMsg("linkdown", "8712"); ++ struct usb_device *udev = interface_to_usbdev(usb_intf); ++ struct usb_device_descriptor *dev_desc = &udev->descriptor; ++ ++ struct usb_host_config *act_conf = udev->actconfig; ++ struct usb_config_descriptor *act_conf_desc = &act_conf->desc; ++ ++ struct usb_host_interface *host_iface; ++ struct usb_interface_descriptor *iface_desc; ++ struct usb_host_endpoint *host_endp; ++ struct usb_endpoint_descriptor *endp_desc; ++ ++#if 1 /* The usb device this usb interface belongs to */ ++ DBG_871X("usb_interface:%p, usb_device:%p(num:%d, path:%s), usb_device_descriptor:%p\n", usb_intf, udev, udev->devnum, udev->devpath, dev_desc); ++ DBG_871X("bLength:%u\n", dev_desc->bLength); ++ DBG_871X("bDescriptorType:0x%02x\n", dev_desc->bDescriptorType); ++ DBG_871X("bcdUSB:0x%04x\n", le16_to_cpu(dev_desc->bcdUSB)); ++ DBG_871X("bDeviceClass:0x%02x\n", dev_desc->bDeviceClass); ++ DBG_871X("bDeviceSubClass:0x%02x\n", dev_desc->bDeviceSubClass); ++ DBG_871X("bDeviceProtocol:0x%02x\n", dev_desc->bDeviceProtocol); ++ DBG_871X("bMaxPacketSize0:%u\n", dev_desc->bMaxPacketSize0); ++ DBG_871X("idVendor:0x%04x\n", le16_to_cpu(dev_desc->idVendor)); ++ DBG_871X("idProduct:0x%04x\n", le16_to_cpu(dev_desc->idProduct)); ++ DBG_871X("bcdDevice:0x%04x\n", le16_to_cpu(dev_desc->bcdDevice)); ++ DBG_871X("iManufacturer:0x02%x\n", dev_desc->iManufacturer); ++ DBG_871X("iProduct:0x%02x\n", dev_desc->iProduct); ++ DBG_871X("iSerialNumber:0x%02x\n", dev_desc->iSerialNumber); ++ DBG_871X("bNumConfigurations:%u\n", dev_desc->bNumConfigurations); +#endif + ++ ++#if 1 /* The acting usb_config_descriptor */ ++ DBG_871X("\nact_conf_desc:%p\n", act_conf_desc); ++ DBG_871X("bLength:%u\n", act_conf_desc->bLength); ++ DBG_871X("bDescriptorType:0x%02x\n", act_conf_desc->bDescriptorType); ++ DBG_871X("wTotalLength:%u\n", le16_to_cpu(act_conf_desc->wTotalLength)); ++ DBG_871X("bNumInterfaces:%u\n", act_conf_desc->bNumInterfaces); ++ DBG_871X("bConfigurationValue:0x%02x\n", act_conf_desc->bConfigurationValue); ++ DBG_871X("iConfiguration:0x%02x\n", act_conf_desc->iConfiguration); ++ DBG_871X("bmAttributes:0x%02x\n", act_conf_desc->bmAttributes); ++ DBG_871X("bMaxPower=%u\n", act_conf_desc->bMaxPower); ++#endif ++ ++ ++ DBG_871X("****** num of altsetting = (%d) ******/\n", usb_intf->num_altsetting); ++ /* Get he host side alternate setting (the current alternate setting) for this interface*/ ++ host_iface = usb_intf->cur_altsetting; ++ iface_desc = &host_iface->desc; ++ ++#if 1 /* The current alternate setting*/ ++ DBG_871X("\nusb_interface_descriptor:%p:\n", iface_desc); ++ DBG_871X("bLength:%u\n", iface_desc->bLength); ++ DBG_871X("bDescriptorType:0x%02x\n", iface_desc->bDescriptorType); ++ DBG_871X("bInterfaceNumber:0x%02x\n", iface_desc->bInterfaceNumber); ++ DBG_871X("bAlternateSetting=%x\n", iface_desc->bAlternateSetting); ++ DBG_871X("bNumEndpoints=%x\n", iface_desc->bNumEndpoints); ++ DBG_871X("bInterfaceClass=%x\n", iface_desc->bInterfaceClass); ++ DBG_871X("bInterfaceSubClass=%x\n", iface_desc->bInterfaceSubClass); ++ DBG_871X("bInterfaceProtocol=%x\n", iface_desc->bInterfaceProtocol); ++ DBG_871X("iInterface=%x\n", iface_desc->iInterface); ++#endif ++ ++ ++#if 1 ++ //DBG_871X("\ndump usb_endpoint_descriptor:\n"); ++ ++ for (i = 0; i < iface_desc->bNumEndpoints; i++) ++ { ++ host_endp = host_iface->endpoint + i; ++ if (host_endp) ++ { ++ endp_desc = &host_endp->desc; ++ ++ DBG_871X("\nusb_endpoint_descriptor(%d):\n", i); ++ DBG_871X("bLength=%x\n",endp_desc->bLength); ++ DBG_871X("bDescriptorType=%x\n",endp_desc->bDescriptorType); ++ DBG_871X("bEndpointAddress=%x\n",endp_desc->bEndpointAddress); ++ DBG_871X("bmAttributes=%x\n",endp_desc->bmAttributes); ++ DBG_871X("wMaxPacketSize=%x\n",endp_desc->wMaxPacketSize); ++ DBG_871X("wMaxPacketSize=%x\n",le16_to_cpu(endp_desc->wMaxPacketSize)); ++ DBG_871X("bInterval=%x\n",endp_desc->bInterval); ++ //DBG_871X("bRefresh=%x\n",pendp_desc->bRefresh); ++ //DBG_871X("bSynchAddress=%x\n",pendp_desc->bSynchAddress); ++ ++ if (RT_usb_endpoint_is_bulk_in(endp_desc)) ++ { ++ DBG_871X("RT_usb_endpoint_is_bulk_in = %x\n", RT_usb_endpoint_num(endp_desc)); ++ //pdvobjpriv->RtNumInPipes++; ++ } ++ else if (RT_usb_endpoint_is_int_in(endp_desc)) ++ { ++ DBG_871X("RT_usb_endpoint_is_int_in = %x, Interval = %x\n", RT_usb_endpoint_num(endp_desc),endp_desc->bInterval); ++ //pdvobjpriv->RtNumInPipes++; ++ } ++ else if (RT_usb_endpoint_is_bulk_out(endp_desc)) ++ { ++ DBG_871X("RT_usb_endpoint_is_bulk_out = %x\n", RT_usb_endpoint_num(endp_desc)); ++ //pdvobjpriv->RtNumOutPipes++; ++ } ++ //pdvobjpriv->ep_num[i] = RT_usb_endpoint_num(pendp_desc); ++ } ++ } ++ ++ //DBG_871X("nr_endpoint=%d, in_num=%d, out_num=%d\n\n", pdvobjpriv->nr_endpoint, pdvobjpriv->RtNumInPipes, pdvobjpriv->RtNumOutPipes); ++#endif ++ ++ if (udev->speed == USB_SPEED_HIGH) ++ DBG_871X("USB_SPEED_HIGH\n"); ++ else ++ DBG_871X("NON USB_SPEED_HIGH\n"); ++ +} + ++ +static int rtw_drv_init(struct usb_interface *pusb_intf, const struct usb_device_id *pdid) +{ + _adapter *if1 = NULL, *if2 = NULL; -+ int status = _FAIL; ++ int status; + struct dvobj_priv *dvobj; +#ifdef CONFIG_MULTI_VIR_IFACES + int i; @@ -378598,19 +181732,16 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + process_spec_devid(pdid); + + /* Initialize dvobj_priv */ -+ if ((dvobj = usb_dvobj_init(pusb_intf, pdid)) == NULL) { ++ if ((dvobj = usb_dvobj_init(pusb_intf)) == NULL) { + RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("initialize device object priv Failed!\n")); + goto exit; + } + -+ if ((if1 = rtw_usb_if1_init(dvobj, pusb_intf)) == NULL) { ++ if ((if1 = rtw_usb_if1_init(dvobj, pusb_intf, pdid)) == NULL) { + DBG_871X("rtw_usb_if1_init Failed!\n"); + goto free_dvobj; + } -+ -+ if (usb_reprobe_switch_usb_mode(if1) == _TRUE) -+ goto free_if1; -+ ++ +#ifdef CONFIG_CONCURRENT_MODE + if((if2 = rtw_drv_if2_init(if1, usb_set_intf_ops)) == NULL) { + goto free_if1; @@ -378639,27 +181770,17 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r +#endif + + //dev_alloc_name && register_netdev -+ if (rtw_os_ndevs_init(dvobj) != _SUCCESS) ++ if((status = rtw_drv_register_netdev(if1)) != _SUCCESS) { + goto free_if2; ++ } + +#ifdef CONFIG_HOSTAPD_MLME + hostapd_mode_init(if1); +#endif -+ -+#ifdef CONFIG_PLATFORM_RTD2880B -+ DBG_871X("wlan link up\n"); -+ rtd2885_wlan_netlink_sendMsg("linkup", "8712"); -+#endif -+ + RT_TRACE(_module_hci_intfs_c_,_drv_err_,("-871x_drv - drv_init, success!\n")); + + status = _SUCCESS; + -+#if 0 /* not used now */ -+os_ndevs_deinit: -+ if (status != _SUCCESS) -+ rtw_os_ndevs_deinit(dvobj); -+#endif +free_if2: + if(status != _SUCCESS && if2) { + #ifdef CONFIG_CONCURRENT_MODE @@ -378685,69 +181806,49 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r +static void rtw_dev_remove(struct usb_interface *pusb_intf) +{ + struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf); -+ struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(dvobj); -+ _adapter *padapter = dvobj->padapters[IFACE_ID0]; ++ _adapter *padapter = dvobj->if1; + struct net_device *pnetdev = padapter->pnetdev; + struct mlme_priv *pmlmepriv= &padapter->mlmepriv; + -+_func_enter_; ++ + + DBG_871X("+rtw_dev_remove\n"); + RT_TRACE(_module_hci_intfs_c_,_drv_err_,("+dev_remove()\n")); + -+ dvobj->processing_dev_remove = _TRUE; -+ -+ /* TODO: use rtw_os_ndevs_deinit instead at the first stage of driver's dev deinit function */ -+ rtw_os_ndevs_unregister(dvobj); -+ -+ if(usb_drv.drv_registered == _TRUE) ++ if(usb_drv.drv_registered == true) + { -+ //DBG_871X("r871xu_dev_remove():padapter->bSurpriseRemoved == _TRUE\n"); -+ rtw_set_surprise_removed(padapter); ++ //DBG_871X("r871xu_dev_remove():padapter->bSurpriseRemoved == true\n"); ++ padapter->bSurpriseRemoved = true; + } + /*else + { + //DBG_871X("r871xu_dev_remove():module removed\n"); -+ padapter->HalData->hw_init_completed = _FALSE; ++ padapter->hw_init_completed = false; + }*/ + -+ +#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) -+ rtw_unregister_early_suspend(pwrctl); ++ rtw_unregister_early_suspend(&padapter->pwrctrlpriv); +#endif + -+ if (padapter->bFWReady == _TRUE) { -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); ++ rtw_pm_set_ips(padapter, IPS_NONE); ++ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); + -+ LeaveAllPowerSaveMode(padapter); -+ } -+ rtw_set_drv_stopped(padapter); /*for stop thread*/ ++ LeaveAllPowerSaveMode(padapter); + -+ /* stop cmd thread */ -+ rtw_stop_cmd_thread(padapter); +#ifdef CONFIG_CONCURRENT_MODE +#ifdef CONFIG_MULTI_VIR_IFACES + rtw_drv_stop_vir_ifaces(dvobj); +#endif //CONFIG_MULTI_VIR_IFACES -+ rtw_drv_if2_stop(dvobj->padapters[IFACE_ID1]); ++ rtw_drv_if2_stop(dvobj->if2); +#endif //CONFIG_CONCURRENT_MODE + -+ #ifdef CONFIG_BT_COEXIST -+ #ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ if (GET_HAL_DATA(padapter)->EEPROMBluetoothCoexist) -+ rtw_btcoex_close_socket(padapter); -+ #endif -+ rtw_btcoex_HaltNotify(padapter); -+ #endif -+ + rtw_usb_if1_deinit(padapter); + +#ifdef CONFIG_CONCURRENT_MODE +#ifdef CONFIG_MULTI_VIR_IFACES + rtw_drv_free_vir_ifaces(dvobj); +#endif //CONFIG_MULTI_VIR_IFACES -+ rtw_drv_if2_free(dvobj->padapters[IFACE_ID1]); ++ rtw_drv_if2_free(dvobj->if2); +#endif //CONFIG_CONCURRENT_MODE + + usb_dvobj_deinit(pusb_intf); @@ -378760,7 +181861,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + rtw_sw_export=NULL; +#endif + -+_func_exit_; ++ #ifdef DBG_MEM_ALLOC ++ rtw_dump_mem_stat (); ++ #endif ++ + + return; + @@ -378771,65 +181875,33 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r + +static int __init rtw_drv_entry(void) +{ -+ int ret = 0; ++ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("+rtw_drv_entry\n")); + -+ DBG_871X_LEVEL(_drv_always_, "module init start\n"); -+ dump_drv_version(RTW_DBGDUMP); -+#ifdef BTCOEXVERSION -+ DBG_871X_LEVEL(_drv_always_, DRV_NAME" BT-Coex version = %s\n", BTCOEXVERSION); -+#endif // BTCOEXVERSION ++ DBG_871X(DRV_NAME " driver version=%s\n", DRIVERVERSION); + -+ ret = platform_wifi_power_on(); -+ if(ret != 0) -+ { -+ DBG_871X("%s: power on failed!!(%d)\n", __FUNCTION__, ret); -+ ret = -1; -+ goto exit; -+ } +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,24)) + //console_suspend_enabled=0; +#endif + -+ usb_drv.drv_registered = _TRUE; + rtw_suspend_lock_init(); -+ rtw_drv_proc_init(); -+ rtw_ndev_notifier_register(); + -+ ret = usb_register(&usb_drv.usbdrv); -+ -+ if (ret != 0) { -+ usb_drv.drv_registered = _FALSE; -+ rtw_suspend_lock_uninit(); -+ rtw_drv_proc_deinit(); -+ rtw_ndev_notifier_unregister(); -+ goto exit; -+ } -+ -+exit: -+ DBG_871X_LEVEL(_drv_always_, "module init ret=%d\n", ret); -+ return ret; ++ usb_drv.drv_registered = true; ++ return usb_register(&usb_drv.usbdrv); +} + +static void __exit rtw_drv_halt(void) +{ -+ DBG_871X_LEVEL(_drv_always_, "module exit start\n"); -+ -+ usb_drv.drv_registered = _FALSE; -+ -+ usb_deregister(&usb_drv.usbdrv); -+ -+ platform_wifi_power_off(); ++ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("+rtw_drv_halt\n")); ++ DBG_871X("+rtw_drv_halt\n"); + + rtw_suspend_lock_uninit(); -+ rtw_drv_proc_deinit(); -+ rtw_ndev_notifier_unregister(); + -+ DBG_871X_LEVEL(_drv_always_, "module exit success\n"); ++ usb_drv.drv_registered = false; ++ usb_deregister(&usb_drv.usbdrv); + -+ rtw_mstat_dump(RTW_DBGDUMP); ++ DBG_871X("-rtw_drv_halt\n"); +} + -+ +module_init(rtw_drv_entry); +module_exit(rtw_drv_halt); + @@ -378840,1771 +181912,14 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_intf.c linux/3rdparty/r +} +EXPORT_SYMBOL(rtw_usb_get_sw_pointer); +#endif //CONFIG_INTEL_PROXIM -+ -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/usb_ops_linux.c linux/3rdparty/rtl8812au/os_dep/linux/usb_ops_linux.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/usb_ops_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/usb_ops_linux.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,1200 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#define _USB_OPS_LINUX_C_ -+ -+#include -+#include -+#include -+ -+struct rtw_async_write_data { -+ u8 data[VENDOR_CMD_MAX_DATA_LEN]; -+ struct usb_ctrlrequest dr; -+}; -+ -+int usbctrl_vendorreq(struct intf_hdl *pintfhdl, u8 request, u16 value, u16 index, void *pdata, u16 len, u8 requesttype) -+{ -+ _adapter *padapter = pintfhdl->padapter; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(pdvobjpriv); -+ struct usb_device *udev=pdvobjpriv->pusbdev; -+ -+ unsigned int pipe; -+ int status = 0; -+ u32 tmp_buflen=0; -+ u8 reqtype; -+ u8 *pIo_buf; -+ int vendorreq_times = 0; -+ -+ #ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE -+ u8 *tmp_buf; -+ #else // use stack memory -+ u8 tmp_buf[MAX_USB_IO_CTL_SIZE]; -+ #endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->adapter_type > PRIMARY_ADAPTER) -+ { -+ padapter = padapter->pbuddy_adapter; -+ pdvobjpriv = adapter_to_dvobj(padapter); -+ udev = pdvobjpriv->pusbdev; -+ } -+#endif -+ -+ //DBG_871X("%s %s:%d\n",__FUNCTION__, current->comm, current->pid); -+ -+ if (RTW_CANNOT_IO(padapter)){ -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usbctrl_vendorreq:(RTW_CANNOT_IO)!!!\n")); -+ status = -EPERM; -+ goto exit; -+ } -+ -+ if(len>MAX_VENDOR_REQ_CMD_SIZE){ -+ DBG_8192C( "[%s] Buffer len error ,vendor request failed\n", __FUNCTION__ ); -+ status = -EINVAL; -+ goto exit; -+ } -+ -+ #ifdef CONFIG_USB_VENDOR_REQ_MUTEX -+ _enter_critical_mutex(&pdvobjpriv->usb_vendor_req_mutex, NULL); -+ #endif -+ -+ -+ // Acquire IO memory for vendorreq -+#ifdef CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC -+ pIo_buf = pdvobjpriv->usb_vendor_req_buf; -+#else -+ #ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE -+ tmp_buf = rtw_malloc( (u32) len + ALIGNMENT_UNIT); -+ tmp_buflen = (u32)len + ALIGNMENT_UNIT; -+ #else // use stack memory -+ tmp_buflen = MAX_USB_IO_CTL_SIZE; -+ #endif -+ -+ // Added by Albert 2010/02/09 -+ // For mstar platform, mstar suggests the address for USB IO should be 16 bytes alignment. -+ // Trying to fix it here. -+ pIo_buf = (tmp_buf==NULL)?NULL:tmp_buf + ALIGNMENT_UNIT -((SIZE_PTR)(tmp_buf) & 0x0f ); -+#endif -+ -+ if ( pIo_buf== NULL) { -+ DBG_8192C( "[%s] pIo_buf == NULL \n", __FUNCTION__ ); -+ status = -ENOMEM; -+ goto release_mutex; -+ } -+ -+ while(++vendorreq_times<= MAX_USBCTRL_VENDORREQ_TIMES) -+ { -+ _rtw_memset(pIo_buf, 0, len); -+ -+ if (requesttype == 0x01) -+ { -+ pipe = usb_rcvctrlpipe(udev, 0);//read_in -+ reqtype = REALTEK_USB_VENQT_READ; -+ } -+ else -+ { -+ pipe = usb_sndctrlpipe(udev, 0);//write_out -+ reqtype = REALTEK_USB_VENQT_WRITE; -+ _rtw_memcpy( pIo_buf, pdata, len); -+ } -+ -+ status = rtw_usb_control_msg(udev, pipe, request, reqtype, value, index, pIo_buf, len, RTW_USB_CONTROL_MSG_TIMEOUT); -+ -+ if ( status == len) // Success this control transfer. -+ { -+ rtw_reset_continual_io_error(pdvobjpriv); -+ if ( requesttype == 0x01 ) -+ { // For Control read transfer, we have to copy the read data from pIo_buf to pdata. -+ _rtw_memcpy( pdata, pIo_buf, len ); -+ } -+ } -+ else { // error cases -+ DBG_8192C("reg 0x%x, usb %s %u fail, status:%d value=0x%x, vendorreq_times:%d\n" -+ , value,(requesttype == 0x01)?"read":"write" , len, status, *(u32*)pdata, vendorreq_times); -+ -+ if (status < 0) { -+ if(status == (-ESHUTDOWN) || status == -ENODEV ) -+ { -+ rtw_set_surprise_removed(padapter); -+ } else { -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.Wifi_Error_Status = USB_VEN_REQ_CMD_FAIL; -+ } -+ #endif -+ } -+ } -+ else // status != len && status >= 0 -+ { -+ if(status > 0) { -+ if ( requesttype == 0x01 ) -+ { // For Control read transfer, we have to copy the read data from pIo_buf to pdata. -+ _rtw_memcpy( pdata, pIo_buf, len ); -+ } -+ } -+ } -+ -+ if(rtw_inc_and_chk_continual_io_error(pdvobjpriv) == _TRUE ){ -+ rtw_set_surprise_removed(padapter); -+ break; -+ } -+ -+ } -+ -+ // firmware download is checksumed, don't retry -+ if( (value >= FW_START_ADDRESS ) || status == len ) -+ break; -+ -+ } -+ -+ // release IO memory used by vendorreq -+ #ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE -+ rtw_mfree(tmp_buf, tmp_buflen); -+ #endif -+ -+release_mutex: -+ #ifdef CONFIG_USB_VENDOR_REQ_MUTEX -+ _exit_critical_mutex(&pdvobjpriv->usb_vendor_req_mutex, NULL); -+ #endif -+exit: -+ return status; -+ -+} -+ -+#ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ -+static void _usbctrl_vendorreq_async_callback(struct urb *urb, struct pt_regs *regs) -+{ -+ if (urb) { -+ if (urb->context) { -+ rtw_mfree(urb->context, sizeof(struct rtw_async_write_data)); -+ } -+ usb_free_urb(urb); -+ } -+} -+ -+int _usbctrl_vendorreq_async_write(struct usb_device *udev, u8 request, -+ u16 value, u16 index, void *pdata, u16 len, u8 requesttype) -+{ -+ int rc; -+ unsigned int pipe; -+ u8 reqtype; -+ struct usb_ctrlrequest *dr; -+ struct urb *urb; -+ struct rtw_async_write_data *buf; -+ -+ -+ if (requesttype == VENDOR_READ) { -+ pipe = usb_rcvctrlpipe(udev, 0);//read_in -+ reqtype = REALTEK_USB_VENQT_READ; -+ } -+ else { -+ pipe = usb_sndctrlpipe(udev, 0);//write_out -+ reqtype = REALTEK_USB_VENQT_WRITE; -+ } -+ -+ buf = (struct rtl819x_async_write_data *)rtw_zmalloc(sizeof(*buf)); -+ if (!buf) { -+ rc = -ENOMEM; -+ goto exit; -+ } -+ -+ urb = usb_alloc_urb(0, GFP_ATOMIC); -+ if (!urb) { -+ rtw_mfree((u8*)buf, sizeof(*buf)); -+ rc = -ENOMEM; -+ goto exit; -+ } -+ -+ dr = &buf->dr; -+ -+ dr->bRequestType = reqtype; -+ dr->bRequest = request; -+ dr->wValue = cpu_to_le16(value); -+ dr->wIndex = cpu_to_le16(index); -+ dr->wLength = cpu_to_le16(len); -+ -+ _rtw_memcpy(buf, pdata, len); -+ -+ usb_fill_control_urb(urb, udev, pipe, (unsigned char *)dr, buf, len, -+ _usbctrl_vendorreq_async_callback, buf); -+ -+ rc = usb_submit_urb(urb, GFP_ATOMIC); -+ if (rc < 0) { -+ rtw_mfree((u8*)buf, sizeof(*buf)); -+ usb_free_urb(urb); -+ } -+ -+exit: -+ return rc; -+} -+ -+ -+#endif /* CONFIG_USB_SUPPORT_ASYNC_VDN_REQ */ -+ -+unsigned int ffaddr2pipehdl(struct dvobj_priv *pdvobj, u32 addr) -+{ -+ unsigned int pipe=0, ep_num=0; -+ struct usb_device *pusbd = pdvobj->pusbdev; -+ -+ if (addr == RECV_BULK_IN_ADDR) { -+ pipe=usb_rcvbulkpipe(pusbd, pdvobj->RtInPipe[0]); -+ -+ } else if (addr == RECV_INT_IN_ADDR) { -+ pipe=usb_rcvintpipe(pusbd, pdvobj->RtInPipe[1]); -+ -+ } else if (addr < HW_QUEUE_ENTRY) { -+ ep_num = pdvobj->Queue2Pipe[addr]; -+ pipe = usb_sndbulkpipe(pusbd, ep_num); -+ } -+ -+ return pipe; -+} -+ -+struct zero_bulkout_context{ -+ void *pbuf; -+ void *purb; -+ void *pirp; -+ void *padapter; -+}; -+ -+static void usb_bulkout_zero_complete(struct urb *purb, struct pt_regs *regs) -+{ -+ struct zero_bulkout_context *pcontext = (struct zero_bulkout_context *)purb->context; -+ -+ //DBG_8192C("+usb_bulkout_zero_complete\n"); -+ -+ if(pcontext) -+ { -+ if(pcontext->pbuf) -+ { -+ rtw_mfree(pcontext->pbuf, sizeof(int)); -+ } -+ -+ if(pcontext->purb && (pcontext->purb==purb)) -+ { -+ usb_free_urb(pcontext->purb); -+ } -+ -+ -+ rtw_mfree((u8*)pcontext, sizeof(struct zero_bulkout_context)); -+ } -+ -+ -+} -+ -+static u32 usb_bulkout_zero(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ int pipe, status, len; -+ u32 ret; -+ unsigned char *pbuf; -+ struct zero_bulkout_context *pcontext; -+ PURB purb = NULL; -+ _adapter *padapter = (_adapter *)pintfhdl->padapter; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(pdvobj); -+ struct usb_device *pusbd = pdvobj->pusbdev; -+ -+ //DBG_871X("%s\n", __func__); -+ -+ -+ if (RTW_CANNOT_TX(padapter)) -+ { -+ return _FAIL; -+ } -+ -+ -+ pcontext = (struct zero_bulkout_context *)rtw_zmalloc(sizeof(struct zero_bulkout_context)); -+ if (pcontext == NULL) { -+ return _FAIL; -+ } -+ -+ pbuf = (unsigned char *)rtw_zmalloc(sizeof(int)); -+ purb = usb_alloc_urb(0, GFP_ATOMIC); -+ -+ //translate DMA FIFO addr to pipehandle -+ pipe = ffaddr2pipehdl(pdvobj, addr); -+ -+ len = 0; -+ pcontext->pbuf = pbuf; -+ pcontext->purb = purb; -+ pcontext->pirp = NULL; -+ pcontext->padapter = padapter; -+ -+ -+ //translate DMA FIFO addr to pipehandle -+ //pipe = ffaddr2pipehdl(pdvobj, addr); -+ -+ usb_fill_bulk_urb(purb, pusbd, pipe, -+ pbuf, -+ len, -+ usb_bulkout_zero_complete, -+ pcontext);//context is pcontext -+ -+ status = usb_submit_urb(purb, GFP_ATOMIC); -+ -+ if (!status) -+ { -+ ret= _SUCCESS; -+ } -+ else -+ { -+ ret= _FAIL; -+ } -+ -+ -+ return _SUCCESS; -+ -+} -+ -+void usb_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) -+{ -+ -+} -+ -+void usb_write_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem) -+{ -+ -+} -+ -+ -+void usb_read_port_cancel(struct intf_hdl *pintfhdl) -+{ -+ int i; -+ struct recv_buf *precvbuf; -+ _adapter *padapter = pintfhdl->padapter; -+ precvbuf = (struct recv_buf *)padapter->recvpriv.precv_buf; -+ -+ DBG_871X("%s\n", __func__); -+ -+ for (i=0; i < NR_RECVBUFF ; i++) { -+ -+ if (precvbuf->purb) { -+ //DBG_8192C("usb_read_port_cancel : usb_kill_urb \n"); -+ usb_kill_urb(precvbuf->purb); -+ } -+ precvbuf++; -+ } -+ -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+ usb_kill_urb(padapter->recvpriv.int_in_urb); -+#endif -+} -+ -+static void usb_write_port_complete(struct urb *purb, struct pt_regs *regs) -+{ -+ _irqL irqL; -+ int i; -+ struct xmit_buf *pxmitbuf = (struct xmit_buf *)purb->context; -+ //struct xmit_frame *pxmitframe = (struct xmit_frame *)pxmitbuf->priv_data; -+ //_adapter *padapter = pxmitframe->padapter; -+ _adapter *padapter = pxmitbuf->padapter; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ //struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+_func_enter_; -+ -+ switch(pxmitbuf->flags) -+ { -+ case VO_QUEUE_INX: -+ pxmitpriv->voq_cnt--; -+ break; -+ case VI_QUEUE_INX: -+ pxmitpriv->viq_cnt--; -+ break; -+ case BE_QUEUE_INX: -+ pxmitpriv->beq_cnt--; -+ break; -+ case BK_QUEUE_INX: -+ pxmitpriv->bkq_cnt--; -+ break; -+ default: -+ break; -+ } -+ -+ -+/* -+ _enter_critical(&pxmitpriv->lock, &irqL); -+ -+ pxmitpriv->txirp_cnt--; -+ -+ switch(pattrib->priority) -+ { -+ case 1: -+ case 2: -+ pxmitpriv->bkq_cnt--; -+ //DBG_8192C("pxmitpriv->bkq_cnt=%d\n", pxmitpriv->bkq_cnt); -+ break; -+ case 4: -+ case 5: -+ pxmitpriv->viq_cnt--; -+ //DBG_8192C("pxmitpriv->viq_cnt=%d\n", pxmitpriv->viq_cnt); -+ break; -+ case 6: -+ case 7: -+ pxmitpriv->voq_cnt--; -+ //DBG_8192C("pxmitpriv->voq_cnt=%d\n", pxmitpriv->voq_cnt); -+ break; -+ case 0: -+ case 3: -+ default: -+ pxmitpriv->beq_cnt--; -+ //DBG_8192C("pxmitpriv->beq_cnt=%d\n", pxmitpriv->beq_cnt); -+ break; -+ -+ } -+ -+ _exit_critical(&pxmitpriv->lock, &irqL); -+ -+ -+ if(pxmitpriv->txirp_cnt==0) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete: txirp_cnt== 0, set allrxreturnevt!\n")); -+ _rtw_up_sema(&(pxmitpriv->tx_retevt)); -+ } -+*/ -+ //rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ if (RTW_CANNOT_TX(padapter)) -+ { -+ DBG_8192C("%s(): TX Warning! bDriverStopped(%s) OR bSurpriseRemoved(%s) pxmitbuf->buf_tag(%x)\n" -+ , __func__ -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False" -+ , pxmitbuf->buf_tag); -+ -+ goto check_completion; -+ } -+ -+ -+ if (purb->status==0) { -+ -+ } else { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete : purb->status(%d) != 0 \n", purb->status)); -+ DBG_871X("###=> urb_write_port_complete status(%d)\n",purb->status); -+ if((purb->status==-EPIPE)||(purb->status==-EPROTO)) -+ { -+ //usb_clear_halt(pusbdev, purb->pipe); -+ //msleep(10); -+ sreset_set_wifi_error_status(padapter, USB_WRITE_PORT_FAIL); -+ } else if (purb->status == -EINPROGRESS) { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete: EINPROGESS\n")); -+ goto check_completion; -+ -+ } else if (purb->status == -ENOENT) { -+ DBG_871X("%s: -ENOENT\n", __func__); -+ goto check_completion; -+ -+ } else if (purb->status == -ECONNRESET) { -+ DBG_871X("%s: -ECONNRESET\n", __func__); -+ goto check_completion; -+ -+ } else if (purb->status == -ESHUTDOWN) { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete: ESHUTDOWN\n")); -+ rtw_set_drv_stopped(padapter); -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete:bDriverStopped=TRUE\n")); -+ -+ goto check_completion; -+ } -+ else -+ { -+ rtw_set_surprise_removed(padapter); -+ DBG_8192C("bSurpriseRemoved=TRUE\n"); -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete:bSurpriseRemoved=TRUE\n")); -+ -+ goto check_completion; -+ } -+ } -+ -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.last_tx_complete_time = rtw_get_current_time(); -+ } -+ #endif -+ -+check_completion: -+ _enter_critical(&pxmitpriv->lock_sctx, &irqL); -+ rtw_sctx_done_err(&pxmitbuf->sctx, -+ purb->status ? RTW_SCTX_DONE_WRITE_PORT_ERR : RTW_SCTX_DONE_SUCCESS); -+ _exit_critical(&pxmitpriv->lock_sctx, &irqL); -+ -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ -+ //if(rtw_txframes_pending(padapter)) -+ { -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+ } -+ -+_func_exit_; -+ -+} -+ -+u32 usb_write_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem) -+{ -+ _irqL irqL; -+ unsigned int pipe; -+ int status; -+ u32 ret = _FAIL, bwritezero = _FALSE; -+ PURB purb = NULL; -+ _adapter *padapter = (_adapter *)pintfhdl->padapter; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(pdvobj); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct xmit_buf *pxmitbuf = (struct xmit_buf *)wmem; -+ struct xmit_frame *pxmitframe = (struct xmit_frame *)pxmitbuf->priv_data; -+ struct usb_device *pusbd = pdvobj->pusbdev; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+_func_enter_; -+ -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("+usb_write_port\n")); -+ -+ if (RTW_CANNOT_TX(padapter)) { -+ #ifdef DBG_TX -+ DBG_871X(" DBG_TX %s:%d bDriverStopped%s, bSurpriseRemoved:%s\n", __func__, __LINE__ -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False"); -+ #endif -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port:( padapter->bDriverStopped ||padapter->bSurpriseRemoved )!!!\n")); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_TX_DENY); -+ goto exit; -+ } -+ -+ _enter_critical(&pxmitpriv->lock, &irqL); -+ -+ switch(addr) -+ { -+ case VO_QUEUE_INX: -+ pxmitpriv->voq_cnt++; -+ pxmitbuf->flags = VO_QUEUE_INX; -+ break; -+ case VI_QUEUE_INX: -+ pxmitpriv->viq_cnt++; -+ pxmitbuf->flags = VI_QUEUE_INX; -+ break; -+ case BE_QUEUE_INX: -+ pxmitpriv->beq_cnt++; -+ pxmitbuf->flags = BE_QUEUE_INX; -+ break; -+ case BK_QUEUE_INX: -+ pxmitpriv->bkq_cnt++; -+ pxmitbuf->flags = BK_QUEUE_INX; -+ break; -+ case HIGH_QUEUE_INX: -+ pxmitbuf->flags = HIGH_QUEUE_INX; -+ break; -+ default: -+ pxmitbuf->flags = MGT_QUEUE_INX; -+ break; -+ } -+ -+ _exit_critical(&pxmitpriv->lock, &irqL); -+ -+ purb = pxmitbuf->pxmit_urb[0]; -+ -+ //translate DMA FIFO addr to pipehandle -+ pipe = ffaddr2pipehdl(pdvobj, addr); -+ -+#ifdef CONFIG_REDUCE_USB_TX_INT -+ if ( (pxmitpriv->free_xmitbuf_cnt%NR_XMITBUFF == 0) -+ || (pxmitbuf->buf_tag > XMITBUF_DATA) ) -+ { -+ purb->transfer_flags &= (~URB_NO_INTERRUPT); -+ } else { -+ purb->transfer_flags |= URB_NO_INTERRUPT; -+ //DBG_8192C("URB_NO_INTERRUPT "); -+ } -+#endif -+ -+ -+ usb_fill_bulk_urb(purb, pusbd, pipe, -+ pxmitframe->buf_addr, //= pxmitbuf->pbuf -+ cnt, -+ usb_write_port_complete, -+ pxmitbuf);//context is pxmitbuf -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ purb->transfer_dma = pxmitbuf->dma_transfer_addr; -+ purb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; -+ purb->transfer_flags |= URB_ZERO_PACKET; -+#endif // CONFIG_USE_USB_BUFFER_ALLOC_TX -+ -+#ifdef USB_PACKET_OFFSET_SZ -+#if (USB_PACKET_OFFSET_SZ == 0) -+ purb->transfer_flags |= URB_ZERO_PACKET; -+#endif -+#endif -+ -+#if 0 -+ if (bwritezero) -+ { -+ purb->transfer_flags |= URB_ZERO_PACKET; -+ } -+#endif -+ -+ status = usb_submit_urb(purb, GFP_ATOMIC); -+ if (!status) { -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.last_tx_time = rtw_get_current_time(); -+ } -+ #endif -+ } else { -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_WRITE_PORT_ERR); -+ DBG_871X("usb_write_port, status=%d\n", status); -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port(): usb_submit_urb, status=%x\n", status)); -+ -+ switch (status) { -+ case -ENODEV: -+ rtw_set_drv_stopped(padapter); -+ break; -+ default: -+ break; -+ } -+ goto exit; -+ } -+ -+ ret= _SUCCESS; -+ -+// Commented by Albert 2009/10/13 -+// We add the URB_ZERO_PACKET flag to urb so that the host will send the zero packet automatically. -+/* -+ if(bwritezero == _TRUE) -+ { -+ usb_bulkout_zero(pintfhdl, addr); -+ } -+*/ -+ -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("-usb_write_port\n")); -+ -+exit: -+ if (ret != _SUCCESS) -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+_func_exit_; -+ return ret; -+ -+} -+ -+void usb_write_port_cancel(struct intf_hdl *pintfhdl) -+{ -+ int i, j; -+ _adapter *padapter = pintfhdl->padapter; -+ struct xmit_buf *pxmitbuf = (struct xmit_buf *)padapter->xmitpriv.pxmitbuf; -+ -+ DBG_871X("%s \n", __func__); -+ -+ for (i=0; ipxmit_urb[j]) { -+ usb_kill_urb(pxmitbuf->pxmit_urb[j]); -+ } -+ } -+ pxmitbuf++; -+ } -+ -+ pxmitbuf = (struct xmit_buf*)padapter->xmitpriv.pxmit_extbuf; -+ for (i = 0; i < NR_XMIT_EXTBUFF ; i++) { -+ for (j=0; j<8; j++) { -+ if(pxmitbuf->pxmit_urb[j]) { -+ usb_kill_urb(pxmitbuf->pxmit_urb[j]); -+ } -+ } -+ pxmitbuf++; -+ } -+} -+ -+void usb_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf) -+{ -+ -+ precvbuf->transfer_len = 0; -+ -+ precvbuf->len = 0; -+ -+ precvbuf->ref_cnt = 0; -+ -+ if(precvbuf->pbuf) -+ { -+ precvbuf->pdata = precvbuf->phead = precvbuf->ptail = precvbuf->pbuf; -+ precvbuf->pend = precvbuf->pdata + MAX_RECVBUF_SZ; -+ } -+ -+} -+ -+int recvbuf2recvframe(PADAPTER padapter, void *ptr); -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+void usb_recv_tasklet(void *priv) -+{ -+ struct recv_buf *precvbuf = NULL; -+ _adapter *padapter = (_adapter*)priv; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ while (NULL != (precvbuf = rtw_dequeue_recvbuf(&precvpriv->recv_buf_pending_queue))) -+ { -+ if (RTW_CANNOT_RUN(padapter)) { -+ DBG_8192C("recv_tasklet => bDriverStopped or bSurpriseRemoved\n"); -+ break; -+ } -+ -+ -+ recvbuf2recvframe(padapter, precvbuf); -+ -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ } -+ -+} -+ -+void usb_read_port_complete(struct urb *purb, struct pt_regs *regs) -+{ -+ struct recv_buf *precvbuf = (struct recv_buf *)purb->context; -+ _adapter *padapter =(_adapter *)precvbuf->adapter; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete!!!\n")); -+ -+ ATOMIC_DEC(&(precvpriv->rx_pending_cnt)); -+ -+ if (RTW_CANNOT_RX(padapter)) -+ { -+ DBG_8192C("%s() RX Warning! bDriverStopped(%s) OR bSurpriseRemoved(%s)\n" -+ , __func__ -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False"); -+ goto exit; -+ } -+ -+ if(purb->status==0)//SUCCESS -+ { -+ if ((purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE)) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete: (purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE)\n")); -+ -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ } -+ else -+ { -+ rtw_reset_continual_io_error(adapter_to_dvobj(padapter)); -+ -+ precvbuf->transfer_len = purb->actual_length; -+ -+ //rtw_enqueue_rx_transfer_buffer(precvpriv, rx_transfer_buf); -+ rtw_enqueue_recvbuf(precvbuf, &precvpriv->recv_buf_pending_queue); -+ -+ tasklet_schedule(&precvpriv->recv_tasklet); -+ } -+ } -+ else -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete : purb->status(%d) != 0 \n", purb->status)); -+ -+ DBG_8192C("###=> usb_read_port_complete => urb status(%d)\n", purb->status); -+ -+ if (rtw_inc_and_chk_continual_io_error(adapter_to_dvobj(padapter)) == _TRUE) -+ rtw_set_surprise_removed(padapter); -+ -+ switch(purb->status) { -+ case -EINVAL: -+ case -EPIPE: -+ case -ENODEV: -+ case -ESHUTDOWN: -+ /*rtw_set_surprise_removed(padapter);*/ -+ //RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bSurpriseRemoved=TRUE\n")); -+ case -ENOENT: -+ rtw_set_drv_stopped(padapter); -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bDriverStopped=TRUE\n")); -+ break; -+ case -EPROTO: -+ case -EILSEQ: -+ case -ETIME: -+ case -ECOMM: -+ case -EOVERFLOW: -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.Wifi_Error_Status = USB_READ_PORT_FAIL; -+ } -+ #endif -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ break; -+ case -EINPROGRESS: -+ DBG_8192C("ERROR: URB IS IN PROGRESS!/n"); -+ break; -+ default: -+ break; -+ } -+ -+ } -+ -+exit: -+ -+_func_exit_; -+} -+ -+u32 usb_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) -+{ -+ int err; -+ unsigned int pipe; -+ u32 ret = _SUCCESS; -+ PURB purb = NULL; -+ struct recv_buf *precvbuf = (struct recv_buf *)rmem; -+ _adapter *adapter = pintfhdl->padapter; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter); -+ struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(pdvobj); -+ struct recv_priv *precvpriv = &adapter->recvpriv; -+ struct usb_device *pusbd = pdvobj->pusbdev; -+ -+_func_enter_; -+ -+ if (RTW_CANNOT_RX(adapter) || (precvbuf == NULL)) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port:( RTW_CANNOT_RX ) || precvbuf == NULL!!!\n")); -+ return _FAIL; -+ } -+ -+ usb_init_recvbuf(adapter, precvbuf); -+ -+ if(precvbuf->pbuf) -+ { -+ ATOMIC_INC(&(precvpriv->rx_pending_cnt)); -+ purb = precvbuf->purb; -+ -+ //translate DMA FIFO addr to pipehandle -+ pipe = ffaddr2pipehdl(pdvobj, addr); -+ -+ usb_fill_bulk_urb(purb, pusbd, pipe, -+ precvbuf->pbuf, -+ MAX_RECVBUF_SZ, -+ usb_read_port_complete, -+ precvbuf);//context is precvbuf -+ -+ purb->transfer_dma = precvbuf->dma_transfer_addr; -+ purb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; -+ -+ err = usb_submit_urb(purb, GFP_ATOMIC); -+ if((err) && (err != (-EPERM))) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("cannot submit rx in-token(err=0x%.8x), URB_STATUS =0x%.8x", err, purb->status)); -+ DBG_8192C("cannot submit rx in-token(err = 0x%08x),urb_status = %d\n",err,purb->status); -+ ret = _FAIL; -+ } -+ -+ } -+ -+_func_exit_; -+ -+ return ret; -+} -+#else // CONFIG_USE_USB_BUFFER_ALLOC_RX -+ -+void usb_recv_tasklet(void *priv) -+{ -+ _pkt *pskb; -+ _adapter *padapter = (_adapter*)priv; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct recv_buf *precvbuf = NULL; -+ -+ while (NULL != (pskb = skb_dequeue(&precvpriv->rx_skb_queue))) { -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ DBG_8192C("recv_tasklet => bDriverStopped or bSurpriseRemoved\n"); -+ #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ if (rtw_free_skb_premem(pskb) != 0) -+ #endif //CONFIG_PREALLOC_RX_SKB_BUFFER -+ rtw_skb_free(pskb); -+ break; -+ } -+ -+ recvbuf2recvframe(padapter, pskb); -+ -+ skb_reset_tail_pointer(pskb); -+ pskb->len = 0; -+ -+ skb_queue_tail(&precvpriv->free_recv_skb_queue, pskb); -+ -+ if (NULL != (precvbuf = rtw_dequeue_recvbuf(&precvpriv->recv_buf_pending_queue))) { -+ precvbuf->pskb = NULL; -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ } -+ } -+} -+ -+void usb_read_port_complete(struct urb *purb, struct pt_regs *regs) -+{ -+ struct recv_buf *precvbuf = (struct recv_buf *)purb->context; -+ _adapter *padapter =(_adapter *)precvbuf->adapter; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete!!!\n")); -+ -+ ATOMIC_DEC(&(precvpriv->rx_pending_cnt)); -+ -+ if(RTW_CANNOT_RX(padapter)) -+ { -+ DBG_8192C("%s() RX Warning! bDriverStopped(%s) OR bSurpriseRemoved(%s)\n" -+ , __func__ -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False"); -+ goto exit; -+ } -+ -+ if(purb->status==0)//SUCCESS -+ { -+ if ((purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE)) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete: (purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE)\n")); -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ DBG_8192C("%s()-%d: RX Warning!\n", __FUNCTION__, __LINE__); -+ } -+ else -+ { -+ rtw_reset_continual_io_error(adapter_to_dvobj(padapter)); -+ -+ precvbuf->transfer_len = purb->actual_length; -+ skb_put(precvbuf->pskb, purb->actual_length); -+ skb_queue_tail(&precvpriv->rx_skb_queue, precvbuf->pskb); -+ -+ #ifndef CONFIG_FIX_NR_BULKIN_BUFFER -+ if (skb_queue_len(&precvpriv->rx_skb_queue)<=1) -+ #endif -+ tasklet_schedule(&precvpriv->recv_tasklet); -+ -+ precvbuf->pskb = NULL; -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ } -+ } -+ else -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete : purb->status(%d) != 0 \n", purb->status)); -+ -+ DBG_8192C("###=> usb_read_port_complete => urb status(%d)\n", purb->status); -+ -+ if (rtw_inc_and_chk_continual_io_error(adapter_to_dvobj(padapter)) == _TRUE) -+ rtw_set_surprise_removed(padapter); -+ -+ -+ switch(purb->status) { -+ case -EINVAL: -+ case -EPIPE: -+ case -ENODEV: -+ case -ESHUTDOWN: -+ /*rtw_set_surprise_removed(padapter);*/ -+ //RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bSurpriseRemoved=TRUE\n")); -+ case -ENOENT: -+ rtw_set_drv_stopped(padapter); -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bDriverStopped=TRUE\n")); -+ break; -+ case -EPROTO: -+ case -EILSEQ: -+ case -ETIME: -+ case -ECOMM: -+ case -EOVERFLOW: -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.Wifi_Error_Status = USB_READ_PORT_FAIL; -+ } -+ #endif -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ break; -+ case -EINPROGRESS: -+ DBG_8192C("ERROR: URB IS IN PROGRESS!/n"); -+ break; -+ default: -+ break; -+ } -+ -+ } -+ -+exit: -+ -+_func_exit_; -+ -+} -+ -+u32 usb_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) -+{ -+ int err; -+ unsigned int pipe; -+ u32 ret = _FAIL; -+ PURB purb = NULL; -+ struct recv_buf *precvbuf = (struct recv_buf *)rmem; -+ _adapter *adapter = pintfhdl->padapter; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter); -+ struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(pdvobj); -+ struct recv_priv *precvpriv = &adapter->recvpriv; -+ struct usb_device *pusbd = pdvobj->pusbdev; -+ -+_func_enter_; -+ -+ if (RTW_CANNOT_RX(adapter) || (precvbuf == NULL)) { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port:( RTW_CANNOT_RX ) || precvbuf == NULL!!!\n")); -+ goto exit; -+ } -+ -+ usb_init_recvbuf(adapter, precvbuf); -+ -+ if (precvbuf->pskb == NULL) { -+ SIZE_PTR tmpaddr = 0; -+ SIZE_PTR alignment = 0; -+ -+ if (NULL != (precvbuf->pskb = skb_dequeue(&precvpriv->free_recv_skb_queue))) -+ goto recv_buf_hook; -+ -+ #ifndef CONFIG_FIX_NR_BULKIN_BUFFER -+ precvbuf->pskb = rtw_skb_alloc(MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ); -+ #endif -+ -+ if (precvbuf->pskb == NULL) { -+ if (0) -+ DBG_871X("usb_read_port() enqueue precvbuf=%p \n", precvbuf); -+ /* enqueue precvbuf and wait for free skb */ -+ rtw_enqueue_recvbuf(precvbuf, &precvpriv->recv_buf_pending_queue); -+ goto exit; -+ } -+ -+ tmpaddr = (SIZE_PTR)precvbuf->pskb->data; -+ alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1); -+ skb_reserve(precvbuf->pskb, (RECVBUFF_ALIGN_SZ - alignment)); -+ } -+ -+recv_buf_hook: -+ precvbuf->phead = precvbuf->pskb->head; -+ precvbuf->pdata = precvbuf->pskb->data; -+ precvbuf->ptail = skb_tail_pointer(precvbuf->pskb); -+ precvbuf->pend = skb_end_pointer(precvbuf->pskb); -+ precvbuf->pbuf = precvbuf->pskb->data; -+ -+ purb = precvbuf->purb; -+ -+ /* translate DMA FIFO addr to pipehandle */ -+ pipe = ffaddr2pipehdl(pdvobj, addr); -+ -+ usb_fill_bulk_urb(purb, pusbd, pipe, -+ precvbuf->pbuf, -+ MAX_RECVBUF_SZ, -+ usb_read_port_complete, -+ precvbuf); -+ -+ err = usb_submit_urb(purb, GFP_ATOMIC); -+ if (err && err != (-EPERM)) { -+ DBG_871X("cannot submit rx in-token(err = 0x%08x),urb_status = %d\n" -+ , err, purb->status); -+ goto exit; -+ } -+ -+ ATOMIC_INC(&(precvpriv->rx_pending_cnt)); -+ ret = _SUCCESS; -+ -+exit: -+ -+_func_exit_; -+ -+ return ret; -+} -+#endif // CONFIG_USE_USB_BUFFER_ALLOC_RX -+ -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+void usb_read_interrupt_complete(struct urb *purb, struct pt_regs *regs) -+{ -+ int err; -+ _adapter *padapter = (_adapter *)purb->context; -+ -+ if (RTW_CANNOT_RX(padapter)) { -+ DBG_8192C("%s() RX Warning! bDriverStopped(%s) OR bSurpriseRemoved(%s)\n" -+ , __func__ -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False"); -+ -+ return; -+ } -+ -+ if (purb->status == 0) {/*SUCCESS*/ -+ if (purb->actual_length > INTERRUPT_MSG_FORMAT_LEN) -+ DBG_8192C("usb_read_interrupt_complete: purb->actual_length > INTERRUPT_MSG_FORMAT_LEN(%d)\n", INTERRUPT_MSG_FORMAT_LEN); -+ -+ rtw_hal_interrupt_handler(padapter, purb->actual_length, purb->transfer_buffer); -+ -+ err = usb_submit_urb(purb, GFP_ATOMIC); -+ if ((err) && (err != (-EPERM))) -+ DBG_8192C("cannot submit interrupt in-token(err = 0x%08x),urb_status = %d\n", err, purb->status); -+ } else { -+ DBG_8192C("###=> usb_read_interrupt_complete => urb status(%d)\n", purb->status); -+ -+ switch (purb->status) { -+ case -EINVAL: -+ case -EPIPE: -+ case -ENODEV: -+ case -ESHUTDOWN: -+ /*rtw_set_surprise_removed(padapter);*/ -+ /*RT_TRACE(_module_hci_ops_os_c_, _drv_err_, ("usb_read_port_complete:bSurpriseRemoved=TRUE\n"));*/ -+ case -ENOENT: -+ rtw_set_drv_stopped(padapter); -+ RT_TRACE(_module_hci_ops_os_c_, _drv_err_, ("usb_read_port_complete:bDriverStopped=TRUE\n")); -+ break; -+ case -EPROTO: -+ break; -+ case -EINPROGRESS: -+ DBG_8192C("ERROR: URB IS IN PROGRESS!/n"); -+ break; -+ default: -+ break; -+ } -+ } -+} -+ -+u32 usb_read_interrupt(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ int err; -+ unsigned int pipe; -+ u32 ret = _SUCCESS; -+ _adapter *adapter = pintfhdl->padapter; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter); -+ struct recv_priv *precvpriv = &adapter->recvpriv; -+ struct usb_device *pusbd = pdvobj->pusbdev; -+ -+_func_enter_; -+ -+ if (RTW_CANNOT_RX(adapter)) { -+ RT_TRACE(_module_hci_ops_os_c_, _drv_err_, ("usb_read_interrupt:( RTW_CANNOT_RX )!!!\n")); -+ return _FAIL; -+ } -+ -+ /*translate DMA FIFO addr to pipehandle*/ -+ pipe = ffaddr2pipehdl(pdvobj, addr); -+ -+ usb_fill_int_urb(precvpriv->int_in_urb, pusbd, pipe, -+ precvpriv->int_in_buf, -+ INTERRUPT_MSG_FORMAT_LEN, -+ usb_read_interrupt_complete, -+ adapter, -+ 1); -+ -+ err = usb_submit_urb(precvpriv->int_in_urb, GFP_ATOMIC); -+ if ((err) && (err != (-EPERM))) { -+ DBG_8192C("cannot submit interrupt in-token(err = 0x%08x), urb_status = %d\n", err, precvpriv->int_in_urb->status); -+ ret = _FAIL; -+ } -+ -+_func_exit_; -+ return ret; -+} -+#endif /* CONFIG_USB_INTERRUPT_IN_PIPE */ -+ -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/wifi_regd.c linux/3rdparty/rtl8812au/os_dep/linux/wifi_regd.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/wifi_regd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/wifi_regd.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,548 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2009-2010 Realtek Corporation. -+ * -+ *****************************************************************************/ -+ -+#include -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ -+#include -+ -+static struct country_code_to_enum_rd allCountries[] = { -+ {COUNTRY_CODE_USER, "RD"}, -+}; -+ -+/* -+ * REG_RULE(freq start, freq end, bandwidth, max gain, eirp, reg_flags) -+ */ -+ -+/* -+ *Only these channels all allow active -+ *scan on all world regulatory domains -+ */ -+ -+/* 2G chan 01 - chan 11 */ -+#define RTW_2GHZ_CH01_11 \ -+ REG_RULE(2412-10, 2462+10, 40, 0, 20, 0) -+ -+/* -+ *We enable active scan on these a case -+ *by case basis by regulatory domain -+ */ -+ -+/* 2G chan 12 - chan 13, PASSIV SCAN */ -+#define RTW_2GHZ_CH12_13 \ -+ REG_RULE(2467-10, 2472+10, 40, 0, 20, \ -+ NL80211_RRF_PASSIVE_SCAN) -+ -+/* 2G chan 14, PASSIVS SCAN, NO OFDM (B only) */ -+#define RTW_2GHZ_CH14 \ -+ REG_RULE(2484-10, 2484+10, 40, 0, 20, \ -+ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_OFDM) -+ -+/* 5G chan 36 - chan 64 */ -+#define RTW_5GHZ_5150_5350 \ -+ REG_RULE(5150-10, 5350+10, 40, 0, 30, \ -+ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_IBSS) -+ -+/* 5G chan 100 - chan 165 */ -+#define RTW_5GHZ_5470_5850 \ -+ REG_RULE(5470-10, 5850+10, 40, 0, 30, \ -+ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_IBSS) -+ -+/* 5G chan 149 - chan 165 */ -+#define RTW_5GHZ_5725_5850 \ -+ REG_RULE(5725-10, 5850+10, 40, 0, 30, \ -+ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_IBSS) -+ -+/* 5G chan 36 - chan 165 */ -+#define RTW_5GHZ_5150_5850 \ -+ REG_RULE(5150-10, 5850+10, 40, 0, 30, \ -+ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_IBSS) -+ -+static const struct ieee80211_regdomain rtw_regdom_rd = { -+ .n_reg_rules = 3, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ RTW_2GHZ_CH12_13, -+ RTW_5GHZ_5150_5850, -+ } -+}; -+ -+static const struct ieee80211_regdomain rtw_regdom_11 = { -+ .n_reg_rules = 1, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ } -+}; -+ -+static const struct ieee80211_regdomain rtw_regdom_12_13 = { -+ .n_reg_rules = 2, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ RTW_2GHZ_CH12_13, -+ } -+}; -+ -+static const struct ieee80211_regdomain rtw_regdom_no_midband = { -+ .n_reg_rules = 3, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ RTW_5GHZ_5150_5350, -+ RTW_5GHZ_5725_5850, -+ } -+}; -+ -+static const struct ieee80211_regdomain rtw_regdom_60_64 = { -+ .n_reg_rules = 3, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ RTW_2GHZ_CH12_13, -+ RTW_5GHZ_5725_5850, -+ } -+}; -+ -+static const struct ieee80211_regdomain rtw_regdom_14_60_64 = { -+ .n_reg_rules = 4, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ RTW_2GHZ_CH12_13, -+ RTW_2GHZ_CH14, -+ RTW_5GHZ_5725_5850, -+ } -+}; -+ -+static const struct ieee80211_regdomain rtw_regdom_14 = { -+ .n_reg_rules = 3, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ RTW_2GHZ_CH12_13, -+ RTW_2GHZ_CH14, -+ } -+}; -+ -+#if 0 -+static struct rtw_regulatory *rtw_regd; -+#endif -+ -+static bool _rtw_is_radar_freq(u16 center_freq) -+{ -+ return (center_freq >= 5260 && center_freq <= 5700); -+} -+ -+#if 0 // not_yet -+static void _rtw_reg_apply_beaconing_flags(struct wiphy *wiphy, -+ enum nl80211_reg_initiator initiator) -+{ -+ enum ieee80211_band band; -+ struct ieee80211_supported_band *sband; -+ const struct ieee80211_reg_rule *reg_rule; -+ struct ieee80211_channel *ch; -+ unsigned int i; -+ u32 bandwidth = 0; -+ int r; -+ -+ for (band = 0; band < IEEE80211_NUM_BANDS; band++) { -+ -+ if (!wiphy->bands[band]) -+ continue; -+ -+ sband = wiphy->bands[band]; -+ -+ for (i = 0; i < sband->n_channels; i++) { -+ ch = &sband->channels[i]; -+ if (_rtw_is_radar_freq(ch->center_freq) || -+ (ch->flags & IEEE80211_CHAN_RADAR)) -+ continue; -+ if (initiator == NL80211_REGDOM_SET_BY_COUNTRY_IE) { -+ r = freq_reg_info(wiphy, ch->center_freq, -+ bandwidth, ®_rule); -+ if (r) -+ continue; -+ -+ /* -+ *If 11d had a rule for this channel ensure -+ *we enable adhoc/beaconing if it allows us to -+ *use it. Note that we would have disabled it -+ *by applying our static world regdomain by -+ *default during init, prior to calling our -+ *regulatory_hint(). -+ */ -+ -+ if (!(reg_rule->flags & NL80211_RRF_NO_IBSS)) -+ ch->flags &= ~IEEE80211_CHAN_NO_IBSS; -+ if (! -+ (reg_rule->flags & -+ NL80211_RRF_PASSIVE_SCAN)) -+ ch->flags &= -+ ~IEEE80211_CHAN_PASSIVE_SCAN; -+ } else { -+ if (ch->beacon_found) -+ ch->flags &= ~(IEEE80211_CHAN_NO_IBSS | -+ IEEE80211_CHAN_PASSIVE_SCAN); -+ } -+ } -+ } -+} -+ -+/* Allows active scan scan on Ch 12 and 13 */ -+static void _rtw_reg_apply_active_scan_flags(struct wiphy *wiphy, -+ enum nl80211_reg_initiator -+ initiator) -+{ -+ struct ieee80211_supported_band *sband; -+ struct ieee80211_channel *ch; -+ const struct ieee80211_reg_rule *reg_rule; -+ u32 bandwidth = 0; -+ int r; -+ -+ if (!wiphy->bands[IEEE80211_BAND_2GHZ]) -+ return; -+ sband = wiphy->bands[IEEE80211_BAND_2GHZ]; -+ -+ /* -+ * If no country IE has been received always enable active scan -+ * on these channels. This is only done for specific regulatory SKUs -+ */ -+ if (initiator != NL80211_REGDOM_SET_BY_COUNTRY_IE) { -+ ch = &sband->channels[11]; /* CH 12 */ -+ if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN) -+ ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN; -+ ch = &sband->channels[12]; /* CH 13 */ -+ if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN) -+ ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN; -+ return; -+ } -+ -+ /* -+ * If a country IE has been received check its rule for this -+ * channel first before enabling active scan. The passive scan -+ * would have been enforced by the initial processing of our -+ * custom regulatory domain. -+ */ -+ -+ ch = &sband->channels[11]; /* CH 12 */ -+ r = freq_reg_info(wiphy, ch->center_freq, bandwidth, ®_rule); -+ if (!r) { -+ if (!(reg_rule->flags & NL80211_RRF_PASSIVE_SCAN)) -+ if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN) -+ ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN; -+ } -+ -+ ch = &sband->channels[12]; /* CH 13 */ -+ r = freq_reg_info(wiphy, ch->center_freq, bandwidth, ®_rule); -+ if (!r) { -+ if (!(reg_rule->flags & NL80211_RRF_PASSIVE_SCAN)) -+ if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN) -+ ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN; -+ } -+} -+#endif -+ -+/* -+ * Always apply Radar/DFS rules on -+ * freq range 5260 MHz - 5700 MHz -+ */ -+static void _rtw_reg_apply_radar_flags(struct wiphy *wiphy) -+{ -+ struct ieee80211_supported_band *sband; -+ struct ieee80211_channel *ch; -+ unsigned int i; -+ -+ if (!wiphy->bands[IEEE80211_BAND_5GHZ]) -+ return; -+ -+ sband = wiphy->bands[IEEE80211_BAND_5GHZ]; -+ -+ for (i = 0; i < sband->n_channels; i++) { -+ ch = &sband->channels[i]; -+ if (!_rtw_is_radar_freq(ch->center_freq)) -+ continue; -+#ifdef CONFIG_DFS -+ #if defined(CONFIG_DFS_MASTER) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) -+ if (!(ch->flags & IEEE80211_CHAN_DISABLED)) { -+ ch->flags |= IEEE80211_CHAN_RADAR; -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,14,0)) -+ ch->flags |= (IEEE80211_CHAN_NO_IBSS|IEEE80211_CHAN_PASSIVE_SCAN); -+ #else -+ ch->flags |= IEEE80211_CHAN_NO_IR; -+ #endif -+ } -+ #endif -+#endif //CONFIG_DFS -+ -+#if 0 -+ /* -+ * We always enable radar detection/DFS on this -+ * frequency range. Additionally we also apply on -+ * this frequency range: -+ * - If STA mode does not yet have DFS supports disable -+ * active scanning -+ * - If adhoc mode does not support DFS yet then disable -+ * adhoc in the frequency. -+ * - If AP mode does not yet support radar detection/DFS -+ * do not allow AP mode -+ */ -+ if (!(ch->flags & IEEE80211_CHAN_DISABLED)) -+ ch->flags |= IEEE80211_CHAN_RADAR | -+ IEEE80211_CHAN_NO_IBSS | -+ IEEE80211_CHAN_PASSIVE_SCAN; -+#endif -+ } -+} -+ -+static void _rtw_reg_apply_flags(struct wiphy *wiphy) -+{ -+#if 1 // by channel plan -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ u8 channel_plan = padapter->mlmepriv.ChannelPlan; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ RT_CHANNEL_INFO *channel_set = pmlmeext->channel_set; -+ u8 max_chan_nums = pmlmeext->max_chan_nums; -+ -+ struct ieee80211_supported_band *sband; -+ struct ieee80211_channel *ch; -+ unsigned int i, j; -+ u16 channel; -+ u32 freq; -+ -+ // all channels disable -+ for (i = 0; i < IEEE80211_NUM_BANDS; i++) { -+ sband = wiphy->bands[i]; -+ -+ if (sband) { -+ for (j = 0; j < sband->n_channels; j++) { -+ ch = &sband->channels[j]; -+ -+ if (ch) -+ ch->flags = IEEE80211_CHAN_DISABLED; -+ } -+ } -+ } -+ -+ // channels apply by channel plans. -+ for (i = 0; i < max_chan_nums; i++) { -+ channel = channel_set[i].ChannelNum; -+ freq = rtw_ch2freq(channel); -+ -+ ch = ieee80211_get_channel(wiphy, freq); -+ if (ch) { -+ if (channel_set[i].ScanType == SCAN_PASSIVE) { -+ #if defined(CONFIG_DFS_MASTER) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) -+ ch->flags = 0; -+ #elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) -+ ch->flags = (IEEE80211_CHAN_NO_IBSS|IEEE80211_CHAN_PASSIVE_SCAN); -+ #else -+ ch->flags = IEEE80211_CHAN_NO_IR; -+ #endif -+ } -+ else { -+ ch->flags = 0; -+ } -+ } -+ } -+ -+#else -+ struct ieee80211_supported_band *sband; -+ struct ieee80211_channel *ch; -+ unsigned int i, j; -+ u16 channels[37] = -+ { 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, -+ 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, -+ 149, 153, -+ 157, 161, 165 -+ }; -+ u16 channel; -+ u32 freq; -+ -+ for (i = 0; i < IEEE80211_NUM_BANDS; i++) { -+ sband = wiphy->bands[i]; -+ -+ if (sband) -+ for (j = 0; j < sband->n_channels; j++) { -+ ch = &sband->channels[j]; -+ -+ if (ch) -+ ch->flags = IEEE80211_CHAN_DISABLED; -+ } -+ } -+ -+ for (i = 0; i < 37; i++) { -+ channel = channels[i]; -+ freq = rtw_ch2freq(channel); -+ -+ ch = ieee80211_get_channel(wiphy, freq); -+ if (ch) { -+ if (channel <= 11) -+ ch->flags = 0; -+ else -+ ch->flags = 0; //IEEE80211_CHAN_PASSIVE_SCAN; -+ } -+ //printk("%s: freq %d(%d) flag 0x%02X \n", __func__, freq, channel, ch->flags); -+ } -+#endif -+} -+ -+static void _rtw_reg_apply_world_flags(struct wiphy *wiphy, -+ enum nl80211_reg_initiator initiator, -+ struct rtw_regulatory *reg) -+{ -+ //_rtw_reg_apply_beaconing_flags(wiphy, initiator); -+ //_rtw_reg_apply_active_scan_flags(wiphy, initiator); -+ return; -+} -+ -+static int _rtw_reg_notifier_apply(struct wiphy *wiphy, -+ struct regulatory_request *request, -+ struct rtw_regulatory *reg) -+{ -+ -+ /* Hard code flags */ -+ _rtw_reg_apply_flags(wiphy); -+ -+ /* We always apply this */ -+ _rtw_reg_apply_radar_flags(wiphy); -+ -+ switch (request->initiator) { -+ case NL80211_REGDOM_SET_BY_DRIVER: -+ DBG_8192C("%s: %s\n", __func__, "NL80211_REGDOM_SET_BY_DRIVER"); -+ _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, -+ reg); -+ break; -+ case NL80211_REGDOM_SET_BY_CORE: -+ DBG_8192C("%s: %s\n", __func__, -+ "NL80211_REGDOM_SET_BY_CORE to DRV"); -+ _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, -+ reg); -+ break; -+ case NL80211_REGDOM_SET_BY_USER: -+ DBG_8192C("%s: %s\n", __func__, -+ "NL80211_REGDOM_SET_BY_USER to DRV"); -+ _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, -+ reg); -+ break; -+ case NL80211_REGDOM_SET_BY_COUNTRY_IE: -+ DBG_8192C("%s: %s\n", __func__, -+ "NL80211_REGDOM_SET_BY_COUNTRY_IE"); -+ _rtw_reg_apply_world_flags(wiphy, request->initiator, reg); -+ break; -+ } -+ -+ return 0; -+} -+ -+static const struct ieee80211_regdomain *_rtw_regdomain_select(struct -+ rtw_regulatory -+ *reg) -+{ -+#if 0 -+ switch (reg->country_code) { -+ case COUNTRY_CODE_USER: -+ default: -+ return &rtw_regdom_rd; -+ } -+#else -+ return &rtw_regdom_rd; -+#endif -+} -+ -+void _rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) -+{ -+ struct rtw_regulatory *reg = NULL; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ _rtw_reg_notifier_apply(wiphy, request, reg); -+} -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,9,0)) -+int rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) -+#else -+void rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) -+#endif -+{ -+ _rtw_reg_notifier(wiphy, request); -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,9,0)) -+ return 0; -+ #endif -+} -+ -+void rtw_reg_notify_by_driver(_adapter *adapter) -+{ -+ if ((adapter->rtw_wdev != NULL) && (adapter->rtw_wdev->wiphy)) { -+ struct regulatory_request request; -+ request.initiator = NL80211_REGDOM_SET_BY_DRIVER; -+ rtw_reg_notifier(adapter->rtw_wdev->wiphy, &request); -+ } -+} -+ -+static void _rtw_regd_init_wiphy(struct rtw_regulatory *reg, struct wiphy *wiphy) -+{ -+ const struct ieee80211_regdomain *regd; -+ -+ wiphy->reg_notifier = rtw_reg_notifier; -+ -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,14,0)) -+ wiphy->flags |= WIPHY_FLAG_CUSTOM_REGULATORY; -+ wiphy->flags &= ~WIPHY_FLAG_STRICT_REGULATORY; -+ wiphy->flags &= ~WIPHY_FLAG_DISABLE_BEACON_HINTS; -+ #else -+ wiphy->regulatory_flags |= REGULATORY_CUSTOM_REG; -+ wiphy->regulatory_flags &= ~REGULATORY_STRICT_REG; -+ wiphy->regulatory_flags &= ~REGULATORY_DISABLE_BEACON_HINTS; -+ #endif -+ -+ regd = _rtw_regdomain_select(reg); -+ wiphy_apply_custom_regulatory(wiphy, regd); -+ -+ /* Hard code flags */ -+ _rtw_reg_apply_flags(wiphy); -+ _rtw_reg_apply_radar_flags(wiphy); -+ _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, reg); -+} -+ -+static struct country_code_to_enum_rd *_rtw_regd_find_country(u16 countrycode) -+{ -+ int i; -+ -+ for (i = 0; i < ARRAY_SIZE(allCountries); i++) { -+ if (allCountries[i].countrycode == countrycode) -+ return &allCountries[i]; -+ } -+ return NULL; -+} -+ -+int rtw_regd_init(_adapter * padapter) -+{ -+ struct wiphy *wiphy = padapter->rtw_wdev->wiphy; -+ -+#if 0 -+ if (rtw_regd == NULL) { -+ rtw_regd = (struct rtw_regulatory *) -+ rtw_malloc(sizeof(struct rtw_regulatory)); -+ -+ rtw_regd->alpha2[0] = '9'; -+ rtw_regd->alpha2[1] = '9'; -+ -+ rtw_regd->country_code = COUNTRY_CODE_USER; -+ } -+ -+ DBG_8192C("%s: Country alpha2 being used: %c%c\n", -+ __func__, rtw_regd->alpha2[0], rtw_regd->alpha2[1]); -+#endif -+ -+ _rtw_regd_init_wiphy(NULL, wiphy); -+ -+ return 0; -+} -+#endif //CONFIG_IOCTL_CFG80211 -+ -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c ---- linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,539 @@ +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/usb_ops_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/usb_ops_linux.c +--- linux-4.14.17/3rdparty/rtl8812au/os_dep/usb_ops_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/usb_ops_linux.c 2018-02-06 17:42:30.725967387 +0200 +@@ -0,0 +1,772 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * ++ * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. @@ -380614,17 +181929,787 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA ++ ******************************************************************************/ ++#define _USB_OPS_LINUX_C_ ++ ++#include ++#include ++#include ++ ++int usbctrl_vendorreq(struct intf_hdl *pintfhdl, u8 request, u16 value, u16 index, void *pdata, u16 len, u8 requesttype) ++{ ++ _adapter *padapter = pintfhdl->padapter; ++ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); ++ struct usb_device *udev=pdvobjpriv->pusbdev; ++ ++ unsigned int pipe; ++ int status = 0; ++ u32 tmp_buflen=0; ++ u8 reqtype; ++ u8 *pIo_buf; ++ int vendorreq_times = 0; ++ ++ #ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE ++ u8 *tmp_buf; ++ #else // use stack memory ++ u8 tmp_buf[MAX_USB_IO_CTL_SIZE]; ++ #endif ++ ++#ifdef CONFIG_CONCURRENT_MODE ++ if(padapter->adapter_type > PRIMARY_ADAPTER) ++ { ++ padapter = padapter->pbuddy_adapter; ++ pdvobjpriv = adapter_to_dvobj(padapter); ++ udev = pdvobjpriv->pusbdev; ++ } ++#endif ++ ++ //DBG_871X("%s %s:%d\n",__FUNCTION__, current->comm, current->pid); ++ ++ if((padapter->bSurpriseRemoved) ||(padapter->pwrctrlpriv.pnp_bstop_trx)){ ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usbctrl_vendorreq:(padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n")); ++ status = -EPERM; ++ goto exit; ++ } ++ ++ if(len>MAX_VENDOR_REQ_CMD_SIZE){ ++ DBG_8192C( "[%s] Buffer len error ,vendor request failed\n", __FUNCTION__ ); ++ status = -EINVAL; ++ goto exit; ++ } ++ ++ #ifdef CONFIG_USB_VENDOR_REQ_MUTEX ++ _enter_critical_mutex(&pdvobjpriv->usb_vendor_req_mutex, NULL); ++ #endif ++ ++ ++ // Acquire IO memory for vendorreq ++#ifdef CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC ++ pIo_buf = pdvobjpriv->usb_vendor_req_buf; ++#else ++ #ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE ++ tmp_buf = rtw_malloc( (u32) len + ALIGNMENT_UNIT); ++ tmp_buflen = (u32)len + ALIGNMENT_UNIT; ++ #else // use stack memory ++ tmp_buflen = MAX_USB_IO_CTL_SIZE; ++ #endif ++ ++ // Added by Albert 2010/02/09 ++ // For mstar platform, mstar suggests the address for USB IO should be 16 bytes alignment. ++ // Trying to fix it here. ++ pIo_buf = (tmp_buf==NULL)?NULL:tmp_buf + ALIGNMENT_UNIT -((SIZE_PTR)(tmp_buf) & 0x0f ); ++#endif ++ ++ if ( pIo_buf== NULL) { ++ DBG_8192C( "[%s] pIo_buf == NULL \n", __FUNCTION__ ); ++ status = -ENOMEM; ++ goto release_mutex; ++ } ++ ++ while(++vendorreq_times<= MAX_USBCTRL_VENDORREQ_TIMES) ++ { ++ _rtw_memset(pIo_buf, 0, len); ++ ++ if (requesttype == 0x01) ++ { ++ pipe = usb_rcvctrlpipe(udev, 0);//read_in ++ reqtype = REALTEK_USB_VENQT_READ; ++ } ++ else ++ { ++ pipe = usb_sndctrlpipe(udev, 0);//write_out ++ reqtype = REALTEK_USB_VENQT_WRITE; ++ _rtw_memcpy( pIo_buf, pdata, len); ++ } ++ ++ status = rtw_usb_control_msg(udev, pipe, request, reqtype, value, index, pIo_buf, len, RTW_USB_CONTROL_MSG_TIMEOUT); ++ ++ if ( status == len) // Success this control transfer. ++ { ++ rtw_reset_continual_urb_error(pdvobjpriv); ++ if ( requesttype == 0x01 ) ++ { // For Control read transfer, we have to copy the read data from pIo_buf to pdata. ++ _rtw_memcpy( pdata, pIo_buf, len ); ++ } ++ } ++ else { // error cases ++ DBG_8192C("reg 0x%x, usb %s %u fail, status:%d value=0x%x, vendorreq_times:%d\n" ++ , value,(requesttype == 0x01)?"read":"write" , len, status, *(u32*)pdata, vendorreq_times); ++ ++ if (status < 0) { ++ if(status == (-ESHUTDOWN) || status == -ENODEV ) ++ { ++ padapter->bSurpriseRemoved = true; ++ } else { ++ #ifdef DBG_CONFIG_ERROR_DETECT ++ { ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ pHalData->srestpriv.Wifi_Error_Status = USB_VEN_REQ_CMD_FAIL; ++ } ++ #endif ++ } ++ } ++ else // status != len && status >= 0 ++ { ++ if(status > 0) { ++ if ( requesttype == 0x01 ) ++ { // For Control read transfer, we have to copy the read data from pIo_buf to pdata. ++ _rtw_memcpy( pdata, pIo_buf, len ); ++ } ++ } ++ } ++ ++ if(rtw_inc_and_chk_continual_urb_error(pdvobjpriv) == true ){ ++ padapter->bSurpriseRemoved = true; ++ break; ++ } ++ ++ } ++ ++ // firmware download is checksumed, don't retry ++ if( (value >= FW_START_ADDRESS ) || status == len ) ++ break; ++ ++ } ++ ++ // release IO memory used by vendorreq ++ #ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE ++ rtw_mfree(tmp_buf, tmp_buflen); ++ #endif ++ ++release_mutex: ++ #ifdef CONFIG_USB_VENDOR_REQ_MUTEX ++ _exit_critical_mutex(&pdvobjpriv->usb_vendor_req_mutex, NULL); ++ #endif ++exit: ++ return status; ++ ++} ++ ++#ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ ++static void _usbctrl_vendorreq_async_callback(struct urb *urb, struct pt_regs *regs) ++{ ++ if (urb) { ++ if (urb->context) { ++ kfree(urb->context); ++ } ++ usb_free_urb(urb); ++ } ++} ++ ++static int _usbctrl_vendorreq_async_write(struct usb_device *udev, u8 request, ++ u16 value, u16 index, void *pdata, u16 len, u8 requesttype) ++{ ++ int rc; ++ unsigned int pipe; ++ u8 reqtype; ++ struct usb_ctrlrequest *dr; ++ struct urb *urb; ++ struct rtl819x_async_write_data { ++ u8 data[VENDOR_CMD_MAX_DATA_LEN]; ++ struct usb_ctrlrequest dr; ++ } *buf; ++ ++ ++ if (requesttype == VENDOR_READ) { ++ pipe = usb_rcvctrlpipe(udev, 0);//read_in ++ reqtype = REALTEK_USB_VENQT_READ; ++ } ++ else { ++ pipe = usb_sndctrlpipe(udev, 0);//write_out ++ reqtype = REALTEK_USB_VENQT_WRITE; ++ } ++ ++ buf = (struct rtl819x_async_write_data *)rtw_zmalloc(sizeof(*buf)); ++ if (!buf) { ++ rc = -ENOMEM; ++ goto exit; ++ } ++ ++ urb = usb_alloc_urb(0, GFP_ATOMIC); ++ if (!urb) { ++ rtw_mfree((u8*)buf, sizeof(*buf)); ++ rc = -ENOMEM; ++ goto exit; ++ } ++ ++ dr = &buf->dr; ++ ++ dr->bRequestType = reqtype; ++ dr->bRequest = request; ++ dr->wValue = cpu_to_le16(value); ++ dr->wIndex = cpu_to_le16(index); ++ dr->wLength = cpu_to_le16(len); ++ ++ _rtw_memcpy(buf, pdata, len); ++ ++ usb_fill_control_urb(urb, udev, pipe, (unsigned char *)dr, buf, len, ++ _usbctrl_vendorreq_async_callback, buf); ++ ++ rc = usb_submit_urb(urb, GFP_ATOMIC); ++ if (rc < 0) { ++ rtw_mfree((u8*)buf, sizeof(*buf)); ++ usb_free_urb(urb); ++ } ++ ++exit: ++ return rc; ++} ++ ++int usb_write_async(struct usb_device *udev, u32 addr, void *pdata, u16 len) ++{ ++ u8 request; ++ u8 requesttype; ++ u16 wvalue; ++ u16 index; ++ ++ int ret; ++ ++ requesttype = VENDOR_WRITE;//write_out ++ request = REALTEK_USB_VENQT_CMD_REQ; ++ index = REALTEK_USB_VENQT_CMD_IDX;//n/a ++ ++ wvalue = (u16)(addr&0x0000ffff); ++ ++ ret = _usbctrl_vendorreq_async_write(udev, request, wvalue, index, pdata, len, requesttype); ++ ++ return ret; ++} ++ ++int usb_async_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val) ++{ ++ u8 data; ++ int ret; ++ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; ++ struct usb_device *udev=pdvobjpriv->pusbdev; ++ ++ ++ data = val; ++ ret = usb_write_async(udev, addr, &data, 1); ++ ++ ++ return ret; ++} ++ ++int usb_async_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val) ++{ ++ u16 data; ++ int ret; ++ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; ++ struct usb_device *udev=pdvobjpriv->pusbdev; ++ ++ ++ data = val; ++ ret = usb_write_async(udev, addr, &data, 2); ++ ++ ++ return ret; ++} ++ ++int usb_async_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val) ++{ ++ u32 data; ++ int ret; ++ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; ++ struct usb_device *udev=pdvobjpriv->pusbdev; ++ ++ ++ data = val; ++ ret = usb_write_async(udev, addr, &data, 4); ++ ++ ++ return ret; ++} ++#endif /* CONFIG_USB_SUPPORT_ASYNC_VDN_REQ */ ++ ++unsigned int ffaddr2pipehdl(struct dvobj_priv *pdvobj, u32 addr) ++{ ++ unsigned int pipe=0, ep_num=0; ++ struct usb_device *pusbd = pdvobj->pusbdev; ++ ++ if (addr == RECV_BULK_IN_ADDR) { ++ pipe=usb_rcvbulkpipe(pusbd, pdvobj->RtInPipe[0]); ++ ++ } else if (addr == RECV_INT_IN_ADDR) { ++ pipe=usb_rcvbulkpipe(pusbd, pdvobj->RtInPipe[1]); ++ ++ } else if (addr < HW_QUEUE_ENTRY) { ++ ep_num = pdvobj->Queue2Pipe[addr]; ++ pipe = usb_sndbulkpipe(pusbd, ep_num); ++ } ++ ++ return pipe; ++} ++ ++struct zero_bulkout_context{ ++ void *pbuf; ++ void *purb; ++ void *pirp; ++ void *padapter; ++}; ++ ++static void usb_bulkout_zero_complete(struct urb *purb, struct pt_regs *regs) ++{ ++ struct zero_bulkout_context *pcontext = (struct zero_bulkout_context *)purb->context; ++ ++ //DBG_8192C("+usb_bulkout_zero_complete\n"); ++ ++ if(pcontext) ++ { ++ if(pcontext->pbuf) ++ { ++ rtw_mfree(pcontext->pbuf, sizeof(int)); ++ } ++ ++ if(pcontext->purb && (pcontext->purb==purb)) ++ { ++ usb_free_urb(pcontext->purb); ++ } ++ ++ ++ rtw_mfree((u8*)pcontext, sizeof(struct zero_bulkout_context)); ++ } ++ ++ ++} ++ ++static u32 usb_bulkout_zero(struct intf_hdl *pintfhdl, u32 addr) ++{ ++ int pipe, status, len; ++ u32 ret; ++ unsigned char *pbuf; ++ struct zero_bulkout_context *pcontext; ++ PURB purb = NULL; ++ _adapter *padapter = (_adapter *)pintfhdl->padapter; ++ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); ++ struct usb_device *pusbd = pdvobj->pusbdev; ++ ++ //DBG_871X("%s\n", __func__); ++ ++ ++ if((padapter->bDriverStopped) || (padapter->bSurpriseRemoved) ||(padapter->pwrctrlpriv.pnp_bstop_trx)) ++ { ++ return _FAIL; ++ } ++ ++ ++ pcontext = (struct zero_bulkout_context *)rtw_zmalloc(sizeof(struct zero_bulkout_context)); ++ ++ pbuf = (unsigned char *)rtw_zmalloc(sizeof(int)); ++ purb = usb_alloc_urb(0, GFP_ATOMIC); ++ ++ len = 0; ++ pcontext->pbuf = pbuf; ++ pcontext->purb = purb; ++ pcontext->pirp = NULL; ++ pcontext->padapter = padapter; ++ ++ ++ //translate DMA FIFO addr to pipehandle ++ //pipe = ffaddr2pipehdl(pdvobj, addr); ++ ++ usb_fill_bulk_urb(purb, pusbd, pipe, ++ pbuf, ++ len, ++ usb_bulkout_zero_complete, ++ pcontext);//context is pcontext ++ ++ status = usb_submit_urb(purb, GFP_ATOMIC); ++ ++ if (!status) ++ { ++ ret= _SUCCESS; ++ } ++ else ++ { ++ ret= _FAIL; ++ } ++ ++ ++ return _SUCCESS; ++ ++} ++ ++void usb_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) ++{ ++ ++} ++ ++void usb_write_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem) ++{ ++ ++} ++ ++ ++void usb_read_port_cancel(struct intf_hdl *pintfhdl) ++{ ++ int i; ++ struct recv_buf *precvbuf; ++ _adapter *padapter = pintfhdl->padapter; ++ precvbuf = (struct recv_buf *)padapter->recvpriv.precv_buf; ++ ++ DBG_871X("%s\n", __func__); ++ ++ padapter->bReadPortCancel = true; ++ ++ for (i=0; i < NR_RECVBUFF ; i++) { ++ ++ precvbuf->reuse = true; ++ if (precvbuf->purb) { ++ //DBG_8192C("usb_read_port_cancel : usb_kill_urb \n"); ++ usb_kill_urb(precvbuf->purb); ++ } ++ precvbuf++; ++ } ++ ++#ifdef CONFIG_USB_INTERRUPT_IN_PIPE ++ usb_kill_urb(padapter->recvpriv.int_in_urb); ++#endif ++} ++ ++static void usb_write_port_complete(struct urb *purb, struct pt_regs *regs) ++{ ++ _irqL irqL; ++ int i; ++ struct xmit_buf *pxmitbuf = (struct xmit_buf *)purb->context; ++ //struct xmit_frame *pxmitframe = (struct xmit_frame *)pxmitbuf->priv_data; ++ //_adapter *padapter = pxmitframe->padapter; ++ _adapter *padapter = pxmitbuf->padapter; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ //struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ ++ ++ ++ switch(pxmitbuf->flags) ++ { ++ case VO_QUEUE_INX: ++ pxmitpriv->voq_cnt--; ++ break; ++ case VI_QUEUE_INX: ++ pxmitpriv->viq_cnt--; ++ break; ++ case BE_QUEUE_INX: ++ pxmitpriv->beq_cnt--; ++ break; ++ case BK_QUEUE_INX: ++ pxmitpriv->bkq_cnt--; ++ break; ++ case HIGH_QUEUE_INX: ++#ifdef CONFIG_AP_MODE ++ rtw_chk_hi_queue_cmd(padapter); ++#endif ++ break; ++ default: ++ break; ++ } ++ ++ ++/* ++ _enter_critical(&pxmitpriv->lock, &irqL); ++ ++ pxmitpriv->txirp_cnt--; ++ ++ switch(pattrib->priority) ++ { ++ case 1: ++ case 2: ++ pxmitpriv->bkq_cnt--; ++ //DBG_8192C("pxmitpriv->bkq_cnt=%d\n", pxmitpriv->bkq_cnt); ++ break; ++ case 4: ++ case 5: ++ pxmitpriv->viq_cnt--; ++ //DBG_8192C("pxmitpriv->viq_cnt=%d\n", pxmitpriv->viq_cnt); ++ break; ++ case 6: ++ case 7: ++ pxmitpriv->voq_cnt--; ++ //DBG_8192C("pxmitpriv->voq_cnt=%d\n", pxmitpriv->voq_cnt); ++ break; ++ case 0: ++ case 3: ++ default: ++ pxmitpriv->beq_cnt--; ++ //DBG_8192C("pxmitpriv->beq_cnt=%d\n", pxmitpriv->beq_cnt); ++ break; ++ ++ } ++ ++ _exit_critical(&pxmitpriv->lock, &irqL); ++ ++ ++ if(pxmitpriv->txirp_cnt==0) ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete: txirp_cnt== 0, set allrxreturnevt!\n")); ++ _rtw_up_sema(&(pxmitpriv->tx_retevt)); ++ } ++*/ ++ //rtw_free_xmitframe(pxmitpriv, pxmitframe); ++ ++ if(padapter->bSurpriseRemoved || padapter->bDriverStopped ||padapter->bWritePortCancel) ++ { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete:bDriverStopped(%d) OR bSurpriseRemoved(%d)", padapter->bDriverStopped, padapter->bSurpriseRemoved)); ++ DBG_8192C("%s(): TX Warning! bDriverStopped(%d) OR bSurpriseRemoved(%d) bWritePortCancel(%d) pxmitbuf->buf_tag(%x) \n", ++ __FUNCTION__,padapter->bDriverStopped, padapter->bSurpriseRemoved,padapter->bReadPortCancel,pxmitbuf->buf_tag); ++ ++ goto check_completion; ++ } ++ ++ ++ if (purb->status==0) { ++ ++ } else { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete : purb->status(%d) != 0 \n", purb->status)); ++ DBG_871X("###=> urb_write_port_complete status(%d)\n",purb->status); ++ if((purb->status==-EPIPE)||(purb->status==-EPROTO)) ++ { ++ //usb_clear_halt(pusbdev, purb->pipe); ++ //msleep(10); ++ sreset_set_wifi_error_status(padapter, USB_WRITE_PORT_FAIL); ++ } else if (purb->status == -EINPROGRESS) { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete: EINPROGESS\n")); ++ goto check_completion; ++ ++ } else if (purb->status == -ENOENT) { ++ DBG_871X("%s: -ENOENT\n", __func__); ++ goto check_completion; ++ ++ } else if (purb->status == -ECONNRESET) { ++ DBG_871X("%s: -ECONNRESET\n", __func__); ++ goto check_completion; ++ ++ } else if (purb->status == -ESHUTDOWN) { ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete: ESHUTDOWN\n")); ++ padapter->bDriverStopped=true; ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete:bDriverStopped=TRUE\n")); ++ ++ goto check_completion; ++ } ++ else ++ { ++ padapter->bSurpriseRemoved=true; ++ DBG_8192C("bSurpriseRemoved=TRUE\n"); ++ //rtl8192cu_trigger_gpio_0(padapter); ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete:bSurpriseRemoved=TRUE\n")); ++ ++ goto check_completion; ++ } ++ } ++ ++ #ifdef DBG_CONFIG_ERROR_DETECT ++ { ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ pHalData->srestpriv.last_tx_complete_time = rtw_get_current_time(); ++ } ++ #endif ++ ++check_completion: ++ _enter_critical(&pxmitpriv->lock_sctx, &irqL); ++ rtw_sctx_done_err(&pxmitbuf->sctx, ++ purb->status ? RTW_SCTX_DONE_WRITE_PORT_ERR : RTW_SCTX_DONE_SUCCESS); ++ _exit_critical(&pxmitpriv->lock_sctx, &irqL); ++ ++ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); ++ ++ //if(rtw_txframes_pending(padapter)) ++ { ++ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); ++ } ++ ++ ++ ++} ++ ++u32 usb_write_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem) ++{ ++ _irqL irqL; ++ unsigned int pipe; ++ int status; ++ u32 ret = _FAIL, bwritezero = false; ++ PURB purb = NULL; ++ _adapter *padapter = (_adapter *)pintfhdl->padapter; ++ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; ++ struct xmit_buf *pxmitbuf = (struct xmit_buf *)wmem; ++ struct xmit_frame *pxmitframe = (struct xmit_frame *)pxmitbuf->priv_data; ++ struct usb_device *pusbd = pdvobj->pusbdev; ++ struct pkt_attrib *pattrib = &pxmitframe->attrib; ++ ++ ++ ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("+usb_write_port\n")); ++ ++ if ((padapter->bDriverStopped) || (padapter->bSurpriseRemoved) ||(padapter->pwrctrlpriv.pnp_bstop_trx)) { ++ #ifdef DBG_TX ++ DBG_871X(" DBG_TX %s:%d bDriverStopped%d, bSurpriseRemoved:%d, pnp_bstop_trx:%d\n",__FUNCTION__, __LINE__ ++ ,padapter->bDriverStopped, padapter->bSurpriseRemoved, padapter->pwrctrlpriv.pnp_bstop_trx ); ++ #endif ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port:( padapter->bDriverStopped ||padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n")); ++ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_TX_DENY); ++ goto exit; ++ } ++ ++ _enter_critical(&pxmitpriv->lock, &irqL); ++ ++ switch(addr) ++ { ++ case VO_QUEUE_INX: ++ pxmitpriv->voq_cnt++; ++ pxmitbuf->flags = VO_QUEUE_INX; ++ break; ++ case VI_QUEUE_INX: ++ pxmitpriv->viq_cnt++; ++ pxmitbuf->flags = VI_QUEUE_INX; ++ break; ++ case BE_QUEUE_INX: ++ pxmitpriv->beq_cnt++; ++ pxmitbuf->flags = BE_QUEUE_INX; ++ break; ++ case BK_QUEUE_INX: ++ pxmitpriv->bkq_cnt++; ++ pxmitbuf->flags = BK_QUEUE_INX; ++ break; ++ case HIGH_QUEUE_INX: ++ pxmitbuf->flags = HIGH_QUEUE_INX; ++ break; ++ default: ++ pxmitbuf->flags = MGT_QUEUE_INX; ++ break; ++ } ++ ++ _exit_critical(&pxmitpriv->lock, &irqL); ++ ++ purb = pxmitbuf->pxmit_urb[0]; ++ ++ //translate DMA FIFO addr to pipehandle ++ pipe = ffaddr2pipehdl(pdvobj, addr); ++ ++#ifdef CONFIG_REDUCE_USB_TX_INT ++ if ( (pxmitpriv->free_xmitbuf_cnt%NR_XMITBUFF == 0) ++ || (pxmitbuf->buf_tag > XMITBUF_DATA) ) ++ { ++ purb->transfer_flags &= (~URB_NO_INTERRUPT); ++ } else { ++ purb->transfer_flags |= URB_NO_INTERRUPT; ++ //DBG_8192C("URB_NO_INTERRUPT "); ++ } ++#endif ++ ++ ++ usb_fill_bulk_urb(purb, pusbd, pipe, ++ pxmitframe->buf_addr, //= pxmitbuf->pbuf ++ cnt, ++ usb_write_port_complete, ++ pxmitbuf);//context is pxmitbuf ++ ++#ifdef CONFIG_USE_USB_BUFFER_ALLOC_TX ++ purb->transfer_dma = pxmitbuf->dma_transfer_addr; ++ purb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; ++ purb->transfer_flags |= URB_ZERO_PACKET; ++#endif // CONFIG_USE_USB_BUFFER_ALLOC_TX ++ ++#if 0 ++ if (bwritezero) ++ { ++ purb->transfer_flags |= URB_ZERO_PACKET; ++ } ++#endif ++ ++ status = usb_submit_urb(purb, GFP_ATOMIC); ++ if (!status) { ++ #ifdef DBG_CONFIG_ERROR_DETECT ++ { ++ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); ++ pHalData->srestpriv.last_tx_time = rtw_get_current_time(); ++ } ++ #endif ++ } else { ++ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_WRITE_PORT_ERR); ++ DBG_871X("usb_write_port, status=%d\n", status); ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port(): usb_submit_urb, status=%x\n", status)); ++ ++ switch (status) { ++ case -ENODEV: ++ padapter->bDriverStopped=true; ++ break; ++ default: ++ break; ++ } ++ goto exit; ++ } ++ ++ ret= _SUCCESS; ++ ++// Commented by Albert 2009/10/13 ++// We add the URB_ZERO_PACKET flag to urb so that the host will send the zero packet automatically. ++/* ++ if(bwritezero == true) ++ { ++ usb_bulkout_zero(pintfhdl, addr); ++ } ++*/ ++ ++ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("-usb_write_port\n")); ++ ++exit: ++ if (ret != _SUCCESS) ++ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); ++ ++ return ret; ++ ++} ++ ++void usb_write_port_cancel(struct intf_hdl *pintfhdl) ++{ ++ int i, j; ++ _adapter *padapter = pintfhdl->padapter; ++ struct xmit_buf *pxmitbuf = (struct xmit_buf *)padapter->xmitpriv.pxmitbuf; ++ ++ DBG_871X("%s \n", __func__); ++ ++ padapter->bWritePortCancel = true; ++ ++ for (i=0; ipxmit_urb[j]) { ++ usb_kill_urb(pxmitbuf->pxmit_urb[j]); ++ } ++ } ++ pxmitbuf++; ++ } ++ ++ pxmitbuf = (struct xmit_buf*)padapter->xmitpriv.pxmit_extbuf; ++ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { ++ for (j=0; j<8; j++) { ++ if(pxmitbuf->pxmit_urb[j]) { ++ usb_kill_urb(pxmitbuf->pxmit_urb[j]); ++ } ++ } ++ pxmitbuf++; ++ } ++} +diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/xmit_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/xmit_linux.c +--- linux-4.14.17/3rdparty/rtl8812au/os_dep/xmit_linux.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/xmit_linux.c 2018-02-06 17:42:30.726967401 +0200 +@@ -0,0 +1,407 @@ ++/****************************************************************************** + * ++ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but WITHOUT ++ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or ++ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for ++ * more details. + * + ******************************************************************************/ +#define _XMIT_OSDEP_C_ + +#include + -+#define DBG_DUMP_OS_QUEUE_CTL 0 + +uint rtw_remainder_len(struct pkt_file *pfile) +{ @@ -380633,49 +182718,49 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty + +void _rtw_open_pktfile (_pkt *pktptr, struct pkt_file *pfile) +{ -+_func_enter_; ++ + + pfile->pkt = pktptr; + pfile->cur_addr = pfile->buf_start = pktptr->data; + pfile->pkt_len = pfile->buf_len = pktptr->len; + + pfile->cur_buffer = pfile->buf_start ; -+ -+_func_exit_; ++ ++ +} + +uint _rtw_pktfile_read (struct pkt_file *pfile, u8 *rmem, uint rlen) -+{ ++{ + uint len = 0; -+ -+_func_enter_; ++ ++ + + len = rtw_remainder_len(pfile); -+ len = (rlen > len)? len: rlen; ++ len = (rlen > len)? len: rlen; + + if(rmem) + skb_copy_bits(pfile->pkt, pfile->buf_len-pfile->pkt_len, rmem, len); + + pfile->cur_addr += len; + pfile->pkt_len -= len; -+ -+_func_exit_; + -+ return len; ++ ++ ++ return len; +} + +sint rtw_endofpktfile(struct pkt_file *pfile) +{ -+_func_enter_; ++ + + if (pfile->pkt_len == 0) { -+_func_exit_; -+ return _TRUE; ++ ++ return true; + } + -+_func_exit_; + -+ return _FALSE; ++ ++ return false; +} + +void rtw_set_tx_chksum_offload(_pkt *pkt, struct pkt_attrib *pattrib) @@ -380684,10 +182769,10 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty +#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX + struct sk_buff *skb = (struct sk_buff *)pkt; + pattrib->hw_tcp_csum = 0; -+ ++ + if (skb->ip_summed == CHECKSUM_PARTIAL) { + if (skb_shinfo(skb)->nr_frags == 0) -+ { ++ { + const struct iphdr *ip = ip_hdr(skb); + if (ip->protocol == IPPROTO_TCP) { + // TCP checksum offload by HW @@ -380696,7 +182781,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty + //skb_checksum_help(skb); + } else if (ip->protocol == IPPROTO_UDP) { + //DBG_871X("CHECKSUM_PARTIAL UDP\n"); -+#if 1 ++#if 1 + skb_checksum_help(skb); +#else + // Set UDP checksum = 0 to skip checksum check @@ -380710,11 +182795,11 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty + } + else { // IP fragmentation case + DBG_871X("%s-%d nr_frags != 0, using skb_checksum_help(skb);!!\n", __FUNCTION__, __LINE__); -+ skb_checksum_help(skb); -+ } ++ skb_checksum_help(skb); ++ } + } -+#endif -+ ++#endif ++ +} + +int rtw_os_xmit_resource_alloc(_adapter *padapter, struct xmit_buf *pxmitbuf, u32 alloc_sz, u8 flag) @@ -380729,7 +182814,7 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty + if(pxmitbuf->pallocated_buf == NULL) + return _FAIL; +#else // CONFIG_USE_USB_BUFFER_ALLOC_TX -+ ++ + pxmitbuf->pallocated_buf = rtw_zmalloc(alloc_sz); + if (pxmitbuf->pallocated_buf == NULL) + { @@ -380742,38 +182827,30 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty + } + + if (flag) { -+#ifdef CONFIG_USB_HCI + int i; + for(i=0; i<8; i++) -+ { -+ pxmitbuf->pxmit_urb[i] = usb_alloc_urb(0, GFP_KERNEL); -+ if(pxmitbuf->pxmit_urb[i] == NULL) -+ { -+ DBG_871X("pxmitbuf->pxmit_urb[i]==NULL"); -+ return _FAIL; -+ } -+ } -+#endif ++ { ++ pxmitbuf->pxmit_urb[i] = usb_alloc_urb(0, GFP_KERNEL); ++ if(pxmitbuf->pxmit_urb[i] == NULL) ++ { ++ DBG_871X("pxmitbuf->pxmit_urb[i]==NULL"); ++ return _FAIL; ++ } ++ } + } -+ -+ return _SUCCESS; ++ return _SUCCESS; +} + +void rtw_os_xmit_resource_free(_adapter *padapter, struct xmit_buf *pxmitbuf,u32 free_sz, u8 flag) +{ + if (flag) { -+#ifdef CONFIG_USB_HCI + int i; + + for(i=0; i<8; i++) + { + if(pxmitbuf->pxmit_urb[i]) -+ { -+ //usb_kill_urb(pxmitbuf->pxmit_urb[i]); + usb_free_urb(pxmitbuf->pxmit_urb[i]); -+ } + } -+#endif + } + + if (free_sz > 0 ) { @@ -380791,109 +182868,50 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty + } +} + -+void dump_os_queue(void *sel, _adapter *padapter) -+{ -+ struct net_device *ndev = padapter->pnetdev; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ int i; -+ -+ for (i=0;i<4;i++) { -+ DBG_871X_SEL_NL(sel, "os_queue[%d]:%s\n" -+ , i, __netif_subqueue_stopped(ndev, i)?"stopped":"waked"); -+ } -+#else -+ DBG_871X_SEL_NL(sel, "os_queue:%s\n" -+ , netif_queue_stopped(ndev)?"stopped":"waked"); -+#endif -+} -+ +#define WMM_XMIT_THRESHOLD (NR_XMITFRAME*2/5) + -+inline static bool rtw_os_need_wake_queue(_adapter *padapter, u16 qidx) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ if (padapter->registrypriv.wifi_spec) { -+ if (pxmitpriv->hwxmits[qidx].accnt < WMM_XMIT_THRESHOLD) -+ return _TRUE; -+ } else { -+ return _TRUE; -+ } -+ return _FALSE; -+#else -+ return _TRUE; -+#endif -+} -+ -+inline static bool rtw_os_need_stop_queue(_adapter *padapter, u16 qidx) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ if (padapter->registrypriv.wifi_spec) { -+ /* No free space for Tx, tx_worker is too slow */ -+ if (pxmitpriv->hwxmits[qidx].accnt > WMM_XMIT_THRESHOLD) -+ return _TRUE; -+ } else { -+ if(pxmitpriv->free_xmitframe_cnt<=4) -+ return _TRUE; -+ } -+#else -+ if(pxmitpriv->free_xmitframe_cnt<=4) -+ return _TRUE; -+#endif -+ return _FALSE; -+} -+ +void rtw_os_pkt_complete(_adapter *padapter, _pkt *pkt) +{ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ u16 qidx; ++ u16 queue; ++ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + -+ qidx = skb_get_queue_mapping(pkt); -+ if (rtw_os_need_wake_queue(padapter, qidx)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ DBG_871X(FUNC_ADPT_FMT": netif_wake_subqueue[%d]\n", FUNC_ADPT_ARG(padapter), qidx); -+ netif_wake_subqueue(padapter->pnetdev, qidx); ++ queue = skb_get_queue_mapping(pkt); ++ if (padapter->registrypriv.wifi_spec) { ++ if(__netif_subqueue_stopped(padapter->pnetdev, queue) && ++ (pxmitpriv->hwxmits[queue].accnt < WMM_XMIT_THRESHOLD)) ++ { ++ netif_wake_subqueue(padapter->pnetdev, queue); ++ } ++ } else { ++ if(__netif_subqueue_stopped(padapter->pnetdev, queue)) ++ netif_wake_subqueue(padapter->pnetdev, queue); + } +#else -+ if (rtw_os_need_wake_queue(padapter, 0)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ DBG_871X(FUNC_ADPT_FMT": netif_wake_queue\n", FUNC_ADPT_ARG(padapter)); ++ if (netif_queue_stopped(padapter->pnetdev)) + netif_wake_queue(padapter->pnetdev); -+ } +#endif + -+ rtw_skb_free(pkt); ++ dev_kfree_skb_any(pkt); +} + +void rtw_os_xmit_complete(_adapter *padapter, struct xmit_frame *pxframe) +{ + if(pxframe->pkt) ++ { ++ //RT_TRACE(_module_xmit_osdep_c_,_drv_err_,("linux : rtw_os_xmit_complete, dev_kfree_skb()\n")); ++ ++ //dev_kfree_skb_any(pxframe->pkt); + rtw_os_pkt_complete(padapter, pxframe->pkt); + ++ } ++ + pxframe->pkt = NULL; +} + +void rtw_os_xmit_schedule(_adapter *padapter) +{ + _adapter *pri_adapter = padapter; -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ if(!padapter) -+ return; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->adapter_type > PRIMARY_ADAPTER) -+ pri_adapter = padapter->pbuddy_adapter; -+#endif -+ -+ if (_rtw_queue_empty(&padapter->xmitpriv.pending_xmitbuf_queue) == _FALSE) -+ _rtw_up_sema(&pri_adapter->xmitpriv.xmit_sema); -+ -+ -+#else + _irqL irqL; + struct xmit_priv *pxmitpriv; + @@ -380904,62 +182922,38 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty + + _enter_critical_bh(&pxmitpriv->lock, &irqL); + -+ if(rtw_txframes_pending(padapter)) ++ if(rtw_txframes_pending(padapter)) + { + tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); + } + + _exit_critical_bh(&pxmitpriv->lock, &irqL); -+#endif +} + -+static bool rtw_check_xmit_resource(_adapter *padapter, _pkt *pkt) ++static void rtw_check_xmit_resource(_adapter *padapter, _pkt *pkt) +{ -+ bool busy = _FALSE; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; +#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ u16 qidx; ++ u16 queue; + -+ qidx = skb_get_queue_mapping(pkt); -+ if (rtw_os_need_stop_queue(padapter, qidx)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ DBG_871X(FUNC_ADPT_FMT": netif_stop_subqueue[%d]\n", FUNC_ADPT_ARG(padapter), qidx); -+ netif_stop_subqueue(padapter->pnetdev, qidx); -+ busy = _TRUE; -+ } -+#else -+ if (rtw_os_need_stop_queue(padapter, 0)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ DBG_871X(FUNC_ADPT_FMT": netif_stop_queue\n", FUNC_ADPT_ARG(padapter)); -+ rtw_netif_stop_queue(padapter->pnetdev); -+ busy = _TRUE; -+ } -+#endif -+ return busy; -+} -+ -+void rtw_os_wake_queue_at_free_stainfo(_adapter *padapter, int *qcnt_freed) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ int i; -+ -+ for (i=0;i<4;i++) { -+ if (qcnt_freed[i] == 0) -+ continue; -+ -+ if(rtw_os_need_wake_queue(padapter, i)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ DBG_871X(FUNC_ADPT_FMT": netif_wake_subqueue[%d]\n", FUNC_ADPT_ARG(padapter), i); -+ netif_wake_subqueue(padapter->pnetdev, i); ++ queue = skb_get_queue_mapping(pkt); ++ if (padapter->registrypriv.wifi_spec) { ++ /* No free space for Tx, tx_worker is too slow */ ++ if (pxmitpriv->hwxmits[queue].accnt > WMM_XMIT_THRESHOLD) { ++ //DBG_871X("%s(): stop netif_subqueue[%d]\n", __FUNCTION__, queue); ++ netif_stop_subqueue(padapter->pnetdev, queue); ++ } ++ } else { ++ if(pxmitpriv->free_xmitframe_cnt<=4) { ++ if (!netif_tx_queue_stopped(netdev_get_tx_queue(padapter->pnetdev, queue))) ++ netif_stop_subqueue(padapter->pnetdev, queue); + } + } +#else -+ if (qcnt_freed[0] || qcnt_freed[1] || qcnt_freed[2] || qcnt_freed[3]) { -+ if(rtw_os_need_wake_queue(padapter, 0)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ DBG_871X(FUNC_ADPT_FMT": netif_wake_queue\n", FUNC_ADPT_ARG(padapter)); -+ netif_wake_queue(padapter->pnetdev); -+ } ++ if(pxmitpriv->free_xmitframe_cnt<=4) ++ { ++ if (!rtw_netif_queue_stopped(padapter->pnetdev)) ++ rtw_netif_stop_queue(padapter->pnetdev); + } +#endif +} @@ -380981,14 +182975,12 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty + int i; + s32 res; + -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u); -+ + _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); + phead = &pstapriv->asoc_list; + plist = get_next(phead); -+ ++ + //free sta asoc_queue -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ++ while ((rtw_end_of_queue_search(phead, plist)) == false) { + int stainfo_offset; + psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); + plist = get_next(plist); @@ -381003,74 +182995,58 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty + for (i = 0; i < chk_alive_num; i++) { + psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); + if(!(psta->state &_FW_LINKED)) -+ { -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_ignore_fw_linked); -+ continue; -+ } -+ -+ /* avoid come from STA1 and send back STA1 */ -+ if (_rtw_memcmp(psta->hwaddr, &skb->data[6], 6) == _TRUE -+ || _rtw_memcmp(psta->hwaddr, null_addr, 6) == _TRUE -+ || _rtw_memcmp(psta->hwaddr, bc_addr, 6) == _TRUE -+ ) -+ { -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_ignore_self); + continue; -+ } + -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry); ++ /* avoid come from STA1 and send back STA1 */ ++ if (_rtw_memcmp(psta->hwaddr, &skb->data[6], 6) == true ++ || _rtw_memcmp(psta->hwaddr, null_addr, 6) == true ++ || _rtw_memcmp(psta->hwaddr, bc_addr, 6) == true ++ ) ++ continue; + -+ newskb = rtw_skb_copy(skb); ++ newskb = skb_copy(skb, GFP_ATOMIC); + + if (newskb) { + _rtw_memcpy(newskb->data, psta->hwaddr, 6); + res = rtw_xmit(padapter, &newskb); + if (res < 0) { -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry_err_xmit); -+ DBG_871X("%s()-%d: rtw_xmit() return error! res=%d\n", __FUNCTION__, __LINE__, res); ++ DBG_871X("%s()-%d: rtw_xmit() return error!\n", __FUNCTION__, __LINE__); + pxmitpriv->tx_drop++; -+ rtw_skb_free(newskb); -+ } ++ dev_kfree_skb_any(newskb); ++ } else ++ pxmitpriv->tx_pkts++; + } else { -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry_err_skb); -+ DBG_871X("%s-%d: rtw_skb_copy() failed!\n", __FUNCTION__, __LINE__); ++ DBG_871X("%s-%d: skb_copy() failed!\n", __FUNCTION__, __LINE__); + pxmitpriv->tx_drop++; -+ //rtw_skb_free(skb); -+ return _FALSE; // Caller shall tx this multicast frame via normal way. ++ //dev_kfree_skb_any(skb); ++ return false; // Caller shall tx this multicast frame via normal way. + } + } + -+ rtw_skb_free(skb); -+ return _TRUE; ++ dev_kfree_skb_any(skb); ++ return true; +} +#endif // CONFIG_TX_MCAST2UNI + + -+int _rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) ++int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; +#ifdef CONFIG_TX_MCAST2UNI + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + extern int rtw_mc2u_disable; -+#endif // CONFIG_TX_MCAST2UNI ++#endif // CONFIG_TX_MCAST2UNI + s32 res = 0; +#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) + u16 queue; +#endif + -+_func_enter_; + -+ if(padapter->registrypriv.mp_mode) -+ { -+ DBG_871X("MP_TX_DROP_OS_FRAME\n"); -+ goto drop_packet; -+ } -+ DBG_COUNTER(padapter->tx_logs.os_tx); ++ + RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("+xmit_enry\n")); + -+ if (rtw_if_up(padapter) == _FALSE) { -+ DBG_COUNTER(padapter->tx_logs.os_tx_err_up); ++ if (rtw_if_up(padapter) == false) { + RT_TRACE(_module_xmit_osdep_c_, _drv_err_, ("rtw_xmit_entry: rtw_if_up fail\n")); + #ifdef DBG_TX_DROP_FRAME + DBG_871X("DBG_TX_DROP_FRAME %s if_up fail\n", __FUNCTION__); @@ -381082,28 +183058,23 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty + +#ifdef CONFIG_TX_MCAST2UNI + if ( !rtw_mc2u_disable -+ && check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE ++ && check_fwstate(pmlmepriv, WIFI_AP_STATE) == true + && ( IP_MCAST_MAC(pkt->data) -+ || ICMPV6_MCAST_MAC(pkt->data) -+ #ifdef CONFIG_TX_BCAST2UNI -+ || is_broadcast_mac_addr(pkt->data) -+ #endif -+ ) ++ || ICMPV6_MCAST_MAC(pkt->data) ) + && (padapter->registrypriv.wifi_spec == 0) + ) + { + if ( pxmitpriv->free_xmitframe_cnt > (NR_XMITFRAME/4) ) { + res = rtw_mlcst2unicst(padapter, pkt); -+ if (res == _TRUE) { ++ if (res == true) { + goto exit; + } + } else { + //DBG_871X("Stop M2U(%d, %d)! ", pxmitpriv->free_xmitframe_cnt, pxmitpriv->free_xmitbuf_cnt); + //DBG_871X("!m2u ); -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_stop); + } -+ } -+#endif // CONFIG_TX_MCAST2UNI ++ } ++#endif // CONFIG_TX_MCAST2UNI + + res = rtw_xmit(padapter, &pkt); + if (res < 0) { @@ -381113,3316 +183084,18 @@ diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/linux/xmit_linux.c linux/3rdparty + goto drop_packet; + } + ++ pxmitpriv->tx_pkts++; + RT_TRACE(_module_xmit_osdep_c_, _drv_info_, ("rtw_xmit_entry: tx_pkts=%d\n", (u32)pxmitpriv->tx_pkts)); + goto exit; + +drop_packet: + pxmitpriv->tx_drop++; -+ rtw_os_pkt_complete(padapter, pkt); ++ dev_kfree_skb_any(pkt); + RT_TRACE(_module_xmit_osdep_c_, _drv_notice_, ("rtw_xmit_entry: drop, tx_drop=%d\n", (u32)pxmitpriv->tx_drop)); + +exit: + -+_func_exit_; ++ + + return 0; +} -+ -+int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) -+{ -+ int ret = 0; -+ -+ if (pkt) { -+ rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, pkt->truesize); -+ ret = _rtw_xmit_entry(pkt, pnetdev); -+ } -+ -+ return ret; -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/os_dep/osdep_service.c linux/3rdparty/rtl8812au/os_dep/osdep_service.c ---- linux.old/3rdparty/rtl8812au/os_dep/osdep_service.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/os_dep/osdep_service.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,2477 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#define _OSDEP_SERVICE_C_ -+ -+#include -+ -+#define RT_TAG '1178' -+ -+#ifdef DBG_MEMORY_LEAK -+#ifdef PLATFORM_LINUX -+atomic_t _malloc_cnt = ATOMIC_INIT(0); -+atomic_t _malloc_size = ATOMIC_INIT(0); -+#endif -+#endif /* DBG_MEMORY_LEAK */ -+ -+ -+#if defined(PLATFORM_LINUX) -+/* -+* Translate the OS dependent @param error_code to OS independent RTW_STATUS_CODE -+* @return: one of RTW_STATUS_CODE -+*/ -+inline int RTW_STATUS_CODE(int error_code){ -+ if(error_code >=0) -+ return _SUCCESS; -+ -+ switch(error_code) { -+ //case -ETIMEDOUT: -+ // return RTW_STATUS_TIMEDOUT; -+ default: -+ return _FAIL; -+ } -+} -+#else -+inline int RTW_STATUS_CODE(int error_code){ -+ return error_code; -+} -+#endif -+ -+u32 rtw_atoi(u8* s) -+{ -+ -+ int num=0,flag=0; -+ int i; -+ for(i=0;i<=strlen(s);i++) -+ { -+ if(s[i] >= '0' && s[i] <= '9') -+ num = num * 10 + s[i] -'0'; -+ else if(s[0] == '-' && i==0) -+ flag =1; -+ else -+ break; -+ } -+ -+ if(flag == 1) -+ num = num * -1; -+ -+ return(num); -+ -+} -+ -+inline u8* _rtw_vmalloc(u32 sz) -+{ -+ u8 *pbuf; -+#ifdef PLATFORM_LINUX -+ pbuf = vmalloc(sz); -+#endif -+#ifdef PLATFORM_FREEBSD -+ pbuf = malloc(sz,M_DEVBUF,M_NOWAIT); -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ NdisAllocateMemoryWithTag(&pbuf,sz, RT_TAG); -+#endif -+ -+#ifdef DBG_MEMORY_LEAK -+#ifdef PLATFORM_LINUX -+ if ( pbuf != NULL) { -+ atomic_inc(&_malloc_cnt); -+ atomic_add(sz, &_malloc_size); -+ } -+#endif -+#endif /* DBG_MEMORY_LEAK */ -+ -+ return pbuf; -+} -+ -+inline u8* _rtw_zvmalloc(u32 sz) -+{ -+ u8 *pbuf; -+#ifdef PLATFORM_LINUX -+ pbuf = _rtw_vmalloc(sz); -+ if (pbuf != NULL) -+ memset(pbuf, 0, sz); -+#endif -+#ifdef PLATFORM_FREEBSD -+ pbuf = malloc(sz,M_DEVBUF,M_ZERO|M_NOWAIT); -+#endif -+#ifdef PLATFORM_WINDOWS -+ NdisAllocateMemoryWithTag(&pbuf,sz, RT_TAG); -+ if (pbuf != NULL) -+ NdisFillMemory(pbuf, sz, 0); -+#endif -+ -+ return pbuf; -+} -+ -+inline void _rtw_vmfree(u8 *pbuf, u32 sz) -+{ -+#ifdef PLATFORM_LINUX -+ vfree(pbuf); -+#endif -+#ifdef PLATFORM_FREEBSD -+ free(pbuf,M_DEVBUF); -+#endif -+#ifdef PLATFORM_WINDOWS -+ NdisFreeMemory(pbuf,sz, 0); -+#endif -+ -+#ifdef DBG_MEMORY_LEAK -+#ifdef PLATFORM_LINUX -+ atomic_dec(&_malloc_cnt); -+ atomic_sub(sz, &_malloc_size); -+#endif -+#endif /* DBG_MEMORY_LEAK */ -+} -+ -+u8* _rtw_malloc(u32 sz) -+{ -+ -+ u8 *pbuf=NULL; -+ -+#ifdef PLATFORM_LINUX -+#ifdef RTK_DMP_PLATFORM -+ if(sz > 0x4000) -+ pbuf = (u8 *)dvr_malloc(sz); -+ else -+#endif -+ pbuf = kmalloc(sz,in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ pbuf = malloc(sz,M_DEVBUF,M_NOWAIT); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisAllocateMemoryWithTag(&pbuf,sz, RT_TAG); -+ -+#endif -+ -+#ifdef DBG_MEMORY_LEAK -+#ifdef PLATFORM_LINUX -+ if ( pbuf != NULL) { -+ atomic_inc(&_malloc_cnt); -+ atomic_add(sz, &_malloc_size); -+ } -+#endif -+#endif /* DBG_MEMORY_LEAK */ -+ -+ return pbuf; -+ -+} -+ -+ -+u8* _rtw_zmalloc(u32 sz) -+{ -+#ifdef PLATFORM_FREEBSD -+ return malloc(sz,M_DEVBUF,M_ZERO|M_NOWAIT); -+#else // PLATFORM_FREEBSD -+ u8 *pbuf = _rtw_malloc(sz); -+ -+ if (pbuf != NULL) { -+ -+#ifdef PLATFORM_LINUX -+ memset(pbuf, 0, sz); -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ NdisFillMemory(pbuf, sz, 0); -+#endif -+ -+ } -+ -+ return pbuf; -+#endif // PLATFORM_FREEBSD -+} -+ -+void _rtw_mfree(u8 *pbuf, u32 sz) -+{ -+ -+#ifdef PLATFORM_LINUX -+#ifdef RTK_DMP_PLATFORM -+ if(sz > 0x4000) -+ dvr_free(pbuf); -+ else -+#endif -+ kfree(pbuf); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ free(pbuf,M_DEVBUF); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisFreeMemory(pbuf,sz, 0); -+ -+#endif -+ -+#ifdef DBG_MEMORY_LEAK -+#ifdef PLATFORM_LINUX -+ atomic_dec(&_malloc_cnt); -+ atomic_sub(sz, &_malloc_size); -+#endif -+#endif /* DBG_MEMORY_LEAK */ -+ -+} -+ -+#ifdef PLATFORM_FREEBSD -+//review again -+struct sk_buff * dev_alloc_skb(unsigned int size) -+{ -+ struct sk_buff *skb=NULL; -+ u8 *data=NULL; -+ -+ //skb = (struct sk_buff *)_rtw_zmalloc(sizeof(struct sk_buff)); // for skb->len, etc. -+ skb = (struct sk_buff *)_rtw_malloc(sizeof(struct sk_buff)); -+ if(!skb) -+ goto out; -+ data = _rtw_malloc(size); -+ if(!data) -+ goto nodata; -+ -+ skb->head = (unsigned char*)data; -+ skb->data = (unsigned char*)data; -+ skb->tail = (unsigned char*)data; -+ skb->end = (unsigned char*)data + size; -+ skb->len = 0; -+ //printf("%s()-%d: skb=%p, skb->head = %p\n", __FUNCTION__, __LINE__, skb, skb->head); -+ -+out: -+ return skb; -+nodata: -+ _rtw_mfree((u8 *)skb, sizeof(struct sk_buff)); -+ skb = NULL; -+goto out; -+ -+} -+ -+void dev_kfree_skb_any(struct sk_buff *skb) -+{ -+ //printf("%s()-%d: skb->head = %p\n", __FUNCTION__, __LINE__, skb->head); -+ if(skb->head) -+ _rtw_mfree(skb->head, 0); -+ //printf("%s()-%d: skb = %p\n", __FUNCTION__, __LINE__, skb); -+ if(skb) -+ _rtw_mfree((u8 *)skb, 0); -+} -+struct sk_buff *skb_clone(const struct sk_buff *skb) -+{ -+ return NULL; -+} -+ -+#endif /* PLATFORM_FREEBSD */ -+ -+inline struct sk_buff *_rtw_skb_alloc(u32 sz) -+{ -+#ifdef PLATFORM_LINUX -+ return __dev_alloc_skb(sz, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ return dev_alloc_skb(sz); -+#endif /* PLATFORM_FREEBSD */ -+} -+ -+inline void _rtw_skb_free(struct sk_buff *skb) -+{ -+ dev_kfree_skb_any(skb); -+} -+ -+inline struct sk_buff *_rtw_skb_copy(const struct sk_buff *skb) -+{ -+#ifdef PLATFORM_LINUX -+ return skb_copy(skb, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ return NULL; -+#endif /* PLATFORM_FREEBSD */ -+} -+ -+inline struct sk_buff *_rtw_skb_clone(struct sk_buff *skb) -+{ -+#ifdef PLATFORM_LINUX -+ return skb_clone(skb, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ return skb_clone(skb); -+#endif /* PLATFORM_FREEBSD */ -+} -+ -+inline int _rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb) -+{ -+#ifdef PLATFORM_LINUX -+ skb->dev = ndev; -+ return netif_rx(skb); -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ return (*ndev->if_input)(ndev, skb); -+#endif /* PLATFORM_FREEBSD */ -+} -+ -+void _rtw_skb_queue_purge(struct sk_buff_head *list) -+{ -+ struct sk_buff *skb; -+ -+ while ((skb = skb_dequeue(list)) != NULL) -+ _rtw_skb_free(skb); -+} -+ -+#ifdef CONFIG_USB_HCI -+inline void *_rtw_usb_buffer_alloc(struct usb_device *dev, size_t size, dma_addr_t *dma) -+{ -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ return usb_alloc_coherent(dev, size, (in_interrupt() ? GFP_ATOMIC : GFP_KERNEL), dma); -+#else -+ return usb_buffer_alloc(dev, size, (in_interrupt() ? GFP_ATOMIC : GFP_KERNEL), dma); -+#endif -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ return (malloc(size, M_USBDEV, M_NOWAIT | M_ZERO)); -+#endif /* PLATFORM_FREEBSD */ -+} -+inline void _rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dma_addr_t dma) -+{ -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ usb_free_coherent(dev, size, addr, dma); -+#else -+ usb_buffer_free(dev, size, addr, dma); -+#endif -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ free(addr, M_USBDEV); -+#endif /* PLATFORM_FREEBSD */ -+} -+#endif /* CONFIG_USB_HCI */ -+ -+#if defined(DBG_MEM_ALLOC) -+ -+struct rtw_mem_stat { -+ ATOMIC_T alloc; // the memory bytes we allocate currently -+ ATOMIC_T peak; // the peak memory bytes we allocate -+ ATOMIC_T alloc_cnt; // the alloc count for alloc currently -+ ATOMIC_T alloc_err_cnt; // the error times we fail to allocate memory -+}; -+ -+struct rtw_mem_stat rtw_mem_type_stat[mstat_tf_idx(MSTAT_TYPE_MAX)]; -+#ifdef RTW_MEM_FUNC_STAT -+struct rtw_mem_stat rtw_mem_func_stat[mstat_ff_idx(MSTAT_FUNC_MAX)]; -+#endif -+ -+char *MSTAT_TYPE_str[] = { -+ "VIR", -+ "PHY", -+ "SKB", -+ "USB", -+}; -+ -+#ifdef RTW_MEM_FUNC_STAT -+char *MSTAT_FUNC_str[] = { -+ "UNSP", -+ "IO", -+ "TXIO", -+ "RXIO", -+ "TX", -+ "RX", -+}; -+#endif -+ -+void rtw_mstat_dump(void *sel) -+{ -+ int i; -+ int value_t[4][mstat_tf_idx(MSTAT_TYPE_MAX)]; -+#ifdef RTW_MEM_FUNC_STAT -+ int value_f[4][mstat_ff_idx(MSTAT_FUNC_MAX)]; -+#endif -+ -+ int vir_alloc, vir_peak, vir_alloc_err, phy_alloc, phy_peak, phy_alloc_err; -+ int tx_alloc, tx_peak, tx_alloc_err, rx_alloc, rx_peak, rx_alloc_err; -+ -+ for(i=0;i 5000) { -+ // rtw_mstat_dump(RTW_DBGDUMP); -+ update_time=rtw_get_current_time(); -+ //} -+} -+ -+#ifndef SIZE_MAX -+ #define SIZE_MAX (~(size_t)0) -+#endif -+ -+struct mstat_sniff_rule { -+ enum mstat_f flags; -+ size_t lb; -+ size_t hb; -+}; -+ -+struct mstat_sniff_rule mstat_sniff_rules[] = { -+ {MSTAT_TYPE_PHY, 4097, SIZE_MAX}, -+}; -+ -+int mstat_sniff_rule_num = sizeof(mstat_sniff_rules)/sizeof(struct mstat_sniff_rule); -+ -+bool match_mstat_sniff_rules(const enum mstat_f flags, const size_t size) -+{ -+ int i; -+ for (i = 0; i= size) -+ return _TRUE; -+ } -+ -+ return _FALSE; -+} -+ -+inline u8* dbg_rtw_vmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ u8 *p; -+ -+ if (match_mstat_sniff_rules(flags, sz)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ p=_rtw_vmalloc((sz)); -+ -+ rtw_mstat_update( -+ flags -+ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , sz -+ ); -+ -+ return p; -+} -+ -+inline u8* dbg_rtw_zvmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ u8 *p; -+ -+ if (match_mstat_sniff_rules(flags, sz)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ p=_rtw_zvmalloc((sz)); -+ -+ rtw_mstat_update( -+ flags -+ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , sz -+ ); -+ -+ return p; -+} -+ -+inline void dbg_rtw_vmfree(u8 *pbuf, u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ -+ if (match_mstat_sniff_rules(flags, sz)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ _rtw_vmfree((pbuf), (sz)); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , sz -+ ); -+} -+ -+inline u8* dbg_rtw_malloc(u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ u8 *p; -+ -+ if (match_mstat_sniff_rules(flags, sz)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ p=_rtw_malloc((sz)); -+ -+ rtw_mstat_update( -+ flags -+ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , sz -+ ); -+ -+ return p; -+} -+ -+inline u8* dbg_rtw_zmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ u8 *p; -+ -+ if (match_mstat_sniff_rules(flags, sz)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ p = _rtw_zmalloc((sz)); -+ -+ rtw_mstat_update( -+ flags -+ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , sz -+ ); -+ -+ return p; -+} -+ -+inline void dbg_rtw_mfree(u8 *pbuf, u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ if (match_mstat_sniff_rules(flags, sz)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ _rtw_mfree((pbuf), (sz)); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , sz -+ ); -+} -+ -+inline struct sk_buff * dbg_rtw_skb_alloc(unsigned int size, const enum mstat_f flags, const char *func, int line) -+{ -+ struct sk_buff *skb; -+ unsigned int truesize = 0; -+ -+ skb = _rtw_skb_alloc(size); -+ -+ if(skb) -+ truesize = skb->truesize; -+ -+ if(!skb || truesize < size || match_mstat_sniff_rules(flags, truesize)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s(%d), skb:%p, truesize=%u\n", func, line, __FUNCTION__, size, skb, truesize); -+ -+ rtw_mstat_update( -+ flags -+ , skb ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , truesize -+ ); -+ -+ return skb; -+} -+ -+inline void dbg_rtw_skb_free(struct sk_buff *skb, const enum mstat_f flags, const char *func, int line) -+{ -+ unsigned int truesize = skb->truesize; -+ -+ if(match_mstat_sniff_rules(flags, truesize)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); -+ -+ _rtw_skb_free(skb); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , truesize -+ ); -+} -+ -+inline struct sk_buff *dbg_rtw_skb_copy(const struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line) -+{ -+ struct sk_buff *skb_cp; -+ unsigned int truesize = skb->truesize; -+ unsigned int cp_truesize = 0; -+ -+ skb_cp = _rtw_skb_copy(skb); -+ if(skb_cp) -+ cp_truesize = skb_cp->truesize; -+ -+ if(!skb_cp || cp_truesize < truesize || match_mstat_sniff_rules(flags, cp_truesize)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s(%u), skb_cp:%p, cp_truesize=%u\n", func, line, __FUNCTION__, truesize, skb_cp, cp_truesize); -+ -+ rtw_mstat_update( -+ flags -+ , skb_cp ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , truesize -+ ); -+ -+ return skb_cp; -+} -+ -+inline struct sk_buff *dbg_rtw_skb_clone(struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line) -+{ -+ struct sk_buff *skb_cl; -+ unsigned int truesize = skb->truesize; -+ unsigned int cl_truesize = 0; -+ -+ skb_cl = _rtw_skb_clone(skb); -+ if(skb_cl) -+ cl_truesize = skb_cl->truesize; -+ -+ if(!skb_cl || cl_truesize < truesize || match_mstat_sniff_rules(flags, cl_truesize)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s(%u), skb_cl:%p, cl_truesize=%u\n", func, line, __FUNCTION__, truesize, skb_cl, cl_truesize); -+ -+ rtw_mstat_update( -+ flags -+ , skb_cl ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , truesize -+ ); -+ -+ return skb_cl; -+} -+ -+inline int dbg_rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line) -+{ -+ int ret; -+ unsigned int truesize = skb->truesize; -+ -+ if(match_mstat_sniff_rules(flags, truesize)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); -+ -+ ret = _rtw_netif_rx(ndev, skb); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , truesize -+ ); -+ -+ return ret; -+} -+ -+inline void dbg_rtw_skb_queue_purge(struct sk_buff_head *list, enum mstat_f flags, const char *func, int line) -+{ -+ struct sk_buff *skb; -+ -+ while ((skb = skb_dequeue(list)) != NULL) -+ dbg_rtw_skb_free(skb, flags, func, line); -+} -+ -+#ifdef CONFIG_USB_HCI -+inline void *dbg_rtw_usb_buffer_alloc(struct usb_device *dev, size_t size, dma_addr_t *dma, const enum mstat_f flags, const char *func, int line) -+{ -+ void *p; -+ -+ if(match_mstat_sniff_rules(flags, size)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s(%zu)\n", func, line, __FUNCTION__, size); -+ -+ p = _rtw_usb_buffer_alloc(dev, size, dma); -+ -+ rtw_mstat_update( -+ flags -+ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , size -+ ); -+ -+ return p; -+} -+ -+inline void dbg_rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dma_addr_t dma, const enum mstat_f flags, const char *func, int line) -+{ -+ -+ if(match_mstat_sniff_rules(flags, size)) -+ DBG_871X("DBG_MEM_ALLOC %s:%d %s(%zu)\n", func, line, __FUNCTION__, size); -+ -+ _rtw_usb_buffer_free(dev, size, addr, dma); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , size -+ ); -+} -+#endif /* CONFIG_USB_HCI */ -+ -+#endif /* defined(DBG_MEM_ALLOC) */ -+ -+void* rtw_malloc2d(int h, int w, size_t size) -+{ -+ int j; -+ -+ void **a = (void **) rtw_zmalloc( h*sizeof(void *) + h*w*size ); -+ if(a == NULL) -+ { -+ DBG_871X("%s: alloc memory fail!\n", __FUNCTION__); -+ return NULL; -+ } -+ -+ for( j=0; jprev = pnew; -+ pnew->next = pnext; -+ pnew->prev = pprev; -+ pprev->next = pnew; -+} -+#endif /* PLATFORM_FREEBSD */ -+ -+ -+void _rtw_init_listhead(_list *list) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ INIT_LIST_HEAD(list); -+ -+#endif -+ -+#ifdef PLATFORM_FREEBSD -+ list->next = list; -+ list->prev = list; -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisInitializeListHead(list); -+ -+#endif -+ -+} -+ -+ -+/* -+For the following list_xxx operations, -+caller must guarantee the atomic context. -+Otherwise, there will be racing condition. -+*/ -+u32 rtw_is_list_empty(_list *phead) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ if (list_empty(phead)) -+ return _TRUE; -+ else -+ return _FALSE; -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ -+ if (phead->next == phead) -+ return _TRUE; -+ else -+ return _FALSE; -+ -+#endif -+ -+ -+#ifdef PLATFORM_WINDOWS -+ -+ if (IsListEmpty(phead)) -+ return _TRUE; -+ else -+ return _FALSE; -+ -+#endif -+ -+ -+} -+ -+void rtw_list_insert_head(_list *plist, _list *phead) -+{ -+ -+#ifdef PLATFORM_LINUX -+ list_add(plist, phead); -+#endif -+ -+#ifdef PLATFORM_FREEBSD -+ __list_add(plist, phead, phead->next); -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ InsertHeadList(phead, plist); -+#endif -+} -+ -+void rtw_list_insert_tail(_list *plist, _list *phead) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ list_add_tail(plist, phead); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ -+ __list_add(plist, phead->prev, phead); -+ -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ InsertTailList(phead, plist); -+ -+#endif -+ -+} -+ -+void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc) -+{ -+ _adapter *adapter = (_adapter *)padapter; -+ -+#ifdef PLATFORM_LINUX -+ _init_timer(ptimer, adapter->pnetdev, pfunc, adapter); -+#endif -+#ifdef PLATFORM_FREEBSD -+ _init_timer(ptimer, adapter->pifp, pfunc, adapter->mlmepriv.nic_hdl); -+#endif -+#ifdef PLATFORM_WINDOWS -+ _init_timer(ptimer, adapter->hndis_adapter, pfunc, adapter->mlmepriv.nic_hdl); -+#endif -+} -+ -+/* -+ -+Caller must check if the list is empty before calling rtw_list_delete -+ -+*/ -+ -+ -+void _rtw_init_sema(_sema *sema, int init_val) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ sema_init(sema, init_val); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ sema_init(sema, init_val, "rtw_drv"); -+#endif -+#ifdef PLATFORM_OS_XP -+ -+ KeInitializeSemaphore(sema, init_val, SEMA_UPBND); // count=0; -+ -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ if(*sema == NULL) -+ *sema = CreateSemaphore(NULL, init_val, SEMA_UPBND, NULL); -+#endif -+ -+} -+ -+void _rtw_free_sema(_sema *sema) -+{ -+#ifdef PLATFORM_FREEBSD -+ sema_destroy(sema); -+#endif -+#ifdef PLATFORM_OS_CE -+ CloseHandle(*sema); -+#endif -+ -+} -+ -+void _rtw_up_sema(_sema *sema) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ up(sema); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ sema_post(sema); -+#endif -+#ifdef PLATFORM_OS_XP -+ -+ KeReleaseSemaphore(sema, IO_NETWORK_INCREMENT, 1, FALSE ); -+ -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ ReleaseSemaphore(*sema, 1, NULL ); -+#endif -+} -+ -+u32 _rtw_down_sema(_sema *sema) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ if (down_interruptible(sema)) -+ return _FAIL; -+ else -+ return _SUCCESS; -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ sema_wait(sema); -+ return _SUCCESS; -+#endif -+#ifdef PLATFORM_OS_XP -+ -+ if(STATUS_SUCCESS == KeWaitForSingleObject(sema, Executive, KernelMode, TRUE, NULL)) -+ return _SUCCESS; -+ else -+ return _FAIL; -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ if(WAIT_OBJECT_0 == WaitForSingleObject(*sema, INFINITE )) -+ return _SUCCESS; -+ else -+ return _FAIL; -+#endif -+} -+ -+ -+ -+void _rtw_mutex_init(_mutex *pmutex) -+{ -+#ifdef PLATFORM_LINUX -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ mutex_init(pmutex); -+#else -+ init_MUTEX(pmutex); -+#endif -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ mtx_init(pmutex, "", NULL, MTX_DEF|MTX_RECURSE); -+#endif -+#ifdef PLATFORM_OS_XP -+ -+ KeInitializeMutex(pmutex, 0); -+ -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ *pmutex = CreateMutex( NULL, _FALSE, NULL); -+#endif -+} -+ -+void _rtw_mutex_free(_mutex *pmutex); -+void _rtw_mutex_free(_mutex *pmutex) -+{ -+#ifdef PLATFORM_LINUX -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ mutex_destroy(pmutex); -+#else -+#endif -+ -+#ifdef PLATFORM_FREEBSD -+ sema_destroy(pmutex); -+#endif -+ -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ -+#endif -+} -+ -+void _rtw_spinlock_init(_lock *plock) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ spin_lock_init(plock); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ mtx_init(plock, "", NULL, MTX_DEF|MTX_RECURSE); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisAllocateSpinLock(plock); -+ -+#endif -+ -+} -+ -+void _rtw_spinlock_free(_lock *plock) -+{ -+#ifdef PLATFORM_FREEBSD -+ mtx_destroy(plock); -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+ NdisFreeSpinLock(plock); -+ -+#endif -+ -+} -+#ifdef PLATFORM_FREEBSD -+extern PADAPTER prtw_lock; -+ -+void rtw_mtx_lock(_lock *plock){ -+ if(prtw_lock){ -+ mtx_lock(&prtw_lock->glock); -+ } -+ else{ -+ printf("%s prtw_lock==NULL",__FUNCTION__); -+ } -+} -+void rtw_mtx_unlock(_lock *plock){ -+ if(prtw_lock){ -+ mtx_unlock(&prtw_lock->glock); -+ } -+ else{ -+ printf("%s prtw_lock==NULL",__FUNCTION__); -+ } -+ -+} -+#endif //PLATFORM_FREEBSD -+ -+ -+void _rtw_spinlock(_lock *plock) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ spin_lock(plock); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ mtx_lock(plock); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisAcquireSpinLock(plock); -+ -+#endif -+ -+} -+ -+void _rtw_spinunlock(_lock *plock) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ spin_unlock(plock); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ mtx_unlock(plock); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisReleaseSpinLock(plock); -+ -+#endif -+} -+ -+ -+void _rtw_spinlock_ex(_lock *plock) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ spin_lock(plock); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ mtx_lock(plock); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisDprAcquireSpinLock(plock); -+ -+#endif -+ -+} -+ -+void _rtw_spinunlock_ex(_lock *plock) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ spin_unlock(plock); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ mtx_unlock(plock); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisDprReleaseSpinLock(plock); -+ -+#endif -+} -+ -+ -+ -+void _rtw_init_queue(_queue *pqueue) -+{ -+ -+ _rtw_init_listhead(&(pqueue->queue)); -+ -+ _rtw_spinlock_init(&(pqueue->lock)); -+ -+} -+ -+u32 _rtw_queue_empty(_queue *pqueue) -+{ -+ return (rtw_is_list_empty(&(pqueue->queue))); -+} -+ -+ -+u32 rtw_end_of_queue_search(_list *head, _list *plist) -+{ -+ if (head == plist) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+ -+u32 rtw_get_current_time(void) -+{ -+ -+#ifdef PLATFORM_LINUX -+ return jiffies; -+#endif -+#ifdef PLATFORM_FREEBSD -+ struct timeval tvp; -+ getmicrotime(&tvp); -+ return tvp.tv_sec; -+#endif -+#ifdef PLATFORM_WINDOWS -+ LARGE_INTEGER SystemTime; -+ NdisGetCurrentSystemTime(&SystemTime); -+ return (u32)(SystemTime.LowPart);// count of 100-nanosecond intervals -+#endif -+} -+ -+inline u32 rtw_systime_to_ms(u32 systime) -+{ -+#ifdef PLATFORM_LINUX -+ return systime * 1000 / HZ; -+#endif -+#ifdef PLATFORM_FREEBSD -+ return systime * 1000; -+#endif -+#ifdef PLATFORM_WINDOWS -+ return systime / 10000 ; -+#endif -+} -+ -+inline u32 rtw_ms_to_systime(u32 ms) -+{ -+#ifdef PLATFORM_LINUX -+ return ms * HZ / 1000; -+#endif -+#ifdef PLATFORM_FREEBSD -+ return ms /1000; -+#endif -+#ifdef PLATFORM_WINDOWS -+ return ms * 10000 ; -+#endif -+} -+ -+// the input parameter start use the same unit as returned by rtw_get_current_time -+inline s32 rtw_get_passing_time_ms(u32 start) -+{ -+#ifdef PLATFORM_LINUX -+ return rtw_systime_to_ms(jiffies-start); -+#endif -+#ifdef PLATFORM_FREEBSD -+ return rtw_systime_to_ms(rtw_get_current_time()); -+#endif -+#ifdef PLATFORM_WINDOWS -+ LARGE_INTEGER SystemTime; -+ NdisGetCurrentSystemTime(&SystemTime); -+ return rtw_systime_to_ms((u32)(SystemTime.LowPart) - start) ; -+#endif -+} -+ -+inline s32 rtw_get_time_interval_ms(u32 start, u32 end) -+{ -+#ifdef PLATFORM_LINUX -+ return rtw_systime_to_ms(end-start); -+#endif -+#ifdef PLATFORM_FREEBSD -+ return rtw_systime_to_ms(rtw_get_current_time()); -+#endif -+#ifdef PLATFORM_WINDOWS -+ return rtw_systime_to_ms(end-start); -+#endif -+} -+ -+ -+void rtw_sleep_schedulable(int ms) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ u32 delta; -+ -+ delta = (ms * HZ)/1000;//(ms) -+ if (delta == 0) { -+ delta = 1;// 1 ms -+ } -+ set_current_state(TASK_INTERRUPTIBLE); -+ if (schedule_timeout(delta) != 0) { -+ return ; -+ } -+ return; -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ DELAY(ms*1000); -+ return ; -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+ NdisMSleep(ms*1000); //(us)*1000=(ms) -+ -+#endif -+ -+} -+ -+ -+void rtw_msleep_os(int ms) -+{ -+ -+#ifdef PLATFORM_LINUX -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) -+ if (ms < 20) { -+ unsigned long us = ms * 1000UL; -+ usleep_range(us, us + 1000UL); -+ } else -+ #endif -+ msleep((unsigned int)ms); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ //Delay for delay microseconds -+ DELAY(ms*1000); -+ return ; -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisMSleep(ms*1000); //(us)*1000=(ms) -+ -+#endif -+ -+ -+} -+void rtw_usleep_os(int us) -+{ -+#ifdef PLATFORM_LINUX -+ -+ // msleep((unsigned int)us); -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) -+ usleep_range(us, us + 1); -+ #else -+ if ( 1 < (us/1000) ) -+ msleep(1); -+ else -+ msleep( (us/1000) + 1); -+ #endif -+#endif -+ -+#ifdef PLATFORM_FREEBSD -+ //Delay for delay microseconds -+ DELAY(us); -+ -+ return ; -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisMSleep(us); //(us) -+ -+#endif -+ -+ -+} -+ -+ -+#ifdef DBG_DELAY_OS -+void _rtw_mdelay_os(int ms, const char *func, const int line) -+{ -+ #if 0 -+ if(ms>10) -+ DBG_871X("%s:%d %s(%d)\n", func, line, __FUNCTION__, ms); -+ rtw_msleep_os(ms); -+ return; -+ #endif -+ -+ -+ DBG_871X("%s:%d %s(%d)\n", func, line, __FUNCTION__, ms); -+ -+#if defined(PLATFORM_LINUX) -+ -+ mdelay((unsigned long)ms); -+ -+#elif defined(PLATFORM_WINDOWS) -+ -+ NdisStallExecution(ms*1000); //(us)*1000=(ms) -+ -+#endif -+ -+ -+} -+void _rtw_udelay_os(int us, const char *func, const int line) -+{ -+ -+ #if 0 -+ if(us > 1000) { -+ DBG_871X("%s:%d %s(%d)\n", func, line, __FUNCTION__, us); -+ rtw_usleep_os(us); -+ return; -+ } -+ #endif -+ -+ -+ DBG_871X("%s:%d %s(%d)\n", func, line, __FUNCTION__, us); -+ -+ -+#if defined(PLATFORM_LINUX) -+ -+ udelay((unsigned long)us); -+ -+#elif defined(PLATFORM_WINDOWS) -+ -+ NdisStallExecution(us); //(us) -+ -+#endif -+ -+} -+#else -+void rtw_mdelay_os(int ms) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ mdelay((unsigned long)ms); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ DELAY(ms*1000); -+ return ; -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisStallExecution(ms*1000); //(us)*1000=(ms) -+ -+#endif -+ -+ -+} -+void rtw_udelay_os(int us) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ udelay((unsigned long)us); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ //Delay for delay microseconds -+ DELAY(us); -+ return ; -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisStallExecution(us); //(us) -+ -+#endif -+ -+} -+#endif -+ -+void rtw_yield_os(void) -+{ -+#ifdef PLATFORM_LINUX -+ yield(); -+#endif -+#ifdef PLATFORM_FREEBSD -+ yield(); -+#endif -+#ifdef PLATFORM_WINDOWS -+ SwitchToThread(); -+#endif -+} -+ -+#define RTW_SUSPEND_LOCK_NAME "rtw_wifi" -+#define RTW_SUSPEND_EXT_LOCK_NAME "rtw_wifi_ext" -+#define RTW_SUSPEND_RX_LOCK_NAME "rtw_wifi_rx" -+#define RTW_SUSPEND_TRAFFIC_LOCK_NAME "rtw_wifi_traffic" -+#define RTW_SUSPEND_RESUME_LOCK_NAME "rtw_wifi_resume" -+#define RTW_RESUME_SCAN_LOCK_NAME "rtw_wifi_scan" -+#ifdef CONFIG_WAKELOCK -+static struct wake_lock rtw_suspend_lock; -+static struct wake_lock rtw_suspend_ext_lock; -+static struct wake_lock rtw_suspend_rx_lock; -+static struct wake_lock rtw_suspend_traffic_lock; -+static struct wake_lock rtw_suspend_resume_lock; -+static struct wake_lock rtw_resume_scan_lock; -+#elif defined(CONFIG_ANDROID_POWER) -+static android_suspend_lock_t rtw_suspend_lock ={ -+ .name = RTW_SUSPEND_LOCK_NAME -+}; -+static android_suspend_lock_t rtw_suspend_ext_lock ={ -+ .name = RTW_SUSPEND_EXT_LOCK_NAME -+}; -+static android_suspend_lock_t rtw_suspend_rx_lock ={ -+ .name = RTW_SUSPEND_RX_LOCK_NAME -+}; -+static android_suspend_lock_t rtw_suspend_traffic_lock ={ -+ .name = RTW_SUSPEND_TRAFFIC_LOCK_NAME -+}; -+static android_suspend_lock_t rtw_suspend_resume_lock ={ -+ .name = RTW_SUSPEND_RESUME_LOCK_NAME -+}; -+static android_suspend_lock_t rtw_resume_scan_lock ={ -+ .name = RTW_RESUME_SCAN_LOCK_NAME -+}; -+#endif -+ -+inline void rtw_suspend_lock_init(void) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_lock_init(&rtw_suspend_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_LOCK_NAME); -+ wake_lock_init(&rtw_suspend_ext_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_EXT_LOCK_NAME); -+ wake_lock_init(&rtw_suspend_rx_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_RX_LOCK_NAME); -+ wake_lock_init(&rtw_suspend_traffic_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_TRAFFIC_LOCK_NAME); -+ wake_lock_init(&rtw_suspend_resume_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_RESUME_LOCK_NAME); -+ wake_lock_init(&rtw_resume_scan_lock, WAKE_LOCK_SUSPEND, RTW_RESUME_SCAN_LOCK_NAME); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_init_suspend_lock(&rtw_suspend_lock); -+ android_init_suspend_lock(&rtw_suspend_ext_lock); -+ android_init_suspend_lock(&rtw_suspend_rx_lock); -+ android_init_suspend_lock(&rtw_suspend_traffic_lock); -+ android_init_suspend_lock(&rtw_suspend_resume_lock); -+ android_init_suspend_lock(&rtw_resume_scan_lock); -+ #endif -+} -+ -+inline void rtw_suspend_lock_uninit(void) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_lock_destroy(&rtw_suspend_lock); -+ wake_lock_destroy(&rtw_suspend_ext_lock); -+ wake_lock_destroy(&rtw_suspend_rx_lock); -+ wake_lock_destroy(&rtw_suspend_traffic_lock); -+ wake_lock_destroy(&rtw_suspend_resume_lock); -+ wake_lock_destroy(&rtw_resume_scan_lock); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_uninit_suspend_lock(&rtw_suspend_lock); -+ android_uninit_suspend_lock(&rtw_suspend_ext_lock); -+ android_uninit_suspend_lock(&rtw_suspend_rx_lock); -+ android_uninit_suspend_lock(&rtw_suspend_traffic_lock); -+ android_uninit_suspend_lock(&rtw_suspend_resume_lock); -+ android_uninit_suspend_lock(&rtw_resume_scan_lock); -+ #endif -+} -+ -+inline void rtw_lock_suspend(void) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_lock(&rtw_suspend_lock); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend(&rtw_suspend_lock); -+ #endif -+ -+ #if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) -+ //DBG_871X("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); -+ #endif -+} -+ -+inline void rtw_unlock_suspend(void) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_unlock(&rtw_suspend_lock); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_unlock_suspend(&rtw_suspend_lock); -+ #endif -+ -+ #if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) -+ //DBG_871X("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); -+ #endif -+} -+ -+inline void rtw_resume_lock_suspend(void) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_lock(&rtw_suspend_resume_lock); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend(&rtw_suspend_resume_lock); -+ #endif -+ -+ #if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) -+ //DBG_871X("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); -+ #endif -+} -+ -+inline void rtw_resume_unlock_suspend(void) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_unlock(&rtw_suspend_resume_lock); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_unlock_suspend(&rtw_suspend_resume_lock); -+ #endif -+ -+ #if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) -+ //DBG_871X("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); -+ #endif -+} -+ -+inline void rtw_lock_suspend_timeout(u32 timeout_ms) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_lock_timeout(&rtw_suspend_lock, rtw_ms_to_systime(timeout_ms)); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend_auto_expire(&rtw_suspend_lock, rtw_ms_to_systime(timeout_ms)); -+ #endif -+} -+ -+inline void rtw_lock_ext_suspend_timeout(u32 timeout_ms) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_lock_timeout(&rtw_suspend_ext_lock, rtw_ms_to_systime(timeout_ms)); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend_auto_expire(&rtw_suspend_ext_lock, rtw_ms_to_systime(timeout_ms)); -+ #endif -+ //DBG_871X("EXT lock timeout:%d\n", timeout_ms); -+} -+ -+inline void rtw_lock_rx_suspend_timeout(u32 timeout_ms) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_lock_timeout(&rtw_suspend_rx_lock, rtw_ms_to_systime(timeout_ms)); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend_auto_expire(&rtw_suspend_rx_lock, rtw_ms_to_systime(timeout_ms)); -+ #endif -+ //DBG_871X("RX lock timeout:%d\n", timeout_ms); -+} -+ -+ -+inline void rtw_lock_traffic_suspend_timeout(u32 timeout_ms) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_lock_timeout(&rtw_suspend_traffic_lock, rtw_ms_to_systime(timeout_ms)); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend_auto_expire(&rtw_suspend_traffic_lock, rtw_ms_to_systime(timeout_ms)); -+ #endif -+ //DBG_871X("traffic lock timeout:%d\n", timeout_ms); -+} -+ -+inline void rtw_lock_resume_scan_timeout(u32 timeout_ms) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_lock_timeout(&rtw_resume_scan_lock, rtw_ms_to_systime(timeout_ms)); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend_auto_expire(&rtw_resume_scan_lock, rtw_ms_to_systime(timeout_ms)); -+ #endif -+ //DBG_871X("resume scan lock:%d\n", timeout_ms); -+} -+ -+inline void ATOMIC_SET(ATOMIC_T *v, int i) -+{ -+ #ifdef PLATFORM_LINUX -+ atomic_set(v,i); -+ #elif defined(PLATFORM_WINDOWS) -+ *v=i;// other choice???? -+ #elif defined(PLATFORM_FREEBSD) -+ atomic_set_int(v,i); -+ #endif -+} -+ -+inline int ATOMIC_READ(ATOMIC_T *v) -+{ -+ #ifdef PLATFORM_LINUX -+ return atomic_read(v); -+ #elif defined(PLATFORM_WINDOWS) -+ return *v; // other choice???? -+ #elif defined(PLATFORM_FREEBSD) -+ return atomic_load_acq_32(v); -+ #endif -+} -+ -+inline void ATOMIC_ADD(ATOMIC_T *v, int i) -+{ -+ #ifdef PLATFORM_LINUX -+ atomic_add(i,v); -+ #elif defined(PLATFORM_WINDOWS) -+ InterlockedAdd(v,i); -+ #elif defined(PLATFORM_FREEBSD) -+ atomic_add_int(v,i); -+ #endif -+} -+inline void ATOMIC_SUB(ATOMIC_T *v, int i) -+{ -+ #ifdef PLATFORM_LINUX -+ atomic_sub(i,v); -+ #elif defined(PLATFORM_WINDOWS) -+ InterlockedAdd(v,-i); -+ #elif defined(PLATFORM_FREEBSD) -+ atomic_subtract_int(v,i); -+ #endif -+} -+ -+inline void ATOMIC_INC(ATOMIC_T *v) -+{ -+ #ifdef PLATFORM_LINUX -+ atomic_inc(v); -+ #elif defined(PLATFORM_WINDOWS) -+ InterlockedIncrement(v); -+ #elif defined(PLATFORM_FREEBSD) -+ atomic_add_int(v,1); -+ #endif -+} -+ -+inline void ATOMIC_DEC(ATOMIC_T *v) -+{ -+ #ifdef PLATFORM_LINUX -+ atomic_dec(v); -+ #elif defined(PLATFORM_WINDOWS) -+ InterlockedDecrement(v); -+ #elif defined(PLATFORM_FREEBSD) -+ atomic_subtract_int(v,1); -+ #endif -+} -+ -+inline int ATOMIC_ADD_RETURN(ATOMIC_T *v, int i) -+{ -+ #ifdef PLATFORM_LINUX -+ return atomic_add_return(i,v); -+ #elif defined(PLATFORM_WINDOWS) -+ return InterlockedAdd(v,i); -+ #elif defined(PLATFORM_FREEBSD) -+ atomic_add_int(v,i); -+ return atomic_load_acq_32(v); -+ #endif -+} -+ -+inline int ATOMIC_SUB_RETURN(ATOMIC_T *v, int i) -+{ -+ #ifdef PLATFORM_LINUX -+ return atomic_sub_return(i,v); -+ #elif defined(PLATFORM_WINDOWS) -+ return InterlockedAdd(v,-i); -+ #elif defined(PLATFORM_FREEBSD) -+ atomic_subtract_int(v,i); -+ return atomic_load_acq_32(v); -+ #endif -+} -+ -+inline int ATOMIC_INC_RETURN(ATOMIC_T *v) -+{ -+ #ifdef PLATFORM_LINUX -+ return atomic_inc_return(v); -+ #elif defined(PLATFORM_WINDOWS) -+ return InterlockedIncrement(v); -+ #elif defined(PLATFORM_FREEBSD) -+ atomic_add_int(v,1); -+ return atomic_load_acq_32(v); -+ #endif -+} -+ -+inline int ATOMIC_DEC_RETURN(ATOMIC_T *v) -+{ -+ #ifdef PLATFORM_LINUX -+ return atomic_dec_return(v); -+ #elif defined(PLATFORM_WINDOWS) -+ return InterlockedDecrement(v); -+ #elif defined(PLATFORM_FREEBSD) -+ atomic_subtract_int(v,1); -+ return atomic_load_acq_32(v); -+ #endif -+} -+ -+ -+#ifdef PLATFORM_LINUX -+/* -+* Open a file with the specific @param path, @param flag, @param mode -+* @param fpp the pointer of struct file pointer to get struct file pointer while file opening is success -+* @param path the path of the file to open -+* @param flag file operation flags, please refer to linux document -+* @param mode please refer to linux document -+* @return Linux specific error code -+*/ -+static int openFile(struct file **fpp, char *path, int flag, int mode) -+{ -+ struct file *fp; -+ -+ fp=filp_open(path, flag, mode); -+ if(IS_ERR(fp)) { -+ *fpp=NULL; -+ return PTR_ERR(fp); -+ } -+ else { -+ *fpp=fp; -+ return 0; -+ } -+} -+ -+/* -+* Close the file with the specific @param fp -+* @param fp the pointer of struct file to close -+* @return always 0 -+*/ -+static int closeFile(struct file *fp) -+{ -+ filp_close(fp,NULL); -+ return 0; -+} -+ -+static int readFile(struct file *fp,char *buf,int len) -+{ -+ int rlen=0, sum=0; -+ -+ if (!fp->f_op || !fp->f_op->read) -+ return -EPERM; -+ -+ while(sumf_op->read(fp,buf+sum,len-sum, &fp->f_pos); -+ if(rlen>0) -+ sum+=rlen; -+ else if(0 != rlen) -+ return rlen; -+ else -+ break; -+ } -+ -+ return sum; -+ -+} -+ -+static int writeFile(struct file *fp,char *buf,int len) -+{ -+ int wlen=0, sum=0; -+ -+ if (!fp->f_op || !fp->f_op->write) -+ return -EPERM; -+ -+ while(sumf_op->write(fp,buf+sum,len-sum, &fp->f_pos); -+ if(wlen>0) -+ sum+=wlen; -+ else if(0 != wlen) -+ return wlen; -+ else -+ break; -+ } -+ -+ return sum; -+ -+} -+ -+/* -+* Test if the specifi @param path is a file and readable -+* @param path the path of the file to test -+* @return Linux specific error code -+*/ -+static int isFileReadable(char *path) -+{ -+ struct file *fp; -+ int ret = 0; -+ mm_segment_t oldfs; -+ char buf; -+ -+ fp=filp_open(path, O_RDONLY, 0); -+ if(IS_ERR(fp)) { -+ ret = PTR_ERR(fp); -+ } -+ else { -+ oldfs = get_fs(); set_fs(get_ds()); -+ -+ if(1!=readFile(fp, &buf, 1)) -+ ret = PTR_ERR(fp); -+ -+ set_fs(oldfs); -+ filp_close(fp,NULL); -+ } -+ return ret; -+} -+ -+/* -+* Open the file with @param path and retrive the file content into memory starting from @param buf for @param sz at most -+* @param path the path of the file to open and read -+* @param buf the starting address of the buffer to store file content -+* @param sz how many bytes to read at most -+* @return the byte we've read, or Linux specific error code -+*/ -+static int retriveFromFile(char *path, u8* buf, u32 sz) -+{ -+ int ret =-1; -+ mm_segment_t oldfs; -+ struct file *fp; -+ -+ if(path && buf) { -+ if( 0 == (ret=openFile(&fp,path, O_RDONLY, 0)) ){ -+ DBG_871X("%s openFile path:%s fp=%p\n",__FUNCTION__, path ,fp); -+ -+ oldfs = get_fs(); set_fs(get_ds()); -+ ret=readFile(fp, buf, sz); -+ set_fs(oldfs); -+ closeFile(fp); -+ -+ DBG_871X("%s readFile, ret:%d\n",__FUNCTION__, ret); -+ -+ } else { -+ DBG_871X("%s openFile path:%s Fail, ret:%d\n",__FUNCTION__, path, ret); -+ } -+ } else { -+ DBG_871X("%s NULL pointer\n",__FUNCTION__); -+ ret = -EINVAL; -+ } -+ return ret; -+} -+ -+/* -+* Open the file with @param path and wirte @param sz byte of data starting from @param buf into the file -+* @param path the path of the file to open and write -+* @param buf the starting address of the data to write into file -+* @param sz how many bytes to write at most -+* @return the byte we've written, or Linux specific error code -+*/ -+static int storeToFile(char *path, u8* buf, u32 sz) -+{ -+ int ret =0; -+ mm_segment_t oldfs; -+ struct file *fp; -+ -+ if(path && buf) { -+ if( 0 == (ret=openFile(&fp, path, O_CREAT|O_WRONLY, 0666)) ) { -+ DBG_871X("%s openFile path:%s fp=%p\n",__FUNCTION__, path ,fp); -+ -+ oldfs = get_fs(); set_fs(get_ds()); -+ ret=writeFile(fp, buf, sz); -+ set_fs(oldfs); -+ closeFile(fp); -+ -+ DBG_871X("%s writeFile, ret:%d\n",__FUNCTION__, ret); -+ -+ } else { -+ DBG_871X("%s openFile path:%s Fail, ret:%d\n",__FUNCTION__, path, ret); -+ } -+ } else { -+ DBG_871X("%s NULL pointer\n",__FUNCTION__); -+ ret = -EINVAL; -+ } -+ return ret; -+} -+#endif //PLATFORM_LINUX -+ -+/* -+* Test if the specifi @param path is a file and readable -+* @param path the path of the file to test -+* @return _TRUE or _FALSE -+*/ -+int rtw_is_file_readable(char *path) -+{ -+#ifdef PLATFORM_LINUX -+ if(isFileReadable(path) == 0) -+ return _TRUE; -+ else -+ return _FALSE; -+#else -+ //Todo... -+ return _FALSE; -+#endif -+} -+ -+/* -+* Open the file with @param path and retrive the file content into memory starting from @param buf for @param sz at most -+* @param path the path of the file to open and read -+* @param buf the starting address of the buffer to store file content -+* @param sz how many bytes to read at most -+* @return the byte we've read -+*/ -+int rtw_retrieve_from_file(char *path, u8 *buf, u32 sz) -+{ -+#ifdef PLATFORM_LINUX -+ int ret =retriveFromFile(path, buf, sz); -+ return ret>=0?ret:0; -+#else -+ //Todo... -+ return 0; -+#endif -+} -+ -+/* -+* Open the file with @param path and wirte @param sz byte of data starting from @param buf into the file -+* @param path the path of the file to open and write -+* @param buf the starting address of the data to write into file -+* @param sz how many bytes to write at most -+* @return the byte we've written -+*/ -+int rtw_store_to_file(char *path, u8* buf, u32 sz) -+{ -+#ifdef PLATFORM_LINUX -+ int ret =storeToFile(path, buf, sz); -+ return ret>=0?ret:0; -+#else -+ //Todo... -+ return 0; -+#endif -+} -+ -+#ifdef PLATFORM_LINUX -+struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv) -+{ -+ struct net_device *pnetdev; -+ struct rtw_netdev_priv_indicator *pnpi; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ pnetdev = alloc_etherdev_mq(sizeof(struct rtw_netdev_priv_indicator), 4); -+#else -+ pnetdev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); -+#endif -+ if (!pnetdev) -+ goto RETURN; -+ -+ pnpi = netdev_priv(pnetdev); -+ pnpi->priv=old_priv; -+ pnpi->sizeof_priv=sizeof_priv; -+ -+RETURN: -+ return pnetdev; -+} -+ -+struct net_device *rtw_alloc_etherdev(int sizeof_priv) -+{ -+ struct net_device *pnetdev; -+ struct rtw_netdev_priv_indicator *pnpi; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ pnetdev = alloc_etherdev_mq(sizeof(struct rtw_netdev_priv_indicator), 4); -+#else -+ pnetdev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); -+#endif -+ if (!pnetdev) -+ goto RETURN; -+ -+ pnpi = netdev_priv(pnetdev); -+ -+ pnpi->priv = rtw_zvmalloc(sizeof_priv); -+ if (!pnpi->priv) { -+ free_netdev(pnetdev); -+ pnetdev = NULL; -+ goto RETURN; -+ } -+ -+ pnpi->sizeof_priv=sizeof_priv; -+RETURN: -+ return pnetdev; -+} -+ -+void rtw_free_netdev(struct net_device * netdev) -+{ -+ struct rtw_netdev_priv_indicator *pnpi; -+ -+ if(!netdev) -+ goto RETURN; -+ -+ pnpi = netdev_priv(netdev); -+ -+ if(!pnpi->priv) -+ goto RETURN; -+ -+ free_netdev(netdev); -+ -+RETURN: -+ return; -+} -+ -+/* -+* Jeff: this function should be called under ioctl (rtnl_lock is accquired) while -+* LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26) -+*/ -+int rtw_change_ifname(_adapter *padapter, const char *ifname) -+{ -+ struct net_device *pnetdev; -+ struct net_device *cur_pnetdev; -+ struct rereg_nd_name_data *rereg_priv; -+ int ret; -+ -+ if(!padapter) -+ goto error; -+ -+ cur_pnetdev = padapter->pnetdev; -+ rereg_priv = &padapter->rereg_nd_name_priv; -+ -+ //free the old_pnetdev -+ if(rereg_priv->old_pnetdev) { -+ free_netdev(rereg_priv->old_pnetdev); -+ rereg_priv->old_pnetdev = NULL; -+ } -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,26)) -+ if(!rtnl_is_locked()) -+ unregister_netdev(cur_pnetdev); -+ else -+#endif -+ unregister_netdevice(cur_pnetdev); -+ -+ rereg_priv->old_pnetdev=cur_pnetdev; -+ -+ pnetdev = rtw_init_netdev(padapter); -+ if (!pnetdev) { -+ ret = -1; -+ goto error; -+ } -+ -+ SET_NETDEV_DEV(pnetdev, dvobj_to_dev(adapter_to_dvobj(padapter))); -+ -+ rtw_init_netdev_name(pnetdev, ifname); -+ -+ _rtw_memcpy(pnetdev->dev_addr, adapter_mac_addr(padapter), ETH_ALEN); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,26)) -+ if(!rtnl_is_locked()) -+ ret = register_netdev(pnetdev); -+ else -+#endif -+ ret = register_netdevice(pnetdev); -+ -+ if ( ret != 0) { -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("register_netdev() failed\n")); -+ goto error; -+ } -+ -+ return 0; -+ -+error: -+ -+ return -1; -+ -+} -+#endif -+ -+#ifdef PLATFORM_FREEBSD -+/* -+ * Copy a buffer from userspace and write into kernel address -+ * space. -+ * -+ * This emulation just calls the FreeBSD copyin function (to -+ * copy data from user space buffer into a kernel space buffer) -+ * and is designed to be used with the above io_write_wrapper. -+ * -+ * This function should return the number of bytes not copied. -+ * I.e. success results in a zero value. -+ * Negative error values are not returned. -+ */ -+unsigned long -+copy_from_user(void *to, const void *from, unsigned long n) -+{ -+ if ( copyin(from, to, n) != 0 ) { -+ /* Any errors will be treated as a failure -+ to copy any of the requested bytes */ -+ return n; -+ } -+ -+ return 0; -+} -+ -+unsigned long -+copy_to_user(void *to, const void *from, unsigned long n) -+{ -+ if ( copyout(from, to, n) != 0 ) { -+ /* Any errors will be treated as a failure -+ to copy any of the requested bytes */ -+ return n; -+ } -+ -+ return 0; -+} -+ -+ -+/* -+ * The usb_register and usb_deregister functions are used to register -+ * usb drivers with the usb subsystem. In this compatibility layer -+ * emulation a list of drivers (struct usb_driver) is maintained -+ * and is used for probing/attaching etc. -+ * -+ * usb_register and usb_deregister simply call these functions. -+ */ -+int -+usb_register(struct usb_driver *driver) -+{ -+ rtw_usb_linux_register(driver); -+ return 0; -+} -+ -+ -+int -+usb_deregister(struct usb_driver *driver) -+{ -+ rtw_usb_linux_deregister(driver); -+ return 0; -+} -+ -+void module_init_exit_wrapper(void *arg) -+{ -+ int (*func)(void) = arg; -+ func(); -+ return; -+} -+ -+#endif //PLATFORM_FREEBSD -+ -+#ifdef CONFIG_PLATFORM_SPRD -+#ifdef do_div -+#undef do_div -+#endif -+#include -+#endif -+ -+u64 rtw_modular64(u64 x, u64 y) -+{ -+#ifdef PLATFORM_LINUX -+ return do_div(x, y); -+#elif defined(PLATFORM_WINDOWS) -+ return (x % y); -+#elif defined(PLATFORM_FREEBSD) -+ return (x %y); -+#endif -+} -+ -+u64 rtw_division64(u64 x, u64 y) -+{ -+#ifdef PLATFORM_LINUX -+ do_div(x, y); -+ return x; -+#elif defined(PLATFORM_WINDOWS) -+ return (x / y); -+#elif defined(PLATFORM_FREEBSD) -+ return (x / y); -+#endif -+} -+ -+inline u32 rtw_random32(void) -+{ -+#ifdef PLATFORM_LINUX -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,8,0)) -+ return prandom_u32(); -+ #elif (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,18)) -+ u32 random_int; -+ get_random_bytes( &random_int , 4 ); -+ return random_int; -+ #else -+ return random32(); -+ #endif -+#elif defined(PLATFORM_WINDOWS) -+ #error "to be implemented\n" -+#elif defined(PLATFORM_FREEBSD) -+ #error "to be implemented\n" -+#endif -+} -+ -+void rtw_buf_free(u8 **buf, u32 *buf_len) -+{ -+ u32 ori_len; -+ -+ if (!buf || !buf_len) -+ return; -+ -+ ori_len = *buf_len; -+ -+ if (*buf) { -+ u32 tmp_buf_len = *buf_len; -+ *buf_len = 0; -+ rtw_mfree(*buf, tmp_buf_len); -+ *buf = NULL; -+ } -+} -+ -+void rtw_buf_update(u8 **buf, u32 *buf_len, u8 *src, u32 src_len) -+{ -+ u32 ori_len = 0, dup_len = 0; -+ u8 *ori = NULL; -+ u8 *dup = NULL; -+ -+ if (!buf || !buf_len) -+ return; -+ -+ if (!src || !src_len) -+ goto keep_ori; -+ -+ /* duplicate src */ -+ dup = rtw_malloc(src_len); -+ if (dup) { -+ dup_len = src_len; -+ _rtw_memcpy(dup, src, dup_len); -+ } -+ -+keep_ori: -+ ori = *buf; -+ ori_len = *buf_len; -+ -+ /* replace buf with dup */ -+ *buf_len = 0; -+ *buf = dup; -+ *buf_len = dup_len; -+ -+ /* free ori */ -+ if (ori && ori_len > 0) -+ rtw_mfree(ori, ori_len); -+} -+ -+ -+/** -+ * rtw_cbuf_full - test if cbuf is full -+ * @cbuf: pointer of struct rtw_cbuf -+ * -+ * Returns: _TRUE if cbuf is full -+ */ -+inline bool rtw_cbuf_full(struct rtw_cbuf *cbuf) -+{ -+ return (cbuf->write == cbuf->read-1)? _TRUE : _FALSE; -+} -+ -+/** -+ * rtw_cbuf_empty - test if cbuf is empty -+ * @cbuf: pointer of struct rtw_cbuf -+ * -+ * Returns: _TRUE if cbuf is empty -+ */ -+inline bool rtw_cbuf_empty(struct rtw_cbuf *cbuf) -+{ -+ return (cbuf->write == cbuf->read)? _TRUE : _FALSE; -+} -+ -+/** -+ * rtw_cbuf_push - push a pointer into cbuf -+ * @cbuf: pointer of struct rtw_cbuf -+ * @buf: pointer to push in -+ * -+ * Lock free operation, be careful of the use scheme -+ * Returns: _TRUE push success -+ */ -+bool rtw_cbuf_push(struct rtw_cbuf *cbuf, void *buf) -+{ -+ if (rtw_cbuf_full(cbuf)) -+ return _FAIL; -+ -+ if (0) -+ DBG_871X("%s on %u\n", __func__, cbuf->write); -+ cbuf->bufs[cbuf->write] = buf; -+ cbuf->write = (cbuf->write+1)%cbuf->size; -+ -+ return _SUCCESS; -+} -+ -+/** -+ * rtw_cbuf_pop - pop a pointer from cbuf -+ * @cbuf: pointer of struct rtw_cbuf -+ * -+ * Lock free operation, be careful of the use scheme -+ * Returns: pointer popped out -+ */ -+void *rtw_cbuf_pop(struct rtw_cbuf *cbuf) -+{ -+ void *buf; -+ if (rtw_cbuf_empty(cbuf)) -+ return NULL; -+ -+ if (0) -+ DBG_871X("%s on %u\n", __func__, cbuf->read); -+ buf = cbuf->bufs[cbuf->read]; -+ cbuf->read = (cbuf->read+1)%cbuf->size; -+ -+ return buf; -+} -+ -+/** -+ * rtw_cbuf_alloc - allocte a rtw_cbuf with given size and do initialization -+ * @size: size of pointer -+ * -+ * Returns: pointer of srtuct rtw_cbuf, NULL for allocation failure -+ */ -+struct rtw_cbuf *rtw_cbuf_alloc(u32 size) -+{ -+ struct rtw_cbuf *cbuf; -+ -+ cbuf = (struct rtw_cbuf *)rtw_malloc(sizeof(*cbuf) + sizeof(void*)*size); -+ -+ if (cbuf) { -+ cbuf->write = cbuf->read = 0; -+ cbuf->size = size; -+ } -+ -+ return cbuf; -+} -+ -+/** -+ * rtw_cbuf_free - free the given rtw_cbuf -+ * @cbuf: pointer of struct rtw_cbuf to free -+ */ -+void rtw_cbuf_free(struct rtw_cbuf *cbuf) -+{ -+ rtw_mfree((u8*)cbuf, sizeof(*cbuf) + sizeof(void*)*cbuf->size); -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/platform/platform_arm_act_sdio.c linux/3rdparty/rtl8812au/platform/platform_arm_act_sdio.c ---- linux.old/3rdparty/rtl8812au/platform/platform_arm_act_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/platform/platform_arm_act_sdio.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,58 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/* -+ * Description: -+ * This file can be applied to following platforms: -+ * CONFIG_PLATFORM_ACTIONS_ATM703X -+ */ -+#include -+ -+#ifdef CONFIG_PLATFORM_ACTIONS_ATM705X -+extern int acts_wifi_init(void); -+extern void acts_wifi_cleanup(void); -+#endif -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_PLATFORM_ACTIONS_ATM705X -+ ret = acts_wifi_init(); -+ if (unlikely(ret < 0)) { -+ pr_err("%s Failed to register the power control driver.\n", __FUNCTION__); -+ goto exit; -+ } -+#endif -+ -+exit: -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+#ifdef CONFIG_PLATFORM_ACTIONS_ATM705X -+ acts_wifi_cleanup(); -+#endif -+} -diff -Nurp linux.old/3rdparty/rtl8812au/platform/platform_ARM_SUN50IW1P1_sdio.c linux/3rdparty/rtl8812au/platform/platform_ARM_SUN50IW1P1_sdio.c ---- linux.old/3rdparty/rtl8812au/platform/platform_ARM_SUN50IW1P1_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/platform/platform_ARM_SUN50IW1P1_sdio.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,91 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/* -+ * Description: -+ * This file can be applied to following platforms: -+ * CONFIG_PLATFORM_ARM_SUN50IW1P1 -+ */ -+#include -+#ifdef CONFIG_GPIO_WAKEUP -+#include -+#endif -+ -+#ifdef CONFIG_MMC -+#if defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) -+extern void sunxi_mmc_rescan_card(unsigned ids); -+extern void sunxi_wlan_set_power(int on); -+extern int sunxi_wlan_get_bus_index(void); -+extern int sunxi_wlan_get_oob_irq(void); -+extern int sunxi_wlan_get_oob_irq_flags(void); -+#endif -+#ifdef CONFIG_GPIO_WAKEUP -+extern unsigned int oob_irq; -+#endif -+#endif // CONFIG_MMC -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_MMC -+{ -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) -+ int wlan_bus_index = sunxi_wlan_get_bus_index(); -+ if(wlan_bus_index < 0) -+ return wlan_bus_index; -+ -+ sunxi_wlan_set_power(1); -+ mdelay(100); -+ sunxi_mmc_rescan_card(wlan_bus_index); -+#endif -+ DBG_871X("%s: power up, rescan card.\n", __FUNCTION__); -+ -+#ifdef CONFIG_GPIO_WAKEUP -+#if defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) -+ oob_irq = sunxi_wlan_get_oob_irq(); -+#endif -+#endif // CONFIG_GPIO_WAKEUP -+} -+#endif // CONFIG_MMC -+ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+#ifdef CONFIG_MMC -+#if defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) -+ int wlan_bus_index = sunxi_wlan_get_bus_index(); -+ if(wlan_bus_index < 0) -+ return; -+ -+ sunxi_mmc_rescan_card(wlan_bus_index); -+ mdelay(100); -+ sunxi_wlan_set_power(0); -+#endif -+ DBG_871X("%s: remove card, power off.\n", __FUNCTION__); -+#endif // CONFIG_MMC -+} -diff -Nurp linux.old/3rdparty/rtl8812au/platform/platform_ARM_SUNnI_sdio.c linux/3rdparty/rtl8812au/platform/platform_ARM_SUNnI_sdio.c ---- linux.old/3rdparty/rtl8812au/platform/platform_ARM_SUNnI_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/platform/platform_ARM_SUNnI_sdio.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,135 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/* -+ * Description: -+ * This file can be applied to following platforms: -+ * CONFIG_PLATFORM_ARM_SUN6I -+ * CONFIG_PLATFORM_ARM_SUN7I -+ * CONFIG_PLATFORM_ARM_SUN8I -+ */ -+#include -+#include -+#ifdef CONFIG_GPIO_WAKEUP -+#include -+#endif -+ -+#ifdef CONFIG_MMC -+static int sdc_id = -1; -+static signed int gpio_eint_wlan = -1; -+static u32 eint_wlan_handle = 0; -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) -+extern void sw_mci_rescan_card(unsigned id, unsigned insert); -+#elif defined(CONFIG_PLATFORM_ARM_SUN8I) -+extern void sunxi_mci_rescan_card(unsigned id, unsigned insert); -+#endif -+ -+#ifdef CONFIG_PLATFORM_ARM_SUN8I_W5P1 -+extern int get_rf_mod_type(void); -+#else -+extern int wifi_pm_get_mod_type(void); -+#endif -+ -+extern void wifi_pm_power(int on); -+#ifdef CONFIG_GPIO_WAKEUP -+extern unsigned int oob_irq; -+#endif -+#endif // CONFIG_MMC -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_MMC -+{ -+ script_item_u val; -+ script_item_value_type_e type; -+ -+#ifdef CONFIG_PLATFORM_ARM_SUN8I_W5P1 -+ unsigned int mod_sel = get_rf_mod_type(); -+#else -+ unsigned int mod_sel = wifi_pm_get_mod_type(); -+#endif -+ -+ type = script_get_item("wifi_para", "wifi_sdc_id", &val); -+ if (SCIRPT_ITEM_VALUE_TYPE_INT!=type) { -+ DBG_871X("get wifi_sdc_id failed\n"); -+ ret = -1; -+ } else { -+ sdc_id = val.val; -+ DBG_871X("----- %s sdc_id: %d, mod_sel: %d\n", __FUNCTION__, sdc_id, mod_sel); -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) -+ sw_mci_rescan_card(sdc_id, 1); -+#elif defined(CONFIG_PLATFORM_ARM_SUN8I) -+ sunxi_mci_rescan_card(sdc_id, 1); -+#endif -+ mdelay(100); -+ wifi_pm_power(1); -+ -+ DBG_871X("%s: power up, rescan card.\n", __FUNCTION__); -+ } -+ -+#ifdef CONFIG_GPIO_WAKEUP -+#ifdef CONFIG_PLATFORM_ARM_SUN8I_W5P1 -+ type = script_get_item("wifi_para", "wl_host_wake", &val); -+#else -+#ifdef CONFIG_RTL8723B -+ type = script_get_item("wifi_para", "rtl8723bs_wl_host_wake", &val); -+#endif -+#ifdef CONFIG_RTL8188E -+ type = script_get_item("wifi_para", "rtl8189es_host_wake", &val); -+#endif -+#endif /* CONFIG_PLATFORM_ARM_SUN8I_W5P1 */ -+ if (SCIRPT_ITEM_VALUE_TYPE_PIO != type) { -+ DBG_871X("No definition of wake up host PIN\n"); -+ ret = -1; -+ } else { -+ gpio_eint_wlan = val.gpio.gpio; -+#ifdef CONFIG_PLATFORM_ARM_SUN8I -+ oob_irq = gpio_to_irq(gpio_eint_wlan); -+#endif -+ } -+#endif // CONFIG_GPIO_WAKEUP -+} -+#endif // CONFIG_MMC -+ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+#ifdef CONFIG_MMC -+#if defined(CONFIG_PLATFORM_ARM_SUN6I) ||defined(CONFIG_PLATFORM_ARM_SUN7I) -+ sw_mci_rescan_card(sdc_id, 0); -+#elif defined(CONFIG_PLATFORM_ARM_SUN8I) -+ sunxi_mci_rescan_card(sdc_id, 0); -+#endif -+ mdelay(100); -+ wifi_pm_power(0); -+ -+ DBG_871X("%s: remove card, power off.\n", __FUNCTION__); -+#endif // CONFIG_MMC -+} -diff -Nurp linux.old/3rdparty/rtl8812au/platform/platform_ARM_SUNxI_sdio.c linux/3rdparty/rtl8812au/platform/platform_ARM_SUNxI_sdio.c ---- linux.old/3rdparty/rtl8812au/platform/platform_ARM_SUNxI_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/platform/platform_ARM_SUNxI_sdio.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,95 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#include -+ -+#ifdef CONFIG_MMC_SUNXI_POWER_CONTROL -+#ifdef CONFIG_WITS_EVB_V13 -+#define SDIOID 0 -+#else // !CONFIG_WITS_EVB_V13 -+#define SDIOID (CONFIG_CHIP_ID==1123 ? 3 : 1) -+#endif // !CONFIG_WITS_EVB_V13 -+ -+#define SUNXI_SDIO_WIFI_NUM_RTL8189ES 10 -+extern void sunximmc_rescan_card(unsigned id, unsigned insert); -+extern int mmc_pm_get_mod_type(void); -+extern int mmc_pm_gpio_ctrl(char* name, int level); -+/* -+ * rtl8189es_shdn = port:PH09<1><0> -+ * rtl8189es_wakeup = port:PH10<1><1> -+ * rtl8189es_vdd_en = port:PH11<1><0> -+ * rtl8189es_vcc_en = port:PH12<1><0> -+ */ -+ -+int rtl8189es_sdio_powerup(void) -+{ -+ mmc_pm_gpio_ctrl("rtl8189es_vdd_en", 1); -+ udelay(100); -+ mmc_pm_gpio_ctrl("rtl8189es_vcc_en", 1); -+ udelay(50); -+ mmc_pm_gpio_ctrl("rtl8189es_shdn", 1); -+ return 0; -+} -+ -+int rtl8189es_sdio_poweroff(void) -+{ -+ mmc_pm_gpio_ctrl("rtl8189es_shdn", 0); -+ mmc_pm_gpio_ctrl("rtl8189es_vcc_en", 0); -+ mmc_pm_gpio_ctrl("rtl8189es_vdd_en", 0); -+ return 0; -+} -+#endif // CONFIG_MMC_SUNXI_POWER_CONTROL -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+#ifdef CONFIG_MMC_SUNXI_POWER_CONTROL -+ unsigned int mod_sel = mmc_pm_get_mod_type(); -+#endif // CONFIG_MMC_SUNXI_POWER_CONTROL -+ -+ -+#ifdef CONFIG_MMC_SUNXI_POWER_CONTROL -+ if (mod_sel == SUNXI_SDIO_WIFI_NUM_RTL8189ES) { -+ rtl8189es_sdio_powerup(); -+ sunximmc_rescan_card(SDIOID, 1); -+ printk("[rtl8189es] %s: power up, rescan card.\n", __FUNCTION__); -+ } else { -+ ret = -1; -+ printk("[rtl8189es] %s: mod_sel = %d is incorrect.\n", __FUNCTION__, mod_sel); -+ } -+#endif // CONFIG_MMC_SUNXI_POWER_CONTROL -+ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+#ifdef CONFIG_MMC_SUNXI_POWER_CONTROL -+ sunximmc_rescan_card(SDIOID, 0); -+#ifdef CONFIG_RTL8188E -+ rtl8189es_sdio_poweroff(); -+ printk("[rtl8189es] %s: remove card, power off.\n", __FUNCTION__); -+#endif // CONFIG_RTL8188E -+#endif // CONFIG_MMC_SUNXI_POWER_CONTROL -+} -diff -Nurp linux.old/3rdparty/rtl8812au/platform/platform_ARM_SUNxI_usb.c linux/3rdparty/rtl8812au/platform/platform_ARM_SUNxI_usb.c ---- linux.old/3rdparty/rtl8812au/platform/platform_ARM_SUNxI_usb.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/platform/platform_ARM_SUNxI_usb.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,142 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/* -+ * Description: -+ * This file can be applied to following platforms: -+ * CONFIG_PLATFORM_ARM_SUNXI Series platform -+ * -+ */ -+ -+#include -+#include -+ -+#ifdef CONFIG_PLATFORM_ARM_SUNxI -+extern int sw_usb_disable_hcd(__u32 usbc_no); -+extern int sw_usb_enable_hcd(__u32 usbc_no); -+static int usb_wifi_host = 2; -+#endif -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) -+extern int sw_usb_disable_hcd(__u32 usbc_no); -+extern int sw_usb_enable_hcd(__u32 usbc_no); -+extern void wifi_pm_power(int on); -+static script_item_u item; -+#endif -+ -+#ifdef CONFIG_PLATFORM_ARM_SUN8I -+extern int sunxi_usb_disable_hcd(__u32 usbc_no); -+extern int sunxi_usb_enable_hcd(__u32 usbc_no); -+extern void wifi_pm_power(int on); -+static script_item_u item; -+#endif -+ -+ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_PLATFORM_ARM_SUNxI -+#ifndef CONFIG_RTL8723A -+ { -+ /* ----------get usb_wifi_usbc_num------------- */ -+ ret = script_parser_fetch("usb_wifi_para", "usb_wifi_usbc_num", (int *)&usb_wifi_host, 64); -+ if(ret != 0){ -+ DBG_8192C("ERR: script_parser_fetch usb_wifi_usbc_num failed\n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ DBG_8192C("sw_usb_enable_hcd: usbc_num = %d\n", usb_wifi_host); -+ sw_usb_enable_hcd(usb_wifi_host); -+ } -+#endif //CONFIG_RTL8723A -+#endif //CONFIG_PLATFORM_ARM_SUNxI -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) -+ { -+ script_item_value_type_e type; -+ -+ type = script_get_item("wifi_para", "wifi_usbc_id", &item); -+ if(SCIRPT_ITEM_VALUE_TYPE_INT != type){ -+ printk("ERR: script_get_item wifi_usbc_id failed\n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ printk("sw_usb_enable_hcd: usbc_num = %d\n", item.val); -+ wifi_pm_power(1); -+ mdelay(10); -+ -+ #if !(defined(CONFIG_RTL8723A)) && !(defined(CONFIG_RTL8723B)) -+ sw_usb_enable_hcd(item.val); -+ #endif -+ } -+#endif //defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN8I) -+ { -+ script_item_value_type_e type; -+ -+ type = script_get_item("wifi_para", "wifi_usbc_id", &item); -+ if(SCIRPT_ITEM_VALUE_TYPE_INT != type){ -+ printk("ERR: script_get_item wifi_usbc_id failed\n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ printk("sw_usb_enable_hcd: usbc_num = %d\n", item.val); -+ wifi_pm_power(1); -+ mdelay(10); -+ -+ #if !(defined(CONFIG_RTL8723A)) && !(defined(CONFIG_RTL8723B)) -+ sunxi_usb_enable_hcd(item.val); -+ #endif -+ } -+#endif //CONFIG_PLATFORM_ARM_SUN8I -+ -+exit: -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+ -+#ifdef CONFIG_PLATFORM_ARM_SUNxI -+#ifndef CONFIG_RTL8723A -+ DBG_8192C("sw_usb_disable_hcd: usbc_num = %d\n", usb_wifi_host); -+ sw_usb_disable_hcd(usb_wifi_host); -+#endif //ifndef CONFIG_RTL8723A -+#endif //CONFIG_PLATFORM_ARM_SUNxI -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) -+ #if !(defined(CONFIG_RTL8723A)) && !(defined(CONFIG_RTL8723B)) -+ sw_usb_disable_hcd(item.val); -+ #endif -+ wifi_pm_power(0); -+#endif //defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN8I) -+ #if !(defined(CONFIG_RTL8723A)) && !(defined(CONFIG_RTL8723B)) -+ sunxi_usb_disable_hcd(item.val); -+ #endif -+ wifi_pm_power(0); -+#endif //defined(CONFIG_PLATFORM_ARM_SUN8I) -+ -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/platform/platform_ARM_WMT_sdio.c linux/3rdparty/rtl8812au/platform/platform_ARM_WMT_sdio.c ---- linux.old/3rdparty/rtl8812au/platform/platform_ARM_WMT_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/platform/platform_ARM_WMT_sdio.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,51 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#include -+#include -+#include -+ -+extern void wmt_detect_sdio2(void); -+extern void force_remove_sdio2(void); -+ -+int platform_wifi_power_on(void) -+{ -+ int err = 0; -+ err = gpio_request(WMT_PIN_GP62_SUSGPIO1, "wifi_chip_en"); -+ if (err < 0){ -+ printk("request gpio for rtl8188eu failed!\n"); -+ return err; -+ } -+ gpio_direction_output(WMT_PIN_GP62_SUSGPIO1, 0);//pull sus_gpio1 to 0 to open vcc_wifi. -+ printk("power on rtl8189.\n"); -+ msleep(500); -+ wmt_detect_sdio2(); -+ printk("[rtl8189es] %s: new card, power on.\n", __FUNCTION__); -+ return err; -+} -+ -+void platform_wifi_power_off(void) -+{ -+ force_remove_sdio2(); -+ -+ gpio_direction_output(WMT_PIN_GP62_SUSGPIO1, 1);//pull sus_gpio1 to 1 to close vcc_wifi. -+ printk("power off rtl8189.\n"); -+ gpio_free(WMT_PIN_GP62_SUSGPIO1); -+ printk("[rtl8189es] %s: remove card, power off.\n", __FUNCTION__); -+} -diff -Nurp linux.old/3rdparty/rtl8812au/platform/platform_ops.c linux/3rdparty/rtl8812au/platform/platform_ops.c ---- linux.old/3rdparty/rtl8812au/platform/platform_ops.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/platform/platform_ops.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,37 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef CONFIG_PLATFORM_OPS -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+} -+#endif // !CONFIG_PLATFORM_OPS -diff -Nurp linux.old/3rdparty/rtl8812au/platform/platform_ops.h linux/3rdparty/rtl8812au/platform/platform_ops.h ---- linux.old/3rdparty/rtl8812au/platform/platform_ops.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/platform/platform_ops.h 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __PLATFORM_OPS_H__ -+#define __PLATFORM_OPS_H__ -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void); -+void platform_wifi_power_off(void); -+ -+#endif // __PLATFORM_OPS_H__ -diff -Nurp linux.old/3rdparty/rtl8812au/platform/platform_RTK_DMP_usb.c linux/3rdparty/rtl8812au/platform/platform_RTK_DMP_usb.c ---- linux.old/3rdparty/rtl8812au/platform/platform_RTK_DMP_usb.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/platform/platform_RTK_DMP_usb.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,36 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#include -+ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ u32 tmp; -+ tmp=readl((volatile unsigned int*)0xb801a608); -+ tmp &= 0xffffff00; -+ tmp |= 0x55; -+ writel(tmp,(volatile unsigned int*)0xb801a608);//write dummy register for 1055 -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+} -+ -diff -Nurp linux.old/3rdparty/rtl8812au/platform/platform_sprd_sdio.c linux/3rdparty/rtl8812au/platform/platform_sprd_sdio.c ---- linux.old/3rdparty/rtl8812au/platform/platform_sprd_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux/3rdparty/rtl8812au/platform/platform_sprd_sdio.c 2017-06-07 23:07:21.048690948 +0300 -@@ -0,0 +1,89 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#include -+ -+extern void sdhci_bus_scan(void); -+#ifndef ANDROID_2X -+extern int sdhci_device_attached(void); -+#endif -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+ -+#ifdef CONFIG_RTL8188E -+ rtw_wifi_gpio_wlan_ctrl(WLAN_POWER_ON); -+#endif // CONFIG_RTL8188E -+ -+ /* Pull up pwd pin, make wifi leave power down mode. */ -+ rtw_wifi_gpio_init(); -+ rtw_wifi_gpio_wlan_ctrl(WLAN_PWDN_ON); -+ -+#if (MP_DRIVER == 1) && (defined(CONFIG_RTL8723A)||defined(CONFIG_RTL8723B)) -+ // Pull up BT reset pin. -+ rtw_wifi_gpio_wlan_ctrl(WLAN_BT_PWDN_ON); -+#endif -+ rtw_mdelay_os(5); -+ -+ sdhci_bus_scan(); -+#ifdef CONFIG_RTL8723B -+ //YJ,test,130305 -+ rtw_mdelay_os(1000); -+#endif -+#ifdef ANDROID_2X -+ rtw_mdelay_os(200); -+#else // !ANDROID_2X -+ if (1) { -+ int i = 0; -+ -+ for (i = 0; i <= 50; i++) { -+ msleep(10); -+ if (sdhci_device_attached()) -+ break; -+ printk("%s delay times:%d\n", __func__, i); -+ } -+ } -+#endif // !ANDROID_2X -+ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+ /* Pull down pwd pin, make wifi enter power down mode. */ -+ rtw_wifi_gpio_wlan_ctrl(WLAN_PWDN_OFF); -+ rtw_mdelay_os(5); -+ rtw_wifi_gpio_deinit(); -+ -+#ifdef CONFIG_RTL8188E -+ rtw_wifi_gpio_wlan_ctrl(WLAN_POWER_OFF); -+#endif // CONFIG_RTL8188E -+ -+#ifdef CONFIG_WOWLAN -+ if(mmc_host) -+ mmc_host->pm_flags &= ~MMC_PM_KEEP_POWER; -+#endif // CONFIG_WOWLAN -+} diff --git a/kernel/tools/cpupowertools/files/patches/mageia/Revert-ipmi-Start-the-timer-and-thread-on-internal-m.patch b/kernel/tools/cpupowertools/files/patches/mageia/Revert-ipmi-Start-the-timer-and-thread-on-internal-m.patch deleted file mode 100644 index 965e5c74..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/Revert-ipmi-Start-the-timer-and-thread-on-internal-m.patch +++ /dev/null @@ -1,197 +0,0 @@ -From 43034bc4606f1f21186ca6fe27bc0448159d5e00 Mon Sep 17 00:00:00 2001 -From: Thomas Backlund -Date: Thu, 10 Mar 2016 15:44:13 +0200 -Subject: [PATCH] Revert "ipmi: Start the timer and thread on internal msgs" - -This reverts commit 0cfec916e86d881e209de4b4ae9959a6271e6660. - -It's reported on ipmi list that Dell R720xd servers will always panic -on dell ipmi services load - -Reverting this fixes the issue. - -Signed-off-by: Thomas Backlund - ---- - drivers/char/ipmi/ipmi_si_intf.c | 73 ++++++++++++++++------------------------ - 1 file changed, 29 insertions(+), 44 deletions(-) - -diff --git a/drivers/char/ipmi/ipmi_si_intf.c b/drivers/char/ipmi/ipmi_si_intf.c -index 4cc72fa..f667be8 100644 ---- a/drivers/char/ipmi/ipmi_si_intf.c -+++ b/drivers/char/ipmi/ipmi_si_intf.c -@@ -412,42 +412,18 @@ static enum si_sm_result start_next_msg(struct smi_info *smi_info) - return rv; - } - --static void smi_mod_timer(struct smi_info *smi_info, unsigned long new_val) --{ -- smi_info->last_timeout_jiffies = jiffies; -- mod_timer(&smi_info->si_timer, new_val); -- smi_info->timer_running = true; --} -- --/* -- * Start a new message and (re)start the timer and thread. -- */ --static void start_new_msg(struct smi_info *smi_info, unsigned char *msg, -- unsigned int size) --{ -- smi_mod_timer(smi_info, jiffies + SI_TIMEOUT_JIFFIES); -- -- if (smi_info->thread) -- wake_up_process(smi_info->thread); -- -- smi_info->handlers->start_transaction(smi_info->si_sm, msg, size); --} -- --static void start_check_enables(struct smi_info *smi_info, bool start_timer) -+static void start_check_enables(struct smi_info *smi_info) - { - unsigned char msg[2]; - - msg[0] = (IPMI_NETFN_APP_REQUEST << 2); - msg[1] = IPMI_GET_BMC_GLOBAL_ENABLES_CMD; - -- if (start_timer) -- start_new_msg(smi_info, msg, 2); -- else -- smi_info->handlers->start_transaction(smi_info->si_sm, msg, 2); -+ smi_info->handlers->start_transaction(smi_info->si_sm, msg, 2); - smi_info->si_state = SI_CHECKING_ENABLES; - } - --static void start_clear_flags(struct smi_info *smi_info, bool start_timer) -+static void start_clear_flags(struct smi_info *smi_info) - { - unsigned char msg[3]; - -@@ -456,10 +432,7 @@ static void start_clear_flags(struct smi_info *smi_info, bool start_timer) - msg[1] = IPMI_CLEAR_MSG_FLAGS_CMD; - msg[2] = WDT_PRE_TIMEOUT_INT; - -- if (start_timer) -- start_new_msg(smi_info, msg, 3); -- else -- smi_info->handlers->start_transaction(smi_info->si_sm, msg, 3); -+ smi_info->handlers->start_transaction(smi_info->si_sm, msg, 3); - smi_info->si_state = SI_CLEARING_FLAGS; - } - -@@ -469,8 +442,10 @@ static void start_getting_msg_queue(struct smi_info *smi_info) - smi_info->curr_msg->data[1] = IPMI_GET_MSG_CMD; - smi_info->curr_msg->data_size = 2; - -- start_new_msg(smi_info, smi_info->curr_msg->data, -- smi_info->curr_msg->data_size); -+ smi_info->handlers->start_transaction( -+ smi_info->si_sm, -+ smi_info->curr_msg->data, -+ smi_info->curr_msg->data_size); - smi_info->si_state = SI_GETTING_MESSAGES; - } - -@@ -480,11 +455,20 @@ static void start_getting_events(struct smi_info *smi_info) - smi_info->curr_msg->data[1] = IPMI_READ_EVENT_MSG_BUFFER_CMD; - smi_info->curr_msg->data_size = 2; - -- start_new_msg(smi_info, smi_info->curr_msg->data, -- smi_info->curr_msg->data_size); -+ smi_info->handlers->start_transaction( -+ smi_info->si_sm, -+ smi_info->curr_msg->data, -+ smi_info->curr_msg->data_size); - smi_info->si_state = SI_GETTING_EVENTS; - } - -+static void smi_mod_timer(struct smi_info *smi_info, unsigned long new_val) -+{ -+ smi_info->last_timeout_jiffies = jiffies; -+ mod_timer(&smi_info->si_timer, new_val); -+ smi_info->timer_running = true; -+} -+ - /* - * When we have a situtaion where we run out of memory and cannot - * allocate messages, we just leave them in the BMC and run the system -@@ -494,11 +478,11 @@ static void start_getting_events(struct smi_info *smi_info) - * Note that we cannot just use disable_irq(), since the interrupt may - * be shared. - */ --static inline bool disable_si_irq(struct smi_info *smi_info, bool start_timer) -+static inline bool disable_si_irq(struct smi_info *smi_info) - { - if ((smi_info->irq) && (!smi_info->interrupt_disabled)) { - smi_info->interrupt_disabled = true; -- start_check_enables(smi_info, start_timer); -+ start_check_enables(smi_info); - return true; - } - return false; -@@ -508,7 +492,7 @@ static inline bool enable_si_irq(struct smi_info *smi_info) - { - if ((smi_info->irq) && (smi_info->interrupt_disabled)) { - smi_info->interrupt_disabled = false; -- start_check_enables(smi_info, true); -+ start_check_enables(smi_info); - return true; - } - return false; -@@ -526,7 +510,7 @@ static struct ipmi_smi_msg *alloc_msg_handle_irq(struct smi_info *smi_info) - - msg = ipmi_alloc_smi_msg(); - if (!msg) { -- if (!disable_si_irq(smi_info, true)) -+ if (!disable_si_irq(smi_info)) - smi_info->si_state = SI_NORMAL; - } else if (enable_si_irq(smi_info)) { - ipmi_free_smi_msg(msg); -@@ -542,7 +526,7 @@ static void handle_flags(struct smi_info *smi_info) - /* Watchdog pre-timeout */ - smi_inc_stat(smi_info, watchdog_pretimeouts); - -- start_clear_flags(smi_info, true); -+ start_clear_flags(smi_info); - smi_info->msg_flags &= ~WDT_PRE_TIMEOUT_INT; - if (smi_info->intf) - ipmi_smi_watchdog_pretimeout(smi_info->intf); -@@ -895,7 +879,8 @@ static enum si_sm_result smi_event_handler(struct smi_info *smi_info, - msg[0] = (IPMI_NETFN_APP_REQUEST << 2); - msg[1] = IPMI_GET_MSG_FLAGS_CMD; - -- start_new_msg(smi_info, msg, 2); -+ smi_info->handlers->start_transaction( -+ smi_info->si_sm, msg, 2); - smi_info->si_state = SI_GETTING_FLAGS; - goto restart; - } -@@ -925,7 +910,7 @@ static enum si_sm_result smi_event_handler(struct smi_info *smi_info, - * disable and messages disabled. - */ - if (smi_info->supports_event_msg_buff || smi_info->irq) { -- start_check_enables(smi_info, true); -+ start_check_enables(smi_info); - } else { - smi_info->curr_msg = alloc_msg_handle_irq(smi_info); - if (!smi_info->curr_msg) -@@ -3635,7 +3620,7 @@ static int try_smi_init(struct smi_info *new_smi) - * Start clearing the flags before we enable interrupts or the - * timer to avoid racing with the timer. - */ -- start_clear_flags(new_smi, false); -+ start_clear_flags(new_smi); - - /* - * IRQ is defined to be set when non-zero. req_events will -@@ -3930,7 +3915,7 @@ static void cleanup_one_si(struct smi_info *to_clean) - poll(to_clean); - schedule_timeout_uninterruptible(1); - } -- disable_si_irq(to_clean, false); -+ disable_si_irq(to_clean); - while (to_clean->curr_msg || (to_clean->si_state != SI_NORMAL)) { - poll(to_clean); - schedule_timeout_uninterruptible(1); --- -2.7.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/acpi-ACPICA-Events-Fix-acpi_ev_initialize_region-return-v.patch b/kernel/tools/cpupowertools/files/patches/mageia/acpi-ACPICA-Events-Fix-acpi_ev_initialize_region-return-v.patch deleted file mode 100644 index 939960bf..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/acpi-ACPICA-Events-Fix-acpi_ev_initialize_region-return-v.patch +++ /dev/null @@ -1,192 +0,0 @@ -From 760235cd6ca8ae0d7509055d75a0f1d8b3c60668 Mon Sep 17 00:00:00 2001 -From: Lv Zheng -Date: Wed, 30 Nov 2016 15:21:12 +0800 -Subject: [PATCH] ACPICA: Events: Fix acpi_ev_initialize_region() return value - -ACPICA commit 543342ab7a676f4eb0c9f100d349388a84dff0e8 - -This patch changes acpi_ev_initialize_region(), stop returning AE_NOT_EXIST -from it so that, not only in acpi_ds_load2_end_op(), but all places invoking -this function won't emit exceptions. The exception can be seen in -acpi_ds_initialize_objects() when certain table loading mode is chosen. - -This patch also removes useless acpi_ns_locked from acpi_ev_initialize_region() -as this function will always be invoked with interpreter lock held now, and -the lock granularity has been tuned to lock around _REG execution, thus it -is now handled by acpi_ex_exit_interpreter(). Lv Zheng. - -Link: https://github.com/acpica/acpica/commit/543342ab -Signed-off-by: Lv Zheng -Signed-off-by: Bob Moore -Signed-off-by: Rafael J. Wysocki ---- - drivers/acpi/acpica/acevents.h | 4 +-- - drivers/acpi/acpica/dsopcode.c | 2 +- - drivers/acpi/acpica/dswload2.c | 13 +--------- - drivers/acpi/acpica/evrgnini.c | 59 +++++++++++++++++------------------------- - 4 files changed, 27 insertions(+), 51 deletions(-) - -diff --git a/drivers/acpi/acpica/acevents.h b/drivers/acpi/acpica/acevents.h -index 92fa47c..8a0049d 100644 ---- a/drivers/acpi/acpica/acevents.h -+++ b/drivers/acpi/acpica/acevents.h -@@ -243,9 +243,7 @@ acpi_ev_default_region_setup(acpi_handle handle, - u32 function, - void *handler_context, void **region_context); - --acpi_status --acpi_ev_initialize_region(union acpi_operand_object *region_obj, -- u8 acpi_ns_locked); -+acpi_status acpi_ev_initialize_region(union acpi_operand_object *region_obj); - - /* - * evsci - SCI (System Control Interrupt) handling/dispatch -diff --git a/drivers/acpi/acpica/dsopcode.c b/drivers/acpi/acpica/dsopcode.c -index 4cc9d98..77fd7c8 100644 ---- a/drivers/acpi/acpica/dsopcode.c -+++ b/drivers/acpi/acpica/dsopcode.c -@@ -84,7 +84,7 @@ acpi_status acpi_ds_initialize_region(acpi_handle obj_handle) - - /* Namespace is NOT locked */ - -- status = acpi_ev_initialize_region(obj_desc, FALSE); -+ status = acpi_ev_initialize_region(obj_desc); - return (status); - } - -diff --git a/drivers/acpi/acpica/dswload2.c b/drivers/acpi/acpica/dswload2.c -index e362182..651f35a 100644 ---- a/drivers/acpi/acpica/dswload2.c -+++ b/drivers/acpi/acpica/dswload2.c -@@ -609,18 +609,7 @@ acpi_status acpi_ds_load2_end_op(struct acpi_walk_state *walk_state) - - status = - acpi_ev_initialize_region -- (acpi_ns_get_attached_object(node), FALSE); -- -- if (ACPI_FAILURE(status)) { -- /* -- * If AE_NOT_EXIST is returned, it is not fatal -- * because many regions get created before a handler -- * is installed for said region. -- */ -- if (AE_NOT_EXIST == status) { -- status = AE_OK; -- } -- } -+ (acpi_ns_get_attached_object(node)); - break; - - case AML_NAME_OP: -diff --git a/drivers/acpi/acpica/evrgnini.c b/drivers/acpi/acpica/evrgnini.c -index 75ddd16..a909225 100644 ---- a/drivers/acpi/acpica/evrgnini.c -+++ b/drivers/acpi/acpica/evrgnini.c -@@ -479,7 +479,6 @@ acpi_ev_default_region_setup(acpi_handle handle, - * FUNCTION: acpi_ev_initialize_region - * - * PARAMETERS: region_obj - Region we are initializing -- * acpi_ns_locked - Is namespace locked? - * - * RETURN: Status - * -@@ -497,19 +496,28 @@ acpi_ev_default_region_setup(acpi_handle handle, - * MUTEX: Interpreter should be unlocked, because we may run the _REG - * method for this region. - * -+ * NOTE: Possible incompliance: -+ * There is a behavior conflict in automatic _REG execution: -+ * 1. When the interpreter is evaluating a method, we can only -+ * automatically run _REG for the following case: -+ * operation_region (OPR1, 0x80, 0x1000010, 0x4) -+ * 2. When the interpreter is loading a table, we can also -+ * automatically run _REG for the following case: -+ * operation_region (OPR1, 0x80, 0x1000010, 0x4) -+ * Though this may not be compliant to the de-facto standard, the -+ * logic is kept in order not to trigger regressions. And keeping -+ * this logic should be taken care by the caller of this function. -+ * - ******************************************************************************/ - --acpi_status --acpi_ev_initialize_region(union acpi_operand_object *region_obj, -- u8 acpi_ns_locked) -+acpi_status acpi_ev_initialize_region(union acpi_operand_object *region_obj) - { - union acpi_operand_object *handler_obj; - union acpi_operand_object *obj_desc; - acpi_adr_space_type space_id; - struct acpi_namespace_node *node; -- acpi_status status; - -- ACPI_FUNCTION_TRACE_U32(ev_initialize_region, acpi_ns_locked); -+ ACPI_FUNCTION_TRACE(ev_initialize_region); - - if (!region_obj) { - return_ACPI_STATUS(AE_BAD_PARAMETER); -@@ -580,39 +588,17 @@ acpi_ev_initialize_region(union acpi_operand_object *region_obj, - handler_obj, region_obj, - obj_desc)); - -- status = -- acpi_ev_attach_region(handler_obj, -- region_obj, -- acpi_ns_locked); -+ (void)acpi_ev_attach_region(handler_obj, -+ region_obj, FALSE); - - /* - * Tell all users that this region is usable by - * running the _REG method - */ -- if (acpi_ns_locked) { -- status = -- acpi_ut_release_mutex -- (ACPI_MTX_NAMESPACE); -- if (ACPI_FAILURE(status)) { -- return_ACPI_STATUS(status); -- } -- } -- - acpi_ex_exit_interpreter(); -- status = -- acpi_ev_execute_reg_method(region_obj, -- ACPI_REG_CONNECT); -+ (void)acpi_ev_execute_reg_method(region_obj, -+ ACPI_REG_CONNECT); - acpi_ex_enter_interpreter(); -- -- if (acpi_ns_locked) { -- status = -- acpi_ut_acquire_mutex -- (ACPI_MTX_NAMESPACE); -- if (ACPI_FAILURE(status)) { -- return_ACPI_STATUS(status); -- } -- } -- - return_ACPI_STATUS(AE_OK); - } - } -@@ -622,12 +608,15 @@ acpi_ev_initialize_region(union acpi_operand_object *region_obj, - node = node->parent; - } - -- /* If we get here, there is no handler for this region */ -- -+ /* -+ * If we get here, there is no handler for this region. This is not -+ * fatal because many regions get created before a handler is installed -+ * for said region. -+ */ - ACPI_DEBUG_PRINT((ACPI_DB_OPREGION, - "No handler for RegionType %s(%X) (RegionObj %p)\n", - acpi_ut_get_region_name(space_id), space_id, - region_obj)); - -- return_ACPI_STATUS(AE_NOT_EXIST); -+ return_ACPI_STATUS(AE_OK); - } --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/acpi-do-not-warn-if-_BQC-does-not-exist.patch b/kernel/tools/cpupowertools/files/patches/mageia/acpi-do-not-warn-if-_BQC-does-not-exist.patch deleted file mode 100644 index 4078a1ec..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/acpi-do-not-warn-if-_BQC-does-not-exist.patch +++ /dev/null @@ -1,39 +0,0 @@ -From 7020bcb82838006e23d058ff07b063b393ed3f10 Mon Sep 17 00:00:00 2001 -From: Zhang Rui -Date: Tue, 29 Nov 2016 23:19:46 +0100 -Subject: [PATCH] ACPI: do not warn if _BQC does not exist - -Starting from ACPI spec 3.0, it's only clarified that _BCM control -method is required if _BCL is implemented. There is no word -saying _BQC is required. - -And in ACPI spec 6.1 B.5.4, for _BQC, it is explicitly stated that -"This optional method returns the current brightness level of a -built-in display output device. If present, it must be set by -the platform for initial brightness." - -Thus remove the obsolete warning message. - -Signed-off-by: Zhang Rui -Signed-off-by: Rafael J. Wysocki ---- - drivers/acpi/scan.c | 3 --- - 1 file changed, 3 deletions(-) - -diff --git a/drivers/acpi/scan.c b/drivers/acpi/scan.c -index 3d1856f..07aa2e6 100644 ---- a/drivers/acpi/scan.c -+++ b/drivers/acpi/scan.c -@@ -1119,9 +1119,6 @@ acpi_backlight_cap_match(acpi_handle handle, u32 level, void *context, - ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found generic backlight " - "support\n")); - *cap |= ACPI_VIDEO_BACKLIGHT; -- if (!acpi_has_method(handle, "_BQC")) -- printk(KERN_WARNING FW_BUG PREFIX "No _BQC method, " -- "cannot determine initial brightness\n"); - /* We have backlight support, no need to scan further */ - return AE_CTRL_TERMINATE; - } --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/acpi-ec-restore-polling-during-noirq-suspend_resume-phases.patch b/kernel/tools/cpupowertools/files/patches/mageia/acpi-ec-restore-polling-during-noirq-suspend_resume-phases.patch new file mode 100644 index 00000000..df41e9dc --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/acpi-ec-restore-polling-during-noirq-suspend_resume-phases.patch @@ -0,0 +1,49 @@ +From: "Rafael J. Wysocki" +Subject: [PATCH] ACPI / EC: Restore polling during noirq suspend/resume phases +Date: Fri, 09 Feb 2018 22:55:28 +0100 + +From: Rafael J. Wysocki + +Commit 662591461c4b (ACPI / EC: Drop EC noirq hooks to fix a +regression) modified the ACPI EC driver so that it doesn't switch +over to busy polling mode during noirq stages of system suspend and +resume in an attempt to fix an issue resulting from that behavior. + +However, that modification introduced a system resume regression on +Thinkpad X240, so make the EC driver switch over to the polling mode +during noirq stages of system suspend and resume again, which +effectively reverts the problematic commit. + +Fixes: 662591461c4b (ACPI / EC: Drop EC noirq hooks to fix a regression) +Link: https://bugzilla.kernel.org/show_bug.cgi?id=197863 +Reported-by: Markus Demleitner +Tested-by: Markus Demleitner +Signed-off-by: Rafael J. Wysocki +--- + drivers/acpi/ec.c | 6 ++++++ + 1 file changed, 6 insertions(+) + +Index: linux-pm/drivers/acpi/ec.c +=================================================================== +--- linux-pm.orig/drivers/acpi/ec.c ++++ linux-pm/drivers/acpi/ec.c +@@ -1927,6 +1927,9 @@ static int acpi_ec_suspend_noirq(struct + ec->reference_count >= 1) + acpi_set_gpe(NULL, ec->gpe, ACPI_GPE_DISABLE); + ++ if (acpi_sleep_no_ec_events()) ++ acpi_ec_enter_noirq(ec); ++ + return 0; + } + +@@ -1934,6 +1937,9 @@ static int acpi_ec_resume_noirq(struct d + { + struct acpi_ec *ec = acpi_driver_data(to_acpi_device(dev)); + ++ if (acpi_sleep_no_ec_events()) ++ acpi_ec_leave_noirq(ec); ++ + if (ec_no_wakeup && test_bit(EC_FLAGS_STARTED, &ec->flags) && + ec->reference_count >= 1) + acpi_set_gpe(NULL, ec->gpe, ACPI_GPE_ENABLE); diff --git a/kernel/tools/cpupowertools/files/patches/mageia/base-cacheinfo-silence-DT-warnings.patch b/kernel/tools/cpupowertools/files/patches/mageia/base-cacheinfo-silence-DT-warnings.patch deleted file mode 100644 index 241453ab..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/base-cacheinfo-silence-DT-warnings.patch +++ /dev/null @@ -1,49 +0,0 @@ - -Devicetree is enabled on 32bit kernels for OLPC support, -but this causes error messages: - -'Failed to find cpu0 device node' that breaks bootsplash. - -https://bugs.mageia.org/show_bug.cgi?id=16655#c39 -https://bugs.mageia.org/show_bug.cgi?id=17010 - -So hide them behind debug for cleaner boot. - -Signed-off-by: Thomas Backlund - - ---- linux/drivers/base/cacheinfo.c.orig -+++ linux/drivers/base/cacheinfo.c -@@ -53,12 +53,12 @@ - return 0; - - if (!cpu_dev) { -- pr_err("No cpu device for CPU %d\n", cpu); -+ pr_debug("No cpu device for CPU %d\n", cpu); - return -ENODEV; - } - np = cpu_dev->of_node; - if (!np) { -- pr_err("Failed to find cpu%d device node\n", cpu); -+ pr_debug("Failed to find cpu%d device node\n", cpu); - return -ENOENT; - } - -@@ -203,7 +203,7 @@ - */ - ret = cache_shared_cpu_map_setup(cpu); - if (ret) { -- pr_warn("Unable to detect cache hierarchy from DT for CPU %d\n", -+ pr_debug("Unable to detect cache hierarchy from DT for CPU %d\n", - cpu); - goto free_ci; - } -@@ -540,7 +540,7 @@ - rc = cache_add_dev(cpu); - if (rc) { - free_cache_attributes(cpu); -- pr_err("error populating cacheinfo..cpu%d\n", cpu); -+ pr_debug("error populating cacheinfo..cpu%d\n", cpu); - goto out; - } - } diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-Make-CFQ-default-to-IOPS-mode-on-SSDs.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-Make-CFQ-default-to-IOPS-mode-on-SSDs.patch deleted file mode 100644 index b26bf714..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/block-Make-CFQ-default-to-IOPS-mode-on-SSDs.patch +++ /dev/null @@ -1,58 +0,0 @@ -From 41c0126b3f22ef36b97b3c38b8f29569848a5ce2 Mon Sep 17 00:00:00 2001 -From: Tahsin Erdogan -Date: Tue, 19 May 2015 13:55:21 -0700 -Subject: block: Make CFQ default to IOPS mode on SSDs - -CFQ idling causes reduced IOPS throughput on non-rotational disks. -Since disk head seeking is not applicable to SSDs, it doesn't really -help performance by anticipating future near-by IO requests. - -By turning off idling (and switching to IOPS mode), we allow other -processes to dispatch IO requests down to the driver and so increase IO -throughput. - -Following FIO benchmark results were taken on a cloud SSD offering with -idling on and off: - -Idling iops avg-lat(ms) stddev bw ------------------------------------------------------- - On 7054 90.107 38.697 28217KB/s - Off 29255 21.836 11.730 117022KB/s - -fio --name=temp --size=100G --time_based --ioengine=libaio \ - --randrepeat=0 --direct=1 --invalidate=1 --verify=0 \ - --verify_fatal=0 --rw=randread --blocksize=4k --group_reporting=1 \ - --filename=/dev/sdb --runtime=10 --iodepth=64 --numjobs=10 - -And the following is from a local SSD run: - -Idling iops avg-lat(ms) stddev bw ------------------------------------------------------- - On 19320 33.043 14.068 77281KB/s - Off 21626 29.465 12.662 86507KB/s - -fio --name=temp --size=5G --time_based --ioengine=libaio \ - --randrepeat=0 --direct=1 --invalidate=1 --verify=0 \ - --verify_fatal=0 --rw=randread --blocksize=4k --group_reporting=1 \ - --filename=/fio_data --runtime=10 --iodepth=64 --numjobs=10 - -Reviewed-by: Nauman Rafique -Signed-off-by: Tahsin Erdogan -Signed-off-by: Jens Axboe - -diff --git a/block/cfq-iosched.c b/block/cfq-iosched.c -index 5da8e6e..402be01 100644 ---- a/block/cfq-iosched.c -+++ b/block/cfq-iosched.c -@@ -4460,7 +4460,7 @@ static int cfq_init_queue(struct request_queue *q, struct elevator_type *e) - cfqd->cfq_slice[1] = cfq_slice_sync; - cfqd->cfq_target_latency = cfq_target_latency; - cfqd->cfq_slice_async_rq = cfq_slice_async_rq; -- cfqd->cfq_slice_idle = cfq_slice_idle; -+ cfqd->cfq_slice_idle = blk_queue_nonrot(q) ? 0 : cfq_slice_idle; - cfqd->cfq_group_idle = cfq_group_idle; - cfqd->cfq_latency = 1; - cfqd->hw_tag = -1; --- -cgit v0.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-Turn-into-BFQ-v8r7-for-4.9.0.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-Turn-into-BFQ-v8r7-for-4.9.0.patch deleted file mode 100644 index 5a5307fa..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/block-Turn-into-BFQ-v8r7-for-4.9.0.patch +++ /dev/null @@ -1,9128 +0,0 @@ -From 0432a5c7bfc4a11531c1e58f574c733a2552f149 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Tue, 17 May 2016 08:28:04 +0200 -Subject: [PATCH 4/4] Turn into BFQ-v8r7 for 4.9.0 - -CHANGELOG from v8r4 to v8r7 - -BFQ v8r7 - -BUGFIX: make BFQ compile also without hierarchical support - -BFQ v8r6 - -BUGFIX Removed the check that, when the new queue to set in service -must be selected, the cached next_in_service entities coincide with -the entities chosen by __bfq_lookup_next_entity. This check, -issuing a warning on failure, was wrong, because the cached and the -newly chosen entity could differ in case of a CLASS_IDLE timeout. - -EFFICIENCY IMPROVEMENT (this improvement is related to the above -BUGFIX) The cached next_in_service entities are now really used to -select the next queue to serve when the in-service queue -expires. Before this change, the cached values were used only for -extra (and in general wrong) consistency checks. This caused -additional overhead instead of reducing it. - -EFFICIENCY IMPROVEMENT The next entity to serve, for each level of the -hierarchy, is now updated on every event that may change it, i.e., on -every activation or deactivation of any entity. This finer granularity -is not strictly needed for corectness, because it is only on queue -expirations that BFQ needs to know what are the next entities to -serve. Yet this change makes it possible to implement optimizations in -which it is necessary to know the next queue to serve before the -in-service queue expires. - -SERVICE-ACCURACY IMPROVEMENT The per-device CLASS_IDLE service timeout -has been turned into a much more accurate per-group timeout. - -CODE-QUALITY IMPROVEMENT The non-trivial parts touched by the above -improvements have been partially rewritten, and enriched of comments, -so as to improve their transparency and understandability. - -IMPROVEMENT Ported and improved CFQ commit 41647e7a -Before this improvememtn, BFQ used the same logic for detecting -seeky queues for rotational disks and SSDs. This logic is appropriate -for the former, as it takes into account only inter-request distance, -and the latter is the dominant latency factor on a rotational device. -Yet things change with flash-based devices, where serving a large -request still yields a high throughput, even the request is far -from the previous request served. This commits extends seeky -detection to take into accoutn also this fact with flash-based -devices. In particular, this commit is an improved port of the -original commit 41647e7a for CFQ. - -CODE IMPROVEMENT Remove useless parameter from bfq_del_bfqq_busy - -OPTIMIZATION Optimize the update of next_in_service entity. -If the update of the next_in_service candidate entity is triggered by -the activation of an entity, then it is not necessary to perform full -lookups in the active trees to update next_in_service. In fact, it is -enough to check whether the just-activated entity has a higher -priority than next_in_service, or, even if it has the same priority as -next_in_service, is eligible and has a lower virtual finish time than -next_in_service. If this compound condition holds, then the new entity -can be set as the new next_in_service. Otherwise no change is needed. -This commit implements this optimization. - -BUGFIX Fix bug causing occasional loss of weight raising. -When a bfq_queue, say bfqq, is split after a merging with another -bfq_queue, BFQ checks whether it has to restore for bfqq the -weight-raising state that bfqq had before being merged. In -particular, the weight-raising is restored only if, according to the -weight-raising duration decided for bfqq when it started to be -weight-raised (before being merged), bfqq would not have already -finished its weight-raising period. -Yet, by mistake, such a duration was not saved when bfqq is merged. So, -if bfqq was freed and reallocated when it was split, then this duration -was wrongly set to zero on the split. As a consequence, the -weight-raising state of bfqq was wrongly not restored, which caused BFQ -to fail in guaranteeing a low latency to bfqq. -This commit fixes this bug by saving weight-raising duration when bfqq -is merged, and correctly restoring it when bfqq is split. - -BUGFIX Fix wrong reset of in-service entities -In-service entities were reset with an indirect logic, which -happened to be even buggy for some cases. This commit fixes -this bug in two important steps. First, by replacing this -indirect logic with a direct logic, in which all involved -entities are immediately reset, with a bubble-up loop, when -the in-service queue is reset. Second, by restructuring the -code related to this change, so as to become not only correct -with respect to this change, but also cleaner and hopefully -clearer. - -CODE IMPROVEMENT Add code to be able to redirect trace log to -console. - -BUGFIX Fixed bug in optimized update of next_in_service entity. -There was a case where bfq_update_next_in_service did not update -next_in_service, even if it might need to be changed: in case of -requeueing or repositioning of the entity that happened to be -pointed exactly by next_in_service. This could result in violation -of service guarantees, because, after a change of timestamps for -such an entity, it might be the case that next_in_service had to -point to a different entity. This commit fixes this bug. - -OPTIMIZATION Stop bubble-up of next_in_service update if possible. - -BUGFIX Fixed a false-positive warning for uninitialized var - -BFQ-v8r5 - -DOCUMENTATION IMPROVEMENT Added documentation of BFQ -benefits, inner workings, interface and tunables. - -BUGFIX: Replaced max wrongly used for modulo numbers. - -DOCUMENTATION IMPROVEMENT Improved help message in -Kconfig.iosched. - -BUGFIX: Removed wrong conversion in use of bfq_fifo_expire. - -CODE IMPROVEMENT Added parentheses to complex macros. - -Signed-off-by: Paolo Valente ---- - Documentation/block/00-INDEX | 2 + - Documentation/block/bfq-iosched.txt | 530 ++++++ - block/Kconfig.iosched | 18 +- - block/bfq-cgroup.c | 501 +++--- - block/bfq-iosched.c | 3278 ++++++++++++++++++++++------------- - block/bfq-sched.c | 1288 +++++++++++--- - block/bfq.h | 800 +++++---- - 7 files changed, 4320 insertions(+), 2097 deletions(-) - create mode 100644 Documentation/block/bfq-iosched.txt - -diff --git a/Documentation/block/00-INDEX b/Documentation/block/00-INDEX -index e55103a..8d55b4b 100644 ---- a/Documentation/block/00-INDEX -+++ b/Documentation/block/00-INDEX -@@ -1,5 +1,7 @@ - 00-INDEX - - This file -+bfq-iosched.txt -+ - BFQ IO scheduler and its tunables - biodoc.txt - - Notes on the Generic Block Layer Rewrite in Linux 2.5 - biovecs.txt -diff --git a/Documentation/block/bfq-iosched.txt b/Documentation/block/bfq-iosched.txt -new file mode 100644 -index 0000000..13b5248 ---- /dev/null -+++ b/Documentation/block/bfq-iosched.txt -@@ -0,0 +1,530 @@ -+BFQ (Budget Fair Queueing) -+========================== -+ -+BFQ is a proportional-share I/O scheduler, with some extra -+low-latency capabilities. In addition to cgroups support (blkio or io -+controllers), BFQ's main features are: -+- BFQ guarantees a high system and application responsiveness, and a -+ low latency for time-sensitive applications, such as audio or video -+ players; -+- BFQ distributes bandwidth, and not just time, among processes or -+ groups (switching back to time distribution when needed to keep -+ throughput high). -+ -+On average CPUs, the current version of BFQ can handle devices -+performing at most ~30K IOPS; at most ~50 KIOPS on faster CPUs. As a -+reference, 30-50 KIOPS correspond to very high bandwidths with -+sequential I/O (e.g., 8-12 GB/s if I/O requests are 256 KB large), and -+to 120-200 MB/s with 4KB random I/O. -+ -+The table of contents follow. Impatients can just jump to Section 3. -+ -+CONTENTS -+ -+1. When may BFQ be useful? -+ 1-1 Personal systems -+ 1-2 Server systems -+2. How does BFQ work? -+3. What are BFQ's tunable? -+4. BFQ group scheduling -+ 4-1 Service guarantees provided -+ 4-2 Interface -+ -+1. When may BFQ be useful? -+========================== -+ -+BFQ provides the following benefits on personal and server systems. -+ -+1-1 Personal systems -+-------------------- -+ -+Low latency for interactive applications -+ -+Regardless of the actual background workload, BFQ guarantees that, for -+interactive tasks, the storage device is virtually as responsive as if -+it was idle. For example, even if one or more of the following -+background workloads are being executed: -+- one or more large files are being read, written or copied, -+- a tree of source files is being compiled, -+- one or more virtual machines are performing I/O, -+- a software update is in progress, -+- indexing daemons are scanning filesystems and updating their -+ databases, -+starting an application or loading a file from within an application -+takes about the same time as if the storage device was idle. As a -+comparison, with CFQ, NOOP or DEADLINE, and in the same conditions, -+applications experience high latencies, or even become unresponsive -+until the background workload terminates (also on SSDs). -+ -+Low latency for soft real-time applications -+ -+Also soft real-time applications, such as audio and video -+players/streamers, enjoy a low latency and a low drop rate, regardless -+of the background I/O workload. As a consequence, these applications -+do not suffer from almost any glitch due to the background workload. -+ -+Higher speed for code-development tasks -+ -+If some additional workload happens to be executed in parallel, then -+BFQ executes the I/O-related components of typical code-development -+tasks (compilation, checkout, merge, ...) much more quickly than CFQ, -+NOOP or DEADLINE. -+ -+High throughput -+ -+On hard disks, BFQ achieves up to 30% higher throughput than CFQ, and -+up to 150% higher throughput than DEADLINE and NOOP, with all the -+sequential workloads considered in our tests. With random workloads, -+and with all the workloads on flash-based devices, BFQ achieves, -+instead, about the same throughput as the other schedulers. -+ -+Strong fairness, bandwidth and delay guarantees -+ -+BFQ distributes the device throughput, and not just the device time, -+among I/O-bound applications in proportion their weights, with any -+workload and regardless of the device parameters. From these bandwidth -+guarantees, it is possible to compute tight per-I/O-request delay -+guarantees by a simple formula. If not configured for strict service -+guarantees, BFQ switches to time-based resource sharing (only) for -+applications that would otherwise cause a throughput loss. -+ -+1-2 Server systems -+------------------ -+ -+Most benefits for server systems follow from the same service -+properties as above. In particular, regardless of whether additional, -+possibly heavy workloads are being served, BFQ guarantees: -+ -+. audio and video-streaming with zero or very low jitter and drop -+ rate; -+ -+. fast retrieval of WEB pages and embedded objects; -+ -+. real-time recording of data in live-dumping applications (e.g., -+ packet logging); -+ -+. responsiveness in local and remote access to a server. -+ -+ -+2. How does BFQ work? -+===================== -+ -+BFQ is a proportional-share I/O scheduler, whose general structure, -+plus a lot of code, are borrowed from CFQ. -+ -+- Each process doing I/O on a device is associated with a weight and a -+ (bfq_)queue. -+ -+- BFQ grants exclusive access to the device, for a while, to one queue -+ (process) at a time, and implements this service model by -+ associating every queue with a budget, measured in number of -+ sectors. -+ -+ - After a queue is granted access to the device, the budget of the -+ queue is decremented, on each request dispatch, by the size of the -+ request. -+ -+ - The in-service queue is expired, i.e., its service is suspended, -+ only if one of the following events occurs: 1) the queue finishes -+ its budget, 2) the queue empties, 3) a "budget timeout" fires. -+ -+ - The budget timeout prevents processes doing random I/O from -+ holding the device for too long and dramatically reducing -+ throughput. -+ -+ - Actually, as in CFQ, a queue associated with a process issuing -+ sync requests may not be expired immediately when it empties. In -+ contrast, BFQ may idle the device for a short time interval, -+ giving the process the chance to go on being served if it issues -+ a new request in time. Device idling typically boosts the -+ throughput on rotational devices, if processes do synchronous -+ and sequential I/O. In addition, under BFQ, device idling is -+ also instrumental in guaranteeing the desired throughput -+ fraction to processes issuing sync requests (see the description -+ of the slice_idle tunable in this document, or [1, 2], for more -+ details). -+ -+ - With respect to idling for service guarantees, if several -+ processes are competing for the device at the same time, but -+ all processes (and groups, after the following commit) have -+ the same weight, then BFQ guarantees the expected throughput -+ distribution without ever idling the device. Throughput is -+ thus as high as possible in this common scenario. -+ -+ - If low-latency mode is enabled (default configuration), BFQ -+ executes some special heuristics to detect interactive and soft -+ real-time applications (e.g., video or audio players/streamers), -+ and to reduce their latency. The most important action taken to -+ achieve this goal is to give to the queues associated with these -+ applications more than their fair share of the device -+ throughput. For brevity, we call just "weight-raising" the whole -+ sets of actions taken by BFQ to privilege these queues. In -+ particular, BFQ provides a milder form of weight-raising for -+ interactive applications, and a stronger form for soft real-time -+ applications. -+ -+ - BFQ automatically deactivates idling for queues born in a burst of -+ queue creations. In fact, these queues are usually associated with -+ the processes of applications and services that benefit mostly -+ from a high throughput. Examples are systemd during boot, or git -+ grep. -+ -+ - As CFQ, BFQ merges queues performing interleaved I/O, i.e., -+ performing random I/O that becomes mostly sequential if -+ merged. Differently from CFQ, BFQ achieves this goal with a more -+ reactive mechanism, called Early Queue Merge (EQM). EQM is so -+ responsive in detecting interleaved I/O (cooperating processes), -+ that it enables BFQ to achieve a high throughput, by queue -+ merging, even for queues for which CFQ needs a different -+ mechanism, preemption, to get a high throughput. As such EQM is a -+ unified mechanism to achieve a high throughput with interleaved -+ I/O. -+ -+ - Queues are scheduled according to a variant of WF2Q+, named -+ B-WF2Q+, and implemented using an augmented rb-tree to preserve an -+ O(log N) overall complexity. See [2] for more details. B-WF2Q+ is -+ also ready for hierarchical scheduling. However, for a cleaner -+ logical breakdown, the code that enables and completes -+ hierarchical support is provided in the next commit, which focuses -+ exactly on this feature. -+ -+ - B-WF2Q+ guarantees a tight deviation with respect to an ideal, -+ perfectly fair, and smooth service. In particular, B-WF2Q+ -+ guarantees that each queue receives a fraction of the device -+ throughput proportional to its weight, even if the throughput -+ fluctuates, and regardless of: the device parameters, the current -+ workload and the budgets assigned to the queue. -+ -+ - The last, budget-independence, property (although probably -+ counterintuitive in the first place) is definitely beneficial, for -+ the following reasons: -+ -+ - First, with any proportional-share scheduler, the maximum -+ deviation with respect to an ideal service is proportional to -+ the maximum budget (slice) assigned to queues. As a consequence, -+ BFQ can keep this deviation tight not only because of the -+ accurate service of B-WF2Q+, but also because BFQ *does not* -+ need to assign a larger budget to a queue to let the queue -+ receive a higher fraction of the device throughput. -+ -+ - Second, BFQ is free to choose, for every process (queue), the -+ budget that best fits the needs of the process, or best -+ leverages the I/O pattern of the process. In particular, BFQ -+ updates queue budgets with a simple feedback-loop algorithm that -+ allows a high throughput to be achieved, while still providing -+ tight latency guarantees to time-sensitive applications. When -+ the in-service queue expires, this algorithm computes the next -+ budget of the queue so as to: -+ -+ - Let large budgets be eventually assigned to the queues -+ associated with I/O-bound applications performing sequential -+ I/O: in fact, the longer these applications are served once -+ got access to the device, the higher the throughput is. -+ -+ - Let small budgets be eventually assigned to the queues -+ associated with time-sensitive applications (which typically -+ perform sporadic and short I/O), because, the smaller the -+ budget assigned to a queue waiting for service is, the sooner -+ B-WF2Q+ will serve that queue (Subsec 3.3 in [2]). -+ -+- If several processes are competing for the device at the same time, -+ but all processes and groups have the same weight, then BFQ -+ guarantees the expected throughput distribution without ever idling -+ the device. It uses preemption instead. Throughput is then much -+ higher in this common scenario. -+ -+- ioprio classes are served in strict priority order, i.e., -+ lower-priority queues are not served as long as there are -+ higher-priority queues. Among queues in the same class, the -+ bandwidth is distributed in proportion to the weight of each -+ queue. A very thin extra bandwidth is however guaranteed to -+ the Idle class, to prevent it from starving. -+ -+ -+3. What are BFQ's tunable? -+========================== -+ -+The tunables back_seek-max, back_seek_penalty, fifo_expire_async and -+fifo_expire_sync below are the same as in CFQ. Their description is -+just copied from that for CFQ. Some considerations in the description -+of slice_idle are copied from CFQ too. -+ -+per-process ioprio and weight -+----------------------------- -+ -+Unless the cgroups interface is used (see "4. BFQ group scheduling"), -+weights can be assigned to processes only indirectly, through I/O -+priorities, and according to the relation: -+weight = (IOPRIO_BE_NR - ioprio) * 10. -+ -+Beware that, if low-latency is set, then BFQ automatically raises the -+weight of the queues associated with interactive and soft real-time -+applications. Unset this tunable if you need/want to control weights. -+ -+slice_idle -+---------- -+ -+This parameter specifies how long BFQ should idle for next I/O -+request, when certain sync BFQ queues become empty. By default -+slice_idle is a non-zero value. Idling has a double purpose: boosting -+throughput and making sure that the desired throughput distribution is -+respected (see the description of how BFQ works, and, if needed, the -+papers referred there). -+ -+As for throughput, idling can be very helpful on highly seeky media -+like single spindle SATA/SAS disks where we can cut down on overall -+number of seeks and see improved throughput. -+ -+Setting slice_idle to 0 will remove all the idling on queues and one -+should see an overall improved throughput on faster storage devices -+like multiple SATA/SAS disks in hardware RAID configuration. -+ -+So depending on storage and workload, it might be useful to set -+slice_idle=0. In general for SATA/SAS disks and software RAID of -+SATA/SAS disks keeping slice_idle enabled should be useful. For any -+configurations where there are multiple spindles behind single LUN -+(Host based hardware RAID controller or for storage arrays), setting -+slice_idle=0 might end up in better throughput and acceptable -+latencies. -+ -+Idling is however necessary to have service guarantees enforced in -+case of differentiated weights or differentiated I/O-request lengths. -+To see why, suppose that a given BFQ queue A must get several I/O -+requests served for each request served for another queue B. Idling -+ensures that, if A makes a new I/O request slightly after becoming -+empty, then no request of B is dispatched in the middle, and thus A -+does not lose the possibility to get more than one request dispatched -+before the next request of B is dispatched. Note that idling -+guarantees the desired differentiated treatment of queues only in -+terms of I/O-request dispatches. To guarantee that the actual service -+order then corresponds to the dispatch order, the strict_guarantees -+tunable must be set too. -+ -+There is an important flipside for idling: apart from the above cases -+where it is beneficial also for throughput, idling can severely impact -+throughput. One important case is random workload. Because of this -+issue, BFQ tends to avoid idling as much as possible, when it is not -+beneficial also for throughput. As a consequence of this behavior, and -+of further issues described for the strict_guarantees tunable, -+short-term service guarantees may be occasionally violated. And, in -+some cases, these guarantees may be more important than guaranteeing -+maximum throughput. For example, in video playing/streaming, a very -+low drop rate may be more important than maximum throughput. In these -+cases, consider setting the strict_guarantees parameter. -+ -+strict_guarantees -+----------------- -+ -+If this parameter is set (default: unset), then BFQ -+ -+- always performs idling when the in-service queue becomes empty; -+ -+- forces the device to serve one I/O request at a time, by dispatching a -+ new request only if there is no outstanding request. -+ -+In the presence of differentiated weights or I/O-request sizes, both -+the above conditions are needed to guarantee that every BFQ queue -+receives its allotted share of the bandwidth. The first condition is -+needed for the reasons explained in the description of the slice_idle -+tunable. The second condition is needed because all modern storage -+devices reorder internally-queued requests, which may trivially break -+the service guarantees enforced by the I/O scheduler. -+ -+Setting strict_guarantees may evidently affect throughput. -+ -+back_seek_max -+------------- -+ -+This specifies, given in Kbytes, the maximum "distance" for backward seeking. -+The distance is the amount of space from the current head location to the -+sectors that are backward in terms of distance. -+ -+This parameter allows the scheduler to anticipate requests in the "backward" -+direction and consider them as being the "next" if they are within this -+distance from the current head location. -+ -+back_seek_penalty -+----------------- -+ -+This parameter is used to compute the cost of backward seeking. If the -+backward distance of request is just 1/back_seek_penalty from a "front" -+request, then the seeking cost of two requests is considered equivalent. -+ -+So scheduler will not bias toward one or the other request (otherwise scheduler -+will bias toward front request). Default value of back_seek_penalty is 2. -+ -+fifo_expire_async -+----------------- -+ -+This parameter is used to set the timeout of asynchronous requests. Default -+value of this is 248ms. -+ -+fifo_expire_sync -+---------------- -+ -+This parameter is used to set the timeout of synchronous requests. Default -+value of this is 124ms. In case to favor synchronous requests over asynchronous -+one, this value should be decreased relative to fifo_expire_async. -+ -+low_latency -+----------- -+ -+This parameter is used to enable/disable BFQ's low latency mode. By -+default, low latency mode is enabled. If enabled, interactive and soft -+real-time applications are privileged and experience a lower latency, -+as explained in more detail in the description of how BFQ works. -+ -+DO NOT enable this mode if you need full control on bandwidth -+distribution. In fact, if it is enabled, then BFQ automatically -+increases the bandwidth share of privileged applications, as the main -+means to guarantee a lower latency to them. -+ -+timeout_sync -+------------ -+ -+Maximum amount of device time that can be given to a task (queue) once -+it has been selected for service. On devices with costly seeks, -+increasing this time usually increases maximum throughput. On the -+opposite end, increasing this time coarsens the granularity of the -+short-term bandwidth and latency guarantees, especially if the -+following parameter is set to zero. -+ -+max_budget -+---------- -+ -+Maximum amount of service, measured in sectors, that can be provided -+to a BFQ queue once it is set in service (of course within the limits -+of the above timeout). According to what said in the description of -+the algorithm, larger values increase the throughput in proportion to -+the percentage of sequential I/O requests issued. The price of larger -+values is that they coarsen the granularity of short-term bandwidth -+and latency guarantees. -+ -+The default value is 0, which enables auto-tuning: BFQ sets max_budget -+to the maximum number of sectors that can be served during -+timeout_sync, according to the estimated peak rate. -+ -+weights -+------- -+ -+Read-only parameter, used to show the weights of the currently active -+BFQ queues. -+ -+ -+wr_ tunables -+------------ -+ -+BFQ exports a few parameters to control/tune the behavior of -+low-latency heuristics. -+ -+wr_coeff -+ -+Factor by which the weight of a weight-raised queue is multiplied. If -+the queue is deemed soft real-time, then the weight is further -+multiplied by an additional, constant factor. -+ -+wr_max_time -+ -+Maximum duration of a weight-raising period for an interactive task -+(ms). If set to zero (default value), then this value is computed -+automatically, as a function of the peak rate of the device. In any -+case, when the value of this parameter is read, it always reports the -+current duration, regardless of whether it has been set manually or -+computed automatically. -+ -+wr_max_softrt_rate -+ -+Maximum service rate below which a queue is deemed to be associated -+with a soft real-time application, and is then weight-raised -+accordingly (sectors/sec). -+ -+wr_min_idle_time -+ -+Minimum idle period after which interactive weight-raising may be -+reactivated for a queue (in ms). -+ -+wr_rt_max_time -+ -+Maximum weight-raising duration for soft real-time queues (in ms). The -+start time from which this duration is considered is automatically -+moved forward if the queue is detected to be still soft real-time -+before the current soft real-time weight-raising period finishes. -+ -+wr_min_inter_arr_async -+ -+Minimum period between I/O request arrivals after which weight-raising -+may be reactivated for an already busy async queue (in ms). -+ -+ -+4. Group scheduling with BFQ -+============================ -+ -+BFQ supports both cgroups-v1 and cgroups-v2 io controllers, namely -+blkio and io. In particular, BFQ supports weight-based proportional -+share. To activate cgroups support, set BFQ_GROUP_IOSCHED. -+ -+4-1 Service guarantees provided -+------------------------------- -+ -+With BFQ, proportional share means true proportional share of the -+device bandwidth, according to group weights. For example, a group -+with weight 200 gets twice the bandwidth, and not just twice the time, -+of a group with weight 100. -+ -+BFQ supports hierarchies (group trees) of any depth. Bandwidth is -+distributed among groups and processes in the expected way: for each -+group, the children of the group share the whole bandwidth of the -+group in proportion to their weights. In particular, this implies -+that, for each leaf group, every process of the group receives the -+same share of the whole group bandwidth, unless the ioprio of the -+process is modified. -+ -+The resource-sharing guarantee for a group may partially or totally -+switch from bandwidth to time, if providing bandwidth guarantees to -+the group lowers the throughput too much. This switch occurs on a -+per-process basis: if a process of a leaf group causes throughput loss -+if served in such a way to receive its share of the bandwidth, then -+BFQ switches back to just time-based proportional share for that -+process. -+ -+4-2 Interface -+------------- -+ -+To get proportional sharing of bandwidth with BFQ for a given device, -+BFQ must of course be the active scheduler for that device. -+ -+Within each group directory, the names of the files associated with -+BFQ-specific cgroup parameters and stats begin with the "bfq." -+prefix. So, with cgroups-v1 or cgroups-v2, the full prefix for -+BFQ-specific files is "blkio.bfq." or "io.bfq." For example, the group -+parameter to set the weight of a group with BFQ is blkio.bfq.weight -+or io.bfq.weight. -+ -+Parameters to set -+----------------- -+ -+For each group, there is only the following parameter to set. -+ -+weight (namely blkio.bfq.weight or io.bfq-weight): the weight of the -+group inside its parent. Available values: 1..10000 (default 100). The -+linear mapping between ioprio and weights, described at the beginning -+of the tunable section, is still valid, but all weights higher than -+IOPRIO_BE_NR*10 are mapped to ioprio 0. -+ -+Recall that, if low-latency is set, then BFQ automatically raises the -+weight of the queues associated with interactive and soft real-time -+applications. Unset this tunable if you need/want to control weights. -+ -+ -+[1] P. Valente, A. Avanzini, "Evolution of the BFQ Storage I/O -+ Scheduler", Proceedings of the First Workshop on Mobile System -+ Technologies (MST-2015), May 2015. -+ http://algogroup.unimore.it/people/paolo/disk_sched/mst-2015.pdf -+ -+[2] P. Valente and M. Andreolini, "Improving Application -+ Responsiveness with the BFQ Disk I/O Scheduler", Proceedings of -+ the 5th Annual International Systems and Storage Conference -+ (SYSTOR '12), June 2012. -+ Slightly extended version: -+ http://algogroup.unimore.it/people/paolo/disk_sched/bfq-v1-suite- -+ results.pdf -diff --git a/block/Kconfig.iosched b/block/Kconfig.iosched -index f78cd1a..f2cd945 100644 ---- a/block/Kconfig.iosched -+++ b/block/Kconfig.iosched -@@ -43,20 +43,20 @@ config IOSCHED_BFQ - tristate "BFQ I/O scheduler" - default n - ---help--- -- The BFQ I/O scheduler tries to distribute bandwidth among -- all processes according to their weights. -- It aims at distributing the bandwidth as desired, independently of -- the disk parameters and with any workload. It also tries to -- guarantee low latency to interactive and soft real-time -- applications. If compiled built-in (saying Y here), BFQ can -- be configured to support hierarchical scheduling. -+ The BFQ I/O scheduler distributes bandwidth among all -+ processes according to their weights, regardless of the -+ device parameters and with any workload. It also guarantees -+ a low latency to interactive and soft real-time applications. -+ Details in Documentation/block/bfq-iosched.txt - - config BFQ_GROUP_IOSCHED - bool "BFQ hierarchical scheduling support" -- depends on CGROUPS && IOSCHED_BFQ=y -+ depends on IOSCHED_BFQ && BLK_CGROUP - default n - ---help--- -- Enable hierarchical scheduling in BFQ, using the blkio controller. -+ -+ Enable hierarchical scheduling in BFQ, using the blkio -+ (cgroups-v1) or io (cgroups-v2) controller. - - choice - prompt "Default I/O scheduler" -diff --git a/block/bfq-cgroup.c b/block/bfq-cgroup.c -index 0367996..bbaecd0 100644 ---- a/block/bfq-cgroup.c -+++ b/block/bfq-cgroup.c -@@ -7,7 +7,9 @@ - * Copyright (C) 2008 Fabio Checconi - * Paolo Valente - * -- * Copyright (C) 2010 Paolo Valente -+ * Copyright (C) 2015 Paolo Valente -+ * -+ * Copyright (C) 2016 Paolo Valente - * - * Licensed under the GPL-2 as detailed in the accompanying COPYING.BFQ - * file. -@@ -163,8 +165,6 @@ static struct bfq_group *blkg_to_bfqg(struct blkcg_gq *blkg) - { - struct blkg_policy_data *pd = blkg_to_pd(blkg, &blkcg_policy_bfq); - -- BUG_ON(!pd); -- - return pd_to_bfqg(pd); - } - -@@ -208,59 +208,49 @@ static void bfqg_put(struct bfq_group *bfqg) - - static void bfqg_stats_update_io_add(struct bfq_group *bfqg, - struct bfq_queue *bfqq, -- int rw) -+ int op, int op_flags) - { -- blkg_rwstat_add(&bfqg->stats.queued, rw, 1); -+ blkg_rwstat_add(&bfqg->stats.queued, op, op_flags, 1); - bfqg_stats_end_empty_time(&bfqg->stats); - if (!(bfqq == ((struct bfq_data *)bfqg->bfqd)->in_service_queue)) - bfqg_stats_set_start_group_wait_time(bfqg, bfqq_group(bfqq)); - } - --static void bfqg_stats_update_io_remove(struct bfq_group *bfqg, int rw) --{ -- blkg_rwstat_add(&bfqg->stats.queued, rw, -1); --} -- --static void bfqg_stats_update_io_merged(struct bfq_group *bfqg, int rw) -+static void bfqg_stats_update_io_remove(struct bfq_group *bfqg, int op, -+ int op_flags) - { -- blkg_rwstat_add(&bfqg->stats.merged, rw, 1); -+ blkg_rwstat_add(&bfqg->stats.queued, op, op_flags, -1); - } - --static void bfqg_stats_update_dispatch(struct bfq_group *bfqg, -- uint64_t bytes, int rw) -+static void bfqg_stats_update_io_merged(struct bfq_group *bfqg, int op, -+ int op_flags) - { -- blkg_stat_add(&bfqg->stats.sectors, bytes >> 9); -- blkg_rwstat_add(&bfqg->stats.serviced, rw, 1); -- blkg_rwstat_add(&bfqg->stats.service_bytes, rw, bytes); -+ blkg_rwstat_add(&bfqg->stats.merged, op, op_flags, 1); - } - - static void bfqg_stats_update_completion(struct bfq_group *bfqg, -- uint64_t start_time, uint64_t io_start_time, int rw) -+ uint64_t start_time, uint64_t io_start_time, int op, -+ int op_flags) - { - struct bfqg_stats *stats = &bfqg->stats; - unsigned long long now = sched_clock(); - - if (time_after64(now, io_start_time)) -- blkg_rwstat_add(&stats->service_time, rw, now - io_start_time); -+ blkg_rwstat_add(&stats->service_time, op, op_flags, -+ now - io_start_time); - if (time_after64(io_start_time, start_time)) -- blkg_rwstat_add(&stats->wait_time, rw, -+ blkg_rwstat_add(&stats->wait_time, op, op_flags, - io_start_time - start_time); - } - - /* @stats = 0 */ - static void bfqg_stats_reset(struct bfqg_stats *stats) - { -- if (!stats) -- return; -- - /* queued stats shouldn't be cleared */ -- blkg_rwstat_reset(&stats->service_bytes); -- blkg_rwstat_reset(&stats->serviced); - blkg_rwstat_reset(&stats->merged); - blkg_rwstat_reset(&stats->service_time); - blkg_rwstat_reset(&stats->wait_time); - blkg_stat_reset(&stats->time); -- blkg_stat_reset(&stats->unaccounted_time); - blkg_stat_reset(&stats->avg_queue_size_sum); - blkg_stat_reset(&stats->avg_queue_size_samples); - blkg_stat_reset(&stats->dequeue); -@@ -270,19 +260,16 @@ static void bfqg_stats_reset(struct bfqg_stats *stats) - } - - /* @to += @from */ --static void bfqg_stats_merge(struct bfqg_stats *to, struct bfqg_stats *from) -+static void bfqg_stats_add_aux(struct bfqg_stats *to, struct bfqg_stats *from) - { - if (!to || !from) - return; - - /* queued stats shouldn't be cleared */ -- blkg_rwstat_add_aux(&to->service_bytes, &from->service_bytes); -- blkg_rwstat_add_aux(&to->serviced, &from->serviced); - blkg_rwstat_add_aux(&to->merged, &from->merged); - blkg_rwstat_add_aux(&to->service_time, &from->service_time); - blkg_rwstat_add_aux(&to->wait_time, &from->wait_time); - blkg_stat_add_aux(&from->time, &from->time); -- blkg_stat_add_aux(&to->unaccounted_time, &from->unaccounted_time); - blkg_stat_add_aux(&to->avg_queue_size_sum, &from->avg_queue_size_sum); - blkg_stat_add_aux(&to->avg_queue_size_samples, - &from->avg_queue_size_samples); -@@ -311,10 +298,8 @@ static void bfqg_stats_xfer_dead(struct bfq_group *bfqg) - if (unlikely(!parent)) - return; - -- bfqg_stats_merge(&parent->dead_stats, &bfqg->stats); -- bfqg_stats_merge(&parent->dead_stats, &bfqg->dead_stats); -+ bfqg_stats_add_aux(&parent->stats, &bfqg->stats); - bfqg_stats_reset(&bfqg->stats); -- bfqg_stats_reset(&bfqg->dead_stats); - } - - static void bfq_init_entity(struct bfq_entity *entity, -@@ -329,21 +314,17 @@ static void bfq_init_entity(struct bfq_entity *entity, - bfqq->ioprio_class = bfqq->new_ioprio_class; - bfqg_get(bfqg); - } -- entity->parent = bfqg->my_entity; -+ entity->parent = bfqg->my_entity; /* NULL for root group */ - entity->sched_data = &bfqg->sched_data; - } - - static void bfqg_stats_exit(struct bfqg_stats *stats) - { -- blkg_rwstat_exit(&stats->service_bytes); -- blkg_rwstat_exit(&stats->serviced); - blkg_rwstat_exit(&stats->merged); - blkg_rwstat_exit(&stats->service_time); - blkg_rwstat_exit(&stats->wait_time); - blkg_rwstat_exit(&stats->queued); -- blkg_stat_exit(&stats->sectors); - blkg_stat_exit(&stats->time); -- blkg_stat_exit(&stats->unaccounted_time); - blkg_stat_exit(&stats->avg_queue_size_sum); - blkg_stat_exit(&stats->avg_queue_size_samples); - blkg_stat_exit(&stats->dequeue); -@@ -354,15 +335,11 @@ static void bfqg_stats_exit(struct bfqg_stats *stats) - - static int bfqg_stats_init(struct bfqg_stats *stats, gfp_t gfp) - { -- if (blkg_rwstat_init(&stats->service_bytes, gfp) || -- blkg_rwstat_init(&stats->serviced, gfp) || -- blkg_rwstat_init(&stats->merged, gfp) || -+ if (blkg_rwstat_init(&stats->merged, gfp) || - blkg_rwstat_init(&stats->service_time, gfp) || - blkg_rwstat_init(&stats->wait_time, gfp) || - blkg_rwstat_init(&stats->queued, gfp) || -- blkg_stat_init(&stats->sectors, gfp) || - blkg_stat_init(&stats->time, gfp) || -- blkg_stat_init(&stats->unaccounted_time, gfp) || - blkg_stat_init(&stats->avg_queue_size_sum, gfp) || - blkg_stat_init(&stats->avg_queue_size_samples, gfp) || - blkg_stat_init(&stats->dequeue, gfp) || -@@ -386,11 +363,27 @@ static struct bfq_group_data *blkcg_to_bfqgd(struct blkcg *blkcg) - return cpd_to_bfqgd(blkcg_to_cpd(blkcg, &blkcg_policy_bfq)); - } - -+static struct blkcg_policy_data *bfq_cpd_alloc(gfp_t gfp) -+{ -+ struct bfq_group_data *bgd; -+ -+ bgd = kzalloc(sizeof(*bgd), GFP_KERNEL); -+ if (!bgd) -+ return NULL; -+ return &bgd->pd; -+} -+ - static void bfq_cpd_init(struct blkcg_policy_data *cpd) - { - struct bfq_group_data *d = cpd_to_bfqgd(cpd); - -- d->weight = BFQ_DEFAULT_GRP_WEIGHT; -+ d->weight = cgroup_subsys_on_dfl(io_cgrp_subsys) ? -+ CGROUP_WEIGHT_DFL : BFQ_WEIGHT_LEGACY_DFL; -+} -+ -+static void bfq_cpd_free(struct blkcg_policy_data *cpd) -+{ -+ kfree(cpd_to_bfqgd(cpd)); - } - - static struct blkg_policy_data *bfq_pd_alloc(gfp_t gfp, int node) -@@ -401,8 +394,7 @@ static struct blkg_policy_data *bfq_pd_alloc(gfp_t gfp, int node) - if (!bfqg) - return NULL; - -- if (bfqg_stats_init(&bfqg->stats, gfp) || -- bfqg_stats_init(&bfqg->dead_stats, gfp)) { -+ if (bfqg_stats_init(&bfqg->stats, gfp)) { - kfree(bfqg); - return NULL; - } -@@ -410,27 +402,20 @@ static struct blkg_policy_data *bfq_pd_alloc(gfp_t gfp, int node) - return &bfqg->pd; - } - --static void bfq_group_set_parent(struct bfq_group *bfqg, -- struct bfq_group *parent) -+static void bfq_pd_init(struct blkg_policy_data *pd) - { -+ struct blkcg_gq *blkg; -+ struct bfq_group *bfqg; -+ struct bfq_data *bfqd; - struct bfq_entity *entity; -+ struct bfq_group_data *d; - -- BUG_ON(!parent); -- BUG_ON(!bfqg); -- BUG_ON(bfqg == parent); -- -+ blkg = pd_to_blkg(pd); -+ BUG_ON(!blkg); -+ bfqg = blkg_to_bfqg(blkg); -+ bfqd = blkg->q->elevator->elevator_data; - entity = &bfqg->entity; -- entity->parent = parent->my_entity; -- entity->sched_data = &parent->sched_data; --} -- --static void bfq_pd_init(struct blkg_policy_data *pd) --{ -- struct blkcg_gq *blkg = pd_to_blkg(pd); -- struct bfq_group *bfqg = blkg_to_bfqg(blkg); -- struct bfq_data *bfqd = blkg->q->elevator->elevator_data; -- struct bfq_entity *entity = &bfqg->entity; -- struct bfq_group_data *d = blkcg_to_bfqgd(blkg->blkcg); -+ d = blkcg_to_bfqgd(blkg->blkcg); - - entity->orig_weight = entity->weight = entity->new_weight = d->weight; - entity->my_sched_data = &bfqg->sched_data; -@@ -448,70 +433,53 @@ static void bfq_pd_free(struct blkg_policy_data *pd) - struct bfq_group *bfqg = pd_to_bfqg(pd); - - bfqg_stats_exit(&bfqg->stats); -- bfqg_stats_exit(&bfqg->dead_stats); -- - return kfree(bfqg); - } - --/* offset delta from bfqg->stats to bfqg->dead_stats */ --static const int dead_stats_off_delta = offsetof(struct bfq_group, dead_stats) - -- offsetof(struct bfq_group, stats); -- --/* to be used by recursive prfill, sums live and dead stats recursively */ --static u64 bfqg_stat_pd_recursive_sum(struct blkg_policy_data *pd, int off) -+static void bfq_pd_reset_stats(struct blkg_policy_data *pd) - { -- u64 sum = 0; -+ struct bfq_group *bfqg = pd_to_bfqg(pd); - -- sum += blkg_stat_recursive_sum(pd_to_blkg(pd), &blkcg_policy_bfq, off); -- sum += blkg_stat_recursive_sum(pd_to_blkg(pd), &blkcg_policy_bfq, -- off + dead_stats_off_delta); -- return sum; -+ bfqg_stats_reset(&bfqg->stats); - } - --/* to be used by recursive prfill, sums live and dead rwstats recursively */ --static struct blkg_rwstat --bfqg_rwstat_pd_recursive_sum(struct blkg_policy_data *pd, int off) -+static void bfq_group_set_parent(struct bfq_group *bfqg, -+ struct bfq_group *parent) - { -- struct blkg_rwstat a, b; -+ struct bfq_entity *entity; -+ -+ BUG_ON(!parent); -+ BUG_ON(!bfqg); -+ BUG_ON(bfqg == parent); - -- a = blkg_rwstat_recursive_sum(pd_to_blkg(pd), &blkcg_policy_bfq, off); -- b = blkg_rwstat_recursive_sum(pd_to_blkg(pd), &blkcg_policy_bfq, -- off + dead_stats_off_delta); -- blkg_rwstat_add_aux(&a, &b); -- return a; -+ entity = &bfqg->entity; -+ entity->parent = parent->my_entity; -+ entity->sched_data = &parent->sched_data; - } - --static void bfq_pd_reset_stats(struct blkg_policy_data *pd) -+static struct bfq_group *bfq_lookup_bfqg(struct bfq_data *bfqd, -+ struct blkcg *blkcg) - { -- struct bfq_group *bfqg = pd_to_bfqg(pd); -+ struct blkcg_gq *blkg; - -- bfqg_stats_reset(&bfqg->stats); -- bfqg_stats_reset(&bfqg->dead_stats); -+ blkg = blkg_lookup(blkcg, bfqd->queue); -+ if (likely(blkg)) -+ return blkg_to_bfqg(blkg); -+ return NULL; - } - --static struct bfq_group *bfq_find_alloc_group(struct bfq_data *bfqd, -- struct blkcg *blkcg) -+static struct bfq_group *bfq_find_set_group(struct bfq_data *bfqd, -+ struct blkcg *blkcg) - { -- struct request_queue *q = bfqd->queue; -- struct bfq_group *bfqg = NULL, *parent; -- struct bfq_entity *entity = NULL; -+ struct bfq_group *bfqg, *parent; -+ struct bfq_entity *entity; - - assert_spin_locked(bfqd->queue->queue_lock); - -- /* avoid lookup for the common case where there's no blkcg */ -- if (blkcg == &blkcg_root) { -- bfqg = bfqd->root_group; -- } else { -- struct blkcg_gq *blkg; -- -- blkg = blkg_lookup_create(blkcg, q); -- if (!IS_ERR(blkg)) -- bfqg = blkg_to_bfqg(blkg); -- else /* fallback to root_group */ -- bfqg = bfqd->root_group; -- } -+ bfqg = bfq_lookup_bfqg(bfqd, blkcg); - -- BUG_ON(!bfqg); -+ if (unlikely(!bfqg)) -+ return NULL; - - /* - * Update chain of bfq_groups as we might be handling a leaf group -@@ -537,11 +505,15 @@ static struct bfq_group *bfq_find_alloc_group(struct bfq_data *bfqd, - static void bfq_pos_tree_add_move(struct bfq_data *bfqd, - struct bfq_queue *bfqq); - -+static void bfq_bfqq_expire(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq, -+ bool compensate, -+ enum bfqq_expiration reason); -+ - /** - * bfq_bfqq_move - migrate @bfqq to @bfqg. - * @bfqd: queue descriptor. - * @bfqq: the queue to move. -- * @entity: @bfqq's entity. - * @bfqg: the group to move to. - * - * Move @bfqq to @bfqg, deactivating it from its old group and reactivating -@@ -552,26 +524,40 @@ static void bfq_pos_tree_add_move(struct bfq_data *bfqd, - * rcu_read_lock()). - */ - static void bfq_bfqq_move(struct bfq_data *bfqd, struct bfq_queue *bfqq, -- struct bfq_entity *entity, struct bfq_group *bfqg) -+ struct bfq_group *bfqg) - { -- int busy, resume; -+ struct bfq_entity *entity = &bfqq->entity; - -- busy = bfq_bfqq_busy(bfqq); -- resume = !RB_EMPTY_ROOT(&bfqq->sort_list); -- -- BUG_ON(resume && !entity->on_st); -- BUG_ON(busy && !resume && entity->on_st && -+ BUG_ON(!bfq_bfqq_busy(bfqq) && !RB_EMPTY_ROOT(&bfqq->sort_list)); -+ BUG_ON(!RB_EMPTY_ROOT(&bfqq->sort_list) && !entity->on_st); -+ BUG_ON(bfq_bfqq_busy(bfqq) && RB_EMPTY_ROOT(&bfqq->sort_list) -+ && entity->on_st && - bfqq != bfqd->in_service_queue); -+ BUG_ON(!bfq_bfqq_busy(bfqq) && bfqq == bfqd->in_service_queue); -+ -+ /* If bfqq is empty, then bfq_bfqq_expire also invokes -+ * bfq_del_bfqq_busy, thereby removing bfqq and its entity -+ * from data structures related to current group. Otherwise we -+ * need to remove bfqq explicitly with bfq_deactivate_bfqq, as -+ * we do below. -+ */ -+ if (bfqq == bfqd->in_service_queue) -+ bfq_bfqq_expire(bfqd, bfqd->in_service_queue, -+ false, BFQ_BFQQ_PREEMPTED); - -- if (busy) { -- BUG_ON(atomic_read(&bfqq->ref) < 2); -+ BUG_ON(entity->on_st && !bfq_bfqq_busy(bfqq) -+ && &bfq_entity_service_tree(entity)->idle != -+ entity->tree); - -- if (!resume) -- bfq_del_bfqq_busy(bfqd, bfqq, 0); -- else -- bfq_deactivate_bfqq(bfqd, bfqq, 0); -- } else if (entity->on_st) -+ BUG_ON(RB_EMPTY_ROOT(&bfqq->sort_list) && bfq_bfqq_busy(bfqq)); -+ -+ if (bfq_bfqq_busy(bfqq)) -+ bfq_deactivate_bfqq(bfqd, bfqq, false, false); -+ else if (entity->on_st) { -+ BUG_ON(&bfq_entity_service_tree(entity)->idle != -+ entity->tree); - bfq_put_idle_entity(bfq_entity_service_tree(entity), entity); -+ } - bfqg_put(bfqq_group(bfqq)); - - /* -@@ -583,14 +569,17 @@ static void bfq_bfqq_move(struct bfq_data *bfqd, struct bfq_queue *bfqq, - entity->sched_data = &bfqg->sched_data; - bfqg_get(bfqg); - -- if (busy) { -+ BUG_ON(RB_EMPTY_ROOT(&bfqq->sort_list) && bfq_bfqq_busy(bfqq)); -+ if (bfq_bfqq_busy(bfqq)) { - bfq_pos_tree_add_move(bfqd, bfqq); -- if (resume) -- bfq_activate_bfqq(bfqd, bfqq); -+ bfq_activate_bfqq(bfqd, bfqq); - } - - if (!bfqd->in_service_queue && !bfqd->rq_in_driver) - bfq_schedule_dispatch(bfqd); -+ BUG_ON(entity->on_st && !bfq_bfqq_busy(bfqq) -+ && &bfq_entity_service_tree(entity)->idle != -+ entity->tree); - } - - /** -@@ -617,7 +606,11 @@ static struct bfq_group *__bfq_bic_change_cgroup(struct bfq_data *bfqd, - - lockdep_assert_held(bfqd->queue->queue_lock); - -- bfqg = bfq_find_alloc_group(bfqd, blkcg); -+ bfqg = bfq_find_set_group(bfqd, blkcg); -+ -+ if (unlikely(!bfqg)) -+ bfqg = bfqd->root_group; -+ - if (async_bfqq) { - entity = &async_bfqq->entity; - -@@ -625,7 +618,8 @@ static struct bfq_group *__bfq_bic_change_cgroup(struct bfq_data *bfqd, - bic_set_bfqq(bic, NULL, 0); - bfq_log_bfqq(bfqd, async_bfqq, - "bic_change_group: %p %d", -- async_bfqq, atomic_read(&async_bfqq->ref)); -+ async_bfqq, -+ async_bfqq->ref); - bfq_put_queue(async_bfqq); - } - } -@@ -633,7 +627,7 @@ static struct bfq_group *__bfq_bic_change_cgroup(struct bfq_data *bfqd, - if (sync_bfqq) { - entity = &sync_bfqq->entity; - if (entity->sched_data != &bfqg->sched_data) -- bfq_bfqq_move(bfqd, sync_bfqq, entity, bfqg); -+ bfq_bfqq_move(bfqd, sync_bfqq, bfqg); - } - - return bfqg; -@@ -642,25 +636,23 @@ static struct bfq_group *__bfq_bic_change_cgroup(struct bfq_data *bfqd, - static void bfq_bic_update_cgroup(struct bfq_io_cq *bic, struct bio *bio) - { - struct bfq_data *bfqd = bic_to_bfqd(bic); -- struct blkcg *blkcg; - struct bfq_group *bfqg = NULL; -- uint64_t id; -+ uint64_t serial_nr; - - rcu_read_lock(); -- blkcg = bio_blkcg(bio); -- id = blkcg->css.serial_nr; -- rcu_read_unlock(); -+ serial_nr = bio_blkcg(bio)->css.serial_nr; - - /* - * Check whether blkcg has changed. The condition may trigger - * spuriously on a newly created cic but there's no harm. - */ -- if (unlikely(!bfqd) || likely(bic->blkcg_id == id)) -- return; -+ if (unlikely(!bfqd) || likely(bic->blkcg_serial_nr == serial_nr)) -+ goto out; - -- bfqg = __bfq_bic_change_cgroup(bfqd, bic, blkcg); -- BUG_ON(!bfqg); -- bic->blkcg_id = id; -+ bfqg = __bfq_bic_change_cgroup(bfqd, bic, bio_blkcg(bio)); -+ bic->blkcg_serial_nr = serial_nr; -+out: -+ rcu_read_unlock(); - } - - /** -@@ -672,7 +664,7 @@ static void bfq_flush_idle_tree(struct bfq_service_tree *st) - struct bfq_entity *entity = st->first_idle; - - for (; entity ; entity = st->first_idle) -- __bfq_deactivate_entity(entity, 0); -+ __bfq_deactivate_entity(entity, false); - } - - /** -@@ -686,7 +678,7 @@ static void bfq_reparent_leaf_entity(struct bfq_data *bfqd, - struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); - - BUG_ON(!bfqq); -- bfq_bfqq_move(bfqd, bfqq, entity, bfqd->root_group); -+ bfq_bfqq_move(bfqd, bfqq, bfqd->root_group); - } - - /** -@@ -717,11 +709,12 @@ static void bfq_reparent_active_entities(struct bfq_data *bfqd, - } - - /** -- * bfq_destroy_group - destroy @bfqg. -- * @bfqg: the group being destroyed. -+ * bfq_pd_offline - deactivate the entity associated with @pd, -+ * and reparent its children entities. -+ * @pd: descriptor of the policy going offline. - * -- * Destroy @bfqg, making sure that it is not referenced from its parent. -- * blkio already grabs the queue_lock for us, so no need to use RCU-based magic -+ * blkio already grabs the queue_lock for us, so no need to use -+ * RCU-based magic - */ - static void bfq_pd_offline(struct blkg_policy_data *pd) - { -@@ -776,10 +769,16 @@ static void bfq_pd_offline(struct blkg_policy_data *pd) - BUG_ON(bfqg->sched_data.next_in_service); - BUG_ON(bfqg->sched_data.in_service_entity); - -- __bfq_deactivate_entity(entity, 0); -+ __bfq_deactivate_entity(entity, false); - bfq_put_async_queues(bfqd, bfqg); - BUG_ON(entity->tree); - -+ /* -+ * @blkg is going offline and will be ignored by -+ * blkg_[rw]stat_recursive_sum(). Transfer stats to the parent so -+ * that they don't get lost. If IOs complete after this point, the -+ * stats for them will be lost. Oh well... -+ */ - bfqg_stats_xfer_dead(bfqg); - } - -@@ -789,46 +788,35 @@ static void bfq_end_wr_async(struct bfq_data *bfqd) - - list_for_each_entry(blkg, &bfqd->queue->blkg_list, q_node) { - struct bfq_group *bfqg = blkg_to_bfqg(blkg); -+ BUG_ON(!bfqg); - - bfq_end_wr_async_queues(bfqd, bfqg); - } - bfq_end_wr_async_queues(bfqd, bfqd->root_group); - } - --static u64 bfqio_cgroup_weight_read(struct cgroup_subsys_state *css, -- struct cftype *cftype) --{ -- struct blkcg *blkcg = css_to_blkcg(css); -- struct bfq_group_data *bfqgd = blkcg_to_bfqgd(blkcg); -- int ret = -EINVAL; -- -- spin_lock_irq(&blkcg->lock); -- ret = bfqgd->weight; -- spin_unlock_irq(&blkcg->lock); -- -- return ret; --} -- --static int bfqio_cgroup_weight_read_dfl(struct seq_file *sf, void *v) -+static int bfq_io_show_weight(struct seq_file *sf, void *v) - { - struct blkcg *blkcg = css_to_blkcg(seq_css(sf)); - struct bfq_group_data *bfqgd = blkcg_to_bfqgd(blkcg); -+ unsigned int val = 0; - -- spin_lock_irq(&blkcg->lock); -- seq_printf(sf, "%u\n", bfqgd->weight); -- spin_unlock_irq(&blkcg->lock); -+ if (bfqgd) -+ val = bfqgd->weight; -+ -+ seq_printf(sf, "%u\n", val); - - return 0; - } - --static int bfqio_cgroup_weight_write(struct cgroup_subsys_state *css, -- struct cftype *cftype, -- u64 val) -+static int bfq_io_set_weight_legacy(struct cgroup_subsys_state *css, -+ struct cftype *cftype, -+ u64 val) - { - struct blkcg *blkcg = css_to_blkcg(css); - struct bfq_group_data *bfqgd = blkcg_to_bfqgd(blkcg); - struct blkcg_gq *blkg; -- int ret = -EINVAL; -+ int ret = -ERANGE; - - if (val < BFQ_MIN_WEIGHT || val > BFQ_MAX_WEIGHT) - return ret; -@@ -873,13 +861,18 @@ static int bfqio_cgroup_weight_write(struct cgroup_subsys_state *css, - return ret; - } - --static ssize_t bfqio_cgroup_weight_write_dfl(struct kernfs_open_file *of, -- char *buf, size_t nbytes, -- loff_t off) -+static ssize_t bfq_io_set_weight(struct kernfs_open_file *of, -+ char *buf, size_t nbytes, -+ loff_t off) - { -+ u64 weight; - /* First unsigned long found in the file is used */ -- return bfqio_cgroup_weight_write(of_css(of), NULL, -- simple_strtoull(strim(buf), NULL, 0)); -+ int ret = kstrtoull(strim(buf), 0, &weight); -+ -+ if (ret) -+ return ret; -+ -+ return bfq_io_set_weight_legacy(of_css(of), NULL, weight); - } - - static int bfqg_print_stat(struct seq_file *sf, void *v) -@@ -899,16 +892,17 @@ static int bfqg_print_rwstat(struct seq_file *sf, void *v) - static u64 bfqg_prfill_stat_recursive(struct seq_file *sf, - struct blkg_policy_data *pd, int off) - { -- u64 sum = bfqg_stat_pd_recursive_sum(pd, off); -- -+ u64 sum = blkg_stat_recursive_sum(pd_to_blkg(pd), -+ &blkcg_policy_bfq, off); - return __blkg_prfill_u64(sf, pd, sum); - } - - static u64 bfqg_prfill_rwstat_recursive(struct seq_file *sf, - struct blkg_policy_data *pd, int off) - { -- struct blkg_rwstat sum = bfqg_rwstat_pd_recursive_sum(pd, off); -- -+ struct blkg_rwstat sum = blkg_rwstat_recursive_sum(pd_to_blkg(pd), -+ &blkcg_policy_bfq, -+ off); - return __blkg_prfill_rwstat(sf, pd, &sum); - } - -@@ -928,6 +922,41 @@ static int bfqg_print_rwstat_recursive(struct seq_file *sf, void *v) - return 0; - } - -+static u64 bfqg_prfill_sectors(struct seq_file *sf, struct blkg_policy_data *pd, -+ int off) -+{ -+ u64 sum = blkg_rwstat_total(&pd->blkg->stat_bytes); -+ -+ return __blkg_prfill_u64(sf, pd, sum >> 9); -+} -+ -+static int bfqg_print_stat_sectors(struct seq_file *sf, void *v) -+{ -+ blkcg_print_blkgs(sf, css_to_blkcg(seq_css(sf)), -+ bfqg_prfill_sectors, &blkcg_policy_bfq, 0, false); -+ return 0; -+} -+ -+static u64 bfqg_prfill_sectors_recursive(struct seq_file *sf, -+ struct blkg_policy_data *pd, int off) -+{ -+ struct blkg_rwstat tmp = blkg_rwstat_recursive_sum(pd->blkg, NULL, -+ offsetof(struct blkcg_gq, stat_bytes)); -+ u64 sum = atomic64_read(&tmp.aux_cnt[BLKG_RWSTAT_READ]) + -+ atomic64_read(&tmp.aux_cnt[BLKG_RWSTAT_WRITE]); -+ -+ return __blkg_prfill_u64(sf, pd, sum >> 9); -+} -+ -+static int bfqg_print_stat_sectors_recursive(struct seq_file *sf, void *v) -+{ -+ blkcg_print_blkgs(sf, css_to_blkcg(seq_css(sf)), -+ bfqg_prfill_sectors_recursive, &blkcg_policy_bfq, 0, -+ false); -+ return 0; -+} -+ -+ - static u64 bfqg_prfill_avg_queue_size(struct seq_file *sf, - struct blkg_policy_data *pd, int off) - { -@@ -964,38 +993,15 @@ bfq_create_group_hierarchy(struct bfq_data *bfqd, int node) - return blkg_to_bfqg(bfqd->queue->root_blkg); - } - --static struct blkcg_policy_data *bfq_cpd_alloc(gfp_t gfp) --{ -- struct bfq_group_data *bgd; -- -- bgd = kzalloc(sizeof(*bgd), GFP_KERNEL); -- if (!bgd) -- return NULL; -- return &bgd->pd; --} -- --static void bfq_cpd_free(struct blkcg_policy_data *cpd) --{ -- kfree(cpd_to_bfqgd(cpd)); --} -- --static struct cftype bfqio_files_dfl[] = { -+static struct cftype bfq_blkcg_legacy_files[] = { - { -- .name = "weight", -+ .name = "bfq.weight", - .flags = CFTYPE_NOT_ON_ROOT, -- .seq_show = bfqio_cgroup_weight_read_dfl, -- .write = bfqio_cgroup_weight_write_dfl, -+ .seq_show = bfq_io_show_weight, -+ .write_u64 = bfq_io_set_weight_legacy, - }, -- {} /* terminate */ --}; - --static struct cftype bfqio_files[] = { -- { -- .name = "bfq.weight", -- .read_u64 = bfqio_cgroup_weight_read, -- .write_u64 = bfqio_cgroup_weight_write, -- }, -- /* statistics, cover only the tasks in the bfqg */ -+ /* statistics, covers only the tasks in the bfqg */ - { - .name = "bfq.time", - .private = offsetof(struct bfq_group, stats.time), -@@ -1003,18 +1009,17 @@ static struct cftype bfqio_files[] = { - }, - { - .name = "bfq.sectors", -- .private = offsetof(struct bfq_group, stats.sectors), -- .seq_show = bfqg_print_stat, -+ .seq_show = bfqg_print_stat_sectors, - }, - { - .name = "bfq.io_service_bytes", -- .private = offsetof(struct bfq_group, stats.service_bytes), -- .seq_show = bfqg_print_rwstat, -+ .private = (unsigned long)&blkcg_policy_bfq, -+ .seq_show = blkg_print_stat_bytes, - }, - { - .name = "bfq.io_serviced", -- .private = offsetof(struct bfq_group, stats.serviced), -- .seq_show = bfqg_print_rwstat, -+ .private = (unsigned long)&blkcg_policy_bfq, -+ .seq_show = blkg_print_stat_ios, - }, - { - .name = "bfq.io_service_time", -@@ -1045,18 +1050,17 @@ static struct cftype bfqio_files[] = { - }, - { - .name = "bfq.sectors_recursive", -- .private = offsetof(struct bfq_group, stats.sectors), -- .seq_show = bfqg_print_stat_recursive, -+ .seq_show = bfqg_print_stat_sectors_recursive, - }, - { - .name = "bfq.io_service_bytes_recursive", -- .private = offsetof(struct bfq_group, stats.service_bytes), -- .seq_show = bfqg_print_rwstat_recursive, -+ .private = (unsigned long)&blkcg_policy_bfq, -+ .seq_show = blkg_print_stat_bytes_recursive, - }, - { - .name = "bfq.io_serviced_recursive", -- .private = offsetof(struct bfq_group, stats.serviced), -- .seq_show = bfqg_print_rwstat_recursive, -+ .private = (unsigned long)&blkcg_policy_bfq, -+ .seq_show = blkg_print_stat_ios_recursive, - }, - { - .name = "bfq.io_service_time_recursive", -@@ -1102,31 +1106,39 @@ static struct cftype bfqio_files[] = { - .private = offsetof(struct bfq_group, stats.dequeue), - .seq_show = bfqg_print_stat, - }, -- { -- .name = "bfq.unaccounted_time", -- .private = offsetof(struct bfq_group, stats.unaccounted_time), -- .seq_show = bfqg_print_stat, -- }, - { } /* terminate */ - }; - --static struct blkcg_policy blkcg_policy_bfq = { -- .dfl_cftypes = bfqio_files_dfl, -- .legacy_cftypes = bfqio_files, -- -- .pd_alloc_fn = bfq_pd_alloc, -- .pd_init_fn = bfq_pd_init, -- .pd_offline_fn = bfq_pd_offline, -- .pd_free_fn = bfq_pd_free, -- .pd_reset_stats_fn = bfq_pd_reset_stats, -- -- .cpd_alloc_fn = bfq_cpd_alloc, -- .cpd_init_fn = bfq_cpd_init, -- .cpd_bind_fn = bfq_cpd_init, -- .cpd_free_fn = bfq_cpd_free, -+static struct cftype bfq_blkg_files[] = { -+ { -+ .name = "bfq.weight", -+ .flags = CFTYPE_NOT_ON_ROOT, -+ .seq_show = bfq_io_show_weight, -+ .write = bfq_io_set_weight, -+ }, -+ {} /* terminate */ - }; - --#else -+#else /* CONFIG_BFQ_GROUP_IOSCHED */ -+ -+static inline void bfqg_stats_update_io_add(struct bfq_group *bfqg, -+ struct bfq_queue *bfqq, int op, int op_flags) { } -+static inline void -+bfqg_stats_update_io_remove(struct bfq_group *bfqg, int op, int op_flags) { } -+static inline void -+bfqg_stats_update_io_merged(struct bfq_group *bfqg, int op, int op_flags) { } -+static inline void bfqg_stats_update_completion(struct bfq_group *bfqg, -+ uint64_t start_time, uint64_t io_start_time, int op, -+ int op_flags) { } -+static inline void -+bfqg_stats_set_start_group_wait_time(struct bfq_group *bfqg, -+ struct bfq_group *curr_bfqg) { } -+static inline void bfqg_stats_end_empty_time(struct bfqg_stats *stats) { } -+static inline void bfqg_stats_update_dequeue(struct bfq_group *bfqg) { } -+static inline void bfqg_stats_set_start_empty_time(struct bfq_group *bfqg) { } -+static inline void bfqg_stats_update_idle_time(struct bfq_group *bfqg) { } -+static inline void bfqg_stats_set_start_idle_time(struct bfq_group *bfqg) { } -+static inline void bfqg_stats_update_avg_queue_size(struct bfq_group *bfqg) { } - - static void bfq_init_entity(struct bfq_entity *entity, - struct bfq_group *bfqg) -@@ -1150,27 +1162,20 @@ bfq_bic_update_cgroup(struct bfq_io_cq *bic, struct bio *bio) - return bfqd->root_group; - } - --static void bfq_bfqq_move(struct bfq_data *bfqd, -- struct bfq_queue *bfqq, -- struct bfq_entity *entity, -- struct bfq_group *bfqg) --{ --} -- - static void bfq_end_wr_async(struct bfq_data *bfqd) - { - bfq_end_wr_async_queues(bfqd, bfqd->root_group); - } - --static void bfq_disconnect_groups(struct bfq_data *bfqd) -+static struct bfq_group *bfq_find_set_group(struct bfq_data *bfqd, -+ struct blkcg *blkcg) - { -- bfq_put_async_queues(bfqd, bfqd->root_group); -+ return bfqd->root_group; - } - --static struct bfq_group *bfq_find_alloc_group(struct bfq_data *bfqd, -- struct blkcg *blkcg) -+static struct bfq_group *bfqq_group(struct bfq_queue *bfqq) - { -- return bfqd->root_group; -+ return bfqq->bfqd->root_group; - } - - static struct bfq_group * -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index cf3e9b1..2a2c130 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -1,5 +1,5 @@ - /* -- * Budget Fair Queueing (BFQ) disk scheduler. -+ * Budget Fair Queueing (BFQ) I/O scheduler. - * - * Based on ideas and code from CFQ: - * Copyright (C) 2003 Jens Axboe -@@ -7,25 +7,34 @@ - * Copyright (C) 2008 Fabio Checconi - * Paolo Valente - * -- * Copyright (C) 2010 Paolo Valente -+ * Copyright (C) 2015 Paolo Valente -+ * -+ * Copyright (C) 2016 Paolo Valente - * - * Licensed under the GPL-2 as detailed in the accompanying COPYING.BFQ - * file. - * -- * BFQ is a proportional-share storage-I/O scheduling algorithm based on -- * the slice-by-slice service scheme of CFQ. But BFQ assigns budgets, -- * measured in number of sectors, to processes instead of time slices. The -- * device is not granted to the in-service process for a given time slice, -- * but until it has exhausted its assigned budget. This change from the time -- * to the service domain allows BFQ to distribute the device throughput -- * among processes as desired, without any distortion due to ZBR, workload -- * fluctuations or other factors. BFQ uses an ad hoc internal scheduler, -- * called B-WF2Q+, to schedule processes according to their budgets. More -- * precisely, BFQ schedules queues associated to processes. Thanks to the -- * accurate policy of B-WF2Q+, BFQ can afford to assign high budgets to -- * I/O-bound processes issuing sequential requests (to boost the -- * throughput), and yet guarantee a low latency to interactive and soft -- * real-time applications. -+ * BFQ is a proportional-share I/O scheduler, with some extra -+ * low-latency capabilities. BFQ also supports full hierarchical -+ * scheduling through cgroups. Next paragraphs provide an introduction -+ * on BFQ inner workings. Details on BFQ benefits and usage can be -+ * found in Documentation/block/bfq-iosched.txt. -+ * -+ * BFQ is a proportional-share storage-I/O scheduling algorithm based -+ * on the slice-by-slice service scheme of CFQ. But BFQ assigns -+ * budgets, measured in number of sectors, to processes instead of -+ * time slices. The device is not granted to the in-service process -+ * for a given time slice, but until it has exhausted its assigned -+ * budget. This change from the time to the service domain enables BFQ -+ * to distribute the device throughput among processes as desired, -+ * without any distortion due to throughput fluctuations, or to device -+ * internal queueing. BFQ uses an ad hoc internal scheduler, called -+ * B-WF2Q+, to schedule processes according to their budgets. More -+ * precisely, BFQ schedules queues associated with processes. Thanks to -+ * the accurate policy of B-WF2Q+, BFQ can afford to assign high -+ * budgets to I/O-bound processes issuing sequential requests (to -+ * boost the throughput), and yet guarantee a low latency to -+ * interactive and soft real-time applications. - * - * BFQ is described in [1], where also a reference to the initial, more - * theoretical paper on BFQ can be found. The interested reader can find -@@ -40,10 +49,10 @@ - * H-WF2Q+, while the augmented tree used to implement B-WF2Q+ with O(log N) - * complexity derives from the one introduced with EEVDF in [3]. - * -- * [1] P. Valente and M. Andreolini, ``Improving Application Responsiveness -- * with the BFQ Disk I/O Scheduler'', -- * Proceedings of the 5th Annual International Systems and Storage -- * Conference (SYSTOR '12), June 2012. -+ * [1] P. Valente, A. Avanzini, "Evolution of the BFQ Storage I/O -+ * Scheduler", Proceedings of the First Workshop on Mobile System -+ * Technologies (MST-2015), May 2015. -+ * http://algogroup.unimore.it/people/paolo/disk_sched/mst-2015.pdf - * - * http://algogroup.unimo.it/people/paolo/disk_sched/bf1-v1-suite-results.pdf - * -@@ -70,24 +79,23 @@ - #include "bfq.h" - #include "blk.h" - --/* Expiration time of sync (0) and async (1) requests, in jiffies. */ --static const int bfq_fifo_expire[2] = { HZ / 4, HZ / 8 }; -+/* Expiration time of sync (0) and async (1) requests, in ns. */ -+static const u64 bfq_fifo_expire[2] = { NSEC_PER_SEC / 4, NSEC_PER_SEC / 8 }; - - /* Maximum backwards seek, in KiB. */ --static const int bfq_back_max = 16 * 1024; -+static const int bfq_back_max = (16 * 1024); - - /* Penalty of a backwards seek, in number of sectors. */ - static const int bfq_back_penalty = 2; - --/* Idling period duration, in jiffies. */ --static int bfq_slice_idle = HZ / 125; -+/* Idling period duration, in ns. */ -+static u32 bfq_slice_idle = (NSEC_PER_SEC / 125); - - /* Minimum number of assigned budgets for which stats are safe to compute. */ - static const int bfq_stats_min_budgets = 194; - - /* Default maximum budget values, in sectors and number of requests. */ --static const int bfq_default_max_budget = 16 * 1024; --static const int bfq_max_budget_async_rq = 4; -+static const int bfq_default_max_budget = (16 * 1024); - - /* - * Async to sync throughput distribution is controlled as follows: -@@ -97,23 +105,28 @@ static const int bfq_max_budget_async_rq = 4; - static const int bfq_async_charge_factor = 10; - - /* Default timeout values, in jiffies, approximating CFQ defaults. */ --static const int bfq_timeout_sync = HZ / 8; --static int bfq_timeout_async = HZ / 25; -+static const int bfq_timeout = (HZ / 8); - - struct kmem_cache *bfq_pool; - --/* Below this threshold (in ms), we consider thinktime immediate. */ --#define BFQ_MIN_TT 2 -+/* Below this threshold (in ns), we consider thinktime immediate. */ -+#define BFQ_MIN_TT (2 * NSEC_PER_MSEC) - - /* hw_tag detection: parallel requests threshold and min samples needed. */ - #define BFQ_HW_QUEUE_THRESHOLD 4 - #define BFQ_HW_QUEUE_SAMPLES 32 - --#define BFQQ_SEEK_THR (sector_t)(8 * 1024) --#define BFQQ_SEEKY(bfqq) ((bfqq)->seek_mean > BFQQ_SEEK_THR) -+#define BFQQ_SEEK_THR (sector_t)(8 * 100) -+#define BFQQ_SECT_THR_NONROT (sector_t)(2 * 32) -+#define BFQQ_CLOSE_THR (sector_t)(8 * 1024) -+#define BFQQ_SEEKY(bfqq) (hweight32(bfqq->seek_history) > 32/8) - --/* Min samples used for peak rate estimation (for autotuning). */ --#define BFQ_PEAK_RATE_SAMPLES 32 -+/* Min number of samples required to perform peak-rate update */ -+#define BFQ_RATE_MIN_SAMPLES 32 -+/* Min observation time interval required to perform a peak-rate update (ns) */ -+#define BFQ_RATE_MIN_INTERVAL (300*NSEC_PER_MSEC) -+/* Target observation time interval for a peak-rate update (ns) */ -+#define BFQ_RATE_REF_INTERVAL NSEC_PER_SEC - - /* Shift used for peak rate fixed precision calculations. */ - #define BFQ_RATE_SHIFT 16 -@@ -141,16 +154,24 @@ struct kmem_cache *bfq_pool; - * The device's speed class is dynamically (re)detected in - * bfq_update_peak_rate() every time the estimated peak rate is updated. - * -- * In the following definitions, R_slow[0]/R_fast[0] and T_slow[0]/T_fast[0] -- * are the reference values for a slow/fast rotational device, whereas -- * R_slow[1]/R_fast[1] and T_slow[1]/T_fast[1] are the reference values for -- * a slow/fast non-rotational device. Finally, device_speed_thresh are the -- * thresholds used to switch between speed classes. -+ * In the following definitions, R_slow[0]/R_fast[0] and -+ * T_slow[0]/T_fast[0] are the reference values for a slow/fast -+ * rotational device, whereas R_slow[1]/R_fast[1] and -+ * T_slow[1]/T_fast[1] are the reference values for a slow/fast -+ * non-rotational device. Finally, device_speed_thresh are the -+ * thresholds used to switch between speed classes. The reference -+ * rates are not the actual peak rates of the devices used as a -+ * reference, but slightly lower values. The reason for using these -+ * slightly lower values is that the peak-rate estimator tends to -+ * yield slightly lower values than the actual peak rate (it can yield -+ * the actual peak rate only if there is only one process doing I/O, -+ * and the process does sequential I/O). -+ * - * Both the reference peak rates and the thresholds are measured in - * sectors/usec, left-shifted by BFQ_RATE_SHIFT. - */ --static int R_slow[2] = {1536, 10752}; --static int R_fast[2] = {17415, 34791}; -+static int R_slow[2] = {1000, 10700}; -+static int R_fast[2] = {14000, 33000}; - /* - * To improve readability, a conversion function is used to initialize the - * following arrays, which entails that they can be initialized only in a -@@ -183,10 +204,7 @@ static void bfq_schedule_dispatch(struct bfq_data *bfqd); - */ - static int bfq_bio_sync(struct bio *bio) - { -- if (bio_data_dir(bio) == READ || (bio->bi_rw & REQ_SYNC)) -- return 1; -- -- return 0; -+ return bio_data_dir(bio) == READ || (bio->bi_opf & REQ_SYNC); - } - - /* -@@ -409,11 +427,7 @@ static bool bfq_differentiated_weights(struct bfq_data *bfqd) - */ - static bool bfq_symmetric_scenario(struct bfq_data *bfqd) - { -- return --#ifdef CONFIG_BFQ_GROUP_IOSCHED -- !bfqd->active_numerous_groups && --#endif -- !bfq_differentiated_weights(bfqd); -+ return !bfq_differentiated_weights(bfqd); - } - - /* -@@ -533,9 +547,19 @@ static struct request *bfq_find_next_rq(struct bfq_data *bfqd, - static unsigned long bfq_serv_to_charge(struct request *rq, - struct bfq_queue *bfqq) - { -- return blk_rq_sectors(rq) * -- (1 + ((!bfq_bfqq_sync(bfqq)) * (bfqq->wr_coeff == 1) * -- bfq_async_charge_factor)); -+ if (bfq_bfqq_sync(bfqq) || bfqq->wr_coeff > 1) -+ return blk_rq_sectors(rq); -+ -+ /* -+ * If there are no weight-raised queues, then amplify service -+ * by just the async charge factor; otherwise amplify service -+ * by twice the async charge factor, to further reduce latency -+ * for weight-raised queues. -+ */ -+ if (bfqq->bfqd->wr_busy_queues == 0) -+ return blk_rq_sectors(rq) * bfq_async_charge_factor; -+ -+ return blk_rq_sectors(rq) * 2 * bfq_async_charge_factor; - } - - /** -@@ -576,7 +600,7 @@ static void bfq_updated_next_req(struct bfq_data *bfqd, - entity->budget = new_budget; - bfq_log_bfqq(bfqd, bfqq, "updated next rq: new budget %lu", - new_budget); -- bfq_activate_bfqq(bfqd, bfqq); -+ bfq_requeue_bfqq(bfqd, bfqq); - } - } - -@@ -590,12 +614,23 @@ static unsigned int bfq_wr_duration(struct bfq_data *bfqd) - dur = bfqd->RT_prod; - do_div(dur, bfqd->peak_rate); - -- return dur; --} -+ /* -+ * Limit duration between 3 and 13 seconds. Tests show that -+ * higher values than 13 seconds often yield the opposite of -+ * the desired result, i.e., worsen responsiveness by letting -+ * non-interactive and non-soft-real-time applications -+ * preserve weight raising for a too long time interval. -+ * -+ * On the other end, lower values than 3 seconds make it -+ * difficult for most interactive tasks to complete their jobs -+ * before weight-raising finishes. -+ */ -+ if (dur > msecs_to_jiffies(13000)) -+ dur = msecs_to_jiffies(13000); -+ else if (dur < msecs_to_jiffies(3000)) -+ dur = msecs_to_jiffies(3000); - --static unsigned int bfq_bfqq_cooperations(struct bfq_queue *bfqq) --{ -- return bfqq->bic ? bfqq->bic->cooperations : 0; -+ return dur; - } - - static void -@@ -605,31 +640,31 @@ bfq_bfqq_resume_state(struct bfq_queue *bfqq, struct bfq_io_cq *bic) - bfq_mark_bfqq_idle_window(bfqq); - else - bfq_clear_bfqq_idle_window(bfqq); -+ - if (bic->saved_IO_bound) - bfq_mark_bfqq_IO_bound(bfqq); - else - bfq_clear_bfqq_IO_bound(bfqq); -- /* Assuming that the flag in_large_burst is already correctly set */ -- if (bic->wr_time_left && bfqq->bfqd->low_latency && -- !bfq_bfqq_in_large_burst(bfqq) && -- bic->cooperations < bfqq->bfqd->bfq_coop_thresh) { -- /* -- * Start a weight raising period with the duration given by -- * the raising_time_left snapshot. -- */ -- if (bfq_bfqq_busy(bfqq)) -- bfqq->bfqd->wr_busy_queues++; -- bfqq->wr_coeff = bfqq->bfqd->bfq_wr_coeff; -- bfqq->wr_cur_max_time = bic->wr_time_left; -- bfqq->last_wr_start_finish = jiffies; -- bfqq->entity.prio_changed = 1; -+ -+ bfqq->wr_coeff = bic->saved_wr_coeff; -+ bfqq->wr_start_at_switch_to_srt = bic->saved_wr_start_at_switch_to_srt; -+ BUG_ON(time_is_after_jiffies(bfqq->wr_start_at_switch_to_srt)); -+ bfqq->last_wr_start_finish = bic->saved_last_wr_start_finish; -+ bfqq->wr_cur_max_time = bic->saved_wr_cur_max_time; -+ BUG_ON(time_is_after_jiffies(bfqq->last_wr_start_finish)); -+ -+ if (bfqq->wr_coeff > 1 && (bfq_bfqq_in_large_burst(bfqq) || -+ time_is_before_jiffies(bfqq->last_wr_start_finish + -+ bfqq->wr_cur_max_time))) { -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "resume state: switching off wr (%lu + %lu < %lu)", -+ bfqq->last_wr_start_finish, bfqq->wr_cur_max_time, -+ jiffies); -+ -+ bfqq->wr_coeff = 1; - } -- /* -- * Clear wr_time_left to prevent bfq_bfqq_save_state() from -- * getting confused about the queue's need of a weight-raising -- * period. -- */ -- bic->wr_time_left = 0; -+ /* make sure weight will be updated, however we got here */ -+ bfqq->entity.prio_changed = 1; - } - - static int bfqq_process_refs(struct bfq_queue *bfqq) -@@ -639,7 +674,7 @@ static int bfqq_process_refs(struct bfq_queue *bfqq) - lockdep_assert_held(bfqq->bfqd->queue->queue_lock); - - io_refs = bfqq->allocated[READ] + bfqq->allocated[WRITE]; -- process_refs = atomic_read(&bfqq->ref) - io_refs - bfqq->entity.on_st; -+ process_refs = bfqq->ref - io_refs - bfqq->entity.on_st; - BUG_ON(process_refs < 0); - return process_refs; - } -@@ -654,6 +689,7 @@ static void bfq_reset_burst_list(struct bfq_data *bfqd, struct bfq_queue *bfqq) - hlist_del_init(&item->burst_list_node); - hlist_add_head(&bfqq->burst_list_node, &bfqd->burst_list); - bfqd->burst_size = 1; -+ bfqd->burst_parent_entity = bfqq->entity.parent; - } - - /* Add bfqq to the list of queues in current burst (see bfq_handle_burst) */ -@@ -662,6 +698,10 @@ static void bfq_add_to_burst(struct bfq_data *bfqd, struct bfq_queue *bfqq) - /* Increment burst size to take into account also bfqq */ - bfqd->burst_size++; - -+ bfq_log_bfqq(bfqd, bfqq, "add_to_burst %d", bfqd->burst_size); -+ -+ BUG_ON(bfqd->burst_size > bfqd->bfq_large_burst_thresh); -+ - if (bfqd->burst_size == bfqd->bfq_large_burst_thresh) { - struct bfq_queue *pos, *bfqq_item; - struct hlist_node *n; -@@ -671,15 +711,19 @@ static void bfq_add_to_burst(struct bfq_data *bfqd, struct bfq_queue *bfqq) - * other to consider this burst as large. - */ - bfqd->large_burst = true; -+ bfq_log_bfqq(bfqd, bfqq, "add_to_burst: large burst started"); - - /* - * We can now mark all queues in the burst list as - * belonging to a large burst. - */ - hlist_for_each_entry(bfqq_item, &bfqd->burst_list, -- burst_list_node) -+ burst_list_node) { - bfq_mark_bfqq_in_large_burst(bfqq_item); -+ bfq_log_bfqq(bfqd, bfqq_item, "marked in large burst"); -+ } - bfq_mark_bfqq_in_large_burst(bfqq); -+ bfq_log_bfqq(bfqd, bfqq, "marked in large burst"); - - /* - * From now on, and until the current burst finishes, any -@@ -691,67 +735,79 @@ static void bfq_add_to_burst(struct bfq_data *bfqd, struct bfq_queue *bfqq) - hlist_for_each_entry_safe(pos, n, &bfqd->burst_list, - burst_list_node) - hlist_del_init(&pos->burst_list_node); -- } else /* burst not yet large: add bfqq to the burst list */ -+ } else /* -+ * Burst not yet large: add bfqq to the burst list. Do -+ * not increment the ref counter for bfqq, because bfqq -+ * is removed from the burst list before freeing bfqq -+ * in put_queue. -+ */ - hlist_add_head(&bfqq->burst_list_node, &bfqd->burst_list); - } - - /* -- * If many queues happen to become active shortly after each other, then, -- * to help the processes associated to these queues get their job done as -- * soon as possible, it is usually better to not grant either weight-raising -- * or device idling to these queues. In this comment we describe, firstly, -- * the reasons why this fact holds, and, secondly, the next function, which -- * implements the main steps needed to properly mark these queues so that -- * they can then be treated in a different way. -+ * If many queues belonging to the same group happen to be created -+ * shortly after each other, then the processes associated with these -+ * queues have typically a common goal. In particular, bursts of queue -+ * creations are usually caused by services or applications that spawn -+ * many parallel threads/processes. Examples are systemd during boot, -+ * or git grep. To help these processes get their job done as soon as -+ * possible, it is usually better to not grant either weight-raising -+ * or device idling to their queues. - * -- * As for the terminology, we say that a queue becomes active, i.e., -- * switches from idle to backlogged, either when it is created (as a -- * consequence of the arrival of an I/O request), or, if already existing, -- * when a new request for the queue arrives while the queue is idle. -- * Bursts of activations, i.e., activations of different queues occurring -- * shortly after each other, are typically caused by services or applications -- * that spawn or reactivate many parallel threads/processes. Examples are -- * systemd during boot or git grep. -+ * In this comment we describe, firstly, the reasons why this fact -+ * holds, and, secondly, the next function, which implements the main -+ * steps needed to properly mark these queues so that they can then be -+ * treated in a different way. - * -- * These services or applications benefit mostly from a high throughput: -- * the quicker the requests of the activated queues are cumulatively served, -- * the sooner the target job of these queues gets completed. As a consequence, -- * weight-raising any of these queues, which also implies idling the device -- * for it, is almost always counterproductive: in most cases it just lowers -- * throughput. -+ * The above services or applications benefit mostly from a high -+ * throughput: the quicker the requests of the activated queues are -+ * cumulatively served, the sooner the target job of these queues gets -+ * completed. As a consequence, weight-raising any of these queues, -+ * which also implies idling the device for it, is almost always -+ * counterproductive. In most cases it just lowers throughput. - * -- * On the other hand, a burst of activations may be also caused by the start -- * of an application that does not consist in a lot of parallel I/O-bound -- * threads. In fact, with a complex application, the burst may be just a -- * consequence of the fact that several processes need to be executed to -- * start-up the application. To start an application as quickly as possible, -- * the best thing to do is to privilege the I/O related to the application -- * with respect to all other I/O. Therefore, the best strategy to start as -- * quickly as possible an application that causes a burst of activations is -- * to weight-raise all the queues activated during the burst. This is the -+ * On the other hand, a burst of queue creations may be caused also by -+ * the start of an application that does not consist of a lot of -+ * parallel I/O-bound threads. In fact, with a complex application, -+ * several short processes may need to be executed to start-up the -+ * application. In this respect, to start an application as quickly as -+ * possible, the best thing to do is in any case to privilege the I/O -+ * related to the application with respect to all other -+ * I/O. Therefore, the best strategy to start as quickly as possible -+ * an application that causes a burst of queue creations is to -+ * weight-raise all the queues created during the burst. This is the - * exact opposite of the best strategy for the other type of bursts. - * -- * In the end, to take the best action for each of the two cases, the two -- * types of bursts need to be distinguished. Fortunately, this seems -- * relatively easy to do, by looking at the sizes of the bursts. In -- * particular, we found a threshold such that bursts with a larger size -- * than that threshold are apparently caused only by services or commands -- * such as systemd or git grep. For brevity, hereafter we call just 'large' -- * these bursts. BFQ *does not* weight-raise queues whose activations occur -- * in a large burst. In addition, for each of these queues BFQ performs or -- * does not perform idling depending on which choice boosts the throughput -- * most. The exact choice depends on the device and request pattern at -+ * In the end, to take the best action for each of the two cases, the -+ * two types of bursts need to be distinguished. Fortunately, this -+ * seems relatively easy, by looking at the sizes of the bursts. In -+ * particular, we found a threshold such that only bursts with a -+ * larger size than that threshold are apparently caused by -+ * services or commands such as systemd or git grep. For brevity, -+ * hereafter we call just 'large' these bursts. BFQ *does not* -+ * weight-raise queues whose creation occurs in a large burst. In -+ * addition, for each of these queues BFQ performs or does not perform -+ * idling depending on which choice boosts the throughput more. The -+ * exact choice depends on the device and request pattern at - * hand. - * -- * Turning back to the next function, it implements all the steps needed -- * to detect the occurrence of a large burst and to properly mark all the -- * queues belonging to it (so that they can then be treated in a different -- * way). This goal is achieved by maintaining a special "burst list" that -- * holds, temporarily, the queues that belong to the burst in progress. The -- * list is then used to mark these queues as belonging to a large burst if -- * the burst does become large. The main steps are the following. -+ * Unfortunately, false positives may occur while an interactive task -+ * is starting (e.g., an application is being started). The -+ * consequence is that the queues associated with the task do not -+ * enjoy weight raising as expected. Fortunately these false positives -+ * are very rare. They typically occur if some service happens to -+ * start doing I/O exactly when the interactive task starts. -+ * -+ * Turning back to the next function, it implements all the steps -+ * needed to detect the occurrence of a large burst and to properly -+ * mark all the queues belonging to it (so that they can then be -+ * treated in a different way). This goal is achieved by maintaining a -+ * "burst list" that holds, temporarily, the queues that belong to the -+ * burst in progress. The list is then used to mark these queues as -+ * belonging to a large burst if the burst does become large. The main -+ * steps are the following. - * -- * . when the very first queue is activated, the queue is inserted into the -+ * . when the very first queue is created, the queue is inserted into the - * list (as it could be the first queue in a possible burst) - * - * . if the current burst has not yet become large, and a queue Q that does -@@ -772,13 +828,13 @@ static void bfq_add_to_burst(struct bfq_data *bfqd, struct bfq_queue *bfqq) - * - * . the device enters a large-burst mode - * -- * . if a queue Q that does not belong to the burst is activated while -+ * . if a queue Q that does not belong to the burst is created while - * the device is in large-burst mode and shortly after the last time - * at which a queue either entered the burst list or was marked as - * belonging to the current large burst, then Q is immediately marked - * as belonging to a large burst. - * -- * . if a queue Q that does not belong to the burst is activated a while -+ * . if a queue Q that does not belong to the burst is created a while - * later, i.e., not shortly after, than the last time at which a queue - * either entered the burst list or was marked as belonging to the - * current large burst, then the current burst is deemed as finished and: -@@ -791,52 +847,44 @@ static void bfq_add_to_burst(struct bfq_data *bfqd, struct bfq_queue *bfqq) - * in a possible new burst (then the burst list contains just Q - * after this step). - */ --static void bfq_handle_burst(struct bfq_data *bfqd, struct bfq_queue *bfqq, -- bool idle_for_long_time) -+static void bfq_handle_burst(struct bfq_data *bfqd, struct bfq_queue *bfqq) - { - /* -- * If bfqq happened to be activated in a burst, but has been idle -- * for at least as long as an interactive queue, then we assume -- * that, in the overall I/O initiated in the burst, the I/O -- * associated to bfqq is finished. So bfqq does not need to be -- * treated as a queue belonging to a burst anymore. Accordingly, -- * we reset bfqq's in_large_burst flag if set, and remove bfqq -- * from the burst list if it's there. We do not decrement instead -- * burst_size, because the fact that bfqq does not need to belong -- * to the burst list any more does not invalidate the fact that -- * bfqq may have been activated during the current burst. -- */ -- if (idle_for_long_time) { -- hlist_del_init(&bfqq->burst_list_node); -- bfq_clear_bfqq_in_large_burst(bfqq); -- } -- -- /* - * If bfqq is already in the burst list or is part of a large -- * burst, then there is nothing else to do. -+ * burst, or finally has just been split, then there is -+ * nothing else to do. - */ - if (!hlist_unhashed(&bfqq->burst_list_node) || -- bfq_bfqq_in_large_burst(bfqq)) -+ bfq_bfqq_in_large_burst(bfqq) || -+ time_is_after_eq_jiffies(bfqq->split_time + -+ msecs_to_jiffies(10))) - return; - - /* -- * If bfqq's activation happens late enough, then the current -- * burst is finished, and related data structures must be reset. -+ * If bfqq's creation happens late enough, or bfqq belongs to -+ * a different group than the burst group, then the current -+ * burst is finished, and related data structures must be -+ * reset. - * -- * In this respect, consider the special case where bfqq is the very -- * first queue being activated. In this case, last_ins_in_burst is -- * not yet significant when we get here. But it is easy to verify -- * that, whether or not the following condition is true, bfqq will -- * end up being inserted into the burst list. In particular the -- * list will happen to contain only bfqq. And this is exactly what -- * has to happen, as bfqq may be the first queue in a possible -+ * In this respect, consider the special case where bfqq is -+ * the very first queue created after BFQ is selected for this -+ * device. In this case, last_ins_in_burst and -+ * burst_parent_entity are not yet significant when we get -+ * here. But it is easy to verify that, whether or not the -+ * following condition is true, bfqq will end up being -+ * inserted into the burst list. In particular the list will -+ * happen to contain only bfqq. And this is exactly what has -+ * to happen, as bfqq may be the first queue of the first - * burst. - */ - if (time_is_before_jiffies(bfqd->last_ins_in_burst + -- bfqd->bfq_burst_interval)) { -+ bfqd->bfq_burst_interval) || -+ bfqq->entity.parent != bfqd->burst_parent_entity) { - bfqd->large_burst = false; - bfq_reset_burst_list(bfqd, bfqq); -- return; -+ bfq_log_bfqq(bfqd, bfqq, -+ "handle_burst: late activation or different group"); -+ goto end; - } - - /* -@@ -845,8 +893,9 @@ static void bfq_handle_burst(struct bfq_data *bfqd, struct bfq_queue *bfqq, - * bfqq as belonging to this large burst immediately. - */ - if (bfqd->large_burst) { -+ bfq_log_bfqq(bfqd, bfqq, "handle_burst: marked in burst"); - bfq_mark_bfqq_in_large_burst(bfqq); -- return; -+ goto end; - } - - /* -@@ -855,25 +904,491 @@ static void bfq_handle_burst(struct bfq_data *bfqd, struct bfq_queue *bfqq, - * queue. Then we add bfqq to the burst. - */ - bfq_add_to_burst(bfqd, bfqq); -+end: -+ /* -+ * At this point, bfqq either has been added to the current -+ * burst or has caused the current burst to terminate and a -+ * possible new burst to start. In particular, in the second -+ * case, bfqq has become the first queue in the possible new -+ * burst. In both cases last_ins_in_burst needs to be moved -+ * forward. -+ */ -+ bfqd->last_ins_in_burst = jiffies; -+ -+} -+ -+static int bfq_bfqq_budget_left(struct bfq_queue *bfqq) -+{ -+ struct bfq_entity *entity = &bfqq->entity; -+ -+ return entity->budget - entity->service; -+} -+ -+/* -+ * If enough samples have been computed, return the current max budget -+ * stored in bfqd, which is dynamically updated according to the -+ * estimated disk peak rate; otherwise return the default max budget -+ */ -+static int bfq_max_budget(struct bfq_data *bfqd) -+{ -+ if (bfqd->budgets_assigned < bfq_stats_min_budgets) -+ return bfq_default_max_budget; -+ else -+ return bfqd->bfq_max_budget; -+} -+ -+/* -+ * Return min budget, which is a fraction of the current or default -+ * max budget (trying with 1/32) -+ */ -+static int bfq_min_budget(struct bfq_data *bfqd) -+{ -+ if (bfqd->budgets_assigned < bfq_stats_min_budgets) -+ return bfq_default_max_budget / 32; -+ else -+ return bfqd->bfq_max_budget / 32; -+} -+ -+static void bfq_bfqq_expire(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq, -+ bool compensate, -+ enum bfqq_expiration reason); -+ -+/* -+ * The next function, invoked after the input queue bfqq switches from -+ * idle to busy, updates the budget of bfqq. The function also tells -+ * whether the in-service queue should be expired, by returning -+ * true. The purpose of expiring the in-service queue is to give bfqq -+ * the chance to possibly preempt the in-service queue, and the reason -+ * for preempting the in-service queue is to achieve one of the two -+ * goals below. -+ * -+ * 1. Guarantee to bfqq its reserved bandwidth even if bfqq has -+ * expired because it has remained idle. In particular, bfqq may have -+ * expired for one of the following two reasons: -+ * -+ * - BFQ_BFQQ_NO_MORE_REQUEST bfqq did not enjoy any device idling and -+ * did not make it to issue a new request before its last request -+ * was served; -+ * -+ * - BFQ_BFQQ_TOO_IDLE bfqq did enjoy device idling, but did not issue -+ * a new request before the expiration of the idling-time. -+ * -+ * Even if bfqq has expired for one of the above reasons, the process -+ * associated with the queue may be however issuing requests greedily, -+ * and thus be sensitive to the bandwidth it receives (bfqq may have -+ * remained idle for other reasons: CPU high load, bfqq not enjoying -+ * idling, I/O throttling somewhere in the path from the process to -+ * the I/O scheduler, ...). But if, after every expiration for one of -+ * the above two reasons, bfqq has to wait for the service of at least -+ * one full budget of another queue before being served again, then -+ * bfqq is likely to get a much lower bandwidth or resource time than -+ * its reserved ones. To address this issue, two countermeasures need -+ * to be taken. -+ * -+ * First, the budget and the timestamps of bfqq need to be updated in -+ * a special way on bfqq reactivation: they need to be updated as if -+ * bfqq did not remain idle and did not expire. In fact, if they are -+ * computed as if bfqq expired and remained idle until reactivation, -+ * then the process associated with bfqq is treated as if, instead of -+ * being greedy, it stopped issuing requests when bfqq remained idle, -+ * and restarts issuing requests only on this reactivation. In other -+ * words, the scheduler does not help the process recover the "service -+ * hole" between bfqq expiration and reactivation. As a consequence, -+ * the process receives a lower bandwidth than its reserved one. In -+ * contrast, to recover this hole, the budget must be updated as if -+ * bfqq was not expired at all before this reactivation, i.e., it must -+ * be set to the value of the remaining budget when bfqq was -+ * expired. Along the same line, timestamps need to be assigned the -+ * value they had the last time bfqq was selected for service, i.e., -+ * before last expiration. Thus timestamps need to be back-shifted -+ * with respect to their normal computation (see [1] for more details -+ * on this tricky aspect). -+ * -+ * Secondly, to allow the process to recover the hole, the in-service -+ * queue must be expired too, to give bfqq the chance to preempt it -+ * immediately. In fact, if bfqq has to wait for a full budget of the -+ * in-service queue to be completed, then it may become impossible to -+ * let the process recover the hole, even if the back-shifted -+ * timestamps of bfqq are lower than those of the in-service queue. If -+ * this happens for most or all of the holes, then the process may not -+ * receive its reserved bandwidth. In this respect, it is worth noting -+ * that, being the service of outstanding requests unpreemptible, a -+ * little fraction of the holes may however be unrecoverable, thereby -+ * causing a little loss of bandwidth. -+ * -+ * The last important point is detecting whether bfqq does need this -+ * bandwidth recovery. In this respect, the next function deems the -+ * process associated with bfqq greedy, and thus allows it to recover -+ * the hole, if: 1) the process is waiting for the arrival of a new -+ * request (which implies that bfqq expired for one of the above two -+ * reasons), and 2) such a request has arrived soon. The first -+ * condition is controlled through the flag non_blocking_wait_rq, -+ * while the second through the flag arrived_in_time. If both -+ * conditions hold, then the function computes the budget in the -+ * above-described special way, and signals that the in-service queue -+ * should be expired. Timestamp back-shifting is done later in -+ * __bfq_activate_entity. -+ * -+ * 2. Reduce latency. Even if timestamps are not backshifted to let -+ * the process associated with bfqq recover a service hole, bfqq may -+ * however happen to have, after being (re)activated, a lower finish -+ * timestamp than the in-service queue. That is, the next budget of -+ * bfqq may have to be completed before the one of the in-service -+ * queue. If this is the case, then preempting the in-service queue -+ * allows this goal to be achieved, apart from the unpreemptible, -+ * outstanding requests mentioned above. -+ * -+ * Unfortunately, regardless of which of the above two goals one wants -+ * to achieve, service trees need first to be updated to know whether -+ * the in-service queue must be preempted. To have service trees -+ * correctly updated, the in-service queue must be expired and -+ * rescheduled, and bfqq must be scheduled too. This is one of the -+ * most costly operations (in future versions, the scheduling -+ * mechanism may be re-designed in such a way to make it possible to -+ * know whether preemption is needed without needing to update service -+ * trees). In addition, queue preemptions almost always cause random -+ * I/O, and thus loss of throughput. Because of these facts, the next -+ * function adopts the following simple scheme to avoid both costly -+ * operations and too frequent preemptions: it requests the expiration -+ * of the in-service queue (unconditionally) only for queues that need -+ * to recover a hole, or that either are weight-raised or deserve to -+ * be weight-raised. -+ */ -+static bool bfq_bfqq_update_budg_for_activation(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq, -+ bool arrived_in_time, -+ bool wr_or_deserves_wr) -+{ -+ struct bfq_entity *entity = &bfqq->entity; -+ -+ if (bfq_bfqq_non_blocking_wait_rq(bfqq) && arrived_in_time) { -+ /* -+ * We do not clear the flag non_blocking_wait_rq here, as -+ * the latter is used in bfq_activate_bfqq to signal -+ * that timestamps need to be back-shifted (and is -+ * cleared right after). -+ */ -+ -+ /* -+ * In next assignment we rely on that either -+ * entity->service or entity->budget are not updated -+ * on expiration if bfqq is empty (see -+ * __bfq_bfqq_recalc_budget). Thus both quantities -+ * remain unchanged after such an expiration, and the -+ * following statement therefore assigns to -+ * entity->budget the remaining budget on such an -+ * expiration. For clarity, entity->service is not -+ * updated on expiration in any case, and, in normal -+ * operation, is reset only when bfqq is selected for -+ * service (see bfq_get_next_queue). -+ */ -+ BUG_ON(bfqq->max_budget < 0); -+ entity->budget = min_t(unsigned long, -+ bfq_bfqq_budget_left(bfqq), -+ bfqq->max_budget); -+ -+ BUG_ON(entity->budget < 0); -+ return true; -+ } -+ -+ BUG_ON(bfqq->max_budget < 0); -+ entity->budget = max_t(unsigned long, bfqq->max_budget, -+ bfq_serv_to_charge(bfqq->next_rq, bfqq)); -+ BUG_ON(entity->budget < 0); -+ -+ bfq_clear_bfqq_non_blocking_wait_rq(bfqq); -+ return wr_or_deserves_wr; -+} -+ -+static void bfq_update_bfqq_wr_on_rq_arrival(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq, -+ unsigned int old_wr_coeff, -+ bool wr_or_deserves_wr, -+ bool interactive, -+ bool in_burst, -+ bool soft_rt) -+{ -+ if (old_wr_coeff == 1 && wr_or_deserves_wr) { -+ /* start a weight-raising period */ -+ if (interactive) { -+ bfqq->wr_coeff = bfqd->bfq_wr_coeff; -+ bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); -+ } else { -+ bfqq->wr_start_at_switch_to_srt = jiffies; -+ bfqq->wr_coeff = bfqd->bfq_wr_coeff * -+ BFQ_SOFTRT_WEIGHT_FACTOR; -+ bfqq->wr_cur_max_time = -+ bfqd->bfq_wr_rt_max_time; -+ } -+ /* -+ * If needed, further reduce budget to make sure it is -+ * close to bfqq's backlog, so as to reduce the -+ * scheduling-error component due to a too large -+ * budget. Do not care about throughput consequences, -+ * but only about latency. Finally, do not assign a -+ * too small budget either, to avoid increasing -+ * latency by causing too frequent expirations. -+ */ -+ bfqq->entity.budget = min_t(unsigned long, -+ bfqq->entity.budget, -+ 2 * bfq_min_budget(bfqd)); -+ -+ bfq_log_bfqq(bfqd, bfqq, -+ "wrais starting at %lu, rais_max_time %u", -+ jiffies, -+ jiffies_to_msecs(bfqq->wr_cur_max_time)); -+ } else if (old_wr_coeff > 1) { -+ if (interactive) { /* update wr coeff and duration */ -+ bfqq->wr_coeff = bfqd->bfq_wr_coeff; -+ bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); -+ } else if (in_burst) { -+ bfqq->wr_coeff = 1; -+ bfq_log_bfqq(bfqd, bfqq, -+ "wrais ending at %lu, rais_max_time %u", -+ jiffies, -+ jiffies_to_msecs(bfqq-> -+ wr_cur_max_time)); -+ } else if (soft_rt) { -+ /* -+ * The application is now or still meeting the -+ * requirements for being deemed soft rt. We -+ * can then correctly and safely (re)charge -+ * the weight-raising duration for the -+ * application with the weight-raising -+ * duration for soft rt applications. -+ * -+ * In particular, doing this recharge now, i.e., -+ * before the weight-raising period for the -+ * application finishes, reduces the probability -+ * of the following negative scenario: -+ * 1) the weight of a soft rt application is -+ * raised at startup (as for any newly -+ * created application), -+ * 2) since the application is not interactive, -+ * at a certain time weight-raising is -+ * stopped for the application, -+ * 3) at that time the application happens to -+ * still have pending requests, and hence -+ * is destined to not have a chance to be -+ * deemed soft rt before these requests are -+ * completed (see the comments to the -+ * function bfq_bfqq_softrt_next_start() -+ * for details on soft rt detection), -+ * 4) these pending requests experience a high -+ * latency because the application is not -+ * weight-raised while they are pending. -+ */ -+ if (bfqq->wr_cur_max_time != -+ bfqd->bfq_wr_rt_max_time) { -+ bfqq->wr_start_at_switch_to_srt = -+ bfqq->last_wr_start_finish; -+ BUG_ON(time_is_after_jiffies(bfqq->last_wr_start_finish)); -+ -+ bfqq->wr_cur_max_time = -+ bfqd->bfq_wr_rt_max_time; -+ bfqq->wr_coeff = bfqd->bfq_wr_coeff * -+ BFQ_SOFTRT_WEIGHT_FACTOR; -+ bfq_log_bfqq(bfqd, bfqq, -+ "switching to soft_rt wr"); -+ } else -+ bfq_log_bfqq(bfqd, bfqq, -+ "moving forward soft_rt wr duration"); -+ bfqq->last_wr_start_finish = jiffies; -+ } -+ } -+} -+ -+static bool bfq_bfqq_idle_for_long_time(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq) -+{ -+ return bfqq->dispatched == 0 && -+ time_is_before_jiffies( -+ bfqq->budget_timeout + -+ bfqd->bfq_wr_min_idle_time); -+} -+ -+static void bfq_bfqq_handle_idle_busy_switch(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq, -+ int old_wr_coeff, -+ struct request *rq, -+ bool *interactive) -+{ -+ bool soft_rt, in_burst, wr_or_deserves_wr, -+ bfqq_wants_to_preempt, -+ idle_for_long_time = bfq_bfqq_idle_for_long_time(bfqd, bfqq), -+ /* -+ * See the comments on -+ * bfq_bfqq_update_budg_for_activation for -+ * details on the usage of the next variable. -+ */ -+ arrived_in_time = ktime_get_ns() <= -+ RQ_BIC(rq)->ttime.last_end_request + -+ bfqd->bfq_slice_idle * 3; -+ -+ bfq_log_bfqq(bfqd, bfqq, -+ "bfq_add_request non-busy: " -+ "jiffies %lu, in_time %d, idle_long %d busyw %d " -+ "wr_coeff %u", -+ jiffies, arrived_in_time, -+ idle_for_long_time, -+ bfq_bfqq_non_blocking_wait_rq(bfqq), -+ old_wr_coeff); -+ -+ BUG_ON(bfqq->entity.budget < bfqq->entity.service); -+ -+ BUG_ON(bfqq == bfqd->in_service_queue); -+ bfqg_stats_update_io_add(bfqq_group(RQ_BFQQ(rq)), bfqq, -+ req_op(rq), rq->cmd_flags); -+ -+ /* -+ * bfqq deserves to be weight-raised if: -+ * - it is sync, -+ * - it does not belong to a large burst, -+ * - it has been idle for enough time or is soft real-time, -+ * - is linked to a bfq_io_cq (it is not shared in any sense) -+ */ -+ in_burst = bfq_bfqq_in_large_burst(bfqq); -+ soft_rt = bfqd->bfq_wr_max_softrt_rate > 0 && -+ !in_burst && -+ time_is_before_jiffies(bfqq->soft_rt_next_start); -+ *interactive = -+ !in_burst && -+ idle_for_long_time; -+ wr_or_deserves_wr = bfqd->low_latency && -+ (bfqq->wr_coeff > 1 || -+ (bfq_bfqq_sync(bfqq) && -+ bfqq->bic && (*interactive || soft_rt))); -+ -+ bfq_log_bfqq(bfqd, bfqq, -+ "bfq_add_request: " -+ "in_burst %d, " -+ "soft_rt %d (next %lu), inter %d, bic %p", -+ bfq_bfqq_in_large_burst(bfqq), soft_rt, -+ bfqq->soft_rt_next_start, -+ *interactive, -+ bfqq->bic); -+ -+ /* -+ * Using the last flag, update budget and check whether bfqq -+ * may want to preempt the in-service queue. -+ */ -+ bfqq_wants_to_preempt = -+ bfq_bfqq_update_budg_for_activation(bfqd, bfqq, -+ arrived_in_time, -+ wr_or_deserves_wr); -+ -+ /* -+ * If bfqq happened to be activated in a burst, but has been -+ * idle for much more than an interactive queue, then we -+ * assume that, in the overall I/O initiated in the burst, the -+ * I/O associated with bfqq is finished. So bfqq does not need -+ * to be treated as a queue belonging to a burst -+ * anymore. Accordingly, we reset bfqq's in_large_burst flag -+ * if set, and remove bfqq from the burst list if it's -+ * there. We do not decrement burst_size, because the fact -+ * that bfqq does not need to belong to the burst list any -+ * more does not invalidate the fact that bfqq was created in -+ * a burst. -+ */ -+ if (likely(!bfq_bfqq_just_created(bfqq)) && -+ idle_for_long_time && -+ time_is_before_jiffies( -+ bfqq->budget_timeout + -+ msecs_to_jiffies(10000))) { -+ hlist_del_init(&bfqq->burst_list_node); -+ bfq_clear_bfqq_in_large_burst(bfqq); -+ } -+ -+ bfq_clear_bfqq_just_created(bfqq); -+ -+ if (!bfq_bfqq_IO_bound(bfqq)) { -+ if (arrived_in_time) { -+ bfqq->requests_within_timer++; -+ if (bfqq->requests_within_timer >= -+ bfqd->bfq_requests_within_timer) -+ bfq_mark_bfqq_IO_bound(bfqq); -+ } else -+ bfqq->requests_within_timer = 0; -+ bfq_log_bfqq(bfqd, bfqq, "requests in time %d", -+ bfqq->requests_within_timer); -+ } -+ -+ if (bfqd->low_latency) { -+ if (unlikely(time_is_after_jiffies(bfqq->split_time))) -+ /* wraparound */ -+ bfqq->split_time = -+ jiffies - bfqd->bfq_wr_min_idle_time - 1; -+ -+ if (time_is_before_jiffies(bfqq->split_time + -+ bfqd->bfq_wr_min_idle_time)) { -+ bfq_update_bfqq_wr_on_rq_arrival(bfqd, bfqq, -+ old_wr_coeff, -+ wr_or_deserves_wr, -+ *interactive, -+ in_burst, -+ soft_rt); -+ -+ if (old_wr_coeff != bfqq->wr_coeff) -+ bfqq->entity.prio_changed = 1; -+ } -+ } -+ -+ bfqq->last_idle_bklogged = jiffies; -+ bfqq->service_from_backlogged = 0; -+ bfq_clear_bfqq_softrt_update(bfqq); -+ -+ bfq_add_bfqq_busy(bfqd, bfqq); -+ -+ /* -+ * Expire in-service queue only if preemption may be needed -+ * for guarantees. In this respect, the function -+ * next_queue_may_preempt just checks a simple, necessary -+ * condition, and not a sufficient condition based on -+ * timestamps. In fact, for the latter condition to be -+ * evaluated, timestamps would need first to be updated, and -+ * this operation is quite costly (see the comments on the -+ * function bfq_bfqq_update_budg_for_activation). -+ */ -+ if (bfqd->in_service_queue && bfqq_wants_to_preempt && -+ bfqd->in_service_queue->wr_coeff < bfqq->wr_coeff && -+ next_queue_may_preempt(bfqd)) { -+ struct bfq_queue *in_serv = -+ bfqd->in_service_queue; -+ BUG_ON(in_serv == bfqq); -+ -+ bfq_bfqq_expire(bfqd, bfqd->in_service_queue, -+ false, BFQ_BFQQ_PREEMPTED); -+ BUG_ON(in_serv->entity.budget < 0); -+ } - } - - static void bfq_add_request(struct request *rq) - { - struct bfq_queue *bfqq = RQ_BFQQ(rq); -- struct bfq_entity *entity = &bfqq->entity; - struct bfq_data *bfqd = bfqq->bfqd; - struct request *next_rq, *prev; -- unsigned long old_wr_coeff = bfqq->wr_coeff; -+ unsigned int old_wr_coeff = bfqq->wr_coeff; - bool interactive = false; - -- bfq_log_bfqq(bfqd, bfqq, "add_request %d", rq_is_sync(rq)); -+ bfq_log_bfqq(bfqd, bfqq, "add_request: size %u %s", -+ blk_rq_sectors(rq), rq_is_sync(rq) ? "S" : "A"); -+ -+ if (bfqq->wr_coeff > 1) /* queue is being weight-raised */ -+ bfq_log_bfqq(bfqd, bfqq, -+ "raising period dur %u/%u msec, old coeff %u, w %d(%d)", -+ jiffies_to_msecs(jiffies - bfqq->last_wr_start_finish), -+ jiffies_to_msecs(bfqq->wr_cur_max_time), -+ bfqq->wr_coeff, -+ bfqq->entity.weight, bfqq->entity.orig_weight); -+ - bfqq->queued[rq_is_sync(rq)]++; - bfqd->queued++; - - elv_rb_add(&bfqq->sort_list, rq); - - /* -- * Check if this request is a better next-serve candidate. -+ * Check if this request is a better next-to-serve candidate. - */ - prev = bfqq->next_rq; - next_rq = bfq_choose_req(bfqd, bfqq->next_rq, rq, bfqd->last_position); -@@ -886,160 +1401,10 @@ static void bfq_add_request(struct request *rq) - if (prev != bfqq->next_rq) - bfq_pos_tree_add_move(bfqd, bfqq); - -- if (!bfq_bfqq_busy(bfqq)) { -- bool soft_rt, coop_or_in_burst, -- idle_for_long_time = time_is_before_jiffies( -- bfqq->budget_timeout + -- bfqd->bfq_wr_min_idle_time); -- --#ifdef CONFIG_BFQ_GROUP_IOSCHED -- bfqg_stats_update_io_add(bfqq_group(RQ_BFQQ(rq)), bfqq, -- rq->cmd_flags); --#endif -- if (bfq_bfqq_sync(bfqq)) { -- bool already_in_burst = -- !hlist_unhashed(&bfqq->burst_list_node) || -- bfq_bfqq_in_large_burst(bfqq); -- bfq_handle_burst(bfqd, bfqq, idle_for_long_time); -- /* -- * If bfqq was not already in the current burst, -- * then, at this point, bfqq either has been -- * added to the current burst or has caused the -- * current burst to terminate. In particular, in -- * the second case, bfqq has become the first -- * queue in a possible new burst. -- * In both cases last_ins_in_burst needs to be -- * moved forward. -- */ -- if (!already_in_burst) -- bfqd->last_ins_in_burst = jiffies; -- } -- -- coop_or_in_burst = bfq_bfqq_in_large_burst(bfqq) || -- bfq_bfqq_cooperations(bfqq) >= bfqd->bfq_coop_thresh; -- soft_rt = bfqd->bfq_wr_max_softrt_rate > 0 && -- !coop_or_in_burst && -- time_is_before_jiffies(bfqq->soft_rt_next_start); -- interactive = !coop_or_in_burst && idle_for_long_time; -- entity->budget = max_t(unsigned long, bfqq->max_budget, -- bfq_serv_to_charge(next_rq, bfqq)); -- -- if (!bfq_bfqq_IO_bound(bfqq)) { -- if (time_before(jiffies, -- RQ_BIC(rq)->ttime.last_end_request + -- bfqd->bfq_slice_idle)) { -- bfqq->requests_within_timer++; -- if (bfqq->requests_within_timer >= -- bfqd->bfq_requests_within_timer) -- bfq_mark_bfqq_IO_bound(bfqq); -- } else -- bfqq->requests_within_timer = 0; -- } -- -- if (!bfqd->low_latency) -- goto add_bfqq_busy; -- -- if (bfq_bfqq_just_split(bfqq)) -- goto set_prio_changed; -- -- /* -- * If the queue: -- * - is not being boosted, -- * - has been idle for enough time, -- * - is not a sync queue or is linked to a bfq_io_cq (it is -- * shared "for its nature" or it is not shared and its -- * requests have not been redirected to a shared queue) -- * start a weight-raising period. -- */ -- if (old_wr_coeff == 1 && (interactive || soft_rt) && -- (!bfq_bfqq_sync(bfqq) || bfqq->bic)) { -- bfqq->wr_coeff = bfqd->bfq_wr_coeff; -- if (interactive) -- bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); -- else -- bfqq->wr_cur_max_time = -- bfqd->bfq_wr_rt_max_time; -- bfq_log_bfqq(bfqd, bfqq, -- "wrais starting at %lu, rais_max_time %u", -- jiffies, -- jiffies_to_msecs(bfqq->wr_cur_max_time)); -- } else if (old_wr_coeff > 1) { -- if (interactive) -- bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); -- else if (coop_or_in_burst || -- (bfqq->wr_cur_max_time == -- bfqd->bfq_wr_rt_max_time && -- !soft_rt)) { -- bfqq->wr_coeff = 1; -- bfq_log_bfqq(bfqd, bfqq, -- "wrais ending at %lu, rais_max_time %u", -- jiffies, -- jiffies_to_msecs(bfqq-> -- wr_cur_max_time)); -- } else if (time_before( -- bfqq->last_wr_start_finish + -- bfqq->wr_cur_max_time, -- jiffies + -- bfqd->bfq_wr_rt_max_time) && -- soft_rt) { -- /* -- * -- * The remaining weight-raising time is lower -- * than bfqd->bfq_wr_rt_max_time, which means -- * that the application is enjoying weight -- * raising either because deemed soft-rt in -- * the near past, or because deemed interactive -- * a long ago. -- * In both cases, resetting now the current -- * remaining weight-raising time for the -- * application to the weight-raising duration -- * for soft rt applications would not cause any -- * latency increase for the application (as the -- * new duration would be higher than the -- * remaining time). -- * -- * In addition, the application is now meeting -- * the requirements for being deemed soft rt. -- * In the end we can correctly and safely -- * (re)charge the weight-raising duration for -- * the application with the weight-raising -- * duration for soft rt applications. -- * -- * In particular, doing this recharge now, i.e., -- * before the weight-raising period for the -- * application finishes, reduces the probability -- * of the following negative scenario: -- * 1) the weight of a soft rt application is -- * raised at startup (as for any newly -- * created application), -- * 2) since the application is not interactive, -- * at a certain time weight-raising is -- * stopped for the application, -- * 3) at that time the application happens to -- * still have pending requests, and hence -- * is destined to not have a chance to be -- * deemed soft rt before these requests are -- * completed (see the comments to the -- * function bfq_bfqq_softrt_next_start() -- * for details on soft rt detection), -- * 4) these pending requests experience a high -- * latency because the application is not -- * weight-raised while they are pending. -- */ -- bfqq->last_wr_start_finish = jiffies; -- bfqq->wr_cur_max_time = -- bfqd->bfq_wr_rt_max_time; -- } -- } --set_prio_changed: -- if (old_wr_coeff != bfqq->wr_coeff) -- entity->prio_changed = 1; --add_bfqq_busy: -- bfqq->last_idle_bklogged = jiffies; -- bfqq->service_from_backlogged = 0; -- bfq_clear_bfqq_softrt_update(bfqq); -- bfq_add_bfqq_busy(bfqd, bfqq); -- } else { -+ if (!bfq_bfqq_busy(bfqq)) /* switching to busy ... */ -+ bfq_bfqq_handle_idle_busy_switch(bfqd, bfqq, old_wr_coeff, -+ rq, &interactive); -+ else { - if (bfqd->low_latency && old_wr_coeff == 1 && !rq_is_sync(rq) && - time_is_before_jiffies( - bfqq->last_wr_start_finish + -@@ -1048,16 +1413,43 @@ static void bfq_add_request(struct request *rq) - bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); - - bfqd->wr_busy_queues++; -- entity->prio_changed = 1; -+ bfqq->entity.prio_changed = 1; - bfq_log_bfqq(bfqd, bfqq, -- "non-idle wrais starting at %lu, rais_max_time %u", -- jiffies, -- jiffies_to_msecs(bfqq->wr_cur_max_time)); -+ "non-idle wrais starting, " -+ "wr_max_time %u wr_busy %d", -+ jiffies_to_msecs(bfqq->wr_cur_max_time), -+ bfqd->wr_busy_queues); - } - if (prev != bfqq->next_rq) - bfq_updated_next_req(bfqd, bfqq); - } - -+ /* -+ * Assign jiffies to last_wr_start_finish in the following -+ * cases: -+ * -+ * . if bfqq is not going to be weight-raised, because, for -+ * non weight-raised queues, last_wr_start_finish stores the -+ * arrival time of the last request; as of now, this piece -+ * of information is used only for deciding whether to -+ * weight-raise async queues -+ * -+ * . if bfqq is not weight-raised, because, if bfqq is now -+ * switching to weight-raised, then last_wr_start_finish -+ * stores the time when weight-raising starts -+ * -+ * . if bfqq is interactive, because, regardless of whether -+ * bfqq is currently weight-raised, the weight-raising -+ * period must start or restart (this case is considered -+ * separately because it is not detected by the above -+ * conditions, if bfqq is already weight-raised) -+ * -+ * last_wr_start_finish has to be updated also if bfqq is soft -+ * real-time, because the weight-raising period is constantly -+ * restarted on idle-to-busy transitions for these queues, but -+ * this is already done in bfq_bfqq_handle_idle_busy_switch if -+ * needed. -+ */ - if (bfqd->low_latency && - (old_wr_coeff == 1 || bfqq->wr_coeff == 1 || interactive)) - bfqq->last_wr_start_finish = jiffies; -@@ -1081,14 +1473,24 @@ static struct request *bfq_find_rq_fmerge(struct bfq_data *bfqd, - return NULL; - } - -+static sector_t get_sdist(sector_t last_pos, struct request *rq) -+{ -+ sector_t sdist = 0; -+ -+ if (last_pos) { -+ if (last_pos < blk_rq_pos(rq)) -+ sdist = blk_rq_pos(rq) - last_pos; -+ else -+ sdist = last_pos - blk_rq_pos(rq); -+ } -+ -+ return sdist; -+} -+ - static void bfq_activate_request(struct request_queue *q, struct request *rq) - { - struct bfq_data *bfqd = q->elevator->elevator_data; -- - bfqd->rq_in_driver++; -- bfqd->last_position = blk_rq_pos(rq) + blk_rq_sectors(rq); -- bfq_log(bfqd, "activate_request: new bfqd->last_position %llu", -- (unsigned long long) bfqd->last_position); - } - - static void bfq_deactivate_request(struct request_queue *q, struct request *rq) -@@ -1105,6 +1507,9 @@ static void bfq_remove_request(struct request *rq) - struct bfq_data *bfqd = bfqq->bfqd; - const int sync = rq_is_sync(rq); - -+ BUG_ON(bfqq->entity.service > bfqq->entity.budget && -+ bfqq == bfqd->in_service_queue); -+ - if (bfqq->next_rq == rq) { - bfqq->next_rq = bfq_find_next_rq(bfqd, bfqq, rq); - bfq_updated_next_req(bfqd, bfqq); -@@ -1118,8 +1523,25 @@ static void bfq_remove_request(struct request *rq) - elv_rb_del(&bfqq->sort_list, rq); - - if (RB_EMPTY_ROOT(&bfqq->sort_list)) { -- if (bfq_bfqq_busy(bfqq) && bfqq != bfqd->in_service_queue) -- bfq_del_bfqq_busy(bfqd, bfqq, 1); -+ BUG_ON(bfqq->entity.budget < 0); -+ -+ if (bfq_bfqq_busy(bfqq) && bfqq != bfqd->in_service_queue) { -+ bfq_del_bfqq_busy(bfqd, bfqq, false); -+ -+ /* bfqq emptied. In normal operation, when -+ * bfqq is empty, bfqq->entity.service and -+ * bfqq->entity.budget must contain, -+ * respectively, the service received and the -+ * budget used last time bfqq emptied. These -+ * facts do not hold in this case, as at least -+ * this last removal occurred while bfqq is -+ * not in service. To avoid inconsistencies, -+ * reset both bfqq->entity.service and -+ * bfqq->entity.budget. -+ */ -+ bfqq->entity.budget = bfqq->entity.service = 0; -+ } -+ - /* - * Remove queue from request-position tree as it is empty. - */ -@@ -1133,9 +1555,8 @@ static void bfq_remove_request(struct request *rq) - BUG_ON(bfqq->meta_pending == 0); - bfqq->meta_pending--; - } --#ifdef CONFIG_BFQ_GROUP_IOSCHED -- bfqg_stats_update_io_remove(bfqq_group(bfqq), rq->cmd_flags); --#endif -+ bfqg_stats_update_io_remove(bfqq_group(bfqq), req_op(rq), -+ rq->cmd_flags); - } - - static int bfq_merge(struct request_queue *q, struct request **req, -@@ -1145,7 +1566,7 @@ static int bfq_merge(struct request_queue *q, struct request **req, - struct request *__rq; - - __rq = bfq_find_rq_fmerge(bfqd, bio); -- if (__rq && elv_rq_merge_ok(__rq, bio)) { -+ if (__rq && elv_bio_merge_ok(__rq, bio)) { - *req = __rq; - return ELEVATOR_FRONT_MERGE; - } -@@ -1190,7 +1611,8 @@ static void bfq_merged_request(struct request_queue *q, struct request *req, - static void bfq_bio_merged(struct request_queue *q, struct request *req, - struct bio *bio) - { -- bfqg_stats_update_io_merged(bfqq_group(RQ_BFQQ(req)), bio->bi_rw); -+ bfqg_stats_update_io_merged(bfqq_group(RQ_BFQQ(req)), bio_op(bio), -+ bio->bi_opf); - } - #endif - -@@ -1210,7 +1632,7 @@ static void bfq_merged_requests(struct request_queue *q, struct request *rq, - */ - if (bfqq == next_bfqq && - !list_empty(&rq->queuelist) && !list_empty(&next->queuelist) && -- time_before(next->fifo_time, rq->fifo_time)) { -+ next->fifo_time < rq->fifo_time) { - list_del_init(&rq->queuelist); - list_replace_init(&next->queuelist, &rq->queuelist); - rq->fifo_time = next->fifo_time; -@@ -1220,21 +1642,31 @@ static void bfq_merged_requests(struct request_queue *q, struct request *rq, - bfqq->next_rq = rq; - - bfq_remove_request(next); --#ifdef CONFIG_BFQ_GROUP_IOSCHED -- bfqg_stats_update_io_merged(bfqq_group(bfqq), next->cmd_flags); --#endif -+ bfqg_stats_update_io_merged(bfqq_group(bfqq), req_op(next), -+ next->cmd_flags); - } - - /* Must be called with bfqq != NULL */ - static void bfq_bfqq_end_wr(struct bfq_queue *bfqq) - { - BUG_ON(!bfqq); -+ - if (bfq_bfqq_busy(bfqq)) - bfqq->bfqd->wr_busy_queues--; - bfqq->wr_coeff = 1; - bfqq->wr_cur_max_time = 0; -- /* Trigger a weight change on the next activation of the queue */ -+ bfqq->last_wr_start_finish = jiffies; -+ /* -+ * Trigger a weight change on the next invocation of -+ * __bfq_entity_update_weight_prio. -+ */ - bfqq->entity.prio_changed = 1; -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "end_wr: wrais ending at %lu, rais_max_time %u", -+ bfqq->last_wr_start_finish, -+ jiffies_to_msecs(bfqq->wr_cur_max_time)); -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "end_wr: wr_busy %d", -+ bfqq->bfqd->wr_busy_queues); - } - - static void bfq_end_wr_async_queues(struct bfq_data *bfqd, -@@ -1277,7 +1709,7 @@ static int bfq_rq_close_to_sector(void *io_struct, bool request, - sector_t sector) - { - return abs(bfq_io_struct_pos(io_struct, request) - sector) <= -- BFQQ_SEEK_THR; -+ BFQQ_CLOSE_THR; - } - - static struct bfq_queue *bfqq_find_close(struct bfq_data *bfqd, -@@ -1399,7 +1831,7 @@ bfq_setup_merge(struct bfq_queue *bfqq, struct bfq_queue *new_bfqq) - * throughput. - */ - bfqq->new_bfqq = new_bfqq; -- atomic_add(process_refs, &new_bfqq->ref); -+ new_bfqq->ref += process_refs; - return new_bfqq; - } - -@@ -1430,9 +1862,23 @@ static bool bfq_may_be_close_cooperator(struct bfq_queue *bfqq, - } - - /* -- * Attempt to schedule a merge of bfqq with the currently in-service queue -- * or with a close queue among the scheduled queues. -- * Return NULL if no merge was scheduled, a pointer to the shared bfq_queue -+ * If this function returns true, then bfqq cannot be merged. The idea -+ * is that true cooperation happens very early after processes start -+ * to do I/O. Usually, late cooperations are just accidental false -+ * positives. In case bfqq is weight-raised, such false positives -+ * would evidently degrade latency guarantees for bfqq. -+ */ -+bool wr_from_too_long(struct bfq_queue *bfqq) -+{ -+ return bfqq->wr_coeff > 1 && -+ time_is_before_jiffies(bfqq->last_wr_start_finish + -+ msecs_to_jiffies(100)); -+} -+ -+/* -+ * Attempt to schedule a merge of bfqq with the currently in-service -+ * queue or with a close queue among the scheduled queues. Return -+ * NULL if no merge was scheduled, a pointer to the shared bfq_queue - * structure otherwise. - * - * The OOM queue is not allowed to participate to cooperation: in fact, since -@@ -1441,6 +1887,18 @@ static bool bfq_may_be_close_cooperator(struct bfq_queue *bfqq, - * handle merging with the OOM queue would be quite complex and expensive - * to maintain. Besides, in such a critical condition as an out of memory, - * the benefits of queue merging may be little relevant, or even negligible. -+ * -+ * Weight-raised queues can be merged only if their weight-raising -+ * period has just started. In fact cooperating processes are usually -+ * started together. Thus, with this filter we avoid false positives -+ * that would jeopardize low-latency guarantees. -+ * -+ * WARNING: queue merging may impair fairness among non-weight raised -+ * queues, for at least two reasons: 1) the original weight of a -+ * merged queue may change during the merged state, 2) even being the -+ * weight the same, a merged queue may be bloated with many more -+ * requests than the ones produced by its originally-associated -+ * process. - */ - static struct bfq_queue * - bfq_setup_cooperator(struct bfq_data *bfqd, struct bfq_queue *bfqq, -@@ -1450,16 +1908,32 @@ bfq_setup_cooperator(struct bfq_data *bfqd, struct bfq_queue *bfqq, - - if (bfqq->new_bfqq) - return bfqq->new_bfqq; -- if (!io_struct || unlikely(bfqq == &bfqd->oom_bfqq)) -+ -+ if (io_struct && wr_from_too_long(bfqq) && -+ likely(bfqq != &bfqd->oom_bfqq)) -+ bfq_log_bfqq(bfqd, bfqq, -+ "would have looked for coop, but bfq%d wr", -+ bfqq->pid); -+ -+ if (!io_struct || -+ wr_from_too_long(bfqq) || -+ unlikely(bfqq == &bfqd->oom_bfqq)) - return NULL; -- /* If device has only one backlogged bfq_queue, don't search. */ -+ -+ /* If there is only one backlogged queue, don't search. */ - if (bfqd->busy_queues == 1) - return NULL; - - in_service_bfqq = bfqd->in_service_queue; - -+ if (in_service_bfqq && in_service_bfqq != bfqq && -+ bfqd->in_service_bic && wr_from_too_long(in_service_bfqq) -+ && likely(in_service_bfqq == &bfqd->oom_bfqq)) -+ bfq_log_bfqq(bfqd, bfqq, -+ "would have tried merge with in-service-queue, but wr"); -+ - if (!in_service_bfqq || in_service_bfqq == bfqq || -- !bfqd->in_service_bic || -+ !bfqd->in_service_bic || wr_from_too_long(in_service_bfqq) || - unlikely(in_service_bfqq == &bfqd->oom_bfqq)) - goto check_scheduled; - -@@ -1481,7 +1955,15 @@ bfq_setup_cooperator(struct bfq_data *bfqd, struct bfq_queue *bfqq, - - BUG_ON(new_bfqq && bfqq->entity.parent != new_bfqq->entity.parent); - -- if (new_bfqq && likely(new_bfqq != &bfqd->oom_bfqq) && -+ if (new_bfqq && wr_from_too_long(new_bfqq) && -+ likely(new_bfqq != &bfqd->oom_bfqq) && -+ bfq_may_be_close_cooperator(bfqq, new_bfqq)) -+ bfq_log_bfqq(bfqd, bfqq, -+ "would have merged with bfq%d, but wr", -+ new_bfqq->pid); -+ -+ if (new_bfqq && !wr_from_too_long(new_bfqq) && -+ likely(new_bfqq != &bfqd->oom_bfqq) && - bfq_may_be_close_cooperator(bfqq, new_bfqq)) - return bfq_setup_merge(bfqq, new_bfqq); - -@@ -1490,53 +1972,25 @@ bfq_setup_cooperator(struct bfq_data *bfqd, struct bfq_queue *bfqq, - - static void bfq_bfqq_save_state(struct bfq_queue *bfqq) - { -+ struct bfq_io_cq *bic = bfqq->bic; -+ - /* - * If !bfqq->bic, the queue is already shared or its requests - * have already been redirected to a shared queue; both idle window - * and weight raising state have already been saved. Do nothing. - */ -- if (!bfqq->bic) -+ if (!bic) - return; -- if (bfqq->bic->wr_time_left) -- /* -- * This is the queue of a just-started process, and would -- * deserve weight raising: we set wr_time_left to the full -- * weight-raising duration to trigger weight-raising when -- * and if the queue is split and the first request of the -- * queue is enqueued. -- */ -- bfqq->bic->wr_time_left = bfq_wr_duration(bfqq->bfqd); -- else if (bfqq->wr_coeff > 1) { -- unsigned long wr_duration = -- jiffies - bfqq->last_wr_start_finish; -- /* -- * It may happen that a queue's weight raising period lasts -- * longer than its wr_cur_max_time, as weight raising is -- * handled only when a request is enqueued or dispatched (it -- * does not use any timer). If the weight raising period is -- * about to end, don't save it. -- */ -- if (bfqq->wr_cur_max_time <= wr_duration) -- bfqq->bic->wr_time_left = 0; -- else -- bfqq->bic->wr_time_left = -- bfqq->wr_cur_max_time - wr_duration; -- /* -- * The bfq_queue is becoming shared or the requests of the -- * process owning the queue are being redirected to a shared -- * queue. Stop the weight raising period of the queue, as in -- * both cases it should not be owned by an interactive or -- * soft real-time application. -- */ -- bfq_bfqq_end_wr(bfqq); -- } else -- bfqq->bic->wr_time_left = 0; -- bfqq->bic->saved_idle_window = bfq_bfqq_idle_window(bfqq); -- bfqq->bic->saved_IO_bound = bfq_bfqq_IO_bound(bfqq); -- bfqq->bic->saved_in_large_burst = bfq_bfqq_in_large_burst(bfqq); -- bfqq->bic->was_in_burst_list = !hlist_unhashed(&bfqq->burst_list_node); -- bfqq->bic->cooperations++; -- bfqq->bic->failed_cooperations = 0; -+ -+ bic->saved_idle_window = bfq_bfqq_idle_window(bfqq); -+ bic->saved_IO_bound = bfq_bfqq_IO_bound(bfqq); -+ bic->saved_in_large_burst = bfq_bfqq_in_large_burst(bfqq); -+ bic->was_in_burst_list = !hlist_unhashed(&bfqq->burst_list_node); -+ bic->saved_wr_coeff = bfqq->wr_coeff; -+ bic->saved_wr_start_at_switch_to_srt = bfqq->wr_start_at_switch_to_srt; -+ bic->saved_last_wr_start_finish = bfqq->last_wr_start_finish; -+ bic->saved_wr_cur_max_time = bfqq->wr_cur_max_time; -+ BUG_ON(time_is_after_jiffies(bfqq->last_wr_start_finish)); - } - - static void bfq_get_bic_reference(struct bfq_queue *bfqq) -@@ -1561,6 +2015,40 @@ bfq_merge_bfqqs(struct bfq_data *bfqd, struct bfq_io_cq *bic, - if (bfq_bfqq_IO_bound(bfqq)) - bfq_mark_bfqq_IO_bound(new_bfqq); - bfq_clear_bfqq_IO_bound(bfqq); -+ -+ /* -+ * If bfqq is weight-raised, then let new_bfqq inherit -+ * weight-raising. To reduce false positives, neglect the case -+ * where bfqq has just been created, but has not yet made it -+ * to be weight-raised (which may happen because EQM may merge -+ * bfqq even before bfq_add_request is executed for the first -+ * time for bfqq). Handling this case would however be very -+ * easy, thanks to the flag just_created. -+ */ -+ if (new_bfqq->wr_coeff == 1 && bfqq->wr_coeff > 1) { -+ new_bfqq->wr_coeff = bfqq->wr_coeff; -+ new_bfqq->wr_cur_max_time = bfqq->wr_cur_max_time; -+ new_bfqq->last_wr_start_finish = bfqq->last_wr_start_finish; -+ new_bfqq->wr_start_at_switch_to_srt = bfqq->wr_start_at_switch_to_srt; -+ if (bfq_bfqq_busy(new_bfqq)) -+ bfqd->wr_busy_queues++; -+ new_bfqq->entity.prio_changed = 1; -+ bfq_log_bfqq(bfqd, new_bfqq, -+ "wr start after merge with %d, rais_max_time %u", -+ bfqq->pid, -+ jiffies_to_msecs(bfqq->wr_cur_max_time)); -+ } -+ -+ if (bfqq->wr_coeff > 1) { /* bfqq has given its wr to new_bfqq */ -+ bfqq->wr_coeff = 1; -+ bfqq->entity.prio_changed = 1; -+ if (bfq_bfqq_busy(bfqq)) -+ bfqd->wr_busy_queues--; -+ } -+ -+ bfq_log_bfqq(bfqd, new_bfqq, "merge_bfqqs: wr_busy %d", -+ bfqd->wr_busy_queues); -+ - /* - * Grab a reference to the bic, to prevent it from being destroyed - * before being possibly touched by a bfq_split_bfqq(). -@@ -1587,20 +2075,8 @@ bfq_merge_bfqqs(struct bfq_data *bfqd, struct bfq_io_cq *bic, - bfq_put_queue(bfqq); - } - --static void bfq_bfqq_increase_failed_cooperations(struct bfq_queue *bfqq) --{ -- struct bfq_io_cq *bic = bfqq->bic; -- struct bfq_data *bfqd = bfqq->bfqd; -- -- if (bic && bfq_bfqq_cooperations(bfqq) >= bfqd->bfq_coop_thresh) { -- bic->failed_cooperations++; -- if (bic->failed_cooperations >= bfqd->bfq_failed_cooperations) -- bic->cooperations = 0; -- } --} -- --static int bfq_allow_merge(struct request_queue *q, struct request *rq, -- struct bio *bio) -+static int bfq_allow_bio_merge(struct request_queue *q, struct request *rq, -+ struct bio *bio) - { - struct bfq_data *bfqd = q->elevator->elevator_data; - struct bfq_io_cq *bic; -@@ -1610,7 +2086,7 @@ static int bfq_allow_merge(struct request_queue *q, struct request *rq, - * Disallow merge of a sync bio into an async request. - */ - if (bfq_bio_sync(bio) && !rq_is_sync(rq)) -- return 0; -+ return false; - - /* - * Lookup the bfqq that this bio will be queued with. Allow -@@ -1619,7 +2095,7 @@ static int bfq_allow_merge(struct request_queue *q, struct request *rq, - */ - bic = bfq_bic_lookup(bfqd, current->io_context); - if (!bic) -- return 0; -+ return false; - - bfqq = bic_to_bfqq(bic, bfq_bio_sync(bio)); - /* -@@ -1636,30 +2112,111 @@ static int bfq_allow_merge(struct request_queue *q, struct request *rq, - * to decide whether bio and rq can be merged. - */ - bfqq = new_bfqq; -- } else -- bfq_bfqq_increase_failed_cooperations(bfqq); -+ } - } - - return bfqq == RQ_BFQQ(rq); - } - -+static int bfq_allow_rq_merge(struct request_queue *q, struct request *rq, -+ struct request *next) -+{ -+ return RQ_BFQQ(rq) == RQ_BFQQ(next); -+} -+ -+/* -+ * Set the maximum time for the in-service queue to consume its -+ * budget. This prevents seeky processes from lowering the throughput. -+ * In practice, a time-slice service scheme is used with seeky -+ * processes. -+ */ -+static void bfq_set_budget_timeout(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq) -+{ -+ unsigned int timeout_coeff; -+ -+ if (bfqq->wr_cur_max_time == bfqd->bfq_wr_rt_max_time) -+ timeout_coeff = 1; -+ else -+ timeout_coeff = bfqq->entity.weight / bfqq->entity.orig_weight; -+ -+ bfqd->last_budget_start = ktime_get(); -+ -+ bfqq->budget_timeout = jiffies + -+ bfqd->bfq_timeout * timeout_coeff; -+ -+ bfq_log_bfqq(bfqd, bfqq, "set budget_timeout %u", -+ jiffies_to_msecs(bfqd->bfq_timeout * timeout_coeff)); -+} -+ - static void __bfq_set_in_service_queue(struct bfq_data *bfqd, - struct bfq_queue *bfqq) - { - if (bfqq) { --#ifdef CONFIG_BFQ_GROUP_IOSCHED - bfqg_stats_update_avg_queue_size(bfqq_group(bfqq)); --#endif - bfq_mark_bfqq_must_alloc(bfqq); -- bfq_mark_bfqq_budget_new(bfqq); - bfq_clear_bfqq_fifo_expire(bfqq); - - bfqd->budgets_assigned = (bfqd->budgets_assigned*7 + 256) / 8; - -+ BUG_ON(bfqq == bfqd->in_service_queue); -+ BUG_ON(RB_EMPTY_ROOT(&bfqq->sort_list)); -+ -+ if (time_is_before_jiffies(bfqq->last_wr_start_finish) && -+ bfqq->wr_coeff > 1 && -+ bfqq->wr_cur_max_time == bfqd->bfq_wr_rt_max_time && -+ time_is_before_jiffies(bfqq->budget_timeout)) { -+ /* -+ * For soft real-time queues, move the start -+ * of the weight-raising period forward by the -+ * time the queue has not received any -+ * service. Otherwise, a relatively long -+ * service delay is likely to cause the -+ * weight-raising period of the queue to end, -+ * because of the short duration of the -+ * weight-raising period of a soft real-time -+ * queue. It is worth noting that this move -+ * is not so dangerous for the other queues, -+ * because soft real-time queues are not -+ * greedy. -+ * -+ * To not add a further variable, we use the -+ * overloaded field budget_timeout to -+ * determine for how long the queue has not -+ * received service, i.e., how much time has -+ * elapsed since the queue expired. However, -+ * this is a little imprecise, because -+ * budget_timeout is set to jiffies if bfqq -+ * not only expires, but also remains with no -+ * request. -+ */ -+ if (time_after(bfqq->budget_timeout, -+ bfqq->last_wr_start_finish)) -+ bfqq->last_wr_start_finish += -+ jiffies - bfqq->budget_timeout; -+ else -+ bfqq->last_wr_start_finish = jiffies; -+ -+ if (time_is_after_jiffies(bfqq->last_wr_start_finish)) { -+ pr_crit( -+ "BFQ WARNING:last %lu budget %lu jiffies %lu", -+ bfqq->last_wr_start_finish, -+ bfqq->budget_timeout, -+ jiffies); -+ pr_crit("diff %lu", jiffies - -+ max_t(unsigned long, -+ bfqq->last_wr_start_finish, -+ bfqq->budget_timeout)); -+ bfqq->last_wr_start_finish = jiffies; -+ } -+ } -+ -+ bfq_set_budget_timeout(bfqd, bfqq); - bfq_log_bfqq(bfqd, bfqq, - "set_in_service_queue, cur-budget = %d", - bfqq->entity.budget); -- } -+ } else -+ bfq_log(bfqd, "set_in_service_queue: NULL"); - - bfqd->in_service_queue = bfqq; - } -@@ -1675,36 +2232,11 @@ static struct bfq_queue *bfq_set_in_service_queue(struct bfq_data *bfqd) - return bfqq; - } - --/* -- * If enough samples have been computed, return the current max budget -- * stored in bfqd, which is dynamically updated according to the -- * estimated disk peak rate; otherwise return the default max budget -- */ --static int bfq_max_budget(struct bfq_data *bfqd) --{ -- if (bfqd->budgets_assigned < bfq_stats_min_budgets) -- return bfq_default_max_budget; -- else -- return bfqd->bfq_max_budget; --} -- --/* -- * Return min budget, which is a fraction of the current or default -- * max budget (trying with 1/32) -- */ --static int bfq_min_budget(struct bfq_data *bfqd) --{ -- if (bfqd->budgets_assigned < bfq_stats_min_budgets) -- return bfq_default_max_budget / 32; -- else -- return bfqd->bfq_max_budget / 32; --} -- - static void bfq_arm_slice_timer(struct bfq_data *bfqd) - { - struct bfq_queue *bfqq = bfqd->in_service_queue; - struct bfq_io_cq *bic; -- unsigned long sl; -+ u32 sl; - - BUG_ON(!RB_EMPTY_ROOT(&bfqq->sort_list)); - -@@ -1728,59 +2260,343 @@ static void bfq_arm_slice_timer(struct bfq_data *bfqd) - sl = bfqd->bfq_slice_idle; - /* - * Unless the queue is being weight-raised or the scenario is -- * asymmetric, grant only minimum idle time if the queue either -- * has been seeky for long enough or has already proved to be -- * constantly seeky. -+ * asymmetric, grant only minimum idle time if the queue -+ * is seeky. A long idling is preserved for a weight-raised -+ * queue, or, more in general, in an asymemtric scenario, -+ * because a long idling is needed for guaranteeing to a queue -+ * its reserved share of the throughput (in particular, it is -+ * needed if the queue has a higher weight than some other -+ * queue). - */ -- if (bfq_sample_valid(bfqq->seek_samples) && -- ((BFQQ_SEEKY(bfqq) && bfqq->entity.service > -- bfq_max_budget(bfqq->bfqd) / 8) || -- bfq_bfqq_constantly_seeky(bfqq)) && bfqq->wr_coeff == 1 && -+ if (BFQQ_SEEKY(bfqq) && bfqq->wr_coeff == 1 && - bfq_symmetric_scenario(bfqd)) -- sl = min(sl, msecs_to_jiffies(BFQ_MIN_TT)); -- else if (bfqq->wr_coeff > 1) -- sl = sl * 3; -+ sl = min_t(u32, sl, BFQ_MIN_TT); -+ - bfqd->last_idling_start = ktime_get(); -- mod_timer(&bfqd->idle_slice_timer, jiffies + sl); --#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ hrtimer_start(&bfqd->idle_slice_timer, ns_to_ktime(sl), -+ HRTIMER_MODE_REL); - bfqg_stats_set_start_idle_time(bfqq_group(bfqq)); --#endif -- bfq_log(bfqd, "arm idle: %u/%u ms", -- jiffies_to_msecs(sl), jiffies_to_msecs(bfqd->bfq_slice_idle)); -+ bfq_log(bfqd, "arm idle: %ld/%ld ms", -+ sl / NSEC_PER_MSEC, bfqd->bfq_slice_idle / NSEC_PER_MSEC); - } - - /* -- * Set the maximum time for the in-service queue to consume its -- * budget. This prevents seeky processes from lowering the disk -- * throughput (always guaranteed with a time slice scheme as in CFQ). -+ * In autotuning mode, max_budget is dynamically recomputed as the -+ * amount of sectors transferred in timeout at the estimated peak -+ * rate. This enables BFQ to utilize a full timeslice with a full -+ * budget, even if the in-service queue is served at peak rate. And -+ * this maximises throughput with sequential workloads. - */ --static void bfq_set_budget_timeout(struct bfq_data *bfqd) -+static unsigned long bfq_calc_max_budget(struct bfq_data *bfqd) - { -- struct bfq_queue *bfqq = bfqd->in_service_queue; -- unsigned int timeout_coeff; -+ return (u64)bfqd->peak_rate * USEC_PER_MSEC * -+ jiffies_to_msecs(bfqd->bfq_timeout)>>BFQ_RATE_SHIFT; -+} - -- if (bfqq->wr_cur_max_time == bfqd->bfq_wr_rt_max_time) -- timeout_coeff = 1; -+/* -+ * Update parameters related to throughput and responsiveness, as a -+ * function of the estimated peak rate. See comments on -+ * bfq_calc_max_budget(), and on T_slow and T_fast arrays. -+ */ -+void update_thr_responsiveness_params(struct bfq_data *bfqd) -+{ -+ int dev_type = blk_queue_nonrot(bfqd->queue); -+ -+ if (bfqd->bfq_user_max_budget == 0) { -+ bfqd->bfq_max_budget = -+ bfq_calc_max_budget(bfqd); -+ BUG_ON(bfqd->bfq_max_budget < 0); -+ bfq_log(bfqd, "new max_budget = %d", -+ bfqd->bfq_max_budget); -+ } -+ -+ if (bfqd->device_speed == BFQ_BFQD_FAST && -+ bfqd->peak_rate < device_speed_thresh[dev_type]) { -+ bfqd->device_speed = BFQ_BFQD_SLOW; -+ bfqd->RT_prod = R_slow[dev_type] * -+ T_slow[dev_type]; -+ } else if (bfqd->device_speed == BFQ_BFQD_SLOW && -+ bfqd->peak_rate > device_speed_thresh[dev_type]) { -+ bfqd->device_speed = BFQ_BFQD_FAST; -+ bfqd->RT_prod = R_fast[dev_type] * -+ T_fast[dev_type]; -+ } -+ -+ bfq_log(bfqd, -+"dev_type %s dev_speed_class = %s (%llu sects/sec), thresh %llu setcs/sec", -+ dev_type == 0 ? "ROT" : "NONROT", -+ bfqd->device_speed == BFQ_BFQD_FAST ? "FAST" : "SLOW", -+ bfqd->device_speed == BFQ_BFQD_FAST ? -+ (USEC_PER_SEC*(u64)R_fast[dev_type])>>BFQ_RATE_SHIFT : -+ (USEC_PER_SEC*(u64)R_slow[dev_type])>>BFQ_RATE_SHIFT, -+ (USEC_PER_SEC*(u64)device_speed_thresh[dev_type])>> -+ BFQ_RATE_SHIFT); -+} -+ -+void bfq_reset_rate_computation(struct bfq_data *bfqd, struct request *rq) -+{ -+ if (rq != NULL) { /* new rq dispatch now, reset accordingly */ -+ bfqd->last_dispatch = bfqd->first_dispatch = ktime_get_ns() ; -+ bfqd->peak_rate_samples = 1; -+ bfqd->sequential_samples = 0; -+ bfqd->tot_sectors_dispatched = bfqd->last_rq_max_size = -+ blk_rq_sectors(rq); -+ } else /* no new rq dispatched, just reset the number of samples */ -+ bfqd->peak_rate_samples = 0; /* full re-init on next disp. */ -+ -+ bfq_log(bfqd, -+ "reset_rate_computation at end, sample %u/%u tot_sects %llu", -+ bfqd->peak_rate_samples, bfqd->sequential_samples, -+ bfqd->tot_sectors_dispatched); -+} -+ -+void bfq_update_rate_reset(struct bfq_data *bfqd, struct request *rq) -+{ -+ u32 rate, weight, divisor; -+ -+ /* -+ * For the convergence property to hold (see comments on -+ * bfq_update_peak_rate()) and for the assessment to be -+ * reliable, a minimum number of samples must be present, and -+ * a minimum amount of time must have elapsed. If not so, do -+ * not compute new rate. Just reset parameters, to get ready -+ * for a new evaluation attempt. -+ */ -+ if (bfqd->peak_rate_samples < BFQ_RATE_MIN_SAMPLES || -+ bfqd->delta_from_first < BFQ_RATE_MIN_INTERVAL) { -+ bfq_log(bfqd, -+ "update_rate_reset: only resetting, delta_first %lluus samples %d", -+ bfqd->delta_from_first>>10, bfqd->peak_rate_samples); -+ goto reset_computation; -+ } -+ -+ /* -+ * If a new request completion has occurred after last -+ * dispatch, then, to approximate the rate at which requests -+ * have been served by the device, it is more precise to -+ * extend the observation interval to the last completion. -+ */ -+ bfqd->delta_from_first = -+ max_t(u64, bfqd->delta_from_first, -+ bfqd->last_completion - bfqd->first_dispatch); -+ -+ BUG_ON(bfqd->delta_from_first == 0); -+ /* -+ * Rate computed in sects/usec, and not sects/nsec, for -+ * precision issues. -+ */ -+ rate = div64_ul(bfqd->tot_sectors_dispatched<delta_from_first, NSEC_PER_USEC)); -+ -+ bfq_log(bfqd, -+"update_rate_reset: tot_sects %llu delta_first %lluus rate %llu sects/s (%d)", -+ bfqd->tot_sectors_dispatched, bfqd->delta_from_first>>10, -+ ((USEC_PER_SEC*(u64)rate)>>BFQ_RATE_SHIFT), -+ rate > 20< 20M sectors/sec) -+ */ -+ if ((bfqd->peak_rate_samples > (3 * bfqd->sequential_samples)>>2 && -+ rate <= bfqd->peak_rate) || -+ rate > 20<peak_rate_samples, bfqd->sequential_samples, -+ ((USEC_PER_SEC*(u64)rate)>>BFQ_RATE_SHIFT), -+ ((USEC_PER_SEC*(u64)bfqd->peak_rate)>>BFQ_RATE_SHIFT)); -+ goto reset_computation; -+ } else { -+ bfq_log(bfqd, -+ "update_rate_reset: do update, samples %u/%u rate/peak %llu/%llu", -+ bfqd->peak_rate_samples, bfqd->sequential_samples, -+ ((USEC_PER_SEC*(u64)rate)>>BFQ_RATE_SHIFT), -+ ((USEC_PER_SEC*(u64)bfqd->peak_rate)>>BFQ_RATE_SHIFT)); -+ } -+ -+ /* -+ * We have to update the peak rate, at last! To this purpose, -+ * we use a low-pass filter. We compute the smoothing constant -+ * of the filter as a function of the 'weight' of the new -+ * measured rate. -+ * -+ * As can be seen in next formulas, we define this weight as a -+ * quantity proportional to how sequential the workload is, -+ * and to how long the observation time interval is. -+ * -+ * The weight runs from 0 to 8. The maximum value of the -+ * weight, 8, yields the minimum value for the smoothing -+ * constant. At this minimum value for the smoothing constant, -+ * the measured rate contributes for half of the next value of -+ * the estimated peak rate. -+ * -+ * So, the first step is to compute the weight as a function -+ * of how sequential the workload is. Note that the weight -+ * cannot reach 9, because bfqd->sequential_samples cannot -+ * become equal to bfqd->peak_rate_samples, which, in its -+ * turn, holds true because bfqd->sequential_samples is not -+ * incremented for the first sample. -+ */ -+ weight = (9 * bfqd->sequential_samples) / bfqd->peak_rate_samples; -+ -+ /* -+ * Second step: further refine the weight as a function of the -+ * duration of the observation interval. -+ */ -+ weight = min_t(u32, 8, -+ div_u64(weight * bfqd->delta_from_first, -+ BFQ_RATE_REF_INTERVAL)); -+ -+ /* -+ * Divisor ranging from 10, for minimum weight, to 2, for -+ * maximum weight. -+ */ -+ divisor = 10 - weight; -+ BUG_ON(divisor == 0); -+ -+ /* -+ * Finally, update peak rate: -+ * -+ * peak_rate = peak_rate * (divisor-1) / divisor + rate / divisor -+ */ -+ bfqd->peak_rate *= divisor-1; -+ bfqd->peak_rate /= divisor; -+ rate /= divisor; /* smoothing constant alpha = 1/divisor */ -+ -+ bfq_log(bfqd, -+ "update_rate_reset: divisor %d tmp_peak_rate %llu tmp_rate %u", -+ divisor, -+ ((USEC_PER_SEC*(u64)bfqd->peak_rate)>>BFQ_RATE_SHIFT), -+ (u32)((USEC_PER_SEC*(u64)rate)>>BFQ_RATE_SHIFT)); -+ -+ BUG_ON(bfqd->peak_rate == 0); -+ BUG_ON(bfqd->peak_rate > 20<peak_rate += rate; -+ update_thr_responsiveness_params(bfqd); -+ BUG_ON(bfqd->peak_rate > 20<peak_rate_samples == 0) { /* first dispatch */ -+ bfq_log(bfqd, -+ "update_peak_rate: goto reset, samples %d", -+ bfqd->peak_rate_samples) ; -+ bfq_reset_rate_computation(bfqd, rq); -+ goto update_last_values; /* will add one sample */ -+ } -+ -+ /* -+ * Device idle for very long: the observation interval lasting -+ * up to this dispatch cannot be a valid observation interval -+ * for computing a new peak rate (similarly to the late- -+ * completion event in bfq_completed_request()). Go to -+ * update_rate_and_reset to have the following three steps -+ * taken: -+ * - close the observation interval at the last (previous) -+ * request dispatch or completion -+ * - compute rate, if possible, for that observation interval -+ * - start a new observation interval with this dispatch -+ */ -+ if (now_ns - bfqd->last_dispatch > 100*NSEC_PER_MSEC && -+ bfqd->rq_in_driver == 0) { -+ bfq_log(bfqd, -+"update_peak_rate: jumping to updating&resetting delta_last %lluus samples %d", -+ (now_ns - bfqd->last_dispatch)>>10, -+ bfqd->peak_rate_samples) ; -+ goto update_rate_and_reset; -+ } -+ -+ /* Update sampling information */ -+ bfqd->peak_rate_samples++; -+ -+ if ((bfqd->rq_in_driver > 0 || -+ now_ns - bfqd->last_completion < BFQ_MIN_TT) -+ && get_sdist(bfqd->last_position, rq) < BFQQ_SEEK_THR) -+ bfqd->sequential_samples++; -+ -+ bfqd->tot_sectors_dispatched += blk_rq_sectors(rq); -+ -+ /* Reset max observed rq size every 32 dispatches */ -+ if (likely(bfqd->peak_rate_samples % 32)) -+ bfqd->last_rq_max_size = -+ max_t(u32, blk_rq_sectors(rq), bfqd->last_rq_max_size); - else -- timeout_coeff = bfqq->entity.weight / bfqq->entity.orig_weight; -+ bfqd->last_rq_max_size = blk_rq_sectors(rq); - -- bfqd->last_budget_start = ktime_get(); -+ bfqd->delta_from_first = now_ns - bfqd->first_dispatch; - -- bfq_clear_bfqq_budget_new(bfqq); -- bfqq->budget_timeout = jiffies + -- bfqd->bfq_timeout[bfq_bfqq_sync(bfqq)] * timeout_coeff; -+ bfq_log(bfqd, -+ "update_peak_rate: added samples %u/%u tot_sects %llu delta_first %lluus", -+ bfqd->peak_rate_samples, bfqd->sequential_samples, -+ bfqd->tot_sectors_dispatched, -+ bfqd->delta_from_first>>10); - -- bfq_log_bfqq(bfqd, bfqq, "set budget_timeout %u", -- jiffies_to_msecs(bfqd->bfq_timeout[bfq_bfqq_sync(bfqq)] * -- timeout_coeff)); -+ /* Target observation interval not yet reached, go on sampling */ -+ if (bfqd->delta_from_first < BFQ_RATE_REF_INTERVAL) -+ goto update_last_values; -+ -+update_rate_and_reset: -+ bfq_update_rate_reset(bfqd, rq); -+update_last_values: -+ bfqd->last_position = blk_rq_pos(rq) + blk_rq_sectors(rq); -+ bfqd->last_dispatch = now_ns; -+ -+ bfq_log(bfqd, -+ "update_peak_rate: delta_first %lluus last_pos %llu peak_rate %llu", -+ (now_ns - bfqd->first_dispatch)>>10, -+ (unsigned long long) bfqd->last_position, -+ ((USEC_PER_SEC*(u64)bfqd->peak_rate)>>BFQ_RATE_SHIFT)); -+ bfq_log(bfqd, -+ "update_peak_rate: samples at end %d", bfqd->peak_rate_samples); - } - - /* -- * Move request from internal lists to the request queue dispatch list. -+ * Move request from internal lists to the dispatch list of the request queue - */ - static void bfq_dispatch_insert(struct request_queue *q, struct request *rq) - { -- struct bfq_data *bfqd = q->elevator->elevator_data; - struct bfq_queue *bfqq = RQ_BFQQ(rq); - - /* -@@ -1794,15 +2610,10 @@ static void bfq_dispatch_insert(struct request_queue *q, struct request *rq) - * incrementing bfqq->dispatched. - */ - bfqq->dispatched++; -+ bfq_update_peak_rate(q->elevator->elevator_data, rq); -+ - bfq_remove_request(rq); - elv_dispatch_sort(q, rq); -- -- if (bfq_bfqq_sync(bfqq)) -- bfqd->sync_flight++; --#ifdef CONFIG_BFQ_GROUP_IOSCHED -- bfqg_stats_update_dispatch(bfqq_group(bfqq), blk_rq_bytes(rq), -- rq->cmd_flags); --#endif - } - - /* -@@ -1822,25 +2633,16 @@ static struct request *bfq_check_fifo(struct bfq_queue *bfqq) - - rq = rq_entry_fifo(bfqq->fifo.next); - -- if (time_before(jiffies, rq->fifo_time)) -+ if (ktime_get_ns() < rq->fifo_time) - return NULL; - - return rq; - } - --static int bfq_bfqq_budget_left(struct bfq_queue *bfqq) --{ -- struct bfq_entity *entity = &bfqq->entity; -- -- return entity->budget - entity->service; --} -- - static void __bfq_bfqq_expire(struct bfq_data *bfqd, struct bfq_queue *bfqq) - { - BUG_ON(bfqq != bfqd->in_service_queue); - -- __bfq_bfqd_reset_in_service(bfqd); -- - /* - * If this bfqq is shared between multiple processes, check - * to make sure that those processes are still issuing I/Os -@@ -1851,20 +2653,30 @@ static void __bfq_bfqq_expire(struct bfq_data *bfqd, struct bfq_queue *bfqq) - bfq_mark_bfqq_split_coop(bfqq); - - if (RB_EMPTY_ROOT(&bfqq->sort_list)) { -- /* -- * Overloading budget_timeout field to store the time -- * at which the queue remains with no backlog; used by -- * the weight-raising mechanism. -- */ -- bfqq->budget_timeout = jiffies; -- bfq_del_bfqq_busy(bfqd, bfqq, 1); -+ if (bfqq->dispatched == 0) -+ /* -+ * Overloading budget_timeout field to store -+ * the time at which the queue remains with no -+ * backlog and no outstanding request; used by -+ * the weight-raising mechanism. -+ */ -+ bfqq->budget_timeout = jiffies; -+ -+ bfq_del_bfqq_busy(bfqd, bfqq, true); - } else { -- bfq_activate_bfqq(bfqd, bfqq); -+ bfq_requeue_bfqq(bfqd, bfqq); - /* - * Resort priority tree of potential close cooperators. - */ - bfq_pos_tree_add_move(bfqd, bfqq); - } -+ -+ /* -+ * All in-service entities must have been properly deactivated -+ * or requeued before executing the next function, which -+ * resets all in-service entites as no more in service. -+ */ -+ __bfq_bfqd_reset_in_service(bfqd); - } - - /** -@@ -1883,10 +2695,19 @@ static void __bfq_bfqq_recalc_budget(struct bfq_data *bfqd, - struct request *next_rq; - int budget, min_budget; - -- budget = bfqq->max_budget; -+ BUG_ON(bfqq != bfqd->in_service_queue); -+ - min_budget = bfq_min_budget(bfqd); - -- BUG_ON(bfqq != bfqd->in_service_queue); -+ if (bfqq->wr_coeff == 1) -+ budget = bfqq->max_budget; -+ else /* -+ * Use a constant, low budget for weight-raised queues, -+ * to help achieve a low latency. Keep it slightly higher -+ * than the minimum possible budget, to cause a little -+ * bit fewer expirations. -+ */ -+ budget = 2 * min_budget; - - bfq_log_bfqq(bfqd, bfqq, "recalc_budg: last budg %d, budg left %d", - bfqq->entity.budget, bfq_bfqq_budget_left(bfqq)); -@@ -1895,7 +2716,7 @@ static void __bfq_bfqq_recalc_budget(struct bfq_data *bfqd, - bfq_log_bfqq(bfqd, bfqq, "recalc_budg: sync %d, seeky %d", - bfq_bfqq_sync(bfqq), BFQQ_SEEKY(bfqd->in_service_queue)); - -- if (bfq_bfqq_sync(bfqq)) { -+ if (bfq_bfqq_sync(bfqq) && bfqq->wr_coeff == 1) { - switch (reason) { - /* - * Caveat: in all the following cases we trade latency -@@ -1937,14 +2758,10 @@ static void __bfq_bfqq_recalc_budget(struct bfq_data *bfqd, - break; - case BFQ_BFQQ_BUDGET_TIMEOUT: - /* -- * We double the budget here because: 1) it -- * gives the chance to boost the throughput if -- * this is not a seeky process (which may have -- * bumped into this timeout because of, e.g., -- * ZBR), 2) together with charge_full_budget -- * it helps give seeky processes higher -- * timestamps, and hence be served less -- * frequently. -+ * We double the budget here because it gives -+ * the chance to boost the throughput if this -+ * is not a seeky process (and has bumped into -+ * this timeout because of, e.g., ZBR). - */ - budget = min(budget * 2, bfqd->bfq_max_budget); - break; -@@ -1961,17 +2778,49 @@ static void __bfq_bfqq_recalc_budget(struct bfq_data *bfqd, - budget = min(budget * 4, bfqd->bfq_max_budget); - break; - case BFQ_BFQQ_NO_MORE_REQUESTS: -- /* -- * Leave the budget unchanged. -- */ -+ /* -+ * For queues that expire for this reason, it -+ * is particularly important to keep the -+ * budget close to the actual service they -+ * need. Doing so reduces the timestamp -+ * misalignment problem described in the -+ * comments in the body of -+ * __bfq_activate_entity. In fact, suppose -+ * that a queue systematically expires for -+ * BFQ_BFQQ_NO_MORE_REQUESTS and presents a -+ * new request in time to enjoy timestamp -+ * back-shifting. The larger the budget of the -+ * queue is with respect to the service the -+ * queue actually requests in each service -+ * slot, the more times the queue can be -+ * reactivated with the same virtual finish -+ * time. It follows that, even if this finish -+ * time is pushed to the system virtual time -+ * to reduce the consequent timestamp -+ * misalignment, the queue unjustly enjoys for -+ * many re-activations a lower finish time -+ * than all newly activated queues. -+ * -+ * The service needed by bfqq is measured -+ * quite precisely by bfqq->entity.service. -+ * Since bfqq does not enjoy device idling, -+ * bfqq->entity.service is equal to the number -+ * of sectors that the process associated with -+ * bfqq requested to read/write before waiting -+ * for request completions, or blocking for -+ * other reasons. -+ */ -+ budget = max_t(int, bfqq->entity.service, min_budget); -+ break; - default: - return; - } -- } else -+ } else if (!bfq_bfqq_sync(bfqq)) - /* -- * Async queues get always the maximum possible budget -- * (their ability to dispatch is limited by -- * @bfqd->bfq_max_budget_async_rq). -+ * Async queues get always the maximum possible -+ * budget, as for them we do not care about latency -+ * (in addition, their ability to dispatch is limited -+ * by the charging factor). - */ - budget = bfqd->bfq_max_budget; - -@@ -1982,160 +2831,120 @@ static void __bfq_bfqq_recalc_budget(struct bfq_data *bfqd, - bfqq->max_budget = min(bfqq->max_budget, bfqd->bfq_max_budget); - - /* -- * Make sure that we have enough budget for the next request. -- * Since the finish time of the bfqq must be kept in sync with -- * the budget, be sure to call __bfq_bfqq_expire() after the -+ * If there is still backlog, then assign a new budget, making -+ * sure that it is large enough for the next request. Since -+ * the finish time of bfqq must be kept in sync with the -+ * budget, be sure to call __bfq_bfqq_expire() *after* this - * update. -+ * -+ * If there is no backlog, then no need to update the budget; -+ * it will be updated on the arrival of a new request. - */ - next_rq = bfqq->next_rq; -- if (next_rq) -+ if (next_rq) { -+ BUG_ON(reason == BFQ_BFQQ_TOO_IDLE || -+ reason == BFQ_BFQQ_NO_MORE_REQUESTS); - bfqq->entity.budget = max_t(unsigned long, bfqq->max_budget, - bfq_serv_to_charge(next_rq, bfqq)); -- else -- bfqq->entity.budget = bfqq->max_budget; -+ BUG_ON(!bfq_bfqq_busy(bfqq)); -+ BUG_ON(RB_EMPTY_ROOT(&bfqq->sort_list)); -+ } - - bfq_log_bfqq(bfqd, bfqq, "head sect: %u, new budget %d", - next_rq ? blk_rq_sectors(next_rq) : 0, - bfqq->entity.budget); - } - --static unsigned long bfq_calc_max_budget(u64 peak_rate, u64 timeout) --{ -- unsigned long max_budget; -- -- /* -- * The max_budget calculated when autotuning is equal to the -- * amount of sectors transfered in timeout_sync at the -- * estimated peak rate. -- */ -- max_budget = (unsigned long)(peak_rate * 1000 * -- timeout >> BFQ_RATE_SHIFT); -- -- return max_budget; --} -- - /* -- * In addition to updating the peak rate, checks whether the process -- * is "slow", and returns 1 if so. This slow flag is used, in addition -- * to the budget timeout, to reduce the amount of service provided to -- * seeky processes, and hence reduce their chances to lower the -- * throughput. See the code for more details. -+ * Return true if the process associated with bfqq is "slow". The slow -+ * flag is used, in addition to the budget timeout, to reduce the -+ * amount of service provided to seeky processes, and thus reduce -+ * their chances to lower the throughput. More details in the comments -+ * on the function bfq_bfqq_expire(). -+ * -+ * An important observation is in order: as discussed in the comments -+ * on the function bfq_update_peak_rate(), with devices with internal -+ * queues, it is hard if ever possible to know when and for how long -+ * an I/O request is processed by the device (apart from the trivial -+ * I/O pattern where a new request is dispatched only after the -+ * previous one has been completed). This makes it hard to evaluate -+ * the real rate at which the I/O requests of each bfq_queue are -+ * served. In fact, for an I/O scheduler like BFQ, serving a -+ * bfq_queue means just dispatching its requests during its service -+ * slot (i.e., until the budget of the queue is exhausted, or the -+ * queue remains idle, or, finally, a timeout fires). But, during the -+ * service slot of a bfq_queue, around 100 ms at most, the device may -+ * be even still processing requests of bfq_queues served in previous -+ * service slots. On the opposite end, the requests of the in-service -+ * bfq_queue may be completed after the service slot of the queue -+ * finishes. -+ * -+ * Anyway, unless more sophisticated solutions are used -+ * (where possible), the sum of the sizes of the requests dispatched -+ * during the service slot of a bfq_queue is probably the only -+ * approximation available for the service received by the bfq_queue -+ * during its service slot. And this sum is the quantity used in this -+ * function to evaluate the I/O speed of a process. - */ --static bool bfq_update_peak_rate(struct bfq_data *bfqd, struct bfq_queue *bfqq, -- bool compensate, enum bfqq_expiration reason) -+static bool bfq_bfqq_is_slow(struct bfq_data *bfqd, struct bfq_queue *bfqq, -+ bool compensate, enum bfqq_expiration reason, -+ unsigned long *delta_ms) - { -- u64 bw, usecs, expected, timeout; -- ktime_t delta; -- int update = 0; -+ ktime_t delta_ktime; -+ u32 delta_usecs; -+ bool slow = BFQQ_SEEKY(bfqq); /* if delta too short, use seekyness */ - -- if (!bfq_bfqq_sync(bfqq) || bfq_bfqq_budget_new(bfqq)) -+ if (!bfq_bfqq_sync(bfqq)) - return false; - - if (compensate) -- delta = bfqd->last_idling_start; -+ delta_ktime = bfqd->last_idling_start; - else -- delta = ktime_get(); -- delta = ktime_sub(delta, bfqd->last_budget_start); -- usecs = ktime_to_us(delta); -- -- /* Don't trust short/unrealistic values. */ -- if (usecs < 100 || usecs >= LONG_MAX) -- return false; -- -- /* -- * Calculate the bandwidth for the last slice. We use a 64 bit -- * value to store the peak rate, in sectors per usec in fixed -- * point math. We do so to have enough precision in the estimate -- * and to avoid overflows. -- */ -- bw = (u64)bfqq->entity.service << BFQ_RATE_SHIFT; -- do_div(bw, (unsigned long)usecs); -- -- timeout = jiffies_to_msecs(bfqd->bfq_timeout[BLK_RW_SYNC]); -- -- /* -- * Use only long (> 20ms) intervals to filter out spikes for -- * the peak rate estimation. -- */ -- if (usecs > 20000) { -- if (bw > bfqd->peak_rate || -- (!BFQQ_SEEKY(bfqq) && -- reason == BFQ_BFQQ_BUDGET_TIMEOUT)) { -- bfq_log(bfqd, "measured bw =%llu", bw); -- /* -- * To smooth oscillations use a low-pass filter with -- * alpha=7/8, i.e., -- * new_rate = (7/8) * old_rate + (1/8) * bw -- */ -- do_div(bw, 8); -- if (bw == 0) -- return 0; -- bfqd->peak_rate *= 7; -- do_div(bfqd->peak_rate, 8); -- bfqd->peak_rate += bw; -- update = 1; -- bfq_log(bfqd, "new peak_rate=%llu", bfqd->peak_rate); -- } -- -- update |= bfqd->peak_rate_samples == BFQ_PEAK_RATE_SAMPLES - 1; -- -- if (bfqd->peak_rate_samples < BFQ_PEAK_RATE_SAMPLES) -- bfqd->peak_rate_samples++; -- -- if (bfqd->peak_rate_samples == BFQ_PEAK_RATE_SAMPLES && -- update) { -- int dev_type = blk_queue_nonrot(bfqd->queue); -- -- if (bfqd->bfq_user_max_budget == 0) { -- bfqd->bfq_max_budget = -- bfq_calc_max_budget(bfqd->peak_rate, -- timeout); -- bfq_log(bfqd, "new max_budget=%d", -- bfqd->bfq_max_budget); -- } -- if (bfqd->device_speed == BFQ_BFQD_FAST && -- bfqd->peak_rate < device_speed_thresh[dev_type]) { -- bfqd->device_speed = BFQ_BFQD_SLOW; -- bfqd->RT_prod = R_slow[dev_type] * -- T_slow[dev_type]; -- } else if (bfqd->device_speed == BFQ_BFQD_SLOW && -- bfqd->peak_rate > device_speed_thresh[dev_type]) { -- bfqd->device_speed = BFQ_BFQD_FAST; -- bfqd->RT_prod = R_fast[dev_type] * -- T_fast[dev_type]; -- } -- } -+ delta_ktime = ktime_get(); -+ delta_ktime = ktime_sub(delta_ktime, bfqd->last_budget_start); -+ delta_usecs = ktime_to_us(delta_ktime); -+ -+ /* don't trust short/unrealistic values. */ -+ if (delta_usecs < 1000 || delta_usecs >= LONG_MAX) { -+ if (blk_queue_nonrot(bfqd->queue)) -+ /* -+ * give same worst-case guarantees as idling -+ * for seeky -+ */ -+ *delta_ms = BFQ_MIN_TT / NSEC_PER_MSEC; -+ else /* charge at least one seek */ -+ *delta_ms = bfq_slice_idle / NSEC_PER_MSEC; -+ -+ bfq_log(bfqd, "bfq_bfqq_is_slow: unrealistic %u", delta_usecs); -+ -+ return slow; - } - -- /* -- * If the process has been served for a too short time -- * interval to let its possible sequential accesses prevail on -- * the initial seek time needed to move the disk head on the -- * first sector it requested, then give the process a chance -- * and for the moment return false. -- */ -- if (bfqq->entity.budget <= bfq_max_budget(bfqd) / 8) -- return false; -+ *delta_ms = delta_usecs / USEC_PER_MSEC; - - /* -- * A process is considered ``slow'' (i.e., seeky, so that we -- * cannot treat it fairly in the service domain, as it would -- * slow down too much the other processes) if, when a slice -- * ends for whatever reason, it has received service at a -- * rate that would not be high enough to complete the budget -- * before the budget timeout expiration. -+ * Use only long (> 20ms) intervals to filter out excessive -+ * spikes in service rate estimation. - */ -- expected = bw * 1000 * timeout >> BFQ_RATE_SHIFT; -+ if (delta_usecs > 20000) { -+ /* -+ * Caveat for rotational devices: processes doing I/O -+ * in the slower disk zones tend to be slow(er) even -+ * if not seeky. In this respect, the estimated peak -+ * rate is likely to be an average over the disk -+ * surface. Accordingly, to not be too harsh with -+ * unlucky processes, a process is deemed slow only if -+ * its rate has been lower than half of the estimated -+ * peak rate. -+ */ -+ slow = bfqq->entity.service < bfqd->bfq_max_budget / 2; -+ bfq_log(bfqd, "bfq_bfqq_is_slow: relative rate %d/%d", -+ bfqq->entity.service, bfqd->bfq_max_budget); -+ } - -- /* -- * Caveat: processes doing IO in the slower disk zones will -- * tend to be slow(er) even if not seeky. And the estimated -- * peak rate will actually be an average over the disk -- * surface. Hence, to not be too harsh with unlucky processes, -- * we keep a budget/3 margin of safety before declaring a -- * process slow. -- */ -- return expected > (4 * bfqq->entity.budget) / 3; -+ bfq_log_bfqq(bfqd, bfqq, "bfq_bfqq_is_slow: slow %d", slow); -+ -+ return slow; - } - - /* -@@ -2193,20 +3002,35 @@ static bool bfq_update_peak_rate(struct bfq_data *bfqd, struct bfq_queue *bfqq, - static unsigned long bfq_bfqq_softrt_next_start(struct bfq_data *bfqd, - struct bfq_queue *bfqq) - { -+ bfq_log_bfqq(bfqd, bfqq, -+"softrt_next_start: service_blkg %lu soft_rate %u sects/sec interval %u", -+ bfqq->service_from_backlogged, -+ bfqd->bfq_wr_max_softrt_rate, -+ jiffies_to_msecs(HZ * bfqq->service_from_backlogged / -+ bfqd->bfq_wr_max_softrt_rate)); -+ - return max(bfqq->last_idle_bklogged + - HZ * bfqq->service_from_backlogged / - bfqd->bfq_wr_max_softrt_rate, -- jiffies + bfqq->bfqd->bfq_slice_idle + 4); -+ jiffies + nsecs_to_jiffies(bfqq->bfqd->bfq_slice_idle) + 4); -+} -+ -+/* -+ * Return the farthest future time instant according to jiffies -+ * macros. -+ */ -+static unsigned long bfq_greatest_from_now(void) -+{ -+ return jiffies + MAX_JIFFY_OFFSET; - } - - /* -- * Return the largest-possible time instant such that, for as long as possible, -- * the current time will be lower than this time instant according to the macro -- * time_is_before_jiffies(). -+ * Return the farthest past time instant according to jiffies -+ * macros. - */ --static unsigned long bfq_infinity_from_now(unsigned long now) -+static unsigned long bfq_smallest_from_now(void) - { -- return now + ULONG_MAX / 2; -+ return jiffies - MAX_JIFFY_OFFSET; - } - - /** -@@ -2216,28 +3040,24 @@ static unsigned long bfq_infinity_from_now(unsigned long now) - * @compensate: if true, compensate for the time spent idling. - * @reason: the reason causing the expiration. - * -+ * If the process associated with bfqq does slow I/O (e.g., because it -+ * issues random requests), we charge bfqq with the time it has been -+ * in service instead of the service it has received (see -+ * bfq_bfqq_charge_time for details on how this goal is achieved). As -+ * a consequence, bfqq will typically get higher timestamps upon -+ * reactivation, and hence it will be rescheduled as if it had -+ * received more service than what it has actually received. In the -+ * end, bfqq receives less service in proportion to how slowly its -+ * associated process consumes its budgets (and hence how seriously it -+ * tends to lower the throughput). In addition, this time-charging -+ * strategy guarantees time fairness among slow processes. In -+ * contrast, if the process associated with bfqq is not slow, we -+ * charge bfqq exactly with the service it has received. - * -- * If the process associated to the queue is slow (i.e., seeky), or in -- * case of budget timeout, or, finally, if it is async, we -- * artificially charge it an entire budget (independently of the -- * actual service it received). As a consequence, the queue will get -- * higher timestamps than the correct ones upon reactivation, and -- * hence it will be rescheduled as if it had received more service -- * than what it actually received. In the end, this class of processes -- * will receive less service in proportion to how slowly they consume -- * their budgets (and hence how seriously they tend to lower the -- * throughput). -- * -- * In contrast, when a queue expires because it has been idling for -- * too much or because it exhausted its budget, we do not touch the -- * amount of service it has received. Hence when the queue will be -- * reactivated and its timestamps updated, the latter will be in sync -- * with the actual service received by the queue until expiration. -- * -- * Charging a full budget to the first type of queues and the exact -- * service to the others has the effect of using the WF2Q+ policy to -- * schedule the former on a timeslice basis, without violating the -- * service domain guarantees of the latter. -+ * Charging time to the first type of queues and the exact service to -+ * the other has the effect of using the WF2Q+ policy to schedule the -+ * former on a timeslice basis, without violating service domain -+ * guarantees among the latter. - */ - static void bfq_bfqq_expire(struct bfq_data *bfqd, - struct bfq_queue *bfqq, -@@ -2245,41 +3065,52 @@ static void bfq_bfqq_expire(struct bfq_data *bfqd, - enum bfqq_expiration reason) - { - bool slow; -+ unsigned long delta = 0; -+ struct bfq_entity *entity = &bfqq->entity; - - BUG_ON(bfqq != bfqd->in_service_queue); - - /* -- * Update disk peak rate for autotuning and check whether the -- * process is slow (see bfq_update_peak_rate). -+ * Check whether the process is slow (see bfq_bfqq_is_slow). - */ -- slow = bfq_update_peak_rate(bfqd, bfqq, compensate, reason); -+ slow = bfq_bfqq_is_slow(bfqd, bfqq, compensate, reason, &delta); - - /* -- * As above explained, 'punish' slow (i.e., seeky), timed-out -- * and async queues, to favor sequential sync workloads. -- * -- * Processes doing I/O in the slower disk zones will tend to be -- * slow(er) even if not seeky. Hence, since the estimated peak -- * rate is actually an average over the disk surface, these -- * processes may timeout just for bad luck. To avoid punishing -- * them we do not charge a full budget to a process that -- * succeeded in consuming at least 2/3 of its budget. -+ * Increase service_from_backlogged before next statement, -+ * because the possible next invocation of -+ * bfq_bfqq_charge_time would likely inflate -+ * entity->service. In contrast, service_from_backlogged must -+ * contain real service, to enable the soft real-time -+ * heuristic to correctly compute the bandwidth consumed by -+ * bfqq. - */ -- if (slow || (reason == BFQ_BFQQ_BUDGET_TIMEOUT && -- bfq_bfqq_budget_left(bfqq) >= bfqq->entity.budget / 3)) -- bfq_bfqq_charge_full_budget(bfqq); -+ bfqq->service_from_backlogged += entity->service; - -- bfqq->service_from_backlogged += bfqq->entity.service; -+ /* -+ * As above explained, charge slow (typically seeky) and -+ * timed-out queues with the time and not the service -+ * received, to favor sequential workloads. -+ * -+ * Processes doing I/O in the slower disk zones will tend to -+ * be slow(er) even if not seeky. Therefore, since the -+ * estimated peak rate is actually an average over the disk -+ * surface, these processes may timeout just for bad luck. To -+ * avoid punishing them, do not charge time to processes that -+ * succeeded in consuming at least 2/3 of their budget. This -+ * allows BFQ to preserve enough elasticity to still perform -+ * bandwidth, and not time, distribution with little unlucky -+ * or quasi-sequential processes. -+ */ -+ if (bfqq->wr_coeff == 1 && -+ (slow || -+ (reason == BFQ_BFQQ_BUDGET_TIMEOUT && -+ bfq_bfqq_budget_left(bfqq) >= entity->budget / 3))) -+ bfq_bfqq_charge_time(bfqd, bfqq, delta); - -- if (BFQQ_SEEKY(bfqq) && reason == BFQ_BFQQ_BUDGET_TIMEOUT && -- !bfq_bfqq_constantly_seeky(bfqq)) { -- bfq_mark_bfqq_constantly_seeky(bfqq); -- if (!blk_queue_nonrot(bfqd->queue)) -- bfqd->const_seeky_busy_in_flight_queues++; -- } -+ BUG_ON(bfqq->entity.budget < bfqq->entity.service); - - if (reason == BFQ_BFQQ_TOO_IDLE && -- bfqq->entity.service <= 2 * bfqq->entity.budget / 10) -+ entity->service <= 2 * entity->budget / 10) - bfq_clear_bfqq_IO_bound(bfqq); - - if (bfqd->low_latency && bfqq->wr_coeff == 1) -@@ -2288,19 +3119,23 @@ static void bfq_bfqq_expire(struct bfq_data *bfqd, - if (bfqd->low_latency && bfqd->bfq_wr_max_softrt_rate > 0 && - RB_EMPTY_ROOT(&bfqq->sort_list)) { - /* -- * If we get here, and there are no outstanding requests, -- * then the request pattern is isochronous (see the comments -- * to the function bfq_bfqq_softrt_next_start()). Hence we -- * can compute soft_rt_next_start. If, instead, the queue -- * still has outstanding requests, then we have to wait -- * for the completion of all the outstanding requests to -+ * If we get here, and there are no outstanding -+ * requests, then the request pattern is isochronous -+ * (see the comments on the function -+ * bfq_bfqq_softrt_next_start()). Thus we can compute -+ * soft_rt_next_start. If, instead, the queue still -+ * has outstanding requests, then we have to wait for -+ * the completion of all the outstanding requests to - * discover whether the request pattern is actually - * isochronous. - */ -- if (bfqq->dispatched == 0) -+ BUG_ON(bfqd->busy_queues < 1); -+ if (bfqq->dispatched == 0) { - bfqq->soft_rt_next_start = - bfq_bfqq_softrt_next_start(bfqd, bfqq); -- else { -+ bfq_log_bfqq(bfqd, bfqq, "new soft_rt_next %lu", -+ bfqq->soft_rt_next_start); -+ } else { - /* - * The application is still waiting for the - * completion of one or more requests: -@@ -2317,7 +3152,7 @@ static void bfq_bfqq_expire(struct bfq_data *bfqd, - * happened to be in the past. - */ - bfqq->soft_rt_next_start = -- bfq_infinity_from_now(jiffies); -+ bfq_greatest_from_now(); - /* - * Schedule an update of soft_rt_next_start to when - * the task may be discovered to be isochronous. -@@ -2327,15 +3162,27 @@ static void bfq_bfqq_expire(struct bfq_data *bfqd, - } - - bfq_log_bfqq(bfqd, bfqq, -- "expire (%d, slow %d, num_disp %d, idle_win %d)", reason, -- slow, bfqq->dispatched, bfq_bfqq_idle_window(bfqq)); -+ "expire (%d, slow %d, num_disp %d, idle_win %d, weight %d)", -+ reason, slow, bfqq->dispatched, -+ bfq_bfqq_idle_window(bfqq), entity->weight); - - /* - * Increase, decrease or leave budget unchanged according to - * reason. - */ -+ BUG_ON(bfqq->entity.budget < bfqq->entity.service); - __bfq_bfqq_recalc_budget(bfqd, bfqq, reason); -+ BUG_ON(bfqq->next_rq == NULL && -+ bfqq->entity.budget < bfqq->entity.service); - __bfq_bfqq_expire(bfqd, bfqq); -+ -+ BUG_ON(!bfq_bfqq_busy(bfqq) && reason == BFQ_BFQQ_BUDGET_EXHAUSTED && -+ !bfq_class_idle(bfqq)); -+ -+ if (!bfq_bfqq_busy(bfqq) && -+ reason != BFQ_BFQQ_BUDGET_TIMEOUT && -+ reason != BFQ_BFQQ_BUDGET_EXHAUSTED) -+ bfq_mark_bfqq_non_blocking_wait_rq(bfqq); - } - - /* -@@ -2345,20 +3192,17 @@ static void bfq_bfqq_expire(struct bfq_data *bfqd, - */ - static bool bfq_bfqq_budget_timeout(struct bfq_queue *bfqq) - { -- if (bfq_bfqq_budget_new(bfqq) || -- time_before(jiffies, bfqq->budget_timeout)) -- return false; -- return true; -+ return time_is_before_eq_jiffies(bfqq->budget_timeout); - } - - /* -- * If we expire a queue that is waiting for the arrival of a new -- * request, we may prevent the fictitious timestamp back-shifting that -- * allows the guarantees of the queue to be preserved (see [1] for -- * this tricky aspect). Hence we return true only if this condition -- * does not hold, or if the queue is slow enough to deserve only to be -- * kicked off for preserving a high throughput. --*/ -+ * If we expire a queue that is actively waiting (i.e., with the -+ * device idled) for the arrival of a new request, then we may incur -+ * the timestamp misalignment problem described in the body of the -+ * function __bfq_activate_entity. Hence we return true only if this -+ * condition does not hold, or if the queue is slow enough to deserve -+ * only to be kicked off for preserving a high throughput. -+ */ - static bool bfq_may_expire_for_budg_timeout(struct bfq_queue *bfqq) - { - bfq_log_bfqq(bfqq->bfqd, bfqq, -@@ -2400,10 +3244,12 @@ static bool bfq_bfqq_may_idle(struct bfq_queue *bfqq) - { - struct bfq_data *bfqd = bfqq->bfqd; - bool idling_boosts_thr, idling_boosts_thr_without_issues, -- all_queues_seeky, on_hdd_and_not_all_queues_seeky, - idling_needed_for_service_guarantees, - asymmetric_scenario; - -+ if (bfqd->strict_guarantees) -+ return true; -+ - /* - * The next variable takes into account the cases where idling - * boosts the throughput. -@@ -2466,74 +3312,27 @@ static bool bfq_bfqq_may_idle(struct bfq_queue *bfqq) - bfqd->wr_busy_queues == 0; - - /* -- * There are then two cases where idling must be performed not -+ * There is then a case where idling must be performed not - * for throughput concerns, but to preserve service -- * guarantees. In the description of these cases, we say, for -- * short, that a queue is sequential/random if the process -- * associated to the queue issues sequential/random requests -- * (in the second case the queue may be tagged as seeky or -- * even constantly_seeky). -+ * guarantees. - * -- * To introduce the first case, we note that, since -- * bfq_bfqq_idle_window(bfqq) is false if the device is -- * NCQ-capable and bfqq is random (see -- * bfq_update_idle_window()), then, from the above two -- * assignments it follows that -- * idling_boosts_thr_without_issues is false if the device is -- * NCQ-capable and bfqq is random. Therefore, for this case, -- * device idling would never be allowed if we used just -- * idling_boosts_thr_without_issues to decide whether to allow -- * it. And, beneficially, this would imply that throughput -- * would always be boosted also with random I/O on NCQ-capable -- * HDDs. -- * -- * But we must be careful on this point, to avoid an unfair -- * treatment for bfqq. In fact, because of the same above -- * assignments, idling_boosts_thr_without_issues is, on the -- * other hand, true if 1) the device is an HDD and bfqq is -- * sequential, and 2) there are no busy weight-raised -- * queues. As a consequence, if we used just -- * idling_boosts_thr_without_issues to decide whether to idle -- * the device, then with an HDD we might easily bump into a -- * scenario where queues that are sequential and I/O-bound -- * would enjoy idling, whereas random queues would not. The -- * latter might then get a low share of the device throughput, -- * simply because the former would get many requests served -- * after being set as in service, while the latter would not. -- * -- * To address this issue, we start by setting to true a -- * sentinel variable, on_hdd_and_not_all_queues_seeky, if the -- * device is rotational and not all queues with pending or -- * in-flight requests are constantly seeky (i.e., there are -- * active sequential queues, and bfqq might then be mistreated -- * if it does not enjoy idling because it is random). -- */ -- all_queues_seeky = bfq_bfqq_constantly_seeky(bfqq) && -- bfqd->busy_in_flight_queues == -- bfqd->const_seeky_busy_in_flight_queues; -- -- on_hdd_and_not_all_queues_seeky = -- !blk_queue_nonrot(bfqd->queue) && !all_queues_seeky; -- -- /* -- * To introduce the second case where idling needs to be -- * performed to preserve service guarantees, we can note that -- * allowing the drive to enqueue more than one request at a -- * time, and hence delegating de facto final scheduling -- * decisions to the drive's internal scheduler, causes loss of -- * control on the actual request service order. In particular, -- * the critical situation is when requests from different -- * processes happens to be present, at the same time, in the -- * internal queue(s) of the drive. In such a situation, the -- * drive, by deciding the service order of the -- * internally-queued requests, does determine also the actual -- * throughput distribution among these processes. But the -- * drive typically has no notion or concern about per-process -- * throughput distribution, and makes its decisions only on a -- * per-request basis. Therefore, the service distribution -- * enforced by the drive's internal scheduler is likely to -- * coincide with the desired device-throughput distribution -- * only in a completely symmetric scenario where: -+ * To introduce this case, we can note that allowing the drive -+ * to enqueue more than one request at a time, and hence -+ * delegating de facto final scheduling decisions to the -+ * drive's internal scheduler, entails loss of control on the -+ * actual request service order. In particular, the critical -+ * situation is when requests from different processes happen -+ * to be present, at the same time, in the internal queue(s) -+ * of the drive. In such a situation, the drive, by deciding -+ * the service order of the internally-queued requests, does -+ * determine also the actual throughput distribution among -+ * these processes. But the drive typically has no notion or -+ * concern about per-process throughput distribution, and -+ * makes its decisions only on a per-request basis. Therefore, -+ * the service distribution enforced by the drive's internal -+ * scheduler is likely to coincide with the desired -+ * device-throughput distribution only in a completely -+ * symmetric scenario where: - * (i) each of these processes must get the same throughput as - * the others; - * (ii) all these processes have the same I/O pattern -@@ -2555,26 +3354,53 @@ static bool bfq_bfqq_may_idle(struct bfq_queue *bfqq) - * words, only if sub-condition (i) holds, then idling is - * allowed, and the device tends to be prevented from queueing - * many requests, possibly of several processes. The reason -- * for not controlling also sub-condition (ii) is that, first, -- * in the case of an HDD, the asymmetry in terms of types of -- * I/O patterns is already taken in to account in the above -- * sentinel variable -- * on_hdd_and_not_all_queues_seeky. Secondly, in the case of a -- * flash-based device, we prefer however to privilege -- * throughput (and idling lowers throughput for this type of -- * devices), for the following reasons: -- * 1) differently from HDDs, the service time of random -- * requests is not orders of magnitudes lower than the service -- * time of sequential requests; thus, even if processes doing -- * sequential I/O get a preferential treatment with respect to -- * others doing random I/O, the consequences are not as -- * dramatic as with HDDs; -- * 2) if a process doing random I/O does need strong -- * throughput guarantees, it is hopefully already being -- * weight-raised, or the user is likely to have assigned it a -- * higher weight than the other processes (and thus -- * sub-condition (i) is likely to be false, which triggers -- * idling). -+ * for not controlling also sub-condition (ii) is that we -+ * exploit preemption to preserve guarantees in case of -+ * symmetric scenarios, even if (ii) does not hold, as -+ * explained in the next two paragraphs. -+ * -+ * Even if a queue, say Q, is expired when it remains idle, Q -+ * can still preempt the new in-service queue if the next -+ * request of Q arrives soon (see the comments on -+ * bfq_bfqq_update_budg_for_activation). If all queues and -+ * groups have the same weight, this form of preemption, -+ * combined with the hole-recovery heuristic described in the -+ * comments on function bfq_bfqq_update_budg_for_activation, -+ * are enough to preserve a correct bandwidth distribution in -+ * the mid term, even without idling. In fact, even if not -+ * idling allows the internal queues of the device to contain -+ * many requests, and thus to reorder requests, we can rather -+ * safely assume that the internal scheduler still preserves a -+ * minimum of mid-term fairness. The motivation for using -+ * preemption instead of idling is that, by not idling, -+ * service guarantees are preserved without minimally -+ * sacrificing throughput. In other words, both a high -+ * throughput and its desired distribution are obtained. -+ * -+ * More precisely, this preemption-based, idleless approach -+ * provides fairness in terms of IOPS, and not sectors per -+ * second. This can be seen with a simple example. Suppose -+ * that there are two queues with the same weight, but that -+ * the first queue receives requests of 8 sectors, while the -+ * second queue receives requests of 1024 sectors. In -+ * addition, suppose that each of the two queues contains at -+ * most one request at a time, which implies that each queue -+ * always remains idle after it is served. Finally, after -+ * remaining idle, each queue receives very quickly a new -+ * request. It follows that the two queues are served -+ * alternatively, preempting each other if needed. This -+ * implies that, although both queues have the same weight, -+ * the queue with large requests receives a service that is -+ * 1024/8 times as high as the service received by the other -+ * queue. -+ * -+ * On the other hand, device idling is performed, and thus -+ * pure sector-domain guarantees are provided, for the -+ * following queues, which are likely to need stronger -+ * throughput guarantees: weight-raised queues, and queues -+ * with a higher weight than other queues. When such queues -+ * are active, sub-condition (i) is false, which triggers -+ * device idling. - * - * According to the above considerations, the next variable is - * true (only) if sub-condition (i) holds. To compute the -@@ -2582,7 +3408,7 @@ static bool bfq_bfqq_may_idle(struct bfq_queue *bfqq) - * the function bfq_symmetric_scenario(), but also check - * whether bfqq is being weight-raised, because - * bfq_symmetric_scenario() does not take into account also -- * weight-raised queues (see comments to -+ * weight-raised queues (see comments on - * bfq_weights_tree_add()). - * - * As a side note, it is worth considering that the above -@@ -2604,17 +3430,16 @@ static bool bfq_bfqq_may_idle(struct bfq_queue *bfqq) - * bfqq. Such a case is when bfqq became active in a burst of - * queue activations. Queues that became active during a large - * burst benefit only from throughput, as discussed in the -- * comments to bfq_handle_burst. Thus, if bfqq became active -+ * comments on bfq_handle_burst. Thus, if bfqq became active - * in a burst and not idling the device maximizes throughput, - * then the device must no be idled, because not idling the - * device provides bfqq and all other queues in the burst with -- * maximum benefit. Combining this and the two cases above, we -- * can now establish when idling is actually needed to -- * preserve service guarantees. -+ * maximum benefit. Combining this and the above case, we can -+ * now establish when idling is actually needed to preserve -+ * service guarantees. - */ - idling_needed_for_service_guarantees = -- (on_hdd_and_not_all_queues_seeky || asymmetric_scenario) && -- !bfq_bfqq_in_large_burst(bfqq); -+ asymmetric_scenario && !bfq_bfqq_in_large_burst(bfqq); - - /* - * We have now all the components we need to compute the return -@@ -2624,6 +3449,16 @@ static bool bfq_bfqq_may_idle(struct bfq_queue *bfqq) - * 2) idling either boosts the throughput (without issues), or - * is necessary to preserve service guarantees. - */ -+ bfq_log_bfqq(bfqd, bfqq, "may_idle: sync %d idling_boosts_thr %d", -+ bfq_bfqq_sync(bfqq), idling_boosts_thr); -+ -+ bfq_log_bfqq(bfqd, bfqq, -+ "may_idle: wr_busy %d boosts %d IO-bound %d guar %d", -+ bfqd->wr_busy_queues, -+ idling_boosts_thr_without_issues, -+ bfq_bfqq_IO_bound(bfqq), -+ idling_needed_for_service_guarantees); -+ - return bfq_bfqq_sync(bfqq) && - (idling_boosts_thr_without_issues || - idling_needed_for_service_guarantees); -@@ -2635,7 +3470,7 @@ static bool bfq_bfqq_may_idle(struct bfq_queue *bfqq) - * 1) the queue must remain in service and cannot be expired, and - * 2) the device must be idled to wait for the possible arrival of a new - * request for the queue. -- * See the comments to the function bfq_bfqq_may_idle for the reasons -+ * See the comments on the function bfq_bfqq_may_idle for the reasons - * why performing device idling is the best choice to boost the throughput - * and preserve service guarantees when bfq_bfqq_may_idle itself - * returns true. -@@ -2665,7 +3500,7 @@ static struct bfq_queue *bfq_select_queue(struct bfq_data *bfqd) - bfq_log_bfqq(bfqd, bfqq, "select_queue: already in-service queue"); - - if (bfq_may_expire_for_budg_timeout(bfqq) && -- !timer_pending(&bfqd->idle_slice_timer) && -+ !hrtimer_active(&bfqd->idle_slice_timer) && - !bfq_bfqq_must_idle(bfqq)) - goto expire; - -@@ -2685,7 +3520,8 @@ static struct bfq_queue *bfq_select_queue(struct bfq_data *bfqd) - * not disable disk idling even when a new request - * arrives. - */ -- if (timer_pending(&bfqd->idle_slice_timer)) { -+ if (bfq_bfqq_wait_request(bfqq)) { -+ BUG_ON(!hrtimer_active(&bfqd->idle_slice_timer)); - /* - * If we get here: 1) at least a new request - * has arrived but we have not disabled the -@@ -2700,10 +3536,8 @@ static struct bfq_queue *bfq_select_queue(struct bfq_data *bfqd) - * So we disable idling. - */ - bfq_clear_bfqq_wait_request(bfqq); -- del_timer(&bfqd->idle_slice_timer); --#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ hrtimer_try_to_cancel(&bfqd->idle_slice_timer); - bfqg_stats_update_idle_time(bfqq_group(bfqq)); --#endif - } - goto keep_queue; - } -@@ -2714,7 +3548,7 @@ static struct bfq_queue *bfq_select_queue(struct bfq_data *bfqd) - * for a new request, or has requests waiting for a completion and - * may idle after their completion, then keep it anyway. - */ -- if (timer_pending(&bfqd->idle_slice_timer) || -+ if (hrtimer_active(&bfqd->idle_slice_timer) || - (bfqq->dispatched != 0 && bfq_bfqq_may_idle(bfqq))) { - bfqq = NULL; - goto keep_queue; -@@ -2736,6 +3570,9 @@ static void bfq_update_wr_data(struct bfq_data *bfqd, struct bfq_queue *bfqq) - struct bfq_entity *entity = &bfqq->entity; - - if (bfqq->wr_coeff > 1) { /* queue is being weight-raised */ -+ BUG_ON(bfqq->wr_cur_max_time == bfqd->bfq_wr_rt_max_time && -+ time_is_after_jiffies(bfqq->last_wr_start_finish)); -+ - bfq_log_bfqq(bfqd, bfqq, - "raising period dur %u/%u msec, old coeff %u, w %d(%d)", - jiffies_to_msecs(jiffies - bfqq->last_wr_start_finish), -@@ -2749,22 +3586,30 @@ static void bfq_update_wr_data(struct bfq_data *bfqd, struct bfq_queue *bfqq) - bfq_log_bfqq(bfqd, bfqq, "WARN: pending prio change"); - - /* -- * If the queue was activated in a burst, or -- * too much time has elapsed from the beginning -- * of this weight-raising period, or the queue has -- * exceeded the acceptable number of cooperations, -- * then end weight raising. -+ * If the queue was activated in a burst, or too much -+ * time has elapsed from the beginning of this -+ * weight-raising period, then end weight raising. - */ -- if (bfq_bfqq_in_large_burst(bfqq) || -- bfq_bfqq_cooperations(bfqq) >= bfqd->bfq_coop_thresh || -- time_is_before_jiffies(bfqq->last_wr_start_finish + -- bfqq->wr_cur_max_time)) { -- bfqq->last_wr_start_finish = jiffies; -- bfq_log_bfqq(bfqd, bfqq, -- "wrais ending at %lu, rais_max_time %u", -- bfqq->last_wr_start_finish, -- jiffies_to_msecs(bfqq->wr_cur_max_time)); -+ if (bfq_bfqq_in_large_burst(bfqq)) - bfq_bfqq_end_wr(bfqq); -+ else if (time_is_before_jiffies(bfqq->last_wr_start_finish + -+ bfqq->wr_cur_max_time)) { -+ if (bfqq->wr_cur_max_time != bfqd->bfq_wr_rt_max_time || -+ time_is_before_jiffies(bfqq->wr_start_at_switch_to_srt + -+ bfq_wr_duration(bfqd))) -+ bfq_bfqq_end_wr(bfqq); -+ else { -+ /* switch back to interactive wr */ -+ bfqq->wr_coeff = bfqd->bfq_wr_coeff; -+ bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); -+ bfqq->last_wr_start_finish = -+ bfqq->wr_start_at_switch_to_srt; -+ BUG_ON(time_is_after_jiffies( -+ bfqq->last_wr_start_finish)); -+ bfqq->entity.prio_changed = 1; -+ bfq_log_bfqq(bfqd, bfqq, -+ "back to interactive wr"); -+ } - } - } - /* Update weight both if it must be raised and if it must be lowered */ -@@ -2815,13 +3660,29 @@ static int bfq_dispatch_request(struct bfq_data *bfqd, - */ - if (!bfqd->rq_in_driver) - bfq_schedule_dispatch(bfqd); -+ BUG_ON(bfqq->entity.budget < bfqq->entity.service); - goto expire; - } - -+ BUG_ON(bfqq->entity.budget < bfqq->entity.service); - /* Finally, insert request into driver dispatch list. */ - bfq_bfqq_served(bfqq, service_to_charge); -+ -+ BUG_ON(bfqq->entity.budget < bfqq->entity.service); -+ - bfq_dispatch_insert(bfqd->queue, rq); - -+ /* -+ * If weight raising has to terminate for bfqq, then next -+ * function causes an immediate update of bfqq's weight, -+ * without waiting for next activation. As a consequence, on -+ * expiration, bfqq will be timestamped as if has never been -+ * weight-raised during this service slot, even if it has -+ * received part or even most of the service as a -+ * weight-raised queue. This inflates bfqq's timestamps, which -+ * is beneficial, as bfqq is then more willing to leave the -+ * device immediately to possible other weight-raised queues. -+ */ - bfq_update_wr_data(bfqd, bfqq); - - bfq_log_bfqq(bfqd, bfqq, -@@ -2837,9 +3698,7 @@ static int bfq_dispatch_request(struct bfq_data *bfqd, - bfqd->in_service_bic = RQ_BIC(rq); - } - -- if (bfqd->busy_queues > 1 && ((!bfq_bfqq_sync(bfqq) && -- dispatched >= bfqd->bfq_max_budget_async_rq) || -- bfq_class_idle(bfqq))) -+ if (bfqd->busy_queues > 1 && bfq_class_idle(bfqq)) - goto expire; - - return dispatched; -@@ -2885,8 +3744,8 @@ static int bfq_forced_dispatch(struct bfq_data *bfqd) - st = bfq_entity_service_tree(&bfqq->entity); - - dispatched += __bfq_forced_dispatch_bfqq(bfqq); -- bfqq->max_budget = bfq_max_budget(bfqd); - -+ bfqq->max_budget = bfq_max_budget(bfqd); - bfq_forget_idle(st); - } - -@@ -2899,37 +3758,37 @@ static int bfq_dispatch_requests(struct request_queue *q, int force) - { - struct bfq_data *bfqd = q->elevator->elevator_data; - struct bfq_queue *bfqq; -- int max_dispatch; - - bfq_log(bfqd, "dispatch requests: %d busy queues", bfqd->busy_queues); -+ - if (bfqd->busy_queues == 0) - return 0; - - if (unlikely(force)) - return bfq_forced_dispatch(bfqd); - -+ /* -+ * Force device to serve one request at a time if -+ * strict_guarantees is true. Forcing this service scheme is -+ * currently the ONLY way to guarantee that the request -+ * service order enforced by the scheduler is respected by a -+ * queueing device. Otherwise the device is free even to make -+ * some unlucky request wait for as long as the device -+ * wishes. -+ * -+ * Of course, serving one request at at time may cause loss of -+ * throughput. -+ */ -+ if (bfqd->strict_guarantees && bfqd->rq_in_driver > 0) -+ return 0; -+ - bfqq = bfq_select_queue(bfqd); - if (!bfqq) - return 0; - -- if (bfq_class_idle(bfqq)) -- max_dispatch = 1; -- -- if (!bfq_bfqq_sync(bfqq)) -- max_dispatch = bfqd->bfq_max_budget_async_rq; -- -- if (!bfq_bfqq_sync(bfqq) && bfqq->dispatched >= max_dispatch) { -- if (bfqd->busy_queues > 1) -- return 0; -- if (bfqq->dispatched >= 4 * max_dispatch) -- return 0; -- } -- -- if (bfqd->sync_flight != 0 && !bfq_bfqq_sync(bfqq)) -- return 0; -+ BUG_ON(bfqq->entity.budget < bfqq->entity.service); - -- bfq_clear_bfqq_wait_request(bfqq); -- BUG_ON(timer_pending(&bfqd->idle_slice_timer)); -+ BUG_ON(bfq_bfqq_wait_request(bfqq)); - - if (!bfq_dispatch_request(bfqd, bfqq)) - return 0; -@@ -2937,6 +3796,8 @@ static int bfq_dispatch_requests(struct request_queue *q, int force) - bfq_log_bfqq(bfqd, bfqq, "dispatched %s request", - bfq_bfqq_sync(bfqq) ? "sync" : "async"); - -+ BUG_ON(bfqq->next_rq == NULL && -+ bfqq->entity.budget < bfqq->entity.service); - return 1; - } - -@@ -2948,23 +3809,21 @@ static int bfq_dispatch_requests(struct request_queue *q, int force) - */ - static void bfq_put_queue(struct bfq_queue *bfqq) - { -- struct bfq_data *bfqd = bfqq->bfqd; - #ifdef CONFIG_BFQ_GROUP_IOSCHED - struct bfq_group *bfqg = bfqq_group(bfqq); - #endif - -- BUG_ON(atomic_read(&bfqq->ref) <= 0); -+ BUG_ON(bfqq->ref <= 0); - -- bfq_log_bfqq(bfqd, bfqq, "put_queue: %p %d", bfqq, -- atomic_read(&bfqq->ref)); -- if (!atomic_dec_and_test(&bfqq->ref)) -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "put_queue: %p %d", bfqq, bfqq->ref); -+ bfqq->ref--; -+ if (bfqq->ref) - return; - - BUG_ON(rb_first(&bfqq->sort_list)); - BUG_ON(bfqq->allocated[READ] + bfqq->allocated[WRITE] != 0); - BUG_ON(bfqq->entity.tree); - BUG_ON(bfq_bfqq_busy(bfqq)); -- BUG_ON(bfqd->in_service_queue == bfqq); - - if (bfq_bfqq_sync(bfqq)) - /* -@@ -2977,7 +3836,7 @@ static void bfq_put_queue(struct bfq_queue *bfqq) - */ - hlist_del_init(&bfqq->burst_list_node); - -- bfq_log_bfqq(bfqd, bfqq, "put_queue: %p freed", bfqq); -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "put_queue: %p freed", bfqq); - - kmem_cache_free(bfq_pool, bfqq); - #ifdef CONFIG_BFQ_GROUP_IOSCHED -@@ -3011,8 +3870,7 @@ static void bfq_exit_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq) - bfq_schedule_dispatch(bfqd); - } - -- bfq_log_bfqq(bfqd, bfqq, "exit_bfqq: %p, %d", bfqq, -- atomic_read(&bfqq->ref)); -+ bfq_log_bfqq(bfqd, bfqq, "exit_bfqq: %p, %d", bfqq, bfqq->ref); - - bfq_put_cooperator(bfqq); - -@@ -3021,28 +3879,7 @@ static void bfq_exit_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq) - - static void bfq_init_icq(struct io_cq *icq) - { -- struct bfq_io_cq *bic = icq_to_bic(icq); -- -- bic->ttime.last_end_request = jiffies; -- /* -- * A newly created bic indicates that the process has just -- * started doing I/O, and is probably mapping into memory its -- * executable and libraries: it definitely needs weight raising. -- * There is however the possibility that the process performs, -- * for a while, I/O close to some other process. EQM intercepts -- * this behavior and may merge the queue corresponding to the -- * process with some other queue, BEFORE the weight of the queue -- * is raised. Merged queues are not weight-raised (they are assumed -- * to belong to processes that benefit only from high throughput). -- * If the merge is basically the consequence of an accident, then -- * the queue will be split soon and will get back its old weight. -- * It is then important to write down somewhere that this queue -- * does need weight raising, even if it did not make it to get its -- * weight raised before being merged. To this purpose, we overload -- * the field raising_time_left and assign 1 to it, to mark the queue -- * as needing weight raising. -- */ -- bic->wr_time_left = 1; -+ icq_to_bic(icq)->ttime.last_end_request = ktime_get_ns() - (1ULL<<32); - } - - static void bfq_exit_icq(struct io_cq *icq) -@@ -3050,21 +3887,21 @@ static void bfq_exit_icq(struct io_cq *icq) - struct bfq_io_cq *bic = icq_to_bic(icq); - struct bfq_data *bfqd = bic_to_bfqd(bic); - -- if (bic->bfqq[BLK_RW_ASYNC]) { -- bfq_exit_bfqq(bfqd, bic->bfqq[BLK_RW_ASYNC]); -- bic->bfqq[BLK_RW_ASYNC] = NULL; -+ if (bic_to_bfqq(bic, false)) { -+ bfq_exit_bfqq(bfqd, bic_to_bfqq(bic, false)); -+ bic_set_bfqq(bic, NULL, false); - } - -- if (bic->bfqq[BLK_RW_SYNC]) { -+ if (bic_to_bfqq(bic, true)) { - /* - * If the bic is using a shared queue, put the reference - * taken on the io_context when the bic started using a - * shared bfq_queue. - */ -- if (bfq_bfqq_coop(bic->bfqq[BLK_RW_SYNC])) -+ if (bfq_bfqq_coop(bic_to_bfqq(bic, true))) - put_io_context(icq->ioc); -- bfq_exit_bfqq(bfqd, bic->bfqq[BLK_RW_SYNC]); -- bic->bfqq[BLK_RW_SYNC] = NULL; -+ bfq_exit_bfqq(bfqd, bic_to_bfqq(bic, true)); -+ bic_set_bfqq(bic, NULL, true); - } - } - -@@ -3072,8 +3909,8 @@ static void bfq_exit_icq(struct io_cq *icq) - * Update the entity prio values; note that the new values will not - * be used until the next (re)activation. - */ --static void --bfq_set_next_ioprio_data(struct bfq_queue *bfqq, struct bfq_io_cq *bic) -+static void bfq_set_next_ioprio_data(struct bfq_queue *bfqq, -+ struct bfq_io_cq *bic) - { - struct task_struct *tsk = current; - int ioprio_class; -@@ -3105,7 +3942,7 @@ bfq_set_next_ioprio_data(struct bfq_queue *bfqq, struct bfq_io_cq *bic) - break; - } - -- if (bfqq->new_ioprio < 0 || bfqq->new_ioprio >= IOPRIO_BE_NR) { -+ if (bfqq->new_ioprio >= IOPRIO_BE_NR) { - pr_crit("bfq_set_next_ioprio_data: new_ioprio %d\n", - bfqq->new_ioprio); - BUG(); -@@ -3113,45 +3950,40 @@ bfq_set_next_ioprio_data(struct bfq_queue *bfqq, struct bfq_io_cq *bic) - - bfqq->entity.new_weight = bfq_ioprio_to_weight(bfqq->new_ioprio); - bfqq->entity.prio_changed = 1; -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "set_next_ioprio_data: bic_class %d prio %d class %d", -+ ioprio_class, bfqq->new_ioprio, bfqq->new_ioprio_class); - } - - static void bfq_check_ioprio_change(struct bfq_io_cq *bic, struct bio *bio) - { -- struct bfq_data *bfqd; -- struct bfq_queue *bfqq, *new_bfqq; -+ struct bfq_data *bfqd = bic_to_bfqd(bic); -+ struct bfq_queue *bfqq; - unsigned long uninitialized_var(flags); - int ioprio = bic->icq.ioc->ioprio; - -- bfqd = bfq_get_bfqd_locked(&(bic->icq.q->elevator->elevator_data), -- &flags); - /* - * This condition may trigger on a newly created bic, be sure to - * drop the lock before returning. - */ - if (unlikely(!bfqd) || likely(bic->ioprio == ioprio)) -- goto out; -+ return; - - bic->ioprio = ioprio; - -- bfqq = bic->bfqq[BLK_RW_ASYNC]; -+ bfqq = bic_to_bfqq(bic, false); - if (bfqq) { -- new_bfqq = bfq_get_queue(bfqd, bio, BLK_RW_ASYNC, bic, -- GFP_ATOMIC); -- if (new_bfqq) { -- bic->bfqq[BLK_RW_ASYNC] = new_bfqq; -- bfq_log_bfqq(bfqd, bfqq, -- "check_ioprio_change: bfqq %p %d", -- bfqq, atomic_read(&bfqq->ref)); -- bfq_put_queue(bfqq); -- } -+ bfq_put_queue(bfqq); -+ bfqq = bfq_get_queue(bfqd, bio, BLK_RW_ASYNC, bic); -+ bic_set_bfqq(bic, bfqq, false); -+ bfq_log_bfqq(bfqd, bfqq, -+ "check_ioprio_change: bfqq %p %d", -+ bfqq, bfqq->ref); - } - -- bfqq = bic->bfqq[BLK_RW_SYNC]; -+ bfqq = bic_to_bfqq(bic, true); - if (bfqq) - bfq_set_next_ioprio_data(bfqq, bic); -- --out: -- bfq_put_bfqd_unlock(bfqd, &flags); - } - - static void bfq_init_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq, -@@ -3160,8 +3992,9 @@ static void bfq_init_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq, - RB_CLEAR_NODE(&bfqq->entity.rb_node); - INIT_LIST_HEAD(&bfqq->fifo); - INIT_HLIST_NODE(&bfqq->burst_list_node); -+ BUG_ON(!hlist_unhashed(&bfqq->burst_list_node)); - -- atomic_set(&bfqq->ref, 0); -+ bfqq->ref = 0; - bfqq->bfqd = bfqd; - - if (bic) -@@ -3171,6 +4004,7 @@ static void bfq_init_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq, - if (!bfq_class_idle(bfqq)) - bfq_mark_bfqq_idle_window(bfqq); - bfq_mark_bfqq_sync(bfqq); -+ bfq_mark_bfqq_just_created(bfqq); - } else - bfq_clear_bfqq_sync(bfqq); - bfq_mark_bfqq_IO_bound(bfqq); -@@ -3180,72 +4014,19 @@ static void bfq_init_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq, - bfqq->pid = pid; - - bfqq->wr_coeff = 1; -- bfqq->last_wr_start_finish = 0; -+ bfqq->last_wr_start_finish = jiffies; -+ bfqq->wr_start_at_switch_to_srt = bfq_smallest_from_now(); -+ bfqq->budget_timeout = bfq_smallest_from_now(); -+ bfqq->split_time = bfq_smallest_from_now(); -+ - /* - * Set to the value for which bfqq will not be deemed as - * soft rt when it becomes backlogged. - */ -- bfqq->soft_rt_next_start = bfq_infinity_from_now(jiffies); --} -- --static struct bfq_queue *bfq_find_alloc_queue(struct bfq_data *bfqd, -- struct bio *bio, int is_sync, -- struct bfq_io_cq *bic, -- gfp_t gfp_mask) --{ -- struct bfq_group *bfqg; -- struct bfq_queue *bfqq, *new_bfqq = NULL; -- struct blkcg *blkcg; -- --retry: -- rcu_read_lock(); -- -- blkcg = bio_blkcg(bio); -- bfqg = bfq_find_alloc_group(bfqd, blkcg); -- /* bic always exists here */ -- bfqq = bic_to_bfqq(bic, is_sync); -- -- /* -- * Always try a new alloc if we fall back to the OOM bfqq -- * originally, since it should just be a temporary situation. -- */ -- if (!bfqq || bfqq == &bfqd->oom_bfqq) { -- bfqq = NULL; -- if (new_bfqq) { -- bfqq = new_bfqq; -- new_bfqq = NULL; -- } else if (gfpflags_allow_blocking(gfp_mask)) { -- rcu_read_unlock(); -- spin_unlock_irq(bfqd->queue->queue_lock); -- new_bfqq = kmem_cache_alloc_node(bfq_pool, -- gfp_mask | __GFP_ZERO, -- bfqd->queue->node); -- spin_lock_irq(bfqd->queue->queue_lock); -- if (new_bfqq) -- goto retry; -- } else { -- bfqq = kmem_cache_alloc_node(bfq_pool, -- gfp_mask | __GFP_ZERO, -- bfqd->queue->node); -- } -- -- if (bfqq) { -- bfq_init_bfqq(bfqd, bfqq, bic, current->pid, -- is_sync); -- bfq_init_entity(&bfqq->entity, bfqg); -- bfq_log_bfqq(bfqd, bfqq, "allocated"); -- } else { -- bfqq = &bfqd->oom_bfqq; -- bfq_log_bfqq(bfqd, bfqq, "using oom bfqq"); -- } -- } -+ bfqq->soft_rt_next_start = bfq_greatest_from_now(); - -- if (new_bfqq) -- kmem_cache_free(bfq_pool, new_bfqq); -- -- rcu_read_unlock(); -- -- return bfqq; -+ /* first request is almost certainly seeky */ -+ bfqq->seek_history = 1; - } - - static struct bfq_queue **bfq_async_queue_prio(struct bfq_data *bfqd, -@@ -3268,90 +4049,86 @@ static struct bfq_queue **bfq_async_queue_prio(struct bfq_data *bfqd, - } - - static struct bfq_queue *bfq_get_queue(struct bfq_data *bfqd, -- struct bio *bio, int is_sync, -- struct bfq_io_cq *bic, gfp_t gfp_mask) -+ struct bio *bio, bool is_sync, -+ struct bfq_io_cq *bic) - { - const int ioprio = IOPRIO_PRIO_DATA(bic->ioprio); - const int ioprio_class = IOPRIO_PRIO_CLASS(bic->ioprio); - struct bfq_queue **async_bfqq = NULL; -- struct bfq_queue *bfqq = NULL; -+ struct bfq_queue *bfqq; -+ struct bfq_group *bfqg; - -- if (!is_sync) { -- struct blkcg *blkcg; -- struct bfq_group *bfqg; -+ rcu_read_lock(); -+ -+ bfqg = bfq_find_set_group(bfqd, bio_blkcg(bio)); -+ if (!bfqg) { -+ bfqq = &bfqd->oom_bfqq; -+ goto out; -+ } - -- rcu_read_lock(); -- blkcg = bio_blkcg(bio); -- rcu_read_unlock(); -- bfqg = bfq_find_alloc_group(bfqd, blkcg); -+ if (!is_sync) { - async_bfqq = bfq_async_queue_prio(bfqd, bfqg, ioprio_class, - ioprio); - bfqq = *async_bfqq; -+ if (bfqq) -+ goto out; - } - -- if (!bfqq) -- bfqq = bfq_find_alloc_queue(bfqd, bio, is_sync, bic, gfp_mask); -+ bfqq = kmem_cache_alloc_node(bfq_pool, GFP_NOWAIT | __GFP_ZERO, -+ bfqd->queue->node); -+ -+ if (bfqq) { -+ bfq_init_bfqq(bfqd, bfqq, bic, current->pid, -+ is_sync); -+ bfq_init_entity(&bfqq->entity, bfqg); -+ bfq_log_bfqq(bfqd, bfqq, "allocated"); -+ } else { -+ bfqq = &bfqd->oom_bfqq; -+ bfq_log_bfqq(bfqd, bfqq, "using oom bfqq"); -+ goto out; -+ } - - /* - * Pin the queue now that it's allocated, scheduler exit will - * prune it. - */ -- if (!is_sync && !(*async_bfqq)) { -- atomic_inc(&bfqq->ref); -+ if (async_bfqq) { -+ bfqq->ref++; - bfq_log_bfqq(bfqd, bfqq, "get_queue, bfqq not in async: %p, %d", -- bfqq, atomic_read(&bfqq->ref)); -+ bfqq, bfqq->ref); - *async_bfqq = bfqq; - } - -- atomic_inc(&bfqq->ref); -- bfq_log_bfqq(bfqd, bfqq, "get_queue, at end: %p, %d", bfqq, -- atomic_read(&bfqq->ref)); -+out: -+ bfqq->ref++; -+ bfq_log_bfqq(bfqd, bfqq, "get_queue, at end: %p, %d", bfqq, bfqq->ref); -+ rcu_read_unlock(); - return bfqq; - } - - static void bfq_update_io_thinktime(struct bfq_data *bfqd, - struct bfq_io_cq *bic) - { -- unsigned long elapsed = jiffies - bic->ttime.last_end_request; -- unsigned long ttime = min(elapsed, 2UL * bfqd->bfq_slice_idle); -+ struct bfq_ttime *ttime = &bic->ttime; -+ u64 elapsed = ktime_get_ns() - bic->ttime.last_end_request; - -- bic->ttime.ttime_samples = (7*bic->ttime.ttime_samples + 256) / 8; -- bic->ttime.ttime_total = (7*bic->ttime.ttime_total + 256*ttime) / 8; -- bic->ttime.ttime_mean = (bic->ttime.ttime_total + 128) / -- bic->ttime.ttime_samples; -+ elapsed = min_t(u64, elapsed, 2 * bfqd->bfq_slice_idle); -+ -+ ttime->ttime_samples = (7*bic->ttime.ttime_samples + 256) / 8; -+ ttime->ttime_total = div_u64(7*ttime->ttime_total + 256*elapsed, 8); -+ ttime->ttime_mean = div64_ul(ttime->ttime_total + 128, -+ ttime->ttime_samples); - } - --static void bfq_update_io_seektime(struct bfq_data *bfqd, -- struct bfq_queue *bfqq, -- struct request *rq) -+static void -+bfq_update_io_seektime(struct bfq_data *bfqd, struct bfq_queue *bfqq, -+ struct request *rq) - { -- sector_t sdist; -- u64 total; -- -- if (bfqq->last_request_pos < blk_rq_pos(rq)) -- sdist = blk_rq_pos(rq) - bfqq->last_request_pos; -- else -- sdist = bfqq->last_request_pos - blk_rq_pos(rq); -- -- /* -- * Don't allow the seek distance to get too large from the -- * odd fragment, pagein, etc. -- */ -- if (bfqq->seek_samples == 0) /* first request, not really a seek */ -- sdist = 0; -- else if (bfqq->seek_samples <= 60) /* second & third seek */ -- sdist = min(sdist, (bfqq->seek_mean * 4) + 2*1024*1024); -- else -- sdist = min(sdist, (bfqq->seek_mean * 4) + 2*1024*64); -- -- bfqq->seek_samples = (7*bfqq->seek_samples + 256) / 8; -- bfqq->seek_total = (7*bfqq->seek_total + (u64)256*sdist) / 8; -- total = bfqq->seek_total + (bfqq->seek_samples/2); -- do_div(total, bfqq->seek_samples); -- bfqq->seek_mean = (sector_t)total; -- -- bfq_log_bfqq(bfqd, bfqq, "dist=%llu mean=%llu", (u64)sdist, -- (u64)bfqq->seek_mean); -+ bfqq->seek_history <<= 1; -+ bfqq->seek_history |= -+ get_sdist(bfqq->last_request_pos, rq) > BFQQ_SEEK_THR && -+ (!blk_queue_nonrot(bfqd->queue) || -+ blk_rq_sectors(rq) < BFQQ_SECT_THR_NONROT); - } - - /* -@@ -3369,7 +4146,8 @@ static void bfq_update_idle_window(struct bfq_data *bfqd, - return; - - /* Idle window just restored, statistics are meaningless. */ -- if (bfq_bfqq_just_split(bfqq)) -+ if (time_is_after_eq_jiffies(bfqq->split_time + -+ bfqd->bfq_wr_min_idle_time)) - return; - - enable_idle = bfq_bfqq_idle_window(bfqq); -@@ -3409,22 +4187,13 @@ static void bfq_rq_enqueued(struct bfq_data *bfqd, struct bfq_queue *bfqq, - - bfq_update_io_thinktime(bfqd, bic); - bfq_update_io_seektime(bfqd, bfqq, rq); -- if (!BFQQ_SEEKY(bfqq) && bfq_bfqq_constantly_seeky(bfqq)) { -- bfq_clear_bfqq_constantly_seeky(bfqq); -- if (!blk_queue_nonrot(bfqd->queue)) { -- BUG_ON(!bfqd->const_seeky_busy_in_flight_queues); -- bfqd->const_seeky_busy_in_flight_queues--; -- } -- } - if (bfqq->entity.service > bfq_max_budget(bfqd) / 8 || - !BFQQ_SEEKY(bfqq)) - bfq_update_idle_window(bfqd, bfqq, bic); -- bfq_clear_bfqq_just_split(bfqq); - - bfq_log_bfqq(bfqd, bfqq, -- "rq_enqueued: idle_window=%d (seeky %d, mean %llu)", -- bfq_bfqq_idle_window(bfqq), BFQQ_SEEKY(bfqq), -- (unsigned long long) bfqq->seek_mean); -+ "rq_enqueued: idle_window=%d (seeky %d)", -+ bfq_bfqq_idle_window(bfqq), BFQQ_SEEKY(bfqq)); - - bfqq->last_request_pos = blk_rq_pos(rq) + blk_rq_sectors(rq); - -@@ -3438,14 +4207,15 @@ static void bfq_rq_enqueued(struct bfq_data *bfqd, struct bfq_queue *bfqq, - * is small and the queue is not to be expired, then - * just exit. - * -- * In this way, if the disk is being idled to wait for -- * a new request from the in-service queue, we avoid -- * unplugging the device and committing the disk to serve -- * just a small request. On the contrary, we wait for -- * the block layer to decide when to unplug the device: -- * hopefully, new requests will be merged to this one -- * quickly, then the device will be unplugged and -- * larger requests will be dispatched. -+ * In this way, if the device is being idled to wait -+ * for a new request from the in-service queue, we -+ * avoid unplugging the device and committing the -+ * device to serve just a small request. On the -+ * contrary, we wait for the block layer to decide -+ * when to unplug the device: hopefully, new requests -+ * will be merged to this one quickly, then the device -+ * will be unplugged and larger requests will be -+ * dispatched. - */ - if (small_req && !budget_timeout) - return; -@@ -3457,10 +4227,8 @@ static void bfq_rq_enqueued(struct bfq_data *bfqd, struct bfq_queue *bfqq, - * timer. - */ - bfq_clear_bfqq_wait_request(bfqq); -- del_timer(&bfqd->idle_slice_timer); --#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ hrtimer_try_to_cancel(&bfqd->idle_slice_timer); - bfqg_stats_update_idle_time(bfqq_group(bfqq)); --#endif - - /* - * The queue is not empty, because a new request just -@@ -3504,28 +4272,20 @@ static void bfq_insert_request(struct request_queue *q, struct request *rq) - */ - new_bfqq->allocated[rq_data_dir(rq)]++; - bfqq->allocated[rq_data_dir(rq)]--; -- atomic_inc(&new_bfqq->ref); -+ new_bfqq->ref++; -+ bfq_clear_bfqq_just_created(bfqq); - bfq_put_queue(bfqq); - if (bic_to_bfqq(RQ_BIC(rq), 1) == bfqq) - bfq_merge_bfqqs(bfqd, RQ_BIC(rq), - bfqq, new_bfqq); - rq->elv.priv[1] = new_bfqq; - bfqq = new_bfqq; -- } else -- bfq_bfqq_increase_failed_cooperations(bfqq); -+ } - } - - bfq_add_request(rq); - -- /* -- * Here a newly-created bfq_queue has already started a weight-raising -- * period: clear raising_time_left to prevent bfq_bfqq_save_state() -- * from assigning it a full weight-raising period. See the detailed -- * comments about this field in bfq_init_icq(). -- */ -- if (bfqq->bic) -- bfqq->bic->wr_time_left = 0; -- rq->fifo_time = jiffies + bfqd->bfq_fifo_expire[rq_is_sync(rq)]; -+ rq->fifo_time = ktime_get_ns() + bfqd->bfq_fifo_expire[rq_is_sync(rq)]; - list_add_tail(&rq->queuelist, &bfqq->fifo); - - bfq_rq_enqueued(bfqd, bfqq, rq); -@@ -3533,8 +4293,8 @@ static void bfq_insert_request(struct request_queue *q, struct request *rq) - - static void bfq_update_hw_tag(struct bfq_data *bfqd) - { -- bfqd->max_rq_in_driver = max(bfqd->max_rq_in_driver, -- bfqd->rq_in_driver); -+ bfqd->max_rq_in_driver = max_t(int, bfqd->max_rq_in_driver, -+ bfqd->rq_in_driver); - - if (bfqd->hw_tag == 1) - return; -@@ -3560,48 +4320,85 @@ static void bfq_completed_request(struct request_queue *q, struct request *rq) - { - struct bfq_queue *bfqq = RQ_BFQQ(rq); - struct bfq_data *bfqd = bfqq->bfqd; -- bool sync = bfq_bfqq_sync(bfqq); -+ u64 now_ns; -+ u32 delta_us; - -- bfq_log_bfqq(bfqd, bfqq, "completed one req with %u sects left (%d)", -- blk_rq_sectors(rq), sync); -+ bfq_log_bfqq(bfqd, bfqq, "completed one req with %u sects left", -+ blk_rq_sectors(rq)); - -+ assert_spin_locked(bfqd->queue->queue_lock); - bfq_update_hw_tag(bfqd); - - BUG_ON(!bfqd->rq_in_driver); - BUG_ON(!bfqq->dispatched); - bfqd->rq_in_driver--; - bfqq->dispatched--; --#ifdef CONFIG_BFQ_GROUP_IOSCHED - bfqg_stats_update_completion(bfqq_group(bfqq), - rq_start_time_ns(rq), -- rq_io_start_time_ns(rq), rq->cmd_flags); --#endif -+ rq_io_start_time_ns(rq), req_op(rq), -+ rq->cmd_flags); - - if (!bfqq->dispatched && !bfq_bfqq_busy(bfqq)) { -+ BUG_ON(!RB_EMPTY_ROOT(&bfqq->sort_list)); -+ /* -+ * Set budget_timeout (which we overload to store the -+ * time at which the queue remains with no backlog and -+ * no outstanding request; used by the weight-raising -+ * mechanism). -+ */ -+ bfqq->budget_timeout = jiffies; -+ - bfq_weights_tree_remove(bfqd, &bfqq->entity, - &bfqd->queue_weights_tree); -- if (!blk_queue_nonrot(bfqd->queue)) { -- BUG_ON(!bfqd->busy_in_flight_queues); -- bfqd->busy_in_flight_queues--; -- if (bfq_bfqq_constantly_seeky(bfqq)) { -- BUG_ON(!bfqd-> -- const_seeky_busy_in_flight_queues); -- bfqd->const_seeky_busy_in_flight_queues--; -- } -- } - } - -- if (sync) { -- bfqd->sync_flight--; -- RQ_BIC(rq)->ttime.last_end_request = jiffies; -- } -+ now_ns = ktime_get_ns(); -+ -+ RQ_BIC(rq)->ttime.last_end_request = now_ns; -+ -+ /* -+ * Using us instead of ns, to get a reasonable precision in -+ * computing rate in next check. -+ */ -+ delta_us = div_u64(now_ns - bfqd->last_completion, NSEC_PER_USEC); -+ -+ bfq_log(bfqd, "rq_completed: delta %uus/%luus max_size %u rate %llu/%llu", -+ delta_us, BFQ_MIN_TT/NSEC_PER_USEC, bfqd->last_rq_max_size, -+ (USEC_PER_SEC* -+ (u64)((bfqd->last_rq_max_size<>BFQ_RATE_SHIFT, -+ (USEC_PER_SEC*(u64)(1UL<<(BFQ_RATE_SHIFT-10)))>>BFQ_RATE_SHIFT); -+ -+ /* -+ * If the request took rather long to complete, and, according -+ * to the maximum request size recorded, this completion latency -+ * implies that the request was certainly served at a very low -+ * rate (less than 1M sectors/sec), then the whole observation -+ * interval that lasts up to this time instant cannot be a -+ * valid time interval for computing a new peak rate. Invoke -+ * bfq_update_rate_reset to have the following three steps -+ * taken: -+ * - close the observation interval at the last (previous) -+ * request dispatch or completion -+ * - compute rate, if possible, for that observation interval -+ * - reset to zero samples, which will trigger a proper -+ * re-initialization of the observation interval on next -+ * dispatch -+ */ -+ if (delta_us > BFQ_MIN_TT/NSEC_PER_USEC && -+ (bfqd->last_rq_max_size<last_completion = now_ns; - - /* -- * If we are waiting to discover whether the request pattern of the -- * task associated with the queue is actually isochronous, and -- * both requisites for this condition to hold are satisfied, then -- * compute soft_rt_next_start (see the comments to the function -- * bfq_bfqq_softrt_next_start()). -+ * If we are waiting to discover whether the request pattern -+ * of the task associated with the queue is actually -+ * isochronous, and both requisites for this condition to hold -+ * are now satisfied, then compute soft_rt_next_start (see the -+ * comments on the function bfq_bfqq_softrt_next_start()). We -+ * schedule this delayed check when bfqq expires, if it still -+ * has in-flight requests. - */ - if (bfq_bfqq_softrt_update(bfqq) && bfqq->dispatched == 0 && - RB_EMPTY_ROOT(&bfqq->sort_list)) -@@ -3613,10 +4410,7 @@ static void bfq_completed_request(struct request_queue *q, struct request *rq) - * or if we want to idle in case it has no pending requests. - */ - if (bfqd->in_service_queue == bfqq) { -- if (bfq_bfqq_budget_new(bfqq)) -- bfq_set_budget_timeout(bfqd); -- -- if (bfq_bfqq_must_idle(bfqq)) { -+ if (bfqq->dispatched == 0 && bfq_bfqq_must_idle(bfqq)) { - bfq_arm_slice_timer(bfqd); - goto out; - } else if (bfq_may_expire_for_budg_timeout(bfqq)) -@@ -3646,7 +4440,7 @@ static int __bfq_may_queue(struct bfq_queue *bfqq) - return ELV_MQUEUE_MAY; - } - --static int bfq_may_queue(struct request_queue *q, int rw) -+static int bfq_may_queue(struct request_queue *q, int op, int op_flags) - { - struct bfq_data *bfqd = q->elevator->elevator_data; - struct task_struct *tsk = current; -@@ -3663,7 +4457,7 @@ static int bfq_may_queue(struct request_queue *q, int rw) - if (!bic) - return ELV_MQUEUE_MAY; - -- bfqq = bic_to_bfqq(bic, rw_is_sync(rw)); -+ bfqq = bic_to_bfqq(bic, rw_is_sync(op, op_flags)); - if (bfqq) - return __bfq_may_queue(bfqq); - -@@ -3687,14 +4481,14 @@ static void bfq_put_request(struct request *rq) - rq->elv.priv[1] = NULL; - - bfq_log_bfqq(bfqq->bfqd, bfqq, "put_request %p, %d", -- bfqq, atomic_read(&bfqq->ref)); -+ bfqq, bfqq->ref); - bfq_put_queue(bfqq); - } - } - - /* - * Returns NULL if a new bfqq should be allocated, or the old bfqq if this -- * was the last process referring to said bfqq. -+ * was the last process referring to that bfqq. - */ - static struct bfq_queue * - bfq_split_bfqq(struct bfq_io_cq *bic, struct bfq_queue *bfqq) -@@ -3732,11 +4526,8 @@ static int bfq_set_request(struct request_queue *q, struct request *rq, - unsigned long flags; - bool split = false; - -- might_sleep_if(gfpflags_allow_blocking(gfp_mask)); -- -- bfq_check_ioprio_change(bic, bio); -- - spin_lock_irqsave(q->queue_lock, flags); -+ bfq_check_ioprio_change(bic, bio); - - if (!bic) - goto queue_fail; -@@ -3746,23 +4537,47 @@ static int bfq_set_request(struct request_queue *q, struct request *rq, - new_queue: - bfqq = bic_to_bfqq(bic, is_sync); - if (!bfqq || bfqq == &bfqd->oom_bfqq) { -- bfqq = bfq_get_queue(bfqd, bio, is_sync, bic, gfp_mask); -+ if (bfqq) -+ bfq_put_queue(bfqq); -+ bfqq = bfq_get_queue(bfqd, bio, is_sync, bic); -+ BUG_ON(!hlist_unhashed(&bfqq->burst_list_node)); -+ - bic_set_bfqq(bic, bfqq, is_sync); - if (split && is_sync) { -+ bfq_log_bfqq(bfqd, bfqq, -+ "set_request: was_in_list %d " -+ "was_in_large_burst %d " -+ "large burst in progress %d", -+ bic->was_in_burst_list, -+ bic->saved_in_large_burst, -+ bfqd->large_burst); -+ - if ((bic->was_in_burst_list && bfqd->large_burst) || -- bic->saved_in_large_burst) -+ bic->saved_in_large_burst) { -+ bfq_log_bfqq(bfqd, bfqq, -+ "set_request: marking in " -+ "large burst"); - bfq_mark_bfqq_in_large_burst(bfqq); -- else { -+ } else { -+ bfq_log_bfqq(bfqd, bfqq, -+ "set_request: clearing in " -+ "large burst"); - bfq_clear_bfqq_in_large_burst(bfqq); - if (bic->was_in_burst_list) - hlist_add_head(&bfqq->burst_list_node, - &bfqd->burst_list); - } -+ bfqq->split_time = jiffies; - } - } else { - /* If the queue was seeky for too long, break it apart. */ - if (bfq_bfqq_coop(bfqq) && bfq_bfqq_split_coop(bfqq)) { - bfq_log_bfqq(bfqd, bfqq, "breaking apart bfqq"); -+ -+ /* Update bic before losing reference to bfqq */ -+ if (bfq_bfqq_in_large_burst(bfqq)) -+ bic->saved_in_large_burst = true; -+ - bfqq = bfq_split_bfqq(bic, bfqq); - split = true; - if (!bfqq) -@@ -3771,9 +4586,8 @@ static int bfq_set_request(struct request_queue *q, struct request *rq, - } - - bfqq->allocated[rw]++; -- atomic_inc(&bfqq->ref); -- bfq_log_bfqq(bfqd, bfqq, "set_request: bfqq %p, %d", bfqq, -- atomic_read(&bfqq->ref)); -+ bfqq->ref++; -+ bfq_log_bfqq(bfqd, bfqq, "set_request: bfqq %p, %d", bfqq, bfqq->ref); - - rq->elv.priv[0] = bic; - rq->elv.priv[1] = bfqq; -@@ -3788,7 +4602,6 @@ static int bfq_set_request(struct request_queue *q, struct request *rq, - if (likely(bfqq != &bfqd->oom_bfqq) && bfqq_process_refs(bfqq) == 1) { - bfqq->bic = bic; - if (split) { -- bfq_mark_bfqq_just_split(bfqq); - /* - * If the queue has just been split from a shared - * queue, restore the idle window and the possible -@@ -3798,6 +4611,9 @@ static int bfq_set_request(struct request_queue *q, struct request *rq, - } - } - -+ if (unlikely(bfq_bfqq_just_created(bfqq))) -+ bfq_handle_burst(bfqd, bfqq); -+ - spin_unlock_irqrestore(q->queue_lock, flags); - - return 0; -@@ -3824,9 +4640,10 @@ static void bfq_kick_queue(struct work_struct *work) - * Handler of the expiration of the timer running if the in-service queue - * is idling inside its time slice. - */ --static void bfq_idle_slice_timer(unsigned long data) -+static enum hrtimer_restart bfq_idle_slice_timer(struct hrtimer *timer) - { -- struct bfq_data *bfqd = (struct bfq_data *)data; -+ struct bfq_data *bfqd = container_of(timer, struct bfq_data, -+ idle_slice_timer); - struct bfq_queue *bfqq; - unsigned long flags; - enum bfqq_expiration reason; -@@ -3844,6 +4661,8 @@ static void bfq_idle_slice_timer(unsigned long data) - */ - if (bfqq) { - bfq_log_bfqq(bfqd, bfqq, "slice_timer expired"); -+ bfq_clear_bfqq_wait_request(bfqq); -+ - if (bfq_bfqq_budget_timeout(bfqq)) - /* - * Also here the queue can be safely expired -@@ -3869,14 +4688,16 @@ static void bfq_idle_slice_timer(unsigned long data) - bfq_schedule_dispatch(bfqd); - - spin_unlock_irqrestore(bfqd->queue->queue_lock, flags); -+ return HRTIMER_NORESTART; - } - - static void bfq_shutdown_timer_wq(struct bfq_data *bfqd) - { -- del_timer_sync(&bfqd->idle_slice_timer); -+ hrtimer_cancel(&bfqd->idle_slice_timer); - cancel_work_sync(&bfqd->unplug_work); - } - -+#ifdef CONFIG_BFQ_GROUP_IOSCHED - static void __bfq_put_async_bfqq(struct bfq_data *bfqd, - struct bfq_queue **bfqq_ptr) - { -@@ -3885,9 +4706,9 @@ static void __bfq_put_async_bfqq(struct bfq_data *bfqd, - - bfq_log(bfqd, "put_async_bfqq: %p", bfqq); - if (bfqq) { -- bfq_bfqq_move(bfqd, bfqq, &bfqq->entity, root_group); -+ bfq_bfqq_move(bfqd, bfqq, root_group); - bfq_log_bfqq(bfqd, bfqq, "put_async_bfqq: putting %p, %d", -- bfqq, atomic_read(&bfqq->ref)); -+ bfqq, bfqq->ref); - bfq_put_queue(bfqq); - *bfqq_ptr = NULL; - } -@@ -3909,6 +4730,7 @@ static void bfq_put_async_queues(struct bfq_data *bfqd, struct bfq_group *bfqg) - - __bfq_put_async_bfqq(bfqd, &bfqg->async_idle_bfqq); - } -+#endif - - static void bfq_exit_queue(struct elevator_queue *e) - { -@@ -3922,15 +4744,13 @@ static void bfq_exit_queue(struct elevator_queue *e) - - BUG_ON(bfqd->in_service_queue); - list_for_each_entry_safe(bfqq, n, &bfqd->idle_list, bfqq_list) -- bfq_deactivate_bfqq(bfqd, bfqq, 0); -+ bfq_deactivate_bfqq(bfqd, bfqq, false, false); - - spin_unlock_irq(q->queue_lock); - - bfq_shutdown_timer_wq(bfqd); - -- synchronize_rcu(); -- -- BUG_ON(timer_pending(&bfqd->idle_slice_timer)); -+ BUG_ON(hrtimer_active(&bfqd->idle_slice_timer)); - - #ifdef CONFIG_BFQ_GROUP_IOSCHED - blkcg_deactivate_policy(q, &blkcg_policy_bfq); -@@ -3954,6 +4774,7 @@ static void bfq_init_root_group(struct bfq_group *root_group, - root_group->rq_pos_tree = RB_ROOT; - for (i = 0; i < BFQ_IOPRIO_CLASSES; i++) - root_group->sched_data.service_tree[i] = BFQ_SERVICE_TREE_INIT; -+ root_group->sched_data.bfq_class_idle_last_service = jiffies; - } - - static int bfq_init_queue(struct request_queue *q, struct elevator_type *e) -@@ -3978,11 +4799,14 @@ static int bfq_init_queue(struct request_queue *q, struct elevator_type *e) - * will not attempt to free it. - */ - bfq_init_bfqq(bfqd, &bfqd->oom_bfqq, NULL, 1, 0); -- atomic_inc(&bfqd->oom_bfqq.ref); -+ bfqd->oom_bfqq.ref++; - bfqd->oom_bfqq.new_ioprio = BFQ_DEFAULT_QUEUE_IOPRIO; - bfqd->oom_bfqq.new_ioprio_class = IOPRIO_CLASS_BE; - bfqd->oom_bfqq.entity.new_weight = - bfq_ioprio_to_weight(bfqd->oom_bfqq.new_ioprio); -+ -+ /* oom_bfqq does not participate to bursts */ -+ bfq_clear_bfqq_just_created(&bfqd->oom_bfqq); - /* - * Trigger weight initialization, according to ioprio, at the - * oom_bfqq's first activation. The oom_bfqq's ioprio and ioprio -@@ -4001,13 +4825,10 @@ static int bfq_init_queue(struct request_queue *q, struct elevator_type *e) - goto out_free; - bfq_init_root_group(bfqd->root_group, bfqd); - bfq_init_entity(&bfqd->oom_bfqq.entity, bfqd->root_group); --#ifdef CONFIG_BFQ_GROUP_IOSCHED -- bfqd->active_numerous_groups = 0; --#endif - -- init_timer(&bfqd->idle_slice_timer); -+ hrtimer_init(&bfqd->idle_slice_timer, CLOCK_MONOTONIC, -+ HRTIMER_MODE_REL); - bfqd->idle_slice_timer.function = bfq_idle_slice_timer; -- bfqd->idle_slice_timer.data = (unsigned long)bfqd; - - bfqd->queue_weights_tree = RB_ROOT; - bfqd->group_weights_tree = RB_ROOT; -@@ -4027,21 +4848,19 @@ static int bfq_init_queue(struct request_queue *q, struct elevator_type *e) - bfqd->bfq_back_max = bfq_back_max; - bfqd->bfq_back_penalty = bfq_back_penalty; - bfqd->bfq_slice_idle = bfq_slice_idle; -- bfqd->bfq_class_idle_last_service = 0; -- bfqd->bfq_max_budget_async_rq = bfq_max_budget_async_rq; -- bfqd->bfq_timeout[BLK_RW_ASYNC] = bfq_timeout_async; -- bfqd->bfq_timeout[BLK_RW_SYNC] = bfq_timeout_sync; -+ bfqd->bfq_timeout = bfq_timeout; - -- bfqd->bfq_coop_thresh = 2; -- bfqd->bfq_failed_cooperations = 7000; - bfqd->bfq_requests_within_timer = 120; - -- bfqd->bfq_large_burst_thresh = 11; -- bfqd->bfq_burst_interval = msecs_to_jiffies(500); -+ bfqd->bfq_large_burst_thresh = 8; -+ bfqd->bfq_burst_interval = msecs_to_jiffies(180); - - bfqd->low_latency = true; - -- bfqd->bfq_wr_coeff = 20; -+ /* -+ * Trade-off between responsiveness and fairness. -+ */ -+ bfqd->bfq_wr_coeff = 30; - bfqd->bfq_wr_rt_max_time = msecs_to_jiffies(300); - bfqd->bfq_wr_max_time = 0; - bfqd->bfq_wr_min_idle_time = msecs_to_jiffies(2000); -@@ -4053,16 +4872,15 @@ static int bfq_init_queue(struct request_queue *q, struct elevator_type *e) - * video. - */ - bfqd->wr_busy_queues = 0; -- bfqd->busy_in_flight_queues = 0; -- bfqd->const_seeky_busy_in_flight_queues = 0; - - /* -- * Begin by assuming, optimistically, that the device peak rate is -- * equal to the highest reference rate. -+ * Begin by assuming, optimistically, that the device is a -+ * high-speed one, and that its peak rate is equal to 2/3 of -+ * the highest reference rate. - */ - bfqd->RT_prod = R_fast[blk_queue_nonrot(bfqd->queue)] * - T_fast[blk_queue_nonrot(bfqd->queue)]; -- bfqd->peak_rate = R_fast[blk_queue_nonrot(bfqd->queue)]; -+ bfqd->peak_rate = R_fast[blk_queue_nonrot(bfqd->queue)] * 2 / 3; - bfqd->device_speed = BFQ_BFQD_FAST; - - return 0; -@@ -4088,7 +4906,7 @@ static int __init bfq_slab_setup(void) - - static ssize_t bfq_var_show(unsigned int var, char *page) - { -- return sprintf(page, "%d\n", var); -+ return sprintf(page, "%u\n", var); - } - - static ssize_t bfq_var_store(unsigned long *var, const char *page, -@@ -4159,21 +4977,21 @@ static ssize_t bfq_weights_show(struct elevator_queue *e, char *page) - static ssize_t __FUNC(struct elevator_queue *e, char *page) \ - { \ - struct bfq_data *bfqd = e->elevator_data; \ -- unsigned int __data = __VAR; \ -- if (__CONV) \ -+ u64 __data = __VAR; \ -+ if (__CONV == 1) \ - __data = jiffies_to_msecs(__data); \ -+ else if (__CONV == 2) \ -+ __data = div_u64(__data, NSEC_PER_MSEC); \ - return bfq_var_show(__data, (page)); \ - } --SHOW_FUNCTION(bfq_fifo_expire_sync_show, bfqd->bfq_fifo_expire[1], 1); --SHOW_FUNCTION(bfq_fifo_expire_async_show, bfqd->bfq_fifo_expire[0], 1); -+SHOW_FUNCTION(bfq_fifo_expire_sync_show, bfqd->bfq_fifo_expire[1], 2); -+SHOW_FUNCTION(bfq_fifo_expire_async_show, bfqd->bfq_fifo_expire[0], 2); - SHOW_FUNCTION(bfq_back_seek_max_show, bfqd->bfq_back_max, 0); - SHOW_FUNCTION(bfq_back_seek_penalty_show, bfqd->bfq_back_penalty, 0); --SHOW_FUNCTION(bfq_slice_idle_show, bfqd->bfq_slice_idle, 1); -+SHOW_FUNCTION(bfq_slice_idle_show, bfqd->bfq_slice_idle, 2); - SHOW_FUNCTION(bfq_max_budget_show, bfqd->bfq_user_max_budget, 0); --SHOW_FUNCTION(bfq_max_budget_async_rq_show, -- bfqd->bfq_max_budget_async_rq, 0); --SHOW_FUNCTION(bfq_timeout_sync_show, bfqd->bfq_timeout[BLK_RW_SYNC], 1); --SHOW_FUNCTION(bfq_timeout_async_show, bfqd->bfq_timeout[BLK_RW_ASYNC], 1); -+SHOW_FUNCTION(bfq_timeout_sync_show, bfqd->bfq_timeout, 1); -+SHOW_FUNCTION(bfq_strict_guarantees_show, bfqd->strict_guarantees, 0); - SHOW_FUNCTION(bfq_low_latency_show, bfqd->low_latency, 0); - SHOW_FUNCTION(bfq_wr_coeff_show, bfqd->bfq_wr_coeff, 0); - SHOW_FUNCTION(bfq_wr_rt_max_time_show, bfqd->bfq_wr_rt_max_time, 1); -@@ -4183,6 +5001,17 @@ SHOW_FUNCTION(bfq_wr_min_inter_arr_async_show, bfqd->bfq_wr_min_inter_arr_async, - SHOW_FUNCTION(bfq_wr_max_softrt_rate_show, bfqd->bfq_wr_max_softrt_rate, 0); - #undef SHOW_FUNCTION - -+#define USEC_SHOW_FUNCTION(__FUNC, __VAR) \ -+static ssize_t __FUNC(struct elevator_queue *e, char *page) \ -+{ \ -+ struct bfq_data *bfqd = e->elevator_data; \ -+ u64 __data = __VAR; \ -+ __data = div_u64(__data, NSEC_PER_USEC); \ -+ return bfq_var_show(__data, (page)); \ -+} -+USEC_SHOW_FUNCTION(bfq_slice_idle_us_show, bfqd->bfq_slice_idle); -+#undef USEC_SHOW_FUNCTION -+ - #define STORE_FUNCTION(__FUNC, __PTR, MIN, MAX, __CONV) \ - static ssize_t \ - __FUNC(struct elevator_queue *e, const char *page, size_t count) \ -@@ -4194,24 +5023,22 @@ __FUNC(struct elevator_queue *e, const char *page, size_t count) \ - __data = (MIN); \ - else if (__data > (MAX)) \ - __data = (MAX); \ -- if (__CONV) \ -+ if (__CONV == 1) \ - *(__PTR) = msecs_to_jiffies(__data); \ -+ else if (__CONV == 2) \ -+ *(__PTR) = (u64)__data * NSEC_PER_MSEC; \ - else \ - *(__PTR) = __data; \ - return ret; \ - } - STORE_FUNCTION(bfq_fifo_expire_sync_store, &bfqd->bfq_fifo_expire[1], 1, -- INT_MAX, 1); -+ INT_MAX, 2); - STORE_FUNCTION(bfq_fifo_expire_async_store, &bfqd->bfq_fifo_expire[0], 1, -- INT_MAX, 1); -+ INT_MAX, 2); - STORE_FUNCTION(bfq_back_seek_max_store, &bfqd->bfq_back_max, 0, INT_MAX, 0); - STORE_FUNCTION(bfq_back_seek_penalty_store, &bfqd->bfq_back_penalty, 1, - INT_MAX, 0); --STORE_FUNCTION(bfq_slice_idle_store, &bfqd->bfq_slice_idle, 0, INT_MAX, 1); --STORE_FUNCTION(bfq_max_budget_async_rq_store, &bfqd->bfq_max_budget_async_rq, -- 1, INT_MAX, 0); --STORE_FUNCTION(bfq_timeout_async_store, &bfqd->bfq_timeout[BLK_RW_ASYNC], 0, -- INT_MAX, 1); -+STORE_FUNCTION(bfq_slice_idle_store, &bfqd->bfq_slice_idle, 0, INT_MAX, 2); - STORE_FUNCTION(bfq_wr_coeff_store, &bfqd->bfq_wr_coeff, 1, INT_MAX, 0); - STORE_FUNCTION(bfq_wr_max_time_store, &bfqd->bfq_wr_max_time, 0, INT_MAX, 1); - STORE_FUNCTION(bfq_wr_rt_max_time_store, &bfqd->bfq_wr_rt_max_time, 0, INT_MAX, -@@ -4224,6 +5051,23 @@ STORE_FUNCTION(bfq_wr_max_softrt_rate_store, &bfqd->bfq_wr_max_softrt_rate, 0, - INT_MAX, 0); - #undef STORE_FUNCTION - -+#define USEC_STORE_FUNCTION(__FUNC, __PTR, MIN, MAX) \ -+static ssize_t __FUNC(struct elevator_queue *e, const char *page, size_t count)\ -+{ \ -+ struct bfq_data *bfqd = e->elevator_data; \ -+ unsigned long uninitialized_var(__data); \ -+ int ret = bfq_var_store(&__data, (page), count); \ -+ if (__data < (MIN)) \ -+ __data = (MIN); \ -+ else if (__data > (MAX)) \ -+ __data = (MAX); \ -+ *(__PTR) = (u64)__data * NSEC_PER_USEC; \ -+ return ret; \ -+} -+USEC_STORE_FUNCTION(bfq_slice_idle_us_store, &bfqd->bfq_slice_idle, 0, -+ UINT_MAX); -+#undef USEC_STORE_FUNCTION -+ - /* do nothing for the moment */ - static ssize_t bfq_weights_store(struct elevator_queue *e, - const char *page, size_t count) -@@ -4231,16 +5075,6 @@ static ssize_t bfq_weights_store(struct elevator_queue *e, - return count; - } - --static unsigned long bfq_estimated_max_budget(struct bfq_data *bfqd) --{ -- u64 timeout = jiffies_to_msecs(bfqd->bfq_timeout[BLK_RW_SYNC]); -- -- if (bfqd->peak_rate_samples >= BFQ_PEAK_RATE_SAMPLES) -- return bfq_calc_max_budget(bfqd->peak_rate, timeout); -- else -- return bfq_default_max_budget; --} -- - static ssize_t bfq_max_budget_store(struct elevator_queue *e, - const char *page, size_t count) - { -@@ -4249,7 +5083,7 @@ static ssize_t bfq_max_budget_store(struct elevator_queue *e, - int ret = bfq_var_store(&__data, (page), count); - - if (__data == 0) -- bfqd->bfq_max_budget = bfq_estimated_max_budget(bfqd); -+ bfqd->bfq_max_budget = bfq_calc_max_budget(bfqd); - else { - if (__data > INT_MAX) - __data = INT_MAX; -@@ -4261,6 +5095,10 @@ static ssize_t bfq_max_budget_store(struct elevator_queue *e, - return ret; - } - -+/* -+ * Leaving this name to preserve name compatibility with cfq -+ * parameters, but this timeout is used for both sync and async. -+ */ - static ssize_t bfq_timeout_sync_store(struct elevator_queue *e, - const char *page, size_t count) - { -@@ -4273,9 +5111,27 @@ static ssize_t bfq_timeout_sync_store(struct elevator_queue *e, - else if (__data > INT_MAX) - __data = INT_MAX; - -- bfqd->bfq_timeout[BLK_RW_SYNC] = msecs_to_jiffies(__data); -+ bfqd->bfq_timeout = msecs_to_jiffies(__data); - if (bfqd->bfq_user_max_budget == 0) -- bfqd->bfq_max_budget = bfq_estimated_max_budget(bfqd); -+ bfqd->bfq_max_budget = bfq_calc_max_budget(bfqd); -+ -+ return ret; -+} -+ -+static ssize_t bfq_strict_guarantees_store(struct elevator_queue *e, -+ const char *page, size_t count) -+{ -+ struct bfq_data *bfqd = e->elevator_data; -+ unsigned long uninitialized_var(__data); -+ int ret = bfq_var_store(&__data, (page), count); -+ -+ if (__data > 1) -+ __data = 1; -+ if (!bfqd->strict_guarantees && __data == 1 -+ && bfqd->bfq_slice_idle < 8 * NSEC_PER_MSEC) -+ bfqd->bfq_slice_idle = 8 * NSEC_PER_MSEC; -+ -+ bfqd->strict_guarantees = __data; - - return ret; - } -@@ -4305,10 +5161,10 @@ static struct elv_fs_entry bfq_attrs[] = { - BFQ_ATTR(back_seek_max), - BFQ_ATTR(back_seek_penalty), - BFQ_ATTR(slice_idle), -+ BFQ_ATTR(slice_idle_us), - BFQ_ATTR(max_budget), -- BFQ_ATTR(max_budget_async_rq), - BFQ_ATTR(timeout_sync), -- BFQ_ATTR(timeout_async), -+ BFQ_ATTR(strict_guarantees), - BFQ_ATTR(low_latency), - BFQ_ATTR(wr_coeff), - BFQ_ATTR(wr_max_time), -@@ -4328,7 +5184,8 @@ static struct elevator_type iosched_bfq = { - #ifdef CONFIG_BFQ_GROUP_IOSCHED - .elevator_bio_merged_fn = bfq_bio_merged, - #endif -- .elevator_allow_merge_fn = bfq_allow_merge, -+ .elevator_allow_bio_merge_fn = bfq_allow_bio_merge, -+ .elevator_allow_rq_merge_fn = bfq_allow_rq_merge, - .elevator_dispatch_fn = bfq_dispatch_requests, - .elevator_add_req_fn = bfq_insert_request, - .elevator_activate_req_fn = bfq_activate_request, -@@ -4351,18 +5208,28 @@ static struct elevator_type iosched_bfq = { - .elevator_owner = THIS_MODULE, - }; - -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+static struct blkcg_policy blkcg_policy_bfq = { -+ .dfl_cftypes = bfq_blkg_files, -+ .legacy_cftypes = bfq_blkcg_legacy_files, -+ -+ .cpd_alloc_fn = bfq_cpd_alloc, -+ .cpd_init_fn = bfq_cpd_init, -+ .cpd_bind_fn = bfq_cpd_init, -+ .cpd_free_fn = bfq_cpd_free, -+ -+ .pd_alloc_fn = bfq_pd_alloc, -+ .pd_init_fn = bfq_pd_init, -+ .pd_offline_fn = bfq_pd_offline, -+ .pd_free_fn = bfq_pd_free, -+ .pd_reset_stats_fn = bfq_pd_reset_stats, -+}; -+#endif -+ - static int __init bfq_init(void) - { - int ret; -- -- /* -- * Can be 0 on HZ < 1000 setups. -- */ -- if (bfq_slice_idle == 0) -- bfq_slice_idle = 1; -- -- if (bfq_timeout_async == 0) -- bfq_timeout_async = 1; -+ char msg[60] = "BFQ I/O-scheduler: v8r7"; - - #ifdef CONFIG_BFQ_GROUP_IOSCHED - ret = blkcg_policy_register(&blkcg_policy_bfq); -@@ -4375,27 +5242,46 @@ static int __init bfq_init(void) - goto err_pol_unreg; - - /* -- * Times to load large popular applications for the typical systems -- * installed on the reference devices (see the comments before the -- * definitions of the two arrays). -+ * Times to load large popular applications for the typical -+ * systems installed on the reference devices (see the -+ * comments before the definitions of the next two -+ * arrays). Actually, we use slightly slower values, as the -+ * estimated peak rate tends to be smaller than the actual -+ * peak rate. The reason for this last fact is that estimates -+ * are computed over much shorter time intervals than the long -+ * intervals typically used for benchmarking. Why? First, to -+ * adapt more quickly to variations. Second, because an I/O -+ * scheduler cannot rely on a peak-rate-evaluation workload to -+ * be run for a long time. - */ -- T_slow[0] = msecs_to_jiffies(2600); -- T_slow[1] = msecs_to_jiffies(1000); -- T_fast[0] = msecs_to_jiffies(5500); -- T_fast[1] = msecs_to_jiffies(2000); -+ T_slow[0] = msecs_to_jiffies(3500); /* actually 4 sec */ -+ T_slow[1] = msecs_to_jiffies(1000); /* actually 1.5 sec */ -+ T_fast[0] = msecs_to_jiffies(7000); /* actually 8 sec */ -+ T_fast[1] = msecs_to_jiffies(2500); /* actually 3 sec */ - - /* -- * Thresholds that determine the switch between speed classes (see -- * the comments before the definition of the array). -+ * Thresholds that determine the switch between speed classes -+ * (see the comments before the definition of the array -+ * device_speed_thresh). These thresholds are biased towards -+ * transitions to the fast class. This is safer than the -+ * opposite bias. In fact, a wrong transition to the slow -+ * class results in short weight-raising periods, because the -+ * speed of the device then tends to be higher that the -+ * reference peak rate. On the opposite end, a wrong -+ * transition to the fast class tends to increase -+ * weight-raising periods, because of the opposite reason. - */ -- device_speed_thresh[0] = (R_fast[0] + R_slow[0]) / 2; -- device_speed_thresh[1] = (R_fast[1] + R_slow[1]) / 2; -+ device_speed_thresh[0] = (4 * R_slow[0]) / 3; -+ device_speed_thresh[1] = (4 * R_slow[1]) / 3; - - ret = elv_register(&iosched_bfq); - if (ret) - goto err_pol_unreg; - -- pr_info("BFQ I/O-scheduler: v7r11"); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ strcat(msg, " (with cgroups support)"); -+#endif -+ pr_info("%s", msg); - - return 0; - -diff --git a/block/bfq-sched.c b/block/bfq-sched.c -index a5ed694..797bce7 100644 ---- a/block/bfq-sched.c -+++ b/block/bfq-sched.c -@@ -7,28 +7,166 @@ - * Copyright (C) 2008 Fabio Checconi - * Paolo Valente - * -- * Copyright (C) 2010 Paolo Valente -+ * Copyright (C) 2015 Paolo Valente -+ * -+ * Copyright (C) 2016 Paolo Valente -+ */ -+ -+static struct bfq_group *bfqq_group(struct bfq_queue *bfqq); -+ -+/** -+ * bfq_gt - compare two timestamps. -+ * @a: first ts. -+ * @b: second ts. -+ * -+ * Return @a > @b, dealing with wrapping correctly. -+ */ -+static int bfq_gt(u64 a, u64 b) -+{ -+ return (s64)(a - b) > 0; -+} -+ -+static struct bfq_entity *bfq_root_active_entity(struct rb_root *tree) -+{ -+ struct rb_node *node = tree->rb_node; -+ -+ return rb_entry(node, struct bfq_entity, rb_node); -+} -+ -+static struct bfq_entity *bfq_lookup_next_entity(struct bfq_sched_data *sd); -+ -+static bool bfq_update_parent_budget(struct bfq_entity *next_in_service); -+ -+/** -+ * bfq_update_next_in_service - update sd->next_in_service -+ * @sd: sched_data for which to perform the update. -+ * @new_entity: if not NULL, pointer to the entity whose activation, -+ * requeueing or repositionig triggered the invocation of -+ * this function. -+ * -+ * This function is called to update sd->next_in_service, which, in -+ * its turn, may change as a consequence of the insertion or -+ * extraction of an entity into/from one of the active trees of -+ * sd. These insertions/extractions occur as a consequence of -+ * activations/deactivations of entities, with some activations being -+ * 'true' activations, and other activations being requeueings (i.e., -+ * implementing the second, requeueing phase of the mechanism used to -+ * reposition an entity in its active tree; see comments on -+ * __bfq_activate_entity and __bfq_requeue_entity for details). In -+ * both the last two activation sub-cases, new_entity points to the -+ * just activated or requeued entity. -+ * -+ * Returns true if sd->next_in_service changes in such a way that -+ * entity->parent may become the next_in_service for its parent -+ * entity. - */ -+static bool bfq_update_next_in_service(struct bfq_sched_data *sd, -+ struct bfq_entity *new_entity) -+{ -+ struct bfq_entity *next_in_service = sd->next_in_service; -+ struct bfq_queue *bfqq; -+ bool parent_sched_may_change = false; -+ -+ /* -+ * If this update is triggered by the activation, requeueing -+ * or repositiong of an entity that does not coincide with -+ * sd->next_in_service, then a full lookup in the active tree -+ * can be avoided. In fact, it is enough to check whether the -+ * just-modified entity has a higher priority than -+ * sd->next_in_service, or, even if it has the same priority -+ * as sd->next_in_service, is eligible and has a lower virtual -+ * finish time than sd->next_in_service. If this compound -+ * condition holds, then the new entity becomes the new -+ * next_in_service. Otherwise no change is needed. -+ */ -+ if (new_entity && new_entity != sd->next_in_service) { -+ /* -+ * Flag used to decide whether to replace -+ * sd->next_in_service with new_entity. Tentatively -+ * set to true, and left as true if -+ * sd->next_in_service is NULL. -+ */ -+ bool replace_next = true; -+ -+ /* -+ * If there is already a next_in_service candidate -+ * entity, then compare class priorities or timestamps -+ * to decide whether to replace sd->service_tree with -+ * new_entity. -+ */ -+ if (next_in_service) { -+ unsigned int new_entity_class_idx = -+ bfq_class_idx(new_entity); -+ struct bfq_service_tree *st = -+ sd->service_tree + new_entity_class_idx; -+ -+ /* -+ * For efficiency, evaluate the most likely -+ * sub-condition first. -+ */ -+ replace_next = -+ (new_entity_class_idx == -+ bfq_class_idx(next_in_service) -+ && -+ !bfq_gt(new_entity->start, st->vtime) -+ && -+ bfq_gt(next_in_service->finish, -+ new_entity->finish)) -+ || -+ new_entity_class_idx < -+ bfq_class_idx(next_in_service); -+ } -+ -+ if (replace_next) -+ next_in_service = new_entity; -+ } else /* invoked because of a deactivation: lookup needed */ -+ next_in_service = bfq_lookup_next_entity(sd); -+ -+ if (next_in_service) { -+ parent_sched_may_change = !sd->next_in_service || -+ bfq_update_parent_budget(next_in_service); -+ } -+ -+ sd->next_in_service = next_in_service; -+ -+ if (!next_in_service) -+ return parent_sched_may_change; - -+ bfqq = bfq_entity_to_bfqq(next_in_service); -+ if (bfqq) -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "update_next_in_service: chosen this queue"); - #ifdef CONFIG_BFQ_GROUP_IOSCHED --#define for_each_entity(entity) \ -+ else { -+ struct bfq_group *bfqg = -+ container_of(next_in_service, -+ struct bfq_group, entity); -+ -+ bfq_log_bfqg((struct bfq_data *)bfqg->bfqd, bfqg, -+ "update_next_in_service: chosen this entity"); -+ } -+#endif -+ return parent_sched_may_change; -+} -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+/* both next loops stop at one of the child entities of the root group */ -+#define for_each_entity(entity) \ - for (; entity ; entity = entity->parent) - - #define for_each_entity_safe(entity, parent) \ - for (; entity && ({ parent = entity->parent; 1; }); entity = parent) - -- --static struct bfq_entity *bfq_lookup_next_entity(struct bfq_sched_data *sd, -- int extract, -- struct bfq_data *bfqd); -- --static struct bfq_group *bfqq_group(struct bfq_queue *bfqq); -- --static void bfq_update_budget(struct bfq_entity *next_in_service) -+/* -+ * Returns true if this budget changes may let next_in_service->parent -+ * become the next_in_service entity for its parent entity. -+ */ -+static bool bfq_update_parent_budget(struct bfq_entity *next_in_service) - { - struct bfq_entity *bfqg_entity; - struct bfq_group *bfqg; - struct bfq_sched_data *group_sd; -+ bool ret = false; - - BUG_ON(!next_in_service); - -@@ -41,60 +179,68 @@ static void bfq_update_budget(struct bfq_entity *next_in_service) - * as it must never become an in-service entity. - */ - bfqg_entity = bfqg->my_entity; -- if (bfqg_entity) -+ if (bfqg_entity) { -+ if (bfqg_entity->budget > next_in_service->budget) -+ ret = true; - bfqg_entity->budget = next_in_service->budget; -+ } -+ -+ return ret; - } - --static int bfq_update_next_in_service(struct bfq_sched_data *sd) -+/* -+ * This function tells whether entity stops being a candidate for next -+ * service, according to the following logic. -+ * -+ * This function is invoked for an entity that is about to be set in -+ * service. If such an entity is a queue, then the entity is no longer -+ * a candidate for next service (i.e, a candidate entity to serve -+ * after the in-service entity is expired). The function then returns -+ * true. -+ * -+ * In contrast, the entity could stil be a candidate for next service -+ * if it is not a queue, and has more than one child. In fact, even if -+ * one of its children is about to be set in service, other children -+ * may still be the next to serve. As a consequence, a non-queue -+ * entity is not a candidate for next-service only if it has only one -+ * child. And only if this condition holds, then the function returns -+ * true for a non-queue entity. -+ */ -+static bool bfq_no_longer_next_in_service(struct bfq_entity *entity) - { -- struct bfq_entity *next_in_service; -+ struct bfq_group *bfqg; - -- if (sd->in_service_entity) -- /* will update/requeue at the end of service */ -- return 0; -+ if (bfq_entity_to_bfqq(entity)) -+ return true; - -- /* -- * NOTE: this can be improved in many ways, such as returning -- * 1 (and thus propagating upwards the update) only when the -- * budget changes, or caching the bfqq that will be scheduled -- * next from this subtree. By now we worry more about -- * correctness than about performance... -- */ -- next_in_service = bfq_lookup_next_entity(sd, 0, NULL); -- sd->next_in_service = next_in_service; -+ bfqg = container_of(entity, struct bfq_group, entity); - -- if (next_in_service) -- bfq_update_budget(next_in_service); -+ BUG_ON(bfqg == ((struct bfq_data *)(bfqg->bfqd))->root_group); -+ BUG_ON(bfqg->active_entities == 0); -+ if (bfqg->active_entities == 1) -+ return true; - -- return 1; -+ return false; - } - --static void bfq_check_next_in_service(struct bfq_sched_data *sd, -- struct bfq_entity *entity) --{ -- BUG_ON(sd->next_in_service != entity); --} --#else -+#else /* CONFIG_BFQ_GROUP_IOSCHED */ - #define for_each_entity(entity) \ - for (; entity ; entity = NULL) - - #define for_each_entity_safe(entity, parent) \ - for (parent = NULL; entity ; entity = parent) - --static int bfq_update_next_in_service(struct bfq_sched_data *sd) -+static bool bfq_update_parent_budget(struct bfq_entity *next_in_service) - { -- return 0; -+ return false; - } - --static void bfq_check_next_in_service(struct bfq_sched_data *sd, -- struct bfq_entity *entity) -+static bool bfq_no_longer_next_in_service(struct bfq_entity *entity) - { -+ return true; - } - --static void bfq_update_budget(struct bfq_entity *next_in_service) --{ --} --#endif -+#endif /* CONFIG_BFQ_GROUP_IOSCHED */ - - /* - * Shift for timestamp calculations. This actually limits the maximum -@@ -105,18 +251,6 @@ static void bfq_update_budget(struct bfq_entity *next_in_service) - */ - #define WFQ_SERVICE_SHIFT 22 - --/** -- * bfq_gt - compare two timestamps. -- * @a: first ts. -- * @b: second ts. -- * -- * Return @a > @b, dealing with wrapping correctly. -- */ --static int bfq_gt(u64 a, u64 b) --{ -- return (s64)(a - b) > 0; --} -- - static struct bfq_queue *bfq_entity_to_bfqq(struct bfq_entity *entity) - { - struct bfq_queue *bfqq = NULL; -@@ -151,20 +285,36 @@ static u64 bfq_delta(unsigned long service, unsigned long weight) - static void bfq_calc_finish(struct bfq_entity *entity, unsigned long service) - { - struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ unsigned long long start, finish, delta; - - BUG_ON(entity->weight == 0); - - entity->finish = entity->start + - bfq_delta(service, entity->weight); - -+ start = ((entity->start>>10)*1000)>>12; -+ finish = ((entity->finish>>10)*1000)>>12; -+ delta = ((bfq_delta(service, entity->weight)>>10)*1000)>>12; -+ - if (bfqq) { - bfq_log_bfqq(bfqq->bfqd, bfqq, - "calc_finish: serv %lu, w %d", - service, entity->weight); - bfq_log_bfqq(bfqq->bfqd, bfqq, - "calc_finish: start %llu, finish %llu, delta %llu", -- entity->start, entity->finish, -- bfq_delta(service, entity->weight)); -+ start, finish, delta); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ } else { -+ struct bfq_group *bfqg = -+ container_of(entity, struct bfq_group, entity); -+ -+ bfq_log_bfqg((struct bfq_data *)bfqg->bfqd, bfqg, -+ "calc_finish group: serv %lu, w %d", -+ service, entity->weight); -+ bfq_log_bfqg((struct bfq_data *)bfqg->bfqd, bfqg, -+ "calc_finish group: start %llu, finish %llu, delta %llu", -+ start, finish, delta); -+#endif - } - } - -@@ -293,10 +443,26 @@ static void bfq_update_min(struct bfq_entity *entity, struct rb_node *node) - static void bfq_update_active_node(struct rb_node *node) - { - struct bfq_entity *entity = rb_entry(node, struct bfq_entity, rb_node); -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); - - entity->min_start = entity->start; - bfq_update_min(entity, node->rb_right); - bfq_update_min(entity, node->rb_left); -+ -+ if (bfqq) { -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "update_active_node: new min_start %llu", -+ ((entity->min_start>>10)*1000)>>12); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ } else { -+ struct bfq_group *bfqg = -+ container_of(entity, struct bfq_group, entity); -+ -+ bfq_log_bfqg((struct bfq_data *)bfqg->bfqd, bfqg, -+ "update_active_node: new min_start %llu", -+ ((entity->min_start>>10)*1000)>>12); -+#endif -+ } - } - - /** -@@ -386,8 +552,6 @@ static void bfq_active_insert(struct bfq_service_tree *st, - BUG_ON(!bfqg); - BUG_ON(!bfqd); - bfqg->active_entities++; -- if (bfqg->active_entities == 2) -- bfqd->active_numerous_groups++; - } - #endif - } -@@ -399,7 +563,7 @@ static void bfq_active_insert(struct bfq_service_tree *st, - static unsigned short bfq_ioprio_to_weight(int ioprio) - { - BUG_ON(ioprio < 0 || ioprio >= IOPRIO_BE_NR); -- return IOPRIO_BE_NR * BFQ_WEIGHT_CONVERSION_COEFF - ioprio; -+ return (IOPRIO_BE_NR - ioprio) * BFQ_WEIGHT_CONVERSION_COEFF; - } - - /** -@@ -422,9 +586,9 @@ static void bfq_get_entity(struct bfq_entity *entity) - struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); - - if (bfqq) { -- atomic_inc(&bfqq->ref); -+ bfqq->ref++; - bfq_log_bfqq(bfqq->bfqd, bfqq, "get_entity: %p %d", -- bfqq, atomic_read(&bfqq->ref)); -+ bfqq, bfqq->ref); - } - } - -@@ -499,10 +663,6 @@ static void bfq_active_extract(struct bfq_service_tree *st, - BUG_ON(!bfqd); - BUG_ON(!bfqg->active_entities); - bfqg->active_entities--; -- if (bfqg->active_entities == 1) { -- BUG_ON(!bfqd->active_numerous_groups); -- bfqd->active_numerous_groups--; -- } - } - #endif - } -@@ -547,12 +707,12 @@ static void bfq_forget_entity(struct bfq_service_tree *st, - - BUG_ON(!entity->on_st); - -- entity->on_st = 0; -+ entity->on_st = false; - st->wsum -= entity->weight; - if (bfqq) { - sd = entity->sched_data; - bfq_log_bfqq(bfqq->bfqd, bfqq, "forget_entity: %p %d", -- bfqq, atomic_read(&bfqq->ref)); -+ bfqq, bfqq->ref); - bfq_put_queue(bfqq); - } - } -@@ -602,7 +762,7 @@ __bfq_entity_update_weight_prio(struct bfq_service_tree *old_st, - - if (entity->prio_changed) { - struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -- unsigned short prev_weight, new_weight; -+ unsigned int prev_weight, new_weight; - struct bfq_data *bfqd = NULL; - struct rb_root *root; - #ifdef CONFIG_BFQ_GROUP_IOSCHED -@@ -630,7 +790,10 @@ __bfq_entity_update_weight_prio(struct bfq_service_tree *old_st, - entity->new_weight > BFQ_MAX_WEIGHT) { - pr_crit("update_weight_prio: new_weight %d\n", - entity->new_weight); -- BUG(); -+ if (entity->new_weight < BFQ_MIN_WEIGHT) -+ entity->new_weight = BFQ_MIN_WEIGHT; -+ else -+ entity->new_weight = BFQ_MAX_WEIGHT; - } - entity->orig_weight = entity->new_weight; - if (bfqq) -@@ -661,6 +824,13 @@ __bfq_entity_update_weight_prio(struct bfq_service_tree *old_st, - * associated with its new weight. - */ - if (prev_weight != new_weight) { -+ if (bfqq) -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "weight changed %d %d(%d %d)", -+ prev_weight, new_weight, -+ entity->orig_weight, -+ bfqq->wr_coeff); -+ - root = bfqq ? &bfqd->queue_weights_tree : - &bfqd->group_weights_tree; - bfq_weights_tree_remove(bfqd, entity, root); -@@ -707,7 +877,7 @@ static void bfq_bfqq_served(struct bfq_queue *bfqq, int served) - st = bfq_entity_service_tree(entity); - - entity->service += served; -- BUG_ON(entity->service > entity->budget); -+ - BUG_ON(st->wsum == 0); - - st->vtime += bfq_delta(served, st->wsum); -@@ -716,170 +886,419 @@ static void bfq_bfqq_served(struct bfq_queue *bfqq, int served) - #ifdef CONFIG_BFQ_GROUP_IOSCHED - bfqg_stats_set_start_empty_time(bfqq_group(bfqq)); - #endif -- bfq_log_bfqq(bfqq->bfqd, bfqq, "bfqq_served %d secs", served); -+ st = bfq_entity_service_tree(&bfqq->entity); -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "bfqq_served %d secs, vtime %llu on %p", -+ served, ((st->vtime>>10)*1000)>>12, st); - } - - /** -- * bfq_bfqq_charge_full_budget - set the service to the entity budget. -+ * bfq_bfqq_charge_time - charge an amount of service equivalent to the length -+ * of the time interval during which bfqq has been in -+ * service. -+ * @bfqd: the device - * @bfqq: the queue that needs a service update. -+ * @time_ms: the amount of time during which the queue has received service -+ * -+ * If a queue does not consume its budget fast enough, then providing -+ * the queue with service fairness may impair throughput, more or less -+ * severely. For this reason, queues that consume their budget slowly -+ * are provided with time fairness instead of service fairness. This -+ * goal is achieved through the BFQ scheduling engine, even if such an -+ * engine works in the service, and not in the time domain. The trick -+ * is charging these queues with an inflated amount of service, equal -+ * to the amount of service that they would have received during their -+ * service slot if they had been fast, i.e., if their requests had -+ * been dispatched at a rate equal to the estimated peak rate. - * -- * When it's not possible to be fair in the service domain, because -- * a queue is not consuming its budget fast enough (the meaning of -- * fast depends on the timeout parameter), we charge it a full -- * budget. In this way we should obtain a sort of time-domain -- * fairness among all the seeky/slow queues. -+ * It is worth noting that time fairness can cause important -+ * distortions in terms of bandwidth distribution, on devices with -+ * internal queueing. The reason is that I/O requests dispatched -+ * during the service slot of a queue may be served after that service -+ * slot is finished, and may have a total processing time loosely -+ * correlated with the duration of the service slot. This is -+ * especially true for short service slots. - */ --static void bfq_bfqq_charge_full_budget(struct bfq_queue *bfqq) -+static void bfq_bfqq_charge_time(struct bfq_data *bfqd, struct bfq_queue *bfqq, -+ unsigned long time_ms) - { - struct bfq_entity *entity = &bfqq->entity; -+ int tot_serv_to_charge = entity->service; -+ unsigned int timeout_ms = jiffies_to_msecs(bfq_timeout); -+ -+ if (time_ms > 0 && time_ms < timeout_ms) -+ tot_serv_to_charge = -+ (bfqd->bfq_max_budget * time_ms) / timeout_ms; - -- bfq_log_bfqq(bfqq->bfqd, bfqq, "charge_full_budget"); -+ if (tot_serv_to_charge < entity->service) -+ tot_serv_to_charge = entity->service; - -- bfq_bfqq_served(bfqq, entity->budget - entity->service); -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "charge_time: %lu/%u ms, %d/%d/%d sectors", -+ time_ms, timeout_ms, entity->service, -+ tot_serv_to_charge, entity->budget); -+ -+ /* Increase budget to avoid inconsistencies */ -+ if (tot_serv_to_charge > entity->budget) -+ entity->budget = tot_serv_to_charge; -+ -+ bfq_bfqq_served(bfqq, -+ max_t(int, 0, tot_serv_to_charge - entity->service)); -+} -+ -+static void bfq_update_fin_time_enqueue(struct bfq_entity *entity, -+ struct bfq_service_tree *st, -+ bool backshifted) -+{ -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ struct bfq_sched_data *sd = entity->sched_data; -+ -+ st = __bfq_entity_update_weight_prio(st, entity); -+ bfq_calc_finish(entity, entity->budget); -+ -+ /* -+ * If some queues enjoy backshifting for a while, then their -+ * (virtual) finish timestamps may happen to become lower and -+ * lower than the system virtual time. In particular, if -+ * these queues often happen to be idle for short time -+ * periods, and during such time periods other queues with -+ * higher timestamps happen to be busy, then the backshifted -+ * timestamps of the former queues can become much lower than -+ * the system virtual time. In fact, to serve the queues with -+ * higher timestamps while the ones with lower timestamps are -+ * idle, the system virtual time may be pushed-up to much -+ * higher values than the finish timestamps of the idle -+ * queues. As a consequence, the finish timestamps of all new -+ * or newly activated queues may end up being much larger than -+ * those of lucky queues with backshifted timestamps. The -+ * latter queues may then monopolize the device for a lot of -+ * time. This would simply break service guarantees. -+ * -+ * To reduce this problem, push up a little bit the -+ * backshifted timestamps of the queue associated with this -+ * entity (only a queue can happen to have the backshifted -+ * flag set): just enough to let the finish timestamp of the -+ * queue be equal to the current value of the system virtual -+ * time. This may introduce a little unfairness among queues -+ * with backshifted timestamps, but it does not break -+ * worst-case fairness guarantees. -+ * -+ * As a special case, if bfqq is weight-raised, push up -+ * timestamps much less, to keep very low the probability that -+ * this push up causes the backshifted finish timestamps of -+ * weight-raised queues to become higher than the backshifted -+ * finish timestamps of non weight-raised queues. -+ */ -+ if (backshifted && bfq_gt(st->vtime, entity->finish)) { -+ unsigned long delta = st->vtime - entity->finish; -+ -+ if (bfqq) -+ delta /= bfqq->wr_coeff; -+ -+ entity->start += delta; -+ entity->finish += delta; -+ -+ if (bfqq) { -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "__activate_entity: new queue finish %llu", -+ ((entity->finish>>10)*1000)>>12); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ } else { -+ struct bfq_group *bfqg = -+ container_of(entity, struct bfq_group, entity); -+ -+ bfq_log_bfqg((struct bfq_data *)bfqg->bfqd, bfqg, -+ "__activate_entity: new group finish %llu", -+ ((entity->finish>>10)*1000)>>12); -+#endif -+ } -+ } -+ -+ bfq_active_insert(st, entity); -+ -+ if (bfqq) { -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "__activate_entity: queue %seligible in st %p", -+ entity->start <= st->vtime ? "" : "non ", st); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ } else { -+ struct bfq_group *bfqg = -+ container_of(entity, struct bfq_group, entity); -+ -+ bfq_log_bfqg((struct bfq_data *)bfqg->bfqd, bfqg, -+ "__activate_entity: group %seligible in st %p", -+ entity->start <= st->vtime ? "" : "non ", st); -+#endif -+ } -+ BUG_ON(RB_EMPTY_ROOT(&st->active)); -+ BUG_ON(&st->active != &sd->service_tree->active && -+ &st->active != &(sd->service_tree+1)->active && -+ &st->active != &(sd->service_tree+2)->active); - } - - /** -- * __bfq_activate_entity - activate an entity. -+ * __bfq_activate_entity - handle activation of entity. - * @entity: the entity being activated. -+ * @non_blocking_wait_rq: true if entity was waiting for a request -+ * -+ * Called for a 'true' activation, i.e., if entity is not active and -+ * one of its children receives a new request. - * -- * Called whenever an entity is activated, i.e., it is not active and one -- * of its children receives a new request, or has to be reactivated due to -- * budget exhaustion. It uses the current budget of the entity (and the -- * service received if @entity is active) of the queue to calculate its -- * timestamps. -+ * Basically, this function updates the timestamps of entity and -+ * inserts entity into its active tree, ater possible extracting it -+ * from its idle tree. - */ --static void __bfq_activate_entity(struct bfq_entity *entity) -+static void __bfq_activate_entity(struct bfq_entity *entity, -+ bool non_blocking_wait_rq) - { - struct bfq_sched_data *sd = entity->sched_data; - struct bfq_service_tree *st = bfq_entity_service_tree(entity); -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ bool backshifted = false; -+ unsigned long long min_vstart; - -- if (entity == sd->in_service_entity) { -- BUG_ON(entity->tree); -- /* -- * If we are requeueing the current entity we have -- * to take care of not charging to it service it has -- * not received. -- */ -- bfq_calc_finish(entity, entity->service); -- entity->start = entity->finish; -- sd->in_service_entity = NULL; -- } else if (entity->tree == &st->active) { -- /* -- * Requeueing an entity due to a change of some -- * next_in_service entity below it. We reuse the -- * old start time. -- */ -- bfq_active_extract(st, entity); -- } else if (entity->tree == &st->idle) { -+ BUG_ON(!sd); -+ BUG_ON(!st); -+ -+ /* See comments on bfq_fqq_update_budg_for_activation */ -+ if (non_blocking_wait_rq && bfq_gt(st->vtime, entity->finish)) { -+ backshifted = true; -+ min_vstart = entity->finish; -+ } else -+ min_vstart = st->vtime; -+ -+ if (entity->tree == &st->idle) { - /* - * Must be on the idle tree, bfq_idle_extract() will - * check for that. - */ - bfq_idle_extract(st, entity); -- entity->start = bfq_gt(st->vtime, entity->finish) ? -- st->vtime : entity->finish; -+ entity->start = bfq_gt(min_vstart, entity->finish) ? -+ min_vstart : entity->finish; - } else { - /* - * The finish time of the entity may be invalid, and - * it is in the past for sure, otherwise the queue - * would have been on the idle tree. - */ -- entity->start = st->vtime; -+ entity->start = min_vstart; - st->wsum += entity->weight; - bfq_get_entity(entity); - -- BUG_ON(entity->on_st); -- entity->on_st = 1; -+ BUG_ON(entity->on_st && bfqq); -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ if (entity->on_st && !bfqq) { -+ struct bfq_group *bfqg = -+ container_of(entity, struct bfq_group, -+ entity); -+ -+ bfq_log_bfqg((struct bfq_data *)bfqg->bfqd, -+ bfqg, -+ "activate bug, class %d in_service %p", -+ bfq_class_idx(entity), sd->in_service_entity); -+ } -+#endif -+ BUG_ON(entity->on_st && !bfqq); -+ entity->on_st = true; - } - -- st = __bfq_entity_update_weight_prio(st, entity); -- bfq_calc_finish(entity, entity->budget); -- bfq_active_insert(st, entity); -+ bfq_update_fin_time_enqueue(entity, st, backshifted); - } - - /** -- * bfq_activate_entity - activate an entity and its ancestors if necessary. -- * @entity: the entity to activate. -+ * __bfq_requeue_entity - handle requeueing or repositioning of an entity. -+ * @entity: the entity being requeued or repositioned. -+ * -+ * Requeueing is needed if this entity stops being served, which -+ * happens if a leaf descendant entity has expired. On the other hand, -+ * repositioning is needed if the next_inservice_entity for the child -+ * entity has changed. See the comments inside the function for -+ * details. - * -- * Activate @entity and all the entities on the path from it to the root. -+ * Basically, this function: 1) removes entity from its active tree if -+ * present there, 2) updates the timestamps of entity and 3) inserts -+ * entity back into its active tree (in the new, right position for -+ * the new values of the timestamps). - */ --static void bfq_activate_entity(struct bfq_entity *entity) -+static void __bfq_requeue_entity(struct bfq_entity *entity) -+{ -+ struct bfq_sched_data *sd = entity->sched_data; -+ struct bfq_service_tree *st = bfq_entity_service_tree(entity); -+ -+ BUG_ON(!sd); -+ BUG_ON(!st); -+ -+ BUG_ON(entity != sd->in_service_entity && -+ entity->tree != &st->active); -+ -+ if (entity == sd->in_service_entity) { -+ /* -+ * We are requeueing the current in-service entity, -+ * which may have to be done for one of the following -+ * reasons: -+ * - entity represents the in-service queue, and the -+ * in-service queue is being requeued after an -+ * expiration; -+ * - entity represents a group, and its budget has -+ * changed because one of its child entities has -+ * just been either activated or requeued for some -+ * reason; the timestamps of the entity need then to -+ * be updated, and the entity needs to be enqueued -+ * or repositioned accordingly. -+ * -+ * In particular, before requeueing, the start time of -+ * the entity must be moved forward to account for the -+ * service that the entity has received while in -+ * service. This is done by the next instructions. The -+ * finish time will then be updated according to this -+ * new value of the start time, and to the budget of -+ * the entity. -+ */ -+ bfq_calc_finish(entity, entity->service); -+ entity->start = entity->finish; -+ BUG_ON(entity->tree && entity->tree != &st->active); -+ /* -+ * In addition, if the entity had more than one child -+ * when set in service, then was not extracted from -+ * the active tree. This implies that the position of -+ * the entity in the active tree may need to be -+ * changed now, because we have just updated the start -+ * time of the entity, and we will update its finish -+ * time in a moment (the requeueing is then, more -+ * precisely, a repositioning in this case). To -+ * implement this repositioning, we: 1) dequeue the -+ * entity here, 2) update the finish time and -+ * requeue the entity according to the new -+ * timestamps below. -+ */ -+ if (entity->tree) -+ bfq_active_extract(st, entity); -+ } else { /* The entity is already active, and not in service */ -+ /* -+ * In this case, this function gets called only if the -+ * next_in_service entity below this entity has -+ * changed, and this change has caused the budget of -+ * this entity to change, which, finally implies that -+ * the finish time of this entity must be -+ * updated. Such an update may cause the scheduling, -+ * i.e., the position in the active tree, of this -+ * entity to change. We handle this change by: 1) -+ * dequeueing the entity here, 2) updating the finish -+ * time and requeueing the entity according to the new -+ * timestamps below. This is the same approach as the -+ * non-extracted-entity sub-case above. -+ */ -+ bfq_active_extract(st, entity); -+ } -+ -+ bfq_update_fin_time_enqueue(entity, st, false); -+} -+ -+static void __bfq_activate_requeue_entity(struct bfq_entity *entity, -+ struct bfq_sched_data *sd, -+ bool non_blocking_wait_rq) -+{ -+ struct bfq_service_tree *st = bfq_entity_service_tree(entity); -+ -+ if (sd->in_service_entity == entity || entity->tree == &st->active) -+ /* -+ * in service or already queued on the active tree, -+ * requeue or reposition -+ */ -+ __bfq_requeue_entity(entity); -+ else -+ /* -+ * Not in service and not queued on its active tree: -+ * the activity is idle and this is a true activation. -+ */ -+ __bfq_activate_entity(entity, non_blocking_wait_rq); -+} -+ -+ -+/** -+ * bfq_activate_entity - activate or requeue an entity representing a bfq_queue, -+ * and activate, requeue or reposition all ancestors -+ * for which such an update becomes necessary. -+ * @entity: the entity to activate. -+ * @non_blocking_wait_rq: true if this entity was waiting for a request -+ * @requeue: true if this is a requeue, which implies that bfqq is -+ * being expired; thus ALL its ancestors stop being served and must -+ * therefore be requeued -+ */ -+static void bfq_activate_requeue_entity(struct bfq_entity *entity, -+ bool non_blocking_wait_rq, -+ bool requeue) - { - struct bfq_sched_data *sd; - - for_each_entity(entity) { -- __bfq_activate_entity(entity); -- -+ BUG_ON(!entity); - sd = entity->sched_data; -- if (!bfq_update_next_in_service(sd)) -- /* -- * No need to propagate the activation to the -- * upper entities, as they will be updated when -- * the in-service entity is rescheduled. -- */ -+ __bfq_activate_requeue_entity(entity, sd, non_blocking_wait_rq); -+ -+ BUG_ON(RB_EMPTY_ROOT(&sd->service_tree->active) && -+ RB_EMPTY_ROOT(&(sd->service_tree+1)->active) && -+ RB_EMPTY_ROOT(&(sd->service_tree+2)->active)); -+ -+ if (!bfq_update_next_in_service(sd, entity) && !requeue) { -+ BUG_ON(!sd->next_in_service); - break; -+ } -+ BUG_ON(!sd->next_in_service); - } - } - - /** - * __bfq_deactivate_entity - deactivate an entity from its service tree. - * @entity: the entity to deactivate. -- * @requeue: if false, the entity will not be put into the idle tree. -- * -- * Deactivate an entity, independently from its previous state. If the -- * entity was not on a service tree just return, otherwise if it is on -- * any scheduler tree, extract it from that tree, and if necessary -- * and if the caller did not specify @requeue, put it on the idle tree. -+ * @ins_into_idle_tree: if false, the entity will not be put into the -+ * idle tree. - * -- * Return %1 if the caller should update the entity hierarchy, i.e., -- * if the entity was in service or if it was the next_in_service for -- * its sched_data; return %0 otherwise. -+ * Deactivates an entity, independently from its previous state. Must -+ * be invoked only if entity is on a service tree. Extracts the entity -+ * from that tree, and if necessary and allowed, puts it on the idle -+ * tree. - */ --static int __bfq_deactivate_entity(struct bfq_entity *entity, int requeue) -+static bool __bfq_deactivate_entity(struct bfq_entity *entity, -+ bool ins_into_idle_tree) - { - struct bfq_sched_data *sd = entity->sched_data; -- struct bfq_service_tree *st; -- int was_in_service; -- int ret = 0; -- -- if (sd == NULL || !entity->on_st) /* never activated, or inactive */ -- return 0; -+ struct bfq_service_tree *st = bfq_entity_service_tree(entity); -+ bool was_in_service = entity == sd->in_service_entity; - -- st = bfq_entity_service_tree(entity); -- was_in_service = entity == sd->in_service_entity; -+ if (!entity->on_st) { /* entity never activated, or already inactive */ -+ BUG_ON(entity == entity->sched_data->in_service_entity); -+ return false; -+ } - -- BUG_ON(was_in_service && entity->tree); -+ BUG_ON(was_in_service && entity->tree && entity->tree != &st->active); - -- if (was_in_service) { -+ if (was_in_service) - bfq_calc_finish(entity, entity->service); -- sd->in_service_entity = NULL; -- } else if (entity->tree == &st->active) -+ -+ if (entity->tree == &st->active) - bfq_active_extract(st, entity); -- else if (entity->tree == &st->idle) -+ else if (!was_in_service && entity->tree == &st->idle) - bfq_idle_extract(st, entity); - else if (entity->tree) - BUG(); - -- if (was_in_service || sd->next_in_service == entity) -- ret = bfq_update_next_in_service(sd); -- -- if (!requeue || !bfq_gt(entity->finish, st->vtime)) -+ if (!ins_into_idle_tree || !bfq_gt(entity->finish, st->vtime)) - bfq_forget_entity(st, entity); - else - bfq_idle_insert(st, entity); - -- BUG_ON(sd->in_service_entity == entity); -- BUG_ON(sd->next_in_service == entity); -- -- return ret; -+ return true; - } - - /** -- * bfq_deactivate_entity - deactivate an entity. -+ * bfq_deactivate_entity - deactivate an entity representing a bfq_queue. - * @entity: the entity to deactivate. -- * @requeue: true if the entity can be put on the idle tree -+ * @ins_into_idle_tree: true if the entity can be put on the idle tree - */ --static void bfq_deactivate_entity(struct bfq_entity *entity, int requeue) -+static void bfq_deactivate_entity(struct bfq_entity *entity, -+ bool ins_into_idle_tree, -+ bool expiration) - { - struct bfq_sched_data *sd; - struct bfq_entity *parent; -@@ -887,63 +1306,154 @@ static void bfq_deactivate_entity(struct bfq_entity *entity, int requeue) - for_each_entity_safe(entity, parent) { - sd = entity->sched_data; - -- if (!__bfq_deactivate_entity(entity, requeue)) -+ BUG_ON(sd == NULL); /* -+ * It would mean that this is the -+ * root group. -+ */ -+ -+ BUG_ON(expiration && entity != sd->in_service_entity); -+ -+ BUG_ON(entity != sd->in_service_entity && -+ entity->tree == -+ &bfq_entity_service_tree(entity)->active && -+ !sd->next_in_service); -+ -+ if (!__bfq_deactivate_entity(entity, ins_into_idle_tree)) { - /* -- * The parent entity is still backlogged, and -- * we don't need to update it as it is still -- * in service. -+ * Entity is not any tree any more, so, this -+ * deactivation is a no-op, and there is -+ * nothing to change for upper-level entities -+ * (in case of expiration, this can never -+ * happen). - */ -- break; -+ BUG_ON(expiration); /* -+ * entity cannot be already out of -+ * any tree -+ */ -+ return; -+ } - -- if (sd->next_in_service) -+ if (sd->next_in_service == entity) - /* -- * The parent entity is still backlogged and -- * the budgets on the path towards the root -- * need to be updated. -+ * entity was the next_in_service entity, -+ * then, since entity has just been -+ * deactivated, a new one must be found. - */ -- goto update; -+ bfq_update_next_in_service(sd, NULL); -+ -+ if (sd->next_in_service) { -+ /* -+ * The parent entity is still backlogged, -+ * because next_in_service is not NULL. So, no -+ * further upwards deactivation must be -+ * performed. Yet, next_in_service has -+ * changed. Then the schedule does need to be -+ * updated upwards. -+ */ -+ BUG_ON(sd->next_in_service == entity); -+ break; -+ } - - /* -- * If we reach there the parent is no more backlogged and -- * we want to propagate the dequeue upwards. -+ * If we get here, then the parent is no more -+ * backlogged and we need to propagate the -+ * deactivation upwards. Thus let the loop go on. - */ -- requeue = 1; -- } - -- return; -+ /* -+ * Also let parent be queued into the idle tree on -+ * deactivation, to preserve service guarantees, and -+ * assuming that who invoked this function does not -+ * need parent entities too to be removed completely. -+ */ -+ ins_into_idle_tree = true; -+ } - --update: -+ /* -+ * If the deactivation loop is fully executed, then there are -+ * no more entities to touch and next loop is not executed at -+ * all. Otherwise, requeue remaining entities if they are -+ * about to stop receiving service, or reposition them if this -+ * is not the case. -+ */ - entity = parent; - for_each_entity(entity) { -- __bfq_activate_entity(entity); -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ -+ /* -+ * Invoke __bfq_requeue_entity on entity, even if -+ * already active, to requeue/reposition it in the -+ * active tree (because sd->next_in_service has -+ * changed) -+ */ -+ __bfq_requeue_entity(entity); - - sd = entity->sched_data; -- if (!bfq_update_next_in_service(sd)) -+ BUG_ON(expiration && sd->in_service_entity != entity); -+ -+ if (bfqq) -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "invoking udpdate_next for this queue"); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ else { -+ struct bfq_group *bfqg = -+ container_of(entity, -+ struct bfq_group, entity); -+ -+ bfq_log_bfqg((struct bfq_data *)bfqg->bfqd, bfqg, -+ "invoking udpdate_next for this entity"); -+ } -+#endif -+ if (!bfq_update_next_in_service(sd, entity) && -+ !expiration) -+ /* -+ * next_in_service unchanged or not causing -+ * any change in entity->parent->sd, and no -+ * requeueing needed for expiration: stop -+ * here. -+ */ - break; - } - } - - /** -- * bfq_update_vtime - update vtime if necessary. -+ * bfq_calc_vtime_jump - compute the value to which the vtime should jump, -+ * if needed, to have at least one entity eligible. - * @st: the service tree to act upon. - * -- * If necessary update the service tree vtime to have at least one -- * eligible entity, skipping to its start time. Assumes that the -- * active tree of the device is not empty. -- * -- * NOTE: this hierarchical implementation updates vtimes quite often, -- * we may end up with reactivated processes getting timestamps after a -- * vtime skip done because we needed a ->first_active entity on some -- * intermediate node. -+ * Assumes that st is not empty. - */ --static void bfq_update_vtime(struct bfq_service_tree *st) -+static u64 bfq_calc_vtime_jump(struct bfq_service_tree *st) - { -- struct bfq_entity *entry; -- struct rb_node *node = st->active.rb_node; -+ struct bfq_entity *root_entity = bfq_root_active_entity(&st->active); -+ -+ if (bfq_gt(root_entity->min_start, st->vtime)) { -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(root_entity); - -- entry = rb_entry(node, struct bfq_entity, rb_node); -- if (bfq_gt(entry->min_start, st->vtime)) { -- st->vtime = entry->min_start; -+ if (bfqq) -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "calc_vtime_jump: new value %llu", -+ root_entity->min_start); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ else { -+ struct bfq_group *bfqg = -+ container_of(root_entity, struct bfq_group, -+ entity); -+ -+ bfq_log_bfqg((struct bfq_data *)bfqg->bfqd, bfqg, -+ "calc_vtime_jump: new value %llu", -+ root_entity->min_start); -+ } -+#endif -+ return root_entity->min_start; -+ } -+ return st->vtime; -+} -+ -+static void bfq_update_vtime(struct bfq_service_tree *st, u64 new_value) -+{ -+ if (new_value > st->vtime) { -+ st->vtime = new_value; - bfq_forget_idle(st); - } - } -@@ -952,6 +1462,7 @@ static void bfq_update_vtime(struct bfq_service_tree *st) - * bfq_first_active_entity - find the eligible entity with - * the smallest finish time - * @st: the service tree to select from. -+ * @vtime: the system virtual to use as a reference for eligibility - * - * This function searches the first schedulable entity, starting from the - * root of the tree and going on the left every time on this side there is -@@ -959,7 +1470,8 @@ static void bfq_update_vtime(struct bfq_service_tree *st) - * the right is followed only if a) the left subtree contains no eligible - * entities and b) no eligible entity has been found yet. - */ --static struct bfq_entity *bfq_first_active_entity(struct bfq_service_tree *st) -+static struct bfq_entity *bfq_first_active_entity(struct bfq_service_tree *st, -+ u64 vtime) - { - struct bfq_entity *entry, *first = NULL; - struct rb_node *node = st->active.rb_node; -@@ -967,15 +1479,15 @@ static struct bfq_entity *bfq_first_active_entity(struct bfq_service_tree *st) - while (node) { - entry = rb_entry(node, struct bfq_entity, rb_node); - left: -- if (!bfq_gt(entry->start, st->vtime)) -+ if (!bfq_gt(entry->start, vtime)) - first = entry; - -- BUG_ON(bfq_gt(entry->min_start, st->vtime)); -+ BUG_ON(bfq_gt(entry->min_start, vtime)); - - if (node->rb_left) { - entry = rb_entry(node->rb_left, - struct bfq_entity, rb_node); -- if (!bfq_gt(entry->min_start, st->vtime)) { -+ if (!bfq_gt(entry->min_start, vtime)) { - node = node->rb_left; - goto left; - } -@@ -993,31 +1505,84 @@ static struct bfq_entity *bfq_first_active_entity(struct bfq_service_tree *st) - * __bfq_lookup_next_entity - return the first eligible entity in @st. - * @st: the service tree. - * -- * Update the virtual time in @st and return the first eligible entity -- * it contains. -+ * If there is no in-service entity for the sched_data st belongs to, -+ * then return the entity that will be set in service if: -+ * 1) the parent entity this st belongs to is set in service; -+ * 2) no entity belonging to such parent entity undergoes a state change -+ * that would influence the timestamps of the entity (e.g., becomes idle, -+ * becomes backlogged, changes its budget, ...). -+ * -+ * In this first case, update the virtual time in @st too (see the -+ * comments on this update inside the function). -+ * -+ * In constrast, if there is an in-service entity, then return the -+ * entity that would be set in service if not only the above -+ * conditions, but also the next one held true: the currently -+ * in-service entity, on expiration, -+ * 1) gets a finish time equal to the current one, or -+ * 2) is not eligible any more, or -+ * 3) is idle. - */ --static struct bfq_entity *__bfq_lookup_next_entity(struct bfq_service_tree *st, -- bool force) -+static struct bfq_entity * -+__bfq_lookup_next_entity(struct bfq_service_tree *st, bool in_service -+#if 0 -+ , bool force -+#endif -+ ) - { -- struct bfq_entity *entity, *new_next_in_service = NULL; -+ struct bfq_entity *entity -+#if 0 -+ , *new_next_in_service = NULL -+#endif -+ ; -+ u64 new_vtime; -+ struct bfq_queue *bfqq; - - if (RB_EMPTY_ROOT(&st->active)) - return NULL; - -- bfq_update_vtime(st); -- entity = bfq_first_active_entity(st); -- BUG_ON(bfq_gt(entity->start, st->vtime)); -+ /* -+ * Get the value of the system virtual time for which at -+ * least one entity is eligible. -+ */ -+ new_vtime = bfq_calc_vtime_jump(st); - - /* -- * If the chosen entity does not match with the sched_data's -- * next_in_service and we are forcedly serving the IDLE priority -- * class tree, bubble up budget update. -+ * If there is no in-service entity for the sched_data this -+ * active tree belongs to, then push the system virtual time -+ * up to the value that guarantees that at least one entity is -+ * eligible. If, instead, there is an in-service entity, then -+ * do not make any such update, because there is already an -+ * eligible entity, namely the in-service one (even if the -+ * entity is not on st, because it was extracted when set in -+ * service). - */ -- if (unlikely(force && entity != entity->sched_data->next_in_service)) { -- new_next_in_service = entity; -- for_each_entity(new_next_in_service) -- bfq_update_budget(new_next_in_service); -+ if (!in_service) -+ bfq_update_vtime(st, new_vtime); -+ -+ entity = bfq_first_active_entity(st, new_vtime); -+ BUG_ON(bfq_gt(entity->start, new_vtime)); -+ -+ /* Log some information */ -+ bfqq = bfq_entity_to_bfqq(entity); -+ if (bfqq) -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "__lookup_next: start %llu vtime %llu st %p", -+ ((entity->start>>10)*1000)>>12, -+ ((new_vtime>>10)*1000)>>12, st); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ else { -+ struct bfq_group *bfqg = -+ container_of(entity, struct bfq_group, entity); -+ -+ bfq_log_bfqg((struct bfq_data *)bfqg->bfqd, bfqg, -+ "__lookup_next: start %llu vtime %llu st %p", -+ ((entity->start>>10)*1000)>>12, -+ ((new_vtime>>10)*1000)>>12, st); - } -+#endif -+ -+ BUG_ON(!entity); - - return entity; - } -@@ -1025,50 +1590,81 @@ static struct bfq_entity *__bfq_lookup_next_entity(struct bfq_service_tree *st, - /** - * bfq_lookup_next_entity - return the first eligible entity in @sd. - * @sd: the sched_data. -- * @extract: if true the returned entity will be also extracted from @sd. - * -- * NOTE: since we cache the next_in_service entity at each level of the -- * hierarchy, the complexity of the lookup can be decreased with -- * absolutely no effort just returning the cached next_in_service value; -- * we prefer to do full lookups to test the consistency of * the data -- * structures. -+ * This function is invoked when there has been a change in the trees -+ * for sd, and we need know what is the new next entity after this -+ * change. - */ --static struct bfq_entity *bfq_lookup_next_entity(struct bfq_sched_data *sd, -- int extract, -- struct bfq_data *bfqd) -+static struct bfq_entity *bfq_lookup_next_entity(struct bfq_sched_data *sd) - { - struct bfq_service_tree *st = sd->service_tree; -- struct bfq_entity *entity; -- int i = 0; -- -- BUG_ON(sd->in_service_entity); -+ struct bfq_service_tree *idle_class_st = st + (BFQ_IOPRIO_CLASSES - 1); -+ struct bfq_entity *entity = NULL; -+ struct bfq_queue *bfqq; -+ int class_idx = 0; - -- if (bfqd && -- jiffies - bfqd->bfq_class_idle_last_service > BFQ_CL_IDLE_TIMEOUT) { -- entity = __bfq_lookup_next_entity(st + BFQ_IOPRIO_CLASSES - 1, -- true); -- if (entity) { -- i = BFQ_IOPRIO_CLASSES - 1; -- bfqd->bfq_class_idle_last_service = jiffies; -- sd->next_in_service = entity; -- } -+ BUG_ON(!sd); -+ BUG_ON(!st); -+ /* -+ * Choose from idle class, if needed to guarantee a minimum -+ * bandwidth to this class (and if there is some active entity -+ * in idle class). This should also mitigate -+ * priority-inversion problems in case a low priority task is -+ * holding file system resources. -+ */ -+ if (time_is_before_jiffies(sd->bfq_class_idle_last_service + -+ BFQ_CL_IDLE_TIMEOUT)) { -+ if (!RB_EMPTY_ROOT(&idle_class_st->active)) -+ class_idx = BFQ_IOPRIO_CLASSES - 1; -+ /* About to be served if backlogged, or not yet backlogged */ -+ sd->bfq_class_idle_last_service = jiffies; - } -- for (; i < BFQ_IOPRIO_CLASSES; i++) { -- entity = __bfq_lookup_next_entity(st + i, false); -- if (entity) { -- if (extract) { -- bfq_check_next_in_service(sd, entity); -- bfq_active_extract(st + i, entity); -- sd->in_service_entity = entity; -- sd->next_in_service = NULL; -- } -+ -+ /* -+ * Find the next entity to serve for the highest-priority -+ * class, unless the idle class needs to be served. -+ */ -+ for (; class_idx < BFQ_IOPRIO_CLASSES; class_idx++) { -+ entity = __bfq_lookup_next_entity(st + class_idx, -+ sd->in_service_entity); -+ -+ if (entity) - break; -- } - } - -+ BUG_ON(!entity && -+ (!RB_EMPTY_ROOT(&st->active) || !RB_EMPTY_ROOT(&(st+1)->active) || -+ !RB_EMPTY_ROOT(&(st+2)->active))); -+ -+ if (!entity) -+ return NULL; -+ -+ /* Log some information */ -+ bfqq = bfq_entity_to_bfqq(entity); -+ if (bfqq) -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "chosen from st %p %d", -+ st + class_idx, class_idx); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ else { -+ struct bfq_group *bfqg = -+ container_of(entity, struct bfq_group, entity); -+ -+ bfq_log_bfqg((struct bfq_data *)bfqg->bfqd, bfqg, -+ "chosen from st %p %d", -+ st + class_idx, class_idx); -+ } -+#endif -+ - return entity; - } - -+static bool next_queue_may_preempt(struct bfq_data *bfqd) -+{ -+ struct bfq_sched_data *sd = &bfqd->root_group->sched_data; -+ -+ return sd->next_in_service != sd->in_service_entity; -+} -+ - /* - * Get next queue for service. - */ -@@ -1083,58 +1679,208 @@ static struct bfq_queue *bfq_get_next_queue(struct bfq_data *bfqd) - if (bfqd->busy_queues == 0) - return NULL; - -+ /* -+ * Traverse the path from the root to the leaf entity to -+ * serve. Set in service all the entities visited along the -+ * way. -+ */ - sd = &bfqd->root_group->sched_data; - for (; sd ; sd = entity->my_sched_data) { -- entity = bfq_lookup_next_entity(sd, 1, bfqd); -- BUG_ON(!entity); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ if (entity) { -+ struct bfq_group *bfqg = -+ container_of(entity, struct bfq_group, entity); -+ -+ bfq_log_bfqg(bfqd, bfqg, -+ "get_next_queue: lookup in this group"); -+ if (!sd->next_in_service) -+ pr_crit("get_next_queue: lookup in this group"); -+ } else { -+ bfq_log_bfqg(bfqd, bfqd->root_group, -+ "get_next_queue: lookup in root group"); -+ if (!sd->next_in_service) -+ pr_crit("get_next_queue: lookup in root group"); -+ } -+#endif -+ -+ BUG_ON(!sd->next_in_service); -+ -+ /* -+ * WARNING. We are about to set the in-service entity -+ * to sd->next_in_service, i.e., to the (cached) value -+ * returned by bfq_lookup_next_entity(sd) the last -+ * time it was invoked, i.e., the last time when the -+ * service order in sd changed as a consequence of the -+ * activation or deactivation of an entity. In this -+ * respect, if we execute bfq_lookup_next_entity(sd) -+ * in this very moment, it may, although with low -+ * probability, yield a different entity than that -+ * pointed to by sd->next_in_service. This rare event -+ * happens in case there was no CLASS_IDLE entity to -+ * serve for sd when bfq_lookup_next_entity(sd) was -+ * invoked for the last time, while there is now one -+ * such entity. -+ * -+ * If the above event happens, then the scheduling of -+ * such entity in CLASS_IDLE is postponed until the -+ * service of the sd->next_in_service entity -+ * finishes. In fact, when the latter is expired, -+ * bfq_lookup_next_entity(sd) gets called again, -+ * exactly to update sd->next_in_service. -+ */ -+ -+ /* Make next_in_service entity become in_service_entity */ -+ entity = sd->next_in_service; -+ sd->in_service_entity = entity; -+ -+ /* -+ * Reset the accumulator of the amount of service that -+ * the entity is about to receive. -+ */ - entity->service = 0; -+ -+ /* -+ * If entity is no longer a candidate for next -+ * service, then we extract it from its active tree, -+ * for the following reason. To further boost the -+ * throughput in some special case, BFQ needs to know -+ * which is the next candidate entity to serve, while -+ * there is already an entity in service. In this -+ * respect, to make it easy to compute/update the next -+ * candidate entity to serve after the current -+ * candidate has been set in service, there is a case -+ * where it is necessary to extract the current -+ * candidate from its service tree. Such a case is -+ * when the entity just set in service cannot be also -+ * a candidate for next service. Details about when -+ * this conditions holds are reported in the comments -+ * on the function bfq_no_longer_next_in_service() -+ * invoked below. -+ */ -+ if (bfq_no_longer_next_in_service(entity)) -+ bfq_active_extract(bfq_entity_service_tree(entity), -+ entity); -+ -+ /* -+ * For the same reason why we may have just extracted -+ * entity from its active tree, we may need to update -+ * next_in_service for the sched_data of entity too, -+ * regardless of whether entity has been extracted. -+ * In fact, even if entity has not been extracted, a -+ * descendant entity may get extracted. Such an event -+ * would cause a change in next_in_service for the -+ * level of the descendant entity, and thus possibly -+ * back to upper levels. -+ * -+ * We cannot perform the resulting needed update -+ * before the end of this loop, because, to know which -+ * is the correct next-to-serve candidate entity for -+ * each level, we need first to find the leaf entity -+ * to set in service. In fact, only after we know -+ * which is the next-to-serve leaf entity, we can -+ * discover whether the parent entity of the leaf -+ * entity becomes the next-to-serve, and so on. -+ */ -+ -+ /* Log some information */ -+ bfqq = bfq_entity_to_bfqq(entity); -+ if (bfqq) -+ bfq_log_bfqq(bfqd, bfqq, -+ "get_next_queue: this queue, finish %llu", -+ (((entity->finish>>10)*1000)>>10)>>2); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ else { -+ struct bfq_group *bfqg = -+ container_of(entity, struct bfq_group, entity); -+ -+ bfq_log_bfqg(bfqd, bfqg, -+ "get_next_queue: this entity, finish %llu", -+ (((entity->finish>>10)*1000)>>10)>>2); -+ } -+#endif -+ - } - -+ BUG_ON(!entity); - bfqq = bfq_entity_to_bfqq(entity); - BUG_ON(!bfqq); - -+ /* -+ * We can finally update all next-to-serve entities along the -+ * path from the leaf entity just set in service to the root. -+ */ -+ for_each_entity(entity) { -+ struct bfq_sched_data *sd = entity->sched_data; -+ -+ if(!bfq_update_next_in_service(sd, NULL)) -+ break; -+ } -+ - return bfqq; - } - - static void __bfq_bfqd_reset_in_service(struct bfq_data *bfqd) - { -+ struct bfq_entity *entity = &bfqd->in_service_queue->entity; -+ - if (bfqd->in_service_bic) { - put_io_context(bfqd->in_service_bic->icq.ioc); - bfqd->in_service_bic = NULL; - } - -+ bfq_clear_bfqq_wait_request(bfqd->in_service_queue); -+ hrtimer_try_to_cancel(&bfqd->idle_slice_timer); - bfqd->in_service_queue = NULL; -- del_timer(&bfqd->idle_slice_timer); -+ -+ /* -+ * When this function is called, all in-service entities have -+ * been properly deactivated or requeued, so we can safely -+ * execute the final step: reset in_service_entity along the -+ * path from entity to the root. -+ */ -+ for_each_entity(entity) -+ entity->sched_data->in_service_entity = NULL; - } - - static void bfq_deactivate_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq, -- int requeue) -+ bool ins_into_idle_tree, bool expiration) - { - struct bfq_entity *entity = &bfqq->entity; - -- if (bfqq == bfqd->in_service_queue) -- __bfq_bfqd_reset_in_service(bfqd); -- -- bfq_deactivate_entity(entity, requeue); -+ bfq_deactivate_entity(entity, ins_into_idle_tree, expiration); - } - - static void bfq_activate_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq) - { - struct bfq_entity *entity = &bfqq->entity; -+ struct bfq_service_tree *st = bfq_entity_service_tree(entity); -+ -+ BUG_ON(bfqq == bfqd->in_service_queue); -+ BUG_ON(entity->tree != &st->active && entity->tree != &st->idle && -+ entity->on_st); - -- bfq_activate_entity(entity); -+ bfq_activate_requeue_entity(entity, bfq_bfqq_non_blocking_wait_rq(bfqq), -+ false); -+ bfq_clear_bfqq_non_blocking_wait_rq(bfqq); -+} -+ -+static void bfq_requeue_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq) -+{ -+ struct bfq_entity *entity = &bfqq->entity; -+ -+ bfq_activate_requeue_entity(entity, false, -+ bfqq == bfqd->in_service_queue); - } - --#ifdef CONFIG_BFQ_GROUP_IOSCHED - static void bfqg_stats_update_dequeue(struct bfq_group *bfqg); --#endif - - /* - * Called when the bfqq no longer has requests pending, remove it from -- * the service tree. -+ * the service tree. As a special case, it can be invoked during an -+ * expiration. - */ - static void bfq_del_bfqq_busy(struct bfq_data *bfqd, struct bfq_queue *bfqq, -- int requeue) -+ bool expiration) - { - BUG_ON(!bfq_bfqq_busy(bfqq)); - BUG_ON(!RB_EMPTY_ROOT(&bfqq->sort_list)); -@@ -1146,27 +1892,20 @@ static void bfq_del_bfqq_busy(struct bfq_data *bfqd, struct bfq_queue *bfqq, - BUG_ON(bfqd->busy_queues == 0); - bfqd->busy_queues--; - -- if (!bfqq->dispatched) { -+ if (!bfqq->dispatched) - bfq_weights_tree_remove(bfqd, &bfqq->entity, - &bfqd->queue_weights_tree); -- if (!blk_queue_nonrot(bfqd->queue)) { -- BUG_ON(!bfqd->busy_in_flight_queues); -- bfqd->busy_in_flight_queues--; -- if (bfq_bfqq_constantly_seeky(bfqq)) { -- BUG_ON(!bfqd-> -- const_seeky_busy_in_flight_queues); -- bfqd->const_seeky_busy_in_flight_queues--; -- } -- } -- } -+ - if (bfqq->wr_coeff > 1) - bfqd->wr_busy_queues--; - --#ifdef CONFIG_BFQ_GROUP_IOSCHED - bfqg_stats_update_dequeue(bfqq_group(bfqq)); --#endif - -- bfq_deactivate_bfqq(bfqd, bfqq, requeue); -+ BUG_ON(bfqq->entity.budget < 0); -+ -+ bfq_deactivate_bfqq(bfqd, bfqq, true, expiration); -+ -+ BUG_ON(bfqq->entity.budget < 0); - } - - /* -@@ -1184,16 +1923,11 @@ static void bfq_add_bfqq_busy(struct bfq_data *bfqd, struct bfq_queue *bfqq) - bfq_mark_bfqq_busy(bfqq); - bfqd->busy_queues++; - -- if (!bfqq->dispatched) { -+ if (!bfqq->dispatched) - if (bfqq->wr_coeff == 1) - bfq_weights_tree_add(bfqd, &bfqq->entity, - &bfqd->queue_weights_tree); -- if (!blk_queue_nonrot(bfqd->queue)) { -- bfqd->busy_in_flight_queues++; -- if (bfq_bfqq_constantly_seeky(bfqq)) -- bfqd->const_seeky_busy_in_flight_queues++; -- } -- } -+ - if (bfqq->wr_coeff > 1) - bfqd->wr_busy_queues++; - } -diff --git a/block/bfq.h b/block/bfq.h -index fcce855..bef8244 100644 ---- a/block/bfq.h -+++ b/block/bfq.h -@@ -1,5 +1,5 @@ - /* -- * BFQ-v7r11 for 4.5.0: data structures and common functions prototypes. -+ * BFQ v8r7 for 4.9.0: data structures and common functions prototypes. - * - * Based on ideas and code from CFQ: - * Copyright (C) 2003 Jens Axboe -@@ -7,7 +7,9 @@ - * Copyright (C) 2008 Fabio Checconi - * Paolo Valente - * -- * Copyright (C) 2010 Paolo Valente -+ * Copyright (C) 2015 Paolo Valente -+ * -+ * Copyright (C) 2016 Paolo Valente - */ - - #ifndef _BFQ_H -@@ -28,20 +30,21 @@ - - #define BFQ_DEFAULT_QUEUE_IOPRIO 4 - --#define BFQ_DEFAULT_GRP_WEIGHT 10 -+#define BFQ_WEIGHT_LEGACY_DFL 100 - #define BFQ_DEFAULT_GRP_IOPRIO 0 - #define BFQ_DEFAULT_GRP_CLASS IOPRIO_CLASS_BE - -+/* -+ * Soft real-time applications are extremely more latency sensitive -+ * than interactive ones. Over-raise the weight of the former to -+ * privilege them against the latter. -+ */ -+#define BFQ_SOFTRT_WEIGHT_FACTOR 100 -+ - struct bfq_entity; - - /** - * struct bfq_service_tree - per ioprio_class service tree. -- * @active: tree for active entities (i.e., those backlogged). -- * @idle: tree for idle entities (i.e., those not backlogged, with V <= F_i). -- * @first_idle: idle entity with minimum F_i. -- * @last_idle: idle entity with maximum F_i. -- * @vtime: scheduler virtual time. -- * @wsum: scheduler weight sum; active and idle entities contribute to it. - * - * Each service tree represents a B-WF2Q+ scheduler on its own. Each - * ioprio_class has its own independent scheduler, and so its own -@@ -49,27 +52,28 @@ struct bfq_entity; - * of the containing bfqd. - */ - struct bfq_service_tree { -+ /* tree for active entities (i.e., those backlogged) */ - struct rb_root active; -+ /* tree for idle entities (i.e., not backlogged, with V <= F_i)*/ - struct rb_root idle; - -- struct bfq_entity *first_idle; -- struct bfq_entity *last_idle; -+ struct bfq_entity *first_idle; /* idle entity with minimum F_i */ -+ struct bfq_entity *last_idle; /* idle entity with maximum F_i */ - -- u64 vtime; -+ u64 vtime; /* scheduler virtual time */ -+ /* scheduler weight sum; active and idle entities contribute to it */ - unsigned long wsum; - }; - - /** - * struct bfq_sched_data - multi-class scheduler. -- * @in_service_entity: entity in service. -- * @next_in_service: head-of-the-line entity in the scheduler. -- * @service_tree: array of service trees, one per ioprio_class. - * - * bfq_sched_data is the basic scheduler queue. It supports three -- * ioprio_classes, and can be used either as a toplevel queue or as -- * an intermediate queue on a hierarchical setup. -- * @next_in_service points to the active entity of the sched_data -- * service trees that will be scheduled next. -+ * ioprio_classes, and can be used either as a toplevel queue or as an -+ * intermediate queue on a hierarchical setup. @next_in_service -+ * points to the active entity of the sched_data service trees that -+ * will be scheduled next. It is used to reduce the number of steps -+ * needed for each hierarchical-schedule update. - * - * The supported ioprio_classes are the same as in CFQ, in descending - * priority order, IOPRIO_CLASS_RT, IOPRIO_CLASS_BE, IOPRIO_CLASS_IDLE. -@@ -79,48 +83,32 @@ struct bfq_service_tree { - * All the fields are protected by the queue lock of the containing bfqd. - */ - struct bfq_sched_data { -- struct bfq_entity *in_service_entity; -+ struct bfq_entity *in_service_entity; /* entity in service */ -+ /* head-of-the-line entity in the scheduler (see comments above) */ - struct bfq_entity *next_in_service; -+ /* array of service trees, one per ioprio_class */ - struct bfq_service_tree service_tree[BFQ_IOPRIO_CLASSES]; -+ /* last time CLASS_IDLE was served */ -+ unsigned long bfq_class_idle_last_service; -+ - }; - - /** - * struct bfq_weight_counter - counter of the number of all active entities - * with a given weight. -- * @weight: weight of the entities that this counter refers to. -- * @num_active: number of active entities with this weight. -- * @weights_node: weights tree member (see bfq_data's @queue_weights_tree -- * and @group_weights_tree). - */ - struct bfq_weight_counter { -- short int weight; -- unsigned int num_active; -+ unsigned int weight; /* weight of the entities this counter refers to */ -+ unsigned int num_active; /* nr of active entities with this weight */ -+ /* -+ * Weights tree member (see bfq_data's @queue_weights_tree and -+ * @group_weights_tree) -+ */ - struct rb_node weights_node; - }; - - /** - * struct bfq_entity - schedulable entity. -- * @rb_node: service_tree member. -- * @weight_counter: pointer to the weight counter associated with this entity. -- * @on_st: flag, true if the entity is on a tree (either the active or -- * the idle one of its service_tree). -- * @finish: B-WF2Q+ finish timestamp (aka F_i). -- * @start: B-WF2Q+ start timestamp (aka S_i). -- * @tree: tree the entity is enqueued into; %NULL if not on a tree. -- * @min_start: minimum start time of the (active) subtree rooted at -- * this entity; used for O(log N) lookups into active trees. -- * @service: service received during the last round of service. -- * @budget: budget used to calculate F_i; F_i = S_i + @budget / @weight. -- * @weight: weight of the queue -- * @parent: parent entity, for hierarchical scheduling. -- * @my_sched_data: for non-leaf nodes in the cgroup hierarchy, the -- * associated scheduler queue, %NULL on leaf nodes. -- * @sched_data: the scheduler queue this entity belongs to. -- * @ioprio: the ioprio in use. -- * @new_weight: when a weight change is requested, the new weight value. -- * @orig_weight: original weight, used to implement weight boosting -- * @prio_changed: flag, true when the user requested a weight, ioprio or -- * ioprio_class change. - * - * A bfq_entity is used to represent either a bfq_queue (leaf node in the - * cgroup hierarchy) or a bfq_group into the upper level scheduler. Each -@@ -147,27 +135,52 @@ struct bfq_weight_counter { - * containing bfqd. - */ - struct bfq_entity { -- struct rb_node rb_node; -+ struct rb_node rb_node; /* service_tree member */ -+ /* pointer to the weight counter associated with this entity */ - struct bfq_weight_counter *weight_counter; - -- int on_st; -+ /* -+ * Flag, true if the entity is on a tree (either the active or -+ * the idle one of its service_tree) or is in service. -+ */ -+ bool on_st; - -- u64 finish; -- u64 start; -+ u64 finish; /* B-WF2Q+ finish timestamp (aka F_i) */ -+ u64 start; /* B-WF2Q+ start timestamp (aka S_i) */ - -+ /* tree the entity is enqueued into; %NULL if not on a tree */ - struct rb_root *tree; - -+ /* -+ * minimum start time of the (active) subtree rooted at this -+ * entity; used for O(log N) lookups into active trees -+ */ - u64 min_start; - -- int service, budget; -- unsigned short weight, new_weight; -- unsigned short orig_weight; -+ /* amount of service received during the last service slot */ -+ int service; -+ -+ /* budget, used also to calculate F_i: F_i = S_i + @budget / @weight */ -+ int budget; -+ -+ unsigned int weight; /* weight of the queue */ -+ unsigned int new_weight; /* next weight if a change is in progress */ -+ -+ /* original weight, used to implement weight boosting */ -+ unsigned int orig_weight; - -+ /* parent entity, for hierarchical scheduling */ - struct bfq_entity *parent; - -+ /* -+ * For non-leaf nodes in the hierarchy, the associated -+ * scheduler queue, %NULL on leaf nodes. -+ */ - struct bfq_sched_data *my_sched_data; -+ /* the scheduler queue this entity belongs to */ - struct bfq_sched_data *sched_data; - -+ /* flag, set to request a weight, ioprio or ioprio_class change */ - int prio_changed; - }; - -@@ -175,56 +188,6 @@ struct bfq_group; - - /** - * struct bfq_queue - leaf schedulable entity. -- * @ref: reference counter. -- * @bfqd: parent bfq_data. -- * @new_ioprio: when an ioprio change is requested, the new ioprio value. -- * @ioprio_class: the ioprio_class in use. -- * @new_ioprio_class: when an ioprio_class change is requested, the new -- * ioprio_class value. -- * @new_bfqq: shared bfq_queue if queue is cooperating with -- * one or more other queues. -- * @pos_node: request-position tree member (see bfq_group's @rq_pos_tree). -- * @pos_root: request-position tree root (see bfq_group's @rq_pos_tree). -- * @sort_list: sorted list of pending requests. -- * @next_rq: if fifo isn't expired, next request to serve. -- * @queued: nr of requests queued in @sort_list. -- * @allocated: currently allocated requests. -- * @meta_pending: pending metadata requests. -- * @fifo: fifo list of requests in sort_list. -- * @entity: entity representing this queue in the scheduler. -- * @max_budget: maximum budget allowed from the feedback mechanism. -- * @budget_timeout: budget expiration (in jiffies). -- * @dispatched: number of requests on the dispatch list or inside driver. -- * @flags: status flags. -- * @bfqq_list: node for active/idle bfqq list inside our bfqd. -- * @burst_list_node: node for the device's burst list. -- * @seek_samples: number of seeks sampled -- * @seek_total: sum of the distances of the seeks sampled -- * @seek_mean: mean seek distance -- * @last_request_pos: position of the last request enqueued -- * @requests_within_timer: number of consecutive pairs of request completion -- * and arrival, such that the queue becomes idle -- * after the completion, but the next request arrives -- * within an idle time slice; used only if the queue's -- * IO_bound has been cleared. -- * @pid: pid of the process owning the queue, used for logging purposes. -- * @last_wr_start_finish: start time of the current weight-raising period if -- * the @bfq-queue is being weight-raised, otherwise -- * finish time of the last weight-raising period -- * @wr_cur_max_time: current max raising time for this queue -- * @soft_rt_next_start: minimum time instant such that, only if a new -- * request is enqueued after this time instant in an -- * idle @bfq_queue with no outstanding requests, then -- * the task associated with the queue it is deemed as -- * soft real-time (see the comments to the function -- * bfq_bfqq_softrt_next_start()) -- * @last_idle_bklogged: time of the last transition of the @bfq_queue from -- * idle to backlogged -- * @service_from_backlogged: cumulative service received from the @bfq_queue -- * since the last transition from idle to -- * backlogged -- * @bic: pointer to the bfq_io_cq owning the bfq_queue, set to %NULL if the -- * queue is shared - * - * A bfq_queue is a leaf request queue; it can be associated with an - * io_context or more, if it is async or shared between cooperating -@@ -235,117 +198,175 @@ struct bfq_group; - * All the fields are protected by the queue lock of the containing bfqd. - */ - struct bfq_queue { -- atomic_t ref; -+ /* reference counter */ -+ int ref; -+ /* parent bfq_data */ - struct bfq_data *bfqd; - -- unsigned short ioprio, new_ioprio; -- unsigned short ioprio_class, new_ioprio_class; -+ /* current ioprio and ioprio class */ -+ unsigned short ioprio, ioprio_class; -+ /* next ioprio and ioprio class if a change is in progress */ -+ unsigned short new_ioprio, new_ioprio_class; - -- /* fields for cooperating queues handling */ -+ /* -+ * Shared bfq_queue if queue is cooperating with one or more -+ * other queues. -+ */ - struct bfq_queue *new_bfqq; -+ /* request-position tree member (see bfq_group's @rq_pos_tree) */ - struct rb_node pos_node; -+ /* request-position tree root (see bfq_group's @rq_pos_tree) */ - struct rb_root *pos_root; - -+ /* sorted list of pending requests */ - struct rb_root sort_list; -+ /* if fifo isn't expired, next request to serve */ - struct request *next_rq; -+ /* number of sync and async requests queued */ - int queued[2]; -+ /* number of sync and async requests currently allocated */ - int allocated[2]; -+ /* number of pending metadata requests */ - int meta_pending; -+ /* fifo list of requests in sort_list */ - struct list_head fifo; - -+ /* entity representing this queue in the scheduler */ - struct bfq_entity entity; - -+ /* maximum budget allowed from the feedback mechanism */ - int max_budget; -+ /* budget expiration (in jiffies) */ - unsigned long budget_timeout; - -+ /* number of requests on the dispatch list or inside driver */ - int dispatched; - -- unsigned int flags; -+ unsigned int flags; /* status flags.*/ - -+ /* node for active/idle bfqq list inside parent bfqd */ - struct list_head bfqq_list; - -+ /* bit vector: a 1 for each seeky requests in history */ -+ u32 seek_history; -+ -+ /* node for the device's burst list */ - struct hlist_node burst_list_node; - -- unsigned int seek_samples; -- u64 seek_total; -- sector_t seek_mean; -+ /* position of the last request enqueued */ - sector_t last_request_pos; - -+ /* Number of consecutive pairs of request completion and -+ * arrival, such that the queue becomes idle after the -+ * completion, but the next request arrives within an idle -+ * time slice; used only if the queue's IO_bound flag has been -+ * cleared. -+ */ - unsigned int requests_within_timer; - -+ /* pid of the process owning the queue, used for logging purposes */ - pid_t pid; -+ -+ /* -+ * Pointer to the bfq_io_cq owning the bfq_queue, set to %NULL -+ * if the queue is shared. -+ */ - struct bfq_io_cq *bic; - -- /* weight-raising fields */ -+ /* current maximum weight-raising time for this queue */ - unsigned long wr_cur_max_time; -+ /* -+ * Minimum time instant such that, only if a new request is -+ * enqueued after this time instant in an idle @bfq_queue with -+ * no outstanding requests, then the task associated with the -+ * queue it is deemed as soft real-time (see the comments on -+ * the function bfq_bfqq_softrt_next_start()) -+ */ - unsigned long soft_rt_next_start; -+ /* -+ * Start time of the current weight-raising period if -+ * the @bfq-queue is being weight-raised, otherwise -+ * finish time of the last weight-raising period. -+ */ - unsigned long last_wr_start_finish; -+ /* factor by which the weight of this queue is multiplied */ - unsigned int wr_coeff; -+ /* -+ * Time of the last transition of the @bfq_queue from idle to -+ * backlogged. -+ */ - unsigned long last_idle_bklogged; -+ /* -+ * Cumulative service received from the @bfq_queue since the -+ * last transition from idle to backlogged. -+ */ - unsigned long service_from_backlogged; -+ /* -+ * Value of wr start time when switching to soft rt -+ */ -+ unsigned long wr_start_at_switch_to_srt; -+ -+ unsigned long split_time; /* time of last split */ - }; - - /** - * struct bfq_ttime - per process thinktime stats. -- * @ttime_total: total process thinktime -- * @ttime_samples: number of thinktime samples -- * @ttime_mean: average process thinktime - */ - struct bfq_ttime { -- unsigned long last_end_request; -+ u64 last_end_request; /* completion time of last request */ -+ -+ u64 ttime_total; /* total process thinktime */ -+ unsigned long ttime_samples; /* number of thinktime samples */ -+ u64 ttime_mean; /* average process thinktime */ - -- unsigned long ttime_total; -- unsigned long ttime_samples; -- unsigned long ttime_mean; - }; - - /** - * struct bfq_io_cq - per (request_queue, io_context) structure. -- * @icq: associated io_cq structure -- * @bfqq: array of two process queues, the sync and the async -- * @ttime: associated @bfq_ttime struct -- * @ioprio: per (request_queue, blkcg) ioprio. -- * @blkcg_id: id of the blkcg the related io_cq belongs to. -- * @wr_time_left: snapshot of the time left before weight raising ends -- * for the sync queue associated to this process; this -- * snapshot is taken to remember this value while the weight -- * raising is suspended because the queue is merged with a -- * shared queue, and is used to set @raising_cur_max_time -- * when the queue is split from the shared queue and its -- * weight is raised again -- * @saved_idle_window: same purpose as the previous field for the idle -- * window -- * @saved_IO_bound: same purpose as the previous two fields for the I/O -- * bound classification of a queue -- * @saved_in_large_burst: same purpose as the previous fields for the -- * value of the field keeping the queue's belonging -- * to a large burst -- * @was_in_burst_list: true if the queue belonged to a burst list -- * before its merge with another cooperating queue -- * @cooperations: counter of consecutive successful queue merges underwent -- * by any of the process' @bfq_queues -- * @failed_cooperations: counter of consecutive failed queue merges of any -- * of the process' @bfq_queues - */ - struct bfq_io_cq { -+ /* associated io_cq structure */ - struct io_cq icq; /* must be the first member */ -+ /* array of two process queues, the sync and the async */ - struct bfq_queue *bfqq[2]; -+ /* associated @bfq_ttime struct */ - struct bfq_ttime ttime; -+ /* per (request_queue, blkcg) ioprio */ - int ioprio; -- - #ifdef CONFIG_BFQ_GROUP_IOSCHED -- uint64_t blkcg_id; /* the current blkcg ID */ -+ uint64_t blkcg_serial_nr; /* the current blkcg serial */ - #endif - -- unsigned int wr_time_left; -+ /* -+ * Snapshot of the idle window before merging; taken to -+ * remember this value while the queue is merged, so as to be -+ * able to restore it in case of split. -+ */ - bool saved_idle_window; -+ /* -+ * Same purpose as the previous two fields for the I/O bound -+ * classification of a queue. -+ */ - bool saved_IO_bound; - -+ /* -+ * Same purpose as the previous fields for the value of the -+ * field keeping the queue's belonging to a large burst -+ */ - bool saved_in_large_burst; -+ /* -+ * True if the queue belonged to a burst list before its merge -+ * with another cooperating queue. -+ */ - bool was_in_burst_list; - -- unsigned int cooperations; -- unsigned int failed_cooperations; -+ /* -+ * Similar to previous fields: save wr information. -+ */ -+ unsigned long saved_wr_coeff; -+ unsigned long saved_last_wr_start_finish; -+ unsigned long saved_wr_start_at_switch_to_srt; -+ unsigned int saved_wr_cur_max_time; - }; - - enum bfq_device_speed { -@@ -354,224 +375,232 @@ enum bfq_device_speed { - }; - - /** -- * struct bfq_data - per device data structure. -- * @queue: request queue for the managed device. -- * @root_group: root bfq_group for the device. -- * @active_numerous_groups: number of bfq_groups containing more than one -- * active @bfq_entity. -- * @queue_weights_tree: rbtree of weight counters of @bfq_queues, sorted by -- * weight. Used to keep track of whether all @bfq_queues -- * have the same weight. The tree contains one counter -- * for each distinct weight associated to some active -- * and not weight-raised @bfq_queue (see the comments to -- * the functions bfq_weights_tree_[add|remove] for -- * further details). -- * @group_weights_tree: rbtree of non-queue @bfq_entity weight counters, sorted -- * by weight. Used to keep track of whether all -- * @bfq_groups have the same weight. The tree contains -- * one counter for each distinct weight associated to -- * some active @bfq_group (see the comments to the -- * functions bfq_weights_tree_[add|remove] for further -- * details). -- * @busy_queues: number of bfq_queues containing requests (including the -- * queue in service, even if it is idling). -- * @busy_in_flight_queues: number of @bfq_queues containing pending or -- * in-flight requests, plus the @bfq_queue in -- * service, even if idle but waiting for the -- * possible arrival of its next sync request. This -- * field is updated only if the device is rotational, -- * but used only if the device is also NCQ-capable. -- * The reason why the field is updated also for non- -- * NCQ-capable rotational devices is related to the -- * fact that the value of @hw_tag may be set also -- * later than when busy_in_flight_queues may need to -- * be incremented for the first time(s). Taking also -- * this possibility into account, to avoid unbalanced -- * increments/decrements, would imply more overhead -- * than just updating busy_in_flight_queues -- * regardless of the value of @hw_tag. -- * @const_seeky_busy_in_flight_queues: number of constantly-seeky @bfq_queues -- * (that is, seeky queues that expired -- * for budget timeout at least once) -- * containing pending or in-flight -- * requests, including the in-service -- * @bfq_queue if constantly seeky. This -- * field is updated only if the device -- * is rotational, but used only if the -- * device is also NCQ-capable (see the -- * comments to @busy_in_flight_queues). -- * @wr_busy_queues: number of weight-raised busy @bfq_queues. -- * @queued: number of queued requests. -- * @rq_in_driver: number of requests dispatched and waiting for completion. -- * @sync_flight: number of sync requests in the driver. -- * @max_rq_in_driver: max number of reqs in driver in the last -- * @hw_tag_samples completed requests. -- * @hw_tag_samples: nr of samples used to calculate hw_tag. -- * @hw_tag: flag set to one if the driver is showing a queueing behavior. -- * @budgets_assigned: number of budgets assigned. -- * @idle_slice_timer: timer set when idling for the next sequential request -- * from the queue in service. -- * @unplug_work: delayed work to restart dispatching on the request queue. -- * @in_service_queue: bfq_queue in service. -- * @in_service_bic: bfq_io_cq (bic) associated with the @in_service_queue. -- * @last_position: on-disk position of the last served request. -- * @last_budget_start: beginning of the last budget. -- * @last_idling_start: beginning of the last idle slice. -- * @peak_rate: peak transfer rate observed for a budget. -- * @peak_rate_samples: number of samples used to calculate @peak_rate. -- * @bfq_max_budget: maximum budget allotted to a bfq_queue before -- * rescheduling. -- * @active_list: list of all the bfq_queues active on the device. -- * @idle_list: list of all the bfq_queues idle on the device. -- * @bfq_fifo_expire: timeout for async/sync requests; when it expires -- * requests are served in fifo order. -- * @bfq_back_penalty: weight of backward seeks wrt forward ones. -- * @bfq_back_max: maximum allowed backward seek. -- * @bfq_slice_idle: maximum idling time. -- * @bfq_user_max_budget: user-configured max budget value -- * (0 for auto-tuning). -- * @bfq_max_budget_async_rq: maximum budget (in nr of requests) allotted to -- * async queues. -- * @bfq_timeout: timeout for bfq_queues to consume their budget; used to -- * to prevent seeky queues to impose long latencies to well -- * behaved ones (this also implies that seeky queues cannot -- * receive guarantees in the service domain; after a timeout -- * they are charged for the whole allocated budget, to try -- * to preserve a behavior reasonably fair among them, but -- * without service-domain guarantees). -- * @bfq_coop_thresh: number of queue merges after which a @bfq_queue is -- * no more granted any weight-raising. -- * @bfq_failed_cooperations: number of consecutive failed cooperation -- * chances after which weight-raising is restored -- * to a queue subject to more than bfq_coop_thresh -- * queue merges. -- * @bfq_requests_within_timer: number of consecutive requests that must be -- * issued within the idle time slice to set -- * again idling to a queue which was marked as -- * non-I/O-bound (see the definition of the -- * IO_bound flag for further details). -- * @last_ins_in_burst: last time at which a queue entered the current -- * burst of queues being activated shortly after -- * each other; for more details about this and the -- * following parameters related to a burst of -- * activations, see the comments to the function -- * @bfq_handle_burst. -- * @bfq_burst_interval: reference time interval used to decide whether a -- * queue has been activated shortly after -- * @last_ins_in_burst. -- * @burst_size: number of queues in the current burst of queue activations. -- * @bfq_large_burst_thresh: maximum burst size above which the current -- * queue-activation burst is deemed as 'large'. -- * @large_burst: true if a large queue-activation burst is in progress. -- * @burst_list: head of the burst list (as for the above fields, more details -- * in the comments to the function bfq_handle_burst). -- * @low_latency: if set to true, low-latency heuristics are enabled. -- * @bfq_wr_coeff: maximum factor by which the weight of a weight-raised -- * queue is multiplied. -- * @bfq_wr_max_time: maximum duration of a weight-raising period (jiffies). -- * @bfq_wr_rt_max_time: maximum duration for soft real-time processes. -- * @bfq_wr_min_idle_time: minimum idle period after which weight-raising -- * may be reactivated for a queue (in jiffies). -- * @bfq_wr_min_inter_arr_async: minimum period between request arrivals -- * after which weight-raising may be -- * reactivated for an already busy queue -- * (in jiffies). -- * @bfq_wr_max_softrt_rate: max service-rate for a soft real-time queue, -- * sectors per seconds. -- * @RT_prod: cached value of the product R*T used for computing the maximum -- * duration of the weight raising automatically. -- * @device_speed: device-speed class for the low-latency heuristic. -- * @oom_bfqq: fallback dummy bfqq for extreme OOM conditions. -+ * struct bfq_data - per-device data structure. - * - * All the fields are protected by the @queue lock. - */ - struct bfq_data { -+ /* request queue for the device */ - struct request_queue *queue; - -+ /* root bfq_group for the device */ - struct bfq_group *root_group; - --#ifdef CONFIG_BFQ_GROUP_IOSCHED -- int active_numerous_groups; --#endif -- -+ /* -+ * rbtree of weight counters of @bfq_queues, sorted by -+ * weight. Used to keep track of whether all @bfq_queues have -+ * the same weight. The tree contains one counter for each -+ * distinct weight associated to some active and not -+ * weight-raised @bfq_queue (see the comments to the functions -+ * bfq_weights_tree_[add|remove] for further details). -+ */ - struct rb_root queue_weights_tree; -+ /* -+ * rbtree of non-queue @bfq_entity weight counters, sorted by -+ * weight. Used to keep track of whether all @bfq_groups have -+ * the same weight. The tree contains one counter for each -+ * distinct weight associated to some active @bfq_group (see -+ * the comments to the functions bfq_weights_tree_[add|remove] -+ * for further details). -+ */ - struct rb_root group_weights_tree; - -+ /* -+ * Number of bfq_queues containing requests (including the -+ * queue in service, even if it is idling). -+ */ - int busy_queues; -- int busy_in_flight_queues; -- int const_seeky_busy_in_flight_queues; -+ /* number of weight-raised busy @bfq_queues */ - int wr_busy_queues; -+ /* number of queued requests */ - int queued; -+ /* number of requests dispatched and waiting for completion */ - int rq_in_driver; -- int sync_flight; - -+ /* -+ * Maximum number of requests in driver in the last -+ * @hw_tag_samples completed requests. -+ */ - int max_rq_in_driver; -+ /* number of samples used to calculate hw_tag */ - int hw_tag_samples; -+ /* flag set to one if the driver is showing a queueing behavior */ - int hw_tag; - -+ /* number of budgets assigned */ - int budgets_assigned; - -- struct timer_list idle_slice_timer; -+ /* -+ * Timer set when idling (waiting) for the next request from -+ * the queue in service. -+ */ -+ struct hrtimer idle_slice_timer; -+ /* delayed work to restart dispatching on the request queue */ - struct work_struct unplug_work; - -+ /* bfq_queue in service */ - struct bfq_queue *in_service_queue; -+ /* bfq_io_cq (bic) associated with the @in_service_queue */ - struct bfq_io_cq *in_service_bic; - -+ /* on-disk position of the last served request */ - sector_t last_position; - -+ /* time of last request completion (ns) */ -+ u64 last_completion; -+ -+ /* time of first rq dispatch in current observation interval (ns) */ -+ u64 first_dispatch; -+ /* time of last rq dispatch in current observation interval (ns) */ -+ u64 last_dispatch; -+ -+ /* beginning of the last budget */ - ktime_t last_budget_start; -+ /* beginning of the last idle slice */ - ktime_t last_idling_start; -+ -+ /* number of samples in current observation interval */ - int peak_rate_samples; -- u64 peak_rate; -+ /* num of samples of seq dispatches in current observation interval */ -+ u32 sequential_samples; -+ /* total num of sectors transferred in current observation interval */ -+ u64 tot_sectors_dispatched; -+ /* max rq size seen during current observation interval (sectors) */ -+ u32 last_rq_max_size; -+ /* time elapsed from first dispatch in current observ. interval (us) */ -+ u64 delta_from_first; -+ /* current estimate of device peak rate */ -+ u32 peak_rate; -+ -+ /* maximum budget allotted to a bfq_queue before rescheduling */ - int bfq_max_budget; - -+ /* list of all the bfq_queues active on the device */ - struct list_head active_list; -+ /* list of all the bfq_queues idle on the device */ - struct list_head idle_list; - -- unsigned int bfq_fifo_expire[2]; -+ /* -+ * Timeout for async/sync requests; when it fires, requests -+ * are served in fifo order. -+ */ -+ u64 bfq_fifo_expire[2]; -+ /* weight of backward seeks wrt forward ones */ - unsigned int bfq_back_penalty; -+ /* maximum allowed backward seek */ - unsigned int bfq_back_max; -- unsigned int bfq_slice_idle; -- u64 bfq_class_idle_last_service; -+ /* maximum idling time */ -+ u32 bfq_slice_idle; - -+ /* user-configured max budget value (0 for auto-tuning) */ - int bfq_user_max_budget; -- int bfq_max_budget_async_rq; -- unsigned int bfq_timeout[2]; -- -- unsigned int bfq_coop_thresh; -- unsigned int bfq_failed_cooperations; -+ /* -+ * Timeout for bfq_queues to consume their budget; used to -+ * prevent seeky queues from imposing long latencies to -+ * sequential or quasi-sequential ones (this also implies that -+ * seeky queues cannot receive guarantees in the service -+ * domain; after a timeout they are charged for the time they -+ * have been in service, to preserve fairness among them, but -+ * without service-domain guarantees). -+ */ -+ unsigned int bfq_timeout; -+ -+ /* -+ * Number of consecutive requests that must be issued within -+ * the idle time slice to set again idling to a queue which -+ * was marked as non-I/O-bound (see the definition of the -+ * IO_bound flag for further details). -+ */ - unsigned int bfq_requests_within_timer; - -+ /* -+ * Force device idling whenever needed to provide accurate -+ * service guarantees, without caring about throughput -+ * issues. CAVEAT: this may even increase latencies, in case -+ * of useless idling for processes that did stop doing I/O. -+ */ -+ bool strict_guarantees; -+ -+ /* -+ * Last time at which a queue entered the current burst of -+ * queues being activated shortly after each other; for more -+ * details about this and the following parameters related to -+ * a burst of activations, see the comments on the function -+ * bfq_handle_burst. -+ */ - unsigned long last_ins_in_burst; -+ /* -+ * Reference time interval used to decide whether a queue has -+ * been activated shortly after @last_ins_in_burst. -+ */ - unsigned long bfq_burst_interval; -+ /* number of queues in the current burst of queue activations */ - int burst_size; -+ -+ /* common parent entity for the queues in the burst */ -+ struct bfq_entity *burst_parent_entity; -+ /* Maximum burst size above which the current queue-activation -+ * burst is deemed as 'large'. -+ */ - unsigned long bfq_large_burst_thresh; -+ /* true if a large queue-activation burst is in progress */ - bool large_burst; -+ /* -+ * Head of the burst list (as for the above fields, more -+ * details in the comments on the function bfq_handle_burst). -+ */ - struct hlist_head burst_list; - -+ /* if set to true, low-latency heuristics are enabled */ - bool low_latency; -- -- /* parameters of the low_latency heuristics */ -+ /* -+ * Maximum factor by which the weight of a weight-raised queue -+ * is multiplied. -+ */ - unsigned int bfq_wr_coeff; -+ /* maximum duration of a weight-raising period (jiffies) */ - unsigned int bfq_wr_max_time; -+ -+ /* Maximum weight-raising duration for soft real-time processes */ - unsigned int bfq_wr_rt_max_time; -+ /* -+ * Minimum idle period after which weight-raising may be -+ * reactivated for a queue (in jiffies). -+ */ - unsigned int bfq_wr_min_idle_time; -+ /* -+ * Minimum period between request arrivals after which -+ * weight-raising may be reactivated for an already busy async -+ * queue (in jiffies). -+ */ - unsigned long bfq_wr_min_inter_arr_async; -+ -+ /* Max service-rate for a soft real-time queue, in sectors/sec */ - unsigned int bfq_wr_max_softrt_rate; -+ /* -+ * Cached value of the product R*T, used for computing the -+ * maximum duration of weight raising automatically. -+ */ - u64 RT_prod; -+ /* device-speed class for the low-latency heuristic */ - enum bfq_device_speed device_speed; - -+ /* fallback dummy bfqq for extreme OOM conditions */ - struct bfq_queue oom_bfqq; - }; - - enum bfqq_state_flags { -- BFQ_BFQQ_FLAG_busy = 0, /* has requests or is in service */ -+ BFQ_BFQQ_FLAG_just_created = 0, /* queue just allocated */ -+ BFQ_BFQQ_FLAG_busy, /* has requests or is in service */ - BFQ_BFQQ_FLAG_wait_request, /* waiting for a request */ -+ BFQ_BFQQ_FLAG_non_blocking_wait_rq, /* -+ * waiting for a request -+ * without idling the device -+ */ - BFQ_BFQQ_FLAG_must_alloc, /* must be allowed rq alloc */ - BFQ_BFQQ_FLAG_fifo_expire, /* FIFO checked in this slice */ - BFQ_BFQQ_FLAG_idle_window, /* slice idling enabled */ - BFQ_BFQQ_FLAG_sync, /* synchronous queue */ -- BFQ_BFQQ_FLAG_budget_new, /* no completion with this budget */ - BFQ_BFQQ_FLAG_IO_bound, /* - * bfqq has timed-out at least once - * having consumed at most 2/10 of -@@ -581,17 +610,12 @@ enum bfqq_state_flags { - * bfqq activated in a large burst, - * see comments to bfq_handle_burst. - */ -- BFQ_BFQQ_FLAG_constantly_seeky, /* -- * bfqq has proved to be slow and -- * seeky until budget timeout -- */ - BFQ_BFQQ_FLAG_softrt_update, /* - * may need softrt-next-start - * update - */ - BFQ_BFQQ_FLAG_coop, /* bfqq is shared */ -- BFQ_BFQQ_FLAG_split_coop, /* shared bfqq will be split */ -- BFQ_BFQQ_FLAG_just_split, /* queue has just been split */ -+ BFQ_BFQQ_FLAG_split_coop /* shared bfqq will be split */ - }; - - #define BFQ_BFQQ_FNS(name) \ -@@ -608,28 +632,94 @@ static int bfq_bfqq_##name(const struct bfq_queue *bfqq) \ - return ((bfqq)->flags & (1 << BFQ_BFQQ_FLAG_##name)) != 0; \ - } - -+BFQ_BFQQ_FNS(just_created); - BFQ_BFQQ_FNS(busy); - BFQ_BFQQ_FNS(wait_request); -+BFQ_BFQQ_FNS(non_blocking_wait_rq); - BFQ_BFQQ_FNS(must_alloc); - BFQ_BFQQ_FNS(fifo_expire); - BFQ_BFQQ_FNS(idle_window); - BFQ_BFQQ_FNS(sync); --BFQ_BFQQ_FNS(budget_new); - BFQ_BFQQ_FNS(IO_bound); - BFQ_BFQQ_FNS(in_large_burst); --BFQ_BFQQ_FNS(constantly_seeky); - BFQ_BFQQ_FNS(coop); - BFQ_BFQQ_FNS(split_coop); --BFQ_BFQQ_FNS(just_split); - BFQ_BFQQ_FNS(softrt_update); - #undef BFQ_BFQQ_FNS - - /* Logging facilities. */ --#define bfq_log_bfqq(bfqd, bfqq, fmt, args...) \ -- blk_add_trace_msg((bfqd)->queue, "bfq%d " fmt, (bfqq)->pid, ##args) -+#ifdef CONFIG_BFQ_REDIRECT_TO_CONSOLE -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+static struct bfq_group *bfqq_group(struct bfq_queue *bfqq); -+static struct blkcg_gq *bfqg_to_blkg(struct bfq_group *bfqg); -+ -+#define bfq_log_bfqq(bfqd, bfqq, fmt, args...) do { \ -+ char __pbuf[128]; \ -+ \ -+ assert_spin_locked((bfqd)->queue->queue_lock); \ -+ blkg_path(bfqg_to_blkg(bfqq_group(bfqq)), __pbuf, sizeof(__pbuf)); \ -+ pr_crit("bfq%d%c %s " fmt "\n", \ -+ (bfqq)->pid, \ -+ bfq_bfqq_sync((bfqq)) ? 'S' : 'A', \ -+ __pbuf, ##args); \ -+} while (0) -+ -+#define bfq_log_bfqg(bfqd, bfqg, fmt, args...) do { \ -+ char __pbuf[128]; \ -+ \ -+ blkg_path(bfqg_to_blkg(bfqg), __pbuf, sizeof(__pbuf)); \ -+ pr_crit("%s " fmt "\n", __pbuf, ##args); \ -+} while (0) -+ -+#else /* CONFIG_BFQ_GROUP_IOSCHED */ -+ -+#define bfq_log_bfqq(bfqd, bfqq, fmt, args...) \ -+ pr_crit("bfq%d%c " fmt "\n", (bfqq)->pid, \ -+ bfq_bfqq_sync((bfqq)) ? 'S' : 'A', \ -+ ##args) -+#define bfq_log_bfqg(bfqd, bfqg, fmt, args...) do {} while (0) -+ -+#endif /* CONFIG_BFQ_GROUP_IOSCHED */ -+ -+#define bfq_log(bfqd, fmt, args...) \ -+ pr_crit("bfq " fmt "\n", ##args) -+ -+#else /* CONFIG_BFQ_REDIRECT_TO_CONSOLE */ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+static struct bfq_group *bfqq_group(struct bfq_queue *bfqq); -+static struct blkcg_gq *bfqg_to_blkg(struct bfq_group *bfqg); -+ -+#define bfq_log_bfqq(bfqd, bfqq, fmt, args...) do { \ -+ char __pbuf[128]; \ -+ \ -+ assert_spin_locked((bfqd)->queue->queue_lock); \ -+ blkg_path(bfqg_to_blkg(bfqq_group(bfqq)), __pbuf, sizeof(__pbuf)); \ -+ blk_add_trace_msg((bfqd)->queue, "bfq%d%c %s " fmt, \ -+ (bfqq)->pid, \ -+ bfq_bfqq_sync((bfqq)) ? 'S' : 'A', \ -+ __pbuf, ##args); \ -+} while (0) -+ -+#define bfq_log_bfqg(bfqd, bfqg, fmt, args...) do { \ -+ char __pbuf[128]; \ -+ \ -+ blkg_path(bfqg_to_blkg(bfqg), __pbuf, sizeof(__pbuf)); \ -+ blk_add_trace_msg((bfqd)->queue, "%s " fmt, __pbuf, ##args); \ -+} while (0) -+ -+#else /* CONFIG_BFQ_GROUP_IOSCHED */ -+ -+#define bfq_log_bfqq(bfqd, bfqq, fmt, args...) \ -+ blk_add_trace_msg((bfqd)->queue, "bfq%d%c " fmt, (bfqq)->pid, \ -+ bfq_bfqq_sync((bfqq)) ? 'S' : 'A', \ -+ ##args) -+#define bfq_log_bfqg(bfqd, bfqg, fmt, args...) do {} while (0) -+ -+#endif /* CONFIG_BFQ_GROUP_IOSCHED */ - - #define bfq_log(bfqd, fmt, args...) \ - blk_add_trace_msg((bfqd)->queue, "bfq " fmt, ##args) -+#endif /* CONFIG_BFQ_REDIRECT_TO_CONSOLE */ - - /* Expiration reasons. */ - enum bfqq_expiration { -@@ -640,15 +730,12 @@ enum bfqq_expiration { - BFQ_BFQQ_BUDGET_TIMEOUT, /* budget took too long to be used */ - BFQ_BFQQ_BUDGET_EXHAUSTED, /* budget consumed */ - BFQ_BFQQ_NO_MORE_REQUESTS, /* the queue has no more requests */ -+ BFQ_BFQQ_PREEMPTED /* preemption in progress */ - }; - --#ifdef CONFIG_BFQ_GROUP_IOSCHED - - struct bfqg_stats { -- /* total bytes transferred */ -- struct blkg_rwstat service_bytes; -- /* total IOs serviced, post merge */ -- struct blkg_rwstat serviced; -+#ifdef CONFIG_BFQ_GROUP_IOSCHED - /* number of ios merged */ - struct blkg_rwstat merged; - /* total time spent on device in ns, may not be accurate w/ queueing */ -@@ -657,12 +744,8 @@ struct bfqg_stats { - struct blkg_rwstat wait_time; - /* number of IOs queued up */ - struct blkg_rwstat queued; -- /* total sectors transferred */ -- struct blkg_stat sectors; - /* total disk time and nr sectors dispatched by this group */ - struct blkg_stat time; -- /* time not charged to this cgroup */ -- struct blkg_stat unaccounted_time; - /* sum of number of ios queued across all samples */ - struct blkg_stat avg_queue_size_sum; - /* count of samples taken for average */ -@@ -680,8 +763,10 @@ struct bfqg_stats { - uint64_t start_idle_time; - uint64_t start_empty_time; - uint16_t flags; -+#endif - }; - -+#ifdef CONFIG_BFQ_GROUP_IOSCHED - /* - * struct bfq_group_data - per-blkcg storage for the blkio subsystem. - * -@@ -692,7 +777,7 @@ struct bfq_group_data { - /* must be the first member */ - struct blkcg_policy_data pd; - -- unsigned short weight; -+ unsigned int weight; - }; - - /** -@@ -712,7 +797,7 @@ struct bfq_group_data { - * unused for the root group. Used to know whether there - * are groups with more than one active @bfq_entity - * (see the comments to the function -- * bfq_bfqq_must_not_expire()). -+ * bfq_bfqq_may_idle()). - * @rq_pos_tree: rbtree sorted by next_request position, used when - * determining if two or more queues have interleaving - * requests (see bfq_find_close_cooperator()). -@@ -745,7 +830,6 @@ struct bfq_group { - struct rb_root rq_pos_tree; - - struct bfqg_stats stats; -- struct bfqg_stats dead_stats; /* stats pushed from dead children */ - }; - - #else -@@ -761,17 +845,38 @@ struct bfq_group { - - static struct bfq_queue *bfq_entity_to_bfqq(struct bfq_entity *entity); - -+static unsigned int bfq_class_idx(struct bfq_entity *entity) -+{ -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ -+ return bfqq ? bfqq->ioprio_class - 1 : -+ BFQ_DEFAULT_GRP_CLASS - 1; -+} -+ - static struct bfq_service_tree * - bfq_entity_service_tree(struct bfq_entity *entity) - { - struct bfq_sched_data *sched_data = entity->sched_data; - struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -- unsigned int idx = bfqq ? bfqq->ioprio_class - 1 : -- BFQ_DEFAULT_GRP_CLASS; -+ unsigned int idx = bfq_class_idx(entity); - - BUG_ON(idx >= BFQ_IOPRIO_CLASSES); - BUG_ON(sched_data == NULL); - -+ if (bfqq) -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "entity_service_tree %p %d", -+ sched_data->service_tree + idx, idx); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ else { -+ struct bfq_group *bfqg = -+ container_of(entity, struct bfq_group, entity); -+ -+ bfq_log_bfqg((struct bfq_data *)bfqg->bfqd, bfqg, -+ "entity_service_tree %p %d", -+ sched_data->service_tree + idx, idx); -+ } -+#endif - return sched_data->service_tree + idx; - } - -@@ -791,47 +896,6 @@ static struct bfq_data *bic_to_bfqd(struct bfq_io_cq *bic) - return bic->icq.q->elevator->elevator_data; - } - --/** -- * bfq_get_bfqd_locked - get a lock to a bfqd using a RCU protected pointer. -- * @ptr: a pointer to a bfqd. -- * @flags: storage for the flags to be saved. -- * -- * This function allows bfqg->bfqd to be protected by the -- * queue lock of the bfqd they reference; the pointer is dereferenced -- * under RCU, so the storage for bfqd is assured to be safe as long -- * as the RCU read side critical section does not end. After the -- * bfqd->queue->queue_lock is taken the pointer is rechecked, to be -- * sure that no other writer accessed it. If we raced with a writer, -- * the function returns NULL, with the queue unlocked, otherwise it -- * returns the dereferenced pointer, with the queue locked. -- */ --static struct bfq_data *bfq_get_bfqd_locked(void **ptr, unsigned long *flags) --{ -- struct bfq_data *bfqd; -- -- rcu_read_lock(); -- bfqd = rcu_dereference(*(struct bfq_data **)ptr); -- -- if (bfqd != NULL) { -- spin_lock_irqsave(bfqd->queue->queue_lock, *flags); -- if (ptr == NULL) -- printk(KERN_CRIT "get_bfqd_locked pointer NULL\n"); -- else if (*ptr == bfqd) -- goto out; -- spin_unlock_irqrestore(bfqd->queue->queue_lock, *flags); -- } -- -- bfqd = NULL; --out: -- rcu_read_unlock(); -- return bfqd; --} -- --static void bfq_put_bfqd_unlock(struct bfq_data *bfqd, unsigned long *flags) --{ -- spin_unlock_irqrestore(bfqd->queue->queue_lock, *flags); --} -- - #ifdef CONFIG_BFQ_GROUP_IOSCHED - - static struct bfq_group *bfq_bfqq_to_bfqg(struct bfq_queue *bfqq) -@@ -857,11 +921,13 @@ static void bfq_check_ioprio_change(struct bfq_io_cq *bic, struct bio *bio); - static void bfq_put_queue(struct bfq_queue *bfqq); - static void bfq_dispatch_insert(struct request_queue *q, struct request *rq); - static struct bfq_queue *bfq_get_queue(struct bfq_data *bfqd, -- struct bio *bio, int is_sync, -- struct bfq_io_cq *bic, gfp_t gfp_mask); -+ struct bio *bio, bool is_sync, -+ struct bfq_io_cq *bic); - static void bfq_end_wr_async_queues(struct bfq_data *bfqd, - struct bfq_group *bfqg); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED - static void bfq_put_async_queues(struct bfq_data *bfqd, struct bfq_group *bfqg); -+#endif - static void bfq_exit_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq); - - #endif /* _BFQ_H */ --- -2.10.0 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-add-Early-Queue-Merge-EQM-to-BFQ-v7r11-for.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-add-Early-Queue-Merge-EQM-to-BFQ-v7r11-for.patch deleted file mode 100644 index e3a09b34..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-add-Early-Queue-Merge-EQM-to-BFQ-v7r11-for.patch +++ /dev/null @@ -1,1101 +0,0 @@ -From 52135041a6bf118c80a6858f63aff70b325389c4 Mon Sep 17 00:00:00 2001 -From: Mauro Andreolini -Date: Sun, 6 Sep 2015 16:09:05 +0200 -Subject: [PATCH 3/4] block, bfq: add Early Queue Merge (EQM) to BFQ-v7r11 for - 4.5.0 - -A set of processes may happen to perform interleaved reads, i.e.,requests -whose union would give rise to a sequential read pattern. There are two -typical cases: in the first case, processes read fixed-size chunks of -data at a fixed distance from each other, while in the second case processes -may read variable-size chunks at variable distances. The latter case occurs -for example with QEMU, which splits the I/O generated by the guest into -multiple chunks, and lets these chunks be served by a pool of cooperating -processes, iteratively assigning the next chunk of I/O to the first -available process. CFQ uses actual queue merging for the first type of -rocesses, whereas it uses preemption to get a sequential read pattern out -of the read requests performed by the second type of processes. In the end -it uses two different mechanisms to achieve the same goal: boosting the -throughput with interleaved I/O. - -This patch introduces Early Queue Merge (EQM), a unified mechanism to get a -sequential read pattern with both types of processes. The main idea is -checking newly arrived requests against the next request of the active queue -both in case of actual request insert and in case of request merge. By doing -so, both the types of processes can be handled by just merging their queues. -EQM is then simpler and more compact than the pair of mechanisms used in -CFQ. - -Finally, EQM also preserves the typical low-latency properties of BFQ, by -properly restoring the weight-raising state of a queue when it gets back to -a non-merged state. - -Signed-off-by: Mauro Andreolini -Signed-off-by: Arianna Avanzini -Signed-off-by: Paolo Valente -Signed-off-by: Linus Walleij ---- - block/bfq-cgroup.c | 5 + - block/bfq-iosched.c | 685 +++++++++++++++++++++++++++++++++++++++++++++++++++- - block/bfq.h | 66 +++++ - 3 files changed, 743 insertions(+), 13 deletions(-) - -diff --git a/block/bfq-cgroup.c b/block/bfq-cgroup.c -index 8b08a57..0367996 100644 ---- a/block/bfq-cgroup.c -+++ b/block/bfq-cgroup.c -@@ -440,6 +440,7 @@ static void bfq_pd_init(struct blkg_policy_data *pd) - */ - bfqg->bfqd = bfqd; - bfqg->active_entities = 0; -+ bfqg->rq_pos_tree = RB_ROOT; - } - - static void bfq_pd_free(struct blkg_policy_data *pd) -@@ -533,6 +534,9 @@ static struct bfq_group *bfq_find_alloc_group(struct bfq_data *bfqd, - return bfqg; - } - -+static void bfq_pos_tree_add_move(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq); -+ - /** - * bfq_bfqq_move - migrate @bfqq to @bfqg. - * @bfqd: queue descriptor. -@@ -580,6 +584,7 @@ static void bfq_bfqq_move(struct bfq_data *bfqd, struct bfq_queue *bfqq, - bfqg_get(bfqg); - - if (busy) { -+ bfq_pos_tree_add_move(bfqd, bfqq); - if (resume) - bfq_activate_bfqq(bfqd, bfqq); - } -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 85e2169..cf3e9b1 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -295,6 +295,72 @@ static struct request *bfq_choose_req(struct bfq_data *bfqd, - } - } - -+static struct bfq_queue * -+bfq_rq_pos_tree_lookup(struct bfq_data *bfqd, struct rb_root *root, -+ sector_t sector, struct rb_node **ret_parent, -+ struct rb_node ***rb_link) -+{ -+ struct rb_node **p, *parent; -+ struct bfq_queue *bfqq = NULL; -+ -+ parent = NULL; -+ p = &root->rb_node; -+ while (*p) { -+ struct rb_node **n; -+ -+ parent = *p; -+ bfqq = rb_entry(parent, struct bfq_queue, pos_node); -+ -+ /* -+ * Sort strictly based on sector. Smallest to the left, -+ * largest to the right. -+ */ -+ if (sector > blk_rq_pos(bfqq->next_rq)) -+ n = &(*p)->rb_right; -+ else if (sector < blk_rq_pos(bfqq->next_rq)) -+ n = &(*p)->rb_left; -+ else -+ break; -+ p = n; -+ bfqq = NULL; -+ } -+ -+ *ret_parent = parent; -+ if (rb_link) -+ *rb_link = p; -+ -+ bfq_log(bfqd, "rq_pos_tree_lookup %llu: returning %d", -+ (unsigned long long) sector, -+ bfqq ? bfqq->pid : 0); -+ -+ return bfqq; -+} -+ -+static void bfq_pos_tree_add_move(struct bfq_data *bfqd, struct bfq_queue *bfqq) -+{ -+ struct rb_node **p, *parent; -+ struct bfq_queue *__bfqq; -+ -+ if (bfqq->pos_root) { -+ rb_erase(&bfqq->pos_node, bfqq->pos_root); -+ bfqq->pos_root = NULL; -+ } -+ -+ if (bfq_class_idle(bfqq)) -+ return; -+ if (!bfqq->next_rq) -+ return; -+ -+ bfqq->pos_root = &bfq_bfqq_to_bfqg(bfqq)->rq_pos_tree; -+ __bfqq = bfq_rq_pos_tree_lookup(bfqd, bfqq->pos_root, -+ blk_rq_pos(bfqq->next_rq), &parent, &p); -+ if (!__bfqq) { -+ rb_link_node(&bfqq->pos_node, parent, p); -+ rb_insert_color(&bfqq->pos_node, bfqq->pos_root); -+ } else -+ bfqq->pos_root = NULL; -+} -+ - /* - * Tell whether there are active queues or groups with differentiated weights. - */ -@@ -527,6 +593,57 @@ static unsigned int bfq_wr_duration(struct bfq_data *bfqd) - return dur; - } - -+static unsigned int bfq_bfqq_cooperations(struct bfq_queue *bfqq) -+{ -+ return bfqq->bic ? bfqq->bic->cooperations : 0; -+} -+ -+static void -+bfq_bfqq_resume_state(struct bfq_queue *bfqq, struct bfq_io_cq *bic) -+{ -+ if (bic->saved_idle_window) -+ bfq_mark_bfqq_idle_window(bfqq); -+ else -+ bfq_clear_bfqq_idle_window(bfqq); -+ if (bic->saved_IO_bound) -+ bfq_mark_bfqq_IO_bound(bfqq); -+ else -+ bfq_clear_bfqq_IO_bound(bfqq); -+ /* Assuming that the flag in_large_burst is already correctly set */ -+ if (bic->wr_time_left && bfqq->bfqd->low_latency && -+ !bfq_bfqq_in_large_burst(bfqq) && -+ bic->cooperations < bfqq->bfqd->bfq_coop_thresh) { -+ /* -+ * Start a weight raising period with the duration given by -+ * the raising_time_left snapshot. -+ */ -+ if (bfq_bfqq_busy(bfqq)) -+ bfqq->bfqd->wr_busy_queues++; -+ bfqq->wr_coeff = bfqq->bfqd->bfq_wr_coeff; -+ bfqq->wr_cur_max_time = bic->wr_time_left; -+ bfqq->last_wr_start_finish = jiffies; -+ bfqq->entity.prio_changed = 1; -+ } -+ /* -+ * Clear wr_time_left to prevent bfq_bfqq_save_state() from -+ * getting confused about the queue's need of a weight-raising -+ * period. -+ */ -+ bic->wr_time_left = 0; -+} -+ -+static int bfqq_process_refs(struct bfq_queue *bfqq) -+{ -+ int process_refs, io_refs; -+ -+ lockdep_assert_held(bfqq->bfqd->queue->queue_lock); -+ -+ io_refs = bfqq->allocated[READ] + bfqq->allocated[WRITE]; -+ process_refs = atomic_read(&bfqq->ref) - io_refs - bfqq->entity.on_st; -+ BUG_ON(process_refs < 0); -+ return process_refs; -+} -+ - /* Empty burst list and add just bfqq (see comments to bfq_handle_burst) */ - static void bfq_reset_burst_list(struct bfq_data *bfqd, struct bfq_queue *bfqq) - { -@@ -763,8 +880,14 @@ static void bfq_add_request(struct request *rq) - BUG_ON(!next_rq); - bfqq->next_rq = next_rq; - -+ /* -+ * Adjust priority tree position, if next_rq changes. -+ */ -+ if (prev != bfqq->next_rq) -+ bfq_pos_tree_add_move(bfqd, bfqq); -+ - if (!bfq_bfqq_busy(bfqq)) { -- bool soft_rt, in_burst, -+ bool soft_rt, coop_or_in_burst, - idle_for_long_time = time_is_before_jiffies( - bfqq->budget_timeout + - bfqd->bfq_wr_min_idle_time); -@@ -792,11 +915,12 @@ static void bfq_add_request(struct request *rq) - bfqd->last_ins_in_burst = jiffies; - } - -- in_burst = bfq_bfqq_in_large_burst(bfqq); -+ coop_or_in_burst = bfq_bfqq_in_large_burst(bfqq) || -+ bfq_bfqq_cooperations(bfqq) >= bfqd->bfq_coop_thresh; - soft_rt = bfqd->bfq_wr_max_softrt_rate > 0 && -- !in_burst && -+ !coop_or_in_burst && - time_is_before_jiffies(bfqq->soft_rt_next_start); -- interactive = !in_burst && idle_for_long_time; -+ interactive = !coop_or_in_burst && idle_for_long_time; - entity->budget = max_t(unsigned long, bfqq->max_budget, - bfq_serv_to_charge(next_rq, bfqq)); - -@@ -815,6 +939,9 @@ static void bfq_add_request(struct request *rq) - if (!bfqd->low_latency) - goto add_bfqq_busy; - -+ if (bfq_bfqq_just_split(bfqq)) -+ goto set_prio_changed; -+ - /* - * If the queue: - * - is not being boosted, -@@ -839,7 +966,7 @@ static void bfq_add_request(struct request *rq) - } else if (old_wr_coeff > 1) { - if (interactive) - bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); -- else if (in_burst || -+ else if (coop_or_in_burst || - (bfqq->wr_cur_max_time == - bfqd->bfq_wr_rt_max_time && - !soft_rt)) { -@@ -904,6 +1031,7 @@ static void bfq_add_request(struct request *rq) - bfqd->bfq_wr_rt_max_time; - } - } -+set_prio_changed: - if (old_wr_coeff != bfqq->wr_coeff) - entity->prio_changed = 1; - add_bfqq_busy: -@@ -1046,6 +1174,15 @@ static void bfq_merged_request(struct request_queue *q, struct request *req, - bfqd->last_position); - BUG_ON(!next_rq); - bfqq->next_rq = next_rq; -+ /* -+ * If next_rq changes, update both the queue's budget to -+ * fit the new request and the queue's position in its -+ * rq_pos_tree. -+ */ -+ if (prev != bfqq->next_rq) { -+ bfq_updated_next_req(bfqd, bfqq); -+ bfq_pos_tree_add_move(bfqd, bfqq); -+ } - } - } - -@@ -1128,11 +1265,346 @@ static void bfq_end_wr(struct bfq_data *bfqd) - spin_unlock_irq(bfqd->queue->queue_lock); - } - -+static sector_t bfq_io_struct_pos(void *io_struct, bool request) -+{ -+ if (request) -+ return blk_rq_pos(io_struct); -+ else -+ return ((struct bio *)io_struct)->bi_iter.bi_sector; -+} -+ -+static int bfq_rq_close_to_sector(void *io_struct, bool request, -+ sector_t sector) -+{ -+ return abs(bfq_io_struct_pos(io_struct, request) - sector) <= -+ BFQQ_SEEK_THR; -+} -+ -+static struct bfq_queue *bfqq_find_close(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq, -+ sector_t sector) -+{ -+ struct rb_root *root = &bfq_bfqq_to_bfqg(bfqq)->rq_pos_tree; -+ struct rb_node *parent, *node; -+ struct bfq_queue *__bfqq; -+ -+ if (RB_EMPTY_ROOT(root)) -+ return NULL; -+ -+ /* -+ * First, if we find a request starting at the end of the last -+ * request, choose it. -+ */ -+ __bfqq = bfq_rq_pos_tree_lookup(bfqd, root, sector, &parent, NULL); -+ if (__bfqq) -+ return __bfqq; -+ -+ /* -+ * If the exact sector wasn't found, the parent of the NULL leaf -+ * will contain the closest sector (rq_pos_tree sorted by -+ * next_request position). -+ */ -+ __bfqq = rb_entry(parent, struct bfq_queue, pos_node); -+ if (bfq_rq_close_to_sector(__bfqq->next_rq, true, sector)) -+ return __bfqq; -+ -+ if (blk_rq_pos(__bfqq->next_rq) < sector) -+ node = rb_next(&__bfqq->pos_node); -+ else -+ node = rb_prev(&__bfqq->pos_node); -+ if (!node) -+ return NULL; -+ -+ __bfqq = rb_entry(node, struct bfq_queue, pos_node); -+ if (bfq_rq_close_to_sector(__bfqq->next_rq, true, sector)) -+ return __bfqq; -+ -+ return NULL; -+} -+ -+static struct bfq_queue *bfq_find_close_cooperator(struct bfq_data *bfqd, -+ struct bfq_queue *cur_bfqq, -+ sector_t sector) -+{ -+ struct bfq_queue *bfqq; -+ -+ /* -+ * We shall notice if some of the queues are cooperating, -+ * e.g., working closely on the same area of the device. In -+ * that case, we can group them together and: 1) don't waste -+ * time idling, and 2) serve the union of their requests in -+ * the best possible order for throughput. -+ */ -+ bfqq = bfqq_find_close(bfqd, cur_bfqq, sector); -+ if (!bfqq || bfqq == cur_bfqq) -+ return NULL; -+ -+ return bfqq; -+} -+ -+static struct bfq_queue * -+bfq_setup_merge(struct bfq_queue *bfqq, struct bfq_queue *new_bfqq) -+{ -+ int process_refs, new_process_refs; -+ struct bfq_queue *__bfqq; -+ -+ /* -+ * If there are no process references on the new_bfqq, then it is -+ * unsafe to follow the ->new_bfqq chain as other bfqq's in the chain -+ * may have dropped their last reference (not just their last process -+ * reference). -+ */ -+ if (!bfqq_process_refs(new_bfqq)) -+ return NULL; -+ -+ /* Avoid a circular list and skip interim queue merges. */ -+ while ((__bfqq = new_bfqq->new_bfqq)) { -+ if (__bfqq == bfqq) -+ return NULL; -+ new_bfqq = __bfqq; -+ } -+ -+ process_refs = bfqq_process_refs(bfqq); -+ new_process_refs = bfqq_process_refs(new_bfqq); -+ /* -+ * If the process for the bfqq has gone away, there is no -+ * sense in merging the queues. -+ */ -+ if (process_refs == 0 || new_process_refs == 0) -+ return NULL; -+ -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "scheduling merge with queue %d", -+ new_bfqq->pid); -+ -+ /* -+ * Merging is just a redirection: the requests of the process -+ * owning one of the two queues are redirected to the other queue. -+ * The latter queue, in its turn, is set as shared if this is the -+ * first time that the requests of some process are redirected to -+ * it. -+ * -+ * We redirect bfqq to new_bfqq and not the opposite, because we -+ * are in the context of the process owning bfqq, hence we have -+ * the io_cq of this process. So we can immediately configure this -+ * io_cq to redirect the requests of the process to new_bfqq. -+ * -+ * NOTE, even if new_bfqq coincides with the in-service queue, the -+ * io_cq of new_bfqq is not available, because, if the in-service -+ * queue is shared, bfqd->in_service_bic may not point to the -+ * io_cq of the in-service queue. -+ * Redirecting the requests of the process owning bfqq to the -+ * currently in-service queue is in any case the best option, as -+ * we feed the in-service queue with new requests close to the -+ * last request served and, by doing so, hopefully increase the -+ * throughput. -+ */ -+ bfqq->new_bfqq = new_bfqq; -+ atomic_add(process_refs, &new_bfqq->ref); -+ return new_bfqq; -+} -+ -+static bool bfq_may_be_close_cooperator(struct bfq_queue *bfqq, -+ struct bfq_queue *new_bfqq) -+{ -+ if (bfq_class_idle(bfqq) || bfq_class_idle(new_bfqq) || -+ (bfqq->ioprio_class != new_bfqq->ioprio_class)) -+ return false; -+ -+ /* -+ * If either of the queues has already been detected as seeky, -+ * then merging it with the other queue is unlikely to lead to -+ * sequential I/O. -+ */ -+ if (BFQQ_SEEKY(bfqq) || BFQQ_SEEKY(new_bfqq)) -+ return false; -+ -+ /* -+ * Interleaved I/O is known to be done by (some) applications -+ * only for reads, so it does not make sense to merge async -+ * queues. -+ */ -+ if (!bfq_bfqq_sync(bfqq) || !bfq_bfqq_sync(new_bfqq)) -+ return false; -+ -+ return true; -+} -+ -+/* -+ * Attempt to schedule a merge of bfqq with the currently in-service queue -+ * or with a close queue among the scheduled queues. -+ * Return NULL if no merge was scheduled, a pointer to the shared bfq_queue -+ * structure otherwise. -+ * -+ * The OOM queue is not allowed to participate to cooperation: in fact, since -+ * the requests temporarily redirected to the OOM queue could be redirected -+ * again to dedicated queues at any time, the state needed to correctly -+ * handle merging with the OOM queue would be quite complex and expensive -+ * to maintain. Besides, in such a critical condition as an out of memory, -+ * the benefits of queue merging may be little relevant, or even negligible. -+ */ -+static struct bfq_queue * -+bfq_setup_cooperator(struct bfq_data *bfqd, struct bfq_queue *bfqq, -+ void *io_struct, bool request) -+{ -+ struct bfq_queue *in_service_bfqq, *new_bfqq; -+ -+ if (bfqq->new_bfqq) -+ return bfqq->new_bfqq; -+ if (!io_struct || unlikely(bfqq == &bfqd->oom_bfqq)) -+ return NULL; -+ /* If device has only one backlogged bfq_queue, don't search. */ -+ if (bfqd->busy_queues == 1) -+ return NULL; -+ -+ in_service_bfqq = bfqd->in_service_queue; -+ -+ if (!in_service_bfqq || in_service_bfqq == bfqq || -+ !bfqd->in_service_bic || -+ unlikely(in_service_bfqq == &bfqd->oom_bfqq)) -+ goto check_scheduled; -+ -+ if (bfq_rq_close_to_sector(io_struct, request, bfqd->last_position) && -+ bfqq->entity.parent == in_service_bfqq->entity.parent && -+ bfq_may_be_close_cooperator(bfqq, in_service_bfqq)) { -+ new_bfqq = bfq_setup_merge(bfqq, in_service_bfqq); -+ if (new_bfqq) -+ return new_bfqq; -+ } -+ /* -+ * Check whether there is a cooperator among currently scheduled -+ * queues. The only thing we need is that the bio/request is not -+ * NULL, as we need it to establish whether a cooperator exists. -+ */ -+check_scheduled: -+ new_bfqq = bfq_find_close_cooperator(bfqd, bfqq, -+ bfq_io_struct_pos(io_struct, request)); -+ -+ BUG_ON(new_bfqq && bfqq->entity.parent != new_bfqq->entity.parent); -+ -+ if (new_bfqq && likely(new_bfqq != &bfqd->oom_bfqq) && -+ bfq_may_be_close_cooperator(bfqq, new_bfqq)) -+ return bfq_setup_merge(bfqq, new_bfqq); -+ -+ return NULL; -+} -+ -+static void bfq_bfqq_save_state(struct bfq_queue *bfqq) -+{ -+ /* -+ * If !bfqq->bic, the queue is already shared or its requests -+ * have already been redirected to a shared queue; both idle window -+ * and weight raising state have already been saved. Do nothing. -+ */ -+ if (!bfqq->bic) -+ return; -+ if (bfqq->bic->wr_time_left) -+ /* -+ * This is the queue of a just-started process, and would -+ * deserve weight raising: we set wr_time_left to the full -+ * weight-raising duration to trigger weight-raising when -+ * and if the queue is split and the first request of the -+ * queue is enqueued. -+ */ -+ bfqq->bic->wr_time_left = bfq_wr_duration(bfqq->bfqd); -+ else if (bfqq->wr_coeff > 1) { -+ unsigned long wr_duration = -+ jiffies - bfqq->last_wr_start_finish; -+ /* -+ * It may happen that a queue's weight raising period lasts -+ * longer than its wr_cur_max_time, as weight raising is -+ * handled only when a request is enqueued or dispatched (it -+ * does not use any timer). If the weight raising period is -+ * about to end, don't save it. -+ */ -+ if (bfqq->wr_cur_max_time <= wr_duration) -+ bfqq->bic->wr_time_left = 0; -+ else -+ bfqq->bic->wr_time_left = -+ bfqq->wr_cur_max_time - wr_duration; -+ /* -+ * The bfq_queue is becoming shared or the requests of the -+ * process owning the queue are being redirected to a shared -+ * queue. Stop the weight raising period of the queue, as in -+ * both cases it should not be owned by an interactive or -+ * soft real-time application. -+ */ -+ bfq_bfqq_end_wr(bfqq); -+ } else -+ bfqq->bic->wr_time_left = 0; -+ bfqq->bic->saved_idle_window = bfq_bfqq_idle_window(bfqq); -+ bfqq->bic->saved_IO_bound = bfq_bfqq_IO_bound(bfqq); -+ bfqq->bic->saved_in_large_burst = bfq_bfqq_in_large_burst(bfqq); -+ bfqq->bic->was_in_burst_list = !hlist_unhashed(&bfqq->burst_list_node); -+ bfqq->bic->cooperations++; -+ bfqq->bic->failed_cooperations = 0; -+} -+ -+static void bfq_get_bic_reference(struct bfq_queue *bfqq) -+{ -+ /* -+ * If bfqq->bic has a non-NULL value, the bic to which it belongs -+ * is about to begin using a shared bfq_queue. -+ */ -+ if (bfqq->bic) -+ atomic_long_inc(&bfqq->bic->icq.ioc->refcount); -+} -+ -+static void -+bfq_merge_bfqqs(struct bfq_data *bfqd, struct bfq_io_cq *bic, -+ struct bfq_queue *bfqq, struct bfq_queue *new_bfqq) -+{ -+ bfq_log_bfqq(bfqd, bfqq, "merging with queue %lu", -+ (unsigned long) new_bfqq->pid); -+ /* Save weight raising and idle window of the merged queues */ -+ bfq_bfqq_save_state(bfqq); -+ bfq_bfqq_save_state(new_bfqq); -+ if (bfq_bfqq_IO_bound(bfqq)) -+ bfq_mark_bfqq_IO_bound(new_bfqq); -+ bfq_clear_bfqq_IO_bound(bfqq); -+ /* -+ * Grab a reference to the bic, to prevent it from being destroyed -+ * before being possibly touched by a bfq_split_bfqq(). -+ */ -+ bfq_get_bic_reference(bfqq); -+ bfq_get_bic_reference(new_bfqq); -+ /* -+ * Merge queues (that is, let bic redirect its requests to new_bfqq) -+ */ -+ bic_set_bfqq(bic, new_bfqq, 1); -+ bfq_mark_bfqq_coop(new_bfqq); -+ /* -+ * new_bfqq now belongs to at least two bics (it is a shared queue): -+ * set new_bfqq->bic to NULL. bfqq either: -+ * - does not belong to any bic any more, and hence bfqq->bic must -+ * be set to NULL, or -+ * - is a queue whose owning bics have already been redirected to a -+ * different queue, hence the queue is destined to not belong to -+ * any bic soon and bfqq->bic is already NULL (therefore the next -+ * assignment causes no harm). -+ */ -+ new_bfqq->bic = NULL; -+ bfqq->bic = NULL; -+ bfq_put_queue(bfqq); -+} -+ -+static void bfq_bfqq_increase_failed_cooperations(struct bfq_queue *bfqq) -+{ -+ struct bfq_io_cq *bic = bfqq->bic; -+ struct bfq_data *bfqd = bfqq->bfqd; -+ -+ if (bic && bfq_bfqq_cooperations(bfqq) >= bfqd->bfq_coop_thresh) { -+ bic->failed_cooperations++; -+ if (bic->failed_cooperations >= bfqd->bfq_failed_cooperations) -+ bic->cooperations = 0; -+ } -+} -+ - static int bfq_allow_merge(struct request_queue *q, struct request *rq, - struct bio *bio) - { - struct bfq_data *bfqd = q->elevator->elevator_data; - struct bfq_io_cq *bic; -+ struct bfq_queue *bfqq, *new_bfqq; - - /* - * Disallow merge of a sync bio into an async request. -@@ -1149,7 +1621,26 @@ static int bfq_allow_merge(struct request_queue *q, struct request *rq, - if (!bic) - return 0; - -- return bic_to_bfqq(bic, bfq_bio_sync(bio)) == RQ_BFQQ(rq); -+ bfqq = bic_to_bfqq(bic, bfq_bio_sync(bio)); -+ /* -+ * We take advantage of this function to perform an early merge -+ * of the queues of possible cooperating processes. -+ */ -+ if (bfqq) { -+ new_bfqq = bfq_setup_cooperator(bfqd, bfqq, bio, false); -+ if (new_bfqq) { -+ bfq_merge_bfqqs(bfqd, bic, bfqq, new_bfqq); -+ /* -+ * If we get here, the bio will be queued in the -+ * shared queue, i.e., new_bfqq, so use new_bfqq -+ * to decide whether bio and rq can be merged. -+ */ -+ bfqq = new_bfqq; -+ } else -+ bfq_bfqq_increase_failed_cooperations(bfqq); -+ } -+ -+ return bfqq == RQ_BFQQ(rq); - } - - static void __bfq_set_in_service_queue(struct bfq_data *bfqd, -@@ -1350,6 +1841,15 @@ static void __bfq_bfqq_expire(struct bfq_data *bfqd, struct bfq_queue *bfqq) - - __bfq_bfqd_reset_in_service(bfqd); - -+ /* -+ * If this bfqq is shared between multiple processes, check -+ * to make sure that those processes are still issuing I/Os -+ * within the mean seek distance. If not, it may be time to -+ * break the queues apart again. -+ */ -+ if (bfq_bfqq_coop(bfqq) && BFQQ_SEEKY(bfqq)) -+ bfq_mark_bfqq_split_coop(bfqq); -+ - if (RB_EMPTY_ROOT(&bfqq->sort_list)) { - /* - * Overloading budget_timeout field to store the time -@@ -1358,8 +1858,13 @@ static void __bfq_bfqq_expire(struct bfq_data *bfqd, struct bfq_queue *bfqq) - */ - bfqq->budget_timeout = jiffies; - bfq_del_bfqq_busy(bfqd, bfqq, 1); -- } else -+ } else { - bfq_activate_bfqq(bfqd, bfqq); -+ /* -+ * Resort priority tree of potential close cooperators. -+ */ -+ bfq_pos_tree_add_move(bfqd, bfqq); -+ } - } - - /** -@@ -2246,10 +2751,12 @@ static void bfq_update_wr_data(struct bfq_data *bfqd, struct bfq_queue *bfqq) - /* - * If the queue was activated in a burst, or - * too much time has elapsed from the beginning -- * of this weight-raising period, then end weight -- * raising. -+ * of this weight-raising period, or the queue has -+ * exceeded the acceptable number of cooperations, -+ * then end weight raising. - */ - if (bfq_bfqq_in_large_burst(bfqq) || -+ bfq_bfqq_cooperations(bfqq) >= bfqd->bfq_coop_thresh || - time_is_before_jiffies(bfqq->last_wr_start_finish + - bfqq->wr_cur_max_time)) { - bfqq->last_wr_start_finish = jiffies; -@@ -2478,6 +2985,25 @@ static void bfq_put_queue(struct bfq_queue *bfqq) - #endif - } - -+static void bfq_put_cooperator(struct bfq_queue *bfqq) -+{ -+ struct bfq_queue *__bfqq, *next; -+ -+ /* -+ * If this queue was scheduled to merge with another queue, be -+ * sure to drop the reference taken on that queue (and others in -+ * the merge chain). See bfq_setup_merge and bfq_merge_bfqqs. -+ */ -+ __bfqq = bfqq->new_bfqq; -+ while (__bfqq) { -+ if (__bfqq == bfqq) -+ break; -+ next = __bfqq->new_bfqq; -+ bfq_put_queue(__bfqq); -+ __bfqq = next; -+ } -+} -+ - static void bfq_exit_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq) - { - if (bfqq == bfqd->in_service_queue) { -@@ -2488,6 +3014,8 @@ static void bfq_exit_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq) - bfq_log_bfqq(bfqd, bfqq, "exit_bfqq: %p, %d", bfqq, - atomic_read(&bfqq->ref)); - -+ bfq_put_cooperator(bfqq); -+ - bfq_put_queue(bfqq); - } - -@@ -2496,6 +3024,25 @@ static void bfq_init_icq(struct io_cq *icq) - struct bfq_io_cq *bic = icq_to_bic(icq); - - bic->ttime.last_end_request = jiffies; -+ /* -+ * A newly created bic indicates that the process has just -+ * started doing I/O, and is probably mapping into memory its -+ * executable and libraries: it definitely needs weight raising. -+ * There is however the possibility that the process performs, -+ * for a while, I/O close to some other process. EQM intercepts -+ * this behavior and may merge the queue corresponding to the -+ * process with some other queue, BEFORE the weight of the queue -+ * is raised. Merged queues are not weight-raised (they are assumed -+ * to belong to processes that benefit only from high throughput). -+ * If the merge is basically the consequence of an accident, then -+ * the queue will be split soon and will get back its old weight. -+ * It is then important to write down somewhere that this queue -+ * does need weight raising, even if it did not make it to get its -+ * weight raised before being merged. To this purpose, we overload -+ * the field raising_time_left and assign 1 to it, to mark the queue -+ * as needing weight raising. -+ */ -+ bic->wr_time_left = 1; - } - - static void bfq_exit_icq(struct io_cq *icq) -@@ -2509,6 +3056,13 @@ static void bfq_exit_icq(struct io_cq *icq) - } - - if (bic->bfqq[BLK_RW_SYNC]) { -+ /* -+ * If the bic is using a shared queue, put the reference -+ * taken on the io_context when the bic started using a -+ * shared bfq_queue. -+ */ -+ if (bfq_bfqq_coop(bic->bfqq[BLK_RW_SYNC])) -+ put_io_context(icq->ioc); - bfq_exit_bfqq(bfqd, bic->bfqq[BLK_RW_SYNC]); - bic->bfqq[BLK_RW_SYNC] = NULL; - } -@@ -2814,6 +3368,10 @@ static void bfq_update_idle_window(struct bfq_data *bfqd, - if (!bfq_bfqq_sync(bfqq) || bfq_class_idle(bfqq)) - return; - -+ /* Idle window just restored, statistics are meaningless. */ -+ if (bfq_bfqq_just_split(bfqq)) -+ return; -+ - enable_idle = bfq_bfqq_idle_window(bfqq); - - if (atomic_read(&bic->icq.ioc->active_ref) == 0 || -@@ -2861,6 +3419,7 @@ static void bfq_rq_enqueued(struct bfq_data *bfqd, struct bfq_queue *bfqq, - if (bfqq->entity.service > bfq_max_budget(bfqd) / 8 || - !BFQQ_SEEKY(bfqq)) - bfq_update_idle_window(bfqd, bfqq, bic); -+ bfq_clear_bfqq_just_split(bfqq); - - bfq_log_bfqq(bfqd, bfqq, - "rq_enqueued: idle_window=%d (seeky %d, mean %llu)", -@@ -2925,12 +3484,47 @@ static void bfq_rq_enqueued(struct bfq_data *bfqd, struct bfq_queue *bfqq, - static void bfq_insert_request(struct request_queue *q, struct request *rq) - { - struct bfq_data *bfqd = q->elevator->elevator_data; -- struct bfq_queue *bfqq = RQ_BFQQ(rq); -+ struct bfq_queue *bfqq = RQ_BFQQ(rq), *new_bfqq; - - assert_spin_locked(bfqd->queue->queue_lock); - -+ /* -+ * An unplug may trigger a requeue of a request from the device -+ * driver: make sure we are in process context while trying to -+ * merge two bfq_queues. -+ */ -+ if (!in_interrupt()) { -+ new_bfqq = bfq_setup_cooperator(bfqd, bfqq, rq, true); -+ if (new_bfqq) { -+ if (bic_to_bfqq(RQ_BIC(rq), 1) != bfqq) -+ new_bfqq = bic_to_bfqq(RQ_BIC(rq), 1); -+ /* -+ * Release the request's reference to the old bfqq -+ * and make sure one is taken to the shared queue. -+ */ -+ new_bfqq->allocated[rq_data_dir(rq)]++; -+ bfqq->allocated[rq_data_dir(rq)]--; -+ atomic_inc(&new_bfqq->ref); -+ bfq_put_queue(bfqq); -+ if (bic_to_bfqq(RQ_BIC(rq), 1) == bfqq) -+ bfq_merge_bfqqs(bfqd, RQ_BIC(rq), -+ bfqq, new_bfqq); -+ rq->elv.priv[1] = new_bfqq; -+ bfqq = new_bfqq; -+ } else -+ bfq_bfqq_increase_failed_cooperations(bfqq); -+ } -+ - bfq_add_request(rq); - -+ /* -+ * Here a newly-created bfq_queue has already started a weight-raising -+ * period: clear raising_time_left to prevent bfq_bfqq_save_state() -+ * from assigning it a full weight-raising period. See the detailed -+ * comments about this field in bfq_init_icq(). -+ */ -+ if (bfqq->bic) -+ bfqq->bic->wr_time_left = 0; - rq->fifo_time = jiffies + bfqd->bfq_fifo_expire[rq_is_sync(rq)]; - list_add_tail(&rq->queuelist, &bfqq->fifo); - -@@ -3099,6 +3693,32 @@ static void bfq_put_request(struct request *rq) - } - - /* -+ * Returns NULL if a new bfqq should be allocated, or the old bfqq if this -+ * was the last process referring to said bfqq. -+ */ -+static struct bfq_queue * -+bfq_split_bfqq(struct bfq_io_cq *bic, struct bfq_queue *bfqq) -+{ -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "splitting queue"); -+ -+ put_io_context(bic->icq.ioc); -+ -+ if (bfqq_process_refs(bfqq) == 1) { -+ bfqq->pid = current->pid; -+ bfq_clear_bfqq_coop(bfqq); -+ bfq_clear_bfqq_split_coop(bfqq); -+ return bfqq; -+ } -+ -+ bic_set_bfqq(bic, NULL, 1); -+ -+ bfq_put_cooperator(bfqq); -+ -+ bfq_put_queue(bfqq); -+ return NULL; -+} -+ -+/* - * Allocate bfq data structures associated with this request. - */ - static int bfq_set_request(struct request_queue *q, struct request *rq, -@@ -3110,6 +3730,7 @@ static int bfq_set_request(struct request_queue *q, struct request *rq, - const int is_sync = rq_is_sync(rq); - struct bfq_queue *bfqq; - unsigned long flags; -+ bool split = false; - - might_sleep_if(gfpflags_allow_blocking(gfp_mask)); - -@@ -3122,15 +3743,30 @@ static int bfq_set_request(struct request_queue *q, struct request *rq, - - bfq_bic_update_cgroup(bic, bio); - -+new_queue: - bfqq = bic_to_bfqq(bic, is_sync); - if (!bfqq || bfqq == &bfqd->oom_bfqq) { - bfqq = bfq_get_queue(bfqd, bio, is_sync, bic, gfp_mask); - bic_set_bfqq(bic, bfqq, is_sync); -- if (is_sync) { -- if (bfqd->large_burst) -+ if (split && is_sync) { -+ if ((bic->was_in_burst_list && bfqd->large_burst) || -+ bic->saved_in_large_burst) - bfq_mark_bfqq_in_large_burst(bfqq); -- else -+ else { - bfq_clear_bfqq_in_large_burst(bfqq); -+ if (bic->was_in_burst_list) -+ hlist_add_head(&bfqq->burst_list_node, -+ &bfqd->burst_list); -+ } -+ } -+ } else { -+ /* If the queue was seeky for too long, break it apart. */ -+ if (bfq_bfqq_coop(bfqq) && bfq_bfqq_split_coop(bfqq)) { -+ bfq_log_bfqq(bfqd, bfqq, "breaking apart bfqq"); -+ bfqq = bfq_split_bfqq(bic, bfqq); -+ split = true; -+ if (!bfqq) -+ goto new_queue; - } - } - -@@ -3142,6 +3778,26 @@ static int bfq_set_request(struct request_queue *q, struct request *rq, - rq->elv.priv[0] = bic; - rq->elv.priv[1] = bfqq; - -+ /* -+ * If a bfq_queue has only one process reference, it is owned -+ * by only one bfq_io_cq: we can set the bic field of the -+ * bfq_queue to the address of that structure. Also, if the -+ * queue has just been split, mark a flag so that the -+ * information is available to the other scheduler hooks. -+ */ -+ if (likely(bfqq != &bfqd->oom_bfqq) && bfqq_process_refs(bfqq) == 1) { -+ bfqq->bic = bic; -+ if (split) { -+ bfq_mark_bfqq_just_split(bfqq); -+ /* -+ * If the queue has just been split from a shared -+ * queue, restore the idle window and the possible -+ * weight raising period. -+ */ -+ bfq_bfqq_resume_state(bfqq, bic); -+ } -+ } -+ - spin_unlock_irqrestore(q->queue_lock, flags); - - return 0; -@@ -3295,6 +3951,7 @@ static void bfq_init_root_group(struct bfq_group *root_group, - root_group->my_entity = NULL; - root_group->bfqd = bfqd; - #endif -+ root_group->rq_pos_tree = RB_ROOT; - for (i = 0; i < BFQ_IOPRIO_CLASSES; i++) - root_group->sched_data.service_tree[i] = BFQ_SERVICE_TREE_INIT; - } -@@ -3375,6 +4032,8 @@ static int bfq_init_queue(struct request_queue *q, struct elevator_type *e) - bfqd->bfq_timeout[BLK_RW_ASYNC] = bfq_timeout_async; - bfqd->bfq_timeout[BLK_RW_SYNC] = bfq_timeout_sync; - -+ bfqd->bfq_coop_thresh = 2; -+ bfqd->bfq_failed_cooperations = 7000; - bfqd->bfq_requests_within_timer = 120; - - bfqd->bfq_large_burst_thresh = 11; -diff --git a/block/bfq.h b/block/bfq.h -index 2bf54ae..fcce855 100644 ---- a/block/bfq.h -+++ b/block/bfq.h -@@ -183,6 +183,8 @@ struct bfq_group; - * ioprio_class value. - * @new_bfqq: shared bfq_queue if queue is cooperating with - * one or more other queues. -+ * @pos_node: request-position tree member (see bfq_group's @rq_pos_tree). -+ * @pos_root: request-position tree root (see bfq_group's @rq_pos_tree). - * @sort_list: sorted list of pending requests. - * @next_rq: if fifo isn't expired, next request to serve. - * @queued: nr of requests queued in @sort_list. -@@ -304,6 +306,26 @@ struct bfq_ttime { - * @ttime: associated @bfq_ttime struct - * @ioprio: per (request_queue, blkcg) ioprio. - * @blkcg_id: id of the blkcg the related io_cq belongs to. -+ * @wr_time_left: snapshot of the time left before weight raising ends -+ * for the sync queue associated to this process; this -+ * snapshot is taken to remember this value while the weight -+ * raising is suspended because the queue is merged with a -+ * shared queue, and is used to set @raising_cur_max_time -+ * when the queue is split from the shared queue and its -+ * weight is raised again -+ * @saved_idle_window: same purpose as the previous field for the idle -+ * window -+ * @saved_IO_bound: same purpose as the previous two fields for the I/O -+ * bound classification of a queue -+ * @saved_in_large_burst: same purpose as the previous fields for the -+ * value of the field keeping the queue's belonging -+ * to a large burst -+ * @was_in_burst_list: true if the queue belonged to a burst list -+ * before its merge with another cooperating queue -+ * @cooperations: counter of consecutive successful queue merges underwent -+ * by any of the process' @bfq_queues -+ * @failed_cooperations: counter of consecutive failed queue merges of any -+ * of the process' @bfq_queues - */ - struct bfq_io_cq { - struct io_cq icq; /* must be the first member */ -@@ -314,6 +336,16 @@ struct bfq_io_cq { - #ifdef CONFIG_BFQ_GROUP_IOSCHED - uint64_t blkcg_id; /* the current blkcg ID */ - #endif -+ -+ unsigned int wr_time_left; -+ bool saved_idle_window; -+ bool saved_IO_bound; -+ -+ bool saved_in_large_burst; -+ bool was_in_burst_list; -+ -+ unsigned int cooperations; -+ unsigned int failed_cooperations; - }; - - enum bfq_device_speed { -@@ -557,6 +589,9 @@ enum bfqq_state_flags { - * may need softrt-next-start - * update - */ -+ BFQ_BFQQ_FLAG_coop, /* bfqq is shared */ -+ BFQ_BFQQ_FLAG_split_coop, /* shared bfqq will be split */ -+ BFQ_BFQQ_FLAG_just_split, /* queue has just been split */ - }; - - #define BFQ_BFQQ_FNS(name) \ -@@ -583,6 +618,9 @@ BFQ_BFQQ_FNS(budget_new); - BFQ_BFQQ_FNS(IO_bound); - BFQ_BFQQ_FNS(in_large_burst); - BFQ_BFQQ_FNS(constantly_seeky); -+BFQ_BFQQ_FNS(coop); -+BFQ_BFQQ_FNS(split_coop); -+BFQ_BFQQ_FNS(just_split); - BFQ_BFQQ_FNS(softrt_update); - #undef BFQ_BFQQ_FNS - -@@ -675,6 +713,9 @@ struct bfq_group_data { - * are groups with more than one active @bfq_entity - * (see the comments to the function - * bfq_bfqq_must_not_expire()). -+ * @rq_pos_tree: rbtree sorted by next_request position, used when -+ * determining if two or more queues have interleaving -+ * requests (see bfq_find_close_cooperator()). - * - * Each (device, cgroup) pair has its own bfq_group, i.e., for each cgroup - * there is a set of bfq_groups, each one collecting the lower-level -@@ -701,6 +742,8 @@ struct bfq_group { - - int active_entities; - -+ struct rb_root rq_pos_tree; -+ - struct bfqg_stats stats; - struct bfqg_stats dead_stats; /* stats pushed from dead children */ - }; -@@ -711,6 +754,8 @@ struct bfq_group { - - struct bfq_queue *async_bfqq[2][IOPRIO_BE_NR]; - struct bfq_queue *async_idle_bfqq; -+ -+ struct rb_root rq_pos_tree; - }; - #endif - -@@ -787,6 +832,27 @@ static void bfq_put_bfqd_unlock(struct bfq_data *bfqd, unsigned long *flags) - spin_unlock_irqrestore(bfqd->queue->queue_lock, *flags); - } - -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ -+static struct bfq_group *bfq_bfqq_to_bfqg(struct bfq_queue *bfqq) -+{ -+ struct bfq_entity *group_entity = bfqq->entity.parent; -+ -+ if (!group_entity) -+ group_entity = &bfqq->bfqd->root_group->entity; -+ -+ return container_of(group_entity, struct bfq_group, entity); -+} -+ -+#else -+ -+static struct bfq_group *bfq_bfqq_to_bfqg(struct bfq_queue *bfqq) -+{ -+ return bfqq->bfqd->root_group; -+} -+ -+#endif -+ - static void bfq_check_ioprio_change(struct bfq_io_cq *bic, struct bio *bio); - static void bfq_put_queue(struct bfq_queue *bfqq); - static void bfq_dispatch_insert(struct request_queue *q, struct request *rq); --- -2.10.0 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-add-missing-invocations-of-bfqg_stats_upda.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-add-missing-invocations-of-bfqg_stats_upda.patch new file mode 100644 index 00000000..91c92f0b --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-add-missing-invocations-of-bfqg_stats_upda.patch @@ -0,0 +1,107 @@ +From 614822f81f606e0064acdae11d9ec1efd3db4190 Mon Sep 17 00:00:00 2001 +From: Luca Miccio +Date: Mon, 13 Nov 2017 07:34:08 +0100 +Subject: [PATCH] block, bfq: add missing invocations of + bfqg_stats_update_io_add/remove + +bfqg_stats_update_io_add and bfqg_stats_update_io_remove are to be +invoked, respectively, when an I/O request enters and when an I/O +request exits the scheduler. Unfortunately, bfq does not fully comply +with this scheme, because it does not invoke these functions for +requests that are inserted into or extracted from its priority +dispatch list. This commit fixes this mistake. + +Tested-by: Lee Tibbert +Tested-by: Oleksandr Natalenko +Signed-off-by: Paolo Valente +Signed-off-by: Luca Miccio +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 21 ++++++++++++++++++--- + 1 file changed, 18 insertions(+), 3 deletions(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 889a8549d97f..91703eba63f0 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -1359,7 +1359,6 @@ static void bfq_bfqq_handle_idle_busy_switch(struct bfq_data *bfqd, + bfqq->ttime.last_end_request + + bfqd->bfq_slice_idle * 3; + +- bfqg_stats_update_io_add(bfqq_group(RQ_BFQQ(rq)), bfqq, rq->cmd_flags); + + /* + * bfqq deserves to be weight-raised if: +@@ -1633,7 +1632,6 @@ static void bfq_remove_request(struct request_queue *q, + if (rq->cmd_flags & REQ_META) + bfqq->meta_pending--; + +- bfqg_stats_update_io_remove(bfqq_group(bfqq), rq->cmd_flags); + } + + static bool bfq_bio_merge(struct blk_mq_hw_ctx *hctx, struct bio *bio) +@@ -1746,6 +1744,7 @@ static void bfq_requests_merged(struct request_queue *q, struct request *rq, + bfqq->next_rq = rq; + + bfq_remove_request(q, next); ++ bfqg_stats_update_io_remove(bfqq_group(bfqq), next->cmd_flags); + + spin_unlock_irq(&bfqq->bfqd->lock); + end: +@@ -3700,6 +3699,9 @@ static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) + spin_lock_irq(&bfqd->lock); + + rq = __bfq_dispatch_request(hctx); ++ if (rq && RQ_BFQQ(rq)) ++ bfqg_stats_update_io_remove(bfqq_group(RQ_BFQQ(rq)), ++ rq->cmd_flags); + spin_unlock_irq(&bfqd->lock); + + return rq; +@@ -4224,6 +4226,7 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + { + struct request_queue *q = hctx->queue; + struct bfq_data *bfqd = q->elevator->elevator_data; ++ struct bfq_queue *bfqq = RQ_BFQQ(rq); + + spin_lock_irq(&bfqd->lock); + if (blk_mq_sched_try_insert_merge(q, rq)) { +@@ -4243,6 +4246,12 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + list_add_tail(&rq->queuelist, &bfqd->dispatch); + } else { + __bfq_insert_request(bfqd, rq); ++ /* ++ * Update bfqq, because, if a queue merge has occurred ++ * in __bfq_insert_request, then rq has been ++ * redirected into a new queue. ++ */ ++ bfqq = RQ_BFQQ(rq); + + if (rq_mergeable(rq)) { + elv_rqhash_add(q, rq); +@@ -4251,6 +4260,9 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + } + } + ++ if (bfqq) ++ bfqg_stats_update_io_add(bfqq_group(bfqq), bfqq, rq->cmd_flags); ++ + spin_unlock_irq(&bfqd->lock); + } + +@@ -4428,8 +4440,11 @@ static void bfq_finish_request(struct request *rq) + * lock is held. + */ + +- if (!RB_EMPTY_NODE(&rq->rb_node)) ++ if (!RB_EMPTY_NODE(&rq->rb_node)) { + bfq_remove_request(rq->q, rq); ++ bfqg_stats_update_io_remove(bfqq_group(bfqq), ++ rq->cmd_flags); ++ } + bfq_put_rq_priv_body(bfqq); + } + +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-add-missing-rq_pos_tree-update-on-rq-remov.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-add-missing-rq_pos_tree-update-on-rq-remov.patch new file mode 100644 index 00000000..addcb7ac --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-add-missing-rq_pos_tree-update-on-rq-remov.patch @@ -0,0 +1,41 @@ +From 05e90283561648301e30232fe0c91bd345ceba03 Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Wed, 20 Dec 2017 12:38:31 +0100 +Subject: [PATCH] block, bfq: add missing rq_pos_tree update on rq removal + +If two processes do I/O close to each other, then BFQ merges the +bfq_queues associated with these processes, to get a more sequential +I/O, and thus a higher throughput. In this respect, to detect whether +two processes are doing I/O close to each other, BFQ keeps a list of +the head-of-line I/O requests of all active bfq_queues. The list is +ordered by initial sectors, and implemented through a red-black tree +(rq_pos_tree). + +Unfortunately, the update of the rq_pos_tree was incomplete, because +the tree was not updated on the removal of the head-of-line I/O +request of a bfq_queue, in case the queue did not remain empty. This +commit adds the missing update. + +Signed-off-by: Paolo Valente +Signed-off-by: Angelo Ruocco +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 2 ++ + 1 file changed, 2 insertions(+) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 0f48583b9380..fa395a260a23 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -1627,6 +1627,8 @@ static void bfq_remove_request(struct request_queue *q, + rb_erase(&bfqq->pos_node, bfqq->pos_root); + bfqq->pos_root = NULL; + } ++ } else { ++ bfq_pos_tree_add_move(bfqd, bfqq); + } + + if (rq->cmd_flags & REQ_META) +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-add-requeue-request-hook.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-add-requeue-request-hook.patch new file mode 100644 index 00000000..c963b98f --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-add-requeue-request-hook.patch @@ -0,0 +1,224 @@ +From a7877390614770965a6925dfed79cbd3eeeb61e0 Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Wed, 7 Feb 2018 22:19:20 +0100 +Subject: [PATCH] block, bfq: add requeue-request hook + +Commit 'a6a252e64914 ("blk-mq-sched: decide how to handle flush rq via +RQF_FLUSH_SEQ")' makes all non-flush re-prepared requests for a device +be re-inserted into the active I/O scheduler for that device. As a +consequence, I/O schedulers may get the same request inserted again, +even several times, without a finish_request invoked on that request +before each re-insertion. + +This fact is the cause of the failure reported in [1]. For an I/O +scheduler, every re-insertion of the same re-prepared request is +equivalent to the insertion of a new request. For schedulers like +mq-deadline or kyber, this fact causes no harm. In contrast, it +confuses a stateful scheduler like BFQ, which keeps state for an I/O +request, until the finish_request hook is invoked on the request. In +particular, BFQ may get stuck, waiting forever for the number of +request dispatches, of the same request, to be balanced by an equal +number of request completions (while there will be one completion for +that request). In this state, BFQ may refuse to serve I/O requests +from other bfq_queues. The hang reported in [1] then follows. + +However, the above re-prepared requests undergo a requeue, thus the +requeue_request hook of the active elevator is invoked for these +requests, if set. This commit then addresses the above issue by +properly implementing the hook requeue_request in BFQ. + +[1] https://marc.info/?l=linux-block&m=151211117608676 + +Reported-by: Ivan Kozik +Reported-by: Alban Browaeys +Tested-by: Mike Galbraith +Signed-off-by: Paolo Valente +Signed-off-by: Serena Ziviani +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 107 ++++++++++++++++++++++++++++++++++++++++------------ + 1 file changed, 82 insertions(+), 25 deletions(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 47e6ec7427c4..aeca22d91101 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -3823,24 +3823,26 @@ static struct request *__bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) + } + + /* +- * We exploit the bfq_finish_request hook to decrement +- * rq_in_driver, but bfq_finish_request will not be +- * invoked on this request. So, to avoid unbalance, +- * just start this request, without incrementing +- * rq_in_driver. As a negative consequence, +- * rq_in_driver is deceptively lower than it should be +- * while this request is in service. This may cause +- * bfq_schedule_dispatch to be invoked uselessly. ++ * We exploit the bfq_finish_requeue_request hook to ++ * decrement rq_in_driver, but ++ * bfq_finish_requeue_request will not be invoked on ++ * this request. So, to avoid unbalance, just start ++ * this request, without incrementing rq_in_driver. As ++ * a negative consequence, rq_in_driver is deceptively ++ * lower than it should be while this request is in ++ * service. This may cause bfq_schedule_dispatch to be ++ * invoked uselessly. + * + * As for implementing an exact solution, the +- * bfq_finish_request hook, if defined, is probably +- * invoked also on this request. So, by exploiting +- * this hook, we could 1) increment rq_in_driver here, +- * and 2) decrement it in bfq_finish_request. Such a +- * solution would let the value of the counter be +- * always accurate, but it would entail using an extra +- * interface function. This cost seems higher than the +- * benefit, being the frequency of non-elevator-private ++ * bfq_finish_requeue_request hook, if defined, is ++ * probably invoked also on this request. So, by ++ * exploiting this hook, we could 1) increment ++ * rq_in_driver here, and 2) decrement it in ++ * bfq_finish_requeue_request. Such a solution would ++ * let the value of the counter be always accurate, ++ * but it would entail using an extra interface ++ * function. This cost seems higher than the benefit, ++ * being the frequency of non-elevator-private + * requests very low. + */ + goto start_rq; +@@ -4515,6 +4517,8 @@ static inline void bfq_update_insert_stats(struct request_queue *q, + unsigned int cmd_flags) {} + #endif + ++static void bfq_prepare_request(struct request *rq, struct bio *bio); ++ + static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + bool at_head) + { +@@ -4541,6 +4545,18 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + else + list_add_tail(&rq->queuelist, &bfqd->dispatch); + } else { ++ if (WARN_ON_ONCE(!bfqq)) { ++ /* ++ * This should never happen. Most likely rq is ++ * a requeued regular request, being ++ * re-inserted without being first ++ * re-prepared. Do a prepare, to avoid ++ * failure. ++ */ ++ bfq_prepare_request(rq, rq->bio); ++ bfqq = RQ_BFQQ(rq); ++ } ++ + idle_timer_disabled = __bfq_insert_request(bfqd, rq); + /* + * Update bfqq, because, if a queue merge has occurred +@@ -4697,22 +4713,44 @@ static void bfq_completed_request(struct bfq_queue *bfqq, struct bfq_data *bfqd) + bfq_schedule_dispatch(bfqd); + } + +-static void bfq_finish_request_body(struct bfq_queue *bfqq) ++static void bfq_finish_requeue_request_body(struct bfq_queue *bfqq) + { + bfqq->allocated--; + + bfq_put_queue(bfqq); + } + +-static void bfq_finish_request(struct request *rq) ++/* ++ * Handle either a requeue or a finish for rq. The things to do are ++ * the same in both cases: all references to rq are to be dropped. In ++ * particular, rq is considered completed from the point of view of ++ * the scheduler. ++ */ ++static void bfq_finish_requeue_request(struct request *rq) + { +- struct bfq_queue *bfqq; ++ struct bfq_queue *bfqq = RQ_BFQQ(rq); + struct bfq_data *bfqd; + +- if (!rq->elv.icq) ++ /* ++ * Requeue and finish hooks are invoked in blk-mq without ++ * checking whether the involved request is actually still ++ * referenced in the scheduler. To handle this fact, the ++ * following two checks make this function exit in case of ++ * spurious invocations, for which there is nothing to do. ++ * ++ * First, check whether rq has nothing to do with an elevator. ++ */ ++ if (unlikely(!(rq->rq_flags & RQF_ELVPRIV))) ++ return; ++ ++ /* ++ * rq either is not associated with any icq, or is an already ++ * requeued request that has not (yet) been re-inserted into ++ * a bfq_queue. ++ */ ++ if (!rq->elv.icq || !bfqq) + return; + +- bfqq = RQ_BFQQ(rq); + bfqd = bfqq->bfqd; + + if (rq->rq_flags & RQF_STARTED) +@@ -4727,13 +4765,14 @@ static void bfq_finish_request(struct request *rq) + spin_lock_irqsave(&bfqd->lock, flags); + + bfq_completed_request(bfqq, bfqd); +- bfq_finish_request_body(bfqq); ++ bfq_finish_requeue_request_body(bfqq); + + spin_unlock_irqrestore(&bfqd->lock, flags); + } else { + /* + * Request rq may be still/already in the scheduler, +- * in which case we need to remove it. And we cannot ++ * in which case we need to remove it (this should ++ * never happen in case of requeue). And we cannot + * defer such a check and removal, to avoid + * inconsistencies in the time interval from the end + * of this function to the start of the deferred work. +@@ -4748,9 +4787,26 @@ static void bfq_finish_request(struct request *rq) + bfqg_stats_update_io_remove(bfqq_group(bfqq), + rq->cmd_flags); + } +- bfq_finish_request_body(bfqq); ++ bfq_finish_requeue_request_body(bfqq); + } + ++ /* ++ * Reset private fields. In case of a requeue, this allows ++ * this function to correctly do nothing if it is spuriously ++ * invoked again on this same request (see the check at the ++ * beginning of the function). Probably, a better general ++ * design would be to prevent blk-mq from invoking the requeue ++ * or finish hooks of an elevator, for a request that is not ++ * referred by that elevator. ++ * ++ * Resetting the following fields would break the ++ * request-insertion logic if rq is re-inserted into a bfq ++ * internal queue, without a re-preparation. Here we assume ++ * that re-insertions of requeued requests, without ++ * re-preparation, can happen only for pass_through or at_head ++ * requests (which are not re-inserted into bfq internal ++ * queues). ++ */ + rq->elv.priv[0] = NULL; + rq->elv.priv[1] = NULL; + } +@@ -5426,7 +5482,8 @@ static struct elevator_type iosched_bfq_mq = { + .ops.mq = { + .limit_depth = bfq_limit_depth, + .prepare_request = bfq_prepare_request, +- .finish_request = bfq_finish_request, ++ .requeue_request = bfq_finish_requeue_request, ++ .finish_request = bfq_finish_requeue_request, + .exit_icq = bfq_exit_icq, + .insert_requests = bfq_insert_requests, + .dispatch_request = bfq_dispatch_request, +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-check-and-switch-back-to-interactive-wr-al.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-check-and-switch-back-to-interactive-wr-al.patch new file mode 100644 index 00000000..fa28c722 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-check-and-switch-back-to-interactive-wr-al.patch @@ -0,0 +1,163 @@ +From 3e2bdd6dff239afd8386e8758eee69ad61e5a3d6 Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Thu, 21 Sep 2017 11:04:01 +0200 +Subject: [PATCH] block, bfq: check and switch back to interactive wr also on + queue split + +As already explained in the message of commit "block, bfq: fix +wrong init of saved start time for weight raising", if a soft +real-time weight-raising period happens to be nested in a larger +interactive weight-raising period, then BFQ restores the interactive +weight raising at the end of the soft real-time weight raising. In +particular, BFQ checks whether the latter has ended only on request +dispatches. + +Unfortunately, the above scheme fails to restore interactive weight +raising in the following corner case: if a bfq_queue, say Q, +1) Is merged with another bfq_queue while it is in a nested soft +real-time weight-raising period. The weight-raising state of Q is +then saved, and not considered any longer until a split occurs. +2) Is split from the other bfq_queue(s) at a time instant when its +soft real-time weight raising is already finished. +On the split, while resuming the previous, soft real-time +weight-raised state of the bfq_queue Q, BFQ checks whether the +current soft real-time weight-raising period is actually over. If so, +BFQ switches weight raising off for Q, *without* checking whether the +soft real-time period was actually nested in a non-yet-finished +interactive weight-raising period. + +This commit addresses this issue by adding the above missing check in +bfq_queue splits, and restoring interactive weight raising if needed. + +Signed-off-by: Paolo Valente +Tested-by: Angelo Ruocco +Tested-by: Mirko Montanari +Tested-by: Oleksandr Natalenko +Tested-by: Lee Tibbert +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 87 ++++++++++++++++++++++++++++++----------------------- + 1 file changed, 49 insertions(+), 38 deletions(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index c25955c25e03..33b63bc4a64b 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -724,6 +724,44 @@ static void bfq_updated_next_req(struct bfq_data *bfqd, + } + } + ++static unsigned int bfq_wr_duration(struct bfq_data *bfqd) ++{ ++ u64 dur; ++ ++ if (bfqd->bfq_wr_max_time > 0) ++ return bfqd->bfq_wr_max_time; ++ ++ dur = bfqd->RT_prod; ++ do_div(dur, bfqd->peak_rate); ++ ++ /* ++ * Limit duration between 3 and 13 seconds. Tests show that ++ * higher values than 13 seconds often yield the opposite of ++ * the desired result, i.e., worsen responsiveness by letting ++ * non-interactive and non-soft-real-time applications ++ * preserve weight raising for a too long time interval. ++ * ++ * On the other end, lower values than 3 seconds make it ++ * difficult for most interactive tasks to complete their jobs ++ * before weight-raising finishes. ++ */ ++ if (dur > msecs_to_jiffies(13000)) ++ dur = msecs_to_jiffies(13000); ++ else if (dur < msecs_to_jiffies(3000)) ++ dur = msecs_to_jiffies(3000); ++ ++ return dur; ++} ++ ++/* switch back from soft real-time to interactive weight raising */ ++static void switch_back_to_interactive_wr(struct bfq_queue *bfqq, ++ struct bfq_data *bfqd) ++{ ++ bfqq->wr_coeff = bfqd->bfq_wr_coeff; ++ bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); ++ bfqq->last_wr_start_finish = bfqq->wr_start_at_switch_to_srt; ++} ++ + static void + bfq_bfqq_resume_state(struct bfq_queue *bfqq, struct bfq_data *bfqd, + struct bfq_io_cq *bic, bool bfq_already_existing) +@@ -750,10 +788,16 @@ bfq_bfqq_resume_state(struct bfq_queue *bfqq, struct bfq_data *bfqd, + if (bfqq->wr_coeff > 1 && (bfq_bfqq_in_large_burst(bfqq) || + time_is_before_jiffies(bfqq->last_wr_start_finish + + bfqq->wr_cur_max_time))) { +- bfq_log_bfqq(bfqq->bfqd, bfqq, +- "resume state: switching off wr"); +- +- bfqq->wr_coeff = 1; ++ if (bfqq->wr_cur_max_time == bfqd->bfq_wr_rt_max_time && ++ !bfq_bfqq_in_large_burst(bfqq) && ++ time_is_after_eq_jiffies(bfqq->wr_start_at_switch_to_srt + ++ bfq_wr_duration(bfqd))) { ++ switch_back_to_interactive_wr(bfqq, bfqd); ++ } else { ++ bfqq->wr_coeff = 1; ++ bfq_log_bfqq(bfqq->bfqd, bfqq, ++ "resume state: switching off wr"); ++ } + } + + /* make sure weight will be updated, however we got here */ +@@ -1173,35 +1217,6 @@ static bool bfq_bfqq_update_budg_for_activation(struct bfq_data *bfqd, + return wr_or_deserves_wr; + } + +-static unsigned int bfq_wr_duration(struct bfq_data *bfqd) +-{ +- u64 dur; +- +- if (bfqd->bfq_wr_max_time > 0) +- return bfqd->bfq_wr_max_time; +- +- dur = bfqd->RT_prod; +- do_div(dur, bfqd->peak_rate); +- +- /* +- * Limit duration between 3 and 13 seconds. Tests show that +- * higher values than 13 seconds often yield the opposite of +- * the desired result, i.e., worsen responsiveness by letting +- * non-interactive and non-soft-real-time applications +- * preserve weight raising for a too long time interval. +- * +- * On the other end, lower values than 3 seconds make it +- * difficult for most interactive tasks to complete their jobs +- * before weight-raising finishes. +- */ +- if (dur > msecs_to_jiffies(13000)) +- dur = msecs_to_jiffies(13000); +- else if (dur < msecs_to_jiffies(3000)) +- dur = msecs_to_jiffies(3000); +- +- return dur; +-} +- + /* + * Return the farthest future time instant according to jiffies + * macros. +@@ -3501,11 +3516,7 @@ static void bfq_update_wr_data(struct bfq_data *bfqd, struct bfq_queue *bfqq) + bfq_wr_duration(bfqd))) + bfq_bfqq_end_wr(bfqq); + else { +- /* switch back to interactive wr */ +- bfqq->wr_coeff = bfqd->bfq_wr_coeff; +- bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); +- bfqq->last_wr_start_finish = +- bfqq->wr_start_at_switch_to_srt; ++ switch_back_to_interactive_wr(bfqq, bfqd); + bfqq->entity.prio_changed = 1; + } + } +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-check-low_latency-flag-in-bfq_bfqq_save_st.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-check-low_latency-flag-in-bfq_bfqq_save_st.patch new file mode 100644 index 00000000..3bd4379c --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-check-low_latency-flag-in-bfq_bfqq_save_st.patch @@ -0,0 +1,48 @@ +From 1be6e8a964ee9aa8d4daac523ce29e5f486dd756 Mon Sep 17 00:00:00 2001 +From: Angelo Ruocco +Date: Wed, 20 Dec 2017 12:38:32 +0100 +Subject: [PATCH] block, bfq: check low_latency flag in bfq_bfqq_save_state() + +A just-created bfq_queue will certainly be deemed as interactive on +the arrival of its first I/O request, if the low_latency flag is +set. Yet, if the queue is merged with another queue on the arrival of +its first I/O request, it will not have the chance to be flagged as +interactive. Nevertheless, if the queue is then split soon enough, it +has to be flagged as interactive after the split. + +To handle this early-merge scenario correctly, BFQ saves the state of +the queue, on the merge, as if the latter had already been deemed +interactive. So, if the queue is split soon, it will get +weight-raised, because the previous state of the queue is resumed on +the split. + +Unfortunately, in the act of saving the state of the newly-created +queue, BFQ doesn't check whether the low_latency flag is set, and this +causes early-merged queues to be then weight-raised, on queue splits, +even if low_latency is off. This commit addresses this problem by +adding the missing check. + +Signed-off-by: Angelo Ruocco +Signed-off-by: Paolo Valente +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 3 ++- + 1 file changed, 2 insertions(+), 1 deletion(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index fa395a260a23..2cf395daee80 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -2064,7 +2064,8 @@ static void bfq_bfqq_save_state(struct bfq_queue *bfqq) + bic->saved_in_large_burst = bfq_bfqq_in_large_burst(bfqq); + bic->was_in_burst_list = !hlist_unhashed(&bfqq->burst_list_node); + if (unlikely(bfq_bfqq_just_created(bfqq) && +- !bfq_bfqq_in_large_burst(bfqq))) { ++ !bfq_bfqq_in_large_burst(bfqq) && ++ bfqq->bfqd->low_latency)) { + /* + * bfqq being merged right after being created: bfqq + * would have deserved interactive weight raising, but +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-consider-also-past-I-O-in-soft-real-time-d.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-consider-also-past-I-O-in-soft-real-time-d.patch new file mode 100644 index 00000000..987378a9 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-consider-also-past-I-O-in-soft-real-time-d.patch @@ -0,0 +1,206 @@ +From a34b024448eb71b0e51ad011fa1862236e366034 Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Fri, 15 Dec 2017 07:23:12 +0100 +Subject: [PATCH] block, bfq: consider also past I/O in soft real-time + detection + +BFQ privileges the I/O of soft real-time applications, such as video +players, to guarantee to these application a high bandwidth and a low +latency. In this respect, it is not easy to correctly detect when an +application is soft real-time. A particularly nasty false positive is +that of an I/O-bound application that occasionally happens to meet all +requirements to be deemed as soft real-time. After being detected as +soft real-time, such an application monopolizes the device. Fortunately, +BFQ will realize soon that the application is actually not soft +real-time and suspend every privilege. Yet, the application may happen +again to be wrongly detected as soft real-time, and so on. + +As highlighted by our tests, this problem causes BFQ to occasionally +fail to guarantee a high responsiveness, in the presence of heavy +background I/O workloads. The reason is that the background workload +happens to be detected as soft real-time, more or less frequently, +during the execution of the interactive task under test. To give an +idea, because of this problem, Libreoffice Writer occasionally takes 8 +seconds, instead of 3, to start up, if there are sequential reads and +writes in the background, on a Kingston SSDNow V300. + +This commit addresses this issue by leveraging the following facts. + +The reason why some applications are detected as soft real-time despite +all BFQ checks to avoid false positives, is simply that, during high +CPU or storage-device load, I/O-bound applications may happen to do +I/O slowly enough to meet all soft real-time requirements, and pass +all BFQ extra checks. Yet, this happens only for limited time periods: +slow-speed time intervals are usually interspersed between other time +intervals during which these applications do I/O at a very high speed. +To exploit these facts, this commit introduces a little change, in the +detection of soft real-time behavior, to systematically consider also +the recent past: the higher the speed was in the recent past, the +later next I/O should arrive for the application to be considered as +soft real-time. At the beginning of a slow-speed interval, the minimum +arrival time allowed for the next I/O usually happens to still be so +high, to fall *after* the end of the slow-speed period itself. As a +consequence, the application does not risk to be deemed as soft +real-time during the slow-speed interval. Then, during the next +high-speed interval, the application cannot, evidently, be deemed as +soft real-time (exactly because of its speed), and so on. + +This extra filtering proved to be rather effective: in the above test, +the frequency of false positives became so low that the start-up time +was 3 seconds in all iterations (apart from occasional outliers, +caused by page-cache-management issues, which are out of the scope of +this commit, and cannot be solved by an I/O scheduler). + +Tested-by: Lee Tibbert +Signed-off-by: Paolo Valente +Signed-off-by: Angelo Ruocco +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 115 ++++++++++++++++++++++++++++++++++++---------------- + 1 file changed, 81 insertions(+), 34 deletions(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 9625550b2f85..e33c5c4c9856 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -2940,45 +2940,87 @@ static bool bfq_bfqq_is_slow(struct bfq_data *bfqd, struct bfq_queue *bfqq, + * whereas soft_rt_next_start is set to infinity for applications that do + * not. + * +- * Unfortunately, even a greedy application may happen to behave in an +- * isochronous way if the CPU load is high. In fact, the application may +- * stop issuing requests while the CPUs are busy serving other processes, +- * then restart, then stop again for a while, and so on. In addition, if +- * the disk achieves a low enough throughput with the request pattern +- * issued by the application (e.g., because the request pattern is random +- * and/or the device is slow), then the application may meet the above +- * bandwidth requirement too. To prevent such a greedy application to be +- * deemed as soft real-time, a further rule is used in the computation of +- * soft_rt_next_start: soft_rt_next_start must be higher than the current +- * time plus the maximum time for which the arrival of a request is waited +- * for when a sync queue becomes idle, namely bfqd->bfq_slice_idle. +- * This filters out greedy applications, as the latter issue instead their +- * next request as soon as possible after the last one has been completed +- * (in contrast, when a batch of requests is completed, a soft real-time +- * application spends some time processing data). ++ * Unfortunately, even a greedy (i.e., I/O-bound) application may ++ * happen to meet, occasionally or systematically, both the above ++ * bandwidth and isochrony requirements. This may happen at least in ++ * the following circumstances. First, if the CPU load is high. The ++ * application may stop issuing requests while the CPUs are busy ++ * serving other processes, then restart, then stop again for a while, ++ * and so on. The other circumstances are related to the storage ++ * device: the storage device is highly loaded or reaches a low-enough ++ * throughput with the I/O of the application (e.g., because the I/O ++ * is random and/or the device is slow). In all these cases, the ++ * I/O of the application may be simply slowed down enough to meet ++ * the bandwidth and isochrony requirements. To reduce the probability ++ * that greedy applications are deemed as soft real-time in these ++ * corner cases, a further rule is used in the computation of ++ * soft_rt_next_start: the return value of this function is forced to ++ * be higher than the maximum between the following two quantities. + * +- * Unfortunately, the last filter may easily generate false positives if +- * only bfqd->bfq_slice_idle is used as a reference time interval and one +- * or both the following cases occur: +- * 1) HZ is so low that the duration of a jiffy is comparable to or higher +- * than bfqd->bfq_slice_idle. This happens, e.g., on slow devices with +- * HZ=100. ++ * (a) Current time plus: (1) the maximum time for which the arrival ++ * of a request is waited for when a sync queue becomes idle, ++ * namely bfqd->bfq_slice_idle, and (2) a few extra jiffies. We ++ * postpone for a moment the reason for adding a few extra ++ * jiffies; we get back to it after next item (b). Lower-bounding ++ * the return value of this function with the current time plus ++ * bfqd->bfq_slice_idle tends to filter out greedy applications, ++ * because the latter issue their next request as soon as possible ++ * after the last one has been completed. In contrast, a soft ++ * real-time application spends some time processing data, after a ++ * batch of its requests has been completed. ++ * ++ * (b) Current value of bfqq->soft_rt_next_start. As pointed out ++ * above, greedy applications may happen to meet both the ++ * bandwidth and isochrony requirements under heavy CPU or ++ * storage-device load. In more detail, in these scenarios, these ++ * applications happen, only for limited time periods, to do I/O ++ * slowly enough to meet all the requirements described so far, ++ * including the filtering in above item (a). These slow-speed ++ * time intervals are usually interspersed between other time ++ * intervals during which these applications do I/O at a very high ++ * speed. Fortunately, exactly because of the high speed of the ++ * I/O in the high-speed intervals, the values returned by this ++ * function happen to be so high, near the end of any such ++ * high-speed interval, to be likely to fall *after* the end of ++ * the low-speed time interval that follows. These high values are ++ * stored in bfqq->soft_rt_next_start after each invocation of ++ * this function. As a consequence, if the last value of ++ * bfqq->soft_rt_next_start is constantly used to lower-bound the ++ * next value that this function may return, then, from the very ++ * beginning of a low-speed interval, bfqq->soft_rt_next_start is ++ * likely to be constantly kept so high that any I/O request ++ * issued during the low-speed interval is considered as arriving ++ * to soon for the application to be deemed as soft ++ * real-time. Then, in the high-speed interval that follows, the ++ * application will not be deemed as soft real-time, just because ++ * it will do I/O at a high speed. And so on. ++ * ++ * Getting back to the filtering in item (a), in the following two ++ * cases this filtering might be easily passed by a greedy ++ * application, if the reference quantity was just ++ * bfqd->bfq_slice_idle: ++ * 1) HZ is so low that the duration of a jiffy is comparable to or ++ * higher than bfqd->bfq_slice_idle. This happens, e.g., on slow ++ * devices with HZ=100. The time granularity may be so coarse ++ * that the approximation, in jiffies, of bfqd->bfq_slice_idle ++ * is rather lower than the exact value. + * 2) jiffies, instead of increasing at a constant rate, may stop increasing + * for a while, then suddenly 'jump' by several units to recover the lost + * increments. This seems to happen, e.g., inside virtual machines. +- * To address this issue, we do not use as a reference time interval just +- * bfqd->bfq_slice_idle, but bfqd->bfq_slice_idle plus a few jiffies. In +- * particular we add the minimum number of jiffies for which the filter +- * seems to be quite precise also in embedded systems and KVM/QEMU virtual +- * machines. ++ * To address this issue, in the filtering in (a) we do not use as a ++ * reference time interval just bfqd->bfq_slice_idle, but ++ * bfqd->bfq_slice_idle plus a few jiffies. In particular, we add the ++ * minimum number of jiffies for which the filter seems to be quite ++ * precise also in embedded systems and KVM/QEMU virtual machines. + */ + static unsigned long bfq_bfqq_softrt_next_start(struct bfq_data *bfqd, + struct bfq_queue *bfqq) + { +- return max(bfqq->last_idle_bklogged + +- HZ * bfqq->service_from_backlogged / +- bfqd->bfq_wr_max_softrt_rate, +- jiffies + nsecs_to_jiffies(bfqq->bfqd->bfq_slice_idle) + 4); ++ return max3(bfqq->soft_rt_next_start, ++ bfqq->last_idle_bklogged + ++ HZ * bfqq->service_from_backlogged / ++ bfqd->bfq_wr_max_softrt_rate, ++ jiffies + nsecs_to_jiffies(bfqq->bfqd->bfq_slice_idle) + 4); + } + + /** +@@ -4014,10 +4056,15 @@ static void bfq_init_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq, + bfqq->split_time = bfq_smallest_from_now(); + + /* +- * Set to the value for which bfqq will not be deemed as +- * soft rt when it becomes backlogged. ++ * To not forget the possibly high bandwidth consumed by a ++ * process/queue in the recent past, ++ * bfq_bfqq_softrt_next_start() returns a value at least equal ++ * to the current value of bfqq->soft_rt_next_start (see ++ * comments on bfq_bfqq_softrt_next_start). Set ++ * soft_rt_next_start to now, to mean that bfqq has consumed ++ * no bandwidth so far. + */ +- bfqq->soft_rt_next_start = bfq_greatest_from_now(); ++ bfqq->soft_rt_next_start = jiffies; + + /* first request is almost certainly seeky */ + bfqq->seek_history = 1; +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-decrease-burst-size-when-queues-in-burst-e.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-decrease-burst-size-when-queues-in-burst-e.patch new file mode 100644 index 00000000..c799fe1e --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-decrease-burst-size-when-queues-in-burst-e.patch @@ -0,0 +1,82 @@ +From 7cb04004fa371a626c1a5ebe6d977f70285759ed Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Thu, 21 Sep 2017 11:04:03 +0200 +Subject: [PATCH] block, bfq: decrease burst size when queues in burst exit + +If many queues belonging to the same group happen to be created +shortly after each other, then the concurrent processes associated +with these queues have typically a common goal, and they get it done +as soon as possible if not hampered by device idling. Examples are +processes spawned by git grep, or by systemd during boot. As for +device idling, this mechanism is currently necessary for weight +raising to succeed in its goal: privileging I/O. In view of these +facts, BFQ does not provide the above queues with either weight +raising or device idling. + +On the other hand, a burst of queue creations may be caused also by +the start-up of a complex application. In this case, these queues need +usually to be served one after the other, and as quickly as possible, +to maximise responsiveness. Therefore, in this case the best strategy +is to weight-raise all the queues created during the burst, i.e., the +exact opposite of the strategy for the above case. + +To distinguish between the two cases, BFQ uses an empirical burst-size +threshold, found through extensive tests and monitoring of daily +usage. Only large bursts, i.e., burst with a size above this +threshold, are considered as generated by a high number of parallel +processes. In this respect, upstart-based boot proved to be rather +hard to detect as generating a large burst of queue creations, because +with upstart most of the queues created in a burst exit *before* the +next queues in the same burst are created. To address this issue, I +changed the burst-detection mechanism so as to not decrease the size +of the current burst even if one of the queues in the burst is +eliminated. + +Unfortunately, this missing decrease causes false positives on very +fast systems: on the start-up of a complex application, such as +libreoffice writer, so many queues are created, served and exited +shortly after each other, that a large burst of queue creations is +wrongly detected as occurring. These false positives just disappear if +the size of a burst is decreased when one of the queues in the burst +exits. This commit restores the missing burst-size decrease, relying +of the fact that upstart is apparently unlikely to be used on systems +running this and future versions of the kernel. + +Signed-off-by: Paolo Valente +Signed-off-by: Mauro Andreolini +Signed-off-by: Angelo Ruocco +Tested-by: Mirko Montanari +Tested-by: Oleksandr Natalenko +Tested-by: Lee Tibbert +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 12 +++--------- + 1 file changed, 3 insertions(+), 9 deletions(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 115747fe43c8..70f9177c4f5b 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -3725,16 +3725,10 @@ void bfq_put_queue(struct bfq_queue *bfqq) + if (bfqq->ref) + return; + +- if (bfq_bfqq_sync(bfqq)) +- /* +- * The fact that this queue is being destroyed does not +- * invalidate the fact that this queue may have been +- * activated during the current burst. As a consequence, +- * although the queue does not exist anymore, and hence +- * needs to be removed from the burst list if there, +- * the burst size has not to be decremented. +- */ ++ if (bfq_bfqq_sync(bfqq) && !hlist_unhashed(&bfqq->burst_list_node)) { + hlist_del_init(&bfqq->burst_list_node); ++ bfqq->bfqd->burst_size--; ++ } + + kmem_cache_free(bfq_pool, bfqq); + #ifdef CONFIG_BFQ_GROUP_IOSCHED +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-fix-occurrences-of-request-finish-method-s.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-fix-occurrences-of-request-finish-method-s.patch new file mode 100644 index 00000000..6c97a9d0 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-fix-occurrences-of-request-finish-method-s.patch @@ -0,0 +1,91 @@ +From 8993d445df388e3541f48920a2353cfc904b220a Mon Sep 17 00:00:00 2001 +From: Chiara Bruschi +Date: Mon, 18 Dec 2017 16:21:59 +0000 +Subject: [PATCH] block, bfq: fix occurrences of request finish method's old + name + +Commit '7b9e93616399' ("blk-mq-sched: unify request finished methods") +changed the old name of current bfq_finish_request method, but left it +unchanged elsewhere in the code (related comments, part of function +name bfq_put_rq_priv_body). + +This commit fixes all occurrences of the old name of this method by +changing them into the current name. + +Fixes: 7b9e93616399 ("blk-mq-sched: unify request finished methods") +Reviewed-by: Paolo Valente +Signed-off-by: Federico Motta +Signed-off-by: Chiara Bruschi +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 26 +++++++++++++------------- + 1 file changed, 13 insertions(+), 13 deletions(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 5e6f837f663e..f352b1677143 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -3684,8 +3684,8 @@ static struct request *__bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) + } + + /* +- * We exploit the put_rq_private hook to decrement +- * rq_in_driver, but put_rq_private will not be ++ * We exploit the bfq_finish_request hook to decrement ++ * rq_in_driver, but bfq_finish_request will not be + * invoked on this request. So, to avoid unbalance, + * just start this request, without incrementing + * rq_in_driver. As a negative consequence, +@@ -3694,14 +3694,14 @@ static struct request *__bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) + * bfq_schedule_dispatch to be invoked uselessly. + * + * As for implementing an exact solution, the +- * put_request hook, if defined, is probably invoked +- * also on this request. So, by exploiting this hook, +- * we could 1) increment rq_in_driver here, and 2) +- * decrement it in put_request. Such a solution would +- * let the value of the counter be always accurate, +- * but it would entail using an extra interface +- * function. This cost seems higher than the benefit, +- * being the frequency of non-elevator-private ++ * bfq_finish_request hook, if defined, is probably ++ * invoked also on this request. So, by exploiting ++ * this hook, we could 1) increment rq_in_driver here, ++ * and 2) decrement it in bfq_finish_request. Such a ++ * solution would let the value of the counter be ++ * always accurate, but it would entail using an extra ++ * interface function. This cost seems higher than the ++ * benefit, being the frequency of non-elevator-private + * requests very low. + */ + goto start_rq; +@@ -4558,7 +4558,7 @@ static void bfq_completed_request(struct bfq_queue *bfqq, struct bfq_data *bfqd) + bfq_schedule_dispatch(bfqd); + } + +-static void bfq_put_rq_priv_body(struct bfq_queue *bfqq) ++static void bfq_finish_request_body(struct bfq_queue *bfqq) + { + bfqq->allocated--; + +@@ -4588,7 +4588,7 @@ static void bfq_finish_request(struct request *rq) + spin_lock_irqsave(&bfqd->lock, flags); + + bfq_completed_request(bfqq, bfqd); +- bfq_put_rq_priv_body(bfqq); ++ bfq_finish_request_body(bfqq); + + spin_unlock_irqrestore(&bfqd->lock, flags); + } else { +@@ -4609,7 +4609,7 @@ static void bfq_finish_request(struct request *rq) + bfqg_stats_update_io_remove(bfqq_group(bfqq), + rq->cmd_flags); + } +- bfq_put_rq_priv_body(bfqq); ++ bfq_finish_request_body(bfqq); + } + + rq->elv.priv[0] = NULL; +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-fix-unbalanced-decrements-of-burst-size.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-fix-unbalanced-decrements-of-burst-size.patch new file mode 100644 index 00000000..fe9cf75e --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-fix-unbalanced-decrements-of-burst-size.patch @@ -0,0 +1,141 @@ +From 99fead8d38e5302b1be9403d4de815ce9174a3df Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Mon, 9 Oct 2017 13:11:23 +0200 +Subject: [PATCH] block, bfq: fix unbalanced decrements of burst size +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +The commit "block, bfq: decrease burst size when queues in burst +exit" introduced the decrement of burst_size on the removal of a +bfq_queue from the burst list. Unfortunately, this decrement can +happen to be performed even when burst size is already equal to 0, +because of unbalanced decrements. A description follows of the cause +of these unbalanced decrements, namely a wrong assumption, and of the +way how this wrong assumption leads to unbalanced decrements. + +The wrong assumption is that a bfq_queue can exit only if the process +associated with the bfq_queue has exited. This is false, because a +bfq_queue, say Q, may exit also as a consequence of a merge with +another bfq_queue. In this case, Q exits because the I/O of its +associated process has been redirected to another bfq_queue. + +The decrement unbalance occurs because Q may then be re-created after +a split, and added back to the current burst list, *without* +incrementing burst_size. burst_size is not incremented because Q is +not a new bfq_queue added to the burst list, but a bfq_queue only +temporarily removed from the list, and, before the commit "bfq-sq, +bfq-mq: decrease burst size when queues in burst exit", burst_size was +not decremented when Q was removed. + +This commit addresses this issue by just checking whether the exiting +bfq_queue is a merged bfq_queue, and, in that case, not decrementing +burst_size. Unfortunately, this still leaves room for unbalanced +decrements, in the following rarer case: on a split, the bfq_queue +happens to be inserted into a different burst list than that it was +removed from when merged. If this happens, the number of elements in +the new burst list becomes higher than burst_size (by one). When the +bfq_queue then exits, it is of course not in a merged state any +longer, thus burst_size is decremented, which results in an unbalanced +decrement. To handle this sporadic, unlucky case in a simple way, +this commit also checks that burst_size is larger than 0 before +decrementing it. + +Finally, this commit removes an useless, extra check: the check that +the bfq_queue is sync, performed before checking whether the bfq_queue +is in the burst list. This extra check is redundant, because only sync +bfq_queues can be inserted into the burst list. + +Fixes: 7cb04004fa37 ("block, bfq: decrease burst size when queues in burst exit") +Reported-by: Philip Müller +Signed-off-by: Paolo Valente +Signed-off-by: Angelo Ruocco +Tested-by: Philip Müller +Tested-by: Oleksandr Natalenko +Tested-by: Lee Tibbert +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 59 +++++++++++++++++++++++++++++++++++++++++++++++++++-- + 1 file changed, 57 insertions(+), 2 deletions(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 261f98695910..889a8549d97f 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -3726,9 +3726,36 @@ void bfq_put_queue(struct bfq_queue *bfqq) + if (bfqq->ref) + return; + +- if (bfq_bfqq_sync(bfqq) && !hlist_unhashed(&bfqq->burst_list_node)) { ++ if (!hlist_unhashed(&bfqq->burst_list_node)) { + hlist_del_init(&bfqq->burst_list_node); +- bfqq->bfqd->burst_size--; ++ /* ++ * Decrement also burst size after the removal, if the ++ * process associated with bfqq is exiting, and thus ++ * does not contribute to the burst any longer. This ++ * decrement helps filter out false positives of large ++ * bursts, when some short-lived process (often due to ++ * the execution of commands by some service) happens ++ * to start and exit while a complex application is ++ * starting, and thus spawning several processes that ++ * do I/O (and that *must not* be treated as a large ++ * burst, see comments on bfq_handle_burst). ++ * ++ * In particular, the decrement is performed only if: ++ * 1) bfqq is not a merged queue, because, if it is, ++ * then this free of bfqq is not triggered by the exit ++ * of the process bfqq is associated with, but exactly ++ * by the fact that bfqq has just been merged. ++ * 2) burst_size is greater than 0, to handle ++ * unbalanced decrements. Unbalanced decrements may ++ * happen in te following case: bfqq is inserted into ++ * the current burst list--without incrementing ++ * bust_size--because of a split, but the current ++ * burst list is not the burst list bfqq belonged to ++ * (see comments on the case of a split in ++ * bfq_set_request). ++ */ ++ if (bfqq->bic && bfqq->bfqd->burst_size > 0) ++ bfqq->bfqd->burst_size--; + } + + kmem_cache_free(bfq_pool, bfqq); +@@ -4460,6 +4487,34 @@ static struct bfq_queue *bfq_get_bfqq_handle_split(struct bfq_data *bfqd, + else { + bfq_clear_bfqq_in_large_burst(bfqq); + if (bic->was_in_burst_list) ++ /* ++ * If bfqq was in the current ++ * burst list before being ++ * merged, then we have to add ++ * it back. And we do not need ++ * to increase burst_size, as ++ * we did not decrement ++ * burst_size when we removed ++ * bfqq from the burst list as ++ * a consequence of a merge ++ * (see comments in ++ * bfq_put_queue). In this ++ * respect, it would be rather ++ * costly to know whether the ++ * current burst list is still ++ * the same burst list from ++ * which bfqq was removed on ++ * the merge. To avoid this ++ * cost, if bfqq was in a ++ * burst list, then we add ++ * bfqq to the current burst ++ * list without any further ++ * check. This can cause ++ * inappropriate insertions, ++ * but rarely enough to not ++ * harm the detection of large ++ * bursts significantly. ++ */ + hlist_add_head(&bfqq->burst_list_node, + &bfqd->burst_list); + } +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-fix-wrong-init-of-saved-start-time-for-wei.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-fix-wrong-init-of-saved-start-time-for-wei.patch new file mode 100644 index 00000000..c702e4a1 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-fix-wrong-init-of-saved-start-time-for-wei.patch @@ -0,0 +1,146 @@ +From 4baa8bb13f41307f3eb62fe91f93a1a798ebef53 Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Thu, 21 Sep 2017 11:04:00 +0200 +Subject: [PATCH] block, bfq: fix wrong init of saved start time for weight + raising + +This commit fixes a bug that causes bfq to fail to guarantee a high +responsiveness on some drives, if there is heavy random read+write I/O +in the background. More precisely, such a failure allowed this bug to +be found [1], but the bug may well cause other yet unreported +anomalies. + +BFQ raises the weight of the bfq_queues associated with soft real-time +applications, to privilege the I/O, and thus reduce latency, for these +applications. This mechanism is named soft-real-time weight raising in +BFQ. A soft real-time period may happen to be nested into an +interactive weight raising period, i.e., it may happen that, when a +bfq_queue switches to a soft real-time weight-raised state, the +bfq_queue is already being weight-raised because deemed interactive +too. In this case, BFQ saves in a special variable +wr_start_at_switch_to_srt, the time instant when the interactive +weight-raising period started for the bfq_queue, i.e., the time +instant when BFQ started to deem the bfq_queue interactive. This value +is then used to check whether the interactive weight-raising period +would still be in progress when the soft real-time weight-raising +period ends. If so, interactive weight raising is restored for the +bfq_queue. This restore is useful, in particular, because it prevents +bfq_queues from losing their interactive weight raising prematurely, +as a consequence of spurious, short-lived soft real-time +weight-raising periods caused by wrong detections as soft real-time. + +If, instead, a bfq_queue switches to soft-real-time weight raising +while it *is not* already in an interactive weight-raising period, +then the variable wr_start_at_switch_to_srt has no meaning during the +following soft real-time weight-raising period. Unfortunately the +handling of this case is wrong in BFQ: not only the variable is not +flagged somehow as meaningless, but it is also set to the time when +the switch to soft real-time weight-raising occurs. This may cause an +interactive weight-raising period to be considered mistakenly as still +in progress, and thus a spurious interactive weight-raising period to +start for the bfq_queue, at the end of the soft-real-time +weight-raising period. In particular the spurious interactive +weight-raising period will be considered as still in progress, if the +soft-real-time weight-raising period does not last very long. The +bfq_queue will then be wrongly privileged and, if I/O bound, will +unjustly steal bandwidth to truly interactive or soft real-time +bfq_queues, harming responsiveness and low latency. + +This commit fixes this issue by just setting wr_start_at_switch_to_srt +to minus infinity (farthest past time instant according to jiffies +macros): when the soft-real-time weight-raising period ends, certainly +no interactive weight-raising period will be considered as still in +progress. + +[1] Background I/O Type: Random - Background I/O mix: Reads and writes +- Application to start: LibreOffice Writer in +http://www.phoronix.com/scan.php?page=news_item&px=Linux-4.13-IO-Laptop + +Signed-off-by: Paolo Valente +Signed-off-by: Angelo Ruocco +Tested-by: Oleksandr Natalenko +Tested-by: Lee Tibbert +Tested-by: Mirko Montanari +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 50 +++++++++++++++++++++++++++++++------------------- + 1 file changed, 31 insertions(+), 19 deletions(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index a4783da90ba8..c25955c25e03 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -1202,6 +1202,24 @@ static unsigned int bfq_wr_duration(struct bfq_data *bfqd) + return dur; + } + ++/* ++ * Return the farthest future time instant according to jiffies ++ * macros. ++ */ ++static unsigned long bfq_greatest_from_now(void) ++{ ++ return jiffies + MAX_JIFFY_OFFSET; ++} ++ ++/* ++ * Return the farthest past time instant according to jiffies ++ * macros. ++ */ ++static unsigned long bfq_smallest_from_now(void) ++{ ++ return jiffies - MAX_JIFFY_OFFSET; ++} ++ + static void bfq_update_bfqq_wr_on_rq_arrival(struct bfq_data *bfqd, + struct bfq_queue *bfqq, + unsigned int old_wr_coeff, +@@ -1216,7 +1234,19 @@ static void bfq_update_bfqq_wr_on_rq_arrival(struct bfq_data *bfqd, + bfqq->wr_coeff = bfqd->bfq_wr_coeff; + bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); + } else { +- bfqq->wr_start_at_switch_to_srt = jiffies; ++ /* ++ * No interactive weight raising in progress ++ * here: assign minus infinity to ++ * wr_start_at_switch_to_srt, to make sure ++ * that, at the end of the soft-real-time ++ * weight raising periods that is starting ++ * now, no interactive weight-raising period ++ * may be wrongly considered as still in ++ * progress (and thus actually started by ++ * mistake). ++ */ ++ bfqq->wr_start_at_switch_to_srt = ++ bfq_smallest_from_now(); + bfqq->wr_coeff = bfqd->bfq_wr_coeff * + BFQ_SOFTRT_WEIGHT_FACTOR; + bfqq->wr_cur_max_time = +@@ -2897,24 +2927,6 @@ static unsigned long bfq_bfqq_softrt_next_start(struct bfq_data *bfqd, + jiffies + nsecs_to_jiffies(bfqq->bfqd->bfq_slice_idle) + 4); + } + +-/* +- * Return the farthest future time instant according to jiffies +- * macros. +- */ +-static unsigned long bfq_greatest_from_now(void) +-{ +- return jiffies + MAX_JIFFY_OFFSET; +-} +- +-/* +- * Return the farthest past time instant according to jiffies +- * macros. +- */ +-static unsigned long bfq_smallest_from_now(void) +-{ +- return jiffies - MAX_JIFFY_OFFSET; +-} +- + /** + * bfq_bfqq_expire - expire a queue. + * @bfqd: device owning the queue. +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-increase-threshold-to-deem-I-O-as-random.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-increase-threshold-to-deem-I-O-as-random.patch new file mode 100644 index 00000000..ddbf7c5f --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-increase-threshold-to-deem-I-O-as-random.patch @@ -0,0 +1,68 @@ +From f0ba5ea2fe45c0ad24a7dedae84a97f7aa046494 Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Wed, 20 Dec 2017 17:27:36 +0100 +Subject: [PATCH] block, bfq: increase threshold to deem I/O as random + +If two processes do I/O close to each other, i.e., are cooperating +processes in BFQ (and CFQ'S) nomenclature, then BFQ merges their +associated bfq_queues, so as to get sequential I/O from the union of +the I/O requests of the processes, and thus reach a higher +throughput. A merged queue is then split if its I/O stops being +sequential. In this respect, BFQ deems the I/O of a bfq_queue as +(mostly) sequential only if less than 4 I/O requests are random, out +of the last 32 requests inserted into the queue. + +Unfortunately, extensive testing (with the interleaved_io benchmark of +the S suite [1], and with real applications spawning cooperating +processes) has clearly shown that, with such a low threshold, only a +rather low I/O throughput may be reached when several cooperating +processes do I/O. In particular, the outcome of each test run was +bimodal: if queue merging occurred and was stable during the test, +then the throughput was close to the peak rate of the storage device, +otherwise the throughput was arbitrarily low (usually around 1/10 of +the peak rate with a rotational device). The probability to get the +unlucky outcomes grew with the number of cooperating processes: it was +already significant with 5 processes, and close to one with 7 or more +processes. + +The cause of the low throughput in the unlucky runs was that the +merged queues containing the I/O of these cooperating processes were +soon split, because they contained more random I/O requests than those +tolerated by the 4/32 threshold, but +- that I/O would have however allowed the storage device to reach + peak throughput or almost peak throughput; +- in contrast, the I/O of these processes, if served individually + (from separate queues) yielded a rather low throughput. + +So we repeated our tests with increasing values of the threshold, +until we found the minimum value (19) for which we obtained maximum +throughput, reliably, with at least up to 9 cooperating +processes. Then we checked that the use of that higher threshold value +did not cause any regression for any other benchmark in the suite [1]. +This commit raises the threshold to such a higher value. + +[1] https://github.com/Algodev-github/S + +Signed-off-by: Angelo Ruocco +Signed-off-by: Paolo Valente +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 2 +- + 1 file changed, 1 insertion(+), 1 deletion(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index bcb6d21baf12..0f48583b9380 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -178,7 +178,7 @@ static struct kmem_cache *bfq_pool; + #define BFQQ_SEEK_THR (sector_t)(8 * 100) + #define BFQQ_SECT_THR_NONROT (sector_t)(2 * 32) + #define BFQQ_CLOSE_THR (sector_t)(8 * 1024) +-#define BFQQ_SEEKY(bfqq) (hweight32(bfqq->seek_history) > 32/8) ++#define BFQQ_SEEKY(bfqq) (hweight32(bfqq->seek_history) > 19) + + /* Min number of samples required to perform peak-rate update */ + #define BFQ_RATE_MIN_SAMPLES 32 +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-iosched-don-t-call-bfqg_and_blkg_put-for-CONFIG_.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-iosched-don-t-call-bfqg_and_blkg_put-for-CONFIG_.patch new file mode 100644 index 00000000..059027fa --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-iosched-don-t-call-bfqg_and_blkg_put-for-CONFIG_.patch @@ -0,0 +1,34 @@ +From 8abef10b3de1144cfe968f454946f13eb1ac3d0a Mon Sep 17 00:00:00 2001 +From: Jens Axboe +Date: Tue, 9 Jan 2018 12:20:51 -0700 +Subject: [PATCH] bfq-iosched: don't call bfqg_and_blkg_put for + !CONFIG_BFQ_GROUP_IOSCHED + +It's not available if we don't have group io scheduling set, and +there's no need to call it. + +Fixes: 0d52af590552 ("block, bfq: release oom-queue ref to root group on exit") +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 2 +- + 1 file changed, 1 insertion(+), 1 deletion(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 7c0b7f60811c..5e6f837f663e 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -4893,10 +4893,10 @@ static void bfq_exit_queue(struct elevator_queue *e) + + hrtimer_cancel(&bfqd->idle_slice_timer); + ++#ifdef CONFIG_BFQ_GROUP_IOSCHED + /* release oom-queue reference to root group */ + bfqg_and_blkg_put(bfqd->root_group); + +-#ifdef CONFIG_BFQ_GROUP_IOSCHED + blkcg_deactivate_policy(bfqd->queue, &blkcg_policy_bfq); + #else + spin_lock_irq(&bfqd->lock); +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-let-a-queue-be-merged-only-shortly-after-s.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-let-a-queue-be-merged-only-shortly-after-s.patch new file mode 100644 index 00000000..5a316e71 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-let-a-queue-be-merged-only-shortly-after-s.patch @@ -0,0 +1,186 @@ +From 7b8fa3b900a087bc03b11329a92398fde563ba37 Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Wed, 20 Dec 2017 12:38:33 +0100 +Subject: [PATCH] block, bfq: let a queue be merged only shortly after starting + I/O + +In BFQ and CFQ, two processes are said to be cooperating if they do +I/O in such a way that the union of their I/O requests yields a +sequential I/O pattern. To get such a sequential I/O pattern out of +the non-sequential pattern of each cooperating process, BFQ and CFQ +merge the queues associated with these processes. In more detail, +cooperating processes, and thus their associated queues, usually +start, or restart, to do I/O shortly after each other. This is the +case, e.g., for the I/O threads of KVM/QEMU and of the dump +utility. Basing on this assumption, this commit allows a bfq_queue to +be merged only during a short time interval (100ms) after it starts, +or re-starts, to do I/O. This filtering provides two important +benefits. + +First, it greatly reduces the probability that two non-cooperating +processes have their queues merged by mistake, if they just happen to +do I/O close to each other for a short time interval. These spurious +merges cause loss of service guarantees. A low-weight bfq_queue may +unjustly get more than its expected share of the throughput: if such a +low-weight queue is merged with a high-weight queue, then the I/O for +the low-weight queue is served as if the queue had a high weight. This +may damage other high-weight queues unexpectedly. For instance, +because of this issue, lxterminal occasionally took 7.5 seconds to +start, instead of 6.5 seconds, when some sequential readers and +writers did I/O in the background on a FUJITSU MHX2300BT HDD. The +reason is that the bfq_queues associated with some of the readers or +the writers were merged with the high-weight queues of some processes +that had to do some urgent but little I/O. The readers then exploited +the inherited high weight for all or most of their I/O, during the +start-up of terminal. The filtering introduced by this commit +eliminated any outlier caused by spurious queue merges in our start-up +time tests. + +This filtering also provides a little boost of the throughput +sustainable by BFQ: 3-4%, depending on the CPU. The reason is that, +once a bfq_queue cannot be merged any longer, this commit makes BFQ +stop updating the data needed to handle merging for the queue. + +Signed-off-by: Paolo Valente +Signed-off-by: Angelo Ruocco +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 57 ++++++++++++++++++++++++++++++++++++++++++----------- + block/bfq-iosched.h | 2 ++ + block/bfq-wf2q.c | 4 ++++ + 3 files changed, 52 insertions(+), 11 deletions(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 2cf395daee80..7066d90f09df 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -166,6 +166,20 @@ static const int bfq_async_charge_factor = 10; + /* Default timeout values, in jiffies, approximating CFQ defaults. */ + const int bfq_timeout = HZ / 8; + ++/* ++ * Time limit for merging (see comments in bfq_setup_cooperator). Set ++ * to the slowest value that, in our tests, proved to be effective in ++ * removing false positives, while not causing true positives to miss ++ * queue merging. ++ * ++ * As can be deduced from the low time limit below, queue merging, if ++ * successful, happens at the very beggining of the I/O of the involved ++ * cooperating processes, as a consequence of the arrival of the very ++ * first requests from each cooperator. After that, there is very ++ * little chance to find cooperators. ++ */ ++static const unsigned long bfq_merge_time_limit = HZ/10; ++ + static struct kmem_cache *bfq_pool; + + /* Below this threshold (in ns), we consider thinktime immediate. */ +@@ -444,6 +458,13 @@ bfq_rq_pos_tree_lookup(struct bfq_data *bfqd, struct rb_root *root, + return bfqq; + } + ++static bool bfq_too_late_for_merging(struct bfq_queue *bfqq) ++{ ++ return bfqq->service_from_backlogged > 0 && ++ time_is_before_jiffies(bfqq->first_IO_time + ++ bfq_merge_time_limit); ++} ++ + void bfq_pos_tree_add_move(struct bfq_data *bfqd, struct bfq_queue *bfqq) + { + struct rb_node **p, *parent; +@@ -454,6 +475,14 @@ void bfq_pos_tree_add_move(struct bfq_data *bfqd, struct bfq_queue *bfqq) + bfqq->pos_root = NULL; + } + ++ /* ++ * bfqq cannot be merged any longer (see comments in ++ * bfq_setup_cooperator): no point in adding bfqq into the ++ * position tree. ++ */ ++ if (bfq_too_late_for_merging(bfqq)) ++ return; ++ + if (bfq_class_idle(bfqq)) + return; + if (!bfqq->next_rq) +@@ -1935,6 +1964,9 @@ bfq_setup_merge(struct bfq_queue *bfqq, struct bfq_queue *new_bfqq) + static bool bfq_may_be_close_cooperator(struct bfq_queue *bfqq, + struct bfq_queue *new_bfqq) + { ++ if (bfq_too_late_for_merging(new_bfqq)) ++ return false; ++ + if (bfq_class_idle(bfqq) || bfq_class_idle(new_bfqq) || + (bfqq->ioprio_class != new_bfqq->ioprio_class)) + return false; +@@ -2003,6 +2035,20 @@ bfq_setup_cooperator(struct bfq_data *bfqd, struct bfq_queue *bfqq, + { + struct bfq_queue *in_service_bfqq, *new_bfqq; + ++ /* ++ * Prevent bfqq from being merged if it has been created too ++ * long ago. The idea is that true cooperating processes, and ++ * thus their associated bfq_queues, are supposed to be ++ * created shortly after each other. This is the case, e.g., ++ * for KVM/QEMU and dump I/O threads. Basing on this ++ * assumption, the following filtering greatly reduces the ++ * probability that two non-cooperating processes, which just ++ * happen to do close I/O for some short time interval, have ++ * their queues merged by mistake. ++ */ ++ if (bfq_too_late_for_merging(bfqq)) ++ return NULL; ++ + if (bfqq->new_bfqq) + return bfqq->new_bfqq; + +@@ -3002,17 +3048,6 @@ void bfq_bfqq_expire(struct bfq_data *bfqd, + */ + slow = bfq_bfqq_is_slow(bfqd, bfqq, compensate, reason, &delta); + +- /* +- * Increase service_from_backlogged before next statement, +- * because the possible next invocation of +- * bfq_bfqq_charge_time would likely inflate +- * entity->service. In contrast, service_from_backlogged must +- * contain real service, to enable the soft real-time +- * heuristic to correctly compute the bandwidth consumed by +- * bfqq. +- */ +- bfqq->service_from_backlogged += entity->service; +- + /* + * As above explained, charge slow (typically seeky) and + * timed-out queues with the time and not the service +diff --git a/block/bfq-iosched.h b/block/bfq-iosched.h +index 91c4390903a1..5d47b58d5fc8 100644 +--- a/block/bfq-iosched.h ++++ b/block/bfq-iosched.h +@@ -344,6 +344,8 @@ struct bfq_queue { + unsigned long wr_start_at_switch_to_srt; + + unsigned long split_time; /* time of last split */ ++ ++ unsigned long first_IO_time; /* time of first I/O for this queue */ + }; + + /** +diff --git a/block/bfq-wf2q.c b/block/bfq-wf2q.c +index e495d3f9b4b0..4456eda34e48 100644 +--- a/block/bfq-wf2q.c ++++ b/block/bfq-wf2q.c +@@ -835,6 +835,10 @@ void bfq_bfqq_served(struct bfq_queue *bfqq, int served) + struct bfq_entity *entity = &bfqq->entity; + struct bfq_service_tree *st; + ++ if (!bfqq->service_from_backlogged) ++ bfqq->first_IO_time = jiffies; ++ ++ bfqq->service_from_backlogged += served; + for_each_entity(entity) { + st = bfq_entity_service_tree(entity); + +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-let-early-merged-queues-be-weight-raised-o.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-let-early-merged-queues-be-weight-raised-o.patch new file mode 100644 index 00000000..698490a2 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-let-early-merged-queues-be-weight-raised-o.patch @@ -0,0 +1,89 @@ +From 894df937e06a56ed6f054a75a416aff84147c5a2 Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Thu, 21 Sep 2017 11:04:02 +0200 +Subject: [PATCH] block, bfq: let early-merged queues be weight-raised on split + too + +A just-created bfq_queue, say Q, may happen to be merged with another +bfq_queue on the very first invocation of the function +__bfq_insert_request. In such a case, even if Q would clearly deserve +interactive weight raising (as it has just been created), the function +bfq_add_request does not make it to be invoked for Q, and thus to +activate weight raising for Q. As a consequence, when the state of Q +is saved for a possible future restore, after a split of Q from the +other bfq_queue(s), such a state happens to be (unjustly) +non-weight-raised. Then the bfq_queue will not enjoy any weight +raising on the split, even if should still be in an interactive +weight-raising period when the split occurs. + +This commit solves this problem as follows, for a just-created +bfq_queue that is being early-merged: it stores directly, in the saved +state of the bfq_queue, the weight-raising state that would have been +assigned to the bfq_queue if not early-merged. + +Signed-off-by: Paolo Valente +Tested-by: Angelo Ruocco +Tested-by: Mirko Montanari +Tested-by: Oleksandr Natalenko +Tested-by: Lee Tibbert +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 28 +++++++++++++++++++++++----- + 1 file changed, 23 insertions(+), 5 deletions(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 33b63bc4a64b..115747fe43c8 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -2061,10 +2061,27 @@ static void bfq_bfqq_save_state(struct bfq_queue *bfqq) + bic->saved_IO_bound = bfq_bfqq_IO_bound(bfqq); + bic->saved_in_large_burst = bfq_bfqq_in_large_burst(bfqq); + bic->was_in_burst_list = !hlist_unhashed(&bfqq->burst_list_node); +- bic->saved_wr_coeff = bfqq->wr_coeff; +- bic->saved_wr_start_at_switch_to_srt = bfqq->wr_start_at_switch_to_srt; +- bic->saved_last_wr_start_finish = bfqq->last_wr_start_finish; +- bic->saved_wr_cur_max_time = bfqq->wr_cur_max_time; ++ if (unlikely(bfq_bfqq_just_created(bfqq) && ++ !bfq_bfqq_in_large_burst(bfqq))) { ++ /* ++ * bfqq being merged right after being created: bfqq ++ * would have deserved interactive weight raising, but ++ * did not make it to be set in a weight-raised state, ++ * because of this early merge. Store directly the ++ * weight-raising state that would have been assigned ++ * to bfqq, so that to avoid that bfqq unjustly fails ++ * to enjoy weight raising if split soon. ++ */ ++ bic->saved_wr_coeff = bfqq->bfqd->bfq_wr_coeff; ++ bic->saved_wr_cur_max_time = bfq_wr_duration(bfqq->bfqd); ++ bic->saved_last_wr_start_finish = jiffies; ++ } else { ++ bic->saved_wr_coeff = bfqq->wr_coeff; ++ bic->saved_wr_start_at_switch_to_srt = ++ bfqq->wr_start_at_switch_to_srt; ++ bic->saved_last_wr_start_finish = bfqq->last_wr_start_finish; ++ bic->saved_wr_cur_max_time = bfqq->wr_cur_max_time; ++ } + } + + static void +@@ -4150,7 +4167,6 @@ static void __bfq_insert_request(struct bfq_data *bfqd, struct request *rq) + new_bfqq->allocated++; + bfqq->allocated--; + new_bfqq->ref++; +- bfq_clear_bfqq_just_created(bfqq); + /* + * If the bic associated with the process + * issuing this request still points to bfqq +@@ -4162,6 +4178,8 @@ static void __bfq_insert_request(struct bfq_data *bfqd, struct request *rq) + if (bic_to_bfqq(RQ_BIC(rq), 1) == bfqq) + bfq_merge_bfqqs(bfqd, RQ_BIC(rq), + bfqq, new_bfqq); ++ ++ bfq_clear_bfqq_just_created(bfqq); + /* + * rq is about to be enqueued into new_bfqq, + * release rq reference on bfqq +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-limit-sectors-served-with-interactive-weig.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-limit-sectors-served-with-interactive-weig.patch new file mode 100644 index 00000000..f2dcc192 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-limit-sectors-served-with-interactive-weig.patch @@ -0,0 +1,202 @@ +From 8a8747dc01cee6f92a52c03ba686e9f60cb46c87 Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Sat, 13 Jan 2018 12:05:18 +0100 +Subject: [PATCH] block, bfq: limit sectors served with interactive weight + raising +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +To maximise responsiveness, BFQ raises the weight, and performs device +idling, for bfq_queues associated with processes deemed as +interactive. In particular, weight raising has a maximum duration, +equal to the time needed to start a large application. If a +weight-raised process goes on doing I/O beyond this maximum duration, +it loses weight-raising. + +This mechanism is evidently vulnerable to the following false +positives: I/O-bound applications that will go on doing I/O for much +longer than the duration of weight-raising. These applications have +basically no benefit from being weight-raised at the beginning of +their I/O. On the opposite end, while being weight-raised, these +applications +a) unjustly steal throughput to applications that may truly need +low latency; +b) make BFQ uselessly perform device idling; device idling results +in loss of device throughput with most flash-based storage, and may +increase latencies when used purposelessly. + +This commit adds a countermeasure to reduce both the above +problems. To introduce this countermeasure, we provide the following +extra piece of information (full details in the comments added by this +commit). During the start-up of the large application used as a +reference to set the duration of weight-raising, involved processes +transfer at most ~110K sectors each. Accordingly, a process initially +deemed as interactive has no right to be weight-raised any longer, +once transferred 110K sectors or more. + +Basing on this consideration, this commit early-ends weight-raising +for a bfq_queue if the latter happens to have received an amount of +service at least equal to 110K sectors (actually, a little bit more, +to keep a safety margin). I/O-bound applications that reach a high +throughput, such as file copy, get to this threshold much before the +allowed weight-raising period finishes. Thus this early ending of +weight-raising reduces the amount of time during which these +applications cause the problems described above. + +Tested-by: Oleksandr Natalenko +Tested-by: Holger Hoffstätte +Signed-off-by: Paolo Valente +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 81 +++++++++++++++++++++++++++++++++++++++++++++++------ + block/bfq-iosched.h | 5 ++++ + block/bfq-wf2q.c | 3 ++ + 3 files changed, 80 insertions(+), 9 deletions(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index a7ab0cb50733..47e6ec7427c4 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -209,15 +209,17 @@ static struct kmem_cache *bfq_pool; + * interactive applications automatically, using the following formula: + * duration = (R / r) * T, where r is the peak rate of the device, and + * R and T are two reference parameters. +- * In particular, R is the peak rate of the reference device (see below), +- * and T is a reference time: given the systems that are likely to be +- * installed on the reference device according to its speed class, T is +- * about the maximum time needed, under BFQ and while reading two files in +- * parallel, to load typical large applications on these systems. +- * In practice, the slower/faster the device at hand is, the more/less it +- * takes to load applications with respect to the reference device. +- * Accordingly, the longer/shorter BFQ grants weight raising to interactive +- * applications. ++ * In particular, R is the peak rate of the reference device (see ++ * below), and T is a reference time: given the systems that are ++ * likely to be installed on the reference device according to its ++ * speed class, T is about the maximum time needed, under BFQ and ++ * while reading two files in parallel, to load typical large ++ * applications on these systems (see the comments on ++ * max_service_from_wr below, for more details on how T is obtained). ++ * In practice, the slower/faster the device at hand is, the more/less ++ * it takes to load applications with respect to the reference device. ++ * Accordingly, the longer/shorter BFQ grants weight raising to ++ * interactive applications. + * + * BFQ uses four different reference pairs (R, T), depending on: + * . whether the device is rotational or non-rotational; +@@ -254,6 +256,60 @@ static int T_slow[2]; + static int T_fast[2]; + static int device_speed_thresh[2]; + ++/* ++ * BFQ uses the above-detailed, time-based weight-raising mechanism to ++ * privilege interactive tasks. This mechanism is vulnerable to the ++ * following false positives: I/O-bound applications that will go on ++ * doing I/O for much longer than the duration of weight ++ * raising. These applications have basically no benefit from being ++ * weight-raised at the beginning of their I/O. On the opposite end, ++ * while being weight-raised, these applications ++ * a) unjustly steal throughput to applications that may actually need ++ * low latency; ++ * b) make BFQ uselessly perform device idling; device idling results ++ * in loss of device throughput with most flash-based storage, and may ++ * increase latencies when used purposelessly. ++ * ++ * BFQ tries to reduce these problems, by adopting the following ++ * countermeasure. To introduce this countermeasure, we need first to ++ * finish explaining how the duration of weight-raising for ++ * interactive tasks is computed. ++ * ++ * For a bfq_queue deemed as interactive, the duration of weight ++ * raising is dynamically adjusted, as a function of the estimated ++ * peak rate of the device, so as to be equal to the time needed to ++ * execute the 'largest' interactive task we benchmarked so far. By ++ * largest task, we mean the task for which each involved process has ++ * to do more I/O than for any of the other tasks we benchmarked. This ++ * reference interactive task is the start-up of LibreOffice Writer, ++ * and in this task each process/bfq_queue needs to have at most ~110K ++ * sectors transferred. ++ * ++ * This last piece of information enables BFQ to reduce the actual ++ * duration of weight-raising for at least one class of I/O-bound ++ * applications: those doing sequential or quasi-sequential I/O. An ++ * example is file copy. In fact, once started, the main I/O-bound ++ * processes of these applications usually consume the above 110K ++ * sectors in much less time than the processes of an application that ++ * is starting, because these I/O-bound processes will greedily devote ++ * almost all their CPU cycles only to their target, ++ * throughput-friendly I/O operations. This is even more true if BFQ ++ * happens to be underestimating the device peak rate, and thus ++ * overestimating the duration of weight raising. But, according to ++ * our measurements, once transferred 110K sectors, these processes ++ * have no right to be weight-raised any longer. ++ * ++ * Basing on the last consideration, BFQ ends weight-raising for a ++ * bfq_queue if the latter happens to have received an amount of ++ * service at least equal to the following constant. The constant is ++ * set to slightly more than 110K, to have a minimum safety margin. ++ * ++ * This early ending of weight-raising reduces the amount of time ++ * during which interactive false positives cause the two problems ++ * described at the beginning of these comments. ++ */ ++static const unsigned long max_service_from_wr = 120000; ++ + #define RQ_BIC(rq) icq_to_bic((rq)->elv.priv[0]) + #define RQ_BFQQ(rq) ((rq)->elv.priv[1]) + +@@ -1352,6 +1408,7 @@ static void bfq_update_bfqq_wr_on_rq_arrival(struct bfq_data *bfqd, + if (old_wr_coeff == 1 && wr_or_deserves_wr) { + /* start a weight-raising period */ + if (interactive) { ++ bfqq->service_from_wr = 0; + bfqq->wr_coeff = bfqd->bfq_wr_coeff; + bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); + } else { +@@ -3665,6 +3722,12 @@ static void bfq_update_wr_data(struct bfq_data *bfqd, struct bfq_queue *bfqq) + bfqq->entity.prio_changed = 1; + } + } ++ if (bfqq->wr_coeff > 1 && ++ bfqq->wr_cur_max_time != bfqd->bfq_wr_rt_max_time && ++ bfqq->service_from_wr > max_service_from_wr) { ++ /* see comments on max_service_from_wr */ ++ bfq_bfqq_end_wr(bfqq); ++ } + } + /* + * To improve latency (for this or other queues), immediately +diff --git a/block/bfq-iosched.h b/block/bfq-iosched.h +index fcd941008127..350c39ae2896 100644 +--- a/block/bfq-iosched.h ++++ b/block/bfq-iosched.h +@@ -337,6 +337,11 @@ struct bfq_queue { + * last transition from idle to backlogged. + */ + unsigned long service_from_backlogged; ++ /* ++ * Cumulative service received from the @bfq_queue since its ++ * last transition to weight-raised state. ++ */ ++ unsigned long service_from_wr; + + /* + * Value of wr start time when switching to soft rt +diff --git a/block/bfq-wf2q.c b/block/bfq-wf2q.c +index 4456eda34e48..4498c43245e2 100644 +--- a/block/bfq-wf2q.c ++++ b/block/bfq-wf2q.c +@@ -838,6 +838,9 @@ void bfq_bfqq_served(struct bfq_queue *bfqq, int served) + if (!bfqq->service_from_backlogged) + bfqq->first_IO_time = jiffies; + ++ if (bfqq->wr_coeff > 1) ++ bfqq->service_from_wr += served; ++ + bfqq->service_from_backlogged += served; + for_each_entity(entity) { + st = bfq_entity_service_tree(entity); +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-limit-tags-for-writes-and-async-I-O.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-limit-tags-for-writes-and-async-I-O.patch new file mode 100644 index 00000000..e165539e --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-limit-tags-for-writes-and-async-I-O.patch @@ -0,0 +1,162 @@ +From a52a69ea89dc12e6f4572f554940789c1ab23c7a Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Sat, 13 Jan 2018 12:05:17 +0100 +Subject: [PATCH] block, bfq: limit tags for writes and async I/O +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +Asynchronous I/O can easily starve synchronous I/O (both sync reads +and sync writes), by consuming all request tags. Similarly, storms of +synchronous writes, such as those that sync(2) may trigger, can starve +synchronous reads. In their turn, these two problems may also cause +BFQ to loose control on latency for interactive and soft real-time +applications. For example, on a PLEXTOR PX-256M5S SSD, LibreOffice +Writer takes 0.6 seconds to start if the device is idle, but it takes +more than 45 seconds (!) if there are sequential writes in the +background. + +This commit addresses this issue by limiting the maximum percentage of +tags that asynchronous I/O requests and synchronous write requests can +consume. In particular, this commit grants a higher threshold to +synchronous writes, to prevent the latter from being starved by +asynchronous I/O. + +According to the above test, LibreOffice Writer now starts in about +1.2 seconds on average, regardless of the background workload, and +apart from some rare outlier. To check this improvement, run, e.g., +sudo ./comm_startup_lat.sh bfq 5 5 seq 10 "lowriter --terminate_after_init" +for the comm_startup_lat benchmark in the S suite [1]. + +[1] https://github.com/Algodev-github/S + +Tested-by: Oleksandr Natalenko +Tested-by: Holger Hoffstätte +Signed-off-by: Paolo Valente +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 77 +++++++++++++++++++++++++++++++++++++++++++++++++++++ + block/bfq-iosched.h | 12 +++++++++ + 2 files changed, 89 insertions(+) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index f352b1677143..a7ab0cb50733 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -417,6 +417,82 @@ static struct request *bfq_choose_req(struct bfq_data *bfqd, + } + } + ++/* ++ * See the comments on bfq_limit_depth for the purpose of ++ * the depths set in the function. ++ */ ++static void bfq_update_depths(struct bfq_data *bfqd, struct sbitmap_queue *bt) ++{ ++ bfqd->sb_shift = bt->sb.shift; ++ ++ /* ++ * In-word depths if no bfq_queue is being weight-raised: ++ * leaving 25% of tags only for sync reads. ++ * ++ * In next formulas, right-shift the value ++ * (1U<sb_shift), instead of computing directly ++ * (1U<<(bfqd->sb_shift - something)), to be robust against ++ * any possible value of bfqd->sb_shift, without having to ++ * limit 'something'. ++ */ ++ /* no more than 50% of tags for async I/O */ ++ bfqd->word_depths[0][0] = max((1U<sb_shift)>>1, 1U); ++ /* ++ * no more than 75% of tags for sync writes (25% extra tags ++ * w.r.t. async I/O, to prevent async I/O from starving sync ++ * writes) ++ */ ++ bfqd->word_depths[0][1] = max(((1U<sb_shift) * 3)>>2, 1U); ++ ++ /* ++ * In-word depths in case some bfq_queue is being weight- ++ * raised: leaving ~63% of tags for sync reads. This is the ++ * highest percentage for which, in our tests, application ++ * start-up times didn't suffer from any regression due to tag ++ * shortage. ++ */ ++ /* no more than ~18% of tags for async I/O */ ++ bfqd->word_depths[1][0] = max(((1U<sb_shift) * 3)>>4, 1U); ++ /* no more than ~37% of tags for sync writes (~20% extra tags) */ ++ bfqd->word_depths[1][1] = max(((1U<sb_shift) * 6)>>4, 1U); ++} ++ ++/* ++ * Async I/O can easily starve sync I/O (both sync reads and sync ++ * writes), by consuming all tags. Similarly, storms of sync writes, ++ * such as those that sync(2) may trigger, can starve sync reads. ++ * Limit depths of async I/O and sync writes so as to counter both ++ * problems. ++ */ ++static void bfq_limit_depth(unsigned int op, struct blk_mq_alloc_data *data) ++{ ++ struct blk_mq_tags *tags = blk_mq_tags_from_data(data); ++ struct bfq_data *bfqd = data->q->elevator->elevator_data; ++ struct sbitmap_queue *bt; ++ ++ if (op_is_sync(op) && !op_is_write(op)) ++ return; ++ ++ if (data->flags & BLK_MQ_REQ_RESERVED) { ++ if (unlikely(!tags->nr_reserved_tags)) { ++ WARN_ON_ONCE(1); ++ return; ++ } ++ bt = &tags->breserved_tags; ++ } else ++ bt = &tags->bitmap_tags; ++ ++ if (unlikely(bfqd->sb_shift != bt->sb.shift)) ++ bfq_update_depths(bfqd, bt); ++ ++ data->shallow_depth = ++ bfqd->word_depths[!!bfqd->wr_busy_queues][op_is_sync(op)]; ++ ++ bfq_log(bfqd, "[%s] wr_busy %d sync %d depth %u", ++ __func__, bfqd->wr_busy_queues, op_is_sync(op), ++ data->shallow_depth); ++} ++ + static struct bfq_queue * + bfq_rq_pos_tree_lookup(struct bfq_data *bfqd, struct rb_root *root, + sector_t sector, struct rb_node **ret_parent, +@@ -5285,6 +5361,7 @@ static struct elv_fs_entry bfq_attrs[] = { + + static struct elevator_type iosched_bfq_mq = { + .ops.mq = { ++ .limit_depth = bfq_limit_depth, + .prepare_request = bfq_prepare_request, + .finish_request = bfq_finish_request, + .exit_icq = bfq_exit_icq, +diff --git a/block/bfq-iosched.h b/block/bfq-iosched.h +index 5d47b58d5fc8..fcd941008127 100644 +--- a/block/bfq-iosched.h ++++ b/block/bfq-iosched.h +@@ -629,6 +629,18 @@ struct bfq_data { + struct bfq_io_cq *bio_bic; + /* bfqq associated with the task issuing current bio for merging */ + struct bfq_queue *bio_bfqq; ++ ++ /* ++ * Cached sbitmap shift, used to compute depth limits in ++ * bfq_update_depths. ++ */ ++ unsigned int sb_shift; ++ ++ /* ++ * Depth limits used in bfq_limit_depth (see comments on the ++ * function) ++ */ ++ unsigned int word_depths[2][2]; + }; + + enum bfqq_state_flags { +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-move-debug-blkio-stats-behind-CONFIG_DEBUG.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-move-debug-blkio-stats-behind-CONFIG_DEBUG.patch new file mode 100644 index 00000000..6bf8c497 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-move-debug-blkio-stats-behind-CONFIG_DEBUG.patch @@ -0,0 +1,467 @@ +From a33801e8b4735b8d473f963e5854172f9cde3e8b Mon Sep 17 00:00:00 2001 +From: Luca Miccio +Date: Mon, 13 Nov 2017 07:34:10 +0100 +Subject: [PATCH] block, bfq: move debug blkio stats behind + CONFIG_DEBUG_BLK_CGROUP + +BFQ currently creates, and updates, its own instance of the whole +set of blkio statistics that cfq creates. Yet, from the comments +of Tejun Heo in [1], it turned out that most of these statistics +are meant/useful only for debugging. This commit makes BFQ create +the latter, debugging statistics only if the option +CONFIG_DEBUG_BLK_CGROUP is set. + +By doing so, this commit also enables BFQ to enjoy a high perfomance +boost. The reason is that, if CONFIG_DEBUG_BLK_CGROUP is not set, then +BFQ has to update far fewer statistics, and, in particular, not the +heaviest to update. To give an idea of the benefits, if +CONFIG_DEBUG_BLK_CGROUP is not set, then, on an Intel i7-4850HQ, and +with 8 threads doing random I/O in parallel on null_blk (configured +with 0 latency), the throughput of BFQ grows from 310 to 400 KIOPS +(+30%). We have measured similar or even much higher boosts with other +CPUs: e.g., +45% with an ARM CortexTM-A53 Octa-core. Our results have +been obtained and can be reproduced very easily with the script in [1]. + +[1] https://www.spinics.net/lists/linux-block/msg18943.html + +Suggested-by: Tejun Heo +Suggested-by: Ulf Hansson +Tested-by: Lee Tibbert +Tested-by: Oleksandr Natalenko +Signed-off-by: Luca Miccio +Signed-off-by: Paolo Valente +Signed-off-by: Jens Axboe +--- + Documentation/block/bfq-iosched.txt | 38 +++++++-- + block/bfq-cgroup.c | 148 ++++++++++++++++++++---------------- + block/bfq-iosched.c | 14 ++-- + block/bfq-iosched.h | 4 +- + 4 files changed, 125 insertions(+), 79 deletions(-) + +diff --git a/Documentation/block/bfq-iosched.txt b/Documentation/block/bfq-iosched.txt +index 7fad6c061470..8d8d8f06cab2 100644 +--- a/Documentation/block/bfq-iosched.txt ++++ b/Documentation/block/bfq-iosched.txt +@@ -20,12 +20,22 @@ for that device, by setting low_latency to 0. See Section 3 for + details on how to configure BFQ for the desired tradeoff between + latency and throughput, or on how to maximize throughput. + +-BFQ has a non-null overhead, which limits the maximum IOPS that the +-CPU can process for a device scheduled with BFQ. To give an idea of +-the limits on slow or average CPUs, here are BFQ limits for three +-different CPUs, on, respectively, an average laptop, an old desktop, +-and a cheap embedded system, in case full hierarchical support is +-enabled (i.e., CONFIG_BFQ_GROUP_IOSCHED is set): ++BFQ has a non-null overhead, which limits the maximum IOPS that a CPU ++can process for a device scheduled with BFQ. To give an idea of the ++limits on slow or average CPUs, here are, first, the limits of BFQ for ++three different CPUs, on, respectively, an average laptop, an old ++desktop, and a cheap embedded system, in case full hierarchical ++support is enabled (i.e., CONFIG_BFQ_GROUP_IOSCHED is set), but ++CONFIG_DEBUG_BLK_CGROUP is not set (Section 4-2): ++- Intel i7-4850HQ: 400 KIOPS ++- AMD A8-3850: 250 KIOPS ++- ARM CortexTM-A53 Octa-core: 80 KIOPS ++ ++If CONFIG_DEBUG_BLK_CGROUP is set (and of course full hierarchical ++support is enabled), then the sustainable throughput with BFQ ++decreases, because all blkio.bfq* statistics are created and updated ++(Section 4-2). For BFQ, this leads to the following maximum ++sustainable throughputs, on the same systems as above: + - Intel i7-4850HQ: 310 KIOPS + - AMD A8-3850: 200 KIOPS + - ARM CortexTM-A53 Octa-core: 56 KIOPS +@@ -505,6 +515,22 @@ BFQ-specific files is "blkio.bfq." or "io.bfq." For example, the group + parameter to set the weight of a group with BFQ is blkio.bfq.weight + or io.bfq.weight. + ++As for cgroups-v1 (blkio controller), the exact set of stat files ++created, and kept up-to-date by bfq, depends on whether ++CONFIG_DEBUG_BLK_CGROUP is set. If it is set, then bfq creates all ++the stat files documented in ++Documentation/cgroup-v1/blkio-controller.txt. If, instead, ++CONFIG_DEBUG_BLK_CGROUP is not set, then bfq creates only the files ++blkio.bfq.io_service_bytes ++blkio.bfq.io_service_bytes_recursive ++blkio.bfq.io_serviced ++blkio.bfq.io_serviced_recursive ++ ++The value of CONFIG_DEBUG_BLK_CGROUP greatly influences the maximum ++throughput sustainable with bfq, because updating the blkio.bfq.* ++stats is rather costly, especially for some of the stats enabled by ++CONFIG_DEBUG_BLK_CGROUP. ++ + Parameters to set + ----------------- + +diff --git a/block/bfq-cgroup.c b/block/bfq-cgroup.c +index ceefb9a706d6..da1525ec4c87 100644 +--- a/block/bfq-cgroup.c ++++ b/block/bfq-cgroup.c +@@ -24,7 +24,7 @@ + + #include "bfq-iosched.h" + +-#ifdef CONFIG_BFQ_GROUP_IOSCHED ++#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) + + /* bfqg stats flags */ + enum bfqg_stats_flags { +@@ -152,6 +152,57 @@ void bfqg_stats_update_avg_queue_size(struct bfq_group *bfqg) + bfqg_stats_update_group_wait_time(stats); + } + ++void bfqg_stats_update_io_add(struct bfq_group *bfqg, struct bfq_queue *bfqq, ++ unsigned int op) ++{ ++ blkg_rwstat_add(&bfqg->stats.queued, op, 1); ++ bfqg_stats_end_empty_time(&bfqg->stats); ++ if (!(bfqq == ((struct bfq_data *)bfqg->bfqd)->in_service_queue)) ++ bfqg_stats_set_start_group_wait_time(bfqg, bfqq_group(bfqq)); ++} ++ ++void bfqg_stats_update_io_remove(struct bfq_group *bfqg, unsigned int op) ++{ ++ blkg_rwstat_add(&bfqg->stats.queued, op, -1); ++} ++ ++void bfqg_stats_update_io_merged(struct bfq_group *bfqg, unsigned int op) ++{ ++ blkg_rwstat_add(&bfqg->stats.merged, op, 1); ++} ++ ++void bfqg_stats_update_completion(struct bfq_group *bfqg, uint64_t start_time, ++ uint64_t io_start_time, unsigned int op) ++{ ++ struct bfqg_stats *stats = &bfqg->stats; ++ unsigned long long now = sched_clock(); ++ ++ if (time_after64(now, io_start_time)) ++ blkg_rwstat_add(&stats->service_time, op, ++ now - io_start_time); ++ if (time_after64(io_start_time, start_time)) ++ blkg_rwstat_add(&stats->wait_time, op, ++ io_start_time - start_time); ++} ++ ++#else /* CONFIG_BFQ_GROUP_IOSCHED && CONFIG_DEBUG_BLK_CGROUP */ ++ ++void bfqg_stats_update_io_add(struct bfq_group *bfqg, struct bfq_queue *bfqq, ++ unsigned int op) { } ++void bfqg_stats_update_io_remove(struct bfq_group *bfqg, unsigned int op) { } ++void bfqg_stats_update_io_merged(struct bfq_group *bfqg, unsigned int op) { } ++void bfqg_stats_update_completion(struct bfq_group *bfqg, uint64_t start_time, ++ uint64_t io_start_time, unsigned int op) { } ++void bfqg_stats_update_dequeue(struct bfq_group *bfqg) { } ++void bfqg_stats_set_start_empty_time(struct bfq_group *bfqg) { } ++void bfqg_stats_update_idle_time(struct bfq_group *bfqg) { } ++void bfqg_stats_set_start_idle_time(struct bfq_group *bfqg) { } ++void bfqg_stats_update_avg_queue_size(struct bfq_group *bfqg) { } ++ ++#endif /* CONFIG_BFQ_GROUP_IOSCHED && CONFIG_DEBUG_BLK_CGROUP */ ++ ++#ifdef CONFIG_BFQ_GROUP_IOSCHED ++ + /* + * blk-cgroup policy-related handlers + * The following functions help in converting between blk-cgroup +@@ -229,42 +280,10 @@ void bfqg_and_blkg_put(struct bfq_group *bfqg) + blkg_put(bfqg_to_blkg(bfqg)); + } + +-void bfqg_stats_update_io_add(struct bfq_group *bfqg, struct bfq_queue *bfqq, +- unsigned int op) +-{ +- blkg_rwstat_add(&bfqg->stats.queued, op, 1); +- bfqg_stats_end_empty_time(&bfqg->stats); +- if (!(bfqq == ((struct bfq_data *)bfqg->bfqd)->in_service_queue)) +- bfqg_stats_set_start_group_wait_time(bfqg, bfqq_group(bfqq)); +-} +- +-void bfqg_stats_update_io_remove(struct bfq_group *bfqg, unsigned int op) +-{ +- blkg_rwstat_add(&bfqg->stats.queued, op, -1); +-} +- +-void bfqg_stats_update_io_merged(struct bfq_group *bfqg, unsigned int op) +-{ +- blkg_rwstat_add(&bfqg->stats.merged, op, 1); +-} +- +-void bfqg_stats_update_completion(struct bfq_group *bfqg, uint64_t start_time, +- uint64_t io_start_time, unsigned int op) +-{ +- struct bfqg_stats *stats = &bfqg->stats; +- unsigned long long now = sched_clock(); +- +- if (time_after64(now, io_start_time)) +- blkg_rwstat_add(&stats->service_time, op, +- now - io_start_time); +- if (time_after64(io_start_time, start_time)) +- blkg_rwstat_add(&stats->wait_time, op, +- io_start_time - start_time); +-} +- + /* @stats = 0 */ + static void bfqg_stats_reset(struct bfqg_stats *stats) + { ++#ifdef CONFIG_DEBUG_BLK_CGROUP + /* queued stats shouldn't be cleared */ + blkg_rwstat_reset(&stats->merged); + blkg_rwstat_reset(&stats->service_time); +@@ -276,6 +295,7 @@ static void bfqg_stats_reset(struct bfqg_stats *stats) + blkg_stat_reset(&stats->group_wait_time); + blkg_stat_reset(&stats->idle_time); + blkg_stat_reset(&stats->empty_time); ++#endif + } + + /* @to += @from */ +@@ -284,6 +304,7 @@ static void bfqg_stats_add_aux(struct bfqg_stats *to, struct bfqg_stats *from) + if (!to || !from) + return; + ++#ifdef CONFIG_DEBUG_BLK_CGROUP + /* queued stats shouldn't be cleared */ + blkg_rwstat_add_aux(&to->merged, &from->merged); + blkg_rwstat_add_aux(&to->service_time, &from->service_time); +@@ -296,6 +317,7 @@ static void bfqg_stats_add_aux(struct bfqg_stats *to, struct bfqg_stats *from) + blkg_stat_add_aux(&to->group_wait_time, &from->group_wait_time); + blkg_stat_add_aux(&to->idle_time, &from->idle_time); + blkg_stat_add_aux(&to->empty_time, &from->empty_time); ++#endif + } + + /* +@@ -342,6 +364,7 @@ void bfq_init_entity(struct bfq_entity *entity, struct bfq_group *bfqg) + + static void bfqg_stats_exit(struct bfqg_stats *stats) + { ++#ifdef CONFIG_DEBUG_BLK_CGROUP + blkg_rwstat_exit(&stats->merged); + blkg_rwstat_exit(&stats->service_time); + blkg_rwstat_exit(&stats->wait_time); +@@ -353,10 +376,12 @@ static void bfqg_stats_exit(struct bfqg_stats *stats) + blkg_stat_exit(&stats->group_wait_time); + blkg_stat_exit(&stats->idle_time); + blkg_stat_exit(&stats->empty_time); ++#endif + } + + static int bfqg_stats_init(struct bfqg_stats *stats, gfp_t gfp) + { ++#ifdef CONFIG_DEBUG_BLK_CGROUP + if (blkg_rwstat_init(&stats->merged, gfp) || + blkg_rwstat_init(&stats->service_time, gfp) || + blkg_rwstat_init(&stats->wait_time, gfp) || +@@ -371,6 +396,7 @@ static int bfqg_stats_init(struct bfqg_stats *stats, gfp_t gfp) + bfqg_stats_exit(stats); + return -ENOMEM; + } ++#endif + + return 0; + } +@@ -887,6 +913,7 @@ static ssize_t bfq_io_set_weight(struct kernfs_open_file *of, + return bfq_io_set_weight_legacy(of_css(of), NULL, weight); + } + ++#ifdef CONFIG_DEBUG_BLK_CGROUP + static int bfqg_print_stat(struct seq_file *sf, void *v) + { + blkcg_print_blkgs(sf, css_to_blkcg(seq_css(sf)), blkg_prfill_stat, +@@ -991,6 +1018,7 @@ static int bfqg_print_avg_queue_size(struct seq_file *sf, void *v) + 0, false); + return 0; + } ++#endif /* CONFIG_DEBUG_BLK_CGROUP */ + + struct bfq_group *bfq_create_group_hierarchy(struct bfq_data *bfqd, int node) + { +@@ -1028,15 +1056,6 @@ struct cftype bfq_blkcg_legacy_files[] = { + }, + + /* statistics, covers only the tasks in the bfqg */ +- { +- .name = "bfq.time", +- .private = offsetof(struct bfq_group, stats.time), +- .seq_show = bfqg_print_stat, +- }, +- { +- .name = "bfq.sectors", +- .seq_show = bfqg_print_stat_sectors, +- }, + { + .name = "bfq.io_service_bytes", + .private = (unsigned long)&blkcg_policy_bfq, +@@ -1047,6 +1066,16 @@ struct cftype bfq_blkcg_legacy_files[] = { + .private = (unsigned long)&blkcg_policy_bfq, + .seq_show = blkg_print_stat_ios, + }, ++#ifdef CONFIG_DEBUG_BLK_CGROUP ++ { ++ .name = "bfq.time", ++ .private = offsetof(struct bfq_group, stats.time), ++ .seq_show = bfqg_print_stat, ++ }, ++ { ++ .name = "bfq.sectors", ++ .seq_show = bfqg_print_stat_sectors, ++ }, + { + .name = "bfq.io_service_time", + .private = offsetof(struct bfq_group, stats.service_time), +@@ -1067,17 +1096,9 @@ struct cftype bfq_blkcg_legacy_files[] = { + .private = offsetof(struct bfq_group, stats.queued), + .seq_show = bfqg_print_rwstat, + }, ++#endif /* CONFIG_DEBUG_BLK_CGROUP */ + + /* the same statictics which cover the bfqg and its descendants */ +- { +- .name = "bfq.time_recursive", +- .private = offsetof(struct bfq_group, stats.time), +- .seq_show = bfqg_print_stat_recursive, +- }, +- { +- .name = "bfq.sectors_recursive", +- .seq_show = bfqg_print_stat_sectors_recursive, +- }, + { + .name = "bfq.io_service_bytes_recursive", + .private = (unsigned long)&blkcg_policy_bfq, +@@ -1088,6 +1109,16 @@ struct cftype bfq_blkcg_legacy_files[] = { + .private = (unsigned long)&blkcg_policy_bfq, + .seq_show = blkg_print_stat_ios_recursive, + }, ++#ifdef CONFIG_DEBUG_BLK_CGROUP ++ { ++ .name = "bfq.time_recursive", ++ .private = offsetof(struct bfq_group, stats.time), ++ .seq_show = bfqg_print_stat_recursive, ++ }, ++ { ++ .name = "bfq.sectors_recursive", ++ .seq_show = bfqg_print_stat_sectors_recursive, ++ }, + { + .name = "bfq.io_service_time_recursive", + .private = offsetof(struct bfq_group, stats.service_time), +@@ -1132,6 +1163,7 @@ struct cftype bfq_blkcg_legacy_files[] = { + .private = offsetof(struct bfq_group, stats.dequeue), + .seq_show = bfqg_print_stat, + }, ++#endif /* CONFIG_DEBUG_BLK_CGROUP */ + { } /* terminate */ + }; + +@@ -1147,18 +1179,6 @@ struct cftype bfq_blkg_files[] = { + + #else /* CONFIG_BFQ_GROUP_IOSCHED */ + +-void bfqg_stats_update_io_add(struct bfq_group *bfqg, struct bfq_queue *bfqq, +- unsigned int op) { } +-void bfqg_stats_update_io_remove(struct bfq_group *bfqg, unsigned int op) { } +-void bfqg_stats_update_io_merged(struct bfq_group *bfqg, unsigned int op) { } +-void bfqg_stats_update_completion(struct bfq_group *bfqg, uint64_t start_time, +- uint64_t io_start_time, unsigned int op) { } +-void bfqg_stats_update_dequeue(struct bfq_group *bfqg) { } +-void bfqg_stats_set_start_empty_time(struct bfq_group *bfqg) { } +-void bfqg_stats_update_idle_time(struct bfq_group *bfqg) { } +-void bfqg_stats_set_start_idle_time(struct bfq_group *bfqg) { } +-void bfqg_stats_update_avg_queue_size(struct bfq_group *bfqg) { } +- + void bfq_bfqq_move(struct bfq_data *bfqd, struct bfq_queue *bfqq, + struct bfq_group *bfqg) {} + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 69e05f861daf..bcb6d21baf12 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -3693,14 +3693,14 @@ static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) + { + struct bfq_data *bfqd = hctx->queue->elevator->elevator_data; + struct request *rq; +-#ifdef CONFIG_BFQ_GROUP_IOSCHED ++#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) + struct bfq_queue *in_serv_queue, *bfqq; + bool waiting_rq, idle_timer_disabled; + #endif + + spin_lock_irq(&bfqd->lock); + +-#ifdef CONFIG_BFQ_GROUP_IOSCHED ++#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) + in_serv_queue = bfqd->in_service_queue; + waiting_rq = in_serv_queue && bfq_bfqq_wait_request(in_serv_queue); + +@@ -3714,7 +3714,7 @@ static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) + #endif + spin_unlock_irq(&bfqd->lock); + +-#ifdef CONFIG_BFQ_GROUP_IOSCHED ++#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) + bfqq = rq ? RQ_BFQQ(rq) : NULL; + if (!idle_timer_disabled && !bfqq) + return rq; +@@ -4281,7 +4281,7 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + { + struct request_queue *q = hctx->queue; + struct bfq_data *bfqd = q->elevator->elevator_data; +-#ifdef CONFIG_BFQ_GROUP_IOSCHED ++#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) + struct bfq_queue *bfqq = RQ_BFQQ(rq); + bool idle_timer_disabled = false; + unsigned int cmd_flags; +@@ -4304,7 +4304,7 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + else + list_add_tail(&rq->queuelist, &bfqd->dispatch); + } else { +-#ifdef CONFIG_BFQ_GROUP_IOSCHED ++#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) + idle_timer_disabled = __bfq_insert_request(bfqd, rq); + /* + * Update bfqq, because, if a queue merge has occurred +@@ -4323,7 +4323,7 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + } + } + +-#ifdef CONFIG_BFQ_GROUP_IOSCHED ++#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) + /* + * Cache cmd_flags before releasing scheduler lock, because rq + * may disappear afterwards (for example, because of a request +@@ -4333,7 +4333,7 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + #endif + spin_unlock_irq(&bfqd->lock); + +-#ifdef CONFIG_BFQ_GROUP_IOSCHED ++#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) + if (!bfqq) + return; + /* +diff --git a/block/bfq-iosched.h b/block/bfq-iosched.h +index ac0809c72c98..91c4390903a1 100644 +--- a/block/bfq-iosched.h ++++ b/block/bfq-iosched.h +@@ -689,7 +689,7 @@ enum bfqq_expiration { + }; + + struct bfqg_stats { +-#ifdef CONFIG_BFQ_GROUP_IOSCHED ++#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) + /* number of ios merged */ + struct blkg_rwstat merged; + /* total time spent on device in ns, may not be accurate w/ queueing */ +@@ -717,7 +717,7 @@ struct bfqg_stats { + uint64_t start_idle_time; + uint64_t start_empty_time; + uint16_t flags; +-#endif /* CONFIG_BFQ_GROUP_IOSCHED */ ++#endif /* CONFIG_BFQ_GROUP_IOSCHED && CONFIG_DEBUG_BLK_CGROUP */ + }; + + #ifdef CONFIG_BFQ_GROUP_IOSCHED +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-put-async-queues-for-root-bfq-groups-too.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-put-async-queues-for-root-bfq-groups-too.patch new file mode 100644 index 00000000..11f33137 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-put-async-queues-for-root-bfq-groups-too.patch @@ -0,0 +1,67 @@ +From 52257ffbfcaf58d247b13fb148e27ed17c33e526 Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Tue, 9 Jan 2018 10:27:58 +0100 +Subject: [PATCH] block, bfq: put async queues for root bfq groups too +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +For each pair [device for which bfq is selected as I/O scheduler, +group in blkio/io], bfq maintains a corresponding bfq group. Each such +bfq group contains a set of async queues, with each async queue +created on demand, i.e., when some I/O request arrives for it. On +creation, an async queue gets an extra reference, to make sure that +the queue is not freed as long as its bfq group exists. Accordingly, +to allow the queue to be freed after the group exited, this extra +reference must released on group exit. + +The above holds also for a bfq root group, i.e., for the bfq group +corresponding to the root blkio/io root for a given device. Yet, by +mistake, the references to the existing async queues of a root group +are not released when the latter exits. This causes a memory leak when +the instance of bfq for a given device exits. In a similar vein, +bfqg_stats_xfer_dead is not executed for a root group. + +This commit fixes bfq_pd_offline so that the latter executes the above +missing operations for a root group too. + +Reported-by: Holger Hoffstätte +Reported-by: Guoqing Jiang +Tested-by: Holger Hoffstätte +Signed-off-by: Davide Ferrari +Signed-off-by: Paolo Valente +Signed-off-by: Jens Axboe +--- + block/bfq-cgroup.c | 7 +++++-- + 1 file changed, 5 insertions(+), 2 deletions(-) + +diff --git a/block/bfq-cgroup.c b/block/bfq-cgroup.c +index da1525ec4c87..d819dc77fe65 100644 +--- a/block/bfq-cgroup.c ++++ b/block/bfq-cgroup.c +@@ -775,10 +775,11 @@ static void bfq_pd_offline(struct blkg_policy_data *pd) + unsigned long flags; + int i; + ++ spin_lock_irqsave(&bfqd->lock, flags); ++ + if (!entity) /* root group */ +- return; ++ goto put_async_queues; + +- spin_lock_irqsave(&bfqd->lock, flags); + /* + * Empty all service_trees belonging to this group before + * deactivating the group itself. +@@ -809,6 +810,8 @@ static void bfq_pd_offline(struct blkg_policy_data *pd) + } + + __bfq_deactivate_entity(entity, false); ++ ++put_async_queues: + bfq_put_async_queues(bfqd, bfqg); + + spin_unlock_irqrestore(&bfqd->lock, flags); +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-release-oom-queue-ref-to-root-group-on-exi.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-release-oom-queue-ref-to-root-group-on-exi.patch new file mode 100644 index 00000000..3f965e25 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-release-oom-queue-ref-to-root-group-on-exi.patch @@ -0,0 +1,39 @@ +From 0d52af590552473666da5b6111e7182d6cd23f92 Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Tue, 9 Jan 2018 10:27:59 +0100 +Subject: [PATCH] block, bfq: release oom-queue ref to root group on exit +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +On scheduler init, a reference to the root group, and a reference to +its corresponding blkg are taken for the oom queue. Yet these +references are not released on scheduler exit, which prevents these +objects from be freed. This commit adds the missing reference +releases. + +Reported-by: Davide Ferrari +Tested-by: Holger Hoffstätte +Signed-off-by: Paolo Valente +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 3 +++ + 1 file changed, 3 insertions(+) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 7bd789da7a29..7c0b7f60811c 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -4893,6 +4893,9 @@ static void bfq_exit_queue(struct elevator_queue *e) + + hrtimer_cancel(&bfqd->idle_slice_timer); + ++ /* release oom-queue reference to root group */ ++ bfqg_and_blkg_put(bfqd->root_group); ++ + #ifdef CONFIG_BFQ_GROUP_IOSCHED + blkcg_deactivate_policy(bfqd->queue, &blkcg_policy_bfq); + #else +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-remove-batches-of-confusing-ifdefs.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-remove-batches-of-confusing-ifdefs.patch new file mode 100644 index 00000000..be493afd --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-remove-batches-of-confusing-ifdefs.patch @@ -0,0 +1,225 @@ +From 9b25bd0368d562d1929059e8eb9de4102567b923 Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Mon, 4 Dec 2017 11:42:05 +0100 +Subject: [PATCH] block, bfq: remove batches of confusing ifdefs + +Commit a33801e8b473 ("block, bfq: move debug blkio stats behind +CONFIG_DEBUG_BLK_CGROUP") introduced two batches of confusing ifdefs: +one reported in [1], plus a similar one in another function. This +commit removes both batches, in the way suggested in [1]. + +[1] https://www.spinics.net/lists/linux-block/msg20043.html + +Fixes: a33801e8b473 ("block, bfq: move debug blkio stats behind CONFIG_DEBUG_BLK_CGROUP") +Reported-by: Linus Torvalds +Tested-by: Luca Miccio +Signed-off-by: Paolo Valente +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 127 +++++++++++++++++++++++++++++----------------------- + 1 file changed, 72 insertions(+), 55 deletions(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index e33c5c4c9856..7bd789da7a29 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -3743,35 +3743,16 @@ static struct request *__bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) + return rq; + } + +-static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) +-{ +- struct bfq_data *bfqd = hctx->queue->elevator->elevator_data; +- struct request *rq; + #if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) +- struct bfq_queue *in_serv_queue, *bfqq; +- bool waiting_rq, idle_timer_disabled; +-#endif +- +- spin_lock_irq(&bfqd->lock); +- +-#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) +- in_serv_queue = bfqd->in_service_queue; +- waiting_rq = in_serv_queue && bfq_bfqq_wait_request(in_serv_queue); +- +- rq = __bfq_dispatch_request(hctx); +- +- idle_timer_disabled = +- waiting_rq && !bfq_bfqq_wait_request(in_serv_queue); +- +-#else +- rq = __bfq_dispatch_request(hctx); +-#endif +- spin_unlock_irq(&bfqd->lock); ++static void bfq_update_dispatch_stats(struct request_queue *q, ++ struct request *rq, ++ struct bfq_queue *in_serv_queue, ++ bool idle_timer_disabled) ++{ ++ struct bfq_queue *bfqq = rq ? RQ_BFQQ(rq) : NULL; + +-#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) +- bfqq = rq ? RQ_BFQQ(rq) : NULL; + if (!idle_timer_disabled && !bfqq) +- return rq; ++ return; + + /* + * rq and bfqq are guaranteed to exist until this function +@@ -3786,7 +3767,7 @@ static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) + * In addition, the following queue lock guarantees that + * bfqq_group(bfqq) exists as well. + */ +- spin_lock_irq(hctx->queue->queue_lock); ++ spin_lock_irq(q->queue_lock); + if (idle_timer_disabled) + /* + * Since the idle timer has been disabled, +@@ -3805,9 +3786,37 @@ static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) + bfqg_stats_set_start_empty_time(bfqg); + bfqg_stats_update_io_remove(bfqg, rq->cmd_flags); + } +- spin_unlock_irq(hctx->queue->queue_lock); ++ spin_unlock_irq(q->queue_lock); ++} ++#else ++static inline void bfq_update_dispatch_stats(struct request_queue *q, ++ struct request *rq, ++ struct bfq_queue *in_serv_queue, ++ bool idle_timer_disabled) {} + #endif + ++static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) ++{ ++ struct bfq_data *bfqd = hctx->queue->elevator->elevator_data; ++ struct request *rq; ++ struct bfq_queue *in_serv_queue; ++ bool waiting_rq, idle_timer_disabled; ++ ++ spin_lock_irq(&bfqd->lock); ++ ++ in_serv_queue = bfqd->in_service_queue; ++ waiting_rq = in_serv_queue && bfq_bfqq_wait_request(in_serv_queue); ++ ++ rq = __bfq_dispatch_request(hctx); ++ ++ idle_timer_disabled = ++ waiting_rq && !bfq_bfqq_wait_request(in_serv_queue); ++ ++ spin_unlock_irq(&bfqd->lock); ++ ++ bfq_update_dispatch_stats(hctx->queue, rq, in_serv_queue, ++ idle_timer_disabled); ++ + return rq; + } + +@@ -4335,16 +4344,46 @@ static bool __bfq_insert_request(struct bfq_data *bfqd, struct request *rq) + return idle_timer_disabled; + } + ++#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) ++static void bfq_update_insert_stats(struct request_queue *q, ++ struct bfq_queue *bfqq, ++ bool idle_timer_disabled, ++ unsigned int cmd_flags) ++{ ++ if (!bfqq) ++ return; ++ ++ /* ++ * bfqq still exists, because it can disappear only after ++ * either it is merged with another queue, or the process it ++ * is associated with exits. But both actions must be taken by ++ * the same process currently executing this flow of ++ * instructions. ++ * ++ * In addition, the following queue lock guarantees that ++ * bfqq_group(bfqq) exists as well. ++ */ ++ spin_lock_irq(q->queue_lock); ++ bfqg_stats_update_io_add(bfqq_group(bfqq), bfqq, cmd_flags); ++ if (idle_timer_disabled) ++ bfqg_stats_update_idle_time(bfqq_group(bfqq)); ++ spin_unlock_irq(q->queue_lock); ++} ++#else ++static inline void bfq_update_insert_stats(struct request_queue *q, ++ struct bfq_queue *bfqq, ++ bool idle_timer_disabled, ++ unsigned int cmd_flags) {} ++#endif ++ + static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + bool at_head) + { + struct request_queue *q = hctx->queue; + struct bfq_data *bfqd = q->elevator->elevator_data; +-#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) + struct bfq_queue *bfqq = RQ_BFQQ(rq); + bool idle_timer_disabled = false; + unsigned int cmd_flags; +-#endif + + spin_lock_irq(&bfqd->lock); + if (blk_mq_sched_try_insert_merge(q, rq)) { +@@ -4363,7 +4402,6 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + else + list_add_tail(&rq->queuelist, &bfqd->dispatch); + } else { +-#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) + idle_timer_disabled = __bfq_insert_request(bfqd, rq); + /* + * Update bfqq, because, if a queue merge has occurred +@@ -4371,9 +4409,6 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + * redirected into a new queue. + */ + bfqq = RQ_BFQQ(rq); +-#else +- __bfq_insert_request(bfqd, rq); +-#endif + + if (rq_mergeable(rq)) { + elv_rqhash_add(q, rq); +@@ -4382,35 +4417,17 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + } + } + +-#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) + /* + * Cache cmd_flags before releasing scheduler lock, because rq + * may disappear afterwards (for example, because of a request + * merge). + */ + cmd_flags = rq->cmd_flags; +-#endif ++ + spin_unlock_irq(&bfqd->lock); + +-#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) +- if (!bfqq) +- return; +- /* +- * bfqq still exists, because it can disappear only after +- * either it is merged with another queue, or the process it +- * is associated with exits. But both actions must be taken by +- * the same process currently executing this flow of +- * instruction. +- * +- * In addition, the following queue lock guarantees that +- * bfqq_group(bfqq) exists as well. +- */ +- spin_lock_irq(q->queue_lock); +- bfqg_stats_update_io_add(bfqq_group(bfqq), bfqq, cmd_flags); +- if (idle_timer_disabled) +- bfqg_stats_update_idle_time(bfqq_group(bfqq)); +- spin_unlock_irq(q->queue_lock); +-#endif ++ bfq_update_insert_stats(q, bfqq, idle_timer_disabled, ++ cmd_flags); + } + + static void bfq_insert_requests(struct blk_mq_hw_ctx *hctx, +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-remove-superfluous-check-in-queue-merging-.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-remove-superfluous-check-in-queue-merging-.patch new file mode 100644 index 00000000..5a206955 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-remove-superfluous-check-in-queue-merging-.patch @@ -0,0 +1,112 @@ +From 4403e4e467c365b4189e3e3d3ad35cf67b8c36ed Mon Sep 17 00:00:00 2001 +From: Angelo Ruocco +Date: Wed, 20 Dec 2017 12:38:34 +0100 +Subject: [PATCH] block, bfq: remove superfluous check in queue-merging setup + +When two or more processes do I/O in a way that the their requests are +sequential in respect to one another, BFQ merges the bfq_queues associated +with the processes. This way the overall I/O pattern becomes sequential, +and thus there is a boost in througput. +These cooperating processes usually start or restart to do I/O shortly +after each other. So, in order to avoid merging non-cooperating processes, +BFQ ensures that none of these queues has been in weight raising for too +long. + +In this respect, from commit "block, bfq-sq, bfq-mq: let a queue be merged +only shortly after being created", BFQ checks whether any queue (and not +only weight-raised ones) is doing I/O continuously from too long to be +merged. + +This new additional check makes the first one useless: a queue doing +I/O from long enough, if being weight-raised, is also a queue in +weight raising for too long to be merged. Accordingly, this commit +removes the first check. + +Signed-off-by: Angelo Ruocco +Signed-off-by: Paolo Valente +Signed-off-by: Jens Axboe +--- + block/bfq-iosched.c | 36 +++++------------------------------- + 1 file changed, 5 insertions(+), 31 deletions(-) + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 7066d90f09df..9625550b2f85 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -1990,20 +1990,6 @@ static bool bfq_may_be_close_cooperator(struct bfq_queue *bfqq, + return true; + } + +-/* +- * If this function returns true, then bfqq cannot be merged. The idea +- * is that true cooperation happens very early after processes start +- * to do I/O. Usually, late cooperations are just accidental false +- * positives. In case bfqq is weight-raised, such false positives +- * would evidently degrade latency guarantees for bfqq. +- */ +-static bool wr_from_too_long(struct bfq_queue *bfqq) +-{ +- return bfqq->wr_coeff > 1 && +- time_is_before_jiffies(bfqq->last_wr_start_finish + +- msecs_to_jiffies(100)); +-} +- + /* + * Attempt to schedule a merge of bfqq with the currently in-service + * queue or with a close queue among the scheduled queues. Return +@@ -2017,11 +2003,6 @@ static bool wr_from_too_long(struct bfq_queue *bfqq) + * to maintain. Besides, in such a critical condition as an out of memory, + * the benefits of queue merging may be little relevant, or even negligible. + * +- * Weight-raised queues can be merged only if their weight-raising +- * period has just started. In fact cooperating processes are usually +- * started together. Thus, with this filter we avoid false positives +- * that would jeopardize low-latency guarantees. +- * + * WARNING: queue merging may impair fairness among non-weight raised + * queues, for at least two reasons: 1) the original weight of a + * merged queue may change during the merged state, 2) even being the +@@ -2052,9 +2033,7 @@ bfq_setup_cooperator(struct bfq_data *bfqd, struct bfq_queue *bfqq, + if (bfqq->new_bfqq) + return bfqq->new_bfqq; + +- if (!io_struct || +- wr_from_too_long(bfqq) || +- unlikely(bfqq == &bfqd->oom_bfqq)) ++ if (!io_struct || unlikely(bfqq == &bfqd->oom_bfqq)) + return NULL; + + /* If there is only one backlogged queue, don't search. */ +@@ -2063,12 +2042,9 @@ bfq_setup_cooperator(struct bfq_data *bfqd, struct bfq_queue *bfqq, + + in_service_bfqq = bfqd->in_service_queue; + +- if (!in_service_bfqq || in_service_bfqq == bfqq +- || wr_from_too_long(in_service_bfqq) || +- unlikely(in_service_bfqq == &bfqd->oom_bfqq)) +- goto check_scheduled; +- +- if (bfq_rq_close_to_sector(io_struct, request, bfqd->last_position) && ++ if (in_service_bfqq && in_service_bfqq != bfqq && ++ likely(in_service_bfqq != &bfqd->oom_bfqq) && ++ bfq_rq_close_to_sector(io_struct, request, bfqd->last_position) && + bfqq->entity.parent == in_service_bfqq->entity.parent && + bfq_may_be_close_cooperator(bfqq, in_service_bfqq)) { + new_bfqq = bfq_setup_merge(bfqq, in_service_bfqq); +@@ -2080,12 +2056,10 @@ bfq_setup_cooperator(struct bfq_data *bfqd, struct bfq_queue *bfqq, + * queues. The only thing we need is that the bio/request is not + * NULL, as we need it to establish whether a cooperator exists. + */ +-check_scheduled: + new_bfqq = bfq_find_close_cooperator(bfqd, bfqq, + bfq_io_struct_pos(io_struct, request)); + +- if (new_bfqq && !wr_from_too_long(new_bfqq) && +- likely(new_bfqq != &bfqd->oom_bfqq) && ++ if (new_bfqq && likely(new_bfqq != &bfqd->oom_bfqq) && + bfq_may_be_close_cooperator(bfqq, new_bfqq)) + return bfq_setup_merge(bfqq, new_bfqq); + +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-update-blkio-stats-outside-the-scheduler-l.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-update-blkio-stats-outside-the-scheduler-l.patch new file mode 100644 index 00000000..e92dd564 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/block-bfq-update-blkio-stats-outside-the-scheduler-l.patch @@ -0,0 +1,283 @@ +From 24bfd19bb7890255693ee5cb6dc100d8d215d00b Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Mon, 13 Nov 2017 07:34:09 +0100 +Subject: [PATCH] block, bfq: update blkio stats outside the scheduler lock + +bfq invokes various blkg_*stats_* functions to update the statistics +contained in the special files blkio.bfq.* in the blkio controller +groups, i.e., the I/O accounting related to the proportional-share +policy provided by bfq. The execution of these functions takes a +considerable percentage, about 40%, of the total per-request execution +time of bfq (i.e., of the sum of the execution time of all the bfq +functions that have to be executed to process an I/O request from its +creation to its destruction). This reduces the request-processing +rate sustainable by bfq noticeably, even on a multicore CPU. In fact, +the bfq functions that invoke blkg_*stats_* functions cannot be +executed in parallel with the rest of the code of bfq, because both +are executed under the same same per-device scheduler lock. + +To reduce this slowdown, this commit moves, wherever possible, the +invocation of these functions (more precisely, of the bfq functions +that invoke blkg_*stats_* functions) outside the critical sections +protected by the scheduler lock. + +With this change, and with all blkio.bfq.* statistics enabled, the +throughput grows, e.g., from 250 to 310 KIOPS (+25%) on an Intel +i7-4850HQ, in case of 8 threads doing random I/O in parallel on +null_blk, with the latter configured with 0 latency. We obtained the +same or higher throughput boosts, up to +30%, with other processors +(some figures are reported in the documentation). For our tests, we +used the script [1], with which our results can be easily reproduced. + +NOTE. This commit still protects the invocation of blkg_*stats_* +functions with the request_queue lock, because the group these +functions are invoked on may otherwise disappear before or while these +functions are executed. Fortunately, tests without even this lock +show, by difference, that the serialization caused by this lock has a +little impact (at most ~5% of throughput reduction). + +[1] https://github.com/Algodev-github/IOSpeed + +Tested-by: Lee Tibbert +Tested-by: Oleksandr Natalenko +Signed-off-by: Paolo Valente +Signed-off-by: Luca Miccio +Signed-off-by: Jens Axboe +--- + Documentation/block/bfq-iosched.txt | 6 +- + block/bfq-iosched.c | 110 ++++++++++++++++++++++++++++++++---- + block/bfq-wf2q.c | 1 - + 3 files changed, 102 insertions(+), 15 deletions(-) + +diff --git a/Documentation/block/bfq-iosched.txt b/Documentation/block/bfq-iosched.txt +index 7a9361508157..7fad6c061470 100644 +--- a/Documentation/block/bfq-iosched.txt ++++ b/Documentation/block/bfq-iosched.txt +@@ -26,9 +26,9 @@ the limits on slow or average CPUs, here are BFQ limits for three + different CPUs, on, respectively, an average laptop, an old desktop, + and a cheap embedded system, in case full hierarchical support is + enabled (i.e., CONFIG_BFQ_GROUP_IOSCHED is set): +-- Intel i7-4850HQ: 250 KIOPS +-- AMD A8-3850: 170 KIOPS +-- ARM CortexTM-A53 Octa-core: 45 KIOPS ++- Intel i7-4850HQ: 310 KIOPS ++- AMD A8-3850: 200 KIOPS ++- ARM CortexTM-A53 Octa-core: 56 KIOPS + + BFQ works for multi-queue devices too. + +diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c +index 91703eba63f0..69e05f861daf 100644 +--- a/block/bfq-iosched.c ++++ b/block/bfq-iosched.c +@@ -2228,7 +2228,6 @@ static void __bfq_set_in_service_queue(struct bfq_data *bfqd, + struct bfq_queue *bfqq) + { + if (bfqq) { +- bfqg_stats_update_avg_queue_size(bfqq_group(bfqq)); + bfq_clear_bfqq_fifo_expire(bfqq); + + bfqd->budgets_assigned = (bfqd->budgets_assigned * 7 + 256) / 8; +@@ -3469,7 +3468,6 @@ static struct bfq_queue *bfq_select_queue(struct bfq_data *bfqd) + */ + bfq_clear_bfqq_wait_request(bfqq); + hrtimer_try_to_cancel(&bfqd->idle_slice_timer); +- bfqg_stats_update_idle_time(bfqq_group(bfqq)); + } + goto keep_queue; + } +@@ -3695,15 +3693,67 @@ static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) + { + struct bfq_data *bfqd = hctx->queue->elevator->elevator_data; + struct request *rq; ++#ifdef CONFIG_BFQ_GROUP_IOSCHED ++ struct bfq_queue *in_serv_queue, *bfqq; ++ bool waiting_rq, idle_timer_disabled; ++#endif + + spin_lock_irq(&bfqd->lock); + ++#ifdef CONFIG_BFQ_GROUP_IOSCHED ++ in_serv_queue = bfqd->in_service_queue; ++ waiting_rq = in_serv_queue && bfq_bfqq_wait_request(in_serv_queue); ++ ++ rq = __bfq_dispatch_request(hctx); ++ ++ idle_timer_disabled = ++ waiting_rq && !bfq_bfqq_wait_request(in_serv_queue); ++ ++#else + rq = __bfq_dispatch_request(hctx); +- if (rq && RQ_BFQQ(rq)) +- bfqg_stats_update_io_remove(bfqq_group(RQ_BFQQ(rq)), +- rq->cmd_flags); ++#endif + spin_unlock_irq(&bfqd->lock); + ++#ifdef CONFIG_BFQ_GROUP_IOSCHED ++ bfqq = rq ? RQ_BFQQ(rq) : NULL; ++ if (!idle_timer_disabled && !bfqq) ++ return rq; ++ ++ /* ++ * rq and bfqq are guaranteed to exist until this function ++ * ends, for the following reasons. First, rq can be ++ * dispatched to the device, and then can be completed and ++ * freed, only after this function ends. Second, rq cannot be ++ * merged (and thus freed because of a merge) any longer, ++ * because it has already started. Thus rq cannot be freed ++ * before this function ends, and, since rq has a reference to ++ * bfqq, the same guarantee holds for bfqq too. ++ * ++ * In addition, the following queue lock guarantees that ++ * bfqq_group(bfqq) exists as well. ++ */ ++ spin_lock_irq(hctx->queue->queue_lock); ++ if (idle_timer_disabled) ++ /* ++ * Since the idle timer has been disabled, ++ * in_serv_queue contained some request when ++ * __bfq_dispatch_request was invoked above, which ++ * implies that rq was picked exactly from ++ * in_serv_queue. Thus in_serv_queue == bfqq, and is ++ * therefore guaranteed to exist because of the above ++ * arguments. ++ */ ++ bfqg_stats_update_idle_time(bfqq_group(in_serv_queue)); ++ if (bfqq) { ++ struct bfq_group *bfqg = bfqq_group(bfqq); ++ ++ bfqg_stats_update_avg_queue_size(bfqg); ++ bfqg_stats_set_start_empty_time(bfqg); ++ bfqg_stats_update_io_remove(bfqg, rq->cmd_flags); ++ } ++ spin_unlock_irq(hctx->queue->queue_lock); ++#endif ++ + return rq; + } + +@@ -4161,7 +4211,6 @@ static void bfq_rq_enqueued(struct bfq_data *bfqd, struct bfq_queue *bfqq, + */ + bfq_clear_bfqq_wait_request(bfqq); + hrtimer_try_to_cancel(&bfqd->idle_slice_timer); +- bfqg_stats_update_idle_time(bfqq_group(bfqq)); + + /* + * The queue is not empty, because a new request just +@@ -4176,10 +4225,12 @@ static void bfq_rq_enqueued(struct bfq_data *bfqd, struct bfq_queue *bfqq, + } + } + +-static void __bfq_insert_request(struct bfq_data *bfqd, struct request *rq) ++/* returns true if it causes the idle timer to be disabled */ ++static bool __bfq_insert_request(struct bfq_data *bfqd, struct request *rq) + { + struct bfq_queue *bfqq = RQ_BFQQ(rq), + *new_bfqq = bfq_setup_cooperator(bfqd, bfqq, rq, true); ++ bool waiting, idle_timer_disabled = false; + + if (new_bfqq) { + if (bic_to_bfqq(RQ_BIC(rq), 1) != bfqq) +@@ -4213,12 +4264,16 @@ static void __bfq_insert_request(struct bfq_data *bfqd, struct request *rq) + bfqq = new_bfqq; + } + ++ waiting = bfqq && bfq_bfqq_wait_request(bfqq); + bfq_add_request(rq); ++ idle_timer_disabled = waiting && !bfq_bfqq_wait_request(bfqq); + + rq->fifo_time = ktime_get_ns() + bfqd->bfq_fifo_expire[rq_is_sync(rq)]; + list_add_tail(&rq->queuelist, &bfqq->fifo); + + bfq_rq_enqueued(bfqd, bfqq, rq); ++ ++ return idle_timer_disabled; + } + + static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, +@@ -4226,7 +4281,11 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + { + struct request_queue *q = hctx->queue; + struct bfq_data *bfqd = q->elevator->elevator_data; ++#ifdef CONFIG_BFQ_GROUP_IOSCHED + struct bfq_queue *bfqq = RQ_BFQQ(rq); ++ bool idle_timer_disabled = false; ++ unsigned int cmd_flags; ++#endif + + spin_lock_irq(&bfqd->lock); + if (blk_mq_sched_try_insert_merge(q, rq)) { +@@ -4245,13 +4304,17 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + else + list_add_tail(&rq->queuelist, &bfqd->dispatch); + } else { +- __bfq_insert_request(bfqd, rq); ++#ifdef CONFIG_BFQ_GROUP_IOSCHED ++ idle_timer_disabled = __bfq_insert_request(bfqd, rq); + /* + * Update bfqq, because, if a queue merge has occurred + * in __bfq_insert_request, then rq has been + * redirected into a new queue. + */ + bfqq = RQ_BFQQ(rq); ++#else ++ __bfq_insert_request(bfqd, rq); ++#endif + + if (rq_mergeable(rq)) { + elv_rqhash_add(q, rq); +@@ -4260,10 +4323,35 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, + } + } + +- if (bfqq) +- bfqg_stats_update_io_add(bfqq_group(bfqq), bfqq, rq->cmd_flags); +- ++#ifdef CONFIG_BFQ_GROUP_IOSCHED ++ /* ++ * Cache cmd_flags before releasing scheduler lock, because rq ++ * may disappear afterwards (for example, because of a request ++ * merge). ++ */ ++ cmd_flags = rq->cmd_flags; ++#endif + spin_unlock_irq(&bfqd->lock); ++ ++#ifdef CONFIG_BFQ_GROUP_IOSCHED ++ if (!bfqq) ++ return; ++ /* ++ * bfqq still exists, because it can disappear only after ++ * either it is merged with another queue, or the process it ++ * is associated with exits. But both actions must be taken by ++ * the same process currently executing this flow of ++ * instruction. ++ * ++ * In addition, the following queue lock guarantees that ++ * bfqq_group(bfqq) exists as well. ++ */ ++ spin_lock_irq(q->queue_lock); ++ bfqg_stats_update_io_add(bfqq_group(bfqq), bfqq, cmd_flags); ++ if (idle_timer_disabled) ++ bfqg_stats_update_idle_time(bfqq_group(bfqq)); ++ spin_unlock_irq(q->queue_lock); ++#endif + } + + static void bfq_insert_requests(struct blk_mq_hw_ctx *hctx, +diff --git a/block/bfq-wf2q.c b/block/bfq-wf2q.c +index 414ba686a847..e495d3f9b4b0 100644 +--- a/block/bfq-wf2q.c ++++ b/block/bfq-wf2q.c +@@ -843,7 +843,6 @@ void bfq_bfqq_served(struct bfq_queue *bfqq, int served) + st->vtime += bfq_delta(served, st->wsum); + bfq_forget_idle(st); + } +- bfqg_stats_set_start_empty_time(bfqq_group(bfqq)); + bfq_log_bfqq(bfqq->bfqd, bfqq, "bfqq_served %d secs", served); + } + +-- +2.15.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-cgroups-kconfig-build-bits-for-BFQ-v7r11-4.5.0.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-cgroups-kconfig-build-bits-for-BFQ-v7r11-4.5.0.patch deleted file mode 100644 index 1d358d74..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/block-cgroups-kconfig-build-bits-for-BFQ-v7r11-4.5.0.patch +++ /dev/null @@ -1,103 +0,0 @@ -From 465ed48c05de63f5bdd34d83915f1b8998a62134 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Tue, 7 Apr 2015 13:39:12 +0200 -Subject: [PATCH 1/4] block: cgroups, kconfig, build bits for BFQ-v7r11-4.5.0 - -Update Kconfig.iosched and do the related Makefile changes to include -kernel configuration options for BFQ. Also increase the number of -policies supported by the blkio controller so that BFQ can add its -own. - -Signed-off-by: Paolo Valente -Signed-off-by: Arianna Avanzini ---- - block/Kconfig.iosched | 32 ++++++++++++++++++++++++++++++++ - block/Makefile | 1 + - include/linux/blkdev.h | 2 +- - 3 files changed, 34 insertions(+), 1 deletion(-) - -diff --git a/block/Kconfig.iosched b/block/Kconfig.iosched -index 421bef9..0ee5f0f 100644 ---- a/block/Kconfig.iosched -+++ b/block/Kconfig.iosched -@@ -39,6 +39,27 @@ config CFQ_GROUP_IOSCHED - ---help--- - Enable group IO scheduling in CFQ. - -+config IOSCHED_BFQ -+ tristate "BFQ I/O scheduler" -+ default n -+ ---help--- -+ The BFQ I/O scheduler tries to distribute bandwidth among -+ all processes according to their weights. -+ It aims at distributing the bandwidth as desired, independently of -+ the disk parameters and with any workload. It also tries to -+ guarantee low latency to interactive and soft real-time -+ applications. If compiled built-in (saying Y here), BFQ can -+ be configured to support hierarchical scheduling. -+ -+config CGROUP_BFQIO -+ bool "BFQ hierarchical scheduling support" -+ depends on CGROUPS && IOSCHED_BFQ=y -+ default n -+ ---help--- -+ Enable hierarchical scheduling in BFQ, using the cgroups -+ filesystem interface. The name of the subsystem will be -+ bfqio. -+ - choice - prompt "Default I/O scheduler" - default DEFAULT_CFQ -@@ -52,6 +73,16 @@ choice - config DEFAULT_CFQ - bool "CFQ" if IOSCHED_CFQ=y - -+ config DEFAULT_BFQ -+ bool "BFQ" if IOSCHED_BFQ=y -+ help -+ Selects BFQ as the default I/O scheduler which will be -+ used by default for all block devices. -+ The BFQ I/O scheduler aims at distributing the bandwidth -+ as desired, independently of the disk parameters and with -+ any workload. It also tries to guarantee low latency to -+ interactive and soft real-time applications. -+ - config DEFAULT_NOOP - bool "No-op" - -@@ -61,6 +92,7 @@ config DEFAULT_IOSCHED - string - default "deadline" if DEFAULT_DEADLINE - default "cfq" if DEFAULT_CFQ -+ default "bfq" if DEFAULT_BFQ - default "noop" if DEFAULT_NOOP - - endmenu -diff --git a/block/Makefile b/block/Makefile -index 36acdd7..736e91a 100644 ---- a/block/Makefile -+++ b/block/Makefile -@@ -18,6 +18,7 @@ obj-$(CONFIG_BLK_DEV_THROTTLING) += blk-throttle.o - obj-$(CONFIG_IOSCHED_NOOP) += noop-iosched.o - obj-$(CONFIG_IOSCHED_DEADLINE) += deadline-iosched.o - obj-$(CONFIG_IOSCHED_CFQ) += cfq-iosched.o -+obj-$(CONFIG_IOSCHED_BFQ) += bfq-iosched.o - - obj-$(CONFIG_BLOCK_COMPAT) += compat_ioctl.o - obj-$(CONFIG_BLK_CMDLINE_PARSER) += cmdline-parser.o -diff --git a/include/linux/blkdev.h b/include/linux/blkdev.h -index c47c358..1047d99 100644 ---- a/include/linux/blkdev.h -+++ b/include/linux/blkdev.h -@@ -45,7 +45,7 @@ struct pr_ops; - * Maximum number of blkcg policies allowed to be registered concurrently. - * Defined here to simplify include dependency. - */ --#define BLKCG_MAX_POLS 2 -+#define BLKCG_MAX_POLS 3 - - typedef void (rq_end_io_fn)(struct request *, int); - --- -2.10.0 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-introduce-the-BFQ-v7r11-I-O-sched-for-4.5.0.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-introduce-the-BFQ-v7r11-I-O-sched-for-4.5.0.patch deleted file mode 100644 index 33216e38..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/block-introduce-the-BFQ-v7r11-I-O-sched-for-4.5.0.patch +++ /dev/null @@ -1,7109 +0,0 @@ -From a43c7e21bccd510d72a003e350247b1b4c6b71c3 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Thu, 9 May 2013 19:10:02 +0200 -Subject: [PATCH 2/4] block: introduce the BFQ-v7r11 I/O sched for 4.5.0 - -The general structure is borrowed from CFQ, as much of the code for -handling I/O contexts. Over time, several useful features have been -ported from CFQ as well (details in the changelog in README.BFQ). A -(bfq_)queue is associated to each task doing I/O on a device, and each -time a scheduling decision has to be made a queue is selected and served -until it expires. - - - Slices are given in the service domain: tasks are assigned - budgets, measured in number of sectors. Once got the disk, a task - must however consume its assigned budget within a configurable - maximum time (by default, the maximum possible value of the - budgets is automatically computed to comply with this timeout). - This allows the desired latency vs "throughput boosting" tradeoff - to be set. - - - Budgets are scheduled according to a variant of WF2Q+, implemented - using an augmented rb-tree to take eligibility into account while - preserving an O(log N) overall complexity. - - - A low-latency tunable is provided; if enabled, both interactive - and soft real-time applications are guaranteed a very low latency. - - - Latency guarantees are preserved also in the presence of NCQ. - - - Also with flash-based devices, a high throughput is achieved - while still preserving latency guarantees. - - - BFQ features Early Queue Merge (EQM), a sort of fusion of the - cooperating-queue-merging and the preemption mechanisms present - in CFQ. EQM is in fact a unified mechanism that tries to get a - sequential read pattern, and hence a high throughput, with any - set of processes performing interleaved I/O over a contiguous - sequence of sectors. - - - BFQ supports full hierarchical scheduling, exporting a cgroups - interface. Since each node has a full scheduler, each group can - be assigned its own weight. - - - If the cgroups interface is not used, only I/O priorities can be - assigned to processes, with ioprio values mapped to weights - with the relation weight = IOPRIO_BE_NR - ioprio. - - - ioprio classes are served in strict priority order, i.e., lower - priority queues are not served as long as there are higher - priority queues. Among queues in the same class the bandwidth is - distributed in proportion to the weight of each queue. A very - thin extra bandwidth is however guaranteed to the Idle class, to - prevent it from starving. - -Signed-off-by: Paolo Valente -Signed-off-by: Arianna Avanzini ---- - block/Kconfig.iosched | 6 +- - block/bfq-cgroup.c | 1186 ++++++++++++++++ - block/bfq-ioc.c | 36 + - block/bfq-iosched.c | 3763 +++++++++++++++++++++++++++++++++++++++++++++++++ - block/bfq-sched.c | 1199 ++++++++++++++++ - block/bfq.h | 801 +++++++++++ - 6 files changed, 6987 insertions(+), 4 deletions(-) - create mode 100644 block/bfq-cgroup.c - create mode 100644 block/bfq-ioc.c - create mode 100644 block/bfq-iosched.c - create mode 100644 block/bfq-sched.c - create mode 100644 block/bfq.h - -diff --git a/block/Kconfig.iosched b/block/Kconfig.iosched -index 0ee5f0f..f78cd1a 100644 ---- a/block/Kconfig.iosched -+++ b/block/Kconfig.iosched -@@ -51,14 +51,12 @@ config IOSCHED_BFQ - applications. If compiled built-in (saying Y here), BFQ can - be configured to support hierarchical scheduling. - --config CGROUP_BFQIO -+config BFQ_GROUP_IOSCHED - bool "BFQ hierarchical scheduling support" - depends on CGROUPS && IOSCHED_BFQ=y - default n - ---help--- -- Enable hierarchical scheduling in BFQ, using the cgroups -- filesystem interface. The name of the subsystem will be -- bfqio. -+ Enable hierarchical scheduling in BFQ, using the blkio controller. - - choice - prompt "Default I/O scheduler" -diff --git a/block/bfq-cgroup.c b/block/bfq-cgroup.c -new file mode 100644 -index 0000000..8b08a57 ---- /dev/null -+++ b/block/bfq-cgroup.c -@@ -0,0 +1,1186 @@ -+/* -+ * BFQ: CGROUPS support. -+ * -+ * Based on ideas and code from CFQ: -+ * Copyright (C) 2003 Jens Axboe -+ * -+ * Copyright (C) 2008 Fabio Checconi -+ * Paolo Valente -+ * -+ * Copyright (C) 2010 Paolo Valente -+ * -+ * Licensed under the GPL-2 as detailed in the accompanying COPYING.BFQ -+ * file. -+ */ -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ -+/* bfqg stats flags */ -+enum bfqg_stats_flags { -+ BFQG_stats_waiting = 0, -+ BFQG_stats_idling, -+ BFQG_stats_empty, -+}; -+ -+#define BFQG_FLAG_FNS(name) \ -+static void bfqg_stats_mark_##name(struct bfqg_stats *stats) \ -+{ \ -+ stats->flags |= (1 << BFQG_stats_##name); \ -+} \ -+static void bfqg_stats_clear_##name(struct bfqg_stats *stats) \ -+{ \ -+ stats->flags &= ~(1 << BFQG_stats_##name); \ -+} \ -+static int bfqg_stats_##name(struct bfqg_stats *stats) \ -+{ \ -+ return (stats->flags & (1 << BFQG_stats_##name)) != 0; \ -+} \ -+ -+BFQG_FLAG_FNS(waiting) -+BFQG_FLAG_FNS(idling) -+BFQG_FLAG_FNS(empty) -+#undef BFQG_FLAG_FNS -+ -+/* This should be called with the queue_lock held. */ -+static void bfqg_stats_update_group_wait_time(struct bfqg_stats *stats) -+{ -+ unsigned long long now; -+ -+ if (!bfqg_stats_waiting(stats)) -+ return; -+ -+ now = sched_clock(); -+ if (time_after64(now, stats->start_group_wait_time)) -+ blkg_stat_add(&stats->group_wait_time, -+ now - stats->start_group_wait_time); -+ bfqg_stats_clear_waiting(stats); -+} -+ -+/* This should be called with the queue_lock held. */ -+static void bfqg_stats_set_start_group_wait_time(struct bfq_group *bfqg, -+ struct bfq_group *curr_bfqg) -+{ -+ struct bfqg_stats *stats = &bfqg->stats; -+ -+ if (bfqg_stats_waiting(stats)) -+ return; -+ if (bfqg == curr_bfqg) -+ return; -+ stats->start_group_wait_time = sched_clock(); -+ bfqg_stats_mark_waiting(stats); -+} -+ -+/* This should be called with the queue_lock held. */ -+static void bfqg_stats_end_empty_time(struct bfqg_stats *stats) -+{ -+ unsigned long long now; -+ -+ if (!bfqg_stats_empty(stats)) -+ return; -+ -+ now = sched_clock(); -+ if (time_after64(now, stats->start_empty_time)) -+ blkg_stat_add(&stats->empty_time, -+ now - stats->start_empty_time); -+ bfqg_stats_clear_empty(stats); -+} -+ -+static void bfqg_stats_update_dequeue(struct bfq_group *bfqg) -+{ -+ blkg_stat_add(&bfqg->stats.dequeue, 1); -+} -+ -+static void bfqg_stats_set_start_empty_time(struct bfq_group *bfqg) -+{ -+ struct bfqg_stats *stats = &bfqg->stats; -+ -+ if (blkg_rwstat_total(&stats->queued)) -+ return; -+ -+ /* -+ * group is already marked empty. This can happen if bfqq got new -+ * request in parent group and moved to this group while being added -+ * to service tree. Just ignore the event and move on. -+ */ -+ if (bfqg_stats_empty(stats)) -+ return; -+ -+ stats->start_empty_time = sched_clock(); -+ bfqg_stats_mark_empty(stats); -+} -+ -+static void bfqg_stats_update_idle_time(struct bfq_group *bfqg) -+{ -+ struct bfqg_stats *stats = &bfqg->stats; -+ -+ if (bfqg_stats_idling(stats)) { -+ unsigned long long now = sched_clock(); -+ -+ if (time_after64(now, stats->start_idle_time)) -+ blkg_stat_add(&stats->idle_time, -+ now - stats->start_idle_time); -+ bfqg_stats_clear_idling(stats); -+ } -+} -+ -+static void bfqg_stats_set_start_idle_time(struct bfq_group *bfqg) -+{ -+ struct bfqg_stats *stats = &bfqg->stats; -+ -+ stats->start_idle_time = sched_clock(); -+ bfqg_stats_mark_idling(stats); -+} -+ -+static void bfqg_stats_update_avg_queue_size(struct bfq_group *bfqg) -+{ -+ struct bfqg_stats *stats = &bfqg->stats; -+ -+ blkg_stat_add(&stats->avg_queue_size_sum, -+ blkg_rwstat_total(&stats->queued)); -+ blkg_stat_add(&stats->avg_queue_size_samples, 1); -+ bfqg_stats_update_group_wait_time(stats); -+} -+ -+static struct blkcg_policy blkcg_policy_bfq; -+ -+/* -+ * blk-cgroup policy-related handlers -+ * The following functions help in converting between blk-cgroup -+ * internal structures and BFQ-specific structures. -+ */ -+ -+static struct bfq_group *pd_to_bfqg(struct blkg_policy_data *pd) -+{ -+ return pd ? container_of(pd, struct bfq_group, pd) : NULL; -+} -+ -+static struct blkcg_gq *bfqg_to_blkg(struct bfq_group *bfqg) -+{ -+ return pd_to_blkg(&bfqg->pd); -+} -+ -+static struct bfq_group *blkg_to_bfqg(struct blkcg_gq *blkg) -+{ -+ struct blkg_policy_data *pd = blkg_to_pd(blkg, &blkcg_policy_bfq); -+ -+ BUG_ON(!pd); -+ -+ return pd_to_bfqg(pd); -+} -+ -+/* -+ * bfq_group handlers -+ * The following functions help in navigating the bfq_group hierarchy -+ * by allowing to find the parent of a bfq_group or the bfq_group -+ * associated to a bfq_queue. -+ */ -+ -+static struct bfq_group *bfqg_parent(struct bfq_group *bfqg) -+{ -+ struct blkcg_gq *pblkg = bfqg_to_blkg(bfqg)->parent; -+ -+ return pblkg ? blkg_to_bfqg(pblkg) : NULL; -+} -+ -+static struct bfq_group *bfqq_group(struct bfq_queue *bfqq) -+{ -+ struct bfq_entity *group_entity = bfqq->entity.parent; -+ -+ return group_entity ? container_of(group_entity, struct bfq_group, -+ entity) : -+ bfqq->bfqd->root_group; -+} -+ -+/* -+ * The following two functions handle get and put of a bfq_group by -+ * wrapping the related blk-cgroup hooks. -+ */ -+ -+static void bfqg_get(struct bfq_group *bfqg) -+{ -+ return blkg_get(bfqg_to_blkg(bfqg)); -+} -+ -+static void bfqg_put(struct bfq_group *bfqg) -+{ -+ return blkg_put(bfqg_to_blkg(bfqg)); -+} -+ -+static void bfqg_stats_update_io_add(struct bfq_group *bfqg, -+ struct bfq_queue *bfqq, -+ int rw) -+{ -+ blkg_rwstat_add(&bfqg->stats.queued, rw, 1); -+ bfqg_stats_end_empty_time(&bfqg->stats); -+ if (!(bfqq == ((struct bfq_data *)bfqg->bfqd)->in_service_queue)) -+ bfqg_stats_set_start_group_wait_time(bfqg, bfqq_group(bfqq)); -+} -+ -+static void bfqg_stats_update_io_remove(struct bfq_group *bfqg, int rw) -+{ -+ blkg_rwstat_add(&bfqg->stats.queued, rw, -1); -+} -+ -+static void bfqg_stats_update_io_merged(struct bfq_group *bfqg, int rw) -+{ -+ blkg_rwstat_add(&bfqg->stats.merged, rw, 1); -+} -+ -+static void bfqg_stats_update_dispatch(struct bfq_group *bfqg, -+ uint64_t bytes, int rw) -+{ -+ blkg_stat_add(&bfqg->stats.sectors, bytes >> 9); -+ blkg_rwstat_add(&bfqg->stats.serviced, rw, 1); -+ blkg_rwstat_add(&bfqg->stats.service_bytes, rw, bytes); -+} -+ -+static void bfqg_stats_update_completion(struct bfq_group *bfqg, -+ uint64_t start_time, uint64_t io_start_time, int rw) -+{ -+ struct bfqg_stats *stats = &bfqg->stats; -+ unsigned long long now = sched_clock(); -+ -+ if (time_after64(now, io_start_time)) -+ blkg_rwstat_add(&stats->service_time, rw, now - io_start_time); -+ if (time_after64(io_start_time, start_time)) -+ blkg_rwstat_add(&stats->wait_time, rw, -+ io_start_time - start_time); -+} -+ -+/* @stats = 0 */ -+static void bfqg_stats_reset(struct bfqg_stats *stats) -+{ -+ if (!stats) -+ return; -+ -+ /* queued stats shouldn't be cleared */ -+ blkg_rwstat_reset(&stats->service_bytes); -+ blkg_rwstat_reset(&stats->serviced); -+ blkg_rwstat_reset(&stats->merged); -+ blkg_rwstat_reset(&stats->service_time); -+ blkg_rwstat_reset(&stats->wait_time); -+ blkg_stat_reset(&stats->time); -+ blkg_stat_reset(&stats->unaccounted_time); -+ blkg_stat_reset(&stats->avg_queue_size_sum); -+ blkg_stat_reset(&stats->avg_queue_size_samples); -+ blkg_stat_reset(&stats->dequeue); -+ blkg_stat_reset(&stats->group_wait_time); -+ blkg_stat_reset(&stats->idle_time); -+ blkg_stat_reset(&stats->empty_time); -+} -+ -+/* @to += @from */ -+static void bfqg_stats_merge(struct bfqg_stats *to, struct bfqg_stats *from) -+{ -+ if (!to || !from) -+ return; -+ -+ /* queued stats shouldn't be cleared */ -+ blkg_rwstat_add_aux(&to->service_bytes, &from->service_bytes); -+ blkg_rwstat_add_aux(&to->serviced, &from->serviced); -+ blkg_rwstat_add_aux(&to->merged, &from->merged); -+ blkg_rwstat_add_aux(&to->service_time, &from->service_time); -+ blkg_rwstat_add_aux(&to->wait_time, &from->wait_time); -+ blkg_stat_add_aux(&from->time, &from->time); -+ blkg_stat_add_aux(&to->unaccounted_time, &from->unaccounted_time); -+ blkg_stat_add_aux(&to->avg_queue_size_sum, &from->avg_queue_size_sum); -+ blkg_stat_add_aux(&to->avg_queue_size_samples, -+ &from->avg_queue_size_samples); -+ blkg_stat_add_aux(&to->dequeue, &from->dequeue); -+ blkg_stat_add_aux(&to->group_wait_time, &from->group_wait_time); -+ blkg_stat_add_aux(&to->idle_time, &from->idle_time); -+ blkg_stat_add_aux(&to->empty_time, &from->empty_time); -+} -+ -+/* -+ * Transfer @bfqg's stats to its parent's dead_stats so that the ancestors' -+ * recursive stats can still account for the amount used by this bfqg after -+ * it's gone. -+ */ -+static void bfqg_stats_xfer_dead(struct bfq_group *bfqg) -+{ -+ struct bfq_group *parent; -+ -+ if (!bfqg) /* root_group */ -+ return; -+ -+ parent = bfqg_parent(bfqg); -+ -+ lockdep_assert_held(bfqg_to_blkg(bfqg)->q->queue_lock); -+ -+ if (unlikely(!parent)) -+ return; -+ -+ bfqg_stats_merge(&parent->dead_stats, &bfqg->stats); -+ bfqg_stats_merge(&parent->dead_stats, &bfqg->dead_stats); -+ bfqg_stats_reset(&bfqg->stats); -+ bfqg_stats_reset(&bfqg->dead_stats); -+} -+ -+static void bfq_init_entity(struct bfq_entity *entity, -+ struct bfq_group *bfqg) -+{ -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ -+ entity->weight = entity->new_weight; -+ entity->orig_weight = entity->new_weight; -+ if (bfqq) { -+ bfqq->ioprio = bfqq->new_ioprio; -+ bfqq->ioprio_class = bfqq->new_ioprio_class; -+ bfqg_get(bfqg); -+ } -+ entity->parent = bfqg->my_entity; -+ entity->sched_data = &bfqg->sched_data; -+} -+ -+static void bfqg_stats_exit(struct bfqg_stats *stats) -+{ -+ blkg_rwstat_exit(&stats->service_bytes); -+ blkg_rwstat_exit(&stats->serviced); -+ blkg_rwstat_exit(&stats->merged); -+ blkg_rwstat_exit(&stats->service_time); -+ blkg_rwstat_exit(&stats->wait_time); -+ blkg_rwstat_exit(&stats->queued); -+ blkg_stat_exit(&stats->sectors); -+ blkg_stat_exit(&stats->time); -+ blkg_stat_exit(&stats->unaccounted_time); -+ blkg_stat_exit(&stats->avg_queue_size_sum); -+ blkg_stat_exit(&stats->avg_queue_size_samples); -+ blkg_stat_exit(&stats->dequeue); -+ blkg_stat_exit(&stats->group_wait_time); -+ blkg_stat_exit(&stats->idle_time); -+ blkg_stat_exit(&stats->empty_time); -+} -+ -+static int bfqg_stats_init(struct bfqg_stats *stats, gfp_t gfp) -+{ -+ if (blkg_rwstat_init(&stats->service_bytes, gfp) || -+ blkg_rwstat_init(&stats->serviced, gfp) || -+ blkg_rwstat_init(&stats->merged, gfp) || -+ blkg_rwstat_init(&stats->service_time, gfp) || -+ blkg_rwstat_init(&stats->wait_time, gfp) || -+ blkg_rwstat_init(&stats->queued, gfp) || -+ blkg_stat_init(&stats->sectors, gfp) || -+ blkg_stat_init(&stats->time, gfp) || -+ blkg_stat_init(&stats->unaccounted_time, gfp) || -+ blkg_stat_init(&stats->avg_queue_size_sum, gfp) || -+ blkg_stat_init(&stats->avg_queue_size_samples, gfp) || -+ blkg_stat_init(&stats->dequeue, gfp) || -+ blkg_stat_init(&stats->group_wait_time, gfp) || -+ blkg_stat_init(&stats->idle_time, gfp) || -+ blkg_stat_init(&stats->empty_time, gfp)) { -+ bfqg_stats_exit(stats); -+ return -ENOMEM; -+ } -+ -+ return 0; -+} -+ -+static struct bfq_group_data *cpd_to_bfqgd(struct blkcg_policy_data *cpd) -+{ -+ return cpd ? container_of(cpd, struct bfq_group_data, pd) : NULL; -+} -+ -+static struct bfq_group_data *blkcg_to_bfqgd(struct blkcg *blkcg) -+{ -+ return cpd_to_bfqgd(blkcg_to_cpd(blkcg, &blkcg_policy_bfq)); -+} -+ -+static void bfq_cpd_init(struct blkcg_policy_data *cpd) -+{ -+ struct bfq_group_data *d = cpd_to_bfqgd(cpd); -+ -+ d->weight = BFQ_DEFAULT_GRP_WEIGHT; -+} -+ -+static struct blkg_policy_data *bfq_pd_alloc(gfp_t gfp, int node) -+{ -+ struct bfq_group *bfqg; -+ -+ bfqg = kzalloc_node(sizeof(*bfqg), gfp, node); -+ if (!bfqg) -+ return NULL; -+ -+ if (bfqg_stats_init(&bfqg->stats, gfp) || -+ bfqg_stats_init(&bfqg->dead_stats, gfp)) { -+ kfree(bfqg); -+ return NULL; -+ } -+ -+ return &bfqg->pd; -+} -+ -+static void bfq_group_set_parent(struct bfq_group *bfqg, -+ struct bfq_group *parent) -+{ -+ struct bfq_entity *entity; -+ -+ BUG_ON(!parent); -+ BUG_ON(!bfqg); -+ BUG_ON(bfqg == parent); -+ -+ entity = &bfqg->entity; -+ entity->parent = parent->my_entity; -+ entity->sched_data = &parent->sched_data; -+} -+ -+static void bfq_pd_init(struct blkg_policy_data *pd) -+{ -+ struct blkcg_gq *blkg = pd_to_blkg(pd); -+ struct bfq_group *bfqg = blkg_to_bfqg(blkg); -+ struct bfq_data *bfqd = blkg->q->elevator->elevator_data; -+ struct bfq_entity *entity = &bfqg->entity; -+ struct bfq_group_data *d = blkcg_to_bfqgd(blkg->blkcg); -+ -+ entity->orig_weight = entity->weight = entity->new_weight = d->weight; -+ entity->my_sched_data = &bfqg->sched_data; -+ bfqg->my_entity = entity; /* -+ * the root_group's will be set to NULL -+ * in bfq_init_queue() -+ */ -+ bfqg->bfqd = bfqd; -+ bfqg->active_entities = 0; -+} -+ -+static void bfq_pd_free(struct blkg_policy_data *pd) -+{ -+ struct bfq_group *bfqg = pd_to_bfqg(pd); -+ -+ bfqg_stats_exit(&bfqg->stats); -+ bfqg_stats_exit(&bfqg->dead_stats); -+ -+ return kfree(bfqg); -+} -+ -+/* offset delta from bfqg->stats to bfqg->dead_stats */ -+static const int dead_stats_off_delta = offsetof(struct bfq_group, dead_stats) - -+ offsetof(struct bfq_group, stats); -+ -+/* to be used by recursive prfill, sums live and dead stats recursively */ -+static u64 bfqg_stat_pd_recursive_sum(struct blkg_policy_data *pd, int off) -+{ -+ u64 sum = 0; -+ -+ sum += blkg_stat_recursive_sum(pd_to_blkg(pd), &blkcg_policy_bfq, off); -+ sum += blkg_stat_recursive_sum(pd_to_blkg(pd), &blkcg_policy_bfq, -+ off + dead_stats_off_delta); -+ return sum; -+} -+ -+/* to be used by recursive prfill, sums live and dead rwstats recursively */ -+static struct blkg_rwstat -+bfqg_rwstat_pd_recursive_sum(struct blkg_policy_data *pd, int off) -+{ -+ struct blkg_rwstat a, b; -+ -+ a = blkg_rwstat_recursive_sum(pd_to_blkg(pd), &blkcg_policy_bfq, off); -+ b = blkg_rwstat_recursive_sum(pd_to_blkg(pd), &blkcg_policy_bfq, -+ off + dead_stats_off_delta); -+ blkg_rwstat_add_aux(&a, &b); -+ return a; -+} -+ -+static void bfq_pd_reset_stats(struct blkg_policy_data *pd) -+{ -+ struct bfq_group *bfqg = pd_to_bfqg(pd); -+ -+ bfqg_stats_reset(&bfqg->stats); -+ bfqg_stats_reset(&bfqg->dead_stats); -+} -+ -+static struct bfq_group *bfq_find_alloc_group(struct bfq_data *bfqd, -+ struct blkcg *blkcg) -+{ -+ struct request_queue *q = bfqd->queue; -+ struct bfq_group *bfqg = NULL, *parent; -+ struct bfq_entity *entity = NULL; -+ -+ assert_spin_locked(bfqd->queue->queue_lock); -+ -+ /* avoid lookup for the common case where there's no blkcg */ -+ if (blkcg == &blkcg_root) { -+ bfqg = bfqd->root_group; -+ } else { -+ struct blkcg_gq *blkg; -+ -+ blkg = blkg_lookup_create(blkcg, q); -+ if (!IS_ERR(blkg)) -+ bfqg = blkg_to_bfqg(blkg); -+ else /* fallback to root_group */ -+ bfqg = bfqd->root_group; -+ } -+ -+ BUG_ON(!bfqg); -+ -+ /* -+ * Update chain of bfq_groups as we might be handling a leaf group -+ * which, along with some of its relatives, has not been hooked yet -+ * to the private hierarchy of BFQ. -+ */ -+ entity = &bfqg->entity; -+ for_each_entity(entity) { -+ bfqg = container_of(entity, struct bfq_group, entity); -+ BUG_ON(!bfqg); -+ if (bfqg != bfqd->root_group) { -+ parent = bfqg_parent(bfqg); -+ if (!parent) -+ parent = bfqd->root_group; -+ BUG_ON(!parent); -+ bfq_group_set_parent(bfqg, parent); -+ } -+ } -+ -+ return bfqg; -+} -+ -+/** -+ * bfq_bfqq_move - migrate @bfqq to @bfqg. -+ * @bfqd: queue descriptor. -+ * @bfqq: the queue to move. -+ * @entity: @bfqq's entity. -+ * @bfqg: the group to move to. -+ * -+ * Move @bfqq to @bfqg, deactivating it from its old group and reactivating -+ * it on the new one. Avoid putting the entity on the old group idle tree. -+ * -+ * Must be called under the queue lock; the cgroup owning @bfqg must -+ * not disappear (by now this just means that we are called under -+ * rcu_read_lock()). -+ */ -+static void bfq_bfqq_move(struct bfq_data *bfqd, struct bfq_queue *bfqq, -+ struct bfq_entity *entity, struct bfq_group *bfqg) -+{ -+ int busy, resume; -+ -+ busy = bfq_bfqq_busy(bfqq); -+ resume = !RB_EMPTY_ROOT(&bfqq->sort_list); -+ -+ BUG_ON(resume && !entity->on_st); -+ BUG_ON(busy && !resume && entity->on_st && -+ bfqq != bfqd->in_service_queue); -+ -+ if (busy) { -+ BUG_ON(atomic_read(&bfqq->ref) < 2); -+ -+ if (!resume) -+ bfq_del_bfqq_busy(bfqd, bfqq, 0); -+ else -+ bfq_deactivate_bfqq(bfqd, bfqq, 0); -+ } else if (entity->on_st) -+ bfq_put_idle_entity(bfq_entity_service_tree(entity), entity); -+ bfqg_put(bfqq_group(bfqq)); -+ -+ /* -+ * Here we use a reference to bfqg. We don't need a refcounter -+ * as the cgroup reference will not be dropped, so that its -+ * destroy() callback will not be invoked. -+ */ -+ entity->parent = bfqg->my_entity; -+ entity->sched_data = &bfqg->sched_data; -+ bfqg_get(bfqg); -+ -+ if (busy) { -+ if (resume) -+ bfq_activate_bfqq(bfqd, bfqq); -+ } -+ -+ if (!bfqd->in_service_queue && !bfqd->rq_in_driver) -+ bfq_schedule_dispatch(bfqd); -+} -+ -+/** -+ * __bfq_bic_change_cgroup - move @bic to @cgroup. -+ * @bfqd: the queue descriptor. -+ * @bic: the bic to move. -+ * @blkcg: the blk-cgroup to move to. -+ * -+ * Move bic to blkcg, assuming that bfqd->queue is locked; the caller -+ * has to make sure that the reference to cgroup is valid across the call. -+ * -+ * NOTE: an alternative approach might have been to store the current -+ * cgroup in bfqq and getting a reference to it, reducing the lookup -+ * time here, at the price of slightly more complex code. -+ */ -+static struct bfq_group *__bfq_bic_change_cgroup(struct bfq_data *bfqd, -+ struct bfq_io_cq *bic, -+ struct blkcg *blkcg) -+{ -+ struct bfq_queue *async_bfqq = bic_to_bfqq(bic, 0); -+ struct bfq_queue *sync_bfqq = bic_to_bfqq(bic, 1); -+ struct bfq_group *bfqg; -+ struct bfq_entity *entity; -+ -+ lockdep_assert_held(bfqd->queue->queue_lock); -+ -+ bfqg = bfq_find_alloc_group(bfqd, blkcg); -+ if (async_bfqq) { -+ entity = &async_bfqq->entity; -+ -+ if (entity->sched_data != &bfqg->sched_data) { -+ bic_set_bfqq(bic, NULL, 0); -+ bfq_log_bfqq(bfqd, async_bfqq, -+ "bic_change_group: %p %d", -+ async_bfqq, atomic_read(&async_bfqq->ref)); -+ bfq_put_queue(async_bfqq); -+ } -+ } -+ -+ if (sync_bfqq) { -+ entity = &sync_bfqq->entity; -+ if (entity->sched_data != &bfqg->sched_data) -+ bfq_bfqq_move(bfqd, sync_bfqq, entity, bfqg); -+ } -+ -+ return bfqg; -+} -+ -+static void bfq_bic_update_cgroup(struct bfq_io_cq *bic, struct bio *bio) -+{ -+ struct bfq_data *bfqd = bic_to_bfqd(bic); -+ struct blkcg *blkcg; -+ struct bfq_group *bfqg = NULL; -+ uint64_t id; -+ -+ rcu_read_lock(); -+ blkcg = bio_blkcg(bio); -+ id = blkcg->css.serial_nr; -+ rcu_read_unlock(); -+ -+ /* -+ * Check whether blkcg has changed. The condition may trigger -+ * spuriously on a newly created cic but there's no harm. -+ */ -+ if (unlikely(!bfqd) || likely(bic->blkcg_id == id)) -+ return; -+ -+ bfqg = __bfq_bic_change_cgroup(bfqd, bic, blkcg); -+ BUG_ON(!bfqg); -+ bic->blkcg_id = id; -+} -+ -+/** -+ * bfq_flush_idle_tree - deactivate any entity on the idle tree of @st. -+ * @st: the service tree being flushed. -+ */ -+static void bfq_flush_idle_tree(struct bfq_service_tree *st) -+{ -+ struct bfq_entity *entity = st->first_idle; -+ -+ for (; entity ; entity = st->first_idle) -+ __bfq_deactivate_entity(entity, 0); -+} -+ -+/** -+ * bfq_reparent_leaf_entity - move leaf entity to the root_group. -+ * @bfqd: the device data structure with the root group. -+ * @entity: the entity to move. -+ */ -+static void bfq_reparent_leaf_entity(struct bfq_data *bfqd, -+ struct bfq_entity *entity) -+{ -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ -+ BUG_ON(!bfqq); -+ bfq_bfqq_move(bfqd, bfqq, entity, bfqd->root_group); -+} -+ -+/** -+ * bfq_reparent_active_entities - move to the root group all active -+ * entities. -+ * @bfqd: the device data structure with the root group. -+ * @bfqg: the group to move from. -+ * @st: the service tree with the entities. -+ * -+ * Needs queue_lock to be taken and reference to be valid over the call. -+ */ -+static void bfq_reparent_active_entities(struct bfq_data *bfqd, -+ struct bfq_group *bfqg, -+ struct bfq_service_tree *st) -+{ -+ struct rb_root *active = &st->active; -+ struct bfq_entity *entity = NULL; -+ -+ if (!RB_EMPTY_ROOT(&st->active)) -+ entity = bfq_entity_of(rb_first(active)); -+ -+ for (; entity ; entity = bfq_entity_of(rb_first(active))) -+ bfq_reparent_leaf_entity(bfqd, entity); -+ -+ if (bfqg->sched_data.in_service_entity) -+ bfq_reparent_leaf_entity(bfqd, -+ bfqg->sched_data.in_service_entity); -+} -+ -+/** -+ * bfq_destroy_group - destroy @bfqg. -+ * @bfqg: the group being destroyed. -+ * -+ * Destroy @bfqg, making sure that it is not referenced from its parent. -+ * blkio already grabs the queue_lock for us, so no need to use RCU-based magic -+ */ -+static void bfq_pd_offline(struct blkg_policy_data *pd) -+{ -+ struct bfq_service_tree *st; -+ struct bfq_group *bfqg; -+ struct bfq_data *bfqd; -+ struct bfq_entity *entity; -+ int i; -+ -+ BUG_ON(!pd); -+ bfqg = pd_to_bfqg(pd); -+ BUG_ON(!bfqg); -+ bfqd = bfqg->bfqd; -+ BUG_ON(bfqd && !bfqd->root_group); -+ -+ entity = bfqg->my_entity; -+ -+ if (!entity) /* root group */ -+ return; -+ -+ /* -+ * Empty all service_trees belonging to this group before -+ * deactivating the group itself. -+ */ -+ for (i = 0; i < BFQ_IOPRIO_CLASSES; i++) { -+ BUG_ON(!bfqg->sched_data.service_tree); -+ st = bfqg->sched_data.service_tree + i; -+ /* -+ * The idle tree may still contain bfq_queues belonging -+ * to exited task because they never migrated to a different -+ * cgroup from the one being destroyed now. No one else -+ * can access them so it's safe to act without any lock. -+ */ -+ bfq_flush_idle_tree(st); -+ -+ /* -+ * It may happen that some queues are still active -+ * (busy) upon group destruction (if the corresponding -+ * processes have been forced to terminate). We move -+ * all the leaf entities corresponding to these queues -+ * to the root_group. -+ * Also, it may happen that the group has an entity -+ * in service, which is disconnected from the active -+ * tree: it must be moved, too. -+ * There is no need to put the sync queues, as the -+ * scheduler has taken no reference. -+ */ -+ bfq_reparent_active_entities(bfqd, bfqg, st); -+ BUG_ON(!RB_EMPTY_ROOT(&st->active)); -+ BUG_ON(!RB_EMPTY_ROOT(&st->idle)); -+ } -+ BUG_ON(bfqg->sched_data.next_in_service); -+ BUG_ON(bfqg->sched_data.in_service_entity); -+ -+ __bfq_deactivate_entity(entity, 0); -+ bfq_put_async_queues(bfqd, bfqg); -+ BUG_ON(entity->tree); -+ -+ bfqg_stats_xfer_dead(bfqg); -+} -+ -+static void bfq_end_wr_async(struct bfq_data *bfqd) -+{ -+ struct blkcg_gq *blkg; -+ -+ list_for_each_entry(blkg, &bfqd->queue->blkg_list, q_node) { -+ struct bfq_group *bfqg = blkg_to_bfqg(blkg); -+ -+ bfq_end_wr_async_queues(bfqd, bfqg); -+ } -+ bfq_end_wr_async_queues(bfqd, bfqd->root_group); -+} -+ -+static u64 bfqio_cgroup_weight_read(struct cgroup_subsys_state *css, -+ struct cftype *cftype) -+{ -+ struct blkcg *blkcg = css_to_blkcg(css); -+ struct bfq_group_data *bfqgd = blkcg_to_bfqgd(blkcg); -+ int ret = -EINVAL; -+ -+ spin_lock_irq(&blkcg->lock); -+ ret = bfqgd->weight; -+ spin_unlock_irq(&blkcg->lock); -+ -+ return ret; -+} -+ -+static int bfqio_cgroup_weight_read_dfl(struct seq_file *sf, void *v) -+{ -+ struct blkcg *blkcg = css_to_blkcg(seq_css(sf)); -+ struct bfq_group_data *bfqgd = blkcg_to_bfqgd(blkcg); -+ -+ spin_lock_irq(&blkcg->lock); -+ seq_printf(sf, "%u\n", bfqgd->weight); -+ spin_unlock_irq(&blkcg->lock); -+ -+ return 0; -+} -+ -+static int bfqio_cgroup_weight_write(struct cgroup_subsys_state *css, -+ struct cftype *cftype, -+ u64 val) -+{ -+ struct blkcg *blkcg = css_to_blkcg(css); -+ struct bfq_group_data *bfqgd = blkcg_to_bfqgd(blkcg); -+ struct blkcg_gq *blkg; -+ int ret = -EINVAL; -+ -+ if (val < BFQ_MIN_WEIGHT || val > BFQ_MAX_WEIGHT) -+ return ret; -+ -+ ret = 0; -+ spin_lock_irq(&blkcg->lock); -+ bfqgd->weight = (unsigned short)val; -+ hlist_for_each_entry(blkg, &blkcg->blkg_list, blkcg_node) { -+ struct bfq_group *bfqg = blkg_to_bfqg(blkg); -+ -+ if (!bfqg) -+ continue; -+ /* -+ * Setting the prio_changed flag of the entity -+ * to 1 with new_weight == weight would re-set -+ * the value of the weight to its ioprio mapping. -+ * Set the flag only if necessary. -+ */ -+ if ((unsigned short)val != bfqg->entity.new_weight) { -+ bfqg->entity.new_weight = (unsigned short)val; -+ /* -+ * Make sure that the above new value has been -+ * stored in bfqg->entity.new_weight before -+ * setting the prio_changed flag. In fact, -+ * this flag may be read asynchronously (in -+ * critical sections protected by a different -+ * lock than that held here), and finding this -+ * flag set may cause the execution of the code -+ * for updating parameters whose value may -+ * depend also on bfqg->entity.new_weight (in -+ * __bfq_entity_update_weight_prio). -+ * This barrier makes sure that the new value -+ * of bfqg->entity.new_weight is correctly -+ * seen in that code. -+ */ -+ smp_wmb(); -+ bfqg->entity.prio_changed = 1; -+ } -+ } -+ spin_unlock_irq(&blkcg->lock); -+ -+ return ret; -+} -+ -+static ssize_t bfqio_cgroup_weight_write_dfl(struct kernfs_open_file *of, -+ char *buf, size_t nbytes, -+ loff_t off) -+{ -+ /* First unsigned long found in the file is used */ -+ return bfqio_cgroup_weight_write(of_css(of), NULL, -+ simple_strtoull(strim(buf), NULL, 0)); -+} -+ -+static int bfqg_print_stat(struct seq_file *sf, void *v) -+{ -+ blkcg_print_blkgs(sf, css_to_blkcg(seq_css(sf)), blkg_prfill_stat, -+ &blkcg_policy_bfq, seq_cft(sf)->private, false); -+ return 0; -+} -+ -+static int bfqg_print_rwstat(struct seq_file *sf, void *v) -+{ -+ blkcg_print_blkgs(sf, css_to_blkcg(seq_css(sf)), blkg_prfill_rwstat, -+ &blkcg_policy_bfq, seq_cft(sf)->private, true); -+ return 0; -+} -+ -+static u64 bfqg_prfill_stat_recursive(struct seq_file *sf, -+ struct blkg_policy_data *pd, int off) -+{ -+ u64 sum = bfqg_stat_pd_recursive_sum(pd, off); -+ -+ return __blkg_prfill_u64(sf, pd, sum); -+} -+ -+static u64 bfqg_prfill_rwstat_recursive(struct seq_file *sf, -+ struct blkg_policy_data *pd, int off) -+{ -+ struct blkg_rwstat sum = bfqg_rwstat_pd_recursive_sum(pd, off); -+ -+ return __blkg_prfill_rwstat(sf, pd, &sum); -+} -+ -+static int bfqg_print_stat_recursive(struct seq_file *sf, void *v) -+{ -+ blkcg_print_blkgs(sf, css_to_blkcg(seq_css(sf)), -+ bfqg_prfill_stat_recursive, &blkcg_policy_bfq, -+ seq_cft(sf)->private, false); -+ return 0; -+} -+ -+static int bfqg_print_rwstat_recursive(struct seq_file *sf, void *v) -+{ -+ blkcg_print_blkgs(sf, css_to_blkcg(seq_css(sf)), -+ bfqg_prfill_rwstat_recursive, &blkcg_policy_bfq, -+ seq_cft(sf)->private, true); -+ return 0; -+} -+ -+static u64 bfqg_prfill_avg_queue_size(struct seq_file *sf, -+ struct blkg_policy_data *pd, int off) -+{ -+ struct bfq_group *bfqg = pd_to_bfqg(pd); -+ u64 samples = blkg_stat_read(&bfqg->stats.avg_queue_size_samples); -+ u64 v = 0; -+ -+ if (samples) { -+ v = blkg_stat_read(&bfqg->stats.avg_queue_size_sum); -+ v = div64_u64(v, samples); -+ } -+ __blkg_prfill_u64(sf, pd, v); -+ return 0; -+} -+ -+/* print avg_queue_size */ -+static int bfqg_print_avg_queue_size(struct seq_file *sf, void *v) -+{ -+ blkcg_print_blkgs(sf, css_to_blkcg(seq_css(sf)), -+ bfqg_prfill_avg_queue_size, &blkcg_policy_bfq, -+ 0, false); -+ return 0; -+} -+ -+static struct bfq_group * -+bfq_create_group_hierarchy(struct bfq_data *bfqd, int node) -+{ -+ int ret; -+ -+ ret = blkcg_activate_policy(bfqd->queue, &blkcg_policy_bfq); -+ if (ret) -+ return NULL; -+ -+ return blkg_to_bfqg(bfqd->queue->root_blkg); -+} -+ -+static struct blkcg_policy_data *bfq_cpd_alloc(gfp_t gfp) -+{ -+ struct bfq_group_data *bgd; -+ -+ bgd = kzalloc(sizeof(*bgd), GFP_KERNEL); -+ if (!bgd) -+ return NULL; -+ return &bgd->pd; -+} -+ -+static void bfq_cpd_free(struct blkcg_policy_data *cpd) -+{ -+ kfree(cpd_to_bfqgd(cpd)); -+} -+ -+static struct cftype bfqio_files_dfl[] = { -+ { -+ .name = "weight", -+ .flags = CFTYPE_NOT_ON_ROOT, -+ .seq_show = bfqio_cgroup_weight_read_dfl, -+ .write = bfqio_cgroup_weight_write_dfl, -+ }, -+ {} /* terminate */ -+}; -+ -+static struct cftype bfqio_files[] = { -+ { -+ .name = "bfq.weight", -+ .read_u64 = bfqio_cgroup_weight_read, -+ .write_u64 = bfqio_cgroup_weight_write, -+ }, -+ /* statistics, cover only the tasks in the bfqg */ -+ { -+ .name = "bfq.time", -+ .private = offsetof(struct bfq_group, stats.time), -+ .seq_show = bfqg_print_stat, -+ }, -+ { -+ .name = "bfq.sectors", -+ .private = offsetof(struct bfq_group, stats.sectors), -+ .seq_show = bfqg_print_stat, -+ }, -+ { -+ .name = "bfq.io_service_bytes", -+ .private = offsetof(struct bfq_group, stats.service_bytes), -+ .seq_show = bfqg_print_rwstat, -+ }, -+ { -+ .name = "bfq.io_serviced", -+ .private = offsetof(struct bfq_group, stats.serviced), -+ .seq_show = bfqg_print_rwstat, -+ }, -+ { -+ .name = "bfq.io_service_time", -+ .private = offsetof(struct bfq_group, stats.service_time), -+ .seq_show = bfqg_print_rwstat, -+ }, -+ { -+ .name = "bfq.io_wait_time", -+ .private = offsetof(struct bfq_group, stats.wait_time), -+ .seq_show = bfqg_print_rwstat, -+ }, -+ { -+ .name = "bfq.io_merged", -+ .private = offsetof(struct bfq_group, stats.merged), -+ .seq_show = bfqg_print_rwstat, -+ }, -+ { -+ .name = "bfq.io_queued", -+ .private = offsetof(struct bfq_group, stats.queued), -+ .seq_show = bfqg_print_rwstat, -+ }, -+ -+ /* the same statictics which cover the bfqg and its descendants */ -+ { -+ .name = "bfq.time_recursive", -+ .private = offsetof(struct bfq_group, stats.time), -+ .seq_show = bfqg_print_stat_recursive, -+ }, -+ { -+ .name = "bfq.sectors_recursive", -+ .private = offsetof(struct bfq_group, stats.sectors), -+ .seq_show = bfqg_print_stat_recursive, -+ }, -+ { -+ .name = "bfq.io_service_bytes_recursive", -+ .private = offsetof(struct bfq_group, stats.service_bytes), -+ .seq_show = bfqg_print_rwstat_recursive, -+ }, -+ { -+ .name = "bfq.io_serviced_recursive", -+ .private = offsetof(struct bfq_group, stats.serviced), -+ .seq_show = bfqg_print_rwstat_recursive, -+ }, -+ { -+ .name = "bfq.io_service_time_recursive", -+ .private = offsetof(struct bfq_group, stats.service_time), -+ .seq_show = bfqg_print_rwstat_recursive, -+ }, -+ { -+ .name = "bfq.io_wait_time_recursive", -+ .private = offsetof(struct bfq_group, stats.wait_time), -+ .seq_show = bfqg_print_rwstat_recursive, -+ }, -+ { -+ .name = "bfq.io_merged_recursive", -+ .private = offsetof(struct bfq_group, stats.merged), -+ .seq_show = bfqg_print_rwstat_recursive, -+ }, -+ { -+ .name = "bfq.io_queued_recursive", -+ .private = offsetof(struct bfq_group, stats.queued), -+ .seq_show = bfqg_print_rwstat_recursive, -+ }, -+ { -+ .name = "bfq.avg_queue_size", -+ .seq_show = bfqg_print_avg_queue_size, -+ }, -+ { -+ .name = "bfq.group_wait_time", -+ .private = offsetof(struct bfq_group, stats.group_wait_time), -+ .seq_show = bfqg_print_stat, -+ }, -+ { -+ .name = "bfq.idle_time", -+ .private = offsetof(struct bfq_group, stats.idle_time), -+ .seq_show = bfqg_print_stat, -+ }, -+ { -+ .name = "bfq.empty_time", -+ .private = offsetof(struct bfq_group, stats.empty_time), -+ .seq_show = bfqg_print_stat, -+ }, -+ { -+ .name = "bfq.dequeue", -+ .private = offsetof(struct bfq_group, stats.dequeue), -+ .seq_show = bfqg_print_stat, -+ }, -+ { -+ .name = "bfq.unaccounted_time", -+ .private = offsetof(struct bfq_group, stats.unaccounted_time), -+ .seq_show = bfqg_print_stat, -+ }, -+ { } /* terminate */ -+}; -+ -+static struct blkcg_policy blkcg_policy_bfq = { -+ .dfl_cftypes = bfqio_files_dfl, -+ .legacy_cftypes = bfqio_files, -+ -+ .pd_alloc_fn = bfq_pd_alloc, -+ .pd_init_fn = bfq_pd_init, -+ .pd_offline_fn = bfq_pd_offline, -+ .pd_free_fn = bfq_pd_free, -+ .pd_reset_stats_fn = bfq_pd_reset_stats, -+ -+ .cpd_alloc_fn = bfq_cpd_alloc, -+ .cpd_init_fn = bfq_cpd_init, -+ .cpd_bind_fn = bfq_cpd_init, -+ .cpd_free_fn = bfq_cpd_free, -+}; -+ -+#else -+ -+static void bfq_init_entity(struct bfq_entity *entity, -+ struct bfq_group *bfqg) -+{ -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ -+ entity->weight = entity->new_weight; -+ entity->orig_weight = entity->new_weight; -+ if (bfqq) { -+ bfqq->ioprio = bfqq->new_ioprio; -+ bfqq->ioprio_class = bfqq->new_ioprio_class; -+ } -+ entity->sched_data = &bfqg->sched_data; -+} -+ -+static struct bfq_group * -+bfq_bic_update_cgroup(struct bfq_io_cq *bic, struct bio *bio) -+{ -+ struct bfq_data *bfqd = bic_to_bfqd(bic); -+ -+ return bfqd->root_group; -+} -+ -+static void bfq_bfqq_move(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq, -+ struct bfq_entity *entity, -+ struct bfq_group *bfqg) -+{ -+} -+ -+static void bfq_end_wr_async(struct bfq_data *bfqd) -+{ -+ bfq_end_wr_async_queues(bfqd, bfqd->root_group); -+} -+ -+static void bfq_disconnect_groups(struct bfq_data *bfqd) -+{ -+ bfq_put_async_queues(bfqd, bfqd->root_group); -+} -+ -+static struct bfq_group *bfq_find_alloc_group(struct bfq_data *bfqd, -+ struct blkcg *blkcg) -+{ -+ return bfqd->root_group; -+} -+ -+static struct bfq_group * -+bfq_create_group_hierarchy(struct bfq_data *bfqd, int node) -+{ -+ struct bfq_group *bfqg; -+ int i; -+ -+ bfqg = kmalloc_node(sizeof(*bfqg), GFP_KERNEL | __GFP_ZERO, node); -+ if (!bfqg) -+ return NULL; -+ -+ for (i = 0; i < BFQ_IOPRIO_CLASSES; i++) -+ bfqg->sched_data.service_tree[i] = BFQ_SERVICE_TREE_INIT; -+ -+ return bfqg; -+} -+#endif -diff --git a/block/bfq-ioc.c b/block/bfq-ioc.c -new file mode 100644 -index 0000000..fb7bb8f ---- /dev/null -+++ b/block/bfq-ioc.c -@@ -0,0 +1,36 @@ -+/* -+ * BFQ: I/O context handling. -+ * -+ * Based on ideas and code from CFQ: -+ * Copyright (C) 2003 Jens Axboe -+ * -+ * Copyright (C) 2008 Fabio Checconi -+ * Paolo Valente -+ * -+ * Copyright (C) 2010 Paolo Valente -+ */ -+ -+/** -+ * icq_to_bic - convert iocontext queue structure to bfq_io_cq. -+ * @icq: the iocontext queue. -+ */ -+static struct bfq_io_cq *icq_to_bic(struct io_cq *icq) -+{ -+ /* bic->icq is the first member, %NULL will convert to %NULL */ -+ return container_of(icq, struct bfq_io_cq, icq); -+} -+ -+/** -+ * bfq_bic_lookup - search into @ioc a bic associated to @bfqd. -+ * @bfqd: the lookup key. -+ * @ioc: the io_context of the process doing I/O. -+ * -+ * Queue lock must be held. -+ */ -+static struct bfq_io_cq *bfq_bic_lookup(struct bfq_data *bfqd, -+ struct io_context *ioc) -+{ -+ if (ioc) -+ return icq_to_bic(ioc_lookup_icq(ioc, bfqd->queue)); -+ return NULL; -+} -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -new file mode 100644 -index 0000000..85e2169 ---- /dev/null -+++ b/block/bfq-iosched.c -@@ -0,0 +1,3763 @@ -+/* -+ * Budget Fair Queueing (BFQ) disk scheduler. -+ * -+ * Based on ideas and code from CFQ: -+ * Copyright (C) 2003 Jens Axboe -+ * -+ * Copyright (C) 2008 Fabio Checconi -+ * Paolo Valente -+ * -+ * Copyright (C) 2010 Paolo Valente -+ * -+ * Licensed under the GPL-2 as detailed in the accompanying COPYING.BFQ -+ * file. -+ * -+ * BFQ is a proportional-share storage-I/O scheduling algorithm based on -+ * the slice-by-slice service scheme of CFQ. But BFQ assigns budgets, -+ * measured in number of sectors, to processes instead of time slices. The -+ * device is not granted to the in-service process for a given time slice, -+ * but until it has exhausted its assigned budget. This change from the time -+ * to the service domain allows BFQ to distribute the device throughput -+ * among processes as desired, without any distortion due to ZBR, workload -+ * fluctuations or other factors. BFQ uses an ad hoc internal scheduler, -+ * called B-WF2Q+, to schedule processes according to their budgets. More -+ * precisely, BFQ schedules queues associated to processes. Thanks to the -+ * accurate policy of B-WF2Q+, BFQ can afford to assign high budgets to -+ * I/O-bound processes issuing sequential requests (to boost the -+ * throughput), and yet guarantee a low latency to interactive and soft -+ * real-time applications. -+ * -+ * BFQ is described in [1], where also a reference to the initial, more -+ * theoretical paper on BFQ can be found. The interested reader can find -+ * in the latter paper full details on the main algorithm, as well as -+ * formulas of the guarantees and formal proofs of all the properties. -+ * With respect to the version of BFQ presented in these papers, this -+ * implementation adds a few more heuristics, such as the one that -+ * guarantees a low latency to soft real-time applications, and a -+ * hierarchical extension based on H-WF2Q+. -+ * -+ * B-WF2Q+ is based on WF2Q+, that is described in [2], together with -+ * H-WF2Q+, while the augmented tree used to implement B-WF2Q+ with O(log N) -+ * complexity derives from the one introduced with EEVDF in [3]. -+ * -+ * [1] P. Valente and M. Andreolini, ``Improving Application Responsiveness -+ * with the BFQ Disk I/O Scheduler'', -+ * Proceedings of the 5th Annual International Systems and Storage -+ * Conference (SYSTOR '12), June 2012. -+ * -+ * http://algogroup.unimo.it/people/paolo/disk_sched/bf1-v1-suite-results.pdf -+ * -+ * [2] Jon C.R. Bennett and H. Zhang, ``Hierarchical Packet Fair Queueing -+ * Algorithms,'' IEEE/ACM Transactions on Networking, 5(5):675-689, -+ * Oct 1997. -+ * -+ * http://www.cs.cmu.edu/~hzhang/papers/TON-97-Oct.ps.gz -+ * -+ * [3] I. Stoica and H. Abdel-Wahab, ``Earliest Eligible Virtual Deadline -+ * First: A Flexible and Accurate Mechanism for Proportional Share -+ * Resource Allocation,'' technical report. -+ * -+ * http://www.cs.berkeley.edu/~istoica/papers/eevdf-tr-95.pdf -+ */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "bfq.h" -+#include "blk.h" -+ -+/* Expiration time of sync (0) and async (1) requests, in jiffies. */ -+static const int bfq_fifo_expire[2] = { HZ / 4, HZ / 8 }; -+ -+/* Maximum backwards seek, in KiB. */ -+static const int bfq_back_max = 16 * 1024; -+ -+/* Penalty of a backwards seek, in number of sectors. */ -+static const int bfq_back_penalty = 2; -+ -+/* Idling period duration, in jiffies. */ -+static int bfq_slice_idle = HZ / 125; -+ -+/* Minimum number of assigned budgets for which stats are safe to compute. */ -+static const int bfq_stats_min_budgets = 194; -+ -+/* Default maximum budget values, in sectors and number of requests. */ -+static const int bfq_default_max_budget = 16 * 1024; -+static const int bfq_max_budget_async_rq = 4; -+ -+/* -+ * Async to sync throughput distribution is controlled as follows: -+ * when an async request is served, the entity is charged the number -+ * of sectors of the request, multiplied by the factor below -+ */ -+static const int bfq_async_charge_factor = 10; -+ -+/* Default timeout values, in jiffies, approximating CFQ defaults. */ -+static const int bfq_timeout_sync = HZ / 8; -+static int bfq_timeout_async = HZ / 25; -+ -+struct kmem_cache *bfq_pool; -+ -+/* Below this threshold (in ms), we consider thinktime immediate. */ -+#define BFQ_MIN_TT 2 -+ -+/* hw_tag detection: parallel requests threshold and min samples needed. */ -+#define BFQ_HW_QUEUE_THRESHOLD 4 -+#define BFQ_HW_QUEUE_SAMPLES 32 -+ -+#define BFQQ_SEEK_THR (sector_t)(8 * 1024) -+#define BFQQ_SEEKY(bfqq) ((bfqq)->seek_mean > BFQQ_SEEK_THR) -+ -+/* Min samples used for peak rate estimation (for autotuning). */ -+#define BFQ_PEAK_RATE_SAMPLES 32 -+ -+/* Shift used for peak rate fixed precision calculations. */ -+#define BFQ_RATE_SHIFT 16 -+ -+/* -+ * By default, BFQ computes the duration of the weight raising for -+ * interactive applications automatically, using the following formula: -+ * duration = (R / r) * T, where r is the peak rate of the device, and -+ * R and T are two reference parameters. -+ * In particular, R is the peak rate of the reference device (see below), -+ * and T is a reference time: given the systems that are likely to be -+ * installed on the reference device according to its speed class, T is -+ * about the maximum time needed, under BFQ and while reading two files in -+ * parallel, to load typical large applications on these systems. -+ * In practice, the slower/faster the device at hand is, the more/less it -+ * takes to load applications with respect to the reference device. -+ * Accordingly, the longer/shorter BFQ grants weight raising to interactive -+ * applications. -+ * -+ * BFQ uses four different reference pairs (R, T), depending on: -+ * . whether the device is rotational or non-rotational; -+ * . whether the device is slow, such as old or portable HDDs, as well as -+ * SD cards, or fast, such as newer HDDs and SSDs. -+ * -+ * The device's speed class is dynamically (re)detected in -+ * bfq_update_peak_rate() every time the estimated peak rate is updated. -+ * -+ * In the following definitions, R_slow[0]/R_fast[0] and T_slow[0]/T_fast[0] -+ * are the reference values for a slow/fast rotational device, whereas -+ * R_slow[1]/R_fast[1] and T_slow[1]/T_fast[1] are the reference values for -+ * a slow/fast non-rotational device. Finally, device_speed_thresh are the -+ * thresholds used to switch between speed classes. -+ * Both the reference peak rates and the thresholds are measured in -+ * sectors/usec, left-shifted by BFQ_RATE_SHIFT. -+ */ -+static int R_slow[2] = {1536, 10752}; -+static int R_fast[2] = {17415, 34791}; -+/* -+ * To improve readability, a conversion function is used to initialize the -+ * following arrays, which entails that they can be initialized only in a -+ * function. -+ */ -+static int T_slow[2]; -+static int T_fast[2]; -+static int device_speed_thresh[2]; -+ -+#define BFQ_SERVICE_TREE_INIT ((struct bfq_service_tree) \ -+ { RB_ROOT, RB_ROOT, NULL, NULL, 0, 0 }) -+ -+#define RQ_BIC(rq) ((struct bfq_io_cq *) (rq)->elv.priv[0]) -+#define RQ_BFQQ(rq) ((rq)->elv.priv[1]) -+ -+static void bfq_schedule_dispatch(struct bfq_data *bfqd); -+ -+#include "bfq-ioc.c" -+#include "bfq-sched.c" -+#include "bfq-cgroup.c" -+ -+#define bfq_class_idle(bfqq) ((bfqq)->ioprio_class == IOPRIO_CLASS_IDLE) -+#define bfq_class_rt(bfqq) ((bfqq)->ioprio_class == IOPRIO_CLASS_RT) -+ -+#define bfq_sample_valid(samples) ((samples) > 80) -+ -+/* -+ * We regard a request as SYNC, if either it's a read or has the SYNC bit -+ * set (in which case it could also be a direct WRITE). -+ */ -+static int bfq_bio_sync(struct bio *bio) -+{ -+ if (bio_data_dir(bio) == READ || (bio->bi_rw & REQ_SYNC)) -+ return 1; -+ -+ return 0; -+} -+ -+/* -+ * Scheduler run of queue, if there are requests pending and no one in the -+ * driver that will restart queueing. -+ */ -+static void bfq_schedule_dispatch(struct bfq_data *bfqd) -+{ -+ if (bfqd->queued != 0) { -+ bfq_log(bfqd, "schedule dispatch"); -+ kblockd_schedule_work(&bfqd->unplug_work); -+ } -+} -+ -+/* -+ * Lifted from AS - choose which of rq1 and rq2 that is best served now. -+ * We choose the request that is closesr to the head right now. Distance -+ * behind the head is penalized and only allowed to a certain extent. -+ */ -+static struct request *bfq_choose_req(struct bfq_data *bfqd, -+ struct request *rq1, -+ struct request *rq2, -+ sector_t last) -+{ -+ sector_t s1, s2, d1 = 0, d2 = 0; -+ unsigned long back_max; -+#define BFQ_RQ1_WRAP 0x01 /* request 1 wraps */ -+#define BFQ_RQ2_WRAP 0x02 /* request 2 wraps */ -+ unsigned int wrap = 0; /* bit mask: requests behind the disk head? */ -+ -+ if (!rq1 || rq1 == rq2) -+ return rq2; -+ if (!rq2) -+ return rq1; -+ -+ if (rq_is_sync(rq1) && !rq_is_sync(rq2)) -+ return rq1; -+ else if (rq_is_sync(rq2) && !rq_is_sync(rq1)) -+ return rq2; -+ if ((rq1->cmd_flags & REQ_META) && !(rq2->cmd_flags & REQ_META)) -+ return rq1; -+ else if ((rq2->cmd_flags & REQ_META) && !(rq1->cmd_flags & REQ_META)) -+ return rq2; -+ -+ s1 = blk_rq_pos(rq1); -+ s2 = blk_rq_pos(rq2); -+ -+ /* -+ * By definition, 1KiB is 2 sectors. -+ */ -+ back_max = bfqd->bfq_back_max * 2; -+ -+ /* -+ * Strict one way elevator _except_ in the case where we allow -+ * short backward seeks which are biased as twice the cost of a -+ * similar forward seek. -+ */ -+ if (s1 >= last) -+ d1 = s1 - last; -+ else if (s1 + back_max >= last) -+ d1 = (last - s1) * bfqd->bfq_back_penalty; -+ else -+ wrap |= BFQ_RQ1_WRAP; -+ -+ if (s2 >= last) -+ d2 = s2 - last; -+ else if (s2 + back_max >= last) -+ d2 = (last - s2) * bfqd->bfq_back_penalty; -+ else -+ wrap |= BFQ_RQ2_WRAP; -+ -+ /* Found required data */ -+ -+ /* -+ * By doing switch() on the bit mask "wrap" we avoid having to -+ * check two variables for all permutations: --> faster! -+ */ -+ switch (wrap) { -+ case 0: /* common case for CFQ: rq1 and rq2 not wrapped */ -+ if (d1 < d2) -+ return rq1; -+ else if (d2 < d1) -+ return rq2; -+ -+ if (s1 >= s2) -+ return rq1; -+ else -+ return rq2; -+ -+ case BFQ_RQ2_WRAP: -+ return rq1; -+ case BFQ_RQ1_WRAP: -+ return rq2; -+ case (BFQ_RQ1_WRAP|BFQ_RQ2_WRAP): /* both rqs wrapped */ -+ default: -+ /* -+ * Since both rqs are wrapped, -+ * start with the one that's further behind head -+ * (--> only *one* back seek required), -+ * since back seek takes more time than forward. -+ */ -+ if (s1 <= s2) -+ return rq1; -+ else -+ return rq2; -+ } -+} -+ -+/* -+ * Tell whether there are active queues or groups with differentiated weights. -+ */ -+static bool bfq_differentiated_weights(struct bfq_data *bfqd) -+{ -+ /* -+ * For weights to differ, at least one of the trees must contain -+ * at least two nodes. -+ */ -+ return (!RB_EMPTY_ROOT(&bfqd->queue_weights_tree) && -+ (bfqd->queue_weights_tree.rb_node->rb_left || -+ bfqd->queue_weights_tree.rb_node->rb_right) -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ ) || -+ (!RB_EMPTY_ROOT(&bfqd->group_weights_tree) && -+ (bfqd->group_weights_tree.rb_node->rb_left || -+ bfqd->group_weights_tree.rb_node->rb_right) -+#endif -+ ); -+} -+ -+/* -+ * The following function returns true if every queue must receive the -+ * same share of the throughput (this condition is used when deciding -+ * whether idling may be disabled, see the comments in the function -+ * bfq_bfqq_may_idle()). -+ * -+ * Such a scenario occurs when: -+ * 1) all active queues have the same weight, -+ * 2) all active groups at the same level in the groups tree have the same -+ * weight, -+ * 3) all active groups at the same level in the groups tree have the same -+ * number of children. -+ * -+ * Unfortunately, keeping the necessary state for evaluating exactly the -+ * above symmetry conditions would be quite complex and time-consuming. -+ * Therefore this function evaluates, instead, the following stronger -+ * sub-conditions, for which it is much easier to maintain the needed -+ * state: -+ * 1) all active queues have the same weight, -+ * 2) all active groups have the same weight, -+ * 3) all active groups have at most one active child each. -+ * In particular, the last two conditions are always true if hierarchical -+ * support and the cgroups interface are not enabled, thus no state needs -+ * to be maintained in this case. -+ */ -+static bool bfq_symmetric_scenario(struct bfq_data *bfqd) -+{ -+ return -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ !bfqd->active_numerous_groups && -+#endif -+ !bfq_differentiated_weights(bfqd); -+} -+ -+/* -+ * If the weight-counter tree passed as input contains no counter for -+ * the weight of the input entity, then add that counter; otherwise just -+ * increment the existing counter. -+ * -+ * Note that weight-counter trees contain few nodes in mostly symmetric -+ * scenarios. For example, if all queues have the same weight, then the -+ * weight-counter tree for the queues may contain at most one node. -+ * This holds even if low_latency is on, because weight-raised queues -+ * are not inserted in the tree. -+ * In most scenarios, the rate at which nodes are created/destroyed -+ * should be low too. -+ */ -+static void bfq_weights_tree_add(struct bfq_data *bfqd, -+ struct bfq_entity *entity, -+ struct rb_root *root) -+{ -+ struct rb_node **new = &(root->rb_node), *parent = NULL; -+ -+ /* -+ * Do not insert if the entity is already associated with a -+ * counter, which happens if: -+ * 1) the entity is associated with a queue, -+ * 2) a request arrival has caused the queue to become both -+ * non-weight-raised, and hence change its weight, and -+ * backlogged; in this respect, each of the two events -+ * causes an invocation of this function, -+ * 3) this is the invocation of this function caused by the -+ * second event. This second invocation is actually useless, -+ * and we handle this fact by exiting immediately. More -+ * efficient or clearer solutions might possibly be adopted. -+ */ -+ if (entity->weight_counter) -+ return; -+ -+ while (*new) { -+ struct bfq_weight_counter *__counter = container_of(*new, -+ struct bfq_weight_counter, -+ weights_node); -+ parent = *new; -+ -+ if (entity->weight == __counter->weight) { -+ entity->weight_counter = __counter; -+ goto inc_counter; -+ } -+ if (entity->weight < __counter->weight) -+ new = &((*new)->rb_left); -+ else -+ new = &((*new)->rb_right); -+ } -+ -+ entity->weight_counter = kzalloc(sizeof(struct bfq_weight_counter), -+ GFP_ATOMIC); -+ entity->weight_counter->weight = entity->weight; -+ rb_link_node(&entity->weight_counter->weights_node, parent, new); -+ rb_insert_color(&entity->weight_counter->weights_node, root); -+ -+inc_counter: -+ entity->weight_counter->num_active++; -+} -+ -+/* -+ * Decrement the weight counter associated with the entity, and, if the -+ * counter reaches 0, remove the counter from the tree. -+ * See the comments to the function bfq_weights_tree_add() for considerations -+ * about overhead. -+ */ -+static void bfq_weights_tree_remove(struct bfq_data *bfqd, -+ struct bfq_entity *entity, -+ struct rb_root *root) -+{ -+ if (!entity->weight_counter) -+ return; -+ -+ BUG_ON(RB_EMPTY_ROOT(root)); -+ BUG_ON(entity->weight_counter->weight != entity->weight); -+ -+ BUG_ON(!entity->weight_counter->num_active); -+ entity->weight_counter->num_active--; -+ if (entity->weight_counter->num_active > 0) -+ goto reset_entity_pointer; -+ -+ rb_erase(&entity->weight_counter->weights_node, root); -+ kfree(entity->weight_counter); -+ -+reset_entity_pointer: -+ entity->weight_counter = NULL; -+} -+ -+static struct request *bfq_find_next_rq(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq, -+ struct request *last) -+{ -+ struct rb_node *rbnext = rb_next(&last->rb_node); -+ struct rb_node *rbprev = rb_prev(&last->rb_node); -+ struct request *next = NULL, *prev = NULL; -+ -+ BUG_ON(RB_EMPTY_NODE(&last->rb_node)); -+ -+ if (rbprev) -+ prev = rb_entry_rq(rbprev); -+ -+ if (rbnext) -+ next = rb_entry_rq(rbnext); -+ else { -+ rbnext = rb_first(&bfqq->sort_list); -+ if (rbnext && rbnext != &last->rb_node) -+ next = rb_entry_rq(rbnext); -+ } -+ -+ return bfq_choose_req(bfqd, next, prev, blk_rq_pos(last)); -+} -+ -+/* see the definition of bfq_async_charge_factor for details */ -+static unsigned long bfq_serv_to_charge(struct request *rq, -+ struct bfq_queue *bfqq) -+{ -+ return blk_rq_sectors(rq) * -+ (1 + ((!bfq_bfqq_sync(bfqq)) * (bfqq->wr_coeff == 1) * -+ bfq_async_charge_factor)); -+} -+ -+/** -+ * bfq_updated_next_req - update the queue after a new next_rq selection. -+ * @bfqd: the device data the queue belongs to. -+ * @bfqq: the queue to update. -+ * -+ * If the first request of a queue changes we make sure that the queue -+ * has enough budget to serve at least its first request (if the -+ * request has grown). We do this because if the queue has not enough -+ * budget for its first request, it has to go through two dispatch -+ * rounds to actually get it dispatched. -+ */ -+static void bfq_updated_next_req(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq) -+{ -+ struct bfq_entity *entity = &bfqq->entity; -+ struct bfq_service_tree *st = bfq_entity_service_tree(entity); -+ struct request *next_rq = bfqq->next_rq; -+ unsigned long new_budget; -+ -+ if (!next_rq) -+ return; -+ -+ if (bfqq == bfqd->in_service_queue) -+ /* -+ * In order not to break guarantees, budgets cannot be -+ * changed after an entity has been selected. -+ */ -+ return; -+ -+ BUG_ON(entity->tree != &st->active); -+ BUG_ON(entity == entity->sched_data->in_service_entity); -+ -+ new_budget = max_t(unsigned long, bfqq->max_budget, -+ bfq_serv_to_charge(next_rq, bfqq)); -+ if (entity->budget != new_budget) { -+ entity->budget = new_budget; -+ bfq_log_bfqq(bfqd, bfqq, "updated next rq: new budget %lu", -+ new_budget); -+ bfq_activate_bfqq(bfqd, bfqq); -+ } -+} -+ -+static unsigned int bfq_wr_duration(struct bfq_data *bfqd) -+{ -+ u64 dur; -+ -+ if (bfqd->bfq_wr_max_time > 0) -+ return bfqd->bfq_wr_max_time; -+ -+ dur = bfqd->RT_prod; -+ do_div(dur, bfqd->peak_rate); -+ -+ return dur; -+} -+ -+/* Empty burst list and add just bfqq (see comments to bfq_handle_burst) */ -+static void bfq_reset_burst_list(struct bfq_data *bfqd, struct bfq_queue *bfqq) -+{ -+ struct bfq_queue *item; -+ struct hlist_node *n; -+ -+ hlist_for_each_entry_safe(item, n, &bfqd->burst_list, burst_list_node) -+ hlist_del_init(&item->burst_list_node); -+ hlist_add_head(&bfqq->burst_list_node, &bfqd->burst_list); -+ bfqd->burst_size = 1; -+} -+ -+/* Add bfqq to the list of queues in current burst (see bfq_handle_burst) */ -+static void bfq_add_to_burst(struct bfq_data *bfqd, struct bfq_queue *bfqq) -+{ -+ /* Increment burst size to take into account also bfqq */ -+ bfqd->burst_size++; -+ -+ if (bfqd->burst_size == bfqd->bfq_large_burst_thresh) { -+ struct bfq_queue *pos, *bfqq_item; -+ struct hlist_node *n; -+ -+ /* -+ * Enough queues have been activated shortly after each -+ * other to consider this burst as large. -+ */ -+ bfqd->large_burst = true; -+ -+ /* -+ * We can now mark all queues in the burst list as -+ * belonging to a large burst. -+ */ -+ hlist_for_each_entry(bfqq_item, &bfqd->burst_list, -+ burst_list_node) -+ bfq_mark_bfqq_in_large_burst(bfqq_item); -+ bfq_mark_bfqq_in_large_burst(bfqq); -+ -+ /* -+ * From now on, and until the current burst finishes, any -+ * new queue being activated shortly after the last queue -+ * was inserted in the burst can be immediately marked as -+ * belonging to a large burst. So the burst list is not -+ * needed any more. Remove it. -+ */ -+ hlist_for_each_entry_safe(pos, n, &bfqd->burst_list, -+ burst_list_node) -+ hlist_del_init(&pos->burst_list_node); -+ } else /* burst not yet large: add bfqq to the burst list */ -+ hlist_add_head(&bfqq->burst_list_node, &bfqd->burst_list); -+} -+ -+/* -+ * If many queues happen to become active shortly after each other, then, -+ * to help the processes associated to these queues get their job done as -+ * soon as possible, it is usually better to not grant either weight-raising -+ * or device idling to these queues. In this comment we describe, firstly, -+ * the reasons why this fact holds, and, secondly, the next function, which -+ * implements the main steps needed to properly mark these queues so that -+ * they can then be treated in a different way. -+ * -+ * As for the terminology, we say that a queue becomes active, i.e., -+ * switches from idle to backlogged, either when it is created (as a -+ * consequence of the arrival of an I/O request), or, if already existing, -+ * when a new request for the queue arrives while the queue is idle. -+ * Bursts of activations, i.e., activations of different queues occurring -+ * shortly after each other, are typically caused by services or applications -+ * that spawn or reactivate many parallel threads/processes. Examples are -+ * systemd during boot or git grep. -+ * -+ * These services or applications benefit mostly from a high throughput: -+ * the quicker the requests of the activated queues are cumulatively served, -+ * the sooner the target job of these queues gets completed. As a consequence, -+ * weight-raising any of these queues, which also implies idling the device -+ * for it, is almost always counterproductive: in most cases it just lowers -+ * throughput. -+ * -+ * On the other hand, a burst of activations may be also caused by the start -+ * of an application that does not consist in a lot of parallel I/O-bound -+ * threads. In fact, with a complex application, the burst may be just a -+ * consequence of the fact that several processes need to be executed to -+ * start-up the application. To start an application as quickly as possible, -+ * the best thing to do is to privilege the I/O related to the application -+ * with respect to all other I/O. Therefore, the best strategy to start as -+ * quickly as possible an application that causes a burst of activations is -+ * to weight-raise all the queues activated during the burst. This is the -+ * exact opposite of the best strategy for the other type of bursts. -+ * -+ * In the end, to take the best action for each of the two cases, the two -+ * types of bursts need to be distinguished. Fortunately, this seems -+ * relatively easy to do, by looking at the sizes of the bursts. In -+ * particular, we found a threshold such that bursts with a larger size -+ * than that threshold are apparently caused only by services or commands -+ * such as systemd or git grep. For brevity, hereafter we call just 'large' -+ * these bursts. BFQ *does not* weight-raise queues whose activations occur -+ * in a large burst. In addition, for each of these queues BFQ performs or -+ * does not perform idling depending on which choice boosts the throughput -+ * most. The exact choice depends on the device and request pattern at -+ * hand. -+ * -+ * Turning back to the next function, it implements all the steps needed -+ * to detect the occurrence of a large burst and to properly mark all the -+ * queues belonging to it (so that they can then be treated in a different -+ * way). This goal is achieved by maintaining a special "burst list" that -+ * holds, temporarily, the queues that belong to the burst in progress. The -+ * list is then used to mark these queues as belonging to a large burst if -+ * the burst does become large. The main steps are the following. -+ * -+ * . when the very first queue is activated, the queue is inserted into the -+ * list (as it could be the first queue in a possible burst) -+ * -+ * . if the current burst has not yet become large, and a queue Q that does -+ * not yet belong to the burst is activated shortly after the last time -+ * at which a new queue entered the burst list, then the function appends -+ * Q to the burst list -+ * -+ * . if, as a consequence of the previous step, the burst size reaches -+ * the large-burst threshold, then -+ * -+ * . all the queues in the burst list are marked as belonging to a -+ * large burst -+ * -+ * . the burst list is deleted; in fact, the burst list already served -+ * its purpose (keeping temporarily track of the queues in a burst, -+ * so as to be able to mark them as belonging to a large burst in the -+ * previous sub-step), and now is not needed any more -+ * -+ * . the device enters a large-burst mode -+ * -+ * . if a queue Q that does not belong to the burst is activated while -+ * the device is in large-burst mode and shortly after the last time -+ * at which a queue either entered the burst list or was marked as -+ * belonging to the current large burst, then Q is immediately marked -+ * as belonging to a large burst. -+ * -+ * . if a queue Q that does not belong to the burst is activated a while -+ * later, i.e., not shortly after, than the last time at which a queue -+ * either entered the burst list or was marked as belonging to the -+ * current large burst, then the current burst is deemed as finished and: -+ * -+ * . the large-burst mode is reset if set -+ * -+ * . the burst list is emptied -+ * -+ * . Q is inserted in the burst list, as Q may be the first queue -+ * in a possible new burst (then the burst list contains just Q -+ * after this step). -+ */ -+static void bfq_handle_burst(struct bfq_data *bfqd, struct bfq_queue *bfqq, -+ bool idle_for_long_time) -+{ -+ /* -+ * If bfqq happened to be activated in a burst, but has been idle -+ * for at least as long as an interactive queue, then we assume -+ * that, in the overall I/O initiated in the burst, the I/O -+ * associated to bfqq is finished. So bfqq does not need to be -+ * treated as a queue belonging to a burst anymore. Accordingly, -+ * we reset bfqq's in_large_burst flag if set, and remove bfqq -+ * from the burst list if it's there. We do not decrement instead -+ * burst_size, because the fact that bfqq does not need to belong -+ * to the burst list any more does not invalidate the fact that -+ * bfqq may have been activated during the current burst. -+ */ -+ if (idle_for_long_time) { -+ hlist_del_init(&bfqq->burst_list_node); -+ bfq_clear_bfqq_in_large_burst(bfqq); -+ } -+ -+ /* -+ * If bfqq is already in the burst list or is part of a large -+ * burst, then there is nothing else to do. -+ */ -+ if (!hlist_unhashed(&bfqq->burst_list_node) || -+ bfq_bfqq_in_large_burst(bfqq)) -+ return; -+ -+ /* -+ * If bfqq's activation happens late enough, then the current -+ * burst is finished, and related data structures must be reset. -+ * -+ * In this respect, consider the special case where bfqq is the very -+ * first queue being activated. In this case, last_ins_in_burst is -+ * not yet significant when we get here. But it is easy to verify -+ * that, whether or not the following condition is true, bfqq will -+ * end up being inserted into the burst list. In particular the -+ * list will happen to contain only bfqq. And this is exactly what -+ * has to happen, as bfqq may be the first queue in a possible -+ * burst. -+ */ -+ if (time_is_before_jiffies(bfqd->last_ins_in_burst + -+ bfqd->bfq_burst_interval)) { -+ bfqd->large_burst = false; -+ bfq_reset_burst_list(bfqd, bfqq); -+ return; -+ } -+ -+ /* -+ * If we get here, then bfqq is being activated shortly after the -+ * last queue. So, if the current burst is also large, we can mark -+ * bfqq as belonging to this large burst immediately. -+ */ -+ if (bfqd->large_burst) { -+ bfq_mark_bfqq_in_large_burst(bfqq); -+ return; -+ } -+ -+ /* -+ * If we get here, then a large-burst state has not yet been -+ * reached, but bfqq is being activated shortly after the last -+ * queue. Then we add bfqq to the burst. -+ */ -+ bfq_add_to_burst(bfqd, bfqq); -+} -+ -+static void bfq_add_request(struct request *rq) -+{ -+ struct bfq_queue *bfqq = RQ_BFQQ(rq); -+ struct bfq_entity *entity = &bfqq->entity; -+ struct bfq_data *bfqd = bfqq->bfqd; -+ struct request *next_rq, *prev; -+ unsigned long old_wr_coeff = bfqq->wr_coeff; -+ bool interactive = false; -+ -+ bfq_log_bfqq(bfqd, bfqq, "add_request %d", rq_is_sync(rq)); -+ bfqq->queued[rq_is_sync(rq)]++; -+ bfqd->queued++; -+ -+ elv_rb_add(&bfqq->sort_list, rq); -+ -+ /* -+ * Check if this request is a better next-serve candidate. -+ */ -+ prev = bfqq->next_rq; -+ next_rq = bfq_choose_req(bfqd, bfqq->next_rq, rq, bfqd->last_position); -+ BUG_ON(!next_rq); -+ bfqq->next_rq = next_rq; -+ -+ if (!bfq_bfqq_busy(bfqq)) { -+ bool soft_rt, in_burst, -+ idle_for_long_time = time_is_before_jiffies( -+ bfqq->budget_timeout + -+ bfqd->bfq_wr_min_idle_time); -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqg_stats_update_io_add(bfqq_group(RQ_BFQQ(rq)), bfqq, -+ rq->cmd_flags); -+#endif -+ if (bfq_bfqq_sync(bfqq)) { -+ bool already_in_burst = -+ !hlist_unhashed(&bfqq->burst_list_node) || -+ bfq_bfqq_in_large_burst(bfqq); -+ bfq_handle_burst(bfqd, bfqq, idle_for_long_time); -+ /* -+ * If bfqq was not already in the current burst, -+ * then, at this point, bfqq either has been -+ * added to the current burst or has caused the -+ * current burst to terminate. In particular, in -+ * the second case, bfqq has become the first -+ * queue in a possible new burst. -+ * In both cases last_ins_in_burst needs to be -+ * moved forward. -+ */ -+ if (!already_in_burst) -+ bfqd->last_ins_in_burst = jiffies; -+ } -+ -+ in_burst = bfq_bfqq_in_large_burst(bfqq); -+ soft_rt = bfqd->bfq_wr_max_softrt_rate > 0 && -+ !in_burst && -+ time_is_before_jiffies(bfqq->soft_rt_next_start); -+ interactive = !in_burst && idle_for_long_time; -+ entity->budget = max_t(unsigned long, bfqq->max_budget, -+ bfq_serv_to_charge(next_rq, bfqq)); -+ -+ if (!bfq_bfqq_IO_bound(bfqq)) { -+ if (time_before(jiffies, -+ RQ_BIC(rq)->ttime.last_end_request + -+ bfqd->bfq_slice_idle)) { -+ bfqq->requests_within_timer++; -+ if (bfqq->requests_within_timer >= -+ bfqd->bfq_requests_within_timer) -+ bfq_mark_bfqq_IO_bound(bfqq); -+ } else -+ bfqq->requests_within_timer = 0; -+ } -+ -+ if (!bfqd->low_latency) -+ goto add_bfqq_busy; -+ -+ /* -+ * If the queue: -+ * - is not being boosted, -+ * - has been idle for enough time, -+ * - is not a sync queue or is linked to a bfq_io_cq (it is -+ * shared "for its nature" or it is not shared and its -+ * requests have not been redirected to a shared queue) -+ * start a weight-raising period. -+ */ -+ if (old_wr_coeff == 1 && (interactive || soft_rt) && -+ (!bfq_bfqq_sync(bfqq) || bfqq->bic)) { -+ bfqq->wr_coeff = bfqd->bfq_wr_coeff; -+ if (interactive) -+ bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); -+ else -+ bfqq->wr_cur_max_time = -+ bfqd->bfq_wr_rt_max_time; -+ bfq_log_bfqq(bfqd, bfqq, -+ "wrais starting at %lu, rais_max_time %u", -+ jiffies, -+ jiffies_to_msecs(bfqq->wr_cur_max_time)); -+ } else if (old_wr_coeff > 1) { -+ if (interactive) -+ bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); -+ else if (in_burst || -+ (bfqq->wr_cur_max_time == -+ bfqd->bfq_wr_rt_max_time && -+ !soft_rt)) { -+ bfqq->wr_coeff = 1; -+ bfq_log_bfqq(bfqd, bfqq, -+ "wrais ending at %lu, rais_max_time %u", -+ jiffies, -+ jiffies_to_msecs(bfqq-> -+ wr_cur_max_time)); -+ } else if (time_before( -+ bfqq->last_wr_start_finish + -+ bfqq->wr_cur_max_time, -+ jiffies + -+ bfqd->bfq_wr_rt_max_time) && -+ soft_rt) { -+ /* -+ * -+ * The remaining weight-raising time is lower -+ * than bfqd->bfq_wr_rt_max_time, which means -+ * that the application is enjoying weight -+ * raising either because deemed soft-rt in -+ * the near past, or because deemed interactive -+ * a long ago. -+ * In both cases, resetting now the current -+ * remaining weight-raising time for the -+ * application to the weight-raising duration -+ * for soft rt applications would not cause any -+ * latency increase for the application (as the -+ * new duration would be higher than the -+ * remaining time). -+ * -+ * In addition, the application is now meeting -+ * the requirements for being deemed soft rt. -+ * In the end we can correctly and safely -+ * (re)charge the weight-raising duration for -+ * the application with the weight-raising -+ * duration for soft rt applications. -+ * -+ * In particular, doing this recharge now, i.e., -+ * before the weight-raising period for the -+ * application finishes, reduces the probability -+ * of the following negative scenario: -+ * 1) the weight of a soft rt application is -+ * raised at startup (as for any newly -+ * created application), -+ * 2) since the application is not interactive, -+ * at a certain time weight-raising is -+ * stopped for the application, -+ * 3) at that time the application happens to -+ * still have pending requests, and hence -+ * is destined to not have a chance to be -+ * deemed soft rt before these requests are -+ * completed (see the comments to the -+ * function bfq_bfqq_softrt_next_start() -+ * for details on soft rt detection), -+ * 4) these pending requests experience a high -+ * latency because the application is not -+ * weight-raised while they are pending. -+ */ -+ bfqq->last_wr_start_finish = jiffies; -+ bfqq->wr_cur_max_time = -+ bfqd->bfq_wr_rt_max_time; -+ } -+ } -+ if (old_wr_coeff != bfqq->wr_coeff) -+ entity->prio_changed = 1; -+add_bfqq_busy: -+ bfqq->last_idle_bklogged = jiffies; -+ bfqq->service_from_backlogged = 0; -+ bfq_clear_bfqq_softrt_update(bfqq); -+ bfq_add_bfqq_busy(bfqd, bfqq); -+ } else { -+ if (bfqd->low_latency && old_wr_coeff == 1 && !rq_is_sync(rq) && -+ time_is_before_jiffies( -+ bfqq->last_wr_start_finish + -+ bfqd->bfq_wr_min_inter_arr_async)) { -+ bfqq->wr_coeff = bfqd->bfq_wr_coeff; -+ bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); -+ -+ bfqd->wr_busy_queues++; -+ entity->prio_changed = 1; -+ bfq_log_bfqq(bfqd, bfqq, -+ "non-idle wrais starting at %lu, rais_max_time %u", -+ jiffies, -+ jiffies_to_msecs(bfqq->wr_cur_max_time)); -+ } -+ if (prev != bfqq->next_rq) -+ bfq_updated_next_req(bfqd, bfqq); -+ } -+ -+ if (bfqd->low_latency && -+ (old_wr_coeff == 1 || bfqq->wr_coeff == 1 || interactive)) -+ bfqq->last_wr_start_finish = jiffies; -+} -+ -+static struct request *bfq_find_rq_fmerge(struct bfq_data *bfqd, -+ struct bio *bio) -+{ -+ struct task_struct *tsk = current; -+ struct bfq_io_cq *bic; -+ struct bfq_queue *bfqq; -+ -+ bic = bfq_bic_lookup(bfqd, tsk->io_context); -+ if (!bic) -+ return NULL; -+ -+ bfqq = bic_to_bfqq(bic, bfq_bio_sync(bio)); -+ if (bfqq) -+ return elv_rb_find(&bfqq->sort_list, bio_end_sector(bio)); -+ -+ return NULL; -+} -+ -+static void bfq_activate_request(struct request_queue *q, struct request *rq) -+{ -+ struct bfq_data *bfqd = q->elevator->elevator_data; -+ -+ bfqd->rq_in_driver++; -+ bfqd->last_position = blk_rq_pos(rq) + blk_rq_sectors(rq); -+ bfq_log(bfqd, "activate_request: new bfqd->last_position %llu", -+ (unsigned long long) bfqd->last_position); -+} -+ -+static void bfq_deactivate_request(struct request_queue *q, struct request *rq) -+{ -+ struct bfq_data *bfqd = q->elevator->elevator_data; -+ -+ BUG_ON(bfqd->rq_in_driver == 0); -+ bfqd->rq_in_driver--; -+} -+ -+static void bfq_remove_request(struct request *rq) -+{ -+ struct bfq_queue *bfqq = RQ_BFQQ(rq); -+ struct bfq_data *bfqd = bfqq->bfqd; -+ const int sync = rq_is_sync(rq); -+ -+ if (bfqq->next_rq == rq) { -+ bfqq->next_rq = bfq_find_next_rq(bfqd, bfqq, rq); -+ bfq_updated_next_req(bfqd, bfqq); -+ } -+ -+ if (rq->queuelist.prev != &rq->queuelist) -+ list_del_init(&rq->queuelist); -+ BUG_ON(bfqq->queued[sync] == 0); -+ bfqq->queued[sync]--; -+ bfqd->queued--; -+ elv_rb_del(&bfqq->sort_list, rq); -+ -+ if (RB_EMPTY_ROOT(&bfqq->sort_list)) { -+ if (bfq_bfqq_busy(bfqq) && bfqq != bfqd->in_service_queue) -+ bfq_del_bfqq_busy(bfqd, bfqq, 1); -+ /* -+ * Remove queue from request-position tree as it is empty. -+ */ -+ if (bfqq->pos_root) { -+ rb_erase(&bfqq->pos_node, bfqq->pos_root); -+ bfqq->pos_root = NULL; -+ } -+ } -+ -+ if (rq->cmd_flags & REQ_META) { -+ BUG_ON(bfqq->meta_pending == 0); -+ bfqq->meta_pending--; -+ } -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqg_stats_update_io_remove(bfqq_group(bfqq), rq->cmd_flags); -+#endif -+} -+ -+static int bfq_merge(struct request_queue *q, struct request **req, -+ struct bio *bio) -+{ -+ struct bfq_data *bfqd = q->elevator->elevator_data; -+ struct request *__rq; -+ -+ __rq = bfq_find_rq_fmerge(bfqd, bio); -+ if (__rq && elv_rq_merge_ok(__rq, bio)) { -+ *req = __rq; -+ return ELEVATOR_FRONT_MERGE; -+ } -+ -+ return ELEVATOR_NO_MERGE; -+} -+ -+static void bfq_merged_request(struct request_queue *q, struct request *req, -+ int type) -+{ -+ if (type == ELEVATOR_FRONT_MERGE && -+ rb_prev(&req->rb_node) && -+ blk_rq_pos(req) < -+ blk_rq_pos(container_of(rb_prev(&req->rb_node), -+ struct request, rb_node))) { -+ struct bfq_queue *bfqq = RQ_BFQQ(req); -+ struct bfq_data *bfqd = bfqq->bfqd; -+ struct request *prev, *next_rq; -+ -+ /* Reposition request in its sort_list */ -+ elv_rb_del(&bfqq->sort_list, req); -+ elv_rb_add(&bfqq->sort_list, req); -+ /* Choose next request to be served for bfqq */ -+ prev = bfqq->next_rq; -+ next_rq = bfq_choose_req(bfqd, bfqq->next_rq, req, -+ bfqd->last_position); -+ BUG_ON(!next_rq); -+ bfqq->next_rq = next_rq; -+ } -+} -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+static void bfq_bio_merged(struct request_queue *q, struct request *req, -+ struct bio *bio) -+{ -+ bfqg_stats_update_io_merged(bfqq_group(RQ_BFQQ(req)), bio->bi_rw); -+} -+#endif -+ -+static void bfq_merged_requests(struct request_queue *q, struct request *rq, -+ struct request *next) -+{ -+ struct bfq_queue *bfqq = RQ_BFQQ(rq), *next_bfqq = RQ_BFQQ(next); -+ -+ /* -+ * If next and rq belong to the same bfq_queue and next is older -+ * than rq, then reposition rq in the fifo (by substituting next -+ * with rq). Otherwise, if next and rq belong to different -+ * bfq_queues, never reposition rq: in fact, we would have to -+ * reposition it with respect to next's position in its own fifo, -+ * which would most certainly be too expensive with respect to -+ * the benefits. -+ */ -+ if (bfqq == next_bfqq && -+ !list_empty(&rq->queuelist) && !list_empty(&next->queuelist) && -+ time_before(next->fifo_time, rq->fifo_time)) { -+ list_del_init(&rq->queuelist); -+ list_replace_init(&next->queuelist, &rq->queuelist); -+ rq->fifo_time = next->fifo_time; -+ } -+ -+ if (bfqq->next_rq == next) -+ bfqq->next_rq = rq; -+ -+ bfq_remove_request(next); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqg_stats_update_io_merged(bfqq_group(bfqq), next->cmd_flags); -+#endif -+} -+ -+/* Must be called with bfqq != NULL */ -+static void bfq_bfqq_end_wr(struct bfq_queue *bfqq) -+{ -+ BUG_ON(!bfqq); -+ if (bfq_bfqq_busy(bfqq)) -+ bfqq->bfqd->wr_busy_queues--; -+ bfqq->wr_coeff = 1; -+ bfqq->wr_cur_max_time = 0; -+ /* Trigger a weight change on the next activation of the queue */ -+ bfqq->entity.prio_changed = 1; -+} -+ -+static void bfq_end_wr_async_queues(struct bfq_data *bfqd, -+ struct bfq_group *bfqg) -+{ -+ int i, j; -+ -+ for (i = 0; i < 2; i++) -+ for (j = 0; j < IOPRIO_BE_NR; j++) -+ if (bfqg->async_bfqq[i][j]) -+ bfq_bfqq_end_wr(bfqg->async_bfqq[i][j]); -+ if (bfqg->async_idle_bfqq) -+ bfq_bfqq_end_wr(bfqg->async_idle_bfqq); -+} -+ -+static void bfq_end_wr(struct bfq_data *bfqd) -+{ -+ struct bfq_queue *bfqq; -+ -+ spin_lock_irq(bfqd->queue->queue_lock); -+ -+ list_for_each_entry(bfqq, &bfqd->active_list, bfqq_list) -+ bfq_bfqq_end_wr(bfqq); -+ list_for_each_entry(bfqq, &bfqd->idle_list, bfqq_list) -+ bfq_bfqq_end_wr(bfqq); -+ bfq_end_wr_async(bfqd); -+ -+ spin_unlock_irq(bfqd->queue->queue_lock); -+} -+ -+static int bfq_allow_merge(struct request_queue *q, struct request *rq, -+ struct bio *bio) -+{ -+ struct bfq_data *bfqd = q->elevator->elevator_data; -+ struct bfq_io_cq *bic; -+ -+ /* -+ * Disallow merge of a sync bio into an async request. -+ */ -+ if (bfq_bio_sync(bio) && !rq_is_sync(rq)) -+ return 0; -+ -+ /* -+ * Lookup the bfqq that this bio will be queued with. Allow -+ * merge only if rq is queued there. -+ * Queue lock is held here. -+ */ -+ bic = bfq_bic_lookup(bfqd, current->io_context); -+ if (!bic) -+ return 0; -+ -+ return bic_to_bfqq(bic, bfq_bio_sync(bio)) == RQ_BFQQ(rq); -+} -+ -+static void __bfq_set_in_service_queue(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq) -+{ -+ if (bfqq) { -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqg_stats_update_avg_queue_size(bfqq_group(bfqq)); -+#endif -+ bfq_mark_bfqq_must_alloc(bfqq); -+ bfq_mark_bfqq_budget_new(bfqq); -+ bfq_clear_bfqq_fifo_expire(bfqq); -+ -+ bfqd->budgets_assigned = (bfqd->budgets_assigned*7 + 256) / 8; -+ -+ bfq_log_bfqq(bfqd, bfqq, -+ "set_in_service_queue, cur-budget = %d", -+ bfqq->entity.budget); -+ } -+ -+ bfqd->in_service_queue = bfqq; -+} -+ -+/* -+ * Get and set a new queue for service. -+ */ -+static struct bfq_queue *bfq_set_in_service_queue(struct bfq_data *bfqd) -+{ -+ struct bfq_queue *bfqq = bfq_get_next_queue(bfqd); -+ -+ __bfq_set_in_service_queue(bfqd, bfqq); -+ return bfqq; -+} -+ -+/* -+ * If enough samples have been computed, return the current max budget -+ * stored in bfqd, which is dynamically updated according to the -+ * estimated disk peak rate; otherwise return the default max budget -+ */ -+static int bfq_max_budget(struct bfq_data *bfqd) -+{ -+ if (bfqd->budgets_assigned < bfq_stats_min_budgets) -+ return bfq_default_max_budget; -+ else -+ return bfqd->bfq_max_budget; -+} -+ -+/* -+ * Return min budget, which is a fraction of the current or default -+ * max budget (trying with 1/32) -+ */ -+static int bfq_min_budget(struct bfq_data *bfqd) -+{ -+ if (bfqd->budgets_assigned < bfq_stats_min_budgets) -+ return bfq_default_max_budget / 32; -+ else -+ return bfqd->bfq_max_budget / 32; -+} -+ -+static void bfq_arm_slice_timer(struct bfq_data *bfqd) -+{ -+ struct bfq_queue *bfqq = bfqd->in_service_queue; -+ struct bfq_io_cq *bic; -+ unsigned long sl; -+ -+ BUG_ON(!RB_EMPTY_ROOT(&bfqq->sort_list)); -+ -+ /* Processes have exited, don't wait. */ -+ bic = bfqd->in_service_bic; -+ if (!bic || atomic_read(&bic->icq.ioc->active_ref) == 0) -+ return; -+ -+ bfq_mark_bfqq_wait_request(bfqq); -+ -+ /* -+ * We don't want to idle for seeks, but we do want to allow -+ * fair distribution of slice time for a process doing back-to-back -+ * seeks. So allow a little bit of time for him to submit a new rq. -+ * -+ * To prevent processes with (partly) seeky workloads from -+ * being too ill-treated, grant them a small fraction of the -+ * assigned budget before reducing the waiting time to -+ * BFQ_MIN_TT. This happened to help reduce latency. -+ */ -+ sl = bfqd->bfq_slice_idle; -+ /* -+ * Unless the queue is being weight-raised or the scenario is -+ * asymmetric, grant only minimum idle time if the queue either -+ * has been seeky for long enough or has already proved to be -+ * constantly seeky. -+ */ -+ if (bfq_sample_valid(bfqq->seek_samples) && -+ ((BFQQ_SEEKY(bfqq) && bfqq->entity.service > -+ bfq_max_budget(bfqq->bfqd) / 8) || -+ bfq_bfqq_constantly_seeky(bfqq)) && bfqq->wr_coeff == 1 && -+ bfq_symmetric_scenario(bfqd)) -+ sl = min(sl, msecs_to_jiffies(BFQ_MIN_TT)); -+ else if (bfqq->wr_coeff > 1) -+ sl = sl * 3; -+ bfqd->last_idling_start = ktime_get(); -+ mod_timer(&bfqd->idle_slice_timer, jiffies + sl); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqg_stats_set_start_idle_time(bfqq_group(bfqq)); -+#endif -+ bfq_log(bfqd, "arm idle: %u/%u ms", -+ jiffies_to_msecs(sl), jiffies_to_msecs(bfqd->bfq_slice_idle)); -+} -+ -+/* -+ * Set the maximum time for the in-service queue to consume its -+ * budget. This prevents seeky processes from lowering the disk -+ * throughput (always guaranteed with a time slice scheme as in CFQ). -+ */ -+static void bfq_set_budget_timeout(struct bfq_data *bfqd) -+{ -+ struct bfq_queue *bfqq = bfqd->in_service_queue; -+ unsigned int timeout_coeff; -+ -+ if (bfqq->wr_cur_max_time == bfqd->bfq_wr_rt_max_time) -+ timeout_coeff = 1; -+ else -+ timeout_coeff = bfqq->entity.weight / bfqq->entity.orig_weight; -+ -+ bfqd->last_budget_start = ktime_get(); -+ -+ bfq_clear_bfqq_budget_new(bfqq); -+ bfqq->budget_timeout = jiffies + -+ bfqd->bfq_timeout[bfq_bfqq_sync(bfqq)] * timeout_coeff; -+ -+ bfq_log_bfqq(bfqd, bfqq, "set budget_timeout %u", -+ jiffies_to_msecs(bfqd->bfq_timeout[bfq_bfqq_sync(bfqq)] * -+ timeout_coeff)); -+} -+ -+/* -+ * Move request from internal lists to the request queue dispatch list. -+ */ -+static void bfq_dispatch_insert(struct request_queue *q, struct request *rq) -+{ -+ struct bfq_data *bfqd = q->elevator->elevator_data; -+ struct bfq_queue *bfqq = RQ_BFQQ(rq); -+ -+ /* -+ * For consistency, the next instruction should have been executed -+ * after removing the request from the queue and dispatching it. -+ * We execute instead this instruction before bfq_remove_request() -+ * (and hence introduce a temporary inconsistency), for efficiency. -+ * In fact, in a forced_dispatch, this prevents two counters related -+ * to bfqq->dispatched to risk to be uselessly decremented if bfqq -+ * is not in service, and then to be incremented again after -+ * incrementing bfqq->dispatched. -+ */ -+ bfqq->dispatched++; -+ bfq_remove_request(rq); -+ elv_dispatch_sort(q, rq); -+ -+ if (bfq_bfqq_sync(bfqq)) -+ bfqd->sync_flight++; -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqg_stats_update_dispatch(bfqq_group(bfqq), blk_rq_bytes(rq), -+ rq->cmd_flags); -+#endif -+} -+ -+/* -+ * Return expired entry, or NULL to just start from scratch in rbtree. -+ */ -+static struct request *bfq_check_fifo(struct bfq_queue *bfqq) -+{ -+ struct request *rq = NULL; -+ -+ if (bfq_bfqq_fifo_expire(bfqq)) -+ return NULL; -+ -+ bfq_mark_bfqq_fifo_expire(bfqq); -+ -+ if (list_empty(&bfqq->fifo)) -+ return NULL; -+ -+ rq = rq_entry_fifo(bfqq->fifo.next); -+ -+ if (time_before(jiffies, rq->fifo_time)) -+ return NULL; -+ -+ return rq; -+} -+ -+static int bfq_bfqq_budget_left(struct bfq_queue *bfqq) -+{ -+ struct bfq_entity *entity = &bfqq->entity; -+ -+ return entity->budget - entity->service; -+} -+ -+static void __bfq_bfqq_expire(struct bfq_data *bfqd, struct bfq_queue *bfqq) -+{ -+ BUG_ON(bfqq != bfqd->in_service_queue); -+ -+ __bfq_bfqd_reset_in_service(bfqd); -+ -+ if (RB_EMPTY_ROOT(&bfqq->sort_list)) { -+ /* -+ * Overloading budget_timeout field to store the time -+ * at which the queue remains with no backlog; used by -+ * the weight-raising mechanism. -+ */ -+ bfqq->budget_timeout = jiffies; -+ bfq_del_bfqq_busy(bfqd, bfqq, 1); -+ } else -+ bfq_activate_bfqq(bfqd, bfqq); -+} -+ -+/** -+ * __bfq_bfqq_recalc_budget - try to adapt the budget to the @bfqq behavior. -+ * @bfqd: device data. -+ * @bfqq: queue to update. -+ * @reason: reason for expiration. -+ * -+ * Handle the feedback on @bfqq budget at queue expiration. -+ * See the body for detailed comments. -+ */ -+static void __bfq_bfqq_recalc_budget(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq, -+ enum bfqq_expiration reason) -+{ -+ struct request *next_rq; -+ int budget, min_budget; -+ -+ budget = bfqq->max_budget; -+ min_budget = bfq_min_budget(bfqd); -+ -+ BUG_ON(bfqq != bfqd->in_service_queue); -+ -+ bfq_log_bfqq(bfqd, bfqq, "recalc_budg: last budg %d, budg left %d", -+ bfqq->entity.budget, bfq_bfqq_budget_left(bfqq)); -+ bfq_log_bfqq(bfqd, bfqq, "recalc_budg: last max_budg %d, min budg %d", -+ budget, bfq_min_budget(bfqd)); -+ bfq_log_bfqq(bfqd, bfqq, "recalc_budg: sync %d, seeky %d", -+ bfq_bfqq_sync(bfqq), BFQQ_SEEKY(bfqd->in_service_queue)); -+ -+ if (bfq_bfqq_sync(bfqq)) { -+ switch (reason) { -+ /* -+ * Caveat: in all the following cases we trade latency -+ * for throughput. -+ */ -+ case BFQ_BFQQ_TOO_IDLE: -+ /* -+ * This is the only case where we may reduce -+ * the budget: if there is no request of the -+ * process still waiting for completion, then -+ * we assume (tentatively) that the timer has -+ * expired because the batch of requests of -+ * the process could have been served with a -+ * smaller budget. Hence, betting that -+ * process will behave in the same way when it -+ * becomes backlogged again, we reduce its -+ * next budget. As long as we guess right, -+ * this budget cut reduces the latency -+ * experienced by the process. -+ * -+ * However, if there are still outstanding -+ * requests, then the process may have not yet -+ * issued its next request just because it is -+ * still waiting for the completion of some of -+ * the still outstanding ones. So in this -+ * subcase we do not reduce its budget, on the -+ * contrary we increase it to possibly boost -+ * the throughput, as discussed in the -+ * comments to the BUDGET_TIMEOUT case. -+ */ -+ if (bfqq->dispatched > 0) /* still outstanding reqs */ -+ budget = min(budget * 2, bfqd->bfq_max_budget); -+ else { -+ if (budget > 5 * min_budget) -+ budget -= 4 * min_budget; -+ else -+ budget = min_budget; -+ } -+ break; -+ case BFQ_BFQQ_BUDGET_TIMEOUT: -+ /* -+ * We double the budget here because: 1) it -+ * gives the chance to boost the throughput if -+ * this is not a seeky process (which may have -+ * bumped into this timeout because of, e.g., -+ * ZBR), 2) together with charge_full_budget -+ * it helps give seeky processes higher -+ * timestamps, and hence be served less -+ * frequently. -+ */ -+ budget = min(budget * 2, bfqd->bfq_max_budget); -+ break; -+ case BFQ_BFQQ_BUDGET_EXHAUSTED: -+ /* -+ * The process still has backlog, and did not -+ * let either the budget timeout or the disk -+ * idling timeout expire. Hence it is not -+ * seeky, has a short thinktime and may be -+ * happy with a higher budget too. So -+ * definitely increase the budget of this good -+ * candidate to boost the disk throughput. -+ */ -+ budget = min(budget * 4, bfqd->bfq_max_budget); -+ break; -+ case BFQ_BFQQ_NO_MORE_REQUESTS: -+ /* -+ * Leave the budget unchanged. -+ */ -+ default: -+ return; -+ } -+ } else -+ /* -+ * Async queues get always the maximum possible budget -+ * (their ability to dispatch is limited by -+ * @bfqd->bfq_max_budget_async_rq). -+ */ -+ budget = bfqd->bfq_max_budget; -+ -+ bfqq->max_budget = budget; -+ -+ if (bfqd->budgets_assigned >= bfq_stats_min_budgets && -+ !bfqd->bfq_user_max_budget) -+ bfqq->max_budget = min(bfqq->max_budget, bfqd->bfq_max_budget); -+ -+ /* -+ * Make sure that we have enough budget for the next request. -+ * Since the finish time of the bfqq must be kept in sync with -+ * the budget, be sure to call __bfq_bfqq_expire() after the -+ * update. -+ */ -+ next_rq = bfqq->next_rq; -+ if (next_rq) -+ bfqq->entity.budget = max_t(unsigned long, bfqq->max_budget, -+ bfq_serv_to_charge(next_rq, bfqq)); -+ else -+ bfqq->entity.budget = bfqq->max_budget; -+ -+ bfq_log_bfqq(bfqd, bfqq, "head sect: %u, new budget %d", -+ next_rq ? blk_rq_sectors(next_rq) : 0, -+ bfqq->entity.budget); -+} -+ -+static unsigned long bfq_calc_max_budget(u64 peak_rate, u64 timeout) -+{ -+ unsigned long max_budget; -+ -+ /* -+ * The max_budget calculated when autotuning is equal to the -+ * amount of sectors transfered in timeout_sync at the -+ * estimated peak rate. -+ */ -+ max_budget = (unsigned long)(peak_rate * 1000 * -+ timeout >> BFQ_RATE_SHIFT); -+ -+ return max_budget; -+} -+ -+/* -+ * In addition to updating the peak rate, checks whether the process -+ * is "slow", and returns 1 if so. This slow flag is used, in addition -+ * to the budget timeout, to reduce the amount of service provided to -+ * seeky processes, and hence reduce their chances to lower the -+ * throughput. See the code for more details. -+ */ -+static bool bfq_update_peak_rate(struct bfq_data *bfqd, struct bfq_queue *bfqq, -+ bool compensate, enum bfqq_expiration reason) -+{ -+ u64 bw, usecs, expected, timeout; -+ ktime_t delta; -+ int update = 0; -+ -+ if (!bfq_bfqq_sync(bfqq) || bfq_bfqq_budget_new(bfqq)) -+ return false; -+ -+ if (compensate) -+ delta = bfqd->last_idling_start; -+ else -+ delta = ktime_get(); -+ delta = ktime_sub(delta, bfqd->last_budget_start); -+ usecs = ktime_to_us(delta); -+ -+ /* Don't trust short/unrealistic values. */ -+ if (usecs < 100 || usecs >= LONG_MAX) -+ return false; -+ -+ /* -+ * Calculate the bandwidth for the last slice. We use a 64 bit -+ * value to store the peak rate, in sectors per usec in fixed -+ * point math. We do so to have enough precision in the estimate -+ * and to avoid overflows. -+ */ -+ bw = (u64)bfqq->entity.service << BFQ_RATE_SHIFT; -+ do_div(bw, (unsigned long)usecs); -+ -+ timeout = jiffies_to_msecs(bfqd->bfq_timeout[BLK_RW_SYNC]); -+ -+ /* -+ * Use only long (> 20ms) intervals to filter out spikes for -+ * the peak rate estimation. -+ */ -+ if (usecs > 20000) { -+ if (bw > bfqd->peak_rate || -+ (!BFQQ_SEEKY(bfqq) && -+ reason == BFQ_BFQQ_BUDGET_TIMEOUT)) { -+ bfq_log(bfqd, "measured bw =%llu", bw); -+ /* -+ * To smooth oscillations use a low-pass filter with -+ * alpha=7/8, i.e., -+ * new_rate = (7/8) * old_rate + (1/8) * bw -+ */ -+ do_div(bw, 8); -+ if (bw == 0) -+ return 0; -+ bfqd->peak_rate *= 7; -+ do_div(bfqd->peak_rate, 8); -+ bfqd->peak_rate += bw; -+ update = 1; -+ bfq_log(bfqd, "new peak_rate=%llu", bfqd->peak_rate); -+ } -+ -+ update |= bfqd->peak_rate_samples == BFQ_PEAK_RATE_SAMPLES - 1; -+ -+ if (bfqd->peak_rate_samples < BFQ_PEAK_RATE_SAMPLES) -+ bfqd->peak_rate_samples++; -+ -+ if (bfqd->peak_rate_samples == BFQ_PEAK_RATE_SAMPLES && -+ update) { -+ int dev_type = blk_queue_nonrot(bfqd->queue); -+ -+ if (bfqd->bfq_user_max_budget == 0) { -+ bfqd->bfq_max_budget = -+ bfq_calc_max_budget(bfqd->peak_rate, -+ timeout); -+ bfq_log(bfqd, "new max_budget=%d", -+ bfqd->bfq_max_budget); -+ } -+ if (bfqd->device_speed == BFQ_BFQD_FAST && -+ bfqd->peak_rate < device_speed_thresh[dev_type]) { -+ bfqd->device_speed = BFQ_BFQD_SLOW; -+ bfqd->RT_prod = R_slow[dev_type] * -+ T_slow[dev_type]; -+ } else if (bfqd->device_speed == BFQ_BFQD_SLOW && -+ bfqd->peak_rate > device_speed_thresh[dev_type]) { -+ bfqd->device_speed = BFQ_BFQD_FAST; -+ bfqd->RT_prod = R_fast[dev_type] * -+ T_fast[dev_type]; -+ } -+ } -+ } -+ -+ /* -+ * If the process has been served for a too short time -+ * interval to let its possible sequential accesses prevail on -+ * the initial seek time needed to move the disk head on the -+ * first sector it requested, then give the process a chance -+ * and for the moment return false. -+ */ -+ if (bfqq->entity.budget <= bfq_max_budget(bfqd) / 8) -+ return false; -+ -+ /* -+ * A process is considered ``slow'' (i.e., seeky, so that we -+ * cannot treat it fairly in the service domain, as it would -+ * slow down too much the other processes) if, when a slice -+ * ends for whatever reason, it has received service at a -+ * rate that would not be high enough to complete the budget -+ * before the budget timeout expiration. -+ */ -+ expected = bw * 1000 * timeout >> BFQ_RATE_SHIFT; -+ -+ /* -+ * Caveat: processes doing IO in the slower disk zones will -+ * tend to be slow(er) even if not seeky. And the estimated -+ * peak rate will actually be an average over the disk -+ * surface. Hence, to not be too harsh with unlucky processes, -+ * we keep a budget/3 margin of safety before declaring a -+ * process slow. -+ */ -+ return expected > (4 * bfqq->entity.budget) / 3; -+} -+ -+/* -+ * To be deemed as soft real-time, an application must meet two -+ * requirements. First, the application must not require an average -+ * bandwidth higher than the approximate bandwidth required to playback or -+ * record a compressed high-definition video. -+ * The next function is invoked on the completion of the last request of a -+ * batch, to compute the next-start time instant, soft_rt_next_start, such -+ * that, if the next request of the application does not arrive before -+ * soft_rt_next_start, then the above requirement on the bandwidth is met. -+ * -+ * The second requirement is that the request pattern of the application is -+ * isochronous, i.e., that, after issuing a request or a batch of requests, -+ * the application stops issuing new requests until all its pending requests -+ * have been completed. After that, the application may issue a new batch, -+ * and so on. -+ * For this reason the next function is invoked to compute -+ * soft_rt_next_start only for applications that meet this requirement, -+ * whereas soft_rt_next_start is set to infinity for applications that do -+ * not. -+ * -+ * Unfortunately, even a greedy application may happen to behave in an -+ * isochronous way if the CPU load is high. In fact, the application may -+ * stop issuing requests while the CPUs are busy serving other processes, -+ * then restart, then stop again for a while, and so on. In addition, if -+ * the disk achieves a low enough throughput with the request pattern -+ * issued by the application (e.g., because the request pattern is random -+ * and/or the device is slow), then the application may meet the above -+ * bandwidth requirement too. To prevent such a greedy application to be -+ * deemed as soft real-time, a further rule is used in the computation of -+ * soft_rt_next_start: soft_rt_next_start must be higher than the current -+ * time plus the maximum time for which the arrival of a request is waited -+ * for when a sync queue becomes idle, namely bfqd->bfq_slice_idle. -+ * This filters out greedy applications, as the latter issue instead their -+ * next request as soon as possible after the last one has been completed -+ * (in contrast, when a batch of requests is completed, a soft real-time -+ * application spends some time processing data). -+ * -+ * Unfortunately, the last filter may easily generate false positives if -+ * only bfqd->bfq_slice_idle is used as a reference time interval and one -+ * or both the following cases occur: -+ * 1) HZ is so low that the duration of a jiffy is comparable to or higher -+ * than bfqd->bfq_slice_idle. This happens, e.g., on slow devices with -+ * HZ=100. -+ * 2) jiffies, instead of increasing at a constant rate, may stop increasing -+ * for a while, then suddenly 'jump' by several units to recover the lost -+ * increments. This seems to happen, e.g., inside virtual machines. -+ * To address this issue, we do not use as a reference time interval just -+ * bfqd->bfq_slice_idle, but bfqd->bfq_slice_idle plus a few jiffies. In -+ * particular we add the minimum number of jiffies for which the filter -+ * seems to be quite precise also in embedded systems and KVM/QEMU virtual -+ * machines. -+ */ -+static unsigned long bfq_bfqq_softrt_next_start(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq) -+{ -+ return max(bfqq->last_idle_bklogged + -+ HZ * bfqq->service_from_backlogged / -+ bfqd->bfq_wr_max_softrt_rate, -+ jiffies + bfqq->bfqd->bfq_slice_idle + 4); -+} -+ -+/* -+ * Return the largest-possible time instant such that, for as long as possible, -+ * the current time will be lower than this time instant according to the macro -+ * time_is_before_jiffies(). -+ */ -+static unsigned long bfq_infinity_from_now(unsigned long now) -+{ -+ return now + ULONG_MAX / 2; -+} -+ -+/** -+ * bfq_bfqq_expire - expire a queue. -+ * @bfqd: device owning the queue. -+ * @bfqq: the queue to expire. -+ * @compensate: if true, compensate for the time spent idling. -+ * @reason: the reason causing the expiration. -+ * -+ * -+ * If the process associated to the queue is slow (i.e., seeky), or in -+ * case of budget timeout, or, finally, if it is async, we -+ * artificially charge it an entire budget (independently of the -+ * actual service it received). As a consequence, the queue will get -+ * higher timestamps than the correct ones upon reactivation, and -+ * hence it will be rescheduled as if it had received more service -+ * than what it actually received. In the end, this class of processes -+ * will receive less service in proportion to how slowly they consume -+ * their budgets (and hence how seriously they tend to lower the -+ * throughput). -+ * -+ * In contrast, when a queue expires because it has been idling for -+ * too much or because it exhausted its budget, we do not touch the -+ * amount of service it has received. Hence when the queue will be -+ * reactivated and its timestamps updated, the latter will be in sync -+ * with the actual service received by the queue until expiration. -+ * -+ * Charging a full budget to the first type of queues and the exact -+ * service to the others has the effect of using the WF2Q+ policy to -+ * schedule the former on a timeslice basis, without violating the -+ * service domain guarantees of the latter. -+ */ -+static void bfq_bfqq_expire(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq, -+ bool compensate, -+ enum bfqq_expiration reason) -+{ -+ bool slow; -+ -+ BUG_ON(bfqq != bfqd->in_service_queue); -+ -+ /* -+ * Update disk peak rate for autotuning and check whether the -+ * process is slow (see bfq_update_peak_rate). -+ */ -+ slow = bfq_update_peak_rate(bfqd, bfqq, compensate, reason); -+ -+ /* -+ * As above explained, 'punish' slow (i.e., seeky), timed-out -+ * and async queues, to favor sequential sync workloads. -+ * -+ * Processes doing I/O in the slower disk zones will tend to be -+ * slow(er) even if not seeky. Hence, since the estimated peak -+ * rate is actually an average over the disk surface, these -+ * processes may timeout just for bad luck. To avoid punishing -+ * them we do not charge a full budget to a process that -+ * succeeded in consuming at least 2/3 of its budget. -+ */ -+ if (slow || (reason == BFQ_BFQQ_BUDGET_TIMEOUT && -+ bfq_bfqq_budget_left(bfqq) >= bfqq->entity.budget / 3)) -+ bfq_bfqq_charge_full_budget(bfqq); -+ -+ bfqq->service_from_backlogged += bfqq->entity.service; -+ -+ if (BFQQ_SEEKY(bfqq) && reason == BFQ_BFQQ_BUDGET_TIMEOUT && -+ !bfq_bfqq_constantly_seeky(bfqq)) { -+ bfq_mark_bfqq_constantly_seeky(bfqq); -+ if (!blk_queue_nonrot(bfqd->queue)) -+ bfqd->const_seeky_busy_in_flight_queues++; -+ } -+ -+ if (reason == BFQ_BFQQ_TOO_IDLE && -+ bfqq->entity.service <= 2 * bfqq->entity.budget / 10) -+ bfq_clear_bfqq_IO_bound(bfqq); -+ -+ if (bfqd->low_latency && bfqq->wr_coeff == 1) -+ bfqq->last_wr_start_finish = jiffies; -+ -+ if (bfqd->low_latency && bfqd->bfq_wr_max_softrt_rate > 0 && -+ RB_EMPTY_ROOT(&bfqq->sort_list)) { -+ /* -+ * If we get here, and there are no outstanding requests, -+ * then the request pattern is isochronous (see the comments -+ * to the function bfq_bfqq_softrt_next_start()). Hence we -+ * can compute soft_rt_next_start. If, instead, the queue -+ * still has outstanding requests, then we have to wait -+ * for the completion of all the outstanding requests to -+ * discover whether the request pattern is actually -+ * isochronous. -+ */ -+ if (bfqq->dispatched == 0) -+ bfqq->soft_rt_next_start = -+ bfq_bfqq_softrt_next_start(bfqd, bfqq); -+ else { -+ /* -+ * The application is still waiting for the -+ * completion of one or more requests: -+ * prevent it from possibly being incorrectly -+ * deemed as soft real-time by setting its -+ * soft_rt_next_start to infinity. In fact, -+ * without this assignment, the application -+ * would be incorrectly deemed as soft -+ * real-time if: -+ * 1) it issued a new request before the -+ * completion of all its in-flight -+ * requests, and -+ * 2) at that time, its soft_rt_next_start -+ * happened to be in the past. -+ */ -+ bfqq->soft_rt_next_start = -+ bfq_infinity_from_now(jiffies); -+ /* -+ * Schedule an update of soft_rt_next_start to when -+ * the task may be discovered to be isochronous. -+ */ -+ bfq_mark_bfqq_softrt_update(bfqq); -+ } -+ } -+ -+ bfq_log_bfqq(bfqd, bfqq, -+ "expire (%d, slow %d, num_disp %d, idle_win %d)", reason, -+ slow, bfqq->dispatched, bfq_bfqq_idle_window(bfqq)); -+ -+ /* -+ * Increase, decrease or leave budget unchanged according to -+ * reason. -+ */ -+ __bfq_bfqq_recalc_budget(bfqd, bfqq, reason); -+ __bfq_bfqq_expire(bfqd, bfqq); -+} -+ -+/* -+ * Budget timeout is not implemented through a dedicated timer, but -+ * just checked on request arrivals and completions, as well as on -+ * idle timer expirations. -+ */ -+static bool bfq_bfqq_budget_timeout(struct bfq_queue *bfqq) -+{ -+ if (bfq_bfqq_budget_new(bfqq) || -+ time_before(jiffies, bfqq->budget_timeout)) -+ return false; -+ return true; -+} -+ -+/* -+ * If we expire a queue that is waiting for the arrival of a new -+ * request, we may prevent the fictitious timestamp back-shifting that -+ * allows the guarantees of the queue to be preserved (see [1] for -+ * this tricky aspect). Hence we return true only if this condition -+ * does not hold, or if the queue is slow enough to deserve only to be -+ * kicked off for preserving a high throughput. -+*/ -+static bool bfq_may_expire_for_budg_timeout(struct bfq_queue *bfqq) -+{ -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "may_budget_timeout: wait_request %d left %d timeout %d", -+ bfq_bfqq_wait_request(bfqq), -+ bfq_bfqq_budget_left(bfqq) >= bfqq->entity.budget / 3, -+ bfq_bfqq_budget_timeout(bfqq)); -+ -+ return (!bfq_bfqq_wait_request(bfqq) || -+ bfq_bfqq_budget_left(bfqq) >= bfqq->entity.budget / 3) -+ && -+ bfq_bfqq_budget_timeout(bfqq); -+} -+ -+/* -+ * For a queue that becomes empty, device idling is allowed only if -+ * this function returns true for that queue. As a consequence, since -+ * device idling plays a critical role for both throughput boosting -+ * and service guarantees, the return value of this function plays a -+ * critical role as well. -+ * -+ * In a nutshell, this function returns true only if idling is -+ * beneficial for throughput or, even if detrimental for throughput, -+ * idling is however necessary to preserve service guarantees (low -+ * latency, desired throughput distribution, ...). In particular, on -+ * NCQ-capable devices, this function tries to return false, so as to -+ * help keep the drives' internal queues full, whenever this helps the -+ * device boost the throughput without causing any service-guarantee -+ * issue. -+ * -+ * In more detail, the return value of this function is obtained by, -+ * first, computing a number of boolean variables that take into -+ * account throughput and service-guarantee issues, and, then, -+ * combining these variables in a logical expression. Most of the -+ * issues taken into account are not trivial. We discuss these issues -+ * while introducing the variables. -+ */ -+static bool bfq_bfqq_may_idle(struct bfq_queue *bfqq) -+{ -+ struct bfq_data *bfqd = bfqq->bfqd; -+ bool idling_boosts_thr, idling_boosts_thr_without_issues, -+ all_queues_seeky, on_hdd_and_not_all_queues_seeky, -+ idling_needed_for_service_guarantees, -+ asymmetric_scenario; -+ -+ /* -+ * The next variable takes into account the cases where idling -+ * boosts the throughput. -+ * -+ * The value of the variable is computed considering, first, that -+ * idling is virtually always beneficial for the throughput if: -+ * (a) the device is not NCQ-capable, or -+ * (b) regardless of the presence of NCQ, the device is rotational -+ * and the request pattern for bfqq is I/O-bound and sequential. -+ * -+ * Secondly, and in contrast to the above item (b), idling an -+ * NCQ-capable flash-based device would not boost the -+ * throughput even with sequential I/O; rather it would lower -+ * the throughput in proportion to how fast the device -+ * is. Accordingly, the next variable is true if any of the -+ * above conditions (a) and (b) is true, and, in particular, -+ * happens to be false if bfqd is an NCQ-capable flash-based -+ * device. -+ */ -+ idling_boosts_thr = !bfqd->hw_tag || -+ (!blk_queue_nonrot(bfqd->queue) && bfq_bfqq_IO_bound(bfqq) && -+ bfq_bfqq_idle_window(bfqq)); -+ -+ /* -+ * The value of the next variable, -+ * idling_boosts_thr_without_issues, is equal to that of -+ * idling_boosts_thr, unless a special case holds. In this -+ * special case, described below, idling may cause problems to -+ * weight-raised queues. -+ * -+ * When the request pool is saturated (e.g., in the presence -+ * of write hogs), if the processes associated with -+ * non-weight-raised queues ask for requests at a lower rate, -+ * then processes associated with weight-raised queues have a -+ * higher probability to get a request from the pool -+ * immediately (or at least soon) when they need one. Thus -+ * they have a higher probability to actually get a fraction -+ * of the device throughput proportional to their high -+ * weight. This is especially true with NCQ-capable drives, -+ * which enqueue several requests in advance, and further -+ * reorder internally-queued requests. -+ * -+ * For this reason, we force to false the value of -+ * idling_boosts_thr_without_issues if there are weight-raised -+ * busy queues. In this case, and if bfqq is not weight-raised, -+ * this guarantees that the device is not idled for bfqq (if, -+ * instead, bfqq is weight-raised, then idling will be -+ * guaranteed by another variable, see below). Combined with -+ * the timestamping rules of BFQ (see [1] for details), this -+ * behavior causes bfqq, and hence any sync non-weight-raised -+ * queue, to get a lower number of requests served, and thus -+ * to ask for a lower number of requests from the request -+ * pool, before the busy weight-raised queues get served -+ * again. This often mitigates starvation problems in the -+ * presence of heavy write workloads and NCQ, thereby -+ * guaranteeing a higher application and system responsiveness -+ * in these hostile scenarios. -+ */ -+ idling_boosts_thr_without_issues = idling_boosts_thr && -+ bfqd->wr_busy_queues == 0; -+ -+ /* -+ * There are then two cases where idling must be performed not -+ * for throughput concerns, but to preserve service -+ * guarantees. In the description of these cases, we say, for -+ * short, that a queue is sequential/random if the process -+ * associated to the queue issues sequential/random requests -+ * (in the second case the queue may be tagged as seeky or -+ * even constantly_seeky). -+ * -+ * To introduce the first case, we note that, since -+ * bfq_bfqq_idle_window(bfqq) is false if the device is -+ * NCQ-capable and bfqq is random (see -+ * bfq_update_idle_window()), then, from the above two -+ * assignments it follows that -+ * idling_boosts_thr_without_issues is false if the device is -+ * NCQ-capable and bfqq is random. Therefore, for this case, -+ * device idling would never be allowed if we used just -+ * idling_boosts_thr_without_issues to decide whether to allow -+ * it. And, beneficially, this would imply that throughput -+ * would always be boosted also with random I/O on NCQ-capable -+ * HDDs. -+ * -+ * But we must be careful on this point, to avoid an unfair -+ * treatment for bfqq. In fact, because of the same above -+ * assignments, idling_boosts_thr_without_issues is, on the -+ * other hand, true if 1) the device is an HDD and bfqq is -+ * sequential, and 2) there are no busy weight-raised -+ * queues. As a consequence, if we used just -+ * idling_boosts_thr_without_issues to decide whether to idle -+ * the device, then with an HDD we might easily bump into a -+ * scenario where queues that are sequential and I/O-bound -+ * would enjoy idling, whereas random queues would not. The -+ * latter might then get a low share of the device throughput, -+ * simply because the former would get many requests served -+ * after being set as in service, while the latter would not. -+ * -+ * To address this issue, we start by setting to true a -+ * sentinel variable, on_hdd_and_not_all_queues_seeky, if the -+ * device is rotational and not all queues with pending or -+ * in-flight requests are constantly seeky (i.e., there are -+ * active sequential queues, and bfqq might then be mistreated -+ * if it does not enjoy idling because it is random). -+ */ -+ all_queues_seeky = bfq_bfqq_constantly_seeky(bfqq) && -+ bfqd->busy_in_flight_queues == -+ bfqd->const_seeky_busy_in_flight_queues; -+ -+ on_hdd_and_not_all_queues_seeky = -+ !blk_queue_nonrot(bfqd->queue) && !all_queues_seeky; -+ -+ /* -+ * To introduce the second case where idling needs to be -+ * performed to preserve service guarantees, we can note that -+ * allowing the drive to enqueue more than one request at a -+ * time, and hence delegating de facto final scheduling -+ * decisions to the drive's internal scheduler, causes loss of -+ * control on the actual request service order. In particular, -+ * the critical situation is when requests from different -+ * processes happens to be present, at the same time, in the -+ * internal queue(s) of the drive. In such a situation, the -+ * drive, by deciding the service order of the -+ * internally-queued requests, does determine also the actual -+ * throughput distribution among these processes. But the -+ * drive typically has no notion or concern about per-process -+ * throughput distribution, and makes its decisions only on a -+ * per-request basis. Therefore, the service distribution -+ * enforced by the drive's internal scheduler is likely to -+ * coincide with the desired device-throughput distribution -+ * only in a completely symmetric scenario where: -+ * (i) each of these processes must get the same throughput as -+ * the others; -+ * (ii) all these processes have the same I/O pattern -+ * (either sequential or random). -+ * In fact, in such a scenario, the drive will tend to treat -+ * the requests of each of these processes in about the same -+ * way as the requests of the others, and thus to provide -+ * each of these processes with about the same throughput -+ * (which is exactly the desired throughput distribution). In -+ * contrast, in any asymmetric scenario, device idling is -+ * certainly needed to guarantee that bfqq receives its -+ * assigned fraction of the device throughput (see [1] for -+ * details). -+ * -+ * We address this issue by controlling, actually, only the -+ * symmetry sub-condition (i), i.e., provided that -+ * sub-condition (i) holds, idling is not performed, -+ * regardless of whether sub-condition (ii) holds. In other -+ * words, only if sub-condition (i) holds, then idling is -+ * allowed, and the device tends to be prevented from queueing -+ * many requests, possibly of several processes. The reason -+ * for not controlling also sub-condition (ii) is that, first, -+ * in the case of an HDD, the asymmetry in terms of types of -+ * I/O patterns is already taken in to account in the above -+ * sentinel variable -+ * on_hdd_and_not_all_queues_seeky. Secondly, in the case of a -+ * flash-based device, we prefer however to privilege -+ * throughput (and idling lowers throughput for this type of -+ * devices), for the following reasons: -+ * 1) differently from HDDs, the service time of random -+ * requests is not orders of magnitudes lower than the service -+ * time of sequential requests; thus, even if processes doing -+ * sequential I/O get a preferential treatment with respect to -+ * others doing random I/O, the consequences are not as -+ * dramatic as with HDDs; -+ * 2) if a process doing random I/O does need strong -+ * throughput guarantees, it is hopefully already being -+ * weight-raised, or the user is likely to have assigned it a -+ * higher weight than the other processes (and thus -+ * sub-condition (i) is likely to be false, which triggers -+ * idling). -+ * -+ * According to the above considerations, the next variable is -+ * true (only) if sub-condition (i) holds. To compute the -+ * value of this variable, we not only use the return value of -+ * the function bfq_symmetric_scenario(), but also check -+ * whether bfqq is being weight-raised, because -+ * bfq_symmetric_scenario() does not take into account also -+ * weight-raised queues (see comments to -+ * bfq_weights_tree_add()). -+ * -+ * As a side note, it is worth considering that the above -+ * device-idling countermeasures may however fail in the -+ * following unlucky scenario: if idling is (correctly) -+ * disabled in a time period during which all symmetry -+ * sub-conditions hold, and hence the device is allowed to -+ * enqueue many requests, but at some later point in time some -+ * sub-condition stops to hold, then it may become impossible -+ * to let requests be served in the desired order until all -+ * the requests already queued in the device have been served. -+ */ -+ asymmetric_scenario = bfqq->wr_coeff > 1 || -+ !bfq_symmetric_scenario(bfqd); -+ -+ /* -+ * Finally, there is a case where maximizing throughput is the -+ * best choice even if it may cause unfairness toward -+ * bfqq. Such a case is when bfqq became active in a burst of -+ * queue activations. Queues that became active during a large -+ * burst benefit only from throughput, as discussed in the -+ * comments to bfq_handle_burst. Thus, if bfqq became active -+ * in a burst and not idling the device maximizes throughput, -+ * then the device must no be idled, because not idling the -+ * device provides bfqq and all other queues in the burst with -+ * maximum benefit. Combining this and the two cases above, we -+ * can now establish when idling is actually needed to -+ * preserve service guarantees. -+ */ -+ idling_needed_for_service_guarantees = -+ (on_hdd_and_not_all_queues_seeky || asymmetric_scenario) && -+ !bfq_bfqq_in_large_burst(bfqq); -+ -+ /* -+ * We have now all the components we need to compute the return -+ * value of the function, which is true only if both the following -+ * conditions hold: -+ * 1) bfqq is sync, because idling make sense only for sync queues; -+ * 2) idling either boosts the throughput (without issues), or -+ * is necessary to preserve service guarantees. -+ */ -+ return bfq_bfqq_sync(bfqq) && -+ (idling_boosts_thr_without_issues || -+ idling_needed_for_service_guarantees); -+} -+ -+/* -+ * If the in-service queue is empty but the function bfq_bfqq_may_idle -+ * returns true, then: -+ * 1) the queue must remain in service and cannot be expired, and -+ * 2) the device must be idled to wait for the possible arrival of a new -+ * request for the queue. -+ * See the comments to the function bfq_bfqq_may_idle for the reasons -+ * why performing device idling is the best choice to boost the throughput -+ * and preserve service guarantees when bfq_bfqq_may_idle itself -+ * returns true. -+ */ -+static bool bfq_bfqq_must_idle(struct bfq_queue *bfqq) -+{ -+ struct bfq_data *bfqd = bfqq->bfqd; -+ -+ return RB_EMPTY_ROOT(&bfqq->sort_list) && bfqd->bfq_slice_idle != 0 && -+ bfq_bfqq_may_idle(bfqq); -+} -+ -+/* -+ * Select a queue for service. If we have a current queue in service, -+ * check whether to continue servicing it, or retrieve and set a new one. -+ */ -+static struct bfq_queue *bfq_select_queue(struct bfq_data *bfqd) -+{ -+ struct bfq_queue *bfqq; -+ struct request *next_rq; -+ enum bfqq_expiration reason = BFQ_BFQQ_BUDGET_TIMEOUT; -+ -+ bfqq = bfqd->in_service_queue; -+ if (!bfqq) -+ goto new_queue; -+ -+ bfq_log_bfqq(bfqd, bfqq, "select_queue: already in-service queue"); -+ -+ if (bfq_may_expire_for_budg_timeout(bfqq) && -+ !timer_pending(&bfqd->idle_slice_timer) && -+ !bfq_bfqq_must_idle(bfqq)) -+ goto expire; -+ -+ next_rq = bfqq->next_rq; -+ /* -+ * If bfqq has requests queued and it has enough budget left to -+ * serve them, keep the queue, otherwise expire it. -+ */ -+ if (next_rq) { -+ if (bfq_serv_to_charge(next_rq, bfqq) > -+ bfq_bfqq_budget_left(bfqq)) { -+ reason = BFQ_BFQQ_BUDGET_EXHAUSTED; -+ goto expire; -+ } else { -+ /* -+ * The idle timer may be pending because we may -+ * not disable disk idling even when a new request -+ * arrives. -+ */ -+ if (timer_pending(&bfqd->idle_slice_timer)) { -+ /* -+ * If we get here: 1) at least a new request -+ * has arrived but we have not disabled the -+ * timer because the request was too small, -+ * 2) then the block layer has unplugged -+ * the device, causing the dispatch to be -+ * invoked. -+ * -+ * Since the device is unplugged, now the -+ * requests are probably large enough to -+ * provide a reasonable throughput. -+ * So we disable idling. -+ */ -+ bfq_clear_bfqq_wait_request(bfqq); -+ del_timer(&bfqd->idle_slice_timer); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqg_stats_update_idle_time(bfqq_group(bfqq)); -+#endif -+ } -+ goto keep_queue; -+ } -+ } -+ -+ /* -+ * No requests pending. However, if the in-service queue is idling -+ * for a new request, or has requests waiting for a completion and -+ * may idle after their completion, then keep it anyway. -+ */ -+ if (timer_pending(&bfqd->idle_slice_timer) || -+ (bfqq->dispatched != 0 && bfq_bfqq_may_idle(bfqq))) { -+ bfqq = NULL; -+ goto keep_queue; -+ } -+ -+ reason = BFQ_BFQQ_NO_MORE_REQUESTS; -+expire: -+ bfq_bfqq_expire(bfqd, bfqq, false, reason); -+new_queue: -+ bfqq = bfq_set_in_service_queue(bfqd); -+ bfq_log(bfqd, "select_queue: new queue %d returned", -+ bfqq ? bfqq->pid : 0); -+keep_queue: -+ return bfqq; -+} -+ -+static void bfq_update_wr_data(struct bfq_data *bfqd, struct bfq_queue *bfqq) -+{ -+ struct bfq_entity *entity = &bfqq->entity; -+ -+ if (bfqq->wr_coeff > 1) { /* queue is being weight-raised */ -+ bfq_log_bfqq(bfqd, bfqq, -+ "raising period dur %u/%u msec, old coeff %u, w %d(%d)", -+ jiffies_to_msecs(jiffies - bfqq->last_wr_start_finish), -+ jiffies_to_msecs(bfqq->wr_cur_max_time), -+ bfqq->wr_coeff, -+ bfqq->entity.weight, bfqq->entity.orig_weight); -+ -+ BUG_ON(bfqq != bfqd->in_service_queue && entity->weight != -+ entity->orig_weight * bfqq->wr_coeff); -+ if (entity->prio_changed) -+ bfq_log_bfqq(bfqd, bfqq, "WARN: pending prio change"); -+ -+ /* -+ * If the queue was activated in a burst, or -+ * too much time has elapsed from the beginning -+ * of this weight-raising period, then end weight -+ * raising. -+ */ -+ if (bfq_bfqq_in_large_burst(bfqq) || -+ time_is_before_jiffies(bfqq->last_wr_start_finish + -+ bfqq->wr_cur_max_time)) { -+ bfqq->last_wr_start_finish = jiffies; -+ bfq_log_bfqq(bfqd, bfqq, -+ "wrais ending at %lu, rais_max_time %u", -+ bfqq->last_wr_start_finish, -+ jiffies_to_msecs(bfqq->wr_cur_max_time)); -+ bfq_bfqq_end_wr(bfqq); -+ } -+ } -+ /* Update weight both if it must be raised and if it must be lowered */ -+ if ((entity->weight > entity->orig_weight) != (bfqq->wr_coeff > 1)) -+ __bfq_entity_update_weight_prio( -+ bfq_entity_service_tree(entity), -+ entity); -+} -+ -+/* -+ * Dispatch one request from bfqq, moving it to the request queue -+ * dispatch list. -+ */ -+static int bfq_dispatch_request(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq) -+{ -+ int dispatched = 0; -+ struct request *rq; -+ unsigned long service_to_charge; -+ -+ BUG_ON(RB_EMPTY_ROOT(&bfqq->sort_list)); -+ -+ /* Follow expired path, else get first next available. */ -+ rq = bfq_check_fifo(bfqq); -+ if (!rq) -+ rq = bfqq->next_rq; -+ service_to_charge = bfq_serv_to_charge(rq, bfqq); -+ -+ if (service_to_charge > bfq_bfqq_budget_left(bfqq)) { -+ /* -+ * This may happen if the next rq is chosen in fifo order -+ * instead of sector order. The budget is properly -+ * dimensioned to be always sufficient to serve the next -+ * request only if it is chosen in sector order. The reason -+ * is that it would be quite inefficient and little useful -+ * to always make sure that the budget is large enough to -+ * serve even the possible next rq in fifo order. -+ * In fact, requests are seldom served in fifo order. -+ * -+ * Expire the queue for budget exhaustion, and make sure -+ * that the next act_budget is enough to serve the next -+ * request, even if it comes from the fifo expired path. -+ */ -+ bfqq->next_rq = rq; -+ /* -+ * Since this dispatch is failed, make sure that -+ * a new one will be performed -+ */ -+ if (!bfqd->rq_in_driver) -+ bfq_schedule_dispatch(bfqd); -+ goto expire; -+ } -+ -+ /* Finally, insert request into driver dispatch list. */ -+ bfq_bfqq_served(bfqq, service_to_charge); -+ bfq_dispatch_insert(bfqd->queue, rq); -+ -+ bfq_update_wr_data(bfqd, bfqq); -+ -+ bfq_log_bfqq(bfqd, bfqq, -+ "dispatched %u sec req (%llu), budg left %d", -+ blk_rq_sectors(rq), -+ (unsigned long long) blk_rq_pos(rq), -+ bfq_bfqq_budget_left(bfqq)); -+ -+ dispatched++; -+ -+ if (!bfqd->in_service_bic) { -+ atomic_long_inc(&RQ_BIC(rq)->icq.ioc->refcount); -+ bfqd->in_service_bic = RQ_BIC(rq); -+ } -+ -+ if (bfqd->busy_queues > 1 && ((!bfq_bfqq_sync(bfqq) && -+ dispatched >= bfqd->bfq_max_budget_async_rq) || -+ bfq_class_idle(bfqq))) -+ goto expire; -+ -+ return dispatched; -+ -+expire: -+ bfq_bfqq_expire(bfqd, bfqq, false, BFQ_BFQQ_BUDGET_EXHAUSTED); -+ return dispatched; -+} -+ -+static int __bfq_forced_dispatch_bfqq(struct bfq_queue *bfqq) -+{ -+ int dispatched = 0; -+ -+ while (bfqq->next_rq) { -+ bfq_dispatch_insert(bfqq->bfqd->queue, bfqq->next_rq); -+ dispatched++; -+ } -+ -+ BUG_ON(!list_empty(&bfqq->fifo)); -+ return dispatched; -+} -+ -+/* -+ * Drain our current requests. -+ * Used for barriers and when switching io schedulers on-the-fly. -+ */ -+static int bfq_forced_dispatch(struct bfq_data *bfqd) -+{ -+ struct bfq_queue *bfqq, *n; -+ struct bfq_service_tree *st; -+ int dispatched = 0; -+ -+ bfqq = bfqd->in_service_queue; -+ if (bfqq) -+ __bfq_bfqq_expire(bfqd, bfqq); -+ -+ /* -+ * Loop through classes, and be careful to leave the scheduler -+ * in a consistent state, as feedback mechanisms and vtime -+ * updates cannot be disabled during the process. -+ */ -+ list_for_each_entry_safe(bfqq, n, &bfqd->active_list, bfqq_list) { -+ st = bfq_entity_service_tree(&bfqq->entity); -+ -+ dispatched += __bfq_forced_dispatch_bfqq(bfqq); -+ bfqq->max_budget = bfq_max_budget(bfqd); -+ -+ bfq_forget_idle(st); -+ } -+ -+ BUG_ON(bfqd->busy_queues != 0); -+ -+ return dispatched; -+} -+ -+static int bfq_dispatch_requests(struct request_queue *q, int force) -+{ -+ struct bfq_data *bfqd = q->elevator->elevator_data; -+ struct bfq_queue *bfqq; -+ int max_dispatch; -+ -+ bfq_log(bfqd, "dispatch requests: %d busy queues", bfqd->busy_queues); -+ if (bfqd->busy_queues == 0) -+ return 0; -+ -+ if (unlikely(force)) -+ return bfq_forced_dispatch(bfqd); -+ -+ bfqq = bfq_select_queue(bfqd); -+ if (!bfqq) -+ return 0; -+ -+ if (bfq_class_idle(bfqq)) -+ max_dispatch = 1; -+ -+ if (!bfq_bfqq_sync(bfqq)) -+ max_dispatch = bfqd->bfq_max_budget_async_rq; -+ -+ if (!bfq_bfqq_sync(bfqq) && bfqq->dispatched >= max_dispatch) { -+ if (bfqd->busy_queues > 1) -+ return 0; -+ if (bfqq->dispatched >= 4 * max_dispatch) -+ return 0; -+ } -+ -+ if (bfqd->sync_flight != 0 && !bfq_bfqq_sync(bfqq)) -+ return 0; -+ -+ bfq_clear_bfqq_wait_request(bfqq); -+ BUG_ON(timer_pending(&bfqd->idle_slice_timer)); -+ -+ if (!bfq_dispatch_request(bfqd, bfqq)) -+ return 0; -+ -+ bfq_log_bfqq(bfqd, bfqq, "dispatched %s request", -+ bfq_bfqq_sync(bfqq) ? "sync" : "async"); -+ -+ return 1; -+} -+ -+/* -+ * Task holds one reference to the queue, dropped when task exits. Each rq -+ * in-flight on this queue also holds a reference, dropped when rq is freed. -+ * -+ * Queue lock must be held here. -+ */ -+static void bfq_put_queue(struct bfq_queue *bfqq) -+{ -+ struct bfq_data *bfqd = bfqq->bfqd; -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ struct bfq_group *bfqg = bfqq_group(bfqq); -+#endif -+ -+ BUG_ON(atomic_read(&bfqq->ref) <= 0); -+ -+ bfq_log_bfqq(bfqd, bfqq, "put_queue: %p %d", bfqq, -+ atomic_read(&bfqq->ref)); -+ if (!atomic_dec_and_test(&bfqq->ref)) -+ return; -+ -+ BUG_ON(rb_first(&bfqq->sort_list)); -+ BUG_ON(bfqq->allocated[READ] + bfqq->allocated[WRITE] != 0); -+ BUG_ON(bfqq->entity.tree); -+ BUG_ON(bfq_bfqq_busy(bfqq)); -+ BUG_ON(bfqd->in_service_queue == bfqq); -+ -+ if (bfq_bfqq_sync(bfqq)) -+ /* -+ * The fact that this queue is being destroyed does not -+ * invalidate the fact that this queue may have been -+ * activated during the current burst. As a consequence, -+ * although the queue does not exist anymore, and hence -+ * needs to be removed from the burst list if there, -+ * the burst size has not to be decremented. -+ */ -+ hlist_del_init(&bfqq->burst_list_node); -+ -+ bfq_log_bfqq(bfqd, bfqq, "put_queue: %p freed", bfqq); -+ -+ kmem_cache_free(bfq_pool, bfqq); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqg_put(bfqg); -+#endif -+} -+ -+static void bfq_exit_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq) -+{ -+ if (bfqq == bfqd->in_service_queue) { -+ __bfq_bfqq_expire(bfqd, bfqq); -+ bfq_schedule_dispatch(bfqd); -+ } -+ -+ bfq_log_bfqq(bfqd, bfqq, "exit_bfqq: %p, %d", bfqq, -+ atomic_read(&bfqq->ref)); -+ -+ bfq_put_queue(bfqq); -+} -+ -+static void bfq_init_icq(struct io_cq *icq) -+{ -+ struct bfq_io_cq *bic = icq_to_bic(icq); -+ -+ bic->ttime.last_end_request = jiffies; -+} -+ -+static void bfq_exit_icq(struct io_cq *icq) -+{ -+ struct bfq_io_cq *bic = icq_to_bic(icq); -+ struct bfq_data *bfqd = bic_to_bfqd(bic); -+ -+ if (bic->bfqq[BLK_RW_ASYNC]) { -+ bfq_exit_bfqq(bfqd, bic->bfqq[BLK_RW_ASYNC]); -+ bic->bfqq[BLK_RW_ASYNC] = NULL; -+ } -+ -+ if (bic->bfqq[BLK_RW_SYNC]) { -+ bfq_exit_bfqq(bfqd, bic->bfqq[BLK_RW_SYNC]); -+ bic->bfqq[BLK_RW_SYNC] = NULL; -+ } -+} -+ -+/* -+ * Update the entity prio values; note that the new values will not -+ * be used until the next (re)activation. -+ */ -+static void -+bfq_set_next_ioprio_data(struct bfq_queue *bfqq, struct bfq_io_cq *bic) -+{ -+ struct task_struct *tsk = current; -+ int ioprio_class; -+ -+ ioprio_class = IOPRIO_PRIO_CLASS(bic->ioprio); -+ switch (ioprio_class) { -+ default: -+ dev_err(bfqq->bfqd->queue->backing_dev_info.dev, -+ "bfq: bad prio class %d\n", ioprio_class); -+ case IOPRIO_CLASS_NONE: -+ /* -+ * No prio set, inherit CPU scheduling settings. -+ */ -+ bfqq->new_ioprio = task_nice_ioprio(tsk); -+ bfqq->new_ioprio_class = task_nice_ioclass(tsk); -+ break; -+ case IOPRIO_CLASS_RT: -+ bfqq->new_ioprio = IOPRIO_PRIO_DATA(bic->ioprio); -+ bfqq->new_ioprio_class = IOPRIO_CLASS_RT; -+ break; -+ case IOPRIO_CLASS_BE: -+ bfqq->new_ioprio = IOPRIO_PRIO_DATA(bic->ioprio); -+ bfqq->new_ioprio_class = IOPRIO_CLASS_BE; -+ break; -+ case IOPRIO_CLASS_IDLE: -+ bfqq->new_ioprio_class = IOPRIO_CLASS_IDLE; -+ bfqq->new_ioprio = 7; -+ bfq_clear_bfqq_idle_window(bfqq); -+ break; -+ } -+ -+ if (bfqq->new_ioprio < 0 || bfqq->new_ioprio >= IOPRIO_BE_NR) { -+ pr_crit("bfq_set_next_ioprio_data: new_ioprio %d\n", -+ bfqq->new_ioprio); -+ BUG(); -+ } -+ -+ bfqq->entity.new_weight = bfq_ioprio_to_weight(bfqq->new_ioprio); -+ bfqq->entity.prio_changed = 1; -+} -+ -+static void bfq_check_ioprio_change(struct bfq_io_cq *bic, struct bio *bio) -+{ -+ struct bfq_data *bfqd; -+ struct bfq_queue *bfqq, *new_bfqq; -+ unsigned long uninitialized_var(flags); -+ int ioprio = bic->icq.ioc->ioprio; -+ -+ bfqd = bfq_get_bfqd_locked(&(bic->icq.q->elevator->elevator_data), -+ &flags); -+ /* -+ * This condition may trigger on a newly created bic, be sure to -+ * drop the lock before returning. -+ */ -+ if (unlikely(!bfqd) || likely(bic->ioprio == ioprio)) -+ goto out; -+ -+ bic->ioprio = ioprio; -+ -+ bfqq = bic->bfqq[BLK_RW_ASYNC]; -+ if (bfqq) { -+ new_bfqq = bfq_get_queue(bfqd, bio, BLK_RW_ASYNC, bic, -+ GFP_ATOMIC); -+ if (new_bfqq) { -+ bic->bfqq[BLK_RW_ASYNC] = new_bfqq; -+ bfq_log_bfqq(bfqd, bfqq, -+ "check_ioprio_change: bfqq %p %d", -+ bfqq, atomic_read(&bfqq->ref)); -+ bfq_put_queue(bfqq); -+ } -+ } -+ -+ bfqq = bic->bfqq[BLK_RW_SYNC]; -+ if (bfqq) -+ bfq_set_next_ioprio_data(bfqq, bic); -+ -+out: -+ bfq_put_bfqd_unlock(bfqd, &flags); -+} -+ -+static void bfq_init_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq, -+ struct bfq_io_cq *bic, pid_t pid, int is_sync) -+{ -+ RB_CLEAR_NODE(&bfqq->entity.rb_node); -+ INIT_LIST_HEAD(&bfqq->fifo); -+ INIT_HLIST_NODE(&bfqq->burst_list_node); -+ -+ atomic_set(&bfqq->ref, 0); -+ bfqq->bfqd = bfqd; -+ -+ if (bic) -+ bfq_set_next_ioprio_data(bfqq, bic); -+ -+ if (is_sync) { -+ if (!bfq_class_idle(bfqq)) -+ bfq_mark_bfqq_idle_window(bfqq); -+ bfq_mark_bfqq_sync(bfqq); -+ } else -+ bfq_clear_bfqq_sync(bfqq); -+ bfq_mark_bfqq_IO_bound(bfqq); -+ -+ /* Tentative initial value to trade off between thr and lat */ -+ bfqq->max_budget = (2 * bfq_max_budget(bfqd)) / 3; -+ bfqq->pid = pid; -+ -+ bfqq->wr_coeff = 1; -+ bfqq->last_wr_start_finish = 0; -+ /* -+ * Set to the value for which bfqq will not be deemed as -+ * soft rt when it becomes backlogged. -+ */ -+ bfqq->soft_rt_next_start = bfq_infinity_from_now(jiffies); -+} -+ -+static struct bfq_queue *bfq_find_alloc_queue(struct bfq_data *bfqd, -+ struct bio *bio, int is_sync, -+ struct bfq_io_cq *bic, -+ gfp_t gfp_mask) -+{ -+ struct bfq_group *bfqg; -+ struct bfq_queue *bfqq, *new_bfqq = NULL; -+ struct blkcg *blkcg; -+ -+retry: -+ rcu_read_lock(); -+ -+ blkcg = bio_blkcg(bio); -+ bfqg = bfq_find_alloc_group(bfqd, blkcg); -+ /* bic always exists here */ -+ bfqq = bic_to_bfqq(bic, is_sync); -+ -+ /* -+ * Always try a new alloc if we fall back to the OOM bfqq -+ * originally, since it should just be a temporary situation. -+ */ -+ if (!bfqq || bfqq == &bfqd->oom_bfqq) { -+ bfqq = NULL; -+ if (new_bfqq) { -+ bfqq = new_bfqq; -+ new_bfqq = NULL; -+ } else if (gfpflags_allow_blocking(gfp_mask)) { -+ rcu_read_unlock(); -+ spin_unlock_irq(bfqd->queue->queue_lock); -+ new_bfqq = kmem_cache_alloc_node(bfq_pool, -+ gfp_mask | __GFP_ZERO, -+ bfqd->queue->node); -+ spin_lock_irq(bfqd->queue->queue_lock); -+ if (new_bfqq) -+ goto retry; -+ } else { -+ bfqq = kmem_cache_alloc_node(bfq_pool, -+ gfp_mask | __GFP_ZERO, -+ bfqd->queue->node); -+ } -+ -+ if (bfqq) { -+ bfq_init_bfqq(bfqd, bfqq, bic, current->pid, -+ is_sync); -+ bfq_init_entity(&bfqq->entity, bfqg); -+ bfq_log_bfqq(bfqd, bfqq, "allocated"); -+ } else { -+ bfqq = &bfqd->oom_bfqq; -+ bfq_log_bfqq(bfqd, bfqq, "using oom bfqq"); -+ } -+ } -+ -+ if (new_bfqq) -+ kmem_cache_free(bfq_pool, new_bfqq); -+ -+ rcu_read_unlock(); -+ -+ return bfqq; -+} -+ -+static struct bfq_queue **bfq_async_queue_prio(struct bfq_data *bfqd, -+ struct bfq_group *bfqg, -+ int ioprio_class, int ioprio) -+{ -+ switch (ioprio_class) { -+ case IOPRIO_CLASS_RT: -+ return &bfqg->async_bfqq[0][ioprio]; -+ case IOPRIO_CLASS_NONE: -+ ioprio = IOPRIO_NORM; -+ /* fall through */ -+ case IOPRIO_CLASS_BE: -+ return &bfqg->async_bfqq[1][ioprio]; -+ case IOPRIO_CLASS_IDLE: -+ return &bfqg->async_idle_bfqq; -+ default: -+ BUG(); -+ } -+} -+ -+static struct bfq_queue *bfq_get_queue(struct bfq_data *bfqd, -+ struct bio *bio, int is_sync, -+ struct bfq_io_cq *bic, gfp_t gfp_mask) -+{ -+ const int ioprio = IOPRIO_PRIO_DATA(bic->ioprio); -+ const int ioprio_class = IOPRIO_PRIO_CLASS(bic->ioprio); -+ struct bfq_queue **async_bfqq = NULL; -+ struct bfq_queue *bfqq = NULL; -+ -+ if (!is_sync) { -+ struct blkcg *blkcg; -+ struct bfq_group *bfqg; -+ -+ rcu_read_lock(); -+ blkcg = bio_blkcg(bio); -+ rcu_read_unlock(); -+ bfqg = bfq_find_alloc_group(bfqd, blkcg); -+ async_bfqq = bfq_async_queue_prio(bfqd, bfqg, ioprio_class, -+ ioprio); -+ bfqq = *async_bfqq; -+ } -+ -+ if (!bfqq) -+ bfqq = bfq_find_alloc_queue(bfqd, bio, is_sync, bic, gfp_mask); -+ -+ /* -+ * Pin the queue now that it's allocated, scheduler exit will -+ * prune it. -+ */ -+ if (!is_sync && !(*async_bfqq)) { -+ atomic_inc(&bfqq->ref); -+ bfq_log_bfqq(bfqd, bfqq, "get_queue, bfqq not in async: %p, %d", -+ bfqq, atomic_read(&bfqq->ref)); -+ *async_bfqq = bfqq; -+ } -+ -+ atomic_inc(&bfqq->ref); -+ bfq_log_bfqq(bfqd, bfqq, "get_queue, at end: %p, %d", bfqq, -+ atomic_read(&bfqq->ref)); -+ return bfqq; -+} -+ -+static void bfq_update_io_thinktime(struct bfq_data *bfqd, -+ struct bfq_io_cq *bic) -+{ -+ unsigned long elapsed = jiffies - bic->ttime.last_end_request; -+ unsigned long ttime = min(elapsed, 2UL * bfqd->bfq_slice_idle); -+ -+ bic->ttime.ttime_samples = (7*bic->ttime.ttime_samples + 256) / 8; -+ bic->ttime.ttime_total = (7*bic->ttime.ttime_total + 256*ttime) / 8; -+ bic->ttime.ttime_mean = (bic->ttime.ttime_total + 128) / -+ bic->ttime.ttime_samples; -+} -+ -+static void bfq_update_io_seektime(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq, -+ struct request *rq) -+{ -+ sector_t sdist; -+ u64 total; -+ -+ if (bfqq->last_request_pos < blk_rq_pos(rq)) -+ sdist = blk_rq_pos(rq) - bfqq->last_request_pos; -+ else -+ sdist = bfqq->last_request_pos - blk_rq_pos(rq); -+ -+ /* -+ * Don't allow the seek distance to get too large from the -+ * odd fragment, pagein, etc. -+ */ -+ if (bfqq->seek_samples == 0) /* first request, not really a seek */ -+ sdist = 0; -+ else if (bfqq->seek_samples <= 60) /* second & third seek */ -+ sdist = min(sdist, (bfqq->seek_mean * 4) + 2*1024*1024); -+ else -+ sdist = min(sdist, (bfqq->seek_mean * 4) + 2*1024*64); -+ -+ bfqq->seek_samples = (7*bfqq->seek_samples + 256) / 8; -+ bfqq->seek_total = (7*bfqq->seek_total + (u64)256*sdist) / 8; -+ total = bfqq->seek_total + (bfqq->seek_samples/2); -+ do_div(total, bfqq->seek_samples); -+ bfqq->seek_mean = (sector_t)total; -+ -+ bfq_log_bfqq(bfqd, bfqq, "dist=%llu mean=%llu", (u64)sdist, -+ (u64)bfqq->seek_mean); -+} -+ -+/* -+ * Disable idle window if the process thinks too long or seeks so much that -+ * it doesn't matter. -+ */ -+static void bfq_update_idle_window(struct bfq_data *bfqd, -+ struct bfq_queue *bfqq, -+ struct bfq_io_cq *bic) -+{ -+ int enable_idle; -+ -+ /* Don't idle for async or idle io prio class. */ -+ if (!bfq_bfqq_sync(bfqq) || bfq_class_idle(bfqq)) -+ return; -+ -+ enable_idle = bfq_bfqq_idle_window(bfqq); -+ -+ if (atomic_read(&bic->icq.ioc->active_ref) == 0 || -+ bfqd->bfq_slice_idle == 0 || -+ (bfqd->hw_tag && BFQQ_SEEKY(bfqq) && -+ bfqq->wr_coeff == 1)) -+ enable_idle = 0; -+ else if (bfq_sample_valid(bic->ttime.ttime_samples)) { -+ if (bic->ttime.ttime_mean > bfqd->bfq_slice_idle && -+ bfqq->wr_coeff == 1) -+ enable_idle = 0; -+ else -+ enable_idle = 1; -+ } -+ bfq_log_bfqq(bfqd, bfqq, "update_idle_window: enable_idle %d", -+ enable_idle); -+ -+ if (enable_idle) -+ bfq_mark_bfqq_idle_window(bfqq); -+ else -+ bfq_clear_bfqq_idle_window(bfqq); -+} -+ -+/* -+ * Called when a new fs request (rq) is added to bfqq. Check if there's -+ * something we should do about it. -+ */ -+static void bfq_rq_enqueued(struct bfq_data *bfqd, struct bfq_queue *bfqq, -+ struct request *rq) -+{ -+ struct bfq_io_cq *bic = RQ_BIC(rq); -+ -+ if (rq->cmd_flags & REQ_META) -+ bfqq->meta_pending++; -+ -+ bfq_update_io_thinktime(bfqd, bic); -+ bfq_update_io_seektime(bfqd, bfqq, rq); -+ if (!BFQQ_SEEKY(bfqq) && bfq_bfqq_constantly_seeky(bfqq)) { -+ bfq_clear_bfqq_constantly_seeky(bfqq); -+ if (!blk_queue_nonrot(bfqd->queue)) { -+ BUG_ON(!bfqd->const_seeky_busy_in_flight_queues); -+ bfqd->const_seeky_busy_in_flight_queues--; -+ } -+ } -+ if (bfqq->entity.service > bfq_max_budget(bfqd) / 8 || -+ !BFQQ_SEEKY(bfqq)) -+ bfq_update_idle_window(bfqd, bfqq, bic); -+ -+ bfq_log_bfqq(bfqd, bfqq, -+ "rq_enqueued: idle_window=%d (seeky %d, mean %llu)", -+ bfq_bfqq_idle_window(bfqq), BFQQ_SEEKY(bfqq), -+ (unsigned long long) bfqq->seek_mean); -+ -+ bfqq->last_request_pos = blk_rq_pos(rq) + blk_rq_sectors(rq); -+ -+ if (bfqq == bfqd->in_service_queue && bfq_bfqq_wait_request(bfqq)) { -+ bool small_req = bfqq->queued[rq_is_sync(rq)] == 1 && -+ blk_rq_sectors(rq) < 32; -+ bool budget_timeout = bfq_bfqq_budget_timeout(bfqq); -+ -+ /* -+ * There is just this request queued: if the request -+ * is small and the queue is not to be expired, then -+ * just exit. -+ * -+ * In this way, if the disk is being idled to wait for -+ * a new request from the in-service queue, we avoid -+ * unplugging the device and committing the disk to serve -+ * just a small request. On the contrary, we wait for -+ * the block layer to decide when to unplug the device: -+ * hopefully, new requests will be merged to this one -+ * quickly, then the device will be unplugged and -+ * larger requests will be dispatched. -+ */ -+ if (small_req && !budget_timeout) -+ return; -+ -+ /* -+ * A large enough request arrived, or the queue is to -+ * be expired: in both cases disk idling is to be -+ * stopped, so clear wait_request flag and reset -+ * timer. -+ */ -+ bfq_clear_bfqq_wait_request(bfqq); -+ del_timer(&bfqd->idle_slice_timer); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqg_stats_update_idle_time(bfqq_group(bfqq)); -+#endif -+ -+ /* -+ * The queue is not empty, because a new request just -+ * arrived. Hence we can safely expire the queue, in -+ * case of budget timeout, without risking that the -+ * timestamps of the queue are not updated correctly. -+ * See [1] for more details. -+ */ -+ if (budget_timeout) -+ bfq_bfqq_expire(bfqd, bfqq, false, -+ BFQ_BFQQ_BUDGET_TIMEOUT); -+ -+ /* -+ * Let the request rip immediately, or let a new queue be -+ * selected if bfqq has just been expired. -+ */ -+ __blk_run_queue(bfqd->queue); -+ } -+} -+ -+static void bfq_insert_request(struct request_queue *q, struct request *rq) -+{ -+ struct bfq_data *bfqd = q->elevator->elevator_data; -+ struct bfq_queue *bfqq = RQ_BFQQ(rq); -+ -+ assert_spin_locked(bfqd->queue->queue_lock); -+ -+ bfq_add_request(rq); -+ -+ rq->fifo_time = jiffies + bfqd->bfq_fifo_expire[rq_is_sync(rq)]; -+ list_add_tail(&rq->queuelist, &bfqq->fifo); -+ -+ bfq_rq_enqueued(bfqd, bfqq, rq); -+} -+ -+static void bfq_update_hw_tag(struct bfq_data *bfqd) -+{ -+ bfqd->max_rq_in_driver = max(bfqd->max_rq_in_driver, -+ bfqd->rq_in_driver); -+ -+ if (bfqd->hw_tag == 1) -+ return; -+ -+ /* -+ * This sample is valid if the number of outstanding requests -+ * is large enough to allow a queueing behavior. Note that the -+ * sum is not exact, as it's not taking into account deactivated -+ * requests. -+ */ -+ if (bfqd->rq_in_driver + bfqd->queued < BFQ_HW_QUEUE_THRESHOLD) -+ return; -+ -+ if (bfqd->hw_tag_samples++ < BFQ_HW_QUEUE_SAMPLES) -+ return; -+ -+ bfqd->hw_tag = bfqd->max_rq_in_driver > BFQ_HW_QUEUE_THRESHOLD; -+ bfqd->max_rq_in_driver = 0; -+ bfqd->hw_tag_samples = 0; -+} -+ -+static void bfq_completed_request(struct request_queue *q, struct request *rq) -+{ -+ struct bfq_queue *bfqq = RQ_BFQQ(rq); -+ struct bfq_data *bfqd = bfqq->bfqd; -+ bool sync = bfq_bfqq_sync(bfqq); -+ -+ bfq_log_bfqq(bfqd, bfqq, "completed one req with %u sects left (%d)", -+ blk_rq_sectors(rq), sync); -+ -+ bfq_update_hw_tag(bfqd); -+ -+ BUG_ON(!bfqd->rq_in_driver); -+ BUG_ON(!bfqq->dispatched); -+ bfqd->rq_in_driver--; -+ bfqq->dispatched--; -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqg_stats_update_completion(bfqq_group(bfqq), -+ rq_start_time_ns(rq), -+ rq_io_start_time_ns(rq), rq->cmd_flags); -+#endif -+ -+ if (!bfqq->dispatched && !bfq_bfqq_busy(bfqq)) { -+ bfq_weights_tree_remove(bfqd, &bfqq->entity, -+ &bfqd->queue_weights_tree); -+ if (!blk_queue_nonrot(bfqd->queue)) { -+ BUG_ON(!bfqd->busy_in_flight_queues); -+ bfqd->busy_in_flight_queues--; -+ if (bfq_bfqq_constantly_seeky(bfqq)) { -+ BUG_ON(!bfqd-> -+ const_seeky_busy_in_flight_queues); -+ bfqd->const_seeky_busy_in_flight_queues--; -+ } -+ } -+ } -+ -+ if (sync) { -+ bfqd->sync_flight--; -+ RQ_BIC(rq)->ttime.last_end_request = jiffies; -+ } -+ -+ /* -+ * If we are waiting to discover whether the request pattern of the -+ * task associated with the queue is actually isochronous, and -+ * both requisites for this condition to hold are satisfied, then -+ * compute soft_rt_next_start (see the comments to the function -+ * bfq_bfqq_softrt_next_start()). -+ */ -+ if (bfq_bfqq_softrt_update(bfqq) && bfqq->dispatched == 0 && -+ RB_EMPTY_ROOT(&bfqq->sort_list)) -+ bfqq->soft_rt_next_start = -+ bfq_bfqq_softrt_next_start(bfqd, bfqq); -+ -+ /* -+ * If this is the in-service queue, check if it needs to be expired, -+ * or if we want to idle in case it has no pending requests. -+ */ -+ if (bfqd->in_service_queue == bfqq) { -+ if (bfq_bfqq_budget_new(bfqq)) -+ bfq_set_budget_timeout(bfqd); -+ -+ if (bfq_bfqq_must_idle(bfqq)) { -+ bfq_arm_slice_timer(bfqd); -+ goto out; -+ } else if (bfq_may_expire_for_budg_timeout(bfqq)) -+ bfq_bfqq_expire(bfqd, bfqq, false, -+ BFQ_BFQQ_BUDGET_TIMEOUT); -+ else if (RB_EMPTY_ROOT(&bfqq->sort_list) && -+ (bfqq->dispatched == 0 || -+ !bfq_bfqq_may_idle(bfqq))) -+ bfq_bfqq_expire(bfqd, bfqq, false, -+ BFQ_BFQQ_NO_MORE_REQUESTS); -+ } -+ -+ if (!bfqd->rq_in_driver) -+ bfq_schedule_dispatch(bfqd); -+ -+out: -+ return; -+} -+ -+static int __bfq_may_queue(struct bfq_queue *bfqq) -+{ -+ if (bfq_bfqq_wait_request(bfqq) && bfq_bfqq_must_alloc(bfqq)) { -+ bfq_clear_bfqq_must_alloc(bfqq); -+ return ELV_MQUEUE_MUST; -+ } -+ -+ return ELV_MQUEUE_MAY; -+} -+ -+static int bfq_may_queue(struct request_queue *q, int rw) -+{ -+ struct bfq_data *bfqd = q->elevator->elevator_data; -+ struct task_struct *tsk = current; -+ struct bfq_io_cq *bic; -+ struct bfq_queue *bfqq; -+ -+ /* -+ * Don't force setup of a queue from here, as a call to may_queue -+ * does not necessarily imply that a request actually will be -+ * queued. So just lookup a possibly existing queue, or return -+ * 'may queue' if that fails. -+ */ -+ bic = bfq_bic_lookup(bfqd, tsk->io_context); -+ if (!bic) -+ return ELV_MQUEUE_MAY; -+ -+ bfqq = bic_to_bfqq(bic, rw_is_sync(rw)); -+ if (bfqq) -+ return __bfq_may_queue(bfqq); -+ -+ return ELV_MQUEUE_MAY; -+} -+ -+/* -+ * Queue lock held here. -+ */ -+static void bfq_put_request(struct request *rq) -+{ -+ struct bfq_queue *bfqq = RQ_BFQQ(rq); -+ -+ if (bfqq) { -+ const int rw = rq_data_dir(rq); -+ -+ BUG_ON(!bfqq->allocated[rw]); -+ bfqq->allocated[rw]--; -+ -+ rq->elv.priv[0] = NULL; -+ rq->elv.priv[1] = NULL; -+ -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "put_request %p, %d", -+ bfqq, atomic_read(&bfqq->ref)); -+ bfq_put_queue(bfqq); -+ } -+} -+ -+/* -+ * Allocate bfq data structures associated with this request. -+ */ -+static int bfq_set_request(struct request_queue *q, struct request *rq, -+ struct bio *bio, gfp_t gfp_mask) -+{ -+ struct bfq_data *bfqd = q->elevator->elevator_data; -+ struct bfq_io_cq *bic = icq_to_bic(rq->elv.icq); -+ const int rw = rq_data_dir(rq); -+ const int is_sync = rq_is_sync(rq); -+ struct bfq_queue *bfqq; -+ unsigned long flags; -+ -+ might_sleep_if(gfpflags_allow_blocking(gfp_mask)); -+ -+ bfq_check_ioprio_change(bic, bio); -+ -+ spin_lock_irqsave(q->queue_lock, flags); -+ -+ if (!bic) -+ goto queue_fail; -+ -+ bfq_bic_update_cgroup(bic, bio); -+ -+ bfqq = bic_to_bfqq(bic, is_sync); -+ if (!bfqq || bfqq == &bfqd->oom_bfqq) { -+ bfqq = bfq_get_queue(bfqd, bio, is_sync, bic, gfp_mask); -+ bic_set_bfqq(bic, bfqq, is_sync); -+ if (is_sync) { -+ if (bfqd->large_burst) -+ bfq_mark_bfqq_in_large_burst(bfqq); -+ else -+ bfq_clear_bfqq_in_large_burst(bfqq); -+ } -+ } -+ -+ bfqq->allocated[rw]++; -+ atomic_inc(&bfqq->ref); -+ bfq_log_bfqq(bfqd, bfqq, "set_request: bfqq %p, %d", bfqq, -+ atomic_read(&bfqq->ref)); -+ -+ rq->elv.priv[0] = bic; -+ rq->elv.priv[1] = bfqq; -+ -+ spin_unlock_irqrestore(q->queue_lock, flags); -+ -+ return 0; -+ -+queue_fail: -+ bfq_schedule_dispatch(bfqd); -+ spin_unlock_irqrestore(q->queue_lock, flags); -+ -+ return 1; -+} -+ -+static void bfq_kick_queue(struct work_struct *work) -+{ -+ struct bfq_data *bfqd = -+ container_of(work, struct bfq_data, unplug_work); -+ struct request_queue *q = bfqd->queue; -+ -+ spin_lock_irq(q->queue_lock); -+ __blk_run_queue(q); -+ spin_unlock_irq(q->queue_lock); -+} -+ -+/* -+ * Handler of the expiration of the timer running if the in-service queue -+ * is idling inside its time slice. -+ */ -+static void bfq_idle_slice_timer(unsigned long data) -+{ -+ struct bfq_data *bfqd = (struct bfq_data *)data; -+ struct bfq_queue *bfqq; -+ unsigned long flags; -+ enum bfqq_expiration reason; -+ -+ spin_lock_irqsave(bfqd->queue->queue_lock, flags); -+ -+ bfqq = bfqd->in_service_queue; -+ /* -+ * Theoretical race here: the in-service queue can be NULL or -+ * different from the queue that was idling if the timer handler -+ * spins on the queue_lock and a new request arrives for the -+ * current queue and there is a full dispatch cycle that changes -+ * the in-service queue. This can hardly happen, but in the worst -+ * case we just expire a queue too early. -+ */ -+ if (bfqq) { -+ bfq_log_bfqq(bfqd, bfqq, "slice_timer expired"); -+ if (bfq_bfqq_budget_timeout(bfqq)) -+ /* -+ * Also here the queue can be safely expired -+ * for budget timeout without wasting -+ * guarantees -+ */ -+ reason = BFQ_BFQQ_BUDGET_TIMEOUT; -+ else if (bfqq->queued[0] == 0 && bfqq->queued[1] == 0) -+ /* -+ * The queue may not be empty upon timer expiration, -+ * because we may not disable the timer when the -+ * first request of the in-service queue arrives -+ * during disk idling. -+ */ -+ reason = BFQ_BFQQ_TOO_IDLE; -+ else -+ goto schedule_dispatch; -+ -+ bfq_bfqq_expire(bfqd, bfqq, true, reason); -+ } -+ -+schedule_dispatch: -+ bfq_schedule_dispatch(bfqd); -+ -+ spin_unlock_irqrestore(bfqd->queue->queue_lock, flags); -+} -+ -+static void bfq_shutdown_timer_wq(struct bfq_data *bfqd) -+{ -+ del_timer_sync(&bfqd->idle_slice_timer); -+ cancel_work_sync(&bfqd->unplug_work); -+} -+ -+static void __bfq_put_async_bfqq(struct bfq_data *bfqd, -+ struct bfq_queue **bfqq_ptr) -+{ -+ struct bfq_group *root_group = bfqd->root_group; -+ struct bfq_queue *bfqq = *bfqq_ptr; -+ -+ bfq_log(bfqd, "put_async_bfqq: %p", bfqq); -+ if (bfqq) { -+ bfq_bfqq_move(bfqd, bfqq, &bfqq->entity, root_group); -+ bfq_log_bfqq(bfqd, bfqq, "put_async_bfqq: putting %p, %d", -+ bfqq, atomic_read(&bfqq->ref)); -+ bfq_put_queue(bfqq); -+ *bfqq_ptr = NULL; -+ } -+} -+ -+/* -+ * Release all the bfqg references to its async queues. If we are -+ * deallocating the group these queues may still contain requests, so -+ * we reparent them to the root cgroup (i.e., the only one that will -+ * exist for sure until all the requests on a device are gone). -+ */ -+static void bfq_put_async_queues(struct bfq_data *bfqd, struct bfq_group *bfqg) -+{ -+ int i, j; -+ -+ for (i = 0; i < 2; i++) -+ for (j = 0; j < IOPRIO_BE_NR; j++) -+ __bfq_put_async_bfqq(bfqd, &bfqg->async_bfqq[i][j]); -+ -+ __bfq_put_async_bfqq(bfqd, &bfqg->async_idle_bfqq); -+} -+ -+static void bfq_exit_queue(struct elevator_queue *e) -+{ -+ struct bfq_data *bfqd = e->elevator_data; -+ struct request_queue *q = bfqd->queue; -+ struct bfq_queue *bfqq, *n; -+ -+ bfq_shutdown_timer_wq(bfqd); -+ -+ spin_lock_irq(q->queue_lock); -+ -+ BUG_ON(bfqd->in_service_queue); -+ list_for_each_entry_safe(bfqq, n, &bfqd->idle_list, bfqq_list) -+ bfq_deactivate_bfqq(bfqd, bfqq, 0); -+ -+ spin_unlock_irq(q->queue_lock); -+ -+ bfq_shutdown_timer_wq(bfqd); -+ -+ synchronize_rcu(); -+ -+ BUG_ON(timer_pending(&bfqd->idle_slice_timer)); -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ blkcg_deactivate_policy(q, &blkcg_policy_bfq); -+#else -+ kfree(bfqd->root_group); -+#endif -+ -+ kfree(bfqd); -+} -+ -+static void bfq_init_root_group(struct bfq_group *root_group, -+ struct bfq_data *bfqd) -+{ -+ int i; -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ root_group->entity.parent = NULL; -+ root_group->my_entity = NULL; -+ root_group->bfqd = bfqd; -+#endif -+ for (i = 0; i < BFQ_IOPRIO_CLASSES; i++) -+ root_group->sched_data.service_tree[i] = BFQ_SERVICE_TREE_INIT; -+} -+ -+static int bfq_init_queue(struct request_queue *q, struct elevator_type *e) -+{ -+ struct bfq_data *bfqd; -+ struct elevator_queue *eq; -+ -+ eq = elevator_alloc(q, e); -+ if (!eq) -+ return -ENOMEM; -+ -+ bfqd = kzalloc_node(sizeof(*bfqd), GFP_KERNEL, q->node); -+ if (!bfqd) { -+ kobject_put(&eq->kobj); -+ return -ENOMEM; -+ } -+ eq->elevator_data = bfqd; -+ -+ /* -+ * Our fallback bfqq if bfq_find_alloc_queue() runs into OOM issues. -+ * Grab a permanent reference to it, so that the normal code flow -+ * will not attempt to free it. -+ */ -+ bfq_init_bfqq(bfqd, &bfqd->oom_bfqq, NULL, 1, 0); -+ atomic_inc(&bfqd->oom_bfqq.ref); -+ bfqd->oom_bfqq.new_ioprio = BFQ_DEFAULT_QUEUE_IOPRIO; -+ bfqd->oom_bfqq.new_ioprio_class = IOPRIO_CLASS_BE; -+ bfqd->oom_bfqq.entity.new_weight = -+ bfq_ioprio_to_weight(bfqd->oom_bfqq.new_ioprio); -+ /* -+ * Trigger weight initialization, according to ioprio, at the -+ * oom_bfqq's first activation. The oom_bfqq's ioprio and ioprio -+ * class won't be changed any more. -+ */ -+ bfqd->oom_bfqq.entity.prio_changed = 1; -+ -+ bfqd->queue = q; -+ -+ spin_lock_irq(q->queue_lock); -+ q->elevator = eq; -+ spin_unlock_irq(q->queue_lock); -+ -+ bfqd->root_group = bfq_create_group_hierarchy(bfqd, q->node); -+ if (!bfqd->root_group) -+ goto out_free; -+ bfq_init_root_group(bfqd->root_group, bfqd); -+ bfq_init_entity(&bfqd->oom_bfqq.entity, bfqd->root_group); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqd->active_numerous_groups = 0; -+#endif -+ -+ init_timer(&bfqd->idle_slice_timer); -+ bfqd->idle_slice_timer.function = bfq_idle_slice_timer; -+ bfqd->idle_slice_timer.data = (unsigned long)bfqd; -+ -+ bfqd->queue_weights_tree = RB_ROOT; -+ bfqd->group_weights_tree = RB_ROOT; -+ -+ INIT_WORK(&bfqd->unplug_work, bfq_kick_queue); -+ -+ INIT_LIST_HEAD(&bfqd->active_list); -+ INIT_LIST_HEAD(&bfqd->idle_list); -+ INIT_HLIST_HEAD(&bfqd->burst_list); -+ -+ bfqd->hw_tag = -1; -+ -+ bfqd->bfq_max_budget = bfq_default_max_budget; -+ -+ bfqd->bfq_fifo_expire[0] = bfq_fifo_expire[0]; -+ bfqd->bfq_fifo_expire[1] = bfq_fifo_expire[1]; -+ bfqd->bfq_back_max = bfq_back_max; -+ bfqd->bfq_back_penalty = bfq_back_penalty; -+ bfqd->bfq_slice_idle = bfq_slice_idle; -+ bfqd->bfq_class_idle_last_service = 0; -+ bfqd->bfq_max_budget_async_rq = bfq_max_budget_async_rq; -+ bfqd->bfq_timeout[BLK_RW_ASYNC] = bfq_timeout_async; -+ bfqd->bfq_timeout[BLK_RW_SYNC] = bfq_timeout_sync; -+ -+ bfqd->bfq_requests_within_timer = 120; -+ -+ bfqd->bfq_large_burst_thresh = 11; -+ bfqd->bfq_burst_interval = msecs_to_jiffies(500); -+ -+ bfqd->low_latency = true; -+ -+ bfqd->bfq_wr_coeff = 20; -+ bfqd->bfq_wr_rt_max_time = msecs_to_jiffies(300); -+ bfqd->bfq_wr_max_time = 0; -+ bfqd->bfq_wr_min_idle_time = msecs_to_jiffies(2000); -+ bfqd->bfq_wr_min_inter_arr_async = msecs_to_jiffies(500); -+ bfqd->bfq_wr_max_softrt_rate = 7000; /* -+ * Approximate rate required -+ * to playback or record a -+ * high-definition compressed -+ * video. -+ */ -+ bfqd->wr_busy_queues = 0; -+ bfqd->busy_in_flight_queues = 0; -+ bfqd->const_seeky_busy_in_flight_queues = 0; -+ -+ /* -+ * Begin by assuming, optimistically, that the device peak rate is -+ * equal to the highest reference rate. -+ */ -+ bfqd->RT_prod = R_fast[blk_queue_nonrot(bfqd->queue)] * -+ T_fast[blk_queue_nonrot(bfqd->queue)]; -+ bfqd->peak_rate = R_fast[blk_queue_nonrot(bfqd->queue)]; -+ bfqd->device_speed = BFQ_BFQD_FAST; -+ -+ return 0; -+ -+out_free: -+ kfree(bfqd); -+ kobject_put(&eq->kobj); -+ return -ENOMEM; -+} -+ -+static void bfq_slab_kill(void) -+{ -+ kmem_cache_destroy(bfq_pool); -+} -+ -+static int __init bfq_slab_setup(void) -+{ -+ bfq_pool = KMEM_CACHE(bfq_queue, 0); -+ if (!bfq_pool) -+ return -ENOMEM; -+ return 0; -+} -+ -+static ssize_t bfq_var_show(unsigned int var, char *page) -+{ -+ return sprintf(page, "%d\n", var); -+} -+ -+static ssize_t bfq_var_store(unsigned long *var, const char *page, -+ size_t count) -+{ -+ unsigned long new_val; -+ int ret = kstrtoul(page, 10, &new_val); -+ -+ if (ret == 0) -+ *var = new_val; -+ -+ return count; -+} -+ -+static ssize_t bfq_wr_max_time_show(struct elevator_queue *e, char *page) -+{ -+ struct bfq_data *bfqd = e->elevator_data; -+ -+ return sprintf(page, "%d\n", bfqd->bfq_wr_max_time > 0 ? -+ jiffies_to_msecs(bfqd->bfq_wr_max_time) : -+ jiffies_to_msecs(bfq_wr_duration(bfqd))); -+} -+ -+static ssize_t bfq_weights_show(struct elevator_queue *e, char *page) -+{ -+ struct bfq_queue *bfqq; -+ struct bfq_data *bfqd = e->elevator_data; -+ ssize_t num_char = 0; -+ -+ num_char += sprintf(page + num_char, "Tot reqs queued %d\n\n", -+ bfqd->queued); -+ -+ spin_lock_irq(bfqd->queue->queue_lock); -+ -+ num_char += sprintf(page + num_char, "Active:\n"); -+ list_for_each_entry(bfqq, &bfqd->active_list, bfqq_list) { -+ num_char += sprintf(page + num_char, -+ "pid%d: weight %hu, nr_queued %d %d, ", -+ bfqq->pid, -+ bfqq->entity.weight, -+ bfqq->queued[0], -+ bfqq->queued[1]); -+ num_char += sprintf(page + num_char, -+ "dur %d/%u\n", -+ jiffies_to_msecs( -+ jiffies - -+ bfqq->last_wr_start_finish), -+ jiffies_to_msecs(bfqq->wr_cur_max_time)); -+ } -+ -+ num_char += sprintf(page + num_char, "Idle:\n"); -+ list_for_each_entry(bfqq, &bfqd->idle_list, bfqq_list) { -+ num_char += sprintf(page + num_char, -+ "pid%d: weight %hu, dur %d/%u\n", -+ bfqq->pid, -+ bfqq->entity.weight, -+ jiffies_to_msecs(jiffies - -+ bfqq->last_wr_start_finish), -+ jiffies_to_msecs(bfqq->wr_cur_max_time)); -+ } -+ -+ spin_unlock_irq(bfqd->queue->queue_lock); -+ -+ return num_char; -+} -+ -+#define SHOW_FUNCTION(__FUNC, __VAR, __CONV) \ -+static ssize_t __FUNC(struct elevator_queue *e, char *page) \ -+{ \ -+ struct bfq_data *bfqd = e->elevator_data; \ -+ unsigned int __data = __VAR; \ -+ if (__CONV) \ -+ __data = jiffies_to_msecs(__data); \ -+ return bfq_var_show(__data, (page)); \ -+} -+SHOW_FUNCTION(bfq_fifo_expire_sync_show, bfqd->bfq_fifo_expire[1], 1); -+SHOW_FUNCTION(bfq_fifo_expire_async_show, bfqd->bfq_fifo_expire[0], 1); -+SHOW_FUNCTION(bfq_back_seek_max_show, bfqd->bfq_back_max, 0); -+SHOW_FUNCTION(bfq_back_seek_penalty_show, bfqd->bfq_back_penalty, 0); -+SHOW_FUNCTION(bfq_slice_idle_show, bfqd->bfq_slice_idle, 1); -+SHOW_FUNCTION(bfq_max_budget_show, bfqd->bfq_user_max_budget, 0); -+SHOW_FUNCTION(bfq_max_budget_async_rq_show, -+ bfqd->bfq_max_budget_async_rq, 0); -+SHOW_FUNCTION(bfq_timeout_sync_show, bfqd->bfq_timeout[BLK_RW_SYNC], 1); -+SHOW_FUNCTION(bfq_timeout_async_show, bfqd->bfq_timeout[BLK_RW_ASYNC], 1); -+SHOW_FUNCTION(bfq_low_latency_show, bfqd->low_latency, 0); -+SHOW_FUNCTION(bfq_wr_coeff_show, bfqd->bfq_wr_coeff, 0); -+SHOW_FUNCTION(bfq_wr_rt_max_time_show, bfqd->bfq_wr_rt_max_time, 1); -+SHOW_FUNCTION(bfq_wr_min_idle_time_show, bfqd->bfq_wr_min_idle_time, 1); -+SHOW_FUNCTION(bfq_wr_min_inter_arr_async_show, bfqd->bfq_wr_min_inter_arr_async, -+ 1); -+SHOW_FUNCTION(bfq_wr_max_softrt_rate_show, bfqd->bfq_wr_max_softrt_rate, 0); -+#undef SHOW_FUNCTION -+ -+#define STORE_FUNCTION(__FUNC, __PTR, MIN, MAX, __CONV) \ -+static ssize_t \ -+__FUNC(struct elevator_queue *e, const char *page, size_t count) \ -+{ \ -+ struct bfq_data *bfqd = e->elevator_data; \ -+ unsigned long uninitialized_var(__data); \ -+ int ret = bfq_var_store(&__data, (page), count); \ -+ if (__data < (MIN)) \ -+ __data = (MIN); \ -+ else if (__data > (MAX)) \ -+ __data = (MAX); \ -+ if (__CONV) \ -+ *(__PTR) = msecs_to_jiffies(__data); \ -+ else \ -+ *(__PTR) = __data; \ -+ return ret; \ -+} -+STORE_FUNCTION(bfq_fifo_expire_sync_store, &bfqd->bfq_fifo_expire[1], 1, -+ INT_MAX, 1); -+STORE_FUNCTION(bfq_fifo_expire_async_store, &bfqd->bfq_fifo_expire[0], 1, -+ INT_MAX, 1); -+STORE_FUNCTION(bfq_back_seek_max_store, &bfqd->bfq_back_max, 0, INT_MAX, 0); -+STORE_FUNCTION(bfq_back_seek_penalty_store, &bfqd->bfq_back_penalty, 1, -+ INT_MAX, 0); -+STORE_FUNCTION(bfq_slice_idle_store, &bfqd->bfq_slice_idle, 0, INT_MAX, 1); -+STORE_FUNCTION(bfq_max_budget_async_rq_store, &bfqd->bfq_max_budget_async_rq, -+ 1, INT_MAX, 0); -+STORE_FUNCTION(bfq_timeout_async_store, &bfqd->bfq_timeout[BLK_RW_ASYNC], 0, -+ INT_MAX, 1); -+STORE_FUNCTION(bfq_wr_coeff_store, &bfqd->bfq_wr_coeff, 1, INT_MAX, 0); -+STORE_FUNCTION(bfq_wr_max_time_store, &bfqd->bfq_wr_max_time, 0, INT_MAX, 1); -+STORE_FUNCTION(bfq_wr_rt_max_time_store, &bfqd->bfq_wr_rt_max_time, 0, INT_MAX, -+ 1); -+STORE_FUNCTION(bfq_wr_min_idle_time_store, &bfqd->bfq_wr_min_idle_time, 0, -+ INT_MAX, 1); -+STORE_FUNCTION(bfq_wr_min_inter_arr_async_store, -+ &bfqd->bfq_wr_min_inter_arr_async, 0, INT_MAX, 1); -+STORE_FUNCTION(bfq_wr_max_softrt_rate_store, &bfqd->bfq_wr_max_softrt_rate, 0, -+ INT_MAX, 0); -+#undef STORE_FUNCTION -+ -+/* do nothing for the moment */ -+static ssize_t bfq_weights_store(struct elevator_queue *e, -+ const char *page, size_t count) -+{ -+ return count; -+} -+ -+static unsigned long bfq_estimated_max_budget(struct bfq_data *bfqd) -+{ -+ u64 timeout = jiffies_to_msecs(bfqd->bfq_timeout[BLK_RW_SYNC]); -+ -+ if (bfqd->peak_rate_samples >= BFQ_PEAK_RATE_SAMPLES) -+ return bfq_calc_max_budget(bfqd->peak_rate, timeout); -+ else -+ return bfq_default_max_budget; -+} -+ -+static ssize_t bfq_max_budget_store(struct elevator_queue *e, -+ const char *page, size_t count) -+{ -+ struct bfq_data *bfqd = e->elevator_data; -+ unsigned long uninitialized_var(__data); -+ int ret = bfq_var_store(&__data, (page), count); -+ -+ if (__data == 0) -+ bfqd->bfq_max_budget = bfq_estimated_max_budget(bfqd); -+ else { -+ if (__data > INT_MAX) -+ __data = INT_MAX; -+ bfqd->bfq_max_budget = __data; -+ } -+ -+ bfqd->bfq_user_max_budget = __data; -+ -+ return ret; -+} -+ -+static ssize_t bfq_timeout_sync_store(struct elevator_queue *e, -+ const char *page, size_t count) -+{ -+ struct bfq_data *bfqd = e->elevator_data; -+ unsigned long uninitialized_var(__data); -+ int ret = bfq_var_store(&__data, (page), count); -+ -+ if (__data < 1) -+ __data = 1; -+ else if (__data > INT_MAX) -+ __data = INT_MAX; -+ -+ bfqd->bfq_timeout[BLK_RW_SYNC] = msecs_to_jiffies(__data); -+ if (bfqd->bfq_user_max_budget == 0) -+ bfqd->bfq_max_budget = bfq_estimated_max_budget(bfqd); -+ -+ return ret; -+} -+ -+static ssize_t bfq_low_latency_store(struct elevator_queue *e, -+ const char *page, size_t count) -+{ -+ struct bfq_data *bfqd = e->elevator_data; -+ unsigned long uninitialized_var(__data); -+ int ret = bfq_var_store(&__data, (page), count); -+ -+ if (__data > 1) -+ __data = 1; -+ if (__data == 0 && bfqd->low_latency != 0) -+ bfq_end_wr(bfqd); -+ bfqd->low_latency = __data; -+ -+ return ret; -+} -+ -+#define BFQ_ATTR(name) \ -+ __ATTR(name, S_IRUGO|S_IWUSR, bfq_##name##_show, bfq_##name##_store) -+ -+static struct elv_fs_entry bfq_attrs[] = { -+ BFQ_ATTR(fifo_expire_sync), -+ BFQ_ATTR(fifo_expire_async), -+ BFQ_ATTR(back_seek_max), -+ BFQ_ATTR(back_seek_penalty), -+ BFQ_ATTR(slice_idle), -+ BFQ_ATTR(max_budget), -+ BFQ_ATTR(max_budget_async_rq), -+ BFQ_ATTR(timeout_sync), -+ BFQ_ATTR(timeout_async), -+ BFQ_ATTR(low_latency), -+ BFQ_ATTR(wr_coeff), -+ BFQ_ATTR(wr_max_time), -+ BFQ_ATTR(wr_rt_max_time), -+ BFQ_ATTR(wr_min_idle_time), -+ BFQ_ATTR(wr_min_inter_arr_async), -+ BFQ_ATTR(wr_max_softrt_rate), -+ BFQ_ATTR(weights), -+ __ATTR_NULL -+}; -+ -+static struct elevator_type iosched_bfq = { -+ .ops = { -+ .elevator_merge_fn = bfq_merge, -+ .elevator_merged_fn = bfq_merged_request, -+ .elevator_merge_req_fn = bfq_merged_requests, -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ .elevator_bio_merged_fn = bfq_bio_merged, -+#endif -+ .elevator_allow_merge_fn = bfq_allow_merge, -+ .elevator_dispatch_fn = bfq_dispatch_requests, -+ .elevator_add_req_fn = bfq_insert_request, -+ .elevator_activate_req_fn = bfq_activate_request, -+ .elevator_deactivate_req_fn = bfq_deactivate_request, -+ .elevator_completed_req_fn = bfq_completed_request, -+ .elevator_former_req_fn = elv_rb_former_request, -+ .elevator_latter_req_fn = elv_rb_latter_request, -+ .elevator_init_icq_fn = bfq_init_icq, -+ .elevator_exit_icq_fn = bfq_exit_icq, -+ .elevator_set_req_fn = bfq_set_request, -+ .elevator_put_req_fn = bfq_put_request, -+ .elevator_may_queue_fn = bfq_may_queue, -+ .elevator_init_fn = bfq_init_queue, -+ .elevator_exit_fn = bfq_exit_queue, -+ }, -+ .icq_size = sizeof(struct bfq_io_cq), -+ .icq_align = __alignof__(struct bfq_io_cq), -+ .elevator_attrs = bfq_attrs, -+ .elevator_name = "bfq", -+ .elevator_owner = THIS_MODULE, -+}; -+ -+static int __init bfq_init(void) -+{ -+ int ret; -+ -+ /* -+ * Can be 0 on HZ < 1000 setups. -+ */ -+ if (bfq_slice_idle == 0) -+ bfq_slice_idle = 1; -+ -+ if (bfq_timeout_async == 0) -+ bfq_timeout_async = 1; -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ ret = blkcg_policy_register(&blkcg_policy_bfq); -+ if (ret) -+ return ret; -+#endif -+ -+ ret = -ENOMEM; -+ if (bfq_slab_setup()) -+ goto err_pol_unreg; -+ -+ /* -+ * Times to load large popular applications for the typical systems -+ * installed on the reference devices (see the comments before the -+ * definitions of the two arrays). -+ */ -+ T_slow[0] = msecs_to_jiffies(2600); -+ T_slow[1] = msecs_to_jiffies(1000); -+ T_fast[0] = msecs_to_jiffies(5500); -+ T_fast[1] = msecs_to_jiffies(2000); -+ -+ /* -+ * Thresholds that determine the switch between speed classes (see -+ * the comments before the definition of the array). -+ */ -+ device_speed_thresh[0] = (R_fast[0] + R_slow[0]) / 2; -+ device_speed_thresh[1] = (R_fast[1] + R_slow[1]) / 2; -+ -+ ret = elv_register(&iosched_bfq); -+ if (ret) -+ goto err_pol_unreg; -+ -+ pr_info("BFQ I/O-scheduler: v7r11"); -+ -+ return 0; -+ -+err_pol_unreg: -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ blkcg_policy_unregister(&blkcg_policy_bfq); -+#endif -+ return ret; -+} -+ -+static void __exit bfq_exit(void) -+{ -+ elv_unregister(&iosched_bfq); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ blkcg_policy_unregister(&blkcg_policy_bfq); -+#endif -+ bfq_slab_kill(); -+} -+ -+module_init(bfq_init); -+module_exit(bfq_exit); -+ -+MODULE_AUTHOR("Arianna Avanzini, Fabio Checconi, Paolo Valente"); -+MODULE_LICENSE("GPL"); -diff --git a/block/bfq-sched.c b/block/bfq-sched.c -new file mode 100644 -index 0000000..a5ed694 ---- /dev/null -+++ b/block/bfq-sched.c -@@ -0,0 +1,1199 @@ -+/* -+ * BFQ: Hierarchical B-WF2Q+ scheduler. -+ * -+ * Based on ideas and code from CFQ: -+ * Copyright (C) 2003 Jens Axboe -+ * -+ * Copyright (C) 2008 Fabio Checconi -+ * Paolo Valente -+ * -+ * Copyright (C) 2010 Paolo Valente -+ */ -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+#define for_each_entity(entity) \ -+ for (; entity ; entity = entity->parent) -+ -+#define for_each_entity_safe(entity, parent) \ -+ for (; entity && ({ parent = entity->parent; 1; }); entity = parent) -+ -+ -+static struct bfq_entity *bfq_lookup_next_entity(struct bfq_sched_data *sd, -+ int extract, -+ struct bfq_data *bfqd); -+ -+static struct bfq_group *bfqq_group(struct bfq_queue *bfqq); -+ -+static void bfq_update_budget(struct bfq_entity *next_in_service) -+{ -+ struct bfq_entity *bfqg_entity; -+ struct bfq_group *bfqg; -+ struct bfq_sched_data *group_sd; -+ -+ BUG_ON(!next_in_service); -+ -+ group_sd = next_in_service->sched_data; -+ -+ bfqg = container_of(group_sd, struct bfq_group, sched_data); -+ /* -+ * bfq_group's my_entity field is not NULL only if the group -+ * is not the root group. We must not touch the root entity -+ * as it must never become an in-service entity. -+ */ -+ bfqg_entity = bfqg->my_entity; -+ if (bfqg_entity) -+ bfqg_entity->budget = next_in_service->budget; -+} -+ -+static int bfq_update_next_in_service(struct bfq_sched_data *sd) -+{ -+ struct bfq_entity *next_in_service; -+ -+ if (sd->in_service_entity) -+ /* will update/requeue at the end of service */ -+ return 0; -+ -+ /* -+ * NOTE: this can be improved in many ways, such as returning -+ * 1 (and thus propagating upwards the update) only when the -+ * budget changes, or caching the bfqq that will be scheduled -+ * next from this subtree. By now we worry more about -+ * correctness than about performance... -+ */ -+ next_in_service = bfq_lookup_next_entity(sd, 0, NULL); -+ sd->next_in_service = next_in_service; -+ -+ if (next_in_service) -+ bfq_update_budget(next_in_service); -+ -+ return 1; -+} -+ -+static void bfq_check_next_in_service(struct bfq_sched_data *sd, -+ struct bfq_entity *entity) -+{ -+ BUG_ON(sd->next_in_service != entity); -+} -+#else -+#define for_each_entity(entity) \ -+ for (; entity ; entity = NULL) -+ -+#define for_each_entity_safe(entity, parent) \ -+ for (parent = NULL; entity ; entity = parent) -+ -+static int bfq_update_next_in_service(struct bfq_sched_data *sd) -+{ -+ return 0; -+} -+ -+static void bfq_check_next_in_service(struct bfq_sched_data *sd, -+ struct bfq_entity *entity) -+{ -+} -+ -+static void bfq_update_budget(struct bfq_entity *next_in_service) -+{ -+} -+#endif -+ -+/* -+ * Shift for timestamp calculations. This actually limits the maximum -+ * service allowed in one timestamp delta (small shift values increase it), -+ * the maximum total weight that can be used for the queues in the system -+ * (big shift values increase it), and the period of virtual time -+ * wraparounds. -+ */ -+#define WFQ_SERVICE_SHIFT 22 -+ -+/** -+ * bfq_gt - compare two timestamps. -+ * @a: first ts. -+ * @b: second ts. -+ * -+ * Return @a > @b, dealing with wrapping correctly. -+ */ -+static int bfq_gt(u64 a, u64 b) -+{ -+ return (s64)(a - b) > 0; -+} -+ -+static struct bfq_queue *bfq_entity_to_bfqq(struct bfq_entity *entity) -+{ -+ struct bfq_queue *bfqq = NULL; -+ -+ BUG_ON(!entity); -+ -+ if (!entity->my_sched_data) -+ bfqq = container_of(entity, struct bfq_queue, entity); -+ -+ return bfqq; -+} -+ -+ -+/** -+ * bfq_delta - map service into the virtual time domain. -+ * @service: amount of service. -+ * @weight: scale factor (weight of an entity or weight sum). -+ */ -+static u64 bfq_delta(unsigned long service, unsigned long weight) -+{ -+ u64 d = (u64)service << WFQ_SERVICE_SHIFT; -+ -+ do_div(d, weight); -+ return d; -+} -+ -+/** -+ * bfq_calc_finish - assign the finish time to an entity. -+ * @entity: the entity to act upon. -+ * @service: the service to be charged to the entity. -+ */ -+static void bfq_calc_finish(struct bfq_entity *entity, unsigned long service) -+{ -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ -+ BUG_ON(entity->weight == 0); -+ -+ entity->finish = entity->start + -+ bfq_delta(service, entity->weight); -+ -+ if (bfqq) { -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "calc_finish: serv %lu, w %d", -+ service, entity->weight); -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "calc_finish: start %llu, finish %llu, delta %llu", -+ entity->start, entity->finish, -+ bfq_delta(service, entity->weight)); -+ } -+} -+ -+/** -+ * bfq_entity_of - get an entity from a node. -+ * @node: the node field of the entity. -+ * -+ * Convert a node pointer to the relative entity. This is used only -+ * to simplify the logic of some functions and not as the generic -+ * conversion mechanism because, e.g., in the tree walking functions, -+ * the check for a %NULL value would be redundant. -+ */ -+static struct bfq_entity *bfq_entity_of(struct rb_node *node) -+{ -+ struct bfq_entity *entity = NULL; -+ -+ if (node) -+ entity = rb_entry(node, struct bfq_entity, rb_node); -+ -+ return entity; -+} -+ -+/** -+ * bfq_extract - remove an entity from a tree. -+ * @root: the tree root. -+ * @entity: the entity to remove. -+ */ -+static void bfq_extract(struct rb_root *root, struct bfq_entity *entity) -+{ -+ BUG_ON(entity->tree != root); -+ -+ entity->tree = NULL; -+ rb_erase(&entity->rb_node, root); -+} -+ -+/** -+ * bfq_idle_extract - extract an entity from the idle tree. -+ * @st: the service tree of the owning @entity. -+ * @entity: the entity being removed. -+ */ -+static void bfq_idle_extract(struct bfq_service_tree *st, -+ struct bfq_entity *entity) -+{ -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ struct rb_node *next; -+ -+ BUG_ON(entity->tree != &st->idle); -+ -+ if (entity == st->first_idle) { -+ next = rb_next(&entity->rb_node); -+ st->first_idle = bfq_entity_of(next); -+ } -+ -+ if (entity == st->last_idle) { -+ next = rb_prev(&entity->rb_node); -+ st->last_idle = bfq_entity_of(next); -+ } -+ -+ bfq_extract(&st->idle, entity); -+ -+ if (bfqq) -+ list_del(&bfqq->bfqq_list); -+} -+ -+/** -+ * bfq_insert - generic tree insertion. -+ * @root: tree root. -+ * @entity: entity to insert. -+ * -+ * This is used for the idle and the active tree, since they are both -+ * ordered by finish time. -+ */ -+static void bfq_insert(struct rb_root *root, struct bfq_entity *entity) -+{ -+ struct bfq_entity *entry; -+ struct rb_node **node = &root->rb_node; -+ struct rb_node *parent = NULL; -+ -+ BUG_ON(entity->tree); -+ -+ while (*node) { -+ parent = *node; -+ entry = rb_entry(parent, struct bfq_entity, rb_node); -+ -+ if (bfq_gt(entry->finish, entity->finish)) -+ node = &parent->rb_left; -+ else -+ node = &parent->rb_right; -+ } -+ -+ rb_link_node(&entity->rb_node, parent, node); -+ rb_insert_color(&entity->rb_node, root); -+ -+ entity->tree = root; -+} -+ -+/** -+ * bfq_update_min - update the min_start field of a entity. -+ * @entity: the entity to update. -+ * @node: one of its children. -+ * -+ * This function is called when @entity may store an invalid value for -+ * min_start due to updates to the active tree. The function assumes -+ * that the subtree rooted at @node (which may be its left or its right -+ * child) has a valid min_start value. -+ */ -+static void bfq_update_min(struct bfq_entity *entity, struct rb_node *node) -+{ -+ struct bfq_entity *child; -+ -+ if (node) { -+ child = rb_entry(node, struct bfq_entity, rb_node); -+ if (bfq_gt(entity->min_start, child->min_start)) -+ entity->min_start = child->min_start; -+ } -+} -+ -+/** -+ * bfq_update_active_node - recalculate min_start. -+ * @node: the node to update. -+ * -+ * @node may have changed position or one of its children may have moved, -+ * this function updates its min_start value. The left and right subtrees -+ * are assumed to hold a correct min_start value. -+ */ -+static void bfq_update_active_node(struct rb_node *node) -+{ -+ struct bfq_entity *entity = rb_entry(node, struct bfq_entity, rb_node); -+ -+ entity->min_start = entity->start; -+ bfq_update_min(entity, node->rb_right); -+ bfq_update_min(entity, node->rb_left); -+} -+ -+/** -+ * bfq_update_active_tree - update min_start for the whole active tree. -+ * @node: the starting node. -+ * -+ * @node must be the deepest modified node after an update. This function -+ * updates its min_start using the values held by its children, assuming -+ * that they did not change, and then updates all the nodes that may have -+ * changed in the path to the root. The only nodes that may have changed -+ * are the ones in the path or their siblings. -+ */ -+static void bfq_update_active_tree(struct rb_node *node) -+{ -+ struct rb_node *parent; -+ -+up: -+ bfq_update_active_node(node); -+ -+ parent = rb_parent(node); -+ if (!parent) -+ return; -+ -+ if (node == parent->rb_left && parent->rb_right) -+ bfq_update_active_node(parent->rb_right); -+ else if (parent->rb_left) -+ bfq_update_active_node(parent->rb_left); -+ -+ node = parent; -+ goto up; -+} -+ -+static void bfq_weights_tree_add(struct bfq_data *bfqd, -+ struct bfq_entity *entity, -+ struct rb_root *root); -+ -+static void bfq_weights_tree_remove(struct bfq_data *bfqd, -+ struct bfq_entity *entity, -+ struct rb_root *root); -+ -+ -+/** -+ * bfq_active_insert - insert an entity in the active tree of its -+ * group/device. -+ * @st: the service tree of the entity. -+ * @entity: the entity being inserted. -+ * -+ * The active tree is ordered by finish time, but an extra key is kept -+ * per each node, containing the minimum value for the start times of -+ * its children (and the node itself), so it's possible to search for -+ * the eligible node with the lowest finish time in logarithmic time. -+ */ -+static void bfq_active_insert(struct bfq_service_tree *st, -+ struct bfq_entity *entity) -+{ -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ struct rb_node *node = &entity->rb_node; -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ struct bfq_sched_data *sd = NULL; -+ struct bfq_group *bfqg = NULL; -+ struct bfq_data *bfqd = NULL; -+#endif -+ -+ bfq_insert(&st->active, entity); -+ -+ if (node->rb_left) -+ node = node->rb_left; -+ else if (node->rb_right) -+ node = node->rb_right; -+ -+ bfq_update_active_tree(node); -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ sd = entity->sched_data; -+ bfqg = container_of(sd, struct bfq_group, sched_data); -+ BUG_ON(!bfqg); -+ bfqd = (struct bfq_data *)bfqg->bfqd; -+#endif -+ if (bfqq) -+ list_add(&bfqq->bfqq_list, &bfqq->bfqd->active_list); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ else { /* bfq_group */ -+ BUG_ON(!bfqd); -+ bfq_weights_tree_add(bfqd, entity, &bfqd->group_weights_tree); -+ } -+ if (bfqg != bfqd->root_group) { -+ BUG_ON(!bfqg); -+ BUG_ON(!bfqd); -+ bfqg->active_entities++; -+ if (bfqg->active_entities == 2) -+ bfqd->active_numerous_groups++; -+ } -+#endif -+} -+ -+/** -+ * bfq_ioprio_to_weight - calc a weight from an ioprio. -+ * @ioprio: the ioprio value to convert. -+ */ -+static unsigned short bfq_ioprio_to_weight(int ioprio) -+{ -+ BUG_ON(ioprio < 0 || ioprio >= IOPRIO_BE_NR); -+ return IOPRIO_BE_NR * BFQ_WEIGHT_CONVERSION_COEFF - ioprio; -+} -+ -+/** -+ * bfq_weight_to_ioprio - calc an ioprio from a weight. -+ * @weight: the weight value to convert. -+ * -+ * To preserve as much as possible the old only-ioprio user interface, -+ * 0 is used as an escape ioprio value for weights (numerically) equal or -+ * larger than IOPRIO_BE_NR * BFQ_WEIGHT_CONVERSION_COEFF. -+ */ -+static unsigned short bfq_weight_to_ioprio(int weight) -+{ -+ BUG_ON(weight < BFQ_MIN_WEIGHT || weight > BFQ_MAX_WEIGHT); -+ return IOPRIO_BE_NR * BFQ_WEIGHT_CONVERSION_COEFF - weight < 0 ? -+ 0 : IOPRIO_BE_NR * BFQ_WEIGHT_CONVERSION_COEFF - weight; -+} -+ -+static void bfq_get_entity(struct bfq_entity *entity) -+{ -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ -+ if (bfqq) { -+ atomic_inc(&bfqq->ref); -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "get_entity: %p %d", -+ bfqq, atomic_read(&bfqq->ref)); -+ } -+} -+ -+/** -+ * bfq_find_deepest - find the deepest node that an extraction can modify. -+ * @node: the node being removed. -+ * -+ * Do the first step of an extraction in an rb tree, looking for the -+ * node that will replace @node, and returning the deepest node that -+ * the following modifications to the tree can touch. If @node is the -+ * last node in the tree return %NULL. -+ */ -+static struct rb_node *bfq_find_deepest(struct rb_node *node) -+{ -+ struct rb_node *deepest; -+ -+ if (!node->rb_right && !node->rb_left) -+ deepest = rb_parent(node); -+ else if (!node->rb_right) -+ deepest = node->rb_left; -+ else if (!node->rb_left) -+ deepest = node->rb_right; -+ else { -+ deepest = rb_next(node); -+ if (deepest->rb_right) -+ deepest = deepest->rb_right; -+ else if (rb_parent(deepest) != node) -+ deepest = rb_parent(deepest); -+ } -+ -+ return deepest; -+} -+ -+/** -+ * bfq_active_extract - remove an entity from the active tree. -+ * @st: the service_tree containing the tree. -+ * @entity: the entity being removed. -+ */ -+static void bfq_active_extract(struct bfq_service_tree *st, -+ struct bfq_entity *entity) -+{ -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ struct rb_node *node; -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ struct bfq_sched_data *sd = NULL; -+ struct bfq_group *bfqg = NULL; -+ struct bfq_data *bfqd = NULL; -+#endif -+ -+ node = bfq_find_deepest(&entity->rb_node); -+ bfq_extract(&st->active, entity); -+ -+ if (node) -+ bfq_update_active_tree(node); -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ sd = entity->sched_data; -+ bfqg = container_of(sd, struct bfq_group, sched_data); -+ BUG_ON(!bfqg); -+ bfqd = (struct bfq_data *)bfqg->bfqd; -+#endif -+ if (bfqq) -+ list_del(&bfqq->bfqq_list); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ else { /* bfq_group */ -+ BUG_ON(!bfqd); -+ bfq_weights_tree_remove(bfqd, entity, -+ &bfqd->group_weights_tree); -+ } -+ if (bfqg != bfqd->root_group) { -+ BUG_ON(!bfqg); -+ BUG_ON(!bfqd); -+ BUG_ON(!bfqg->active_entities); -+ bfqg->active_entities--; -+ if (bfqg->active_entities == 1) { -+ BUG_ON(!bfqd->active_numerous_groups); -+ bfqd->active_numerous_groups--; -+ } -+ } -+#endif -+} -+ -+/** -+ * bfq_idle_insert - insert an entity into the idle tree. -+ * @st: the service tree containing the tree. -+ * @entity: the entity to insert. -+ */ -+static void bfq_idle_insert(struct bfq_service_tree *st, -+ struct bfq_entity *entity) -+{ -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ struct bfq_entity *first_idle = st->first_idle; -+ struct bfq_entity *last_idle = st->last_idle; -+ -+ if (!first_idle || bfq_gt(first_idle->finish, entity->finish)) -+ st->first_idle = entity; -+ if (!last_idle || bfq_gt(entity->finish, last_idle->finish)) -+ st->last_idle = entity; -+ -+ bfq_insert(&st->idle, entity); -+ -+ if (bfqq) -+ list_add(&bfqq->bfqq_list, &bfqq->bfqd->idle_list); -+} -+ -+/** -+ * bfq_forget_entity - remove an entity from the wfq trees. -+ * @st: the service tree. -+ * @entity: the entity being removed. -+ * -+ * Update the device status and forget everything about @entity, putting -+ * the device reference to it, if it is a queue. Entities belonging to -+ * groups are not refcounted. -+ */ -+static void bfq_forget_entity(struct bfq_service_tree *st, -+ struct bfq_entity *entity) -+{ -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ struct bfq_sched_data *sd; -+ -+ BUG_ON(!entity->on_st); -+ -+ entity->on_st = 0; -+ st->wsum -= entity->weight; -+ if (bfqq) { -+ sd = entity->sched_data; -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "forget_entity: %p %d", -+ bfqq, atomic_read(&bfqq->ref)); -+ bfq_put_queue(bfqq); -+ } -+} -+ -+/** -+ * bfq_put_idle_entity - release the idle tree ref of an entity. -+ * @st: service tree for the entity. -+ * @entity: the entity being released. -+ */ -+static void bfq_put_idle_entity(struct bfq_service_tree *st, -+ struct bfq_entity *entity) -+{ -+ bfq_idle_extract(st, entity); -+ bfq_forget_entity(st, entity); -+} -+ -+/** -+ * bfq_forget_idle - update the idle tree if necessary. -+ * @st: the service tree to act upon. -+ * -+ * To preserve the global O(log N) complexity we only remove one entry here; -+ * as the idle tree will not grow indefinitely this can be done safely. -+ */ -+static void bfq_forget_idle(struct bfq_service_tree *st) -+{ -+ struct bfq_entity *first_idle = st->first_idle; -+ struct bfq_entity *last_idle = st->last_idle; -+ -+ if (RB_EMPTY_ROOT(&st->active) && last_idle && -+ !bfq_gt(last_idle->finish, st->vtime)) { -+ /* -+ * Forget the whole idle tree, increasing the vtime past -+ * the last finish time of idle entities. -+ */ -+ st->vtime = last_idle->finish; -+ } -+ -+ if (first_idle && !bfq_gt(first_idle->finish, st->vtime)) -+ bfq_put_idle_entity(st, first_idle); -+} -+ -+static struct bfq_service_tree * -+__bfq_entity_update_weight_prio(struct bfq_service_tree *old_st, -+ struct bfq_entity *entity) -+{ -+ struct bfq_service_tree *new_st = old_st; -+ -+ if (entity->prio_changed) { -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ unsigned short prev_weight, new_weight; -+ struct bfq_data *bfqd = NULL; -+ struct rb_root *root; -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ struct bfq_sched_data *sd; -+ struct bfq_group *bfqg; -+#endif -+ -+ if (bfqq) -+ bfqd = bfqq->bfqd; -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ else { -+ sd = entity->my_sched_data; -+ bfqg = container_of(sd, struct bfq_group, sched_data); -+ BUG_ON(!bfqg); -+ bfqd = (struct bfq_data *)bfqg->bfqd; -+ BUG_ON(!bfqd); -+ } -+#endif -+ -+ BUG_ON(old_st->wsum < entity->weight); -+ old_st->wsum -= entity->weight; -+ -+ if (entity->new_weight != entity->orig_weight) { -+ if (entity->new_weight < BFQ_MIN_WEIGHT || -+ entity->new_weight > BFQ_MAX_WEIGHT) { -+ pr_crit("update_weight_prio: new_weight %d\n", -+ entity->new_weight); -+ BUG(); -+ } -+ entity->orig_weight = entity->new_weight; -+ if (bfqq) -+ bfqq->ioprio = -+ bfq_weight_to_ioprio(entity->orig_weight); -+ } -+ -+ if (bfqq) -+ bfqq->ioprio_class = bfqq->new_ioprio_class; -+ entity->prio_changed = 0; -+ -+ /* -+ * NOTE: here we may be changing the weight too early, -+ * this will cause unfairness. The correct approach -+ * would have required additional complexity to defer -+ * weight changes to the proper time instants (i.e., -+ * when entity->finish <= old_st->vtime). -+ */ -+ new_st = bfq_entity_service_tree(entity); -+ -+ prev_weight = entity->weight; -+ new_weight = entity->orig_weight * -+ (bfqq ? bfqq->wr_coeff : 1); -+ /* -+ * If the weight of the entity changes, remove the entity -+ * from its old weight counter (if there is a counter -+ * associated with the entity), and add it to the counter -+ * associated with its new weight. -+ */ -+ if (prev_weight != new_weight) { -+ root = bfqq ? &bfqd->queue_weights_tree : -+ &bfqd->group_weights_tree; -+ bfq_weights_tree_remove(bfqd, entity, root); -+ } -+ entity->weight = new_weight; -+ /* -+ * Add the entity to its weights tree only if it is -+ * not associated with a weight-raised queue. -+ */ -+ if (prev_weight != new_weight && -+ (bfqq ? bfqq->wr_coeff == 1 : 1)) -+ /* If we get here, root has been initialized. */ -+ bfq_weights_tree_add(bfqd, entity, root); -+ -+ new_st->wsum += entity->weight; -+ -+ if (new_st != old_st) -+ entity->start = new_st->vtime; -+ } -+ -+ return new_st; -+} -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+static void bfqg_stats_set_start_empty_time(struct bfq_group *bfqg); -+#endif -+ -+/** -+ * bfq_bfqq_served - update the scheduler status after selection for -+ * service. -+ * @bfqq: the queue being served. -+ * @served: bytes to transfer. -+ * -+ * NOTE: this can be optimized, as the timestamps of upper level entities -+ * are synchronized every time a new bfqq is selected for service. By now, -+ * we keep it to better check consistency. -+ */ -+static void bfq_bfqq_served(struct bfq_queue *bfqq, int served) -+{ -+ struct bfq_entity *entity = &bfqq->entity; -+ struct bfq_service_tree *st; -+ -+ for_each_entity(entity) { -+ st = bfq_entity_service_tree(entity); -+ -+ entity->service += served; -+ BUG_ON(entity->service > entity->budget); -+ BUG_ON(st->wsum == 0); -+ -+ st->vtime += bfq_delta(served, st->wsum); -+ bfq_forget_idle(st); -+ } -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqg_stats_set_start_empty_time(bfqq_group(bfqq)); -+#endif -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "bfqq_served %d secs", served); -+} -+ -+/** -+ * bfq_bfqq_charge_full_budget - set the service to the entity budget. -+ * @bfqq: the queue that needs a service update. -+ * -+ * When it's not possible to be fair in the service domain, because -+ * a queue is not consuming its budget fast enough (the meaning of -+ * fast depends on the timeout parameter), we charge it a full -+ * budget. In this way we should obtain a sort of time-domain -+ * fairness among all the seeky/slow queues. -+ */ -+static void bfq_bfqq_charge_full_budget(struct bfq_queue *bfqq) -+{ -+ struct bfq_entity *entity = &bfqq->entity; -+ -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "charge_full_budget"); -+ -+ bfq_bfqq_served(bfqq, entity->budget - entity->service); -+} -+ -+/** -+ * __bfq_activate_entity - activate an entity. -+ * @entity: the entity being activated. -+ * -+ * Called whenever an entity is activated, i.e., it is not active and one -+ * of its children receives a new request, or has to be reactivated due to -+ * budget exhaustion. It uses the current budget of the entity (and the -+ * service received if @entity is active) of the queue to calculate its -+ * timestamps. -+ */ -+static void __bfq_activate_entity(struct bfq_entity *entity) -+{ -+ struct bfq_sched_data *sd = entity->sched_data; -+ struct bfq_service_tree *st = bfq_entity_service_tree(entity); -+ -+ if (entity == sd->in_service_entity) { -+ BUG_ON(entity->tree); -+ /* -+ * If we are requeueing the current entity we have -+ * to take care of not charging to it service it has -+ * not received. -+ */ -+ bfq_calc_finish(entity, entity->service); -+ entity->start = entity->finish; -+ sd->in_service_entity = NULL; -+ } else if (entity->tree == &st->active) { -+ /* -+ * Requeueing an entity due to a change of some -+ * next_in_service entity below it. We reuse the -+ * old start time. -+ */ -+ bfq_active_extract(st, entity); -+ } else if (entity->tree == &st->idle) { -+ /* -+ * Must be on the idle tree, bfq_idle_extract() will -+ * check for that. -+ */ -+ bfq_idle_extract(st, entity); -+ entity->start = bfq_gt(st->vtime, entity->finish) ? -+ st->vtime : entity->finish; -+ } else { -+ /* -+ * The finish time of the entity may be invalid, and -+ * it is in the past for sure, otherwise the queue -+ * would have been on the idle tree. -+ */ -+ entity->start = st->vtime; -+ st->wsum += entity->weight; -+ bfq_get_entity(entity); -+ -+ BUG_ON(entity->on_st); -+ entity->on_st = 1; -+ } -+ -+ st = __bfq_entity_update_weight_prio(st, entity); -+ bfq_calc_finish(entity, entity->budget); -+ bfq_active_insert(st, entity); -+} -+ -+/** -+ * bfq_activate_entity - activate an entity and its ancestors if necessary. -+ * @entity: the entity to activate. -+ * -+ * Activate @entity and all the entities on the path from it to the root. -+ */ -+static void bfq_activate_entity(struct bfq_entity *entity) -+{ -+ struct bfq_sched_data *sd; -+ -+ for_each_entity(entity) { -+ __bfq_activate_entity(entity); -+ -+ sd = entity->sched_data; -+ if (!bfq_update_next_in_service(sd)) -+ /* -+ * No need to propagate the activation to the -+ * upper entities, as they will be updated when -+ * the in-service entity is rescheduled. -+ */ -+ break; -+ } -+} -+ -+/** -+ * __bfq_deactivate_entity - deactivate an entity from its service tree. -+ * @entity: the entity to deactivate. -+ * @requeue: if false, the entity will not be put into the idle tree. -+ * -+ * Deactivate an entity, independently from its previous state. If the -+ * entity was not on a service tree just return, otherwise if it is on -+ * any scheduler tree, extract it from that tree, and if necessary -+ * and if the caller did not specify @requeue, put it on the idle tree. -+ * -+ * Return %1 if the caller should update the entity hierarchy, i.e., -+ * if the entity was in service or if it was the next_in_service for -+ * its sched_data; return %0 otherwise. -+ */ -+static int __bfq_deactivate_entity(struct bfq_entity *entity, int requeue) -+{ -+ struct bfq_sched_data *sd = entity->sched_data; -+ struct bfq_service_tree *st; -+ int was_in_service; -+ int ret = 0; -+ -+ if (sd == NULL || !entity->on_st) /* never activated, or inactive */ -+ return 0; -+ -+ st = bfq_entity_service_tree(entity); -+ was_in_service = entity == sd->in_service_entity; -+ -+ BUG_ON(was_in_service && entity->tree); -+ -+ if (was_in_service) { -+ bfq_calc_finish(entity, entity->service); -+ sd->in_service_entity = NULL; -+ } else if (entity->tree == &st->active) -+ bfq_active_extract(st, entity); -+ else if (entity->tree == &st->idle) -+ bfq_idle_extract(st, entity); -+ else if (entity->tree) -+ BUG(); -+ -+ if (was_in_service || sd->next_in_service == entity) -+ ret = bfq_update_next_in_service(sd); -+ -+ if (!requeue || !bfq_gt(entity->finish, st->vtime)) -+ bfq_forget_entity(st, entity); -+ else -+ bfq_idle_insert(st, entity); -+ -+ BUG_ON(sd->in_service_entity == entity); -+ BUG_ON(sd->next_in_service == entity); -+ -+ return ret; -+} -+ -+/** -+ * bfq_deactivate_entity - deactivate an entity. -+ * @entity: the entity to deactivate. -+ * @requeue: true if the entity can be put on the idle tree -+ */ -+static void bfq_deactivate_entity(struct bfq_entity *entity, int requeue) -+{ -+ struct bfq_sched_data *sd; -+ struct bfq_entity *parent; -+ -+ for_each_entity_safe(entity, parent) { -+ sd = entity->sched_data; -+ -+ if (!__bfq_deactivate_entity(entity, requeue)) -+ /* -+ * The parent entity is still backlogged, and -+ * we don't need to update it as it is still -+ * in service. -+ */ -+ break; -+ -+ if (sd->next_in_service) -+ /* -+ * The parent entity is still backlogged and -+ * the budgets on the path towards the root -+ * need to be updated. -+ */ -+ goto update; -+ -+ /* -+ * If we reach there the parent is no more backlogged and -+ * we want to propagate the dequeue upwards. -+ */ -+ requeue = 1; -+ } -+ -+ return; -+ -+update: -+ entity = parent; -+ for_each_entity(entity) { -+ __bfq_activate_entity(entity); -+ -+ sd = entity->sched_data; -+ if (!bfq_update_next_in_service(sd)) -+ break; -+ } -+} -+ -+/** -+ * bfq_update_vtime - update vtime if necessary. -+ * @st: the service tree to act upon. -+ * -+ * If necessary update the service tree vtime to have at least one -+ * eligible entity, skipping to its start time. Assumes that the -+ * active tree of the device is not empty. -+ * -+ * NOTE: this hierarchical implementation updates vtimes quite often, -+ * we may end up with reactivated processes getting timestamps after a -+ * vtime skip done because we needed a ->first_active entity on some -+ * intermediate node. -+ */ -+static void bfq_update_vtime(struct bfq_service_tree *st) -+{ -+ struct bfq_entity *entry; -+ struct rb_node *node = st->active.rb_node; -+ -+ entry = rb_entry(node, struct bfq_entity, rb_node); -+ if (bfq_gt(entry->min_start, st->vtime)) { -+ st->vtime = entry->min_start; -+ bfq_forget_idle(st); -+ } -+} -+ -+/** -+ * bfq_first_active_entity - find the eligible entity with -+ * the smallest finish time -+ * @st: the service tree to select from. -+ * -+ * This function searches the first schedulable entity, starting from the -+ * root of the tree and going on the left every time on this side there is -+ * a subtree with at least one eligible (start >= vtime) entity. The path on -+ * the right is followed only if a) the left subtree contains no eligible -+ * entities and b) no eligible entity has been found yet. -+ */ -+static struct bfq_entity *bfq_first_active_entity(struct bfq_service_tree *st) -+{ -+ struct bfq_entity *entry, *first = NULL; -+ struct rb_node *node = st->active.rb_node; -+ -+ while (node) { -+ entry = rb_entry(node, struct bfq_entity, rb_node); -+left: -+ if (!bfq_gt(entry->start, st->vtime)) -+ first = entry; -+ -+ BUG_ON(bfq_gt(entry->min_start, st->vtime)); -+ -+ if (node->rb_left) { -+ entry = rb_entry(node->rb_left, -+ struct bfq_entity, rb_node); -+ if (!bfq_gt(entry->min_start, st->vtime)) { -+ node = node->rb_left; -+ goto left; -+ } -+ } -+ if (first) -+ break; -+ node = node->rb_right; -+ } -+ -+ BUG_ON(!first && !RB_EMPTY_ROOT(&st->active)); -+ return first; -+} -+ -+/** -+ * __bfq_lookup_next_entity - return the first eligible entity in @st. -+ * @st: the service tree. -+ * -+ * Update the virtual time in @st and return the first eligible entity -+ * it contains. -+ */ -+static struct bfq_entity *__bfq_lookup_next_entity(struct bfq_service_tree *st, -+ bool force) -+{ -+ struct bfq_entity *entity, *new_next_in_service = NULL; -+ -+ if (RB_EMPTY_ROOT(&st->active)) -+ return NULL; -+ -+ bfq_update_vtime(st); -+ entity = bfq_first_active_entity(st); -+ BUG_ON(bfq_gt(entity->start, st->vtime)); -+ -+ /* -+ * If the chosen entity does not match with the sched_data's -+ * next_in_service and we are forcedly serving the IDLE priority -+ * class tree, bubble up budget update. -+ */ -+ if (unlikely(force && entity != entity->sched_data->next_in_service)) { -+ new_next_in_service = entity; -+ for_each_entity(new_next_in_service) -+ bfq_update_budget(new_next_in_service); -+ } -+ -+ return entity; -+} -+ -+/** -+ * bfq_lookup_next_entity - return the first eligible entity in @sd. -+ * @sd: the sched_data. -+ * @extract: if true the returned entity will be also extracted from @sd. -+ * -+ * NOTE: since we cache the next_in_service entity at each level of the -+ * hierarchy, the complexity of the lookup can be decreased with -+ * absolutely no effort just returning the cached next_in_service value; -+ * we prefer to do full lookups to test the consistency of * the data -+ * structures. -+ */ -+static struct bfq_entity *bfq_lookup_next_entity(struct bfq_sched_data *sd, -+ int extract, -+ struct bfq_data *bfqd) -+{ -+ struct bfq_service_tree *st = sd->service_tree; -+ struct bfq_entity *entity; -+ int i = 0; -+ -+ BUG_ON(sd->in_service_entity); -+ -+ if (bfqd && -+ jiffies - bfqd->bfq_class_idle_last_service > BFQ_CL_IDLE_TIMEOUT) { -+ entity = __bfq_lookup_next_entity(st + BFQ_IOPRIO_CLASSES - 1, -+ true); -+ if (entity) { -+ i = BFQ_IOPRIO_CLASSES - 1; -+ bfqd->bfq_class_idle_last_service = jiffies; -+ sd->next_in_service = entity; -+ } -+ } -+ for (; i < BFQ_IOPRIO_CLASSES; i++) { -+ entity = __bfq_lookup_next_entity(st + i, false); -+ if (entity) { -+ if (extract) { -+ bfq_check_next_in_service(sd, entity); -+ bfq_active_extract(st + i, entity); -+ sd->in_service_entity = entity; -+ sd->next_in_service = NULL; -+ } -+ break; -+ } -+ } -+ -+ return entity; -+} -+ -+/* -+ * Get next queue for service. -+ */ -+static struct bfq_queue *bfq_get_next_queue(struct bfq_data *bfqd) -+{ -+ struct bfq_entity *entity = NULL; -+ struct bfq_sched_data *sd; -+ struct bfq_queue *bfqq; -+ -+ BUG_ON(bfqd->in_service_queue); -+ -+ if (bfqd->busy_queues == 0) -+ return NULL; -+ -+ sd = &bfqd->root_group->sched_data; -+ for (; sd ; sd = entity->my_sched_data) { -+ entity = bfq_lookup_next_entity(sd, 1, bfqd); -+ BUG_ON(!entity); -+ entity->service = 0; -+ } -+ -+ bfqq = bfq_entity_to_bfqq(entity); -+ BUG_ON(!bfqq); -+ -+ return bfqq; -+} -+ -+static void __bfq_bfqd_reset_in_service(struct bfq_data *bfqd) -+{ -+ if (bfqd->in_service_bic) { -+ put_io_context(bfqd->in_service_bic->icq.ioc); -+ bfqd->in_service_bic = NULL; -+ } -+ -+ bfqd->in_service_queue = NULL; -+ del_timer(&bfqd->idle_slice_timer); -+} -+ -+static void bfq_deactivate_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq, -+ int requeue) -+{ -+ struct bfq_entity *entity = &bfqq->entity; -+ -+ if (bfqq == bfqd->in_service_queue) -+ __bfq_bfqd_reset_in_service(bfqd); -+ -+ bfq_deactivate_entity(entity, requeue); -+} -+ -+static void bfq_activate_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq) -+{ -+ struct bfq_entity *entity = &bfqq->entity; -+ -+ bfq_activate_entity(entity); -+} -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+static void bfqg_stats_update_dequeue(struct bfq_group *bfqg); -+#endif -+ -+/* -+ * Called when the bfqq no longer has requests pending, remove it from -+ * the service tree. -+ */ -+static void bfq_del_bfqq_busy(struct bfq_data *bfqd, struct bfq_queue *bfqq, -+ int requeue) -+{ -+ BUG_ON(!bfq_bfqq_busy(bfqq)); -+ BUG_ON(!RB_EMPTY_ROOT(&bfqq->sort_list)); -+ -+ bfq_log_bfqq(bfqd, bfqq, "del from busy"); -+ -+ bfq_clear_bfqq_busy(bfqq); -+ -+ BUG_ON(bfqd->busy_queues == 0); -+ bfqd->busy_queues--; -+ -+ if (!bfqq->dispatched) { -+ bfq_weights_tree_remove(bfqd, &bfqq->entity, -+ &bfqd->queue_weights_tree); -+ if (!blk_queue_nonrot(bfqd->queue)) { -+ BUG_ON(!bfqd->busy_in_flight_queues); -+ bfqd->busy_in_flight_queues--; -+ if (bfq_bfqq_constantly_seeky(bfqq)) { -+ BUG_ON(!bfqd-> -+ const_seeky_busy_in_flight_queues); -+ bfqd->const_seeky_busy_in_flight_queues--; -+ } -+ } -+ } -+ if (bfqq->wr_coeff > 1) -+ bfqd->wr_busy_queues--; -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqg_stats_update_dequeue(bfqq_group(bfqq)); -+#endif -+ -+ bfq_deactivate_bfqq(bfqd, bfqq, requeue); -+} -+ -+/* -+ * Called when an inactive queue receives a new request. -+ */ -+static void bfq_add_bfqq_busy(struct bfq_data *bfqd, struct bfq_queue *bfqq) -+{ -+ BUG_ON(bfq_bfqq_busy(bfqq)); -+ BUG_ON(bfqq == bfqd->in_service_queue); -+ -+ bfq_log_bfqq(bfqd, bfqq, "add to busy"); -+ -+ bfq_activate_bfqq(bfqd, bfqq); -+ -+ bfq_mark_bfqq_busy(bfqq); -+ bfqd->busy_queues++; -+ -+ if (!bfqq->dispatched) { -+ if (bfqq->wr_coeff == 1) -+ bfq_weights_tree_add(bfqd, &bfqq->entity, -+ &bfqd->queue_weights_tree); -+ if (!blk_queue_nonrot(bfqd->queue)) { -+ bfqd->busy_in_flight_queues++; -+ if (bfq_bfqq_constantly_seeky(bfqq)) -+ bfqd->const_seeky_busy_in_flight_queues++; -+ } -+ } -+ if (bfqq->wr_coeff > 1) -+ bfqd->wr_busy_queues++; -+} -diff --git a/block/bfq.h b/block/bfq.h -new file mode 100644 -index 0000000..2bf54ae ---- /dev/null -+++ b/block/bfq.h -@@ -0,0 +1,801 @@ -+/* -+ * BFQ-v7r11 for 4.5.0: data structures and common functions prototypes. -+ * -+ * Based on ideas and code from CFQ: -+ * Copyright (C) 2003 Jens Axboe -+ * -+ * Copyright (C) 2008 Fabio Checconi -+ * Paolo Valente -+ * -+ * Copyright (C) 2010 Paolo Valente -+ */ -+ -+#ifndef _BFQ_H -+#define _BFQ_H -+ -+#include -+#include -+#include -+#include -+#include -+ -+#define BFQ_IOPRIO_CLASSES 3 -+#define BFQ_CL_IDLE_TIMEOUT (HZ/5) -+ -+#define BFQ_MIN_WEIGHT 1 -+#define BFQ_MAX_WEIGHT 1000 -+#define BFQ_WEIGHT_CONVERSION_COEFF 10 -+ -+#define BFQ_DEFAULT_QUEUE_IOPRIO 4 -+ -+#define BFQ_DEFAULT_GRP_WEIGHT 10 -+#define BFQ_DEFAULT_GRP_IOPRIO 0 -+#define BFQ_DEFAULT_GRP_CLASS IOPRIO_CLASS_BE -+ -+struct bfq_entity; -+ -+/** -+ * struct bfq_service_tree - per ioprio_class service tree. -+ * @active: tree for active entities (i.e., those backlogged). -+ * @idle: tree for idle entities (i.e., those not backlogged, with V <= F_i). -+ * @first_idle: idle entity with minimum F_i. -+ * @last_idle: idle entity with maximum F_i. -+ * @vtime: scheduler virtual time. -+ * @wsum: scheduler weight sum; active and idle entities contribute to it. -+ * -+ * Each service tree represents a B-WF2Q+ scheduler on its own. Each -+ * ioprio_class has its own independent scheduler, and so its own -+ * bfq_service_tree. All the fields are protected by the queue lock -+ * of the containing bfqd. -+ */ -+struct bfq_service_tree { -+ struct rb_root active; -+ struct rb_root idle; -+ -+ struct bfq_entity *first_idle; -+ struct bfq_entity *last_idle; -+ -+ u64 vtime; -+ unsigned long wsum; -+}; -+ -+/** -+ * struct bfq_sched_data - multi-class scheduler. -+ * @in_service_entity: entity in service. -+ * @next_in_service: head-of-the-line entity in the scheduler. -+ * @service_tree: array of service trees, one per ioprio_class. -+ * -+ * bfq_sched_data is the basic scheduler queue. It supports three -+ * ioprio_classes, and can be used either as a toplevel queue or as -+ * an intermediate queue on a hierarchical setup. -+ * @next_in_service points to the active entity of the sched_data -+ * service trees that will be scheduled next. -+ * -+ * The supported ioprio_classes are the same as in CFQ, in descending -+ * priority order, IOPRIO_CLASS_RT, IOPRIO_CLASS_BE, IOPRIO_CLASS_IDLE. -+ * Requests from higher priority queues are served before all the -+ * requests from lower priority queues; among requests of the same -+ * queue requests are served according to B-WF2Q+. -+ * All the fields are protected by the queue lock of the containing bfqd. -+ */ -+struct bfq_sched_data { -+ struct bfq_entity *in_service_entity; -+ struct bfq_entity *next_in_service; -+ struct bfq_service_tree service_tree[BFQ_IOPRIO_CLASSES]; -+}; -+ -+/** -+ * struct bfq_weight_counter - counter of the number of all active entities -+ * with a given weight. -+ * @weight: weight of the entities that this counter refers to. -+ * @num_active: number of active entities with this weight. -+ * @weights_node: weights tree member (see bfq_data's @queue_weights_tree -+ * and @group_weights_tree). -+ */ -+struct bfq_weight_counter { -+ short int weight; -+ unsigned int num_active; -+ struct rb_node weights_node; -+}; -+ -+/** -+ * struct bfq_entity - schedulable entity. -+ * @rb_node: service_tree member. -+ * @weight_counter: pointer to the weight counter associated with this entity. -+ * @on_st: flag, true if the entity is on a tree (either the active or -+ * the idle one of its service_tree). -+ * @finish: B-WF2Q+ finish timestamp (aka F_i). -+ * @start: B-WF2Q+ start timestamp (aka S_i). -+ * @tree: tree the entity is enqueued into; %NULL if not on a tree. -+ * @min_start: minimum start time of the (active) subtree rooted at -+ * this entity; used for O(log N) lookups into active trees. -+ * @service: service received during the last round of service. -+ * @budget: budget used to calculate F_i; F_i = S_i + @budget / @weight. -+ * @weight: weight of the queue -+ * @parent: parent entity, for hierarchical scheduling. -+ * @my_sched_data: for non-leaf nodes in the cgroup hierarchy, the -+ * associated scheduler queue, %NULL on leaf nodes. -+ * @sched_data: the scheduler queue this entity belongs to. -+ * @ioprio: the ioprio in use. -+ * @new_weight: when a weight change is requested, the new weight value. -+ * @orig_weight: original weight, used to implement weight boosting -+ * @prio_changed: flag, true when the user requested a weight, ioprio or -+ * ioprio_class change. -+ * -+ * A bfq_entity is used to represent either a bfq_queue (leaf node in the -+ * cgroup hierarchy) or a bfq_group into the upper level scheduler. Each -+ * entity belongs to the sched_data of the parent group in the cgroup -+ * hierarchy. Non-leaf entities have also their own sched_data, stored -+ * in @my_sched_data. -+ * -+ * Each entity stores independently its priority values; this would -+ * allow different weights on different devices, but this -+ * functionality is not exported to userspace by now. Priorities and -+ * weights are updated lazily, first storing the new values into the -+ * new_* fields, then setting the @prio_changed flag. As soon as -+ * there is a transition in the entity state that allows the priority -+ * update to take place the effective and the requested priority -+ * values are synchronized. -+ * -+ * Unless cgroups are used, the weight value is calculated from the -+ * ioprio to export the same interface as CFQ. When dealing with -+ * ``well-behaved'' queues (i.e., queues that do not spend too much -+ * time to consume their budget and have true sequential behavior, and -+ * when there are no external factors breaking anticipation) the -+ * relative weights at each level of the cgroups hierarchy should be -+ * guaranteed. All the fields are protected by the queue lock of the -+ * containing bfqd. -+ */ -+struct bfq_entity { -+ struct rb_node rb_node; -+ struct bfq_weight_counter *weight_counter; -+ -+ int on_st; -+ -+ u64 finish; -+ u64 start; -+ -+ struct rb_root *tree; -+ -+ u64 min_start; -+ -+ int service, budget; -+ unsigned short weight, new_weight; -+ unsigned short orig_weight; -+ -+ struct bfq_entity *parent; -+ -+ struct bfq_sched_data *my_sched_data; -+ struct bfq_sched_data *sched_data; -+ -+ int prio_changed; -+}; -+ -+struct bfq_group; -+ -+/** -+ * struct bfq_queue - leaf schedulable entity. -+ * @ref: reference counter. -+ * @bfqd: parent bfq_data. -+ * @new_ioprio: when an ioprio change is requested, the new ioprio value. -+ * @ioprio_class: the ioprio_class in use. -+ * @new_ioprio_class: when an ioprio_class change is requested, the new -+ * ioprio_class value. -+ * @new_bfqq: shared bfq_queue if queue is cooperating with -+ * one or more other queues. -+ * @sort_list: sorted list of pending requests. -+ * @next_rq: if fifo isn't expired, next request to serve. -+ * @queued: nr of requests queued in @sort_list. -+ * @allocated: currently allocated requests. -+ * @meta_pending: pending metadata requests. -+ * @fifo: fifo list of requests in sort_list. -+ * @entity: entity representing this queue in the scheduler. -+ * @max_budget: maximum budget allowed from the feedback mechanism. -+ * @budget_timeout: budget expiration (in jiffies). -+ * @dispatched: number of requests on the dispatch list or inside driver. -+ * @flags: status flags. -+ * @bfqq_list: node for active/idle bfqq list inside our bfqd. -+ * @burst_list_node: node for the device's burst list. -+ * @seek_samples: number of seeks sampled -+ * @seek_total: sum of the distances of the seeks sampled -+ * @seek_mean: mean seek distance -+ * @last_request_pos: position of the last request enqueued -+ * @requests_within_timer: number of consecutive pairs of request completion -+ * and arrival, such that the queue becomes idle -+ * after the completion, but the next request arrives -+ * within an idle time slice; used only if the queue's -+ * IO_bound has been cleared. -+ * @pid: pid of the process owning the queue, used for logging purposes. -+ * @last_wr_start_finish: start time of the current weight-raising period if -+ * the @bfq-queue is being weight-raised, otherwise -+ * finish time of the last weight-raising period -+ * @wr_cur_max_time: current max raising time for this queue -+ * @soft_rt_next_start: minimum time instant such that, only if a new -+ * request is enqueued after this time instant in an -+ * idle @bfq_queue with no outstanding requests, then -+ * the task associated with the queue it is deemed as -+ * soft real-time (see the comments to the function -+ * bfq_bfqq_softrt_next_start()) -+ * @last_idle_bklogged: time of the last transition of the @bfq_queue from -+ * idle to backlogged -+ * @service_from_backlogged: cumulative service received from the @bfq_queue -+ * since the last transition from idle to -+ * backlogged -+ * @bic: pointer to the bfq_io_cq owning the bfq_queue, set to %NULL if the -+ * queue is shared -+ * -+ * A bfq_queue is a leaf request queue; it can be associated with an -+ * io_context or more, if it is async or shared between cooperating -+ * processes. @cgroup holds a reference to the cgroup, to be sure that it -+ * does not disappear while a bfqq still references it (mostly to avoid -+ * races between request issuing and task migration followed by cgroup -+ * destruction). -+ * All the fields are protected by the queue lock of the containing bfqd. -+ */ -+struct bfq_queue { -+ atomic_t ref; -+ struct bfq_data *bfqd; -+ -+ unsigned short ioprio, new_ioprio; -+ unsigned short ioprio_class, new_ioprio_class; -+ -+ /* fields for cooperating queues handling */ -+ struct bfq_queue *new_bfqq; -+ struct rb_node pos_node; -+ struct rb_root *pos_root; -+ -+ struct rb_root sort_list; -+ struct request *next_rq; -+ int queued[2]; -+ int allocated[2]; -+ int meta_pending; -+ struct list_head fifo; -+ -+ struct bfq_entity entity; -+ -+ int max_budget; -+ unsigned long budget_timeout; -+ -+ int dispatched; -+ -+ unsigned int flags; -+ -+ struct list_head bfqq_list; -+ -+ struct hlist_node burst_list_node; -+ -+ unsigned int seek_samples; -+ u64 seek_total; -+ sector_t seek_mean; -+ sector_t last_request_pos; -+ -+ unsigned int requests_within_timer; -+ -+ pid_t pid; -+ struct bfq_io_cq *bic; -+ -+ /* weight-raising fields */ -+ unsigned long wr_cur_max_time; -+ unsigned long soft_rt_next_start; -+ unsigned long last_wr_start_finish; -+ unsigned int wr_coeff; -+ unsigned long last_idle_bklogged; -+ unsigned long service_from_backlogged; -+}; -+ -+/** -+ * struct bfq_ttime - per process thinktime stats. -+ * @ttime_total: total process thinktime -+ * @ttime_samples: number of thinktime samples -+ * @ttime_mean: average process thinktime -+ */ -+struct bfq_ttime { -+ unsigned long last_end_request; -+ -+ unsigned long ttime_total; -+ unsigned long ttime_samples; -+ unsigned long ttime_mean; -+}; -+ -+/** -+ * struct bfq_io_cq - per (request_queue, io_context) structure. -+ * @icq: associated io_cq structure -+ * @bfqq: array of two process queues, the sync and the async -+ * @ttime: associated @bfq_ttime struct -+ * @ioprio: per (request_queue, blkcg) ioprio. -+ * @blkcg_id: id of the blkcg the related io_cq belongs to. -+ */ -+struct bfq_io_cq { -+ struct io_cq icq; /* must be the first member */ -+ struct bfq_queue *bfqq[2]; -+ struct bfq_ttime ttime; -+ int ioprio; -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ uint64_t blkcg_id; /* the current blkcg ID */ -+#endif -+}; -+ -+enum bfq_device_speed { -+ BFQ_BFQD_FAST, -+ BFQ_BFQD_SLOW, -+}; -+ -+/** -+ * struct bfq_data - per device data structure. -+ * @queue: request queue for the managed device. -+ * @root_group: root bfq_group for the device. -+ * @active_numerous_groups: number of bfq_groups containing more than one -+ * active @bfq_entity. -+ * @queue_weights_tree: rbtree of weight counters of @bfq_queues, sorted by -+ * weight. Used to keep track of whether all @bfq_queues -+ * have the same weight. The tree contains one counter -+ * for each distinct weight associated to some active -+ * and not weight-raised @bfq_queue (see the comments to -+ * the functions bfq_weights_tree_[add|remove] for -+ * further details). -+ * @group_weights_tree: rbtree of non-queue @bfq_entity weight counters, sorted -+ * by weight. Used to keep track of whether all -+ * @bfq_groups have the same weight. The tree contains -+ * one counter for each distinct weight associated to -+ * some active @bfq_group (see the comments to the -+ * functions bfq_weights_tree_[add|remove] for further -+ * details). -+ * @busy_queues: number of bfq_queues containing requests (including the -+ * queue in service, even if it is idling). -+ * @busy_in_flight_queues: number of @bfq_queues containing pending or -+ * in-flight requests, plus the @bfq_queue in -+ * service, even if idle but waiting for the -+ * possible arrival of its next sync request. This -+ * field is updated only if the device is rotational, -+ * but used only if the device is also NCQ-capable. -+ * The reason why the field is updated also for non- -+ * NCQ-capable rotational devices is related to the -+ * fact that the value of @hw_tag may be set also -+ * later than when busy_in_flight_queues may need to -+ * be incremented for the first time(s). Taking also -+ * this possibility into account, to avoid unbalanced -+ * increments/decrements, would imply more overhead -+ * than just updating busy_in_flight_queues -+ * regardless of the value of @hw_tag. -+ * @const_seeky_busy_in_flight_queues: number of constantly-seeky @bfq_queues -+ * (that is, seeky queues that expired -+ * for budget timeout at least once) -+ * containing pending or in-flight -+ * requests, including the in-service -+ * @bfq_queue if constantly seeky. This -+ * field is updated only if the device -+ * is rotational, but used only if the -+ * device is also NCQ-capable (see the -+ * comments to @busy_in_flight_queues). -+ * @wr_busy_queues: number of weight-raised busy @bfq_queues. -+ * @queued: number of queued requests. -+ * @rq_in_driver: number of requests dispatched and waiting for completion. -+ * @sync_flight: number of sync requests in the driver. -+ * @max_rq_in_driver: max number of reqs in driver in the last -+ * @hw_tag_samples completed requests. -+ * @hw_tag_samples: nr of samples used to calculate hw_tag. -+ * @hw_tag: flag set to one if the driver is showing a queueing behavior. -+ * @budgets_assigned: number of budgets assigned. -+ * @idle_slice_timer: timer set when idling for the next sequential request -+ * from the queue in service. -+ * @unplug_work: delayed work to restart dispatching on the request queue. -+ * @in_service_queue: bfq_queue in service. -+ * @in_service_bic: bfq_io_cq (bic) associated with the @in_service_queue. -+ * @last_position: on-disk position of the last served request. -+ * @last_budget_start: beginning of the last budget. -+ * @last_idling_start: beginning of the last idle slice. -+ * @peak_rate: peak transfer rate observed for a budget. -+ * @peak_rate_samples: number of samples used to calculate @peak_rate. -+ * @bfq_max_budget: maximum budget allotted to a bfq_queue before -+ * rescheduling. -+ * @active_list: list of all the bfq_queues active on the device. -+ * @idle_list: list of all the bfq_queues idle on the device. -+ * @bfq_fifo_expire: timeout for async/sync requests; when it expires -+ * requests are served in fifo order. -+ * @bfq_back_penalty: weight of backward seeks wrt forward ones. -+ * @bfq_back_max: maximum allowed backward seek. -+ * @bfq_slice_idle: maximum idling time. -+ * @bfq_user_max_budget: user-configured max budget value -+ * (0 for auto-tuning). -+ * @bfq_max_budget_async_rq: maximum budget (in nr of requests) allotted to -+ * async queues. -+ * @bfq_timeout: timeout for bfq_queues to consume their budget; used to -+ * to prevent seeky queues to impose long latencies to well -+ * behaved ones (this also implies that seeky queues cannot -+ * receive guarantees in the service domain; after a timeout -+ * they are charged for the whole allocated budget, to try -+ * to preserve a behavior reasonably fair among them, but -+ * without service-domain guarantees). -+ * @bfq_coop_thresh: number of queue merges after which a @bfq_queue is -+ * no more granted any weight-raising. -+ * @bfq_failed_cooperations: number of consecutive failed cooperation -+ * chances after which weight-raising is restored -+ * to a queue subject to more than bfq_coop_thresh -+ * queue merges. -+ * @bfq_requests_within_timer: number of consecutive requests that must be -+ * issued within the idle time slice to set -+ * again idling to a queue which was marked as -+ * non-I/O-bound (see the definition of the -+ * IO_bound flag for further details). -+ * @last_ins_in_burst: last time at which a queue entered the current -+ * burst of queues being activated shortly after -+ * each other; for more details about this and the -+ * following parameters related to a burst of -+ * activations, see the comments to the function -+ * @bfq_handle_burst. -+ * @bfq_burst_interval: reference time interval used to decide whether a -+ * queue has been activated shortly after -+ * @last_ins_in_burst. -+ * @burst_size: number of queues in the current burst of queue activations. -+ * @bfq_large_burst_thresh: maximum burst size above which the current -+ * queue-activation burst is deemed as 'large'. -+ * @large_burst: true if a large queue-activation burst is in progress. -+ * @burst_list: head of the burst list (as for the above fields, more details -+ * in the comments to the function bfq_handle_burst). -+ * @low_latency: if set to true, low-latency heuristics are enabled. -+ * @bfq_wr_coeff: maximum factor by which the weight of a weight-raised -+ * queue is multiplied. -+ * @bfq_wr_max_time: maximum duration of a weight-raising period (jiffies). -+ * @bfq_wr_rt_max_time: maximum duration for soft real-time processes. -+ * @bfq_wr_min_idle_time: minimum idle period after which weight-raising -+ * may be reactivated for a queue (in jiffies). -+ * @bfq_wr_min_inter_arr_async: minimum period between request arrivals -+ * after which weight-raising may be -+ * reactivated for an already busy queue -+ * (in jiffies). -+ * @bfq_wr_max_softrt_rate: max service-rate for a soft real-time queue, -+ * sectors per seconds. -+ * @RT_prod: cached value of the product R*T used for computing the maximum -+ * duration of the weight raising automatically. -+ * @device_speed: device-speed class for the low-latency heuristic. -+ * @oom_bfqq: fallback dummy bfqq for extreme OOM conditions. -+ * -+ * All the fields are protected by the @queue lock. -+ */ -+struct bfq_data { -+ struct request_queue *queue; -+ -+ struct bfq_group *root_group; -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ int active_numerous_groups; -+#endif -+ -+ struct rb_root queue_weights_tree; -+ struct rb_root group_weights_tree; -+ -+ int busy_queues; -+ int busy_in_flight_queues; -+ int const_seeky_busy_in_flight_queues; -+ int wr_busy_queues; -+ int queued; -+ int rq_in_driver; -+ int sync_flight; -+ -+ int max_rq_in_driver; -+ int hw_tag_samples; -+ int hw_tag; -+ -+ int budgets_assigned; -+ -+ struct timer_list idle_slice_timer; -+ struct work_struct unplug_work; -+ -+ struct bfq_queue *in_service_queue; -+ struct bfq_io_cq *in_service_bic; -+ -+ sector_t last_position; -+ -+ ktime_t last_budget_start; -+ ktime_t last_idling_start; -+ int peak_rate_samples; -+ u64 peak_rate; -+ int bfq_max_budget; -+ -+ struct list_head active_list; -+ struct list_head idle_list; -+ -+ unsigned int bfq_fifo_expire[2]; -+ unsigned int bfq_back_penalty; -+ unsigned int bfq_back_max; -+ unsigned int bfq_slice_idle; -+ u64 bfq_class_idle_last_service; -+ -+ int bfq_user_max_budget; -+ int bfq_max_budget_async_rq; -+ unsigned int bfq_timeout[2]; -+ -+ unsigned int bfq_coop_thresh; -+ unsigned int bfq_failed_cooperations; -+ unsigned int bfq_requests_within_timer; -+ -+ unsigned long last_ins_in_burst; -+ unsigned long bfq_burst_interval; -+ int burst_size; -+ unsigned long bfq_large_burst_thresh; -+ bool large_burst; -+ struct hlist_head burst_list; -+ -+ bool low_latency; -+ -+ /* parameters of the low_latency heuristics */ -+ unsigned int bfq_wr_coeff; -+ unsigned int bfq_wr_max_time; -+ unsigned int bfq_wr_rt_max_time; -+ unsigned int bfq_wr_min_idle_time; -+ unsigned long bfq_wr_min_inter_arr_async; -+ unsigned int bfq_wr_max_softrt_rate; -+ u64 RT_prod; -+ enum bfq_device_speed device_speed; -+ -+ struct bfq_queue oom_bfqq; -+}; -+ -+enum bfqq_state_flags { -+ BFQ_BFQQ_FLAG_busy = 0, /* has requests or is in service */ -+ BFQ_BFQQ_FLAG_wait_request, /* waiting for a request */ -+ BFQ_BFQQ_FLAG_must_alloc, /* must be allowed rq alloc */ -+ BFQ_BFQQ_FLAG_fifo_expire, /* FIFO checked in this slice */ -+ BFQ_BFQQ_FLAG_idle_window, /* slice idling enabled */ -+ BFQ_BFQQ_FLAG_sync, /* synchronous queue */ -+ BFQ_BFQQ_FLAG_budget_new, /* no completion with this budget */ -+ BFQ_BFQQ_FLAG_IO_bound, /* -+ * bfqq has timed-out at least once -+ * having consumed at most 2/10 of -+ * its budget -+ */ -+ BFQ_BFQQ_FLAG_in_large_burst, /* -+ * bfqq activated in a large burst, -+ * see comments to bfq_handle_burst. -+ */ -+ BFQ_BFQQ_FLAG_constantly_seeky, /* -+ * bfqq has proved to be slow and -+ * seeky until budget timeout -+ */ -+ BFQ_BFQQ_FLAG_softrt_update, /* -+ * may need softrt-next-start -+ * update -+ */ -+}; -+ -+#define BFQ_BFQQ_FNS(name) \ -+static void bfq_mark_bfqq_##name(struct bfq_queue *bfqq) \ -+{ \ -+ (bfqq)->flags |= (1 << BFQ_BFQQ_FLAG_##name); \ -+} \ -+static void bfq_clear_bfqq_##name(struct bfq_queue *bfqq) \ -+{ \ -+ (bfqq)->flags &= ~(1 << BFQ_BFQQ_FLAG_##name); \ -+} \ -+static int bfq_bfqq_##name(const struct bfq_queue *bfqq) \ -+{ \ -+ return ((bfqq)->flags & (1 << BFQ_BFQQ_FLAG_##name)) != 0; \ -+} -+ -+BFQ_BFQQ_FNS(busy); -+BFQ_BFQQ_FNS(wait_request); -+BFQ_BFQQ_FNS(must_alloc); -+BFQ_BFQQ_FNS(fifo_expire); -+BFQ_BFQQ_FNS(idle_window); -+BFQ_BFQQ_FNS(sync); -+BFQ_BFQQ_FNS(budget_new); -+BFQ_BFQQ_FNS(IO_bound); -+BFQ_BFQQ_FNS(in_large_burst); -+BFQ_BFQQ_FNS(constantly_seeky); -+BFQ_BFQQ_FNS(softrt_update); -+#undef BFQ_BFQQ_FNS -+ -+/* Logging facilities. */ -+#define bfq_log_bfqq(bfqd, bfqq, fmt, args...) \ -+ blk_add_trace_msg((bfqd)->queue, "bfq%d " fmt, (bfqq)->pid, ##args) -+ -+#define bfq_log(bfqd, fmt, args...) \ -+ blk_add_trace_msg((bfqd)->queue, "bfq " fmt, ##args) -+ -+/* Expiration reasons. */ -+enum bfqq_expiration { -+ BFQ_BFQQ_TOO_IDLE = 0, /* -+ * queue has been idling for -+ * too long -+ */ -+ BFQ_BFQQ_BUDGET_TIMEOUT, /* budget took too long to be used */ -+ BFQ_BFQQ_BUDGET_EXHAUSTED, /* budget consumed */ -+ BFQ_BFQQ_NO_MORE_REQUESTS, /* the queue has no more requests */ -+}; -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ -+struct bfqg_stats { -+ /* total bytes transferred */ -+ struct blkg_rwstat service_bytes; -+ /* total IOs serviced, post merge */ -+ struct blkg_rwstat serviced; -+ /* number of ios merged */ -+ struct blkg_rwstat merged; -+ /* total time spent on device in ns, may not be accurate w/ queueing */ -+ struct blkg_rwstat service_time; -+ /* total time spent waiting in scheduler queue in ns */ -+ struct blkg_rwstat wait_time; -+ /* number of IOs queued up */ -+ struct blkg_rwstat queued; -+ /* total sectors transferred */ -+ struct blkg_stat sectors; -+ /* total disk time and nr sectors dispatched by this group */ -+ struct blkg_stat time; -+ /* time not charged to this cgroup */ -+ struct blkg_stat unaccounted_time; -+ /* sum of number of ios queued across all samples */ -+ struct blkg_stat avg_queue_size_sum; -+ /* count of samples taken for average */ -+ struct blkg_stat avg_queue_size_samples; -+ /* how many times this group has been removed from service tree */ -+ struct blkg_stat dequeue; -+ /* total time spent waiting for it to be assigned a timeslice. */ -+ struct blkg_stat group_wait_time; -+ /* time spent idling for this blkcg_gq */ -+ struct blkg_stat idle_time; -+ /* total time with empty current active q with other requests queued */ -+ struct blkg_stat empty_time; -+ /* fields after this shouldn't be cleared on stat reset */ -+ uint64_t start_group_wait_time; -+ uint64_t start_idle_time; -+ uint64_t start_empty_time; -+ uint16_t flags; -+}; -+ -+/* -+ * struct bfq_group_data - per-blkcg storage for the blkio subsystem. -+ * -+ * @ps: @blkcg_policy_storage that this structure inherits -+ * @weight: weight of the bfq_group -+ */ -+struct bfq_group_data { -+ /* must be the first member */ -+ struct blkcg_policy_data pd; -+ -+ unsigned short weight; -+}; -+ -+/** -+ * struct bfq_group - per (device, cgroup) data structure. -+ * @entity: schedulable entity to insert into the parent group sched_data. -+ * @sched_data: own sched_data, to contain child entities (they may be -+ * both bfq_queues and bfq_groups). -+ * @bfqd: the bfq_data for the device this group acts upon. -+ * @async_bfqq: array of async queues for all the tasks belonging to -+ * the group, one queue per ioprio value per ioprio_class, -+ * except for the idle class that has only one queue. -+ * @async_idle_bfqq: async queue for the idle class (ioprio is ignored). -+ * @my_entity: pointer to @entity, %NULL for the toplevel group; used -+ * to avoid too many special cases during group creation/ -+ * migration. -+ * @active_entities: number of active entities belonging to the group; -+ * unused for the root group. Used to know whether there -+ * are groups with more than one active @bfq_entity -+ * (see the comments to the function -+ * bfq_bfqq_must_not_expire()). -+ * -+ * Each (device, cgroup) pair has its own bfq_group, i.e., for each cgroup -+ * there is a set of bfq_groups, each one collecting the lower-level -+ * entities belonging to the group that are acting on the same device. -+ * -+ * Locking works as follows: -+ * o @bfqd is protected by the queue lock, RCU is used to access it -+ * from the readers. -+ * o All the other fields are protected by the @bfqd queue lock. -+ */ -+struct bfq_group { -+ /* must be the first member */ -+ struct blkg_policy_data pd; -+ -+ struct bfq_entity entity; -+ struct bfq_sched_data sched_data; -+ -+ void *bfqd; -+ -+ struct bfq_queue *async_bfqq[2][IOPRIO_BE_NR]; -+ struct bfq_queue *async_idle_bfqq; -+ -+ struct bfq_entity *my_entity; -+ -+ int active_entities; -+ -+ struct bfqg_stats stats; -+ struct bfqg_stats dead_stats; /* stats pushed from dead children */ -+}; -+ -+#else -+struct bfq_group { -+ struct bfq_sched_data sched_data; -+ -+ struct bfq_queue *async_bfqq[2][IOPRIO_BE_NR]; -+ struct bfq_queue *async_idle_bfqq; -+}; -+#endif -+ -+static struct bfq_queue *bfq_entity_to_bfqq(struct bfq_entity *entity); -+ -+static struct bfq_service_tree * -+bfq_entity_service_tree(struct bfq_entity *entity) -+{ -+ struct bfq_sched_data *sched_data = entity->sched_data; -+ struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -+ unsigned int idx = bfqq ? bfqq->ioprio_class - 1 : -+ BFQ_DEFAULT_GRP_CLASS; -+ -+ BUG_ON(idx >= BFQ_IOPRIO_CLASSES); -+ BUG_ON(sched_data == NULL); -+ -+ return sched_data->service_tree + idx; -+} -+ -+static struct bfq_queue *bic_to_bfqq(struct bfq_io_cq *bic, bool is_sync) -+{ -+ return bic->bfqq[is_sync]; -+} -+ -+static void bic_set_bfqq(struct bfq_io_cq *bic, struct bfq_queue *bfqq, -+ bool is_sync) -+{ -+ bic->bfqq[is_sync] = bfqq; -+} -+ -+static struct bfq_data *bic_to_bfqd(struct bfq_io_cq *bic) -+{ -+ return bic->icq.q->elevator->elevator_data; -+} -+ -+/** -+ * bfq_get_bfqd_locked - get a lock to a bfqd using a RCU protected pointer. -+ * @ptr: a pointer to a bfqd. -+ * @flags: storage for the flags to be saved. -+ * -+ * This function allows bfqg->bfqd to be protected by the -+ * queue lock of the bfqd they reference; the pointer is dereferenced -+ * under RCU, so the storage for bfqd is assured to be safe as long -+ * as the RCU read side critical section does not end. After the -+ * bfqd->queue->queue_lock is taken the pointer is rechecked, to be -+ * sure that no other writer accessed it. If we raced with a writer, -+ * the function returns NULL, with the queue unlocked, otherwise it -+ * returns the dereferenced pointer, with the queue locked. -+ */ -+static struct bfq_data *bfq_get_bfqd_locked(void **ptr, unsigned long *flags) -+{ -+ struct bfq_data *bfqd; -+ -+ rcu_read_lock(); -+ bfqd = rcu_dereference(*(struct bfq_data **)ptr); -+ -+ if (bfqd != NULL) { -+ spin_lock_irqsave(bfqd->queue->queue_lock, *flags); -+ if (ptr == NULL) -+ printk(KERN_CRIT "get_bfqd_locked pointer NULL\n"); -+ else if (*ptr == bfqd) -+ goto out; -+ spin_unlock_irqrestore(bfqd->queue->queue_lock, *flags); -+ } -+ -+ bfqd = NULL; -+out: -+ rcu_read_unlock(); -+ return bfqd; -+} -+ -+static void bfq_put_bfqd_unlock(struct bfq_data *bfqd, unsigned long *flags) -+{ -+ spin_unlock_irqrestore(bfqd->queue->queue_lock, *flags); -+} -+ -+static void bfq_check_ioprio_change(struct bfq_io_cq *bic, struct bio *bio); -+static void bfq_put_queue(struct bfq_queue *bfqq); -+static void bfq_dispatch_insert(struct request_queue *q, struct request *rq); -+static struct bfq_queue *bfq_get_queue(struct bfq_data *bfqd, -+ struct bio *bio, int is_sync, -+ struct bfq_io_cq *bic, gfp_t gfp_mask); -+static void bfq_end_wr_async_queues(struct bfq_data *bfqd, -+ struct bfq_group *bfqg); -+static void bfq_put_async_queues(struct bfq_data *bfqd, struct bfq_group *bfqg); -+static void bfq_exit_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq); -+ -+#endif /* _BFQ_H */ --- -2.10.0 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-nvme-detect-NVMe-controller-in-recent-MacBooks.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-nvme-detect-NVMe-controller-in-recent-MacBooks.patch deleted file mode 100644 index a248ba34..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/block-nvme-detect-NVMe-controller-in-recent-MacBooks.patch +++ /dev/null @@ -1,34 +0,0 @@ -From 124298bd03acebd9c9da29a794718aca31bec1f7 Mon Sep 17 00:00:00 2001 -From: Daniel Roschka -Date: Wed, 22 Feb 2017 15:17:29 -0700 -Subject: [PATCH] nvme: detect NVMe controller in recent MacBooks - -Adds support for detection of the NVMe controller found in the -following recent MacBooks: -- Retina MacBook 2016 (MacBook9,1) -- 13" MacBook Pro 2016 without Touch Bar (MacBook13,1) -- 13" MacBook Pro 2016 with Touch Bar (MacBook13,2) - -Signed-off-by: Daniel Roschka -Reviewed-by: Christoph Hellwig -Signed-off-by: Sagi Grimberg -Signed-off-by: Jens Axboe ---- - drivers/nvme/host/pci.c | 1 + - 1 file changed, 1 insertion(+) - -diff --git a/drivers/nvme/host/pci.c b/drivers/nvme/host/pci.c -index d38dae9..319f5c5 100644 ---- a/drivers/nvme/host/pci.c -+++ b/drivers/nvme/host/pci.c -@@ -2120,6 +2120,7 @@ static const struct pci_device_id nvme_id_table[] = { - .driver_data = NVME_QUIRK_DELAY_BEFORE_CHK_RDY, }, - { PCI_DEVICE_CLASS(PCI_CLASS_STORAGE_EXPRESS, 0xffffff) }, - { PCI_DEVICE(PCI_VENDOR_ID_APPLE, 0x2001) }, -+ { PCI_DEVICE(PCI_VENDOR_ID_APPLE, 0x2003) }, - { 0, } - }; - MODULE_DEVICE_TABLE(pci, nvme_id_table); --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-update-bfq-from-v8r10-to-v8r11.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-update-bfq-from-v8r10-to-v8r11.patch deleted file mode 100644 index 8299447d..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/block-update-bfq-from-v8r10-to-v8r11.patch +++ /dev/null @@ -1,69 +0,0 @@ - block/bfq-iosched.c | 4 +++- - block/bfq-sched.c | 15 ++++++++++++--- - block/bfq.h | 2 +- - 3 files changed, 16 insertions(+), 5 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 96b79a0dae9f..158628392d92 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -4572,6 +4572,8 @@ static int bfq_set_request(struct request_queue *q, struct request *rq, - if (!bic) - goto queue_fail; - -+ bfq_check_ioprio_change(bic, bio); -+ - bfq_bic_update_cgroup(bic, bio); - - new_queue: -@@ -5268,7 +5270,7 @@ static struct blkcg_policy blkcg_policy_bfq = { - static int __init bfq_init(void) - { - int ret; -- char msg[60] = "BFQ I/O-scheduler: v8r10"; -+ char msg[60] = "BFQ I/O-scheduler: v8r11"; - - #ifdef CONFIG_BFQ_GROUP_IOSCHED - ret = blkcg_policy_register(&blkcg_policy_bfq); -diff --git a/block/bfq-sched.c b/block/bfq-sched.c -index 70aac56b02ef..8311bdbeceea 100644 ---- a/block/bfq-sched.c -+++ b/block/bfq-sched.c -@@ -1280,14 +1280,23 @@ static bool __bfq_deactivate_entity(struct bfq_entity *entity, - bool ins_into_idle_tree) - { - struct bfq_sched_data *sd = entity->sched_data; -- struct bfq_service_tree *st = bfq_entity_service_tree(entity); -- bool is_in_service = entity == sd->in_service_entity; -+ struct bfq_service_tree *st; -+ bool is_in_service; - - if (!entity->on_st) { /* entity never activated, or already inactive */ -- BUG_ON(entity == entity->sched_data->in_service_entity); -+ BUG_ON(sd && entity == sd->in_service_entity); - return false; - } - -+ /* -+ * If we get here, then entity is active, which implies that -+ * bfq_group_set_parent has already been invoked for the group -+ * represented by entity. Therefore, the field -+ * entity->sched_data has been set, and we can safely use it. -+ */ -+ st = bfq_entity_service_tree(entity); -+ is_in_service = entity == sd->in_service_entity; -+ - BUG_ON(is_in_service && entity->tree && entity->tree != &st->active); - - if (is_in_service) -diff --git a/block/bfq.h b/block/bfq.h -index e3855af1211b..a521ac40cac0 100644 ---- a/block/bfq.h -+++ b/block/bfq.h -@@ -1,5 +1,5 @@ - /* -- * BFQ v8r10 for 4.9.0: data structures and common functions prototypes. -+ * BFQ v8r11 for 4.9.0: data structures and common functions prototypes. - * - * Based on ideas and code from CFQ: - * Copyright (C) 2003 Jens Axboe diff --git a/kernel/tools/cpupowertools/files/patches/mageia/block-update-bfq-from-v8r7-to-v8r10.patch b/kernel/tools/cpupowertools/files/patches/mageia/block-update-bfq-from-v8r7-to-v8r10.patch deleted file mode 100644 index 17cea46c..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/block-update-bfq-from-v8r7-to-v8r10.patch +++ /dev/null @@ -1,729 +0,0 @@ - block/bfq-cgroup.c | 12 +-- - block/bfq-iosched.c | 211 +++++++++++++++++++++++++++++++--------------------- - block/bfq-sched.c | 73 ++++++++++++------ - block/bfq.h | 4 +- - 4 files changed, 180 insertions(+), 120 deletions(-) - -diff --git a/block/bfq-cgroup.c b/block/bfq-cgroup.c -index bbaecd0..a66a723 100644 ---- a/block/bfq-cgroup.c -+++ b/block/bfq-cgroup.c -@@ -771,7 +771,6 @@ static void bfq_pd_offline(struct blkg_policy_data *pd) - - __bfq_deactivate_entity(entity, false); - bfq_put_async_queues(bfqd, bfqg); -- BUG_ON(entity->tree); - - /* - * @blkg is going offline and will be ignored by -@@ -1140,6 +1139,9 @@ static inline void bfqg_stats_update_idle_time(struct bfq_group *bfqg) { } - static inline void bfqg_stats_set_start_idle_time(struct bfq_group *bfqg) { } - static inline void bfqg_stats_update_avg_queue_size(struct bfq_group *bfqg) { } - -+static void bfq_bfqq_move(struct bfq_data *bfqd, struct bfq_queue *bfqq, -+ struct bfq_group *bfqg) {} -+ - static void bfq_init_entity(struct bfq_entity *entity, - struct bfq_group *bfqg) - { -@@ -1154,13 +1156,7 @@ static void bfq_init_entity(struct bfq_entity *entity, - entity->sched_data = &bfqg->sched_data; - } - --static struct bfq_group * --bfq_bic_update_cgroup(struct bfq_io_cq *bic, struct bio *bio) --{ -- struct bfq_data *bfqd = bic_to_bfqd(bic); -- -- return bfqd->root_group; --} -+static void bfq_bic_update_cgroup(struct bfq_io_cq *bic, struct bio *bio) {} - - static void bfq_end_wr_async(struct bfq_data *bfqd) - { -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 78baa07..96b79a0 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -9,7 +9,7 @@ - * - * Copyright (C) 2015 Paolo Valente - * -- * Copyright (C) 2016 Paolo Valente -+ * Copyright (C) 2017 Paolo Valente - * - * Licensed under the GPL-2 as detailed in the accompanying COPYING.BFQ - * file. -@@ -107,7 +107,7 @@ static const int bfq_async_charge_factor = 10; - /* Default timeout values, in jiffies, approximating CFQ defaults. */ - static const int bfq_timeout = (HZ / 8); - --struct kmem_cache *bfq_pool; -+static struct kmem_cache *bfq_pool; - - /* Below this threshold (in ns), we consider thinktime immediate. */ - #define BFQ_MIN_TT (2 * NSEC_PER_MSEC) -@@ -483,6 +483,22 @@ static void bfq_weights_tree_add(struct bfq_data *bfqd, - - entity->weight_counter = kzalloc(sizeof(struct bfq_weight_counter), - GFP_ATOMIC); -+ -+ /* -+ * In the unlucky event of an allocation failure, we just -+ * exit. This will cause the weight of entity to not be -+ * considered in bfq_differentiated_weights, which, in its -+ * turn, causes the scenario to be deemed wrongly symmetric in -+ * case entity's weight would have been the only weight making -+ * the scenario asymmetric. On the bright side, no unbalance -+ * will however occur when entity becomes inactive again (the -+ * invocation of this function is triggered by an activation -+ * of entity). In fact, bfq_weights_tree_remove does nothing -+ * if !entity->weight_counter. -+ */ -+ if (unlikely(!entity->weight_counter)) -+ return; -+ - entity->weight_counter->weight = entity->weight; - rb_link_node(&entity->weight_counter->weights_node, parent, new); - rb_insert_color(&entity->weight_counter->weights_node, root); -@@ -519,13 +535,45 @@ static void bfq_weights_tree_remove(struct bfq_data *bfqd, - entity->weight_counter = NULL; - } - -+/* -+ * Return expired entry, or NULL to just start from scratch in rbtree. -+ */ -+static struct request *bfq_check_fifo(struct bfq_queue *bfqq, -+ struct request *last) -+{ -+ struct request *rq; -+ -+ if (bfq_bfqq_fifo_expire(bfqq)) -+ return NULL; -+ -+ bfq_mark_bfqq_fifo_expire(bfqq); -+ -+ rq = rq_entry_fifo(bfqq->fifo.next); -+ -+ if (rq == last || ktime_get_ns() < rq->fifo_time) -+ return NULL; -+ -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "check_fifo: returned %p", rq); -+ BUG_ON(RB_EMPTY_NODE(&rq->rb_node)); -+ return rq; -+} -+ - static struct request *bfq_find_next_rq(struct bfq_data *bfqd, - struct bfq_queue *bfqq, - struct request *last) - { - struct rb_node *rbnext = rb_next(&last->rb_node); - struct rb_node *rbprev = rb_prev(&last->rb_node); -- struct request *next = NULL, *prev = NULL; -+ struct request *next, *prev = NULL; -+ -+ BUG_ON(list_empty(&bfqq->fifo)); -+ -+ /* Follow expired path, else get first next available. */ -+ next = bfq_check_fifo(bfqq, last); -+ if (next) { -+ BUG_ON(next == last); -+ return next; -+ } - - BUG_ON(RB_EMPTY_NODE(&last->rb_node)); - -@@ -1359,7 +1407,6 @@ static void bfq_bfqq_handle_idle_busy_switch(struct bfq_data *bfqd, - - bfq_bfqq_expire(bfqd, bfqd->in_service_queue, - false, BFQ_BFQQ_PREEMPTED); -- BUG_ON(in_serv->entity.budget < 0); - } - } - -@@ -1523,12 +1570,15 @@ static void bfq_remove_request(struct request *rq) - elv_rb_del(&bfqq->sort_list, rq); - - if (RB_EMPTY_ROOT(&bfqq->sort_list)) { -+ bfqq->next_rq = NULL; -+ - BUG_ON(bfqq->entity.budget < 0); - - if (bfq_bfqq_busy(bfqq) && bfqq != bfqd->in_service_queue) { -+ BUG_ON(bfqq->ref < 2); /* referred by rq and on tree */ - bfq_del_bfqq_busy(bfqd, bfqq, false); -- -- /* bfqq emptied. In normal operation, when -+ /* -+ * bfqq emptied. In normal operation, when - * bfqq is empty, bfqq->entity.service and - * bfqq->entity.budget must contain, - * respectively, the service received and the -@@ -1537,7 +1587,8 @@ static void bfq_remove_request(struct request *rq) - * this last removal occurred while bfqq is - * not in service. To avoid inconsistencies, - * reset both bfqq->entity.service and -- * bfqq->entity.budget. -+ * bfqq->entity.budget, if bfqq has still a -+ * process that may issue I/O requests to it. - */ - bfqq->entity.budget = bfqq->entity.service = 0; - } -@@ -1868,7 +1919,7 @@ static bool bfq_may_be_close_cooperator(struct bfq_queue *bfqq, - * positives. In case bfqq is weight-raised, such false positives - * would evidently degrade latency guarantees for bfqq. - */ --bool wr_from_too_long(struct bfq_queue *bfqq) -+static bool wr_from_too_long(struct bfq_queue *bfqq) - { - return bfqq->wr_coeff > 1 && - time_is_before_jiffies(bfqq->last_wr_start_finish + -@@ -2029,7 +2080,8 @@ bfq_merge_bfqqs(struct bfq_data *bfqd, struct bfq_io_cq *bic, - new_bfqq->wr_coeff = bfqq->wr_coeff; - new_bfqq->wr_cur_max_time = bfqq->wr_cur_max_time; - new_bfqq->last_wr_start_finish = bfqq->last_wr_start_finish; -- new_bfqq->wr_start_at_switch_to_srt = bfqq->wr_start_at_switch_to_srt; -+ new_bfqq->wr_start_at_switch_to_srt = -+ bfqq->wr_start_at_switch_to_srt; - if (bfq_bfqq_busy(new_bfqq)) - bfqd->wr_busy_queues++; - new_bfqq->entity.prio_changed = 1; -@@ -2072,6 +2124,7 @@ bfq_merge_bfqqs(struct bfq_data *bfqd, struct bfq_io_cq *bic, - */ - new_bfqq->bic = NULL; - bfqq->bic = NULL; -+ /* release process reference to bfqq */ - bfq_put_queue(bfqq); - } - -@@ -2298,7 +2351,7 @@ static unsigned long bfq_calc_max_budget(struct bfq_data *bfqd) - * function of the estimated peak rate. See comments on - * bfq_calc_max_budget(), and on T_slow and T_fast arrays. - */ --void update_thr_responsiveness_params(struct bfq_data *bfqd) -+static void update_thr_responsiveness_params(struct bfq_data *bfqd) - { - int dev_type = blk_queue_nonrot(bfqd->queue); - -@@ -2333,7 +2386,7 @@ void update_thr_responsiveness_params(struct bfq_data *bfqd) - BFQ_RATE_SHIFT); - } - --void bfq_reset_rate_computation(struct bfq_data *bfqd, struct request *rq) -+static void bfq_reset_rate_computation(struct bfq_data *bfqd, struct request *rq) - { - if (rq != NULL) { /* new rq dispatch now, reset accordingly */ - bfqd->last_dispatch = bfqd->first_dispatch = ktime_get_ns() ; -@@ -2350,7 +2403,7 @@ void bfq_reset_rate_computation(struct bfq_data *bfqd, struct request *rq) - bfqd->tot_sectors_dispatched); - } - --void bfq_update_rate_reset(struct bfq_data *bfqd, struct request *rq) -+static void bfq_update_rate_reset(struct bfq_data *bfqd, struct request *rq) - { - u32 rate, weight, divisor; - -@@ -2400,7 +2453,7 @@ void bfq_update_rate_reset(struct bfq_data *bfqd, struct request *rq) - * total, and rate is below the current estimated peak rate - * - rate is unreasonably high (> 20M sectors/sec) - */ -- if ((bfqd->peak_rate_samples > (3 * bfqd->sequential_samples)>>2 && -+ if ((bfqd->sequential_samples < (3 * bfqd->peak_rate_samples)>>2 && - rate <= bfqd->peak_rate) || - rate > 20<fifo)) -- return NULL; -- -- rq = rq_entry_fifo(bfqq->fifo.next); -- -- if (ktime_get_ns() < rq->fifo_time) -- return NULL; -- -- return rq; --} -- - static void __bfq_bfqq_expire(struct bfq_data *bfqd, struct bfq_queue *bfqq) - { - BUG_ON(bfqq != bfqd->in_service_queue); -@@ -2904,8 +2934,8 @@ static bool bfq_bfqq_is_slow(struct bfq_data *bfqd, struct bfq_queue *bfqq, - delta_ktime = ktime_sub(delta_ktime, bfqd->last_budget_start); - delta_usecs = ktime_to_us(delta_ktime); - -- /* don't trust short/unrealistic values. */ -- if (delta_usecs < 1000 || delta_usecs >= LONG_MAX) { -+ /* don't use too short time intervals */ -+ if (delta_usecs < 1000) { - if (blk_queue_nonrot(bfqd->queue)) - /* - * give same worst-case guarantees as idling -@@ -2915,7 +2945,7 @@ static bool bfq_bfqq_is_slow(struct bfq_data *bfqd, struct bfq_queue *bfqq, - else /* charge at least one seek */ - *delta_ms = bfq_slice_idle / NSEC_PER_MSEC; - -- bfq_log(bfqd, "bfq_bfqq_is_slow: unrealistic %u", delta_usecs); -+ bfq_log(bfqd, "bfq_bfqq_is_slow: too short %u", delta_usecs); - - return slow; - } -@@ -3067,6 +3097,7 @@ static void bfq_bfqq_expire(struct bfq_data *bfqd, - bool slow; - unsigned long delta = 0; - struct bfq_entity *entity = &bfqq->entity; -+ int ref; - - BUG_ON(bfqq != bfqd->in_service_queue); - -@@ -3174,12 +3205,15 @@ static void bfq_bfqq_expire(struct bfq_data *bfqd, - __bfq_bfqq_recalc_budget(bfqd, bfqq, reason); - BUG_ON(bfqq->next_rq == NULL && - bfqq->entity.budget < bfqq->entity.service); -+ ref = bfqq->ref; - __bfq_bfqq_expire(bfqd, bfqq); - -- BUG_ON(!bfq_bfqq_busy(bfqq) && reason == BFQ_BFQQ_BUDGET_EXHAUSTED && -+ BUG_ON(ref > 1 && -+ !bfq_bfqq_busy(bfqq) && reason == BFQ_BFQQ_BUDGET_EXHAUSTED && - !bfq_class_idle(bfqq)); - -- if (!bfq_bfqq_busy(bfqq) && -+ /* mark bfqq as waiting a request only if a bic still points to it */ -+ if (ref > 1 && !bfq_bfqq_busy(bfqq) && - reason != BFQ_BFQQ_BUDGET_TIMEOUT && - reason != BFQ_BFQQ_BUDGET_EXHAUSTED) - bfq_mark_bfqq_non_blocking_wait_rq(bfqq); -@@ -3504,14 +3538,29 @@ static struct bfq_queue *bfq_select_queue(struct bfq_data *bfqd) - !bfq_bfqq_must_idle(bfqq)) - goto expire; - -+check_queue: -+ /* -+ * This loop is rarely executed more than once. Even when it -+ * happens, it is much more convenient to re-execute this loop -+ * than to return NULL and trigger a new dispatch to get a -+ * request served. -+ */ - next_rq = bfqq->next_rq; - /* - * If bfqq has requests queued and it has enough budget left to - * serve them, keep the queue, otherwise expire it. - */ - if (next_rq) { -+ BUG_ON(RB_EMPTY_ROOT(&bfqq->sort_list)); -+ - if (bfq_serv_to_charge(next_rq, bfqq) > - bfq_bfqq_budget_left(bfqq)) { -+ /* -+ * Expire the queue for budget exhaustion, -+ * which makes sure that the next budget is -+ * enough to serve the next request, even if -+ * it comes from the fifo expired path. -+ */ - reason = BFQ_BFQQ_BUDGET_EXHAUSTED; - goto expire; - } else { -@@ -3559,9 +3608,16 @@ static struct bfq_queue *bfq_select_queue(struct bfq_data *bfqd) - bfq_bfqq_expire(bfqd, bfqq, false, reason); - new_queue: - bfqq = bfq_set_in_service_queue(bfqd); -- bfq_log(bfqd, "select_queue: new queue %d returned", -- bfqq ? bfqq->pid : 0); -+ if (bfqq) { -+ bfq_log_bfqq(bfqd, bfqq, "select_queue: checking new queue"); -+ goto check_queue; -+ } - keep_queue: -+ if (bfqq) -+ bfq_log_bfqq(bfqd, bfqq, "select_queue: returned this queue"); -+ else -+ bfq_log(bfqd, "select_queue: no queue returned"); -+ - return bfqq; - } - -@@ -3627,45 +3683,17 @@ static int bfq_dispatch_request(struct bfq_data *bfqd, - struct bfq_queue *bfqq) - { - int dispatched = 0; -- struct request *rq; -+ struct request *rq = bfqq->next_rq; - unsigned long service_to_charge; - - BUG_ON(RB_EMPTY_ROOT(&bfqq->sort_list)); -- -- /* Follow expired path, else get first next available. */ -- rq = bfq_check_fifo(bfqq); -- if (!rq) -- rq = bfqq->next_rq; -+ BUG_ON(!rq); - service_to_charge = bfq_serv_to_charge(rq, bfqq); - -- if (service_to_charge > bfq_bfqq_budget_left(bfqq)) { -- /* -- * This may happen if the next rq is chosen in fifo order -- * instead of sector order. The budget is properly -- * dimensioned to be always sufficient to serve the next -- * request only if it is chosen in sector order. The reason -- * is that it would be quite inefficient and little useful -- * to always make sure that the budget is large enough to -- * serve even the possible next rq in fifo order. -- * In fact, requests are seldom served in fifo order. -- * -- * Expire the queue for budget exhaustion, and make sure -- * that the next act_budget is enough to serve the next -- * request, even if it comes from the fifo expired path. -- */ -- bfqq->next_rq = rq; -- /* -- * Since this dispatch is failed, make sure that -- * a new one will be performed -- */ -- if (!bfqd->rq_in_driver) -- bfq_schedule_dispatch(bfqd); -- BUG_ON(bfqq->entity.budget < bfqq->entity.service); -- goto expire; -- } -+ BUG_ON(service_to_charge > bfq_bfqq_budget_left(bfqq)); - - BUG_ON(bfqq->entity.budget < bfqq->entity.service); -- /* Finally, insert request into driver dispatch list. */ -+ - bfq_bfqq_served(bfqq, service_to_charge); - - BUG_ON(bfqq->entity.budget < bfqq->entity.service); -@@ -3805,7 +3833,8 @@ static int bfq_dispatch_requests(struct request_queue *q, int force) - * Task holds one reference to the queue, dropped when task exits. Each rq - * in-flight on this queue also holds a reference, dropped when rq is freed. - * -- * Queue lock must be held here. -+ * Queue lock must be held here. Recall not to use bfqq after calling -+ * this function on it. - */ - static void bfq_put_queue(struct bfq_queue *bfqq) - { -@@ -3874,7 +3903,7 @@ static void bfq_exit_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq) - - bfq_put_cooperator(bfqq); - -- bfq_put_queue(bfqq); -+ bfq_put_queue(bfqq); /* release process reference */ - } - - static void bfq_init_icq(struct io_cq *icq) -@@ -3973,6 +4002,7 @@ static void bfq_check_ioprio_change(struct bfq_io_cq *bic, struct bio *bio) - - bfqq = bic_to_bfqq(bic, false); - if (bfqq) { -+ /* release process reference on this queue */ - bfq_put_queue(bfqq); - bfqq = bfq_get_queue(bfqd, bio, BLK_RW_ASYNC, bic); - bic_set_bfqq(bic, bfqq, false); -@@ -4093,14 +4123,20 @@ static struct bfq_queue *bfq_get_queue(struct bfq_data *bfqd, - * prune it. - */ - if (async_bfqq) { -- bfqq->ref++; -+ bfqq->ref++; /* -+ * Extra group reference, w.r.t. sync -+ * queue. This extra reference is removed -+ * only if bfqq->bfqg disappears, to -+ * guarantee that this queue is not freed -+ * until its group goes away. -+ */ - bfq_log_bfqq(bfqd, bfqq, "get_queue, bfqq not in async: %p, %d", - bfqq, bfqq->ref); - *async_bfqq = bfqq; - } - - out: -- bfqq->ref++; -+ bfqq->ref++; /* get a process reference to this queue */ - bfq_log_bfqq(bfqd, bfqq, "get_queue, at end: %p, %d", bfqq, bfqq->ref); - rcu_read_unlock(); - return bfqq; -@@ -4274,10 +4310,14 @@ static void bfq_insert_request(struct request_queue *q, struct request *rq) - bfqq->allocated[rq_data_dir(rq)]--; - new_bfqq->ref++; - bfq_clear_bfqq_just_created(bfqq); -- bfq_put_queue(bfqq); - if (bic_to_bfqq(RQ_BIC(rq), 1) == bfqq) - bfq_merge_bfqqs(bfqd, RQ_BIC(rq), - bfqq, new_bfqq); -+ /* -+ * rq is about to be enqueued into new_bfqq, -+ * release rq reference on bfqq -+ */ -+ bfq_put_queue(bfqq); - rq->elv.priv[1] = new_bfqq; - bfqq = new_bfqq; - } -@@ -4697,9 +4737,8 @@ static void bfq_shutdown_timer_wq(struct bfq_data *bfqd) - cancel_work_sync(&bfqd->unplug_work); - } - --#ifdef CONFIG_BFQ_GROUP_IOSCHED - static void __bfq_put_async_bfqq(struct bfq_data *bfqd, -- struct bfq_queue **bfqq_ptr) -+ struct bfq_queue **bfqq_ptr) - { - struct bfq_group *root_group = bfqd->root_group; - struct bfq_queue *bfqq = *bfqq_ptr; -@@ -4730,7 +4769,6 @@ static void bfq_put_async_queues(struct bfq_data *bfqd, struct bfq_group *bfqg) - - __bfq_put_async_bfqq(bfqd, &bfqg->async_idle_bfqq); - } --#endif - - static void bfq_exit_queue(struct elevator_queue *e) - { -@@ -4755,6 +4793,7 @@ static void bfq_exit_queue(struct elevator_queue *e) - #ifdef CONFIG_BFQ_GROUP_IOSCHED - blkcg_deactivate_policy(q, &blkcg_policy_bfq); - #else -+ bfq_put_async_queues(bfqd, bfqd->root_group); - kfree(bfqd->root_group); - #endif - -@@ -5229,7 +5268,7 @@ static struct blkcg_policy blkcg_policy_bfq = { - static int __init bfq_init(void) - { - int ret; -- char msg[60] = "BFQ I/O-scheduler: v8r7"; -+ char msg[60] = "BFQ I/O-scheduler: v8r10"; - - #ifdef CONFIG_BFQ_GROUP_IOSCHED - ret = blkcg_policy_register(&blkcg_policy_bfq); -@@ -5255,7 +5294,7 @@ static int __init bfq_init(void) - * be run for a long time. - */ - T_slow[0] = msecs_to_jiffies(3500); /* actually 4 sec */ -- T_slow[1] = msecs_to_jiffies(1000); /* actually 1.5 sec */ -+ T_slow[1] = msecs_to_jiffies(6000); /* actually 6.5 sec */ - T_fast[0] = msecs_to_jiffies(7000); /* actually 8 sec */ - T_fast[1] = msecs_to_jiffies(2500); /* actually 3 sec */ - -diff --git a/block/bfq-sched.c b/block/bfq-sched.c -index 797bce7..70aac56 100644 ---- a/block/bfq-sched.c -+++ b/block/bfq-sched.c -@@ -154,7 +154,13 @@ static bool bfq_update_next_in_service(struct bfq_sched_data *sd, - #define for_each_entity(entity) \ - for (; entity ; entity = entity->parent) - --#define for_each_entity_safe(entity, parent) \ -+/* -+ * For each iteration, compute parent in advance, so as to be safe if -+ * entity is deallocated during the iteration. Such a deallocation may -+ * happen as a consequence of a bfq_put_queue that frees the bfq_queue -+ * containing entity. -+ */ -+#define for_each_entity_safe(entity, parent) \ - for (; entity && ({ parent = entity->parent; 1; }); entity = parent) - - /* -@@ -691,27 +697,31 @@ static void bfq_idle_insert(struct bfq_service_tree *st, - } - - /** -- * bfq_forget_entity - remove an entity from the wfq trees. -+ * bfq_forget_entity - do not consider entity any longer for scheduling - * @st: the service tree. - * @entity: the entity being removed. -+ * @is_in_service: true if entity is currently the in-service entity. - * -- * Update the device status and forget everything about @entity, putting -- * the device reference to it, if it is a queue. Entities belonging to -- * groups are not refcounted. -+ * Forget everything about @entity. In addition, if entity represents -+ * a queue, and the latter is not in service, then release the service -+ * reference to the queue (the one taken through bfq_get_entity). In -+ * fact, in this case, there is really no more service reference to -+ * the queue, as the latter is also outside any service tree. If, -+ * instead, the queue is in service, then __bfq_bfqd_reset_in_service -+ * will take care of putting the reference when the queue finally -+ * stops being served. - */ - static void bfq_forget_entity(struct bfq_service_tree *st, -- struct bfq_entity *entity) -+ struct bfq_entity *entity, -+ bool is_in_service) - { - struct bfq_queue *bfqq = bfq_entity_to_bfqq(entity); -- struct bfq_sched_data *sd; -- - BUG_ON(!entity->on_st); - - entity->on_st = false; - st->wsum -= entity->weight; -- if (bfqq) { -- sd = entity->sched_data; -- bfq_log_bfqq(bfqq->bfqd, bfqq, "forget_entity: %p %d", -+ if (bfqq && !is_in_service) { -+ bfq_log_bfqq(bfqq->bfqd, bfqq, "forget_entity (before): %p %d", - bfqq, bfqq->ref); - bfq_put_queue(bfqq); - } -@@ -726,7 +736,8 @@ static void bfq_put_idle_entity(struct bfq_service_tree *st, - struct bfq_entity *entity) - { - bfq_idle_extract(st, entity); -- bfq_forget_entity(st, entity); -+ bfq_forget_entity(st, entity, -+ entity == entity->sched_data->in_service_entity); - } - - /** -@@ -1082,6 +1093,12 @@ static void __bfq_activate_entity(struct bfq_entity *entity, - */ - entity->start = min_vstart; - st->wsum += entity->weight; -+ /* -+ * entity is about to be inserted into a service tree, -+ * and then set in service: get a reference to make -+ * sure entity does not disappear until it is no -+ * longer in service or scheduled for service. -+ */ - bfq_get_entity(entity); - - BUG_ON(entity->on_st && bfqq); -@@ -1264,27 +1281,27 @@ static bool __bfq_deactivate_entity(struct bfq_entity *entity, - { - struct bfq_sched_data *sd = entity->sched_data; - struct bfq_service_tree *st = bfq_entity_service_tree(entity); -- bool was_in_service = entity == sd->in_service_entity; -+ bool is_in_service = entity == sd->in_service_entity; - - if (!entity->on_st) { /* entity never activated, or already inactive */ - BUG_ON(entity == entity->sched_data->in_service_entity); - return false; - } - -- BUG_ON(was_in_service && entity->tree && entity->tree != &st->active); -+ BUG_ON(is_in_service && entity->tree && entity->tree != &st->active); - -- if (was_in_service) -+ if (is_in_service) - bfq_calc_finish(entity, entity->service); - - if (entity->tree == &st->active) - bfq_active_extract(st, entity); -- else if (!was_in_service && entity->tree == &st->idle) -+ else if (!is_in_service && entity->tree == &st->idle) - bfq_idle_extract(st, entity); - else if (entity->tree) - BUG(); - - if (!ins_into_idle_tree || !bfq_gt(entity->finish, st->vtime)) -- bfq_forget_entity(st, entity); -+ bfq_forget_entity(st, entity, is_in_service); - else - bfq_idle_insert(st, entity); - -@@ -1301,7 +1318,7 @@ static void bfq_deactivate_entity(struct bfq_entity *entity, - bool expiration) - { - struct bfq_sched_data *sd; -- struct bfq_entity *parent; -+ struct bfq_entity *parent = NULL; - - for_each_entity_safe(entity, parent) { - sd = entity->sched_data; -@@ -1320,8 +1337,8 @@ static void bfq_deactivate_entity(struct bfq_entity *entity, - - if (!__bfq_deactivate_entity(entity, ins_into_idle_tree)) { - /* -- * Entity is not any tree any more, so, this -- * deactivation is a no-op, and there is -+ * entity is not in any tree any more, so -+ * this deactivation is a no-op, and there is - * nothing to change for upper-level entities - * (in case of expiration, this can never - * happen). -@@ -1821,14 +1838,16 @@ static struct bfq_queue *bfq_get_next_queue(struct bfq_data *bfqd) - - static void __bfq_bfqd_reset_in_service(struct bfq_data *bfqd) - { -- struct bfq_entity *entity = &bfqd->in_service_queue->entity; -+ struct bfq_queue *in_serv_bfqq = bfqd->in_service_queue; -+ struct bfq_entity *in_serv_entity = &in_serv_bfqq->entity; -+ struct bfq_entity *entity = in_serv_entity; - - if (bfqd->in_service_bic) { - put_io_context(bfqd->in_service_bic->icq.ioc); - bfqd->in_service_bic = NULL; - } - -- bfq_clear_bfqq_wait_request(bfqd->in_service_queue); -+ bfq_clear_bfqq_wait_request(in_serv_bfqq); - hrtimer_try_to_cancel(&bfqd->idle_slice_timer); - bfqd->in_service_queue = NULL; - -@@ -1840,6 +1859,14 @@ static void __bfq_bfqd_reset_in_service(struct bfq_data *bfqd) - */ - for_each_entity(entity) - entity->sched_data->in_service_entity = NULL; -+ -+ /* -+ * in_serv_entity is no longer in service, so, if it is in no -+ * service tree either, then release the service reference to -+ * the queue it represents (taken with bfq_get_entity). -+ */ -+ if (!in_serv_entity->on_st) -+ bfq_put_queue(in_serv_bfqq); - } - - static void bfq_deactivate_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq, -@@ -1904,8 +1931,6 @@ static void bfq_del_bfqq_busy(struct bfq_data *bfqd, struct bfq_queue *bfqq, - BUG_ON(bfqq->entity.budget < 0); - - bfq_deactivate_bfqq(bfqd, bfqq, true, expiration); -- -- BUG_ON(bfqq->entity.budget < 0); - } - - /* -diff --git a/block/bfq.h b/block/bfq.h -index a9da002..e3855af 100644 ---- a/block/bfq.h -+++ b/block/bfq.h -@@ -1,5 +1,5 @@ - /* -- * BFQ v8r7 for 4.9.0: data structures and common functions prototypes. -+ * BFQ v8r10 for 4.9.0: data structures and common functions prototypes. - * - * Based on ideas and code from CFQ: - * Copyright (C) 2003 Jens Axboe -@@ -9,7 +9,7 @@ - * - * Copyright (C) 2015 Paolo Valente - * -- * Copyright (C) 2016 Paolo Valente -+ * Copyright (C) 2017 Paolo Valente - */ - - #ifndef _BFQ_H diff --git a/kernel/tools/cpupowertools/files/patches/mageia/char-tmp-tpm_crb-fix-Intel-PTT-hw-bug-during-idle-state.patch b/kernel/tools/cpupowertools/files/patches/mageia/char-tmp-tpm_crb-fix-Intel-PTT-hw-bug-during-idle-state.patch deleted file mode 100644 index 767ccd9a..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/char-tmp-tpm_crb-fix-Intel-PTT-hw-bug-during-idle-state.patch +++ /dev/null @@ -1,115 +0,0 @@ -From bc33c5df710c0aae6db396146194108634ef6f60 Mon Sep 17 00:00:00 2001 -From: "Winkler, Tomas" -Date: Mon, 12 Sep 2016 16:04:19 +0300 -Subject: [PATCH] tmp/tpm_crb: fix Intel PTT hw bug during idle state - -There is a HW bug in Skylake, and Broxton PCH Intel PTT device, where -most of the registers in the control area except START, REQUEST, CANCEL, -and LOC_CTRL lost retention when the device is in the idle state. Hence -we need to bring the device to ready state before accessing the other -registers. The fix brings device to ready state before trying to read -command and response buffer addresses in order to remap the for access. - -Signed-off-by: Tomas Winkler -Tested-by: Jarkko Sakkinen -Reviewed-by: Jarkko Sakkinen -Signed-off-by: Jarkko Sakkinen ---- - drivers/char/tpm/tpm_crb.c | 47 ++++++++++++++++++++++++++++++++++++++-------- - 1 file changed, 39 insertions(+), 8 deletions(-) - -diff --git a/drivers/char/tpm/tpm_crb.c b/drivers/char/tpm/tpm_crb.c -index 8dd0f20..ff0d505 100644 ---- a/drivers/char/tpm/tpm_crb.c -+++ b/drivers/char/tpm/tpm_crb.c -@@ -315,6 +315,7 @@ static int crb_map_io(struct acpi_device *device, struct crb_priv *priv, - struct list_head resources; - struct resource io_res; - struct device *dev = &device->dev; -+ u32 pa_high, pa_low; - u64 cmd_pa; - u32 cmd_size; - u64 rsp_pa; -@@ -342,12 +343,27 @@ static int crb_map_io(struct acpi_device *device, struct crb_priv *priv, - if (IS_ERR(priv->cca)) - return PTR_ERR(priv->cca); - -- cmd_pa = ((u64) ioread32(&priv->cca->cmd_pa_high) << 32) | -- (u64) ioread32(&priv->cca->cmd_pa_low); -+ /* -+ * PTT HW bug w/a: wake up the device to access -+ * possibly not retained registers. -+ */ -+ ret = crb_cmd_ready(dev, priv); -+ if (ret) -+ return ret; -+ -+ pa_high = ioread32(&priv->cca->cmd_pa_high); -+ pa_low = ioread32(&priv->cca->cmd_pa_low); -+ cmd_pa = ((u64)pa_high << 32) | pa_low; - cmd_size = ioread32(&priv->cca->cmd_size); -+ -+ dev_dbg(dev, "cmd_hi = %X cmd_low = %X cmd_size %X\n", -+ pa_high, pa_low, cmd_size); -+ - priv->cmd = crb_map_res(dev, priv, &io_res, cmd_pa, cmd_size); -- if (IS_ERR(priv->cmd)) -- return PTR_ERR(priv->cmd); -+ if (IS_ERR(priv->cmd)) { -+ ret = PTR_ERR(priv->cmd); -+ goto out; -+ } - - memcpy_fromio(&rsp_pa, &priv->cca->rsp_pa, 8); - rsp_pa = le64_to_cpu(rsp_pa); -@@ -355,7 +371,8 @@ static int crb_map_io(struct acpi_device *device, struct crb_priv *priv, - - if (cmd_pa != rsp_pa) { - priv->rsp = crb_map_res(dev, priv, &io_res, rsp_pa, rsp_size); -- return PTR_ERR_OR_ZERO(priv->rsp); -+ ret = PTR_ERR_OR_ZERO(priv->rsp); -+ goto out; - } - - /* According to the PTP specification, overlapping command and response -@@ -363,12 +380,18 @@ static int crb_map_io(struct acpi_device *device, struct crb_priv *priv, - */ - if (cmd_size != rsp_size) { - dev_err(dev, FW_BUG "overlapping command and response buffer sizes are not identical"); -- return -EINVAL; -+ ret = -EINVAL; -+ goto out; - } -+ - priv->cmd_size = cmd_size; - - priv->rsp = priv->cmd; -- return 0; -+ -+out: -+ crb_go_idle(dev, priv); -+ -+ return ret; - } - - static int crb_acpi_add(struct acpi_device *device) -@@ -412,7 +435,15 @@ static int crb_acpi_add(struct acpi_device *device) - if (rc) - return rc; - -- return crb_init(device, priv); -+ rc = crb_cmd_ready(dev, priv); -+ if (rc) -+ return rc; -+ -+ rc = crb_init(device, priv); -+ if (rc) -+ crb_go_idle(dev, priv); -+ -+ return rc; - } - - static int crb_acpi_remove(struct acpi_device *device) --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/char-tmp-tpm_crb-implement-runtime-pm-for-tpm_crb.patch b/kernel/tools/cpupowertools/files/patches/mageia/char-tmp-tpm_crb-implement-runtime-pm-for-tpm_crb.patch deleted file mode 100644 index c4953345..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/char-tmp-tpm_crb-implement-runtime-pm-for-tpm_crb.patch +++ /dev/null @@ -1,134 +0,0 @@ -From e74f2f76c13770bb8e004475a933923e9c92723d Mon Sep 17 00:00:00 2001 -From: "Winkler, Tomas" -Date: Sat, 8 Oct 2016 14:59:39 +0300 -Subject: [PATCH] tmp/tpm_crb: implement runtime pm for tpm_crb - -Utilize runtime_pm for driving tpm crb idle states. -The framework calls cmd_ready from the pm_runtime_resume handler -and go idle from the pm_runtime_suspend handler. -The TPM framework should wake the device before transmit and receive. -In case the runtime_pm framework is not compiled in or enabled, the device -will be in the permanent ready state. - -Signed-off-by: Tomas Winkler -Reviewed-by: Jarkko Sakkinen -Tested-by: Jarkko Sakkinen -Signed-off-by: Jarkko Sakkinen ---- - drivers/char/tpm/tpm-interface.c | 5 +++++ - drivers/char/tpm/tpm_crb.c | 42 ++++++++++++++++++++++++++++++++++++---- - 2 files changed, 43 insertions(+), 4 deletions(-) - -diff --git a/drivers/char/tpm/tpm-interface.c b/drivers/char/tpm/tpm-interface.c -index 3a9149c..cb0e57e 100644 ---- a/drivers/char/tpm/tpm-interface.c -+++ b/drivers/char/tpm/tpm-interface.c -@@ -29,6 +29,7 @@ - #include - #include - #include -+#include - - #include "tpm.h" - #include "tpm_eventlog.h" -@@ -356,6 +357,8 @@ ssize_t tpm_transmit(struct tpm_chip *chip, const u8 *buf, size_t bufsiz, - if (!(flags & TPM_TRANSMIT_UNLOCKED)) - mutex_lock(&chip->tpm_mutex); - -+ pm_runtime_get_sync(chip->dev.parent); -+ - rc = chip->ops->send(chip, (u8 *) buf, count); - if (rc < 0) { - dev_err(&chip->dev, -@@ -397,6 +400,8 @@ ssize_t tpm_transmit(struct tpm_chip *chip, const u8 *buf, size_t bufsiz, - dev_err(&chip->dev, - "tpm_transmit: tpm_recv: error %zd\n", rc); - out: -+ pm_runtime_put_sync(chip->dev.parent); -+ - if (!(flags & TPM_TRANSMIT_UNLOCKED)) - mutex_unlock(&chip->tpm_mutex); - return rc; -diff --git a/drivers/char/tpm/tpm_crb.c b/drivers/char/tpm/tpm_crb.c -index f579f1a..717b6b4 100644 ---- a/drivers/char/tpm/tpm_crb.c -+++ b/drivers/char/tpm/tpm_crb.c -@@ -19,6 +19,7 @@ - #include - #include - #include -+#include - #include "tpm.h" - - #define ACPI_SIG_TPM2 "TPM2" -@@ -149,8 +150,6 @@ static int __maybe_unused crb_cmd_ready(struct device *dev, - return 0; - } - --static SIMPLE_DEV_PM_OPS(crb_pm, tpm_pm_suspend, tpm_pm_resume); -- - static u8 crb_status(struct tpm_chip *chip) - { - struct crb_priv *priv = dev_get_drvdata(&chip->dev); -@@ -433,11 +432,21 @@ static int crb_acpi_add(struct acpi_device *device) - if (rc) - return rc; - -+ pm_runtime_get_noresume(dev); -+ pm_runtime_set_active(dev); -+ pm_runtime_enable(dev); -+ - rc = tpm_chip_register(chip); -- if (rc) -+ if (rc) { - crb_go_idle(dev, priv); -+ pm_runtime_put_noidle(dev); -+ pm_runtime_disable(dev); -+ return rc; -+ } - -- return rc; -+ pm_runtime_put(dev); -+ -+ return 0; - } - - static int crb_acpi_remove(struct acpi_device *device) -@@ -447,9 +456,34 @@ static int crb_acpi_remove(struct acpi_device *device) - - tpm_chip_unregister(chip); - -+ pm_runtime_disable(dev); -+ - return 0; - } - -+#ifdef CONFIG_PM -+static int crb_pm_runtime_suspend(struct device *dev) -+{ -+ struct tpm_chip *chip = dev_get_drvdata(dev); -+ struct crb_priv *priv = dev_get_drvdata(&chip->dev); -+ -+ return crb_go_idle(dev, priv); -+} -+ -+static int crb_pm_runtime_resume(struct device *dev) -+{ -+ struct tpm_chip *chip = dev_get_drvdata(dev); -+ struct crb_priv *priv = dev_get_drvdata(&chip->dev); -+ -+ return crb_cmd_ready(dev, priv); -+} -+#endif /* CONFIG_PM */ -+ -+static const struct dev_pm_ops crb_pm = { -+ SET_SYSTEM_SLEEP_PM_OPS(tpm_pm_suspend, tpm_pm_resume) -+ SET_RUNTIME_PM_OPS(crb_pm_runtime_suspend, crb_pm_runtime_resume, NULL) -+}; -+ - static struct acpi_device_id crb_device_ids[] = { - {"MSFT0101", 0}, - {"", 0}, --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/char-tpm-tpm_crb-implement-tpm-crb-idle-state.patch b/kernel/tools/cpupowertools/files/patches/mageia/char-tpm-tpm_crb-implement-tpm-crb-idle-state.patch deleted file mode 100644 index 5ba21308..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/char-tpm-tpm_crb-implement-tpm-crb-idle-state.patch +++ /dev/null @@ -1,111 +0,0 @@ -From ba5287b6ef6a2ee91dc6cc0829649cecf7b70253 Mon Sep 17 00:00:00 2001 -From: "Winkler, Tomas" -Date: Thu, 15 Sep 2016 10:27:38 +0300 -Subject: [PATCH] tpm/tpm_crb: implement tpm crb idle state - -The register TPM_CRB_CTRL_REQ_x contains bits goIdle and cmdReady for -SW to indicate that the device can enter or should exit the idle state. - -The legacy ACPI-start (SMI + DMA) based devices do not support these -bits and the idle state management is not exposed to the host SW. -Thus, this functionality only is enabled only for a CRB start (MMIO) -based devices. - -Based on Jarkko Sakkinen -original patch: -'tpm_crb: implement power tpm crb power management' - -To keep the implementation local to the hw we don't use wait_for_tpm_stat -for polling the TPM_CRB_CTRL_REQ. - -[jarkko.sakkinen@linux.intel.com: removed cmdReady debug trace on a - success case due the heavy amount of log traffic it causes.] - -Signed-off-by: Tomas Winkler -Reviewed-by: Jarkko Sakkinen -Tested-by: Jarkko Sakkinen -Signed-off-by: Jarkko Sakkinen ---- - drivers/char/tpm/tpm_crb.c | 66 ++++++++++++++++++++++++++++++++++++++++++++++ - 1 file changed, 66 insertions(+) - -diff --git a/drivers/char/tpm/tpm_crb.c b/drivers/char/tpm/tpm_crb.c -index a7c870a..8dd0f20 100644 ---- a/drivers/char/tpm/tpm_crb.c -+++ b/drivers/char/tpm/tpm_crb.c -@@ -83,6 +83,72 @@ struct crb_priv { - u32 cmd_size; - }; - -+/** -+ * crb_go_idle - request tpm crb device to go the idle state -+ * -+ * @dev: crb device -+ * @priv: crb private data -+ * -+ * Write CRB_CTRL_REQ_GO_IDLE to TPM_CRB_CTRL_REQ -+ * The device should respond within TIMEOUT_C by clearing the bit. -+ * Anyhow, we do not wait here as a consequent CMD_READY request -+ * will be handled correctly even if idle was not completed. -+ * -+ * The function does nothing for devices with ACPI-start method. -+ * -+ * Return: 0 always -+ */ -+static int __maybe_unused crb_go_idle(struct device *dev, struct crb_priv *priv) -+{ -+ if (priv->flags & CRB_FL_ACPI_START) -+ return 0; -+ -+ iowrite32(CRB_CTRL_REQ_GO_IDLE, &priv->cca->req); -+ /* we don't really care when this settles */ -+ -+ return 0; -+} -+ -+/** -+ * crb_cmd_ready - request tpm crb device to enter ready state -+ * -+ * @dev: crb device -+ * @priv: crb private data -+ * -+ * Write CRB_CTRL_REQ_CMD_READY to TPM_CRB_CTRL_REQ -+ * and poll till the device acknowledge it by clearing the bit. -+ * The device should respond within TIMEOUT_C. -+ * -+ * The function does nothing for devices with ACPI-start method -+ * -+ * Return: 0 on success -ETIME on timeout; -+ */ -+static int __maybe_unused crb_cmd_ready(struct device *dev, -+ struct crb_priv *priv) -+{ -+ ktime_t stop, start; -+ -+ if (priv->flags & CRB_FL_ACPI_START) -+ return 0; -+ -+ iowrite32(CRB_CTRL_REQ_CMD_READY, &priv->cca->req); -+ -+ start = ktime_get(); -+ stop = ktime_add(start, ms_to_ktime(TPM2_TIMEOUT_C)); -+ do { -+ if (!(ioread32(&priv->cca->req) & CRB_CTRL_REQ_CMD_READY)) -+ return 0; -+ usleep_range(50, 100); -+ } while (ktime_before(ktime_get(), stop)); -+ -+ if (ioread32(&priv->cca->req) & CRB_CTRL_REQ_CMD_READY) { -+ dev_warn(dev, "cmdReady timed out\n"); -+ return -ETIME; -+ } -+ -+ return 0; -+} -+ - static SIMPLE_DEV_PM_OPS(crb_pm, tpm_pm_suspend, tpm_pm_resume); - - static u8 crb_status(struct tpm_chip *chip) --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/char-tpm-tpm_crb-open-code-the-crb_init-into-acpi_add.patch b/kernel/tools/cpupowertools/files/patches/mageia/char-tpm-tpm_crb-open-code-the-crb_init-into-acpi_add.patch deleted file mode 100644 index b4e47ae1..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/char-tpm-tpm_crb-open-code-the-crb_init-into-acpi_add.patch +++ /dev/null @@ -1,75 +0,0 @@ -From c58bd34cec4c05f8e3362a79ae94de9f405c39b5 Mon Sep 17 00:00:00 2001 -From: "Winkler, Tomas" -Date: Mon, 12 Sep 2016 16:04:20 +0300 -Subject: [PATCH] tpm/tpm_crb: open code the crb_init into acpi_add - -This is preparation step for implementing tpm crb -runtime pm. We need to have tpm chip allocated -and populated before we access the runtime handlers. - -Signed-off-by: Tomas Winkler -Reviewed-by: Jarkko Sakkinen -Tested-by: Jarkko Sakkinen -Signed-off-by: Jarkko Sakkinen ---- - drivers/char/tpm/tpm_crb.c | 26 ++++++++++---------------- - 1 file changed, 10 insertions(+), 16 deletions(-) - -diff --git a/drivers/char/tpm/tpm_crb.c b/drivers/char/tpm/tpm_crb.c -index ff0d505..f579f1a 100644 ---- a/drivers/char/tpm/tpm_crb.c -+++ b/drivers/char/tpm/tpm_crb.c -@@ -262,21 +262,6 @@ static const struct tpm_class_ops tpm_crb = { - .req_complete_val = CRB_DRV_STS_COMPLETE, - }; - --static int crb_init(struct acpi_device *device, struct crb_priv *priv) --{ -- struct tpm_chip *chip; -- -- chip = tpmm_chip_alloc(&device->dev, &tpm_crb); -- if (IS_ERR(chip)) -- return PTR_ERR(chip); -- -- dev_set_drvdata(&chip->dev, priv); -- chip->acpi_dev_handle = device->handle; -- chip->flags = TPM_CHIP_FLAG_TPM2; -- -- return tpm_chip_register(chip); --} -- - static int crb_check_resource(struct acpi_resource *ares, void *data) - { - struct resource *io_res = data; -@@ -398,6 +383,7 @@ static int crb_acpi_add(struct acpi_device *device) - { - struct acpi_table_tpm2 *buf; - struct crb_priv *priv; -+ struct tpm_chip *chip; - struct device *dev = &device->dev; - acpi_status status; - u32 sm; -@@ -435,11 +421,19 @@ static int crb_acpi_add(struct acpi_device *device) - if (rc) - return rc; - -+ chip = tpmm_chip_alloc(dev, &tpm_crb); -+ if (IS_ERR(chip)) -+ return PTR_ERR(chip); -+ -+ dev_set_drvdata(&chip->dev, priv); -+ chip->acpi_dev_handle = device->handle; -+ chip->flags = TPM_CHIP_FLAG_TPM2; -+ - rc = crb_cmd_ready(dev, priv); - if (rc) - return rc; - -- rc = crb_init(device, priv); -+ rc = tpm_chip_register(chip); - if (rc) - crb_go_idle(dev, priv); - --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/doc-block-bfq-update-max-IOPS-sustainable-with-BFQ.patch b/kernel/tools/cpupowertools/files/patches/mageia/doc-block-bfq-update-max-IOPS-sustainable-with-BFQ.patch new file mode 100644 index 00000000..41823486 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/doc-block-bfq-update-max-IOPS-sustainable-with-BFQ.patch @@ -0,0 +1,61 @@ +From 68017e5d87a2477d40476f1a0a06f202ee79316b Mon Sep 17 00:00:00 2001 +From: Paolo Valente +Date: Mon, 13 Nov 2017 07:34:07 +0100 +Subject: [PATCH] doc, block, bfq: update max IOPS sustainable with BFQ + +We have investigated more deeply the performance of BFQ, in terms of +number of IOPS that can be processed by the CPU when BFQ is used as +I/O scheduler. In more detail, using the script [1], we have measured +the number of IOPS reached on top of a null block device configured +with zero latency, as a function of the workload (sequential read, +sequential write, random read, random write) and of the system (we +considered desktops, laptops and embedded systems). + +Basing on the resulting figures, with this commit we update the +current, conservative IOPS range reported in BFQ documentation. In +particular, the documentation now reports, for each of three different +systems, the lowest number of IOPS obtained for that system with the +above test (namely, the value obtained with the workload leading to +the lowest IOPS). + +[1] https://github.com/Algodev-github/IOSpeed + +Reviewed-by: Lee Tibbert +Signed-off-by: Paolo Valente +Signed-off-by: Luca Miccio +Signed-off-by: Jens Axboe +--- + Documentation/block/bfq-iosched.txt | 17 +++++++++++------ + 1 file changed, 11 insertions(+), 6 deletions(-) + +diff --git a/Documentation/block/bfq-iosched.txt b/Documentation/block/bfq-iosched.txt +index 3d6951d63489..7a9361508157 100644 +--- a/Documentation/block/bfq-iosched.txt ++++ b/Documentation/block/bfq-iosched.txt +@@ -20,12 +20,17 @@ for that device, by setting low_latency to 0. See Section 3 for + details on how to configure BFQ for the desired tradeoff between + latency and throughput, or on how to maximize throughput. + +-On average CPUs, the current version of BFQ can handle devices +-performing at most ~30K IOPS; at most ~50 KIOPS on faster CPUs. As a +-reference, 30-50 KIOPS correspond to very high bandwidths with +-sequential I/O (e.g., 8-12 GB/s if I/O requests are 256 KB large), and +-to 120-200 MB/s with 4KB random I/O. BFQ is currently being tested on +-multi-queue devices too. ++BFQ has a non-null overhead, which limits the maximum IOPS that the ++CPU can process for a device scheduled with BFQ. To give an idea of ++the limits on slow or average CPUs, here are BFQ limits for three ++different CPUs, on, respectively, an average laptop, an old desktop, ++and a cheap embedded system, in case full hierarchical support is ++enabled (i.e., CONFIG_BFQ_GROUP_IOSCHED is set): ++- Intel i7-4850HQ: 250 KIOPS ++- AMD A8-3850: 170 KIOPS ++- ARM CortexTM-A53 Octa-core: 45 KIOPS ++ ++BFQ works for multi-queue devices too. + + The table of contents follow. Impatients can just jump to Section 3. + +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-4.14-modular.patch b/kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-4.14-modular.patch new file mode 100644 index 00000000..786c03ea --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-4.14-modular.patch @@ -0,0 +1,431 @@ + + fs/aufs/Kconfig | 2 +- + fs/dcache.c | 2 ++ + fs/exec.c | 1 + + fs/fcntl.c | 1 + + fs/file_table.c | 4 ++++ + fs/inode.c | 1 + + fs/namespace.c | 2 ++ + fs/notify/group.c | 4 ++++ + fs/notify/mark.c | 4 ++++ + fs/open.c | 2 ++ + fs/read_write.c | 4 ++++ + fs/splice.c | 2 ++ + fs/sync.c | 1 + + fs/xattr.c | 1 + + kernel/task_work.c | 1 + + security/commoncap.c | 2 ++ + security/device_cgroup.c | 2 ++ + security/security.c | 10 ++++++++++ + 18 files changed, 45 insertions(+), 1 deletion(-) + +diff -Nurp linux-4.14.14-aufs/fs/aufs/Kconfig linux-4.14.14-aufs.mod/fs/aufs/Kconfig +--- linux-4.14.14-aufs/fs/aufs/Kconfig 2018-01-17 11:17:42.191975391 +0200 ++++ linux-4.14.14-aufs.mod/fs/aufs/Kconfig 2018-01-17 11:18:22.784556755 +0200 +@@ -1,6 +1,6 @@ + # SPDX-License-Identifier: GPL-2.0 + config AUFS_FS +- bool "Aufs (Advanced multi layered unification filesystem) support" ++ tristate "Aufs (Advanced multi layered unification filesystem) support" + help + Aufs is a stackable unification filesystem such as Unionfs, + which unifies several directories and provides a merged single +diff -Nurp linux-4.14.14-aufs/fs/dcache.c linux-4.14.14-aufs.mod/fs/dcache.c +--- linux-4.14.14-aufs/fs/dcache.c 2018-01-17 11:17:42.200975519 +0200 ++++ linux-4.14.14-aufs.mod/fs/dcache.c 2018-01-17 11:18:22.784556755 +0200 +@@ -1305,6 +1305,7 @@ rename_retry: + seq = 1; + goto again; + } ++EXPORT_SYMBOL_GPL(d_walk); + + struct check_mount { + struct vfsmount *mnt; +@@ -2894,6 +2895,7 @@ void d_exchange(struct dentry *dentry1, + + write_sequnlock(&rename_lock); + } ++EXPORT_SYMBOL_GPL(d_exchange); + + /** + * d_ancestor - search for an ancestor +diff -Nurp linux-4.14.14-aufs/fs/exec.c linux-4.14.14-aufs.mod/fs/exec.c +--- linux-4.14.14-aufs/fs/exec.c 2018-01-17 11:08:18.957908605 +0200 ++++ linux-4.14.14-aufs.mod/fs/exec.c 2018-01-17 11:18:22.785556770 +0200 +@@ -109,6 +109,7 @@ bool path_noexec(const struct path *path + return (path->mnt->mnt_flags & MNT_NOEXEC) || + (path->mnt->mnt_sb->s_iflags & SB_I_NOEXEC); + } ++EXPORT_SYMBOL_GPL(path_noexec); + + #ifdef CONFIG_USELIB + /* +diff -Nurp linux-4.14.14-aufs/fs/fcntl.c linux-4.14.14-aufs.mod/fs/fcntl.c +--- linux-4.14.14-aufs/fs/fcntl.c 2018-01-17 11:17:42.200975519 +0200 ++++ linux-4.14.14-aufs.mod/fs/fcntl.c 2018-01-17 11:18:22.785556770 +0200 +@@ -85,6 +85,7 @@ int setfl(int fd, struct file * filp, un + out: + return error; + } ++EXPORT_SYMBOL_GPL(setfl); + + static void f_modown(struct file *filp, struct pid *pid, enum pid_type type, + int force) +diff -Nurp linux-4.14.14-aufs/fs/file_table.c linux-4.14.14-aufs.mod/fs/file_table.c +--- linux-4.14.14-aufs/fs/file_table.c 2017-11-12 20:46:13.000000000 +0200 ++++ linux-4.14.14-aufs.mod/fs/file_table.c 2018-01-17 11:18:22.785556770 +0200 +@@ -148,6 +148,7 @@ over: + } + return ERR_PTR(-ENFILE); + } ++EXPORT_SYMBOL_GPL(get_empty_filp); + + /** + * alloc_file - allocate and initialize a 'struct file' +@@ -258,6 +259,7 @@ void flush_delayed_fput(void) + { + delayed_fput(NULL); + } ++EXPORT_SYMBOL_GPL(flush_delayed_fput); + + static DECLARE_DELAYED_WORK(delayed_fput_work, delayed_fput); + +@@ -300,6 +302,7 @@ void __fput_sync(struct file *file) + } + + EXPORT_SYMBOL(fput); ++EXPORT_SYMBOL_GPL(__fput_sync); + + void put_filp(struct file *file) + { +@@ -308,6 +311,7 @@ void put_filp(struct file *file) + file_free(file); + } + } ++EXPORT_SYMBOL_GPL(put_filp); + + void __init files_init(void) + { +diff -Nurp linux-4.14.14-aufs/fs/inode.c linux-4.14.14-aufs.mod/fs/inode.c +--- linux-4.14.14-aufs/fs/inode.c 2018-01-17 11:17:42.200975519 +0200 ++++ linux-4.14.14-aufs.mod/fs/inode.c 2018-01-17 11:18:22.785556770 +0200 +@@ -1664,6 +1664,7 @@ int update_time(struct inode *inode, str + + return update_time(inode, time, flags); + } ++EXPORT_SYMBOL_GPL(update_time); + + /** + * touch_atime - update the access time +diff -Nurp linux-4.14.14-aufs/fs/namespace.c linux-4.14.14-aufs.mod/fs/namespace.c +--- linux-4.14.14-aufs/fs/namespace.c 2018-01-17 11:17:42.201975534 +0200 ++++ linux-4.14.14-aufs.mod/fs/namespace.c 2018-01-17 11:18:22.785556770 +0200 +@@ -517,6 +517,7 @@ void __mnt_drop_write(struct vfsmount *m + mnt_dec_writers(real_mount(mnt)); + preempt_enable(); + } ++EXPORT_SYMBOL_GPL(__mnt_drop_write); + + /** + * mnt_drop_write - give up write access to a mount +@@ -1887,6 +1888,7 @@ int iterate_mounts(int (*f)(struct vfsmo + } + return 0; + } ++EXPORT_SYMBOL_GPL(iterate_mounts); + + static void cleanup_group_ids(struct mount *mnt, struct mount *end) + { +diff -Nurp linux-4.14.14-aufs/fs/notify/group.c linux-4.14.14-aufs.mod/fs/notify/group.c +--- linux-4.14.14-aufs/fs/notify/group.c 2017-11-12 20:46:13.000000000 +0200 ++++ linux-4.14.14-aufs.mod/fs/notify/group.c 2018-01-17 11:18:22.786556784 +0200 +@@ -22,6 +22,7 @@ + #include + #include + #include ++#include + + #include + #include "fsnotify.h" +@@ -109,6 +110,7 @@ void fsnotify_get_group(struct fsnotify_ + { + atomic_inc(&group->refcnt); + } ++EXPORT_SYMBOL_GPL(fsnotify_get_group); + + /* + * Drop a reference to a group. Free it if it's through. +@@ -118,6 +120,7 @@ void fsnotify_put_group(struct fsnotify_ + if (atomic_dec_and_test(&group->refcnt)) + fsnotify_final_destroy_group(group); + } ++EXPORT_SYMBOL_GPL(fsnotify_put_group); + + /* + * Create a new fsnotify_group and hold a reference for the group returned. +@@ -147,6 +150,7 @@ struct fsnotify_group *fsnotify_alloc_gr + + return group; + } ++EXPORT_SYMBOL_GPL(fsnotify_alloc_group); + + int fsnotify_fasync(int fd, struct file *file, int on) + { +diff -Nurp linux-4.14.14-aufs/fs/notify/mark.c linux-4.14.14-aufs.mod/fs/notify/mark.c +--- linux-4.14.14-aufs/fs/notify/mark.c 2018-01-17 11:08:18.963908691 +0200 ++++ linux-4.14.14-aufs.mod/fs/notify/mark.c 2018-01-17 11:18:22.786556784 +0200 +@@ -124,6 +124,7 @@ static void __fsnotify_recalc_mask(struc + else if (conn->flags & FSNOTIFY_OBJ_TYPE_VFSMOUNT) + real_mount(conn->mnt)->mnt_fsnotify_mask = new_mask; + } ++EXPORT_SYMBOL_GPL(fsnotify_put_mark); + + /* + * Calculate mask of events for a list of marks. The caller must make sure +@@ -271,6 +272,7 @@ static bool fsnotify_get_mark_safe(struc + } + return false; + } ++EXPORT_SYMBOL_GPL(fsnotify_destroy_mark); + + /* + * Puts marks and wakes up group destruction if necessary. +@@ -428,6 +430,7 @@ int fsnotify_compare_groups(struct fsnot + return 1; + return -1; + } ++EXPORT_SYMBOL_GPL(fsnotify_add_mark); + + static int fsnotify_attach_connector_to_object( + struct fsnotify_mark_connector __rcu **connp, +@@ -557,6 +560,7 @@ out_err: + spin_unlock(&mark->lock); + return err; + } ++EXPORT_SYMBOL_GPL(fsnotify_init_mark); + + /* + * Attach an initialized mark to a given group and fs object. +diff -Nurp linux-4.14.14-aufs/fs/open.c linux-4.14.14-aufs.mod/fs/open.c +--- linux-4.14.14-aufs/fs/open.c 2017-11-12 20:46:13.000000000 +0200 ++++ linux-4.14.14-aufs.mod/fs/open.c 2018-01-17 11:18:22.786556784 +0200 +@@ -64,6 +64,7 @@ int do_truncate(struct dentry *dentry, l + inode_unlock(dentry->d_inode); + return ret; + } ++EXPORT_SYMBOL_GPL(do_truncate); + + long vfs_truncate(const struct path *path, loff_t length) + { +@@ -691,6 +692,7 @@ int open_check_o_direct(struct file *f) + } + return 0; + } ++EXPORT_SYMBOL_GPL(open_check_o_direct); + + static int do_dentry_open(struct file *f, + struct inode *inode, +diff -Nurp linux-4.14.14-aufs/fs/read_write.c linux-4.14.14-aufs.mod/fs/read_write.c +--- linux-4.14.14-aufs/fs/read_write.c 2018-01-17 11:17:42.201975534 +0200 ++++ linux-4.14.14-aufs.mod/fs/read_write.c 2018-01-17 11:18:22.790556841 +0200 +@@ -454,6 +454,7 @@ ssize_t vfs_read(struct file *file, char + + return ret; + } ++EXPORT_SYMBOL_GPL(vfs_read); + + static ssize_t new_sync_write(struct file *filp, const char __user *buf, size_t len, loff_t *ppos) + { +@@ -494,6 +495,7 @@ vfs_readf_t vfs_readf(struct file *file) + return new_sync_read; + return ERR_PTR(-ENOSYS); + } ++EXPORT_SYMBOL_GPL(vfs_readf); + + vfs_writef_t vfs_writef(struct file *file) + { +@@ -505,6 +507,7 @@ vfs_writef_t vfs_writef(struct file *fil + return new_sync_write; + return ERR_PTR(-ENOSYS); + } ++EXPORT_SYMBOL_GPL(vfs_writef); + + ssize_t __kernel_write(struct file *file, const void *buf, size_t count, loff_t *pos) + { +@@ -574,6 +577,7 @@ ssize_t vfs_write(struct file *file, con + + return ret; + } ++EXPORT_SYMBOL_GPL(vfs_write); + + static inline loff_t file_pos_read(struct file *file) + { +diff -Nurp linux-4.14.14-aufs/fs/splice.c linux-4.14.14-aufs.mod/fs/splice.c +--- linux-4.14.14-aufs/fs/splice.c 2018-01-17 11:17:42.201975534 +0200 ++++ linux-4.14.14-aufs.mod/fs/splice.c 2018-01-17 11:18:22.791556855 +0200 +@@ -850,6 +850,7 @@ long do_splice_from(struct pipe_inode_in + + return splice_write(pipe, out, ppos, len, flags); + } ++EXPORT_SYMBOL_GPL(do_splice_from); + + /* + * Attempt to initiate a splice from a file to a pipe. +@@ -879,6 +880,7 @@ long do_splice_to(struct file *in, loff_ + + return splice_read(in, ppos, pipe, len, flags); + } ++EXPORT_SYMBOL_GPL(do_splice_to); + + /** + * splice_direct_to_actor - splices data directly between two non-pipes +diff -Nurp linux-4.14.14-aufs/fs/sync.c linux-4.14.14-aufs.mod/fs/sync.c +--- linux-4.14.14-aufs/fs/sync.c 2018-01-17 11:17:42.201975534 +0200 ++++ linux-4.14.14-aufs.mod/fs/sync.c 2018-01-17 11:18:22.791556855 +0200 +@@ -39,6 +39,7 @@ int __sync_filesystem(struct super_block + sb->s_op->sync_fs(sb, wait); + return __sync_blockdev(sb->s_bdev, wait); + } ++EXPORT_SYMBOL_GPL(__sync_filesystem); + + /* + * Write out and wait upon all dirty data associated with this +diff -Nurp linux-4.14.14-aufs/fs/xattr.c linux-4.14.14-aufs.mod/fs/xattr.c +--- linux-4.14.14-aufs/fs/xattr.c 2017-11-12 20:46:13.000000000 +0200 ++++ linux-4.14.14-aufs.mod/fs/xattr.c 2018-01-17 11:18:22.791556855 +0200 +@@ -297,6 +297,7 @@ vfs_getxattr_alloc(struct dentry *dentry + *xattr_value = value; + return error; + } ++EXPORT_SYMBOL_GPL(vfs_getxattr_alloc); + + ssize_t + __vfs_getxattr(struct dentry *dentry, struct inode *inode, const char *name, +diff -Nurp linux-4.14.14-aufs/kernel/task_work.c linux-4.14.14-aufs.mod/kernel/task_work.c +--- linux-4.14.14-aufs/kernel/task_work.c 2018-01-17 11:08:18.979908919 +0200 ++++ linux-4.14.14-aufs.mod/kernel/task_work.c 2018-01-17 11:18:22.791556855 +0200 +@@ -116,3 +116,4 @@ void task_work_run(void) + } while (work); + } + } ++EXPORT_SYMBOL_GPL(task_work_run); +diff -Nurp linux-4.14.14-aufs/security/commoncap.c linux-4.14.14-aufs.mod/security/commoncap.c +--- linux-4.14.14-aufs/security/commoncap.c 2018-01-17 11:08:18.999909204 +0200 ++++ linux-4.14.14-aufs.mod/security/commoncap.c 2018-01-17 11:18:22.791556855 +0200 +@@ -1267,12 +1267,14 @@ int cap_mmap_addr(unsigned long addr) + } + return ret; + } ++EXPORT_SYMBOL_GPL(cap_mmap_addr); + + int cap_mmap_file(struct file *file, unsigned long reqprot, + unsigned long prot, unsigned long flags) + { + return 0; + } ++EXPORT_SYMBOL_GPL(cap_mmap_file); + + #ifdef CONFIG_SECURITY + +diff -Nurp linux-4.14.14-aufs/security/device_cgroup.c linux-4.14.14-aufs.mod/security/device_cgroup.c +--- linux-4.14.14-aufs/security/device_cgroup.c 2017-11-12 20:46:13.000000000 +0200 ++++ linux-4.14.14-aufs.mod/security/device_cgroup.c 2018-01-17 11:18:22.791556855 +0200 +@@ -8,6 +8,7 @@ + #include + #include + #include ++#include + #include + #include + #include +@@ -850,6 +851,7 @@ int __devcgroup_inode_permission(struct + return __devcgroup_check_permission(type, imajor(inode), iminor(inode), + access); + } ++EXPORT_SYMBOL_GPL(__devcgroup_inode_permission); + + int devcgroup_inode_mknod(int mode, dev_t dev) + { +diff -Nurp linux-4.14.14-aufs/security/security.c linux-4.14.14-aufs.mod/security/security.c +--- linux-4.14.14-aufs/security/security.c 2017-11-12 20:46:13.000000000 +0200 ++++ linux-4.14.14-aufs.mod/security/security.c 2018-01-17 11:18:22.791556855 +0200 +@@ -530,6 +530,7 @@ int security_path_rmdir(const struct pat + return 0; + return call_int_hook(path_rmdir, 0, dir, dentry); + } ++EXPORT_SYMBOL_GPL(security_path_rmdir); + + int security_path_unlink(const struct path *dir, struct dentry *dentry) + { +@@ -546,6 +547,7 @@ int security_path_symlink(const struct p + return 0; + return call_int_hook(path_symlink, 0, dir, dentry, old_name); + } ++EXPORT_SYMBOL_GPL(security_path_symlink); + + int security_path_link(struct dentry *old_dentry, const struct path *new_dir, + struct dentry *new_dentry) +@@ -554,6 +556,7 @@ int security_path_link(struct dentry *ol + return 0; + return call_int_hook(path_link, 0, old_dentry, new_dir, new_dentry); + } ++EXPORT_SYMBOL_GPL(security_path_link); + + int security_path_rename(const struct path *old_dir, struct dentry *old_dentry, + const struct path *new_dir, struct dentry *new_dentry, +@@ -581,6 +584,7 @@ int security_path_truncate(const struct + return 0; + return call_int_hook(path_truncate, 0, path); + } ++EXPORT_SYMBOL_GPL(security_path_truncate); + + int security_path_chmod(const struct path *path, umode_t mode) + { +@@ -588,6 +592,7 @@ int security_path_chmod(const struct pat + return 0; + return call_int_hook(path_chmod, 0, path, mode); + } ++EXPORT_SYMBOL_GPL(security_path_chmod); + + int security_path_chown(const struct path *path, kuid_t uid, kgid_t gid) + { +@@ -595,6 +600,7 @@ int security_path_chown(const struct pat + return 0; + return call_int_hook(path_chown, 0, path, uid, gid); + } ++EXPORT_SYMBOL_GPL(security_path_chown); + + int security_path_chroot(const struct path *path) + { +@@ -680,6 +686,7 @@ int security_inode_readlink(struct dentr + return 0; + return call_int_hook(inode_readlink, 0, dentry); + } ++EXPORT_SYMBOL_GPL(security_inode_readlink); + + int security_inode_follow_link(struct dentry *dentry, struct inode *inode, + bool rcu) +@@ -695,6 +702,7 @@ int security_inode_permission(struct ino + return 0; + return call_int_hook(inode_permission, 0, inode, mask); + } ++EXPORT_SYMBOL_GPL(security_inode_permission); + + int security_inode_setattr(struct dentry *dentry, struct iattr *attr) + { +@@ -866,6 +874,7 @@ int security_file_permission(struct file + + return fsnotify_perm(file, mask); + } ++EXPORT_SYMBOL_GPL(security_file_permission); + + int security_file_alloc(struct file *file) + { +@@ -925,6 +934,7 @@ int security_mmap_file(struct file *file + return ret; + return ima_file_mmap(file, prot); + } ++EXPORT_SYMBOL_GPL(security_mmap_file); + + int security_mmap_addr(unsigned long addr) + { diff --git a/kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-4.9.patch b/kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-4.14.patch similarity index 89% rename from kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-4.9.patch rename to kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-4.14.patch index 9b0feefe..b558c0aa 100644 --- a/kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-4.9.patch +++ b/kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-4.14.patch @@ -1,13 +1,14 @@ - Documentation/ABI/testing/debugfs-aufs | 50 + Documentation/ABI/testing/sysfs-aufs | 31 + - Documentation/filesystems/aufs/README | 393 +++++ - Documentation/filesystems/aufs/design/01intro.txt | 157 ++ + Documentation/filesystems/aufs/README | 393 ++++ + Documentation/filesystems/aufs/design/01intro.txt | 158 ++ Documentation/filesystems/aufs/design/02struct.txt | 245 +++ .../filesystems/aufs/design/03atomic_open.txt | 72 + Documentation/filesystems/aufs/design/03lookup.txt | 100 ++ Documentation/filesystems/aufs/design/04branch.txt | 61 + .../filesystems/aufs/design/05wbr_policy.txt | 51 + + Documentation/filesystems/aufs/design/06dirren.dot | 31 + + Documentation/filesystems/aufs/design/06dirren.txt | 89 + Documentation/filesystems/aufs/design/06fhsm.txt | 105 ++ Documentation/filesystems/aufs/design/06mmap.txt | 59 + Documentation/filesystems/aufs/design/06xattr.txt | 81 + @@ -18,104 +19,109 @@ drivers/block/loop.c | 18 + fs/Kconfig | 1 + fs/Makefile | 1 + - fs/aufs/Kconfig | 185 ++ - fs/aufs/Makefile | 36 + - fs/aufs/aufs.h | 46 + - fs/aufs/branch.c | 1399 +++++++++++++++ - fs/aufs/branch.h | 296 ++++ - fs/aufs/cpup.c | 1381 +++++++++++++++ - fs/aufs/cpup.h | 81 + + fs/aufs/Kconfig | 199 +++ + fs/aufs/Makefile | 38 + + fs/aufs/aufs.h | 48 + + fs/aufs/branch.c | 1420 +++++++++++++++ + fs/aufs/branch.h | 321 ++++ + fs/aufs/cpup.c | 1430 +++++++++++++++ + fs/aufs/cpup.h | 87 + fs/aufs/dbgaufs.c | 425 +++++ - fs/aufs/dbgaufs.h | 35 + - fs/aufs/dcsub.c | 212 +++ - fs/aufs/dcsub.h | 123 ++ - fs/aufs/debug.c | 427 +++++ - fs/aufs/debug.h | 212 +++ - fs/aufs/dentry.c | 1117 ++++++++++++ - fs/aufs/dentry.h | 242 +++ - fs/aufs/dinfo.c | 540 ++++++ - fs/aufs/dir.c | 749 ++++++++ - fs/aufs/dir.h | 124 ++ - fs/aufs/dynop.c | 358 ++++ - fs/aufs/dynop.h | 61 + - fs/aufs/export.c | 823 +++++++++ - fs/aufs/f_op.c | 710 ++++++++ - fs/aufs/fhsm.c | 412 +++++ + fs/aufs/dbgaufs.h | 36 + + fs/aufs/dcsub.c | 213 +++ + fs/aufs/dcsub.h | 124 ++ + fs/aufs/debug.c | 428 +++++ + fs/aufs/debug.h | 213 +++ + fs/aufs/dentry.c | 1140 ++++++++++++ + fs/aufs/dentry.h | 254 +++ + fs/aufs/dinfo.c | 541 ++++++ + fs/aufs/dir.c | 747 ++++++++ + fs/aufs/dir.h | 119 ++ + fs/aufs/dirren.c | 1303 ++++++++++++++ + fs/aufs/dirren.h | 127 ++ + fs/aufs/dynop.c | 357 ++++ + fs/aufs/dynop.h | 62 + + fs/aufs/export.c | 824 +++++++++ + fs/aufs/f_op.c | 805 +++++++++ + fs/aufs/fhsm.c | 413 +++++ fs/aufs/file.c | 844 +++++++++ - fs/aufs/file.h | 281 +++ - fs/aufs/finfo.c | 138 ++ - fs/aufs/fstype.h | 387 ++++ - fs/aufs/hfsnotify.c | 274 +++ - fs/aufs/hfsplus.c | 43 + - fs/aufs/hnotify.c | 710 ++++++++ - fs/aufs/i_op.c | 1431 +++++++++++++++ - fs/aufs/i_op_add.c | 915 ++++++++++ - fs/aufs/i_op_del.c | 498 ++++++ - fs/aufs/i_op_ren.c | 1152 ++++++++++++ - fs/aufs/iinfo.c | 272 +++ - fs/aufs/inode.c | 506 ++++++ - fs/aufs/inode.h | 678 +++++++ - fs/aufs/ioctl.c | 206 +++ - fs/aufs/loop.c | 134 ++ - fs/aufs/loop.h | 39 + - fs/aufs/magic.mk | 30 + - fs/aufs/module.c | 319 ++++ - fs/aufs/module.h | 143 ++ - fs/aufs/mvdown.c | 691 ++++++++ - fs/aufs/opts.c | 1857 ++++++++++++++++++++ - fs/aufs/opts.h | 200 +++ - fs/aufs/plink.c | 501 ++++++ - fs/aufs/poll.c | 39 + - fs/aufs/posix_acl.c | 85 + - fs/aufs/procfs.c | 156 ++ - fs/aufs/rdu.c | 368 ++++ - fs/aufs/rwsem.h | 185 ++ - fs/aufs/sbinfo.c | 342 ++++ - fs/aufs/spl.h | 100 ++ - fs/aufs/super.c | 1033 +++++++++++ - fs/aufs/super.h | 626 +++++++ - fs/aufs/sysaufs.c | 91 + - fs/aufs/sysaufs.h | 88 + - fs/aufs/sysfs.c | 340 ++++ - fs/aufs/sysrq.c | 144 ++ - fs/aufs/vdir.c | 887 ++++++++++ - fs/aufs/vfsub.c | 873 +++++++++ - fs/aufs/vfsub.h | 303 ++++ - fs/aufs/wbr_policy.c | 817 +++++++++ - fs/aufs/whout.c | 1048 +++++++++++ - fs/aufs/whout.h | 72 + - fs/aufs/wkq.c | 200 +++ - fs/aufs/wkq.h | 80 + - fs/aufs/xattr.c | 319 ++++ - fs/aufs/xino.c | 1305 ++++++++++++++ + fs/aufs/file.h | 328 ++++ + fs/aufs/finfo.c | 136 ++ + fs/aufs/fstype.h | 388 ++++ + fs/aufs/hbl.h | 52 + + fs/aufs/hfsnotify.c | 277 +++ + fs/aufs/hfsplus.c | 44 + + fs/aufs/hnotify.c | 707 ++++++++ + fs/aufs/i_op.c | 1447 +++++++++++++++ + fs/aufs/i_op_add.c | 908 ++++++++++ + fs/aufs/i_op_del.c | 499 ++++++ + fs/aufs/i_op_ren.c | 1234 +++++++++++++ + fs/aufs/iinfo.c | 273 +++ + fs/aufs/inode.c | 515 ++++++ + fs/aufs/inode.h | 683 +++++++ + fs/aufs/ioctl.c | 207 +++ + fs/aufs/loop.c | 135 ++ + fs/aufs/loop.h | 40 + + fs/aufs/magic.mk | 31 + + fs/aufs/module.c | 253 +++ + fs/aufs/module.h | 89 + + fs/aufs/mvdown.c | 692 +++++++ + fs/aufs/opts.c | 1879 ++++++++++++++++++++ + fs/aufs/opts.h | 212 +++ + fs/aufs/plink.c | 503 ++++++ + fs/aufs/poll.c | 40 + + fs/aufs/posix_acl.c | 90 + + fs/aufs/procfs.c | 158 ++ + fs/aufs/rdu.c | 369 ++++ + fs/aufs/rwsem.h | 60 + + fs/aufs/sbinfo.c | 292 +++ + fs/aufs/super.c | 1034 +++++++++++ + fs/aufs/super.h | 614 +++++++ + fs/aufs/sysaufs.c | 92 + + fs/aufs/sysaufs.h | 89 + + fs/aufs/sysfs.c | 341 ++++ + fs/aufs/sysrq.c | 147 ++ + fs/aufs/vdir.c | 880 +++++++++ + fs/aufs/vfsub.c | 882 +++++++++ + fs/aufs/vfsub.h | 348 ++++ + fs/aufs/wbr_policy.c | 818 +++++++++ + fs/aufs/whout.c | 1049 +++++++++++ + fs/aufs/whout.h | 73 + + fs/aufs/wkq.c | 378 ++++ + fs/aufs/wkq.h | 81 + + fs/aufs/xattr.c | 343 ++++ + fs/aufs/xino.c | 1406 +++++++++++++++ fs/dcache.c | 2 +- fs/fcntl.c | 4 +- fs/inode.c | 2 +- + fs/namespace.c | 6 + fs/proc/base.c | 2 +- fs/proc/nommu.c | 5 +- fs/proc/task_mmu.c | 7 +- fs/proc/task_nommu.c | 5 +- fs/read_write.c | 22 + fs/splice.c | 10 +- + fs/sync.c | 2 +- include/linux/file.h | 1 + - include/linux/fs.h | 9 + + include/linux/fs.h | 10 + + include/linux/lockdep.h | 3 + include/linux/mm.h | 22 + include/linux/mm_types.h | 2 + + include/linux/mnt_namespace.h | 3 + include/linux/splice.h | 6 + - include/uapi/linux/Kbuild | 1 + - include/uapi/linux/aufs_type.h | 406 +++++ + include/uapi/linux/aufs_type.h | 435 +++++ kernel/fork.c | 2 +- + kernel/locking/lockdep.c | 3 +- mm/Makefile | 2 +- mm/filemap.c | 2 +- - mm/memory.c | 2 +- mm/mmap.c | 33 +- mm/nommu.c | 10 +- mm/prfile.c | 86 + - 112 files changed, 33913 insertions(+), 30 deletions(-) + 119 files changed, 35967 insertions(+), 31 deletions(-) diff --git a/Documentation/ABI/testing/debugfs-aufs b/Documentation/ABI/testing/debugfs-aufs new file mode 100644 -index 0000000..99642d1 +index 000000000000..99642d1055a2 --- /dev/null +++ b/Documentation/ABI/testing/debugfs-aufs @@ -0,0 +1,50 @@ @@ -171,7 +177,7 @@ index 0000000..99642d1 + will be empty. About XINO files, see the aufs manual. diff --git a/Documentation/ABI/testing/sysfs-aufs b/Documentation/ABI/testing/sysfs-aufs new file mode 100644 -index 0000000..82f9518 +index 000000000000..82f9518495ea --- /dev/null +++ b/Documentation/ABI/testing/sysfs-aufs @@ -0,0 +1,31 @@ @@ -208,7 +214,7 @@ index 0000000..82f9518 + will be empty. About XINO files, see the aufs manual. diff --git a/Documentation/filesystems/aufs/README b/Documentation/filesystems/aufs/README new file mode 100644 -index 0000000..fa82b63 +index 000000000000..fa82b6394f69 --- /dev/null +++ b/Documentation/filesystems/aufs/README @@ -0,0 +1,393 @@ @@ -607,22 +613,23 @@ index 0000000..fa82b63 +# End: ; diff --git a/Documentation/filesystems/aufs/design/01intro.txt b/Documentation/filesystems/aufs/design/01intro.txt new file mode 100644 -index 0000000..5d01214 +index 000000000000..0cabbfc90903 --- /dev/null +++ b/Documentation/filesystems/aufs/design/01intro.txt -@@ -0,0 +1,157 @@ +@@ -0,0 +1,158 @@ + -+# Copyright (C) 2005-2016 Junjiro R. Okajima ++# Copyright (C) 2005-2017 Junjiro R. Okajima + +Introduction +---------------------------------------- + -+aufs [ei ju: ef es] | [a u f s] ++aufs [ei ju: ef es] | /ey-yoo-ef-es/ | [a u f s] +1. abbrev. for "advanced multi-layered unification filesystem". +2. abbrev. for "another unionfs". +3. abbrev. for "auf das" in German which means "on the" in English. + Ex. "Butter aufs Brot"(G) means "butter onto bread"(E). + But "Filesystem aufs Filesystem" is hard to understand. ++4. abbrev. for "African Urban Fashion Show". + +AUFS is a filesystem with features: +- multi layered stackable unification filesystem, the member directory @@ -770,12 +777,12 @@ index 0000000..5d01214 +about it. But currently I have implemented it in kernel space. diff --git a/Documentation/filesystems/aufs/design/02struct.txt b/Documentation/filesystems/aufs/design/02struct.txt new file mode 100644 -index 0000000..783328a +index 000000000000..cec903ec2c48 --- /dev/null +++ b/Documentation/filesystems/aufs/design/02struct.txt @@ -0,0 +1,245 @@ + -+# Copyright (C) 2005-2016 Junjiro R. Okajima ++# Copyright (C) 2005-2017 Junjiro R. Okajima + +Basic Aufs Internal Structure + @@ -1021,12 +1028,12 @@ index 0000000..783328a +For this purpose, use "aumvdown" command in aufs-util.git. diff --git a/Documentation/filesystems/aufs/design/03atomic_open.txt b/Documentation/filesystems/aufs/design/03atomic_open.txt new file mode 100644 -index 0000000..741ad6d +index 000000000000..12117ae5772b --- /dev/null +++ b/Documentation/filesystems/aufs/design/03atomic_open.txt @@ -0,0 +1,72 @@ + -+# Copyright (C) 2015-2016 Junjiro R. Okajima ++# Copyright (C) 2015-2017 Junjiro R. Okajima + +Support for a branch who has its ->atomic_open() +---------------------------------------------------------------------- @@ -1099,12 +1106,12 @@ index 0000000..741ad6d + be implemented in aufs, but not all I am afraid. diff --git a/Documentation/filesystems/aufs/design/03lookup.txt b/Documentation/filesystems/aufs/design/03lookup.txt new file mode 100644 -index 0000000..5b6b000 +index 000000000000..9421550324a2 --- /dev/null +++ b/Documentation/filesystems/aufs/design/03lookup.txt @@ -0,0 +1,100 @@ + -+# Copyright (C) 2005-2016 Junjiro R. Okajima ++# Copyright (C) 2005-2017 Junjiro R. Okajima + +Lookup in a Branch +---------------------------------------------------------------------- @@ -1205,12 +1212,12 @@ index 0000000..5b6b000 + by over-mounting something (or another method). diff --git a/Documentation/filesystems/aufs/design/04branch.txt b/Documentation/filesystems/aufs/design/04branch.txt new file mode 100644 -index 0000000..e68f4d3 +index 000000000000..ec59427ad94f --- /dev/null +++ b/Documentation/filesystems/aufs/design/04branch.txt @@ -0,0 +1,61 @@ + -+# Copyright (C) 2005-2016 Junjiro R. Okajima ++# Copyright (C) 2005-2017 Junjiro R. Okajima + +Branch Manipulation + @@ -1272,12 +1279,12 @@ index 0000000..e68f4d3 + same named entry on the upper branch. diff --git a/Documentation/filesystems/aufs/design/05wbr_policy.txt b/Documentation/filesystems/aufs/design/05wbr_policy.txt new file mode 100644 -index 0000000..1726d5d +index 000000000000..89df0e2819d2 --- /dev/null +++ b/Documentation/filesystems/aufs/design/05wbr_policy.txt @@ -0,0 +1,51 @@ + -+# Copyright (C) 2005-2016 Junjiro R. Okajima ++# Copyright (C) 2005-2017 Junjiro R. Okajima + +Policies to Select One among Multiple Writable Branches +---------------------------------------------------------------------- @@ -1327,14 +1334,146 @@ index 0000000..1726d5d + where the source and the target exists and selects the higher + one. If the selected branch is readonly, then aufs follows the + copyup policy. +diff --git a/Documentation/filesystems/aufs/design/06dirren.dot b/Documentation/filesystems/aufs/design/06dirren.dot +new file mode 100644 +index 000000000000..2d62bb6dd55f +--- /dev/null ++++ b/Documentation/filesystems/aufs/design/06dirren.dot +@@ -0,0 +1,31 @@ ++ ++// to view this graph, run dot(1) command in GRAPHVIZ. ++ ++digraph G { ++node [shape=box]; ++whinfo [label="detailed info file\n(lower_brid_root-hinum, h_inum, namelen, old name)"]; ++ ++node [shape=oval]; ++ ++aufs_rename -> whinfo [label="store/remove"]; ++ ++node [shape=oval]; ++inode_list [label="h_inum list in branch\ncache"]; ++ ++node [shape=box]; ++whinode [label="h_inum list file"]; ++ ++node [shape=oval]; ++brmgmt [label="br_add/del/mod/umount"]; ++ ++brmgmt -> inode_list [label="create/remove"]; ++brmgmt -> whinode [label="load/store"]; ++ ++inode_list -> whinode [style=dashed,dir=both]; ++ ++aufs_rename -> inode_list [label="add/del"]; ++ ++aufs_lookup -> inode_list [label="search"]; ++ ++aufs_lookup -> whinfo [label="load/remove"]; ++} +diff --git a/Documentation/filesystems/aufs/design/06dirren.txt b/Documentation/filesystems/aufs/design/06dirren.txt +new file mode 100644 +index 000000000000..7aed1889d91e +--- /dev/null ++++ b/Documentation/filesystems/aufs/design/06dirren.txt +@@ -0,0 +1,89 @@ ++ ++# Copyright (C) 2017 Junjiro R. Okajima ++ ++Special handling for renaming a directory (DIRREN) ++---------------------------------------------------------------------- ++First, let's assume we have a simple usecase. ++ ++- /u = /rw + /ro ++- /rw/dirA exists ++- /ro/dirA and /ro/dirA/file exist too ++- there is no dirB on both branches ++- a user issues rename("dirA", "dirB") ++ ++Now, what should aufs behave against this rename(2)? ++There are a few possible cases. ++ ++A. returns EROFS. ++ since dirA exists on a readonly branch which cannot be renamed. ++B. returns EXDEV. ++ it is possible to copy-up dirA (only the dir itself), but the child ++ entries ("file" in this case) should not be. it must be a bad ++ approach to copy-up recursively. ++C. returns a success. ++ even the branch /ro is readonly, aufs tries renaming it. Obviously it ++ is a violation of aufs' policy. ++D. construct an extra information which indicates that /ro/dirA should ++ be handled as the name of dirB. ++ overlayfs has a similar feature called REDIRECT. ++ ++Until now, aufs implements the case B only which returns EXDEV, and ++expects the userspace application behaves like mv(1) which tries ++issueing rename(2) recursively. ++ ++A new aufs feature called DIRREN is introduced which implements the case ++D. There are several "extra information" added. ++ ++1. detailed info per renamed directory ++ path: /rw/dirB/$AUFS_WH_DR_INFO_PFX. ++2. the inode-number list of directories on a branch ++ path: /rw/dirB/$AUFS_WH_DR_BRHINO ++ ++The filename of "detailed info per directory" represents the lower ++branch, and its format is ++- a type of the branch id ++ one of these. ++ + uuid (not implemented yet) ++ + fsid ++ + dev ++- the inode-number of the branch root dir ++ ++And it contains these info in a single regular file. ++- magic number ++- branch's inode-number of the logically renamed dir ++- the name of the before-renamed dir ++ ++The "detailed info per directory" file is created in aufs rename(2), and ++loaded in any lookup. ++The info is considered in lookup for the matching case only. Here ++"matching" means that the root of branch (in the info filename) is same ++to the current looking-up branch. After looking-up the before-renamed ++name, the inode-number is compared. And the matched dentry is used. ++ ++The "inode-number list of directories" is a regular file which contains ++simply the inode-numbers on the branch. The file is created or updated ++in removing the branch, and loaded in adding the branch. Its lifetime is ++equal to the branch. ++The list is refered in lookup, and when the current target inode is ++found in the list, the aufs tries loading the "detailed info per ++directory" and get the changed and valid name of the dir. ++ ++Theoretically these "extra informaiton" may be able to be put into XATTR ++in the dir inode. But aufs doesn't choose this way because ++1. XATTR may not be supported by the branch (or its configuration) ++2. XATTR may have its size limit. ++3. XATTR may be less easy to convert than a regular file, when the ++ format of the info is changed in the future. ++At the same time, I agree that the regular file approach is much slower ++than XATTR approach. So, in the future, aufs may take the XATTR or other ++better approach. ++ ++This DIRREN feature is enabled by aufs configuration, and is activated ++by a new mount option. ++ ++For the more complicated case, there is a work with UDBA option, which ++is to dected the direct access to the branches (by-passing aufs) and to ++maintain the cashes in aufs. Since a single cached aufs dentry may ++contains two names, before- and after-rename, the name comparision in ++UDBA handler may not work correctly. In this case, the behaviour will be ++equivalen to udba=reval case. diff --git a/Documentation/filesystems/aufs/design/06fhsm.txt b/Documentation/filesystems/aufs/design/06fhsm.txt new file mode 100644 -index 0000000..84b46dc +index 000000000000..dc8451fc3ac2 --- /dev/null +++ b/Documentation/filesystems/aufs/design/06fhsm.txt @@ -0,0 +1,105 @@ + -+# Copyright (C) 2011-2016 Junjiro R. Okajima ++# Copyright (C) 2011-2017 Junjiro R. Okajima + +File-based Hierarchical Storage Management (FHSM) +---------------------------------------------------------------------- @@ -1440,12 +1579,12 @@ index 0000000..84b46dc +should restore the original file state after an error happens. diff --git a/Documentation/filesystems/aufs/design/06mmap.txt b/Documentation/filesystems/aufs/design/06mmap.txt new file mode 100644 -index 0000000..991c0b1 +index 000000000000..d79f7ad01162 --- /dev/null +++ b/Documentation/filesystems/aufs/design/06mmap.txt @@ -0,0 +1,59 @@ + -+# Copyright (C) 2005-2016 Junjiro R. Okajima ++# Copyright (C) 2005-2017 Junjiro R. Okajima + +mmap(2) -- File Memory Mapping +---------------------------------------------------------------------- @@ -1505,12 +1644,12 @@ index 0000000..991c0b1 +I have to give up this "looks-smater" approach. diff --git a/Documentation/filesystems/aufs/design/06xattr.txt b/Documentation/filesystems/aufs/design/06xattr.txt new file mode 100644 -index 0000000..7bfa94f +index 000000000000..1ff7d53f9b07 --- /dev/null +++ b/Documentation/filesystems/aufs/design/06xattr.txt @@ -0,0 +1,81 @@ + -+# Copyright (C) 2014-2016 Junjiro R. Okajima ++# Copyright (C) 2014-2017 Junjiro R. Okajima + +Listing XATTR/EA and getting the value +---------------------------------------------------------------------- @@ -1592,12 +1731,12 @@ index 0000000..7bfa94f +now, aufs implements the branch attributes to ignore the error. diff --git a/Documentation/filesystems/aufs/design/07export.txt b/Documentation/filesystems/aufs/design/07export.txt new file mode 100644 -index 0000000..c23930b +index 000000000000..d50dcb8eb7fe --- /dev/null +++ b/Documentation/filesystems/aufs/design/07export.txt @@ -0,0 +1,45 @@ + -+# Copyright (C) 2005-2016 Junjiro R. Okajima ++# Copyright (C) 2005-2017 Junjiro R. Okajima + +Export Aufs via NFS +---------------------------------------------------------------------- @@ -1643,12 +1782,12 @@ index 0000000..c23930b + lookup_one_len(), vfs_getattr(), encode_fh() and others. diff --git a/Documentation/filesystems/aufs/design/08shwh.txt b/Documentation/filesystems/aufs/design/08shwh.txt new file mode 100644 -index 0000000..ad58ebe +index 000000000000..7b57de50fbc7 --- /dev/null +++ b/Documentation/filesystems/aufs/design/08shwh.txt @@ -0,0 +1,39 @@ + -+# Copyright (C) 2005-2016 Junjiro R. Okajima ++# Copyright (C) 2005-2017 Junjiro R. Okajima + +Show Whiteout Mode (shwh) +---------------------------------------------------------------------- @@ -1688,12 +1827,12 @@ index 0000000..ad58ebe +initramfs will use it to replace the old one at the next boot. diff --git a/Documentation/filesystems/aufs/design/10dynop.txt b/Documentation/filesystems/aufs/design/10dynop.txt new file mode 100644 -index 0000000..49afc58 +index 000000000000..1c38e65a43bd --- /dev/null +++ b/Documentation/filesystems/aufs/design/10dynop.txt @@ -0,0 +1,34 @@ + -+# Copyright (C) 2010-2016 Junjiro R. Okajima ++# Copyright (C) 2010-2017 Junjiro R. Okajima + +Dynamically customizable FS operations +---------------------------------------------------------------------- @@ -1727,10 +1866,10 @@ index 0000000..49afc58 +Currently this approach is applied to address_space_operations for +regular files only. diff --git a/MAINTAINERS b/MAINTAINERS -index 63cefa6..d78b954 100644 +index 2811a211632c..02b6deb1f5bc 100644 --- a/MAINTAINERS +++ b/MAINTAINERS -@@ -2293,6 +2293,19 @@ F: include/linux/audit.h +@@ -2465,6 +2465,19 @@ F: include/linux/audit.h F: include/uapi/linux/audit.h F: kernel/audit* @@ -1751,10 +1890,10 @@ index 63cefa6..d78b954 100644 M: Miguel Ojeda Sandonis W: http://miguelojeda.es/auxdisplay.htm diff --git a/drivers/block/loop.c b/drivers/block/loop.c -index fa1b7a9..6ee9235 100644 +index 85de67334695..d44de9dbaddf 100644 --- a/drivers/block/loop.c +++ b/drivers/block/loop.c -@@ -701,6 +701,24 @@ static inline int is_loop_device(struct file *file) +@@ -686,6 +686,24 @@ static inline int is_loop_device(struct file *file) return i && S_ISBLK(i->i_mode) && MAJOR(i->i_rdev) == LOOP_MAJOR; } @@ -1780,10 +1919,10 @@ index fa1b7a9..6ee9235 100644 static ssize_t loop_attr_show(struct device *dev, char *page, diff --git a/fs/Kconfig b/fs/Kconfig -index 4bd03a2..620e01b 100644 +index 7aee6d699fd6..ec92031204c5 100644 --- a/fs/Kconfig +++ b/fs/Kconfig -@@ -249,6 +249,7 @@ source "fs/pstore/Kconfig" +@@ -248,6 +248,7 @@ source "fs/pstore/Kconfig" source "fs/sysv/Kconfig" source "fs/ufs/Kconfig" source "fs/exofs/Kconfig" @@ -1792,7 +1931,7 @@ index 4bd03a2..620e01b 100644 endif # MISC_FILESYSTEMS diff --git a/fs/Makefile b/fs/Makefile -index ed2b632..aa6d14b 100644 +index ef772f1eaff8..51779e68c0d0 100644 --- a/fs/Makefile +++ b/fs/Makefile @@ -129,3 +129,4 @@ obj-y += exofs/ # Multiple modules @@ -1802,10 +1941,11 @@ index ed2b632..aa6d14b 100644 +obj-$(CONFIG_AUFS_FS) += aufs/ diff --git a/fs/aufs/Kconfig b/fs/aufs/Kconfig new file mode 100644 -index 0000000..a4efb8b +index 000000000000..0b442aeb7b45 --- /dev/null +++ b/fs/aufs/Kconfig -@@ -0,0 +1,185 @@ +@@ -0,0 +1,199 @@ ++# SPDX-License-Identifier: GPL-2.0 +config AUFS_FS + bool "Aufs (Advanced multi layered unification filesystem) support" + help @@ -1924,6 +2064,19 @@ index 0000000..a4efb8b + shows better performance in most cases. + See detail in aufs.5. + ++config AUFS_DIRREN ++ bool "Workaround for rename(2)-ing a directory" ++ help ++ By default, aufs returns EXDEV error in renameing a dir who has ++ his child on the lower branch, since it is a bad idea to issue ++ rename(2) internally for every lower branch. But user may not ++ accept this behaviour. So here is a workaround to allow such ++ rename(2) and store some extra infromation on the writable ++ branch. Obviously this costs high (and I don't like it). ++ To use this feature, you need to enable this configuration AND ++ to specify the mount option `dirren.' ++ See details in aufs.5 and the design documents. ++ +config AUFS_SHWH + bool "Show whiteouts" + help @@ -1993,10 +2146,11 @@ index 0000000..a4efb8b +endif diff --git a/fs/aufs/Makefile b/fs/aufs/Makefile new file mode 100644 -index 0000000..c7efb62 +index 000000000000..aa43f916b5ef --- /dev/null +++ b/fs/aufs/Makefile -@@ -0,0 +1,36 @@ +@@ -0,0 +1,38 @@ ++# SPDX-License-Identifier: GPL-2.0 + +include ${srctree}/${src}/magic.mk + @@ -2027,6 +2181,7 @@ index 0000000..c7efb62 +aufs-$(CONFIG_AUFS_EXPORT) += export.o +aufs-$(CONFIG_AUFS_XATTR) += xattr.o +aufs-$(CONFIG_FS_POSIX_ACL) += posix_acl.o ++aufs-$(CONFIG_AUFS_DIRREN) += dirren.o +aufs-$(CONFIG_AUFS_FHSM) += fhsm.o +aufs-$(CONFIG_AUFS_POLL) += poll.o +aufs-$(CONFIG_AUFS_RDU) += rdu.o @@ -2035,12 +2190,13 @@ index 0000000..c7efb62 +aufs-$(CONFIG_AUFS_MAGIC_SYSRQ) += sysrq.o diff --git a/fs/aufs/aufs.h b/fs/aufs/aufs.h new file mode 100644 -index 0000000..49f43b4 +index 000000000000..73a0cae76784 --- /dev/null +++ b/fs/aufs/aufs.h -@@ -0,0 +1,46 @@ +@@ -0,0 +1,48 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -2068,15 +2224,16 @@ index 0000000..49f43b4 +#include "dbgaufs.h" +#include "dentry.h" +#include "dir.h" ++#include "dirren.h" +#include "dynop.h" +#include "file.h" +#include "fstype.h" ++#include "hbl.h" +#include "inode.h" +#include "loop.h" +#include "module.h" +#include "opts.h" +#include "rwsem.h" -+#include "spl.h" +#include "super.h" +#include "sysaufs.h" +#include "vfsub.h" @@ -2087,12 +2244,13 @@ index 0000000..49f43b4 +#endif /* __AUFS_H__ */ diff --git a/fs/aufs/branch.c b/fs/aufs/branch.c new file mode 100644 -index 0000000..3bfbe5b +index 000000000000..1027fce6a0ec --- /dev/null +++ b/fs/aufs/branch.c -@@ -0,0 +1,1399 @@ +@@ -0,0 +1,1420 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -2113,10 +2271,14 @@ index 0000000..3bfbe5b + struct au_dykey **key; + + au_hnotify_fin_br(br); ++ /* always, regardless the mount option */ ++ au_dr_hino_free(&br->br_dirren); + + if (br->br_xino.xi_file) + fput(br->br_xino.xi_file); -+ mutex_destroy(&br->br_xino.xi_nondir_mtx); ++ for (i = br->br_xino.xi_nondir.total - 1; i >= 0; i--) ++ AuDebugOn(br->br_xino.xi_nondir.array[i]); ++ kfree(br->br_xino.xi_nondir.array); + + AuDebugOn(au_br_count(br)); + au_br_count_fin(br); @@ -2131,7 +2293,7 @@ index 0000000..3bfbe5b + + if (br->br_fhsm) { + au_br_fhsm_fin(br->br_fhsm); -+ au_delayed_kfree(br->br_fhsm); ++ kfree(br->br_fhsm); + } + + key = br->br_dykey; @@ -2145,9 +2307,8 @@ index 0000000..3bfbe5b + lockdep_off(); + path_put(&br->br_path); + lockdep_on(); -+ if (wbr) -+ au_delayed_kfree(wbr); -+ au_delayed_kfree(br); ++ kfree(wbr); ++ kfree(br); +} + +/* @@ -2211,14 +2372,19 @@ index 0000000..3bfbe5b + int err; + + err = -ENOMEM; -+ root = sb->s_root; + add_branch = kzalloc(sizeof(*add_branch), GFP_NOFS); + if (unlikely(!add_branch)) + goto out; ++ add_branch->br_xino.xi_nondir.total = 8; /* initial size */ ++ add_branch->br_xino.xi_nondir.array ++ = kcalloc(add_branch->br_xino.xi_nondir.total, sizeof(ino_t), ++ GFP_NOFS); ++ if (unlikely(!add_branch->br_xino.xi_nondir.array)) ++ goto out_br; + + err = au_hnotify_init_br(add_branch, perm); + if (unlikely(err)) -+ goto out_br; ++ goto out_xinondir; + + if (au_br_writable(perm)) { + /* may be freed separately at changing the branch permission */ @@ -2234,23 +2400,26 @@ index 0000000..3bfbe5b + goto out_wbr; + } + ++ root = sb->s_root; + err = au_sbr_realloc(au_sbi(sb), new_nbranch, /*may_shrink*/0); + if (!err) + err = au_di_realloc(au_di(root), new_nbranch, /*may_shrink*/0); + if (!err) { + inode = d_inode(root); -+ err = au_hinode_realloc(au_ii(inode), new_nbranch, /*may_shrink*/0); ++ err = au_hinode_realloc(au_ii(inode), new_nbranch, ++ /*may_shrink*/0); + } + if (!err) + return add_branch; /* success */ + +out_wbr: -+ if (add_branch->br_wbr) -+ au_delayed_kfree(add_branch->br_wbr); ++ kfree(add_branch->br_wbr); +out_hnotify: + au_hnotify_fin_br(add_branch); ++out_xinondir: ++ kfree(add_branch->br_xino.xi_nondir.array); +out_br: -+ au_delayed_kfree(add_branch); ++ kfree(add_branch); +out: + return ERR_PTR(err); +} @@ -2416,7 +2585,7 @@ index 0000000..3bfbe5b + br->br_perm = old_perm; + + if (!err && wbr && !au_br_writable(new_perm)) { -+ au_delayed_kfree(wbr); ++ kfree(wbr); + br->br_wbr = NULL; + } + @@ -2462,7 +2631,8 @@ index 0000000..3bfbe5b + struct inode *h_inode; + + err = 0; -+ mutex_init(&br->br_xino.xi_nondir_mtx); ++ spin_lock_init(&br->br_xino.xi_nondir.spin); ++ init_waitqueue_head(&br->br_xino.xi_nondir.wqh); + br->br_perm = add->perm; + br->br_path = add->path; /* set first, path_get() later */ + spin_lock_init(&br->br_dykey_lock); @@ -2471,6 +2641,11 @@ index 0000000..3bfbe5b + br->br_id = au_new_br_id(sb); + AuDebugOn(br->br_id < 0); + ++ /* always, regardless the given option */ ++ err = au_dr_br_init(sb, br, &add->path); ++ if (unlikely(err)) ++ goto out_err; ++ + if (au_br_writable(add->perm)) { + err = au_wbr_init(br, sb, add->perm); + if (unlikely(err)) @@ -2637,14 +2812,15 @@ index 0000000..3bfbe5b +{ + unsigned long long n; + struct file **p, *f; -+ struct au_sphlhead *files; ++ struct hlist_bl_head *files; ++ struct hlist_bl_node *pos; + struct au_finfo *finfo; + + n = 0; + p = a; + files = &au_sbi(sb)->si_files; -+ spin_lock(&files->spin); -+ hlist_for_each_entry(finfo, &files->head, fi_hlist) { ++ hlist_bl_lock(files); ++ hlist_bl_for_each_entry(finfo, pos, files, fi_hlist) { + f = finfo->fi_file; + if (file_count(f) + && !special_file(file_inode(f)->i_mode)) { @@ -2654,7 +2830,7 @@ index 0000000..3bfbe5b + AuDebugOn(n > max); + } + } -+ spin_unlock(&files->spin); ++ hlist_bl_unlock(files); + + return n; +} @@ -3057,6 +3233,9 @@ index 0000000..3bfbe5b + au_br_do_del_hip(au_ii(inode), bindex, bbot); + au_sbilist_unlock(); + ++ /* ignore an error */ ++ au_dr_br_fin(sb, br); /* always, regardless the mount option */ ++ + dput(h_root); + iput(h_inode); + au_br_do_free(br); @@ -3442,7 +3621,7 @@ index 0000000..3bfbe5b + if (br->br_wbr) { + err = au_wbr_init(br, sb, mod->perm); + if (unlikely(err)) { -+ au_delayed_kfree(br->br_wbr); ++ kfree(br->br_wbr); + br->br_wbr = NULL; + } + } @@ -3454,7 +3633,7 @@ index 0000000..3bfbe5b + if (!au_br_fhsm(mod->perm)) { + /* fhsm --> non-fhsm */ + au_br_fhsm_fin(br->br_fhsm); -+ au_delayed_kfree(br->br_fhsm); ++ kfree(br->br_fhsm); + br->br_fhsm = NULL; + } + } else if (au_br_fhsm(mod->perm)) @@ -3466,8 +3645,7 @@ index 0000000..3bfbe5b + goto out; /* success */ + +out_bf: -+ if (bf) -+ au_delayed_kfree(bf); ++ kfree(bf); +out: + AuTraceErr(err); + return err; @@ -3492,12 +3670,13 @@ index 0000000..3bfbe5b +} diff --git a/fs/aufs/branch.h b/fs/aufs/branch.h new file mode 100644 -index 0000000..32a4d8f +index 000000000000..4d00945fae8d --- /dev/null +++ b/fs/aufs/branch.h -@@ -0,0 +1,296 @@ +@@ -0,0 +1,321 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -3510,6 +3689,7 @@ index 0000000..32a4d8f +#ifdef __KERNEL__ + +#include ++#include "dirren.h" +#include "dynop.h" +#include "rwsem.h" +#include "super.h" @@ -3519,7 +3699,14 @@ index 0000000..32a4d8f +/* a xino file */ +struct au_xino_file { + struct file *xi_file; -+ struct mutex xi_nondir_mtx; ++ struct { ++ spinlock_t spin; ++ ino_t *array; ++ int total; ++ /* reserved for future use */ ++ /* unsigned long *bitmap; */ ++ wait_queue_head_t wqh; ++ } xi_nondir; + + /* todo: make xino files an array to support huge inode number */ + @@ -3600,6 +3787,8 @@ index 0000000..32a4d8f + /* entries under sysfs per mount-point */ + struct au_brsysfs br_sysfs[AuBrSysfs_Last]; +#endif ++ ++ struct au_dr_br br_dirren; +}; + +/* ---------------------------------------------------------------------- */ @@ -3646,7 +3835,7 @@ index 0000000..32a4d8f + +static inline int au_br_rdonly(struct au_branch *br) +{ -+ return ((au_br_sb(br)->s_flags & MS_RDONLY) ++ return (sb_rdonly(au_br_sb(br)) + || !au_br_writable(br->br_perm)) + ? -EROFS : 0; +} @@ -3666,7 +3855,7 @@ index 0000000..32a4d8f + + err = 0; + exec_flag = oflag & __FMODE_EXEC; -+ if (unlikely(exec_flag && (au_br_mnt(br)->mnt_flags & MNT_NOEXEC))) ++ if (unlikely(exec_flag && path_noexec(&br->br_path))) + err = -EACCES; + + return err; @@ -3718,6 +3907,11 @@ index 0000000..32a4d8f +struct file *au_xino_def(struct super_block *sb); +int au_xino_path(struct seq_file *seq, struct file *file); + ++void au_xinondir_leave(struct super_block *sb, aufs_bindex_t bindex, ++ ino_t h_ino, int idx); ++int au_xinondir_enter(struct super_block *sb, aufs_bindex_t bindex, ino_t h_ino, ++ int *idx); ++ +/* ---------------------------------------------------------------------- */ + +/* Superblock to branch */ @@ -3761,15 +3955,24 @@ index 0000000..32a4d8f + +/* ---------------------------------------------------------------------- */ + ++#define wbr_wh_read_lock(wbr) au_rw_read_lock(&(wbr)->wbr_wh_rwsem) ++#define wbr_wh_write_lock(wbr) au_rw_write_lock(&(wbr)->wbr_wh_rwsem) ++#define wbr_wh_read_trylock(wbr) au_rw_read_trylock(&(wbr)->wbr_wh_rwsem) ++#define wbr_wh_write_trylock(wbr) au_rw_write_trylock(&(wbr)->wbr_wh_rwsem) +/* -+ * wbr_wh_read_lock, wbr_wh_write_lock -+ * wbr_wh_read_unlock, wbr_wh_write_unlock, wbr_wh_downgrade_lock -+ */ -+AuSimpleRwsemFuncs(wbr_wh, struct au_wbr *wbr, &wbr->wbr_wh_rwsem); ++#define wbr_wh_read_trylock_nested(wbr) \ ++ au_rw_read_trylock_nested(&(wbr)->wbr_wh_rwsem) ++#define wbr_wh_write_trylock_nested(wbr) \ ++ au_rw_write_trylock_nested(&(wbr)->wbr_wh_rwsem) ++*/ + -+#define WbrWhMustNoWaiters(wbr) AuRwMustNoWaiters(&wbr->wbr_wh_rwsem) -+#define WbrWhMustAnyLock(wbr) AuRwMustAnyLock(&wbr->wbr_wh_rwsem) -+#define WbrWhMustWriteLock(wbr) AuRwMustWriteLock(&wbr->wbr_wh_rwsem) ++#define wbr_wh_read_unlock(wbr) au_rw_read_unlock(&(wbr)->wbr_wh_rwsem) ++#define wbr_wh_write_unlock(wbr) au_rw_write_unlock(&(wbr)->wbr_wh_rwsem) ++#define wbr_wh_downgrade_lock(wbr) au_rw_dgrade_lock(&(wbr)->wbr_wh_rwsem) ++ ++#define WbrWhMustNoWaiters(wbr) AuRwMustNoWaiters(&(wbr)->wbr_wh_rwsem) ++#define WbrWhMustAnyLock(wbr) AuRwMustAnyLock(&(wbr)->wbr_wh_rwsem) ++#define WbrWhMustWriteLock(wbr) AuRwMustWriteLock(&(wbr)->wbr_wh_rwsem) + +/* ---------------------------------------------------------------------- */ + @@ -3794,12 +3997,13 @@ index 0000000..32a4d8f +#endif /* __AUFS_BRANCH_H__ */ diff --git a/fs/aufs/cpup.c b/fs/aufs/cpup.c new file mode 100644 -index 0000000..5b050ec +index 000000000000..3678bacc40b3 --- /dev/null +++ b/fs/aufs/cpup.c -@@ -0,0 +1,1381 @@ +@@ -0,0 +1,1430 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -4144,14 +4348,67 @@ index 0000000..5b050ec + dst->f_pos = 0; + err = au_do_copy_file(dst, src, len, buf, blksize); + if (do_kfree) -+ au_delayed_kfree(buf); ++ kfree(buf); + else -+ au_delayed_free_page((unsigned long)buf); ++ free_page((unsigned long)buf); + +out: + return err; +} + ++static int au_do_copy(struct file *dst, struct file *src, loff_t len) ++{ ++ int err; ++ struct super_block *h_src_sb; ++ struct inode *h_src_inode; ++ ++ h_src_inode = file_inode(src); ++ h_src_sb = h_src_inode->i_sb; ++ ++ /* XFS acquires inode_lock */ ++ if (!au_test_xfs(h_src_sb)) ++ err = au_copy_file(dst, src, len); ++ else { ++ inode_unlock_shared(h_src_inode); ++ err = au_copy_file(dst, src, len); ++ vfsub_inode_lock_shared_nested(h_src_inode, AuLsc_I_CHILD); ++ } ++ ++ return err; ++} ++ ++static int au_clone_or_copy(struct file *dst, struct file *src, loff_t len) ++{ ++ int err; ++ struct super_block *h_src_sb; ++ struct inode *h_src_inode; ++ ++ h_src_inode = file_inode(src); ++ h_src_sb = h_src_inode->i_sb; ++ if (h_src_sb != file_inode(dst)->i_sb ++ || !dst->f_op->clone_file_range) { ++ err = au_do_copy(dst, src, len); ++ goto out; ++ } ++ ++ if (!au_test_nfs(h_src_sb)) { ++ inode_unlock_shared(h_src_inode); ++ err = vfsub_clone_file_range(src, dst, len); ++ vfsub_inode_lock_shared_nested(h_src_inode, AuLsc_I_CHILD); ++ } else ++ err = vfsub_clone_file_range(src, dst, len); ++ /* older XFS has a condition in cloning */ ++ if (unlikely(err != -EOPNOTSUPP)) ++ goto out; ++ ++ /* the backend fs on NFS may not support cloning */ ++ err = au_do_copy(dst, src, len); ++ ++out: ++ AuTraceErr(err); ++ return err; ++} ++ +/* + * to support a sparse file which is opened with O_APPEND, + * we need to close the file. @@ -4180,7 +4437,7 @@ index 0000000..5b050ec + .label = &&out_src + } + }; -+ struct super_block *sb; ++ struct super_block *sb, *h_src_sb; + struct inode *h_src_inode; + struct task_struct *tsk = current; + @@ -4198,16 +4455,16 @@ index 0000000..5b050ec + + /* try stopping to update while we copyup */ + h_src_inode = d_inode(file[SRC].dentry); -+ if (!au_test_nfs(h_src_inode->i_sb)) ++ h_src_sb = h_src_inode->i_sb; ++ if (!au_test_nfs(h_src_sb)) + IMustLock(h_src_inode); -+ err = au_copy_file(file[DST].file, file[SRC].file, cpg->len); ++ err = au_clone_or_copy(file[DST].file, file[SRC].file, cpg->len); + + /* i wonder if we had O_NO_DELAY_FPUT flag */ + if (tsk->flags & PF_KTHREAD) + __fput_sync(file[DST].file); + else { -+ WARN(1, "%pD\nPlease report this warning to aufs-users ML", -+ file[DST].file); ++ /* it happend actually */ + fput(file[DST].file); + /* + * too bad. @@ -4241,29 +4498,30 @@ index 0000000..5b050ec + cpg->len = l; + if (cpg->len) { + /* try stopping to update while we are referencing */ -+ inode_lock_nested(h_src_inode, AuLsc_I_CHILD); ++ vfsub_inode_lock_shared_nested(h_src_inode, AuLsc_I_CHILD); + au_pin_hdir_unlock(cpg->pin); + + h_path.dentry = au_h_dptr(cpg->dentry, cpg->bsrc); + h_path.mnt = au_sbr_mnt(cpg->dentry->d_sb, cpg->bsrc); + h_src_attr->iflags = h_src_inode->i_flags; + if (!au_test_nfs(h_src_inode->i_sb)) -+ err = vfs_getattr(&h_path, &h_src_attr->st); ++ err = vfsub_getattr(&h_path, &h_src_attr->st); + else { -+ inode_unlock(h_src_inode); -+ err = vfs_getattr(&h_path, &h_src_attr->st); -+ inode_lock_nested(h_src_inode, AuLsc_I_CHILD); ++ inode_unlock_shared(h_src_inode); ++ err = vfsub_getattr(&h_path, &h_src_attr->st); ++ vfsub_inode_lock_shared_nested(h_src_inode, ++ AuLsc_I_CHILD); + } + if (unlikely(err)) { -+ inode_unlock(h_src_inode); ++ inode_unlock_shared(h_src_inode); + goto out; + } + h_src_attr->valid = 1; + if (!au_test_nfs(h_src_inode->i_sb)) { + err = au_cp_regular(cpg); -+ inode_unlock(h_src_inode); ++ inode_unlock_shared(h_src_inode); + } else { -+ inode_unlock(h_src_inode); ++ inode_unlock_shared(h_src_inode); + err = au_cp_regular(cpg); + } + rerr = au_pin_hdir_relock(cpg->pin); @@ -4291,12 +4549,6 @@ index 0000000..5b050ec + char *k; + char __user *u; + } sym; -+ struct inode *h_inode = d_inode(h_src); -+ const struct inode_operations *h_iop = h_inode->i_op; -+ -+ err = -ENOSYS; -+ if (unlikely(!h_iop->readlink)) -+ goto out; + + err = -ENOMEM; + sym.k = (void *)__get_free_page(GFP_NOFS); @@ -4306,7 +4558,7 @@ index 0000000..5b050ec + /* unnecessary to support mmap_sem since symlink is not mmap-able */ + old_fs = get_fs(); + set_fs(KERNEL_DS); -+ symlen = h_iop->readlink(h_src, sym.u, PATH_MAX); ++ symlen = vfs_readlink(h_src, sym.u, PATH_MAX); + err = symlen; + set_fs(old_fs); + @@ -4314,7 +4566,7 @@ index 0000000..5b050ec + sym.k[symlen] = 0; + err = vfsub_symlink(h_dir, h_path, sym.k); + } -+ au_delayed_free_page((unsigned long)sym.k); ++ free_page((unsigned long)sym.k); + +out: + return err; @@ -4688,7 +4940,7 @@ index 0000000..5b050ec + } +out_parent: + dput(dst_parent); -+ au_delayed_kfree(a); ++ kfree(a); +out: + return err; +} @@ -5181,12 +5433,13 @@ index 0000000..5b050ec +} diff --git a/fs/aufs/cpup.h b/fs/aufs/cpup.h new file mode 100644 -index 0000000..ccba2c4 +index 000000000000..22c5f5402939 --- /dev/null +++ b/fs/aufs/cpup.h -@@ -0,0 +1,81 @@ +@@ -0,0 +1,87 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -5233,6 +5486,11 @@ index 0000000..ccba2c4 +#define AuCpup_RWDST (1 << 5) /* force write target even if + the branch is marked as RO */ + ++#ifndef CONFIG_AUFS_BR_HFSPLUS ++#undef AuCpup_HOPEN ++#define AuCpup_HOPEN 0 ++#endif ++ +#define au_ftest_cpup(flags, name) ((flags) & AuCpup_##name) +#define au_fset_cpup(flags, name) \ + do { (flags) |= AuCpup_##name; } while (0) @@ -5268,12 +5526,13 @@ index 0000000..ccba2c4 +#endif /* __AUFS_CPUP_H__ */ diff --git a/fs/aufs/dbgaufs.c b/fs/aufs/dbgaufs.c new file mode 100644 -index 0000000..4db01e8 +index 000000000000..ec512d378dda --- /dev/null +++ b/fs/aufs/dbgaufs.c @@ -0,0 +1,425 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -5302,7 +5561,7 @@ index 0000000..4db01e8 +static int dbgaufs_xi_release(struct inode *inode __maybe_unused, + struct file *file) +{ -+ au_delayed_kfree(file->private_data); ++ kfree(file->private_data); + return 0; +} + @@ -5323,15 +5582,15 @@ index 0000000..4db01e8 + if (!xf) + goto out; + -+ err = vfs_getattr(&xf->f_path, &st); ++ err = vfsub_getattr(&xf->f_path, &st); + if (!err) { + if (do_fcnt) + p->n = snprintf -+ (p->a, sizeof(p->a), "%ld, %llux%lu %lld\n", ++ (p->a, sizeof(p->a), "%ld, %llux%u %lld\n", + (long)file_count(xf), st.blocks, st.blksize, + (long long)st.size); + else -+ p->n = snprintf(p->a, sizeof(p->a), "%llux%lu %lld\n", ++ p->n = snprintf(p->a, sizeof(p->a), "%llux%u %lld\n", + st.blocks, st.blksize, + (long long)st.size); + AuDebugOn(p->n >= sizeof(p->a)); @@ -5364,7 +5623,7 @@ index 0000000..4db01e8 +static int dbgaufs_plink_release(struct inode *inode __maybe_unused, + struct file *file) +{ -+ au_delayed_free_page((unsigned long)file->private_data); ++ free_page((unsigned long)file->private_data); + return 0; +} + @@ -5375,7 +5634,7 @@ index 0000000..4db01e8 + struct dbgaufs_plink_arg *p; + struct au_sbinfo *sbinfo; + struct super_block *sb; -+ struct au_sphlhead *sphl; ++ struct hlist_bl_head *hbl; + + err = -ENOMEM; + p = (void *)get_zeroed_page(GFP_NOFS); @@ -5395,10 +5654,9 @@ index 0000000..4db01e8 + limit -= n; + + sum = 0; -+ for (i = 0, sphl = sbinfo->si_plink; -+ i < AuPlink_NHASH; -+ i++, sphl++) { -+ n = au_sphl_count(sphl); ++ for (i = 0, hbl = sbinfo->si_plink; i < AuPlink_NHASH; ++ i++, hbl++) { ++ n = au_hbl_count(hbl); + sum += n; + + n = snprintf(p->a + p->n, limit, "%lu ", n); @@ -5428,7 +5686,7 @@ index 0000000..4db01e8 + goto out; /* success */ + +out_free: -+ au_delayed_free_page((unsigned long)p); ++ free_page((unsigned long)p); +out: + return err; +} @@ -5699,12 +5957,13 @@ index 0000000..4db01e8 +} diff --git a/fs/aufs/dbgaufs.h b/fs/aufs/dbgaufs.h new file mode 100644 -index 0000000..81f272e +index 000000000000..323a96962aef --- /dev/null +++ b/fs/aufs/dbgaufs.h -@@ -0,0 +1,35 @@ +@@ -0,0 +1,36 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -5740,12 +5999,13 @@ index 0000000..81f272e +#endif /* __DBGAUFS_H__ */ diff --git a/fs/aufs/dcsub.c b/fs/aufs/dcsub.c new file mode 100644 -index 0000000..5d46398 +index 000000000000..0541d11207f2 --- /dev/null +++ b/fs/aufs/dcsub.c -@@ -0,0 +1,212 @@ +@@ -0,0 +1,213 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -5762,7 +6022,7 @@ index 0000000..5d46398 + p = dpage->dentries; + for (i = 0; i < dpage->ndentry; i++) + dput(*p++); -+ au_delayed_free_page((unsigned long)dpage->dentries); ++ free_page((unsigned long)dpage->dentries); +} + +int au_dpages_init(struct au_dcsub_pages *dpages, gfp_t gfp) @@ -5785,7 +6045,7 @@ index 0000000..5d46398 + return 0; /* success */ + +out_dpages: -+ au_delayed_kfree(dpages->dpages); ++ kfree(dpages->dpages); +out: + return err; +} @@ -5798,7 +6058,7 @@ index 0000000..5d46398 + p = dpages->dpages; + for (i = 0; i < dpages->ndpage; i++) + au_dpage_free(p++); -+ au_delayed_kfree(dpages->dpages); ++ kfree(dpages->dpages); +} + +static int au_dpages_append(struct au_dcsub_pages *dpages, @@ -5958,12 +6218,13 @@ index 0000000..5d46398 +} diff --git a/fs/aufs/dcsub.h b/fs/aufs/dcsub.h new file mode 100644 -index 0000000..5d2cf66 +index 000000000000..3b19330c1f50 --- /dev/null +++ b/fs/aufs/dcsub.h -@@ -0,0 +1,123 @@ +@@ -0,0 +1,124 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -6087,12 +6348,13 @@ index 0000000..5d2cf66 +#endif /* __AUFS_DCSUB_H__ */ diff --git a/fs/aufs/debug.c b/fs/aufs/debug.c new file mode 100644 -index 0000000..443fee3 +index 000000000000..7b39a8d5965d --- /dev/null +++ b/fs/aufs/debug.c -@@ -0,0 +1,427 @@ +@@ -0,0 +1,428 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -6416,7 +6678,7 @@ index 0000000..443fee3 + au_br_count_init(&a->fake); + err = do_pri_br(-1, &a->fake); + au_br_count_fin(&a->fake); -+ au_delayed_kfree(a); ++ kfree(a); + dpri("dev 0x%x\n", sb->s_dev); + if (err || !au_test_aufs(sb)) + return; @@ -6426,7 +6688,7 @@ index 0000000..443fee3 + return; + dpri("nw %d, gen %u, kobj %d\n", + atomic_read(&sbinfo->si_nowait.nw_len), sbinfo->si_generation, -+ atomic_read(&sbinfo->si_kobj.kref.refcount)); ++ kref_read(&sbinfo->si_kobj.kref)); + for (bindex = 0; bindex <= sbinfo->si_bbot; bindex++) + do_pri_br(bindex, sbinfo->si_branch[0 + bindex]); +} @@ -6520,12 +6782,13 @@ index 0000000..443fee3 +} diff --git a/fs/aufs/debug.h b/fs/aufs/debug.h new file mode 100644 -index 0000000..0567f31 +index 000000000000..5f3245be378e --- /dev/null +++ b/fs/aufs/debug.h -@@ -0,0 +1,212 @@ +@@ -0,0 +1,213 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -6738,12 +7001,13 @@ index 0000000..0567f31 +#endif /* __AUFS_DEBUG_H__ */ diff --git a/fs/aufs/dentry.c b/fs/aufs/dentry.c new file mode 100644 -index 0000000..5eb4f36 +index 000000000000..de83d9e5b94d --- /dev/null +++ b/fs/aufs/dentry.c -@@ -0,0 +1,1117 @@ +@@ -0,0 +1,1140 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -6753,19 +7017,13 @@ index 0000000..5eb4f36 +#include +#include "aufs.h" + -+struct au_do_lookup_args { -+ unsigned int flags; -+ mode_t type; -+}; -+ +/* + * returns positive/negative dentry, NULL or an error. + * NULL means whiteout-ed or not-found. + */ +static struct dentry* +au_do_lookup(struct dentry *h_parent, struct dentry *dentry, -+ aufs_bindex_t bindex, struct qstr *wh_name, -+ struct au_do_lookup_args *args) ++ aufs_bindex_t bindex, struct au_do_lookup_args *args) +{ + struct dentry *h_dentry; + struct inode *h_inode; @@ -6780,7 +7038,7 @@ index 0000000..5eb4f36 + br = au_sbr(dentry->d_sb, bindex); + wh_able = !!au_br_whable(br->br_perm); + if (wh_able) -+ wh_found = au_wh_test(h_parent, wh_name, ignore_perm); ++ wh_found = au_wh_test(h_parent, &args->whname, ignore_perm); + h_dentry = ERR_PTR(wh_found); + if (!wh_found) + goto real_lookup; @@ -6795,9 +7053,9 @@ index 0000000..5eb4f36 + +real_lookup: + if (!ignore_perm) -+ h_dentry = vfsub_lkup_one(&dentry->d_name, h_parent); ++ h_dentry = vfsub_lkup_one(args->name, h_parent); + else -+ h_dentry = au_sio_lkup_one(&dentry->d_name, h_parent); ++ h_dentry = au_sio_lkup_one(args->name, h_parent); + if (IS_ERR(h_dentry)) { + if (PTR_ERR(h_dentry) == -ENAMETOOLONG + && !allow_neg) @@ -6812,6 +7070,13 @@ index 0000000..5eb4f36 + } else if (wh_found + || (args->type && args->type != (h_inode->i_mode & S_IFMT))) + goto out_neg; ++ else if (au_ftest_lkup(args->flags, DIRREN) ++ /* && h_inode */ ++ && !au_dr_lkup_h_ino(args, bindex, h_inode->i_ino)) { ++ AuDbg("b%d %pd ignored hi%llu\n", bindex, h_dentry, ++ (unsigned long long)h_inode->i_ino); ++ goto out_neg; ++ } + + if (au_dbbot(dentry) <= bindex) + au_set_dbbot(dentry, bindex); @@ -6824,9 +7089,9 @@ index 0000000..5eb4f36 + || (d_really_is_positive(dentry) && !d_is_dir(dentry))) + goto out; /* success */ + -+ inode_lock_nested(h_inode, AuLsc_I_CHILD); ++ vfsub_inode_lock_shared_nested(h_inode, AuLsc_I_CHILD); + opq = au_diropq_test(h_dentry); -+ inode_unlock(h_inode); ++ inode_unlock_shared(h_inode); + if (opq > 0) + au_set_dbdiropq(dentry, bindex); + else if (unlikely(opq < 0)) { @@ -6860,26 +7125,28 @@ index 0000000..5eb4f36 +{ + int npositive, err; + aufs_bindex_t bindex, btail, bdiropq; -+ unsigned char isdir, dirperm1; -+ struct qstr whname; ++ unsigned char isdir, dirperm1, dirren; + struct au_do_lookup_args args = { -+ .flags = flags ++ .flags = flags, ++ .name = &dentry->d_name + }; -+ const struct qstr *name = &dentry->d_name; + struct dentry *parent; + struct super_block *sb; + + sb = dentry->d_sb; -+ err = au_test_shwh(sb, name); ++ err = au_test_shwh(sb, args.name); + if (unlikely(err)) + goto out; + -+ err = au_wh_name_alloc(&whname, name); ++ err = au_wh_name_alloc(&args.whname, args.name); + if (unlikely(err)) + goto out; + + isdir = !!d_is_dir(dentry); + dirperm1 = !!au_opt_test(au_mntflags(sb), DIRPERM1); ++ dirren = !!au_opt_test(au_mntflags(sb), DIRREN); ++ if (dirren) ++ au_fset_lkup(args.flags, DIRREN); + + npositive = 0; + parent = dget_parent(dentry); @@ -6887,6 +7154,7 @@ index 0000000..5eb4f36 + for (bindex = btop; bindex <= btail; bindex++) { + struct dentry *h_parent, *h_dentry; + struct inode *h_inode, *h_dir; ++ struct au_branch *br; + + h_dentry = au_h_dptr(dentry, bindex); + if (h_dentry) { @@ -6898,11 +7166,17 @@ index 0000000..5eb4f36 + if (!h_parent || !d_is_dir(h_parent)) + continue; + ++ if (dirren) { ++ /* if the inum matches, then use the prepared name */ ++ err = au_dr_lkup_name(&args, bindex); ++ if (unlikely(err)) ++ goto out_parent; ++ } ++ + h_dir = d_inode(h_parent); -+ inode_lock_nested(h_dir, AuLsc_I_PARENT); -+ h_dentry = au_do_lookup(h_parent, dentry, bindex, &whname, -+ &args); -+ inode_unlock(h_dir); ++ vfsub_inode_lock_shared_nested(h_dir, AuLsc_I_PARENT); ++ h_dentry = au_do_lookup(h_parent, dentry, bindex, &args); ++ inode_unlock_shared(h_dir); + err = PTR_ERR(h_dentry); + if (IS_ERR(h_dentry)) + goto out_parent; @@ -6929,6 +7203,15 @@ index 0000000..5eb4f36 + if (bdiropq >= 0 && bdiropq <= bindex) + break; + } ++ br = au_sbr(sb, bindex); ++ if (dirren ++ && au_dr_hino_test_add(&br->br_dirren, h_inode->i_ino, ++ /*add_ent*/NULL)) { ++ /* prepare next name to lookup */ ++ err = au_dr_lkup(&args, dentry, bindex); ++ if (unlikely(err)) ++ goto out_parent; ++ } + } + + if (npositive) { @@ -6945,7 +7228,9 @@ index 0000000..5eb4f36 + +out_parent: + dput(parent); -+ au_delayed_kfree(whname.name); ++ kfree(args.whname.name); ++ if (dirren) ++ au_dr_lkup_fin(&args); +out: + return err; +} @@ -7554,7 +7839,7 @@ index 0000000..5eb4f36 + +/* todo: remove this */ +static int h_d_revalidate(struct dentry *dentry, struct inode *inode, -+ unsigned int flags, int do_udba) ++ unsigned int flags, int do_udba, int dirren) +{ + int err; + umode_t mode, h_mode; @@ -7605,7 +7890,7 @@ index 0000000..5eb4f36 + && !is_root + && ((!h_nfs + && (unhashed != !!d_unhashed(h_dentry) -+ || (!tmpfile ++ || (!tmpfile && !dirren + && !au_qstreq(name, h_name)) + )) + || (h_nfs @@ -7746,7 +8031,7 @@ index 0000000..5eb4f36 +{ + int valid, err; + unsigned int sigen; -+ unsigned char do_udba; ++ unsigned char do_udba, dirren; + struct super_block *sb; + struct inode *inode; + @@ -7819,7 +8104,8 @@ index 0000000..5eb4f36 + } + } + -+ err = h_d_revalidate(dentry, inode, flags, do_udba); ++ dirren = !!au_opt_test(au_mntflags(sb), DIRREN); ++ err = h_d_revalidate(dentry, inode, flags, do_udba, dirren); + if (unlikely(!err && do_udba && au_dbtop(dentry) < 0)) { + err = -EIO; + AuDbg("both of real entry and whiteout found, %p, err %d\n", @@ -7861,12 +8147,13 @@ index 0000000..5eb4f36 +}; diff --git a/fs/aufs/dentry.h b/fs/aufs/dentry.h new file mode 100644 -index 0000000..01211d2 +index 000000000000..4f3f8b838bb4 --- /dev/null +++ b/fs/aufs/dentry.h -@@ -0,0 +1,242 @@ +@@ -0,0 +1,254 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -7879,6 +8166,7 @@ index 0000000..01211d2 +#ifdef __KERNEL__ + +#include ++#include "dirren.h" +#include "rwsem.h" + +struct au_hdentry { @@ -7892,10 +8180,7 @@ index 0000000..01211d2 + struct au_rwsem di_rwsem; + aufs_bindex_t di_btop, di_bbot, di_bwh, di_bdiropq; + unsigned char di_tmpfile; /* to allow the different name */ -+ union { -+ struct au_hdentry *di_hdentry; -+ struct llist_node di_lnode; /* delayed free */ -+ }; ++ struct au_hdentry *di_hdentry; +} ____cacheline_aligned_in_smp; + +/* ---------------------------------------------------------------------- */ @@ -7903,12 +8188,25 @@ index 0000000..01211d2 +/* flags for au_lkup_dentry() */ +#define AuLkup_ALLOW_NEG 1 +#define AuLkup_IGNORE_PERM (1 << 1) ++#define AuLkup_DIRREN (1 << 2) +#define au_ftest_lkup(flags, name) ((flags) & AuLkup_##name) +#define au_fset_lkup(flags, name) \ + do { (flags) |= AuLkup_##name; } while (0) +#define au_fclr_lkup(flags, name) \ + do { (flags) &= ~AuLkup_##name; } while (0) + ++#ifndef CONFIG_AUFS_DIRREN ++#undef AuLkup_DIRREN ++#define AuLkup_DIRREN 0 ++#endif ++ ++struct au_do_lookup_args { ++ unsigned int flags; ++ mode_t type; ++ struct qstr whname, *name; ++ struct au_dr_lookup dirren; ++}; ++ +/* ---------------------------------------------------------------------- */ + +/* dentry.c */ @@ -8109,12 +8407,13 @@ index 0000000..01211d2 +#endif /* __AUFS_DENTRY_H__ */ diff --git a/fs/aufs/dinfo.c b/fs/aufs/dinfo.c new file mode 100644 -index 0000000..2626c0c +index 000000000000..ad8e3487db0b --- /dev/null +++ b/fs/aufs/dinfo.c -@@ -0,0 +1,540 @@ +@@ -0,0 +1,541 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -8155,7 +8454,7 @@ index 0000000..2626c0c + goto out; + } + -+ au_cache_dfree_dinfo(dinfo); ++ au_cache_free_dinfo(dinfo); + dinfo = NULL; + +out: @@ -8175,8 +8474,8 @@ index 0000000..2626c0c + while (bindex++ <= bbot) + au_hdput(p++); + } -+ au_delayed_kfree(dinfo->di_hdentry); -+ au_cache_dfree_dinfo(dinfo); ++ kfree(dinfo->di_hdentry); ++ au_cache_free_dinfo(dinfo); +} + +void au_di_swap(struct au_dinfo *a, struct au_dinfo *b) @@ -8378,11 +8677,11 @@ index 0000000..2626c0c + || d_inode(d1) == d_inode(d2) + || d1->d_sb != d2->d_sb); + -+ if (isdir && au_test_subdir(d1, d2)) { ++ if ((isdir && au_test_subdir(d1, d2)) ++ || d1 < d2) { + di_write_lock_child(d1); + di_write_lock_child2(d2); + } else { -+ /* there should be no races */ + di_write_lock_child(d2); + di_write_lock_child2(d1); + } @@ -8394,11 +8693,11 @@ index 0000000..2626c0c + || d_inode(d1) == d_inode(d2) + || d1->d_sb != d2->d_sb); + -+ if (isdir && au_test_subdir(d1, d2)) { ++ if ((isdir && au_test_subdir(d1, d2)) ++ || d1 < d2) { + di_write_lock_parent(d1); + di_write_lock_parent2(d2); + } else { -+ /* there should be no races */ + di_write_lock_parent(d2); + di_write_lock_parent2(d1); + } @@ -8655,12 +8954,13 @@ index 0000000..2626c0c +} diff --git a/fs/aufs/dir.c b/fs/aufs/dir.c new file mode 100644 -index 0000000..395563e +index 000000000000..aab6ff4c412b --- /dev/null +++ b/fs/aufs/dir.c -@@ -0,0 +1,749 @@ +@@ -0,0 +1,747 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -8804,7 +9104,7 @@ index 0000000..395563e +out: + dput(a->dentry); + au_nwt_done(&au_sbi(sb)->si_nowait); -+ au_delayed_kfree(arg); ++ kfree(arg); +} + +void au_dir_ts(struct inode *dir, aufs_bindex_t bindex) @@ -8840,7 +9140,7 @@ index 0000000..395563e + if (unlikely(wkq_err)) { + pr_err("wkq %d\n", wkq_err); + dput(dentry); -+ au_delayed_kfree(arg); ++ kfree(arg); + } + +out: @@ -8959,7 +9259,7 @@ index 0000000..395563e + }; + err = au_do_open(file, &args); + if (unlikely(err)) -+ au_delayed_kfree(fidir); ++ kfree(fidir); + } + si_read_unlock(sb); + return err; @@ -8973,21 +9273,18 @@ index 0000000..395563e + struct au_fidir *fidir; + struct au_hfile *hf; + aufs_bindex_t bindex, bbot; -+ int execed, delayed; + -+ delayed = (current->flags & PF_KTHREAD) || in_interrupt(); + finfo = au_fi(file); + fidir = finfo->fi_hdir; + if (fidir) { -+ au_sphl_del(&finfo->fi_hlist, -+ &au_sbi(file->f_path.dentry->d_sb)->si_files); ++ au_hbl_del(&finfo->fi_hlist, ++ &au_sbi(file->f_path.dentry->d_sb)->si_files); + vdir_cache = fidir->fd_vdir_cache; /* lock-free */ + if (vdir_cache) -+ au_vdir_free(vdir_cache, delayed); ++ au_vdir_free(vdir_cache); + + bindex = finfo->fi_btop; + if (bindex >= 0) { -+ execed = vfsub_file_execed(file); + hf = fidir->fd_hfile + bindex; + /* + * calls fput() instead of filp_close(), @@ -8996,12 +9293,12 @@ index 0000000..395563e + bbot = fidir->fd_bbot; + for (; bindex <= bbot; bindex++, hf++) + if (hf->hf_file) -+ au_hfput(hf, execed); ++ au_hfput(hf, /*execed*/0); + } -+ au_delayed_kfree(fidir); ++ kfree(fidir); + finfo->fi_hdir = NULL; + } -+ au_finfo_fin(file, delayed); ++ au_finfo_fin(file); + return 0; +} + @@ -9066,7 +9363,7 @@ index 0000000..395563e + struct super_block *sb; + struct inode *inode; + -+ err = au_reval_and_lock_fdi(file, reopen_dir, /*wlock*/1); ++ err = au_reval_and_lock_fdi(file, reopen_dir, /*wlock*/1, /*fi_lsc*/0); + if (unlikely(err)) + goto out; + @@ -9135,7 +9432,7 @@ index 0000000..395563e + + sb = dentry->d_sb; + si_read_lock(sb, AuLock_FLUSH); -+ err = au_reval_and_lock_fdi(file, reopen_dir, /*wlock*/1); ++ err = au_reval_and_lock_fdi(file, reopen_dir, /*wlock*/1, /*fi_lsc*/0); + if (unlikely(err)) + goto out; + err = au_alive_dir(dentry); @@ -9288,9 +9585,9 @@ index 0000000..395563e + h_dentry = au_h_dptr(dentry, arg->bindex); + h_inode = d_inode(h_dentry); + /* todo: i_mode changes anytime? */ -+ inode_lock_nested(h_inode, AuLsc_I_CHILD); ++ vfsub_inode_lock_shared_nested(h_inode, AuLsc_I_CHILD); + err = au_test_h_perm_sio(h_inode, MAY_EXEC | MAY_READ); -+ inode_unlock(h_inode); ++ inode_unlock_shared(h_inode); + if (!err) + err = do_test_empty(dentry, arg); + else { @@ -9410,12 +9707,13 @@ index 0000000..395563e +}; diff --git a/fs/aufs/dir.h b/fs/aufs/dir.h new file mode 100644 -index 0000000..4f3945a +index 000000000000..04b652f787d6 --- /dev/null +++ b/fs/aufs/dir.h -@@ -0,0 +1,124 @@ +@@ -0,0 +1,119 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -9445,10 +9743,7 @@ index 0000000..4f3945a + +struct au_vdir_dehstr { + struct hlist_node hash; -+ union { -+ struct au_vdir_destr *str; -+ struct llist_node lnode; /* delayed free */ -+ }; ++ struct au_vdir_destr *str; +} ____cacheline_aligned_in_smp; + +struct au_vdir_de { @@ -9486,10 +9781,7 @@ index 0000000..4f3945a + + unsigned long vd_version; + unsigned int vd_deblk_sz; -+ union { -+ unsigned long vd_jiffy; -+ struct llist_node vd_lnode; /* delayed free */ -+ }; ++ unsigned long vd_jiffy; +} ____cacheline_aligned_in_smp; + +/* ---------------------------------------------------------------------- */ @@ -9513,7 +9805,7 @@ index 0000000..4f3945a +int au_nhash_append_wh(struct au_nhash *whlist, char *name, int nlen, ino_t ino, + unsigned int d_type, aufs_bindex_t bindex, + unsigned char shwh); -+void au_vdir_free(struct au_vdir *vdir, int atonce); ++void au_vdir_free(struct au_vdir *vdir); +int au_vdir_init(struct file *file); +int au_vdir_fill_de(struct file *file, struct dir_context *ctx); + @@ -9538,14 +9830,1457 @@ index 0000000..4f3945a + +#endif /* __KERNEL__ */ +#endif /* __AUFS_DIR_H__ */ +diff --git a/fs/aufs/dirren.c b/fs/aufs/dirren.c +new file mode 100644 +index 000000000000..56fec6307e6b +--- /dev/null ++++ b/fs/aufs/dirren.c +@@ -0,0 +1,1303 @@ ++/* ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2017 Junjiro R. Okajima ++ */ ++ ++/* ++ * special handling in renaming a directoy ++ * in order to support looking-up the before-renamed name on the lower readonly ++ * branches ++ */ ++ ++#include ++#include "aufs.h" ++ ++static void au_dr_hino_del(struct au_dr_br *dr, struct au_dr_hino *ent) ++{ ++ int idx; ++ ++ idx = au_dr_ihash(ent->dr_h_ino); ++ au_hbl_del(&ent->dr_hnode, dr->dr_h_ino + idx); ++} ++ ++static int au_dr_hino_test_empty(struct au_dr_br *dr) ++{ ++ int ret, i; ++ struct hlist_bl_head *hbl; ++ ++ ret = 1; ++ for (i = 0; ret && i < AuDirren_NHASH; i++) { ++ hbl = dr->dr_h_ino + i; ++ hlist_bl_lock(hbl); ++ ret &= hlist_bl_empty(hbl); ++ hlist_bl_unlock(hbl); ++ } ++ ++ return ret; ++} ++ ++static struct au_dr_hino *au_dr_hino_find(struct au_dr_br *dr, ino_t ino) ++{ ++ struct au_dr_hino *found, *ent; ++ struct hlist_bl_head *hbl; ++ struct hlist_bl_node *pos; ++ int idx; ++ ++ found = NULL; ++ idx = au_dr_ihash(ino); ++ hbl = dr->dr_h_ino + idx; ++ hlist_bl_lock(hbl); ++ hlist_bl_for_each_entry(ent, pos, hbl, dr_hnode) ++ if (ent->dr_h_ino == ino) { ++ found = ent; ++ break; ++ } ++ hlist_bl_unlock(hbl); ++ ++ return found; ++} ++ ++int au_dr_hino_test_add(struct au_dr_br *dr, ino_t ino, ++ struct au_dr_hino *add_ent) ++{ ++ int found, idx; ++ struct hlist_bl_head *hbl; ++ struct hlist_bl_node *pos; ++ struct au_dr_hino *ent; ++ ++ found = 0; ++ idx = au_dr_ihash(ino); ++ hbl = dr->dr_h_ino + idx; ++#if 0 ++ { ++ struct hlist_bl_node *tmp; ++ ++ hlist_bl_for_each_entry_safe(ent, pos, tmp, hbl, dr_hnode) ++ AuDbg("hi%llu\n", (unsigned long long)ent->dr_h_ino); ++ } ++#endif ++ hlist_bl_lock(hbl); ++ hlist_bl_for_each_entry(ent, pos, hbl, dr_hnode) ++ if (ent->dr_h_ino == ino) { ++ found = 1; ++ break; ++ } ++ if (!found && add_ent) ++ hlist_bl_add_head(&add_ent->dr_hnode, hbl); ++ hlist_bl_unlock(hbl); ++ ++ if (!found && add_ent) ++ AuDbg("i%llu added\n", (unsigned long long)add_ent->dr_h_ino); ++ ++ return found; ++} ++ ++void au_dr_hino_free(struct au_dr_br *dr) ++{ ++ int i; ++ struct hlist_bl_head *hbl; ++ struct hlist_bl_node *pos, *tmp; ++ struct au_dr_hino *ent; ++ ++ /* SiMustWriteLock(sb); */ ++ ++ for (i = 0; i < AuDirren_NHASH; i++) { ++ hbl = dr->dr_h_ino + i; ++ /* no spinlock since sbinfo must be write-locked */ ++ hlist_bl_for_each_entry_safe(ent, pos, tmp, hbl, dr_hnode) ++ kfree(ent); ++ INIT_HLIST_BL_HEAD(hbl); ++ } ++} ++ ++/* returns the number of inodes or an error */ ++static int au_dr_hino_store(struct super_block *sb, struct au_branch *br, ++ struct file *hinofile) ++{ ++ int err, i; ++ ssize_t ssz; ++ loff_t pos, oldsize; ++ __be64 u64; ++ struct inode *hinoinode; ++ struct hlist_bl_head *hbl; ++ struct hlist_bl_node *n1, *n2; ++ struct au_dr_hino *ent; ++ ++ SiMustWriteLock(sb); ++ AuDebugOn(!au_br_writable(br->br_perm)); ++ ++ hinoinode = file_inode(hinofile); ++ oldsize = i_size_read(hinoinode); ++ ++ err = 0; ++ pos = 0; ++ hbl = br->br_dirren.dr_h_ino; ++ for (i = 0; !err && i < AuDirren_NHASH; i++, hbl++) { ++ /* no bit-lock since sbinfo must be write-locked */ ++ hlist_bl_for_each_entry_safe(ent, n1, n2, hbl, dr_hnode) { ++ AuDbg("hi%llu, %pD2\n", ++ (unsigned long long)ent->dr_h_ino, hinofile); ++ u64 = cpu_to_be64(ent->dr_h_ino); ++ ssz = vfsub_write_k(hinofile, &u64, sizeof(u64), &pos); ++ if (ssz == sizeof(u64)) ++ continue; ++ ++ /* write error */ ++ pr_err("ssz %zd, %pD2\n", ssz, hinofile); ++ err = -ENOSPC; ++ if (ssz < 0) ++ err = ssz; ++ break; ++ } ++ } ++ /* regardless the error */ ++ if (pos < oldsize) { ++ err = vfsub_trunc(&hinofile->f_path, pos, /*attr*/0, hinofile); ++ AuTraceErr(err); ++ } ++ ++ AuTraceErr(err); ++ return err; ++} ++ ++static int au_dr_hino_load(struct au_dr_br *dr, struct file *hinofile) ++{ ++ int err, hidx; ++ ssize_t ssz; ++ size_t sz, n; ++ loff_t pos; ++ uint64_t u64; ++ struct au_dr_hino *ent; ++ struct inode *hinoinode; ++ struct hlist_bl_head *hbl; ++ ++ err = 0; ++ pos = 0; ++ hbl = dr->dr_h_ino; ++ hinoinode = file_inode(hinofile); ++ sz = i_size_read(hinoinode); ++ AuDebugOn(sz % sizeof(u64)); ++ n = sz / sizeof(u64); ++ while (n--) { ++ ssz = vfsub_read_k(hinofile, &u64, sizeof(u64), &pos); ++ if (unlikely(ssz != sizeof(u64))) { ++ pr_err("ssz %zd, %pD2\n", ssz, hinofile); ++ err = -EINVAL; ++ if (ssz < 0) ++ err = ssz; ++ goto out_free; ++ } ++ ++ ent = kmalloc(sizeof(*ent), GFP_NOFS); ++ if (!ent) { ++ err = -ENOMEM; ++ AuTraceErr(err); ++ goto out_free; ++ } ++ ent->dr_h_ino = be64_to_cpu((__force __be64)u64); ++ AuDbg("hi%llu, %pD2\n", ++ (unsigned long long)ent->dr_h_ino, hinofile); ++ hidx = au_dr_ihash(ent->dr_h_ino); ++ au_hbl_add(&ent->dr_hnode, hbl + hidx); ++ } ++ goto out; /* success */ ++ ++out_free: ++ au_dr_hino_free(dr); ++out: ++ AuTraceErr(err); ++ return err; ++} ++ ++/* ++ * @bindex/@br is a switch to distinguish whether suspending hnotify or not. ++ * @path is a switch to distinguish load and store. ++ */ ++static int au_dr_hino(struct super_block *sb, aufs_bindex_t bindex, ++ struct au_branch *br, const struct path *path) ++{ ++ int err, flags; ++ unsigned char load, suspend; ++ struct file *hinofile; ++ struct au_hinode *hdir; ++ struct inode *dir, *delegated; ++ struct path hinopath; ++ struct qstr hinoname = QSTR_INIT(AUFS_WH_DR_BRHINO, ++ sizeof(AUFS_WH_DR_BRHINO) - 1); ++ ++ AuDebugOn(bindex < 0 && !br); ++ AuDebugOn(bindex >= 0 && br); ++ ++ err = -EINVAL; ++ suspend = !br; ++ if (suspend) ++ br = au_sbr(sb, bindex); ++ load = !!path; ++ if (!load) { ++ path = &br->br_path; ++ AuDebugOn(!au_br_writable(br->br_perm)); ++ if (unlikely(!au_br_writable(br->br_perm))) ++ goto out; ++ } ++ ++ hdir = NULL; ++ if (suspend) { ++ dir = d_inode(sb->s_root); ++ hdir = au_hinode(au_ii(dir), bindex); ++ dir = hdir->hi_inode; ++ au_hn_inode_lock_nested(hdir, AuLsc_I_CHILD); ++ } else { ++ dir = d_inode(path->dentry); ++ inode_lock_nested(dir, AuLsc_I_CHILD); ++ } ++ hinopath.dentry = vfsub_lkup_one(&hinoname, path->dentry); ++ err = PTR_ERR(hinopath.dentry); ++ if (IS_ERR(hinopath.dentry)) ++ goto out_unlock; ++ ++ err = 0; ++ flags = O_RDONLY; ++ if (load) { ++ if (d_is_negative(hinopath.dentry)) ++ goto out_dput; /* success */ ++ } else { ++ if (au_dr_hino_test_empty(&br->br_dirren)) { ++ if (d_is_positive(hinopath.dentry)) { ++ delegated = NULL; ++ err = vfsub_unlink(dir, &hinopath, &delegated, ++ /*force*/0); ++ AuTraceErr(err); ++ if (unlikely(err)) ++ pr_err("ignored err %d, %pd2\n", ++ err, hinopath.dentry); ++ if (unlikely(err == -EWOULDBLOCK)) ++ iput(delegated); ++ err = 0; ++ } ++ goto out_dput; ++ } else if (!d_is_positive(hinopath.dentry)) { ++ err = vfsub_create(dir, &hinopath, 0600, ++ /*want_excl*/false); ++ AuTraceErr(err); ++ if (unlikely(err)) ++ goto out_dput; ++ } ++ flags = O_WRONLY; ++ } ++ hinopath.mnt = path->mnt; ++ hinofile = vfsub_dentry_open(&hinopath, flags); ++ if (suspend) ++ au_hn_inode_unlock(hdir); ++ else ++ inode_unlock(dir); ++ dput(hinopath.dentry); ++ AuTraceErrPtr(hinofile); ++ if (IS_ERR(hinofile)) { ++ err = PTR_ERR(hinofile); ++ goto out; ++ } ++ ++ if (load) ++ err = au_dr_hino_load(&br->br_dirren, hinofile); ++ else ++ err = au_dr_hino_store(sb, br, hinofile); ++ fput(hinofile); ++ goto out; ++ ++out_dput: ++ dput(hinopath.dentry); ++out_unlock: ++ if (suspend) ++ au_hn_inode_unlock(hdir); ++ else ++ inode_unlock(dir); ++out: ++ AuTraceErr(err); ++ return err; ++} ++ ++/* ---------------------------------------------------------------------- */ ++ ++static int au_dr_brid_init(struct au_dr_brid *brid, const struct path *path) ++{ ++ int err; ++ struct kstatfs kstfs; ++ dev_t dev; ++ struct dentry *dentry; ++ struct super_block *sb; ++ ++ err = vfs_statfs((void *)path, &kstfs); ++ AuTraceErr(err); ++ if (unlikely(err)) ++ goto out; ++ ++ /* todo: support for UUID */ ++ ++ if (kstfs.f_fsid.val[0] || kstfs.f_fsid.val[1]) { ++ brid->type = AuBrid_FSID; ++ brid->fsid = kstfs.f_fsid; ++ } else { ++ dentry = path->dentry; ++ sb = dentry->d_sb; ++ dev = sb->s_dev; ++ if (dev) { ++ brid->type = AuBrid_DEV; ++ brid->dev = dev; ++ } ++ } ++ ++out: ++ return err; ++} ++ ++int au_dr_br_init(struct super_block *sb, struct au_branch *br, ++ const struct path *path) ++{ ++ int err, i; ++ struct au_dr_br *dr; ++ struct hlist_bl_head *hbl; ++ ++ dr = &br->br_dirren; ++ hbl = dr->dr_h_ino; ++ for (i = 0; i < AuDirren_NHASH; i++, hbl++) ++ INIT_HLIST_BL_HEAD(hbl); ++ ++ err = au_dr_brid_init(&dr->dr_brid, path); ++ if (unlikely(err)) ++ goto out; ++ ++ if (au_opt_test(au_mntflags(sb), DIRREN)) ++ err = au_dr_hino(sb, /*bindex*/-1, br, path); ++ ++out: ++ AuTraceErr(err); ++ return err; ++} ++ ++int au_dr_br_fin(struct super_block *sb, struct au_branch *br) ++{ ++ int err; ++ ++ err = 0; ++ if (au_br_writable(br->br_perm)) ++ err = au_dr_hino(sb, /*bindex*/-1, br, /*path*/NULL); ++ if (!err) ++ au_dr_hino_free(&br->br_dirren); ++ ++ return err; ++} ++ ++/* ---------------------------------------------------------------------- */ ++ ++static int au_brid_str(struct au_dr_brid *brid, struct inode *h_inode, ++ char *buf, size_t sz) ++{ ++ int err; ++ unsigned int major, minor; ++ char *p; ++ ++ p = buf; ++ err = snprintf(p, sz, "%d_", brid->type); ++ AuDebugOn(err > sz); ++ p += err; ++ sz -= err; ++ switch (brid->type) { ++ case AuBrid_Unset: ++ return -EINVAL; ++ case AuBrid_UUID: ++ err = snprintf(p, sz, "%pU", brid->uuid.b); ++ break; ++ case AuBrid_FSID: ++ err = snprintf(p, sz, "%08x-%08x", ++ brid->fsid.val[0], brid->fsid.val[1]); ++ break; ++ case AuBrid_DEV: ++ major = MAJOR(brid->dev); ++ minor = MINOR(brid->dev); ++ if (major <= 0xff && minor <= 0xff) ++ err = snprintf(p, sz, "%02x%02x", major, minor); ++ else ++ err = snprintf(p, sz, "%03x:%05x", major, minor); ++ break; ++ } ++ AuDebugOn(err > sz); ++ p += err; ++ sz -= err; ++ err = snprintf(p, sz, "_%llu", (unsigned long long)h_inode->i_ino); ++ AuDebugOn(err > sz); ++ p += err; ++ sz -= err; ++ ++ return p - buf; ++} ++ ++static int au_drinfo_name(struct au_branch *br, char *name, int len) ++{ ++ int rlen; ++ struct dentry *br_dentry; ++ struct inode *br_inode; ++ ++ br_dentry = au_br_dentry(br); ++ br_inode = d_inode(br_dentry); ++ rlen = au_brid_str(&br->br_dirren.dr_brid, br_inode, name, len); ++ AuDebugOn(rlen >= AUFS_DIRREN_ENV_VAL_SZ); ++ AuDebugOn(rlen > len); ++ ++ return rlen; ++} ++ ++/* ---------------------------------------------------------------------- */ ++ ++/* ++ * from the given @h_dentry, construct drinfo at @*fdata. ++ * when the size of @*fdata is not enough, reallocate and return new @fdata and ++ * @allocated. ++ */ ++static int au_drinfo_construct(struct au_drinfo_fdata **fdata, ++ struct dentry *h_dentry, ++ unsigned char *allocated) ++{ ++ int err, v; ++ struct au_drinfo_fdata *f, *p; ++ struct au_drinfo *drinfo; ++ struct inode *h_inode; ++ struct qstr *qname; ++ ++ err = 0; ++ f = *fdata; ++ h_inode = d_inode(h_dentry); ++ qname = &h_dentry->d_name; ++ drinfo = &f->drinfo; ++ drinfo->ino = (__force uint64_t)cpu_to_be64(h_inode->i_ino); ++ drinfo->oldnamelen = qname->len; ++ if (*allocated < sizeof(*f) + qname->len) { ++ v = roundup_pow_of_two(*allocated + qname->len); ++ p = au_krealloc(f, v, GFP_NOFS, /*may_shrink*/0); ++ if (unlikely(!p)) { ++ err = -ENOMEM; ++ AuTraceErr(err); ++ goto out; ++ } ++ f = p; ++ *fdata = f; ++ *allocated = v; ++ drinfo = &f->drinfo; ++ } ++ memcpy(drinfo->oldname, qname->name, qname->len); ++ AuDbg("i%llu, %.*s\n", ++ be64_to_cpu((__force __be64)drinfo->ino), drinfo->oldnamelen, ++ drinfo->oldname); ++ ++out: ++ AuTraceErr(err); ++ return err; ++} ++ ++/* callers have to free the return value */ ++static struct au_drinfo *au_drinfo_read_k(struct file *file, ino_t h_ino) ++{ ++ struct au_drinfo *ret, *drinfo; ++ struct au_drinfo_fdata fdata; ++ int len; ++ loff_t pos; ++ ssize_t ssz; ++ ++ ret = ERR_PTR(-EIO); ++ pos = 0; ++ ssz = vfsub_read_k(file, &fdata, sizeof(fdata), &pos); ++ if (unlikely(ssz != sizeof(fdata))) { ++ AuIOErr("ssz %zd, %u, %pD2\n", ++ ssz, (unsigned int)sizeof(fdata), file); ++ goto out; ++ } ++ ++ fdata.magic = ntohl((__force __be32)fdata.magic); ++ switch (fdata.magic) { ++ case AUFS_DRINFO_MAGIC_V1: ++ break; ++ default: ++ AuIOErr("magic-num 0x%x, 0x%x, %pD2\n", ++ fdata.magic, AUFS_DRINFO_MAGIC_V1, file); ++ goto out; ++ } ++ ++ drinfo = &fdata.drinfo; ++ len = drinfo->oldnamelen; ++ if (!len) { ++ AuIOErr("broken drinfo %pD2\n", file); ++ goto out; ++ } ++ ++ ret = NULL; ++ drinfo->ino = be64_to_cpu((__force __be64)drinfo->ino); ++ if (unlikely(h_ino && drinfo->ino != h_ino)) { ++ AuDbg("ignored i%llu, i%llu, %pD2\n", ++ (unsigned long long)drinfo->ino, ++ (unsigned long long)h_ino, file); ++ goto out; /* success */ ++ } ++ ++ ret = kmalloc(sizeof(*ret) + len, GFP_NOFS); ++ if (unlikely(!ret)) { ++ ret = ERR_PTR(-ENOMEM); ++ AuTraceErrPtr(ret); ++ goto out; ++ } ++ ++ *ret = *drinfo; ++ ssz = vfsub_read_k(file, (void *)ret->oldname, len, &pos); ++ if (unlikely(ssz != len)) { ++ kfree(ret); ++ ret = ERR_PTR(-EIO); ++ AuIOErr("ssz %zd, %u, %pD2\n", ssz, len, file); ++ goto out; ++ } ++ ++ AuDbg("oldname %.*s\n", ret->oldnamelen, ret->oldname); ++ ++out: ++ return ret; ++} ++ ++/* ---------------------------------------------------------------------- */ ++ ++/* in order to be revertible */ ++struct au_drinfo_rev_elm { ++ int created; ++ struct dentry *info_dentry; ++ struct au_drinfo *info_last; ++}; ++ ++struct au_drinfo_rev { ++ unsigned char already; ++ aufs_bindex_t nelm; ++ struct au_drinfo_rev_elm elm[0]; ++}; ++ ++/* todo: isn't it too large? */ ++struct au_drinfo_store { ++ struct path h_ppath; ++ struct dentry *h_dentry; ++ struct au_drinfo_fdata *fdata; ++ char *infoname; /* inside of whname, just after PFX */ ++ char whname[sizeof(AUFS_WH_DR_INFO_PFX) + AUFS_DIRREN_ENV_VAL_SZ]; ++ aufs_bindex_t btgt, btail; ++ unsigned char no_sio, ++ allocated, /* current size of *fdata */ ++ infonamelen, /* room size for p */ ++ whnamelen, /* length of the genarated name */ ++ renameback; /* renamed back */ ++}; ++ ++/* on rename(2) error, the caller should revert it using @elm */ ++static int au_drinfo_do_store(struct au_drinfo_store *w, ++ struct au_drinfo_rev_elm *elm) ++{ ++ int err, len; ++ ssize_t ssz; ++ loff_t pos; ++ struct path infopath = { ++ .mnt = w->h_ppath.mnt ++ }; ++ struct inode *h_dir, *h_inode, *delegated; ++ struct file *infofile; ++ struct qstr *qname; ++ ++ AuDebugOn(elm ++ && memcmp(elm, page_address(ZERO_PAGE(0)), sizeof(*elm))); ++ ++ infopath.dentry = vfsub_lookup_one_len(w->whname, w->h_ppath.dentry, ++ w->whnamelen); ++ AuTraceErrPtr(infopath.dentry); ++ if (IS_ERR(infopath.dentry)) { ++ err = PTR_ERR(infopath.dentry); ++ goto out; ++ } ++ ++ err = 0; ++ h_dir = d_inode(w->h_ppath.dentry); ++ if (elm && d_is_negative(infopath.dentry)) { ++ err = vfsub_create(h_dir, &infopath, 0600, /*want_excl*/true); ++ AuTraceErr(err); ++ if (unlikely(err)) ++ goto out_dput; ++ elm->created = 1; ++ elm->info_dentry = dget(infopath.dentry); ++ } ++ ++ infofile = vfsub_dentry_open(&infopath, O_RDWR); ++ AuTraceErrPtr(infofile); ++ if (IS_ERR(infofile)) { ++ err = PTR_ERR(infofile); ++ goto out_dput; ++ } ++ ++ h_inode = d_inode(infopath.dentry); ++ if (elm && i_size_read(h_inode)) { ++ h_inode = d_inode(w->h_dentry); ++ elm->info_last = au_drinfo_read_k(infofile, h_inode->i_ino); ++ AuTraceErrPtr(elm->info_last); ++ if (IS_ERR(elm->info_last)) { ++ err = PTR_ERR(elm->info_last); ++ elm->info_last = NULL; ++ AuDebugOn(elm->info_dentry); ++ goto out_fput; ++ } ++ } ++ ++ if (elm && w->renameback) { ++ delegated = NULL; ++ err = vfsub_unlink(h_dir, &infopath, &delegated, /*force*/0); ++ AuTraceErr(err); ++ if (unlikely(err == -EWOULDBLOCK)) ++ iput(delegated); ++ goto out_fput; ++ } ++ ++ pos = 0; ++ qname = &w->h_dentry->d_name; ++ len = sizeof(*w->fdata) + qname->len; ++ if (!elm) ++ len = sizeof(*w->fdata) + w->fdata->drinfo.oldnamelen; ++ ssz = vfsub_write_k(infofile, w->fdata, len, &pos); ++ if (ssz == len) { ++ AuDbg("hi%llu, %.*s\n", w->fdata->drinfo.ino, ++ w->fdata->drinfo.oldnamelen, w->fdata->drinfo.oldname); ++ goto out_fput; /* success */ ++ } else { ++ err = -EIO; ++ if (ssz < 0) ++ err = ssz; ++ /* the caller should revert it using @elm */ ++ } ++ ++out_fput: ++ fput(infofile); ++out_dput: ++ dput(infopath.dentry); ++out: ++ AuTraceErr(err); ++ return err; ++} ++ ++struct au_call_drinfo_do_store_args { ++ int *errp; ++ struct au_drinfo_store *w; ++ struct au_drinfo_rev_elm *elm; ++}; ++ ++static void au_call_drinfo_do_store(void *args) ++{ ++ struct au_call_drinfo_do_store_args *a = args; ++ ++ *a->errp = au_drinfo_do_store(a->w, a->elm); ++} ++ ++static int au_drinfo_store_sio(struct au_drinfo_store *w, ++ struct au_drinfo_rev_elm *elm) ++{ ++ int err, wkq_err; ++ ++ if (w->no_sio) ++ err = au_drinfo_do_store(w, elm); ++ else { ++ struct au_call_drinfo_do_store_args a = { ++ .errp = &err, ++ .w = w, ++ .elm = elm ++ }; ++ wkq_err = au_wkq_wait(au_call_drinfo_do_store, &a); ++ if (unlikely(wkq_err)) ++ err = wkq_err; ++ } ++ AuTraceErr(err); ++ ++ return err; ++} ++ ++static int au_drinfo_store_work_init(struct au_drinfo_store *w, ++ aufs_bindex_t btgt) ++{ ++ int err; ++ ++ memset(w, 0, sizeof(*w)); ++ w->allocated = roundup_pow_of_two(sizeof(*w->fdata) + 40); ++ strcpy(w->whname, AUFS_WH_DR_INFO_PFX); ++ w->infoname = w->whname + sizeof(AUFS_WH_DR_INFO_PFX) - 1; ++ w->infonamelen = sizeof(w->whname) - sizeof(AUFS_WH_DR_INFO_PFX); ++ w->btgt = btgt; ++ w->no_sio = !!uid_eq(current_fsuid(), GLOBAL_ROOT_UID); ++ ++ err = -ENOMEM; ++ w->fdata = kcalloc(1, w->allocated, GFP_NOFS); ++ if (unlikely(!w->fdata)) { ++ AuTraceErr(err); ++ goto out; ++ } ++ w->fdata->magic = (__force uint32_t)htonl(AUFS_DRINFO_MAGIC_V1); ++ err = 0; ++ ++out: ++ return err; ++} ++ ++static void au_drinfo_store_work_fin(struct au_drinfo_store *w) ++{ ++ kfree(w->fdata); ++} ++ ++static void au_drinfo_store_rev(struct au_drinfo_rev *rev, ++ struct au_drinfo_store *w) ++{ ++ struct au_drinfo_rev_elm *elm; ++ struct inode *h_dir, *delegated; ++ int err, nelm; ++ struct path infopath = { ++ .mnt = w->h_ppath.mnt ++ }; ++ ++ h_dir = d_inode(w->h_ppath.dentry); ++ IMustLock(h_dir); ++ ++ err = 0; ++ elm = rev->elm; ++ for (nelm = rev->nelm; nelm > 0; nelm--, elm++) { ++ AuDebugOn(elm->created && elm->info_last); ++ if (elm->created) { ++ AuDbg("here\n"); ++ delegated = NULL; ++ infopath.dentry = elm->info_dentry; ++ err = vfsub_unlink(h_dir, &infopath, &delegated, ++ !w->no_sio); ++ AuTraceErr(err); ++ if (unlikely(err == -EWOULDBLOCK)) ++ iput(delegated); ++ dput(elm->info_dentry); ++ } else if (elm->info_last) { ++ AuDbg("here\n"); ++ w->fdata->drinfo = *elm->info_last; ++ memcpy(w->fdata->drinfo.oldname, ++ elm->info_last->oldname, ++ elm->info_last->oldnamelen); ++ err = au_drinfo_store_sio(w, /*elm*/NULL); ++ kfree(elm->info_last); ++ } ++ if (unlikely(err)) ++ AuIOErr("%d, %s\n", err, w->whname); ++ /* go on even if err */ ++ } ++} ++ ++/* caller has to call au_dr_rename_fin() later */ ++static int au_drinfo_store(struct dentry *dentry, aufs_bindex_t btgt, ++ struct qstr *dst_name, void *_rev) ++{ ++ int err, sz, nelm; ++ aufs_bindex_t bindex, btail; ++ struct au_drinfo_store work; ++ struct au_drinfo_rev *rev, **p; ++ struct au_drinfo_rev_elm *elm; ++ struct super_block *sb; ++ struct au_branch *br; ++ struct au_hinode *hdir; ++ ++ err = au_drinfo_store_work_init(&work, btgt); ++ AuTraceErr(err); ++ if (unlikely(err)) ++ goto out; ++ ++ err = -ENOMEM; ++ btail = au_dbtaildir(dentry); ++ nelm = btail - btgt; ++ sz = sizeof(*rev) + sizeof(*elm) * nelm; ++ rev = kcalloc(1, sz, GFP_NOFS); ++ if (unlikely(!rev)) { ++ AuTraceErr(err); ++ goto out_args; ++ } ++ rev->nelm = nelm; ++ elm = rev->elm; ++ p = _rev; ++ *p = rev; ++ ++ err = 0; ++ sb = dentry->d_sb; ++ work.h_ppath.dentry = au_h_dptr(dentry, btgt); ++ work.h_ppath.mnt = au_sbr_mnt(sb, btgt); ++ hdir = au_hi(d_inode(dentry), btgt); ++ au_hn_inode_lock_nested(hdir, AuLsc_I_CHILD); ++ for (bindex = btgt + 1; bindex <= btail; bindex++, elm++) { ++ work.h_dentry = au_h_dptr(dentry, bindex); ++ if (!work.h_dentry) ++ continue; ++ ++ err = au_drinfo_construct(&work.fdata, work.h_dentry, ++ &work.allocated); ++ AuTraceErr(err); ++ if (unlikely(err)) ++ break; ++ ++ work.renameback = au_qstreq(&work.h_dentry->d_name, dst_name); ++ br = au_sbr(sb, bindex); ++ work.whnamelen = sizeof(AUFS_WH_DR_INFO_PFX) - 1; ++ work.whnamelen += au_drinfo_name(br, work.infoname, ++ work.infonamelen); ++ AuDbg("whname %.*s, i%llu, %.*s\n", ++ work.whnamelen, work.whname, ++ be64_to_cpu((__force __be64)work.fdata->drinfo.ino), ++ work.fdata->drinfo.oldnamelen, ++ work.fdata->drinfo.oldname); ++ ++ err = au_drinfo_store_sio(&work, elm); ++ AuTraceErr(err); ++ if (unlikely(err)) ++ break; ++ } ++ if (unlikely(err)) { ++ /* revert all drinfo */ ++ au_drinfo_store_rev(rev, &work); ++ kfree(rev); ++ *p = NULL; ++ } ++ au_hn_inode_unlock(hdir); ++ ++out_args: ++ au_drinfo_store_work_fin(&work); ++out: ++ return err; ++} ++ ++/* ---------------------------------------------------------------------- */ ++ ++int au_dr_rename(struct dentry *src, aufs_bindex_t bindex, ++ struct qstr *dst_name, void *_rev) ++{ ++ int err, already; ++ ino_t ino; ++ struct super_block *sb; ++ struct au_branch *br; ++ struct au_dr_br *dr; ++ struct dentry *h_dentry; ++ struct inode *h_inode; ++ struct au_dr_hino *ent; ++ struct au_drinfo_rev *rev, **p; ++ ++ AuDbg("bindex %d\n", bindex); ++ ++ err = -ENOMEM; ++ ent = kmalloc(sizeof(*ent), GFP_NOFS); ++ if (unlikely(!ent)) ++ goto out; ++ ++ sb = src->d_sb; ++ br = au_sbr(sb, bindex); ++ dr = &br->br_dirren; ++ h_dentry = au_h_dptr(src, bindex); ++ h_inode = d_inode(h_dentry); ++ ino = h_inode->i_ino; ++ ent->dr_h_ino = ino; ++ already = au_dr_hino_test_add(dr, ino, ent); ++ AuDbg("b%d, hi%llu, already %d\n", ++ bindex, (unsigned long long)ino, already); ++ ++ err = au_drinfo_store(src, bindex, dst_name, _rev); ++ AuTraceErr(err); ++ if (!err) { ++ p = _rev; ++ rev = *p; ++ rev->already = already; ++ goto out; /* success */ ++ } ++ ++ /* revert */ ++ if (!already) ++ au_dr_hino_del(dr, ent); ++ kfree(ent); ++ ++out: ++ AuTraceErr(err); ++ return err; ++} ++ ++void au_dr_rename_fin(struct dentry *src, aufs_bindex_t btgt, void *_rev) ++{ ++ struct au_drinfo_rev *rev; ++ struct au_drinfo_rev_elm *elm; ++ int nelm; ++ ++ rev = _rev; ++ elm = rev->elm; ++ for (nelm = rev->nelm; nelm > 0; nelm--, elm++) { ++ dput(elm->info_dentry); ++ kfree(elm->info_last); ++ } ++ kfree(rev); ++} ++ ++void au_dr_rename_rev(struct dentry *src, aufs_bindex_t btgt, void *_rev) ++{ ++ int err; ++ struct au_drinfo_store work; ++ struct au_drinfo_rev *rev = _rev; ++ struct super_block *sb; ++ struct au_branch *br; ++ struct inode *h_inode; ++ struct au_dr_br *dr; ++ struct au_dr_hino *ent; ++ ++ err = au_drinfo_store_work_init(&work, btgt); ++ if (unlikely(err)) ++ goto out; ++ ++ sb = src->d_sb; ++ br = au_sbr(sb, btgt); ++ work.h_ppath.dentry = au_h_dptr(src, btgt); ++ work.h_ppath.mnt = au_br_mnt(br); ++ au_drinfo_store_rev(rev, &work); ++ au_drinfo_store_work_fin(&work); ++ if (rev->already) ++ goto out; ++ ++ dr = &br->br_dirren; ++ h_inode = d_inode(work.h_ppath.dentry); ++ ent = au_dr_hino_find(dr, h_inode->i_ino); ++ BUG_ON(!ent); ++ au_dr_hino_del(dr, ent); ++ kfree(ent); ++ ++out: ++ kfree(rev); ++ if (unlikely(err)) ++ pr_err("failed to remove dirren info\n"); ++} ++ ++/* ---------------------------------------------------------------------- */ ++ ++static struct au_drinfo *au_drinfo_do_load(struct path *h_ppath, ++ char *whname, int whnamelen, ++ struct dentry **info_dentry) ++{ ++ struct au_drinfo *drinfo; ++ struct file *f; ++ struct inode *h_dir; ++ struct path infopath; ++ int unlocked; ++ ++ AuDbg("%pd/%.*s\n", h_ppath->dentry, whnamelen, whname); ++ ++ *info_dentry = NULL; ++ drinfo = NULL; ++ unlocked = 0; ++ h_dir = d_inode(h_ppath->dentry); ++ vfsub_inode_lock_shared_nested(h_dir, AuLsc_I_PARENT); ++ infopath.dentry = vfsub_lookup_one_len(whname, h_ppath->dentry, ++ whnamelen); ++ if (IS_ERR(infopath.dentry)) { ++ drinfo = (void *)infopath.dentry; ++ goto out; ++ } ++ ++ if (d_is_negative(infopath.dentry)) ++ goto out_dput; /* success */ ++ ++ infopath.mnt = h_ppath->mnt; ++ f = vfsub_dentry_open(&infopath, O_RDONLY); ++ inode_unlock_shared(h_dir); ++ unlocked = 1; ++ if (IS_ERR(f)) { ++ drinfo = (void *)f; ++ goto out_dput; ++ } ++ ++ drinfo = au_drinfo_read_k(f, /*h_ino*/0); ++ if (IS_ERR_OR_NULL(drinfo)) ++ goto out_fput; ++ ++ AuDbg("oldname %.*s\n", drinfo->oldnamelen, drinfo->oldname); ++ *info_dentry = dget(infopath.dentry); /* keep it alive */ ++ ++out_fput: ++ fput(f); ++out_dput: ++ dput(infopath.dentry); ++out: ++ if (!unlocked) ++ inode_unlock_shared(h_dir); ++ AuTraceErrPtr(drinfo); ++ return drinfo; ++} ++ ++struct au_drinfo_do_load_args { ++ struct au_drinfo **drinfop; ++ struct path *h_ppath; ++ char *whname; ++ int whnamelen; ++ struct dentry **info_dentry; ++}; ++ ++static void au_call_drinfo_do_load(void *args) ++{ ++ struct au_drinfo_do_load_args *a = args; ++ ++ *a->drinfop = au_drinfo_do_load(a->h_ppath, a->whname, a->whnamelen, ++ a->info_dentry); ++} ++ ++struct au_drinfo_load { ++ struct path h_ppath; ++ struct qstr *qname; ++ unsigned char no_sio; ++ ++ aufs_bindex_t ninfo; ++ struct au_drinfo **drinfo; ++}; ++ ++static int au_drinfo_load(struct au_drinfo_load *w, aufs_bindex_t bindex, ++ struct au_branch *br) ++{ ++ int err, wkq_err, whnamelen, e; ++ char whname[sizeof(AUFS_WH_DR_INFO_PFX) + AUFS_DIRREN_ENV_VAL_SZ] ++ = AUFS_WH_DR_INFO_PFX; ++ struct au_drinfo *drinfo; ++ struct qstr oldname; ++ struct inode *h_dir, *delegated; ++ struct dentry *info_dentry; ++ struct path infopath; ++ ++ whnamelen = sizeof(AUFS_WH_DR_INFO_PFX) - 1; ++ whnamelen += au_drinfo_name(br, whname + whnamelen, ++ sizeof(whname) - whnamelen); ++ if (w->no_sio) ++ drinfo = au_drinfo_do_load(&w->h_ppath, whname, whnamelen, ++ &info_dentry); ++ else { ++ struct au_drinfo_do_load_args args = { ++ .drinfop = &drinfo, ++ .h_ppath = &w->h_ppath, ++ .whname = whname, ++ .whnamelen = whnamelen, ++ .info_dentry = &info_dentry ++ }; ++ wkq_err = au_wkq_wait(au_call_drinfo_do_load, &args); ++ if (unlikely(wkq_err)) ++ drinfo = ERR_PTR(wkq_err); ++ } ++ err = PTR_ERR(drinfo); ++ if (IS_ERR_OR_NULL(drinfo)) ++ goto out; ++ ++ err = 0; ++ oldname.len = drinfo->oldnamelen; ++ oldname.name = drinfo->oldname; ++ if (au_qstreq(w->qname, &oldname)) { ++ /* the name is renamed back */ ++ kfree(drinfo); ++ drinfo = NULL; ++ ++ infopath.dentry = info_dentry; ++ infopath.mnt = w->h_ppath.mnt; ++ h_dir = d_inode(w->h_ppath.dentry); ++ delegated = NULL; ++ inode_lock_nested(h_dir, AuLsc_I_PARENT); ++ e = vfsub_unlink(h_dir, &infopath, &delegated, !w->no_sio); ++ inode_unlock(h_dir); ++ if (unlikely(e)) ++ AuIOErr("ignored %d, %pd2\n", e, &infopath.dentry); ++ if (unlikely(e == -EWOULDBLOCK)) ++ iput(delegated); ++ } ++ kfree(w->drinfo[bindex]); ++ w->drinfo[bindex] = drinfo; ++ dput(info_dentry); ++ ++out: ++ AuTraceErr(err); ++ return err; ++} ++ ++/* ---------------------------------------------------------------------- */ ++ ++static void au_dr_lkup_free(struct au_drinfo **drinfo, int n) ++{ ++ struct au_drinfo **p = drinfo; ++ ++ while (n-- > 0) ++ kfree(*drinfo++); ++ kfree(p); ++} ++ ++int au_dr_lkup(struct au_do_lookup_args *lkup, struct dentry *dentry, ++ aufs_bindex_t btgt) ++{ ++ int err, ninfo; ++ struct au_drinfo_load w; ++ aufs_bindex_t bindex, bbot; ++ struct au_branch *br; ++ struct inode *h_dir; ++ struct au_dr_hino *ent; ++ struct super_block *sb; ++ ++ AuDbg("%.*s, name %.*s, whname %.*s, b%d\n", ++ AuLNPair(&dentry->d_name), AuLNPair(&lkup->dirren.dr_name), ++ AuLNPair(&lkup->whname), btgt); ++ ++ sb = dentry->d_sb; ++ bbot = au_sbbot(sb); ++ w.ninfo = bbot + 1; ++ if (!lkup->dirren.drinfo) { ++ lkup->dirren.drinfo = kcalloc(w.ninfo, ++ sizeof(*lkup->dirren.drinfo), ++ GFP_NOFS); ++ if (unlikely(!lkup->dirren.drinfo)) { ++ err = -ENOMEM; ++ goto out; ++ } ++ lkup->dirren.ninfo = w.ninfo; ++ } ++ w.drinfo = lkup->dirren.drinfo; ++ w.no_sio = !!uid_eq(current_fsuid(), GLOBAL_ROOT_UID); ++ w.h_ppath.dentry = au_h_dptr(dentry, btgt); ++ AuDebugOn(!w.h_ppath.dentry); ++ w.h_ppath.mnt = au_sbr_mnt(sb, btgt); ++ w.qname = &dentry->d_name; ++ ++ ninfo = 0; ++ for (bindex = btgt + 1; bindex <= bbot; bindex++) { ++ br = au_sbr(sb, bindex); ++ err = au_drinfo_load(&w, bindex, br); ++ if (unlikely(err)) ++ goto out_free; ++ if (w.drinfo[bindex]) ++ ninfo++; ++ } ++ if (!ninfo) { ++ br = au_sbr(sb, btgt); ++ h_dir = d_inode(w.h_ppath.dentry); ++ ent = au_dr_hino_find(&br->br_dirren, h_dir->i_ino); ++ AuDebugOn(!ent); ++ au_dr_hino_del(&br->br_dirren, ent); ++ kfree(ent); ++ } ++ goto out; /* success */ ++ ++out_free: ++ au_dr_lkup_free(lkup->dirren.drinfo, lkup->dirren.ninfo); ++ lkup->dirren.ninfo = 0; ++ lkup->dirren.drinfo = NULL; ++out: ++ AuTraceErr(err); ++ return err; ++} ++ ++void au_dr_lkup_fin(struct au_do_lookup_args *lkup) ++{ ++ au_dr_lkup_free(lkup->dirren.drinfo, lkup->dirren.ninfo); ++} ++ ++int au_dr_lkup_name(struct au_do_lookup_args *lkup, aufs_bindex_t btgt) ++{ ++ int err; ++ struct au_drinfo *drinfo; ++ ++ err = 0; ++ if (!lkup->dirren.drinfo) ++ goto out; ++ AuDebugOn(lkup->dirren.ninfo < btgt + 1); ++ drinfo = lkup->dirren.drinfo[btgt + 1]; ++ if (!drinfo) ++ goto out; ++ ++ kfree(lkup->whname.name); ++ lkup->whname.name = NULL; ++ lkup->dirren.dr_name.len = drinfo->oldnamelen; ++ lkup->dirren.dr_name.name = drinfo->oldname; ++ lkup->name = &lkup->dirren.dr_name; ++ err = au_wh_name_alloc(&lkup->whname, lkup->name); ++ if (!err) ++ AuDbg("name %.*s, whname %.*s, b%d\n", ++ AuLNPair(lkup->name), AuLNPair(&lkup->whname), ++ btgt); ++ ++out: ++ AuTraceErr(err); ++ return err; ++} ++ ++int au_dr_lkup_h_ino(struct au_do_lookup_args *lkup, aufs_bindex_t bindex, ++ ino_t h_ino) ++{ ++ int match; ++ struct au_drinfo *drinfo; ++ ++ match = 1; ++ if (!lkup->dirren.drinfo) ++ goto out; ++ AuDebugOn(lkup->dirren.ninfo < bindex + 1); ++ drinfo = lkup->dirren.drinfo[bindex + 1]; ++ if (!drinfo) ++ goto out; ++ ++ match = (drinfo->ino == h_ino); ++ AuDbg("match %d\n", match); ++ ++out: ++ return match; ++} ++ ++/* ---------------------------------------------------------------------- */ ++ ++int au_dr_opt_set(struct super_block *sb) ++{ ++ int err; ++ aufs_bindex_t bindex, bbot; ++ struct au_branch *br; ++ ++ err = 0; ++ bbot = au_sbbot(sb); ++ for (bindex = 0; !err && bindex <= bbot; bindex++) { ++ br = au_sbr(sb, bindex); ++ err = au_dr_hino(sb, bindex, /*br*/NULL, &br->br_path); ++ } ++ ++ return err; ++} ++ ++int au_dr_opt_flush(struct super_block *sb) ++{ ++ int err; ++ aufs_bindex_t bindex, bbot; ++ struct au_branch *br; ++ ++ err = 0; ++ bbot = au_sbbot(sb); ++ for (bindex = 0; !err && bindex <= bbot; bindex++) { ++ br = au_sbr(sb, bindex); ++ if (au_br_writable(br->br_perm)) ++ err = au_dr_hino(sb, bindex, /*br*/NULL, /*path*/NULL); ++ } ++ ++ return err; ++} ++ ++int au_dr_opt_clr(struct super_block *sb, int no_flush) ++{ ++ int err; ++ aufs_bindex_t bindex, bbot; ++ struct au_branch *br; ++ ++ err = 0; ++ if (!no_flush) { ++ err = au_dr_opt_flush(sb); ++ if (unlikely(err)) ++ goto out; ++ } ++ ++ bbot = au_sbbot(sb); ++ for (bindex = 0; bindex <= bbot; bindex++) { ++ br = au_sbr(sb, bindex); ++ au_dr_hino_free(&br->br_dirren); ++ } ++ ++out: ++ return err; ++} +diff --git a/fs/aufs/dirren.h b/fs/aufs/dirren.h +new file mode 100644 +index 000000000000..4b672fb11f02 +--- /dev/null ++++ b/fs/aufs/dirren.h +@@ -0,0 +1,127 @@ ++/* ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2017 Junjiro R. Okajima ++ */ ++ ++/* ++ * renamed dir info ++ */ ++ ++#ifndef __AUFS_DIRREN_H__ ++#define __AUFS_DIRREN_H__ ++ ++#ifdef __KERNEL__ ++ ++#include ++#include ++#include ++#include "hbl.h" ++ ++#define AuDirren_NHASH 100 ++ ++#ifdef CONFIG_AUFS_DIRREN ++enum au_brid_type { ++ AuBrid_Unset, ++ AuBrid_UUID, ++ AuBrid_FSID, ++ AuBrid_DEV ++}; ++ ++struct au_dr_brid { ++ enum au_brid_type type; ++ union { ++ uuid_t uuid; /* unimplemented yet */ ++ fsid_t fsid; ++ dev_t dev; ++ }; ++}; ++ ++/* 20 is the max digits length of ulong 64 */ ++/* brid-type "_" uuid "_" inum */ ++#define AUFS_DIRREN_FNAME_SZ (1 + 1 + UUID_STRING_LEN + 20) ++#define AUFS_DIRREN_ENV_VAL_SZ (AUFS_DIRREN_FNAME_SZ + 1 + 20) ++ ++struct au_dr_hino { ++ struct hlist_bl_node dr_hnode; ++ ino_t dr_h_ino; ++}; ++ ++struct au_dr_br { ++ struct hlist_bl_head dr_h_ino[AuDirren_NHASH]; ++ struct au_dr_brid dr_brid; ++}; ++ ++struct au_dr_lookup { ++ /* dr_name is pointed by struct au_do_lookup_args.name */ ++ struct qstr dr_name; /* subset of dr_info */ ++ aufs_bindex_t ninfo; ++ struct au_drinfo **drinfo; ++}; ++#else ++struct au_dr_hino; ++/* empty */ ++struct au_dr_br { }; ++struct au_dr_lookup { }; ++#endif ++ ++/* ---------------------------------------------------------------------- */ ++ ++struct au_branch; ++struct au_do_lookup_args; ++struct au_hinode; ++#ifdef CONFIG_AUFS_DIRREN ++int au_dr_hino_test_add(struct au_dr_br *dr, ino_t h_ino, ++ struct au_dr_hino *add_ent); ++void au_dr_hino_free(struct au_dr_br *dr); ++int au_dr_br_init(struct super_block *sb, struct au_branch *br, ++ const struct path *path); ++int au_dr_br_fin(struct super_block *sb, struct au_branch *br); ++int au_dr_rename(struct dentry *src, aufs_bindex_t bindex, ++ struct qstr *dst_name, void *_rev); ++void au_dr_rename_fin(struct dentry *src, aufs_bindex_t btgt, void *rev); ++void au_dr_rename_rev(struct dentry *src, aufs_bindex_t bindex, void *rev); ++int au_dr_lkup(struct au_do_lookup_args *lkup, struct dentry *dentry, ++ aufs_bindex_t bindex); ++int au_dr_lkup_name(struct au_do_lookup_args *lkup, aufs_bindex_t btgt); ++int au_dr_lkup_h_ino(struct au_do_lookup_args *lkup, aufs_bindex_t bindex, ++ ino_t h_ino); ++void au_dr_lkup_fin(struct au_do_lookup_args *lkup); ++int au_dr_opt_set(struct super_block *sb); ++int au_dr_opt_flush(struct super_block *sb); ++int au_dr_opt_clr(struct super_block *sb, int no_flush); ++#else ++AuStubInt0(au_dr_hino_test_add, struct au_dr_br *dr, ino_t h_ino, ++ struct au_dr_hino *add_ent); ++AuStubVoid(au_dr_hino_free, struct au_dr_br *dr); ++AuStubInt0(au_dr_br_init, struct super_block *sb, struct au_branch *br, ++ const struct path *path); ++AuStubInt0(au_dr_br_fin, struct super_block *sb, struct au_branch *br); ++AuStubInt0(au_dr_rename, struct dentry *src, aufs_bindex_t bindex, ++ struct qstr *dst_name, void *_rev); ++AuStubVoid(au_dr_rename_fin, struct dentry *src, aufs_bindex_t btgt, void *rev); ++AuStubVoid(au_dr_rename_rev, struct dentry *src, aufs_bindex_t bindex, ++ void *rev); ++AuStubInt0(au_dr_lkup, struct au_do_lookup_args *lkup, struct dentry *dentry, ++ aufs_bindex_t bindex); ++AuStubInt0(au_dr_lkup_name, struct au_do_lookup_args *lkup, aufs_bindex_t btgt); ++AuStubInt0(au_dr_lkup_h_ino, struct au_do_lookup_args *lkup, ++ aufs_bindex_t bindex, ino_t h_ino); ++AuStubVoid(au_dr_lkup_fin, struct au_do_lookup_args *lkup); ++AuStubInt0(au_dr_opt_set, struct super_block *sb); ++AuStubInt0(au_dr_opt_flush, struct super_block *sb); ++AuStubInt0(au_dr_opt_clr, struct super_block *sb, int no_flush); ++#endif ++ ++/* ---------------------------------------------------------------------- */ ++ ++#ifdef CONFIG_AUFS_DIRREN ++static inline int au_dr_ihash(ino_t h_ino) ++{ ++ return h_ino % AuDirren_NHASH; ++} ++#else ++AuStubInt0(au_dr_ihash, ino_t h_ino); ++#endif ++ ++#endif /* __KERNEL__ */ ++#endif /* __AUFS_DIRREN_H__ */ diff --git a/fs/aufs/dynop.c b/fs/aufs/dynop.c new file mode 100644 -index 0000000..eb0e1a7 +index 000000000000..706c2f4bf347 --- /dev/null +++ b/fs/aufs/dynop.c -@@ -0,0 +1,358 @@ +@@ -0,0 +1,357 @@ +/* -+ * Copyright (C) 2010-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2010-2017 Junjiro R. Okajima + */ + +/* @@ -9560,23 +11295,23 @@ index 0000000..eb0e1a7 + * How large will these lists be? + * Usually just a few elements, 20-30 at most for each, I guess. + */ -+static struct au_sphlhead dynop[AuDyLast]; ++static struct hlist_bl_head dynop[AuDyLast]; + -+static struct au_dykey *dy_gfind_get(struct au_sphlhead *sphl, const void *h_op) ++static struct au_dykey *dy_gfind_get(struct hlist_bl_head *hbl, ++ const void *h_op) +{ + struct au_dykey *key, *tmp; -+ struct hlist_head *head; ++ struct hlist_bl_node *pos; + + key = NULL; -+ head = &sphl->head; -+ rcu_read_lock(); -+ hlist_for_each_entry_rcu(tmp, head, dk_hnode) ++ hlist_bl_lock(hbl); ++ hlist_bl_for_each_entry(tmp, pos, hbl, dk_hnode) + if (tmp->dk_op.dy_hop == h_op) { + key = tmp; + kref_get(&key->dk_kref); + break; + } -+ rcu_read_unlock(); ++ hlist_bl_unlock(hbl); + + return key; +} @@ -9617,24 +11352,23 @@ index 0000000..eb0e1a7 +} + +/* kref_get() if @key is already added */ -+static struct au_dykey *dy_gadd(struct au_sphlhead *sphl, struct au_dykey *key) ++static struct au_dykey *dy_gadd(struct hlist_bl_head *hbl, struct au_dykey *key) +{ + struct au_dykey *tmp, *found; -+ struct hlist_head *head; ++ struct hlist_bl_node *pos; + const void *h_op = key->dk_op.dy_hop; + + found = NULL; -+ head = &sphl->head; -+ spin_lock(&sphl->spin); -+ hlist_for_each_entry(tmp, head, dk_hnode) ++ hlist_bl_lock(hbl); ++ hlist_bl_for_each_entry(tmp, pos, hbl, dk_hnode) + if (tmp->dk_op.dy_hop == h_op) { + kref_get(&tmp->dk_kref); + found = tmp; + break; + } + if (!found) -+ hlist_add_head_rcu(&key->dk_hnode, head); -+ spin_unlock(&sphl->spin); ++ hlist_bl_add_head(&key->dk_hnode, hbl); ++ hlist_bl_unlock(hbl); + + if (!found) + DyPrSym(key); @@ -9647,17 +11381,17 @@ index 0000000..eb0e1a7 + + key = container_of(rcu, struct au_dykey, dk_rcu); + DyPrSym(key); -+ kfree(key); /* not delayed */ ++ kfree(key); +} + +static void dy_free(struct kref *kref) +{ + struct au_dykey *key; -+ struct au_sphlhead *sphl; ++ struct hlist_bl_head *hbl; + + key = container_of(kref, struct au_dykey, dk_kref); -+ sphl = dynop + key->dk_op.dy_type; -+ au_sphl_del_rcu(&key->dk_hnode, sphl); ++ hbl = dynop + key->dk_op.dy_type; ++ au_hbl_del(&key->dk_hnode, hbl); + call_rcu(&key->dk_rcu, dy_free_rcu); +} + @@ -9744,7 +11478,7 @@ index 0000000..eb0e1a7 +static struct au_dykey *dy_get(struct au_dynop *op, struct au_branch *br) +{ + struct au_dykey *key, *old; -+ struct au_sphlhead *sphl; ++ struct hlist_bl_head *hbl; + struct op { + unsigned int sz; + void (*set)(struct au_dykey *key, const void *h_op, @@ -9758,8 +11492,8 @@ index 0000000..eb0e1a7 + }; + const struct op *p; + -+ sphl = dynop + op->dy_type; -+ key = dy_gfind_get(sphl, op->dy_hop); ++ hbl = dynop + op->dy_type; ++ key = dy_gfind_get(hbl, op->dy_hop); + if (key) + goto out_add; /* success */ + @@ -9773,9 +11507,9 @@ index 0000000..eb0e1a7 + key->dk_op.dy_hop = op->dy_hop; + kref_init(&key->dk_kref); + p->set(key, op->dy_hop, au_br_sb(br)); -+ old = dy_gadd(sphl, key); ++ old = dy_gadd(hbl, key); + if (old) { -+ au_delayed_kfree(key); ++ kfree(key); + key = old; + } + @@ -9870,16 +11604,15 @@ index 0000000..eb0e1a7 + +void au_dy_arefresh(int do_dx) +{ -+ struct au_sphlhead *sphl; -+ struct hlist_head *head; ++ struct hlist_bl_head *hbl; ++ struct hlist_bl_node *pos; + struct au_dykey *key; + -+ sphl = dynop + AuDy_AOP; -+ head = &sphl->head; -+ spin_lock(&sphl->spin); -+ hlist_for_each_entry(key, head, dk_hnode) ++ hbl = dynop + AuDy_AOP; ++ hlist_bl_lock(hbl); ++ hlist_bl_for_each_entry(key, pos, hbl, dk_hnode) + dy_adx((void *)key, do_dx); -+ spin_unlock(&sphl->spin); ++ hlist_bl_unlock(hbl); +} + +/* ---------------------------------------------------------------------- */ @@ -9892,7 +11625,7 @@ index 0000000..eb0e1a7 + BUILD_BUG_ON(offsetof(struct au_dyaop, da_key)); + + for (i = 0; i < AuDyLast; i++) -+ au_sphl_init(dynop + i); ++ INIT_HLIST_BL_HEAD(dynop + i); +} + +void au_dy_fin(void) @@ -9900,16 +11633,17 @@ index 0000000..eb0e1a7 + int i; + + for (i = 0; i < AuDyLast; i++) -+ WARN_ON(!hlist_empty(&dynop[i].head)); ++ WARN_ON(!hlist_bl_empty(dynop + i)); +} diff --git a/fs/aufs/dynop.h b/fs/aufs/dynop.h new file mode 100644 -index 0000000..5db2da2 +index 000000000000..9a48883f520d --- /dev/null +++ b/fs/aufs/dynop.h -@@ -0,0 +1,61 @@ +@@ -0,0 +1,62 @@ +/* -+ * Copyright (C) 2010-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2010-2017 Junjiro R. Okajima + */ + +/* @@ -9936,7 +11670,7 @@ index 0000000..5db2da2 + +struct au_dykey { + union { -+ struct hlist_node dk_hnode; ++ struct hlist_bl_node dk_hnode; + struct rcu_head dk_rcu; + }; + struct au_dynop dk_op; @@ -9971,12 +11705,13 @@ index 0000000..5db2da2 +#endif /* __AUFS_DYNOP_H__ */ diff --git a/fs/aufs/export.c b/fs/aufs/export.c new file mode 100644 -index 0000000..203f58b +index 000000000000..a7e471fd6c6a --- /dev/null +++ b/fs/aufs/export.c -@@ -0,0 +1,823 @@ +@@ -0,0 +1,824 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -10380,7 +12115,7 @@ index 0000000..203f58b + } + +out_name: -+ au_delayed_free_page((unsigned long)arg.name); ++ free_page((unsigned long)arg.name); +out_file: + fput(file); +out: @@ -10534,7 +12269,7 @@ index 0000000..203f58b + dentry = ERR_PTR(-ESTALE); + } +out_pathname: -+ au_delayed_free_page((unsigned long)pathname); ++ free_page((unsigned long)pathname); +out_h_parent: + dput(h_parent); +out: @@ -10800,12 +12535,13 @@ index 0000000..203f58b +} diff --git a/fs/aufs/f_op.c b/fs/aufs/f_op.c new file mode 100644 -index 0000000..139240a +index 000000000000..3ea06e5a1610 --- /dev/null +++ b/fs/aufs/f_op.c -@@ -0,0 +1,710 @@ +@@ -0,0 +1,805 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -10892,17 +12628,15 @@ index 0000000..139240a +{ + struct au_finfo *finfo; + aufs_bindex_t bindex; -+ int delayed; + + finfo = au_fi(file); -+ au_sphl_del(&finfo->fi_hlist, -+ &au_sbi(file->f_path.dentry->d_sb)->si_files); ++ au_hbl_del(&finfo->fi_hlist, ++ &au_sbi(file->f_path.dentry->d_sb)->si_files); + bindex = finfo->fi_btop; + if (bindex >= 0) + au_set_h_fptr(file, bindex, NULL); + -+ delayed = (current->flags & PF_KTHREAD) || in_interrupt(); -+ au_finfo_fin(file, delayed); ++ au_finfo_fin(file); + return 0; +} + @@ -10935,12 +12669,12 @@ index 0000000..139240a + */ + +/* Callers should call au_read_post() or fput() in the end */ -+struct file *au_read_pre(struct file *file, int keep_fi) ++struct file *au_read_pre(struct file *file, int keep_fi, unsigned int lsc) +{ + struct file *h_file; + int err; + -+ err = au_reval_and_lock_fdi(file, au_reopen_nondir, /*wlock*/0); ++ err = au_reval_and_lock_fdi(file, au_reopen_nondir, /*wlock*/0, lsc); + if (!err) { + di_read_unlock(file->f_path.dentry, AuLock_IR); + h_file = au_hf_top(file); @@ -10961,6 +12695,10 @@ index 0000000..139240a +} + +struct au_write_pre { ++ /* input */ ++ unsigned int lsc; ++ ++ /* output */ + blkcnt_t blks; + aufs_bindex_t btop; +}; @@ -10976,9 +12714,13 @@ index 0000000..139240a + struct file *h_file; + struct dentry *dentry; + int err; ++ unsigned int lsc; + struct au_pin pin; + -+ err = au_reval_and_lock_fdi(file, au_reopen_nondir, /*wlock*/1); ++ lsc = 0; ++ if (wpre) ++ lsc = wpre->lsc; ++ err = au_reval_and_lock_fdi(file, au_reopen_nondir, /*wlock*/1, lsc); + h_file = ERR_PTR(err); + if (unlikely(err)) + goto out; @@ -11020,12 +12762,11 @@ index 0000000..139240a + h_inode = file_inode(h_file); + inode->i_mode = h_inode->i_mode; + ii_write_unlock(inode); -+ fput(h_file); -+ + /* AuDbg("blks %llu, %llu\n", (u64)blks, (u64)h_inode->i_blocks); */ + if (written > 0) + au_fhsm_wrote(inode->i_sb, wpre->btop, + /*force*/h_inode->i_blocks > wpre->blks); ++ fput(h_file); +} + +static ssize_t aufs_read(struct file *file, char __user *buf, size_t count, @@ -11040,7 +12781,7 @@ index 0000000..139240a + sb = inode->i_sb; + si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLMW); + -+ h_file = au_read_pre(file, /*keep_fi*/0); ++ h_file = au_read_pre(file, /*keep_fi*/0, /*lsc*/0); + err = PTR_ERR(h_file); + if (IS_ERR(h_file)) + goto out; @@ -11090,6 +12831,7 @@ index 0000000..139240a + inode = file_inode(file); + au_mtx_and_read_lock(inode); + ++ wpre.lsc = 0; + h_file = au_write_pre(file, /*do_ready*/1, &wpre); + err = PTR_ERR(h_file); + if (IS_ERR(h_file)) @@ -11149,7 +12891,7 @@ index 0000000..139240a + sb = inode->i_sb; + si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLMW); + -+ h_file = au_read_pre(file, /*keep_fi*/1); ++ h_file = au_read_pre(file, /*keep_fi*/1, /*lsc*/0); + err = PTR_ERR(h_file); + if (IS_ERR(h_file)) + goto out; @@ -11184,6 +12926,7 @@ index 0000000..139240a + inode = file_inode(file); + au_mtx_and_read_lock(inode); + ++ wpre.lsc = 0; + h_file = au_write_pre(file, /*do_ready*/1, &wpre); + err = PTR_ERR(h_file); + if (IS_ERR(h_file)) @@ -11211,7 +12954,7 @@ index 0000000..139240a + sb = inode->i_sb; + si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLMW); + -+ h_file = au_read_pre(file, /*keep_fi*/0); ++ h_file = au_read_pre(file, /*keep_fi*/0, /*lsc*/0); + err = PTR_ERR(h_file); + if (IS_ERR(h_file)) + goto out; @@ -11238,6 +12981,7 @@ index 0000000..139240a + inode = file_inode(file); + au_mtx_and_read_lock(inode); + ++ wpre.lsc = 0; + h_file = au_write_pre(file, /*do_ready*/1, &wpre); + err = PTR_ERR(h_file); + if (IS_ERR(h_file)) @@ -11263,6 +13007,7 @@ index 0000000..139240a + inode = file_inode(file); + au_mtx_and_read_lock(inode); + ++ wpre.lsc = 0; + h_file = au_write_pre(file, /*do_ready*/1, &wpre); + err = PTR_ERR(h_file); + if (IS_ERR(h_file)) @@ -11279,6 +13024,88 @@ index 0000000..139240a + return err; +} + ++static ssize_t aufs_copy_file_range(struct file *src, loff_t src_pos, ++ struct file *dst, loff_t dst_pos, ++ size_t len, unsigned int flags) ++{ ++ ssize_t err; ++ struct au_write_pre wpre; ++ enum { SRC, DST }; ++ struct { ++ struct inode *inode; ++ struct file *h_file; ++ struct super_block *h_sb; ++ } a[2]; ++#define a_src a[SRC] ++#define a_dst a[DST] ++ ++ err = -EINVAL; ++ a_src.inode = file_inode(src); ++ if (unlikely(!S_ISREG(a_src.inode->i_mode))) ++ goto out; ++ a_dst.inode = file_inode(dst); ++ if (unlikely(!S_ISREG(a_dst.inode->i_mode))) ++ goto out; ++ ++ au_mtx_and_read_lock(a_dst.inode); ++ /* ++ * in order to match the order in di_write_lock2_{child,parent}(), ++ * use f_path.dentry for this comparision. ++ */ ++ if (src->f_path.dentry < dst->f_path.dentry) { ++ a_src.h_file = au_read_pre(src, /*keep_fi*/1, AuLsc_FI_1); ++ err = PTR_ERR(a_src.h_file); ++ if (IS_ERR(a_src.h_file)) ++ goto out_si; ++ ++ wpre.lsc = AuLsc_FI_2; ++ a_dst.h_file = au_write_pre(dst, /*do_ready*/1, &wpre); ++ err = PTR_ERR(a_dst.h_file); ++ if (IS_ERR(a_dst.h_file)) { ++ au_read_post(a_src.inode, a_src.h_file); ++ goto out_si; ++ } ++ } else { ++ wpre.lsc = AuLsc_FI_1; ++ a_dst.h_file = au_write_pre(dst, /*do_ready*/1, &wpre); ++ err = PTR_ERR(a_dst.h_file); ++ if (IS_ERR(a_dst.h_file)) ++ goto out_si; ++ ++ a_src.h_file = au_read_pre(src, /*keep_fi*/1, AuLsc_FI_2); ++ err = PTR_ERR(a_src.h_file); ++ if (IS_ERR(a_src.h_file)) { ++ au_write_post(a_dst.inode, a_dst.h_file, &wpre, ++ /*written*/0); ++ goto out_si; ++ } ++ } ++ ++ err = -EXDEV; ++ a_src.h_sb = file_inode(a_src.h_file)->i_sb; ++ a_dst.h_sb = file_inode(a_dst.h_file)->i_sb; ++ if (unlikely(a_src.h_sb != a_dst.h_sb)) { ++ AuDbgFile(src); ++ AuDbgFile(dst); ++ goto out_file; ++ } ++ ++ err = vfsub_copy_file_range(a_src.h_file, src_pos, a_dst.h_file, ++ dst_pos, len, flags); ++ ++out_file: ++ au_write_post(a_dst.inode, a_dst.h_file, &wpre, err); ++ fi_read_unlock(src); ++ au_read_post(a_src.inode, a_src.h_file); ++out_si: ++ si_read_unlock(a_dst.inode->i_sb); ++ inode_unlock(a_dst.inode); ++out: ++ return err; ++#undef a_src ++#undef a_dst ++} ++ +/* ---------------------------------------------------------------------- */ + +/* @@ -11369,7 +13196,7 @@ index 0000000..139240a + * au_flag_conv(vma->vm_flags)); + */ + if (!err) -+ err = h_file->f_op->mmap(h_file, vma); ++ err = call_mmap(h_file, vma); + if (!err) { + au_vm_prfile_set(vma, file); + fsstack_copy_attr_atime(inode, file_inode(h_file)); @@ -11408,6 +13235,7 @@ index 0000000..139240a + inode = file_inode(file); + au_mtx_and_read_lock(inode); + ++ wpre.lsc = 0; + h_file = au_write_pre(file, /*do_ready*/1, &wpre); + err = PTR_ERR(h_file); + if (IS_ERR(h_file)) @@ -11432,7 +13260,7 @@ index 0000000..139240a + sb = file->f_path.dentry->d_sb; + si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLMW); + -+ h_file = au_read_pre(file, /*keep_fi*/0); ++ h_file = au_read_pre(file, /*keep_fi*/0, /*lsc*/0); + err = PTR_ERR(h_file); + if (IS_ERR(h_file)) + goto out; @@ -11455,12 +13283,13 @@ index 0000000..139240a + sb = file->f_path.dentry->d_sb; + si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLMW); + -+ h_file = au_read_pre(file, /*keep_fi*/0); ++ h_file = au_read_pre(file, /*keep_fi*/0, /*lsc*/0); + err = PTR_ERR(h_file); + if (IS_ERR(h_file)) + goto out; + -+ arg |= vfsub_file_flags(file) & FASYNC; /* stop calling h_file->fasync */ ++ /* stop calling h_file->fasync */ ++ arg |= vfsub_file_flags(file) & FASYNC; + err = setfl(/*unused fd*/-1, h_file, arg); + fput(h_file); /* instead of au_read_post() */ + @@ -11512,16 +13341,18 @@ index 0000000..139240a + .aio_splice_write = aufs_aio_splice_write, + .aio_splice_read = aufs_aio_splice_read, +#endif -+ .fallocate = aufs_fallocate ++ .fallocate = aufs_fallocate, ++ .copy_file_range = aufs_copy_file_range +}; diff --git a/fs/aufs/fhsm.c b/fs/aufs/fhsm.c new file mode 100644 -index 0000000..e3cb6ed +index 000000000000..c55abb1b846f --- /dev/null +++ b/fs/aufs/fhsm.c -@@ -0,0 +1,412 @@ +@@ -0,0 +1,413 @@ +/* -+ * Copyright (C) 2011-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2011-2017 Junjiro R. Okajima + */ + +/* @@ -11934,12 +13765,13 @@ index 0000000..e3cb6ed +} diff --git a/fs/aufs/file.c b/fs/aufs/file.c new file mode 100644 -index 0000000..bfc1d1b +index 000000000000..83e69022c64c --- /dev/null +++ b/fs/aufs/file.c @@ -0,0 +1,844 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -12035,7 +13867,7 @@ index 0000000..bfc1d1b + +static int au_cmoo(struct dentry *dentry) +{ -+ int err, cmoo; ++ int err, cmoo, matched; + unsigned int udba; + struct path h_path; + struct au_pin pin; @@ -12070,9 +13902,12 @@ index 0000000..bfc1d1b + sbinfo = au_sbi(sb); + fhsm = &sbinfo->si_fhsm; + pid = au_fhsm_pid(fhsm); -+ if (pid -+ && (current->pid == pid -+ || current->real_parent->pid == pid)) ++ rcu_read_lock(); ++ matched = (pid ++ && (current->pid == pid ++ || rcu_dereference(current->real_parent)->pid == pid)); ++ rcu_read_unlock(); ++ if (matched) + goto out; + + br = au_sbr(sb, cpg.bsrc); @@ -12149,11 +13984,11 @@ index 0000000..bfc1d1b + +int au_do_open(struct file *file, struct au_do_open_args *args) +{ -+ int err, no_lock = args->no_lock; ++ int err, aopen = args->aopen; + struct dentry *dentry; + struct au_finfo *finfo; + -+ if (!no_lock) ++ if (!aopen) + err = au_finfo_init(file, args->fidir); + else { + lockdep_off(); @@ -12165,33 +14000,27 @@ index 0000000..bfc1d1b + + dentry = file->f_path.dentry; + AuDebugOn(IS_ERR_OR_NULL(dentry)); -+ if (!no_lock) { -+ di_write_lock_child(dentry); -+ err = au_cmoo(dentry); -+ di_downgrade_lock(dentry, AuLock_IR); -+ if (!err) ++ di_write_lock_child(dentry); ++ err = au_cmoo(dentry); ++ di_downgrade_lock(dentry, AuLock_IR); ++ if (!err) { ++ if (!aopen) + err = args->open(file, vfsub_file_flags(file), NULL); -+ di_read_unlock(dentry, AuLock_IR); -+ } else { -+ err = au_cmoo(dentry); -+ if (!err) -+ err = args->open(file, vfsub_file_flags(file), -+ args->h_file); -+ if (!err && au_fbtop(file) != au_dbtop(dentry)) -+ /* -+ * cmoo happens after h_file was opened. -+ * need to refresh file later. -+ */ -+ atomic_dec(&au_fi(file)->fi_generation); ++ else { ++ lockdep_off(); ++ err = args->open(file, vfsub_file_flags(file), NULL); ++ lockdep_on(); ++ } + } ++ di_read_unlock(dentry, AuLock_IR); + + finfo = au_fi(file); + if (!err) { + finfo->fi_file = file; -+ au_sphl_add(&finfo->fi_hlist, -+ &au_sbi(file->f_path.dentry->d_sb)->si_files); ++ au_hbl_add(&finfo->fi_hlist, ++ &au_sbi(file->f_path.dentry->d_sb)->si_files); + } -+ if (!no_lock) ++ if (!aopen) + fi_write_unlock(file); + else { + lockdep_off(); @@ -12200,10 +14029,11 @@ index 0000000..bfc1d1b + } + if (unlikely(err)) { + finfo->fi_hdir = NULL; -+ au_finfo_fin(file, /*atonce*/0); ++ au_finfo_fin(file); + } + +out: ++ AuTraceErr(err); + return err; +} + @@ -12520,7 +14350,6 @@ index 0000000..bfc1d1b + +static void au_do_refresh_dir(struct file *file) +{ -+ int execed; + aufs_bindex_t bindex, bbot, new_bindex, brid; + struct au_hfile *p, tmp, *q; + struct au_finfo *finfo; @@ -12559,7 +14388,6 @@ index 0000000..bfc1d1b + } + } + -+ execed = vfsub_file_execed(file); + p = fidir->fd_hfile; + if (!au_test_mmapped(file) && !d_unlinked(file->f_path.dentry)) { + bbot = au_sbbot(sb); @@ -12568,14 +14396,14 @@ index 0000000..bfc1d1b + if (p->hf_file) { + if (file_inode(p->hf_file)) + break; -+ au_hfput(p, execed); ++ au_hfput(p, /*execed*/0); + } + } else { + bbot = au_br_index(sb, brid); + for (finfo->fi_btop = 0; finfo->fi_btop < bbot; + finfo->fi_btop++, p++) + if (p->hf_file) -+ au_hfput(p, execed); ++ au_hfput(p, /*execed*/0); + bbot = au_sbbot(sb); + } + @@ -12585,7 +14413,7 @@ index 0000000..bfc1d1b + if (p->hf_file) { + if (file_inode(p->hf_file)) + break; -+ au_hfput(p, execed); ++ au_hfput(p, /*execed*/0); + } + AuDebugOn(fidir->fd_bbot < finfo->fi_btop); +} @@ -12647,7 +14475,7 @@ index 0000000..bfc1d1b + +/* common function to regular file and dir */ +int au_reval_and_lock_fdi(struct file *file, int (*reopen)(struct file *file), -+ int wlock) ++ int wlock, unsigned int fi_lsc) +{ + int err; + unsigned int sigen, figen; @@ -12660,9 +14488,12 @@ index 0000000..bfc1d1b + dentry = file->f_path.dentry; + inode = d_inode(dentry); + sigen = au_sigen(dentry->d_sb); -+ fi_write_lock(file); ++ fi_write_lock_nested(file, fi_lsc); + figen = au_figen(file); -+ di_write_lock_child(dentry); ++ if (!fi_lsc) ++ di_write_lock_child(dentry); ++ else ++ di_write_lock_child2(dentry); + btop = au_dbtop(dentry); + pseudo_link = (btop != au_ibtop(inode)); + if (sigen == figen && !pseudo_link && au_fbtop(file) == btop) { @@ -12784,12 +14615,13 @@ index 0000000..bfc1d1b +}; diff --git a/fs/aufs/file.h b/fs/aufs/file.h new file mode 100644 -index 0000000..f53b381 +index 000000000000..c767a785227c --- /dev/null +++ b/fs/aufs/file.h -@@ -0,0 +1,281 @@ +@@ -0,0 +1,328 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -12803,6 +14635,7 @@ index 0000000..f53b381 + +#include +#include ++#include +#include +#include "rwsem.h" + @@ -12839,11 +14672,8 @@ index 0000000..f53b381 + }; + struct au_fidir *fi_hdir; /* for dir only */ + -+ struct hlist_node fi_hlist; -+ union { -+ struct file *fi_file; /* very ugly */ -+ struct llist_node fi_lnode; /* delayed free */ -+ }; ++ struct hlist_bl_node fi_hlist; ++ struct file *fi_file; /* very ugly */ +} ____cacheline_aligned_in_smp; + +/* ---------------------------------------------------------------------- */ @@ -12854,7 +14684,7 @@ index 0000000..f53b381 +struct file *au_h_open(struct dentry *dentry, aufs_bindex_t bindex, int flags, + struct file *file, int force_wr); +struct au_do_open_args { -+ int no_lock; ++ int aopen; + int (*open)(struct file *file, int flags, + struct file *h_file); + struct au_fidir *fidir; @@ -12865,7 +14695,7 @@ index 0000000..f53b381 +struct au_pin; +int au_ready_to_write(struct file *file, loff_t len, struct au_pin *pin); +int au_reval_and_lock_fdi(struct file *file, int (*reopen)(struct file *file), -+ int wlock); ++ int wlock, unsigned int fi_lsc); +int au_do_flush(struct file *file, fl_owner_t id, + int (*flush)(struct file *file, fl_owner_t id)); + @@ -12891,7 +14721,7 @@ index 0000000..f53b381 +extern const struct file_operations aufs_file_fop; +int au_do_open_nondir(struct file *file, int flags, struct file *h_file); +int aufs_release_nondir(struct inode *inode __maybe_unused, struct file *file); -+struct file *au_read_pre(struct file *file, int keep_fi); ++struct file *au_read_pre(struct file *file, int keep_fi, unsigned int lsc); + +/* finfo.c */ +void au_hfput(struct au_hfile *hf, int execed); @@ -12903,7 +14733,7 @@ index 0000000..f53b381 +int au_fidir_realloc(struct au_finfo *finfo, int nbr, int may_shrink); + +void au_fi_init_once(void *_fi); -+void au_finfo_fin(struct file *file, int atonce); ++void au_finfo_fin(struct file *file); +int au_finfo_init(struct file *file, struct au_fidir *fidir); + +/* ioctl.c */ @@ -12924,11 +14754,59 @@ index 0000000..f53b381 + +/* ---------------------------------------------------------------------- */ + ++#define fi_read_lock(f) au_rw_read_lock(&au_fi(f)->fi_rwsem) ++#define fi_write_lock(f) au_rw_write_lock(&au_fi(f)->fi_rwsem) ++#define fi_read_trylock(f) au_rw_read_trylock(&au_fi(f)->fi_rwsem) ++#define fi_write_trylock(f) au_rw_write_trylock(&au_fi(f)->fi_rwsem) +/* -+ * fi_read_lock, fi_write_lock, -+ * fi_read_unlock, fi_write_unlock, fi_downgrade_lock ++#define fi_read_trylock_nested(f) \ ++ au_rw_read_trylock_nested(&au_fi(f)->fi_rwsem) ++#define fi_write_trylock_nested(f) \ ++ au_rw_write_trylock_nested(&au_fi(f)->fi_rwsem) ++*/ ++ ++#define fi_read_unlock(f) au_rw_read_unlock(&au_fi(f)->fi_rwsem) ++#define fi_write_unlock(f) au_rw_write_unlock(&au_fi(f)->fi_rwsem) ++#define fi_downgrade_lock(f) au_rw_dgrade_lock(&au_fi(f)->fi_rwsem) ++ ++/* lock subclass for finfo */ ++enum { ++ AuLsc_FI_1, ++ AuLsc_FI_2 ++}; ++ ++static inline void fi_read_lock_nested(struct file *f, unsigned int lsc) ++{ ++ au_rw_read_lock_nested(&au_fi(f)->fi_rwsem, lsc); ++} ++ ++static inline void fi_write_lock_nested(struct file *f, unsigned int lsc) ++{ ++ au_rw_write_lock_nested(&au_fi(f)->fi_rwsem, lsc); ++} ++ ++/* ++ * fi_read_lock_1, fi_write_lock_1, ++ * fi_read_lock_2, fi_write_lock_2 + */ -+AuSimpleRwsemFuncs(fi, struct file *f, &au_fi(f)->fi_rwsem); ++#define AuReadLockFunc(name) \ ++static inline void fi_read_lock_##name(struct file *f) \ ++{ fi_read_lock_nested(f, AuLsc_FI_##name); } ++ ++#define AuWriteLockFunc(name) \ ++static inline void fi_write_lock_##name(struct file *f) \ ++{ fi_write_lock_nested(f, AuLsc_FI_##name); } ++ ++#define AuRWLockFuncs(name) \ ++ AuReadLockFunc(name) \ ++ AuWriteLockFunc(name) ++ ++AuRWLockFuncs(1); ++AuRWLockFuncs(2); ++ ++#undef AuReadLockFunc ++#undef AuWriteLockFunc ++#undef AuRWLockFuncs + +#define FiMustNoWaiters(f) AuRwMustNoWaiters(&au_fi(f)->fi_rwsem) +#define FiMustAnyLock(f) AuRwMustAnyLock(&au_fi(f)->fi_rwsem) @@ -13071,12 +14949,13 @@ index 0000000..f53b381 +#endif /* __AUFS_FILE_H__ */ diff --git a/fs/aufs/finfo.c b/fs/aufs/finfo.c new file mode 100644 -index 0000000..0f016ed +index 000000000000..ca55e38058f1 --- /dev/null +++ b/fs/aufs/finfo.c -@@ -0,0 +1,138 @@ +@@ -0,0 +1,136 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -13166,7 +15045,7 @@ index 0000000..0f016ed + +/* ---------------------------------------------------------------------- */ + -+void au_finfo_fin(struct file *file, int atonce) ++void au_finfo_fin(struct file *file) +{ + struct au_finfo *finfo; + @@ -13175,10 +15054,7 @@ index 0000000..0f016ed + finfo = au_fi(file); + AuDebugOn(finfo->fi_hdir); + AuRwDestroy(&finfo->fi_rwsem); -+ if (!atonce) -+ au_cache_dfree_finfo(finfo); -+ else -+ au_cache_free_finfo(finfo); ++ au_cache_free_finfo(finfo); +} + +void au_fi_init_once(void *_finfo) @@ -13215,12 +15091,13 @@ index 0000000..0f016ed +} diff --git a/fs/aufs/fstype.h b/fs/aufs/fstype.h new file mode 100644 -index 0000000..95b78b9 +index 000000000000..702f4280c196 --- /dev/null +++ b/fs/aufs/fstype.h -@@ -0,0 +1,387 @@ +@@ -0,0 +1,388 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -13606,14 +15483,73 @@ index 0000000..95b78b9 + +#endif /* __KERNEL__ */ +#endif /* __AUFS_FSTYPE_H__ */ +diff --git a/fs/aufs/hbl.h b/fs/aufs/hbl.h +new file mode 100644 +index 000000000000..5b40d113b9ea +--- /dev/null ++++ b/fs/aufs/hbl.h +@@ -0,0 +1,52 @@ ++/* ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2017 Junjiro R. Okajima ++ */ ++ ++/* ++ * helpers for hlist_bl.h ++ */ ++ ++#ifndef __AUFS_HBL_H__ ++#define __AUFS_HBL_H__ ++ ++#ifdef __KERNEL__ ++ ++#include ++ ++static inline void au_hbl_add(struct hlist_bl_node *node, ++ struct hlist_bl_head *hbl) ++{ ++ hlist_bl_lock(hbl); ++ hlist_bl_add_head(node, hbl); ++ hlist_bl_unlock(hbl); ++} ++ ++static inline void au_hbl_del(struct hlist_bl_node *node, ++ struct hlist_bl_head *hbl) ++{ ++ hlist_bl_lock(hbl); ++ hlist_bl_del(node); ++ hlist_bl_unlock(hbl); ++} ++ ++#define au_hbl_for_each(pos, head) \ ++ for (pos = hlist_bl_first(head); \ ++ pos; \ ++ pos = pos->next) ++ ++static inline unsigned long au_hbl_count(struct hlist_bl_head *hbl) ++{ ++ unsigned long cnt; ++ struct hlist_bl_node *pos; ++ ++ cnt = 0; ++ hlist_bl_lock(hbl); ++ au_hbl_for_each(pos, hbl) ++ cnt++; ++ hlist_bl_unlock(hbl); ++ return cnt; ++} ++ ++#endif /* __KERNEL__ */ ++#endif /* __AUFS_HBL_H__ */ diff --git a/fs/aufs/hfsnotify.c b/fs/aufs/hfsnotify.c new file mode 100644 -index 0000000..110f8f5 +index 000000000000..b11a88a33416 --- /dev/null +++ b/fs/aufs/hfsnotify.c -@@ -0,0 +1,274 @@ +@@ -0,0 +1,277 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -13633,8 +15569,8 @@ index 0000000..110f8f5 + struct au_hnotify *hn = container_of(mark, struct au_hnotify, + hn_mark); + /* AuDbg("here\n"); */ -+ au_cache_dfree_hnotify(hn); -+ smp_mb__before_atomic(); ++ au_cache_free_hnotify(hn); ++ smp_mb__before_atomic(); /* for atomic64_dec */ + if (atomic64_dec_and_test(&au_hfsn_ifree)) + wake_up(&au_hfsn_wq); +} @@ -13655,15 +15591,15 @@ index 0000000..110f8f5 + AuDebugOn(!br->br_hfsn); + + mark = &hn->hn_mark; -+ fsnotify_init_mark(mark, au_hfsn_free_mark); ++ fsnotify_init_mark(mark, br->br_hfsn->hfsn_group); + mark->mask = AuHfsnMask; + /* + * by udba rename or rmdir, aufs assign a new inode to the known + * h_inode, so specify 1 to allow dups. + */ + lockdep_off(); -+ err = fsnotify_add_mark(mark, br->br_hfsn->hfsn_group, hinode->hi_inode, -+ /*mnt*/NULL, /*allow_dups*/1); ++ err = fsnotify_add_mark(mark, hinode->hi_inode, /*mnt*/NULL, ++ /*allow_dups*/1); + lockdep_on(); + + return err; @@ -13757,15 +15693,16 @@ index 0000000..110f8f5 + struct au_br_hfsnotify *hfsn = group->private; + + /* AuDbg("here\n"); */ -+ au_delayed_kfree(hfsn); ++ kfree(hfsn); +} + +static int au_hfsn_handle_event(struct fsnotify_group *group, + struct inode *inode, + struct fsnotify_mark *inode_mark, + struct fsnotify_mark *vfsmount_mark, -+ u32 mask, void *data, int data_type, -+ const unsigned char *file_name, u32 cookie) ++ u32 mask, const void *data, int data_type, ++ const unsigned char *file_name, u32 cookie, ++ struct fsnotify_iter_info *iter_info) +{ + int err; + struct au_hnotify *hnotify; @@ -13804,7 +15741,8 @@ index 0000000..110f8f5 + +static struct fsnotify_ops au_hfsn_ops = { + .handle_event = au_hfsn_handle_event, -+ .free_group_priv = au_hfsn_free_group ++ .free_group_priv = au_hfsn_free_group, ++ .free_mark = au_hfsn_free_mark +}; + +/* ---------------------------------------------------------------------- */ @@ -13851,7 +15789,7 @@ index 0000000..110f8f5 + goto out; /* success */ + +out_hfsn: -+ au_delayed_kfree(hfsn); ++ kfree(hfsn); +out: + return err; +} @@ -13888,12 +15826,13 @@ index 0000000..110f8f5 +}; diff --git a/fs/aufs/hfsplus.c b/fs/aufs/hfsplus.c new file mode 100644 -index 0000000..145c6ac +index 000000000000..2596935ce744 --- /dev/null +++ b/fs/aufs/hfsplus.c -@@ -0,0 +1,43 @@ +@@ -0,0 +1,44 @@ +/* -+ * Copyright (C) 2010-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2010-2017 Junjiro R. Okajima + */ + +/* @@ -13937,12 +15876,13 @@ index 0000000..145c6ac +} diff --git a/fs/aufs/hnotify.c b/fs/aufs/hnotify.c new file mode 100644 -index 0000000..a05aed8 +index 000000000000..e55c6c04d147 --- /dev/null +++ b/fs/aufs/hnotify.c -@@ -0,0 +1,710 @@ +@@ -0,0 +1,707 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -13965,7 +15905,7 @@ index 0000000..a05aed8 + AuTraceErr(err); + if (unlikely(err)) { + hinode->hi_notify = NULL; -+ au_cache_dfree_hnotify(hn); ++ au_cache_free_hnotify(hn); + /* + * The upper dir was removed by udba, but the same named + * dir left. In this case, aufs assignes a new inode @@ -13989,7 +15929,7 @@ index 0000000..a05aed8 + if (hn) { + hinode->hi_notify = NULL; + if (au_hnotify_op.free(hinode, hn)) -+ au_cache_dfree_hnotify(hn); ++ au_cache_free_hnotify(hn); + } +} + @@ -14252,11 +16192,11 @@ index 0000000..a05aed8 + if (au_ftest_hnjob(a->flags, TRYXINO0) + && a->inode + && a->h_inode) { -+ inode_lock_nested(a->h_inode, AuLsc_I_CHILD); ++ vfsub_inode_lock_shared_nested(a->h_inode, AuLsc_I_CHILD); + if (!a->h_inode->i_nlink + && !(a->h_inode->i_state & I_LINKABLE)) + hn_xino(a->inode, a->h_inode); /* ignore this error */ -+ inode_unlock(a->h_inode); ++ inode_unlock_shared(a->h_inode); + } + + /* make the generation obsolete */ @@ -14392,6 +16332,14 @@ index 0000000..a05aed8 + AuDebugOn(!sbinfo); + si_write_lock(sb, AuLock_NOPLMW); + ++ if (au_opt_test(sbinfo->si_mntflags, DIRREN)) ++ switch (a->mask & FS_EVENTS_POSS_ON_CHILD) { ++ case FS_MOVED_FROM: ++ case FS_MOVED_TO: ++ AuWarn1("DIRREN with UDBA may not work correctly " ++ "for the direct rename(2)\n"); ++ } ++ + ii_read_lock_parent(a->dir); + bfound = -1; + bbot = au_ibbot(a->dir); @@ -14462,7 +16410,7 @@ index 0000000..a05aed8 + iput(a->dir); + si_write_unlock(sb); + au_nwt_done(&sbinfo->si_nowait); -+ au_delayed_kfree(a); ++ kfree(a); +} + +/* ---------------------------------------------------------------------- */ @@ -14568,7 +16516,7 @@ index 0000000..a05aed8 + iput(args->h_child_inode); + iput(args->h_dir); + iput(args->dir); -+ au_delayed_kfree(args); ++ kfree(args); + } + +out: @@ -14609,26 +16557,17 @@ index 0000000..a05aed8 + +static void au_hn_destroy_cache(void) +{ -+ struct au_cache *cp; -+ -+ flush_delayed_work(&au_dfree.dwork); -+ cp = au_dfree.cache + AuCache_HNOTIFY; -+ AuDebugOn(!llist_empty(&cp->llist)); -+ kmem_cache_destroy(cp->cache); -+ cp->cache = NULL; ++ kmem_cache_destroy(au_cache[AuCache_HNOTIFY]); ++ au_cache[AuCache_HNOTIFY] = NULL; +} + -+AU_CACHE_DFREE_FUNC(hnotify, HNOTIFY, hn_lnode); -+ +int __init au_hnotify_init(void) +{ + int err; -+ struct au_cache *cp; + + err = -ENOMEM; -+ cp = au_dfree.cache + AuCache_HNOTIFY; -+ cp->cache = AuCache(au_hnotify); -+ if (cp->cache) { ++ au_cache[AuCache_HNOTIFY] = AuCache(au_hnotify); ++ if (au_cache[AuCache_HNOTIFY]) { + err = 0; + if (au_hnotify_op.init) + err = au_hnotify_op.init(); @@ -14641,24 +16580,22 @@ index 0000000..a05aed8 + +void au_hnotify_fin(void) +{ -+ struct au_cache *cp; -+ + if (au_hnotify_op.fin) + au_hnotify_op.fin(); + + /* cf. au_cache_fin() */ -+ cp = au_dfree.cache + AuCache_HNOTIFY; -+ if (cp->cache) ++ if (au_cache[AuCache_HNOTIFY]) + au_hn_destroy_cache(); +} diff --git a/fs/aufs/i_op.c b/fs/aufs/i_op.c new file mode 100644 -index 0000000..444be461 +index 000000000000..6d9381769876 --- /dev/null +++ b/fs/aufs/i_op.c -@@ -0,0 +1,1431 @@ +@@ -0,0 +1,1447 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -14898,27 +16835,28 @@ index 0000000..444be461 +/* ---------------------------------------------------------------------- */ + +struct aopen_node { -+ struct hlist_node hlist; ++ struct hlist_bl_node hblist; + struct file *file, *h_file; +}; + +static int au_do_aopen(struct inode *inode, struct file *file) +{ -+ struct au_sphlhead *aopen; ++ struct hlist_bl_head *aopen; ++ struct hlist_bl_node *pos; + struct aopen_node *node; + struct au_do_open_args args = { -+ .no_lock = 1, -+ .open = au_do_open_nondir ++ .aopen = 1, ++ .open = au_do_open_nondir + }; + + aopen = &au_sbi(inode->i_sb)->si_aopen; -+ spin_lock(&aopen->spin); -+ hlist_for_each_entry(node, &aopen->head, hlist) ++ hlist_bl_lock(aopen); ++ hlist_bl_for_each_entry(node, pos, aopen, hblist) + if (node->file == file) { + args.h_file = node->h_file; + break; + } -+ spin_unlock(&aopen->spin); ++ hlist_bl_unlock(aopen); + /* AuDebugOn(!args.h_file); */ + + return au_do_open(file, &args); @@ -14928,10 +16866,10 @@ index 0000000..444be461 + struct file *file, unsigned int open_flag, + umode_t create_mode, int *opened) +{ -+ int err, h_opened = *opened; ++ int err, unlocked, h_opened = *opened; + unsigned int lkup_flags; + struct dentry *parent, *d; -+ struct au_sphlhead *aopen; ++ struct hlist_bl_head *aopen; + struct vfsub_aopen_args args = { + .open_flag = open_flag, + .create_mode = create_mode, @@ -14973,6 +16911,7 @@ index 0000000..444be461 + || !(open_flag & O_CREAT)) + goto out_no_open; + ++ unlocked = 0; + err = aufs_read_lock(dentry, AuLock_DW | AuLock_FLUSH | AuLock_GEN); + if (unlikely(err)) + goto out; @@ -15003,6 +16942,9 @@ index 0000000..444be461 + put_filp(args.file); + goto out_unlock; + } ++ di_write_unlock(parent); ++ di_write_unlock(dentry); ++ unlocked = 1; + + /* some filesystems don't set FILE_CREATED while succeeded? */ + *opened |= FILE_CREATED; @@ -15013,17 +16955,21 @@ index 0000000..444be461 + args.file = NULL; + } + aopen = &au_sbi(dir->i_sb)->si_aopen; -+ au_sphl_add(&aopen_node.hlist, aopen); ++ au_hbl_add(&aopen_node.hblist, aopen); + err = finish_open(file, dentry, au_do_aopen, opened); -+ au_sphl_del(&aopen_node.hlist, aopen); ++ au_hbl_del(&aopen_node.hblist, aopen); + AuTraceErr(err); + AuDbgFile(file); + if (aopen_node.h_file) + fput(aopen_node.h_file); + +out_unlock: -+ di_write_unlock(parent); -+ aufs_read_unlock(dentry, AuLock_DW); ++ if (unlocked) ++ si_read_unlock(dentry->d_sb); ++ else { ++ di_write_unlock(parent); ++ aufs_read_unlock(dentry, AuLock_DW); ++ } + AuDbgDentry(dentry); + if (unlikely(err < 0)) + goto out; @@ -15069,10 +17015,10 @@ index 0000000..444be461 + if (!err && add_entry && !au_ftest_wrdir(add_entry, TMPFILE)) { + h_parent = au_h_dptr(parent, bcpup); + h_dir = d_inode(h_parent); -+ inode_lock_nested(h_dir, AuLsc_I_PARENT); ++ vfsub_inode_lock_shared_nested(h_dir, AuLsc_I_PARENT); + err = au_lkup_neg(dentry, bcpup, /*wh*/0); + /* todo: no unlock here */ -+ inode_unlock(h_dir); ++ inode_unlock_shared(h_dir); + + AuDbg("bcpup %d\n", bcpup); + if (!err) { @@ -15456,10 +17402,10 @@ index 0000000..444be461 + a->h_path.dentry = au_h_dptr(dentry, btop); + a->h_inode = d_inode(a->h_path.dentry); + if (ia && (ia->ia_valid & ATTR_SIZE)) { -+ inode_lock_nested(a->h_inode, AuLsc_I_CHILD); ++ vfsub_inode_lock_shared_nested(a->h_inode, AuLsc_I_CHILD); + if (ia->ia_size < i_size_read(a->h_inode)) + sz = ia->ia_size; -+ inode_unlock(a->h_inode); ++ inode_unlock_shared(a->h_inode); + } + + hi_wh = NULL; @@ -15556,7 +17502,8 @@ index 0000000..444be461 + /* currently ftruncate(2) only */ + AuDebugOn(!d_is_reg(dentry)); + file = ia->ia_file; -+ err = au_reval_and_lock_fdi(file, au_reopen_nondir, /*wlock*/1); ++ err = au_reval_and_lock_fdi(file, au_reopen_nondir, /*wlock*/1, ++ /*fi_lsc*/0); + if (unlikely(err)) + goto out_si; + ia->ia_file = au_hf_top(file); @@ -15646,7 +17593,7 @@ index 0000000..444be461 +out_si: + si_read_unlock(sb); +out_kfree: -+ au_delayed_kfree(a); ++ kfree(a); +out: + AuTraceErr(err); + return err; @@ -15737,7 +17684,7 @@ index 0000000..444be461 + di_write_unlock(dentry); + si_read_unlock(sb); +out_kfree: -+ au_delayed_kfree(a); ++ kfree(a); +out: + AuTraceErr(err); + return err; @@ -15778,7 +17725,8 @@ index 0000000..444be461 + * returns zero or negative (an error). + * @dentry will be read-locked in success. + */ -+int au_h_path_getattr(struct dentry *dentry, int force, struct path *h_path) ++int au_h_path_getattr(struct dentry *dentry, int force, struct path *h_path, ++ int locked) +{ + int err; + unsigned int mnt_flags, sigen; @@ -15795,6 +17743,9 @@ index 0000000..444be461 + mnt_flags = au_mntflags(sb); + udba_none = !!au_opt_test(mnt_flags, UDBA_NONE); + ++ if (unlikely(locked)) ++ goto body; /* skip locking dinfo */ ++ + /* support fstat(2) */ + if (!d_unlinked(dentry) && !udba_none) { + sigen = au_sigen(sb); @@ -15822,6 +17773,7 @@ index 0000000..444be461 + } else + di_read_lock_child(dentry, AuLock_IR); + ++body: + inode = d_inode(dentry); + bindex = au_ibtop(inode); + h_path->mnt = au_sbr_mnt(sb, bindex); @@ -15846,21 +17798,23 @@ index 0000000..444be461 + return err; +} + -+static int aufs_getattr(struct vfsmount *mnt __maybe_unused, -+ struct dentry *dentry, struct kstat *st) ++static int aufs_getattr(const struct path *path, struct kstat *st, ++ u32 request, unsigned int query) +{ + int err; + unsigned char positive; + struct path h_path; ++ struct dentry *dentry; + struct inode *inode; + struct super_block *sb; + ++ dentry = path->dentry; + inode = d_inode(dentry); + sb = dentry->d_sb; + err = si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLM); + if (unlikely(err)) + goto out; -+ err = au_h_path_getattr(dentry, /*force*/0, &h_path); ++ err = au_h_path_getattr(dentry, /*force*/0, &h_path, /*locked*/0); + if (unlikely(err)) + goto out_si; + if (unlikely(!h_path.dentry)) @@ -15869,7 +17823,8 @@ index 0000000..444be461 + + positive = d_is_positive(h_path.dentry); + if (positive) -+ err = vfs_getattr(&h_path, st); ++ /* no vfsub version */ ++ err = vfs_getattr(&h_path, st, request, query); + if (!err) { + if (positive) + au_refresh_iattr(inode, st, @@ -15978,7 +17933,6 @@ index 0000000..444be461 + lockdep_off(); + si_read_lock(sb, AuLock_FLUSH); + ii_write_lock_child(inode); -+ lockdep_on(); + + err = 0; + bindex = au_ibtop(inode); @@ -16006,7 +17960,6 @@ index 0000000..444be461 + AuDebugOn(1); + } + -+ lockdep_off(); + if (!err) + au_cpup_attr_timesizes(inode); + ii_write_unlock(inode); @@ -16038,7 +17991,6 @@ index 0000000..444be461 + .listxattr = aufs_listxattr, +#endif + -+ .readlink = generic_readlink, + .get_link = aufs_get_link, + + /* .update_time = aufs_update_time */ @@ -16090,12 +18042,13 @@ index 0000000..444be461 +}; diff --git a/fs/aufs/i_op_add.c b/fs/aufs/i_op_add.c new file mode 100644 -index 0000000..680cd89 +index 000000000000..5523be8edd6a --- /dev/null +++ b/fs/aufs/i_op_add.c -@@ -0,0 +1,915 @@ +@@ -0,0 +1,908 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -16428,7 +18381,7 @@ index 0000000..680cd89 + if (!try_aopen) + aufs_read_unlock(dentry, AuLock_DW); +out_free: -+ au_delayed_kfree(a); ++ kfree(a); +out: + return err; +} @@ -16538,18 +18491,11 @@ index 0000000..680cd89 + goto out_parent; + + h_parent = au_h_dptr(parent, bindex); -+ err = inode_permission(d_inode(h_parent), MAY_WRITE | MAY_EXEC); -+ if (unlikely(err)) ++ h_dentry = vfs_tmpfile(h_parent, mode, /*open_flag*/0); ++ if (IS_ERR(h_dentry)) { ++ err = PTR_ERR(h_dentry); + goto out_mnt; -+ -+ err = -ENOMEM; -+ h_dentry = d_alloc(h_parent, &dentry->d_name); -+ if (unlikely(!h_dentry)) -+ goto out_mnt; -+ -+ err = h_dir->i_op->tmpfile(h_dir, h_dentry, mode); -+ if (unlikely(err)) -+ goto out_dentry; ++ } + + au_set_dbtop(dentry, bindex); + au_set_dbbot(dentry, bindex); @@ -16570,9 +18516,8 @@ index 0000000..680cd89 + if (au_ibtop(dir) == au_dbtop(dentry)) + au_cpup_attr_timesizes(dir); + } -+ -+out_dentry: + dput(h_dentry); ++ +out_mnt: + vfsub_mnt_drop_write(h_mnt); +out_parent: @@ -16896,7 +18841,7 @@ index 0000000..680cd89 + } + aufs_read_and_write_unlock2(dentry, src_dentry); +out_kfree: -+ au_delayed_kfree(a); ++ kfree(a); +out: + AuTraceErr(err); + return err; @@ -17005,18 +18950,19 @@ index 0000000..680cd89 + } + aufs_read_unlock(dentry, AuLock_DW); +out_free: -+ au_delayed_kfree(a); ++ kfree(a); +out: + return err; +} diff --git a/fs/aufs/i_op_del.c b/fs/aufs/i_op_del.c new file mode 100644 -index 0000000..2fe8f07 +index 000000000000..4a22fbcfc348 --- /dev/null +++ b/fs/aufs/i_op_del.c -@@ -0,0 +1,498 @@ +@@ -0,0 +1,499 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -17398,7 +19344,7 @@ index 0000000..2fe8f07 +out_unlock: + aufs_read_unlock(dentry, AuLock_DW); +out_free: -+ au_delayed_kfree(a); ++ kfree(a); +out: + return err; +} @@ -17508,19 +19454,20 @@ index 0000000..2fe8f07 +out_unlock: + aufs_read_unlock(dentry, AuLock_DW); +out_free: -+ au_delayed_kfree(a); ++ kfree(a); +out: + AuTraceErr(err); + return err; +} diff --git a/fs/aufs/i_op_ren.c b/fs/aufs/i_op_ren.c new file mode 100644 -index 0000000..dd47c44 +index 000000000000..7071c57d3d63 --- /dev/null +++ b/fs/aufs/i_op_ren.c -@@ -0,0 +1,1152 @@ +@@ -0,0 +1,1234 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -17542,12 +19489,20 @@ index 0000000..dd47c44 +#define AuRen_DT_DSTDIR (1 << 6) +#define AuRen_DIROPQ_SRC (1 << 7) +#define AuRen_DIROPQ_DST (1 << 8) ++#define AuRen_DIRREN (1 << 9) ++#define AuRen_DROPPED_SRC (1 << 10) ++#define AuRen_DROPPED_DST (1 << 11) +#define au_ftest_ren(flags, name) ((flags) & AuRen_##name) +#define au_fset_ren(flags, name) \ + do { (flags) |= AuRen_##name; } while (0) +#define au_fclr_ren(flags, name) \ + do { (flags) &= ~AuRen_##name; } while (0) + ++#ifndef CONFIG_AUFS_DIRREN ++#undef AuRen_DIRREN ++#define AuRen_DIRREN 0 ++#endif ++ +struct au_ren_args { + struct { + struct dentry *dentry, *h_dentry, *parent, *h_parent, @@ -17600,6 +19555,7 @@ index 0000000..dd47c44 + + struct au_whtmp_rmdir *thargs; + struct dentry *h_dst; ++ struct au_hinode *h_root; +}; + +/* ---------------------------------------------------------------------- */ @@ -17814,6 +19770,7 @@ index 0000000..dd47c44 + d = a->dst_dentry; /* already renamed on the branch */ + always = !!au_opt_test(au_mntflags(d->d_sb), ALWAYS_DIROPQ); + if (au_ftest_ren(a->auren_flags, ISDIR_SRC) ++ && !au_ftest_ren(a->auren_flags, DIRREN) + && a->btgt != au_dbdiropq(a->src_dentry) + && (a->dst_wh_dentry + || a->btgt <= au_dbdiropq(d) @@ -17861,6 +19818,7 @@ index 0000000..dd47c44 + /* prepare workqueue args for asynchronous rmdir */ + h_d = a->dst_h_dentry; + if (au_ftest_ren(a->auren_flags, ISDIR_DST) ++ /* && !au_ftest_ren(a->auren_flags, DIRREN) */ + && d_is_positive(h_d)) { + err = -ENOMEM; + a->thargs = au_whtmp_rmdir_alloc(a->src_dentry->d_sb, @@ -17910,6 +19868,11 @@ index 0000000..dd47c44 + } + + BUG_ON(d_is_positive(a->dst_h_dentry) && a->src_btop != a->btgt); ++#if 0 ++ BUG_ON(!au_ftest_ren(a->auren_flags, DIRREN) ++ && d_is_positive(a->dst_h_dentry) ++ && a->src_btop != a->btgt); ++#endif + + /* rename by vfs_rename or cpup */ + err = au_ren_or_cpup(a); @@ -17992,25 +19955,35 @@ index 0000000..dd47c44 +} + +/* -+ * test if @dentry dir can be rename source or not. -+ * if it can, return 0 and @children is filled. ++ * test if @a->src_dentry dir can be rename source or not. ++ * if it can, return 0. + * success means, + * - it is a logically empty dir. + * - or, it exists on writable branch and has no children including whiteouts -+ * on the lower branch. ++ * on the lower branch unless DIRREN is on. + */ -+static int may_rename_srcdir(struct dentry *dentry, aufs_bindex_t btgt) ++static int may_rename_srcdir(struct au_ren_args *a) +{ + int err; + unsigned int rdhash; -+ aufs_bindex_t btop; ++ aufs_bindex_t btop, btgt; ++ struct dentry *dentry; ++ struct super_block *sb; ++ struct au_sbinfo *sbinfo; + ++ dentry = a->src_dentry; ++ sb = dentry->d_sb; ++ sbinfo = au_sbi(sb); ++ if (au_opt_test(sbinfo->si_mntflags, DIRREN)) ++ au_fset_ren(a->auren_flags, DIRREN); ++ ++ btgt = a->btgt; + btop = au_dbtop(dentry); + if (btop != btgt) { + struct au_nhash whlist; + -+ SiMustAnyLock(dentry->d_sb); -+ rdhash = au_sbi(dentry->d_sb)->si_rdhash; ++ SiMustAnyLock(sb); ++ rdhash = sbinfo->si_rdhash; + if (!rdhash) + rdhash = au_rdhash_est(au_dir_size(/*file*/NULL, + dentry)); @@ -18029,9 +20002,13 @@ index 0000000..dd47c44 + +out: + if (err == -ENOTEMPTY) { -+ AuWarn1("renaming dir who has child(ren) on multiple branches," -+ " is not supported\n"); -+ err = -EXDEV; ++ if (au_ftest_ren(a->auren_flags, DIRREN)) { ++ err = 0; ++ } else { ++ AuWarn1("renaming dir who has child(ren) on multiple " ++ "branches, is not supported\n"); ++ err = -EXDEV; ++ } + } + return err; +} @@ -18060,7 +20037,7 @@ index 0000000..dd47c44 + err = may_rename_dstdir(d, &a->whlist); + au_set_dbtop(d, a->btgt); + } else -+ err = may_rename_srcdir(d, a->btgt); ++ err = may_rename_srcdir(a); + } + a->dst_h_dentry = au_h_dptr(d, au_dbtop(d)); + if (unlikely(err)) @@ -18069,7 +20046,7 @@ index 0000000..dd47c44 + d = a->src_dentry; + a->src_h_dentry = au_h_dptr(d, au_dbtop(d)); + if (au_ftest_ren(a->auren_flags, ISDIR_SRC)) { -+ err = may_rename_srcdir(d, a->btgt); ++ err = may_rename_srcdir(a); + if (unlikely(err)) { + au_nhash_wh_free(&a->whlist); + a->whlist.nh_num = 0; @@ -18159,6 +20136,9 @@ index 0000000..dd47c44 +{ + vfsub_unlock_rename(a->src_h_parent, a->src_hdir, + a->dst_h_parent, a->dst_hdir); ++ if (au_ftest_ren(a->auren_flags, DIRREN) ++ && a->h_root) ++ au_hn_inode_unlock(a->h_root); + if (au_ftest_ren(a->auren_flags, MNT_WRITE)) + vfsub_mnt_drop_write(au_br_mnt(a->br)); +} @@ -18178,6 +20158,23 @@ index 0000000..dd47c44 + if (unlikely(err)) + goto out; + au_fset_ren(a->auren_flags, MNT_WRITE); ++ if (au_ftest_ren(a->auren_flags, DIRREN)) { ++ struct dentry *root; ++ struct inode *dir; ++ ++ /* ++ * sbinfo is already locked, so this ii_read_lock is ++ * unnecessary. but our debugging feature checks it. ++ */ ++ root = a->src_inode->i_sb->s_root; ++ if (root != a->src_parent && root != a->dst_parent) { ++ dir = d_inode(root); ++ ii_read_lock_parent3(dir); ++ a->h_root = au_hi(dir, a->btgt); ++ ii_read_unlock(dir); ++ au_hn_inode_lock_nested(a->h_root, AuLsc_I_PARENT3); ++ } ++ } + a->h_trap = vfsub_lock_rename(a->src_h_parent, a->src_hdir, + a->dst_h_parent, a->dst_hdir); + udba = au_opt_udba(a->src_dentry->d_sb); @@ -18273,34 +20270,39 @@ index 0000000..dd47c44 + au_update_dbrange(d, /*do_put_zero*/0); + } + -+ d = a->src_dentry; -+ if (!a->exchange) { -+ au_set_dbwh(d, -1); -+ bbot = au_dbbot(d); -+ for (bindex = a->btgt + 1; bindex <= bbot; bindex++) { -+ h_d = au_h_dptr(d, bindex); -+ if (h_d) -+ au_set_h_dptr(d, bindex, NULL); -+ } -+ au_set_dbbot(d, a->btgt); -+ -+ sb = d->d_sb; -+ i = a->src_inode; -+ if (au_opt_test(au_mntflags(sb), PLINK) && au_plink_test(i)) -+ return; /* success */ -+ -+ bbot = au_ibbot(i); -+ for (bindex = a->btgt + 1; bindex <= bbot; bindex++) { -+ h_i = au_h_iptr(i, bindex); -+ if (h_i) { -+ au_xino_write(sb, bindex, h_i->i_ino, /*ino*/0); -+ /* ignore this error */ -+ au_set_h_iptr(i, bindex, NULL, 0); -+ } -+ } -+ au_set_ibbot(i, a->btgt); -+ } ++ if (a->exchange ++ || au_ftest_ren(a->auren_flags, DIRREN)) { + d_drop(a->src_dentry); ++ if (au_ftest_ren(a->auren_flags, DIRREN)) ++ au_set_dbwh(a->src_dentry, -1); ++ return; ++ } ++ ++ d = a->src_dentry; ++ au_set_dbwh(d, -1); ++ bbot = au_dbbot(d); ++ for (bindex = a->btgt + 1; bindex <= bbot; bindex++) { ++ h_d = au_h_dptr(d, bindex); ++ if (h_d) ++ au_set_h_dptr(d, bindex, NULL); ++ } ++ au_set_dbbot(d, a->btgt); ++ ++ sb = d->d_sb; ++ i = a->src_inode; ++ if (au_opt_test(au_mntflags(sb), PLINK) && au_plink_test(i)) ++ return; /* success */ ++ ++ bbot = au_ibbot(i); ++ for (bindex = a->btgt + 1; bindex <= bbot; bindex++) { ++ h_i = au_h_iptr(i, bindex); ++ if (h_i) { ++ au_xino_write(sb, bindex, h_i->i_ino, /*ino*/0); ++ /* ignore this error */ ++ au_set_h_iptr(i, bindex, NULL, 0); ++ } ++ } ++ au_set_ibbot(i, a->btgt); +} + +/* ---------------------------------------------------------------------- */ @@ -18409,6 +20411,7 @@ index 0000000..dd47c44 + unsigned int _flags) +{ + int err, lock_flags; ++ void *rev; + /* reduce stack space */ + struct au_ren_args *a; + struct au_pin pin; @@ -18468,7 +20471,8 @@ index 0000000..dd47c44 + goto out_free; + lock_flags |= AuLock_DIRS; + } -+ err = aufs_read_and_write_lock2(a->dst_dentry, a->src_dentry, lock_flags); ++ err = aufs_read_and_write_lock2(a->dst_dentry, a->src_dentry, ++ lock_flags); + if (unlikely(err)) + goto out_free; + @@ -18621,10 +20625,22 @@ index 0000000..dd47c44 + /* store timestamps to be revertible */ + au_ren_dt(a); + ++ /* store dirren info */ ++ if (au_ftest_ren(a->auren_flags, DIRREN)) { ++ err = au_dr_rename(a->src_dentry, a->btgt, ++ &a->dst_dentry->d_name, &rev); ++ AuTraceErr(err); ++ if (unlikely(err)) ++ goto out_dt; ++ } ++ + /* here we go */ + err = do_rename(a); + if (unlikely(err)) -+ goto out_dt; ++ goto out_dirren; ++ ++ if (au_ftest_ren(a->auren_flags, DIRREN)) ++ au_dr_rename_fin(a->src_dentry, a->btgt, rev); + + /* update dir attributes */ + au_ren_refresh_dir(a); @@ -18634,6 +20650,9 @@ index 0000000..dd47c44 + + goto out_hdir; /* success */ + ++out_dirren: ++ if (au_ftest_ren(a->auren_flags, DIRREN)) ++ au_dr_rename_rev(a->src_dentry, a->btgt, rev); +out_dt: + au_ren_rev_dt(err, a); +out_hdir: @@ -18647,10 +20666,19 @@ index 0000000..dd47c44 + } +out_parent: + if (!err) { ++ if (d_unhashed(a->src_dentry)) ++ au_fset_ren(a->auren_flags, DROPPED_SRC); ++ if (d_unhashed(a->dst_dentry)) ++ au_fset_ren(a->auren_flags, DROPPED_DST); + if (!a->exchange) + d_move(a->src_dentry, a->dst_dentry); -+ else ++ else { + d_exchange(a->src_dentry, a->dst_dentry); ++ if (au_ftest_ren(a->auren_flags, DROPPED_DST)) ++ d_drop(a->dst_dentry); ++ } ++ if (au_ftest_ren(a->auren_flags, DROPPED_SRC)) ++ d_drop(a->src_dentry); + } else { + au_update_dbtop(a->dst_dentry); + if (!a->dst_inode) @@ -18666,19 +20694,20 @@ index 0000000..dd47c44 + iput(a->dst_inode); + if (a->thargs) + au_whtmp_rmdir_free(a->thargs); -+ au_delayed_kfree(a); ++ kfree(a); +out: + AuTraceErr(err); + return err; +} diff --git a/fs/aufs/iinfo.c b/fs/aufs/iinfo.c new file mode 100644 -index 0000000..975cff3 +index 000000000000..df293a889764 --- /dev/null +++ b/fs/aufs/iinfo.c -@@ -0,0 +1,272 @@ +@@ -0,0 +1,273 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -18934,7 +20963,7 @@ index 0000000..975cff3 + + iinfo = au_ii(inode); + if (iinfo->ii_vdir) -+ au_vdir_free(iinfo->ii_vdir, /*atonce*/0); ++ au_vdir_free(iinfo->ii_vdir); + + bindex = iinfo->ii_btop; + if (bindex >= 0) { @@ -18946,17 +20975,18 @@ index 0000000..975cff3 + hi++; + } + } -+ au_delayed_kfree(iinfo->ii_hinode); ++ kfree(iinfo->ii_hinode); + AuRwDestroy(&iinfo->ii_rwsem); +} diff --git a/fs/aufs/inode.c b/fs/aufs/inode.c new file mode 100644 -index 0000000..8f7446d +index 000000000000..8638aa04bbfa --- /dev/null +++ b/fs/aufs/inode.c -@@ -0,0 +1,506 @@ +@@ -0,0 +1,515 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -19279,32 +21309,34 @@ index 0000000..8f7446d +int au_ino(struct super_block *sb, aufs_bindex_t bindex, ino_t h_ino, + unsigned int d_type, ino_t *ino) +{ -+ int err; -+ struct mutex *mtx; ++ int err, idx; ++ const int isnondir = d_type != DT_DIR; + + /* prevent hardlinked inode number from race condition */ -+ mtx = NULL; -+ if (d_type != DT_DIR) { -+ mtx = &au_sbr(sb, bindex)->br_xino.xi_nondir_mtx; -+ mutex_lock(mtx); ++ if (isnondir) { ++ err = au_xinondir_enter(sb, bindex, h_ino, &idx); ++ if (unlikely(err)) ++ goto out; + } ++ + err = au_xino_read(sb, bindex, h_ino, ino); + if (unlikely(err)) -+ goto out; ++ goto out_xinondir; + + if (!*ino) { + err = -EIO; + *ino = au_xino_new_ino(sb); + if (unlikely(!*ino)) -+ goto out; ++ goto out_xinondir; + err = au_xino_write(sb, bindex, h_ino, *ino); + if (unlikely(err)) -+ goto out; ++ goto out_xinondir; + } + ++out_xinondir: ++ if (isnondir && idx >= 0) ++ au_xinondir_leave(sb, bindex, h_ino, idx); +out: -+ if (mtx) -+ mutex_unlock(mtx); + return err; +} + @@ -19315,9 +21347,8 @@ index 0000000..8f7446d + struct inode *inode, *h_inode; + struct dentry *h_dentry; + struct super_block *sb; -+ struct mutex *mtx; + ino_t h_ino, ino; -+ int err; ++ int err, idx, hlinked; + aufs_bindex_t btop; + + sb = dentry->d_sb; @@ -19325,28 +21356,30 @@ index 0000000..8f7446d + h_dentry = au_h_dptr(dentry, btop); + h_inode = d_inode(h_dentry); + h_ino = h_inode->i_ino; ++ hlinked = !d_is_dir(h_dentry) && h_inode->i_nlink > 1; + ++new_ino: + /* + * stop 'race'-ing between hardlinks under different + * parents. + */ -+ mtx = NULL; -+ if (!d_is_dir(h_dentry)) -+ mtx = &au_sbr(sb, btop)->br_xino.xi_nondir_mtx; ++ if (hlinked) { ++ err = au_xinondir_enter(sb, btop, h_ino, &idx); ++ inode = ERR_PTR(err); ++ if (unlikely(err)) ++ goto out; ++ } + -+new_ino: -+ if (mtx) -+ mutex_lock(mtx); + err = au_xino_read(sb, btop, h_ino, &ino); + inode = ERR_PTR(err); + if (unlikely(err)) -+ goto out; ++ goto out_xinondir; + + if (!ino) { + ino = au_xino_new_ino(sb); + if (unlikely(!ino)) { + inode = ERR_PTR(-EIO); -+ goto out; ++ goto out_xinondir; + } + } + @@ -19354,7 +21387,7 @@ index 0000000..8f7446d + inode = au_iget_locked(sb, ino); + err = PTR_ERR(inode); + if (IS_ERR(inode)) -+ goto out; ++ goto out_xinondir; + + AuDbg("%lx, new %d\n", inode->i_state, !!(inode->i_state & I_NEW)); + if (inode->i_state & I_NEW) { @@ -19362,7 +21395,7 @@ index 0000000..8f7446d + err = set_inode(inode, dentry); + if (!err) { + unlock_new_inode(inode); -+ goto out; /* success */ ++ goto out_xinondir; /* success */ + } + + /* @@ -19381,19 +21414,23 @@ index 0000000..8f7446d + * horrible race condition between lookup, readdir and copyup + * (or something). + */ -+ if (mtx) -+ mutex_unlock(mtx); ++ if (hlinked && idx >= 0) ++ au_xinondir_leave(sb, btop, h_ino, idx); + err = reval_inode(inode, dentry); + if (unlikely(err < 0)) { -+ mtx = NULL; ++ hlinked = 0; + goto out_iput; + } -+ -+ if (!err) { -+ mtx = NULL; ++ if (!err) + goto out; /* success */ -+ } else if (mtx) -+ mutex_lock(mtx); ++ else if (hlinked && idx >= 0) { ++ err = au_xinondir_enter(sb, btop, h_ino, &idx); ++ if (unlikely(err)) { ++ iput(inode); ++ inode = ERR_PTR(err); ++ goto out; ++ } ++ } + } + + if (unlikely(au_test_fs_unique_ino(h_inode))) @@ -19405,17 +21442,18 @@ index 0000000..8f7446d + err = au_xino_write(sb, btop, h_ino, /*ino*/0); + if (!err) { + iput(inode); -+ if (mtx) -+ mutex_unlock(mtx); ++ if (hlinked && idx >= 0) ++ au_xinondir_leave(sb, btop, h_ino, idx); + goto new_ino; + } + +out_iput: + iput(inode); + inode = ERR_PTR(err); ++out_xinondir: ++ if (hlinked && idx >= 0) ++ au_xinondir_leave(sb, btop, h_ino, idx); +out: -+ if (mtx) -+ mutex_unlock(mtx); + return inode; +} + @@ -19463,12 +21501,13 @@ index 0000000..8f7446d +} diff --git a/fs/aufs/inode.h b/fs/aufs/inode.h new file mode 100644 -index 0000000..b9e3039 +index 000000000000..2f8e518b283f --- /dev/null +++ b/fs/aufs/inode.h -@@ -0,0 +1,678 @@ +@@ -0,0 +1,683 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -19491,10 +21530,7 @@ index 0000000..b9e3039 + /* never use fsnotify_add_vfsmount_mark() */ + struct fsnotify_mark hn_mark; +#endif -+ union { -+ struct inode *hn_aufs_inode; /* no get/put */ -+ struct llist_node hn_lnode; /* delayed free */ -+ }; ++ struct inode *hn_aufs_inode; /* no get/put */ +#endif +} ____cacheline_aligned_in_smp; + @@ -19537,10 +21573,7 @@ index 0000000..b9e3039 +struct au_icntnr { + struct au_iinfo iinfo; + struct inode vfs_inode; -+ union { -+ struct hlist_node plink; -+ struct llist_node lnode; /* delayed free */ -+ }; ++ struct hlist_bl_node plink; +} ____cacheline_aligned_in_smp; + +/* au_pin flags */ @@ -19666,7 +21699,8 @@ index 0000000..b9e3039 +int au_pin_and_icpup(struct dentry *dentry, struct iattr *ia, + struct au_icpup_args *a); + -+int au_h_path_getattr(struct dentry *dentry, int force, struct path *h_path); ++int au_h_path_getattr(struct dentry *dentry, int force, struct path *h_path, ++ int locked); + +/* i_op_add.c */ +int au_may_add(struct dentry *dentry, aufs_bindex_t bindex, @@ -19855,10 +21889,9 @@ index 0000000..b9e3039 +#undef AuWriteLockFunc +#undef AuRWLockFuncs + -+/* -+ * ii_read_unlock, ii_write_unlock, ii_downgrade_lock -+ */ -+AuSimpleUnlockRwsemFuncs(ii, struct inode *i, &au_ii(i)->ii_rwsem); ++#define ii_read_unlock(i) au_rw_read_unlock(&au_ii(i)->ii_rwsem) ++#define ii_write_unlock(i) au_rw_write_unlock(&au_ii(i)->ii_rwsem) ++#define ii_downgrade_lock(i) au_rw_dgrade_lock(&au_ii(i)->ii_rwsem) + +#define IiMustNoWaiters(i) AuRwMustNoWaiters(&au_ii(i)->ii_rwsem) +#define IiMustAnyLock(i) AuRwMustAnyLock(&au_ii(i)->ii_rwsem) @@ -20137,6 +22170,16 @@ index 0000000..b9e3039 + au_hn_suspend(hdir); +} + ++#if 0 /* unused */ ++#include "vfsub.h" ++static inline void au_hn_inode_lock_shared_nested(struct au_hinode *hdir, ++ unsigned int sc) ++{ ++ vfsub_inode_lock_shared_nested(hdir->hi_inode, sc); ++ au_hn_suspend(hdir); ++} ++#endif ++ +static inline void au_hn_inode_unlock(struct au_hinode *hdir) +{ + au_hn_resume(hdir); @@ -20147,12 +22190,13 @@ index 0000000..b9e3039 +#endif /* __AUFS_INODE_H__ */ diff --git a/fs/aufs/ioctl.c b/fs/aufs/ioctl.c new file mode 100644 -index 0000000..2ebfdc4 +index 000000000000..4714d2167447 --- /dev/null +++ b/fs/aufs/ioctl.c -@@ -0,0 +1,206 @@ +@@ -0,0 +1,207 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -20359,12 +22403,13 @@ index 0000000..2ebfdc4 +#endif diff --git a/fs/aufs/loop.c b/fs/aufs/loop.c new file mode 100644 -index 0000000..c3ca50f +index 000000000000..3b217c24dd12 --- /dev/null +++ b/fs/aufs/loop.c -@@ -0,0 +1,134 @@ +@@ -0,0 +1,135 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -20495,16 +22540,17 @@ index 0000000..c3ca50f +{ + if (backing_file_func) + symbol_put(loop_backing_file); -+ au_delayed_kfree(au_warn_loopback_array); ++ kfree(au_warn_loopback_array); +} diff --git a/fs/aufs/loop.h b/fs/aufs/loop.h new file mode 100644 -index 0000000..48bf070 +index 000000000000..7d7bf342c4d8 --- /dev/null +++ b/fs/aufs/loop.h -@@ -0,0 +1,39 @@ +@@ -0,0 +1,40 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -20544,10 +22590,11 @@ index 0000000..48bf070 +#endif /* __AUFS_LOOP_H__ */ diff --git a/fs/aufs/magic.mk b/fs/aufs/magic.mk new file mode 100644 -index 0000000..4f83bdf +index 000000000000..7bc9eef3ffec --- /dev/null +++ b/fs/aufs/magic.mk -@@ -0,0 +1,30 @@ +@@ -0,0 +1,31 @@ ++# SPDX-License-Identifier: GPL-2.0 + +# defined in ${srctree}/fs/fuse/inode.c +# tristate @@ -20580,12 +22627,13 @@ index 0000000..4f83bdf +endif diff --git a/fs/aufs/module.c b/fs/aufs/module.c new file mode 100644 -index 0000000..5092b4b +index 000000000000..7cde174ad9e1 --- /dev/null +++ b/fs/aufs/module.c -@@ -0,0 +1,319 @@ +@@ -0,0 +1,253 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -20607,7 +22655,7 @@ index 0000000..5092b4b + if (p) { +#if 0 /* unused */ + if (!new_sz) { -+ au_delayed_kfree(p); ++ kfree(p); + p = NULL; + goto out; + } @@ -20631,7 +22679,7 @@ index 0000000..5092b4b + if (q) { + if (p) { + memcpy(q, p, new_sz); -+ au_delayed_kfree(p); ++ kfree(p); + } + p = q; + } else @@ -20655,61 +22703,11 @@ index 0000000..5092b4b +/* + * aufs caches + */ -+ -+struct au_dfree au_dfree; -+ -+/* delayed free */ -+static void au_do_dfree(struct work_struct *work __maybe_unused) -+{ -+ struct llist_head *head; -+ struct llist_node *node, *next; -+ -+#define AU_CACHE_DFREE_DO_BODY(name, idx, lnode) do { \ -+ head = &au_dfree.cache[AuCache_##idx].llist; \ -+ node = llist_del_all(head); \ -+ for (; node; node = next) { \ -+ struct au_##name *p \ -+ = llist_entry(node, struct au_##name, \ -+ lnode); \ -+ next = llist_next(node); \ -+ au_cache_free_##name(p); \ -+ } \ -+ } while (0) -+ -+ AU_CACHE_DFREE_DO_BODY(dinfo, DINFO, di_lnode); -+ AU_CACHE_DFREE_DO_BODY(icntnr, ICNTNR, lnode); -+ AU_CACHE_DFREE_DO_BODY(finfo, FINFO, fi_lnode); -+ AU_CACHE_DFREE_DO_BODY(vdir, VDIR, vd_lnode); -+ AU_CACHE_DFREE_DO_BODY(vdir_dehstr, DEHSTR, lnode); -+#ifdef CONFIG_AUFS_HNOTIFY -+ AU_CACHE_DFREE_DO_BODY(hnotify, HNOTIFY, hn_lnode); -+#endif -+ -+#define AU_DFREE_DO_BODY(llist, func) do { \ -+ node = llist_del_all(llist); \ -+ for (; node; node = next) { \ -+ next = llist_next(node); \ -+ func(node); \ -+ } \ -+ } while (0) -+ -+ AU_DFREE_DO_BODY(au_dfree.llist + AU_DFREE_KFREE, kfree); -+ AU_DFREE_DO_BODY(au_dfree.llist + AU_DFREE_FREE_PAGE, au_free_page); -+ -+#undef AU_CACHE_DFREE_DO_BODY -+#undef AU_DFREE_DO_BODY -+} -+ -+AU_CACHE_DFREE_FUNC(dinfo, DINFO, di_lnode); -+AU_CACHE_DFREE_FUNC(icntnr, ICNTNR, lnode); -+AU_CACHE_DFREE_FUNC(finfo, FINFO, fi_lnode); -+AU_CACHE_DFREE_FUNC(vdir, VDIR, vd_lnode); -+AU_CACHE_DFREE_FUNC(vdir_dehstr, DEHSTR, lnode); ++struct kmem_cache *au_cache[AuCache_Last]; + +static void au_cache_fin(void) +{ + int i; -+ struct au_cache *cp; + + /* + * Make sure all delayed rcu free inodes are flushed before we @@ -20719,33 +22717,27 @@ index 0000000..5092b4b + + /* excluding AuCache_HNOTIFY */ + BUILD_BUG_ON(AuCache_HNOTIFY + 1 != AuCache_Last); -+ flush_delayed_work(&au_dfree.dwork); + for (i = 0; i < AuCache_HNOTIFY; i++) { -+ cp = au_dfree.cache + i; -+ AuDebugOn(!llist_empty(&cp->llist)); -+ kmem_cache_destroy(cp->cache); -+ cp->cache = NULL; ++ kmem_cache_destroy(au_cache[i]); ++ au_cache[i] = NULL; + } +} + +static int __init au_cache_init(void) +{ -+ struct au_cache *cp; -+ -+ cp = au_dfree.cache; -+ cp[AuCache_DINFO].cache = AuCacheCtor(au_dinfo, au_di_init_once); -+ if (cp[AuCache_DINFO].cache) ++ au_cache[AuCache_DINFO] = AuCacheCtor(au_dinfo, au_di_init_once); ++ if (au_cache[AuCache_DINFO]) + /* SLAB_DESTROY_BY_RCU */ -+ cp[AuCache_ICNTNR].cache = AuCacheCtor(au_icntnr, ++ au_cache[AuCache_ICNTNR] = AuCacheCtor(au_icntnr, + au_icntnr_init_once); -+ if (cp[AuCache_ICNTNR].cache) -+ cp[AuCache_FINFO].cache = AuCacheCtor(au_finfo, ++ if (au_cache[AuCache_ICNTNR]) ++ au_cache[AuCache_FINFO] = AuCacheCtor(au_finfo, + au_fi_init_once); -+ if (cp[AuCache_FINFO].cache) -+ cp[AuCache_VDIR].cache = AuCache(au_vdir); -+ if (cp[AuCache_VDIR].cache) -+ cp[AuCache_DEHSTR].cache = AuCache(au_vdir_dehstr); -+ if (cp[AuCache_DEHSTR].cache) ++ if (au_cache[AuCache_FINFO]) ++ au_cache[AuCache_VDIR] = AuCache(au_vdir); ++ if (au_cache[AuCache_VDIR]) ++ au_cache[AuCache_DEHSTR] = AuCache(au_vdir_dehstr); ++ if (au_cache[AuCache_DEHSTR]) + return 0; + + au_cache_fin(); @@ -20761,7 +22753,7 @@ index 0000000..5092b4b + * iterate_supers_type() doesn't protect us from + * remounting (branch management) + */ -+struct au_sphlhead au_sbilist; ++struct hlist_bl_head au_sbilist; +#endif + +/* @@ -20793,9 +22785,9 @@ index 0000000..5092b4b + int err; + + err = seq_path(seq, path, au_esc_chars); -+ if (err > 0) ++ if (err >= 0) + err = 0; -+ else if (err < 0) ++ else + err = -ENOMEM; + + return err; @@ -20807,7 +22799,6 @@ index 0000000..5092b4b +{ + int err, i; + char *p; -+ struct au_cache *cp; + + p = au_esc_chars; + for (i = 1; i <= ' '; i++) @@ -20822,15 +22813,7 @@ index 0000000..5092b4b + for (i = 0; i < AuIop_Last; i++) + aufs_iop_nogetattr[i].getattr = NULL; + -+ /* First, initialize au_dfree */ -+ for (i = 0; i < AuCache_Last; i++) { /* including hnotify */ -+ cp = au_dfree.cache + i; -+ cp->cache = NULL; -+ init_llist_head(&cp->llist); -+ } -+ for (i = 0; i < AU_DFREE_Last; i++) -+ init_llist_head(au_dfree.llist + i); -+ INIT_DELAYED_WORK(&au_dfree.dwork, au_do_dfree); ++ memset(au_cache, 0, sizeof(au_cache)); /* including hnotify */ + + au_sbilist_init(); + sysaufs_brs_init(); @@ -20882,7 +22865,6 @@ index 0000000..5092b4b +out_sysaufs: + sysaufs_fin(); + au_dy_fin(); -+ flush_delayed_work(&au_dfree.dwork); +out: + return err; +} @@ -20898,19 +22880,19 @@ index 0000000..5092b4b + au_procfs_fin(); + sysaufs_fin(); + au_dy_fin(); -+ flush_delayed_work(&au_dfree.dwork); +} + +module_init(aufs_init); +module_exit(aufs_exit); diff --git a/fs/aufs/module.h b/fs/aufs/module.h new file mode 100644 -index 0000000..6f968ba +index 000000000000..f5f31430427d --- /dev/null +++ b/fs/aufs/module.h -@@ -0,0 +1,143 @@ +@@ -0,0 +1,89 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -20923,7 +22905,6 @@ index 0000000..6f968ba +#ifdef __KERNEL__ + +#include -+#include "debug.h" + +struct path; +struct seq_file; @@ -20962,7 +22943,7 @@ index 0000000..6f968ba + +/* ---------------------------------------------------------------------- */ + -+/* kmem cache and delayed free */ ++/* kmem cache */ +enum { + AuCache_DINFO, + AuCache_ICNTNR, @@ -20973,28 +22954,7 @@ index 0000000..6f968ba + AuCache_Last +}; + -+enum { -+ AU_DFREE_KFREE, -+ AU_DFREE_FREE_PAGE, -+ AU_DFREE_Last -+}; -+ -+struct au_cache { -+ struct kmem_cache *cache; -+ struct llist_head llist; /* delayed free */ -+}; -+ -+/* -+ * in order to reduce the cost of the internal timer, consolidate all the -+ * delayed free works into a single delayed_work. -+ */ -+struct au_dfree { -+ struct au_cache cache[AuCache_Last]; -+ struct llist_head llist[AU_DFREE_Last]; -+ struct delayed_work dwork; -+}; -+ -+extern struct au_dfree au_dfree; ++extern struct kmem_cache *au_cache[AuCache_Last]; + +#define AuCacheFlags (SLAB_RECLAIM_ACCOUNT | SLAB_MEM_SPREAD) +#define AuCache(type) KMEM_CACHE(type, AuCacheFlags) @@ -21002,25 +22962,11 @@ index 0000000..6f968ba + kmem_cache_create(#type, sizeof(struct type), \ + __alignof__(struct type), AuCacheFlags, ctor) + -+#define AU_DFREE_DELAY msecs_to_jiffies(10) -+#define AU_DFREE_BODY(lnode, llist) do { \ -+ if (llist_add(lnode, llist)) \ -+ schedule_delayed_work(&au_dfree.dwork, \ -+ AU_DFREE_DELAY); \ -+ } while (0) -+#define AU_CACHE_DFREE_FUNC(name, idx, lnode) \ -+ void au_cache_dfree_##name(struct au_##name *p) \ -+ { \ -+ struct au_cache *cp = au_dfree.cache + AuCache_##idx; \ -+ AU_DFREE_BODY(&p->lnode, &cp->llist); \ -+ } -+ +#define AuCacheFuncs(name, index) \ +static inline struct au_##name *au_cache_alloc_##name(void) \ -+{ return kmem_cache_alloc(au_dfree.cache[AuCache_##index].cache, GFP_NOFS); } \ ++{ return kmem_cache_alloc(au_cache[AuCache_##index], GFP_NOFS); } \ +static inline void au_cache_free_##name(struct au_##name *p) \ -+{ kmem_cache_free(au_dfree.cache[AuCache_##index].cache, p); } \ -+void au_cache_dfree_##name(struct au_##name *p) ++{ kmem_cache_free(au_cache[AuCache_##index], p); } + +AuCacheFuncs(dinfo, DINFO); +AuCacheFuncs(icntnr, ICNTNR); @@ -21031,35 +22977,17 @@ index 0000000..6f968ba +AuCacheFuncs(hnotify, HNOTIFY); +#endif + -+static inline void au_delayed_kfree(const void *p) -+{ -+ AuDebugOn(!p); -+ AuDebugOn(ksize(p) < sizeof(struct llist_node)); -+ -+ AU_DFREE_BODY((void *)p, au_dfree.llist + AU_DFREE_KFREE); -+} -+ -+/* cast only */ -+static inline void au_free_page(void *p) -+{ -+ free_page((unsigned long)p); -+} -+ -+static inline void au_delayed_free_page(unsigned long addr) -+{ -+ AU_DFREE_BODY((void *)addr, au_dfree.llist + AU_DFREE_FREE_PAGE); -+} -+ +#endif /* __KERNEL__ */ +#endif /* __AUFS_MODULE_H__ */ diff --git a/fs/aufs/mvdown.c b/fs/aufs/mvdown.c new file mode 100644 -index 0000000..b0e5b84 +index 000000000000..57f24f22e4a6 --- /dev/null +++ b/fs/aufs/mvdown.c -@@ -0,0 +1,691 @@ +@@ -0,0 +1,692 @@ +/* -+ * Copyright (C) 2011-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2011-2017 Junjiro R. Okajima + */ + +/* @@ -21123,7 +23051,7 @@ index 0000000..b0e5b84 + for (bindex++; bindex <= bbot; bindex++) { + br = au_sbr(sb, bindex); + if (au_br_fhsm(br->br_perm) -+ && (!(au_br_sb(br)->s_flags & MS_RDONLY))) ++ && !sb_rdonly(au_br_sb(br))) + return bindex; + } + else if (!(a->mvdown.flags & AUFS_MVDOWN_ROLOWER)) @@ -21135,7 +23063,7 @@ index 0000000..b0e5b84 + else + for (bindex++; bindex <= bbot; bindex++) { + br = au_sbr(sb, bindex); -+ if (!(au_br_sb(br)->s_flags & MS_RDONLY)) { ++ if (!sb_rdonly(au_br_sb(br))) { + if (au_br_rdonly(br)) + a->mvdown.flags + |= AUFS_MVDOWN_ROLOWER_R; @@ -21744,19 +23672,20 @@ index 0000000..b0e5b84 + e = copy_to_user(uarg, &args->mvdown, sizeof(args->mvdown)); + if (unlikely(e)) + err = -EFAULT; -+ au_delayed_kfree(args); ++ kfree(args); +out: + AuTraceErr(err); + return err; +} diff --git a/fs/aufs/opts.c b/fs/aufs/opts.c new file mode 100644 -index 0000000..8d9461d +index 000000000000..40c506207806 --- /dev/null +++ b/fs/aufs/opts.c -@@ -0,0 +1,1857 @@ +@@ -0,0 +1,1879 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -21791,6 +23720,7 @@ index 0000000..8d9461d + Opt_verbose, Opt_noverbose, + Opt_sum, Opt_nosum, Opt_wsum, + Opt_dirperm1, Opt_nodirperm1, ++ Opt_dirren, Opt_nodirren, + Opt_acl, Opt_noacl, + Opt_tail, Opt_ignore, Opt_ignore_silent, Opt_err +}; @@ -21845,10 +23775,18 @@ index 0000000..8d9461d + {Opt_dio, "dio"}, + {Opt_nodio, "nodio"}, + ++#ifdef CONFIG_AUFS_DIRREN ++ {Opt_dirren, "dirren"}, ++ {Opt_nodirren, "nodirren"}, ++#else ++ {Opt_ignore, "dirren"}, ++ {Opt_ignore_silent, "nodirren"}, ++#endif ++ +#ifdef CONFIG_AUFS_FHSM + {Opt_fhsm_sec, "fhsm_sec=%d"}, +#else -+ {Opt_ignore_silent, "fhsm_sec=%d"}, ++ {Opt_ignore, "fhsm_sec=%d"}, +#endif + + {Opt_diropq_a, "diropq=always"}, @@ -21861,7 +23799,7 @@ index 0000000..8d9461d + + /* keep them temporary */ + {Opt_ignore_silent, "nodlgt"}, -+ {Opt_ignore_silent, "clean_plink"}, ++ {Opt_ignore, "clean_plink"}, + +#ifdef CONFIG_AUFS_SHWH + {Opt_shwh, "shwh"}, @@ -21899,7 +23837,7 @@ index 0000000..8d9461d + {Opt_acl, "acl"}, + {Opt_noacl, "noacl"}, +#else -+ {Opt_ignore_silent, "acl"}, ++ {Opt_ignore, "acl"}, + {Opt_ignore_silent, "noacl"}, +#endif + @@ -22182,28 +24120,6 @@ index 0000000..8d9461d + {-1, NULL} +}; + -+/* -+ * cf. linux/lib/parser.c and cmdline.c -+ * gave up calling memparse() since it uses simple_strtoull() instead of -+ * kstrto...(). -+ */ -+static int noinline_for_stack -+au_match_ull(substring_t *s, unsigned long long *result) -+{ -+ int err; -+ unsigned int len; -+ char a[32]; -+ -+ err = -ERANGE; -+ len = s->to - s->from; -+ if (len + 1 <= sizeof(a)) { -+ memcpy(a, s->from, len); -+ a[len] = '\0'; -+ err = kstrtoull(a, 0, result); -+ } -+ return err; -+} -+ +static int au_wbr_mfs_wmark(substring_t *arg, char *str, + struct au_opt_wbr_create *create) +{ @@ -22211,7 +24127,7 @@ index 0000000..8d9461d + unsigned long long ull; + + err = 0; -+ if (!au_match_ull(arg, &ull)) ++ if (!match_u64(arg, &ull)) + create->mfsrr_watermark = ull; + else { + pr_err("bad integer in %s\n", str); @@ -22487,6 +24403,12 @@ index 0000000..8d9461d + case Opt_fhsm_sec: + AuDbg("fhsm_sec %u\n", opt->fhsm_second); + break; ++ case Opt_dirren: ++ AuLabel(dirren); ++ break; ++ case Opt_nodirren: ++ AuLabel(nodirren); ++ break; + case Opt_acl: + AuLabel(acl); + break; @@ -22937,6 +24859,8 @@ index 0000000..8d9461d + case Opt_wsum: + case Opt_rdblk_def: + case Opt_rdhash_def: ++ case Opt_dirren: ++ case Opt_nodirren: + case Opt_acl: + case Opt_noacl: + err = 0; @@ -23008,7 +24932,7 @@ index 0000000..8d9461d + } + } + -+ au_delayed_kfree(a); ++ kfree(a); + dump_opts(opts); + if (unlikely(err)) + au_opts_free(opts); @@ -23203,6 +25127,28 @@ index 0000000..8d9461d + au_fclr_opts(opts->flags, TRUNC_XIB); + break; + ++ case Opt_dirren: ++ err = 1; ++ if (!au_opt_test(sbinfo->si_mntflags, DIRREN)) { ++ err = au_dr_opt_set(sb); ++ if (!err) ++ err = 1; ++ } ++ if (err == 1) ++ au_opt_set(sbinfo->si_mntflags, DIRREN); ++ break; ++ case Opt_nodirren: ++ err = 1; ++ if (au_opt_test(sbinfo->si_mntflags, DIRREN)) { ++ err = au_dr_opt_clr(sb, au_ftest_opts(opts->flags, ++ DR_FLUSHED)); ++ if (!err) ++ err = 1; ++ } ++ if (err == 1) ++ au_opt_clr(sbinfo->si_mntflags, DIRREN); ++ break; ++ + case Opt_acl: + sb->s_flags |= MS_POSIXACL; + break; @@ -23271,7 +25217,6 @@ index 0000000..8d9461d + } + break; + } -+ + return err; +} + @@ -23432,8 +25377,7 @@ index 0000000..8d9461d + au_hn_inode_unlock(hdir); + + if (!err && do_free) { -+ if (wbr) -+ au_delayed_kfree(wbr); ++ kfree(wbr); + br->br_wbr = NULL; + } + } @@ -23562,7 +25506,11 @@ index 0000000..8d9461d + + SiMustWriteLock(sb); + -+ err = 0; ++ err = au_dr_opt_flush(sb); ++ if (unlikely(err)) ++ goto out; ++ au_fset_opts(opts->flags, DR_FLUSHED); ++ + dir = d_inode(sb->s_root); + sbinfo = au_sbi(sb); + opt_xino = NULL; @@ -23603,6 +25551,8 @@ index 0000000..8d9461d + au_fset_opts(opts->flags, REFRESH); + + AuDbg("status 0x%x\n", opts->flags); ++ ++out: + return err; +} + @@ -23614,12 +25564,13 @@ index 0000000..8d9461d +} diff --git a/fs/aufs/opts.h b/fs/aufs/opts.h new file mode 100644 -index 0000000..c7323ee +index 000000000000..82f8c3258b1f --- /dev/null +++ b/fs/aufs/opts.h -@@ -0,0 +1,200 @@ +@@ -0,0 +1,212 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -23634,7 +25585,6 @@ index 0000000..c7323ee +#include + +struct file; -+struct super_block; + +/* ---------------------------------------------------------------------- */ + @@ -23655,11 +25605,16 @@ index 0000000..c7323ee +#define AuOpt_WARN_PERM (1 << 12) /* warn when add-branch */ +#define AuOpt_VERBOSE (1 << 13) /* busy inode when del-branch */ +#define AuOpt_DIO (1 << 14) /* direct io */ ++#define AuOpt_DIRREN (1 << 15) /* directory rename */ + +#ifndef CONFIG_AUFS_HNOTIFY +#undef AuOpt_UDBA_HNOTIFY +#define AuOpt_UDBA_HNOTIFY 0 +#endif ++#ifndef CONFIG_AUFS_DIRREN ++#undef AuOpt_DIRREN ++#define AuOpt_DIRREN 0 ++#endif +#ifndef CONFIG_AUFS_SHWH +#undef AuOpt_SHWH +#define AuOpt_SHWH 0 @@ -23784,12 +25739,18 @@ index 0000000..c7323ee +#define AuOpts_TRUNC_XIB (1 << 2) +#define AuOpts_REFRESH_DYAOP (1 << 3) +#define AuOpts_REFRESH_IDOP (1 << 4) ++#define AuOpts_DR_FLUSHED (1 << 5) +#define au_ftest_opts(flags, name) ((flags) & AuOpts_##name) +#define au_fset_opts(flags, name) \ + do { (flags) |= AuOpts_##name; } while (0) +#define au_fclr_opts(flags, name) \ + do { (flags) &= ~AuOpts_##name; } while (0) + ++#ifndef CONFIG_AUFS_DIRREN ++#undef AuOpts_DR_FLUSHED ++#define AuOpts_DR_FLUSHED 0 ++#endif ++ +struct au_opts { + struct au_opt *opt; + int max_opt; @@ -23808,6 +25769,7 @@ index 0000000..c7323ee +const char *au_optstr_wbr_create(int wbr_create); + +void au_opts_free(struct au_opts *opts); ++struct super_block; +int au_opts_parse(struct super_block *sb, char *str, struct au_opts *opts); +int au_opts_verify(struct super_block *sb, unsigned long sb_flags, + unsigned int pending); @@ -23820,12 +25782,13 @@ index 0000000..c7323ee +#endif /* __AUFS_OPTS_H__ */ diff --git a/fs/aufs/plink.c b/fs/aufs/plink.c new file mode 100644 -index 0000000..d8d75e8 +index 000000000000..3fe5ef527f5f --- /dev/null +++ b/fs/aufs/plink.c -@@ -0,0 +1,501 @@ +@@ -0,0 +1,503 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -23948,7 +25911,8 @@ index 0000000..d8d75e8 +{ + int i; + struct au_sbinfo *sbinfo; -+ struct hlist_head *plink_hlist; ++ struct hlist_bl_head *hbl; ++ struct hlist_bl_node *pos; + struct au_icntnr *icntnr; + + SiMustAnyLock(sb); @@ -23958,11 +25922,11 @@ index 0000000..d8d75e8 + AuDebugOn(au_plink_maint(sb, AuLock_NOPLM)); + + for (i = 0; i < AuPlink_NHASH; i++) { -+ plink_hlist = &sbinfo->si_plink[i].head; -+ rcu_read_lock(); -+ hlist_for_each_entry_rcu(icntnr, plink_hlist, plink) ++ hbl = sbinfo->si_plink + i; ++ hlist_bl_lock(hbl); ++ hlist_bl_for_each_entry(icntnr, pos, hbl, plink) + AuDbg("%lu\n", icntnr->vfs_inode.i_ino); -+ rcu_read_unlock(); ++ hlist_bl_unlock(hbl); + } +} +#endif @@ -23972,7 +25936,8 @@ index 0000000..d8d75e8 +{ + int found, i; + struct au_sbinfo *sbinfo; -+ struct hlist_head *plink_hlist; ++ struct hlist_bl_head *hbl; ++ struct hlist_bl_node *pos; + struct au_icntnr *icntnr; + + sbinfo = au_sbi(inode->i_sb); @@ -23982,14 +25947,14 @@ index 0000000..d8d75e8 + + found = 0; + i = au_plink_hash(inode->i_ino); -+ plink_hlist = &sbinfo->si_plink[i].head; -+ rcu_read_lock(); -+ hlist_for_each_entry_rcu(icntnr, plink_hlist, plink) ++ hbl = sbinfo->si_plink + i; ++ hlist_bl_lock(hbl); ++ hlist_bl_for_each_entry(icntnr, pos, hbl, plink) + if (&icntnr->vfs_inode == inode) { + found = 1; + break; + } -+ rcu_read_unlock(); ++ hlist_bl_unlock(hbl); + return found; +} + @@ -24028,9 +25993,9 @@ index 0000000..d8d75e8 + struct inode *h_inode; + + h_inode = d_inode(h_parent); -+ inode_lock_nested(h_inode, AuLsc_I_CHILD2); ++ vfsub_inode_lock_shared_nested(h_inode, AuLsc_I_CHILD2); + h_dentry = vfsub_lkup_one(tgtname, h_parent); -+ inode_unlock(h_inode); ++ inode_unlock_shared(h_inode); + return h_dentry; +} + @@ -24177,9 +26142,9 @@ index 0000000..d8d75e8 +{ + struct super_block *sb; + struct au_sbinfo *sbinfo; -+ struct hlist_head *plink_hlist; ++ struct hlist_bl_head *hbl; ++ struct hlist_bl_node *pos; + struct au_icntnr *icntnr; -+ struct au_sphlhead *sphl; + int found, err, cnt, i; + + sb = inode->i_sb; @@ -24192,12 +26157,11 @@ index 0000000..d8d75e8 + return; + + i = au_plink_hash(inode->i_ino); -+ sphl = sbinfo->si_plink + i; -+ plink_hlist = &sphl->head; ++ hbl = sbinfo->si_plink + i; + au_igrab(inode); + -+ spin_lock(&sphl->spin); -+ hlist_for_each_entry(icntnr, plink_hlist, plink) { ++ hlist_bl_lock(hbl); ++ hlist_bl_for_each_entry(icntnr, pos, hbl, plink) { + if (&icntnr->vfs_inode == inode) { + found = 1; + break; @@ -24205,11 +26169,11 @@ index 0000000..d8d75e8 + } + if (!found) { + icntnr = container_of(inode, struct au_icntnr, vfs_inode); -+ hlist_add_head_rcu(&icntnr->plink, plink_hlist); ++ hlist_bl_add_head(&icntnr->plink, hbl); + } -+ spin_unlock(&sphl->spin); ++ hlist_bl_unlock(hbl); + if (!found) { -+ cnt = au_sphl_count(sphl); ++ cnt = au_hbl_count(hbl); +#define msg "unexpectedly unblanced or too many pseudo-links" + if (cnt > AUFS_PLINK_WARN) + AuWarn1(msg ", %d\n", cnt); @@ -24217,7 +26181,7 @@ index 0000000..d8d75e8 + err = whplink(h_dentry, inode, bindex, au_sbr(sb, bindex)); + if (unlikely(err)) { + pr_warn("err %d, damaged pseudo link.\n", err); -+ au_sphl_del_rcu(&icntnr->plink, sphl); ++ au_hbl_del(&icntnr->plink, hbl); + iput(&icntnr->vfs_inode); + } + } else @@ -24229,8 +26193,8 @@ index 0000000..d8d75e8 +{ + int i, warned; + struct au_sbinfo *sbinfo; -+ struct hlist_head *plink_hlist; -+ struct hlist_node *tmp; ++ struct hlist_bl_head *hbl; ++ struct hlist_bl_node *pos, *tmp; + struct au_icntnr *icntnr; + + SiMustWriteLock(sb); @@ -24242,14 +26206,14 @@ index 0000000..d8d75e8 + /* no spin_lock since sbinfo is write-locked */ + warned = 0; + for (i = 0; i < AuPlink_NHASH; i++) { -+ plink_hlist = &sbinfo->si_plink[i].head; -+ if (!warned && verbose && !hlist_empty(plink_hlist)) { ++ hbl = sbinfo->si_plink + i; ++ if (!warned && verbose && !hlist_bl_empty(hbl)) { + pr_warn("pseudo-link is not flushed"); + warned = 1; + } -+ hlist_for_each_entry_safe(icntnr, tmp, plink_hlist, plink) ++ hlist_bl_for_each_entry_safe(icntnr, pos, tmp, hbl, plink) + iput(&icntnr->vfs_inode); -+ INIT_HLIST_HEAD(plink_hlist); ++ INIT_HLIST_BL_HEAD(hbl); + } +} + @@ -24297,8 +26261,8 @@ index 0000000..d8d75e8 +void au_plink_half_refresh(struct super_block *sb, aufs_bindex_t br_id) +{ + struct au_sbinfo *sbinfo; -+ struct hlist_head *plink_hlist; -+ struct hlist_node *tmp; ++ struct hlist_bl_head *hbl; ++ struct hlist_bl_node *pos, *tmp; + struct au_icntnr *icntnr; + struct inode *inode; + int i, do_put; @@ -24309,15 +26273,15 @@ index 0000000..d8d75e8 + AuDebugOn(!au_opt_test(au_mntflags(sb), PLINK)); + AuDebugOn(au_plink_maint(sb, AuLock_NOPLM)); + -+ /* no spin_lock since sbinfo is write-locked */ ++ /* no bit_lock since sbinfo is write-locked */ + for (i = 0; i < AuPlink_NHASH; i++) { -+ plink_hlist = &sbinfo->si_plink[i].head; -+ hlist_for_each_entry_safe(icntnr, tmp, plink_hlist, plink) { ++ hbl = sbinfo->si_plink + i; ++ hlist_bl_for_each_entry_safe(icntnr, pos, tmp, hbl, plink) { + inode = au_igrab(&icntnr->vfs_inode); + ii_write_lock_child(inode); + do_put = au_plink_do_half_refresh(inode, br_id); + if (do_put) { -+ hlist_del(&icntnr->plink); ++ hlist_bl_del(&icntnr->plink); + iput(inode); + } + ii_write_unlock(inode); @@ -24327,12 +26291,13 @@ index 0000000..d8d75e8 +} diff --git a/fs/aufs/poll.c b/fs/aufs/poll.c new file mode 100644 -index 0000000..dd2baf5 +index 000000000000..0ecc465e505e --- /dev/null +++ b/fs/aufs/poll.c -@@ -0,0 +1,39 @@ +@@ -0,0 +1,40 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -24354,7 +26319,7 @@ index 0000000..dd2baf5 + sb = file->f_path.dentry->d_sb; + si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLMW); + -+ h_file = au_read_pre(file, /*keep_fi*/0); ++ h_file = au_read_pre(file, /*keep_fi*/0, /*lsc*/0); + err = PTR_ERR(h_file); + if (IS_ERR(h_file)) + goto out; @@ -24372,12 +26337,13 @@ index 0000000..dd2baf5 +} diff --git a/fs/aufs/posix_acl.c b/fs/aufs/posix_acl.c new file mode 100644 -index 0000000..81510b9 +index 000000000000..dee01d657850 --- /dev/null +++ b/fs/aufs/posix_acl.c -@@ -0,0 +1,85 @@ +@@ -0,0 +1,90 @@ +/* -+ * Copyright (C) 2014-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2014-2017 Junjiro R. Okajima + */ + +/* @@ -24414,6 +26380,8 @@ index 0000000..81510b9 + + /* always topmost only */ + acl = get_acl(h_inode, type); ++ if (!IS_ERR_OR_NULL(acl)) ++ set_cached_acl(inode, type, acl); + +out: + ii_read_unlock(inode); @@ -24455,20 +26423,23 @@ index 0000000..81510b9 + ssz = au_sxattr(dentry, inode, &arg); + dput(dentry); + err = ssz; -+ if (ssz >= 0) ++ if (ssz >= 0) { + err = 0; ++ set_cached_acl(inode, type, acl); ++ } + +out: + return err; +} diff --git a/fs/aufs/procfs.c b/fs/aufs/procfs.c new file mode 100644 -index 0000000..e5a4e37 +index 000000000000..7481906e90ee --- /dev/null +++ b/fs/aufs/procfs.c -@@ -0,0 +1,156 @@ +@@ -0,0 +1,158 @@ +/* -+ * Copyright (C) 2010-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2010-2017 Junjiro R. Okajima + */ + +/* @@ -24505,6 +26476,7 @@ index 0000000..e5a4e37 + int err; + struct super_block *sb; + struct au_sbinfo *sbinfo; ++ struct hlist_bl_node *pos; + + err = -EBUSY; + if (unlikely(file->private_data)) @@ -24512,14 +26484,14 @@ index 0000000..e5a4e37 + + sb = NULL; + /* don't use au_sbilist_lock() here */ -+ spin_lock(&au_sbilist.spin); -+ hlist_for_each_entry(sbinfo, &au_sbilist.head, si_list) ++ hlist_bl_lock(&au_sbilist); ++ hlist_bl_for_each_entry(sbinfo, pos, &au_sbilist, si_list) + if (id == sysaufs_si_id(sbinfo)) { + kobject_get(&sbinfo->si_kobj); + sb = sbinfo->si_sb; + break; + } -+ spin_unlock(&au_sbilist.spin); ++ hlist_bl_unlock(&au_sbilist); + + err = -EINVAL; + if (unlikely(!sb)) @@ -24625,12 +26597,13 @@ index 0000000..e5a4e37 +} diff --git a/fs/aufs/rdu.c b/fs/aufs/rdu.c new file mode 100644 -index 0000000..54abc14 +index 000000000000..94128e655471 --- /dev/null +++ b/fs/aufs/rdu.c -@@ -0,0 +1,368 @@ +@@ -0,0 +1,369 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -24999,12 +26972,13 @@ index 0000000..54abc14 +#endif diff --git a/fs/aufs/rwsem.h b/fs/aufs/rwsem.h new file mode 100644 -index 0000000..6c0d5a9 +index 000000000000..8a3713b409cc --- /dev/null +++ b/fs/aufs/rwsem.h -@@ -0,0 +1,185 @@ +@@ -0,0 +1,60 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -25018,184 +26992,59 @@ index 0000000..6c0d5a9 + +#include "debug.h" + -+struct au_rwsem { -+ struct rw_semaphore rwsem; -+#ifdef CONFIG_AUFS_DEBUG -+ /* just for debugging, not almighty counter */ -+ atomic_t rcnt, wcnt; -+#endif -+}; -+ -+#ifdef CONFIG_LOCKDEP -+#define au_lockdep_set_name(rw) \ -+ lockdep_set_class_and_name(&(rw)->rwsem, \ -+ /*original key*/(rw)->rwsem.dep_map.key, \ -+ /*name*/#rw) -+#else -+#define au_lockdep_set_name(rw) do {} while (0) -+#endif -+ -+#ifdef CONFIG_AUFS_DEBUG -+#define AuDbgCntInit(rw) do { \ -+ atomic_set(&(rw)->rcnt, 0); \ -+ atomic_set(&(rw)->wcnt, 0); \ -+ smp_mb(); /* atomic set */ \ -+} while (0) -+ -+#define AuDbgCnt(rw, cnt) atomic_read(&(rw)->cnt) -+#define AuDbgCntInc(rw, cnt) atomic_inc(&(rw)->cnt) -+#define AuDbgCntDec(rw, cnt) WARN_ON(atomic_dec_return(&(rw)->cnt) < 0) -+#define AuDbgRcntInc(rw) AuDbgCntInc(rw, rcnt) -+#define AuDbgRcntDec(rw) AuDbgCntDec(rw, rcnt) -+#define AuDbgWcntInc(rw) AuDbgCntInc(rw, wcnt) -+#define AuDbgWcntDec(rw) AuDbgCntDec(rw, wcnt) -+#else -+#define AuDbgCnt(rw, cnt) 0 -+#define AuDbgCntInit(rw) do {} while (0) -+#define AuDbgRcntInc(rw) do {} while (0) -+#define AuDbgRcntDec(rw) do {} while (0) -+#define AuDbgWcntInc(rw) do {} while (0) -+#define AuDbgWcntDec(rw) do {} while (0) -+#endif /* CONFIG_AUFS_DEBUG */ ++/* in the futre, the name 'au_rwsem' will be totally gone */ ++#define au_rwsem rw_semaphore + +/* to debug easier, do not make them inlined functions */ -+#define AuRwMustNoWaiters(rw) AuDebugOn(rwsem_is_contended(&(rw)->rwsem)) ++#define AuRwMustNoWaiters(rw) AuDebugOn(rwsem_is_contended(rw)) +/* rwsem_is_locked() is unusable */ -+#define AuRwMustReadLock(rw) AuDebugOn(AuDbgCnt(rw, rcnt) <= 0) -+#define AuRwMustWriteLock(rw) AuDebugOn(AuDbgCnt(rw, wcnt) <= 0) -+#define AuRwMustAnyLock(rw) AuDebugOn(AuDbgCnt(rw, rcnt) <= 0 \ -+ && AuDbgCnt(rw, wcnt) <= 0) -+#define AuRwDestroy(rw) AuDebugOn(AuDbgCnt(rw, rcnt) \ -+ || AuDbgCnt(rw, wcnt)) ++#define AuRwMustReadLock(rw) AuDebugOn(!lockdep_recursing(current) \ ++ && debug_locks \ ++ && !lockdep_is_held_type(rw, 1)) ++#define AuRwMustWriteLock(rw) AuDebugOn(!lockdep_recursing(current) \ ++ && debug_locks \ ++ && !lockdep_is_held_type(rw, 0)) ++#define AuRwMustAnyLock(rw) AuDebugOn(!lockdep_recursing(current) \ ++ && debug_locks \ ++ && !lockdep_is_held(rw)) ++#define AuRwDestroy(rw) AuDebugOn(!lockdep_recursing(current) \ ++ && debug_locks \ ++ && lockdep_is_held(rw)) + -+#define au_rw_init(rw) do { \ -+ AuDbgCntInit(rw); \ -+ init_rwsem(&(rw)->rwsem); \ -+ au_lockdep_set_name(rw); \ -+ } while (0) ++#define au_rw_init(rw) init_rwsem(rw) + +#define au_rw_init_wlock(rw) do { \ + au_rw_init(rw); \ -+ down_write(&(rw)->rwsem); \ -+ AuDbgWcntInc(rw); \ ++ down_write(rw); \ + } while (0) + -+#define au_rw_init_wlock_nested(rw, lsc) do { \ -+ au_rw_init(rw); \ -+ down_write_nested(&(rw)->rwsem, lsc); \ -+ AuDbgWcntInc(rw); \ ++#define au_rw_init_wlock_nested(rw, lsc) do { \ ++ au_rw_init(rw); \ ++ down_write_nested(rw, lsc); \ + } while (0) + -+static inline void au_rw_read_lock(struct au_rwsem *rw) -+{ -+ down_read(&rw->rwsem); -+ AuDbgRcntInc(rw); -+} -+ -+static inline void au_rw_read_lock_nested(struct au_rwsem *rw, unsigned int lsc) -+{ -+ down_read_nested(&rw->rwsem, lsc); -+ AuDbgRcntInc(rw); -+} -+ -+static inline void au_rw_read_unlock(struct au_rwsem *rw) -+{ -+ AuRwMustReadLock(rw); -+ AuDbgRcntDec(rw); -+ up_read(&rw->rwsem); -+} -+ -+static inline void au_rw_dgrade_lock(struct au_rwsem *rw) -+{ -+ AuRwMustWriteLock(rw); -+ AuDbgRcntInc(rw); -+ AuDbgWcntDec(rw); -+ downgrade_write(&rw->rwsem); -+} -+ -+static inline void au_rw_write_lock(struct au_rwsem *rw) -+{ -+ down_write(&rw->rwsem); -+ AuDbgWcntInc(rw); -+} -+ -+static inline void au_rw_write_lock_nested(struct au_rwsem *rw, -+ unsigned int lsc) -+{ -+ down_write_nested(&rw->rwsem, lsc); -+ AuDbgWcntInc(rw); -+} -+ -+static inline void au_rw_write_unlock(struct au_rwsem *rw) -+{ -+ AuRwMustWriteLock(rw); -+ AuDbgWcntDec(rw); -+ up_write(&rw->rwsem); -+} -+ -+/* why is not _nested version defined */ -+static inline int au_rw_read_trylock(struct au_rwsem *rw) -+{ -+ int ret; -+ -+ ret = down_read_trylock(&rw->rwsem); -+ if (ret) -+ AuDbgRcntInc(rw); -+ return ret; -+} -+ -+static inline int au_rw_write_trylock(struct au_rwsem *rw) -+{ -+ int ret; -+ -+ ret = down_write_trylock(&rw->rwsem); -+ if (ret) -+ AuDbgWcntInc(rw); -+ return ret; -+} -+ -+#undef AuDbgCntDec -+#undef AuDbgRcntInc -+#undef AuDbgRcntDec -+#undef AuDbgWcntDec -+ -+#define AuSimpleLockRwsemFuncs(prefix, param, rwsem) \ -+static inline void prefix##_read_lock(param) \ -+{ au_rw_read_lock(rwsem); } \ -+static inline void prefix##_write_lock(param) \ -+{ au_rw_write_lock(rwsem); } \ -+static inline int prefix##_read_trylock(param) \ -+{ return au_rw_read_trylock(rwsem); } \ -+static inline int prefix##_write_trylock(param) \ -+{ return au_rw_write_trylock(rwsem); } -+/* why is not _nested version defined */ -+/* static inline void prefix##_read_trylock_nested(param, lsc) -+{ au_rw_read_trylock_nested(rwsem, lsc)); } -+static inline void prefix##_write_trylock_nestd(param, lsc) -+{ au_rw_write_trylock_nested(rwsem, lsc); } */ -+ -+#define AuSimpleUnlockRwsemFuncs(prefix, param, rwsem) \ -+static inline void prefix##_read_unlock(param) \ -+{ au_rw_read_unlock(rwsem); } \ -+static inline void prefix##_write_unlock(param) \ -+{ au_rw_write_unlock(rwsem); } \ -+static inline void prefix##_downgrade_lock(param) \ -+{ au_rw_dgrade_lock(rwsem); } -+ -+#define AuSimpleRwsemFuncs(prefix, param, rwsem) \ -+ AuSimpleLockRwsemFuncs(prefix, param, rwsem) \ -+ AuSimpleUnlockRwsemFuncs(prefix, param, rwsem) ++#define au_rw_read_lock(rw) down_read(rw) ++#define au_rw_read_lock_nested(rw, lsc) down_read_nested(rw, lsc) ++#define au_rw_read_unlock(rw) up_read(rw) ++#define au_rw_dgrade_lock(rw) downgrade_write(rw) ++#define au_rw_write_lock(rw) down_write(rw) ++#define au_rw_write_lock_nested(rw, lsc) down_write_nested(rw, lsc) ++#define au_rw_write_unlock(rw) up_write(rw) ++/* why is not _nested version defined? */ ++#define au_rw_read_trylock(rw) down_read_trylock(rw) ++#define au_rw_write_trylock(rw) down_write_trylock(rw) + +#endif /* __KERNEL__ */ +#endif /* __AUFS_RWSEM_H__ */ diff --git a/fs/aufs/sbinfo.c b/fs/aufs/sbinfo.c new file mode 100644 -index 0000000..e113b51 +index 000000000000..1d862c4e1105 --- /dev/null +++ b/fs/aufs/sbinfo.c -@@ -0,0 +1,342 @@ +@@ -0,0 +1,292 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -25215,7 +27064,7 @@ index 0000000..e113b51 + + sbinfo = container_of(kobj, struct au_sbinfo, si_kobj); + for (i = 0; i < AuPlink_NHASH; i++) -+ AuDebugOn(!hlist_empty(&sbinfo->si_plink[i].head)); ++ AuDebugOn(!hlist_bl_empty(sbinfo->si_plink + i)); + AuDebugOn(atomic_read(&sbinfo->si_nowait.nw_len)); + + AuDebugOn(percpu_counter_sum(&sbinfo->si_ninodes)); @@ -25227,15 +27076,11 @@ index 0000000..e113b51 + au_br_free(sbinfo); + au_rw_write_unlock(&sbinfo->si_rwsem); + -+ au_delayed_kfree(sbinfo->si_branch); -+ for (i = 0; i < AU_NPIDMAP; i++) -+ if (sbinfo->au_si_pid.pid_bitmap[i]) -+ au_delayed_kfree(sbinfo->au_si_pid.pid_bitmap[i]); -+ mutex_destroy(&sbinfo->au_si_pid.pid_mtx); ++ kfree(sbinfo->si_branch); + mutex_destroy(&sbinfo->si_xib_mtx); + AuRwDestroy(&sbinfo->si_rwsem); + -+ au_delayed_kfree(sbinfo); ++ kfree(sbinfo); +} + +int au_si_alloc(struct super_block *sb) @@ -25259,7 +27104,6 @@ index 0000000..e113b51 + + au_nwt_init(&sbinfo->si_nowait); + au_rw_init_wlock(&sbinfo->si_rwsem); -+ mutex_init(&sbinfo->au_si_pid.pid_mtx); + + percpu_counter_init(&sbinfo->si_ninodes, 0, GFP_NOFS); + percpu_counter_init(&sbinfo->si_nfiles, 0, GFP_NOFS); @@ -25283,7 +27127,7 @@ index 0000000..e113b51 + sbinfo->si_xino_brid = -1; + /* leave si_xib_last_pindex and si_xib_next_bit */ + -+ au_sphl_init(&sbinfo->si_aopen); ++ INIT_HLIST_BL_HEAD(&sbinfo->si_aopen); + + sbinfo->si_rdcache = msecs_to_jiffies(AUFS_RDCACHE_DEF * MSEC_PER_SEC); + sbinfo->si_rdblk = AUFS_RDBLK_DEF; @@ -25291,11 +27135,11 @@ index 0000000..e113b51 + sbinfo->si_dirwh = AUFS_DIRWH_DEF; + + for (i = 0; i < AuPlink_NHASH; i++) -+ au_sphl_init(sbinfo->si_plink + i); ++ INIT_HLIST_BL_HEAD(sbinfo->si_plink + i); + init_waitqueue_head(&sbinfo->si_plink_wq); + spin_lock_init(&sbinfo->si_plink_maint_lock); + -+ au_sphl_init(&sbinfo->si_files); ++ INIT_HLIST_BL_HEAD(&sbinfo->si_files); + + /* with getattr by default */ + sbinfo->si_iop_array = aufs_iop; @@ -25307,9 +27151,9 @@ index 0000000..e113b51 + return 0; /* success */ + +out_br: -+ au_delayed_kfree(sbinfo->si_branch); ++ kfree(sbinfo->si_branch); +out_sbinfo: -+ au_delayed_kfree(sbinfo); ++ kfree(sbinfo); +out: + return err; +} @@ -25490,166 +27334,15 @@ index 0000000..e113b51 + di_write_unlock2(d1, d2); + si_read_unlock(d1->d_sb); +} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static void si_pid_alloc(struct au_si_pid *au_si_pid, int idx) -+{ -+ unsigned long *p; -+ -+ BUILD_BUG_ON(sizeof(unsigned long) != -+ sizeof(*au_si_pid->pid_bitmap)); -+ -+ mutex_lock(&au_si_pid->pid_mtx); -+ p = au_si_pid->pid_bitmap[idx]; -+ while (!p) { -+ /* -+ * bad approach. -+ * but keeping 'si_pid_set()' void is more important. -+ */ -+ p = kcalloc(BITS_TO_LONGS(AU_PIDSTEP), -+ sizeof(*au_si_pid->pid_bitmap), -+ GFP_NOFS); -+ if (p) -+ break; -+ cond_resched(); -+ } -+ au_si_pid->pid_bitmap[idx] = p; -+ mutex_unlock(&au_si_pid->pid_mtx); -+} -+ -+void si_pid_set(struct super_block *sb) -+{ -+ pid_t bit; -+ int idx; -+ unsigned long *bitmap; -+ struct au_si_pid *au_si_pid; -+ -+ si_pid_idx_bit(&idx, &bit); -+ au_si_pid = &au_sbi(sb)->au_si_pid; -+ bitmap = au_si_pid->pid_bitmap[idx]; -+ if (!bitmap) { -+ si_pid_alloc(au_si_pid, idx); -+ bitmap = au_si_pid->pid_bitmap[idx]; -+ } -+ AuDebugOn(test_bit(bit, bitmap)); -+ set_bit(bit, bitmap); -+ /* smp_mb(); */ -+} -diff --git a/fs/aufs/spl.h b/fs/aufs/spl.h -new file mode 100644 -index 0000000..8f519db3 ---- /dev/null -+++ b/fs/aufs/spl.h -@@ -0,0 +1,100 @@ -+/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima -+ */ -+ -+/* -+ * simple list protected by a spinlock -+ */ -+ -+#ifndef __AUFS_SPL_H__ -+#define __AUFS_SPL_H__ -+ -+#ifdef __KERNEL__ -+ -+#if 0 -+struct au_splhead { -+ spinlock_t spin; -+ struct list_head head; -+}; -+ -+static inline void au_spl_init(struct au_splhead *spl) -+{ -+ spin_lock_init(&spl->spin); -+ INIT_LIST_HEAD(&spl->head); -+} -+ -+static inline void au_spl_add(struct list_head *list, struct au_splhead *spl) -+{ -+ spin_lock(&spl->spin); -+ list_add(list, &spl->head); -+ spin_unlock(&spl->spin); -+} -+ -+static inline void au_spl_del(struct list_head *list, struct au_splhead *spl) -+{ -+ spin_lock(&spl->spin); -+ list_del(list); -+ spin_unlock(&spl->spin); -+} -+ -+static inline void au_spl_del_rcu(struct list_head *list, -+ struct au_splhead *spl) -+{ -+ spin_lock(&spl->spin); -+ list_del_rcu(list); -+ spin_unlock(&spl->spin); -+} -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct au_sphlhead { -+ spinlock_t spin; -+ struct hlist_head head; -+}; -+ -+static inline void au_sphl_init(struct au_sphlhead *sphl) -+{ -+ spin_lock_init(&sphl->spin); -+ INIT_HLIST_HEAD(&sphl->head); -+} -+ -+static inline void au_sphl_add(struct hlist_node *hlist, -+ struct au_sphlhead *sphl) -+{ -+ spin_lock(&sphl->spin); -+ hlist_add_head(hlist, &sphl->head); -+ spin_unlock(&sphl->spin); -+} -+ -+static inline void au_sphl_del(struct hlist_node *hlist, -+ struct au_sphlhead *sphl) -+{ -+ spin_lock(&sphl->spin); -+ hlist_del(hlist); -+ spin_unlock(&sphl->spin); -+} -+ -+static inline void au_sphl_del_rcu(struct hlist_node *hlist, -+ struct au_sphlhead *sphl) -+{ -+ spin_lock(&sphl->spin); -+ hlist_del_rcu(hlist); -+ spin_unlock(&sphl->spin); -+} -+ -+static inline unsigned long au_sphl_count(struct au_sphlhead *sphl) -+{ -+ unsigned long cnt; -+ struct hlist_node *pos; -+ -+ cnt = 0; -+ spin_lock(&sphl->spin); -+ hlist_for_each(pos, &sphl->head) -+ cnt++; -+ spin_unlock(&sphl->spin); -+ return cnt; -+} -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_SPL_H__ */ diff --git a/fs/aufs/super.c b/fs/aufs/super.c new file mode 100644 -index 0000000..0082ce4 +index 000000000000..75c2e173fde1 --- /dev/null +++ b/fs/aufs/super.c -@@ -0,0 +1,1033 @@ +@@ -0,0 +1,1034 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -25683,7 +27376,7 @@ index 0000000..0082ce4 +{ + struct inode *inode = container_of(head, struct inode, i_rcu); + -+ au_cache_dfree_icntnr(container_of(inode, struct au_icntnr, vfs_inode)); ++ au_cache_free_icntnr(container_of(inode, struct au_icntnr, vfs_inode)); +} + +static void aufs_destroy_inode(struct inode *inode) @@ -25925,6 +27618,7 @@ index 0000000..0082ce4 + + au_fhsm_show(m, sbinfo); + ++ AuBool(DIRREN, dirren); + AuBool(SUM, sum); + /* AuBool(SUM_W, wsum); */ + AuBool(WARN_PERM, warn_perm); @@ -26084,12 +27778,10 @@ index 0000000..0082ce4 + continue; + + h_sb = au_sbr_sb(sb, bindex); -+ if (h_sb->s_op->sync_fs) { -+ e = h_sb->s_op->sync_fs(h_sb, wait); -+ if (unlikely(e && !err)) -+ err = e; -+ /* go on even if an error happens */ -+ } ++ e = vfsub_sync_filesystem(h_sb, wait); ++ if (unlikely(e && !err)) ++ err = e; ++ /* go on even if an error happens */ + } + si_read_unlock(sb); + @@ -26473,7 +28165,7 @@ index 0000000..0082ce4 +out_mtx: + inode_unlock(inode); +out_opts: -+ au_delayed_free_page((unsigned long)opts.opt); ++ free_page((unsigned long)opts.opt); +out: + err = cvt_err(err); + AuTraceErr(err); @@ -26614,7 +28306,7 @@ index 0000000..0082ce4 + kobject_put(&sbinfo->si_kobj); + sb->s_fs_info = NULL; +out_opts: -+ au_delayed_free_page((unsigned long)opts.opt); ++ free_page((unsigned long)opts.opt); +out: + AuTraceErr(err); + err = cvt_err(err); @@ -26665,6 +28357,7 @@ index 0000000..0082ce4 + if (au_opt_test(sbinfo->si_mntflags, PLINK)) + au_plink_put(sb, /*verbose*/1); + au_xino_clr(sb); ++ au_dr_opt_flush(sb); + sbinfo->si_sb = NULL; + aufs_write_unlock(sb->s_root); + au_nwt_flush(&sbinfo->si_nowait); @@ -26683,12 +28376,13 @@ index 0000000..0082ce4 +}; diff --git a/fs/aufs/super.h b/fs/aufs/super.h new file mode 100644 -index 0000000..ba614b3 +index 000000000000..9562f4debe9f --- /dev/null +++ b/fs/aufs/super.h -@@ -0,0 +1,626 @@ +@@ -0,0 +1,614 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -26702,8 +28396,8 @@ index 0000000..ba614b3 + +#include +#include ++#include "hbl.h" +#include "rwsem.h" -+#include "spl.h" +#include "wkq.h" + +/* policies to select one among multiple writable branches */ @@ -26755,13 +28449,6 @@ index 0000000..ba614b3 +#endif +}; + -+#define AU_PIDSTEP (int)(BITS_TO_LONGS(PID_MAX_DEFAULT) * BITS_PER_LONG) -+#define AU_NPIDMAP (int)DIV_ROUND_UP(PID_MAX_LIMIT, AU_PIDSTEP) -+struct au_si_pid { -+ unsigned long *pid_bitmap[AU_NPIDMAP]; -+ struct mutex pid_mtx; -+}; -+ +struct au_branch; +struct au_sbinfo { + /* nowait tasks in the system-wide workqueue */ @@ -26773,9 +28460,6 @@ index 0000000..ba614b3 + */ + struct au_rwsem si_rwsem; + -+ /* prevent recursive locking in deleting inode */ -+ struct au_si_pid au_si_pid; -+ + /* + * dirty approach to protect sb->sb_inodes and ->s_files (gone) from + * remount. @@ -26835,7 +28519,7 @@ index 0000000..ba614b3 +#endif + + /* dirty trick to suppoer atomic_open */ -+ struct au_sphlhead si_aopen; ++ struct hlist_bl_head si_aopen; + + /* vdir parameters */ + unsigned long si_rdcache; /* max cache time in jiffies */ @@ -26851,13 +28535,13 @@ index 0000000..ba614b3 + unsigned int si_dirwh; + + /* pseudo_link list */ -+ struct au_sphlhead si_plink[AuPlink_NHASH]; ++ struct hlist_bl_head si_plink[AuPlink_NHASH]; + wait_queue_head_t si_plink_wq; + spinlock_t si_plink_maint_lock; + pid_t si_plink_maint_pid; + + /* file list */ -+ struct au_sphlhead si_files; ++ struct hlist_bl_head si_files; + + /* with/without getattr, brother of sb->s_d_op */ + struct inode_operations *si_iop_array; @@ -26879,7 +28563,7 @@ index 0000000..ba614b3 +#endif + +#ifdef CONFIG_AUFS_SBILIST -+ struct hlist_node si_list; ++ struct hlist_bl_node si_list; +#endif + + /* dirty, necessary for unmounting, sysfs and sysrq */ @@ -27054,32 +28738,32 @@ index 0000000..ba614b3 + +#ifdef CONFIG_AUFS_SBILIST +/* module.c */ -+extern struct au_sphlhead au_sbilist; ++extern struct hlist_bl_head au_sbilist; + +static inline void au_sbilist_init(void) +{ -+ au_sphl_init(&au_sbilist); ++ INIT_HLIST_BL_HEAD(&au_sbilist); +} + +static inline void au_sbilist_add(struct super_block *sb) +{ -+ au_sphl_add(&au_sbi(sb)->si_list, &au_sbilist); ++ au_hbl_add(&au_sbi(sb)->si_list, &au_sbilist); +} + +static inline void au_sbilist_del(struct super_block *sb) +{ -+ au_sphl_del(&au_sbi(sb)->si_list, &au_sbilist); ++ au_hbl_del(&au_sbi(sb)->si_list, &au_sbilist); +} + +#ifdef CONFIG_AUFS_MAGIC_SYSRQ +static inline void au_sbilist_lock(void) +{ -+ spin_lock(&au_sbilist.spin); ++ hlist_bl_lock(&au_sbilist); +} + +static inline void au_sbilist_unlock(void) +{ -+ spin_unlock(&au_sbilist.spin); ++ hlist_bl_unlock(&au_sbilist); +} +#define AuGFP_SBILIST GFP_ATOMIC +#else @@ -27117,51 +28801,48 @@ index 0000000..ba614b3 + +/* ---------------------------------------------------------------------- */ + -+static inline void si_pid_idx_bit(int *idx, pid_t *bit) -+{ -+ /* the origin of pid is 1, but the bitmap's is 0 */ -+ *bit = current->pid - 1; -+ *idx = *bit / AU_PIDSTEP; -+ *bit %= AU_PIDSTEP; -+} ++/* current->atomic_flags */ ++/* this value should never corrupt the ones defined in linux/sched.h */ ++#define PFA_AUFS 7 ++ ++TASK_PFA_TEST(AUFS, test_aufs) /* task_test_aufs */ ++TASK_PFA_SET(AUFS, aufs) /* task_set_aufs */ ++TASK_PFA_CLEAR(AUFS, aufs) /* task_clear_aufs */ + +static inline int si_pid_test(struct super_block *sb) +{ -+ pid_t bit; -+ int idx; -+ unsigned long *bitmap; -+ -+ si_pid_idx_bit(&idx, &bit); -+ bitmap = au_sbi(sb)->au_si_pid.pid_bitmap[idx]; -+ if (bitmap) -+ return test_bit(bit, bitmap); -+ return 0; ++ return !!task_test_aufs(current); +} + +static inline void si_pid_clr(struct super_block *sb) +{ -+ pid_t bit; -+ int idx; -+ unsigned long *bitmap; -+ -+ si_pid_idx_bit(&idx, &bit); -+ bitmap = au_sbi(sb)->au_si_pid.pid_bitmap[idx]; -+ BUG_ON(!bitmap); -+ AuDebugOn(!test_bit(bit, bitmap)); -+ clear_bit(bit, bitmap); -+ /* smp_mb(); */ ++ AuDebugOn(!task_test_aufs(current)); ++ task_clear_aufs(current); +} + -+void si_pid_set(struct super_block *sb); ++static inline void si_pid_set(struct super_block *sb) ++{ ++ AuDebugOn(task_test_aufs(current)); ++ task_set_aufs(current); ++} + +/* ---------------------------------------------------------------------- */ + +/* lock superblock. mainly for entry point functions */ ++#define __si_read_lock(sb) au_rw_read_lock(&au_sbi(sb)->si_rwsem) ++#define __si_write_lock(sb) au_rw_write_lock(&au_sbi(sb)->si_rwsem) ++#define __si_read_trylock(sb) au_rw_read_trylock(&au_sbi(sb)->si_rwsem) ++#define __si_write_trylock(sb) au_rw_write_trylock(&au_sbi(sb)->si_rwsem) +/* -+ * __si_read_lock, __si_write_lock, -+ * __si_read_unlock, __si_write_unlock, __si_downgrade_lock -+ */ -+AuSimpleRwsemFuncs(__si, struct super_block *sb, &au_sbi(sb)->si_rwsem); ++#define __si_read_trylock_nested(sb) \ ++ au_rw_read_trylock_nested(&au_sbi(sb)->si_rwsem) ++#define __si_write_trylock_nested(sb) \ ++ au_rw_write_trylock_nested(&au_sbi(sb)->si_rwsem) ++*/ ++ ++#define __si_read_unlock(sb) au_rw_read_unlock(&au_sbi(sb)->si_rwsem) ++#define __si_write_unlock(sb) au_rw_write_unlock(&au_sbi(sb)->si_rwsem) ++#define __si_downgrade_lock(sb) au_rw_dgrade_lock(&au_sbi(sb)->si_rwsem) + +#define SiMustNoWaiters(sb) AuRwMustNoWaiters(&au_sbi(sb)->si_rwsem) +#define SiMustAnyLock(sb) AuRwMustAnyLock(&au_sbi(sb)->si_rwsem) @@ -27315,12 +28996,13 @@ index 0000000..ba614b3 +#endif /* __AUFS_SUPER_H__ */ diff --git a/fs/aufs/sysaufs.c b/fs/aufs/sysaufs.c new file mode 100644 -index 0000000..8ec10fb3 +index 000000000000..505d6ef3371c --- /dev/null +++ b/fs/aufs/sysaufs.c -@@ -0,0 +1,91 @@ +@@ -0,0 +1,92 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -27412,12 +29094,13 @@ index 0000000..8ec10fb3 +} diff --git a/fs/aufs/sysaufs.h b/fs/aufs/sysaufs.h new file mode 100644 -index 0000000..1f79983 +index 000000000000..a4d84ce79e32 --- /dev/null +++ b/fs/aufs/sysaufs.h -@@ -0,0 +1,88 @@ +@@ -0,0 +1,89 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -27506,12 +29189,13 @@ index 0000000..1f79983 +#endif /* __SYSAUFS_H__ */ diff --git a/fs/aufs/sysfs.c b/fs/aufs/sysfs.c new file mode 100644 -index 0000000..f4c3170 +index 000000000000..d00aa523e242 --- /dev/null +++ b/fs/aufs/sysfs.c -@@ -0,0 +1,340 @@ +@@ -0,0 +1,341 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -27685,7 +29369,7 @@ index 0000000..f4c3170 + if (unlikely(err == PAGE_SIZE)) + err = -EFBIG; + } -+ au_delayed_kfree(seq); ++ kfree(seq); +out_unlock: + si_read_unlock(sb); +out: @@ -27756,9 +29440,9 @@ index 0000000..f4c3170 + err = -EFAULT; + +out_seq: -+ au_delayed_kfree(seq); ++ kfree(seq); +out_buf: -+ au_delayed_free_page((unsigned long)buf); ++ free_page((unsigned long)buf); +out: + si_read_unlock(sb); + return err; @@ -27852,12 +29536,13 @@ index 0000000..f4c3170 +} diff --git a/fs/aufs/sysrq.c b/fs/aufs/sysrq.c new file mode 100644 -index 0000000..7d22979 +index 000000000000..d928d408d1e5 --- /dev/null +++ b/fs/aufs/sysrq.c -@@ -0,0 +1,144 @@ +@@ -0,0 +1,147 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -27875,7 +29560,8 @@ index 0000000..7d22979 + char *plevel; + struct au_sbinfo *sbinfo; + struct file *file; -+ struct au_sphlhead *files; ++ struct hlist_bl_head *files; ++ struct hlist_bl_node *pos; + struct au_finfo *finfo; + + plevel = au_plevel; @@ -27934,8 +29620,8 @@ index 0000000..7d22979 +#endif + pr("files\n"); + files = &au_sbi(sb)->si_files; -+ spin_lock(&files->spin); -+ hlist_for_each_entry(finfo, &files->head, fi_hlist) { ++ hlist_bl_lock(files); ++ hlist_bl_for_each_entry(finfo, pos, files, fi_hlist) { + umode_t mode; + + file = finfo->fi_file; @@ -27943,7 +29629,7 @@ index 0000000..7d22979 + if (!special_file(mode)) + au_dpri_file(file); + } -+ spin_unlock(&files->spin); ++ hlist_bl_unlock(files); + pr("done\n"); + +#undef pr @@ -27960,10 +29646,11 @@ index 0000000..7d22979 +static void au_sysrq(int key __maybe_unused) +{ + struct au_sbinfo *sbinfo; ++ struct hlist_bl_node *pos; + + lockdep_off(); + au_sbilist_lock(); -+ hlist_for_each_entry(sbinfo, &au_sbilist.head, si_list) ++ hlist_bl_for_each_entry(sbinfo, pos, &au_sbilist, si_list) + sysrq_sb(sbinfo->si_sb); + au_sbilist_unlock(); + lockdep_on(); @@ -28002,12 +29689,13 @@ index 0000000..7d22979 +} diff --git a/fs/aufs/vdir.c b/fs/aufs/vdir.c new file mode 100644 -index 0000000..b2eb4c0 +index 000000000000..7afd018b94ef --- /dev/null +++ b/fs/aufs/vdir.c -@@ -0,0 +1,887 @@ +@@ -0,0 +1,880 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -28105,7 +29793,7 @@ index 0000000..b2eb4c0 + struct hlist_node *node; + + hlist_for_each_entry_safe(pos, node, head, wh_hash) -+ au_delayed_kfree(pos); ++ kfree(pos); +} + +static void au_nhash_de_do_free(struct hlist_head *head) @@ -28114,7 +29802,7 @@ index 0000000..b2eb4c0 + struct hlist_node *node; + + hlist_for_each_entry_safe(pos, node, head, hash) -+ au_cache_dfree_vdir_dehstr(pos); ++ au_cache_free_vdir_dehstr(pos); +} + +static void au_nhash_do_free(struct au_nhash *nhash, @@ -28132,7 +29820,7 @@ index 0000000..b2eb4c0 + nhash_count(head); + free(head++); + } -+ au_delayed_kfree(nhash->nh_head); ++ kfree(nhash->nh_head); +} + +void au_nhash_wh_free(struct au_nhash *whlist) @@ -28345,23 +30033,15 @@ index 0000000..b2eb4c0 + +/* ---------------------------------------------------------------------- */ + -+void au_vdir_free(struct au_vdir *vdir, int atonce) ++void au_vdir_free(struct au_vdir *vdir) +{ + unsigned char **deblk; + + deblk = vdir->vd_deblk; -+ if (!atonce) { -+ while (vdir->vd_nblk--) -+ au_delayed_kfree(*deblk++); -+ au_delayed_kfree(vdir->vd_deblk); -+ au_cache_dfree_vdir(vdir); -+ } else { -+ /* not delayed */ -+ while (vdir->vd_nblk--) -+ kfree(*deblk++); -+ kfree(vdir->vd_deblk); -+ au_cache_free_vdir(vdir); -+ } ++ while (vdir->vd_nblk--) ++ kfree(*deblk++); ++ kfree(vdir->vd_deblk); ++ au_cache_free_vdir(vdir); +} + +static struct au_vdir *alloc_vdir(struct file *file) @@ -28395,10 +30075,10 @@ index 0000000..b2eb4c0 + if (!err) + return vdir; /* success */ + -+ au_delayed_kfree(vdir->vd_deblk); ++ kfree(vdir->vd_deblk); + +out_free: -+ au_cache_dfree_vdir(vdir); ++ au_cache_free_vdir(vdir); +out: + vdir = ERR_PTR(err); + return vdir; @@ -28410,7 +30090,7 @@ index 0000000..b2eb4c0 + union au_vdir_deblk_p p, deblk_end; + + while (vdir->vd_nblk > 1) { -+ au_delayed_kfree(vdir->vd_deblk[vdir->vd_nblk - 1]); ++ kfree(vdir->vd_deblk[vdir->vd_nblk - 1]); + /* vdir->vd_deblk[vdir->vd_nblk - 1] = NULL; */ + vdir->vd_nblk--; + } @@ -28541,7 +30221,7 @@ index 0000000..b2eb4c0 + } + } + -+ au_delayed_free_page((unsigned long)o); ++ free_page((unsigned long)o); + +out: + AuTraceErr(err); @@ -28680,7 +30360,7 @@ index 0000000..b2eb4c0 + if (allocated) + au_set_ivdir(inode, allocated); + } else if (allocated) -+ au_vdir_free(allocated, /*atonce*/0); ++ au_vdir_free(allocated); + +out: + return err; @@ -28775,7 +30455,7 @@ index 0000000..b2eb4c0 + if (allocated) + au_set_fvdir_cache(file, allocated); + } else if (allocated) -+ au_vdir_free(allocated, /*atonce*/0); ++ au_vdir_free(allocated); + +out: + return err; @@ -28895,41 +30575,49 @@ index 0000000..b2eb4c0 +} diff --git a/fs/aufs/vfsub.c b/fs/aufs/vfsub.c new file mode 100644 -index 0000000..f2c500b +index 000000000000..f70a954d11c1 --- /dev/null +++ b/fs/aufs/vfsub.c -@@ -0,0 +1,873 @@ +@@ -0,0 +1,882 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* + * sub-routines for VFS + */ + ++#include +#include +#include +#include +#include -+#ifdef CONFIG_AUFS_BR_FUSE -+#include "../fs/mount.h" -+#endif +#include "aufs.h" + +#ifdef CONFIG_AUFS_BR_FUSE +int vfsub_test_mntns(struct vfsmount *mnt, struct super_block *h_sb) +{ -+ struct nsproxy *ns; -+ + if (!au_test_fuse(h_sb) || !au_userns) + return 0; + -+ ns = current->nsproxy; -+ /* no {get,put}_nsproxy(ns) */ -+ return real_mount(mnt)->mnt_ns == ns->mnt_ns ? 0 : -EACCES; ++ return is_current_mnt_ns(mnt) ? 0 : -EACCES; +} +#endif + ++int vfsub_sync_filesystem(struct super_block *h_sb, int wait) ++{ ++ int err; ++ ++ lockdep_off(); ++ down_read(&h_sb->s_umount); ++ err = __sync_filesystem(h_sb, wait); ++ up_read(&h_sb->s_umount); ++ lockdep_on(); ++ ++ return err; ++} ++ +/* ---------------------------------------------------------------------- */ + +int vfsub_update_h_iattr(struct path *h_path, int *did) @@ -28947,7 +30635,7 @@ index 0000000..f2c500b + h_sb = h_path->dentry->d_sb; + *did = (!au_test_fs_remote(h_sb) && au_test_fs_refresh_iattr(h_sb)); + if (*did) -+ err = vfs_getattr(h_path, &st); ++ err = vfsub_getattr(h_path, &st); + + return err; +} @@ -29473,6 +31161,7 @@ index 0000000..f2c500b + lockdep_on(); + if (err >= 0) + vfsub_update_h_iattr(&file->f_path, /*did*/NULL); /*ignore*/ ++ + return err; +} + @@ -29774,12 +31463,13 @@ index 0000000..f2c500b +} diff --git a/fs/aufs/vfsub.h b/fs/aufs/vfsub.h new file mode 100644 -index 0000000..c9df32c +index 000000000000..85739f295e07 --- /dev/null +++ b/fs/aufs/vfsub.h -@@ -0,0 +1,303 @@ +@@ -0,0 +1,348 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -29821,6 +31511,13 @@ index 0000000..c9df32c +#define MtxMustLock(mtx) AuDebugOn(!mutex_is_locked(mtx)) +#define IMustLock(i) AuDebugOn(!inode_is_locked(i)) + ++/* why VFS doesn't define it? */ ++static inline ++void vfsub_inode_lock_shared_nested(struct inode *inode, unsigned int sc) ++{ ++ down_read_nested(&inode->i_rwsem, sc); ++} ++ +/* ---------------------------------------------------------------------- */ + +static inline void vfsub_drop_nlink(struct inode *inode) @@ -29838,7 +31535,7 @@ index 0000000..c9df32c + +static inline int vfsub_native_ro(struct inode *inode) +{ -+ return (inode->i_sb->s_flags & MS_RDONLY) ++ return sb_rdonly(inode->i_sb) + || IS_RDONLY(inode) + /* || IS_APPEND(inode) */ + || IS_IMMUTABLE(inode); @@ -29850,6 +31547,8 @@ index 0000000..c9df32c +AuStubInt0(vfsub_test_mntns, struct vfsmount *mnt, struct super_block *h_sb); +#endif + ++int vfsub_sync_filesystem(struct super_block *h_sb, int wait); ++ +/* ---------------------------------------------------------------------- */ + +int vfsub_update_h_iattr(struct path *h_path, int *did); @@ -30031,6 +31730,36 @@ index 0000000..c9df32c + struct file *h_file); +int vfsub_fsync(struct file *file, struct path *path, int datasync); + ++/* ++ * re-use branch fs's ioctl(FICLONE) while aufs itself doesn't support such ++ * ioctl. ++ */ ++static inline int vfsub_clone_file_range(struct file *src, struct file *dst, ++ u64 len) ++{ ++ int err; ++ ++ lockdep_off(); ++ err = vfs_clone_file_range(src, 0, dst, 0, len); ++ lockdep_on(); ++ ++ return err; ++} ++ ++/* copy_file_range(2) is a systemcall */ ++static inline ssize_t vfsub_copy_file_range(struct file *src, loff_t src_pos, ++ struct file *dst, loff_t dst_pos, ++ size_t len, unsigned int flags) ++{ ++ ssize_t ssz; ++ ++ lockdep_off(); ++ ssz = vfs_copy_file_range(src, src_pos, dst, dst_pos, len, flags); ++ lockdep_on(); ++ ++ return ssz; ++} ++ +/* ---------------------------------------------------------------------- */ + +static inline loff_t vfsub_llseek(struct file *file, loff_t offset, int origin) @@ -30054,6 +31783,11 @@ index 0000000..c9df32c +int vfsub_unlink(struct inode *dir, struct path *path, + struct inode **delegated_inode, int force); + ++static inline int vfsub_getattr(const struct path *path, struct kstat *st) ++{ ++ return vfs_getattr(path, st, STATX_BASIC_STATS, AT_STATX_SYNC_AS_STAT); ++} ++ +/* ---------------------------------------------------------------------- */ + +static inline int vfsub_setxattr(struct dentry *dentry, const char *name, @@ -30083,12 +31817,13 @@ index 0000000..c9df32c +#endif /* __AUFS_VFSUB_H__ */ diff --git a/fs/aufs/wbr_policy.c b/fs/aufs/wbr_policy.c new file mode 100644 -index 0000000..438a8da +index 000000000000..c18e0dc4d236 --- /dev/null +++ b/fs/aufs/wbr_policy.c -@@ -0,0 +1,817 @@ +@@ -0,0 +1,818 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -30537,7 +32272,7 @@ index 0000000..438a8da + + mfs->mfsrr_bytes = bavail; + AuDbg("b%d\n", mfs->mfs_bindex); -+ au_delayed_kfree(st); ++ kfree(st); +} + +static int au_wbr_create_mfs(struct dentry *dentry, unsigned int flags) @@ -30906,12 +32641,13 @@ index 0000000..438a8da +}; diff --git a/fs/aufs/whout.c b/fs/aufs/whout.c new file mode 100644 -index 0000000..2fa8627 +index 000000000000..9ed0b30b56f4 --- /dev/null +++ b/fs/aufs/whout.c -@@ -0,0 +1,1048 @@ +@@ -0,0 +1,1049 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -31061,7 +32797,7 @@ index 0000000..2fa8627 + +out_name: + if (name != defname) -+ au_delayed_kfree(name); ++ kfree(name); +out: + AuTraceErrPtr(dentry); + return dentry; @@ -31501,7 +33237,7 @@ index 0000000..2fa8627 + au_br_put(a->br); + si_write_unlock(a->sb); + au_nwt_done(&au_sbi(a->sb)->si_nowait); -+ au_delayed_kfree(arg); ++ kfree(arg); + if (unlikely(err)) + AuIOErr("err %d\n", err); +} @@ -31529,7 +33265,7 @@ index 0000000..2fa8627 + if (unlikely(wkq_err)) { + atomic_dec(&br->br_wbr->wbr_wh_running); + au_br_put(br); -+ au_delayed_kfree(arg); ++ kfree(arg); + } + do_dec = 0; + } @@ -31688,7 +33424,7 @@ index 0000000..2fa8627 + wh_dentry = ERR_PTR(err); + if (!err) { + wh_dentry = vfsub_lkup_one(&wh_name, h_parent); -+ au_delayed_kfree(wh_name.name); ++ kfree(wh_name.name); + } + return wh_dentry; +} @@ -31764,7 +33500,7 @@ index 0000000..2fa8627 + break; + } + } -+ au_delayed_free_page((unsigned long)wh_name.name); ++ free_page((unsigned long)wh_name.name); + +out: + return err; @@ -31806,7 +33542,7 @@ index 0000000..2fa8627 + rdhash = AUFS_RDHASH_DEF; + err = au_nhash_alloc(&whtmp->whlist, rdhash, gfp); + if (unlikely(err)) { -+ au_delayed_kfree(whtmp); ++ kfree(whtmp); + whtmp = ERR_PTR(err); + } + @@ -31821,7 +33557,7 @@ index 0000000..2fa8627 + dput(whtmp->wh_dentry); + iput(whtmp->dir); + au_nhash_wh_free(&whtmp->whlist); -+ au_delayed_kfree(whtmp); ++ kfree(whtmp); +} + +/* @@ -31960,12 +33696,13 @@ index 0000000..2fa8627 +} diff --git a/fs/aufs/whout.h b/fs/aufs/whout.h new file mode 100644 -index 0000000..4077dd1 +index 000000000000..94a76217bbcb --- /dev/null +++ b/fs/aufs/whout.h -@@ -0,0 +1,72 @@ +@@ -0,0 +1,73 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -32038,12 +33775,13 @@ index 0000000..4077dd1 +#endif /* __AUFS_WHOUT_H__ */ diff --git a/fs/aufs/wkq.c b/fs/aufs/wkq.c new file mode 100644 -index 0000000..216d08f +index 000000000000..df25631428d6 --- /dev/null +++ b/fs/aufs/wkq.c -@@ -0,0 +1,200 @@ +@@ -0,0 +1,378 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -32067,10 +33805,177 @@ index 0000000..216d08f + au_wkq_func_t func; + void *args; + ++#ifdef CONFIG_LOCKDEP ++ int dont_check; ++ struct held_lock **hlock; ++#endif ++ + struct completion *comp; +}; + +/* ---------------------------------------------------------------------- */ ++/* ++ * Aufs passes some operations to the workqueue such as the internal copyup. ++ * This scheme looks rather unnatural for LOCKDEP debugging feature, since the ++ * job run by workqueue depends upon the locks acquired in the other task. ++ * Delegating a small operation to the workqueue, aufs passes its lockdep ++ * information too. And the job in the workqueue restores the info in order to ++ * pretend as if it acquired those locks. This is just to make LOCKDEP work ++ * correctly and expectedly. ++ */ ++ ++#ifndef CONFIG_LOCKDEP ++AuStubInt0(au_wkq_lockdep_alloc, struct au_wkinfo *wkinfo); ++AuStubVoid(au_wkq_lockdep_free, struct au_wkinfo *wkinfo); ++AuStubVoid(au_wkq_lockdep_pre, struct au_wkinfo *wkinfo); ++AuStubVoid(au_wkq_lockdep_post, struct au_wkinfo *wkinfo); ++AuStubVoid(au_wkq_lockdep_init, struct au_wkinfo *wkinfo); ++#else ++static void au_wkq_lockdep_init(struct au_wkinfo *wkinfo) ++{ ++ wkinfo->hlock = NULL; ++ wkinfo->dont_check = 0; ++} ++ ++/* ++ * 1: matched ++ * 0: unmatched ++ */ ++static int au_wkq_lockdep_test(struct lock_class_key *key, const char *name) ++{ ++ static DEFINE_SPINLOCK(spin); ++ static struct { ++ char *name; ++ struct lock_class_key *key; ++ } a[] = { ++ { .name = "&sbinfo->si_rwsem" }, ++ { .name = "&finfo->fi_rwsem" }, ++ { .name = "&dinfo->di_rwsem" }, ++ { .name = "&iinfo->ii_rwsem" } ++ }; ++ static int set; ++ int i; ++ ++ /* lockless read from 'set.' see below */ ++ if (set == ARRAY_SIZE(a)) { ++ for (i = 0; i < ARRAY_SIZE(a); i++) ++ if (a[i].key == key) ++ goto match; ++ goto unmatch; ++ } ++ ++ spin_lock(&spin); ++ if (set) ++ for (i = 0; i < ARRAY_SIZE(a); i++) ++ if (a[i].key == key) { ++ spin_unlock(&spin); ++ goto match; ++ } ++ for (i = 0; i < ARRAY_SIZE(a); i++) { ++ if (a[i].key) { ++ if (unlikely(a[i].key == key)) { /* rare but possible */ ++ spin_unlock(&spin); ++ goto match; ++ } else ++ continue; ++ } ++ if (strstr(a[i].name, name)) { ++ /* ++ * the order of these three lines is important for the ++ * lockless read above. ++ */ ++ a[i].key = key; ++ spin_unlock(&spin); ++ set++; ++ /* AuDbg("%d, %s\n", set, name); */ ++ goto match; ++ } ++ } ++ spin_unlock(&spin); ++ goto unmatch; ++ ++match: ++ return 1; ++unmatch: ++ return 0; ++} ++ ++static int au_wkq_lockdep_alloc(struct au_wkinfo *wkinfo) ++{ ++ int err, n; ++ struct task_struct *curr; ++ struct held_lock **hl, *held_locks, *p; ++ ++ err = 0; ++ curr = current; ++ wkinfo->dont_check = lockdep_recursing(curr); ++ if (wkinfo->dont_check) ++ goto out; ++ n = curr->lockdep_depth; ++ if (!n) ++ goto out; ++ ++ err = -ENOMEM; ++ wkinfo->hlock = kmalloc_array(n + 1, sizeof(*wkinfo->hlock), GFP_NOFS); ++ if (unlikely(!wkinfo->hlock)) ++ goto out; ++ ++ err = 0; ++#if 0 ++ if (0 && au_debug_test()) /* left for debugging */ ++ lockdep_print_held_locks(curr); ++#endif ++ held_locks = curr->held_locks; ++ hl = wkinfo->hlock; ++ while (n--) { ++ p = held_locks++; ++ if (au_wkq_lockdep_test(p->instance->key, p->instance->name)) ++ *hl++ = p; ++ } ++ *hl = NULL; ++ ++out: ++ return err; ++} ++ ++static void au_wkq_lockdep_free(struct au_wkinfo *wkinfo) ++{ ++ kfree(wkinfo->hlock); ++} ++ ++static void au_wkq_lockdep_pre(struct au_wkinfo *wkinfo) ++{ ++ struct held_lock *p, **hl = wkinfo->hlock; ++ int subclass; ++ ++ if (wkinfo->dont_check) ++ lockdep_off(); ++ if (!hl) ++ return; ++ while ((p = *hl++)) { /* assignment */ ++ subclass = lockdep_hlock_class(p)->subclass; ++ /* AuDbg("%s, %d\n", p->instance->name, subclass); */ ++ if (p->read) ++ rwsem_acquire_read(p->instance, subclass, 0, ++ /*p->acquire_ip*/_RET_IP_); ++ else ++ rwsem_acquire(p->instance, subclass, 0, ++ /*p->acquire_ip*/_RET_IP_); ++ } ++} ++ ++static void au_wkq_lockdep_post(struct au_wkinfo *wkinfo) ++{ ++ struct held_lock *p, **hl = wkinfo->hlock; ++ ++ if (wkinfo->dont_check) ++ lockdep_on(); ++ if (!hl) ++ return; ++ while ((p = *hl++)) /* assignment */ ++ rwsem_release(p->instance, 0, /*p->acquire_ip*/_RET_IP_); ++} ++#endif + +static void wkq_func(struct work_struct *wk) +{ @@ -32079,13 +33984,15 @@ index 0000000..216d08f + AuDebugOn(!uid_eq(current_fsuid(), GLOBAL_ROOT_UID)); + AuDebugOn(rlimit(RLIMIT_FSIZE) != RLIM_INFINITY); + ++ au_wkq_lockdep_pre(wkinfo); + wkinfo->func(wkinfo->args); ++ au_wkq_lockdep_post(wkinfo); + if (au_ftest_wkq(wkinfo->flags, WAIT)) + complete(wkinfo->comp); + else { + kobject_put(wkinfo->kobj); + module_put(THIS_MODULE); /* todo: ?? */ -+ au_delayed_kfree(wkinfo); ++ kfree(wkinfo); + } +} + @@ -32108,7 +34015,7 @@ index 0000000..216d08f + +static void au_wkq_comp_free(struct completion *comp) +{ -+ au_delayed_kfree(comp); ++ kfree(comp); +} + +#else @@ -32167,16 +34074,23 @@ index 0000000..216d08f + }; + + err = au_wkq_comp_alloc(&wkinfo, &comp); ++ if (unlikely(err)) ++ goto out; ++ err = au_wkq_lockdep_alloc(&wkinfo); ++ if (unlikely(err)) ++ goto out_comp; + if (!err) { + au_wkq_run(&wkinfo); + /* no timeout, no interrupt */ + wait_for_completion(wkinfo.comp); -+ au_wkq_comp_free(comp); -+ destroy_work_on_stack(&wkinfo.wk); + } ++ au_wkq_lockdep_free(&wkinfo); + ++out_comp: ++ au_wkq_comp_free(comp); ++out: ++ destroy_work_on_stack(&wkinfo.wk); + return err; -+ +} + +/* @@ -32203,6 +34117,7 @@ index 0000000..216d08f + wkinfo->func = func; + wkinfo->args = args; + wkinfo->comp = NULL; ++ au_wkq_lockdep_init(wkinfo); + kobject_get(wkinfo->kobj); + __module_get(THIS_MODULE); /* todo: ?? */ + @@ -32244,12 +34159,13 @@ index 0000000..216d08f +} diff --git a/fs/aufs/wkq.h b/fs/aufs/wkq.h new file mode 100644 -index 0000000..6d63f74 +index 000000000000..43150d025ac3 --- /dev/null +++ b/fs/aufs/wkq.h -@@ -0,0 +1,80 @@ +@@ -0,0 +1,81 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -32262,7 +34178,7 @@ index 0000000..6d63f74 + +#ifdef __KERNEL__ + -+#include ++#include + +struct super_block; + @@ -32330,18 +34246,21 @@ index 0000000..6d63f74 +#endif /* __AUFS_WKQ_H__ */ diff --git a/fs/aufs/xattr.c b/fs/aufs/xattr.c new file mode 100644 -index 0000000..1daba20 +index 000000000000..dbe452868cd5 --- /dev/null +++ b/fs/aufs/xattr.c -@@ -0,0 +1,319 @@ +@@ -0,0 +1,343 @@ +/* -+ * Copyright (C) 2014-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2014-2017 Junjiro R. Okajima + */ + +/* + * handling xattr functions + */ + ++#include ++#include +#include +#include "aufs.h" + @@ -32437,7 +34356,7 @@ index 0000000..1daba20 + h_isrc = d_inode(h_src); + h_idst = d_inode(h_dst); + inode_unlock(h_idst); -+ inode_lock_nested(h_isrc, AuLsc_I_CHILD); ++ vfsub_inode_lock_shared_nested(h_isrc, AuLsc_I_CHILD); + inode_lock_nested(h_idst, AuLsc_I_CHILD2); + unlocked = 0; + @@ -32463,7 +34382,7 @@ index 0000000..1daba20 + goto out; + err = vfs_listxattr(h_src, p, ssz); + } -+ inode_unlock(h_isrc); ++ inode_unlock_shared(h_isrc); + unlocked = 1; + AuDbg("err %d, ssz %zd\n", err, ssz); + if (unlikely(err < 0)) @@ -32499,21 +34418,32 @@ index 0000000..1daba20 + AuTraceErr(err); + } + -+ if (value) -+ au_delayed_kfree(value); ++ kfree(value); + +out_free: -+ if (o) -+ au_delayed_kfree(o); ++ kfree(o); +out: + if (!unlocked) -+ inode_unlock(h_isrc); ++ inode_unlock_shared(h_isrc); + AuTraceErr(err); + return err; +} + +/* ---------------------------------------------------------------------- */ + ++static int au_smack_reentering(struct super_block *sb) ++{ ++#if IS_ENABLED(CONFIG_SECURITY_SMACK) ++ /* ++ * as a part of lookup, smack_d_instantiate() is called, and it calls ++ * i_op->getxattr(). ouch. ++ */ ++ return si_pid_test(sb); ++#else ++ return 0; ++#endif ++} ++ +enum { + AU_XATTR_LIST, + AU_XATTR_GET @@ -32537,14 +34467,18 @@ index 0000000..1daba20 +static ssize_t au_lgxattr(struct dentry *dentry, struct au_lgxattr *arg) +{ + ssize_t err; ++ int reenter; + struct path h_path; + struct super_block *sb; + + sb = dentry->d_sb; -+ err = si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLM); -+ if (unlikely(err)) -+ goto out; -+ err = au_h_path_getattr(dentry, /*force*/1, &h_path); ++ reenter = au_smack_reentering(sb); ++ if (!reenter) { ++ err = si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLM); ++ if (unlikely(err)) ++ goto out; ++ } ++ err = au_h_path_getattr(dentry, /*force*/1, &h_path, reenter); + if (unlikely(err)) + goto out_si; + if (unlikely(!h_path.dentry)) @@ -32566,9 +34500,11 @@ index 0000000..1daba20 + } + +out_di: -+ di_read_unlock(dentry, AuLock_IR); ++ if (!reenter) ++ di_read_unlock(dentry, AuLock_IR); +out_si: -+ si_read_unlock(sb); ++ if (!reenter) ++ si_read_unlock(sb); +out: + AuTraceErr(err); + return err; @@ -32645,7 +34581,11 @@ index 0000000..1daba20 +}; + +static const struct xattr_handler *au_xattr_handlers[] = { -+ &au_xattr_handler, ++#ifdef CONFIG_FS_POSIX_ACL ++ &posix_acl_access_xattr_handler, ++ &posix_acl_default_xattr_handler, ++#endif ++ &au_xattr_handler, /* must be last */ + NULL +}; + @@ -32655,12 +34595,13 @@ index 0000000..1daba20 +} diff --git a/fs/aufs/xino.c b/fs/aufs/xino.c new file mode 100644 -index 0000000..2a411f9 +index 000000000000..74aecb7193ab --- /dev/null +++ b/fs/aufs/xino.c -@@ -0,0 +1,1305 @@ +@@ -0,0 +1,1406 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +/* @@ -32792,8 +34733,11 @@ index 0000000..2a411f9 + lockdep_off(); + err = do_xino_fwrite(func, file, buf, size, pos); + lockdep_on(); -+ } else ++ } else { ++ lockdep_off(); + err = xino_fwrite_wkq(func, file, buf, size, pos); ++ lockdep_on(); ++ } + + return err; +} @@ -32986,7 +34930,7 @@ index 0000000..2a411f9 + AuErr1("statfs err %d, ignored\n", err); + +out_st: -+ au_delayed_kfree(st); ++ kfree(st); +out: + return err; +} @@ -33021,7 +34965,7 @@ index 0000000..2a411f9 + au_br_put(br); + si_write_unlock(sb); + au_nwt_done(&au_sbi(sb)->si_nowait); -+ au_delayed_kfree(args); ++ kfree(args); +} + +static int xino_trunc_test(struct super_block *sb, struct au_branch *br) @@ -33075,7 +35019,7 @@ index 0000000..2a411f9 + + pr_err("wkq %d\n", wkq_err); + au_br_put(br); -+ au_delayed_kfree(args); ++ kfree(args); + +out: + atomic_dec(&br->br_xino_running); @@ -33599,7 +35543,7 @@ index 0000000..2a411f9 + (sb, au_sbr(sb, bindex)->br_xino.xi_file, page); + else + AuDbg("b%d\n", bindex); -+ au_delayed_free_page((unsigned long)page); ++ free_page((unsigned long)page); + +out: + return err; @@ -33677,7 +35621,7 @@ index 0000000..2a411f9 + fput(sbinfo->si_xib); + sbinfo->si_xib = NULL; + if (sbinfo->si_xib_buf) -+ au_delayed_free_page((unsigned long)sbinfo->si_xib_buf); ++ free_page((unsigned long)sbinfo->si_xib_buf); + sbinfo->si_xib_buf = NULL; +} + @@ -33721,7 +35665,7 @@ index 0000000..2a411f9 + +out_free: + if (sbinfo->si_xib_buf) -+ au_delayed_free_page((unsigned long)sbinfo->si_xib_buf); ++ free_page((unsigned long)sbinfo->si_xib_buf); + sbinfo->si_xib_buf = NULL; + if (err >= 0) + err = -EIO; @@ -33814,7 +35758,7 @@ index 0000000..2a411f9 + fput(p->new); + else + break; -+ au_delayed_kfree(fpair); ++ kfree(fpair); +out: + return err; +} @@ -33925,7 +35869,7 @@ index 0000000..2a411f9 + if (!IS_ERR(file)) + au_xino_brid_set(sb, br->br_id); + } -+ au_delayed_free_page((unsigned long)page); ++ free_page((unsigned long)page); + } else { + file = au_xino_create(sb, AUFS_XINO_DEFPATH, /*silent*/0); + if (IS_ERR(file)) @@ -33964,11 +35908,108 @@ index 0000000..2a411f9 +out: + return err; +} ++ ++/* ---------------------------------------------------------------------- */ ++ ++void au_xinondir_leave(struct super_block *sb, aufs_bindex_t bindex, ++ ino_t h_ino, int idx) ++{ ++ struct au_xino_file *xino; ++ ++ AuDebugOn(!au_opt_test(au_mntflags(sb), XINO)); ++ xino = &au_sbr(sb, bindex)->br_xino; ++ AuDebugOn(idx < 0 || xino->xi_nondir.total <= idx); ++ ++ spin_lock(&xino->xi_nondir.spin); ++ AuDebugOn(xino->xi_nondir.array[idx] != h_ino); ++ xino->xi_nondir.array[idx] = 0; ++ spin_unlock(&xino->xi_nondir.spin); ++ wake_up_all(&xino->xi_nondir.wqh); ++} ++ ++static int au_xinondir_find(struct au_xino_file *xino, ino_t h_ino) ++{ ++ int found, total, i; ++ ++ found = -1; ++ total = xino->xi_nondir.total; ++ for (i = 0; i < total; i++) { ++ if (xino->xi_nondir.array[i] != h_ino) ++ continue; ++ found = i; ++ break; ++ } ++ ++ return found; ++} ++ ++static int au_xinondir_expand(struct au_xino_file *xino) ++{ ++ int err, sz; ++ ino_t *p; ++ ++ BUILD_BUG_ON(KMALLOC_MAX_SIZE > INT_MAX); ++ ++ err = -ENOMEM; ++ sz = xino->xi_nondir.total * sizeof(ino_t); ++ if (unlikely(sz > KMALLOC_MAX_SIZE / 2)) ++ goto out; ++ p = au_kzrealloc(xino->xi_nondir.array, sz, sz << 1, GFP_ATOMIC, ++ /*may_shrink*/0); ++ if (p) { ++ xino->xi_nondir.array = p; ++ xino->xi_nondir.total <<= 1; ++ AuDbg("xi_nondir.total %d\n", xino->xi_nondir.total); ++ err = 0; ++ } ++ ++out: ++ return err; ++} ++ ++int au_xinondir_enter(struct super_block *sb, aufs_bindex_t bindex, ino_t h_ino, ++ int *idx) ++{ ++ int err, found, empty; ++ struct au_xino_file *xino; ++ ++ err = 0; ++ *idx = -1; ++ if (!au_opt_test(au_mntflags(sb), XINO)) ++ goto out; /* no xino */ ++ ++ xino = &au_sbr(sb, bindex)->br_xino; ++ ++again: ++ spin_lock(&xino->xi_nondir.spin); ++ found = au_xinondir_find(xino, h_ino); ++ if (found == -1) { ++ empty = au_xinondir_find(xino, /*h_ino*/0); ++ if (empty == -1) { ++ empty = xino->xi_nondir.total; ++ err = au_xinondir_expand(xino); ++ if (unlikely(err)) ++ goto out_unlock; ++ } ++ xino->xi_nondir.array[empty] = h_ino; ++ *idx = empty; ++ } else { ++ spin_unlock(&xino->xi_nondir.spin); ++ wait_event(xino->xi_nondir.wqh, ++ xino->xi_nondir.array[found] != h_ino); ++ goto again; ++ } ++ ++out_unlock: ++ spin_unlock(&xino->xi_nondir.spin); ++out: ++ return err; ++} diff --git a/fs/dcache.c b/fs/dcache.c -index 5c7cc95..df0268c 100644 +index f90141387f01..e3719a5e45d9 100644 --- a/fs/dcache.c +++ b/fs/dcache.c -@@ -1164,7 +1164,7 @@ enum d_walk_ret { +@@ -1197,7 +1197,7 @@ enum d_walk_ret { * * The @enter() and @finish() callbacks are called with d_lock held. */ @@ -33978,10 +36019,10 @@ index 5c7cc95..df0268c 100644 void (*finish)(void *)) { diff --git a/fs/fcntl.c b/fs/fcntl.c -index 350a2c8..6f42279 100644 +index 8d78ffd7b399..cffefab04504 100644 --- a/fs/fcntl.c +++ b/fs/fcntl.c -@@ -29,7 +29,7 @@ +@@ -32,7 +32,7 @@ #define SETFL_MASK (O_APPEND | O_NONBLOCK | O_NDELAY | O_DIRECT | O_NOATIME) @@ -33990,7 +36031,7 @@ index 350a2c8..6f42279 100644 { struct inode * inode = file_inode(filp); int error = 0; -@@ -60,6 +60,8 @@ static int setfl(int fd, struct file * filp, unsigned long arg) +@@ -63,6 +63,8 @@ static int setfl(int fd, struct file * filp, unsigned long arg) if (filp->f_op->check_flags) error = filp->f_op->check_flags(arg); @@ -34000,10 +36041,10 @@ index 350a2c8..6f42279 100644 return error; diff --git a/fs/inode.c b/fs/inode.c -index 88110fd..9a9ba3a 100644 +index d1e35b53bb23..f7800d6fd1a0 100644 --- a/fs/inode.c +++ b/fs/inode.c -@@ -1642,7 +1642,7 @@ EXPORT_SYMBOL(generic_update_time); +@@ -1655,7 +1655,7 @@ EXPORT_SYMBOL(generic_update_time); * This does the actual work of updating an inodes time or version. Must have * had called mnt_want_write() before calling this. */ @@ -34012,11 +36053,28 @@ index 88110fd..9a9ba3a 100644 { int (*update_time)(struct inode *, struct timespec *, int); +diff --git a/fs/namespace.c b/fs/namespace.c +index d18deb4c410b..e5a4a7f8a249 100644 +--- a/fs/namespace.c ++++ b/fs/namespace.c +@@ -846,6 +846,12 @@ static inline int check_mnt(struct mount *mnt) + return mnt->mnt_ns == current->nsproxy->mnt_ns; + } + ++/* for aufs, CONFIG_AUFS_BR_FUSE */ ++int is_current_mnt_ns(struct vfsmount *mnt) ++{ ++ return check_mnt(real_mount(mnt)); ++} ++ + /* + * vfsmount lock must be held for write + */ diff --git a/fs/proc/base.c b/fs/proc/base.c -index ca651ac..0e8551a 100644 +index 9d357b2ea6cb..11f4f23b803e 100644 --- a/fs/proc/base.c +++ b/fs/proc/base.c -@@ -1953,7 +1953,7 @@ static int map_files_get_link(struct dentry *dentry, struct path *path) +@@ -1988,7 +1988,7 @@ static int map_files_get_link(struct dentry *dentry, struct path *path) down_read(&mm->mmap_sem); vma = find_exact_vma(mm, vm_start, vm_end); if (vma && vma->vm_file) { @@ -34026,7 +36084,7 @@ index ca651ac..0e8551a 100644 rc = 0; } diff --git a/fs/proc/nommu.c b/fs/proc/nommu.c -index f8595e8..cb8eda0 100644 +index 75634379f82e..7c0dc0ff4882 100644 --- a/fs/proc/nommu.c +++ b/fs/proc/nommu.c @@ -45,7 +45,10 @@ static int nommu_region_show(struct seq_file *m, struct vm_region *region) @@ -34042,10 +36100,10 @@ index f8595e8..cb8eda0 100644 ino = inode->i_ino; } diff --git a/fs/proc/task_mmu.c b/fs/proc/task_mmu.c -index 35b92d8..5b981db 100644 +index 6744bd706ecf..6d4dea31b008 100644 --- a/fs/proc/task_mmu.c +++ b/fs/proc/task_mmu.c -@@ -291,7 +291,10 @@ show_map_vma(struct seq_file *m, struct vm_area_struct *vma, int is_pid) +@@ -310,7 +310,10 @@ show_map_vma(struct seq_file *m, struct vm_area_struct *vma, int is_pid) const char *name = NULL; if (file) { @@ -34057,7 +36115,7 @@ index 35b92d8..5b981db 100644 dev = inode->i_sb->s_dev; ino = inode->i_ino; pgoff = ((loff_t)vma->vm_pgoff) << PAGE_SHIFT; -@@ -1627,7 +1630,7 @@ static int show_numa_map(struct seq_file *m, void *v, int is_pid) +@@ -1739,7 +1742,7 @@ static int show_numa_map(struct seq_file *m, void *v, int is_pid) struct proc_maps_private *proc_priv = &numa_priv->proc_maps; struct vm_area_struct *vma = v; struct numa_maps *md = &numa_priv->md; @@ -34067,10 +36125,10 @@ index 35b92d8..5b981db 100644 struct mm_walk walk = { .hugetlb_entry = gather_hugetlb_stats, diff --git a/fs/proc/task_nommu.c b/fs/proc/task_nommu.c -index 3717562..6a328f1 100644 +index 5b62f57bd9bc..dfb4a3bd0fac 100644 --- a/fs/proc/task_nommu.c +++ b/fs/proc/task_nommu.c -@@ -155,7 +155,10 @@ static int nommu_vma_show(struct seq_file *m, struct vm_area_struct *vma, +@@ -156,7 +156,10 @@ static int nommu_vma_show(struct seq_file *m, struct vm_area_struct *vma, file = vma->vm_file; if (file) { @@ -34083,12 +36141,12 @@ index 3717562..6a328f1 100644 ino = inode->i_ino; pgoff = (loff_t)vma->vm_pgoff << PAGE_SHIFT; diff --git a/fs/read_write.c b/fs/read_write.c -index 190e0d36..4052813 100644 +index 0046d72efe94..2388284447cf 100644 --- a/fs/read_write.c +++ b/fs/read_write.c -@@ -515,6 +515,28 @@ ssize_t __vfs_write(struct file *file, const char __user *p, size_t count, +@@ -484,6 +484,28 @@ ssize_t __vfs_write(struct file *file, const char __user *p, size_t count, + return -EINVAL; } - EXPORT_SYMBOL(__vfs_write); +vfs_readf_t vfs_readf(struct file *file) +{ @@ -34112,14 +36170,14 @@ index 190e0d36..4052813 100644 + return ERR_PTR(-ENOSYS); +} + - ssize_t __kernel_write(struct file *file, const char *buf, size_t count, loff_t *pos) + ssize_t __kernel_write(struct file *file, const void *buf, size_t count, loff_t *pos) { mm_segment_t old_fs; diff --git a/fs/splice.c b/fs/splice.c -index 5a7750b..28160a7 100644 +index f3084cce0ea6..eb888c670aec 100644 --- a/fs/splice.c +++ b/fs/splice.c -@@ -855,8 +855,8 @@ EXPORT_SYMBOL(generic_splice_sendpage); +@@ -837,8 +837,8 @@ EXPORT_SYMBOL(generic_splice_sendpage); /* * Attempt to initiate a splice from pipe to file. */ @@ -34130,7 +36188,7 @@ index 5a7750b..28160a7 100644 { ssize_t (*splice_write)(struct pipe_inode_info *, struct file *, loff_t *, size_t, unsigned int); -@@ -872,9 +872,9 @@ static long do_splice_from(struct pipe_inode_info *pipe, struct file *out, +@@ -854,9 +854,9 @@ static long do_splice_from(struct pipe_inode_info *pipe, struct file *out, /* * Attempt to initiate a splice from a file to a pipe. */ @@ -34143,31 +36201,44 @@ index 5a7750b..28160a7 100644 { ssize_t (*splice_read)(struct file *, loff_t *, struct pipe_inode_info *, size_t, unsigned int); +diff --git a/fs/sync.c b/fs/sync.c +index 83ac79a960dd..fe15900ed873 100644 +--- a/fs/sync.c ++++ b/fs/sync.c +@@ -28,7 +28,7 @@ + * wait == 1 case since in that case write_inode() functions do + * sync_dirty_buffer() and thus effectively write one block at a time. + */ +-static int __sync_filesystem(struct super_block *sb, int wait) ++int __sync_filesystem(struct super_block *sb, int wait) + { + if (wait) + sync_inodes_sb(sb); diff --git a/include/linux/file.h b/include/linux/file.h -index 7444f5f..bdac0be 100644 +index 279720db984a..76e38eade225 100644 --- a/include/linux/file.h +++ b/include/linux/file.h -@@ -19,6 +19,7 @@ struct dentry; +@@ -20,6 +20,7 @@ struct dentry; struct path; - extern struct file *alloc_file(struct path *, fmode_t mode, + extern struct file *alloc_file(const struct path *, fmode_t mode, const struct file_operations *fop); +extern struct file *get_empty_filp(void); static inline void fput_light(struct file *file, int fput_needed) { diff --git a/include/linux/fs.h b/include/linux/fs.h -index dc0478c..27c05e7 100644 +index 885266aae2d7..e489e42d1a6d 100644 --- a/include/linux/fs.h +++ b/include/linux/fs.h -@@ -1291,6 +1291,7 @@ extern void fasync_free(struct fasync_struct *); +@@ -1265,6 +1265,7 @@ extern void fasync_free(struct fasync_struct *); /* can be called from interrupts */ extern void kill_fasync(struct fasync_struct **, int, int); +extern int setfl(int fd, struct file * filp, unsigned long arg); extern void __f_setown(struct file *filp, struct pid *, enum pid_type, int force); - extern void f_setown(struct file *filp, unsigned long arg, int force); + extern int f_setown(struct file *filp, unsigned long arg, int force); extern void f_delown(struct file *filp); -@@ -1715,6 +1716,7 @@ struct file_operations { +@@ -1711,6 +1712,7 @@ struct file_operations { ssize_t (*sendpage) (struct file *, struct page *, int, size_t, loff_t *, int); unsigned long (*get_unmapped_area)(struct file *, unsigned long, unsigned long, unsigned long, unsigned long); int (*check_flags)(int); @@ -34175,7 +36246,7 @@ index dc0478c..27c05e7 100644 int (*flock) (struct file *, int, struct file_lock *); ssize_t (*splice_write)(struct pipe_inode_info *, struct file *, loff_t *, size_t, unsigned int); ssize_t (*splice_read)(struct file *, loff_t *, struct pipe_inode_info *, size_t, unsigned int); -@@ -1768,6 +1770,12 @@ ssize_t rw_copy_check_uvector(int type, const struct iovec __user * uvector, +@@ -1781,6 +1783,12 @@ ssize_t rw_copy_check_uvector(int type, const struct iovec __user * uvector, struct iovec *fast_pointer, struct iovec **ret_pointer); @@ -34186,9 +36257,9 @@ index dc0478c..27c05e7 100644 +vfs_writef_t vfs_writef(struct file *file); + extern ssize_t __vfs_read(struct file *, char __user *, size_t, loff_t *); - extern ssize_t __vfs_write(struct file *, const char __user *, size_t, loff_t *); extern ssize_t vfs_read(struct file *, char __user *, size_t, loff_t *); -@@ -2140,6 +2148,7 @@ extern int current_umask(void); + extern ssize_t vfs_write(struct file *, const char __user *, size_t, loff_t *); +@@ -2183,6 +2191,7 @@ extern int current_umask(void); extern void ihold(struct inode * inode); extern void iput(struct inode *); extern int generic_update_time(struct inode *, struct timespec *, int); @@ -34196,11 +36267,40 @@ index dc0478c..27c05e7 100644 /* /sys/fs */ extern struct kobject *fs_kobj; +@@ -2463,6 +2472,7 @@ static inline bool sb_is_blkdev_sb(struct super_block *sb) + return false; + } + #endif ++extern int __sync_filesystem(struct super_block *, int); + extern int sync_filesystem(struct super_block *); + extern const struct file_operations def_blk_fops; + extern const struct file_operations def_chr_fops; +diff --git a/include/linux/lockdep.h b/include/linux/lockdep.h +index f301d31b473c..c26f5b420464 100644 +--- a/include/linux/lockdep.h ++++ b/include/linux/lockdep.h +@@ -406,6 +406,8 @@ static inline int lockdep_match_key(struct lockdep_map *lock, + return lock->key == key; + } + ++struct lock_class *lockdep_hlock_class(struct held_lock *hlock); ++ + /* + * Acquire a lock. + * +@@ -530,6 +532,7 @@ struct lock_class_key { }; + + #define lockdep_depth(tsk) (0) + ++#define lockdep_is_held(lock) (1) + #define lockdep_is_held_type(l, r) (1) + + #define lockdep_assert_held(l) do { (void)(l); } while (0) diff --git a/include/linux/mm.h b/include/linux/mm.h -index a92c8d7..1d83a2a 100644 +index 43edf659453b..3f9acd93ae28 100644 --- a/include/linux/mm.h +++ b/include/linux/mm.h -@@ -1266,6 +1266,28 @@ static inline int fixup_user_fault(struct task_struct *tsk, +@@ -1349,6 +1349,28 @@ static inline int fixup_user_fault(struct task_struct *tsk, } #endif @@ -34230,10 +36330,10 @@ index a92c8d7..1d83a2a 100644 unsigned int gup_flags); extern int access_remote_vm(struct mm_struct *mm, unsigned long addr, diff --git a/include/linux/mm_types.h b/include/linux/mm_types.h -index 4a8aced..badd16b 100644 +index c85f11dafd56..a63875a76849 100644 --- a/include/linux/mm_types.h +++ b/include/linux/mm_types.h -@@ -275,6 +275,7 @@ struct vm_region { +@@ -261,6 +261,7 @@ struct vm_region { unsigned long vm_top; /* region allocated to here */ unsigned long vm_pgoff; /* the offset in vm_file corresponding to vm_start */ struct file *vm_file; /* the backing file or NULL */ @@ -34241,19 +36341,38 @@ index 4a8aced..badd16b 100644 int vm_usage; /* region usage count (access under nommu_region_sem) */ bool vm_icache_flushed : 1; /* true if the icache has been flushed for -@@ -349,6 +350,7 @@ struct vm_area_struct { +@@ -335,6 +336,7 @@ struct vm_area_struct { unsigned long vm_pgoff; /* Offset (within vm_file) in PAGE_SIZE units */ struct file * vm_file; /* File we map to (can be NULL). */ + struct file *vm_prfile; /* shadow of vm_file */ void * vm_private_data; /* was vm_pte (shared mem) */ - #ifndef CONFIG_MMU + atomic_long_t swap_readahead_info; +diff --git a/include/linux/mnt_namespace.h b/include/linux/mnt_namespace.h +index 35942084cd40..24f5fd1a789d 100644 +--- a/include/linux/mnt_namespace.h ++++ b/include/linux/mnt_namespace.h +@@ -6,11 +6,14 @@ + struct mnt_namespace; + struct fs_struct; + struct user_namespace; ++struct vfsmount; + + extern struct mnt_namespace *copy_mnt_ns(unsigned long, struct mnt_namespace *, + struct user_namespace *, struct fs_struct *); + extern void put_mnt_ns(struct mnt_namespace *ns); + ++extern int is_current_mnt_ns(struct vfsmount *mnt); ++ + extern const struct file_operations proc_mounts_operations; + extern const struct file_operations proc_mountinfo_operations; + extern const struct file_operations proc_mountstats_operations; diff --git a/include/linux/splice.h b/include/linux/splice.h -index 00a2116..1f0a4a2 100644 +index 74b4911ac16d..19789fbea567 100644 --- a/include/linux/splice.h +++ b/include/linux/splice.h -@@ -86,4 +86,10 @@ extern void spd_release_page(struct splice_pipe_desc *, unsigned int); +@@ -87,4 +87,10 @@ extern void splice_shrink_spd(struct splice_pipe_desc *); extern const struct pipe_buf_operations page_cache_pipe_buf_ops; extern const struct pipe_buf_operations default_pipe_buf_ops; @@ -34264,26 +36383,15 @@ index 00a2116..1f0a4a2 100644 + struct pipe_inode_info *pipe, size_t len, + unsigned int flags); #endif -diff --git a/include/uapi/linux/Kbuild b/include/uapi/linux/Kbuild -index cd2be1c..78f3c68 100644 ---- a/include/uapi/linux/Kbuild -+++ b/include/uapi/linux/Kbuild -@@ -59,6 +59,7 @@ header-y += atmsvc.h - header-y += atm_tcp.h - header-y += atm_zatm.h - header-y += audit.h -+header-y += aufs_type.h - header-y += auto_fs4.h - header-y += auto_fs.h - header-y += auxvec.h diff --git a/include/uapi/linux/aufs_type.h b/include/uapi/linux/aufs_type.h new file mode 100644 -index 0000000..b036c0a +index 000000000000..95702c1e61e5 --- /dev/null +++ b/include/uapi/linux/aufs_type.h -@@ -0,0 +1,406 @@ +@@ -0,0 +1,435 @@ +/* -+ * Copyright (C) 2005-2016 Junjiro R. Okajima ++ * SPDX-License-Identifier: GPL-2.0 ++ * Copyright (C) 2005-2017 Junjiro R. Okajima + */ + +#ifndef __AUFS_TYPE_H__ @@ -34310,7 +36418,7 @@ index 0000000..b036c0a + +#include + -+#define AUFS_VERSION "4.9" ++#define AUFS_VERSION "4.14" + +/* todo? move this to linux-2.6.19/include/magic.h */ +#define AUFS_SUPER_MAGIC ('a' << 24 | 'u' << 16 | 'f' << 8 | 's') @@ -34372,6 +36480,13 @@ index 0000000..b036c0a +#define AUFS_PLINK_MAINT_DIR "fs/" AUFS_NAME +#define AUFS_PLINK_MAINT_PATH AUFS_PLINK_MAINT_DIR "/" AUFS_PLINK_MAINT_NAME + ++/* dirren, renamed dir */ ++#define AUFS_DR_INFO_PFX AUFS_WH_PFX ".dr." ++#define AUFS_DR_BRHINO_NAME AUFS_WH_PFX "hino" ++/* whiteouted doubly */ ++#define AUFS_WH_DR_INFO_PFX AUFS_WH_PFX AUFS_DR_INFO_PFX ++#define AUFS_WH_DR_BRHINO AUFS_WH_PFX AUFS_DR_BRHINO_NAME ++ +#define AUFS_DIROPQ_NAME AUFS_WH_PFX ".opq" /* whiteouted doubly */ +#define AUFS_WH_DIROPQ AUFS_WH_PFX AUFS_DIROPQ_NAME + @@ -34590,6 +36705,27 @@ index 0000000..b036c0a + +/* ---------------------------------------------------------------------- */ + ++/* dirren. the branch is identified by the filename who contains this */ ++struct au_drinfo { ++ uint64_t ino; ++ union { ++ uint8_t oldnamelen; ++ uint64_t _padding; ++ }; ++ uint8_t oldname[0]; ++} __aligned(8); ++ ++struct au_drinfo_fdata { ++ uint32_t magic; ++ struct au_drinfo drinfo; ++} __aligned(8); ++ ++#define AUFS_DRINFO_MAGIC_V1 ('a' << 24 | 'd' << 16 | 'r' << 8 | 0x01) ++/* future */ ++#define AUFS_DRINFO_MAGIC_V2 ('a' << 24 | 'd' << 16 | 'r' << 8 | 0x02) ++ ++/* ---------------------------------------------------------------------- */ ++ +struct aufs_wbr_fd { + uint32_t oflags; + int16_t brid; @@ -34689,10 +36825,10 @@ index 0000000..b036c0a + +#endif /* __AUFS_TYPE_H__ */ diff --git a/kernel/fork.c b/kernel/fork.c -index 997ac1d..4d0131b 100644 +index 07cc743698d3..b1d2b4381ab7 100644 --- a/kernel/fork.c +++ b/kernel/fork.c -@@ -624,7 +624,7 @@ static __latent_entropy int dup_mmap(struct mm_struct *mm, +@@ -676,7 +676,7 @@ static __latent_entropy int dup_mmap(struct mm_struct *mm, struct inode *inode = file_inode(file); struct address_space *mapping = file->f_mapping; @@ -34701,13 +36837,34 @@ index 997ac1d..4d0131b 100644 if (tmp->vm_flags & VM_DENYWRITE) atomic_dec(&inode->i_writecount); i_mmap_lock_write(mapping); +diff --git a/kernel/locking/lockdep.c b/kernel/locking/lockdep.c +index e36e652d996f..bc97a9799ba1 100644 +--- a/kernel/locking/lockdep.c ++++ b/kernel/locking/lockdep.c +@@ -144,7 +144,7 @@ static struct lock_list list_entries[MAX_LOCKDEP_ENTRIES]; + unsigned long nr_lock_classes; + static struct lock_class lock_classes[MAX_LOCKDEP_KEYS]; + +-static inline struct lock_class *hlock_class(struct held_lock *hlock) ++inline struct lock_class *lockdep_hlock_class(struct held_lock *hlock) + { + if (!hlock->class_idx) { + /* +@@ -155,6 +155,7 @@ static inline struct lock_class *hlock_class(struct held_lock *hlock) + } + return lock_classes + hlock->class_idx - 1; + } ++#define hlock_class(hlock) lockdep_hlock_class(hlock) + + #ifdef CONFIG_LOCK_STAT + static DEFINE_PER_CPU(struct lock_class_stats[MAX_LOCKDEP_KEYS], cpu_lock_stats); diff --git a/mm/Makefile b/mm/Makefile -index 295bd7a..14fa1c8 100644 +index 4659b93cba43..844888411196 100644 --- a/mm/Makefile +++ b/mm/Makefile -@@ -37,7 +37,7 @@ obj-y := filemap.o mempool.o oom_kill.o \ +@@ -40,7 +40,7 @@ obj-y := filemap.o mempool.o oom_kill.o \ mm_init.o mmu_context.o percpu.o slab_common.o \ - compaction.o vmacache.o \ + compaction.o vmacache.o swap_slots.o \ interval_tree.o list_lru.o workingset.o \ - debug.o $(mmu-y) + prfile.o debug.o $(mmu-y) @@ -34715,36 +36872,23 @@ index 295bd7a..14fa1c8 100644 obj-y += init-mm.o diff --git a/mm/filemap.c b/mm/filemap.c -index 50b52fe..9e607f9 100644 +index 594d73fef8b4..7183aefa1551 100644 --- a/mm/filemap.c +++ b/mm/filemap.c -@@ -2304,7 +2304,7 @@ int filemap_page_mkwrite(struct vm_area_struct *vma, struct vm_fault *vmf) +@@ -2590,7 +2590,7 @@ int filemap_page_mkwrite(struct vm_fault *vmf) int ret = VM_FAULT_LOCKED; sb_start_pagefault(inode->i_sb); -- file_update_time(vma->vm_file); -+ vma_file_update_time(vma); +- file_update_time(vmf->vma->vm_file); ++ vma_file_update_time(vmf->vma); lock_page(page); if (page->mapping != inode->i_mapping) { unlock_page(page); -diff --git a/mm/memory.c b/mm/memory.c -index e18c57b..7be4a39 100644 ---- a/mm/memory.c -+++ b/mm/memory.c -@@ -2117,7 +2117,7 @@ static inline int wp_page_reuse(struct fault_env *fe, pte_t orig_pte, - } - - if (!page_mkwrite) -- file_update_time(vma->vm_file); -+ vma_file_update_time(vma); - } - - return VM_FAULT_WRITE; diff --git a/mm/mmap.c b/mm/mmap.c -index 1af87c1..95b0ff4 100644 +index 680506faceae..081406a0aeec 100644 --- a/mm/mmap.c +++ b/mm/mmap.c -@@ -170,7 +170,7 @@ static struct vm_area_struct *remove_vma(struct vm_area_struct *vma) +@@ -171,7 +171,7 @@ static struct vm_area_struct *remove_vma(struct vm_area_struct *vma) if (vma->vm_ops && vma->vm_ops->close) vma->vm_ops->close(vma); if (vma->vm_file) @@ -34753,7 +36897,7 @@ index 1af87c1..95b0ff4 100644 mpol_put(vma_policy(vma)); kmem_cache_free(vm_area_cachep, vma); return next; -@@ -879,7 +879,7 @@ int __vma_adjust(struct vm_area_struct *vma, unsigned long start, +@@ -896,7 +896,7 @@ int __vma_adjust(struct vm_area_struct *vma, unsigned long start, if (remove_next) { if (file) { uprobe_munmap(next, next->vm_start, next->vm_end); @@ -34762,7 +36906,7 @@ index 1af87c1..95b0ff4 100644 } if (next->anon_vma) anon_vma_merge(vma, next); -@@ -1727,8 +1727,8 @@ unsigned long mmap_region(struct file *file, unsigned long addr, +@@ -1746,8 +1746,8 @@ unsigned long mmap_region(struct file *file, unsigned long addr, return addr; unmap_and_free_vma: @@ -34772,7 +36916,7 @@ index 1af87c1..95b0ff4 100644 /* Undo any partial mapping done by a device driver. */ unmap_region(mm, vma, prev, vma->vm_start, vma->vm_end); -@@ -2533,7 +2533,7 @@ static int __split_vma(struct mm_struct *mm, struct vm_area_struct *vma, +@@ -2569,7 +2569,7 @@ int __split_vma(struct mm_struct *mm, struct vm_area_struct *vma, goto out_free_mpol; if (new->vm_file) @@ -34781,7 +36925,7 @@ index 1af87c1..95b0ff4 100644 if (new->vm_ops && new->vm_ops->open) new->vm_ops->open(new); -@@ -2552,7 +2552,7 @@ static int __split_vma(struct mm_struct *mm, struct vm_area_struct *vma, +@@ -2588,7 +2588,7 @@ int __split_vma(struct mm_struct *mm, struct vm_area_struct *vma, if (new->vm_ops && new->vm_ops->close) new->vm_ops->close(new); if (new->vm_file) @@ -34790,7 +36934,7 @@ index 1af87c1..95b0ff4 100644 unlink_anon_vmas(new); out_free_mpol: mpol_put(vma_policy(new)); -@@ -2703,7 +2703,7 @@ SYSCALL_DEFINE5(remap_file_pages, unsigned long, start, unsigned long, size, +@@ -2750,7 +2750,7 @@ SYSCALL_DEFINE5(remap_file_pages, unsigned long, start, unsigned long, size, struct vm_area_struct *vma; unsigned long populate = 0; unsigned long ret = -EINVAL; @@ -34799,7 +36943,7 @@ index 1af87c1..95b0ff4 100644 pr_warn_once("%s (%d) uses deprecated remap_file_pages() syscall. See Documentation/vm/remap_file_pages.txt.\n", current->comm, current->pid); -@@ -2778,10 +2778,27 @@ SYSCALL_DEFINE5(remap_file_pages, unsigned long, start, unsigned long, size, +@@ -2825,10 +2825,27 @@ SYSCALL_DEFINE5(remap_file_pages, unsigned long, start, unsigned long, size, } } @@ -34808,7 +36952,7 @@ index 1af87c1..95b0ff4 100644 + file = vma->vm_file; + prfile = vma->vm_prfile; ret = do_mmap_pgoff(vma->vm_file, start, size, - prot, flags, pgoff, &populate); + prot, flags, pgoff, &populate, NULL); + if (!IS_ERR_VALUE(ret) && file && prfile) { + struct vm_area_struct *new_vma; + @@ -34828,7 +36972,7 @@ index 1af87c1..95b0ff4 100644 out: up_write(&mm->mmap_sem); if (populate) -@@ -3056,7 +3073,7 @@ struct vm_area_struct *copy_vma(struct vm_area_struct **vmap, +@@ -3136,7 +3153,7 @@ struct vm_area_struct *copy_vma(struct vm_area_struct **vmap, if (anon_vma_clone(new_vma, vma)) goto out_free_mempol; if (new_vma->vm_file) @@ -34838,10 +36982,10 @@ index 1af87c1..95b0ff4 100644 new_vma->vm_ops->open(new_vma); vma_link(mm, new_vma, prev, rb_link, rb_parent); diff --git a/mm/nommu.c b/mm/nommu.c -index 8b8faaf..5d26ed94 100644 +index 17c00d93de2e..4bcdf9448dd0 100644 --- a/mm/nommu.c +++ b/mm/nommu.c -@@ -636,7 +636,7 @@ static void __put_nommu_region(struct vm_region *region) +@@ -641,7 +641,7 @@ static void __put_nommu_region(struct vm_region *region) up_write(&nommu_region_sem); if (region->vm_file) @@ -34850,7 +36994,7 @@ index 8b8faaf..5d26ed94 100644 /* IO memory and memory shared directly out of the pagecache * from ramfs/tmpfs mustn't be released here */ -@@ -794,7 +794,7 @@ static void delete_vma(struct mm_struct *mm, struct vm_area_struct *vma) +@@ -799,7 +799,7 @@ static void delete_vma(struct mm_struct *mm, struct vm_area_struct *vma) if (vma->vm_ops && vma->vm_ops->close) vma->vm_ops->close(vma); if (vma->vm_file) @@ -34859,7 +37003,7 @@ index 8b8faaf..5d26ed94 100644 put_nommu_region(vma->vm_region); kmem_cache_free(vm_area_cachep, vma); } -@@ -1320,7 +1320,7 @@ unsigned long do_mmap(struct file *file, +@@ -1321,7 +1321,7 @@ unsigned long do_mmap(struct file *file, goto error_just_free; } } @@ -34868,7 +37012,7 @@ index 8b8faaf..5d26ed94 100644 kmem_cache_free(vm_region_jar, region); region = pregion; result = start; -@@ -1395,10 +1395,10 @@ unsigned long do_mmap(struct file *file, +@@ -1396,10 +1396,10 @@ unsigned long do_mmap(struct file *file, up_write(&nommu_region_sem); error: if (region->vm_file) @@ -34883,18 +37027,19 @@ index 8b8faaf..5d26ed94 100644 diff --git a/mm/prfile.c b/mm/prfile.c new file mode 100644 -index 0000000..b323b8a +index 000000000000..3f5666999b7c --- /dev/null +++ b/mm/prfile.c @@ -0,0 +1,86 @@ +/* -+ * Mainly for aufs which mmap(2) diffrent file and wants to print different path -+ * in /proc/PID/maps. ++ * SPDX-License-Identifier: GPL-2.0 ++ * Mainly for aufs which mmap(2) different file and wants to print different ++ * path in /proc/PID/maps. + * Call these functions via macros defined in linux/mm.h. + * + * See Documentation/filesystems/aufs/design/06mmap.txt + * -+ * Copyright (c) 2014 Junjro R. Okajima ++ * Copyright (c) 2014-2017 Junjro R. Okajima + * Copyright (c) 2014 Ian Campbell + */ + @@ -34908,8 +37053,7 @@ index 0000000..b323b8a +{ +#ifdef PRFILE_TRACE + if (pr) -+ pr_info("%s:%d: %s, %s\n", func, line, func2, -+ f ? (char *)f->f_path.dentry->d_name.name : "(null)"); ++ pr_info("%s:%d: %s, %pD2\n", func, line, func2, f); +#endif +} + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-4.9-modular.patch b/kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-4.9-modular.patch deleted file mode 100644 index f0a84fef..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-4.9-modular.patch +++ /dev/null @@ -1,402 +0,0 @@ - - fs/aufs/Kconfig | 2 +- - fs/dcache.c | 2 ++ - fs/exec.c | 1 + - fs/fcntl.c | 1 + - fs/file_table.c | 4 ++++ - fs/inode.c | 1 + - fs/namespace.c | 2 ++ - fs/notify/group.c | 4 ++++ - fs/notify/mark.c | 4 ++++ - fs/open.c | 2 ++ - fs/read_write.c | 2 ++ - fs/splice.c | 2 ++ - fs/xattr.c | 1 + - kernel/task_work.c | 1 + - security/commoncap.c | 2 ++ - security/device_cgroup.c | 2 ++ - security/security.c | 10 ++++++++++ - 17 files changed, 42 insertions(+), 1 deletion(-) - -diff -Nurp linux-4.9-aufs/fs/aufs/Kconfig linux-4.9-aufs-mod/fs/aufs/Kconfig ---- linux-4.9-aufs/fs/aufs/Kconfig 2016-12-31 00:31:52.367789380 +0200 -+++ linux-4.9-aufs-mod/fs/aufs/Kconfig 2016-12-31 00:32:35.153785422 +0200 -@@ -1,5 +1,5 @@ - config AUFS_FS -- bool "Aufs (Advanced multi layered unification filesystem) support" -+ tristate "Aufs (Advanced multi layered unification filesystem) support" - help - Aufs is a stackable unification filesystem such as Unionfs, - which unifies several directories and provides a merged single -diff -Nurp linux-4.9-aufs/fs/dcache.c linux-4.9-aufs-mod/fs/dcache.c ---- linux-4.9-aufs/fs/dcache.c 2016-12-31 00:31:52.379789379 +0200 -+++ linux-4.9-aufs-mod/fs/dcache.c 2016-12-31 01:49:12.324360147 +0200 -@@ -1272,6 +1272,7 @@ rename_retry: - seq = 1; - goto again; - } -+EXPORT_SYMBOL_GPL(d_walk); - - /* - * Search for at least 1 mount point in the dentry's subdirs. -@@ -2855,6 +2856,7 @@ void d_exchange(struct dentry *dentry1, - - write_sequnlock(&rename_lock); - } -+EXPORT_SYMBOL_GPL(d_exchange); - - /** - * d_ancestor - search for an ancestor -diff -Nurp linux-4.9-aufs/fs/exec.c linux-4.9-aufs-mod/fs/exec.c ---- linux-4.9-aufs/fs/exec.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.9-aufs-mod/fs/exec.c 2016-12-31 00:32:35.153785422 +0200 -@@ -104,6 +104,7 @@ bool path_noexec(const struct path *path - return (path->mnt->mnt_flags & MNT_NOEXEC) || - (path->mnt->mnt_sb->s_iflags & SB_I_NOEXEC); - } -+EXPORT_SYMBOL_GPL(path_noexec); - - #ifdef CONFIG_USELIB - /* -diff -Nurp linux-4.9-aufs/fs/fcntl.c linux-4.9-aufs-mod/fs/fcntl.c ---- linux-4.9-aufs/fs/fcntl.c 2016-12-31 00:31:52.379789379 +0200 -+++ linux-4.9-aufs-mod/fs/fcntl.c 2016-12-31 00:32:35.154785422 +0200 -@@ -82,6 +82,7 @@ int setfl(int fd, struct file * filp, un - out: - return error; - } -+EXPORT_SYMBOL_GPL(setfl); - - static void f_modown(struct file *filp, struct pid *pid, enum pid_type type, - int force) -diff -Nurp linux-4.9-aufs/fs/file_table.c linux-4.9-aufs-mod/fs/file_table.c ---- linux-4.9-aufs/fs/file_table.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.9-aufs-mod/fs/file_table.c 2016-12-31 00:32:35.154785422 +0200 -@@ -147,6 +147,7 @@ over: - } - return ERR_PTR(-ENFILE); - } -+EXPORT_SYMBOL_GPL(get_empty_filp); - - /** - * alloc_file - allocate and initialize a 'struct file' -@@ -258,6 +259,7 @@ void flush_delayed_fput(void) - { - delayed_fput(NULL); - } -+EXPORT_SYMBOL_GPL(flush_delayed_fput); - - static DECLARE_DELAYED_WORK(delayed_fput_work, delayed_fput); - -@@ -300,6 +302,7 @@ void __fput_sync(struct file *file) - } - - EXPORT_SYMBOL(fput); -+EXPORT_SYMBOL_GPL(__fput_sync); - - void put_filp(struct file *file) - { -@@ -308,6 +311,7 @@ void put_filp(struct file *file) - file_free(file); - } - } -+EXPORT_SYMBOL_GPL(put_filp); - - void __init files_init(void) - { -diff -Nurp linux-4.9-aufs/fs/inode.c linux-4.9-aufs-mod/fs/inode.c ---- linux-4.9-aufs/fs/inode.c 2016-12-31 00:31:52.379789379 +0200 -+++ linux-4.9-aufs-mod/fs/inode.c 2016-12-31 00:32:35.154785422 +0200 -@@ -1651,6 +1651,7 @@ int update_time(struct inode *inode, str - - return update_time(inode, time, flags); - } -+EXPORT_SYMBOL_GPL(update_time); - - /** - * touch_atime - update the access time -diff -Nurp linux-4.9-aufs/fs/namespace.c linux-4.9-aufs-mod/fs/namespace.c ---- linux-4.9-aufs/fs/namespace.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.9-aufs-mod/fs/namespace.c 2016-12-31 00:32:35.154785422 +0200 -@@ -466,6 +466,7 @@ void __mnt_drop_write(struct vfsmount *m - mnt_dec_writers(real_mount(mnt)); - preempt_enable(); - } -+EXPORT_SYMBOL_GPL(__mnt_drop_write); - - /** - * mnt_drop_write - give up write access to a mount -@@ -1823,6 +1824,7 @@ int iterate_mounts(int (*f)(struct vfsmo - } - return 0; - } -+EXPORT_SYMBOL_GPL(iterate_mounts); - - static void cleanup_group_ids(struct mount *mnt, struct mount *end) - { -diff -Nurp linux-4.9-aufs/fs/notify/group.c linux-4.9-aufs-mod/fs/notify/group.c ---- linux-4.9-aufs/fs/notify/group.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.9-aufs-mod/fs/notify/group.c 2016-12-31 00:32:35.155785422 +0200 -@@ -22,6 +22,7 @@ - #include - #include - #include -+#include - - #include - #include "fsnotify.h" -@@ -100,6 +101,7 @@ void fsnotify_get_group(struct fsnotify_ - { - atomic_inc(&group->refcnt); - } -+EXPORT_SYMBOL_GPL(fsnotify_get_group); - - /* - * Drop a reference to a group. Free it if it's through. -@@ -109,6 +111,7 @@ void fsnotify_put_group(struct fsnotify_ - if (atomic_dec_and_test(&group->refcnt)) - fsnotify_final_destroy_group(group); - } -+EXPORT_SYMBOL_GPL(fsnotify_put_group); - - /* - * Create a new fsnotify_group and hold a reference for the group returned. -@@ -137,6 +140,7 @@ struct fsnotify_group *fsnotify_alloc_gr - - return group; - } -+EXPORT_SYMBOL_GPL(fsnotify_alloc_group); - - int fsnotify_fasync(int fd, struct file *file, int on) - { -diff -Nurp linux-4.9-aufs/fs/notify/mark.c linux-4.9-aufs-mod/fs/notify/mark.c ---- linux-4.9-aufs/fs/notify/mark.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.9-aufs-mod/fs/notify/mark.c 2016-12-31 00:32:35.155785422 +0200 -@@ -113,6 +113,7 @@ void fsnotify_put_mark(struct fsnotify_m - mark->free_mark(mark); - } - } -+EXPORT_SYMBOL_GPL(fsnotify_put_mark); - - /* Calculate mask of events for a list of marks */ - u32 fsnotify_recalc_mask(struct hlist_head *head) -@@ -230,6 +231,7 @@ void fsnotify_destroy_mark(struct fsnoti - mutex_unlock(&group->mark_mutex); - fsnotify_free_mark(mark); - } -+EXPORT_SYMBOL_GPL(fsnotify_destroy_mark); - - void fsnotify_destroy_marks(struct hlist_head *head, spinlock_t *lock) - { -@@ -415,6 +417,7 @@ err: - - return ret; - } -+EXPORT_SYMBOL_GPL(fsnotify_add_mark); - - int fsnotify_add_mark(struct fsnotify_mark *mark, struct fsnotify_group *group, - struct inode *inode, struct vfsmount *mnt, int allow_dups) -@@ -521,6 +524,7 @@ void fsnotify_duplicate_mark(struct fsno - new->mask = old->mask; - new->free_mark = old->free_mark; - } -+EXPORT_SYMBOL_GPL(fsnotify_init_mark); - - /* - * Nothing fancy, just initialize lists and locks and counters. -diff -Nurp linux-4.9-aufs/fs/open.c linux-4.9-aufs-mod/fs/open.c ---- linux-4.9-aufs/fs/open.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.9-aufs-mod/fs/open.c 2016-12-31 00:32:35.155785422 +0200 -@@ -64,6 +64,7 @@ int do_truncate(struct dentry *dentry, l - inode_unlock(dentry->d_inode); - return ret; - } -+EXPORT_SYMBOL_GPL(do_truncate); - - long vfs_truncate(const struct path *path, loff_t length) - { -@@ -695,6 +696,7 @@ int open_check_o_direct(struct file *f) - } - return 0; - } -+EXPORT_SYMBOL_GPL(open_check_o_direct); - - static int do_dentry_open(struct file *f, - struct inode *inode, -diff -Nurp linux-4.9-aufs/fs/read_write.c linux-4.9-aufs-mod/fs/read_write.c ---- linux-4.9-aufs/fs/read_write.c 2016-12-31 00:31:52.380789379 +0200 -+++ linux-4.9-aufs-mod/fs/read_write.c 2016-12-31 00:32:35.155785422 +0200 -@@ -525,6 +525,7 @@ vfs_readf_t vfs_readf(struct file *file) - return new_sync_read; - return ERR_PTR(-ENOSYS); - } -+EXPORT_SYMBOL_GPL(vfs_readf); - - vfs_writef_t vfs_writef(struct file *file) - { -@@ -536,6 +537,7 @@ vfs_writef_t vfs_writef(struct file *fil - return new_sync_write; - return ERR_PTR(-ENOSYS); - } -+EXPORT_SYMBOL_GPL(vfs_writef); - - ssize_t __kernel_write(struct file *file, const char *buf, size_t count, loff_t *pos) - { -diff -Nurp linux-4.9-aufs/fs/splice.c linux-4.9-aufs-mod/fs/splice.c ---- linux-4.9-aufs/fs/splice.c 2016-12-31 00:31:52.380789379 +0200 -+++ linux-4.9-aufs-mod/fs/splice.c 2016-12-31 00:32:35.156785422 +0200 -@@ -868,6 +868,7 @@ long do_splice_from(struct pipe_inode_in - - return splice_write(pipe, out, ppos, len, flags); - } -+EXPORT_SYMBOL_GPL(do_splice_from); - - /* - * Attempt to initiate a splice from a file to a pipe. -@@ -897,6 +898,7 @@ long do_splice_to(struct file *in, loff_ - - return splice_read(in, ppos, pipe, len, flags); - } -+EXPORT_SYMBOL_GPL(do_splice_to); - - /** - * splice_direct_to_actor - splices data directly between two non-pipes -diff -Nurp linux-4.9-aufs/fs/xattr.c linux-4.9-aufs-mod/fs/xattr.c ---- linux-4.9-aufs/fs/xattr.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.9-aufs-mod/fs/xattr.c 2016-12-31 00:32:35.156785422 +0200 -@@ -296,6 +296,7 @@ vfs_getxattr_alloc(struct dentry *dentry - *xattr_value = value; - return error; - } -+EXPORT_SYMBOL_GPL(vfs_getxattr_alloc); - - ssize_t - __vfs_getxattr(struct dentry *dentry, struct inode *inode, const char *name, -diff -Nurp linux-4.9-aufs/kernel/task_work.c linux-4.9-aufs-mod/kernel/task_work.c ---- linux-4.9-aufs/kernel/task_work.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.9-aufs-mod/kernel/task_work.c 2016-12-31 00:32:35.156785422 +0200 -@@ -119,3 +119,4 @@ void task_work_run(void) - } while (work); - } - } -+EXPORT_SYMBOL_GPL(task_work_run); -diff -Nurp linux-4.9-aufs/security/commoncap.c linux-4.9-aufs-mod/security/commoncap.c ---- linux-4.9-aufs/security/commoncap.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.9-aufs-mod/security/commoncap.c 2016-12-31 00:32:35.156785422 +0200 -@@ -1061,12 +1061,14 @@ int cap_mmap_addr(unsigned long addr) - } - return ret; - } -+EXPORT_SYMBOL_GPL(cap_mmap_addr); - - int cap_mmap_file(struct file *file, unsigned long reqprot, - unsigned long prot, unsigned long flags) - { - return 0; - } -+EXPORT_SYMBOL_GPL(cap_mmap_file); - - #ifdef CONFIG_SECURITY - -diff -Nurp linux-4.9-aufs/security/device_cgroup.c linux-4.9-aufs-mod/security/device_cgroup.c ---- linux-4.9-aufs/security/device_cgroup.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.9-aufs-mod/security/device_cgroup.c 2016-12-31 00:32:35.156785422 +0200 -@@ -7,6 +7,7 @@ - #include - #include - #include -+#include - #include - #include - #include -@@ -849,6 +850,7 @@ int __devcgroup_inode_permission(struct - return __devcgroup_check_permission(type, imajor(inode), iminor(inode), - access); - } -+EXPORT_SYMBOL_GPL(__devcgroup_inode_permission); - - int devcgroup_inode_mknod(int mode, dev_t dev) - { -diff -Nurp linux-4.9-aufs/security/security.c linux-4.9-aufs-mod/security/security.c ---- linux-4.9-aufs/security/security.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.9-aufs-mod/security/security.c 2016-12-31 00:32:35.157785422 +0200 -@@ -443,6 +443,7 @@ int security_path_rmdir(const struct pat - return 0; - return call_int_hook(path_rmdir, 0, dir, dentry); - } -+EXPORT_SYMBOL_GPL(security_path_rmdir); - - int security_path_unlink(const struct path *dir, struct dentry *dentry) - { -@@ -459,6 +460,7 @@ int security_path_symlink(const struct p - return 0; - return call_int_hook(path_symlink, 0, dir, dentry, old_name); - } -+EXPORT_SYMBOL_GPL(security_path_symlink); - - int security_path_link(struct dentry *old_dentry, const struct path *new_dir, - struct dentry *new_dentry) -@@ -467,6 +469,7 @@ int security_path_link(struct dentry *ol - return 0; - return call_int_hook(path_link, 0, old_dentry, new_dir, new_dentry); - } -+EXPORT_SYMBOL_GPL(security_path_link); - - int security_path_rename(const struct path *old_dir, struct dentry *old_dentry, - const struct path *new_dir, struct dentry *new_dentry, -@@ -494,6 +497,7 @@ int security_path_truncate(const struct - return 0; - return call_int_hook(path_truncate, 0, path); - } -+EXPORT_SYMBOL_GPL(security_path_truncate); - - int security_path_chmod(const struct path *path, umode_t mode) - { -@@ -501,6 +505,7 @@ int security_path_chmod(const struct pat - return 0; - return call_int_hook(path_chmod, 0, path, mode); - } -+EXPORT_SYMBOL_GPL(security_path_chmod); - - int security_path_chown(const struct path *path, kuid_t uid, kgid_t gid) - { -@@ -508,6 +513,7 @@ int security_path_chown(const struct pat - return 0; - return call_int_hook(path_chown, 0, path, uid, gid); - } -+EXPORT_SYMBOL_GPL(security_path_chown); - - int security_path_chroot(const struct path *path) - { -@@ -593,6 +599,7 @@ int security_inode_readlink(struct dentr - return 0; - return call_int_hook(inode_readlink, 0, dentry); - } -+EXPORT_SYMBOL_GPL(security_inode_readlink); - - int security_inode_follow_link(struct dentry *dentry, struct inode *inode, - bool rcu) -@@ -608,6 +615,7 @@ int security_inode_permission(struct ino - return 0; - return call_int_hook(inode_permission, 0, inode, mask); - } -+EXPORT_SYMBOL_GPL(security_inode_permission); - - int security_inode_setattr(struct dentry *dentry, struct iattr *attr) - { -@@ -779,6 +787,7 @@ int security_file_permission(struct file - - return fsnotify_perm(file, mask); - } -+EXPORT_SYMBOL_GPL(security_file_permission); - - int security_file_alloc(struct file *file) - { -@@ -838,6 +847,7 @@ int security_mmap_file(struct file *file - return ret; - return ima_file_mmap(file, prot); - } -+EXPORT_SYMBOL_GPL(security_mmap_file); - - int security_mmap_addr(unsigned long addr) - { diff --git a/kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-include-vmalloc.patch b/kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-include-vmalloc.patch new file mode 100644 index 00000000..0c413647 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/fs-aufs-include-vmalloc.patch @@ -0,0 +1,27 @@ + +arm build fails with: + +n file included from fs/aufs/aufs.h:31:0, + from fs/aufs/module.c:11: +fs/aufs/file.h: In function 'au_do_vm_file_reset': +fs/aufs/file.h:273:9: error: dereferencing pointer to incomplete type 'struct vm_area_struct' + f = vma->vm_file; + ^ + +on x86(64) we seem to get covered by implict inclusion. + +So explicitly include it to avoid subtle breakage + +Signed-off-by: Thomas Backlund +--- + +--- ./fs/aufs/file.h.orig ++++ ./fs/aufs/file.h +@@ -15,6 +15,7 @@ + #include + #include + #include ++#include + #include "rwsem.h" + + struct au_branch; diff --git a/kernel/tools/cpupowertools/files/patches/mageia/fs-jbd2-Fix-dbench4-performance-regression-for-nobarrier-mounts.patch b/kernel/tools/cpupowertools/files/patches/mageia/fs-jbd2-Fix-dbench4-performance-regression-for-nobarrier-mounts.patch deleted file mode 100644 index 6c29cbbf..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/fs-jbd2-Fix-dbench4-performance-regression-for-nobarrier-mounts.patch +++ /dev/null @@ -1,39 +0,0 @@ -From: Jan Kara -Subject: [PATCH] jbd2: Fix dbench4 performance regression for 'nobarrier' mounts -Date: Fri, 28 Apr 2017 11:59:34 +0200 - -Commit b685d3d65ac7 "block: treat REQ_FUA and REQ_PREFLUSH as -synchronous" removed REQ_SYNC flag from WRITE_FUA implementation. Since -JBD2 strips REQ_FUA and REQ_FLUSH flags from submitted IO when the -filesystem is mounted with nobarrier mount option, journal superblock -writes ended up being async writes after this patch and that caused -heavy performance regression for dbench4 benchmark with high number of -processes. In my test setup with HP RAID array with non-volatile write -cache and 32 GB ram, dbench4 runs with 8 processes regressed by ~25%. - -Fix the problem by making sure journal superblock writes are always -treated as synchronous since they generally block progress of the -journalling machinery and thus the whole filesystem. - -Fixes: b685d3d65ac791406e0dfd8779cc9b3707fea5a3 -CC: stable@vger.kernel.org -Signed-off-by: Jan Kara ---- - fs/jbd2/journal.c | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - -diff --git a/fs/jbd2/journal.c b/fs/jbd2/journal.c -index 5adc2fb62b0f..e768126f6a72 100644 ---- a/fs/jbd2/journal.c -+++ b/fs/jbd2/journal.c -@@ -1348,7 +1348,7 @@ static int jbd2_write_superblock(journal_t *journal, int write_flags) - jbd2_superblock_csum_set(journal, sb); - get_bh(bh); - bh->b_end_io = end_buffer_write_sync; -- ret = submit_bh(REQ_OP_WRITE, write_flags, bh); -+ ret = submit_bh(REQ_OP_WRITE, write_flags | REQ_SYNC, bh); - wait_on_buffer(bh); - if (buffer_write_io_error(bh)) { - clear_buffer_write_io_error(bh); --- -2.12.0 diff --git a/kernel/tools/cpupowertools/files/patches/mageia/fs-seq_file-reset-iterator-to-first-record-for-zero-off.patch b/kernel/tools/cpupowertools/files/patches/mageia/fs-seq_file-reset-iterator-to-first-record-for-zero-off.patch deleted file mode 100644 index b0cc86e3..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/fs-seq_file-reset-iterator-to-first-record-for-zero-off.patch +++ /dev/null @@ -1,44 +0,0 @@ -From e522751d605d99a81508e58390a8f51ee96fb662 Mon Sep 17 00:00:00 2001 -From: Tomasz Majchrzak -Date: Tue, 29 Nov 2016 15:18:20 +0100 -Subject: [PATCH] seq_file: reset iterator to first record for zero offset - -If kernfs file is empty on a first read, successive read operations -using the same file descriptor will return no data, even when data is -available. Default kernfs 'seq_next' implementation advances iterator -position even when next object is not there. Kernfs 'seq_start' for -following requests will not return iterator as position is already on -the second object. - -This defect doesn't allow to monitor badblocks sysfs files from MD raid. -They are initially empty but if data appears at some stage, userspace is -not able to read it. - -Signed-off-by: Tomasz Majchrzak -Signed-off-by: Miklos Szeredi -Signed-off-by: Al Viro ---- - fs/seq_file.c | 7 +++++++ - 1 file changed, 7 insertions(+) - -diff --git a/fs/seq_file.c b/fs/seq_file.c -index 368bfb9..a11f271 100644 ---- a/fs/seq_file.c -+++ b/fs/seq_file.c -@@ -190,6 +190,13 @@ ssize_t seq_read(struct file *file, char __user *buf, size_t size, loff_t *ppos) - */ - m->version = file->f_version; - -+ /* -+ * if request is to read from zero offset, reset iterator to first -+ * record as it might have been already advanced by previous requests -+ */ -+ if (*ppos == 0) -+ m->index = 0; -+ - /* Don't assume *ppos is where we left it */ - if (unlikely(*ppos != m->read_pos)) { - while ((err = traverse(m, *ppos)) == -EAGAIN) --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amd-amdgpu-add-POLARIS12-PCI-ID.patch b/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amd-amdgpu-add-POLARIS12-PCI-ID.patch deleted file mode 100644 index e8bff963..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amd-amdgpu-add-POLARIS12-PCI-ID.patch +++ /dev/null @@ -1,28 +0,0 @@ -From cf8c73afb3abf0f8905efbaddd4ce11a0deec9da Mon Sep 17 00:00:00 2001 -From: Evan Quan -Date: Fri, 17 Mar 2017 10:22:51 +0800 -Subject: [PATCH] drm/amd/amdgpu: add POLARIS12 PCI ID - -Signed-off-by: Evan Quan -Reviewed-by: Junwei Zhang -Signed-off-by: Alex Deucher -Cc: stable@vger.kernel.org ---- - drivers/gpu/drm/amd/amdgpu/amdgpu_drv.c | 1 + - 1 file changed, 1 insertion(+) - -diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_drv.c b/drivers/gpu/drm/amd/amdgpu/amdgpu_drv.c -index f7adbac..b76cd69 100644 ---- a/drivers/gpu/drm/amd/amdgpu/amdgpu_drv.c -+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu_drv.c -@@ -421,6 +421,7 @@ static const struct pci_device_id pciidlist[] = { - {0x1002, 0x6985, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, - {0x1002, 0x6986, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, - {0x1002, 0x6987, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, -+ {0x1002, 0x6995, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, - {0x1002, 0x699F, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, - - {0, 0, 0} --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amd-amdgpu-add-Polaris12-PCI-ID.patch b/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amd-amdgpu-add-Polaris12-PCI-ID.patch deleted file mode 100644 index 3a010204..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amd-amdgpu-add-Polaris12-PCI-ID.patch +++ /dev/null @@ -1,38 +0,0 @@ -From fc8e9c54699e42754094ff475da46440778d8f19 Mon Sep 17 00:00:00 2001 -From: Junwei Zhang -Date: Thu, 4 Aug 2016 12:54:22 +0800 -Subject: [PATCH] drm/amd/amdgpu: add Polaris12 PCI ID -MIME-Version: 1.0 -Content-Type: text/plain; charset=UTF-8 -Content-Transfer-Encoding: 8bit - -Signed-off-by: Junwei Zhang -Reviewed-by: Alex Deucher -Reviewed-by: Christian König -Reviewed-by: Ken Wang -Signed-off-by: Alex Deucher ---- - drivers/gpu/drm/amd/amdgpu/amdgpu_drv.c | 7 +++++++ - 1 file changed, 7 insertions(+) - -diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_drv.c b/drivers/gpu/drm/amd/amdgpu/amdgpu_drv.c -index 8cb937b..2534ada 100644 ---- a/drivers/gpu/drm/amd/amdgpu/amdgpu_drv.c -+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu_drv.c -@@ -418,6 +418,13 @@ static const struct pci_device_id pciidlist[] = { - {0x1002, 0x67CA, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS10}, - {0x1002, 0x67CC, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS10}, - {0x1002, 0x67CF, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS10}, -+ /* Polaris12 */ -+ {0x1002, 0x6980, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, -+ {0x1002, 0x6981, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, -+ {0x1002, 0x6985, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, -+ {0x1002, 0x6986, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, -+ {0x1002, 0x6987, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, -+ {0x1002, 0x699F, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, - - {0, 0, 0} - }; --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amd-amdgpu-add-Polaris12-support-v3.patch b/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amd-amdgpu-add-Polaris12-support-v3.patch deleted file mode 100644 index 7b8a1133..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amd-amdgpu-add-Polaris12-support-v3.patch +++ /dev/null @@ -1,469 +0,0 @@ -From c4642a479fac9f5c224ff7425d86c427b94011af Mon Sep 17 00:00:00 2001 -From: Junwei Zhang -Date: Wed, 14 Dec 2016 15:32:28 -0500 -Subject: [PATCH] drm/amd/amdgpu: add Polaris12 support (v3) -MIME-Version: 1.0 -Content-Type: text/plain; charset=UTF-8 -Content-Transfer-Encoding: 8bit - -v2: agd: squash in various fixes -v3: agd: squash in: -drm/amdgpu: remove unnecessary smc sk firmware for polaris12 - -Signed-off-by: Junwei Zhang -Reviewed-by: Alex Deucher -Reviewed-by: Christian König -Reviewed-by: Ken Wang -Signed-off-by: Alex Deucher -[ rebased for 4.9 / tmb ] -Signed-off-by: Thomas Backlund ---- - drivers/gpu/drm/amd/amdgpu/amdgpu_cgs.c | 3 +++ - drivers/gpu/drm/amd/amdgpu/amdgpu_device.c | 2 ++ - drivers/gpu/drm/amd/amdgpu/amdgpu_uvd.c | 5 +++++ - drivers/gpu/drm/amd/amdgpu/amdgpu_vce.c | 5 +++++ - drivers/gpu/drm/amd/amdgpu/dce_v11_0.c | 13 ++++++++++--- - drivers/gpu/drm/amd/amdgpu/gfx_v8_0.c | 31 +++++++++++++++++++++++++----- - drivers/gpu/drm/amd/amdgpu/gmc_v8_0.c | 5 +++++ - drivers/gpu/drm/amd/amdgpu/sdma_v3_0.c | 6 ++++++ - drivers/gpu/drm/amd/amdgpu/vce_v3_0.c | 5 +++-- - drivers/gpu/drm/amd/amdgpu/vi.c | 10 ++++++++++ - drivers/gpu/drm/amd/include/amd_shared.h | 1 + - 11 files changed, 76 insertions(+), 10 deletions(-) - -diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_cgs.c b/drivers/gpu/drm/amd/amdgpu/amdgpu_cgs.c -index 9ada56c..4c851fde 100644 ---- a/drivers/gpu/drm/amd/amdgpu/amdgpu_cgs.c -+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu_cgs.c -@@ -840,6 +840,9 @@ static int amdgpu_cgs_get_firmware_info(struct cgs_device *cgs_device, - else if (type == CGS_UCODE_ID_SMU_SK) - strcpy(fw_name, "amdgpu/polaris10_smc_sk.bin"); - break; -+ case CHIP_POLARIS12: -+ strcpy(fw_name, "amdgpu/polaris12_smc.bin"); -+ break; - default: - DRM_ERROR("SMC firmware not supported\n"); - return -EINVAL; -diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_device.c b/drivers/gpu/drm/amd/amdgpu/amdgpu_device.c -index 60bd4af..fe3bb94 100644 ---- a/drivers/gpu/drm/amd/amdgpu/amdgpu_device.c -+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu_device.c -@@ -73,6 +73,7 @@ static const char *amdgpu_asic_name[] = { - "STONEY", - "POLARIS10", - "POLARIS11", -+ "POLARIS12", - "LAST", - }; - -@@ -1277,6 +1278,7 @@ static int amdgpu_early_init(struct amdgpu_device *adev) - case CHIP_FIJI: - case CHIP_POLARIS11: - case CHIP_POLARIS10: -+ case CHIP_POLARIS12: - case CHIP_CARRIZO: - case CHIP_STONEY: - if (adev->asic_type == CHIP_CARRIZO || adev->asic_type == CHIP_STONEY) -diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_uvd.c b/drivers/gpu/drm/amd/amdgpu/amdgpu_uvd.c -index a81dfae..1d564be 100644 ---- a/drivers/gpu/drm/amd/amdgpu/amdgpu_uvd.c -+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu_uvd.c -@@ -65,6 +65,7 @@ - #define FIRMWARE_STONEY "amdgpu/stoney_uvd.bin" - #define FIRMWARE_POLARIS10 "amdgpu/polaris10_uvd.bin" - #define FIRMWARE_POLARIS11 "amdgpu/polaris11_uvd.bin" -+#define FIRMWARE_POLARIS12 "amdgpu/polaris12_uvd.bin" - - /** - * amdgpu_uvd_cs_ctx - Command submission parser context -@@ -98,6 +99,7 @@ MODULE_FIRMWARE(FIRMWARE_FIJI); - MODULE_FIRMWARE(FIRMWARE_STONEY); - MODULE_FIRMWARE(FIRMWARE_POLARIS10); - MODULE_FIRMWARE(FIRMWARE_POLARIS11); -+MODULE_FIRMWARE(FIRMWARE_POLARIS12); - - static void amdgpu_uvd_idle_work_handler(struct work_struct *work); - -@@ -149,6 +151,9 @@ int amdgpu_uvd_sw_init(struct amdgpu_device *adev) - case CHIP_POLARIS11: - fw_name = FIRMWARE_POLARIS11; - break; -+ case CHIP_POLARIS12: -+ fw_name = FIRMWARE_POLARIS12; -+ break; - default: - return -EINVAL; - } -diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_vce.c b/drivers/gpu/drm/amd/amdgpu/amdgpu_vce.c -index 69b66b9..8fec802 100644 ---- a/drivers/gpu/drm/amd/amdgpu/amdgpu_vce.c -+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu_vce.c -@@ -52,6 +52,7 @@ - #define FIRMWARE_STONEY "amdgpu/stoney_vce.bin" - #define FIRMWARE_POLARIS10 "amdgpu/polaris10_vce.bin" - #define FIRMWARE_POLARIS11 "amdgpu/polaris11_vce.bin" -+#define FIRMWARE_POLARIS12 "amdgpu/polaris12_vce.bin" - - #ifdef CONFIG_DRM_AMDGPU_CIK - MODULE_FIRMWARE(FIRMWARE_BONAIRE); -@@ -66,6 +67,7 @@ MODULE_FIRMWARE(FIRMWARE_FIJI); - MODULE_FIRMWARE(FIRMWARE_STONEY); - MODULE_FIRMWARE(FIRMWARE_POLARIS10); - MODULE_FIRMWARE(FIRMWARE_POLARIS11); -+MODULE_FIRMWARE(FIRMWARE_POLARIS12); - - static void amdgpu_vce_idle_work_handler(struct work_struct *work); - -@@ -121,6 +123,9 @@ int amdgpu_vce_sw_init(struct amdgpu_device *adev, unsigned long size) - case CHIP_POLARIS11: - fw_name = FIRMWARE_POLARIS11; - break; -+ case CHIP_POLARIS12: -+ fw_name = FIRMWARE_POLARIS12; -+ break; - - default: - return -EINVAL; -diff --git a/drivers/gpu/drm/amd/amdgpu/dce_v11_0.c b/drivers/gpu/drm/amd/amdgpu/dce_v11_0.c -index b3d62b9..2006abb 100644 ---- a/drivers/gpu/drm/amd/amdgpu/dce_v11_0.c -+++ b/drivers/gpu/drm/amd/amdgpu/dce_v11_0.c -@@ -167,6 +167,7 @@ static void dce_v11_0_init_golden_registers(struct amdgpu_device *adev) - (const u32)ARRAY_SIZE(stoney_golden_settings_a11)); - break; - case CHIP_POLARIS11: -+ case CHIP_POLARIS12: - amdgpu_program_register_sequence(adev, - polaris11_golden_settings_a11, - (const u32)ARRAY_SIZE(polaris11_golden_settings_a11)); -@@ -608,6 +609,7 @@ static int dce_v11_0_get_num_crtc (struct amdgpu_device *adev) - num_crtc = 6; - break; - case CHIP_POLARIS11: -+ case CHIP_POLARIS12: - num_crtc = 5; - break; - default: -@@ -1589,6 +1591,7 @@ static int dce_v11_0_audio_init(struct amdgpu_device *adev) - adev->mode_info.audio.num_pins = 8; - break; - case CHIP_POLARIS11: -+ case CHIP_POLARIS12: - adev->mode_info.audio.num_pins = 6; - break; - default: -@@ -2388,7 +2391,8 @@ static u32 dce_v11_0_pick_pll(struct drm_crtc *crtc) - int pll; - - if ((adev->asic_type == CHIP_POLARIS10) || -- (adev->asic_type == CHIP_POLARIS11)) { -+ (adev->asic_type == CHIP_POLARIS11) || -+ (adev->asic_type == CHIP_POLARIS12)) { - struct amdgpu_encoder *amdgpu_encoder = - to_amdgpu_encoder(amdgpu_crtc->encoder); - struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv; -@@ -2822,7 +2826,8 @@ static int dce_v11_0_crtc_mode_set(struct drm_crtc *crtc, - return -EINVAL; - - if ((adev->asic_type == CHIP_POLARIS10) || -- (adev->asic_type == CHIP_POLARIS11)) { -+ (adev->asic_type == CHIP_POLARIS11) || -+ (adev->asic_type == CHIP_POLARIS12)) { - struct amdgpu_encoder *amdgpu_encoder = - to_amdgpu_encoder(amdgpu_crtc->encoder); - int encoder_mode = -@@ -2992,6 +2997,7 @@ static int dce_v11_0_early_init(void *handle) - adev->mode_info.num_dig = 6; - break; - case CHIP_POLARIS11: -+ case CHIP_POLARIS12: - adev->mode_info.num_hpd = 5; - adev->mode_info.num_dig = 5; - break; -@@ -3101,7 +3107,8 @@ static int dce_v11_0_hw_init(void *handle) - amdgpu_atombios_crtc_powergate_init(adev); - amdgpu_atombios_encoder_init_dig(adev); - if ((adev->asic_type == CHIP_POLARIS10) || -- (adev->asic_type == CHIP_POLARIS11)) { -+ (adev->asic_type == CHIP_POLARIS11) || -+ (adev->asic_type == CHIP_POLARIS12)) { - amdgpu_atombios_crtc_set_dce_clock(adev, adev->clock.default_dispclk, - DCE_CLOCK_TYPE_DISPCLK, ATOM_GCK_DFS); - amdgpu_atombios_crtc_set_dce_clock(adev, 0, -diff --git a/drivers/gpu/drm/amd/amdgpu/gfx_v8_0.c b/drivers/gpu/drm/amd/amdgpu/gfx_v8_0.c -index d0ec009..3733741 100644 ---- a/drivers/gpu/drm/amd/amdgpu/gfx_v8_0.c -+++ b/drivers/gpu/drm/amd/amdgpu/gfx_v8_0.c -@@ -138,6 +138,13 @@ MODULE_FIRMWARE("amdgpu/polaris10_mec.bi - MODULE_FIRMWARE("amdgpu/polaris10_mec2.bin"); - MODULE_FIRMWARE("amdgpu/polaris10_rlc.bin"); - -+MODULE_FIRMWARE("amdgpu/polaris12_ce.bin"); -+MODULE_FIRMWARE("amdgpu/polaris12_pfp.bin"); -+MODULE_FIRMWARE("amdgpu/polaris12_me.bin"); -+MODULE_FIRMWARE("amdgpu/polaris12_mec.bin"); -+MODULE_FIRMWARE("amdgpu/polaris12_mec2.bin"); -+MODULE_FIRMWARE("amdgpu/polaris12_rlc.bin"); -+ - static const struct amdgpu_gds_reg_offset amdgpu_gds_reg_offset[] = - { - {mmGDS_VMID0_BASE, mmGDS_VMID0_SIZE, mmGDS_GWS_VMID0, mmGDS_OA_VMID0}, -@@ -687,6 +694,7 @@ static void gfx_v8_0_init_golden_registe - (const u32)ARRAY_SIZE(tonga_golden_common_all)); - break; - case CHIP_POLARIS11: -+ case CHIP_POLARIS12: - amdgpu_program_register_sequence(adev, - golden_settings_polaris11_a11, - (const u32)ARRAY_SIZE(golden_settings_polaris11_a11)); -@@ -901,6 +909,9 @@ static int gfx_v8_0_init_microcode(struc - case CHIP_POLARIS10: - chip_name = "polaris10"; - break; -+ case CHIP_POLARIS12: -+ chip_name = "polaris12"; -+ break; - case CHIP_STONEY: - chip_name = "stoney"; - break; -@@ -1777,6 +1788,7 @@ static int gfx_v8_0_gpu_early_init(struc - gb_addr_config = TONGA_GB_ADDR_CONFIG_GOLDEN; - break; - case CHIP_POLARIS11: -+ case CHIP_POLARIS12: - ret = amdgpu_atombios_get_gfx_info(adev); - if (ret) - return ret; -@@ -2695,6 +2707,7 @@ static void gfx_v8_0_tiling_mode_table_i - - break; - case CHIP_POLARIS11: -+ case CHIP_POLARIS12: - modearray[0] = (ARRAY_MODE(ARRAY_2D_TILED_THIN1) | - PIPE_CONFIG(ADDR_SURF_P4_16x16) | - TILE_SPLIT(ADDR_SURF_TILE_SPLIT_64B) | -@@ -3516,6 +3529,7 @@ gfx_v8_0_raster_config(struct amdgpu_dev - *rconf1 |= 0x0; - break; - case CHIP_POLARIS11: -+ case CHIP_POLARIS12: - *rconf |= RB_MAP_PKR0(2) | RB_XSEL2(1) | SE_MAP(2) | - SE_XSEL(1) | SE_YSEL(1); - *rconf1 |= 0x0; -@@ -4029,7 +4043,8 @@ static void gfx_v8_0_init_pg(struct amdg - cz_enable_cp_power_gating(adev, true); - else - cz_enable_cp_power_gating(adev, false); -- } else if (adev->asic_type == CHIP_POLARIS11) { -+ } else if ((adev->asic_type == CHIP_POLARIS11) || -+ (adev->asic_type == CHIP_POLARIS11)) { - gfx_v8_0_init_power_gating(adev); - } - } -@@ -4100,7 +4115,8 @@ static int gfx_v8_0_rlc_resume(struct am - RLC_CGCG_CGLS_CTRL__CGLS_EN_MASK); - WREG32(mmRLC_CGCG_CGLS_CTRL, tmp); - if (adev->asic_type == CHIP_POLARIS11 || -- adev->asic_type == CHIP_POLARIS10) { -+ adev->asic_type == CHIP_POLARIS10 || -+ adev->asic_type == CHIP_POLARIS12) { - tmp = RREG32(mmRLC_CGCG_CGLS_CTRL_3D); - tmp &= ~0x3; - WREG32(mmRLC_CGCG_CGLS_CTRL_3D, tmp); -@@ -4288,6 +4304,7 @@ static int gfx_v8_0_cp_gfx_start(struct - amdgpu_ring_write(ring, 0x0000002A); - break; - case CHIP_POLARIS11: -+ case CHIP_POLARIS12: - amdgpu_ring_write(ring, 0x16000012); - amdgpu_ring_write(ring, 0x00000000); - break; -@@ -4938,7 +4955,8 @@ static int gfx_v8_0_cp_compute_resume(st - (adev->asic_type == CHIP_FIJI) || - (adev->asic_type == CHIP_STONEY) || - (adev->asic_type == CHIP_POLARIS11) || -- (adev->asic_type == CHIP_POLARIS10)) { -+ (adev->asic_type == CHIP_POLARIS10) || -+ (adev->asic_type == CHIP_POLARIS12)) { - WREG32(mmCP_MEC_DOORBELL_RANGE_LOWER, - AMDGPU_DOORBELL_KIQ << 2); - WREG32(mmCP_MEC_DOORBELL_RANGE_UPPER, -@@ -4974,7 +4992,8 @@ static int gfx_v8_0_cp_compute_resume(st - mqd->cp_hqd_persistent_state = tmp; - if (adev->asic_type == CHIP_STONEY || - adev->asic_type == CHIP_POLARIS11 || -- adev->asic_type == CHIP_POLARIS10) { -+ adev->asic_type == CHIP_POLARIS10 || -+ adev->asic_type == CHIP_POLARIS12) { - tmp = RREG32(mmCP_ME1_PIPE3_INT_CNTL); - tmp = REG_SET_FIELD(tmp, CP_ME1_PIPE3_INT_CNTL, GENERIC2_INT_ENABLE, 1); - WREG32(mmCP_ME1_PIPE3_INT_CNTL, tmp); -@@ -5488,7 +5507,8 @@ static int gfx_v8_0_late_init(void *hand - static void gfx_v8_0_enable_gfx_static_mg_power_gating(struct amdgpu_device *adev, - bool enable) - { -- if (adev->asic_type == CHIP_POLARIS11) -+ if ((adev->asic_type == CHIP_POLARIS11) || -+ (adev->asic_type == CHIP_POLARIS12)) - /* Send msg to SMU via Powerplay */ - amdgpu_set_powergating_state(adev, - AMD_IP_BLOCK_TYPE_SMC, -@@ -5565,6 +5585,7 @@ static int gfx_v8_0_set_powergating_stat - gfx_v8_0_enable_gfx_dynamic_mg_power_gating(adev, false); - break; - case CHIP_POLARIS11: -+ case CHIP_POLARIS12: - if ((adev->pg_flags & AMD_PG_SUPPORT_GFX_SMG) && enable) - gfx_v8_0_enable_gfx_static_mg_power_gating(adev, true); - else -diff --git a/drivers/gpu/drm/amd/amdgpu/gmc_v8_0.c b/drivers/gpu/drm/amd/amdgpu/gmc_v8_0.c -index 0daac3a..476bc9f 100644 ---- a/drivers/gpu/drm/amd/amdgpu/gmc_v8_0.c -+++ b/drivers/gpu/drm/amd/amdgpu/gmc_v8_0.c -@@ -46,6 +46,7 @@ static int gmc_v8_0_wait_for_idle(void *handle); - MODULE_FIRMWARE("amdgpu/tonga_mc.bin"); - MODULE_FIRMWARE("amdgpu/polaris11_mc.bin"); - MODULE_FIRMWARE("amdgpu/polaris10_mc.bin"); -+MODULE_FIRMWARE("amdgpu/polaris12_mc.bin"); - - static const u32 golden_settings_tonga_a11[] = - { -@@ -130,6 +131,7 @@ static void gmc_v8_0_init_golden_registers(struct amdgpu_device *adev) - (const u32)ARRAY_SIZE(golden_settings_tonga_a11)); - break; - case CHIP_POLARIS11: -+ case CHIP_POLARIS12: - amdgpu_program_register_sequence(adev, - golden_settings_polaris11_a11, - (const u32)ARRAY_SIZE(golden_settings_polaris11_a11)); -@@ -225,6 +227,9 @@ static int gmc_v8_0_init_microcode(struct amdgpu_device *adev) - case CHIP_POLARIS10: - chip_name = "polaris10"; - break; -+ case CHIP_POLARIS12: -+ chip_name = "polaris12"; -+ break; - case CHIP_FIJI: - case CHIP_CARRIZO: - case CHIP_STONEY: -diff --git a/drivers/gpu/drm/amd/amdgpu/sdma_v3_0.c b/drivers/gpu/drm/amd/amdgpu/sdma_v3_0.c -index 1170a64..034ace7 100644 ---- a/drivers/gpu/drm/amd/amdgpu/sdma_v3_0.c -+++ b/drivers/gpu/drm/amd/amdgpu/sdma_v3_0.c -@@ -60,6 +60,8 @@ MODULE_FIRMWARE("amdgpu/polaris10_sdma.bin"); - MODULE_FIRMWARE("amdgpu/polaris10_sdma1.bin"); - MODULE_FIRMWARE("amdgpu/polaris11_sdma.bin"); - MODULE_FIRMWARE("amdgpu/polaris11_sdma1.bin"); -+MODULE_FIRMWARE("amdgpu/polaris12_sdma.bin"); -+MODULE_FIRMWARE("amdgpu/polaris12_sdma1.bin"); - - - static const u32 sdma_offsets[SDMA_MAX_INSTANCE] = -@@ -206,6 +208,7 @@ static void sdma_v3_0_init_golden_registers(struct amdgpu_device *adev) - (const u32)ARRAY_SIZE(golden_settings_tonga_a11)); - break; - case CHIP_POLARIS11: -+ case CHIP_POLARIS12: - amdgpu_program_register_sequence(adev, - golden_settings_polaris11_a11, - (const u32)ARRAY_SIZE(golden_settings_polaris11_a11)); -@@ -278,6 +281,9 @@ static int sdma_v3_0_init_microcode(struct amdgpu_device *adev) - case CHIP_POLARIS10: - chip_name = "polaris10"; - break; -+ case CHIP_POLARIS12: -+ chip_name = "polaris12"; -+ break; - case CHIP_CARRIZO: - chip_name = "carrizo"; - break; -diff --git a/drivers/gpu/drm/amd/amdgpu/vce_v3_0.c b/drivers/gpu/drm/amd/amdgpu/vce_v3_0.c -index 6b3293a..5fb0b7f 100644 ---- a/drivers/gpu/drm/amd/amdgpu/vce_v3_0.c -+++ b/drivers/gpu/drm/amd/amdgpu/vce_v3_0.c -@@ -320,11 +320,12 @@ static unsigned vce_v3_0_get_harvest_config(struct amdgpu_device *adev) - { - u32 tmp; - -- /* Fiji, Stoney, Polaris10, Polaris11 are single pipe */ -+ /* Fiji, Stoney, Polaris10, Polaris11, Polaris12 are single pipe */ - if ((adev->asic_type == CHIP_FIJI) || - (adev->asic_type == CHIP_STONEY) || - (adev->asic_type == CHIP_POLARIS10) || -- (adev->asic_type == CHIP_POLARIS11)) -+ (adev->asic_type == CHIP_POLARIS11) || -+ (adev->asic_type == CHIP_POLARIS12)) - return AMDGPU_VCE_HARVEST_VCE1; - - /* Tonga and CZ are dual or single pipe */ -diff --git a/drivers/gpu/drm/amd/amdgpu/vi.c b/drivers/gpu/drm/amd/amdgpu/vi.c -index bf088d6..c2ac54f 100644 ---- a/drivers/gpu/drm/amd/amdgpu/vi.c -+++ b/drivers/gpu/drm/amd/amdgpu/vi.c -@@ -88,6 +88,7 @@ MODULE_FIRMWARE("amdgpu/polaris10_smc.bi - MODULE_FIRMWARE("amdgpu/polaris10_smc_sk.bin"); - MODULE_FIRMWARE("amdgpu/polaris11_smc.bin"); - MODULE_FIRMWARE("amdgpu/polaris11_smc_sk.bin"); -+MODULE_FIRMWARE("amdgpu/polaris12_smc.bin"); - - /* - * Indirect registers accessor -@@ -312,6 +313,7 @@ static void vi_init_golden_registers(str - break; - case CHIP_POLARIS11: - case CHIP_POLARIS10: -+ case CHIP_POLARIS12: - default: - break; - } -@@ -592,6 +594,7 @@ static int vi_read_register(struct amdgp - case CHIP_TONGA: - case CHIP_POLARIS11: - case CHIP_POLARIS10: -+ case CHIP_POLARIS12: - case CHIP_CARRIZO: - case CHIP_STONEY: - asic_register_table = cz_allowed_read_registers; -@@ -1465,6 +1468,7 @@ int vi_set_ip_blocks(struct amdgpu_devic - break; - case CHIP_POLARIS11: - case CHIP_POLARIS10: -+ case CHIP_POLARIS12: - adev->ip_blocks = polaris11_ip_blocks_vd; - adev->num_ip_blocks = ARRAY_SIZE(polaris11_ip_blocks_vd); - break; -@@ -1608,6 +1612,11 @@ static int vi_common_early_init(void *ha - adev->pg_flags = 0; - adev->external_rev_id = adev->rev_id + 0x50; - break; -+ case CHIP_POLARIS12: -+ adev->cg_flags = AMD_CG_SUPPORT_UVD_MGCG; -+ adev->pg_flags = 0; -+ adev->external_rev_id = adev->rev_id + 0x64; -+ break; - case CHIP_CARRIZO: - adev->cg_flags = AMD_CG_SUPPORT_UVD_MGCG | - AMD_CG_SUPPORT_GFX_MGCG | -@@ -1897,6 +1906,7 @@ static int vi_common_set_clockgating_sta - case CHIP_TONGA: - case CHIP_POLARIS10: - case CHIP_POLARIS11: -+ case CHIP_POLARIS12: - vi_common_set_clockgating_state_by_smu(adev, state); - default: - break; -diff --git a/drivers/gpu/drm/amd/include/amd_shared.h b/drivers/gpu/drm/amd/include/amd_shared.h -index c02469a..5f59117 100644 ---- a/drivers/gpu/drm/amd/include/amd_shared.h -+++ b/drivers/gpu/drm/amd/include/amd_shared.h -@@ -46,6 +46,7 @@ enum amd_asic_type { - CHIP_STONEY, - CHIP_POLARIS10, - CHIP_POLARIS11, -+ CHIP_POLARIS12, - CHIP_LAST, - }; - --- -2.10.2 diff --git a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amdgpu-add-Polaris12-DID.patch b/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amdgpu-add-Polaris12-DID.patch deleted file mode 100644 index c58684f6..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amdgpu-add-Polaris12-DID.patch +++ /dev/null @@ -1,24 +0,0 @@ -From 6e88491cf2a3b17199c78bd53348b39dc6a88275 Mon Sep 17 00:00:00 2001 -From: Junshan Fang -Date: Thu, 15 Jun 2017 14:02:20 +0800 -Subject: [PATCH] drm/amdgpu: add Polaris12 DID - -Signed-off-by: Junshan Fang -Reviewed-by: Roger.He -Signed-off-by: Alex Deucher -Cc: stable@vger.kernel.org -Signed-off-by: Alex Deucher ---- - drivers/gpu/drm/amd/amdgpu/amdgpu_drv.c | 1 + - 1 file changed, 1 insertion(+) - -diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_drv.c b/drivers/gpu/drm/amd/amdgpu/amdgpu_drv.c -index f2d705e6a75a..ab6b0d0febab 100644 -@@ -418,6 +418,7 @@ static const struct pci_device_id pciidl - {0x1002, 0x6986, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, - {0x1002, 0x6987, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, - {0x1002, 0x6995, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, -+ {0x1002, 0x6997, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, - {0x1002, 0x699F, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_POLARIS12}, - - {0, 0, 0} diff --git a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amdgpu-pm-check-for-headless-before-calling-comp.patch b/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amdgpu-pm-check-for-headless-before-calling-comp.patch deleted file mode 100644 index de592904..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amdgpu-pm-check-for-headless-before-calling-comp.patch +++ /dev/null @@ -1,32 +0,0 @@ -From c10c8f7c27103bd7ac02d041d9d6e97296d48fc1 Mon Sep 17 00:00:00 2001 -From: Alex Deucher -Date: Fri, 10 Feb 2017 18:09:32 -0500 -Subject: [PATCH] drm/amdgpu/pm: check for headless before calling - compute_clocks - -Don't update display bandwidth on headless asics. - -bug: -https://bugs.freedesktop.org/show_bug.cgi?id=99387 - -Signed-off-by: Alex Deucher -Cc: stable@vger.kernel.org ---- - drivers/gpu/drm/amd/amdgpu/amdgpu_pm.c | 3 ++- - 1 file changed, 2 insertions(+), 1 deletion(-) - -diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_pm.c b/drivers/gpu/drm/amd/amdgpu/amdgpu_pm.c -index 95e026a..346e80a 100644 ---- a/drivers/gpu/drm/amd/amdgpu/amdgpu_pm.c -+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu_pm.c -@@ -1283,7 +1283,9 @@ void amdgpu_pm_compute_clocks(struct amd - if (adev->pp_enabled) { - int i = 0; - -- amdgpu_display_bandwidth_update(adev); -+ if (adev->mode_info.num_crtc) -+ amdgpu_display_bandwidth_update(adev); -+ - for (i = 0; i < AMDGPU_MAX_RINGS; i++) { - struct amdgpu_ring *ring = adev->rings[i]; - if (ring && ring->ready) diff --git a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amdgpu-powerplay-add-Polaris12-support.patch b/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amdgpu-powerplay-add-Polaris12-support.patch deleted file mode 100644 index 7b2b0f63..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-amdgpu-powerplay-add-Polaris12-support.patch +++ /dev/null @@ -1,81 +0,0 @@ -From f4309526576db325264b6dc9ee150ee70b330a42 Mon Sep 17 00:00:00 2001 -From: Junwei Zhang -Date: Wed, 14 Dec 2016 15:40:48 -0500 -Subject: [PATCH] drm/amdgpu/powerplay: add Polaris12 support -MIME-Version: 1.0 -Content-Type: text/plain; charset=UTF-8 -Content-Transfer-Encoding: 8bit - -Signed-off-by: Junwei Zhang -Reviewed-by: Alex Deucher -Reviewed-by: Christian König -Reviewed-by: Ken Wang -Signed-off-by: Alex Deucher ---- - drivers/gpu/drm/amd/amdgpu/amdgpu_powerplay.c | 1 + - drivers/gpu/drm/amd/powerplay/hwmgr/hwmgr.c | 3 ++- - drivers/gpu/drm/amd/powerplay/hwmgr/smu7_powertune.c | 2 +- - drivers/gpu/drm/amd/powerplay/smumgr/smumgr.c | 1 + - 4 files changed, 5 insertions(+), 2 deletions(-) - -diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_powerplay.c b/drivers/gpu/drm/amd/amdgpu/amdgpu_powerplay.c -index fc592c2..95a568d 100644 ---- a/drivers/gpu/drm/amd/amdgpu/amdgpu_powerplay.c -+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu_powerplay.c -@@ -98,6 +98,7 @@ static int amdgpu_pp_early_init(void *handle) - switch (adev->asic_type) { - case CHIP_POLARIS11: - case CHIP_POLARIS10: -+ case CHIP_POLARIS12: - case CHIP_TONGA: - case CHIP_FIJI: - case CHIP_TOPAZ: -diff --git a/drivers/gpu/drm/amd/powerplay/hwmgr/hwmgr.c b/drivers/gpu/drm/amd/powerplay/hwmgr/hwmgr.c -index dc6700a..b036064 100644 ---- a/drivers/gpu/drm/amd/powerplay/hwmgr/hwmgr.c -+++ b/drivers/gpu/drm/amd/powerplay/hwmgr/hwmgr.c -@@ -95,6 +95,7 @@ int hwmgr_init(struct amd_pp_init *pp_init, struct pp_instance *handle) - break; - case CHIP_POLARIS11: - case CHIP_POLARIS10: -+ case CHIP_POLARIS12: - polaris_set_asic_special_caps(hwmgr); - hwmgr->feature_mask &= ~(PP_UVD_HANDSHAKE_MASK); - break; -@@ -745,7 +746,7 @@ int polaris_set_asic_special_caps(struct pp_hwmgr *hwmgr) - phm_cap_set(hwmgr->platform_descriptor.platformCaps, - PHM_PlatformCaps_TablelessHardwareInterface); - -- if (hwmgr->chip_id == CHIP_POLARIS11) -+ if ((hwmgr->chip_id == CHIP_POLARIS11) || (hwmgr->chip_id == CHIP_POLARIS12)) - phm_cap_set(hwmgr->platform_descriptor.platformCaps, - PHM_PlatformCaps_SPLLShutdownSupport); - return 0; -diff --git a/drivers/gpu/drm/amd/powerplay/hwmgr/smu7_powertune.c b/drivers/gpu/drm/amd/powerplay/hwmgr/smu7_powertune.c -index 26477f0..6cd1287 100644 ---- a/drivers/gpu/drm/amd/powerplay/hwmgr/smu7_powertune.c -+++ b/drivers/gpu/drm/amd/powerplay/hwmgr/smu7_powertune.c -@@ -521,7 +521,7 @@ int smu7_enable_didt_config(struct pp_hwmgr *hwmgr) - PP_ASSERT_WITH_CODE((result == 0), "DIDT Config failed.", return result); - result = smu7_program_pt_config_registers(hwmgr, DIDTConfig_Polaris10); - PP_ASSERT_WITH_CODE((result == 0), "DIDT Config failed.", return result); -- } else if (hwmgr->chip_id == CHIP_POLARIS11) { -+ } else if ((hwmgr->chip_id == CHIP_POLARIS11) || (hwmgr->chip_id == CHIP_POLARIS12)) { - result = smu7_program_pt_config_registers(hwmgr, GCCACConfig_Polaris11); - PP_ASSERT_WITH_CODE((result == 0), "DIDT Config failed.", return result); - result = smu7_program_pt_config_registers(hwmgr, DIDTConfig_Polaris11); -diff --git a/drivers/gpu/drm/amd/powerplay/smumgr/smumgr.c b/drivers/gpu/drm/amd/powerplay/smumgr/smumgr.c -index e5812aa..6e618aa 100644 ---- a/drivers/gpu/drm/amd/powerplay/smumgr/smumgr.c -+++ b/drivers/gpu/drm/amd/powerplay/smumgr/smumgr.c -@@ -65,6 +65,7 @@ int smum_init(struct amd_pp_init *pp_init, struct pp_instance *handle) - break; - case CHIP_POLARIS11: - case CHIP_POLARIS10: -+ case CHIP_POLARIS12: - polaris10_smum_init(smumgr); - break; - default: --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-i915-don-t-warn-about-Skylake-CPU-KabyPoint-PCH-.patch b/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-i915-don-t-warn-about-Skylake-CPU-KabyPoint-PCH-.patch deleted file mode 100644 index aaf9bb26..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/gpu-drm-i915-don-t-warn-about-Skylake-CPU-KabyPoint-PCH-.patch +++ /dev/null @@ -1,42 +0,0 @@ -From 853277481178fdf14d1a4e9e6ac7174d6046176f Mon Sep 17 00:00:00 2001 -From: Jani Nikula -Date: Wed, 1 Feb 2017 15:46:09 +0200 -Subject: [PATCH] drm/i915: don't warn about Skylake CPU - KabyPoint PCH combo - -Apparently there are machines out there with Skylake CPU and KabyPoint -PCH. Judging from our driver code, there doesn't seem to be any code -paths that would do anything different between SunrisePoint and -KabyPoint PCHs, so it would seem okay to accept the combo without -warnings. - -Fixes: 22dea0be50b2 ("drm/i915: Introduce Kabypoint PCH for Kabylake H/DT.") -References: https://lists.freedesktop.org/archives/intel-gfx/2017-February/118611.html -Reported-by: Rainer Koenig -Cc: Rainer Koenig -Cc: Rodrigo Vivi -Cc: # v4.8+ -Reviewed-by: Rodrigo Vivi -Signed-off-by: Jani Nikula -Link: http://patchwork.freedesktop.org/patch/msgid/1485956769-26015-1-git-send-email-jani.nikula@intel.com -(cherry picked from commit 3aac4acb89710fe782c9e78e7b1febf76e112c6c) -Signed-off-by: Jani Nikula -[ rebased for 4.9 / tmb ] -Signed-off-by: Thomas Backlund ---- - drivers/gpu/drm/i915/i915_drv.c | 3 ++- - 1 file changed, 2 insertions(+), 1 deletion(-) - -diff --git a/drivers/gpu/drm/i915/i915_drv.c b/drivers/gpu/drm/i915/i915_drv.c -index b2c4a0b..8d63098 100644 ---- a/drivers/gpu/drm/i915/i915_drv.c -+++ b/drivers/gpu/drm/i915/i915_drv.c -@@ -207,7 +207,8 @@ static void intel_detect_pch(struct drm_ - } else if (id == INTEL_PCH_KBP_DEVICE_ID_TYPE) { - dev_priv->pch_type = PCH_KBP; - DRM_DEBUG_KMS("Found KabyPoint PCH\n"); -- WARN_ON(!IS_KABYLAKE(dev)); -+ WARN_ON(!IS_SKYLAKE(dev) && -+ !IS_KABYLAKE(dev)); - } else if ((id == INTEL_PCH_P2X_DEVICE_ID_TYPE) || - (id == INTEL_PCH_P3X_DEVICE_ID_TYPE) || - ((id == INTEL_PCH_QEMU_DEVICE_ID_TYPE) && diff --git a/kernel/tools/cpupowertools/files/patches/mageia/hwmon-k10temp-Add-support-for-family-17h.patch b/kernel/tools/cpupowertools/files/patches/mageia/hwmon-k10temp-Add-support-for-family-17h.patch new file mode 100644 index 00000000..eda09934 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/hwmon-k10temp-Add-support-for-family-17h.patch @@ -0,0 +1,70 @@ +From 9af0a9aecdb945cd5513941ffdcbcc031009b402 Mon Sep 17 00:00:00 2001 +From: Guenter Roeck +Date: Mon, 4 Sep 2017 18:33:53 -0700 +Subject: hwmon: (k10temp) Add support for family 17h + +Add support for temperature sensors on Family 17h (Ryzen) processors. + +Signed-off-by: Guenter Roeck +--- + drivers/hwmon/k10temp.c | 16 ++++++++++++++++ + 1 file changed, 16 insertions(+) + +diff --git a/drivers/hwmon/k10temp.c b/drivers/hwmon/k10temp.c +index fc8076c..c4dac53 100644 +--- a/drivers/hwmon/k10temp.c ++++ b/drivers/hwmon/k10temp.c +@@ -36,6 +36,10 @@ MODULE_PARM_DESC(force, "force loading on processors with erratum 319"); + /* Provide lock for writing to NB_SMU_IND_ADDR */ + static DEFINE_MUTEX(nb_smu_ind_mutex); + ++#ifndef PCI_DEVICE_ID_AMD_17H_DF_F3 ++#define PCI_DEVICE_ID_AMD_17H_DF_F3 0x1463 ++#endif ++ + /* CPUID function 0x80000001, ebx */ + #define CPUID_PKGTYPE_MASK 0xf0000000 + #define CPUID_PKGTYPE_F 0x00000000 +@@ -61,6 +65,9 @@ static DEFINE_MUTEX(nb_smu_ind_mutex); + */ + #define F15H_M60H_REPORTED_TEMP_CTRL_OFFSET 0xd8200ca4 + ++/* F17h M01h Access througn SMN */ ++#define F17H_M01H_REPORTED_TEMP_CTRL_OFFSET 0x00059800 ++ + struct k10temp_data { + struct pci_dev *pdev; + void (*read_tempreg)(struct pci_dev *pdev, u32 *regval); +@@ -88,6 +95,12 @@ static void read_tempreg_nb_f15(struct pci_dev *pdev, u32 *regval) + F15H_M60H_REPORTED_TEMP_CTRL_OFFSET, regval); + } + ++static void read_tempreg_nb_f17(struct pci_dev *pdev, u32 *regval) ++{ ++ amd_nb_index_read(pdev, PCI_DEVFN(0, 0), 0x60, ++ F17H_M01H_REPORTED_TEMP_CTRL_OFFSET, regval); ++} ++ + static ssize_t temp1_input_show(struct device *dev, + struct device_attribute *attr, char *buf) + { +@@ -224,6 +237,8 @@ static int k10temp_probe(struct pci_dev *pdev, + if (boot_cpu_data.x86 == 0x15 && (boot_cpu_data.x86_model == 0x60 || + boot_cpu_data.x86_model == 0x70)) + data->read_tempreg = read_tempreg_nb_f15; ++ else if (boot_cpu_data.x86 == 0x17) ++ data->read_tempreg = read_tempreg_nb_f17; + else + data->read_tempreg = read_tempreg_pci; + +@@ -242,6 +257,7 @@ static const struct pci_device_id k10temp_id_table[] = { + { PCI_VDEVICE(AMD, PCI_DEVICE_ID_AMD_15H_M60H_NB_F3) }, + { PCI_VDEVICE(AMD, PCI_DEVICE_ID_AMD_16H_NB_F3) }, + { PCI_VDEVICE(AMD, PCI_DEVICE_ID_AMD_16H_M30H_NB_F3) }, ++ { PCI_VDEVICE(AMD, PCI_DEVICE_ID_AMD_17H_DF_F3) }, + {} + }; + MODULE_DEVICE_TABLE(pci, k10temp_id_table); +-- +cgit v1.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/hwmon-k10temp-Add-support-for-temperature-offsets.patch b/kernel/tools/cpupowertools/files/patches/mageia/hwmon-k10temp-Add-support-for-temperature-offsets.patch new file mode 100644 index 00000000..b7d650b3 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/hwmon-k10temp-Add-support-for-temperature-offsets.patch @@ -0,0 +1,80 @@ +From 1b50b776355fa6c6d7b3281a63c275d5c18d629d Mon Sep 17 00:00:00 2001 +From: Guenter Roeck +Date: Mon, 4 Sep 2017 18:33:53 -0700 +Subject: hwmon: (k10temp) Add support for temperature offsets + +Add support for handling temperature offset values for various AMD CPUs, +similar to the code used in the coretemp driver for Intel CPUs. This is +primarily for Ryzen CPUs (which has documented temperature offsets), +but the code is kept generic to simplify adding additional CPUs. + +Signed-off-by: Guenter Roeck +--- + drivers/hwmon/k10temp.c | 30 ++++++++++++++++++++++++++++++ + 1 file changed, 30 insertions(+) + +diff --git a/drivers/hwmon/k10temp.c b/drivers/hwmon/k10temp.c +index c4dac53..46a54ed 100644 +--- a/drivers/hwmon/k10temp.c ++++ b/drivers/hwmon/k10temp.c +@@ -71,6 +71,24 @@ static DEFINE_MUTEX(nb_smu_ind_mutex); + struct k10temp_data { + struct pci_dev *pdev; + void (*read_tempreg)(struct pci_dev *pdev, u32 *regval); ++ int temp_offset; ++}; ++ ++struct tctl_offset { ++ u8 model; ++ char const *id; ++ int offset; ++}; ++ ++static const struct tctl_offset tctl_offset_table[] = { ++ { 0x17, "AMD Ryzen 7 1600X", 20000 }, ++ { 0x17, "AMD Ryzen 7 1700X", 20000 }, ++ { 0x17, "AMD Ryzen 7 1800X", 20000 }, ++ { 0x17, "AMD Ryzen Threadripper 1950X", 27000 }, ++ { 0x17, "AMD Ryzen Threadripper 1920X", 27000 }, ++ { 0x17, "AMD Ryzen Threadripper 1950", 10000 }, ++ { 0x17, "AMD Ryzen Threadripper 1920", 10000 }, ++ { 0x17, "AMD Ryzen Threadripper 1910", 10000 }, + }; + + static void read_tempreg_pci(struct pci_dev *pdev, u32 *regval) +@@ -110,6 +128,7 @@ static ssize_t temp1_input_show(struct device *dev, + + data->read_tempreg(data->pdev, ®val); + temp = (regval >> 21) * 125; ++ temp -= data->temp_offset; + + return sprintf(buf, "%u\n", temp); + } +@@ -217,6 +236,7 @@ static int k10temp_probe(struct pci_dev *pdev, + struct device *dev = &pdev->dev; + struct k10temp_data *data; + struct device *hwmon_dev; ++ int i; + + if (unreliable) { + if (!force) { +@@ -242,6 +262,16 @@ static int k10temp_probe(struct pci_dev *pdev, + else + data->read_tempreg = read_tempreg_pci; + ++ for (i = 0; i < ARRAY_SIZE(tctl_offset_table); i++) { ++ const struct tctl_offset *entry = &tctl_offset_table[i]; ++ ++ if (boot_cpu_data.x86 == entry->model && ++ strstr(boot_cpu_data.x86_model_id, entry->id)) { ++ data->temp_offset = entry->offset; ++ break; ++ } ++ } ++ + hwmon_dev = devm_hwmon_device_register_with_groups(dev, "k10temp", data, + k10temp_groups); + return PTR_ERR_OR_ZERO(hwmon_dev); +-- +cgit v1.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/hwmon-k10temp-Move-chip-specific-code-into-probe-function.patch b/kernel/tools/cpupowertools/files/patches/mageia/hwmon-k10temp-Move-chip-specific-code-into-probe-function.patch new file mode 100644 index 00000000..c171d274 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/hwmon-k10temp-Move-chip-specific-code-into-probe-function.patch @@ -0,0 +1,132 @@ +From 68546abf7a3a63f199e53d6dcaa7375df37a6aaa Mon Sep 17 00:00:00 2001 +From: Guenter Roeck +Date: Mon, 4 Sep 2017 18:33:53 -0700 +Subject: hwmon: (k10temp) Move chip specific code into probe function + +Introduce a local data structure and determine the temperature read +function at probe time to reduce runtime complexity. + +Signed-off-by: Guenter Roeck +--- + drivers/hwmon/k10temp.c | 62 +++++++++++++++++++++++++++++++++++-------------- + 1 file changed, 45 insertions(+), 17 deletions(-) + +diff --git a/drivers/hwmon/k10temp.c b/drivers/hwmon/k10temp.c +index ce3b91f..fc8076c 100644 +--- a/drivers/hwmon/k10temp.c ++++ b/drivers/hwmon/k10temp.c +@@ -61,31 +61,44 @@ static DEFINE_MUTEX(nb_smu_ind_mutex); + */ + #define F15H_M60H_REPORTED_TEMP_CTRL_OFFSET 0xd8200ca4 + +-static void amd_nb_smu_index_read(struct pci_dev *pdev, unsigned int devfn, +- int offset, u32 *val) ++struct k10temp_data { ++ struct pci_dev *pdev; ++ void (*read_tempreg)(struct pci_dev *pdev, u32 *regval); ++}; ++ ++static void read_tempreg_pci(struct pci_dev *pdev, u32 *regval) ++{ ++ pci_read_config_dword(pdev, REG_REPORTED_TEMPERATURE, regval); ++} ++ ++static void amd_nb_index_read(struct pci_dev *pdev, unsigned int devfn, ++ unsigned int base, int offset, u32 *val) + { + mutex_lock(&nb_smu_ind_mutex); + pci_bus_write_config_dword(pdev->bus, devfn, +- 0xb8, offset); ++ base, offset); + pci_bus_read_config_dword(pdev->bus, devfn, +- 0xbc, val); ++ base + 4, val); + mutex_unlock(&nb_smu_ind_mutex); + } + ++static void read_tempreg_nb_f15(struct pci_dev *pdev, u32 *regval) ++{ ++ amd_nb_index_read(pdev, PCI_DEVFN(0, 0), 0xb8, ++ F15H_M60H_REPORTED_TEMP_CTRL_OFFSET, regval); ++} ++ + static ssize_t temp1_input_show(struct device *dev, + struct device_attribute *attr, char *buf) + { ++ struct k10temp_data *data = dev_get_drvdata(dev); + u32 regval; +- struct pci_dev *pdev = dev_get_drvdata(dev); +- +- if (boot_cpu_data.x86 == 0x15 && boot_cpu_data.x86_model == 0x60) { +- amd_nb_smu_index_read(pdev, PCI_DEVFN(0, 0), +- F15H_M60H_REPORTED_TEMP_CTRL_OFFSET, +- ®val); +- } else { +- pci_read_config_dword(pdev, REG_REPORTED_TEMPERATURE, ®val); +- } +- return sprintf(buf, "%u\n", (regval >> 21) * 125); ++ unsigned int temp; ++ ++ data->read_tempreg(data->pdev, ®val); ++ temp = (regval >> 21) * 125; ++ ++ return sprintf(buf, "%u\n", temp); + } + + static ssize_t temp1_max_show(struct device *dev, +@@ -98,11 +111,12 @@ static ssize_t show_temp_crit(struct device *dev, + struct device_attribute *devattr, char *buf) + { + struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); ++ struct k10temp_data *data = dev_get_drvdata(dev); + int show_hyst = attr->index; + u32 regval; + int value; + +- pci_read_config_dword(dev_get_drvdata(dev), ++ pci_read_config_dword(data->pdev, + REG_HARDWARE_THERMAL_CONTROL, ®val); + value = ((regval >> 16) & 0x7f) * 500 + 52000; + if (show_hyst) +@@ -119,7 +133,8 @@ static umode_t k10temp_is_visible(struct kobject *kobj, + struct attribute *attr, int index) + { + struct device *dev = container_of(kobj, struct device, kobj); +- struct pci_dev *pdev = dev_get_drvdata(dev); ++ struct k10temp_data *data = dev_get_drvdata(dev); ++ struct pci_dev *pdev = data->pdev; + + if (index >= 2) { + u32 reg_caps, reg_htc; +@@ -187,6 +202,7 @@ static int k10temp_probe(struct pci_dev *pdev, + { + int unreliable = has_erratum_319(pdev); + struct device *dev = &pdev->dev; ++ struct k10temp_data *data; + struct device *hwmon_dev; + + if (unreliable) { +@@ -199,7 +215,19 @@ static int k10temp_probe(struct pci_dev *pdev, + "unreliable CPU thermal sensor; check erratum 319\n"); + } + +- hwmon_dev = devm_hwmon_device_register_with_groups(dev, "k10temp", pdev, ++ data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); ++ if (!data) ++ return -ENOMEM; ++ ++ data->pdev = pdev; ++ ++ if (boot_cpu_data.x86 == 0x15 && (boot_cpu_data.x86_model == 0x60 || ++ boot_cpu_data.x86_model == 0x70)) ++ data->read_tempreg = read_tempreg_nb_f15; ++ else ++ data->read_tempreg = read_tempreg_pci; ++ ++ hwmon_dev = devm_hwmon_device_register_with_groups(dev, "k10temp", data, + k10temp_groups); + return PTR_ERR_OR_ZERO(hwmon_dev); + } +-- +cgit v1.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/include-kbuild-export-pci_ids.patch b/kernel/tools/cpupowertools/files/patches/mageia/include-kbuild-export-pci_ids.patch deleted file mode 100644 index ebcf9832..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/include-kbuild-export-pci_ids.patch +++ /dev/null @@ -1,19 +0,0 @@ -From Thierry Vignaud (Mandriva) - -We now lacks /usr/include/linux/pci_ids.h which break ldetect build... -Can you readd it please? -Thanks ---- - include/linux/Kbuild | 1 + - 1 file changed, 1 insertion(+) - ---- linux/include/uapi/linux/Kbuild.include-kbuild-export-pci_ids.orig -+++ linux/include/uapi/linux/Kbuild -@@ -277,6 +277,7 @@ header-y += param.h - header-y += parport.h - header-y += patchkey.h - header-y += pci.h -+header-y += pci_ids.h - header-y += pci_regs.h - header-y += perf_event.h - header-y += personality.h diff --git a/kernel/tools/cpupowertools/files/patches/mageia/iommu-amd-flush-IOTLB-for-specific-domains-only-v3.patch b/kernel/tools/cpupowertools/files/patches/mageia/iommu-amd-flush-IOTLB-for-specific-domains-only-v3.patch deleted file mode 100644 index 9d28dcef..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/iommu-amd-flush-IOTLB-for-specific-domains-only-v3.patch +++ /dev/null @@ -1,102 +0,0 @@ -From: Arindam Nath - -Change History --------------- - -v3: -- add Fixes and CC tags -- add link to Bugzilla - -v2: changes suggested by Joerg -- add flush flag to improve efficiency of flush operation - -v1: -- The idea behind flush queues is to defer the IOTLB flushing - for domains for which the mappings are no longer valid. We - add such domains in queue_add(), and when the queue size - reaches FLUSH_QUEUE_SIZE, we perform __queue_flush(). - - Since we have already taken lock before __queue_flush() - is called, we need to make sure the IOTLB flushing is - performed as quickly as possible. - - In the current implementation, we perform IOTLB flushing - for all domains irrespective of which ones were actually - added in the flush queue initially. This can be quite - expensive especially for domains for which unmapping is - not required at this point of time. - - This patch makes use of domain information in - 'struct flush_queue_entry' to make sure we only flush - IOTLBs for domains who need it, skipping others. - -Bugzilla: https://bugs.freedesktop.org/101029 -Fixes: b1516a14657a ("iommu/amd: Implement flush queue") -Cc: stable@vger.kernel.org -Suggested-by: Joerg Roedel -Signed-off-by: Arindam Nath ---- - drivers/iommu/amd_iommu.c | 27 ++++++++++++++++++++------- - drivers/iommu/amd_iommu_types.h | 2 ++ - 2 files changed, 22 insertions(+), 7 deletions(-) - -diff --git a/drivers/iommu/amd_iommu.c b/drivers/iommu/amd_iommu.c -index 63cacf5..1edeebec 100644 ---- a/drivers/iommu/amd_iommu.c -+++ b/drivers/iommu/amd_iommu.c -@@ -2227,15 +2227,26 @@ static struct iommu_group *amd_iommu_device_group(struct device *dev) - - static void __queue_flush(struct flush_queue *queue) - { -- struct protection_domain *domain; -- unsigned long flags; - int idx; - -- /* First flush TLB of all known domains */ -- spin_lock_irqsave(&amd_iommu_pd_lock, flags); -- list_for_each_entry(domain, &amd_iommu_pd_list, list) -- domain_flush_tlb(domain); -- spin_unlock_irqrestore(&amd_iommu_pd_lock, flags); -+ /* First flush TLB of all domains which were added to flush queue */ -+ for (idx = 0; idx < queue->next; ++idx) { -+ struct flush_queue_entry *entry; -+ -+ entry = queue->entries + idx; -+ -+ /* -+ * There might be cases where multiple IOVA entries for the -+ * same domain are queued in the flush queue. To avoid -+ * flushing the same domain again, we check whether the -+ * flag is set or not. This improves the efficiency of -+ * flush operation. -+ */ -+ if (!entry->dma_dom->domain.already_flushed) { -+ entry->dma_dom->domain.already_flushed = true; -+ domain_flush_tlb(&entry->dma_dom->domain); -+ } -+ } - - /* Wait until flushes have completed */ - domain_flush_complete(NULL); -@@ -2289,6 +2300,8 @@ static void queue_add(struct dma_ops_domain *dma_dom, - pages = __roundup_pow_of_two(pages); - address >>= PAGE_SHIFT; - -+ dma_dom->domain.already_flushed = false; -+ - queue = get_cpu_ptr(&flush_queue); - spin_lock_irqsave(&queue->lock, flags); - -diff --git a/drivers/iommu/amd_iommu_types.h b/drivers/iommu/amd_iommu_types.h -index 4de8f41..4f5519d 100644 ---- a/drivers/iommu/amd_iommu_types.h -+++ b/drivers/iommu/amd_iommu_types.h -@@ -454,6 +454,8 @@ struct protection_domain { - bool updated; /* complete domain flush required */ - unsigned dev_cnt; /* devices assigned to this domain */ - unsigned dev_iommu[MAX_IOMMUS]; /* per-IOMMU reference count */ -+ bool already_flushed; /* flag to avoid flushing the same domain again -+ in a single invocation of __queue_flush() */ - }; - - /* diff --git a/kernel/tools/cpupowertools/files/patches/mageia/mm-page_vma_mapped-Introduce-pfn_in_hpage.patch b/kernel/tools/cpupowertools/files/patches/mageia/mm-page_vma_mapped-Introduce-pfn_in_hpage.patch new file mode 100644 index 00000000..71f6c656 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/mm-page_vma_mapped-Introduce-pfn_in_hpage.patch @@ -0,0 +1,58 @@ +From 7222708e823afc98dfb769d36bf2f26b6420b7ce Mon Sep 17 00:00:00 2001 +From: "Kirill A. Shutemov" +Date: Mon, 22 Jan 2018 12:22:30 +0300 +Subject: [PATCH] mm, page_vma_mapped: Introduce pfn_in_hpage() + +The new helper would check if the pfn belongs to the page. For huge +pages it checks if the PFN is within range covered by the huge page. + +The helper is used in check_pte(). The original code the helper replaces +had two call to page_to_pfn(). page_to_pfn() is relatively costly. + +Although current GCC is able to optimize code to have one call, it's +better to do this explicitly. + +Signed-off-by: Kirill A. Shutemov +Signed-off-by: Linus Torvalds +--- + mm/page_vma_mapped.c | 17 +++++++++-------- + 1 file changed, 9 insertions(+), 8 deletions(-) + +diff --git a/mm/page_vma_mapped.c b/mm/page_vma_mapped.c +index 956015614395..ae3c2a35d61b 100644 +--- a/mm/page_vma_mapped.c ++++ b/mm/page_vma_mapped.c +@@ -30,6 +30,14 @@ static bool map_pte(struct page_vma_mapped_walk *pvmw) + return true; + } + ++static inline bool pfn_in_hpage(struct page *hpage, unsigned long pfn) ++{ ++ unsigned long hpage_pfn = page_to_pfn(hpage); ++ ++ /* THP can be referenced by any subpage */ ++ return pfn >= hpage_pfn && pfn - hpage_pfn < hpage_nr_pages(hpage); ++} ++ + /** + * check_pte - check if @pvmw->page is mapped at the @pvmw->pte + * +@@ -78,14 +86,7 @@ static bool check_pte(struct page_vma_mapped_walk *pvmw) + pfn = pte_pfn(*pvmw->pte); + } + +- if (pfn < page_to_pfn(pvmw->page)) +- return false; +- +- /* THP can be referenced by any subpage */ +- if (pfn - page_to_pfn(pvmw->page) >= hpage_nr_pages(pvmw->page)) +- return false; +- +- return true; ++ return pfn_in_hpage(pvmw->page, pfn); + } + + /** +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/net-WireGuard.patch b/kernel/tools/cpupowertools/files/patches/mageia/net-WireGuard.patch new file mode 100644 index 00000000..e42e438c --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/net-WireGuard.patch @@ -0,0 +1,32576 @@ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/allowedips.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,327 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "allowedips.h" ++#include "peer.h" ++ ++struct allowedips_node { ++ struct wireguard_peer *peer; ++ struct rcu_head rcu; ++ struct allowedips_node __rcu *bit[2]; ++ /* While it may seem scandalous that we waste space for v4, ++ * we're alloc'ing to the nearest power of 2 anyway, so this ++ * doesn't actually make a difference. ++ */ ++ union { ++ __be64 v6[2]; ++ __be32 v4; ++ u8 bits[16]; ++ }; ++ u8 cidr, bit_at_a, bit_at_b; ++}; ++ ++static void copy_and_assign_cidr(struct allowedips_node *node, const u8 *src, u8 cidr) ++{ ++ node->cidr = cidr; ++ node->bit_at_a = cidr / 8; ++ node->bit_at_b = 7 - (cidr % 8); ++ if (cidr) { ++ memcpy(node->bits, src, (cidr + 7) / 8); ++ node->bits[(cidr + 7) / 8 - 1] &= ~0U << ((8 - (cidr % 8)) % 8); ++ } ++} ++ ++#define choose_node(parent, key) parent->bit[(key[parent->bit_at_a] >> parent->bit_at_b) & 1] ++ ++static void node_free_rcu(struct rcu_head *rcu) ++{ ++ kfree(container_of(rcu, struct allowedips_node, rcu)); ++} ++ ++#define push(stack, p, len) ({ \ ++ if (rcu_access_pointer(p)) { \ ++ BUG_ON(len >= 128); \ ++ stack[len++] = rcu_dereference_protected(p, lockdep_is_held(lock)); \ ++ } \ ++ true; \ ++}) ++static void free_root_node(struct allowedips_node __rcu *top, struct mutex *lock) ++{ ++ struct allowedips_node *stack[128], *node; ++ unsigned int len; ++ ++ for (len = 0, push(stack, top, len); len > 0 && (node = stack[--len]) && push(stack, node->bit[0], len) && push(stack, node->bit[1], len);) ++ call_rcu_bh(&node->rcu, node_free_rcu); ++} ++ ++static int walk_by_peer(struct allowedips_node __rcu *top, int family, struct allowedips_cursor *cursor, struct wireguard_peer *peer, int (*func)(void *ctx, const u8 *ip, u8 cidr, int family), void *ctx, struct mutex *lock) ++{ ++ struct allowedips_node *node; ++ int ret; ++ ++ if (!rcu_access_pointer(top)) ++ return 0; ++ ++ if (!cursor->len) ++ push(cursor->stack, top, cursor->len); ++ ++ for (; cursor->len > 0 && (node = cursor->stack[cursor->len - 1]); --cursor->len, push(cursor->stack, node->bit[0], cursor->len), push(cursor->stack, node->bit[1], cursor->len)) { ++ if (node->peer != peer) ++ continue; ++ ret = func(ctx, node->bits, node->cidr, family); ++ if (ret) ++ return ret; ++ } ++ return 0; ++} ++#undef push ++ ++#define ref(p) rcu_access_pointer(p) ++#define deref(p) rcu_dereference_protected(*p, lockdep_is_held(lock)) ++#define push(p) ({ BUG_ON(len >= 128); stack[len++] = p; }) ++static void walk_remove_by_peer(struct allowedips_node __rcu **top, struct wireguard_peer *peer, struct mutex *lock) ++{ ++ struct allowedips_node __rcu **stack[128], **nptr; ++ struct allowedips_node *node, *prev; ++ unsigned int len; ++ ++ if (unlikely(!peer || !ref(*top))) ++ return; ++ ++ for (prev = NULL, len = 0, push(top); len > 0; prev = node) { ++ nptr = stack[len - 1]; ++ node = deref(nptr); ++ if (!node) { ++ --len; ++ continue; ++ } ++ if (!prev || ref(prev->bit[0]) == node || ref(prev->bit[1]) == node) { ++ if (ref(node->bit[0])) ++ push(&node->bit[0]); ++ else if (ref(node->bit[1])) ++ push(&node->bit[1]); ++ } else if (ref(node->bit[0]) == prev) { ++ if (ref(node->bit[1])) ++ push(&node->bit[1]); ++ } else { ++ if (node->peer == peer) { ++ node->peer = NULL; ++ if (!node->bit[0] || !node->bit[1]) { ++ rcu_assign_pointer(*nptr, deref(&node->bit[!ref(node->bit[0])])); ++ call_rcu_bh(&node->rcu, node_free_rcu); ++ node = deref(nptr); ++ } ++ } ++ --len; ++ } ++ } ++} ++#undef ref ++#undef deref ++#undef push ++ ++static __always_inline unsigned int fls128(u64 a, u64 b) ++{ ++ return a ? fls64(a) + 64 : fls64(b); ++} ++ ++static __always_inline u8 common_bits(const struct allowedips_node *node, const u8 *key, u8 bits) ++{ ++ if (bits == 32) ++ return 32 - fls(be32_to_cpu(*(const __be32 *)node->bits ^ *(const __be32 *)key)); ++ else if (bits == 128) ++ return 128 - fls128(be64_to_cpu(*(const __be64 *)&node->bits[0] ^ *(const __be64 *)&key[0]), be64_to_cpu(*(const __be64 *)&node->bits[8] ^ *(const __be64 *)&key[8])); ++ return 0; ++} ++ ++/* This could be much faster if it actually just compared the common bits properly, ++ * by precomputing a mask bswap(~0 << (32 - cidr)), and the rest, but it turns out that ++ * common_bits is already super fast on modern processors, even taking into account ++ * the unfortunate bswap. So, we just inline it like this instead. */ ++#define prefix_matches(node, key, bits) (common_bits(node, key, bits) >= node->cidr) ++ ++static __always_inline struct allowedips_node *find_node(struct allowedips_node *trie, u8 bits, const u8 *key) ++{ ++ struct allowedips_node *node = trie, *found = NULL; ++ ++ while (node && prefix_matches(node, key, bits)) { ++ if (node->peer) ++ found = node; ++ if (node->cidr == bits) ++ break; ++ node = rcu_dereference_bh(choose_node(node, key)); ++ } ++ return found; ++} ++ ++/* Returns a strong reference to a peer */ ++static __always_inline struct wireguard_peer *lookup(struct allowedips_node __rcu *root, u8 bits, const void *ip) ++{ ++ struct wireguard_peer *peer = NULL; ++ struct allowedips_node *node; ++ ++ rcu_read_lock_bh(); ++ node = find_node(rcu_dereference_bh(root), bits, ip); ++ if (node) ++ peer = peer_get(node->peer); ++ rcu_read_unlock_bh(); ++ return peer; ++} ++ ++__attribute__((nonnull(1))) ++static inline bool node_placement(struct allowedips_node __rcu *trie, const u8 *key, u8 cidr, u8 bits, struct allowedips_node **rnode, struct mutex *lock) ++{ ++ bool exact = false; ++ struct allowedips_node *parent = NULL, *node = rcu_dereference_protected(trie, lockdep_is_held(lock)); ++ ++ while (node && node->cidr <= cidr && prefix_matches(node, key, bits)) { ++ parent = node; ++ if (parent->cidr == cidr) { ++ exact = true; ++ break; ++ } ++ node = rcu_dereference_protected(choose_node(parent, key), lockdep_is_held(lock)); ++ } ++ *rnode = parent; ++ return exact; ++} ++ ++static int add(struct allowedips_node __rcu **trie, u8 bits, const u8 *key, u8 cidr, struct wireguard_peer *peer, struct mutex *lock) ++{ ++ struct allowedips_node *node, *parent, *down, *newnode; ++ ++ if (unlikely(cidr > bits || !peer)) ++ return -EINVAL; ++ ++ if (!rcu_access_pointer(*trie)) { ++ node = kzalloc(sizeof(*node), GFP_KERNEL); ++ if (!node) ++ return -ENOMEM; ++ node->peer = peer; ++ copy_and_assign_cidr(node, key, cidr); ++ rcu_assign_pointer(*trie, node); ++ return 0; ++ } ++ if (node_placement(*trie, key, cidr, bits, &node, lock)) { ++ node->peer = peer; ++ return 0; ++ } ++ ++ newnode = kzalloc(sizeof(*newnode), GFP_KERNEL); ++ if (!newnode) ++ return -ENOMEM; ++ newnode->peer = peer; ++ copy_and_assign_cidr(newnode, key, cidr); ++ ++ if (!node) ++ down = rcu_dereference_protected(*trie, lockdep_is_held(lock)); ++ else { ++ down = rcu_dereference_protected(choose_node(node, key), lockdep_is_held(lock)); ++ if (!down) { ++ rcu_assign_pointer(choose_node(node, key), newnode); ++ return 0; ++ } ++ } ++ cidr = min(cidr, common_bits(down, key, bits)); ++ parent = node; ++ ++ if (newnode->cidr == cidr) { ++ rcu_assign_pointer(choose_node(newnode, down->bits), down); ++ if (!parent) ++ rcu_assign_pointer(*trie, newnode); ++ else ++ rcu_assign_pointer(choose_node(parent, newnode->bits), newnode); ++ } else { ++ node = kzalloc(sizeof(*node), GFP_KERNEL); ++ if (!node) { ++ kfree(newnode); ++ return -ENOMEM; ++ } ++ copy_and_assign_cidr(node, newnode->bits, cidr); ++ ++ rcu_assign_pointer(choose_node(node, down->bits), down); ++ rcu_assign_pointer(choose_node(node, newnode->bits), newnode); ++ if (!parent) ++ rcu_assign_pointer(*trie, node); ++ else ++ rcu_assign_pointer(choose_node(parent, node->bits), node); ++ } ++ return 0; ++} ++ ++void allowedips_init(struct allowedips *table) ++{ ++ table->root4 = table->root6 = NULL; ++ table->seq = 1; ++} ++ ++void allowedips_free(struct allowedips *table, struct mutex *lock) ++{ ++ ++table->seq; ++ free_root_node(table->root4, lock); ++ rcu_assign_pointer(table->root4, NULL); ++ free_root_node(table->root6, lock); ++ rcu_assign_pointer(table->root6, NULL); ++} ++ ++int allowedips_insert_v4(struct allowedips *table, const struct in_addr *ip, u8 cidr, struct wireguard_peer *peer, struct mutex *lock) ++{ ++ ++table->seq; ++ return add(&table->root4, 32, (const u8 *)ip, cidr, peer, lock); ++} ++ ++int allowedips_insert_v6(struct allowedips *table, const struct in6_addr *ip, u8 cidr, struct wireguard_peer *peer, struct mutex *lock) ++{ ++ ++table->seq; ++ return add(&table->root6, 128, (const u8 *)ip, cidr, peer, lock); ++} ++ ++void allowedips_remove_by_peer(struct allowedips *table, struct wireguard_peer *peer, struct mutex *lock) ++{ ++ ++table->seq; ++ walk_remove_by_peer(&table->root4, peer, lock); ++ walk_remove_by_peer(&table->root6, peer, lock); ++} ++ ++int allowedips_walk_by_peer(struct allowedips *table, struct allowedips_cursor *cursor, struct wireguard_peer *peer, int (*func)(void *ctx, const u8 *ip, u8 cidr, int family), void *ctx, struct mutex *lock) ++{ ++ int ret; ++ ++ if (!cursor->seq) ++ cursor->seq = table->seq; ++ else if (cursor->seq != table->seq) ++ return 0; ++ ++ if (!cursor->second_half) { ++ ret = walk_by_peer(table->root4, AF_INET, cursor, peer, func, ctx, lock); ++ if (ret) ++ return ret; ++ cursor->len = 0; ++ cursor->second_half = true; ++ } ++ return walk_by_peer(table->root6, AF_INET6, cursor, peer, func, ctx, lock); ++} ++ ++/* Returns a strong reference to a peer */ ++struct wireguard_peer *allowedips_lookup_dst(struct allowedips *table, struct sk_buff *skb) ++{ ++ if (skb->protocol == htons(ETH_P_IP)) ++ return lookup(table->root4, 32, &ip_hdr(skb)->daddr); ++ else if (skb->protocol == htons(ETH_P_IPV6)) ++ return lookup(table->root6, 128, &ipv6_hdr(skb)->daddr); ++ return NULL; ++} ++ ++/* Returns a strong reference to a peer */ ++struct wireguard_peer *allowedips_lookup_src(struct allowedips *table, struct sk_buff *skb) ++{ ++ if (skb->protocol == htons(ETH_P_IP)) ++ return lookup(table->root4, 32, &ip_hdr(skb)->saddr); ++ else if (skb->protocol == htons(ETH_P_IPV6)) ++ return lookup(table->root6, 128, &ipv6_hdr(skb)->saddr); ++ return NULL; ++} ++ ++#include "selftest/allowedips.h" +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/cookie.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,195 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "cookie.h" ++#include "peer.h" ++#include "device.h" ++#include "messages.h" ++#include "ratelimiter.h" ++#include "crypto/blake2s.h" ++#include "crypto/chacha20poly1305.h" ++ ++#include ++#include ++#include ++ ++void cookie_checker_init(struct cookie_checker *checker, struct wireguard_device *wg) ++{ ++ init_rwsem(&checker->secret_lock); ++ checker->secret_birthdate = get_jiffies_64(); ++ get_random_bytes(checker->secret, NOISE_HASH_LEN); ++ checker->device = wg; ++} ++ ++enum { COOKIE_KEY_LABEL_LEN = 8 }; ++static const u8 mac1_key_label[COOKIE_KEY_LABEL_LEN] = "mac1----"; ++static const u8 cookie_key_label[COOKIE_KEY_LABEL_LEN] = "cookie--"; ++ ++static void precompute_key(u8 key[NOISE_SYMMETRIC_KEY_LEN], const u8 pubkey[NOISE_PUBLIC_KEY_LEN], const u8 label[COOKIE_KEY_LABEL_LEN]) ++{ ++ struct blake2s_state blake; ++ ++ blake2s_init(&blake, NOISE_SYMMETRIC_KEY_LEN); ++ blake2s_update(&blake, label, COOKIE_KEY_LABEL_LEN); ++ blake2s_update(&blake, pubkey, NOISE_PUBLIC_KEY_LEN); ++ blake2s_final(&blake, key, NOISE_SYMMETRIC_KEY_LEN); ++} ++ ++void cookie_checker_precompute_device_keys(struct cookie_checker *checker) ++{ ++ down_read(&checker->device->static_identity.lock); ++ if (likely(checker->device->static_identity.has_identity)) { ++ precompute_key(checker->cookie_encryption_key, checker->device->static_identity.static_public, cookie_key_label); ++ precompute_key(checker->message_mac1_key, checker->device->static_identity.static_public, mac1_key_label); ++ } else { ++ memset(checker->cookie_encryption_key, 0, NOISE_SYMMETRIC_KEY_LEN); ++ memset(checker->message_mac1_key, 0, NOISE_SYMMETRIC_KEY_LEN); ++ } ++ up_read(&checker->device->static_identity.lock); ++} ++ ++void cookie_checker_precompute_peer_keys(struct wireguard_peer *peer) ++{ ++ precompute_key(peer->latest_cookie.cookie_decryption_key, peer->handshake.remote_static, cookie_key_label); ++ precompute_key(peer->latest_cookie.message_mac1_key, peer->handshake.remote_static, mac1_key_label); ++} ++ ++void cookie_init(struct cookie *cookie) ++{ ++ memset(cookie, 0, sizeof(struct cookie)); ++ init_rwsem(&cookie->lock); ++} ++ ++static void compute_mac1(u8 mac1[COOKIE_LEN], const void *message, size_t len, const u8 key[NOISE_SYMMETRIC_KEY_LEN]) ++{ ++ len = len - sizeof(struct message_macs) + offsetof(struct message_macs, mac1); ++ blake2s(mac1, message, key, COOKIE_LEN, len, NOISE_SYMMETRIC_KEY_LEN); ++} ++ ++static void compute_mac2(u8 mac2[COOKIE_LEN], const void *message, size_t len, const u8 cookie[COOKIE_LEN]) ++{ ++ len = len - sizeof(struct message_macs) + offsetof(struct message_macs, mac2); ++ blake2s(mac2, message, cookie, COOKIE_LEN, len, COOKIE_LEN); ++} ++ ++static void make_cookie(u8 cookie[COOKIE_LEN], struct sk_buff *skb, struct cookie_checker *checker) ++{ ++ struct blake2s_state state; ++ ++ if (!time_is_after_jiffies64(checker->secret_birthdate + COOKIE_SECRET_MAX_AGE)) { ++ down_write(&checker->secret_lock); ++ checker->secret_birthdate = get_jiffies_64(); ++ get_random_bytes(checker->secret, NOISE_HASH_LEN); ++ up_write(&checker->secret_lock); ++ } ++ ++ down_read(&checker->secret_lock); ++ ++ blake2s_init_key(&state, COOKIE_LEN, checker->secret, NOISE_HASH_LEN); ++ if (skb->protocol == htons(ETH_P_IP)) ++ blake2s_update(&state, (u8 *)&ip_hdr(skb)->saddr, sizeof(struct in_addr)); ++ else if (skb->protocol == htons(ETH_P_IPV6)) ++ blake2s_update(&state, (u8 *)&ipv6_hdr(skb)->saddr, sizeof(struct in6_addr)); ++ blake2s_update(&state, (u8 *)&udp_hdr(skb)->source, sizeof(__be16)); ++ blake2s_final(&state, cookie, COOKIE_LEN); ++ ++ up_read(&checker->secret_lock); ++} ++ ++enum cookie_mac_state cookie_validate_packet(struct cookie_checker *checker, struct sk_buff *skb, bool check_cookie) ++{ ++ u8 computed_mac[COOKIE_LEN]; ++ u8 cookie[COOKIE_LEN]; ++ enum cookie_mac_state ret; ++ struct message_macs *macs = (struct message_macs *)(skb->data + skb->len - sizeof(struct message_macs)); ++ ++ ret = INVALID_MAC; ++ compute_mac1(computed_mac, skb->data, skb->len, checker->message_mac1_key); ++ if (crypto_memneq(computed_mac, macs->mac1, COOKIE_LEN)) ++ goto out; ++ ++ ret = VALID_MAC_BUT_NO_COOKIE; ++ ++ if (!check_cookie) ++ goto out; ++ ++ make_cookie(cookie, skb, checker); ++ ++ compute_mac2(computed_mac, skb->data, skb->len, cookie); ++ if (crypto_memneq(computed_mac, macs->mac2, COOKIE_LEN)) ++ goto out; ++ ++ ret = VALID_MAC_WITH_COOKIE_BUT_RATELIMITED; ++ if (!ratelimiter_allow(skb, dev_net(checker->device->dev))) ++ goto out; ++ ++ ret = VALID_MAC_WITH_COOKIE; ++ ++out: ++ return ret; ++} ++ ++void cookie_add_mac_to_packet(void *message, size_t len, struct wireguard_peer *peer) ++{ ++ struct message_macs *macs = (struct message_macs *)((u8 *)message + len - sizeof(struct message_macs)); ++ ++ down_write(&peer->latest_cookie.lock); ++ compute_mac1(macs->mac1, message, len, peer->latest_cookie.message_mac1_key); ++ memcpy(peer->latest_cookie.last_mac1_sent, macs->mac1, COOKIE_LEN); ++ peer->latest_cookie.have_sent_mac1 = true; ++ up_write(&peer->latest_cookie.lock); ++ ++ down_read(&peer->latest_cookie.lock); ++ if (peer->latest_cookie.is_valid && time_is_after_jiffies64(peer->latest_cookie.birthdate + COOKIE_SECRET_MAX_AGE - COOKIE_SECRET_LATENCY)) ++ compute_mac2(macs->mac2, message, len, peer->latest_cookie.cookie); ++ else ++ memset(macs->mac2, 0, COOKIE_LEN); ++ up_read(&peer->latest_cookie.lock); ++} ++ ++void cookie_message_create(struct message_handshake_cookie *dst, struct sk_buff *skb, __le32 index, struct cookie_checker *checker) ++{ ++ struct message_macs *macs = (struct message_macs *)((u8 *)skb->data + skb->len - sizeof(struct message_macs)); ++ u8 cookie[COOKIE_LEN]; ++ ++ dst->header.type = cpu_to_le32(MESSAGE_HANDSHAKE_COOKIE); ++ dst->receiver_index = index; ++ get_random_bytes_wait(dst->nonce, COOKIE_NONCE_LEN); ++ ++ make_cookie(cookie, skb, checker); ++ xchacha20poly1305_encrypt(dst->encrypted_cookie, cookie, COOKIE_LEN, macs->mac1, COOKIE_LEN, dst->nonce, checker->cookie_encryption_key); ++} ++ ++void cookie_message_consume(struct message_handshake_cookie *src, struct wireguard_device *wg) ++{ ++ u8 cookie[COOKIE_LEN]; ++ struct index_hashtable_entry *entry; ++ bool ret; ++ ++ entry = index_hashtable_lookup(&wg->index_hashtable, INDEX_HASHTABLE_HANDSHAKE | INDEX_HASHTABLE_KEYPAIR, src->receiver_index); ++ if (unlikely(!entry)) ++ return; ++ ++ down_read(&entry->peer->latest_cookie.lock); ++ if (unlikely(!entry->peer->latest_cookie.have_sent_mac1)) { ++ up_read(&entry->peer->latest_cookie.lock); ++ goto out; ++ } ++ ret = xchacha20poly1305_decrypt(cookie, src->encrypted_cookie, sizeof(src->encrypted_cookie), entry->peer->latest_cookie.last_mac1_sent, COOKIE_LEN, src->nonce, entry->peer->latest_cookie.cookie_decryption_key); ++ up_read(&entry->peer->latest_cookie.lock); ++ ++ if (ret) { ++ down_write(&entry->peer->latest_cookie.lock); ++ memcpy(entry->peer->latest_cookie.cookie, cookie, COOKIE_LEN); ++ entry->peer->latest_cookie.birthdate = get_jiffies_64(); ++ entry->peer->latest_cookie.is_valid = true; ++ entry->peer->latest_cookie.have_sent_mac1 = false; ++ up_write(&entry->peer->latest_cookie.lock); ++ } else ++ net_dbg_ratelimited("%s: Could not decrypt invalid cookie response\n", wg->dev->name); ++ ++out: ++ peer_put(entry->peer); ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/device.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,421 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "queueing.h" ++#include "socket.h" ++#include "timers.h" ++#include "device.h" ++#include "ratelimiter.h" ++#include "peer.h" ++#include "messages.h" ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++static LIST_HEAD(device_list); ++ ++static int open(struct net_device *dev) ++{ ++ int ret; ++ struct wireguard_peer *peer; ++ struct wireguard_device *wg = netdev_priv(dev); ++#ifndef COMPAT_CANNOT_USE_IN6_DEV_GET ++ struct inet6_dev *dev_v6 = __in6_dev_get(dev); ++#endif ++ struct in_device *dev_v4 = __in_dev_get_rtnl(dev); ++ ++ if (dev_v4) { ++ /* TODO: when we merge to mainline, put this check near the ip_rt_send_redirect ++ * call of ip_forward in net/ipv4/ip_forward.c, similar to the current secpath ++ * check, rather than turning it off like this. This is just a stop gap solution ++ * while we're an out of tree module. ++ */ ++ IN_DEV_CONF_SET(dev_v4, SEND_REDIRECTS, false); ++ IPV4_DEVCONF_ALL(dev_net(dev), SEND_REDIRECTS) = false; ++ } ++#ifndef COMPAT_CANNOT_USE_IN6_DEV_GET ++ if (dev_v6) ++#ifndef COMPAT_CANNOT_USE_DEV_CNF ++ dev_v6->cnf.addr_gen_mode = IN6_ADDR_GEN_MODE_NONE; ++#else ++ dev_v6->addr_gen_mode = IN6_ADDR_GEN_MODE_NONE; ++#endif ++#endif ++ ++ ret = socket_init(wg, wg->incoming_port); ++ if (ret < 0) ++ return ret; ++ mutex_lock(&wg->device_update_lock); ++ list_for_each_entry(peer, &wg->peer_list, peer_list) { ++ packet_send_staged_packets(peer); ++ if (peer->persistent_keepalive_interval) ++ packet_send_keepalive(peer); ++ } ++ mutex_unlock(&wg->device_update_lock); ++ return 0; ++} ++ ++#if defined(CONFIG_PM_SLEEP) && !defined(CONFIG_ANDROID) ++static int pm_notification(struct notifier_block *nb, unsigned long action, void *data) ++{ ++ struct wireguard_device *wg; ++ struct wireguard_peer *peer; ++ ++ if (action != PM_HIBERNATION_PREPARE && action != PM_SUSPEND_PREPARE) ++ return 0; ++ ++ rtnl_lock(); ++ list_for_each_entry(wg, &device_list, device_list) { ++ mutex_lock(&wg->device_update_lock); ++ list_for_each_entry(peer, &wg->peer_list, peer_list) { ++ noise_handshake_clear(&peer->handshake); ++ noise_keypairs_clear(&peer->keypairs); ++ if (peer->timers_enabled) ++ del_timer(&peer->timer_zero_key_material); ++ } ++ mutex_unlock(&wg->device_update_lock); ++ } ++ rtnl_unlock(); ++ rcu_barrier_bh(); ++ return 0; ++} ++static struct notifier_block pm_notifier = { .notifier_call = pm_notification }; ++#endif ++ ++static int stop(struct net_device *dev) ++{ ++ struct wireguard_device *wg = netdev_priv(dev); ++ struct wireguard_peer *peer; ++ ++ mutex_lock(&wg->device_update_lock); ++ list_for_each_entry(peer, &wg->peer_list, peer_list) { ++ skb_queue_purge(&peer->staged_packet_queue); ++ timers_stop(peer); ++ noise_handshake_clear(&peer->handshake); ++ noise_keypairs_clear(&peer->keypairs); ++ peer->last_sent_handshake = get_jiffies_64() - REKEY_TIMEOUT - HZ; ++ } ++ mutex_unlock(&wg->device_update_lock); ++ skb_queue_purge(&wg->incoming_handshakes); ++ socket_reinit(wg, NULL, NULL); ++ return 0; ++} ++ ++static netdev_tx_t xmit(struct sk_buff *skb, struct net_device *dev) ++{ ++ struct wireguard_device *wg = netdev_priv(dev); ++ struct wireguard_peer *peer; ++ struct sk_buff *next; ++ struct sk_buff_head packets; ++ sa_family_t family; ++ int ret; ++ ++ if (unlikely(skb_examine_untrusted_ip_hdr(skb) != skb->protocol)) { ++ ret = -EPROTONOSUPPORT; ++ net_dbg_ratelimited("%s: Invalid IP packet\n", dev->name); ++ goto err; ++ } ++ ++ peer = allowedips_lookup_dst(&wg->peer_allowedips, skb); ++ if (unlikely(!peer)) { ++ ret = -ENOKEY; ++ net_dbg_skb_ratelimited("%s: No peer is configured for %pISc\n", dev->name, skb); ++ goto err; ++ } ++ ++ family = READ_ONCE(peer->endpoint.addr.sa_family); ++ if (unlikely(family != AF_INET && family != AF_INET6)) { ++ ret = -EDESTADDRREQ; ++ net_dbg_ratelimited("%s: No valid endpoint has been configured or discovered for peer %llu\n", dev->name, peer->internal_id); ++ goto err_peer; ++ } ++ ++ __skb_queue_head_init(&packets); ++ if (!skb_is_gso(skb)) ++ skb->next = NULL; ++ else { ++ struct sk_buff *segs = skb_gso_segment(skb, 0); ++ ++ if (unlikely(IS_ERR(segs))) { ++ ret = PTR_ERR(segs); ++ goto err_peer; ++ } ++ dev_kfree_skb(skb); ++ skb = segs; ++ } ++ do { ++ next = skb->next; ++ skb->next = skb->prev = NULL; ++ ++ skb = skb_share_check(skb, GFP_ATOMIC); ++ if (unlikely(!skb)) ++ continue; ++ ++ /* We only need to keep the original dst around for icmp, ++ * so at this point we're in a position to drop it. ++ */ ++ skb_dst_drop(skb); ++ ++ __skb_queue_tail(&packets, skb); ++ } while ((skb = next) != NULL); ++ ++ spin_lock_bh(&peer->staged_packet_queue.lock); ++ /* If the queue is getting too big, we start removing the oldest packets until it's small again. ++ * We do this before adding the new packet, so we don't remove GSO segments that are in excess. ++ */ ++ while (skb_queue_len(&peer->staged_packet_queue) > MAX_STAGED_PACKETS) ++ dev_kfree_skb(__skb_dequeue(&peer->staged_packet_queue)); ++ skb_queue_splice_tail(&packets, &peer->staged_packet_queue); ++ spin_unlock_bh(&peer->staged_packet_queue.lock); ++ ++ packet_send_staged_packets(peer); ++ ++ peer_put(peer); ++ return NETDEV_TX_OK; ++ ++err_peer: ++ peer_put(peer); ++err: ++ ++dev->stats.tx_errors; ++ if (skb->protocol == htons(ETH_P_IP)) ++ icmp_send(skb, ICMP_DEST_UNREACH, ICMP_HOST_UNREACH, 0); ++ else if (skb->protocol == htons(ETH_P_IPV6)) ++ icmpv6_send(skb, ICMPV6_DEST_UNREACH, ICMPV6_ADDR_UNREACH, 0); ++ kfree_skb(skb); ++ return ret; ++} ++ ++static const struct net_device_ops netdev_ops = { ++ .ndo_open = open, ++ .ndo_stop = stop, ++ .ndo_start_xmit = xmit, ++ .ndo_get_stats64 = ip_tunnel_get_stats64 ++}; ++ ++static void destruct(struct net_device *dev) ++{ ++ struct wireguard_device *wg = netdev_priv(dev); ++ ++ rtnl_lock(); ++ list_del(&wg->device_list); ++ rtnl_unlock(); ++ mutex_lock(&wg->device_update_lock); ++ wg->incoming_port = 0; ++ socket_reinit(wg, NULL, NULL); ++ peer_remove_all(wg); /* The final references are cleared in the below calls to destroy_workqueue. */ ++ destroy_workqueue(wg->handshake_receive_wq); ++ destroy_workqueue(wg->handshake_send_wq); ++ packet_queue_free(&wg->decrypt_queue, true); ++ packet_queue_free(&wg->encrypt_queue, true); ++ destroy_workqueue(wg->packet_crypt_wq); ++ rcu_barrier_bh(); /* Wait for all the peers to be actually freed. */ ++ allowedips_free(&wg->peer_allowedips, &wg->device_update_lock); ++ ratelimiter_uninit(); ++ memzero_explicit(&wg->static_identity, sizeof(struct noise_static_identity)); ++ skb_queue_purge(&wg->incoming_handshakes); ++ free_percpu(dev->tstats); ++ free_percpu(wg->incoming_handshakes_worker); ++ if (wg->have_creating_net_ref) ++ put_net(wg->creating_net); ++ mutex_unlock(&wg->device_update_lock); ++ ++ pr_debug("%s: Interface deleted\n", dev->name); ++ free_netdev(dev); ++} ++ ++static const struct device_type device_type = { ++ .name = KBUILD_MODNAME ++}; ++ ++static void setup(struct net_device *dev) ++{ ++ struct wireguard_device *wg = netdev_priv(dev); ++ enum { WG_NETDEV_FEATURES = NETIF_F_HW_CSUM | NETIF_F_RXCSUM | NETIF_F_SG | NETIF_F_GSO | NETIF_F_GSO_SOFTWARE | NETIF_F_HIGHDMA }; ++ ++ dev->netdev_ops = &netdev_ops; ++ dev->hard_header_len = 0; ++ dev->addr_len = 0; ++ dev->needed_headroom = DATA_PACKET_HEAD_ROOM; ++ dev->needed_tailroom = noise_encrypted_len(MESSAGE_PADDING_MULTIPLE); ++ dev->type = ARPHRD_NONE; ++ dev->flags = IFF_POINTOPOINT | IFF_NOARP; ++#ifndef COMPAT_CANNOT_USE_IFF_NO_QUEUE ++ dev->priv_flags |= IFF_NO_QUEUE; ++#else ++ dev->tx_queue_len = 0; ++#endif ++ dev->features |= NETIF_F_LLTX; ++ dev->features |= WG_NETDEV_FEATURES; ++ dev->hw_features |= WG_NETDEV_FEATURES; ++ dev->hw_enc_features |= WG_NETDEV_FEATURES; ++ dev->mtu = ETH_DATA_LEN - MESSAGE_MINIMUM_LENGTH - sizeof(struct udphdr) - max(sizeof(struct ipv6hdr), sizeof(struct iphdr)); ++ ++ SET_NETDEV_DEVTYPE(dev, &device_type); ++ ++ /* We need to keep the dst around in case of icmp replies. */ ++ netif_keep_dst(dev); ++ ++ memset(wg, 0, sizeof(struct wireguard_device)); ++ wg->dev = dev; ++} ++ ++static int newlink(struct net *src_net, struct net_device *dev, struct nlattr *tb[], struct nlattr *data[], struct netlink_ext_ack *extack) ++{ ++ int ret = -ENOMEM; ++ struct wireguard_device *wg = netdev_priv(dev); ++ ++ wg->creating_net = src_net; ++ init_rwsem(&wg->static_identity.lock); ++ mutex_init(&wg->socket_update_lock); ++ mutex_init(&wg->device_update_lock); ++ skb_queue_head_init(&wg->incoming_handshakes); ++ pubkey_hashtable_init(&wg->peer_hashtable); ++ index_hashtable_init(&wg->index_hashtable); ++ allowedips_init(&wg->peer_allowedips); ++ cookie_checker_init(&wg->cookie_checker, wg); ++ INIT_LIST_HEAD(&wg->peer_list); ++ wg->device_update_gen = 1; ++ ++ dev->tstats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats); ++ if (!dev->tstats) ++ goto error_1; ++ ++ wg->incoming_handshakes_worker = packet_alloc_percpu_multicore_worker(packet_handshake_receive_worker, wg); ++ if (!wg->incoming_handshakes_worker) ++ goto error_2; ++ ++ wg->handshake_receive_wq = alloc_workqueue("wg-kex-%s", WQ_CPU_INTENSIVE | WQ_FREEZABLE, 0, dev->name); ++ if (!wg->handshake_receive_wq) ++ goto error_3; ++ ++ wg->handshake_send_wq = alloc_workqueue("wg-kex-%s", WQ_UNBOUND | WQ_FREEZABLE, 0, dev->name); ++ if (!wg->handshake_send_wq) ++ goto error_4; ++ ++ wg->packet_crypt_wq = alloc_workqueue("wg-crypt-%s", WQ_CPU_INTENSIVE | WQ_MEM_RECLAIM, 0, dev->name); ++ if (!wg->packet_crypt_wq) ++ goto error_5; ++ ++ if (packet_queue_init(&wg->encrypt_queue, packet_encrypt_worker, true, MAX_QUEUED_PACKETS) < 0) ++ goto error_6; ++ ++ if (packet_queue_init(&wg->decrypt_queue, packet_decrypt_worker, true, MAX_QUEUED_PACKETS) < 0) ++ goto error_7; ++ ++ ret = ratelimiter_init(); ++ if (ret < 0) ++ goto error_8; ++ ++ ret = register_netdevice(dev); ++ if (ret < 0) ++ goto error_9; ++ ++ list_add(&wg->device_list, &device_list); ++ ++ /* We wait until the end to assign priv_destructor, so that register_netdevice doesn't ++ * call it for us if it fails. ++ */ ++ dev->priv_destructor = destruct; ++ ++ pr_debug("%s: Interface created\n", dev->name); ++ return ret; ++ ++error_9: ++ ratelimiter_uninit(); ++error_8: ++ packet_queue_free(&wg->decrypt_queue, true); ++error_7: ++ packet_queue_free(&wg->encrypt_queue, true); ++error_6: ++ destroy_workqueue(wg->packet_crypt_wq); ++error_5: ++ destroy_workqueue(wg->handshake_send_wq); ++error_4: ++ destroy_workqueue(wg->handshake_receive_wq); ++error_3: ++ free_percpu(wg->incoming_handshakes_worker); ++error_2: ++ free_percpu(dev->tstats); ++error_1: ++ return ret; ++} ++ ++static struct rtnl_link_ops link_ops __read_mostly = { ++ .kind = KBUILD_MODNAME, ++ .priv_size = sizeof(struct wireguard_device), ++ .setup = setup, ++ .newlink = newlink, ++}; ++ ++static int netdevice_notification(struct notifier_block *nb, unsigned long action, void *data) ++{ ++ struct net_device *dev = ((struct netdev_notifier_info *)data)->dev; ++ struct wireguard_device *wg = netdev_priv(dev); ++ ++ ASSERT_RTNL(); ++ ++ if (action != NETDEV_REGISTER || dev->netdev_ops != &netdev_ops) ++ return 0; ++ ++ if (dev_net(dev) == wg->creating_net && wg->have_creating_net_ref) { ++ put_net(wg->creating_net); ++ wg->have_creating_net_ref = false; ++ } else if (dev_net(dev) != wg->creating_net && !wg->have_creating_net_ref) { ++ wg->have_creating_net_ref = true; ++ get_net(wg->creating_net); ++ } ++ return 0; ++} ++ ++static struct notifier_block netdevice_notifier = { .notifier_call = netdevice_notification }; ++ ++int __init device_init(void) ++{ ++ int ret; ++ ++#if defined(CONFIG_PM_SLEEP) && !defined(CONFIG_ANDROID) ++ ret = register_pm_notifier(&pm_notifier); ++ if (ret) ++ return ret; ++#endif ++ ++ ret = register_netdevice_notifier(&netdevice_notifier); ++ if (ret) ++ goto error_pm; ++ ++ ret = rtnl_link_register(&link_ops); ++ if (ret) ++ goto error_netdevice; ++ ++ return 0; ++ ++error_netdevice: ++ unregister_netdevice_notifier(&netdevice_notifier); ++error_pm: ++#if defined(CONFIG_PM_SLEEP) && !defined(CONFIG_ANDROID) ++ unregister_pm_notifier(&pm_notifier); ++#endif ++ return ret; ++} ++ ++void device_uninit(void) ++{ ++ rtnl_link_unregister(&link_ops); ++ unregister_netdevice_notifier(&netdevice_notifier); ++#if defined(CONFIG_PM_SLEEP) && !defined(CONFIG_ANDROID) ++ unregister_pm_notifier(&pm_notifier); ++#endif ++ rcu_barrier_bh(); ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/hashtables.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,168 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "hashtables.h" ++#include "peer.h" ++#include "noise.h" ++ ++static inline struct hlist_head *pubkey_bucket(struct pubkey_hashtable *table, const u8 pubkey[NOISE_PUBLIC_KEY_LEN]) ++{ ++ /* siphash gives us a secure 64bit number based on a random key. Since the bits are ++ * uniformly distributed, we can then mask off to get the bits we need. ++ */ ++ return &table->hashtable[siphash(pubkey, NOISE_PUBLIC_KEY_LEN, &table->key) & (HASH_SIZE(table->hashtable) - 1)]; ++} ++ ++void pubkey_hashtable_init(struct pubkey_hashtable *table) ++{ ++ get_random_bytes(&table->key, sizeof(table->key)); ++ hash_init(table->hashtable); ++ mutex_init(&table->lock); ++} ++ ++void pubkey_hashtable_add(struct pubkey_hashtable *table, struct wireguard_peer *peer) ++{ ++ mutex_lock(&table->lock); ++ hlist_add_head_rcu(&peer->pubkey_hash, pubkey_bucket(table, peer->handshake.remote_static)); ++ mutex_unlock(&table->lock); ++} ++ ++void pubkey_hashtable_remove(struct pubkey_hashtable *table, struct wireguard_peer *peer) ++{ ++ mutex_lock(&table->lock); ++ hlist_del_init_rcu(&peer->pubkey_hash); ++ mutex_unlock(&table->lock); ++} ++ ++/* Returns a strong reference to a peer */ ++struct wireguard_peer *pubkey_hashtable_lookup(struct pubkey_hashtable *table, const u8 pubkey[NOISE_PUBLIC_KEY_LEN]) ++{ ++ struct wireguard_peer *iter_peer, *peer = NULL; ++ ++ rcu_read_lock_bh(); ++ hlist_for_each_entry_rcu_bh(iter_peer, pubkey_bucket(table, pubkey), pubkey_hash) { ++ if (!memcmp(pubkey, iter_peer->handshake.remote_static, NOISE_PUBLIC_KEY_LEN)) { ++ peer = iter_peer; ++ break; ++ } ++ } ++ peer = peer_get(peer); ++ rcu_read_unlock_bh(); ++ return peer; ++} ++ ++static inline struct hlist_head *index_bucket(struct index_hashtable *table, const __le32 index) ++{ ++ /* Since the indices are random and thus all bits are uniformly distributed, ++ * we can find its bucket simply by masking. ++ */ ++ return &table->hashtable[(__force u32)index & (HASH_SIZE(table->hashtable) - 1)]; ++} ++ ++void index_hashtable_init(struct index_hashtable *table) ++{ ++ hash_init(table->hashtable); ++ spin_lock_init(&table->lock); ++} ++ ++/* At the moment, we limit ourselves to 2^20 total peers, which generally might amount to 2^20*3 ++ * items in this hashtable. The algorithm below works by picking a random number and testing it. ++ * We can see that these limits mean we usually succeed pretty quickly: ++ * ++ * >>> def calculation(tries, size): ++ * ... return (size / 2**32)**(tries - 1) * (1 - (size / 2**32)) ++ * ... ++ * >>> calculation(1, 2**20 * 3) ++ * 0.999267578125 ++ * >>> calculation(2, 2**20 * 3) ++ * 0.0007318854331970215 ++ * >>> calculation(3, 2**20 * 3) ++ * 5.360489012673497e-07 ++ * >>> calculation(4, 2**20 * 3) ++ * 3.9261394135792216e-10 ++ * ++ * At the moment, we don't do any masking, so this algorithm isn't exactly constant time in ++ * either the random guessing or in the hash list lookup. We could require a minimum of 3 ++ * tries, which would successfully mask the guessing. TODO: this would not, however, help ++ * with the growing hash lengths. ++ */ ++ ++__le32 index_hashtable_insert(struct index_hashtable *table, struct index_hashtable_entry *entry) ++{ ++ struct index_hashtable_entry *existing_entry; ++ ++ spin_lock_bh(&table->lock); ++ hlist_del_init_rcu(&entry->index_hash); ++ spin_unlock_bh(&table->lock); ++ ++ rcu_read_lock_bh(); ++ ++search_unused_slot: ++ /* First we try to find an unused slot, randomly, while unlocked. */ ++ entry->index = (__force __le32)get_random_u32(); ++ hlist_for_each_entry_rcu_bh(existing_entry, index_bucket(table, entry->index), index_hash) { ++ if (existing_entry->index == entry->index) ++ goto search_unused_slot; /* If it's already in use, we continue searching. */ ++ } ++ ++ /* Once we've found an unused slot, we lock it, and then double-check ++ * that nobody else stole it from us. ++ */ ++ spin_lock_bh(&table->lock); ++ hlist_for_each_entry_rcu_bh(existing_entry, index_bucket(table, entry->index), index_hash) { ++ if (existing_entry->index == entry->index) { ++ spin_unlock_bh(&table->lock); ++ goto search_unused_slot; /* If it was stolen, we start over. */ ++ } ++ } ++ /* Otherwise, we know we have it exclusively (since we're locked), so we insert. */ ++ hlist_add_head_rcu(&entry->index_hash, index_bucket(table, entry->index)); ++ spin_unlock_bh(&table->lock); ++ ++ rcu_read_unlock_bh(); ++ ++ return entry->index; ++} ++ ++bool index_hashtable_replace(struct index_hashtable *table, struct index_hashtable_entry *old, struct index_hashtable_entry *new) ++{ ++ if (unlikely(hlist_unhashed(&old->index_hash))) ++ return false; ++ spin_lock_bh(&table->lock); ++ new->index = old->index; ++ hlist_replace_rcu(&old->index_hash, &new->index_hash); ++ INIT_HLIST_NODE(&old->index_hash); ++ spin_unlock_bh(&table->lock); ++ return true; ++} ++ ++void index_hashtable_remove(struct index_hashtable *table, struct index_hashtable_entry *entry) ++{ ++ spin_lock_bh(&table->lock); ++ hlist_del_init_rcu(&entry->index_hash); ++ spin_unlock_bh(&table->lock); ++} ++ ++/* Returns a strong reference to a entry->peer */ ++struct index_hashtable_entry *index_hashtable_lookup(struct index_hashtable *table, const enum index_hashtable_type type_mask, const __le32 index) ++{ ++ struct index_hashtable_entry *iter_entry, *entry = NULL; ++ ++ rcu_read_lock_bh(); ++ hlist_for_each_entry_rcu_bh(iter_entry, index_bucket(table, index), index_hash) { ++ if (iter_entry->index == index) { ++ if (likely(iter_entry->type & type_mask)) ++ entry = iter_entry; ++ break; ++ } ++ } ++ if (likely(entry)) { ++ entry->peer = peer_get(entry->peer); ++ if (unlikely(!entry->peer)) ++ entry = NULL; ++ } ++ rcu_read_unlock_bh(); ++ return entry; ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/main.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,69 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "version.h" ++#include "device.h" ++#include "noise.h" ++#include "queueing.h" ++#include "ratelimiter.h" ++#include "netlink.h" ++#include "crypto/chacha20poly1305.h" ++#include "crypto/blake2s.h" ++#include "crypto/curve25519.h" ++#include "uapi/wireguard.h" ++ ++#include ++#include ++#include ++#include ++#include ++ ++static int __init mod_init(void) ++{ ++ int ret; ++ ++ chacha20poly1305_fpu_init(); ++ blake2s_fpu_init(); ++ curve25519_fpu_init(); ++#ifdef DEBUG ++ if (!allowedips_selftest() || !packet_counter_selftest() || !curve25519_selftest() || !chacha20poly1305_selftest() || !poly1305_selftest() || !blake2s_selftest() || !ratelimiter_selftest()) ++ return -ENOTRECOVERABLE; ++#endif ++ noise_init(); ++ ++ ret = device_init(); ++ if (ret < 0) ++ goto err_packet; ++ ++ ret = genetlink_init(); ++ if (ret < 0) ++ goto err_netlink; ++ ++ pr_info("WireGuard " WIREGUARD_VERSION " loaded. See www.wireguard.com for information.\n"); ++ pr_info("Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved.\n"); ++ ++ return 0; ++ ++err_netlink: ++ device_uninit(); ++err_packet: ++ return ret; ++} ++ ++static void __exit mod_exit(void) ++{ ++ genetlink_uninit(); ++ device_uninit(); ++ pr_debug("WireGuard unloaded\n"); ++} ++ ++module_init(mod_init); ++module_exit(mod_exit); ++MODULE_LICENSE("GPL v2"); ++MODULE_DESCRIPTION("Fast, secure, and modern VPN tunnel"); ++MODULE_AUTHOR("Jason A. Donenfeld "); ++MODULE_VERSION(WIREGUARD_VERSION); ++MODULE_ALIAS_RTNL_LINK(KBUILD_MODNAME); ++MODULE_ALIAS_GENL_FAMILY(WG_GENL_NAME); +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/netlink.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,517 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "netlink.h" ++#include "device.h" ++#include "peer.h" ++#include "socket.h" ++#include "queueing.h" ++#include "messages.h" ++#include "uapi/wireguard.h" ++#include ++#include ++#include ++ ++static struct genl_family genl_family; ++ ++static const struct nla_policy device_policy[WGDEVICE_A_MAX + 1] = { ++ [WGDEVICE_A_IFINDEX] = { .type = NLA_U32 }, ++ [WGDEVICE_A_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ - 1 }, ++ [WGDEVICE_A_PRIVATE_KEY]= { .len = NOISE_PUBLIC_KEY_LEN }, ++ [WGDEVICE_A_PUBLIC_KEY] = { .len = NOISE_PUBLIC_KEY_LEN }, ++ [WGDEVICE_A_FLAGS] = { .type = NLA_U32 }, ++ [WGDEVICE_A_LISTEN_PORT]= { .type = NLA_U16 }, ++ [WGDEVICE_A_FWMARK] = { .type = NLA_U32 }, ++ [WGDEVICE_A_PEERS] = { .type = NLA_NESTED } ++}; ++ ++static const struct nla_policy peer_policy[WGPEER_A_MAX + 1] = { ++ [WGPEER_A_PUBLIC_KEY] = { .len = NOISE_PUBLIC_KEY_LEN }, ++ [WGPEER_A_PRESHARED_KEY] = { .len = NOISE_SYMMETRIC_KEY_LEN }, ++ [WGPEER_A_FLAGS] = { .type = NLA_U32 }, ++ [WGPEER_A_ENDPOINT] = { .len = sizeof(struct sockaddr) }, ++ [WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL]= { .type = NLA_U16 }, ++ [WGPEER_A_LAST_HANDSHAKE_TIME] = { .len = sizeof(struct timespec) }, ++ [WGPEER_A_RX_BYTES] = { .type = NLA_U64 }, ++ [WGPEER_A_TX_BYTES] = { .type = NLA_U64 }, ++ [WGPEER_A_ALLOWEDIPS] = { .type = NLA_NESTED } ++}; ++ ++static const struct nla_policy allowedip_policy[WGALLOWEDIP_A_MAX + 1] = { ++ [WGALLOWEDIP_A_FAMILY] = { .type = NLA_U16 }, ++ [WGALLOWEDIP_A_IPADDR] = { .len = sizeof(struct in_addr) }, ++ [WGALLOWEDIP_A_CIDR_MASK] = { .type = NLA_U8 } ++}; ++ ++static struct wireguard_device *lookup_interface(struct nlattr **attrs, struct sk_buff *skb) ++{ ++ struct net_device *dev = NULL; ++ ++ if (!attrs[WGDEVICE_A_IFINDEX] == !attrs[WGDEVICE_A_IFNAME]) ++ return ERR_PTR(-EBADR); ++ if (attrs[WGDEVICE_A_IFINDEX]) ++ dev = dev_get_by_index(sock_net(skb->sk), nla_get_u32(attrs[WGDEVICE_A_IFINDEX])); ++ else if (attrs[WGDEVICE_A_IFNAME]) ++ dev = dev_get_by_name(sock_net(skb->sk), nla_data(attrs[WGDEVICE_A_IFNAME])); ++ if (!dev) ++ return ERR_PTR(-ENODEV); ++ if (!dev->rtnl_link_ops || !dev->rtnl_link_ops->kind || strcmp(dev->rtnl_link_ops->kind, KBUILD_MODNAME)) { ++ dev_put(dev); ++ return ERR_PTR(-EOPNOTSUPP); ++ } ++ return netdev_priv(dev); ++} ++ ++struct allowedips_ctx { ++ struct sk_buff *skb; ++ unsigned int i; ++}; ++ ++static int get_allowedips(void *ctx, const u8 *ip, u8 cidr, int family) ++{ ++ struct nlattr *allowedip_nest; ++ struct allowedips_ctx *actx = ctx; ++ ++ allowedip_nest = nla_nest_start(actx->skb, actx->i++); ++ if (!allowedip_nest) ++ return -EMSGSIZE; ++ ++ if (nla_put_u8(actx->skb, WGALLOWEDIP_A_CIDR_MASK, cidr) || nla_put_u16(actx->skb, WGALLOWEDIP_A_FAMILY, family) || ++ nla_put(actx->skb, WGALLOWEDIP_A_IPADDR, family == AF_INET6 ? sizeof(struct in6_addr) : sizeof(struct in_addr), ip)) { ++ nla_nest_cancel(actx->skb, allowedip_nest); ++ return -EMSGSIZE; ++ } ++ ++ nla_nest_end(actx->skb, allowedip_nest); ++ return 0; ++} ++ ++static int get_peer(struct wireguard_peer *peer, unsigned int index, struct allowedips_cursor *rt_cursor, struct sk_buff *skb) ++{ ++ struct allowedips_ctx ctx = { .skb = skb }; ++ struct nlattr *allowedips_nest, *peer_nest = nla_nest_start(skb, index); ++ bool fail; ++ ++ if (!peer_nest) ++ return -EMSGSIZE; ++ ++ down_read(&peer->handshake.lock); ++ fail = nla_put(skb, WGPEER_A_PUBLIC_KEY, NOISE_PUBLIC_KEY_LEN, peer->handshake.remote_static); ++ up_read(&peer->handshake.lock); ++ if (fail) ++ goto err; ++ ++ if (!rt_cursor->seq) { ++ down_read(&peer->handshake.lock); ++ fail = nla_put(skb, WGPEER_A_PRESHARED_KEY, NOISE_SYMMETRIC_KEY_LEN, peer->handshake.preshared_key); ++ up_read(&peer->handshake.lock); ++ if (fail) ++ goto err; ++ ++ if (nla_put(skb, WGPEER_A_LAST_HANDSHAKE_TIME, sizeof(struct timespec), &peer->walltime_last_handshake) || nla_put_u16(skb, WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL, peer->persistent_keepalive_interval / HZ) || ++ nla_put_u64_64bit(skb, WGPEER_A_TX_BYTES, peer->tx_bytes, WGPEER_A_UNSPEC) || nla_put_u64_64bit(skb, WGPEER_A_RX_BYTES, peer->rx_bytes, WGPEER_A_UNSPEC)) ++ goto err; ++ ++ read_lock_bh(&peer->endpoint_lock); ++ if (peer->endpoint.addr.sa_family == AF_INET) ++ fail = nla_put(skb, WGPEER_A_ENDPOINT, sizeof(struct sockaddr_in), &peer->endpoint.addr4); ++ else if (peer->endpoint.addr.sa_family == AF_INET6) ++ fail = nla_put(skb, WGPEER_A_ENDPOINT, sizeof(struct sockaddr_in6), &peer->endpoint.addr6); ++ read_unlock_bh(&peer->endpoint_lock); ++ if (fail) ++ goto err; ++ } ++ ++ allowedips_nest = nla_nest_start(skb, WGPEER_A_ALLOWEDIPS); ++ if (!allowedips_nest) ++ goto err; ++ if (allowedips_walk_by_peer(&peer->device->peer_allowedips, rt_cursor, peer, get_allowedips, &ctx, &peer->device->device_update_lock)) { ++ nla_nest_end(skb, allowedips_nest); ++ nla_nest_end(skb, peer_nest); ++ return -EMSGSIZE; ++ } ++ memset(rt_cursor, 0, sizeof(*rt_cursor)); ++ nla_nest_end(skb, allowedips_nest); ++ nla_nest_end(skb, peer_nest); ++ return 0; ++err: ++ nla_nest_cancel(skb, peer_nest); ++ return -EMSGSIZE; ++} ++ ++static int get_device_start(struct netlink_callback *cb) ++{ ++ struct wireguard_device *wg; ++ struct nlattr **attrs = genl_family_attrbuf(&genl_family); ++ int ret = nlmsg_parse(cb->nlh, GENL_HDRLEN + genl_family.hdrsize, attrs, genl_family.maxattr, device_policy, NULL); ++ ++ if (ret < 0) ++ return ret; ++ cb->args[2] = (long)kzalloc(sizeof(struct allowedips_cursor), GFP_KERNEL); ++ if (!cb->args[2]) ++ return -ENOMEM; ++ wg = lookup_interface(attrs, cb->skb); ++ if (IS_ERR(wg)) { ++ kfree((void *)cb->args[2]); ++ cb->args[2] = 0; ++ return PTR_ERR(wg); ++ } ++ cb->args[0] = (long)wg; ++ return 0; ++} ++ ++static int get_device_dump(struct sk_buff *skb, struct netlink_callback *cb) ++{ ++ struct wireguard_device *wg = (struct wireguard_device *)cb->args[0]; ++ struct wireguard_peer *peer, *next_peer_cursor = NULL, *last_peer_cursor = (struct wireguard_peer *)cb->args[1]; ++ struct allowedips_cursor *rt_cursor = (struct allowedips_cursor *)cb->args[2]; ++ unsigned int peer_idx = 0; ++ struct nlattr *peers_nest; ++ bool done = true; ++ void *hdr; ++ int ret = -EMSGSIZE; ++ ++ rtnl_lock(); ++ mutex_lock(&wg->device_update_lock); ++ cb->seq = wg->device_update_gen; ++ ++ hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq, &genl_family, NLM_F_MULTI, WG_CMD_GET_DEVICE); ++ if (!hdr) ++ goto out; ++ genl_dump_check_consistent(cb, hdr); ++ ++ if (!last_peer_cursor) { ++ if (nla_put_u16(skb, WGDEVICE_A_LISTEN_PORT, wg->incoming_port) || nla_put_u32(skb, WGDEVICE_A_FWMARK, wg->fwmark) || nla_put_u32(skb, WGDEVICE_A_IFINDEX, wg->dev->ifindex) || nla_put_string(skb, WGDEVICE_A_IFNAME, wg->dev->name)) ++ goto out; ++ ++ down_read(&wg->static_identity.lock); ++ if (wg->static_identity.has_identity) { ++ if (nla_put(skb, WGDEVICE_A_PRIVATE_KEY, NOISE_PUBLIC_KEY_LEN, wg->static_identity.static_private) || nla_put(skb, WGDEVICE_A_PUBLIC_KEY, NOISE_PUBLIC_KEY_LEN, wg->static_identity.static_public)) { ++ up_read(&wg->static_identity.lock); ++ goto out; ++ } ++ } ++ up_read(&wg->static_identity.lock); ++ } ++ ++ peers_nest = nla_nest_start(skb, WGDEVICE_A_PEERS); ++ if (!peers_nest) ++ goto out; ++ ret = 0; ++ /* If the last cursor was removed via list_del_init in peer_remove, then we just treat ++ * this the same as there being no more peers left. The reason is that seq_nr should ++ * indicate to userspace that this isn't a coherent dump anyway, so they'll try again. ++ */ ++ if (list_empty(&wg->peer_list) || (last_peer_cursor && list_empty(&last_peer_cursor->peer_list))) { ++ nla_nest_cancel(skb, peers_nest); ++ goto out; ++ } ++ lockdep_assert_held(&wg->device_update_lock); ++ peer = list_prepare_entry(last_peer_cursor, &wg->peer_list, peer_list); ++ list_for_each_entry_continue(peer, &wg->peer_list, peer_list) { ++ if (get_peer(peer, peer_idx++, rt_cursor, skb)) { ++ done = false; ++ break; ++ } ++ next_peer_cursor = peer; ++ } ++ nla_nest_end(skb, peers_nest); ++ ++out: ++ peer_put(last_peer_cursor); ++ if (!ret && !done) ++ next_peer_cursor = peer_rcu_get(next_peer_cursor); ++ mutex_unlock(&wg->device_update_lock); ++ rtnl_unlock(); ++ ++ if (ret) { ++ genlmsg_cancel(skb, hdr); ++ return ret; ++ } ++ genlmsg_end(skb, hdr); ++ if (done) { ++ cb->args[1] = 0; ++ return 0; ++ } ++ cb->args[1] = (long)next_peer_cursor; ++ return skb->len; ++ ++ /* At this point, we can't really deal ourselves with safely zeroing out ++ * the private key material after usage. This will need an additional API ++ * in the kernel for marking skbs as zero_on_free. ++ */ ++} ++ ++static int get_device_done(struct netlink_callback *cb) ++{ ++ struct wireguard_device *wg = (struct wireguard_device *)cb->args[0]; ++ struct wireguard_peer *peer = (struct wireguard_peer *)cb->args[1]; ++ struct allowedips_cursor *rt_cursor = (struct allowedips_cursor *)cb->args[2]; ++ ++ if (wg) ++ dev_put(wg->dev); ++ kfree(rt_cursor); ++ peer_put(peer); ++ return 0; ++} ++ ++static int set_port(struct wireguard_device *wg, u16 port) ++{ ++ struct wireguard_peer *peer; ++ ++ if (wg->incoming_port == port) ++ return 0; ++ list_for_each_entry(peer, &wg->peer_list, peer_list) ++ socket_clear_peer_endpoint_src(peer); ++ if (!netif_running(wg->dev)) { ++ wg->incoming_port = port; ++ return 0; ++ } ++ return socket_init(wg, port); ++} ++ ++static int set_allowedip(struct wireguard_peer *peer, struct nlattr **attrs) ++{ ++ int ret = -EINVAL; ++ u16 family; ++ u8 cidr; ++ ++ if (!attrs[WGALLOWEDIP_A_FAMILY] || !attrs[WGALLOWEDIP_A_IPADDR] || !attrs[WGALLOWEDIP_A_CIDR_MASK]) ++ return ret; ++ family = nla_get_u16(attrs[WGALLOWEDIP_A_FAMILY]); ++ cidr = nla_get_u8(attrs[WGALLOWEDIP_A_CIDR_MASK]); ++ ++ if (family == AF_INET && cidr <= 32 && nla_len(attrs[WGALLOWEDIP_A_IPADDR]) == sizeof(struct in_addr)) ++ ret = allowedips_insert_v4(&peer->device->peer_allowedips, nla_data(attrs[WGALLOWEDIP_A_IPADDR]), cidr, peer, &peer->device->device_update_lock); ++ else if (family == AF_INET6 && cidr <= 128 && nla_len(attrs[WGALLOWEDIP_A_IPADDR]) == sizeof(struct in6_addr)) ++ ret = allowedips_insert_v6(&peer->device->peer_allowedips, nla_data(attrs[WGALLOWEDIP_A_IPADDR]), cidr, peer, &peer->device->device_update_lock); ++ ++ return ret; ++} ++ ++static int set_peer(struct wireguard_device *wg, struct nlattr **attrs) ++{ ++ int ret; ++ u32 flags = 0; ++ struct wireguard_peer *peer = NULL; ++ u8 *public_key = NULL, *preshared_key = NULL; ++ ++ ret = -EINVAL; ++ if (attrs[WGPEER_A_PUBLIC_KEY] && nla_len(attrs[WGPEER_A_PUBLIC_KEY]) == NOISE_PUBLIC_KEY_LEN) ++ public_key = nla_data(attrs[WGPEER_A_PUBLIC_KEY]); ++ else ++ goto out; ++ if (attrs[WGPEER_A_PRESHARED_KEY] && nla_len(attrs[WGPEER_A_PRESHARED_KEY]) == NOISE_SYMMETRIC_KEY_LEN) ++ preshared_key = nla_data(attrs[WGPEER_A_PRESHARED_KEY]); ++ if (attrs[WGPEER_A_FLAGS]) ++ flags = nla_get_u32(attrs[WGPEER_A_FLAGS]); ++ ++ peer = pubkey_hashtable_lookup(&wg->peer_hashtable, nla_data(attrs[WGPEER_A_PUBLIC_KEY])); ++ if (!peer) { /* Peer doesn't exist yet. Add a new one. */ ++ ret = -ENODEV; ++ if (flags & WGPEER_F_REMOVE_ME) ++ goto out; /* Tried to remove a non-existing peer. */ ++ ++ down_read(&wg->static_identity.lock); ++ if (wg->static_identity.has_identity && !memcmp(nla_data(attrs[WGPEER_A_PUBLIC_KEY]), wg->static_identity.static_public, NOISE_PUBLIC_KEY_LEN)) { ++ /* We silently ignore peers that have the same public key as the device. The reason we do it silently ++ * is that we'd like for people to be able to reuse the same set of API calls across peers. ++ */ ++ up_read(&wg->static_identity.lock); ++ ret = 0; ++ goto out; ++ } ++ up_read(&wg->static_identity.lock); ++ ++ ret = -ENOMEM; ++ peer = peer_rcu_get(peer_create(wg, public_key, preshared_key)); ++ if (!peer) ++ goto out; ++ } ++ ++ ret = 0; ++ if (flags & WGPEER_F_REMOVE_ME) { ++ peer_remove(peer); ++ goto out; ++ } ++ ++ if (preshared_key) { ++ down_write(&peer->handshake.lock); ++ memcpy(&peer->handshake.preshared_key, preshared_key, NOISE_SYMMETRIC_KEY_LEN); ++ up_write(&peer->handshake.lock); ++ } ++ ++ if (attrs[WGPEER_A_ENDPOINT]) { ++ struct sockaddr *addr = nla_data(attrs[WGPEER_A_ENDPOINT]); ++ size_t len = nla_len(attrs[WGPEER_A_ENDPOINT]); ++ ++ if ((len == sizeof(struct sockaddr_in) && addr->sa_family == AF_INET) || (len == sizeof(struct sockaddr_in6) && addr->sa_family == AF_INET6)) { ++ struct endpoint endpoint = { { { 0 } } }; ++ ++ memcpy(&endpoint.addr, addr, len); ++ socket_set_peer_endpoint(peer, &endpoint); ++ } ++ } ++ ++ if (flags & WGPEER_F_REPLACE_ALLOWEDIPS) ++ allowedips_remove_by_peer(&wg->peer_allowedips, peer, &wg->device_update_lock); ++ ++ if (attrs[WGPEER_A_ALLOWEDIPS]) { ++ int rem; ++ struct nlattr *attr, *allowedip[WGALLOWEDIP_A_MAX + 1]; ++ ++ nla_for_each_nested(attr, attrs[WGPEER_A_ALLOWEDIPS], rem) { ++ ret = nla_parse_nested(allowedip, WGALLOWEDIP_A_MAX, attr, allowedip_policy, NULL); ++ if (ret < 0) ++ goto out; ++ ret = set_allowedip(peer, allowedip); ++ if (ret < 0) ++ goto out; ++ } ++ } ++ ++ if (attrs[WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL]) { ++ const u16 persistent_keepalive_interval = nla_get_u16(attrs[WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL]); ++ const bool send_keepalive = !peer->persistent_keepalive_interval && persistent_keepalive_interval && netif_running(wg->dev); ++ ++ peer->persistent_keepalive_interval = (unsigned long)persistent_keepalive_interval * HZ; ++ if (send_keepalive) ++ packet_send_keepalive(peer); ++ } ++ ++ if (netif_running(wg->dev)) ++ packet_send_staged_packets(peer); ++ ++out: ++ peer_put(peer); ++ if (attrs[WGPEER_A_PRESHARED_KEY]) ++ memzero_explicit(nla_data(attrs[WGPEER_A_PRESHARED_KEY]), nla_len(attrs[WGPEER_A_PRESHARED_KEY])); ++ return ret; ++} ++ ++static int set_device(struct sk_buff *skb, struct genl_info *info) ++{ ++ int ret; ++ struct wireguard_device *wg = lookup_interface(info->attrs, skb); ++ ++ if (IS_ERR(wg)) { ++ ret = PTR_ERR(wg); ++ goto out_nodev; ++ } ++ ++ rtnl_lock(); ++ mutex_lock(&wg->device_update_lock); ++ ++wg->device_update_gen; ++ ++ if (info->attrs[WGDEVICE_A_FWMARK]) { ++ struct wireguard_peer *peer; ++ ++ wg->fwmark = nla_get_u32(info->attrs[WGDEVICE_A_FWMARK]); ++ list_for_each_entry(peer, &wg->peer_list, peer_list) ++ socket_clear_peer_endpoint_src(peer); ++ } ++ ++ if (info->attrs[WGDEVICE_A_LISTEN_PORT]) { ++ ret = set_port(wg, nla_get_u16(info->attrs[WGDEVICE_A_LISTEN_PORT])); ++ if (ret) ++ goto out; ++ } ++ ++ if (info->attrs[WGDEVICE_A_FLAGS] && nla_get_u32(info->attrs[WGDEVICE_A_FLAGS]) & WGDEVICE_F_REPLACE_PEERS) ++ peer_remove_all(wg); ++ ++ if (info->attrs[WGDEVICE_A_PRIVATE_KEY] && nla_len(info->attrs[WGDEVICE_A_PRIVATE_KEY]) == NOISE_PUBLIC_KEY_LEN) { ++ struct wireguard_peer *peer, *temp; ++ u8 public_key[NOISE_PUBLIC_KEY_LEN], *private_key = nla_data(info->attrs[WGDEVICE_A_PRIVATE_KEY]); ++ ++ /* We remove before setting, to prevent race, which means doing two 25519-genpub ops. */ ++ if (curve25519_generate_public(public_key, private_key)) { ++ peer = pubkey_hashtable_lookup(&wg->peer_hashtable, public_key); ++ if (peer) { ++ peer_put(peer); ++ peer_remove(peer); ++ } ++ } ++ ++ noise_set_static_identity_private_key(&wg->static_identity, private_key); ++ list_for_each_entry_safe(peer, temp, &wg->peer_list, peer_list) { ++ if (!noise_precompute_static_static(peer)) ++ peer_remove(peer); ++ } ++ cookie_checker_precompute_device_keys(&wg->cookie_checker); ++ } ++ ++ if (info->attrs[WGDEVICE_A_PEERS]) { ++ int rem; ++ struct nlattr *attr, *peer[WGPEER_A_MAX + 1]; ++ ++ nla_for_each_nested(attr, info->attrs[WGDEVICE_A_PEERS], rem) { ++ ret = nla_parse_nested(peer, WGPEER_A_MAX, attr, peer_policy, NULL); ++ if (ret < 0) ++ goto out; ++ ret = set_peer(wg, peer); ++ if (ret < 0) ++ goto out; ++ } ++ } ++ ret = 0; ++ ++out: ++ mutex_unlock(&wg->device_update_lock); ++ rtnl_unlock(); ++ dev_put(wg->dev); ++out_nodev: ++ if (info->attrs[WGDEVICE_A_PRIVATE_KEY]) ++ memzero_explicit(nla_data(info->attrs[WGDEVICE_A_PRIVATE_KEY]), nla_len(info->attrs[WGDEVICE_A_PRIVATE_KEY])); ++ return ret; ++} ++ ++#ifndef COMPAT_CANNOT_USE_CONST_GENL_OPS ++static const ++#else ++static ++#endif ++struct genl_ops genl_ops[] = { ++ { ++ .cmd = WG_CMD_GET_DEVICE, ++#ifndef COMPAT_CANNOT_USE_NETLINK_START ++ .start = get_device_start, ++#endif ++ .dumpit = get_device_dump, ++ .done = get_device_done, ++ .policy = device_policy, ++ .flags = GENL_UNS_ADMIN_PERM ++ }, { ++ .cmd = WG_CMD_SET_DEVICE, ++ .doit = set_device, ++ .policy = device_policy, ++ .flags = GENL_UNS_ADMIN_PERM ++ } ++}; ++ ++static struct genl_family genl_family ++#ifndef COMPAT_CANNOT_USE_GENL_NOPS ++__ro_after_init = { ++ .ops = genl_ops, ++ .n_ops = ARRAY_SIZE(genl_ops), ++#else ++= { ++#endif ++ .name = WG_GENL_NAME, ++ .version = WG_GENL_VERSION, ++ .maxattr = WGDEVICE_A_MAX, ++ .module = THIS_MODULE, ++ .netnsok = true ++}; ++ ++int __init genetlink_init(void) ++{ ++ return genl_register_family(&genl_family); ++} ++ ++void __exit genetlink_uninit(void) ++{ ++ genl_unregister_family(&genl_family); ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/noise.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,635 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "noise.h" ++#include "device.h" ++#include "peer.h" ++#include "messages.h" ++#include "queueing.h" ++#include "hashtables.h" ++ ++#include ++#include ++#include ++#include ++#include ++#include ++ ++/* This implements Noise_IKpsk2: ++ * ++ * <- s ++ * ****** ++ * -> e, es, s, ss, {t} ++ * <- e, ee, se, psk, {} ++ */ ++ ++static const u8 handshake_name[37] = "Noise_IKpsk2_25519_ChaChaPoly_BLAKE2s"; ++static const u8 identifier_name[34] = "WireGuard v1 zx2c4 Jason@zx2c4.com"; ++static u8 handshake_init_hash[NOISE_HASH_LEN] __ro_after_init; ++static u8 handshake_init_chaining_key[NOISE_HASH_LEN] __ro_after_init; ++static atomic64_t keypair_counter = ATOMIC64_INIT(0); ++ ++void __init noise_init(void) ++{ ++ struct blake2s_state blake; ++ ++ blake2s(handshake_init_chaining_key, handshake_name, NULL, NOISE_HASH_LEN, sizeof(handshake_name), 0); ++ blake2s_init(&blake, NOISE_HASH_LEN); ++ blake2s_update(&blake, handshake_init_chaining_key, NOISE_HASH_LEN); ++ blake2s_update(&blake, identifier_name, sizeof(identifier_name)); ++ blake2s_final(&blake, handshake_init_hash, NOISE_HASH_LEN); ++} ++ ++bool noise_precompute_static_static(struct wireguard_peer *peer) ++{ ++ if (peer->handshake.static_identity->has_identity) ++ return curve25519(peer->handshake.precomputed_static_static, peer->handshake.static_identity->static_private, peer->handshake.remote_static); ++ memset(peer->handshake.precomputed_static_static, 0, NOISE_PUBLIC_KEY_LEN); ++ return true; ++} ++ ++bool noise_handshake_init(struct noise_handshake *handshake, struct noise_static_identity *static_identity, const u8 peer_public_key[NOISE_PUBLIC_KEY_LEN], const u8 peer_preshared_key[NOISE_SYMMETRIC_KEY_LEN], struct wireguard_peer *peer) ++{ ++ memset(handshake, 0, sizeof(struct noise_handshake)); ++ init_rwsem(&handshake->lock); ++ handshake->entry.type = INDEX_HASHTABLE_HANDSHAKE; ++ handshake->entry.peer = peer; ++ memcpy(handshake->remote_static, peer_public_key, NOISE_PUBLIC_KEY_LEN); ++ if (peer_preshared_key) ++ memcpy(handshake->preshared_key, peer_preshared_key, NOISE_SYMMETRIC_KEY_LEN); ++ handshake->static_identity = static_identity; ++ handshake->state = HANDSHAKE_ZEROED; ++ return noise_precompute_static_static(peer); ++} ++ ++static void handshake_zero(struct noise_handshake *handshake) ++{ ++ memset(&handshake->ephemeral_private, 0, NOISE_PUBLIC_KEY_LEN); ++ memset(&handshake->remote_ephemeral, 0, NOISE_PUBLIC_KEY_LEN); ++ memset(&handshake->hash, 0, NOISE_HASH_LEN); ++ memset(&handshake->chaining_key, 0, NOISE_HASH_LEN); ++ handshake->remote_index = 0; ++ handshake->state = HANDSHAKE_ZEROED; ++} ++ ++void noise_handshake_clear(struct noise_handshake *handshake) ++{ ++ index_hashtable_remove(&handshake->entry.peer->device->index_hashtable, &handshake->entry); ++ down_write(&handshake->lock); ++ handshake_zero(handshake); ++ up_write(&handshake->lock); ++ index_hashtable_remove(&handshake->entry.peer->device->index_hashtable, &handshake->entry); ++} ++ ++static struct noise_keypair *keypair_create(struct wireguard_peer *peer) ++{ ++ struct noise_keypair *keypair = kzalloc(sizeof(struct noise_keypair), GFP_KERNEL); ++ ++ if (unlikely(!keypair)) ++ return NULL; ++ keypair->internal_id = atomic64_inc_return(&keypair_counter); ++ keypair->entry.type = INDEX_HASHTABLE_KEYPAIR; ++ keypair->entry.peer = peer; ++ kref_init(&keypair->refcount); ++ return keypair; ++} ++ ++static void keypair_free_rcu(struct rcu_head *rcu) ++{ ++ struct noise_keypair *keypair = container_of(rcu, struct noise_keypair, rcu); ++ ++ net_dbg_ratelimited("%s: Keypair %llu destroyed for peer %llu\n", keypair->entry.peer->device->dev->name, keypair->internal_id, keypair->entry.peer->internal_id); ++ kzfree(keypair); ++} ++ ++static void keypair_free_kref(struct kref *kref) ++{ ++ struct noise_keypair *keypair = container_of(kref, struct noise_keypair, refcount); ++ ++ index_hashtable_remove(&keypair->entry.peer->device->index_hashtable, &keypair->entry); ++ call_rcu_bh(&keypair->rcu, keypair_free_rcu); ++} ++ ++void noise_keypair_put(struct noise_keypair *keypair) ++{ ++ if (unlikely(!keypair)) ++ return; ++ kref_put(&keypair->refcount, keypair_free_kref); ++} ++ ++struct noise_keypair *noise_keypair_get(struct noise_keypair *keypair) ++{ ++ RCU_LOCKDEP_WARN(!rcu_read_lock_bh_held(), "Taking noise keypair reference without holding the RCU BH read lock"); ++ if (unlikely(!keypair || !kref_get_unless_zero(&keypair->refcount))) ++ return NULL; ++ return keypair; ++} ++ ++void noise_keypairs_clear(struct noise_keypairs *keypairs) ++{ ++ struct noise_keypair *old; ++ ++ spin_lock_bh(&keypairs->keypair_update_lock); ++ old = rcu_dereference_protected(keypairs->previous_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); ++ rcu_assign_pointer(keypairs->previous_keypair, NULL); ++ noise_keypair_put(old); ++ old = rcu_dereference_protected(keypairs->next_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); ++ rcu_assign_pointer(keypairs->next_keypair, NULL); ++ noise_keypair_put(old); ++ old = rcu_dereference_protected(keypairs->current_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); ++ rcu_assign_pointer(keypairs->current_keypair, NULL); ++ noise_keypair_put(old); ++ spin_unlock_bh(&keypairs->keypair_update_lock); ++} ++ ++static void add_new_keypair(struct noise_keypairs *keypairs, struct noise_keypair *new_keypair) ++{ ++ struct noise_keypair *previous_keypair, *next_keypair, *current_keypair; ++ ++ spin_lock_bh(&keypairs->keypair_update_lock); ++ previous_keypair = rcu_dereference_protected(keypairs->previous_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); ++ next_keypair = rcu_dereference_protected(keypairs->next_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); ++ current_keypair = rcu_dereference_protected(keypairs->current_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); ++ if (new_keypair->i_am_the_initiator) { ++ /* If we're the initiator, it means we've sent a handshake, and received ++ * a confirmation response, which means this new keypair can now be used. ++ */ ++ if (next_keypair) { ++ /* If there already was a next keypair pending, we demote it to be ++ * the previous keypair, and free the existing current. ++ * TODO: note that this means KCI can result in this transition. It ++ * would perhaps be more sound to always just get rid of the unused ++ * next keypair instead of putting it in the previous slot, but this ++ * might be a bit less robust. Something to think about and decide on. ++ */ ++ rcu_assign_pointer(keypairs->next_keypair, NULL); ++ rcu_assign_pointer(keypairs->previous_keypair, next_keypair); ++ noise_keypair_put(current_keypair); ++ } else /* If there wasn't an existing next keypair, we replace the ++ * previous with the current one. ++ */ ++ rcu_assign_pointer(keypairs->previous_keypair, current_keypair); ++ /* At this point we can get rid of the old previous keypair, and set up ++ * the new keypair. ++ */ ++ noise_keypair_put(previous_keypair); ++ rcu_assign_pointer(keypairs->current_keypair, new_keypair); ++ } else { ++ /* If we're the responder, it means we can't use the new keypair until ++ * we receive confirmation via the first data packet, so we get rid of ++ * the existing previous one, the possibly existing next one, and slide ++ * in the new next one. ++ */ ++ rcu_assign_pointer(keypairs->next_keypair, new_keypair); ++ noise_keypair_put(next_keypair); ++ rcu_assign_pointer(keypairs->previous_keypair, NULL); ++ noise_keypair_put(previous_keypair); ++ } ++ spin_unlock_bh(&keypairs->keypair_update_lock); ++} ++ ++bool noise_received_with_keypair(struct noise_keypairs *keypairs, struct noise_keypair *received_keypair) ++{ ++ bool key_is_new; ++ struct noise_keypair *old_keypair; ++ ++ /* We first check without taking the spinlock. */ ++ key_is_new = received_keypair == rcu_access_pointer(keypairs->next_keypair); ++ if (likely(!key_is_new)) ++ return false; ++ ++ spin_lock_bh(&keypairs->keypair_update_lock); ++ /* After locking, we double check that things didn't change from beneath us. */ ++ if (unlikely(received_keypair != rcu_dereference_protected(keypairs->next_keypair, lockdep_is_held(&keypairs->keypair_update_lock)))) { ++ spin_unlock_bh(&keypairs->keypair_update_lock); ++ return false; ++ } ++ ++ /* When we've finally received the confirmation, we slide the next ++ * into the current, the current into the previous, and get rid of ++ * the old previous. ++ */ ++ old_keypair = rcu_dereference_protected(keypairs->previous_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); ++ rcu_assign_pointer(keypairs->previous_keypair, rcu_dereference_protected(keypairs->current_keypair, lockdep_is_held(&keypairs->keypair_update_lock))); ++ noise_keypair_put(old_keypair); ++ rcu_assign_pointer(keypairs->current_keypair, received_keypair); ++ rcu_assign_pointer(keypairs->next_keypair, NULL); ++ ++ spin_unlock_bh(&keypairs->keypair_update_lock); ++ return true; ++} ++ ++void noise_set_static_identity_private_key(struct noise_static_identity *static_identity, const u8 private_key[NOISE_PUBLIC_KEY_LEN]) ++{ ++ down_write(&static_identity->lock); ++ memcpy(static_identity->static_private, private_key, NOISE_PUBLIC_KEY_LEN); ++ static_identity->has_identity = curve25519_generate_public(static_identity->static_public, private_key); ++ up_write(&static_identity->lock); ++} ++ ++/* This is Hugo Krawczyk's HKDF: ++ * - https://eprint.iacr.org/2010/264.pdf ++ * - https://tools.ietf.org/html/rfc5869 ++ */ ++static void kdf(u8 *first_dst, u8 *second_dst, u8 *third_dst, const u8 *data, size_t first_len, size_t second_len, size_t third_len, size_t data_len, const u8 chaining_key[NOISE_HASH_LEN]) ++{ ++ u8 secret[BLAKE2S_OUTBYTES]; ++ u8 output[BLAKE2S_OUTBYTES + 1]; ++ ++#ifdef DEBUG ++ BUG_ON(first_len > BLAKE2S_OUTBYTES || second_len > BLAKE2S_OUTBYTES || third_len > BLAKE2S_OUTBYTES || ((second_len || second_dst || third_len || third_dst) && (!first_len || !first_dst)) || ((third_len || third_dst) && (!second_len || !second_dst))); ++#endif ++ ++ /* Extract entropy from data into secret */ ++ blake2s_hmac(secret, data, chaining_key, BLAKE2S_OUTBYTES, data_len, NOISE_HASH_LEN); ++ ++ if (!first_dst || !first_len) ++ goto out; ++ ++ /* Expand first key: key = secret, data = 0x1 */ ++ output[0] = 1; ++ blake2s_hmac(output, output, secret, BLAKE2S_OUTBYTES, 1, BLAKE2S_OUTBYTES); ++ memcpy(first_dst, output, first_len); ++ ++ if (!second_dst || !second_len) ++ goto out; ++ ++ /* Expand second key: key = secret, data = first-key || 0x2 */ ++ output[BLAKE2S_OUTBYTES] = 2; ++ blake2s_hmac(output, output, secret, BLAKE2S_OUTBYTES, BLAKE2S_OUTBYTES + 1, BLAKE2S_OUTBYTES); ++ memcpy(second_dst, output, second_len); ++ ++ if (!third_dst || !third_len) ++ goto out; ++ ++ /* Expand third key: key = secret, data = second-key || 0x3 */ ++ output[BLAKE2S_OUTBYTES] = 3; ++ blake2s_hmac(output, output, secret, BLAKE2S_OUTBYTES, BLAKE2S_OUTBYTES + 1, BLAKE2S_OUTBYTES); ++ memcpy(third_dst, output, third_len); ++ ++out: ++ /* Clear sensitive data from stack */ ++ memzero_explicit(secret, BLAKE2S_OUTBYTES); ++ memzero_explicit(output, BLAKE2S_OUTBYTES + 1); ++} ++ ++static void symmetric_key_init(struct noise_symmetric_key *key) ++{ ++ spin_lock_init(&key->counter.receive.lock); ++ atomic64_set(&key->counter.counter, 0); ++ memset(key->counter.receive.backtrack, 0, sizeof(key->counter.receive.backtrack)); ++ key->birthdate = get_jiffies_64(); ++ key->is_valid = true; ++} ++ ++static void derive_keys(struct noise_symmetric_key *first_dst, struct noise_symmetric_key *second_dst, const u8 chaining_key[NOISE_HASH_LEN]) ++{ ++ kdf(first_dst->key, second_dst->key, NULL, NULL, NOISE_SYMMETRIC_KEY_LEN, NOISE_SYMMETRIC_KEY_LEN, 0, 0, chaining_key); ++ symmetric_key_init(first_dst); ++ symmetric_key_init(second_dst); ++} ++ ++static bool __must_check mix_dh(u8 chaining_key[NOISE_HASH_LEN], u8 key[NOISE_SYMMETRIC_KEY_LEN], const u8 private[NOISE_PUBLIC_KEY_LEN], const u8 public[NOISE_PUBLIC_KEY_LEN]) ++{ ++ u8 dh_calculation[NOISE_PUBLIC_KEY_LEN]; ++ ++ if (unlikely(!curve25519(dh_calculation, private, public))) ++ return false; ++ kdf(chaining_key, key, NULL, dh_calculation, NOISE_HASH_LEN, NOISE_SYMMETRIC_KEY_LEN, 0, NOISE_PUBLIC_KEY_LEN, chaining_key); ++ memzero_explicit(dh_calculation, NOISE_PUBLIC_KEY_LEN); ++ return true; ++} ++ ++static void mix_hash(u8 hash[NOISE_HASH_LEN], const u8 *src, size_t src_len) ++{ ++ struct blake2s_state blake; ++ ++ blake2s_init(&blake, NOISE_HASH_LEN); ++ blake2s_update(&blake, hash, NOISE_HASH_LEN); ++ blake2s_update(&blake, src, src_len); ++ blake2s_final(&blake, hash, NOISE_HASH_LEN); ++} ++ ++static void mix_psk(u8 chaining_key[NOISE_HASH_LEN], u8 hash[NOISE_HASH_LEN], u8 key[NOISE_SYMMETRIC_KEY_LEN], const u8 psk[NOISE_SYMMETRIC_KEY_LEN]) ++{ ++ u8 temp_hash[NOISE_HASH_LEN]; ++ ++ kdf(chaining_key, temp_hash, key, psk, NOISE_HASH_LEN, NOISE_HASH_LEN, NOISE_SYMMETRIC_KEY_LEN, NOISE_SYMMETRIC_KEY_LEN, chaining_key); ++ mix_hash(hash, temp_hash, NOISE_HASH_LEN); ++ memzero_explicit(temp_hash, NOISE_HASH_LEN); ++} ++ ++static void handshake_init(u8 chaining_key[NOISE_HASH_LEN], u8 hash[NOISE_HASH_LEN], const u8 remote_static[NOISE_PUBLIC_KEY_LEN]) ++{ ++ memcpy(hash, handshake_init_hash, NOISE_HASH_LEN); ++ memcpy(chaining_key, handshake_init_chaining_key, NOISE_HASH_LEN); ++ mix_hash(hash, remote_static, NOISE_PUBLIC_KEY_LEN); ++} ++ ++static void message_encrypt(u8 *dst_ciphertext, const u8 *src_plaintext, size_t src_len, u8 key[NOISE_SYMMETRIC_KEY_LEN], u8 hash[NOISE_HASH_LEN]) ++{ ++ chacha20poly1305_encrypt(dst_ciphertext, src_plaintext, src_len, hash, NOISE_HASH_LEN, 0 /* Always zero for Noise_IK */, key); ++ mix_hash(hash, dst_ciphertext, noise_encrypted_len(src_len)); ++} ++ ++static bool message_decrypt(u8 *dst_plaintext, const u8 *src_ciphertext, size_t src_len, u8 key[NOISE_SYMMETRIC_KEY_LEN], u8 hash[NOISE_HASH_LEN]) ++{ ++ if (!chacha20poly1305_decrypt(dst_plaintext, src_ciphertext, src_len, hash, NOISE_HASH_LEN, 0 /* Always zero for Noise_IK */, key)) ++ return false; ++ mix_hash(hash, src_ciphertext, src_len); ++ return true; ++} ++ ++static void message_ephemeral(u8 ephemeral_dst[NOISE_PUBLIC_KEY_LEN], const u8 ephemeral_src[NOISE_PUBLIC_KEY_LEN], u8 chaining_key[NOISE_HASH_LEN], u8 hash[NOISE_HASH_LEN]) ++{ ++ if (ephemeral_dst != ephemeral_src) ++ memcpy(ephemeral_dst, ephemeral_src, NOISE_PUBLIC_KEY_LEN); ++ mix_hash(hash, ephemeral_src, NOISE_PUBLIC_KEY_LEN); ++ kdf(chaining_key, NULL, NULL, ephemeral_src, NOISE_HASH_LEN, 0, 0, NOISE_PUBLIC_KEY_LEN, chaining_key); ++} ++ ++static void tai64n_now(u8 output[NOISE_TIMESTAMP_LEN]) ++{ ++ struct timespec64 now; ++ ++ getnstimeofday64(&now); ++ /* https://cr.yp.to/libtai/tai64.html */ ++ *(__be64 *)output = cpu_to_be64(4611686018427387914ULL + now.tv_sec); ++ *(__be32 *)(output + sizeof(__be64)) = cpu_to_be32(now.tv_nsec); ++} ++ ++bool noise_handshake_create_initiation(struct message_handshake_initiation *dst, struct noise_handshake *handshake) ++{ ++ u8 timestamp[NOISE_TIMESTAMP_LEN]; ++ u8 key[NOISE_SYMMETRIC_KEY_LEN]; ++ bool ret = false; ++ ++ down_read(&handshake->static_identity->lock); ++ down_write(&handshake->lock); ++ ++ if (unlikely(!handshake->static_identity->has_identity)) ++ goto out; ++ ++ dst->header.type = cpu_to_le32(MESSAGE_HANDSHAKE_INITIATION); ++ ++ handshake_init(handshake->chaining_key, handshake->hash, handshake->remote_static); ++ ++ /* e */ ++ curve25519_generate_secret(handshake->ephemeral_private); ++ if (!curve25519_generate_public(dst->unencrypted_ephemeral, handshake->ephemeral_private)) ++ goto out; ++ message_ephemeral(dst->unencrypted_ephemeral, dst->unencrypted_ephemeral, handshake->chaining_key, handshake->hash); ++ ++ /* es */ ++ if (!mix_dh(handshake->chaining_key, key, handshake->ephemeral_private, handshake->remote_static)) ++ goto out; ++ ++ /* s */ ++ message_encrypt(dst->encrypted_static, handshake->static_identity->static_public, NOISE_PUBLIC_KEY_LEN, key, handshake->hash); ++ ++ /* ss */ ++ kdf(handshake->chaining_key, key, NULL, handshake->precomputed_static_static, NOISE_HASH_LEN, NOISE_SYMMETRIC_KEY_LEN, 0, NOISE_PUBLIC_KEY_LEN, handshake->chaining_key); ++ ++ /* {t} */ ++ tai64n_now(timestamp); ++ message_encrypt(dst->encrypted_timestamp, timestamp, NOISE_TIMESTAMP_LEN, key, handshake->hash); ++ ++ dst->sender_index = index_hashtable_insert(&handshake->entry.peer->device->index_hashtable, &handshake->entry); ++ ++ handshake->state = HANDSHAKE_CREATED_INITIATION; ++ ret = true; ++ ++out: ++ up_write(&handshake->lock); ++ up_read(&handshake->static_identity->lock); ++ memzero_explicit(key, NOISE_SYMMETRIC_KEY_LEN); ++ return ret; ++} ++ ++struct wireguard_peer *noise_handshake_consume_initiation(struct message_handshake_initiation *src, struct wireguard_device *wg) ++{ ++ bool replay_attack, flood_attack; ++ u8 s[NOISE_PUBLIC_KEY_LEN]; ++ u8 e[NOISE_PUBLIC_KEY_LEN]; ++ u8 t[NOISE_TIMESTAMP_LEN]; ++ struct noise_handshake *handshake; ++ struct wireguard_peer *wg_peer = NULL; ++ u8 key[NOISE_SYMMETRIC_KEY_LEN]; ++ u8 hash[NOISE_HASH_LEN]; ++ u8 chaining_key[NOISE_HASH_LEN]; ++ ++ down_read(&wg->static_identity.lock); ++ if (unlikely(!wg->static_identity.has_identity)) ++ goto out; ++ ++ handshake_init(chaining_key, hash, wg->static_identity.static_public); ++ ++ /* e */ ++ message_ephemeral(e, src->unencrypted_ephemeral, chaining_key, hash); ++ ++ /* es */ ++ if (!mix_dh(chaining_key, key, wg->static_identity.static_private, e)) ++ goto out; ++ ++ /* s */ ++ if (!message_decrypt(s, src->encrypted_static, sizeof(src->encrypted_static), key, hash)) ++ goto out; ++ ++ /* Lookup which peer we're actually talking to */ ++ wg_peer = pubkey_hashtable_lookup(&wg->peer_hashtable, s); ++ if (!wg_peer) ++ goto out; ++ handshake = &wg_peer->handshake; ++ ++ /* ss */ ++ kdf(chaining_key, key, NULL, handshake->precomputed_static_static, NOISE_HASH_LEN, NOISE_SYMMETRIC_KEY_LEN, 0, NOISE_PUBLIC_KEY_LEN, chaining_key); ++ ++ /* {t} */ ++ if (!message_decrypt(t, src->encrypted_timestamp, sizeof(src->encrypted_timestamp), key, hash)) ++ goto out; ++ ++ down_read(&handshake->lock); ++ replay_attack = memcmp(t, handshake->latest_timestamp, NOISE_TIMESTAMP_LEN) <= 0; ++ flood_attack = !time_is_before_jiffies64(handshake->last_initiation_consumption + INITIATIONS_PER_SECOND); ++ up_read(&handshake->lock); ++ if (replay_attack || flood_attack) { ++ peer_put(wg_peer); ++ wg_peer = NULL; ++ goto out; ++ } ++ ++ /* Success! Copy everything to peer */ ++ down_write(&handshake->lock); ++ memcpy(handshake->remote_ephemeral, e, NOISE_PUBLIC_KEY_LEN); ++ memcpy(handshake->latest_timestamp, t, NOISE_TIMESTAMP_LEN); ++ memcpy(handshake->hash, hash, NOISE_HASH_LEN); ++ memcpy(handshake->chaining_key, chaining_key, NOISE_HASH_LEN); ++ handshake->remote_index = src->sender_index; ++ handshake->last_initiation_consumption = get_jiffies_64(); ++ handshake->state = HANDSHAKE_CONSUMED_INITIATION; ++ up_write(&handshake->lock); ++ ++out: ++ memzero_explicit(key, NOISE_SYMMETRIC_KEY_LEN); ++ memzero_explicit(hash, NOISE_HASH_LEN); ++ memzero_explicit(chaining_key, NOISE_HASH_LEN); ++ up_read(&wg->static_identity.lock); ++ return wg_peer; ++} ++ ++bool noise_handshake_create_response(struct message_handshake_response *dst, struct noise_handshake *handshake) ++{ ++ bool ret = false; ++ u8 key[NOISE_SYMMETRIC_KEY_LEN]; ++ ++ down_read(&handshake->static_identity->lock); ++ down_write(&handshake->lock); ++ ++ if (handshake->state != HANDSHAKE_CONSUMED_INITIATION) ++ goto out; ++ ++ dst->header.type = cpu_to_le32(MESSAGE_HANDSHAKE_RESPONSE); ++ dst->receiver_index = handshake->remote_index; ++ ++ /* e */ ++ curve25519_generate_secret(handshake->ephemeral_private); ++ if (!curve25519_generate_public(dst->unencrypted_ephemeral, handshake->ephemeral_private)) ++ goto out; ++ message_ephemeral(dst->unencrypted_ephemeral, dst->unencrypted_ephemeral, handshake->chaining_key, handshake->hash); ++ ++ /* ee */ ++ if (!mix_dh(handshake->chaining_key, NULL, handshake->ephemeral_private, handshake->remote_ephemeral)) ++ goto out; ++ ++ /* se */ ++ if (!mix_dh(handshake->chaining_key, NULL, handshake->ephemeral_private, handshake->remote_static)) ++ goto out; ++ ++ /* psk */ ++ mix_psk(handshake->chaining_key, handshake->hash, key, handshake->preshared_key); ++ ++ /* {} */ ++ message_encrypt(dst->encrypted_nothing, NULL, 0, key, handshake->hash); ++ ++ dst->sender_index = index_hashtable_insert(&handshake->entry.peer->device->index_hashtable, &handshake->entry); ++ ++ handshake->state = HANDSHAKE_CREATED_RESPONSE; ++ ret = true; ++ ++out: ++ up_write(&handshake->lock); ++ up_read(&handshake->static_identity->lock); ++ memzero_explicit(key, NOISE_SYMMETRIC_KEY_LEN); ++ return ret; ++} ++ ++struct wireguard_peer *noise_handshake_consume_response(struct message_handshake_response *src, struct wireguard_device *wg) ++{ ++ struct noise_handshake *handshake; ++ struct wireguard_peer *ret_peer = NULL; ++ u8 key[NOISE_SYMMETRIC_KEY_LEN]; ++ u8 hash[NOISE_HASH_LEN]; ++ u8 chaining_key[NOISE_HASH_LEN]; ++ u8 e[NOISE_PUBLIC_KEY_LEN]; ++ u8 ephemeral_private[NOISE_PUBLIC_KEY_LEN]; ++ u8 static_private[NOISE_PUBLIC_KEY_LEN]; ++ enum noise_handshake_state state = HANDSHAKE_ZEROED; ++ ++ down_read(&wg->static_identity.lock); ++ ++ if (unlikely(!wg->static_identity.has_identity)) ++ goto out; ++ ++ handshake = (struct noise_handshake *)index_hashtable_lookup(&wg->index_hashtable, INDEX_HASHTABLE_HANDSHAKE, src->receiver_index); ++ if (unlikely(!handshake)) ++ goto out; ++ ++ down_read(&handshake->lock); ++ state = handshake->state; ++ memcpy(hash, handshake->hash, NOISE_HASH_LEN); ++ memcpy(chaining_key, handshake->chaining_key, NOISE_HASH_LEN); ++ memcpy(ephemeral_private, handshake->ephemeral_private, NOISE_PUBLIC_KEY_LEN); ++ up_read(&handshake->lock); ++ ++ if (state != HANDSHAKE_CREATED_INITIATION) ++ goto fail; ++ ++ /* e */ ++ message_ephemeral(e, src->unencrypted_ephemeral, chaining_key, hash); ++ ++ /* ee */ ++ if (!mix_dh(chaining_key, NULL, ephemeral_private, e)) ++ goto out; ++ ++ /* se */ ++ if (!mix_dh(chaining_key, NULL, wg->static_identity.static_private, e)) ++ goto out; ++ ++ /* psk */ ++ mix_psk(chaining_key, hash, key, handshake->preshared_key); ++ ++ /* {} */ ++ if (!message_decrypt(NULL, src->encrypted_nothing, sizeof(src->encrypted_nothing), key, hash)) ++ goto fail; ++ ++ /* Success! Copy everything to peer */ ++ down_write(&handshake->lock); ++ /* It's important to check that the state is still the same, while we have an exclusive lock */ ++ if (handshake->state != state) { ++ up_write(&handshake->lock); ++ goto fail; ++ } ++ memcpy(handshake->remote_ephemeral, e, NOISE_PUBLIC_KEY_LEN); ++ memcpy(handshake->hash, hash, NOISE_HASH_LEN); ++ memcpy(handshake->chaining_key, chaining_key, NOISE_HASH_LEN); ++ handshake->remote_index = src->sender_index; ++ handshake->state = HANDSHAKE_CONSUMED_RESPONSE; ++ up_write(&handshake->lock); ++ ret_peer = handshake->entry.peer; ++ goto out; ++ ++fail: ++ peer_put(handshake->entry.peer); ++out: ++ memzero_explicit(key, NOISE_SYMMETRIC_KEY_LEN); ++ memzero_explicit(hash, NOISE_HASH_LEN); ++ memzero_explicit(chaining_key, NOISE_HASH_LEN); ++ memzero_explicit(ephemeral_private, NOISE_PUBLIC_KEY_LEN); ++ memzero_explicit(static_private, NOISE_PUBLIC_KEY_LEN); ++ up_read(&wg->static_identity.lock); ++ return ret_peer; ++} ++ ++bool noise_handshake_begin_session(struct noise_handshake *handshake, struct noise_keypairs *keypairs) ++{ ++ struct noise_keypair *new_keypair; ++ ++ down_write(&handshake->lock); ++ if (handshake->state != HANDSHAKE_CREATED_RESPONSE && handshake->state != HANDSHAKE_CONSUMED_RESPONSE) ++ goto fail; ++ ++ new_keypair = keypair_create(handshake->entry.peer); ++ if (!new_keypair) ++ goto fail; ++ new_keypair->i_am_the_initiator = handshake->state == HANDSHAKE_CONSUMED_RESPONSE; ++ new_keypair->remote_index = handshake->remote_index; ++ ++ if (new_keypair->i_am_the_initiator) ++ derive_keys(&new_keypair->sending, &new_keypair->receiving, handshake->chaining_key); ++ else ++ derive_keys(&new_keypair->receiving, &new_keypair->sending, handshake->chaining_key); ++ ++ handshake_zero(handshake); ++ add_new_keypair(keypairs, new_keypair); ++ net_dbg_ratelimited("%s: Keypair %llu created for peer %llu\n", new_keypair->entry.peer->device->dev->name, new_keypair->internal_id, new_keypair->entry.peer->internal_id); ++ WARN_ON(!index_hashtable_replace(&handshake->entry.peer->device->index_hashtable, &handshake->entry, &new_keypair->entry)); ++ up_write(&handshake->lock); ++ ++ return true; ++ ++fail: ++ up_write(&handshake->lock); ++ return false; ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/peer.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,136 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "peer.h" ++#include "device.h" ++#include "queueing.h" ++#include "timers.h" ++#include "hashtables.h" ++#include "noise.h" ++ ++#include ++#include ++#include ++#include ++ ++static atomic64_t peer_counter = ATOMIC64_INIT(0); ++ ++struct wireguard_peer *peer_create(struct wireguard_device *wg, const u8 public_key[NOISE_PUBLIC_KEY_LEN], const u8 preshared_key[NOISE_SYMMETRIC_KEY_LEN]) ++{ ++ struct wireguard_peer *peer; ++ ++ lockdep_assert_held(&wg->device_update_lock); ++ ++ if (wg->num_peers >= MAX_PEERS_PER_DEVICE) ++ return NULL; ++ ++wg->num_peers; ++ ++ peer = kzalloc(sizeof(struct wireguard_peer), GFP_KERNEL); ++ if (!peer) ++ return NULL; ++ peer->device = wg; ++ ++ if (dst_cache_init(&peer->endpoint_cache, GFP_KERNEL)) { ++ kfree(peer); ++ return NULL; ++ } ++ ++ peer->internal_id = atomic64_inc_return(&peer_counter); ++ peer->serial_work_cpu = nr_cpumask_bits; ++ cookie_init(&peer->latest_cookie); ++ if (!noise_handshake_init(&peer->handshake, &wg->static_identity, public_key, preshared_key, peer)) { ++ kfree(peer); ++ return NULL; ++ } ++ timers_init(peer); ++ cookie_checker_precompute_peer_keys(peer); ++ spin_lock_init(&peer->keypairs.keypair_update_lock); ++ INIT_WORK(&peer->transmit_handshake_work, packet_handshake_send_worker); ++ rwlock_init(&peer->endpoint_lock); ++ kref_init(&peer->refcount); ++ packet_queue_init(&peer->tx_queue, packet_tx_worker, false, MAX_QUEUED_PACKETS); ++ packet_queue_init(&peer->rx_queue, packet_rx_worker, false, MAX_QUEUED_PACKETS); ++ skb_queue_head_init(&peer->staged_packet_queue); ++ list_add_tail(&peer->peer_list, &wg->peer_list); ++ pubkey_hashtable_add(&wg->peer_hashtable, peer); ++ peer->last_sent_handshake = get_jiffies_64() - REKEY_TIMEOUT - HZ; ++ pr_debug("%s: Peer %llu created\n", wg->dev->name, peer->internal_id); ++ return peer; ++} ++ ++struct wireguard_peer *peer_get(struct wireguard_peer *peer) ++{ ++ RCU_LOCKDEP_WARN(!rcu_read_lock_bh_held(), "Taking peer reference without holding the RCU read lock"); ++ if (unlikely(!peer || !kref_get_unless_zero(&peer->refcount))) ++ return NULL; ++ return peer; ++} ++ ++struct wireguard_peer *peer_rcu_get(struct wireguard_peer *peer) ++{ ++ rcu_read_lock_bh(); ++ peer = peer_get(peer); ++ rcu_read_unlock_bh(); ++ return peer; ++} ++ ++/* We have a separate "remove" function to get rid of the final reference because ++ * peer_list, clearing handshakes, and flushing all require mutexes which requires ++ * sleeping, which must only be done from certain contexts. ++ */ ++void peer_remove(struct wireguard_peer *peer) ++{ ++ if (unlikely(!peer)) ++ return; ++ lockdep_assert_held(&peer->device->device_update_lock); ++ allowedips_remove_by_peer(&peer->device->peer_allowedips, peer, &peer->device->device_update_lock); ++ pubkey_hashtable_remove(&peer->device->peer_hashtable, peer); ++ skb_queue_purge(&peer->staged_packet_queue); ++ noise_handshake_clear(&peer->handshake); ++ noise_keypairs_clear(&peer->keypairs); ++ list_del_init(&peer->peer_list); ++ timers_stop(peer); ++ flush_workqueue(peer->device->packet_crypt_wq); /* The first flush is for encrypt/decrypt step. */ ++ flush_workqueue(peer->device->packet_crypt_wq); /* The second flush is for send/receive step. */ ++ flush_workqueue(peer->device->handshake_send_wq); ++ --peer->device->num_peers; ++ peer_put(peer); ++} ++ ++static void rcu_release(struct rcu_head *rcu) ++{ ++ struct wireguard_peer *peer = container_of(rcu, struct wireguard_peer, rcu); ++ ++ pr_debug("%s: Peer %llu (%pISpfsc) destroyed\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr); ++ dst_cache_destroy(&peer->endpoint_cache); ++ packet_queue_free(&peer->rx_queue, false); ++ packet_queue_free(&peer->tx_queue, false); ++ kzfree(peer); ++} ++ ++static void kref_release(struct kref *refcount) ++{ ++ struct wireguard_peer *peer = container_of(refcount, struct wireguard_peer, refcount); ++ ++ index_hashtable_remove(&peer->device->index_hashtable, &peer->handshake.entry); ++ skb_queue_purge(&peer->staged_packet_queue); ++ call_rcu_bh(&peer->rcu, rcu_release); ++} ++ ++void peer_put(struct wireguard_peer *peer) ++{ ++ if (unlikely(!peer)) ++ return; ++ kref_put(&peer->refcount, kref_release); ++} ++ ++void peer_remove_all(struct wireguard_device *wg) ++{ ++ struct wireguard_peer *peer, *temp; ++ ++ lockdep_assert_held(&wg->device_update_lock); ++ list_for_each_entry_safe(peer, temp, &wg->peer_list, peer_list) ++ peer_remove(peer); ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/queueing.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,46 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "queueing.h" ++ ++struct multicore_worker __percpu *packet_alloc_percpu_multicore_worker(work_func_t function, void *ptr) ++{ ++ int cpu; ++ struct multicore_worker __percpu *worker = alloc_percpu(struct multicore_worker); ++ ++ if (!worker) ++ return NULL; ++ ++ for_each_possible_cpu(cpu) { ++ per_cpu_ptr(worker, cpu)->ptr = ptr; ++ INIT_WORK(&per_cpu_ptr(worker, cpu)->work, function); ++ } ++ return worker; ++} ++ ++int packet_queue_init(struct crypt_queue *queue, work_func_t function, bool multicore, unsigned int len) ++{ ++ int ret; ++ ++ memset(queue, 0, sizeof(*queue)); ++ ret = ptr_ring_init(&queue->ring, len, GFP_KERNEL); ++ if (ret) ++ return ret; ++ if (multicore) { ++ queue->worker = packet_alloc_percpu_multicore_worker(function, queue); ++ if (!queue->worker) ++ return -ENOMEM; ++ } else ++ INIT_WORK(&queue->work, function); ++ return 0; ++} ++ ++void packet_queue_free(struct crypt_queue *queue, bool multicore) ++{ ++ if (multicore) ++ free_percpu(queue->worker); ++ WARN_ON(!ptr_ring_empty_bh(&queue->ring)); ++ ptr_ring_cleanup(&queue->ring, NULL); ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/ratelimiter.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,199 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "ratelimiter.h" ++#include ++#include ++#include ++#include ++ ++static struct kmem_cache *entry_cache; ++static hsiphash_key_t key; ++static spinlock_t table_lock = __SPIN_LOCK_UNLOCKED("ratelimiter_table_lock"); ++static atomic64_t refcnt = ATOMIC64_INIT(0); ++static atomic_t total_entries = ATOMIC_INIT(0); ++static unsigned int max_entries, table_size; ++static void gc_entries(struct work_struct *); ++static DECLARE_DEFERRABLE_WORK(gc_work, gc_entries); ++static struct hlist_head *table_v4; ++#if IS_ENABLED(CONFIG_IPV6) ++static struct hlist_head *table_v6; ++#endif ++ ++struct ratelimiter_entry { ++ u64 last_time_ns, tokens; ++ __be64 ip; ++ void *net; ++ spinlock_t lock; ++ struct hlist_node hash; ++ struct rcu_head rcu; ++}; ++ ++enum { ++ PACKETS_PER_SECOND = 20, ++ PACKETS_BURSTABLE = 5, ++ PACKET_COST = NSEC_PER_SEC / PACKETS_PER_SECOND, ++ TOKEN_MAX = PACKET_COST * PACKETS_BURSTABLE ++}; ++ ++static void entry_free(struct rcu_head *rcu) ++{ ++ kmem_cache_free(entry_cache, container_of(rcu, struct ratelimiter_entry, rcu)); ++ atomic_dec(&total_entries); ++} ++ ++static void entry_uninit(struct ratelimiter_entry *entry) ++{ ++ hlist_del_rcu(&entry->hash); ++ call_rcu(&entry->rcu, entry_free); ++} ++ ++/* Calling this function with a NULL work uninits all entries. */ ++static void gc_entries(struct work_struct *work) ++{ ++ unsigned int i; ++ struct ratelimiter_entry *entry; ++ struct hlist_node *temp; ++ const u64 now = ktime_get_ns(); ++ ++ for (i = 0; i < table_size; ++i) { ++ spin_lock(&table_lock); ++ hlist_for_each_entry_safe(entry, temp, &table_v4[i], hash) { ++ if (unlikely(!work) || now - entry->last_time_ns > NSEC_PER_SEC) ++ entry_uninit(entry); ++ } ++#if IS_ENABLED(CONFIG_IPV6) ++ hlist_for_each_entry_safe(entry, temp, &table_v6[i], hash) { ++ if (unlikely(!work) || now - entry->last_time_ns > NSEC_PER_SEC) ++ entry_uninit(entry); ++ } ++#endif ++ spin_unlock(&table_lock); ++ if (likely(work)) ++ cond_resched(); ++ } ++ if (likely(work)) ++ queue_delayed_work(system_power_efficient_wq, &gc_work, HZ); ++} ++ ++bool ratelimiter_allow(struct sk_buff *skb, struct net *net) ++{ ++ struct ratelimiter_entry *entry; ++ struct hlist_head *bucket; ++ struct { __be64 ip; u32 net; } data = { .net = (unsigned long)net & 0xffffffff }; ++ ++ if (skb->protocol == htons(ETH_P_IP)) { ++ data.ip = (__force __be64)ip_hdr(skb)->saddr; ++ bucket = &table_v4[hsiphash(&data, sizeof(u32) * 3, &key) & (table_size - 1)]; ++ } ++#if IS_ENABLED(CONFIG_IPV6) ++ else if (skb->protocol == htons(ETH_P_IPV6)) { ++ memcpy(&data.ip, &ipv6_hdr(skb)->saddr, sizeof(__be64)); /* Only 64 bits */ ++ bucket = &table_v6[hsiphash(&data, sizeof(u32) * 3, &key) & (table_size - 1)]; ++ } ++#endif ++ else ++ return false; ++ rcu_read_lock(); ++ hlist_for_each_entry_rcu(entry, bucket, hash) { ++ if (entry->net == net && entry->ip == data.ip) { ++ u64 now, tokens; ++ bool ret; ++ /* Inspired by nft_limit.c, but this is actually a slightly different ++ * algorithm. Namely, we incorporate the burst as part of the maximum ++ * tokens, rather than as part of the rate. ++ */ ++ spin_lock(&entry->lock); ++ now = ktime_get_ns(); ++ tokens = min_t(u64, TOKEN_MAX, entry->tokens + now - entry->last_time_ns); ++ entry->last_time_ns = now; ++ ret = tokens >= PACKET_COST; ++ entry->tokens = ret ? tokens - PACKET_COST : tokens; ++ spin_unlock(&entry->lock); ++ rcu_read_unlock(); ++ return ret; ++ } ++ } ++ rcu_read_unlock(); ++ ++ if (atomic_inc_return(&total_entries) > max_entries) ++ goto err_oom; ++ ++ entry = kmem_cache_alloc(entry_cache, GFP_KERNEL); ++ if (!entry) ++ goto err_oom; ++ ++ entry->net = net; ++ entry->ip = data.ip; ++ INIT_HLIST_NODE(&entry->hash); ++ spin_lock_init(&entry->lock); ++ entry->last_time_ns = ktime_get_ns(); ++ entry->tokens = TOKEN_MAX - PACKET_COST; ++ spin_lock(&table_lock); ++ hlist_add_head_rcu(&entry->hash, bucket); ++ spin_unlock(&table_lock); ++ return true; ++ ++err_oom: ++ atomic_dec(&total_entries); ++ return false; ++} ++ ++int ratelimiter_init(void) ++{ ++ if (atomic64_inc_return(&refcnt) != 1) ++ return 0; ++ ++ entry_cache = KMEM_CACHE(ratelimiter_entry, 0); ++ if (!entry_cache) ++ goto err; ++ ++ /* xt_hashlimit.c uses a slightly different algorithm for ratelimiting, ++ * but what it shares in common is that it uses a massive hashtable. So, ++ * we borrow their wisdom about good table sizes on different systems ++ * dependent on RAM. This calculation here comes from there. ++ */ ++ table_size = (totalram_pages > (1U << 30) / PAGE_SIZE) ? 8192 : max_t(unsigned long, 16, roundup_pow_of_two((totalram_pages << PAGE_SHIFT) / (1U << 14) / sizeof(struct hlist_head))); ++ max_entries = table_size * 8; ++ ++ table_v4 = kvzalloc(table_size * sizeof(struct hlist_head), GFP_KERNEL); ++ if (!table_v4) ++ goto err_kmemcache; ++ ++#if IS_ENABLED(CONFIG_IPV6) ++ table_v6 = kvzalloc(table_size * sizeof(struct hlist_head), GFP_KERNEL); ++ if (!table_v6) { ++ kvfree(table_v4); ++ goto err_kmemcache; ++ } ++#endif ++ ++ queue_delayed_work(system_power_efficient_wq, &gc_work, HZ); ++ get_random_bytes(&key, sizeof(key)); ++ return 0; ++ ++err_kmemcache: ++ kmem_cache_destroy(entry_cache); ++err: ++ atomic64_dec(&refcnt); ++ return -ENOMEM; ++} ++ ++void ratelimiter_uninit(void) ++{ ++ if (atomic64_dec_return(&refcnt)) ++ return; ++ ++ cancel_delayed_work_sync(&gc_work); ++ gc_entries(NULL); ++ rcu_barrier(); ++ kvfree(table_v4); ++#if IS_ENABLED(CONFIG_IPV6) ++ kvfree(table_v6); ++#endif ++ kmem_cache_destroy(entry_cache); ++} ++ ++#include "selftest/ratelimiter.h" +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/receive.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,490 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "queueing.h" ++#include "device.h" ++#include "peer.h" ++#include "timers.h" ++#include "messages.h" ++#include "cookie.h" ++#include "socket.h" ++ ++#include ++#include ++#include ++#include ++ ++/* Must be called with bh disabled. */ ++static inline void rx_stats(struct wireguard_peer *peer, size_t len) ++{ ++ struct pcpu_sw_netstats *tstats = get_cpu_ptr(peer->device->dev->tstats); ++ ++ u64_stats_update_begin(&tstats->syncp); ++ ++tstats->rx_packets; ++ tstats->rx_bytes += len; ++ peer->rx_bytes += len; ++ u64_stats_update_end(&tstats->syncp); ++ put_cpu_ptr(tstats); ++} ++ ++#define SKB_TYPE_LE32(skb) (((struct message_header *)(skb)->data)->type) ++ ++static inline size_t validate_header_len(struct sk_buff *skb) ++{ ++ if (unlikely(skb->len < sizeof(struct message_header))) ++ return 0; ++ if (SKB_TYPE_LE32(skb) == cpu_to_le32(MESSAGE_DATA) && skb->len >= MESSAGE_MINIMUM_LENGTH) ++ return sizeof(struct message_data); ++ if (SKB_TYPE_LE32(skb) == cpu_to_le32(MESSAGE_HANDSHAKE_INITIATION) && skb->len == sizeof(struct message_handshake_initiation)) ++ return sizeof(struct message_handshake_initiation); ++ if (SKB_TYPE_LE32(skb) == cpu_to_le32(MESSAGE_HANDSHAKE_RESPONSE) && skb->len == sizeof(struct message_handshake_response)) ++ return sizeof(struct message_handshake_response); ++ if (SKB_TYPE_LE32(skb) == cpu_to_le32(MESSAGE_HANDSHAKE_COOKIE) && skb->len == sizeof(struct message_handshake_cookie)) ++ return sizeof(struct message_handshake_cookie); ++ return 0; ++} ++ ++static inline int skb_prepare_header(struct sk_buff *skb, struct wireguard_device *wg) ++{ ++ struct udphdr *udp; ++ size_t data_offset, data_len, header_len; ++ ++ if (unlikely(skb_examine_untrusted_ip_hdr(skb) != skb->protocol || skb_transport_header(skb) < skb->head || (skb_transport_header(skb) + sizeof(struct udphdr)) > skb_tail_pointer(skb))) ++ return -EINVAL; /* Bogus IP header */ ++ udp = udp_hdr(skb); ++ data_offset = (u8 *)udp - skb->data; ++ if (unlikely(data_offset > U16_MAX || data_offset + sizeof(struct udphdr) > skb->len)) ++ return -EINVAL; /* Packet has offset at impossible location or isn't big enough to have UDP fields*/ ++ data_len = ntohs(udp->len); ++ if (unlikely(data_len < sizeof(struct udphdr) || data_len > skb->len - data_offset)) ++ return -EINVAL; /* UDP packet is reporting too small of a size or lying about its size */ ++ data_len -= sizeof(struct udphdr); ++ data_offset = (u8 *)udp + sizeof(struct udphdr) - skb->data; ++ if (unlikely(!pskb_may_pull(skb, data_offset + sizeof(struct message_header)) || pskb_trim(skb, data_len + data_offset) < 0)) ++ return -EINVAL; ++ skb_pull(skb, data_offset); ++ if (unlikely(skb->len != data_len)) ++ return -EINVAL; /* Final len does not agree with calculated len */ ++ header_len = validate_header_len(skb); ++ if (unlikely(!header_len)) ++ return -EINVAL; ++ __skb_push(skb, data_offset); ++ if (unlikely(!pskb_may_pull(skb, data_offset + header_len))) ++ return -EINVAL; ++ __skb_pull(skb, data_offset); ++ return 0; ++} ++ ++static void receive_handshake_packet(struct wireguard_device *wg, struct sk_buff *skb) ++{ ++ static u64 last_under_load; /* Yes this is global, so that our load calculation applies to the whole system. */ ++ struct wireguard_peer *peer = NULL; ++ bool under_load; ++ enum cookie_mac_state mac_state; ++ bool packet_needs_cookie; ++ ++ if (SKB_TYPE_LE32(skb) == cpu_to_le32(MESSAGE_HANDSHAKE_COOKIE)) { ++ net_dbg_skb_ratelimited("%s: Receiving cookie response from %pISpfsc\n", wg->dev->name, skb); ++ cookie_message_consume((struct message_handshake_cookie *)skb->data, wg); ++ return; ++ } ++ ++ under_load = skb_queue_len(&wg->incoming_handshakes) >= MAX_QUEUED_INCOMING_HANDSHAKES / 8; ++ if (under_load) ++ last_under_load = get_jiffies_64(); ++ else if (last_under_load) ++ under_load = time_is_after_jiffies64(last_under_load + HZ); ++ mac_state = cookie_validate_packet(&wg->cookie_checker, skb, under_load); ++ if ((under_load && mac_state == VALID_MAC_WITH_COOKIE) || (!under_load && mac_state == VALID_MAC_BUT_NO_COOKIE)) ++ packet_needs_cookie = false; ++ else if (under_load && mac_state == VALID_MAC_BUT_NO_COOKIE) ++ packet_needs_cookie = true; ++ else { ++ net_dbg_skb_ratelimited("%s: Invalid MAC of handshake, dropping packet from %pISpfsc\n", wg->dev->name, skb); ++ return; ++ } ++ ++ switch (SKB_TYPE_LE32(skb)) { ++ case cpu_to_le32(MESSAGE_HANDSHAKE_INITIATION): { ++ struct message_handshake_initiation *message = (struct message_handshake_initiation *)skb->data; ++ ++ if (packet_needs_cookie) { ++ packet_send_handshake_cookie(wg, skb, message->sender_index); ++ return; ++ } ++ peer = noise_handshake_consume_initiation(message, wg); ++ if (unlikely(!peer)) { ++ net_dbg_skb_ratelimited("%s: Invalid handshake initiation from %pISpfsc\n", wg->dev->name, skb); ++ return; ++ } ++ socket_set_peer_endpoint_from_skb(peer, skb); ++ net_dbg_ratelimited("%s: Receiving handshake initiation from peer %llu (%pISpfsc)\n", wg->dev->name, peer->internal_id, &peer->endpoint.addr); ++ packet_send_handshake_response(peer); ++ break; ++ } ++ case cpu_to_le32(MESSAGE_HANDSHAKE_RESPONSE): { ++ struct message_handshake_response *message = (struct message_handshake_response *)skb->data; ++ ++ if (packet_needs_cookie) { ++ packet_send_handshake_cookie(wg, skb, message->sender_index); ++ return; ++ } ++ peer = noise_handshake_consume_response(message, wg); ++ if (unlikely(!peer)) { ++ net_dbg_skb_ratelimited("%s: Invalid handshake response from %pISpfsc\n", wg->dev->name, skb); ++ return; ++ } ++ socket_set_peer_endpoint_from_skb(peer, skb); ++ net_dbg_ratelimited("%s: Receiving handshake response from peer %llu (%pISpfsc)\n", wg->dev->name, peer->internal_id, &peer->endpoint.addr); ++ if (noise_handshake_begin_session(&peer->handshake, &peer->keypairs)) { ++ timers_session_derived(peer); ++ timers_handshake_complete(peer); ++ /* Calling this function will either send any existing packets in the queue ++ * and not send a keepalive, which is the best case, Or, if there's nothing ++ * in the queue, it will send a keepalive, in order to give immediate ++ * confirmation of the session. ++ */ ++ packet_send_keepalive(peer); ++ } ++ break; ++ } ++ } ++ ++ if (unlikely(!peer)) { ++ WARN(1, "Somehow a wrong type of packet wound up in the handshake queue!\n"); ++ return; ++ } ++ ++ local_bh_disable(); ++ rx_stats(peer, skb->len); ++ local_bh_enable(); ++ ++ timers_any_authenticated_packet_received(peer); ++ timers_any_authenticated_packet_traversal(peer); ++ peer_put(peer); ++} ++ ++void packet_handshake_receive_worker(struct work_struct *work) ++{ ++ struct wireguard_device *wg = container_of(work, struct multicore_worker, work)->ptr; ++ struct sk_buff *skb; ++ ++ while ((skb = skb_dequeue(&wg->incoming_handshakes)) != NULL) { ++ receive_handshake_packet(wg, skb); ++ dev_kfree_skb(skb); ++ cond_resched(); ++ } ++} ++ ++static inline void keep_key_fresh(struct wireguard_peer *peer) ++{ ++ struct noise_keypair *keypair; ++ bool send = false; ++ ++ if (peer->sent_lastminute_handshake) ++ return; ++ ++ rcu_read_lock_bh(); ++ keypair = rcu_dereference_bh(peer->keypairs.current_keypair); ++ if (likely(keypair && keypair->sending.is_valid) && keypair->i_am_the_initiator && ++ unlikely(time_is_before_eq_jiffies64(keypair->sending.birthdate + REJECT_AFTER_TIME - KEEPALIVE_TIMEOUT - REKEY_TIMEOUT))) ++ send = true; ++ rcu_read_unlock_bh(); ++ ++ if (send) { ++ peer->sent_lastminute_handshake = true; ++ packet_send_queued_handshake_initiation(peer, false); ++ } ++} ++ ++static inline bool skb_decrypt(struct sk_buff *skb, struct noise_symmetric_key *key, bool have_simd) ++{ ++ struct scatterlist sg[MAX_SKB_FRAGS * 2 + 1]; ++ struct sk_buff *trailer; ++ unsigned int offset; ++ int num_frags; ++ ++ if (unlikely(!key)) ++ return false; ++ ++ if (unlikely(!key->is_valid || time_is_before_eq_jiffies64(key->birthdate + REJECT_AFTER_TIME) || key->counter.receive.counter >= REJECT_AFTER_MESSAGES)) { ++ key->is_valid = false; ++ return false; ++ } ++ ++ PACKET_CB(skb)->nonce = le64_to_cpu(((struct message_data *)skb->data)->counter); ++ ++ /* We ensure that the network header is part of the packet before we ++ * call skb_cow_data, so that there's no chance that data is removed ++ * from the skb, so that later we can extract the original endpoint. ++ */ ++ offset = skb->data - skb_network_header(skb); ++ skb_push(skb, offset); ++ num_frags = skb_cow_data(skb, 0, &trailer); ++ offset += sizeof(struct message_data); ++ skb_pull(skb, offset); ++ if (unlikely(num_frags < 0 || num_frags > ARRAY_SIZE(sg))) ++ return false; ++ ++ sg_init_table(sg, num_frags); ++ if (skb_to_sgvec(skb, sg, 0, skb->len) <= 0) ++ return false; ++ ++ if (!chacha20poly1305_decrypt_sg(sg, sg, skb->len, NULL, 0, PACKET_CB(skb)->nonce, key->key, have_simd)) ++ return false; ++ ++ /* Another ugly situation of pushing and pulling the header so as to ++ * keep endpoint information intact. ++ */ ++ skb_push(skb, offset); ++ if (pskb_trim(skb, skb->len - noise_encrypted_len(0))) ++ return false; ++ skb_pull(skb, offset); ++ ++ return true; ++} ++ ++/* This is RFC6479, a replay detection bitmap algorithm that avoids bitshifts */ ++static inline bool counter_validate(union noise_counter *counter, u64 their_counter) ++{ ++ bool ret = false; ++ unsigned long index, index_current, top, i; ++ ++ spin_lock_bh(&counter->receive.lock); ++ ++ if (unlikely(counter->receive.counter >= REJECT_AFTER_MESSAGES + 1 || their_counter >= REJECT_AFTER_MESSAGES)) ++ goto out; ++ ++ ++their_counter; ++ ++ if (unlikely((COUNTER_WINDOW_SIZE + their_counter) < counter->receive.counter)) ++ goto out; ++ ++ index = their_counter >> ilog2(BITS_PER_LONG); ++ ++ if (likely(their_counter > counter->receive.counter)) { ++ index_current = counter->receive.counter >> ilog2(BITS_PER_LONG); ++ top = min_t(unsigned long, index - index_current, COUNTER_BITS_TOTAL / BITS_PER_LONG); ++ for (i = 1; i <= top; ++i) ++ counter->receive.backtrack[(i + index_current) & ((COUNTER_BITS_TOTAL / BITS_PER_LONG) - 1)] = 0; ++ counter->receive.counter = their_counter; ++ } ++ ++ index &= (COUNTER_BITS_TOTAL / BITS_PER_LONG) - 1; ++ ret = !test_and_set_bit(their_counter & (BITS_PER_LONG - 1), &counter->receive.backtrack[index]); ++ ++out: ++ spin_unlock_bh(&counter->receive.lock); ++ return ret; ++} ++#include "selftest/counter.h" ++ ++static void packet_consume_data_done(struct sk_buff *skb, struct endpoint *endpoint) ++{ ++ struct wireguard_peer *peer = PACKET_PEER(skb), *routed_peer; ++ struct net_device *dev = peer->device->dev; ++ unsigned int len, len_before_trim; ++ ++ socket_set_peer_endpoint(peer, endpoint); ++ ++ if (unlikely(noise_received_with_keypair(&peer->keypairs, PACKET_CB(skb)->keypair))) { ++ timers_handshake_complete(peer); ++ packet_send_staged_packets(peer); ++ } ++ ++ keep_key_fresh(peer); ++ ++ timers_any_authenticated_packet_received(peer); ++ timers_any_authenticated_packet_traversal(peer); ++ ++ /* A packet with length 0 is a keepalive packet */ ++ if (unlikely(!skb->len)) { ++ rx_stats(peer, message_data_len(0)); ++ net_dbg_ratelimited("%s: Receiving keepalive packet from peer %llu (%pISpfsc)\n", dev->name, peer->internal_id, &peer->endpoint.addr); ++ goto packet_processed; ++ } ++ ++ timers_data_received(peer); ++ ++ if (unlikely(skb_network_header(skb) < skb->head)) ++ goto dishonest_packet_size; ++ if (unlikely(!(pskb_network_may_pull(skb, sizeof(struct iphdr)) && (ip_hdr(skb)->version == 4 || (ip_hdr(skb)->version == 6 && pskb_network_may_pull(skb, sizeof(struct ipv6hdr))))))) ++ goto dishonest_packet_type; ++ ++ skb->dev = dev; ++ skb->ip_summed = CHECKSUM_UNNECESSARY; ++ skb->protocol = skb_examine_untrusted_ip_hdr(skb); ++ if (skb->protocol == htons(ETH_P_IP)) { ++ len = ntohs(ip_hdr(skb)->tot_len); ++ if (unlikely(len < sizeof(struct iphdr))) ++ goto dishonest_packet_size; ++ if (INET_ECN_is_ce(PACKET_CB(skb)->ds)) ++ IP_ECN_set_ce(ip_hdr(skb)); ++ } else if (skb->protocol == htons(ETH_P_IPV6)) { ++ len = ntohs(ipv6_hdr(skb)->payload_len) + sizeof(struct ipv6hdr); ++ if (INET_ECN_is_ce(PACKET_CB(skb)->ds)) ++ IP6_ECN_set_ce(skb, ipv6_hdr(skb)); ++ } else ++ goto dishonest_packet_type; ++ ++ if (unlikely(len > skb->len)) ++ goto dishonest_packet_size; ++ len_before_trim = skb->len; ++ if (unlikely(pskb_trim(skb, len))) ++ goto packet_processed; ++ ++ routed_peer = allowedips_lookup_src(&peer->device->peer_allowedips, skb); ++ peer_put(routed_peer); /* We don't need the extra reference. */ ++ ++ if (unlikely(routed_peer != peer)) ++ goto dishonest_packet_peer; ++ ++ if (unlikely(netif_receive_skb(skb) == NET_RX_DROP)) { ++ ++dev->stats.rx_dropped; ++ net_dbg_ratelimited("%s: Failed to give packet to userspace from peer %llu (%pISpfsc)\n", dev->name, peer->internal_id, &peer->endpoint.addr); ++ } else ++ rx_stats(peer, message_data_len(len_before_trim)); ++ return; ++ ++dishonest_packet_peer: ++ net_dbg_skb_ratelimited("%s: Packet has unallowed src IP (%pISc) from peer %llu (%pISpfsc)\n", dev->name, skb, peer->internal_id, &peer->endpoint.addr); ++ ++dev->stats.rx_errors; ++ ++dev->stats.rx_frame_errors; ++ goto packet_processed; ++dishonest_packet_type: ++ net_dbg_ratelimited("%s: Packet is neither ipv4 nor ipv6 from peer %llu (%pISpfsc)\n", dev->name, peer->internal_id, &peer->endpoint.addr); ++ ++dev->stats.rx_errors; ++ ++dev->stats.rx_frame_errors; ++ goto packet_processed; ++dishonest_packet_size: ++ net_dbg_ratelimited("%s: Packet has incorrect size from peer %llu (%pISpfsc)\n", dev->name, peer->internal_id, &peer->endpoint.addr); ++ ++dev->stats.rx_errors; ++ ++dev->stats.rx_length_errors; ++ goto packet_processed; ++packet_processed: ++ dev_kfree_skb(skb); ++} ++ ++void packet_rx_worker(struct work_struct *work) ++{ ++ struct crypt_queue *queue = container_of(work, struct crypt_queue, work); ++ struct wireguard_peer *peer; ++ struct noise_keypair *keypair; ++ struct sk_buff *skb; ++ struct endpoint endpoint; ++ enum packet_state state; ++ bool free; ++ ++ local_bh_disable(); ++ spin_lock_bh(&queue->ring.consumer_lock); ++ while ((skb = __ptr_ring_peek(&queue->ring)) != NULL && (state = atomic_read(&PACKET_CB(skb)->state)) != PACKET_STATE_UNCRYPTED) { ++ __ptr_ring_discard_one(&queue->ring); ++ peer = PACKET_PEER(skb); ++ keypair = PACKET_CB(skb)->keypair; ++ free = true; ++ ++ if (unlikely(state != PACKET_STATE_CRYPTED)) ++ goto next; ++ ++ if (unlikely(!counter_validate(&keypair->receiving.counter, PACKET_CB(skb)->nonce))) { ++ net_dbg_ratelimited("%s: Packet has invalid nonce %llu (max %llu)\n", peer->device->dev->name, PACKET_CB(skb)->nonce, keypair->receiving.counter.receive.counter); ++ goto next; ++ } ++ ++ if (unlikely(socket_endpoint_from_skb(&endpoint, skb))) ++ goto next; ++ ++ skb_reset(skb); ++ packet_consume_data_done(skb, &endpoint); ++ free = false; ++ ++next: ++ noise_keypair_put(keypair); ++ peer_put(peer); ++ if (unlikely(free)) ++ dev_kfree_skb(skb); ++ } ++ spin_unlock_bh(&queue->ring.consumer_lock); ++ local_bh_enable(); ++} ++ ++void packet_decrypt_worker(struct work_struct *work) ++{ ++ struct crypt_queue *queue = container_of(work, struct multicore_worker, work)->ptr; ++ struct sk_buff *skb; ++ bool have_simd = chacha20poly1305_init_simd(); ++ ++ while ((skb = ptr_ring_consume_bh(&queue->ring)) != NULL) { ++ enum packet_state state = likely(skb_decrypt(skb, &PACKET_CB(skb)->keypair->receiving, have_simd)) ? PACKET_STATE_CRYPTED : PACKET_STATE_DEAD; ++ ++ queue_enqueue_per_peer(&PACKET_PEER(skb)->rx_queue, skb, state); ++ } ++ ++ chacha20poly1305_deinit_simd(have_simd); ++} ++ ++static void packet_consume_data(struct wireguard_device *wg, struct sk_buff *skb) ++{ ++ struct wireguard_peer *peer; ++ __le32 idx = ((struct message_data *)skb->data)->key_idx; ++ int ret; ++ ++ rcu_read_lock_bh(); ++ PACKET_CB(skb)->keypair = noise_keypair_get((struct noise_keypair *)index_hashtable_lookup(&wg->index_hashtable, INDEX_HASHTABLE_KEYPAIR, idx)); ++ rcu_read_unlock_bh(); ++ if (unlikely(!PACKET_CB(skb)->keypair)) { ++ dev_kfree_skb(skb); ++ return; ++ } ++ ++ /* The call to index_hashtable_lookup gives us a reference to its underlying peer, so we don't need to call peer_rcu_get(). */ ++ peer = PACKET_PEER(skb); ++ ++ ret = queue_enqueue_per_device_and_peer(&wg->decrypt_queue, &peer->rx_queue, skb, wg->packet_crypt_wq, &wg->decrypt_queue.last_cpu); ++ if (likely(!ret)) ++ return; /* Successful. No need to drop references below. */ ++ ++ if (ret == -EPIPE) ++ queue_enqueue_per_peer(&peer->rx_queue, skb, PACKET_STATE_DEAD); ++ else { ++ peer_put(peer); ++ noise_keypair_put(PACKET_CB(skb)->keypair); ++ dev_kfree_skb(skb); ++ } ++} ++ ++void packet_receive(struct wireguard_device *wg, struct sk_buff *skb) ++{ ++ if (unlikely(skb_prepare_header(skb, wg) < 0)) ++ goto err; ++ switch (SKB_TYPE_LE32(skb)) { ++ case cpu_to_le32(MESSAGE_HANDSHAKE_INITIATION): ++ case cpu_to_le32(MESSAGE_HANDSHAKE_RESPONSE): ++ case cpu_to_le32(MESSAGE_HANDSHAKE_COOKIE): { ++ int cpu; ++ ++ if (skb_queue_len(&wg->incoming_handshakes) > MAX_QUEUED_INCOMING_HANDSHAKES) { ++ net_dbg_skb_ratelimited("%s: Too many handshakes queued, dropping packet from %pISpfsc\n", wg->dev->name, skb); ++ goto err; ++ } ++ skb_queue_tail(&wg->incoming_handshakes, skb); ++ /* Queues up a call to packet_process_queued_handshake_packets(skb): */ ++ cpu = cpumask_next_online(&wg->incoming_handshake_cpu); ++ queue_work_on(cpu, wg->handshake_receive_wq, &per_cpu_ptr(wg->incoming_handshakes_worker, cpu)->work); ++ break; ++ } ++ case cpu_to_le32(MESSAGE_DATA): ++ PACKET_CB(skb)->ds = ip_tunnel_get_dsfield(ip_hdr(skb), skb); ++ packet_consume_data(wg, skb); ++ break; ++ default: ++ net_dbg_skb_ratelimited("%s: Invalid packet from %pISpfsc\n", wg->dev->name, skb); ++ goto err; ++ } ++ return; ++ ++err: ++ dev_kfree_skb(skb); ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/send.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,348 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "queueing.h" ++#include "timers.h" ++#include "device.h" ++#include "peer.h" ++#include "socket.h" ++#include "messages.h" ++#include "cookie.h" ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++static void packet_send_handshake_initiation(struct wireguard_peer *peer) ++{ ++ struct message_handshake_initiation packet; ++ ++ down_write(&peer->handshake.lock); ++ if (!time_is_before_jiffies64(peer->last_sent_handshake + REKEY_TIMEOUT)) { ++ up_write(&peer->handshake.lock); ++ return; /* This function is rate limited. */ ++ } ++ peer->last_sent_handshake = get_jiffies_64(); ++ up_write(&peer->handshake.lock); ++ ++ net_dbg_ratelimited("%s: Sending handshake initiation to peer %llu (%pISpfsc)\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr); ++ ++ if (noise_handshake_create_initiation(&packet, &peer->handshake)) { ++ cookie_add_mac_to_packet(&packet, sizeof(packet), peer); ++ timers_any_authenticated_packet_traversal(peer); ++ socket_send_buffer_to_peer(peer, &packet, sizeof(struct message_handshake_initiation), HANDSHAKE_DSCP); ++ timers_handshake_initiated(peer); ++ } ++} ++ ++void packet_handshake_send_worker(struct work_struct *work) ++{ ++ struct wireguard_peer *peer = container_of(work, struct wireguard_peer, transmit_handshake_work); ++ ++ packet_send_handshake_initiation(peer); ++ peer_put(peer); ++} ++ ++void packet_send_queued_handshake_initiation(struct wireguard_peer *peer, bool is_retry) ++{ ++ if (!is_retry) ++ peer->timer_handshake_attempts = 0; ++ ++ /* First checking the timestamp here is just an optimization; it will ++ * be caught while properly locked inside the actual work queue. ++ */ ++ if (!time_is_before_jiffies64(peer->last_sent_handshake + REKEY_TIMEOUT)) ++ return; ++ ++ peer = peer_rcu_get(peer); ++ /* Queues up calling packet_send_queued_handshakes(peer), where we do a peer_put(peer) after: */ ++ if (!queue_work(peer->device->handshake_send_wq, &peer->transmit_handshake_work)) ++ peer_put(peer); /* If the work was already queued, we want to drop the extra reference */ ++} ++ ++void packet_send_handshake_response(struct wireguard_peer *peer) ++{ ++ struct message_handshake_response packet; ++ ++ net_dbg_ratelimited("%s: Sending handshake response to peer %llu (%pISpfsc)\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr); ++ peer->last_sent_handshake = get_jiffies_64(); ++ ++ if (noise_handshake_create_response(&packet, &peer->handshake)) { ++ cookie_add_mac_to_packet(&packet, sizeof(packet), peer); ++ if (noise_handshake_begin_session(&peer->handshake, &peer->keypairs)) { ++ timers_session_derived(peer); ++ timers_any_authenticated_packet_traversal(peer); ++ socket_send_buffer_to_peer(peer, &packet, sizeof(struct message_handshake_response), HANDSHAKE_DSCP); ++ } ++ } ++} ++ ++void packet_send_handshake_cookie(struct wireguard_device *wg, struct sk_buff *initiating_skb, __le32 sender_index) ++{ ++ struct message_handshake_cookie packet; ++ ++ net_dbg_skb_ratelimited("%s: Sending cookie response for denied handshake message for %pISpfsc\n", wg->dev->name, initiating_skb); ++ cookie_message_create(&packet, initiating_skb, sender_index, &wg->cookie_checker); ++ socket_send_buffer_as_reply_to_skb(wg, initiating_skb, &packet, sizeof(packet)); ++} ++ ++static inline void keep_key_fresh(struct wireguard_peer *peer) ++{ ++ struct noise_keypair *keypair; ++ bool send = false; ++ ++ rcu_read_lock_bh(); ++ keypair = rcu_dereference_bh(peer->keypairs.current_keypair); ++ if (likely(keypair && keypair->sending.is_valid) && ++ (unlikely(atomic64_read(&keypair->sending.counter.counter) > REKEY_AFTER_MESSAGES) || ++ (keypair->i_am_the_initiator && unlikely(time_is_before_eq_jiffies64(keypair->sending.birthdate + REKEY_AFTER_TIME))))) ++ send = true; ++ rcu_read_unlock_bh(); ++ ++ if (send) ++ packet_send_queued_handshake_initiation(peer, false); ++} ++ ++static inline unsigned int skb_padding(struct sk_buff *skb) ++{ ++ /* We do this modulo business with the MTU, just in case the networking layer ++ * gives us a packet that's bigger than the MTU. Since we support GSO, this ++ * isn't strictly neccessary, but it's better to be cautious here, especially ++ * if that code ever changes. ++ */ ++ unsigned int last_unit = skb->len % skb->dev->mtu; ++ unsigned int padded_size = (last_unit + MESSAGE_PADDING_MULTIPLE - 1) & ~(MESSAGE_PADDING_MULTIPLE - 1); ++ ++ if (padded_size > skb->dev->mtu) ++ padded_size = skb->dev->mtu; ++ return padded_size - last_unit; ++} ++ ++static inline bool skb_encrypt(struct sk_buff *skb, struct noise_keypair *keypair, bool have_simd) ++{ ++ struct scatterlist sg[MAX_SKB_FRAGS * 2 + 1]; ++ struct message_data *header; ++ unsigned int padding_len, plaintext_len, trailer_len; ++ int num_frags; ++ struct sk_buff *trailer; ++ ++ /* Calculate lengths */ ++ padding_len = skb_padding(skb); ++ trailer_len = padding_len + noise_encrypted_len(0); ++ plaintext_len = skb->len + padding_len; ++ ++ /* Expand data section to have room for padding and auth tag */ ++ num_frags = skb_cow_data(skb, trailer_len, &trailer); ++ if (unlikely(num_frags < 0 || num_frags > ARRAY_SIZE(sg))) ++ return false; ++ ++ /* Set the padding to zeros, and make sure it and the auth tag are part of the skb */ ++ memset(skb_tail_pointer(trailer), 0, padding_len); ++ ++ /* Expand head section to have room for our header and the network stack's headers. */ ++ if (unlikely(skb_cow_head(skb, DATA_PACKET_HEAD_ROOM) < 0)) ++ return false; ++ ++ /* We have to remember to add the checksum to the innerpacket, in case the receiver forwards it. */ ++ if (likely(!skb_checksum_setup(skb, true))) ++ skb_checksum_help(skb); ++ ++ /* Only after checksumming can we safely add on the padding at the end and the header. */ ++ skb_set_inner_network_header(skb, 0); ++ header = (struct message_data *)skb_push(skb, sizeof(struct message_data)); ++ header->header.type = cpu_to_le32(MESSAGE_DATA); ++ header->key_idx = keypair->remote_index; ++ header->counter = cpu_to_le64(PACKET_CB(skb)->nonce); ++ pskb_put(skb, trailer, trailer_len); ++ ++ /* Now we can encrypt the scattergather segments */ ++ sg_init_table(sg, num_frags); ++ if (skb_to_sgvec(skb, sg, sizeof(struct message_data), noise_encrypted_len(plaintext_len)) <= 0) ++ return false; ++ return chacha20poly1305_encrypt_sg(sg, sg, plaintext_len, NULL, 0, PACKET_CB(skb)->nonce, keypair->sending.key, have_simd); ++} ++ ++void packet_send_keepalive(struct wireguard_peer *peer) ++{ ++ struct sk_buff *skb; ++ ++ if (skb_queue_empty(&peer->staged_packet_queue)) { ++ skb = alloc_skb(DATA_PACKET_HEAD_ROOM + MESSAGE_MINIMUM_LENGTH, GFP_ATOMIC); ++ if (unlikely(!skb)) ++ return; ++ skb_reserve(skb, DATA_PACKET_HEAD_ROOM); ++ skb->dev = peer->device->dev; ++ skb_queue_tail(&peer->staged_packet_queue, skb); ++ net_dbg_ratelimited("%s: Sending keepalive packet to peer %llu (%pISpfsc)\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr); ++ } ++ ++ packet_send_staged_packets(peer); ++} ++ ++#define skb_walk_null_queue_safe(first, skb, next) for (skb = first, next = skb->next; skb; skb = next, next = skb ? skb->next : NULL) ++static inline void skb_free_null_queue(struct sk_buff *first) ++{ ++ struct sk_buff *skb, *next; ++ ++ skb_walk_null_queue_safe(first, skb, next) ++ dev_kfree_skb(skb); ++} ++ ++static void packet_create_data_done(struct sk_buff *first, struct wireguard_peer *peer) ++{ ++ struct sk_buff *skb, *next; ++ bool is_keepalive, data_sent = false; ++ ++ timers_any_authenticated_packet_traversal(peer); ++ skb_walk_null_queue_safe(first, skb, next) { ++ is_keepalive = skb->len == message_data_len(0); ++ if (likely(!socket_send_skb_to_peer(peer, skb, PACKET_CB(skb)->ds) && !is_keepalive)) ++ data_sent = true; ++ } ++ ++ if (likely(data_sent)) ++ timers_data_sent(peer); ++ ++ keep_key_fresh(peer); ++} ++ ++void packet_tx_worker(struct work_struct *work) ++{ ++ struct crypt_queue *queue = container_of(work, struct crypt_queue, work); ++ struct wireguard_peer *peer; ++ struct noise_keypair *keypair; ++ struct sk_buff *first; ++ enum packet_state state; ++ ++ spin_lock_bh(&queue->ring.consumer_lock); ++ while ((first = __ptr_ring_peek(&queue->ring)) != NULL && (state = atomic_read(&PACKET_CB(first)->state)) != PACKET_STATE_UNCRYPTED) { ++ __ptr_ring_discard_one(&queue->ring); ++ peer = PACKET_PEER(first); ++ keypair = PACKET_CB(first)->keypair; ++ ++ if (likely(state == PACKET_STATE_CRYPTED)) ++ packet_create_data_done(first, peer); ++ else ++ skb_free_null_queue(first); ++ ++ noise_keypair_put(keypair); ++ peer_put(peer); ++ } ++ spin_unlock_bh(&queue->ring.consumer_lock); ++} ++ ++void packet_encrypt_worker(struct work_struct *work) ++{ ++ struct crypt_queue *queue = container_of(work, struct multicore_worker, work)->ptr; ++ struct sk_buff *first, *skb, *next; ++ bool have_simd = chacha20poly1305_init_simd(); ++ ++ while ((first = ptr_ring_consume_bh(&queue->ring)) != NULL) { ++ enum packet_state state = PACKET_STATE_CRYPTED; ++ ++ skb_walk_null_queue_safe(first, skb, next) { ++ if (likely(skb_encrypt(skb, PACKET_CB(first)->keypair, have_simd))) ++ skb_reset(skb); ++ else { ++ state = PACKET_STATE_DEAD; ++ break; ++ } ++ } ++ queue_enqueue_per_peer(&PACKET_PEER(first)->tx_queue, first, state); ++ } ++ chacha20poly1305_deinit_simd(have_simd); ++} ++ ++static void packet_create_data(struct sk_buff *first) ++{ ++ struct wireguard_peer *peer = PACKET_PEER(first); ++ struct wireguard_device *wg = peer->device; ++ int ret; ++ ++ ret = queue_enqueue_per_device_and_peer(&wg->encrypt_queue, &peer->tx_queue, first, wg->packet_crypt_wq, &wg->encrypt_queue.last_cpu); ++ if (likely(!ret)) ++ return; /* Successful. No need to fall through to drop references below. */ ++ ++ if (ret == -EPIPE) ++ queue_enqueue_per_peer(&peer->tx_queue, first, PACKET_STATE_DEAD); ++ else { ++ peer_put(peer); ++ noise_keypair_put(PACKET_CB(first)->keypair); ++ skb_free_null_queue(first); ++ } ++} ++ ++void packet_send_staged_packets(struct wireguard_peer *peer) ++{ ++ struct noise_keypair *keypair; ++ struct noise_symmetric_key *key; ++ struct sk_buff_head packets; ++ struct sk_buff *skb; ++ ++ /* Steal the current queue into our local one. */ ++ __skb_queue_head_init(&packets); ++ spin_lock_bh(&peer->staged_packet_queue.lock); ++ skb_queue_splice_init(&peer->staged_packet_queue, &packets); ++ spin_unlock_bh(&peer->staged_packet_queue.lock); ++ if (unlikely(skb_queue_empty(&packets))) ++ return; ++ ++ /* First we make sure we have a valid reference to a valid key. */ ++ rcu_read_lock_bh(); ++ keypair = noise_keypair_get(rcu_dereference_bh(peer->keypairs.current_keypair)); ++ rcu_read_unlock_bh(); ++ if (unlikely(!keypair)) ++ goto out_nokey; ++ key = &keypair->sending; ++ if (unlikely(!key || !key->is_valid)) ++ goto out_nokey; ++ if (unlikely(time_is_before_eq_jiffies64(key->birthdate + REJECT_AFTER_TIME))) ++ goto out_invalid; ++ ++ /* After we know we have a somewhat valid key, we now try to assign nonces to ++ * all of the packets in the queue. If we can't assign nonces for all of them, ++ * we just consider it a failure and wait for the next handshake. ++ */ ++ skb_queue_walk(&packets, skb) { ++ PACKET_CB(skb)->ds = ip_tunnel_ecn_encap(0 /* No outer TOS: no leak. TODO: should we use flowi->tos as outer? */, ip_hdr(skb), skb); ++ PACKET_CB(skb)->nonce = atomic64_inc_return(&key->counter.counter) - 1; ++ if (unlikely(PACKET_CB(skb)->nonce >= REJECT_AFTER_MESSAGES)) ++ goto out_invalid; ++ } ++ ++ packets.prev->next = NULL; ++ peer_rcu_get(keypair->entry.peer); ++ PACKET_CB(packets.next)->keypair = keypair; ++ packet_create_data(packets.next); ++ return; ++ ++out_invalid: ++ key->is_valid = false; ++out_nokey: ++ noise_keypair_put(keypair); ++ ++ /* We orphan the packets if we're waiting on a handshake, so that they ++ * don't block a socket's pool. ++ */ ++ skb_queue_walk(&packets, skb) ++ skb_orphan(skb); ++ /* Then we put them back on the top of the queue. We're not too concerned about ++ * accidently getting things a little out of order if packets are being added ++ * really fast, because this queue is for before packets can even be sent and ++ * it's small anyway. ++ */ ++ spin_lock_bh(&peer->staged_packet_queue.lock); ++ skb_queue_splice(&packets, &peer->staged_packet_queue); ++ spin_unlock_bh(&peer->staged_packet_queue.lock); ++ ++ /* If we're exiting because there's something wrong with the key, it means ++ * we should initiate a new handshake. ++ */ ++ packet_send_queued_handshake_initiation(peer, false); ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/socket.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,393 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "device.h" ++#include "peer.h" ++#include "socket.h" ++#include "queueing.h" ++#include "messages.h" ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++static inline int send4(struct wireguard_device *wg, struct sk_buff *skb, struct endpoint *endpoint, u8 ds, struct dst_cache *cache) ++{ ++ struct flowi4 fl = { ++ .saddr = endpoint->src4.s_addr, ++ .daddr = endpoint->addr4.sin_addr.s_addr, ++ .fl4_dport = endpoint->addr4.sin_port, ++ .flowi4_mark = wg->fwmark, ++ .flowi4_proto = IPPROTO_UDP ++ }; ++ struct rtable *rt = NULL; ++ struct sock *sock; ++ int ret = 0; ++ ++ skb->next = skb->prev = NULL; ++ skb->dev = wg->dev; ++ skb->mark = wg->fwmark; ++ ++ rcu_read_lock_bh(); ++ sock = rcu_dereference_bh(wg->sock4); ++ ++ if (unlikely(!sock)) { ++ ret = -ENONET; ++ goto err; ++ } ++ ++ fl.fl4_sport = inet_sk(sock)->inet_sport; ++ ++ if (cache) ++ rt = dst_cache_get_ip4(cache, &fl.saddr); ++ ++ if (!rt) { ++ security_sk_classify_flow(sock, flowi4_to_flowi(&fl)); ++ if (unlikely(!inet_confirm_addr(sock_net(sock), NULL, 0, fl.saddr, RT_SCOPE_HOST))) { ++ endpoint->src4.s_addr = *(__force __be32 *)&endpoint->src_if4 = fl.saddr = 0; ++ if (cache) ++ dst_cache_reset(cache); ++ } ++ rt = ip_route_output_flow(sock_net(sock), &fl, sock); ++ if (unlikely(endpoint->src_if4 && ((IS_ERR(rt) && PTR_ERR(rt) == -EINVAL) || (!IS_ERR(rt) && rt->dst.dev->ifindex != endpoint->src_if4)))) { ++ endpoint->src4.s_addr = *(__force __be32 *)&endpoint->src_if4 = fl.saddr = 0; ++ if (cache) ++ dst_cache_reset(cache); ++ if (!IS_ERR(rt)) ++ ip_rt_put(rt); ++ rt = ip_route_output_flow(sock_net(sock), &fl, sock); ++ } ++ if (unlikely(IS_ERR(rt))) { ++ ret = PTR_ERR(rt); ++ net_dbg_ratelimited("%s: No route to %pISpfsc, error %d\n", wg->dev->name, &endpoint->addr, ret); ++ goto err; ++ } else if (unlikely(rt->dst.dev == skb->dev)) { ++ ip_rt_put(rt); ++ ret = -ELOOP; ++ net_dbg_ratelimited("%s: Avoiding routing loop to %pISpfsc\n", wg->dev->name, &endpoint->addr); ++ goto err; ++ } ++ if (cache) ++ dst_cache_set_ip4(cache, &rt->dst, fl.saddr); ++ } ++ udp_tunnel_xmit_skb(rt, sock, skb, fl.saddr, fl.daddr, ds, ip4_dst_hoplimit(&rt->dst), 0, fl.fl4_sport, fl.fl4_dport, false, false); ++ goto out; ++ ++err: ++ kfree_skb(skb); ++out: ++ rcu_read_unlock_bh(); ++ return ret; ++} ++ ++static inline int send6(struct wireguard_device *wg, struct sk_buff *skb, struct endpoint *endpoint, u8 ds, struct dst_cache *cache) ++{ ++#if IS_ENABLED(CONFIG_IPV6) ++ struct flowi6 fl = { ++ .saddr = endpoint->src6, ++ .daddr = endpoint->addr6.sin6_addr, ++ .fl6_dport = endpoint->addr6.sin6_port, ++ .flowi6_mark = wg->fwmark, ++ .flowi6_oif = endpoint->addr6.sin6_scope_id, ++ .flowi6_proto = IPPROTO_UDP ++ /* TODO: addr->sin6_flowinfo */ ++ }; ++ struct dst_entry *dst = NULL; ++ struct sock *sock; ++ int ret = 0; ++ ++ skb->next = skb->prev = NULL; ++ skb->dev = wg->dev; ++ skb->mark = wg->fwmark; ++ ++ rcu_read_lock_bh(); ++ sock = rcu_dereference_bh(wg->sock6); ++ ++ if (unlikely(!sock)) { ++ ret = -ENONET; ++ goto err; ++ } ++ ++ fl.fl6_sport = inet_sk(sock)->inet_sport; ++ ++ if (cache) ++ dst = dst_cache_get_ip6(cache, &fl.saddr); ++ ++ if (!dst) { ++ security_sk_classify_flow(sock, flowi6_to_flowi(&fl)); ++ if (unlikely(!ipv6_addr_any(&fl.saddr) && !ipv6_chk_addr(sock_net(sock), &fl.saddr, NULL, 0))) { ++ endpoint->src6 = fl.saddr = in6addr_any; ++ if (cache) ++ dst_cache_reset(cache); ++ } ++ ret = ipv6_stub->ipv6_dst_lookup(sock_net(sock), sock, &dst, &fl); ++ if (unlikely(ret)) { ++ net_dbg_ratelimited("%s: No route to %pISpfsc, error %d\n", wg->dev->name, &endpoint->addr, ret); ++ goto err; ++ } else if (unlikely(dst->dev == skb->dev)) { ++ dst_release(dst); ++ ret = -ELOOP; ++ net_dbg_ratelimited("%s: Avoiding routing loop to %pISpfsc\n", wg->dev->name, &endpoint->addr); ++ goto err; ++ } ++ if (cache) ++ dst_cache_set_ip6(cache, dst, &fl.saddr); ++ } ++ ++ udp_tunnel6_xmit_skb(dst, sock, skb, skb->dev, &fl.saddr, &fl.daddr, ds, ip6_dst_hoplimit(dst), 0, fl.fl6_sport, fl.fl6_dport, false); ++ goto out; ++ ++err: ++ kfree_skb(skb); ++out: ++ rcu_read_unlock_bh(); ++ return ret; ++#else ++ return -EAFNOSUPPORT; ++#endif ++} ++ ++int socket_send_skb_to_peer(struct wireguard_peer *peer, struct sk_buff *skb, u8 ds) ++{ ++ size_t skb_len = skb->len; ++ int ret = -EAFNOSUPPORT; ++ ++ read_lock_bh(&peer->endpoint_lock); ++ if (peer->endpoint.addr.sa_family == AF_INET) ++ ret = send4(peer->device, skb, &peer->endpoint, ds, &peer->endpoint_cache); ++ else if (peer->endpoint.addr.sa_family == AF_INET6) ++ ret = send6(peer->device, skb, &peer->endpoint, ds, &peer->endpoint_cache); ++ else ++ dev_kfree_skb(skb); ++ if (likely(!ret)) ++ peer->tx_bytes += skb_len; ++ read_unlock_bh(&peer->endpoint_lock); ++ ++ return ret; ++} ++ ++int socket_send_buffer_to_peer(struct wireguard_peer *peer, void *buffer, size_t len, u8 ds) ++{ ++ struct sk_buff *skb = alloc_skb(len + SKB_HEADER_LEN, GFP_ATOMIC); ++ ++ if (unlikely(!skb)) ++ return -ENOMEM; ++ ++ skb_reserve(skb, SKB_HEADER_LEN); ++ skb_set_inner_network_header(skb, 0); ++ memcpy(skb_put(skb, len), buffer, len); ++ return socket_send_skb_to_peer(peer, skb, ds); ++} ++ ++int socket_send_buffer_as_reply_to_skb(struct wireguard_device *wg, struct sk_buff *in_skb, void *out_buffer, size_t len) ++{ ++ int ret = 0; ++ struct sk_buff *skb; ++ struct endpoint endpoint; ++ ++ if (unlikely(!in_skb)) ++ return -EINVAL; ++ ret = socket_endpoint_from_skb(&endpoint, in_skb); ++ if (unlikely(ret < 0)) ++ return ret; ++ ++ skb = alloc_skb(len + SKB_HEADER_LEN, GFP_ATOMIC); ++ if (unlikely(!skb)) ++ return -ENOMEM; ++ skb_reserve(skb, SKB_HEADER_LEN); ++ skb_set_inner_network_header(skb, 0); ++ memcpy(skb_put(skb, len), out_buffer, len); ++ ++ if (endpoint.addr.sa_family == AF_INET) ++ ret = send4(wg, skb, &endpoint, 0, NULL); ++ else if (endpoint.addr.sa_family == AF_INET6) ++ ret = send6(wg, skb, &endpoint, 0, NULL); ++ /* No other possibilities if the endpoint is valid, which it is, as we checked above. */ ++ ++ return ret; ++} ++ ++int socket_endpoint_from_skb(struct endpoint *endpoint, const struct sk_buff *skb) ++{ ++ memset(endpoint, 0, sizeof(struct endpoint)); ++ if (skb->protocol == htons(ETH_P_IP)) { ++ endpoint->addr4.sin_family = AF_INET; ++ endpoint->addr4.sin_port = udp_hdr(skb)->source; ++ endpoint->addr4.sin_addr.s_addr = ip_hdr(skb)->saddr; ++ endpoint->src4.s_addr = ip_hdr(skb)->daddr; ++ endpoint->src_if4 = skb->skb_iif; ++ } else if (skb->protocol == htons(ETH_P_IPV6)) { ++ endpoint->addr6.sin6_family = AF_INET6; ++ endpoint->addr6.sin6_port = udp_hdr(skb)->source; ++ endpoint->addr6.sin6_addr = ipv6_hdr(skb)->saddr; ++ endpoint->addr6.sin6_scope_id = ipv6_iface_scope_id(&ipv6_hdr(skb)->saddr, skb->skb_iif); ++ endpoint->src6 = ipv6_hdr(skb)->daddr; ++ } else ++ return -EINVAL; ++ return 0; ++} ++ ++static inline bool endpoint_eq(const struct endpoint *a, const struct endpoint *b) ++{ ++ return (a->addr.sa_family == AF_INET && b->addr.sa_family == AF_INET && ++ a->addr4.sin_port == b->addr4.sin_port && a->addr4.sin_addr.s_addr == b->addr4.sin_addr.s_addr && ++ a->src4.s_addr == b->src4.s_addr && a->src_if4 == b->src_if4) || ++ (a->addr.sa_family == AF_INET6 && b->addr.sa_family == AF_INET6 && ++ a->addr6.sin6_port == b->addr6.sin6_port && ipv6_addr_equal(&a->addr6.sin6_addr, &b->addr6.sin6_addr) && ++ a->addr6.sin6_scope_id == b->addr6.sin6_scope_id && ipv6_addr_equal(&a->src6, &b->src6)) || ++ unlikely(!a->addr.sa_family && !b->addr.sa_family); ++} ++ ++void socket_set_peer_endpoint(struct wireguard_peer *peer, const struct endpoint *endpoint) ++{ ++ /* First we check unlocked, in order to optimize, since it's pretty rare ++ * that an endpoint will change. If we happen to be mid-write, and two ++ * CPUs wind up writing the same thing or something slightly different, ++ * it doesn't really matter much either. ++ */ ++ if (endpoint_eq(endpoint, &peer->endpoint)) ++ return; ++ write_lock_bh(&peer->endpoint_lock); ++ if (endpoint->addr.sa_family == AF_INET) { ++ peer->endpoint.addr4 = endpoint->addr4; ++ peer->endpoint.src4 = endpoint->src4; ++ peer->endpoint.src_if4 = endpoint->src_if4; ++ } else if (endpoint->addr.sa_family == AF_INET6) { ++ peer->endpoint.addr6 = endpoint->addr6; ++ peer->endpoint.src6 = endpoint->src6; ++ } else ++ goto out; ++ dst_cache_reset(&peer->endpoint_cache); ++out: ++ write_unlock_bh(&peer->endpoint_lock); ++} ++ ++void socket_set_peer_endpoint_from_skb(struct wireguard_peer *peer, const struct sk_buff *skb) ++{ ++ struct endpoint endpoint; ++ ++ if (!socket_endpoint_from_skb(&endpoint, skb)) ++ socket_set_peer_endpoint(peer, &endpoint); ++} ++ ++void socket_clear_peer_endpoint_src(struct wireguard_peer *peer) ++{ ++ write_lock_bh(&peer->endpoint_lock); ++ memset(&peer->endpoint.src6, 0, sizeof(peer->endpoint.src6)); ++ dst_cache_reset(&peer->endpoint_cache); ++ write_unlock_bh(&peer->endpoint_lock); ++} ++ ++static int receive(struct sock *sk, struct sk_buff *skb) ++{ ++ struct wireguard_device *wg; ++ ++ if (unlikely(!sk)) ++ goto err; ++ wg = sk->sk_user_data; ++ if (unlikely(!wg)) ++ goto err; ++ packet_receive(wg, skb); ++ return 0; ++ ++err: ++ kfree_skb(skb); ++ return 0; ++} ++ ++static inline void sock_free(struct sock *sock) ++{ ++ if (unlikely(!sock)) ++ return; ++ sk_clear_memalloc(sock); ++ udp_tunnel_sock_release(sock->sk_socket); ++} ++ ++static inline void set_sock_opts(struct socket *sock) ++{ ++ sock->sk->sk_allocation = GFP_ATOMIC; ++ sock->sk->sk_sndbuf = INT_MAX; ++ sk_set_memalloc(sock->sk); ++} ++ ++int socket_init(struct wireguard_device *wg, u16 port) ++{ ++ int ret; ++ struct udp_tunnel_sock_cfg cfg = { ++ .sk_user_data = wg, ++ .encap_type = 1, ++ .encap_rcv = receive ++ }; ++ struct socket *new4 = NULL, *new6 = NULL; ++ struct udp_port_cfg port4 = { ++ .family = AF_INET, ++ .local_ip.s_addr = htonl(INADDR_ANY), ++ .local_udp_port = htons(port), ++ .use_udp_checksums = true ++ }; ++#if IS_ENABLED(CONFIG_IPV6) ++ int retries = 0; ++ struct udp_port_cfg port6 = { ++ .family = AF_INET6, ++ .local_ip6 = IN6ADDR_ANY_INIT, ++ .use_udp6_tx_checksums = true, ++ .use_udp6_rx_checksums = true, ++ .ipv6_v6only = true ++ }; ++#endif ++ ++#if IS_ENABLED(CONFIG_IPV6) ++retry: ++#endif ++ ++ ret = udp_sock_create(wg->creating_net, &port4, &new4); ++ if (ret < 0) { ++ pr_err("%s: Could not create IPv4 socket\n", wg->dev->name); ++ return ret; ++ } ++ set_sock_opts(new4); ++ setup_udp_tunnel_sock(wg->creating_net, new4, &cfg); ++ ++#if IS_ENABLED(CONFIG_IPV6) ++ if (ipv6_mod_enabled()) { ++ port6.local_udp_port = inet_sk(new4->sk)->inet_sport; ++ ret = udp_sock_create(wg->creating_net, &port6, &new6); ++ if (ret < 0) { ++ udp_tunnel_sock_release(new4); ++ if (ret == -EADDRINUSE && !port && retries++ < 100) ++ goto retry; ++ pr_err("%s: Could not create IPv6 socket\n", wg->dev->name); ++ return ret; ++ } ++ set_sock_opts(new6); ++ setup_udp_tunnel_sock(wg->creating_net, new6, &cfg); ++ } ++#endif ++ ++ socket_reinit(wg, new4 ? new4->sk : NULL, new6 ? new6->sk : NULL); ++ return 0; ++} ++ ++void socket_reinit(struct wireguard_device *wg, struct sock *new4, struct sock *new6) ++{ ++ struct sock *old4, *old6; ++ ++ mutex_lock(&wg->socket_update_lock); ++ old4 = rcu_dereference_protected(wg->sock4, lockdep_is_held(&wg->socket_update_lock)); ++ old6 = rcu_dereference_protected(wg->sock6, lockdep_is_held(&wg->socket_update_lock)); ++ rcu_assign_pointer(wg->sock4, new4); ++ rcu_assign_pointer(wg->sock6, new6); ++ if (new4) ++ wg->incoming_port = ntohs(inet_sk(new4)->inet_sport); ++ mutex_unlock(&wg->socket_update_lock); ++ synchronize_rcu_bh(); ++ synchronize_net(); ++ sock_free(old4); ++ sock_free(old6); ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/timers.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,199 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "timers.h" ++#include "device.h" ++#include "peer.h" ++#include "queueing.h" ++#include "socket.h" ++ ++/* ++ * Timer for retransmitting the handshake if we don't hear back after `REKEY_TIMEOUT + jitter` ms ++ * Timer for sending empty packet if we have received a packet but after have not sent one for `KEEPALIVE_TIMEOUT` ms ++ * Timer for initiating new handshake if we have sent a packet but after have not received one (even empty) for `(KEEPALIVE_TIMEOUT + REKEY_TIMEOUT)` ms ++ * Timer for zeroing out all ephemeral keys after `(REJECT_AFTER_TIME * 3)` ms if no new keys have been received ++ * Timer for, if enabled, sending an empty authenticated packet every user-specified seconds ++ */ ++ ++/* This rounds the time down to the closest power of two of the closest quarter second. */ ++static inline unsigned long slack_time(unsigned long time) ++{ ++ return time & ~(roundup_pow_of_two(HZ / 4) - 1); ++} ++ ++#define peer_get_from_timer(timer_name) \ ++ struct wireguard_peer *peer = peer_rcu_get(from_timer(peer, timer, timer_name)); \ ++ if (unlikely(!peer)) \ ++ return; ++ ++static inline bool timers_active(struct wireguard_peer *peer) ++{ ++ return netif_running(peer->device->dev) && !list_empty(&peer->peer_list); ++} ++ ++static void expired_retransmit_handshake(struct timer_list *timer) ++{ ++ peer_get_from_timer(timer_retransmit_handshake); ++ ++ if (peer->timer_handshake_attempts > MAX_TIMER_HANDSHAKES) { ++ pr_debug("%s: Handshake for peer %llu (%pISpfsc) did not complete after %d attempts, giving up\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr, MAX_TIMER_HANDSHAKES + 2); ++ ++ if (likely(timers_active(peer))) ++ del_timer(&peer->timer_send_keepalive); ++ /* We drop all packets without a keypair and don't try again, ++ * if we try unsuccessfully for too long to make a handshake. ++ */ ++ skb_queue_purge(&peer->staged_packet_queue); ++ ++ /* We set a timer for destroying any residue that might be left ++ * of a partial exchange. ++ */ ++ if (likely(timers_active(peer)) && !timer_pending(&peer->timer_zero_key_material)) ++ mod_timer(&peer->timer_zero_key_material, jiffies + (REJECT_AFTER_TIME * 3)); ++ } else { ++ ++peer->timer_handshake_attempts; ++ pr_debug("%s: Handshake for peer %llu (%pISpfsc) did not complete after %d seconds, retrying (try %d)\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr, REKEY_TIMEOUT / HZ, peer->timer_handshake_attempts + 1); ++ ++ /* We clear the endpoint address src address, in case this is the cause of trouble. */ ++ socket_clear_peer_endpoint_src(peer); ++ ++ packet_send_queued_handshake_initiation(peer, true); ++ } ++ peer_put(peer); ++} ++ ++static void expired_send_keepalive(struct timer_list *timer) ++{ ++ peer_get_from_timer(timer_send_keepalive); ++ ++ packet_send_keepalive(peer); ++ if (peer->timer_need_another_keepalive) { ++ peer->timer_need_another_keepalive = false; ++ if (likely(timers_active(peer))) ++ mod_timer(&peer->timer_send_keepalive, jiffies + KEEPALIVE_TIMEOUT); ++ } ++ peer_put(peer); ++} ++ ++static void expired_new_handshake(struct timer_list *timer) ++{ ++ peer_get_from_timer(timer_new_handshake); ++ ++ pr_debug("%s: Retrying handshake with peer %llu (%pISpfsc) because we stopped hearing back after %d seconds\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr, (KEEPALIVE_TIMEOUT + REKEY_TIMEOUT) / HZ); ++ /* We clear the endpoint address src address, in case this is the cause of trouble. */ ++ socket_clear_peer_endpoint_src(peer); ++ packet_send_queued_handshake_initiation(peer, false); ++ peer_put(peer); ++} ++ ++static void expired_zero_key_material(struct timer_list *timer) ++{ ++ peer_get_from_timer(timer_zero_key_material); ++ ++ if (!queue_work(peer->device->handshake_send_wq, &peer->clear_peer_work)) /* Takes our reference. */ ++ peer_put(peer); /* If the work was already on the queue, we want to drop the extra reference */ ++} ++static void queued_expired_zero_key_material(struct work_struct *work) ++{ ++ struct wireguard_peer *peer = container_of(work, struct wireguard_peer, clear_peer_work); ++ ++ pr_debug("%s: Zeroing out all keys for peer %llu (%pISpfsc), since we haven't received a new one in %d seconds\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr, (REJECT_AFTER_TIME * 3) / HZ); ++ noise_handshake_clear(&peer->handshake); ++ noise_keypairs_clear(&peer->keypairs); ++ peer_put(peer); ++} ++ ++static void expired_send_persistent_keepalive(struct timer_list *timer) ++{ ++ peer_get_from_timer(timer_persistent_keepalive); ++ ++ if (likely(peer->persistent_keepalive_interval)) { ++ if (likely(timers_active(peer))) ++ del_timer(&peer->timer_send_keepalive); ++ packet_send_keepalive(peer); ++ } ++ peer_put(peer); ++} ++ ++/* Should be called after an authenticated data packet is sent. */ ++void timers_data_sent(struct wireguard_peer *peer) ++{ ++ if (likely(timers_active(peer))) ++ del_timer(&peer->timer_send_keepalive); ++ ++ if (likely(timers_active(peer)) && !timer_pending(&peer->timer_new_handshake)) ++ mod_timer(&peer->timer_new_handshake, jiffies + KEEPALIVE_TIMEOUT + REKEY_TIMEOUT); ++} ++ ++/* Should be called after an authenticated data packet is received. */ ++void timers_data_received(struct wireguard_peer *peer) ++{ ++ if (likely(timers_active(peer))) { ++ if (!timer_pending(&peer->timer_send_keepalive)) ++ mod_timer(&peer->timer_send_keepalive, jiffies + KEEPALIVE_TIMEOUT); ++ else ++ peer->timer_need_another_keepalive = true; ++ } ++} ++ ++/* Should be called after any type of authenticated packet is received -- keepalive or data. */ ++void timers_any_authenticated_packet_received(struct wireguard_peer *peer) ++{ ++ if (likely(timers_active(peer))) ++ del_timer(&peer->timer_new_handshake); ++} ++ ++/* Should be called after a handshake initiation message is sent. */ ++void timers_handshake_initiated(struct wireguard_peer *peer) ++{ ++ if (likely(timers_active(peer))) { ++ del_timer(&peer->timer_send_keepalive); ++ mod_timer(&peer->timer_retransmit_handshake, slack_time(jiffies + REKEY_TIMEOUT + prandom_u32_max(REKEY_TIMEOUT_JITTER_MAX))); ++ } ++} ++ ++/* Should be called after a handshake response message is received and processed or when getting key confirmation via the first data message. */ ++void timers_handshake_complete(struct wireguard_peer *peer) ++{ ++ if (likely(timers_active(peer))) ++ del_timer(&peer->timer_retransmit_handshake); ++ peer->timer_handshake_attempts = 0; ++ peer->sent_lastminute_handshake = false; ++ getnstimeofday(&peer->walltime_last_handshake); ++} ++ ++/* Should be called after an ephemeral key is created, which is before sending a handshake response or after receiving a handshake response. */ ++void timers_session_derived(struct wireguard_peer *peer) ++{ ++ if (likely(timers_active(peer))) ++ mod_timer(&peer->timer_zero_key_material, jiffies + (REJECT_AFTER_TIME * 3)); ++} ++ ++/* Should be called before a packet with authentication -- data, keepalive, either handshake -- is sent, or after one is received. */ ++void timers_any_authenticated_packet_traversal(struct wireguard_peer *peer) ++{ ++ if (peer->persistent_keepalive_interval && likely(timers_active(peer))) ++ mod_timer(&peer->timer_persistent_keepalive, slack_time(jiffies + peer->persistent_keepalive_interval)); ++} ++ ++void timers_init(struct wireguard_peer *peer) ++{ ++ timer_setup(&peer->timer_retransmit_handshake, expired_retransmit_handshake, 0); ++ timer_setup(&peer->timer_send_keepalive, expired_send_keepalive, 0); ++ timer_setup(&peer->timer_new_handshake, expired_new_handshake, 0); ++ timer_setup(&peer->timer_zero_key_material, expired_zero_key_material, 0); ++ timer_setup(&peer->timer_persistent_keepalive, expired_send_persistent_keepalive, 0); ++ INIT_WORK(&peer->clear_peer_work, queued_expired_zero_key_material); ++} ++ ++void timers_stop(struct wireguard_peer *peer) ++{ ++ del_timer_sync(&peer->timer_retransmit_handshake); ++ del_timer_sync(&peer->timer_send_keepalive); ++ del_timer_sync(&peer->timer_new_handshake); ++ del_timer_sync(&peer->timer_zero_key_material); ++ del_timer_sync(&peer->timer_persistent_keepalive); ++ flush_work(&peer->clear_peer_work); ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/allowedips.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,44 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_ALLOWEDIPS_H ++#define _WG_ALLOWEDIPS_H ++ ++#include ++#include ++#include ++ ++struct wireguard_peer; ++struct allowedips_node; ++ ++struct allowedips { ++ struct allowedips_node __rcu *root4; ++ struct allowedips_node __rcu *root6; ++ u64 seq; ++}; ++ ++struct allowedips_cursor { ++ u64 seq; ++ struct allowedips_node *stack[128]; ++ unsigned int len; ++ bool second_half; ++}; ++ ++void allowedips_init(struct allowedips *table); ++void allowedips_free(struct allowedips *table, struct mutex *mutex); ++int allowedips_insert_v4(struct allowedips *table, const struct in_addr *ip, u8 cidr, struct wireguard_peer *peer, struct mutex *lock); ++int allowedips_insert_v6(struct allowedips *table, const struct in6_addr *ip, u8 cidr, struct wireguard_peer *peer, struct mutex *lock); ++void allowedips_remove_by_peer(struct allowedips *table, struct wireguard_peer *peer, struct mutex *lock); ++int allowedips_walk_by_peer(struct allowedips *table, struct allowedips_cursor *cursor, struct wireguard_peer *peer, int (*func)(void *ctx, const u8 *ip, u8 cidr, int family), void *ctx, struct mutex *lock); ++ ++/* These return a strong reference to a peer: */ ++struct wireguard_peer *allowedips_lookup_dst(struct allowedips *table, struct sk_buff *skb); ++struct wireguard_peer *allowedips_lookup_src(struct allowedips *table, struct sk_buff *skb); ++ ++#ifdef DEBUG ++bool allowedips_selftest(void); ++#endif ++ ++#endif /* _WG_ALLOWEDIPS_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/cookie.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,52 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_COOKIE_H ++#define _WG_COOKIE_H ++ ++#include "messages.h" ++#include ++ ++struct wireguard_peer; ++ ++struct cookie_checker { ++ u8 secret[NOISE_HASH_LEN]; ++ u8 cookie_encryption_key[NOISE_SYMMETRIC_KEY_LEN]; ++ u8 message_mac1_key[NOISE_SYMMETRIC_KEY_LEN]; ++ u64 secret_birthdate; ++ struct rw_semaphore secret_lock; ++ struct wireguard_device *device; ++}; ++ ++struct cookie { ++ u64 birthdate; ++ bool is_valid; ++ u8 cookie[COOKIE_LEN]; ++ bool have_sent_mac1; ++ u8 last_mac1_sent[COOKIE_LEN]; ++ u8 cookie_decryption_key[NOISE_SYMMETRIC_KEY_LEN]; ++ u8 message_mac1_key[NOISE_SYMMETRIC_KEY_LEN]; ++ struct rw_semaphore lock; ++}; ++ ++enum cookie_mac_state { ++ INVALID_MAC, ++ VALID_MAC_BUT_NO_COOKIE, ++ VALID_MAC_WITH_COOKIE_BUT_RATELIMITED, ++ VALID_MAC_WITH_COOKIE ++}; ++ ++void cookie_checker_init(struct cookie_checker *checker, struct wireguard_device *wg); ++void cookie_checker_precompute_device_keys(struct cookie_checker *checker); ++void cookie_checker_precompute_peer_keys(struct wireguard_peer *peer); ++void cookie_init(struct cookie *cookie); ++ ++enum cookie_mac_state cookie_validate_packet(struct cookie_checker *checker, struct sk_buff *skb, bool check_cookie); ++void cookie_add_mac_to_packet(void *message, size_t len, struct wireguard_peer *peer); ++ ++void cookie_message_create(struct message_handshake_cookie *src, struct sk_buff *skb, __le32 index, struct cookie_checker *checker); ++void cookie_message_consume(struct message_handshake_cookie *src, struct wireguard_device *wg); ++ ++#endif /* _WG_COOKIE_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/device.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,64 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_DEVICE_H ++#define _WG_DEVICE_H ++ ++#include "noise.h" ++#include "allowedips.h" ++#include "hashtables.h" ++#include "cookie.h" ++ ++#include ++#include ++#include ++#include ++#include ++#include ++ ++struct wireguard_device; ++ ++struct multicore_worker { ++ void *ptr; ++ struct work_struct work; ++}; ++ ++struct crypt_queue { ++ struct ptr_ring ring; ++ union { ++ struct { ++ struct multicore_worker __percpu *worker; ++ int last_cpu; ++ }; ++ struct work_struct work; ++ }; ++}; ++ ++struct wireguard_device { ++ struct net_device *dev; ++ struct crypt_queue encrypt_queue, decrypt_queue; ++ struct sock __rcu *sock4, *sock6; ++ struct net *creating_net; ++ struct noise_static_identity static_identity; ++ struct workqueue_struct *handshake_receive_wq, *handshake_send_wq, *packet_crypt_wq; ++ struct sk_buff_head incoming_handshakes; ++ int incoming_handshake_cpu; ++ struct multicore_worker __percpu *incoming_handshakes_worker; ++ struct cookie_checker cookie_checker; ++ struct pubkey_hashtable peer_hashtable; ++ struct index_hashtable index_hashtable; ++ struct allowedips peer_allowedips; ++ struct mutex device_update_lock, socket_update_lock; ++ struct list_head device_list, peer_list; ++ unsigned int num_peers, device_update_gen; ++ u32 fwmark; ++ u16 incoming_port; ++ bool have_creating_net_ref; ++}; ++ ++int device_init(void); ++void device_uninit(void); ++ ++#endif /* _WG_DEVICE_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/hashtables.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,52 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_HASHTABLES_H ++#define _WG_HASHTABLES_H ++ ++#include "messages.h" ++ ++#include ++#include ++#include ++ ++struct wireguard_peer; ++ ++struct pubkey_hashtable { ++ /* TODO: move to rhashtable */ ++ DECLARE_HASHTABLE(hashtable, 11); ++ siphash_key_t key; ++ struct mutex lock; ++}; ++ ++void pubkey_hashtable_init(struct pubkey_hashtable *table); ++void pubkey_hashtable_add(struct pubkey_hashtable *table, struct wireguard_peer *peer); ++void pubkey_hashtable_remove(struct pubkey_hashtable *table, struct wireguard_peer *peer); ++struct wireguard_peer *pubkey_hashtable_lookup(struct pubkey_hashtable *table, const u8 pubkey[NOISE_PUBLIC_KEY_LEN]); ++ ++struct index_hashtable { ++ /* TODO: move to rhashtable */ ++ DECLARE_HASHTABLE(hashtable, 13); ++ spinlock_t lock; ++}; ++ ++enum index_hashtable_type { ++ INDEX_HASHTABLE_HANDSHAKE = 1U << 0, ++ INDEX_HASHTABLE_KEYPAIR = 1U << 1 ++}; ++ ++struct index_hashtable_entry { ++ struct wireguard_peer *peer; ++ struct hlist_node index_hash; ++ enum index_hashtable_type type; ++ __le32 index; ++}; ++void index_hashtable_init(struct index_hashtable *table); ++__le32 index_hashtable_insert(struct index_hashtable *table, struct index_hashtable_entry *entry); ++bool index_hashtable_replace(struct index_hashtable *table, struct index_hashtable_entry *old, struct index_hashtable_entry *new); ++void index_hashtable_remove(struct index_hashtable *table, struct index_hashtable_entry *entry); ++struct index_hashtable_entry *index_hashtable_lookup(struct index_hashtable *table, const enum index_hashtable_type type_mask, const __le32 index); ++ ++#endif /* _WG_HASHTABLES_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/messages.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,129 @@ ++/* SPDX-License-Identifier: GPL-2.0 */ ++/* ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * ++ * See doc/protocol.md for more info ++ */ ++ ++#ifndef _WG_MESSAGES_H ++#define _WG_MESSAGES_H ++ ++#include "crypto/curve25519.h" ++#include "crypto/chacha20poly1305.h" ++#include "crypto/blake2s.h" ++ ++#include ++#include ++#include ++ ++enum noise_lengths { ++ NOISE_PUBLIC_KEY_LEN = CURVE25519_POINT_SIZE, ++ NOISE_SYMMETRIC_KEY_LEN = CHACHA20POLY1305_KEYLEN, ++ NOISE_TIMESTAMP_LEN = sizeof(u64) + sizeof(u32), ++ NOISE_AUTHTAG_LEN = CHACHA20POLY1305_AUTHTAGLEN, ++ NOISE_HASH_LEN = BLAKE2S_OUTBYTES ++}; ++ ++#define noise_encrypted_len(plain_len) (plain_len + NOISE_AUTHTAG_LEN) ++ ++enum cookie_values { ++ COOKIE_SECRET_MAX_AGE = 2 * 60 * HZ, ++ COOKIE_SECRET_LATENCY = 5 * HZ, ++ COOKIE_NONCE_LEN = XCHACHA20POLY1305_NONCELEN, ++ COOKIE_LEN = 16 ++}; ++ ++enum counter_values { ++ COUNTER_BITS_TOTAL = 2048, ++ COUNTER_REDUNDANT_BITS = BITS_PER_LONG, ++ COUNTER_WINDOW_SIZE = COUNTER_BITS_TOTAL - COUNTER_REDUNDANT_BITS ++}; ++ ++enum limits { ++ REKEY_AFTER_MESSAGES = U64_MAX - 0xffff, ++ REJECT_AFTER_MESSAGES = U64_MAX - COUNTER_WINDOW_SIZE - 1, ++ REKEY_TIMEOUT = 5 * HZ, ++ REKEY_TIMEOUT_JITTER_MAX = HZ / 3, ++ REKEY_AFTER_TIME = 120 * HZ, ++ REJECT_AFTER_TIME = 180 * HZ, ++ INITIATIONS_PER_SECOND = HZ / 50, ++ MAX_PEERS_PER_DEVICE = 1U << 20, ++ KEEPALIVE_TIMEOUT = 10 * HZ, ++ MAX_TIMER_HANDSHAKES = (90 * HZ) / REKEY_TIMEOUT, ++ MAX_QUEUED_INCOMING_HANDSHAKES = 4096, /* TODO: replace this with DQL */ ++ MAX_STAGED_PACKETS = 128, ++ MAX_QUEUED_PACKETS = 1024 /* TODO: replace this with DQL */ ++}; ++ ++enum message_type { ++ MESSAGE_INVALID = 0, ++ MESSAGE_HANDSHAKE_INITIATION = 1, ++ MESSAGE_HANDSHAKE_RESPONSE = 2, ++ MESSAGE_HANDSHAKE_COOKIE = 3, ++ MESSAGE_DATA = 4, ++ MESSAGE_TOTAL = 5 ++}; ++ ++struct message_header { ++ /* The actual layout of this that we want is: ++ * u8 type ++ * u8 reserved_zero[3] ++ * ++ * But it turns out that by encoding this as little endian, ++ * we achieve the same thing, and it makes checking faster. ++ */ ++ __le32 type; ++}; ++ ++struct message_macs { ++ u8 mac1[COOKIE_LEN]; ++ u8 mac2[COOKIE_LEN]; ++}; ++ ++struct message_handshake_initiation { ++ struct message_header header; ++ __le32 sender_index; ++ u8 unencrypted_ephemeral[NOISE_PUBLIC_KEY_LEN]; ++ u8 encrypted_static[noise_encrypted_len(NOISE_PUBLIC_KEY_LEN)]; ++ u8 encrypted_timestamp[noise_encrypted_len(NOISE_TIMESTAMP_LEN)]; ++ struct message_macs macs; ++}; ++ ++struct message_handshake_response { ++ struct message_header header; ++ __le32 sender_index; ++ __le32 receiver_index; ++ u8 unencrypted_ephemeral[NOISE_PUBLIC_KEY_LEN]; ++ u8 encrypted_nothing[noise_encrypted_len(0)]; ++ struct message_macs macs; ++}; ++ ++struct message_handshake_cookie { ++ struct message_header header; ++ __le32 receiver_index; ++ u8 nonce[COOKIE_NONCE_LEN]; ++ u8 encrypted_cookie[noise_encrypted_len(COOKIE_LEN)]; ++}; ++ ++struct message_data { ++ struct message_header header; ++ __le32 key_idx; ++ __le64 counter; ++ u8 encrypted_data[]; ++}; ++ ++#define message_data_len(plain_len) (noise_encrypted_len(plain_len) + sizeof(struct message_data)) ++ ++enum message_alignments { ++ MESSAGE_PADDING_MULTIPLE = 16, ++ MESSAGE_MINIMUM_LENGTH = message_data_len(0) ++}; ++ ++#define SKB_HEADER_LEN (max(sizeof(struct iphdr), sizeof(struct ipv6hdr)) + sizeof(struct udphdr) + NET_SKB_PAD) ++#define DATA_PACKET_HEAD_ROOM ALIGN(sizeof(struct message_data) + SKB_HEADER_LEN, 4) ++ ++enum { ++ HANDSHAKE_DSCP = 0x88 /* AF41, plus 00 ECN */ ++}; ++ ++#endif /* _WG_MESSAGES_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/netlink.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,12 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_NETLINK_H ++#define _WG_NETLINK_H ++ ++int genetlink_init(void); ++void genetlink_uninit(void); ++ ++#endif /* _WG_NETLINK_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/noise.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,117 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * ++ * See doc/protocol.md and https://github.com/trevp/noise/blob/master/noise.md for more info ++ */ ++ ++#ifndef _WG_NOISE_H ++#define _WG_NOISE_H ++ ++#include "messages.h" ++#include "hashtables.h" ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++union noise_counter { ++ struct { ++ u64 counter; ++ unsigned long backtrack[COUNTER_BITS_TOTAL / BITS_PER_LONG]; ++ spinlock_t lock; ++ } receive; ++ atomic64_t counter; ++}; ++ ++struct noise_symmetric_key { ++ u8 key[NOISE_SYMMETRIC_KEY_LEN]; ++ union noise_counter counter; ++ u64 birthdate; ++ bool is_valid; ++}; ++ ++struct noise_keypair { ++ struct index_hashtable_entry entry; ++ struct noise_symmetric_key sending; ++ struct noise_symmetric_key receiving; ++ __le32 remote_index; ++ bool i_am_the_initiator; ++ struct kref refcount; ++ struct rcu_head rcu; ++ u64 internal_id; ++}; ++ ++struct noise_keypairs { ++ struct noise_keypair __rcu *current_keypair; ++ struct noise_keypair __rcu *previous_keypair; ++ struct noise_keypair __rcu *next_keypair; ++ spinlock_t keypair_update_lock; ++}; ++ ++struct noise_static_identity { ++ bool has_identity; ++ u8 static_public[NOISE_PUBLIC_KEY_LEN]; ++ u8 static_private[NOISE_PUBLIC_KEY_LEN]; ++ struct rw_semaphore lock; ++}; ++ ++enum noise_handshake_state { ++ HANDSHAKE_ZEROED, ++ HANDSHAKE_CREATED_INITIATION, ++ HANDSHAKE_CONSUMED_INITIATION, ++ HANDSHAKE_CREATED_RESPONSE, ++ HANDSHAKE_CONSUMED_RESPONSE ++}; ++ ++struct noise_handshake { ++ struct index_hashtable_entry entry; ++ ++ enum noise_handshake_state state; ++ u64 last_initiation_consumption; ++ ++ struct noise_static_identity *static_identity; ++ ++ u8 ephemeral_private[NOISE_PUBLIC_KEY_LEN]; ++ u8 remote_static[NOISE_PUBLIC_KEY_LEN]; ++ u8 remote_ephemeral[NOISE_PUBLIC_KEY_LEN]; ++ u8 precomputed_static_static[NOISE_PUBLIC_KEY_LEN]; ++ ++ u8 preshared_key[NOISE_SYMMETRIC_KEY_LEN]; ++ ++ u8 hash[NOISE_HASH_LEN]; ++ u8 chaining_key[NOISE_HASH_LEN]; ++ ++ u8 latest_timestamp[NOISE_TIMESTAMP_LEN]; ++ __le32 remote_index; ++ ++ /* Protects all members except the immutable (after noise_handshake_init): remote_static, precomputed_static_static, static_identity */ ++ struct rw_semaphore lock; ++}; ++ ++struct wireguard_device; ++ ++void noise_init(void); ++bool noise_handshake_init(struct noise_handshake *handshake, struct noise_static_identity *static_identity, const u8 peer_public_key[NOISE_PUBLIC_KEY_LEN], const u8 peer_preshared_key[NOISE_SYMMETRIC_KEY_LEN], struct wireguard_peer *peer); ++void noise_handshake_clear(struct noise_handshake *handshake); ++void noise_keypair_put(struct noise_keypair *keypair); ++struct noise_keypair *noise_keypair_get(struct noise_keypair *keypair); ++void noise_keypairs_clear(struct noise_keypairs *keypairs); ++bool noise_received_with_keypair(struct noise_keypairs *keypairs, struct noise_keypair *received_keypair); ++ ++void noise_set_static_identity_private_key(struct noise_static_identity *static_identity, const u8 private_key[NOISE_PUBLIC_KEY_LEN]); ++bool noise_precompute_static_static(struct wireguard_peer *peer); ++ ++bool noise_handshake_create_initiation(struct message_handshake_initiation *dst, struct noise_handshake *handshake); ++struct wireguard_peer *noise_handshake_consume_initiation(struct message_handshake_initiation *src, struct wireguard_device *wg); ++ ++bool noise_handshake_create_response(struct message_handshake_response *dst, struct noise_handshake *peer); ++struct wireguard_peer *noise_handshake_consume_response(struct message_handshake_response *src, struct wireguard_device *wg); ++ ++bool noise_handshake_begin_session(struct noise_handshake *handshake, struct noise_keypairs *keypairs); ++ ++#endif /* _WG_NOISE_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/peer.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,73 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_PEER_H ++#define _WG_PEER_H ++ ++#include "device.h" ++#include "noise.h" ++#include "cookie.h" ++ ++#include ++#include ++#include ++#include ++#include ++ ++struct wireguard_device; ++ ++struct endpoint { ++ union { ++ struct sockaddr addr; ++ struct sockaddr_in addr4; ++ struct sockaddr_in6 addr6; ++ }; ++ union { ++ struct { ++ struct in_addr src4; ++ int src_if4; /* Essentially the same as addr6->scope_id */ ++ }; ++ struct in6_addr src6; ++ }; ++}; ++ ++struct wireguard_peer { ++ struct wireguard_device *device; ++ struct crypt_queue tx_queue, rx_queue; ++ struct sk_buff_head staged_packet_queue; ++ int serial_work_cpu; ++ struct noise_keypairs keypairs; ++ struct endpoint endpoint; ++ struct dst_cache endpoint_cache; ++ rwlock_t endpoint_lock; ++ struct noise_handshake handshake; ++ u64 last_sent_handshake; ++ struct work_struct transmit_handshake_work, clear_peer_work; ++ struct cookie latest_cookie; ++ struct hlist_node pubkey_hash; ++ u64 rx_bytes, tx_bytes; ++ struct timer_list timer_retransmit_handshake, timer_send_keepalive, timer_new_handshake, timer_zero_key_material, timer_persistent_keepalive; ++ unsigned int timer_handshake_attempts; ++ unsigned long persistent_keepalive_interval; ++ bool timers_enabled, timer_need_another_keepalive, sent_lastminute_handshake; ++ struct timespec walltime_last_handshake; ++ struct kref refcount; ++ struct rcu_head rcu; ++ struct list_head peer_list; ++ u64 internal_id; ++}; ++ ++struct wireguard_peer *peer_create(struct wireguard_device *wg, const u8 public_key[NOISE_PUBLIC_KEY_LEN], const u8 preshared_key[NOISE_SYMMETRIC_KEY_LEN]); ++ ++struct wireguard_peer *peer_get(struct wireguard_peer *peer); ++struct wireguard_peer *peer_rcu_get(struct wireguard_peer *peer); ++ ++void peer_put(struct wireguard_peer *peer); ++void peer_remove(struct wireguard_peer *peer); ++void peer_remove_all(struct wireguard_device *wg); ++ ++struct wireguard_peer *peer_lookup_by_index(struct wireguard_device *wg, u32 index); ++ ++#endif /* _WG_PEER_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/queueing.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,142 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_QUEUEING_H ++#define _WG_QUEUEING_H ++ ++#include "peer.h" ++#include ++#include ++#include ++#include ++ ++struct wireguard_device; ++struct wireguard_peer; ++struct multicore_worker; ++struct crypt_queue; ++struct sk_buff; ++ ++/* queueing.c APIs: */ ++int packet_queue_init(struct crypt_queue *queue, work_func_t function, bool multicore, unsigned int len); ++void packet_queue_free(struct crypt_queue *queue, bool multicore); ++struct multicore_worker __percpu *packet_alloc_percpu_multicore_worker(work_func_t function, void *ptr); ++ ++/* receive.c APIs: */ ++void packet_receive(struct wireguard_device *wg, struct sk_buff *skb); ++void packet_handshake_receive_worker(struct work_struct *work); ++/* Workqueue workers: */ ++void packet_rx_worker(struct work_struct *work); ++void packet_decrypt_worker(struct work_struct *work); ++ ++/* send.c APIs: */ ++void packet_send_queued_handshake_initiation(struct wireguard_peer *peer, bool is_retry); ++void packet_send_handshake_response(struct wireguard_peer *peer); ++void packet_send_handshake_cookie(struct wireguard_device *wg, struct sk_buff *initiating_skb, __le32 sender_index); ++void packet_send_keepalive(struct wireguard_peer *peer); ++void packet_send_staged_packets(struct wireguard_peer *peer); ++/* Workqueue workers: */ ++void packet_handshake_send_worker(struct work_struct *work); ++void packet_tx_worker(struct work_struct *work); ++void packet_encrypt_worker(struct work_struct *work); ++ ++enum packet_state { PACKET_STATE_UNCRYPTED, PACKET_STATE_CRYPTED, PACKET_STATE_DEAD }; ++struct packet_cb { ++ u64 nonce; ++ struct noise_keypair *keypair; ++ atomic_t state; ++ u8 ds; ++}; ++#define PACKET_PEER(skb) (((struct packet_cb *)skb->cb)->keypair->entry.peer) ++#define PACKET_CB(skb) ((struct packet_cb *)skb->cb) ++ ++/* Returns either the correct skb->protocol value, or 0 if invalid. */ ++static inline __be16 skb_examine_untrusted_ip_hdr(struct sk_buff *skb) ++{ ++ if (skb_network_header(skb) >= skb->head && (skb_network_header(skb) + sizeof(struct iphdr)) <= skb_tail_pointer(skb) && ip_hdr(skb)->version == 4) ++ return htons(ETH_P_IP); ++ if (skb_network_header(skb) >= skb->head && (skb_network_header(skb) + sizeof(struct ipv6hdr)) <= skb_tail_pointer(skb) && ipv6_hdr(skb)->version == 6) ++ return htons(ETH_P_IPV6); ++ return 0; ++} ++ ++static inline void skb_reset(struct sk_buff *skb) ++{ ++ skb_scrub_packet(skb, false); ++ memset(&skb->headers_start, 0, offsetof(struct sk_buff, headers_end) - offsetof(struct sk_buff, headers_start)); ++ skb->queue_mapping = 0; ++ skb->nohdr = 0; ++ skb->peeked = 0; ++ skb->mac_len = 0; ++ skb->dev = NULL; ++#ifdef CONFIG_NET_SCHED ++ skb->tc_index = 0; ++ skb_reset_tc(skb); ++#endif ++ skb->hdr_len = skb_headroom(skb); ++ skb_reset_mac_header(skb); ++ skb_reset_network_header(skb); ++ skb_probe_transport_header(skb, 0); ++ skb_reset_inner_headers(skb); ++} ++ ++static inline int cpumask_choose_online(int *stored_cpu, unsigned int id) ++{ ++ unsigned int cpu = *stored_cpu, cpu_index, i; ++ ++ if (unlikely(cpu == nr_cpumask_bits || !cpumask_test_cpu(cpu, cpu_online_mask))) { ++ cpu_index = id % cpumask_weight(cpu_online_mask); ++ cpu = cpumask_first(cpu_online_mask); ++ for (i = 0; i < cpu_index; ++i) ++ cpu = cpumask_next(cpu, cpu_online_mask); ++ *stored_cpu = cpu; ++ } ++ return cpu; ++} ++ ++/* This function is racy, in the sense that next is unlocked, so it could return ++ * the same CPU twice. A race-free version of this would be to instead store an ++ * atomic sequence number, do an increment-and-return, and then iterate through ++ * every possible CPU until we get to that index -- choose_cpu. However that's ++ * a bit slower, and it doesn't seem like this potential race actually introduces ++ * any performance loss, so we live with it. ++ */ ++static inline int cpumask_next_online(int *next) ++{ ++ int cpu = *next; ++ ++ while (unlikely(!cpumask_test_cpu(cpu, cpu_online_mask))) ++ cpu = cpumask_next(cpu, cpu_online_mask) % nr_cpumask_bits; ++ *next = cpumask_next(cpu, cpu_online_mask) % nr_cpumask_bits; ++ return cpu; ++} ++ ++static inline int queue_enqueue_per_device_and_peer(struct crypt_queue *device_queue, struct crypt_queue *peer_queue, struct sk_buff *skb, struct workqueue_struct *wq, int *next_cpu) ++{ ++ int cpu; ++ ++ atomic_set(&PACKET_CB(skb)->state, PACKET_STATE_UNCRYPTED); ++ if (unlikely(ptr_ring_produce_bh(&peer_queue->ring, skb))) ++ return -ENOSPC; ++ cpu = cpumask_next_online(next_cpu); ++ if (unlikely(ptr_ring_produce_bh(&device_queue->ring, skb))) ++ return -EPIPE; ++ queue_work_on(cpu, wq, &per_cpu_ptr(device_queue->worker, cpu)->work); ++ return 0; ++} ++ ++static inline void queue_enqueue_per_peer(struct crypt_queue *queue, struct sk_buff *skb, enum packet_state state) ++{ ++ struct wireguard_peer *peer = peer_rcu_get(PACKET_PEER(skb)); ++ ++ atomic_set(&PACKET_CB(skb)->state, state); ++ queue_work_on(cpumask_choose_online(&peer->serial_work_cpu, peer->internal_id), peer->device->packet_crypt_wq, &queue->work); ++ peer_put(peer); ++} ++ ++#ifdef DEBUG ++bool packet_counter_selftest(void); ++#endif ++ ++#endif /* _WG_QUEUEING_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/ratelimiter.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,19 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_RATELIMITER_H ++#define _WG_RATELIMITER_H ++ ++#include ++ ++int ratelimiter_init(void); ++void ratelimiter_uninit(void); ++bool ratelimiter_allow(struct sk_buff *skb, struct net *net); ++ ++#ifdef DEBUG ++bool ratelimiter_selftest(void); ++#endif ++ ++#endif /* _WG_RATELIMITER_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/socket.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,35 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_SOCKET_H ++#define _WG_SOCKET_H ++ ++#include ++#include ++#include ++#include ++ ++int socket_init(struct wireguard_device *wg, u16 port); ++void socket_reinit(struct wireguard_device *wg, struct sock *new4, struct sock *new6); ++int socket_send_buffer_to_peer(struct wireguard_peer *peer, void *data, size_t len, u8 ds); ++int socket_send_skb_to_peer(struct wireguard_peer *peer, struct sk_buff *skb, u8 ds); ++int socket_send_buffer_as_reply_to_skb(struct wireguard_device *wg, struct sk_buff *in_skb, void *out_buffer, size_t len); ++ ++int socket_endpoint_from_skb(struct endpoint *endpoint, const struct sk_buff *skb); ++void socket_set_peer_endpoint(struct wireguard_peer *peer, const struct endpoint *endpoint); ++void socket_set_peer_endpoint_from_skb(struct wireguard_peer *peer, const struct sk_buff *skb); ++void socket_clear_peer_endpoint_src(struct wireguard_peer *peer); ++ ++#if defined(CONFIG_DYNAMIC_DEBUG) || defined(DEBUG) ++#define net_dbg_skb_ratelimited(fmt, dev, skb, ...) do { \ ++ struct endpoint __endpoint; \ ++ socket_endpoint_from_skb(&__endpoint, skb); \ ++ net_dbg_ratelimited(fmt, dev, &__endpoint.addr, ##__VA_ARGS__); \ ++} while (0) ++#else ++#define net_dbg_skb_ratelimited(fmt, skb, ...) ++#endif ++ ++#endif /* _WG_SOCKET_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/timers.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,21 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_TIMERS_H ++#define _WG_TIMERS_H ++ ++struct wireguard_peer; ++ ++void timers_init(struct wireguard_peer *peer); ++void timers_stop(struct wireguard_peer *peer); ++void timers_data_sent(struct wireguard_peer *peer); ++void timers_data_received(struct wireguard_peer *peer); ++void timers_any_authenticated_packet_received(struct wireguard_peer *peer); ++void timers_handshake_initiated(struct wireguard_peer *peer); ++void timers_handshake_complete(struct wireguard_peer *peer); ++void timers_session_derived(struct wireguard_peer *peer); ++void timers_any_authenticated_packet_traversal(struct wireguard_peer *peer); ++ ++#endif /* _WG_TIMERS_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/version.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1 @@ ++#define WIREGUARD_VERSION "0.0.20180218" +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/uapi/wireguard.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,182 @@ ++/* SPDX-License-Identifier: ((GPL-2.0 WITH Linux-syscall-note) OR MIT) ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * ++ * Documentation ++ * ============= ++ * ++ * The below enums and macros are for interfacing with WireGuard, using generic ++ * netlink, with family WG_GENL_NAME and version WG_GENL_VERSION. It defines two ++ * methods: get and set. Note that while they share many common attributes, these ++ * two functions actually accept a slightly different set of inputs and outputs. ++ * ++ * WG_CMD_GET_DEVICE ++ * ----------------- ++ * ++ * May only be called via NLM_F_REQUEST | NLM_F_DUMP. The command should contain ++ * one but not both of: ++ * ++ * WGDEVICE_A_IFINDEX: NLA_U32 ++ * WGDEVICE_A_IFNAME: NLA_NUL_STRING, maxlen IFNAMESIZ - 1 ++ * ++ * The kernel will then return several messages (NLM_F_MULTI) containing the following ++ * tree of nested items: ++ * ++ * WGDEVICE_A_IFINDEX: NLA_U32 ++ * WGDEVICE_A_IFNAME: NLA_NUL_STRING, maxlen IFNAMESIZ - 1 ++ * WGDEVICE_A_PRIVATE_KEY: len WG_KEY_LEN ++ * WGDEVICE_A_PUBLIC_KEY: len WG_KEY_LEN ++ * WGDEVICE_A_LISTEN_PORT: NLA_U16 ++ * WGDEVICE_A_FWMARK: NLA_U32 ++ * WGDEVICE_A_PEERS: NLA_NESTED ++ * 0: NLA_NESTED ++ * WGPEER_A_PUBLIC_KEY: len WG_KEY_LEN ++ * WGPEER_A_PRESHARED_KEY: len WG_KEY_LEN ++ * WGPEER_A_ENDPOINT: struct sockaddr_in or struct sockaddr_in6 ++ * WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL: NLA_U16 ++ * WGPEER_A_LAST_HANDSHAKE_TIME: struct timespec ++ * WGPEER_A_RX_BYTES: NLA_U64 ++ * WGPEER_A_TX_BYTES: NLA_U64 ++ * WGPEER_A_ALLOWEDIPS: NLA_NESTED ++ * 0: NLA_NESTED ++ * WGALLOWEDIP_A_FAMILY: NLA_U16 ++ * WGALLOWEDIP_A_IPADDR: struct in_addr or struct in6_addr ++ * WGALLOWEDIP_A_CIDR_MASK: NLA_U8 ++ * 1: NLA_NESTED ++ * ... ++ * 2: NLA_NESTED ++ * ... ++ * ... ++ * 1: NLA_NESTED ++ * ... ++ * ... ++ * ++ * It is possible that all of the allowed IPs of a single peer will not ++ * fit within a single netlink message. In that case, the same peer will ++ * be written in the following message, except it will only contain ++ * WGPEER_A_PUBLIC_KEY and WGPEER_A_ALLOWEDIPS. This may occur several ++ * times in a row for the same peer. It is then up to the receiver to ++ * coalesce adjacent peers. Likewise, it is possible that all peers will ++ * not fit within a single message. So, subsequent peers will be sent ++ * in following messages, except those will only contain WGDEVICE_A_IFNAME ++ * and WGDEVICE_A_PEERS. It is then up to the receiver to coalesce these ++ * messages to form the complete list of peers. ++ * ++ * Since this is an NLA_F_DUMP command, the final message will always be ++ * NLMSG_DONE, even if an error occurs. However, this NLMSG_DONE message ++ * contains an integer error code. It is either zero or a negative error ++ * code corresponding to the errno. ++ * ++ * WG_CMD_SET_DEVICE ++ * ----------------- ++ * ++ * May only be called via NLM_F_REQUEST. The command should contain the following ++ * tree of nested items, containing one but not both of WGDEVICE_A_IFINDEX ++ * and WGDEVICE_A_IFNAME: ++ * ++ * WGDEVICE_A_IFINDEX: NLA_U32 ++ * WGDEVICE_A_IFNAME: NLA_NUL_STRING, maxlen IFNAMESIZ - 1 ++ * WGDEVICE_A_FLAGS: NLA_U32, 0 or WGDEVICE_F_REPLACE_PEERS if all current ++ * peers should be removed prior to adding the list below. ++ * WGDEVICE_A_PRIVATE_KEY: len WG_KEY_LEN, all zeros to remove ++ * WGDEVICE_A_LISTEN_PORT: NLA_U16, 0 to choose randomly ++ * WGDEVICE_A_FWMARK: NLA_U32, 0 to disable ++ * WGDEVICE_A_PEERS: NLA_NESTED ++ * 0: NLA_NESTED ++ * WGPEER_A_PUBLIC_KEY: len WG_KEY_LEN ++ * WGPEER_A_FLAGS: NLA_U32, 0 and/or WGPEER_F_REMOVE_ME if the specified peer ++ * should be removed rather than added/updated and/or ++ * WGPEER_F_REPLACE_ALLOWEDIPS if all current allowed IPs of ++ * this peer should be removed prior to adding the list below. ++ * WGPEER_A_PRESHARED_KEY: len WG_KEY_LEN, all zeros to remove ++ * WGPEER_A_ENDPOINT: struct sockaddr_in or struct sockaddr_in6 ++ * WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL: NLA_U16, 0 to disable ++ * WGPEER_A_ALLOWEDIPS: NLA_NESTED ++ * 0: NLA_NESTED ++ * WGALLOWEDIP_A_FAMILY: NLA_U16 ++ * WGALLOWEDIP_A_IPADDR: struct in_addr or struct in6_addr ++ * WGALLOWEDIP_A_CIDR_MASK: NLA_U8 ++ * 1: NLA_NESTED ++ * ... ++ * 2: NLA_NESTED ++ * ... ++ * ... ++ * 1: NLA_NESTED ++ * ... ++ * ... ++ * ++ * It is possible that the amount of configuration data exceeds that of ++ * the maximum message length accepted by the kernel. In that case, ++ * several messages should be sent one after another, with each ++ * successive one filling in information not contained in the prior. Note ++ * that if WGDEVICE_F_REPLACE_PEERS is specified in the first message, it ++ * probably should not be specified in fragments that come after, so that ++ * the list of peers is only cleared the first time but appened after. ++ * Likewise for peers, if WGPEER_F_REPLACE_ALLOWEDIPS is specified in the ++ * first message of a peer, it likely should not be specified in subsequent ++ * fragments. ++ * ++ * If an error occurs, NLMSG_ERROR will reply containing an errno. ++ */ ++ ++#ifndef _WG_UAPI_WIREGUARD_H ++#define _WG_UAPI_WIREGUARD_H ++ ++#define WG_GENL_NAME "wireguard" ++#define WG_GENL_VERSION 1 ++ ++#define WG_KEY_LEN 32 ++ ++enum wg_cmd { ++ WG_CMD_GET_DEVICE, ++ WG_CMD_SET_DEVICE, ++ __WG_CMD_MAX ++}; ++#define WG_CMD_MAX (__WG_CMD_MAX - 1) ++ ++enum wgdevice_flag { ++ WGDEVICE_F_REPLACE_PEERS = 1U << 0 ++}; ++enum wgdevice_attribute { ++ WGDEVICE_A_UNSPEC, ++ WGDEVICE_A_IFINDEX, ++ WGDEVICE_A_IFNAME, ++ WGDEVICE_A_PRIVATE_KEY, ++ WGDEVICE_A_PUBLIC_KEY, ++ WGDEVICE_A_FLAGS, ++ WGDEVICE_A_LISTEN_PORT, ++ WGDEVICE_A_FWMARK, ++ WGDEVICE_A_PEERS, ++ __WGDEVICE_A_LAST ++}; ++#define WGDEVICE_A_MAX (__WGDEVICE_A_LAST - 1) ++ ++enum wgpeer_flag { ++ WGPEER_F_REMOVE_ME = 1U << 0, ++ WGPEER_F_REPLACE_ALLOWEDIPS = 1U << 1 ++}; ++enum wgpeer_attribute { ++ WGPEER_A_UNSPEC, ++ WGPEER_A_PUBLIC_KEY, ++ WGPEER_A_PRESHARED_KEY, ++ WGPEER_A_FLAGS, ++ WGPEER_A_ENDPOINT, ++ WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL, ++ WGPEER_A_LAST_HANDSHAKE_TIME, ++ WGPEER_A_RX_BYTES, ++ WGPEER_A_TX_BYTES, ++ WGPEER_A_ALLOWEDIPS, ++ __WGPEER_A_LAST ++}; ++#define WGPEER_A_MAX (__WGPEER_A_LAST - 1) ++ ++enum wgallowedip_attribute { ++ WGALLOWEDIP_A_UNSPEC, ++ WGALLOWEDIP_A_FAMILY, ++ WGALLOWEDIP_A_IPADDR, ++ WGALLOWEDIP_A_CIDR_MASK, ++ __WGALLOWEDIP_A_LAST ++}; ++#define WGALLOWEDIP_A_MAX (__WGALLOWEDIP_A_LAST - 1) ++ ++#endif /* _WG_UAPI_WIREGUARD_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/selftest/allowedips.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,514 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifdef DEBUG ++ ++#ifdef DEBUG_PRINT_TRIE_GRAPHVIZ ++#include ++static __init void print_node(struct allowedips_node *node, u8 bits) ++{ ++ u32 color = 0; ++ char *style = "dotted"; ++ char *fmt_connection = KERN_DEBUG "\t\"%p/%d\" -> \"%p/%d\";\n"; ++ char *fmt_declaration = KERN_DEBUG "\t\"%p/%d\"[style=%s, color=\"#%06x\"];\n"; ++ if (bits == 32) { ++ fmt_connection = KERN_DEBUG "\t\"%pI4/%d\" -> \"%pI4/%d\";\n"; ++ fmt_declaration = KERN_DEBUG "\t\"%pI4/%d\"[style=%s, color=\"#%06x\"];\n"; ++ } else if (bits == 128) { ++ fmt_connection = KERN_DEBUG "\t\"%pI6/%d\" -> \"%pI6/%d\";\n"; ++ fmt_declaration = KERN_DEBUG "\t\"%pI6/%d\"[style=%s, color=\"#%06x\"];\n"; ++ } ++ if (node->peer) { ++ hsiphash_key_t key = { 0 }; ++ memcpy(&key, &node->peer, sizeof(node->peer)); ++ color = hsiphash_1u32(0xdeadbeef, &key) % 200 << 16 | hsiphash_1u32(0xbabecafe, &key) % 200 << 8 | hsiphash_1u32(0xabad1dea, &key) % 200; ++ style = "bold"; ++ } ++ printk(fmt_declaration, node->bits, node->cidr, style, color); ++ if (node->bit[0]) { ++ printk(fmt_connection, node->bits, node->cidr, node->bit[0]->bits, node->bit[0]->cidr); ++ print_node(node->bit[0], bits); ++ } ++ if (node->bit[1]) { ++ printk(fmt_connection, node->bits, node->cidr, node->bit[1]->bits, node->bit[1]->cidr); ++ print_node(node->bit[1], bits); ++ } ++} ++static __init void print_tree(struct allowedips_node *top, u8 bits) ++{ ++ printk(KERN_DEBUG "digraph trie {\n"); ++ print_node(top, bits); ++ printk(KERN_DEBUG "}\n"); ++} ++#endif ++ ++#ifdef DEBUG_RANDOM_TRIE ++#define NUM_PEERS 2000 ++#define NUM_RAND_ROUTES 400 ++#define NUM_MUTATED_ROUTES 100 ++#define NUM_QUERIES (NUM_RAND_ROUTES * NUM_MUTATED_ROUTES * 30) ++#include ++struct horrible_allowedips { ++ struct hlist_head head; ++}; ++struct horrible_allowedips_node { ++ struct hlist_node table; ++ union nf_inet_addr ip; ++ union nf_inet_addr mask; ++ uint8_t ip_version; ++ void *value; ++}; ++static __init void horrible_allowedips_init(struct horrible_allowedips *table) ++{ ++ INIT_HLIST_HEAD(&table->head); ++} ++static __init void horrible_allowedips_free(struct horrible_allowedips *table) ++{ ++ struct hlist_node *h; ++ struct horrible_allowedips_node *node; ++ hlist_for_each_entry_safe(node, h, &table->head, table) { ++ hlist_del(&node->table); ++ kfree(node); ++ } ++} ++static __init inline union nf_inet_addr horrible_cidr_to_mask(uint8_t cidr) ++{ ++ union nf_inet_addr mask; ++ memset(&mask, 0x00, 128 / 8); ++ memset(&mask, 0xff, cidr / 8); ++ if (cidr % 32) ++ mask.all[cidr / 32] = htonl((0xFFFFFFFFUL << (32 - (cidr % 32))) & 0xFFFFFFFFUL); ++ return mask; ++} ++static __init inline uint8_t horrible_mask_to_cidr(union nf_inet_addr subnet) ++{ ++ return hweight32(subnet.all[0]) ++ + hweight32(subnet.all[1]) ++ + hweight32(subnet.all[2]) ++ + hweight32(subnet.all[3]); ++} ++static __init inline void horrible_mask_self(struct horrible_allowedips_node *node) ++{ ++ if (node->ip_version == 4) ++ node->ip.ip &= node->mask.ip; ++ else if (node->ip_version == 6) { ++ node->ip.ip6[0] &= node->mask.ip6[0]; ++ node->ip.ip6[1] &= node->mask.ip6[1]; ++ node->ip.ip6[2] &= node->mask.ip6[2]; ++ node->ip.ip6[3] &= node->mask.ip6[3]; ++ } ++} ++static __init inline bool horrible_match_v4(const struct horrible_allowedips_node *node, struct in_addr *ip) ++{ ++ return (ip->s_addr & node->mask.ip) == node->ip.ip; ++} ++static __init inline bool horrible_match_v6(const struct horrible_allowedips_node *node, struct in6_addr *ip) ++{ ++ return (ip->in6_u.u6_addr32[0] & node->mask.ip6[0]) == node->ip.ip6[0] && ++ (ip->in6_u.u6_addr32[1] & node->mask.ip6[1]) == node->ip.ip6[1] && ++ (ip->in6_u.u6_addr32[2] & node->mask.ip6[2]) == node->ip.ip6[2] && ++ (ip->in6_u.u6_addr32[3] & node->mask.ip6[3]) == node->ip.ip6[3]; ++} ++static __init void horrible_insert_ordered(struct horrible_allowedips *table, struct horrible_allowedips_node *node) ++{ ++ struct horrible_allowedips_node *other = NULL, *where = NULL; ++ uint8_t my_cidr = horrible_mask_to_cidr(node->mask); ++ hlist_for_each_entry(other, &table->head, table) { ++ if (!memcmp(&other->mask, &node->mask, sizeof(union nf_inet_addr)) && ++ !memcmp(&other->ip, &node->ip, sizeof(union nf_inet_addr)) && ++ other->ip_version == node->ip_version) { ++ other->value = node->value; ++ kfree(node); ++ return; ++ } ++ where = other; ++ if (horrible_mask_to_cidr(other->mask) <= my_cidr) ++ break; ++ } ++ if (!other && !where) ++ hlist_add_head(&node->table, &table->head); ++ else if (!other) ++ hlist_add_behind(&node->table, &where->table); ++ else ++ hlist_add_before(&node->table, &where->table); ++} ++static __init int horrible_allowedips_insert_v4(struct horrible_allowedips *table, struct in_addr *ip, uint8_t cidr, void *value) ++{ ++ struct horrible_allowedips_node *node = kzalloc(sizeof(struct horrible_allowedips_node), GFP_KERNEL); ++ if (!node) ++ return -ENOMEM; ++ node->ip.in = *ip; ++ node->mask = horrible_cidr_to_mask(cidr); ++ node->ip_version = 4; ++ node->value = value; ++ horrible_mask_self(node); ++ horrible_insert_ordered(table, node); ++ return 0; ++} ++static __init int horrible_allowedips_insert_v6(struct horrible_allowedips *table, struct in6_addr *ip, uint8_t cidr, void *value) ++{ ++ struct horrible_allowedips_node *node = kzalloc(sizeof(struct horrible_allowedips_node), GFP_KERNEL); ++ if (!node) ++ return -ENOMEM; ++ node->ip.in6 = *ip; ++ node->mask = horrible_cidr_to_mask(cidr); ++ node->ip_version = 6; ++ node->value = value; ++ horrible_mask_self(node); ++ horrible_insert_ordered(table, node); ++ return 0; ++} ++static __init void *horrible_allowedips_lookup_v4(struct horrible_allowedips *table, struct in_addr *ip) ++{ ++ struct horrible_allowedips_node *node; ++ void *ret = NULL; ++ hlist_for_each_entry(node, &table->head, table) { ++ if (node->ip_version != 4) ++ continue; ++ if (horrible_match_v4(node, ip)) { ++ ret = node->value; ++ break; ++ } ++ } ++ return ret; ++} ++static __init void *horrible_allowedips_lookup_v6(struct horrible_allowedips *table, struct in6_addr *ip) ++{ ++ struct horrible_allowedips_node *node; ++ void *ret = NULL; ++ hlist_for_each_entry(node, &table->head, table) { ++ if (node->ip_version != 6) ++ continue; ++ if (horrible_match_v6(node, ip)) { ++ ret = node->value; ++ break; ++ } ++ } ++ return ret; ++} ++ ++static __init bool randomized_test(void) ++{ ++ DEFINE_MUTEX(mutex); ++ bool ret = false; ++ unsigned int i, j, k, mutate_amount, cidr; ++ struct wireguard_peer **peers, *peer; ++ struct allowedips t; ++ struct horrible_allowedips h; ++ u8 ip[16], mutate_mask[16], mutated[16]; ++ ++ allowedips_init(&t); ++ horrible_allowedips_init(&h); ++ ++ peers = kcalloc(NUM_PEERS, sizeof(struct wireguard_peer *), GFP_KERNEL); ++ if (!peers) { ++ pr_info("allowedips random self-test: out of memory\n"); ++ goto free; ++ } ++ for (i = 0; i < NUM_PEERS; ++i) { ++ peers[i] = kzalloc(sizeof(struct wireguard_peer), GFP_KERNEL); ++ if (!peers[i]) { ++ pr_info("allowedips random self-test: out of memory\n"); ++ goto free; ++ } ++ kref_init(&peers[i]->refcount); ++ } ++ ++ for (i = 0; i < NUM_RAND_ROUTES; ++i) { ++ prandom_bytes(ip, 4); ++ cidr = prandom_u32_max(32) + 1; ++ peer = peers[prandom_u32_max(NUM_PEERS)]; ++ if (allowedips_insert_v4(&t, (struct in_addr *)ip, cidr, peer, &mutex) < 0) { ++ pr_info("allowedips random self-test: out of memory\n"); ++ goto free; ++ } ++ if (horrible_allowedips_insert_v4(&h, (struct in_addr *)ip, cidr, peer) < 0) { ++ pr_info("allowedips random self-test: out of memory\n"); ++ goto free; ++ } ++ for (j = 0; j < NUM_MUTATED_ROUTES; ++j) { ++ memcpy(mutated, ip, 4); ++ prandom_bytes(mutate_mask, 4); ++ mutate_amount = prandom_u32_max(32); ++ for (k = 0; k < mutate_amount / 8; ++k) ++ mutate_mask[k] = 0xff; ++ mutate_mask[k] = 0xff << ((8 - (mutate_amount % 8)) % 8); ++ for (; k < 4; ++k) ++ mutate_mask[k] = 0; ++ for (k = 0; k < 4; ++k) ++ mutated[k] = (mutated[k] & mutate_mask[k]) | (~mutate_mask[k] & prandom_u32_max(256)); ++ cidr = prandom_u32_max(32) + 1; ++ peer = peers[prandom_u32_max(NUM_PEERS)]; ++ if (allowedips_insert_v4(&t, (struct in_addr *)mutated, cidr, peer, &mutex) < 0) { ++ pr_info("allowedips random self-test: out of memory\n"); ++ goto free; ++ } ++ if (horrible_allowedips_insert_v4(&h, (struct in_addr *)mutated, cidr, peer)) { ++ pr_info("allowedips random self-test: out of memory\n"); ++ goto free; ++ } ++ } ++ } ++ ++ for (i = 0; i < NUM_RAND_ROUTES; ++i) { ++ prandom_bytes(ip, 16); ++ cidr = prandom_u32_max(128) + 1; ++ peer = peers[prandom_u32_max(NUM_PEERS)]; ++ if (allowedips_insert_v6(&t, (struct in6_addr *)ip, cidr, peer, &mutex) < 0) { ++ pr_info("allowedips random self-test: out of memory\n"); ++ goto free; ++ } ++ if (horrible_allowedips_insert_v6(&h, (struct in6_addr *)ip, cidr, peer) < 0) { ++ pr_info("allowedips random self-test: out of memory\n"); ++ goto free; ++ } ++ for (j = 0; j < NUM_MUTATED_ROUTES; ++j) { ++ memcpy(mutated, ip, 16); ++ prandom_bytes(mutate_mask, 16); ++ mutate_amount = prandom_u32_max(128); ++ for (k = 0; k < mutate_amount / 8; ++k) ++ mutate_mask[k] = 0xff; ++ mutate_mask[k] = 0xff << ((8 - (mutate_amount % 8)) % 8); ++ for (; k < 4; ++k) ++ mutate_mask[k] = 0; ++ for (k = 0; k < 4; ++k) ++ mutated[k] = (mutated[k] & mutate_mask[k]) | (~mutate_mask[k] & prandom_u32_max(256)); ++ cidr = prandom_u32_max(128) + 1; ++ peer = peers[prandom_u32_max(NUM_PEERS)]; ++ if (allowedips_insert_v6(&t, (struct in6_addr *)mutated, cidr, peer, &mutex) < 0) { ++ pr_info("allowedips random self-test: out of memory\n"); ++ goto free; ++ } ++ if (horrible_allowedips_insert_v6(&h, (struct in6_addr *)mutated, cidr, peer)) { ++ pr_info("allowedips random self-test: out of memory\n"); ++ goto free; ++ } ++ } ++ } ++ ++#ifdef DEBUG_PRINT_TRIE_GRAPHVIZ ++ print_tree(t.root4, 32); ++ print_tree(t.root6, 128); ++#endif ++ ++ for (i = 0; i < NUM_QUERIES; ++i) { ++ prandom_bytes(ip, 4); ++ if (lookup(t.root4, 32, ip) != horrible_allowedips_lookup_v4(&h, (struct in_addr *)ip)) { ++ pr_info("allowedips random self-test: FAIL\n"); ++ goto free; ++ } ++ } ++ ++ for (i = 0; i < NUM_QUERIES; ++i) { ++ prandom_bytes(ip, 16); ++ if (lookup(t.root6, 128, ip) != horrible_allowedips_lookup_v6(&h, (struct in6_addr *)ip)) { ++ pr_info("allowedips random self-test: FAIL\n"); ++ goto free; ++ } ++ } ++ ret = true; ++ ++free: ++ allowedips_free(&t, &mutex); ++ horrible_allowedips_free(&h); ++ if (peers) { ++ for (i = 0; i < NUM_PEERS; ++i) ++ kfree(peers[i]); ++ } ++ kfree(peers); ++ return ret; ++} ++#endif ++ ++static __init inline struct in_addr *ip4(u8 a, u8 b, u8 c, u8 d) ++{ ++ static struct in_addr ip; ++ u8 *split = (u8 *)&ip; ++ split[0] = a; ++ split[1] = b; ++ split[2] = c; ++ split[3] = d; ++ return &ip; ++} ++static __init inline struct in6_addr *ip6(u32 a, u32 b, u32 c, u32 d) ++{ ++ static struct in6_addr ip; ++ __be32 *split = (__be32 *)&ip; ++ split[0] = cpu_to_be32(a); ++ split[1] = cpu_to_be32(b); ++ split[2] = cpu_to_be32(c); ++ split[3] = cpu_to_be32(d); ++ return &ip; ++} ++ ++#define init_peer(name) do { \ ++ name = kzalloc(sizeof(struct wireguard_peer), GFP_KERNEL); \ ++ if (!name) { \ ++ pr_info("allowedips self-test: out of memory\n"); \ ++ goto free; \ ++ } \ ++ kref_init(&name->refcount); \ ++} while (0) ++ ++#define insert(version, mem, ipa, ipb, ipc, ipd, cidr) \ ++ allowedips_insert_v##version(&t, ip##version(ipa, ipb, ipc, ipd), cidr, mem, &mutex) ++ ++#define maybe_fail \ ++ ++i; \ ++ if (!_s) { \ ++ pr_info("allowedips self-test %zu: FAIL\n", i); \ ++ success = false; \ ++ } ++ ++#define test(version, mem, ipa, ipb, ipc, ipd) do { \ ++ bool _s = lookup(t.root##version, version == 4 ? 32 : 128, ip##version(ipa, ipb, ipc, ipd)) == mem; \ ++ maybe_fail \ ++} while (0) ++ ++#define test_negative(version, mem, ipa, ipb, ipc, ipd) do { \ ++ bool _s = lookup(t.root##version, version == 4 ? 32 : 128, ip##version(ipa, ipb, ipc, ipd)) != mem; \ ++ maybe_fail \ ++} while (0) ++ ++bool __init allowedips_selftest(void) ++{ ++ DEFINE_MUTEX(mutex); ++ struct allowedips t; ++ struct wireguard_peer *a = NULL, *b = NULL, *c = NULL, *d = NULL, *e = NULL, *f = NULL, *g = NULL, *h = NULL; ++ size_t i = 0; ++ bool success = false; ++ struct in6_addr ip; ++ __be64 part; ++ ++ mutex_init(&mutex); ++ ++ mutex_lock(&mutex); ++ ++ allowedips_init(&t); ++ init_peer(a); ++ init_peer(b); ++ init_peer(c); ++ init_peer(d); ++ init_peer(e); ++ init_peer(f); ++ init_peer(g); ++ init_peer(h); ++ ++ insert(4, a, 192, 168, 4, 0, 24); ++ insert(4, b, 192, 168, 4, 4, 32); ++ insert(4, c, 192, 168, 0, 0, 16); ++ insert(4, d, 192, 95, 5, 64, 27); ++ insert(4, c, 192, 95, 5, 65, 27); /* replaces previous entry, and maskself is required */ ++ insert(6, d, 0x26075300, 0x60006b00, 0, 0xc05f0543, 128); ++ insert(6, c, 0x26075300, 0x60006b00, 0, 0, 64); ++ insert(4, e, 0, 0, 0, 0, 0); ++ insert(6, e, 0, 0, 0, 0, 0); ++ insert(6, f, 0, 0, 0, 0, 0); /* replaces previous entry */ ++ insert(6, g, 0x24046800, 0, 0, 0, 32); ++ insert(6, h, 0x24046800, 0x40040800, 0xdeadbeef, 0xdeadbeef, 64); /* maskself is required */ ++ insert(6, a, 0x24046800, 0x40040800, 0xdeadbeef, 0xdeadbeef, 128); ++ insert(6, c, 0x24446800, 0x40e40800, 0xdeaebeef, 0xdefbeef, 128); ++ insert(6, b, 0x24446800, 0xf0e40800, 0xeeaebeef, 0, 98); ++ insert(4, g, 64, 15, 112, 0, 20); ++ insert(4, h, 64, 15, 123, 211, 25); /* maskself is required */ ++ insert(4, a, 10, 0, 0, 0, 25); ++ insert(4, b, 10, 0, 0, 128, 25); ++ insert(4, a, 10, 1, 0, 0, 30); ++ insert(4, b, 10, 1, 0, 4, 30); ++ insert(4, c, 10, 1, 0, 8, 29); ++ insert(4, d, 10, 1, 0, 16, 29); ++ ++#ifdef DEBUG_PRINT_TRIE_GRAPHVIZ ++ print_tree(t.root4, 32); ++ print_tree(t.root6, 128); ++#endif ++ ++ success = true; ++ ++ test(4, a, 192, 168, 4, 20); ++ test(4, a, 192, 168, 4, 0); ++ test(4, b, 192, 168, 4, 4); ++ test(4, c, 192, 168, 200, 182); ++ test(4, c, 192, 95, 5, 68); ++ test(4, e, 192, 95, 5, 96); ++ test(6, d, 0x26075300, 0x60006b00, 0, 0xc05f0543); ++ test(6, c, 0x26075300, 0x60006b00, 0, 0xc02e01ee); ++ test(6, f, 0x26075300, 0x60006b01, 0, 0); ++ test(6, g, 0x24046800, 0x40040806, 0, 0x1006); ++ test(6, g, 0x24046800, 0x40040806, 0x1234, 0x5678); ++ test(6, f, 0x240467ff, 0x40040806, 0x1234, 0x5678); ++ test(6, f, 0x24046801, 0x40040806, 0x1234, 0x5678); ++ test(6, h, 0x24046800, 0x40040800, 0x1234, 0x5678); ++ test(6, h, 0x24046800, 0x40040800, 0, 0); ++ test(6, h, 0x24046800, 0x40040800, 0x10101010, 0x10101010); ++ test(6, a, 0x24046800, 0x40040800, 0xdeadbeef, 0xdeadbeef); ++ test(4, g, 64, 15, 116, 26); ++ test(4, g, 64, 15, 127, 3); ++ test(4, g, 64, 15, 123, 1); ++ test(4, h, 64, 15, 123, 128); ++ test(4, h, 64, 15, 123, 129); ++ test(4, a, 10, 0, 0, 52); ++ test(4, b, 10, 0, 0, 220); ++ test(4, a, 10, 1, 0, 2); ++ test(4, b, 10, 1, 0, 6); ++ test(4, c, 10, 1, 0, 10); ++ test(4, d, 10, 1, 0, 20); ++ ++ insert(4, a, 1, 0, 0, 0, 32); ++ insert(4, a, 64, 0, 0, 0, 32); ++ insert(4, a, 128, 0, 0, 0, 32); ++ insert(4, a, 192, 0, 0, 0, 32); ++ insert(4, a, 255, 0, 0, 0, 32); ++ allowedips_remove_by_peer(&t, a, &mutex); ++ test_negative(4, a, 1, 0, 0, 0); ++ test_negative(4, a, 64, 0, 0, 0); ++ test_negative(4, a, 128, 0, 0, 0); ++ test_negative(4, a, 192, 0, 0, 0); ++ test_negative(4, a, 255, 0, 0, 0); ++ ++ allowedips_free(&t, &mutex); ++ allowedips_init(&t); ++ insert(4, a, 192, 168, 0, 0, 16); ++ insert(4, a, 192, 168, 0, 0, 24); ++ allowedips_remove_by_peer(&t, a, &mutex); ++ test_negative(4, a, 192, 168, 0, 1); ++ ++ /* These will hit the BUG_ON(len >= 128) in free_node if something goes wrong. */ ++ for (i = 0; i < 128; ++i) { ++ part = cpu_to_be64(~(1LLU << (i % 64))); ++ memset(&ip, 0xff, 16); ++ memcpy((u8 *)&ip + (i < 64) * 8, &part, 8); ++ allowedips_insert_v6(&t, &ip, 128, a, &mutex); ++ } ++ ++#ifdef DEBUG_RANDOM_TRIE ++ if (success) ++ success = randomized_test(); ++#endif ++ ++ if (success) ++ pr_info("allowedips self-tests: pass\n"); ++ ++free: ++ allowedips_free(&t, &mutex); ++ kfree(a); ++ kfree(b); ++ kfree(c); ++ kfree(d); ++ kfree(e); ++ kfree(f); ++ kfree(g); ++ kfree(h); ++ mutex_unlock(&mutex); ++ ++ return success; ++} ++#undef test_negative ++#undef test ++#undef remove ++#undef insert ++#undef init_peer ++ ++#endif +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/selftest/blake2s.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,559 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifdef DEBUG ++static const u8 blake2s_testvecs[][BLAKE2S_OUTBYTES] __initconst = { ++ { 0x69, 0x21, 0x7A, 0x30, 0x79, 0x90, 0x80, 0x94, 0xE1, 0x11, 0x21, 0xD0, 0x42, 0x35, 0x4A, 0x7C, 0x1F, 0x55, 0xB6, 0x48, 0x2C, 0xA1, 0xA5, 0x1E, 0x1B, 0x25, 0x0D, 0xFD, 0x1E, 0xD0, 0xEE, 0xF9 }, ++ { 0xE3, 0x4D, 0x74, 0xDB, 0xAF, 0x4F, 0xF4, 0xC6, 0xAB, 0xD8, 0x71, 0xCC, 0x22, 0x04, 0x51, 0xD2, 0xEA, 0x26, 0x48, 0x84, 0x6C, 0x77, 0x57, 0xFB, 0xAA, 0xC8, 0x2F, 0xE5, 0x1A, 0xD6, 0x4B, 0xEA }, ++ { 0xDD, 0xAD, 0x9A, 0xB1, 0x5D, 0xAC, 0x45, 0x49, 0xBA, 0x42, 0xF4, 0x9D, 0x26, 0x24, 0x96, 0xBE, 0xF6, 0xC0, 0xBA, 0xE1, 0xDD, 0x34, 0x2A, 0x88, 0x08, 0xF8, 0xEA, 0x26, 0x7C, 0x6E, 0x21, 0x0C }, ++ { 0xE8, 0xF9, 0x1C, 0x6E, 0xF2, 0x32, 0xA0, 0x41, 0x45, 0x2A, 0xB0, 0xE1, 0x49, 0x07, 0x0C, 0xDD, 0x7D, 0xD1, 0x76, 0x9E, 0x75, 0xB3, 0xA5, 0x92, 0x1B, 0xE3, 0x78, 0x76, 0xC4, 0x5C, 0x99, 0x00 }, ++ { 0x0C, 0xC7, 0x0E, 0x00, 0x34, 0x8B, 0x86, 0xBA, 0x29, 0x44, 0xD0, 0xC3, 0x20, 0x38, 0xB2, 0x5C, 0x55, 0x58, 0x4F, 0x90, 0xDF, 0x23, 0x04, 0xF5, 0x5F, 0xA3, 0x32, 0xAF, 0x5F, 0xB0, 0x1E, 0x20 }, ++ { 0xEC, 0x19, 0x64, 0x19, 0x10, 0x87, 0xA4, 0xFE, 0x9D, 0xF1, 0xC7, 0x95, 0x34, 0x2A, 0x02, 0xFF, 0xC1, 0x91, 0xA5, 0xB2, 0x51, 0x76, 0x48, 0x56, 0xAE, 0x5B, 0x8B, 0x57, 0x69, 0xF0, 0xC6, 0xCD }, ++ { 0xE1, 0xFA, 0x51, 0x61, 0x8D, 0x7D, 0xF4, 0xEB, 0x70, 0xCF, 0x0D, 0x5A, 0x9E, 0x90, 0x6F, 0x80, 0x6E, 0x9D, 0x19, 0xF7, 0xF4, 0xF0, 0x1E, 0x3B, 0x62, 0x12, 0x88, 0xE4, 0x12, 0x04, 0x05, 0xD6 }, ++ { 0x59, 0x80, 0x01, 0xFA, 0xFB, 0xE8, 0xF9, 0x4E, 0xC6, 0x6D, 0xC8, 0x27, 0xD0, 0x12, 0xCF, 0xCB, 0xBA, 0x22, 0x28, 0x56, 0x9F, 0x44, 0x8E, 0x89, 0xEA, 0x22, 0x08, 0xC8, 0xBF, 0x76, 0x92, 0x93 }, ++ { 0xC7, 0xE8, 0x87, 0xB5, 0x46, 0x62, 0x36, 0x35, 0xE9, 0x3E, 0x04, 0x95, 0x59, 0x8F, 0x17, 0x26, 0x82, 0x19, 0x96, 0xC2, 0x37, 0x77, 0x05, 0xB9, 0x3A, 0x1F, 0x63, 0x6F, 0x87, 0x2B, 0xFA, 0x2D }, ++ { 0xC3, 0x15, 0xA4, 0x37, 0xDD, 0x28, 0x06, 0x2A, 0x77, 0x0D, 0x48, 0x19, 0x67, 0x13, 0x6B, 0x1B, 0x5E, 0xB8, 0x8B, 0x21, 0xEE, 0x53, 0xD0, 0x32, 0x9C, 0x58, 0x97, 0x12, 0x6E, 0x9D, 0xB0, 0x2C }, ++ { 0xBB, 0x47, 0x3D, 0xED, 0xDC, 0x05, 0x5F, 0xEA, 0x62, 0x28, 0xF2, 0x07, 0xDA, 0x57, 0x53, 0x47, 0xBB, 0x00, 0x40, 0x4C, 0xD3, 0x49, 0xD3, 0x8C, 0x18, 0x02, 0x63, 0x07, 0xA2, 0x24, 0xCB, 0xFF }, ++ { 0x68, 0x7E, 0x18, 0x73, 0xA8, 0x27, 0x75, 0x91, 0xBB, 0x33, 0xD9, 0xAD, 0xF9, 0xA1, 0x39, 0x12, 0xEF, 0xEF, 0xE5, 0x57, 0xCA, 0xFC, 0x39, 0xA7, 0x95, 0x26, 0x23, 0xE4, 0x72, 0x55, 0xF1, 0x6D }, ++ { 0x1A, 0xC7, 0xBA, 0x75, 0x4D, 0x6E, 0x2F, 0x94, 0xE0, 0xE8, 0x6C, 0x46, 0xBF, 0xB2, 0x62, 0xAB, 0xBB, 0x74, 0xF4, 0x50, 0xEF, 0x45, 0x6D, 0x6B, 0x4D, 0x97, 0xAA, 0x80, 0xCE, 0x6D, 0xA7, 0x67 }, ++ { 0x01, 0x2C, 0x97, 0x80, 0x96, 0x14, 0x81, 0x6B, 0x5D, 0x94, 0x94, 0x47, 0x7D, 0x4B, 0x68, 0x7D, 0x15, 0xB9, 0x6E, 0xB6, 0x9C, 0x0E, 0x80, 0x74, 0xA8, 0x51, 0x6F, 0x31, 0x22, 0x4B, 0x5C, 0x98 }, ++ { 0x91, 0xFF, 0xD2, 0x6C, 0xFA, 0x4D, 0xA5, 0x13, 0x4C, 0x7E, 0xA2, 0x62, 0xF7, 0x88, 0x9C, 0x32, 0x9F, 0x61, 0xF6, 0xA6, 0x57, 0x22, 0x5C, 0xC2, 0x12, 0xF4, 0x00, 0x56, 0xD9, 0x86, 0xB3, 0xF4 }, ++ { 0xD9, 0x7C, 0x82, 0x8D, 0x81, 0x82, 0xA7, 0x21, 0x80, 0xA0, 0x6A, 0x78, 0x26, 0x83, 0x30, 0x67, 0x3F, 0x7C, 0x4E, 0x06, 0x35, 0x94, 0x7C, 0x04, 0xC0, 0x23, 0x23, 0xFD, 0x45, 0xC0, 0xA5, 0x2D }, ++ { 0xEF, 0xC0, 0x4C, 0xDC, 0x39, 0x1C, 0x7E, 0x91, 0x19, 0xBD, 0x38, 0x66, 0x8A, 0x53, 0x4E, 0x65, 0xFE, 0x31, 0x03, 0x6D, 0x6A, 0x62, 0x11, 0x2E, 0x44, 0xEB, 0xEB, 0x11, 0xF9, 0xC5, 0x70, 0x80 }, ++ { 0x99, 0x2C, 0xF5, 0xC0, 0x53, 0x44, 0x2A, 0x5F, 0xBC, 0x4F, 0xAF, 0x58, 0x3E, 0x04, 0xE5, 0x0B, 0xB7, 0x0D, 0x2F, 0x39, 0xFB, 0xB6, 0xA5, 0x03, 0xF8, 0x9E, 0x56, 0xA6, 0x3E, 0x18, 0x57, 0x8A }, ++ { 0x38, 0x64, 0x0E, 0x9F, 0x21, 0x98, 0x3E, 0x67, 0xB5, 0x39, 0xCA, 0xCC, 0xAE, 0x5E, 0xCF, 0x61, 0x5A, 0xE2, 0x76, 0x4F, 0x75, 0xA0, 0x9C, 0x9C, 0x59, 0xB7, 0x64, 0x83, 0xC1, 0xFB, 0xC7, 0x35 }, ++ { 0x21, 0x3D, 0xD3, 0x4C, 0x7E, 0xFE, 0x4F, 0xB2, 0x7A, 0x6B, 0x35, 0xF6, 0xB4, 0x00, 0x0D, 0x1F, 0xE0, 0x32, 0x81, 0xAF, 0x3C, 0x72, 0x3E, 0x5C, 0x9F, 0x94, 0x74, 0x7A, 0x5F, 0x31, 0xCD, 0x3B }, ++ { 0xEC, 0x24, 0x6E, 0xEE, 0xB9, 0xCE, 0xD3, 0xF7, 0xAD, 0x33, 0xED, 0x28, 0x66, 0x0D, 0xD9, 0xBB, 0x07, 0x32, 0x51, 0x3D, 0xB4, 0xE2, 0xFA, 0x27, 0x8B, 0x60, 0xCD, 0xE3, 0x68, 0x2A, 0x4C, 0xCD }, ++ { 0xAC, 0x9B, 0x61, 0xD4, 0x46, 0x64, 0x8C, 0x30, 0x05, 0xD7, 0x89, 0x2B, 0xF3, 0xA8, 0x71, 0x9F, 0x4C, 0x81, 0x81, 0xCF, 0xDC, 0xBC, 0x2B, 0x79, 0xFE, 0xF1, 0x0A, 0x27, 0x9B, 0x91, 0x10, 0x95 }, ++ { 0x7B, 0xF8, 0xB2, 0x29, 0x59, 0xE3, 0x4E, 0x3A, 0x43, 0xF7, 0x07, 0x92, 0x23, 0xE8, 0x3A, 0x97, 0x54, 0x61, 0x7D, 0x39, 0x1E, 0x21, 0x3D, 0xFD, 0x80, 0x8E, 0x41, 0xB9, 0xBE, 0xAD, 0x4C, 0xE7 }, ++ { 0x68, 0xD4, 0xB5, 0xD4, 0xFA, 0x0E, 0x30, 0x2B, 0x64, 0xCC, 0xC5, 0xAF, 0x79, 0x29, 0x13, 0xAC, 0x4C, 0x88, 0xEC, 0x95, 0xC0, 0x7D, 0xDF, 0x40, 0x69, 0x42, 0x56, 0xEB, 0x88, 0xCE, 0x9F, 0x3D }, ++ { 0xB2, 0xC2, 0x42, 0x0F, 0x05, 0xF9, 0xAB, 0xE3, 0x63, 0x15, 0x91, 0x93, 0x36, 0xB3, 0x7E, 0x4E, 0x0F, 0xA3, 0x3F, 0xF7, 0xE7, 0x6A, 0x49, 0x27, 0x67, 0x00, 0x6F, 0xDB, 0x5D, 0x93, 0x54, 0x62 }, ++ { 0x13, 0x4F, 0x61, 0xBB, 0xD0, 0xBB, 0xB6, 0x9A, 0xED, 0x53, 0x43, 0x90, 0x45, 0x51, 0xA3, 0xE6, 0xC1, 0xAA, 0x7D, 0xCD, 0xD7, 0x7E, 0x90, 0x3E, 0x70, 0x23, 0xEB, 0x7C, 0x60, 0x32, 0x0A, 0xA7 }, ++ { 0x46, 0x93, 0xF9, 0xBF, 0xF7, 0xD4, 0xF3, 0x98, 0x6A, 0x7D, 0x17, 0x6E, 0x6E, 0x06, 0xF7, 0x2A, 0xD1, 0x49, 0x0D, 0x80, 0x5C, 0x99, 0xE2, 0x53, 0x47, 0xB8, 0xDE, 0x77, 0xB4, 0xDB, 0x6D, 0x9B }, ++ { 0x85, 0x3E, 0x26, 0xF7, 0x41, 0x95, 0x3B, 0x0F, 0xD5, 0xBD, 0xB4, 0x24, 0xE8, 0xAB, 0x9E, 0x8B, 0x37, 0x50, 0xEA, 0xA8, 0xEF, 0x61, 0xE4, 0x79, 0x02, 0xC9, 0x1E, 0x55, 0x4E, 0x9C, 0x73, 0xB9 }, ++ { 0xF7, 0xDE, 0x53, 0x63, 0x61, 0xAB, 0xAA, 0x0E, 0x15, 0x81, 0x56, 0xCF, 0x0E, 0xA4, 0xF6, 0x3A, 0x99, 0xB5, 0xE4, 0x05, 0x4F, 0x8F, 0xA4, 0xC9, 0xD4, 0x5F, 0x62, 0x85, 0xCA, 0xD5, 0x56, 0x94 }, ++ { 0x4C, 0x23, 0x06, 0x08, 0x86, 0x0A, 0x99, 0xAE, 0x8D, 0x7B, 0xD5, 0xC2, 0xCC, 0x17, 0xFA, 0x52, 0x09, 0x6B, 0x9A, 0x61, 0xBE, 0xDB, 0x17, 0xCB, 0x76, 0x17, 0x86, 0x4A, 0xD2, 0x9C, 0xA7, 0xA6 }, ++ { 0xAE, 0xB9, 0x20, 0xEA, 0x87, 0x95, 0x2D, 0xAD, 0xB1, 0xFB, 0x75, 0x92, 0x91, 0xE3, 0x38, 0x81, 0x39, 0xA8, 0x72, 0x86, 0x50, 0x01, 0x88, 0x6E, 0xD8, 0x47, 0x52, 0xE9, 0x3C, 0x25, 0x0C, 0x2A }, ++ { 0xAB, 0xA4, 0xAD, 0x9B, 0x48, 0x0B, 0x9D, 0xF3, 0xD0, 0x8C, 0xA5, 0xE8, 0x7B, 0x0C, 0x24, 0x40, 0xD4, 0xE4, 0xEA, 0x21, 0x22, 0x4C, 0x2E, 0xB4, 0x2C, 0xBA, 0xE4, 0x69, 0xD0, 0x89, 0xB9, 0x31 }, ++ { 0x05, 0x82, 0x56, 0x07, 0xD7, 0xFD, 0xF2, 0xD8, 0x2E, 0xF4, 0xC3, 0xC8, 0xC2, 0xAE, 0xA9, 0x61, 0xAD, 0x98, 0xD6, 0x0E, 0xDF, 0xF7, 0xD0, 0x18, 0x98, 0x3E, 0x21, 0x20, 0x4C, 0x0D, 0x93, 0xD1 }, ++ { 0xA7, 0x42, 0xF8, 0xB6, 0xAF, 0x82, 0xD8, 0xA6, 0xCA, 0x23, 0x57, 0xC5, 0xF1, 0xCF, 0x91, 0xDE, 0xFB, 0xD0, 0x66, 0x26, 0x7D, 0x75, 0xC0, 0x48, 0xB3, 0x52, 0x36, 0x65, 0x85, 0x02, 0x59, 0x62 }, ++ { 0x2B, 0xCA, 0xC8, 0x95, 0x99, 0x00, 0x0B, 0x42, 0xC9, 0x5A, 0xE2, 0x38, 0x35, 0xA7, 0x13, 0x70, 0x4E, 0xD7, 0x97, 0x89, 0xC8, 0x4F, 0xEF, 0x14, 0x9A, 0x87, 0x4F, 0xF7, 0x33, 0xF0, 0x17, 0xA2 }, ++ { 0xAC, 0x1E, 0xD0, 0x7D, 0x04, 0x8F, 0x10, 0x5A, 0x9E, 0x5B, 0x7A, 0xB8, 0x5B, 0x09, 0xA4, 0x92, 0xD5, 0xBA, 0xFF, 0x14, 0xB8, 0xBF, 0xB0, 0xE9, 0xFD, 0x78, 0x94, 0x86, 0xEE, 0xA2, 0xB9, 0x74 }, ++ { 0xE4, 0x8D, 0x0E, 0xCF, 0xAF, 0x49, 0x7D, 0x5B, 0x27, 0xC2, 0x5D, 0x99, 0xE1, 0x56, 0xCB, 0x05, 0x79, 0xD4, 0x40, 0xD6, 0xE3, 0x1F, 0xB6, 0x24, 0x73, 0x69, 0x6D, 0xBF, 0x95, 0xE0, 0x10, 0xE4 }, ++ { 0x12, 0xA9, 0x1F, 0xAD, 0xF8, 0xB2, 0x16, 0x44, 0xFD, 0x0F, 0x93, 0x4F, 0x3C, 0x4A, 0x8F, 0x62, 0xBA, 0x86, 0x2F, 0xFD, 0x20, 0xE8, 0xE9, 0x61, 0x15, 0x4C, 0x15, 0xC1, 0x38, 0x84, 0xED, 0x3D }, ++ { 0x7C, 0xBE, 0xE9, 0x6E, 0x13, 0x98, 0x97, 0xDC, 0x98, 0xFB, 0xEF, 0x3B, 0xE8, 0x1A, 0xD4, 0xD9, 0x64, 0xD2, 0x35, 0xCB, 0x12, 0x14, 0x1F, 0xB6, 0x67, 0x27, 0xE6, 0xE5, 0xDF, 0x73, 0xA8, 0x78 }, ++ { 0xEB, 0xF6, 0x6A, 0xBB, 0x59, 0x7A, 0xE5, 0x72, 0xA7, 0x29, 0x7C, 0xB0, 0x87, 0x1E, 0x35, 0x5A, 0xCC, 0xAF, 0xAD, 0x83, 0x77, 0xB8, 0xE7, 0x8B, 0xF1, 0x64, 0xCE, 0x2A, 0x18, 0xDE, 0x4B, 0xAF }, ++ { 0x71, 0xB9, 0x33, 0xB0, 0x7E, 0x4F, 0xF7, 0x81, 0x8C, 0xE0, 0x59, 0xD0, 0x08, 0x82, 0x9E, 0x45, 0x3C, 0x6F, 0xF0, 0x2E, 0xC0, 0xA7, 0xDB, 0x39, 0x3F, 0xC2, 0xD8, 0x70, 0xF3, 0x7A, 0x72, 0x86 }, ++ { 0x7C, 0xF7, 0xC5, 0x13, 0x31, 0x22, 0x0B, 0x8D, 0x3E, 0xBA, 0xED, 0x9C, 0x29, 0x39, 0x8A, 0x16, 0xD9, 0x81, 0x56, 0xE2, 0x61, 0x3C, 0xB0, 0x88, 0xF2, 0xB0, 0xE0, 0x8A, 0x1B, 0xE4, 0xCF, 0x4F }, ++ { 0x3E, 0x41, 0xA1, 0x08, 0xE0, 0xF6, 0x4A, 0xD2, 0x76, 0xB9, 0x79, 0xE1, 0xCE, 0x06, 0x82, 0x79, 0xE1, 0x6F, 0x7B, 0xC7, 0xE4, 0xAA, 0x1D, 0x21, 0x1E, 0x17, 0xB8, 0x11, 0x61, 0xDF, 0x16, 0x02 }, ++ { 0x88, 0x65, 0x02, 0xA8, 0x2A, 0xB4, 0x7B, 0xA8, 0xD8, 0x67, 0x10, 0xAA, 0x9D, 0xE3, 0xD4, 0x6E, 0xA6, 0x5C, 0x47, 0xAF, 0x6E, 0xE8, 0xDE, 0x45, 0x0C, 0xCE, 0xB8, 0xB1, 0x1B, 0x04, 0x5F, 0x50 }, ++ { 0xC0, 0x21, 0xBC, 0x5F, 0x09, 0x54, 0xFE, 0xE9, 0x4F, 0x46, 0xEA, 0x09, 0x48, 0x7E, 0x10, 0xA8, 0x48, 0x40, 0xD0, 0x2F, 0x64, 0x81, 0x0B, 0xC0, 0x8D, 0x9E, 0x55, 0x1F, 0x7D, 0x41, 0x68, 0x14 }, ++ { 0x20, 0x30, 0x51, 0x6E, 0x8A, 0x5F, 0xE1, 0x9A, 0xE7, 0x9C, 0x33, 0x6F, 0xCE, 0x26, 0x38, 0x2A, 0x74, 0x9D, 0x3F, 0xD0, 0xEC, 0x91, 0xE5, 0x37, 0xD4, 0xBD, 0x23, 0x58, 0xC1, 0x2D, 0xFB, 0x22 }, ++ { 0x55, 0x66, 0x98, 0xDA, 0xC8, 0x31, 0x7F, 0xD3, 0x6D, 0xFB, 0xDF, 0x25, 0xA7, 0x9C, 0xB1, 0x12, 0xD5, 0x42, 0x58, 0x60, 0x60, 0x5C, 0xBA, 0xF5, 0x07, 0xF2, 0x3B, 0xF7, 0xE9, 0xF4, 0x2A, 0xFE }, ++ { 0x2F, 0x86, 0x7B, 0xA6, 0x77, 0x73, 0xFD, 0xC3, 0xE9, 0x2F, 0xCE, 0xD9, 0x9A, 0x64, 0x09, 0xAD, 0x39, 0xD0, 0xB8, 0x80, 0xFD, 0xE8, 0xF1, 0x09, 0xA8, 0x17, 0x30, 0xC4, 0x45, 0x1D, 0x01, 0x78 }, ++ { 0x17, 0x2E, 0xC2, 0x18, 0xF1, 0x19, 0xDF, 0xAE, 0x98, 0x89, 0x6D, 0xFF, 0x29, 0xDD, 0x98, 0x76, 0xC9, 0x4A, 0xF8, 0x74, 0x17, 0xF9, 0xAE, 0x4C, 0x70, 0x14, 0xBB, 0x4E, 0x4B, 0x96, 0xAF, 0xC7 }, ++ { 0x3F, 0x85, 0x81, 0x4A, 0x18, 0x19, 0x5F, 0x87, 0x9A, 0xA9, 0x62, 0xF9, 0x5D, 0x26, 0xBD, 0x82, 0xA2, 0x78, 0xF2, 0xB8, 0x23, 0x20, 0x21, 0x8F, 0x6B, 0x3B, 0xD6, 0xF7, 0xF6, 0x67, 0xA6, 0xD9 }, ++ { 0x1B, 0x61, 0x8F, 0xBA, 0xA5, 0x66, 0xB3, 0xD4, 0x98, 0xC1, 0x2E, 0x98, 0x2C, 0x9E, 0xC5, 0x2E, 0x4D, 0xA8, 0x5A, 0x8C, 0x54, 0xF3, 0x8F, 0x34, 0xC0, 0x90, 0x39, 0x4F, 0x23, 0xC1, 0x84, 0xC1 }, ++ { 0x0C, 0x75, 0x8F, 0xB5, 0x69, 0x2F, 0xFD, 0x41, 0xA3, 0x57, 0x5D, 0x0A, 0xF0, 0x0C, 0xC7, 0xFB, 0xF2, 0xCB, 0xE5, 0x90, 0x5A, 0x58, 0x32, 0x3A, 0x88, 0xAE, 0x42, 0x44, 0xF6, 0xE4, 0xC9, 0x93 }, ++ { 0xA9, 0x31, 0x36, 0x0C, 0xAD, 0x62, 0x8C, 0x7F, 0x12, 0xA6, 0xC1, 0xC4, 0xB7, 0x53, 0xB0, 0xF4, 0x06, 0x2A, 0xEF, 0x3C, 0xE6, 0x5A, 0x1A, 0xE3, 0xF1, 0x93, 0x69, 0xDA, 0xDF, 0x3A, 0xE2, 0x3D }, ++ { 0xCB, 0xAC, 0x7D, 0x77, 0x3B, 0x1E, 0x3B, 0x3C, 0x66, 0x91, 0xD7, 0xAB, 0xB7, 0xE9, 0xDF, 0x04, 0x5C, 0x8B, 0xA1, 0x92, 0x68, 0xDE, 0xD1, 0x53, 0x20, 0x7F, 0x5E, 0x80, 0x43, 0x52, 0xEC, 0x5D }, ++ { 0x23, 0xA1, 0x96, 0xD3, 0x80, 0x2E, 0xD3, 0xC1, 0xB3, 0x84, 0x01, 0x9A, 0x82, 0x32, 0x58, 0x40, 0xD3, 0x2F, 0x71, 0x95, 0x0C, 0x45, 0x80, 0xB0, 0x34, 0x45, 0xE0, 0x89, 0x8E, 0x14, 0x05, 0x3C }, ++ { 0xF4, 0x49, 0x54, 0x70, 0xF2, 0x26, 0xC8, 0xC2, 0x14, 0xBE, 0x08, 0xFD, 0xFA, 0xD4, 0xBC, 0x4A, 0x2A, 0x9D, 0xBE, 0xA9, 0x13, 0x6A, 0x21, 0x0D, 0xF0, 0xD4, 0xB6, 0x49, 0x29, 0xE6, 0xFC, 0x14 }, ++ { 0xE2, 0x90, 0xDD, 0x27, 0x0B, 0x46, 0x7F, 0x34, 0xAB, 0x1C, 0x00, 0x2D, 0x34, 0x0F, 0xA0, 0x16, 0x25, 0x7F, 0xF1, 0x9E, 0x58, 0x33, 0xFD, 0xBB, 0xF2, 0xCB, 0x40, 0x1C, 0x3B, 0x28, 0x17, 0xDE }, ++ { 0x9F, 0xC7, 0xB5, 0xDE, 0xD3, 0xC1, 0x50, 0x42, 0xB2, 0xA6, 0x58, 0x2D, 0xC3, 0x9B, 0xE0, 0x16, 0xD2, 0x4A, 0x68, 0x2D, 0x5E, 0x61, 0xAD, 0x1E, 0xFF, 0x9C, 0x63, 0x30, 0x98, 0x48, 0xF7, 0x06 }, ++ { 0x8C, 0xCA, 0x67, 0xA3, 0x6D, 0x17, 0xD5, 0xE6, 0x34, 0x1C, 0xB5, 0x92, 0xFD, 0x7B, 0xEF, 0x99, 0x26, 0xC9, 0xE3, 0xAA, 0x10, 0x27, 0xEA, 0x11, 0xA7, 0xD8, 0xBD, 0x26, 0x0B, 0x57, 0x6E, 0x04 }, ++ { 0x40, 0x93, 0x92, 0xF5, 0x60, 0xF8, 0x68, 0x31, 0xDA, 0x43, 0x73, 0xEE, 0x5E, 0x00, 0x74, 0x26, 0x05, 0x95, 0xD7, 0xBC, 0x24, 0x18, 0x3B, 0x60, 0xED, 0x70, 0x0D, 0x45, 0x83, 0xD3, 0xF6, 0xF0 }, ++ { 0x28, 0x02, 0x16, 0x5D, 0xE0, 0x90, 0x91, 0x55, 0x46, 0xF3, 0x39, 0x8C, 0xD8, 0x49, 0x16, 0x4A, 0x19, 0xF9, 0x2A, 0xDB, 0xC3, 0x61, 0xAD, 0xC9, 0x9B, 0x0F, 0x20, 0xC8, 0xEA, 0x07, 0x10, 0x54 }, ++ { 0xAD, 0x83, 0x91, 0x68, 0xD9, 0xF8, 0xA4, 0xBE, 0x95, 0xBA, 0x9E, 0xF9, 0xA6, 0x92, 0xF0, 0x72, 0x56, 0xAE, 0x43, 0xFE, 0x6F, 0x98, 0x64, 0xE2, 0x90, 0x69, 0x1B, 0x02, 0x56, 0xCE, 0x50, 0xA9 }, ++ { 0x75, 0xFD, 0xAA, 0x50, 0x38, 0xC2, 0x84, 0xB8, 0x6D, 0x6E, 0x8A, 0xFF, 0xE8, 0xB2, 0x80, 0x7E, 0x46, 0x7B, 0x86, 0x60, 0x0E, 0x79, 0xAF, 0x36, 0x89, 0xFB, 0xC0, 0x63, 0x28, 0xCB, 0xF8, 0x94 }, ++ { 0xE5, 0x7C, 0xB7, 0x94, 0x87, 0xDD, 0x57, 0x90, 0x24, 0x32, 0xB2, 0x50, 0x73, 0x38, 0x13, 0xBD, 0x96, 0xA8, 0x4E, 0xFC, 0xE5, 0x9F, 0x65, 0x0F, 0xAC, 0x26, 0xE6, 0x69, 0x6A, 0xEF, 0xAF, 0xC3 }, ++ { 0x56, 0xF3, 0x4E, 0x8B, 0x96, 0x55, 0x7E, 0x90, 0xC1, 0xF2, 0x4B, 0x52, 0xD0, 0xC8, 0x9D, 0x51, 0x08, 0x6A, 0xCF, 0x1B, 0x00, 0xF6, 0x34, 0xCF, 0x1D, 0xDE, 0x92, 0x33, 0xB8, 0xEA, 0xAA, 0x3E }, ++ { 0x1B, 0x53, 0xEE, 0x94, 0xAA, 0xF3, 0x4E, 0x4B, 0x15, 0x9D, 0x48, 0xDE, 0x35, 0x2C, 0x7F, 0x06, 0x61, 0xD0, 0xA4, 0x0E, 0xDF, 0xF9, 0x5A, 0x0B, 0x16, 0x39, 0xB4, 0x09, 0x0E, 0x97, 0x44, 0x72 }, ++ { 0x05, 0x70, 0x5E, 0x2A, 0x81, 0x75, 0x7C, 0x14, 0xBD, 0x38, 0x3E, 0xA9, 0x8D, 0xDA, 0x54, 0x4E, 0xB1, 0x0E, 0x6B, 0xC0, 0x7B, 0xAE, 0x43, 0x5E, 0x25, 0x18, 0xDB, 0xE1, 0x33, 0x52, 0x53, 0x75 }, ++ { 0xD8, 0xB2, 0x86, 0x6E, 0x8A, 0x30, 0x9D, 0xB5, 0x3E, 0x52, 0x9E, 0xC3, 0x29, 0x11, 0xD8, 0x2F, 0x5C, 0xA1, 0x6C, 0xFF, 0x76, 0x21, 0x68, 0x91, 0xA9, 0x67, 0x6A, 0xA3, 0x1A, 0xAA, 0x6C, 0x42 }, ++ { 0xF5, 0x04, 0x1C, 0x24, 0x12, 0x70, 0xEB, 0x04, 0xC7, 0x1E, 0xC2, 0xC9, 0x5D, 0x4C, 0x38, 0xD8, 0x03, 0xB1, 0x23, 0x7B, 0x0F, 0x29, 0xFD, 0x4D, 0xB3, 0xEB, 0x39, 0x76, 0x69, 0xE8, 0x86, 0x99 }, ++ { 0x9A, 0x4C, 0xE0, 0x77, 0xC3, 0x49, 0x32, 0x2F, 0x59, 0x5E, 0x0E, 0xE7, 0x9E, 0xD0, 0xDA, 0x5F, 0xAB, 0x66, 0x75, 0x2C, 0xBF, 0xEF, 0x8F, 0x87, 0xD0, 0xE9, 0xD0, 0x72, 0x3C, 0x75, 0x30, 0xDD }, ++ { 0x65, 0x7B, 0x09, 0xF3, 0xD0, 0xF5, 0x2B, 0x5B, 0x8F, 0x2F, 0x97, 0x16, 0x3A, 0x0E, 0xDF, 0x0C, 0x04, 0xF0, 0x75, 0x40, 0x8A, 0x07, 0xBB, 0xEB, 0x3A, 0x41, 0x01, 0xA8, 0x91, 0x99, 0x0D, 0x62 }, ++ { 0x1E, 0x3F, 0x7B, 0xD5, 0xA5, 0x8F, 0xA5, 0x33, 0x34, 0x4A, 0xA8, 0xED, 0x3A, 0xC1, 0x22, 0xBB, 0x9E, 0x70, 0xD4, 0xEF, 0x50, 0xD0, 0x04, 0x53, 0x08, 0x21, 0x94, 0x8F, 0x5F, 0xE6, 0x31, 0x5A }, ++ { 0x80, 0xDC, 0xCF, 0x3F, 0xD8, 0x3D, 0xFD, 0x0D, 0x35, 0xAA, 0x28, 0x58, 0x59, 0x22, 0xAB, 0x89, 0xD5, 0x31, 0x39, 0x97, 0x67, 0x3E, 0xAF, 0x90, 0x5C, 0xEA, 0x9C, 0x0B, 0x22, 0x5C, 0x7B, 0x5F }, ++ { 0x8A, 0x0D, 0x0F, 0xBF, 0x63, 0x77, 0xD8, 0x3B, 0xB0, 0x8B, 0x51, 0x4B, 0x4B, 0x1C, 0x43, 0xAC, 0xC9, 0x5D, 0x75, 0x17, 0x14, 0xF8, 0x92, 0x56, 0x45, 0xCB, 0x6B, 0xC8, 0x56, 0xCA, 0x15, 0x0A }, ++ { 0x9F, 0xA5, 0xB4, 0x87, 0x73, 0x8A, 0xD2, 0x84, 0x4C, 0xC6, 0x34, 0x8A, 0x90, 0x19, 0x18, 0xF6, 0x59, 0xA3, 0xB8, 0x9E, 0x9C, 0x0D, 0xFE, 0xEA, 0xD3, 0x0D, 0xD9, 0x4B, 0xCF, 0x42, 0xEF, 0x8E }, ++ { 0x80, 0x83, 0x2C, 0x4A, 0x16, 0x77, 0xF5, 0xEA, 0x25, 0x60, 0xF6, 0x68, 0xE9, 0x35, 0x4D, 0xD3, 0x69, 0x97, 0xF0, 0x37, 0x28, 0xCF, 0xA5, 0x5E, 0x1B, 0x38, 0x33, 0x7C, 0x0C, 0x9E, 0xF8, 0x18 }, ++ { 0xAB, 0x37, 0xDD, 0xB6, 0x83, 0x13, 0x7E, 0x74, 0x08, 0x0D, 0x02, 0x6B, 0x59, 0x0B, 0x96, 0xAE, 0x9B, 0xB4, 0x47, 0x72, 0x2F, 0x30, 0x5A, 0x5A, 0xC5, 0x70, 0xEC, 0x1D, 0xF9, 0xB1, 0x74, 0x3C }, ++ { 0x3E, 0xE7, 0x35, 0xA6, 0x94, 0xC2, 0x55, 0x9B, 0x69, 0x3A, 0xA6, 0x86, 0x29, 0x36, 0x1E, 0x15, 0xD1, 0x22, 0x65, 0xAD, 0x6A, 0x3D, 0xED, 0xF4, 0x88, 0xB0, 0xB0, 0x0F, 0xAC, 0x97, 0x54, 0xBA }, ++ { 0xD6, 0xFC, 0xD2, 0x32, 0x19, 0xB6, 0x47, 0xE4, 0xCB, 0xD5, 0xEB, 0x2D, 0x0A, 0xD0, 0x1E, 0xC8, 0x83, 0x8A, 0x4B, 0x29, 0x01, 0xFC, 0x32, 0x5C, 0xC3, 0x70, 0x19, 0x81, 0xCA, 0x6C, 0x88, 0x8B }, ++ { 0x05, 0x20, 0xEC, 0x2F, 0x5B, 0xF7, 0xA7, 0x55, 0xDA, 0xCB, 0x50, 0xC6, 0xBF, 0x23, 0x3E, 0x35, 0x15, 0x43, 0x47, 0x63, 0xDB, 0x01, 0x39, 0xCC, 0xD9, 0xFA, 0xEF, 0xBB, 0x82, 0x07, 0x61, 0x2D }, ++ { 0xAF, 0xF3, 0xB7, 0x5F, 0x3F, 0x58, 0x12, 0x64, 0xD7, 0x66, 0x16, 0x62, 0xB9, 0x2F, 0x5A, 0xD3, 0x7C, 0x1D, 0x32, 0xBD, 0x45, 0xFF, 0x81, 0xA4, 0xED, 0x8A, 0xDC, 0x9E, 0xF3, 0x0D, 0xD9, 0x89 }, ++ { 0xD0, 0xDD, 0x65, 0x0B, 0xEF, 0xD3, 0xBA, 0x63, 0xDC, 0x25, 0x10, 0x2C, 0x62, 0x7C, 0x92, 0x1B, 0x9C, 0xBE, 0xB0, 0xB1, 0x30, 0x68, 0x69, 0x35, 0xB5, 0xC9, 0x27, 0xCB, 0x7C, 0xCD, 0x5E, 0x3B }, ++ { 0xE1, 0x14, 0x98, 0x16, 0xB1, 0x0A, 0x85, 0x14, 0xFB, 0x3E, 0x2C, 0xAB, 0x2C, 0x08, 0xBE, 0xE9, 0xF7, 0x3C, 0xE7, 0x62, 0x21, 0x70, 0x12, 0x46, 0xA5, 0x89, 0xBB, 0xB6, 0x73, 0x02, 0xD8, 0xA9 }, ++ { 0x7D, 0xA3, 0xF4, 0x41, 0xDE, 0x90, 0x54, 0x31, 0x7E, 0x72, 0xB5, 0xDB, 0xF9, 0x79, 0xDA, 0x01, 0xE6, 0xBC, 0xEE, 0xBB, 0x84, 0x78, 0xEA, 0xE6, 0xA2, 0x28, 0x49, 0xD9, 0x02, 0x92, 0x63, 0x5C }, ++ { 0x12, 0x30, 0xB1, 0xFC, 0x8A, 0x7D, 0x92, 0x15, 0xED, 0xC2, 0xD4, 0xA2, 0xDE, 0xCB, 0xDD, 0x0A, 0x6E, 0x21, 0x6C, 0x92, 0x42, 0x78, 0xC9, 0x1F, 0xC5, 0xD1, 0x0E, 0x7D, 0x60, 0x19, 0x2D, 0x94 }, ++ { 0x57, 0x50, 0xD7, 0x16, 0xB4, 0x80, 0x8F, 0x75, 0x1F, 0xEB, 0xC3, 0x88, 0x06, 0xBA, 0x17, 0x0B, 0xF6, 0xD5, 0x19, 0x9A, 0x78, 0x16, 0xBE, 0x51, 0x4E, 0x3F, 0x93, 0x2F, 0xBE, 0x0C, 0xB8, 0x71 }, ++ { 0x6F, 0xC5, 0x9B, 0x2F, 0x10, 0xFE, 0xBA, 0x95, 0x4A, 0xA6, 0x82, 0x0B, 0x3C, 0xA9, 0x87, 0xEE, 0x81, 0xD5, 0xCC, 0x1D, 0xA3, 0xC6, 0x3C, 0xE8, 0x27, 0x30, 0x1C, 0x56, 0x9D, 0xFB, 0x39, 0xCE }, ++ { 0xC7, 0xC3, 0xFE, 0x1E, 0xEB, 0xDC, 0x7B, 0x5A, 0x93, 0x93, 0x26, 0xE8, 0xDD, 0xB8, 0x3E, 0x8B, 0xF2, 0xB7, 0x80, 0xB6, 0x56, 0x78, 0xCB, 0x62, 0xF2, 0x08, 0xB0, 0x40, 0xAB, 0xDD, 0x35, 0xE2 }, ++ { 0x0C, 0x75, 0xC1, 0xA1, 0x5C, 0xF3, 0x4A, 0x31, 0x4E, 0xE4, 0x78, 0xF4, 0xA5, 0xCE, 0x0B, 0x8A, 0x6B, 0x36, 0x52, 0x8E, 0xF7, 0xA8, 0x20, 0x69, 0x6C, 0x3E, 0x42, 0x46, 0xC5, 0xA1, 0x58, 0x64 }, ++ { 0x21, 0x6D, 0xC1, 0x2A, 0x10, 0x85, 0x69, 0xA3, 0xC7, 0xCD, 0xDE, 0x4A, 0xED, 0x43, 0xA6, 0xC3, 0x30, 0x13, 0x9D, 0xDA, 0x3C, 0xCC, 0x4A, 0x10, 0x89, 0x05, 0xDB, 0x38, 0x61, 0x89, 0x90, 0x50 }, ++ { 0xA5, 0x7B, 0xE6, 0xAE, 0x67, 0x56, 0xF2, 0x8B, 0x02, 0xF5, 0x9D, 0xAD, 0xF7, 0xE0, 0xD7, 0xD8, 0x80, 0x7F, 0x10, 0xFA, 0x15, 0xCE, 0xD1, 0xAD, 0x35, 0x85, 0x52, 0x1A, 0x1D, 0x99, 0x5A, 0x89 }, ++ { 0x81, 0x6A, 0xEF, 0x87, 0x59, 0x53, 0x71, 0x6C, 0xD7, 0xA5, 0x81, 0xF7, 0x32, 0xF5, 0x3D, 0xD4, 0x35, 0xDA, 0xB6, 0x6D, 0x09, 0xC3, 0x61, 0xD2, 0xD6, 0x59, 0x2D, 0xE1, 0x77, 0x55, 0xD8, 0xA8 }, ++ { 0x9A, 0x76, 0x89, 0x32, 0x26, 0x69, 0x3B, 0x6E, 0xA9, 0x7E, 0x6A, 0x73, 0x8F, 0x9D, 0x10, 0xFB, 0x3D, 0x0B, 0x43, 0xAE, 0x0E, 0x8B, 0x7D, 0x81, 0x23, 0xEA, 0x76, 0xCE, 0x97, 0x98, 0x9C, 0x7E }, ++ { 0x8D, 0xAE, 0xDB, 0x9A, 0x27, 0x15, 0x29, 0xDB, 0xB7, 0xDC, 0x3B, 0x60, 0x7F, 0xE5, 0xEB, 0x2D, 0x32, 0x11, 0x77, 0x07, 0x58, 0xDD, 0x3B, 0x0A, 0x35, 0x93, 0xD2, 0xD7, 0x95, 0x4E, 0x2D, 0x5B }, ++ { 0x16, 0xDB, 0xC0, 0xAA, 0x5D, 0xD2, 0xC7, 0x74, 0xF5, 0x05, 0x10, 0x0F, 0x73, 0x37, 0x86, 0xD8, 0xA1, 0x75, 0xFC, 0xBB, 0xB5, 0x9C, 0x43, 0xE1, 0xFB, 0xFF, 0x3E, 0x1E, 0xAF, 0x31, 0xCB, 0x4A }, ++ { 0x86, 0x06, 0xCB, 0x89, 0x9C, 0x6A, 0xEA, 0xF5, 0x1B, 0x9D, 0xB0, 0xFE, 0x49, 0x24, 0xA9, 0xFD, 0x5D, 0xAB, 0xC1, 0x9F, 0x88, 0x26, 0xF2, 0xBC, 0x1C, 0x1D, 0x7D, 0xA1, 0x4D, 0x2C, 0x2C, 0x99 }, ++ { 0x84, 0x79, 0x73, 0x1A, 0xED, 0xA5, 0x7B, 0xD3, 0x7E, 0xAD, 0xB5, 0x1A, 0x50, 0x7E, 0x30, 0x7F, 0x3B, 0xD9, 0x5E, 0x69, 0xDB, 0xCA, 0x94, 0xF3, 0xBC, 0x21, 0x72, 0x60, 0x66, 0xAD, 0x6D, 0xFD }, ++ { 0x58, 0x47, 0x3A, 0x9E, 0xA8, 0x2E, 0xFA, 0x3F, 0x3B, 0x3D, 0x8F, 0xC8, 0x3E, 0xD8, 0x86, 0x31, 0x27, 0xB3, 0x3A, 0xE8, 0xDE, 0xAE, 0x63, 0x07, 0x20, 0x1E, 0xDB, 0x6D, 0xDE, 0x61, 0xDE, 0x29 }, ++ { 0x9A, 0x92, 0x55, 0xD5, 0x3A, 0xF1, 0x16, 0xDE, 0x8B, 0xA2, 0x7C, 0xE3, 0x5B, 0x4C, 0x7E, 0x15, 0x64, 0x06, 0x57, 0xA0, 0xFC, 0xB8, 0x88, 0xC7, 0x0D, 0x95, 0x43, 0x1D, 0xAC, 0xD8, 0xF8, 0x30 }, ++ { 0x9E, 0xB0, 0x5F, 0xFB, 0xA3, 0x9F, 0xD8, 0x59, 0x6A, 0x45, 0x49, 0x3E, 0x18, 0xD2, 0x51, 0x0B, 0xF3, 0xEF, 0x06, 0x5C, 0x51, 0xD6, 0xE1, 0x3A, 0xBE, 0x66, 0xAA, 0x57, 0xE0, 0x5C, 0xFD, 0xB7 }, ++ { 0x81, 0xDC, 0xC3, 0xA5, 0x05, 0xEA, 0xCE, 0x3F, 0x87, 0x9D, 0x8F, 0x70, 0x27, 0x76, 0x77, 0x0F, 0x9D, 0xF5, 0x0E, 0x52, 0x1D, 0x14, 0x28, 0xA8, 0x5D, 0xAF, 0x04, 0xF9, 0xAD, 0x21, 0x50, 0xE0 }, ++ { 0xE3, 0xE3, 0xC4, 0xAA, 0x3A, 0xCB, 0xBC, 0x85, 0x33, 0x2A, 0xF9, 0xD5, 0x64, 0xBC, 0x24, 0x16, 0x5E, 0x16, 0x87, 0xF6, 0xB1, 0xAD, 0xCB, 0xFA, 0xE7, 0x7A, 0x8F, 0x03, 0xC7, 0x2A, 0xC2, 0x8C }, ++ { 0x67, 0x46, 0xC8, 0x0B, 0x4E, 0xB5, 0x6A, 0xEA, 0x45, 0xE6, 0x4E, 0x72, 0x89, 0xBB, 0xA3, 0xED, 0xBF, 0x45, 0xEC, 0xF8, 0x20, 0x64, 0x81, 0xFF, 0x63, 0x02, 0x12, 0x29, 0x84, 0xCD, 0x52, 0x6A }, ++ { 0x2B, 0x62, 0x8E, 0x52, 0x76, 0x4D, 0x7D, 0x62, 0xC0, 0x86, 0x8B, 0x21, 0x23, 0x57, 0xCD, 0xD1, 0x2D, 0x91, 0x49, 0x82, 0x2F, 0x4E, 0x98, 0x45, 0xD9, 0x18, 0xA0, 0x8D, 0x1A, 0xE9, 0x90, 0xC0 }, ++ { 0xE4, 0xBF, 0xE8, 0x0D, 0x58, 0xC9, 0x19, 0x94, 0x61, 0x39, 0x09, 0xDC, 0x4B, 0x1A, 0x12, 0x49, 0x68, 0x96, 0xC0, 0x04, 0xAF, 0x7B, 0x57, 0x01, 0x48, 0x3D, 0xE4, 0x5D, 0x28, 0x23, 0xD7, 0x8E }, ++ { 0xEB, 0xB4, 0xBA, 0x15, 0x0C, 0xEF, 0x27, 0x34, 0x34, 0x5B, 0x5D, 0x64, 0x1B, 0xBE, 0xD0, 0x3A, 0x21, 0xEA, 0xFA, 0xE9, 0x33, 0xC9, 0x9E, 0x00, 0x92, 0x12, 0xEF, 0x04, 0x57, 0x4A, 0x85, 0x30 }, ++ { 0x39, 0x66, 0xEC, 0x73, 0xB1, 0x54, 0xAC, 0xC6, 0x97, 0xAC, 0x5C, 0xF5, 0xB2, 0x4B, 0x40, 0xBD, 0xB0, 0xDB, 0x9E, 0x39, 0x88, 0x36, 0xD7, 0x6D, 0x4B, 0x88, 0x0E, 0x3B, 0x2A, 0xF1, 0xAA, 0x27 }, ++ { 0xEF, 0x7E, 0x48, 0x31, 0xB3, 0xA8, 0x46, 0x36, 0x51, 0x8D, 0x6E, 0x4B, 0xFC, 0xE6, 0x4A, 0x43, 0xDB, 0x2A, 0x5D, 0xDA, 0x9C, 0xCA, 0x2B, 0x44, 0xF3, 0x90, 0x33, 0xBD, 0xC4, 0x0D, 0x62, 0x43 }, ++ { 0x7A, 0xBF, 0x6A, 0xCF, 0x5C, 0x8E, 0x54, 0x9D, 0xDB, 0xB1, 0x5A, 0xE8, 0xD8, 0xB3, 0x88, 0xC1, 0xC1, 0x97, 0xE6, 0x98, 0x73, 0x7C, 0x97, 0x85, 0x50, 0x1E, 0xD1, 0xF9, 0x49, 0x30, 0xB7, 0xD9 }, ++ { 0x88, 0x01, 0x8D, 0xED, 0x66, 0x81, 0x3F, 0x0C, 0xA9, 0x5D, 0xEF, 0x47, 0x4C, 0x63, 0x06, 0x92, 0x01, 0x99, 0x67, 0xB9, 0xE3, 0x68, 0x88, 0xDA, 0xDD, 0x94, 0x12, 0x47, 0x19, 0xB6, 0x82, 0xF6 }, ++ { 0x39, 0x30, 0x87, 0x6B, 0x9F, 0xC7, 0x52, 0x90, 0x36, 0xB0, 0x08, 0xB1, 0xB8, 0xBB, 0x99, 0x75, 0x22, 0xA4, 0x41, 0x63, 0x5A, 0x0C, 0x25, 0xEC, 0x02, 0xFB, 0x6D, 0x90, 0x26, 0xE5, 0x5A, 0x97 }, ++ { 0x0A, 0x40, 0x49, 0xD5, 0x7E, 0x83, 0x3B, 0x56, 0x95, 0xFA, 0xC9, 0x3D, 0xD1, 0xFB, 0xEF, 0x31, 0x66, 0xB4, 0x4B, 0x12, 0xAD, 0x11, 0x24, 0x86, 0x62, 0x38, 0x3A, 0xE0, 0x51, 0xE1, 0x58, 0x27 }, ++ { 0x81, 0xDC, 0xC0, 0x67, 0x8B, 0xB6, 0xA7, 0x65, 0xE4, 0x8C, 0x32, 0x09, 0x65, 0x4F, 0xE9, 0x00, 0x89, 0xCE, 0x44, 0xFF, 0x56, 0x18, 0x47, 0x7E, 0x39, 0xAB, 0x28, 0x64, 0x76, 0xDF, 0x05, 0x2B }, ++ { 0xE6, 0x9B, 0x3A, 0x36, 0xA4, 0x46, 0x19, 0x12, 0xDC, 0x08, 0x34, 0x6B, 0x11, 0xDD, 0xCB, 0x9D, 0xB7, 0x96, 0xF8, 0x85, 0xFD, 0x01, 0x93, 0x6E, 0x66, 0x2F, 0xE2, 0x92, 0x97, 0xB0, 0x99, 0xA4 }, ++ { 0x5A, 0xC6, 0x50, 0x3B, 0x0D, 0x8D, 0xA6, 0x91, 0x76, 0x46, 0xE6, 0xDC, 0xC8, 0x7E, 0xDC, 0x58, 0xE9, 0x42, 0x45, 0x32, 0x4C, 0xC2, 0x04, 0xF4, 0xDD, 0x4A, 0xF0, 0x15, 0x63, 0xAC, 0xD4, 0x27 }, ++ { 0xDF, 0x6D, 0xDA, 0x21, 0x35, 0x9A, 0x30, 0xBC, 0x27, 0x17, 0x80, 0x97, 0x1C, 0x1A, 0xBD, 0x56, 0xA6, 0xEF, 0x16, 0x7E, 0x48, 0x08, 0x87, 0x88, 0x8E, 0x73, 0xA8, 0x6D, 0x3B, 0xF6, 0x05, 0xE9 }, ++ { 0xE8, 0xE6, 0xE4, 0x70, 0x71, 0xE7, 0xB7, 0xDF, 0x25, 0x80, 0xF2, 0x25, 0xCF, 0xBB, 0xED, 0xF8, 0x4C, 0xE6, 0x77, 0x46, 0x62, 0x66, 0x28, 0xD3, 0x30, 0x97, 0xE4, 0xB7, 0xDC, 0x57, 0x11, 0x07 }, ++ { 0x53, 0xE4, 0x0E, 0xAD, 0x62, 0x05, 0x1E, 0x19, 0xCB, 0x9B, 0xA8, 0x13, 0x3E, 0x3E, 0x5C, 0x1C, 0xE0, 0x0D, 0xDC, 0xAD, 0x8A, 0xCF, 0x34, 0x2A, 0x22, 0x43, 0x60, 0xB0, 0xAC, 0xC1, 0x47, 0x77 }, ++ { 0x9C, 0xCD, 0x53, 0xFE, 0x80, 0xBE, 0x78, 0x6A, 0xA9, 0x84, 0x63, 0x84, 0x62, 0xFB, 0x28, 0xAF, 0xDF, 0x12, 0x2B, 0x34, 0xD7, 0x8F, 0x46, 0x87, 0xEC, 0x63, 0x2B, 0xB1, 0x9D, 0xE2, 0x37, 0x1A }, ++ { 0xCB, 0xD4, 0x80, 0x52, 0xC4, 0x8D, 0x78, 0x84, 0x66, 0xA3, 0xE8, 0x11, 0x8C, 0x56, 0xC9, 0x7F, 0xE1, 0x46, 0xE5, 0x54, 0x6F, 0xAA, 0xF9, 0x3E, 0x2B, 0xC3, 0xC4, 0x7E, 0x45, 0x93, 0x97, 0x53 }, ++ { 0x25, 0x68, 0x83, 0xB1, 0x4E, 0x2A, 0xF4, 0x4D, 0xAD, 0xB2, 0x8E, 0x1B, 0x34, 0xB2, 0xAC, 0x0F, 0x0F, 0x4C, 0x91, 0xC3, 0x4E, 0xC9, 0x16, 0x9E, 0x29, 0x03, 0x61, 0x58, 0xAC, 0xAA, 0x95, 0xB9 }, ++ { 0x44, 0x71, 0xB9, 0x1A, 0xB4, 0x2D, 0xB7, 0xC4, 0xDD, 0x84, 0x90, 0xAB, 0x95, 0xA2, 0xEE, 0x8D, 0x04, 0xE3, 0xEF, 0x5C, 0x3D, 0x6F, 0xC7, 0x1A, 0xC7, 0x4B, 0x2B, 0x26, 0x91, 0x4D, 0x16, 0x41 }, ++ { 0xA5, 0xEB, 0x08, 0x03, 0x8F, 0x8F, 0x11, 0x55, 0xED, 0x86, 0xE6, 0x31, 0x90, 0x6F, 0xC1, 0x30, 0x95, 0xF6, 0xBB, 0xA4, 0x1D, 0xE5, 0xD4, 0xE7, 0x95, 0x75, 0x8E, 0xC8, 0xC8, 0xDF, 0x8A, 0xF1 }, ++ { 0xDC, 0x1D, 0xB6, 0x4E, 0xD8, 0xB4, 0x8A, 0x91, 0x0E, 0x06, 0x0A, 0x6B, 0x86, 0x63, 0x74, 0xC5, 0x78, 0x78, 0x4E, 0x9A, 0xC4, 0x9A, 0xB2, 0x77, 0x40, 0x92, 0xAC, 0x71, 0x50, 0x19, 0x34, 0xAC }, ++ { 0x28, 0x54, 0x13, 0xB2, 0xF2, 0xEE, 0x87, 0x3D, 0x34, 0x31, 0x9E, 0xE0, 0xBB, 0xFB, 0xB9, 0x0F, 0x32, 0xDA, 0x43, 0x4C, 0xC8, 0x7E, 0x3D, 0xB5, 0xED, 0x12, 0x1B, 0xB3, 0x98, 0xED, 0x96, 0x4B }, ++ { 0x02, 0x16, 0xE0, 0xF8, 0x1F, 0x75, 0x0F, 0x26, 0xF1, 0x99, 0x8B, 0xC3, 0x93, 0x4E, 0x3E, 0x12, 0x4C, 0x99, 0x45, 0xE6, 0x85, 0xA6, 0x0B, 0x25, 0xE8, 0xFB, 0xD9, 0x62, 0x5A, 0xB6, 0xB5, 0x99 }, ++ { 0x38, 0xC4, 0x10, 0xF5, 0xB9, 0xD4, 0x07, 0x20, 0x50, 0x75, 0x5B, 0x31, 0xDC, 0xA8, 0x9F, 0xD5, 0x39, 0x5C, 0x67, 0x85, 0xEE, 0xB3, 0xD7, 0x90, 0xF3, 0x20, 0xFF, 0x94, 0x1C, 0x5A, 0x93, 0xBF }, ++ { 0xF1, 0x84, 0x17, 0xB3, 0x9D, 0x61, 0x7A, 0xB1, 0xC1, 0x8F, 0xDF, 0x91, 0xEB, 0xD0, 0xFC, 0x6D, 0x55, 0x16, 0xBB, 0x34, 0xCF, 0x39, 0x36, 0x40, 0x37, 0xBC, 0xE8, 0x1F, 0xA0, 0x4C, 0xEC, 0xB1 }, ++ { 0x1F, 0xA8, 0x77, 0xDE, 0x67, 0x25, 0x9D, 0x19, 0x86, 0x3A, 0x2A, 0x34, 0xBC, 0xC6, 0x96, 0x2A, 0x2B, 0x25, 0xFC, 0xBF, 0x5C, 0xBE, 0xCD, 0x7E, 0xDE, 0x8F, 0x1F, 0xA3, 0x66, 0x88, 0xA7, 0x96 }, ++ { 0x5B, 0xD1, 0x69, 0xE6, 0x7C, 0x82, 0xC2, 0xC2, 0xE9, 0x8E, 0xF7, 0x00, 0x8B, 0xDF, 0x26, 0x1F, 0x2D, 0xDF, 0x30, 0xB1, 0xC0, 0x0F, 0x9E, 0x7F, 0x27, 0x5B, 0xB3, 0xE8, 0xA2, 0x8D, 0xC9, 0xA2 }, ++ { 0xC8, 0x0A, 0xBE, 0xEB, 0xB6, 0x69, 0xAD, 0x5D, 0xEE, 0xB5, 0xF5, 0xEC, 0x8E, 0xA6, 0xB7, 0xA0, 0x5D, 0xDF, 0x7D, 0x31, 0xEC, 0x4C, 0x0A, 0x2E, 0xE2, 0x0B, 0x0B, 0x98, 0xCA, 0xEC, 0x67, 0x46 }, ++ { 0xE7, 0x6D, 0x3F, 0xBD, 0xA5, 0xBA, 0x37, 0x4E, 0x6B, 0xF8, 0xE5, 0x0F, 0xAD, 0xC3, 0xBB, 0xB9, 0xBA, 0x5C, 0x20, 0x6E, 0xBD, 0xEC, 0x89, 0xA3, 0xA5, 0x4C, 0xF3, 0xDD, 0x84, 0xA0, 0x70, 0x16 }, ++ { 0x7B, 0xBA, 0x9D, 0xC5, 0xB5, 0xDB, 0x20, 0x71, 0xD1, 0x77, 0x52, 0xB1, 0x04, 0x4C, 0x1E, 0xCE, 0xD9, 0x6A, 0xAF, 0x2D, 0xD4, 0x6E, 0x9B, 0x43, 0x37, 0x50, 0xE8, 0xEA, 0x0D, 0xCC, 0x18, 0x70 }, ++ { 0xF2, 0x9B, 0x1B, 0x1A, 0xB9, 0xBA, 0xB1, 0x63, 0x01, 0x8E, 0xE3, 0xDA, 0x15, 0x23, 0x2C, 0xCA, 0x78, 0xEC, 0x52, 0xDB, 0xC3, 0x4E, 0xDA, 0x5B, 0x82, 0x2E, 0xC1, 0xD8, 0x0F, 0xC2, 0x1B, 0xD0 }, ++ { 0x9E, 0xE3, 0xE3, 0xE7, 0xE9, 0x00, 0xF1, 0xE1, 0x1D, 0x30, 0x8C, 0x4B, 0x2B, 0x30, 0x76, 0xD2, 0x72, 0xCF, 0x70, 0x12, 0x4F, 0x9F, 0x51, 0xE1, 0xDA, 0x60, 0xF3, 0x78, 0x46, 0xCD, 0xD2, 0xF4 }, ++ { 0x70, 0xEA, 0x3B, 0x01, 0x76, 0x92, 0x7D, 0x90, 0x96, 0xA1, 0x85, 0x08, 0xCD, 0x12, 0x3A, 0x29, 0x03, 0x25, 0x92, 0x0A, 0x9D, 0x00, 0xA8, 0x9B, 0x5D, 0xE0, 0x42, 0x73, 0xFB, 0xC7, 0x6B, 0x85 }, ++ { 0x67, 0xDE, 0x25, 0xC0, 0x2A, 0x4A, 0xAB, 0xA2, 0x3B, 0xDC, 0x97, 0x3C, 0x8B, 0xB0, 0xB5, 0x79, 0x6D, 0x47, 0xCC, 0x06, 0x59, 0xD4, 0x3D, 0xFF, 0x1F, 0x97, 0xDE, 0x17, 0x49, 0x63, 0xB6, 0x8E }, ++ { 0xB2, 0x16, 0x8E, 0x4E, 0x0F, 0x18, 0xB0, 0xE6, 0x41, 0x00, 0xB5, 0x17, 0xED, 0x95, 0x25, 0x7D, 0x73, 0xF0, 0x62, 0x0D, 0xF8, 0x85, 0xC1, 0x3D, 0x2E, 0xCF, 0x79, 0x36, 0x7B, 0x38, 0x4C, 0xEE }, ++ { 0x2E, 0x7D, 0xEC, 0x24, 0x28, 0x85, 0x3B, 0x2C, 0x71, 0x76, 0x07, 0x45, 0x54, 0x1F, 0x7A, 0xFE, 0x98, 0x25, 0xB5, 0xDD, 0x77, 0xDF, 0x06, 0x51, 0x1D, 0x84, 0x41, 0xA9, 0x4B, 0xAC, 0xC9, 0x27 }, ++ { 0xCA, 0x9F, 0xFA, 0xC4, 0xC4, 0x3F, 0x0B, 0x48, 0x46, 0x1D, 0xC5, 0xC2, 0x63, 0xBE, 0xA3, 0xF6, 0xF0, 0x06, 0x11, 0xCE, 0xAC, 0xAB, 0xF6, 0xF8, 0x95, 0xBA, 0x2B, 0x01, 0x01, 0xDB, 0xB6, 0x8D }, ++ { 0x74, 0x10, 0xD4, 0x2D, 0x8F, 0xD1, 0xD5, 0xE9, 0xD2, 0xF5, 0x81, 0x5C, 0xB9, 0x34, 0x17, 0x99, 0x88, 0x28, 0xEF, 0x3C, 0x42, 0x30, 0xBF, 0xBD, 0x41, 0x2D, 0xF0, 0xA4, 0xA7, 0xA2, 0x50, 0x7A }, ++ { 0x50, 0x10, 0xF6, 0x84, 0x51, 0x6D, 0xCC, 0xD0, 0xB6, 0xEE, 0x08, 0x52, 0xC2, 0x51, 0x2B, 0x4D, 0xC0, 0x06, 0x6C, 0xF0, 0xD5, 0x6F, 0x35, 0x30, 0x29, 0x78, 0xDB, 0x8A, 0xE3, 0x2C, 0x6A, 0x81 }, ++ { 0xAC, 0xAA, 0xB5, 0x85, 0xF7, 0xB7, 0x9B, 0x71, 0x99, 0x35, 0xCE, 0xB8, 0x95, 0x23, 0xDD, 0xC5, 0x48, 0x27, 0xF7, 0x5C, 0x56, 0x88, 0x38, 0x56, 0x15, 0x4A, 0x56, 0xCD, 0xCD, 0x5E, 0xE9, 0x88 }, ++ { 0x66, 0x6D, 0xE5, 0xD1, 0x44, 0x0F, 0xEE, 0x73, 0x31, 0xAA, 0xF0, 0x12, 0x3A, 0x62, 0xEF, 0x2D, 0x8B, 0xA5, 0x74, 0x53, 0xA0, 0x76, 0x96, 0x35, 0xAC, 0x6C, 0xD0, 0x1E, 0x63, 0x3F, 0x77, 0x12 }, ++ { 0xA6, 0xF9, 0x86, 0x58, 0xF6, 0xEA, 0xBA, 0xF9, 0x02, 0xD8, 0xB3, 0x87, 0x1A, 0x4B, 0x10, 0x1D, 0x16, 0x19, 0x6E, 0x8A, 0x4B, 0x24, 0x1E, 0x15, 0x58, 0xFE, 0x29, 0x96, 0x6E, 0x10, 0x3E, 0x8D }, ++ { 0x89, 0x15, 0x46, 0xA8, 0xB2, 0x9F, 0x30, 0x47, 0xDD, 0xCF, 0xE5, 0xB0, 0x0E, 0x45, 0xFD, 0x55, 0x75, 0x63, 0x73, 0x10, 0x5E, 0xA8, 0x63, 0x7D, 0xFC, 0xFF, 0x54, 0x7B, 0x6E, 0xA9, 0x53, 0x5F }, ++ { 0x18, 0xDF, 0xBC, 0x1A, 0xC5, 0xD2, 0x5B, 0x07, 0x61, 0x13, 0x7D, 0xBD, 0x22, 0xC1, 0x7C, 0x82, 0x9D, 0x0F, 0x0E, 0xF1, 0xD8, 0x23, 0x44, 0xE9, 0xC8, 0x9C, 0x28, 0x66, 0x94, 0xDA, 0x24, 0xE8 }, ++ { 0xB5, 0x4B, 0x9B, 0x67, 0xF8, 0xFE, 0xD5, 0x4B, 0xBF, 0x5A, 0x26, 0x66, 0xDB, 0xDF, 0x4B, 0x23, 0xCF, 0xF1, 0xD1, 0xB6, 0xF4, 0xAF, 0xC9, 0x85, 0xB2, 0xE6, 0xD3, 0x30, 0x5A, 0x9F, 0xF8, 0x0F }, ++ { 0x7D, 0xB4, 0x42, 0xE1, 0x32, 0xBA, 0x59, 0xBC, 0x12, 0x89, 0xAA, 0x98, 0xB0, 0xD3, 0xE8, 0x06, 0x00, 0x4F, 0x8E, 0xC1, 0x28, 0x11, 0xAF, 0x1E, 0x2E, 0x33, 0xC6, 0x9B, 0xFD, 0xE7, 0x29, 0xE1 }, ++ { 0x25, 0x0F, 0x37, 0xCD, 0xC1, 0x5E, 0x81, 0x7D, 0x2F, 0x16, 0x0D, 0x99, 0x56, 0xC7, 0x1F, 0xE3, 0xEB, 0x5D, 0xB7, 0x45, 0x56, 0xE4, 0xAD, 0xF9, 0xA4, 0xFF, 0xAF, 0xBA, 0x74, 0x01, 0x03, 0x96 }, ++ { 0x4A, 0xB8, 0xA3, 0xDD, 0x1D, 0xDF, 0x8A, 0xD4, 0x3D, 0xAB, 0x13, 0xA2, 0x7F, 0x66, 0xA6, 0x54, 0x4F, 0x29, 0x05, 0x97, 0xFA, 0x96, 0x04, 0x0E, 0x0E, 0x1D, 0xB9, 0x26, 0x3A, 0xA4, 0x79, 0xF8 }, ++ { 0xEE, 0x61, 0x72, 0x7A, 0x07, 0x66, 0xDF, 0x93, 0x9C, 0xCD, 0xC8, 0x60, 0x33, 0x40, 0x44, 0xC7, 0x9A, 0x3C, 0x9B, 0x15, 0x62, 0x00, 0xBC, 0x3A, 0xA3, 0x29, 0x73, 0x48, 0x3D, 0x83, 0x41, 0xAE }, ++ { 0x3F, 0x68, 0xC7, 0xEC, 0x63, 0xAC, 0x11, 0xEB, 0xB9, 0x8F, 0x94, 0xB3, 0x39, 0xB0, 0x5C, 0x10, 0x49, 0x84, 0xFD, 0xA5, 0x01, 0x03, 0x06, 0x01, 0x44, 0xE5, 0xA2, 0xBF, 0xCC, 0xC9, 0xDA, 0x95 }, ++ { 0x05, 0x6F, 0x29, 0x81, 0x6B, 0x8A, 0xF8, 0xF5, 0x66, 0x82, 0xBC, 0x4D, 0x7C, 0xF0, 0x94, 0x11, 0x1D, 0xA7, 0x73, 0x3E, 0x72, 0x6C, 0xD1, 0x3D, 0x6B, 0x3E, 0x8E, 0xA0, 0x3E, 0x92, 0xA0, 0xD5 }, ++ { 0xF5, 0xEC, 0x43, 0xA2, 0x8A, 0xCB, 0xEF, 0xF1, 0xF3, 0x31, 0x8A, 0x5B, 0xCA, 0xC7, 0xC6, 0x6D, 0xDB, 0x52, 0x30, 0xB7, 0x9D, 0xB2, 0xD1, 0x05, 0xBC, 0xBE, 0x15, 0xF3, 0xC1, 0x14, 0x8D, 0x69 }, ++ { 0x2A, 0x69, 0x60, 0xAD, 0x1D, 0x8D, 0xD5, 0x47, 0x55, 0x5C, 0xFB, 0xD5, 0xE4, 0x60, 0x0F, 0x1E, 0xAA, 0x1C, 0x8E, 0xDA, 0x34, 0xDE, 0x03, 0x74, 0xEC, 0x4A, 0x26, 0xEA, 0xAA, 0xA3, 0x3B, 0x4E }, ++ { 0xDC, 0xC1, 0xEA, 0x7B, 0xAA, 0xB9, 0x33, 0x84, 0xF7, 0x6B, 0x79, 0x68, 0x66, 0x19, 0x97, 0x54, 0x74, 0x2F, 0x7B, 0x96, 0xD6, 0xB4, 0xC1, 0x20, 0x16, 0x5C, 0x04, 0xA6, 0xC4, 0xF5, 0xCE, 0x10 }, ++ { 0x13, 0xD5, 0xDF, 0x17, 0x92, 0x21, 0x37, 0x9C, 0x6A, 0x78, 0xC0, 0x7C, 0x79, 0x3F, 0xF5, 0x34, 0x87, 0xCA, 0xE6, 0xBF, 0x9F, 0xE8, 0x82, 0x54, 0x1A, 0xB0, 0xE7, 0x35, 0xE3, 0xEA, 0xDA, 0x3B }, ++ { 0x8C, 0x59, 0xE4, 0x40, 0x76, 0x41, 0xA0, 0x1E, 0x8F, 0xF9, 0x1F, 0x99, 0x80, 0xDC, 0x23, 0x6F, 0x4E, 0xCD, 0x6F, 0xCF, 0x52, 0x58, 0x9A, 0x09, 0x9A, 0x96, 0x16, 0x33, 0x96, 0x77, 0x14, 0xE1 }, ++ { 0x83, 0x3B, 0x1A, 0xC6, 0xA2, 0x51, 0xFD, 0x08, 0xFD, 0x6D, 0x90, 0x8F, 0xEA, 0x2A, 0x4E, 0xE1, 0xE0, 0x40, 0xBC, 0xA9, 0x3F, 0xC1, 0xA3, 0x8E, 0xC3, 0x82, 0x0E, 0x0C, 0x10, 0xBD, 0x82, 0xEA }, ++ { 0xA2, 0x44, 0xF9, 0x27, 0xF3, 0xB4, 0x0B, 0x8F, 0x6C, 0x39, 0x15, 0x70, 0xC7, 0x65, 0x41, 0x8F, 0x2F, 0x6E, 0x70, 0x8E, 0xAC, 0x90, 0x06, 0xC5, 0x1A, 0x7F, 0xEF, 0xF4, 0xAF, 0x3B, 0x2B, 0x9E }, ++ { 0x3D, 0x99, 0xED, 0x95, 0x50, 0xCF, 0x11, 0x96, 0xE6, 0xC4, 0xD2, 0x0C, 0x25, 0x96, 0x20, 0xF8, 0x58, 0xC3, 0xD7, 0x03, 0x37, 0x4C, 0x12, 0x8C, 0xE7, 0xB5, 0x90, 0x31, 0x0C, 0x83, 0x04, 0x6D }, ++ { 0x2B, 0x35, 0xC4, 0x7D, 0x7B, 0x87, 0x76, 0x1F, 0x0A, 0xE4, 0x3A, 0xC5, 0x6A, 0xC2, 0x7B, 0x9F, 0x25, 0x83, 0x03, 0x67, 0xB5, 0x95, 0xBE, 0x8C, 0x24, 0x0E, 0x94, 0x60, 0x0C, 0x6E, 0x33, 0x12 }, ++ { 0x5D, 0x11, 0xED, 0x37, 0xD2, 0x4D, 0xC7, 0x67, 0x30, 0x5C, 0xB7, 0xE1, 0x46, 0x7D, 0x87, 0xC0, 0x65, 0xAC, 0x4B, 0xC8, 0xA4, 0x26, 0xDE, 0x38, 0x99, 0x1F, 0xF5, 0x9A, 0xA8, 0x73, 0x5D, 0x02 }, ++ { 0xB8, 0x36, 0x47, 0x8E, 0x1C, 0xA0, 0x64, 0x0D, 0xCE, 0x6F, 0xD9, 0x10, 0xA5, 0x09, 0x62, 0x72, 0xC8, 0x33, 0x09, 0x90, 0xCD, 0x97, 0x86, 0x4A, 0xC2, 0xBF, 0x14, 0xEF, 0x6B, 0x23, 0x91, 0x4A }, ++ { 0x91, 0x00, 0xF9, 0x46, 0xD6, 0xCC, 0xDE, 0x3A, 0x59, 0x7F, 0x90, 0xD3, 0x9F, 0xC1, 0x21, 0x5B, 0xAD, 0xDC, 0x74, 0x13, 0x64, 0x3D, 0x85, 0xC2, 0x1C, 0x3E, 0xEE, 0x5D, 0x2D, 0xD3, 0x28, 0x94 }, ++ { 0xDA, 0x70, 0xEE, 0xDD, 0x23, 0xE6, 0x63, 0xAA, 0x1A, 0x74, 0xB9, 0x76, 0x69, 0x35, 0xB4, 0x79, 0x22, 0x2A, 0x72, 0xAF, 0xBA, 0x5C, 0x79, 0x51, 0x58, 0xDA, 0xD4, 0x1A, 0x3B, 0xD7, 0x7E, 0x40 }, ++ { 0xF0, 0x67, 0xED, 0x6A, 0x0D, 0xBD, 0x43, 0xAA, 0x0A, 0x92, 0x54, 0xE6, 0x9F, 0xD6, 0x6B, 0xDD, 0x8A, 0xCB, 0x87, 0xDE, 0x93, 0x6C, 0x25, 0x8C, 0xFB, 0x02, 0x28, 0x5F, 0x2C, 0x11, 0xFA, 0x79 }, ++ { 0x71, 0x5C, 0x99, 0xC7, 0xD5, 0x75, 0x80, 0xCF, 0x97, 0x53, 0xB4, 0xC1, 0xD7, 0x95, 0xE4, 0x5A, 0x83, 0xFB, 0xB2, 0x28, 0xC0, 0xD3, 0x6F, 0xBE, 0x20, 0xFA, 0xF3, 0x9B, 0xDD, 0x6D, 0x4E, 0x85 }, ++ { 0xE4, 0x57, 0xD6, 0xAD, 0x1E, 0x67, 0xCB, 0x9B, 0xBD, 0x17, 0xCB, 0xD6, 0x98, 0xFA, 0x6D, 0x7D, 0xAE, 0x0C, 0x9B, 0x7A, 0xD6, 0xCB, 0xD6, 0x53, 0x96, 0x34, 0xE3, 0x2A, 0x71, 0x9C, 0x84, 0x92 }, ++ { 0xEC, 0xE3, 0xEA, 0x81, 0x03, 0xE0, 0x24, 0x83, 0xC6, 0x4A, 0x70, 0xA4, 0xBD, 0xCE, 0xE8, 0xCE, 0xB6, 0x27, 0x8F, 0x25, 0x33, 0xF3, 0xF4, 0x8D, 0xBE, 0xED, 0xFB, 0xA9, 0x45, 0x31, 0xD4, 0xAE }, ++ { 0x38, 0x8A, 0xA5, 0xD3, 0x66, 0x7A, 0x97, 0xC6, 0x8D, 0x3D, 0x56, 0xF8, 0xF3, 0xEE, 0x8D, 0x3D, 0x36, 0x09, 0x1F, 0x17, 0xFE, 0x5D, 0x1B, 0x0D, 0x5D, 0x84, 0xC9, 0x3B, 0x2F, 0xFE, 0x40, 0xBD }, ++ { 0x8B, 0x6B, 0x31, 0xB9, 0xAD, 0x7C, 0x3D, 0x5C, 0xD8, 0x4B, 0xF9, 0x89, 0x47, 0xB9, 0xCD, 0xB5, 0x9D, 0xF8, 0xA2, 0x5F, 0xF7, 0x38, 0x10, 0x10, 0x13, 0xBE, 0x4F, 0xD6, 0x5E, 0x1D, 0xD1, 0xA3 }, ++ { 0x06, 0x62, 0x91, 0xF6, 0xBB, 0xD2, 0x5F, 0x3C, 0x85, 0x3D, 0xB7, 0xD8, 0xB9, 0x5C, 0x9A, 0x1C, 0xFB, 0x9B, 0xF1, 0xC1, 0xC9, 0x9F, 0xB9, 0x5A, 0x9B, 0x78, 0x69, 0xD9, 0x0F, 0x1C, 0x29, 0x03 }, ++ { 0xA7, 0x07, 0xEF, 0xBC, 0xCD, 0xCE, 0xED, 0x42, 0x96, 0x7A, 0x66, 0xF5, 0x53, 0x9B, 0x93, 0xED, 0x75, 0x60, 0xD4, 0x67, 0x30, 0x40, 0x16, 0xC4, 0x78, 0x0D, 0x77, 0x55, 0xA5, 0x65, 0xD4, 0xC4 }, ++ { 0x38, 0xC5, 0x3D, 0xFB, 0x70, 0xBE, 0x7E, 0x79, 0x2B, 0x07, 0xA6, 0xA3, 0x5B, 0x8A, 0x6A, 0x0A, 0xBA, 0x02, 0xC5, 0xC5, 0xF3, 0x8B, 0xAF, 0x5C, 0x82, 0x3F, 0xDF, 0xD9, 0xE4, 0x2D, 0x65, 0x7E }, ++ { 0xF2, 0x91, 0x13, 0x86, 0x50, 0x1D, 0x9A, 0xB9, 0xD7, 0x20, 0xCF, 0x8A, 0xD1, 0x05, 0x03, 0xD5, 0x63, 0x4B, 0xF4, 0xB7, 0xD1, 0x2B, 0x56, 0xDF, 0xB7, 0x4F, 0xEC, 0xC6, 0xE4, 0x09, 0x3F, 0x68 }, ++ { 0xC6, 0xF2, 0xBD, 0xD5, 0x2B, 0x81, 0xE6, 0xE4, 0xF6, 0x59, 0x5A, 0xBD, 0x4D, 0x7F, 0xB3, 0x1F, 0x65, 0x11, 0x69, 0xD0, 0x0F, 0xF3, 0x26, 0x92, 0x6B, 0x34, 0x94, 0x7B, 0x28, 0xA8, 0x39, 0x59 }, ++ { 0x29, 0x3D, 0x94, 0xB1, 0x8C, 0x98, 0xBB, 0x32, 0x23, 0x36, 0x6B, 0x8C, 0xE7, 0x4C, 0x28, 0xFB, 0xDF, 0x28, 0xE1, 0xF8, 0x4A, 0x33, 0x50, 0xB0, 0xEB, 0x2D, 0x18, 0x04, 0xA5, 0x77, 0x57, 0x9B }, ++ { 0x2C, 0x2F, 0xA5, 0xC0, 0xB5, 0x15, 0x33, 0x16, 0x5B, 0xC3, 0x75, 0xC2, 0x2E, 0x27, 0x81, 0x76, 0x82, 0x70, 0xA3, 0x83, 0x98, 0x5D, 0x13, 0xBD, 0x6B, 0x67, 0xB6, 0xFD, 0x67, 0xF8, 0x89, 0xEB }, ++ { 0xCA, 0xA0, 0x9B, 0x82, 0xB7, 0x25, 0x62, 0xE4, 0x3F, 0x4B, 0x22, 0x75, 0xC0, 0x91, 0x91, 0x8E, 0x62, 0x4D, 0x91, 0x16, 0x61, 0xCC, 0x81, 0x1B, 0xB5, 0xFA, 0xEC, 0x51, 0xF6, 0x08, 0x8E, 0xF7 }, ++ { 0x24, 0x76, 0x1E, 0x45, 0xE6, 0x74, 0x39, 0x53, 0x79, 0xFB, 0x17, 0x72, 0x9C, 0x78, 0xCB, 0x93, 0x9E, 0x6F, 0x74, 0xC5, 0xDF, 0xFB, 0x9C, 0x96, 0x1F, 0x49, 0x59, 0x82, 0xC3, 0xED, 0x1F, 0xE3 }, ++ { 0x55, 0xB7, 0x0A, 0x82, 0x13, 0x1E, 0xC9, 0x48, 0x88, 0xD7, 0xAB, 0x54, 0xA7, 0xC5, 0x15, 0x25, 0x5C, 0x39, 0x38, 0xBB, 0x10, 0xBC, 0x78, 0x4D, 0xC9, 0xB6, 0x7F, 0x07, 0x6E, 0x34, 0x1A, 0x73 }, ++ { 0x6A, 0xB9, 0x05, 0x7B, 0x97, 0x7E, 0xBC, 0x3C, 0xA4, 0xD4, 0xCE, 0x74, 0x50, 0x6C, 0x25, 0xCC, 0xCD, 0xC5, 0x66, 0x49, 0x7C, 0x45, 0x0B, 0x54, 0x15, 0xA3, 0x94, 0x86, 0xF8, 0x65, 0x7A, 0x03 }, ++ { 0x24, 0x06, 0x6D, 0xEE, 0xE0, 0xEC, 0xEE, 0x15, 0xA4, 0x5F, 0x0A, 0x32, 0x6D, 0x0F, 0x8D, 0xBC, 0x79, 0x76, 0x1E, 0xBB, 0x93, 0xCF, 0x8C, 0x03, 0x77, 0xAF, 0x44, 0x09, 0x78, 0xFC, 0xF9, 0x94 }, ++ { 0x20, 0x00, 0x0D, 0x3F, 0x66, 0xBA, 0x76, 0x86, 0x0D, 0x5A, 0x95, 0x06, 0x88, 0xB9, 0xAA, 0x0D, 0x76, 0xCF, 0xEA, 0x59, 0xB0, 0x05, 0xD8, 0x59, 0x91, 0x4B, 0x1A, 0x46, 0x65, 0x3A, 0x93, 0x9B }, ++ { 0xB9, 0x2D, 0xAA, 0x79, 0x60, 0x3E, 0x3B, 0xDB, 0xC3, 0xBF, 0xE0, 0xF4, 0x19, 0xE4, 0x09, 0xB2, 0xEA, 0x10, 0xDC, 0x43, 0x5B, 0xEE, 0xFE, 0x29, 0x59, 0xDA, 0x16, 0x89, 0x5D, 0x5D, 0xCA, 0x1C }, ++ { 0xE9, 0x47, 0x94, 0x87, 0x05, 0xB2, 0x06, 0xD5, 0x72, 0xB0, 0xE8, 0xF6, 0x2F, 0x66, 0xA6, 0x55, 0x1C, 0xBD, 0x6B, 0xC3, 0x05, 0xD2, 0x6C, 0xE7, 0x53, 0x9A, 0x12, 0xF9, 0xAA, 0xDF, 0x75, 0x71 }, ++ { 0x3D, 0x67, 0xC1, 0xB3, 0xF9, 0xB2, 0x39, 0x10, 0xE3, 0xD3, 0x5E, 0x6B, 0x0F, 0x2C, 0xCF, 0x44, 0xA0, 0xB5, 0x40, 0xA4, 0x5C, 0x18, 0xBA, 0x3C, 0x36, 0x26, 0x4D, 0xD4, 0x8E, 0x96, 0xAF, 0x6A }, ++ { 0xC7, 0x55, 0x8B, 0xAB, 0xDA, 0x04, 0xBC, 0xCB, 0x76, 0x4D, 0x0B, 0xBF, 0x33, 0x58, 0x42, 0x51, 0x41, 0x90, 0x2D, 0x22, 0x39, 0x1D, 0x9F, 0x8C, 0x59, 0x15, 0x9F, 0xEC, 0x9E, 0x49, 0xB1, 0x51 }, ++ { 0x0B, 0x73, 0x2B, 0xB0, 0x35, 0x67, 0x5A, 0x50, 0xFF, 0x58, 0xF2, 0xC2, 0x42, 0xE4, 0x71, 0x0A, 0xEC, 0xE6, 0x46, 0x70, 0x07, 0x9C, 0x13, 0x04, 0x4C, 0x79, 0xC9, 0xB7, 0x49, 0x1F, 0x70, 0x00 }, ++ { 0xD1, 0x20, 0xB5, 0xEF, 0x6D, 0x57, 0xEB, 0xF0, 0x6E, 0xAF, 0x96, 0xBC, 0x93, 0x3C, 0x96, 0x7B, 0x16, 0xCB, 0xE6, 0xE2, 0xBF, 0x00, 0x74, 0x1C, 0x30, 0xAA, 0x1C, 0x54, 0xBA, 0x64, 0x80, 0x1F }, ++ { 0x58, 0xD2, 0x12, 0xAD, 0x6F, 0x58, 0xAE, 0xF0, 0xF8, 0x01, 0x16, 0xB4, 0x41, 0xE5, 0x7F, 0x61, 0x95, 0xBF, 0xEF, 0x26, 0xB6, 0x14, 0x63, 0xED, 0xEC, 0x11, 0x83, 0xCD, 0xB0, 0x4F, 0xE7, 0x6D }, ++ { 0xB8, 0x83, 0x6F, 0x51, 0xD1, 0xE2, 0x9B, 0xDF, 0xDB, 0xA3, 0x25, 0x56, 0x53, 0x60, 0x26, 0x8B, 0x8F, 0xAD, 0x62, 0x74, 0x73, 0xED, 0xEC, 0xEF, 0x7E, 0xAE, 0xFE, 0xE8, 0x37, 0xC7, 0x40, 0x03 }, ++ { 0xC5, 0x47, 0xA3, 0xC1, 0x24, 0xAE, 0x56, 0x85, 0xFF, 0xA7, 0xB8, 0xED, 0xAF, 0x96, 0xEC, 0x86, 0xF8, 0xB2, 0xD0, 0xD5, 0x0C, 0xEE, 0x8B, 0xE3, 0xB1, 0xF0, 0xC7, 0x67, 0x63, 0x06, 0x9D, 0x9C }, ++ { 0x5D, 0x16, 0x8B, 0x76, 0x9A, 0x2F, 0x67, 0x85, 0x3D, 0x62, 0x95, 0xF7, 0x56, 0x8B, 0xE4, 0x0B, 0xB7, 0xA1, 0x6B, 0x8D, 0x65, 0xBA, 0x87, 0x63, 0x5D, 0x19, 0x78, 0xD2, 0xAB, 0x11, 0xBA, 0x2A }, ++ { 0xA2, 0xF6, 0x75, 0xDC, 0x73, 0x02, 0x63, 0x8C, 0xB6, 0x02, 0x01, 0x06, 0x4C, 0xA5, 0x50, 0x77, 0x71, 0x4D, 0x71, 0xFE, 0x09, 0x6A, 0x31, 0x5F, 0x2F, 0xE7, 0x40, 0x12, 0x77, 0xCA, 0xA5, 0xAF }, ++ { 0xC8, 0xAA, 0xB5, 0xCD, 0x01, 0x60, 0xAE, 0x78, 0xCD, 0x2E, 0x8A, 0xC5, 0xFB, 0x0E, 0x09, 0x3C, 0xDB, 0x5C, 0x4B, 0x60, 0x52, 0xA0, 0xA9, 0x7B, 0xB0, 0x42, 0x16, 0x82, 0x6F, 0xA7, 0xA4, 0x37 }, ++ { 0xFF, 0x68, 0xCA, 0x40, 0x35, 0xBF, 0xEB, 0x43, 0xFB, 0xF1, 0x45, 0xFD, 0xDD, 0x5E, 0x43, 0xF1, 0xCE, 0xA5, 0x4F, 0x11, 0xF7, 0xBE, 0xE1, 0x30, 0x58, 0xF0, 0x27, 0x32, 0x9A, 0x4A, 0x5F, 0xA4 }, ++ { 0x1D, 0x4E, 0x54, 0x87, 0xAE, 0x3C, 0x74, 0x0F, 0x2B, 0xA6, 0xE5, 0x41, 0xAC, 0x91, 0xBC, 0x2B, 0xFC, 0xD2, 0x99, 0x9C, 0x51, 0x8D, 0x80, 0x7B, 0x42, 0x67, 0x48, 0x80, 0x3A, 0x35, 0x0F, 0xD4 }, ++ { 0x6D, 0x24, 0x4E, 0x1A, 0x06, 0xCE, 0x4E, 0xF5, 0x78, 0xDD, 0x0F, 0x63, 0xAF, 0xF0, 0x93, 0x67, 0x06, 0x73, 0x51, 0x19, 0xCA, 0x9C, 0x8D, 0x22, 0xD8, 0x6C, 0x80, 0x14, 0x14, 0xAB, 0x97, 0x41 }, ++ { 0xDE, 0xCF, 0x73, 0x29, 0xDB, 0xCC, 0x82, 0x7B, 0x8F, 0xC5, 0x24, 0xC9, 0x43, 0x1E, 0x89, 0x98, 0x02, 0x9E, 0xCE, 0x12, 0xCE, 0x93, 0xB7, 0xB2, 0xF3, 0xE7, 0x69, 0xA9, 0x41, 0xFB, 0x8C, 0xEA }, ++ { 0x2F, 0xAF, 0xCC, 0x0F, 0x2E, 0x63, 0xCB, 0xD0, 0x77, 0x55, 0xBE, 0x7B, 0x75, 0xEC, 0xEA, 0x0A, 0xDF, 0xF9, 0xAA, 0x5E, 0xDE, 0x2A, 0x52, 0xFD, 0xAB, 0x4D, 0xFD, 0x03, 0x74, 0xCD, 0x48, 0x3F }, ++ { 0xAA, 0x85, 0x01, 0x0D, 0xD4, 0x6A, 0x54, 0x6B, 0x53, 0x5E, 0xF4, 0xCF, 0x5F, 0x07, 0xD6, 0x51, 0x61, 0xE8, 0x98, 0x28, 0xF3, 0xA7, 0x7D, 0xB7, 0xB9, 0xB5, 0x6F, 0x0D, 0xF5, 0x9A, 0xAE, 0x45 }, ++ { 0x07, 0xE8, 0xE1, 0xEE, 0x73, 0x2C, 0xB0, 0xD3, 0x56, 0xC9, 0xC0, 0xD1, 0x06, 0x9C, 0x89, 0xD1, 0x7A, 0xDF, 0x6A, 0x9A, 0x33, 0x4F, 0x74, 0x5E, 0xC7, 0x86, 0x73, 0x32, 0x54, 0x8C, 0xA8, 0xE9 }, ++ { 0x0E, 0x01, 0xE8, 0x1C, 0xAD, 0xA8, 0x16, 0x2B, 0xFD, 0x5F, 0x8A, 0x8C, 0x81, 0x8A, 0x6C, 0x69, 0xFE, 0xDF, 0x02, 0xCE, 0xB5, 0x20, 0x85, 0x23, 0xCB, 0xE5, 0x31, 0x3B, 0x89, 0xCA, 0x10, 0x53 }, ++ { 0x6B, 0xB6, 0xC6, 0x47, 0x26, 0x55, 0x08, 0x43, 0x99, 0x85, 0x2E, 0x00, 0x24, 0x9F, 0x8C, 0xB2, 0x47, 0x89, 0x6D, 0x39, 0x2B, 0x02, 0xD7, 0x3B, 0x7F, 0x0D, 0xD8, 0x18, 0xE1, 0xE2, 0x9B, 0x07 }, ++ { 0x42, 0xD4, 0x63, 0x6E, 0x20, 0x60, 0xF0, 0x8F, 0x41, 0xC8, 0x82, 0xE7, 0x6B, 0x39, 0x6B, 0x11, 0x2E, 0xF6, 0x27, 0xCC, 0x24, 0xC4, 0x3D, 0xD5, 0xF8, 0x3A, 0x1D, 0x1A, 0x7E, 0xAD, 0x71, 0x1A }, ++ { 0x48, 0x58, 0xC9, 0xA1, 0x88, 0xB0, 0x23, 0x4F, 0xB9, 0xA8, 0xD4, 0x7D, 0x0B, 0x41, 0x33, 0x65, 0x0A, 0x03, 0x0B, 0xD0, 0x61, 0x1B, 0x87, 0xC3, 0x89, 0x2E, 0x94, 0x95, 0x1F, 0x8D, 0xF8, 0x52 }, ++ { 0x3F, 0xAB, 0x3E, 0x36, 0x98, 0x8D, 0x44, 0x5A, 0x51, 0xC8, 0x78, 0x3E, 0x53, 0x1B, 0xE3, 0xA0, 0x2B, 0xE4, 0x0C, 0xD0, 0x47, 0x96, 0xCF, 0xB6, 0x1D, 0x40, 0x34, 0x74, 0x42, 0xD3, 0xF7, 0x94 }, ++ { 0xEB, 0xAB, 0xC4, 0x96, 0x36, 0xBD, 0x43, 0x3D, 0x2E, 0xC8, 0xF0, 0xE5, 0x18, 0x73, 0x2E, 0xF8, 0xFA, 0x21, 0xD4, 0xD0, 0x71, 0xCC, 0x3B, 0xC4, 0x6C, 0xD7, 0x9F, 0xA3, 0x8A, 0x28, 0xB8, 0x10 }, ++ { 0xA1, 0xD0, 0x34, 0x35, 0x23, 0xB8, 0x93, 0xFC, 0xA8, 0x4F, 0x47, 0xFE, 0xB4, 0xA6, 0x4D, 0x35, 0x0A, 0x17, 0xD8, 0xEE, 0xF5, 0x49, 0x7E, 0xCE, 0x69, 0x7D, 0x02, 0xD7, 0x91, 0x78, 0xB5, 0x91 }, ++ { 0x26, 0x2E, 0xBF, 0xD9, 0x13, 0x0B, 0x7D, 0x28, 0x76, 0x0D, 0x08, 0xEF, 0x8B, 0xFD, 0x3B, 0x86, 0xCD, 0xD3, 0xB2, 0x11, 0x3D, 0x2C, 0xAE, 0xF7, 0xEA, 0x95, 0x1A, 0x30, 0x3D, 0xFA, 0x38, 0x46 }, ++ { 0xF7, 0x61, 0x58, 0xED, 0xD5, 0x0A, 0x15, 0x4F, 0xA7, 0x82, 0x03, 0xED, 0x23, 0x62, 0x93, 0x2F, 0xCB, 0x82, 0x53, 0xAA, 0xE3, 0x78, 0x90, 0x3E, 0xDE, 0xD1, 0xE0, 0x3F, 0x70, 0x21, 0xA2, 0x57 }, ++ { 0x26, 0x17, 0x8E, 0x95, 0x0A, 0xC7, 0x22, 0xF6, 0x7A, 0xE5, 0x6E, 0x57, 0x1B, 0x28, 0x4C, 0x02, 0x07, 0x68, 0x4A, 0x63, 0x34, 0xA1, 0x77, 0x48, 0xA9, 0x4D, 0x26, 0x0B, 0xC5, 0xF5, 0x52, 0x74 }, ++ { 0xC3, 0x78, 0xD1, 0xE4, 0x93, 0xB4, 0x0E, 0xF1, 0x1F, 0xE6, 0xA1, 0x5D, 0x9C, 0x27, 0x37, 0xA3, 0x78, 0x09, 0x63, 0x4C, 0x5A, 0xBA, 0xD5, 0xB3, 0x3D, 0x7E, 0x39, 0x3B, 0x4A, 0xE0, 0x5D, 0x03 }, ++ { 0x98, 0x4B, 0xD8, 0x37, 0x91, 0x01, 0xBE, 0x8F, 0xD8, 0x06, 0x12, 0xD8, 0xEA, 0x29, 0x59, 0xA7, 0x86, 0x5E, 0xC9, 0x71, 0x85, 0x23, 0x55, 0x01, 0x07, 0xAE, 0x39, 0x38, 0xDF, 0x32, 0x01, 0x1B }, ++ { 0xC6, 0xF2, 0x5A, 0x81, 0x2A, 0x14, 0x48, 0x58, 0xAC, 0x5C, 0xED, 0x37, 0xA9, 0x3A, 0x9F, 0x47, 0x59, 0xBA, 0x0B, 0x1C, 0x0F, 0xDC, 0x43, 0x1D, 0xCE, 0x35, 0xF9, 0xEC, 0x1F, 0x1F, 0x4A, 0x99 }, ++ { 0x92, 0x4C, 0x75, 0xC9, 0x44, 0x24, 0xFF, 0x75, 0xE7, 0x4B, 0x8B, 0x4E, 0x94, 0x35, 0x89, 0x58, 0xB0, 0x27, 0xB1, 0x71, 0xDF, 0x5E, 0x57, 0x89, 0x9A, 0xD0, 0xD4, 0xDA, 0xC3, 0x73, 0x53, 0xB6 }, ++ { 0x0A, 0xF3, 0x58, 0x92, 0xA6, 0x3F, 0x45, 0x93, 0x1F, 0x68, 0x46, 0xED, 0x19, 0x03, 0x61, 0xCD, 0x07, 0x30, 0x89, 0xE0, 0x77, 0x16, 0x57, 0x14, 0xB5, 0x0B, 0x81, 0xA2, 0xE3, 0xDD, 0x9B, 0xA1 }, ++ { 0xCC, 0x80, 0xCE, 0xFB, 0x26, 0xC3, 0xB2, 0xB0, 0xDA, 0xEF, 0x23, 0x3E, 0x60, 0x6D, 0x5F, 0xFC, 0x80, 0xFA, 0x17, 0x42, 0x7D, 0x18, 0xE3, 0x04, 0x89, 0x67, 0x3E, 0x06, 0xEF, 0x4B, 0x87, 0xF7 }, ++ { 0xC2, 0xF8, 0xC8, 0x11, 0x74, 0x47, 0xF3, 0x97, 0x8B, 0x08, 0x18, 0xDC, 0xF6, 0xF7, 0x01, 0x16, 0xAC, 0x56, 0xFD, 0x18, 0x4D, 0xD1, 0x27, 0x84, 0x94, 0xE1, 0x03, 0xFC, 0x6D, 0x74, 0xA8, 0x87 }, ++ { 0xBD, 0xEC, 0xF6, 0xBF, 0xC1, 0xBA, 0x0D, 0xF6, 0xE8, 0x62, 0xC8, 0x31, 0x99, 0x22, 0x07, 0x79, 0x6A, 0xCC, 0x79, 0x79, 0x68, 0x35, 0x88, 0x28, 0xC0, 0x6E, 0x7A, 0x51, 0xE0, 0x90, 0x09, 0x8F }, ++ { 0x24, 0xD1, 0xA2, 0x6E, 0x3D, 0xAB, 0x02, 0xFE, 0x45, 0x72, 0xD2, 0xAA, 0x7D, 0xBD, 0x3E, 0xC3, 0x0F, 0x06, 0x93, 0xDB, 0x26, 0xF2, 0x73, 0xD0, 0xAB, 0x2C, 0xB0, 0xC1, 0x3B, 0x5E, 0x64, 0x51 }, ++ { 0xEC, 0x56, 0xF5, 0x8B, 0x09, 0x29, 0x9A, 0x30, 0x0B, 0x14, 0x05, 0x65, 0xD7, 0xD3, 0xE6, 0x87, 0x82, 0xB6, 0xE2, 0xFB, 0xEB, 0x4B, 0x7E, 0xA9, 0x7A, 0xC0, 0x57, 0x98, 0x90, 0x61, 0xDD, 0x3F }, ++ { 0x11, 0xA4, 0x37, 0xC1, 0xAB, 0xA3, 0xC1, 0x19, 0xDD, 0xFA, 0xB3, 0x1B, 0x3E, 0x8C, 0x84, 0x1D, 0xEE, 0xEB, 0x91, 0x3E, 0xF5, 0x7F, 0x7E, 0x48, 0xF2, 0xC9, 0xCF, 0x5A, 0x28, 0xFA, 0x42, 0xBC }, ++ { 0x53, 0xC7, 0xE6, 0x11, 0x4B, 0x85, 0x0A, 0x2C, 0xB4, 0x96, 0xC9, 0xB3, 0xC6, 0x9A, 0x62, 0x3E, 0xAE, 0xA2, 0xCB, 0x1D, 0x33, 0xDD, 0x81, 0x7E, 0x47, 0x65, 0xED, 0xAA, 0x68, 0x23, 0xC2, 0x28 }, ++ { 0x15, 0x4C, 0x3E, 0x96, 0xFE, 0xE5, 0xDB, 0x14, 0xF8, 0x77, 0x3E, 0x18, 0xAF, 0x14, 0x85, 0x79, 0x13, 0x50, 0x9D, 0xA9, 0x99, 0xB4, 0x6C, 0xDD, 0x3D, 0x4C, 0x16, 0x97, 0x60, 0xC8, 0x3A, 0xD2 }, ++ { 0x40, 0xB9, 0x91, 0x6F, 0x09, 0x3E, 0x02, 0x7A, 0x87, 0x86, 0x64, 0x18, 0x18, 0x92, 0x06, 0x20, 0x47, 0x2F, 0xBC, 0xF6, 0x8F, 0x70, 0x1D, 0x1B, 0x68, 0x06, 0x32, 0xE6, 0x99, 0x6B, 0xDE, 0xD3 }, ++ { 0x24, 0xC4, 0xCB, 0xBA, 0x07, 0x11, 0x98, 0x31, 0xA7, 0x26, 0xB0, 0x53, 0x05, 0xD9, 0x6D, 0xA0, 0x2F, 0xF8, 0xB1, 0x48, 0xF0, 0xDA, 0x44, 0x0F, 0xE2, 0x33, 0xBC, 0xAA, 0x32, 0xC7, 0x2F, 0x6F }, ++ { 0x5D, 0x20, 0x15, 0x10, 0x25, 0x00, 0x20, 0xB7, 0x83, 0x68, 0x96, 0x88, 0xAB, 0xBF, 0x8E, 0xCF, 0x25, 0x94, 0xA9, 0x6A, 0x08, 0xF2, 0xBF, 0xEC, 0x6C, 0xE0, 0x57, 0x44, 0x65, 0xDD, 0xED, 0x71 }, ++ { 0x04, 0x3B, 0x97, 0xE3, 0x36, 0xEE, 0x6F, 0xDB, 0xBE, 0x2B, 0x50, 0xF2, 0x2A, 0xF8, 0x32, 0x75, 0xA4, 0x08, 0x48, 0x05, 0xD2, 0xD5, 0x64, 0x59, 0x62, 0x45, 0x4B, 0x6C, 0x9B, 0x80, 0x53, 0xA0 }, ++ { 0x56, 0x48, 0x35, 0xCB, 0xAE, 0xA7, 0x74, 0x94, 0x85, 0x68, 0xBE, 0x36, 0xCF, 0x52, 0xFC, 0xDD, 0x83, 0x93, 0x4E, 0xB0, 0xA2, 0x75, 0x12, 0xDB, 0xE3, 0xE2, 0xDB, 0x47, 0xB9, 0xE6, 0x63, 0x5A }, ++ { 0xF2, 0x1C, 0x33, 0xF4, 0x7B, 0xDE, 0x40, 0xA2, 0xA1, 0x01, 0xC9, 0xCD, 0xE8, 0x02, 0x7A, 0xAF, 0x61, 0xA3, 0x13, 0x7D, 0xE2, 0x42, 0x2B, 0x30, 0x03, 0x5A, 0x04, 0xC2, 0x70, 0x89, 0x41, 0x83 }, ++ { 0x9D, 0xB0, 0xEF, 0x74, 0xE6, 0x6C, 0xBB, 0x84, 0x2E, 0xB0, 0xE0, 0x73, 0x43, 0xA0, 0x3C, 0x5C, 0x56, 0x7E, 0x37, 0x2B, 0x3F, 0x23, 0xB9, 0x43, 0xC7, 0x88, 0xA4, 0xF2, 0x50, 0xF6, 0x78, 0x91 }, ++ { 0xAB, 0x8D, 0x08, 0x65, 0x5F, 0xF1, 0xD3, 0xFE, 0x87, 0x58, 0xD5, 0x62, 0x23, 0x5F, 0xD2, 0x3E, 0x7C, 0xF9, 0xDC, 0xAA, 0xD6, 0x58, 0x87, 0x2A, 0x49, 0xE5, 0xD3, 0x18, 0x3B, 0x6C, 0xCE, 0xBD }, ++ { 0x6F, 0x27, 0xF7, 0x7E, 0x7B, 0xCF, 0x46, 0xA1, 0xE9, 0x63, 0xAD, 0xE0, 0x30, 0x97, 0x33, 0x54, 0x30, 0x31, 0xDC, 0xCD, 0xD4, 0x7C, 0xAA, 0xC1, 0x74, 0xD7, 0xD2, 0x7C, 0xE8, 0x07, 0x7E, 0x8B }, ++ { 0xE3, 0xCD, 0x54, 0xDA, 0x7E, 0x44, 0x4C, 0xAA, 0x62, 0x07, 0x56, 0x95, 0x25, 0xA6, 0x70, 0xEB, 0xAE, 0x12, 0x78, 0xDE, 0x4E, 0x3F, 0xE2, 0x68, 0x4B, 0x3E, 0x33, 0xF5, 0xEF, 0x90, 0xCC, 0x1B }, ++ { 0xB2, 0xC3, 0xE3, 0x3A, 0x51, 0xD2, 0x2C, 0x4C, 0x08, 0xFC, 0x09, 0x89, 0xC8, 0x73, 0xC9, 0xCC, 0x41, 0x50, 0x57, 0x9B, 0x1E, 0x61, 0x63, 0xFA, 0x69, 0x4A, 0xD5, 0x1D, 0x53, 0xD7, 0x12, 0xDC }, ++ { 0xBE, 0x7F, 0xDA, 0x98, 0x3E, 0x13, 0x18, 0x9B, 0x4C, 0x77, 0xE0, 0xA8, 0x09, 0x20, 0xB6, 0xE0, 0xE0, 0xEA, 0x80, 0xC3, 0xB8, 0x4D, 0xBE, 0x7E, 0x71, 0x17, 0xD2, 0x53, 0xF4, 0x81, 0x12, 0xF4 }, ++ { 0xB6, 0x00, 0x8C, 0x28, 0xFA, 0xE0, 0x8A, 0xA4, 0x27, 0xE5, 0xBD, 0x3A, 0xAD, 0x36, 0xF1, 0x00, 0x21, 0xF1, 0x6C, 0x77, 0xCF, 0xEA, 0xBE, 0xD0, 0x7F, 0x97, 0xCC, 0x7D, 0xC1, 0xF1, 0x28, 0x4A }, ++ { 0x6E, 0x4E, 0x67, 0x60, 0xC5, 0x38, 0xF2, 0xE9, 0x7B, 0x3A, 0xDB, 0xFB, 0xBC, 0xDE, 0x57, 0xF8, 0x96, 0x6B, 0x7E, 0xA8, 0xFC, 0xB5, 0xBF, 0x7E, 0xFE, 0xC9, 0x13, 0xFD, 0x2A, 0x2B, 0x0C, 0x55 }, ++ { 0x4A, 0xE5, 0x1F, 0xD1, 0x83, 0x4A, 0xA5, 0xBD, 0x9A, 0x6F, 0x7E, 0xC3, 0x9F, 0xC6, 0x63, 0x33, 0x8D, 0xC5, 0xD2, 0xE2, 0x07, 0x61, 0x56, 0x6D, 0x90, 0xCC, 0x68, 0xB1, 0xCB, 0x87, 0x5E, 0xD8 }, ++ { 0xB6, 0x73, 0xAA, 0xD7, 0x5A, 0xB1, 0xFD, 0xB5, 0x40, 0x1A, 0xBF, 0xA1, 0xBF, 0x89, 0xF3, 0xAD, 0xD2, 0xEB, 0xC4, 0x68, 0xDF, 0x36, 0x24, 0xA4, 0x78, 0xF4, 0xFE, 0x85, 0x9D, 0x8D, 0x55, 0xE2 }, ++ { 0x13, 0xC9, 0x47, 0x1A, 0x98, 0x55, 0x91, 0x35, 0x39, 0x83, 0x66, 0x60, 0x39, 0x8D, 0xA0, 0xF3, 0xF9, 0x9A, 0xDA, 0x08, 0x47, 0x9C, 0x69, 0xD1, 0xB7, 0xFC, 0xAA, 0x34, 0x61, 0xDD, 0x7E, 0x59 }, ++ { 0x2C, 0x11, 0xF4, 0xA7, 0xF9, 0x9A, 0x1D, 0x23, 0xA5, 0x8B, 0xB6, 0x36, 0x35, 0x0F, 0xE8, 0x49, 0xF2, 0x9C, 0xBA, 0xC1, 0xB2, 0xA1, 0x11, 0x2D, 0x9F, 0x1E, 0xD5, 0xBC, 0x5B, 0x31, 0x3C, 0xCD }, ++ { 0xC7, 0xD3, 0xC0, 0x70, 0x6B, 0x11, 0xAE, 0x74, 0x1C, 0x05, 0xA1, 0xEF, 0x15, 0x0D, 0xD6, 0x5B, 0x54, 0x94, 0xD6, 0xD5, 0x4C, 0x9A, 0x86, 0xE2, 0x61, 0x78, 0x54, 0xE6, 0xAE, 0xEE, 0xBB, 0xD9 }, ++ { 0x19, 0x4E, 0x10, 0xC9, 0x38, 0x93, 0xAF, 0xA0, 0x64, 0xC3, 0xAC, 0x04, 0xC0, 0xDD, 0x80, 0x8D, 0x79, 0x1C, 0x3D, 0x4B, 0x75, 0x56, 0xE8, 0x9D, 0x8D, 0x9C, 0xB2, 0x25, 0xC4, 0xB3, 0x33, 0x39 }, ++ { 0x6F, 0xC4, 0x98, 0x8B, 0x8F, 0x78, 0x54, 0x6B, 0x16, 0x88, 0x99, 0x18, 0x45, 0x90, 0x8F, 0x13, 0x4B, 0x6A, 0x48, 0x2E, 0x69, 0x94, 0xB3, 0xD4, 0x83, 0x17, 0xBF, 0x08, 0xDB, 0x29, 0x21, 0x85 }, ++ { 0x56, 0x65, 0xBE, 0xB8, 0xB0, 0x95, 0x55, 0x25, 0x81, 0x3B, 0x59, 0x81, 0xCD, 0x14, 0x2E, 0xD4, 0xD0, 0x3F, 0xBA, 0x38, 0xA6, 0xF3, 0xE5, 0xAD, 0x26, 0x8E, 0x0C, 0xC2, 0x70, 0xD1, 0xCD, 0x11 }, ++ { 0xB8, 0x83, 0xD6, 0x8F, 0x5F, 0xE5, 0x19, 0x36, 0x43, 0x1B, 0xA4, 0x25, 0x67, 0x38, 0x05, 0x3B, 0x1D, 0x04, 0x26, 0xD4, 0xCB, 0x64, 0xB1, 0x6E, 0x83, 0xBA, 0xDC, 0x5E, 0x9F, 0xBE, 0x3B, 0x81 }, ++ { 0x53, 0xE7, 0xB2, 0x7E, 0xA5, 0x9C, 0x2F, 0x6D, 0xBB, 0x50, 0x76, 0x9E, 0x43, 0x55, 0x4D, 0xF3, 0x5A, 0xF8, 0x9F, 0x48, 0x22, 0xD0, 0x46, 0x6B, 0x00, 0x7D, 0xD6, 0xF6, 0xDE, 0xAF, 0xFF, 0x02 }, ++ { 0x1F, 0x1A, 0x02, 0x29, 0xD4, 0x64, 0x0F, 0x01, 0x90, 0x15, 0x88, 0xD9, 0xDE, 0xC2, 0x2D, 0x13, 0xFC, 0x3E, 0xB3, 0x4A, 0x61, 0xB3, 0x29, 0x38, 0xEF, 0xBF, 0x53, 0x34, 0xB2, 0x80, 0x0A, 0xFA }, ++ { 0xC2, 0xB4, 0x05, 0xAF, 0xA0, 0xFA, 0x66, 0x68, 0x85, 0x2A, 0xEE, 0x4D, 0x88, 0x04, 0x08, 0x53, 0xFA, 0xB8, 0x00, 0xE7, 0x2B, 0x57, 0x58, 0x14, 0x18, 0xE5, 0x50, 0x6F, 0x21, 0x4C, 0x7D, 0x1F }, ++ { 0xC0, 0x8A, 0xA1, 0xC2, 0x86, 0xD7, 0x09, 0xFD, 0xC7, 0x47, 0x37, 0x44, 0x97, 0x71, 0x88, 0xC8, 0x95, 0xBA, 0x01, 0x10, 0x14, 0x24, 0x7E, 0x4E, 0xFA, 0x8D, 0x07, 0xE7, 0x8F, 0xEC, 0x69, 0x5C }, ++ { 0xF0, 0x3F, 0x57, 0x89, 0xD3, 0x33, 0x6B, 0x80, 0xD0, 0x02, 0xD5, 0x9F, 0xDF, 0x91, 0x8B, 0xDB, 0x77, 0x5B, 0x00, 0x95, 0x6E, 0xD5, 0x52, 0x8E, 0x86, 0xAA, 0x99, 0x4A, 0xCB, 0x38, 0xFE, 0x2D } ++}; ++ ++static const u8 blake2s_keyed_testvecs[][BLAKE2S_OUTBYTES] __initconst = { ++ { 0x48, 0xA8, 0x99, 0x7D, 0xA4, 0x07, 0x87, 0x6B, 0x3D, 0x79, 0xC0, 0xD9, 0x23, 0x25, 0xAD, 0x3B, 0x89, 0xCB, 0xB7, 0x54, 0xD8, 0x6A, 0xB7, 0x1A, 0xEE, 0x04, 0x7A, 0xD3, 0x45, 0xFD, 0x2C, 0x49 }, ++ { 0x40, 0xD1, 0x5F, 0xEE, 0x7C, 0x32, 0x88, 0x30, 0x16, 0x6A, 0xC3, 0xF9, 0x18, 0x65, 0x0F, 0x80, 0x7E, 0x7E, 0x01, 0xE1, 0x77, 0x25, 0x8C, 0xDC, 0x0A, 0x39, 0xB1, 0x1F, 0x59, 0x80, 0x66, 0xF1 }, ++ { 0x6B, 0xB7, 0x13, 0x00, 0x64, 0x4C, 0xD3, 0x99, 0x1B, 0x26, 0xCC, 0xD4, 0xD2, 0x74, 0xAC, 0xD1, 0xAD, 0xEA, 0xB8, 0xB1, 0xD7, 0x91, 0x45, 0x46, 0xC1, 0x19, 0x8B, 0xBE, 0x9F, 0xC9, 0xD8, 0x03 }, ++ { 0x1D, 0x22, 0x0D, 0xBE, 0x2E, 0xE1, 0x34, 0x66, 0x1F, 0xDF, 0x6D, 0x9E, 0x74, 0xB4, 0x17, 0x04, 0x71, 0x05, 0x56, 0xF2, 0xF6, 0xE5, 0xA0, 0x91, 0xB2, 0x27, 0x69, 0x74, 0x45, 0xDB, 0xEA, 0x6B }, ++ { 0xF6, 0xC3, 0xFB, 0xAD, 0xB4, 0xCC, 0x68, 0x7A, 0x00, 0x64, 0xA5, 0xBE, 0x6E, 0x79, 0x1B, 0xEC, 0x63, 0xB8, 0x68, 0xAD, 0x62, 0xFB, 0xA6, 0x1B, 0x37, 0x57, 0xEF, 0x9C, 0xA5, 0x2E, 0x05, 0xB2 }, ++ { 0x49, 0xC1, 0xF2, 0x11, 0x88, 0xDF, 0xD7, 0x69, 0xAE, 0xA0, 0xE9, 0x11, 0xDD, 0x6B, 0x41, 0xF1, 0x4D, 0xAB, 0x10, 0x9D, 0x2B, 0x85, 0x97, 0x7A, 0xA3, 0x08, 0x8B, 0x5C, 0x70, 0x7E, 0x85, 0x98 }, ++ { 0xFD, 0xD8, 0x99, 0x3D, 0xCD, 0x43, 0xF6, 0x96, 0xD4, 0x4F, 0x3C, 0xEA, 0x0F, 0xF3, 0x53, 0x45, 0x23, 0x4E, 0xC8, 0xEE, 0x08, 0x3E, 0xB3, 0xCA, 0xDA, 0x01, 0x7C, 0x7F, 0x78, 0xC1, 0x71, 0x43 }, ++ { 0xE6, 0xC8, 0x12, 0x56, 0x37, 0x43, 0x8D, 0x09, 0x05, 0xB7, 0x49, 0xF4, 0x65, 0x60, 0xAC, 0x89, 0xFD, 0x47, 0x1C, 0xF8, 0x69, 0x2E, 0x28, 0xFA, 0xB9, 0x82, 0xF7, 0x3F, 0x01, 0x9B, 0x83, 0xA9 }, ++ { 0x19, 0xFC, 0x8C, 0xA6, 0x97, 0x9D, 0x60, 0xE6, 0xED, 0xD3, 0xB4, 0x54, 0x1E, 0x2F, 0x96, 0x7C, 0xED, 0x74, 0x0D, 0xF6, 0xEC, 0x1E, 0xAE, 0xBB, 0xFE, 0x81, 0x38, 0x32, 0xE9, 0x6B, 0x29, 0x74 }, ++ { 0xA6, 0xAD, 0x77, 0x7C, 0xE8, 0x81, 0xB5, 0x2B, 0xB5, 0xA4, 0x42, 0x1A, 0xB6, 0xCD, 0xD2, 0xDF, 0xBA, 0x13, 0xE9, 0x63, 0x65, 0x2D, 0x4D, 0x6D, 0x12, 0x2A, 0xEE, 0x46, 0x54, 0x8C, 0x14, 0xA7 }, ++ { 0xF5, 0xC4, 0xB2, 0xBA, 0x1A, 0x00, 0x78, 0x1B, 0x13, 0xAB, 0xA0, 0x42, 0x52, 0x42, 0xC6, 0x9C, 0xB1, 0x55, 0x2F, 0x3F, 0x71, 0xA9, 0xA3, 0xBB, 0x22, 0xB4, 0xA6, 0xB4, 0x27, 0x7B, 0x46, 0xDD }, ++ { 0xE3, 0x3C, 0x4C, 0x9B, 0xD0, 0xCC, 0x7E, 0x45, 0xC8, 0x0E, 0x65, 0xC7, 0x7F, 0xA5, 0x99, 0x7F, 0xEC, 0x70, 0x02, 0x73, 0x85, 0x41, 0x50, 0x9E, 0x68, 0xA9, 0x42, 0x38, 0x91, 0xE8, 0x22, 0xA3 }, ++ { 0xFB, 0xA1, 0x61, 0x69, 0xB2, 0xC3, 0xEE, 0x10, 0x5B, 0xE6, 0xE1, 0xE6, 0x50, 0xE5, 0xCB, 0xF4, 0x07, 0x46, 0xB6, 0x75, 0x3D, 0x03, 0x6A, 0xB5, 0x51, 0x79, 0x01, 0x4A, 0xD7, 0xEF, 0x66, 0x51 }, ++ { 0xF5, 0xC4, 0xBE, 0xC6, 0xD6, 0x2F, 0xC6, 0x08, 0xBF, 0x41, 0xCC, 0x11, 0x5F, 0x16, 0xD6, 0x1C, 0x7E, 0xFD, 0x3F, 0xF6, 0xC6, 0x56, 0x92, 0xBB, 0xE0, 0xAF, 0xFF, 0xB1, 0xFE, 0xDE, 0x74, 0x75 }, ++ { 0xA4, 0x86, 0x2E, 0x76, 0xDB, 0x84, 0x7F, 0x05, 0xBA, 0x17, 0xED, 0xE5, 0xDA, 0x4E, 0x7F, 0x91, 0xB5, 0x92, 0x5C, 0xF1, 0xAD, 0x4B, 0xA1, 0x27, 0x32, 0xC3, 0x99, 0x57, 0x42, 0xA5, 0xCD, 0x6E }, ++ { 0x65, 0xF4, 0xB8, 0x60, 0xCD, 0x15, 0xB3, 0x8E, 0xF8, 0x14, 0xA1, 0xA8, 0x04, 0x31, 0x4A, 0x55, 0xBE, 0x95, 0x3C, 0xAA, 0x65, 0xFD, 0x75, 0x8A, 0xD9, 0x89, 0xFF, 0x34, 0xA4, 0x1C, 0x1E, 0xEA }, ++ { 0x19, 0xBA, 0x23, 0x4F, 0x0A, 0x4F, 0x38, 0x63, 0x7D, 0x18, 0x39, 0xF9, 0xD9, 0xF7, 0x6A, 0xD9, 0x1C, 0x85, 0x22, 0x30, 0x71, 0x43, 0xC9, 0x7D, 0x5F, 0x93, 0xF6, 0x92, 0x74, 0xCE, 0xC9, 0xA7 }, ++ { 0x1A, 0x67, 0x18, 0x6C, 0xA4, 0xA5, 0xCB, 0x8E, 0x65, 0xFC, 0xA0, 0xE2, 0xEC, 0xBC, 0x5D, 0xDC, 0x14, 0xAE, 0x38, 0x1B, 0xB8, 0xBF, 0xFE, 0xB9, 0xE0, 0xA1, 0x03, 0x44, 0x9E, 0x3E, 0xF0, 0x3C }, ++ { 0xAF, 0xBE, 0xA3, 0x17, 0xB5, 0xA2, 0xE8, 0x9C, 0x0B, 0xD9, 0x0C, 0xCF, 0x5D, 0x7F, 0xD0, 0xED, 0x57, 0xFE, 0x58, 0x5E, 0x4B, 0xE3, 0x27, 0x1B, 0x0A, 0x6B, 0xF0, 0xF5, 0x78, 0x6B, 0x0F, 0x26 }, ++ { 0xF1, 0xB0, 0x15, 0x58, 0xCE, 0x54, 0x12, 0x62, 0xF5, 0xEC, 0x34, 0x29, 0x9D, 0x6F, 0xB4, 0x09, 0x00, 0x09, 0xE3, 0x43, 0x4B, 0xE2, 0xF4, 0x91, 0x05, 0xCF, 0x46, 0xAF, 0x4D, 0x2D, 0x41, 0x24 }, ++ { 0x13, 0xA0, 0xA0, 0xC8, 0x63, 0x35, 0x63, 0x5E, 0xAA, 0x74, 0xCA, 0x2D, 0x5D, 0x48, 0x8C, 0x79, 0x7B, 0xBB, 0x4F, 0x47, 0xDC, 0x07, 0x10, 0x50, 0x15, 0xED, 0x6A, 0x1F, 0x33, 0x09, 0xEF, 0xCE }, ++ { 0x15, 0x80, 0xAF, 0xEE, 0xBE, 0xBB, 0x34, 0x6F, 0x94, 0xD5, 0x9F, 0xE6, 0x2D, 0xA0, 0xB7, 0x92, 0x37, 0xEA, 0xD7, 0xB1, 0x49, 0x1F, 0x56, 0x67, 0xA9, 0x0E, 0x45, 0xED, 0xF6, 0xCA, 0x8B, 0x03 }, ++ { 0x20, 0xBE, 0x1A, 0x87, 0x5B, 0x38, 0xC5, 0x73, 0xDD, 0x7F, 0xAA, 0xA0, 0xDE, 0x48, 0x9D, 0x65, 0x5C, 0x11, 0xEF, 0xB6, 0xA5, 0x52, 0x69, 0x8E, 0x07, 0xA2, 0xD3, 0x31, 0xB5, 0xF6, 0x55, 0xC3 }, ++ { 0xBE, 0x1F, 0xE3, 0xC4, 0xC0, 0x40, 0x18, 0xC5, 0x4C, 0x4A, 0x0F, 0x6B, 0x9A, 0x2E, 0xD3, 0xC5, 0x3A, 0xBE, 0x3A, 0x9F, 0x76, 0xB4, 0xD2, 0x6D, 0xE5, 0x6F, 0xC9, 0xAE, 0x95, 0x05, 0x9A, 0x99 }, ++ { 0xE3, 0xE3, 0xAC, 0xE5, 0x37, 0xEB, 0x3E, 0xDD, 0x84, 0x63, 0xD9, 0xAD, 0x35, 0x82, 0xE1, 0x3C, 0xF8, 0x65, 0x33, 0xFF, 0xDE, 0x43, 0xD6, 0x68, 0xDD, 0x2E, 0x93, 0xBB, 0xDB, 0xD7, 0x19, 0x5A }, ++ { 0x11, 0x0C, 0x50, 0xC0, 0xBF, 0x2C, 0x6E, 0x7A, 0xEB, 0x7E, 0x43, 0x5D, 0x92, 0xD1, 0x32, 0xAB, 0x66, 0x55, 0x16, 0x8E, 0x78, 0xA2, 0xDE, 0xCD, 0xEC, 0x33, 0x30, 0x77, 0x76, 0x84, 0xD9, 0xC1 }, ++ { 0xE9, 0xBA, 0x8F, 0x50, 0x5C, 0x9C, 0x80, 0xC0, 0x86, 0x66, 0xA7, 0x01, 0xF3, 0x36, 0x7E, 0x6C, 0xC6, 0x65, 0xF3, 0x4B, 0x22, 0xE7, 0x3C, 0x3C, 0x04, 0x17, 0xEB, 0x1C, 0x22, 0x06, 0x08, 0x2F }, ++ { 0x26, 0xCD, 0x66, 0xFC, 0xA0, 0x23, 0x79, 0xC7, 0x6D, 0xF1, 0x23, 0x17, 0x05, 0x2B, 0xCA, 0xFD, 0x6C, 0xD8, 0xC3, 0xA7, 0xB8, 0x90, 0xD8, 0x05, 0xF3, 0x6C, 0x49, 0x98, 0x97, 0x82, 0x43, 0x3A }, ++ { 0x21, 0x3F, 0x35, 0x96, 0xD6, 0xE3, 0xA5, 0xD0, 0xE9, 0x93, 0x2C, 0xD2, 0x15, 0x91, 0x46, 0x01, 0x5E, 0x2A, 0xBC, 0x94, 0x9F, 0x47, 0x29, 0xEE, 0x26, 0x32, 0xFE, 0x1E, 0xDB, 0x78, 0xD3, 0x37 }, ++ { 0x10, 0x15, 0xD7, 0x01, 0x08, 0xE0, 0x3B, 0xE1, 0xC7, 0x02, 0xFE, 0x97, 0x25, 0x36, 0x07, 0xD1, 0x4A, 0xEE, 0x59, 0x1F, 0x24, 0x13, 0xEA, 0x67, 0x87, 0x42, 0x7B, 0x64, 0x59, 0xFF, 0x21, 0x9A }, ++ { 0x3C, 0xA9, 0x89, 0xDE, 0x10, 0xCF, 0xE6, 0x09, 0x90, 0x94, 0x72, 0xC8, 0xD3, 0x56, 0x10, 0x80, 0x5B, 0x2F, 0x97, 0x77, 0x34, 0xCF, 0x65, 0x2C, 0xC6, 0x4B, 0x3B, 0xFC, 0x88, 0x2D, 0x5D, 0x89 }, ++ { 0xB6, 0x15, 0x6F, 0x72, 0xD3, 0x80, 0xEE, 0x9E, 0xA6, 0xAC, 0xD1, 0x90, 0x46, 0x4F, 0x23, 0x07, 0xA5, 0xC1, 0x79, 0xEF, 0x01, 0xFD, 0x71, 0xF9, 0x9F, 0x2D, 0x0F, 0x7A, 0x57, 0x36, 0x0A, 0xEA }, ++ { 0xC0, 0x3B, 0xC6, 0x42, 0xB2, 0x09, 0x59, 0xCB, 0xE1, 0x33, 0xA0, 0x30, 0x3E, 0x0C, 0x1A, 0xBF, 0xF3, 0xE3, 0x1E, 0xC8, 0xE1, 0xA3, 0x28, 0xEC, 0x85, 0x65, 0xC3, 0x6D, 0xEC, 0xFF, 0x52, 0x65 }, ++ { 0x2C, 0x3E, 0x08, 0x17, 0x6F, 0x76, 0x0C, 0x62, 0x64, 0xC3, 0xA2, 0xCD, 0x66, 0xFE, 0xC6, 0xC3, 0xD7, 0x8D, 0xE4, 0x3F, 0xC1, 0x92, 0x45, 0x7B, 0x2A, 0x4A, 0x66, 0x0A, 0x1E, 0x0E, 0xB2, 0x2B }, ++ { 0xF7, 0x38, 0xC0, 0x2F, 0x3C, 0x1B, 0x19, 0x0C, 0x51, 0x2B, 0x1A, 0x32, 0xDE, 0xAB, 0xF3, 0x53, 0x72, 0x8E, 0x0E, 0x9A, 0xB0, 0x34, 0x49, 0x0E, 0x3C, 0x34, 0x09, 0x94, 0x6A, 0x97, 0xAE, 0xEC }, ++ { 0x8B, 0x18, 0x80, 0xDF, 0x30, 0x1C, 0xC9, 0x63, 0x41, 0x88, 0x11, 0x08, 0x89, 0x64, 0x83, 0x92, 0x87, 0xFF, 0x7F, 0xE3, 0x1C, 0x49, 0xEA, 0x6E, 0xBD, 0x9E, 0x48, 0xBD, 0xEE, 0xE4, 0x97, 0xC5 }, ++ { 0x1E, 0x75, 0xCB, 0x21, 0xC6, 0x09, 0x89, 0x02, 0x03, 0x75, 0xF1, 0xA7, 0xA2, 0x42, 0x83, 0x9F, 0x0B, 0x0B, 0x68, 0x97, 0x3A, 0x4C, 0x2A, 0x05, 0xCF, 0x75, 0x55, 0xED, 0x5A, 0xAE, 0xC4, 0xC1 }, ++ { 0x62, 0xBF, 0x8A, 0x9C, 0x32, 0xA5, 0xBC, 0xCF, 0x29, 0x0B, 0x6C, 0x47, 0x4D, 0x75, 0xB2, 0xA2, 0xA4, 0x09, 0x3F, 0x1A, 0x9E, 0x27, 0x13, 0x94, 0x33, 0xA8, 0xF2, 0xB3, 0xBC, 0xE7, 0xB8, 0xD7 }, ++ { 0x16, 0x6C, 0x83, 0x50, 0xD3, 0x17, 0x3B, 0x5E, 0x70, 0x2B, 0x78, 0x3D, 0xFD, 0x33, 0xC6, 0x6E, 0xE0, 0x43, 0x27, 0x42, 0xE9, 0xB9, 0x2B, 0x99, 0x7F, 0xD2, 0x3C, 0x60, 0xDC, 0x67, 0x56, 0xCA }, ++ { 0x04, 0x4A, 0x14, 0xD8, 0x22, 0xA9, 0x0C, 0xAC, 0xF2, 0xF5, 0xA1, 0x01, 0x42, 0x8A, 0xDC, 0x8F, 0x41, 0x09, 0x38, 0x6C, 0xCB, 0x15, 0x8B, 0xF9, 0x05, 0xC8, 0x61, 0x8B, 0x8E, 0xE2, 0x4E, 0xC3 }, ++ { 0x38, 0x7D, 0x39, 0x7E, 0xA4, 0x3A, 0x99, 0x4B, 0xE8, 0x4D, 0x2D, 0x54, 0x4A, 0xFB, 0xE4, 0x81, 0xA2, 0x00, 0x0F, 0x55, 0x25, 0x26, 0x96, 0xBB, 0xA2, 0xC5, 0x0C, 0x8E, 0xBD, 0x10, 0x13, 0x47 }, ++ { 0x56, 0xF8, 0xCC, 0xF1, 0xF8, 0x64, 0x09, 0xB4, 0x6C, 0xE3, 0x61, 0x66, 0xAE, 0x91, 0x65, 0x13, 0x84, 0x41, 0x57, 0x75, 0x89, 0xDB, 0x08, 0xCB, 0xC5, 0xF6, 0x6C, 0xA2, 0x97, 0x43, 0xB9, 0xFD }, ++ { 0x97, 0x06, 0xC0, 0x92, 0xB0, 0x4D, 0x91, 0xF5, 0x3D, 0xFF, 0x91, 0xFA, 0x37, 0xB7, 0x49, 0x3D, 0x28, 0xB5, 0x76, 0xB5, 0xD7, 0x10, 0x46, 0x9D, 0xF7, 0x94, 0x01, 0x66, 0x22, 0x36, 0xFC, 0x03 }, ++ { 0x87, 0x79, 0x68, 0x68, 0x6C, 0x06, 0x8C, 0xE2, 0xF7, 0xE2, 0xAD, 0xCF, 0xF6, 0x8B, 0xF8, 0x74, 0x8E, 0xDF, 0x3C, 0xF8, 0x62, 0xCF, 0xB4, 0xD3, 0x94, 0x7A, 0x31, 0x06, 0x95, 0x80, 0x54, 0xE3 }, ++ { 0x88, 0x17, 0xE5, 0x71, 0x98, 0x79, 0xAC, 0xF7, 0x02, 0x47, 0x87, 0xEC, 0xCD, 0xB2, 0x71, 0x03, 0x55, 0x66, 0xCF, 0xA3, 0x33, 0xE0, 0x49, 0x40, 0x7C, 0x01, 0x78, 0xCC, 0xC5, 0x7A, 0x5B, 0x9F }, ++ { 0x89, 0x38, 0x24, 0x9E, 0x4B, 0x50, 0xCA, 0xDA, 0xCC, 0xDF, 0x5B, 0x18, 0x62, 0x13, 0x26, 0xCB, 0xB1, 0x52, 0x53, 0xE3, 0x3A, 0x20, 0xF5, 0x63, 0x6E, 0x99, 0x5D, 0x72, 0x47, 0x8D, 0xE4, 0x72 }, ++ { 0xF1, 0x64, 0xAB, 0xBA, 0x49, 0x63, 0xA4, 0x4D, 0x10, 0x72, 0x57, 0xE3, 0x23, 0x2D, 0x90, 0xAC, 0xA5, 0xE6, 0x6A, 0x14, 0x08, 0x24, 0x8C, 0x51, 0x74, 0x1E, 0x99, 0x1D, 0xB5, 0x22, 0x77, 0x56 }, ++ { 0xD0, 0x55, 0x63, 0xE2, 0xB1, 0xCB, 0xA0, 0xC4, 0xA2, 0xA1, 0xE8, 0xBD, 0xE3, 0xA1, 0xA0, 0xD9, 0xF5, 0xB4, 0x0C, 0x85, 0xA0, 0x70, 0xD6, 0xF5, 0xFB, 0x21, 0x06, 0x6E, 0xAD, 0x5D, 0x06, 0x01 }, ++ { 0x03, 0xFB, 0xB1, 0x63, 0x84, 0xF0, 0xA3, 0x86, 0x6F, 0x4C, 0x31, 0x17, 0x87, 0x76, 0x66, 0xEF, 0xBF, 0x12, 0x45, 0x97, 0x56, 0x4B, 0x29, 0x3D, 0x4A, 0xAB, 0x0D, 0x26, 0x9F, 0xAB, 0xDD, 0xFA }, ++ { 0x5F, 0xA8, 0x48, 0x6A, 0xC0, 0xE5, 0x29, 0x64, 0xD1, 0x88, 0x1B, 0xBE, 0x33, 0x8E, 0xB5, 0x4B, 0xE2, 0xF7, 0x19, 0x54, 0x92, 0x24, 0x89, 0x20, 0x57, 0xB4, 0xDA, 0x04, 0xBA, 0x8B, 0x34, 0x75 }, ++ { 0xCD, 0xFA, 0xBC, 0xEE, 0x46, 0x91, 0x11, 0x11, 0x23, 0x6A, 0x31, 0x70, 0x8B, 0x25, 0x39, 0xD7, 0x1F, 0xC2, 0x11, 0xD9, 0xB0, 0x9C, 0x0D, 0x85, 0x30, 0xA1, 0x1E, 0x1D, 0xBF, 0x6E, 0xED, 0x01 }, ++ { 0x4F, 0x82, 0xDE, 0x03, 0xB9, 0x50, 0x47, 0x93, 0xB8, 0x2A, 0x07, 0xA0, 0xBD, 0xCD, 0xFF, 0x31, 0x4D, 0x75, 0x9E, 0x7B, 0x62, 0xD2, 0x6B, 0x78, 0x49, 0x46, 0xB0, 0xD3, 0x6F, 0x91, 0x6F, 0x52 }, ++ { 0x25, 0x9E, 0xC7, 0xF1, 0x73, 0xBC, 0xC7, 0x6A, 0x09, 0x94, 0xC9, 0x67, 0xB4, 0xF5, 0xF0, 0x24, 0xC5, 0x60, 0x57, 0xFB, 0x79, 0xC9, 0x65, 0xC4, 0xFA, 0xE4, 0x18, 0x75, 0xF0, 0x6A, 0x0E, 0x4C }, ++ { 0x19, 0x3C, 0xC8, 0xE7, 0xC3, 0xE0, 0x8B, 0xB3, 0x0F, 0x54, 0x37, 0xAA, 0x27, 0xAD, 0xE1, 0xF1, 0x42, 0x36, 0x9B, 0x24, 0x6A, 0x67, 0x5B, 0x23, 0x83, 0xE6, 0xDA, 0x9B, 0x49, 0xA9, 0x80, 0x9E }, ++ { 0x5C, 0x10, 0x89, 0x6F, 0x0E, 0x28, 0x56, 0xB2, 0xA2, 0xEE, 0xE0, 0xFE, 0x4A, 0x2C, 0x16, 0x33, 0x56, 0x5D, 0x18, 0xF0, 0xE9, 0x3E, 0x1F, 0xAB, 0x26, 0xC3, 0x73, 0xE8, 0xF8, 0x29, 0x65, 0x4D }, ++ { 0xF1, 0x60, 0x12, 0xD9, 0x3F, 0x28, 0x85, 0x1A, 0x1E, 0xB9, 0x89, 0xF5, 0xD0, 0xB4, 0x3F, 0x3F, 0x39, 0xCA, 0x73, 0xC9, 0xA6, 0x2D, 0x51, 0x81, 0xBF, 0xF2, 0x37, 0x53, 0x6B, 0xD3, 0x48, 0xC3 }, ++ { 0x29, 0x66, 0xB3, 0xCF, 0xAE, 0x1E, 0x44, 0xEA, 0x99, 0x6D, 0xC5, 0xD6, 0x86, 0xCF, 0x25, 0xFA, 0x05, 0x3F, 0xB6, 0xF6, 0x72, 0x01, 0xB9, 0xE4, 0x6E, 0xAD, 0xE8, 0x5D, 0x0A, 0xD6, 0xB8, 0x06 }, ++ { 0xDD, 0xB8, 0x78, 0x24, 0x85, 0xE9, 0x00, 0xBC, 0x60, 0xBC, 0xF4, 0xC3, 0x3A, 0x6F, 0xD5, 0x85, 0x68, 0x0C, 0xC6, 0x83, 0xD5, 0x16, 0xEF, 0xA0, 0x3E, 0xB9, 0x98, 0x5F, 0xAD, 0x87, 0x15, 0xFB }, ++ { 0x4C, 0x4D, 0x6E, 0x71, 0xAE, 0xA0, 0x57, 0x86, 0x41, 0x31, 0x48, 0xFC, 0x7A, 0x78, 0x6B, 0x0E, 0xCA, 0xF5, 0x82, 0xCF, 0xF1, 0x20, 0x9F, 0x5A, 0x80, 0x9F, 0xBA, 0x85, 0x04, 0xCE, 0x66, 0x2C }, ++ { 0xFB, 0x4C, 0x5E, 0x86, 0xD7, 0xB2, 0x22, 0x9B, 0x99, 0xB8, 0xBA, 0x6D, 0x94, 0xC2, 0x47, 0xEF, 0x96, 0x4A, 0xA3, 0xA2, 0xBA, 0xE8, 0xED, 0xC7, 0x75, 0x69, 0xF2, 0x8D, 0xBB, 0xFF, 0x2D, 0x4E }, ++ { 0xE9, 0x4F, 0x52, 0x6D, 0xE9, 0x01, 0x96, 0x33, 0xEC, 0xD5, 0x4A, 0xC6, 0x12, 0x0F, 0x23, 0x95, 0x8D, 0x77, 0x18, 0xF1, 0xE7, 0x71, 0x7B, 0xF3, 0x29, 0x21, 0x1A, 0x4F, 0xAE, 0xED, 0x4E, 0x6D }, ++ { 0xCB, 0xD6, 0x66, 0x0A, 0x10, 0xDB, 0x3F, 0x23, 0xF7, 0xA0, 0x3D, 0x4B, 0x9D, 0x40, 0x44, 0xC7, 0x93, 0x2B, 0x28, 0x01, 0xAC, 0x89, 0xD6, 0x0B, 0xC9, 0xEB, 0x92, 0xD6, 0x5A, 0x46, 0xC2, 0xA0 }, ++ { 0x88, 0x18, 0xBB, 0xD3, 0xDB, 0x4D, 0xC1, 0x23, 0xB2, 0x5C, 0xBB, 0xA5, 0xF5, 0x4C, 0x2B, 0xC4, 0xB3, 0xFC, 0xF9, 0xBF, 0x7D, 0x7A, 0x77, 0x09, 0xF4, 0xAE, 0x58, 0x8B, 0x26, 0x7C, 0x4E, 0xCE }, ++ { 0xC6, 0x53, 0x82, 0x51, 0x3F, 0x07, 0x46, 0x0D, 0xA3, 0x98, 0x33, 0xCB, 0x66, 0x6C, 0x5E, 0xD8, 0x2E, 0x61, 0xB9, 0xE9, 0x98, 0xF4, 0xB0, 0xC4, 0x28, 0x7C, 0xEE, 0x56, 0xC3, 0xCC, 0x9B, 0xCD }, ++ { 0x89, 0x75, 0xB0, 0x57, 0x7F, 0xD3, 0x55, 0x66, 0xD7, 0x50, 0xB3, 0x62, 0xB0, 0x89, 0x7A, 0x26, 0xC3, 0x99, 0x13, 0x6D, 0xF0, 0x7B, 0xAB, 0xAB, 0xBD, 0xE6, 0x20, 0x3F, 0xF2, 0x95, 0x4E, 0xD4 }, ++ { 0x21, 0xFE, 0x0C, 0xEB, 0x00, 0x52, 0xBE, 0x7F, 0xB0, 0xF0, 0x04, 0x18, 0x7C, 0xAC, 0xD7, 0xDE, 0x67, 0xFA, 0x6E, 0xB0, 0x93, 0x8D, 0x92, 0x76, 0x77, 0xF2, 0x39, 0x8C, 0x13, 0x23, 0x17, 0xA8 }, ++ { 0x2E, 0xF7, 0x3F, 0x3C, 0x26, 0xF1, 0x2D, 0x93, 0x88, 0x9F, 0x3C, 0x78, 0xB6, 0xA6, 0x6C, 0x1D, 0x52, 0xB6, 0x49, 0xDC, 0x9E, 0x85, 0x6E, 0x2C, 0x17, 0x2E, 0xA7, 0xC5, 0x8A, 0xC2, 0xB5, 0xE3 }, ++ { 0x38, 0x8A, 0x3C, 0xD5, 0x6D, 0x73, 0x86, 0x7A, 0xBB, 0x5F, 0x84, 0x01, 0x49, 0x2B, 0x6E, 0x26, 0x81, 0xEB, 0x69, 0x85, 0x1E, 0x76, 0x7F, 0xD8, 0x42, 0x10, 0xA5, 0x60, 0x76, 0xFB, 0x3D, 0xD3 }, ++ { 0xAF, 0x53, 0x3E, 0x02, 0x2F, 0xC9, 0x43, 0x9E, 0x4E, 0x3C, 0xB8, 0x38, 0xEC, 0xD1, 0x86, 0x92, 0x23, 0x2A, 0xDF, 0x6F, 0xE9, 0x83, 0x95, 0x26, 0xD3, 0xC3, 0xDD, 0x1B, 0x71, 0x91, 0x0B, 0x1A }, ++ { 0x75, 0x1C, 0x09, 0xD4, 0x1A, 0x93, 0x43, 0x88, 0x2A, 0x81, 0xCD, 0x13, 0xEE, 0x40, 0x81, 0x8D, 0x12, 0xEB, 0x44, 0xC6, 0xC7, 0xF4, 0x0D, 0xF1, 0x6E, 0x4A, 0xEA, 0x8F, 0xAB, 0x91, 0x97, 0x2A }, ++ { 0x5B, 0x73, 0xDD, 0xB6, 0x8D, 0x9D, 0x2B, 0x0A, 0xA2, 0x65, 0xA0, 0x79, 0x88, 0xD6, 0xB8, 0x8A, 0xE9, 0xAA, 0xC5, 0x82, 0xAF, 0x83, 0x03, 0x2F, 0x8A, 0x9B, 0x21, 0xA2, 0xE1, 0xB7, 0xBF, 0x18 }, ++ { 0x3D, 0xA2, 0x91, 0x26, 0xC7, 0xC5, 0xD7, 0xF4, 0x3E, 0x64, 0x24, 0x2A, 0x79, 0xFE, 0xAA, 0x4E, 0xF3, 0x45, 0x9C, 0xDE, 0xCC, 0xC8, 0x98, 0xED, 0x59, 0xA9, 0x7F, 0x6E, 0xC9, 0x3B, 0x9D, 0xAB }, ++ { 0x56, 0x6D, 0xC9, 0x20, 0x29, 0x3D, 0xA5, 0xCB, 0x4F, 0xE0, 0xAA, 0x8A, 0xBD, 0xA8, 0xBB, 0xF5, 0x6F, 0x55, 0x23, 0x13, 0xBF, 0xF1, 0x90, 0x46, 0x64, 0x1E, 0x36, 0x15, 0xC1, 0xE3, 0xED, 0x3F }, ++ { 0x41, 0x15, 0xBE, 0xA0, 0x2F, 0x73, 0xF9, 0x7F, 0x62, 0x9E, 0x5C, 0x55, 0x90, 0x72, 0x0C, 0x01, 0xE7, 0xE4, 0x49, 0xAE, 0x2A, 0x66, 0x97, 0xD4, 0xD2, 0x78, 0x33, 0x21, 0x30, 0x36, 0x92, 0xF9 }, ++ { 0x4C, 0xE0, 0x8F, 0x47, 0x62, 0x46, 0x8A, 0x76, 0x70, 0x01, 0x21, 0x64, 0x87, 0x8D, 0x68, 0x34, 0x0C, 0x52, 0xA3, 0x5E, 0x66, 0xC1, 0x88, 0x4D, 0x5C, 0x86, 0x48, 0x89, 0xAB, 0xC9, 0x66, 0x77 }, ++ { 0x81, 0xEA, 0x0B, 0x78, 0x04, 0x12, 0x4E, 0x0C, 0x22, 0xEA, 0x5F, 0xC7, 0x11, 0x04, 0xA2, 0xAF, 0xCB, 0x52, 0xA1, 0xFA, 0x81, 0x6F, 0x3E, 0xCB, 0x7D, 0xCB, 0x5D, 0x9D, 0xEA, 0x17, 0x86, 0xD0 }, ++ { 0xFE, 0x36, 0x27, 0x33, 0xB0, 0x5F, 0x6B, 0xED, 0xAF, 0x93, 0x79, 0xD7, 0xF7, 0x93, 0x6E, 0xDE, 0x20, 0x9B, 0x1F, 0x83, 0x23, 0xC3, 0x92, 0x25, 0x49, 0xD9, 0xE7, 0x36, 0x81, 0xB5, 0xDB, 0x7B }, ++ { 0xEF, 0xF3, 0x7D, 0x30, 0xDF, 0xD2, 0x03, 0x59, 0xBE, 0x4E, 0x73, 0xFD, 0xF4, 0x0D, 0x27, 0x73, 0x4B, 0x3D, 0xF9, 0x0A, 0x97, 0xA5, 0x5E, 0xD7, 0x45, 0x29, 0x72, 0x94, 0xCA, 0x85, 0xD0, 0x9F }, ++ { 0x17, 0x2F, 0xFC, 0x67, 0x15, 0x3D, 0x12, 0xE0, 0xCA, 0x76, 0xA8, 0xB6, 0xCD, 0x5D, 0x47, 0x31, 0x88, 0x5B, 0x39, 0xCE, 0x0C, 0xAC, 0x93, 0xA8, 0x97, 0x2A, 0x18, 0x00, 0x6C, 0x8B, 0x8B, 0xAF }, ++ { 0xC4, 0x79, 0x57, 0xF1, 0xCC, 0x88, 0xE8, 0x3E, 0xF9, 0x44, 0x58, 0x39, 0x70, 0x9A, 0x48, 0x0A, 0x03, 0x6B, 0xED, 0x5F, 0x88, 0xAC, 0x0F, 0xCC, 0x8E, 0x1E, 0x70, 0x3F, 0xFA, 0xAC, 0x13, 0x2C }, ++ { 0x30, 0xF3, 0x54, 0x83, 0x70, 0xCF, 0xDC, 0xED, 0xA5, 0xC3, 0x7B, 0x56, 0x9B, 0x61, 0x75, 0xE7, 0x99, 0xEE, 0xF1, 0xA6, 0x2A, 0xAA, 0x94, 0x32, 0x45, 0xAE, 0x76, 0x69, 0xC2, 0x27, 0xA7, 0xB5 }, ++ { 0xC9, 0x5D, 0xCB, 0x3C, 0xF1, 0xF2, 0x7D, 0x0E, 0xEF, 0x2F, 0x25, 0xD2, 0x41, 0x38, 0x70, 0x90, 0x4A, 0x87, 0x7C, 0x4A, 0x56, 0xC2, 0xDE, 0x1E, 0x83, 0xE2, 0xBC, 0x2A, 0xE2, 0xE4, 0x68, 0x21 }, ++ { 0xD5, 0xD0, 0xB5, 0xD7, 0x05, 0x43, 0x4C, 0xD4, 0x6B, 0x18, 0x57, 0x49, 0xF6, 0x6B, 0xFB, 0x58, 0x36, 0xDC, 0xDF, 0x6E, 0xE5, 0x49, 0xA2, 0xB7, 0xA4, 0xAE, 0xE7, 0xF5, 0x80, 0x07, 0xCA, 0xAF }, ++ { 0xBB, 0xC1, 0x24, 0xA7, 0x12, 0xF1, 0x5D, 0x07, 0xC3, 0x00, 0xE0, 0x5B, 0x66, 0x83, 0x89, 0xA4, 0x39, 0xC9, 0x17, 0x77, 0xF7, 0x21, 0xF8, 0x32, 0x0C, 0x1C, 0x90, 0x78, 0x06, 0x6D, 0x2C, 0x7E }, ++ { 0xA4, 0x51, 0xB4, 0x8C, 0x35, 0xA6, 0xC7, 0x85, 0x4C, 0xFA, 0xAE, 0x60, 0x26, 0x2E, 0x76, 0x99, 0x08, 0x16, 0x38, 0x2A, 0xC0, 0x66, 0x7E, 0x5A, 0x5C, 0x9E, 0x1B, 0x46, 0xC4, 0x34, 0x2D, 0xDF }, ++ { 0xB0, 0xD1, 0x50, 0xFB, 0x55, 0xE7, 0x78, 0xD0, 0x11, 0x47, 0xF0, 0xB5, 0xD8, 0x9D, 0x99, 0xEC, 0xB2, 0x0F, 0xF0, 0x7E, 0x5E, 0x67, 0x60, 0xD6, 0xB6, 0x45, 0xEB, 0x5B, 0x65, 0x4C, 0x62, 0x2B }, ++ { 0x34, 0xF7, 0x37, 0xC0, 0xAB, 0x21, 0x99, 0x51, 0xEE, 0xE8, 0x9A, 0x9F, 0x8D, 0xAC, 0x29, 0x9C, 0x9D, 0x4C, 0x38, 0xF3, 0x3F, 0xA4, 0x94, 0xC5, 0xC6, 0xEE, 0xFC, 0x92, 0xB6, 0xDB, 0x08, 0xBC }, ++ { 0x1A, 0x62, 0xCC, 0x3A, 0x00, 0x80, 0x0D, 0xCB, 0xD9, 0x98, 0x91, 0x08, 0x0C, 0x1E, 0x09, 0x84, 0x58, 0x19, 0x3A, 0x8C, 0xC9, 0xF9, 0x70, 0xEA, 0x99, 0xFB, 0xEF, 0xF0, 0x03, 0x18, 0xC2, 0x89 }, ++ { 0xCF, 0xCE, 0x55, 0xEB, 0xAF, 0xC8, 0x40, 0xD7, 0xAE, 0x48, 0x28, 0x1C, 0x7F, 0xD5, 0x7E, 0xC8, 0xB4, 0x82, 0xD4, 0xB7, 0x04, 0x43, 0x74, 0x95, 0x49, 0x5A, 0xC4, 0x14, 0xCF, 0x4A, 0x37, 0x4B }, ++ { 0x67, 0x46, 0xFA, 0xCF, 0x71, 0x14, 0x6D, 0x99, 0x9D, 0xAB, 0xD0, 0x5D, 0x09, 0x3A, 0xE5, 0x86, 0x64, 0x8D, 0x1E, 0xE2, 0x8E, 0x72, 0x61, 0x7B, 0x99, 0xD0, 0xF0, 0x08, 0x6E, 0x1E, 0x45, 0xBF }, ++ { 0x57, 0x1C, 0xED, 0x28, 0x3B, 0x3F, 0x23, 0xB4, 0xE7, 0x50, 0xBF, 0x12, 0xA2, 0xCA, 0xF1, 0x78, 0x18, 0x47, 0xBD, 0x89, 0x0E, 0x43, 0x60, 0x3C, 0xDC, 0x59, 0x76, 0x10, 0x2B, 0x7B, 0xB1, 0x1B }, ++ { 0xCF, 0xCB, 0x76, 0x5B, 0x04, 0x8E, 0x35, 0x02, 0x2C, 0x5D, 0x08, 0x9D, 0x26, 0xE8, 0x5A, 0x36, 0xB0, 0x05, 0xA2, 0xB8, 0x04, 0x93, 0xD0, 0x3A, 0x14, 0x4E, 0x09, 0xF4, 0x09, 0xB6, 0xAF, 0xD1 }, ++ { 0x40, 0x50, 0xC7, 0xA2, 0x77, 0x05, 0xBB, 0x27, 0xF4, 0x20, 0x89, 0xB2, 0x99, 0xF3, 0xCB, 0xE5, 0x05, 0x4E, 0xAD, 0x68, 0x72, 0x7E, 0x8E, 0xF9, 0x31, 0x8C, 0xE6, 0xF2, 0x5C, 0xD6, 0xF3, 0x1D }, ++ { 0x18, 0x40, 0x70, 0xBD, 0x5D, 0x26, 0x5F, 0xBD, 0xC1, 0x42, 0xCD, 0x1C, 0x5C, 0xD0, 0xD7, 0xE4, 0x14, 0xE7, 0x03, 0x69, 0xA2, 0x66, 0xD6, 0x27, 0xC8, 0xFB, 0xA8, 0x4F, 0xA5, 0xE8, 0x4C, 0x34 }, ++ { 0x9E, 0xDD, 0xA9, 0xA4, 0x44, 0x39, 0x02, 0xA9, 0x58, 0x8C, 0x0D, 0x0C, 0xCC, 0x62, 0xB9, 0x30, 0x21, 0x84, 0x79, 0xA6, 0x84, 0x1E, 0x6F, 0xE7, 0xD4, 0x30, 0x03, 0xF0, 0x4B, 0x1F, 0xD6, 0x43 }, ++ { 0xE4, 0x12, 0xFE, 0xEF, 0x79, 0x08, 0x32, 0x4A, 0x6D, 0xA1, 0x84, 0x16, 0x29, 0xF3, 0x5D, 0x3D, 0x35, 0x86, 0x42, 0x01, 0x93, 0x10, 0xEC, 0x57, 0xC6, 0x14, 0x83, 0x6B, 0x63, 0xD3, 0x07, 0x63 }, ++ { 0x1A, 0x2B, 0x8E, 0xDF, 0xF3, 0xF9, 0xAC, 0xC1, 0x55, 0x4F, 0xCB, 0xAE, 0x3C, 0xF1, 0xD6, 0x29, 0x8C, 0x64, 0x62, 0xE2, 0x2E, 0x5E, 0xB0, 0x25, 0x96, 0x84, 0xF8, 0x35, 0x01, 0x2B, 0xD1, 0x3F }, ++ { 0x28, 0x8C, 0x4A, 0xD9, 0xB9, 0x40, 0x97, 0x62, 0xEA, 0x07, 0xC2, 0x4A, 0x41, 0xF0, 0x4F, 0x69, 0xA7, 0xD7, 0x4B, 0xEE, 0x2D, 0x95, 0x43, 0x53, 0x74, 0xBD, 0xE9, 0x46, 0xD7, 0x24, 0x1C, 0x7B }, ++ { 0x80, 0x56, 0x91, 0xBB, 0x28, 0x67, 0x48, 0xCF, 0xB5, 0x91, 0xD3, 0xAE, 0xBE, 0x7E, 0x6F, 0x4E, 0x4D, 0xC6, 0xE2, 0x80, 0x8C, 0x65, 0x14, 0x3C, 0xC0, 0x04, 0xE4, 0xEB, 0x6F, 0xD0, 0x9D, 0x43 }, ++ { 0xD4, 0xAC, 0x8D, 0x3A, 0x0A, 0xFC, 0x6C, 0xFA, 0x7B, 0x46, 0x0A, 0xE3, 0x00, 0x1B, 0xAE, 0xB3, 0x6D, 0xAD, 0xB3, 0x7D, 0xA0, 0x7D, 0x2E, 0x8A, 0xC9, 0x18, 0x22, 0xDF, 0x34, 0x8A, 0xED, 0x3D }, ++ { 0xC3, 0x76, 0x61, 0x70, 0x14, 0xD2, 0x01, 0x58, 0xBC, 0xED, 0x3D, 0x3B, 0xA5, 0x52, 0xB6, 0xEC, 0xCF, 0x84, 0xE6, 0x2A, 0xA3, 0xEB, 0x65, 0x0E, 0x90, 0x02, 0x9C, 0x84, 0xD1, 0x3E, 0xEA, 0x69 }, ++ { 0xC4, 0x1F, 0x09, 0xF4, 0x3C, 0xEC, 0xAE, 0x72, 0x93, 0xD6, 0x00, 0x7C, 0xA0, 0xA3, 0x57, 0x08, 0x7D, 0x5A, 0xE5, 0x9B, 0xE5, 0x00, 0xC1, 0xCD, 0x5B, 0x28, 0x9E, 0xE8, 0x10, 0xC7, 0xB0, 0x82 }, ++ { 0x03, 0xD1, 0xCE, 0xD1, 0xFB, 0xA5, 0xC3, 0x91, 0x55, 0xC4, 0x4B, 0x77, 0x65, 0xCB, 0x76, 0x0C, 0x78, 0x70, 0x8D, 0xCF, 0xC8, 0x0B, 0x0B, 0xD8, 0xAD, 0xE3, 0xA5, 0x6D, 0xA8, 0x83, 0x0B, 0x29 }, ++ { 0x09, 0xBD, 0xE6, 0xF1, 0x52, 0x21, 0x8D, 0xC9, 0x2C, 0x41, 0xD7, 0xF4, 0x53, 0x87, 0xE6, 0x3E, 0x58, 0x69, 0xD8, 0x07, 0xEC, 0x70, 0xB8, 0x21, 0x40, 0x5D, 0xBD, 0x88, 0x4B, 0x7F, 0xCF, 0x4B }, ++ { 0x71, 0xC9, 0x03, 0x6E, 0x18, 0x17, 0x9B, 0x90, 0xB3, 0x7D, 0x39, 0xE9, 0xF0, 0x5E, 0xB8, 0x9C, 0xC5, 0xFC, 0x34, 0x1F, 0xD7, 0xC4, 0x77, 0xD0, 0xD7, 0x49, 0x32, 0x85, 0xFA, 0xCA, 0x08, 0xA4 }, ++ { 0x59, 0x16, 0x83, 0x3E, 0xBB, 0x05, 0xCD, 0x91, 0x9C, 0xA7, 0xFE, 0x83, 0xB6, 0x92, 0xD3, 0x20, 0x5B, 0xEF, 0x72, 0x39, 0x2B, 0x2C, 0xF6, 0xBB, 0x0A, 0x6D, 0x43, 0xF9, 0x94, 0xF9, 0x5F, 0x11 }, ++ { 0xF6, 0x3A, 0xAB, 0x3E, 0xC6, 0x41, 0xB3, 0xB0, 0x24, 0x96, 0x4C, 0x2B, 0x43, 0x7C, 0x04, 0xF6, 0x04, 0x3C, 0x4C, 0x7E, 0x02, 0x79, 0x23, 0x99, 0x95, 0x40, 0x19, 0x58, 0xF8, 0x6B, 0xBE, 0x54 }, ++ { 0xF1, 0x72, 0xB1, 0x80, 0xBF, 0xB0, 0x97, 0x40, 0x49, 0x31, 0x20, 0xB6, 0x32, 0x6C, 0xBD, 0xC5, 0x61, 0xE4, 0x77, 0xDE, 0xF9, 0xBB, 0xCF, 0xD2, 0x8C, 0xC8, 0xC1, 0xC5, 0xE3, 0x37, 0x9A, 0x31 }, ++ { 0xCB, 0x9B, 0x89, 0xCC, 0x18, 0x38, 0x1D, 0xD9, 0x14, 0x1A, 0xDE, 0x58, 0x86, 0x54, 0xD4, 0xE6, 0xA2, 0x31, 0xD5, 0xBF, 0x49, 0xD4, 0xD5, 0x9A, 0xC2, 0x7D, 0x86, 0x9C, 0xBE, 0x10, 0x0C, 0xF3 }, ++ { 0x7B, 0xD8, 0x81, 0x50, 0x46, 0xFD, 0xD8, 0x10, 0xA9, 0x23, 0xE1, 0x98, 0x4A, 0xAE, 0xBD, 0xCD, 0xF8, 0x4D, 0x87, 0xC8, 0x99, 0x2D, 0x68, 0xB5, 0xEE, 0xB4, 0x60, 0xF9, 0x3E, 0xB3, 0xC8, 0xD7 }, ++ { 0x60, 0x7B, 0xE6, 0x68, 0x62, 0xFD, 0x08, 0xEE, 0x5B, 0x19, 0xFA, 0xCA, 0xC0, 0x9D, 0xFD, 0xBC, 0xD4, 0x0C, 0x31, 0x21, 0x01, 0xD6, 0x6E, 0x6E, 0xBD, 0x2B, 0x84, 0x1F, 0x1B, 0x9A, 0x93, 0x25 }, ++ { 0x9F, 0xE0, 0x3B, 0xBE, 0x69, 0xAB, 0x18, 0x34, 0xF5, 0x21, 0x9B, 0x0D, 0xA8, 0x8A, 0x08, 0xB3, 0x0A, 0x66, 0xC5, 0x91, 0x3F, 0x01, 0x51, 0x96, 0x3C, 0x36, 0x05, 0x60, 0xDB, 0x03, 0x87, 0xB3 }, ++ { 0x90, 0xA8, 0x35, 0x85, 0x71, 0x7B, 0x75, 0xF0, 0xE9, 0xB7, 0x25, 0xE0, 0x55, 0xEE, 0xEE, 0xB9, 0xE7, 0xA0, 0x28, 0xEA, 0x7E, 0x6C, 0xBC, 0x07, 0xB2, 0x09, 0x17, 0xEC, 0x03, 0x63, 0xE3, 0x8C }, ++ { 0x33, 0x6E, 0xA0, 0x53, 0x0F, 0x4A, 0x74, 0x69, 0x12, 0x6E, 0x02, 0x18, 0x58, 0x7E, 0xBB, 0xDE, 0x33, 0x58, 0xA0, 0xB3, 0x1C, 0x29, 0xD2, 0x00, 0xF7, 0xDC, 0x7E, 0xB1, 0x5C, 0x6A, 0xAD, 0xD8 }, ++ { 0xA7, 0x9E, 0x76, 0xDC, 0x0A, 0xBC, 0xA4, 0x39, 0x6F, 0x07, 0x47, 0xCD, 0x7B, 0x74, 0x8D, 0xF9, 0x13, 0x00, 0x76, 0x26, 0xB1, 0xD6, 0x59, 0xDA, 0x0C, 0x1F, 0x78, 0xB9, 0x30, 0x3D, 0x01, 0xA3 }, ++ { 0x44, 0xE7, 0x8A, 0x77, 0x37, 0x56, 0xE0, 0x95, 0x15, 0x19, 0x50, 0x4D, 0x70, 0x38, 0xD2, 0x8D, 0x02, 0x13, 0xA3, 0x7E, 0x0C, 0xE3, 0x75, 0x37, 0x17, 0x57, 0xBC, 0x99, 0x63, 0x11, 0xE3, 0xB8 }, ++ { 0x77, 0xAC, 0x01, 0x2A, 0x3F, 0x75, 0x4D, 0xCF, 0xEA, 0xB5, 0xEB, 0x99, 0x6B, 0xE9, 0xCD, 0x2D, 0x1F, 0x96, 0x11, 0x1B, 0x6E, 0x49, 0xF3, 0x99, 0x4D, 0xF1, 0x81, 0xF2, 0x85, 0x69, 0xD8, 0x25 }, ++ { 0xCE, 0x5A, 0x10, 0xDB, 0x6F, 0xCC, 0xDA, 0xF1, 0x40, 0xAA, 0xA4, 0xDE, 0xD6, 0x25, 0x0A, 0x9C, 0x06, 0xE9, 0x22, 0x2B, 0xC9, 0xF9, 0xF3, 0x65, 0x8A, 0x4A, 0xFF, 0x93, 0x5F, 0x2B, 0x9F, 0x3A }, ++ { 0xEC, 0xC2, 0x03, 0xA7, 0xFE, 0x2B, 0xE4, 0xAB, 0xD5, 0x5B, 0xB5, 0x3E, 0x6E, 0x67, 0x35, 0x72, 0xE0, 0x07, 0x8D, 0xA8, 0xCD, 0x37, 0x5E, 0xF4, 0x30, 0xCC, 0x97, 0xF9, 0xF8, 0x00, 0x83, 0xAF }, ++ { 0x14, 0xA5, 0x18, 0x6D, 0xE9, 0xD7, 0xA1, 0x8B, 0x04, 0x12, 0xB8, 0x56, 0x3E, 0x51, 0xCC, 0x54, 0x33, 0x84, 0x0B, 0x4A, 0x12, 0x9A, 0x8F, 0xF9, 0x63, 0xB3, 0x3A, 0x3C, 0x4A, 0xFE, 0x8E, 0xBB }, ++ { 0x13, 0xF8, 0xEF, 0x95, 0xCB, 0x86, 0xE6, 0xA6, 0x38, 0x93, 0x1C, 0x8E, 0x10, 0x76, 0x73, 0xEB, 0x76, 0xBA, 0x10, 0xD7, 0xC2, 0xCD, 0x70, 0xB9, 0xD9, 0x92, 0x0B, 0xBE, 0xED, 0x92, 0x94, 0x09 }, ++ { 0x0B, 0x33, 0x8F, 0x4E, 0xE1, 0x2F, 0x2D, 0xFC, 0xB7, 0x87, 0x13, 0x37, 0x79, 0x41, 0xE0, 0xB0, 0x63, 0x21, 0x52, 0x58, 0x1D, 0x13, 0x32, 0x51, 0x6E, 0x4A, 0x2C, 0xAB, 0x19, 0x42, 0xCC, 0xA4 }, ++ { 0xEA, 0xAB, 0x0E, 0xC3, 0x7B, 0x3B, 0x8A, 0xB7, 0x96, 0xE9, 0xF5, 0x72, 0x38, 0xDE, 0x14, 0xA2, 0x64, 0xA0, 0x76, 0xF3, 0x88, 0x7D, 0x86, 0xE2, 0x9B, 0xB5, 0x90, 0x6D, 0xB5, 0xA0, 0x0E, 0x02 }, ++ { 0x23, 0xCB, 0x68, 0xB8, 0xC0, 0xE6, 0xDC, 0x26, 0xDC, 0x27, 0x76, 0x6D, 0xDC, 0x0A, 0x13, 0xA9, 0x94, 0x38, 0xFD, 0x55, 0x61, 0x7A, 0xA4, 0x09, 0x5D, 0x8F, 0x96, 0x97, 0x20, 0xC8, 0x72, 0xDF }, ++ { 0x09, 0x1D, 0x8E, 0xE3, 0x0D, 0x6F, 0x29, 0x68, 0xD4, 0x6B, 0x68, 0x7D, 0xD6, 0x52, 0x92, 0x66, 0x57, 0x42, 0xDE, 0x0B, 0xB8, 0x3D, 0xCC, 0x00, 0x04, 0xC7, 0x2C, 0xE1, 0x00, 0x07, 0xA5, 0x49 }, ++ { 0x7F, 0x50, 0x7A, 0xBC, 0x6D, 0x19, 0xBA, 0x00, 0xC0, 0x65, 0xA8, 0x76, 0xEC, 0x56, 0x57, 0x86, 0x88, 0x82, 0xD1, 0x8A, 0x22, 0x1B, 0xC4, 0x6C, 0x7A, 0x69, 0x12, 0x54, 0x1F, 0x5B, 0xC7, 0xBA }, ++ { 0xA0, 0x60, 0x7C, 0x24, 0xE1, 0x4E, 0x8C, 0x22, 0x3D, 0xB0, 0xD7, 0x0B, 0x4D, 0x30, 0xEE, 0x88, 0x01, 0x4D, 0x60, 0x3F, 0x43, 0x7E, 0x9E, 0x02, 0xAA, 0x7D, 0xAF, 0xA3, 0xCD, 0xFB, 0xAD, 0x94 }, ++ { 0xDD, 0xBF, 0xEA, 0x75, 0xCC, 0x46, 0x78, 0x82, 0xEB, 0x34, 0x83, 0xCE, 0x5E, 0x2E, 0x75, 0x6A, 0x4F, 0x47, 0x01, 0xB7, 0x6B, 0x44, 0x55, 0x19, 0xE8, 0x9F, 0x22, 0xD6, 0x0F, 0xA8, 0x6E, 0x06 }, ++ { 0x0C, 0x31, 0x1F, 0x38, 0xC3, 0x5A, 0x4F, 0xB9, 0x0D, 0x65, 0x1C, 0x28, 0x9D, 0x48, 0x68, 0x56, 0xCD, 0x14, 0x13, 0xDF, 0x9B, 0x06, 0x77, 0xF5, 0x3E, 0xCE, 0x2C, 0xD9, 0xE4, 0x77, 0xC6, 0x0A }, ++ { 0x46, 0xA7, 0x3A, 0x8D, 0xD3, 0xE7, 0x0F, 0x59, 0xD3, 0x94, 0x2C, 0x01, 0xDF, 0x59, 0x9D, 0xEF, 0x78, 0x3C, 0x9D, 0xA8, 0x2F, 0xD8, 0x32, 0x22, 0xCD, 0x66, 0x2B, 0x53, 0xDC, 0xE7, 0xDB, 0xDF }, ++ { 0xAD, 0x03, 0x8F, 0xF9, 0xB1, 0x4D, 0xE8, 0x4A, 0x80, 0x1E, 0x4E, 0x62, 0x1C, 0xE5, 0xDF, 0x02, 0x9D, 0xD9, 0x35, 0x20, 0xD0, 0xC2, 0xFA, 0x38, 0xBF, 0xF1, 0x76, 0xA8, 0xB1, 0xD1, 0x69, 0x8C }, ++ { 0xAB, 0x70, 0xC5, 0xDF, 0xBD, 0x1E, 0xA8, 0x17, 0xFE, 0xD0, 0xCD, 0x06, 0x72, 0x93, 0xAB, 0xF3, 0x19, 0xE5, 0xD7, 0x90, 0x1C, 0x21, 0x41, 0xD5, 0xD9, 0x9B, 0x23, 0xF0, 0x3A, 0x38, 0xE7, 0x48 }, ++ { 0x1F, 0xFF, 0xDA, 0x67, 0x93, 0x2B, 0x73, 0xC8, 0xEC, 0xAF, 0x00, 0x9A, 0x34, 0x91, 0xA0, 0x26, 0x95, 0x3B, 0xAB, 0xFE, 0x1F, 0x66, 0x3B, 0x06, 0x97, 0xC3, 0xC4, 0xAE, 0x8B, 0x2E, 0x7D, 0xCB }, ++ { 0xB0, 0xD2, 0xCC, 0x19, 0x47, 0x2D, 0xD5, 0x7F, 0x2B, 0x17, 0xEF, 0xC0, 0x3C, 0x8D, 0x58, 0xC2, 0x28, 0x3D, 0xBB, 0x19, 0xDA, 0x57, 0x2F, 0x77, 0x55, 0x85, 0x5A, 0xA9, 0x79, 0x43, 0x17, 0xA0 }, ++ { 0xA0, 0xD1, 0x9A, 0x6E, 0xE3, 0x39, 0x79, 0xC3, 0x25, 0x51, 0x0E, 0x27, 0x66, 0x22, 0xDF, 0x41, 0xF7, 0x15, 0x83, 0xD0, 0x75, 0x01, 0xB8, 0x70, 0x71, 0x12, 0x9A, 0x0A, 0xD9, 0x47, 0x32, 0xA5 }, ++ { 0x72, 0x46, 0x42, 0xA7, 0x03, 0x2D, 0x10, 0x62, 0xB8, 0x9E, 0x52, 0xBE, 0xA3, 0x4B, 0x75, 0xDF, 0x7D, 0x8F, 0xE7, 0x72, 0xD9, 0xFE, 0x3C, 0x93, 0xDD, 0xF3, 0xC4, 0x54, 0x5A, 0xB5, 0xA9, 0x9B }, ++ { 0xAD, 0xE5, 0xEA, 0xA7, 0xE6, 0x1F, 0x67, 0x2D, 0x58, 0x7E, 0xA0, 0x3D, 0xAE, 0x7D, 0x7B, 0x55, 0x22, 0x9C, 0x01, 0xD0, 0x6B, 0xC0, 0xA5, 0x70, 0x14, 0x36, 0xCB, 0xD1, 0x83, 0x66, 0xA6, 0x26 }, ++ { 0x01, 0x3B, 0x31, 0xEB, 0xD2, 0x28, 0xFC, 0xDD, 0xA5, 0x1F, 0xAB, 0xB0, 0x3B, 0xB0, 0x2D, 0x60, 0xAC, 0x20, 0xCA, 0x21, 0x5A, 0xAF, 0xA8, 0x3B, 0xDD, 0x85, 0x5E, 0x37, 0x55, 0xA3, 0x5F, 0x0B }, ++ { 0x33, 0x2E, 0xD4, 0x0B, 0xB1, 0x0D, 0xDE, 0x3C, 0x95, 0x4A, 0x75, 0xD7, 0xB8, 0x99, 0x9D, 0x4B, 0x26, 0xA1, 0xC0, 0x63, 0xC1, 0xDC, 0x6E, 0x32, 0xC1, 0xD9, 0x1B, 0xAB, 0x7B, 0xBB, 0x7D, 0x16 }, ++ { 0xC7, 0xA1, 0x97, 0xB3, 0xA0, 0x5B, 0x56, 0x6B, 0xCC, 0x9F, 0xAC, 0xD2, 0x0E, 0x44, 0x1D, 0x6F, 0x6C, 0x28, 0x60, 0xAC, 0x96, 0x51, 0xCD, 0x51, 0xD6, 0xB9, 0xD2, 0xCD, 0xEE, 0xEA, 0x03, 0x90 }, ++ { 0xBD, 0x9C, 0xF6, 0x4E, 0xA8, 0x95, 0x3C, 0x03, 0x71, 0x08, 0xE6, 0xF6, 0x54, 0x91, 0x4F, 0x39, 0x58, 0xB6, 0x8E, 0x29, 0xC1, 0x67, 0x00, 0xDC, 0x18, 0x4D, 0x94, 0xA2, 0x17, 0x08, 0xFF, 0x60 }, ++ { 0x88, 0x35, 0xB0, 0xAC, 0x02, 0x11, 0x51, 0xDF, 0x71, 0x64, 0x74, 0xCE, 0x27, 0xCE, 0x4D, 0x3C, 0x15, 0xF0, 0xB2, 0xDA, 0xB4, 0x80, 0x03, 0xCF, 0x3F, 0x3E, 0xFD, 0x09, 0x45, 0x10, 0x6B, 0x9A }, ++ { 0x3B, 0xFE, 0xFA, 0x33, 0x01, 0xAA, 0x55, 0xC0, 0x80, 0x19, 0x0C, 0xFF, 0xDA, 0x8E, 0xAE, 0x51, 0xD9, 0xAF, 0x48, 0x8B, 0x4C, 0x1F, 0x24, 0xC3, 0xD9, 0xA7, 0x52, 0x42, 0xFD, 0x8E, 0xA0, 0x1D }, ++ { 0x08, 0x28, 0x4D, 0x14, 0x99, 0x3C, 0xD4, 0x7D, 0x53, 0xEB, 0xAE, 0xCF, 0x0D, 0xF0, 0x47, 0x8C, 0xC1, 0x82, 0xC8, 0x9C, 0x00, 0xE1, 0x85, 0x9C, 0x84, 0x85, 0x16, 0x86, 0xDD, 0xF2, 0xC1, 0xB7 }, ++ { 0x1E, 0xD7, 0xEF, 0x9F, 0x04, 0xC2, 0xAC, 0x8D, 0xB6, 0xA8, 0x64, 0xDB, 0x13, 0x10, 0x87, 0xF2, 0x70, 0x65, 0x09, 0x8E, 0x69, 0xC3, 0xFE, 0x78, 0x71, 0x8D, 0x9B, 0x94, 0x7F, 0x4A, 0x39, 0xD0 }, ++ { 0xC1, 0x61, 0xF2, 0xDC, 0xD5, 0x7E, 0x9C, 0x14, 0x39, 0xB3, 0x1A, 0x9D, 0xD4, 0x3D, 0x8F, 0x3D, 0x7D, 0xD8, 0xF0, 0xEB, 0x7C, 0xFA, 0xC6, 0xFB, 0x25, 0xA0, 0xF2, 0x8E, 0x30, 0x6F, 0x06, 0x61 }, ++ { 0xC0, 0x19, 0x69, 0xAD, 0x34, 0xC5, 0x2C, 0xAF, 0x3D, 0xC4, 0xD8, 0x0D, 0x19, 0x73, 0x5C, 0x29, 0x73, 0x1A, 0xC6, 0xE7, 0xA9, 0x20, 0x85, 0xAB, 0x92, 0x50, 0xC4, 0x8D, 0xEA, 0x48, 0xA3, 0xFC }, ++ { 0x17, 0x20, 0xB3, 0x65, 0x56, 0x19, 0xD2, 0xA5, 0x2B, 0x35, 0x21, 0xAE, 0x0E, 0x49, 0xE3, 0x45, 0xCB, 0x33, 0x89, 0xEB, 0xD6, 0x20, 0x8A, 0xCA, 0xF9, 0xF1, 0x3F, 0xDA, 0xCC, 0xA8, 0xBE, 0x49 }, ++ { 0x75, 0x62, 0x88, 0x36, 0x1C, 0x83, 0xE2, 0x4C, 0x61, 0x7C, 0xF9, 0x5C, 0x90, 0x5B, 0x22, 0xD0, 0x17, 0xCD, 0xC8, 0x6F, 0x0B, 0xF1, 0xD6, 0x58, 0xF4, 0x75, 0x6C, 0x73, 0x79, 0x87, 0x3B, 0x7F }, ++ { 0xE7, 0xD0, 0xED, 0xA3, 0x45, 0x26, 0x93, 0xB7, 0x52, 0xAB, 0xCD, 0xA1, 0xB5, 0x5E, 0x27, 0x6F, 0x82, 0x69, 0x8F, 0x5F, 0x16, 0x05, 0x40, 0x3E, 0xFF, 0x83, 0x0B, 0xEA, 0x00, 0x71, 0xA3, 0x94 }, ++ { 0x2C, 0x82, 0xEC, 0xAA, 0x6B, 0x84, 0x80, 0x3E, 0x04, 0x4A, 0xF6, 0x31, 0x18, 0xAF, 0xE5, 0x44, 0x68, 0x7C, 0xB6, 0xE6, 0xC7, 0xDF, 0x49, 0xED, 0x76, 0x2D, 0xFD, 0x7C, 0x86, 0x93, 0xA1, 0xBC }, ++ { 0x61, 0x36, 0xCB, 0xF4, 0xB4, 0x41, 0x05, 0x6F, 0xA1, 0xE2, 0x72, 0x24, 0x98, 0x12, 0x5D, 0x6D, 0xED, 0x45, 0xE1, 0x7B, 0x52, 0x14, 0x39, 0x59, 0xC7, 0xF4, 0xD4, 0xE3, 0x95, 0x21, 0x8A, 0xC2 }, ++ { 0x72, 0x1D, 0x32, 0x45, 0xAA, 0xFE, 0xF2, 0x7F, 0x6A, 0x62, 0x4F, 0x47, 0x95, 0x4B, 0x6C, 0x25, 0x50, 0x79, 0x52, 0x6F, 0xFA, 0x25, 0xE9, 0xFF, 0x77, 0xE5, 0xDC, 0xFF, 0x47, 0x3B, 0x15, 0x97 }, ++ { 0x9D, 0xD2, 0xFB, 0xD8, 0xCE, 0xF1, 0x6C, 0x35, 0x3C, 0x0A, 0xC2, 0x11, 0x91, 0xD5, 0x09, 0xEB, 0x28, 0xDD, 0x9E, 0x3E, 0x0D, 0x8C, 0xEA, 0x5D, 0x26, 0xCA, 0x83, 0x93, 0x93, 0x85, 0x1C, 0x3A }, ++ { 0xB2, 0x39, 0x4C, 0xEA, 0xCD, 0xEB, 0xF2, 0x1B, 0xF9, 0xDF, 0x2C, 0xED, 0x98, 0xE5, 0x8F, 0x1C, 0x3A, 0x4B, 0xBB, 0xFF, 0x66, 0x0D, 0xD9, 0x00, 0xF6, 0x22, 0x02, 0xD6, 0x78, 0x5C, 0xC4, 0x6E }, ++ { 0x57, 0x08, 0x9F, 0x22, 0x27, 0x49, 0xAD, 0x78, 0x71, 0x76, 0x5F, 0x06, 0x2B, 0x11, 0x4F, 0x43, 0xBA, 0x20, 0xEC, 0x56, 0x42, 0x2A, 0x8B, 0x1E, 0x3F, 0x87, 0x19, 0x2C, 0x0E, 0xA7, 0x18, 0xC6 }, ++ { 0xE4, 0x9A, 0x94, 0x59, 0x96, 0x1C, 0xD3, 0x3C, 0xDF, 0x4A, 0xAE, 0x1B, 0x10, 0x78, 0xA5, 0xDE, 0xA7, 0xC0, 0x40, 0xE0, 0xFE, 0xA3, 0x40, 0xC9, 0x3A, 0x72, 0x48, 0x72, 0xFC, 0x4A, 0xF8, 0x06 }, ++ { 0xED, 0xE6, 0x7F, 0x72, 0x0E, 0xFF, 0xD2, 0xCA, 0x9C, 0x88, 0x99, 0x41, 0x52, 0xD0, 0x20, 0x1D, 0xEE, 0x6B, 0x0A, 0x2D, 0x2C, 0x07, 0x7A, 0xCA, 0x6D, 0xAE, 0x29, 0xF7, 0x3F, 0x8B, 0x63, 0x09 }, ++ { 0xE0, 0xF4, 0x34, 0xBF, 0x22, 0xE3, 0x08, 0x80, 0x39, 0xC2, 0x1F, 0x71, 0x9F, 0xFC, 0x67, 0xF0, 0xF2, 0xCB, 0x5E, 0x98, 0xA7, 0xA0, 0x19, 0x4C, 0x76, 0xE9, 0x6B, 0xF4, 0xE8, 0xE1, 0x7E, 0x61 }, ++ { 0x27, 0x7C, 0x04, 0xE2, 0x85, 0x34, 0x84, 0xA4, 0xEB, 0xA9, 0x10, 0xAD, 0x33, 0x6D, 0x01, 0xB4, 0x77, 0xB6, 0x7C, 0xC2, 0x00, 0xC5, 0x9F, 0x3C, 0x8D, 0x77, 0xEE, 0xF8, 0x49, 0x4F, 0x29, 0xCD }, ++ { 0x15, 0x6D, 0x57, 0x47, 0xD0, 0xC9, 0x9C, 0x7F, 0x27, 0x09, 0x7D, 0x7B, 0x7E, 0x00, 0x2B, 0x2E, 0x18, 0x5C, 0xB7, 0x2D, 0x8D, 0xD7, 0xEB, 0x42, 0x4A, 0x03, 0x21, 0x52, 0x81, 0x61, 0x21, 0x9F }, ++ { 0x20, 0xDD, 0xD1, 0xED, 0x9B, 0x1C, 0xA8, 0x03, 0x94, 0x6D, 0x64, 0xA8, 0x3A, 0xE4, 0x65, 0x9D, 0xA6, 0x7F, 0xBA, 0x7A, 0x1A, 0x3E, 0xDD, 0xB1, 0xE1, 0x03, 0xC0, 0xF5, 0xE0, 0x3E, 0x3A, 0x2C }, ++ { 0xF0, 0xAF, 0x60, 0x4D, 0x3D, 0xAB, 0xBF, 0x9A, 0x0F, 0x2A, 0x7D, 0x3D, 0xDA, 0x6B, 0xD3, 0x8B, 0xBA, 0x72, 0xC6, 0xD0, 0x9B, 0xE4, 0x94, 0xFC, 0xEF, 0x71, 0x3F, 0xF1, 0x01, 0x89, 0xB6, 0xE6 }, ++ { 0x98, 0x02, 0xBB, 0x87, 0xDE, 0xF4, 0xCC, 0x10, 0xC4, 0xA5, 0xFD, 0x49, 0xAA, 0x58, 0xDF, 0xE2, 0xF3, 0xFD, 0xDB, 0x46, 0xB4, 0x70, 0x88, 0x14, 0xEA, 0xD8, 0x1D, 0x23, 0xBA, 0x95, 0x13, 0x9B }, ++ { 0x4F, 0x8C, 0xE1, 0xE5, 0x1D, 0x2F, 0xE7, 0xF2, 0x40, 0x43, 0xA9, 0x04, 0xD8, 0x98, 0xEB, 0xFC, 0x91, 0x97, 0x54, 0x18, 0x75, 0x34, 0x13, 0xAA, 0x09, 0x9B, 0x79, 0x5E, 0xCB, 0x35, 0xCE, 0xDB }, ++ { 0xBD, 0xDC, 0x65, 0x14, 0xD7, 0xEE, 0x6A, 0xCE, 0x0A, 0x4A, 0xC1, 0xD0, 0xE0, 0x68, 0x11, 0x22, 0x88, 0xCB, 0xCF, 0x56, 0x04, 0x54, 0x64, 0x27, 0x05, 0x63, 0x01, 0x77, 0xCB, 0xA6, 0x08, 0xBD }, ++ { 0xD6, 0x35, 0x99, 0x4F, 0x62, 0x91, 0x51, 0x7B, 0x02, 0x81, 0xFF, 0xDD, 0x49, 0x6A, 0xFA, 0x86, 0x27, 0x12, 0xE5, 0xB3, 0xC4, 0xE5, 0x2E, 0x4C, 0xD5, 0xFD, 0xAE, 0x8C, 0x0E, 0x72, 0xFB, 0x08 }, ++ { 0x87, 0x8D, 0x9C, 0xA6, 0x00, 0xCF, 0x87, 0xE7, 0x69, 0xCC, 0x30, 0x5C, 0x1B, 0x35, 0x25, 0x51, 0x86, 0x61, 0x5A, 0x73, 0xA0, 0xDA, 0x61, 0x3B, 0x5F, 0x1C, 0x98, 0xDB, 0xF8, 0x12, 0x83, 0xEA }, ++ { 0xA6, 0x4E, 0xBE, 0x5D, 0xC1, 0x85, 0xDE, 0x9F, 0xDD, 0xE7, 0x60, 0x7B, 0x69, 0x98, 0x70, 0x2E, 0xB2, 0x34, 0x56, 0x18, 0x49, 0x57, 0x30, 0x7D, 0x2F, 0xA7, 0x2E, 0x87, 0xA4, 0x77, 0x02, 0xD6 }, ++ { 0xCE, 0x50, 0xEA, 0xB7, 0xB5, 0xEB, 0x52, 0xBD, 0xC9, 0xAD, 0x8E, 0x5A, 0x48, 0x0A, 0xB7, 0x80, 0xCA, 0x93, 0x20, 0xE4, 0x43, 0x60, 0xB1, 0xFE, 0x37, 0xE0, 0x3F, 0x2F, 0x7A, 0xD7, 0xDE, 0x01 }, ++ { 0xEE, 0xDD, 0xB7, 0xC0, 0xDB, 0x6E, 0x30, 0xAB, 0xE6, 0x6D, 0x79, 0xE3, 0x27, 0x51, 0x1E, 0x61, 0xFC, 0xEB, 0xBC, 0x29, 0xF1, 0x59, 0xB4, 0x0A, 0x86, 0xB0, 0x46, 0xEC, 0xF0, 0x51, 0x38, 0x23 }, ++ { 0x78, 0x7F, 0xC9, 0x34, 0x40, 0xC1, 0xEC, 0x96, 0xB5, 0xAD, 0x01, 0xC1, 0x6C, 0xF7, 0x79, 0x16, 0xA1, 0x40, 0x5F, 0x94, 0x26, 0x35, 0x6E, 0xC9, 0x21, 0xD8, 0xDF, 0xF3, 0xEA, 0x63, 0xB7, 0xE0 }, ++ { 0x7F, 0x0D, 0x5E, 0xAB, 0x47, 0xEE, 0xFD, 0xA6, 0x96, 0xC0, 0xBF, 0x0F, 0xBF, 0x86, 0xAB, 0x21, 0x6F, 0xCE, 0x46, 0x1E, 0x93, 0x03, 0xAB, 0xA6, 0xAC, 0x37, 0x41, 0x20, 0xE8, 0x90, 0xE8, 0xDF }, ++ { 0xB6, 0x80, 0x04, 0xB4, 0x2F, 0x14, 0xAD, 0x02, 0x9F, 0x4C, 0x2E, 0x03, 0xB1, 0xD5, 0xEB, 0x76, 0xD5, 0x71, 0x60, 0xE2, 0x64, 0x76, 0xD2, 0x11, 0x31, 0xBE, 0xF2, 0x0A, 0xDA, 0x7D, 0x27, 0xF4 }, ++ { 0xB0, 0xC4, 0xEB, 0x18, 0xAE, 0x25, 0x0B, 0x51, 0xA4, 0x13, 0x82, 0xEA, 0xD9, 0x2D, 0x0D, 0xC7, 0x45, 0x5F, 0x93, 0x79, 0xFC, 0x98, 0x84, 0x42, 0x8E, 0x47, 0x70, 0x60, 0x8D, 0xB0, 0xFA, 0xEC }, ++ { 0xF9, 0x2B, 0x7A, 0x87, 0x0C, 0x05, 0x9F, 0x4D, 0x46, 0x46, 0x4C, 0x82, 0x4E, 0xC9, 0x63, 0x55, 0x14, 0x0B, 0xDC, 0xE6, 0x81, 0x32, 0x2C, 0xC3, 0xA9, 0x92, 0xFF, 0x10, 0x3E, 0x3F, 0xEA, 0x52 }, ++ { 0x53, 0x64, 0x31, 0x26, 0x14, 0x81, 0x33, 0x98, 0xCC, 0x52, 0x5D, 0x4C, 0x4E, 0x14, 0x6E, 0xDE, 0xB3, 0x71, 0x26, 0x5F, 0xBA, 0x19, 0x13, 0x3A, 0x2C, 0x3D, 0x21, 0x59, 0x29, 0x8A, 0x17, 0x42 }, ++ { 0xF6, 0x62, 0x0E, 0x68, 0xD3, 0x7F, 0xB2, 0xAF, 0x50, 0x00, 0xFC, 0x28, 0xE2, 0x3B, 0x83, 0x22, 0x97, 0xEC, 0xD8, 0xBC, 0xE9, 0x9E, 0x8B, 0xE4, 0xD0, 0x4E, 0x85, 0x30, 0x9E, 0x3D, 0x33, 0x74 }, ++ { 0x53, 0x16, 0xA2, 0x79, 0x69, 0xD7, 0xFE, 0x04, 0xFF, 0x27, 0xB2, 0x83, 0x96, 0x1B, 0xFF, 0xC3, 0xBF, 0x5D, 0xFB, 0x32, 0xFB, 0x6A, 0x89, 0xD1, 0x01, 0xC6, 0xC3, 0xB1, 0x93, 0x7C, 0x28, 0x71 }, ++ { 0x81, 0xD1, 0x66, 0x4F, 0xDF, 0x3C, 0xB3, 0x3C, 0x24, 0xEE, 0xBA, 0xC0, 0xBD, 0x64, 0x24, 0x4B, 0x77, 0xC4, 0xAB, 0xEA, 0x90, 0xBB, 0xE8, 0xB5, 0xEE, 0x0B, 0x2A, 0xAF, 0xCF, 0x2D, 0x6A, 0x53 }, ++ { 0x34, 0x57, 0x82, 0xF2, 0x95, 0xB0, 0x88, 0x03, 0x52, 0xE9, 0x24, 0xA0, 0x46, 0x7B, 0x5F, 0xBC, 0x3E, 0x8F, 0x3B, 0xFB, 0xC3, 0xC7, 0xE4, 0x8B, 0x67, 0x09, 0x1F, 0xB5, 0xE8, 0x0A, 0x94, 0x42 }, ++ { 0x79, 0x41, 0x11, 0xEA, 0x6C, 0xD6, 0x5E, 0x31, 0x1F, 0x74, 0xEE, 0x41, 0xD4, 0x76, 0xCB, 0x63, 0x2C, 0xE1, 0xE4, 0xB0, 0x51, 0xDC, 0x1D, 0x9E, 0x9D, 0x06, 0x1A, 0x19, 0xE1, 0xD0, 0xBB, 0x49 }, ++ { 0x2A, 0x85, 0xDA, 0xF6, 0x13, 0x88, 0x16, 0xB9, 0x9B, 0xF8, 0xD0, 0x8B, 0xA2, 0x11, 0x4B, 0x7A, 0xB0, 0x79, 0x75, 0xA7, 0x84, 0x20, 0xC1, 0xA3, 0xB0, 0x6A, 0x77, 0x7C, 0x22, 0xDD, 0x8B, 0xCB }, ++ { 0x89, 0xB0, 0xD5, 0xF2, 0x89, 0xEC, 0x16, 0x40, 0x1A, 0x06, 0x9A, 0x96, 0x0D, 0x0B, 0x09, 0x3E, 0x62, 0x5D, 0xA3, 0xCF, 0x41, 0xEE, 0x29, 0xB5, 0x9B, 0x93, 0x0C, 0x58, 0x20, 0x14, 0x54, 0x55 }, ++ { 0xD0, 0xFD, 0xCB, 0x54, 0x39, 0x43, 0xFC, 0x27, 0xD2, 0x08, 0x64, 0xF5, 0x21, 0x81, 0x47, 0x1B, 0x94, 0x2C, 0xC7, 0x7C, 0xA6, 0x75, 0xBC, 0xB3, 0x0D, 0xF3, 0x1D, 0x35, 0x8E, 0xF7, 0xB1, 0xEB }, ++ { 0xB1, 0x7E, 0xA8, 0xD7, 0x70, 0x63, 0xC7, 0x09, 0xD4, 0xDC, 0x6B, 0x87, 0x94, 0x13, 0xC3, 0x43, 0xE3, 0x79, 0x0E, 0x9E, 0x62, 0xCA, 0x85, 0xB7, 0x90, 0x0B, 0x08, 0x6F, 0x6B, 0x75, 0xC6, 0x72 }, ++ { 0xE7, 0x1A, 0x3E, 0x2C, 0x27, 0x4D, 0xB8, 0x42, 0xD9, 0x21, 0x14, 0xF2, 0x17, 0xE2, 0xC0, 0xEA, 0xC8, 0xB4, 0x50, 0x93, 0xFD, 0xFD, 0x9D, 0xF4, 0xCA, 0x71, 0x62, 0x39, 0x48, 0x62, 0xD5, 0x01 }, ++ { 0xC0, 0x47, 0x67, 0x59, 0xAB, 0x7A, 0xA3, 0x33, 0x23, 0x4F, 0x6B, 0x44, 0xF5, 0xFD, 0x85, 0x83, 0x90, 0xEC, 0x23, 0x69, 0x4C, 0x62, 0x2C, 0xB9, 0x86, 0xE7, 0x69, 0xC7, 0x8E, 0xDD, 0x73, 0x3E }, ++ { 0x9A, 0xB8, 0xEA, 0xBB, 0x14, 0x16, 0x43, 0x4D, 0x85, 0x39, 0x13, 0x41, 0xD5, 0x69, 0x93, 0xC5, 0x54, 0x58, 0x16, 0x7D, 0x44, 0x18, 0xB1, 0x9A, 0x0F, 0x2A, 0xD8, 0xB7, 0x9A, 0x83, 0xA7, 0x5B }, ++ { 0x79, 0x92, 0xD0, 0xBB, 0xB1, 0x5E, 0x23, 0x82, 0x6F, 0x44, 0x3E, 0x00, 0x50, 0x5D, 0x68, 0xD3, 0xED, 0x73, 0x72, 0x99, 0x5A, 0x5C, 0x3E, 0x49, 0x86, 0x54, 0x10, 0x2F, 0xBC, 0xD0, 0x96, 0x4E }, ++ { 0xC0, 0x21, 0xB3, 0x00, 0x85, 0x15, 0x14, 0x35, 0xDF, 0x33, 0xB0, 0x07, 0xCC, 0xEC, 0xC6, 0x9D, 0xF1, 0x26, 0x9F, 0x39, 0xBA, 0x25, 0x09, 0x2B, 0xED, 0x59, 0xD9, 0x32, 0xAC, 0x0F, 0xDC, 0x28 }, ++ { 0x91, 0xA2, 0x5E, 0xC0, 0xEC, 0x0D, 0x9A, 0x56, 0x7F, 0x89, 0xC4, 0xBF, 0xE1, 0xA6, 0x5A, 0x0E, 0x43, 0x2D, 0x07, 0x06, 0x4B, 0x41, 0x90, 0xE2, 0x7D, 0xFB, 0x81, 0x90, 0x1F, 0xD3, 0x13, 0x9B }, ++ { 0x59, 0x50, 0xD3, 0x9A, 0x23, 0xE1, 0x54, 0x5F, 0x30, 0x12, 0x70, 0xAA, 0x1A, 0x12, 0xF2, 0xE6, 0xC4, 0x53, 0x77, 0x6E, 0x4D, 0x63, 0x55, 0xDE, 0x42, 0x5C, 0xC1, 0x53, 0xF9, 0x81, 0x88, 0x67 }, ++ { 0xD7, 0x9F, 0x14, 0x72, 0x0C, 0x61, 0x0A, 0xF1, 0x79, 0xA3, 0x76, 0x5D, 0x4B, 0x7C, 0x09, 0x68, 0xF9, 0x77, 0x96, 0x2D, 0xBF, 0x65, 0x5B, 0x52, 0x12, 0x72, 0xB6, 0xF1, 0xE1, 0x94, 0x48, 0x8E }, ++ { 0xE9, 0x53, 0x1B, 0xFC, 0x8B, 0x02, 0x99, 0x5A, 0xEA, 0xA7, 0x5B, 0xA2, 0x70, 0x31, 0xFA, 0xDB, 0xCB, 0xF4, 0xA0, 0xDA, 0xB8, 0x96, 0x1D, 0x92, 0x96, 0xCD, 0x7E, 0x84, 0xD2, 0x5D, 0x60, 0x06 }, ++ { 0x34, 0xE9, 0xC2, 0x6A, 0x01, 0xD7, 0xF1, 0x61, 0x81, 0xB4, 0x54, 0xA9, 0xD1, 0x62, 0x3C, 0x23, 0x3C, 0xB9, 0x9D, 0x31, 0xC6, 0x94, 0x65, 0x6E, 0x94, 0x13, 0xAC, 0xA3, 0xE9, 0x18, 0x69, 0x2F }, ++ { 0xD9, 0xD7, 0x42, 0x2F, 0x43, 0x7B, 0xD4, 0x39, 0xDD, 0xD4, 0xD8, 0x83, 0xDA, 0xE2, 0xA0, 0x83, 0x50, 0x17, 0x34, 0x14, 0xBE, 0x78, 0x15, 0x51, 0x33, 0xFF, 0xF1, 0x96, 0x4C, 0x3D, 0x79, 0x72 }, ++ { 0x4A, 0xEE, 0x0C, 0x7A, 0xAF, 0x07, 0x54, 0x14, 0xFF, 0x17, 0x93, 0xEA, 0xD7, 0xEA, 0xCA, 0x60, 0x17, 0x75, 0xC6, 0x15, 0xDB, 0xD6, 0x0B, 0x64, 0x0B, 0x0A, 0x9F, 0x0C, 0xE5, 0x05, 0xD4, 0x35 }, ++ { 0x6B, 0xFD, 0xD1, 0x54, 0x59, 0xC8, 0x3B, 0x99, 0xF0, 0x96, 0xBF, 0xB4, 0x9E, 0xE8, 0x7B, 0x06, 0x3D, 0x69, 0xC1, 0x97, 0x4C, 0x69, 0x28, 0xAC, 0xFC, 0xFB, 0x40, 0x99, 0xF8, 0xC4, 0xEF, 0x67 }, ++ { 0x9F, 0xD1, 0xC4, 0x08, 0xFD, 0x75, 0xC3, 0x36, 0x19, 0x3A, 0x2A, 0x14, 0xD9, 0x4F, 0x6A, 0xF5, 0xAD, 0xF0, 0x50, 0xB8, 0x03, 0x87, 0xB4, 0xB0, 0x10, 0xFB, 0x29, 0xF4, 0xCC, 0x72, 0x70, 0x7C }, ++ { 0x13, 0xC8, 0x84, 0x80, 0xA5, 0xD0, 0x0D, 0x6C, 0x8C, 0x7A, 0xD2, 0x11, 0x0D, 0x76, 0xA8, 0x2D, 0x9B, 0x70, 0xF4, 0xFA, 0x66, 0x96, 0xD4, 0xE5, 0xDD, 0x42, 0xA0, 0x66, 0xDC, 0xAF, 0x99, 0x20 }, ++ { 0x82, 0x0E, 0x72, 0x5E, 0xE2, 0x5F, 0xE8, 0xFD, 0x3A, 0x8D, 0x5A, 0xBE, 0x4C, 0x46, 0xC3, 0xBA, 0x88, 0x9D, 0xE6, 0xFA, 0x91, 0x91, 0xAA, 0x22, 0xBA, 0x67, 0xD5, 0x70, 0x54, 0x21, 0x54, 0x2B }, ++ { 0x32, 0xD9, 0x3A, 0x0E, 0xB0, 0x2F, 0x42, 0xFB, 0xBC, 0xAF, 0x2B, 0xAD, 0x00, 0x85, 0xB2, 0x82, 0xE4, 0x60, 0x46, 0xA4, 0xDF, 0x7A, 0xD1, 0x06, 0x57, 0xC9, 0xD6, 0x47, 0x63, 0x75, 0xB9, 0x3E }, ++ { 0xAD, 0xC5, 0x18, 0x79, 0x05, 0xB1, 0x66, 0x9C, 0xD8, 0xEC, 0x9C, 0x72, 0x1E, 0x19, 0x53, 0x78, 0x6B, 0x9D, 0x89, 0xA9, 0xBA, 0xE3, 0x07, 0x80, 0xF1, 0xE1, 0xEA, 0xB2, 0x4A, 0x00, 0x52, 0x3C }, ++ { 0xE9, 0x07, 0x56, 0xFF, 0x7F, 0x9A, 0xD8, 0x10, 0xB2, 0x39, 0xA1, 0x0C, 0xED, 0x2C, 0xF9, 0xB2, 0x28, 0x43, 0x54, 0xC1, 0xF8, 0xC7, 0xE0, 0xAC, 0xCC, 0x24, 0x61, 0xDC, 0x79, 0x6D, 0x6E, 0x89 }, ++ { 0x12, 0x51, 0xF7, 0x6E, 0x56, 0x97, 0x84, 0x81, 0x87, 0x53, 0x59, 0x80, 0x1D, 0xB5, 0x89, 0xA0, 0xB2, 0x2F, 0x86, 0xD8, 0xD6, 0x34, 0xDC, 0x04, 0x50, 0x6F, 0x32, 0x2E, 0xD7, 0x8F, 0x17, 0xE8 }, ++ { 0x3A, 0xFA, 0x89, 0x9F, 0xD9, 0x80, 0xE7, 0x3E, 0xCB, 0x7F, 0x4D, 0x8B, 0x8F, 0x29, 0x1D, 0xC9, 0xAF, 0x79, 0x6B, 0xC6, 0x5D, 0x27, 0xF9, 0x74, 0xC6, 0xF1, 0x93, 0xC9, 0x19, 0x1A, 0x09, 0xFD }, ++ { 0xAA, 0x30, 0x5B, 0xE2, 0x6E, 0x5D, 0xED, 0xDC, 0x3C, 0x10, 0x10, 0xCB, 0xC2, 0x13, 0xF9, 0x5F, 0x05, 0x1C, 0x78, 0x5C, 0x5B, 0x43, 0x1E, 0x6A, 0x7C, 0xD0, 0x48, 0xF1, 0x61, 0x78, 0x75, 0x28 }, ++ { 0x8E, 0xA1, 0x88, 0x4F, 0xF3, 0x2E, 0x9D, 0x10, 0xF0, 0x39, 0xB4, 0x07, 0xD0, 0xD4, 0x4E, 0x7E, 0x67, 0x0A, 0xBD, 0x88, 0x4A, 0xEE, 0xE0, 0xFB, 0x75, 0x7A, 0xE9, 0x4E, 0xAA, 0x97, 0x37, 0x3D }, ++ { 0xD4, 0x82, 0xB2, 0x15, 0x5D, 0x4D, 0xEC, 0x6B, 0x47, 0x36, 0xA1, 0xF1, 0x61, 0x7B, 0x53, 0xAA, 0xA3, 0x73, 0x10, 0x27, 0x7D, 0x3F, 0xEF, 0x0C, 0x37, 0xAD, 0x41, 0x76, 0x8F, 0xC2, 0x35, 0xB4 }, ++ { 0x4D, 0x41, 0x39, 0x71, 0x38, 0x7E, 0x7A, 0x88, 0x98, 0xA8, 0xDC, 0x2A, 0x27, 0x50, 0x07, 0x78, 0x53, 0x9E, 0xA2, 0x14, 0xA2, 0xDF, 0xE9, 0xB3, 0xD7, 0xE8, 0xEB, 0xDC, 0xE5, 0xCF, 0x3D, 0xB3 }, ++ { 0x69, 0x6E, 0x5D, 0x46, 0xE6, 0xC5, 0x7E, 0x87, 0x96, 0xE4, 0x73, 0x5D, 0x08, 0x91, 0x6E, 0x0B, 0x79, 0x29, 0xB3, 0xCF, 0x29, 0x8C, 0x29, 0x6D, 0x22, 0xE9, 0xD3, 0x01, 0x96, 0x53, 0x37, 0x1C }, ++ { 0x1F, 0x56, 0x47, 0xC1, 0xD3, 0xB0, 0x88, 0x22, 0x88, 0x85, 0x86, 0x5C, 0x89, 0x40, 0x90, 0x8B, 0xF4, 0x0D, 0x1A, 0x82, 0x72, 0x82, 0x19, 0x73, 0xB1, 0x60, 0x00, 0x8E, 0x7A, 0x3C, 0xE2, 0xEB }, ++ { 0xB6, 0xE7, 0x6C, 0x33, 0x0F, 0x02, 0x1A, 0x5B, 0xDA, 0x65, 0x87, 0x50, 0x10, 0xB0, 0xED, 0xF0, 0x91, 0x26, 0xC0, 0xF5, 0x10, 0xEA, 0x84, 0x90, 0x48, 0x19, 0x20, 0x03, 0xAE, 0xF4, 0xC6, 0x1C }, ++ { 0x3C, 0xD9, 0x52, 0xA0, 0xBE, 0xAD, 0xA4, 0x1A, 0xBB, 0x42, 0x4C, 0xE4, 0x7F, 0x94, 0xB4, 0x2B, 0xE6, 0x4E, 0x1F, 0xFB, 0x0F, 0xD0, 0x78, 0x22, 0x76, 0x80, 0x79, 0x46, 0xD0, 0xD0, 0xBC, 0x55 }, ++ { 0x98, 0xD9, 0x26, 0x77, 0x43, 0x9B, 0x41, 0xB7, 0xBB, 0x51, 0x33, 0x12, 0xAF, 0xB9, 0x2B, 0xCC, 0x8E, 0xE9, 0x68, 0xB2, 0xE3, 0xB2, 0x38, 0xCE, 0xCB, 0x9B, 0x0F, 0x34, 0xC9, 0xBB, 0x63, 0xD0 }, ++ { 0xEC, 0xBC, 0xA2, 0xCF, 0x08, 0xAE, 0x57, 0xD5, 0x17, 0xAD, 0x16, 0x15, 0x8A, 0x32, 0xBF, 0xA7, 0xDC, 0x03, 0x82, 0xEA, 0xED, 0xA1, 0x28, 0xE9, 0x18, 0x86, 0x73, 0x4C, 0x24, 0xA0, 0xB2, 0x9D }, ++ { 0x94, 0x2C, 0xC7, 0xC0, 0xB5, 0x2E, 0x2B, 0x16, 0xA4, 0xB8, 0x9F, 0xA4, 0xFC, 0x7E, 0x0B, 0xF6, 0x09, 0xE2, 0x9A, 0x08, 0xC1, 0xA8, 0x54, 0x34, 0x52, 0xB7, 0x7C, 0x7B, 0xFD, 0x11, 0xBB, 0x28 }, ++ { 0x8A, 0x06, 0x5D, 0x8B, 0x61, 0xA0, 0xDF, 0xFB, 0x17, 0x0D, 0x56, 0x27, 0x73, 0x5A, 0x76, 0xB0, 0xE9, 0x50, 0x60, 0x37, 0x80, 0x8C, 0xBA, 0x16, 0xC3, 0x45, 0x00, 0x7C, 0x9F, 0x79, 0xCF, 0x8F }, ++ { 0x1B, 0x9F, 0xA1, 0x97, 0x14, 0x65, 0x9C, 0x78, 0xFF, 0x41, 0x38, 0x71, 0x84, 0x92, 0x15, 0x36, 0x10, 0x29, 0xAC, 0x80, 0x2B, 0x1C, 0xBC, 0xD5, 0x4E, 0x40, 0x8B, 0xD8, 0x72, 0x87, 0xF8, 0x1F }, ++ { 0x8D, 0xAB, 0x07, 0x1B, 0xCD, 0x6C, 0x72, 0x92, 0xA9, 0xEF, 0x72, 0x7B, 0x4A, 0xE0, 0xD8, 0x67, 0x13, 0x30, 0x1D, 0xA8, 0x61, 0x8D, 0x9A, 0x48, 0xAD, 0xCE, 0x55, 0xF3, 0x03, 0xA8, 0x69, 0xA1 }, ++ { 0x82, 0x53, 0xE3, 0xE7, 0xC7, 0xB6, 0x84, 0xB9, 0xCB, 0x2B, 0xEB, 0x01, 0x4C, 0xE3, 0x30, 0xFF, 0x3D, 0x99, 0xD1, 0x7A, 0xBB, 0xDB, 0xAB, 0xE4, 0xF4, 0xD6, 0x74, 0xDE, 0xD5, 0x3F, 0xFC, 0x6B }, ++ { 0xF1, 0x95, 0xF3, 0x21, 0xE9, 0xE3, 0xD6, 0xBD, 0x7D, 0x07, 0x45, 0x04, 0xDD, 0x2A, 0xB0, 0xE6, 0x24, 0x1F, 0x92, 0xE7, 0x84, 0xB1, 0xAA, 0x27, 0x1F, 0xF6, 0x48, 0xB1, 0xCA, 0xB6, 0xD7, 0xF6 }, ++ { 0x27, 0xE4, 0xCC, 0x72, 0x09, 0x0F, 0x24, 0x12, 0x66, 0x47, 0x6A, 0x7C, 0x09, 0x49, 0x5F, 0x2D, 0xB1, 0x53, 0xD5, 0xBC, 0xBD, 0x76, 0x19, 0x03, 0xEF, 0x79, 0x27, 0x5E, 0xC5, 0x6B, 0x2E, 0xD8 }, ++ { 0x89, 0x9C, 0x24, 0x05, 0x78, 0x8E, 0x25, 0xB9, 0x9A, 0x18, 0x46, 0x35, 0x5E, 0x64, 0x6D, 0x77, 0xCF, 0x40, 0x00, 0x83, 0x41, 0x5F, 0x7D, 0xC5, 0xAF, 0xE6, 0x9D, 0x6E, 0x17, 0xC0, 0x00, 0x23 }, ++ { 0xA5, 0x9B, 0x78, 0xC4, 0x90, 0x57, 0x44, 0x07, 0x6B, 0xFE, 0xE8, 0x94, 0xDE, 0x70, 0x7D, 0x4F, 0x12, 0x0B, 0x5C, 0x68, 0x93, 0xEA, 0x04, 0x00, 0x29, 0x7D, 0x0B, 0xB8, 0x34, 0x72, 0x76, 0x32 }, ++ { 0x59, 0xDC, 0x78, 0xB1, 0x05, 0x64, 0x97, 0x07, 0xA2, 0xBB, 0x44, 0x19, 0xC4, 0x8F, 0x00, 0x54, 0x00, 0xD3, 0x97, 0x3D, 0xE3, 0x73, 0x66, 0x10, 0x23, 0x04, 0x35, 0xB1, 0x04, 0x24, 0xB2, 0x4F }, ++ { 0xC0, 0x14, 0x9D, 0x1D, 0x7E, 0x7A, 0x63, 0x53, 0xA6, 0xD9, 0x06, 0xEF, 0xE7, 0x28, 0xF2, 0xF3, 0x29, 0xFE, 0x14, 0xA4, 0x14, 0x9A, 0x3E, 0xA7, 0x76, 0x09, 0xBC, 0x42, 0xB9, 0x75, 0xDD, 0xFA }, ++ { 0xA3, 0x2F, 0x24, 0x14, 0x74, 0xA6, 0xC1, 0x69, 0x32, 0xE9, 0x24, 0x3B, 0xE0, 0xCF, 0x09, 0xBC, 0xDC, 0x7E, 0x0C, 0xA0, 0xE7, 0xA6, 0xA1, 0xB9, 0xB1, 0xA0, 0xF0, 0x1E, 0x41, 0x50, 0x23, 0x77 }, ++ { 0xB2, 0x39, 0xB2, 0xE4, 0xF8, 0x18, 0x41, 0x36, 0x1C, 0x13, 0x39, 0xF6, 0x8E, 0x2C, 0x35, 0x9F, 0x92, 0x9A, 0xF9, 0xAD, 0x9F, 0x34, 0xE0, 0x1A, 0xAB, 0x46, 0x31, 0xAD, 0x6D, 0x55, 0x00, 0xB0 }, ++ { 0x85, 0xFB, 0x41, 0x9C, 0x70, 0x02, 0xA3, 0xE0, 0xB4, 0xB6, 0xEA, 0x09, 0x3B, 0x4C, 0x1A, 0xC6, 0x93, 0x66, 0x45, 0xB6, 0x5D, 0xAC, 0x5A, 0xC1, 0x5A, 0x85, 0x28, 0xB7, 0xB9, 0x4C, 0x17, 0x54 }, ++ { 0x96, 0x19, 0x72, 0x06, 0x25, 0xF1, 0x90, 0xB9, 0x3A, 0x3F, 0xAD, 0x18, 0x6A, 0xB3, 0x14, 0x18, 0x96, 0x33, 0xC0, 0xD3, 0xA0, 0x1E, 0x6F, 0x9B, 0xC8, 0xC4, 0xA8, 0xF8, 0x2F, 0x38, 0x3D, 0xBF }, ++ { 0x7D, 0x62, 0x0D, 0x90, 0xFE, 0x69, 0xFA, 0x46, 0x9A, 0x65, 0x38, 0x38, 0x89, 0x70, 0xA1, 0xAA, 0x09, 0xBB, 0x48, 0xA2, 0xD5, 0x9B, 0x34, 0x7B, 0x97, 0xE8, 0xCE, 0x71, 0xF4, 0x8C, 0x7F, 0x46 }, ++ { 0x29, 0x43, 0x83, 0x56, 0x85, 0x96, 0xFB, 0x37, 0xC7, 0x5B, 0xBA, 0xCD, 0x97, 0x9C, 0x5F, 0xF6, 0xF2, 0x0A, 0x55, 0x6B, 0xF8, 0x87, 0x9C, 0xC7, 0x29, 0x24, 0x85, 0x5D, 0xF9, 0xB8, 0x24, 0x0E }, ++ { 0x16, 0xB1, 0x8A, 0xB3, 0x14, 0x35, 0x9C, 0x2B, 0x83, 0x3C, 0x1C, 0x69, 0x86, 0xD4, 0x8C, 0x55, 0xA9, 0xFC, 0x97, 0xCD, 0xE9, 0xA3, 0xC1, 0xF1, 0x0A, 0x31, 0x77, 0x14, 0x0F, 0x73, 0xF7, 0x38 }, ++ { 0x8C, 0xBB, 0xDD, 0x14, 0xBC, 0x33, 0xF0, 0x4C, 0xF4, 0x58, 0x13, 0xE4, 0xA1, 0x53, 0xA2, 0x73, 0xD3, 0x6A, 0xDA, 0xD5, 0xCE, 0x71, 0xF4, 0x99, 0xEE, 0xB8, 0x7F, 0xB8, 0xAC, 0x63, 0xB7, 0x29 }, ++ { 0x69, 0xC9, 0xA4, 0x98, 0xDB, 0x17, 0x4E, 0xCA, 0xEF, 0xCC, 0x5A, 0x3A, 0xC9, 0xFD, 0xED, 0xF0, 0xF8, 0x13, 0xA5, 0xBE, 0xC7, 0x27, 0xF1, 0xE7, 0x75, 0xBA, 0xBD, 0xEC, 0x77, 0x18, 0x81, 0x6E }, ++ { 0xB4, 0x62, 0xC3, 0xBE, 0x40, 0x44, 0x8F, 0x1D, 0x4F, 0x80, 0x62, 0x62, 0x54, 0xE5, 0x35, 0xB0, 0x8B, 0xC9, 0xCD, 0xCF, 0xF5, 0x99, 0xA7, 0x68, 0x57, 0x8D, 0x4B, 0x28, 0x81, 0xA8, 0xE3, 0xF0 }, ++ { 0x55, 0x3E, 0x9D, 0x9C, 0x5F, 0x36, 0x0A, 0xC0, 0xB7, 0x4A, 0x7D, 0x44, 0xE5, 0xA3, 0x91, 0xDA, 0xD4, 0xCE, 0xD0, 0x3E, 0x0C, 0x24, 0x18, 0x3B, 0x7E, 0x8E, 0xCA, 0xBD, 0xF1, 0x71, 0x5A, 0x64 }, ++ { 0x7A, 0x7C, 0x55, 0xA5, 0x6F, 0xA9, 0xAE, 0x51, 0xE6, 0x55, 0xE0, 0x19, 0x75, 0xD8, 0xA6, 0xFF, 0x4A, 0xE9, 0xE4, 0xB4, 0x86, 0xFC, 0xBE, 0x4E, 0xAC, 0x04, 0x45, 0x88, 0xF2, 0x45, 0xEB, 0xEA }, ++ { 0x2A, 0xFD, 0xF3, 0xC8, 0x2A, 0xBC, 0x48, 0x67, 0xF5, 0xDE, 0x11, 0x12, 0x86, 0xC2, 0xB3, 0xBE, 0x7D, 0x6E, 0x48, 0x65, 0x7B, 0xA9, 0x23, 0xCF, 0xBF, 0x10, 0x1A, 0x6D, 0xFC, 0xF9, 0xDB, 0x9A }, ++ { 0x41, 0x03, 0x7D, 0x2E, 0xDC, 0xDC, 0xE0, 0xC4, 0x9B, 0x7F, 0xB4, 0xA6, 0xAA, 0x09, 0x99, 0xCA, 0x66, 0x97, 0x6C, 0x74, 0x83, 0xAF, 0xE6, 0x31, 0xD4, 0xED, 0xA2, 0x83, 0x14, 0x4F, 0x6D, 0xFC }, ++ { 0xC4, 0x46, 0x6F, 0x84, 0x97, 0xCA, 0x2E, 0xEB, 0x45, 0x83, 0xA0, 0xB0, 0x8E, 0x9D, 0x9A, 0xC7, 0x43, 0x95, 0x70, 0x9F, 0xDA, 0x10, 0x9D, 0x24, 0xF2, 0xE4, 0x46, 0x21, 0x96, 0x77, 0x9C, 0x5D }, ++ { 0x75, 0xF6, 0x09, 0x33, 0x8A, 0xA6, 0x7D, 0x96, 0x9A, 0x2A, 0xE2, 0xA2, 0x36, 0x2B, 0x2D, 0xA9, 0xD7, 0x7C, 0x69, 0x5D, 0xFD, 0x1D, 0xF7, 0x22, 0x4A, 0x69, 0x01, 0xDB, 0x93, 0x2C, 0x33, 0x64 }, ++ { 0x68, 0x60, 0x6C, 0xEB, 0x98, 0x9D, 0x54, 0x88, 0xFC, 0x7C, 0xF6, 0x49, 0xF3, 0xD7, 0xC2, 0x72, 0xEF, 0x05, 0x5D, 0xA1, 0xA9, 0x3F, 0xAE, 0xCD, 0x55, 0xFE, 0x06, 0xF6, 0x96, 0x70, 0x98, 0xCA }, ++ { 0x44, 0x34, 0x6B, 0xDE, 0xB7, 0xE0, 0x52, 0xF6, 0x25, 0x50, 0x48, 0xF0, 0xD9, 0xB4, 0x2C, 0x42, 0x5B, 0xAB, 0x9C, 0x3D, 0xD2, 0x41, 0x68, 0x21, 0x2C, 0x3E, 0xCF, 0x1E, 0xBF, 0x34, 0xE6, 0xAE }, ++ { 0x8E, 0x9C, 0xF6, 0xE1, 0xF3, 0x66, 0x47, 0x1F, 0x2A, 0xC7, 0xD2, 0xEE, 0x9B, 0x5E, 0x62, 0x66, 0xFD, 0xA7, 0x1F, 0x8F, 0x2E, 0x41, 0x09, 0xF2, 0x23, 0x7E, 0xD5, 0xF8, 0x81, 0x3F, 0xC7, 0x18 }, ++ { 0x84, 0xBB, 0xEB, 0x84, 0x06, 0xD2, 0x50, 0x95, 0x1F, 0x8C, 0x1B, 0x3E, 0x86, 0xA7, 0xC0, 0x10, 0x08, 0x29, 0x21, 0x83, 0x3D, 0xFD, 0x95, 0x55, 0xA2, 0xF9, 0x09, 0xB1, 0x08, 0x6E, 0xB4, 0xB8 }, ++ { 0xEE, 0x66, 0x6F, 0x3E, 0xEF, 0x0F, 0x7E, 0x2A, 0x9C, 0x22, 0x29, 0x58, 0xC9, 0x7E, 0xAF, 0x35, 0xF5, 0x1C, 0xED, 0x39, 0x3D, 0x71, 0x44, 0x85, 0xAB, 0x09, 0xA0, 0x69, 0x34, 0x0F, 0xDF, 0x88 }, ++ { 0xC1, 0x53, 0xD3, 0x4A, 0x65, 0xC4, 0x7B, 0x4A, 0x62, 0xC5, 0xCA, 0xCF, 0x24, 0x01, 0x09, 0x75, 0xD0, 0x35, 0x6B, 0x2F, 0x32, 0xC8, 0xF5, 0xDA, 0x53, 0x0D, 0x33, 0x88, 0x16, 0xAD, 0x5D, 0xE6 }, ++ { 0x9F, 0xC5, 0x45, 0x01, 0x09, 0xE1, 0xB7, 0x79, 0xF6, 0xC7, 0xAE, 0x79, 0xD5, 0x6C, 0x27, 0x63, 0x5C, 0x8D, 0xD4, 0x26, 0xC5, 0xA9, 0xD5, 0x4E, 0x25, 0x78, 0xDB, 0x98, 0x9B, 0x8C, 0x3B, 0x4E }, ++ { 0xD1, 0x2B, 0xF3, 0x73, 0x2E, 0xF4, 0xAF, 0x5C, 0x22, 0xFA, 0x90, 0x35, 0x6A, 0xF8, 0xFC, 0x50, 0xFC, 0xB4, 0x0F, 0x8F, 0x2E, 0xA5, 0xC8, 0x59, 0x47, 0x37, 0xA3, 0xB3, 0xD5, 0xAB, 0xDB, 0xD7 }, ++ { 0x11, 0x03, 0x0B, 0x92, 0x89, 0xBB, 0xA5, 0xAF, 0x65, 0x26, 0x06, 0x72, 0xAB, 0x6F, 0xEE, 0x88, 0xB8, 0x74, 0x20, 0xAC, 0xEF, 0x4A, 0x17, 0x89, 0xA2, 0x07, 0x3B, 0x7E, 0xC2, 0xF2, 0xA0, 0x9E }, ++ { 0x69, 0xCB, 0x19, 0x2B, 0x84, 0x44, 0x00, 0x5C, 0x8C, 0x0C, 0xEB, 0x12, 0xC8, 0x46, 0x86, 0x07, 0x68, 0x18, 0x8C, 0xDA, 0x0A, 0xEC, 0x27, 0xA9, 0xC8, 0xA5, 0x5C, 0xDE, 0xE2, 0x12, 0x36, 0x32 }, ++ { 0xDB, 0x44, 0x4C, 0x15, 0x59, 0x7B, 0x5F, 0x1A, 0x03, 0xD1, 0xF9, 0xED, 0xD1, 0x6E, 0x4A, 0x9F, 0x43, 0xA6, 0x67, 0xCC, 0x27, 0x51, 0x75, 0xDF, 0xA2, 0xB7, 0x04, 0xE3, 0xBB, 0x1A, 0x9B, 0x83 }, ++ { 0x3F, 0xB7, 0x35, 0x06, 0x1A, 0xBC, 0x51, 0x9D, 0xFE, 0x97, 0x9E, 0x54, 0xC1, 0xEE, 0x5B, 0xFA, 0xD0, 0xA9, 0xD8, 0x58, 0xB3, 0x31, 0x5B, 0xAD, 0x34, 0xBD, 0xE9, 0x99, 0xEF, 0xD7, 0x24, 0xDD } ++}; ++ ++bool __init blake2s_selftest(void) ++{ ++ u8 key[BLAKE2S_KEYBYTES]; ++ u8 buf[ARRAY_SIZE(blake2s_testvecs)]; ++ u8 hash[BLAKE2S_OUTBYTES]; ++ size_t i; ++ bool success = true; ++ ++ for (i = 0; i < BLAKE2S_KEYBYTES; ++i) ++ key[i] = (u8)i; ++ ++ for (i = 0; i < ARRAY_SIZE(blake2s_testvecs); ++i) ++ buf[i] = (u8)i; ++ ++ for (i = 0; i < ARRAY_SIZE(blake2s_keyed_testvecs); ++i) { ++ blake2s(hash, buf, key, BLAKE2S_OUTBYTES, i, BLAKE2S_KEYBYTES); ++ if (memcmp(hash, blake2s_keyed_testvecs[i], BLAKE2S_OUTBYTES)) { ++ pr_info("blake2s keyed self-test %zu: FAIL\n", i + 1); ++ success = false; ++ } ++ } ++ ++ for (i = 0; i < ARRAY_SIZE(blake2s_testvecs); ++i) { ++ blake2s(hash, buf, NULL, BLAKE2S_OUTBYTES, i, 0); ++ if (memcmp(hash, blake2s_testvecs[i], BLAKE2S_OUTBYTES)) { ++ pr_info("blake2s unkeyed self-test %zu: FAIL\n", i + i); ++ success = false; ++ } ++ } ++ ++ if (success) ++ pr_info("blake2s self-tests: pass\n"); ++ return success; ++} ++#endif +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/selftest/chacha20poly1305.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,333 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifdef DEBUG ++struct chacha20poly1305_testvec { ++ u8 *key, *nonce, *assoc, *input, *result; ++ size_t alen, ilen; ++}; ++ ++/* The first of these are the ChaCha20-Poly1305 AEAD test vectors from RFC7539 2.8.2. The rest are generated by: ++ * #!/usr/bin/env python3 ++ * ++ * from cryptography.hazmat.primitives.ciphers.aead import ChaCha20Poly1305 ++ * import os ++ * ++ * def encode_blob(blob): ++ * a = "" ++ * for i in blob: ++ * a += "\\x" + hex(i)[2:] ++ * return a ++ * ++ * enc = [ ] ++ * dec = [ ] ++ * ++ * def make_vector(plen, adlen): ++ * key = os.urandom(32) ++ * nonce = os.urandom(8) ++ * p = os.urandom(plen) ++ * ad = os.urandom(adlen) ++ * c = ChaCha20Poly1305(key).encrypt(nonce=bytes(4) + nonce, data=p, associated_data=ad) ++ * ++ * out = "{\n" ++ * out += "\t.key\t= \"" + encode_blob(key) + "\",\n" ++ * out += "\t.nonce\t= \"" + encode_blob(nonce) + "\",\n" ++ * out += "\t.assoc\t= \"" + encode_blob(ad) + "\",\n" ++ * out += "\t.alen\t= " + str(len(ad)) + ",\n" ++ * out += "\t.input\t= \"" + encode_blob(p) + "\",\n" ++ * out += "\t.ilen\t= " + str(len(p)) + ",\n" ++ * out += "\t.result\t= \"" + encode_blob(c) + "\"\n" ++ * out += "}" ++ * enc.append(out) ++ * ++ * ++ * out = "{\n" ++ * out += "\t.key\t= \"" + encode_blob(key) + "\",\n" ++ * out += "\t.nonce\t= \"" + encode_blob(nonce) + "\",\n" ++ * out += "\t.assoc\t= \"" + encode_blob(ad) + "\",\n" ++ * out += "\t.alen\t= " + str(len(ad)) + ",\n" ++ * out += "\t.input\t= \"" + encode_blob(c) + "\",\n" ++ * out += "\t.ilen\t= " + str(len(c)) + ",\n" ++ * out += "\t.result\t= \"" + encode_blob(p) + "\"\n" ++ * out += "}" ++ * dec.append(out) ++ * ++ * ++ * make_vector(0, 0) ++ * make_vector(0, 8) ++ * make_vector(1, 8) ++ * make_vector(1, 0) ++ * make_vector(129, 7) ++ * make_vector(256, 0) ++ * make_vector(512, 0) ++ * make_vector(513, 9) ++ * make_vector(1024, 16) ++ * make_vector(1933, 7) ++ * make_vector(2011, 63) ++ * ++ * print("======== encryption vectors ========") ++ * print(", ".join(enc)) ++ * ++ * print("\n\n\n======== decryption vectors ========") ++ * print(", ".join(dec)) ++ */ ++ ++static const struct chacha20poly1305_testvec chacha20poly1305_enc_vectors[] __initconst = { { ++ .key = "\x1c\x92\x40\xa5\xeb\x55\xd3\x8a\xf3\x33\x88\x86\x04\xf6\xb5\xf0\x47\x39\x17\xc1\x40\x2b\x80\x09\x9d\xca\x5c\xbc\x20\x70\x75\xc0", ++ .nonce = "\x01\x02\x03\x04\x05\x06\x07\x08", ++ .assoc = "\xf3\x33\x88\x86\x00\x00\x00\x00\x00\x00\x4e\x91", ++ .alen = 12, ++ .input = "\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x72\x65\x20\x64\x72\x61\x66\x74\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x76\x61\x6c\x69\x64\x20\x66\x6f\x72\x20\x61\x20\x6d\x61\x78\x69\x6d\x75\x6d\x20\x6f\x66\x20\x73\x69\x78\x20\x6d\x6f\x6e\x74\x68\x73\x20\x61\x6e\x64\x20\x6d\x61\x79\x20\x62\x65\x20\x75\x70\x64\x61\x74\x65\x64\x2c\x20\x72\x65\x70\x6c\x61\x63\x65\x64\x2c\x20\x6f\x72\x20\x6f\x62\x73\x6f\x6c\x65\x74\x65\x64\x20\x62\x79\x20\x6f\x74\x68\x65\x72\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x61\x74\x20\x61\x6e\x79\x20\x74\x69\x6d\x65\x2e\x20\x49\x74\x20\x69\x73\x20\x69\x6e\x61\x70\x70\x72\x6f\x70\x72\x69\x61\x74\x65\x20\x74\x6f\x20\x75\x73\x65\x20\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x73\x20\x72\x65\x66\x65\x72\x65\x6e\x63\x65\x20\x6d\x61\x74\x65\x72\x69\x61\x6c\x20\x6f\x72\x20\x74\x6f\x20\x63\x69\x74\x65\x20\x74\x68\x65\x6d\x20\x6f\x74\x68\x65\x72\x20\x74\x68\x61\x6e\x20\x61\x73\x20\x2f\xe2\x80\x9c\x77\x6f\x72\x6b\x20\x69\x6e\x20\x70\x72\x6f\x67\x72\x65\x73\x73\x2e\x2f\xe2\x80\x9d", ++ .ilen = 265, ++ .result = "\x64\xa0\x86\x15\x75\x86\x1a\xf4\x60\xf0\x62\xc7\x9b\xe6\x43\xbd\x5e\x80\x5c\xfd\x34\x5c\xf3\x89\xf1\x08\x67\x0a\xc7\x6c\x8c\xb2\x4c\x6c\xfc\x18\x75\x5d\x43\xee\xa0\x9e\xe9\x4e\x38\x2d\x26\xb0\xbd\xb7\xb7\x3c\x32\x1b\x01\x00\xd4\xf0\x3b\x7f\x35\x58\x94\xcf\x33\x2f\x83\x0e\x71\x0b\x97\xce\x98\xc8\xa8\x4a\xbd\x0b\x94\x81\x14\xad\x17\x6e\x00\x8d\x33\xbd\x60\xf9\x82\xb1\xff\x37\xc8\x55\x97\x97\xa0\x6e\xf4\xf0\xef\x61\xc1\x86\x32\x4e\x2b\x35\x06\x38\x36\x06\x90\x7b\x6a\x7c\x02\xb0\xf9\xf6\x15\x7b\x53\xc8\x67\xe4\xb9\x16\x6c\x76\x7b\x80\x4d\x46\xa5\x9b\x52\x16\xcd\xe7\xa4\xe9\x90\x40\xc5\xa4\x04\x33\x22\x5e\xe2\x82\xa1\xb0\xa0\x6c\x52\x3e\xaf\x45\x34\xd7\xf8\x3f\xa1\x15\x5b\x00\x47\x71\x8c\xbc\x54\x6a\x0d\x07\x2b\x04\xb3\x56\x4e\xea\x1b\x42\x22\x73\xf5\x48\x27\x1a\x0b\xb2\x31\x60\x53\xfa\x76\x99\x19\x55\xeb\xd6\x31\x59\x43\x4e\xce\xbb\x4e\x46\x6d\xae\x5a\x10\x73\xa6\x72\x76\x27\x09\x7a\x10\x49\xe6\x17\xd9\x1d\x36\x10\x94\xfa\x68\xf0\xff\x77\x98\x71\x30\x30\x5b\xea\xba\x2e\xda\x04\xdf\x99\x7b\x71\x4d\x6c\x6f\x2c\x29\xa6\xad\x5c\xb4\x02\x2b\x02\x70\x9b\xee\xad\x9d\x67\x89\x0c\xbb\x22\x39\x23\x36\xfe\xa1\x85\x1f\x38" ++}, { ++ .key = "\x4c\xf5\x96\x83\x38\xe6\xae\x7f\x2d\x29\x25\x76\xd5\x75\x27\x86\x91\x9a\x27\x7a\xfb\x46\xc5\xef\x94\x81\x79\x57\x14\x59\x40\x68", ++ .nonce = "\xca\xbf\x33\x71\x32\x45\x77\x8e", ++ .assoc = "", ++ .alen = 0, ++ .input = "", ++ .ilen = 0, ++ .result = "\xea\xe0\x1e\x9e\x2c\x91\xaa\xe1\xdb\x5d\x99\x3f\x8a\xf7\x69\x92" ++}, { ++ .key = "\x2d\xb0\x5d\x40\xc8\xed\x44\x88\x34\xd1\x13\xaf\x57\xa1\xeb\x3a\x2a\x80\x51\x36\xec\x5b\xbc\x8\x93\x84\x21\xb5\x13\x88\x3c\xd", ++ .nonce = "\x3d\x86\xb5\x6b\xc8\xa3\x1f\x1d", ++ .assoc = "\x33\x10\x41\x12\x1f\xf3\xd2\x6b", ++ .alen = 8, ++ .input = "", ++ .ilen = 0, ++ .result = "\xdd\x6b\x3b\x82\xce\x5a\xbd\xd6\xa9\x35\x83\xd8\x8c\x3d\x85\x77" ++}, { ++ .key = "\x4b\x28\x4b\xa3\x7b\xbe\xe9\xf8\x31\x80\x82\xd7\xd8\xe8\xb5\xa1\xe2\x18\x18\x8a\x9c\xfa\xa3\x3d\x25\x71\x3e\x40\xbc\x54\x7a\x3e", ++ .nonce = "\xd2\x32\x1f\x29\x28\xc6\xc4\xc4", ++ .assoc = "\x6a\xe2\xad\x3f\x88\x39\x5a\x40", ++ .alen = 8, ++ .input = "\xa4", ++ .ilen = 1, ++ .result = "\xb7\x1b\xb0\x73\x59\xb0\x84\xb2\x6d\x8e\xab\x94\x31\xa1\xae\xac\x89" ++}, { ++ .key = "\x66\xca\x9c\x23\x2a\x4b\x4b\x31\xe\x92\x89\x8b\xf4\x93\xc7\x87\x98\xa3\xd8\x39\xf8\xf4\xa7\x1\xc0\x2e\xa\xa6\x7e\x5a\x78\x87", ++ .nonce = "\x20\x1c\xaa\x5f\x9c\xbf\x92\x30", ++ .assoc = "", ++ .alen = 0, ++ .input = "\x2d", ++ .ilen = 1, ++ .result = "\xbf\xe1\x5b\xb\xdb\x6b\xf5\x5e\x6c\x5d\x84\x44\x39\x81\xc1\x9c\xac" ++}, { ++ .key = "\x68\x7b\x8d\x8e\xe3\xc4\xdd\xae\xdf\x72\x7f\x53\x72\x25\x1e\x78\x91\xcb\x69\x76\x1f\x49\x93\xf9\x6f\x21\xcc\x39\x9c\xad\xb1\x1", ++ .nonce = "\xdf\x51\x84\x82\x42\xc\x75\x9c", ++ .assoc = "\x70\xd3\x33\xf3\x8b\x18\xb", ++ .alen = 7, ++ .input = "\x33\x2f\x94\xc1\xa4\xef\xcc\x2a\x5b\xa6\xe5\x8f\x1d\x40\xf0\x92\x3c\xd9\x24\x11\xa9\x71\xf9\x37\x14\x99\xfa\xbe\xe6\x80\xde\x50\xc9\x96\xd4\xb0\xec\x9e\x17\xec\xd2\x5e\x72\x99\xfc\xa\xe1\xcb\x48\xd2\x85\xdd\x2f\x90\xe0\x66\x3b\xe6\x20\x74\xbe\x23\x8f\xcb\xb4\xe4\xda\x48\x40\xa6\xd1\x1b\xc7\x42\xce\x2f\xc\xa6\x85\x6e\x87\x37\x3\xb1\x7c\x25\x96\xa3\x5\xd8\xb0\xf4\xed\xea\xc2\xf0\x31\x98\x6c\xd1\x14\x25\xc0\xcb\x1\x74\xd0\x82\xf4\x36\xf5\x41\xd5\xdc\xca\xc5\xbb\x98\xfe\xfc\x69\x21\x70\xd8\xa4\x4b\xc8\xde\x8f", ++ .ilen = 129, ++ .result = "\x8b\x6\xd3\x31\xb0\x93\x45\xb1\x75\x6e\x26\xf9\x67\xbc\x90\x15\x81\x2c\xb5\xf0\xc6\x2b\xc7\x8c\x56\xd1\xbf\x69\x6c\x7\xa0\xda\x65\x27\xc9\x90\x3d\xef\x4b\x11\xf\x19\x7\xfd\x29\x92\xd9\xc8\xf7\x99\x2e\x4a\xd0\xb8\x2c\xdc\x93\xf5\x9e\x33\x78\xd1\x37\xc3\x66\xd7\x5e\xbc\x44\xbf\x53\xa5\xbc\xc4\xcb\x7b\x3a\x8e\x7f\x2\xbd\xbb\xe7\xca\xa6\x6c\x6b\x93\x21\x93\x10\x61\xe7\x69\xd0\x78\xf3\x7\x5a\x1a\x8f\x73\xaa\xb1\x4e\xd3\xda\x4f\xf3\x32\xe1\x66\x3e\x6c\xc6\x13\xba\x6\x5b\xfc\x6a\xe5\x6f\x60\xfb\x7\x40\xb0\x8c\x9d\x84\x43\x6b\xc1\xf7\x8d\x8d\x31\xf7\x7a\x39\x4d\x8f\x9a\xeb" ++}, { ++ .key = "\x8d\xb8\x91\x48\xf0\xe7\xa\xbd\xf9\x3f\xcd\xd9\xa0\x1e\x42\x4c\xe7\xde\x25\x3d\xa3\xd7\x5\x80\x8d\xf2\x82\xac\x44\x16\x51\x1", ++ .nonce = "\xde\x7b\xef\xc3\x65\x1b\x68\xb0", ++ .assoc = "", ++ .alen = 0, ++ .input = "\x9b\x18\xdb\xdd\x9a\xf\x3e\xa5\x15\x17\xde\xdf\x8\x9d\x65\xa\x67\x30\x12\xe2\x34\x77\x4b\xc1\xd9\xc6\x1f\xab\xc6\x18\x50\x17\xa7\x9d\x3c\xa6\xc5\x35\x8c\x1c\xc0\xa1\x7c\x9f\x3\x89\xca\xe1\xe6\xe9\xd4\xd3\x88\xdb\xb4\x51\x9d\xec\xb4\xfc\x52\xee\x6d\xf1\x75\x42\xc6\xfd\xbd\x7a\x8e\x86\xfc\x44\xb3\x4f\xf3\xea\x67\x5a\x41\x13\xba\xb0\xdc\xe1\xd3\x2a\x7c\x22\xb3\xca\xac\x6a\x37\x98\x3e\x1d\x40\x97\xf7\x9b\x1d\x36\x6b\xb3\x28\xbd\x60\x82\x47\x34\xaa\x2f\x7d\xe9\xa8\x70\x81\x57\xd4\xb9\x77\xa\x9d\x29\xa7\x84\x52\x4f\xc2\x4a\x40\x3b\x3c\xd4\xc9\x2a\xdb\x4a\x53\xc4\xbe\x80\xe9\x51\x7f\x8f\xc7\xa2\xce\x82\x5c\x91\x1e\x74\xd9\xd0\xbd\xd5\xf3\xfd\xda\x4d\x25\xb4\xbb\x2d\xac\x2f\x3d\x71\x85\x7b\xcf\x3c\x7b\x3e\xe\x22\x78\xc\x29\xbf\xe4\xf4\x57\xb3\xcb\x49\xa0\xfc\x1e\x5\x4e\x16\xbc\xd5\xa8\xa3\xee\x5\x35\xc6\x7c\xab\x60\x14\x55\x1a\x8e\xc5\x88\x5d\xd5\x81\xc2\x81\xa5\xc4\x60\xdb\xaf\x77\x91\xe1\xce\xa2\x7e\x7f\x42\xe3\xb0\x13\x1c\x1f\x25\x60\x21\xe2\x40\x5f\x99\xb7\x73\xec\x9b\x2b\xf0\x65\x11\xc8\xd0\xa\x9f\xd3", ++ .ilen = 256, ++ .result = "\x85\x4\xc2\xed\x8d\xfd\x97\x5c\xd2\xb7\xe2\xc1\x6b\xa3\xba\xf8\xc9\x50\xc3\xc6\xa5\xe3\xa4\x7c\xc3\x23\x49\x5e\xa9\xb9\x32\xeb\x8a\x7c\xca\xe5\xec\xfb\x7c\xc0\xcb\x7d\xdc\x2c\x9d\x92\x55\x21\xa\xc8\x43\x63\x59\xa\x31\x70\x82\x67\x41\x3\xf8\xdf\xf2\xac\xa7\x2\xd4\xd5\x8a\x2d\xc8\x99\x19\x66\xd0\xf6\x88\x2c\x77\xd9\xd4\xd\x6c\xbd\x98\xde\xe7\x7f\xad\x7e\x8a\xfb\xe9\x4b\xe5\xf7\xe5\x50\xa0\x90\x3f\xd6\x22\x53\xe3\xfe\x1b\xcc\x79\x3b\xec\x12\x47\x52\xa7\xd6\x4\xe3\x52\xe6\x93\x90\x91\x32\x73\x79\xb8\xd0\x31\xde\x1f\x9f\x2f\x5\x38\x54\x2f\x35\x4\x39\xe0\xa7\xba\xc6\x52\xf6\x37\x65\x4c\x7\xa9\x7e\xb3\x21\x6f\x74\x8c\xc9\xde\xdb\x65\x1b\x9b\xaa\x60\xb1\x3\x30\x6b\xb2\x3\xc4\x1c\x4\xf8\xf\x64\xaf\x46\xe4\x65\x99\x49\xe2\xea\xce\x78\x0\xd8\x8b\xd5\x2e\xcf\xfc\x40\x49\xe8\x58\xdc\x34\x9c\x8c\x61\xbf\xa\x8e\xec\x39\xa9\x30\x5\x5a\xd2\x56\x1\xc7\xda\x8f\x4e\xbb\x43\xa3\x3a\xf9\x15\x2a\xd0\xa0\x7a\x87\x34\x82\xfe\x8a\xd1\x2d\x5e\xc7\xbf\x4\x53\x5f\x3b\x36\xd4\x25\x5c\x34\x7a\x8d\xd5\x5\xce\x72\xca\xef\x7a\x4b\xbc\xb0\x10\x5c\x96\x42\x3a\x0\x98\xcd\x15\xe8\xb7\x53" ++}, { ++ .key = "\xf2\xaa\x4f\x99\xfd\x3e\xa8\x53\xc1\x44\xe9\x81\x18\xdc\xf5\xf0\x3e\x44\x15\x59\xe0\xc5\x44\x86\xc3\x91\xa8\x75\xc0\x12\x46\xba", ++ .nonce = "\xe\xd\x57\xbb\x7b\x40\x54\x2", ++ .assoc = "", ++ .alen = 0, ++ .input = "\xc3\x9\x94\x62\xe6\x46\x2e\x10\xbe\x0\xe4\xfc\xf3\x40\xa3\xe2\xf\xc2\x8b\x28\xdc\xba\xb4\x3c\xe4\x21\x58\x61\xcd\x8b\xcd\xfb\xac\x94\xa1\x45\xf5\x1c\xe1\x12\xe0\x3b\x67\x21\x54\x5e\x8c\xaa\xcf\xdb\xb4\x51\xd4\x13\xda\xe6\x83\x89\xb6\x92\xe9\x21\x76\xa4\x93\x7d\xe\xfd\x96\x36\x3\x91\x43\x5c\x92\x49\x62\x61\x7b\xeb\x43\x89\xb8\x12\x20\x43\xd4\x47\x6\x84\xee\x47\xe9\x8a\x73\x15\xf\x72\xcf\xed\xce\x96\xb2\x7f\x21\x45\x76\xeb\x26\x28\x83\x6a\xad\xaa\xa6\x81\xd8\x55\xb1\xa3\x85\xb3\xc\xdf\xf1\x69\x2d\x97\x5\x2a\xbc\x7c\x7b\x25\xf8\x80\x9d\x39\x25\xf3\x62\xf0\x66\x5e\xf4\xa0\xcf\xd8\xfd\x4f\xb1\x1f\x60\x3a\x8\x47\xaf\xe1\xf6\x10\x77\x9\xa7\x27\x8f\x9a\x97\x5a\x26\xfa\xfe\x41\x32\x83\x10\xe0\x1d\xbf\x64\xd\xf4\x1c\x32\x35\xe5\x1b\x36\xef\xd4\x4a\x93\x4d\x0\x7c\xec\x2\x7\x8b\x5d\x7d\x1b\xe\xd1\xa6\xa5\x5d\x7d\x57\x88\xa8\xcc\x81\xb4\x86\x4e\xb4\x40\xe9\x1d\xc3\xb1\x24\x3e\x7f\xcc\x8a\x24\x9b\xdf\x6d\xf0\x39\x69\x3e\x4c\xc0\x96\xe4\x13\xda\x90\xda\xf4\x95\x66\x8b\x17\x17\xfe\x39\x43\x25\xaa\xda\xa0\x43\x3c\xb1\x41\x2\xa3\xf0\xa7\x19\x59\xbc\x1d\x7d\x6c\x6d\x91\x9\x5c\xb7\x5b\x1\xd1\x6f\x17\x21\x97\xbf\x89\x71\xa5\xb0\x6e\x7\x45\xfd\x9d\xea\x7\xf6\x7a\x9f\x10\x18\x22\x30\x73\xac\xd4\x6b\x72\x44\xed\xd9\x19\x9b\x2d\x4a\x41\xdd\xd1\x85\x5e\x37\x19\xed\xd2\x15\x8f\x5e\x91\xdb\x33\xf2\xe4\xdb\xff\x98\xfb\xa3\xb5\xca\x21\x69\x8\xe7\x8a\xdf\x90\xff\x3e\xe9\x20\x86\x3c\xe9\xfc\xb\xfe\x5c\x61\xaa\x13\x92\x7f\x7b\xec\xe0\x6d\xa8\x23\x22\xf6\x6b\x77\xc4\xfe\x40\x7\x3b\xb6\xf6\x8e\x5f\xd4\xb9\xb7\xf\x21\x4\xef\x83\x63\x91\x69\x40\xa3\x48\x5c\xd2\x60\xf9\x4f\x6c\x47\x8b\x3b\xb1\x9f\x8e\xee\x16\x8a\x13\xfc\x46\x17\xc3\xc3\x32\x56\xf8\x3c\x85\x3a\xb6\x3e\xaa\x89\x4f\xb3\xdf\x38\xfd\xf1\xe4\x3a\xc0\xe6\x58\xb5\x8f\xc5\x29\xa2\x92\x4a\xb6\xa0\x34\x7f\xab\xb5\x8a\x90\xa1\xdb\x4d\xca\xb6\x2c\x41\x3c\xf7\x2b\x21\xc3\xfd\xf4\x17\x5c\xb5\x33\x17\x68\x2b\x8\x30\xf3\xf7\x30\x3c\x96\xe6\x6a\x20\x97\xe7\x4d\x10\x5f\x47\x5f\x49\x96\x9\xf0\x27\x91\xc8\xf8\x5a\x2e\x79\xb5\xe2\xb8\xe8\xb9\x7b\xd5\x10\xcb\xff\x5d\x14\x73\xf3", ++ .ilen = 512, ++ .result = "\x14\xf6\x41\x37\xa6\xd4\x27\xcd\xdb\x6\x3e\x9a\x4e\xab\xd5\xb1\x1e\x6b\xd2\xbc\x11\xf4\x28\x93\x63\x54\xef\xbb\x5e\x1d\x3a\x1d\x37\x3c\xa\x6c\x1e\xc2\xd1\x2c\xb5\xa3\xb5\x7b\xb8\x8f\x25\xa6\x1b\x61\x1c\xec\x28\x58\x26\xa4\xa8\x33\x28\x25\x5c\x45\x5\xe5\x6c\x99\xe5\x45\xc4\xa2\x3\x84\x3\x73\x1e\x8c\x49\xac\x20\xdd\x8d\xb3\xc4\xf5\xe7\x4f\xf1\xed\xa1\x98\xde\xa4\x96\xdd\x2f\xab\xab\x97\xcf\x3e\xd2\x9e\xb8\x13\x7\x28\x29\x19\xaf\xfd\xf2\x49\x43\xea\x49\x26\x91\xc1\x7\xd6\xbb\x81\x75\x35\xd\x24\x7f\xc8\xda\xd4\xb7\xeb\xe8\x5c\x9\xa2\x2f\xdc\x28\x7d\x3a\x3\xfa\x94\xb5\x1d\x17\x99\x36\xc3\x1c\x18\x34\xe3\x9f\xf5\x55\x7c\xb0\x60\x9d\xff\xac\xd4\x61\xf2\xad\xf8\xce\xc7\xbe\x5c\xd2\x95\xa8\x4b\x77\x13\x19\x59\x26\xc9\xb7\x8f\x6a\xcb\x2d\x37\x91\xea\x92\x9c\x94\x5b\xda\xb\xce\xfe\x30\x20\xf8\x51\xad\xf2\xbe\xe7\xc7\xff\xb3\x33\x91\x6a\xc9\x1a\x41\xc9\xf\xf3\x10\xe\xfd\x53\xff\x6c\x16\x52\xd9\xf3\xf7\x98\x2e\xc9\x7\x31\x2c\xc\x72\xd7\xc5\xc6\x8\x2a\x7b\xda\xbd\x7e\x2\xea\x1a\xbb\xf2\x4\x27\x61\x28\x8e\xf5\x4\x3\x1f\x4c\x7\x55\x82\xec\x1e\xd7\x8b\x2f\x65\x56\xd1\xd9\x1e\x3c\xe9\x1f\x5e\x98\x70\x38\x4a\x8c\x49\xc5\x43\xa0\xa1\x8b\x74\x9d\x4c\x62\xd\x10\xc\xf4\x6c\x8f\xe0\xaa\x9a\x8d\xb7\xe0\xbe\x4c\x87\xf1\x98\x2f\xcc\xed\xc0\x52\x29\xdc\x83\xf8\xfc\x2c\xe\xa8\x51\x4d\x80\xd\xa3\xfe\xd8\x37\xe7\x41\x24\xfc\xfb\x75\xe3\x71\x7b\x57\x45\xf5\x97\x73\x65\x63\x14\x74\xb8\x82\x9f\xf8\x60\x2f\x8a\xf2\x4e\xf1\x39\xda\x33\x91\xf8\x36\xe0\x8d\x3f\x1f\x3b\x56\xdc\xa0\x8f\x3c\x9d\x71\x52\xa7\xb8\xc0\xa5\xc6\xa2\x73\xda\xf4\x4b\x74\x5b\x0\x3d\x99\xd7\x96\xba\xe6\xe1\xa6\x96\x38\xad\xb3\xc0\xd2\xba\x91\x6b\xf9\x19\xdd\x3b\xbe\xbe\x9c\x20\x50\xba\xa1\xd0\xce\x11\xbd\x95\xd8\xd1\xdd\x33\x85\x74\xdc\xdb\x66\x76\x44\xdc\x3\x74\x48\x35\x98\xb1\x18\x47\x94\x7d\xff\x62\xe4\x58\x78\xab\xed\x95\x36\xd9\x84\x91\x82\x64\x41\xbb\x58\xe6\x1c\x20\x6d\x15\x6b\x13\x96\xe8\x35\x7f\xdc\x40\x2c\xe9\xbc\x8a\x4f\x92\xec\x6\x2d\x50\xdf\x93\x5d\x65\x5a\xa8\xfc\x20\x50\x14\xa9\x8a\x7e\x1d\x8\x1f\xe2\x99\xd0\xbe\xfb\x3a\x21\x9d\xad\x86\x54\xfd\xd\x98\x1c\x5a\x6f\x1f\x9a\x40\xcd\xa2\xff\x6a\xf1\x54" ++}, { ++ .key = "\xea\xbc\x56\x99\xe3\x50\xff\xc5\xcc\x1a\xd7\xc1\x57\x72\xea\x86\x5b\x89\x88\x61\x3d\x2f\x9b\xb2\xe7\x9c\xec\x74\x6e\x3e\xf4\x3b", ++ .nonce = "\xef\x2d\x63\xee\x6b\x80\x8b\x78", ++ .assoc = "\x5a\x27\xff\xeb\xdf\x84\xb2\x9e\xef", ++ .alen = 9, ++ .input = "\xe6\xc3\xdb\x63\x55\x15\xe3\x5b\xb7\x4b\x27\x8b\x5a\xdd\xc2\xe8\x3a\x6b\xd7\x81\x96\x35\x97\xca\xd7\x68\xe8\xef\xce\xab\xda\x9\x6e\xd6\x8e\xcb\x55\xb5\xe1\xe5\x57\xfd\xc4\xe3\xe0\x18\x4f\x85\xf5\x3f\x7e\x4b\x88\xc9\x52\x44\xf\xea\xaf\x1f\x71\x48\x9f\x97\x6d\xb9\x6f\x0\xa6\xde\x2b\x77\x8b\x15\xad\x10\xa0\x2b\x7b\x41\x90\x3\x2d\x69\xae\xcc\x77\x7c\xa5\x9d\x29\x22\xc2\xea\xb4\x0\x1a\xd2\x7a\x98\x8a\xf9\xf7\x82\xb0\xab\xd8\xa6\x94\x8d\x58\x2f\x1\x9e\x0\x20\xfc\x49\xdc\xe\x3\xe8\x45\x10\xd6\xa8\xda\x55\x10\x9a\xdf\x67\x22\x8b\x43\xab\x0\xbb\x2\xc8\xdd\x7b\x97\x17\xd7\x1d\x9e\x2\x5e\x48\xde\x8e\xcf\x99\x7\x95\x92\x3c\x5f\x9f\xc5\x8a\xc0\x23\xaa\xd5\x8c\x82\x6e\x16\x92\xb1\x12\x17\x7\xc3\xfb\x36\xf5\x6c\x35\xd6\x6\x1f\x9f\xa7\x94\xa2\x38\x63\x9c\xb0\x71\xb3\xa5\xd2\xd8\xba\x9f\x8\x1\xb3\xff\x4\x97\x73\x45\x1b\xd5\xa9\x9c\x80\xaf\x4\x9a\x85\xdb\x32\x5b\x5d\x1a\xc1\x36\x28\x10\x79\xf1\x3c\xbf\x1a\x41\x5c\x4e\xdf\xb2\x7c\x79\x3b\x7a\x62\x3d\x4b\xc9\x9b\x2a\x2e\x7c\xa2\xb1\x11\x98\xa7\x34\x1a\x0\xf3\xd1\xbc\x18\x22\xba\x2\x56\x62\x31\x10\x11\x6d\xe0\x54\x9d\x40\x1f\x26\x80\x41\xca\x3f\x68\xf\x32\x1d\xa\x8e\x79\xd8\xa4\x1b\x29\x1c\x90\x8e\xc5\xe3\xb4\x91\x37\x9a\x97\x86\x99\xd5\x9\xc5\xbb\xa3\x3f\x21\x29\x82\x14\x5c\xab\x25\xfb\xf2\x4f\x58\x26\xd4\x83\xaa\x66\x89\x67\x7e\xc0\x49\xe1\x11\x10\x7f\x7a\xda\x29\x4\xff\xf0\xcb\x9\x7c\x9d\xfa\x3\x6f\x81\x9\x31\x60\xfb\x8\xfa\x74\xd3\x64\x44\x7c\x55\x85\xec\x9c\x6e\x25\xb7\x6c\xc5\x37\xb6\x83\x87\x72\x95\x8b\x9d\xe1\x69\x5c\x31\x95\x42\xa6\x2c\xd1\x36\x47\x1f\xec\x54\xab\xa2\x1c\xd8\x0\xcc\xbc\xd\x65\xe2\x67\xbf\xbc\xea\xee\x9e\xe4\x36\x95\xbe\x73\xd9\xa6\xd9\xf\xa0\xcc\x82\x76\x26\xad\x5b\x58\x6c\x4e\xab\x29\x64\xd3\xd9\xa9\x8\x8c\x1d\xa1\x4f\x80\xd8\x3f\x94\xfb\xd3\x7b\xfc\xd1\x2b\xc3\x21\xeb\xe5\x1c\x84\x23\x7f\x4b\xfa\xdb\x34\x18\xa2\xc2\xe5\x13\xfe\x6c\x49\x81\xd2\x73\xe7\xe2\xd7\xe4\x4f\x4b\x8\x6e\xb1\x12\x22\x10\x9d\xac\x51\x1e\x17\xd9\x8a\xb\x42\x88\x16\x81\x37\x7c\x6a\xf7\xef\x2d\xe3\xd9\xf8\x5f\xe0\x53\x27\x74\xb9\xe2\xd6\x1c\x80\x2c\x52\x65", ++ .ilen = 513, ++ .result = "\xfd\x81\x8d\xd0\x3d\xb4\xd5\xdf\xd3\x42\x47\x5a\x6d\x19\x27\x66\x4b\x2e\xc\x27\x9c\x96\x4c\x72\x2\xa3\x65\xc3\xb3\x6f\x2e\xbd\x63\x8a\x4a\x5d\x29\xa2\xd0\x28\x48\xc5\x3d\x98\xa3\xbc\xe0\xbe\x3b\x3f\xe6\x8a\xa4\x7f\x53\x6\xfa\x7f\x27\x76\x72\x31\xa1\xf5\xd6\xc\x52\x47\xba\xcd\x4f\xd7\xeb\x5\x48\xd\x7c\x35\x4a\x9\xc9\x76\x71\x2\xa3\xfb\xb7\x1a\x65\xb7\xed\x98\xc6\x30\x8a\x0\xae\xa1\x31\xe5\xb5\x9e\x6d\x62\xda\xda\x7\xf\x38\x38\xd3\xcb\xc1\xb0\xad\xec\x72\xec\xb1\xa2\x7b\x59\xf3\x3d\x2b\xef\xcd\x28\x5b\x83\xcc\x18\x91\x88\xb0\x2e\xf9\x29\x31\x18\xf9\x4e\xe9\xa\x91\x92\x9f\xae\x2d\xad\xf4\xe6\x1a\xe2\xa4\xee\x47\x15\xbf\x83\x6e\xd7\x72\x12\x3b\x2d\x24\xe9\xb2\x55\xcb\x3c\x10\xf0\x24\x8a\x4a\x2\xea\x90\x25\xf0\xb4\x79\x3a\xef\x6e\xf5\x52\xdf\xb0\xa\xcd\x24\x1c\xd3\x2e\x22\x74\xea\x21\x6f\xe9\xbd\xc8\x3e\x36\x5b\x19\xf1\xca\x99\xa\xb4\xa7\x52\x1a\x4e\xf2\xad\x8d\x56\x85\xbb\x64\x89\xba\x26\xf9\xc7\xe1\x89\x19\x22\x77\xc3\xa8\xfc\xff\xad\xfe\xb9\x48\xae\x12\x30\x9f\x19\xfb\x1b\xef\x14\x87\x8a\x78\x71\xf3\xf4\xb7\x0\x9c\x1d\xb5\x3d\x49\x0\xc\x6\xd4\x50\xf9\x54\x45\xb2\x5b\x43\xdb\x6d\xcf\x1a\xe9\x7a\x7a\xcf\xfc\x8a\x4e\x4d\xb\x7\x63\x28\xd8\xe7\x8\x95\xdf\xa6\x72\x93\x2e\xbb\xa0\x42\x89\x16\xf1\xd9\xc\xf9\xa1\x16\xfd\xd9\x3\xb4\x3b\x8a\xf5\xf6\xe7\x6b\x2e\x8e\x4c\x3d\xe2\xaf\x8\x45\x3\xff\x9\xb6\xeb\x2d\xc6\x1b\x88\x94\xac\x3e\xf1\x9f\xe\xe\x2b\xd5\x0\x4d\x3f\x3b\x53\xae\xaf\x1c\x33\x5f\x55\x6e\x8d\xaf\x5\x7a\x10\x34\xc9\xf4\x66\xcb\x62\x12\xa6\xee\xe8\x1c\x5d\x12\x86\xdb\x6f\x1c\x33\xc4\x1c\xda\x82\x2d\x3b\x59\xfe\xb1\xa4\x59\x41\x86\xd0\xef\xae\xfb\xda\x6d\x11\xb8\xca\xe9\x6e\xff\xf7\xa9\xd9\x70\x30\xfc\x53\xe2\xd7\xa2\x4e\xc7\x91\xd9\x7\x6\xaa\xdd\xb0\x59\x28\x1d\x0\x66\xc5\x54\xc2\xfc\x6\xda\x5\x90\x52\x1d\x37\x66\xee\xf0\xb2\x55\x8a\x5d\xd2\x38\x86\x94\x9b\xfc\x10\x4c\xa1\xb9\x64\x3e\x44\xb8\x5f\xb0\xc\xec\xe0\xc9\xe5\x62\x75\x3f\x9\xd5\xf5\xd9\x26\xba\x9e\xd2\xf4\xb9\x48\xa\xbc\xa2\xd6\x7c\x36\x11\x7d\x26\x81\x89\xcf\xa4\xad\x73\xe\xee\xcc\x6\xa9\xdb\xb1\xfd\xfb\x9\x7f\x90\x42\x37\x2f\xe1\x9c\xf\x6f\xcf\x43\xb5\xd9\x90\xe1\x85\xf5\xa8\xae" ++}, { ++ .key = "\x47\x11\xeb\x86\x2b\x2c\xab\x44\x34\xda\x7f\x57\x3\x39\xc\xaf\x2c\x14\xfd\x65\x23\xe9\x8e\x74\xd5\x8\x68\x8\xe7\xb4\x72\xd7", ++ .nonce = "\xdb\x92\xf\x7f\x17\x54\xc\x30", ++ .assoc = "\xd2\xa1\x70\xdb\x7a\xf8\xfa\x27\xba\x73\xf\xbf\x3d\x1e\x82\xb2", ++ .alen = 16, ++ .input = "\x42\x93\xe4\xeb\x97\xb0\x57\xbf\x1a\x8b\x1f\xe4\x5f\x36\x20\x3c\xef\xa\xa9\x48\x5f\x5f\x37\x22\x3a\xde\xe3\xae\xbe\xad\x7\xcc\xb1\xf6\xf5\xf9\x56\xdd\xe7\x16\x1e\x7f\xdf\x7a\x9e\x75\xb7\xc7\xbe\xbe\x8a\x36\x4\xc0\x10\xf4\x95\x20\x3\xec\xdc\x5\xa1\x7d\xc4\xa9\x2c\x82\xd0\xbc\x8b\xc5\xc7\x45\x50\xf6\xa2\x1a\xb5\x46\x3b\x73\x2\xa6\x83\x4b\x73\x82\x58\x5e\x3b\x65\x2f\xe\xfd\x2b\x59\x16\xce\xa1\x60\x9c\xe8\x3a\x99\xed\x8d\x5a\xcf\xf6\x83\xaf\xba\xd7\x73\x73\x40\x97\x3d\xca\xef\x7\x57\xe6\xd9\x70\xe\x95\xae\xa6\x8d\x4\xcc\xee\xf7\x9\x31\x77\x12\xa3\x23\x97\x62\xb3\x7b\x32\xfb\x80\x14\x48\x81\xc3\xe5\xea\x91\x39\x52\x81\xa2\x4f\xe4\xb3\x9\xff\xde\x5e\xe9\x58\x84\x6e\xf9\x3d\xdf\x25\xea\xad\xae\xe6\x9a\xd1\x89\x55\xd3\xde\x6c\x52\xdb\x70\xfe\x37\xce\x44\xa\xa8\x25\x5f\x92\xc1\x33\x4a\x4f\x9b\x62\x35\xff\xce\xc0\xa9\x60\xce\x52\x0\x97\x51\x35\x26\x2e\xb9\x36\xa9\x87\x6e\x1e\xcc\x91\x78\x53\x98\x86\x5b\x9c\x74\x7d\x88\x33\xe1\xdf\x37\x69\x2b\xbb\xf1\x4d\xf4\xd1\xf1\x39\x93\x17\x51\x19\xe3\x19\x1e\x76\x37\x25\xfb\x9\x27\x6a\xab\x67\x6f\x14\x12\x64\xe7\xc4\x7\xdf\x4d\x17\xbb\x6d\xe0\xe9\xb9\xab\xca\x10\x68\xaf\x7e\xb7\x33\x54\x73\x7\x6e\xf7\x81\x97\x9c\x5\x6f\x84\x5f\xd2\x42\xfb\x38\xcf\xd1\x2f\x14\x30\x88\x98\x4d\x5a\xa9\x76\xd5\x4f\x3e\x70\x6c\x85\x76\xd7\x1\xa0\x1a\xc8\x4e\xaa\xac\x78\xfe\x46\xde\x6a\x5\x46\xa7\x43\xc\xb9\xde\xb9\x68\xfb\xce\x42\x99\x7\x4d\xb\x3b\x5a\x30\x35\xa8\xf9\x3a\x73\xef\xf\xdb\x1e\x16\x42\xc4\xba\xae\x58\xaa\xf8\xe5\x75\x2f\x1b\x15\x5c\xfd\xa\x97\xd0\xe4\x37\x83\x61\x5f\x43\xa6\xc7\x3f\x38\x59\xe6\xeb\xa3\x90\xc3\xaa\xaa\x5a\xd3\x34\xd4\x17\xc8\x65\x3e\x57\xbc\x5e\xdd\x9e\xb7\xf0\x2e\x5b\xb2\x1f\x8a\x8\xd\x45\x91\xb\x29\x53\x4f\x4c\x5a\x73\x56\xfe\xaf\x41\x1\x39\xa\x24\x3c\x7e\xbe\x4e\x53\xf3\xeb\x6\x66\x51\x28\x1d\xbd\x41\xa\x1\xab\x16\x47\x27\x47\x47\xf7\xcb\x46\xa\x70\x9e\x1\x9c\x9\xe1\x2a\x0\x1a\xd8\xd4\x79\x9d\x80\x15\x8e\x53\x2a\x65\x83\x78\x3e\x3\x0\x7\x12\x1f\x33\x3e\x7b\x13\x37\xf1\xc3\xef\xb7\xc1\x20\x3c\x3e\x67\x66\x5d\x88\xa7\x7d\x33\x50\x77\xb0\x28\x8e\xe7\x2c\x2e\x7a\xf4\x3c\x8d\x74\x83\xaf\x8e\x87\xf\xe4\x50\xff\x84\x5c\x47\xc\x6a\x49\xbf\x42\x86\x77\x15\x48\xa5\x90\x5d\x93\xd6\x2a\x11\xd5\xd5\x11\xaa\xce\xe7\x6f\xa5\xb0\x9\x2c\x8d\xd3\x92\xf0\x5a\x2a\xda\x5b\x1e\xd5\x9a\xc4\xc4\xf3\x49\x74\x41\xca\xe8\xc1\xf8\x44\xd6\x3c\xae\x6c\x1d\x9a\x30\x4\x4d\x27\xe\xb1\x5f\x59\xa2\x24\xe8\xe1\x98\xc5\x6a\x4c\xfe\x41\xd2\x27\x42\x52\xe1\xe9\x7d\x62\xe4\x88\xf\xad\xb2\x70\xcb\x9d\x4c\x27\x2e\x76\x1e\x1a\x63\x65\xf5\x3b\xf8\x57\x69\xeb\x5b\x38\x26\x39\x33\x25\x45\x3e\x91\xb8\xd8\xc7\xd5\x42\xc0\x22\x31\x74\xf4\xbc\xc\x23\xf1\xca\xc1\x8d\xd7\xbe\xc9\x62\xe4\x8\x1a\xcf\x36\xd5\xfe\x55\x21\x59\x91\x87\x87\xdf\x6\xdb\xdf\x96\x45\x58\xda\x5\xcd\x50\x4d\xd2\x7d\x5\x18\x73\x6a\x8d\x11\x85\xa6\x88\xe8\xda\xe6\x30\x33\xa4\x89\x31\x75\xbe\x69\x43\x84\x43\x50\x87\xdd\x71\x36\x83\xc3\x78\x74\x24\xa\xed\x7b\xdb\xa4\x24\xb\xb9\x7e\x5d\xff\xde\xb1\xef\x61\x5a\x45\x33\xf6\x17\x7\x8\x98\x83\x92\xf\x23\x6d\xe6\xaa\x17\x54\xad\x6a\xc8\xdb\x26\xbe\xb8\xb6\x8\xfa\x68\xf1\xd7\x79\x6f\x18\xb4\x9e\x2d\x3f\x1b\x64\xaf\x8d\x6\xe\x49\x28\xe0\x5d\x45\x68\x13\x87\xfa\xde\x40\x7b\xd2\xc3\x94\xd5\xe1\xd9\xc2\xaf\x55\x89\xeb\xb4\x12\x59\xa8\xd4\xc5\x29\x66\x38\xe6\xac\x22\x22\xd9\x64\x9b\x34\xa\x32\x9f\xc2\xbf\x17\x6c\x3f\x71\x7a\x38\x6b\x98\xfb\x49\x36\x89\xc9\xe2\xd6\xc7\x5d\xd0\x69\x5f\x23\x35\xc9\x30\xe2\xfd\x44\x58\x39\xd7\x97\xfb\x5c\x0\xd5\x4f\x7a\x1a\x95\x8b\x62\x4b\xce\xe5\x91\x21\x7b\x30\x0\xd6\xdd\x6d\x2\x86\x49\xf\x3c\x1a\x27\x3c\xd3\xe\x71\xf2\xff\xf5\x2f\x87\xac\x67\x59\x81\xa3\xf7\xf8\xd6\x11\xc\x84\xa9\x3\xee\x2a\xc4\xf3\x22\xab\x7c\xe2\x25\xf5\x67\xa3\xe4\x11\xe0\x59\xb3\xca\x87\xa0\xae\xc9\xa6\x62\x1b\x6e\x4d\x2\x6b\x7\x9d\xfd\xd0\x92\x6\xe1\xb2\x9a\x4a\x1f\x1f\x13\x49\x99\x97\x8\xde\x7f\x98\xaf\x51\x98\xee\x2c\xcb\xf0\xb\xc6\xb6\xb7\x2d\x9a\xb1\xac\xa6\xe3\x15\x77\x9d\x6b\x1a\xe4\xfc\x8b\xf2\x17\x59\x8\x4\x58\x81\x9d\x1b\x1b\x69\x55\xc2\xb4\x3c\x1f\x50\xf1\x7f\x77\x90\x4c\x66\x40\x5a\xc0\x33\x1f\xcb\x5\x6d\x5c\x6\x87\x52\xa2\x8f\x26\xd5\x4f", ++ .ilen = 1024, ++ .result = "\xe5\x26\xa4\x3d\xbd\x33\xd0\x4b\x6f\x5\xa7\x6e\x12\x7a\xd2\x74\xa6\xdd\xbd\x95\xeb\xf9\xa4\xf1\x59\x93\x91\x70\xd9\xfe\x9a\xcd\x53\x1f\x3a\xab\xa6\x7c\x9f\xa6\x9e\xbd\x99\xd9\xb5\x97\x44\xd5\x14\x48\x4d\x9d\xc0\xd0\x5\x96\xeb\x4c\x78\x55\x9\x8\x1\x2\x30\x90\x7b\x96\x7a\x7b\x5f\x30\x41\x24\xce\x68\x61\x49\x86\x57\x82\xdd\x53\x1c\x51\x28\x2b\x53\x6e\x2d\xc2\x20\x4c\xdd\x8f\x65\x10\x20\x50\xdd\x9d\x50\xe5\x71\x40\x53\x69\xfc\x77\x48\x11\xb9\xde\xa4\x8d\x58\xe4\xa6\x1a\x18\x47\x81\x7e\xfc\xdd\xf6\xef\xce\x2f\x43\x68\xd6\x6\xe2\x74\x6a\xad\x90\xf5\x37\xf3\x3d\x82\x69\x40\xe9\x6b\xa7\x3d\xa8\x1e\xd2\x2\x7c\xb7\x9b\xe4\xda\x8f\x95\x6\xc5\xdf\x73\xa3\x20\x9a\x49\xde\x9c\xbc\xee\x14\x3f\x81\x5e\xf8\x3b\x59\x3c\xe1\x68\x12\x5a\x3a\x76\x3a\x3f\xf7\x87\x33\xa\x1\xb8\xd4\xed\xb6\xbe\x94\x5e\x70\x40\x56\x67\x1f\x50\x44\x19\xce\x82\x70\x10\x87\x13\x20\xb\x4c\x5a\xb6\xf6\xa7\xae\x81\x75\x1\x81\xe6\x4b\x57\x7c\xdd\x6d\xf8\x1c\x29\x32\xf7\xda\x3c\x2d\xf8\x9b\x25\x6e\x0\xb4\xf7\x2f\xf7\x4\xf7\xa1\x56\xac\x4f\x1a\x64\xb8\x47\x55\x18\x7b\x7\x4d\xbd\x47\x24\x80\x5d\xa2\x70\xc5\xdd\x8e\x82\xd4\xeb\xec\xb2\xc\x39\xd2\x97\xc1\xcb\xeb\xf4\x77\x59\xb4\x87\xef\xcb\x43\x2d\x46\x54\xd1\xa7\xd7\x15\x99\xa\x43\xa1\xe0\x99\x33\x71\xc1\xed\xfe\x72\x46\x33\x8e\x91\x8\x9f\xc8\x2e\xca\xfa\xdc\x59\xd5\xc3\x76\x84\x9f\xa3\x37\x68\xc3\xf0\x47\x2c\x68\xdb\x5e\xc3\x49\x4c\xe8\x92\x85\xe2\x23\xd3\x3f\xad\x32\xe5\x2b\x82\xd7\x8f\x99\xa\x59\x5c\x45\xd9\xb4\x51\x52\xc2\xae\xbf\x80\xcf\xc9\xc9\x51\x24\x2a\x3b\x3a\x4d\xae\xeb\xbd\x22\xc3\xe\xf\x59\x25\x92\x17\xe9\x74\xc7\x8b\x70\x70\x36\x55\x95\x75\x4b\xad\x61\x2b\x9\xbc\x82\xf2\x6e\x94\x43\xae\xc3\xd5\xcd\x8e\xfe\x5b\x9a\x88\x43\x1\x75\xb2\x23\x9\xf7\x89\x83\xe7\xfa\xf9\xb4\x9b\xf8\xef\xbd\x1c\x92\xc1\xda\x7e\xfe\x5\xba\x5a\xcd\x7\x6a\x78\x9e\x5d\xfb\x11\x2f\x79\x38\xb6\xc2\x5b\x6b\x51\xb4\x71\xdd\xf7\x2a\xe4\xf4\x72\x76\xad\xc2\xdd\x64\x5d\x79\xb6\xf5\x7a\x77\x20\x5\x3d\x30\x6\xd4\x4c\xa\x2c\x98\x5a\xb9\xd4\x98\xa9\x3f\xc6\x12\xea\x3b\x4b\xc5\x79\x64\x63\x6b\x9\x54\x3b\x14\x27\xba\x99\x80\xc8\x72\xa8\x12\x90\x29\xba\x40\x54\x97\x2b\x7b\xfe\xeb\xcd\x1\x5\x44\x72\xdb\x99\xe4\x61\xc9\x69\xd6\xb9\x28\xd1\x5\x3e\xf9\xb\x49\xa\x49\xe9\x8d\xe\xa7\x4a\xf\xaf\x32\xd0\xe0\xb2\x3a\x55\x58\xfe\x5c\x28\x70\x51\x23\xb0\x7b\x6a\x5f\x1e\xb8\x17\xd7\x94\x15\x8f\xee\x20\xc7\x42\x25\x3e\x9a\x14\xd7\x60\x72\x39\x47\x48\xa9\xfe\xdd\x47\xa\xb1\xe6\x60\x28\x8c\x11\x68\xe1\xff\xd7\xce\xc8\xbe\xb3\xfe\x27\x30\x9\x70\xd7\xfa\x2\x33\x3a\x61\x2e\xc7\xff\xa4\x2a\xa8\x6e\xb4\x79\x35\x6d\x4c\x1e\x38\xf8\xee\xd4\x84\x4e\x6e\x28\xa7\xce\xc8\xc1\xcf\x80\x5\xf3\x4\xef\xc8\x18\x28\x2e\x8d\x5e\xc\xdf\xb8\x5f\x96\xe8\xc6\x9c\x2f\xe5\xa6\x44\xd7\xe7\x99\x44\xc\xec\xd7\x5\x60\x97\xbb\x74\x77\x58\xd5\xbb\x48\xde\x5a\xb2\x54\x7f\xe\x46\x70\x6a\x6f\x78\xa5\x8\x89\x5\x4e\x7e\xa0\x69\xb4\x40\x60\x55\x77\x75\x9b\x19\xf2\xd5\x13\x80\x77\xf9\x4b\x3f\x1e\xee\xe6\x76\x84\x7b\x8c\xe5\x27\xa8\xa\x91\x1\x68\x71\x8a\x3f\x6\xab\xf6\xa9\xa5\xe6\x72\x92\xe4\x67\xe2\xa2\x46\x35\x84\x55\x7d\xca\xa8\x85\xd0\xf1\x3f\xbe\xd7\x34\x64\xfc\xae\xe3\xe4\x4\x9f\x66\x2\xb9\x88\x10\xd9\xc4\x4c\x31\x43\x7a\x93\xe2\x9b\x56\x43\x84\xdc\xdc\xde\x1d\xa4\x2\xe\xc2\xef\xc3\xf8\x78\xd1\xb2\x6b\x63\x18\xc9\xa9\xe5\x72\xd8\xf3\xb9\xd1\x8a\xc7\x1a\x2\x27\x20\x77\x10\xe5\xc8\xd4\x4a\x47\xe5\xdf\x5f\x1\xaa\xb0\xd4\x10\xbb\x69\xe3\x36\xc8\xe1\x3d\x43\xfb\x86\xcd\xcc\xbf\xf4\x88\xe0\x20\xca\xb7\x1b\xf1\x2f\x5c\xee\xd4\xd3\xa3\xcc\xa4\x1e\x1c\x47\xfb\xbf\xfc\xa2\x41\x55\x9d\xf6\x5a\x5e\x65\x32\x34\x7b\x52\x8d\xd5\xd0\x20\x60\x3\xab\x3f\x8c\xd4\x21\xea\x2a\xd9\xc4\xd0\xd3\x65\xd8\x7a\x13\x28\x62\x32\x4b\x2c\x87\x93\xa8\xb4\x52\x45\x9\x44\xec\xec\xc3\x17\xdb\x9a\x4d\x5c\xa9\x11\xd4\x7d\xaf\x9e\xf1\x2d\xb2\x66\xc5\x1d\xed\xb7\xcd\xb\x25\x5e\x30\x47\x3f\x40\xf4\xa1\xa0\x0\x94\x10\xc5\x6a\x63\x1a\xd5\x88\x92\x8e\x82\x39\x87\x3c\x78\x65\x58\x42\x75\x5b\xdd\x77\x3e\x9\x4e\x76\x5b\xe6\xe\x4d\x38\xb2\xc0\xb8\x95\x1\x7a\x10\xe0\xfb\x7\xf2\xab\x2d\x8c\x32\xed\x2b\xc0\x46\xc2\xf5\x38\x83\xf0\x17\xec\xc1\x20\x6a\x9a\xb\x0\xa0\x98\x22\x50\x23\xd5\x80\x6b\xf6\x1f\xc3\xcc\x97\xc9\x24\x9f\xf3\xaf\x43\x14\xd5\xa0" ++}, { ++ .key = "\x35\x4e\xb5\x70\x50\x42\x8a\x85\xf2\xfb\xed\x7b\xd0\x9e\x97\xca\xfa\x98\x66\x63\xee\x37\xcc\x52\xfe\xd1\xdf\x95\x15\x34\x29\x38", ++ .nonce = "\xfd\x87\xd4\xd8\x62\xfd\xec\xaa", ++ .assoc = "\xd6\x31\xda\x5d\x42\x5e\xd7", ++ .alen = 7, ++ .input = "\x7a\x57\xf2\xc7\x6\x3f\x50\x7b\x36\x1a\x66\x5c\xb9\xe\x5e\x3b\x45\x60\xbe\x9a\x31\x9f\xff\x5d\x66\x34\xb4\xdc\xfb\x9d\x8e\xee\x6a\x33\xa4\x7\x3c\xf9\x4c\x30\xa1\x24\x52\xf9\x50\x46\x88\x20\x2\x32\x3a\xe\x99\x63\xaf\x1f\x15\x28\x2a\x5\xff\x57\x59\x5e\x18\xa1\x1f\xd0\x92\x5c\x88\x66\x1b\x0\x64\xa5\x93\x8d\x6\x46\xb0\x64\x8b\x8b\xef\x99\x5\x35\x85\xb3\xf3\x33\xbb\xec\x66\xb6\x3d\x57\x42\xe3\xb4\xc6\xaa\xb0\x41\x2a\xb9\x59\xa9\xf6\x3e\x15\x26\x12\x3\x21\x4c\x74\x43\x13\x2a\x3\x27\x9\xb4\xfb\xe7\xb7\x40\xff\x5e\xce\x48\x9a\x60\xe3\x8b\x80\x8c\x38\x2d\xcb\x93\x37\x74\x5\x52\x6f\x73\x3e\xc3\xbc\xca\x72\xa\xeb\xf1\x3b\xa0\x95\xdc\x8a\xc4\xa9\xdc\xca\x44\xd8\x8\x63\x6a\x36\xd3\x3c\xb8\xac\x46\x7d\xfd\xaa\xeb\x3e\xf\x45\x8f\x49\xda\x2b\xf2\x12\xbd\xaf\x67\x8a\x63\x48\x4b\x55\x5f\x6d\x8c\xb9\x76\x34\x84\xae\xc2\xfc\x52\x64\x82\xf7\xb0\x6\xf0\x45\x73\x12\x50\x30\x72\xea\x78\x9a\xa8\xaf\xb5\xe3\xbb\x77\x52\xec\x59\x84\xbf\x6b\x8f\xce\x86\x5e\x1f\x23\xe9\xfb\x8\x86\xf7\x10\xb9\xf2\x44\x96\x44\x63\xa9\xa8\x78\x0\x23\xd6\xc7\xe7\x6e\x66\x4f\xcc\xee\x15\xb3\xbd\x1d\xa0\xe5\x9c\x1b\x24\x2c\x4d\x3c\x62\x35\x9c\x88\x59\x9\xdd\x82\x1b\xcf\xa\x83\x6b\x3f\xae\x3\xc4\xb4\xdd\x7e\x5b\x28\x76\x25\x96\xd9\xc9\x9d\x5f\x86\xfa\xf6\xd7\xd2\xe6\x76\x1d\xf\xa1\xdc\x74\x5\x1b\x1d\xe0\xcd\x16\xb0\xa8\x8a\x34\x7b\x15\x11\x77\xe5\x7b\x7e\x20\xf7\xda\x38\xda\xce\x70\xe9\xf5\x6c\xd9\xbe\xc\x4c\x95\x4c\xc2\x9b\x34\x55\x55\xe1\xf3\x46\x8e\x48\x74\x14\x4f\x9d\xc9\xf5\xe8\x1a\xf0\x11\x4a\xc1\x8d\xe0\x93\xa0\xbe\x9\x1c\x2b\x4e\xf\xb2\x87\x8b\x84\xfe\x92\x32\x14\xd7\x93\xdf\xe7\x44\xbc\xc5\xae\x53\x69\xd8\xb3\x79\x37\x80\xe3\x17\x5c\xec\x53\x0\x9a\xe3\x8e\xdc\x38\xb8\x66\xf0\xd3\xad\x1d\x2\x96\x86\x3e\x9d\x3b\x5d\xa5\x7f\x21\x10\xf1\x1f\x13\x20\xf9\x57\x87\x20\xf5\x5f\xf1\x17\x48\xa\x51\x5a\xcd\x19\x3\xa6\x5a\xd1\x12\x97\xe9\x48\xe2\x1d\x83\x75\x50\xd9\x75\x7d\x6a\x82\xa1\xf9\x4e\x54\x87\x89\xc9\xc\xb7\x5b\x6a\x91\xc1\x9c\xb2\xa9\xdc\x9a\xa4\x49\xa\x6d\xd\xbb\xde\x86\x44\xdd\x5d\x89\x2b\x96\xf\x23\x95\xad\xcc\xa2\xb3\xb9\x7e\x74\x38\xba\x9f\x73\xae\x5f\xf8\x68\xa2\xe0\xa9\xce\xbd\x40\xd4\x4c\x6b\xd2\x56\x62\xb0\xcc\x63\x7e\x5b\xd3\xae\xd1\x75\xce\xbb\xb4\x5b\xa8\xf8\xb4\xac\x71\x75\xaa\xc9\x9f\xbb\x6c\xad\xf\x55\x5d\xe8\x85\x7d\xf9\x21\x35\xea\x92\x85\x2b\x0\xec\x84\x90\xa\x63\x96\xe4\x6b\xa9\x77\xb8\x91\xf8\x46\x15\x72\x63\x70\x1\x40\xa3\xa5\x76\x62\x2b\xbf\xf1\xe5\x8d\x9f\xa3\xfa\x9b\x3\xbe\xfe\x65\x6f\xa2\x29\xd\x54\xb4\x71\xce\xa9\xd6\x3d\x88\xf9\xaf\x6b\xa8\x9e\xf4\x16\x96\x36\xb9\x0\xdc\x10\xab\xb5\x8\x31\x1f\x0\xb1\x3c\xd9\x38\x3e\xc6\x4\xa7\x4e\xe8\xae\xed\x98\xc2\xf7\xb9\x0\x5f\x8c\x60\xd1\xe5\x15\xf7\xae\x1e\x84\x88\xd1\xf6\xbc\x3a\x89\x35\x22\x83\x7c\xca\xf0\x33\x82\x4c\x79\x3c\xfd\xb1\xae\x52\x62\x55\xd2\x41\x60\xc6\xbb\xfa\xe\x59\xd6\xa8\xfe\x5d\xed\x47\x3d\xe0\xea\x1f\x6e\x43\x51\xec\x10\x52\x56\x77\x42\x6b\x52\x87\xd8\xec\xe0\xaa\x76\xa5\x84\x2a\x22\x24\xfd\x92\x40\x88\xd5\x85\x1c\x1f\x6b\x47\xa0\xc4\xe4\xef\xf4\xea\xd7\x59\xac\x2a\x9e\x8c\xfa\x1f\x42\x8\xfe\x4f\x74\xa0\x26\xf5\xb3\x84\xf6\x58\x5f\x26\x66\x3e\xd7\xe4\x22\x91\x13\xc8\xac\x25\x96\x23\xd8\x9\xea\x45\x75\x23\xb8\x5f\xc2\x90\x8b\x9\xc4\xfc\x47\x6c\x6d\xa\xef\x69\xa4\x38\x19\xcf\x7d\xf9\x9\x73\x9b\x60\x5a\xf7\x37\xb5\xfe\x9f\xe3\x2b\x4c\xd\x6e\x19\xf1\xd6\xc0\x70\xf3\x9d\x22\x3c\xf9\x49\xce\x30\x8e\x44\xb5\x76\x15\x8f\x52\xfd\xa5\x4\xb8\x55\x6a\x36\x59\x7c\xc4\x48\xb8\xd7\xab\x5\x66\xe9\x5e\x21\x6f\x6b\x36\x29\xbb\xe9\xe3\xa2\x9a\xa8\xcd\x55\x25\x11\xba\x5a\x58\xa0\xde\xae\x19\x2a\x48\x5a\xff\x36\xcd\x6d\x16\x7a\x73\x38\x46\xe5\x47\x59\xc8\xa2\xf6\xe2\x6c\x83\xc5\x36\x2c\x83\x7d\xb4\x1\x5\x69\xe7\xaf\x5c\xc4\x64\x82\x12\x21\xef\xf7\xd1\x7d\xb8\x8d\x8c\x98\x7c\x5f\x7d\x92\x88\xb9\x94\x7\x9c\xd8\xe9\x9c\x17\x38\xe3\x57\x6c\xe0\xdc\xa5\x92\x42\xb3\xbd\x50\xa2\x7e\xb5\xb1\x52\x72\x3\x97\xd8\xaa\x9a\x1e\x75\x41\x11\xa3\x4f\xcc\xd4\xe3\x73\xad\x96\xdc\x47\x41\x9f\xb0\xbe\x79\x91\xf5\xb6\x18\xfe\xc2\x83\x18\x7d\x73\xd9\x4f\x83\x84\x3\xb3\xf0\x77\x66\x3d\x83\x63\x2e\x2c\xf9\xdd\xa6\x1f\x89\x82\xb8\x23\x42\xeb\xe2\xca\x70\x82\x61\x41\xa\x6d\x5f\x75\xc5\xe2\xc4\x91\x18\x44\x22\xfa\x34\x10\xf5\x20\xdc\xb7\xdd\x2a\x20\x77\xf5\xf9\xce\xdb\xa0\xa\x52\x2a\x4e\xdd\xcc\x97\xdf\x5\xe4\x5e\xb7\xaa\xf0\xe2\x80\xff\xba\x1a\xf\xac\xdf\x2\x32\xe6\xf7\xc7\x17\x13\xb7\xfc\x98\x48\x8c\xd\x82\xc9\x80\x7a\xe2\xa\xc5\xb4\xde\x7c\x3c\x79\x81\xe\x28\x65\x79\x67\x82\x69\x44\x66\x9\xf7\x16\x1a\xf9\x7d\x80\xa1\x79\x14\xa9\xc8\x20\xfb\xa2\x46\xbe\x8\x35\x17\x58\xc1\x1a\xda\x2a\x6b\x2e\x1e\xe6\x27\x55\x7b\x19\xe2\xfb\x64\xfc\x5e\x15\x54\x3c\xe7\xc2\x11\x50\x30\xb8\x72\x3\xb\x1a\x9f\x86\x27\x11\x5c\x6\x2b\xbd\x75\x1a\xa\xda\x1\xfa\x5c\x4a\xc1\x80\x3a\x6e\x30\xc8\x2c\xeb\x56\xec\x89\xfa\x35\x7b\xb2\xf0\x97\x8\x86\x53\xbe\xbd\x40\x41\x38\x1c\xb4\x8b\x79\x2e\x18\x96\x94\xde\xe8\xca\xe5\x9f\x92\x9f\x15\x5d\x56\x60\x5c\x9\xf9\x16\xf4\x17\xf\xf6\x4c\xda\xe6\x67\x89\x9f\xca\x6c\xe7\x9b\x4\x62\xe\x26\xa6\x52\xbd\x29\xff\xc7\xa4\x96\xe6\x6a\x2\xa5\x2e\x7b\xfe\x97\x68\x3e\x2e\x5f\x3b\xf\x36\xd6\x98\x19\x59\x48\xd2\xc6\xe1\x55\x1a\x6e\xd6\xed\x2c\xba\xc3\x9e\x64\xc9\x95\x86\x35\x5e\x3e\x88\x69\x99\x4b\xee\xbe\x9a\x99\xb5\x6e\x58\xae\xdd\x22\xdb\xdd\x6b\xfc\xaf\x90\xa3\x3d\xa4\xc1\x15\x92\x18\x8d\xd2\x4b\x7b\x6\xd1\x37\xb5\xe2\x7c\x2c\xf0\x25\xe4\x94\x2a\xbd\xe3\x82\x70\x78\xa3\x82\x10\x5a\x90\xd7\xa4\xfa\xaf\x1a\x88\x59\xdc\x74\x12\xb4\x8e\xd7\x19\x46\xf4\x84\x69\x9f\xbb\x70\xa8\x4c\x52\x81\xa9\xff\x76\x1c\xae\xd8\x11\x3d\x7f\x7d\xc5\x12\x59\x28\x18\xc2\xa2\xb7\x1c\x88\xf8\xd6\x1b\xa6\x7d\x9e\xde\x29\xf8\xed\xff\xeb\x92\x24\x4f\x5\xaa\xd9\x49\xba\x87\x59\x51\xc9\x20\x5c\x9b\x74\xcf\x3\xd9\x2d\x34\xc7\x5b\xa5\x40\xb2\x99\xf5\xcb\xb4\xf6\xb7\x72\x4a\xd6\xbd\xb0\xf3\x93\xe0\x1b\xa8\x4\x1e\x35\xd4\x80\x20\xf4\x9c\x31\x6b\x45\xb9\x15\xb0\x5e\xdd\xa\x33\x9c\x83\xcd\x58\x89\x50\x56\xbb\x81\x0\x91\x32\xf3\x1b\x3e\xcf\x45\xe1\xf9\xe1\x2c\x26\x78\x93\x9a\x60\x46\xc9\xb5\x5e\x6a\x28\x92\x87\x3f\x63\x7b\xdb\xf7\xd0\x13\x9d\x32\x40\x5e\xcf\xfb\x79\x68\x47\x4c\xfd\x1\x17\xe6\x97\x93\x78\xbb\xa6\x27\xa3\xe8\x1a\xe8\x94\x55\x7d\x8\xe5\xdc\x66\xa3\x69\xc8\xca\xc5\xa1\x84\x55\xde\x8\x91\x16\x3a\xc\x86\xab\x27\x2b\x64\x34\x2\x6c\x76\x8b\xc6\xaf\xcc\xe1\xd6\x8c\x2a\x18\x3d\xa6\x1b\x37\x75\x45\x73\xc2\x75\xd7\x53\x78\x3a\xd6\xe8\x29\xd2\x4a\xa8\x1e\x82\xf6\xb6\x81\xde\x21\xed\x2b\x56\xbb\xf2\xd0\x57\xc1\x7c\xd2\x6a\xd2\x56\xf5\x13\x5f\x1c\x6a\xb\x74\xfb\xe9\xfe\x9e\xea\x95\xb2\x46\xab\xa\xfc\xfd\xf3\xbb\x4\x2b\x76\x1b\xa4\x74\xb0\xc1\x78\xc3\x69\xe2\xb0\x1\xe1\xde\x32\x4c\x8d\x1a\xb3\x38\x8\xd5\xfc\x1f\xdc\xe\x2c\x9c\xb1\xa1\x63\x17\x22\xf5\x6c\x93\x70\x74\x0\xf8\x39\x1\x94\xd1\x32\x23\x56\x5d\xa6\x2\x76\x76\x93\xce\x2f\x19\xe9\x17\x52\xae\x6e\x2c\x6d\x61\x7f\x3b\xaa\xe0\x52\x85\xc5\x65\xc1\xbb\x8e\x5b\x21\xd5\xc9\x78\x83\x7\x97\x4c\x62\x61\x41\xd4\xfc\xc9\x39\xe3\x9b\xd0\xcc\x75\xc4\x97\xe6\xdd\x2a\x5f\xa6\xe8\x59\x6c\x98\xb9\x2\xe2\xa2\xd6\x68\xee\x3b\x1d\xe3\x4d\x5b\x30\xef\x3\xf2\xeb\x18\x57\x36\xe8\xa1\xf4\x47\xfb\xcb\x8f\xcb\xc8\xf3\x4f\x74\x9d\x9d\xb1\x8d\x14\x44\xd9\x19\xb4\x54\x4f\x75\x19\x9\xa0\x75\xbc\x3b\x82\xc6\x3f\xb8\x83\x19\x6e\xd6\x37\xfe\x6e\x8a\x4e\xe0\x4a\xab\x7b\xc8\xb4\x1d\xf4\xed\x27\x3\x65\xa2\xa1\xae\x11\xe7\x98\x78\x48\x91\xd2\xd2\xd4\x23\x78\x50\xb1\x5b\x85\x10\x8d\xca\x5f\xf\x71\xae\x72\x9a\xf6\x25\x19\x60\x6\xf7\x10\x34\x18\xd\xc9\x9f\x7b\xc\x9b\x8f\x91\x1b\x9f\xcd\x10\xee\x75\xf9\x97\x66\xfc\x4d\x33\x6e\x28\x2b\x92\x85\x4f\xab\x43\x8d\x8f\x7d\x86\xa7\xc7\xd8\xd3\xb\x8b\x57\xb6\x1d\x95\xd\xe9\xbc\xd9\x3\xd9\x10\x19\xc3\x46\x63\x55\x87\x61\x79\x6c\x95\xe\x9c\xdd\xca\xc3\xf3\x64\xf0\x7d\x76\xb7\x53\x67\x2b\x1e\x44\x56\x81\xea\x8f\x5c\x42\x16\xb8\x28\xeb\x1b\x61\x10\x1e\xbf\xec\xa8", ++ .ilen = 1933, ++ .result = "\x6a\xfc\x4b\x25\xdf\xc0\xe4\xe8\x17\x4d\x4c\xc9\x7e\xde\x3a\xcc\x3c\xba\x6a\x77\x47\xdb\xe3\x74\x7a\x4d\x5f\x8d\x37\x55\x80\x73\x90\x66\x5d\x3a\x7d\x5d\x86\x5e\x8d\xfd\x83\xff\x4e\x74\x6f\xf9\xe6\x70\x17\x70\x3e\x96\xa7\x7e\xcb\xab\x8f\x58\x24\x9b\x1\xfd\xcb\xe6\x4d\x9b\xf0\x88\x94\x57\x66\xef\x72\x4c\x42\x6e\x16\x19\x15\xea\x70\x5b\xac\x13\xdb\x9f\x18\xe2\x3c\x26\x97\xbc\xdc\x45\x8c\x6c\x24\x69\x9c\xf7\x65\x1e\x18\x59\x31\x7c\xe4\x73\xbc\x39\x62\xc6\x5c\x9f\xbf\xfa\x90\x3\xc9\x72\x26\xb6\x1b\xc2\xb7\x3f\xf2\x13\x77\xf2\x8d\xb9\x47\xd0\x53\xdd\xc8\x91\x83\x8b\xb1\xce\xa3\xfe\xcd\xd9\xdd\x92\x7b\xdb\xb8\xfb\xc9\x2d\x1\x59\x39\x52\xad\x1b\xec\xcf\xd7\x70\x13\x21\xf5\x47\xaa\x18\x21\x5c\xc9\x9a\xd2\x6b\x5\x9c\x1\xa1\xda\x35\x5d\xb3\x70\xe6\xa9\x80\x8b\x91\xb7\xb3\x5f\x24\x9a\xb7\xd1\x6b\xa1\x1c\x50\xba\x49\xe0\xee\x2e\x75\xac\x69\xc0\xeb\x3\xdd\x19\xe5\xf6\x6\xdd\xc3\xd7\x2b\x7\x7\x30\xa7\x19\xc\xbf\xe6\x18\xcc\xb1\x1\x11\x85\x77\x1d\x96\xa7\xa3\x0\x84\x2\xa2\x83\x68\xda\x17\x27\xc8\x7f\x23\xb7\xf4\x13\x85\xcf\xdd\x7a\x7d\x24\x57\xfe\x5\x93\xf5\x74\xce\xed\xc\x20\x98\x8d\x92\x30\xa1\x29\x23\x1a\xa0\x4f\x69\x56\x4c\xe1\xc8\xce\xf6\x9a\xc\xa4\xfa\x4\xf6\x62\x95\xf2\xfa\xc7\x40\x68\x40\x8f\x41\xda\xb4\x26\x6f\x70\xab\x40\x61\xa4\xe\x75\xfb\x86\xeb\x9d\x9a\x1f\xec\x76\x99\xe7\xea\xaa\x1e\x2d\xb5\xd4\xa6\x1a\xb8\x61\xa\x1d\x16\x5b\x98\xc2\x31\x40\xe7\x23\x1d\x66\x99\xc8\xc0\xd7\xce\xf3\x57\x40\x4\x3f\xfc\xea\xb3\xfc\xd2\xd3\x99\xa4\x94\x69\xa0\xef\xd1\x85\xb3\xa6\xb1\x28\xbf\x94\x67\x22\xc3\x36\x46\xf8\xd2\xf\x5f\xf4\x59\x80\xe6\x2d\x43\x8\x7d\x19\x9\x97\xa7\x4c\x3d\x8d\xba\x65\x62\xa3\x71\x33\x29\x62\xdb\xc1\x33\x34\x1a\x63\x33\x16\xb6\x64\x7e\xab\x33\xf0\xe6\x26\x68\xba\x1d\x2e\x38\x8\xe6\x2\xd3\x25\x2c\x47\x23\x58\x34\xf\x9d\x63\x4f\x63\xbb\x7f\x3b\x34\x38\xa7\xb5\x8d\x65\xd9\x9f\x79\x55\x3e\x4d\xe7\x73\xd8\xf6\x98\x97\x84\x60\x9c\xc8\xa9\x3c\xf6\xdc\x12\x5c\xe1\xbb\xb\x8b\x98\x9c\x9d\x26\x7c\x4a\xe6\x46\x36\x58\x21\x4a\xee\xca\xd7\x3b\xc2\x6c\x49\x2f\xe5\xd5\x3\x59\x84\x53\xcb\xfe\x92\x71\x2e\x7c\x21\xcc\x99\x85\x7f\xb8\x74\x90\x13\x42\x3f\xe0\x6b\x1d\xf2\x4d\x54\xd4\xfc\x3a\x5\xe6\x74\xaf\xa6\xa0\x2a\x20\x23\x5d\x34\x5c\xd9\x3e\x4e\xfa\x93\xe7\xaa\xe9\x6f\x8\x43\x67\x41\xc5\xad\xfb\x31\x95\x82\x73\x32\xd8\xa6\xa3\xed\xe\x2d\xf6\x5f\xfd\x80\xa6\x7a\xe0\xdf\x78\x15\x29\x74\x33\xd0\x9e\x83\x86\x72\x22\x57\x29\xb9\x9e\x5d\xd3\x1a\xb5\x96\x72\x41\x3d\xf1\x64\x43\x67\xee\xaa\x5c\xd3\x9a\x96\x13\x11\x5d\xf3\xc\x87\x82\x1e\x41\x9e\xd0\x27\xd7\x54\x3b\x67\x73\x9\x91\xe9\xd5\x36\xa7\xb5\x55\xe4\xf3\x21\x51\x49\x22\x7\x55\x4f\x44\x4b\xd2\x15\x93\x17\x2a\xfa\x4d\x4a\x57\xdb\x4c\xa6\xeb\xec\x53\x25\x6c\x21\xed\x0\x4c\x3b\xca\x14\x57\xa9\xd6\x6a\xcd\x8d\x5e\x74\xac\x72\xc1\x97\xe5\x1b\x45\x4e\xda\xfc\xcc\x40\xe8\x48\x88\xb\xa3\xe3\x8d\x83\x42\xc3\x23\xfd\x68\xb5\x8e\xf1\x9d\x63\x77\xe9\xa3\x8e\x8c\x26\x6b\xbd\x72\x73\x35\xc\x3\xf8\x43\x78\x52\x71\x15\x1f\x71\x5d\x6e\xed\xb9\xcc\x86\x30\xdb\x2b\xd3\x82\x88\x23\x71\x90\x53\x5c\xa9\x2f\x76\x1\xb7\x9a\xfe\x43\x55\xa3\x4\x9b\xe\xe4\x59\xdf\xc9\xe9\xb1\xea\x29\x28\x3c\x5c\xae\x72\x84\xb6\xc6\xeb\xc\x27\x7\x74\x90\xd\x31\xb0\x0\x77\xe9\x40\x70\x6f\x68\xa7\xfd\x6\xec\x4b\xc0\xb7\xac\xbc\x33\xb7\x6d\xa\xbd\x12\x1b\x59\xcb\xdd\x32\xf5\x1d\x94\x57\x76\x9e\xc\x18\x98\x71\xd7\x2a\xdb\xb\x7b\xa7\x71\xb7\x67\x81\x23\x96\xae\xb9\x7e\x32\x43\x92\x8a\x19\xa0\xc4\xd4\x3b\x57\xf9\x4a\x2c\xfb\x51\x46\xbb\xcb\x5d\xb3\xef\x13\x93\x6e\x68\x42\x54\x57\xd3\x6a\x3a\x8f\x9d\x66\xbf\xbd\x36\x23\xf5\x93\x83\x7b\x9c\xc0\xdd\xc5\x49\xc0\x64\xed\x7\x12\xb3\xe6\xe4\xe5\x38\x95\x23\xb1\xa0\x3b\x1a\x61\xda\x17\xac\xc3\x58\xdd\x74\x64\x22\x11\xe8\x32\x1d\x16\x93\x85\x99\xa5\x9c\x34\x55\xb1\xe9\x20\x72\xc9\x28\x7b\x79\x0\xa1\xa6\xa3\x27\x40\x18\x8a\x54\xe0\xcc\xe8\x4e\x8e\x43\x96\xe7\x3f\xc8\xe9\xb2\xf9\xc9\xda\x4\x71\x50\x47\xe4\xaa\xce\xa2\x30\xc8\xe4\xac\xc7\xd\x6\x2e\xe6\xe8\x80\x36\x29\x9e\x1\xb8\xc3\xf0\xa0\x5d\x7a\xca\x4d\xa0\x57\xbd\x2a\x45\xa7\x7f\x9c\x93\x7\x8f\x35\x67\x92\xe3\xe9\x7f\xa8\x61\x43\x9e\x25\x4f\x33\x76\x13\x6e\x12\xb9\xdd\xa4\x7c\x8\x9f\x7c\xe7\xa\x8d\x84\x6\xa4\x33\x17\x34\x5e\x10\x7c\xc0\xa8\x3d\x1f\x42\x20\x51\x65\x5d\x9\xc3\xaa\xc0\xc8\xd\xf0\x79\xbc\x20\x1b\x95\xe7\x6\x7d\x47\x20\x3\x1a\x74\xdd\xe2\xd4\xae\x38\x71\x9b\xf5\x80\xec\x8\x4e\x56\xba\x76\x12\x1a\xdf\x48\xf3\xae\xb3\xe6\xe6\xbe\xc0\x91\x2e\x1\xb3\x1\x86\xa2\xb9\x52\xd1\x21\xae\xd4\x97\x1d\xef\x41\x12\x95\x3d\x48\x45\x1c\x56\x32\x8f\xb8\x43\xbb\x19\xf3\xca\xe9\xeb\x6d\x84\xbe\x86\x6\xe2\x36\xb2\x62\x9d\xd3\x4c\x48\x18\x54\x13\x4e\xcf\xfd\xba\x84\xb9\x30\x53\xcf\xfb\xb9\x29\x8f\xdc\x9f\xef\x60\xb\x64\xf6\x8b\xee\xa6\x91\xc2\x41\x6c\xf6\xfa\x79\x67\x4b\xc1\x3f\xaf\x9\x81\xd4\x5d\xcb\x9\xdf\x36\x31\xc0\x14\x3c\x7c\xe\x65\x95\x99\x6d\xa3\xf4\xd7\x38\xee\x1a\x2b\x37\xe2\xa4\x3b\x4b\xd0\x65\xca\xf8\xc3\xe8\x15\x20\xef\xf2\x0\xfd\x1\x9\xc5\xc8\x17\x4\x93\xd0\x93\x3\x55\xc5\xfe\x32\xa3\x3e\x28\x2d\x3b\x93\x8a\xcc\x7\x72\x80\x8b\x74\x16\x24\xbb\xda\x94\x39\x30\x8f\xb1\xcd\x4a\x90\x92\x7c\x14\x8f\x95\x4e\xac\x9b\xd8\x8f\x1a\x87\xa4\x32\x27\x8a\xba\xf7\x41\xcf\x84\x37\x19\xe6\x6\xf5\xe\xcf\x36\xf5\x9e\x6c\xde\xbc\xff\x64\x7e\x4e\x59\x57\x48\xfe\x14\xf7\x9c\x93\x5d\x15\xad\xcc\x11\xb1\x17\x18\xb2\x7e\xcc\xab\xe9\xce\x7d\x77\x5b\x51\x1b\x1e\x20\xa8\x32\x6\xe\x75\x93\xac\xdb\x35\x37\x1f\xe9\x19\x1d\xb4\x71\x97\xd6\x4e\x2c\x8\xa5\x13\xf9\xe\x7e\x78\x6e\x14\xe0\xa9\xb9\x96\x4c\x80\x82\xba\x17\xb3\x9d\x69\xb0\x84\x46\xff\xf9\x52\x79\x94\x58\x3a\x62\x90\x15\x35\x71\x10\x37\xed\xa1\x8e\x53\x6e\xf4\x26\x57\x93\x15\x93\xf6\x81\x2c\x5a\x10\xda\x92\xad\x2f\xdb\x28\x31\x2d\x55\x4\xd2\x6\x28\x8c\x1e\xdc\xea\x54\xac\xff\xb7\x6c\x30\x15\xd4\xb4\xd\x0\x93\x57\xdd\xd2\x7\x7\x6\xd9\x43\x9b\xcd\x3a\xf4\x7d\x4c\x36\x5d\x23\xa2\xcc\x57\x40\x91\xe9\x2c\x2f\x2c\xd5\x30\x9b\x17\xb0\xc9\xf7\xa7\x2f\xd1\x93\x20\x6b\xc6\xc1\xe4\x6f\xcb\xd1\xe7\x9\xf\x9e\xdc\xaa\x9f\x2f\xdf\x56\x9f\xd4\x33\x4\xaf\xd3\x6c\x58\x61\xf0\x30\xec\xf2\x7f\xf2\x9c\xdf\x39\xbb\x6f\xa2\x8c\x7e\xc4\x22\x51\x71\xc0\x4d\x14\x1a\xc4\xcd\x4\xd9\x87\x8\x50\x5\xcc\xaf\xf6\xf0\x8f\x92\x54\x58\xc2\xc7\x9\x7a\x59\x2\x5\xe8\xb0\x86\xd9\xbf\x7b\x35\x51\x4d\xaf\x8\x97\x2c\x65\xda\x2a\x71\x3a\xa8\x51\xcc\xf2\x73\x27\xc3\xfd\x62\xcf\xe3\xb2\xca\xcb\xbe\x1a\xa\xa1\x34\x7b\x77\xc4\x62\x68\x78\x5f\x94\x7\x4\x65\x16\x4b\x61\xcb\xff\x75\x26\x50\x66\x1f\x6e\x93\xf8\xc5\x51\xeb\xa4\x4a\x48\x68\x6b\xe2\x5e\x44\xb2\x50\x2c\x6c\xae\x79\x4e\x66\x35\x81\x50\xac\xbc\x3f\xb1\xc\xf3\x5\x3c\x4a\xa3\x6c\x2a\x79\xb4\xb7\xab\xca\xc7\x9b\x8e\xcd\x5f\x11\x3\xcb\x30\xa3\xab\xda\xfe\x64\xb9\xbb\xd8\x5e\x3a\x1a\x56\xe5\x5\x48\x90\x1e\x61\x69\x1b\x22\xe6\x1a\x3c\x75\xad\x1f\x37\x28\xdc\xe4\x6d\xbd\x42\xdc\xd3\xc8\xb6\x1c\x48\xfe\x94\x77\x7f\xbd\x62\xac\xa3\x47\x27\xcf\x5f\xd9\xdb\xaf\xec\xf7\x5e\xc1\xb0\x9d\x1\x26\x99\x7e\x8f\x3\x70\xb5\x42\xbe\x67\x28\x1b\x7c\xbd\x61\x21\x97\xcc\x5c\xe1\x97\x8f\x8d\xde\x2b\xaa\xa7\x71\x1d\x1e\x2\x73\x70\x58\x32\x5b\x1d\x67\x3d\xe0\x74\x4f\x3\xf2\x70\x51\x79\xf1\x61\x70\x15\x74\x9d\x23\x89\xde\xac\xfd\xde\xd0\x1f\xc3\x87\x44\x35\x4b\xe5\xb0\x60\xc5\x22\xe4\x9e\xca\xeb\xd5\x3a\x9\x45\xa4\xdb\xfa\x3f\xeb\x1b\xc7\xc8\x14\x99\x51\x92\x10\xed\xed\x28\xe0\xa1\xf8\x26\xcf\xcd\xcb\x63\xa1\x3b\xe3\xdf\x7e\xfe\xa6\xf0\x81\x9a\xbf\x55\xde\x54\xd5\x56\x60\x98\x10\x68\xf4\x38\x96\x8e\x6f\x1d\x44\x7f\xd6\x2f\xfe\x55\xfb\xc\x7e\x67\xe2\x61\x44\xed\xf2\x35\x30\x5d\xe9\xc7\xd6\x6d\xe0\xa0\xed\xf3\xfc\xd8\x3e\xa\x7b\xcd\xaf\x65\x68\x18\xc0\xec\x4\x1c\x74\x6d\xe2\x6e\x79\xd4\x11\x2b\x62\xd5\x27\xad\x4f\x1\x59\x73\xcc\x6a\x53\xfb\x2d\xd5\x4e\x99\x21\x65\x4d\xf5\x82\xf7\xd8\x42\xce\x6f\x3d\x36\x47\xf1\x5\x16\xe8\x1b\x6a\x8f\x93\xf2\x8f\x37\x40\x12\x28\xa3\xe6\xb9\x17\x4a\x1f\xb1\xd1\x66\x69\x86\xc4\xfc\x97\xae\x3f\x8f\x1e\x2b\xdf\xcd\xf9\x3c" ++}, { ++ .key = "\xb3\x35\x50\x3\x54\x2e\x40\x5e\x8f\x59\x8e\xc5\x90\xd5\x27\x2d\xba\x29\x2e\xcb\x1b\x70\x44\x1e\x65\x91\x6e\x2a\x79\x22\xda\x64", ++ .nonce = "\x5\xa3\x93\xed\x30\xc5\xa2\x6", ++ .assoc = "\xb1\x69\x83\x87\x30\xaa\x5d\xb8\x77\xe8\x21\xff\x6\x59\x35\xce\x75\xfe\x38\xef\xb8\x91\x43\x8c\xcf\x70\xdd\xa\x68\xbf\xd4\xbc\x16\x76\x99\x36\x1e\x58\x79\x5e\xd4\x29\xf7\x33\x93\x48\xdb\x5f\x1\xae\x9c\xb6\xe4\x88\x6d\x2b\x76\x75\xe0\xf3\x74\xe2\xc9", ++ .alen = 63, ++ .input = "\x74\xa6\x3e\xe4\xb1\xcb\xaf\xb0\x40\xe5\xf\x9e\xf1\xf2\x89\xb5\x42\x34\x8a\xa1\x3\xb7\xe9\x57\x46\xbe\x20\xe4\x6e\xb0\xeb\xff\xea\x7\x7e\xef\xe2\x55\x9f\xe5\x78\x3a\xb7\x83\xc2\x18\x40\x7b\xeb\xcd\x81\xfb\x90\x12\x9e\x46\xa9\xd6\x4a\xba\xb0\x62\xdb\x6b\x99\xc4\xdb\x54\x4b\xb8\xa5\x71\xcb\xcd\x63\x32\x55\xfb\x31\xf0\x38\xf5\xbe\x78\xe4\x45\xce\x1b\x6a\x5b\xe\xf4\x16\xe4\xb1\x3d\xf6\x63\x7b\xa7\xc\xde\x6f\x8f\x74\xdf\xe0\x1e\x9d\xce\x8f\x24\xef\x23\x35\x33\x7b\x83\x34\x23\x58\x74\x14\x77\x1f\xc2\x4f\x4e\xc6\x89\xf9\x52\x9\x37\x64\x14\xc4\x1\x6b\x9d\x77\xe8\x90\x5d\xa8\x4a\x2a\xef\x5c\x7f\xeb\xbb\xb2\xc6\x93\x99\x66\xdc\x7f\xd4\x9e\x2a\xca\x8d\xdb\xe7\x20\xcf\xe4\x73\xae\x49\x7d\x64\xf\xe\x28\x46\xa9\xa8\x32\xe4\xe\xf6\x51\x53\xb8\x3c\xb1\xff\xa3\x33\x41\x75\xff\xf1\x6f\xf1\xfb\xbb\x83\x7f\x6\x9b\xe7\x1b\xa\xe0\x5c\x33\x60\x5b\xdb\x5b\xed\xfe\xa5\x16\x19\x72\xa3\x64\x23\x0\x2\xc7\xf3\x6a\x81\x3e\x44\x1d\x79\x15\x5f\x9a\xde\xe2\xfd\x1b\x73\xc1\xbc\x23\xba\x31\xd2\x50\xd5\xad\x7f\x74\xa7\xc9\xf8\x3e\x2b\x26\x10\xf6\x3\x36\x74\xe4\xe\x6a\x72\xb7\x73\xa\x42\x28\xc2\xad\x5e\x3\xbe\xb8\xb\xa8\x5b\xd4\xb8\xba\x52\x89\xb1\x9b\xc1\xc3\x65\x87\xed\xa5\xf4\x86\xfd\x41\x80\x91\x27\x59\x53\x67\x15\x78\x54\x8b\x2d\x3d\xc7\xff\x2\x92\x7\x5f\x7a\x4b\x60\x59\x3c\x6f\x5c\xd8\xec\x95\xd2\xfe\xa0\x3b\xd8\x3f\xd1\x69\xa6\xd6\x41\xb2\xf4\x4d\x12\xf4\x58\x3e\x66\x64\x80\x31\x9b\xa8\x4c\x8b\x7\xb2\xec\x66\x94\x66\x47\x50\x50\x5f\x18\xb\xe\xd6\xc0\x39\x21\x13\x9e\x33\xbc\x79\x36\x2\x96\x70\xf0\x48\x67\x2f\x26\xe9\x6d\x10\xbb\xd6\x3f\xd1\x64\x7a\x2e\xbe\xc\x61\xf0\x75\x42\x38\x23\xb1\x9e\x9f\x7c\x67\x66\xd9\x58\x9a\xf1\xbb\x41\x2a\x8d\x65\x84\x94\xfc\xdc\x6a\x50\x64\xdb\x56\x33\x76\x0\x10\xed\xbe\xd2\x12\xf6\xf6\x1b\xa2\x16\xde\xae\x31\x95\xdd\xb1\x8\x7e\x4e\xee\xe7\xf9\xa5\xfb\x5b\x61\x43\x0\x40\xf6\x7e\x2\x4\x32\x4e\xc\xe2\x66\xd\xd7\x7\x98\xe\xf8\x72\x34\x6d\x95\x86\xd7\xcb\x31\x54\x47\xd0\x38\x29\x9c\x5a\x68\xd4\x87\x76\xc9\xe7\x7e\xe3\xf4\x81\x6d\x18\xcb\xc9\x5\xaf\xa0\xfb\x66\xf7\xf1\x1c\xc6\x14\x11\x4f\x2b\x79\x42\x8b\xbc\xac\xe7\x6c\xfe\xf\x58\xe7\x7c\x78\x39\x30\xb0\x66\x2c\x9b\x6d\x3a\xe1\xcf\xc9\xa4\xe\x6d\x6d\x8a\xa1\x3a\xe7\x28\xd4\x78\x4c\xa6\xa2\x2a\xa6\x3\x30\xd7\xa8\x25\x66\x87\x2f\x69\x5c\x4e\xdd\xa5\x49\x5d\x37\x4a\x59\xc4\xaf\x1f\xa2\xe4\xf8\xa6\x12\x97\xd5\x79\xf5\xe2\x4a\x2b\x5f\x61\xe4\x9e\xe3\xee\xb8\xa7\x5b\x2f\xf4\x9e\x6c\xfb\xd1\xc6\x56\x77\xba\x75\xaa\x3d\x1a\xa8\xb\xb3\x68\x24\x0\x10\x7f\xfd\xd7\xa1\x8d\x83\x54\x4f\x1f\xd8\x2a\xbe\x8a\xc\x87\xab\xa2\xde\xc3\x39\xbf\x9\x3\xa5\xf3\x5\x28\xe1\xe1\xee\x39\x70\x9c\xd8\x81\x12\x1e\x2\x40\xd2\x6e\xf0\xeb\x1b\x3d\x22\xc6\xe5\xe3\xb4\x5a\x98\xbb\xf0\x22\x28\x8d\xe5\xd3\x16\x48\x24\xa5\xe6\x66\xc\xf9\x8\xf9\x7e\x1e\xe1\x28\x26\x22\xc7\xc7\xa\x32\x47\xfa\xa3\xbe\x3c\xc4\xc5\x53\xa\xd5\x94\x4a\xd7\x93\xd8\x42\x99\xb9\xa\xdb\x56\xf7\xb9\x1c\x53\x4f\xfa\xd3\x74\xad\xd9\x68\xf1\x1b\xdf\x61\xc6\x5e\xa8\x48\xfc\xd4\x4a\x4c\x3c\x32\xf7\x1c\x96\x21\x9b\xf9\xa3\xcc\x5a\xce\xd5\xd7\x8\x24\xf6\x1c\xfd\xdd\x38\xc2\x32\xe9\xb8\xe7\xb6\xfa\x9d\x45\x13\x2c\x83\xfd\x4a\x69\x82\xcd\xdc\xb3\x76\xc\x9e\xd8\xf4\x1b\x45\x15\xb4\x97\xe7\x58\x34\xe2\x3\x29\x5a\xbf\xb6\xe0\x5d\x13\xd9\x2b\xb4\x80\xb2\x45\x81\x6a\x2e\x6c\x89\x7d\xee\xbb\x52\xdd\x1f\x18\xe7\x13\x6b\x33\xe\xea\x36\x92\x77\x7b\x6d\x9c\x5a\x5f\x45\x7b\x7b\x35\x62\x23\xd1\xbf\xf\xd0\x8\x1b\x2b\x80\x6b\x7e\xf1\x21\x47\xb0\x57\xd1\x98\x72\x90\x34\x1c\x20\x4\xff\x3d\x5c\xee\xe\x57\x5f\x6f\x24\x4e\x3c\xea\xfc\xa5\xa9\x83\xc9\x61\xb4\x51\x24\xf8\x27\x5e\x46\x8c\xb1\x53\x2\x96\x35\xba\xb8\x4c\x71\xd3\x15\x59\x35\x22\x20\xad\x3\x9f\x66\x44\x3b\x9c\x35\x37\x1f\x9b\xbb\xf3\xdb\x35\x63\x30\x64\xaa\xa2\x6\xa8\x5d\xbb\xe1\x9f\x70\xec\x82\x11\x6\x36\xec\x8b\x69\x66\x24\x44\xc9\x4a\x57\xbb\x9b\x78\x13\xce\x9c\xc\xba\x92\x93\x63\xb8\xe2\x95\xf\xf\x16\x39\x52\xfd\x3a\x6d\x2\x4b\xdf\x13\xd3\x2a\x22\xb4\x3\x7c\x54\x49\x96\x68\x54\x10\xfa\xef\xaa\x6c\xe8\x22\xdc\x71\x16\x13\x1a\xf6\x28\xe5\x6d\x77\x3d\xcd\x30\x63\xb1\x70\x52\xa1\xc5\x94\x5f\xcf\xe8\xb8\x26\x98\xf7\x6\xa0\xa\x70\xfa\x3\x80\xac\xc1\xec\xd6\x4c\x54\xd7\xfe\x47\xb6\x88\x4a\xf7\x71\x24\xee\xf3\xd2\xc2\x4a\x7f\xfe\x61\xc7\x35\xc9\x37\x67\xcb\x24\x35\xda\x7e\xca\x5f\xf3\x8d\xd4\x13\x8e\xd6\xcb\x4d\x53\x8f\x53\x1f\xc0\x74\xf7\x53\xb9\x5e\x23\x37\xba\x6e\xe3\x9d\x7\x55\x25\x7b\xe6\x2a\x64\xd1\x32\xdd\x54\x1b\x4b\xc0\xe1\xd7\x69\x58\xf8\x93\x29\xc4\xdd\x23\x2f\xa5\xfc\x9d\x7e\xf8\xd4\x90\xcd\x82\x55\xdc\x16\x16\x9f\x7\x52\x9b\x9d\x25\xed\x32\xc5\x7b\xdf\xf6\x83\x46\x3d\x65\xb7\xef\x87\x7a\x12\x69\x8f\x6\x7c\x51\x15\x4a\x8\xe8\xac\x9a\xc\x24\xa7\x27\xd8\x46\x2f\xe7\x1\xe\x1c\xc6\x91\xb0\x6e\x85\x65\xf0\x29\xd\x2e\x6b\x3b\xfb\x4b\xdf\xe4\x80\x93\x3\x66\x46\x3e\x8a\x6e\xf3\x5e\x4d\x62\xe\x49\x5\xaf\xd4\xf8\x21\x20\x61\x1d\x39\x17\xf4\x61\x47\x95\xfb\x15\x2e\xb3\x4f\xd0\x5d\xf5\x7d\x40\xda\x90\x3c\x6b\xcb\x17\x0\x13\x3b\x64\x34\x1b\xf0\xf2\xe5\x3b\xb2\xc7\xd3\x5f\x3a\x44\xa6\x9b\xb7\x78\xe\x42\x5d\x4c\xc1\xe9\xd2\xcb\xb7\x78\xd1\xfe\x9a\xb5\x7\xe9\xe0\xbe\xe2\x8a\xa7\x1\x83\x0\x8c\x5c\x8\xe6\x63\x12\x92\xb7\xb7\xa6\x19\x7d\x38\x13\x38\x92\x87\x24\xf9\x48\xb3\x5e\x87\x6a\x40\x39\x5c\x3f\xed\x8f\xee\xdb\x15\x82\x6\xda\x49\x21\x2b\xb5\xbf\x32\x7c\x9f\x42\x28\x63\xcf\xaf\x1e\xf8\xc6\xa0\xd1\x2\x43\x57\x62\xec\x9b\xf\x1\x9e\x71\xd8\x87\x9d\x1\xc1\x58\x77\xd9\xaf\xb1\x10\x7e\xdd\xa6\x50\x96\xe5\xf0\x72\x0\x6d\x4b\xf8\x2a\x8f\x19\xf3\x22\x88\x11\x4a\x8b\x7c\xfd\xb7\xed\xe1\xf6\x40\x39\xe0\xe9\xf6\x3d\x25\xe6\x74\x3c\x58\x57\x7f\xe1\x22\x96\x47\x31\x91\xba\x70\x85\x28\x6b\x9f\x6e\x25\xac\x23\x66\x2f\x29\x88\x28\xce\x8c\x5c\x88\x53\xd1\x3b\xcc\x6a\x51\xb2\xe1\x28\x3f\x91\xb4\xd\x0\x3a\xe3\xf8\xc3\x8f\xd7\x96\x62\xe\x2e\xfc\xc8\x6c\x77\xa6\x1d\x22\xc1\xb8\xe6\x61\xd7\x67\x36\x13\x7b\xbb\x9b\x59\x9\xa6\xdf\xf7\x6b\xa3\x40\x1a\xf5\x4f\xb4\xda\xd3\xf3\x81\x93\xc6\x18\xd9\x26\xee\xac\xf0\xaa\xdf\xc5\x9c\xca\xc2\xa2\xcc\x7b\x5c\x24\xb0\xbc\xd0\x6a\x4d\x89\x9\xb8\x7\xfe\x87\xad\xa\xea\xb8\x42\xf9\x5e\xb3\x3e\x36\x4c\xaf\x75\x9e\x1c\xeb\xbd\xbc\xbb\x80\x40\xa7\x3a\x30\xbf\xa8\x44\xf4\xeb\x38\xad\x29\xba\x23\xed\x41\xc\xea\xd2\xbb\x41\x18\xd6\xb9\xba\x65\x2b\xa3\x91\x6d\x1f\xa9\xf4\xd1\x25\x8d\x4d\x38\xff\x64\xa0\xec\xde\xa6\xb6\x79\xab\x8e\x33\x6c\x47\xde\xaf\x94\xa4\xa5\x86\x77\x55\x9\x92\x81\x31\x76\xc7\x34\x22\x89\x8e\x3d\x26\x26\xd7\xfc\x1e\x16\x72\x13\x33\x63\xd5\x22\xbe\xb8\x4\x34\x84\x41\xbb\x80\xd0\x9f\x46\x48\x7\xa7\xfc\x2b\x3a\x75\x55\x8c\xc7\x6a\xbd\x7e\x46\x8\x84\xf\xd5\x74\xc0\x82\x8e\xaa\x61\x5\x1\xb2\x47\x6e\x20\x6a\x2d\x58\x70\x48\x32\xa7\x37\xd2\xb8\x82\x1a\x51\xb9\x61\xdd\xfd\x9d\x6b\xe\x18\x97\xf8\x45\x5f\x87\x10\xcf\x34\x72\x45\x26\x49\x70\xe7\xa3\x78\xe0\x52\x89\x84\x94\x83\x82\xc2\x69\x8f\xe3\xe1\x3f\x60\x74\x88\xc4\xf7\x75\x2c\xfb\xbd\xb6\xc4\x7e\x10\xa\x6c\x90\x4\x9e\xc3\x3f\x59\x7c\xce\x31\x18\x60\x57\x73\x46\x94\x7d\x6\xa0\x6d\x44\xec\xa2\xa\x9e\x5\x15\xef\xca\x5c\xbf\x0\xeb\xf7\x3d\x32\xd4\xa5\xef\x49\x89\x5e\x46\xb0\xa6\x63\x5b\x8a\x73\xae\x6f\xd5\x9d\xf8\x4f\x40\xb5\xb2\x6e\xd3\xb6\x1\xa9\x26\xa2\x21\xcf\x33\x7a\x3a\xa4\x23\x13\xb0\x69\x6a\xee\xce\xd8\x9d\x1\x1d\x50\xc1\x30\x6c\xb1\xcd\xa0\xf0\xf0\xa2\x64\x6f\xbb\xbf\x5e\xe6\xab\x87\xb4\xf\x4f\x15\xaf\xb5\x25\xa1\xb2\xd0\x80\x2c\xfb\xf9\xfe\xd2\x33\xbb\x76\xfe\x7c\xa8\x66\xf7\xe7\x85\x9f\x1f\x85\x57\x88\xe1\xe9\x63\xe4\xd8\x1c\xa1\xfb\xda\x44\x5\x2e\x1d\x3a\x1c\xff\xc8\x3b\xc0\xfe\xda\x22\xb\x43\xd6\x88\x39\x4c\x4a\xa6\x69\x18\x93\x42\x4e\xb5\xcc\x66\xd\x9\xf8\x1e\x7c\xd3\x3c\x99\xd\x50\x1d\x62\xe9\x57\x6\xbf\x19\x88\xdd\xad\x7b\x4f\xf9\xc7\x82\x6d\x8d\xc8\xc4\xc5\x78\x17\x20\x15\xc5\x52\x41\xcf\x5b\xd6\x7f\x94\x2\x41\xe0\x40\x22\x3\x5e\xd1\x53\xd4\x86\xd3\x2c\x9f\xf\x96\xe3\x6b\x9a\x76\x32\x6\x47\x4b\x11\xb3\xdd\x3\x65\xbd\x9b\x1\xda\x9c\xb9\x7e\x3f\x6a\xc4\x7b\xea\xd4\x3c\xb9\xfb\x5c\x6b\x64\x33\x52\xba\x64\x78\x8f\xa4\xaf\x7a\x61\x8d\xbc\xc5\x73\xe9\x6b\x58\x97\x4b\xbf\x63\x22\xd3\x37\x2\x54\xc5\xb9\x16\x4a\xf0\x19\xd8\x94\x57\xb8\x8a\xb3\x16\x3b\xd0\x84\x8e\x67\xa6\xa3\x7d\x78\xec\x0", ++ .ilen = 2011, ++ .result = "\x52\x34\xb3\x65\x3b\xb7\xe5\xd3\xab\x49\x17\x60\xd2\x52\x56\xdf\xdf\x34\x56\x82\xe2\xbe\xe5\xe1\x28\xd1\x4e\x5f\x4f\x1\x7d\x3f\x99\x6b\x30\x6e\x1a\x7c\x4c\x8e\x62\x81\xae\x86\x3f\x6b\xd0\xb5\xa9\xcf\x50\xf1\x2\x12\xa0\xb\x24\xe9\xe6\x72\x89\x2c\x52\x1b\x34\x38\xf8\x75\x5f\xa0\x74\xe2\x99\xdd\xa6\x4b\x14\x50\x4e\xf1\xbe\xd6\x9e\xdb\xb2\x24\x27\x74\x12\x4a\x78\x78\x17\xa5\x58\x8e\x2f\xf9\xf4\x8d\xee\x3\x88\xae\xb8\x29\xa1\x2f\x4b\xee\x92\xbd\x87\xb3\xce\x34\x21\x57\x46\x4\x49\xc\x80\xf2\x1\x13\xa1\x55\xb3\xff\x44\x30\x3c\x1c\xd0\xef\xbc\x18\x74\x26\xad\x41\x5b\x5b\x3e\x9a\x7a\x46\x4f\x16\xd6\x74\x5a\xb7\x3a\x28\x31\xd8\xae\x26\xac\x50\x53\x86\xf2\x56\xd7\x3f\x29\xbc\x45\x68\x8e\xcb\x98\x64\xdd\xc9\xba\xb8\x4b\x7b\x82\xdd\x14\xa7\xcb\x71\x72\x0\x5c\xad\x7b\x6a\x89\xa4\x3d\xbf\xb5\x4b\x3e\x7c\x5a\xcf\xb8\xa1\xc5\x6e\xc8\xb6\x31\x57\x7b\xdf\xa5\x7e\xb1\xd6\x42\x2a\x31\x36\xd1\xd0\x3f\x7a\xe5\x94\xd6\x36\xa0\x6f\xb7\x40\x7d\x37\xc6\x55\x7c\x50\x40\x6d\x29\x89\xe3\x5a\xae\x97\xe7\x44\x49\x6e\xbd\x81\x3d\x3\x93\x6\x12\x6\xe2\x41\x12\x4a\xf1\x6a\xa4\x58\xa2\xfb\xd2\x15\xba\xc9\x79\xc9\xce\x5e\x13\xbb\xf1\x9\x4\xcc\xfd\xe8\x51\x34\x6a\xe8\x61\x88\xda\xed\x1\x47\x84\xf5\x73\x25\xf9\x1c\x42\x86\x7\xf3\x5b\x1a\x1\xb3\xeb\x24\x32\x8d\xf6\xed\x7c\x4b\xeb\x3c\x36\x42\x28\xdf\xdf\xb6\xbe\xd9\x8c\x52\xd3\x2b\x8\x90\x8c\xe7\x98\x31\xe2\x32\x8e\xfc\x11\x48\x0\xa8\x6a\x42\x4a\x2\xc6\x4b\x9\xf1\xe3\x49\xf3\x45\x1f\xe\xbc\x56\xe2\xe4\xdf\xfb\xeb\x61\xfa\x24\xc1\x63\x75\xbb\x47\x75\xaf\xe1\x53\x16\x96\x21\x85\x26\x11\xb3\x76\xe3\x23\xa1\x6b\x74\x37\xd0\xde\x6\x90\x71\x5d\x43\x88\x9b\x0\x54\xa6\x75\x2f\xa1\xc2\xb\x73\x20\x1d\xb6\x21\x79\x57\x3f\xfa\x9\xbe\x8a\x33\xc3\x52\xf0\x1d\x82\x31\xd1\x55\xb5\x6c\x99\x25\xcf\x5c\x32\xce\xe9\xd\xfa\x69\x2c\xd5\xd\xc5\x6d\x86\xd0\xc\x3b\x6\x50\x79\xe8\xc3\xae\x4\xe6\xcd\x51\xe4\x26\x9b\x4f\x7e\xa6\xf\xab\xd8\xe5\xde\xa9\x0\x95\xbe\xa3\x9d\x5d\xb2\x9\x70\x18\x1c\xf0\xac\x29\x23\x2\x29\x28\xd2\x74\x35\x57\x62\xf\x24\xea\x5e\x33\xc2\x92\xf3\x78\x4d\x30\x1e\xa1\x99\xa9\x82\xb0\x42\x31\x8d\xad\x8a\xbc\xfc\xd4\x57\x47\x3e\xb4\x50\xdd\x6e\x2c\x80\x4d\x22\xf1\xfb\x57\xc4\xdd\x17\xe1\x8a\x36\x4a\xb3\x37\xca\xc9\x4e\xab\xd5\x69\xc4\xf4\xbc\xb\x3b\x44\x4b\x29\x9c\xee\xd4\x35\x22\x21\xb0\x1f\x27\x64\xa8\x51\x1b\xf0\x9f\x19\x5c\xfb\x5a\x64\x74\x70\x45\x9\xf5\x64\xfe\x1a\x2d\xc9\x14\x4\x14\xcf\xd5\x7d\x60\xaf\x94\x39\x94\xe2\x7d\x79\x82\xd0\x65\x3b\x6b\x9c\x19\x84\xb4\x6d\xb3\xc\x99\xc0\x56\xa8\xbd\x73\xce\x5\x84\x3e\x30\xaa\xc4\x9b\x1b\x4\x2a\x9f\xd7\x43\x2b\x23\xdf\xbf\xaa\xd5\xc2\x43\x2d\x70\xab\xdc\x75\xad\xac\xf7\xc0\xbe\x67\xb2\x74\xed\x67\x10\x4a\x92\x60\xc1\x40\x50\x19\x8a\x8a\x8c\x9\xe\x72\xe1\x73\x5e\xe8\x41\x85\x63\x9f\x3f\xd7\x7d\xc4\xfb\x22\x5d\x92\x6c\xb3\x1e\xe2\x50\x2f\x82\xa8\x28\xc0\xb5\xd7\x5f\x68\xd\x2c\x2d\xaf\x7e\xfa\x2e\x8\xf\x1f\x70\x9f\xe9\x19\x72\x55\xf8\xfb\x51\xd2\x33\x5d\xa0\xd3\x2b\xa\x6c\xbc\x4e\xcf\x36\x4d\xdc\x3b\xe9\x3e\x81\x7c\x61\xdb\x20\x2d\x3a\xc3\xb3\xc\x1e\x0\xb9\x7c\xf5\xca\x10\x5f\x3a\x71\xb3\xe4\x20\xdb\xc\x2a\x98\x63\x45\x0\x58\xf6\x68\xe4\xb\xda\x13\x3b\x60\x5c\x76\xdb\xb9\x97\x71\xe4\xd9\xb7\xdb\xbd\x68\xc7\x84\x84\xaa\x7c\x68\x62\x5e\x16\xfc\xba\x72\xaa\x9a\xa9\xeb\x7c\x75\x47\x97\x7e\xad\xe2\xd9\x91\xe8\xe4\xa5\x31\xd7\x1\x8e\xa2\x11\x88\x95\xb9\xf2\x9b\xd3\x7f\x1b\x81\x22\xf7\x98\x60\xa\x64\xa6\xc1\xf6\x49\xc7\xe3\x7\x4d\x94\x7a\xcf\x6e\x68\xc\x1b\x3f\x6e\x2e\xee\x92\xfa\x52\xb3\x59\xf8\xf1\x8f\x6a\x66\xa3\x82\x76\x4a\x7\x1a\xc7\xdd\xf5\xda\x9c\x3c\x24\xbf\xfd\x42\xa1\x10\x64\x6a\xf\x89\xee\x36\xa5\xce\x99\x48\x6a\xf0\x9f\x9e\x69\xa4\x40\x20\xe9\x16\x15\xf7\xdb\x75\x2\xcb\xe9\x73\x8b\x3b\x49\x2f\xf0\xaf\x51\x6\x5c\xdf\x27\x27\x49\x6a\xd1\xcc\xc7\xb5\x63\xb5\xfc\xb8\x5c\x87\x7f\x84\xb4\xcc\x14\xa9\x53\xda\xa4\x56\xf8\xb6\x1b\xcc\x40\x27\x52\x6\x5a\x13\x81\xd7\x3a\xd4\x3b\xfb\x49\x65\x31\x33\xb2\xfa\xcd\xad\x58\x4e\x2b\xae\xd2\x20\xfb\x1a\x48\xb4\x3f\x9a\xd8\x7a\x35\x4a\xc8\xee\x88\x5e\x7\x66\x54\xb9\xec\x9f\xa3\xe3\xb9\x37\xaa\x49\x76\x31\xda\x74\x2d\x3c\xa4\x65\x10\x32\x38\xf0\xde\xd3\x99\x17\xaa\x71\xaa\x8f\xf\x8c\xaf\xa2\xf8\x5d\x64\xba\x1d\xa3\xef\x96\x73\xe8\xa1\x2\x8d\xc\x6d\xb8\x6\x90\xb8\x8\x56\x2c\xa7\x6\xc9\xc2\x38\xdb\x7c\x63\xb1\x57\x8e\xea\x7c\x79\xf3\x49\x1d\xfe\x9f\xf3\x6e\xb1\x1d\xba\x19\x80\x1a\xa\xd3\xb0\x26\x21\x40\xb1\x7c\xf9\x4d\x8d\x10\xc1\x7e\xf4\xf6\x3c\xa8\xfd\x7c\xa3\x92\xb2\xf\xaa\xcc\xa6\x11\xfe\x4\xe3\xd1\x7a\x32\x89\xdf\xd\xc4\x8f\x79\x6b\xca\x16\x7c\x6e\xf9\xad\xf\xf6\xfe\x27\xdb\xc4\x13\x70\xf1\x62\x1a\x4f\x79\x40\xc9\x9b\x8b\x21\xea\x84\xfa\xf5\xf1\x89\xce\xb7\x55\xa\x80\x39\x2f\x55\x36\x16\x9c\x7b\x8\xbd\x87\xd\xa5\x32\xf1\x52\x7c\xe8\x55\x60\x5b\xd7\x69\xe4\xfc\xfa\x12\x85\x96\xea\x50\x28\xab\x8a\xf7\xbb\xe\x53\x74\xca\xa6\x27\x9\xc2\xb5\xde\x18\x14\xd9\xea\xe5\x29\x1c\x40\x56\xcf\xd7\xae\x5\x3f\x65\xaf\x5\x73\xe2\x35\x96\x27\x7\x14\xc0\xad\x33\xf1\xdc\x44\x7a\x89\x17\x77\xd2\x9c\x58\x60\xf0\x3f\x7b\x2d\x2e\x57\x95\x54\x87\xed\xf2\xc7\x4c\xf0\xae\x56\x29\x19\x7d\x66\x4b\x9b\x83\x84\x42\x3b\x1\x25\x66\x8e\x2\xde\xb9\x83\x54\x19\xf6\x9f\x79\xd\x67\xc5\x1d\x7a\x44\x2\x98\xa7\x16\x1c\x29\xd\x74\xff\x85\x40\x6\xef\x2c\xa9\xc6\xf5\x53\x7\x6\xae\xe4\xfa\x5f\xd8\x39\x4d\xf1\x9b\x6b\xd9\x24\x84\xfe\x3\x4c\xb2\x3f\xdf\xa1\x5\x9e\x50\x14\x5a\xd9\x1a\xa2\xa7\xfa\xfa\x17\xf7\x78\xd6\xb5\x92\x61\x91\xac\x36\xfa\x56\xd\x38\x32\x18\x85\x8\x58\x37\xf0\x4b\xdb\x59\xe7\xa4\x34\xc0\x1b\x1\xaf\x2d\xde\xa1\xaa\x5d\xd3\xec\xe1\xd4\xf7\xe6\x54\x68\xf0\x51\x97\xa7\x89\xea\x24\xad\xd3\x6e\x47\x93\x8b\x4b\xb4\xf7\x1c\x42\x6\x67\xe8\x99\xf6\xf5\x7b\x85\xb5\x65\xb5\xb5\xd2\x37\xf5\xf3\x2\xa6\x4d\x11\xa7\xdc\x51\x9\x7f\xa0\xd8\x88\x1c\x13\x71\xae\x9c\xb7\x7b\x34\xd6\x4e\x68\x26\x83\x51\xaf\x1d\xee\x8b\xbb\x69\x43\x2b\x9e\x8a\xbc\x2\xe\xa0\x1b\xe0\xa8\x5f\x6f\xaf\x1b\x8f\xe7\x64\x71\x74\x11\x7e\xa8\xd8\xf9\x97\x6\xc3\xb6\xfb\xfb\xb7\x3d\x35\x9d\x3b\x52\xed\x54\xca\xf4\x81\x1\x2d\x1b\xc3\xa7\x0\x3d\x1a\x39\x54\xe1\xf6\xff\xed\x6f\xb\x5a\x68\xda\x58\xdd\xa9\xcf\x5c\x4a\xe5\x9\x4e\xde\x9d\xbc\x3e\xee\x5a\x0\x3b\x2c\x87\x10\x65\x60\xdd\xd7\x56\xd1\x4c\x64\x45\xe4\x21\xec\x78\xf8\x25\x7a\x3e\x16\x5d\x9\x53\x14\xbe\x4f\xae\x87\xd8\xd1\xaa\x3c\xf6\x3e\xa4\x70\x8c\x5e\x70\xa4\xb3\x6b\x66\x73\xd3\xbf\x31\x6\x19\x62\x93\x15\xf2\x86\xe4\x52\x7e\x53\x4c\x12\x38\xcc\x34\x7d\x57\xf6\x42\x93\x8a\xc4\xee\x5c\x8a\xe1\x52\x8f\x56\x64\xf6\xa6\xd1\x91\x57\x70\xcd\x11\x76\xf5\x59\x60\x60\x3c\xc1\xc3\xb\x7f\x58\x1a\x50\x91\xf1\x68\x8f\x6e\x74\x74\xa8\x51\xb\xf7\x7a\x98\x37\xf2\xa\xe\xa4\x97\x4\xb8\x9b\xfd\xa0\xea\xf7\xd\xe1\xdb\x3\xf0\x31\x29\xf8\xdd\x6b\x8b\x5d\xd8\x59\xa9\x29\xcf\x9a\x79\x89\x19\x63\x46\x9\x79\x6a\x11\xda\x63\x68\x48\x77\x23\xfb\x7d\x3a\x43\xcb\x2\x3b\x7a\x6d\x10\x2a\x9e\xac\xf1\xd4\x19\xf8\x23\x64\x1d\x2c\x5f\xf2\xb0\x5c\x23\x27\xf7\x27\x30\x16\x37\xb1\x90\xab\x38\xfb\x55\xcd\x78\x58\xd4\x7d\x43\xf6\x45\x5e\x55\x8d\xb1\x2\x65\x58\xb4\x13\x4b\x36\xf7\xcc\xfe\x3d\xb\x82\xe2\x12\x11\xbb\xe6\xb8\x3a\x48\x71\xc7\x50\x6\x16\x3a\xe6\x7c\x5\xc7\xc8\x4d\x2f\x8\x6a\x17\x9a\x95\x97\x50\x68\xdc\x28\x18\xc4\x61\x38\xb9\xe0\x3e\x78\xdb\x29\xe0\x9f\x52\xdd\xf8\x4f\x91\xc1\xd0\x33\xa1\x7a\x8e\x30\x13\x82\x7\x9f\xd3\x31\xf\x23\xbe\x32\x5a\x75\xcf\x96\xb2\xec\xb5\x32\xac\x21\xd1\x82\x33\xd3\x15\x74\xbd\x90\xf1\x2c\xe6\x5f\x8d\xe3\x2\xe8\xe9\xc4\xca\x96\xeb\xe\xbc\x91\xf4\xb9\xea\xd9\x1b\x75\xbd\xe1\xac\x2a\x5\x37\x52\x9b\x1b\x3f\x5a\xdc\x21\xc3\x98\xbb\xaf\xa3\xf2\x0\xbf\xd\x30\x89\x5\xcc\xa5\x76\xf5\x6\xf0\xc6\x54\x8a\x5d\xd4\x1e\xc1\xf2\xce\xb0\x62\xc8\xfc\x59\x42\x9a\x90\x60\x55\xfe\x88\xa5\x8b\xb8\x33\xc\x23\x24\xd\x15\x70\x37\x1e\x3d\xf6\xd2\xea\x92\x10\xb2\xc4\x51\xac\xf2\xac\xf3\x6b\x6c\xaa\xcf\x12\xc5\x6c\x90\x50\xb5\xc\xfc\x1a\x15\x52\xe9\x26\xc6\x52\xa4\xe7\x81\x69\xe1\xe7\x9e\x30\x1\xec\x84\x89\xb2\xd\x66\xdd\xce\x28\x5c\xec\x98\x46\x68\x21\x9f\x88\x3f\x1f\x42\x77\xce\xd0\x61\xd4\x20\xa7\xff\x53\xad\x37\xd0\x17\x35\xc9\xfc\xba\xa\x78\x3f\xf2\xcc\x86\x89\xe8\x4b\x3c\x48\x33\x9\x7f\xc6\xc0\xdd\xb8\xfd\x7a\x66\x66\x65\xeb\x47\xa7\x4\x28\xa3\x19\x8e\xa9\xb1\x13\x67\x62\x70\xcf\xd6" ++} }; ++static const struct chacha20poly1305_testvec chacha20poly1305_dec_vectors[] __initconst = { { ++ .key = "\x1c\x92\x40\xa5\xeb\x55\xd3\x8a\xf3\x33\x88\x86\x04\xf6\xb5\xf0\x47\x39\x17\xc1\x40\x2b\x80\x09\x9d\xca\x5c\xbc\x20\x70\x75\xc0", ++ .nonce = "\x01\x02\x03\x04\x05\x06\x07\x08", ++ .assoc = "\xf3\x33\x88\x86\x00\x00\x00\x00\x00\x00\x4e\x91", ++ .alen = 12, ++ .input = "\x64\xa0\x86\x15\x75\x86\x1a\xf4\x60\xf0\x62\xc7\x9b\xe6\x43\xbd\x5e\x80\x5c\xfd\x34\x5c\xf3\x89\xf1\x08\x67\x0a\xc7\x6c\x8c\xb2\x4c\x6c\xfc\x18\x75\x5d\x43\xee\xa0\x9e\xe9\x4e\x38\x2d\x26\xb0\xbd\xb7\xb7\x3c\x32\x1b\x01\x00\xd4\xf0\x3b\x7f\x35\x58\x94\xcf\x33\x2f\x83\x0e\x71\x0b\x97\xce\x98\xc8\xa8\x4a\xbd\x0b\x94\x81\x14\xad\x17\x6e\x00\x8d\x33\xbd\x60\xf9\x82\xb1\xff\x37\xc8\x55\x97\x97\xa0\x6e\xf4\xf0\xef\x61\xc1\x86\x32\x4e\x2b\x35\x06\x38\x36\x06\x90\x7b\x6a\x7c\x02\xb0\xf9\xf6\x15\x7b\x53\xc8\x67\xe4\xb9\x16\x6c\x76\x7b\x80\x4d\x46\xa5\x9b\x52\x16\xcd\xe7\xa4\xe9\x90\x40\xc5\xa4\x04\x33\x22\x5e\xe2\x82\xa1\xb0\xa0\x6c\x52\x3e\xaf\x45\x34\xd7\xf8\x3f\xa1\x15\x5b\x00\x47\x71\x8c\xbc\x54\x6a\x0d\x07\x2b\x04\xb3\x56\x4e\xea\x1b\x42\x22\x73\xf5\x48\x27\x1a\x0b\xb2\x31\x60\x53\xfa\x76\x99\x19\x55\xeb\xd6\x31\x59\x43\x4e\xce\xbb\x4e\x46\x6d\xae\x5a\x10\x73\xa6\x72\x76\x27\x09\x7a\x10\x49\xe6\x17\xd9\x1d\x36\x10\x94\xfa\x68\xf0\xff\x77\x98\x71\x30\x30\x5b\xea\xba\x2e\xda\x04\xdf\x99\x7b\x71\x4d\x6c\x6f\x2c\x29\xa6\xad\x5c\xb4\x02\x2b\x02\x70\x9b\xee\xad\x9d\x67\x89\x0c\xbb\x22\x39\x23\x36\xfe\xa1\x85\x1f\x38", ++ .ilen = 281, ++ .result = "\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x72\x65\x20\x64\x72\x61\x66\x74\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x76\x61\x6c\x69\x64\x20\x66\x6f\x72\x20\x61\x20\x6d\x61\x78\x69\x6d\x75\x6d\x20\x6f\x66\x20\x73\x69\x78\x20\x6d\x6f\x6e\x74\x68\x73\x20\x61\x6e\x64\x20\x6d\x61\x79\x20\x62\x65\x20\x75\x70\x64\x61\x74\x65\x64\x2c\x20\x72\x65\x70\x6c\x61\x63\x65\x64\x2c\x20\x6f\x72\x20\x6f\x62\x73\x6f\x6c\x65\x74\x65\x64\x20\x62\x79\x20\x6f\x74\x68\x65\x72\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x61\x74\x20\x61\x6e\x79\x20\x74\x69\x6d\x65\x2e\x20\x49\x74\x20\x69\x73\x20\x69\x6e\x61\x70\x70\x72\x6f\x70\x72\x69\x61\x74\x65\x20\x74\x6f\x20\x75\x73\x65\x20\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x73\x20\x72\x65\x66\x65\x72\x65\x6e\x63\x65\x20\x6d\x61\x74\x65\x72\x69\x61\x6c\x20\x6f\x72\x20\x74\x6f\x20\x63\x69\x74\x65\x20\x74\x68\x65\x6d\x20\x6f\x74\x68\x65\x72\x20\x74\x68\x61\x6e\x20\x61\x73\x20\x2f\xe2\x80\x9c\x77\x6f\x72\x6b\x20\x69\x6e\x20\x70\x72\x6f\x67\x72\x65\x73\x73\x2e\x2f\xe2\x80\x9d" ++}, { ++ .key = "\x4c\xf5\x96\x83\x38\xe6\xae\x7f\x2d\x29\x25\x76\xd5\x75\x27\x86\x91\x9a\x27\x7a\xfb\x46\xc5\xef\x94\x81\x79\x57\x14\x59\x40\x68", ++ .nonce = "\xca\xbf\x33\x71\x32\x45\x77\x8e", ++ .assoc = "", ++ .alen = 0, ++ .input = "\xea\xe0\x1e\x9e\x2c\x91\xaa\xe1\xdb\x5d\x99\x3f\x8a\xf7\x69\x92", ++ .ilen = 16, ++ .result = "" ++}, { ++ .key = "\x2d\xb0\x5d\x40\xc8\xed\x44\x88\x34\xd1\x13\xaf\x57\xa1\xeb\x3a\x2a\x80\x51\x36\xec\x5b\xbc\x8\x93\x84\x21\xb5\x13\x88\x3c\xd", ++ .nonce = "\x3d\x86\xb5\x6b\xc8\xa3\x1f\x1d", ++ .assoc = "\x33\x10\x41\x12\x1f\xf3\xd2\x6b", ++ .alen = 8, ++ .input = "\xdd\x6b\x3b\x82\xce\x5a\xbd\xd6\xa9\x35\x83\xd8\x8c\x3d\x85\x77", ++ .ilen = 16, ++ .result = "" ++}, { ++ .key = "\x4b\x28\x4b\xa3\x7b\xbe\xe9\xf8\x31\x80\x82\xd7\xd8\xe8\xb5\xa1\xe2\x18\x18\x8a\x9c\xfa\xa3\x3d\x25\x71\x3e\x40\xbc\x54\x7a\x3e", ++ .nonce = "\xd2\x32\x1f\x29\x28\xc6\xc4\xc4", ++ .assoc = "\x6a\xe2\xad\x3f\x88\x39\x5a\x40", ++ .alen = 8, ++ .input = "\xb7\x1b\xb0\x73\x59\xb0\x84\xb2\x6d\x8e\xab\x94\x31\xa1\xae\xac\x89", ++ .ilen = 17, ++ .result = "\xa4" ++}, { ++ .key = "\x66\xca\x9c\x23\x2a\x4b\x4b\x31\xe\x92\x89\x8b\xf4\x93\xc7\x87\x98\xa3\xd8\x39\xf8\xf4\xa7\x1\xc0\x2e\xa\xa6\x7e\x5a\x78\x87", ++ .nonce = "\x20\x1c\xaa\x5f\x9c\xbf\x92\x30", ++ .assoc = "", ++ .alen = 0, ++ .input = "\xbf\xe1\x5b\xb\xdb\x6b\xf5\x5e\x6c\x5d\x84\x44\x39\x81\xc1\x9c\xac", ++ .ilen = 17, ++ .result = "\x2d" ++}, { ++ .key = "\x68\x7b\x8d\x8e\xe3\xc4\xdd\xae\xdf\x72\x7f\x53\x72\x25\x1e\x78\x91\xcb\x69\x76\x1f\x49\x93\xf9\x6f\x21\xcc\x39\x9c\xad\xb1\x1", ++ .nonce = "\xdf\x51\x84\x82\x42\xc\x75\x9c", ++ .assoc = "\x70\xd3\x33\xf3\x8b\x18\xb", ++ .alen = 7, ++ .input = "\x8b\x6\xd3\x31\xb0\x93\x45\xb1\x75\x6e\x26\xf9\x67\xbc\x90\x15\x81\x2c\xb5\xf0\xc6\x2b\xc7\x8c\x56\xd1\xbf\x69\x6c\x7\xa0\xda\x65\x27\xc9\x90\x3d\xef\x4b\x11\xf\x19\x7\xfd\x29\x92\xd9\xc8\xf7\x99\x2e\x4a\xd0\xb8\x2c\xdc\x93\xf5\x9e\x33\x78\xd1\x37\xc3\x66\xd7\x5e\xbc\x44\xbf\x53\xa5\xbc\xc4\xcb\x7b\x3a\x8e\x7f\x2\xbd\xbb\xe7\xca\xa6\x6c\x6b\x93\x21\x93\x10\x61\xe7\x69\xd0\x78\xf3\x7\x5a\x1a\x8f\x73\xaa\xb1\x4e\xd3\xda\x4f\xf3\x32\xe1\x66\x3e\x6c\xc6\x13\xba\x6\x5b\xfc\x6a\xe5\x6f\x60\xfb\x7\x40\xb0\x8c\x9d\x84\x43\x6b\xc1\xf7\x8d\x8d\x31\xf7\x7a\x39\x4d\x8f\x9a\xeb", ++ .ilen = 145, ++ .result = "\x33\x2f\x94\xc1\xa4\xef\xcc\x2a\x5b\xa6\xe5\x8f\x1d\x40\xf0\x92\x3c\xd9\x24\x11\xa9\x71\xf9\x37\x14\x99\xfa\xbe\xe6\x80\xde\x50\xc9\x96\xd4\xb0\xec\x9e\x17\xec\xd2\x5e\x72\x99\xfc\xa\xe1\xcb\x48\xd2\x85\xdd\x2f\x90\xe0\x66\x3b\xe6\x20\x74\xbe\x23\x8f\xcb\xb4\xe4\xda\x48\x40\xa6\xd1\x1b\xc7\x42\xce\x2f\xc\xa6\x85\x6e\x87\x37\x3\xb1\x7c\x25\x96\xa3\x5\xd8\xb0\xf4\xed\xea\xc2\xf0\x31\x98\x6c\xd1\x14\x25\xc0\xcb\x1\x74\xd0\x82\xf4\x36\xf5\x41\xd5\xdc\xca\xc5\xbb\x98\xfe\xfc\x69\x21\x70\xd8\xa4\x4b\xc8\xde\x8f" ++}, { ++ .key = "\x8d\xb8\x91\x48\xf0\xe7\xa\xbd\xf9\x3f\xcd\xd9\xa0\x1e\x42\x4c\xe7\xde\x25\x3d\xa3\xd7\x5\x80\x8d\xf2\x82\xac\x44\x16\x51\x1", ++ .nonce = "\xde\x7b\xef\xc3\x65\x1b\x68\xb0", ++ .assoc = "", ++ .alen = 0, ++ .input = "\x85\x4\xc2\xed\x8d\xfd\x97\x5c\xd2\xb7\xe2\xc1\x6b\xa3\xba\xf8\xc9\x50\xc3\xc6\xa5\xe3\xa4\x7c\xc3\x23\x49\x5e\xa9\xb9\x32\xeb\x8a\x7c\xca\xe5\xec\xfb\x7c\xc0\xcb\x7d\xdc\x2c\x9d\x92\x55\x21\xa\xc8\x43\x63\x59\xa\x31\x70\x82\x67\x41\x3\xf8\xdf\xf2\xac\xa7\x2\xd4\xd5\x8a\x2d\xc8\x99\x19\x66\xd0\xf6\x88\x2c\x77\xd9\xd4\xd\x6c\xbd\x98\xde\xe7\x7f\xad\x7e\x8a\xfb\xe9\x4b\xe5\xf7\xe5\x50\xa0\x90\x3f\xd6\x22\x53\xe3\xfe\x1b\xcc\x79\x3b\xec\x12\x47\x52\xa7\xd6\x4\xe3\x52\xe6\x93\x90\x91\x32\x73\x79\xb8\xd0\x31\xde\x1f\x9f\x2f\x5\x38\x54\x2f\x35\x4\x39\xe0\xa7\xba\xc6\x52\xf6\x37\x65\x4c\x7\xa9\x7e\xb3\x21\x6f\x74\x8c\xc9\xde\xdb\x65\x1b\x9b\xaa\x60\xb1\x3\x30\x6b\xb2\x3\xc4\x1c\x4\xf8\xf\x64\xaf\x46\xe4\x65\x99\x49\xe2\xea\xce\x78\x0\xd8\x8b\xd5\x2e\xcf\xfc\x40\x49\xe8\x58\xdc\x34\x9c\x8c\x61\xbf\xa\x8e\xec\x39\xa9\x30\x5\x5a\xd2\x56\x1\xc7\xda\x8f\x4e\xbb\x43\xa3\x3a\xf9\x15\x2a\xd0\xa0\x7a\x87\x34\x82\xfe\x8a\xd1\x2d\x5e\xc7\xbf\x4\x53\x5f\x3b\x36\xd4\x25\x5c\x34\x7a\x8d\xd5\x5\xce\x72\xca\xef\x7a\x4b\xbc\xb0\x10\x5c\x96\x42\x3a\x0\x98\xcd\x15\xe8\xb7\x53", ++ .ilen = 272, ++ .result = "\x9b\x18\xdb\xdd\x9a\xf\x3e\xa5\x15\x17\xde\xdf\x8\x9d\x65\xa\x67\x30\x12\xe2\x34\x77\x4b\xc1\xd9\xc6\x1f\xab\xc6\x18\x50\x17\xa7\x9d\x3c\xa6\xc5\x35\x8c\x1c\xc0\xa1\x7c\x9f\x3\x89\xca\xe1\xe6\xe9\xd4\xd3\x88\xdb\xb4\x51\x9d\xec\xb4\xfc\x52\xee\x6d\xf1\x75\x42\xc6\xfd\xbd\x7a\x8e\x86\xfc\x44\xb3\x4f\xf3\xea\x67\x5a\x41\x13\xba\xb0\xdc\xe1\xd3\x2a\x7c\x22\xb3\xca\xac\x6a\x37\x98\x3e\x1d\x40\x97\xf7\x9b\x1d\x36\x6b\xb3\x28\xbd\x60\x82\x47\x34\xaa\x2f\x7d\xe9\xa8\x70\x81\x57\xd4\xb9\x77\xa\x9d\x29\xa7\x84\x52\x4f\xc2\x4a\x40\x3b\x3c\xd4\xc9\x2a\xdb\x4a\x53\xc4\xbe\x80\xe9\x51\x7f\x8f\xc7\xa2\xce\x82\x5c\x91\x1e\x74\xd9\xd0\xbd\xd5\xf3\xfd\xda\x4d\x25\xb4\xbb\x2d\xac\x2f\x3d\x71\x85\x7b\xcf\x3c\x7b\x3e\xe\x22\x78\xc\x29\xbf\xe4\xf4\x57\xb3\xcb\x49\xa0\xfc\x1e\x5\x4e\x16\xbc\xd5\xa8\xa3\xee\x5\x35\xc6\x7c\xab\x60\x14\x55\x1a\x8e\xc5\x88\x5d\xd5\x81\xc2\x81\xa5\xc4\x60\xdb\xaf\x77\x91\xe1\xce\xa2\x7e\x7f\x42\xe3\xb0\x13\x1c\x1f\x25\x60\x21\xe2\x40\x5f\x99\xb7\x73\xec\x9b\x2b\xf0\x65\x11\xc8\xd0\xa\x9f\xd3" ++}, { ++ .key = "\xf2\xaa\x4f\x99\xfd\x3e\xa8\x53\xc1\x44\xe9\x81\x18\xdc\xf5\xf0\x3e\x44\x15\x59\xe0\xc5\x44\x86\xc3\x91\xa8\x75\xc0\x12\x46\xba", ++ .nonce = "\xe\xd\x57\xbb\x7b\x40\x54\x2", ++ .assoc = "", ++ .alen = 0, ++ .input = "\x14\xf6\x41\x37\xa6\xd4\x27\xcd\xdb\x6\x3e\x9a\x4e\xab\xd5\xb1\x1e\x6b\xd2\xbc\x11\xf4\x28\x93\x63\x54\xef\xbb\x5e\x1d\x3a\x1d\x37\x3c\xa\x6c\x1e\xc2\xd1\x2c\xb5\xa3\xb5\x7b\xb8\x8f\x25\xa6\x1b\x61\x1c\xec\x28\x58\x26\xa4\xa8\x33\x28\x25\x5c\x45\x5\xe5\x6c\x99\xe5\x45\xc4\xa2\x3\x84\x3\x73\x1e\x8c\x49\xac\x20\xdd\x8d\xb3\xc4\xf5\xe7\x4f\xf1\xed\xa1\x98\xde\xa4\x96\xdd\x2f\xab\xab\x97\xcf\x3e\xd2\x9e\xb8\x13\x7\x28\x29\x19\xaf\xfd\xf2\x49\x43\xea\x49\x26\x91\xc1\x7\xd6\xbb\x81\x75\x35\xd\x24\x7f\xc8\xda\xd4\xb7\xeb\xe8\x5c\x9\xa2\x2f\xdc\x28\x7d\x3a\x3\xfa\x94\xb5\x1d\x17\x99\x36\xc3\x1c\x18\x34\xe3\x9f\xf5\x55\x7c\xb0\x60\x9d\xff\xac\xd4\x61\xf2\xad\xf8\xce\xc7\xbe\x5c\xd2\x95\xa8\x4b\x77\x13\x19\x59\x26\xc9\xb7\x8f\x6a\xcb\x2d\x37\x91\xea\x92\x9c\x94\x5b\xda\xb\xce\xfe\x30\x20\xf8\x51\xad\xf2\xbe\xe7\xc7\xff\xb3\x33\x91\x6a\xc9\x1a\x41\xc9\xf\xf3\x10\xe\xfd\x53\xff\x6c\x16\x52\xd9\xf3\xf7\x98\x2e\xc9\x7\x31\x2c\xc\x72\xd7\xc5\xc6\x8\x2a\x7b\xda\xbd\x7e\x2\xea\x1a\xbb\xf2\x4\x27\x61\x28\x8e\xf5\x4\x3\x1f\x4c\x7\x55\x82\xec\x1e\xd7\x8b\x2f\x65\x56\xd1\xd9\x1e\x3c\xe9\x1f\x5e\x98\x70\x38\x4a\x8c\x49\xc5\x43\xa0\xa1\x8b\x74\x9d\x4c\x62\xd\x10\xc\xf4\x6c\x8f\xe0\xaa\x9a\x8d\xb7\xe0\xbe\x4c\x87\xf1\x98\x2f\xcc\xed\xc0\x52\x29\xdc\x83\xf8\xfc\x2c\xe\xa8\x51\x4d\x80\xd\xa3\xfe\xd8\x37\xe7\x41\x24\xfc\xfb\x75\xe3\x71\x7b\x57\x45\xf5\x97\x73\x65\x63\x14\x74\xb8\x82\x9f\xf8\x60\x2f\x8a\xf2\x4e\xf1\x39\xda\x33\x91\xf8\x36\xe0\x8d\x3f\x1f\x3b\x56\xdc\xa0\x8f\x3c\x9d\x71\x52\xa7\xb8\xc0\xa5\xc6\xa2\x73\xda\xf4\x4b\x74\x5b\x0\x3d\x99\xd7\x96\xba\xe6\xe1\xa6\x96\x38\xad\xb3\xc0\xd2\xba\x91\x6b\xf9\x19\xdd\x3b\xbe\xbe\x9c\x20\x50\xba\xa1\xd0\xce\x11\xbd\x95\xd8\xd1\xdd\x33\x85\x74\xdc\xdb\x66\x76\x44\xdc\x3\x74\x48\x35\x98\xb1\x18\x47\x94\x7d\xff\x62\xe4\x58\x78\xab\xed\x95\x36\xd9\x84\x91\x82\x64\x41\xbb\x58\xe6\x1c\x20\x6d\x15\x6b\x13\x96\xe8\x35\x7f\xdc\x40\x2c\xe9\xbc\x8a\x4f\x92\xec\x6\x2d\x50\xdf\x93\x5d\x65\x5a\xa8\xfc\x20\x50\x14\xa9\x8a\x7e\x1d\x8\x1f\xe2\x99\xd0\xbe\xfb\x3a\x21\x9d\xad\x86\x54\xfd\xd\x98\x1c\x5a\x6f\x1f\x9a\x40\xcd\xa2\xff\x6a\xf1\x54", ++ .ilen = 528, ++ .result = "\xc3\x9\x94\x62\xe6\x46\x2e\x10\xbe\x0\xe4\xfc\xf3\x40\xa3\xe2\xf\xc2\x8b\x28\xdc\xba\xb4\x3c\xe4\x21\x58\x61\xcd\x8b\xcd\xfb\xac\x94\xa1\x45\xf5\x1c\xe1\x12\xe0\x3b\x67\x21\x54\x5e\x8c\xaa\xcf\xdb\xb4\x51\xd4\x13\xda\xe6\x83\x89\xb6\x92\xe9\x21\x76\xa4\x93\x7d\xe\xfd\x96\x36\x3\x91\x43\x5c\x92\x49\x62\x61\x7b\xeb\x43\x89\xb8\x12\x20\x43\xd4\x47\x6\x84\xee\x47\xe9\x8a\x73\x15\xf\x72\xcf\xed\xce\x96\xb2\x7f\x21\x45\x76\xeb\x26\x28\x83\x6a\xad\xaa\xa6\x81\xd8\x55\xb1\xa3\x85\xb3\xc\xdf\xf1\x69\x2d\x97\x5\x2a\xbc\x7c\x7b\x25\xf8\x80\x9d\x39\x25\xf3\x62\xf0\x66\x5e\xf4\xa0\xcf\xd8\xfd\x4f\xb1\x1f\x60\x3a\x8\x47\xaf\xe1\xf6\x10\x77\x9\xa7\x27\x8f\x9a\x97\x5a\x26\xfa\xfe\x41\x32\x83\x10\xe0\x1d\xbf\x64\xd\xf4\x1c\x32\x35\xe5\x1b\x36\xef\xd4\x4a\x93\x4d\x0\x7c\xec\x2\x7\x8b\x5d\x7d\x1b\xe\xd1\xa6\xa5\x5d\x7d\x57\x88\xa8\xcc\x81\xb4\x86\x4e\xb4\x40\xe9\x1d\xc3\xb1\x24\x3e\x7f\xcc\x8a\x24\x9b\xdf\x6d\xf0\x39\x69\x3e\x4c\xc0\x96\xe4\x13\xda\x90\xda\xf4\x95\x66\x8b\x17\x17\xfe\x39\x43\x25\xaa\xda\xa0\x43\x3c\xb1\x41\x2\xa3\xf0\xa7\x19\x59\xbc\x1d\x7d\x6c\x6d\x91\x9\x5c\xb7\x5b\x1\xd1\x6f\x17\x21\x97\xbf\x89\x71\xa5\xb0\x6e\x7\x45\xfd\x9d\xea\x7\xf6\x7a\x9f\x10\x18\x22\x30\x73\xac\xd4\x6b\x72\x44\xed\xd9\x19\x9b\x2d\x4a\x41\xdd\xd1\x85\x5e\x37\x19\xed\xd2\x15\x8f\x5e\x91\xdb\x33\xf2\xe4\xdb\xff\x98\xfb\xa3\xb5\xca\x21\x69\x8\xe7\x8a\xdf\x90\xff\x3e\xe9\x20\x86\x3c\xe9\xfc\xb\xfe\x5c\x61\xaa\x13\x92\x7f\x7b\xec\xe0\x6d\xa8\x23\x22\xf6\x6b\x77\xc4\xfe\x40\x7\x3b\xb6\xf6\x8e\x5f\xd4\xb9\xb7\xf\x21\x4\xef\x83\x63\x91\x69\x40\xa3\x48\x5c\xd2\x60\xf9\x4f\x6c\x47\x8b\x3b\xb1\x9f\x8e\xee\x16\x8a\x13\xfc\x46\x17\xc3\xc3\x32\x56\xf8\x3c\x85\x3a\xb6\x3e\xaa\x89\x4f\xb3\xdf\x38\xfd\xf1\xe4\x3a\xc0\xe6\x58\xb5\x8f\xc5\x29\xa2\x92\x4a\xb6\xa0\x34\x7f\xab\xb5\x8a\x90\xa1\xdb\x4d\xca\xb6\x2c\x41\x3c\xf7\x2b\x21\xc3\xfd\xf4\x17\x5c\xb5\x33\x17\x68\x2b\x8\x30\xf3\xf7\x30\x3c\x96\xe6\x6a\x20\x97\xe7\x4d\x10\x5f\x47\x5f\x49\x96\x9\xf0\x27\x91\xc8\xf8\x5a\x2e\x79\xb5\xe2\xb8\xe8\xb9\x7b\xd5\x10\xcb\xff\x5d\x14\x73\xf3" ++}, { ++ .key = "\xea\xbc\x56\x99\xe3\x50\xff\xc5\xcc\x1a\xd7\xc1\x57\x72\xea\x86\x5b\x89\x88\x61\x3d\x2f\x9b\xb2\xe7\x9c\xec\x74\x6e\x3e\xf4\x3b", ++ .nonce = "\xef\x2d\x63\xee\x6b\x80\x8b\x78", ++ .assoc = "\x5a\x27\xff\xeb\xdf\x84\xb2\x9e\xef", ++ .alen = 9, ++ .input = "\xfd\x81\x8d\xd0\x3d\xb4\xd5\xdf\xd3\x42\x47\x5a\x6d\x19\x27\x66\x4b\x2e\xc\x27\x9c\x96\x4c\x72\x2\xa3\x65\xc3\xb3\x6f\x2e\xbd\x63\x8a\x4a\x5d\x29\xa2\xd0\x28\x48\xc5\x3d\x98\xa3\xbc\xe0\xbe\x3b\x3f\xe6\x8a\xa4\x7f\x53\x6\xfa\x7f\x27\x76\x72\x31\xa1\xf5\xd6\xc\x52\x47\xba\xcd\x4f\xd7\xeb\x5\x48\xd\x7c\x35\x4a\x9\xc9\x76\x71\x2\xa3\xfb\xb7\x1a\x65\xb7\xed\x98\xc6\x30\x8a\x0\xae\xa1\x31\xe5\xb5\x9e\x6d\x62\xda\xda\x7\xf\x38\x38\xd3\xcb\xc1\xb0\xad\xec\x72\xec\xb1\xa2\x7b\x59\xf3\x3d\x2b\xef\xcd\x28\x5b\x83\xcc\x18\x91\x88\xb0\x2e\xf9\x29\x31\x18\xf9\x4e\xe9\xa\x91\x92\x9f\xae\x2d\xad\xf4\xe6\x1a\xe2\xa4\xee\x47\x15\xbf\x83\x6e\xd7\x72\x12\x3b\x2d\x24\xe9\xb2\x55\xcb\x3c\x10\xf0\x24\x8a\x4a\x2\xea\x90\x25\xf0\xb4\x79\x3a\xef\x6e\xf5\x52\xdf\xb0\xa\xcd\x24\x1c\xd3\x2e\x22\x74\xea\x21\x6f\xe9\xbd\xc8\x3e\x36\x5b\x19\xf1\xca\x99\xa\xb4\xa7\x52\x1a\x4e\xf2\xad\x8d\x56\x85\xbb\x64\x89\xba\x26\xf9\xc7\xe1\x89\x19\x22\x77\xc3\xa8\xfc\xff\xad\xfe\xb9\x48\xae\x12\x30\x9f\x19\xfb\x1b\xef\x14\x87\x8a\x78\x71\xf3\xf4\xb7\x0\x9c\x1d\xb5\x3d\x49\x0\xc\x6\xd4\x50\xf9\x54\x45\xb2\x5b\x43\xdb\x6d\xcf\x1a\xe9\x7a\x7a\xcf\xfc\x8a\x4e\x4d\xb\x7\x63\x28\xd8\xe7\x8\x95\xdf\xa6\x72\x93\x2e\xbb\xa0\x42\x89\x16\xf1\xd9\xc\xf9\xa1\x16\xfd\xd9\x3\xb4\x3b\x8a\xf5\xf6\xe7\x6b\x2e\x8e\x4c\x3d\xe2\xaf\x8\x45\x3\xff\x9\xb6\xeb\x2d\xc6\x1b\x88\x94\xac\x3e\xf1\x9f\xe\xe\x2b\xd5\x0\x4d\x3f\x3b\x53\xae\xaf\x1c\x33\x5f\x55\x6e\x8d\xaf\x5\x7a\x10\x34\xc9\xf4\x66\xcb\x62\x12\xa6\xee\xe8\x1c\x5d\x12\x86\xdb\x6f\x1c\x33\xc4\x1c\xda\x82\x2d\x3b\x59\xfe\xb1\xa4\x59\x41\x86\xd0\xef\xae\xfb\xda\x6d\x11\xb8\xca\xe9\x6e\xff\xf7\xa9\xd9\x70\x30\xfc\x53\xe2\xd7\xa2\x4e\xc7\x91\xd9\x7\x6\xaa\xdd\xb0\x59\x28\x1d\x0\x66\xc5\x54\xc2\xfc\x6\xda\x5\x90\x52\x1d\x37\x66\xee\xf0\xb2\x55\x8a\x5d\xd2\x38\x86\x94\x9b\xfc\x10\x4c\xa1\xb9\x64\x3e\x44\xb8\x5f\xb0\xc\xec\xe0\xc9\xe5\x62\x75\x3f\x9\xd5\xf5\xd9\x26\xba\x9e\xd2\xf4\xb9\x48\xa\xbc\xa2\xd6\x7c\x36\x11\x7d\x26\x81\x89\xcf\xa4\xad\x73\xe\xee\xcc\x6\xa9\xdb\xb1\xfd\xfb\x9\x7f\x90\x42\x37\x2f\xe1\x9c\xf\x6f\xcf\x43\xb5\xd9\x90\xe1\x85\xf5\xa8\xae", ++ .ilen = 529, ++ .result = "\xe6\xc3\xdb\x63\x55\x15\xe3\x5b\xb7\x4b\x27\x8b\x5a\xdd\xc2\xe8\x3a\x6b\xd7\x81\x96\x35\x97\xca\xd7\x68\xe8\xef\xce\xab\xda\x9\x6e\xd6\x8e\xcb\x55\xb5\xe1\xe5\x57\xfd\xc4\xe3\xe0\x18\x4f\x85\xf5\x3f\x7e\x4b\x88\xc9\x52\x44\xf\xea\xaf\x1f\x71\x48\x9f\x97\x6d\xb9\x6f\x0\xa6\xde\x2b\x77\x8b\x15\xad\x10\xa0\x2b\x7b\x41\x90\x3\x2d\x69\xae\xcc\x77\x7c\xa5\x9d\x29\x22\xc2\xea\xb4\x0\x1a\xd2\x7a\x98\x8a\xf9\xf7\x82\xb0\xab\xd8\xa6\x94\x8d\x58\x2f\x1\x9e\x0\x20\xfc\x49\xdc\xe\x3\xe8\x45\x10\xd6\xa8\xda\x55\x10\x9a\xdf\x67\x22\x8b\x43\xab\x0\xbb\x2\xc8\xdd\x7b\x97\x17\xd7\x1d\x9e\x2\x5e\x48\xde\x8e\xcf\x99\x7\x95\x92\x3c\x5f\x9f\xc5\x8a\xc0\x23\xaa\xd5\x8c\x82\x6e\x16\x92\xb1\x12\x17\x7\xc3\xfb\x36\xf5\x6c\x35\xd6\x6\x1f\x9f\xa7\x94\xa2\x38\x63\x9c\xb0\x71\xb3\xa5\xd2\xd8\xba\x9f\x8\x1\xb3\xff\x4\x97\x73\x45\x1b\xd5\xa9\x9c\x80\xaf\x4\x9a\x85\xdb\x32\x5b\x5d\x1a\xc1\x36\x28\x10\x79\xf1\x3c\xbf\x1a\x41\x5c\x4e\xdf\xb2\x7c\x79\x3b\x7a\x62\x3d\x4b\xc9\x9b\x2a\x2e\x7c\xa2\xb1\x11\x98\xa7\x34\x1a\x0\xf3\xd1\xbc\x18\x22\xba\x2\x56\x62\x31\x10\x11\x6d\xe0\x54\x9d\x40\x1f\x26\x80\x41\xca\x3f\x68\xf\x32\x1d\xa\x8e\x79\xd8\xa4\x1b\x29\x1c\x90\x8e\xc5\xe3\xb4\x91\x37\x9a\x97\x86\x99\xd5\x9\xc5\xbb\xa3\x3f\x21\x29\x82\x14\x5c\xab\x25\xfb\xf2\x4f\x58\x26\xd4\x83\xaa\x66\x89\x67\x7e\xc0\x49\xe1\x11\x10\x7f\x7a\xda\x29\x4\xff\xf0\xcb\x9\x7c\x9d\xfa\x3\x6f\x81\x9\x31\x60\xfb\x8\xfa\x74\xd3\x64\x44\x7c\x55\x85\xec\x9c\x6e\x25\xb7\x6c\xc5\x37\xb6\x83\x87\x72\x95\x8b\x9d\xe1\x69\x5c\x31\x95\x42\xa6\x2c\xd1\x36\x47\x1f\xec\x54\xab\xa2\x1c\xd8\x0\xcc\xbc\xd\x65\xe2\x67\xbf\xbc\xea\xee\x9e\xe4\x36\x95\xbe\x73\xd9\xa6\xd9\xf\xa0\xcc\x82\x76\x26\xad\x5b\x58\x6c\x4e\xab\x29\x64\xd3\xd9\xa9\x8\x8c\x1d\xa1\x4f\x80\xd8\x3f\x94\xfb\xd3\x7b\xfc\xd1\x2b\xc3\x21\xeb\xe5\x1c\x84\x23\x7f\x4b\xfa\xdb\x34\x18\xa2\xc2\xe5\x13\xfe\x6c\x49\x81\xd2\x73\xe7\xe2\xd7\xe4\x4f\x4b\x8\x6e\xb1\x12\x22\x10\x9d\xac\x51\x1e\x17\xd9\x8a\xb\x42\x88\x16\x81\x37\x7c\x6a\xf7\xef\x2d\xe3\xd9\xf8\x5f\xe0\x53\x27\x74\xb9\xe2\xd6\x1c\x80\x2c\x52\x65" ++}, { ++ .key = "\x47\x11\xeb\x86\x2b\x2c\xab\x44\x34\xda\x7f\x57\x3\x39\xc\xaf\x2c\x14\xfd\x65\x23\xe9\x8e\x74\xd5\x8\x68\x8\xe7\xb4\x72\xd7", ++ .nonce = "\xdb\x92\xf\x7f\x17\x54\xc\x30", ++ .assoc = "\xd2\xa1\x70\xdb\x7a\xf8\xfa\x27\xba\x73\xf\xbf\x3d\x1e\x82\xb2", ++ .alen = 16, ++ .input = "\xe5\x26\xa4\x3d\xbd\x33\xd0\x4b\x6f\x5\xa7\x6e\x12\x7a\xd2\x74\xa6\xdd\xbd\x95\xeb\xf9\xa4\xf1\x59\x93\x91\x70\xd9\xfe\x9a\xcd\x53\x1f\x3a\xab\xa6\x7c\x9f\xa6\x9e\xbd\x99\xd9\xb5\x97\x44\xd5\x14\x48\x4d\x9d\xc0\xd0\x5\x96\xeb\x4c\x78\x55\x9\x8\x1\x2\x30\x90\x7b\x96\x7a\x7b\x5f\x30\x41\x24\xce\x68\x61\x49\x86\x57\x82\xdd\x53\x1c\x51\x28\x2b\x53\x6e\x2d\xc2\x20\x4c\xdd\x8f\x65\x10\x20\x50\xdd\x9d\x50\xe5\x71\x40\x53\x69\xfc\x77\x48\x11\xb9\xde\xa4\x8d\x58\xe4\xa6\x1a\x18\x47\x81\x7e\xfc\xdd\xf6\xef\xce\x2f\x43\x68\xd6\x6\xe2\x74\x6a\xad\x90\xf5\x37\xf3\x3d\x82\x69\x40\xe9\x6b\xa7\x3d\xa8\x1e\xd2\x2\x7c\xb7\x9b\xe4\xda\x8f\x95\x6\xc5\xdf\x73\xa3\x20\x9a\x49\xde\x9c\xbc\xee\x14\x3f\x81\x5e\xf8\x3b\x59\x3c\xe1\x68\x12\x5a\x3a\x76\x3a\x3f\xf7\x87\x33\xa\x1\xb8\xd4\xed\xb6\xbe\x94\x5e\x70\x40\x56\x67\x1f\x50\x44\x19\xce\x82\x70\x10\x87\x13\x20\xb\x4c\x5a\xb6\xf6\xa7\xae\x81\x75\x1\x81\xe6\x4b\x57\x7c\xdd\x6d\xf8\x1c\x29\x32\xf7\xda\x3c\x2d\xf8\x9b\x25\x6e\x0\xb4\xf7\x2f\xf7\x4\xf7\xa1\x56\xac\x4f\x1a\x64\xb8\x47\x55\x18\x7b\x7\x4d\xbd\x47\x24\x80\x5d\xa2\x70\xc5\xdd\x8e\x82\xd4\xeb\xec\xb2\xc\x39\xd2\x97\xc1\xcb\xeb\xf4\x77\x59\xb4\x87\xef\xcb\x43\x2d\x46\x54\xd1\xa7\xd7\x15\x99\xa\x43\xa1\xe0\x99\x33\x71\xc1\xed\xfe\x72\x46\x33\x8e\x91\x8\x9f\xc8\x2e\xca\xfa\xdc\x59\xd5\xc3\x76\x84\x9f\xa3\x37\x68\xc3\xf0\x47\x2c\x68\xdb\x5e\xc3\x49\x4c\xe8\x92\x85\xe2\x23\xd3\x3f\xad\x32\xe5\x2b\x82\xd7\x8f\x99\xa\x59\x5c\x45\xd9\xb4\x51\x52\xc2\xae\xbf\x80\xcf\xc9\xc9\x51\x24\x2a\x3b\x3a\x4d\xae\xeb\xbd\x22\xc3\xe\xf\x59\x25\x92\x17\xe9\x74\xc7\x8b\x70\x70\x36\x55\x95\x75\x4b\xad\x61\x2b\x9\xbc\x82\xf2\x6e\x94\x43\xae\xc3\xd5\xcd\x8e\xfe\x5b\x9a\x88\x43\x1\x75\xb2\x23\x9\xf7\x89\x83\xe7\xfa\xf9\xb4\x9b\xf8\xef\xbd\x1c\x92\xc1\xda\x7e\xfe\x5\xba\x5a\xcd\x7\x6a\x78\x9e\x5d\xfb\x11\x2f\x79\x38\xb6\xc2\x5b\x6b\x51\xb4\x71\xdd\xf7\x2a\xe4\xf4\x72\x76\xad\xc2\xdd\x64\x5d\x79\xb6\xf5\x7a\x77\x20\x5\x3d\x30\x6\xd4\x4c\xa\x2c\x98\x5a\xb9\xd4\x98\xa9\x3f\xc6\x12\xea\x3b\x4b\xc5\x79\x64\x63\x6b\x9\x54\x3b\x14\x27\xba\x99\x80\xc8\x72\xa8\x12\x90\x29\xba\x40\x54\x97\x2b\x7b\xfe\xeb\xcd\x1\x5\x44\x72\xdb\x99\xe4\x61\xc9\x69\xd6\xb9\x28\xd1\x5\x3e\xf9\xb\x49\xa\x49\xe9\x8d\xe\xa7\x4a\xf\xaf\x32\xd0\xe0\xb2\x3a\x55\x58\xfe\x5c\x28\x70\x51\x23\xb0\x7b\x6a\x5f\x1e\xb8\x17\xd7\x94\x15\x8f\xee\x20\xc7\x42\x25\x3e\x9a\x14\xd7\x60\x72\x39\x47\x48\xa9\xfe\xdd\x47\xa\xb1\xe6\x60\x28\x8c\x11\x68\xe1\xff\xd7\xce\xc8\xbe\xb3\xfe\x27\x30\x9\x70\xd7\xfa\x2\x33\x3a\x61\x2e\xc7\xff\xa4\x2a\xa8\x6e\xb4\x79\x35\x6d\x4c\x1e\x38\xf8\xee\xd4\x84\x4e\x6e\x28\xa7\xce\xc8\xc1\xcf\x80\x5\xf3\x4\xef\xc8\x18\x28\x2e\x8d\x5e\xc\xdf\xb8\x5f\x96\xe8\xc6\x9c\x2f\xe5\xa6\x44\xd7\xe7\x99\x44\xc\xec\xd7\x5\x60\x97\xbb\x74\x77\x58\xd5\xbb\x48\xde\x5a\xb2\x54\x7f\xe\x46\x70\x6a\x6f\x78\xa5\x8\x89\x5\x4e\x7e\xa0\x69\xb4\x40\x60\x55\x77\x75\x9b\x19\xf2\xd5\x13\x80\x77\xf9\x4b\x3f\x1e\xee\xe6\x76\x84\x7b\x8c\xe5\x27\xa8\xa\x91\x1\x68\x71\x8a\x3f\x6\xab\xf6\xa9\xa5\xe6\x72\x92\xe4\x67\xe2\xa2\x46\x35\x84\x55\x7d\xca\xa8\x85\xd0\xf1\x3f\xbe\xd7\x34\x64\xfc\xae\xe3\xe4\x4\x9f\x66\x2\xb9\x88\x10\xd9\xc4\x4c\x31\x43\x7a\x93\xe2\x9b\x56\x43\x84\xdc\xdc\xde\x1d\xa4\x2\xe\xc2\xef\xc3\xf8\x78\xd1\xb2\x6b\x63\x18\xc9\xa9\xe5\x72\xd8\xf3\xb9\xd1\x8a\xc7\x1a\x2\x27\x20\x77\x10\xe5\xc8\xd4\x4a\x47\xe5\xdf\x5f\x1\xaa\xb0\xd4\x10\xbb\x69\xe3\x36\xc8\xe1\x3d\x43\xfb\x86\xcd\xcc\xbf\xf4\x88\xe0\x20\xca\xb7\x1b\xf1\x2f\x5c\xee\xd4\xd3\xa3\xcc\xa4\x1e\x1c\x47\xfb\xbf\xfc\xa2\x41\x55\x9d\xf6\x5a\x5e\x65\x32\x34\x7b\x52\x8d\xd5\xd0\x20\x60\x3\xab\x3f\x8c\xd4\x21\xea\x2a\xd9\xc4\xd0\xd3\x65\xd8\x7a\x13\x28\x62\x32\x4b\x2c\x87\x93\xa8\xb4\x52\x45\x9\x44\xec\xec\xc3\x17\xdb\x9a\x4d\x5c\xa9\x11\xd4\x7d\xaf\x9e\xf1\x2d\xb2\x66\xc5\x1d\xed\xb7\xcd\xb\x25\x5e\x30\x47\x3f\x40\xf4\xa1\xa0\x0\x94\x10\xc5\x6a\x63\x1a\xd5\x88\x92\x8e\x82\x39\x87\x3c\x78\x65\x58\x42\x75\x5b\xdd\x77\x3e\x9\x4e\x76\x5b\xe6\xe\x4d\x38\xb2\xc0\xb8\x95\x1\x7a\x10\xe0\xfb\x7\xf2\xab\x2d\x8c\x32\xed\x2b\xc0\x46\xc2\xf5\x38\x83\xf0\x17\xec\xc1\x20\x6a\x9a\xb\x0\xa0\x98\x22\x50\x23\xd5\x80\x6b\xf6\x1f\xc3\xcc\x97\xc9\x24\x9f\xf3\xaf\x43\x14\xd5\xa0", ++ .ilen = 1040, ++ .result = "\x42\x93\xe4\xeb\x97\xb0\x57\xbf\x1a\x8b\x1f\xe4\x5f\x36\x20\x3c\xef\xa\xa9\x48\x5f\x5f\x37\x22\x3a\xde\xe3\xae\xbe\xad\x7\xcc\xb1\xf6\xf5\xf9\x56\xdd\xe7\x16\x1e\x7f\xdf\x7a\x9e\x75\xb7\xc7\xbe\xbe\x8a\x36\x4\xc0\x10\xf4\x95\x20\x3\xec\xdc\x5\xa1\x7d\xc4\xa9\x2c\x82\xd0\xbc\x8b\xc5\xc7\x45\x50\xf6\xa2\x1a\xb5\x46\x3b\x73\x2\xa6\x83\x4b\x73\x82\x58\x5e\x3b\x65\x2f\xe\xfd\x2b\x59\x16\xce\xa1\x60\x9c\xe8\x3a\x99\xed\x8d\x5a\xcf\xf6\x83\xaf\xba\xd7\x73\x73\x40\x97\x3d\xca\xef\x7\x57\xe6\xd9\x70\xe\x95\xae\xa6\x8d\x4\xcc\xee\xf7\x9\x31\x77\x12\xa3\x23\x97\x62\xb3\x7b\x32\xfb\x80\x14\x48\x81\xc3\xe5\xea\x91\x39\x52\x81\xa2\x4f\xe4\xb3\x9\xff\xde\x5e\xe9\x58\x84\x6e\xf9\x3d\xdf\x25\xea\xad\xae\xe6\x9a\xd1\x89\x55\xd3\xde\x6c\x52\xdb\x70\xfe\x37\xce\x44\xa\xa8\x25\x5f\x92\xc1\x33\x4a\x4f\x9b\x62\x35\xff\xce\xc0\xa9\x60\xce\x52\x0\x97\x51\x35\x26\x2e\xb9\x36\xa9\x87\x6e\x1e\xcc\x91\x78\x53\x98\x86\x5b\x9c\x74\x7d\x88\x33\xe1\xdf\x37\x69\x2b\xbb\xf1\x4d\xf4\xd1\xf1\x39\x93\x17\x51\x19\xe3\x19\x1e\x76\x37\x25\xfb\x9\x27\x6a\xab\x67\x6f\x14\x12\x64\xe7\xc4\x7\xdf\x4d\x17\xbb\x6d\xe0\xe9\xb9\xab\xca\x10\x68\xaf\x7e\xb7\x33\x54\x73\x7\x6e\xf7\x81\x97\x9c\x5\x6f\x84\x5f\xd2\x42\xfb\x38\xcf\xd1\x2f\x14\x30\x88\x98\x4d\x5a\xa9\x76\xd5\x4f\x3e\x70\x6c\x85\x76\xd7\x1\xa0\x1a\xc8\x4e\xaa\xac\x78\xfe\x46\xde\x6a\x5\x46\xa7\x43\xc\xb9\xde\xb9\x68\xfb\xce\x42\x99\x7\x4d\xb\x3b\x5a\x30\x35\xa8\xf9\x3a\x73\xef\xf\xdb\x1e\x16\x42\xc4\xba\xae\x58\xaa\xf8\xe5\x75\x2f\x1b\x15\x5c\xfd\xa\x97\xd0\xe4\x37\x83\x61\x5f\x43\xa6\xc7\x3f\x38\x59\xe6\xeb\xa3\x90\xc3\xaa\xaa\x5a\xd3\x34\xd4\x17\xc8\x65\x3e\x57\xbc\x5e\xdd\x9e\xb7\xf0\x2e\x5b\xb2\x1f\x8a\x8\xd\x45\x91\xb\x29\x53\x4f\x4c\x5a\x73\x56\xfe\xaf\x41\x1\x39\xa\x24\x3c\x7e\xbe\x4e\x53\xf3\xeb\x6\x66\x51\x28\x1d\xbd\x41\xa\x1\xab\x16\x47\x27\x47\x47\xf7\xcb\x46\xa\x70\x9e\x1\x9c\x9\xe1\x2a\x0\x1a\xd8\xd4\x79\x9d\x80\x15\x8e\x53\x2a\x65\x83\x78\x3e\x3\x0\x7\x12\x1f\x33\x3e\x7b\x13\x37\xf1\xc3\xef\xb7\xc1\x20\x3c\x3e\x67\x66\x5d\x88\xa7\x7d\x33\x50\x77\xb0\x28\x8e\xe7\x2c\x2e\x7a\xf4\x3c\x8d\x74\x83\xaf\x8e\x87\xf\xe4\x50\xff\x84\x5c\x47\xc\x6a\x49\xbf\x42\x86\x77\x15\x48\xa5\x90\x5d\x93\xd6\x2a\x11\xd5\xd5\x11\xaa\xce\xe7\x6f\xa5\xb0\x9\x2c\x8d\xd3\x92\xf0\x5a\x2a\xda\x5b\x1e\xd5\x9a\xc4\xc4\xf3\x49\x74\x41\xca\xe8\xc1\xf8\x44\xd6\x3c\xae\x6c\x1d\x9a\x30\x4\x4d\x27\xe\xb1\x5f\x59\xa2\x24\xe8\xe1\x98\xc5\x6a\x4c\xfe\x41\xd2\x27\x42\x52\xe1\xe9\x7d\x62\xe4\x88\xf\xad\xb2\x70\xcb\x9d\x4c\x27\x2e\x76\x1e\x1a\x63\x65\xf5\x3b\xf8\x57\x69\xeb\x5b\x38\x26\x39\x33\x25\x45\x3e\x91\xb8\xd8\xc7\xd5\x42\xc0\x22\x31\x74\xf4\xbc\xc\x23\xf1\xca\xc1\x8d\xd7\xbe\xc9\x62\xe4\x8\x1a\xcf\x36\xd5\xfe\x55\x21\x59\x91\x87\x87\xdf\x6\xdb\xdf\x96\x45\x58\xda\x5\xcd\x50\x4d\xd2\x7d\x5\x18\x73\x6a\x8d\x11\x85\xa6\x88\xe8\xda\xe6\x30\x33\xa4\x89\x31\x75\xbe\x69\x43\x84\x43\x50\x87\xdd\x71\x36\x83\xc3\x78\x74\x24\xa\xed\x7b\xdb\xa4\x24\xb\xb9\x7e\x5d\xff\xde\xb1\xef\x61\x5a\x45\x33\xf6\x17\x7\x8\x98\x83\x92\xf\x23\x6d\xe6\xaa\x17\x54\xad\x6a\xc8\xdb\x26\xbe\xb8\xb6\x8\xfa\x68\xf1\xd7\x79\x6f\x18\xb4\x9e\x2d\x3f\x1b\x64\xaf\x8d\x6\xe\x49\x28\xe0\x5d\x45\x68\x13\x87\xfa\xde\x40\x7b\xd2\xc3\x94\xd5\xe1\xd9\xc2\xaf\x55\x89\xeb\xb4\x12\x59\xa8\xd4\xc5\x29\x66\x38\xe6\xac\x22\x22\xd9\x64\x9b\x34\xa\x32\x9f\xc2\xbf\x17\x6c\x3f\x71\x7a\x38\x6b\x98\xfb\x49\x36\x89\xc9\xe2\xd6\xc7\x5d\xd0\x69\x5f\x23\x35\xc9\x30\xe2\xfd\x44\x58\x39\xd7\x97\xfb\x5c\x0\xd5\x4f\x7a\x1a\x95\x8b\x62\x4b\xce\xe5\x91\x21\x7b\x30\x0\xd6\xdd\x6d\x2\x86\x49\xf\x3c\x1a\x27\x3c\xd3\xe\x71\xf2\xff\xf5\x2f\x87\xac\x67\x59\x81\xa3\xf7\xf8\xd6\x11\xc\x84\xa9\x3\xee\x2a\xc4\xf3\x22\xab\x7c\xe2\x25\xf5\x67\xa3\xe4\x11\xe0\x59\xb3\xca\x87\xa0\xae\xc9\xa6\x62\x1b\x6e\x4d\x2\x6b\x7\x9d\xfd\xd0\x92\x6\xe1\xb2\x9a\x4a\x1f\x1f\x13\x49\x99\x97\x8\xde\x7f\x98\xaf\x51\x98\xee\x2c\xcb\xf0\xb\xc6\xb6\xb7\x2d\x9a\xb1\xac\xa6\xe3\x15\x77\x9d\x6b\x1a\xe4\xfc\x8b\xf2\x17\x59\x8\x4\x58\x81\x9d\x1b\x1b\x69\x55\xc2\xb4\x3c\x1f\x50\xf1\x7f\x77\x90\x4c\x66\x40\x5a\xc0\x33\x1f\xcb\x5\x6d\x5c\x6\x87\x52\xa2\x8f\x26\xd5\x4f" ++}, { ++ .key = "\x35\x4e\xb5\x70\x50\x42\x8a\x85\xf2\xfb\xed\x7b\xd0\x9e\x97\xca\xfa\x98\x66\x63\xee\x37\xcc\x52\xfe\xd1\xdf\x95\x15\x34\x29\x38", ++ .nonce = "\xfd\x87\xd4\xd8\x62\xfd\xec\xaa", ++ .assoc = "\xd6\x31\xda\x5d\x42\x5e\xd7", ++ .alen = 7, ++ .input = "\x6a\xfc\x4b\x25\xdf\xc0\xe4\xe8\x17\x4d\x4c\xc9\x7e\xde\x3a\xcc\x3c\xba\x6a\x77\x47\xdb\xe3\x74\x7a\x4d\x5f\x8d\x37\x55\x80\x73\x90\x66\x5d\x3a\x7d\x5d\x86\x5e\x8d\xfd\x83\xff\x4e\x74\x6f\xf9\xe6\x70\x17\x70\x3e\x96\xa7\x7e\xcb\xab\x8f\x58\x24\x9b\x1\xfd\xcb\xe6\x4d\x9b\xf0\x88\x94\x57\x66\xef\x72\x4c\x42\x6e\x16\x19\x15\xea\x70\x5b\xac\x13\xdb\x9f\x18\xe2\x3c\x26\x97\xbc\xdc\x45\x8c\x6c\x24\x69\x9c\xf7\x65\x1e\x18\x59\x31\x7c\xe4\x73\xbc\x39\x62\xc6\x5c\x9f\xbf\xfa\x90\x3\xc9\x72\x26\xb6\x1b\xc2\xb7\x3f\xf2\x13\x77\xf2\x8d\xb9\x47\xd0\x53\xdd\xc8\x91\x83\x8b\xb1\xce\xa3\xfe\xcd\xd9\xdd\x92\x7b\xdb\xb8\xfb\xc9\x2d\x1\x59\x39\x52\xad\x1b\xec\xcf\xd7\x70\x13\x21\xf5\x47\xaa\x18\x21\x5c\xc9\x9a\xd2\x6b\x5\x9c\x1\xa1\xda\x35\x5d\xb3\x70\xe6\xa9\x80\x8b\x91\xb7\xb3\x5f\x24\x9a\xb7\xd1\x6b\xa1\x1c\x50\xba\x49\xe0\xee\x2e\x75\xac\x69\xc0\xeb\x3\xdd\x19\xe5\xf6\x6\xdd\xc3\xd7\x2b\x7\x7\x30\xa7\x19\xc\xbf\xe6\x18\xcc\xb1\x1\x11\x85\x77\x1d\x96\xa7\xa3\x0\x84\x2\xa2\x83\x68\xda\x17\x27\xc8\x7f\x23\xb7\xf4\x13\x85\xcf\xdd\x7a\x7d\x24\x57\xfe\x5\x93\xf5\x74\xce\xed\xc\x20\x98\x8d\x92\x30\xa1\x29\x23\x1a\xa0\x4f\x69\x56\x4c\xe1\xc8\xce\xf6\x9a\xc\xa4\xfa\x4\xf6\x62\x95\xf2\xfa\xc7\x40\x68\x40\x8f\x41\xda\xb4\x26\x6f\x70\xab\x40\x61\xa4\xe\x75\xfb\x86\xeb\x9d\x9a\x1f\xec\x76\x99\xe7\xea\xaa\x1e\x2d\xb5\xd4\xa6\x1a\xb8\x61\xa\x1d\x16\x5b\x98\xc2\x31\x40\xe7\x23\x1d\x66\x99\xc8\xc0\xd7\xce\xf3\x57\x40\x4\x3f\xfc\xea\xb3\xfc\xd2\xd3\x99\xa4\x94\x69\xa0\xef\xd1\x85\xb3\xa6\xb1\x28\xbf\x94\x67\x22\xc3\x36\x46\xf8\xd2\xf\x5f\xf4\x59\x80\xe6\x2d\x43\x8\x7d\x19\x9\x97\xa7\x4c\x3d\x8d\xba\x65\x62\xa3\x71\x33\x29\x62\xdb\xc1\x33\x34\x1a\x63\x33\x16\xb6\x64\x7e\xab\x33\xf0\xe6\x26\x68\xba\x1d\x2e\x38\x8\xe6\x2\xd3\x25\x2c\x47\x23\x58\x34\xf\x9d\x63\x4f\x63\xbb\x7f\x3b\x34\x38\xa7\xb5\x8d\x65\xd9\x9f\x79\x55\x3e\x4d\xe7\x73\xd8\xf6\x98\x97\x84\x60\x9c\xc8\xa9\x3c\xf6\xdc\x12\x5c\xe1\xbb\xb\x8b\x98\x9c\x9d\x26\x7c\x4a\xe6\x46\x36\x58\x21\x4a\xee\xca\xd7\x3b\xc2\x6c\x49\x2f\xe5\xd5\x3\x59\x84\x53\xcb\xfe\x92\x71\x2e\x7c\x21\xcc\x99\x85\x7f\xb8\x74\x90\x13\x42\x3f\xe0\x6b\x1d\xf2\x4d\x54\xd4\xfc\x3a\x5\xe6\x74\xaf\xa6\xa0\x2a\x20\x23\x5d\x34\x5c\xd9\x3e\x4e\xfa\x93\xe7\xaa\xe9\x6f\x8\x43\x67\x41\xc5\xad\xfb\x31\x95\x82\x73\x32\xd8\xa6\xa3\xed\xe\x2d\xf6\x5f\xfd\x80\xa6\x7a\xe0\xdf\x78\x15\x29\x74\x33\xd0\x9e\x83\x86\x72\x22\x57\x29\xb9\x9e\x5d\xd3\x1a\xb5\x96\x72\x41\x3d\xf1\x64\x43\x67\xee\xaa\x5c\xd3\x9a\x96\x13\x11\x5d\xf3\xc\x87\x82\x1e\x41\x9e\xd0\x27\xd7\x54\x3b\x67\x73\x9\x91\xe9\xd5\x36\xa7\xb5\x55\xe4\xf3\x21\x51\x49\x22\x7\x55\x4f\x44\x4b\xd2\x15\x93\x17\x2a\xfa\x4d\x4a\x57\xdb\x4c\xa6\xeb\xec\x53\x25\x6c\x21\xed\x0\x4c\x3b\xca\x14\x57\xa9\xd6\x6a\xcd\x8d\x5e\x74\xac\x72\xc1\x97\xe5\x1b\x45\x4e\xda\xfc\xcc\x40\xe8\x48\x88\xb\xa3\xe3\x8d\x83\x42\xc3\x23\xfd\x68\xb5\x8e\xf1\x9d\x63\x77\xe9\xa3\x8e\x8c\x26\x6b\xbd\x72\x73\x35\xc\x3\xf8\x43\x78\x52\x71\x15\x1f\x71\x5d\x6e\xed\xb9\xcc\x86\x30\xdb\x2b\xd3\x82\x88\x23\x71\x90\x53\x5c\xa9\x2f\x76\x1\xb7\x9a\xfe\x43\x55\xa3\x4\x9b\xe\xe4\x59\xdf\xc9\xe9\xb1\xea\x29\x28\x3c\x5c\xae\x72\x84\xb6\xc6\xeb\xc\x27\x7\x74\x90\xd\x31\xb0\x0\x77\xe9\x40\x70\x6f\x68\xa7\xfd\x6\xec\x4b\xc0\xb7\xac\xbc\x33\xb7\x6d\xa\xbd\x12\x1b\x59\xcb\xdd\x32\xf5\x1d\x94\x57\x76\x9e\xc\x18\x98\x71\xd7\x2a\xdb\xb\x7b\xa7\x71\xb7\x67\x81\x23\x96\xae\xb9\x7e\x32\x43\x92\x8a\x19\xa0\xc4\xd4\x3b\x57\xf9\x4a\x2c\xfb\x51\x46\xbb\xcb\x5d\xb3\xef\x13\x93\x6e\x68\x42\x54\x57\xd3\x6a\x3a\x8f\x9d\x66\xbf\xbd\x36\x23\xf5\x93\x83\x7b\x9c\xc0\xdd\xc5\x49\xc0\x64\xed\x7\x12\xb3\xe6\xe4\xe5\x38\x95\x23\xb1\xa0\x3b\x1a\x61\xda\x17\xac\xc3\x58\xdd\x74\x64\x22\x11\xe8\x32\x1d\x16\x93\x85\x99\xa5\x9c\x34\x55\xb1\xe9\x20\x72\xc9\x28\x7b\x79\x0\xa1\xa6\xa3\x27\x40\x18\x8a\x54\xe0\xcc\xe8\x4e\x8e\x43\x96\xe7\x3f\xc8\xe9\xb2\xf9\xc9\xda\x4\x71\x50\x47\xe4\xaa\xce\xa2\x30\xc8\xe4\xac\xc7\xd\x6\x2e\xe6\xe8\x80\x36\x29\x9e\x1\xb8\xc3\xf0\xa0\x5d\x7a\xca\x4d\xa0\x57\xbd\x2a\x45\xa7\x7f\x9c\x93\x7\x8f\x35\x67\x92\xe3\xe9\x7f\xa8\x61\x43\x9e\x25\x4f\x33\x76\x13\x6e\x12\xb9\xdd\xa4\x7c\x8\x9f\x7c\xe7\xa\x8d\x84\x6\xa4\x33\x17\x34\x5e\x10\x7c\xc0\xa8\x3d\x1f\x42\x20\x51\x65\x5d\x9\xc3\xaa\xc0\xc8\xd\xf0\x79\xbc\x20\x1b\x95\xe7\x6\x7d\x47\x20\x3\x1a\x74\xdd\xe2\xd4\xae\x38\x71\x9b\xf5\x80\xec\x8\x4e\x56\xba\x76\x12\x1a\xdf\x48\xf3\xae\xb3\xe6\xe6\xbe\xc0\x91\x2e\x1\xb3\x1\x86\xa2\xb9\x52\xd1\x21\xae\xd4\x97\x1d\xef\x41\x12\x95\x3d\x48\x45\x1c\x56\x32\x8f\xb8\x43\xbb\x19\xf3\xca\xe9\xeb\x6d\x84\xbe\x86\x6\xe2\x36\xb2\x62\x9d\xd3\x4c\x48\x18\x54\x13\x4e\xcf\xfd\xba\x84\xb9\x30\x53\xcf\xfb\xb9\x29\x8f\xdc\x9f\xef\x60\xb\x64\xf6\x8b\xee\xa6\x91\xc2\x41\x6c\xf6\xfa\x79\x67\x4b\xc1\x3f\xaf\x9\x81\xd4\x5d\xcb\x9\xdf\x36\x31\xc0\x14\x3c\x7c\xe\x65\x95\x99\x6d\xa3\xf4\xd7\x38\xee\x1a\x2b\x37\xe2\xa4\x3b\x4b\xd0\x65\xca\xf8\xc3\xe8\x15\x20\xef\xf2\x0\xfd\x1\x9\xc5\xc8\x17\x4\x93\xd0\x93\x3\x55\xc5\xfe\x32\xa3\x3e\x28\x2d\x3b\x93\x8a\xcc\x7\x72\x80\x8b\x74\x16\x24\xbb\xda\x94\x39\x30\x8f\xb1\xcd\x4a\x90\x92\x7c\x14\x8f\x95\x4e\xac\x9b\xd8\x8f\x1a\x87\xa4\x32\x27\x8a\xba\xf7\x41\xcf\x84\x37\x19\xe6\x6\xf5\xe\xcf\x36\xf5\x9e\x6c\xde\xbc\xff\x64\x7e\x4e\x59\x57\x48\xfe\x14\xf7\x9c\x93\x5d\x15\xad\xcc\x11\xb1\x17\x18\xb2\x7e\xcc\xab\xe9\xce\x7d\x77\x5b\x51\x1b\x1e\x20\xa8\x32\x6\xe\x75\x93\xac\xdb\x35\x37\x1f\xe9\x19\x1d\xb4\x71\x97\xd6\x4e\x2c\x8\xa5\x13\xf9\xe\x7e\x78\x6e\x14\xe0\xa9\xb9\x96\x4c\x80\x82\xba\x17\xb3\x9d\x69\xb0\x84\x46\xff\xf9\x52\x79\x94\x58\x3a\x62\x90\x15\x35\x71\x10\x37\xed\xa1\x8e\x53\x6e\xf4\x26\x57\x93\x15\x93\xf6\x81\x2c\x5a\x10\xda\x92\xad\x2f\xdb\x28\x31\x2d\x55\x4\xd2\x6\x28\x8c\x1e\xdc\xea\x54\xac\xff\xb7\x6c\x30\x15\xd4\xb4\xd\x0\x93\x57\xdd\xd2\x7\x7\x6\xd9\x43\x9b\xcd\x3a\xf4\x7d\x4c\x36\x5d\x23\xa2\xcc\x57\x40\x91\xe9\x2c\x2f\x2c\xd5\x30\x9b\x17\xb0\xc9\xf7\xa7\x2f\xd1\x93\x20\x6b\xc6\xc1\xe4\x6f\xcb\xd1\xe7\x9\xf\x9e\xdc\xaa\x9f\x2f\xdf\x56\x9f\xd4\x33\x4\xaf\xd3\x6c\x58\x61\xf0\x30\xec\xf2\x7f\xf2\x9c\xdf\x39\xbb\x6f\xa2\x8c\x7e\xc4\x22\x51\x71\xc0\x4d\x14\x1a\xc4\xcd\x4\xd9\x87\x8\x50\x5\xcc\xaf\xf6\xf0\x8f\x92\x54\x58\xc2\xc7\x9\x7a\x59\x2\x5\xe8\xb0\x86\xd9\xbf\x7b\x35\x51\x4d\xaf\x8\x97\x2c\x65\xda\x2a\x71\x3a\xa8\x51\xcc\xf2\x73\x27\xc3\xfd\x62\xcf\xe3\xb2\xca\xcb\xbe\x1a\xa\xa1\x34\x7b\x77\xc4\x62\x68\x78\x5f\x94\x7\x4\x65\x16\x4b\x61\xcb\xff\x75\x26\x50\x66\x1f\x6e\x93\xf8\xc5\x51\xeb\xa4\x4a\x48\x68\x6b\xe2\x5e\x44\xb2\x50\x2c\x6c\xae\x79\x4e\x66\x35\x81\x50\xac\xbc\x3f\xb1\xc\xf3\x5\x3c\x4a\xa3\x6c\x2a\x79\xb4\xb7\xab\xca\xc7\x9b\x8e\xcd\x5f\x11\x3\xcb\x30\xa3\xab\xda\xfe\x64\xb9\xbb\xd8\x5e\x3a\x1a\x56\xe5\x5\x48\x90\x1e\x61\x69\x1b\x22\xe6\x1a\x3c\x75\xad\x1f\x37\x28\xdc\xe4\x6d\xbd\x42\xdc\xd3\xc8\xb6\x1c\x48\xfe\x94\x77\x7f\xbd\x62\xac\xa3\x47\x27\xcf\x5f\xd9\xdb\xaf\xec\xf7\x5e\xc1\xb0\x9d\x1\x26\x99\x7e\x8f\x3\x70\xb5\x42\xbe\x67\x28\x1b\x7c\xbd\x61\x21\x97\xcc\x5c\xe1\x97\x8f\x8d\xde\x2b\xaa\xa7\x71\x1d\x1e\x2\x73\x70\x58\x32\x5b\x1d\x67\x3d\xe0\x74\x4f\x3\xf2\x70\x51\x79\xf1\x61\x70\x15\x74\x9d\x23\x89\xde\xac\xfd\xde\xd0\x1f\xc3\x87\x44\x35\x4b\xe5\xb0\x60\xc5\x22\xe4\x9e\xca\xeb\xd5\x3a\x9\x45\xa4\xdb\xfa\x3f\xeb\x1b\xc7\xc8\x14\x99\x51\x92\x10\xed\xed\x28\xe0\xa1\xf8\x26\xcf\xcd\xcb\x63\xa1\x3b\xe3\xdf\x7e\xfe\xa6\xf0\x81\x9a\xbf\x55\xde\x54\xd5\x56\x60\x98\x10\x68\xf4\x38\x96\x8e\x6f\x1d\x44\x7f\xd6\x2f\xfe\x55\xfb\xc\x7e\x67\xe2\x61\x44\xed\xf2\x35\x30\x5d\xe9\xc7\xd6\x6d\xe0\xa0\xed\xf3\xfc\xd8\x3e\xa\x7b\xcd\xaf\x65\x68\x18\xc0\xec\x4\x1c\x74\x6d\xe2\x6e\x79\xd4\x11\x2b\x62\xd5\x27\xad\x4f\x1\x59\x73\xcc\x6a\x53\xfb\x2d\xd5\x4e\x99\x21\x65\x4d\xf5\x82\xf7\xd8\x42\xce\x6f\x3d\x36\x47\xf1\x5\x16\xe8\x1b\x6a\x8f\x93\xf2\x8f\x37\x40\x12\x28\xa3\xe6\xb9\x17\x4a\x1f\xb1\xd1\x66\x69\x86\xc4\xfc\x97\xae\x3f\x8f\x1e\x2b\xdf\xcd\xf9\x3c", ++ .ilen = 1949, ++ .result = "\x7a\x57\xf2\xc7\x6\x3f\x50\x7b\x36\x1a\x66\x5c\xb9\xe\x5e\x3b\x45\x60\xbe\x9a\x31\x9f\xff\x5d\x66\x34\xb4\xdc\xfb\x9d\x8e\xee\x6a\x33\xa4\x7\x3c\xf9\x4c\x30\xa1\x24\x52\xf9\x50\x46\x88\x20\x2\x32\x3a\xe\x99\x63\xaf\x1f\x15\x28\x2a\x5\xff\x57\x59\x5e\x18\xa1\x1f\xd0\x92\x5c\x88\x66\x1b\x0\x64\xa5\x93\x8d\x6\x46\xb0\x64\x8b\x8b\xef\x99\x5\x35\x85\xb3\xf3\x33\xbb\xec\x66\xb6\x3d\x57\x42\xe3\xb4\xc6\xaa\xb0\x41\x2a\xb9\x59\xa9\xf6\x3e\x15\x26\x12\x3\x21\x4c\x74\x43\x13\x2a\x3\x27\x9\xb4\xfb\xe7\xb7\x40\xff\x5e\xce\x48\x9a\x60\xe3\x8b\x80\x8c\x38\x2d\xcb\x93\x37\x74\x5\x52\x6f\x73\x3e\xc3\xbc\xca\x72\xa\xeb\xf1\x3b\xa0\x95\xdc\x8a\xc4\xa9\xdc\xca\x44\xd8\x8\x63\x6a\x36\xd3\x3c\xb8\xac\x46\x7d\xfd\xaa\xeb\x3e\xf\x45\x8f\x49\xda\x2b\xf2\x12\xbd\xaf\x67\x8a\x63\x48\x4b\x55\x5f\x6d\x8c\xb9\x76\x34\x84\xae\xc2\xfc\x52\x64\x82\xf7\xb0\x6\xf0\x45\x73\x12\x50\x30\x72\xea\x78\x9a\xa8\xaf\xb5\xe3\xbb\x77\x52\xec\x59\x84\xbf\x6b\x8f\xce\x86\x5e\x1f\x23\xe9\xfb\x8\x86\xf7\x10\xb9\xf2\x44\x96\x44\x63\xa9\xa8\x78\x0\x23\xd6\xc7\xe7\x6e\x66\x4f\xcc\xee\x15\xb3\xbd\x1d\xa0\xe5\x9c\x1b\x24\x2c\x4d\x3c\x62\x35\x9c\x88\x59\x9\xdd\x82\x1b\xcf\xa\x83\x6b\x3f\xae\x3\xc4\xb4\xdd\x7e\x5b\x28\x76\x25\x96\xd9\xc9\x9d\x5f\x86\xfa\xf6\xd7\xd2\xe6\x76\x1d\xf\xa1\xdc\x74\x5\x1b\x1d\xe0\xcd\x16\xb0\xa8\x8a\x34\x7b\x15\x11\x77\xe5\x7b\x7e\x20\xf7\xda\x38\xda\xce\x70\xe9\xf5\x6c\xd9\xbe\xc\x4c\x95\x4c\xc2\x9b\x34\x55\x55\xe1\xf3\x46\x8e\x48\x74\x14\x4f\x9d\xc9\xf5\xe8\x1a\xf0\x11\x4a\xc1\x8d\xe0\x93\xa0\xbe\x9\x1c\x2b\x4e\xf\xb2\x87\x8b\x84\xfe\x92\x32\x14\xd7\x93\xdf\xe7\x44\xbc\xc5\xae\x53\x69\xd8\xb3\x79\x37\x80\xe3\x17\x5c\xec\x53\x0\x9a\xe3\x8e\xdc\x38\xb8\x66\xf0\xd3\xad\x1d\x2\x96\x86\x3e\x9d\x3b\x5d\xa5\x7f\x21\x10\xf1\x1f\x13\x20\xf9\x57\x87\x20\xf5\x5f\xf1\x17\x48\xa\x51\x5a\xcd\x19\x3\xa6\x5a\xd1\x12\x97\xe9\x48\xe2\x1d\x83\x75\x50\xd9\x75\x7d\x6a\x82\xa1\xf9\x4e\x54\x87\x89\xc9\xc\xb7\x5b\x6a\x91\xc1\x9c\xb2\xa9\xdc\x9a\xa4\x49\xa\x6d\xd\xbb\xde\x86\x44\xdd\x5d\x89\x2b\x96\xf\x23\x95\xad\xcc\xa2\xb3\xb9\x7e\x74\x38\xba\x9f\x73\xae\x5f\xf8\x68\xa2\xe0\xa9\xce\xbd\x40\xd4\x4c\x6b\xd2\x56\x62\xb0\xcc\x63\x7e\x5b\xd3\xae\xd1\x75\xce\xbb\xb4\x5b\xa8\xf8\xb4\xac\x71\x75\xaa\xc9\x9f\xbb\x6c\xad\xf\x55\x5d\xe8\x85\x7d\xf9\x21\x35\xea\x92\x85\x2b\x0\xec\x84\x90\xa\x63\x96\xe4\x6b\xa9\x77\xb8\x91\xf8\x46\x15\x72\x63\x70\x1\x40\xa3\xa5\x76\x62\x2b\xbf\xf1\xe5\x8d\x9f\xa3\xfa\x9b\x3\xbe\xfe\x65\x6f\xa2\x29\xd\x54\xb4\x71\xce\xa9\xd6\x3d\x88\xf9\xaf\x6b\xa8\x9e\xf4\x16\x96\x36\xb9\x0\xdc\x10\xab\xb5\x8\x31\x1f\x0\xb1\x3c\xd9\x38\x3e\xc6\x4\xa7\x4e\xe8\xae\xed\x98\xc2\xf7\xb9\x0\x5f\x8c\x60\xd1\xe5\x15\xf7\xae\x1e\x84\x88\xd1\xf6\xbc\x3a\x89\x35\x22\x83\x7c\xca\xf0\x33\x82\x4c\x79\x3c\xfd\xb1\xae\x52\x62\x55\xd2\x41\x60\xc6\xbb\xfa\xe\x59\xd6\xa8\xfe\x5d\xed\x47\x3d\xe0\xea\x1f\x6e\x43\x51\xec\x10\x52\x56\x77\x42\x6b\x52\x87\xd8\xec\xe0\xaa\x76\xa5\x84\x2a\x22\x24\xfd\x92\x40\x88\xd5\x85\x1c\x1f\x6b\x47\xa0\xc4\xe4\xef\xf4\xea\xd7\x59\xac\x2a\x9e\x8c\xfa\x1f\x42\x8\xfe\x4f\x74\xa0\x26\xf5\xb3\x84\xf6\x58\x5f\x26\x66\x3e\xd7\xe4\x22\x91\x13\xc8\xac\x25\x96\x23\xd8\x9\xea\x45\x75\x23\xb8\x5f\xc2\x90\x8b\x9\xc4\xfc\x47\x6c\x6d\xa\xef\x69\xa4\x38\x19\xcf\x7d\xf9\x9\x73\x9b\x60\x5a\xf7\x37\xb5\xfe\x9f\xe3\x2b\x4c\xd\x6e\x19\xf1\xd6\xc0\x70\xf3\x9d\x22\x3c\xf9\x49\xce\x30\x8e\x44\xb5\x76\x15\x8f\x52\xfd\xa5\x4\xb8\x55\x6a\x36\x59\x7c\xc4\x48\xb8\xd7\xab\x5\x66\xe9\x5e\x21\x6f\x6b\x36\x29\xbb\xe9\xe3\xa2\x9a\xa8\xcd\x55\x25\x11\xba\x5a\x58\xa0\xde\xae\x19\x2a\x48\x5a\xff\x36\xcd\x6d\x16\x7a\x73\x38\x46\xe5\x47\x59\xc8\xa2\xf6\xe2\x6c\x83\xc5\x36\x2c\x83\x7d\xb4\x1\x5\x69\xe7\xaf\x5c\xc4\x64\x82\x12\x21\xef\xf7\xd1\x7d\xb8\x8d\x8c\x98\x7c\x5f\x7d\x92\x88\xb9\x94\x7\x9c\xd8\xe9\x9c\x17\x38\xe3\x57\x6c\xe0\xdc\xa5\x92\x42\xb3\xbd\x50\xa2\x7e\xb5\xb1\x52\x72\x3\x97\xd8\xaa\x9a\x1e\x75\x41\x11\xa3\x4f\xcc\xd4\xe3\x73\xad\x96\xdc\x47\x41\x9f\xb0\xbe\x79\x91\xf5\xb6\x18\xfe\xc2\x83\x18\x7d\x73\xd9\x4f\x83\x84\x3\xb3\xf0\x77\x66\x3d\x83\x63\x2e\x2c\xf9\xdd\xa6\x1f\x89\x82\xb8\x23\x42\xeb\xe2\xca\x70\x82\x61\x41\xa\x6d\x5f\x75\xc5\xe2\xc4\x91\x18\x44\x22\xfa\x34\x10\xf5\x20\xdc\xb7\xdd\x2a\x20\x77\xf5\xf9\xce\xdb\xa0\xa\x52\x2a\x4e\xdd\xcc\x97\xdf\x5\xe4\x5e\xb7\xaa\xf0\xe2\x80\xff\xba\x1a\xf\xac\xdf\x2\x32\xe6\xf7\xc7\x17\x13\xb7\xfc\x98\x48\x8c\xd\x82\xc9\x80\x7a\xe2\xa\xc5\xb4\xde\x7c\x3c\x79\x81\xe\x28\x65\x79\x67\x82\x69\x44\x66\x9\xf7\x16\x1a\xf9\x7d\x80\xa1\x79\x14\xa9\xc8\x20\xfb\xa2\x46\xbe\x8\x35\x17\x58\xc1\x1a\xda\x2a\x6b\x2e\x1e\xe6\x27\x55\x7b\x19\xe2\xfb\x64\xfc\x5e\x15\x54\x3c\xe7\xc2\x11\x50\x30\xb8\x72\x3\xb\x1a\x9f\x86\x27\x11\x5c\x6\x2b\xbd\x75\x1a\xa\xda\x1\xfa\x5c\x4a\xc1\x80\x3a\x6e\x30\xc8\x2c\xeb\x56\xec\x89\xfa\x35\x7b\xb2\xf0\x97\x8\x86\x53\xbe\xbd\x40\x41\x38\x1c\xb4\x8b\x79\x2e\x18\x96\x94\xde\xe8\xca\xe5\x9f\x92\x9f\x15\x5d\x56\x60\x5c\x9\xf9\x16\xf4\x17\xf\xf6\x4c\xda\xe6\x67\x89\x9f\xca\x6c\xe7\x9b\x4\x62\xe\x26\xa6\x52\xbd\x29\xff\xc7\xa4\x96\xe6\x6a\x2\xa5\x2e\x7b\xfe\x97\x68\x3e\x2e\x5f\x3b\xf\x36\xd6\x98\x19\x59\x48\xd2\xc6\xe1\x55\x1a\x6e\xd6\xed\x2c\xba\xc3\x9e\x64\xc9\x95\x86\x35\x5e\x3e\x88\x69\x99\x4b\xee\xbe\x9a\x99\xb5\x6e\x58\xae\xdd\x22\xdb\xdd\x6b\xfc\xaf\x90\xa3\x3d\xa4\xc1\x15\x92\x18\x8d\xd2\x4b\x7b\x6\xd1\x37\xb5\xe2\x7c\x2c\xf0\x25\xe4\x94\x2a\xbd\xe3\x82\x70\x78\xa3\x82\x10\x5a\x90\xd7\xa4\xfa\xaf\x1a\x88\x59\xdc\x74\x12\xb4\x8e\xd7\x19\x46\xf4\x84\x69\x9f\xbb\x70\xa8\x4c\x52\x81\xa9\xff\x76\x1c\xae\xd8\x11\x3d\x7f\x7d\xc5\x12\x59\x28\x18\xc2\xa2\xb7\x1c\x88\xf8\xd6\x1b\xa6\x7d\x9e\xde\x29\xf8\xed\xff\xeb\x92\x24\x4f\x5\xaa\xd9\x49\xba\x87\x59\x51\xc9\x20\x5c\x9b\x74\xcf\x3\xd9\x2d\x34\xc7\x5b\xa5\x40\xb2\x99\xf5\xcb\xb4\xf6\xb7\x72\x4a\xd6\xbd\xb0\xf3\x93\xe0\x1b\xa8\x4\x1e\x35\xd4\x80\x20\xf4\x9c\x31\x6b\x45\xb9\x15\xb0\x5e\xdd\xa\x33\x9c\x83\xcd\x58\x89\x50\x56\xbb\x81\x0\x91\x32\xf3\x1b\x3e\xcf\x45\xe1\xf9\xe1\x2c\x26\x78\x93\x9a\x60\x46\xc9\xb5\x5e\x6a\x28\x92\x87\x3f\x63\x7b\xdb\xf7\xd0\x13\x9d\x32\x40\x5e\xcf\xfb\x79\x68\x47\x4c\xfd\x1\x17\xe6\x97\x93\x78\xbb\xa6\x27\xa3\xe8\x1a\xe8\x94\x55\x7d\x8\xe5\xdc\x66\xa3\x69\xc8\xca\xc5\xa1\x84\x55\xde\x8\x91\x16\x3a\xc\x86\xab\x27\x2b\x64\x34\x2\x6c\x76\x8b\xc6\xaf\xcc\xe1\xd6\x8c\x2a\x18\x3d\xa6\x1b\x37\x75\x45\x73\xc2\x75\xd7\x53\x78\x3a\xd6\xe8\x29\xd2\x4a\xa8\x1e\x82\xf6\xb6\x81\xde\x21\xed\x2b\x56\xbb\xf2\xd0\x57\xc1\x7c\xd2\x6a\xd2\x56\xf5\x13\x5f\x1c\x6a\xb\x74\xfb\xe9\xfe\x9e\xea\x95\xb2\x46\xab\xa\xfc\xfd\xf3\xbb\x4\x2b\x76\x1b\xa4\x74\xb0\xc1\x78\xc3\x69\xe2\xb0\x1\xe1\xde\x32\x4c\x8d\x1a\xb3\x38\x8\xd5\xfc\x1f\xdc\xe\x2c\x9c\xb1\xa1\x63\x17\x22\xf5\x6c\x93\x70\x74\x0\xf8\x39\x1\x94\xd1\x32\x23\x56\x5d\xa6\x2\x76\x76\x93\xce\x2f\x19\xe9\x17\x52\xae\x6e\x2c\x6d\x61\x7f\x3b\xaa\xe0\x52\x85\xc5\x65\xc1\xbb\x8e\x5b\x21\xd5\xc9\x78\x83\x7\x97\x4c\x62\x61\x41\xd4\xfc\xc9\x39\xe3\x9b\xd0\xcc\x75\xc4\x97\xe6\xdd\x2a\x5f\xa6\xe8\x59\x6c\x98\xb9\x2\xe2\xa2\xd6\x68\xee\x3b\x1d\xe3\x4d\x5b\x30\xef\x3\xf2\xeb\x18\x57\x36\xe8\xa1\xf4\x47\xfb\xcb\x8f\xcb\xc8\xf3\x4f\x74\x9d\x9d\xb1\x8d\x14\x44\xd9\x19\xb4\x54\x4f\x75\x19\x9\xa0\x75\xbc\x3b\x82\xc6\x3f\xb8\x83\x19\x6e\xd6\x37\xfe\x6e\x8a\x4e\xe0\x4a\xab\x7b\xc8\xb4\x1d\xf4\xed\x27\x3\x65\xa2\xa1\xae\x11\xe7\x98\x78\x48\x91\xd2\xd2\xd4\x23\x78\x50\xb1\x5b\x85\x10\x8d\xca\x5f\xf\x71\xae\x72\x9a\xf6\x25\x19\x60\x6\xf7\x10\x34\x18\xd\xc9\x9f\x7b\xc\x9b\x8f\x91\x1b\x9f\xcd\x10\xee\x75\xf9\x97\x66\xfc\x4d\x33\x6e\x28\x2b\x92\x85\x4f\xab\x43\x8d\x8f\x7d\x86\xa7\xc7\xd8\xd3\xb\x8b\x57\xb6\x1d\x95\xd\xe9\xbc\xd9\x3\xd9\x10\x19\xc3\x46\x63\x55\x87\x61\x79\x6c\x95\xe\x9c\xdd\xca\xc3\xf3\x64\xf0\x7d\x76\xb7\x53\x67\x2b\x1e\x44\x56\x81\xea\x8f\x5c\x42\x16\xb8\x28\xeb\x1b\x61\x10\x1e\xbf\xec\xa8" ++}, { ++ .key = "\xb3\x35\x50\x3\x54\x2e\x40\x5e\x8f\x59\x8e\xc5\x90\xd5\x27\x2d\xba\x29\x2e\xcb\x1b\x70\x44\x1e\x65\x91\x6e\x2a\x79\x22\xda\x64", ++ .nonce = "\x5\xa3\x93\xed\x30\xc5\xa2\x6", ++ .assoc = "\xb1\x69\x83\x87\x30\xaa\x5d\xb8\x77\xe8\x21\xff\x6\x59\x35\xce\x75\xfe\x38\xef\xb8\x91\x43\x8c\xcf\x70\xdd\xa\x68\xbf\xd4\xbc\x16\x76\x99\x36\x1e\x58\x79\x5e\xd4\x29\xf7\x33\x93\x48\xdb\x5f\x1\xae\x9c\xb6\xe4\x88\x6d\x2b\x76\x75\xe0\xf3\x74\xe2\xc9", ++ .alen = 63, ++ .input = "\x52\x34\xb3\x65\x3b\xb7\xe5\xd3\xab\x49\x17\x60\xd2\x52\x56\xdf\xdf\x34\x56\x82\xe2\xbe\xe5\xe1\x28\xd1\x4e\x5f\x4f\x1\x7d\x3f\x99\x6b\x30\x6e\x1a\x7c\x4c\x8e\x62\x81\xae\x86\x3f\x6b\xd0\xb5\xa9\xcf\x50\xf1\x2\x12\xa0\xb\x24\xe9\xe6\x72\x89\x2c\x52\x1b\x34\x38\xf8\x75\x5f\xa0\x74\xe2\x99\xdd\xa6\x4b\x14\x50\x4e\xf1\xbe\xd6\x9e\xdb\xb2\x24\x27\x74\x12\x4a\x78\x78\x17\xa5\x58\x8e\x2f\xf9\xf4\x8d\xee\x3\x88\xae\xb8\x29\xa1\x2f\x4b\xee\x92\xbd\x87\xb3\xce\x34\x21\x57\x46\x4\x49\xc\x80\xf2\x1\x13\xa1\x55\xb3\xff\x44\x30\x3c\x1c\xd0\xef\xbc\x18\x74\x26\xad\x41\x5b\x5b\x3e\x9a\x7a\x46\x4f\x16\xd6\x74\x5a\xb7\x3a\x28\x31\xd8\xae\x26\xac\x50\x53\x86\xf2\x56\xd7\x3f\x29\xbc\x45\x68\x8e\xcb\x98\x64\xdd\xc9\xba\xb8\x4b\x7b\x82\xdd\x14\xa7\xcb\x71\x72\x0\x5c\xad\x7b\x6a\x89\xa4\x3d\xbf\xb5\x4b\x3e\x7c\x5a\xcf\xb8\xa1\xc5\x6e\xc8\xb6\x31\x57\x7b\xdf\xa5\x7e\xb1\xd6\x42\x2a\x31\x36\xd1\xd0\x3f\x7a\xe5\x94\xd6\x36\xa0\x6f\xb7\x40\x7d\x37\xc6\x55\x7c\x50\x40\x6d\x29\x89\xe3\x5a\xae\x97\xe7\x44\x49\x6e\xbd\x81\x3d\x3\x93\x6\x12\x6\xe2\x41\x12\x4a\xf1\x6a\xa4\x58\xa2\xfb\xd2\x15\xba\xc9\x79\xc9\xce\x5e\x13\xbb\xf1\x9\x4\xcc\xfd\xe8\x51\x34\x6a\xe8\x61\x88\xda\xed\x1\x47\x84\xf5\x73\x25\xf9\x1c\x42\x86\x7\xf3\x5b\x1a\x1\xb3\xeb\x24\x32\x8d\xf6\xed\x7c\x4b\xeb\x3c\x36\x42\x28\xdf\xdf\xb6\xbe\xd9\x8c\x52\xd3\x2b\x8\x90\x8c\xe7\x98\x31\xe2\x32\x8e\xfc\x11\x48\x0\xa8\x6a\x42\x4a\x2\xc6\x4b\x9\xf1\xe3\x49\xf3\x45\x1f\xe\xbc\x56\xe2\xe4\xdf\xfb\xeb\x61\xfa\x24\xc1\x63\x75\xbb\x47\x75\xaf\xe1\x53\x16\x96\x21\x85\x26\x11\xb3\x76\xe3\x23\xa1\x6b\x74\x37\xd0\xde\x6\x90\x71\x5d\x43\x88\x9b\x0\x54\xa6\x75\x2f\xa1\xc2\xb\x73\x20\x1d\xb6\x21\x79\x57\x3f\xfa\x9\xbe\x8a\x33\xc3\x52\xf0\x1d\x82\x31\xd1\x55\xb5\x6c\x99\x25\xcf\x5c\x32\xce\xe9\xd\xfa\x69\x2c\xd5\xd\xc5\x6d\x86\xd0\xc\x3b\x6\x50\x79\xe8\xc3\xae\x4\xe6\xcd\x51\xe4\x26\x9b\x4f\x7e\xa6\xf\xab\xd8\xe5\xde\xa9\x0\x95\xbe\xa3\x9d\x5d\xb2\x9\x70\x18\x1c\xf0\xac\x29\x23\x2\x29\x28\xd2\x74\x35\x57\x62\xf\x24\xea\x5e\x33\xc2\x92\xf3\x78\x4d\x30\x1e\xa1\x99\xa9\x82\xb0\x42\x31\x8d\xad\x8a\xbc\xfc\xd4\x57\x47\x3e\xb4\x50\xdd\x6e\x2c\x80\x4d\x22\xf1\xfb\x57\xc4\xdd\x17\xe1\x8a\x36\x4a\xb3\x37\xca\xc9\x4e\xab\xd5\x69\xc4\xf4\xbc\xb\x3b\x44\x4b\x29\x9c\xee\xd4\x35\x22\x21\xb0\x1f\x27\x64\xa8\x51\x1b\xf0\x9f\x19\x5c\xfb\x5a\x64\x74\x70\x45\x9\xf5\x64\xfe\x1a\x2d\xc9\x14\x4\x14\xcf\xd5\x7d\x60\xaf\x94\x39\x94\xe2\x7d\x79\x82\xd0\x65\x3b\x6b\x9c\x19\x84\xb4\x6d\xb3\xc\x99\xc0\x56\xa8\xbd\x73\xce\x5\x84\x3e\x30\xaa\xc4\x9b\x1b\x4\x2a\x9f\xd7\x43\x2b\x23\xdf\xbf\xaa\xd5\xc2\x43\x2d\x70\xab\xdc\x75\xad\xac\xf7\xc0\xbe\x67\xb2\x74\xed\x67\x10\x4a\x92\x60\xc1\x40\x50\x19\x8a\x8a\x8c\x9\xe\x72\xe1\x73\x5e\xe8\x41\x85\x63\x9f\x3f\xd7\x7d\xc4\xfb\x22\x5d\x92\x6c\xb3\x1e\xe2\x50\x2f\x82\xa8\x28\xc0\xb5\xd7\x5f\x68\xd\x2c\x2d\xaf\x7e\xfa\x2e\x8\xf\x1f\x70\x9f\xe9\x19\x72\x55\xf8\xfb\x51\xd2\x33\x5d\xa0\xd3\x2b\xa\x6c\xbc\x4e\xcf\x36\x4d\xdc\x3b\xe9\x3e\x81\x7c\x61\xdb\x20\x2d\x3a\xc3\xb3\xc\x1e\x0\xb9\x7c\xf5\xca\x10\x5f\x3a\x71\xb3\xe4\x20\xdb\xc\x2a\x98\x63\x45\x0\x58\xf6\x68\xe4\xb\xda\x13\x3b\x60\x5c\x76\xdb\xb9\x97\x71\xe4\xd9\xb7\xdb\xbd\x68\xc7\x84\x84\xaa\x7c\x68\x62\x5e\x16\xfc\xba\x72\xaa\x9a\xa9\xeb\x7c\x75\x47\x97\x7e\xad\xe2\xd9\x91\xe8\xe4\xa5\x31\xd7\x1\x8e\xa2\x11\x88\x95\xb9\xf2\x9b\xd3\x7f\x1b\x81\x22\xf7\x98\x60\xa\x64\xa6\xc1\xf6\x49\xc7\xe3\x7\x4d\x94\x7a\xcf\x6e\x68\xc\x1b\x3f\x6e\x2e\xee\x92\xfa\x52\xb3\x59\xf8\xf1\x8f\x6a\x66\xa3\x82\x76\x4a\x7\x1a\xc7\xdd\xf5\xda\x9c\x3c\x24\xbf\xfd\x42\xa1\x10\x64\x6a\xf\x89\xee\x36\xa5\xce\x99\x48\x6a\xf0\x9f\x9e\x69\xa4\x40\x20\xe9\x16\x15\xf7\xdb\x75\x2\xcb\xe9\x73\x8b\x3b\x49\x2f\xf0\xaf\x51\x6\x5c\xdf\x27\x27\x49\x6a\xd1\xcc\xc7\xb5\x63\xb5\xfc\xb8\x5c\x87\x7f\x84\xb4\xcc\x14\xa9\x53\xda\xa4\x56\xf8\xb6\x1b\xcc\x40\x27\x52\x6\x5a\x13\x81\xd7\x3a\xd4\x3b\xfb\x49\x65\x31\x33\xb2\xfa\xcd\xad\x58\x4e\x2b\xae\xd2\x20\xfb\x1a\x48\xb4\x3f\x9a\xd8\x7a\x35\x4a\xc8\xee\x88\x5e\x7\x66\x54\xb9\xec\x9f\xa3\xe3\xb9\x37\xaa\x49\x76\x31\xda\x74\x2d\x3c\xa4\x65\x10\x32\x38\xf0\xde\xd3\x99\x17\xaa\x71\xaa\x8f\xf\x8c\xaf\xa2\xf8\x5d\x64\xba\x1d\xa3\xef\x96\x73\xe8\xa1\x2\x8d\xc\x6d\xb8\x6\x90\xb8\x8\x56\x2c\xa7\x6\xc9\xc2\x38\xdb\x7c\x63\xb1\x57\x8e\xea\x7c\x79\xf3\x49\x1d\xfe\x9f\xf3\x6e\xb1\x1d\xba\x19\x80\x1a\xa\xd3\xb0\x26\x21\x40\xb1\x7c\xf9\x4d\x8d\x10\xc1\x7e\xf4\xf6\x3c\xa8\xfd\x7c\xa3\x92\xb2\xf\xaa\xcc\xa6\x11\xfe\x4\xe3\xd1\x7a\x32\x89\xdf\xd\xc4\x8f\x79\x6b\xca\x16\x7c\x6e\xf9\xad\xf\xf6\xfe\x27\xdb\xc4\x13\x70\xf1\x62\x1a\x4f\x79\x40\xc9\x9b\x8b\x21\xea\x84\xfa\xf5\xf1\x89\xce\xb7\x55\xa\x80\x39\x2f\x55\x36\x16\x9c\x7b\x8\xbd\x87\xd\xa5\x32\xf1\x52\x7c\xe8\x55\x60\x5b\xd7\x69\xe4\xfc\xfa\x12\x85\x96\xea\x50\x28\xab\x8a\xf7\xbb\xe\x53\x74\xca\xa6\x27\x9\xc2\xb5\xde\x18\x14\xd9\xea\xe5\x29\x1c\x40\x56\xcf\xd7\xae\x5\x3f\x65\xaf\x5\x73\xe2\x35\x96\x27\x7\x14\xc0\xad\x33\xf1\xdc\x44\x7a\x89\x17\x77\xd2\x9c\x58\x60\xf0\x3f\x7b\x2d\x2e\x57\x95\x54\x87\xed\xf2\xc7\x4c\xf0\xae\x56\x29\x19\x7d\x66\x4b\x9b\x83\x84\x42\x3b\x1\x25\x66\x8e\x2\xde\xb9\x83\x54\x19\xf6\x9f\x79\xd\x67\xc5\x1d\x7a\x44\x2\x98\xa7\x16\x1c\x29\xd\x74\xff\x85\x40\x6\xef\x2c\xa9\xc6\xf5\x53\x7\x6\xae\xe4\xfa\x5f\xd8\x39\x4d\xf1\x9b\x6b\xd9\x24\x84\xfe\x3\x4c\xb2\x3f\xdf\xa1\x5\x9e\x50\x14\x5a\xd9\x1a\xa2\xa7\xfa\xfa\x17\xf7\x78\xd6\xb5\x92\x61\x91\xac\x36\xfa\x56\xd\x38\x32\x18\x85\x8\x58\x37\xf0\x4b\xdb\x59\xe7\xa4\x34\xc0\x1b\x1\xaf\x2d\xde\xa1\xaa\x5d\xd3\xec\xe1\xd4\xf7\xe6\x54\x68\xf0\x51\x97\xa7\x89\xea\x24\xad\xd3\x6e\x47\x93\x8b\x4b\xb4\xf7\x1c\x42\x6\x67\xe8\x99\xf6\xf5\x7b\x85\xb5\x65\xb5\xb5\xd2\x37\xf5\xf3\x2\xa6\x4d\x11\xa7\xdc\x51\x9\x7f\xa0\xd8\x88\x1c\x13\x71\xae\x9c\xb7\x7b\x34\xd6\x4e\x68\x26\x83\x51\xaf\x1d\xee\x8b\xbb\x69\x43\x2b\x9e\x8a\xbc\x2\xe\xa0\x1b\xe0\xa8\x5f\x6f\xaf\x1b\x8f\xe7\x64\x71\x74\x11\x7e\xa8\xd8\xf9\x97\x6\xc3\xb6\xfb\xfb\xb7\x3d\x35\x9d\x3b\x52\xed\x54\xca\xf4\x81\x1\x2d\x1b\xc3\xa7\x0\x3d\x1a\x39\x54\xe1\xf6\xff\xed\x6f\xb\x5a\x68\xda\x58\xdd\xa9\xcf\x5c\x4a\xe5\x9\x4e\xde\x9d\xbc\x3e\xee\x5a\x0\x3b\x2c\x87\x10\x65\x60\xdd\xd7\x56\xd1\x4c\x64\x45\xe4\x21\xec\x78\xf8\x25\x7a\x3e\x16\x5d\x9\x53\x14\xbe\x4f\xae\x87\xd8\xd1\xaa\x3c\xf6\x3e\xa4\x70\x8c\x5e\x70\xa4\xb3\x6b\x66\x73\xd3\xbf\x31\x6\x19\x62\x93\x15\xf2\x86\xe4\x52\x7e\x53\x4c\x12\x38\xcc\x34\x7d\x57\xf6\x42\x93\x8a\xc4\xee\x5c\x8a\xe1\x52\x8f\x56\x64\xf6\xa6\xd1\x91\x57\x70\xcd\x11\x76\xf5\x59\x60\x60\x3c\xc1\xc3\xb\x7f\x58\x1a\x50\x91\xf1\x68\x8f\x6e\x74\x74\xa8\x51\xb\xf7\x7a\x98\x37\xf2\xa\xe\xa4\x97\x4\xb8\x9b\xfd\xa0\xea\xf7\xd\xe1\xdb\x3\xf0\x31\x29\xf8\xdd\x6b\x8b\x5d\xd8\x59\xa9\x29\xcf\x9a\x79\x89\x19\x63\x46\x9\x79\x6a\x11\xda\x63\x68\x48\x77\x23\xfb\x7d\x3a\x43\xcb\x2\x3b\x7a\x6d\x10\x2a\x9e\xac\xf1\xd4\x19\xf8\x23\x64\x1d\x2c\x5f\xf2\xb0\x5c\x23\x27\xf7\x27\x30\x16\x37\xb1\x90\xab\x38\xfb\x55\xcd\x78\x58\xd4\x7d\x43\xf6\x45\x5e\x55\x8d\xb1\x2\x65\x58\xb4\x13\x4b\x36\xf7\xcc\xfe\x3d\xb\x82\xe2\x12\x11\xbb\xe6\xb8\x3a\x48\x71\xc7\x50\x6\x16\x3a\xe6\x7c\x5\xc7\xc8\x4d\x2f\x8\x6a\x17\x9a\x95\x97\x50\x68\xdc\x28\x18\xc4\x61\x38\xb9\xe0\x3e\x78\xdb\x29\xe0\x9f\x52\xdd\xf8\x4f\x91\xc1\xd0\x33\xa1\x7a\x8e\x30\x13\x82\x7\x9f\xd3\x31\xf\x23\xbe\x32\x5a\x75\xcf\x96\xb2\xec\xb5\x32\xac\x21\xd1\x82\x33\xd3\x15\x74\xbd\x90\xf1\x2c\xe6\x5f\x8d\xe3\x2\xe8\xe9\xc4\xca\x96\xeb\xe\xbc\x91\xf4\xb9\xea\xd9\x1b\x75\xbd\xe1\xac\x2a\x5\x37\x52\x9b\x1b\x3f\x5a\xdc\x21\xc3\x98\xbb\xaf\xa3\xf2\x0\xbf\xd\x30\x89\x5\xcc\xa5\x76\xf5\x6\xf0\xc6\x54\x8a\x5d\xd4\x1e\xc1\xf2\xce\xb0\x62\xc8\xfc\x59\x42\x9a\x90\x60\x55\xfe\x88\xa5\x8b\xb8\x33\xc\x23\x24\xd\x15\x70\x37\x1e\x3d\xf6\xd2\xea\x92\x10\xb2\xc4\x51\xac\xf2\xac\xf3\x6b\x6c\xaa\xcf\x12\xc5\x6c\x90\x50\xb5\xc\xfc\x1a\x15\x52\xe9\x26\xc6\x52\xa4\xe7\x81\x69\xe1\xe7\x9e\x30\x1\xec\x84\x89\xb2\xd\x66\xdd\xce\x28\x5c\xec\x98\x46\x68\x21\x9f\x88\x3f\x1f\x42\x77\xce\xd0\x61\xd4\x20\xa7\xff\x53\xad\x37\xd0\x17\x35\xc9\xfc\xba\xa\x78\x3f\xf2\xcc\x86\x89\xe8\x4b\x3c\x48\x33\x9\x7f\xc6\xc0\xdd\xb8\xfd\x7a\x66\x66\x65\xeb\x47\xa7\x4\x28\xa3\x19\x8e\xa9\xb1\x13\x67\x62\x70\xcf\xd6", ++ .ilen = 2027, ++ .result = "\x74\xa6\x3e\xe4\xb1\xcb\xaf\xb0\x40\xe5\xf\x9e\xf1\xf2\x89\xb5\x42\x34\x8a\xa1\x3\xb7\xe9\x57\x46\xbe\x20\xe4\x6e\xb0\xeb\xff\xea\x7\x7e\xef\xe2\x55\x9f\xe5\x78\x3a\xb7\x83\xc2\x18\x40\x7b\xeb\xcd\x81\xfb\x90\x12\x9e\x46\xa9\xd6\x4a\xba\xb0\x62\xdb\x6b\x99\xc4\xdb\x54\x4b\xb8\xa5\x71\xcb\xcd\x63\x32\x55\xfb\x31\xf0\x38\xf5\xbe\x78\xe4\x45\xce\x1b\x6a\x5b\xe\xf4\x16\xe4\xb1\x3d\xf6\x63\x7b\xa7\xc\xde\x6f\x8f\x74\xdf\xe0\x1e\x9d\xce\x8f\x24\xef\x23\x35\x33\x7b\x83\x34\x23\x58\x74\x14\x77\x1f\xc2\x4f\x4e\xc6\x89\xf9\x52\x9\x37\x64\x14\xc4\x1\x6b\x9d\x77\xe8\x90\x5d\xa8\x4a\x2a\xef\x5c\x7f\xeb\xbb\xb2\xc6\x93\x99\x66\xdc\x7f\xd4\x9e\x2a\xca\x8d\xdb\xe7\x20\xcf\xe4\x73\xae\x49\x7d\x64\xf\xe\x28\x46\xa9\xa8\x32\xe4\xe\xf6\x51\x53\xb8\x3c\xb1\xff\xa3\x33\x41\x75\xff\xf1\x6f\xf1\xfb\xbb\x83\x7f\x6\x9b\xe7\x1b\xa\xe0\x5c\x33\x60\x5b\xdb\x5b\xed\xfe\xa5\x16\x19\x72\xa3\x64\x23\x0\x2\xc7\xf3\x6a\x81\x3e\x44\x1d\x79\x15\x5f\x9a\xde\xe2\xfd\x1b\x73\xc1\xbc\x23\xba\x31\xd2\x50\xd5\xad\x7f\x74\xa7\xc9\xf8\x3e\x2b\x26\x10\xf6\x3\x36\x74\xe4\xe\x6a\x72\xb7\x73\xa\x42\x28\xc2\xad\x5e\x3\xbe\xb8\xb\xa8\x5b\xd4\xb8\xba\x52\x89\xb1\x9b\xc1\xc3\x65\x87\xed\xa5\xf4\x86\xfd\x41\x80\x91\x27\x59\x53\x67\x15\x78\x54\x8b\x2d\x3d\xc7\xff\x2\x92\x7\x5f\x7a\x4b\x60\x59\x3c\x6f\x5c\xd8\xec\x95\xd2\xfe\xa0\x3b\xd8\x3f\xd1\x69\xa6\xd6\x41\xb2\xf4\x4d\x12\xf4\x58\x3e\x66\x64\x80\x31\x9b\xa8\x4c\x8b\x7\xb2\xec\x66\x94\x66\x47\x50\x50\x5f\x18\xb\xe\xd6\xc0\x39\x21\x13\x9e\x33\xbc\x79\x36\x2\x96\x70\xf0\x48\x67\x2f\x26\xe9\x6d\x10\xbb\xd6\x3f\xd1\x64\x7a\x2e\xbe\xc\x61\xf0\x75\x42\x38\x23\xb1\x9e\x9f\x7c\x67\x66\xd9\x58\x9a\xf1\xbb\x41\x2a\x8d\x65\x84\x94\xfc\xdc\x6a\x50\x64\xdb\x56\x33\x76\x0\x10\xed\xbe\xd2\x12\xf6\xf6\x1b\xa2\x16\xde\xae\x31\x95\xdd\xb1\x8\x7e\x4e\xee\xe7\xf9\xa5\xfb\x5b\x61\x43\x0\x40\xf6\x7e\x2\x4\x32\x4e\xc\xe2\x66\xd\xd7\x7\x98\xe\xf8\x72\x34\x6d\x95\x86\xd7\xcb\x31\x54\x47\xd0\x38\x29\x9c\x5a\x68\xd4\x87\x76\xc9\xe7\x7e\xe3\xf4\x81\x6d\x18\xcb\xc9\x5\xaf\xa0\xfb\x66\xf7\xf1\x1c\xc6\x14\x11\x4f\x2b\x79\x42\x8b\xbc\xac\xe7\x6c\xfe\xf\x58\xe7\x7c\x78\x39\x30\xb0\x66\x2c\x9b\x6d\x3a\xe1\xcf\xc9\xa4\xe\x6d\x6d\x8a\xa1\x3a\xe7\x28\xd4\x78\x4c\xa6\xa2\x2a\xa6\x3\x30\xd7\xa8\x25\x66\x87\x2f\x69\x5c\x4e\xdd\xa5\x49\x5d\x37\x4a\x59\xc4\xaf\x1f\xa2\xe4\xf8\xa6\x12\x97\xd5\x79\xf5\xe2\x4a\x2b\x5f\x61\xe4\x9e\xe3\xee\xb8\xa7\x5b\x2f\xf4\x9e\x6c\xfb\xd1\xc6\x56\x77\xba\x75\xaa\x3d\x1a\xa8\xb\xb3\x68\x24\x0\x10\x7f\xfd\xd7\xa1\x8d\x83\x54\x4f\x1f\xd8\x2a\xbe\x8a\xc\x87\xab\xa2\xde\xc3\x39\xbf\x9\x3\xa5\xf3\x5\x28\xe1\xe1\xee\x39\x70\x9c\xd8\x81\x12\x1e\x2\x40\xd2\x6e\xf0\xeb\x1b\x3d\x22\xc6\xe5\xe3\xb4\x5a\x98\xbb\xf0\x22\x28\x8d\xe5\xd3\x16\x48\x24\xa5\xe6\x66\xc\xf9\x8\xf9\x7e\x1e\xe1\x28\x26\x22\xc7\xc7\xa\x32\x47\xfa\xa3\xbe\x3c\xc4\xc5\x53\xa\xd5\x94\x4a\xd7\x93\xd8\x42\x99\xb9\xa\xdb\x56\xf7\xb9\x1c\x53\x4f\xfa\xd3\x74\xad\xd9\x68\xf1\x1b\xdf\x61\xc6\x5e\xa8\x48\xfc\xd4\x4a\x4c\x3c\x32\xf7\x1c\x96\x21\x9b\xf9\xa3\xcc\x5a\xce\xd5\xd7\x8\x24\xf6\x1c\xfd\xdd\x38\xc2\x32\xe9\xb8\xe7\xb6\xfa\x9d\x45\x13\x2c\x83\xfd\x4a\x69\x82\xcd\xdc\xb3\x76\xc\x9e\xd8\xf4\x1b\x45\x15\xb4\x97\xe7\x58\x34\xe2\x3\x29\x5a\xbf\xb6\xe0\x5d\x13\xd9\x2b\xb4\x80\xb2\x45\x81\x6a\x2e\x6c\x89\x7d\xee\xbb\x52\xdd\x1f\x18\xe7\x13\x6b\x33\xe\xea\x36\x92\x77\x7b\x6d\x9c\x5a\x5f\x45\x7b\x7b\x35\x62\x23\xd1\xbf\xf\xd0\x8\x1b\x2b\x80\x6b\x7e\xf1\x21\x47\xb0\x57\xd1\x98\x72\x90\x34\x1c\x20\x4\xff\x3d\x5c\xee\xe\x57\x5f\x6f\x24\x4e\x3c\xea\xfc\xa5\xa9\x83\xc9\x61\xb4\x51\x24\xf8\x27\x5e\x46\x8c\xb1\x53\x2\x96\x35\xba\xb8\x4c\x71\xd3\x15\x59\x35\x22\x20\xad\x3\x9f\x66\x44\x3b\x9c\x35\x37\x1f\x9b\xbb\xf3\xdb\x35\x63\x30\x64\xaa\xa2\x6\xa8\x5d\xbb\xe1\x9f\x70\xec\x82\x11\x6\x36\xec\x8b\x69\x66\x24\x44\xc9\x4a\x57\xbb\x9b\x78\x13\xce\x9c\xc\xba\x92\x93\x63\xb8\xe2\x95\xf\xf\x16\x39\x52\xfd\x3a\x6d\x2\x4b\xdf\x13\xd3\x2a\x22\xb4\x3\x7c\x54\x49\x96\x68\x54\x10\xfa\xef\xaa\x6c\xe8\x22\xdc\x71\x16\x13\x1a\xf6\x28\xe5\x6d\x77\x3d\xcd\x30\x63\xb1\x70\x52\xa1\xc5\x94\x5f\xcf\xe8\xb8\x26\x98\xf7\x6\xa0\xa\x70\xfa\x3\x80\xac\xc1\xec\xd6\x4c\x54\xd7\xfe\x47\xb6\x88\x4a\xf7\x71\x24\xee\xf3\xd2\xc2\x4a\x7f\xfe\x61\xc7\x35\xc9\x37\x67\xcb\x24\x35\xda\x7e\xca\x5f\xf3\x8d\xd4\x13\x8e\xd6\xcb\x4d\x53\x8f\x53\x1f\xc0\x74\xf7\x53\xb9\x5e\x23\x37\xba\x6e\xe3\x9d\x7\x55\x25\x7b\xe6\x2a\x64\xd1\x32\xdd\x54\x1b\x4b\xc0\xe1\xd7\x69\x58\xf8\x93\x29\xc4\xdd\x23\x2f\xa5\xfc\x9d\x7e\xf8\xd4\x90\xcd\x82\x55\xdc\x16\x16\x9f\x7\x52\x9b\x9d\x25\xed\x32\xc5\x7b\xdf\xf6\x83\x46\x3d\x65\xb7\xef\x87\x7a\x12\x69\x8f\x6\x7c\x51\x15\x4a\x8\xe8\xac\x9a\xc\x24\xa7\x27\xd8\x46\x2f\xe7\x1\xe\x1c\xc6\x91\xb0\x6e\x85\x65\xf0\x29\xd\x2e\x6b\x3b\xfb\x4b\xdf\xe4\x80\x93\x3\x66\x46\x3e\x8a\x6e\xf3\x5e\x4d\x62\xe\x49\x5\xaf\xd4\xf8\x21\x20\x61\x1d\x39\x17\xf4\x61\x47\x95\xfb\x15\x2e\xb3\x4f\xd0\x5d\xf5\x7d\x40\xda\x90\x3c\x6b\xcb\x17\x0\x13\x3b\x64\x34\x1b\xf0\xf2\xe5\x3b\xb2\xc7\xd3\x5f\x3a\x44\xa6\x9b\xb7\x78\xe\x42\x5d\x4c\xc1\xe9\xd2\xcb\xb7\x78\xd1\xfe\x9a\xb5\x7\xe9\xe0\xbe\xe2\x8a\xa7\x1\x83\x0\x8c\x5c\x8\xe6\x63\x12\x92\xb7\xb7\xa6\x19\x7d\x38\x13\x38\x92\x87\x24\xf9\x48\xb3\x5e\x87\x6a\x40\x39\x5c\x3f\xed\x8f\xee\xdb\x15\x82\x6\xda\x49\x21\x2b\xb5\xbf\x32\x7c\x9f\x42\x28\x63\xcf\xaf\x1e\xf8\xc6\xa0\xd1\x2\x43\x57\x62\xec\x9b\xf\x1\x9e\x71\xd8\x87\x9d\x1\xc1\x58\x77\xd9\xaf\xb1\x10\x7e\xdd\xa6\x50\x96\xe5\xf0\x72\x0\x6d\x4b\xf8\x2a\x8f\x19\xf3\x22\x88\x11\x4a\x8b\x7c\xfd\xb7\xed\xe1\xf6\x40\x39\xe0\xe9\xf6\x3d\x25\xe6\x74\x3c\x58\x57\x7f\xe1\x22\x96\x47\x31\x91\xba\x70\x85\x28\x6b\x9f\x6e\x25\xac\x23\x66\x2f\x29\x88\x28\xce\x8c\x5c\x88\x53\xd1\x3b\xcc\x6a\x51\xb2\xe1\x28\x3f\x91\xb4\xd\x0\x3a\xe3\xf8\xc3\x8f\xd7\x96\x62\xe\x2e\xfc\xc8\x6c\x77\xa6\x1d\x22\xc1\xb8\xe6\x61\xd7\x67\x36\x13\x7b\xbb\x9b\x59\x9\xa6\xdf\xf7\x6b\xa3\x40\x1a\xf5\x4f\xb4\xda\xd3\xf3\x81\x93\xc6\x18\xd9\x26\xee\xac\xf0\xaa\xdf\xc5\x9c\xca\xc2\xa2\xcc\x7b\x5c\x24\xb0\xbc\xd0\x6a\x4d\x89\x9\xb8\x7\xfe\x87\xad\xa\xea\xb8\x42\xf9\x5e\xb3\x3e\x36\x4c\xaf\x75\x9e\x1c\xeb\xbd\xbc\xbb\x80\x40\xa7\x3a\x30\xbf\xa8\x44\xf4\xeb\x38\xad\x29\xba\x23\xed\x41\xc\xea\xd2\xbb\x41\x18\xd6\xb9\xba\x65\x2b\xa3\x91\x6d\x1f\xa9\xf4\xd1\x25\x8d\x4d\x38\xff\x64\xa0\xec\xde\xa6\xb6\x79\xab\x8e\x33\x6c\x47\xde\xaf\x94\xa4\xa5\x86\x77\x55\x9\x92\x81\x31\x76\xc7\x34\x22\x89\x8e\x3d\x26\x26\xd7\xfc\x1e\x16\x72\x13\x33\x63\xd5\x22\xbe\xb8\x4\x34\x84\x41\xbb\x80\xd0\x9f\x46\x48\x7\xa7\xfc\x2b\x3a\x75\x55\x8c\xc7\x6a\xbd\x7e\x46\x8\x84\xf\xd5\x74\xc0\x82\x8e\xaa\x61\x5\x1\xb2\x47\x6e\x20\x6a\x2d\x58\x70\x48\x32\xa7\x37\xd2\xb8\x82\x1a\x51\xb9\x61\xdd\xfd\x9d\x6b\xe\x18\x97\xf8\x45\x5f\x87\x10\xcf\x34\x72\x45\x26\x49\x70\xe7\xa3\x78\xe0\x52\x89\x84\x94\x83\x82\xc2\x69\x8f\xe3\xe1\x3f\x60\x74\x88\xc4\xf7\x75\x2c\xfb\xbd\xb6\xc4\x7e\x10\xa\x6c\x90\x4\x9e\xc3\x3f\x59\x7c\xce\x31\x18\x60\x57\x73\x46\x94\x7d\x6\xa0\x6d\x44\xec\xa2\xa\x9e\x5\x15\xef\xca\x5c\xbf\x0\xeb\xf7\x3d\x32\xd4\xa5\xef\x49\x89\x5e\x46\xb0\xa6\x63\x5b\x8a\x73\xae\x6f\xd5\x9d\xf8\x4f\x40\xb5\xb2\x6e\xd3\xb6\x1\xa9\x26\xa2\x21\xcf\x33\x7a\x3a\xa4\x23\x13\xb0\x69\x6a\xee\xce\xd8\x9d\x1\x1d\x50\xc1\x30\x6c\xb1\xcd\xa0\xf0\xf0\xa2\x64\x6f\xbb\xbf\x5e\xe6\xab\x87\xb4\xf\x4f\x15\xaf\xb5\x25\xa1\xb2\xd0\x80\x2c\xfb\xf9\xfe\xd2\x33\xbb\x76\xfe\x7c\xa8\x66\xf7\xe7\x85\x9f\x1f\x85\x57\x88\xe1\xe9\x63\xe4\xd8\x1c\xa1\xfb\xda\x44\x5\x2e\x1d\x3a\x1c\xff\xc8\x3b\xc0\xfe\xda\x22\xb\x43\xd6\x88\x39\x4c\x4a\xa6\x69\x18\x93\x42\x4e\xb5\xcc\x66\xd\x9\xf8\x1e\x7c\xd3\x3c\x99\xd\x50\x1d\x62\xe9\x57\x6\xbf\x19\x88\xdd\xad\x7b\x4f\xf9\xc7\x82\x6d\x8d\xc8\xc4\xc5\x78\x17\x20\x15\xc5\x52\x41\xcf\x5b\xd6\x7f\x94\x2\x41\xe0\x40\x22\x3\x5e\xd1\x53\xd4\x86\xd3\x2c\x9f\xf\x96\xe3\x6b\x9a\x76\x32\x6\x47\x4b\x11\xb3\xdd\x3\x65\xbd\x9b\x1\xda\x9c\xb9\x7e\x3f\x6a\xc4\x7b\xea\xd4\x3c\xb9\xfb\x5c\x6b\x64\x33\x52\xba\x64\x78\x8f\xa4\xaf\x7a\x61\x8d\xbc\xc5\x73\xe9\x6b\x58\x97\x4b\xbf\x63\x22\xd3\x37\x2\x54\xc5\xb9\x16\x4a\xf0\x19\xd8\x94\x57\xb8\x8a\xb3\x16\x3b\xd0\x84\x8e\x67\xa6\xa3\x7d\x78\xec\x0" ++} }; ++ ++static const struct chacha20poly1305_testvec xchacha20poly1305_enc_vectors[] __initconst = { { ++ .key = "\x1c\x92\x40\xa5\xeb\x55\xd3\x8a\xf3\x33\x88\x86\x04\xf6\xb5\xf0\x47\x39\x17\xc1\x40\x2b\x80\x09\x9d\xca\x5c\xbc\x20\x70\x75\xc0", ++ .nonce = "\x00\x01\x02\x03\x04\x05\x06\x07\x08\x09\x0a\x0b\x0c\x0d\x0e\x0f\x10\x11\x12\x13\x14\x15\x16\x17", ++ .assoc = "\xf3\x33\x88\x86\x00\x00\x00\x00\x00\x00\x4e\x91", ++ .alen = 12, ++ .input = "\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x72\x65\x20\x64\x72\x61\x66\x74\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x76\x61\x6c\x69\x64\x20\x66\x6f\x72\x20\x61\x20\x6d\x61\x78\x69\x6d\x75\x6d\x20\x6f\x66\x20\x73\x69\x78\x20\x6d\x6f\x6e\x74\x68\x73\x20\x61\x6e\x64\x20\x6d\x61\x79\x20\x62\x65\x20\x75\x70\x64\x61\x74\x65\x64\x2c\x20\x72\x65\x70\x6c\x61\x63\x65\x64\x2c\x20\x6f\x72\x20\x6f\x62\x73\x6f\x6c\x65\x74\x65\x64\x20\x62\x79\x20\x6f\x74\x68\x65\x72\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x61\x74\x20\x61\x6e\x79\x20\x74\x69\x6d\x65\x2e\x20\x49\x74\x20\x69\x73\x20\x69\x6e\x61\x70\x70\x72\x6f\x70\x72\x69\x61\x74\x65\x20\x74\x6f\x20\x75\x73\x65\x20\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x73\x20\x72\x65\x66\x65\x72\x65\x6e\x63\x65\x20\x6d\x61\x74\x65\x72\x69\x61\x6c\x20\x6f\x72\x20\x74\x6f\x20\x63\x69\x74\x65\x20\x74\x68\x65\x6d\x20\x6f\x74\x68\x65\x72\x20\x74\x68\x61\x6e\x20\x61\x73\x20\x2f\xe2\x80\x9c\x77\x6f\x72\x6b\x20\x69\x6e\x20\x70\x72\x6f\x67\x72\x65\x73\x73\x2e\x2f\xe2\x80\x9d", ++ .ilen = 265, ++ .result = "\x1a\x6e\x3a\xd9\xfd\x41\x3f\x77\x54\x72\x0a\x70\x9a\xa0\x29\x92\x2e\xed\x93\xcf\x0f\x71\x88\x18\x7a\x9d\x2d\x24\xe0\xf5\xea\x3d\x55\x64\xd7\xad\x2a\x1a\x1f\x7e\x86\x6d\xb0\xce\x80\x41\x72\x86\x26\xee\x84\xd7\xef\x82\x9e\xe2\x60\x9d\x5a\xfc\xf0\xe4\x19\x85\xea\x09\xc6\xfb\xb3\xa9\x50\x09\xec\x5e\x11\x90\xa1\xc5\x4e\x49\xef\x50\xd8\x8f\xe0\x78\xd7\xfd\xb9\x3b\xc9\xf2\x91\xc8\x25\xc8\xa7\x63\x60\xce\x10\xcd\xc6\x7f\xf8\x16\xf8\xe1\x0a\xd9\xde\x79\x50\x33\xf2\x16\x0f\x17\xba\xb8\x5d\xd8\xdf\x4e\x51\xa8\x39\xd0\x85\xca\x46\x6a\x10\xa7\xa3\x88\xef\x79\xb9\xf8\x24\xf3\xe0\x71\x7b\x76\x28\x46\x3a\x3a\x1b\x91\xb6\xd4\x3e\x23\xe5\x44\x15\xbf\x60\x43\x9d\xa4\xbb\xd5\x5f\x89\xeb\xef\x8e\xfd\xdd\xb4\x0d\x46\xf0\x69\x23\x63\xae\x94\xf5\x5e\xa5\xad\x13\x1c\x41\x76\xe6\x90\xd6\x6d\xa2\x8f\x97\x4c\xa8\x0b\xcf\x8d\x43\x2b\x9c\x9b\xc5\x58\xa5\xb6\x95\x9a\xbf\x81\xc6\x54\xc9\x66\x0c\xe5\x4f\x6a\x53\xa1\xe5\x0c\xba\x31\xde\x34\x64\x73\x8a\x3b\xbd\x92\x01\xdb\x71\x69\xf3\x58\x99\xbc\xd1\xcb\x4a\x05\xe2\x58\x9c\x25\x17\xcd\xdc\x83\xb7\xff\xfb\x09\x61\xad\xbf\x13\x5b\x5e\xed\x46\x82\x6f\x22\xd8\x93\xa6\x85\x5b\x40\x39\x5c\xc5\x9c" ++} }; ++static const struct chacha20poly1305_testvec xchacha20poly1305_dec_vectors[] __initconst = { { ++ .key = "\x1c\x92\x40\xa5\xeb\x55\xd3\x8a\xf3\x33\x88\x86\x04\xf6\xb5\xf0\x47\x39\x17\xc1\x40\x2b\x80\x09\x9d\xca\x5c\xbc\x20\x70\x75\xc0", ++ .nonce = "\x00\x01\x02\x03\x04\x05\x06\x07\x08\x09\x0a\x0b\x0c\x0d\x0e\x0f\x10\x11\x12\x13\x14\x15\x16\x17", ++ .assoc = "\xf3\x33\x88\x86\x00\x00\x00\x00\x00\x00\x4e\x91", ++ .alen = 12, ++ .input = "\x1a\x6e\x3a\xd9\xfd\x41\x3f\x77\x54\x72\x0a\x70\x9a\xa0\x29\x92\x2e\xed\x93\xcf\x0f\x71\x88\x18\x7a\x9d\x2d\x24\xe0\xf5\xea\x3d\x55\x64\xd7\xad\x2a\x1a\x1f\x7e\x86\x6d\xb0\xce\x80\x41\x72\x86\x26\xee\x84\xd7\xef\x82\x9e\xe2\x60\x9d\x5a\xfc\xf0\xe4\x19\x85\xea\x09\xc6\xfb\xb3\xa9\x50\x09\xec\x5e\x11\x90\xa1\xc5\x4e\x49\xef\x50\xd8\x8f\xe0\x78\xd7\xfd\xb9\x3b\xc9\xf2\x91\xc8\x25\xc8\xa7\x63\x60\xce\x10\xcd\xc6\x7f\xf8\x16\xf8\xe1\x0a\xd9\xde\x79\x50\x33\xf2\x16\x0f\x17\xba\xb8\x5d\xd8\xdf\x4e\x51\xa8\x39\xd0\x85\xca\x46\x6a\x10\xa7\xa3\x88\xef\x79\xb9\xf8\x24\xf3\xe0\x71\x7b\x76\x28\x46\x3a\x3a\x1b\x91\xb6\xd4\x3e\x23\xe5\x44\x15\xbf\x60\x43\x9d\xa4\xbb\xd5\x5f\x89\xeb\xef\x8e\xfd\xdd\xb4\x0d\x46\xf0\x69\x23\x63\xae\x94\xf5\x5e\xa5\xad\x13\x1c\x41\x76\xe6\x90\xd6\x6d\xa2\x8f\x97\x4c\xa8\x0b\xcf\x8d\x43\x2b\x9c\x9b\xc5\x58\xa5\xb6\x95\x9a\xbf\x81\xc6\x54\xc9\x66\x0c\xe5\x4f\x6a\x53\xa1\xe5\x0c\xba\x31\xde\x34\x64\x73\x8a\x3b\xbd\x92\x01\xdb\x71\x69\xf3\x58\x99\xbc\xd1\xcb\x4a\x05\xe2\x58\x9c\x25\x17\xcd\xdc\x83\xb7\xff\xfb\x09\x61\xad\xbf\x13\x5b\x5e\xed\x46\x82\x6f\x22\xd8\x93\xa6\x85\x5b\x40\x39\x5c\xc5\x9c", ++ .ilen = 281, ++ .result = "\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x72\x65\x20\x64\x72\x61\x66\x74\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x76\x61\x6c\x69\x64\x20\x66\x6f\x72\x20\x61\x20\x6d\x61\x78\x69\x6d\x75\x6d\x20\x6f\x66\x20\x73\x69\x78\x20\x6d\x6f\x6e\x74\x68\x73\x20\x61\x6e\x64\x20\x6d\x61\x79\x20\x62\x65\x20\x75\x70\x64\x61\x74\x65\x64\x2c\x20\x72\x65\x70\x6c\x61\x63\x65\x64\x2c\x20\x6f\x72\x20\x6f\x62\x73\x6f\x6c\x65\x74\x65\x64\x20\x62\x79\x20\x6f\x74\x68\x65\x72\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x61\x74\x20\x61\x6e\x79\x20\x74\x69\x6d\x65\x2e\x20\x49\x74\x20\x69\x73\x20\x69\x6e\x61\x70\x70\x72\x6f\x70\x72\x69\x61\x74\x65\x20\x74\x6f\x20\x75\x73\x65\x20\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x73\x20\x72\x65\x66\x65\x72\x65\x6e\x63\x65\x20\x6d\x61\x74\x65\x72\x69\x61\x6c\x20\x6f\x72\x20\x74\x6f\x20\x63\x69\x74\x65\x20\x74\x68\x65\x6d\x20\x6f\x74\x68\x65\x72\x20\x74\x68\x61\x6e\x20\x61\x73\x20\x2f\xe2\x80\x9c\x77\x6f\x72\x6b\x20\x69\x6e\x20\x70\x72\x6f\x67\x72\x65\x73\x73\x2e\x2f\xe2\x80\x9d" ++} }; ++ ++bool __init chacha20poly1305_selftest(void) ++{ ++ size_t i; ++ u8 computed_result[3000]; ++ bool success = true, ret; ++ ++ for (i = 0; i < ARRAY_SIZE(chacha20poly1305_enc_vectors); ++i) { ++ memset(computed_result, 0, sizeof(computed_result)); ++ chacha20poly1305_encrypt(computed_result, chacha20poly1305_enc_vectors[i].input, chacha20poly1305_enc_vectors[i].ilen, chacha20poly1305_enc_vectors[i].assoc, chacha20poly1305_enc_vectors[i].alen, le64_to_cpu(*(__force __le64 *)chacha20poly1305_enc_vectors[i].nonce), chacha20poly1305_enc_vectors[i].key); ++ if (memcmp(computed_result, chacha20poly1305_enc_vectors[i].result, chacha20poly1305_enc_vectors[i].ilen + POLY1305_MAC_SIZE)) { ++ pr_info("chacha20poly1305 encryption self-test %zu: FAIL\n", i + 1); ++ success = false; ++ } ++ } ++ for (i = 0; i < ARRAY_SIZE(chacha20poly1305_dec_vectors); ++i) { ++ memset(computed_result, 0, sizeof(computed_result)); ++ ret = chacha20poly1305_decrypt(computed_result, chacha20poly1305_dec_vectors[i].input, chacha20poly1305_dec_vectors[i].ilen, chacha20poly1305_dec_vectors[i].assoc, chacha20poly1305_dec_vectors[i].alen, le64_to_cpu(*(__force __le64 *)chacha20poly1305_dec_vectors[i].nonce), chacha20poly1305_dec_vectors[i].key); ++ if (!ret || memcmp(computed_result, chacha20poly1305_dec_vectors[i].result, chacha20poly1305_dec_vectors[i].ilen - POLY1305_MAC_SIZE)) { ++ pr_info("chacha20poly1305 decryption self-test %zu: FAIL\n", i + 1); ++ success = false; ++ } ++ } ++ for (i = 0; i < ARRAY_SIZE(xchacha20poly1305_enc_vectors); ++i) { ++ memset(computed_result, 0, sizeof(computed_result)); ++ xchacha20poly1305_encrypt(computed_result, xchacha20poly1305_enc_vectors[i].input, xchacha20poly1305_enc_vectors[i].ilen, xchacha20poly1305_enc_vectors[i].assoc, xchacha20poly1305_enc_vectors[i].alen, xchacha20poly1305_enc_vectors[i].nonce, xchacha20poly1305_enc_vectors[i].key); ++ if (memcmp(computed_result, xchacha20poly1305_enc_vectors[i].result, xchacha20poly1305_enc_vectors[i].ilen + POLY1305_MAC_SIZE)) { ++ pr_info("xchacha20poly1305 encryption self-test %zu: FAIL\n", i + 1); ++ success = false; ++ } ++ } ++ for (i = 0; i < ARRAY_SIZE(xchacha20poly1305_dec_vectors); ++i) { ++ memset(computed_result, 0, sizeof(computed_result)); ++ ret = xchacha20poly1305_decrypt(computed_result, xchacha20poly1305_dec_vectors[i].input, xchacha20poly1305_dec_vectors[i].ilen, xchacha20poly1305_dec_vectors[i].assoc, xchacha20poly1305_dec_vectors[i].alen, xchacha20poly1305_dec_vectors[i].nonce, xchacha20poly1305_dec_vectors[i].key); ++ if (!ret || memcmp(computed_result, xchacha20poly1305_dec_vectors[i].result, xchacha20poly1305_dec_vectors[i].ilen - POLY1305_MAC_SIZE)) { ++ pr_info("xchacha20poly1305 decryption self-test %zu: FAIL\n", i + 1); ++ success = false; ++ } ++ } ++ if (success) ++ pr_info("chacha20poly1305 self-tests: pass\n"); ++ return success; ++} ++#endif +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/selftest/counter.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,92 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifdef DEBUG ++bool __init packet_counter_selftest(void) ++{ ++ bool success = true; ++ unsigned int test_num = 0, i; ++ union noise_counter counter; ++ ++#define T_INIT do { memset(&counter, 0, sizeof(union noise_counter)); spin_lock_init(&counter.receive.lock); } while (0) ++#define T_LIM (COUNTER_WINDOW_SIZE + 1) ++#define T(n, v) do { ++test_num; if (counter_validate(&counter, n) != v) { pr_info("nonce counter self-test %u: FAIL\n", test_num); success = false; } } while (0) ++ T_INIT; ++ /* 1 */ T(0, true); ++ /* 2 */ T(1, true); ++ /* 3 */ T(1, false); ++ /* 4 */ T(9, true); ++ /* 5 */ T(8, true); ++ /* 6 */ T(7, true); ++ /* 7 */ T(7, false); ++ /* 8 */ T(T_LIM, true); ++ /* 9 */ T(T_LIM - 1, true); ++ /* 10 */ T(T_LIM - 1, false); ++ /* 11 */ T(T_LIM - 2, true); ++ /* 12 */ T(2, true); ++ /* 13 */ T(2, false); ++ /* 14 */ T(T_LIM + 16, true); ++ /* 15 */ T(3, false); ++ /* 16 */ T(T_LIM + 16, false); ++ /* 17 */ T(T_LIM * 4, true); ++ /* 18 */ T(T_LIM * 4 - (T_LIM - 1), true); ++ /* 19 */ T(10, false); ++ /* 20 */ T(T_LIM * 4 - T_LIM, false); ++ /* 21 */ T(T_LIM * 4 - (T_LIM + 1), false); ++ /* 22 */ T(T_LIM * 4 - (T_LIM - 2), true); ++ /* 23 */ T(T_LIM * 4 + 1 - T_LIM, false); ++ /* 24 */ T(0, false); ++ /* 25 */ T(REJECT_AFTER_MESSAGES, false); ++ /* 26 */ T(REJECT_AFTER_MESSAGES - 1, true); ++ /* 27 */ T(REJECT_AFTER_MESSAGES, false); ++ /* 28 */ T(REJECT_AFTER_MESSAGES - 1, false); ++ /* 29 */ T(REJECT_AFTER_MESSAGES - 2, true); ++ /* 30 */ T(REJECT_AFTER_MESSAGES + 1, false); ++ /* 31 */ T(REJECT_AFTER_MESSAGES + 2, false); ++ /* 32 */ T(REJECT_AFTER_MESSAGES - 2, false); ++ /* 33 */ T(REJECT_AFTER_MESSAGES - 3, true); ++ /* 34 */ T(0, false); ++ ++ T_INIT; ++ for (i = 1; i <= COUNTER_WINDOW_SIZE; ++i) ++ T(i, true); ++ T(0, true); ++ T(0, false); ++ ++ T_INIT; ++ for (i = 2; i <= COUNTER_WINDOW_SIZE + 1; ++i) ++ T(i, true); ++ T(1, true); ++ T(0, false); ++ ++ T_INIT; ++ for (i = COUNTER_WINDOW_SIZE + 1; i-- > 0 ;) ++ T(i, true); ++ ++ T_INIT; ++ for (i = COUNTER_WINDOW_SIZE + 2; i-- > 1 ;) ++ T(i, true); ++ T(0, false); ++ ++ T_INIT; ++ for (i = COUNTER_WINDOW_SIZE + 1; i-- > 1 ;) ++ T(i, true); ++ T(COUNTER_WINDOW_SIZE + 1, true); ++ T(0, false); ++ ++ T_INIT; ++ for (i = COUNTER_WINDOW_SIZE + 1; i-- > 1 ;) ++ T(i, true); ++ T(0, true); ++ T(COUNTER_WINDOW_SIZE + 1, true); ++#undef T ++#undef T_LIM ++#undef T_INIT ++ ++ if (success) ++ pr_info("nonce counter self-tests: pass\n"); ++ return success; ++} ++#endif +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/selftest/curve25519.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,103 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifdef DEBUG ++struct curve25519_test_vector { ++ u8 private[CURVE25519_POINT_SIZE]; ++ u8 public[CURVE25519_POINT_SIZE]; ++ u8 result[CURVE25519_POINT_SIZE]; ++ bool valid; ++}; ++static const struct curve25519_test_vector curve25519_test_vectors[] __initconst = { ++ { ++ .private = { 0x77, 0x07, 0x6d, 0x0a, 0x73, 0x18, 0xa5, 0x7d, 0x3c, 0x16, 0xc1, 0x72, 0x51, 0xb2, 0x66, 0x45, 0xdf, 0x4c, 0x2f, 0x87, 0xeb, 0xc0, 0x99, 0x2a, 0xb1, 0x77, 0xfb, 0xa5, 0x1d, 0xb9, 0x2c, 0x2a }, ++ .public = { 0xde, 0x9e, 0xdb, 0x7d, 0x7b, 0x7d, 0xc1, 0xb4, 0xd3, 0x5b, 0x61, 0xc2, 0xec, 0xe4, 0x35, 0x37, 0x3f, 0x83, 0x43, 0xc8, 0x5b, 0x78, 0x67, 0x4d, 0xad, 0xfc, 0x7e, 0x14, 0x6f, 0x88, 0x2b, 0x4f }, ++ .result = { 0x4a, 0x5d, 0x9d, 0x5b, 0xa4, 0xce, 0x2d, 0xe1, 0x72, 0x8e, 0x3b, 0xf4, 0x80, 0x35, 0x0f, 0x25, 0xe0, 0x7e, 0x21, 0xc9, 0x47, 0xd1, 0x9e, 0x33, 0x76, 0xf0, 0x9b, 0x3c, 0x1e, 0x16, 0x17, 0x42 }, ++ .valid = true ++ }, ++ { ++ .private = { 0x5d, 0xab, 0x08, 0x7e, 0x62, 0x4a, 0x8a, 0x4b, 0x79, 0xe1, 0x7f, 0x8b, 0x83, 0x80, 0x0e, 0xe6, 0x6f, 0x3b, 0xb1, 0x29, 0x26, 0x18, 0xb6, 0xfd, 0x1c, 0x2f, 0x8b, 0x27, 0xff, 0x88, 0xe0, 0xeb }, ++ .public = { 0x85, 0x20, 0xf0, 0x09, 0x89, 0x30, 0xa7, 0x54, 0x74, 0x8b, 0x7d, 0xdc, 0xb4, 0x3e, 0xf7, 0x5a, 0x0d, 0xbf, 0x3a, 0x0d, 0x26, 0x38, 0x1a, 0xf4, 0xeb, 0xa4, 0xa9, 0x8e, 0xaa, 0x9b, 0x4e, 0x6a }, ++ .result = { 0x4a, 0x5d, 0x9d, 0x5b, 0xa4, 0xce, 0x2d, 0xe1, 0x72, 0x8e, 0x3b, 0xf4, 0x80, 0x35, 0x0f, 0x25, 0xe0, 0x7e, 0x21, 0xc9, 0x47, 0xd1, 0x9e, 0x33, 0x76, 0xf0, 0x9b, 0x3c, 0x1e, 0x16, 0x17, 0x42 }, ++ .valid = true ++ }, ++ { ++ .private = { 1 }, ++ .public = { 0x25, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }, ++ .result = { 0x3c, 0x77, 0x77, 0xca, 0xf9, 0x97, 0xb2, 0x64, 0x41, 0x60, 0x77, 0x66, 0x5b, 0x4e, 0x22, 0x9d, 0xb, 0x95, 0x48, 0xdc, 0xc, 0xd8, 0x19, 0x98, 0xdd, 0xcd, 0xc5, 0xc8, 0x53, 0x3c, 0x79, 0x7f }, ++ .valid = true ++ }, ++ { ++ .private = { 1 }, ++ .public = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }, ++ .result = { 0xb3, 0x2d, 0x13, 0x62, 0xc2, 0x48, 0xd6, 0x2f, 0xe6, 0x26, 0x19, 0xcf, 0xf0, 0x4d, 0xd4, 0x3d, 0xb7, 0x3f, 0xfc, 0x1b, 0x63, 0x8, 0xed, 0xe3, 0xb, 0x78, 0xd8, 0x73, 0x80, 0xf1, 0xe8, 0x34 }, ++ .valid = true ++ }, ++ { ++ .private = { 0xa5, 0x46, 0xe3, 0x6b, 0xf0, 0x52, 0x7c, 0x9d, 0x3b, 0x16, 0x15, 0x4b, 0x82, 0x46, 0x5e, 0xdd, 0x62, 0x14, 0x4c, 0x0a, 0xc1, 0xfc, 0x5a, 0x18, 0x50, 0x6a, 0x22, 0x44, 0xba, 0x44, 0x9a, 0xc4 }, ++ .public = { 0xe6, 0xdb, 0x68, 0x67, 0x58, 0x30, 0x30, 0xdb, 0x35, 0x94, 0xc1, 0xa4, 0x24, 0xb1, 0x5f, 0x7c, 0x72, 0x66, 0x24, 0xec, 0x26, 0xb3, 0x35, 0x3b, 0x10, 0xa9, 0x03, 0xa6, 0xd0, 0xab, 0x1c, 0x4c }, ++ .result = { 0xc3, 0xda, 0x55, 0x37, 0x9d, 0xe9, 0xc6, 0x90, 0x8e, 0x94, 0xea, 0x4d, 0xf2, 0x8d, 0x08, 0x4f, 0x32, 0xec, 0xcf, 0x03, 0x49, 0x1c, 0x71, 0xf7, 0x54, 0xb4, 0x07, 0x55, 0x77, 0xa2, 0x85, 0x52 }, ++ .valid = true ++ }, ++ { ++ .private = { 1, 2, 3, 4 }, ++ .public = { 0 }, ++ .result = { 0 }, ++ .valid = false ++ }, ++ { ++ .private = { 2, 4, 6, 8 }, ++ .public = { 0xe0, 0xeb, 0x7a, 0x7c, 0x3b, 0x41, 0xb8, 0xae, 0x16, 0x56, 0xe3, 0xfa, 0xf1, 0x9f, 0xc4, 0x6a, 0xda, 0x09, 0x8d, 0xeb, 0x9c, 0x32, 0xb1, 0xfd, 0x86, 0x62, 0x05, 0x16, 0x5f, 0x49, 0xb8 }, ++ .result = { 0 }, ++ .valid = false ++ }, ++ { ++ .private = { 0xff, 0xff, 0xff, 0xff, 0x0a, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }, ++ .public = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x0a, 0x00, 0xfb, 0x9f }, ++ .result = { 0x77, 0x52, 0xb6, 0x18, 0xc1, 0x2d, 0x48, 0xd2, 0xc6, 0x93, 0x46, 0x83, 0x81, 0x7c, 0xc6, 0x57, 0xf3, 0x31, 0x03, 0x19, 0x49, 0x48, 0x20, 0x05, 0x42, 0x2b, 0x4e, 0xae, 0x8d, 0x1d, 0x43, 0x23 }, ++ .valid = true ++ }, ++ { ++ .private = { 0x8e, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }, ++ .public = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x8e, 0x06 }, ++ .result = { 0x5a, 0xdf, 0xaa, 0x25, 0x86, 0x8e, 0x32, 0x3d, 0xae, 0x49, 0x62, 0xc1, 0x01, 0x5c, 0xb3, 0x12, 0xe1, 0xc5, 0xc7, 0x9e, 0x95, 0x3f, 0x03, 0x99, 0xb0, 0xba, 0x16, 0x22, 0xf3, 0xb6, 0xf7, 0x0c }, ++ .valid = true ++ } ++}; ++bool __init curve25519_selftest(void) ++{ ++ bool success = true, ret, ret2; ++ size_t i = 0, j; ++ u8 in[CURVE25519_POINT_SIZE], out[CURVE25519_POINT_SIZE], out2[CURVE25519_POINT_SIZE]; ++ ++ for (i = 0; i < ARRAY_SIZE(curve25519_test_vectors); ++i) { ++ memset(out, 0, CURVE25519_POINT_SIZE); ++ ret = curve25519(out, curve25519_test_vectors[i].private, curve25519_test_vectors[i].public); ++ if (ret != curve25519_test_vectors[i].valid || memcmp(out, curve25519_test_vectors[i].result, CURVE25519_POINT_SIZE)) { ++ pr_info("curve25519 self-test %zu: FAIL\n", i + 1); ++ success = false; ++ break; ++ } ++ } ++ ++ for (i = 0; i < 5; ++i) { ++ get_random_bytes(in, sizeof(in)); ++ ret = curve25519_generate_public(out, in); ++ ret2 = curve25519(out2, in, (u8[CURVE25519_POINT_SIZE]){ 9 }); ++ if (ret != ret2 || memcmp(out, out2, CURVE25519_POINT_SIZE)) { ++ pr_info("curve25519 basepoint self-test %zu: FAIL: input - 0x", i + 1); ++ for (j = CURVE25519_POINT_SIZE; j-- > 0;) ++ printk(KERN_CONT "%02x", in[j]); ++ printk(KERN_CONT "\n"); ++ success = false; ++ break; ++ } ++ } ++ ++ if (success) ++ pr_info("curve25519 self-tests: pass\n"); ++ return success; ++} ++#endif +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/selftest/poly1305.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,1566 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * Copyright (C) 2016-2017 The OpenSSL Project Authors. All Rights Reserved. ++ */ ++ ++#ifdef DEBUG ++ ++struct poly1305_testdata { ++ size_t size; ++ const u8 data[1024]; ++}; ++ ++struct poly1305_testvec { ++ struct poly1305_testdata input, key, expected; ++}; ++ ++static const struct poly1305_testvec poly1305_testvecs[] = { ++ /* ++ * RFC7539 ++ */ ++ { ++ { ++ 34, ++ { ++ 0x43, 0x72, 0x79, 0x70, 0x74, 0x6f, 0x67, 0x72, ++ 0x61, 0x70, 0x68, 0x69, 0x63, 0x20, 0x46, 0x6f, ++ 0x72, 0x75, 0x6d, 0x20, 0x52, 0x65, 0x73, 0x65, ++ 0x61, 0x72, 0x63, 0x68, 0x20, 0x47, 0x72, 0x6f, ++ ++ 0x75, 0x70 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x85, 0xd6, 0xbe, 0x78, 0x57, 0x55, 0x6d, 0x33, ++ 0x7f, 0x44, 0x52, 0xfe, 0x42, 0xd5, 0x06, 0xa8, ++ 0x01, 0x03, 0x80, 0x8a, 0xfb, 0x0d, 0xb2, 0xfd, ++ 0x4a, 0xbf, 0xf6, 0xaf, 0x41, 0x49, 0xf5, 0x1b ++ } ++ }, ++ { ++ 16, ++ { ++ 0xa8, 0x06, 0x1d, 0xc1, 0x30, 0x51, 0x36, 0xc6, ++ 0xc2, 0x2b, 0x8b, 0xaf, 0x0c, 0x01, 0x27, 0xa9 ++ } ++ } ++ }, ++ /* ++ * test vectors from "The Poly1305-AES message-authentication code" ++ */ ++ { ++ { ++ 2, ++ { ++ 0xf3, 0xf6 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x85, 0x1f, 0xc4, 0x0c, 0x34, 0x67, 0xac, 0x0b, ++ 0xe0, 0x5c, 0xc2, 0x04, 0x04, 0xf3, 0xf7, 0x00, ++ 0x58, 0x0b, 0x3b, 0x0f, 0x94, 0x47, 0xbb, 0x1e, ++ 0x69, 0xd0, 0x95, 0xb5, 0x92, 0x8b, 0x6d, 0xbc ++ } ++ }, ++ { ++ 16, ++ { ++ 0xf4, 0xc6, 0x33, 0xc3, 0x04, 0x4f, 0xc1, 0x45, ++ 0xf8, 0x4f, 0x33, 0x5c, 0xb8, 0x19, 0x53, 0xde ++ } ++ } ++ }, ++ { ++ { ++ 0, ++ { ++ 0 ++ } ++ }, ++ { ++ 32, ++ { ++ 0xa0, 0xf3, 0x08, 0x00, 0x00, 0xf4, 0x64, 0x00, ++ 0xd0, 0xc7, 0xe9, 0x07, 0x6c, 0x83, 0x44, 0x03, ++ 0xdd, 0x3f, 0xab, 0x22, 0x51, 0xf1, 0x1a, 0xc7, ++ 0x59, 0xf0, 0x88, 0x71, 0x29, 0xcc, 0x2e, 0xe7 ++ } ++ }, ++ { ++ 16, ++ { ++ 0xdd, 0x3f, 0xab, 0x22, 0x51, 0xf1, 0x1a, 0xc7, ++ 0x59, 0xf0, 0x88, 0x71, 0x29, 0xcc, 0x2e, 0xe7 ++ } ++ } ++ }, ++ { ++ { ++ 32, ++ { ++ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, ++ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, ++ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, ++ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, ++ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, ++ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, ++ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef ++ } ++ }, ++ { ++ 16, ++ { ++ 0x0e, 0xe1, 0xc1, 0x6b, 0xb7, 0x3f, 0x0f, 0x4f, ++ 0xd1, 0x98, 0x81, 0x75, 0x3c, 0x01, 0xcd, 0xbe ++ } ++ } ++ }, ++ { ++ { ++ 63, ++ { ++ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, ++ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, ++ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, ++ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, ++ ++ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, ++ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, ++ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, ++ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, ++ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, ++ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, ++ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 ++ } ++ }, ++ { ++ 16, ++ { ++ 0x51, 0x54, 0xad, 0x0d, 0x2c, 0xb2, 0x6e, 0x01, ++ 0x27, 0x4f, 0xc5, 0x11, 0x48, 0x49, 0x1f, 0x1b ++ } ++ }, ++ }, ++ /* ++ * self-generated vectors exercise "significant" lengths, such that ++ * are handled by different code paths ++ */ ++ { ++ { ++ 64, ++ { ++ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, ++ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, ++ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, ++ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, ++ ++ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, ++ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, ++ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, ++ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf ++ } ++ }, ++ { ++ 32, ++ { ++ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, ++ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, ++ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, ++ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 ++ } ++ }, ++ { ++ 16, ++ { ++ 0x81, 0x20, 0x59, 0xa5, 0xda, 0x19, 0x86, 0x37, ++ 0xca, 0xc7, 0xc4, 0xa6, 0x31, 0xbe, 0xe4, 0x66 ++ } ++ }, ++ }, ++ { ++ { ++ 48, ++ { ++ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, ++ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, ++ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, ++ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, ++ ++ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, ++ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, ++ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, ++ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, ++ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 ++ ++ } ++ }, ++ { ++ 16, ++ { ++ 0x5b, 0x88, 0xd7, 0xf6, 0x22, 0x8b, 0x11, 0xe2, ++ 0xe2, 0x85, 0x79, 0xa5, 0xc0, 0xc1, 0xf7, 0x61 ++ } ++ }, ++ }, ++ { ++ { ++ 96, ++ { ++ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, ++ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, ++ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, ++ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, ++ ++ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, ++ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, ++ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, ++ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, ++ ++ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, ++ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, ++ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, ++ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, ++ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, ++ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, ++ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 ++ } ++ }, ++ { ++ 16, ++ { ++ 0xbb, 0xb6, 0x13, 0xb2, 0xb6, 0xd7, 0x53, 0xba, ++ 0x07, 0x39, 0x5b, 0x91, 0x6a, 0xae, 0xce, 0x15 ++ } ++ }, ++ }, ++ { ++ { ++ 112, ++ { ++ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, ++ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, ++ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, ++ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, ++ ++ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, ++ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, ++ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, ++ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, ++ ++ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, ++ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, ++ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, ++ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, ++ ++ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, ++ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, ++ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, ++ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, ++ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 ++ } ++ }, ++ { ++ 16, ++ { ++ 0xc7, 0x94, 0xd7, 0x05, 0x7d, 0x17, 0x78, 0xc4, ++ 0xbb, 0xee, 0x0a, 0x39, 0xb3, 0xd9, 0x73, 0x42 ++ } ++ }, ++ }, ++ { ++ { ++ 128, ++ { ++ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, ++ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, ++ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, ++ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, ++ ++ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, ++ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, ++ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, ++ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, ++ ++ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, ++ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, ++ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, ++ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, ++ ++ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, ++ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, ++ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, ++ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, ++ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, ++ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, ++ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 ++ } ++ }, ++ { ++ 16, ++ { ++ 0xff, 0xbc, 0xb9, 0xb3, 0x71, 0x42, 0x31, 0x52, ++ 0xd7, 0xfc, 0xa5, 0xad, 0x04, 0x2f, 0xba, 0xa9 ++ } ++ }, ++ }, ++ { ++ { ++ 144, ++ { ++ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, ++ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, ++ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, ++ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, ++ ++ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, ++ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, ++ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, ++ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, ++ ++ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, ++ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, ++ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, ++ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, ++ ++ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, ++ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, ++ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, ++ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36, ++ ++ 0x81, 0x20, 0x59, 0xa5, 0xda, 0x19, 0x86, 0x37, ++ 0xca, 0xc7, 0xc4, 0xa6, 0x31, 0xbe, 0xe4, 0x66 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, ++ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, ++ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, ++ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 ++ } ++ }, ++ { ++ 16, ++ { ++ 0x06, 0x9e, 0xd6, 0xb8, 0xef, 0x0f, 0x20, 0x7b, ++ 0x3e, 0x24, 0x3b, 0xb1, 0x01, 0x9f, 0xe6, 0x32 ++ } ++ }, ++ }, ++ { ++ { ++ 160, ++ { ++ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, ++ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, ++ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, ++ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, ++ ++ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, ++ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, ++ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, ++ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, ++ ++ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, ++ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, ++ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, ++ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, ++ ++ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, ++ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, ++ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, ++ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36, ++ ++ 0x81, 0x20, 0x59, 0xa5, 0xda, 0x19, 0x86, 0x37, ++ 0xca, 0xc7, 0xc4, 0xa6, 0x31, 0xbe, 0xe4, 0x66, ++ 0x5b, 0x88, 0xd7, 0xf6, 0x22, 0x8b, 0x11, 0xe2, ++ 0xe2, 0x85, 0x79, 0xa5, 0xc0, 0xc1, 0xf7, 0x61 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, ++ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, ++ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, ++ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 ++ } ++ }, ++ { ++ 16, ++ { ++ 0xcc, 0xa3, 0x39, 0xd9, 0xa4, 0x5f, 0xa2, 0x36, ++ 0x8c, 0x2c, 0x68, 0xb3, 0xa4, 0x17, 0x91, 0x33 ++ } ++ }, ++ }, ++ { ++ { ++ 288, ++ { ++ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, ++ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, ++ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, ++ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, ++ ++ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, ++ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, ++ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, ++ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, ++ ++ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, ++ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, ++ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, ++ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, ++ ++ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, ++ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, ++ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, ++ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36, ++ ++ 0x81, 0x20, 0x59, 0xa5, 0xda, 0x19, 0x86, 0x37, ++ 0xca, 0xc7, 0xc4, 0xa6, 0x31, 0xbe, 0xe4, 0x66, ++ 0x5b, 0x88, 0xd7, 0xf6, 0x22, 0x8b, 0x11, 0xe2, ++ 0xe2, 0x85, 0x79, 0xa5, 0xc0, 0xc1, 0xf7, 0x61, ++ ++ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, ++ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, ++ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, ++ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, ++ ++ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, ++ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, ++ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, ++ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, ++ ++ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, ++ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, ++ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, ++ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, ++ ++ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, ++ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, ++ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, ++ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, ++ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, ++ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, ++ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 ++ } ++ }, ++ { ++ 16, ++ { ++ 0x53, 0xf6, 0xe8, 0x28, 0xa2, 0xf0, 0xfe, 0x0e, ++ 0xe8, 0x15, 0xbf, 0x0b, 0xd5, 0x84, 0x1a, 0x34 ++ } ++ }, ++ }, ++ { ++ { ++ 320, ++ { ++ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, ++ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, ++ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, ++ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, ++ ++ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, ++ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, ++ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, ++ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, ++ ++ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, ++ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, ++ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, ++ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, ++ ++ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, ++ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, ++ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, ++ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36, ++ ++ 0x81, 0x20, 0x59, 0xa5, 0xda, 0x19, 0x86, 0x37, ++ 0xca, 0xc7, 0xc4, 0xa6, 0x31, 0xbe, 0xe4, 0x66, ++ 0x5b, 0x88, 0xd7, 0xf6, 0x22, 0x8b, 0x11, 0xe2, ++ 0xe2, 0x85, 0x79, 0xa5, 0xc0, 0xc1, 0xf7, 0x61, ++ ++ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, ++ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, ++ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, ++ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, ++ ++ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, ++ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, ++ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, ++ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, ++ ++ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, ++ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, ++ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, ++ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, ++ ++ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, ++ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, ++ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, ++ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36, ++ ++ 0x81, 0x20, 0x59, 0xa5, 0xda, 0x19, 0x86, 0x37, ++ 0xca, 0xc7, 0xc4, 0xa6, 0x31, 0xbe, 0xe4, 0x66, ++ 0x5b, 0x88, 0xd7, 0xf6, 0x22, 0x8b, 0x11, 0xe2, ++ 0xe2, 0x85, 0x79, 0xa5, 0xc0, 0xc1, 0xf7, 0x61 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, ++ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, ++ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, ++ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 ++ } ++ }, ++ { ++ 16, ++ { ++ 0xb8, 0x46, 0xd4, 0x4e, 0x9b, 0xbd, 0x53, 0xce, ++ 0xdf, 0xfb, 0xfb, 0xb6, 0xb7, 0xfa, 0x49, 0x33 ++ } ++ }, ++ }, ++ /* ++ * 4th power of the key spills to 131th bit in SIMD key setup ++ */ ++ { ++ { ++ 256, ++ { ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff ++ } ++ }, ++ { ++ 32, ++ { ++ 0xad, 0x62, 0x81, 0x07, 0xe8, 0x35, 0x1d, 0x0f, ++ 0x2c, 0x23, 0x1a, 0x05, 0xdc, 0x4a, 0x41, 0x06, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ { ++ 16, ++ { ++ 0x07, 0x14, 0x5a, 0x4c, 0x02, 0xfe, 0x5f, 0xa3, ++ 0x20, 0x36, 0xde, 0x68, 0xfa, 0xbe, 0x90, 0x66 ++ } ++ }, ++ }, ++ /* ++ * OpenSSL's poly1305_ieee754.c failed this in final stage ++ */ ++ { ++ { ++ 252, ++ { ++ 0x84, 0x23, 0x64, 0xe1, 0x56, 0x33, 0x6c, 0x09, ++ 0x98, 0xb9, 0x33, 0xa6, 0x23, 0x77, 0x26, 0x18, ++ 0x0d, 0x9e, 0x3f, 0xdc, 0xbd, 0xe4, 0xcd, 0x5d, ++ 0x17, 0x08, 0x0f, 0xc3, 0xbe, 0xb4, 0x96, 0x14, ++ ++ 0xd7, 0x12, 0x2c, 0x03, 0x74, 0x63, 0xff, 0x10, ++ 0x4d, 0x73, 0xf1, 0x9c, 0x12, 0x70, 0x46, 0x28, ++ 0xd4, 0x17, 0xc4, 0xc5, 0x4a, 0x3f, 0xe3, 0x0d, ++ 0x3c, 0x3d, 0x77, 0x14, 0x38, 0x2d, 0x43, 0xb0, ++ ++ 0x38, 0x2a, 0x50, 0xa5, 0xde, 0xe5, 0x4b, 0xe8, ++ 0x44, 0xb0, 0x76, 0xe8, 0xdf, 0x88, 0x20, 0x1a, ++ 0x1c, 0xd4, 0x3b, 0x90, 0xeb, 0x21, 0x64, 0x3f, ++ 0xa9, 0x6f, 0x39, 0xb5, 0x18, 0xaa, 0x83, 0x40, ++ ++ 0xc9, 0x42, 0xff, 0x3c, 0x31, 0xba, 0xf7, 0xc9, ++ 0xbd, 0xbf, 0x0f, 0x31, 0xae, 0x3f, 0xa0, 0x96, ++ 0xbf, 0x8c, 0x63, 0x03, 0x06, 0x09, 0x82, 0x9f, ++ 0xe7, 0x2e, 0x17, 0x98, 0x24, 0x89, 0x0b, 0xc8, ++ ++ 0xe0, 0x8c, 0x31, 0x5c, 0x1c, 0xce, 0x2a, 0x83, ++ 0x14, 0x4d, 0xbb, 0xff, 0x09, 0xf7, 0x4e, 0x3e, ++ 0xfc, 0x77, 0x0b, 0x54, 0xd0, 0x98, 0x4a, 0x8f, ++ 0x19, 0xb1, 0x47, 0x19, 0xe6, 0x36, 0x35, 0x64, ++ ++ 0x1d, 0x6b, 0x1e, 0xed, 0xf6, 0x3e, 0xfb, 0xf0, ++ 0x80, 0xe1, 0x78, 0x3d, 0x32, 0x44, 0x54, 0x12, ++ 0x11, 0x4c, 0x20, 0xde, 0x0b, 0x83, 0x7a, 0x0d, ++ 0xfa, 0x33, 0xd6, 0xb8, 0x28, 0x25, 0xff, 0xf4, ++ ++ 0x4c, 0x9a, 0x70, 0xea, 0x54, 0xce, 0x47, 0xf0, ++ 0x7d, 0xf6, 0x98, 0xe6, 0xb0, 0x33, 0x23, 0xb5, ++ 0x30, 0x79, 0x36, 0x4a, 0x5f, 0xc3, 0xe9, 0xdd, ++ 0x03, 0x43, 0x92, 0xbd, 0xde, 0x86, 0xdc, 0xcd, ++ ++ 0xda, 0x94, 0x32, 0x1c, 0x5e, 0x44, 0x06, 0x04, ++ 0x89, 0x33, 0x6c, 0xb6, 0x5b, 0xf3, 0x98, 0x9c, ++ 0x36, 0xf7, 0x28, 0x2c, 0x2f, 0x5d, 0x2b, 0x88, ++ 0x2c, 0x17, 0x1e, 0x74 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x95, 0xd5, 0xc0, 0x05, 0x50, 0x3e, 0x51, 0x0d, ++ 0x8c, 0xd0, 0xaa, 0x07, 0x2c, 0x4a, 0x4d, 0x06, ++ 0x6e, 0xab, 0xc5, 0x2d, 0x11, 0x65, 0x3d, 0xf4, ++ 0x7f, 0xbf, 0x63, 0xab, 0x19, 0x8b, 0xcc, 0x26 ++ } ++ }, ++ { ++ 16, ++ { ++ 0xf2, 0x48, 0x31, 0x2e, 0x57, 0x8d, 0x9d, 0x58, ++ 0xf8, 0xb7, 0xbb, 0x4d, 0x19, 0x10, 0x54, 0x31 ++ } ++ }, ++ }, ++ /* ++ * AVX2 in OpenSSL's poly1305-x86.pl failed this with 176+32 split ++ */ ++ { ++ { ++ 208, ++ { ++ 0x24, 0x8a, 0xc3, 0x10, 0x85, 0xb6, 0xc2, 0xad, ++ 0xaa, 0xa3, 0x82, 0x59, 0xa0, 0xd7, 0x19, 0x2c, ++ 0x5c, 0x35, 0xd1, 0xbb, 0x4e, 0xf3, 0x9a, 0xd9, ++ 0x4c, 0x38, 0xd1, 0xc8, 0x24, 0x79, 0xe2, 0xdd, ++ ++ 0x21, 0x59, 0xa0, 0x77, 0x02, 0x4b, 0x05, 0x89, ++ 0xbc, 0x8a, 0x20, 0x10, 0x1b, 0x50, 0x6f, 0x0a, ++ 0x1a, 0xd0, 0xbb, 0xab, 0x76, 0xe8, 0x3a, 0x83, ++ 0xf1, 0xb9, 0x4b, 0xe6, 0xbe, 0xae, 0x74, 0xe8, ++ ++ 0x74, 0xca, 0xb6, 0x92, 0xc5, 0x96, 0x3a, 0x75, ++ 0x43, 0x6b, 0x77, 0x61, 0x21, 0xec, 0x9f, 0x62, ++ 0x39, 0x9a, 0x3e, 0x66, 0xb2, 0xd2, 0x27, 0x07, ++ 0xda, 0xe8, 0x19, 0x33, 0xb6, 0x27, 0x7f, 0x3c, ++ ++ 0x85, 0x16, 0xbc, 0xbe, 0x26, 0xdb, 0xbd, 0x86, ++ 0xf3, 0x73, 0x10, 0x3d, 0x7c, 0xf4, 0xca, 0xd1, ++ 0x88, 0x8c, 0x95, 0x21, 0x18, 0xfb, 0xfb, 0xd0, ++ 0xd7, 0xb4, 0xbe, 0xdc, 0x4a, 0xe4, 0x93, 0x6a, ++ ++ 0xff, 0x91, 0x15, 0x7e, 0x7a, 0xa4, 0x7c, 0x54, ++ 0x44, 0x2e, 0xa7, 0x8d, 0x6a, 0xc2, 0x51, 0xd3, ++ 0x24, 0xa0, 0xfb, 0xe4, 0x9d, 0x89, 0xcc, 0x35, ++ 0x21, 0xb6, 0x6d, 0x16, 0xe9, 0xc6, 0x6a, 0x37, ++ ++ 0x09, 0x89, 0x4e, 0x4e, 0xb0, 0xa4, 0xee, 0xdc, ++ 0x4a, 0xe1, 0x94, 0x68, 0xe6, 0x6b, 0x81, 0xf2, ++ ++ 0x71, 0x35, 0x1b, 0x1d, 0x92, 0x1e, 0xa5, 0x51, ++ 0x04, 0x7a, 0xbc, 0xc6, 0xb8, 0x7a, 0x90, 0x1f, ++ 0xde, 0x7d, 0xb7, 0x9f, 0xa1, 0x81, 0x8c, 0x11, ++ 0x33, 0x6d, 0xbc, 0x07, 0x24, 0x4a, 0x40, 0xeb ++ } ++ }, ++ { ++ 32, ++ { ++ 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, ++ 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ { ++ 16, ++ { ++ 0xbc, 0x93, 0x9b, 0xc5, 0x28, 0x14, 0x80, 0xfa, ++ 0x99, 0xc6, 0xd6, 0x8c, 0x25, 0x8e, 0xc4, 0x2f ++ } ++ }, ++ }, ++ /* ++ * test vectors from Google ++ */ ++ { ++ { ++ 0, ++ { ++ 0x00, ++ } ++ }, ++ { ++ 32, ++ { ++ 0xc8, 0xaf, 0xaa, 0xc3, 0x31, 0xee, 0x37, 0x2c, ++ 0xd6, 0x08, 0x2d, 0xe1, 0x34, 0x94, 0x3b, 0x17, ++ 0x47, 0x10, 0x13, 0x0e, 0x9f, 0x6f, 0xea, 0x8d, ++ 0x72, 0x29, 0x38, 0x50, 0xa6, 0x67, 0xd8, 0x6c ++ } ++ }, ++ { ++ 16, ++ { ++ 0x47, 0x10, 0x13, 0x0e, 0x9f, 0x6f, 0xea, 0x8d, ++ 0x72, 0x29, 0x38, 0x50, 0xa6, 0x67, 0xd8, 0x6c ++ } ++ }, ++ }, ++ { ++ { ++ 12, ++ { ++ 0x48, 0x65, 0x6c, 0x6c, 0x6f, 0x20, 0x77, 0x6f, ++ 0x72, 0x6c, 0x64, 0x21 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x74, 0x68, 0x69, 0x73, 0x20, 0x69, 0x73, 0x20, ++ 0x33, 0x32, 0x2d, 0x62, 0x79, 0x74, 0x65, 0x20, ++ 0x6b, 0x65, 0x79, 0x20, 0x66, 0x6f, 0x72, 0x20, ++ 0x50, 0x6f, 0x6c, 0x79, 0x31, 0x33, 0x30, 0x35 ++ } ++ }, ++ { ++ 16, ++ { ++ 0xa6, 0xf7, 0x45, 0x00, 0x8f, 0x81, 0xc9, 0x16, ++ 0xa2, 0x0d, 0xcc, 0x74, 0xee, 0xf2, 0xb2, 0xf0 ++ } ++ }, ++ }, ++ { ++ { ++ 32, ++ { ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x74, 0x68, 0x69, 0x73, 0x20, 0x69, 0x73, 0x20, ++ 0x33, 0x32, 0x2d, 0x62, 0x79, 0x74, 0x65, 0x20, ++ 0x6b, 0x65, 0x79, 0x20, 0x66, 0x6f, 0x72, 0x20, ++ 0x50, 0x6f, 0x6c, 0x79, 0x31, 0x33, 0x30, 0x35 ++ } ++ }, ++ { ++ 16, ++ { ++ 0x49, 0xec, 0x78, 0x09, 0x0e, 0x48, 0x1e, 0xc6, ++ 0xc2, 0x6b, 0x33, 0xb9, 0x1c, 0xcc, 0x03, 0x07 ++ } ++ }, ++ }, ++ { ++ { ++ 128, ++ { ++ 0x89, 0xda, 0xb8, 0x0b, 0x77, 0x17, 0xc1, 0xdb, ++ 0x5d, 0xb4, 0x37, 0x86, 0x0a, 0x3f, 0x70, 0x21, ++ 0x8e, 0x93, 0xe1, 0xb8, 0xf4, 0x61, 0xfb, 0x67, ++ 0x7f, 0x16, 0xf3, 0x5f, 0x6f, 0x87, 0xe2, 0xa9, ++ ++ 0x1c, 0x99, 0xbc, 0x3a, 0x47, 0xac, 0xe4, 0x76, ++ 0x40, 0xcc, 0x95, 0xc3, 0x45, 0xbe, 0x5e, 0xcc, ++ 0xa5, 0xa3, 0x52, 0x3c, 0x35, 0xcc, 0x01, 0x89, ++ 0x3a, 0xf0, 0xb6, 0x4a, 0x62, 0x03, 0x34, 0x27, ++ ++ 0x03, 0x72, 0xec, 0x12, 0x48, 0x2d, 0x1b, 0x1e, ++ 0x36, 0x35, 0x61, 0x69, 0x8a, 0x57, 0x8b, 0x35, ++ 0x98, 0x03, 0x49, 0x5b, 0xb4, 0xe2, 0xef, 0x19, ++ 0x30, 0xb1, 0x7a, 0x51, 0x90, 0xb5, 0x80, 0xf1, ++ ++ 0x41, 0x30, 0x0d, 0xf3, 0x0a, 0xdb, 0xec, 0xa2, ++ 0x8f, 0x64, 0x27, 0xa8, 0xbc, 0x1a, 0x99, 0x9f, ++ 0xd5, 0x1c, 0x55, 0x4a, 0x01, 0x7d, 0x09, 0x5d, ++ 0x8c, 0x3e, 0x31, 0x27, 0xda, 0xf9, 0xf5, 0x95 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x2d, 0x77, 0x3b, 0xe3, 0x7a, 0xdb, 0x1e, 0x4d, ++ 0x68, 0x3b, 0xf0, 0x07, 0x5e, 0x79, 0xc4, 0xee, ++ 0x03, 0x79, 0x18, 0x53, 0x5a, 0x7f, 0x99, 0xcc, ++ 0xb7, 0x04, 0x0f, 0xb5, 0xf5, 0xf4, 0x3a, 0xea ++ } ++ }, ++ { ++ 16, ++ { ++ 0xc8, 0x5d, 0x15, 0xed, 0x44, 0xc3, 0x78, 0xd6, ++ 0xb0, 0x0e, 0x23, 0x06, 0x4c, 0x7b, 0xcd, 0x51 ++ } ++ }, ++ }, ++ { ++ { ++ 528, ++ { ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0b, ++ 0x17, 0x03, 0x03, 0x02, 0x00, 0x00, 0x00, 0x00, ++ ++ 0x06, 0xdb, 0x1f, 0x1f, 0x36, 0x8d, 0x69, 0x6a, ++ 0x81, 0x0a, 0x34, 0x9c, 0x0c, 0x71, 0x4c, 0x9a, ++ 0x5e, 0x78, 0x50, 0xc2, 0x40, 0x7d, 0x72, 0x1a, ++ 0xcd, 0xed, 0x95, 0xe0, 0x18, 0xd7, 0xa8, 0x52, ++ ++ 0x66, 0xa6, 0xe1, 0x28, 0x9c, 0xdb, 0x4a, 0xeb, ++ 0x18, 0xda, 0x5a, 0xc8, 0xa2, 0xb0, 0x02, 0x6d, ++ 0x24, 0xa5, 0x9a, 0xd4, 0x85, 0x22, 0x7f, 0x3e, ++ 0xae, 0xdb, 0xb2, 0xe7, 0xe3, 0x5e, 0x1c, 0x66, ++ ++ 0xcd, 0x60, 0xf9, 0xab, 0xf7, 0x16, 0xdc, 0xc9, ++ 0xac, 0x42, 0x68, 0x2d, 0xd7, 0xda, 0xb2, 0x87, ++ 0xa7, 0x02, 0x4c, 0x4e, 0xef, 0xc3, 0x21, 0xcc, ++ 0x05, 0x74, 0xe1, 0x67, 0x93, 0xe3, 0x7c, 0xec, ++ ++ 0x03, 0xc5, 0xbd, 0xa4, 0x2b, 0x54, 0xc1, 0x14, ++ 0xa8, 0x0b, 0x57, 0xaf, 0x26, 0x41, 0x6c, 0x7b, ++ 0xe7, 0x42, 0x00, 0x5e, 0x20, 0x85, 0x5c, 0x73, ++ 0xe2, 0x1d, 0xc8, 0xe2, 0xed, 0xc9, 0xd4, 0x35, ++ ++ 0xcb, 0x6f, 0x60, 0x59, 0x28, 0x00, 0x11, 0xc2, ++ 0x70, 0xb7, 0x15, 0x70, 0x05, 0x1c, 0x1c, 0x9b, ++ 0x30, 0x52, 0x12, 0x66, 0x20, 0xbc, 0x1e, 0x27, ++ 0x30, 0xfa, 0x06, 0x6c, 0x7a, 0x50, 0x9d, 0x53, ++ ++ 0xc6, 0x0e, 0x5a, 0xe1, 0xb4, 0x0a, 0xa6, 0xe3, ++ 0x9e, 0x49, 0x66, 0x92, 0x28, 0xc9, 0x0e, 0xec, ++ 0xb4, 0xa5, 0x0d, 0xb3, 0x2a, 0x50, 0xbc, 0x49, ++ 0xe9, 0x0b, 0x4f, 0x4b, 0x35, 0x9a, 0x1d, 0xfd, ++ ++ 0x11, 0x74, 0x9c, 0xd3, 0x86, 0x7f, 0xcf, 0x2f, ++ 0xb7, 0xbb, 0x6c, 0xd4, 0x73, 0x8f, 0x6a, 0x4a, ++ 0xd6, 0xf7, 0xca, 0x50, 0x58, 0xf7, 0x61, 0x88, ++ 0x45, 0xaf, 0x9f, 0x02, 0x0f, 0x6c, 0x3b, 0x96, ++ ++ 0x7b, 0x8f, 0x4c, 0xd4, 0xa9, 0x1e, 0x28, 0x13, ++ 0xb5, 0x07, 0xae, 0x66, 0xf2, 0xd3, 0x5c, 0x18, ++ 0x28, 0x4f, 0x72, 0x92, 0x18, 0x60, 0x62, 0xe1, ++ 0x0f, 0xd5, 0x51, 0x0d, 0x18, 0x77, 0x53, 0x51, ++ ++ 0xef, 0x33, 0x4e, 0x76, 0x34, 0xab, 0x47, 0x43, ++ 0xf5, 0xb6, 0x8f, 0x49, 0xad, 0xca, 0xb3, 0x84, ++ 0xd3, 0xfd, 0x75, 0xf7, 0x39, 0x0f, 0x40, 0x06, ++ 0xef, 0x2a, 0x29, 0x5c, 0x8c, 0x7a, 0x07, 0x6a, ++ ++ 0xd5, 0x45, 0x46, 0xcd, 0x25, 0xd2, 0x10, 0x7f, ++ 0xbe, 0x14, 0x36, 0xc8, 0x40, 0x92, 0x4a, 0xae, ++ 0xbe, 0x5b, 0x37, 0x08, 0x93, 0xcd, 0x63, 0xd1, ++ 0x32, 0x5b, 0x86, 0x16, 0xfc, 0x48, 0x10, 0x88, ++ ++ 0x6b, 0xc1, 0x52, 0xc5, 0x32, 0x21, 0xb6, 0xdf, ++ 0x37, 0x31, 0x19, 0x39, 0x32, 0x55, 0xee, 0x72, ++ 0xbc, 0xaa, 0x88, 0x01, 0x74, 0xf1, 0x71, 0x7f, ++ 0x91, 0x84, 0xfa, 0x91, 0x64, 0x6f, 0x17, 0xa2, ++ ++ 0x4a, 0xc5, 0x5d, 0x16, 0xbf, 0xdd, 0xca, 0x95, ++ 0x81, 0xa9, 0x2e, 0xda, 0x47, 0x92, 0x01, 0xf0, ++ 0xed, 0xbf, 0x63, 0x36, 0x00, 0xd6, 0x06, 0x6d, ++ 0x1a, 0xb3, 0x6d, 0x5d, 0x24, 0x15, 0xd7, 0x13, ++ ++ 0x51, 0xbb, 0xcd, 0x60, 0x8a, 0x25, 0x10, 0x8d, ++ 0x25, 0x64, 0x19, 0x92, 0xc1, 0xf2, 0x6c, 0x53, ++ 0x1c, 0xf9, 0xf9, 0x02, 0x03, 0xbc, 0x4c, 0xc1, ++ 0x9f, 0x59, 0x27, 0xd8, 0x34, 0xb0, 0xa4, 0x71, ++ ++ 0x16, 0xd3, 0x88, 0x4b, 0xbb, 0x16, 0x4b, 0x8e, ++ 0xc8, 0x83, 0xd1, 0xac, 0x83, 0x2e, 0x56, 0xb3, ++ 0x91, 0x8a, 0x98, 0x60, 0x1a, 0x08, 0xd1, 0x71, ++ 0x88, 0x15, 0x41, 0xd5, 0x94, 0xdb, 0x39, 0x9c, ++ ++ 0x6a, 0xe6, 0x15, 0x12, 0x21, 0x74, 0x5a, 0xec, ++ 0x81, 0x4c, 0x45, 0xb0, 0xb0, 0x5b, 0x56, 0x54, ++ 0x36, 0xfd, 0x6f, 0x13, 0x7a, 0xa1, 0x0a, 0x0c, ++ 0x0b, 0x64, 0x37, 0x61, 0xdb, 0xd6, 0xf9, 0xa9, ++ ++ 0xdc, 0xb9, 0x9b, 0x1a, 0x6e, 0x69, 0x08, 0x54, ++ 0xce, 0x07, 0x69, 0xcd, 0xe3, 0x97, 0x61, 0xd8, ++ 0x2f, 0xcd, 0xec, 0x15, 0xf0, 0xd9, 0x2d, 0x7d, ++ 0x8e, 0x94, 0xad, 0xe8, 0xeb, 0x83, 0xfb, 0xe0 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x99, 0xe5, 0x82, 0x2d, 0xd4, 0x17, 0x3c, 0x99, ++ 0x5e, 0x3d, 0xae, 0x0d, 0xde, 0xfb, 0x97, 0x74, ++ 0x3f, 0xde, 0x3b, 0x08, 0x01, 0x34, 0xb3, 0x9f, ++ 0x76, 0xe9, 0xbf, 0x8d, 0x0e, 0x88, 0xd5, 0x46 ++ } ++ }, ++ { ++ 16, ++ { ++ 0x26, 0x37, 0x40, 0x8f, 0xe1, 0x30, 0x86, 0xea, ++ 0x73, 0xf9, 0x71, 0xe3, 0x42, 0x5e, 0x28, 0x20 ++ } ++ }, ++ }, ++ /* ++ * test vectors from Hanno Böck ++ */ ++ { ++ { ++ 257, ++ { ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ 0xcc, 0x80, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xce, 0xcc, 0xcc, 0xcc, ++ ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xc5, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xe3, 0xcc, 0xcc, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xac, 0xcc, 0xcc, 0xcc, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xe6, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x00, 0x00, 0x00, ++ 0xaf, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, ++ ++ 0xcc, 0xcc, 0xff, 0xff, 0xff, 0xf5, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ ++ 0x00, 0xff, 0xff, 0xff, 0xe7, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x71, 0x92, 0x05, 0xa8, 0x52, 0x1d, ++ ++ 0xfc ++ } ++ }, ++ { ++ 32, ++ { ++ 0x7f, 0x1b, 0x02, 0x64, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc ++ } ++ }, ++ { ++ 16, ++ { ++ 0x85, 0x59, 0xb8, 0x76, 0xec, 0xee, 0xd6, 0x6e, ++ 0xb3, 0x77, 0x98, 0xc0, 0x45, 0x7b, 0xaf, 0xf9 ++ } ++ }, ++ }, ++ { ++ { ++ 39, ++ { ++ 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, ++ 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, ++ 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, ++ 0xaa, 0xaa, 0xaa, 0x00, 0x00, 0x00, 0x00, 0x00, ++ ++ 0x00, 0x00, 0x00, 0x00, 0x80, 0x02, 0x64 ++ } ++ }, ++ { ++ 32, ++ { ++ 0xe0, 0x00, 0x16, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, ++ 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa ++ } ++ }, ++ { ++ 16, ++ { ++ 0x00, 0xbd, 0x12, 0x58, 0x97, 0x8e, 0x20, 0x54, ++ 0x44, 0xc9, 0xaa, 0xaa, 0x82, 0x00, 0x6f, 0xed ++ } ++ }, ++ }, ++ { ++ { ++ 2, ++ { ++ 0x02, 0xfc ++ } ++ }, ++ { ++ 32, ++ { ++ 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, ++ 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, ++ 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, ++ 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c ++ } ++ }, ++ { ++ 16, ++ { ++ 0x06, 0x12, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, ++ 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c ++ } ++ }, ++ }, ++ { ++ { ++ 415, ++ { ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7a, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ ++ 0x7b, 0x7b, 0x5c, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x6e, 0x7b, 0x00, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7a, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x5c, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, ++ ++ 0x7b, 0x6e, 0x7b, 0x00, 0x13, 0x00, 0x00, 0x00, ++ 0x00, 0xb3, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ ++ 0xf2, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x20, 0x00, 0xef, 0xff, 0x00, ++ 0x09, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00, 0x00, ++ 0x00, 0x00, 0x09, 0x00, 0x00, 0x00, 0x64, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x13, 0x00, 0x00, 0x00, 0x00, ++ ++ 0xb3, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf2, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x20, 0x00, 0xef, 0xff, 0x00, 0x09, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x7a, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00, ++ ++ 0x00, 0x09, 0x00, 0x00, 0x00, 0x64, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfc ++ } ++ }, ++ { ++ 32, ++ { ++ 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x1e, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7b, 0x7b ++ } ++ }, ++ { ++ 16, ++ { ++ 0x33, 0x20, 0x5b, 0xbf, 0x9e, 0x9f, 0x8f, 0x72, ++ 0x12, 0xab, 0x9e, 0x2a, 0xb9, 0xb7, 0xe4, 0xa5 ++ } ++ }, ++ }, ++ { ++ { ++ 118, ++ { ++ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, ++ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, ++ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, ++ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, ++ ++ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, ++ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, ++ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, ++ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, ++ ++ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, ++ 0x77, 0x77, 0x77, 0x77, 0xff, 0xff, 0xff, 0xe9, ++ 0xe9, 0xac, 0xac, 0xac, 0xac, 0xac, 0xac, 0xac, ++ 0xac, 0xac, 0xac, 0xac, 0x00, 0x00, 0xac, 0xac, ++ ++ 0xec, 0x01, 0x00, 0xac, 0xac, 0xac, 0x2c, 0xac, ++ 0xa2, 0xac, 0xac, 0xac, 0xac, 0xac, 0xac, 0xac, ++ 0xac, 0xac, 0xac, 0xac, 0x64, 0xf2 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x00, 0x00, 0x00, 0x7f, 0x00, 0x00, 0x00, 0x7f, ++ 0x01, 0x00, 0x00, 0x20, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0xcf, 0x77, 0x77, 0x77, 0x77, 0x77, ++ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77 ++ } ++ }, ++ { ++ 16, ++ { ++ 0x02, 0xee, 0x7c, 0x8c, 0x54, 0x6d, 0xde, 0xb1, ++ 0xa4, 0x67, 0xe4, 0xc3, 0x98, 0x11, 0x58, 0xb9 ++ } ++ }, ++ }, ++ /* ++ * test vectors from Andrew Moon ++ */ ++ { /* nacl */ ++ { ++ 131, ++ { ++ 0x8e, 0x99, 0x3b, 0x9f, 0x48, 0x68, 0x12, 0x73, ++ 0xc2, 0x96, 0x50, 0xba, 0x32, 0xfc, 0x76, 0xce, ++ 0x48, 0x33, 0x2e, 0xa7, 0x16, 0x4d, 0x96, 0xa4, ++ 0x47, 0x6f, 0xb8, 0xc5, 0x31, 0xa1, 0x18, 0x6a, ++ ++ 0xc0, 0xdf, 0xc1, 0x7c, 0x98, 0xdc, 0xe8, 0x7b, ++ 0x4d, 0xa7, 0xf0, 0x11, 0xec, 0x48, 0xc9, 0x72, ++ 0x71, 0xd2, 0xc2, 0x0f, 0x9b, 0x92, 0x8f, 0xe2, ++ 0x27, 0x0d, 0x6f, 0xb8, 0x63, 0xd5, 0x17, 0x38, ++ ++ 0xb4, 0x8e, 0xee, 0xe3, 0x14, 0xa7, 0xcc, 0x8a, ++ 0xb9, 0x32, 0x16, 0x45, 0x48, 0xe5, 0x26, 0xae, ++ 0x90, 0x22, 0x43, 0x68, 0x51, 0x7a, 0xcf, 0xea, ++ 0xbd, 0x6b, 0xb3, 0x73, 0x2b, 0xc0, 0xe9, 0xda, ++ ++ 0x99, 0x83, 0x2b, 0x61, 0xca, 0x01, 0xb6, 0xde, ++ 0x56, 0x24, 0x4a, 0x9e, 0x88, 0xd5, 0xf9, 0xb3, ++ 0x79, 0x73, 0xf6, 0x22, 0xa4, 0x3d, 0x14, 0xa6, ++ 0x59, 0x9b, 0x1f, 0x65, 0x4c, 0xb4, 0x5a, 0x74, ++ ++ 0xe3, 0x55, 0xa5 ++ } ++ }, ++ { ++ 32, ++ { ++ 0xee, 0xa6, 0xa7, 0x25, 0x1c, 0x1e, 0x72, 0x91, ++ 0x6d, 0x11, 0xc2, 0xcb, 0x21, 0x4d, 0x3c, 0x25, ++ 0x25, 0x39, 0x12, 0x1d, 0x8e, 0x23, 0x4e, 0x65, ++ 0x2d, 0x65, 0x1f, 0xa4, 0xc8, 0xcf, 0xf8, 0x80 ++ } ++ }, ++ { ++ 16, ++ { ++ 0xf3, 0xff, 0xc7, 0x70, 0x3f, 0x94, 0x00, 0xe5, ++ 0x2a, 0x7d, 0xfb, 0x4b, 0x3d, 0x33, 0x05, 0xd9 ++ } ++ }, ++ }, ++ { /* wrap 2^130-5 */ ++ { ++ 16, ++ { ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff ++ } ++ }, ++ { ++ 32, ++ { ++ 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ { ++ 16, ++ { ++ 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ }, ++ { /* wrap 2^128 */ ++ { ++ 16, ++ { ++ 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff ++ } ++ }, ++ { ++ 16, ++ { ++ 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ }, ++ { /* limb carry */ ++ { ++ 48, ++ { ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xf0, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ ++ 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ { ++ 16, ++ { ++ 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ }, ++ { /* 2^130-5 */ ++ { ++ 48, ++ { ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xfb, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, ++ 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, ++ ++ 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, ++ 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ { ++ 16, ++ { ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ ++ } ++ }, ++ }, ++ { /* 2^130-6 */ ++ { ++ 16, ++ { ++ 0xfd, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff ++ } ++ }, ++ { ++ 32, ++ { ++ 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ { ++ 16, ++ { ++ 0xfa, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff ++ } ++ }, ++ }, ++ { /* 5*H+L reduction intermediate */ ++ { ++ 64, ++ { ++ 0xe3, 0x35, 0x94, 0xd7, 0x50, 0x5e, 0x43, 0xb9, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x33, 0x94, 0xd7, 0x50, 0x5e, 0x43, 0x79, 0xcd, ++ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ { ++ 32, ++ { ++ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ { ++ 16, ++ { ++ 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x55, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ }, ++ { /* 5*H+L reduction final */ ++ { ++ 48, ++ { ++ 0xe3, 0x35, 0x94, 0xd7, 0x50, 0x5e, 0x43, 0xb9, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x33, 0x94, 0xd7, 0x50, 0x5e, 0x43, 0x79, 0xcd, ++ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ ++ } ++ }, ++ { ++ 32, ++ { ++ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ }, ++ { ++ 16, ++ { ++ 0x13, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, ++ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 ++ } ++ } ++ } ++}; ++ ++bool __init poly1305_selftest(void) ++{ ++ bool have_simd = chacha20poly1305_init_simd(); ++ bool success = true; ++ size_t i; ++ ++ for (i = 0; i < ARRAY_SIZE(poly1305_testvecs); ++i) { ++ struct poly1305_ctx poly1305; ++ const u8 *in = poly1305_testvecs[i].input.data; ++ size_t inlen = poly1305_testvecs[i].input.size; ++ const u8 *key = poly1305_testvecs[i].key.data; ++ const u8 *expected = poly1305_testvecs[i].expected.data; ++ size_t expectedlen = poly1305_testvecs[i].expected.size; ++ u8 out[POLY1305_MAC_SIZE]; ++ ++ if (expectedlen != sizeof(out)) { ++ pr_info("poly1305 self-test %zu logic: FAIL\n", i + 1); ++ success = false; ++ } ++ ++ memset(out, 0, sizeof(out)); ++ memset(&poly1305, 0, sizeof(poly1305)); ++ poly1305_init(&poly1305, key, have_simd); ++ poly1305_update(&poly1305, in, inlen, have_simd); ++ poly1305_finish(&poly1305, out, have_simd); ++ if (memcmp(out, expected, expectedlen)) { ++ pr_info("poly1305 self-test %zu: FAIL\n", i + 1); ++ success = false; ++ } ++ ++ if (inlen > 16) { ++ memset(out, 0, sizeof(out)); ++ memset(&poly1305, 0, sizeof(poly1305)); ++ poly1305_init(&poly1305, key, have_simd); ++ poly1305_update(&poly1305, in, 1, have_simd); ++ poly1305_update(&poly1305, in + 1, inlen - 1, have_simd); ++ poly1305_finish(&poly1305, out, have_simd); ++ if (memcmp(out, expected, expectedlen)) { ++ pr_info("poly1305 self-test %zu/1+(N-1): FAIL\n", i + 1); ++ success = false; ++ } ++ } ++ ++ if (inlen > 32) { ++ size_t half = inlen / 2; ++ ++ memset(out, 0, sizeof(out)); ++ memset(&poly1305, 0, sizeof(poly1305)); ++ poly1305_init(&poly1305, key, have_simd); ++ poly1305_update(&poly1305, in, half, have_simd); ++ poly1305_update(&poly1305, in + half, inlen - half, have_simd); ++ poly1305_finish(&poly1305, out, have_simd); ++ if (memcmp(out, expected, expectedlen)) { ++ pr_info("poly1305 self-test %zu/2: FAIL\n", i + 1); ++ success = false; ++ } ++ ++ for (half = 16; half < inlen; half += 16) { ++ memset(out, 0, sizeof(out)); ++ memset(&poly1305, 0, sizeof(poly1305)); ++ poly1305_init(&poly1305, key, have_simd); ++ poly1305_update(&poly1305, in, half, have_simd); ++ poly1305_update(&poly1305, in + half, inlen - half, have_simd); ++ poly1305_finish(&poly1305, out, have_simd); ++ if (memcmp(out, expected, expectedlen)) { ++ pr_info("poly1305 self-test %zu/%zu+%zu: FAIL\n", i + 1, half, inlen - half); ++ success = false; ++ } ++ } ++ } ++ } ++ chacha20poly1305_deinit_simd(have_simd); ++ ++ if (success) ++ pr_info("poly1305 self-tests: pass\n"); ++ ++ return success; ++} ++#endif +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/selftest/ratelimiter.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,157 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifdef DEBUG ++ ++#include ++ ++static const struct { bool result; unsigned int msec_to_sleep_before; } expected_results[] __initconst = { ++ [0 ... PACKETS_BURSTABLE - 1] = { true, 0 }, ++ [PACKETS_BURSTABLE] = { false, 0 }, ++ [PACKETS_BURSTABLE + 1] = { true, MSEC_PER_SEC / PACKETS_PER_SECOND }, ++ [PACKETS_BURSTABLE + 2] = { false, 0 }, ++ [PACKETS_BURSTABLE + 3] = { true, (MSEC_PER_SEC / PACKETS_PER_SECOND) * 2 }, ++ [PACKETS_BURSTABLE + 4] = { true, 0 }, ++ [PACKETS_BURSTABLE + 5] = { false, 0 } ++}; ++ ++static __init unsigned int maximum_jiffies_at_index(int index) ++{ ++ unsigned int total_msecs = 2 * MSEC_PER_SEC / PACKETS_PER_SECOND / 3; ++ int i; ++ ++ for (i = 0; i <= index; ++i) ++ total_msecs += expected_results[i].msec_to_sleep_before; ++ return msecs_to_jiffies(total_msecs); ++} ++ ++bool __init ratelimiter_selftest(void) ++{ ++ struct sk_buff *skb4; ++ struct iphdr *hdr4; ++#if IS_ENABLED(CONFIG_IPV6) ++ struct sk_buff *skb6; ++ struct ipv6hdr *hdr6; ++#endif ++ int i, test = 0, tries = 0, ret = false; ++ unsigned long loop_start_time; ++ ++ BUILD_BUG_ON(MSEC_PER_SEC % PACKETS_PER_SECOND != 0); ++ ++ if (ratelimiter_init()) ++ goto out; ++ ++test; ++ if (ratelimiter_init()) { ++ ratelimiter_uninit(); ++ goto out; ++ } ++ ++test; ++ if (ratelimiter_init()) { ++ ratelimiter_uninit(); ++ ratelimiter_uninit(); ++ goto out; ++ } ++ ++test; ++ ++ skb4 = alloc_skb(sizeof(struct iphdr), GFP_KERNEL); ++ if (!skb4) ++ goto err_nofree; ++ skb4->protocol = htons(ETH_P_IP); ++ hdr4 = (struct iphdr *)skb_put(skb4, sizeof(struct iphdr)); ++ hdr4->saddr = htonl(8182); ++ skb_reset_network_header(skb4); ++ ++test; ++ ++#if IS_ENABLED(CONFIG_IPV6) ++ skb6 = alloc_skb(sizeof(struct ipv6hdr), GFP_KERNEL); ++ if (!skb6) { ++ kfree_skb(skb4); ++ goto err_nofree; ++ } ++ skb6->protocol = htons(ETH_P_IPV6); ++ hdr6 = (struct ipv6hdr *)skb_put(skb6, sizeof(struct ipv6hdr)); ++ hdr6->saddr.in6_u.u6_addr32[0] = htonl(1212); ++ hdr6->saddr.in6_u.u6_addr32[1] = htonl(289188); ++ skb_reset_network_header(skb6); ++ ++test; ++#endif ++ ++restart: ++ loop_start_time = jiffies; ++ for (i = 0; i < ARRAY_SIZE(expected_results); ++i) { ++#define ensure_time do {\ ++ if (time_is_before_jiffies(loop_start_time + maximum_jiffies_at_index(i))) { \ ++ if (++tries >= 5000) \ ++ goto err; \ ++ gc_entries(NULL); \ ++ rcu_barrier(); \ ++ msleep(500); \ ++ goto restart; \ ++ }} while (0) ++ ++ if (expected_results[i].msec_to_sleep_before) ++ msleep(expected_results[i].msec_to_sleep_before); ++ ++ ensure_time; ++ if (ratelimiter_allow(skb4, &init_net) != expected_results[i].result) ++ goto err; ++ ++test; ++ hdr4->saddr = htonl(ntohl(hdr4->saddr) + i + 1); ++ ensure_time; ++ if (!ratelimiter_allow(skb4, &init_net)) ++ goto err; ++ ++test; ++ hdr4->saddr = htonl(ntohl(hdr4->saddr) - i - 1); ++ ++#if IS_ENABLED(CONFIG_IPV6) ++ hdr6->saddr.in6_u.u6_addr32[2] = hdr6->saddr.in6_u.u6_addr32[3] = htonl(i); ++ ensure_time; ++ if (ratelimiter_allow(skb6, &init_net) != expected_results[i].result) ++ goto err; ++ ++test; ++ hdr6->saddr.in6_u.u6_addr32[0] = htonl(ntohl(hdr6->saddr.in6_u.u6_addr32[0]) + i + 1); ++ ensure_time; ++ if (!ratelimiter_allow(skb6, &init_net)) ++ goto err; ++ ++test; ++ hdr6->saddr.in6_u.u6_addr32[0] = htonl(ntohl(hdr6->saddr.in6_u.u6_addr32[0]) - i - 1); ++ ensure_time; ++#endif ++ } ++ ++ gc_entries(NULL); ++ rcu_barrier(); ++ ++ if (atomic_read(&total_entries)) ++ goto err; ++ ++test; ++ ++ for (i = 0; i <= max_entries; ++i) { ++ hdr4->saddr = htonl(i); ++ if (ratelimiter_allow(skb4, &init_net) != (i != max_entries)) ++ goto err; ++ ++test; ++ } ++ ++ ret = true; ++ ++err: ++ kfree_skb(skb4); ++#if IS_ENABLED(CONFIG_IPV6) ++ kfree_skb(skb6); ++#endif ++err_nofree: ++ ratelimiter_uninit(); ++ ratelimiter_uninit(); ++ ratelimiter_uninit(); ++out: ++ if (ret) ++ pr_info("ratelimiter self-tests: pass\n"); ++ else ++ pr_info("ratelimiter self-test %d: fail\n", test); ++ ++ return ret; ++} ++#endif +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/blake2s.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,294 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * ++ * Original author: Samuel Neves ++ */ ++ ++#include "blake2s.h" ++ ++#include ++#include ++#include ++#include ++#include ++ ++typedef union { ++ struct { ++ u8 digest_length; ++ u8 key_length; ++ u8 fanout; ++ u8 depth; ++ u32 leaf_length; ++ u32 node_offset; ++ u16 xof_length; ++ u8 node_depth; ++ u8 inner_length; ++ u8 salt[8]; ++ u8 personal[8]; ++ }; ++ __le32 words[8]; ++} __packed blake2s_param; ++ ++static const u32 blake2s_iv[8] = { ++ 0x6A09E667UL, 0xBB67AE85UL, 0x3C6EF372UL, 0xA54FF53AUL, ++ 0x510E527FUL, 0x9B05688CUL, 0x1F83D9ABUL, 0x5BE0CD19UL ++}; ++ ++static const u8 blake2s_sigma[10][16] = { ++ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15}, ++ {14, 10, 4, 8, 9, 15, 13, 6, 1, 12, 0, 2, 11, 7, 5, 3}, ++ {11, 8, 12, 0, 5, 2, 15, 13, 10, 14, 3, 6, 7, 1, 9, 4}, ++ {7, 9, 3, 1, 13, 12, 11, 14, 2, 6, 5, 10, 4, 0, 15, 8}, ++ {9, 0, 5, 7, 2, 4, 10, 15, 14, 1, 11, 12, 6, 8, 3, 13}, ++ {2, 12, 6, 10, 0, 11, 8, 3, 4, 13, 7, 5, 15, 14, 1, 9}, ++ {12, 5, 1, 15, 14, 13, 4, 10, 0, 7, 6, 3, 9, 2, 8, 11}, ++ {13, 11, 7, 14, 12, 1, 3, 9, 5, 0, 15, 4, 8, 6, 2, 10}, ++ {6, 15, 14, 9, 11, 3, 0, 8, 12, 2, 13, 7, 1, 4, 10, 5}, ++ {10, 2, 8, 4, 7, 6, 1, 5, 15, 11, 9, 14, 3, 12, 13, 0}, ++}; ++ ++static inline u32 le32_to_cpuvp(const void *p) ++{ ++ return le32_to_cpup(p); ++} ++ ++static inline void blake2s_set_lastblock(struct blake2s_state *state) ++{ ++ if (state->last_node) ++ state->f[1] = -1; ++ state->f[0] = -1; ++} ++ ++static inline void blake2s_increment_counter(struct blake2s_state *state, const u32 inc) ++{ ++ state->t[0] += inc; ++ state->t[1] += (state->t[0] < inc); ++} ++ ++static inline void blake2s_init_param(struct blake2s_state *state, const blake2s_param *param) ++{ ++ int i; ++ ++ memset(state, 0, sizeof(struct blake2s_state)); ++ for (i = 0; i < 8; ++i) ++ state->h[i] = blake2s_iv[i] ^ le32_to_cpu(param->words[i]); ++} ++ ++void blake2s_init(struct blake2s_state *state, const size_t outlen) ++{ ++ blake2s_param param __aligned(__alignof__(u32)) = { ++ .digest_length = outlen, ++ .fanout = 1, ++ .depth = 1 ++ }; ++ ++#ifdef DEBUG ++ BUG_ON(!outlen || outlen > BLAKE2S_OUTBYTES); ++#endif ++ blake2s_init_param(state, ¶m); ++} ++ ++void blake2s_init_key(struct blake2s_state *state, const size_t outlen, const void *key, const size_t keylen) ++{ ++ blake2s_param param = { ++ .digest_length = outlen, ++ .key_length = keylen, ++ .fanout = 1, ++ .depth = 1 ++ }; ++ u8 block[BLAKE2S_BLOCKBYTES] = { 0 }; ++ ++#ifdef DEBUG ++ BUG_ON(!outlen || outlen > BLAKE2S_OUTBYTES || !key || !keylen || keylen > BLAKE2S_KEYBYTES); ++#endif ++ blake2s_init_param(state, ¶m); ++ memcpy(block, key, keylen); ++ blake2s_update(state, block, BLAKE2S_BLOCKBYTES); ++ memzero_explicit(block, BLAKE2S_BLOCKBYTES); ++} ++ ++#ifdef CONFIG_X86_64 ++#include ++#include ++#include ++#include ++static bool blake2s_use_avx __read_mostly; ++static bool blake2s_use_avx512 __read_mostly; ++void __init blake2s_fpu_init(void) ++{ ++#ifndef CONFIG_UML ++ blake2s_use_avx = boot_cpu_has(X86_FEATURE_AVX) && cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM, NULL); ++#ifndef COMPAT_CANNOT_USE_AVX512 ++ blake2s_use_avx512 = boot_cpu_has(X86_FEATURE_AVX) && boot_cpu_has(X86_FEATURE_AVX2) && boot_cpu_has(X86_FEATURE_AVX512F) && boot_cpu_has(X86_FEATURE_AVX512VL) && cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM | XFEATURE_MASK_AVX512, NULL); ++#endif ++#endif ++} ++#ifdef CONFIG_AS_AVX ++asmlinkage void blake2s_compress_avx(struct blake2s_state *state, const u8 *block, size_t nblocks, u32 inc); ++#endif ++#ifdef CONFIG_AS_AVX512 ++asmlinkage void blake2s_compress_avx512(struct blake2s_state *state, const u8 *block, size_t nblocks, u32 inc); ++#endif ++#else ++void __init blake2s_fpu_init(void) { } ++#endif ++ ++static inline void blake2s_compress(struct blake2s_state *state, const u8 *block, size_t nblocks, u32 inc) ++{ ++ u32 m[16]; ++ u32 v[16]; ++ int i; ++ ++#ifdef DEBUG ++ BUG_ON(nblocks > 1 && inc != BLAKE2S_BLOCKBYTES); ++#endif ++ ++#ifdef CONFIG_X86_64 ++#ifdef CONFIG_AS_AVX512 ++ if (blake2s_use_avx512 && irq_fpu_usable()) { ++ kernel_fpu_begin(); ++ blake2s_compress_avx512(state, block, nblocks, inc); ++ kernel_fpu_end(); ++ return; ++ } ++#endif ++#ifdef CONFIG_AS_AVX ++ if (blake2s_use_avx && irq_fpu_usable()) { ++ kernel_fpu_begin(); ++ blake2s_compress_avx(state, block, nblocks, inc); ++ kernel_fpu_end(); ++ return; ++ } ++#endif ++#endif ++ ++ while (nblocks > 0) { ++ blake2s_increment_counter(state, inc); ++ ++#ifdef __LITTLE_ENDIAN ++ memcpy(m, block, BLAKE2S_BLOCKBYTES); ++#else ++ for (i = 0; i < 16; ++i) ++ m[i] = get_unaligned_le32(block + i * sizeof(m[i])); ++#endif ++ memcpy(v, state->h, 32); ++ v[ 8] = blake2s_iv[0]; ++ v[ 9] = blake2s_iv[1]; ++ v[10] = blake2s_iv[2]; ++ v[11] = blake2s_iv[3]; ++ v[12] = blake2s_iv[4] ^ state->t[0]; ++ v[13] = blake2s_iv[5] ^ state->t[1]; ++ v[14] = blake2s_iv[6] ^ state->f[0]; ++ v[15] = blake2s_iv[7] ^ state->f[1]; ++ ++#define G(r, i, a, b, c, d) do { \ ++ a += b + m[blake2s_sigma[r][2 * i + 0]]; \ ++ d = ror32(d ^ a, 16); \ ++ c += d; \ ++ b = ror32(b ^ c, 12); \ ++ a += b + m[blake2s_sigma[r][2 * i + 1]]; \ ++ d = ror32(d ^ a, 8); \ ++ c += d; \ ++ b = ror32(b ^ c, 7); \ ++} while (0) ++ ++#define ROUND(r) do { \ ++ G(r, 0, v[0], v[ 4], v[ 8], v[12]); \ ++ G(r, 1, v[1], v[ 5], v[ 9], v[13]); \ ++ G(r, 2, v[2], v[ 6], v[10], v[14]); \ ++ G(r, 3, v[3], v[ 7], v[11], v[15]); \ ++ G(r, 4, v[0], v[ 5], v[10], v[15]); \ ++ G(r, 5, v[1], v[ 6], v[11], v[12]); \ ++ G(r, 6, v[2], v[ 7], v[ 8], v[13]); \ ++ G(r, 7, v[3], v[ 4], v[ 9], v[14]); \ ++} while (0) ++ ROUND(0); ++ ROUND(1); ++ ROUND(2); ++ ROUND(3); ++ ROUND(4); ++ ROUND(5); ++ ROUND(6); ++ ROUND(7); ++ ROUND(8); ++ ROUND(9); ++ ++#undef G ++#undef ROUND ++ ++ for (i = 0; i < 8; ++i) ++ state->h[i] ^= v[i] ^ v[i + 8]; ++ ++ block += BLAKE2S_BLOCKBYTES; ++ --nblocks; ++ } ++} ++ ++void blake2s_update(struct blake2s_state *state, const u8 *in, size_t inlen) ++{ ++ const size_t fill = BLAKE2S_BLOCKBYTES - state->buflen; ++ ++ if (unlikely(!inlen)) ++ return; ++ if (inlen > fill) { ++ memcpy(state->buf + state->buflen, in, fill); ++ blake2s_compress(state, state->buf, 1, BLAKE2S_BLOCKBYTES); ++ state->buflen = 0; ++ in += fill; ++ inlen -= fill; ++ } ++ if (inlen > BLAKE2S_BLOCKBYTES) { ++ const size_t nblocks = (inlen + BLAKE2S_BLOCKBYTES - 1) / BLAKE2S_BLOCKBYTES; ++ /* Hash one less (full) block than strictly possible */ ++ blake2s_compress(state, in, nblocks - 1, BLAKE2S_BLOCKBYTES); ++ in += BLAKE2S_BLOCKBYTES * (nblocks - 1); ++ inlen -= BLAKE2S_BLOCKBYTES * (nblocks - 1); ++ } ++ memcpy(state->buf + state->buflen, in, inlen); ++ state->buflen += inlen; ++} ++ ++void __blake2s_final(struct blake2s_state *state) ++{ ++ blake2s_set_lastblock(state); ++ memset(state->buf + state->buflen, 0, BLAKE2S_BLOCKBYTES - state->buflen); /* Padding */ ++ blake2s_compress(state, state->buf, 1, state->buflen); ++} ++ ++void blake2s_hmac(u8 *out, const u8 *in, const u8 *key, const size_t outlen, const size_t inlen, const size_t keylen) ++{ ++ struct blake2s_state state; ++ u8 x_key[BLAKE2S_BLOCKBYTES] __aligned(__alignof__(u32)) = { 0 }; ++ u8 i_hash[BLAKE2S_OUTBYTES] __aligned(__alignof__(u32)); ++ int i; ++ ++ if (keylen > BLAKE2S_BLOCKBYTES) { ++ blake2s_init(&state, BLAKE2S_OUTBYTES); ++ blake2s_update(&state, key, keylen); ++ blake2s_final(&state, x_key, BLAKE2S_OUTBYTES); ++ } else ++ memcpy(x_key, key, keylen); ++ ++ for (i = 0; i < BLAKE2S_BLOCKBYTES; ++i) ++ x_key[i] ^= 0x36; ++ ++ blake2s_init(&state, BLAKE2S_OUTBYTES); ++ blake2s_update(&state, x_key, BLAKE2S_BLOCKBYTES); ++ blake2s_update(&state, in, inlen); ++ blake2s_final(&state, i_hash, BLAKE2S_OUTBYTES); ++ ++ for (i = 0; i < BLAKE2S_BLOCKBYTES; ++i) ++ x_key[i] ^= 0x5c ^ 0x36; ++ ++ blake2s_init(&state, BLAKE2S_OUTBYTES); ++ blake2s_update(&state, x_key, BLAKE2S_BLOCKBYTES); ++ blake2s_update(&state, i_hash, BLAKE2S_OUTBYTES); ++ blake2s_final(&state, i_hash, BLAKE2S_OUTBYTES); ++ ++ memcpy(out, i_hash, outlen); ++ memzero_explicit(x_key, BLAKE2S_BLOCKBYTES); ++ memzero_explicit(i_hash, BLAKE2S_OUTBYTES); ++} ++ ++#include "../selftest/blake2s.h" +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/chacha20poly1305.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,852 @@ ++/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. ++ */ ++ ++#include "chacha20poly1305.h" ++ ++#include ++#include ++#include ++#include ++#include ++#include ++ ++#if defined(CONFIG_X86_64) ++#include ++#include ++#include ++asmlinkage void poly1305_init_x86_64(void *ctx, const u8 key[16]); ++asmlinkage void poly1305_blocks_x86_64(void *ctx, const u8 *inp, size_t len, u32 padbit); ++asmlinkage void poly1305_emit_x86_64(void *ctx, u8 mac[16], const u32 nonce[4]); ++#ifdef CONFIG_AS_SSSE3 ++asmlinkage void hchacha20_ssse3(u8 *derived_key, const u8 *nonce, const u8 *key); ++asmlinkage void chacha20_ssse3(u8 *out, const u8 *in, size_t len, const u32 key[8], const u32 counter[4]); ++#endif ++#ifdef CONFIG_AS_AVX ++asmlinkage void poly1305_emit_avx(void *ctx, u8 mac[16], const u32 nonce[4]); ++asmlinkage void poly1305_blocks_avx(void *ctx, const u8 *inp, size_t len, u32 padbit); ++#endif ++#ifdef CONFIG_AS_AVX2 ++asmlinkage void chacha20_avx2(u8 *out, const u8 *in, size_t len, const u32 key[8], const u32 counter[4]); ++asmlinkage void poly1305_blocks_avx2(void *ctx, const u8 *inp, size_t len, u32 padbit); ++#endif ++#ifdef CONFIG_AS_AVX512 ++asmlinkage void chacha20_avx512(u8 *out, const u8 *in, size_t len, const u32 key[8], const u32 counter[4]); ++asmlinkage void chacha20_avx512vl(u8 *out, const u8 *in, size_t len, const u32 key[8], const u32 counter[4]); ++asmlinkage void poly1305_blocks_avx512(void *ctx, const u8 *inp, size_t len, u32 padbit); ++#endif ++ ++static bool chacha20poly1305_use_ssse3 __read_mostly; ++static bool chacha20poly1305_use_avx __read_mostly; ++static bool chacha20poly1305_use_avx2 __read_mostly; ++static bool chacha20poly1305_use_avx512 __read_mostly; ++static bool chacha20poly1305_use_avx512vl __read_mostly; ++ ++void __init chacha20poly1305_fpu_init(void) ++{ ++#ifndef CONFIG_UML ++ chacha20poly1305_use_ssse3 = boot_cpu_has(X86_FEATURE_SSSE3); ++ chacha20poly1305_use_avx = boot_cpu_has(X86_FEATURE_AVX) && ++ cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM, NULL); ++ chacha20poly1305_use_avx2 = boot_cpu_has(X86_FEATURE_AVX) && boot_cpu_has(X86_FEATURE_AVX2) && ++ cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM, NULL); ++#ifndef COMPAT_CANNOT_USE_AVX512 ++ chacha20poly1305_use_avx512 = boot_cpu_has(X86_FEATURE_AVX) && boot_cpu_has(X86_FEATURE_AVX2) && boot_cpu_has(X86_FEATURE_AVX512F) && ++ cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM | XFEATURE_MASK_AVX512, NULL) && ++ boot_cpu_data.x86_model != INTEL_FAM6_SKYLAKE_X; ++ chacha20poly1305_use_avx512vl = boot_cpu_has(X86_FEATURE_AVX) && boot_cpu_has(X86_FEATURE_AVX2) && boot_cpu_has(X86_FEATURE_AVX512F) && boot_cpu_has(X86_FEATURE_AVX512VL) && ++ cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM | XFEATURE_MASK_AVX512, NULL); ++#endif ++#endif ++} ++#elif defined(CONFIG_ARM) || defined(CONFIG_ARM64) ++asmlinkage void poly1305_init_arm(void *ctx, const u8 key[16]); ++asmlinkage void poly1305_blocks_arm(void *ctx, const u8 *inp, size_t len, u32 padbit); ++asmlinkage void poly1305_emit_arm(void *ctx, u8 mac[16], const u32 nonce[4]); ++asmlinkage void chacha20_arm(u8 *out, const u8 *in, size_t len, const u32 key[8], const u32 counter[4]); ++#if IS_ENABLED(CONFIG_KERNEL_MODE_NEON) && (!defined(__LINUX_ARM_ARCH__) || __LINUX_ARM_ARCH__ >= 7) ++#define ARM_USE_NEON ++#include ++#include ++asmlinkage void poly1305_blocks_neon(void *ctx, const u8 *inp, size_t len, u32 padbit); ++asmlinkage void poly1305_emit_neon(void *ctx, u8 mac[16], const u32 nonce[4]); ++asmlinkage void chacha20_neon(u8 *out, const u8 *in, size_t len, const u32 key[8], const u32 counter[4]); ++#endif ++static bool chacha20poly1305_use_neon __read_mostly; ++void __init chacha20poly1305_fpu_init(void) ++{ ++#if defined(CONFIG_ARM64) ++ chacha20poly1305_use_neon = elf_hwcap & HWCAP_ASIMD; ++#elif defined(CONFIG_ARM) ++ chacha20poly1305_use_neon = elf_hwcap & HWCAP_NEON; ++#endif ++} ++#elif defined(CONFIG_MIPS) && defined(CONFIG_64BIT) ++asmlinkage void poly1305_init_mips(void *ctx, const u8 key[16]); ++asmlinkage void poly1305_blocks_mips(void *ctx, const u8 *inp, size_t len, u32 padbit); ++asmlinkage void poly1305_emit_mips(void *ctx, u8 mac[16], const u32 nonce[4]); ++void __init chacha20poly1305_fpu_init(void) { } ++#else ++void __init chacha20poly1305_fpu_init(void) { } ++#endif ++ ++enum { ++ CHACHA20_IV_SIZE = 16, ++ CHACHA20_KEY_SIZE = 32, ++ CHACHA20_BLOCK_SIZE = 64, ++ POLY1305_BLOCK_SIZE = 16, ++ POLY1305_KEY_SIZE = 32, ++ POLY1305_MAC_SIZE = 16 ++}; ++ ++static inline u32 le32_to_cpuvp(const void *p) ++{ ++ return le32_to_cpup(p); ++} ++ ++static inline u64 le64_to_cpuvp(const void *p) ++{ ++ return le64_to_cpup(p); ++} ++ ++struct chacha20_ctx { ++ u32 state[CHACHA20_BLOCK_SIZE / sizeof(u32)]; ++} __aligned(32); ++ ++#define QUARTER_ROUND(x, a, b, c, d) ( \ ++ x[a] += x[b], \ ++ x[d] = rol32((x[d] ^ x[a]), 16), \ ++ x[c] += x[d], \ ++ x[b] = rol32((x[b] ^ x[c]), 12), \ ++ x[a] += x[b], \ ++ x[d] = rol32((x[d] ^ x[a]), 8), \ ++ x[c] += x[d], \ ++ x[b] = rol32((x[b] ^ x[c]), 7) \ ++) ++ ++#define C(i, j) (i * 4 + j) ++ ++#define DOUBLE_ROUND(x) ( \ ++ /* Column Round */ \ ++ QUARTER_ROUND(x, C(0, 0), C(1, 0), C(2, 0), C(3, 0)), \ ++ QUARTER_ROUND(x, C(0, 1), C(1, 1), C(2, 1), C(3, 1)), \ ++ QUARTER_ROUND(x, C(0, 2), C(1, 2), C(2, 2), C(3, 2)), \ ++ QUARTER_ROUND(x, C(0, 3), C(1, 3), C(2, 3), C(3, 3)), \ ++ /* Diagonal Round */ \ ++ QUARTER_ROUND(x, C(0, 0), C(1, 1), C(2, 2), C(3, 3)), \ ++ QUARTER_ROUND(x, C(0, 1), C(1, 2), C(2, 3), C(3, 0)), \ ++ QUARTER_ROUND(x, C(0, 2), C(1, 3), C(2, 0), C(3, 1)), \ ++ QUARTER_ROUND(x, C(0, 3), C(1, 0), C(2, 1), C(3, 2)) \ ++) ++ ++#define TWENTY_ROUNDS(x) ( \ ++ DOUBLE_ROUND(x), \ ++ DOUBLE_ROUND(x), \ ++ DOUBLE_ROUND(x), \ ++ DOUBLE_ROUND(x), \ ++ DOUBLE_ROUND(x), \ ++ DOUBLE_ROUND(x), \ ++ DOUBLE_ROUND(x), \ ++ DOUBLE_ROUND(x), \ ++ DOUBLE_ROUND(x), \ ++ DOUBLE_ROUND(x) \ ++) ++ ++static void chacha20_block_generic(struct chacha20_ctx *ctx, __le32 *stream) ++{ ++ u32 x[CHACHA20_BLOCK_SIZE / sizeof(u32)]; ++ int i; ++ ++ for (i = 0; i < ARRAY_SIZE(x); ++i) ++ x[i] = ctx->state[i]; ++ ++ TWENTY_ROUNDS(x); ++ ++ for (i = 0; i < ARRAY_SIZE(x); ++i) ++ stream[i] = cpu_to_le32(x[i] + ctx->state[i]); ++ ++ ++ctx->state[12]; ++} ++ ++static void hchacha20_generic(u8 derived_key[CHACHA20POLY1305_KEYLEN], const u8 nonce[16], const u8 key[CHACHA20POLY1305_KEYLEN]) ++{ ++ __le32 *out = (__force __le32 *)derived_key; ++ u32 x[] = { ++ 0x61707865, 0x3320646e, 0x79622d32, 0x6b206574, ++ le32_to_cpuvp(key + 0), le32_to_cpuvp(key + 4), le32_to_cpuvp(key + 8), le32_to_cpuvp(key + 12), ++ le32_to_cpuvp(key + 16), le32_to_cpuvp(key + 20), le32_to_cpuvp(key + 24), le32_to_cpuvp(key + 28), ++ le32_to_cpuvp(nonce + 0), le32_to_cpuvp(nonce + 4), le32_to_cpuvp(nonce + 8), le32_to_cpuvp(nonce + 12) ++ }; ++ ++ TWENTY_ROUNDS(x); ++ ++ out[0] = cpu_to_le32(x[0]); ++ out[1] = cpu_to_le32(x[1]); ++ out[2] = cpu_to_le32(x[2]); ++ out[3] = cpu_to_le32(x[3]); ++ out[4] = cpu_to_le32(x[12]); ++ out[5] = cpu_to_le32(x[13]); ++ out[6] = cpu_to_le32(x[14]); ++ out[7] = cpu_to_le32(x[15]); ++} ++ ++static inline void hchacha20(u8 derived_key[CHACHA20POLY1305_KEYLEN], const u8 nonce[16], const u8 key[CHACHA20POLY1305_KEYLEN], bool have_simd) ++{ ++#if defined(CONFIG_X86_64) && defined(CONFIG_AS_SSSE3) ++ if (have_simd && chacha20poly1305_use_ssse3) { ++ hchacha20_ssse3(derived_key, nonce, key); ++ return; ++ } ++#endif ++ ++ hchacha20_generic(derived_key, nonce, key); ++} ++ ++#define chacha20_initial_state(key, nonce) {{ \ ++ 0x61707865, 0x3320646e, 0x79622d32, 0x6b206574, \ ++ le32_to_cpuvp((key) + 0), le32_to_cpuvp((key) + 4), le32_to_cpuvp((key) + 8), le32_to_cpuvp((key) + 12), \ ++ le32_to_cpuvp((key) + 16), le32_to_cpuvp((key) + 20), le32_to_cpuvp((key) + 24), le32_to_cpuvp((key) + 28), \ ++ 0, 0, le32_to_cpuvp((nonce) + 0), le32_to_cpuvp((nonce) + 4) \ ++}} ++ ++static void chacha20_crypt(struct chacha20_ctx *ctx, u8 *dst, const u8 *src, u32 bytes, bool have_simd) ++{ ++ __le32 buf[CHACHA20_BLOCK_SIZE / sizeof(__le32)]; ++ ++ if (!have_simd ++#if defined(CONFIG_X86_64) ++ || !chacha20poly1305_use_ssse3 ++ ++#elif defined(ARM_USE_NEON) ++ || !chacha20poly1305_use_neon ++#endif ++ ) ++ goto no_simd; ++ ++#if defined(CONFIG_X86_64) ++#ifdef CONFIG_AS_AVX512 ++ if (chacha20poly1305_use_avx512) { ++ chacha20_avx512(dst, src, bytes, &ctx->state[4], &ctx->state[12]); ++ ctx->state[12] += (bytes + 63) / 64; ++ return; ++ } ++ if (chacha20poly1305_use_avx512vl) { ++ chacha20_avx512vl(dst, src, bytes, &ctx->state[4], &ctx->state[12]); ++ ctx->state[12] += (bytes + 63) / 64; ++ return; ++ } ++#endif ++#ifdef CONFIG_AS_AVX2 ++ if (chacha20poly1305_use_avx2) { ++ chacha20_avx2(dst, src, bytes, &ctx->state[4], &ctx->state[12]); ++ ctx->state[12] += (bytes + 63) / 64; ++ return; ++ } ++#endif ++#ifdef CONFIG_AS_SSSE3 ++ chacha20_ssse3(dst, src, bytes, &ctx->state[4], &ctx->state[12]); ++ ctx->state[12] += (bytes + 63) / 64; ++ return; ++#endif ++#elif defined(ARM_USE_NEON) ++ chacha20_neon(dst, src, bytes, &ctx->state[4], &ctx->state[12]); ++ ctx->state[12] += (bytes + 63) / 64; ++ return; ++#endif ++ ++no_simd: ++#if defined(CONFIG_ARM) || defined(CONFIG_ARM64) ++ chacha20_arm(dst, src, bytes, &ctx->state[4], &ctx->state[12]); ++ ctx->state[12] += (bytes + 63) / 64; ++ return; ++#endif ++ ++ if (dst != src) ++ memcpy(dst, src, bytes); ++ ++ while (bytes >= CHACHA20_BLOCK_SIZE) { ++ chacha20_block_generic(ctx, buf); ++ crypto_xor(dst, (u8 *)buf, CHACHA20_BLOCK_SIZE); ++ bytes -= CHACHA20_BLOCK_SIZE; ++ dst += CHACHA20_BLOCK_SIZE; ++ } ++ if (bytes) { ++ chacha20_block_generic(ctx, buf); ++ crypto_xor(dst, (u8 *)buf, bytes); ++ } ++} ++ ++struct poly1305_ctx { ++ u8 opaque[24 * sizeof(u64)]; ++ u32 nonce[4]; ++ u8 data[POLY1305_BLOCK_SIZE]; ++ size_t num; ++} __aligned(8); ++ ++#if !(defined(CONFIG_X86_64) || defined(CONFIG_ARM) || defined(CONFIG_ARM64) || (defined(CONFIG_MIPS) && defined(CONFIG_64BIT))) ++struct poly1305_internal { ++ u32 h[5]; ++ u32 r[4]; ++}; ++ ++static void poly1305_init_generic(void *ctx, const u8 key[16]) ++{ ++ struct poly1305_internal *st = (struct poly1305_internal *)ctx; ++ ++ /* h = 0 */ ++ st->h[0] = 0; ++ st->h[1] = 0; ++ st->h[2] = 0; ++ st->h[3] = 0; ++ st->h[4] = 0; ++ ++ /* r &= 0xffffffc0ffffffc0ffffffc0fffffff */ ++ st->r[0] = le32_to_cpuvp(&key[ 0]) & 0x0fffffff; ++ st->r[1] = le32_to_cpuvp(&key[ 4]) & 0x0ffffffc; ++ st->r[2] = le32_to_cpuvp(&key[ 8]) & 0x0ffffffc; ++ st->r[3] = le32_to_cpuvp(&key[12]) & 0x0ffffffc; ++} ++ ++static void poly1305_blocks_generic(void *ctx, const u8 *inp, size_t len, u32 padbit) ++{ ++#define CONSTANT_TIME_CARRY(a,b) ((a ^ ((a ^ b) | ((a - b) ^ b))) >> (sizeof(a) * 8 - 1)) ++ struct poly1305_internal *st = (struct poly1305_internal *)ctx; ++ u32 r0, r1, r2, r3; ++ u32 s1, s2, s3; ++ u32 h0, h1, h2, h3, h4, c; ++ u64 d0, d1, d2, d3; ++ ++ r0 = st->r[0]; ++ r1 = st->r[1]; ++ r2 = st->r[2]; ++ r3 = st->r[3]; ++ ++ s1 = r1 + (r1 >> 2); ++ s2 = r2 + (r2 >> 2); ++ s3 = r3 + (r3 >> 2); ++ ++ h0 = st->h[0]; ++ h1 = st->h[1]; ++ h2 = st->h[2]; ++ h3 = st->h[3]; ++ h4 = st->h[4]; ++ ++ while (len >= POLY1305_BLOCK_SIZE) { ++ /* h += m[i] */ ++ h0 = (u32)(d0 = (u64)h0 + le32_to_cpuvp(inp + 0)); ++ h1 = (u32)(d1 = (u64)h1 + (d0 >> 32) + le32_to_cpuvp(inp + 4)); ++ h2 = (u32)(d2 = (u64)h2 + (d1 >> 32) + le32_to_cpuvp(inp + 8)); ++ h3 = (u32)(d3 = (u64)h3 + (d2 >> 32) + le32_to_cpuvp(inp + 12)); ++ h4 += (u32)(d3 >> 32) + padbit; ++ ++ /* h *= r "%" p, where "%" stands for "partial remainder" */ ++ d0 = ((u64)h0 * r0) + ++ ((u64)h1 * s3) + ++ ((u64)h2 * s2) + ++ ((u64)h3 * s1); ++ d1 = ((u64)h0 * r1) + ++ ((u64)h1 * r0) + ++ ((u64)h2 * s3) + ++ ((u64)h3 * s2) + ++ (h4 * s1); ++ d2 = ((u64)h0 * r2) + ++ ((u64)h1 * r1) + ++ ((u64)h2 * r0) + ++ ((u64)h3 * s3) + ++ (h4 * s2); ++ d3 = ((u64)h0 * r3) + ++ ((u64)h1 * r2) + ++ ((u64)h2 * r1) + ++ ((u64)h3 * r0) + ++ (h4 * s3); ++ h4 = (h4 * r0); ++ ++ /* last reduction step: */ ++ /* a) h4:h0 = h4<<128 + d3<<96 + d2<<64 + d1<<32 + d0 */ ++ h0 = (u32)d0; ++ h1 = (u32)(d1 += d0 >> 32); ++ h2 = (u32)(d2 += d1 >> 32); ++ h3 = (u32)(d3 += d2 >> 32); ++ h4 += (u32)(d3 >> 32); ++ /* b) (h4:h0 += (h4:h0>>130) * 5) %= 2^130 */ ++ c = (h4 >> 2) + (h4 & ~3U); ++ h4 &= 3; ++ h0 += c; ++ h1 += (c = CONSTANT_TIME_CARRY(h0,c)); ++ h2 += (c = CONSTANT_TIME_CARRY(h1,c)); ++ h3 += (c = CONSTANT_TIME_CARRY(h2,c)); ++ h4 += CONSTANT_TIME_CARRY(h3,c); ++ /* ++ * Occasional overflows to 3rd bit of h4 are taken care of ++ * "naturally". If after this point we end up at the top of ++ * this loop, then the overflow bit will be accounted for ++ * in next iteration. If we end up in poly1305_emit, then ++ * comparison to modulus below will still count as "carry ++ * into 131st bit", so that properly reduced value will be ++ * picked in conditional move. ++ */ ++ ++ inp += POLY1305_BLOCK_SIZE; ++ len -= POLY1305_BLOCK_SIZE; ++ } ++ ++ st->h[0] = h0; ++ st->h[1] = h1; ++ st->h[2] = h2; ++ st->h[3] = h3; ++ st->h[4] = h4; ++#undef CONSTANT_TIME_CARRY ++} ++ ++static void poly1305_emit_generic(void *ctx, u8 mac[16], const u32 nonce[4]) ++{ ++ struct poly1305_internal *st = (struct poly1305_internal *)ctx; ++ __le32 *omac = (__force __le32 *)mac; ++ u32 h0, h1, h2, h3, h4; ++ u32 g0, g1, g2, g3, g4; ++ u64 t; ++ u32 mask; ++ ++ h0 = st->h[0]; ++ h1 = st->h[1]; ++ h2 = st->h[2]; ++ h3 = st->h[3]; ++ h4 = st->h[4]; ++ ++ /* compare to modulus by computing h + -p */ ++ g0 = (u32)(t = (u64)h0 + 5); ++ g1 = (u32)(t = (u64)h1 + (t >> 32)); ++ g2 = (u32)(t = (u64)h2 + (t >> 32)); ++ g3 = (u32)(t = (u64)h3 + (t >> 32)); ++ g4 = h4 + (u32)(t >> 32); ++ ++ /* if there was carry into 131st bit, h3:h0 = g3:g0 */ ++ mask = 0 - (g4 >> 2); ++ g0 &= mask; ++ g1 &= mask; ++ g2 &= mask; ++ g3 &= mask; ++ mask = ~mask; ++ h0 = (h0 & mask) | g0; ++ h1 = (h1 & mask) | g1; ++ h2 = (h2 & mask) | g2; ++ h3 = (h3 & mask) | g3; ++ ++ /* mac = (h + nonce) % (2^128) */ ++ h0 = (u32)(t = (u64)h0 + nonce[0]); ++ h1 = (u32)(t = (u64)h1 + (t >> 32) + nonce[1]); ++ h2 = (u32)(t = (u64)h2 + (t >> 32) + nonce[2]); ++ h3 = (u32)(t = (u64)h3 + (t >> 32) + nonce[3]); ++ ++ omac[0] = cpu_to_le32(h0); ++ omac[1] = cpu_to_le32(h1); ++ omac[2] = cpu_to_le32(h2); ++ omac[3] = cpu_to_le32(h3); ++} ++#endif ++ ++static void poly1305_init(struct poly1305_ctx *ctx, const u8 key[POLY1305_KEY_SIZE], bool have_simd) ++{ ++ ctx->nonce[0] = le32_to_cpuvp(&key[16]); ++ ctx->nonce[1] = le32_to_cpuvp(&key[20]); ++ ctx->nonce[2] = le32_to_cpuvp(&key[24]); ++ ctx->nonce[3] = le32_to_cpuvp(&key[28]); ++ ++#if defined(CONFIG_X86_64) ++ poly1305_init_x86_64(ctx->opaque, key); ++#elif defined(CONFIG_ARM) || defined(CONFIG_ARM64) ++ poly1305_init_arm(ctx->opaque, key); ++#elif defined(CONFIG_MIPS) && defined(CONFIG_64BIT) ++ poly1305_init_mips(ctx->opaque, key); ++#else ++ poly1305_init_generic(ctx->opaque, key); ++#endif ++ ctx->num = 0; ++} ++ ++static inline void poly1305_blocks(void *ctx, const u8 *inp, size_t len, u32 padbit, bool have_simd) ++{ ++#if defined(CONFIG_X86_64) ++#ifdef CONFIG_AS_AVX512 ++ if(chacha20poly1305_use_avx512 && have_simd) ++ poly1305_blocks_avx512(ctx, inp, len, padbit); ++ else ++#endif ++#ifdef CONFIG_AS_AVX2 ++ if (chacha20poly1305_use_avx2 && have_simd) ++ poly1305_blocks_avx2(ctx, inp, len, padbit); ++ else ++#endif ++#ifdef CONFIG_AS_AVX ++ if (chacha20poly1305_use_avx && have_simd) ++ poly1305_blocks_avx(ctx, inp, len, padbit); ++ else ++#endif ++ poly1305_blocks_x86_64(ctx, inp, len, padbit); ++#elif defined(CONFIG_ARM) || defined(CONFIG_ARM64) ++#if defined(ARM_USE_NEON) ++ if (chacha20poly1305_use_neon && have_simd) ++ poly1305_blocks_neon(ctx, inp, len, padbit); ++ else ++#endif ++ poly1305_blocks_arm(ctx, inp, len, padbit); ++#elif defined(CONFIG_MIPS) && defined(CONFIG_64BIT) ++ poly1305_blocks_mips(ctx, inp, len, padbit); ++#else ++ poly1305_blocks_generic(ctx, inp, len, padbit); ++#endif ++} ++ ++static inline void poly1305_emit(void *ctx, u8 mac[16], const u32 nonce[4], bool have_simd) ++{ ++#if defined(CONFIG_X86_64) ++#ifdef CONFIG_AS_AVX512 ++ if(chacha20poly1305_use_avx512 && have_simd) ++ poly1305_emit_avx(ctx, mac, nonce); ++ else ++#endif ++#ifdef CONFIG_AS_AVX2 ++ if (chacha20poly1305_use_avx2 && have_simd) ++ poly1305_emit_avx(ctx, mac, nonce); ++ else ++#endif ++#ifdef CONFIG_AS_AVX ++ if (chacha20poly1305_use_avx && have_simd) ++ poly1305_emit_avx(ctx, mac, nonce); ++ else ++#endif ++ poly1305_emit_x86_64(ctx, mac, nonce); ++#elif defined(CONFIG_ARM) || defined(CONFIG_ARM64) ++#if defined(ARM_USE_NEON) ++ if (chacha20poly1305_use_neon && have_simd) ++ poly1305_emit_neon(ctx, mac, nonce); ++ else ++#endif ++ poly1305_emit_arm(ctx, mac, nonce); ++#elif defined(CONFIG_MIPS) && defined(CONFIG_64BIT) ++ poly1305_emit_mips(ctx, mac, nonce); ++#else ++ poly1305_emit_generic(ctx, mac, nonce); ++#endif ++} ++ ++static void poly1305_update(struct poly1305_ctx *ctx, const u8 *inp, size_t len, bool have_simd) ++{ ++ const size_t num = ctx->num; ++ size_t rem; ++ ++ if (num) { ++ rem = POLY1305_BLOCK_SIZE - num; ++ if (len >= rem) { ++ memcpy(ctx->data + num, inp, rem); ++ poly1305_blocks(ctx->opaque, ctx->data, POLY1305_BLOCK_SIZE, 1, have_simd); ++ inp += rem; ++ len -= rem; ++ } else { ++ /* Still not enough data to process a block. */ ++ memcpy(ctx->data + num, inp, len); ++ ctx->num = num + len; ++ return; ++ } ++ } ++ ++ rem = len % POLY1305_BLOCK_SIZE; ++ len -= rem; ++ ++ if (len >= POLY1305_BLOCK_SIZE) { ++ poly1305_blocks(ctx->opaque, inp, len, 1, have_simd); ++ inp += len; ++ } ++ ++ if (rem) ++ memcpy(ctx->data, inp, rem); ++ ++ ctx->num = rem; ++} ++ ++static void poly1305_finish(struct poly1305_ctx *ctx, u8 mac[16], bool have_simd) ++{ ++ size_t num = ctx->num; ++ ++ if (num) { ++ ctx->data[num++] = 1; /* pad bit */ ++ while (num < POLY1305_BLOCK_SIZE) ++ ctx->data[num++] = 0; ++ poly1305_blocks(ctx->opaque, ctx->data, POLY1305_BLOCK_SIZE, 0, have_simd); ++ } ++ ++ poly1305_emit(ctx->opaque, mac, ctx->nonce, have_simd); ++ ++ /* zero out the state */ ++ memzero_explicit(ctx, sizeof(*ctx)); ++} ++ ++ ++static const u8 pad0[16] = { 0 }; ++ ++static struct crypto_alg chacha20_alg = { ++ .cra_blocksize = 1, ++ .cra_alignmask = sizeof(u32) - 1 ++}; ++static struct crypto_blkcipher chacha20_cipher = { ++ .base = { ++ .__crt_alg = &chacha20_alg ++ } ++}; ++static struct blkcipher_desc chacha20_desc = { ++ .tfm = &chacha20_cipher ++}; ++ ++static inline void __chacha20poly1305_encrypt(u8 *dst, const u8 *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN], ++ bool have_simd) ++{ ++ __le64 len, le_nonce = cpu_to_le64(nonce); ++ struct poly1305_ctx poly1305_state; ++ struct chacha20_ctx chacha20_state = chacha20_initial_state(key, (u8 *)&le_nonce); ++ u8 block0[CHACHA20_BLOCK_SIZE] = { 0 }; ++ ++ chacha20_crypt(&chacha20_state, block0, block0, sizeof(block0), have_simd); ++ poly1305_init(&poly1305_state, block0, have_simd); ++ memzero_explicit(block0, sizeof(block0)); ++ ++ poly1305_update(&poly1305_state, ad, ad_len, have_simd); ++ poly1305_update(&poly1305_state, pad0, (0x10 - ad_len) & 0xf, have_simd); ++ ++ chacha20_crypt(&chacha20_state, dst, src, src_len, have_simd); ++ ++ poly1305_update(&poly1305_state, dst, src_len, have_simd); ++ poly1305_update(&poly1305_state, pad0, (0x10 - src_len) & 0xf, have_simd); ++ ++ len = cpu_to_le64(ad_len); ++ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); ++ ++ len = cpu_to_le64(src_len); ++ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); ++ ++ poly1305_finish(&poly1305_state, dst + src_len, have_simd); ++ ++ memzero_explicit(&chacha20_state, sizeof(chacha20_state)); ++} ++ ++void chacha20poly1305_encrypt(u8 *dst, const u8 *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN]) ++{ ++ bool have_simd; ++ ++ have_simd = chacha20poly1305_init_simd(); ++ __chacha20poly1305_encrypt(dst, src, src_len, ad, ad_len, nonce, key, have_simd); ++ chacha20poly1305_deinit_simd(have_simd); ++} ++ ++bool chacha20poly1305_encrypt_sg(struct scatterlist *dst, struct scatterlist *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN], ++ bool have_simd) ++{ ++ __le64 len, le_nonce = cpu_to_le64(nonce); ++ struct poly1305_ctx poly1305_state; ++ struct chacha20_ctx chacha20_state = chacha20_initial_state(key, (u8 *)&le_nonce); ++ int ret = 0; ++ struct blkcipher_walk walk; ++ u8 block0[CHACHA20_BLOCK_SIZE] = { 0 }; ++ u8 mac[POLY1305_MAC_SIZE]; ++ ++ chacha20_crypt(&chacha20_state, block0, block0, sizeof(block0), have_simd); ++ poly1305_init(&poly1305_state, block0, have_simd); ++ memzero_explicit(block0, sizeof(block0)); ++ ++ poly1305_update(&poly1305_state, ad, ad_len, have_simd); ++ poly1305_update(&poly1305_state, pad0, (0x10 - ad_len) & 0xf, have_simd); ++ ++ if (likely(src_len)) { ++ blkcipher_walk_init(&walk, dst, src, src_len); ++ ret = blkcipher_walk_virt_block(&chacha20_desc, &walk, CHACHA20_BLOCK_SIZE); ++ while (walk.nbytes >= CHACHA20_BLOCK_SIZE) { ++ size_t chunk_len = rounddown(walk.nbytes, CHACHA20_BLOCK_SIZE); ++ ++ chacha20_crypt(&chacha20_state, walk.dst.virt.addr, walk.src.virt.addr, chunk_len, have_simd); ++ poly1305_update(&poly1305_state, walk.dst.virt.addr, chunk_len, have_simd); ++ ret = blkcipher_walk_done(&chacha20_desc, &walk, walk.nbytes % CHACHA20_BLOCK_SIZE); ++ } ++ if (walk.nbytes) { ++ chacha20_crypt(&chacha20_state, walk.dst.virt.addr, walk.src.virt.addr, walk.nbytes, have_simd); ++ poly1305_update(&poly1305_state, walk.dst.virt.addr, walk.nbytes, have_simd); ++ ret = blkcipher_walk_done(&chacha20_desc, &walk, 0); ++ } ++ } ++ if (unlikely(ret)) ++ goto err; ++ ++ poly1305_update(&poly1305_state, pad0, (0x10 - src_len) & 0xf, have_simd); ++ ++ len = cpu_to_le64(ad_len); ++ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); ++ ++ len = cpu_to_le64(src_len); ++ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); ++ ++ poly1305_finish(&poly1305_state, mac, have_simd); ++ scatterwalk_map_and_copy(mac, dst, src_len, sizeof(mac), 1); ++err: ++ memzero_explicit(&chacha20_state, sizeof(chacha20_state)); ++ memzero_explicit(mac, sizeof(mac)); ++ return !ret; ++} ++ ++static inline bool __chacha20poly1305_decrypt(u8 *dst, const u8 *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN], ++ bool have_simd) ++{ ++ __le64 len, le_nonce = cpu_to_le64(nonce); ++ struct poly1305_ctx poly1305_state; ++ struct chacha20_ctx chacha20_state = chacha20_initial_state(key, (u8 *)&le_nonce); ++ int ret; ++ u8 block0[CHACHA20_BLOCK_SIZE] = { 0 }; ++ u8 mac[POLY1305_MAC_SIZE]; ++ size_t dst_len; ++ ++ if (unlikely(src_len < POLY1305_MAC_SIZE)) ++ return false; ++ ++ chacha20_crypt(&chacha20_state, block0, block0, sizeof(block0), have_simd); ++ poly1305_init(&poly1305_state, block0, have_simd); ++ memzero_explicit(block0, sizeof(block0)); ++ ++ poly1305_update(&poly1305_state, ad, ad_len, have_simd); ++ poly1305_update(&poly1305_state, pad0, (0x10 - ad_len) & 0xf, have_simd); ++ ++ dst_len = src_len - POLY1305_MAC_SIZE; ++ poly1305_update(&poly1305_state, src, dst_len, have_simd); ++ poly1305_update(&poly1305_state, pad0, (0x10 - dst_len) & 0xf, have_simd); ++ ++ len = cpu_to_le64(ad_len); ++ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); ++ ++ len = cpu_to_le64(dst_len); ++ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); ++ ++ poly1305_finish(&poly1305_state, mac, have_simd); ++ ++ ret = crypto_memneq(mac, src + dst_len, POLY1305_MAC_SIZE); ++ memzero_explicit(mac, POLY1305_MAC_SIZE); ++ if (likely(!ret)) ++ chacha20_crypt(&chacha20_state, dst, src, dst_len, have_simd); ++ ++ memzero_explicit(&chacha20_state, sizeof(chacha20_state)); ++ ++ return !ret; ++} ++ ++bool chacha20poly1305_decrypt(u8 *dst, const u8 *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN]) ++{ ++ bool have_simd, ret; ++ ++ have_simd = chacha20poly1305_init_simd(); ++ ret = __chacha20poly1305_decrypt(dst, src, src_len, ad, ad_len, nonce, key, have_simd); ++ chacha20poly1305_deinit_simd(have_simd); ++ return ret; ++} ++ ++bool chacha20poly1305_decrypt_sg(struct scatterlist *dst, struct scatterlist *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN], ++ bool have_simd) ++{ ++ __le64 len, le_nonce = cpu_to_le64(nonce); ++ struct poly1305_ctx poly1305_state; ++ struct chacha20_ctx chacha20_state = chacha20_initial_state(key, (u8 *)&le_nonce); ++ struct blkcipher_walk walk; ++ int ret = 0; ++ u8 block0[CHACHA20_BLOCK_SIZE] = { 0 }; ++ u8 read_mac[POLY1305_MAC_SIZE], computed_mac[POLY1305_MAC_SIZE]; ++ size_t dst_len; ++ ++ if (unlikely(src_len < POLY1305_MAC_SIZE)) ++ return false; ++ ++ chacha20_crypt(&chacha20_state, block0, block0, sizeof(block0), have_simd); ++ poly1305_init(&poly1305_state, block0, have_simd); ++ memzero_explicit(block0, sizeof(block0)); ++ ++ poly1305_update(&poly1305_state, ad, ad_len, have_simd); ++ poly1305_update(&poly1305_state, pad0, (0x10 - ad_len) & 0xf, have_simd); ++ ++ dst_len = src_len - POLY1305_MAC_SIZE; ++ if (likely(dst_len)) { ++ blkcipher_walk_init(&walk, dst, src, dst_len); ++ ret = blkcipher_walk_virt_block(&chacha20_desc, &walk, CHACHA20_BLOCK_SIZE); ++ while (walk.nbytes >= CHACHA20_BLOCK_SIZE) { ++ size_t chunk_len = rounddown(walk.nbytes, CHACHA20_BLOCK_SIZE); ++ ++ poly1305_update(&poly1305_state, walk.src.virt.addr, chunk_len, have_simd); ++ chacha20_crypt(&chacha20_state, walk.dst.virt.addr, walk.src.virt.addr, chunk_len, have_simd); ++ ret = blkcipher_walk_done(&chacha20_desc, &walk, walk.nbytes % CHACHA20_BLOCK_SIZE); ++ } ++ if (walk.nbytes) { ++ poly1305_update(&poly1305_state, walk.src.virt.addr, walk.nbytes, have_simd); ++ chacha20_crypt(&chacha20_state, walk.dst.virt.addr, walk.src.virt.addr, walk.nbytes, have_simd); ++ ret = blkcipher_walk_done(&chacha20_desc, &walk, 0); ++ } ++ } ++ if (unlikely(ret)) ++ goto err; ++ ++ poly1305_update(&poly1305_state, pad0, (0x10 - dst_len) & 0xf, have_simd); ++ ++ len = cpu_to_le64(ad_len); ++ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); ++ ++ len = cpu_to_le64(dst_len); ++ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); ++ ++ poly1305_finish(&poly1305_state, computed_mac, have_simd); ++ ++ scatterwalk_map_and_copy(read_mac, src, dst_len, POLY1305_MAC_SIZE, 0); ++ ret = crypto_memneq(read_mac, computed_mac, POLY1305_MAC_SIZE); ++err: ++ memzero_explicit(read_mac, POLY1305_MAC_SIZE); ++ memzero_explicit(computed_mac, POLY1305_MAC_SIZE); ++ memzero_explicit(&chacha20_state, sizeof(chacha20_state)); ++ return !ret; ++} ++ ++ ++void xchacha20poly1305_encrypt(u8 *dst, const u8 *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u8 nonce[XCHACHA20POLY1305_NONCELEN], ++ const u8 key[CHACHA20POLY1305_KEYLEN]) ++{ ++ bool have_simd = chacha20poly1305_init_simd(); ++ u8 derived_key[CHACHA20POLY1305_KEYLEN] __aligned(16); ++ ++ hchacha20(derived_key, nonce, key, have_simd); ++ __chacha20poly1305_encrypt(dst, src, src_len, ad, ad_len, le64_to_cpuvp(nonce + 16), derived_key, have_simd); ++ memzero_explicit(derived_key, CHACHA20POLY1305_KEYLEN); ++ chacha20poly1305_deinit_simd(have_simd); ++} ++ ++bool xchacha20poly1305_decrypt(u8 *dst, const u8 *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u8 nonce[XCHACHA20POLY1305_NONCELEN], ++ const u8 key[CHACHA20POLY1305_KEYLEN]) ++{ ++ bool ret, have_simd = chacha20poly1305_init_simd(); ++ u8 derived_key[CHACHA20POLY1305_KEYLEN] __aligned(16); ++ ++ hchacha20(derived_key, nonce, key, have_simd); ++ ret = __chacha20poly1305_decrypt(dst, src, src_len, ad, ad_len, le64_to_cpuvp(nonce + 16), derived_key, have_simd); ++ memzero_explicit(derived_key, CHACHA20POLY1305_KEYLEN); ++ chacha20poly1305_deinit_simd(have_simd); ++ return ret; ++} ++ ++#include "../selftest/chacha20poly1305.h" ++#include "../selftest/poly1305.h" +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/curve25519.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,81 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include "curve25519.h" ++ ++#include ++#include ++#include ++#include ++ ++static __always_inline void normalize_secret(u8 secret[CURVE25519_POINT_SIZE]) ++{ ++ secret[0] &= 248; ++ secret[31] &= 127; ++ secret[31] |= 64; ++} ++ ++#if defined(CONFIG_X86_64) && defined(CONFIG_AS_AVX) ++#include "curve25519-x86_64.h" ++#elif IS_ENABLED(CONFIG_KERNEL_MODE_NEON) && defined(CONFIG_ARM) ++#include "curve25519-arm.h" ++#else ++void __init curve25519_fpu_init(void) { } ++#endif ++ ++#if defined(CONFIG_ARCH_SUPPORTS_INT128) && defined(__SIZEOF_INT128__) ++#include "curve25519-hacl64.h" ++#else ++#include "curve25519-fiat32.h" ++#endif ++ ++static const u8 null_point[CURVE25519_POINT_SIZE] = { 0 }; ++ ++bool curve25519(u8 mypublic[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE], const u8 basepoint[CURVE25519_POINT_SIZE]) ++{ ++#if defined(CONFIG_X86_64) && defined(CONFIG_AS_AVX) ++ if (curve25519_use_avx && irq_fpu_usable()) { ++ kernel_fpu_begin(); ++ curve25519_sandy2x(mypublic, secret, basepoint); ++ kernel_fpu_end(); ++ } else ++#elif IS_ENABLED(CONFIG_KERNEL_MODE_NEON) && defined(CONFIG_ARM) ++ if (curve25519_use_neon && may_use_simd()) { ++ kernel_neon_begin(); ++ curve25519_neon(mypublic, secret, basepoint); ++ kernel_neon_end(); ++ } else ++#endif ++ curve25519_generic(mypublic, secret, basepoint); ++ ++ return crypto_memneq(mypublic, null_point, CURVE25519_POINT_SIZE); ++} ++ ++bool curve25519_generate_public(u8 pub[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE]) ++{ ++ static const u8 basepoint[CURVE25519_POINT_SIZE] __aligned(32) = { 9 }; ++ ++ if (unlikely(!crypto_memneq(secret, null_point, CURVE25519_POINT_SIZE))) ++ return false; ++ ++#if defined(CONFIG_X86_64) && defined(CONFIG_AS_AVX) ++ if (curve25519_use_avx && irq_fpu_usable()) { ++ kernel_fpu_begin(); ++ curve25519_sandy2x_base(pub, secret); ++ kernel_fpu_end(); ++ return crypto_memneq(pub, null_point, CURVE25519_POINT_SIZE); ++ } ++#endif ++ ++ return curve25519(pub, secret, basepoint); ++} ++ ++void curve25519_generate_secret(u8 secret[CURVE25519_POINT_SIZE]) ++{ ++ get_random_bytes_wait(secret, CURVE25519_POINT_SIZE); ++ normalize_secret(secret); ++} ++ ++#include "../selftest/curve25519.h" +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/blake2s.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,94 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_BLAKE2S_H ++#define _WG_BLAKE2S_H ++ ++#include ++#include ++#include ++ ++enum blake2s_lengths { ++ BLAKE2S_BLOCKBYTES = 64, ++ BLAKE2S_OUTBYTES = 32, ++ BLAKE2S_KEYBYTES = 32 ++}; ++ ++struct blake2s_state { ++ u32 h[8]; ++ u32 t[2]; ++ u32 f[2]; ++ u8 buf[BLAKE2S_BLOCKBYTES]; ++ size_t buflen; ++ u8 last_node; ++}; ++ ++void blake2s_init(struct blake2s_state *state, const size_t outlen); ++void blake2s_init_key(struct blake2s_state *state, const size_t outlen, const void *key, const size_t keylen); ++void blake2s_update(struct blake2s_state *state, const u8 *in, size_t inlen); ++void __blake2s_final(struct blake2s_state *state); ++static inline void blake2s_final(struct blake2s_state *state, u8 *out, size_t outlen) ++{ ++ int i; ++ ++#ifdef DEBUG ++ BUG_ON(!out || !outlen || outlen > BLAKE2S_OUTBYTES); ++#endif ++ __blake2s_final(state); ++ ++ if (__builtin_constant_p(outlen) && !(outlen % sizeof(u32))) { ++ if (IS_ENABLED(CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS) || IS_ALIGNED((unsigned long)out, __alignof__(u32))) { ++ __le32 *outwords = (__le32 *)out; ++ ++ for (i = 0; i < outlen / sizeof(u32); ++i) ++ outwords[i] = cpu_to_le32(state->h[i]); ++ } else { ++ __le32 buffer[BLAKE2S_OUTBYTES]; ++ ++ for (i = 0; i < outlen / sizeof(u32); ++i) ++ buffer[i] = cpu_to_le32(state->h[i]); ++ memcpy(out, buffer, outlen); ++ memzero_explicit(buffer, sizeof(buffer)); ++ } ++ } else { ++ u8 buffer[BLAKE2S_OUTBYTES] __aligned(__alignof__(u32)); ++ __le32 *outwords = (__le32 *)buffer; ++ ++ for (i = 0; i < 8; ++i) ++ outwords[i] = cpu_to_le32(state->h[i]); ++ memcpy(out, buffer, outlen); ++ memzero_explicit(buffer, sizeof(buffer)); ++ } ++ ++ memzero_explicit(state, sizeof(struct blake2s_state)); ++} ++ ++ ++static inline void blake2s(u8 *out, const u8 *in, const u8 *key, const size_t outlen, size_t inlen, const size_t keylen) ++{ ++ struct blake2s_state state; ++ ++#ifdef DEBUG ++ BUG_ON((!in && inlen > 0) || !out || !outlen || outlen > BLAKE2S_OUTBYTES || keylen > BLAKE2S_KEYBYTES || (!key && keylen)); ++#endif ++ ++ if (keylen) ++ blake2s_init_key(&state, outlen, key, keylen); ++ else ++ blake2s_init(&state, outlen); ++ ++ blake2s_update(&state, in, inlen); ++ blake2s_final(&state, out, outlen); ++} ++ ++void blake2s_hmac(u8 *out, const u8 *in, const u8 *key, const size_t outlen, const size_t inlen, const size_t keylen); ++ ++void blake2s_fpu_init(void); ++ ++#ifdef DEBUG ++bool blake2s_selftest(void); ++#endif ++ ++#endif /* _WG_BLAKE2S_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/chacha20poly1305.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,93 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_CHACHA20POLY1305_H ++#define _WG_CHACHA20POLY1305_H ++ ++#include ++ ++struct scatterlist; ++ ++enum chacha20poly1305_lengths { ++ XCHACHA20POLY1305_NONCELEN = 24, ++ CHACHA20POLY1305_KEYLEN = 32, ++ CHACHA20POLY1305_AUTHTAGLEN = 16 ++}; ++ ++void chacha20poly1305_fpu_init(void); ++ ++void chacha20poly1305_encrypt(u8 *dst, const u8 *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN]); ++ ++bool __must_check chacha20poly1305_encrypt_sg(struct scatterlist *dst, struct scatterlist *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN], ++ bool have_simd); ++ ++bool __must_check chacha20poly1305_decrypt(u8 *dst, const u8 *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN]); ++ ++bool __must_check chacha20poly1305_decrypt_sg(struct scatterlist *dst, struct scatterlist *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN], ++ bool have_simd); ++ ++void xchacha20poly1305_encrypt(u8 *dst, const u8 *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u8 nonce[XCHACHA20POLY1305_NONCELEN], ++ const u8 key[CHACHA20POLY1305_KEYLEN]); ++ ++bool __must_check xchacha20poly1305_decrypt(u8 *dst, const u8 *src, const size_t src_len, ++ const u8 *ad, const size_t ad_len, ++ const u8 nonce[XCHACHA20POLY1305_NONCELEN], ++ const u8 key[CHACHA20POLY1305_KEYLEN]); ++ ++#if defined(CONFIG_X86_64) ++#include ++#include ++#include ++#elif IS_ENABLED(CONFIG_KERNEL_MODE_NEON) ++#include ++#include ++#endif ++ ++static inline bool chacha20poly1305_init_simd(void) ++{ ++ bool have_simd = false; ++#if defined(CONFIG_X86_64) && !defined(CONFIG_UML) ++ have_simd = irq_fpu_usable(); ++ if (have_simd) ++ kernel_fpu_begin(); ++#elif IS_ENABLED(CONFIG_KERNEL_MODE_NEON) ++#if defined(CONFIG_ARM64) ++ have_simd = true; /* ARM64 supports NEON in any context. */ ++#elif defined(CONFIG_ARM) ++ have_simd = may_use_simd(); /* ARM doesn't support NEON in interrupt context. */ ++#endif ++ if (have_simd) ++ kernel_neon_begin(); ++#endif ++ return have_simd; ++} ++ ++static inline void chacha20poly1305_deinit_simd(bool was_on) ++{ ++#if defined(CONFIG_X86_64) && !defined(CONFIG_UML) ++ if (was_on) ++ kernel_fpu_end(); ++#elif IS_ENABLED(CONFIG_KERNEL_MODE_NEON) ++ if (was_on) ++ kernel_neon_end(); ++#endif ++} ++ ++#ifdef DEBUG ++bool chacha20poly1305_selftest(void); ++bool poly1305_selftest(void); ++#endif ++ ++#endif /* _WG_CHACHA20POLY1305_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/curve25519-arm.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,14 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include ++#include ++#include ++asmlinkage void curve25519_neon(u8 mypublic[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE], const u8 basepoint[CURVE25519_POINT_SIZE]); ++static bool curve25519_use_neon __read_mostly; ++void __init curve25519_fpu_init(void) ++{ ++ curve25519_use_neon = elf_hwcap & HWCAP_NEON; ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/curve25519-fiat32.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,838 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2016 The fiat-crypto Authors. ++ * Copyright (C) 2018 Jason A. Donenfeld . All Rights Reserved. ++ * ++ * This is a machine-generated formally verified implementation of curve25519 DH from: ++ * https://github.com/mit-plv/fiat-crypto ++ */ ++ ++/* fe means field element. Here the field is \Z/(2^255-19). An element t, ++ * entries t[0]...t[9], represents the integer t[0]+2^26 t[1]+2^51 t[2]+2^77 ++ * t[3]+2^102 t[4]+...+2^230 t[9]. ++ * fe limbs are bounded by 1.125*2^26,1.125*2^25,1.125*2^26,1.125*2^25,etc. ++ * Multiplication and carrying produce fe from fe_loose. ++ */ ++typedef struct fe { u32 v[10]; } fe; ++ ++/* fe_loose limbs are bounded by 3.375*2^26,3.375*2^25,3.375*2^26,3.375*2^25,etc. ++ * Addition and subtraction produce fe_loose from (fe, fe). ++ */ ++typedef struct fe_loose { u32 v[10]; } fe_loose; ++ ++static __always_inline void fe_frombytes_impl(u32 h[10], const u8 *s) ++{ ++ /* Ignores top bit of s. */ ++ u32 a0 = le32_to_cpup((__force __le32 *)(s)); ++ u32 a1 = le32_to_cpup((__force __le32 *)(s+4)); ++ u32 a2 = le32_to_cpup((__force __le32 *)(s+8)); ++ u32 a3 = le32_to_cpup((__force __le32 *)(s+12)); ++ u32 a4 = le32_to_cpup((__force __le32 *)(s+16)); ++ u32 a5 = le32_to_cpup((__force __le32 *)(s+20)); ++ u32 a6 = le32_to_cpup((__force __le32 *)(s+24)); ++ u32 a7 = le32_to_cpup((__force __le32 *)(s+28)); ++ h[0] = a0&((1<<26)-1); /* 26 used, 32-26 left. 26 */ ++ h[1] = (a0>>26) | ((a1&((1<<19)-1))<< 6); /* (32-26) + 19 = 6+19 = 25 */ ++ h[2] = (a1>>19) | ((a2&((1<<13)-1))<<13); /* (32-19) + 13 = 13+13 = 26 */ ++ h[3] = (a2>>13) | ((a3&((1<< 6)-1))<<19); /* (32-13) + 6 = 19+ 6 = 25 */ ++ h[4] = (a3>> 6); /* (32- 6) = 26 */ ++ h[5] = a4&((1<<25)-1); /* 25 */ ++ h[6] = (a4>>25) | ((a5&((1<<19)-1))<< 7); /* (32-25) + 19 = 7+19 = 26 */ ++ h[7] = (a5>>19) | ((a6&((1<<12)-1))<<13); /* (32-19) + 12 = 13+12 = 25 */ ++ h[8] = (a6>>12) | ((a7&((1<< 6)-1))<<20); /* (32-12) + 6 = 20+ 6 = 26 */ ++ h[9] = (a7>> 6)&((1<<25)-1); /* 25 */ ++} ++ ++static __always_inline void fe_frombytes(fe *h, const u8 *s) ++{ ++ fe_frombytes_impl(h->v, s); ++} ++ ++static __always_inline u8 /*bool*/ addcarryx_u25(u8 /*bool*/ c, u32 a, u32 b, u32 *low) ++{ ++ /* This function extracts 25 bits of result and 1 bit of carry (26 total), so ++ * a 32-bit intermediate is sufficient. ++ */ ++ u32 x = a + b + c; ++ *low = x & ((1 << 25) - 1); ++ return (x >> 25) & 1; ++} ++ ++static __always_inline u8 /*bool*/ addcarryx_u26(u8 /*bool*/ c, u32 a, u32 b, u32 *low) ++{ ++ /* This function extracts 26 bits of result and 1 bit of carry (27 total), so ++ * a 32-bit intermediate is sufficient. ++ */ ++ u32 x = a + b + c; ++ *low = x & ((1 << 26) - 1); ++ return (x >> 26) & 1; ++} ++ ++static __always_inline u8 /*bool*/ subborrow_u25(u8 /*bool*/ c, u32 a, u32 b, u32 *low) ++{ ++ /* This function extracts 25 bits of result and 1 bit of borrow (26 total), so ++ * a 32-bit intermediate is sufficient. ++ */ ++ u32 x = a - b - c; ++ *low = x & ((1 << 25) - 1); ++ return x >> 31; ++} ++ ++static __always_inline u8 /*bool*/ subborrow_u26(u8 /*bool*/ c, u32 a, u32 b, u32 *low) ++{ ++ /* This function extracts 26 bits of result and 1 bit of borrow (27 total), so ++ * a 32-bit intermediate is sufficient. ++ */ ++ u32 x = a - b - c; ++ *low = x & ((1 << 26) - 1); ++ return x >> 31; ++} ++ ++static __always_inline u32 cmovznz32(u32 t, u32 z, u32 nz) ++{ ++ t = -!!t; /* all set if nonzero, 0 if 0 */ ++ return (t&nz) | ((~t)&z); ++} ++ ++static __always_inline void fe_freeze(u32 out[10], const u32 in1[10]) ++{ ++ { const u32 x17 = in1[9]; ++ { const u32 x18 = in1[8]; ++ { const u32 x16 = in1[7]; ++ { const u32 x14 = in1[6]; ++ { const u32 x12 = in1[5]; ++ { const u32 x10 = in1[4]; ++ { const u32 x8 = in1[3]; ++ { const u32 x6 = in1[2]; ++ { const u32 x4 = in1[1]; ++ { const u32 x2 = in1[0]; ++ { u32 x20; u8/*bool*/ x21 = subborrow_u26(0x0, x2, 0x3ffffed, &x20); ++ { u32 x23; u8/*bool*/ x24 = subborrow_u25(x21, x4, 0x1ffffff, &x23); ++ { u32 x26; u8/*bool*/ x27 = subborrow_u26(x24, x6, 0x3ffffff, &x26); ++ { u32 x29; u8/*bool*/ x30 = subborrow_u25(x27, x8, 0x1ffffff, &x29); ++ { u32 x32; u8/*bool*/ x33 = subborrow_u26(x30, x10, 0x3ffffff, &x32); ++ { u32 x35; u8/*bool*/ x36 = subborrow_u25(x33, x12, 0x1ffffff, &x35); ++ { u32 x38; u8/*bool*/ x39 = subborrow_u26(x36, x14, 0x3ffffff, &x38); ++ { u32 x41; u8/*bool*/ x42 = subborrow_u25(x39, x16, 0x1ffffff, &x41); ++ { u32 x44; u8/*bool*/ x45 = subborrow_u26(x42, x18, 0x3ffffff, &x44); ++ { u32 x47; u8/*bool*/ x48 = subborrow_u25(x45, x17, 0x1ffffff, &x47); ++ { u32 x49 = cmovznz32(x48, 0x0, 0xffffffff); ++ { u32 x50 = (x49 & 0x3ffffed); ++ { u32 x52; u8/*bool*/ x53 = addcarryx_u26(0x0, x20, x50, &x52); ++ { u32 x54 = (x49 & 0x1ffffff); ++ { u32 x56; u8/*bool*/ x57 = addcarryx_u25(x53, x23, x54, &x56); ++ { u32 x58 = (x49 & 0x3ffffff); ++ { u32 x60; u8/*bool*/ x61 = addcarryx_u26(x57, x26, x58, &x60); ++ { u32 x62 = (x49 & 0x1ffffff); ++ { u32 x64; u8/*bool*/ x65 = addcarryx_u25(x61, x29, x62, &x64); ++ { u32 x66 = (x49 & 0x3ffffff); ++ { u32 x68; u8/*bool*/ x69 = addcarryx_u26(x65, x32, x66, &x68); ++ { u32 x70 = (x49 & 0x1ffffff); ++ { u32 x72; u8/*bool*/ x73 = addcarryx_u25(x69, x35, x70, &x72); ++ { u32 x74 = (x49 & 0x3ffffff); ++ { u32 x76; u8/*bool*/ x77 = addcarryx_u26(x73, x38, x74, &x76); ++ { u32 x78 = (x49 & 0x1ffffff); ++ { u32 x80; u8/*bool*/ x81 = addcarryx_u25(x77, x41, x78, &x80); ++ { u32 x82 = (x49 & 0x3ffffff); ++ { u32 x84; u8/*bool*/ x85 = addcarryx_u26(x81, x44, x82, &x84); ++ { u32 x86 = (x49 & 0x1ffffff); ++ { u32 x88; addcarryx_u25(x85, x47, x86, &x88); ++ out[0] = x52; ++ out[1] = x56; ++ out[2] = x60; ++ out[3] = x64; ++ out[4] = x68; ++ out[5] = x72; ++ out[6] = x76; ++ out[7] = x80; ++ out[8] = x84; ++ out[9] = x88; ++ }}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}} ++} ++ ++static __always_inline void fe_tobytes(u8 s[32], const fe *f) ++{ ++ u32 h[10]; ++ fe_freeze(h, f->v); ++ s[0] = h[0] >> 0; ++ s[1] = h[0] >> 8; ++ s[2] = h[0] >> 16; ++ s[3] = (h[0] >> 24) | (h[1] << 2); ++ s[4] = h[1] >> 6; ++ s[5] = h[1] >> 14; ++ s[6] = (h[1] >> 22) | (h[2] << 3); ++ s[7] = h[2] >> 5; ++ s[8] = h[2] >> 13; ++ s[9] = (h[2] >> 21) | (h[3] << 5); ++ s[10] = h[3] >> 3; ++ s[11] = h[3] >> 11; ++ s[12] = (h[3] >> 19) | (h[4] << 6); ++ s[13] = h[4] >> 2; ++ s[14] = h[4] >> 10; ++ s[15] = h[4] >> 18; ++ s[16] = h[5] >> 0; ++ s[17] = h[5] >> 8; ++ s[18] = h[5] >> 16; ++ s[19] = (h[5] >> 24) | (h[6] << 1); ++ s[20] = h[6] >> 7; ++ s[21] = h[6] >> 15; ++ s[22] = (h[6] >> 23) | (h[7] << 3); ++ s[23] = h[7] >> 5; ++ s[24] = h[7] >> 13; ++ s[25] = (h[7] >> 21) | (h[8] << 4); ++ s[26] = h[8] >> 4; ++ s[27] = h[8] >> 12; ++ s[28] = (h[8] >> 20) | (h[9] << 6); ++ s[29] = h[9] >> 2; ++ s[30] = h[9] >> 10; ++ s[31] = h[9] >> 18; ++} ++ ++/* h = f */ ++static __always_inline void fe_copy(fe *h, const fe *f) ++{ ++ memmove(h, f, sizeof(u32) * 10); ++} ++ ++static __always_inline void fe_copy_lt(fe_loose *h, const fe *f) ++{ ++ memmove(h, f, sizeof(u32) * 10); ++} ++ ++/* h = 0 */ ++static __always_inline void fe_0(fe *h) ++{ ++ memset(h, 0, sizeof(u32) * 10); ++} ++ ++/* h = 1 */ ++static __always_inline void fe_1(fe *h) ++{ ++ memset(h, 0, sizeof(u32) * 10); ++ h->v[0] = 1; ++} ++ ++static void fe_add_impl(u32 out[10], const u32 in1[10], const u32 in2[10]) ++{ ++ { const u32 x20 = in1[9]; ++ { const u32 x21 = in1[8]; ++ { const u32 x19 = in1[7]; ++ { const u32 x17 = in1[6]; ++ { const u32 x15 = in1[5]; ++ { const u32 x13 = in1[4]; ++ { const u32 x11 = in1[3]; ++ { const u32 x9 = in1[2]; ++ { const u32 x7 = in1[1]; ++ { const u32 x5 = in1[0]; ++ { const u32 x38 = in2[9]; ++ { const u32 x39 = in2[8]; ++ { const u32 x37 = in2[7]; ++ { const u32 x35 = in2[6]; ++ { const u32 x33 = in2[5]; ++ { const u32 x31 = in2[4]; ++ { const u32 x29 = in2[3]; ++ { const u32 x27 = in2[2]; ++ { const u32 x25 = in2[1]; ++ { const u32 x23 = in2[0]; ++ out[0] = (x5 + x23); ++ out[1] = (x7 + x25); ++ out[2] = (x9 + x27); ++ out[3] = (x11 + x29); ++ out[4] = (x13 + x31); ++ out[5] = (x15 + x33); ++ out[6] = (x17 + x35); ++ out[7] = (x19 + x37); ++ out[8] = (x21 + x39); ++ out[9] = (x20 + x38); ++ }}}}}}}}}}}}}}}}}}}} ++} ++ ++/* h = f + g ++ * Can overlap h with f or g. ++ */ ++static __always_inline void fe_add(fe_loose *h, const fe *f, const fe *g) ++{ ++ fe_add_impl(h->v, f->v, g->v); ++} ++ ++static void fe_sub_impl(u32 out[10], const u32 in1[10], const u32 in2[10]) ++{ ++ { const u32 x20 = in1[9]; ++ { const u32 x21 = in1[8]; ++ { const u32 x19 = in1[7]; ++ { const u32 x17 = in1[6]; ++ { const u32 x15 = in1[5]; ++ { const u32 x13 = in1[4]; ++ { const u32 x11 = in1[3]; ++ { const u32 x9 = in1[2]; ++ { const u32 x7 = in1[1]; ++ { const u32 x5 = in1[0]; ++ { const u32 x38 = in2[9]; ++ { const u32 x39 = in2[8]; ++ { const u32 x37 = in2[7]; ++ { const u32 x35 = in2[6]; ++ { const u32 x33 = in2[5]; ++ { const u32 x31 = in2[4]; ++ { const u32 x29 = in2[3]; ++ { const u32 x27 = in2[2]; ++ { const u32 x25 = in2[1]; ++ { const u32 x23 = in2[0]; ++ out[0] = ((0x7ffffda + x5) - x23); ++ out[1] = ((0x3fffffe + x7) - x25); ++ out[2] = ((0x7fffffe + x9) - x27); ++ out[3] = ((0x3fffffe + x11) - x29); ++ out[4] = ((0x7fffffe + x13) - x31); ++ out[5] = ((0x3fffffe + x15) - x33); ++ out[6] = ((0x7fffffe + x17) - x35); ++ out[7] = ((0x3fffffe + x19) - x37); ++ out[8] = ((0x7fffffe + x21) - x39); ++ out[9] = ((0x3fffffe + x20) - x38); ++ }}}}}}}}}}}}}}}}}}}} ++} ++ ++/* h = f - g ++ * Can overlap h with f or g. ++ */ ++static __always_inline void fe_sub(fe_loose *h, const fe *f, const fe *g) ++{ ++ fe_sub_impl(h->v, f->v, g->v); ++} ++ ++static void fe_mul_impl(u32 out[10], const u32 in1[10], const u32 in2[10]) ++{ ++ { const u32 x20 = in1[9]; ++ { const u32 x21 = in1[8]; ++ { const u32 x19 = in1[7]; ++ { const u32 x17 = in1[6]; ++ { const u32 x15 = in1[5]; ++ { const u32 x13 = in1[4]; ++ { const u32 x11 = in1[3]; ++ { const u32 x9 = in1[2]; ++ { const u32 x7 = in1[1]; ++ { const u32 x5 = in1[0]; ++ { const u32 x38 = in2[9]; ++ { const u32 x39 = in2[8]; ++ { const u32 x37 = in2[7]; ++ { const u32 x35 = in2[6]; ++ { const u32 x33 = in2[5]; ++ { const u32 x31 = in2[4]; ++ { const u32 x29 = in2[3]; ++ { const u32 x27 = in2[2]; ++ { const u32 x25 = in2[1]; ++ { const u32 x23 = in2[0]; ++ { u64 x40 = ((u64)x23 * x5); ++ { u64 x41 = (((u64)x23 * x7) + ((u64)x25 * x5)); ++ { u64 x42 = ((((u64)(0x2 * x25) * x7) + ((u64)x23 * x9)) + ((u64)x27 * x5)); ++ { u64 x43 = (((((u64)x25 * x9) + ((u64)x27 * x7)) + ((u64)x23 * x11)) + ((u64)x29 * x5)); ++ { u64 x44 = (((((u64)x27 * x9) + (0x2 * (((u64)x25 * x11) + ((u64)x29 * x7)))) + ((u64)x23 * x13)) + ((u64)x31 * x5)); ++ { u64 x45 = (((((((u64)x27 * x11) + ((u64)x29 * x9)) + ((u64)x25 * x13)) + ((u64)x31 * x7)) + ((u64)x23 * x15)) + ((u64)x33 * x5)); ++ { u64 x46 = (((((0x2 * ((((u64)x29 * x11) + ((u64)x25 * x15)) + ((u64)x33 * x7))) + ((u64)x27 * x13)) + ((u64)x31 * x9)) + ((u64)x23 * x17)) + ((u64)x35 * x5)); ++ { u64 x47 = (((((((((u64)x29 * x13) + ((u64)x31 * x11)) + ((u64)x27 * x15)) + ((u64)x33 * x9)) + ((u64)x25 * x17)) + ((u64)x35 * x7)) + ((u64)x23 * x19)) + ((u64)x37 * x5)); ++ { u64 x48 = (((((((u64)x31 * x13) + (0x2 * (((((u64)x29 * x15) + ((u64)x33 * x11)) + ((u64)x25 * x19)) + ((u64)x37 * x7)))) + ((u64)x27 * x17)) + ((u64)x35 * x9)) + ((u64)x23 * x21)) + ((u64)x39 * x5)); ++ { u64 x49 = (((((((((((u64)x31 * x15) + ((u64)x33 * x13)) + ((u64)x29 * x17)) + ((u64)x35 * x11)) + ((u64)x27 * x19)) + ((u64)x37 * x9)) + ((u64)x25 * x21)) + ((u64)x39 * x7)) + ((u64)x23 * x20)) + ((u64)x38 * x5)); ++ { u64 x50 = (((((0x2 * ((((((u64)x33 * x15) + ((u64)x29 * x19)) + ((u64)x37 * x11)) + ((u64)x25 * x20)) + ((u64)x38 * x7))) + ((u64)x31 * x17)) + ((u64)x35 * x13)) + ((u64)x27 * x21)) + ((u64)x39 * x9)); ++ { u64 x51 = (((((((((u64)x33 * x17) + ((u64)x35 * x15)) + ((u64)x31 * x19)) + ((u64)x37 * x13)) + ((u64)x29 * x21)) + ((u64)x39 * x11)) + ((u64)x27 * x20)) + ((u64)x38 * x9)); ++ { u64 x52 = (((((u64)x35 * x17) + (0x2 * (((((u64)x33 * x19) + ((u64)x37 * x15)) + ((u64)x29 * x20)) + ((u64)x38 * x11)))) + ((u64)x31 * x21)) + ((u64)x39 * x13)); ++ { u64 x53 = (((((((u64)x35 * x19) + ((u64)x37 * x17)) + ((u64)x33 * x21)) + ((u64)x39 * x15)) + ((u64)x31 * x20)) + ((u64)x38 * x13)); ++ { u64 x54 = (((0x2 * ((((u64)x37 * x19) + ((u64)x33 * x20)) + ((u64)x38 * x15))) + ((u64)x35 * x21)) + ((u64)x39 * x17)); ++ { u64 x55 = (((((u64)x37 * x21) + ((u64)x39 * x19)) + ((u64)x35 * x20)) + ((u64)x38 * x17)); ++ { u64 x56 = (((u64)x39 * x21) + (0x2 * (((u64)x37 * x20) + ((u64)x38 * x19)))); ++ { u64 x57 = (((u64)x39 * x20) + ((u64)x38 * x21)); ++ { u64 x58 = ((u64)(0x2 * x38) * x20); ++ { u64 x59 = (x48 + (x58 << 0x4)); ++ { u64 x60 = (x59 + (x58 << 0x1)); ++ { u64 x61 = (x60 + x58); ++ { u64 x62 = (x47 + (x57 << 0x4)); ++ { u64 x63 = (x62 + (x57 << 0x1)); ++ { u64 x64 = (x63 + x57); ++ { u64 x65 = (x46 + (x56 << 0x4)); ++ { u64 x66 = (x65 + (x56 << 0x1)); ++ { u64 x67 = (x66 + x56); ++ { u64 x68 = (x45 + (x55 << 0x4)); ++ { u64 x69 = (x68 + (x55 << 0x1)); ++ { u64 x70 = (x69 + x55); ++ { u64 x71 = (x44 + (x54 << 0x4)); ++ { u64 x72 = (x71 + (x54 << 0x1)); ++ { u64 x73 = (x72 + x54); ++ { u64 x74 = (x43 + (x53 << 0x4)); ++ { u64 x75 = (x74 + (x53 << 0x1)); ++ { u64 x76 = (x75 + x53); ++ { u64 x77 = (x42 + (x52 << 0x4)); ++ { u64 x78 = (x77 + (x52 << 0x1)); ++ { u64 x79 = (x78 + x52); ++ { u64 x80 = (x41 + (x51 << 0x4)); ++ { u64 x81 = (x80 + (x51 << 0x1)); ++ { u64 x82 = (x81 + x51); ++ { u64 x83 = (x40 + (x50 << 0x4)); ++ { u64 x84 = (x83 + (x50 << 0x1)); ++ { u64 x85 = (x84 + x50); ++ { u64 x86 = (x85 >> 0x1a); ++ { u32 x87 = ((u32)x85 & 0x3ffffff); ++ { u64 x88 = (x86 + x82); ++ { u64 x89 = (x88 >> 0x19); ++ { u32 x90 = ((u32)x88 & 0x1ffffff); ++ { u64 x91 = (x89 + x79); ++ { u64 x92 = (x91 >> 0x1a); ++ { u32 x93 = ((u32)x91 & 0x3ffffff); ++ { u64 x94 = (x92 + x76); ++ { u64 x95 = (x94 >> 0x19); ++ { u32 x96 = ((u32)x94 & 0x1ffffff); ++ { u64 x97 = (x95 + x73); ++ { u64 x98 = (x97 >> 0x1a); ++ { u32 x99 = ((u32)x97 & 0x3ffffff); ++ { u64 x100 = (x98 + x70); ++ { u64 x101 = (x100 >> 0x19); ++ { u32 x102 = ((u32)x100 & 0x1ffffff); ++ { u64 x103 = (x101 + x67); ++ { u64 x104 = (x103 >> 0x1a); ++ { u32 x105 = ((u32)x103 & 0x3ffffff); ++ { u64 x106 = (x104 + x64); ++ { u64 x107 = (x106 >> 0x19); ++ { u32 x108 = ((u32)x106 & 0x1ffffff); ++ { u64 x109 = (x107 + x61); ++ { u64 x110 = (x109 >> 0x1a); ++ { u32 x111 = ((u32)x109 & 0x3ffffff); ++ { u64 x112 = (x110 + x49); ++ { u64 x113 = (x112 >> 0x19); ++ { u32 x114 = ((u32)x112 & 0x1ffffff); ++ { u64 x115 = (x87 + (0x13 * x113)); ++ { u32 x116 = (u32) (x115 >> 0x1a); ++ { u32 x117 = ((u32)x115 & 0x3ffffff); ++ { u32 x118 = (x116 + x90); ++ { u32 x119 = (x118 >> 0x19); ++ { u32 x120 = (x118 & 0x1ffffff); ++ out[0] = x117; ++ out[1] = x120; ++ out[2] = (x119 + x93); ++ out[3] = x96; ++ out[4] = x99; ++ out[5] = x102; ++ out[6] = x105; ++ out[7] = x108; ++ out[8] = x111; ++ out[9] = x114; ++ }}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}} ++} ++ ++static __always_inline void fe_mul_ttt(fe *h, const fe *f, const fe *g) ++{ ++ fe_mul_impl(h->v, f->v, g->v); ++} ++ ++static __always_inline void fe_mul_tlt(fe *h, const fe_loose *f, const fe *g) ++{ ++ fe_mul_impl(h->v, f->v, g->v); ++} ++ ++static __always_inline void fe_mul_tll(fe *h, const fe_loose *f, const fe_loose *g) ++{ ++ fe_mul_impl(h->v, f->v, g->v); ++} ++ ++static void fe_sqr_impl(u32 out[10], const u32 in1[10]) ++{ ++ { const u32 x17 = in1[9]; ++ { const u32 x18 = in1[8]; ++ { const u32 x16 = in1[7]; ++ { const u32 x14 = in1[6]; ++ { const u32 x12 = in1[5]; ++ { const u32 x10 = in1[4]; ++ { const u32 x8 = in1[3]; ++ { const u32 x6 = in1[2]; ++ { const u32 x4 = in1[1]; ++ { const u32 x2 = in1[0]; ++ { u64 x19 = ((u64)x2 * x2); ++ { u64 x20 = ((u64)(0x2 * x2) * x4); ++ { u64 x21 = (0x2 * (((u64)x4 * x4) + ((u64)x2 * x6))); ++ { u64 x22 = (0x2 * (((u64)x4 * x6) + ((u64)x2 * x8))); ++ { u64 x23 = ((((u64)x6 * x6) + ((u64)(0x4 * x4) * x8)) + ((u64)(0x2 * x2) * x10)); ++ { u64 x24 = (0x2 * ((((u64)x6 * x8) + ((u64)x4 * x10)) + ((u64)x2 * x12))); ++ { u64 x25 = (0x2 * (((((u64)x8 * x8) + ((u64)x6 * x10)) + ((u64)x2 * x14)) + ((u64)(0x2 * x4) * x12))); ++ { u64 x26 = (0x2 * (((((u64)x8 * x10) + ((u64)x6 * x12)) + ((u64)x4 * x14)) + ((u64)x2 * x16))); ++ { u64 x27 = (((u64)x10 * x10) + (0x2 * ((((u64)x6 * x14) + ((u64)x2 * x18)) + (0x2 * (((u64)x4 * x16) + ((u64)x8 * x12)))))); ++ { u64 x28 = (0x2 * ((((((u64)x10 * x12) + ((u64)x8 * x14)) + ((u64)x6 * x16)) + ((u64)x4 * x18)) + ((u64)x2 * x17))); ++ { u64 x29 = (0x2 * (((((u64)x12 * x12) + ((u64)x10 * x14)) + ((u64)x6 * x18)) + (0x2 * (((u64)x8 * x16) + ((u64)x4 * x17))))); ++ { u64 x30 = (0x2 * (((((u64)x12 * x14) + ((u64)x10 * x16)) + ((u64)x8 * x18)) + ((u64)x6 * x17))); ++ { u64 x31 = (((u64)x14 * x14) + (0x2 * (((u64)x10 * x18) + (0x2 * (((u64)x12 * x16) + ((u64)x8 * x17)))))); ++ { u64 x32 = (0x2 * ((((u64)x14 * x16) + ((u64)x12 * x18)) + ((u64)x10 * x17))); ++ { u64 x33 = (0x2 * ((((u64)x16 * x16) + ((u64)x14 * x18)) + ((u64)(0x2 * x12) * x17))); ++ { u64 x34 = (0x2 * (((u64)x16 * x18) + ((u64)x14 * x17))); ++ { u64 x35 = (((u64)x18 * x18) + ((u64)(0x4 * x16) * x17)); ++ { u64 x36 = ((u64)(0x2 * x18) * x17); ++ { u64 x37 = ((u64)(0x2 * x17) * x17); ++ { u64 x38 = (x27 + (x37 << 0x4)); ++ { u64 x39 = (x38 + (x37 << 0x1)); ++ { u64 x40 = (x39 + x37); ++ { u64 x41 = (x26 + (x36 << 0x4)); ++ { u64 x42 = (x41 + (x36 << 0x1)); ++ { u64 x43 = (x42 + x36); ++ { u64 x44 = (x25 + (x35 << 0x4)); ++ { u64 x45 = (x44 + (x35 << 0x1)); ++ { u64 x46 = (x45 + x35); ++ { u64 x47 = (x24 + (x34 << 0x4)); ++ { u64 x48 = (x47 + (x34 << 0x1)); ++ { u64 x49 = (x48 + x34); ++ { u64 x50 = (x23 + (x33 << 0x4)); ++ { u64 x51 = (x50 + (x33 << 0x1)); ++ { u64 x52 = (x51 + x33); ++ { u64 x53 = (x22 + (x32 << 0x4)); ++ { u64 x54 = (x53 + (x32 << 0x1)); ++ { u64 x55 = (x54 + x32); ++ { u64 x56 = (x21 + (x31 << 0x4)); ++ { u64 x57 = (x56 + (x31 << 0x1)); ++ { u64 x58 = (x57 + x31); ++ { u64 x59 = (x20 + (x30 << 0x4)); ++ { u64 x60 = (x59 + (x30 << 0x1)); ++ { u64 x61 = (x60 + x30); ++ { u64 x62 = (x19 + (x29 << 0x4)); ++ { u64 x63 = (x62 + (x29 << 0x1)); ++ { u64 x64 = (x63 + x29); ++ { u64 x65 = (x64 >> 0x1a); ++ { u32 x66 = ((u32)x64 & 0x3ffffff); ++ { u64 x67 = (x65 + x61); ++ { u64 x68 = (x67 >> 0x19); ++ { u32 x69 = ((u32)x67 & 0x1ffffff); ++ { u64 x70 = (x68 + x58); ++ { u64 x71 = (x70 >> 0x1a); ++ { u32 x72 = ((u32)x70 & 0x3ffffff); ++ { u64 x73 = (x71 + x55); ++ { u64 x74 = (x73 >> 0x19); ++ { u32 x75 = ((u32)x73 & 0x1ffffff); ++ { u64 x76 = (x74 + x52); ++ { u64 x77 = (x76 >> 0x1a); ++ { u32 x78 = ((u32)x76 & 0x3ffffff); ++ { u64 x79 = (x77 + x49); ++ { u64 x80 = (x79 >> 0x19); ++ { u32 x81 = ((u32)x79 & 0x1ffffff); ++ { u64 x82 = (x80 + x46); ++ { u64 x83 = (x82 >> 0x1a); ++ { u32 x84 = ((u32)x82 & 0x3ffffff); ++ { u64 x85 = (x83 + x43); ++ { u64 x86 = (x85 >> 0x19); ++ { u32 x87 = ((u32)x85 & 0x1ffffff); ++ { u64 x88 = (x86 + x40); ++ { u64 x89 = (x88 >> 0x1a); ++ { u32 x90 = ((u32)x88 & 0x3ffffff); ++ { u64 x91 = (x89 + x28); ++ { u64 x92 = (x91 >> 0x19); ++ { u32 x93 = ((u32)x91 & 0x1ffffff); ++ { u64 x94 = (x66 + (0x13 * x92)); ++ { u32 x95 = (u32) (x94 >> 0x1a); ++ { u32 x96 = ((u32)x94 & 0x3ffffff); ++ { u32 x97 = (x95 + x69); ++ { u32 x98 = (x97 >> 0x19); ++ { u32 x99 = (x97 & 0x1ffffff); ++ out[0] = x96; ++ out[1] = x99; ++ out[2] = (x98 + x72); ++ out[3] = x75; ++ out[4] = x78; ++ out[5] = x81; ++ out[6] = x84; ++ out[7] = x87; ++ out[8] = x90; ++ out[9] = x93; ++ }}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}} ++} ++ ++static __always_inline void fe_sq_tl(fe *h, const fe_loose *f) ++{ ++ fe_sqr_impl(h->v, f->v); ++} ++ ++static __always_inline void fe_sq_tt(fe *h, const fe *f) ++{ ++ fe_sqr_impl(h->v, f->v); ++} ++ ++static __always_inline void fe_loose_invert(fe *out, const fe_loose *z) ++{ ++ fe t0; ++ fe t1; ++ fe t2; ++ fe t3; ++ int i; ++ ++ fe_sq_tl(&t0, z); ++ fe_sq_tt(&t1, &t0); ++ for (i = 1; i < 2; ++i) ++ fe_sq_tt(&t1, &t1); ++ fe_mul_tlt(&t1, z, &t1); ++ fe_mul_ttt(&t0, &t0, &t1); ++ fe_sq_tt(&t2, &t0); ++ fe_mul_ttt(&t1, &t1, &t2); ++ fe_sq_tt(&t2, &t1); ++ for (i = 1; i < 5; ++i) ++ fe_sq_tt(&t2, &t2); ++ fe_mul_ttt(&t1, &t2, &t1); ++ fe_sq_tt(&t2, &t1); ++ for (i = 1; i < 10; ++i) ++ fe_sq_tt(&t2, &t2); ++ fe_mul_ttt(&t2, &t2, &t1); ++ fe_sq_tt(&t3, &t2); ++ for (i = 1; i < 20; ++i) ++ fe_sq_tt(&t3, &t3); ++ fe_mul_ttt(&t2, &t3, &t2); ++ fe_sq_tt(&t2, &t2); ++ for (i = 1; i < 10; ++i) ++ fe_sq_tt(&t2, &t2); ++ fe_mul_ttt(&t1, &t2, &t1); ++ fe_sq_tt(&t2, &t1); ++ for (i = 1; i < 50; ++i) ++ fe_sq_tt(&t2, &t2); ++ fe_mul_ttt(&t2, &t2, &t1); ++ fe_sq_tt(&t3, &t2); ++ for (i = 1; i < 100; ++i) ++ fe_sq_tt(&t3, &t3); ++ fe_mul_ttt(&t2, &t3, &t2); ++ fe_sq_tt(&t2, &t2); ++ for (i = 1; i < 50; ++i) ++ fe_sq_tt(&t2, &t2); ++ fe_mul_ttt(&t1, &t2, &t1); ++ fe_sq_tt(&t1, &t1); ++ for (i = 1; i < 5; ++i) ++ fe_sq_tt(&t1, &t1); ++ fe_mul_ttt(out, &t1, &t0); ++} ++ ++static __always_inline void fe_invert(fe *out, const fe *z) ++{ ++ fe_loose l; ++ fe_copy_lt(&l, z); ++ fe_loose_invert(out, &l); ++} ++ ++/* Replace (f,g) with (g,f) if b == 1; ++ * replace (f,g) with (f,g) if b == 0. ++ * ++ * Preconditions: b in {0,1} ++ */ ++static __always_inline void fe_cswap(fe *f, fe *g, unsigned int b) ++{ ++ unsigned i; ++ b = 0-b; ++ for (i = 0; i < 10; i++) { ++ u32 x = f->v[i] ^ g->v[i]; ++ x &= b; ++ f->v[i] ^= x; ++ g->v[i] ^= x; ++ } ++} ++ ++/* NOTE: based on fiat-crypto fe_mul, edited for in2=121666, 0, 0.*/ ++static __always_inline void fe_mul_121666_impl(u32 out[10], const u32 in1[10]) ++{ ++ { const u32 x20 = in1[9]; ++ { const u32 x21 = in1[8]; ++ { const u32 x19 = in1[7]; ++ { const u32 x17 = in1[6]; ++ { const u32 x15 = in1[5]; ++ { const u32 x13 = in1[4]; ++ { const u32 x11 = in1[3]; ++ { const u32 x9 = in1[2]; ++ { const u32 x7 = in1[1]; ++ { const u32 x5 = in1[0]; ++ { const u32 x38 = 0; ++ { const u32 x39 = 0; ++ { const u32 x37 = 0; ++ { const u32 x35 = 0; ++ { const u32 x33 = 0; ++ { const u32 x31 = 0; ++ { const u32 x29 = 0; ++ { const u32 x27 = 0; ++ { const u32 x25 = 0; ++ { const u32 x23 = 121666; ++ { u64 x40 = ((u64)x23 * x5); ++ { u64 x41 = (((u64)x23 * x7) + ((u64)x25 * x5)); ++ { u64 x42 = ((((u64)(0x2 * x25) * x7) + ((u64)x23 * x9)) + ((u64)x27 * x5)); ++ { u64 x43 = (((((u64)x25 * x9) + ((u64)x27 * x7)) + ((u64)x23 * x11)) + ((u64)x29 * x5)); ++ { u64 x44 = (((((u64)x27 * x9) + (0x2 * (((u64)x25 * x11) + ((u64)x29 * x7)))) + ((u64)x23 * x13)) + ((u64)x31 * x5)); ++ { u64 x45 = (((((((u64)x27 * x11) + ((u64)x29 * x9)) + ((u64)x25 * x13)) + ((u64)x31 * x7)) + ((u64)x23 * x15)) + ((u64)x33 * x5)); ++ { u64 x46 = (((((0x2 * ((((u64)x29 * x11) + ((u64)x25 * x15)) + ((u64)x33 * x7))) + ((u64)x27 * x13)) + ((u64)x31 * x9)) + ((u64)x23 * x17)) + ((u64)x35 * x5)); ++ { u64 x47 = (((((((((u64)x29 * x13) + ((u64)x31 * x11)) + ((u64)x27 * x15)) + ((u64)x33 * x9)) + ((u64)x25 * x17)) + ((u64)x35 * x7)) + ((u64)x23 * x19)) + ((u64)x37 * x5)); ++ { u64 x48 = (((((((u64)x31 * x13) + (0x2 * (((((u64)x29 * x15) + ((u64)x33 * x11)) + ((u64)x25 * x19)) + ((u64)x37 * x7)))) + ((u64)x27 * x17)) + ((u64)x35 * x9)) + ((u64)x23 * x21)) + ((u64)x39 * x5)); ++ { u64 x49 = (((((((((((u64)x31 * x15) + ((u64)x33 * x13)) + ((u64)x29 * x17)) + ((u64)x35 * x11)) + ((u64)x27 * x19)) + ((u64)x37 * x9)) + ((u64)x25 * x21)) + ((u64)x39 * x7)) + ((u64)x23 * x20)) + ((u64)x38 * x5)); ++ { u64 x50 = (((((0x2 * ((((((u64)x33 * x15) + ((u64)x29 * x19)) + ((u64)x37 * x11)) + ((u64)x25 * x20)) + ((u64)x38 * x7))) + ((u64)x31 * x17)) + ((u64)x35 * x13)) + ((u64)x27 * x21)) + ((u64)x39 * x9)); ++ { u64 x51 = (((((((((u64)x33 * x17) + ((u64)x35 * x15)) + ((u64)x31 * x19)) + ((u64)x37 * x13)) + ((u64)x29 * x21)) + ((u64)x39 * x11)) + ((u64)x27 * x20)) + ((u64)x38 * x9)); ++ { u64 x52 = (((((u64)x35 * x17) + (0x2 * (((((u64)x33 * x19) + ((u64)x37 * x15)) + ((u64)x29 * x20)) + ((u64)x38 * x11)))) + ((u64)x31 * x21)) + ((u64)x39 * x13)); ++ { u64 x53 = (((((((u64)x35 * x19) + ((u64)x37 * x17)) + ((u64)x33 * x21)) + ((u64)x39 * x15)) + ((u64)x31 * x20)) + ((u64)x38 * x13)); ++ { u64 x54 = (((0x2 * ((((u64)x37 * x19) + ((u64)x33 * x20)) + ((u64)x38 * x15))) + ((u64)x35 * x21)) + ((u64)x39 * x17)); ++ { u64 x55 = (((((u64)x37 * x21) + ((u64)x39 * x19)) + ((u64)x35 * x20)) + ((u64)x38 * x17)); ++ { u64 x56 = (((u64)x39 * x21) + (0x2 * (((u64)x37 * x20) + ((u64)x38 * x19)))); ++ { u64 x57 = (((u64)x39 * x20) + ((u64)x38 * x21)); ++ { u64 x58 = ((u64)(0x2 * x38) * x20); ++ { u64 x59 = (x48 + (x58 << 0x4)); ++ { u64 x60 = (x59 + (x58 << 0x1)); ++ { u64 x61 = (x60 + x58); ++ { u64 x62 = (x47 + (x57 << 0x4)); ++ { u64 x63 = (x62 + (x57 << 0x1)); ++ { u64 x64 = (x63 + x57); ++ { u64 x65 = (x46 + (x56 << 0x4)); ++ { u64 x66 = (x65 + (x56 << 0x1)); ++ { u64 x67 = (x66 + x56); ++ { u64 x68 = (x45 + (x55 << 0x4)); ++ { u64 x69 = (x68 + (x55 << 0x1)); ++ { u64 x70 = (x69 + x55); ++ { u64 x71 = (x44 + (x54 << 0x4)); ++ { u64 x72 = (x71 + (x54 << 0x1)); ++ { u64 x73 = (x72 + x54); ++ { u64 x74 = (x43 + (x53 << 0x4)); ++ { u64 x75 = (x74 + (x53 << 0x1)); ++ { u64 x76 = (x75 + x53); ++ { u64 x77 = (x42 + (x52 << 0x4)); ++ { u64 x78 = (x77 + (x52 << 0x1)); ++ { u64 x79 = (x78 + x52); ++ { u64 x80 = (x41 + (x51 << 0x4)); ++ { u64 x81 = (x80 + (x51 << 0x1)); ++ { u64 x82 = (x81 + x51); ++ { u64 x83 = (x40 + (x50 << 0x4)); ++ { u64 x84 = (x83 + (x50 << 0x1)); ++ { u64 x85 = (x84 + x50); ++ { u64 x86 = (x85 >> 0x1a); ++ { u32 x87 = ((u32)x85 & 0x3ffffff); ++ { u64 x88 = (x86 + x82); ++ { u64 x89 = (x88 >> 0x19); ++ { u32 x90 = ((u32)x88 & 0x1ffffff); ++ { u64 x91 = (x89 + x79); ++ { u64 x92 = (x91 >> 0x1a); ++ { u32 x93 = ((u32)x91 & 0x3ffffff); ++ { u64 x94 = (x92 + x76); ++ { u64 x95 = (x94 >> 0x19); ++ { u32 x96 = ((u32)x94 & 0x1ffffff); ++ { u64 x97 = (x95 + x73); ++ { u64 x98 = (x97 >> 0x1a); ++ { u32 x99 = ((u32)x97 & 0x3ffffff); ++ { u64 x100 = (x98 + x70); ++ { u64 x101 = (x100 >> 0x19); ++ { u32 x102 = ((u32)x100 & 0x1ffffff); ++ { u64 x103 = (x101 + x67); ++ { u64 x104 = (x103 >> 0x1a); ++ { u32 x105 = ((u32)x103 & 0x3ffffff); ++ { u64 x106 = (x104 + x64); ++ { u64 x107 = (x106 >> 0x19); ++ { u32 x108 = ((u32)x106 & 0x1ffffff); ++ { u64 x109 = (x107 + x61); ++ { u64 x110 = (x109 >> 0x1a); ++ { u32 x111 = ((u32)x109 & 0x3ffffff); ++ { u64 x112 = (x110 + x49); ++ { u64 x113 = (x112 >> 0x19); ++ { u32 x114 = ((u32)x112 & 0x1ffffff); ++ { u64 x115 = (x87 + (0x13 * x113)); ++ { u32 x116 = (u32) (x115 >> 0x1a); ++ { u32 x117 = ((u32)x115 & 0x3ffffff); ++ { u32 x118 = (x116 + x90); ++ { u32 x119 = (x118 >> 0x19); ++ { u32 x120 = (x118 & 0x1ffffff); ++ out[0] = x117; ++ out[1] = x120; ++ out[2] = (x119 + x93); ++ out[3] = x96; ++ out[4] = x99; ++ out[5] = x102; ++ out[6] = x105; ++ out[7] = x108; ++ out[8] = x111; ++ out[9] = x114; ++ }}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}} ++} ++ ++static __always_inline void fe_mul121666(fe *h, const fe_loose *f) ++{ ++ fe_mul_121666_impl(h->v, f->v); ++} ++ ++static void curve25519_generic(u8 out[CURVE25519_POINT_SIZE], const u8 scalar[CURVE25519_POINT_SIZE], const u8 point[CURVE25519_POINT_SIZE]) ++{ ++ fe x1, x2, z2, x3, z3, tmp0, tmp1; ++ fe_loose x2l, z2l, x3l, tmp0l, tmp1l; ++ unsigned swap = 0; ++ int pos; ++ u8 e[32]; ++ ++ memcpy(e, scalar, 32); ++ normalize_secret(e); ++ ++ /* The following implementation was transcribed to Coq and proven to ++ * correspond to unary scalar multiplication in affine coordinates given that ++ * x1 != 0 is the x coordinate of some point on the curve. It was also checked ++ * in Coq that doing a ladderstep with x1 = x3 = 0 gives z2' = z3' = 0, and z2 ++ * = z3 = 0 gives z2' = z3' = 0. The statement was quantified over the ++ * underlying field, so it applies to Curve25519 itself and the quadratic ++ * twist of Curve25519. It was not proven in Coq that prime-field arithmetic ++ * correctly simulates extension-field arithmetic on prime-field values. ++ * The decoding of the byte array representation of e was not considered. ++ * Specification of Montgomery curves in affine coordinates: ++ * ++ * Proof that these form a group that is isomorphic to a Weierstrass curve: ++ * ++ * Coq transcription and correctness proof of the loop (where scalarbits=255): ++ * ++ * ++ * preconditions: 0 <= e < 2^255 (not necessarily e < order), fe_invert(0) = 0 ++ */ ++ fe_frombytes(&x1, point); ++ fe_1(&x2); ++ fe_0(&z2); ++ fe_copy(&x3, &x1); ++ fe_1(&z3); ++ ++ for (pos = 254; pos >= 0; --pos) { ++ /* loop invariant as of right before the test, for the case where x1 != 0: ++ * pos >= -1; if z2 = 0 then x2 is nonzero; if z3 = 0 then x3 is nonzero ++ * let r := e >> (pos+1) in the following equalities of projective points: ++ * to_xz (r*P) === if swap then (x3, z3) else (x2, z2) ++ * to_xz ((r+1)*P) === if swap then (x2, z2) else (x3, z3) ++ * x1 is the nonzero x coordinate of the nonzero point (r*P-(r+1)*P) ++ */ ++ unsigned b = 1 & (e[pos / 8] >> (pos & 7)); ++ swap ^= b; ++ fe_cswap(&x2, &x3, swap); ++ fe_cswap(&z2, &z3, swap); ++ swap = b; ++ /* Coq transcription of ladderstep formula (called from transcribed loop): ++ * ++ * ++ * x1 != 0 ++ * x1 = 0 ++ */ ++ fe_sub(&tmp0l, &x3, &z3); ++ fe_sub(&tmp1l, &x2, &z2); ++ fe_add(&x2l, &x2, &z2); ++ fe_add(&z2l, &x3, &z3); ++ fe_mul_tll(&z3, &tmp0l, &x2l); ++ fe_mul_tll(&z2, &z2l, &tmp1l); ++ fe_sq_tl(&tmp0, &tmp1l); ++ fe_sq_tl(&tmp1, &x2l); ++ fe_add(&x3l, &z3, &z2); ++ fe_sub(&z2l, &z3, &z2); ++ fe_mul_ttt(&x2, &tmp1, &tmp0); ++ fe_sub(&tmp1l, &tmp1, &tmp0); ++ fe_sq_tl(&z2, &z2l); ++ fe_mul121666(&z3, &tmp1l); ++ fe_sq_tl(&x3, &x3l); ++ fe_add(&tmp0l, &tmp0, &z3); ++ fe_mul_ttt(&z3, &x1, &z2); ++ fe_mul_tll(&z2, &tmp1l, &tmp0l); ++ } ++ /* here pos=-1, so r=e, so to_xz (e*P) === if swap then (x3, z3) else (x2, z2) */ ++ fe_cswap(&x2, &x3, swap); ++ fe_cswap(&z2, &z3, swap); ++ ++ fe_invert(&z2, &z2); ++ fe_mul_ttt(&x2, &x2, &z2); ++ fe_tobytes(out, &x2); ++ ++ memzero_explicit(&x1, sizeof(x1)); ++ memzero_explicit(&x2, sizeof(x2)); ++ memzero_explicit(&z2, sizeof(z2)); ++ memzero_explicit(&x3, sizeof(x3)); ++ memzero_explicit(&z3, sizeof(z3)); ++ memzero_explicit(&tmp0, sizeof(tmp0)); ++ memzero_explicit(&tmp1, sizeof(tmp1)); ++ memzero_explicit(&x2l, sizeof(x2l)); ++ memzero_explicit(&z2l, sizeof(z2l)); ++ memzero_explicit(&x3l, sizeof(x3l)); ++ memzero_explicit(&tmp0l, sizeof(tmp0l)); ++ memzero_explicit(&tmp1l, sizeof(tmp1l)); ++ memzero_explicit(&e, sizeof(e)); ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/curve25519.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,25 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_CURVE25519_H ++#define _WG_CURVE25519_H ++ ++#include ++ ++enum curve25519_lengths { ++ CURVE25519_POINT_SIZE = 32 ++}; ++ ++bool __must_check curve25519(u8 mypublic[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE], const u8 basepoint[CURVE25519_POINT_SIZE]); ++void curve25519_generate_secret(u8 secret[CURVE25519_POINT_SIZE]); ++bool __must_check curve25519_generate_public(u8 pub[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE]); ++ ++void curve25519_fpu_init(void); ++ ++#ifdef DEBUG ++bool curve25519_selftest(void); ++#endif ++ ++#endif /* _WG_CURVE25519_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/curve25519-hacl64.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,751 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2016-2017 INRIA and Microsoft Corporation. ++ * Copyright (C) 2018 Jason A. Donenfeld . All Rights Reserved. ++ * ++ * This is a machine-generated formally verified implementation of curve25519 DH from: ++ * https://github.com/mitls/hacl-star ++ */ ++ ++typedef __uint128_t u128; ++static __always_inline u64 u64_eq_mask(u64 x, u64 y) ++{ ++ x = ~(x ^ y); ++ x &= x << 32; ++ x &= x << 16; ++ x &= x << 8; ++ x &= x << 4; ++ x &= x << 2; ++ x &= x << 1; ++ return ((s64)x) >> 63; ++} ++ ++static __always_inline u64 u64_gte_mask(u64 x, u64 y) ++{ ++ u64 low63 = ~((u64)((s64)((s64)(x & 0x7fffffffffffffffLLU) - (s64)(y & 0x7fffffffffffffffLLU)) >> 63)); ++ u64 high_bit = ~((u64)((s64)((s64)(x & 0x8000000000000000LLU) - (s64)(y & 0x8000000000000000LLU)) >> 63)); ++ return low63 & high_bit; ++} ++ ++static __always_inline void modulo_carry_top(u64 *b) ++{ ++ u64 b4 = b[4]; ++ u64 b0 = b[0]; ++ u64 b4_ = b4 & 0x7ffffffffffffLLU; ++ u64 b0_ = b0 + 19 * (b4 >> 51); ++ b[4] = b4_; ++ b[0] = b0_; ++} ++ ++static __always_inline void fproduct_copy_from_wide_(u64 *output, u128 *input) ++{ ++ { ++ u128 xi = input[0]; ++ output[0] = ((u64)(xi)); ++ } ++ { ++ u128 xi = input[1]; ++ output[1] = ((u64)(xi)); ++ } ++ { ++ u128 xi = input[2]; ++ output[2] = ((u64)(xi)); ++ } ++ { ++ u128 xi = input[3]; ++ output[3] = ((u64)(xi)); ++ } ++ { ++ u128 xi = input[4]; ++ output[4] = ((u64)(xi)); ++ } ++} ++ ++static __always_inline void fproduct_sum_scalar_multiplication_(u128 *output, u64 *input, u64 s) ++{ ++ output[0] += (u128)input[0] * s; ++ output[1] += (u128)input[1] * s; ++ output[2] += (u128)input[2] * s; ++ output[3] += (u128)input[3] * s; ++ output[4] += (u128)input[4] * s; ++} ++ ++static __always_inline void fproduct_carry_wide_(u128 *tmp) ++{ ++ { ++ u32 ctr = 0; ++ u128 tctr = tmp[ctr]; ++ u128 tctrp1 = tmp[ctr + 1]; ++ u64 r0 = ((u64)(tctr)) & 0x7ffffffffffffLLU; ++ u128 c = ((tctr) >> (51)); ++ tmp[ctr] = ((u128)(r0)); ++ tmp[ctr + 1] = ((tctrp1) + (c)); ++ } ++ { ++ u32 ctr = 1; ++ u128 tctr = tmp[ctr]; ++ u128 tctrp1 = tmp[ctr + 1]; ++ u64 r0 = ((u64)(tctr)) & 0x7ffffffffffffLLU; ++ u128 c = ((tctr) >> (51)); ++ tmp[ctr] = ((u128)(r0)); ++ tmp[ctr + 1] = ((tctrp1) + (c)); ++ } ++ ++ { ++ u32 ctr = 2; ++ u128 tctr = tmp[ctr]; ++ u128 tctrp1 = tmp[ctr + 1]; ++ u64 r0 = ((u64)(tctr)) & 0x7ffffffffffffLLU; ++ u128 c = ((tctr) >> (51)); ++ tmp[ctr] = ((u128)(r0)); ++ tmp[ctr + 1] = ((tctrp1) + (c)); ++ } ++ { ++ u32 ctr = 3; ++ u128 tctr = tmp[ctr]; ++ u128 tctrp1 = tmp[ctr + 1]; ++ u64 r0 = ((u64)(tctr)) & 0x7ffffffffffffLLU; ++ u128 c = ((tctr) >> (51)); ++ tmp[ctr] = ((u128)(r0)); ++ tmp[ctr + 1] = ((tctrp1) + (c)); ++ } ++} ++ ++static __always_inline void fmul_shift_reduce(u64 *output) ++{ ++ u64 tmp = output[4]; ++ u64 b0; ++ { ++ u32 ctr = 5 - 0 - 1; ++ u64 z = output[ctr - 1]; ++ output[ctr] = z; ++ } ++ { ++ u32 ctr = 5 - 1 - 1; ++ u64 z = output[ctr - 1]; ++ output[ctr] = z; ++ } ++ { ++ u32 ctr = 5 - 2 - 1; ++ u64 z = output[ctr - 1]; ++ output[ctr] = z; ++ } ++ { ++ u32 ctr = 5 - 3 - 1; ++ u64 z = output[ctr - 1]; ++ output[ctr] = z; ++ } ++ output[0] = tmp; ++ b0 = output[0]; ++ output[0] = 19 * b0; ++} ++ ++static __always_inline void fmul_mul_shift_reduce_(u128 *output, u64 *input, u64 *input21) ++{ ++ u32 i; ++ u64 input2i; ++ { ++ u64 input2i = input21[0]; ++ fproduct_sum_scalar_multiplication_(output, input, input2i); ++ fmul_shift_reduce(input); ++ } ++ { ++ u64 input2i = input21[1]; ++ fproduct_sum_scalar_multiplication_(output, input, input2i); ++ fmul_shift_reduce(input); ++ } ++ { ++ u64 input2i = input21[2]; ++ fproduct_sum_scalar_multiplication_(output, input, input2i); ++ fmul_shift_reduce(input); ++ } ++ { ++ u64 input2i = input21[3]; ++ fproduct_sum_scalar_multiplication_(output, input, input2i); ++ fmul_shift_reduce(input); ++ } ++ i = 4; ++ input2i = input21[i]; ++ fproduct_sum_scalar_multiplication_(output, input, input2i); ++} ++ ++static __always_inline void fmul_fmul(u64 *output, u64 *input, u64 *input21) ++{ ++ u64 tmp[5]; ++ memcpy(tmp, input, 5 * sizeof(*input)); ++ { ++ u128 b4; ++ u128 b0; ++ u128 b4_; ++ u128 b0_; ++ u64 i0; ++ u64 i1; ++ u64 i0_; ++ u64 i1_; ++ u128 t[5] = { 0 }; ++ fmul_mul_shift_reduce_(t, tmp, input21); ++ fproduct_carry_wide_(t); ++ b4 = t[4]; ++ b0 = t[0]; ++ b4_ = ((b4) & (((u128)(0x7ffffffffffffLLU)))); ++ b0_ = ((b0) + (((u128)(19) * (((u64)(((b4) >> (51)))))))); ++ t[4] = b4_; ++ t[0] = b0_; ++ fproduct_copy_from_wide_(output, t); ++ i0 = output[0]; ++ i1 = output[1]; ++ i0_ = i0 & 0x7ffffffffffffLLU; ++ i1_ = i1 + (i0 >> 51); ++ output[0] = i0_; ++ output[1] = i1_; ++ } ++} ++ ++static __always_inline void fsquare_fsquare__(u128 *tmp, u64 *output) ++{ ++ u64 r0 = output[0]; ++ u64 r1 = output[1]; ++ u64 r2 = output[2]; ++ u64 r3 = output[3]; ++ u64 r4 = output[4]; ++ u64 d0 = r0 * 2; ++ u64 d1 = r1 * 2; ++ u64 d2 = r2 * 2 * 19; ++ u64 d419 = r4 * 19; ++ u64 d4 = d419 * 2; ++ u128 s0 = ((((((u128)(r0) * (r0))) + (((u128)(d4) * (r1))))) + (((u128)(d2) * (r3)))); ++ u128 s1 = ((((((u128)(d0) * (r1))) + (((u128)(d4) * (r2))))) + (((u128)(r3 * 19) * (r3)))); ++ u128 s2 = ((((((u128)(d0) * (r2))) + (((u128)(r1) * (r1))))) + (((u128)(d4) * (r3)))); ++ u128 s3 = ((((((u128)(d0) * (r3))) + (((u128)(d1) * (r2))))) + (((u128)(r4) * (d419)))); ++ u128 s4 = ((((((u128)(d0) * (r4))) + (((u128)(d1) * (r3))))) + (((u128)(r2) * (r2)))); ++ tmp[0] = s0; ++ tmp[1] = s1; ++ tmp[2] = s2; ++ tmp[3] = s3; ++ tmp[4] = s4; ++} ++ ++static __always_inline void fsquare_fsquare_(u128 *tmp, u64 *output) ++{ ++ u128 b4; ++ u128 b0; ++ u128 b4_; ++ u128 b0_; ++ u64 i0; ++ u64 i1; ++ u64 i0_; ++ u64 i1_; ++ fsquare_fsquare__(tmp, output); ++ fproduct_carry_wide_(tmp); ++ b4 = tmp[4]; ++ b0 = tmp[0]; ++ b4_ = ((b4) & (((u128)(0x7ffffffffffffLLU)))); ++ b0_ = ((b0) + (((u128)(19) * (((u64)(((b4) >> (51)))))))); ++ tmp[4] = b4_; ++ tmp[0] = b0_; ++ fproduct_copy_from_wide_(output, tmp); ++ i0 = output[0]; ++ i1 = output[1]; ++ i0_ = i0 & 0x7ffffffffffffLLU; ++ i1_ = i1 + (i0 >> 51); ++ output[0] = i0_; ++ output[1] = i1_; ++} ++ ++static __always_inline void fsquare_fsquare_times_(u64 *output, u128 *tmp, u32 count1) ++{ ++ u32 i; ++ fsquare_fsquare_(tmp, output); ++ for (i = 1; i < count1; ++i) ++ fsquare_fsquare_(tmp, output); ++} ++ ++static __always_inline void fsquare_fsquare_times(u64 *output, u64 *input, u32 count1) ++{ ++ u128 t[5]; ++ memcpy(output, input, 5 * sizeof(*input)); ++ fsquare_fsquare_times_(output, t, count1); ++} ++ ++static __always_inline void fsquare_fsquare_times_inplace(u64 *output, u32 count1) ++{ ++ u128 t[5]; ++ fsquare_fsquare_times_(output, t, count1); ++} ++ ++static __always_inline void crecip_crecip(u64 *out, u64 *z) ++{ ++ u64 buf[20] = { 0 }; ++ u64 *a0 = buf; ++ u64 *t00 = buf + 5; ++ u64 *b0 = buf + 10; ++ u64 *t01; ++ u64 *b1; ++ u64 *c0; ++ u64 *a; ++ u64 *t0; ++ u64 *b; ++ u64 *c; ++ fsquare_fsquare_times(a0, z, 1); ++ fsquare_fsquare_times(t00, a0, 2); ++ fmul_fmul(b0, t00, z); ++ fmul_fmul(a0, b0, a0); ++ fsquare_fsquare_times(t00, a0, 1); ++ fmul_fmul(b0, t00, b0); ++ fsquare_fsquare_times(t00, b0, 5); ++ t01 = buf + 5; ++ b1 = buf + 10; ++ c0 = buf + 15; ++ fmul_fmul(b1, t01, b1); ++ fsquare_fsquare_times(t01, b1, 10); ++ fmul_fmul(c0, t01, b1); ++ fsquare_fsquare_times(t01, c0, 20); ++ fmul_fmul(t01, t01, c0); ++ fsquare_fsquare_times_inplace(t01, 10); ++ fmul_fmul(b1, t01, b1); ++ fsquare_fsquare_times(t01, b1, 50); ++ a = buf; ++ t0 = buf + 5; ++ b = buf + 10; ++ c = buf + 15; ++ fmul_fmul(c, t0, b); ++ fsquare_fsquare_times(t0, c, 100); ++ fmul_fmul(t0, t0, c); ++ fsquare_fsquare_times_inplace(t0, 50); ++ fmul_fmul(t0, t0, b); ++ fsquare_fsquare_times_inplace(t0, 5); ++ fmul_fmul(out, t0, a); ++} ++ ++static __always_inline void fsum(u64 *a, u64 *b) ++{ ++ a[0] += b[0]; ++ a[1] += b[1]; ++ a[2] += b[2]; ++ a[3] += b[3]; ++ a[4] += b[4]; ++} ++ ++static __always_inline void fdifference(u64 *a, u64 *b) ++{ ++ u64 tmp[5] = { 0 }; ++ u64 b0; ++ u64 b1; ++ u64 b2; ++ u64 b3; ++ u64 b4; ++ memcpy(tmp, b, 5 * sizeof(*b)); ++ b0 = tmp[0]; ++ b1 = tmp[1]; ++ b2 = tmp[2]; ++ b3 = tmp[3]; ++ b4 = tmp[4]; ++ tmp[0] = b0 + 0x3fffffffffff68LLU; ++ tmp[1] = b1 + 0x3ffffffffffff8LLU; ++ tmp[2] = b2 + 0x3ffffffffffff8LLU; ++ tmp[3] = b3 + 0x3ffffffffffff8LLU; ++ tmp[4] = b4 + 0x3ffffffffffff8LLU; ++ { ++ u64 xi = a[0]; ++ u64 yi = tmp[0]; ++ a[0] = yi - xi; ++ } ++ { ++ u64 xi = a[1]; ++ u64 yi = tmp[1]; ++ a[1] = yi - xi; ++ } ++ { ++ u64 xi = a[2]; ++ u64 yi = tmp[2]; ++ a[2] = yi - xi; ++ } ++ { ++ u64 xi = a[3]; ++ u64 yi = tmp[3]; ++ a[3] = yi - xi; ++ } ++ { ++ u64 xi = a[4]; ++ u64 yi = tmp[4]; ++ a[4] = yi - xi; ++ } ++} ++ ++static __always_inline void fscalar(u64 *output, u64 *b, u64 s) ++{ ++ u128 tmp[5]; ++ u128 b4; ++ u128 b0; ++ u128 b4_; ++ u128 b0_; ++ { ++ u64 xi = b[0]; ++ tmp[0] = ((u128)(xi) * (s)); ++ } ++ { ++ u64 xi = b[1]; ++ tmp[1] = ((u128)(xi) * (s)); ++ } ++ { ++ u64 xi = b[2]; ++ tmp[2] = ((u128)(xi) * (s)); ++ } ++ { ++ u64 xi = b[3]; ++ tmp[3] = ((u128)(xi) * (s)); ++ } ++ { ++ u64 xi = b[4]; ++ tmp[4] = ((u128)(xi) * (s)); ++ } ++ fproduct_carry_wide_(tmp); ++ b4 = tmp[4]; ++ b0 = tmp[0]; ++ b4_ = ((b4) & (((u128)(0x7ffffffffffffLLU)))); ++ b0_ = ((b0) + (((u128)(19) * (((u64)(((b4) >> (51)))))))); ++ tmp[4] = b4_; ++ tmp[0] = b0_; ++ fproduct_copy_from_wide_(output, tmp); ++} ++ ++static __always_inline void fmul(u64 *output, u64 *a, u64 *b) ++{ ++ fmul_fmul(output, a, b); ++} ++ ++static __always_inline void crecip(u64 *output, u64 *input) ++{ ++ crecip_crecip(output, input); ++} ++ ++static __always_inline void point_swap_conditional_step(u64 *a, u64 *b, u64 swap1, u32 ctr) ++{ ++ u32 i = ctr - 1; ++ u64 ai = a[i]; ++ u64 bi = b[i]; ++ u64 x = swap1 & (ai ^ bi); ++ u64 ai1 = ai ^ x; ++ u64 bi1 = bi ^ x; ++ a[i] = ai1; ++ b[i] = bi1; ++} ++ ++static __always_inline void point_swap_conditional5(u64 *a, u64 *b, u64 swap1) ++{ ++ point_swap_conditional_step(a, b, swap1, 5); ++ point_swap_conditional_step(a, b, swap1, 4); ++ point_swap_conditional_step(a, b, swap1, 3); ++ point_swap_conditional_step(a, b, swap1, 2); ++ point_swap_conditional_step(a, b, swap1, 1); ++} ++ ++static __always_inline void point_swap_conditional(u64 *a, u64 *b, u64 iswap) ++{ ++ u64 swap1 = 0 - iswap; ++ point_swap_conditional5(a, b, swap1); ++ point_swap_conditional5(a + 5, b + 5, swap1); ++} ++ ++static __always_inline void point_copy(u64 *output, u64 *input) ++{ ++ memcpy(output, input, 5 * sizeof(*input)); ++ memcpy(output + 5, input + 5, 5 * sizeof(*input)); ++} ++ ++static __always_inline void addanddouble_fmonty(u64 *pp, u64 *ppq, u64 *p, u64 *pq, u64 *qmqp) ++{ ++ u64 *qx = qmqp; ++ u64 *x2 = pp; ++ u64 *z2 = pp + 5; ++ u64 *x3 = ppq; ++ u64 *z3 = ppq + 5; ++ u64 *x = p; ++ u64 *z = p + 5; ++ u64 *xprime = pq; ++ u64 *zprime = pq + 5; ++ u64 buf[40] = { 0 }; ++ u64 *origx = buf; ++ u64 *origxprime0 = buf + 5; ++ u64 *xxprime0; ++ u64 *zzprime0; ++ u64 *origxprime; ++ xxprime0 = buf + 25; ++ zzprime0 = buf + 30; ++ memcpy(origx, x, 5 * sizeof(*x)); ++ fsum(x, z); ++ fdifference(z, origx); ++ memcpy(origxprime0, xprime, 5 * sizeof(*xprime)); ++ fsum(xprime, zprime); ++ fdifference(zprime, origxprime0); ++ fmul(xxprime0, xprime, z); ++ fmul(zzprime0, x, zprime); ++ origxprime = buf + 5; ++ { ++ u64 *xx0; ++ u64 *zz0; ++ u64 *xxprime; ++ u64 *zzprime; ++ u64 *zzzprime; ++ xx0 = buf + 15; ++ zz0 = buf + 20; ++ xxprime = buf + 25; ++ zzprime = buf + 30; ++ zzzprime = buf + 35; ++ memcpy(origxprime, xxprime, 5 * sizeof(*xxprime)); ++ fsum(xxprime, zzprime); ++ fdifference(zzprime, origxprime); ++ fsquare_fsquare_times(x3, xxprime, 1); ++ fsquare_fsquare_times(zzzprime, zzprime, 1); ++ fmul(z3, zzzprime, qx); ++ fsquare_fsquare_times(xx0, x, 1); ++ fsquare_fsquare_times(zz0, z, 1); ++ { ++ u64 *zzz; ++ u64 *xx; ++ u64 *zz; ++ u64 scalar; ++ zzz = buf + 10; ++ xx = buf + 15; ++ zz = buf + 20; ++ fmul(x2, xx, zz); ++ fdifference(zz, xx); ++ scalar = 121665; ++ fscalar(zzz, zz, scalar); ++ fsum(zzz, xx); ++ fmul(z2, zzz, zz); ++ } ++ } ++} ++ ++static __always_inline void ladder_smallloop_cmult_small_loop_step(u64 *nq, u64 *nqpq, u64 *nq2, u64 *nqpq2, u64 *q, u8 byt) ++{ ++ u64 bit0 = (u64)(byt >> 7); ++ u64 bit; ++ point_swap_conditional(nq, nqpq, bit0); ++ addanddouble_fmonty(nq2, nqpq2, nq, nqpq, q); ++ bit = (u64)(byt >> 7); ++ point_swap_conditional(nq2, nqpq2, bit); ++} ++ ++static __always_inline void ladder_smallloop_cmult_small_loop_double_step(u64 *nq, u64 *nqpq, u64 *nq2, u64 *nqpq2, u64 *q, u8 byt) ++{ ++ u8 byt1; ++ ladder_smallloop_cmult_small_loop_step(nq, nqpq, nq2, nqpq2, q, byt); ++ byt1 = byt << 1; ++ ladder_smallloop_cmult_small_loop_step(nq2, nqpq2, nq, nqpq, q, byt1); ++} ++ ++static __always_inline void ladder_smallloop_cmult_small_loop(u64 *nq, u64 *nqpq, u64 *nq2, u64 *nqpq2, u64 *q, u8 byt, u32 i) ++{ ++ while (i--) { ++ ladder_smallloop_cmult_small_loop_double_step(nq, nqpq, nq2, nqpq2, q, byt); ++ byt <<= 2; ++ } ++} ++ ++static __always_inline void ladder_bigloop_cmult_big_loop(u8 *n1, u64 *nq, u64 *nqpq, u64 *nq2, u64 *nqpq2, u64 *q, u32 i) ++{ ++ while (i--) { ++ u8 byte = n1[i]; ++ ladder_smallloop_cmult_small_loop(nq, nqpq, nq2, nqpq2, q, byte, 4); ++ } ++} ++ ++static __always_inline void ladder_cmult(u64 *result, u8 *n1, u64 *q) ++{ ++ u64 point_buf[40] = { 0 }; ++ u64 *nq = point_buf; ++ u64 *nqpq = point_buf + 10; ++ u64 *nq2 = point_buf + 20; ++ u64 *nqpq2 = point_buf + 30; ++ point_copy(nqpq, q); ++ nq[0] = 1; ++ ladder_bigloop_cmult_big_loop(n1, nq, nqpq, nq2, nqpq2, q, 32); ++ point_copy(result, nq); ++} ++ ++static __always_inline void format_fexpand(u64 *output, const u8 *input) ++{ ++ const u8 *x00 = input + 6; ++ const u8 *x01 = input + 12; ++ const u8 *x02 = input + 19; ++ const u8 *x0 = input + 24; ++ u64 i0, i1, i2, i3, i4, output0, output1, output2, output3, output4; ++ i0 = le64_to_cpup((__force __le64 *)input); ++ i1 = le64_to_cpup((__force __le64 *)x00); ++ i2 = le64_to_cpup((__force __le64 *)x01); ++ i3 = le64_to_cpup((__force __le64 *)x02); ++ i4 = le64_to_cpup((__force __le64 *)x0); ++ output0 = i0 & 0x7ffffffffffffLLU; ++ output1 = i1 >> 3 & 0x7ffffffffffffLLU; ++ output2 = i2 >> 6 & 0x7ffffffffffffLLU; ++ output3 = i3 >> 1 & 0x7ffffffffffffLLU; ++ output4 = i4 >> 12 & 0x7ffffffffffffLLU; ++ output[0] = output0; ++ output[1] = output1; ++ output[2] = output2; ++ output[3] = output3; ++ output[4] = output4; ++} ++ ++static __always_inline void format_fcontract_first_carry_pass(u64 *input) ++{ ++ u64 t0 = input[0]; ++ u64 t1 = input[1]; ++ u64 t2 = input[2]; ++ u64 t3 = input[3]; ++ u64 t4 = input[4]; ++ u64 t1_ = t1 + (t0 >> 51); ++ u64 t0_ = t0 & 0x7ffffffffffffLLU; ++ u64 t2_ = t2 + (t1_ >> 51); ++ u64 t1__ = t1_ & 0x7ffffffffffffLLU; ++ u64 t3_ = t3 + (t2_ >> 51); ++ u64 t2__ = t2_ & 0x7ffffffffffffLLU; ++ u64 t4_ = t4 + (t3_ >> 51); ++ u64 t3__ = t3_ & 0x7ffffffffffffLLU; ++ input[0] = t0_; ++ input[1] = t1__; ++ input[2] = t2__; ++ input[3] = t3__; ++ input[4] = t4_; ++} ++ ++static __always_inline void format_fcontract_first_carry_full(u64 *input) ++{ ++ format_fcontract_first_carry_pass(input); ++ modulo_carry_top(input); ++} ++ ++static __always_inline void format_fcontract_second_carry_pass(u64 *input) ++{ ++ u64 t0 = input[0]; ++ u64 t1 = input[1]; ++ u64 t2 = input[2]; ++ u64 t3 = input[3]; ++ u64 t4 = input[4]; ++ u64 t1_ = t1 + (t0 >> 51); ++ u64 t0_ = t0 & 0x7ffffffffffffLLU; ++ u64 t2_ = t2 + (t1_ >> 51); ++ u64 t1__ = t1_ & 0x7ffffffffffffLLU; ++ u64 t3_ = t3 + (t2_ >> 51); ++ u64 t2__ = t2_ & 0x7ffffffffffffLLU; ++ u64 t4_ = t4 + (t3_ >> 51); ++ u64 t3__ = t3_ & 0x7ffffffffffffLLU; ++ input[0] = t0_; ++ input[1] = t1__; ++ input[2] = t2__; ++ input[3] = t3__; ++ input[4] = t4_; ++} ++ ++static __always_inline void format_fcontract_second_carry_full(u64 *input) ++{ ++ u64 i0; ++ u64 i1; ++ u64 i0_; ++ u64 i1_; ++ format_fcontract_second_carry_pass(input); ++ modulo_carry_top(input); ++ i0 = input[0]; ++ i1 = input[1]; ++ i0_ = i0 & 0x7ffffffffffffLLU; ++ i1_ = i1 + (i0 >> 51); ++ input[0] = i0_; ++ input[1] = i1_; ++} ++ ++static __always_inline void format_fcontract_trim(u64 *input) ++{ ++ u64 a0 = input[0]; ++ u64 a1 = input[1]; ++ u64 a2 = input[2]; ++ u64 a3 = input[3]; ++ u64 a4 = input[4]; ++ u64 mask0 = u64_gte_mask(a0, 0x7ffffffffffedLLU); ++ u64 mask1 = u64_eq_mask(a1, 0x7ffffffffffffLLU); ++ u64 mask2 = u64_eq_mask(a2, 0x7ffffffffffffLLU); ++ u64 mask3 = u64_eq_mask(a3, 0x7ffffffffffffLLU); ++ u64 mask4 = u64_eq_mask(a4, 0x7ffffffffffffLLU); ++ u64 mask = (((mask0 & mask1) & mask2) & mask3) & mask4; ++ u64 a0_ = a0 - (0x7ffffffffffedLLU & mask); ++ u64 a1_ = a1 - (0x7ffffffffffffLLU & mask); ++ u64 a2_ = a2 - (0x7ffffffffffffLLU & mask); ++ u64 a3_ = a3 - (0x7ffffffffffffLLU & mask); ++ u64 a4_ = a4 - (0x7ffffffffffffLLU & mask); ++ input[0] = a0_; ++ input[1] = a1_; ++ input[2] = a2_; ++ input[3] = a3_; ++ input[4] = a4_; ++} ++ ++static __always_inline void format_fcontract_store(u8 *output, u64 *input) ++{ ++ u64 t0 = input[0]; ++ u64 t1 = input[1]; ++ u64 t2 = input[2]; ++ u64 t3 = input[3]; ++ u64 t4 = input[4]; ++ u64 o0 = t1 << 51 | t0; ++ u64 o1 = t2 << 38 | t1 >> 13; ++ u64 o2 = t3 << 25 | t2 >> 26; ++ u64 o3 = t4 << 12 | t3 >> 39; ++ u8 *b0 = output; ++ u8 *b1 = output + 8; ++ u8 *b2 = output + 16; ++ u8 *b3 = output + 24; ++ *(__force __le64 *)b0 = cpu_to_le64(o0); ++ *(__force __le64 *)b1 = cpu_to_le64(o1); ++ *(__force __le64 *)b2 = cpu_to_le64(o2); ++ *(__force __le64 *)b3 = cpu_to_le64(o3); ++} ++ ++static __always_inline void format_fcontract(u8 *output, u64 *input) ++{ ++ format_fcontract_first_carry_full(input); ++ format_fcontract_second_carry_full(input); ++ format_fcontract_trim(input); ++ format_fcontract_store(output, input); ++} ++ ++static __always_inline void format_scalar_of_point(u8 *scalar, u64 *point) ++{ ++ u64 *x = point; ++ u64 *z = point + 5; ++ u64 buf[10] __aligned(32) = { 0 }; ++ u64 *zmone = buf; ++ u64 *sc = buf + 5; ++ crecip(zmone, z); ++ fmul(sc, x, zmone); ++ format_fcontract(scalar, sc); ++} ++ ++static void curve25519_generic(u8 mypublic[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE], const u8 basepoint[CURVE25519_POINT_SIZE]) ++{ ++ u64 buf0[10] __aligned(32) = { 0 }; ++ u64 *x0 = buf0; ++ u64 *z = buf0 + 5; ++ u64 *q; ++ format_fexpand(x0, basepoint); ++ z[0] = 1; ++ q = buf0; ++ { ++ u8 e[32] __aligned(32) = { 0 }; ++ u8 *scalar; ++ memcpy(e, secret, 32); ++ normalize_secret(e); ++ scalar = e; ++ { ++ u64 buf[15] = { 0 }; ++ u64 *nq = buf; ++ u64 *x = nq; ++ x[0] = 1; ++ ladder_cmult(nq, scalar, q); ++ format_scalar_of_point(mypublic, nq); ++ memzero_explicit(buf, sizeof(buf)); ++ } ++ memzero_explicit(e, sizeof(e)); ++ } ++ memzero_explicit(buf0, sizeof(buf0)); ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/curve25519-x86_64.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,175 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * ++ * Based on algorithms from Tung Chou ++ */ ++ ++#include ++#include ++#include ++#include ++static bool curve25519_use_avx __read_mostly; ++void __init curve25519_fpu_init(void) ++{ ++#ifndef CONFIG_UML ++ curve25519_use_avx = boot_cpu_has(X86_FEATURE_AVX) && cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM, NULL); ++#endif ++} ++ ++typedef u64 fex[10]; ++typedef u64 fe51[5]; ++asmlinkage void curve25519_sandy2x_ladder(fex *, const u8 *); ++asmlinkage void curve25519_sandy2x_ladder_base(fex *, const u8 *); ++asmlinkage void curve25519_sandy2x_fe51_pack(u8 *, const fe51 *); ++asmlinkage void curve25519_sandy2x_fe51_mul(fe51 *, const fe51 *, const fe51 *); ++asmlinkage void curve25519_sandy2x_fe51_nsquare(fe51 *, const fe51 *, int); ++ ++static inline u32 le24_to_cpupv(const u8 *in) ++{ ++ return le16_to_cpup((__le16 *)in) | ((u32)in[2]) << 16; ++} ++ ++static inline void fex_frombytes(fex h, const u8 *s) ++{ ++ u64 h0 = le32_to_cpup((__le32 *)s); ++ u64 h1 = le24_to_cpupv(s + 4) << 6; ++ u64 h2 = le24_to_cpupv(s + 7) << 5; ++ u64 h3 = le24_to_cpupv(s + 10) << 3; ++ u64 h4 = le24_to_cpupv(s + 13) << 2; ++ u64 h5 = le32_to_cpup((__le32 *)(s + 16)); ++ u64 h6 = le24_to_cpupv(s + 20) << 7; ++ u64 h7 = le24_to_cpupv(s + 23) << 5; ++ u64 h8 = le24_to_cpupv(s + 26) << 4; ++ u64 h9 = (le24_to_cpupv(s + 29) & 8388607) << 2; ++ u64 carry0, carry1, carry2, carry3, carry4, carry5, carry6, carry7, carry8, carry9; ++ ++ carry9 = h9 >> 25; h0 += carry9 * 19; h9 &= 0x1FFFFFF; ++ carry1 = h1 >> 25; h2 += carry1; h1 &= 0x1FFFFFF; ++ carry3 = h3 >> 25; h4 += carry3; h3 &= 0x1FFFFFF; ++ carry5 = h5 >> 25; h6 += carry5; h5 &= 0x1FFFFFF; ++ carry7 = h7 >> 25; h8 += carry7; h7 &= 0x1FFFFFF; ++ ++ carry0 = h0 >> 26; h1 += carry0; h0 &= 0x3FFFFFF; ++ carry2 = h2 >> 26; h3 += carry2; h2 &= 0x3FFFFFF; ++ carry4 = h4 >> 26; h5 += carry4; h4 &= 0x3FFFFFF; ++ carry6 = h6 >> 26; h7 += carry6; h6 &= 0x3FFFFFF; ++ carry8 = h8 >> 26; h9 += carry8; h8 &= 0x3FFFFFF; ++ ++ h[0] = h0; ++ h[1] = h1; ++ h[2] = h2; ++ h[3] = h3; ++ h[4] = h4; ++ h[5] = h5; ++ h[6] = h6; ++ h[7] = h7; ++ h[8] = h8; ++ h[9] = h9; ++} ++ ++static inline void fe51_invert(fe51 *r, const fe51 *x) ++{ ++ fe51 z2, z9, z11, z2_5_0, z2_10_0, z2_20_0, z2_50_0, z2_100_0, t; ++ ++ /* 2 */ curve25519_sandy2x_fe51_nsquare(&z2, x, 1); ++ /* 4 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z2, 1); ++ /* 8 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&t, 1); ++ /* 9 */ curve25519_sandy2x_fe51_mul(&z9, (const fe51 *)&t, x); ++ /* 11 */ curve25519_sandy2x_fe51_mul(&z11, (const fe51 *)&z9, (const fe51 *)&z2); ++ /* 22 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z11, 1); ++ /* 2^5 - 2^0 = 31 */ curve25519_sandy2x_fe51_mul(&z2_5_0, (const fe51 *)&t, (const fe51 *)&z9); ++ ++ /* 2^10 - 2^5 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z2_5_0, 5); ++ /* 2^10 - 2^0 */ curve25519_sandy2x_fe51_mul(&z2_10_0, (const fe51 *)&t, (const fe51 *)&z2_5_0); ++ ++ /* 2^20 - 2^10 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z2_10_0, 10); ++ /* 2^20 - 2^0 */ curve25519_sandy2x_fe51_mul(&z2_20_0, (const fe51 *)&t, (const fe51 *)&z2_10_0); ++ ++ /* 2^40 - 2^20 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z2_20_0, 20); ++ /* 2^40 - 2^0 */ curve25519_sandy2x_fe51_mul(&t, (const fe51 *)&t, (const fe51 *)&z2_20_0); ++ ++ /* 2^50 - 2^10 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&t, 10); ++ /* 2^50 - 2^0 */ curve25519_sandy2x_fe51_mul(&z2_50_0, (const fe51 *)&t, (const fe51 *)&z2_10_0); ++ ++ /* 2^100 - 2^50 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z2_50_0, 50); ++ /* 2^100 - 2^0 */ curve25519_sandy2x_fe51_mul(&z2_100_0, (const fe51 *)&t, (const fe51 *)&z2_50_0); ++ ++ /* 2^200 - 2^100 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z2_100_0, 100); ++ /* 2^200 - 2^0 */ curve25519_sandy2x_fe51_mul(&t, (const fe51 *)&t, (const fe51 *)&z2_100_0); ++ ++ /* 2^250 - 2^50 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&t, 50); ++ /* 2^250 - 2^0 */ curve25519_sandy2x_fe51_mul(&t, (const fe51 *)&t, (const fe51 *)&z2_50_0); ++ ++ /* 2^255 - 2^5 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&t, 5); ++ /* 2^255 - 21 */ curve25519_sandy2x_fe51_mul(r, (const fe51 *)t, (const fe51 *)&z11); ++} ++ ++static void curve25519_sandy2x(u8 mypublic[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE], const u8 basepoint[CURVE25519_POINT_SIZE]) ++{ ++ u8 e[32]; ++ fex var[3]; ++ fe51 x_51, z_51; ++ ++ memcpy(e, secret, 32); ++ normalize_secret(e); ++#define x1 var[0] ++#define x2 var[1] ++#define z2 var[2] ++ fex_frombytes(x1, basepoint); ++ curve25519_sandy2x_ladder(var, e); ++ z_51[0] = (z2[1] << 26) + z2[0]; ++ z_51[1] = (z2[3] << 26) + z2[2]; ++ z_51[2] = (z2[5] << 26) + z2[4]; ++ z_51[3] = (z2[7] << 26) + z2[6]; ++ z_51[4] = (z2[9] << 26) + z2[8]; ++ x_51[0] = (x2[1] << 26) + x2[0]; ++ x_51[1] = (x2[3] << 26) + x2[2]; ++ x_51[2] = (x2[5] << 26) + x2[4]; ++ x_51[3] = (x2[7] << 26) + x2[6]; ++ x_51[4] = (x2[9] << 26) + x2[8]; ++#undef x1 ++#undef x2 ++#undef z2 ++ fe51_invert(&z_51, (const fe51 *)&z_51); ++ curve25519_sandy2x_fe51_mul(&x_51, (const fe51 *)&x_51, (const fe51 *)&z_51); ++ curve25519_sandy2x_fe51_pack(mypublic, (const fe51 *)&x_51); ++ ++ memzero_explicit(e, sizeof(e)); ++ memzero_explicit(var, sizeof(var)); ++ memzero_explicit(x_51, sizeof(x_51)); ++ memzero_explicit(z_51, sizeof(z_51)); ++} ++ ++static void curve25519_sandy2x_base(u8 pub[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE]) ++{ ++ u8 e[32]; ++ fex var[3]; ++ fe51 x_51, z_51; ++ ++ memcpy(e, secret, 32); ++ normalize_secret(e); ++ curve25519_sandy2x_ladder_base(var, e); ++#define x2 var[0] ++#define z2 var[1] ++ z_51[0] = (z2[1] << 26) + z2[0]; ++ z_51[1] = (z2[3] << 26) + z2[2]; ++ z_51[2] = (z2[5] << 26) + z2[4]; ++ z_51[3] = (z2[7] << 26) + z2[6]; ++ z_51[4] = (z2[9] << 26) + z2[8]; ++ x_51[0] = (x2[1] << 26) + x2[0]; ++ x_51[1] = (x2[3] << 26) + x2[2]; ++ x_51[2] = (x2[5] << 26) + x2[4]; ++ x_51[3] = (x2[7] << 26) + x2[6]; ++ x_51[4] = (x2[9] << 26) + x2[8]; ++#undef x2 ++#undef z2 ++ fe51_invert(&z_51, (const fe51 *)&z_51); ++ curve25519_sandy2x_fe51_mul(&x_51, (const fe51 *)&x_51, (const fe51 *)&z_51); ++ curve25519_sandy2x_fe51_pack(pub, (const fe51 *)&x_51); ++ ++ memzero_explicit(e, sizeof(e)); ++ memzero_explicit(var, sizeof(var)); ++ memzero_explicit(x_51, sizeof(x_51)); ++ memzero_explicit(z_51, sizeof(z_51)); ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/blake2s-x86_64.S 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,685 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * Copyright (C) 2017 Samuel Neves . All Rights Reserved. ++ */ ++ ++#include ++ ++.section .rodata.cst32.BLAKE2S_IV, "aM", @progbits, 32 ++.align 32 ++IV: .octa 0xA54FF53A3C6EF372BB67AE856A09E667 ++ .octa 0x5BE0CD191F83D9AB9B05688C510E527F ++.section .rodata.cst16.ROT16, "aM", @progbits, 16 ++.align 16 ++ROT16: .octa 0x0D0C0F0E09080B0A0504070601000302 ++.section .rodata.cst16.ROR328, "aM", @progbits, 16 ++.align 16 ++ROR328: .octa 0x0C0F0E0D080B0A090407060500030201 ++#ifdef CONFIG_AS_AVX512 ++.section .rodata.cst64.BLAKE2S_SIGMA, "aM", @progbits, 640 ++.align 64 ++SIGMA: ++.long 0, 2, 4, 6, 1, 3, 5, 7, 8, 10, 12, 14, 9, 11, 13, 15 ++.long 11, 2, 12, 14, 9, 8, 15, 3, 4, 0, 13, 6, 10, 1, 7, 5 ++.long 10, 12, 11, 6, 5, 9, 13, 3, 4, 15, 14, 2, 0, 7, 8, 1 ++.long 10, 9, 7, 0, 11, 14, 1, 12, 6, 2, 15, 3, 13, 8, 5, 4 ++.long 4, 9, 8, 13, 14, 0, 10, 11, 7, 3, 12, 1, 5, 6, 15, 2 ++.long 2, 10, 4, 14, 13, 3, 9, 11, 6, 5, 7, 12, 15, 1, 8, 0 ++.long 4, 11, 14, 8, 13, 10, 12, 5, 2, 1, 15, 3, 9, 7, 0, 6 ++.long 6, 12, 0, 13, 15, 2, 1, 10, 4, 5, 11, 14, 8, 3, 9, 7 ++.long 14, 5, 4, 12, 9, 7, 3, 10, 2, 0, 6, 15, 11, 1, 13, 8 ++.long 11, 7, 13, 10, 12, 14, 0, 15, 4, 5, 6, 9, 2, 1, 8, 3 ++#endif /* CONFIG_AS_AVX512 */ ++ ++.text ++#ifdef CONFIG_AS_AVX ++ENTRY(blake2s_compress_avx) ++ movl %ecx, %ecx ++ testq %rdx, %rdx ++ je .Lendofloop ++ .align 32 ++.Lbeginofloop: ++ addq %rcx, 32(%rdi) ++ vmovdqu IV+16(%rip), %xmm1 ++ vmovdqu (%rsi), %xmm4 ++ vpxor 32(%rdi), %xmm1, %xmm1 ++ vmovdqu 16(%rsi), %xmm3 ++ vshufps $136, %xmm3, %xmm4, %xmm6 ++ vmovdqa ROT16(%rip), %xmm7 ++ vpaddd (%rdi), %xmm6, %xmm6 ++ vpaddd 16(%rdi), %xmm6, %xmm6 ++ vpxor %xmm6, %xmm1, %xmm1 ++ vmovdqu IV(%rip), %xmm8 ++ vpshufb %xmm7, %xmm1, %xmm1 ++ vmovdqu 48(%rsi), %xmm5 ++ vpaddd %xmm1, %xmm8, %xmm8 ++ vpxor 16(%rdi), %xmm8, %xmm9 ++ vmovdqu 32(%rsi), %xmm2 ++ vpblendw $12, %xmm3, %xmm5, %xmm13 ++ vshufps $221, %xmm5, %xmm2, %xmm12 ++ vpunpckhqdq %xmm2, %xmm4, %xmm14 ++ vpslld $20, %xmm9, %xmm0 ++ vpsrld $12, %xmm9, %xmm9 ++ vpxor %xmm0, %xmm9, %xmm0 ++ vshufps $221, %xmm3, %xmm4, %xmm9 ++ vpaddd %xmm9, %xmm6, %xmm9 ++ vpaddd %xmm0, %xmm9, %xmm9 ++ vpxor %xmm9, %xmm1, %xmm1 ++ vmovdqa ROR328(%rip), %xmm6 ++ vpshufb %xmm6, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm8, %xmm8 ++ vpxor %xmm8, %xmm0, %xmm0 ++ vpshufd $147, %xmm1, %xmm1 ++ vpshufd $78, %xmm8, %xmm8 ++ vpslld $25, %xmm0, %xmm10 ++ vpsrld $7, %xmm0, %xmm0 ++ vpxor %xmm10, %xmm0, %xmm0 ++ vshufps $136, %xmm5, %xmm2, %xmm10 ++ vpshufd $57, %xmm0, %xmm0 ++ vpaddd %xmm10, %xmm9, %xmm9 ++ vpaddd %xmm0, %xmm9, %xmm9 ++ vpxor %xmm9, %xmm1, %xmm1 ++ vpaddd %xmm12, %xmm9, %xmm9 ++ vpblendw $12, %xmm2, %xmm3, %xmm12 ++ vpshufb %xmm7, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm8, %xmm8 ++ vpxor %xmm8, %xmm0, %xmm10 ++ vpslld $20, %xmm10, %xmm0 ++ vpsrld $12, %xmm10, %xmm10 ++ vpxor %xmm0, %xmm10, %xmm0 ++ vpaddd %xmm0, %xmm9, %xmm9 ++ vpxor %xmm9, %xmm1, %xmm1 ++ vpshufb %xmm6, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm8, %xmm8 ++ vpxor %xmm8, %xmm0, %xmm0 ++ vpshufd $57, %xmm1, %xmm1 ++ vpshufd $78, %xmm8, %xmm8 ++ vpslld $25, %xmm0, %xmm10 ++ vpsrld $7, %xmm0, %xmm0 ++ vpxor %xmm10, %xmm0, %xmm0 ++ vpslldq $4, %xmm5, %xmm10 ++ vpblendw $240, %xmm10, %xmm12, %xmm12 ++ vpshufd $147, %xmm0, %xmm0 ++ vpshufd $147, %xmm12, %xmm12 ++ vpaddd %xmm9, %xmm12, %xmm12 ++ vpaddd %xmm0, %xmm12, %xmm12 ++ vpxor %xmm12, %xmm1, %xmm1 ++ vpshufb %xmm7, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm8, %xmm8 ++ vpxor %xmm8, %xmm0, %xmm11 ++ vpslld $20, %xmm11, %xmm9 ++ vpsrld $12, %xmm11, %xmm11 ++ vpxor %xmm9, %xmm11, %xmm0 ++ vpshufd $8, %xmm2, %xmm9 ++ vpblendw $192, %xmm5, %xmm3, %xmm11 ++ vpblendw $240, %xmm11, %xmm9, %xmm9 ++ vpshufd $177, %xmm9, %xmm9 ++ vpaddd %xmm12, %xmm9, %xmm9 ++ vpaddd %xmm0, %xmm9, %xmm11 ++ vpxor %xmm11, %xmm1, %xmm1 ++ vpshufb %xmm6, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm8, %xmm8 ++ vpxor %xmm8, %xmm0, %xmm9 ++ vpshufd $147, %xmm1, %xmm1 ++ vpshufd $78, %xmm8, %xmm8 ++ vpslld $25, %xmm9, %xmm0 ++ vpsrld $7, %xmm9, %xmm9 ++ vpxor %xmm0, %xmm9, %xmm0 ++ vpslldq $4, %xmm3, %xmm9 ++ vpblendw $48, %xmm9, %xmm2, %xmm9 ++ vpblendw $240, %xmm9, %xmm4, %xmm9 ++ vpshufd $57, %xmm0, %xmm0 ++ vpshufd $177, %xmm9, %xmm9 ++ vpaddd %xmm11, %xmm9, %xmm9 ++ vpaddd %xmm0, %xmm9, %xmm9 ++ vpxor %xmm9, %xmm1, %xmm1 ++ vpshufb %xmm7, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm8, %xmm11 ++ vpxor %xmm11, %xmm0, %xmm0 ++ vpslld $20, %xmm0, %xmm8 ++ vpsrld $12, %xmm0, %xmm0 ++ vpxor %xmm8, %xmm0, %xmm0 ++ vpunpckhdq %xmm3, %xmm4, %xmm8 ++ vpblendw $12, %xmm10, %xmm8, %xmm12 ++ vpshufd $177, %xmm12, %xmm12 ++ vpaddd %xmm9, %xmm12, %xmm9 ++ vpaddd %xmm0, %xmm9, %xmm9 ++ vpxor %xmm9, %xmm1, %xmm1 ++ vpshufb %xmm6, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm11, %xmm11 ++ vpxor %xmm11, %xmm0, %xmm0 ++ vpshufd $57, %xmm1, %xmm1 ++ vpshufd $78, %xmm11, %xmm11 ++ vpslld $25, %xmm0, %xmm12 ++ vpsrld $7, %xmm0, %xmm0 ++ vpxor %xmm12, %xmm0, %xmm0 ++ vpunpckhdq %xmm5, %xmm2, %xmm12 ++ vpshufd $147, %xmm0, %xmm0 ++ vpblendw $15, %xmm13, %xmm12, %xmm12 ++ vpslldq $8, %xmm5, %xmm13 ++ vpshufd $210, %xmm12, %xmm12 ++ vpaddd %xmm9, %xmm12, %xmm9 ++ vpaddd %xmm0, %xmm9, %xmm9 ++ vpxor %xmm9, %xmm1, %xmm1 ++ vpshufb %xmm7, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm11, %xmm11 ++ vpxor %xmm11, %xmm0, %xmm0 ++ vpslld $20, %xmm0, %xmm12 ++ vpsrld $12, %xmm0, %xmm0 ++ vpxor %xmm12, %xmm0, %xmm0 ++ vpunpckldq %xmm4, %xmm2, %xmm12 ++ vpblendw $240, %xmm4, %xmm12, %xmm12 ++ vpblendw $192, %xmm13, %xmm12, %xmm12 ++ vpsrldq $12, %xmm3, %xmm13 ++ vpaddd %xmm12, %xmm9, %xmm9 ++ vpaddd %xmm0, %xmm9, %xmm9 ++ vpxor %xmm9, %xmm1, %xmm1 ++ vpshufb %xmm6, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm11, %xmm11 ++ vpxor %xmm11, %xmm0, %xmm0 ++ vpshufd $147, %xmm1, %xmm1 ++ vpshufd $78, %xmm11, %xmm11 ++ vpslld $25, %xmm0, %xmm12 ++ vpsrld $7, %xmm0, %xmm0 ++ vpxor %xmm12, %xmm0, %xmm0 ++ vpblendw $60, %xmm2, %xmm4, %xmm12 ++ vpblendw $3, %xmm13, %xmm12, %xmm12 ++ vpshufd $57, %xmm0, %xmm0 ++ vpshufd $78, %xmm12, %xmm12 ++ vpaddd %xmm9, %xmm12, %xmm9 ++ vpaddd %xmm0, %xmm9, %xmm9 ++ vpxor %xmm9, %xmm1, %xmm1 ++ vpshufb %xmm7, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm11, %xmm11 ++ vpxor %xmm11, %xmm0, %xmm12 ++ vpslld $20, %xmm12, %xmm13 ++ vpsrld $12, %xmm12, %xmm0 ++ vpblendw $51, %xmm3, %xmm4, %xmm12 ++ vpxor %xmm13, %xmm0, %xmm0 ++ vpblendw $192, %xmm10, %xmm12, %xmm10 ++ vpslldq $8, %xmm2, %xmm12 ++ vpshufd $27, %xmm10, %xmm10 ++ vpaddd %xmm9, %xmm10, %xmm9 ++ vpaddd %xmm0, %xmm9, %xmm9 ++ vpxor %xmm9, %xmm1, %xmm1 ++ vpshufb %xmm6, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm11, %xmm11 ++ vpxor %xmm11, %xmm0, %xmm0 ++ vpshufd $57, %xmm1, %xmm1 ++ vpshufd $78, %xmm11, %xmm11 ++ vpslld $25, %xmm0, %xmm10 ++ vpsrld $7, %xmm0, %xmm0 ++ vpxor %xmm10, %xmm0, %xmm0 ++ vpunpckhdq %xmm2, %xmm8, %xmm10 ++ vpshufd $147, %xmm0, %xmm0 ++ vpblendw $12, %xmm5, %xmm10, %xmm10 ++ vpshufd $210, %xmm10, %xmm10 ++ vpaddd %xmm9, %xmm10, %xmm9 ++ vpaddd %xmm0, %xmm9, %xmm9 ++ vpxor %xmm9, %xmm1, %xmm1 ++ vpshufb %xmm7, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm11, %xmm11 ++ vpxor %xmm11, %xmm0, %xmm10 ++ vpslld $20, %xmm10, %xmm0 ++ vpsrld $12, %xmm10, %xmm10 ++ vpxor %xmm0, %xmm10, %xmm0 ++ vpblendw $12, %xmm4, %xmm5, %xmm10 ++ vpblendw $192, %xmm12, %xmm10, %xmm10 ++ vpunpckldq %xmm2, %xmm4, %xmm12 ++ vpshufd $135, %xmm10, %xmm10 ++ vpaddd %xmm9, %xmm10, %xmm9 ++ vpaddd %xmm0, %xmm9, %xmm9 ++ vpxor %xmm9, %xmm1, %xmm1 ++ vpshufb %xmm6, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm11, %xmm13 ++ vpxor %xmm13, %xmm0, %xmm0 ++ vpshufd $147, %xmm1, %xmm1 ++ vpshufd $78, %xmm13, %xmm13 ++ vpslld $25, %xmm0, %xmm10 ++ vpsrld $7, %xmm0, %xmm0 ++ vpxor %xmm10, %xmm0, %xmm0 ++ vpblendw $15, %xmm3, %xmm4, %xmm10 ++ vpblendw $192, %xmm5, %xmm10, %xmm10 ++ vpshufd $57, %xmm0, %xmm0 ++ vpshufd $198, %xmm10, %xmm10 ++ vpaddd %xmm9, %xmm10, %xmm10 ++ vpaddd %xmm0, %xmm10, %xmm10 ++ vpxor %xmm10, %xmm1, %xmm1 ++ vpshufb %xmm7, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm13, %xmm13 ++ vpxor %xmm13, %xmm0, %xmm9 ++ vpslld $20, %xmm9, %xmm0 ++ vpsrld $12, %xmm9, %xmm9 ++ vpxor %xmm0, %xmm9, %xmm0 ++ vpunpckhdq %xmm2, %xmm3, %xmm9 ++ vpunpcklqdq %xmm12, %xmm9, %xmm15 ++ vpunpcklqdq %xmm12, %xmm8, %xmm12 ++ vpblendw $15, %xmm5, %xmm8, %xmm8 ++ vpaddd %xmm15, %xmm10, %xmm15 ++ vpaddd %xmm0, %xmm15, %xmm15 ++ vpxor %xmm15, %xmm1, %xmm1 ++ vpshufd $141, %xmm8, %xmm8 ++ vpshufb %xmm6, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm13, %xmm13 ++ vpxor %xmm13, %xmm0, %xmm0 ++ vpshufd $57, %xmm1, %xmm1 ++ vpshufd $78, %xmm13, %xmm13 ++ vpslld $25, %xmm0, %xmm10 ++ vpsrld $7, %xmm0, %xmm0 ++ vpxor %xmm10, %xmm0, %xmm0 ++ vpunpcklqdq %xmm2, %xmm3, %xmm10 ++ vpshufd $147, %xmm0, %xmm0 ++ vpblendw $51, %xmm14, %xmm10, %xmm14 ++ vpshufd $135, %xmm14, %xmm14 ++ vpaddd %xmm15, %xmm14, %xmm14 ++ vpaddd %xmm0, %xmm14, %xmm14 ++ vpxor %xmm14, %xmm1, %xmm1 ++ vpunpcklqdq %xmm3, %xmm4, %xmm15 ++ vpshufb %xmm7, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm13, %xmm13 ++ vpxor %xmm13, %xmm0, %xmm0 ++ vpslld $20, %xmm0, %xmm11 ++ vpsrld $12, %xmm0, %xmm0 ++ vpxor %xmm11, %xmm0, %xmm0 ++ vpunpckhqdq %xmm5, %xmm3, %xmm11 ++ vpblendw $51, %xmm15, %xmm11, %xmm11 ++ vpunpckhqdq %xmm3, %xmm5, %xmm15 ++ vpaddd %xmm11, %xmm14, %xmm11 ++ vpaddd %xmm0, %xmm11, %xmm11 ++ vpxor %xmm11, %xmm1, %xmm1 ++ vpshufb %xmm6, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm13, %xmm13 ++ vpxor %xmm13, %xmm0, %xmm0 ++ vpshufd $147, %xmm1, %xmm1 ++ vpshufd $78, %xmm13, %xmm13 ++ vpslld $25, %xmm0, %xmm14 ++ vpsrld $7, %xmm0, %xmm0 ++ vpxor %xmm14, %xmm0, %xmm14 ++ vpunpckhqdq %xmm4, %xmm2, %xmm0 ++ vpshufd $57, %xmm14, %xmm14 ++ vpblendw $51, %xmm15, %xmm0, %xmm15 ++ vpaddd %xmm15, %xmm11, %xmm15 ++ vpaddd %xmm14, %xmm15, %xmm15 ++ vpxor %xmm15, %xmm1, %xmm1 ++ vpshufb %xmm7, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm13, %xmm13 ++ vpxor %xmm13, %xmm14, %xmm14 ++ vpslld $20, %xmm14, %xmm11 ++ vpsrld $12, %xmm14, %xmm14 ++ vpxor %xmm11, %xmm14, %xmm14 ++ vpblendw $3, %xmm2, %xmm4, %xmm11 ++ vpslldq $8, %xmm11, %xmm0 ++ vpblendw $15, %xmm5, %xmm0, %xmm0 ++ vpshufd $99, %xmm0, %xmm0 ++ vpaddd %xmm15, %xmm0, %xmm15 ++ vpaddd %xmm14, %xmm15, %xmm15 ++ vpxor %xmm15, %xmm1, %xmm0 ++ vpaddd %xmm12, %xmm15, %xmm15 ++ vpshufb %xmm6, %xmm0, %xmm0 ++ vpaddd %xmm0, %xmm13, %xmm13 ++ vpxor %xmm13, %xmm14, %xmm14 ++ vpshufd $57, %xmm0, %xmm0 ++ vpshufd $78, %xmm13, %xmm13 ++ vpslld $25, %xmm14, %xmm1 ++ vpsrld $7, %xmm14, %xmm14 ++ vpxor %xmm1, %xmm14, %xmm14 ++ vpblendw $3, %xmm5, %xmm4, %xmm1 ++ vpshufd $147, %xmm14, %xmm14 ++ vpaddd %xmm14, %xmm15, %xmm15 ++ vpxor %xmm15, %xmm0, %xmm0 ++ vpshufb %xmm7, %xmm0, %xmm0 ++ vpaddd %xmm0, %xmm13, %xmm13 ++ vpxor %xmm13, %xmm14, %xmm14 ++ vpslld $20, %xmm14, %xmm12 ++ vpsrld $12, %xmm14, %xmm14 ++ vpxor %xmm12, %xmm14, %xmm14 ++ vpsrldq $4, %xmm2, %xmm12 ++ vpblendw $60, %xmm12, %xmm1, %xmm1 ++ vpaddd %xmm1, %xmm15, %xmm15 ++ vpaddd %xmm14, %xmm15, %xmm15 ++ vpxor %xmm15, %xmm0, %xmm0 ++ vpblendw $12, %xmm4, %xmm3, %xmm1 ++ vpshufb %xmm6, %xmm0, %xmm0 ++ vpaddd %xmm0, %xmm13, %xmm13 ++ vpxor %xmm13, %xmm14, %xmm14 ++ vpshufd $147, %xmm0, %xmm0 ++ vpshufd $78, %xmm13, %xmm13 ++ vpslld $25, %xmm14, %xmm12 ++ vpsrld $7, %xmm14, %xmm14 ++ vpxor %xmm12, %xmm14, %xmm14 ++ vpsrldq $4, %xmm5, %xmm12 ++ vpblendw $48, %xmm12, %xmm1, %xmm1 ++ vpshufd $33, %xmm5, %xmm12 ++ vpshufd $57, %xmm14, %xmm14 ++ vpshufd $108, %xmm1, %xmm1 ++ vpblendw $51, %xmm12, %xmm10, %xmm12 ++ vpaddd %xmm15, %xmm1, %xmm15 ++ vpaddd %xmm14, %xmm15, %xmm15 ++ vpxor %xmm15, %xmm0, %xmm0 ++ vpaddd %xmm12, %xmm15, %xmm15 ++ vpshufb %xmm7, %xmm0, %xmm0 ++ vpaddd %xmm0, %xmm13, %xmm1 ++ vpxor %xmm1, %xmm14, %xmm14 ++ vpslld $20, %xmm14, %xmm13 ++ vpsrld $12, %xmm14, %xmm14 ++ vpxor %xmm13, %xmm14, %xmm14 ++ vpslldq $12, %xmm3, %xmm13 ++ vpaddd %xmm14, %xmm15, %xmm15 ++ vpxor %xmm15, %xmm0, %xmm0 ++ vpshufb %xmm6, %xmm0, %xmm0 ++ vpaddd %xmm0, %xmm1, %xmm1 ++ vpxor %xmm1, %xmm14, %xmm14 ++ vpshufd $57, %xmm0, %xmm0 ++ vpshufd $78, %xmm1, %xmm1 ++ vpslld $25, %xmm14, %xmm12 ++ vpsrld $7, %xmm14, %xmm14 ++ vpxor %xmm12, %xmm14, %xmm14 ++ vpblendw $51, %xmm5, %xmm4, %xmm12 ++ vpshufd $147, %xmm14, %xmm14 ++ vpblendw $192, %xmm13, %xmm12, %xmm12 ++ vpaddd %xmm12, %xmm15, %xmm15 ++ vpaddd %xmm14, %xmm15, %xmm15 ++ vpxor %xmm15, %xmm0, %xmm0 ++ vpsrldq $4, %xmm3, %xmm12 ++ vpshufb %xmm7, %xmm0, %xmm0 ++ vpaddd %xmm0, %xmm1, %xmm1 ++ vpxor %xmm1, %xmm14, %xmm14 ++ vpslld $20, %xmm14, %xmm13 ++ vpsrld $12, %xmm14, %xmm14 ++ vpxor %xmm13, %xmm14, %xmm14 ++ vpblendw $48, %xmm2, %xmm5, %xmm13 ++ vpblendw $3, %xmm12, %xmm13, %xmm13 ++ vpshufd $156, %xmm13, %xmm13 ++ vpaddd %xmm15, %xmm13, %xmm15 ++ vpaddd %xmm14, %xmm15, %xmm15 ++ vpxor %xmm15, %xmm0, %xmm0 ++ vpshufb %xmm6, %xmm0, %xmm0 ++ vpaddd %xmm0, %xmm1, %xmm1 ++ vpxor %xmm1, %xmm14, %xmm14 ++ vpshufd $147, %xmm0, %xmm0 ++ vpshufd $78, %xmm1, %xmm1 ++ vpslld $25, %xmm14, %xmm13 ++ vpsrld $7, %xmm14, %xmm14 ++ vpxor %xmm13, %xmm14, %xmm14 ++ vpunpcklqdq %xmm2, %xmm4, %xmm13 ++ vpshufd $57, %xmm14, %xmm14 ++ vpblendw $12, %xmm12, %xmm13, %xmm12 ++ vpshufd $180, %xmm12, %xmm12 ++ vpaddd %xmm15, %xmm12, %xmm15 ++ vpaddd %xmm14, %xmm15, %xmm15 ++ vpxor %xmm15, %xmm0, %xmm0 ++ vpshufb %xmm7, %xmm0, %xmm0 ++ vpaddd %xmm0, %xmm1, %xmm1 ++ vpxor %xmm1, %xmm14, %xmm14 ++ vpslld $20, %xmm14, %xmm12 ++ vpsrld $12, %xmm14, %xmm14 ++ vpxor %xmm12, %xmm14, %xmm14 ++ vpunpckhqdq %xmm9, %xmm4, %xmm12 ++ vpshufd $198, %xmm12, %xmm12 ++ vpaddd %xmm15, %xmm12, %xmm15 ++ vpaddd %xmm14, %xmm15, %xmm15 ++ vpxor %xmm15, %xmm0, %xmm0 ++ vpaddd %xmm15, %xmm8, %xmm15 ++ vpshufb %xmm6, %xmm0, %xmm0 ++ vpaddd %xmm0, %xmm1, %xmm1 ++ vpxor %xmm1, %xmm14, %xmm14 ++ vpshufd $57, %xmm0, %xmm0 ++ vpshufd $78, %xmm1, %xmm1 ++ vpslld $25, %xmm14, %xmm12 ++ vpsrld $7, %xmm14, %xmm14 ++ vpxor %xmm12, %xmm14, %xmm14 ++ vpsrldq $4, %xmm4, %xmm12 ++ vpshufd $147, %xmm14, %xmm14 ++ vpaddd %xmm14, %xmm15, %xmm15 ++ vpxor %xmm15, %xmm0, %xmm0 ++ vpshufb %xmm7, %xmm0, %xmm0 ++ vpaddd %xmm0, %xmm1, %xmm1 ++ vpxor %xmm1, %xmm14, %xmm14 ++ vpslld $20, %xmm14, %xmm8 ++ vpsrld $12, %xmm14, %xmm14 ++ vpxor %xmm14, %xmm8, %xmm14 ++ vpblendw $48, %xmm5, %xmm2, %xmm8 ++ vpblendw $3, %xmm12, %xmm8, %xmm8 ++ vpunpckhqdq %xmm5, %xmm4, %xmm12 ++ vpshufd $75, %xmm8, %xmm8 ++ vpblendw $60, %xmm10, %xmm12, %xmm10 ++ vpaddd %xmm15, %xmm8, %xmm15 ++ vpaddd %xmm14, %xmm15, %xmm15 ++ vpxor %xmm0, %xmm15, %xmm0 ++ vpshufd $45, %xmm10, %xmm10 ++ vpshufb %xmm6, %xmm0, %xmm0 ++ vpaddd %xmm15, %xmm10, %xmm15 ++ vpaddd %xmm0, %xmm1, %xmm1 ++ vpxor %xmm1, %xmm14, %xmm14 ++ vpshufd $147, %xmm0, %xmm0 ++ vpshufd $78, %xmm1, %xmm1 ++ vpslld $25, %xmm14, %xmm8 ++ vpsrld $7, %xmm14, %xmm14 ++ vpxor %xmm14, %xmm8, %xmm8 ++ vpshufd $57, %xmm8, %xmm8 ++ vpaddd %xmm8, %xmm15, %xmm15 ++ vpxor %xmm0, %xmm15, %xmm0 ++ vpshufb %xmm7, %xmm0, %xmm0 ++ vpaddd %xmm0, %xmm1, %xmm1 ++ vpxor %xmm8, %xmm1, %xmm8 ++ vpslld $20, %xmm8, %xmm10 ++ vpsrld $12, %xmm8, %xmm8 ++ vpxor %xmm8, %xmm10, %xmm10 ++ vpunpckldq %xmm3, %xmm4, %xmm8 ++ vpunpcklqdq %xmm9, %xmm8, %xmm9 ++ vpaddd %xmm9, %xmm15, %xmm9 ++ vpaddd %xmm10, %xmm9, %xmm9 ++ vpxor %xmm0, %xmm9, %xmm8 ++ vpshufb %xmm6, %xmm8, %xmm8 ++ vpaddd %xmm8, %xmm1, %xmm1 ++ vpxor %xmm1, %xmm10, %xmm10 ++ vpshufd $57, %xmm8, %xmm8 ++ vpshufd $78, %xmm1, %xmm1 ++ vpslld $25, %xmm10, %xmm12 ++ vpsrld $7, %xmm10, %xmm10 ++ vpxor %xmm10, %xmm12, %xmm10 ++ vpblendw $48, %xmm4, %xmm3, %xmm12 ++ vpshufd $147, %xmm10, %xmm0 ++ vpunpckhdq %xmm5, %xmm3, %xmm10 ++ vpshufd $78, %xmm12, %xmm12 ++ vpunpcklqdq %xmm4, %xmm10, %xmm10 ++ vpblendw $192, %xmm2, %xmm10, %xmm10 ++ vpshufhw $78, %xmm10, %xmm10 ++ vpaddd %xmm10, %xmm9, %xmm10 ++ vpaddd %xmm0, %xmm10, %xmm10 ++ vpxor %xmm8, %xmm10, %xmm8 ++ vpshufb %xmm7, %xmm8, %xmm8 ++ vpaddd %xmm8, %xmm1, %xmm1 ++ vpxor %xmm0, %xmm1, %xmm9 ++ vpslld $20, %xmm9, %xmm0 ++ vpsrld $12, %xmm9, %xmm9 ++ vpxor %xmm9, %xmm0, %xmm0 ++ vpunpckhdq %xmm5, %xmm4, %xmm9 ++ vpblendw $240, %xmm9, %xmm2, %xmm13 ++ vpshufd $39, %xmm13, %xmm13 ++ vpaddd %xmm10, %xmm13, %xmm10 ++ vpaddd %xmm0, %xmm10, %xmm10 ++ vpxor %xmm8, %xmm10, %xmm8 ++ vpblendw $12, %xmm4, %xmm2, %xmm13 ++ vpshufb %xmm6, %xmm8, %xmm8 ++ vpslldq $4, %xmm13, %xmm13 ++ vpblendw $15, %xmm5, %xmm13, %xmm13 ++ vpaddd %xmm8, %xmm1, %xmm1 ++ vpxor %xmm1, %xmm0, %xmm0 ++ vpaddd %xmm13, %xmm10, %xmm13 ++ vpshufd $147, %xmm8, %xmm8 ++ vpshufd $78, %xmm1, %xmm1 ++ vpslld $25, %xmm0, %xmm14 ++ vpsrld $7, %xmm0, %xmm0 ++ vpxor %xmm0, %xmm14, %xmm14 ++ vpshufd $57, %xmm14, %xmm14 ++ vpaddd %xmm14, %xmm13, %xmm13 ++ vpxor %xmm8, %xmm13, %xmm8 ++ vpaddd %xmm13, %xmm12, %xmm12 ++ vpshufb %xmm7, %xmm8, %xmm8 ++ vpaddd %xmm8, %xmm1, %xmm1 ++ vpxor %xmm14, %xmm1, %xmm14 ++ vpslld $20, %xmm14, %xmm10 ++ vpsrld $12, %xmm14, %xmm14 ++ vpxor %xmm14, %xmm10, %xmm10 ++ vpaddd %xmm10, %xmm12, %xmm12 ++ vpxor %xmm8, %xmm12, %xmm8 ++ vpshufb %xmm6, %xmm8, %xmm8 ++ vpaddd %xmm8, %xmm1, %xmm1 ++ vpxor %xmm1, %xmm10, %xmm0 ++ vpshufd $57, %xmm8, %xmm8 ++ vpshufd $78, %xmm1, %xmm1 ++ vpslld $25, %xmm0, %xmm10 ++ vpsrld $7, %xmm0, %xmm0 ++ vpxor %xmm0, %xmm10, %xmm10 ++ vpblendw $48, %xmm2, %xmm3, %xmm0 ++ vpblendw $15, %xmm11, %xmm0, %xmm0 ++ vpshufd $147, %xmm10, %xmm10 ++ vpshufd $114, %xmm0, %xmm0 ++ vpaddd %xmm12, %xmm0, %xmm0 ++ vpaddd %xmm10, %xmm0, %xmm0 ++ vpxor %xmm8, %xmm0, %xmm8 ++ vpshufb %xmm7, %xmm8, %xmm8 ++ vpaddd %xmm8, %xmm1, %xmm1 ++ vpxor %xmm10, %xmm1, %xmm10 ++ vpslld $20, %xmm10, %xmm11 ++ vpsrld $12, %xmm10, %xmm10 ++ vpxor %xmm10, %xmm11, %xmm10 ++ vpslldq $4, %xmm4, %xmm11 ++ vpblendw $192, %xmm11, %xmm3, %xmm3 ++ vpunpckldq %xmm5, %xmm4, %xmm4 ++ vpshufd $99, %xmm3, %xmm3 ++ vpaddd %xmm0, %xmm3, %xmm3 ++ vpaddd %xmm10, %xmm3, %xmm3 ++ vpxor %xmm8, %xmm3, %xmm11 ++ vpunpckldq %xmm5, %xmm2, %xmm0 ++ vpblendw $192, %xmm2, %xmm5, %xmm2 ++ vpshufb %xmm6, %xmm11, %xmm11 ++ vpunpckhqdq %xmm0, %xmm9, %xmm0 ++ vpblendw $15, %xmm4, %xmm2, %xmm4 ++ vpaddd %xmm11, %xmm1, %xmm1 ++ vpxor %xmm1, %xmm10, %xmm10 ++ vpshufd $147, %xmm11, %xmm11 ++ vpshufd $201, %xmm0, %xmm0 ++ vpslld $25, %xmm10, %xmm8 ++ vpsrld $7, %xmm10, %xmm10 ++ vpxor %xmm10, %xmm8, %xmm10 ++ vpshufd $78, %xmm1, %xmm1 ++ vpaddd %xmm3, %xmm0, %xmm0 ++ vpshufd $27, %xmm4, %xmm4 ++ vpshufd $57, %xmm10, %xmm10 ++ vpaddd %xmm10, %xmm0, %xmm0 ++ vpxor %xmm11, %xmm0, %xmm11 ++ vpaddd %xmm0, %xmm4, %xmm0 ++ vpshufb %xmm7, %xmm11, %xmm7 ++ vpaddd %xmm7, %xmm1, %xmm1 ++ vpxor %xmm10, %xmm1, %xmm10 ++ vpslld $20, %xmm10, %xmm8 ++ vpsrld $12, %xmm10, %xmm10 ++ vpxor %xmm10, %xmm8, %xmm8 ++ vpaddd %xmm8, %xmm0, %xmm0 ++ vpxor %xmm7, %xmm0, %xmm7 ++ vpshufb %xmm6, %xmm7, %xmm6 ++ vpaddd %xmm6, %xmm1, %xmm1 ++ vpxor %xmm1, %xmm8, %xmm8 ++ vpshufd $78, %xmm1, %xmm1 ++ vpshufd $57, %xmm6, %xmm6 ++ vpslld $25, %xmm8, %xmm2 ++ vpsrld $7, %xmm8, %xmm8 ++ vpxor %xmm8, %xmm2, %xmm8 ++ vpxor (%rdi), %xmm1, %xmm1 ++ vpshufd $147, %xmm8, %xmm8 ++ vpxor %xmm0, %xmm1, %xmm0 ++ vmovups %xmm0, (%rdi) ++ vpxor 16(%rdi), %xmm8, %xmm0 ++ vpxor %xmm6, %xmm0, %xmm6 ++ vmovups %xmm6, 16(%rdi) ++ addq $64, %rsi ++ decq %rdx ++ jnz .Lbeginofloop ++.Lendofloop: ++ ret ++ENDPROC(blake2s_compress_avx) ++#endif /* CONFIG_AS_AVX */ ++ ++#ifdef CONFIG_AS_AVX512 ++ENTRY(blake2s_compress_avx512) ++ vmovdqu (%rdi),%xmm0 ++ vmovdqu 0x10(%rdi),%xmm1 ++ vmovdqu 0x20(%rdi),%xmm4 ++ vmovq %rcx,%xmm5 ++ vmovdqa IV(%rip),%xmm14 ++ vmovdqa IV+16(%rip),%xmm15 ++ jmp .Lblake2s_compress_avx512_mainloop ++.align 32 ++.Lblake2s_compress_avx512_mainloop: ++ vmovdqa %xmm0,%xmm10 ++ vmovdqa %xmm1,%xmm11 ++ vpaddq %xmm5,%xmm4,%xmm4 ++ vmovdqa %xmm14,%xmm2 ++ vpxor %xmm15,%xmm4,%xmm3 ++ vmovdqu (%rsi),%ymm6 ++ vmovdqu 0x20(%rsi),%ymm7 ++ addq $0x40,%rsi ++ leaq SIGMA(%rip),%rax ++ movb $0xa,%cl ++.Lblake2s_compress_avx512_roundloop: ++ addq $0x40,%rax ++ vmovdqa -0x40(%rax),%ymm8 ++ vmovdqa -0x20(%rax),%ymm9 ++ vpermi2d %ymm7,%ymm6,%ymm8 ++ vpermi2d %ymm7,%ymm6,%ymm9 ++ vmovdqa %ymm8,%ymm6 ++ vmovdqa %ymm9,%ymm7 ++ vpaddd %xmm8,%xmm0,%xmm0 ++ vpaddd %xmm1,%xmm0,%xmm0 ++ vpxor %xmm0,%xmm3,%xmm3 ++ vprord $0x10,%xmm3,%xmm3 ++ vpaddd %xmm3,%xmm2,%xmm2 ++ vpxor %xmm2,%xmm1,%xmm1 ++ vprord $0xc,%xmm1,%xmm1 ++ vextracti128 $0x1,%ymm8,%xmm8 ++ vpaddd %xmm8,%xmm0,%xmm0 ++ vpaddd %xmm1,%xmm0,%xmm0 ++ vpxor %xmm0,%xmm3,%xmm3 ++ vprord $0x8,%xmm3,%xmm3 ++ vpaddd %xmm3,%xmm2,%xmm2 ++ vpxor %xmm2,%xmm1,%xmm1 ++ vprord $0x7,%xmm1,%xmm1 ++ vpshufd $0x39,%xmm1,%xmm1 ++ vpshufd $0x4e,%xmm2,%xmm2 ++ vpshufd $0x93,%xmm3,%xmm3 ++ vpaddd %xmm9,%xmm0,%xmm0 ++ vpaddd %xmm1,%xmm0,%xmm0 ++ vpxor %xmm0,%xmm3,%xmm3 ++ vprord $0x10,%xmm3,%xmm3 ++ vpaddd %xmm3,%xmm2,%xmm2 ++ vpxor %xmm2,%xmm1,%xmm1 ++ vprord $0xc,%xmm1,%xmm1 ++ vextracti128 $0x1,%ymm9,%xmm9 ++ vpaddd %xmm9,%xmm0,%xmm0 ++ vpaddd %xmm1,%xmm0,%xmm0 ++ vpxor %xmm0,%xmm3,%xmm3 ++ vprord $0x8,%xmm3,%xmm3 ++ vpaddd %xmm3,%xmm2,%xmm2 ++ vpxor %xmm2,%xmm1,%xmm1 ++ vprord $0x7,%xmm1,%xmm1 ++ vpshufd $0x93,%xmm1,%xmm1 ++ vpshufd $0x4e,%xmm2,%xmm2 ++ vpshufd $0x39,%xmm3,%xmm3 ++ decb %cl ++ jne .Lblake2s_compress_avx512_roundloop ++ vpxor %xmm10,%xmm0,%xmm0 ++ vpxor %xmm11,%xmm1,%xmm1 ++ vpxor %xmm2,%xmm0,%xmm0 ++ vpxor %xmm3,%xmm1,%xmm1 ++ decq %rdx ++ jne .Lblake2s_compress_avx512_mainloop ++ vmovdqu %xmm0,(%rdi) ++ vmovdqu %xmm1,0x10(%rdi) ++ vmovdqu %xmm4,0x20(%rdi) ++ vzeroupper ++ retq ++ENDPROC(blake2s_compress_avx512) ++#endif /* CONFIG_AS_AVX512 */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/chacha20-arm64.S 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,1940 @@ ++/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. ++ */ ++ ++#include ++ ++.text ++.align 5 ++.Lsigma: ++.quad 0x3320646e61707865,0x6b20657479622d32 // endian-neutral ++.Lone: ++.long 1,0,0,0 ++ ++.align 5 ++ENTRY(chacha20_arm) ++ cbz x2,.Labort ++.Lshort: ++ stp x29,x30,[sp,#-96]! ++ add x29,sp,#0 ++ ++ adr x5,.Lsigma ++ stp x19,x20,[sp,#16] ++ stp x21,x22,[sp,#32] ++ stp x23,x24,[sp,#48] ++ stp x25,x26,[sp,#64] ++ stp x27,x28,[sp,#80] ++ sub sp,sp,#64 ++ ++ ldp x22,x23,[x5] // load sigma ++ ldp x24,x25,[x3] // load key ++ ldp x26,x27,[x3,#16] ++ ldp x28,x30,[x4] // load counter ++#ifdef __ARMEB__ ++ ror x24,x24,#32 ++ ror x25,x25,#32 ++ ror x26,x26,#32 ++ ror x27,x27,#32 ++ ror x28,x28,#32 ++ ror x30,x30,#32 ++#endif ++ ++.Loop_outer: ++ mov w5,w22 // unpack key block ++ lsr x6,x22,#32 ++ mov w7,w23 ++ lsr x8,x23,#32 ++ mov w9,w24 ++ lsr x10,x24,#32 ++ mov w11,w25 ++ lsr x12,x25,#32 ++ mov w13,w26 ++ lsr x14,x26,#32 ++ mov w15,w27 ++ lsr x16,x27,#32 ++ mov w17,w28 ++ lsr x19,x28,#32 ++ mov w20,w30 ++ lsr x21,x30,#32 ++ ++ mov x4,#10 ++ subs x2,x2,#64 ++.Loop: ++ sub x4,x4,#1 ++ add w5,w5,w9 ++ add w6,w6,w10 ++ add w7,w7,w11 ++ add w8,w8,w12 ++ eor w17,w17,w5 ++ eor w19,w19,w6 ++ eor w20,w20,w7 ++ eor w21,w21,w8 ++ ror w17,w17,#16 ++ ror w19,w19,#16 ++ ror w20,w20,#16 ++ ror w21,w21,#16 ++ add w13,w13,w17 ++ add w14,w14,w19 ++ add w15,w15,w20 ++ add w16,w16,w21 ++ eor w9,w9,w13 ++ eor w10,w10,w14 ++ eor w11,w11,w15 ++ eor w12,w12,w16 ++ ror w9,w9,#20 ++ ror w10,w10,#20 ++ ror w11,w11,#20 ++ ror w12,w12,#20 ++ add w5,w5,w9 ++ add w6,w6,w10 ++ add w7,w7,w11 ++ add w8,w8,w12 ++ eor w17,w17,w5 ++ eor w19,w19,w6 ++ eor w20,w20,w7 ++ eor w21,w21,w8 ++ ror w17,w17,#24 ++ ror w19,w19,#24 ++ ror w20,w20,#24 ++ ror w21,w21,#24 ++ add w13,w13,w17 ++ add w14,w14,w19 ++ add w15,w15,w20 ++ add w16,w16,w21 ++ eor w9,w9,w13 ++ eor w10,w10,w14 ++ eor w11,w11,w15 ++ eor w12,w12,w16 ++ ror w9,w9,#25 ++ ror w10,w10,#25 ++ ror w11,w11,#25 ++ ror w12,w12,#25 ++ add w5,w5,w10 ++ add w6,w6,w11 ++ add w7,w7,w12 ++ add w8,w8,w9 ++ eor w21,w21,w5 ++ eor w17,w17,w6 ++ eor w19,w19,w7 ++ eor w20,w20,w8 ++ ror w21,w21,#16 ++ ror w17,w17,#16 ++ ror w19,w19,#16 ++ ror w20,w20,#16 ++ add w15,w15,w21 ++ add w16,w16,w17 ++ add w13,w13,w19 ++ add w14,w14,w20 ++ eor w10,w10,w15 ++ eor w11,w11,w16 ++ eor w12,w12,w13 ++ eor w9,w9,w14 ++ ror w10,w10,#20 ++ ror w11,w11,#20 ++ ror w12,w12,#20 ++ ror w9,w9,#20 ++ add w5,w5,w10 ++ add w6,w6,w11 ++ add w7,w7,w12 ++ add w8,w8,w9 ++ eor w21,w21,w5 ++ eor w17,w17,w6 ++ eor w19,w19,w7 ++ eor w20,w20,w8 ++ ror w21,w21,#24 ++ ror w17,w17,#24 ++ ror w19,w19,#24 ++ ror w20,w20,#24 ++ add w15,w15,w21 ++ add w16,w16,w17 ++ add w13,w13,w19 ++ add w14,w14,w20 ++ eor w10,w10,w15 ++ eor w11,w11,w16 ++ eor w12,w12,w13 ++ eor w9,w9,w14 ++ ror w10,w10,#25 ++ ror w11,w11,#25 ++ ror w12,w12,#25 ++ ror w9,w9,#25 ++ cbnz x4,.Loop ++ ++ add w5,w5,w22 // accumulate key block ++ add x6,x6,x22,lsr#32 ++ add w7,w7,w23 ++ add x8,x8,x23,lsr#32 ++ add w9,w9,w24 ++ add x10,x10,x24,lsr#32 ++ add w11,w11,w25 ++ add x12,x12,x25,lsr#32 ++ add w13,w13,w26 ++ add x14,x14,x26,lsr#32 ++ add w15,w15,w27 ++ add x16,x16,x27,lsr#32 ++ add w17,w17,w28 ++ add x19,x19,x28,lsr#32 ++ add w20,w20,w30 ++ add x21,x21,x30,lsr#32 ++ ++ b.lo .Ltail ++ ++ add x5,x5,x6,lsl#32 // pack ++ add x7,x7,x8,lsl#32 ++ ldp x6,x8,[x1,#0] // load input ++ add x9,x9,x10,lsl#32 ++ add x11,x11,x12,lsl#32 ++ ldp x10,x12,[x1,#16] ++ add x13,x13,x14,lsl#32 ++ add x15,x15,x16,lsl#32 ++ ldp x14,x16,[x1,#32] ++ add x17,x17,x19,lsl#32 ++ add x20,x20,x21,lsl#32 ++ ldp x19,x21,[x1,#48] ++ add x1,x1,#64 ++#ifdef __ARMEB__ ++ rev x5,x5 ++ rev x7,x7 ++ rev x9,x9 ++ rev x11,x11 ++ rev x13,x13 ++ rev x15,x15 ++ rev x17,x17 ++ rev x20,x20 ++#endif ++ eor x5,x5,x6 ++ eor x7,x7,x8 ++ eor x9,x9,x10 ++ eor x11,x11,x12 ++ eor x13,x13,x14 ++ eor x15,x15,x16 ++ eor x17,x17,x19 ++ eor x20,x20,x21 ++ ++ stp x5,x7,[x0,#0] // store output ++ add x28,x28,#1 // increment counter ++ stp x9,x11,[x0,#16] ++ stp x13,x15,[x0,#32] ++ stp x17,x20,[x0,#48] ++ add x0,x0,#64 ++ ++ b.hi .Loop_outer ++ ++ ldp x19,x20,[x29,#16] ++ add sp,sp,#64 ++ ldp x21,x22,[x29,#32] ++ ldp x23,x24,[x29,#48] ++ ldp x25,x26,[x29,#64] ++ ldp x27,x28,[x29,#80] ++ ldp x29,x30,[sp],#96 ++.Labort: ++ ret ++ ++.align 4 ++.Ltail: ++ add x2,x2,#64 ++.Less_than_64: ++ sub x0,x0,#1 ++ add x1,x1,x2 ++ add x0,x0,x2 ++ add x4,sp,x2 ++ neg x2,x2 ++ ++ add x5,x5,x6,lsl#32 // pack ++ add x7,x7,x8,lsl#32 ++ add x9,x9,x10,lsl#32 ++ add x11,x11,x12,lsl#32 ++ add x13,x13,x14,lsl#32 ++ add x15,x15,x16,lsl#32 ++ add x17,x17,x19,lsl#32 ++ add x20,x20,x21,lsl#32 ++#ifdef __ARMEB__ ++ rev x5,x5 ++ rev x7,x7 ++ rev x9,x9 ++ rev x11,x11 ++ rev x13,x13 ++ rev x15,x15 ++ rev x17,x17 ++ rev x20,x20 ++#endif ++ stp x5,x7,[sp,#0] ++ stp x9,x11,[sp,#16] ++ stp x13,x15,[sp,#32] ++ stp x17,x20,[sp,#48] ++ ++.Loop_tail: ++ ldrb w10,[x1,x2] ++ ldrb w11,[x4,x2] ++ add x2,x2,#1 ++ eor w10,w10,w11 ++ strb w10,[x0,x2] ++ cbnz x2,.Loop_tail ++ ++ stp xzr,xzr,[sp,#0] ++ stp xzr,xzr,[sp,#16] ++ stp xzr,xzr,[sp,#32] ++ stp xzr,xzr,[sp,#48] ++ ++ ldp x19,x20,[x29,#16] ++ add sp,sp,#64 ++ ldp x21,x22,[x29,#32] ++ ldp x23,x24,[x29,#48] ++ ldp x25,x26,[x29,#64] ++ ldp x27,x28,[x29,#80] ++ ldp x29,x30,[sp],#96 ++ ret ++ENDPROC(chacha20_arm) ++ ++.align 5 ++ENTRY(chacha20_neon) ++ cbz x2,.Labort_neon ++ cmp x2,#192 ++ b.lo .Lshort ++ ++ stp x29,x30,[sp,#-96]! ++ add x29,sp,#0 ++ ++ adr x5,.Lsigma ++ stp x19,x20,[sp,#16] ++ stp x21,x22,[sp,#32] ++ stp x23,x24,[sp,#48] ++ stp x25,x26,[sp,#64] ++ stp x27,x28,[sp,#80] ++ cmp x2,#512 ++ b.hs .L512_or_more_neon ++ ++ sub sp,sp,#64 ++ ++ ldp x22,x23,[x5] // load sigma ++ ld1 {v24.4s},[x5],#16 ++ ldp x24,x25,[x3] // load key ++ ldp x26,x27,[x3,#16] ++ ld1 {v25.4s,v26.4s},[x3] ++ ldp x28,x30,[x4] // load counter ++ ld1 {v27.4s},[x4] ++ ld1 {v31.4s},[x5] ++#ifdef __ARMEB__ ++ rev64 v24.4s,v24.4s ++ ror x24,x24,#32 ++ ror x25,x25,#32 ++ ror x26,x26,#32 ++ ror x27,x27,#32 ++ ror x28,x28,#32 ++ ror x30,x30,#32 ++#endif ++ add v27.4s,v27.4s,v31.4s // += 1 ++ add v28.4s,v27.4s,v31.4s ++ add v29.4s,v28.4s,v31.4s ++ shl v31.4s,v31.4s,#2 // 1 -> 4 ++ ++.Loop_outer_neon: ++ mov w5,w22 // unpack key block ++ lsr x6,x22,#32 ++ mov v0.16b,v24.16b ++ mov w7,w23 ++ lsr x8,x23,#32 ++ mov v4.16b,v24.16b ++ mov w9,w24 ++ lsr x10,x24,#32 ++ mov v16.16b,v24.16b ++ mov w11,w25 ++ mov v1.16b,v25.16b ++ lsr x12,x25,#32 ++ mov v5.16b,v25.16b ++ mov w13,w26 ++ mov v17.16b,v25.16b ++ lsr x14,x26,#32 ++ mov v3.16b,v27.16b ++ mov w15,w27 ++ mov v7.16b,v28.16b ++ lsr x16,x27,#32 ++ mov v19.16b,v29.16b ++ mov w17,w28 ++ mov v2.16b,v26.16b ++ lsr x19,x28,#32 ++ mov v6.16b,v26.16b ++ mov w20,w30 ++ mov v18.16b,v26.16b ++ lsr x21,x30,#32 ++ ++ mov x4,#10 ++ subs x2,x2,#256 ++.Loop_neon: ++ sub x4,x4,#1 ++ add v0.4s,v0.4s,v1.4s ++ add w5,w5,w9 ++ add v4.4s,v4.4s,v5.4s ++ add w6,w6,w10 ++ add v16.4s,v16.4s,v17.4s ++ add w7,w7,w11 ++ eor v3.16b,v3.16b,v0.16b ++ add w8,w8,w12 ++ eor v7.16b,v7.16b,v4.16b ++ eor w17,w17,w5 ++ eor v19.16b,v19.16b,v16.16b ++ eor w19,w19,w6 ++ rev32 v3.8h,v3.8h ++ eor w20,w20,w7 ++ rev32 v7.8h,v7.8h ++ eor w21,w21,w8 ++ rev32 v19.8h,v19.8h ++ ror w17,w17,#16 ++ add v2.4s,v2.4s,v3.4s ++ ror w19,w19,#16 ++ add v6.4s,v6.4s,v7.4s ++ ror w20,w20,#16 ++ add v18.4s,v18.4s,v19.4s ++ ror w21,w21,#16 ++ eor v20.16b,v1.16b,v2.16b ++ add w13,w13,w17 ++ eor v21.16b,v5.16b,v6.16b ++ add w14,w14,w19 ++ eor v22.16b,v17.16b,v18.16b ++ add w15,w15,w20 ++ ushr v1.4s,v20.4s,#20 ++ add w16,w16,w21 ++ ushr v5.4s,v21.4s,#20 ++ eor w9,w9,w13 ++ ushr v17.4s,v22.4s,#20 ++ eor w10,w10,w14 ++ sli v1.4s,v20.4s,#12 ++ eor w11,w11,w15 ++ sli v5.4s,v21.4s,#12 ++ eor w12,w12,w16 ++ sli v17.4s,v22.4s,#12 ++ ror w9,w9,#20 ++ add v0.4s,v0.4s,v1.4s ++ ror w10,w10,#20 ++ add v4.4s,v4.4s,v5.4s ++ ror w11,w11,#20 ++ add v16.4s,v16.4s,v17.4s ++ ror w12,w12,#20 ++ eor v20.16b,v3.16b,v0.16b ++ add w5,w5,w9 ++ eor v21.16b,v7.16b,v4.16b ++ add w6,w6,w10 ++ eor v22.16b,v19.16b,v16.16b ++ add w7,w7,w11 ++ ushr v3.4s,v20.4s,#24 ++ add w8,w8,w12 ++ ushr v7.4s,v21.4s,#24 ++ eor w17,w17,w5 ++ ushr v19.4s,v22.4s,#24 ++ eor w19,w19,w6 ++ sli v3.4s,v20.4s,#8 ++ eor w20,w20,w7 ++ sli v7.4s,v21.4s,#8 ++ eor w21,w21,w8 ++ sli v19.4s,v22.4s,#8 ++ ror w17,w17,#24 ++ add v2.4s,v2.4s,v3.4s ++ ror w19,w19,#24 ++ add v6.4s,v6.4s,v7.4s ++ ror w20,w20,#24 ++ add v18.4s,v18.4s,v19.4s ++ ror w21,w21,#24 ++ eor v20.16b,v1.16b,v2.16b ++ add w13,w13,w17 ++ eor v21.16b,v5.16b,v6.16b ++ add w14,w14,w19 ++ eor v22.16b,v17.16b,v18.16b ++ add w15,w15,w20 ++ ushr v1.4s,v20.4s,#25 ++ add w16,w16,w21 ++ ushr v5.4s,v21.4s,#25 ++ eor w9,w9,w13 ++ ushr v17.4s,v22.4s,#25 ++ eor w10,w10,w14 ++ sli v1.4s,v20.4s,#7 ++ eor w11,w11,w15 ++ sli v5.4s,v21.4s,#7 ++ eor w12,w12,w16 ++ sli v17.4s,v22.4s,#7 ++ ror w9,w9,#25 ++ ext v2.16b,v2.16b,v2.16b,#8 ++ ror w10,w10,#25 ++ ext v6.16b,v6.16b,v6.16b,#8 ++ ror w11,w11,#25 ++ ext v18.16b,v18.16b,v18.16b,#8 ++ ror w12,w12,#25 ++ ext v3.16b,v3.16b,v3.16b,#12 ++ ext v7.16b,v7.16b,v7.16b,#12 ++ ext v19.16b,v19.16b,v19.16b,#12 ++ ext v1.16b,v1.16b,v1.16b,#4 ++ ext v5.16b,v5.16b,v5.16b,#4 ++ ext v17.16b,v17.16b,v17.16b,#4 ++ add v0.4s,v0.4s,v1.4s ++ add w5,w5,w10 ++ add v4.4s,v4.4s,v5.4s ++ add w6,w6,w11 ++ add v16.4s,v16.4s,v17.4s ++ add w7,w7,w12 ++ eor v3.16b,v3.16b,v0.16b ++ add w8,w8,w9 ++ eor v7.16b,v7.16b,v4.16b ++ eor w21,w21,w5 ++ eor v19.16b,v19.16b,v16.16b ++ eor w17,w17,w6 ++ rev32 v3.8h,v3.8h ++ eor w19,w19,w7 ++ rev32 v7.8h,v7.8h ++ eor w20,w20,w8 ++ rev32 v19.8h,v19.8h ++ ror w21,w21,#16 ++ add v2.4s,v2.4s,v3.4s ++ ror w17,w17,#16 ++ add v6.4s,v6.4s,v7.4s ++ ror w19,w19,#16 ++ add v18.4s,v18.4s,v19.4s ++ ror w20,w20,#16 ++ eor v20.16b,v1.16b,v2.16b ++ add w15,w15,w21 ++ eor v21.16b,v5.16b,v6.16b ++ add w16,w16,w17 ++ eor v22.16b,v17.16b,v18.16b ++ add w13,w13,w19 ++ ushr v1.4s,v20.4s,#20 ++ add w14,w14,w20 ++ ushr v5.4s,v21.4s,#20 ++ eor w10,w10,w15 ++ ushr v17.4s,v22.4s,#20 ++ eor w11,w11,w16 ++ sli v1.4s,v20.4s,#12 ++ eor w12,w12,w13 ++ sli v5.4s,v21.4s,#12 ++ eor w9,w9,w14 ++ sli v17.4s,v22.4s,#12 ++ ror w10,w10,#20 ++ add v0.4s,v0.4s,v1.4s ++ ror w11,w11,#20 ++ add v4.4s,v4.4s,v5.4s ++ ror w12,w12,#20 ++ add v16.4s,v16.4s,v17.4s ++ ror w9,w9,#20 ++ eor v20.16b,v3.16b,v0.16b ++ add w5,w5,w10 ++ eor v21.16b,v7.16b,v4.16b ++ add w6,w6,w11 ++ eor v22.16b,v19.16b,v16.16b ++ add w7,w7,w12 ++ ushr v3.4s,v20.4s,#24 ++ add w8,w8,w9 ++ ushr v7.4s,v21.4s,#24 ++ eor w21,w21,w5 ++ ushr v19.4s,v22.4s,#24 ++ eor w17,w17,w6 ++ sli v3.4s,v20.4s,#8 ++ eor w19,w19,w7 ++ sli v7.4s,v21.4s,#8 ++ eor w20,w20,w8 ++ sli v19.4s,v22.4s,#8 ++ ror w21,w21,#24 ++ add v2.4s,v2.4s,v3.4s ++ ror w17,w17,#24 ++ add v6.4s,v6.4s,v7.4s ++ ror w19,w19,#24 ++ add v18.4s,v18.4s,v19.4s ++ ror w20,w20,#24 ++ eor v20.16b,v1.16b,v2.16b ++ add w15,w15,w21 ++ eor v21.16b,v5.16b,v6.16b ++ add w16,w16,w17 ++ eor v22.16b,v17.16b,v18.16b ++ add w13,w13,w19 ++ ushr v1.4s,v20.4s,#25 ++ add w14,w14,w20 ++ ushr v5.4s,v21.4s,#25 ++ eor w10,w10,w15 ++ ushr v17.4s,v22.4s,#25 ++ eor w11,w11,w16 ++ sli v1.4s,v20.4s,#7 ++ eor w12,w12,w13 ++ sli v5.4s,v21.4s,#7 ++ eor w9,w9,w14 ++ sli v17.4s,v22.4s,#7 ++ ror w10,w10,#25 ++ ext v2.16b,v2.16b,v2.16b,#8 ++ ror w11,w11,#25 ++ ext v6.16b,v6.16b,v6.16b,#8 ++ ror w12,w12,#25 ++ ext v18.16b,v18.16b,v18.16b,#8 ++ ror w9,w9,#25 ++ ext v3.16b,v3.16b,v3.16b,#4 ++ ext v7.16b,v7.16b,v7.16b,#4 ++ ext v19.16b,v19.16b,v19.16b,#4 ++ ext v1.16b,v1.16b,v1.16b,#12 ++ ext v5.16b,v5.16b,v5.16b,#12 ++ ext v17.16b,v17.16b,v17.16b,#12 ++ cbnz x4,.Loop_neon ++ ++ add w5,w5,w22 // accumulate key block ++ add v0.4s,v0.4s,v24.4s ++ add x6,x6,x22,lsr#32 ++ add v4.4s,v4.4s,v24.4s ++ add w7,w7,w23 ++ add v16.4s,v16.4s,v24.4s ++ add x8,x8,x23,lsr#32 ++ add v2.4s,v2.4s,v26.4s ++ add w9,w9,w24 ++ add v6.4s,v6.4s,v26.4s ++ add x10,x10,x24,lsr#32 ++ add v18.4s,v18.4s,v26.4s ++ add w11,w11,w25 ++ add v3.4s,v3.4s,v27.4s ++ add x12,x12,x25,lsr#32 ++ add w13,w13,w26 ++ add v7.4s,v7.4s,v28.4s ++ add x14,x14,x26,lsr#32 ++ add w15,w15,w27 ++ add v19.4s,v19.4s,v29.4s ++ add x16,x16,x27,lsr#32 ++ add w17,w17,w28 ++ add v1.4s,v1.4s,v25.4s ++ add x19,x19,x28,lsr#32 ++ add w20,w20,w30 ++ add v5.4s,v5.4s,v25.4s ++ add x21,x21,x30,lsr#32 ++ add v17.4s,v17.4s,v25.4s ++ ++ b.lo .Ltail_neon ++ ++ add x5,x5,x6,lsl#32 // pack ++ add x7,x7,x8,lsl#32 ++ ldp x6,x8,[x1,#0] // load input ++ add x9,x9,x10,lsl#32 ++ add x11,x11,x12,lsl#32 ++ ldp x10,x12,[x1,#16] ++ add x13,x13,x14,lsl#32 ++ add x15,x15,x16,lsl#32 ++ ldp x14,x16,[x1,#32] ++ add x17,x17,x19,lsl#32 ++ add x20,x20,x21,lsl#32 ++ ldp x19,x21,[x1,#48] ++ add x1,x1,#64 ++#ifdef __ARMEB__ ++ rev x5,x5 ++ rev x7,x7 ++ rev x9,x9 ++ rev x11,x11 ++ rev x13,x13 ++ rev x15,x15 ++ rev x17,x17 ++ rev x20,x20 ++#endif ++ ld1 {v20.16b,v21.16b,v22.16b,v23.16b},[x1],#64 ++ eor x5,x5,x6 ++ eor x7,x7,x8 ++ eor x9,x9,x10 ++ eor x11,x11,x12 ++ eor x13,x13,x14 ++ eor v0.16b,v0.16b,v20.16b ++ eor x15,x15,x16 ++ eor v1.16b,v1.16b,v21.16b ++ eor x17,x17,x19 ++ eor v2.16b,v2.16b,v22.16b ++ eor x20,x20,x21 ++ eor v3.16b,v3.16b,v23.16b ++ ld1 {v20.16b,v21.16b,v22.16b,v23.16b},[x1],#64 ++ ++ stp x5,x7,[x0,#0] // store output ++ add x28,x28,#4 // increment counter ++ stp x9,x11,[x0,#16] ++ add v27.4s,v27.4s,v31.4s // += 4 ++ stp x13,x15,[x0,#32] ++ add v28.4s,v28.4s,v31.4s ++ stp x17,x20,[x0,#48] ++ add v29.4s,v29.4s,v31.4s ++ add x0,x0,#64 ++ ++ st1 {v0.16b,v1.16b,v2.16b,v3.16b},[x0],#64 ++ ld1 {v0.16b,v1.16b,v2.16b,v3.16b},[x1],#64 ++ ++ eor v4.16b,v4.16b,v20.16b ++ eor v5.16b,v5.16b,v21.16b ++ eor v6.16b,v6.16b,v22.16b ++ eor v7.16b,v7.16b,v23.16b ++ st1 {v4.16b,v5.16b,v6.16b,v7.16b},[x0],#64 ++ ++ eor v16.16b,v16.16b,v0.16b ++ eor v17.16b,v17.16b,v1.16b ++ eor v18.16b,v18.16b,v2.16b ++ eor v19.16b,v19.16b,v3.16b ++ st1 {v16.16b,v17.16b,v18.16b,v19.16b},[x0],#64 ++ ++ b.hi .Loop_outer_neon ++ ++ ldp x19,x20,[x29,#16] ++ add sp,sp,#64 ++ ldp x21,x22,[x29,#32] ++ ldp x23,x24,[x29,#48] ++ ldp x25,x26,[x29,#64] ++ ldp x27,x28,[x29,#80] ++ ldp x29,x30,[sp],#96 ++ ret ++ ++.Ltail_neon: ++ add x2,x2,#256 ++ cmp x2,#64 ++ b.lo .Less_than_64 ++ ++ add x5,x5,x6,lsl#32 // pack ++ add x7,x7,x8,lsl#32 ++ ldp x6,x8,[x1,#0] // load input ++ add x9,x9,x10,lsl#32 ++ add x11,x11,x12,lsl#32 ++ ldp x10,x12,[x1,#16] ++ add x13,x13,x14,lsl#32 ++ add x15,x15,x16,lsl#32 ++ ldp x14,x16,[x1,#32] ++ add x17,x17,x19,lsl#32 ++ add x20,x20,x21,lsl#32 ++ ldp x19,x21,[x1,#48] ++ add x1,x1,#64 ++#ifdef __ARMEB__ ++ rev x5,x5 ++ rev x7,x7 ++ rev x9,x9 ++ rev x11,x11 ++ rev x13,x13 ++ rev x15,x15 ++ rev x17,x17 ++ rev x20,x20 ++#endif ++ eor x5,x5,x6 ++ eor x7,x7,x8 ++ eor x9,x9,x10 ++ eor x11,x11,x12 ++ eor x13,x13,x14 ++ eor x15,x15,x16 ++ eor x17,x17,x19 ++ eor x20,x20,x21 ++ ++ stp x5,x7,[x0,#0] // store output ++ add x28,x28,#4 // increment counter ++ stp x9,x11,[x0,#16] ++ stp x13,x15,[x0,#32] ++ stp x17,x20,[x0,#48] ++ add x0,x0,#64 ++ b.eq .Ldone_neon ++ sub x2,x2,#64 ++ cmp x2,#64 ++ b.lo .Less_than_128 ++ ++ ld1 {v20.16b,v21.16b,v22.16b,v23.16b},[x1],#64 ++ eor v0.16b,v0.16b,v20.16b ++ eor v1.16b,v1.16b,v21.16b ++ eor v2.16b,v2.16b,v22.16b ++ eor v3.16b,v3.16b,v23.16b ++ st1 {v0.16b,v1.16b,v2.16b,v3.16b},[x0],#64 ++ b.eq .Ldone_neon ++ sub x2,x2,#64 ++ cmp x2,#64 ++ b.lo .Less_than_192 ++ ++ ld1 {v20.16b,v21.16b,v22.16b,v23.16b},[x1],#64 ++ eor v4.16b,v4.16b,v20.16b ++ eor v5.16b,v5.16b,v21.16b ++ eor v6.16b,v6.16b,v22.16b ++ eor v7.16b,v7.16b,v23.16b ++ st1 {v4.16b,v5.16b,v6.16b,v7.16b},[x0],#64 ++ b.eq .Ldone_neon ++ sub x2,x2,#64 ++ ++ st1 {v16.16b,v17.16b,v18.16b,v19.16b},[sp] ++ b .Last_neon ++ ++.Less_than_128: ++ st1 {v0.16b,v1.16b,v2.16b,v3.16b},[sp] ++ b .Last_neon ++.Less_than_192: ++ st1 {v4.16b,v5.16b,v6.16b,v7.16b},[sp] ++ b .Last_neon ++ ++.align 4 ++.Last_neon: ++ sub x0,x0,#1 ++ add x1,x1,x2 ++ add x0,x0,x2 ++ add x4,sp,x2 ++ neg x2,x2 ++ ++.Loop_tail_neon: ++ ldrb w10,[x1,x2] ++ ldrb w11,[x4,x2] ++ add x2,x2,#1 ++ eor w10,w10,w11 ++ strb w10,[x0,x2] ++ cbnz x2,.Loop_tail_neon ++ ++ stp xzr,xzr,[sp,#0] ++ stp xzr,xzr,[sp,#16] ++ stp xzr,xzr,[sp,#32] ++ stp xzr,xzr,[sp,#48] ++ ++.Ldone_neon: ++ ldp x19,x20,[x29,#16] ++ add sp,sp,#64 ++ ldp x21,x22,[x29,#32] ++ ldp x23,x24,[x29,#48] ++ ldp x25,x26,[x29,#64] ++ ldp x27,x28,[x29,#80] ++ ldp x29,x30,[sp],#96 ++ ret ++ ++.L512_or_more_neon: ++ sub sp,sp,#128+64 ++ ++ ldp x22,x23,[x5] // load sigma ++ ld1 {v24.4s},[x5],#16 ++ ldp x24,x25,[x3] // load key ++ ldp x26,x27,[x3,#16] ++ ld1 {v25.4s,v26.4s},[x3] ++ ldp x28,x30,[x4] // load counter ++ ld1 {v27.4s},[x4] ++ ld1 {v31.4s},[x5] ++#ifdef __ARMEB__ ++ rev64 v24.4s,v24.4s ++ ror x24,x24,#32 ++ ror x25,x25,#32 ++ ror x26,x26,#32 ++ ror x27,x27,#32 ++ ror x28,x28,#32 ++ ror x30,x30,#32 ++#endif ++ add v27.4s,v27.4s,v31.4s // += 1 ++ stp q24,q25,[sp,#0] // off-load key block, invariant part ++ add v27.4s,v27.4s,v31.4s // not typo ++ str q26,[sp,#32] ++ add v28.4s,v27.4s,v31.4s ++ add v29.4s,v28.4s,v31.4s ++ add v30.4s,v29.4s,v31.4s ++ shl v31.4s,v31.4s,#2 // 1 -> 4 ++ ++ stp d8,d9,[sp,#128+0] // meet ABI requirements ++ stp d10,d11,[sp,#128+16] ++ stp d12,d13,[sp,#128+32] ++ stp d14,d15,[sp,#128+48] ++ ++ sub x2,x2,#512 // not typo ++ ++.Loop_outer_512_neon: ++ mov v0.16b,v24.16b ++ mov v4.16b,v24.16b ++ mov v8.16b,v24.16b ++ mov v12.16b,v24.16b ++ mov v16.16b,v24.16b ++ mov v20.16b,v24.16b ++ mov v1.16b,v25.16b ++ mov w5,w22 // unpack key block ++ mov v5.16b,v25.16b ++ lsr x6,x22,#32 ++ mov v9.16b,v25.16b ++ mov w7,w23 ++ mov v13.16b,v25.16b ++ lsr x8,x23,#32 ++ mov v17.16b,v25.16b ++ mov w9,w24 ++ mov v21.16b,v25.16b ++ lsr x10,x24,#32 ++ mov v3.16b,v27.16b ++ mov w11,w25 ++ mov v7.16b,v28.16b ++ lsr x12,x25,#32 ++ mov v11.16b,v29.16b ++ mov w13,w26 ++ mov v15.16b,v30.16b ++ lsr x14,x26,#32 ++ mov v2.16b,v26.16b ++ mov w15,w27 ++ mov v6.16b,v26.16b ++ lsr x16,x27,#32 ++ add v19.4s,v3.4s,v31.4s // +4 ++ mov w17,w28 ++ add v23.4s,v7.4s,v31.4s // +4 ++ lsr x19,x28,#32 ++ mov v10.16b,v26.16b ++ mov w20,w30 ++ mov v14.16b,v26.16b ++ lsr x21,x30,#32 ++ mov v18.16b,v26.16b ++ stp q27,q28,[sp,#48] // off-load key block, variable part ++ mov v22.16b,v26.16b ++ str q29,[sp,#80] ++ ++ mov x4,#5 ++ subs x2,x2,#512 ++.Loop_upper_neon: ++ sub x4,x4,#1 ++ add v0.4s,v0.4s,v1.4s ++ add w5,w5,w9 ++ add v4.4s,v4.4s,v5.4s ++ add w6,w6,w10 ++ add v8.4s,v8.4s,v9.4s ++ add w7,w7,w11 ++ add v12.4s,v12.4s,v13.4s ++ add w8,w8,w12 ++ add v16.4s,v16.4s,v17.4s ++ eor w17,w17,w5 ++ add v20.4s,v20.4s,v21.4s ++ eor w19,w19,w6 ++ eor v3.16b,v3.16b,v0.16b ++ eor w20,w20,w7 ++ eor v7.16b,v7.16b,v4.16b ++ eor w21,w21,w8 ++ eor v11.16b,v11.16b,v8.16b ++ ror w17,w17,#16 ++ eor v15.16b,v15.16b,v12.16b ++ ror w19,w19,#16 ++ eor v19.16b,v19.16b,v16.16b ++ ror w20,w20,#16 ++ eor v23.16b,v23.16b,v20.16b ++ ror w21,w21,#16 ++ rev32 v3.8h,v3.8h ++ add w13,w13,w17 ++ rev32 v7.8h,v7.8h ++ add w14,w14,w19 ++ rev32 v11.8h,v11.8h ++ add w15,w15,w20 ++ rev32 v15.8h,v15.8h ++ add w16,w16,w21 ++ rev32 v19.8h,v19.8h ++ eor w9,w9,w13 ++ rev32 v23.8h,v23.8h ++ eor w10,w10,w14 ++ add v2.4s,v2.4s,v3.4s ++ eor w11,w11,w15 ++ add v6.4s,v6.4s,v7.4s ++ eor w12,w12,w16 ++ add v10.4s,v10.4s,v11.4s ++ ror w9,w9,#20 ++ add v14.4s,v14.4s,v15.4s ++ ror w10,w10,#20 ++ add v18.4s,v18.4s,v19.4s ++ ror w11,w11,#20 ++ add v22.4s,v22.4s,v23.4s ++ ror w12,w12,#20 ++ eor v24.16b,v1.16b,v2.16b ++ add w5,w5,w9 ++ eor v25.16b,v5.16b,v6.16b ++ add w6,w6,w10 ++ eor v26.16b,v9.16b,v10.16b ++ add w7,w7,w11 ++ eor v27.16b,v13.16b,v14.16b ++ add w8,w8,w12 ++ eor v28.16b,v17.16b,v18.16b ++ eor w17,w17,w5 ++ eor v29.16b,v21.16b,v22.16b ++ eor w19,w19,w6 ++ ushr v1.4s,v24.4s,#20 ++ eor w20,w20,w7 ++ ushr v5.4s,v25.4s,#20 ++ eor w21,w21,w8 ++ ushr v9.4s,v26.4s,#20 ++ ror w17,w17,#24 ++ ushr v13.4s,v27.4s,#20 ++ ror w19,w19,#24 ++ ushr v17.4s,v28.4s,#20 ++ ror w20,w20,#24 ++ ushr v21.4s,v29.4s,#20 ++ ror w21,w21,#24 ++ sli v1.4s,v24.4s,#12 ++ add w13,w13,w17 ++ sli v5.4s,v25.4s,#12 ++ add w14,w14,w19 ++ sli v9.4s,v26.4s,#12 ++ add w15,w15,w20 ++ sli v13.4s,v27.4s,#12 ++ add w16,w16,w21 ++ sli v17.4s,v28.4s,#12 ++ eor w9,w9,w13 ++ sli v21.4s,v29.4s,#12 ++ eor w10,w10,w14 ++ add v0.4s,v0.4s,v1.4s ++ eor w11,w11,w15 ++ add v4.4s,v4.4s,v5.4s ++ eor w12,w12,w16 ++ add v8.4s,v8.4s,v9.4s ++ ror w9,w9,#25 ++ add v12.4s,v12.4s,v13.4s ++ ror w10,w10,#25 ++ add v16.4s,v16.4s,v17.4s ++ ror w11,w11,#25 ++ add v20.4s,v20.4s,v21.4s ++ ror w12,w12,#25 ++ eor v24.16b,v3.16b,v0.16b ++ add w5,w5,w10 ++ eor v25.16b,v7.16b,v4.16b ++ add w6,w6,w11 ++ eor v26.16b,v11.16b,v8.16b ++ add w7,w7,w12 ++ eor v27.16b,v15.16b,v12.16b ++ add w8,w8,w9 ++ eor v28.16b,v19.16b,v16.16b ++ eor w21,w21,w5 ++ eor v29.16b,v23.16b,v20.16b ++ eor w17,w17,w6 ++ ushr v3.4s,v24.4s,#24 ++ eor w19,w19,w7 ++ ushr v7.4s,v25.4s,#24 ++ eor w20,w20,w8 ++ ushr v11.4s,v26.4s,#24 ++ ror w21,w21,#16 ++ ushr v15.4s,v27.4s,#24 ++ ror w17,w17,#16 ++ ushr v19.4s,v28.4s,#24 ++ ror w19,w19,#16 ++ ushr v23.4s,v29.4s,#24 ++ ror w20,w20,#16 ++ sli v3.4s,v24.4s,#8 ++ add w15,w15,w21 ++ sli v7.4s,v25.4s,#8 ++ add w16,w16,w17 ++ sli v11.4s,v26.4s,#8 ++ add w13,w13,w19 ++ sli v15.4s,v27.4s,#8 ++ add w14,w14,w20 ++ sli v19.4s,v28.4s,#8 ++ eor w10,w10,w15 ++ sli v23.4s,v29.4s,#8 ++ eor w11,w11,w16 ++ add v2.4s,v2.4s,v3.4s ++ eor w12,w12,w13 ++ add v6.4s,v6.4s,v7.4s ++ eor w9,w9,w14 ++ add v10.4s,v10.4s,v11.4s ++ ror w10,w10,#20 ++ add v14.4s,v14.4s,v15.4s ++ ror w11,w11,#20 ++ add v18.4s,v18.4s,v19.4s ++ ror w12,w12,#20 ++ add v22.4s,v22.4s,v23.4s ++ ror w9,w9,#20 ++ eor v24.16b,v1.16b,v2.16b ++ add w5,w5,w10 ++ eor v25.16b,v5.16b,v6.16b ++ add w6,w6,w11 ++ eor v26.16b,v9.16b,v10.16b ++ add w7,w7,w12 ++ eor v27.16b,v13.16b,v14.16b ++ add w8,w8,w9 ++ eor v28.16b,v17.16b,v18.16b ++ eor w21,w21,w5 ++ eor v29.16b,v21.16b,v22.16b ++ eor w17,w17,w6 ++ ushr v1.4s,v24.4s,#25 ++ eor w19,w19,w7 ++ ushr v5.4s,v25.4s,#25 ++ eor w20,w20,w8 ++ ushr v9.4s,v26.4s,#25 ++ ror w21,w21,#24 ++ ushr v13.4s,v27.4s,#25 ++ ror w17,w17,#24 ++ ushr v17.4s,v28.4s,#25 ++ ror w19,w19,#24 ++ ushr v21.4s,v29.4s,#25 ++ ror w20,w20,#24 ++ sli v1.4s,v24.4s,#7 ++ add w15,w15,w21 ++ sli v5.4s,v25.4s,#7 ++ add w16,w16,w17 ++ sli v9.4s,v26.4s,#7 ++ add w13,w13,w19 ++ sli v13.4s,v27.4s,#7 ++ add w14,w14,w20 ++ sli v17.4s,v28.4s,#7 ++ eor w10,w10,w15 ++ sli v21.4s,v29.4s,#7 ++ eor w11,w11,w16 ++ ext v2.16b,v2.16b,v2.16b,#8 ++ eor w12,w12,w13 ++ ext v6.16b,v6.16b,v6.16b,#8 ++ eor w9,w9,w14 ++ ext v10.16b,v10.16b,v10.16b,#8 ++ ror w10,w10,#25 ++ ext v14.16b,v14.16b,v14.16b,#8 ++ ror w11,w11,#25 ++ ext v18.16b,v18.16b,v18.16b,#8 ++ ror w12,w12,#25 ++ ext v22.16b,v22.16b,v22.16b,#8 ++ ror w9,w9,#25 ++ ext v3.16b,v3.16b,v3.16b,#12 ++ ext v7.16b,v7.16b,v7.16b,#12 ++ ext v11.16b,v11.16b,v11.16b,#12 ++ ext v15.16b,v15.16b,v15.16b,#12 ++ ext v19.16b,v19.16b,v19.16b,#12 ++ ext v23.16b,v23.16b,v23.16b,#12 ++ ext v1.16b,v1.16b,v1.16b,#4 ++ ext v5.16b,v5.16b,v5.16b,#4 ++ ext v9.16b,v9.16b,v9.16b,#4 ++ ext v13.16b,v13.16b,v13.16b,#4 ++ ext v17.16b,v17.16b,v17.16b,#4 ++ ext v21.16b,v21.16b,v21.16b,#4 ++ add v0.4s,v0.4s,v1.4s ++ add w5,w5,w9 ++ add v4.4s,v4.4s,v5.4s ++ add w6,w6,w10 ++ add v8.4s,v8.4s,v9.4s ++ add w7,w7,w11 ++ add v12.4s,v12.4s,v13.4s ++ add w8,w8,w12 ++ add v16.4s,v16.4s,v17.4s ++ eor w17,w17,w5 ++ add v20.4s,v20.4s,v21.4s ++ eor w19,w19,w6 ++ eor v3.16b,v3.16b,v0.16b ++ eor w20,w20,w7 ++ eor v7.16b,v7.16b,v4.16b ++ eor w21,w21,w8 ++ eor v11.16b,v11.16b,v8.16b ++ ror w17,w17,#16 ++ eor v15.16b,v15.16b,v12.16b ++ ror w19,w19,#16 ++ eor v19.16b,v19.16b,v16.16b ++ ror w20,w20,#16 ++ eor v23.16b,v23.16b,v20.16b ++ ror w21,w21,#16 ++ rev32 v3.8h,v3.8h ++ add w13,w13,w17 ++ rev32 v7.8h,v7.8h ++ add w14,w14,w19 ++ rev32 v11.8h,v11.8h ++ add w15,w15,w20 ++ rev32 v15.8h,v15.8h ++ add w16,w16,w21 ++ rev32 v19.8h,v19.8h ++ eor w9,w9,w13 ++ rev32 v23.8h,v23.8h ++ eor w10,w10,w14 ++ add v2.4s,v2.4s,v3.4s ++ eor w11,w11,w15 ++ add v6.4s,v6.4s,v7.4s ++ eor w12,w12,w16 ++ add v10.4s,v10.4s,v11.4s ++ ror w9,w9,#20 ++ add v14.4s,v14.4s,v15.4s ++ ror w10,w10,#20 ++ add v18.4s,v18.4s,v19.4s ++ ror w11,w11,#20 ++ add v22.4s,v22.4s,v23.4s ++ ror w12,w12,#20 ++ eor v24.16b,v1.16b,v2.16b ++ add w5,w5,w9 ++ eor v25.16b,v5.16b,v6.16b ++ add w6,w6,w10 ++ eor v26.16b,v9.16b,v10.16b ++ add w7,w7,w11 ++ eor v27.16b,v13.16b,v14.16b ++ add w8,w8,w12 ++ eor v28.16b,v17.16b,v18.16b ++ eor w17,w17,w5 ++ eor v29.16b,v21.16b,v22.16b ++ eor w19,w19,w6 ++ ushr v1.4s,v24.4s,#20 ++ eor w20,w20,w7 ++ ushr v5.4s,v25.4s,#20 ++ eor w21,w21,w8 ++ ushr v9.4s,v26.4s,#20 ++ ror w17,w17,#24 ++ ushr v13.4s,v27.4s,#20 ++ ror w19,w19,#24 ++ ushr v17.4s,v28.4s,#20 ++ ror w20,w20,#24 ++ ushr v21.4s,v29.4s,#20 ++ ror w21,w21,#24 ++ sli v1.4s,v24.4s,#12 ++ add w13,w13,w17 ++ sli v5.4s,v25.4s,#12 ++ add w14,w14,w19 ++ sli v9.4s,v26.4s,#12 ++ add w15,w15,w20 ++ sli v13.4s,v27.4s,#12 ++ add w16,w16,w21 ++ sli v17.4s,v28.4s,#12 ++ eor w9,w9,w13 ++ sli v21.4s,v29.4s,#12 ++ eor w10,w10,w14 ++ add v0.4s,v0.4s,v1.4s ++ eor w11,w11,w15 ++ add v4.4s,v4.4s,v5.4s ++ eor w12,w12,w16 ++ add v8.4s,v8.4s,v9.4s ++ ror w9,w9,#25 ++ add v12.4s,v12.4s,v13.4s ++ ror w10,w10,#25 ++ add v16.4s,v16.4s,v17.4s ++ ror w11,w11,#25 ++ add v20.4s,v20.4s,v21.4s ++ ror w12,w12,#25 ++ eor v24.16b,v3.16b,v0.16b ++ add w5,w5,w10 ++ eor v25.16b,v7.16b,v4.16b ++ add w6,w6,w11 ++ eor v26.16b,v11.16b,v8.16b ++ add w7,w7,w12 ++ eor v27.16b,v15.16b,v12.16b ++ add w8,w8,w9 ++ eor v28.16b,v19.16b,v16.16b ++ eor w21,w21,w5 ++ eor v29.16b,v23.16b,v20.16b ++ eor w17,w17,w6 ++ ushr v3.4s,v24.4s,#24 ++ eor w19,w19,w7 ++ ushr v7.4s,v25.4s,#24 ++ eor w20,w20,w8 ++ ushr v11.4s,v26.4s,#24 ++ ror w21,w21,#16 ++ ushr v15.4s,v27.4s,#24 ++ ror w17,w17,#16 ++ ushr v19.4s,v28.4s,#24 ++ ror w19,w19,#16 ++ ushr v23.4s,v29.4s,#24 ++ ror w20,w20,#16 ++ sli v3.4s,v24.4s,#8 ++ add w15,w15,w21 ++ sli v7.4s,v25.4s,#8 ++ add w16,w16,w17 ++ sli v11.4s,v26.4s,#8 ++ add w13,w13,w19 ++ sli v15.4s,v27.4s,#8 ++ add w14,w14,w20 ++ sli v19.4s,v28.4s,#8 ++ eor w10,w10,w15 ++ sli v23.4s,v29.4s,#8 ++ eor w11,w11,w16 ++ add v2.4s,v2.4s,v3.4s ++ eor w12,w12,w13 ++ add v6.4s,v6.4s,v7.4s ++ eor w9,w9,w14 ++ add v10.4s,v10.4s,v11.4s ++ ror w10,w10,#20 ++ add v14.4s,v14.4s,v15.4s ++ ror w11,w11,#20 ++ add v18.4s,v18.4s,v19.4s ++ ror w12,w12,#20 ++ add v22.4s,v22.4s,v23.4s ++ ror w9,w9,#20 ++ eor v24.16b,v1.16b,v2.16b ++ add w5,w5,w10 ++ eor v25.16b,v5.16b,v6.16b ++ add w6,w6,w11 ++ eor v26.16b,v9.16b,v10.16b ++ add w7,w7,w12 ++ eor v27.16b,v13.16b,v14.16b ++ add w8,w8,w9 ++ eor v28.16b,v17.16b,v18.16b ++ eor w21,w21,w5 ++ eor v29.16b,v21.16b,v22.16b ++ eor w17,w17,w6 ++ ushr v1.4s,v24.4s,#25 ++ eor w19,w19,w7 ++ ushr v5.4s,v25.4s,#25 ++ eor w20,w20,w8 ++ ushr v9.4s,v26.4s,#25 ++ ror w21,w21,#24 ++ ushr v13.4s,v27.4s,#25 ++ ror w17,w17,#24 ++ ushr v17.4s,v28.4s,#25 ++ ror w19,w19,#24 ++ ushr v21.4s,v29.4s,#25 ++ ror w20,w20,#24 ++ sli v1.4s,v24.4s,#7 ++ add w15,w15,w21 ++ sli v5.4s,v25.4s,#7 ++ add w16,w16,w17 ++ sli v9.4s,v26.4s,#7 ++ add w13,w13,w19 ++ sli v13.4s,v27.4s,#7 ++ add w14,w14,w20 ++ sli v17.4s,v28.4s,#7 ++ eor w10,w10,w15 ++ sli v21.4s,v29.4s,#7 ++ eor w11,w11,w16 ++ ext v2.16b,v2.16b,v2.16b,#8 ++ eor w12,w12,w13 ++ ext v6.16b,v6.16b,v6.16b,#8 ++ eor w9,w9,w14 ++ ext v10.16b,v10.16b,v10.16b,#8 ++ ror w10,w10,#25 ++ ext v14.16b,v14.16b,v14.16b,#8 ++ ror w11,w11,#25 ++ ext v18.16b,v18.16b,v18.16b,#8 ++ ror w12,w12,#25 ++ ext v22.16b,v22.16b,v22.16b,#8 ++ ror w9,w9,#25 ++ ext v3.16b,v3.16b,v3.16b,#4 ++ ext v7.16b,v7.16b,v7.16b,#4 ++ ext v11.16b,v11.16b,v11.16b,#4 ++ ext v15.16b,v15.16b,v15.16b,#4 ++ ext v19.16b,v19.16b,v19.16b,#4 ++ ext v23.16b,v23.16b,v23.16b,#4 ++ ext v1.16b,v1.16b,v1.16b,#12 ++ ext v5.16b,v5.16b,v5.16b,#12 ++ ext v9.16b,v9.16b,v9.16b,#12 ++ ext v13.16b,v13.16b,v13.16b,#12 ++ ext v17.16b,v17.16b,v17.16b,#12 ++ ext v21.16b,v21.16b,v21.16b,#12 ++ cbnz x4,.Loop_upper_neon ++ ++ add w5,w5,w22 // accumulate key block ++ add x6,x6,x22,lsr#32 ++ add w7,w7,w23 ++ add x8,x8,x23,lsr#32 ++ add w9,w9,w24 ++ add x10,x10,x24,lsr#32 ++ add w11,w11,w25 ++ add x12,x12,x25,lsr#32 ++ add w13,w13,w26 ++ add x14,x14,x26,lsr#32 ++ add w15,w15,w27 ++ add x16,x16,x27,lsr#32 ++ add w17,w17,w28 ++ add x19,x19,x28,lsr#32 ++ add w20,w20,w30 ++ add x21,x21,x30,lsr#32 ++ ++ add x5,x5,x6,lsl#32 // pack ++ add x7,x7,x8,lsl#32 ++ ldp x6,x8,[x1,#0] // load input ++ add x9,x9,x10,lsl#32 ++ add x11,x11,x12,lsl#32 ++ ldp x10,x12,[x1,#16] ++ add x13,x13,x14,lsl#32 ++ add x15,x15,x16,lsl#32 ++ ldp x14,x16,[x1,#32] ++ add x17,x17,x19,lsl#32 ++ add x20,x20,x21,lsl#32 ++ ldp x19,x21,[x1,#48] ++ add x1,x1,#64 ++#ifdef __ARMEB__ ++ rev x5,x5 ++ rev x7,x7 ++ rev x9,x9 ++ rev x11,x11 ++ rev x13,x13 ++ rev x15,x15 ++ rev x17,x17 ++ rev x20,x20 ++#endif ++ eor x5,x5,x6 ++ eor x7,x7,x8 ++ eor x9,x9,x10 ++ eor x11,x11,x12 ++ eor x13,x13,x14 ++ eor x15,x15,x16 ++ eor x17,x17,x19 ++ eor x20,x20,x21 ++ ++ stp x5,x7,[x0,#0] // store output ++ add x28,x28,#1 // increment counter ++ mov w5,w22 // unpack key block ++ lsr x6,x22,#32 ++ stp x9,x11,[x0,#16] ++ mov w7,w23 ++ lsr x8,x23,#32 ++ stp x13,x15,[x0,#32] ++ mov w9,w24 ++ lsr x10,x24,#32 ++ stp x17,x20,[x0,#48] ++ add x0,x0,#64 ++ mov w11,w25 ++ lsr x12,x25,#32 ++ mov w13,w26 ++ lsr x14,x26,#32 ++ mov w15,w27 ++ lsr x16,x27,#32 ++ mov w17,w28 ++ lsr x19,x28,#32 ++ mov w20,w30 ++ lsr x21,x30,#32 ++ ++ mov x4,#5 ++.Loop_lower_neon: ++ sub x4,x4,#1 ++ add v0.4s,v0.4s,v1.4s ++ add w5,w5,w9 ++ add v4.4s,v4.4s,v5.4s ++ add w6,w6,w10 ++ add v8.4s,v8.4s,v9.4s ++ add w7,w7,w11 ++ add v12.4s,v12.4s,v13.4s ++ add w8,w8,w12 ++ add v16.4s,v16.4s,v17.4s ++ eor w17,w17,w5 ++ add v20.4s,v20.4s,v21.4s ++ eor w19,w19,w6 ++ eor v3.16b,v3.16b,v0.16b ++ eor w20,w20,w7 ++ eor v7.16b,v7.16b,v4.16b ++ eor w21,w21,w8 ++ eor v11.16b,v11.16b,v8.16b ++ ror w17,w17,#16 ++ eor v15.16b,v15.16b,v12.16b ++ ror w19,w19,#16 ++ eor v19.16b,v19.16b,v16.16b ++ ror w20,w20,#16 ++ eor v23.16b,v23.16b,v20.16b ++ ror w21,w21,#16 ++ rev32 v3.8h,v3.8h ++ add w13,w13,w17 ++ rev32 v7.8h,v7.8h ++ add w14,w14,w19 ++ rev32 v11.8h,v11.8h ++ add w15,w15,w20 ++ rev32 v15.8h,v15.8h ++ add w16,w16,w21 ++ rev32 v19.8h,v19.8h ++ eor w9,w9,w13 ++ rev32 v23.8h,v23.8h ++ eor w10,w10,w14 ++ add v2.4s,v2.4s,v3.4s ++ eor w11,w11,w15 ++ add v6.4s,v6.4s,v7.4s ++ eor w12,w12,w16 ++ add v10.4s,v10.4s,v11.4s ++ ror w9,w9,#20 ++ add v14.4s,v14.4s,v15.4s ++ ror w10,w10,#20 ++ add v18.4s,v18.4s,v19.4s ++ ror w11,w11,#20 ++ add v22.4s,v22.4s,v23.4s ++ ror w12,w12,#20 ++ eor v24.16b,v1.16b,v2.16b ++ add w5,w5,w9 ++ eor v25.16b,v5.16b,v6.16b ++ add w6,w6,w10 ++ eor v26.16b,v9.16b,v10.16b ++ add w7,w7,w11 ++ eor v27.16b,v13.16b,v14.16b ++ add w8,w8,w12 ++ eor v28.16b,v17.16b,v18.16b ++ eor w17,w17,w5 ++ eor v29.16b,v21.16b,v22.16b ++ eor w19,w19,w6 ++ ushr v1.4s,v24.4s,#20 ++ eor w20,w20,w7 ++ ushr v5.4s,v25.4s,#20 ++ eor w21,w21,w8 ++ ushr v9.4s,v26.4s,#20 ++ ror w17,w17,#24 ++ ushr v13.4s,v27.4s,#20 ++ ror w19,w19,#24 ++ ushr v17.4s,v28.4s,#20 ++ ror w20,w20,#24 ++ ushr v21.4s,v29.4s,#20 ++ ror w21,w21,#24 ++ sli v1.4s,v24.4s,#12 ++ add w13,w13,w17 ++ sli v5.4s,v25.4s,#12 ++ add w14,w14,w19 ++ sli v9.4s,v26.4s,#12 ++ add w15,w15,w20 ++ sli v13.4s,v27.4s,#12 ++ add w16,w16,w21 ++ sli v17.4s,v28.4s,#12 ++ eor w9,w9,w13 ++ sli v21.4s,v29.4s,#12 ++ eor w10,w10,w14 ++ add v0.4s,v0.4s,v1.4s ++ eor w11,w11,w15 ++ add v4.4s,v4.4s,v5.4s ++ eor w12,w12,w16 ++ add v8.4s,v8.4s,v9.4s ++ ror w9,w9,#25 ++ add v12.4s,v12.4s,v13.4s ++ ror w10,w10,#25 ++ add v16.4s,v16.4s,v17.4s ++ ror w11,w11,#25 ++ add v20.4s,v20.4s,v21.4s ++ ror w12,w12,#25 ++ eor v24.16b,v3.16b,v0.16b ++ add w5,w5,w10 ++ eor v25.16b,v7.16b,v4.16b ++ add w6,w6,w11 ++ eor v26.16b,v11.16b,v8.16b ++ add w7,w7,w12 ++ eor v27.16b,v15.16b,v12.16b ++ add w8,w8,w9 ++ eor v28.16b,v19.16b,v16.16b ++ eor w21,w21,w5 ++ eor v29.16b,v23.16b,v20.16b ++ eor w17,w17,w6 ++ ushr v3.4s,v24.4s,#24 ++ eor w19,w19,w7 ++ ushr v7.4s,v25.4s,#24 ++ eor w20,w20,w8 ++ ushr v11.4s,v26.4s,#24 ++ ror w21,w21,#16 ++ ushr v15.4s,v27.4s,#24 ++ ror w17,w17,#16 ++ ushr v19.4s,v28.4s,#24 ++ ror w19,w19,#16 ++ ushr v23.4s,v29.4s,#24 ++ ror w20,w20,#16 ++ sli v3.4s,v24.4s,#8 ++ add w15,w15,w21 ++ sli v7.4s,v25.4s,#8 ++ add w16,w16,w17 ++ sli v11.4s,v26.4s,#8 ++ add w13,w13,w19 ++ sli v15.4s,v27.4s,#8 ++ add w14,w14,w20 ++ sli v19.4s,v28.4s,#8 ++ eor w10,w10,w15 ++ sli v23.4s,v29.4s,#8 ++ eor w11,w11,w16 ++ add v2.4s,v2.4s,v3.4s ++ eor w12,w12,w13 ++ add v6.4s,v6.4s,v7.4s ++ eor w9,w9,w14 ++ add v10.4s,v10.4s,v11.4s ++ ror w10,w10,#20 ++ add v14.4s,v14.4s,v15.4s ++ ror w11,w11,#20 ++ add v18.4s,v18.4s,v19.4s ++ ror w12,w12,#20 ++ add v22.4s,v22.4s,v23.4s ++ ror w9,w9,#20 ++ eor v24.16b,v1.16b,v2.16b ++ add w5,w5,w10 ++ eor v25.16b,v5.16b,v6.16b ++ add w6,w6,w11 ++ eor v26.16b,v9.16b,v10.16b ++ add w7,w7,w12 ++ eor v27.16b,v13.16b,v14.16b ++ add w8,w8,w9 ++ eor v28.16b,v17.16b,v18.16b ++ eor w21,w21,w5 ++ eor v29.16b,v21.16b,v22.16b ++ eor w17,w17,w6 ++ ushr v1.4s,v24.4s,#25 ++ eor w19,w19,w7 ++ ushr v5.4s,v25.4s,#25 ++ eor w20,w20,w8 ++ ushr v9.4s,v26.4s,#25 ++ ror w21,w21,#24 ++ ushr v13.4s,v27.4s,#25 ++ ror w17,w17,#24 ++ ushr v17.4s,v28.4s,#25 ++ ror w19,w19,#24 ++ ushr v21.4s,v29.4s,#25 ++ ror w20,w20,#24 ++ sli v1.4s,v24.4s,#7 ++ add w15,w15,w21 ++ sli v5.4s,v25.4s,#7 ++ add w16,w16,w17 ++ sli v9.4s,v26.4s,#7 ++ add w13,w13,w19 ++ sli v13.4s,v27.4s,#7 ++ add w14,w14,w20 ++ sli v17.4s,v28.4s,#7 ++ eor w10,w10,w15 ++ sli v21.4s,v29.4s,#7 ++ eor w11,w11,w16 ++ ext v2.16b,v2.16b,v2.16b,#8 ++ eor w12,w12,w13 ++ ext v6.16b,v6.16b,v6.16b,#8 ++ eor w9,w9,w14 ++ ext v10.16b,v10.16b,v10.16b,#8 ++ ror w10,w10,#25 ++ ext v14.16b,v14.16b,v14.16b,#8 ++ ror w11,w11,#25 ++ ext v18.16b,v18.16b,v18.16b,#8 ++ ror w12,w12,#25 ++ ext v22.16b,v22.16b,v22.16b,#8 ++ ror w9,w9,#25 ++ ext v3.16b,v3.16b,v3.16b,#12 ++ ext v7.16b,v7.16b,v7.16b,#12 ++ ext v11.16b,v11.16b,v11.16b,#12 ++ ext v15.16b,v15.16b,v15.16b,#12 ++ ext v19.16b,v19.16b,v19.16b,#12 ++ ext v23.16b,v23.16b,v23.16b,#12 ++ ext v1.16b,v1.16b,v1.16b,#4 ++ ext v5.16b,v5.16b,v5.16b,#4 ++ ext v9.16b,v9.16b,v9.16b,#4 ++ ext v13.16b,v13.16b,v13.16b,#4 ++ ext v17.16b,v17.16b,v17.16b,#4 ++ ext v21.16b,v21.16b,v21.16b,#4 ++ add v0.4s,v0.4s,v1.4s ++ add w5,w5,w9 ++ add v4.4s,v4.4s,v5.4s ++ add w6,w6,w10 ++ add v8.4s,v8.4s,v9.4s ++ add w7,w7,w11 ++ add v12.4s,v12.4s,v13.4s ++ add w8,w8,w12 ++ add v16.4s,v16.4s,v17.4s ++ eor w17,w17,w5 ++ add v20.4s,v20.4s,v21.4s ++ eor w19,w19,w6 ++ eor v3.16b,v3.16b,v0.16b ++ eor w20,w20,w7 ++ eor v7.16b,v7.16b,v4.16b ++ eor w21,w21,w8 ++ eor v11.16b,v11.16b,v8.16b ++ ror w17,w17,#16 ++ eor v15.16b,v15.16b,v12.16b ++ ror w19,w19,#16 ++ eor v19.16b,v19.16b,v16.16b ++ ror w20,w20,#16 ++ eor v23.16b,v23.16b,v20.16b ++ ror w21,w21,#16 ++ rev32 v3.8h,v3.8h ++ add w13,w13,w17 ++ rev32 v7.8h,v7.8h ++ add w14,w14,w19 ++ rev32 v11.8h,v11.8h ++ add w15,w15,w20 ++ rev32 v15.8h,v15.8h ++ add w16,w16,w21 ++ rev32 v19.8h,v19.8h ++ eor w9,w9,w13 ++ rev32 v23.8h,v23.8h ++ eor w10,w10,w14 ++ add v2.4s,v2.4s,v3.4s ++ eor w11,w11,w15 ++ add v6.4s,v6.4s,v7.4s ++ eor w12,w12,w16 ++ add v10.4s,v10.4s,v11.4s ++ ror w9,w9,#20 ++ add v14.4s,v14.4s,v15.4s ++ ror w10,w10,#20 ++ add v18.4s,v18.4s,v19.4s ++ ror w11,w11,#20 ++ add v22.4s,v22.4s,v23.4s ++ ror w12,w12,#20 ++ eor v24.16b,v1.16b,v2.16b ++ add w5,w5,w9 ++ eor v25.16b,v5.16b,v6.16b ++ add w6,w6,w10 ++ eor v26.16b,v9.16b,v10.16b ++ add w7,w7,w11 ++ eor v27.16b,v13.16b,v14.16b ++ add w8,w8,w12 ++ eor v28.16b,v17.16b,v18.16b ++ eor w17,w17,w5 ++ eor v29.16b,v21.16b,v22.16b ++ eor w19,w19,w6 ++ ushr v1.4s,v24.4s,#20 ++ eor w20,w20,w7 ++ ushr v5.4s,v25.4s,#20 ++ eor w21,w21,w8 ++ ushr v9.4s,v26.4s,#20 ++ ror w17,w17,#24 ++ ushr v13.4s,v27.4s,#20 ++ ror w19,w19,#24 ++ ushr v17.4s,v28.4s,#20 ++ ror w20,w20,#24 ++ ushr v21.4s,v29.4s,#20 ++ ror w21,w21,#24 ++ sli v1.4s,v24.4s,#12 ++ add w13,w13,w17 ++ sli v5.4s,v25.4s,#12 ++ add w14,w14,w19 ++ sli v9.4s,v26.4s,#12 ++ add w15,w15,w20 ++ sli v13.4s,v27.4s,#12 ++ add w16,w16,w21 ++ sli v17.4s,v28.4s,#12 ++ eor w9,w9,w13 ++ sli v21.4s,v29.4s,#12 ++ eor w10,w10,w14 ++ add v0.4s,v0.4s,v1.4s ++ eor w11,w11,w15 ++ add v4.4s,v4.4s,v5.4s ++ eor w12,w12,w16 ++ add v8.4s,v8.4s,v9.4s ++ ror w9,w9,#25 ++ add v12.4s,v12.4s,v13.4s ++ ror w10,w10,#25 ++ add v16.4s,v16.4s,v17.4s ++ ror w11,w11,#25 ++ add v20.4s,v20.4s,v21.4s ++ ror w12,w12,#25 ++ eor v24.16b,v3.16b,v0.16b ++ add w5,w5,w10 ++ eor v25.16b,v7.16b,v4.16b ++ add w6,w6,w11 ++ eor v26.16b,v11.16b,v8.16b ++ add w7,w7,w12 ++ eor v27.16b,v15.16b,v12.16b ++ add w8,w8,w9 ++ eor v28.16b,v19.16b,v16.16b ++ eor w21,w21,w5 ++ eor v29.16b,v23.16b,v20.16b ++ eor w17,w17,w6 ++ ushr v3.4s,v24.4s,#24 ++ eor w19,w19,w7 ++ ushr v7.4s,v25.4s,#24 ++ eor w20,w20,w8 ++ ushr v11.4s,v26.4s,#24 ++ ror w21,w21,#16 ++ ushr v15.4s,v27.4s,#24 ++ ror w17,w17,#16 ++ ushr v19.4s,v28.4s,#24 ++ ror w19,w19,#16 ++ ushr v23.4s,v29.4s,#24 ++ ror w20,w20,#16 ++ sli v3.4s,v24.4s,#8 ++ add w15,w15,w21 ++ sli v7.4s,v25.4s,#8 ++ add w16,w16,w17 ++ sli v11.4s,v26.4s,#8 ++ add w13,w13,w19 ++ sli v15.4s,v27.4s,#8 ++ add w14,w14,w20 ++ sli v19.4s,v28.4s,#8 ++ eor w10,w10,w15 ++ sli v23.4s,v29.4s,#8 ++ eor w11,w11,w16 ++ add v2.4s,v2.4s,v3.4s ++ eor w12,w12,w13 ++ add v6.4s,v6.4s,v7.4s ++ eor w9,w9,w14 ++ add v10.4s,v10.4s,v11.4s ++ ror w10,w10,#20 ++ add v14.4s,v14.4s,v15.4s ++ ror w11,w11,#20 ++ add v18.4s,v18.4s,v19.4s ++ ror w12,w12,#20 ++ add v22.4s,v22.4s,v23.4s ++ ror w9,w9,#20 ++ eor v24.16b,v1.16b,v2.16b ++ add w5,w5,w10 ++ eor v25.16b,v5.16b,v6.16b ++ add w6,w6,w11 ++ eor v26.16b,v9.16b,v10.16b ++ add w7,w7,w12 ++ eor v27.16b,v13.16b,v14.16b ++ add w8,w8,w9 ++ eor v28.16b,v17.16b,v18.16b ++ eor w21,w21,w5 ++ eor v29.16b,v21.16b,v22.16b ++ eor w17,w17,w6 ++ ushr v1.4s,v24.4s,#25 ++ eor w19,w19,w7 ++ ushr v5.4s,v25.4s,#25 ++ eor w20,w20,w8 ++ ushr v9.4s,v26.4s,#25 ++ ror w21,w21,#24 ++ ushr v13.4s,v27.4s,#25 ++ ror w17,w17,#24 ++ ushr v17.4s,v28.4s,#25 ++ ror w19,w19,#24 ++ ushr v21.4s,v29.4s,#25 ++ ror w20,w20,#24 ++ sli v1.4s,v24.4s,#7 ++ add w15,w15,w21 ++ sli v5.4s,v25.4s,#7 ++ add w16,w16,w17 ++ sli v9.4s,v26.4s,#7 ++ add w13,w13,w19 ++ sli v13.4s,v27.4s,#7 ++ add w14,w14,w20 ++ sli v17.4s,v28.4s,#7 ++ eor w10,w10,w15 ++ sli v21.4s,v29.4s,#7 ++ eor w11,w11,w16 ++ ext v2.16b,v2.16b,v2.16b,#8 ++ eor w12,w12,w13 ++ ext v6.16b,v6.16b,v6.16b,#8 ++ eor w9,w9,w14 ++ ext v10.16b,v10.16b,v10.16b,#8 ++ ror w10,w10,#25 ++ ext v14.16b,v14.16b,v14.16b,#8 ++ ror w11,w11,#25 ++ ext v18.16b,v18.16b,v18.16b,#8 ++ ror w12,w12,#25 ++ ext v22.16b,v22.16b,v22.16b,#8 ++ ror w9,w9,#25 ++ ext v3.16b,v3.16b,v3.16b,#4 ++ ext v7.16b,v7.16b,v7.16b,#4 ++ ext v11.16b,v11.16b,v11.16b,#4 ++ ext v15.16b,v15.16b,v15.16b,#4 ++ ext v19.16b,v19.16b,v19.16b,#4 ++ ext v23.16b,v23.16b,v23.16b,#4 ++ ext v1.16b,v1.16b,v1.16b,#12 ++ ext v5.16b,v5.16b,v5.16b,#12 ++ ext v9.16b,v9.16b,v9.16b,#12 ++ ext v13.16b,v13.16b,v13.16b,#12 ++ ext v17.16b,v17.16b,v17.16b,#12 ++ ext v21.16b,v21.16b,v21.16b,#12 ++ cbnz x4,.Loop_lower_neon ++ ++ add w5,w5,w22 // accumulate key block ++ ldp q24,q25,[sp,#0] ++ add x6,x6,x22,lsr#32 ++ ldp q26,q27,[sp,#32] ++ add w7,w7,w23 ++ ldp q28,q29,[sp,#64] ++ add x8,x8,x23,lsr#32 ++ add v0.4s,v0.4s,v24.4s ++ add w9,w9,w24 ++ add v4.4s,v4.4s,v24.4s ++ add x10,x10,x24,lsr#32 ++ add v8.4s,v8.4s,v24.4s ++ add w11,w11,w25 ++ add v12.4s,v12.4s,v24.4s ++ add x12,x12,x25,lsr#32 ++ add v16.4s,v16.4s,v24.4s ++ add w13,w13,w26 ++ add v20.4s,v20.4s,v24.4s ++ add x14,x14,x26,lsr#32 ++ add v2.4s,v2.4s,v26.4s ++ add w15,w15,w27 ++ add v6.4s,v6.4s,v26.4s ++ add x16,x16,x27,lsr#32 ++ add v10.4s,v10.4s,v26.4s ++ add w17,w17,w28 ++ add v14.4s,v14.4s,v26.4s ++ add x19,x19,x28,lsr#32 ++ add v18.4s,v18.4s,v26.4s ++ add w20,w20,w30 ++ add v22.4s,v22.4s,v26.4s ++ add x21,x21,x30,lsr#32 ++ add v19.4s,v19.4s,v31.4s // +4 ++ add x5,x5,x6,lsl#32 // pack ++ add v23.4s,v23.4s,v31.4s // +4 ++ add x7,x7,x8,lsl#32 ++ add v3.4s,v3.4s,v27.4s ++ ldp x6,x8,[x1,#0] // load input ++ add v7.4s,v7.4s,v28.4s ++ add x9,x9,x10,lsl#32 ++ add v11.4s,v11.4s,v29.4s ++ add x11,x11,x12,lsl#32 ++ add v15.4s,v15.4s,v30.4s ++ ldp x10,x12,[x1,#16] ++ add v19.4s,v19.4s,v27.4s ++ add x13,x13,x14,lsl#32 ++ add v23.4s,v23.4s,v28.4s ++ add x15,x15,x16,lsl#32 ++ add v1.4s,v1.4s,v25.4s ++ ldp x14,x16,[x1,#32] ++ add v5.4s,v5.4s,v25.4s ++ add x17,x17,x19,lsl#32 ++ add v9.4s,v9.4s,v25.4s ++ add x20,x20,x21,lsl#32 ++ add v13.4s,v13.4s,v25.4s ++ ldp x19,x21,[x1,#48] ++ add v17.4s,v17.4s,v25.4s ++ add x1,x1,#64 ++ add v21.4s,v21.4s,v25.4s ++ ++#ifdef __ARMEB__ ++ rev x5,x5 ++ rev x7,x7 ++ rev x9,x9 ++ rev x11,x11 ++ rev x13,x13 ++ rev x15,x15 ++ rev x17,x17 ++ rev x20,x20 ++#endif ++ ld1 {v24.16b,v25.16b,v26.16b,v27.16b},[x1],#64 ++ eor x5,x5,x6 ++ eor x7,x7,x8 ++ eor x9,x9,x10 ++ eor x11,x11,x12 ++ eor x13,x13,x14 ++ eor v0.16b,v0.16b,v24.16b ++ eor x15,x15,x16 ++ eor v1.16b,v1.16b,v25.16b ++ eor x17,x17,x19 ++ eor v2.16b,v2.16b,v26.16b ++ eor x20,x20,x21 ++ eor v3.16b,v3.16b,v27.16b ++ ld1 {v24.16b,v25.16b,v26.16b,v27.16b},[x1],#64 ++ ++ stp x5,x7,[x0,#0] // store output ++ add x28,x28,#7 // increment counter ++ stp x9,x11,[x0,#16] ++ stp x13,x15,[x0,#32] ++ stp x17,x20,[x0,#48] ++ add x0,x0,#64 ++ st1 {v0.16b,v1.16b,v2.16b,v3.16b},[x0],#64 ++ ++ ld1 {v0.16b,v1.16b,v2.16b,v3.16b},[x1],#64 ++ eor v4.16b,v4.16b,v24.16b ++ eor v5.16b,v5.16b,v25.16b ++ eor v6.16b,v6.16b,v26.16b ++ eor v7.16b,v7.16b,v27.16b ++ st1 {v4.16b,v5.16b,v6.16b,v7.16b},[x0],#64 ++ ++ ld1 {v4.16b,v5.16b,v6.16b,v7.16b},[x1],#64 ++ eor v8.16b,v8.16b,v0.16b ++ ldp q24,q25,[sp,#0] ++ eor v9.16b,v9.16b,v1.16b ++ ldp q26,q27,[sp,#32] ++ eor v10.16b,v10.16b,v2.16b ++ eor v11.16b,v11.16b,v3.16b ++ st1 {v8.16b,v9.16b,v10.16b,v11.16b},[x0],#64 ++ ++ ld1 {v8.16b,v9.16b,v10.16b,v11.16b},[x1],#64 ++ eor v12.16b,v12.16b,v4.16b ++ eor v13.16b,v13.16b,v5.16b ++ eor v14.16b,v14.16b,v6.16b ++ eor v15.16b,v15.16b,v7.16b ++ st1 {v12.16b,v13.16b,v14.16b,v15.16b},[x0],#64 ++ ++ ld1 {v12.16b,v13.16b,v14.16b,v15.16b},[x1],#64 ++ eor v16.16b,v16.16b,v8.16b ++ eor v17.16b,v17.16b,v9.16b ++ eor v18.16b,v18.16b,v10.16b ++ eor v19.16b,v19.16b,v11.16b ++ st1 {v16.16b,v17.16b,v18.16b,v19.16b},[x0],#64 ++ ++ shl v0.4s,v31.4s,#1 // 4 -> 8 ++ eor v20.16b,v20.16b,v12.16b ++ eor v21.16b,v21.16b,v13.16b ++ eor v22.16b,v22.16b,v14.16b ++ eor v23.16b,v23.16b,v15.16b ++ st1 {v20.16b,v21.16b,v22.16b,v23.16b},[x0],#64 ++ ++ add v27.4s,v27.4s,v0.4s // += 8 ++ add v28.4s,v28.4s,v0.4s ++ add v29.4s,v29.4s,v0.4s ++ add v30.4s,v30.4s,v0.4s ++ ++ b.hs .Loop_outer_512_neon ++ ++ adds x2,x2,#512 ++ ushr v0.4s,v31.4s,#2 // 4 -> 1 ++ ++ ldp d8,d9,[sp,#128+0] // meet ABI requirements ++ ldp d10,d11,[sp,#128+16] ++ ldp d12,d13,[sp,#128+32] ++ ldp d14,d15,[sp,#128+48] ++ ++ stp q24,q31,[sp,#0] // wipe off-load area ++ stp q24,q31,[sp,#32] ++ stp q24,q31,[sp,#64] ++ ++ b.eq .Ldone_512_neon ++ ++ cmp x2,#192 ++ sub v27.4s,v27.4s,v0.4s // -= 1 ++ sub v28.4s,v28.4s,v0.4s ++ sub v29.4s,v29.4s,v0.4s ++ add sp,sp,#128 ++ b.hs .Loop_outer_neon ++ ++ eor v25.16b,v25.16b,v25.16b ++ eor v26.16b,v26.16b,v26.16b ++ eor v27.16b,v27.16b,v27.16b ++ eor v28.16b,v28.16b,v28.16b ++ eor v29.16b,v29.16b,v29.16b ++ eor v30.16b,v30.16b,v30.16b ++ b .Loop_outer ++ ++.Ldone_512_neon: ++ ldp x19,x20,[x29,#16] ++ add sp,sp,#128+64 ++ ldp x21,x22,[x29,#32] ++ ldp x23,x24,[x29,#48] ++ ldp x25,x26,[x29,#64] ++ ldp x27,x28,[x29,#80] ++ ldp x29,x30,[sp],#96 ++.Labort_neon: ++ ret ++ENDPROC(chacha20_neon) +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/chacha20-arm.S 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,1471 @@ ++/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. ++ */ ++ ++#include ++ ++.text ++#if defined(__thumb2__) || defined(__clang__) ++.syntax unified ++#endif ++#if defined(__thumb2__) ++.thumb ++#else ++.code 32 ++#endif ++ ++#if defined(__thumb2__) || defined(__clang__) ++#define ldrhsb ldrbhs ++#endif ++ ++.align 5 ++.Lsigma: ++.long 0x61707865,0x3320646e,0x79622d32,0x6b206574 @ endian-neutral ++.Lone: ++.long 1,0,0,0 ++.word -1 ++ ++#if __LINUX_ARM_ARCH__ >= 7 && IS_ENABLED(CONFIG_KERNEL_MODE_NEON) ++.arch armv7-a ++.fpu neon ++ ++.align 5 ++ENTRY(chacha20_neon) ++ ldr r12,[sp,#0] @ pull pointer to counter and nonce ++ stmdb sp!,{r0-r2,r4-r11,lr} ++ cmp r2,#0 @ len==0? ++#ifdef __thumb2__ ++ itt eq ++#endif ++ addeq sp,sp,#4*3 ++ beq .Lno_data_neon ++ cmp r2,#192 @ test len ++ bls .Lshort ++.Lchacha20_neon_begin: ++ adr r14,.Lsigma ++ vstmdb sp!,{d8-d15} @ ABI spec says so ++ stmdb sp!,{r0-r3} ++ ++ vld1.32 {q1-q2},[r3] @ load key ++ ldmia r3,{r4-r11} @ load key ++ ++ sub sp,sp,#4*(16+16) ++ vld1.32 {q3},[r12] @ load counter and nonce ++ add r12,sp,#4*8 ++ ldmia r14,{r0-r3} @ load sigma ++ vld1.32 {q0},[r14]! @ load sigma ++ vld1.32 {q12},[r14] @ one ++ vst1.32 {q2-q3},[r12] @ copy 1/2key|counter|nonce ++ vst1.32 {q0-q1},[sp] @ copy sigma|1/2key ++ ++ str r10,[sp,#4*(16+10)] @ off-load "rx" ++ str r11,[sp,#4*(16+11)] @ off-load "rx" ++ vshl.i32 d26,d24,#1 @ two ++ vstr d24,[sp,#4*(16+0)] ++ vshl.i32 d28,d24,#2 @ four ++ vstr d26,[sp,#4*(16+2)] ++ vmov q4,q0 ++ vstr d28,[sp,#4*(16+4)] ++ vmov q8,q0 ++ vmov q5,q1 ++ vmov q9,q1 ++ b .Loop_neon_enter ++ ++.align 4 ++.Loop_neon_outer: ++ ldmia sp,{r0-r9} @ load key material ++ cmp r11,#64*2 @ if len<=64*2 ++ bls .Lbreak_neon @ switch to integer-only ++ vmov q4,q0 ++ str r11,[sp,#4*(32+2)] @ save len ++ vmov q8,q0 ++ str r12, [sp,#4*(32+1)] @ save inp ++ vmov q5,q1 ++ str r14, [sp,#4*(32+0)] @ save out ++ vmov q9,q1 ++.Loop_neon_enter: ++ ldr r11, [sp,#4*(15)] ++ vadd.i32 q7,q3,q12 @ counter+1 ++ ldr r12,[sp,#4*(12)] @ modulo-scheduled load ++ vmov q6,q2 ++ ldr r10, [sp,#4*(13)] ++ vmov q10,q2 ++ ldr r14,[sp,#4*(14)] ++ vadd.i32 q11,q7,q12 @ counter+2 ++ str r11, [sp,#4*(16+15)] ++ mov r11,#10 ++ add r12,r12,#3 @ counter+3 ++ b .Loop_neon ++ ++.align 4 ++.Loop_neon: ++ subs r11,r11,#1 ++ vadd.i32 q0,q0,q1 ++ add r0,r0,r4 ++ vadd.i32 q4,q4,q5 ++ mov r12,r12,ror#16 ++ vadd.i32 q8,q8,q9 ++ add r1,r1,r5 ++ veor q3,q3,q0 ++ mov r10,r10,ror#16 ++ veor q7,q7,q4 ++ eor r12,r12,r0,ror#16 ++ veor q11,q11,q8 ++ eor r10,r10,r1,ror#16 ++ vrev32.16 q3,q3 ++ add r8,r8,r12 ++ vrev32.16 q7,q7 ++ mov r4,r4,ror#20 ++ vrev32.16 q11,q11 ++ add r9,r9,r10 ++ vadd.i32 q2,q2,q3 ++ mov r5,r5,ror#20 ++ vadd.i32 q6,q6,q7 ++ eor r4,r4,r8,ror#20 ++ vadd.i32 q10,q10,q11 ++ eor r5,r5,r9,ror#20 ++ veor q12,q1,q2 ++ add r0,r0,r4 ++ veor q13,q5,q6 ++ mov r12,r12,ror#24 ++ veor q14,q9,q10 ++ add r1,r1,r5 ++ vshr.u32 q1,q12,#20 ++ mov r10,r10,ror#24 ++ vshr.u32 q5,q13,#20 ++ eor r12,r12,r0,ror#24 ++ vshr.u32 q9,q14,#20 ++ eor r10,r10,r1,ror#24 ++ vsli.32 q1,q12,#12 ++ add r8,r8,r12 ++ vsli.32 q5,q13,#12 ++ mov r4,r4,ror#25 ++ vsli.32 q9,q14,#12 ++ add r9,r9,r10 ++ vadd.i32 q0,q0,q1 ++ mov r5,r5,ror#25 ++ vadd.i32 q4,q4,q5 ++ str r10,[sp,#4*(16+13)] ++ vadd.i32 q8,q8,q9 ++ ldr r10,[sp,#4*(16+15)] ++ veor q12,q3,q0 ++ eor r4,r4,r8,ror#25 ++ veor q13,q7,q4 ++ eor r5,r5,r9,ror#25 ++ veor q14,q11,q8 ++ str r8,[sp,#4*(16+8)] ++ vshr.u32 q3,q12,#24 ++ ldr r8,[sp,#4*(16+10)] ++ vshr.u32 q7,q13,#24 ++ add r2,r2,r6 ++ vshr.u32 q11,q14,#24 ++ mov r14,r14,ror#16 ++ vsli.32 q3,q12,#8 ++ str r9,[sp,#4*(16+9)] ++ vsli.32 q7,q13,#8 ++ ldr r9,[sp,#4*(16+11)] ++ vsli.32 q11,q14,#8 ++ add r3,r3,r7 ++ vadd.i32 q2,q2,q3 ++ mov r10,r10,ror#16 ++ vadd.i32 q6,q6,q7 ++ eor r14,r14,r2,ror#16 ++ vadd.i32 q10,q10,q11 ++ eor r10,r10,r3,ror#16 ++ veor q12,q1,q2 ++ add r8,r8,r14 ++ veor q13,q5,q6 ++ mov r6,r6,ror#20 ++ veor q14,q9,q10 ++ add r9,r9,r10 ++ vshr.u32 q1,q12,#25 ++ mov r7,r7,ror#20 ++ vshr.u32 q5,q13,#25 ++ eor r6,r6,r8,ror#20 ++ vshr.u32 q9,q14,#25 ++ eor r7,r7,r9,ror#20 ++ vsli.32 q1,q12,#7 ++ add r2,r2,r6 ++ vsli.32 q5,q13,#7 ++ mov r14,r14,ror#24 ++ vsli.32 q9,q14,#7 ++ add r3,r3,r7 ++ vext.8 q2,q2,q2,#8 ++ mov r10,r10,ror#24 ++ vext.8 q6,q6,q6,#8 ++ eor r14,r14,r2,ror#24 ++ vext.8 q10,q10,q10,#8 ++ eor r10,r10,r3,ror#24 ++ vext.8 q1,q1,q1,#4 ++ add r8,r8,r14 ++ vext.8 q5,q5,q5,#4 ++ mov r6,r6,ror#25 ++ vext.8 q9,q9,q9,#4 ++ add r9,r9,r10 ++ vext.8 q3,q3,q3,#12 ++ mov r7,r7,ror#25 ++ vext.8 q7,q7,q7,#12 ++ eor r6,r6,r8,ror#25 ++ vext.8 q11,q11,q11,#12 ++ eor r7,r7,r9,ror#25 ++ vadd.i32 q0,q0,q1 ++ add r0,r0,r5 ++ vadd.i32 q4,q4,q5 ++ mov r10,r10,ror#16 ++ vadd.i32 q8,q8,q9 ++ add r1,r1,r6 ++ veor q3,q3,q0 ++ mov r12,r12,ror#16 ++ veor q7,q7,q4 ++ eor r10,r10,r0,ror#16 ++ veor q11,q11,q8 ++ eor r12,r12,r1,ror#16 ++ vrev32.16 q3,q3 ++ add r8,r8,r10 ++ vrev32.16 q7,q7 ++ mov r5,r5,ror#20 ++ vrev32.16 q11,q11 ++ add r9,r9,r12 ++ vadd.i32 q2,q2,q3 ++ mov r6,r6,ror#20 ++ vadd.i32 q6,q6,q7 ++ eor r5,r5,r8,ror#20 ++ vadd.i32 q10,q10,q11 ++ eor r6,r6,r9,ror#20 ++ veor q12,q1,q2 ++ add r0,r0,r5 ++ veor q13,q5,q6 ++ mov r10,r10,ror#24 ++ veor q14,q9,q10 ++ add r1,r1,r6 ++ vshr.u32 q1,q12,#20 ++ mov r12,r12,ror#24 ++ vshr.u32 q5,q13,#20 ++ eor r10,r10,r0,ror#24 ++ vshr.u32 q9,q14,#20 ++ eor r12,r12,r1,ror#24 ++ vsli.32 q1,q12,#12 ++ add r8,r8,r10 ++ vsli.32 q5,q13,#12 ++ mov r5,r5,ror#25 ++ vsli.32 q9,q14,#12 ++ str r10,[sp,#4*(16+15)] ++ vadd.i32 q0,q0,q1 ++ ldr r10,[sp,#4*(16+13)] ++ vadd.i32 q4,q4,q5 ++ add r9,r9,r12 ++ vadd.i32 q8,q8,q9 ++ mov r6,r6,ror#25 ++ veor q12,q3,q0 ++ eor r5,r5,r8,ror#25 ++ veor q13,q7,q4 ++ eor r6,r6,r9,ror#25 ++ veor q14,q11,q8 ++ str r8,[sp,#4*(16+10)] ++ vshr.u32 q3,q12,#24 ++ ldr r8,[sp,#4*(16+8)] ++ vshr.u32 q7,q13,#24 ++ add r2,r2,r7 ++ vshr.u32 q11,q14,#24 ++ mov r10,r10,ror#16 ++ vsli.32 q3,q12,#8 ++ str r9,[sp,#4*(16+11)] ++ vsli.32 q7,q13,#8 ++ ldr r9,[sp,#4*(16+9)] ++ vsli.32 q11,q14,#8 ++ add r3,r3,r4 ++ vadd.i32 q2,q2,q3 ++ mov r14,r14,ror#16 ++ vadd.i32 q6,q6,q7 ++ eor r10,r10,r2,ror#16 ++ vadd.i32 q10,q10,q11 ++ eor r14,r14,r3,ror#16 ++ veor q12,q1,q2 ++ add r8,r8,r10 ++ veor q13,q5,q6 ++ mov r7,r7,ror#20 ++ veor q14,q9,q10 ++ add r9,r9,r14 ++ vshr.u32 q1,q12,#25 ++ mov r4,r4,ror#20 ++ vshr.u32 q5,q13,#25 ++ eor r7,r7,r8,ror#20 ++ vshr.u32 q9,q14,#25 ++ eor r4,r4,r9,ror#20 ++ vsli.32 q1,q12,#7 ++ add r2,r2,r7 ++ vsli.32 q5,q13,#7 ++ mov r10,r10,ror#24 ++ vsli.32 q9,q14,#7 ++ add r3,r3,r4 ++ vext.8 q2,q2,q2,#8 ++ mov r14,r14,ror#24 ++ vext.8 q6,q6,q6,#8 ++ eor r10,r10,r2,ror#24 ++ vext.8 q10,q10,q10,#8 ++ eor r14,r14,r3,ror#24 ++ vext.8 q1,q1,q1,#12 ++ add r8,r8,r10 ++ vext.8 q5,q5,q5,#12 ++ mov r7,r7,ror#25 ++ vext.8 q9,q9,q9,#12 ++ add r9,r9,r14 ++ vext.8 q3,q3,q3,#4 ++ mov r4,r4,ror#25 ++ vext.8 q7,q7,q7,#4 ++ eor r7,r7,r8,ror#25 ++ vext.8 q11,q11,q11,#4 ++ eor r4,r4,r9,ror#25 ++ bne .Loop_neon ++ ++ add r11,sp,#32 ++ vld1.32 {q12-q13},[sp] @ load key material ++ vld1.32 {q14-q15},[r11] ++ ++ ldr r11,[sp,#4*(32+2)] @ load len ++ ++ str r8, [sp,#4*(16+8)] @ modulo-scheduled store ++ str r9, [sp,#4*(16+9)] ++ str r12,[sp,#4*(16+12)] ++ str r10, [sp,#4*(16+13)] ++ str r14,[sp,#4*(16+14)] ++ ++ @ at this point we have first half of 512-bit result in ++ @ rx and second half at sp+4*(16+8) ++ ++ ldr r12,[sp,#4*(32+1)] @ load inp ++ ldr r14,[sp,#4*(32+0)] @ load out ++ ++ vadd.i32 q0,q0,q12 @ accumulate key material ++ vadd.i32 q4,q4,q12 ++ vadd.i32 q8,q8,q12 ++ vldr d24,[sp,#4*(16+0)] @ one ++ ++ vadd.i32 q1,q1,q13 ++ vadd.i32 q5,q5,q13 ++ vadd.i32 q9,q9,q13 ++ vldr d26,[sp,#4*(16+2)] @ two ++ ++ vadd.i32 q2,q2,q14 ++ vadd.i32 q6,q6,q14 ++ vadd.i32 q10,q10,q14 ++ vadd.i32 d14,d14,d24 @ counter+1 ++ vadd.i32 d22,d22,d26 @ counter+2 ++ ++ vadd.i32 q3,q3,q15 ++ vadd.i32 q7,q7,q15 ++ vadd.i32 q11,q11,q15 ++ ++ cmp r11,#64*4 ++ blo .Ltail_neon ++ ++ vld1.8 {q12-q13},[r12]! @ load input ++ mov r11,sp ++ vld1.8 {q14-q15},[r12]! ++ veor q0,q0,q12 @ xor with input ++ veor q1,q1,q13 ++ vld1.8 {q12-q13},[r12]! ++ veor q2,q2,q14 ++ veor q3,q3,q15 ++ vld1.8 {q14-q15},[r12]! ++ ++ veor q4,q4,q12 ++ vst1.8 {q0-q1},[r14]! @ store output ++ veor q5,q5,q13 ++ vld1.8 {q12-q13},[r12]! ++ veor q6,q6,q14 ++ vst1.8 {q2-q3},[r14]! ++ veor q7,q7,q15 ++ vld1.8 {q14-q15},[r12]! ++ ++ veor q8,q8,q12 ++ vld1.32 {q0-q1},[r11]! @ load for next iteration ++ veor d25,d25,d25 ++ vldr d24,[sp,#4*(16+4)] @ four ++ veor q9,q9,q13 ++ vld1.32 {q2-q3},[r11] ++ veor q10,q10,q14 ++ vst1.8 {q4-q5},[r14]! ++ veor q11,q11,q15 ++ vst1.8 {q6-q7},[r14]! ++ ++ vadd.i32 d6,d6,d24 @ next counter value ++ vldr d24,[sp,#4*(16+0)] @ one ++ ++ ldmia sp,{r8-r11} @ load key material ++ add r0,r0,r8 @ accumulate key material ++ ldr r8,[r12],#16 @ load input ++ vst1.8 {q8-q9},[r14]! ++ add r1,r1,r9 ++ ldr r9,[r12,#-12] ++ vst1.8 {q10-q11},[r14]! ++ add r2,r2,r10 ++ ldr r10,[r12,#-8] ++ add r3,r3,r11 ++ ldr r11,[r12,#-4] ++#ifdef __ARMEB__ ++ rev r0,r0 ++ rev r1,r1 ++ rev r2,r2 ++ rev r3,r3 ++#endif ++ eor r0,r0,r8 @ xor with input ++ add r8,sp,#4*(4) ++ eor r1,r1,r9 ++ str r0,[r14],#16 @ store output ++ eor r2,r2,r10 ++ str r1,[r14,#-12] ++ eor r3,r3,r11 ++ ldmia r8,{r8-r11} @ load key material ++ str r2,[r14,#-8] ++ str r3,[r14,#-4] ++ ++ add r4,r4,r8 @ accumulate key material ++ ldr r8,[r12],#16 @ load input ++ add r5,r5,r9 ++ ldr r9,[r12,#-12] ++ add r6,r6,r10 ++ ldr r10,[r12,#-8] ++ add r7,r7,r11 ++ ldr r11,[r12,#-4] ++#ifdef __ARMEB__ ++ rev r4,r4 ++ rev r5,r5 ++ rev r6,r6 ++ rev r7,r7 ++#endif ++ eor r4,r4,r8 ++ add r8,sp,#4*(8) ++ eor r5,r5,r9 ++ str r4,[r14],#16 @ store output ++ eor r6,r6,r10 ++ str r5,[r14,#-12] ++ eor r7,r7,r11 ++ ldmia r8,{r8-r11} @ load key material ++ str r6,[r14,#-8] ++ add r0,sp,#4*(16+8) ++ str r7,[r14,#-4] ++ ++ ldmia r0,{r0-r7} @ load second half ++ ++ add r0,r0,r8 @ accumulate key material ++ ldr r8,[r12],#16 @ load input ++ add r1,r1,r9 ++ ldr r9,[r12,#-12] ++#ifdef __thumb2__ ++ it hi ++#endif ++ strhi r10,[sp,#4*(16+10)] @ copy "rx" while at it ++ add r2,r2,r10 ++ ldr r10,[r12,#-8] ++#ifdef __thumb2__ ++ it hi ++#endif ++ strhi r11,[sp,#4*(16+11)] @ copy "rx" while at it ++ add r3,r3,r11 ++ ldr r11,[r12,#-4] ++#ifdef __ARMEB__ ++ rev r0,r0 ++ rev r1,r1 ++ rev r2,r2 ++ rev r3,r3 ++#endif ++ eor r0,r0,r8 ++ add r8,sp,#4*(12) ++ eor r1,r1,r9 ++ str r0,[r14],#16 @ store output ++ eor r2,r2,r10 ++ str r1,[r14,#-12] ++ eor r3,r3,r11 ++ ldmia r8,{r8-r11} @ load key material ++ str r2,[r14,#-8] ++ str r3,[r14,#-4] ++ ++ add r4,r4,r8 @ accumulate key material ++ add r8,r8,#4 @ next counter value ++ add r5,r5,r9 ++ str r8,[sp,#4*(12)] @ save next counter value ++ ldr r8,[r12],#16 @ load input ++ add r6,r6,r10 ++ add r4,r4,#3 @ counter+3 ++ ldr r9,[r12,#-12] ++ add r7,r7,r11 ++ ldr r10,[r12,#-8] ++ ldr r11,[r12,#-4] ++#ifdef __ARMEB__ ++ rev r4,r4 ++ rev r5,r5 ++ rev r6,r6 ++ rev r7,r7 ++#endif ++ eor r4,r4,r8 ++#ifdef __thumb2__ ++ it hi ++#endif ++ ldrhi r8,[sp,#4*(32+2)] @ re-load len ++ eor r5,r5,r9 ++ eor r6,r6,r10 ++ str r4,[r14],#16 @ store output ++ eor r7,r7,r11 ++ str r5,[r14,#-12] ++ sub r11,r8,#64*4 @ len-=64*4 ++ str r6,[r14,#-8] ++ str r7,[r14,#-4] ++ bhi .Loop_neon_outer ++ ++ b .Ldone_neon ++ ++.align 4 ++.Lbreak_neon: ++ @ harmonize NEON and integer-only stack frames: load data ++ @ from NEON frame, but save to integer-only one; distance ++ @ between the two is 4*(32+4+16-32)=4*(20). ++ ++ str r11, [sp,#4*(20+32+2)] @ save len ++ add r11,sp,#4*(32+4) ++ str r12, [sp,#4*(20+32+1)] @ save inp ++ str r14, [sp,#4*(20+32+0)] @ save out ++ ++ ldr r12,[sp,#4*(16+10)] ++ ldr r14,[sp,#4*(16+11)] ++ vldmia r11,{d8-d15} @ fulfill ABI requirement ++ str r12,[sp,#4*(20+16+10)] @ copy "rx" ++ str r14,[sp,#4*(20+16+11)] @ copy "rx" ++ ++ ldr r11, [sp,#4*(15)] ++ ldr r12,[sp,#4*(12)] @ modulo-scheduled load ++ ldr r10, [sp,#4*(13)] ++ ldr r14,[sp,#4*(14)] ++ str r11, [sp,#4*(20+16+15)] ++ add r11,sp,#4*(20) ++ vst1.32 {q0-q1},[r11]! @ copy key ++ add sp,sp,#4*(20) @ switch frame ++ vst1.32 {q2-q3},[r11] ++ mov r11,#10 ++ b .Loop @ go integer-only ++ ++.align 4 ++.Ltail_neon: ++ cmp r11,#64*3 ++ bhs .L192_or_more_neon ++ cmp r11,#64*2 ++ bhs .L128_or_more_neon ++ cmp r11,#64*1 ++ bhs .L64_or_more_neon ++ ++ add r8,sp,#4*(8) ++ vst1.8 {q0-q1},[sp] ++ add r10,sp,#4*(0) ++ vst1.8 {q2-q3},[r8] ++ b .Loop_tail_neon ++ ++.align 4 ++.L64_or_more_neon: ++ vld1.8 {q12-q13},[r12]! ++ vld1.8 {q14-q15},[r12]! ++ veor q0,q0,q12 ++ veor q1,q1,q13 ++ veor q2,q2,q14 ++ veor q3,q3,q15 ++ vst1.8 {q0-q1},[r14]! ++ vst1.8 {q2-q3},[r14]! ++ ++ beq .Ldone_neon ++ ++ add r8,sp,#4*(8) ++ vst1.8 {q4-q5},[sp] ++ add r10,sp,#4*(0) ++ vst1.8 {q6-q7},[r8] ++ sub r11,r11,#64*1 @ len-=64*1 ++ b .Loop_tail_neon ++ ++.align 4 ++.L128_or_more_neon: ++ vld1.8 {q12-q13},[r12]! ++ vld1.8 {q14-q15},[r12]! ++ veor q0,q0,q12 ++ veor q1,q1,q13 ++ vld1.8 {q12-q13},[r12]! ++ veor q2,q2,q14 ++ veor q3,q3,q15 ++ vld1.8 {q14-q15},[r12]! ++ ++ veor q4,q4,q12 ++ veor q5,q5,q13 ++ vst1.8 {q0-q1},[r14]! ++ veor q6,q6,q14 ++ vst1.8 {q2-q3},[r14]! ++ veor q7,q7,q15 ++ vst1.8 {q4-q5},[r14]! ++ vst1.8 {q6-q7},[r14]! ++ ++ beq .Ldone_neon ++ ++ add r8,sp,#4*(8) ++ vst1.8 {q8-q9},[sp] ++ add r10,sp,#4*(0) ++ vst1.8 {q10-q11},[r8] ++ sub r11,r11,#64*2 @ len-=64*2 ++ b .Loop_tail_neon ++ ++.align 4 ++.L192_or_more_neon: ++ vld1.8 {q12-q13},[r12]! ++ vld1.8 {q14-q15},[r12]! ++ veor q0,q0,q12 ++ veor q1,q1,q13 ++ vld1.8 {q12-q13},[r12]! ++ veor q2,q2,q14 ++ veor q3,q3,q15 ++ vld1.8 {q14-q15},[r12]! ++ ++ veor q4,q4,q12 ++ veor q5,q5,q13 ++ vld1.8 {q12-q13},[r12]! ++ veor q6,q6,q14 ++ vst1.8 {q0-q1},[r14]! ++ veor q7,q7,q15 ++ vld1.8 {q14-q15},[r12]! ++ ++ veor q8,q8,q12 ++ vst1.8 {q2-q3},[r14]! ++ veor q9,q9,q13 ++ vst1.8 {q4-q5},[r14]! ++ veor q10,q10,q14 ++ vst1.8 {q6-q7},[r14]! ++ veor q11,q11,q15 ++ vst1.8 {q8-q9},[r14]! ++ vst1.8 {q10-q11},[r14]! ++ ++ beq .Ldone_neon ++ ++ ldmia sp,{r8-r11} @ load key material ++ add r0,r0,r8 @ accumulate key material ++ add r8,sp,#4*(4) ++ add r1,r1,r9 ++ add r2,r2,r10 ++ add r3,r3,r11 ++ ldmia r8,{r8-r11} @ load key material ++ ++ add r4,r4,r8 @ accumulate key material ++ add r8,sp,#4*(8) ++ add r5,r5,r9 ++ add r6,r6,r10 ++ add r7,r7,r11 ++ ldmia r8,{r8-r11} @ load key material ++#ifdef __ARMEB__ ++ rev r0,r0 ++ rev r1,r1 ++ rev r2,r2 ++ rev r3,r3 ++ rev r4,r4 ++ rev r5,r5 ++ rev r6,r6 ++ rev r7,r7 ++#endif ++ stmia sp,{r0-r7} ++ add r0,sp,#4*(16+8) ++ ++ ldmia r0,{r0-r7} @ load second half ++ ++ add r0,r0,r8 @ accumulate key material ++ add r8,sp,#4*(12) ++ add r1,r1,r9 ++ add r2,r2,r10 ++ add r3,r3,r11 ++ ldmia r8,{r8-r11} @ load key material ++ ++ add r4,r4,r8 @ accumulate key material ++ add r8,sp,#4*(8) ++ add r5,r5,r9 ++ add r4,r4,#3 @ counter+3 ++ add r6,r6,r10 ++ add r7,r7,r11 ++ ldr r11,[sp,#4*(32+2)] @ re-load len ++#ifdef __ARMEB__ ++ rev r0,r0 ++ rev r1,r1 ++ rev r2,r2 ++ rev r3,r3 ++ rev r4,r4 ++ rev r5,r5 ++ rev r6,r6 ++ rev r7,r7 ++#endif ++ stmia r8,{r0-r7} ++ add r10,sp,#4*(0) ++ sub r11,r11,#64*3 @ len-=64*3 ++ ++.Loop_tail_neon: ++ ldrb r8,[r10],#1 @ read buffer on stack ++ ldrb r9,[r12],#1 @ read input ++ subs r11,r11,#1 ++ eor r8,r8,r9 ++ strb r8,[r14],#1 @ store output ++ bne .Loop_tail_neon ++ ++.Ldone_neon: ++ add sp,sp,#4*(32+4) ++ vldmia sp,{d8-d15} ++ add sp,sp,#4*(16+3) ++.Lno_data_neon: ++ ldmia sp!,{r4-r11,pc} ++ENDPROC(chacha20_neon) ++#endif ++ ++.align 5 ++.Lsigma2: ++.long 0x61707865,0x3320646e,0x79622d32,0x6b206574 @ endian-neutral ++.Lone2: ++.long 1,0,0,0 ++.word -1 ++ ++.align 5 ++ENTRY(chacha20_arm) ++ ldr r12,[sp,#0] @ pull pointer to counter and nonce ++ stmdb sp!,{r0-r2,r4-r11,lr} ++ cmp r2,#0 @ len==0? ++#ifdef __thumb2__ ++ itt eq ++#endif ++ addeq sp,sp,#4*3 ++ beq .Lno_data_arm ++.Lshort: ++ ldmia r12,{r4-r7} @ load counter and nonce ++ sub sp,sp,#4*(16) @ off-load area ++#if __LINUX_ARM_ARCH__ < 7 && !defined(__thumb2__) ++ sub r14,pc,#100 @ .Lsigma2 ++#else ++ adr r14,.Lsigma2 @ .Lsigma2 ++#endif ++ stmdb sp!,{r4-r7} @ copy counter and nonce ++ ldmia r3,{r4-r11} @ load key ++ ldmia r14,{r0-r3} @ load sigma ++ stmdb sp!,{r4-r11} @ copy key ++ stmdb sp!,{r0-r3} @ copy sigma ++ str r10,[sp,#4*(16+10)] @ off-load "rx" ++ str r11,[sp,#4*(16+11)] @ off-load "rx" ++ b .Loop_outer_enter ++ ++.align 4 ++.Loop_outer: ++ ldmia sp,{r0-r9} @ load key material ++ str r11,[sp,#4*(32+2)] @ save len ++ str r12, [sp,#4*(32+1)] @ save inp ++ str r14, [sp,#4*(32+0)] @ save out ++.Loop_outer_enter: ++ ldr r11, [sp,#4*(15)] ++ ldr r12,[sp,#4*(12)] @ modulo-scheduled load ++ ldr r10, [sp,#4*(13)] ++ ldr r14,[sp,#4*(14)] ++ str r11, [sp,#4*(16+15)] ++ mov r11,#10 ++ b .Loop ++ ++.align 4 ++.Loop: ++ subs r11,r11,#1 ++ add r0,r0,r4 ++ mov r12,r12,ror#16 ++ add r1,r1,r5 ++ mov r10,r10,ror#16 ++ eor r12,r12,r0,ror#16 ++ eor r10,r10,r1,ror#16 ++ add r8,r8,r12 ++ mov r4,r4,ror#20 ++ add r9,r9,r10 ++ mov r5,r5,ror#20 ++ eor r4,r4,r8,ror#20 ++ eor r5,r5,r9,ror#20 ++ add r0,r0,r4 ++ mov r12,r12,ror#24 ++ add r1,r1,r5 ++ mov r10,r10,ror#24 ++ eor r12,r12,r0,ror#24 ++ eor r10,r10,r1,ror#24 ++ add r8,r8,r12 ++ mov r4,r4,ror#25 ++ add r9,r9,r10 ++ mov r5,r5,ror#25 ++ str r10,[sp,#4*(16+13)] ++ ldr r10,[sp,#4*(16+15)] ++ eor r4,r4,r8,ror#25 ++ eor r5,r5,r9,ror#25 ++ str r8,[sp,#4*(16+8)] ++ ldr r8,[sp,#4*(16+10)] ++ add r2,r2,r6 ++ mov r14,r14,ror#16 ++ str r9,[sp,#4*(16+9)] ++ ldr r9,[sp,#4*(16+11)] ++ add r3,r3,r7 ++ mov r10,r10,ror#16 ++ eor r14,r14,r2,ror#16 ++ eor r10,r10,r3,ror#16 ++ add r8,r8,r14 ++ mov r6,r6,ror#20 ++ add r9,r9,r10 ++ mov r7,r7,ror#20 ++ eor r6,r6,r8,ror#20 ++ eor r7,r7,r9,ror#20 ++ add r2,r2,r6 ++ mov r14,r14,ror#24 ++ add r3,r3,r7 ++ mov r10,r10,ror#24 ++ eor r14,r14,r2,ror#24 ++ eor r10,r10,r3,ror#24 ++ add r8,r8,r14 ++ mov r6,r6,ror#25 ++ add r9,r9,r10 ++ mov r7,r7,ror#25 ++ eor r6,r6,r8,ror#25 ++ eor r7,r7,r9,ror#25 ++ add r0,r0,r5 ++ mov r10,r10,ror#16 ++ add r1,r1,r6 ++ mov r12,r12,ror#16 ++ eor r10,r10,r0,ror#16 ++ eor r12,r12,r1,ror#16 ++ add r8,r8,r10 ++ mov r5,r5,ror#20 ++ add r9,r9,r12 ++ mov r6,r6,ror#20 ++ eor r5,r5,r8,ror#20 ++ eor r6,r6,r9,ror#20 ++ add r0,r0,r5 ++ mov r10,r10,ror#24 ++ add r1,r1,r6 ++ mov r12,r12,ror#24 ++ eor r10,r10,r0,ror#24 ++ eor r12,r12,r1,ror#24 ++ add r8,r8,r10 ++ mov r5,r5,ror#25 ++ str r10,[sp,#4*(16+15)] ++ ldr r10,[sp,#4*(16+13)] ++ add r9,r9,r12 ++ mov r6,r6,ror#25 ++ eor r5,r5,r8,ror#25 ++ eor r6,r6,r9,ror#25 ++ str r8,[sp,#4*(16+10)] ++ ldr r8,[sp,#4*(16+8)] ++ add r2,r2,r7 ++ mov r10,r10,ror#16 ++ str r9,[sp,#4*(16+11)] ++ ldr r9,[sp,#4*(16+9)] ++ add r3,r3,r4 ++ mov r14,r14,ror#16 ++ eor r10,r10,r2,ror#16 ++ eor r14,r14,r3,ror#16 ++ add r8,r8,r10 ++ mov r7,r7,ror#20 ++ add r9,r9,r14 ++ mov r4,r4,ror#20 ++ eor r7,r7,r8,ror#20 ++ eor r4,r4,r9,ror#20 ++ add r2,r2,r7 ++ mov r10,r10,ror#24 ++ add r3,r3,r4 ++ mov r14,r14,ror#24 ++ eor r10,r10,r2,ror#24 ++ eor r14,r14,r3,ror#24 ++ add r8,r8,r10 ++ mov r7,r7,ror#25 ++ add r9,r9,r14 ++ mov r4,r4,ror#25 ++ eor r7,r7,r8,ror#25 ++ eor r4,r4,r9,ror#25 ++ bne .Loop ++ ++ ldr r11,[sp,#4*(32+2)] @ load len ++ ++ str r8, [sp,#4*(16+8)] @ modulo-scheduled store ++ str r9, [sp,#4*(16+9)] ++ str r12,[sp,#4*(16+12)] ++ str r10, [sp,#4*(16+13)] ++ str r14,[sp,#4*(16+14)] ++ ++ @ at this point we have first half of 512-bit result in ++ @ rx and second half at sp+4*(16+8) ++ ++ cmp r11,#64 @ done yet? ++#ifdef __thumb2__ ++ itete lo ++#endif ++ addlo r12,sp,#4*(0) @ shortcut or ... ++ ldrhs r12,[sp,#4*(32+1)] @ ... load inp ++ addlo r14,sp,#4*(0) @ shortcut or ... ++ ldrhs r14,[sp,#4*(32+0)] @ ... load out ++ ++ ldr r8,[sp,#4*(0)] @ load key material ++ ldr r9,[sp,#4*(1)] ++ ++#if __LINUX_ARM_ARCH__ >= 6 || !defined(__ARMEB__) ++#if __LINUX_ARM_ARCH__ < 7 ++ orr r10,r12,r14 ++ tst r10,#3 @ are input and output aligned? ++ ldr r10,[sp,#4*(2)] ++ bne .Lunaligned ++ cmp r11,#64 @ restore flags ++#else ++ ldr r10,[sp,#4*(2)] ++#endif ++ ldr r11,[sp,#4*(3)] ++ ++ add r0,r0,r8 @ accumulate key material ++ add r1,r1,r9 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhs r8,[r12],#16 @ load input ++ ldrhs r9,[r12,#-12] ++ ++ add r2,r2,r10 ++ add r3,r3,r11 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhs r10,[r12,#-8] ++ ldrhs r11,[r12,#-4] ++#if __LINUX_ARM_ARCH__ >= 6 && defined(__ARMEB__) ++ rev r0,r0 ++ rev r1,r1 ++ rev r2,r2 ++ rev r3,r3 ++#endif ++#ifdef __thumb2__ ++ itt hs ++#endif ++ eorhs r0,r0,r8 @ xor with input ++ eorhs r1,r1,r9 ++ add r8,sp,#4*(4) ++ str r0,[r14],#16 @ store output ++#ifdef __thumb2__ ++ itt hs ++#endif ++ eorhs r2,r2,r10 ++ eorhs r3,r3,r11 ++ ldmia r8,{r8-r11} @ load key material ++ str r1,[r14,#-12] ++ str r2,[r14,#-8] ++ str r3,[r14,#-4] ++ ++ add r4,r4,r8 @ accumulate key material ++ add r5,r5,r9 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhs r8,[r12],#16 @ load input ++ ldrhs r9,[r12,#-12] ++ add r6,r6,r10 ++ add r7,r7,r11 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhs r10,[r12,#-8] ++ ldrhs r11,[r12,#-4] ++#if __LINUX_ARM_ARCH__ >= 6 && defined(__ARMEB__) ++ rev r4,r4 ++ rev r5,r5 ++ rev r6,r6 ++ rev r7,r7 ++#endif ++#ifdef __thumb2__ ++ itt hs ++#endif ++ eorhs r4,r4,r8 ++ eorhs r5,r5,r9 ++ add r8,sp,#4*(8) ++ str r4,[r14],#16 @ store output ++#ifdef __thumb2__ ++ itt hs ++#endif ++ eorhs r6,r6,r10 ++ eorhs r7,r7,r11 ++ str r5,[r14,#-12] ++ ldmia r8,{r8-r11} @ load key material ++ str r6,[r14,#-8] ++ add r0,sp,#4*(16+8) ++ str r7,[r14,#-4] ++ ++ ldmia r0,{r0-r7} @ load second half ++ ++ add r0,r0,r8 @ accumulate key material ++ add r1,r1,r9 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhs r8,[r12],#16 @ load input ++ ldrhs r9,[r12,#-12] ++#ifdef __thumb2__ ++ itt hi ++#endif ++ strhi r10,[sp,#4*(16+10)] @ copy "rx" while at it ++ strhi r11,[sp,#4*(16+11)] @ copy "rx" while at it ++ add r2,r2,r10 ++ add r3,r3,r11 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhs r10,[r12,#-8] ++ ldrhs r11,[r12,#-4] ++#if __LINUX_ARM_ARCH__ >= 6 && defined(__ARMEB__) ++ rev r0,r0 ++ rev r1,r1 ++ rev r2,r2 ++ rev r3,r3 ++#endif ++#ifdef __thumb2__ ++ itt hs ++#endif ++ eorhs r0,r0,r8 ++ eorhs r1,r1,r9 ++ add r8,sp,#4*(12) ++ str r0,[r14],#16 @ store output ++#ifdef __thumb2__ ++ itt hs ++#endif ++ eorhs r2,r2,r10 ++ eorhs r3,r3,r11 ++ str r1,[r14,#-12] ++ ldmia r8,{r8-r11} @ load key material ++ str r2,[r14,#-8] ++ str r3,[r14,#-4] ++ ++ add r4,r4,r8 @ accumulate key material ++ add r5,r5,r9 ++#ifdef __thumb2__ ++ itt hi ++#endif ++ addhi r8,r8,#1 @ next counter value ++ strhi r8,[sp,#4*(12)] @ save next counter value ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhs r8,[r12],#16 @ load input ++ ldrhs r9,[r12,#-12] ++ add r6,r6,r10 ++ add r7,r7,r11 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhs r10,[r12,#-8] ++ ldrhs r11,[r12,#-4] ++#if __LINUX_ARM_ARCH__ >= 6 && defined(__ARMEB__) ++ rev r4,r4 ++ rev r5,r5 ++ rev r6,r6 ++ rev r7,r7 ++#endif ++#ifdef __thumb2__ ++ itt hs ++#endif ++ eorhs r4,r4,r8 ++ eorhs r5,r5,r9 ++#ifdef __thumb2__ ++ it ne ++#endif ++ ldrne r8,[sp,#4*(32+2)] @ re-load len ++#ifdef __thumb2__ ++ itt hs ++#endif ++ eorhs r6,r6,r10 ++ eorhs r7,r7,r11 ++ str r4,[r14],#16 @ store output ++ str r5,[r14,#-12] ++#ifdef __thumb2__ ++ it hs ++#endif ++ subhs r11,r8,#64 @ len-=64 ++ str r6,[r14,#-8] ++ str r7,[r14,#-4] ++ bhi .Loop_outer ++ ++ beq .Ldone ++#if __LINUX_ARM_ARCH__ < 7 ++ b .Ltail ++ ++.align 4 ++.Lunaligned: @ unaligned endian-neutral path ++ cmp r11,#64 @ restore flags ++#endif ++#endif ++#if __LINUX_ARM_ARCH__ < 7 ++ ldr r11,[sp,#4*(3)] ++ add r0,r0,r8 @ accumulate key material ++ add r1,r1,r9 ++ add r2,r2,r10 ++#ifdef __thumb2__ ++ itete lo ++#endif ++ eorlo r8,r8,r8 @ zero or ... ++ ldrhsb r8,[r12],#16 @ ... load input ++ eorlo r9,r9,r9 ++ ldrhsb r9,[r12,#-12] ++ ++ add r3,r3,r11 ++#ifdef __thumb2__ ++ itete lo ++#endif ++ eorlo r10,r10,r10 ++ ldrhsb r10,[r12,#-8] ++ eorlo r11,r11,r11 ++ ldrhsb r11,[r12,#-4] ++ ++ eor r0,r8,r0 @ xor with input (or zero) ++ eor r1,r9,r1 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r8,[r12,#-15] @ load more input ++ ldrhsb r9,[r12,#-11] ++ eor r2,r10,r2 ++ strb r0,[r14],#16 @ store output ++ eor r3,r11,r3 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r10,[r12,#-7] ++ ldrhsb r11,[r12,#-3] ++ strb r1,[r14,#-12] ++ eor r0,r8,r0,lsr#8 ++ strb r2,[r14,#-8] ++ eor r1,r9,r1,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r8,[r12,#-14] @ load more input ++ ldrhsb r9,[r12,#-10] ++ strb r3,[r14,#-4] ++ eor r2,r10,r2,lsr#8 ++ strb r0,[r14,#-15] ++ eor r3,r11,r3,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r10,[r12,#-6] ++ ldrhsb r11,[r12,#-2] ++ strb r1,[r14,#-11] ++ eor r0,r8,r0,lsr#8 ++ strb r2,[r14,#-7] ++ eor r1,r9,r1,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r8,[r12,#-13] @ load more input ++ ldrhsb r9,[r12,#-9] ++ strb r3,[r14,#-3] ++ eor r2,r10,r2,lsr#8 ++ strb r0,[r14,#-14] ++ eor r3,r11,r3,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r10,[r12,#-5] ++ ldrhsb r11,[r12,#-1] ++ strb r1,[r14,#-10] ++ strb r2,[r14,#-6] ++ eor r0,r8,r0,lsr#8 ++ strb r3,[r14,#-2] ++ eor r1,r9,r1,lsr#8 ++ strb r0,[r14,#-13] ++ eor r2,r10,r2,lsr#8 ++ strb r1,[r14,#-9] ++ eor r3,r11,r3,lsr#8 ++ strb r2,[r14,#-5] ++ strb r3,[r14,#-1] ++ add r8,sp,#4*(4+0) ++ ldmia r8,{r8-r11} @ load key material ++ add r0,sp,#4*(16+8) ++ add r4,r4,r8 @ accumulate key material ++ add r5,r5,r9 ++ add r6,r6,r10 ++#ifdef __thumb2__ ++ itete lo ++#endif ++ eorlo r8,r8,r8 @ zero or ... ++ ldrhsb r8,[r12],#16 @ ... load input ++ eorlo r9,r9,r9 ++ ldrhsb r9,[r12,#-12] ++ ++ add r7,r7,r11 ++#ifdef __thumb2__ ++ itete lo ++#endif ++ eorlo r10,r10,r10 ++ ldrhsb r10,[r12,#-8] ++ eorlo r11,r11,r11 ++ ldrhsb r11,[r12,#-4] ++ ++ eor r4,r8,r4 @ xor with input (or zero) ++ eor r5,r9,r5 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r8,[r12,#-15] @ load more input ++ ldrhsb r9,[r12,#-11] ++ eor r6,r10,r6 ++ strb r4,[r14],#16 @ store output ++ eor r7,r11,r7 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r10,[r12,#-7] ++ ldrhsb r11,[r12,#-3] ++ strb r5,[r14,#-12] ++ eor r4,r8,r4,lsr#8 ++ strb r6,[r14,#-8] ++ eor r5,r9,r5,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r8,[r12,#-14] @ load more input ++ ldrhsb r9,[r12,#-10] ++ strb r7,[r14,#-4] ++ eor r6,r10,r6,lsr#8 ++ strb r4,[r14,#-15] ++ eor r7,r11,r7,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r10,[r12,#-6] ++ ldrhsb r11,[r12,#-2] ++ strb r5,[r14,#-11] ++ eor r4,r8,r4,lsr#8 ++ strb r6,[r14,#-7] ++ eor r5,r9,r5,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r8,[r12,#-13] @ load more input ++ ldrhsb r9,[r12,#-9] ++ strb r7,[r14,#-3] ++ eor r6,r10,r6,lsr#8 ++ strb r4,[r14,#-14] ++ eor r7,r11,r7,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r10,[r12,#-5] ++ ldrhsb r11,[r12,#-1] ++ strb r5,[r14,#-10] ++ strb r6,[r14,#-6] ++ eor r4,r8,r4,lsr#8 ++ strb r7,[r14,#-2] ++ eor r5,r9,r5,lsr#8 ++ strb r4,[r14,#-13] ++ eor r6,r10,r6,lsr#8 ++ strb r5,[r14,#-9] ++ eor r7,r11,r7,lsr#8 ++ strb r6,[r14,#-5] ++ strb r7,[r14,#-1] ++ add r8,sp,#4*(4+4) ++ ldmia r8,{r8-r11} @ load key material ++ ldmia r0,{r0-r7} @ load second half ++#ifdef __thumb2__ ++ itt hi ++#endif ++ strhi r10,[sp,#4*(16+10)] @ copy "rx" ++ strhi r11,[sp,#4*(16+11)] @ copy "rx" ++ add r0,r0,r8 @ accumulate key material ++ add r1,r1,r9 ++ add r2,r2,r10 ++#ifdef __thumb2__ ++ itete lo ++#endif ++ eorlo r8,r8,r8 @ zero or ... ++ ldrhsb r8,[r12],#16 @ ... load input ++ eorlo r9,r9,r9 ++ ldrhsb r9,[r12,#-12] ++ ++ add r3,r3,r11 ++#ifdef __thumb2__ ++ itete lo ++#endif ++ eorlo r10,r10,r10 ++ ldrhsb r10,[r12,#-8] ++ eorlo r11,r11,r11 ++ ldrhsb r11,[r12,#-4] ++ ++ eor r0,r8,r0 @ xor with input (or zero) ++ eor r1,r9,r1 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r8,[r12,#-15] @ load more input ++ ldrhsb r9,[r12,#-11] ++ eor r2,r10,r2 ++ strb r0,[r14],#16 @ store output ++ eor r3,r11,r3 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r10,[r12,#-7] ++ ldrhsb r11,[r12,#-3] ++ strb r1,[r14,#-12] ++ eor r0,r8,r0,lsr#8 ++ strb r2,[r14,#-8] ++ eor r1,r9,r1,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r8,[r12,#-14] @ load more input ++ ldrhsb r9,[r12,#-10] ++ strb r3,[r14,#-4] ++ eor r2,r10,r2,lsr#8 ++ strb r0,[r14,#-15] ++ eor r3,r11,r3,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r10,[r12,#-6] ++ ldrhsb r11,[r12,#-2] ++ strb r1,[r14,#-11] ++ eor r0,r8,r0,lsr#8 ++ strb r2,[r14,#-7] ++ eor r1,r9,r1,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r8,[r12,#-13] @ load more input ++ ldrhsb r9,[r12,#-9] ++ strb r3,[r14,#-3] ++ eor r2,r10,r2,lsr#8 ++ strb r0,[r14,#-14] ++ eor r3,r11,r3,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r10,[r12,#-5] ++ ldrhsb r11,[r12,#-1] ++ strb r1,[r14,#-10] ++ strb r2,[r14,#-6] ++ eor r0,r8,r0,lsr#8 ++ strb r3,[r14,#-2] ++ eor r1,r9,r1,lsr#8 ++ strb r0,[r14,#-13] ++ eor r2,r10,r2,lsr#8 ++ strb r1,[r14,#-9] ++ eor r3,r11,r3,lsr#8 ++ strb r2,[r14,#-5] ++ strb r3,[r14,#-1] ++ add r8,sp,#4*(4+8) ++ ldmia r8,{r8-r11} @ load key material ++ add r4,r4,r8 @ accumulate key material ++#ifdef __thumb2__ ++ itt hi ++#endif ++ addhi r8,r8,#1 @ next counter value ++ strhi r8,[sp,#4*(12)] @ save next counter value ++ add r5,r5,r9 ++ add r6,r6,r10 ++#ifdef __thumb2__ ++ itete lo ++#endif ++ eorlo r8,r8,r8 @ zero or ... ++ ldrhsb r8,[r12],#16 @ ... load input ++ eorlo r9,r9,r9 ++ ldrhsb r9,[r12,#-12] ++ ++ add r7,r7,r11 ++#ifdef __thumb2__ ++ itete lo ++#endif ++ eorlo r10,r10,r10 ++ ldrhsb r10,[r12,#-8] ++ eorlo r11,r11,r11 ++ ldrhsb r11,[r12,#-4] ++ ++ eor r4,r8,r4 @ xor with input (or zero) ++ eor r5,r9,r5 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r8,[r12,#-15] @ load more input ++ ldrhsb r9,[r12,#-11] ++ eor r6,r10,r6 ++ strb r4,[r14],#16 @ store output ++ eor r7,r11,r7 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r10,[r12,#-7] ++ ldrhsb r11,[r12,#-3] ++ strb r5,[r14,#-12] ++ eor r4,r8,r4,lsr#8 ++ strb r6,[r14,#-8] ++ eor r5,r9,r5,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r8,[r12,#-14] @ load more input ++ ldrhsb r9,[r12,#-10] ++ strb r7,[r14,#-4] ++ eor r6,r10,r6,lsr#8 ++ strb r4,[r14,#-15] ++ eor r7,r11,r7,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r10,[r12,#-6] ++ ldrhsb r11,[r12,#-2] ++ strb r5,[r14,#-11] ++ eor r4,r8,r4,lsr#8 ++ strb r6,[r14,#-7] ++ eor r5,r9,r5,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r8,[r12,#-13] @ load more input ++ ldrhsb r9,[r12,#-9] ++ strb r7,[r14,#-3] ++ eor r6,r10,r6,lsr#8 ++ strb r4,[r14,#-14] ++ eor r7,r11,r7,lsr#8 ++#ifdef __thumb2__ ++ itt hs ++#endif ++ ldrhsb r10,[r12,#-5] ++ ldrhsb r11,[r12,#-1] ++ strb r5,[r14,#-10] ++ strb r6,[r14,#-6] ++ eor r4,r8,r4,lsr#8 ++ strb r7,[r14,#-2] ++ eor r5,r9,r5,lsr#8 ++ strb r4,[r14,#-13] ++ eor r6,r10,r6,lsr#8 ++ strb r5,[r14,#-9] ++ eor r7,r11,r7,lsr#8 ++ strb r6,[r14,#-5] ++ strb r7,[r14,#-1] ++#ifdef __thumb2__ ++ it ne ++#endif ++ ldrne r8,[sp,#4*(32+2)] @ re-load len ++#ifdef __thumb2__ ++ it hs ++#endif ++ subhs r11,r8,#64 @ len-=64 ++ bhi .Loop_outer ++ ++ beq .Ldone ++#endif ++ ++.Ltail: ++ ldr r12,[sp,#4*(32+1)] @ load inp ++ add r9,sp,#4*(0) ++ ldr r14,[sp,#4*(32+0)] @ load out ++ ++.Loop_tail: ++ ldrb r10,[r9],#1 @ read buffer on stack ++ ldrb r11,[r12],#1 @ read input ++ subs r8,r8,#1 ++ eor r11,r11,r10 ++ strb r11,[r14],#1 @ store output ++ bne .Loop_tail ++ ++.Ldone: ++ add sp,sp,#4*(32+3) ++.Lno_data_arm: ++ ldmia sp!,{r4-r11,pc} ++ENDPROC(chacha20_arm) +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/chacha20-x86_64.S 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,2630 @@ ++/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) ++ * ++ * Copyright (C) 2017 Samuel Neves . All Rights Reserved. ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. ++ */ ++ ++#include ++ ++.section .rodata.cst16.Lzero, "aM", @progbits, 16 ++.align 16 ++.Lzero: ++.long 0,0,0,0 ++.section .rodata.cst16.Lone, "aM", @progbits, 16 ++.align 16 ++.Lone: ++.long 1,0,0,0 ++.section .rodata.cst16.Linc, "aM", @progbits, 16 ++.align 16 ++.Linc: ++.long 0,1,2,3 ++.section .rodata.cst16.Lfour, "aM", @progbits, 16 ++.align 16 ++.Lfour: ++.long 4,4,4,4 ++.section .rodata.cst32.Lincy, "aM", @progbits, 32 ++.align 32 ++.Lincy: ++.long 0,2,4,6,1,3,5,7 ++.section .rodata.cst32.Leight, "aM", @progbits, 32 ++.align 32 ++.Leight: ++.long 8,8,8,8,8,8,8,8 ++.section .rodata.cst16.Lrot16, "aM", @progbits, 16 ++.align 16 ++.Lrot16: ++.byte 0x2,0x3,0x0,0x1, 0x6,0x7,0x4,0x5, 0xa,0xb,0x8,0x9, 0xe,0xf,0xc,0xd ++.section .rodata.cst16.Lrot24, "aM", @progbits, 16 ++.align 16 ++.Lrot24: ++.byte 0x3,0x0,0x1,0x2, 0x7,0x4,0x5,0x6, 0xb,0x8,0x9,0xa, 0xf,0xc,0xd,0xe ++.section .rodata.cst16.Lsigma, "aM", @progbits, 16 ++.align 16 ++.Lsigma: ++.byte 101,120,112,97,110,100,32,51,50,45,98,121,116,101,32,107,0 ++.section .rodata.cst64.Lzeroz, "aM", @progbits, 64 ++.align 64 ++.Lzeroz: ++.long 0,0,0,0, 1,0,0,0, 2,0,0,0, 3,0,0,0 ++.section .rodata.cst64.Lfourz, "aM", @progbits, 64 ++.align 64 ++.Lfourz: ++.long 4,0,0,0, 4,0,0,0, 4,0,0,0, 4,0,0,0 ++.section .rodata.cst64.Lincz, "aM", @progbits, 64 ++.align 64 ++.Lincz: ++.long 0,1,2,3,4,5,6,7,8,9,10,11,12,13,14,15 ++.section .rodata.cst64.Lsixteen, "aM", @progbits, 64 ++.align 64 ++.Lsixteen: ++.long 16,16,16,16,16,16,16,16,16,16,16,16,16,16,16,16 ++.section .rodata.cst32.Ltwoy, "aM", @progbits, 32 ++.align 64 ++.Ltwoy: ++.long 2,0,0,0, 2,0,0,0 ++ ++.text ++ ++#ifdef CONFIG_AS_SSSE3 ++.align 32 ++ENTRY(hchacha20_ssse3) ++ movdqa .Lsigma(%rip),%xmm0 ++ movdqu (%rdx),%xmm1 ++ movdqu 16(%rdx),%xmm2 ++ movdqu (%rsi),%xmm3 ++ movdqa .Lrot16(%rip),%xmm6 ++ movdqa .Lrot24(%rip),%xmm7 ++ movq $10,%r8 ++ .align 32 ++.Loop_hssse3: ++ paddd %xmm1,%xmm0 ++ pxor %xmm0,%xmm3 ++ pshufb %xmm6,%xmm3 ++ paddd %xmm3,%xmm2 ++ pxor %xmm2,%xmm1 ++ movdqa %xmm1,%xmm4 ++ psrld $20,%xmm1 ++ pslld $12,%xmm4 ++ por %xmm4,%xmm1 ++ paddd %xmm1,%xmm0 ++ pxor %xmm0,%xmm3 ++ pshufb %xmm7,%xmm3 ++ paddd %xmm3,%xmm2 ++ pxor %xmm2,%xmm1 ++ movdqa %xmm1,%xmm4 ++ psrld $25,%xmm1 ++ pslld $7,%xmm4 ++ por %xmm4,%xmm1 ++ pshufd $78,%xmm2,%xmm2 ++ pshufd $57,%xmm1,%xmm1 ++ pshufd $147,%xmm3,%xmm3 ++ nop ++ paddd %xmm1,%xmm0 ++ pxor %xmm0,%xmm3 ++ pshufb %xmm6,%xmm3 ++ paddd %xmm3,%xmm2 ++ pxor %xmm2,%xmm1 ++ movdqa %xmm1,%xmm4 ++ psrld $20,%xmm1 ++ pslld $12,%xmm4 ++ por %xmm4,%xmm1 ++ paddd %xmm1,%xmm0 ++ pxor %xmm0,%xmm3 ++ pshufb %xmm7,%xmm3 ++ paddd %xmm3,%xmm2 ++ pxor %xmm2,%xmm1 ++ movdqa %xmm1,%xmm4 ++ psrld $25,%xmm1 ++ pslld $7,%xmm4 ++ por %xmm4,%xmm1 ++ pshufd $78,%xmm2,%xmm2 ++ pshufd $147,%xmm1,%xmm1 ++ pshufd $57,%xmm3,%xmm3 ++ decq %r8 ++ jnz .Loop_hssse3 ++ movdqu %xmm0,0(%rdi) ++ movdqu %xmm3,16(%rdi) ++ ret ++ENDPROC(hchacha20_ssse3) ++ ++.align 32 ++ENTRY(chacha20_ssse3) ++.Lchacha20_ssse3: ++ cmpq $0,%rdx ++ je .Lssse3_epilogue ++ leaq 8(%rsp),%r10 ++ ++ cmpq $128,%rdx ++ ja .Lchacha20_4x ++ ++.Ldo_sse3_after_all: ++ subq $64+8,%rsp ++ andq $-32,%rsp ++ movdqa .Lsigma(%rip),%xmm0 ++ movdqu (%rcx),%xmm1 ++ movdqu 16(%rcx),%xmm2 ++ movdqu (%r8),%xmm3 ++ movdqa .Lrot16(%rip),%xmm6 ++ movdqa .Lrot24(%rip),%xmm7 ++ ++ movdqa %xmm0,0(%rsp) ++ movdqa %xmm1,16(%rsp) ++ movdqa %xmm2,32(%rsp) ++ movdqa %xmm3,48(%rsp) ++ movq $10,%r8 ++ jmp .Loop_ssse3 ++ ++.align 32 ++.Loop_outer_ssse3: ++ movdqa .Lone(%rip),%xmm3 ++ movdqa 0(%rsp),%xmm0 ++ movdqa 16(%rsp),%xmm1 ++ movdqa 32(%rsp),%xmm2 ++ paddd 48(%rsp),%xmm3 ++ movq $10,%r8 ++ movdqa %xmm3,48(%rsp) ++ jmp .Loop_ssse3 ++ ++.align 32 ++.Loop_ssse3: ++ paddd %xmm1,%xmm0 ++ pxor %xmm0,%xmm3 ++ pshufb %xmm6,%xmm3 ++ paddd %xmm3,%xmm2 ++ pxor %xmm2,%xmm1 ++ movdqa %xmm1,%xmm4 ++ psrld $20,%xmm1 ++ pslld $12,%xmm4 ++ por %xmm4,%xmm1 ++ paddd %xmm1,%xmm0 ++ pxor %xmm0,%xmm3 ++ pshufb %xmm7,%xmm3 ++ paddd %xmm3,%xmm2 ++ pxor %xmm2,%xmm1 ++ movdqa %xmm1,%xmm4 ++ psrld $25,%xmm1 ++ pslld $7,%xmm4 ++ por %xmm4,%xmm1 ++ pshufd $78,%xmm2,%xmm2 ++ pshufd $57,%xmm1,%xmm1 ++ pshufd $147,%xmm3,%xmm3 ++ nop ++ paddd %xmm1,%xmm0 ++ pxor %xmm0,%xmm3 ++ pshufb %xmm6,%xmm3 ++ paddd %xmm3,%xmm2 ++ pxor %xmm2,%xmm1 ++ movdqa %xmm1,%xmm4 ++ psrld $20,%xmm1 ++ pslld $12,%xmm4 ++ por %xmm4,%xmm1 ++ paddd %xmm1,%xmm0 ++ pxor %xmm0,%xmm3 ++ pshufb %xmm7,%xmm3 ++ paddd %xmm3,%xmm2 ++ pxor %xmm2,%xmm1 ++ movdqa %xmm1,%xmm4 ++ psrld $25,%xmm1 ++ pslld $7,%xmm4 ++ por %xmm4,%xmm1 ++ pshufd $78,%xmm2,%xmm2 ++ pshufd $147,%xmm1,%xmm1 ++ pshufd $57,%xmm3,%xmm3 ++ decq %r8 ++ jnz .Loop_ssse3 ++ paddd 0(%rsp),%xmm0 ++ paddd 16(%rsp),%xmm1 ++ paddd 32(%rsp),%xmm2 ++ paddd 48(%rsp),%xmm3 ++ ++ cmpq $64,%rdx ++ jb .Ltail_ssse3 ++ ++ movdqu 0(%rsi),%xmm4 ++ movdqu 16(%rsi),%xmm5 ++ pxor %xmm4,%xmm0 ++ movdqu 32(%rsi),%xmm4 ++ pxor %xmm5,%xmm1 ++ movdqu 48(%rsi),%xmm5 ++ leaq 64(%rsi),%rsi ++ pxor %xmm4,%xmm2 ++ pxor %xmm5,%xmm3 ++ ++ movdqu %xmm0,0(%rdi) ++ movdqu %xmm1,16(%rdi) ++ movdqu %xmm2,32(%rdi) ++ movdqu %xmm3,48(%rdi) ++ leaq 64(%rdi),%rdi ++ ++ subq $64,%rdx ++ jnz .Loop_outer_ssse3 ++ ++ jmp .Ldone_ssse3 ++ ++.align 16 ++.Ltail_ssse3: ++ movdqa %xmm0,0(%rsp) ++ movdqa %xmm1,16(%rsp) ++ movdqa %xmm2,32(%rsp) ++ movdqa %xmm3,48(%rsp) ++ xorq %r8,%r8 ++ ++.Loop_tail_ssse3: ++ movzbl (%rsi,%r8,1),%eax ++ movzbl (%rsp,%r8,1),%ecx ++ leaq 1(%r8),%r8 ++ xorl %ecx,%eax ++ movb %al,-1(%rdi,%r8,1) ++ decq %rdx ++ jnz .Loop_tail_ssse3 ++ ++.Ldone_ssse3: ++ leaq -8(%r10),%rsp ++ ++.Lssse3_epilogue: ++ ret ++ ++.align 32 ++.Lchacha20_4x: ++ leaq 8(%rsp),%r10 ++ ++.Lproceed4x: ++ subq $0x140+8,%rsp ++ andq $-32,%rsp ++ movdqa .Lsigma(%rip),%xmm11 ++ movdqu (%rcx),%xmm15 ++ movdqu 16(%rcx),%xmm7 ++ movdqu (%r8),%xmm3 ++ leaq 256(%rsp),%rcx ++ leaq .Lrot16(%rip),%r9 ++ leaq .Lrot24(%rip),%r11 ++ ++ pshufd $0x00,%xmm11,%xmm8 ++ pshufd $0x55,%xmm11,%xmm9 ++ movdqa %xmm8,64(%rsp) ++ pshufd $0xaa,%xmm11,%xmm10 ++ movdqa %xmm9,80(%rsp) ++ pshufd $0xff,%xmm11,%xmm11 ++ movdqa %xmm10,96(%rsp) ++ movdqa %xmm11,112(%rsp) ++ ++ pshufd $0x00,%xmm15,%xmm12 ++ pshufd $0x55,%xmm15,%xmm13 ++ movdqa %xmm12,128-256(%rcx) ++ pshufd $0xaa,%xmm15,%xmm14 ++ movdqa %xmm13,144-256(%rcx) ++ pshufd $0xff,%xmm15,%xmm15 ++ movdqa %xmm14,160-256(%rcx) ++ movdqa %xmm15,176-256(%rcx) ++ ++ pshufd $0x00,%xmm7,%xmm4 ++ pshufd $0x55,%xmm7,%xmm5 ++ movdqa %xmm4,192-256(%rcx) ++ pshufd $0xaa,%xmm7,%xmm6 ++ movdqa %xmm5,208-256(%rcx) ++ pshufd $0xff,%xmm7,%xmm7 ++ movdqa %xmm6,224-256(%rcx) ++ movdqa %xmm7,240-256(%rcx) ++ ++ pshufd $0x00,%xmm3,%xmm0 ++ pshufd $0x55,%xmm3,%xmm1 ++ paddd .Linc(%rip),%xmm0 ++ pshufd $0xaa,%xmm3,%xmm2 ++ movdqa %xmm1,272-256(%rcx) ++ pshufd $0xff,%xmm3,%xmm3 ++ movdqa %xmm2,288-256(%rcx) ++ movdqa %xmm3,304-256(%rcx) ++ ++ jmp .Loop_enter4x ++ ++.align 32 ++.Loop_outer4x: ++ movdqa 64(%rsp),%xmm8 ++ movdqa 80(%rsp),%xmm9 ++ movdqa 96(%rsp),%xmm10 ++ movdqa 112(%rsp),%xmm11 ++ movdqa 128-256(%rcx),%xmm12 ++ movdqa 144-256(%rcx),%xmm13 ++ movdqa 160-256(%rcx),%xmm14 ++ movdqa 176-256(%rcx),%xmm15 ++ movdqa 192-256(%rcx),%xmm4 ++ movdqa 208-256(%rcx),%xmm5 ++ movdqa 224-256(%rcx),%xmm6 ++ movdqa 240-256(%rcx),%xmm7 ++ movdqa 256-256(%rcx),%xmm0 ++ movdqa 272-256(%rcx),%xmm1 ++ movdqa 288-256(%rcx),%xmm2 ++ movdqa 304-256(%rcx),%xmm3 ++ paddd .Lfour(%rip),%xmm0 ++ ++.Loop_enter4x: ++ movdqa %xmm6,32(%rsp) ++ movdqa %xmm7,48(%rsp) ++ movdqa (%r9),%xmm7 ++ movl $10,%eax ++ movdqa %xmm0,256-256(%rcx) ++ jmp .Loop4x ++ ++.align 32 ++.Loop4x: ++ paddd %xmm12,%xmm8 ++ paddd %xmm13,%xmm9 ++ pxor %xmm8,%xmm0 ++ pxor %xmm9,%xmm1 ++ pshufb %xmm7,%xmm0 ++ pshufb %xmm7,%xmm1 ++ paddd %xmm0,%xmm4 ++ paddd %xmm1,%xmm5 ++ pxor %xmm4,%xmm12 ++ pxor %xmm5,%xmm13 ++ movdqa %xmm12,%xmm6 ++ pslld $12,%xmm12 ++ psrld $20,%xmm6 ++ movdqa %xmm13,%xmm7 ++ pslld $12,%xmm13 ++ por %xmm6,%xmm12 ++ psrld $20,%xmm7 ++ movdqa (%r11),%xmm6 ++ por %xmm7,%xmm13 ++ paddd %xmm12,%xmm8 ++ paddd %xmm13,%xmm9 ++ pxor %xmm8,%xmm0 ++ pxor %xmm9,%xmm1 ++ pshufb %xmm6,%xmm0 ++ pshufb %xmm6,%xmm1 ++ paddd %xmm0,%xmm4 ++ paddd %xmm1,%xmm5 ++ pxor %xmm4,%xmm12 ++ pxor %xmm5,%xmm13 ++ movdqa %xmm12,%xmm7 ++ pslld $7,%xmm12 ++ psrld $25,%xmm7 ++ movdqa %xmm13,%xmm6 ++ pslld $7,%xmm13 ++ por %xmm7,%xmm12 ++ psrld $25,%xmm6 ++ movdqa (%r9),%xmm7 ++ por %xmm6,%xmm13 ++ movdqa %xmm4,0(%rsp) ++ movdqa %xmm5,16(%rsp) ++ movdqa 32(%rsp),%xmm4 ++ movdqa 48(%rsp),%xmm5 ++ paddd %xmm14,%xmm10 ++ paddd %xmm15,%xmm11 ++ pxor %xmm10,%xmm2 ++ pxor %xmm11,%xmm3 ++ pshufb %xmm7,%xmm2 ++ pshufb %xmm7,%xmm3 ++ paddd %xmm2,%xmm4 ++ paddd %xmm3,%xmm5 ++ pxor %xmm4,%xmm14 ++ pxor %xmm5,%xmm15 ++ movdqa %xmm14,%xmm6 ++ pslld $12,%xmm14 ++ psrld $20,%xmm6 ++ movdqa %xmm15,%xmm7 ++ pslld $12,%xmm15 ++ por %xmm6,%xmm14 ++ psrld $20,%xmm7 ++ movdqa (%r11),%xmm6 ++ por %xmm7,%xmm15 ++ paddd %xmm14,%xmm10 ++ paddd %xmm15,%xmm11 ++ pxor %xmm10,%xmm2 ++ pxor %xmm11,%xmm3 ++ pshufb %xmm6,%xmm2 ++ pshufb %xmm6,%xmm3 ++ paddd %xmm2,%xmm4 ++ paddd %xmm3,%xmm5 ++ pxor %xmm4,%xmm14 ++ pxor %xmm5,%xmm15 ++ movdqa %xmm14,%xmm7 ++ pslld $7,%xmm14 ++ psrld $25,%xmm7 ++ movdqa %xmm15,%xmm6 ++ pslld $7,%xmm15 ++ por %xmm7,%xmm14 ++ psrld $25,%xmm6 ++ movdqa (%r9),%xmm7 ++ por %xmm6,%xmm15 ++ paddd %xmm13,%xmm8 ++ paddd %xmm14,%xmm9 ++ pxor %xmm8,%xmm3 ++ pxor %xmm9,%xmm0 ++ pshufb %xmm7,%xmm3 ++ pshufb %xmm7,%xmm0 ++ paddd %xmm3,%xmm4 ++ paddd %xmm0,%xmm5 ++ pxor %xmm4,%xmm13 ++ pxor %xmm5,%xmm14 ++ movdqa %xmm13,%xmm6 ++ pslld $12,%xmm13 ++ psrld $20,%xmm6 ++ movdqa %xmm14,%xmm7 ++ pslld $12,%xmm14 ++ por %xmm6,%xmm13 ++ psrld $20,%xmm7 ++ movdqa (%r11),%xmm6 ++ por %xmm7,%xmm14 ++ paddd %xmm13,%xmm8 ++ paddd %xmm14,%xmm9 ++ pxor %xmm8,%xmm3 ++ pxor %xmm9,%xmm0 ++ pshufb %xmm6,%xmm3 ++ pshufb %xmm6,%xmm0 ++ paddd %xmm3,%xmm4 ++ paddd %xmm0,%xmm5 ++ pxor %xmm4,%xmm13 ++ pxor %xmm5,%xmm14 ++ movdqa %xmm13,%xmm7 ++ pslld $7,%xmm13 ++ psrld $25,%xmm7 ++ movdqa %xmm14,%xmm6 ++ pslld $7,%xmm14 ++ por %xmm7,%xmm13 ++ psrld $25,%xmm6 ++ movdqa (%r9),%xmm7 ++ por %xmm6,%xmm14 ++ movdqa %xmm4,32(%rsp) ++ movdqa %xmm5,48(%rsp) ++ movdqa 0(%rsp),%xmm4 ++ movdqa 16(%rsp),%xmm5 ++ paddd %xmm15,%xmm10 ++ paddd %xmm12,%xmm11 ++ pxor %xmm10,%xmm1 ++ pxor %xmm11,%xmm2 ++ pshufb %xmm7,%xmm1 ++ pshufb %xmm7,%xmm2 ++ paddd %xmm1,%xmm4 ++ paddd %xmm2,%xmm5 ++ pxor %xmm4,%xmm15 ++ pxor %xmm5,%xmm12 ++ movdqa %xmm15,%xmm6 ++ pslld $12,%xmm15 ++ psrld $20,%xmm6 ++ movdqa %xmm12,%xmm7 ++ pslld $12,%xmm12 ++ por %xmm6,%xmm15 ++ psrld $20,%xmm7 ++ movdqa (%r11),%xmm6 ++ por %xmm7,%xmm12 ++ paddd %xmm15,%xmm10 ++ paddd %xmm12,%xmm11 ++ pxor %xmm10,%xmm1 ++ pxor %xmm11,%xmm2 ++ pshufb %xmm6,%xmm1 ++ pshufb %xmm6,%xmm2 ++ paddd %xmm1,%xmm4 ++ paddd %xmm2,%xmm5 ++ pxor %xmm4,%xmm15 ++ pxor %xmm5,%xmm12 ++ movdqa %xmm15,%xmm7 ++ pslld $7,%xmm15 ++ psrld $25,%xmm7 ++ movdqa %xmm12,%xmm6 ++ pslld $7,%xmm12 ++ por %xmm7,%xmm15 ++ psrld $25,%xmm6 ++ movdqa (%r9),%xmm7 ++ por %xmm6,%xmm12 ++ decl %eax ++ jnz .Loop4x ++ ++ paddd 64(%rsp),%xmm8 ++ paddd 80(%rsp),%xmm9 ++ paddd 96(%rsp),%xmm10 ++ paddd 112(%rsp),%xmm11 ++ ++ movdqa %xmm8,%xmm6 ++ punpckldq %xmm9,%xmm8 ++ movdqa %xmm10,%xmm7 ++ punpckldq %xmm11,%xmm10 ++ punpckhdq %xmm9,%xmm6 ++ punpckhdq %xmm11,%xmm7 ++ movdqa %xmm8,%xmm9 ++ punpcklqdq %xmm10,%xmm8 ++ movdqa %xmm6,%xmm11 ++ punpcklqdq %xmm7,%xmm6 ++ punpckhqdq %xmm10,%xmm9 ++ punpckhqdq %xmm7,%xmm11 ++ paddd 128-256(%rcx),%xmm12 ++ paddd 144-256(%rcx),%xmm13 ++ paddd 160-256(%rcx),%xmm14 ++ paddd 176-256(%rcx),%xmm15 ++ ++ movdqa %xmm8,0(%rsp) ++ movdqa %xmm9,16(%rsp) ++ movdqa 32(%rsp),%xmm8 ++ movdqa 48(%rsp),%xmm9 ++ ++ movdqa %xmm12,%xmm10 ++ punpckldq %xmm13,%xmm12 ++ movdqa %xmm14,%xmm7 ++ punpckldq %xmm15,%xmm14 ++ punpckhdq %xmm13,%xmm10 ++ punpckhdq %xmm15,%xmm7 ++ movdqa %xmm12,%xmm13 ++ punpcklqdq %xmm14,%xmm12 ++ movdqa %xmm10,%xmm15 ++ punpcklqdq %xmm7,%xmm10 ++ punpckhqdq %xmm14,%xmm13 ++ punpckhqdq %xmm7,%xmm15 ++ paddd 192-256(%rcx),%xmm4 ++ paddd 208-256(%rcx),%xmm5 ++ paddd 224-256(%rcx),%xmm8 ++ paddd 240-256(%rcx),%xmm9 ++ ++ movdqa %xmm6,32(%rsp) ++ movdqa %xmm11,48(%rsp) ++ ++ movdqa %xmm4,%xmm14 ++ punpckldq %xmm5,%xmm4 ++ movdqa %xmm8,%xmm7 ++ punpckldq %xmm9,%xmm8 ++ punpckhdq %xmm5,%xmm14 ++ punpckhdq %xmm9,%xmm7 ++ movdqa %xmm4,%xmm5 ++ punpcklqdq %xmm8,%xmm4 ++ movdqa %xmm14,%xmm9 ++ punpcklqdq %xmm7,%xmm14 ++ punpckhqdq %xmm8,%xmm5 ++ punpckhqdq %xmm7,%xmm9 ++ paddd 256-256(%rcx),%xmm0 ++ paddd 272-256(%rcx),%xmm1 ++ paddd 288-256(%rcx),%xmm2 ++ paddd 304-256(%rcx),%xmm3 ++ ++ movdqa %xmm0,%xmm8 ++ punpckldq %xmm1,%xmm0 ++ movdqa %xmm2,%xmm7 ++ punpckldq %xmm3,%xmm2 ++ punpckhdq %xmm1,%xmm8 ++ punpckhdq %xmm3,%xmm7 ++ movdqa %xmm0,%xmm1 ++ punpcklqdq %xmm2,%xmm0 ++ movdqa %xmm8,%xmm3 ++ punpcklqdq %xmm7,%xmm8 ++ punpckhqdq %xmm2,%xmm1 ++ punpckhqdq %xmm7,%xmm3 ++ cmpq $256,%rdx ++ jb .Ltail4x ++ ++ movdqu 0(%rsi),%xmm6 ++ movdqu 16(%rsi),%xmm11 ++ movdqu 32(%rsi),%xmm2 ++ movdqu 48(%rsi),%xmm7 ++ pxor 0(%rsp),%xmm6 ++ pxor %xmm12,%xmm11 ++ pxor %xmm4,%xmm2 ++ pxor %xmm0,%xmm7 ++ ++ movdqu %xmm6,0(%rdi) ++ movdqu 64(%rsi),%xmm6 ++ movdqu %xmm11,16(%rdi) ++ movdqu 80(%rsi),%xmm11 ++ movdqu %xmm2,32(%rdi) ++ movdqu 96(%rsi),%xmm2 ++ movdqu %xmm7,48(%rdi) ++ movdqu 112(%rsi),%xmm7 ++ leaq 128(%rsi),%rsi ++ pxor 16(%rsp),%xmm6 ++ pxor %xmm13,%xmm11 ++ pxor %xmm5,%xmm2 ++ pxor %xmm1,%xmm7 ++ ++ movdqu %xmm6,64(%rdi) ++ movdqu 0(%rsi),%xmm6 ++ movdqu %xmm11,80(%rdi) ++ movdqu 16(%rsi),%xmm11 ++ movdqu %xmm2,96(%rdi) ++ movdqu 32(%rsi),%xmm2 ++ movdqu %xmm7,112(%rdi) ++ leaq 128(%rdi),%rdi ++ movdqu 48(%rsi),%xmm7 ++ pxor 32(%rsp),%xmm6 ++ pxor %xmm10,%xmm11 ++ pxor %xmm14,%xmm2 ++ pxor %xmm8,%xmm7 ++ ++ movdqu %xmm6,0(%rdi) ++ movdqu 64(%rsi),%xmm6 ++ movdqu %xmm11,16(%rdi) ++ movdqu 80(%rsi),%xmm11 ++ movdqu %xmm2,32(%rdi) ++ movdqu 96(%rsi),%xmm2 ++ movdqu %xmm7,48(%rdi) ++ movdqu 112(%rsi),%xmm7 ++ leaq 128(%rsi),%rsi ++ pxor 48(%rsp),%xmm6 ++ pxor %xmm15,%xmm11 ++ pxor %xmm9,%xmm2 ++ pxor %xmm3,%xmm7 ++ movdqu %xmm6,64(%rdi) ++ movdqu %xmm11,80(%rdi) ++ movdqu %xmm2,96(%rdi) ++ movdqu %xmm7,112(%rdi) ++ leaq 128(%rdi),%rdi ++ ++ subq $256,%rdx ++ jnz .Loop_outer4x ++ ++ jmp .Ldone4x ++ ++.Ltail4x: ++ cmpq $192,%rdx ++ jae .L192_or_more4x ++ cmpq $128,%rdx ++ jae .L128_or_more4x ++ cmpq $64,%rdx ++ jae .L64_or_more4x ++ ++ ++ xorq %r9,%r9 ++ ++ movdqa %xmm12,16(%rsp) ++ movdqa %xmm4,32(%rsp) ++ movdqa %xmm0,48(%rsp) ++ jmp .Loop_tail4x ++ ++.align 32 ++.L64_or_more4x: ++ movdqu 0(%rsi),%xmm6 ++ movdqu 16(%rsi),%xmm11 ++ movdqu 32(%rsi),%xmm2 ++ movdqu 48(%rsi),%xmm7 ++ pxor 0(%rsp),%xmm6 ++ pxor %xmm12,%xmm11 ++ pxor %xmm4,%xmm2 ++ pxor %xmm0,%xmm7 ++ movdqu %xmm6,0(%rdi) ++ movdqu %xmm11,16(%rdi) ++ movdqu %xmm2,32(%rdi) ++ movdqu %xmm7,48(%rdi) ++ je .Ldone4x ++ ++ movdqa 16(%rsp),%xmm6 ++ leaq 64(%rsi),%rsi ++ xorq %r9,%r9 ++ movdqa %xmm6,0(%rsp) ++ movdqa %xmm13,16(%rsp) ++ leaq 64(%rdi),%rdi ++ movdqa %xmm5,32(%rsp) ++ subq $64,%rdx ++ movdqa %xmm1,48(%rsp) ++ jmp .Loop_tail4x ++ ++.align 32 ++.L128_or_more4x: ++ movdqu 0(%rsi),%xmm6 ++ movdqu 16(%rsi),%xmm11 ++ movdqu 32(%rsi),%xmm2 ++ movdqu 48(%rsi),%xmm7 ++ pxor 0(%rsp),%xmm6 ++ pxor %xmm12,%xmm11 ++ pxor %xmm4,%xmm2 ++ pxor %xmm0,%xmm7 ++ ++ movdqu %xmm6,0(%rdi) ++ movdqu 64(%rsi),%xmm6 ++ movdqu %xmm11,16(%rdi) ++ movdqu 80(%rsi),%xmm11 ++ movdqu %xmm2,32(%rdi) ++ movdqu 96(%rsi),%xmm2 ++ movdqu %xmm7,48(%rdi) ++ movdqu 112(%rsi),%xmm7 ++ pxor 16(%rsp),%xmm6 ++ pxor %xmm13,%xmm11 ++ pxor %xmm5,%xmm2 ++ pxor %xmm1,%xmm7 ++ movdqu %xmm6,64(%rdi) ++ movdqu %xmm11,80(%rdi) ++ movdqu %xmm2,96(%rdi) ++ movdqu %xmm7,112(%rdi) ++ je .Ldone4x ++ ++ movdqa 32(%rsp),%xmm6 ++ leaq 128(%rsi),%rsi ++ xorq %r9,%r9 ++ movdqa %xmm6,0(%rsp) ++ movdqa %xmm10,16(%rsp) ++ leaq 128(%rdi),%rdi ++ movdqa %xmm14,32(%rsp) ++ subq $128,%rdx ++ movdqa %xmm8,48(%rsp) ++ jmp .Loop_tail4x ++ ++.align 32 ++.L192_or_more4x: ++ movdqu 0(%rsi),%xmm6 ++ movdqu 16(%rsi),%xmm11 ++ movdqu 32(%rsi),%xmm2 ++ movdqu 48(%rsi),%xmm7 ++ pxor 0(%rsp),%xmm6 ++ pxor %xmm12,%xmm11 ++ pxor %xmm4,%xmm2 ++ pxor %xmm0,%xmm7 ++ ++ movdqu %xmm6,0(%rdi) ++ movdqu 64(%rsi),%xmm6 ++ movdqu %xmm11,16(%rdi) ++ movdqu 80(%rsi),%xmm11 ++ movdqu %xmm2,32(%rdi) ++ movdqu 96(%rsi),%xmm2 ++ movdqu %xmm7,48(%rdi) ++ movdqu 112(%rsi),%xmm7 ++ leaq 128(%rsi),%rsi ++ pxor 16(%rsp),%xmm6 ++ pxor %xmm13,%xmm11 ++ pxor %xmm5,%xmm2 ++ pxor %xmm1,%xmm7 ++ ++ movdqu %xmm6,64(%rdi) ++ movdqu 0(%rsi),%xmm6 ++ movdqu %xmm11,80(%rdi) ++ movdqu 16(%rsi),%xmm11 ++ movdqu %xmm2,96(%rdi) ++ movdqu 32(%rsi),%xmm2 ++ movdqu %xmm7,112(%rdi) ++ leaq 128(%rdi),%rdi ++ movdqu 48(%rsi),%xmm7 ++ pxor 32(%rsp),%xmm6 ++ pxor %xmm10,%xmm11 ++ pxor %xmm14,%xmm2 ++ pxor %xmm8,%xmm7 ++ movdqu %xmm6,0(%rdi) ++ movdqu %xmm11,16(%rdi) ++ movdqu %xmm2,32(%rdi) ++ movdqu %xmm7,48(%rdi) ++ je .Ldone4x ++ ++ movdqa 48(%rsp),%xmm6 ++ leaq 64(%rsi),%rsi ++ xorq %r9,%r9 ++ movdqa %xmm6,0(%rsp) ++ movdqa %xmm15,16(%rsp) ++ leaq 64(%rdi),%rdi ++ movdqa %xmm9,32(%rsp) ++ subq $192,%rdx ++ movdqa %xmm3,48(%rsp) ++ ++.Loop_tail4x: ++ movzbl (%rsi,%r9,1),%eax ++ movzbl (%rsp,%r9,1),%ecx ++ leaq 1(%r9),%r9 ++ xorl %ecx,%eax ++ movb %al,-1(%rdi,%r9,1) ++ decq %rdx ++ jnz .Loop_tail4x ++ ++.Ldone4x: ++ leaq -8(%r10),%rsp ++ ++.L4x_epilogue: ++ ret ++ENDPROC(chacha20_ssse3) ++#endif /* CONFIG_AS_SSSE3 */ ++ ++#ifdef CONFIG_AS_AVX2 ++.align 32 ++ENTRY(chacha20_avx2) ++.Lchacha20_avx2: ++ cmpq $0,%rdx ++ je .L8x_epilogue ++ leaq 8(%rsp),%r10 ++ ++ subq $0x280+8,%rsp ++ andq $-32,%rsp ++ vzeroupper ++ ++ vbroadcasti128 .Lsigma(%rip),%ymm11 ++ vbroadcasti128 (%rcx),%ymm3 ++ vbroadcasti128 16(%rcx),%ymm15 ++ vbroadcasti128 (%r8),%ymm7 ++ leaq 256(%rsp),%rcx ++ leaq 512(%rsp),%rax ++ leaq .Lrot16(%rip),%r9 ++ leaq .Lrot24(%rip),%r11 ++ ++ vpshufd $0x00,%ymm11,%ymm8 ++ vpshufd $0x55,%ymm11,%ymm9 ++ vmovdqa %ymm8,128-256(%rcx) ++ vpshufd $0xaa,%ymm11,%ymm10 ++ vmovdqa %ymm9,160-256(%rcx) ++ vpshufd $0xff,%ymm11,%ymm11 ++ vmovdqa %ymm10,192-256(%rcx) ++ vmovdqa %ymm11,224-256(%rcx) ++ ++ vpshufd $0x00,%ymm3,%ymm0 ++ vpshufd $0x55,%ymm3,%ymm1 ++ vmovdqa %ymm0,256-256(%rcx) ++ vpshufd $0xaa,%ymm3,%ymm2 ++ vmovdqa %ymm1,288-256(%rcx) ++ vpshufd $0xff,%ymm3,%ymm3 ++ vmovdqa %ymm2,320-256(%rcx) ++ vmovdqa %ymm3,352-256(%rcx) ++ ++ vpshufd $0x00,%ymm15,%ymm12 ++ vpshufd $0x55,%ymm15,%ymm13 ++ vmovdqa %ymm12,384-512(%rax) ++ vpshufd $0xaa,%ymm15,%ymm14 ++ vmovdqa %ymm13,416-512(%rax) ++ vpshufd $0xff,%ymm15,%ymm15 ++ vmovdqa %ymm14,448-512(%rax) ++ vmovdqa %ymm15,480-512(%rax) ++ ++ vpshufd $0x00,%ymm7,%ymm4 ++ vpshufd $0x55,%ymm7,%ymm5 ++ vpaddd .Lincy(%rip),%ymm4,%ymm4 ++ vpshufd $0xaa,%ymm7,%ymm6 ++ vmovdqa %ymm5,544-512(%rax) ++ vpshufd $0xff,%ymm7,%ymm7 ++ vmovdqa %ymm6,576-512(%rax) ++ vmovdqa %ymm7,608-512(%rax) ++ ++ jmp .Loop_enter8x ++ ++.align 32 ++.Loop_outer8x: ++ vmovdqa 128-256(%rcx),%ymm8 ++ vmovdqa 160-256(%rcx),%ymm9 ++ vmovdqa 192-256(%rcx),%ymm10 ++ vmovdqa 224-256(%rcx),%ymm11 ++ vmovdqa 256-256(%rcx),%ymm0 ++ vmovdqa 288-256(%rcx),%ymm1 ++ vmovdqa 320-256(%rcx),%ymm2 ++ vmovdqa 352-256(%rcx),%ymm3 ++ vmovdqa 384-512(%rax),%ymm12 ++ vmovdqa 416-512(%rax),%ymm13 ++ vmovdqa 448-512(%rax),%ymm14 ++ vmovdqa 480-512(%rax),%ymm15 ++ vmovdqa 512-512(%rax),%ymm4 ++ vmovdqa 544-512(%rax),%ymm5 ++ vmovdqa 576-512(%rax),%ymm6 ++ vmovdqa 608-512(%rax),%ymm7 ++ vpaddd .Leight(%rip),%ymm4,%ymm4 ++ ++.Loop_enter8x: ++ vmovdqa %ymm14,64(%rsp) ++ vmovdqa %ymm15,96(%rsp) ++ vbroadcasti128 (%r9),%ymm15 ++ vmovdqa %ymm4,512-512(%rax) ++ movl $10,%eax ++ jmp .Loop8x ++ ++.align 32 ++.Loop8x: ++ vpaddd %ymm0,%ymm8,%ymm8 ++ vpxor %ymm4,%ymm8,%ymm4 ++ vpshufb %ymm15,%ymm4,%ymm4 ++ vpaddd %ymm1,%ymm9,%ymm9 ++ vpxor %ymm5,%ymm9,%ymm5 ++ vpshufb %ymm15,%ymm5,%ymm5 ++ vpaddd %ymm4,%ymm12,%ymm12 ++ vpxor %ymm0,%ymm12,%ymm0 ++ vpslld $12,%ymm0,%ymm14 ++ vpsrld $20,%ymm0,%ymm0 ++ vpor %ymm0,%ymm14,%ymm0 ++ vbroadcasti128 (%r11),%ymm14 ++ vpaddd %ymm5,%ymm13,%ymm13 ++ vpxor %ymm1,%ymm13,%ymm1 ++ vpslld $12,%ymm1,%ymm15 ++ vpsrld $20,%ymm1,%ymm1 ++ vpor %ymm1,%ymm15,%ymm1 ++ vpaddd %ymm0,%ymm8,%ymm8 ++ vpxor %ymm4,%ymm8,%ymm4 ++ vpshufb %ymm14,%ymm4,%ymm4 ++ vpaddd %ymm1,%ymm9,%ymm9 ++ vpxor %ymm5,%ymm9,%ymm5 ++ vpshufb %ymm14,%ymm5,%ymm5 ++ vpaddd %ymm4,%ymm12,%ymm12 ++ vpxor %ymm0,%ymm12,%ymm0 ++ vpslld $7,%ymm0,%ymm15 ++ vpsrld $25,%ymm0,%ymm0 ++ vpor %ymm0,%ymm15,%ymm0 ++ vbroadcasti128 (%r9),%ymm15 ++ vpaddd %ymm5,%ymm13,%ymm13 ++ vpxor %ymm1,%ymm13,%ymm1 ++ vpslld $7,%ymm1,%ymm14 ++ vpsrld $25,%ymm1,%ymm1 ++ vpor %ymm1,%ymm14,%ymm1 ++ vmovdqa %ymm12,0(%rsp) ++ vmovdqa %ymm13,32(%rsp) ++ vmovdqa 64(%rsp),%ymm12 ++ vmovdqa 96(%rsp),%ymm13 ++ vpaddd %ymm2,%ymm10,%ymm10 ++ vpxor %ymm6,%ymm10,%ymm6 ++ vpshufb %ymm15,%ymm6,%ymm6 ++ vpaddd %ymm3,%ymm11,%ymm11 ++ vpxor %ymm7,%ymm11,%ymm7 ++ vpshufb %ymm15,%ymm7,%ymm7 ++ vpaddd %ymm6,%ymm12,%ymm12 ++ vpxor %ymm2,%ymm12,%ymm2 ++ vpslld $12,%ymm2,%ymm14 ++ vpsrld $20,%ymm2,%ymm2 ++ vpor %ymm2,%ymm14,%ymm2 ++ vbroadcasti128 (%r11),%ymm14 ++ vpaddd %ymm7,%ymm13,%ymm13 ++ vpxor %ymm3,%ymm13,%ymm3 ++ vpslld $12,%ymm3,%ymm15 ++ vpsrld $20,%ymm3,%ymm3 ++ vpor %ymm3,%ymm15,%ymm3 ++ vpaddd %ymm2,%ymm10,%ymm10 ++ vpxor %ymm6,%ymm10,%ymm6 ++ vpshufb %ymm14,%ymm6,%ymm6 ++ vpaddd %ymm3,%ymm11,%ymm11 ++ vpxor %ymm7,%ymm11,%ymm7 ++ vpshufb %ymm14,%ymm7,%ymm7 ++ vpaddd %ymm6,%ymm12,%ymm12 ++ vpxor %ymm2,%ymm12,%ymm2 ++ vpslld $7,%ymm2,%ymm15 ++ vpsrld $25,%ymm2,%ymm2 ++ vpor %ymm2,%ymm15,%ymm2 ++ vbroadcasti128 (%r9),%ymm15 ++ vpaddd %ymm7,%ymm13,%ymm13 ++ vpxor %ymm3,%ymm13,%ymm3 ++ vpslld $7,%ymm3,%ymm14 ++ vpsrld $25,%ymm3,%ymm3 ++ vpor %ymm3,%ymm14,%ymm3 ++ vpaddd %ymm1,%ymm8,%ymm8 ++ vpxor %ymm7,%ymm8,%ymm7 ++ vpshufb %ymm15,%ymm7,%ymm7 ++ vpaddd %ymm2,%ymm9,%ymm9 ++ vpxor %ymm4,%ymm9,%ymm4 ++ vpshufb %ymm15,%ymm4,%ymm4 ++ vpaddd %ymm7,%ymm12,%ymm12 ++ vpxor %ymm1,%ymm12,%ymm1 ++ vpslld $12,%ymm1,%ymm14 ++ vpsrld $20,%ymm1,%ymm1 ++ vpor %ymm1,%ymm14,%ymm1 ++ vbroadcasti128 (%r11),%ymm14 ++ vpaddd %ymm4,%ymm13,%ymm13 ++ vpxor %ymm2,%ymm13,%ymm2 ++ vpslld $12,%ymm2,%ymm15 ++ vpsrld $20,%ymm2,%ymm2 ++ vpor %ymm2,%ymm15,%ymm2 ++ vpaddd %ymm1,%ymm8,%ymm8 ++ vpxor %ymm7,%ymm8,%ymm7 ++ vpshufb %ymm14,%ymm7,%ymm7 ++ vpaddd %ymm2,%ymm9,%ymm9 ++ vpxor %ymm4,%ymm9,%ymm4 ++ vpshufb %ymm14,%ymm4,%ymm4 ++ vpaddd %ymm7,%ymm12,%ymm12 ++ vpxor %ymm1,%ymm12,%ymm1 ++ vpslld $7,%ymm1,%ymm15 ++ vpsrld $25,%ymm1,%ymm1 ++ vpor %ymm1,%ymm15,%ymm1 ++ vbroadcasti128 (%r9),%ymm15 ++ vpaddd %ymm4,%ymm13,%ymm13 ++ vpxor %ymm2,%ymm13,%ymm2 ++ vpslld $7,%ymm2,%ymm14 ++ vpsrld $25,%ymm2,%ymm2 ++ vpor %ymm2,%ymm14,%ymm2 ++ vmovdqa %ymm12,64(%rsp) ++ vmovdqa %ymm13,96(%rsp) ++ vmovdqa 0(%rsp),%ymm12 ++ vmovdqa 32(%rsp),%ymm13 ++ vpaddd %ymm3,%ymm10,%ymm10 ++ vpxor %ymm5,%ymm10,%ymm5 ++ vpshufb %ymm15,%ymm5,%ymm5 ++ vpaddd %ymm0,%ymm11,%ymm11 ++ vpxor %ymm6,%ymm11,%ymm6 ++ vpshufb %ymm15,%ymm6,%ymm6 ++ vpaddd %ymm5,%ymm12,%ymm12 ++ vpxor %ymm3,%ymm12,%ymm3 ++ vpslld $12,%ymm3,%ymm14 ++ vpsrld $20,%ymm3,%ymm3 ++ vpor %ymm3,%ymm14,%ymm3 ++ vbroadcasti128 (%r11),%ymm14 ++ vpaddd %ymm6,%ymm13,%ymm13 ++ vpxor %ymm0,%ymm13,%ymm0 ++ vpslld $12,%ymm0,%ymm15 ++ vpsrld $20,%ymm0,%ymm0 ++ vpor %ymm0,%ymm15,%ymm0 ++ vpaddd %ymm3,%ymm10,%ymm10 ++ vpxor %ymm5,%ymm10,%ymm5 ++ vpshufb %ymm14,%ymm5,%ymm5 ++ vpaddd %ymm0,%ymm11,%ymm11 ++ vpxor %ymm6,%ymm11,%ymm6 ++ vpshufb %ymm14,%ymm6,%ymm6 ++ vpaddd %ymm5,%ymm12,%ymm12 ++ vpxor %ymm3,%ymm12,%ymm3 ++ vpslld $7,%ymm3,%ymm15 ++ vpsrld $25,%ymm3,%ymm3 ++ vpor %ymm3,%ymm15,%ymm3 ++ vbroadcasti128 (%r9),%ymm15 ++ vpaddd %ymm6,%ymm13,%ymm13 ++ vpxor %ymm0,%ymm13,%ymm0 ++ vpslld $7,%ymm0,%ymm14 ++ vpsrld $25,%ymm0,%ymm0 ++ vpor %ymm0,%ymm14,%ymm0 ++ decl %eax ++ jnz .Loop8x ++ ++ leaq 512(%rsp),%rax ++ vpaddd 128-256(%rcx),%ymm8,%ymm8 ++ vpaddd 160-256(%rcx),%ymm9,%ymm9 ++ vpaddd 192-256(%rcx),%ymm10,%ymm10 ++ vpaddd 224-256(%rcx),%ymm11,%ymm11 ++ ++ vpunpckldq %ymm9,%ymm8,%ymm14 ++ vpunpckldq %ymm11,%ymm10,%ymm15 ++ vpunpckhdq %ymm9,%ymm8,%ymm8 ++ vpunpckhdq %ymm11,%ymm10,%ymm10 ++ vpunpcklqdq %ymm15,%ymm14,%ymm9 ++ vpunpckhqdq %ymm15,%ymm14,%ymm14 ++ vpunpcklqdq %ymm10,%ymm8,%ymm11 ++ vpunpckhqdq %ymm10,%ymm8,%ymm8 ++ vpaddd 256-256(%rcx),%ymm0,%ymm0 ++ vpaddd 288-256(%rcx),%ymm1,%ymm1 ++ vpaddd 320-256(%rcx),%ymm2,%ymm2 ++ vpaddd 352-256(%rcx),%ymm3,%ymm3 ++ ++ vpunpckldq %ymm1,%ymm0,%ymm10 ++ vpunpckldq %ymm3,%ymm2,%ymm15 ++ vpunpckhdq %ymm1,%ymm0,%ymm0 ++ vpunpckhdq %ymm3,%ymm2,%ymm2 ++ vpunpcklqdq %ymm15,%ymm10,%ymm1 ++ vpunpckhqdq %ymm15,%ymm10,%ymm10 ++ vpunpcklqdq %ymm2,%ymm0,%ymm3 ++ vpunpckhqdq %ymm2,%ymm0,%ymm0 ++ vperm2i128 $0x20,%ymm1,%ymm9,%ymm15 ++ vperm2i128 $0x31,%ymm1,%ymm9,%ymm1 ++ vperm2i128 $0x20,%ymm10,%ymm14,%ymm9 ++ vperm2i128 $0x31,%ymm10,%ymm14,%ymm10 ++ vperm2i128 $0x20,%ymm3,%ymm11,%ymm14 ++ vperm2i128 $0x31,%ymm3,%ymm11,%ymm3 ++ vperm2i128 $0x20,%ymm0,%ymm8,%ymm11 ++ vperm2i128 $0x31,%ymm0,%ymm8,%ymm0 ++ vmovdqa %ymm15,0(%rsp) ++ vmovdqa %ymm9,32(%rsp) ++ vmovdqa 64(%rsp),%ymm15 ++ vmovdqa 96(%rsp),%ymm9 ++ ++ vpaddd 384-512(%rax),%ymm12,%ymm12 ++ vpaddd 416-512(%rax),%ymm13,%ymm13 ++ vpaddd 448-512(%rax),%ymm15,%ymm15 ++ vpaddd 480-512(%rax),%ymm9,%ymm9 ++ ++ vpunpckldq %ymm13,%ymm12,%ymm2 ++ vpunpckldq %ymm9,%ymm15,%ymm8 ++ vpunpckhdq %ymm13,%ymm12,%ymm12 ++ vpunpckhdq %ymm9,%ymm15,%ymm15 ++ vpunpcklqdq %ymm8,%ymm2,%ymm13 ++ vpunpckhqdq %ymm8,%ymm2,%ymm2 ++ vpunpcklqdq %ymm15,%ymm12,%ymm9 ++ vpunpckhqdq %ymm15,%ymm12,%ymm12 ++ vpaddd 512-512(%rax),%ymm4,%ymm4 ++ vpaddd 544-512(%rax),%ymm5,%ymm5 ++ vpaddd 576-512(%rax),%ymm6,%ymm6 ++ vpaddd 608-512(%rax),%ymm7,%ymm7 ++ ++ vpunpckldq %ymm5,%ymm4,%ymm15 ++ vpunpckldq %ymm7,%ymm6,%ymm8 ++ vpunpckhdq %ymm5,%ymm4,%ymm4 ++ vpunpckhdq %ymm7,%ymm6,%ymm6 ++ vpunpcklqdq %ymm8,%ymm15,%ymm5 ++ vpunpckhqdq %ymm8,%ymm15,%ymm15 ++ vpunpcklqdq %ymm6,%ymm4,%ymm7 ++ vpunpckhqdq %ymm6,%ymm4,%ymm4 ++ vperm2i128 $0x20,%ymm5,%ymm13,%ymm8 ++ vperm2i128 $0x31,%ymm5,%ymm13,%ymm5 ++ vperm2i128 $0x20,%ymm15,%ymm2,%ymm13 ++ vperm2i128 $0x31,%ymm15,%ymm2,%ymm15 ++ vperm2i128 $0x20,%ymm7,%ymm9,%ymm2 ++ vperm2i128 $0x31,%ymm7,%ymm9,%ymm7 ++ vperm2i128 $0x20,%ymm4,%ymm12,%ymm9 ++ vperm2i128 $0x31,%ymm4,%ymm12,%ymm4 ++ vmovdqa 0(%rsp),%ymm6 ++ vmovdqa 32(%rsp),%ymm12 ++ ++ cmpq $512,%rdx ++ jb .Ltail8x ++ ++ vpxor 0(%rsi),%ymm6,%ymm6 ++ vpxor 32(%rsi),%ymm8,%ymm8 ++ vpxor 64(%rsi),%ymm1,%ymm1 ++ vpxor 96(%rsi),%ymm5,%ymm5 ++ leaq 128(%rsi),%rsi ++ vmovdqu %ymm6,0(%rdi) ++ vmovdqu %ymm8,32(%rdi) ++ vmovdqu %ymm1,64(%rdi) ++ vmovdqu %ymm5,96(%rdi) ++ leaq 128(%rdi),%rdi ++ ++ vpxor 0(%rsi),%ymm12,%ymm12 ++ vpxor 32(%rsi),%ymm13,%ymm13 ++ vpxor 64(%rsi),%ymm10,%ymm10 ++ vpxor 96(%rsi),%ymm15,%ymm15 ++ leaq 128(%rsi),%rsi ++ vmovdqu %ymm12,0(%rdi) ++ vmovdqu %ymm13,32(%rdi) ++ vmovdqu %ymm10,64(%rdi) ++ vmovdqu %ymm15,96(%rdi) ++ leaq 128(%rdi),%rdi ++ ++ vpxor 0(%rsi),%ymm14,%ymm14 ++ vpxor 32(%rsi),%ymm2,%ymm2 ++ vpxor 64(%rsi),%ymm3,%ymm3 ++ vpxor 96(%rsi),%ymm7,%ymm7 ++ leaq 128(%rsi),%rsi ++ vmovdqu %ymm14,0(%rdi) ++ vmovdqu %ymm2,32(%rdi) ++ vmovdqu %ymm3,64(%rdi) ++ vmovdqu %ymm7,96(%rdi) ++ leaq 128(%rdi),%rdi ++ ++ vpxor 0(%rsi),%ymm11,%ymm11 ++ vpxor 32(%rsi),%ymm9,%ymm9 ++ vpxor 64(%rsi),%ymm0,%ymm0 ++ vpxor 96(%rsi),%ymm4,%ymm4 ++ leaq 128(%rsi),%rsi ++ vmovdqu %ymm11,0(%rdi) ++ vmovdqu %ymm9,32(%rdi) ++ vmovdqu %ymm0,64(%rdi) ++ vmovdqu %ymm4,96(%rdi) ++ leaq 128(%rdi),%rdi ++ ++ subq $512,%rdx ++ jnz .Loop_outer8x ++ ++ jmp .Ldone8x ++ ++.Ltail8x: ++ cmpq $448,%rdx ++ jae .L448_or_more8x ++ cmpq $384,%rdx ++ jae .L384_or_more8x ++ cmpq $320,%rdx ++ jae .L320_or_more8x ++ cmpq $256,%rdx ++ jae .L256_or_more8x ++ cmpq $192,%rdx ++ jae .L192_or_more8x ++ cmpq $128,%rdx ++ jae .L128_or_more8x ++ cmpq $64,%rdx ++ jae .L64_or_more8x ++ ++ xorq %r9,%r9 ++ vmovdqa %ymm6,0(%rsp) ++ vmovdqa %ymm8,32(%rsp) ++ jmp .Loop_tail8x ++ ++.align 32 ++.L64_or_more8x: ++ vpxor 0(%rsi),%ymm6,%ymm6 ++ vpxor 32(%rsi),%ymm8,%ymm8 ++ vmovdqu %ymm6,0(%rdi) ++ vmovdqu %ymm8,32(%rdi) ++ je .Ldone8x ++ ++ leaq 64(%rsi),%rsi ++ xorq %r9,%r9 ++ vmovdqa %ymm1,0(%rsp) ++ leaq 64(%rdi),%rdi ++ subq $64,%rdx ++ vmovdqa %ymm5,32(%rsp) ++ jmp .Loop_tail8x ++ ++.align 32 ++.L128_or_more8x: ++ vpxor 0(%rsi),%ymm6,%ymm6 ++ vpxor 32(%rsi),%ymm8,%ymm8 ++ vpxor 64(%rsi),%ymm1,%ymm1 ++ vpxor 96(%rsi),%ymm5,%ymm5 ++ vmovdqu %ymm6,0(%rdi) ++ vmovdqu %ymm8,32(%rdi) ++ vmovdqu %ymm1,64(%rdi) ++ vmovdqu %ymm5,96(%rdi) ++ je .Ldone8x ++ ++ leaq 128(%rsi),%rsi ++ xorq %r9,%r9 ++ vmovdqa %ymm12,0(%rsp) ++ leaq 128(%rdi),%rdi ++ subq $128,%rdx ++ vmovdqa %ymm13,32(%rsp) ++ jmp .Loop_tail8x ++ ++.align 32 ++.L192_or_more8x: ++ vpxor 0(%rsi),%ymm6,%ymm6 ++ vpxor 32(%rsi),%ymm8,%ymm8 ++ vpxor 64(%rsi),%ymm1,%ymm1 ++ vpxor 96(%rsi),%ymm5,%ymm5 ++ vpxor 128(%rsi),%ymm12,%ymm12 ++ vpxor 160(%rsi),%ymm13,%ymm13 ++ vmovdqu %ymm6,0(%rdi) ++ vmovdqu %ymm8,32(%rdi) ++ vmovdqu %ymm1,64(%rdi) ++ vmovdqu %ymm5,96(%rdi) ++ vmovdqu %ymm12,128(%rdi) ++ vmovdqu %ymm13,160(%rdi) ++ je .Ldone8x ++ ++ leaq 192(%rsi),%rsi ++ xorq %r9,%r9 ++ vmovdqa %ymm10,0(%rsp) ++ leaq 192(%rdi),%rdi ++ subq $192,%rdx ++ vmovdqa %ymm15,32(%rsp) ++ jmp .Loop_tail8x ++ ++.align 32 ++.L256_or_more8x: ++ vpxor 0(%rsi),%ymm6,%ymm6 ++ vpxor 32(%rsi),%ymm8,%ymm8 ++ vpxor 64(%rsi),%ymm1,%ymm1 ++ vpxor 96(%rsi),%ymm5,%ymm5 ++ vpxor 128(%rsi),%ymm12,%ymm12 ++ vpxor 160(%rsi),%ymm13,%ymm13 ++ vpxor 192(%rsi),%ymm10,%ymm10 ++ vpxor 224(%rsi),%ymm15,%ymm15 ++ vmovdqu %ymm6,0(%rdi) ++ vmovdqu %ymm8,32(%rdi) ++ vmovdqu %ymm1,64(%rdi) ++ vmovdqu %ymm5,96(%rdi) ++ vmovdqu %ymm12,128(%rdi) ++ vmovdqu %ymm13,160(%rdi) ++ vmovdqu %ymm10,192(%rdi) ++ vmovdqu %ymm15,224(%rdi) ++ je .Ldone8x ++ ++ leaq 256(%rsi),%rsi ++ xorq %r9,%r9 ++ vmovdqa %ymm14,0(%rsp) ++ leaq 256(%rdi),%rdi ++ subq $256,%rdx ++ vmovdqa %ymm2,32(%rsp) ++ jmp .Loop_tail8x ++ ++.align 32 ++.L320_or_more8x: ++ vpxor 0(%rsi),%ymm6,%ymm6 ++ vpxor 32(%rsi),%ymm8,%ymm8 ++ vpxor 64(%rsi),%ymm1,%ymm1 ++ vpxor 96(%rsi),%ymm5,%ymm5 ++ vpxor 128(%rsi),%ymm12,%ymm12 ++ vpxor 160(%rsi),%ymm13,%ymm13 ++ vpxor 192(%rsi),%ymm10,%ymm10 ++ vpxor 224(%rsi),%ymm15,%ymm15 ++ vpxor 256(%rsi),%ymm14,%ymm14 ++ vpxor 288(%rsi),%ymm2,%ymm2 ++ vmovdqu %ymm6,0(%rdi) ++ vmovdqu %ymm8,32(%rdi) ++ vmovdqu %ymm1,64(%rdi) ++ vmovdqu %ymm5,96(%rdi) ++ vmovdqu %ymm12,128(%rdi) ++ vmovdqu %ymm13,160(%rdi) ++ vmovdqu %ymm10,192(%rdi) ++ vmovdqu %ymm15,224(%rdi) ++ vmovdqu %ymm14,256(%rdi) ++ vmovdqu %ymm2,288(%rdi) ++ je .Ldone8x ++ ++ leaq 320(%rsi),%rsi ++ xorq %r9,%r9 ++ vmovdqa %ymm3,0(%rsp) ++ leaq 320(%rdi),%rdi ++ subq $320,%rdx ++ vmovdqa %ymm7,32(%rsp) ++ jmp .Loop_tail8x ++ ++.align 32 ++.L384_or_more8x: ++ vpxor 0(%rsi),%ymm6,%ymm6 ++ vpxor 32(%rsi),%ymm8,%ymm8 ++ vpxor 64(%rsi),%ymm1,%ymm1 ++ vpxor 96(%rsi),%ymm5,%ymm5 ++ vpxor 128(%rsi),%ymm12,%ymm12 ++ vpxor 160(%rsi),%ymm13,%ymm13 ++ vpxor 192(%rsi),%ymm10,%ymm10 ++ vpxor 224(%rsi),%ymm15,%ymm15 ++ vpxor 256(%rsi),%ymm14,%ymm14 ++ vpxor 288(%rsi),%ymm2,%ymm2 ++ vpxor 320(%rsi),%ymm3,%ymm3 ++ vpxor 352(%rsi),%ymm7,%ymm7 ++ vmovdqu %ymm6,0(%rdi) ++ vmovdqu %ymm8,32(%rdi) ++ vmovdqu %ymm1,64(%rdi) ++ vmovdqu %ymm5,96(%rdi) ++ vmovdqu %ymm12,128(%rdi) ++ vmovdqu %ymm13,160(%rdi) ++ vmovdqu %ymm10,192(%rdi) ++ vmovdqu %ymm15,224(%rdi) ++ vmovdqu %ymm14,256(%rdi) ++ vmovdqu %ymm2,288(%rdi) ++ vmovdqu %ymm3,320(%rdi) ++ vmovdqu %ymm7,352(%rdi) ++ je .Ldone8x ++ ++ leaq 384(%rsi),%rsi ++ xorq %r9,%r9 ++ vmovdqa %ymm11,0(%rsp) ++ leaq 384(%rdi),%rdi ++ subq $384,%rdx ++ vmovdqa %ymm9,32(%rsp) ++ jmp .Loop_tail8x ++ ++.align 32 ++.L448_or_more8x: ++ vpxor 0(%rsi),%ymm6,%ymm6 ++ vpxor 32(%rsi),%ymm8,%ymm8 ++ vpxor 64(%rsi),%ymm1,%ymm1 ++ vpxor 96(%rsi),%ymm5,%ymm5 ++ vpxor 128(%rsi),%ymm12,%ymm12 ++ vpxor 160(%rsi),%ymm13,%ymm13 ++ vpxor 192(%rsi),%ymm10,%ymm10 ++ vpxor 224(%rsi),%ymm15,%ymm15 ++ vpxor 256(%rsi),%ymm14,%ymm14 ++ vpxor 288(%rsi),%ymm2,%ymm2 ++ vpxor 320(%rsi),%ymm3,%ymm3 ++ vpxor 352(%rsi),%ymm7,%ymm7 ++ vpxor 384(%rsi),%ymm11,%ymm11 ++ vpxor 416(%rsi),%ymm9,%ymm9 ++ vmovdqu %ymm6,0(%rdi) ++ vmovdqu %ymm8,32(%rdi) ++ vmovdqu %ymm1,64(%rdi) ++ vmovdqu %ymm5,96(%rdi) ++ vmovdqu %ymm12,128(%rdi) ++ vmovdqu %ymm13,160(%rdi) ++ vmovdqu %ymm10,192(%rdi) ++ vmovdqu %ymm15,224(%rdi) ++ vmovdqu %ymm14,256(%rdi) ++ vmovdqu %ymm2,288(%rdi) ++ vmovdqu %ymm3,320(%rdi) ++ vmovdqu %ymm7,352(%rdi) ++ vmovdqu %ymm11,384(%rdi) ++ vmovdqu %ymm9,416(%rdi) ++ je .Ldone8x ++ ++ leaq 448(%rsi),%rsi ++ xorq %r9,%r9 ++ vmovdqa %ymm0,0(%rsp) ++ leaq 448(%rdi),%rdi ++ subq $448,%rdx ++ vmovdqa %ymm4,32(%rsp) ++ ++.Loop_tail8x: ++ movzbl (%rsi,%r9,1),%eax ++ movzbl (%rsp,%r9,1),%ecx ++ leaq 1(%r9),%r9 ++ xorl %ecx,%eax ++ movb %al,-1(%rdi,%r9,1) ++ decq %rdx ++ jnz .Loop_tail8x ++ ++.Ldone8x: ++ vzeroall ++ leaq -8(%r10),%rsp ++ ++.L8x_epilogue: ++ ret ++ENDPROC(chacha20_avx2) ++#endif /* CONFIG_AS_AVX2 */ ++ ++#ifdef CONFIG_AS_AVX512 ++.align 32 ++ENTRY(chacha20_avx512) ++.Lchacha20_avx512: ++ cmpq $0,%rdx ++ je .Lavx512_epilogue ++ leaq 8(%rsp),%r10 ++ ++ cmpq $512,%rdx ++ ja .Lchacha20_16x ++ ++ subq $64+8,%rsp ++ andq $-64,%rsp ++ vbroadcasti32x4 .Lsigma(%rip),%zmm0 ++ vbroadcasti32x4 (%rcx),%zmm1 ++ vbroadcasti32x4 16(%rcx),%zmm2 ++ vbroadcasti32x4 (%r8),%zmm3 ++ ++ vmovdqa32 %zmm0,%zmm16 ++ vmovdqa32 %zmm1,%zmm17 ++ vmovdqa32 %zmm2,%zmm18 ++ vpaddd .Lzeroz(%rip),%zmm3,%zmm3 ++ vmovdqa32 .Lfourz(%rip),%zmm20 ++ movq $10,%r8 ++ vmovdqa32 %zmm3,%zmm19 ++ jmp .Loop_avx512 ++ ++.align 16 ++.Loop_outer_avx512: ++ vmovdqa32 %zmm16,%zmm0 ++ vmovdqa32 %zmm17,%zmm1 ++ vmovdqa32 %zmm18,%zmm2 ++ vpaddd %zmm20,%zmm19,%zmm3 ++ movq $10,%r8 ++ vmovdqa32 %zmm3,%zmm19 ++ jmp .Loop_avx512 ++ ++.align 32 ++.Loop_avx512: ++ vpaddd %zmm1,%zmm0,%zmm0 ++ vpxord %zmm0,%zmm3,%zmm3 ++ vprold $16,%zmm3,%zmm3 ++ vpaddd %zmm3,%zmm2,%zmm2 ++ vpxord %zmm2,%zmm1,%zmm1 ++ vprold $12,%zmm1,%zmm1 ++ vpaddd %zmm1,%zmm0,%zmm0 ++ vpxord %zmm0,%zmm3,%zmm3 ++ vprold $8,%zmm3,%zmm3 ++ vpaddd %zmm3,%zmm2,%zmm2 ++ vpxord %zmm2,%zmm1,%zmm1 ++ vprold $7,%zmm1,%zmm1 ++ vpshufd $78,%zmm2,%zmm2 ++ vpshufd $57,%zmm1,%zmm1 ++ vpshufd $147,%zmm3,%zmm3 ++ vpaddd %zmm1,%zmm0,%zmm0 ++ vpxord %zmm0,%zmm3,%zmm3 ++ vprold $16,%zmm3,%zmm3 ++ vpaddd %zmm3,%zmm2,%zmm2 ++ vpxord %zmm2,%zmm1,%zmm1 ++ vprold $12,%zmm1,%zmm1 ++ vpaddd %zmm1,%zmm0,%zmm0 ++ vpxord %zmm0,%zmm3,%zmm3 ++ vprold $8,%zmm3,%zmm3 ++ vpaddd %zmm3,%zmm2,%zmm2 ++ vpxord %zmm2,%zmm1,%zmm1 ++ vprold $7,%zmm1,%zmm1 ++ vpshufd $78,%zmm2,%zmm2 ++ vpshufd $147,%zmm1,%zmm1 ++ vpshufd $57,%zmm3,%zmm3 ++ decq %r8 ++ jnz .Loop_avx512 ++ vpaddd %zmm16,%zmm0,%zmm0 ++ vpaddd %zmm17,%zmm1,%zmm1 ++ vpaddd %zmm18,%zmm2,%zmm2 ++ vpaddd %zmm19,%zmm3,%zmm3 ++ ++ subq $64,%rdx ++ jb .Ltail64_avx512 ++ ++ vpxor 0(%rsi),%xmm0,%xmm4 ++ vpxor 16(%rsi),%xmm1,%xmm5 ++ vpxor 32(%rsi),%xmm2,%xmm6 ++ vpxor 48(%rsi),%xmm3,%xmm7 ++ leaq 64(%rsi),%rsi ++ ++ vmovdqu %xmm4,0(%rdi) ++ vmovdqu %xmm5,16(%rdi) ++ vmovdqu %xmm6,32(%rdi) ++ vmovdqu %xmm7,48(%rdi) ++ leaq 64(%rdi),%rdi ++ ++ jz .Ldone_avx512 ++ ++ vextracti32x4 $1,%zmm0,%xmm4 ++ vextracti32x4 $1,%zmm1,%xmm5 ++ vextracti32x4 $1,%zmm2,%xmm6 ++ vextracti32x4 $1,%zmm3,%xmm7 ++ ++ subq $64,%rdx ++ jb .Ltail_avx512 ++ ++ vpxor 0(%rsi),%xmm4,%xmm4 ++ vpxor 16(%rsi),%xmm5,%xmm5 ++ vpxor 32(%rsi),%xmm6,%xmm6 ++ vpxor 48(%rsi),%xmm7,%xmm7 ++ leaq 64(%rsi),%rsi ++ ++ vmovdqu %xmm4,0(%rdi) ++ vmovdqu %xmm5,16(%rdi) ++ vmovdqu %xmm6,32(%rdi) ++ vmovdqu %xmm7,48(%rdi) ++ leaq 64(%rdi),%rdi ++ ++ jz .Ldone_avx512 ++ ++ vextracti32x4 $2,%zmm0,%xmm4 ++ vextracti32x4 $2,%zmm1,%xmm5 ++ vextracti32x4 $2,%zmm2,%xmm6 ++ vextracti32x4 $2,%zmm3,%xmm7 ++ ++ subq $64,%rdx ++ jb .Ltail_avx512 ++ ++ vpxor 0(%rsi),%xmm4,%xmm4 ++ vpxor 16(%rsi),%xmm5,%xmm5 ++ vpxor 32(%rsi),%xmm6,%xmm6 ++ vpxor 48(%rsi),%xmm7,%xmm7 ++ leaq 64(%rsi),%rsi ++ ++ vmovdqu %xmm4,0(%rdi) ++ vmovdqu %xmm5,16(%rdi) ++ vmovdqu %xmm6,32(%rdi) ++ vmovdqu %xmm7,48(%rdi) ++ leaq 64(%rdi),%rdi ++ ++ jz .Ldone_avx512 ++ ++ vextracti32x4 $3,%zmm0,%xmm4 ++ vextracti32x4 $3,%zmm1,%xmm5 ++ vextracti32x4 $3,%zmm2,%xmm6 ++ vextracti32x4 $3,%zmm3,%xmm7 ++ ++ subq $64,%rdx ++ jb .Ltail_avx512 ++ ++ vpxor 0(%rsi),%xmm4,%xmm4 ++ vpxor 16(%rsi),%xmm5,%xmm5 ++ vpxor 32(%rsi),%xmm6,%xmm6 ++ vpxor 48(%rsi),%xmm7,%xmm7 ++ leaq 64(%rsi),%rsi ++ ++ vmovdqu %xmm4,0(%rdi) ++ vmovdqu %xmm5,16(%rdi) ++ vmovdqu %xmm6,32(%rdi) ++ vmovdqu %xmm7,48(%rdi) ++ leaq 64(%rdi),%rdi ++ ++ jnz .Loop_outer_avx512 ++ ++ jmp .Ldone_avx512 ++ ++.align 16 ++.Ltail64_avx512: ++ vmovdqa %xmm0,0(%rsp) ++ vmovdqa %xmm1,16(%rsp) ++ vmovdqa %xmm2,32(%rsp) ++ vmovdqa %xmm3,48(%rsp) ++ addq $64,%rdx ++ jmp .Loop_tail_avx512 ++ ++.align 16 ++.Ltail_avx512: ++ vmovdqa %xmm4,0(%rsp) ++ vmovdqa %xmm5,16(%rsp) ++ vmovdqa %xmm6,32(%rsp) ++ vmovdqa %xmm7,48(%rsp) ++ addq $64,%rdx ++ ++.Loop_tail_avx512: ++ movzbl (%rsi,%r8,1),%eax ++ movzbl (%rsp,%r8,1),%ecx ++ leaq 1(%r8),%r8 ++ xorl %ecx,%eax ++ movb %al,-1(%rdi,%r8,1) ++ decq %rdx ++ jnz .Loop_tail_avx512 ++ ++ vmovdqa32 %zmm16,0(%rsp) ++ ++.Ldone_avx512: ++ vzeroall ++ leaq -8(%r10),%rsp ++ ++.Lavx512_epilogue: ++ ret ++ ++.align 32 ++.Lchacha20_16x: ++ leaq 8(%rsp),%r10 ++ ++ subq $64+8,%rsp ++ andq $-64,%rsp ++ vzeroupper ++ ++ leaq .Lsigma(%rip),%r9 ++ vbroadcasti32x4 (%r9),%zmm3 ++ vbroadcasti32x4 (%rcx),%zmm7 ++ vbroadcasti32x4 16(%rcx),%zmm11 ++ vbroadcasti32x4 (%r8),%zmm15 ++ ++ vpshufd $0x00,%zmm3,%zmm0 ++ vpshufd $0x55,%zmm3,%zmm1 ++ vpshufd $0xaa,%zmm3,%zmm2 ++ vpshufd $0xff,%zmm3,%zmm3 ++ vmovdqa64 %zmm0,%zmm16 ++ vmovdqa64 %zmm1,%zmm17 ++ vmovdqa64 %zmm2,%zmm18 ++ vmovdqa64 %zmm3,%zmm19 ++ ++ vpshufd $0x00,%zmm7,%zmm4 ++ vpshufd $0x55,%zmm7,%zmm5 ++ vpshufd $0xaa,%zmm7,%zmm6 ++ vpshufd $0xff,%zmm7,%zmm7 ++ vmovdqa64 %zmm4,%zmm20 ++ vmovdqa64 %zmm5,%zmm21 ++ vmovdqa64 %zmm6,%zmm22 ++ vmovdqa64 %zmm7,%zmm23 ++ ++ vpshufd $0x00,%zmm11,%zmm8 ++ vpshufd $0x55,%zmm11,%zmm9 ++ vpshufd $0xaa,%zmm11,%zmm10 ++ vpshufd $0xff,%zmm11,%zmm11 ++ vmovdqa64 %zmm8,%zmm24 ++ vmovdqa64 %zmm9,%zmm25 ++ vmovdqa64 %zmm10,%zmm26 ++ vmovdqa64 %zmm11,%zmm27 ++ ++ vpshufd $0x00,%zmm15,%zmm12 ++ vpshufd $0x55,%zmm15,%zmm13 ++ vpshufd $0xaa,%zmm15,%zmm14 ++ vpshufd $0xff,%zmm15,%zmm15 ++ vpaddd .Lincz(%rip),%zmm12,%zmm12 ++ vmovdqa64 %zmm12,%zmm28 ++ vmovdqa64 %zmm13,%zmm29 ++ vmovdqa64 %zmm14,%zmm30 ++ vmovdqa64 %zmm15,%zmm31 ++ ++ movl $10,%eax ++ jmp .Loop16x ++ ++.align 32 ++.Loop_outer16x: ++ vpbroadcastd 0(%r9),%zmm0 ++ vpbroadcastd 4(%r9),%zmm1 ++ vpbroadcastd 8(%r9),%zmm2 ++ vpbroadcastd 12(%r9),%zmm3 ++ vpaddd .Lsixteen(%rip),%zmm28,%zmm28 ++ vmovdqa64 %zmm20,%zmm4 ++ vmovdqa64 %zmm21,%zmm5 ++ vmovdqa64 %zmm22,%zmm6 ++ vmovdqa64 %zmm23,%zmm7 ++ vmovdqa64 %zmm24,%zmm8 ++ vmovdqa64 %zmm25,%zmm9 ++ vmovdqa64 %zmm26,%zmm10 ++ vmovdqa64 %zmm27,%zmm11 ++ vmovdqa64 %zmm28,%zmm12 ++ vmovdqa64 %zmm29,%zmm13 ++ vmovdqa64 %zmm30,%zmm14 ++ vmovdqa64 %zmm31,%zmm15 ++ ++ vmovdqa64 %zmm0,%zmm16 ++ vmovdqa64 %zmm1,%zmm17 ++ vmovdqa64 %zmm2,%zmm18 ++ vmovdqa64 %zmm3,%zmm19 ++ ++ movl $10,%eax ++ jmp .Loop16x ++ ++.align 32 ++.Loop16x: ++ vpaddd %zmm4,%zmm0,%zmm0 ++ vpaddd %zmm5,%zmm1,%zmm1 ++ vpaddd %zmm6,%zmm2,%zmm2 ++ vpaddd %zmm7,%zmm3,%zmm3 ++ vpxord %zmm0,%zmm12,%zmm12 ++ vpxord %zmm1,%zmm13,%zmm13 ++ vpxord %zmm2,%zmm14,%zmm14 ++ vpxord %zmm3,%zmm15,%zmm15 ++ vprold $16,%zmm12,%zmm12 ++ vprold $16,%zmm13,%zmm13 ++ vprold $16,%zmm14,%zmm14 ++ vprold $16,%zmm15,%zmm15 ++ vpaddd %zmm12,%zmm8,%zmm8 ++ vpaddd %zmm13,%zmm9,%zmm9 ++ vpaddd %zmm14,%zmm10,%zmm10 ++ vpaddd %zmm15,%zmm11,%zmm11 ++ vpxord %zmm8,%zmm4,%zmm4 ++ vpxord %zmm9,%zmm5,%zmm5 ++ vpxord %zmm10,%zmm6,%zmm6 ++ vpxord %zmm11,%zmm7,%zmm7 ++ vprold $12,%zmm4,%zmm4 ++ vprold $12,%zmm5,%zmm5 ++ vprold $12,%zmm6,%zmm6 ++ vprold $12,%zmm7,%zmm7 ++ vpaddd %zmm4,%zmm0,%zmm0 ++ vpaddd %zmm5,%zmm1,%zmm1 ++ vpaddd %zmm6,%zmm2,%zmm2 ++ vpaddd %zmm7,%zmm3,%zmm3 ++ vpxord %zmm0,%zmm12,%zmm12 ++ vpxord %zmm1,%zmm13,%zmm13 ++ vpxord %zmm2,%zmm14,%zmm14 ++ vpxord %zmm3,%zmm15,%zmm15 ++ vprold $8,%zmm12,%zmm12 ++ vprold $8,%zmm13,%zmm13 ++ vprold $8,%zmm14,%zmm14 ++ vprold $8,%zmm15,%zmm15 ++ vpaddd %zmm12,%zmm8,%zmm8 ++ vpaddd %zmm13,%zmm9,%zmm9 ++ vpaddd %zmm14,%zmm10,%zmm10 ++ vpaddd %zmm15,%zmm11,%zmm11 ++ vpxord %zmm8,%zmm4,%zmm4 ++ vpxord %zmm9,%zmm5,%zmm5 ++ vpxord %zmm10,%zmm6,%zmm6 ++ vpxord %zmm11,%zmm7,%zmm7 ++ vprold $7,%zmm4,%zmm4 ++ vprold $7,%zmm5,%zmm5 ++ vprold $7,%zmm6,%zmm6 ++ vprold $7,%zmm7,%zmm7 ++ vpaddd %zmm5,%zmm0,%zmm0 ++ vpaddd %zmm6,%zmm1,%zmm1 ++ vpaddd %zmm7,%zmm2,%zmm2 ++ vpaddd %zmm4,%zmm3,%zmm3 ++ vpxord %zmm0,%zmm15,%zmm15 ++ vpxord %zmm1,%zmm12,%zmm12 ++ vpxord %zmm2,%zmm13,%zmm13 ++ vpxord %zmm3,%zmm14,%zmm14 ++ vprold $16,%zmm15,%zmm15 ++ vprold $16,%zmm12,%zmm12 ++ vprold $16,%zmm13,%zmm13 ++ vprold $16,%zmm14,%zmm14 ++ vpaddd %zmm15,%zmm10,%zmm10 ++ vpaddd %zmm12,%zmm11,%zmm11 ++ vpaddd %zmm13,%zmm8,%zmm8 ++ vpaddd %zmm14,%zmm9,%zmm9 ++ vpxord %zmm10,%zmm5,%zmm5 ++ vpxord %zmm11,%zmm6,%zmm6 ++ vpxord %zmm8,%zmm7,%zmm7 ++ vpxord %zmm9,%zmm4,%zmm4 ++ vprold $12,%zmm5,%zmm5 ++ vprold $12,%zmm6,%zmm6 ++ vprold $12,%zmm7,%zmm7 ++ vprold $12,%zmm4,%zmm4 ++ vpaddd %zmm5,%zmm0,%zmm0 ++ vpaddd %zmm6,%zmm1,%zmm1 ++ vpaddd %zmm7,%zmm2,%zmm2 ++ vpaddd %zmm4,%zmm3,%zmm3 ++ vpxord %zmm0,%zmm15,%zmm15 ++ vpxord %zmm1,%zmm12,%zmm12 ++ vpxord %zmm2,%zmm13,%zmm13 ++ vpxord %zmm3,%zmm14,%zmm14 ++ vprold $8,%zmm15,%zmm15 ++ vprold $8,%zmm12,%zmm12 ++ vprold $8,%zmm13,%zmm13 ++ vprold $8,%zmm14,%zmm14 ++ vpaddd %zmm15,%zmm10,%zmm10 ++ vpaddd %zmm12,%zmm11,%zmm11 ++ vpaddd %zmm13,%zmm8,%zmm8 ++ vpaddd %zmm14,%zmm9,%zmm9 ++ vpxord %zmm10,%zmm5,%zmm5 ++ vpxord %zmm11,%zmm6,%zmm6 ++ vpxord %zmm8,%zmm7,%zmm7 ++ vpxord %zmm9,%zmm4,%zmm4 ++ vprold $7,%zmm5,%zmm5 ++ vprold $7,%zmm6,%zmm6 ++ vprold $7,%zmm7,%zmm7 ++ vprold $7,%zmm4,%zmm4 ++ decl %eax ++ jnz .Loop16x ++ ++ vpaddd %zmm16,%zmm0,%zmm0 ++ vpaddd %zmm17,%zmm1,%zmm1 ++ vpaddd %zmm18,%zmm2,%zmm2 ++ vpaddd %zmm19,%zmm3,%zmm3 ++ ++ vpunpckldq %zmm1,%zmm0,%zmm18 ++ vpunpckldq %zmm3,%zmm2,%zmm19 ++ vpunpckhdq %zmm1,%zmm0,%zmm0 ++ vpunpckhdq %zmm3,%zmm2,%zmm2 ++ vpunpcklqdq %zmm19,%zmm18,%zmm1 ++ vpunpckhqdq %zmm19,%zmm18,%zmm18 ++ vpunpcklqdq %zmm2,%zmm0,%zmm3 ++ vpunpckhqdq %zmm2,%zmm0,%zmm0 ++ vpaddd %zmm20,%zmm4,%zmm4 ++ vpaddd %zmm21,%zmm5,%zmm5 ++ vpaddd %zmm22,%zmm6,%zmm6 ++ vpaddd %zmm23,%zmm7,%zmm7 ++ ++ vpunpckldq %zmm5,%zmm4,%zmm2 ++ vpunpckldq %zmm7,%zmm6,%zmm19 ++ vpunpckhdq %zmm5,%zmm4,%zmm4 ++ vpunpckhdq %zmm7,%zmm6,%zmm6 ++ vpunpcklqdq %zmm19,%zmm2,%zmm5 ++ vpunpckhqdq %zmm19,%zmm2,%zmm2 ++ vpunpcklqdq %zmm6,%zmm4,%zmm7 ++ vpunpckhqdq %zmm6,%zmm4,%zmm4 ++ vshufi32x4 $0x44,%zmm5,%zmm1,%zmm19 ++ vshufi32x4 $0xee,%zmm5,%zmm1,%zmm5 ++ vshufi32x4 $0x44,%zmm2,%zmm18,%zmm1 ++ vshufi32x4 $0xee,%zmm2,%zmm18,%zmm2 ++ vshufi32x4 $0x44,%zmm7,%zmm3,%zmm18 ++ vshufi32x4 $0xee,%zmm7,%zmm3,%zmm7 ++ vshufi32x4 $0x44,%zmm4,%zmm0,%zmm3 ++ vshufi32x4 $0xee,%zmm4,%zmm0,%zmm4 ++ vpaddd %zmm24,%zmm8,%zmm8 ++ vpaddd %zmm25,%zmm9,%zmm9 ++ vpaddd %zmm26,%zmm10,%zmm10 ++ vpaddd %zmm27,%zmm11,%zmm11 ++ ++ vpunpckldq %zmm9,%zmm8,%zmm6 ++ vpunpckldq %zmm11,%zmm10,%zmm0 ++ vpunpckhdq %zmm9,%zmm8,%zmm8 ++ vpunpckhdq %zmm11,%zmm10,%zmm10 ++ vpunpcklqdq %zmm0,%zmm6,%zmm9 ++ vpunpckhqdq %zmm0,%zmm6,%zmm6 ++ vpunpcklqdq %zmm10,%zmm8,%zmm11 ++ vpunpckhqdq %zmm10,%zmm8,%zmm8 ++ vpaddd %zmm28,%zmm12,%zmm12 ++ vpaddd %zmm29,%zmm13,%zmm13 ++ vpaddd %zmm30,%zmm14,%zmm14 ++ vpaddd %zmm31,%zmm15,%zmm15 ++ ++ vpunpckldq %zmm13,%zmm12,%zmm10 ++ vpunpckldq %zmm15,%zmm14,%zmm0 ++ vpunpckhdq %zmm13,%zmm12,%zmm12 ++ vpunpckhdq %zmm15,%zmm14,%zmm14 ++ vpunpcklqdq %zmm0,%zmm10,%zmm13 ++ vpunpckhqdq %zmm0,%zmm10,%zmm10 ++ vpunpcklqdq %zmm14,%zmm12,%zmm15 ++ vpunpckhqdq %zmm14,%zmm12,%zmm12 ++ vshufi32x4 $0x44,%zmm13,%zmm9,%zmm0 ++ vshufi32x4 $0xee,%zmm13,%zmm9,%zmm13 ++ vshufi32x4 $0x44,%zmm10,%zmm6,%zmm9 ++ vshufi32x4 $0xee,%zmm10,%zmm6,%zmm10 ++ vshufi32x4 $0x44,%zmm15,%zmm11,%zmm6 ++ vshufi32x4 $0xee,%zmm15,%zmm11,%zmm15 ++ vshufi32x4 $0x44,%zmm12,%zmm8,%zmm11 ++ vshufi32x4 $0xee,%zmm12,%zmm8,%zmm12 ++ vshufi32x4 $0x88,%zmm0,%zmm19,%zmm16 ++ vshufi32x4 $0xdd,%zmm0,%zmm19,%zmm19 ++ vshufi32x4 $0x88,%zmm13,%zmm5,%zmm0 ++ vshufi32x4 $0xdd,%zmm13,%zmm5,%zmm13 ++ vshufi32x4 $0x88,%zmm9,%zmm1,%zmm17 ++ vshufi32x4 $0xdd,%zmm9,%zmm1,%zmm1 ++ vshufi32x4 $0x88,%zmm10,%zmm2,%zmm9 ++ vshufi32x4 $0xdd,%zmm10,%zmm2,%zmm10 ++ vshufi32x4 $0x88,%zmm6,%zmm18,%zmm14 ++ vshufi32x4 $0xdd,%zmm6,%zmm18,%zmm18 ++ vshufi32x4 $0x88,%zmm15,%zmm7,%zmm6 ++ vshufi32x4 $0xdd,%zmm15,%zmm7,%zmm15 ++ vshufi32x4 $0x88,%zmm11,%zmm3,%zmm8 ++ vshufi32x4 $0xdd,%zmm11,%zmm3,%zmm3 ++ vshufi32x4 $0x88,%zmm12,%zmm4,%zmm11 ++ vshufi32x4 $0xdd,%zmm12,%zmm4,%zmm12 ++ cmpq $1024,%rdx ++ jb .Ltail16x ++ ++ vpxord 0(%rsi),%zmm16,%zmm16 ++ vpxord 64(%rsi),%zmm17,%zmm17 ++ vpxord 128(%rsi),%zmm14,%zmm14 ++ vpxord 192(%rsi),%zmm8,%zmm8 ++ vmovdqu32 %zmm16,0(%rdi) ++ vmovdqu32 %zmm17,64(%rdi) ++ vmovdqu32 %zmm14,128(%rdi) ++ vmovdqu32 %zmm8,192(%rdi) ++ ++ vpxord 256(%rsi),%zmm19,%zmm19 ++ vpxord 320(%rsi),%zmm1,%zmm1 ++ vpxord 384(%rsi),%zmm18,%zmm18 ++ vpxord 448(%rsi),%zmm3,%zmm3 ++ vmovdqu32 %zmm19,256(%rdi) ++ vmovdqu32 %zmm1,320(%rdi) ++ vmovdqu32 %zmm18,384(%rdi) ++ vmovdqu32 %zmm3,448(%rdi) ++ ++ vpxord 512(%rsi),%zmm0,%zmm0 ++ vpxord 576(%rsi),%zmm9,%zmm9 ++ vpxord 640(%rsi),%zmm6,%zmm6 ++ vpxord 704(%rsi),%zmm11,%zmm11 ++ vmovdqu32 %zmm0,512(%rdi) ++ vmovdqu32 %zmm9,576(%rdi) ++ vmovdqu32 %zmm6,640(%rdi) ++ vmovdqu32 %zmm11,704(%rdi) ++ ++ vpxord 768(%rsi),%zmm13,%zmm13 ++ vpxord 832(%rsi),%zmm10,%zmm10 ++ vpxord 896(%rsi),%zmm15,%zmm15 ++ vpxord 960(%rsi),%zmm12,%zmm12 ++ leaq 1024(%rsi),%rsi ++ vmovdqu32 %zmm13,768(%rdi) ++ vmovdqu32 %zmm10,832(%rdi) ++ vmovdqu32 %zmm15,896(%rdi) ++ vmovdqu32 %zmm12,960(%rdi) ++ leaq 1024(%rdi),%rdi ++ ++ subq $1024,%rdx ++ jnz .Loop_outer16x ++ ++ jmp .Ldone16x ++ ++.align 32 ++.Ltail16x: ++ xorq %r9,%r9 ++ subq %rsi,%rdi ++ cmpq $64,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm16,%zmm16 ++ vmovdqu32 %zmm16,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm17,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $128,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm17,%zmm17 ++ vmovdqu32 %zmm17,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm14,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $192,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm14,%zmm14 ++ vmovdqu32 %zmm14,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm8,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $256,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm8,%zmm8 ++ vmovdqu32 %zmm8,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm19,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $320,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm19,%zmm19 ++ vmovdqu32 %zmm19,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm1,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $384,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm1,%zmm1 ++ vmovdqu32 %zmm1,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm18,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $448,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm18,%zmm18 ++ vmovdqu32 %zmm18,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm3,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $512,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm3,%zmm3 ++ vmovdqu32 %zmm3,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm0,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $576,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm0,%zmm0 ++ vmovdqu32 %zmm0,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm9,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $640,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm9,%zmm9 ++ vmovdqu32 %zmm9,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm6,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $704,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm6,%zmm6 ++ vmovdqu32 %zmm6,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm11,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $768,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm11,%zmm11 ++ vmovdqu32 %zmm11,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm13,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $832,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm13,%zmm13 ++ vmovdqu32 %zmm13,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm10,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $896,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm10,%zmm10 ++ vmovdqu32 %zmm10,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm15,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $960,%rdx ++ jb .Less_than_64_16x ++ vpxord (%rsi),%zmm15,%zmm15 ++ vmovdqu32 %zmm15,(%rdi,%rsi,1) ++ je .Ldone16x ++ vmovdqa32 %zmm12,%zmm16 ++ leaq 64(%rsi),%rsi ++ ++.Less_than_64_16x: ++ vmovdqa32 %zmm16,0(%rsp) ++ leaq (%rdi,%rsi,1),%rdi ++ andq $63,%rdx ++ ++.Loop_tail16x: ++ movzbl (%rsi,%r9,1),%eax ++ movzbl (%rsp,%r9,1),%ecx ++ leaq 1(%r9),%r9 ++ xorl %ecx,%eax ++ movb %al,-1(%rdi,%r9,1) ++ decq %rdx ++ jnz .Loop_tail16x ++ ++ vpxord %zmm16,%zmm16,%zmm16 ++ vmovdqa32 %zmm16,0(%rsp) ++ ++.Ldone16x: ++ vzeroall ++ leaq -8(%r10),%rsp ++ ++.L16x_epilogue: ++ ret ++ENDPROC(chacha20_avx512) ++ ++.align 32 ++ENTRY(chacha20_avx512vl) ++ cmpq $0,%rdx ++ je .Lavx512vl_epilogue ++ ++ leaq 8(%rsp),%r10 ++ ++ cmpq $128,%rdx ++ ja .Lchacha20_8xvl ++ ++ subq $64+8,%rsp ++ andq $-64,%rsp ++ vbroadcasti128 .Lsigma(%rip),%ymm0 ++ vbroadcasti128 (%rcx),%ymm1 ++ vbroadcasti128 16(%rcx),%ymm2 ++ vbroadcasti128 (%r8),%ymm3 ++ ++ vmovdqa32 %ymm0,%ymm16 ++ vmovdqa32 %ymm1,%ymm17 ++ vmovdqa32 %ymm2,%ymm18 ++ vpaddd .Lzeroz(%rip),%ymm3,%ymm3 ++ vmovdqa32 .Ltwoy(%rip),%ymm20 ++ movq $10,%r8 ++ vmovdqa32 %ymm3,%ymm19 ++ jmp .Loop_avx512vl ++ ++.align 16 ++.Loop_outer_avx512vl: ++ vmovdqa32 %ymm18,%ymm2 ++ vpaddd %ymm20,%ymm19,%ymm3 ++ movq $10,%r8 ++ vmovdqa32 %ymm3,%ymm19 ++ jmp .Loop_avx512vl ++ ++.align 32 ++.Loop_avx512vl: ++ vpaddd %ymm1,%ymm0,%ymm0 ++ vpxor %ymm0,%ymm3,%ymm3 ++ vprold $16,%ymm3,%ymm3 ++ vpaddd %ymm3,%ymm2,%ymm2 ++ vpxor %ymm2,%ymm1,%ymm1 ++ vprold $12,%ymm1,%ymm1 ++ vpaddd %ymm1,%ymm0,%ymm0 ++ vpxor %ymm0,%ymm3,%ymm3 ++ vprold $8,%ymm3,%ymm3 ++ vpaddd %ymm3,%ymm2,%ymm2 ++ vpxor %ymm2,%ymm1,%ymm1 ++ vprold $7,%ymm1,%ymm1 ++ vpshufd $78,%ymm2,%ymm2 ++ vpshufd $57,%ymm1,%ymm1 ++ vpshufd $147,%ymm3,%ymm3 ++ vpaddd %ymm1,%ymm0,%ymm0 ++ vpxor %ymm0,%ymm3,%ymm3 ++ vprold $16,%ymm3,%ymm3 ++ vpaddd %ymm3,%ymm2,%ymm2 ++ vpxor %ymm2,%ymm1,%ymm1 ++ vprold $12,%ymm1,%ymm1 ++ vpaddd %ymm1,%ymm0,%ymm0 ++ vpxor %ymm0,%ymm3,%ymm3 ++ vprold $8,%ymm3,%ymm3 ++ vpaddd %ymm3,%ymm2,%ymm2 ++ vpxor %ymm2,%ymm1,%ymm1 ++ vprold $7,%ymm1,%ymm1 ++ vpshufd $78,%ymm2,%ymm2 ++ vpshufd $147,%ymm1,%ymm1 ++ vpshufd $57,%ymm3,%ymm3 ++ decq %r8 ++ jnz .Loop_avx512vl ++ vpaddd %ymm16,%ymm0,%ymm0 ++ vpaddd %ymm17,%ymm1,%ymm1 ++ vpaddd %ymm18,%ymm2,%ymm2 ++ vpaddd %ymm19,%ymm3,%ymm3 ++ ++ subq $64,%rdx ++ jb .Ltail64_avx512vl ++ ++ vpxor 0(%rsi),%xmm0,%xmm4 ++ vpxor 16(%rsi),%xmm1,%xmm5 ++ vpxor 32(%rsi),%xmm2,%xmm6 ++ vpxor 48(%rsi),%xmm3,%xmm7 ++ leaq 64(%rsi),%rsi ++ ++ vmovdqu %xmm4,0(%rdi) ++ vmovdqu %xmm5,16(%rdi) ++ vmovdqu %xmm6,32(%rdi) ++ vmovdqu %xmm7,48(%rdi) ++ leaq 64(%rdi),%rdi ++ ++ jz .Ldone_avx512vl ++ ++ vextracti128 $1,%ymm0,%xmm4 ++ vextracti128 $1,%ymm1,%xmm5 ++ vextracti128 $1,%ymm2,%xmm6 ++ vextracti128 $1,%ymm3,%xmm7 ++ ++ subq $64,%rdx ++ jb .Ltail_avx512vl ++ ++ vpxor 0(%rsi),%xmm4,%xmm4 ++ vpxor 16(%rsi),%xmm5,%xmm5 ++ vpxor 32(%rsi),%xmm6,%xmm6 ++ vpxor 48(%rsi),%xmm7,%xmm7 ++ leaq 64(%rsi),%rsi ++ ++ vmovdqu %xmm4,0(%rdi) ++ vmovdqu %xmm5,16(%rdi) ++ vmovdqu %xmm6,32(%rdi) ++ vmovdqu %xmm7,48(%rdi) ++ leaq 64(%rdi),%rdi ++ ++ vmovdqa32 %ymm16,%ymm0 ++ vmovdqa32 %ymm17,%ymm1 ++ jnz .Loop_outer_avx512vl ++ ++ jmp .Ldone_avx512vl ++ ++.align 16 ++.Ltail64_avx512vl: ++ vmovdqa %xmm0,0(%rsp) ++ vmovdqa %xmm1,16(%rsp) ++ vmovdqa %xmm2,32(%rsp) ++ vmovdqa %xmm3,48(%rsp) ++ addq $64,%rdx ++ jmp .Loop_tail_avx512vl ++ ++.align 16 ++.Ltail_avx512vl: ++ vmovdqa %xmm4,0(%rsp) ++ vmovdqa %xmm5,16(%rsp) ++ vmovdqa %xmm6,32(%rsp) ++ vmovdqa %xmm7,48(%rsp) ++ addq $64,%rdx ++ ++.Loop_tail_avx512vl: ++ movzbl (%rsi,%r8,1),%eax ++ movzbl (%rsp,%r8,1),%ecx ++ leaq 1(%r8),%r8 ++ xorl %ecx,%eax ++ movb %al,-1(%rdi,%r8,1) ++ decq %rdx ++ jnz .Loop_tail_avx512vl ++ ++ vmovdqa32 %ymm16,0(%rsp) ++ vmovdqa32 %ymm16,32(%rsp) ++ ++.Ldone_avx512vl: ++ vzeroall ++ leaq -8(%r10),%rsp ++.Lavx512vl_epilogue: ++ ret ++ ++.align 32 ++.Lchacha20_8xvl: ++ leaq 8(%rsp),%r10 ++ subq $64+8,%rsp ++ andq $-64,%rsp ++ vzeroupper ++ ++ leaq .Lsigma(%rip),%r9 ++ vbroadcasti128 (%r9),%ymm3 ++ vbroadcasti128 (%rcx),%ymm7 ++ vbroadcasti128 16(%rcx),%ymm11 ++ vbroadcasti128 (%r8),%ymm15 ++ ++ vpshufd $0x00,%ymm3,%ymm0 ++ vpshufd $0x55,%ymm3,%ymm1 ++ vpshufd $0xaa,%ymm3,%ymm2 ++ vpshufd $0xff,%ymm3,%ymm3 ++ vmovdqa64 %ymm0,%ymm16 ++ vmovdqa64 %ymm1,%ymm17 ++ vmovdqa64 %ymm2,%ymm18 ++ vmovdqa64 %ymm3,%ymm19 ++ ++ vpshufd $0x00,%ymm7,%ymm4 ++ vpshufd $0x55,%ymm7,%ymm5 ++ vpshufd $0xaa,%ymm7,%ymm6 ++ vpshufd $0xff,%ymm7,%ymm7 ++ vmovdqa64 %ymm4,%ymm20 ++ vmovdqa64 %ymm5,%ymm21 ++ vmovdqa64 %ymm6,%ymm22 ++ vmovdqa64 %ymm7,%ymm23 ++ ++ vpshufd $0x00,%ymm11,%ymm8 ++ vpshufd $0x55,%ymm11,%ymm9 ++ vpshufd $0xaa,%ymm11,%ymm10 ++ vpshufd $0xff,%ymm11,%ymm11 ++ vmovdqa64 %ymm8,%ymm24 ++ vmovdqa64 %ymm9,%ymm25 ++ vmovdqa64 %ymm10,%ymm26 ++ vmovdqa64 %ymm11,%ymm27 ++ ++ vpshufd $0x00,%ymm15,%ymm12 ++ vpshufd $0x55,%ymm15,%ymm13 ++ vpshufd $0xaa,%ymm15,%ymm14 ++ vpshufd $0xff,%ymm15,%ymm15 ++ vpaddd .Lincy(%rip),%ymm12,%ymm12 ++ vmovdqa64 %ymm12,%ymm28 ++ vmovdqa64 %ymm13,%ymm29 ++ vmovdqa64 %ymm14,%ymm30 ++ vmovdqa64 %ymm15,%ymm31 ++ ++ movl $10,%eax ++ jmp .Loop8xvl ++ ++.align 32 ++.Loop_outer8xvl: ++ ++ ++ vpbroadcastd 8(%r9),%ymm2 ++ vpbroadcastd 12(%r9),%ymm3 ++ vpaddd .Leight(%rip),%ymm28,%ymm28 ++ vmovdqa64 %ymm20,%ymm4 ++ vmovdqa64 %ymm21,%ymm5 ++ vmovdqa64 %ymm22,%ymm6 ++ vmovdqa64 %ymm23,%ymm7 ++ vmovdqa64 %ymm24,%ymm8 ++ vmovdqa64 %ymm25,%ymm9 ++ vmovdqa64 %ymm26,%ymm10 ++ vmovdqa64 %ymm27,%ymm11 ++ vmovdqa64 %ymm28,%ymm12 ++ vmovdqa64 %ymm29,%ymm13 ++ vmovdqa64 %ymm30,%ymm14 ++ vmovdqa64 %ymm31,%ymm15 ++ ++ vmovdqa64 %ymm0,%ymm16 ++ vmovdqa64 %ymm1,%ymm17 ++ vmovdqa64 %ymm2,%ymm18 ++ vmovdqa64 %ymm3,%ymm19 ++ ++ movl $10,%eax ++ jmp .Loop8xvl ++ ++.align 32 ++.Loop8xvl: ++ vpaddd %ymm4,%ymm0,%ymm0 ++ vpaddd %ymm5,%ymm1,%ymm1 ++ vpaddd %ymm6,%ymm2,%ymm2 ++ vpaddd %ymm7,%ymm3,%ymm3 ++ vpxor %ymm0,%ymm12,%ymm12 ++ vpxor %ymm1,%ymm13,%ymm13 ++ vpxor %ymm2,%ymm14,%ymm14 ++ vpxor %ymm3,%ymm15,%ymm15 ++ vprold $16,%ymm12,%ymm12 ++ vprold $16,%ymm13,%ymm13 ++ vprold $16,%ymm14,%ymm14 ++ vprold $16,%ymm15,%ymm15 ++ vpaddd %ymm12,%ymm8,%ymm8 ++ vpaddd %ymm13,%ymm9,%ymm9 ++ vpaddd %ymm14,%ymm10,%ymm10 ++ vpaddd %ymm15,%ymm11,%ymm11 ++ vpxor %ymm8,%ymm4,%ymm4 ++ vpxor %ymm9,%ymm5,%ymm5 ++ vpxor %ymm10,%ymm6,%ymm6 ++ vpxor %ymm11,%ymm7,%ymm7 ++ vprold $12,%ymm4,%ymm4 ++ vprold $12,%ymm5,%ymm5 ++ vprold $12,%ymm6,%ymm6 ++ vprold $12,%ymm7,%ymm7 ++ vpaddd %ymm4,%ymm0,%ymm0 ++ vpaddd %ymm5,%ymm1,%ymm1 ++ vpaddd %ymm6,%ymm2,%ymm2 ++ vpaddd %ymm7,%ymm3,%ymm3 ++ vpxor %ymm0,%ymm12,%ymm12 ++ vpxor %ymm1,%ymm13,%ymm13 ++ vpxor %ymm2,%ymm14,%ymm14 ++ vpxor %ymm3,%ymm15,%ymm15 ++ vprold $8,%ymm12,%ymm12 ++ vprold $8,%ymm13,%ymm13 ++ vprold $8,%ymm14,%ymm14 ++ vprold $8,%ymm15,%ymm15 ++ vpaddd %ymm12,%ymm8,%ymm8 ++ vpaddd %ymm13,%ymm9,%ymm9 ++ vpaddd %ymm14,%ymm10,%ymm10 ++ vpaddd %ymm15,%ymm11,%ymm11 ++ vpxor %ymm8,%ymm4,%ymm4 ++ vpxor %ymm9,%ymm5,%ymm5 ++ vpxor %ymm10,%ymm6,%ymm6 ++ vpxor %ymm11,%ymm7,%ymm7 ++ vprold $7,%ymm4,%ymm4 ++ vprold $7,%ymm5,%ymm5 ++ vprold $7,%ymm6,%ymm6 ++ vprold $7,%ymm7,%ymm7 ++ vpaddd %ymm5,%ymm0,%ymm0 ++ vpaddd %ymm6,%ymm1,%ymm1 ++ vpaddd %ymm7,%ymm2,%ymm2 ++ vpaddd %ymm4,%ymm3,%ymm3 ++ vpxor %ymm0,%ymm15,%ymm15 ++ vpxor %ymm1,%ymm12,%ymm12 ++ vpxor %ymm2,%ymm13,%ymm13 ++ vpxor %ymm3,%ymm14,%ymm14 ++ vprold $16,%ymm15,%ymm15 ++ vprold $16,%ymm12,%ymm12 ++ vprold $16,%ymm13,%ymm13 ++ vprold $16,%ymm14,%ymm14 ++ vpaddd %ymm15,%ymm10,%ymm10 ++ vpaddd %ymm12,%ymm11,%ymm11 ++ vpaddd %ymm13,%ymm8,%ymm8 ++ vpaddd %ymm14,%ymm9,%ymm9 ++ vpxor %ymm10,%ymm5,%ymm5 ++ vpxor %ymm11,%ymm6,%ymm6 ++ vpxor %ymm8,%ymm7,%ymm7 ++ vpxor %ymm9,%ymm4,%ymm4 ++ vprold $12,%ymm5,%ymm5 ++ vprold $12,%ymm6,%ymm6 ++ vprold $12,%ymm7,%ymm7 ++ vprold $12,%ymm4,%ymm4 ++ vpaddd %ymm5,%ymm0,%ymm0 ++ vpaddd %ymm6,%ymm1,%ymm1 ++ vpaddd %ymm7,%ymm2,%ymm2 ++ vpaddd %ymm4,%ymm3,%ymm3 ++ vpxor %ymm0,%ymm15,%ymm15 ++ vpxor %ymm1,%ymm12,%ymm12 ++ vpxor %ymm2,%ymm13,%ymm13 ++ vpxor %ymm3,%ymm14,%ymm14 ++ vprold $8,%ymm15,%ymm15 ++ vprold $8,%ymm12,%ymm12 ++ vprold $8,%ymm13,%ymm13 ++ vprold $8,%ymm14,%ymm14 ++ vpaddd %ymm15,%ymm10,%ymm10 ++ vpaddd %ymm12,%ymm11,%ymm11 ++ vpaddd %ymm13,%ymm8,%ymm8 ++ vpaddd %ymm14,%ymm9,%ymm9 ++ vpxor %ymm10,%ymm5,%ymm5 ++ vpxor %ymm11,%ymm6,%ymm6 ++ vpxor %ymm8,%ymm7,%ymm7 ++ vpxor %ymm9,%ymm4,%ymm4 ++ vprold $7,%ymm5,%ymm5 ++ vprold $7,%ymm6,%ymm6 ++ vprold $7,%ymm7,%ymm7 ++ vprold $7,%ymm4,%ymm4 ++ decl %eax ++ jnz .Loop8xvl ++ ++ vpaddd %ymm16,%ymm0,%ymm0 ++ vpaddd %ymm17,%ymm1,%ymm1 ++ vpaddd %ymm18,%ymm2,%ymm2 ++ vpaddd %ymm19,%ymm3,%ymm3 ++ ++ vpunpckldq %ymm1,%ymm0,%ymm18 ++ vpunpckldq %ymm3,%ymm2,%ymm19 ++ vpunpckhdq %ymm1,%ymm0,%ymm0 ++ vpunpckhdq %ymm3,%ymm2,%ymm2 ++ vpunpcklqdq %ymm19,%ymm18,%ymm1 ++ vpunpckhqdq %ymm19,%ymm18,%ymm18 ++ vpunpcklqdq %ymm2,%ymm0,%ymm3 ++ vpunpckhqdq %ymm2,%ymm0,%ymm0 ++ vpaddd %ymm20,%ymm4,%ymm4 ++ vpaddd %ymm21,%ymm5,%ymm5 ++ vpaddd %ymm22,%ymm6,%ymm6 ++ vpaddd %ymm23,%ymm7,%ymm7 ++ ++ vpunpckldq %ymm5,%ymm4,%ymm2 ++ vpunpckldq %ymm7,%ymm6,%ymm19 ++ vpunpckhdq %ymm5,%ymm4,%ymm4 ++ vpunpckhdq %ymm7,%ymm6,%ymm6 ++ vpunpcklqdq %ymm19,%ymm2,%ymm5 ++ vpunpckhqdq %ymm19,%ymm2,%ymm2 ++ vpunpcklqdq %ymm6,%ymm4,%ymm7 ++ vpunpckhqdq %ymm6,%ymm4,%ymm4 ++ vshufi32x4 $0,%ymm5,%ymm1,%ymm19 ++ vshufi32x4 $3,%ymm5,%ymm1,%ymm5 ++ vshufi32x4 $0,%ymm2,%ymm18,%ymm1 ++ vshufi32x4 $3,%ymm2,%ymm18,%ymm2 ++ vshufi32x4 $0,%ymm7,%ymm3,%ymm18 ++ vshufi32x4 $3,%ymm7,%ymm3,%ymm7 ++ vshufi32x4 $0,%ymm4,%ymm0,%ymm3 ++ vshufi32x4 $3,%ymm4,%ymm0,%ymm4 ++ vpaddd %ymm24,%ymm8,%ymm8 ++ vpaddd %ymm25,%ymm9,%ymm9 ++ vpaddd %ymm26,%ymm10,%ymm10 ++ vpaddd %ymm27,%ymm11,%ymm11 ++ ++ vpunpckldq %ymm9,%ymm8,%ymm6 ++ vpunpckldq %ymm11,%ymm10,%ymm0 ++ vpunpckhdq %ymm9,%ymm8,%ymm8 ++ vpunpckhdq %ymm11,%ymm10,%ymm10 ++ vpunpcklqdq %ymm0,%ymm6,%ymm9 ++ vpunpckhqdq %ymm0,%ymm6,%ymm6 ++ vpunpcklqdq %ymm10,%ymm8,%ymm11 ++ vpunpckhqdq %ymm10,%ymm8,%ymm8 ++ vpaddd %ymm28,%ymm12,%ymm12 ++ vpaddd %ymm29,%ymm13,%ymm13 ++ vpaddd %ymm30,%ymm14,%ymm14 ++ vpaddd %ymm31,%ymm15,%ymm15 ++ ++ vpunpckldq %ymm13,%ymm12,%ymm10 ++ vpunpckldq %ymm15,%ymm14,%ymm0 ++ vpunpckhdq %ymm13,%ymm12,%ymm12 ++ vpunpckhdq %ymm15,%ymm14,%ymm14 ++ vpunpcklqdq %ymm0,%ymm10,%ymm13 ++ vpunpckhqdq %ymm0,%ymm10,%ymm10 ++ vpunpcklqdq %ymm14,%ymm12,%ymm15 ++ vpunpckhqdq %ymm14,%ymm12,%ymm12 ++ vperm2i128 $0x20,%ymm13,%ymm9,%ymm0 ++ vperm2i128 $0x31,%ymm13,%ymm9,%ymm13 ++ vperm2i128 $0x20,%ymm10,%ymm6,%ymm9 ++ vperm2i128 $0x31,%ymm10,%ymm6,%ymm10 ++ vperm2i128 $0x20,%ymm15,%ymm11,%ymm6 ++ vperm2i128 $0x31,%ymm15,%ymm11,%ymm15 ++ vperm2i128 $0x20,%ymm12,%ymm8,%ymm11 ++ vperm2i128 $0x31,%ymm12,%ymm8,%ymm12 ++ cmpq $512,%rdx ++ jb .Ltail8xvl ++ ++ movl $0x80,%eax ++ vpxord 0(%rsi),%ymm19,%ymm19 ++ vpxor 32(%rsi),%ymm0,%ymm0 ++ vpxor 64(%rsi),%ymm5,%ymm5 ++ vpxor 96(%rsi),%ymm13,%ymm13 ++ leaq (%rsi,%rax,1),%rsi ++ vmovdqu32 %ymm19,0(%rdi) ++ vmovdqu %ymm0,32(%rdi) ++ vmovdqu %ymm5,64(%rdi) ++ vmovdqu %ymm13,96(%rdi) ++ leaq (%rdi,%rax,1),%rdi ++ ++ vpxor 0(%rsi),%ymm1,%ymm1 ++ vpxor 32(%rsi),%ymm9,%ymm9 ++ vpxor 64(%rsi),%ymm2,%ymm2 ++ vpxor 96(%rsi),%ymm10,%ymm10 ++ leaq (%rsi,%rax,1),%rsi ++ vmovdqu %ymm1,0(%rdi) ++ vmovdqu %ymm9,32(%rdi) ++ vmovdqu %ymm2,64(%rdi) ++ vmovdqu %ymm10,96(%rdi) ++ leaq (%rdi,%rax,1),%rdi ++ ++ vpxord 0(%rsi),%ymm18,%ymm18 ++ vpxor 32(%rsi),%ymm6,%ymm6 ++ vpxor 64(%rsi),%ymm7,%ymm7 ++ vpxor 96(%rsi),%ymm15,%ymm15 ++ leaq (%rsi,%rax,1),%rsi ++ vmovdqu32 %ymm18,0(%rdi) ++ vmovdqu %ymm6,32(%rdi) ++ vmovdqu %ymm7,64(%rdi) ++ vmovdqu %ymm15,96(%rdi) ++ leaq (%rdi,%rax,1),%rdi ++ ++ vpxor 0(%rsi),%ymm3,%ymm3 ++ vpxor 32(%rsi),%ymm11,%ymm11 ++ vpxor 64(%rsi),%ymm4,%ymm4 ++ vpxor 96(%rsi),%ymm12,%ymm12 ++ leaq (%rsi,%rax,1),%rsi ++ vmovdqu %ymm3,0(%rdi) ++ vmovdqu %ymm11,32(%rdi) ++ vmovdqu %ymm4,64(%rdi) ++ vmovdqu %ymm12,96(%rdi) ++ leaq (%rdi,%rax,1),%rdi ++ ++ vpbroadcastd 0(%r9),%ymm0 ++ vpbroadcastd 4(%r9),%ymm1 ++ ++ subq $512,%rdx ++ jnz .Loop_outer8xvl ++ ++ jmp .Ldone8xvl ++ ++.align 32 ++.Ltail8xvl: ++ vmovdqa64 %ymm19,%ymm8 ++ xorq %r9,%r9 ++ subq %rsi,%rdi ++ cmpq $64,%rdx ++ jb .Less_than_64_8xvl ++ vpxor 0(%rsi),%ymm8,%ymm8 ++ vpxor 32(%rsi),%ymm0,%ymm0 ++ vmovdqu %ymm8,0(%rdi,%rsi,1) ++ vmovdqu %ymm0,32(%rdi,%rsi,1) ++ je .Ldone8xvl ++ vmovdqa %ymm5,%ymm8 ++ vmovdqa %ymm13,%ymm0 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $128,%rdx ++ jb .Less_than_64_8xvl ++ vpxor 0(%rsi),%ymm5,%ymm5 ++ vpxor 32(%rsi),%ymm13,%ymm13 ++ vmovdqu %ymm5,0(%rdi,%rsi,1) ++ vmovdqu %ymm13,32(%rdi,%rsi,1) ++ je .Ldone8xvl ++ vmovdqa %ymm1,%ymm8 ++ vmovdqa %ymm9,%ymm0 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $192,%rdx ++ jb .Less_than_64_8xvl ++ vpxor 0(%rsi),%ymm1,%ymm1 ++ vpxor 32(%rsi),%ymm9,%ymm9 ++ vmovdqu %ymm1,0(%rdi,%rsi,1) ++ vmovdqu %ymm9,32(%rdi,%rsi,1) ++ je .Ldone8xvl ++ vmovdqa %ymm2,%ymm8 ++ vmovdqa %ymm10,%ymm0 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $256,%rdx ++ jb .Less_than_64_8xvl ++ vpxor 0(%rsi),%ymm2,%ymm2 ++ vpxor 32(%rsi),%ymm10,%ymm10 ++ vmovdqu %ymm2,0(%rdi,%rsi,1) ++ vmovdqu %ymm10,32(%rdi,%rsi,1) ++ je .Ldone8xvl ++ vmovdqa32 %ymm18,%ymm8 ++ vmovdqa %ymm6,%ymm0 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $320,%rdx ++ jb .Less_than_64_8xvl ++ vpxord 0(%rsi),%ymm18,%ymm18 ++ vpxor 32(%rsi),%ymm6,%ymm6 ++ vmovdqu32 %ymm18,0(%rdi,%rsi,1) ++ vmovdqu %ymm6,32(%rdi,%rsi,1) ++ je .Ldone8xvl ++ vmovdqa %ymm7,%ymm8 ++ vmovdqa %ymm15,%ymm0 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $384,%rdx ++ jb .Less_than_64_8xvl ++ vpxor 0(%rsi),%ymm7,%ymm7 ++ vpxor 32(%rsi),%ymm15,%ymm15 ++ vmovdqu %ymm7,0(%rdi,%rsi,1) ++ vmovdqu %ymm15,32(%rdi,%rsi,1) ++ je .Ldone8xvl ++ vmovdqa %ymm3,%ymm8 ++ vmovdqa %ymm11,%ymm0 ++ leaq 64(%rsi),%rsi ++ ++ cmpq $448,%rdx ++ jb .Less_than_64_8xvl ++ vpxor 0(%rsi),%ymm3,%ymm3 ++ vpxor 32(%rsi),%ymm11,%ymm11 ++ vmovdqu %ymm3,0(%rdi,%rsi,1) ++ vmovdqu %ymm11,32(%rdi,%rsi,1) ++ je .Ldone8xvl ++ vmovdqa %ymm4,%ymm8 ++ vmovdqa %ymm12,%ymm0 ++ leaq 64(%rsi),%rsi ++ ++.Less_than_64_8xvl: ++ vmovdqa %ymm8,0(%rsp) ++ vmovdqa %ymm0,32(%rsp) ++ leaq (%rdi,%rsi,1),%rdi ++ andq $63,%rdx ++ ++.Loop_tail8xvl: ++ movzbl (%rsi,%r9,1),%eax ++ movzbl (%rsp,%r9,1),%ecx ++ leaq 1(%r9),%r9 ++ xorl %ecx,%eax ++ movb %al,-1(%rdi,%r9,1) ++ decq %rdx ++ jnz .Loop_tail8xvl ++ ++ vpxor %ymm8,%ymm8,%ymm8 ++ vmovdqa %ymm8,0(%rsp) ++ vmovdqa %ymm8,32(%rsp) ++ ++.Ldone8xvl: ++ vzeroall ++ leaq -8(%r10),%rsp ++.L8xvl_epilogue: ++ ret ++ENDPROC(chacha20_avx512vl) ++ ++#endif /* CONFIG_AS_AVX512 */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/curve25519-arm.S 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,2110 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * ++ * Based on algorithms from Daniel J. Bernstein and Peter Schwabe. ++ */ ++ ++#if IS_ENABLED(CONFIG_KERNEL_MODE_NEON) ++ ++#include ++ ++ .text ++ .fpu neon ++ .align 4 ++ ++ENTRY(curve25519_neon) ++ vpush {q4,q5,q6,q7} ++ mov r12,sp ++ sub r3,sp,#736 ++ and r3,r3,#0xffffffe0 ++ mov sp,r3 ++ strd r4,[sp,#0] ++ strd r6,[sp,#8] ++ strd r8,[sp,#16] ++ strd r10,[sp,#24] ++ str r12,[sp,#480] ++ str r14,[sp,#484] ++ mov r0,r0 ++ mov r1,r1 ++ mov r2,r2 ++ add r3,sp,#32 ++ ldr r4,=0 ++ ldr r5,=254 ++ vmov.i32 q0,#1 ++ vshr.u64 q1,q0,#7 ++ vshr.u64 q0,q0,#8 ++ vmov.i32 d4,#19 ++ vmov.i32 d5,#38 ++ add r6,sp,#512 ++ vst1.8 {d2-d3},[r6,: 128] ++ add r6,sp,#528 ++ vst1.8 {d0-d1},[r6,: 128] ++ add r6,sp,#544 ++ vst1.8 {d4-d5},[r6,: 128] ++ add r6,r3,#0 ++ vmov.i32 q2,#0 ++ vst1.8 {d4-d5},[r6,: 128]! ++ vst1.8 {d4-d5},[r6,: 128]! ++ vst1.8 d4,[r6,: 64] ++ add r6,r3,#0 ++ ldr r7,=960 ++ sub r7,r7,#2 ++ neg r7,r7 ++ sub r7,r7,r7,LSL #7 ++ str r7,[r6] ++ add r6,sp,#704 ++ vld1.8 {d4-d5},[r1]! ++ vld1.8 {d6-d7},[r1] ++ vst1.8 {d4-d5},[r6,: 128]! ++ vst1.8 {d6-d7},[r6,: 128] ++ sub r1,r6,#16 ++ ldrb r6,[r1] ++ and r6,r6,#248 ++ strb r6,[r1] ++ ldrb r6,[r1,#31] ++ and r6,r6,#127 ++ orr r6,r6,#64 ++ strb r6,[r1,#31] ++ vmov.i64 q2,#0xffffffff ++ vshr.u64 q3,q2,#7 ++ vshr.u64 q2,q2,#6 ++ vld1.8 {d8},[r2] ++ vld1.8 {d10},[r2] ++ add r2,r2,#6 ++ vld1.8 {d12},[r2] ++ vld1.8 {d14},[r2] ++ add r2,r2,#6 ++ vld1.8 {d16},[r2] ++ add r2,r2,#4 ++ vld1.8 {d18},[r2] ++ vld1.8 {d20},[r2] ++ add r2,r2,#6 ++ vld1.8 {d22},[r2] ++ add r2,r2,#2 ++ vld1.8 {d24},[r2] ++ vld1.8 {d26},[r2] ++ vshr.u64 q5,q5,#26 ++ vshr.u64 q6,q6,#3 ++ vshr.u64 q7,q7,#29 ++ vshr.u64 q8,q8,#6 ++ vshr.u64 q10,q10,#25 ++ vshr.u64 q11,q11,#3 ++ vshr.u64 q12,q12,#12 ++ vshr.u64 q13,q13,#38 ++ vand q4,q4,q2 ++ vand q6,q6,q2 ++ vand q8,q8,q2 ++ vand q10,q10,q2 ++ vand q2,q12,q2 ++ vand q5,q5,q3 ++ vand q7,q7,q3 ++ vand q9,q9,q3 ++ vand q11,q11,q3 ++ vand q3,q13,q3 ++ add r2,r3,#48 ++ vadd.i64 q12,q4,q1 ++ vadd.i64 q13,q10,q1 ++ vshr.s64 q12,q12,#26 ++ vshr.s64 q13,q13,#26 ++ vadd.i64 q5,q5,q12 ++ vshl.i64 q12,q12,#26 ++ vadd.i64 q14,q5,q0 ++ vadd.i64 q11,q11,q13 ++ vshl.i64 q13,q13,#26 ++ vadd.i64 q15,q11,q0 ++ vsub.i64 q4,q4,q12 ++ vshr.s64 q12,q14,#25 ++ vsub.i64 q10,q10,q13 ++ vshr.s64 q13,q15,#25 ++ vadd.i64 q6,q6,q12 ++ vshl.i64 q12,q12,#25 ++ vadd.i64 q14,q6,q1 ++ vadd.i64 q2,q2,q13 ++ vsub.i64 q5,q5,q12 ++ vshr.s64 q12,q14,#26 ++ vshl.i64 q13,q13,#25 ++ vadd.i64 q14,q2,q1 ++ vadd.i64 q7,q7,q12 ++ vshl.i64 q12,q12,#26 ++ vadd.i64 q15,q7,q0 ++ vsub.i64 q11,q11,q13 ++ vshr.s64 q13,q14,#26 ++ vsub.i64 q6,q6,q12 ++ vshr.s64 q12,q15,#25 ++ vadd.i64 q3,q3,q13 ++ vshl.i64 q13,q13,#26 ++ vadd.i64 q14,q3,q0 ++ vadd.i64 q8,q8,q12 ++ vshl.i64 q12,q12,#25 ++ vadd.i64 q15,q8,q1 ++ add r2,r2,#8 ++ vsub.i64 q2,q2,q13 ++ vshr.s64 q13,q14,#25 ++ vsub.i64 q7,q7,q12 ++ vshr.s64 q12,q15,#26 ++ vadd.i64 q14,q13,q13 ++ vadd.i64 q9,q9,q12 ++ vtrn.32 d12,d14 ++ vshl.i64 q12,q12,#26 ++ vtrn.32 d13,d15 ++ vadd.i64 q0,q9,q0 ++ vadd.i64 q4,q4,q14 ++ vst1.8 d12,[r2,: 64]! ++ vshl.i64 q6,q13,#4 ++ vsub.i64 q7,q8,q12 ++ vshr.s64 q0,q0,#25 ++ vadd.i64 q4,q4,q6 ++ vadd.i64 q6,q10,q0 ++ vshl.i64 q0,q0,#25 ++ vadd.i64 q8,q6,q1 ++ vadd.i64 q4,q4,q13 ++ vshl.i64 q10,q13,#25 ++ vadd.i64 q1,q4,q1 ++ vsub.i64 q0,q9,q0 ++ vshr.s64 q8,q8,#26 ++ vsub.i64 q3,q3,q10 ++ vtrn.32 d14,d0 ++ vshr.s64 q1,q1,#26 ++ vtrn.32 d15,d1 ++ vadd.i64 q0,q11,q8 ++ vst1.8 d14,[r2,: 64] ++ vshl.i64 q7,q8,#26 ++ vadd.i64 q5,q5,q1 ++ vtrn.32 d4,d6 ++ vshl.i64 q1,q1,#26 ++ vtrn.32 d5,d7 ++ vsub.i64 q3,q6,q7 ++ add r2,r2,#16 ++ vsub.i64 q1,q4,q1 ++ vst1.8 d4,[r2,: 64] ++ vtrn.32 d6,d0 ++ vtrn.32 d7,d1 ++ sub r2,r2,#8 ++ vtrn.32 d2,d10 ++ vtrn.32 d3,d11 ++ vst1.8 d6,[r2,: 64] ++ sub r2,r2,#24 ++ vst1.8 d2,[r2,: 64] ++ add r2,r3,#96 ++ vmov.i32 q0,#0 ++ vmov.i64 d2,#0xff ++ vmov.i64 d3,#0 ++ vshr.u32 q1,q1,#7 ++ vst1.8 {d2-d3},[r2,: 128]! ++ vst1.8 {d0-d1},[r2,: 128]! ++ vst1.8 d0,[r2,: 64] ++ add r2,r3,#144 ++ vmov.i32 q0,#0 ++ vst1.8 {d0-d1},[r2,: 128]! ++ vst1.8 {d0-d1},[r2,: 128]! ++ vst1.8 d0,[r2,: 64] ++ add r2,r3,#240 ++ vmov.i32 q0,#0 ++ vmov.i64 d2,#0xff ++ vmov.i64 d3,#0 ++ vshr.u32 q1,q1,#7 ++ vst1.8 {d2-d3},[r2,: 128]! ++ vst1.8 {d0-d1},[r2,: 128]! ++ vst1.8 d0,[r2,: 64] ++ add r2,r3,#48 ++ add r6,r3,#192 ++ vld1.8 {d0-d1},[r2,: 128]! ++ vld1.8 {d2-d3},[r2,: 128]! ++ vld1.8 {d4},[r2,: 64] ++ vst1.8 {d0-d1},[r6,: 128]! ++ vst1.8 {d2-d3},[r6,: 128]! ++ vst1.8 d4,[r6,: 64] ++ .Lmainloop: ++ mov r2,r5,LSR #3 ++ and r6,r5,#7 ++ ldrb r2,[r1,r2] ++ mov r2,r2,LSR r6 ++ and r2,r2,#1 ++ str r5,[sp,#488] ++ eor r4,r4,r2 ++ str r2,[sp,#492] ++ neg r2,r4 ++ add r4,r3,#96 ++ add r5,r3,#192 ++ add r6,r3,#144 ++ vld1.8 {d8-d9},[r4,: 128]! ++ add r7,r3,#240 ++ vld1.8 {d10-d11},[r5,: 128]! ++ veor q6,q4,q5 ++ vld1.8 {d14-d15},[r6,: 128]! ++ vdup.i32 q8,r2 ++ vld1.8 {d18-d19},[r7,: 128]! ++ veor q10,q7,q9 ++ vld1.8 {d22-d23},[r4,: 128]! ++ vand q6,q6,q8 ++ vld1.8 {d24-d25},[r5,: 128]! ++ vand q10,q10,q8 ++ vld1.8 {d26-d27},[r6,: 128]! ++ veor q4,q4,q6 ++ vld1.8 {d28-d29},[r7,: 128]! ++ veor q5,q5,q6 ++ vld1.8 {d0},[r4,: 64] ++ veor q6,q7,q10 ++ vld1.8 {d2},[r5,: 64] ++ veor q7,q9,q10 ++ vld1.8 {d4},[r6,: 64] ++ veor q9,q11,q12 ++ vld1.8 {d6},[r7,: 64] ++ veor q10,q0,q1 ++ sub r2,r4,#32 ++ vand q9,q9,q8 ++ sub r4,r5,#32 ++ vand q10,q10,q8 ++ sub r5,r6,#32 ++ veor q11,q11,q9 ++ sub r6,r7,#32 ++ veor q0,q0,q10 ++ veor q9,q12,q9 ++ veor q1,q1,q10 ++ veor q10,q13,q14 ++ veor q12,q2,q3 ++ vand q10,q10,q8 ++ vand q8,q12,q8 ++ veor q12,q13,q10 ++ veor q2,q2,q8 ++ veor q10,q14,q10 ++ veor q3,q3,q8 ++ vadd.i32 q8,q4,q6 ++ vsub.i32 q4,q4,q6 ++ vst1.8 {d16-d17},[r2,: 128]! ++ vadd.i32 q6,q11,q12 ++ vst1.8 {d8-d9},[r5,: 128]! ++ vsub.i32 q4,q11,q12 ++ vst1.8 {d12-d13},[r2,: 128]! ++ vadd.i32 q6,q0,q2 ++ vst1.8 {d8-d9},[r5,: 128]! ++ vsub.i32 q0,q0,q2 ++ vst1.8 d12,[r2,: 64] ++ vadd.i32 q2,q5,q7 ++ vst1.8 d0,[r5,: 64] ++ vsub.i32 q0,q5,q7 ++ vst1.8 {d4-d5},[r4,: 128]! ++ vadd.i32 q2,q9,q10 ++ vst1.8 {d0-d1},[r6,: 128]! ++ vsub.i32 q0,q9,q10 ++ vst1.8 {d4-d5},[r4,: 128]! ++ vadd.i32 q2,q1,q3 ++ vst1.8 {d0-d1},[r6,: 128]! ++ vsub.i32 q0,q1,q3 ++ vst1.8 d4,[r4,: 64] ++ vst1.8 d0,[r6,: 64] ++ add r2,sp,#544 ++ add r4,r3,#96 ++ add r5,r3,#144 ++ vld1.8 {d0-d1},[r2,: 128] ++ vld1.8 {d2-d3},[r4,: 128]! ++ vld1.8 {d4-d5},[r5,: 128]! ++ vzip.i32 q1,q2 ++ vld1.8 {d6-d7},[r4,: 128]! ++ vld1.8 {d8-d9},[r5,: 128]! ++ vshl.i32 q5,q1,#1 ++ vzip.i32 q3,q4 ++ vshl.i32 q6,q2,#1 ++ vld1.8 {d14},[r4,: 64] ++ vshl.i32 q8,q3,#1 ++ vld1.8 {d15},[r5,: 64] ++ vshl.i32 q9,q4,#1 ++ vmul.i32 d21,d7,d1 ++ vtrn.32 d14,d15 ++ vmul.i32 q11,q4,q0 ++ vmul.i32 q0,q7,q0 ++ vmull.s32 q12,d2,d2 ++ vmlal.s32 q12,d11,d1 ++ vmlal.s32 q12,d12,d0 ++ vmlal.s32 q12,d13,d23 ++ vmlal.s32 q12,d16,d22 ++ vmlal.s32 q12,d7,d21 ++ vmull.s32 q10,d2,d11 ++ vmlal.s32 q10,d4,d1 ++ vmlal.s32 q10,d13,d0 ++ vmlal.s32 q10,d6,d23 ++ vmlal.s32 q10,d17,d22 ++ vmull.s32 q13,d10,d4 ++ vmlal.s32 q13,d11,d3 ++ vmlal.s32 q13,d13,d1 ++ vmlal.s32 q13,d16,d0 ++ vmlal.s32 q13,d17,d23 ++ vmlal.s32 q13,d8,d22 ++ vmull.s32 q1,d10,d5 ++ vmlal.s32 q1,d11,d4 ++ vmlal.s32 q1,d6,d1 ++ vmlal.s32 q1,d17,d0 ++ vmlal.s32 q1,d8,d23 ++ vmull.s32 q14,d10,d6 ++ vmlal.s32 q14,d11,d13 ++ vmlal.s32 q14,d4,d4 ++ vmlal.s32 q14,d17,d1 ++ vmlal.s32 q14,d18,d0 ++ vmlal.s32 q14,d9,d23 ++ vmull.s32 q11,d10,d7 ++ vmlal.s32 q11,d11,d6 ++ vmlal.s32 q11,d12,d5 ++ vmlal.s32 q11,d8,d1 ++ vmlal.s32 q11,d19,d0 ++ vmull.s32 q15,d10,d8 ++ vmlal.s32 q15,d11,d17 ++ vmlal.s32 q15,d12,d6 ++ vmlal.s32 q15,d13,d5 ++ vmlal.s32 q15,d19,d1 ++ vmlal.s32 q15,d14,d0 ++ vmull.s32 q2,d10,d9 ++ vmlal.s32 q2,d11,d8 ++ vmlal.s32 q2,d12,d7 ++ vmlal.s32 q2,d13,d6 ++ vmlal.s32 q2,d14,d1 ++ vmull.s32 q0,d15,d1 ++ vmlal.s32 q0,d10,d14 ++ vmlal.s32 q0,d11,d19 ++ vmlal.s32 q0,d12,d8 ++ vmlal.s32 q0,d13,d17 ++ vmlal.s32 q0,d6,d6 ++ add r2,sp,#512 ++ vld1.8 {d18-d19},[r2,: 128] ++ vmull.s32 q3,d16,d7 ++ vmlal.s32 q3,d10,d15 ++ vmlal.s32 q3,d11,d14 ++ vmlal.s32 q3,d12,d9 ++ vmlal.s32 q3,d13,d8 ++ add r2,sp,#528 ++ vld1.8 {d8-d9},[r2,: 128] ++ vadd.i64 q5,q12,q9 ++ vadd.i64 q6,q15,q9 ++ vshr.s64 q5,q5,#26 ++ vshr.s64 q6,q6,#26 ++ vadd.i64 q7,q10,q5 ++ vshl.i64 q5,q5,#26 ++ vadd.i64 q8,q7,q4 ++ vadd.i64 q2,q2,q6 ++ vshl.i64 q6,q6,#26 ++ vadd.i64 q10,q2,q4 ++ vsub.i64 q5,q12,q5 ++ vshr.s64 q8,q8,#25 ++ vsub.i64 q6,q15,q6 ++ vshr.s64 q10,q10,#25 ++ vadd.i64 q12,q13,q8 ++ vshl.i64 q8,q8,#25 ++ vadd.i64 q13,q12,q9 ++ vadd.i64 q0,q0,q10 ++ vsub.i64 q7,q7,q8 ++ vshr.s64 q8,q13,#26 ++ vshl.i64 q10,q10,#25 ++ vadd.i64 q13,q0,q9 ++ vadd.i64 q1,q1,q8 ++ vshl.i64 q8,q8,#26 ++ vadd.i64 q15,q1,q4 ++ vsub.i64 q2,q2,q10 ++ vshr.s64 q10,q13,#26 ++ vsub.i64 q8,q12,q8 ++ vshr.s64 q12,q15,#25 ++ vadd.i64 q3,q3,q10 ++ vshl.i64 q10,q10,#26 ++ vadd.i64 q13,q3,q4 ++ vadd.i64 q14,q14,q12 ++ add r2,r3,#288 ++ vshl.i64 q12,q12,#25 ++ add r4,r3,#336 ++ vadd.i64 q15,q14,q9 ++ add r2,r2,#8 ++ vsub.i64 q0,q0,q10 ++ add r4,r4,#8 ++ vshr.s64 q10,q13,#25 ++ vsub.i64 q1,q1,q12 ++ vshr.s64 q12,q15,#26 ++ vadd.i64 q13,q10,q10 ++ vadd.i64 q11,q11,q12 ++ vtrn.32 d16,d2 ++ vshl.i64 q12,q12,#26 ++ vtrn.32 d17,d3 ++ vadd.i64 q1,q11,q4 ++ vadd.i64 q4,q5,q13 ++ vst1.8 d16,[r2,: 64]! ++ vshl.i64 q5,q10,#4 ++ vst1.8 d17,[r4,: 64]! ++ vsub.i64 q8,q14,q12 ++ vshr.s64 q1,q1,#25 ++ vadd.i64 q4,q4,q5 ++ vadd.i64 q5,q6,q1 ++ vshl.i64 q1,q1,#25 ++ vadd.i64 q6,q5,q9 ++ vadd.i64 q4,q4,q10 ++ vshl.i64 q10,q10,#25 ++ vadd.i64 q9,q4,q9 ++ vsub.i64 q1,q11,q1 ++ vshr.s64 q6,q6,#26 ++ vsub.i64 q3,q3,q10 ++ vtrn.32 d16,d2 ++ vshr.s64 q9,q9,#26 ++ vtrn.32 d17,d3 ++ vadd.i64 q1,q2,q6 ++ vst1.8 d16,[r2,: 64] ++ vshl.i64 q2,q6,#26 ++ vst1.8 d17,[r4,: 64] ++ vadd.i64 q6,q7,q9 ++ vtrn.32 d0,d6 ++ vshl.i64 q7,q9,#26 ++ vtrn.32 d1,d7 ++ vsub.i64 q2,q5,q2 ++ add r2,r2,#16 ++ vsub.i64 q3,q4,q7 ++ vst1.8 d0,[r2,: 64] ++ add r4,r4,#16 ++ vst1.8 d1,[r4,: 64] ++ vtrn.32 d4,d2 ++ vtrn.32 d5,d3 ++ sub r2,r2,#8 ++ sub r4,r4,#8 ++ vtrn.32 d6,d12 ++ vtrn.32 d7,d13 ++ vst1.8 d4,[r2,: 64] ++ vst1.8 d5,[r4,: 64] ++ sub r2,r2,#24 ++ sub r4,r4,#24 ++ vst1.8 d6,[r2,: 64] ++ vst1.8 d7,[r4,: 64] ++ add r2,r3,#240 ++ add r4,r3,#96 ++ vld1.8 {d0-d1},[r4,: 128]! ++ vld1.8 {d2-d3},[r4,: 128]! ++ vld1.8 {d4},[r4,: 64] ++ add r4,r3,#144 ++ vld1.8 {d6-d7},[r4,: 128]! ++ vtrn.32 q0,q3 ++ vld1.8 {d8-d9},[r4,: 128]! ++ vshl.i32 q5,q0,#4 ++ vtrn.32 q1,q4 ++ vshl.i32 q6,q3,#4 ++ vadd.i32 q5,q5,q0 ++ vadd.i32 q6,q6,q3 ++ vshl.i32 q7,q1,#4 ++ vld1.8 {d5},[r4,: 64] ++ vshl.i32 q8,q4,#4 ++ vtrn.32 d4,d5 ++ vadd.i32 q7,q7,q1 ++ vadd.i32 q8,q8,q4 ++ vld1.8 {d18-d19},[r2,: 128]! ++ vshl.i32 q10,q2,#4 ++ vld1.8 {d22-d23},[r2,: 128]! ++ vadd.i32 q10,q10,q2 ++ vld1.8 {d24},[r2,: 64] ++ vadd.i32 q5,q5,q0 ++ add r2,r3,#192 ++ vld1.8 {d26-d27},[r2,: 128]! ++ vadd.i32 q6,q6,q3 ++ vld1.8 {d28-d29},[r2,: 128]! ++ vadd.i32 q8,q8,q4 ++ vld1.8 {d25},[r2,: 64] ++ vadd.i32 q10,q10,q2 ++ vtrn.32 q9,q13 ++ vadd.i32 q7,q7,q1 ++ vadd.i32 q5,q5,q0 ++ vtrn.32 q11,q14 ++ vadd.i32 q6,q6,q3 ++ add r2,sp,#560 ++ vadd.i32 q10,q10,q2 ++ vtrn.32 d24,d25 ++ vst1.8 {d12-d13},[r2,: 128] ++ vshl.i32 q6,q13,#1 ++ add r2,sp,#576 ++ vst1.8 {d20-d21},[r2,: 128] ++ vshl.i32 q10,q14,#1 ++ add r2,sp,#592 ++ vst1.8 {d12-d13},[r2,: 128] ++ vshl.i32 q15,q12,#1 ++ vadd.i32 q8,q8,q4 ++ vext.32 d10,d31,d30,#0 ++ vadd.i32 q7,q7,q1 ++ add r2,sp,#608 ++ vst1.8 {d16-d17},[r2,: 128] ++ vmull.s32 q8,d18,d5 ++ vmlal.s32 q8,d26,d4 ++ vmlal.s32 q8,d19,d9 ++ vmlal.s32 q8,d27,d3 ++ vmlal.s32 q8,d22,d8 ++ vmlal.s32 q8,d28,d2 ++ vmlal.s32 q8,d23,d7 ++ vmlal.s32 q8,d29,d1 ++ vmlal.s32 q8,d24,d6 ++ vmlal.s32 q8,d25,d0 ++ add r2,sp,#624 ++ vst1.8 {d14-d15},[r2,: 128] ++ vmull.s32 q2,d18,d4 ++ vmlal.s32 q2,d12,d9 ++ vmlal.s32 q2,d13,d8 ++ vmlal.s32 q2,d19,d3 ++ vmlal.s32 q2,d22,d2 ++ vmlal.s32 q2,d23,d1 ++ vmlal.s32 q2,d24,d0 ++ add r2,sp,#640 ++ vst1.8 {d20-d21},[r2,: 128] ++ vmull.s32 q7,d18,d9 ++ vmlal.s32 q7,d26,d3 ++ vmlal.s32 q7,d19,d8 ++ vmlal.s32 q7,d27,d2 ++ vmlal.s32 q7,d22,d7 ++ vmlal.s32 q7,d28,d1 ++ vmlal.s32 q7,d23,d6 ++ vmlal.s32 q7,d29,d0 ++ add r2,sp,#656 ++ vst1.8 {d10-d11},[r2,: 128] ++ vmull.s32 q5,d18,d3 ++ vmlal.s32 q5,d19,d2 ++ vmlal.s32 q5,d22,d1 ++ vmlal.s32 q5,d23,d0 ++ vmlal.s32 q5,d12,d8 ++ add r2,sp,#672 ++ vst1.8 {d16-d17},[r2,: 128] ++ vmull.s32 q4,d18,d8 ++ vmlal.s32 q4,d26,d2 ++ vmlal.s32 q4,d19,d7 ++ vmlal.s32 q4,d27,d1 ++ vmlal.s32 q4,d22,d6 ++ vmlal.s32 q4,d28,d0 ++ vmull.s32 q8,d18,d7 ++ vmlal.s32 q8,d26,d1 ++ vmlal.s32 q8,d19,d6 ++ vmlal.s32 q8,d27,d0 ++ add r2,sp,#576 ++ vld1.8 {d20-d21},[r2,: 128] ++ vmlal.s32 q7,d24,d21 ++ vmlal.s32 q7,d25,d20 ++ vmlal.s32 q4,d23,d21 ++ vmlal.s32 q4,d29,d20 ++ vmlal.s32 q8,d22,d21 ++ vmlal.s32 q8,d28,d20 ++ vmlal.s32 q5,d24,d20 ++ add r2,sp,#576 ++ vst1.8 {d14-d15},[r2,: 128] ++ vmull.s32 q7,d18,d6 ++ vmlal.s32 q7,d26,d0 ++ add r2,sp,#656 ++ vld1.8 {d30-d31},[r2,: 128] ++ vmlal.s32 q2,d30,d21 ++ vmlal.s32 q7,d19,d21 ++ vmlal.s32 q7,d27,d20 ++ add r2,sp,#624 ++ vld1.8 {d26-d27},[r2,: 128] ++ vmlal.s32 q4,d25,d27 ++ vmlal.s32 q8,d29,d27 ++ vmlal.s32 q8,d25,d26 ++ vmlal.s32 q7,d28,d27 ++ vmlal.s32 q7,d29,d26 ++ add r2,sp,#608 ++ vld1.8 {d28-d29},[r2,: 128] ++ vmlal.s32 q4,d24,d29 ++ vmlal.s32 q8,d23,d29 ++ vmlal.s32 q8,d24,d28 ++ vmlal.s32 q7,d22,d29 ++ vmlal.s32 q7,d23,d28 ++ add r2,sp,#608 ++ vst1.8 {d8-d9},[r2,: 128] ++ add r2,sp,#560 ++ vld1.8 {d8-d9},[r2,: 128] ++ vmlal.s32 q7,d24,d9 ++ vmlal.s32 q7,d25,d31 ++ vmull.s32 q1,d18,d2 ++ vmlal.s32 q1,d19,d1 ++ vmlal.s32 q1,d22,d0 ++ vmlal.s32 q1,d24,d27 ++ vmlal.s32 q1,d23,d20 ++ vmlal.s32 q1,d12,d7 ++ vmlal.s32 q1,d13,d6 ++ vmull.s32 q6,d18,d1 ++ vmlal.s32 q6,d19,d0 ++ vmlal.s32 q6,d23,d27 ++ vmlal.s32 q6,d22,d20 ++ vmlal.s32 q6,d24,d26 ++ vmull.s32 q0,d18,d0 ++ vmlal.s32 q0,d22,d27 ++ vmlal.s32 q0,d23,d26 ++ vmlal.s32 q0,d24,d31 ++ vmlal.s32 q0,d19,d20 ++ add r2,sp,#640 ++ vld1.8 {d18-d19},[r2,: 128] ++ vmlal.s32 q2,d18,d7 ++ vmlal.s32 q2,d19,d6 ++ vmlal.s32 q5,d18,d6 ++ vmlal.s32 q5,d19,d21 ++ vmlal.s32 q1,d18,d21 ++ vmlal.s32 q1,d19,d29 ++ vmlal.s32 q0,d18,d28 ++ vmlal.s32 q0,d19,d9 ++ vmlal.s32 q6,d18,d29 ++ vmlal.s32 q6,d19,d28 ++ add r2,sp,#592 ++ vld1.8 {d18-d19},[r2,: 128] ++ add r2,sp,#512 ++ vld1.8 {d22-d23},[r2,: 128] ++ vmlal.s32 q5,d19,d7 ++ vmlal.s32 q0,d18,d21 ++ vmlal.s32 q0,d19,d29 ++ vmlal.s32 q6,d18,d6 ++ add r2,sp,#528 ++ vld1.8 {d6-d7},[r2,: 128] ++ vmlal.s32 q6,d19,d21 ++ add r2,sp,#576 ++ vld1.8 {d18-d19},[r2,: 128] ++ vmlal.s32 q0,d30,d8 ++ add r2,sp,#672 ++ vld1.8 {d20-d21},[r2,: 128] ++ vmlal.s32 q5,d30,d29 ++ add r2,sp,#608 ++ vld1.8 {d24-d25},[r2,: 128] ++ vmlal.s32 q1,d30,d28 ++ vadd.i64 q13,q0,q11 ++ vadd.i64 q14,q5,q11 ++ vmlal.s32 q6,d30,d9 ++ vshr.s64 q4,q13,#26 ++ vshr.s64 q13,q14,#26 ++ vadd.i64 q7,q7,q4 ++ vshl.i64 q4,q4,#26 ++ vadd.i64 q14,q7,q3 ++ vadd.i64 q9,q9,q13 ++ vshl.i64 q13,q13,#26 ++ vadd.i64 q15,q9,q3 ++ vsub.i64 q0,q0,q4 ++ vshr.s64 q4,q14,#25 ++ vsub.i64 q5,q5,q13 ++ vshr.s64 q13,q15,#25 ++ vadd.i64 q6,q6,q4 ++ vshl.i64 q4,q4,#25 ++ vadd.i64 q14,q6,q11 ++ vadd.i64 q2,q2,q13 ++ vsub.i64 q4,q7,q4 ++ vshr.s64 q7,q14,#26 ++ vshl.i64 q13,q13,#25 ++ vadd.i64 q14,q2,q11 ++ vadd.i64 q8,q8,q7 ++ vshl.i64 q7,q7,#26 ++ vadd.i64 q15,q8,q3 ++ vsub.i64 q9,q9,q13 ++ vshr.s64 q13,q14,#26 ++ vsub.i64 q6,q6,q7 ++ vshr.s64 q7,q15,#25 ++ vadd.i64 q10,q10,q13 ++ vshl.i64 q13,q13,#26 ++ vadd.i64 q14,q10,q3 ++ vadd.i64 q1,q1,q7 ++ add r2,r3,#144 ++ vshl.i64 q7,q7,#25 ++ add r4,r3,#96 ++ vadd.i64 q15,q1,q11 ++ add r2,r2,#8 ++ vsub.i64 q2,q2,q13 ++ add r4,r4,#8 ++ vshr.s64 q13,q14,#25 ++ vsub.i64 q7,q8,q7 ++ vshr.s64 q8,q15,#26 ++ vadd.i64 q14,q13,q13 ++ vadd.i64 q12,q12,q8 ++ vtrn.32 d12,d14 ++ vshl.i64 q8,q8,#26 ++ vtrn.32 d13,d15 ++ vadd.i64 q3,q12,q3 ++ vadd.i64 q0,q0,q14 ++ vst1.8 d12,[r2,: 64]! ++ vshl.i64 q7,q13,#4 ++ vst1.8 d13,[r4,: 64]! ++ vsub.i64 q1,q1,q8 ++ vshr.s64 q3,q3,#25 ++ vadd.i64 q0,q0,q7 ++ vadd.i64 q5,q5,q3 ++ vshl.i64 q3,q3,#25 ++ vadd.i64 q6,q5,q11 ++ vadd.i64 q0,q0,q13 ++ vshl.i64 q7,q13,#25 ++ vadd.i64 q8,q0,q11 ++ vsub.i64 q3,q12,q3 ++ vshr.s64 q6,q6,#26 ++ vsub.i64 q7,q10,q7 ++ vtrn.32 d2,d6 ++ vshr.s64 q8,q8,#26 ++ vtrn.32 d3,d7 ++ vadd.i64 q3,q9,q6 ++ vst1.8 d2,[r2,: 64] ++ vshl.i64 q6,q6,#26 ++ vst1.8 d3,[r4,: 64] ++ vadd.i64 q1,q4,q8 ++ vtrn.32 d4,d14 ++ vshl.i64 q4,q8,#26 ++ vtrn.32 d5,d15 ++ vsub.i64 q5,q5,q6 ++ add r2,r2,#16 ++ vsub.i64 q0,q0,q4 ++ vst1.8 d4,[r2,: 64] ++ add r4,r4,#16 ++ vst1.8 d5,[r4,: 64] ++ vtrn.32 d10,d6 ++ vtrn.32 d11,d7 ++ sub r2,r2,#8 ++ sub r4,r4,#8 ++ vtrn.32 d0,d2 ++ vtrn.32 d1,d3 ++ vst1.8 d10,[r2,: 64] ++ vst1.8 d11,[r4,: 64] ++ sub r2,r2,#24 ++ sub r4,r4,#24 ++ vst1.8 d0,[r2,: 64] ++ vst1.8 d1,[r4,: 64] ++ add r2,r3,#288 ++ add r4,r3,#336 ++ vld1.8 {d0-d1},[r2,: 128]! ++ vld1.8 {d2-d3},[r4,: 128]! ++ vsub.i32 q0,q0,q1 ++ vld1.8 {d2-d3},[r2,: 128]! ++ vld1.8 {d4-d5},[r4,: 128]! ++ vsub.i32 q1,q1,q2 ++ add r5,r3,#240 ++ vld1.8 {d4},[r2,: 64] ++ vld1.8 {d6},[r4,: 64] ++ vsub.i32 q2,q2,q3 ++ vst1.8 {d0-d1},[r5,: 128]! ++ vst1.8 {d2-d3},[r5,: 128]! ++ vst1.8 d4,[r5,: 64] ++ add r2,r3,#144 ++ add r4,r3,#96 ++ add r5,r3,#144 ++ add r6,r3,#192 ++ vld1.8 {d0-d1},[r2,: 128]! ++ vld1.8 {d2-d3},[r4,: 128]! ++ vsub.i32 q2,q0,q1 ++ vadd.i32 q0,q0,q1 ++ vld1.8 {d2-d3},[r2,: 128]! ++ vld1.8 {d6-d7},[r4,: 128]! ++ vsub.i32 q4,q1,q3 ++ vadd.i32 q1,q1,q3 ++ vld1.8 {d6},[r2,: 64] ++ vld1.8 {d10},[r4,: 64] ++ vsub.i32 q6,q3,q5 ++ vadd.i32 q3,q3,q5 ++ vst1.8 {d4-d5},[r5,: 128]! ++ vst1.8 {d0-d1},[r6,: 128]! ++ vst1.8 {d8-d9},[r5,: 128]! ++ vst1.8 {d2-d3},[r6,: 128]! ++ vst1.8 d12,[r5,: 64] ++ vst1.8 d6,[r6,: 64] ++ add r2,r3,#0 ++ add r4,r3,#240 ++ vld1.8 {d0-d1},[r4,: 128]! ++ vld1.8 {d2-d3},[r4,: 128]! ++ vld1.8 {d4},[r4,: 64] ++ add r4,r3,#336 ++ vld1.8 {d6-d7},[r4,: 128]! ++ vtrn.32 q0,q3 ++ vld1.8 {d8-d9},[r4,: 128]! ++ vshl.i32 q5,q0,#4 ++ vtrn.32 q1,q4 ++ vshl.i32 q6,q3,#4 ++ vadd.i32 q5,q5,q0 ++ vadd.i32 q6,q6,q3 ++ vshl.i32 q7,q1,#4 ++ vld1.8 {d5},[r4,: 64] ++ vshl.i32 q8,q4,#4 ++ vtrn.32 d4,d5 ++ vadd.i32 q7,q7,q1 ++ vadd.i32 q8,q8,q4 ++ vld1.8 {d18-d19},[r2,: 128]! ++ vshl.i32 q10,q2,#4 ++ vld1.8 {d22-d23},[r2,: 128]! ++ vadd.i32 q10,q10,q2 ++ vld1.8 {d24},[r2,: 64] ++ vadd.i32 q5,q5,q0 ++ add r2,r3,#288 ++ vld1.8 {d26-d27},[r2,: 128]! ++ vadd.i32 q6,q6,q3 ++ vld1.8 {d28-d29},[r2,: 128]! ++ vadd.i32 q8,q8,q4 ++ vld1.8 {d25},[r2,: 64] ++ vadd.i32 q10,q10,q2 ++ vtrn.32 q9,q13 ++ vadd.i32 q7,q7,q1 ++ vadd.i32 q5,q5,q0 ++ vtrn.32 q11,q14 ++ vadd.i32 q6,q6,q3 ++ add r2,sp,#560 ++ vadd.i32 q10,q10,q2 ++ vtrn.32 d24,d25 ++ vst1.8 {d12-d13},[r2,: 128] ++ vshl.i32 q6,q13,#1 ++ add r2,sp,#576 ++ vst1.8 {d20-d21},[r2,: 128] ++ vshl.i32 q10,q14,#1 ++ add r2,sp,#592 ++ vst1.8 {d12-d13},[r2,: 128] ++ vshl.i32 q15,q12,#1 ++ vadd.i32 q8,q8,q4 ++ vext.32 d10,d31,d30,#0 ++ vadd.i32 q7,q7,q1 ++ add r2,sp,#608 ++ vst1.8 {d16-d17},[r2,: 128] ++ vmull.s32 q8,d18,d5 ++ vmlal.s32 q8,d26,d4 ++ vmlal.s32 q8,d19,d9 ++ vmlal.s32 q8,d27,d3 ++ vmlal.s32 q8,d22,d8 ++ vmlal.s32 q8,d28,d2 ++ vmlal.s32 q8,d23,d7 ++ vmlal.s32 q8,d29,d1 ++ vmlal.s32 q8,d24,d6 ++ vmlal.s32 q8,d25,d0 ++ add r2,sp,#624 ++ vst1.8 {d14-d15},[r2,: 128] ++ vmull.s32 q2,d18,d4 ++ vmlal.s32 q2,d12,d9 ++ vmlal.s32 q2,d13,d8 ++ vmlal.s32 q2,d19,d3 ++ vmlal.s32 q2,d22,d2 ++ vmlal.s32 q2,d23,d1 ++ vmlal.s32 q2,d24,d0 ++ add r2,sp,#640 ++ vst1.8 {d20-d21},[r2,: 128] ++ vmull.s32 q7,d18,d9 ++ vmlal.s32 q7,d26,d3 ++ vmlal.s32 q7,d19,d8 ++ vmlal.s32 q7,d27,d2 ++ vmlal.s32 q7,d22,d7 ++ vmlal.s32 q7,d28,d1 ++ vmlal.s32 q7,d23,d6 ++ vmlal.s32 q7,d29,d0 ++ add r2,sp,#656 ++ vst1.8 {d10-d11},[r2,: 128] ++ vmull.s32 q5,d18,d3 ++ vmlal.s32 q5,d19,d2 ++ vmlal.s32 q5,d22,d1 ++ vmlal.s32 q5,d23,d0 ++ vmlal.s32 q5,d12,d8 ++ add r2,sp,#672 ++ vst1.8 {d16-d17},[r2,: 128] ++ vmull.s32 q4,d18,d8 ++ vmlal.s32 q4,d26,d2 ++ vmlal.s32 q4,d19,d7 ++ vmlal.s32 q4,d27,d1 ++ vmlal.s32 q4,d22,d6 ++ vmlal.s32 q4,d28,d0 ++ vmull.s32 q8,d18,d7 ++ vmlal.s32 q8,d26,d1 ++ vmlal.s32 q8,d19,d6 ++ vmlal.s32 q8,d27,d0 ++ add r2,sp,#576 ++ vld1.8 {d20-d21},[r2,: 128] ++ vmlal.s32 q7,d24,d21 ++ vmlal.s32 q7,d25,d20 ++ vmlal.s32 q4,d23,d21 ++ vmlal.s32 q4,d29,d20 ++ vmlal.s32 q8,d22,d21 ++ vmlal.s32 q8,d28,d20 ++ vmlal.s32 q5,d24,d20 ++ add r2,sp,#576 ++ vst1.8 {d14-d15},[r2,: 128] ++ vmull.s32 q7,d18,d6 ++ vmlal.s32 q7,d26,d0 ++ add r2,sp,#656 ++ vld1.8 {d30-d31},[r2,: 128] ++ vmlal.s32 q2,d30,d21 ++ vmlal.s32 q7,d19,d21 ++ vmlal.s32 q7,d27,d20 ++ add r2,sp,#624 ++ vld1.8 {d26-d27},[r2,: 128] ++ vmlal.s32 q4,d25,d27 ++ vmlal.s32 q8,d29,d27 ++ vmlal.s32 q8,d25,d26 ++ vmlal.s32 q7,d28,d27 ++ vmlal.s32 q7,d29,d26 ++ add r2,sp,#608 ++ vld1.8 {d28-d29},[r2,: 128] ++ vmlal.s32 q4,d24,d29 ++ vmlal.s32 q8,d23,d29 ++ vmlal.s32 q8,d24,d28 ++ vmlal.s32 q7,d22,d29 ++ vmlal.s32 q7,d23,d28 ++ add r2,sp,#608 ++ vst1.8 {d8-d9},[r2,: 128] ++ add r2,sp,#560 ++ vld1.8 {d8-d9},[r2,: 128] ++ vmlal.s32 q7,d24,d9 ++ vmlal.s32 q7,d25,d31 ++ vmull.s32 q1,d18,d2 ++ vmlal.s32 q1,d19,d1 ++ vmlal.s32 q1,d22,d0 ++ vmlal.s32 q1,d24,d27 ++ vmlal.s32 q1,d23,d20 ++ vmlal.s32 q1,d12,d7 ++ vmlal.s32 q1,d13,d6 ++ vmull.s32 q6,d18,d1 ++ vmlal.s32 q6,d19,d0 ++ vmlal.s32 q6,d23,d27 ++ vmlal.s32 q6,d22,d20 ++ vmlal.s32 q6,d24,d26 ++ vmull.s32 q0,d18,d0 ++ vmlal.s32 q0,d22,d27 ++ vmlal.s32 q0,d23,d26 ++ vmlal.s32 q0,d24,d31 ++ vmlal.s32 q0,d19,d20 ++ add r2,sp,#640 ++ vld1.8 {d18-d19},[r2,: 128] ++ vmlal.s32 q2,d18,d7 ++ vmlal.s32 q2,d19,d6 ++ vmlal.s32 q5,d18,d6 ++ vmlal.s32 q5,d19,d21 ++ vmlal.s32 q1,d18,d21 ++ vmlal.s32 q1,d19,d29 ++ vmlal.s32 q0,d18,d28 ++ vmlal.s32 q0,d19,d9 ++ vmlal.s32 q6,d18,d29 ++ vmlal.s32 q6,d19,d28 ++ add r2,sp,#592 ++ vld1.8 {d18-d19},[r2,: 128] ++ add r2,sp,#512 ++ vld1.8 {d22-d23},[r2,: 128] ++ vmlal.s32 q5,d19,d7 ++ vmlal.s32 q0,d18,d21 ++ vmlal.s32 q0,d19,d29 ++ vmlal.s32 q6,d18,d6 ++ add r2,sp,#528 ++ vld1.8 {d6-d7},[r2,: 128] ++ vmlal.s32 q6,d19,d21 ++ add r2,sp,#576 ++ vld1.8 {d18-d19},[r2,: 128] ++ vmlal.s32 q0,d30,d8 ++ add r2,sp,#672 ++ vld1.8 {d20-d21},[r2,: 128] ++ vmlal.s32 q5,d30,d29 ++ add r2,sp,#608 ++ vld1.8 {d24-d25},[r2,: 128] ++ vmlal.s32 q1,d30,d28 ++ vadd.i64 q13,q0,q11 ++ vadd.i64 q14,q5,q11 ++ vmlal.s32 q6,d30,d9 ++ vshr.s64 q4,q13,#26 ++ vshr.s64 q13,q14,#26 ++ vadd.i64 q7,q7,q4 ++ vshl.i64 q4,q4,#26 ++ vadd.i64 q14,q7,q3 ++ vadd.i64 q9,q9,q13 ++ vshl.i64 q13,q13,#26 ++ vadd.i64 q15,q9,q3 ++ vsub.i64 q0,q0,q4 ++ vshr.s64 q4,q14,#25 ++ vsub.i64 q5,q5,q13 ++ vshr.s64 q13,q15,#25 ++ vadd.i64 q6,q6,q4 ++ vshl.i64 q4,q4,#25 ++ vadd.i64 q14,q6,q11 ++ vadd.i64 q2,q2,q13 ++ vsub.i64 q4,q7,q4 ++ vshr.s64 q7,q14,#26 ++ vshl.i64 q13,q13,#25 ++ vadd.i64 q14,q2,q11 ++ vadd.i64 q8,q8,q7 ++ vshl.i64 q7,q7,#26 ++ vadd.i64 q15,q8,q3 ++ vsub.i64 q9,q9,q13 ++ vshr.s64 q13,q14,#26 ++ vsub.i64 q6,q6,q7 ++ vshr.s64 q7,q15,#25 ++ vadd.i64 q10,q10,q13 ++ vshl.i64 q13,q13,#26 ++ vadd.i64 q14,q10,q3 ++ vadd.i64 q1,q1,q7 ++ add r2,r3,#288 ++ vshl.i64 q7,q7,#25 ++ add r4,r3,#96 ++ vadd.i64 q15,q1,q11 ++ add r2,r2,#8 ++ vsub.i64 q2,q2,q13 ++ add r4,r4,#8 ++ vshr.s64 q13,q14,#25 ++ vsub.i64 q7,q8,q7 ++ vshr.s64 q8,q15,#26 ++ vadd.i64 q14,q13,q13 ++ vadd.i64 q12,q12,q8 ++ vtrn.32 d12,d14 ++ vshl.i64 q8,q8,#26 ++ vtrn.32 d13,d15 ++ vadd.i64 q3,q12,q3 ++ vadd.i64 q0,q0,q14 ++ vst1.8 d12,[r2,: 64]! ++ vshl.i64 q7,q13,#4 ++ vst1.8 d13,[r4,: 64]! ++ vsub.i64 q1,q1,q8 ++ vshr.s64 q3,q3,#25 ++ vadd.i64 q0,q0,q7 ++ vadd.i64 q5,q5,q3 ++ vshl.i64 q3,q3,#25 ++ vadd.i64 q6,q5,q11 ++ vadd.i64 q0,q0,q13 ++ vshl.i64 q7,q13,#25 ++ vadd.i64 q8,q0,q11 ++ vsub.i64 q3,q12,q3 ++ vshr.s64 q6,q6,#26 ++ vsub.i64 q7,q10,q7 ++ vtrn.32 d2,d6 ++ vshr.s64 q8,q8,#26 ++ vtrn.32 d3,d7 ++ vadd.i64 q3,q9,q6 ++ vst1.8 d2,[r2,: 64] ++ vshl.i64 q6,q6,#26 ++ vst1.8 d3,[r4,: 64] ++ vadd.i64 q1,q4,q8 ++ vtrn.32 d4,d14 ++ vshl.i64 q4,q8,#26 ++ vtrn.32 d5,d15 ++ vsub.i64 q5,q5,q6 ++ add r2,r2,#16 ++ vsub.i64 q0,q0,q4 ++ vst1.8 d4,[r2,: 64] ++ add r4,r4,#16 ++ vst1.8 d5,[r4,: 64] ++ vtrn.32 d10,d6 ++ vtrn.32 d11,d7 ++ sub r2,r2,#8 ++ sub r4,r4,#8 ++ vtrn.32 d0,d2 ++ vtrn.32 d1,d3 ++ vst1.8 d10,[r2,: 64] ++ vst1.8 d11,[r4,: 64] ++ sub r2,r2,#24 ++ sub r4,r4,#24 ++ vst1.8 d0,[r2,: 64] ++ vst1.8 d1,[r4,: 64] ++ add r2,sp,#544 ++ add r4,r3,#144 ++ add r5,r3,#192 ++ vld1.8 {d0-d1},[r2,: 128] ++ vld1.8 {d2-d3},[r4,: 128]! ++ vld1.8 {d4-d5},[r5,: 128]! ++ vzip.i32 q1,q2 ++ vld1.8 {d6-d7},[r4,: 128]! ++ vld1.8 {d8-d9},[r5,: 128]! ++ vshl.i32 q5,q1,#1 ++ vzip.i32 q3,q4 ++ vshl.i32 q6,q2,#1 ++ vld1.8 {d14},[r4,: 64] ++ vshl.i32 q8,q3,#1 ++ vld1.8 {d15},[r5,: 64] ++ vshl.i32 q9,q4,#1 ++ vmul.i32 d21,d7,d1 ++ vtrn.32 d14,d15 ++ vmul.i32 q11,q4,q0 ++ vmul.i32 q0,q7,q0 ++ vmull.s32 q12,d2,d2 ++ vmlal.s32 q12,d11,d1 ++ vmlal.s32 q12,d12,d0 ++ vmlal.s32 q12,d13,d23 ++ vmlal.s32 q12,d16,d22 ++ vmlal.s32 q12,d7,d21 ++ vmull.s32 q10,d2,d11 ++ vmlal.s32 q10,d4,d1 ++ vmlal.s32 q10,d13,d0 ++ vmlal.s32 q10,d6,d23 ++ vmlal.s32 q10,d17,d22 ++ vmull.s32 q13,d10,d4 ++ vmlal.s32 q13,d11,d3 ++ vmlal.s32 q13,d13,d1 ++ vmlal.s32 q13,d16,d0 ++ vmlal.s32 q13,d17,d23 ++ vmlal.s32 q13,d8,d22 ++ vmull.s32 q1,d10,d5 ++ vmlal.s32 q1,d11,d4 ++ vmlal.s32 q1,d6,d1 ++ vmlal.s32 q1,d17,d0 ++ vmlal.s32 q1,d8,d23 ++ vmull.s32 q14,d10,d6 ++ vmlal.s32 q14,d11,d13 ++ vmlal.s32 q14,d4,d4 ++ vmlal.s32 q14,d17,d1 ++ vmlal.s32 q14,d18,d0 ++ vmlal.s32 q14,d9,d23 ++ vmull.s32 q11,d10,d7 ++ vmlal.s32 q11,d11,d6 ++ vmlal.s32 q11,d12,d5 ++ vmlal.s32 q11,d8,d1 ++ vmlal.s32 q11,d19,d0 ++ vmull.s32 q15,d10,d8 ++ vmlal.s32 q15,d11,d17 ++ vmlal.s32 q15,d12,d6 ++ vmlal.s32 q15,d13,d5 ++ vmlal.s32 q15,d19,d1 ++ vmlal.s32 q15,d14,d0 ++ vmull.s32 q2,d10,d9 ++ vmlal.s32 q2,d11,d8 ++ vmlal.s32 q2,d12,d7 ++ vmlal.s32 q2,d13,d6 ++ vmlal.s32 q2,d14,d1 ++ vmull.s32 q0,d15,d1 ++ vmlal.s32 q0,d10,d14 ++ vmlal.s32 q0,d11,d19 ++ vmlal.s32 q0,d12,d8 ++ vmlal.s32 q0,d13,d17 ++ vmlal.s32 q0,d6,d6 ++ add r2,sp,#512 ++ vld1.8 {d18-d19},[r2,: 128] ++ vmull.s32 q3,d16,d7 ++ vmlal.s32 q3,d10,d15 ++ vmlal.s32 q3,d11,d14 ++ vmlal.s32 q3,d12,d9 ++ vmlal.s32 q3,d13,d8 ++ add r2,sp,#528 ++ vld1.8 {d8-d9},[r2,: 128] ++ vadd.i64 q5,q12,q9 ++ vadd.i64 q6,q15,q9 ++ vshr.s64 q5,q5,#26 ++ vshr.s64 q6,q6,#26 ++ vadd.i64 q7,q10,q5 ++ vshl.i64 q5,q5,#26 ++ vadd.i64 q8,q7,q4 ++ vadd.i64 q2,q2,q6 ++ vshl.i64 q6,q6,#26 ++ vadd.i64 q10,q2,q4 ++ vsub.i64 q5,q12,q5 ++ vshr.s64 q8,q8,#25 ++ vsub.i64 q6,q15,q6 ++ vshr.s64 q10,q10,#25 ++ vadd.i64 q12,q13,q8 ++ vshl.i64 q8,q8,#25 ++ vadd.i64 q13,q12,q9 ++ vadd.i64 q0,q0,q10 ++ vsub.i64 q7,q7,q8 ++ vshr.s64 q8,q13,#26 ++ vshl.i64 q10,q10,#25 ++ vadd.i64 q13,q0,q9 ++ vadd.i64 q1,q1,q8 ++ vshl.i64 q8,q8,#26 ++ vadd.i64 q15,q1,q4 ++ vsub.i64 q2,q2,q10 ++ vshr.s64 q10,q13,#26 ++ vsub.i64 q8,q12,q8 ++ vshr.s64 q12,q15,#25 ++ vadd.i64 q3,q3,q10 ++ vshl.i64 q10,q10,#26 ++ vadd.i64 q13,q3,q4 ++ vadd.i64 q14,q14,q12 ++ add r2,r3,#144 ++ vshl.i64 q12,q12,#25 ++ add r4,r3,#192 ++ vadd.i64 q15,q14,q9 ++ add r2,r2,#8 ++ vsub.i64 q0,q0,q10 ++ add r4,r4,#8 ++ vshr.s64 q10,q13,#25 ++ vsub.i64 q1,q1,q12 ++ vshr.s64 q12,q15,#26 ++ vadd.i64 q13,q10,q10 ++ vadd.i64 q11,q11,q12 ++ vtrn.32 d16,d2 ++ vshl.i64 q12,q12,#26 ++ vtrn.32 d17,d3 ++ vadd.i64 q1,q11,q4 ++ vadd.i64 q4,q5,q13 ++ vst1.8 d16,[r2,: 64]! ++ vshl.i64 q5,q10,#4 ++ vst1.8 d17,[r4,: 64]! ++ vsub.i64 q8,q14,q12 ++ vshr.s64 q1,q1,#25 ++ vadd.i64 q4,q4,q5 ++ vadd.i64 q5,q6,q1 ++ vshl.i64 q1,q1,#25 ++ vadd.i64 q6,q5,q9 ++ vadd.i64 q4,q4,q10 ++ vshl.i64 q10,q10,#25 ++ vadd.i64 q9,q4,q9 ++ vsub.i64 q1,q11,q1 ++ vshr.s64 q6,q6,#26 ++ vsub.i64 q3,q3,q10 ++ vtrn.32 d16,d2 ++ vshr.s64 q9,q9,#26 ++ vtrn.32 d17,d3 ++ vadd.i64 q1,q2,q6 ++ vst1.8 d16,[r2,: 64] ++ vshl.i64 q2,q6,#26 ++ vst1.8 d17,[r4,: 64] ++ vadd.i64 q6,q7,q9 ++ vtrn.32 d0,d6 ++ vshl.i64 q7,q9,#26 ++ vtrn.32 d1,d7 ++ vsub.i64 q2,q5,q2 ++ add r2,r2,#16 ++ vsub.i64 q3,q4,q7 ++ vst1.8 d0,[r2,: 64] ++ add r4,r4,#16 ++ vst1.8 d1,[r4,: 64] ++ vtrn.32 d4,d2 ++ vtrn.32 d5,d3 ++ sub r2,r2,#8 ++ sub r4,r4,#8 ++ vtrn.32 d6,d12 ++ vtrn.32 d7,d13 ++ vst1.8 d4,[r2,: 64] ++ vst1.8 d5,[r4,: 64] ++ sub r2,r2,#24 ++ sub r4,r4,#24 ++ vst1.8 d6,[r2,: 64] ++ vst1.8 d7,[r4,: 64] ++ add r2,r3,#336 ++ add r4,r3,#288 ++ vld1.8 {d0-d1},[r2,: 128]! ++ vld1.8 {d2-d3},[r4,: 128]! ++ vadd.i32 q0,q0,q1 ++ vld1.8 {d2-d3},[r2,: 128]! ++ vld1.8 {d4-d5},[r4,: 128]! ++ vadd.i32 q1,q1,q2 ++ add r5,r3,#288 ++ vld1.8 {d4},[r2,: 64] ++ vld1.8 {d6},[r4,: 64] ++ vadd.i32 q2,q2,q3 ++ vst1.8 {d0-d1},[r5,: 128]! ++ vst1.8 {d2-d3},[r5,: 128]! ++ vst1.8 d4,[r5,: 64] ++ add r2,r3,#48 ++ add r4,r3,#144 ++ vld1.8 {d0-d1},[r4,: 128]! ++ vld1.8 {d2-d3},[r4,: 128]! ++ vld1.8 {d4},[r4,: 64] ++ add r4,r3,#288 ++ vld1.8 {d6-d7},[r4,: 128]! ++ vtrn.32 q0,q3 ++ vld1.8 {d8-d9},[r4,: 128]! ++ vshl.i32 q5,q0,#4 ++ vtrn.32 q1,q4 ++ vshl.i32 q6,q3,#4 ++ vadd.i32 q5,q5,q0 ++ vadd.i32 q6,q6,q3 ++ vshl.i32 q7,q1,#4 ++ vld1.8 {d5},[r4,: 64] ++ vshl.i32 q8,q4,#4 ++ vtrn.32 d4,d5 ++ vadd.i32 q7,q7,q1 ++ vadd.i32 q8,q8,q4 ++ vld1.8 {d18-d19},[r2,: 128]! ++ vshl.i32 q10,q2,#4 ++ vld1.8 {d22-d23},[r2,: 128]! ++ vadd.i32 q10,q10,q2 ++ vld1.8 {d24},[r2,: 64] ++ vadd.i32 q5,q5,q0 ++ add r2,r3,#240 ++ vld1.8 {d26-d27},[r2,: 128]! ++ vadd.i32 q6,q6,q3 ++ vld1.8 {d28-d29},[r2,: 128]! ++ vadd.i32 q8,q8,q4 ++ vld1.8 {d25},[r2,: 64] ++ vadd.i32 q10,q10,q2 ++ vtrn.32 q9,q13 ++ vadd.i32 q7,q7,q1 ++ vadd.i32 q5,q5,q0 ++ vtrn.32 q11,q14 ++ vadd.i32 q6,q6,q3 ++ add r2,sp,#560 ++ vadd.i32 q10,q10,q2 ++ vtrn.32 d24,d25 ++ vst1.8 {d12-d13},[r2,: 128] ++ vshl.i32 q6,q13,#1 ++ add r2,sp,#576 ++ vst1.8 {d20-d21},[r2,: 128] ++ vshl.i32 q10,q14,#1 ++ add r2,sp,#592 ++ vst1.8 {d12-d13},[r2,: 128] ++ vshl.i32 q15,q12,#1 ++ vadd.i32 q8,q8,q4 ++ vext.32 d10,d31,d30,#0 ++ vadd.i32 q7,q7,q1 ++ add r2,sp,#608 ++ vst1.8 {d16-d17},[r2,: 128] ++ vmull.s32 q8,d18,d5 ++ vmlal.s32 q8,d26,d4 ++ vmlal.s32 q8,d19,d9 ++ vmlal.s32 q8,d27,d3 ++ vmlal.s32 q8,d22,d8 ++ vmlal.s32 q8,d28,d2 ++ vmlal.s32 q8,d23,d7 ++ vmlal.s32 q8,d29,d1 ++ vmlal.s32 q8,d24,d6 ++ vmlal.s32 q8,d25,d0 ++ add r2,sp,#624 ++ vst1.8 {d14-d15},[r2,: 128] ++ vmull.s32 q2,d18,d4 ++ vmlal.s32 q2,d12,d9 ++ vmlal.s32 q2,d13,d8 ++ vmlal.s32 q2,d19,d3 ++ vmlal.s32 q2,d22,d2 ++ vmlal.s32 q2,d23,d1 ++ vmlal.s32 q2,d24,d0 ++ add r2,sp,#640 ++ vst1.8 {d20-d21},[r2,: 128] ++ vmull.s32 q7,d18,d9 ++ vmlal.s32 q7,d26,d3 ++ vmlal.s32 q7,d19,d8 ++ vmlal.s32 q7,d27,d2 ++ vmlal.s32 q7,d22,d7 ++ vmlal.s32 q7,d28,d1 ++ vmlal.s32 q7,d23,d6 ++ vmlal.s32 q7,d29,d0 ++ add r2,sp,#656 ++ vst1.8 {d10-d11},[r2,: 128] ++ vmull.s32 q5,d18,d3 ++ vmlal.s32 q5,d19,d2 ++ vmlal.s32 q5,d22,d1 ++ vmlal.s32 q5,d23,d0 ++ vmlal.s32 q5,d12,d8 ++ add r2,sp,#672 ++ vst1.8 {d16-d17},[r2,: 128] ++ vmull.s32 q4,d18,d8 ++ vmlal.s32 q4,d26,d2 ++ vmlal.s32 q4,d19,d7 ++ vmlal.s32 q4,d27,d1 ++ vmlal.s32 q4,d22,d6 ++ vmlal.s32 q4,d28,d0 ++ vmull.s32 q8,d18,d7 ++ vmlal.s32 q8,d26,d1 ++ vmlal.s32 q8,d19,d6 ++ vmlal.s32 q8,d27,d0 ++ add r2,sp,#576 ++ vld1.8 {d20-d21},[r2,: 128] ++ vmlal.s32 q7,d24,d21 ++ vmlal.s32 q7,d25,d20 ++ vmlal.s32 q4,d23,d21 ++ vmlal.s32 q4,d29,d20 ++ vmlal.s32 q8,d22,d21 ++ vmlal.s32 q8,d28,d20 ++ vmlal.s32 q5,d24,d20 ++ add r2,sp,#576 ++ vst1.8 {d14-d15},[r2,: 128] ++ vmull.s32 q7,d18,d6 ++ vmlal.s32 q7,d26,d0 ++ add r2,sp,#656 ++ vld1.8 {d30-d31},[r2,: 128] ++ vmlal.s32 q2,d30,d21 ++ vmlal.s32 q7,d19,d21 ++ vmlal.s32 q7,d27,d20 ++ add r2,sp,#624 ++ vld1.8 {d26-d27},[r2,: 128] ++ vmlal.s32 q4,d25,d27 ++ vmlal.s32 q8,d29,d27 ++ vmlal.s32 q8,d25,d26 ++ vmlal.s32 q7,d28,d27 ++ vmlal.s32 q7,d29,d26 ++ add r2,sp,#608 ++ vld1.8 {d28-d29},[r2,: 128] ++ vmlal.s32 q4,d24,d29 ++ vmlal.s32 q8,d23,d29 ++ vmlal.s32 q8,d24,d28 ++ vmlal.s32 q7,d22,d29 ++ vmlal.s32 q7,d23,d28 ++ add r2,sp,#608 ++ vst1.8 {d8-d9},[r2,: 128] ++ add r2,sp,#560 ++ vld1.8 {d8-d9},[r2,: 128] ++ vmlal.s32 q7,d24,d9 ++ vmlal.s32 q7,d25,d31 ++ vmull.s32 q1,d18,d2 ++ vmlal.s32 q1,d19,d1 ++ vmlal.s32 q1,d22,d0 ++ vmlal.s32 q1,d24,d27 ++ vmlal.s32 q1,d23,d20 ++ vmlal.s32 q1,d12,d7 ++ vmlal.s32 q1,d13,d6 ++ vmull.s32 q6,d18,d1 ++ vmlal.s32 q6,d19,d0 ++ vmlal.s32 q6,d23,d27 ++ vmlal.s32 q6,d22,d20 ++ vmlal.s32 q6,d24,d26 ++ vmull.s32 q0,d18,d0 ++ vmlal.s32 q0,d22,d27 ++ vmlal.s32 q0,d23,d26 ++ vmlal.s32 q0,d24,d31 ++ vmlal.s32 q0,d19,d20 ++ add r2,sp,#640 ++ vld1.8 {d18-d19},[r2,: 128] ++ vmlal.s32 q2,d18,d7 ++ vmlal.s32 q2,d19,d6 ++ vmlal.s32 q5,d18,d6 ++ vmlal.s32 q5,d19,d21 ++ vmlal.s32 q1,d18,d21 ++ vmlal.s32 q1,d19,d29 ++ vmlal.s32 q0,d18,d28 ++ vmlal.s32 q0,d19,d9 ++ vmlal.s32 q6,d18,d29 ++ vmlal.s32 q6,d19,d28 ++ add r2,sp,#592 ++ vld1.8 {d18-d19},[r2,: 128] ++ add r2,sp,#512 ++ vld1.8 {d22-d23},[r2,: 128] ++ vmlal.s32 q5,d19,d7 ++ vmlal.s32 q0,d18,d21 ++ vmlal.s32 q0,d19,d29 ++ vmlal.s32 q6,d18,d6 ++ add r2,sp,#528 ++ vld1.8 {d6-d7},[r2,: 128] ++ vmlal.s32 q6,d19,d21 ++ add r2,sp,#576 ++ vld1.8 {d18-d19},[r2,: 128] ++ vmlal.s32 q0,d30,d8 ++ add r2,sp,#672 ++ vld1.8 {d20-d21},[r2,: 128] ++ vmlal.s32 q5,d30,d29 ++ add r2,sp,#608 ++ vld1.8 {d24-d25},[r2,: 128] ++ vmlal.s32 q1,d30,d28 ++ vadd.i64 q13,q0,q11 ++ vadd.i64 q14,q5,q11 ++ vmlal.s32 q6,d30,d9 ++ vshr.s64 q4,q13,#26 ++ vshr.s64 q13,q14,#26 ++ vadd.i64 q7,q7,q4 ++ vshl.i64 q4,q4,#26 ++ vadd.i64 q14,q7,q3 ++ vadd.i64 q9,q9,q13 ++ vshl.i64 q13,q13,#26 ++ vadd.i64 q15,q9,q3 ++ vsub.i64 q0,q0,q4 ++ vshr.s64 q4,q14,#25 ++ vsub.i64 q5,q5,q13 ++ vshr.s64 q13,q15,#25 ++ vadd.i64 q6,q6,q4 ++ vshl.i64 q4,q4,#25 ++ vadd.i64 q14,q6,q11 ++ vadd.i64 q2,q2,q13 ++ vsub.i64 q4,q7,q4 ++ vshr.s64 q7,q14,#26 ++ vshl.i64 q13,q13,#25 ++ vadd.i64 q14,q2,q11 ++ vadd.i64 q8,q8,q7 ++ vshl.i64 q7,q7,#26 ++ vadd.i64 q15,q8,q3 ++ vsub.i64 q9,q9,q13 ++ vshr.s64 q13,q14,#26 ++ vsub.i64 q6,q6,q7 ++ vshr.s64 q7,q15,#25 ++ vadd.i64 q10,q10,q13 ++ vshl.i64 q13,q13,#26 ++ vadd.i64 q14,q10,q3 ++ vadd.i64 q1,q1,q7 ++ add r2,r3,#240 ++ vshl.i64 q7,q7,#25 ++ add r4,r3,#144 ++ vadd.i64 q15,q1,q11 ++ add r2,r2,#8 ++ vsub.i64 q2,q2,q13 ++ add r4,r4,#8 ++ vshr.s64 q13,q14,#25 ++ vsub.i64 q7,q8,q7 ++ vshr.s64 q8,q15,#26 ++ vadd.i64 q14,q13,q13 ++ vadd.i64 q12,q12,q8 ++ vtrn.32 d12,d14 ++ vshl.i64 q8,q8,#26 ++ vtrn.32 d13,d15 ++ vadd.i64 q3,q12,q3 ++ vadd.i64 q0,q0,q14 ++ vst1.8 d12,[r2,: 64]! ++ vshl.i64 q7,q13,#4 ++ vst1.8 d13,[r4,: 64]! ++ vsub.i64 q1,q1,q8 ++ vshr.s64 q3,q3,#25 ++ vadd.i64 q0,q0,q7 ++ vadd.i64 q5,q5,q3 ++ vshl.i64 q3,q3,#25 ++ vadd.i64 q6,q5,q11 ++ vadd.i64 q0,q0,q13 ++ vshl.i64 q7,q13,#25 ++ vadd.i64 q8,q0,q11 ++ vsub.i64 q3,q12,q3 ++ vshr.s64 q6,q6,#26 ++ vsub.i64 q7,q10,q7 ++ vtrn.32 d2,d6 ++ vshr.s64 q8,q8,#26 ++ vtrn.32 d3,d7 ++ vadd.i64 q3,q9,q6 ++ vst1.8 d2,[r2,: 64] ++ vshl.i64 q6,q6,#26 ++ vst1.8 d3,[r4,: 64] ++ vadd.i64 q1,q4,q8 ++ vtrn.32 d4,d14 ++ vshl.i64 q4,q8,#26 ++ vtrn.32 d5,d15 ++ vsub.i64 q5,q5,q6 ++ add r2,r2,#16 ++ vsub.i64 q0,q0,q4 ++ vst1.8 d4,[r2,: 64] ++ add r4,r4,#16 ++ vst1.8 d5,[r4,: 64] ++ vtrn.32 d10,d6 ++ vtrn.32 d11,d7 ++ sub r2,r2,#8 ++ sub r4,r4,#8 ++ vtrn.32 d0,d2 ++ vtrn.32 d1,d3 ++ vst1.8 d10,[r2,: 64] ++ vst1.8 d11,[r4,: 64] ++ sub r2,r2,#24 ++ sub r4,r4,#24 ++ vst1.8 d0,[r2,: 64] ++ vst1.8 d1,[r4,: 64] ++ ldr r2,[sp,#488] ++ ldr r4,[sp,#492] ++ subs r5,r2,#1 ++ bge .Lmainloop ++ add r1,r3,#144 ++ add r2,r3,#336 ++ vld1.8 {d0-d1},[r1,: 128]! ++ vld1.8 {d2-d3},[r1,: 128]! ++ vld1.8 {d4},[r1,: 64] ++ vst1.8 {d0-d1},[r2,: 128]! ++ vst1.8 {d2-d3},[r2,: 128]! ++ vst1.8 d4,[r2,: 64] ++ ldr r1,=0 ++ .Linvertloop: ++ add r2,r3,#144 ++ ldr r4,=0 ++ ldr r5,=2 ++ cmp r1,#1 ++ ldreq r5,=1 ++ addeq r2,r3,#336 ++ addeq r4,r3,#48 ++ cmp r1,#2 ++ ldreq r5,=1 ++ addeq r2,r3,#48 ++ cmp r1,#3 ++ ldreq r5,=5 ++ addeq r4,r3,#336 ++ cmp r1,#4 ++ ldreq r5,=10 ++ cmp r1,#5 ++ ldreq r5,=20 ++ cmp r1,#6 ++ ldreq r5,=10 ++ addeq r2,r3,#336 ++ addeq r4,r3,#336 ++ cmp r1,#7 ++ ldreq r5,=50 ++ cmp r1,#8 ++ ldreq r5,=100 ++ cmp r1,#9 ++ ldreq r5,=50 ++ addeq r2,r3,#336 ++ cmp r1,#10 ++ ldreq r5,=5 ++ addeq r2,r3,#48 ++ cmp r1,#11 ++ ldreq r5,=0 ++ addeq r2,r3,#96 ++ add r6,r3,#144 ++ add r7,r3,#288 ++ vld1.8 {d0-d1},[r6,: 128]! ++ vld1.8 {d2-d3},[r6,: 128]! ++ vld1.8 {d4},[r6,: 64] ++ vst1.8 {d0-d1},[r7,: 128]! ++ vst1.8 {d2-d3},[r7,: 128]! ++ vst1.8 d4,[r7,: 64] ++ cmp r5,#0 ++ beq .Lskipsquaringloop ++ .Lsquaringloop: ++ add r6,r3,#288 ++ add r7,r3,#288 ++ add r8,r3,#288 ++ vmov.i32 q0,#19 ++ vmov.i32 q1,#0 ++ vmov.i32 q2,#1 ++ vzip.i32 q1,q2 ++ vld1.8 {d4-d5},[r7,: 128]! ++ vld1.8 {d6-d7},[r7,: 128]! ++ vld1.8 {d9},[r7,: 64] ++ vld1.8 {d10-d11},[r6,: 128]! ++ add r7,sp,#416 ++ vld1.8 {d12-d13},[r6,: 128]! ++ vmul.i32 q7,q2,q0 ++ vld1.8 {d8},[r6,: 64] ++ vext.32 d17,d11,d10,#1 ++ vmul.i32 q9,q3,q0 ++ vext.32 d16,d10,d8,#1 ++ vshl.u32 q10,q5,q1 ++ vext.32 d22,d14,d4,#1 ++ vext.32 d24,d18,d6,#1 ++ vshl.u32 q13,q6,q1 ++ vshl.u32 d28,d8,d2 ++ vrev64.i32 d22,d22 ++ vmul.i32 d1,d9,d1 ++ vrev64.i32 d24,d24 ++ vext.32 d29,d8,d13,#1 ++ vext.32 d0,d1,d9,#1 ++ vrev64.i32 d0,d0 ++ vext.32 d2,d9,d1,#1 ++ vext.32 d23,d15,d5,#1 ++ vmull.s32 q4,d20,d4 ++ vrev64.i32 d23,d23 ++ vmlal.s32 q4,d21,d1 ++ vrev64.i32 d2,d2 ++ vmlal.s32 q4,d26,d19 ++ vext.32 d3,d5,d15,#1 ++ vmlal.s32 q4,d27,d18 ++ vrev64.i32 d3,d3 ++ vmlal.s32 q4,d28,d15 ++ vext.32 d14,d12,d11,#1 ++ vmull.s32 q5,d16,d23 ++ vext.32 d15,d13,d12,#1 ++ vmlal.s32 q5,d17,d4 ++ vst1.8 d8,[r7,: 64]! ++ vmlal.s32 q5,d14,d1 ++ vext.32 d12,d9,d8,#0 ++ vmlal.s32 q5,d15,d19 ++ vmov.i64 d13,#0 ++ vmlal.s32 q5,d29,d18 ++ vext.32 d25,d19,d7,#1 ++ vmlal.s32 q6,d20,d5 ++ vrev64.i32 d25,d25 ++ vmlal.s32 q6,d21,d4 ++ vst1.8 d11,[r7,: 64]! ++ vmlal.s32 q6,d26,d1 ++ vext.32 d9,d10,d10,#0 ++ vmlal.s32 q6,d27,d19 ++ vmov.i64 d8,#0 ++ vmlal.s32 q6,d28,d18 ++ vmlal.s32 q4,d16,d24 ++ vmlal.s32 q4,d17,d5 ++ vmlal.s32 q4,d14,d4 ++ vst1.8 d12,[r7,: 64]! ++ vmlal.s32 q4,d15,d1 ++ vext.32 d10,d13,d12,#0 ++ vmlal.s32 q4,d29,d19 ++ vmov.i64 d11,#0 ++ vmlal.s32 q5,d20,d6 ++ vmlal.s32 q5,d21,d5 ++ vmlal.s32 q5,d26,d4 ++ vext.32 d13,d8,d8,#0 ++ vmlal.s32 q5,d27,d1 ++ vmov.i64 d12,#0 ++ vmlal.s32 q5,d28,d19 ++ vst1.8 d9,[r7,: 64]! ++ vmlal.s32 q6,d16,d25 ++ vmlal.s32 q6,d17,d6 ++ vst1.8 d10,[r7,: 64] ++ vmlal.s32 q6,d14,d5 ++ vext.32 d8,d11,d10,#0 ++ vmlal.s32 q6,d15,d4 ++ vmov.i64 d9,#0 ++ vmlal.s32 q6,d29,d1 ++ vmlal.s32 q4,d20,d7 ++ vmlal.s32 q4,d21,d6 ++ vmlal.s32 q4,d26,d5 ++ vext.32 d11,d12,d12,#0 ++ vmlal.s32 q4,d27,d4 ++ vmov.i64 d10,#0 ++ vmlal.s32 q4,d28,d1 ++ vmlal.s32 q5,d16,d0 ++ sub r6,r7,#32 ++ vmlal.s32 q5,d17,d7 ++ vmlal.s32 q5,d14,d6 ++ vext.32 d30,d9,d8,#0 ++ vmlal.s32 q5,d15,d5 ++ vld1.8 {d31},[r6,: 64]! ++ vmlal.s32 q5,d29,d4 ++ vmlal.s32 q15,d20,d0 ++ vext.32 d0,d6,d18,#1 ++ vmlal.s32 q15,d21,d25 ++ vrev64.i32 d0,d0 ++ vmlal.s32 q15,d26,d24 ++ vext.32 d1,d7,d19,#1 ++ vext.32 d7,d10,d10,#0 ++ vmlal.s32 q15,d27,d23 ++ vrev64.i32 d1,d1 ++ vld1.8 {d6},[r6,: 64] ++ vmlal.s32 q15,d28,d22 ++ vmlal.s32 q3,d16,d4 ++ add r6,r6,#24 ++ vmlal.s32 q3,d17,d2 ++ vext.32 d4,d31,d30,#0 ++ vmov d17,d11 ++ vmlal.s32 q3,d14,d1 ++ vext.32 d11,d13,d13,#0 ++ vext.32 d13,d30,d30,#0 ++ vmlal.s32 q3,d15,d0 ++ vext.32 d1,d8,d8,#0 ++ vmlal.s32 q3,d29,d3 ++ vld1.8 {d5},[r6,: 64] ++ sub r6,r6,#16 ++ vext.32 d10,d6,d6,#0 ++ vmov.i32 q1,#0xffffffff ++ vshl.i64 q4,q1,#25 ++ add r7,sp,#512 ++ vld1.8 {d14-d15},[r7,: 128] ++ vadd.i64 q9,q2,q7 ++ vshl.i64 q1,q1,#26 ++ vshr.s64 q10,q9,#26 ++ vld1.8 {d0},[r6,: 64]! ++ vadd.i64 q5,q5,q10 ++ vand q9,q9,q1 ++ vld1.8 {d16},[r6,: 64]! ++ add r6,sp,#528 ++ vld1.8 {d20-d21},[r6,: 128] ++ vadd.i64 q11,q5,q10 ++ vsub.i64 q2,q2,q9 ++ vshr.s64 q9,q11,#25 ++ vext.32 d12,d5,d4,#0 ++ vand q11,q11,q4 ++ vadd.i64 q0,q0,q9 ++ vmov d19,d7 ++ vadd.i64 q3,q0,q7 ++ vsub.i64 q5,q5,q11 ++ vshr.s64 q11,q3,#26 ++ vext.32 d18,d11,d10,#0 ++ vand q3,q3,q1 ++ vadd.i64 q8,q8,q11 ++ vadd.i64 q11,q8,q10 ++ vsub.i64 q0,q0,q3 ++ vshr.s64 q3,q11,#25 ++ vand q11,q11,q4 ++ vadd.i64 q3,q6,q3 ++ vadd.i64 q6,q3,q7 ++ vsub.i64 q8,q8,q11 ++ vshr.s64 q11,q6,#26 ++ vand q6,q6,q1 ++ vadd.i64 q9,q9,q11 ++ vadd.i64 d25,d19,d21 ++ vsub.i64 q3,q3,q6 ++ vshr.s64 d23,d25,#25 ++ vand q4,q12,q4 ++ vadd.i64 d21,d23,d23 ++ vshl.i64 d25,d23,#4 ++ vadd.i64 d21,d21,d23 ++ vadd.i64 d25,d25,d21 ++ vadd.i64 d4,d4,d25 ++ vzip.i32 q0,q8 ++ vadd.i64 d12,d4,d14 ++ add r6,r8,#8 ++ vst1.8 d0,[r6,: 64] ++ vsub.i64 d19,d19,d9 ++ add r6,r6,#16 ++ vst1.8 d16,[r6,: 64] ++ vshr.s64 d22,d12,#26 ++ vand q0,q6,q1 ++ vadd.i64 d10,d10,d22 ++ vzip.i32 q3,q9 ++ vsub.i64 d4,d4,d0 ++ sub r6,r6,#8 ++ vst1.8 d6,[r6,: 64] ++ add r6,r6,#16 ++ vst1.8 d18,[r6,: 64] ++ vzip.i32 q2,q5 ++ sub r6,r6,#32 ++ vst1.8 d4,[r6,: 64] ++ subs r5,r5,#1 ++ bhi .Lsquaringloop ++ .Lskipsquaringloop: ++ mov r2,r2 ++ add r5,r3,#288 ++ add r6,r3,#144 ++ vmov.i32 q0,#19 ++ vmov.i32 q1,#0 ++ vmov.i32 q2,#1 ++ vzip.i32 q1,q2 ++ vld1.8 {d4-d5},[r5,: 128]! ++ vld1.8 {d6-d7},[r5,: 128]! ++ vld1.8 {d9},[r5,: 64] ++ vld1.8 {d10-d11},[r2,: 128]! ++ add r5,sp,#416 ++ vld1.8 {d12-d13},[r2,: 128]! ++ vmul.i32 q7,q2,q0 ++ vld1.8 {d8},[r2,: 64] ++ vext.32 d17,d11,d10,#1 ++ vmul.i32 q9,q3,q0 ++ vext.32 d16,d10,d8,#1 ++ vshl.u32 q10,q5,q1 ++ vext.32 d22,d14,d4,#1 ++ vext.32 d24,d18,d6,#1 ++ vshl.u32 q13,q6,q1 ++ vshl.u32 d28,d8,d2 ++ vrev64.i32 d22,d22 ++ vmul.i32 d1,d9,d1 ++ vrev64.i32 d24,d24 ++ vext.32 d29,d8,d13,#1 ++ vext.32 d0,d1,d9,#1 ++ vrev64.i32 d0,d0 ++ vext.32 d2,d9,d1,#1 ++ vext.32 d23,d15,d5,#1 ++ vmull.s32 q4,d20,d4 ++ vrev64.i32 d23,d23 ++ vmlal.s32 q4,d21,d1 ++ vrev64.i32 d2,d2 ++ vmlal.s32 q4,d26,d19 ++ vext.32 d3,d5,d15,#1 ++ vmlal.s32 q4,d27,d18 ++ vrev64.i32 d3,d3 ++ vmlal.s32 q4,d28,d15 ++ vext.32 d14,d12,d11,#1 ++ vmull.s32 q5,d16,d23 ++ vext.32 d15,d13,d12,#1 ++ vmlal.s32 q5,d17,d4 ++ vst1.8 d8,[r5,: 64]! ++ vmlal.s32 q5,d14,d1 ++ vext.32 d12,d9,d8,#0 ++ vmlal.s32 q5,d15,d19 ++ vmov.i64 d13,#0 ++ vmlal.s32 q5,d29,d18 ++ vext.32 d25,d19,d7,#1 ++ vmlal.s32 q6,d20,d5 ++ vrev64.i32 d25,d25 ++ vmlal.s32 q6,d21,d4 ++ vst1.8 d11,[r5,: 64]! ++ vmlal.s32 q6,d26,d1 ++ vext.32 d9,d10,d10,#0 ++ vmlal.s32 q6,d27,d19 ++ vmov.i64 d8,#0 ++ vmlal.s32 q6,d28,d18 ++ vmlal.s32 q4,d16,d24 ++ vmlal.s32 q4,d17,d5 ++ vmlal.s32 q4,d14,d4 ++ vst1.8 d12,[r5,: 64]! ++ vmlal.s32 q4,d15,d1 ++ vext.32 d10,d13,d12,#0 ++ vmlal.s32 q4,d29,d19 ++ vmov.i64 d11,#0 ++ vmlal.s32 q5,d20,d6 ++ vmlal.s32 q5,d21,d5 ++ vmlal.s32 q5,d26,d4 ++ vext.32 d13,d8,d8,#0 ++ vmlal.s32 q5,d27,d1 ++ vmov.i64 d12,#0 ++ vmlal.s32 q5,d28,d19 ++ vst1.8 d9,[r5,: 64]! ++ vmlal.s32 q6,d16,d25 ++ vmlal.s32 q6,d17,d6 ++ vst1.8 d10,[r5,: 64] ++ vmlal.s32 q6,d14,d5 ++ vext.32 d8,d11,d10,#0 ++ vmlal.s32 q6,d15,d4 ++ vmov.i64 d9,#0 ++ vmlal.s32 q6,d29,d1 ++ vmlal.s32 q4,d20,d7 ++ vmlal.s32 q4,d21,d6 ++ vmlal.s32 q4,d26,d5 ++ vext.32 d11,d12,d12,#0 ++ vmlal.s32 q4,d27,d4 ++ vmov.i64 d10,#0 ++ vmlal.s32 q4,d28,d1 ++ vmlal.s32 q5,d16,d0 ++ sub r2,r5,#32 ++ vmlal.s32 q5,d17,d7 ++ vmlal.s32 q5,d14,d6 ++ vext.32 d30,d9,d8,#0 ++ vmlal.s32 q5,d15,d5 ++ vld1.8 {d31},[r2,: 64]! ++ vmlal.s32 q5,d29,d4 ++ vmlal.s32 q15,d20,d0 ++ vext.32 d0,d6,d18,#1 ++ vmlal.s32 q15,d21,d25 ++ vrev64.i32 d0,d0 ++ vmlal.s32 q15,d26,d24 ++ vext.32 d1,d7,d19,#1 ++ vext.32 d7,d10,d10,#0 ++ vmlal.s32 q15,d27,d23 ++ vrev64.i32 d1,d1 ++ vld1.8 {d6},[r2,: 64] ++ vmlal.s32 q15,d28,d22 ++ vmlal.s32 q3,d16,d4 ++ add r2,r2,#24 ++ vmlal.s32 q3,d17,d2 ++ vext.32 d4,d31,d30,#0 ++ vmov d17,d11 ++ vmlal.s32 q3,d14,d1 ++ vext.32 d11,d13,d13,#0 ++ vext.32 d13,d30,d30,#0 ++ vmlal.s32 q3,d15,d0 ++ vext.32 d1,d8,d8,#0 ++ vmlal.s32 q3,d29,d3 ++ vld1.8 {d5},[r2,: 64] ++ sub r2,r2,#16 ++ vext.32 d10,d6,d6,#0 ++ vmov.i32 q1,#0xffffffff ++ vshl.i64 q4,q1,#25 ++ add r5,sp,#512 ++ vld1.8 {d14-d15},[r5,: 128] ++ vadd.i64 q9,q2,q7 ++ vshl.i64 q1,q1,#26 ++ vshr.s64 q10,q9,#26 ++ vld1.8 {d0},[r2,: 64]! ++ vadd.i64 q5,q5,q10 ++ vand q9,q9,q1 ++ vld1.8 {d16},[r2,: 64]! ++ add r2,sp,#528 ++ vld1.8 {d20-d21},[r2,: 128] ++ vadd.i64 q11,q5,q10 ++ vsub.i64 q2,q2,q9 ++ vshr.s64 q9,q11,#25 ++ vext.32 d12,d5,d4,#0 ++ vand q11,q11,q4 ++ vadd.i64 q0,q0,q9 ++ vmov d19,d7 ++ vadd.i64 q3,q0,q7 ++ vsub.i64 q5,q5,q11 ++ vshr.s64 q11,q3,#26 ++ vext.32 d18,d11,d10,#0 ++ vand q3,q3,q1 ++ vadd.i64 q8,q8,q11 ++ vadd.i64 q11,q8,q10 ++ vsub.i64 q0,q0,q3 ++ vshr.s64 q3,q11,#25 ++ vand q11,q11,q4 ++ vadd.i64 q3,q6,q3 ++ vadd.i64 q6,q3,q7 ++ vsub.i64 q8,q8,q11 ++ vshr.s64 q11,q6,#26 ++ vand q6,q6,q1 ++ vadd.i64 q9,q9,q11 ++ vadd.i64 d25,d19,d21 ++ vsub.i64 q3,q3,q6 ++ vshr.s64 d23,d25,#25 ++ vand q4,q12,q4 ++ vadd.i64 d21,d23,d23 ++ vshl.i64 d25,d23,#4 ++ vadd.i64 d21,d21,d23 ++ vadd.i64 d25,d25,d21 ++ vadd.i64 d4,d4,d25 ++ vzip.i32 q0,q8 ++ vadd.i64 d12,d4,d14 ++ add r2,r6,#8 ++ vst1.8 d0,[r2,: 64] ++ vsub.i64 d19,d19,d9 ++ add r2,r2,#16 ++ vst1.8 d16,[r2,: 64] ++ vshr.s64 d22,d12,#26 ++ vand q0,q6,q1 ++ vadd.i64 d10,d10,d22 ++ vzip.i32 q3,q9 ++ vsub.i64 d4,d4,d0 ++ sub r2,r2,#8 ++ vst1.8 d6,[r2,: 64] ++ add r2,r2,#16 ++ vst1.8 d18,[r2,: 64] ++ vzip.i32 q2,q5 ++ sub r2,r2,#32 ++ vst1.8 d4,[r2,: 64] ++ cmp r4,#0 ++ beq .Lskippostcopy ++ add r2,r3,#144 ++ mov r4,r4 ++ vld1.8 {d0-d1},[r2,: 128]! ++ vld1.8 {d2-d3},[r2,: 128]! ++ vld1.8 {d4},[r2,: 64] ++ vst1.8 {d0-d1},[r4,: 128]! ++ vst1.8 {d2-d3},[r4,: 128]! ++ vst1.8 d4,[r4,: 64] ++ .Lskippostcopy: ++ cmp r1,#1 ++ bne .Lskipfinalcopy ++ add r2,r3,#288 ++ add r4,r3,#144 ++ vld1.8 {d0-d1},[r2,: 128]! ++ vld1.8 {d2-d3},[r2,: 128]! ++ vld1.8 {d4},[r2,: 64] ++ vst1.8 {d0-d1},[r4,: 128]! ++ vst1.8 {d2-d3},[r4,: 128]! ++ vst1.8 d4,[r4,: 64] ++ .Lskipfinalcopy: ++ add r1,r1,#1 ++ cmp r1,#12 ++ blo .Linvertloop ++ add r1,r3,#144 ++ ldr r2,[r1],#4 ++ ldr r3,[r1],#4 ++ ldr r4,[r1],#4 ++ ldr r5,[r1],#4 ++ ldr r6,[r1],#4 ++ ldr r7,[r1],#4 ++ ldr r8,[r1],#4 ++ ldr r9,[r1],#4 ++ ldr r10,[r1],#4 ++ ldr r1,[r1] ++ add r11,r1,r1,LSL #4 ++ add r11,r11,r1,LSL #1 ++ add r11,r11,#16777216 ++ mov r11,r11,ASR #25 ++ add r11,r11,r2 ++ mov r11,r11,ASR #26 ++ add r11,r11,r3 ++ mov r11,r11,ASR #25 ++ add r11,r11,r4 ++ mov r11,r11,ASR #26 ++ add r11,r11,r5 ++ mov r11,r11,ASR #25 ++ add r11,r11,r6 ++ mov r11,r11,ASR #26 ++ add r11,r11,r7 ++ mov r11,r11,ASR #25 ++ add r11,r11,r8 ++ mov r11,r11,ASR #26 ++ add r11,r11,r9 ++ mov r11,r11,ASR #25 ++ add r11,r11,r10 ++ mov r11,r11,ASR #26 ++ add r11,r11,r1 ++ mov r11,r11,ASR #25 ++ add r2,r2,r11 ++ add r2,r2,r11,LSL #1 ++ add r2,r2,r11,LSL #4 ++ mov r11,r2,ASR #26 ++ add r3,r3,r11 ++ sub r2,r2,r11,LSL #26 ++ mov r11,r3,ASR #25 ++ add r4,r4,r11 ++ sub r3,r3,r11,LSL #25 ++ mov r11,r4,ASR #26 ++ add r5,r5,r11 ++ sub r4,r4,r11,LSL #26 ++ mov r11,r5,ASR #25 ++ add r6,r6,r11 ++ sub r5,r5,r11,LSL #25 ++ mov r11,r6,ASR #26 ++ add r7,r7,r11 ++ sub r6,r6,r11,LSL #26 ++ mov r11,r7,ASR #25 ++ add r8,r8,r11 ++ sub r7,r7,r11,LSL #25 ++ mov r11,r8,ASR #26 ++ add r9,r9,r11 ++ sub r8,r8,r11,LSL #26 ++ mov r11,r9,ASR #25 ++ add r10,r10,r11 ++ sub r9,r9,r11,LSL #25 ++ mov r11,r10,ASR #26 ++ add r1,r1,r11 ++ sub r10,r10,r11,LSL #26 ++ mov r11,r1,ASR #25 ++ sub r1,r1,r11,LSL #25 ++ add r2,r2,r3,LSL #26 ++ mov r3,r3,LSR #6 ++ add r3,r3,r4,LSL #19 ++ mov r4,r4,LSR #13 ++ add r4,r4,r5,LSL #13 ++ mov r5,r5,LSR #19 ++ add r5,r5,r6,LSL #6 ++ add r6,r7,r8,LSL #25 ++ mov r7,r8,LSR #7 ++ add r7,r7,r9,LSL #19 ++ mov r8,r9,LSR #13 ++ add r8,r8,r10,LSL #12 ++ mov r9,r10,LSR #20 ++ add r1,r9,r1,LSL #6 ++ str r2,[r0],#4 ++ str r3,[r0],#4 ++ str r4,[r0],#4 ++ str r5,[r0],#4 ++ str r6,[r0],#4 ++ str r7,[r0],#4 ++ str r8,[r0],#4 ++ str r1,[r0] ++ ldrd r4,[sp,#0] ++ ldrd r6,[sp,#8] ++ ldrd r8,[sp,#16] ++ ldrd r10,[sp,#24] ++ ldr r12,[sp,#480] ++ ldr r14,[sp,#484] ++ ldr r0,=0 ++ mov sp,r12 ++ vpop {q4,q5,q6,q7} ++ bx lr ++ENDPROC(curve25519_neon) ++#endif +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/curve25519-x86_64.S 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,3261 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * ++ * Based on algorithms from Tung Chou ++ */ ++ ++#include ++ ++.data ++.align 16 ++curve25519_sandy2x_v0_0: .quad 0, 0 ++curve25519_sandy2x_v1_0: .quad 1, 0 ++curve25519_sandy2x_v2_1: .quad 2, 1 ++curve25519_sandy2x_v9_0: .quad 9, 0 ++curve25519_sandy2x_v9_9: .quad 9, 9 ++curve25519_sandy2x_v19_19: .quad 19, 19 ++curve25519_sandy2x_v38_1: .quad 38, 1 ++curve25519_sandy2x_v38_38: .quad 38, 38 ++curve25519_sandy2x_v121666_121666: .quad 121666, 121666 ++curve25519_sandy2x_m25: .quad 33554431, 33554431 ++curve25519_sandy2x_m26: .quad 67108863, 67108863 ++curve25519_sandy2x_subc0: .quad 0x07FFFFDA, 0x03FFFFFE ++curve25519_sandy2x_subc2: .quad 0x07FFFFFE, 0x03FFFFFE ++curve25519_sandy2x_REDMASK51: .quad 0x0007FFFFFFFFFFFF ++ ++.text ++.align 32 ++#ifdef CONFIG_AS_AVX ++ENTRY(curve25519_sandy2x_fe51_mul) ++ push %rbp ++ mov %rsp,%rbp ++ sub $96,%rsp ++ and $-32,%rsp ++ movq %r11,0(%rsp) ++ movq %r12,8(%rsp) ++ movq %r13,16(%rsp) ++ movq %r14,24(%rsp) ++ movq %r15,32(%rsp) ++ movq %rbx,40(%rsp) ++ movq %rbp,48(%rsp) ++ movq %rdi,56(%rsp) ++ mov %rdx,%rcx ++ movq 24(%rsi),%rdx ++ imulq $19,%rdx,%rax ++ movq %rax,64(%rsp) ++ mulq 16(%rcx) ++ mov %rax,%r8 ++ mov %rdx,%r9 ++ movq 32(%rsi),%rdx ++ imulq $19,%rdx,%rax ++ movq %rax,72(%rsp) ++ mulq 8(%rcx) ++ add %rax,%r8 ++ adc %rdx,%r9 ++ movq 0(%rsi),%rax ++ mulq 0(%rcx) ++ add %rax,%r8 ++ adc %rdx,%r9 ++ movq 0(%rsi),%rax ++ mulq 8(%rcx) ++ mov %rax,%r10 ++ mov %rdx,%r11 ++ movq 0(%rsi),%rax ++ mulq 16(%rcx) ++ mov %rax,%r12 ++ mov %rdx,%r13 ++ movq 0(%rsi),%rax ++ mulq 24(%rcx) ++ mov %rax,%r14 ++ mov %rdx,%r15 ++ movq 0(%rsi),%rax ++ mulq 32(%rcx) ++ mov %rax,%rbx ++ mov %rdx,%rbp ++ movq 8(%rsi),%rax ++ mulq 0(%rcx) ++ add %rax,%r10 ++ adc %rdx,%r11 ++ movq 8(%rsi),%rax ++ mulq 8(%rcx) ++ add %rax,%r12 ++ adc %rdx,%r13 ++ movq 8(%rsi),%rax ++ mulq 16(%rcx) ++ add %rax,%r14 ++ adc %rdx,%r15 ++ movq 8(%rsi),%rax ++ mulq 24(%rcx) ++ add %rax,%rbx ++ adc %rdx,%rbp ++ movq 8(%rsi),%rdx ++ imulq $19,%rdx,%rax ++ mulq 32(%rcx) ++ add %rax,%r8 ++ adc %rdx,%r9 ++ movq 16(%rsi),%rax ++ mulq 0(%rcx) ++ add %rax,%r12 ++ adc %rdx,%r13 ++ movq 16(%rsi),%rax ++ mulq 8(%rcx) ++ add %rax,%r14 ++ adc %rdx,%r15 ++ movq 16(%rsi),%rax ++ mulq 16(%rcx) ++ add %rax,%rbx ++ adc %rdx,%rbp ++ movq 16(%rsi),%rdx ++ imulq $19,%rdx,%rax ++ mulq 24(%rcx) ++ add %rax,%r8 ++ adc %rdx,%r9 ++ movq 16(%rsi),%rdx ++ imulq $19,%rdx,%rax ++ mulq 32(%rcx) ++ add %rax,%r10 ++ adc %rdx,%r11 ++ movq 24(%rsi),%rax ++ mulq 0(%rcx) ++ add %rax,%r14 ++ adc %rdx,%r15 ++ movq 24(%rsi),%rax ++ mulq 8(%rcx) ++ add %rax,%rbx ++ adc %rdx,%rbp ++ movq 64(%rsp),%rax ++ mulq 24(%rcx) ++ add %rax,%r10 ++ adc %rdx,%r11 ++ movq 64(%rsp),%rax ++ mulq 32(%rcx) ++ add %rax,%r12 ++ adc %rdx,%r13 ++ movq 32(%rsi),%rax ++ mulq 0(%rcx) ++ add %rax,%rbx ++ adc %rdx,%rbp ++ movq 72(%rsp),%rax ++ mulq 16(%rcx) ++ add %rax,%r10 ++ adc %rdx,%r11 ++ movq 72(%rsp),%rax ++ mulq 24(%rcx) ++ add %rax,%r12 ++ adc %rdx,%r13 ++ movq 72(%rsp),%rax ++ mulq 32(%rcx) ++ add %rax,%r14 ++ adc %rdx,%r15 ++ movq curve25519_sandy2x_REDMASK51(%rip),%rsi ++ shld $13,%r8,%r9 ++ and %rsi,%r8 ++ shld $13,%r10,%r11 ++ and %rsi,%r10 ++ add %r9,%r10 ++ shld $13,%r12,%r13 ++ and %rsi,%r12 ++ add %r11,%r12 ++ shld $13,%r14,%r15 ++ and %rsi,%r14 ++ add %r13,%r14 ++ shld $13,%rbx,%rbp ++ and %rsi,%rbx ++ add %r15,%rbx ++ imulq $19,%rbp,%rdx ++ add %rdx,%r8 ++ mov %r8,%rdx ++ shr $51,%rdx ++ add %r10,%rdx ++ mov %rdx,%rcx ++ shr $51,%rdx ++ and %rsi,%r8 ++ add %r12,%rdx ++ mov %rdx,%r9 ++ shr $51,%rdx ++ and %rsi,%rcx ++ add %r14,%rdx ++ mov %rdx,%rax ++ shr $51,%rdx ++ and %rsi,%r9 ++ add %rbx,%rdx ++ mov %rdx,%r10 ++ shr $51,%rdx ++ and %rsi,%rax ++ imulq $19,%rdx,%rdx ++ add %rdx,%r8 ++ and %rsi,%r10 ++ movq %r8,0(%rdi) ++ movq %rcx,8(%rdi) ++ movq %r9,16(%rdi) ++ movq %rax,24(%rdi) ++ movq %r10,32(%rdi) ++ movq 0(%rsp),%r11 ++ movq 8(%rsp),%r12 ++ movq 16(%rsp),%r13 ++ movq 24(%rsp),%r14 ++ movq 32(%rsp),%r15 ++ movq 40(%rsp),%rbx ++ movq 48(%rsp),%rbp ++ leave ++ ret ++ENDPROC(curve25519_sandy2x_fe51_mul) ++ ++.align 32 ++ENTRY(curve25519_sandy2x_fe51_nsquare) ++ push %rbp ++ mov %rsp,%rbp ++ sub $64,%rsp ++ and $-32,%rsp ++ movq %r11,0(%rsp) ++ movq %r12,8(%rsp) ++ movq %r13,16(%rsp) ++ movq %r14,24(%rsp) ++ movq %r15,32(%rsp) ++ movq %rbx,40(%rsp) ++ movq %rbp,48(%rsp) ++ movq 0(%rsi),%rcx ++ movq 8(%rsi),%r8 ++ movq 16(%rsi),%r9 ++ movq 24(%rsi),%rax ++ movq 32(%rsi),%rsi ++ movq %r9,16(%rdi) ++ movq %rax,24(%rdi) ++ movq %rsi,32(%rdi) ++ mov %rdx,%rsi ++ ++ .align 16 ++ .Lloop: ++ sub $1,%rsi ++ mov %rcx,%rax ++ mul %rcx ++ add %rcx,%rcx ++ mov %rax,%r9 ++ mov %rdx,%r10 ++ mov %rcx,%rax ++ mul %r8 ++ mov %rax,%r11 ++ mov %rdx,%r12 ++ mov %rcx,%rax ++ mulq 16(%rdi) ++ mov %rax,%r13 ++ mov %rdx,%r14 ++ mov %rcx,%rax ++ mulq 24(%rdi) ++ mov %rax,%r15 ++ mov %rdx,%rbx ++ mov %rcx,%rax ++ mulq 32(%rdi) ++ mov %rax,%rcx ++ mov %rdx,%rbp ++ mov %r8,%rax ++ mul %r8 ++ add %r8,%r8 ++ add %rax,%r13 ++ adc %rdx,%r14 ++ mov %r8,%rax ++ mulq 16(%rdi) ++ add %rax,%r15 ++ adc %rdx,%rbx ++ mov %r8,%rax ++ imulq $19, %r8,%r8 ++ mulq 24(%rdi) ++ add %rax,%rcx ++ adc %rdx,%rbp ++ mov %r8,%rax ++ mulq 32(%rdi) ++ add %rax,%r9 ++ adc %rdx,%r10 ++ movq 16(%rdi),%rax ++ mulq 16(%rdi) ++ add %rax,%rcx ++ adc %rdx,%rbp ++ shld $13,%rcx,%rbp ++ movq 16(%rdi),%rax ++ imulq $38, %rax,%rax ++ mulq 24(%rdi) ++ add %rax,%r9 ++ adc %rdx,%r10 ++ shld $13,%r9,%r10 ++ movq 16(%rdi),%rax ++ imulq $38, %rax,%rax ++ mulq 32(%rdi) ++ add %rax,%r11 ++ adc %rdx,%r12 ++ movq 24(%rdi),%rax ++ imulq $19, %rax,%rax ++ mulq 24(%rdi) ++ add %rax,%r11 ++ adc %rdx,%r12 ++ shld $13,%r11,%r12 ++ movq 24(%rdi),%rax ++ imulq $38, %rax,%rax ++ mulq 32(%rdi) ++ add %rax,%r13 ++ adc %rdx,%r14 ++ shld $13,%r13,%r14 ++ movq 32(%rdi),%rax ++ imulq $19, %rax,%rax ++ mulq 32(%rdi) ++ add %rax,%r15 ++ adc %rdx,%rbx ++ shld $13,%r15,%rbx ++ movq curve25519_sandy2x_REDMASK51(%rip),%rdx ++ and %rdx,%rcx ++ add %rbx,%rcx ++ and %rdx,%r9 ++ and %rdx,%r11 ++ add %r10,%r11 ++ and %rdx,%r13 ++ add %r12,%r13 ++ and %rdx,%r15 ++ add %r14,%r15 ++ imulq $19, %rbp,%rbp ++ lea (%r9,%rbp),%r9 ++ mov %r9,%rax ++ shr $51,%r9 ++ add %r11,%r9 ++ and %rdx,%rax ++ mov %r9,%r8 ++ shr $51,%r9 ++ add %r13,%r9 ++ and %rdx,%r8 ++ mov %r9,%r10 ++ shr $51,%r9 ++ add %r15,%r9 ++ and %rdx,%r10 ++ movq %r10,16(%rdi) ++ mov %r9,%r10 ++ shr $51,%r9 ++ add %rcx,%r9 ++ and %rdx,%r10 ++ movq %r10,24(%rdi) ++ mov %r9,%r10 ++ shr $51,%r9 ++ imulq $19, %r9,%r9 ++ lea (%rax,%r9),%rcx ++ and %rdx,%r10 ++ movq %r10,32(%rdi) ++ cmp $0,%rsi ++ jne .Lloop ++ ++ movq %rcx,0(%rdi) ++ movq %r8,8(%rdi) ++ movq 0(%rsp),%r11 ++ movq 8(%rsp),%r12 ++ movq 16(%rsp),%r13 ++ movq 24(%rsp),%r14 ++ movq 32(%rsp),%r15 ++ movq 40(%rsp),%rbx ++ movq 48(%rsp),%rbp ++ leave ++ ret ++ENDPROC(curve25519_sandy2x_fe51_nsquare) ++ ++.align 32 ++ENTRY(curve25519_sandy2x_fe51_pack) ++ push %rbp ++ mov %rsp,%rbp ++ sub $32,%rsp ++ and $-32,%rsp ++ movq %r11,0(%rsp) ++ movq %r12,8(%rsp) ++ movq 0(%rsi),%rdx ++ movq 8(%rsi),%rcx ++ movq 16(%rsi),%r8 ++ movq 24(%rsi),%r9 ++ movq 32(%rsi),%rsi ++ movq curve25519_sandy2x_REDMASK51(%rip),%rax ++ lea -18(%rax),%r10 ++ mov $3,%r11 ++ ++ .align 16 ++ .Lreduceloop: ++ mov %rdx,%r12 ++ shr $51,%r12 ++ and %rax,%rdx ++ add %r12,%rcx ++ mov %rcx,%r12 ++ shr $51,%r12 ++ and %rax,%rcx ++ add %r12,%r8 ++ mov %r8,%r12 ++ shr $51,%r12 ++ and %rax,%r8 ++ add %r12,%r9 ++ mov %r9,%r12 ++ shr $51,%r12 ++ and %rax,%r9 ++ add %r12,%rsi ++ mov %rsi,%r12 ++ shr $51,%r12 ++ and %rax,%rsi ++ imulq $19, %r12,%r12 ++ add %r12,%rdx ++ sub $1,%r11 ++ ja .Lreduceloop ++ ++ mov $1,%r12 ++ cmp %r10,%rdx ++ cmovl %r11,%r12 ++ cmp %rax,%rcx ++ cmovne %r11,%r12 ++ cmp %rax,%r8 ++ cmovne %r11,%r12 ++ cmp %rax,%r9 ++ cmovne %r11,%r12 ++ cmp %rax,%rsi ++ cmovne %r11,%r12 ++ neg %r12 ++ and %r12,%rax ++ and %r12,%r10 ++ sub %r10,%rdx ++ sub %rax,%rcx ++ sub %rax,%r8 ++ sub %rax,%r9 ++ sub %rax,%rsi ++ mov %rdx,%rax ++ and $0xFF,%eax ++ movb %al,0(%rdi) ++ mov %rdx,%rax ++ shr $8,%rax ++ and $0xFF,%eax ++ movb %al,1(%rdi) ++ mov %rdx,%rax ++ shr $16,%rax ++ and $0xFF,%eax ++ movb %al,2(%rdi) ++ mov %rdx,%rax ++ shr $24,%rax ++ and $0xFF,%eax ++ movb %al,3(%rdi) ++ mov %rdx,%rax ++ shr $32,%rax ++ and $0xFF,%eax ++ movb %al,4(%rdi) ++ mov %rdx,%rax ++ shr $40,%rax ++ and $0xFF,%eax ++ movb %al,5(%rdi) ++ mov %rdx,%rdx ++ shr $48,%rdx ++ mov %rcx,%rax ++ shl $3,%rax ++ and $0xF8,%eax ++ xor %rdx,%rax ++ movb %al,6(%rdi) ++ mov %rcx,%rdx ++ shr $5,%rdx ++ and $0xFF,%edx ++ movb %dl,7(%rdi) ++ mov %rcx,%rdx ++ shr $13,%rdx ++ and $0xFF,%edx ++ movb %dl,8(%rdi) ++ mov %rcx,%rdx ++ shr $21,%rdx ++ and $0xFF,%edx ++ movb %dl,9(%rdi) ++ mov %rcx,%rdx ++ shr $29,%rdx ++ and $0xFF,%edx ++ movb %dl,10(%rdi) ++ mov %rcx,%rdx ++ shr $37,%rdx ++ and $0xFF,%edx ++ movb %dl,11(%rdi) ++ mov %rcx,%rdx ++ shr $45,%rdx ++ mov %r8,%rcx ++ shl $6,%rcx ++ and $0xC0,%ecx ++ xor %rdx,%rcx ++ movb %cl,12(%rdi) ++ mov %r8,%rdx ++ shr $2,%rdx ++ and $0xFF,%edx ++ movb %dl,13(%rdi) ++ mov %r8,%rdx ++ shr $10,%rdx ++ and $0xFF,%edx ++ movb %dl,14(%rdi) ++ mov %r8,%rdx ++ shr $18,%rdx ++ and $0xFF,%edx ++ movb %dl,15(%rdi) ++ mov %r8,%rdx ++ shr $26,%rdx ++ and $0xFF,%edx ++ movb %dl,16(%rdi) ++ mov %r8,%rdx ++ shr $34,%rdx ++ and $0xFF,%edx ++ movb %dl,17(%rdi) ++ mov %r8,%rdx ++ shr $42,%rdx ++ movb %dl,18(%rdi) ++ mov %r8,%rdx ++ shr $50,%rdx ++ mov %r9,%rcx ++ shl $1,%rcx ++ and $0xFE,%ecx ++ xor %rdx,%rcx ++ movb %cl,19(%rdi) ++ mov %r9,%rdx ++ shr $7,%rdx ++ and $0xFF,%edx ++ movb %dl,20(%rdi) ++ mov %r9,%rdx ++ shr $15,%rdx ++ and $0xFF,%edx ++ movb %dl,21(%rdi) ++ mov %r9,%rdx ++ shr $23,%rdx ++ and $0xFF,%edx ++ movb %dl,22(%rdi) ++ mov %r9,%rdx ++ shr $31,%rdx ++ and $0xFF,%edx ++ movb %dl,23(%rdi) ++ mov %r9,%rdx ++ shr $39,%rdx ++ and $0xFF,%edx ++ movb %dl,24(%rdi) ++ mov %r9,%rdx ++ shr $47,%rdx ++ mov %rsi,%rcx ++ shl $4,%rcx ++ and $0xF0,%ecx ++ xor %rdx,%rcx ++ movb %cl,25(%rdi) ++ mov %rsi,%rdx ++ shr $4,%rdx ++ and $0xFF,%edx ++ movb %dl,26(%rdi) ++ mov %rsi,%rdx ++ shr $12,%rdx ++ and $0xFF,%edx ++ movb %dl,27(%rdi) ++ mov %rsi,%rdx ++ shr $20,%rdx ++ and $0xFF,%edx ++ movb %dl,28(%rdi) ++ mov %rsi,%rdx ++ shr $28,%rdx ++ and $0xFF,%edx ++ movb %dl,29(%rdi) ++ mov %rsi,%rdx ++ shr $36,%rdx ++ and $0xFF,%edx ++ movb %dl,30(%rdi) ++ mov %rsi,%rsi ++ shr $44,%rsi ++ movb %sil,31(%rdi) ++ movq 0(%rsp),%r11 ++ movq 8(%rsp),%r12 ++ leave ++ ret ++ENDPROC(curve25519_sandy2x_fe51_pack) ++ ++.align 32 ++ENTRY(curve25519_sandy2x_ladder) ++ push %rbp ++ mov %rsp,%rbp ++ sub $1856,%rsp ++ and $-32,%rsp ++ movq %r11,1824(%rsp) ++ movq %r12,1832(%rsp) ++ movq %r13,1840(%rsp) ++ movq %r14,1848(%rsp) ++ vmovdqa curve25519_sandy2x_v0_0(%rip),%xmm0 ++ vmovdqa curve25519_sandy2x_v1_0(%rip),%xmm1 ++ vmovdqu 0(%rdi),%xmm2 ++ vmovdqa %xmm2,0(%rsp) ++ vmovdqu 16(%rdi),%xmm2 ++ vmovdqa %xmm2,16(%rsp) ++ vmovdqu 32(%rdi),%xmm2 ++ vmovdqa %xmm2,32(%rsp) ++ vmovdqu 48(%rdi),%xmm2 ++ vmovdqa %xmm2,48(%rsp) ++ vmovdqu 64(%rdi),%xmm2 ++ vmovdqa %xmm2,64(%rsp) ++ vmovdqa %xmm1,80(%rsp) ++ vmovdqa %xmm0,96(%rsp) ++ vmovdqa %xmm0,112(%rsp) ++ vmovdqa %xmm0,128(%rsp) ++ vmovdqa %xmm0,144(%rsp) ++ vmovdqa %xmm1,%xmm0 ++ vpxor %xmm1,%xmm1,%xmm1 ++ vpxor %xmm2,%xmm2,%xmm2 ++ vpxor %xmm3,%xmm3,%xmm3 ++ vpxor %xmm4,%xmm4,%xmm4 ++ vpxor %xmm5,%xmm5,%xmm5 ++ vpxor %xmm6,%xmm6,%xmm6 ++ vpxor %xmm7,%xmm7,%xmm7 ++ vpxor %xmm8,%xmm8,%xmm8 ++ vpxor %xmm9,%xmm9,%xmm9 ++ vmovdqu 0(%rdi),%xmm10 ++ vmovdqa %xmm10,160(%rsp) ++ vmovdqu 16(%rdi),%xmm10 ++ vmovdqa %xmm10,176(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 ++ vmovdqa %xmm10,192(%rsp) ++ vmovdqu 32(%rdi),%xmm10 ++ vmovdqa %xmm10,208(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 ++ vmovdqa %xmm10,224(%rsp) ++ vmovdqu 48(%rdi),%xmm10 ++ vmovdqa %xmm10,240(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 ++ vmovdqa %xmm10,256(%rsp) ++ vmovdqu 64(%rdi),%xmm10 ++ vmovdqa %xmm10,272(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 ++ vmovdqa %xmm10,288(%rsp) ++ vmovdqu 8(%rdi),%xmm10 ++ vpmuludq curve25519_sandy2x_v2_1(%rip),%xmm10,%xmm10 ++ vmovdqa %xmm10,304(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 ++ vmovdqa %xmm10,320(%rsp) ++ vmovdqu 24(%rdi),%xmm10 ++ vpmuludq curve25519_sandy2x_v2_1(%rip),%xmm10,%xmm10 ++ vmovdqa %xmm10,336(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 ++ vmovdqa %xmm10,352(%rsp) ++ vmovdqu 40(%rdi),%xmm10 ++ vpmuludq curve25519_sandy2x_v2_1(%rip),%xmm10,%xmm10 ++ vmovdqa %xmm10,368(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 ++ vmovdqa %xmm10,384(%rsp) ++ vmovdqu 56(%rdi),%xmm10 ++ vpmuludq curve25519_sandy2x_v2_1(%rip),%xmm10,%xmm10 ++ vmovdqa %xmm10,400(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 ++ vmovdqa %xmm10,416(%rsp) ++ vmovdqu 0(%rdi),%xmm10 ++ vmovdqu 64(%rdi),%xmm11 ++ vblendps $12, %xmm11, %xmm10, %xmm10 ++ vpshufd $2,%xmm10,%xmm10 ++ vpmuludq curve25519_sandy2x_v38_1(%rip),%xmm10,%xmm10 ++ vmovdqa %xmm10,432(%rsp) ++ movq 0(%rsi),%rdx ++ movq 8(%rsi),%rcx ++ movq 16(%rsi),%r8 ++ movq 24(%rsi),%r9 ++ shrd $1,%rcx,%rdx ++ shrd $1,%r8,%rcx ++ shrd $1,%r9,%r8 ++ shr $1,%r9 ++ xorq 0(%rsi),%rdx ++ xorq 8(%rsi),%rcx ++ xorq 16(%rsi),%r8 ++ xorq 24(%rsi),%r9 ++ leaq 800(%rsp),%rsi ++ mov $64,%rax ++ ++ .align 16 ++ .Lladder_small_loop: ++ mov %rdx,%r10 ++ mov %rcx,%r11 ++ mov %r8,%r12 ++ mov %r9,%r13 ++ shr $1,%rdx ++ shr $1,%rcx ++ shr $1,%r8 ++ shr $1,%r9 ++ and $1,%r10d ++ and $1,%r11d ++ and $1,%r12d ++ and $1,%r13d ++ neg %r10 ++ neg %r11 ++ neg %r12 ++ neg %r13 ++ movl %r10d,0(%rsi) ++ movl %r11d,256(%rsi) ++ movl %r12d,512(%rsi) ++ movl %r13d,768(%rsi) ++ add $4,%rsi ++ sub $1,%rax ++ jne .Lladder_small_loop ++ mov $255,%rdx ++ add $760,%rsi ++ ++ .align 16 ++ .Lladder_loop: ++ sub $1,%rdx ++ vbroadcastss 0(%rsi),%xmm10 ++ sub $4,%rsi ++ vmovdqa 0(%rsp),%xmm11 ++ vmovdqa 80(%rsp),%xmm12 ++ vpxor %xmm11,%xmm0,%xmm13 ++ vpand %xmm10,%xmm13,%xmm13 ++ vpxor %xmm13,%xmm0,%xmm0 ++ vpxor %xmm13,%xmm11,%xmm11 ++ vpxor %xmm12,%xmm1,%xmm13 ++ vpand %xmm10,%xmm13,%xmm13 ++ vpxor %xmm13,%xmm1,%xmm1 ++ vpxor %xmm13,%xmm12,%xmm12 ++ vmovdqa 16(%rsp),%xmm13 ++ vmovdqa 96(%rsp),%xmm14 ++ vpxor %xmm13,%xmm2,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm2,%xmm2 ++ vpxor %xmm15,%xmm13,%xmm13 ++ vpxor %xmm14,%xmm3,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm3,%xmm3 ++ vpxor %xmm15,%xmm14,%xmm14 ++ vmovdqa %xmm13,0(%rsp) ++ vmovdqa %xmm14,16(%rsp) ++ vmovdqa 32(%rsp),%xmm13 ++ vmovdqa 112(%rsp),%xmm14 ++ vpxor %xmm13,%xmm4,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm4,%xmm4 ++ vpxor %xmm15,%xmm13,%xmm13 ++ vpxor %xmm14,%xmm5,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm5,%xmm5 ++ vpxor %xmm15,%xmm14,%xmm14 ++ vmovdqa %xmm13,32(%rsp) ++ vmovdqa %xmm14,80(%rsp) ++ vmovdqa 48(%rsp),%xmm13 ++ vmovdqa 128(%rsp),%xmm14 ++ vpxor %xmm13,%xmm6,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm6,%xmm6 ++ vpxor %xmm15,%xmm13,%xmm13 ++ vpxor %xmm14,%xmm7,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm7,%xmm7 ++ vpxor %xmm15,%xmm14,%xmm14 ++ vmovdqa %xmm13,48(%rsp) ++ vmovdqa %xmm14,96(%rsp) ++ vmovdqa 64(%rsp),%xmm13 ++ vmovdqa 144(%rsp),%xmm14 ++ vpxor %xmm13,%xmm8,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm8,%xmm8 ++ vpxor %xmm15,%xmm13,%xmm13 ++ vpxor %xmm14,%xmm9,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm9,%xmm9 ++ vpxor %xmm15,%xmm14,%xmm14 ++ vmovdqa %xmm13,64(%rsp) ++ vmovdqa %xmm14,112(%rsp) ++ vpaddq curve25519_sandy2x_subc0(%rip),%xmm11,%xmm10 ++ vpsubq %xmm12,%xmm10,%xmm10 ++ vpaddq %xmm12,%xmm11,%xmm11 ++ vpunpckhqdq %xmm10,%xmm11,%xmm12 ++ vpunpcklqdq %xmm10,%xmm11,%xmm10 ++ vpaddq %xmm1,%xmm0,%xmm11 ++ vpaddq curve25519_sandy2x_subc0(%rip),%xmm0,%xmm0 ++ vpsubq %xmm1,%xmm0,%xmm0 ++ vpunpckhqdq %xmm11,%xmm0,%xmm1 ++ vpunpcklqdq %xmm11,%xmm0,%xmm0 ++ vpmuludq %xmm0,%xmm10,%xmm11 ++ vpmuludq %xmm1,%xmm10,%xmm13 ++ vmovdqa %xmm1,128(%rsp) ++ vpaddq %xmm1,%xmm1,%xmm1 ++ vpmuludq %xmm0,%xmm12,%xmm14 ++ vmovdqa %xmm0,144(%rsp) ++ vpaddq %xmm14,%xmm13,%xmm13 ++ vpmuludq %xmm1,%xmm12,%xmm0 ++ vmovdqa %xmm1,448(%rsp) ++ vpaddq %xmm3,%xmm2,%xmm1 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm2,%xmm2 ++ vpsubq %xmm3,%xmm2,%xmm2 ++ vpunpckhqdq %xmm1,%xmm2,%xmm3 ++ vpunpcklqdq %xmm1,%xmm2,%xmm1 ++ vpmuludq %xmm1,%xmm10,%xmm2 ++ vpaddq %xmm2,%xmm0,%xmm0 ++ vpmuludq %xmm3,%xmm10,%xmm2 ++ vmovdqa %xmm3,464(%rsp) ++ vpaddq %xmm3,%xmm3,%xmm3 ++ vpmuludq %xmm1,%xmm12,%xmm14 ++ vmovdqa %xmm1,480(%rsp) ++ vpaddq %xmm14,%xmm2,%xmm2 ++ vpmuludq %xmm3,%xmm12,%xmm1 ++ vmovdqa %xmm3,496(%rsp) ++ vpaddq %xmm5,%xmm4,%xmm3 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm4,%xmm4 ++ vpsubq %xmm5,%xmm4,%xmm4 ++ vpunpckhqdq %xmm3,%xmm4,%xmm5 ++ vpunpcklqdq %xmm3,%xmm4,%xmm3 ++ vpmuludq %xmm3,%xmm10,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vpmuludq %xmm5,%xmm10,%xmm4 ++ vmovdqa %xmm5,512(%rsp) ++ vpaddq %xmm5,%xmm5,%xmm5 ++ vpmuludq %xmm3,%xmm12,%xmm14 ++ vmovdqa %xmm3,528(%rsp) ++ vpaddq %xmm14,%xmm4,%xmm4 ++ vpaddq %xmm7,%xmm6,%xmm3 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm6,%xmm6 ++ vpsubq %xmm7,%xmm6,%xmm6 ++ vpunpckhqdq %xmm3,%xmm6,%xmm7 ++ vpunpcklqdq %xmm3,%xmm6,%xmm3 ++ vpmuludq %xmm3,%xmm10,%xmm6 ++ vpmuludq %xmm5,%xmm12,%xmm14 ++ vmovdqa %xmm5,544(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm5,%xmm5 ++ vmovdqa %xmm5,560(%rsp) ++ vpaddq %xmm14,%xmm6,%xmm6 ++ vpmuludq %xmm7,%xmm10,%xmm5 ++ vmovdqa %xmm7,576(%rsp) ++ vpaddq %xmm7,%xmm7,%xmm7 ++ vpmuludq %xmm3,%xmm12,%xmm14 ++ vmovdqa %xmm3,592(%rsp) ++ vpaddq %xmm14,%xmm5,%xmm5 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 ++ vmovdqa %xmm3,608(%rsp) ++ vpaddq %xmm9,%xmm8,%xmm3 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm8,%xmm8 ++ vpsubq %xmm9,%xmm8,%xmm8 ++ vpunpckhqdq %xmm3,%xmm8,%xmm9 ++ vpunpcklqdq %xmm3,%xmm8,%xmm3 ++ vmovdqa %xmm3,624(%rsp) ++ vpmuludq %xmm7,%xmm12,%xmm8 ++ vmovdqa %xmm7,640(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm7,%xmm7 ++ vmovdqa %xmm7,656(%rsp) ++ vpmuludq %xmm3,%xmm10,%xmm7 ++ vpaddq %xmm7,%xmm8,%xmm8 ++ vpmuludq %xmm9,%xmm10,%xmm7 ++ vmovdqa %xmm9,672(%rsp) ++ vpaddq %xmm9,%xmm9,%xmm9 ++ vpmuludq %xmm3,%xmm12,%xmm10 ++ vpaddq %xmm10,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 ++ vmovdqa %xmm3,688(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm12,%xmm12 ++ vpmuludq %xmm9,%xmm12,%xmm3 ++ vmovdqa %xmm9,704(%rsp) ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vmovdqa 0(%rsp),%xmm3 ++ vmovdqa 16(%rsp),%xmm9 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 ++ vpsubq %xmm9,%xmm10,%xmm10 ++ vpaddq %xmm9,%xmm3,%xmm3 ++ vpunpckhqdq %xmm10,%xmm3,%xmm9 ++ vpunpcklqdq %xmm10,%xmm3,%xmm3 ++ vpmuludq 144(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm0,%xmm0 ++ vpmuludq 128(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm2,%xmm2 ++ vpmuludq 480(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm1,%xmm1 ++ vpmuludq 464(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm4,%xmm4 ++ vpmuludq 528(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm6,%xmm6 ++ vpmuludq 512(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm5,%xmm5 ++ vpmuludq 592(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm8,%xmm8 ++ vpmuludq 576(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 ++ vpmuludq 624(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm11,%xmm11 ++ vpmuludq 672(%rsp),%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 144(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpmuludq 448(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm1,%xmm1 ++ vpmuludq 480(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 496(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 528(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 544(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm8,%xmm8 ++ vpmuludq 592(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 ++ vpmuludq 640(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 624(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 704(%rsp),%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm0,%xmm0 ++ vmovdqa 32(%rsp),%xmm3 ++ vmovdqa 80(%rsp),%xmm9 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 ++ vpsubq %xmm9,%xmm10,%xmm10 ++ vpaddq %xmm9,%xmm3,%xmm3 ++ vpunpckhqdq %xmm10,%xmm3,%xmm9 ++ vpunpcklqdq %xmm10,%xmm3,%xmm3 ++ vpmuludq 144(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm1,%xmm1 ++ vpmuludq 128(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm4,%xmm4 ++ vpmuludq 480(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm6,%xmm6 ++ vpmuludq 464(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm5,%xmm5 ++ vpmuludq 528(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm8,%xmm8 ++ vpmuludq 512(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 ++ vpmuludq 592(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm11,%xmm11 ++ vpmuludq 576(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm13,%xmm13 ++ vpmuludq 624(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm0,%xmm0 ++ vpmuludq 672(%rsp),%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpmuludq 144(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 448(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 480(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 496(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm8,%xmm8 ++ vpmuludq 528(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 ++ vpmuludq 544(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 592(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 640(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm0,%xmm0 ++ vpmuludq 624(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpmuludq 704(%rsp),%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm1,%xmm1 ++ vmovdqa 48(%rsp),%xmm3 ++ vmovdqa 96(%rsp),%xmm9 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 ++ vpsubq %xmm9,%xmm10,%xmm10 ++ vpaddq %xmm9,%xmm3,%xmm3 ++ vpunpckhqdq %xmm10,%xmm3,%xmm9 ++ vpunpcklqdq %xmm10,%xmm3,%xmm3 ++ vpmuludq 144(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm6,%xmm6 ++ vpmuludq 128(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm5,%xmm5 ++ vpmuludq 480(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm8,%xmm8 ++ vpmuludq 464(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 ++ vpmuludq 528(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm11,%xmm11 ++ vpmuludq 512(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm13,%xmm13 ++ vpmuludq 592(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm0,%xmm0 ++ vpmuludq 576(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm2,%xmm2 ++ vpmuludq 624(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm1,%xmm1 ++ vpmuludq 672(%rsp),%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 144(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 448(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm8,%xmm8 ++ vpmuludq 480(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 ++ vpmuludq 496(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 528(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 544(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm0,%xmm0 ++ vpmuludq 592(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpmuludq 640(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm1,%xmm1 ++ vpmuludq 624(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 704(%rsp),%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm6,%xmm6 ++ vmovdqa 64(%rsp),%xmm3 ++ vmovdqa 112(%rsp),%xmm9 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 ++ vpsubq %xmm9,%xmm10,%xmm10 ++ vpaddq %xmm9,%xmm3,%xmm3 ++ vpunpckhqdq %xmm10,%xmm3,%xmm9 ++ vpunpcklqdq %xmm10,%xmm3,%xmm3 ++ vpmuludq 144(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm8,%xmm8 ++ vpmuludq 128(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 ++ vpmuludq 480(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm11,%xmm11 ++ vpmuludq 464(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm13,%xmm13 ++ vpmuludq 528(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm0,%xmm0 ++ vpmuludq 512(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm2,%xmm2 ++ vpmuludq 592(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm1,%xmm1 ++ vpmuludq 576(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm4,%xmm4 ++ vpmuludq 624(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm6,%xmm6 ++ vpmuludq 672(%rsp),%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 144(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 ++ vpmuludq 448(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 480(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 496(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm0,%xmm0 ++ vpmuludq 528(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpmuludq 544(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm1,%xmm1 ++ vpmuludq 592(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 640(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 624(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 704(%rsp),%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm8,%xmm8 ++ vpsrlq $25,%xmm4,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpand curve25519_sandy2x_m25(%rip),%xmm4,%xmm4 ++ vpsrlq $26,%xmm11,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 ++ vpsrlq $26,%xmm6,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 ++ vpsrlq $25,%xmm13,%xmm3 ++ vpaddq %xmm3,%xmm0,%xmm0 ++ vpand curve25519_sandy2x_m25(%rip),%xmm13,%xmm13 ++ vpsrlq $25,%xmm5,%xmm3 ++ vpaddq %xmm3,%xmm8,%xmm8 ++ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 ++ vpsrlq $26,%xmm0,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpand curve25519_sandy2x_m26(%rip),%xmm0,%xmm0 ++ vpsrlq $26,%xmm8,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpand curve25519_sandy2x_m26(%rip),%xmm8,%xmm8 ++ vpsrlq $25,%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm1,%xmm1 ++ vpand curve25519_sandy2x_m25(%rip),%xmm2,%xmm2 ++ vpsrlq $25,%xmm7,%xmm3 ++ vpsllq $4,%xmm3,%xmm9 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpsllq $1,%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m25(%rip),%xmm7,%xmm7 ++ vpsrlq $26,%xmm1,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 ++ vpsrlq $26,%xmm11,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 ++ vpsrlq $25,%xmm4,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpand curve25519_sandy2x_m25(%rip),%xmm4,%xmm4 ++ vpunpcklqdq %xmm13,%xmm11,%xmm3 ++ vpunpckhqdq %xmm13,%xmm11,%xmm9 ++ vpaddq curve25519_sandy2x_subc0(%rip),%xmm9,%xmm10 ++ vpsubq %xmm3,%xmm10,%xmm10 ++ vpaddq %xmm9,%xmm3,%xmm3 ++ vpunpckhqdq %xmm3,%xmm10,%xmm9 ++ vpunpcklqdq %xmm3,%xmm10,%xmm10 ++ vpmuludq %xmm10,%xmm10,%xmm3 ++ vpaddq %xmm10,%xmm10,%xmm10 ++ vpmuludq %xmm9,%xmm10,%xmm11 ++ vpunpcklqdq %xmm2,%xmm0,%xmm12 ++ vpunpckhqdq %xmm2,%xmm0,%xmm0 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm0,%xmm2 ++ vpsubq %xmm12,%xmm2,%xmm2 ++ vpaddq %xmm0,%xmm12,%xmm12 ++ vpunpckhqdq %xmm12,%xmm2,%xmm0 ++ vpunpcklqdq %xmm12,%xmm2,%xmm2 ++ vpmuludq %xmm2,%xmm10,%xmm12 ++ vpaddq %xmm9,%xmm9,%xmm13 ++ vpmuludq %xmm13,%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm12,%xmm12 ++ vpmuludq %xmm0,%xmm10,%xmm9 ++ vpmuludq %xmm2,%xmm13,%xmm14 ++ vpaddq %xmm14,%xmm9,%xmm9 ++ vpunpcklqdq %xmm4,%xmm1,%xmm14 ++ vpunpckhqdq %xmm4,%xmm1,%xmm1 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm1,%xmm4 ++ vpsubq %xmm14,%xmm4,%xmm4 ++ vpaddq %xmm1,%xmm14,%xmm14 ++ vpunpckhqdq %xmm14,%xmm4,%xmm1 ++ vpunpcklqdq %xmm14,%xmm4,%xmm4 ++ vmovdqa %xmm1,0(%rsp) ++ vpaddq %xmm1,%xmm1,%xmm1 ++ vmovdqa %xmm1,16(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 ++ vmovdqa %xmm1,32(%rsp) ++ vpmuludq %xmm4,%xmm10,%xmm1 ++ vpmuludq %xmm2,%xmm2,%xmm14 ++ vpaddq %xmm14,%xmm1,%xmm1 ++ vpmuludq 0(%rsp),%xmm10,%xmm14 ++ vpmuludq %xmm4,%xmm13,%xmm15 ++ vpaddq %xmm15,%xmm14,%xmm14 ++ vpunpcklqdq %xmm5,%xmm6,%xmm15 ++ vpunpckhqdq %xmm5,%xmm6,%xmm5 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm5,%xmm6 ++ vpsubq %xmm15,%xmm6,%xmm6 ++ vpaddq %xmm5,%xmm15,%xmm15 ++ vpunpckhqdq %xmm15,%xmm6,%xmm5 ++ vpunpcklqdq %xmm15,%xmm6,%xmm6 ++ vmovdqa %xmm6,48(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm6,%xmm6 ++ vmovdqa %xmm6,64(%rsp) ++ vmovdqa %xmm5,80(%rsp) ++ vpmuludq curve25519_sandy2x_v38_38(%rip),%xmm5,%xmm5 ++ vmovdqa %xmm5,96(%rsp) ++ vpmuludq 48(%rsp),%xmm10,%xmm5 ++ vpaddq %xmm0,%xmm0,%xmm6 ++ vpmuludq %xmm6,%xmm0,%xmm0 ++ vpaddq %xmm0,%xmm5,%xmm5 ++ vpmuludq 80(%rsp),%xmm10,%xmm0 ++ vpmuludq %xmm4,%xmm6,%xmm15 ++ vpaddq %xmm15,%xmm0,%xmm0 ++ vpmuludq %xmm6,%xmm13,%xmm15 ++ vpaddq %xmm15,%xmm1,%xmm1 ++ vpmuludq %xmm6,%xmm2,%xmm15 ++ vpaddq %xmm15,%xmm14,%xmm14 ++ vpunpcklqdq %xmm7,%xmm8,%xmm15 ++ vpunpckhqdq %xmm7,%xmm8,%xmm7 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm7,%xmm8 ++ vpsubq %xmm15,%xmm8,%xmm8 ++ vpaddq %xmm7,%xmm15,%xmm15 ++ vpunpckhqdq %xmm15,%xmm8,%xmm7 ++ vpunpcklqdq %xmm15,%xmm8,%xmm8 ++ vmovdqa %xmm8,112(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm8,%xmm8 ++ vmovdqa %xmm8,448(%rsp) ++ vpmuludq 112(%rsp),%xmm10,%xmm8 ++ vpmuludq %xmm7,%xmm10,%xmm10 ++ vpmuludq curve25519_sandy2x_v38_38(%rip),%xmm7,%xmm15 ++ vpmuludq %xmm15,%xmm7,%xmm7 ++ vpaddq %xmm7,%xmm8,%xmm8 ++ vpmuludq %xmm15,%xmm13,%xmm7 ++ vpaddq %xmm7,%xmm3,%xmm3 ++ vpmuludq %xmm15,%xmm2,%xmm7 ++ vpaddq %xmm7,%xmm11,%xmm11 ++ vpmuludq 80(%rsp),%xmm13,%xmm7 ++ vpaddq %xmm7,%xmm7,%xmm7 ++ vpaddq %xmm7,%xmm8,%xmm8 ++ vpmuludq 16(%rsp),%xmm13,%xmm7 ++ vpaddq %xmm7,%xmm5,%xmm5 ++ vpmuludq 48(%rsp),%xmm13,%xmm7 ++ vpaddq %xmm7,%xmm0,%xmm0 ++ vpmuludq 112(%rsp),%xmm13,%xmm7 ++ vpaddq %xmm7,%xmm10,%xmm10 ++ vpmuludq %xmm15,%xmm6,%xmm7 ++ vpaddq %xmm7,%xmm12,%xmm12 ++ vpmuludq %xmm15,%xmm4,%xmm7 ++ vpaddq %xmm7,%xmm9,%xmm9 ++ vpaddq %xmm2,%xmm2,%xmm2 ++ vpmuludq %xmm4,%xmm2,%xmm7 ++ vpaddq %xmm7,%xmm5,%xmm5 ++ vpmuludq 448(%rsp),%xmm2,%xmm7 ++ vpaddq %xmm7,%xmm3,%xmm3 ++ vpmuludq 448(%rsp),%xmm6,%xmm7 ++ vpaddq %xmm7,%xmm11,%xmm11 ++ vpmuludq 0(%rsp),%xmm2,%xmm7 ++ vpaddq %xmm7,%xmm0,%xmm0 ++ vpmuludq 48(%rsp),%xmm2,%xmm7 ++ vpaddq %xmm7,%xmm8,%xmm8 ++ vpmuludq 80(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq 96(%rsp),%xmm4,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpmuludq %xmm4,%xmm4,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpaddq %xmm4,%xmm4,%xmm2 ++ vpmuludq 448(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm12,%xmm12 ++ vpmuludq 16(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vpmuludq 48(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm14,%xmm14 ++ vpmuludq 96(%rsp),%xmm6,%xmm4 ++ vpaddq %xmm4,%xmm3,%xmm3 ++ vmovdqa 16(%rsp),%xmm4 ++ vpmuludq 448(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm9,%xmm9 ++ vpmuludq 16(%rsp),%xmm6,%xmm4 ++ vpaddq %xmm4,%xmm8,%xmm8 ++ vpmuludq 48(%rsp),%xmm6,%xmm4 ++ vpaddq %xmm4,%xmm10,%xmm10 ++ vpmuludq 80(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm5,%xmm5 ++ vpmuludq 112(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm0,%xmm0 ++ vmovdqa 48(%rsp),%xmm4 ++ vpaddq %xmm4,%xmm4,%xmm4 ++ vpmuludq 448(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vmovdqa 80(%rsp),%xmm4 ++ vpaddq %xmm4,%xmm4,%xmm4 ++ vpmuludq 448(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm14,%xmm14 ++ vpmuludq 64(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm3,%xmm3 ++ vmovdqa 16(%rsp),%xmm4 ++ vpmuludq 64(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm11,%xmm11 ++ vmovdqa 16(%rsp),%xmm4 ++ vpmuludq 96(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm12,%xmm12 ++ vmovdqa 48(%rsp),%xmm4 ++ vpmuludq 96(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm9,%xmm9 ++ vpmuludq 0(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vmovdqa 32(%rsp),%xmm2 ++ vpmuludq 0(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm3,%xmm3 ++ vmovdqa 64(%rsp),%xmm2 ++ vpmuludq 48(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vmovdqa 96(%rsp),%xmm2 ++ vpmuludq 80(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm1,%xmm1 ++ vmovdqa 448(%rsp),%xmm2 ++ vpmuludq 112(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpsrlq $26,%xmm3,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m26(%rip),%xmm3,%xmm3 ++ vpsrlq $25,%xmm14,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m25(%rip),%xmm14,%xmm14 ++ vpsrlq $25,%xmm11,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpand curve25519_sandy2x_m25(%rip),%xmm11,%xmm11 ++ vpsrlq $26,%xmm5,%xmm2 ++ vpaddq %xmm2,%xmm0,%xmm0 ++ vpand curve25519_sandy2x_m26(%rip),%xmm5,%xmm5 ++ vpsrlq $26,%xmm12,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpand curve25519_sandy2x_m26(%rip),%xmm12,%xmm12 ++ vpsrlq $25,%xmm0,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpand curve25519_sandy2x_m25(%rip),%xmm0,%xmm0 ++ vpsrlq $25,%xmm9,%xmm2 ++ vpaddq %xmm2,%xmm1,%xmm1 ++ vpand curve25519_sandy2x_m25(%rip),%xmm9,%xmm9 ++ vpsrlq $26,%xmm8,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpand curve25519_sandy2x_m26(%rip),%xmm8,%xmm8 ++ vpsrlq $26,%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm14,%xmm14 ++ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 ++ vpsrlq $25,%xmm10,%xmm2 ++ vpsllq $4,%xmm2,%xmm4 ++ vpaddq %xmm2,%xmm3,%xmm3 ++ vpsllq $1,%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm3,%xmm3 ++ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 ++ vpsrlq $25,%xmm14,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m25(%rip),%xmm14,%xmm14 ++ vpsrlq $26,%xmm3,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m26(%rip),%xmm3,%xmm3 ++ vpunpckhqdq %xmm11,%xmm3,%xmm2 ++ vmovdqa %xmm2,0(%rsp) ++ vpshufd $0,%xmm3,%xmm2 ++ vpshufd $0,%xmm11,%xmm3 ++ vpmuludq 160(%rsp),%xmm2,%xmm4 ++ vpmuludq 432(%rsp),%xmm3,%xmm6 ++ vpaddq %xmm6,%xmm4,%xmm4 ++ vpmuludq 176(%rsp),%xmm2,%xmm6 ++ vpmuludq 304(%rsp),%xmm3,%xmm7 ++ vpaddq %xmm7,%xmm6,%xmm6 ++ vpmuludq 208(%rsp),%xmm2,%xmm7 ++ vpmuludq 336(%rsp),%xmm3,%xmm11 ++ vpaddq %xmm11,%xmm7,%xmm7 ++ vpmuludq 240(%rsp),%xmm2,%xmm11 ++ vpmuludq 368(%rsp),%xmm3,%xmm13 ++ vpaddq %xmm13,%xmm11,%xmm11 ++ vpmuludq 272(%rsp),%xmm2,%xmm2 ++ vpmuludq 400(%rsp),%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpunpckhqdq %xmm9,%xmm12,%xmm3 ++ vmovdqa %xmm3,16(%rsp) ++ vpshufd $0,%xmm12,%xmm3 ++ vpshufd $0,%xmm9,%xmm9 ++ vpmuludq 288(%rsp),%xmm3,%xmm12 ++ vpaddq %xmm12,%xmm4,%xmm4 ++ vpmuludq 416(%rsp),%xmm9,%xmm12 ++ vpaddq %xmm12,%xmm4,%xmm4 ++ vpmuludq 160(%rsp),%xmm3,%xmm12 ++ vpaddq %xmm12,%xmm6,%xmm6 ++ vpmuludq 432(%rsp),%xmm9,%xmm12 ++ vpaddq %xmm12,%xmm6,%xmm6 ++ vpmuludq 176(%rsp),%xmm3,%xmm12 ++ vpaddq %xmm12,%xmm7,%xmm7 ++ vpmuludq 304(%rsp),%xmm9,%xmm12 ++ vpaddq %xmm12,%xmm7,%xmm7 ++ vpmuludq 208(%rsp),%xmm3,%xmm12 ++ vpaddq %xmm12,%xmm11,%xmm11 ++ vpmuludq 336(%rsp),%xmm9,%xmm12 ++ vpaddq %xmm12,%xmm11,%xmm11 ++ vpmuludq 240(%rsp),%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpmuludq 368(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpunpckhqdq %xmm14,%xmm1,%xmm3 ++ vmovdqa %xmm3,32(%rsp) ++ vpshufd $0,%xmm1,%xmm1 ++ vpshufd $0,%xmm14,%xmm3 ++ vpmuludq 256(%rsp),%xmm1,%xmm9 ++ vpaddq %xmm9,%xmm4,%xmm4 ++ vpmuludq 384(%rsp),%xmm3,%xmm9 ++ vpaddq %xmm9,%xmm4,%xmm4 ++ vpmuludq 288(%rsp),%xmm1,%xmm9 ++ vpaddq %xmm9,%xmm6,%xmm6 ++ vpmuludq 416(%rsp),%xmm3,%xmm9 ++ vpaddq %xmm9,%xmm6,%xmm6 ++ vpmuludq 160(%rsp),%xmm1,%xmm9 ++ vpaddq %xmm9,%xmm7,%xmm7 ++ vpmuludq 432(%rsp),%xmm3,%xmm9 ++ vpaddq %xmm9,%xmm7,%xmm7 ++ vpmuludq 176(%rsp),%xmm1,%xmm9 ++ vpaddq %xmm9,%xmm11,%xmm11 ++ vpmuludq 304(%rsp),%xmm3,%xmm9 ++ vpaddq %xmm9,%xmm11,%xmm11 ++ vpmuludq 208(%rsp),%xmm1,%xmm1 ++ vpaddq %xmm1,%xmm2,%xmm2 ++ vpmuludq 336(%rsp),%xmm3,%xmm1 ++ vpaddq %xmm1,%xmm2,%xmm2 ++ vpunpckhqdq %xmm0,%xmm5,%xmm1 ++ vmovdqa %xmm1,48(%rsp) ++ vpshufd $0,%xmm5,%xmm1 ++ vpshufd $0,%xmm0,%xmm0 ++ vpmuludq 224(%rsp),%xmm1,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 352(%rsp),%xmm0,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 256(%rsp),%xmm1,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 384(%rsp),%xmm0,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 288(%rsp),%xmm1,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq 416(%rsp),%xmm0,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq 160(%rsp),%xmm1,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 432(%rsp),%xmm0,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 176(%rsp),%xmm1,%xmm1 ++ vpaddq %xmm1,%xmm2,%xmm2 ++ vpmuludq 304(%rsp),%xmm0,%xmm0 ++ vpaddq %xmm0,%xmm2,%xmm2 ++ vpunpckhqdq %xmm10,%xmm8,%xmm0 ++ vmovdqa %xmm0,64(%rsp) ++ vpshufd $0,%xmm8,%xmm0 ++ vpshufd $0,%xmm10,%xmm1 ++ vpmuludq 192(%rsp),%xmm0,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 320(%rsp),%xmm1,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 224(%rsp),%xmm0,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 352(%rsp),%xmm1,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 256(%rsp),%xmm0,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq 384(%rsp),%xmm1,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq 288(%rsp),%xmm0,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 416(%rsp),%xmm1,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 160(%rsp),%xmm0,%xmm0 ++ vpaddq %xmm0,%xmm2,%xmm2 ++ vpmuludq 432(%rsp),%xmm1,%xmm0 ++ vpaddq %xmm0,%xmm2,%xmm2 ++ vmovdqa %xmm4,80(%rsp) ++ vmovdqa %xmm6,96(%rsp) ++ vmovdqa %xmm7,112(%rsp) ++ vmovdqa %xmm11,448(%rsp) ++ vmovdqa %xmm2,496(%rsp) ++ vmovdqa 144(%rsp),%xmm0 ++ vpmuludq %xmm0,%xmm0,%xmm1 ++ vpaddq %xmm0,%xmm0,%xmm0 ++ vmovdqa 128(%rsp),%xmm2 ++ vpmuludq %xmm2,%xmm0,%xmm3 ++ vmovdqa 480(%rsp),%xmm4 ++ vpmuludq %xmm4,%xmm0,%xmm5 ++ vmovdqa 464(%rsp),%xmm6 ++ vpmuludq %xmm6,%xmm0,%xmm7 ++ vmovdqa 528(%rsp),%xmm8 ++ vpmuludq %xmm8,%xmm0,%xmm9 ++ vpmuludq 512(%rsp),%xmm0,%xmm10 ++ vpmuludq 592(%rsp),%xmm0,%xmm11 ++ vpmuludq 576(%rsp),%xmm0,%xmm12 ++ vpmuludq 624(%rsp),%xmm0,%xmm13 ++ vmovdqa 672(%rsp),%xmm14 ++ vpmuludq %xmm14,%xmm0,%xmm0 ++ vpmuludq curve25519_sandy2x_v38_38(%rip),%xmm14,%xmm15 ++ vpmuludq %xmm15,%xmm14,%xmm14 ++ vpaddq %xmm14,%xmm13,%xmm13 ++ vpaddq %xmm6,%xmm6,%xmm14 ++ vpmuludq %xmm14,%xmm6,%xmm6 ++ vpaddq %xmm6,%xmm11,%xmm11 ++ vpaddq %xmm2,%xmm2,%xmm6 ++ vpmuludq %xmm6,%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpmuludq %xmm15,%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm1,%xmm1 ++ vpmuludq %xmm15,%xmm4,%xmm2 ++ vpaddq %xmm2,%xmm3,%xmm3 ++ vpmuludq 544(%rsp),%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpmuludq 592(%rsp),%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq 640(%rsp),%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpmuludq 624(%rsp),%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm0,%xmm0 ++ vpmuludq %xmm4,%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm7,%xmm7 ++ vpmuludq %xmm14,%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpmuludq %xmm8,%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq %xmm15,%xmm14,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpmuludq %xmm15,%xmm8,%xmm2 ++ vpaddq %xmm2,%xmm7,%xmm7 ++ vpmuludq %xmm4,%xmm4,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpmuludq %xmm14,%xmm4,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpaddq %xmm4,%xmm4,%xmm2 ++ vpmuludq %xmm8,%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm11,%xmm11 ++ vpmuludq 688(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vpmuludq 688(%rsp),%xmm14,%xmm4 ++ vpaddq %xmm4,%xmm3,%xmm3 ++ vpmuludq 512(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm12,%xmm12 ++ vpmuludq 592(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm13,%xmm13 ++ vpmuludq 576(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm0,%xmm0 ++ vpmuludq 656(%rsp),%xmm8,%xmm2 ++ vpaddq %xmm2,%xmm3,%xmm3 ++ vpmuludq %xmm8,%xmm14,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq %xmm8,%xmm8,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpaddq %xmm8,%xmm8,%xmm2 ++ vpmuludq 688(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm5,%xmm5 ++ vpmuludq 544(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm9,%xmm9 ++ vpmuludq 592(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm10,%xmm10 ++ vpmuludq 656(%rsp),%xmm14,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vmovdqa 544(%rsp),%xmm4 ++ vpmuludq 688(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm7,%xmm7 ++ vpmuludq 544(%rsp),%xmm14,%xmm4 ++ vpaddq %xmm4,%xmm13,%xmm13 ++ vpmuludq 592(%rsp),%xmm14,%xmm4 ++ vpaddq %xmm4,%xmm0,%xmm0 ++ vpmuludq 640(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm11,%xmm11 ++ vpmuludq 624(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm12,%xmm12 ++ vmovdqa 592(%rsp),%xmm4 ++ vpaddq %xmm4,%xmm4,%xmm4 ++ vpmuludq 688(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm9,%xmm9 ++ vpmuludq 608(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vmovdqa 544(%rsp),%xmm4 ++ vpmuludq 608(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm3,%xmm3 ++ vmovdqa 544(%rsp),%xmm4 ++ vpmuludq 656(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm5,%xmm5 ++ vmovdqa 592(%rsp),%xmm4 ++ vpmuludq 656(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm7,%xmm7 ++ vmovdqa 640(%rsp),%xmm4 ++ vpmuludq 688(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm10,%xmm10 ++ vpmuludq 512(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm0,%xmm0 ++ vmovdqa 560(%rsp),%xmm2 ++ vpmuludq 512(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm1,%xmm1 ++ vmovdqa 608(%rsp),%xmm2 ++ vpmuludq 592(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vmovdqa 656(%rsp),%xmm2 ++ vpmuludq 576(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vmovdqa 688(%rsp),%xmm2 ++ vpmuludq 624(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpsrlq $26,%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm3,%xmm3 ++ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 ++ vpsrlq $25,%xmm10,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 ++ vpsrlq $25,%xmm3,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m25(%rip),%xmm3,%xmm3 ++ vpsrlq $26,%xmm11,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 ++ vpsrlq $26,%xmm5,%xmm2 ++ vpaddq %xmm2,%xmm7,%xmm7 ++ vpand curve25519_sandy2x_m26(%rip),%xmm5,%xmm5 ++ vpsrlq $25,%xmm12,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpand curve25519_sandy2x_m25(%rip),%xmm12,%xmm12 ++ vpsrlq $25,%xmm7,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpand curve25519_sandy2x_m25(%rip),%xmm7,%xmm7 ++ vpsrlq $26,%xmm13,%xmm2 ++ vpaddq %xmm2,%xmm0,%xmm0 ++ vpand curve25519_sandy2x_m26(%rip),%xmm13,%xmm13 ++ vpsrlq $26,%xmm9,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpand curve25519_sandy2x_m26(%rip),%xmm9,%xmm9 ++ vpsrlq $25,%xmm0,%xmm2 ++ vpsllq $4,%xmm2,%xmm4 ++ vpaddq %xmm2,%xmm1,%xmm1 ++ vpsllq $1,%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vpand curve25519_sandy2x_m25(%rip),%xmm0,%xmm0 ++ vpsrlq $25,%xmm10,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 ++ vpsrlq $26,%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm3,%xmm3 ++ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 ++ vpunpckhqdq %xmm3,%xmm1,%xmm2 ++ vpunpcklqdq %xmm3,%xmm1,%xmm1 ++ vmovdqa %xmm1,464(%rsp) ++ vpaddq curve25519_sandy2x_subc0(%rip),%xmm2,%xmm3 ++ vpsubq %xmm1,%xmm3,%xmm3 ++ vpunpckhqdq %xmm3,%xmm2,%xmm1 ++ vpunpcklqdq %xmm3,%xmm2,%xmm2 ++ vmovdqa %xmm2,480(%rsp) ++ vmovdqa %xmm1,512(%rsp) ++ vpsllq $1,%xmm1,%xmm1 ++ vmovdqa %xmm1,528(%rsp) ++ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm3,%xmm3 ++ vmovdqa 80(%rsp),%xmm1 ++ vpunpcklqdq %xmm1,%xmm3,%xmm2 ++ vpunpckhqdq %xmm1,%xmm3,%xmm1 ++ vpunpckhqdq %xmm7,%xmm5,%xmm3 ++ vpunpcklqdq %xmm7,%xmm5,%xmm4 ++ vmovdqa %xmm4,544(%rsp) ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm5 ++ vpsubq %xmm4,%xmm5,%xmm5 ++ vpunpckhqdq %xmm5,%xmm3,%xmm4 ++ vpunpcklqdq %xmm5,%xmm3,%xmm3 ++ vmovdqa %xmm3,560(%rsp) ++ vmovdqa %xmm4,576(%rsp) ++ vpsllq $1,%xmm4,%xmm4 ++ vmovdqa %xmm4,592(%rsp) ++ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm5,%xmm5 ++ vmovdqa 96(%rsp),%xmm3 ++ vpunpcklqdq %xmm3,%xmm5,%xmm4 ++ vpunpckhqdq %xmm3,%xmm5,%xmm3 ++ vpunpckhqdq %xmm10,%xmm9,%xmm5 ++ vpunpcklqdq %xmm10,%xmm9,%xmm6 ++ vmovdqa %xmm6,608(%rsp) ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm5,%xmm7 ++ vpsubq %xmm6,%xmm7,%xmm7 ++ vpunpckhqdq %xmm7,%xmm5,%xmm6 ++ vpunpcklqdq %xmm7,%xmm5,%xmm5 ++ vmovdqa %xmm5,624(%rsp) ++ vmovdqa %xmm6,640(%rsp) ++ vpsllq $1,%xmm6,%xmm6 ++ vmovdqa %xmm6,656(%rsp) ++ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm7,%xmm7 ++ vmovdqa 112(%rsp),%xmm5 ++ vpunpcklqdq %xmm5,%xmm7,%xmm6 ++ vpunpckhqdq %xmm5,%xmm7,%xmm5 ++ vpunpckhqdq %xmm12,%xmm11,%xmm7 ++ vpunpcklqdq %xmm12,%xmm11,%xmm8 ++ vmovdqa %xmm8,672(%rsp) ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm7,%xmm9 ++ vpsubq %xmm8,%xmm9,%xmm9 ++ vpunpckhqdq %xmm9,%xmm7,%xmm8 ++ vpunpcklqdq %xmm9,%xmm7,%xmm7 ++ vmovdqa %xmm7,688(%rsp) ++ vmovdqa %xmm8,704(%rsp) ++ vpsllq $1,%xmm8,%xmm8 ++ vmovdqa %xmm8,720(%rsp) ++ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm9,%xmm9 ++ vmovdqa 448(%rsp),%xmm7 ++ vpunpcklqdq %xmm7,%xmm9,%xmm8 ++ vpunpckhqdq %xmm7,%xmm9,%xmm7 ++ vpunpckhqdq %xmm0,%xmm13,%xmm9 ++ vpunpcklqdq %xmm0,%xmm13,%xmm0 ++ vmovdqa %xmm0,448(%rsp) ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm9,%xmm10 ++ vpsubq %xmm0,%xmm10,%xmm10 ++ vpunpckhqdq %xmm10,%xmm9,%xmm0 ++ vpunpcklqdq %xmm10,%xmm9,%xmm9 ++ vmovdqa %xmm9,736(%rsp) ++ vmovdqa %xmm0,752(%rsp) ++ vpsllq $1,%xmm0,%xmm0 ++ vmovdqa %xmm0,768(%rsp) ++ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm10,%xmm10 ++ vmovdqa 496(%rsp),%xmm0 ++ vpunpcklqdq %xmm0,%xmm10,%xmm9 ++ vpunpckhqdq %xmm0,%xmm10,%xmm0 ++ vpsrlq $26,%xmm2,%xmm10 ++ vpaddq %xmm10,%xmm1,%xmm1 ++ vpand curve25519_sandy2x_m26(%rip),%xmm2,%xmm2 ++ vpsrlq $25,%xmm5,%xmm10 ++ vpaddq %xmm10,%xmm8,%xmm8 ++ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 ++ vpsrlq $25,%xmm1,%xmm10 ++ vpaddq %xmm10,%xmm4,%xmm4 ++ vpand curve25519_sandy2x_m25(%rip),%xmm1,%xmm1 ++ vpsrlq $26,%xmm8,%xmm10 ++ vpaddq %xmm10,%xmm7,%xmm7 ++ vpand curve25519_sandy2x_m26(%rip),%xmm8,%xmm8 ++ vpsrlq $26,%xmm4,%xmm10 ++ vpaddq %xmm10,%xmm3,%xmm3 ++ vpand curve25519_sandy2x_m26(%rip),%xmm4,%xmm4 ++ vpsrlq $25,%xmm7,%xmm10 ++ vpaddq %xmm10,%xmm9,%xmm9 ++ vpand curve25519_sandy2x_m25(%rip),%xmm7,%xmm7 ++ vpsrlq $25,%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm6,%xmm6 ++ vpand curve25519_sandy2x_m25(%rip),%xmm3,%xmm3 ++ vpsrlq $26,%xmm9,%xmm10 ++ vpaddq %xmm10,%xmm0,%xmm0 ++ vpand curve25519_sandy2x_m26(%rip),%xmm9,%xmm9 ++ vpsrlq $26,%xmm6,%xmm10 ++ vpaddq %xmm10,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 ++ vpsrlq $25,%xmm0,%xmm10 ++ vpsllq $4,%xmm10,%xmm11 ++ vpaddq %xmm10,%xmm2,%xmm2 ++ vpsllq $1,%xmm10,%xmm10 ++ vpaddq %xmm10,%xmm11,%xmm11 ++ vpaddq %xmm11,%xmm2,%xmm2 ++ vpand curve25519_sandy2x_m25(%rip),%xmm0,%xmm0 ++ vpsrlq $25,%xmm5,%xmm10 ++ vpaddq %xmm10,%xmm8,%xmm8 ++ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 ++ vpsrlq $26,%xmm2,%xmm10 ++ vpaddq %xmm10,%xmm1,%xmm1 ++ vpand curve25519_sandy2x_m26(%rip),%xmm2,%xmm2 ++ vpunpckhqdq %xmm1,%xmm2,%xmm10 ++ vmovdqa %xmm10,80(%rsp) ++ vpunpcklqdq %xmm1,%xmm2,%xmm1 ++ vpunpckhqdq %xmm3,%xmm4,%xmm2 ++ vmovdqa %xmm2,96(%rsp) ++ vpunpcklqdq %xmm3,%xmm4,%xmm2 ++ vpunpckhqdq %xmm5,%xmm6,%xmm3 ++ vmovdqa %xmm3,112(%rsp) ++ vpunpcklqdq %xmm5,%xmm6,%xmm3 ++ vpunpckhqdq %xmm7,%xmm8,%xmm4 ++ vmovdqa %xmm4,128(%rsp) ++ vpunpcklqdq %xmm7,%xmm8,%xmm4 ++ vpunpckhqdq %xmm0,%xmm9,%xmm5 ++ vmovdqa %xmm5,144(%rsp) ++ vpunpcklqdq %xmm0,%xmm9,%xmm0 ++ vmovdqa 464(%rsp),%xmm5 ++ vpaddq %xmm5,%xmm1,%xmm1 ++ vpunpcklqdq %xmm1,%xmm5,%xmm6 ++ vpunpckhqdq %xmm1,%xmm5,%xmm1 ++ vpmuludq 512(%rsp),%xmm6,%xmm5 ++ vpmuludq 480(%rsp),%xmm1,%xmm7 ++ vpaddq %xmm7,%xmm5,%xmm5 ++ vpmuludq 560(%rsp),%xmm6,%xmm7 ++ vpmuludq 528(%rsp),%xmm1,%xmm8 ++ vpaddq %xmm8,%xmm7,%xmm7 ++ vpmuludq 576(%rsp),%xmm6,%xmm8 ++ vpmuludq 560(%rsp),%xmm1,%xmm9 ++ vpaddq %xmm9,%xmm8,%xmm8 ++ vpmuludq 624(%rsp),%xmm6,%xmm9 ++ vpmuludq 592(%rsp),%xmm1,%xmm10 ++ vpaddq %xmm10,%xmm9,%xmm9 ++ vpmuludq 640(%rsp),%xmm6,%xmm10 ++ vpmuludq 624(%rsp),%xmm1,%xmm11 ++ vpaddq %xmm11,%xmm10,%xmm10 ++ vpmuludq 688(%rsp),%xmm6,%xmm11 ++ vpmuludq 656(%rsp),%xmm1,%xmm12 ++ vpaddq %xmm12,%xmm11,%xmm11 ++ vpmuludq 704(%rsp),%xmm6,%xmm12 ++ vpmuludq 688(%rsp),%xmm1,%xmm13 ++ vpaddq %xmm13,%xmm12,%xmm12 ++ vpmuludq 736(%rsp),%xmm6,%xmm13 ++ vpmuludq 720(%rsp),%xmm1,%xmm14 ++ vpaddq %xmm14,%xmm13,%xmm13 ++ vpmuludq 752(%rsp),%xmm6,%xmm14 ++ vpmuludq 736(%rsp),%xmm1,%xmm15 ++ vpaddq %xmm15,%xmm14,%xmm14 ++ vpmuludq 480(%rsp),%xmm6,%xmm6 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 ++ vpmuludq 768(%rsp),%xmm1,%xmm1 ++ vpaddq %xmm1,%xmm6,%xmm6 ++ vmovdqa 544(%rsp),%xmm1 ++ vpaddq %xmm1,%xmm2,%xmm2 ++ vpunpcklqdq %xmm2,%xmm1,%xmm15 ++ vpunpckhqdq %xmm2,%xmm1,%xmm1 ++ vpmuludq 480(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm7,%xmm7 ++ vpmuludq 512(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpmuludq 560(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpmuludq 576(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq 624(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpmuludq 640(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq 688(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpmuludq 704(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm15,%xmm15 ++ vpmuludq 736(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm6,%xmm6 ++ vpmuludq 752(%rsp),%xmm15,%xmm15 ++ vpaddq %xmm15,%xmm5,%xmm5 ++ vpmuludq 480(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpmuludq 528(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpmuludq 560(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq 592(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpmuludq 624(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq 656(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpmuludq 688(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 ++ vpmuludq 720(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm6,%xmm6 ++ vpmuludq 736(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpmuludq 768(%rsp),%xmm1,%xmm1 ++ vpaddq %xmm1,%xmm7,%xmm7 ++ vmovdqa 608(%rsp),%xmm1 ++ vpaddq %xmm1,%xmm3,%xmm3 ++ vpunpcklqdq %xmm3,%xmm1,%xmm2 ++ vpunpckhqdq %xmm3,%xmm1,%xmm1 ++ vpmuludq 480(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm9,%xmm9 ++ vpmuludq 512(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm10,%xmm10 ++ vpmuludq 560(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 576(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm12,%xmm12 ++ vpmuludq 624(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 640(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm2,%xmm2 ++ vpmuludq 688(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 704(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 736(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq 752(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpmuludq 480(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq 528(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpmuludq 560(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq 592(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpmuludq 624(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 ++ vpmuludq 656(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm6,%xmm6 ++ vpmuludq 688(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpmuludq 720(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm7,%xmm7 ++ vpmuludq 736(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpmuludq 768(%rsp),%xmm1,%xmm1 ++ vpaddq %xmm1,%xmm9,%xmm9 ++ vmovdqa 672(%rsp),%xmm1 ++ vpaddq %xmm1,%xmm4,%xmm4 ++ vpunpcklqdq %xmm4,%xmm1,%xmm2 ++ vpunpckhqdq %xmm4,%xmm1,%xmm1 ++ vpmuludq 480(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 512(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm12,%xmm12 ++ vpmuludq 560(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 576(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm2,%xmm2 ++ vpmuludq 624(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 640(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 688(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq 704(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm8,%xmm8 ++ vpmuludq 736(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm9,%xmm9 ++ vpmuludq 752(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq 480(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq 528(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpmuludq 560(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 ++ vpmuludq 592(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm6,%xmm6 ++ vpmuludq 624(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpmuludq 656(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm7,%xmm7 ++ vpmuludq 688(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpmuludq 720(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpmuludq 736(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq 768(%rsp),%xmm1,%xmm1 ++ vpaddq %xmm1,%xmm11,%xmm11 ++ vmovdqa 448(%rsp),%xmm1 ++ vpaddq %xmm1,%xmm0,%xmm0 ++ vpunpcklqdq %xmm0,%xmm1,%xmm2 ++ vpunpckhqdq %xmm0,%xmm1,%xmm0 ++ vpmuludq 480(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm13,%xmm13 ++ vpmuludq 512(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm2,%xmm2 ++ vpmuludq 560(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm6,%xmm6 ++ vpmuludq 576(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm5,%xmm5 ++ vpmuludq 624(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm7,%xmm7 ++ vpmuludq 640(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm8,%xmm8 ++ vpmuludq 688(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm9,%xmm9 ++ vpmuludq 704(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm10,%xmm10 ++ vpmuludq 736(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm11,%xmm11 ++ vpmuludq 752(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq 480(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm0,%xmm0 ++ vpmuludq 528(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm6,%xmm6 ++ vpmuludq 560(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm5,%xmm5 ++ vpmuludq 592(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm7,%xmm7 ++ vpmuludq 624(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm8,%xmm8 ++ vpmuludq 656(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm9,%xmm9 ++ vpmuludq 688(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm10,%xmm10 ++ vpmuludq 720(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm11,%xmm11 ++ vpmuludq 736(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm12,%xmm12 ++ vpmuludq 768(%rsp),%xmm0,%xmm0 ++ vpaddq %xmm0,%xmm13,%xmm13 ++ vpsrlq $26,%xmm6,%xmm0 ++ vpaddq %xmm0,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 ++ vpsrlq $25,%xmm10,%xmm0 ++ vpaddq %xmm0,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 ++ vpsrlq $25,%xmm5,%xmm0 ++ vpaddq %xmm0,%xmm7,%xmm7 ++ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 ++ vpsrlq $26,%xmm11,%xmm0 ++ vpaddq %xmm0,%xmm12,%xmm12 ++ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 ++ vpsrlq $26,%xmm7,%xmm0 ++ vpaddq %xmm0,%xmm8,%xmm8 ++ vpand curve25519_sandy2x_m26(%rip),%xmm7,%xmm7 ++ vpsrlq $25,%xmm12,%xmm0 ++ vpaddq %xmm0,%xmm13,%xmm13 ++ vpand curve25519_sandy2x_m25(%rip),%xmm12,%xmm12 ++ vpsrlq $25,%xmm8,%xmm0 ++ vpaddq %xmm0,%xmm9,%xmm9 ++ vpand curve25519_sandy2x_m25(%rip),%xmm8,%xmm8 ++ vpsrlq $26,%xmm13,%xmm0 ++ vpaddq %xmm0,%xmm14,%xmm14 ++ vpand curve25519_sandy2x_m26(%rip),%xmm13,%xmm13 ++ vpsrlq $26,%xmm9,%xmm0 ++ vpaddq %xmm0,%xmm10,%xmm10 ++ vpand curve25519_sandy2x_m26(%rip),%xmm9,%xmm9 ++ vpsrlq $25,%xmm14,%xmm0 ++ vpsllq $4,%xmm0,%xmm1 ++ vpaddq %xmm0,%xmm6,%xmm6 ++ vpsllq $1,%xmm0,%xmm0 ++ vpaddq %xmm0,%xmm1,%xmm1 ++ vpaddq %xmm1,%xmm6,%xmm6 ++ vpand curve25519_sandy2x_m25(%rip),%xmm14,%xmm14 ++ vpsrlq $25,%xmm10,%xmm0 ++ vpaddq %xmm0,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 ++ vpsrlq $26,%xmm6,%xmm0 ++ vpaddq %xmm0,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 ++ vpunpckhqdq %xmm5,%xmm6,%xmm1 ++ vpunpcklqdq %xmm5,%xmm6,%xmm0 ++ vpunpckhqdq %xmm8,%xmm7,%xmm3 ++ vpunpcklqdq %xmm8,%xmm7,%xmm2 ++ vpunpckhqdq %xmm10,%xmm9,%xmm5 ++ vpunpcklqdq %xmm10,%xmm9,%xmm4 ++ vpunpckhqdq %xmm12,%xmm11,%xmm7 ++ vpunpcklqdq %xmm12,%xmm11,%xmm6 ++ vpunpckhqdq %xmm14,%xmm13,%xmm9 ++ vpunpcklqdq %xmm14,%xmm13,%xmm8 ++ cmp $0,%rdx ++ jne .Lladder_loop ++ vmovdqu %xmm1,160(%rdi) ++ vmovdqu %xmm0,80(%rdi) ++ vmovdqu %xmm3,176(%rdi) ++ vmovdqu %xmm2,96(%rdi) ++ vmovdqu %xmm5,192(%rdi) ++ vmovdqu %xmm4,112(%rdi) ++ vmovdqu %xmm7,208(%rdi) ++ vmovdqu %xmm6,128(%rdi) ++ vmovdqu %xmm9,224(%rdi) ++ vmovdqu %xmm8,144(%rdi) ++ movq 1824(%rsp),%r11 ++ movq 1832(%rsp),%r12 ++ movq 1840(%rsp),%r13 ++ movq 1848(%rsp),%r14 ++ leave ++ ret ++ENDPROC(curve25519_sandy2x_ladder) ++ ++.align 32 ++ENTRY(curve25519_sandy2x_ladder_base) ++ push %rbp ++ mov %rsp,%rbp ++ sub $1568,%rsp ++ and $-32,%rsp ++ movq %r11,1536(%rsp) ++ movq %r12,1544(%rsp) ++ movq %r13,1552(%rsp) ++ vmovdqa curve25519_sandy2x_v0_0(%rip),%xmm0 ++ vmovdqa curve25519_sandy2x_v1_0(%rip),%xmm1 ++ vmovdqa curve25519_sandy2x_v9_0(%rip),%xmm2 ++ vmovdqa %xmm2,0(%rsp) ++ vmovdqa %xmm0,16(%rsp) ++ vmovdqa %xmm0,32(%rsp) ++ vmovdqa %xmm0,48(%rsp) ++ vmovdqa %xmm0,64(%rsp) ++ vmovdqa %xmm1,80(%rsp) ++ vmovdqa %xmm0,96(%rsp) ++ vmovdqa %xmm0,112(%rsp) ++ vmovdqa %xmm0,128(%rsp) ++ vmovdqa %xmm0,144(%rsp) ++ vmovdqa %xmm1,%xmm0 ++ vpxor %xmm1,%xmm1,%xmm1 ++ vpxor %xmm2,%xmm2,%xmm2 ++ vpxor %xmm3,%xmm3,%xmm3 ++ vpxor %xmm4,%xmm4,%xmm4 ++ vpxor %xmm5,%xmm5,%xmm5 ++ vpxor %xmm6,%xmm6,%xmm6 ++ vpxor %xmm7,%xmm7,%xmm7 ++ vpxor %xmm8,%xmm8,%xmm8 ++ vpxor %xmm9,%xmm9,%xmm9 ++ movq 0(%rsi),%rdx ++ movq 8(%rsi),%rcx ++ movq 16(%rsi),%r8 ++ movq 24(%rsi),%r9 ++ shrd $1,%rcx,%rdx ++ shrd $1,%r8,%rcx ++ shrd $1,%r9,%r8 ++ shr $1,%r9 ++ xorq 0(%rsi),%rdx ++ xorq 8(%rsi),%rcx ++ xorq 16(%rsi),%r8 ++ xorq 24(%rsi),%r9 ++ leaq 512(%rsp),%rsi ++ mov $64,%rax ++ ++ .align 16 ++ .Lladder_base_small_loop: ++ mov %rdx,%r10 ++ mov %rcx,%r11 ++ mov %r8,%r12 ++ mov %r9,%r13 ++ shr $1,%rdx ++ shr $1,%rcx ++ shr $1,%r8 ++ shr $1,%r9 ++ and $1,%r10d ++ and $1,%r11d ++ and $1,%r12d ++ and $1,%r13d ++ neg %r10 ++ neg %r11 ++ neg %r12 ++ neg %r13 ++ movl %r10d,0(%rsi) ++ movl %r11d,256(%rsi) ++ movl %r12d,512(%rsi) ++ movl %r13d,768(%rsi) ++ add $4,%rsi ++ sub $1,%rax ++ jne .Lladder_base_small_loop ++ mov $255,%rdx ++ add $760,%rsi ++ ++ .align 16 ++ .Lladder_base_loop: ++ sub $1,%rdx ++ vbroadcastss 0(%rsi),%xmm10 ++ sub $4,%rsi ++ vmovdqa 0(%rsp),%xmm11 ++ vmovdqa 80(%rsp),%xmm12 ++ vpxor %xmm11,%xmm0,%xmm13 ++ vpand %xmm10,%xmm13,%xmm13 ++ vpxor %xmm13,%xmm0,%xmm0 ++ vpxor %xmm13,%xmm11,%xmm11 ++ vpxor %xmm12,%xmm1,%xmm13 ++ vpand %xmm10,%xmm13,%xmm13 ++ vpxor %xmm13,%xmm1,%xmm1 ++ vpxor %xmm13,%xmm12,%xmm12 ++ vmovdqa 16(%rsp),%xmm13 ++ vmovdqa 96(%rsp),%xmm14 ++ vpxor %xmm13,%xmm2,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm2,%xmm2 ++ vpxor %xmm15,%xmm13,%xmm13 ++ vpxor %xmm14,%xmm3,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm3,%xmm3 ++ vpxor %xmm15,%xmm14,%xmm14 ++ vmovdqa %xmm13,0(%rsp) ++ vmovdqa %xmm14,16(%rsp) ++ vmovdqa 32(%rsp),%xmm13 ++ vmovdqa 112(%rsp),%xmm14 ++ vpxor %xmm13,%xmm4,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm4,%xmm4 ++ vpxor %xmm15,%xmm13,%xmm13 ++ vpxor %xmm14,%xmm5,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm5,%xmm5 ++ vpxor %xmm15,%xmm14,%xmm14 ++ vmovdqa %xmm13,32(%rsp) ++ vmovdqa %xmm14,80(%rsp) ++ vmovdqa 48(%rsp),%xmm13 ++ vmovdqa 128(%rsp),%xmm14 ++ vpxor %xmm13,%xmm6,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm6,%xmm6 ++ vpxor %xmm15,%xmm13,%xmm13 ++ vpxor %xmm14,%xmm7,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm7,%xmm7 ++ vpxor %xmm15,%xmm14,%xmm14 ++ vmovdqa %xmm13,48(%rsp) ++ vmovdqa %xmm14,96(%rsp) ++ vmovdqa 64(%rsp),%xmm13 ++ vmovdqa 144(%rsp),%xmm14 ++ vpxor %xmm13,%xmm8,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm8,%xmm8 ++ vpxor %xmm15,%xmm13,%xmm13 ++ vpxor %xmm14,%xmm9,%xmm15 ++ vpand %xmm10,%xmm15,%xmm15 ++ vpxor %xmm15,%xmm9,%xmm9 ++ vpxor %xmm15,%xmm14,%xmm14 ++ vmovdqa %xmm13,64(%rsp) ++ vmovdqa %xmm14,112(%rsp) ++ vpaddq curve25519_sandy2x_subc0(%rip),%xmm11,%xmm10 ++ vpsubq %xmm12,%xmm10,%xmm10 ++ vpaddq %xmm12,%xmm11,%xmm11 ++ vpunpckhqdq %xmm10,%xmm11,%xmm12 ++ vpunpcklqdq %xmm10,%xmm11,%xmm10 ++ vpaddq %xmm1,%xmm0,%xmm11 ++ vpaddq curve25519_sandy2x_subc0(%rip),%xmm0,%xmm0 ++ vpsubq %xmm1,%xmm0,%xmm0 ++ vpunpckhqdq %xmm11,%xmm0,%xmm1 ++ vpunpcklqdq %xmm11,%xmm0,%xmm0 ++ vpmuludq %xmm0,%xmm10,%xmm11 ++ vpmuludq %xmm1,%xmm10,%xmm13 ++ vmovdqa %xmm1,128(%rsp) ++ vpaddq %xmm1,%xmm1,%xmm1 ++ vpmuludq %xmm0,%xmm12,%xmm14 ++ vmovdqa %xmm0,144(%rsp) ++ vpaddq %xmm14,%xmm13,%xmm13 ++ vpmuludq %xmm1,%xmm12,%xmm0 ++ vmovdqa %xmm1,160(%rsp) ++ vpaddq %xmm3,%xmm2,%xmm1 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm2,%xmm2 ++ vpsubq %xmm3,%xmm2,%xmm2 ++ vpunpckhqdq %xmm1,%xmm2,%xmm3 ++ vpunpcklqdq %xmm1,%xmm2,%xmm1 ++ vpmuludq %xmm1,%xmm10,%xmm2 ++ vpaddq %xmm2,%xmm0,%xmm0 ++ vpmuludq %xmm3,%xmm10,%xmm2 ++ vmovdqa %xmm3,176(%rsp) ++ vpaddq %xmm3,%xmm3,%xmm3 ++ vpmuludq %xmm1,%xmm12,%xmm14 ++ vmovdqa %xmm1,192(%rsp) ++ vpaddq %xmm14,%xmm2,%xmm2 ++ vpmuludq %xmm3,%xmm12,%xmm1 ++ vmovdqa %xmm3,208(%rsp) ++ vpaddq %xmm5,%xmm4,%xmm3 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm4,%xmm4 ++ vpsubq %xmm5,%xmm4,%xmm4 ++ vpunpckhqdq %xmm3,%xmm4,%xmm5 ++ vpunpcklqdq %xmm3,%xmm4,%xmm3 ++ vpmuludq %xmm3,%xmm10,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vpmuludq %xmm5,%xmm10,%xmm4 ++ vmovdqa %xmm5,224(%rsp) ++ vpaddq %xmm5,%xmm5,%xmm5 ++ vpmuludq %xmm3,%xmm12,%xmm14 ++ vmovdqa %xmm3,240(%rsp) ++ vpaddq %xmm14,%xmm4,%xmm4 ++ vpaddq %xmm7,%xmm6,%xmm3 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm6,%xmm6 ++ vpsubq %xmm7,%xmm6,%xmm6 ++ vpunpckhqdq %xmm3,%xmm6,%xmm7 ++ vpunpcklqdq %xmm3,%xmm6,%xmm3 ++ vpmuludq %xmm3,%xmm10,%xmm6 ++ vpmuludq %xmm5,%xmm12,%xmm14 ++ vmovdqa %xmm5,256(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm5,%xmm5 ++ vmovdqa %xmm5,272(%rsp) ++ vpaddq %xmm14,%xmm6,%xmm6 ++ vpmuludq %xmm7,%xmm10,%xmm5 ++ vmovdqa %xmm7,288(%rsp) ++ vpaddq %xmm7,%xmm7,%xmm7 ++ vpmuludq %xmm3,%xmm12,%xmm14 ++ vmovdqa %xmm3,304(%rsp) ++ vpaddq %xmm14,%xmm5,%xmm5 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 ++ vmovdqa %xmm3,320(%rsp) ++ vpaddq %xmm9,%xmm8,%xmm3 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm8,%xmm8 ++ vpsubq %xmm9,%xmm8,%xmm8 ++ vpunpckhqdq %xmm3,%xmm8,%xmm9 ++ vpunpcklqdq %xmm3,%xmm8,%xmm3 ++ vmovdqa %xmm3,336(%rsp) ++ vpmuludq %xmm7,%xmm12,%xmm8 ++ vmovdqa %xmm7,352(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm7,%xmm7 ++ vmovdqa %xmm7,368(%rsp) ++ vpmuludq %xmm3,%xmm10,%xmm7 ++ vpaddq %xmm7,%xmm8,%xmm8 ++ vpmuludq %xmm9,%xmm10,%xmm7 ++ vmovdqa %xmm9,384(%rsp) ++ vpaddq %xmm9,%xmm9,%xmm9 ++ vpmuludq %xmm3,%xmm12,%xmm10 ++ vpaddq %xmm10,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 ++ vmovdqa %xmm3,400(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm12,%xmm12 ++ vpmuludq %xmm9,%xmm12,%xmm3 ++ vmovdqa %xmm9,416(%rsp) ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vmovdqa 0(%rsp),%xmm3 ++ vmovdqa 16(%rsp),%xmm9 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 ++ vpsubq %xmm9,%xmm10,%xmm10 ++ vpaddq %xmm9,%xmm3,%xmm3 ++ vpunpckhqdq %xmm10,%xmm3,%xmm9 ++ vpunpcklqdq %xmm10,%xmm3,%xmm3 ++ vpmuludq 144(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm0,%xmm0 ++ vpmuludq 128(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm2,%xmm2 ++ vpmuludq 192(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm1,%xmm1 ++ vpmuludq 176(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm4,%xmm4 ++ vpmuludq 240(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm6,%xmm6 ++ vpmuludq 224(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm5,%xmm5 ++ vpmuludq 304(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm8,%xmm8 ++ vpmuludq 288(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 ++ vpmuludq 336(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm11,%xmm11 ++ vpmuludq 384(%rsp),%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 144(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpmuludq 160(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm1,%xmm1 ++ vpmuludq 192(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 208(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 240(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 256(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm8,%xmm8 ++ vpmuludq 304(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 ++ vpmuludq 352(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 336(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 416(%rsp),%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm0,%xmm0 ++ vmovdqa 32(%rsp),%xmm3 ++ vmovdqa 80(%rsp),%xmm9 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 ++ vpsubq %xmm9,%xmm10,%xmm10 ++ vpaddq %xmm9,%xmm3,%xmm3 ++ vpunpckhqdq %xmm10,%xmm3,%xmm9 ++ vpunpcklqdq %xmm10,%xmm3,%xmm3 ++ vpmuludq 144(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm1,%xmm1 ++ vpmuludq 128(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm4,%xmm4 ++ vpmuludq 192(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm6,%xmm6 ++ vpmuludq 176(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm5,%xmm5 ++ vpmuludq 240(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm8,%xmm8 ++ vpmuludq 224(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 ++ vpmuludq 304(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm11,%xmm11 ++ vpmuludq 288(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm13,%xmm13 ++ vpmuludq 336(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm0,%xmm0 ++ vpmuludq 384(%rsp),%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpmuludq 144(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 160(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 192(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 208(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm8,%xmm8 ++ vpmuludq 240(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 ++ vpmuludq 256(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 304(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 352(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm0,%xmm0 ++ vpmuludq 336(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpmuludq 416(%rsp),%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm1,%xmm1 ++ vmovdqa 48(%rsp),%xmm3 ++ vmovdqa 96(%rsp),%xmm9 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 ++ vpsubq %xmm9,%xmm10,%xmm10 ++ vpaddq %xmm9,%xmm3,%xmm3 ++ vpunpckhqdq %xmm10,%xmm3,%xmm9 ++ vpunpcklqdq %xmm10,%xmm3,%xmm3 ++ vpmuludq 144(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm6,%xmm6 ++ vpmuludq 128(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm5,%xmm5 ++ vpmuludq 192(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm8,%xmm8 ++ vpmuludq 176(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 ++ vpmuludq 240(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm11,%xmm11 ++ vpmuludq 224(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm13,%xmm13 ++ vpmuludq 304(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm0,%xmm0 ++ vpmuludq 288(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm2,%xmm2 ++ vpmuludq 336(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm1,%xmm1 ++ vpmuludq 384(%rsp),%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 144(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 160(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm8,%xmm8 ++ vpmuludq 192(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 ++ vpmuludq 208(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 240(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 256(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm0,%xmm0 ++ vpmuludq 304(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpmuludq 352(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm1,%xmm1 ++ vpmuludq 336(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 416(%rsp),%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm6,%xmm6 ++ vmovdqa 64(%rsp),%xmm3 ++ vmovdqa 112(%rsp),%xmm9 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 ++ vpsubq %xmm9,%xmm10,%xmm10 ++ vpaddq %xmm9,%xmm3,%xmm3 ++ vpunpckhqdq %xmm10,%xmm3,%xmm9 ++ vpunpcklqdq %xmm10,%xmm3,%xmm3 ++ vpmuludq 144(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm8,%xmm8 ++ vpmuludq 128(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 ++ vpmuludq 192(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm11,%xmm11 ++ vpmuludq 176(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm13,%xmm13 ++ vpmuludq 240(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm0,%xmm0 ++ vpmuludq 224(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm2,%xmm2 ++ vpmuludq 304(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm1,%xmm1 ++ vpmuludq 288(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm4,%xmm4 ++ vpmuludq 336(%rsp),%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm6,%xmm6 ++ vpmuludq 384(%rsp),%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 144(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 ++ vpmuludq 160(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 192(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 208(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm0,%xmm0 ++ vpmuludq 240(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpmuludq 256(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm1,%xmm1 ++ vpmuludq 304(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpmuludq 352(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 336(%rsp),%xmm9,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 416(%rsp),%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm8,%xmm8 ++ vpsrlq $25,%xmm4,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpand curve25519_sandy2x_m25(%rip),%xmm4,%xmm4 ++ vpsrlq $26,%xmm11,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 ++ vpsrlq $26,%xmm6,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 ++ vpsrlq $25,%xmm13,%xmm3 ++ vpaddq %xmm3,%xmm0,%xmm0 ++ vpand curve25519_sandy2x_m25(%rip),%xmm13,%xmm13 ++ vpsrlq $25,%xmm5,%xmm3 ++ vpaddq %xmm3,%xmm8,%xmm8 ++ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 ++ vpsrlq $26,%xmm0,%xmm3 ++ vpaddq %xmm3,%xmm2,%xmm2 ++ vpand curve25519_sandy2x_m26(%rip),%xmm0,%xmm0 ++ vpsrlq $26,%xmm8,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpand curve25519_sandy2x_m26(%rip),%xmm8,%xmm8 ++ vpsrlq $25,%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm1,%xmm1 ++ vpand curve25519_sandy2x_m25(%rip),%xmm2,%xmm2 ++ vpsrlq $25,%xmm7,%xmm3 ++ vpsllq $4,%xmm3,%xmm9 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpsllq $1,%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m25(%rip),%xmm7,%xmm7 ++ vpsrlq $26,%xmm1,%xmm3 ++ vpaddq %xmm3,%xmm4,%xmm4 ++ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 ++ vpsrlq $26,%xmm11,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 ++ vpsrlq $25,%xmm4,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpand curve25519_sandy2x_m25(%rip),%xmm4,%xmm4 ++ vpunpcklqdq %xmm13,%xmm11,%xmm3 ++ vpunpckhqdq %xmm13,%xmm11,%xmm9 ++ vpaddq curve25519_sandy2x_subc0(%rip),%xmm9,%xmm10 ++ vpsubq %xmm3,%xmm10,%xmm10 ++ vpaddq %xmm9,%xmm3,%xmm3 ++ vpunpckhqdq %xmm3,%xmm10,%xmm9 ++ vpunpcklqdq %xmm3,%xmm10,%xmm10 ++ vpmuludq %xmm10,%xmm10,%xmm3 ++ vpaddq %xmm10,%xmm10,%xmm10 ++ vpmuludq %xmm9,%xmm10,%xmm11 ++ vpunpcklqdq %xmm2,%xmm0,%xmm12 ++ vpunpckhqdq %xmm2,%xmm0,%xmm0 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm0,%xmm2 ++ vpsubq %xmm12,%xmm2,%xmm2 ++ vpaddq %xmm0,%xmm12,%xmm12 ++ vpunpckhqdq %xmm12,%xmm2,%xmm0 ++ vpunpcklqdq %xmm12,%xmm2,%xmm2 ++ vpmuludq %xmm2,%xmm10,%xmm12 ++ vpaddq %xmm9,%xmm9,%xmm13 ++ vpmuludq %xmm13,%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm12,%xmm12 ++ vpmuludq %xmm0,%xmm10,%xmm9 ++ vpmuludq %xmm2,%xmm13,%xmm14 ++ vpaddq %xmm14,%xmm9,%xmm9 ++ vpunpcklqdq %xmm4,%xmm1,%xmm14 ++ vpunpckhqdq %xmm4,%xmm1,%xmm1 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm1,%xmm4 ++ vpsubq %xmm14,%xmm4,%xmm4 ++ vpaddq %xmm1,%xmm14,%xmm14 ++ vpunpckhqdq %xmm14,%xmm4,%xmm1 ++ vpunpcklqdq %xmm14,%xmm4,%xmm4 ++ vmovdqa %xmm1,0(%rsp) ++ vpaddq %xmm1,%xmm1,%xmm1 ++ vmovdqa %xmm1,16(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 ++ vmovdqa %xmm1,32(%rsp) ++ vpmuludq %xmm4,%xmm10,%xmm1 ++ vpmuludq %xmm2,%xmm2,%xmm14 ++ vpaddq %xmm14,%xmm1,%xmm1 ++ vpmuludq 0(%rsp),%xmm10,%xmm14 ++ vpmuludq %xmm4,%xmm13,%xmm15 ++ vpaddq %xmm15,%xmm14,%xmm14 ++ vpunpcklqdq %xmm5,%xmm6,%xmm15 ++ vpunpckhqdq %xmm5,%xmm6,%xmm5 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm5,%xmm6 ++ vpsubq %xmm15,%xmm6,%xmm6 ++ vpaddq %xmm5,%xmm15,%xmm15 ++ vpunpckhqdq %xmm15,%xmm6,%xmm5 ++ vpunpcklqdq %xmm15,%xmm6,%xmm6 ++ vmovdqa %xmm6,48(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm6,%xmm6 ++ vmovdqa %xmm6,64(%rsp) ++ vmovdqa %xmm5,80(%rsp) ++ vpmuludq curve25519_sandy2x_v38_38(%rip),%xmm5,%xmm5 ++ vmovdqa %xmm5,96(%rsp) ++ vpmuludq 48(%rsp),%xmm10,%xmm5 ++ vpaddq %xmm0,%xmm0,%xmm6 ++ vpmuludq %xmm6,%xmm0,%xmm0 ++ vpaddq %xmm0,%xmm5,%xmm5 ++ vpmuludq 80(%rsp),%xmm10,%xmm0 ++ vpmuludq %xmm4,%xmm6,%xmm15 ++ vpaddq %xmm15,%xmm0,%xmm0 ++ vpmuludq %xmm6,%xmm13,%xmm15 ++ vpaddq %xmm15,%xmm1,%xmm1 ++ vpmuludq %xmm6,%xmm2,%xmm15 ++ vpaddq %xmm15,%xmm14,%xmm14 ++ vpunpcklqdq %xmm7,%xmm8,%xmm15 ++ vpunpckhqdq %xmm7,%xmm8,%xmm7 ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm7,%xmm8 ++ vpsubq %xmm15,%xmm8,%xmm8 ++ vpaddq %xmm7,%xmm15,%xmm15 ++ vpunpckhqdq %xmm15,%xmm8,%xmm7 ++ vpunpcklqdq %xmm15,%xmm8,%xmm8 ++ vmovdqa %xmm8,112(%rsp) ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm8,%xmm8 ++ vmovdqa %xmm8,160(%rsp) ++ vpmuludq 112(%rsp),%xmm10,%xmm8 ++ vpmuludq %xmm7,%xmm10,%xmm10 ++ vpmuludq curve25519_sandy2x_v38_38(%rip),%xmm7,%xmm15 ++ vpmuludq %xmm15,%xmm7,%xmm7 ++ vpaddq %xmm7,%xmm8,%xmm8 ++ vpmuludq %xmm15,%xmm13,%xmm7 ++ vpaddq %xmm7,%xmm3,%xmm3 ++ vpmuludq %xmm15,%xmm2,%xmm7 ++ vpaddq %xmm7,%xmm11,%xmm11 ++ vpmuludq 80(%rsp),%xmm13,%xmm7 ++ vpaddq %xmm7,%xmm7,%xmm7 ++ vpaddq %xmm7,%xmm8,%xmm8 ++ vpmuludq 16(%rsp),%xmm13,%xmm7 ++ vpaddq %xmm7,%xmm5,%xmm5 ++ vpmuludq 48(%rsp),%xmm13,%xmm7 ++ vpaddq %xmm7,%xmm0,%xmm0 ++ vpmuludq 112(%rsp),%xmm13,%xmm7 ++ vpaddq %xmm7,%xmm10,%xmm10 ++ vpmuludq %xmm15,%xmm6,%xmm7 ++ vpaddq %xmm7,%xmm12,%xmm12 ++ vpmuludq %xmm15,%xmm4,%xmm7 ++ vpaddq %xmm7,%xmm9,%xmm9 ++ vpaddq %xmm2,%xmm2,%xmm2 ++ vpmuludq %xmm4,%xmm2,%xmm7 ++ vpaddq %xmm7,%xmm5,%xmm5 ++ vpmuludq 160(%rsp),%xmm2,%xmm7 ++ vpaddq %xmm7,%xmm3,%xmm3 ++ vpmuludq 160(%rsp),%xmm6,%xmm7 ++ vpaddq %xmm7,%xmm11,%xmm11 ++ vpmuludq 0(%rsp),%xmm2,%xmm7 ++ vpaddq %xmm7,%xmm0,%xmm0 ++ vpmuludq 48(%rsp),%xmm2,%xmm7 ++ vpaddq %xmm7,%xmm8,%xmm8 ++ vpmuludq 80(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq 96(%rsp),%xmm4,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpmuludq %xmm4,%xmm4,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpaddq %xmm4,%xmm4,%xmm2 ++ vpmuludq 160(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm12,%xmm12 ++ vpmuludq 16(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vpmuludq 48(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm14,%xmm14 ++ vpmuludq 96(%rsp),%xmm6,%xmm4 ++ vpaddq %xmm4,%xmm3,%xmm3 ++ vmovdqa 16(%rsp),%xmm4 ++ vpmuludq 160(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm9,%xmm9 ++ vpmuludq 16(%rsp),%xmm6,%xmm4 ++ vpaddq %xmm4,%xmm8,%xmm8 ++ vpmuludq 48(%rsp),%xmm6,%xmm4 ++ vpaddq %xmm4,%xmm10,%xmm10 ++ vpmuludq 80(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm5,%xmm5 ++ vpmuludq 112(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm0,%xmm0 ++ vmovdqa 48(%rsp),%xmm4 ++ vpaddq %xmm4,%xmm4,%xmm4 ++ vpmuludq 160(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vmovdqa 80(%rsp),%xmm4 ++ vpaddq %xmm4,%xmm4,%xmm4 ++ vpmuludq 160(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm14,%xmm14 ++ vpmuludq 64(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm3,%xmm3 ++ vmovdqa 16(%rsp),%xmm4 ++ vpmuludq 64(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm11,%xmm11 ++ vmovdqa 16(%rsp),%xmm4 ++ vpmuludq 96(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm12,%xmm12 ++ vmovdqa 48(%rsp),%xmm4 ++ vpmuludq 96(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm9,%xmm9 ++ vpmuludq 0(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vmovdqa 32(%rsp),%xmm2 ++ vpmuludq 0(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm3,%xmm3 ++ vmovdqa 64(%rsp),%xmm2 ++ vpmuludq 48(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vmovdqa 96(%rsp),%xmm2 ++ vpmuludq 80(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm1,%xmm1 ++ vmovdqa 160(%rsp),%xmm2 ++ vpmuludq 112(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpsrlq $26,%xmm3,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m26(%rip),%xmm3,%xmm3 ++ vpsrlq $25,%xmm14,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m25(%rip),%xmm14,%xmm14 ++ vpsrlq $25,%xmm11,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpand curve25519_sandy2x_m25(%rip),%xmm11,%xmm11 ++ vpsrlq $26,%xmm5,%xmm2 ++ vpaddq %xmm2,%xmm0,%xmm0 ++ vpand curve25519_sandy2x_m26(%rip),%xmm5,%xmm5 ++ vpsrlq $26,%xmm12,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpand curve25519_sandy2x_m26(%rip),%xmm12,%xmm12 ++ vpsrlq $25,%xmm0,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpand curve25519_sandy2x_m25(%rip),%xmm0,%xmm0 ++ vpsrlq $25,%xmm9,%xmm2 ++ vpaddq %xmm2,%xmm1,%xmm1 ++ vpand curve25519_sandy2x_m25(%rip),%xmm9,%xmm9 ++ vpsrlq $26,%xmm8,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpand curve25519_sandy2x_m26(%rip),%xmm8,%xmm8 ++ vpsrlq $26,%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm14,%xmm14 ++ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 ++ vpsrlq $25,%xmm10,%xmm2 ++ vpsllq $4,%xmm2,%xmm4 ++ vpaddq %xmm2,%xmm3,%xmm3 ++ vpsllq $1,%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm3,%xmm3 ++ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 ++ vpsrlq $25,%xmm14,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m25(%rip),%xmm14,%xmm14 ++ vpsrlq $26,%xmm3,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m26(%rip),%xmm3,%xmm3 ++ vpunpckhqdq %xmm11,%xmm3,%xmm2 ++ vmovdqa %xmm2,0(%rsp) ++ vpunpcklqdq %xmm11,%xmm3,%xmm2 ++ vpmuludq curve25519_sandy2x_v9_9(%rip),%xmm2,%xmm2 ++ vmovdqa %xmm2,80(%rsp) ++ vpunpckhqdq %xmm9,%xmm12,%xmm2 ++ vmovdqa %xmm2,16(%rsp) ++ vpunpcklqdq %xmm9,%xmm12,%xmm2 ++ vpmuludq curve25519_sandy2x_v9_9(%rip),%xmm2,%xmm2 ++ vmovdqa %xmm2,96(%rsp) ++ vpunpckhqdq %xmm14,%xmm1,%xmm2 ++ vmovdqa %xmm2,32(%rsp) ++ vpunpcklqdq %xmm14,%xmm1,%xmm1 ++ vpmuludq curve25519_sandy2x_v9_9(%rip),%xmm1,%xmm1 ++ vmovdqa %xmm1,112(%rsp) ++ vpunpckhqdq %xmm0,%xmm5,%xmm1 ++ vmovdqa %xmm1,48(%rsp) ++ vpunpcklqdq %xmm0,%xmm5,%xmm0 ++ vpmuludq curve25519_sandy2x_v9_9(%rip),%xmm0,%xmm0 ++ vmovdqa %xmm0,160(%rsp) ++ vpunpckhqdq %xmm10,%xmm8,%xmm0 ++ vmovdqa %xmm0,64(%rsp) ++ vpunpcklqdq %xmm10,%xmm8,%xmm0 ++ vpmuludq curve25519_sandy2x_v9_9(%rip),%xmm0,%xmm0 ++ vmovdqa %xmm0,208(%rsp) ++ vmovdqa 144(%rsp),%xmm0 ++ vpmuludq %xmm0,%xmm0,%xmm1 ++ vpaddq %xmm0,%xmm0,%xmm0 ++ vmovdqa 128(%rsp),%xmm2 ++ vpmuludq %xmm2,%xmm0,%xmm3 ++ vmovdqa 192(%rsp),%xmm4 ++ vpmuludq %xmm4,%xmm0,%xmm5 ++ vmovdqa 176(%rsp),%xmm6 ++ vpmuludq %xmm6,%xmm0,%xmm7 ++ vmovdqa 240(%rsp),%xmm8 ++ vpmuludq %xmm8,%xmm0,%xmm9 ++ vpmuludq 224(%rsp),%xmm0,%xmm10 ++ vpmuludq 304(%rsp),%xmm0,%xmm11 ++ vpmuludq 288(%rsp),%xmm0,%xmm12 ++ vpmuludq 336(%rsp),%xmm0,%xmm13 ++ vmovdqa 384(%rsp),%xmm14 ++ vpmuludq %xmm14,%xmm0,%xmm0 ++ vpmuludq curve25519_sandy2x_v38_38(%rip),%xmm14,%xmm15 ++ vpmuludq %xmm15,%xmm14,%xmm14 ++ vpaddq %xmm14,%xmm13,%xmm13 ++ vpaddq %xmm6,%xmm6,%xmm14 ++ vpmuludq %xmm14,%xmm6,%xmm6 ++ vpaddq %xmm6,%xmm11,%xmm11 ++ vpaddq %xmm2,%xmm2,%xmm6 ++ vpmuludq %xmm6,%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpmuludq %xmm15,%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm1,%xmm1 ++ vpmuludq %xmm15,%xmm4,%xmm2 ++ vpaddq %xmm2,%xmm3,%xmm3 ++ vpmuludq 256(%rsp),%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpmuludq 304(%rsp),%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq 352(%rsp),%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpmuludq 336(%rsp),%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm0,%xmm0 ++ vpmuludq %xmm4,%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm7,%xmm7 ++ vpmuludq %xmm14,%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpmuludq %xmm8,%xmm6,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq %xmm15,%xmm14,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpmuludq %xmm15,%xmm8,%xmm2 ++ vpaddq %xmm2,%xmm7,%xmm7 ++ vpmuludq %xmm4,%xmm4,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpmuludq %xmm14,%xmm4,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpaddq %xmm4,%xmm4,%xmm2 ++ vpmuludq %xmm8,%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm11,%xmm11 ++ vpmuludq 400(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vpmuludq 400(%rsp),%xmm14,%xmm4 ++ vpaddq %xmm4,%xmm3,%xmm3 ++ vpmuludq 224(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm12,%xmm12 ++ vpmuludq 304(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm13,%xmm13 ++ vpmuludq 288(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm0,%xmm0 ++ vpmuludq 368(%rsp),%xmm8,%xmm2 ++ vpaddq %xmm2,%xmm3,%xmm3 ++ vpmuludq %xmm8,%xmm14,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq %xmm8,%xmm8,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpaddq %xmm8,%xmm8,%xmm2 ++ vpmuludq 400(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm5,%xmm5 ++ vpmuludq 256(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm9,%xmm9 ++ vpmuludq 304(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm10,%xmm10 ++ vpmuludq 368(%rsp),%xmm14,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vmovdqa 256(%rsp),%xmm4 ++ vpmuludq 400(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm7,%xmm7 ++ vpmuludq 256(%rsp),%xmm14,%xmm4 ++ vpaddq %xmm4,%xmm13,%xmm13 ++ vpmuludq 304(%rsp),%xmm14,%xmm4 ++ vpaddq %xmm4,%xmm0,%xmm0 ++ vpmuludq 352(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm11,%xmm11 ++ vpmuludq 336(%rsp),%xmm15,%xmm4 ++ vpaddq %xmm4,%xmm12,%xmm12 ++ vmovdqa 304(%rsp),%xmm4 ++ vpaddq %xmm4,%xmm4,%xmm4 ++ vpmuludq 400(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm9,%xmm9 ++ vpmuludq 320(%rsp),%xmm2,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vmovdqa 256(%rsp),%xmm4 ++ vpmuludq 320(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm3,%xmm3 ++ vmovdqa 256(%rsp),%xmm4 ++ vpmuludq 368(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm5,%xmm5 ++ vmovdqa 304(%rsp),%xmm4 ++ vpmuludq 368(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm7,%xmm7 ++ vmovdqa 352(%rsp),%xmm4 ++ vpmuludq 400(%rsp),%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm10,%xmm10 ++ vpmuludq 224(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm0,%xmm0 ++ vmovdqa 272(%rsp),%xmm2 ++ vpmuludq 224(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm1,%xmm1 ++ vmovdqa 320(%rsp),%xmm2 ++ vpmuludq 304(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vmovdqa 368(%rsp),%xmm2 ++ vpmuludq 288(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vmovdqa 400(%rsp),%xmm2 ++ vpmuludq 336(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpsrlq $26,%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm3,%xmm3 ++ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 ++ vpsrlq $25,%xmm10,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 ++ vpsrlq $25,%xmm3,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m25(%rip),%xmm3,%xmm3 ++ vpsrlq $26,%xmm11,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 ++ vpsrlq $26,%xmm5,%xmm2 ++ vpaddq %xmm2,%xmm7,%xmm7 ++ vpand curve25519_sandy2x_m26(%rip),%xmm5,%xmm5 ++ vpsrlq $25,%xmm12,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpand curve25519_sandy2x_m25(%rip),%xmm12,%xmm12 ++ vpsrlq $25,%xmm7,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpand curve25519_sandy2x_m25(%rip),%xmm7,%xmm7 ++ vpsrlq $26,%xmm13,%xmm2 ++ vpaddq %xmm2,%xmm0,%xmm0 ++ vpand curve25519_sandy2x_m26(%rip),%xmm13,%xmm13 ++ vpsrlq $26,%xmm9,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpand curve25519_sandy2x_m26(%rip),%xmm9,%xmm9 ++ vpsrlq $25,%xmm0,%xmm2 ++ vpsllq $4,%xmm2,%xmm4 ++ vpaddq %xmm2,%xmm1,%xmm1 ++ vpsllq $1,%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm1,%xmm1 ++ vpand curve25519_sandy2x_m25(%rip),%xmm0,%xmm0 ++ vpsrlq $25,%xmm10,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 ++ vpsrlq $26,%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm3,%xmm3 ++ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 ++ vpunpckhqdq %xmm3,%xmm1,%xmm2 ++ vpunpcklqdq %xmm3,%xmm1,%xmm1 ++ vmovdqa %xmm1,176(%rsp) ++ vpaddq curve25519_sandy2x_subc0(%rip),%xmm2,%xmm3 ++ vpsubq %xmm1,%xmm3,%xmm3 ++ vpunpckhqdq %xmm3,%xmm2,%xmm1 ++ vpunpcklqdq %xmm3,%xmm2,%xmm2 ++ vmovdqa %xmm2,192(%rsp) ++ vmovdqa %xmm1,224(%rsp) ++ vpsllq $1,%xmm1,%xmm1 ++ vmovdqa %xmm1,240(%rsp) ++ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm3,%xmm3 ++ vmovdqa 80(%rsp),%xmm1 ++ vpunpcklqdq %xmm1,%xmm3,%xmm2 ++ vpunpckhqdq %xmm1,%xmm3,%xmm1 ++ vpunpckhqdq %xmm7,%xmm5,%xmm3 ++ vpunpcklqdq %xmm7,%xmm5,%xmm4 ++ vmovdqa %xmm4,256(%rsp) ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm5 ++ vpsubq %xmm4,%xmm5,%xmm5 ++ vpunpckhqdq %xmm5,%xmm3,%xmm4 ++ vpunpcklqdq %xmm5,%xmm3,%xmm3 ++ vmovdqa %xmm3,272(%rsp) ++ vmovdqa %xmm4,288(%rsp) ++ vpsllq $1,%xmm4,%xmm4 ++ vmovdqa %xmm4,304(%rsp) ++ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm5,%xmm5 ++ vmovdqa 96(%rsp),%xmm3 ++ vpunpcklqdq %xmm3,%xmm5,%xmm4 ++ vpunpckhqdq %xmm3,%xmm5,%xmm3 ++ vpunpckhqdq %xmm10,%xmm9,%xmm5 ++ vpunpcklqdq %xmm10,%xmm9,%xmm6 ++ vmovdqa %xmm6,320(%rsp) ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm5,%xmm7 ++ vpsubq %xmm6,%xmm7,%xmm7 ++ vpunpckhqdq %xmm7,%xmm5,%xmm6 ++ vpunpcklqdq %xmm7,%xmm5,%xmm5 ++ vmovdqa %xmm5,336(%rsp) ++ vmovdqa %xmm6,352(%rsp) ++ vpsllq $1,%xmm6,%xmm6 ++ vmovdqa %xmm6,368(%rsp) ++ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm7,%xmm7 ++ vmovdqa 112(%rsp),%xmm5 ++ vpunpcklqdq %xmm5,%xmm7,%xmm6 ++ vpunpckhqdq %xmm5,%xmm7,%xmm5 ++ vpunpckhqdq %xmm12,%xmm11,%xmm7 ++ vpunpcklqdq %xmm12,%xmm11,%xmm8 ++ vmovdqa %xmm8,384(%rsp) ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm7,%xmm9 ++ vpsubq %xmm8,%xmm9,%xmm9 ++ vpunpckhqdq %xmm9,%xmm7,%xmm8 ++ vpunpcklqdq %xmm9,%xmm7,%xmm7 ++ vmovdqa %xmm7,400(%rsp) ++ vmovdqa %xmm8,416(%rsp) ++ vpsllq $1,%xmm8,%xmm8 ++ vmovdqa %xmm8,432(%rsp) ++ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm9,%xmm9 ++ vmovdqa 160(%rsp),%xmm7 ++ vpunpcklqdq %xmm7,%xmm9,%xmm8 ++ vpunpckhqdq %xmm7,%xmm9,%xmm7 ++ vpunpckhqdq %xmm0,%xmm13,%xmm9 ++ vpunpcklqdq %xmm0,%xmm13,%xmm0 ++ vmovdqa %xmm0,160(%rsp) ++ vpaddq curve25519_sandy2x_subc2(%rip),%xmm9,%xmm10 ++ vpsubq %xmm0,%xmm10,%xmm10 ++ vpunpckhqdq %xmm10,%xmm9,%xmm0 ++ vpunpcklqdq %xmm10,%xmm9,%xmm9 ++ vmovdqa %xmm9,448(%rsp) ++ vmovdqa %xmm0,464(%rsp) ++ vpsllq $1,%xmm0,%xmm0 ++ vmovdqa %xmm0,480(%rsp) ++ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm10,%xmm10 ++ vmovdqa 208(%rsp),%xmm0 ++ vpunpcklqdq %xmm0,%xmm10,%xmm9 ++ vpunpckhqdq %xmm0,%xmm10,%xmm0 ++ vpsrlq $26,%xmm2,%xmm10 ++ vpaddq %xmm10,%xmm1,%xmm1 ++ vpand curve25519_sandy2x_m26(%rip),%xmm2,%xmm2 ++ vpsrlq $25,%xmm5,%xmm10 ++ vpaddq %xmm10,%xmm8,%xmm8 ++ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 ++ vpsrlq $25,%xmm1,%xmm10 ++ vpaddq %xmm10,%xmm4,%xmm4 ++ vpand curve25519_sandy2x_m25(%rip),%xmm1,%xmm1 ++ vpsrlq $26,%xmm8,%xmm10 ++ vpaddq %xmm10,%xmm7,%xmm7 ++ vpand curve25519_sandy2x_m26(%rip),%xmm8,%xmm8 ++ vpsrlq $26,%xmm4,%xmm10 ++ vpaddq %xmm10,%xmm3,%xmm3 ++ vpand curve25519_sandy2x_m26(%rip),%xmm4,%xmm4 ++ vpsrlq $25,%xmm7,%xmm10 ++ vpaddq %xmm10,%xmm9,%xmm9 ++ vpand curve25519_sandy2x_m25(%rip),%xmm7,%xmm7 ++ vpsrlq $25,%xmm3,%xmm10 ++ vpaddq %xmm10,%xmm6,%xmm6 ++ vpand curve25519_sandy2x_m25(%rip),%xmm3,%xmm3 ++ vpsrlq $26,%xmm9,%xmm10 ++ vpaddq %xmm10,%xmm0,%xmm0 ++ vpand curve25519_sandy2x_m26(%rip),%xmm9,%xmm9 ++ vpsrlq $26,%xmm6,%xmm10 ++ vpaddq %xmm10,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 ++ vpsrlq $25,%xmm0,%xmm10 ++ vpsllq $4,%xmm10,%xmm11 ++ vpaddq %xmm10,%xmm2,%xmm2 ++ vpsllq $1,%xmm10,%xmm10 ++ vpaddq %xmm10,%xmm11,%xmm11 ++ vpaddq %xmm11,%xmm2,%xmm2 ++ vpand curve25519_sandy2x_m25(%rip),%xmm0,%xmm0 ++ vpsrlq $25,%xmm5,%xmm10 ++ vpaddq %xmm10,%xmm8,%xmm8 ++ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 ++ vpsrlq $26,%xmm2,%xmm10 ++ vpaddq %xmm10,%xmm1,%xmm1 ++ vpand curve25519_sandy2x_m26(%rip),%xmm2,%xmm2 ++ vpunpckhqdq %xmm1,%xmm2,%xmm10 ++ vmovdqa %xmm10,80(%rsp) ++ vpunpcklqdq %xmm1,%xmm2,%xmm1 ++ vpunpckhqdq %xmm3,%xmm4,%xmm2 ++ vmovdqa %xmm2,96(%rsp) ++ vpunpcklqdq %xmm3,%xmm4,%xmm2 ++ vpunpckhqdq %xmm5,%xmm6,%xmm3 ++ vmovdqa %xmm3,112(%rsp) ++ vpunpcklqdq %xmm5,%xmm6,%xmm3 ++ vpunpckhqdq %xmm7,%xmm8,%xmm4 ++ vmovdqa %xmm4,128(%rsp) ++ vpunpcklqdq %xmm7,%xmm8,%xmm4 ++ vpunpckhqdq %xmm0,%xmm9,%xmm5 ++ vmovdqa %xmm5,144(%rsp) ++ vpunpcklqdq %xmm0,%xmm9,%xmm0 ++ vmovdqa 176(%rsp),%xmm5 ++ vpaddq %xmm5,%xmm1,%xmm1 ++ vpunpcklqdq %xmm1,%xmm5,%xmm6 ++ vpunpckhqdq %xmm1,%xmm5,%xmm1 ++ vpmuludq 224(%rsp),%xmm6,%xmm5 ++ vpmuludq 192(%rsp),%xmm1,%xmm7 ++ vpaddq %xmm7,%xmm5,%xmm5 ++ vpmuludq 272(%rsp),%xmm6,%xmm7 ++ vpmuludq 240(%rsp),%xmm1,%xmm8 ++ vpaddq %xmm8,%xmm7,%xmm7 ++ vpmuludq 288(%rsp),%xmm6,%xmm8 ++ vpmuludq 272(%rsp),%xmm1,%xmm9 ++ vpaddq %xmm9,%xmm8,%xmm8 ++ vpmuludq 336(%rsp),%xmm6,%xmm9 ++ vpmuludq 304(%rsp),%xmm1,%xmm10 ++ vpaddq %xmm10,%xmm9,%xmm9 ++ vpmuludq 352(%rsp),%xmm6,%xmm10 ++ vpmuludq 336(%rsp),%xmm1,%xmm11 ++ vpaddq %xmm11,%xmm10,%xmm10 ++ vpmuludq 400(%rsp),%xmm6,%xmm11 ++ vpmuludq 368(%rsp),%xmm1,%xmm12 ++ vpaddq %xmm12,%xmm11,%xmm11 ++ vpmuludq 416(%rsp),%xmm6,%xmm12 ++ vpmuludq 400(%rsp),%xmm1,%xmm13 ++ vpaddq %xmm13,%xmm12,%xmm12 ++ vpmuludq 448(%rsp),%xmm6,%xmm13 ++ vpmuludq 432(%rsp),%xmm1,%xmm14 ++ vpaddq %xmm14,%xmm13,%xmm13 ++ vpmuludq 464(%rsp),%xmm6,%xmm14 ++ vpmuludq 448(%rsp),%xmm1,%xmm15 ++ vpaddq %xmm15,%xmm14,%xmm14 ++ vpmuludq 192(%rsp),%xmm6,%xmm6 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 ++ vpmuludq 480(%rsp),%xmm1,%xmm1 ++ vpaddq %xmm1,%xmm6,%xmm6 ++ vmovdqa 256(%rsp),%xmm1 ++ vpaddq %xmm1,%xmm2,%xmm2 ++ vpunpcklqdq %xmm2,%xmm1,%xmm15 ++ vpunpckhqdq %xmm2,%xmm1,%xmm1 ++ vpmuludq 192(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm7,%xmm7 ++ vpmuludq 224(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpmuludq 272(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpmuludq 288(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq 336(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpmuludq 352(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq 400(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpmuludq 416(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm15,%xmm15 ++ vpmuludq 448(%rsp),%xmm15,%xmm2 ++ vpaddq %xmm2,%xmm6,%xmm6 ++ vpmuludq 464(%rsp),%xmm15,%xmm15 ++ vpaddq %xmm15,%xmm5,%xmm5 ++ vpmuludq 192(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpmuludq 240(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpmuludq 272(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq 304(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpmuludq 336(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq 368(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpmuludq 400(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 ++ vpmuludq 432(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm6,%xmm6 ++ vpmuludq 448(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpmuludq 480(%rsp),%xmm1,%xmm1 ++ vpaddq %xmm1,%xmm7,%xmm7 ++ vmovdqa 320(%rsp),%xmm1 ++ vpaddq %xmm1,%xmm3,%xmm3 ++ vpunpcklqdq %xmm3,%xmm1,%xmm2 ++ vpunpckhqdq %xmm3,%xmm1,%xmm1 ++ vpmuludq 192(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm9,%xmm9 ++ vpmuludq 224(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm10,%xmm10 ++ vpmuludq 272(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 288(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm12,%xmm12 ++ vpmuludq 336(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 352(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm2,%xmm2 ++ vpmuludq 400(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 416(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 448(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq 464(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpmuludq 192(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq 240(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpmuludq 272(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq 304(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpmuludq 336(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 ++ vpmuludq 368(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm6,%xmm6 ++ vpmuludq 400(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpmuludq 432(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm7,%xmm7 ++ vpmuludq 448(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpmuludq 480(%rsp),%xmm1,%xmm1 ++ vpaddq %xmm1,%xmm9,%xmm9 ++ vmovdqa 384(%rsp),%xmm1 ++ vpaddq %xmm1,%xmm4,%xmm4 ++ vpunpcklqdq %xmm4,%xmm1,%xmm2 ++ vpunpckhqdq %xmm4,%xmm1,%xmm1 ++ vpmuludq 192(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm11,%xmm11 ++ vpmuludq 224(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm12,%xmm12 ++ vpmuludq 272(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpmuludq 288(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm2,%xmm2 ++ vpmuludq 336(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm6,%xmm6 ++ vpmuludq 352(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm5,%xmm5 ++ vpmuludq 400(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm7,%xmm7 ++ vpmuludq 416(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm8,%xmm8 ++ vpmuludq 448(%rsp),%xmm2,%xmm3 ++ vpaddq %xmm3,%xmm9,%xmm9 ++ vpmuludq 464(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq 192(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq 240(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpmuludq 272(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 ++ vpmuludq 304(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm6,%xmm6 ++ vpmuludq 336(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm5,%xmm5 ++ vpmuludq 368(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm7,%xmm7 ++ vpmuludq 400(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm8,%xmm8 ++ vpmuludq 432(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm9,%xmm9 ++ vpmuludq 448(%rsp),%xmm1,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ vpmuludq 480(%rsp),%xmm1,%xmm1 ++ vpaddq %xmm1,%xmm11,%xmm11 ++ vmovdqa 160(%rsp),%xmm1 ++ vpaddq %xmm1,%xmm0,%xmm0 ++ vpunpcklqdq %xmm0,%xmm1,%xmm2 ++ vpunpckhqdq %xmm0,%xmm1,%xmm0 ++ vpmuludq 192(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm13,%xmm13 ++ vpmuludq 224(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm2,%xmm2 ++ vpmuludq 272(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm6,%xmm6 ++ vpmuludq 288(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm5,%xmm5 ++ vpmuludq 336(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm7,%xmm7 ++ vpmuludq 352(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm8,%xmm8 ++ vpmuludq 400(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm9,%xmm9 ++ vpmuludq 416(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm10,%xmm10 ++ vpmuludq 448(%rsp),%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm11,%xmm11 ++ vpmuludq 464(%rsp),%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm12,%xmm12 ++ vpmuludq 192(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm14,%xmm14 ++ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm0,%xmm0 ++ vpmuludq 240(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm6,%xmm6 ++ vpmuludq 272(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm5,%xmm5 ++ vpmuludq 304(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm7,%xmm7 ++ vpmuludq 336(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm8,%xmm8 ++ vpmuludq 368(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm9,%xmm9 ++ vpmuludq 400(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm10,%xmm10 ++ vpmuludq 432(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm11,%xmm11 ++ vpmuludq 448(%rsp),%xmm0,%xmm1 ++ vpaddq %xmm1,%xmm12,%xmm12 ++ vpmuludq 480(%rsp),%xmm0,%xmm0 ++ vpaddq %xmm0,%xmm13,%xmm13 ++ vpsrlq $26,%xmm6,%xmm0 ++ vpaddq %xmm0,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 ++ vpsrlq $25,%xmm10,%xmm0 ++ vpaddq %xmm0,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 ++ vpsrlq $25,%xmm5,%xmm0 ++ vpaddq %xmm0,%xmm7,%xmm7 ++ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 ++ vpsrlq $26,%xmm11,%xmm0 ++ vpaddq %xmm0,%xmm12,%xmm12 ++ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 ++ vpsrlq $26,%xmm7,%xmm0 ++ vpaddq %xmm0,%xmm8,%xmm8 ++ vpand curve25519_sandy2x_m26(%rip),%xmm7,%xmm7 ++ vpsrlq $25,%xmm12,%xmm0 ++ vpaddq %xmm0,%xmm13,%xmm13 ++ vpand curve25519_sandy2x_m25(%rip),%xmm12,%xmm12 ++ vpsrlq $25,%xmm8,%xmm0 ++ vpaddq %xmm0,%xmm9,%xmm9 ++ vpand curve25519_sandy2x_m25(%rip),%xmm8,%xmm8 ++ vpsrlq $26,%xmm13,%xmm0 ++ vpaddq %xmm0,%xmm14,%xmm14 ++ vpand curve25519_sandy2x_m26(%rip),%xmm13,%xmm13 ++ vpsrlq $26,%xmm9,%xmm0 ++ vpaddq %xmm0,%xmm10,%xmm10 ++ vpand curve25519_sandy2x_m26(%rip),%xmm9,%xmm9 ++ vpsrlq $25,%xmm14,%xmm0 ++ vpsllq $4,%xmm0,%xmm1 ++ vpaddq %xmm0,%xmm6,%xmm6 ++ vpsllq $1,%xmm0,%xmm0 ++ vpaddq %xmm0,%xmm1,%xmm1 ++ vpaddq %xmm1,%xmm6,%xmm6 ++ vpand curve25519_sandy2x_m25(%rip),%xmm14,%xmm14 ++ vpsrlq $25,%xmm10,%xmm0 ++ vpaddq %xmm0,%xmm11,%xmm11 ++ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 ++ vpsrlq $26,%xmm6,%xmm0 ++ vpaddq %xmm0,%xmm5,%xmm5 ++ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 ++ vpunpckhqdq %xmm5,%xmm6,%xmm1 ++ vpunpcklqdq %xmm5,%xmm6,%xmm0 ++ vpunpckhqdq %xmm8,%xmm7,%xmm3 ++ vpunpcklqdq %xmm8,%xmm7,%xmm2 ++ vpunpckhqdq %xmm10,%xmm9,%xmm5 ++ vpunpcklqdq %xmm10,%xmm9,%xmm4 ++ vpunpckhqdq %xmm12,%xmm11,%xmm7 ++ vpunpcklqdq %xmm12,%xmm11,%xmm6 ++ vpunpckhqdq %xmm14,%xmm13,%xmm9 ++ vpunpcklqdq %xmm14,%xmm13,%xmm8 ++ cmp $0,%rdx ++ jne .Lladder_base_loop ++ vmovdqu %xmm1,80(%rdi) ++ vmovdqu %xmm0,0(%rdi) ++ vmovdqu %xmm3,96(%rdi) ++ vmovdqu %xmm2,16(%rdi) ++ vmovdqu %xmm5,112(%rdi) ++ vmovdqu %xmm4,32(%rdi) ++ vmovdqu %xmm7,128(%rdi) ++ vmovdqu %xmm6,48(%rdi) ++ vmovdqu %xmm9,144(%rdi) ++ vmovdqu %xmm8,64(%rdi) ++ movq 1536(%rsp),%r11 ++ movq 1544(%rsp),%r12 ++ movq 1552(%rsp),%r13 ++ leave ++ ret ++ENDPROC(curve25519_sandy2x_ladder_base) ++#endif /* CONFIG_AS_AVX */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/poly1305-arm64.S 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,820 @@ ++/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. ++ */ ++ ++#include ++.text ++ ++.align 5 ++ENTRY(poly1305_init_arm) ++ cmp x1,xzr ++ stp xzr,xzr,[x0] // zero hash value ++ stp xzr,xzr,[x0,#16] // [along with is_base2_26] ++ ++ csel x0,xzr,x0,eq ++ b.eq .Lno_key ++ ++ ldp x7,x8,[x1] // load key ++ mov x9,#0xfffffffc0fffffff ++ movk x9,#0x0fff,lsl#48 ++#ifdef __ARMEB__ ++ rev x7,x7 // flip bytes ++ rev x8,x8 ++#endif ++ and x7,x7,x9 // &=0ffffffc0fffffff ++ and x9,x9,#-4 ++ and x8,x8,x9 // &=0ffffffc0ffffffc ++ stp x7,x8,[x0,#32] // save key value ++ ++.Lno_key: ++ ret ++ENDPROC(poly1305_init_arm) ++ ++.align 5 ++ENTRY(poly1305_blocks_arm) ++ ands x2,x2,#-16 ++ b.eq .Lno_data ++ ++ ldp x4,x5,[x0] // load hash value ++ ldp x7,x8,[x0,#32] // load key value ++ ldr x6,[x0,#16] ++ add x9,x8,x8,lsr#2 // s1 = r1 + (r1 >> 2) ++ b .Loop ++ ++.align 5 ++.Loop: ++ ldp x10,x11,[x1],#16 // load input ++ sub x2,x2,#16 ++#ifdef __ARMEB__ ++ rev x10,x10 ++ rev x11,x11 ++#endif ++ adds x4,x4,x10 // accumulate input ++ adcs x5,x5,x11 ++ ++ mul x12,x4,x7 // h0*r0 ++ adc x6,x6,x3 ++ umulh x13,x4,x7 ++ ++ mul x10,x5,x9 // h1*5*r1 ++ umulh x11,x5,x9 ++ ++ adds x12,x12,x10 ++ mul x10,x4,x8 // h0*r1 ++ adc x13,x13,x11 ++ umulh x14,x4,x8 ++ ++ adds x13,x13,x10 ++ mul x10,x5,x7 // h1*r0 ++ adc x14,x14,xzr ++ umulh x11,x5,x7 ++ ++ adds x13,x13,x10 ++ mul x10,x6,x9 // h2*5*r1 ++ adc x14,x14,x11 ++ mul x11,x6,x7 // h2*r0 ++ ++ adds x13,x13,x10 ++ adc x14,x14,x11 ++ ++ and x10,x14,#-4 // final reduction ++ and x6,x14,#3 ++ add x10,x10,x14,lsr#2 ++ adds x4,x12,x10 ++ adcs x5,x13,xzr ++ adc x6,x6,xzr ++ ++ cbnz x2,.Loop ++ ++ stp x4,x5,[x0] // store hash value ++ str x6,[x0,#16] ++ ++.Lno_data: ++ ret ++ENDPROC(poly1305_blocks_arm) ++ ++.align 5 ++ENTRY(poly1305_emit_arm) ++ ldp x4,x5,[x0] // load hash base 2^64 ++ ldr x6,[x0,#16] ++ ldp x10,x11,[x2] // load nonce ++ ++ adds x12,x4,#5 // compare to modulus ++ adcs x13,x5,xzr ++ adc x14,x6,xzr ++ ++ tst x14,#-4 // see if it's carried/borrowed ++ ++ csel x4,x4,x12,eq ++ csel x5,x5,x13,eq ++ ++#ifdef __ARMEB__ ++ ror x10,x10,#32 // flip nonce words ++ ror x11,x11,#32 ++#endif ++ adds x4,x4,x10 // accumulate nonce ++ adc x5,x5,x11 ++#ifdef __ARMEB__ ++ rev x4,x4 // flip output bytes ++ rev x5,x5 ++#endif ++ stp x4,x5,[x1] // write result ++ ++ ret ++ENDPROC(poly1305_emit_arm) ++ ++.align 5 ++__poly1305_mult: ++ mul x12,x4,x7 // h0*r0 ++ umulh x13,x4,x7 ++ ++ mul x10,x5,x9 // h1*5*r1 ++ umulh x11,x5,x9 ++ ++ adds x12,x12,x10 ++ mul x10,x4,x8 // h0*r1 ++ adc x13,x13,x11 ++ umulh x14,x4,x8 ++ ++ adds x13,x13,x10 ++ mul x10,x5,x7 // h1*r0 ++ adc x14,x14,xzr ++ umulh x11,x5,x7 ++ ++ adds x13,x13,x10 ++ mul x10,x6,x9 // h2*5*r1 ++ adc x14,x14,x11 ++ mul x11,x6,x7 // h2*r0 ++ ++ adds x13,x13,x10 ++ adc x14,x14,x11 ++ ++ and x10,x14,#-4 // final reduction ++ and x6,x14,#3 ++ add x10,x10,x14,lsr#2 ++ adds x4,x12,x10 ++ adcs x5,x13,xzr ++ adc x6,x6,xzr ++ ++ ret ++ ++__poly1305_splat: ++ and x12,x4,#0x03ffffff // base 2^64 -> base 2^26 ++ ubfx x13,x4,#26,#26 ++ extr x14,x5,x4,#52 ++ and x14,x14,#0x03ffffff ++ ubfx x15,x5,#14,#26 ++ extr x16,x6,x5,#40 ++ ++ str w12,[x0,#16*0] // r0 ++ add w12,w13,w13,lsl#2 // r1*5 ++ str w13,[x0,#16*1] // r1 ++ add w13,w14,w14,lsl#2 // r2*5 ++ str w12,[x0,#16*2] // s1 ++ str w14,[x0,#16*3] // r2 ++ add w14,w15,w15,lsl#2 // r3*5 ++ str w13,[x0,#16*4] // s2 ++ str w15,[x0,#16*5] // r3 ++ add w15,w16,w16,lsl#2 // r4*5 ++ str w14,[x0,#16*6] // s3 ++ str w16,[x0,#16*7] // r4 ++ str w15,[x0,#16*8] // s4 ++ ++ ret ++ ++.align 5 ++ENTRY(poly1305_blocks_neon) ++ ldr x17,[x0,#24] ++ cmp x2,#128 ++ b.hs .Lblocks_neon ++ cbz x17,poly1305_blocks_arm ++ ++.Lblocks_neon: ++ stp x29,x30,[sp,#-80]! ++ add x29,sp,#0 ++ ++ ands x2,x2,#-16 ++ b.eq .Lno_data_neon ++ ++ cbz x17,.Lbase2_64_neon ++ ++ ldp w10,w11,[x0] // load hash value base 2^26 ++ ldp w12,w13,[x0,#8] ++ ldr w14,[x0,#16] ++ ++ tst x2,#31 ++ b.eq .Leven_neon ++ ++ ldp x7,x8,[x0,#32] // load key value ++ ++ add x4,x10,x11,lsl#26 // base 2^26 -> base 2^64 ++ lsr x5,x12,#12 ++ adds x4,x4,x12,lsl#52 ++ add x5,x5,x13,lsl#14 ++ adc x5,x5,xzr ++ lsr x6,x14,#24 ++ adds x5,x5,x14,lsl#40 ++ adc x14,x6,xzr // can be partially reduced... ++ ++ ldp x12,x13,[x1],#16 // load input ++ sub x2,x2,#16 ++ add x9,x8,x8,lsr#2 // s1 = r1 + (r1 >> 2) ++ ++ and x10,x14,#-4 // ... so reduce ++ and x6,x14,#3 ++ add x10,x10,x14,lsr#2 ++ adds x4,x4,x10 ++ adcs x5,x5,xzr ++ adc x6,x6,xzr ++ ++#ifdef __ARMEB__ ++ rev x12,x12 ++ rev x13,x13 ++#endif ++ adds x4,x4,x12 // accumulate input ++ adcs x5,x5,x13 ++ adc x6,x6,x3 ++ ++ bl __poly1305_mult ++ ldr x30,[sp,#8] ++ ++ cbz x3,.Lstore_base2_64_neon ++ ++ and x10,x4,#0x03ffffff // base 2^64 -> base 2^26 ++ ubfx x11,x4,#26,#26 ++ extr x12,x5,x4,#52 ++ and x12,x12,#0x03ffffff ++ ubfx x13,x5,#14,#26 ++ extr x14,x6,x5,#40 ++ ++ cbnz x2,.Leven_neon ++ ++ stp w10,w11,[x0] // store hash value base 2^26 ++ stp w12,w13,[x0,#8] ++ str w14,[x0,#16] ++ b .Lno_data_neon ++ ++.align 4 ++.Lstore_base2_64_neon: ++ stp x4,x5,[x0] // store hash value base 2^64 ++ stp x6,xzr,[x0,#16] // note that is_base2_26 is zeroed ++ b .Lno_data_neon ++ ++.align 4 ++.Lbase2_64_neon: ++ ldp x7,x8,[x0,#32] // load key value ++ ++ ldp x4,x5,[x0] // load hash value base 2^64 ++ ldr x6,[x0,#16] ++ ++ tst x2,#31 ++ b.eq .Linit_neon ++ ++ ldp x12,x13,[x1],#16 // load input ++ sub x2,x2,#16 ++ add x9,x8,x8,lsr#2 // s1 = r1 + (r1 >> 2) ++#ifdef __ARMEB__ ++ rev x12,x12 ++ rev x13,x13 ++#endif ++ adds x4,x4,x12 // accumulate input ++ adcs x5,x5,x13 ++ adc x6,x6,x3 ++ ++ bl __poly1305_mult ++ ++.Linit_neon: ++ and x10,x4,#0x03ffffff // base 2^64 -> base 2^26 ++ ubfx x11,x4,#26,#26 ++ extr x12,x5,x4,#52 ++ and x12,x12,#0x03ffffff ++ ubfx x13,x5,#14,#26 ++ extr x14,x6,x5,#40 ++ ++ stp d8,d9,[sp,#16] // meet ABI requirements ++ stp d10,d11,[sp,#32] ++ stp d12,d13,[sp,#48] ++ stp d14,d15,[sp,#64] ++ ++ fmov d24,x10 ++ fmov d25,x11 ++ fmov d26,x12 ++ fmov d27,x13 ++ fmov d28,x14 ++ ++ ////////////////////////////////// initialize r^n table ++ mov x4,x7 // r^1 ++ add x9,x8,x8,lsr#2 // s1 = r1 + (r1 >> 2) ++ mov x5,x8 ++ mov x6,xzr ++ add x0,x0,#48+12 ++ bl __poly1305_splat ++ ++ bl __poly1305_mult // r^2 ++ sub x0,x0,#4 ++ bl __poly1305_splat ++ ++ bl __poly1305_mult // r^3 ++ sub x0,x0,#4 ++ bl __poly1305_splat ++ ++ bl __poly1305_mult // r^4 ++ sub x0,x0,#4 ++ bl __poly1305_splat ++ ldr x30,[sp,#8] ++ ++ add x16,x1,#32 ++ adr x17,.Lzeros ++ subs x2,x2,#64 ++ csel x16,x17,x16,lo ++ ++ mov x4,#1 ++ str x4,[x0,#-24] // set is_base2_26 ++ sub x0,x0,#48 // restore original x0 ++ b .Ldo_neon ++ ++.align 4 ++.Leven_neon: ++ add x16,x1,#32 ++ adr x17,.Lzeros ++ subs x2,x2,#64 ++ csel x16,x17,x16,lo ++ ++ stp d8,d9,[sp,#16] // meet ABI requirements ++ stp d10,d11,[sp,#32] ++ stp d12,d13,[sp,#48] ++ stp d14,d15,[sp,#64] ++ ++ fmov d24,x10 ++ fmov d25,x11 ++ fmov d26,x12 ++ fmov d27,x13 ++ fmov d28,x14 ++ ++.Ldo_neon: ++ ldp x8,x12,[x16],#16 // inp[2:3] (or zero) ++ ldp x9,x13,[x16],#48 ++ ++ lsl x3,x3,#24 ++ add x15,x0,#48 ++ ++#ifdef __ARMEB__ ++ rev x8,x8 ++ rev x12,x12 ++ rev x9,x9 ++ rev x13,x13 ++#endif ++ and x4,x8,#0x03ffffff // base 2^64 -> base 2^26 ++ and x5,x9,#0x03ffffff ++ ubfx x6,x8,#26,#26 ++ ubfx x7,x9,#26,#26 ++ add x4,x4,x5,lsl#32 // bfi x4,x5,#32,#32 ++ extr x8,x12,x8,#52 ++ extr x9,x13,x9,#52 ++ add x6,x6,x7,lsl#32 // bfi x6,x7,#32,#32 ++ fmov d14,x4 ++ and x8,x8,#0x03ffffff ++ and x9,x9,#0x03ffffff ++ ubfx x10,x12,#14,#26 ++ ubfx x11,x13,#14,#26 ++ add x12,x3,x12,lsr#40 ++ add x13,x3,x13,lsr#40 ++ add x8,x8,x9,lsl#32 // bfi x8,x9,#32,#32 ++ fmov d15,x6 ++ add x10,x10,x11,lsl#32 // bfi x10,x11,#32,#32 ++ add x12,x12,x13,lsl#32 // bfi x12,x13,#32,#32 ++ fmov d16,x8 ++ fmov d17,x10 ++ fmov d18,x12 ++ ++ ldp x8,x12,[x1],#16 // inp[0:1] ++ ldp x9,x13,[x1],#48 ++ ++ ld1 {v0.4s,v1.4s,v2.4s,v3.4s},[x15],#64 ++ ld1 {v4.4s,v5.4s,v6.4s,v7.4s},[x15],#64 ++ ld1 {v8.4s},[x15] ++ ++#ifdef __ARMEB__ ++ rev x8,x8 ++ rev x12,x12 ++ rev x9,x9 ++ rev x13,x13 ++#endif ++ and x4,x8,#0x03ffffff // base 2^64 -> base 2^26 ++ and x5,x9,#0x03ffffff ++ ubfx x6,x8,#26,#26 ++ ubfx x7,x9,#26,#26 ++ add x4,x4,x5,lsl#32 // bfi x4,x5,#32,#32 ++ extr x8,x12,x8,#52 ++ extr x9,x13,x9,#52 ++ add x6,x6,x7,lsl#32 // bfi x6,x7,#32,#32 ++ fmov d9,x4 ++ and x8,x8,#0x03ffffff ++ and x9,x9,#0x03ffffff ++ ubfx x10,x12,#14,#26 ++ ubfx x11,x13,#14,#26 ++ add x12,x3,x12,lsr#40 ++ add x13,x3,x13,lsr#40 ++ add x8,x8,x9,lsl#32 // bfi x8,x9,#32,#32 ++ fmov d10,x6 ++ add x10,x10,x11,lsl#32 // bfi x10,x11,#32,#32 ++ add x12,x12,x13,lsl#32 // bfi x12,x13,#32,#32 ++ movi v31.2d,#-1 ++ fmov d11,x8 ++ fmov d12,x10 ++ fmov d13,x12 ++ ushr v31.2d,v31.2d,#38 ++ ++ b.ls .Lskip_loop ++ ++.align 4 ++.Loop_neon: ++ //////////////////////////////////////////////////////////////// ++ // ((inp[0]*r^4+inp[2]*r^2+inp[4])*r^4+inp[6]*r^2 ++ // ((inp[1]*r^4+inp[3]*r^2+inp[5])*r^3+inp[7]*r ++ // ___________________/ ++ // ((inp[0]*r^4+inp[2]*r^2+inp[4])*r^4+inp[6]*r^2+inp[8])*r^2 ++ // ((inp[1]*r^4+inp[3]*r^2+inp[5])*r^4+inp[7]*r^2+inp[9])*r ++ // ___________________/ ____________________/ ++ // ++ // Note that we start with inp[2:3]*r^2. This is because it ++ // doesn't depend on reduction in previous iteration. ++ //////////////////////////////////////////////////////////////// ++ // d4 = h0*r4 + h1*r3 + h2*r2 + h3*r1 + h4*r0 ++ // d3 = h0*r3 + h1*r2 + h2*r1 + h3*r0 + h4*5*r4 ++ // d2 = h0*r2 + h1*r1 + h2*r0 + h3*5*r4 + h4*5*r3 ++ // d1 = h0*r1 + h1*r0 + h2*5*r4 + h3*5*r3 + h4*5*r2 ++ // d0 = h0*r0 + h1*5*r4 + h2*5*r3 + h3*5*r2 + h4*5*r1 ++ ++ subs x2,x2,#64 ++ umull v23.2d,v14.2s,v7.s[2] ++ csel x16,x17,x16,lo ++ umull v22.2d,v14.2s,v5.s[2] ++ umull v21.2d,v14.2s,v3.s[2] ++ ldp x8,x12,[x16],#16 // inp[2:3] (or zero) ++ umull v20.2d,v14.2s,v1.s[2] ++ ldp x9,x13,[x16],#48 ++ umull v19.2d,v14.2s,v0.s[2] ++#ifdef __ARMEB__ ++ rev x8,x8 ++ rev x12,x12 ++ rev x9,x9 ++ rev x13,x13 ++#endif ++ ++ umlal v23.2d,v15.2s,v5.s[2] ++ and x4,x8,#0x03ffffff // base 2^64 -> base 2^26 ++ umlal v22.2d,v15.2s,v3.s[2] ++ and x5,x9,#0x03ffffff ++ umlal v21.2d,v15.2s,v1.s[2] ++ ubfx x6,x8,#26,#26 ++ umlal v20.2d,v15.2s,v0.s[2] ++ ubfx x7,x9,#26,#26 ++ umlal v19.2d,v15.2s,v8.s[2] ++ add x4,x4,x5,lsl#32 // bfi x4,x5,#32,#32 ++ ++ umlal v23.2d,v16.2s,v3.s[2] ++ extr x8,x12,x8,#52 ++ umlal v22.2d,v16.2s,v1.s[2] ++ extr x9,x13,x9,#52 ++ umlal v21.2d,v16.2s,v0.s[2] ++ add x6,x6,x7,lsl#32 // bfi x6,x7,#32,#32 ++ umlal v20.2d,v16.2s,v8.s[2] ++ fmov d14,x4 ++ umlal v19.2d,v16.2s,v6.s[2] ++ and x8,x8,#0x03ffffff ++ ++ umlal v23.2d,v17.2s,v1.s[2] ++ and x9,x9,#0x03ffffff ++ umlal v22.2d,v17.2s,v0.s[2] ++ ubfx x10,x12,#14,#26 ++ umlal v21.2d,v17.2s,v8.s[2] ++ ubfx x11,x13,#14,#26 ++ umlal v20.2d,v17.2s,v6.s[2] ++ add x8,x8,x9,lsl#32 // bfi x8,x9,#32,#32 ++ umlal v19.2d,v17.2s,v4.s[2] ++ fmov d15,x6 ++ ++ add v11.2s,v11.2s,v26.2s ++ add x12,x3,x12,lsr#40 ++ umlal v23.2d,v18.2s,v0.s[2] ++ add x13,x3,x13,lsr#40 ++ umlal v22.2d,v18.2s,v8.s[2] ++ add x10,x10,x11,lsl#32 // bfi x10,x11,#32,#32 ++ umlal v21.2d,v18.2s,v6.s[2] ++ add x12,x12,x13,lsl#32 // bfi x12,x13,#32,#32 ++ umlal v20.2d,v18.2s,v4.s[2] ++ fmov d16,x8 ++ umlal v19.2d,v18.2s,v2.s[2] ++ fmov d17,x10 ++ ++ //////////////////////////////////////////////////////////////// ++ // (hash+inp[0:1])*r^4 and accumulate ++ ++ add v9.2s,v9.2s,v24.2s ++ fmov d18,x12 ++ umlal v22.2d,v11.2s,v1.s[0] ++ ldp x8,x12,[x1],#16 // inp[0:1] ++ umlal v19.2d,v11.2s,v6.s[0] ++ ldp x9,x13,[x1],#48 ++ umlal v23.2d,v11.2s,v3.s[0] ++ umlal v20.2d,v11.2s,v8.s[0] ++ umlal v21.2d,v11.2s,v0.s[0] ++#ifdef __ARMEB__ ++ rev x8,x8 ++ rev x12,x12 ++ rev x9,x9 ++ rev x13,x13 ++#endif ++ ++ add v10.2s,v10.2s,v25.2s ++ umlal v22.2d,v9.2s,v5.s[0] ++ umlal v23.2d,v9.2s,v7.s[0] ++ and x4,x8,#0x03ffffff // base 2^64 -> base 2^26 ++ umlal v21.2d,v9.2s,v3.s[0] ++ and x5,x9,#0x03ffffff ++ umlal v19.2d,v9.2s,v0.s[0] ++ ubfx x6,x8,#26,#26 ++ umlal v20.2d,v9.2s,v1.s[0] ++ ubfx x7,x9,#26,#26 ++ ++ add v12.2s,v12.2s,v27.2s ++ add x4,x4,x5,lsl#32 // bfi x4,x5,#32,#32 ++ umlal v22.2d,v10.2s,v3.s[0] ++ extr x8,x12,x8,#52 ++ umlal v23.2d,v10.2s,v5.s[0] ++ extr x9,x13,x9,#52 ++ umlal v19.2d,v10.2s,v8.s[0] ++ add x6,x6,x7,lsl#32 // bfi x6,x7,#32,#32 ++ umlal v21.2d,v10.2s,v1.s[0] ++ fmov d9,x4 ++ umlal v20.2d,v10.2s,v0.s[0] ++ and x8,x8,#0x03ffffff ++ ++ add v13.2s,v13.2s,v28.2s ++ and x9,x9,#0x03ffffff ++ umlal v22.2d,v12.2s,v0.s[0] ++ ubfx x10,x12,#14,#26 ++ umlal v19.2d,v12.2s,v4.s[0] ++ ubfx x11,x13,#14,#26 ++ umlal v23.2d,v12.2s,v1.s[0] ++ add x8,x8,x9,lsl#32 // bfi x8,x9,#32,#32 ++ umlal v20.2d,v12.2s,v6.s[0] ++ fmov d10,x6 ++ umlal v21.2d,v12.2s,v8.s[0] ++ add x12,x3,x12,lsr#40 ++ ++ umlal v22.2d,v13.2s,v8.s[0] ++ add x13,x3,x13,lsr#40 ++ umlal v19.2d,v13.2s,v2.s[0] ++ add x10,x10,x11,lsl#32 // bfi x10,x11,#32,#32 ++ umlal v23.2d,v13.2s,v0.s[0] ++ add x12,x12,x13,lsl#32 // bfi x12,x13,#32,#32 ++ umlal v20.2d,v13.2s,v4.s[0] ++ fmov d11,x8 ++ umlal v21.2d,v13.2s,v6.s[0] ++ fmov d12,x10 ++ fmov d13,x12 ++ ++ ///////////////////////////////////////////////////////////////// ++ // lazy reduction as discussed in "NEON crypto" by D.J. Bernstein ++ // and P. Schwabe ++ // ++ // [see discussion in poly1305-armv4 module] ++ ++ ushr v29.2d,v22.2d,#26 ++ xtn v27.2s,v22.2d ++ ushr v30.2d,v19.2d,#26 ++ and v19.16b,v19.16b,v31.16b ++ add v23.2d,v23.2d,v29.2d // h3 -> h4 ++ bic v27.2s,#0xfc,lsl#24 // &=0x03ffffff ++ add v20.2d,v20.2d,v30.2d // h0 -> h1 ++ ++ ushr v29.2d,v23.2d,#26 ++ xtn v28.2s,v23.2d ++ ushr v30.2d,v20.2d,#26 ++ xtn v25.2s,v20.2d ++ bic v28.2s,#0xfc,lsl#24 ++ add v21.2d,v21.2d,v30.2d // h1 -> h2 ++ ++ add v19.2d,v19.2d,v29.2d ++ shl v29.2d,v29.2d,#2 ++ shrn v30.2s,v21.2d,#26 ++ xtn v26.2s,v21.2d ++ add v19.2d,v19.2d,v29.2d // h4 -> h0 ++ bic v25.2s,#0xfc,lsl#24 ++ add v27.2s,v27.2s,v30.2s // h2 -> h3 ++ bic v26.2s,#0xfc,lsl#24 ++ ++ shrn v29.2s,v19.2d,#26 ++ xtn v24.2s,v19.2d ++ ushr v30.2s,v27.2s,#26 ++ bic v27.2s,#0xfc,lsl#24 ++ bic v24.2s,#0xfc,lsl#24 ++ add v25.2s,v25.2s,v29.2s // h0 -> h1 ++ add v28.2s,v28.2s,v30.2s // h3 -> h4 ++ ++ b.hi .Loop_neon ++ ++.Lskip_loop: ++ dup v16.2d,v16.d[0] ++ add v11.2s,v11.2s,v26.2s ++ ++ //////////////////////////////////////////////////////////////// ++ // multiply (inp[0:1]+hash) or inp[2:3] by r^2:r^1 ++ ++ adds x2,x2,#32 ++ b.ne .Long_tail ++ ++ dup v16.2d,v11.d[0] ++ add v14.2s,v9.2s,v24.2s ++ add v17.2s,v12.2s,v27.2s ++ add v15.2s,v10.2s,v25.2s ++ add v18.2s,v13.2s,v28.2s ++ ++.Long_tail: ++ dup v14.2d,v14.d[0] ++ umull2 v19.2d,v16.4s,v6.4s ++ umull2 v22.2d,v16.4s,v1.4s ++ umull2 v23.2d,v16.4s,v3.4s ++ umull2 v21.2d,v16.4s,v0.4s ++ umull2 v20.2d,v16.4s,v8.4s ++ ++ dup v15.2d,v15.d[0] ++ umlal2 v19.2d,v14.4s,v0.4s ++ umlal2 v21.2d,v14.4s,v3.4s ++ umlal2 v22.2d,v14.4s,v5.4s ++ umlal2 v23.2d,v14.4s,v7.4s ++ umlal2 v20.2d,v14.4s,v1.4s ++ ++ dup v17.2d,v17.d[0] ++ umlal2 v19.2d,v15.4s,v8.4s ++ umlal2 v22.2d,v15.4s,v3.4s ++ umlal2 v21.2d,v15.4s,v1.4s ++ umlal2 v23.2d,v15.4s,v5.4s ++ umlal2 v20.2d,v15.4s,v0.4s ++ ++ dup v18.2d,v18.d[0] ++ umlal2 v22.2d,v17.4s,v0.4s ++ umlal2 v23.2d,v17.4s,v1.4s ++ umlal2 v19.2d,v17.4s,v4.4s ++ umlal2 v20.2d,v17.4s,v6.4s ++ umlal2 v21.2d,v17.4s,v8.4s ++ ++ umlal2 v22.2d,v18.4s,v8.4s ++ umlal2 v19.2d,v18.4s,v2.4s ++ umlal2 v23.2d,v18.4s,v0.4s ++ umlal2 v20.2d,v18.4s,v4.4s ++ umlal2 v21.2d,v18.4s,v6.4s ++ ++ b.eq .Lshort_tail ++ ++ //////////////////////////////////////////////////////////////// ++ // (hash+inp[0:1])*r^4:r^3 and accumulate ++ ++ add v9.2s,v9.2s,v24.2s ++ umlal v22.2d,v11.2s,v1.2s ++ umlal v19.2d,v11.2s,v6.2s ++ umlal v23.2d,v11.2s,v3.2s ++ umlal v20.2d,v11.2s,v8.2s ++ umlal v21.2d,v11.2s,v0.2s ++ ++ add v10.2s,v10.2s,v25.2s ++ umlal v22.2d,v9.2s,v5.2s ++ umlal v19.2d,v9.2s,v0.2s ++ umlal v23.2d,v9.2s,v7.2s ++ umlal v20.2d,v9.2s,v1.2s ++ umlal v21.2d,v9.2s,v3.2s ++ ++ add v12.2s,v12.2s,v27.2s ++ umlal v22.2d,v10.2s,v3.2s ++ umlal v19.2d,v10.2s,v8.2s ++ umlal v23.2d,v10.2s,v5.2s ++ umlal v20.2d,v10.2s,v0.2s ++ umlal v21.2d,v10.2s,v1.2s ++ ++ add v13.2s,v13.2s,v28.2s ++ umlal v22.2d,v12.2s,v0.2s ++ umlal v19.2d,v12.2s,v4.2s ++ umlal v23.2d,v12.2s,v1.2s ++ umlal v20.2d,v12.2s,v6.2s ++ umlal v21.2d,v12.2s,v8.2s ++ ++ umlal v22.2d,v13.2s,v8.2s ++ umlal v19.2d,v13.2s,v2.2s ++ umlal v23.2d,v13.2s,v0.2s ++ umlal v20.2d,v13.2s,v4.2s ++ umlal v21.2d,v13.2s,v6.2s ++ ++.Lshort_tail: ++ //////////////////////////////////////////////////////////////// ++ // horizontal add ++ ++ addp v22.2d,v22.2d,v22.2d ++ ldp d8,d9,[sp,#16] // meet ABI requirements ++ addp v19.2d,v19.2d,v19.2d ++ ldp d10,d11,[sp,#32] ++ addp v23.2d,v23.2d,v23.2d ++ ldp d12,d13,[sp,#48] ++ addp v20.2d,v20.2d,v20.2d ++ ldp d14,d15,[sp,#64] ++ addp v21.2d,v21.2d,v21.2d ++ ++ //////////////////////////////////////////////////////////////// ++ // lazy reduction, but without narrowing ++ ++ ushr v29.2d,v22.2d,#26 ++ and v22.16b,v22.16b,v31.16b ++ ushr v30.2d,v19.2d,#26 ++ and v19.16b,v19.16b,v31.16b ++ ++ add v23.2d,v23.2d,v29.2d // h3 -> h4 ++ add v20.2d,v20.2d,v30.2d // h0 -> h1 ++ ++ ushr v29.2d,v23.2d,#26 ++ and v23.16b,v23.16b,v31.16b ++ ushr v30.2d,v20.2d,#26 ++ and v20.16b,v20.16b,v31.16b ++ add v21.2d,v21.2d,v30.2d // h1 -> h2 ++ ++ add v19.2d,v19.2d,v29.2d ++ shl v29.2d,v29.2d,#2 ++ ushr v30.2d,v21.2d,#26 ++ and v21.16b,v21.16b,v31.16b ++ add v19.2d,v19.2d,v29.2d // h4 -> h0 ++ add v22.2d,v22.2d,v30.2d // h2 -> h3 ++ ++ ushr v29.2d,v19.2d,#26 ++ and v19.16b,v19.16b,v31.16b ++ ushr v30.2d,v22.2d,#26 ++ and v22.16b,v22.16b,v31.16b ++ add v20.2d,v20.2d,v29.2d // h0 -> h1 ++ add v23.2d,v23.2d,v30.2d // h3 -> h4 ++ ++ //////////////////////////////////////////////////////////////// ++ // write the result, can be partially reduced ++ ++ st4 {v19.s,v20.s,v21.s,v22.s}[0],[x0],#16 ++ st1 {v23.s}[0],[x0] ++ ++.Lno_data_neon: ++ ldr x29,[sp],#80 ++ ret ++ENDPROC(poly1305_blocks_neon) ++ ++.align 5 ++ENTRY(poly1305_emit_neon) ++ ldr x17,[x0,#24] ++ cbz x17,poly1305_emit_arm ++ ++ ldp w10,w11,[x0] // load hash value base 2^26 ++ ldp w12,w13,[x0,#8] ++ ldr w14,[x0,#16] ++ ++ add x4,x10,x11,lsl#26 // base 2^26 -> base 2^64 ++ lsr x5,x12,#12 ++ adds x4,x4,x12,lsl#52 ++ add x5,x5,x13,lsl#14 ++ adc x5,x5,xzr ++ lsr x6,x14,#24 ++ adds x5,x5,x14,lsl#40 ++ adc x6,x6,xzr // can be partially reduced... ++ ++ ldp x10,x11,[x2] // load nonce ++ ++ and x12,x6,#-4 // ... so reduce ++ add x12,x12,x6,lsr#2 ++ and x6,x6,#3 ++ adds x4,x4,x12 ++ adcs x5,x5,xzr ++ adc x6,x6,xzr ++ ++ adds x12,x4,#5 // compare to modulus ++ adcs x13,x5,xzr ++ adc x14,x6,xzr ++ ++ tst x14,#-4 // see if it's carried/borrowed ++ ++ csel x4,x4,x12,eq ++ csel x5,x5,x13,eq ++ ++#ifdef __ARMEB__ ++ ror x10,x10,#32 // flip nonce words ++ ror x11,x11,#32 ++#endif ++ adds x4,x4,x10 // accumulate nonce ++ adc x5,x5,x11 ++#ifdef __ARMEB__ ++ rev x4,x4 // flip output bytes ++ rev x5,x5 ++#endif ++ stp x4,x5,[x1] // write result ++ ++ ret ++ENDPROC(poly1305_emit_neon) ++ ++.align 5 ++.Lzeros: ++.long 0,0,0,0,0,0,0,0 +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/poly1305-arm.S 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,1115 @@ ++/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. ++ */ ++ ++#include ++ ++.text ++#if defined(__thumb2__) ++.syntax unified ++.thumb ++#else ++.code 32 ++#endif ++ ++.align 5 ++ENTRY(poly1305_init_arm) ++ stmdb sp!,{r4-r11} ++ ++ eor r3,r3,r3 ++ cmp r1,#0 ++ str r3,[r0,#0] @ zero hash value ++ str r3,[r0,#4] ++ str r3,[r0,#8] ++ str r3,[r0,#12] ++ str r3,[r0,#16] ++ str r3,[r0,#36] @ is_base2_26 ++ add r0,r0,#20 ++ ++#ifdef __thumb2__ ++ it eq ++#endif ++ moveq r0,#0 ++ beq .Lno_key ++ ++ ldrb r4,[r1,#0] ++ mov r10,#0x0fffffff ++ ldrb r5,[r1,#1] ++ and r3,r10,#-4 @ 0x0ffffffc ++ ldrb r6,[r1,#2] ++ ldrb r7,[r1,#3] ++ orr r4,r4,r5,lsl#8 ++ ldrb r5,[r1,#4] ++ orr r4,r4,r6,lsl#16 ++ ldrb r6,[r1,#5] ++ orr r4,r4,r7,lsl#24 ++ ldrb r7,[r1,#6] ++ and r4,r4,r10 ++ ++ ldrb r8,[r1,#7] ++ orr r5,r5,r6,lsl#8 ++ ldrb r6,[r1,#8] ++ orr r5,r5,r7,lsl#16 ++ ldrb r7,[r1,#9] ++ orr r5,r5,r8,lsl#24 ++ ldrb r8,[r1,#10] ++ and r5,r5,r3 ++ ++ ldrb r9,[r1,#11] ++ orr r6,r6,r7,lsl#8 ++ ldrb r7,[r1,#12] ++ orr r6,r6,r8,lsl#16 ++ ldrb r8,[r1,#13] ++ orr r6,r6,r9,lsl#24 ++ ldrb r9,[r1,#14] ++ and r6,r6,r3 ++ ++ ldrb r10,[r1,#15] ++ orr r7,r7,r8,lsl#8 ++ str r4,[r0,#0] ++ orr r7,r7,r9,lsl#16 ++ str r5,[r0,#4] ++ orr r7,r7,r10,lsl#24 ++ str r6,[r0,#8] ++ and r7,r7,r3 ++ str r7,[r0,#12] ++.Lno_key: ++ ldmia sp!,{r4-r11} ++#if __LINUX_ARM_ARCH__ >= 5 ++ bx lr @ bx lr ++#else ++ tst lr,#1 ++ moveq pc,lr @ be binary compatible with V4, yet ++ .word 0xe12fff1e @ interoperable with Thumb ISA:-) ++#endif ++ENDPROC(poly1305_init_arm) ++ ++.align 5 ++ENTRY(poly1305_blocks_arm) ++.Lpoly1305_blocks_arm: ++ stmdb sp!,{r3-r11,lr} ++ ++ ands r2,r2,#-16 ++ beq .Lno_data ++ ++ cmp r3,#0 ++ add r2,r2,r1 @ end pointer ++ sub sp,sp,#32 ++ ++ ldmia r0,{r4-r12} @ load context ++ ++ str r0,[sp,#12] @ offload stuff ++ mov lr,r1 ++ str r2,[sp,#16] ++ str r10,[sp,#20] ++ str r11,[sp,#24] ++ str r12,[sp,#28] ++ b .Loop ++ ++.Loop: ++#if __LINUX_ARM_ARCH__ < 7 ++ ldrb r0,[lr],#16 @ load input ++#ifdef __thumb2__ ++ it hi ++#endif ++ addhi r8,r8,#1 @ 1<<128 ++ ldrb r1,[lr,#-15] ++ ldrb r2,[lr,#-14] ++ ldrb r3,[lr,#-13] ++ orr r1,r0,r1,lsl#8 ++ ldrb r0,[lr,#-12] ++ orr r2,r1,r2,lsl#16 ++ ldrb r1,[lr,#-11] ++ orr r3,r2,r3,lsl#24 ++ ldrb r2,[lr,#-10] ++ adds r4,r4,r3 @ accumulate input ++ ++ ldrb r3,[lr,#-9] ++ orr r1,r0,r1,lsl#8 ++ ldrb r0,[lr,#-8] ++ orr r2,r1,r2,lsl#16 ++ ldrb r1,[lr,#-7] ++ orr r3,r2,r3,lsl#24 ++ ldrb r2,[lr,#-6] ++ adcs r5,r5,r3 ++ ++ ldrb r3,[lr,#-5] ++ orr r1,r0,r1,lsl#8 ++ ldrb r0,[lr,#-4] ++ orr r2,r1,r2,lsl#16 ++ ldrb r1,[lr,#-3] ++ orr r3,r2,r3,lsl#24 ++ ldrb r2,[lr,#-2] ++ adcs r6,r6,r3 ++ ++ ldrb r3,[lr,#-1] ++ orr r1,r0,r1,lsl#8 ++ str lr,[sp,#8] @ offload input pointer ++ orr r2,r1,r2,lsl#16 ++ add r10,r10,r10,lsr#2 ++ orr r3,r2,r3,lsl#24 ++#else ++ ldr r0,[lr],#16 @ load input ++#ifdef __thumb2__ ++ it hi ++#endif ++ addhi r8,r8,#1 @ padbit ++ ldr r1,[lr,#-12] ++ ldr r2,[lr,#-8] ++ ldr r3,[lr,#-4] ++#ifdef __ARMEB__ ++ rev r0,r0 ++ rev r1,r1 ++ rev r2,r2 ++ rev r3,r3 ++#endif ++ adds r4,r4,r0 @ accumulate input ++ str lr,[sp,#8] @ offload input pointer ++ adcs r5,r5,r1 ++ add r10,r10,r10,lsr#2 ++ adcs r6,r6,r2 ++#endif ++ add r11,r11,r11,lsr#2 ++ adcs r7,r7,r3 ++ add r12,r12,r12,lsr#2 ++ ++ umull r2,r3,r5,r9 ++ adc r8,r8,#0 ++ umull r0,r1,r4,r9 ++ umlal r2,r3,r8,r10 ++ umlal r0,r1,r7,r10 ++ ldr r10,[sp,#20] @ reload r10 ++ umlal r2,r3,r6,r12 ++ umlal r0,r1,r5,r12 ++ umlal r2,r3,r7,r11 ++ umlal r0,r1,r6,r11 ++ umlal r2,r3,r4,r10 ++ str r0,[sp,#0] @ future r4 ++ mul r0,r11,r8 ++ ldr r11,[sp,#24] @ reload r11 ++ adds r2,r2,r1 @ d1+=d0>>32 ++ eor r1,r1,r1 ++ adc lr,r3,#0 @ future r6 ++ str r2,[sp,#4] @ future r5 ++ ++ mul r2,r12,r8 ++ eor r3,r3,r3 ++ umlal r0,r1,r7,r12 ++ ldr r12,[sp,#28] @ reload r12 ++ umlal r2,r3,r7,r9 ++ umlal r0,r1,r6,r9 ++ umlal r2,r3,r6,r10 ++ umlal r0,r1,r5,r10 ++ umlal r2,r3,r5,r11 ++ umlal r0,r1,r4,r11 ++ umlal r2,r3,r4,r12 ++ ldr r4,[sp,#0] ++ mul r8,r9,r8 ++ ldr r5,[sp,#4] ++ ++ adds r6,lr,r0 @ d2+=d1>>32 ++ ldr lr,[sp,#8] @ reload input pointer ++ adc r1,r1,#0 ++ adds r7,r2,r1 @ d3+=d2>>32 ++ ldr r0,[sp,#16] @ reload end pointer ++ adc r3,r3,#0 ++ add r8,r8,r3 @ h4+=d3>>32 ++ ++ and r1,r8,#-4 ++ and r8,r8,#3 ++ add r1,r1,r1,lsr#2 @ *=5 ++ adds r4,r4,r1 ++ adcs r5,r5,#0 ++ adcs r6,r6,#0 ++ adcs r7,r7,#0 ++ adc r8,r8,#0 ++ ++ cmp r0,lr @ done yet? ++ bhi .Loop ++ ++ ldr r0,[sp,#12] ++ add sp,sp,#32 ++ stmia r0,{r4-r8} @ store the result ++ ++.Lno_data: ++#if __LINUX_ARM_ARCH__ >= 5 ++ ldmia sp!,{r3-r11,pc} ++#else ++ ldmia sp!,{r3-r11,lr} ++ tst lr,#1 ++ moveq pc,lr @ be binary compatible with V4, yet ++ .word 0xe12fff1e @ interoperable with Thumb ISA:-) ++#endif ++ENDPROC(poly1305_blocks_arm) ++ ++.align 5 ++ENTRY(poly1305_emit_arm) ++ stmdb sp!,{r4-r11} ++.Lpoly1305_emit_enter: ++ ldmia r0,{r3-r7} ++ adds r8,r3,#5 @ compare to modulus ++ adcs r9,r4,#0 ++ adcs r10,r5,#0 ++ adcs r11,r6,#0 ++ adc r7,r7,#0 ++ tst r7,#4 @ did it carry/borrow? ++ ++#ifdef __thumb2__ ++ it ne ++#endif ++ movne r3,r8 ++ ldr r8,[r2,#0] ++#ifdef __thumb2__ ++ it ne ++#endif ++ movne r4,r9 ++ ldr r9,[r2,#4] ++#ifdef __thumb2__ ++ it ne ++#endif ++ movne r5,r10 ++ ldr r10,[r2,#8] ++#ifdef __thumb2__ ++ it ne ++#endif ++ movne r6,r11 ++ ldr r11,[r2,#12] ++ ++ adds r3,r3,r8 ++ adcs r4,r4,r9 ++ adcs r5,r5,r10 ++ adc r6,r6,r11 ++ ++#if __LINUX_ARM_ARCH__ >= 7 ++#ifdef __ARMEB__ ++ rev r3,r3 ++ rev r4,r4 ++ rev r5,r5 ++ rev r6,r6 ++#endif ++ str r3,[r1,#0] ++ str r4,[r1,#4] ++ str r5,[r1,#8] ++ str r6,[r1,#12] ++#else ++ strb r3,[r1,#0] ++ mov r3,r3,lsr#8 ++ strb r4,[r1,#4] ++ mov r4,r4,lsr#8 ++ strb r5,[r1,#8] ++ mov r5,r5,lsr#8 ++ strb r6,[r1,#12] ++ mov r6,r6,lsr#8 ++ ++ strb r3,[r1,#1] ++ mov r3,r3,lsr#8 ++ strb r4,[r1,#5] ++ mov r4,r4,lsr#8 ++ strb r5,[r1,#9] ++ mov r5,r5,lsr#8 ++ strb r6,[r1,#13] ++ mov r6,r6,lsr#8 ++ ++ strb r3,[r1,#2] ++ mov r3,r3,lsr#8 ++ strb r4,[r1,#6] ++ mov r4,r4,lsr#8 ++ strb r5,[r1,#10] ++ mov r5,r5,lsr#8 ++ strb r6,[r1,#14] ++ mov r6,r6,lsr#8 ++ ++ strb r3,[r1,#3] ++ strb r4,[r1,#7] ++ strb r5,[r1,#11] ++ strb r6,[r1,#15] ++#endif ++ ldmia sp!,{r4-r11} ++#if __LINUX_ARM_ARCH__ >= 5 ++ bx lr @ bx lr ++#else ++ tst lr,#1 ++ moveq pc,lr @ be binary compatible with V4, yet ++ .word 0xe12fff1e @ interoperable with Thumb ISA:-) ++#endif ++ENDPROC(poly1305_emit_arm) ++ ++ ++#if __LINUX_ARM_ARCH__ >= 7 ++.fpu neon ++ ++.align 5 ++ENTRY(poly1305_init_neon) ++.Lpoly1305_init_neon: ++ ldr r4,[r0,#20] @ load key base 2^32 ++ ldr r5,[r0,#24] ++ ldr r6,[r0,#28] ++ ldr r7,[r0,#32] ++ ++ and r2,r4,#0x03ffffff @ base 2^32 -> base 2^26 ++ mov r3,r4,lsr#26 ++ mov r4,r5,lsr#20 ++ orr r3,r3,r5,lsl#6 ++ mov r5,r6,lsr#14 ++ orr r4,r4,r6,lsl#12 ++ mov r6,r7,lsr#8 ++ orr r5,r5,r7,lsl#18 ++ and r3,r3,#0x03ffffff ++ and r4,r4,#0x03ffffff ++ and r5,r5,#0x03ffffff ++ ++ vdup.32 d0,r2 @ r^1 in both lanes ++ add r2,r3,r3,lsl#2 @ *5 ++ vdup.32 d1,r3 ++ add r3,r4,r4,lsl#2 ++ vdup.32 d2,r2 ++ vdup.32 d3,r4 ++ add r4,r5,r5,lsl#2 ++ vdup.32 d4,r3 ++ vdup.32 d5,r5 ++ add r5,r6,r6,lsl#2 ++ vdup.32 d6,r4 ++ vdup.32 d7,r6 ++ vdup.32 d8,r5 ++ ++ mov r5,#2 @ counter ++ ++.Lsquare_neon: ++ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ++ @ d0 = h0*r0 + h4*5*r1 + h3*5*r2 + h2*5*r3 + h1*5*r4 ++ @ d1 = h1*r0 + h0*r1 + h4*5*r2 + h3*5*r3 + h2*5*r4 ++ @ d2 = h2*r0 + h1*r1 + h0*r2 + h4*5*r3 + h3*5*r4 ++ @ d3 = h3*r0 + h2*r1 + h1*r2 + h0*r3 + h4*5*r4 ++ @ d4 = h4*r0 + h3*r1 + h2*r2 + h1*r3 + h0*r4 ++ ++ vmull.u32 q5,d0,d0[1] ++ vmull.u32 q6,d1,d0[1] ++ vmull.u32 q7,d3,d0[1] ++ vmull.u32 q8,d5,d0[1] ++ vmull.u32 q9,d7,d0[1] ++ ++ vmlal.u32 q5,d7,d2[1] ++ vmlal.u32 q6,d0,d1[1] ++ vmlal.u32 q7,d1,d1[1] ++ vmlal.u32 q8,d3,d1[1] ++ vmlal.u32 q9,d5,d1[1] ++ ++ vmlal.u32 q5,d5,d4[1] ++ vmlal.u32 q6,d7,d4[1] ++ vmlal.u32 q8,d1,d3[1] ++ vmlal.u32 q7,d0,d3[1] ++ vmlal.u32 q9,d3,d3[1] ++ ++ vmlal.u32 q5,d3,d6[1] ++ vmlal.u32 q8,d0,d5[1] ++ vmlal.u32 q6,d5,d6[1] ++ vmlal.u32 q7,d7,d6[1] ++ vmlal.u32 q9,d1,d5[1] ++ ++ vmlal.u32 q8,d7,d8[1] ++ vmlal.u32 q5,d1,d8[1] ++ vmlal.u32 q6,d3,d8[1] ++ vmlal.u32 q7,d5,d8[1] ++ vmlal.u32 q9,d0,d7[1] ++ ++ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ++ @ lazy reduction as discussed in "NEON crypto" by D.J. Bernstein ++ @ and P. Schwabe ++ @ ++ @ H0>>+H1>>+H2>>+H3>>+H4 ++ @ H3>>+H4>>*5+H0>>+H1 ++ @ ++ @ Trivia. ++ @ ++ @ Result of multiplication of n-bit number by m-bit number is ++ @ n+m bits wide. However! Even though 2^n is a n+1-bit number, ++ @ m-bit number multiplied by 2^n is still n+m bits wide. ++ @ ++ @ Sum of two n-bit numbers is n+1 bits wide, sum of three - n+2, ++ @ and so is sum of four. Sum of 2^m n-m-bit numbers and n-bit ++ @ one is n+1 bits wide. ++ @ ++ @ >>+ denotes Hnext += Hn>>26, Hn &= 0x3ffffff. This means that ++ @ H0, H2, H3 are guaranteed to be 26 bits wide, while H1 and H4 ++ @ can be 27. However! In cases when their width exceeds 26 bits ++ @ they are limited by 2^26+2^6. This in turn means that *sum* ++ @ of the products with these values can still be viewed as sum ++ @ of 52-bit numbers as long as the amount of addends is not a ++ @ power of 2. For example, ++ @ ++ @ H4 = H4*R0 + H3*R1 + H2*R2 + H1*R3 + H0 * R4, ++ @ ++ @ which can't be larger than 5 * (2^26 + 2^6) * (2^26 + 2^6), or ++ @ 5 * (2^52 + 2*2^32 + 2^12), which in turn is smaller than ++ @ 8 * (2^52) or 2^55. However, the value is then multiplied by ++ @ by 5, so we should be looking at 5 * 5 * (2^52 + 2^33 + 2^12), ++ @ which is less than 32 * (2^52) or 2^57. And when processing ++ @ data we are looking at triple as many addends... ++ @ ++ @ In key setup procedure pre-reduced H0 is limited by 5*4+1 and ++ @ 5*H4 - by 5*5 52-bit addends, or 57 bits. But when hashing the ++ @ input H0 is limited by (5*4+1)*3 addends, or 58 bits, while ++ @ 5*H4 by 5*5*3, or 59[!] bits. How is this relevant? vmlal.u32 ++ @ instruction accepts 2x32-bit input and writes 2x64-bit result. ++ @ This means that result of reduction have to be compressed upon ++ @ loop wrap-around. This can be done in the process of reduction ++ @ to minimize amount of instructions [as well as amount of ++ @ 128-bit instructions, which benefits low-end processors], but ++ @ one has to watch for H2 (which is narrower than H0) and 5*H4 ++ @ not being wider than 58 bits, so that result of right shift ++ @ by 26 bits fits in 32 bits. This is also useful on x86, ++ @ because it allows to use paddd in place for paddq, which ++ @ benefits Atom, where paddq is ridiculously slow. ++ ++ vshr.u64 q15,q8,#26 ++ vmovn.i64 d16,q8 ++ vshr.u64 q4,q5,#26 ++ vmovn.i64 d10,q5 ++ vadd.i64 q9,q9,q15 @ h3 -> h4 ++ vbic.i32 d16,#0xfc000000 @ &=0x03ffffff ++ vadd.i64 q6,q6,q4 @ h0 -> h1 ++ vbic.i32 d10,#0xfc000000 ++ ++ vshrn.u64 d30,q9,#26 ++ vmovn.i64 d18,q9 ++ vshr.u64 q4,q6,#26 ++ vmovn.i64 d12,q6 ++ vadd.i64 q7,q7,q4 @ h1 -> h2 ++ vbic.i32 d18,#0xfc000000 ++ vbic.i32 d12,#0xfc000000 ++ ++ vadd.i32 d10,d10,d30 ++ vshl.u32 d30,d30,#2 ++ vshrn.u64 d8,q7,#26 ++ vmovn.i64 d14,q7 ++ vadd.i32 d10,d10,d30 @ h4 -> h0 ++ vadd.i32 d16,d16,d8 @ h2 -> h3 ++ vbic.i32 d14,#0xfc000000 ++ ++ vshr.u32 d30,d10,#26 ++ vbic.i32 d10,#0xfc000000 ++ vshr.u32 d8,d16,#26 ++ vbic.i32 d16,#0xfc000000 ++ vadd.i32 d12,d12,d30 @ h0 -> h1 ++ vadd.i32 d18,d18,d8 @ h3 -> h4 ++ ++ subs r5,r5,#1 ++ beq .Lsquare_break_neon ++ ++ add r6,r0,#(48+0*9*4) ++ add r7,r0,#(48+1*9*4) ++ ++ vtrn.32 d0,d10 @ r^2:r^1 ++ vtrn.32 d3,d14 ++ vtrn.32 d5,d16 ++ vtrn.32 d1,d12 ++ vtrn.32 d7,d18 ++ ++ vshl.u32 d4,d3,#2 @ *5 ++ vshl.u32 d6,d5,#2 ++ vshl.u32 d2,d1,#2 ++ vshl.u32 d8,d7,#2 ++ vadd.i32 d4,d4,d3 ++ vadd.i32 d2,d2,d1 ++ vadd.i32 d6,d6,d5 ++ vadd.i32 d8,d8,d7 ++ ++ vst4.32 {d0[0],d1[0],d2[0],d3[0]},[r6]! ++ vst4.32 {d0[1],d1[1],d2[1],d3[1]},[r7]! ++ vst4.32 {d4[0],d5[0],d6[0],d7[0]},[r6]! ++ vst4.32 {d4[1],d5[1],d6[1],d7[1]},[r7]! ++ vst1.32 {d8[0]},[r6,:32] ++ vst1.32 {d8[1]},[r7,:32] ++ ++ b .Lsquare_neon ++ ++.align 4 ++.Lsquare_break_neon: ++ add r6,r0,#(48+2*4*9) ++ add r7,r0,#(48+3*4*9) ++ ++ vmov d0,d10 @ r^4:r^3 ++ vshl.u32 d2,d12,#2 @ *5 ++ vmov d1,d12 ++ vshl.u32 d4,d14,#2 ++ vmov d3,d14 ++ vshl.u32 d6,d16,#2 ++ vmov d5,d16 ++ vshl.u32 d8,d18,#2 ++ vmov d7,d18 ++ vadd.i32 d2,d2,d12 ++ vadd.i32 d4,d4,d14 ++ vadd.i32 d6,d6,d16 ++ vadd.i32 d8,d8,d18 ++ ++ vst4.32 {d0[0],d1[0],d2[0],d3[0]},[r6]! ++ vst4.32 {d0[1],d1[1],d2[1],d3[1]},[r7]! ++ vst4.32 {d4[0],d5[0],d6[0],d7[0]},[r6]! ++ vst4.32 {d4[1],d5[1],d6[1],d7[1]},[r7]! ++ vst1.32 {d8[0]},[r6] ++ vst1.32 {d8[1]},[r7] ++ ++ bx lr @ bx lr ++ENDPROC(poly1305_init_neon) ++ ++.align 5 ++ENTRY(poly1305_blocks_neon) ++ ldr ip,[r0,#36] @ is_base2_26 ++ ands r2,r2,#-16 ++ beq .Lno_data_neon ++ ++ cmp r2,#64 ++ bhs .Lenter_neon ++ tst ip,ip @ is_base2_26? ++ beq .Lpoly1305_blocks_arm ++ ++.Lenter_neon: ++ stmdb sp!,{r4-r7} ++ vstmdb sp!,{d8-d15} @ ABI specification says so ++ ++ tst ip,ip @ is_base2_26? ++ bne .Lbase2_26_neon ++ ++ stmdb sp!,{r1-r3,lr} ++ bl .Lpoly1305_init_neon ++ ++ ldr r4,[r0,#0] @ load hash value base 2^32 ++ ldr r5,[r0,#4] ++ ldr r6,[r0,#8] ++ ldr r7,[r0,#12] ++ ldr ip,[r0,#16] ++ ++ and r2,r4,#0x03ffffff @ base 2^32 -> base 2^26 ++ mov r3,r4,lsr#26 ++ veor d10,d10,d10 ++ mov r4,r5,lsr#20 ++ orr r3,r3,r5,lsl#6 ++ veor d12,d12,d12 ++ mov r5,r6,lsr#14 ++ orr r4,r4,r6,lsl#12 ++ veor d14,d14,d14 ++ mov r6,r7,lsr#8 ++ orr r5,r5,r7,lsl#18 ++ veor d16,d16,d16 ++ and r3,r3,#0x03ffffff ++ orr r6,r6,ip,lsl#24 ++ veor d18,d18,d18 ++ and r4,r4,#0x03ffffff ++ mov r1,#1 ++ and r5,r5,#0x03ffffff ++ str r1,[r0,#36] @ is_base2_26 ++ ++ vmov.32 d10[0],r2 ++ vmov.32 d12[0],r3 ++ vmov.32 d14[0],r4 ++ vmov.32 d16[0],r5 ++ vmov.32 d18[0],r6 ++ adr r5,.Lzeros ++ ++ ldmia sp!,{r1-r3,lr} ++ b .Lbase2_32_neon ++ ++.align 4 ++.Lbase2_26_neon: ++ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ++ @ load hash value ++ ++ veor d10,d10,d10 ++ veor d12,d12,d12 ++ veor d14,d14,d14 ++ veor d16,d16,d16 ++ veor d18,d18,d18 ++ vld4.32 {d10[0],d12[0],d14[0],d16[0]},[r0]! ++ adr r5,.Lzeros ++ vld1.32 {d18[0]},[r0] ++ sub r0,r0,#16 @ rewind ++ ++.Lbase2_32_neon: ++ add r4,r1,#32 ++ mov r3,r3,lsl#24 ++ tst r2,#31 ++ beq .Leven ++ ++ vld4.32 {d20[0],d22[0],d24[0],d26[0]},[r1]! ++ vmov.32 d28[0],r3 ++ sub r2,r2,#16 ++ add r4,r1,#32 ++ ++#ifdef __ARMEB__ ++ vrev32.8 q10,q10 ++ vrev32.8 q13,q13 ++ vrev32.8 q11,q11 ++ vrev32.8 q12,q12 ++#endif ++ vsri.u32 d28,d26,#8 @ base 2^32 -> base 2^26 ++ vshl.u32 d26,d26,#18 ++ ++ vsri.u32 d26,d24,#14 ++ vshl.u32 d24,d24,#12 ++ vadd.i32 d29,d28,d18 @ add hash value and move to #hi ++ ++ vbic.i32 d26,#0xfc000000 ++ vsri.u32 d24,d22,#20 ++ vshl.u32 d22,d22,#6 ++ ++ vbic.i32 d24,#0xfc000000 ++ vsri.u32 d22,d20,#26 ++ vadd.i32 d27,d26,d16 ++ ++ vbic.i32 d20,#0xfc000000 ++ vbic.i32 d22,#0xfc000000 ++ vadd.i32 d25,d24,d14 ++ ++ vadd.i32 d21,d20,d10 ++ vadd.i32 d23,d22,d12 ++ ++ mov r7,r5 ++ add r6,r0,#48 ++ ++ cmp r2,r2 ++ b .Long_tail ++ ++.align 4 ++.Leven: ++ subs r2,r2,#64 ++ it lo ++ movlo r4,r5 ++ ++ vmov.i32 q14,#1<<24 @ padbit, yes, always ++ vld4.32 {d20,d22,d24,d26},[r1] @ inp[0:1] ++ add r1,r1,#64 ++ vld4.32 {d21,d23,d25,d27},[r4] @ inp[2:3] (or 0) ++ add r4,r4,#64 ++ itt hi ++ addhi r7,r0,#(48+1*9*4) ++ addhi r6,r0,#(48+3*9*4) ++ ++#ifdef __ARMEB__ ++ vrev32.8 q10,q10 ++ vrev32.8 q13,q13 ++ vrev32.8 q11,q11 ++ vrev32.8 q12,q12 ++#endif ++ vsri.u32 q14,q13,#8 @ base 2^32 -> base 2^26 ++ vshl.u32 q13,q13,#18 ++ ++ vsri.u32 q13,q12,#14 ++ vshl.u32 q12,q12,#12 ++ ++ vbic.i32 q13,#0xfc000000 ++ vsri.u32 q12,q11,#20 ++ vshl.u32 q11,q11,#6 ++ ++ vbic.i32 q12,#0xfc000000 ++ vsri.u32 q11,q10,#26 ++ ++ vbic.i32 q10,#0xfc000000 ++ vbic.i32 q11,#0xfc000000 ++ ++ bls .Lskip_loop ++ ++ vld4.32 {d0[1],d1[1],d2[1],d3[1]},[r7]! @ load r^2 ++ vld4.32 {d0[0],d1[0],d2[0],d3[0]},[r6]! @ load r^4 ++ vld4.32 {d4[1],d5[1],d6[1],d7[1]},[r7]! ++ vld4.32 {d4[0],d5[0],d6[0],d7[0]},[r6]! ++ b .Loop_neon ++ ++.align 5 ++.Loop_neon: ++ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ++ @ ((inp[0]*r^4+inp[2]*r^2+inp[4])*r^4+inp[6]*r^2 ++ @ ((inp[1]*r^4+inp[3]*r^2+inp[5])*r^3+inp[7]*r ++ @ ___________________/ ++ @ ((inp[0]*r^4+inp[2]*r^2+inp[4])*r^4+inp[6]*r^2+inp[8])*r^2 ++ @ ((inp[1]*r^4+inp[3]*r^2+inp[5])*r^4+inp[7]*r^2+inp[9])*r ++ @ ___________________/ ____________________/ ++ @ ++ @ Note that we start with inp[2:3]*r^2. This is because it ++ @ doesn't depend on reduction in previous iteration. ++ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ++ @ d4 = h4*r0 + h3*r1 + h2*r2 + h1*r3 + h0*r4 ++ @ d3 = h3*r0 + h2*r1 + h1*r2 + h0*r3 + h4*5*r4 ++ @ d2 = h2*r0 + h1*r1 + h0*r2 + h4*5*r3 + h3*5*r4 ++ @ d1 = h1*r0 + h0*r1 + h4*5*r2 + h3*5*r3 + h2*5*r4 ++ @ d0 = h0*r0 + h4*5*r1 + h3*5*r2 + h2*5*r3 + h1*5*r4 ++ ++ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ++ @ inp[2:3]*r^2 ++ ++ vadd.i32 d24,d24,d14 @ accumulate inp[0:1] ++ vmull.u32 q7,d25,d0[1] ++ vadd.i32 d20,d20,d10 ++ vmull.u32 q5,d21,d0[1] ++ vadd.i32 d26,d26,d16 ++ vmull.u32 q8,d27,d0[1] ++ vmlal.u32 q7,d23,d1[1] ++ vadd.i32 d22,d22,d12 ++ vmull.u32 q6,d23,d0[1] ++ ++ vadd.i32 d28,d28,d18 ++ vmull.u32 q9,d29,d0[1] ++ subs r2,r2,#64 ++ vmlal.u32 q5,d29,d2[1] ++ it lo ++ movlo r4,r5 ++ vmlal.u32 q8,d25,d1[1] ++ vld1.32 d8[1],[r7,:32] ++ vmlal.u32 q6,d21,d1[1] ++ vmlal.u32 q9,d27,d1[1] ++ ++ vmlal.u32 q5,d27,d4[1] ++ vmlal.u32 q8,d23,d3[1] ++ vmlal.u32 q9,d25,d3[1] ++ vmlal.u32 q6,d29,d4[1] ++ vmlal.u32 q7,d21,d3[1] ++ ++ vmlal.u32 q8,d21,d5[1] ++ vmlal.u32 q5,d25,d6[1] ++ vmlal.u32 q9,d23,d5[1] ++ vmlal.u32 q6,d27,d6[1] ++ vmlal.u32 q7,d29,d6[1] ++ ++ vmlal.u32 q8,d29,d8[1] ++ vmlal.u32 q5,d23,d8[1] ++ vmlal.u32 q9,d21,d7[1] ++ vmlal.u32 q6,d25,d8[1] ++ vmlal.u32 q7,d27,d8[1] ++ ++ vld4.32 {d21,d23,d25,d27},[r4] @ inp[2:3] (or 0) ++ add r4,r4,#64 ++ ++ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ++ @ (hash+inp[0:1])*r^4 and accumulate ++ ++ vmlal.u32 q8,d26,d0[0] ++ vmlal.u32 q5,d20,d0[0] ++ vmlal.u32 q9,d28,d0[0] ++ vmlal.u32 q6,d22,d0[0] ++ vmlal.u32 q7,d24,d0[0] ++ vld1.32 d8[0],[r6,:32] ++ ++ vmlal.u32 q8,d24,d1[0] ++ vmlal.u32 q5,d28,d2[0] ++ vmlal.u32 q9,d26,d1[0] ++ vmlal.u32 q6,d20,d1[0] ++ vmlal.u32 q7,d22,d1[0] ++ ++ vmlal.u32 q8,d22,d3[0] ++ vmlal.u32 q5,d26,d4[0] ++ vmlal.u32 q9,d24,d3[0] ++ vmlal.u32 q6,d28,d4[0] ++ vmlal.u32 q7,d20,d3[0] ++ ++ vmlal.u32 q8,d20,d5[0] ++ vmlal.u32 q5,d24,d6[0] ++ vmlal.u32 q9,d22,d5[0] ++ vmlal.u32 q6,d26,d6[0] ++ vmlal.u32 q8,d28,d8[0] ++ ++ vmlal.u32 q7,d28,d6[0] ++ vmlal.u32 q5,d22,d8[0] ++ vmlal.u32 q9,d20,d7[0] ++ vmov.i32 q14,#1<<24 @ padbit, yes, always ++ vmlal.u32 q6,d24,d8[0] ++ vmlal.u32 q7,d26,d8[0] ++ ++ vld4.32 {d20,d22,d24,d26},[r1] @ inp[0:1] ++ add r1,r1,#64 ++#ifdef __ARMEB__ ++ vrev32.8 q10,q10 ++ vrev32.8 q11,q11 ++ vrev32.8 q12,q12 ++ vrev32.8 q13,q13 ++#endif ++ ++ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ++ @ lazy reduction interleaved with base 2^32 -> base 2^26 of ++ @ inp[0:3] previously loaded to q10-q13 and smashed to q10-q14. ++ ++ vshr.u64 q15,q8,#26 ++ vmovn.i64 d16,q8 ++ vshr.u64 q4,q5,#26 ++ vmovn.i64 d10,q5 ++ vadd.i64 q9,q9,q15 @ h3 -> h4 ++ vbic.i32 d16,#0xfc000000 ++ vsri.u32 q14,q13,#8 @ base 2^32 -> base 2^26 ++ vadd.i64 q6,q6,q4 @ h0 -> h1 ++ vshl.u32 q13,q13,#18 ++ vbic.i32 d10,#0xfc000000 ++ ++ vshrn.u64 d30,q9,#26 ++ vmovn.i64 d18,q9 ++ vshr.u64 q4,q6,#26 ++ vmovn.i64 d12,q6 ++ vadd.i64 q7,q7,q4 @ h1 -> h2 ++ vsri.u32 q13,q12,#14 ++ vbic.i32 d18,#0xfc000000 ++ vshl.u32 q12,q12,#12 ++ vbic.i32 d12,#0xfc000000 ++ ++ vadd.i32 d10,d10,d30 ++ vshl.u32 d30,d30,#2 ++ vbic.i32 q13,#0xfc000000 ++ vshrn.u64 d8,q7,#26 ++ vmovn.i64 d14,q7 ++ vaddl.u32 q5,d10,d30 @ h4 -> h0 [widen for a sec] ++ vsri.u32 q12,q11,#20 ++ vadd.i32 d16,d16,d8 @ h2 -> h3 ++ vshl.u32 q11,q11,#6 ++ vbic.i32 d14,#0xfc000000 ++ vbic.i32 q12,#0xfc000000 ++ ++ vshrn.u64 d30,q5,#26 @ re-narrow ++ vmovn.i64 d10,q5 ++ vsri.u32 q11,q10,#26 ++ vbic.i32 q10,#0xfc000000 ++ vshr.u32 d8,d16,#26 ++ vbic.i32 d16,#0xfc000000 ++ vbic.i32 d10,#0xfc000000 ++ vadd.i32 d12,d12,d30 @ h0 -> h1 ++ vadd.i32 d18,d18,d8 @ h3 -> h4 ++ vbic.i32 q11,#0xfc000000 ++ ++ bhi .Loop_neon ++ ++.Lskip_loop: ++ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ++ @ multiply (inp[0:1]+hash) or inp[2:3] by r^2:r^1 ++ ++ add r7,r0,#(48+0*9*4) ++ add r6,r0,#(48+1*9*4) ++ adds r2,r2,#32 ++ it ne ++ movne r2,#0 ++ bne .Long_tail ++ ++ vadd.i32 d25,d24,d14 @ add hash value and move to #hi ++ vadd.i32 d21,d20,d10 ++ vadd.i32 d27,d26,d16 ++ vadd.i32 d23,d22,d12 ++ vadd.i32 d29,d28,d18 ++ ++.Long_tail: ++ vld4.32 {d0[1],d1[1],d2[1],d3[1]},[r7]! @ load r^1 ++ vld4.32 {d0[0],d1[0],d2[0],d3[0]},[r6]! @ load r^2 ++ ++ vadd.i32 d24,d24,d14 @ can be redundant ++ vmull.u32 q7,d25,d0 ++ vadd.i32 d20,d20,d10 ++ vmull.u32 q5,d21,d0 ++ vadd.i32 d26,d26,d16 ++ vmull.u32 q8,d27,d0 ++ vadd.i32 d22,d22,d12 ++ vmull.u32 q6,d23,d0 ++ vadd.i32 d28,d28,d18 ++ vmull.u32 q9,d29,d0 ++ ++ vmlal.u32 q5,d29,d2 ++ vld4.32 {d4[1],d5[1],d6[1],d7[1]},[r7]! ++ vmlal.u32 q8,d25,d1 ++ vld4.32 {d4[0],d5[0],d6[0],d7[0]},[r6]! ++ vmlal.u32 q6,d21,d1 ++ vmlal.u32 q9,d27,d1 ++ vmlal.u32 q7,d23,d1 ++ ++ vmlal.u32 q8,d23,d3 ++ vld1.32 d8[1],[r7,:32] ++ vmlal.u32 q5,d27,d4 ++ vld1.32 d8[0],[r6,:32] ++ vmlal.u32 q9,d25,d3 ++ vmlal.u32 q6,d29,d4 ++ vmlal.u32 q7,d21,d3 ++ ++ vmlal.u32 q8,d21,d5 ++ it ne ++ addne r7,r0,#(48+2*9*4) ++ vmlal.u32 q5,d25,d6 ++ it ne ++ addne r6,r0,#(48+3*9*4) ++ vmlal.u32 q9,d23,d5 ++ vmlal.u32 q6,d27,d6 ++ vmlal.u32 q7,d29,d6 ++ ++ vmlal.u32 q8,d29,d8 ++ vorn q0,q0,q0 @ all-ones, can be redundant ++ vmlal.u32 q5,d23,d8 ++ vshr.u64 q0,q0,#38 ++ vmlal.u32 q9,d21,d7 ++ vmlal.u32 q6,d25,d8 ++ vmlal.u32 q7,d27,d8 ++ ++ beq .Lshort_tail ++ ++ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ++ @ (hash+inp[0:1])*r^4:r^3 and accumulate ++ ++ vld4.32 {d0[1],d1[1],d2[1],d3[1]},[r7]! @ load r^3 ++ vld4.32 {d0[0],d1[0],d2[0],d3[0]},[r6]! @ load r^4 ++ ++ vmlal.u32 q7,d24,d0 ++ vmlal.u32 q5,d20,d0 ++ vmlal.u32 q8,d26,d0 ++ vmlal.u32 q6,d22,d0 ++ vmlal.u32 q9,d28,d0 ++ ++ vmlal.u32 q5,d28,d2 ++ vld4.32 {d4[1],d5[1],d6[1],d7[1]},[r7]! ++ vmlal.u32 q8,d24,d1 ++ vld4.32 {d4[0],d5[0],d6[0],d7[0]},[r6]! ++ vmlal.u32 q6,d20,d1 ++ vmlal.u32 q9,d26,d1 ++ vmlal.u32 q7,d22,d1 ++ ++ vmlal.u32 q8,d22,d3 ++ vld1.32 d8[1],[r7,:32] ++ vmlal.u32 q5,d26,d4 ++ vld1.32 d8[0],[r6,:32] ++ vmlal.u32 q9,d24,d3 ++ vmlal.u32 q6,d28,d4 ++ vmlal.u32 q7,d20,d3 ++ ++ vmlal.u32 q8,d20,d5 ++ vmlal.u32 q5,d24,d6 ++ vmlal.u32 q9,d22,d5 ++ vmlal.u32 q6,d26,d6 ++ vmlal.u32 q7,d28,d6 ++ ++ vmlal.u32 q8,d28,d8 ++ vorn q0,q0,q0 @ all-ones ++ vmlal.u32 q5,d22,d8 ++ vshr.u64 q0,q0,#38 ++ vmlal.u32 q9,d20,d7 ++ vmlal.u32 q6,d24,d8 ++ vmlal.u32 q7,d26,d8 ++ ++.Lshort_tail: ++ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ++ @ horizontal addition ++ ++ vadd.i64 d16,d16,d17 ++ vadd.i64 d10,d10,d11 ++ vadd.i64 d18,d18,d19 ++ vadd.i64 d12,d12,d13 ++ vadd.i64 d14,d14,d15 ++ ++ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ++ @ lazy reduction, but without narrowing ++ ++ vshr.u64 q15,q8,#26 ++ vand.i64 q8,q8,q0 ++ vshr.u64 q4,q5,#26 ++ vand.i64 q5,q5,q0 ++ vadd.i64 q9,q9,q15 @ h3 -> h4 ++ vadd.i64 q6,q6,q4 @ h0 -> h1 ++ ++ vshr.u64 q15,q9,#26 ++ vand.i64 q9,q9,q0 ++ vshr.u64 q4,q6,#26 ++ vand.i64 q6,q6,q0 ++ vadd.i64 q7,q7,q4 @ h1 -> h2 ++ ++ vadd.i64 q5,q5,q15 ++ vshl.u64 q15,q15,#2 ++ vshr.u64 q4,q7,#26 ++ vand.i64 q7,q7,q0 ++ vadd.i64 q5,q5,q15 @ h4 -> h0 ++ vadd.i64 q8,q8,q4 @ h2 -> h3 ++ ++ vshr.u64 q15,q5,#26 ++ vand.i64 q5,q5,q0 ++ vshr.u64 q4,q8,#26 ++ vand.i64 q8,q8,q0 ++ vadd.i64 q6,q6,q15 @ h0 -> h1 ++ vadd.i64 q9,q9,q4 @ h3 -> h4 ++ ++ cmp r2,#0 ++ bne .Leven ++ ++ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ++ @ store hash value ++ ++ vst4.32 {d10[0],d12[0],d14[0],d16[0]},[r0]! ++ vst1.32 {d18[0]},[r0] ++ ++ vldmia sp!,{d8-d15} @ epilogue ++ ldmia sp!,{r4-r7} ++.Lno_data_neon: ++ bx lr @ bx lr ++ENDPROC(poly1305_blocks_neon) ++ ++.align 5 ++ENTRY(poly1305_emit_neon) ++ ldr ip,[r0,#36] @ is_base2_26 ++ ++ stmdb sp!,{r4-r11} ++ ++ tst ip,ip ++ beq .Lpoly1305_emit_enter ++ ++ ldmia r0,{r3-r7} ++ eor r8,r8,r8 ++ ++ adds r3,r3,r4,lsl#26 @ base 2^26 -> base 2^32 ++ mov r4,r4,lsr#6 ++ adcs r4,r4,r5,lsl#20 ++ mov r5,r5,lsr#12 ++ adcs r5,r5,r6,lsl#14 ++ mov r6,r6,lsr#18 ++ adcs r6,r6,r7,lsl#8 ++ adc r7,r8,r7,lsr#24 @ can be partially reduced ... ++ ++ and r8,r7,#-4 @ ... so reduce ++ and r7,r6,#3 ++ add r8,r8,r8,lsr#2 @ *= 5 ++ adds r3,r3,r8 ++ adcs r4,r4,#0 ++ adcs r5,r5,#0 ++ adcs r6,r6,#0 ++ adc r7,r7,#0 ++ ++ adds r8,r3,#5 @ compare to modulus ++ adcs r9,r4,#0 ++ adcs r10,r5,#0 ++ adcs r11,r6,#0 ++ adc r7,r7,#0 ++ tst r7,#4 @ did it carry/borrow? ++ ++ it ne ++ movne r3,r8 ++ ldr r8,[r2,#0] ++ it ne ++ movne r4,r9 ++ ldr r9,[r2,#4] ++ it ne ++ movne r5,r10 ++ ldr r10,[r2,#8] ++ it ne ++ movne r6,r11 ++ ldr r11,[r2,#12] ++ ++ adds r3,r3,r8 @ accumulate nonce ++ adcs r4,r4,r9 ++ adcs r5,r5,r10 ++ adc r6,r6,r11 ++ ++#ifdef __ARMEB__ ++ rev r3,r3 ++ rev r4,r4 ++ rev r5,r5 ++ rev r6,r6 ++#endif ++ str r3,[r1,#0] @ store the result ++ str r4,[r1,#4] ++ str r5,[r1,#8] ++ str r6,[r1,#12] ++ ++ ldmia sp!,{r4-r11} ++ bx lr @ bx lr ++ENDPROC(poly1305_emit_neon) ++ ++.align 5 ++.Lzeros: ++.long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0 ++#endif +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/poly1305-mips64.S 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,357 @@ ++/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. ++ */ ++ ++#if !defined(CONFIG_64BIT) ++#error "This is only for 64-bit kernels." ++#endif ++ ++#ifdef __MIPSEB__ ++#define MSB 0 ++#define LSB 7 ++#else ++#define MSB 7 ++#define LSB 0 ++#endif ++ ++#if defined(CONFIG_CPU_MIPS64_R6) || defined(CONFIG_CPU_MIPSR6) ++#define dmultu(rs,rt) ++#define mflo(rd,rs,rt) dmulu rd,rs,rt ++#define mfhi(rd,rs,rt) dmuhu rd,rs,rt ++#else ++#define dmultu(rs,rt) dmultu rs,rt ++#define multu(rs,rt) multu rs,rt ++#define mflo(rd,rs,rt) mflo rd ++#define mfhi(rd,rs,rt) mfhi rd ++#endif ++ ++.text ++.set noat ++.set noreorder ++ ++/* While most of the assembly in the kernel prefers ENTRY() and ENDPROC(), ++ * there is no existing MIPS assembly that uses it, and MIPS assembler seems ++ * to like its own .ent/.end notation, which the MIPS include files don't ++ * provide in a MIPS-specific ENTRY/ENDPROC definition. So, we skip these ++ * for now, until somebody complains. */ ++ ++.align 5 ++.globl poly1305_init_mips ++.ent poly1305_init_mips ++poly1305_init_mips: ++ .frame $29,0,$31 ++ .set reorder ++ ++ sd $0,0($4) ++ sd $0,8($4) ++ sd $0,16($4) ++ ++ beqz $5,.Lno_key ++ ++#if defined(CONFIG_CPU_MIPS64_R6) || defined(CONFIG_CPU_MIPSR6) ++ ld $8,0($5) ++ ld $9,8($5) ++#else ++ ldl $8,0+MSB($5) ++ ldl $9,8+MSB($5) ++ ldr $8,0+LSB($5) ++ ldr $9,8+LSB($5) ++#endif ++#ifdef __MIPSEB__ ++#if defined(CONFIG_CPU_MIPS64_R2) || defined(CONFIG_CPU_MIPSR2) || defined(CONFIG_CPU_MIPS64_R6) || defined(CONFIG_CPU_MIPSR6) ++ dsbh $8,$8 # byte swap ++ dsbh $9,$9 ++ dshd $8,$8 ++ dshd $9,$9 ++#else ++ ori $10,$0,0xFF ++ dsll $1,$10,32 ++ or $10,$1 # 0x000000FF000000FF ++ ++ and $11,$8,$10 # byte swap ++ and $2,$9,$10 ++ dsrl $1,$8,24 ++ dsrl $24,$9,24 ++ dsll $11,24 ++ dsll $2,24 ++ and $1,$10 ++ and $24,$10 ++ dsll $10,8 # 0x0000FF000000FF00 ++ or $11,$1 ++ or $2,$24 ++ and $1,$8,$10 ++ and $24,$9,$10 ++ dsrl $8,8 ++ dsrl $9,8 ++ dsll $1,8 ++ dsll $24,8 ++ and $8,$10 ++ and $9,$10 ++ or $11,$1 ++ or $2,$24 ++ or $8,$11 ++ or $9,$2 ++ dsrl $11,$8,32 ++ dsrl $2,$9,32 ++ dsll $8,32 ++ dsll $9,32 ++ or $8,$11 ++ or $9,$2 ++#endif ++#endif ++ li $10,1 ++ dsll $10,32 ++ daddiu $10,-63 ++ dsll $10,28 ++ daddiu $10,-1 # 0ffffffc0fffffff ++ ++ and $8,$10 ++ daddiu $10,-3 # 0ffffffc0ffffffc ++ and $9,$10 ++ ++ sd $8,24($4) ++ dsrl $10,$9,2 ++ sd $9,32($4) ++ daddu $10,$9 # s1 = r1 + (r1 >> 2) ++ sd $10,40($4) ++ ++.Lno_key: ++ li $2,0 # return 0 ++ jr $31 ++.end poly1305_init_mips ++ ++.align 5 ++.globl poly1305_blocks_mips ++.ent poly1305_blocks_mips ++poly1305_blocks_mips: ++ .set noreorder ++ dsrl $6,4 # number of complete blocks ++ bnez $6,poly1305_blocks_internal ++ nop ++ jr $31 ++ nop ++.end poly1305_blocks_mips ++ ++.align 5 ++.ent poly1305_blocks_internal ++poly1305_blocks_internal: ++ .frame $29,6*8,$31 ++ .mask 0x00030000,-8 ++ .set noreorder ++ dsubu $29,6*8 ++ sd $17,40($29) ++ sd $16,32($29) ++ .set reorder ++ ++ ld $12,0($4) # load hash value ++ ld $13,8($4) ++ ld $14,16($4) ++ ++ ld $15,24($4) # load key ++ ld $16,32($4) ++ ld $17,40($4) ++ ++.Loop: ++#if defined(CONFIG_CPU_MIPS64_R6) || defined(CONFIG_CPU_MIPSR6) ++ ld $8,0($5) # load input ++ ld $9,8($5) ++#else ++ ldl $8,0+MSB($5) # load input ++ ldl $9,8+MSB($5) ++ ldr $8,0+LSB($5) ++ ldr $9,8+LSB($5) ++#endif ++ daddiu $6,-1 ++ daddiu $5,16 ++#ifdef __MIPSEB__ ++#if defined(CONFIG_CPU_MIPS64_R2) || defined(CONFIG_CPU_MIPSR2) || defined(CONFIG_CPU_MIPS64_R6) || defined(CONFIG_CPU_MIPSR6) ++ dsbh $8,$8 # byte swap ++ dsbh $9,$9 ++ dshd $8,$8 ++ dshd $9,$9 ++#else ++ ori $10,$0,0xFF ++ dsll $1,$10,32 ++ or $10,$1 # 0x000000FF000000FF ++ ++ and $11,$8,$10 # byte swap ++ and $2,$9,$10 ++ dsrl $1,$8,24 ++ dsrl $24,$9,24 ++ dsll $11,24 ++ dsll $2,24 ++ and $1,$10 ++ and $24,$10 ++ dsll $10,8 # 0x0000FF000000FF00 ++ or $11,$1 ++ or $2,$24 ++ and $1,$8,$10 ++ and $24,$9,$10 ++ dsrl $8,8 ++ dsrl $9,8 ++ dsll $1,8 ++ dsll $24,8 ++ and $8,$10 ++ and $9,$10 ++ or $11,$1 ++ or $2,$24 ++ or $8,$11 ++ or $9,$2 ++ dsrl $11,$8,32 ++ dsrl $2,$9,32 ++ dsll $8,32 ++ dsll $9,32 ++ or $8,$11 ++ or $9,$2 ++#endif ++#endif ++ daddu $12,$8 # accumulate input ++ daddu $13,$9 ++ sltu $10,$12,$8 ++ sltu $11,$13,$9 ++ daddu $13,$10 ++ ++ dmultu ($15,$12) # h0*r0 ++ daddu $14,$7 ++ sltu $10,$13,$10 ++ mflo ($8,$15,$12) ++ mfhi ($9,$15,$12) ++ ++ dmultu ($17,$13) # h1*5*r1 ++ daddu $10,$11 ++ daddu $14,$10 ++ mflo ($10,$17,$13) ++ mfhi ($11,$17,$13) ++ ++ dmultu ($16,$12) # h0*r1 ++ daddu $8,$10 ++ daddu $9,$11 ++ mflo ($1,$16,$12) ++ mfhi ($25,$16,$12) ++ sltu $10,$8,$10 ++ daddu $9,$10 ++ ++ dmultu ($15,$13) # h1*r0 ++ daddu $9,$1 ++ sltu $1,$9,$1 ++ mflo ($10,$15,$13) ++ mfhi ($11,$15,$13) ++ daddu $25,$1 ++ ++ dmultu ($17,$14) # h2*5*r1 ++ daddu $9,$10 ++ daddu $25,$11 ++ mflo ($1,$17,$14) ++ ++ dmultu ($15,$14) # h2*r0 ++ sltu $10,$9,$10 ++ daddu $25,$10 ++ mflo ($2,$15,$14) ++ ++ daddu $9,$1 ++ daddu $25,$2 ++ sltu $1,$9,$1 ++ daddu $25,$1 ++ ++ li $10,-4 # final reduction ++ and $10,$25 ++ dsrl $11,$25,2 ++ andi $14,$25,3 ++ daddu $10,$11 ++ daddu $12,$8,$10 ++ sltu $10,$12,$10 ++ daddu $13,$9,$10 ++ sltu $10,$13,$10 ++ daddu $14,$14,$10 ++ ++ bnez $6,.Loop ++ ++ sd $12,0($4) # store hash value ++ sd $13,8($4) ++ sd $14,16($4) ++ ++ .set noreorder ++ ld $17,40($29) # epilogue ++ ld $16,32($29) ++ jr $31 ++ daddu $29,6*8 ++.end poly1305_blocks_internal ++ ++.align 5 ++.globl poly1305_emit_mips ++.ent poly1305_emit_mips ++poly1305_emit_mips: ++ .frame $29,0,$31 ++ .set reorder ++ ++ ld $10,0($4) ++ ld $11,8($4) ++ ld $1,16($4) ++ ++ daddiu $8,$10,5 # compare to modulus ++ sltiu $2,$8,5 ++ daddu $9,$11,$2 ++ sltu $2,$9,$2 ++ daddu $1,$1,$2 ++ ++ dsrl $1,2 # see if it carried/borrowed ++ dsubu $1,$0,$1 ++ nor $2,$0,$1 ++ ++ and $8,$1 ++ and $10,$2 ++ and $9,$1 ++ and $11,$2 ++ or $8,$10 ++ or $9,$11 ++ ++ lwu $10,0($6) # load nonce ++ lwu $11,4($6) ++ lwu $1,8($6) ++ lwu $2,12($6) ++ dsll $11,32 ++ dsll $2,32 ++ or $10,$11 ++ or $1,$2 ++ ++ daddu $8,$10 # accumulate nonce ++ daddu $9,$1 ++ sltu $10,$8,$10 ++ daddu $9,$10 ++ ++ dsrl $10,$8,8 # write mac value ++ dsrl $11,$8,16 ++ dsrl $1,$8,24 ++ sb $8,0($5) ++ dsrl $2,$8,32 ++ sb $10,1($5) ++ dsrl $10,$8,40 ++ sb $11,2($5) ++ dsrl $11,$8,48 ++ sb $1,3($5) ++ dsrl $1,$8,56 ++ sb $2,4($5) ++ dsrl $2,$9,8 ++ sb $10,5($5) ++ dsrl $10,$9,16 ++ sb $11,6($5) ++ dsrl $11,$9,24 ++ sb $1,7($5) ++ ++ sb $9,8($5) ++ dsrl $1,$9,32 ++ sb $2,9($5) ++ dsrl $2,$9,40 ++ sb $10,10($5) ++ dsrl $10,$9,48 ++ sb $11,11($5) ++ dsrl $11,$9,56 ++ sb $1,12($5) ++ sb $2,13($5) ++ sb $10,14($5) ++ sb $11,15($5) ++ ++ jr $31 ++.end poly1305_emit_mips +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/crypto/poly1305-x86_64.S 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,2803 @@ ++/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) ++ * ++ * Copyright (C) 2017 Samuel Neves . All Rights Reserved. ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. ++ */ ++ ++#include ++ ++.section .rodata.cst32.Lmask24, "aM", @progbits, 32 ++.align 64 ++.Lconst: ++.Lmask24: ++.long 0x0ffffff,0,0x0ffffff,0,0x0ffffff,0,0x0ffffff,0 ++.section .rodata.cst32.L129, "aM", @progbits, 32 ++.align 32 ++.L129: ++.long 16777216,0,16777216,0,16777216,0,16777216,0 ++.section .rodata.cst32.Lmask26, "aM", @progbits, 32 ++.align 32 ++.Lmask26: ++.long 0x3ffffff,0,0x3ffffff,0,0x3ffffff,0,0x3ffffff,0 ++.section .rodata.cst32.Lpermd_avx2, "aM", @progbits, 32 ++.align 32 ++.Lpermd_avx2: ++.long 2,2,2,3,2,0,2,1 ++.section .rodata.cst64.Lpermd_avx512, "aM", @progbits, 64 ++.align 64 ++.Lpermd_avx512: ++.long 0,0,0,1, 0,2,0,3, 0,4,0,5, 0,6,0,7 ++ ++.text ++ ++.align 32 ++ENTRY(poly1305_init_x86_64) ++ xorq %rax,%rax ++ movq %rax,0(%rdi) ++ movq %rax,8(%rdi) ++ movq %rax,16(%rdi) ++ ++ cmpq $0,%rsi ++ je .Lno_key ++ ++ movq $0x0ffffffc0fffffff,%rax ++ movq $0x0ffffffc0ffffffc,%rcx ++ andq 0(%rsi),%rax ++ andq 8(%rsi),%rcx ++ movq %rax,24(%rdi) ++ movq %rcx,32(%rdi) ++ movl $1,%eax ++.Lno_key: ++ ret ++ENDPROC(poly1305_init_x86_64) ++ ++.align 32 ++ENTRY(poly1305_blocks_x86_64) ++.Lblocks: ++ shrq $4,%rdx ++ jz .Lno_data ++ ++ pushq %rbx ++ pushq %r12 ++ pushq %r13 ++ pushq %r14 ++ pushq %r15 ++ pushq %rdi ++ ++.Lblocks_body: ++ ++ movq %rdx,%r15 ++ ++ movq 24(%rdi),%r11 ++ movq 32(%rdi),%r13 ++ ++ movq 0(%rdi),%r14 ++ movq 8(%rdi),%rbx ++ movq 16(%rdi),%r10 ++ ++ movq %r13,%r12 ++ shrq $2,%r13 ++ movq %r12,%rax ++ addq %r12,%r13 ++ jmp .Loop ++ ++.align 32 ++.Loop: ++ ++ addq 0(%rsi),%r14 ++ adcq 8(%rsi),%rbx ++ leaq 16(%rsi),%rsi ++ adcq %rcx,%r10 ++ mulq %r14 ++ movq %rax,%r9 ++ movq %r11,%rax ++ movq %rdx,%rdi ++ ++ mulq %r14 ++ movq %rax,%r14 ++ movq %r11,%rax ++ movq %rdx,%r8 ++ ++ mulq %rbx ++ addq %rax,%r9 ++ movq %r13,%rax ++ adcq %rdx,%rdi ++ ++ mulq %rbx ++ movq %r10,%rbx ++ addq %rax,%r14 ++ adcq %rdx,%r8 ++ ++ imulq %r13,%rbx ++ addq %rbx,%r9 ++ movq %r8,%rbx ++ adcq $0,%rdi ++ ++ imulq %r11,%r10 ++ addq %r9,%rbx ++ movq $-4,%rax ++ adcq %r10,%rdi ++ ++ andq %rdi,%rax ++ movq %rdi,%r10 ++ shrq $2,%rdi ++ andq $3,%r10 ++ addq %rdi,%rax ++ addq %rax,%r14 ++ adcq $0,%rbx ++ adcq $0,%r10 ++ ++ movq %r12,%rax ++ decq %r15 ++ jnz .Loop ++ ++ movq 0(%rsp),%rdi ++ ++ movq %r14,0(%rdi) ++ movq %rbx,8(%rdi) ++ movq %r10,16(%rdi) ++ ++ movq 8(%rsp),%r15 ++ movq 16(%rsp),%r14 ++ movq 24(%rsp),%r13 ++ movq 32(%rsp),%r12 ++ movq 40(%rsp),%rbx ++ leaq 48(%rsp),%rsp ++.Lno_data: ++.Lblocks_epilogue: ++ ret ++ENDPROC(poly1305_blocks_x86_64) ++ ++.align 32 ++ENTRY(poly1305_emit_x86_64) ++.Lemit: ++ movq 0(%rdi),%r8 ++ movq 8(%rdi),%r9 ++ movq 16(%rdi),%r10 ++ ++ movq %r8,%rax ++ addq $5,%r8 ++ movq %r9,%rcx ++ adcq $0,%r9 ++ adcq $0,%r10 ++ shrq $2,%r10 ++ cmovnzq %r8,%rax ++ cmovnzq %r9,%rcx ++ ++ addq 0(%rdx),%rax ++ adcq 8(%rdx),%rcx ++ movq %rax,0(%rsi) ++ movq %rcx,8(%rsi) ++ ++ ret ++ENDPROC(poly1305_emit_x86_64) ++ ++.macro __poly1305_block ++ mulq %r14 ++ movq %rax,%r9 ++ movq %r11,%rax ++ movq %rdx,%rdi ++ ++ mulq %r14 ++ movq %rax,%r14 ++ movq %r11,%rax ++ movq %rdx,%r8 ++ ++ mulq %rbx ++ addq %rax,%r9 ++ movq %r13,%rax ++ adcq %rdx,%rdi ++ ++ mulq %rbx ++ movq %r10,%rbx ++ addq %rax,%r14 ++ adcq %rdx,%r8 ++ ++ imulq %r13,%rbx ++ addq %rbx,%r9 ++ movq %r8,%rbx ++ adcq $0,%rdi ++ ++ imulq %r11,%r10 ++ addq %r9,%rbx ++ movq $-4,%rax ++ adcq %r10,%rdi ++ ++ andq %rdi,%rax ++ movq %rdi,%r10 ++ shrq $2,%rdi ++ andq $3,%r10 ++ addq %rdi,%rax ++ addq %rax,%r14 ++ adcq $0,%rbx ++ adcq $0,%r10 ++.endm ++ ++.macro __poly1305_init_avx ++ movq %r11,%r14 ++ movq %r12,%rbx ++ xorq %r10,%r10 ++ ++ leaq 48+64(%rdi),%rdi ++ ++ movq %r12,%rax ++ movq %rdi,0(%rsp) ++ __poly1305_block ++ movq 0(%rsp),%rdi ++ ++ movl $0x3ffffff,%eax ++ movl $0x3ffffff,%edx ++ movq %r14,%r8 ++ andl %r14d,%eax ++ movq %r11,%r9 ++ andl %r11d,%edx ++ movl %eax,-64(%rdi) ++ shrq $26,%r8 ++ movl %edx,-60(%rdi) ++ shrq $26,%r9 ++ ++ movl $0x3ffffff,%eax ++ movl $0x3ffffff,%edx ++ andl %r8d,%eax ++ andl %r9d,%edx ++ movl %eax,-48(%rdi) ++ leal (%rax,%rax,4),%eax ++ movl %edx,-44(%rdi) ++ leal (%rdx,%rdx,4),%edx ++ movl %eax,-32(%rdi) ++ shrq $26,%r8 ++ movl %edx,-28(%rdi) ++ shrq $26,%r9 ++ ++ movq %rbx,%rax ++ movq %r12,%rdx ++ shlq $12,%rax ++ shlq $12,%rdx ++ orq %r8,%rax ++ orq %r9,%rdx ++ andl $0x3ffffff,%eax ++ andl $0x3ffffff,%edx ++ movl %eax,-16(%rdi) ++ leal (%rax,%rax,4),%eax ++ movl %edx,-12(%rdi) ++ leal (%rdx,%rdx,4),%edx ++ movl %eax,0(%rdi) ++ movq %rbx,%r8 ++ movl %edx,4(%rdi) ++ movq %r12,%r9 ++ ++ movl $0x3ffffff,%eax ++ movl $0x3ffffff,%edx ++ shrq $14,%r8 ++ shrq $14,%r9 ++ andl %r8d,%eax ++ andl %r9d,%edx ++ movl %eax,16(%rdi) ++ leal (%rax,%rax,4),%eax ++ movl %edx,20(%rdi) ++ leal (%rdx,%rdx,4),%edx ++ movl %eax,32(%rdi) ++ shrq $26,%r8 ++ movl %edx,36(%rdi) ++ shrq $26,%r9 ++ ++ movq %r10,%rax ++ shlq $24,%rax ++ orq %rax,%r8 ++ movl %r8d,48(%rdi) ++ leaq (%r8,%r8,4),%r8 ++ movl %r9d,52(%rdi) ++ leaq (%r9,%r9,4),%r9 ++ movl %r8d,64(%rdi) ++ movl %r9d,68(%rdi) ++ ++ movq %r12,%rax ++ movq %rdi,0(%rsp) ++ __poly1305_block ++ movq 0(%rsp),%rdi ++ ++ movl $0x3ffffff,%eax ++ movq %r14,%r8 ++ andl %r14d,%eax ++ shrq $26,%r8 ++ movl %eax,-52(%rdi) ++ ++ movl $0x3ffffff,%edx ++ andl %r8d,%edx ++ movl %edx,-36(%rdi) ++ leal (%rdx,%rdx,4),%edx ++ shrq $26,%r8 ++ movl %edx,-20(%rdi) ++ ++ movq %rbx,%rax ++ shlq $12,%rax ++ orq %r8,%rax ++ andl $0x3ffffff,%eax ++ movl %eax,-4(%rdi) ++ leal (%rax,%rax,4),%eax ++ movq %rbx,%r8 ++ movl %eax,12(%rdi) ++ ++ movl $0x3ffffff,%edx ++ shrq $14,%r8 ++ andl %r8d,%edx ++ movl %edx,28(%rdi) ++ leal (%rdx,%rdx,4),%edx ++ shrq $26,%r8 ++ movl %edx,44(%rdi) ++ ++ movq %r10,%rax ++ shlq $24,%rax ++ orq %rax,%r8 ++ movl %r8d,60(%rdi) ++ leaq (%r8,%r8,4),%r8 ++ movl %r8d,76(%rdi) ++ ++ movq %r12,%rax ++ movq %rdi,0(%rsp) ++ __poly1305_block ++ movq 0(%rsp),%rdi ++ ++ movl $0x3ffffff,%eax ++ movq %r14,%r8 ++ andl %r14d,%eax ++ shrq $26,%r8 ++ movl %eax,-56(%rdi) ++ ++ movl $0x3ffffff,%edx ++ andl %r8d,%edx ++ movl %edx,-40(%rdi) ++ leal (%rdx,%rdx,4),%edx ++ shrq $26,%r8 ++ movl %edx,-24(%rdi) ++ ++ movq %rbx,%rax ++ shlq $12,%rax ++ orq %r8,%rax ++ andl $0x3ffffff,%eax ++ movl %eax,-8(%rdi) ++ leal (%rax,%rax,4),%eax ++ movq %rbx,%r8 ++ movl %eax,8(%rdi) ++ ++ movl $0x3ffffff,%edx ++ shrq $14,%r8 ++ andl %r8d,%edx ++ movl %edx,24(%rdi) ++ leal (%rdx,%rdx,4),%edx ++ shrq $26,%r8 ++ movl %edx,40(%rdi) ++ ++ movq %r10,%rax ++ shlq $24,%rax ++ orq %rax,%r8 ++ movl %r8d,56(%rdi) ++ leaq (%r8,%r8,4),%r8 ++ movl %r8d,72(%rdi) ++ ++ leaq -48-64(%rdi),%rdi ++.endm ++ ++#ifdef CONFIG_AS_AVX ++.align 32 ++ENTRY(poly1305_blocks_avx) ++ ++ movl 20(%rdi),%r8d ++ cmpq $128,%rdx ++ jae .Lblocks_avx ++ testl %r8d,%r8d ++ jz .Lblocks ++ ++.Lblocks_avx: ++ andq $-16,%rdx ++ jz .Lno_data_avx ++ ++ vzeroupper ++ ++ testl %r8d,%r8d ++ jz .Lbase2_64_avx ++ ++ testq $31,%rdx ++ jz .Leven_avx ++ ++ pushq %rbx ++ pushq %r12 ++ pushq %r13 ++ pushq %r14 ++ pushq %r15 ++ pushq %rdi ++ ++.Lblocks_avx_body: ++ ++ movq %rdx,%r15 ++ ++ movq 0(%rdi),%r8 ++ movq 8(%rdi),%r9 ++ movl 16(%rdi),%r10d ++ ++ movq 24(%rdi),%r11 ++ movq 32(%rdi),%r13 ++ ++ ++ movl %r8d,%r14d ++ andq $-2147483648,%r8 ++ movq %r9,%r12 ++ movl %r9d,%ebx ++ andq $-2147483648,%r9 ++ ++ shrq $6,%r8 ++ shlq $52,%r12 ++ addq %r8,%r14 ++ shrq $12,%rbx ++ shrq $18,%r9 ++ addq %r12,%r14 ++ adcq %r9,%rbx ++ ++ movq %r10,%r8 ++ shlq $40,%r8 ++ shrq $24,%r10 ++ addq %r8,%rbx ++ adcq $0,%r10 ++ ++ movq $-4,%r9 ++ movq %r10,%r8 ++ andq %r10,%r9 ++ shrq $2,%r8 ++ andq $3,%r10 ++ addq %r9,%r8 ++ addq %r8,%r14 ++ adcq $0,%rbx ++ adcq $0,%r10 ++ ++ movq %r13,%r12 ++ movq %r13,%rax ++ shrq $2,%r13 ++ addq %r12,%r13 ++ ++ addq 0(%rsi),%r14 ++ adcq 8(%rsi),%rbx ++ leaq 16(%rsi),%rsi ++ adcq %rcx,%r10 ++ ++ movq %rdi,0(%rsp) ++ __poly1305_block ++ movq 0(%rsp),%rdi ++ ++ testq %rcx,%rcx ++ jz .Lstore_base2_64_avx ++ ++ ++ movq %r14,%rax ++ movq %r14,%rdx ++ shrq $52,%r14 ++ movq %rbx,%r11 ++ movq %rbx,%r12 ++ shrq $26,%rdx ++ andq $0x3ffffff,%rax ++ shlq $12,%r11 ++ andq $0x3ffffff,%rdx ++ shrq $14,%rbx ++ orq %r11,%r14 ++ shlq $24,%r10 ++ andq $0x3ffffff,%r14 ++ shrq $40,%r12 ++ andq $0x3ffffff,%rbx ++ orq %r12,%r10 ++ ++ subq $16,%r15 ++ jz .Lstore_base2_26_avx ++ ++ vmovd %eax,%xmm0 ++ vmovd %edx,%xmm1 ++ vmovd %r14d,%xmm2 ++ vmovd %ebx,%xmm3 ++ vmovd %r10d,%xmm4 ++ jmp .Lproceed_avx ++ ++.align 32 ++.Lstore_base2_64_avx: ++ movq %r14,0(%rdi) ++ movq %rbx,8(%rdi) ++ movq %r10,16(%rdi) ++ jmp .Ldone_avx ++ ++.align 16 ++.Lstore_base2_26_avx: ++ movl %eax,0(%rdi) ++ movl %edx,4(%rdi) ++ movl %r14d,8(%rdi) ++ movl %ebx,12(%rdi) ++ movl %r10d,16(%rdi) ++.align 16 ++.Ldone_avx: ++ movq 8(%rsp),%r15 ++ movq 16(%rsp),%r14 ++ movq 24(%rsp),%r13 ++ movq 32(%rsp),%r12 ++ movq 40(%rsp),%rbx ++ leaq 48(%rsp),%rsp ++ ++.Lno_data_avx: ++.Lblocks_avx_epilogue: ++ ret ++ ++.align 32 ++.Lbase2_64_avx: ++ ++ pushq %rbx ++ pushq %r12 ++ pushq %r13 ++ pushq %r14 ++ pushq %r15 ++ pushq %rdi ++ ++.Lbase2_64_avx_body: ++ ++ movq %rdx,%r15 ++ ++ movq 24(%rdi),%r11 ++ movq 32(%rdi),%r13 ++ ++ movq 0(%rdi),%r14 ++ movq 8(%rdi),%rbx ++ movl 16(%rdi),%r10d ++ ++ movq %r13,%r12 ++ movq %r13,%rax ++ shrq $2,%r13 ++ addq %r12,%r13 ++ ++ testq $31,%rdx ++ jz .Linit_avx ++ ++ addq 0(%rsi),%r14 ++ adcq 8(%rsi),%rbx ++ leaq 16(%rsi),%rsi ++ adcq %rcx,%r10 ++ subq $16,%r15 ++ ++ movq %rdi,0(%rsp) ++ __poly1305_block ++ movq 0(%rsp),%rdi ++ ++.Linit_avx: ++ ++ movq %r14,%rax ++ movq %r14,%rdx ++ shrq $52,%r14 ++ movq %rbx,%r8 ++ movq %rbx,%r9 ++ shrq $26,%rdx ++ andq $0x3ffffff,%rax ++ shlq $12,%r8 ++ andq $0x3ffffff,%rdx ++ shrq $14,%rbx ++ orq %r8,%r14 ++ shlq $24,%r10 ++ andq $0x3ffffff,%r14 ++ shrq $40,%r9 ++ andq $0x3ffffff,%rbx ++ orq %r9,%r10 ++ ++ vmovd %eax,%xmm0 ++ vmovd %edx,%xmm1 ++ vmovd %r14d,%xmm2 ++ vmovd %ebx,%xmm3 ++ vmovd %r10d,%xmm4 ++ movl $1,20(%rdi) ++ ++ __poly1305_init_avx ++ ++.Lproceed_avx: ++ movq %r15,%rdx ++ ++ movq 8(%rsp),%r15 ++ movq 16(%rsp),%r14 ++ movq 24(%rsp),%r13 ++ movq 32(%rsp),%r12 ++ movq 40(%rsp),%rbx ++ leaq 48(%rsp),%rax ++ leaq 48(%rsp),%rsp ++ ++.Lbase2_64_avx_epilogue: ++ jmp .Ldo_avx ++ ++ ++.align 32 ++.Leven_avx: ++ vmovd 0(%rdi),%xmm0 ++ vmovd 4(%rdi),%xmm1 ++ vmovd 8(%rdi),%xmm2 ++ vmovd 12(%rdi),%xmm3 ++ vmovd 16(%rdi),%xmm4 ++ ++.Ldo_avx: ++ leaq 8(%rsp),%r10 ++ andq $-32,%rsp ++ subq $8,%rsp ++ leaq -88(%rsp),%r11 ++ subq $0x178,%rsp ++ subq $64,%rdx ++ leaq -32(%rsi),%rax ++ cmovcq %rax,%rsi ++ ++ vmovdqu 48(%rdi),%xmm14 ++ leaq 112(%rdi),%rdi ++ leaq .Lconst(%rip),%rcx ++ ++ vmovdqu 32(%rsi),%xmm5 ++ vmovdqu 48(%rsi),%xmm6 ++ vmovdqa 64(%rcx),%xmm15 ++ ++ vpsrldq $6,%xmm5,%xmm7 ++ vpsrldq $6,%xmm6,%xmm8 ++ vpunpckhqdq %xmm6,%xmm5,%xmm9 ++ vpunpcklqdq %xmm6,%xmm5,%xmm5 ++ vpunpcklqdq %xmm8,%xmm7,%xmm8 ++ ++ vpsrlq $40,%xmm9,%xmm9 ++ vpsrlq $26,%xmm5,%xmm6 ++ vpand %xmm15,%xmm5,%xmm5 ++ vpsrlq $4,%xmm8,%xmm7 ++ vpand %xmm15,%xmm6,%xmm6 ++ vpsrlq $30,%xmm8,%xmm8 ++ vpand %xmm15,%xmm7,%xmm7 ++ vpand %xmm15,%xmm8,%xmm8 ++ vpor 32(%rcx),%xmm9,%xmm9 ++ ++ jbe .Lskip_loop_avx ++ ++ ++ vmovdqu -48(%rdi),%xmm11 ++ vmovdqu -32(%rdi),%xmm12 ++ vpshufd $0xEE,%xmm14,%xmm13 ++ vpshufd $0x44,%xmm14,%xmm10 ++ vmovdqa %xmm13,-144(%r11) ++ vmovdqa %xmm10,0(%rsp) ++ vpshufd $0xEE,%xmm11,%xmm14 ++ vmovdqu -16(%rdi),%xmm10 ++ vpshufd $0x44,%xmm11,%xmm11 ++ vmovdqa %xmm14,-128(%r11) ++ vmovdqa %xmm11,16(%rsp) ++ vpshufd $0xEE,%xmm12,%xmm13 ++ vmovdqu 0(%rdi),%xmm11 ++ vpshufd $0x44,%xmm12,%xmm12 ++ vmovdqa %xmm13,-112(%r11) ++ vmovdqa %xmm12,32(%rsp) ++ vpshufd $0xEE,%xmm10,%xmm14 ++ vmovdqu 16(%rdi),%xmm12 ++ vpshufd $0x44,%xmm10,%xmm10 ++ vmovdqa %xmm14,-96(%r11) ++ vmovdqa %xmm10,48(%rsp) ++ vpshufd $0xEE,%xmm11,%xmm13 ++ vmovdqu 32(%rdi),%xmm10 ++ vpshufd $0x44,%xmm11,%xmm11 ++ vmovdqa %xmm13,-80(%r11) ++ vmovdqa %xmm11,64(%rsp) ++ vpshufd $0xEE,%xmm12,%xmm14 ++ vmovdqu 48(%rdi),%xmm11 ++ vpshufd $0x44,%xmm12,%xmm12 ++ vmovdqa %xmm14,-64(%r11) ++ vmovdqa %xmm12,80(%rsp) ++ vpshufd $0xEE,%xmm10,%xmm13 ++ vmovdqu 64(%rdi),%xmm12 ++ vpshufd $0x44,%xmm10,%xmm10 ++ vmovdqa %xmm13,-48(%r11) ++ vmovdqa %xmm10,96(%rsp) ++ vpshufd $0xEE,%xmm11,%xmm14 ++ vpshufd $0x44,%xmm11,%xmm11 ++ vmovdqa %xmm14,-32(%r11) ++ vmovdqa %xmm11,112(%rsp) ++ vpshufd $0xEE,%xmm12,%xmm13 ++ vmovdqa 0(%rsp),%xmm14 ++ vpshufd $0x44,%xmm12,%xmm12 ++ vmovdqa %xmm13,-16(%r11) ++ vmovdqa %xmm12,128(%rsp) ++ ++ jmp .Loop_avx ++ ++.align 32 ++.Loop_avx: ++ ++ vpmuludq %xmm5,%xmm14,%xmm10 ++ vpmuludq %xmm6,%xmm14,%xmm11 ++ vmovdqa %xmm2,32(%r11) ++ vpmuludq %xmm7,%xmm14,%xmm12 ++ vmovdqa 16(%rsp),%xmm2 ++ vpmuludq %xmm8,%xmm14,%xmm13 ++ vpmuludq %xmm9,%xmm14,%xmm14 ++ ++ vmovdqa %xmm0,0(%r11) ++ vpmuludq 32(%rsp),%xmm9,%xmm0 ++ vmovdqa %xmm1,16(%r11) ++ vpmuludq %xmm8,%xmm2,%xmm1 ++ vpaddq %xmm0,%xmm10,%xmm10 ++ vpaddq %xmm1,%xmm14,%xmm14 ++ vmovdqa %xmm3,48(%r11) ++ vpmuludq %xmm7,%xmm2,%xmm0 ++ vpmuludq %xmm6,%xmm2,%xmm1 ++ vpaddq %xmm0,%xmm13,%xmm13 ++ vmovdqa 48(%rsp),%xmm3 ++ vpaddq %xmm1,%xmm12,%xmm12 ++ vmovdqa %xmm4,64(%r11) ++ vpmuludq %xmm5,%xmm2,%xmm2 ++ vpmuludq %xmm7,%xmm3,%xmm0 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ ++ vmovdqa 64(%rsp),%xmm4 ++ vpaddq %xmm0,%xmm14,%xmm14 ++ vpmuludq %xmm6,%xmm3,%xmm1 ++ vpmuludq %xmm5,%xmm3,%xmm3 ++ vpaddq %xmm1,%xmm13,%xmm13 ++ vmovdqa 80(%rsp),%xmm2 ++ vpaddq %xmm3,%xmm12,%xmm12 ++ vpmuludq %xmm9,%xmm4,%xmm0 ++ vpmuludq %xmm8,%xmm4,%xmm4 ++ vpaddq %xmm0,%xmm11,%xmm11 ++ vmovdqa 96(%rsp),%xmm3 ++ vpaddq %xmm4,%xmm10,%xmm10 ++ ++ vmovdqa 128(%rsp),%xmm4 ++ vpmuludq %xmm6,%xmm2,%xmm1 ++ vpmuludq %xmm5,%xmm2,%xmm2 ++ vpaddq %xmm1,%xmm14,%xmm14 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ vpmuludq %xmm9,%xmm3,%xmm0 ++ vpmuludq %xmm8,%xmm3,%xmm1 ++ vpaddq %xmm0,%xmm12,%xmm12 ++ vmovdqu 0(%rsi),%xmm0 ++ vpaddq %xmm1,%xmm11,%xmm11 ++ vpmuludq %xmm7,%xmm3,%xmm3 ++ vpmuludq %xmm7,%xmm4,%xmm7 ++ vpaddq %xmm3,%xmm10,%xmm10 ++ ++ vmovdqu 16(%rsi),%xmm1 ++ vpaddq %xmm7,%xmm11,%xmm11 ++ vpmuludq %xmm8,%xmm4,%xmm8 ++ vpmuludq %xmm9,%xmm4,%xmm9 ++ vpsrldq $6,%xmm0,%xmm2 ++ vpaddq %xmm8,%xmm12,%xmm12 ++ vpaddq %xmm9,%xmm13,%xmm13 ++ vpsrldq $6,%xmm1,%xmm3 ++ vpmuludq 112(%rsp),%xmm5,%xmm9 ++ vpmuludq %xmm6,%xmm4,%xmm5 ++ vpunpckhqdq %xmm1,%xmm0,%xmm4 ++ vpaddq %xmm9,%xmm14,%xmm14 ++ vmovdqa -144(%r11),%xmm9 ++ vpaddq %xmm5,%xmm10,%xmm10 ++ ++ vpunpcklqdq %xmm1,%xmm0,%xmm0 ++ vpunpcklqdq %xmm3,%xmm2,%xmm3 ++ ++ ++ vpsrldq $5,%xmm4,%xmm4 ++ vpsrlq $26,%xmm0,%xmm1 ++ vpand %xmm15,%xmm0,%xmm0 ++ vpsrlq $4,%xmm3,%xmm2 ++ vpand %xmm15,%xmm1,%xmm1 ++ vpand 0(%rcx),%xmm4,%xmm4 ++ vpsrlq $30,%xmm3,%xmm3 ++ vpand %xmm15,%xmm2,%xmm2 ++ vpand %xmm15,%xmm3,%xmm3 ++ vpor 32(%rcx),%xmm4,%xmm4 ++ ++ vpaddq 0(%r11),%xmm0,%xmm0 ++ vpaddq 16(%r11),%xmm1,%xmm1 ++ vpaddq 32(%r11),%xmm2,%xmm2 ++ vpaddq 48(%r11),%xmm3,%xmm3 ++ vpaddq 64(%r11),%xmm4,%xmm4 ++ ++ leaq 32(%rsi),%rax ++ leaq 64(%rsi),%rsi ++ subq $64,%rdx ++ cmovcq %rax,%rsi ++ ++ vpmuludq %xmm0,%xmm9,%xmm5 ++ vpmuludq %xmm1,%xmm9,%xmm6 ++ vpaddq %xmm5,%xmm10,%xmm10 ++ vpaddq %xmm6,%xmm11,%xmm11 ++ vmovdqa -128(%r11),%xmm7 ++ vpmuludq %xmm2,%xmm9,%xmm5 ++ vpmuludq %xmm3,%xmm9,%xmm6 ++ vpaddq %xmm5,%xmm12,%xmm12 ++ vpaddq %xmm6,%xmm13,%xmm13 ++ vpmuludq %xmm4,%xmm9,%xmm9 ++ vpmuludq -112(%r11),%xmm4,%xmm5 ++ vpaddq %xmm9,%xmm14,%xmm14 ++ ++ vpaddq %xmm5,%xmm10,%xmm10 ++ vpmuludq %xmm2,%xmm7,%xmm6 ++ vpmuludq %xmm3,%xmm7,%xmm5 ++ vpaddq %xmm6,%xmm13,%xmm13 ++ vmovdqa -96(%r11),%xmm8 ++ vpaddq %xmm5,%xmm14,%xmm14 ++ vpmuludq %xmm1,%xmm7,%xmm6 ++ vpmuludq %xmm0,%xmm7,%xmm7 ++ vpaddq %xmm6,%xmm12,%xmm12 ++ vpaddq %xmm7,%xmm11,%xmm11 ++ ++ vmovdqa -80(%r11),%xmm9 ++ vpmuludq %xmm2,%xmm8,%xmm5 ++ vpmuludq %xmm1,%xmm8,%xmm6 ++ vpaddq %xmm5,%xmm14,%xmm14 ++ vpaddq %xmm6,%xmm13,%xmm13 ++ vmovdqa -64(%r11),%xmm7 ++ vpmuludq %xmm0,%xmm8,%xmm8 ++ vpmuludq %xmm4,%xmm9,%xmm5 ++ vpaddq %xmm8,%xmm12,%xmm12 ++ vpaddq %xmm5,%xmm11,%xmm11 ++ vmovdqa -48(%r11),%xmm8 ++ vpmuludq %xmm3,%xmm9,%xmm9 ++ vpmuludq %xmm1,%xmm7,%xmm6 ++ vpaddq %xmm9,%xmm10,%xmm10 ++ ++ vmovdqa -16(%r11),%xmm9 ++ vpaddq %xmm6,%xmm14,%xmm14 ++ vpmuludq %xmm0,%xmm7,%xmm7 ++ vpmuludq %xmm4,%xmm8,%xmm5 ++ vpaddq %xmm7,%xmm13,%xmm13 ++ vpaddq %xmm5,%xmm12,%xmm12 ++ vmovdqu 32(%rsi),%xmm5 ++ vpmuludq %xmm3,%xmm8,%xmm7 ++ vpmuludq %xmm2,%xmm8,%xmm8 ++ vpaddq %xmm7,%xmm11,%xmm11 ++ vmovdqu 48(%rsi),%xmm6 ++ vpaddq %xmm8,%xmm10,%xmm10 ++ ++ vpmuludq %xmm2,%xmm9,%xmm2 ++ vpmuludq %xmm3,%xmm9,%xmm3 ++ vpsrldq $6,%xmm5,%xmm7 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpmuludq %xmm4,%xmm9,%xmm4 ++ vpsrldq $6,%xmm6,%xmm8 ++ vpaddq %xmm3,%xmm12,%xmm2 ++ vpaddq %xmm4,%xmm13,%xmm3 ++ vpmuludq -32(%r11),%xmm0,%xmm4 ++ vpmuludq %xmm1,%xmm9,%xmm0 ++ vpunpckhqdq %xmm6,%xmm5,%xmm9 ++ vpaddq %xmm4,%xmm14,%xmm4 ++ vpaddq %xmm0,%xmm10,%xmm0 ++ ++ vpunpcklqdq %xmm6,%xmm5,%xmm5 ++ vpunpcklqdq %xmm8,%xmm7,%xmm8 ++ ++ ++ vpsrldq $5,%xmm9,%xmm9 ++ vpsrlq $26,%xmm5,%xmm6 ++ vmovdqa 0(%rsp),%xmm14 ++ vpand %xmm15,%xmm5,%xmm5 ++ vpsrlq $4,%xmm8,%xmm7 ++ vpand %xmm15,%xmm6,%xmm6 ++ vpand 0(%rcx),%xmm9,%xmm9 ++ vpsrlq $30,%xmm8,%xmm8 ++ vpand %xmm15,%xmm7,%xmm7 ++ vpand %xmm15,%xmm8,%xmm8 ++ vpor 32(%rcx),%xmm9,%xmm9 ++ ++ vpsrlq $26,%xmm3,%xmm13 ++ vpand %xmm15,%xmm3,%xmm3 ++ vpaddq %xmm13,%xmm4,%xmm4 ++ ++ vpsrlq $26,%xmm0,%xmm10 ++ vpand %xmm15,%xmm0,%xmm0 ++ vpaddq %xmm10,%xmm11,%xmm1 ++ ++ vpsrlq $26,%xmm4,%xmm10 ++ vpand %xmm15,%xmm4,%xmm4 ++ ++ vpsrlq $26,%xmm1,%xmm11 ++ vpand %xmm15,%xmm1,%xmm1 ++ vpaddq %xmm11,%xmm2,%xmm2 ++ ++ vpaddq %xmm10,%xmm0,%xmm0 ++ vpsllq $2,%xmm10,%xmm10 ++ vpaddq %xmm10,%xmm0,%xmm0 ++ ++ vpsrlq $26,%xmm2,%xmm12 ++ vpand %xmm15,%xmm2,%xmm2 ++ vpaddq %xmm12,%xmm3,%xmm3 ++ ++ vpsrlq $26,%xmm0,%xmm10 ++ vpand %xmm15,%xmm0,%xmm0 ++ vpaddq %xmm10,%xmm1,%xmm1 ++ ++ vpsrlq $26,%xmm3,%xmm13 ++ vpand %xmm15,%xmm3,%xmm3 ++ vpaddq %xmm13,%xmm4,%xmm4 ++ ++ ja .Loop_avx ++ ++.Lskip_loop_avx: ++ vpshufd $0x10,%xmm14,%xmm14 ++ addq $32,%rdx ++ jnz .Long_tail_avx ++ ++ vpaddq %xmm2,%xmm7,%xmm7 ++ vpaddq %xmm0,%xmm5,%xmm5 ++ vpaddq %xmm1,%xmm6,%xmm6 ++ vpaddq %xmm3,%xmm8,%xmm8 ++ vpaddq %xmm4,%xmm9,%xmm9 ++ ++.Long_tail_avx: ++ vmovdqa %xmm2,32(%r11) ++ vmovdqa %xmm0,0(%r11) ++ vmovdqa %xmm1,16(%r11) ++ vmovdqa %xmm3,48(%r11) ++ vmovdqa %xmm4,64(%r11) ++ ++ vpmuludq %xmm7,%xmm14,%xmm12 ++ vpmuludq %xmm5,%xmm14,%xmm10 ++ vpshufd $0x10,-48(%rdi),%xmm2 ++ vpmuludq %xmm6,%xmm14,%xmm11 ++ vpmuludq %xmm8,%xmm14,%xmm13 ++ vpmuludq %xmm9,%xmm14,%xmm14 ++ ++ vpmuludq %xmm8,%xmm2,%xmm0 ++ vpaddq %xmm0,%xmm14,%xmm14 ++ vpshufd $0x10,-32(%rdi),%xmm3 ++ vpmuludq %xmm7,%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm13,%xmm13 ++ vpshufd $0x10,-16(%rdi),%xmm4 ++ vpmuludq %xmm6,%xmm2,%xmm0 ++ vpaddq %xmm0,%xmm12,%xmm12 ++ vpmuludq %xmm5,%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm11,%xmm11 ++ vpmuludq %xmm9,%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm10,%xmm10 ++ ++ vpshufd $0x10,0(%rdi),%xmm2 ++ vpmuludq %xmm7,%xmm4,%xmm1 ++ vpaddq %xmm1,%xmm14,%xmm14 ++ vpmuludq %xmm6,%xmm4,%xmm0 ++ vpaddq %xmm0,%xmm13,%xmm13 ++ vpshufd $0x10,16(%rdi),%xmm3 ++ vpmuludq %xmm5,%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm12,%xmm12 ++ vpmuludq %xmm9,%xmm2,%xmm1 ++ vpaddq %xmm1,%xmm11,%xmm11 ++ vpshufd $0x10,32(%rdi),%xmm4 ++ vpmuludq %xmm8,%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm10,%xmm10 ++ ++ vpmuludq %xmm6,%xmm3,%xmm0 ++ vpaddq %xmm0,%xmm14,%xmm14 ++ vpmuludq %xmm5,%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm13,%xmm13 ++ vpshufd $0x10,48(%rdi),%xmm2 ++ vpmuludq %xmm9,%xmm4,%xmm1 ++ vpaddq %xmm1,%xmm12,%xmm12 ++ vpshufd $0x10,64(%rdi),%xmm3 ++ vpmuludq %xmm8,%xmm4,%xmm0 ++ vpaddq %xmm0,%xmm11,%xmm11 ++ vpmuludq %xmm7,%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm10,%xmm10 ++ ++ vpmuludq %xmm5,%xmm2,%xmm2 ++ vpaddq %xmm2,%xmm14,%xmm14 ++ vpmuludq %xmm9,%xmm3,%xmm1 ++ vpaddq %xmm1,%xmm13,%xmm13 ++ vpmuludq %xmm8,%xmm3,%xmm0 ++ vpaddq %xmm0,%xmm12,%xmm12 ++ vpmuludq %xmm7,%xmm3,%xmm1 ++ vpaddq %xmm1,%xmm11,%xmm11 ++ vpmuludq %xmm6,%xmm3,%xmm3 ++ vpaddq %xmm3,%xmm10,%xmm10 ++ ++ jz .Lshort_tail_avx ++ ++ vmovdqu 0(%rsi),%xmm0 ++ vmovdqu 16(%rsi),%xmm1 ++ ++ vpsrldq $6,%xmm0,%xmm2 ++ vpsrldq $6,%xmm1,%xmm3 ++ vpunpckhqdq %xmm1,%xmm0,%xmm4 ++ vpunpcklqdq %xmm1,%xmm0,%xmm0 ++ vpunpcklqdq %xmm3,%xmm2,%xmm3 ++ ++ vpsrlq $40,%xmm4,%xmm4 ++ vpsrlq $26,%xmm0,%xmm1 ++ vpand %xmm15,%xmm0,%xmm0 ++ vpsrlq $4,%xmm3,%xmm2 ++ vpand %xmm15,%xmm1,%xmm1 ++ vpsrlq $30,%xmm3,%xmm3 ++ vpand %xmm15,%xmm2,%xmm2 ++ vpand %xmm15,%xmm3,%xmm3 ++ vpor 32(%rcx),%xmm4,%xmm4 ++ ++ vpshufd $0x32,-64(%rdi),%xmm9 ++ vpaddq 0(%r11),%xmm0,%xmm0 ++ vpaddq 16(%r11),%xmm1,%xmm1 ++ vpaddq 32(%r11),%xmm2,%xmm2 ++ vpaddq 48(%r11),%xmm3,%xmm3 ++ vpaddq 64(%r11),%xmm4,%xmm4 ++ ++ vpmuludq %xmm0,%xmm9,%xmm5 ++ vpaddq %xmm5,%xmm10,%xmm10 ++ vpmuludq %xmm1,%xmm9,%xmm6 ++ vpaddq %xmm6,%xmm11,%xmm11 ++ vpmuludq %xmm2,%xmm9,%xmm5 ++ vpaddq %xmm5,%xmm12,%xmm12 ++ vpshufd $0x32,-48(%rdi),%xmm7 ++ vpmuludq %xmm3,%xmm9,%xmm6 ++ vpaddq %xmm6,%xmm13,%xmm13 ++ vpmuludq %xmm4,%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm14,%xmm14 ++ ++ vpmuludq %xmm3,%xmm7,%xmm5 ++ vpaddq %xmm5,%xmm14,%xmm14 ++ vpshufd $0x32,-32(%rdi),%xmm8 ++ vpmuludq %xmm2,%xmm7,%xmm6 ++ vpaddq %xmm6,%xmm13,%xmm13 ++ vpshufd $0x32,-16(%rdi),%xmm9 ++ vpmuludq %xmm1,%xmm7,%xmm5 ++ vpaddq %xmm5,%xmm12,%xmm12 ++ vpmuludq %xmm0,%xmm7,%xmm7 ++ vpaddq %xmm7,%xmm11,%xmm11 ++ vpmuludq %xmm4,%xmm8,%xmm8 ++ vpaddq %xmm8,%xmm10,%xmm10 ++ ++ vpshufd $0x32,0(%rdi),%xmm7 ++ vpmuludq %xmm2,%xmm9,%xmm6 ++ vpaddq %xmm6,%xmm14,%xmm14 ++ vpmuludq %xmm1,%xmm9,%xmm5 ++ vpaddq %xmm5,%xmm13,%xmm13 ++ vpshufd $0x32,16(%rdi),%xmm8 ++ vpmuludq %xmm0,%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm12,%xmm12 ++ vpmuludq %xmm4,%xmm7,%xmm6 ++ vpaddq %xmm6,%xmm11,%xmm11 ++ vpshufd $0x32,32(%rdi),%xmm9 ++ vpmuludq %xmm3,%xmm7,%xmm7 ++ vpaddq %xmm7,%xmm10,%xmm10 ++ ++ vpmuludq %xmm1,%xmm8,%xmm5 ++ vpaddq %xmm5,%xmm14,%xmm14 ++ vpmuludq %xmm0,%xmm8,%xmm8 ++ vpaddq %xmm8,%xmm13,%xmm13 ++ vpshufd $0x32,48(%rdi),%xmm7 ++ vpmuludq %xmm4,%xmm9,%xmm6 ++ vpaddq %xmm6,%xmm12,%xmm12 ++ vpshufd $0x32,64(%rdi),%xmm8 ++ vpmuludq %xmm3,%xmm9,%xmm5 ++ vpaddq %xmm5,%xmm11,%xmm11 ++ vpmuludq %xmm2,%xmm9,%xmm9 ++ vpaddq %xmm9,%xmm10,%xmm10 ++ ++ vpmuludq %xmm0,%xmm7,%xmm7 ++ vpaddq %xmm7,%xmm14,%xmm14 ++ vpmuludq %xmm4,%xmm8,%xmm6 ++ vpaddq %xmm6,%xmm13,%xmm13 ++ vpmuludq %xmm3,%xmm8,%xmm5 ++ vpaddq %xmm5,%xmm12,%xmm12 ++ vpmuludq %xmm2,%xmm8,%xmm6 ++ vpaddq %xmm6,%xmm11,%xmm11 ++ vpmuludq %xmm1,%xmm8,%xmm8 ++ vpaddq %xmm8,%xmm10,%xmm10 ++ ++.Lshort_tail_avx: ++ ++ vpsrldq $8,%xmm14,%xmm9 ++ vpsrldq $8,%xmm13,%xmm8 ++ vpsrldq $8,%xmm11,%xmm6 ++ vpsrldq $8,%xmm10,%xmm5 ++ vpsrldq $8,%xmm12,%xmm7 ++ vpaddq %xmm8,%xmm13,%xmm13 ++ vpaddq %xmm9,%xmm14,%xmm14 ++ vpaddq %xmm5,%xmm10,%xmm10 ++ vpaddq %xmm6,%xmm11,%xmm11 ++ vpaddq %xmm7,%xmm12,%xmm12 ++ ++ vpsrlq $26,%xmm13,%xmm3 ++ vpand %xmm15,%xmm13,%xmm13 ++ vpaddq %xmm3,%xmm14,%xmm14 ++ ++ vpsrlq $26,%xmm10,%xmm0 ++ vpand %xmm15,%xmm10,%xmm10 ++ vpaddq %xmm0,%xmm11,%xmm11 ++ ++ vpsrlq $26,%xmm14,%xmm4 ++ vpand %xmm15,%xmm14,%xmm14 ++ ++ vpsrlq $26,%xmm11,%xmm1 ++ vpand %xmm15,%xmm11,%xmm11 ++ vpaddq %xmm1,%xmm12,%xmm12 ++ ++ vpaddq %xmm4,%xmm10,%xmm10 ++ vpsllq $2,%xmm4,%xmm4 ++ vpaddq %xmm4,%xmm10,%xmm10 ++ ++ vpsrlq $26,%xmm12,%xmm2 ++ vpand %xmm15,%xmm12,%xmm12 ++ vpaddq %xmm2,%xmm13,%xmm13 ++ ++ vpsrlq $26,%xmm10,%xmm0 ++ vpand %xmm15,%xmm10,%xmm10 ++ vpaddq %xmm0,%xmm11,%xmm11 ++ ++ vpsrlq $26,%xmm13,%xmm3 ++ vpand %xmm15,%xmm13,%xmm13 ++ vpaddq %xmm3,%xmm14,%xmm14 ++ ++ vmovd %xmm10,-112(%rdi) ++ vmovd %xmm11,-108(%rdi) ++ vmovd %xmm12,-104(%rdi) ++ vmovd %xmm13,-100(%rdi) ++ vmovd %xmm14,-96(%rdi) ++ leaq -8(%r10),%rsp ++ ++ vzeroupper ++ ret ++ENDPROC(poly1305_blocks_avx) ++ ++.align 32 ++ENTRY(poly1305_emit_avx) ++ cmpl $0,20(%rdi) ++ je .Lemit ++ ++ movl 0(%rdi),%eax ++ movl 4(%rdi),%ecx ++ movl 8(%rdi),%r8d ++ movl 12(%rdi),%r11d ++ movl 16(%rdi),%r10d ++ ++ shlq $26,%rcx ++ movq %r8,%r9 ++ shlq $52,%r8 ++ addq %rcx,%rax ++ shrq $12,%r9 ++ addq %rax,%r8 ++ adcq $0,%r9 ++ ++ shlq $14,%r11 ++ movq %r10,%rax ++ shrq $24,%r10 ++ addq %r11,%r9 ++ shlq $40,%rax ++ addq %rax,%r9 ++ adcq $0,%r10 ++ ++ movq %r10,%rax ++ movq %r10,%rcx ++ andq $3,%r10 ++ shrq $2,%rax ++ andq $-4,%rcx ++ addq %rcx,%rax ++ addq %rax,%r8 ++ adcq $0,%r9 ++ adcq $0,%r10 ++ ++ movq %r8,%rax ++ addq $5,%r8 ++ movq %r9,%rcx ++ adcq $0,%r9 ++ adcq $0,%r10 ++ shrq $2,%r10 ++ cmovnzq %r8,%rax ++ cmovnzq %r9,%rcx ++ ++ addq 0(%rdx),%rax ++ adcq 8(%rdx),%rcx ++ movq %rax,0(%rsi) ++ movq %rcx,8(%rsi) ++ ++ ret ++ENDPROC(poly1305_emit_avx) ++#endif /* CONFIG_AS_AVX */ ++ ++#ifdef CONFIG_AS_AVX2 ++.align 32 ++ENTRY(poly1305_blocks_avx2) ++ ++ movl 20(%rdi),%r8d ++ cmpq $128,%rdx ++ jae .Lblocks_avx2 ++ testl %r8d,%r8d ++ jz .Lblocks ++ ++.Lblocks_avx2: ++ andq $-16,%rdx ++ jz .Lno_data_avx2 ++ ++ vzeroupper ++ ++ testl %r8d,%r8d ++ jz .Lbase2_64_avx2 ++ ++ testq $63,%rdx ++ jz .Leven_avx2 ++ ++ pushq %rbx ++ pushq %r12 ++ pushq %r13 ++ pushq %r14 ++ pushq %r15 ++ pushq %rdi ++ ++.Lblocks_avx2_body: ++ ++ movq %rdx,%r15 ++ ++ movq 0(%rdi),%r8 ++ movq 8(%rdi),%r9 ++ movl 16(%rdi),%r10d ++ ++ movq 24(%rdi),%r11 ++ movq 32(%rdi),%r13 ++ ++ ++ movl %r8d,%r14d ++ andq $-2147483648,%r8 ++ movq %r9,%r12 ++ movl %r9d,%ebx ++ andq $-2147483648,%r9 ++ ++ shrq $6,%r8 ++ shlq $52,%r12 ++ addq %r8,%r14 ++ shrq $12,%rbx ++ shrq $18,%r9 ++ addq %r12,%r14 ++ adcq %r9,%rbx ++ ++ movq %r10,%r8 ++ shlq $40,%r8 ++ shrq $24,%r10 ++ addq %r8,%rbx ++ adcq $0,%r10 ++ ++ movq $-4,%r9 ++ movq %r10,%r8 ++ andq %r10,%r9 ++ shrq $2,%r8 ++ andq $3,%r10 ++ addq %r9,%r8 ++ addq %r8,%r14 ++ adcq $0,%rbx ++ adcq $0,%r10 ++ ++ movq %r13,%r12 ++ movq %r13,%rax ++ shrq $2,%r13 ++ addq %r12,%r13 ++ ++.Lbase2_26_pre_avx2: ++ addq 0(%rsi),%r14 ++ adcq 8(%rsi),%rbx ++ leaq 16(%rsi),%rsi ++ adcq %rcx,%r10 ++ subq $16,%r15 ++ ++ movq %rdi,0(%rsp) ++ __poly1305_block ++ movq 0(%rsp),%rdi ++ movq %r12,%rax ++ ++ testq $63,%r15 ++ jnz .Lbase2_26_pre_avx2 ++ ++ testq %rcx,%rcx ++ jz .Lstore_base2_64_avx2 ++ ++ ++ movq %r14,%rax ++ movq %r14,%rdx ++ shrq $52,%r14 ++ movq %rbx,%r11 ++ movq %rbx,%r12 ++ shrq $26,%rdx ++ andq $0x3ffffff,%rax ++ shlq $12,%r11 ++ andq $0x3ffffff,%rdx ++ shrq $14,%rbx ++ orq %r11,%r14 ++ shlq $24,%r10 ++ andq $0x3ffffff,%r14 ++ shrq $40,%r12 ++ andq $0x3ffffff,%rbx ++ orq %r12,%r10 ++ ++ testq %r15,%r15 ++ jz .Lstore_base2_26_avx2 ++ ++ vmovd %eax,%xmm0 ++ vmovd %edx,%xmm1 ++ vmovd %r14d,%xmm2 ++ vmovd %ebx,%xmm3 ++ vmovd %r10d,%xmm4 ++ jmp .Lproceed_avx2 ++ ++.align 32 ++.Lstore_base2_64_avx2: ++ movq %r14,0(%rdi) ++ movq %rbx,8(%rdi) ++ movq %r10,16(%rdi) ++ jmp .Ldone_avx2 ++ ++.align 16 ++.Lstore_base2_26_avx2: ++ movl %eax,0(%rdi) ++ movl %edx,4(%rdi) ++ movl %r14d,8(%rdi) ++ movl %ebx,12(%rdi) ++ movl %r10d,16(%rdi) ++.align 16 ++.Ldone_avx2: ++ movq 8(%rsp),%r15 ++ movq 16(%rsp),%r14 ++ movq 24(%rsp),%r13 ++ movq 32(%rsp),%r12 ++ movq 40(%rsp),%rbx ++ leaq 48(%rsp),%rsp ++ ++.Lno_data_avx2: ++.Lblocks_avx2_epilogue: ++ ret ++ ++ ++.align 32 ++.Lbase2_64_avx2: ++ ++ ++ pushq %rbx ++ pushq %r12 ++ pushq %r13 ++ pushq %r14 ++ pushq %r15 ++ pushq %rdi ++ ++.Lbase2_64_avx2_body: ++ ++ movq %rdx,%r15 ++ ++ movq 24(%rdi),%r11 ++ movq 32(%rdi),%r13 ++ ++ movq 0(%rdi),%r14 ++ movq 8(%rdi),%rbx ++ movl 16(%rdi),%r10d ++ ++ movq %r13,%r12 ++ movq %r13,%rax ++ shrq $2,%r13 ++ addq %r12,%r13 ++ ++ testq $63,%rdx ++ jz .Linit_avx2 ++ ++.Lbase2_64_pre_avx2: ++ addq 0(%rsi),%r14 ++ adcq 8(%rsi),%rbx ++ leaq 16(%rsi),%rsi ++ adcq %rcx,%r10 ++ subq $16,%r15 ++ ++ movq %rdi,0(%rsp) ++ __poly1305_block ++ movq 0(%rsp),%rdi ++ movq %r12,%rax ++ ++ testq $63,%r15 ++ jnz .Lbase2_64_pre_avx2 ++ ++.Linit_avx2: ++ ++ movq %r14,%rax ++ movq %r14,%rdx ++ shrq $52,%r14 ++ movq %rbx,%r8 ++ movq %rbx,%r9 ++ shrq $26,%rdx ++ andq $0x3ffffff,%rax ++ shlq $12,%r8 ++ andq $0x3ffffff,%rdx ++ shrq $14,%rbx ++ orq %r8,%r14 ++ shlq $24,%r10 ++ andq $0x3ffffff,%r14 ++ shrq $40,%r9 ++ andq $0x3ffffff,%rbx ++ orq %r9,%r10 ++ ++ vmovd %eax,%xmm0 ++ vmovd %edx,%xmm1 ++ vmovd %r14d,%xmm2 ++ vmovd %ebx,%xmm3 ++ vmovd %r10d,%xmm4 ++ movl $1,20(%rdi) ++ ++ __poly1305_init_avx ++ ++.Lproceed_avx2: ++ movq %r15,%rdx ++ ++ movq 8(%rsp),%r15 ++ movq 16(%rsp),%r14 ++ movq 24(%rsp),%r13 ++ movq 32(%rsp),%r12 ++ movq 40(%rsp),%rbx ++ leaq 48(%rsp),%rax ++ leaq 48(%rsp),%rsp ++ ++.Lbase2_64_avx2_epilogue: ++ jmp .Ldo_avx2 ++ ++ ++.align 32 ++.Leven_avx2: ++ ++ vmovd 0(%rdi),%xmm0 ++ vmovd 4(%rdi),%xmm1 ++ vmovd 8(%rdi),%xmm2 ++ vmovd 12(%rdi),%xmm3 ++ vmovd 16(%rdi),%xmm4 ++ ++.Ldo_avx2: ++ leaq 8(%rsp),%r10 ++ subq $0x128,%rsp ++ leaq .Lconst(%rip),%rcx ++ leaq 48+64(%rdi),%rdi ++ vmovdqa 96(%rcx),%ymm7 ++ ++ ++ vmovdqu -64(%rdi),%xmm9 ++ andq $-512,%rsp ++ vmovdqu -48(%rdi),%xmm10 ++ vmovdqu -32(%rdi),%xmm6 ++ vmovdqu -16(%rdi),%xmm11 ++ vmovdqu 0(%rdi),%xmm12 ++ vmovdqu 16(%rdi),%xmm13 ++ leaq 144(%rsp),%rax ++ vmovdqu 32(%rdi),%xmm14 ++ vpermd %ymm9,%ymm7,%ymm9 ++ vmovdqu 48(%rdi),%xmm15 ++ vpermd %ymm10,%ymm7,%ymm10 ++ vmovdqu 64(%rdi),%xmm5 ++ vpermd %ymm6,%ymm7,%ymm6 ++ vmovdqa %ymm9,0(%rsp) ++ vpermd %ymm11,%ymm7,%ymm11 ++ vmovdqa %ymm10,32-144(%rax) ++ vpermd %ymm12,%ymm7,%ymm12 ++ vmovdqa %ymm6,64-144(%rax) ++ vpermd %ymm13,%ymm7,%ymm13 ++ vmovdqa %ymm11,96-144(%rax) ++ vpermd %ymm14,%ymm7,%ymm14 ++ vmovdqa %ymm12,128-144(%rax) ++ vpermd %ymm15,%ymm7,%ymm15 ++ vmovdqa %ymm13,160-144(%rax) ++ vpermd %ymm5,%ymm7,%ymm5 ++ vmovdqa %ymm14,192-144(%rax) ++ vmovdqa %ymm15,224-144(%rax) ++ vmovdqa %ymm5,256-144(%rax) ++ vmovdqa 64(%rcx),%ymm5 ++ ++ ++ ++ vmovdqu 0(%rsi),%xmm7 ++ vmovdqu 16(%rsi),%xmm8 ++ vinserti128 $1,32(%rsi),%ymm7,%ymm7 ++ vinserti128 $1,48(%rsi),%ymm8,%ymm8 ++ leaq 64(%rsi),%rsi ++ ++ vpsrldq $6,%ymm7,%ymm9 ++ vpsrldq $6,%ymm8,%ymm10 ++ vpunpckhqdq %ymm8,%ymm7,%ymm6 ++ vpunpcklqdq %ymm10,%ymm9,%ymm9 ++ vpunpcklqdq %ymm8,%ymm7,%ymm7 ++ ++ vpsrlq $30,%ymm9,%ymm10 ++ vpsrlq $4,%ymm9,%ymm9 ++ vpsrlq $26,%ymm7,%ymm8 ++ vpsrlq $40,%ymm6,%ymm6 ++ vpand %ymm5,%ymm9,%ymm9 ++ vpand %ymm5,%ymm7,%ymm7 ++ vpand %ymm5,%ymm8,%ymm8 ++ vpand %ymm5,%ymm10,%ymm10 ++ vpor 32(%rcx),%ymm6,%ymm6 ++ ++ vpaddq %ymm2,%ymm9,%ymm2 ++ subq $64,%rdx ++ jz .Ltail_avx2 ++ jmp .Loop_avx2 ++ ++.align 32 ++.Loop_avx2: ++ ++ vpaddq %ymm0,%ymm7,%ymm0 ++ vmovdqa 0(%rsp),%ymm7 ++ vpaddq %ymm1,%ymm8,%ymm1 ++ vmovdqa 32(%rsp),%ymm8 ++ vpaddq %ymm3,%ymm10,%ymm3 ++ vmovdqa 96(%rsp),%ymm9 ++ vpaddq %ymm4,%ymm6,%ymm4 ++ vmovdqa 48(%rax),%ymm10 ++ vmovdqa 112(%rax),%ymm5 ++ ++ vpmuludq %ymm2,%ymm7,%ymm13 ++ vpmuludq %ymm2,%ymm8,%ymm14 ++ vpmuludq %ymm2,%ymm9,%ymm15 ++ vpmuludq %ymm2,%ymm10,%ymm11 ++ vpmuludq %ymm2,%ymm5,%ymm12 ++ ++ vpmuludq %ymm0,%ymm8,%ymm6 ++ vpmuludq %ymm1,%ymm8,%ymm2 ++ vpaddq %ymm6,%ymm12,%ymm12 ++ vpaddq %ymm2,%ymm13,%ymm13 ++ vpmuludq %ymm3,%ymm8,%ymm6 ++ vpmuludq 64(%rsp),%ymm4,%ymm2 ++ vpaddq %ymm6,%ymm15,%ymm15 ++ vpaddq %ymm2,%ymm11,%ymm11 ++ vmovdqa -16(%rax),%ymm8 ++ ++ vpmuludq %ymm0,%ymm7,%ymm6 ++ vpmuludq %ymm1,%ymm7,%ymm2 ++ vpaddq %ymm6,%ymm11,%ymm11 ++ vpaddq %ymm2,%ymm12,%ymm12 ++ vpmuludq %ymm3,%ymm7,%ymm6 ++ vpmuludq %ymm4,%ymm7,%ymm2 ++ vmovdqu 0(%rsi),%xmm7 ++ vpaddq %ymm6,%ymm14,%ymm14 ++ vpaddq %ymm2,%ymm15,%ymm15 ++ vinserti128 $1,32(%rsi),%ymm7,%ymm7 ++ ++ vpmuludq %ymm3,%ymm8,%ymm6 ++ vpmuludq %ymm4,%ymm8,%ymm2 ++ vmovdqu 16(%rsi),%xmm8 ++ vpaddq %ymm6,%ymm11,%ymm11 ++ vpaddq %ymm2,%ymm12,%ymm12 ++ vmovdqa 16(%rax),%ymm2 ++ vpmuludq %ymm1,%ymm9,%ymm6 ++ vpmuludq %ymm0,%ymm9,%ymm9 ++ vpaddq %ymm6,%ymm14,%ymm14 ++ vpaddq %ymm9,%ymm13,%ymm13 ++ vinserti128 $1,48(%rsi),%ymm8,%ymm8 ++ leaq 64(%rsi),%rsi ++ ++ vpmuludq %ymm1,%ymm2,%ymm6 ++ vpmuludq %ymm0,%ymm2,%ymm2 ++ vpsrldq $6,%ymm7,%ymm9 ++ vpaddq %ymm6,%ymm15,%ymm15 ++ vpaddq %ymm2,%ymm14,%ymm14 ++ vpmuludq %ymm3,%ymm10,%ymm6 ++ vpmuludq %ymm4,%ymm10,%ymm2 ++ vpsrldq $6,%ymm8,%ymm10 ++ vpaddq %ymm6,%ymm12,%ymm12 ++ vpaddq %ymm2,%ymm13,%ymm13 ++ vpunpckhqdq %ymm8,%ymm7,%ymm6 ++ ++ vpmuludq %ymm3,%ymm5,%ymm3 ++ vpmuludq %ymm4,%ymm5,%ymm4 ++ vpunpcklqdq %ymm8,%ymm7,%ymm7 ++ vpaddq %ymm3,%ymm13,%ymm2 ++ vpaddq %ymm4,%ymm14,%ymm3 ++ vpunpcklqdq %ymm10,%ymm9,%ymm10 ++ vpmuludq 80(%rax),%ymm0,%ymm4 ++ vpmuludq %ymm1,%ymm5,%ymm0 ++ vmovdqa 64(%rcx),%ymm5 ++ vpaddq %ymm4,%ymm15,%ymm4 ++ vpaddq %ymm0,%ymm11,%ymm0 ++ ++ vpsrlq $26,%ymm3,%ymm14 ++ vpand %ymm5,%ymm3,%ymm3 ++ vpaddq %ymm14,%ymm4,%ymm4 ++ ++ vpsrlq $26,%ymm0,%ymm11 ++ vpand %ymm5,%ymm0,%ymm0 ++ vpaddq %ymm11,%ymm12,%ymm1 ++ ++ vpsrlq $26,%ymm4,%ymm15 ++ vpand %ymm5,%ymm4,%ymm4 ++ ++ vpsrlq $4,%ymm10,%ymm9 ++ ++ vpsrlq $26,%ymm1,%ymm12 ++ vpand %ymm5,%ymm1,%ymm1 ++ vpaddq %ymm12,%ymm2,%ymm2 ++ ++ vpaddq %ymm15,%ymm0,%ymm0 ++ vpsllq $2,%ymm15,%ymm15 ++ vpaddq %ymm15,%ymm0,%ymm0 ++ ++ vpand %ymm5,%ymm9,%ymm9 ++ vpsrlq $26,%ymm7,%ymm8 ++ ++ vpsrlq $26,%ymm2,%ymm13 ++ vpand %ymm5,%ymm2,%ymm2 ++ vpaddq %ymm13,%ymm3,%ymm3 ++ ++ vpaddq %ymm9,%ymm2,%ymm2 ++ vpsrlq $30,%ymm10,%ymm10 ++ ++ vpsrlq $26,%ymm0,%ymm11 ++ vpand %ymm5,%ymm0,%ymm0 ++ vpaddq %ymm11,%ymm1,%ymm1 ++ ++ vpsrlq $40,%ymm6,%ymm6 ++ ++ vpsrlq $26,%ymm3,%ymm14 ++ vpand %ymm5,%ymm3,%ymm3 ++ vpaddq %ymm14,%ymm4,%ymm4 ++ ++ vpand %ymm5,%ymm7,%ymm7 ++ vpand %ymm5,%ymm8,%ymm8 ++ vpand %ymm5,%ymm10,%ymm10 ++ vpor 32(%rcx),%ymm6,%ymm6 ++ ++ subq $64,%rdx ++ jnz .Loop_avx2 ++ ++.byte 0x66,0x90 ++.Ltail_avx2: ++ ++ vpaddq %ymm0,%ymm7,%ymm0 ++ vmovdqu 4(%rsp),%ymm7 ++ vpaddq %ymm1,%ymm8,%ymm1 ++ vmovdqu 36(%rsp),%ymm8 ++ vpaddq %ymm3,%ymm10,%ymm3 ++ vmovdqu 100(%rsp),%ymm9 ++ vpaddq %ymm4,%ymm6,%ymm4 ++ vmovdqu 52(%rax),%ymm10 ++ vmovdqu 116(%rax),%ymm5 ++ ++ vpmuludq %ymm2,%ymm7,%ymm13 ++ vpmuludq %ymm2,%ymm8,%ymm14 ++ vpmuludq %ymm2,%ymm9,%ymm15 ++ vpmuludq %ymm2,%ymm10,%ymm11 ++ vpmuludq %ymm2,%ymm5,%ymm12 ++ ++ vpmuludq %ymm0,%ymm8,%ymm6 ++ vpmuludq %ymm1,%ymm8,%ymm2 ++ vpaddq %ymm6,%ymm12,%ymm12 ++ vpaddq %ymm2,%ymm13,%ymm13 ++ vpmuludq %ymm3,%ymm8,%ymm6 ++ vpmuludq 68(%rsp),%ymm4,%ymm2 ++ vpaddq %ymm6,%ymm15,%ymm15 ++ vpaddq %ymm2,%ymm11,%ymm11 ++ ++ vpmuludq %ymm0,%ymm7,%ymm6 ++ vpmuludq %ymm1,%ymm7,%ymm2 ++ vpaddq %ymm6,%ymm11,%ymm11 ++ vmovdqu -12(%rax),%ymm8 ++ vpaddq %ymm2,%ymm12,%ymm12 ++ vpmuludq %ymm3,%ymm7,%ymm6 ++ vpmuludq %ymm4,%ymm7,%ymm2 ++ vpaddq %ymm6,%ymm14,%ymm14 ++ vpaddq %ymm2,%ymm15,%ymm15 ++ ++ vpmuludq %ymm3,%ymm8,%ymm6 ++ vpmuludq %ymm4,%ymm8,%ymm2 ++ vpaddq %ymm6,%ymm11,%ymm11 ++ vpaddq %ymm2,%ymm12,%ymm12 ++ vmovdqu 20(%rax),%ymm2 ++ vpmuludq %ymm1,%ymm9,%ymm6 ++ vpmuludq %ymm0,%ymm9,%ymm9 ++ vpaddq %ymm6,%ymm14,%ymm14 ++ vpaddq %ymm9,%ymm13,%ymm13 ++ ++ vpmuludq %ymm1,%ymm2,%ymm6 ++ vpmuludq %ymm0,%ymm2,%ymm2 ++ vpaddq %ymm6,%ymm15,%ymm15 ++ vpaddq %ymm2,%ymm14,%ymm14 ++ vpmuludq %ymm3,%ymm10,%ymm6 ++ vpmuludq %ymm4,%ymm10,%ymm2 ++ vpaddq %ymm6,%ymm12,%ymm12 ++ vpaddq %ymm2,%ymm13,%ymm13 ++ ++ vpmuludq %ymm3,%ymm5,%ymm3 ++ vpmuludq %ymm4,%ymm5,%ymm4 ++ vpaddq %ymm3,%ymm13,%ymm2 ++ vpaddq %ymm4,%ymm14,%ymm3 ++ vpmuludq 84(%rax),%ymm0,%ymm4 ++ vpmuludq %ymm1,%ymm5,%ymm0 ++ vmovdqa 64(%rcx),%ymm5 ++ vpaddq %ymm4,%ymm15,%ymm4 ++ vpaddq %ymm0,%ymm11,%ymm0 ++ ++ vpsrldq $8,%ymm12,%ymm8 ++ vpsrldq $8,%ymm2,%ymm9 ++ vpsrldq $8,%ymm3,%ymm10 ++ vpsrldq $8,%ymm4,%ymm6 ++ vpsrldq $8,%ymm0,%ymm7 ++ vpaddq %ymm8,%ymm12,%ymm12 ++ vpaddq %ymm9,%ymm2,%ymm2 ++ vpaddq %ymm10,%ymm3,%ymm3 ++ vpaddq %ymm6,%ymm4,%ymm4 ++ vpaddq %ymm7,%ymm0,%ymm0 ++ ++ vpermq $0x2,%ymm3,%ymm10 ++ vpermq $0x2,%ymm4,%ymm6 ++ vpermq $0x2,%ymm0,%ymm7 ++ vpermq $0x2,%ymm12,%ymm8 ++ vpermq $0x2,%ymm2,%ymm9 ++ vpaddq %ymm10,%ymm3,%ymm3 ++ vpaddq %ymm6,%ymm4,%ymm4 ++ vpaddq %ymm7,%ymm0,%ymm0 ++ vpaddq %ymm8,%ymm12,%ymm12 ++ vpaddq %ymm9,%ymm2,%ymm2 ++ ++ vpsrlq $26,%ymm3,%ymm14 ++ vpand %ymm5,%ymm3,%ymm3 ++ vpaddq %ymm14,%ymm4,%ymm4 ++ ++ vpsrlq $26,%ymm0,%ymm11 ++ vpand %ymm5,%ymm0,%ymm0 ++ vpaddq %ymm11,%ymm12,%ymm1 ++ ++ vpsrlq $26,%ymm4,%ymm15 ++ vpand %ymm5,%ymm4,%ymm4 ++ ++ vpsrlq $26,%ymm1,%ymm12 ++ vpand %ymm5,%ymm1,%ymm1 ++ vpaddq %ymm12,%ymm2,%ymm2 ++ ++ vpaddq %ymm15,%ymm0,%ymm0 ++ vpsllq $2,%ymm15,%ymm15 ++ vpaddq %ymm15,%ymm0,%ymm0 ++ ++ vpsrlq $26,%ymm2,%ymm13 ++ vpand %ymm5,%ymm2,%ymm2 ++ vpaddq %ymm13,%ymm3,%ymm3 ++ ++ vpsrlq $26,%ymm0,%ymm11 ++ vpand %ymm5,%ymm0,%ymm0 ++ vpaddq %ymm11,%ymm1,%ymm1 ++ ++ vpsrlq $26,%ymm3,%ymm14 ++ vpand %ymm5,%ymm3,%ymm3 ++ vpaddq %ymm14,%ymm4,%ymm4 ++ ++ vmovd %xmm0,-112(%rdi) ++ vmovd %xmm1,-108(%rdi) ++ vmovd %xmm2,-104(%rdi) ++ vmovd %xmm3,-100(%rdi) ++ vmovd %xmm4,-96(%rdi) ++ leaq -8(%r10),%rsp ++ ++ vzeroupper ++ ret ++ ++ENDPROC(poly1305_blocks_avx2) ++#endif /* CONFIG_AS_AVX2 */ ++ ++#ifdef CONFIG_AS_AVX512 ++.align 32 ++ENTRY(poly1305_blocks_avx512) ++ ++ movl 20(%rdi),%r8d ++ cmpq $128,%rdx ++ jae .Lblocks_avx2_512 ++ testl %r8d,%r8d ++ jz .Lblocks ++ ++.Lblocks_avx2_512: ++ andq $-16,%rdx ++ jz .Lno_data_avx2_512 ++ ++ vzeroupper ++ ++ testl %r8d,%r8d ++ jz .Lbase2_64_avx2_512 ++ ++ testq $63,%rdx ++ jz .Leven_avx2_512 ++ ++ pushq %rbx ++ pushq %r12 ++ pushq %r13 ++ pushq %r14 ++ pushq %r15 ++ pushq %rdi ++ ++.Lblocks_avx2_body_512: ++ ++ movq %rdx,%r15 ++ ++ movq 0(%rdi),%r8 ++ movq 8(%rdi),%r9 ++ movl 16(%rdi),%r10d ++ ++ movq 24(%rdi),%r11 ++ movq 32(%rdi),%r13 ++ ++ ++ movl %r8d,%r14d ++ andq $-2147483648,%r8 ++ movq %r9,%r12 ++ movl %r9d,%ebx ++ andq $-2147483648,%r9 ++ ++ shrq $6,%r8 ++ shlq $52,%r12 ++ addq %r8,%r14 ++ shrq $12,%rbx ++ shrq $18,%r9 ++ addq %r12,%r14 ++ adcq %r9,%rbx ++ ++ movq %r10,%r8 ++ shlq $40,%r8 ++ shrq $24,%r10 ++ addq %r8,%rbx ++ adcq $0,%r10 ++ ++ movq $-4,%r9 ++ movq %r10,%r8 ++ andq %r10,%r9 ++ shrq $2,%r8 ++ andq $3,%r10 ++ addq %r9,%r8 ++ addq %r8,%r14 ++ adcq $0,%rbx ++ adcq $0,%r10 ++ ++ movq %r13,%r12 ++ movq %r13,%rax ++ shrq $2,%r13 ++ addq %r12,%r13 ++ ++.Lbase2_26_pre_avx2_512: ++ addq 0(%rsi),%r14 ++ adcq 8(%rsi),%rbx ++ leaq 16(%rsi),%rsi ++ adcq %rcx,%r10 ++ subq $16,%r15 ++ ++ movq %rdi,0(%rsp) ++ __poly1305_block ++ movq 0(%rsp),%rdi ++ movq %r12,%rax ++ ++ testq $63,%r15 ++ jnz .Lbase2_26_pre_avx2_512 ++ ++ testq %rcx,%rcx ++ jz .Lstore_base2_64_avx2_512 ++ ++ ++ movq %r14,%rax ++ movq %r14,%rdx ++ shrq $52,%r14 ++ movq %rbx,%r11 ++ movq %rbx,%r12 ++ shrq $26,%rdx ++ andq $0x3ffffff,%rax ++ shlq $12,%r11 ++ andq $0x3ffffff,%rdx ++ shrq $14,%rbx ++ orq %r11,%r14 ++ shlq $24,%r10 ++ andq $0x3ffffff,%r14 ++ shrq $40,%r12 ++ andq $0x3ffffff,%rbx ++ orq %r12,%r10 ++ ++ testq %r15,%r15 ++ jz .Lstore_base2_26_avx2_512 ++ ++ vmovd %eax,%xmm0 ++ vmovd %edx,%xmm1 ++ vmovd %r14d,%xmm2 ++ vmovd %ebx,%xmm3 ++ vmovd %r10d,%xmm4 ++ jmp .Lproceed_avx2_512 ++ ++.align 32 ++.Lstore_base2_64_avx2_512: ++ movq %r14,0(%rdi) ++ movq %rbx,8(%rdi) ++ movq %r10,16(%rdi) ++ jmp .Ldone_avx2_512 ++ ++.align 16 ++.Lstore_base2_26_avx2_512: ++ movl %eax,0(%rdi) ++ movl %edx,4(%rdi) ++ movl %r14d,8(%rdi) ++ movl %ebx,12(%rdi) ++ movl %r10d,16(%rdi) ++.align 16 ++.Ldone_avx2_512: ++ movq 8(%rsp),%r15 ++ movq 16(%rsp),%r14 ++ movq 24(%rsp),%r13 ++ movq 32(%rsp),%r12 ++ movq 40(%rsp),%rbx ++ leaq 48(%rsp),%rsp ++ ++.Lno_data_avx2_512: ++.Lblocks_avx2_epilogue_512: ++ ret ++ ++ ++.align 32 ++.Lbase2_64_avx2_512: ++ ++ pushq %rbx ++ pushq %r12 ++ pushq %r13 ++ pushq %r14 ++ pushq %r15 ++ pushq %rdi ++ ++.Lbase2_64_avx2_body_512: ++ ++ movq %rdx,%r15 ++ ++ movq 24(%rdi),%r11 ++ movq 32(%rdi),%r13 ++ ++ movq 0(%rdi),%r14 ++ movq 8(%rdi),%rbx ++ movl 16(%rdi),%r10d ++ ++ movq %r13,%r12 ++ movq %r13,%rax ++ shrq $2,%r13 ++ addq %r12,%r13 ++ ++ testq $63,%rdx ++ jz .Linit_avx2_512 ++ ++.Lbase2_64_pre_avx2_512: ++ addq 0(%rsi),%r14 ++ adcq 8(%rsi),%rbx ++ leaq 16(%rsi),%rsi ++ adcq %rcx,%r10 ++ subq $16,%r15 ++ ++ movq %rdi,0(%rsp) ++ __poly1305_block ++ movq 0(%rsp),%rdi ++ movq %r12,%rax ++ ++ testq $63,%r15 ++ jnz .Lbase2_64_pre_avx2_512 ++ ++.Linit_avx2_512: ++ ++ movq %r14,%rax ++ movq %r14,%rdx ++ shrq $52,%r14 ++ movq %rbx,%r8 ++ movq %rbx,%r9 ++ shrq $26,%rdx ++ andq $0x3ffffff,%rax ++ shlq $12,%r8 ++ andq $0x3ffffff,%rdx ++ shrq $14,%rbx ++ orq %r8,%r14 ++ shlq $24,%r10 ++ andq $0x3ffffff,%r14 ++ shrq $40,%r9 ++ andq $0x3ffffff,%rbx ++ orq %r9,%r10 ++ ++ vmovd %eax,%xmm0 ++ vmovd %edx,%xmm1 ++ vmovd %r14d,%xmm2 ++ vmovd %ebx,%xmm3 ++ vmovd %r10d,%xmm4 ++ movl $1,20(%rdi) ++ ++ __poly1305_init_avx ++ ++.Lproceed_avx2_512: ++ movq %r15,%rdx ++ ++ movq 8(%rsp),%r15 ++ movq 16(%rsp),%r14 ++ movq 24(%rsp),%r13 ++ movq 32(%rsp),%r12 ++ movq 40(%rsp),%rbx ++ leaq 48(%rsp),%rax ++ leaq 48(%rsp),%rsp ++ ++.Lbase2_64_avx2_epilogue_512: ++ jmp .Ldo_avx2_512 ++ ++ ++.align 32 ++.Leven_avx2_512: ++ ++ vmovd 0(%rdi),%xmm0 ++ vmovd 4(%rdi),%xmm1 ++ vmovd 8(%rdi),%xmm2 ++ vmovd 12(%rdi),%xmm3 ++ vmovd 16(%rdi),%xmm4 ++ ++.Ldo_avx2_512: ++ cmpq $512,%rdx ++ jae .Lblocks_avx512 ++.Lskip_avx512: ++ leaq 8(%rsp),%r10 ++ ++ subq $0x128,%rsp ++ leaq .Lconst(%rip),%rcx ++ leaq 48+64(%rdi),%rdi ++ vmovdqa 96(%rcx),%ymm7 ++ ++ ++ vmovdqu -64(%rdi),%xmm9 ++ andq $-512,%rsp ++ vmovdqu -48(%rdi),%xmm10 ++ vmovdqu -32(%rdi),%xmm6 ++ vmovdqu -16(%rdi),%xmm11 ++ vmovdqu 0(%rdi),%xmm12 ++ vmovdqu 16(%rdi),%xmm13 ++ leaq 144(%rsp),%rax ++ vmovdqu 32(%rdi),%xmm14 ++ vpermd %ymm9,%ymm7,%ymm9 ++ vmovdqu 48(%rdi),%xmm15 ++ vpermd %ymm10,%ymm7,%ymm10 ++ vmovdqu 64(%rdi),%xmm5 ++ vpermd %ymm6,%ymm7,%ymm6 ++ vmovdqa %ymm9,0(%rsp) ++ vpermd %ymm11,%ymm7,%ymm11 ++ vmovdqa %ymm10,32-144(%rax) ++ vpermd %ymm12,%ymm7,%ymm12 ++ vmovdqa %ymm6,64-144(%rax) ++ vpermd %ymm13,%ymm7,%ymm13 ++ vmovdqa %ymm11,96-144(%rax) ++ vpermd %ymm14,%ymm7,%ymm14 ++ vmovdqa %ymm12,128-144(%rax) ++ vpermd %ymm15,%ymm7,%ymm15 ++ vmovdqa %ymm13,160-144(%rax) ++ vpermd %ymm5,%ymm7,%ymm5 ++ vmovdqa %ymm14,192-144(%rax) ++ vmovdqa %ymm15,224-144(%rax) ++ vmovdqa %ymm5,256-144(%rax) ++ vmovdqa 64(%rcx),%ymm5 ++ ++ ++ ++ vmovdqu 0(%rsi),%xmm7 ++ vmovdqu 16(%rsi),%xmm8 ++ vinserti128 $1,32(%rsi),%ymm7,%ymm7 ++ vinserti128 $1,48(%rsi),%ymm8,%ymm8 ++ leaq 64(%rsi),%rsi ++ ++ vpsrldq $6,%ymm7,%ymm9 ++ vpsrldq $6,%ymm8,%ymm10 ++ vpunpckhqdq %ymm8,%ymm7,%ymm6 ++ vpunpcklqdq %ymm10,%ymm9,%ymm9 ++ vpunpcklqdq %ymm8,%ymm7,%ymm7 ++ ++ vpsrlq $30,%ymm9,%ymm10 ++ vpsrlq $4,%ymm9,%ymm9 ++ vpsrlq $26,%ymm7,%ymm8 ++ vpsrlq $40,%ymm6,%ymm6 ++ vpand %ymm5,%ymm9,%ymm9 ++ vpand %ymm5,%ymm7,%ymm7 ++ vpand %ymm5,%ymm8,%ymm8 ++ vpand %ymm5,%ymm10,%ymm10 ++ vpor 32(%rcx),%ymm6,%ymm6 ++ ++ vpaddq %ymm2,%ymm9,%ymm2 ++ subq $64,%rdx ++ jz .Ltail_avx2_512 ++ jmp .Loop_avx2_512 ++ ++.align 32 ++.Loop_avx2_512: ++ ++ vpaddq %ymm0,%ymm7,%ymm0 ++ vmovdqa 0(%rsp),%ymm7 ++ vpaddq %ymm1,%ymm8,%ymm1 ++ vmovdqa 32(%rsp),%ymm8 ++ vpaddq %ymm3,%ymm10,%ymm3 ++ vmovdqa 96(%rsp),%ymm9 ++ vpaddq %ymm4,%ymm6,%ymm4 ++ vmovdqa 48(%rax),%ymm10 ++ vmovdqa 112(%rax),%ymm5 ++ ++ vpmuludq %ymm2,%ymm7,%ymm13 ++ vpmuludq %ymm2,%ymm8,%ymm14 ++ vpmuludq %ymm2,%ymm9,%ymm15 ++ vpmuludq %ymm2,%ymm10,%ymm11 ++ vpmuludq %ymm2,%ymm5,%ymm12 ++ ++ vpmuludq %ymm0,%ymm8,%ymm6 ++ vpmuludq %ymm1,%ymm8,%ymm2 ++ vpaddq %ymm6,%ymm12,%ymm12 ++ vpaddq %ymm2,%ymm13,%ymm13 ++ vpmuludq %ymm3,%ymm8,%ymm6 ++ vpmuludq 64(%rsp),%ymm4,%ymm2 ++ vpaddq %ymm6,%ymm15,%ymm15 ++ vpaddq %ymm2,%ymm11,%ymm11 ++ vmovdqa -16(%rax),%ymm8 ++ ++ vpmuludq %ymm0,%ymm7,%ymm6 ++ vpmuludq %ymm1,%ymm7,%ymm2 ++ vpaddq %ymm6,%ymm11,%ymm11 ++ vpaddq %ymm2,%ymm12,%ymm12 ++ vpmuludq %ymm3,%ymm7,%ymm6 ++ vpmuludq %ymm4,%ymm7,%ymm2 ++ vmovdqu 0(%rsi),%xmm7 ++ vpaddq %ymm6,%ymm14,%ymm14 ++ vpaddq %ymm2,%ymm15,%ymm15 ++ vinserti128 $1,32(%rsi),%ymm7,%ymm7 ++ ++ vpmuludq %ymm3,%ymm8,%ymm6 ++ vpmuludq %ymm4,%ymm8,%ymm2 ++ vmovdqu 16(%rsi),%xmm8 ++ vpaddq %ymm6,%ymm11,%ymm11 ++ vpaddq %ymm2,%ymm12,%ymm12 ++ vmovdqa 16(%rax),%ymm2 ++ vpmuludq %ymm1,%ymm9,%ymm6 ++ vpmuludq %ymm0,%ymm9,%ymm9 ++ vpaddq %ymm6,%ymm14,%ymm14 ++ vpaddq %ymm9,%ymm13,%ymm13 ++ vinserti128 $1,48(%rsi),%ymm8,%ymm8 ++ leaq 64(%rsi),%rsi ++ ++ vpmuludq %ymm1,%ymm2,%ymm6 ++ vpmuludq %ymm0,%ymm2,%ymm2 ++ vpsrldq $6,%ymm7,%ymm9 ++ vpaddq %ymm6,%ymm15,%ymm15 ++ vpaddq %ymm2,%ymm14,%ymm14 ++ vpmuludq %ymm3,%ymm10,%ymm6 ++ vpmuludq %ymm4,%ymm10,%ymm2 ++ vpsrldq $6,%ymm8,%ymm10 ++ vpaddq %ymm6,%ymm12,%ymm12 ++ vpaddq %ymm2,%ymm13,%ymm13 ++ vpunpckhqdq %ymm8,%ymm7,%ymm6 ++ ++ vpmuludq %ymm3,%ymm5,%ymm3 ++ vpmuludq %ymm4,%ymm5,%ymm4 ++ vpunpcklqdq %ymm8,%ymm7,%ymm7 ++ vpaddq %ymm3,%ymm13,%ymm2 ++ vpaddq %ymm4,%ymm14,%ymm3 ++ vpunpcklqdq %ymm10,%ymm9,%ymm10 ++ vpmuludq 80(%rax),%ymm0,%ymm4 ++ vpmuludq %ymm1,%ymm5,%ymm0 ++ vmovdqa 64(%rcx),%ymm5 ++ vpaddq %ymm4,%ymm15,%ymm4 ++ vpaddq %ymm0,%ymm11,%ymm0 ++ ++ vpsrlq $26,%ymm3,%ymm14 ++ vpand %ymm5,%ymm3,%ymm3 ++ vpaddq %ymm14,%ymm4,%ymm4 ++ ++ vpsrlq $26,%ymm0,%ymm11 ++ vpand %ymm5,%ymm0,%ymm0 ++ vpaddq %ymm11,%ymm12,%ymm1 ++ ++ vpsrlq $26,%ymm4,%ymm15 ++ vpand %ymm5,%ymm4,%ymm4 ++ ++ vpsrlq $4,%ymm10,%ymm9 ++ ++ vpsrlq $26,%ymm1,%ymm12 ++ vpand %ymm5,%ymm1,%ymm1 ++ vpaddq %ymm12,%ymm2,%ymm2 ++ ++ vpaddq %ymm15,%ymm0,%ymm0 ++ vpsllq $2,%ymm15,%ymm15 ++ vpaddq %ymm15,%ymm0,%ymm0 ++ ++ vpand %ymm5,%ymm9,%ymm9 ++ vpsrlq $26,%ymm7,%ymm8 ++ ++ vpsrlq $26,%ymm2,%ymm13 ++ vpand %ymm5,%ymm2,%ymm2 ++ vpaddq %ymm13,%ymm3,%ymm3 ++ ++ vpaddq %ymm9,%ymm2,%ymm2 ++ vpsrlq $30,%ymm10,%ymm10 ++ ++ vpsrlq $26,%ymm0,%ymm11 ++ vpand %ymm5,%ymm0,%ymm0 ++ vpaddq %ymm11,%ymm1,%ymm1 ++ ++ vpsrlq $40,%ymm6,%ymm6 ++ ++ vpsrlq $26,%ymm3,%ymm14 ++ vpand %ymm5,%ymm3,%ymm3 ++ vpaddq %ymm14,%ymm4,%ymm4 ++ ++ vpand %ymm5,%ymm7,%ymm7 ++ vpand %ymm5,%ymm8,%ymm8 ++ vpand %ymm5,%ymm10,%ymm10 ++ vpor 32(%rcx),%ymm6,%ymm6 ++ ++ subq $64,%rdx ++ jnz .Loop_avx2_512 ++ ++.byte 0x66,0x90 ++.Ltail_avx2_512: ++ ++ vpaddq %ymm0,%ymm7,%ymm0 ++ vmovdqu 4(%rsp),%ymm7 ++ vpaddq %ymm1,%ymm8,%ymm1 ++ vmovdqu 36(%rsp),%ymm8 ++ vpaddq %ymm3,%ymm10,%ymm3 ++ vmovdqu 100(%rsp),%ymm9 ++ vpaddq %ymm4,%ymm6,%ymm4 ++ vmovdqu 52(%rax),%ymm10 ++ vmovdqu 116(%rax),%ymm5 ++ ++ vpmuludq %ymm2,%ymm7,%ymm13 ++ vpmuludq %ymm2,%ymm8,%ymm14 ++ vpmuludq %ymm2,%ymm9,%ymm15 ++ vpmuludq %ymm2,%ymm10,%ymm11 ++ vpmuludq %ymm2,%ymm5,%ymm12 ++ ++ vpmuludq %ymm0,%ymm8,%ymm6 ++ vpmuludq %ymm1,%ymm8,%ymm2 ++ vpaddq %ymm6,%ymm12,%ymm12 ++ vpaddq %ymm2,%ymm13,%ymm13 ++ vpmuludq %ymm3,%ymm8,%ymm6 ++ vpmuludq 68(%rsp),%ymm4,%ymm2 ++ vpaddq %ymm6,%ymm15,%ymm15 ++ vpaddq %ymm2,%ymm11,%ymm11 ++ ++ vpmuludq %ymm0,%ymm7,%ymm6 ++ vpmuludq %ymm1,%ymm7,%ymm2 ++ vpaddq %ymm6,%ymm11,%ymm11 ++ vmovdqu -12(%rax),%ymm8 ++ vpaddq %ymm2,%ymm12,%ymm12 ++ vpmuludq %ymm3,%ymm7,%ymm6 ++ vpmuludq %ymm4,%ymm7,%ymm2 ++ vpaddq %ymm6,%ymm14,%ymm14 ++ vpaddq %ymm2,%ymm15,%ymm15 ++ ++ vpmuludq %ymm3,%ymm8,%ymm6 ++ vpmuludq %ymm4,%ymm8,%ymm2 ++ vpaddq %ymm6,%ymm11,%ymm11 ++ vpaddq %ymm2,%ymm12,%ymm12 ++ vmovdqu 20(%rax),%ymm2 ++ vpmuludq %ymm1,%ymm9,%ymm6 ++ vpmuludq %ymm0,%ymm9,%ymm9 ++ vpaddq %ymm6,%ymm14,%ymm14 ++ vpaddq %ymm9,%ymm13,%ymm13 ++ ++ vpmuludq %ymm1,%ymm2,%ymm6 ++ vpmuludq %ymm0,%ymm2,%ymm2 ++ vpaddq %ymm6,%ymm15,%ymm15 ++ vpaddq %ymm2,%ymm14,%ymm14 ++ vpmuludq %ymm3,%ymm10,%ymm6 ++ vpmuludq %ymm4,%ymm10,%ymm2 ++ vpaddq %ymm6,%ymm12,%ymm12 ++ vpaddq %ymm2,%ymm13,%ymm13 ++ ++ vpmuludq %ymm3,%ymm5,%ymm3 ++ vpmuludq %ymm4,%ymm5,%ymm4 ++ vpaddq %ymm3,%ymm13,%ymm2 ++ vpaddq %ymm4,%ymm14,%ymm3 ++ vpmuludq 84(%rax),%ymm0,%ymm4 ++ vpmuludq %ymm1,%ymm5,%ymm0 ++ vmovdqa 64(%rcx),%ymm5 ++ vpaddq %ymm4,%ymm15,%ymm4 ++ vpaddq %ymm0,%ymm11,%ymm0 ++ ++ vpsrldq $8,%ymm12,%ymm8 ++ vpsrldq $8,%ymm2,%ymm9 ++ vpsrldq $8,%ymm3,%ymm10 ++ vpsrldq $8,%ymm4,%ymm6 ++ vpsrldq $8,%ymm0,%ymm7 ++ vpaddq %ymm8,%ymm12,%ymm12 ++ vpaddq %ymm9,%ymm2,%ymm2 ++ vpaddq %ymm10,%ymm3,%ymm3 ++ vpaddq %ymm6,%ymm4,%ymm4 ++ vpaddq %ymm7,%ymm0,%ymm0 ++ ++ vpermq $0x2,%ymm3,%ymm10 ++ vpermq $0x2,%ymm4,%ymm6 ++ vpermq $0x2,%ymm0,%ymm7 ++ vpermq $0x2,%ymm12,%ymm8 ++ vpermq $0x2,%ymm2,%ymm9 ++ vpaddq %ymm10,%ymm3,%ymm3 ++ vpaddq %ymm6,%ymm4,%ymm4 ++ vpaddq %ymm7,%ymm0,%ymm0 ++ vpaddq %ymm8,%ymm12,%ymm12 ++ vpaddq %ymm9,%ymm2,%ymm2 ++ ++ vpsrlq $26,%ymm3,%ymm14 ++ vpand %ymm5,%ymm3,%ymm3 ++ vpaddq %ymm14,%ymm4,%ymm4 ++ ++ vpsrlq $26,%ymm0,%ymm11 ++ vpand %ymm5,%ymm0,%ymm0 ++ vpaddq %ymm11,%ymm12,%ymm1 ++ ++ vpsrlq $26,%ymm4,%ymm15 ++ vpand %ymm5,%ymm4,%ymm4 ++ ++ vpsrlq $26,%ymm1,%ymm12 ++ vpand %ymm5,%ymm1,%ymm1 ++ vpaddq %ymm12,%ymm2,%ymm2 ++ ++ vpaddq %ymm15,%ymm0,%ymm0 ++ vpsllq $2,%ymm15,%ymm15 ++ vpaddq %ymm15,%ymm0,%ymm0 ++ ++ vpsrlq $26,%ymm2,%ymm13 ++ vpand %ymm5,%ymm2,%ymm2 ++ vpaddq %ymm13,%ymm3,%ymm3 ++ ++ vpsrlq $26,%ymm0,%ymm11 ++ vpand %ymm5,%ymm0,%ymm0 ++ vpaddq %ymm11,%ymm1,%ymm1 ++ ++ vpsrlq $26,%ymm3,%ymm14 ++ vpand %ymm5,%ymm3,%ymm3 ++ vpaddq %ymm14,%ymm4,%ymm4 ++ ++ vmovd %xmm0,-112(%rdi) ++ vmovd %xmm1,-108(%rdi) ++ vmovd %xmm2,-104(%rdi) ++ vmovd %xmm3,-100(%rdi) ++ vmovd %xmm4,-96(%rdi) ++ leaq -8(%r10),%rsp ++ ++ vzeroupper ++ ret ++ ++.Lblocks_avx512: ++ ++ movl $15,%eax ++ kmovw %eax,%k2 ++ leaq 8(%rsp),%r10 ++ ++ subq $0x128,%rsp ++ leaq .Lconst(%rip),%rcx ++ leaq 48+64(%rdi),%rdi ++ vmovdqa 96(%rcx),%ymm9 ++ ++ vmovdqu32 -64(%rdi),%zmm16{%k2}{z} ++ andq $-512,%rsp ++ vmovdqu32 -48(%rdi),%zmm17{%k2}{z} ++ movq $0x20,%rax ++ vmovdqu32 -32(%rdi),%zmm21{%k2}{z} ++ vmovdqu32 -16(%rdi),%zmm18{%k2}{z} ++ vmovdqu32 0(%rdi),%zmm22{%k2}{z} ++ vmovdqu32 16(%rdi),%zmm19{%k2}{z} ++ vmovdqu32 32(%rdi),%zmm23{%k2}{z} ++ vmovdqu32 48(%rdi),%zmm20{%k2}{z} ++ vmovdqu32 64(%rdi),%zmm24{%k2}{z} ++ vpermd %zmm16,%zmm9,%zmm16 ++ vpbroadcastq 64(%rcx),%zmm5 ++ vpermd %zmm17,%zmm9,%zmm17 ++ vpermd %zmm21,%zmm9,%zmm21 ++ vpermd %zmm18,%zmm9,%zmm18 ++ vmovdqa64 %zmm16,0(%rsp){%k2} ++ vpsrlq $32,%zmm16,%zmm7 ++ vpermd %zmm22,%zmm9,%zmm22 ++ vmovdqu64 %zmm17,0(%rsp,%rax,1){%k2} ++ vpsrlq $32,%zmm17,%zmm8 ++ vpermd %zmm19,%zmm9,%zmm19 ++ vmovdqa64 %zmm21,64(%rsp){%k2} ++ vpermd %zmm23,%zmm9,%zmm23 ++ vpermd %zmm20,%zmm9,%zmm20 ++ vmovdqu64 %zmm18,64(%rsp,%rax,1){%k2} ++ vpermd %zmm24,%zmm9,%zmm24 ++ vmovdqa64 %zmm22,128(%rsp){%k2} ++ vmovdqu64 %zmm19,128(%rsp,%rax,1){%k2} ++ vmovdqa64 %zmm23,192(%rsp){%k2} ++ vmovdqu64 %zmm20,192(%rsp,%rax,1){%k2} ++ vmovdqa64 %zmm24,256(%rsp){%k2} ++ ++ vpmuludq %zmm7,%zmm16,%zmm11 ++ vpmuludq %zmm7,%zmm17,%zmm12 ++ vpmuludq %zmm7,%zmm18,%zmm13 ++ vpmuludq %zmm7,%zmm19,%zmm14 ++ vpmuludq %zmm7,%zmm20,%zmm15 ++ vpsrlq $32,%zmm18,%zmm9 ++ ++ vpmuludq %zmm8,%zmm24,%zmm25 ++ vpmuludq %zmm8,%zmm16,%zmm26 ++ vpmuludq %zmm8,%zmm17,%zmm27 ++ vpmuludq %zmm8,%zmm18,%zmm28 ++ vpmuludq %zmm8,%zmm19,%zmm29 ++ vpsrlq $32,%zmm19,%zmm10 ++ vpaddq %zmm25,%zmm11,%zmm11 ++ vpaddq %zmm26,%zmm12,%zmm12 ++ vpaddq %zmm27,%zmm13,%zmm13 ++ vpaddq %zmm28,%zmm14,%zmm14 ++ vpaddq %zmm29,%zmm15,%zmm15 ++ ++ vpmuludq %zmm9,%zmm23,%zmm25 ++ vpmuludq %zmm9,%zmm24,%zmm26 ++ vpmuludq %zmm9,%zmm17,%zmm28 ++ vpmuludq %zmm9,%zmm18,%zmm29 ++ vpmuludq %zmm9,%zmm16,%zmm27 ++ vpsrlq $32,%zmm20,%zmm6 ++ vpaddq %zmm25,%zmm11,%zmm11 ++ vpaddq %zmm26,%zmm12,%zmm12 ++ vpaddq %zmm28,%zmm14,%zmm14 ++ vpaddq %zmm29,%zmm15,%zmm15 ++ vpaddq %zmm27,%zmm13,%zmm13 ++ ++ vpmuludq %zmm10,%zmm22,%zmm25 ++ vpmuludq %zmm10,%zmm16,%zmm28 ++ vpmuludq %zmm10,%zmm17,%zmm29 ++ vpmuludq %zmm10,%zmm23,%zmm26 ++ vpmuludq %zmm10,%zmm24,%zmm27 ++ vpaddq %zmm25,%zmm11,%zmm11 ++ vpaddq %zmm28,%zmm14,%zmm14 ++ vpaddq %zmm29,%zmm15,%zmm15 ++ vpaddq %zmm26,%zmm12,%zmm12 ++ vpaddq %zmm27,%zmm13,%zmm13 ++ ++ vpmuludq %zmm6,%zmm24,%zmm28 ++ vpmuludq %zmm6,%zmm16,%zmm29 ++ vpmuludq %zmm6,%zmm21,%zmm25 ++ vpmuludq %zmm6,%zmm22,%zmm26 ++ vpmuludq %zmm6,%zmm23,%zmm27 ++ vpaddq %zmm28,%zmm14,%zmm14 ++ vpaddq %zmm29,%zmm15,%zmm15 ++ vpaddq %zmm25,%zmm11,%zmm11 ++ vpaddq %zmm26,%zmm12,%zmm12 ++ vpaddq %zmm27,%zmm13,%zmm13 ++ ++ vmovdqu64 0(%rsi),%zmm10 ++ vmovdqu64 64(%rsi),%zmm6 ++ leaq 128(%rsi),%rsi ++ ++ vpsrlq $26,%zmm14,%zmm28 ++ vpandq %zmm5,%zmm14,%zmm14 ++ vpaddq %zmm28,%zmm15,%zmm15 ++ ++ vpsrlq $26,%zmm11,%zmm25 ++ vpandq %zmm5,%zmm11,%zmm11 ++ vpaddq %zmm25,%zmm12,%zmm12 ++ ++ vpsrlq $26,%zmm15,%zmm29 ++ vpandq %zmm5,%zmm15,%zmm15 ++ ++ vpsrlq $26,%zmm12,%zmm26 ++ vpandq %zmm5,%zmm12,%zmm12 ++ vpaddq %zmm26,%zmm13,%zmm13 ++ ++ vpaddq %zmm29,%zmm11,%zmm11 ++ vpsllq $2,%zmm29,%zmm29 ++ vpaddq %zmm29,%zmm11,%zmm11 ++ ++ vpsrlq $26,%zmm13,%zmm27 ++ vpandq %zmm5,%zmm13,%zmm13 ++ vpaddq %zmm27,%zmm14,%zmm14 ++ ++ vpsrlq $26,%zmm11,%zmm25 ++ vpandq %zmm5,%zmm11,%zmm11 ++ vpaddq %zmm25,%zmm12,%zmm12 ++ ++ vpsrlq $26,%zmm14,%zmm28 ++ vpandq %zmm5,%zmm14,%zmm14 ++ vpaddq %zmm28,%zmm15,%zmm15 ++ ++ vpunpcklqdq %zmm6,%zmm10,%zmm7 ++ vpunpckhqdq %zmm6,%zmm10,%zmm6 ++ ++ vmovdqa32 128(%rcx),%zmm25 ++ movl $0x7777,%eax ++ kmovw %eax,%k1 ++ ++ vpermd %zmm16,%zmm25,%zmm16 ++ vpermd %zmm17,%zmm25,%zmm17 ++ vpermd %zmm18,%zmm25,%zmm18 ++ vpermd %zmm19,%zmm25,%zmm19 ++ vpermd %zmm20,%zmm25,%zmm20 ++ ++ vpermd %zmm11,%zmm25,%zmm16{%k1} ++ vpermd %zmm12,%zmm25,%zmm17{%k1} ++ vpermd %zmm13,%zmm25,%zmm18{%k1} ++ vpermd %zmm14,%zmm25,%zmm19{%k1} ++ vpermd %zmm15,%zmm25,%zmm20{%k1} ++ ++ vpslld $2,%zmm17,%zmm21 ++ vpslld $2,%zmm18,%zmm22 ++ vpslld $2,%zmm19,%zmm23 ++ vpslld $2,%zmm20,%zmm24 ++ vpaddd %zmm17,%zmm21,%zmm21 ++ vpaddd %zmm18,%zmm22,%zmm22 ++ vpaddd %zmm19,%zmm23,%zmm23 ++ vpaddd %zmm20,%zmm24,%zmm24 ++ ++ vpbroadcastq 32(%rcx),%zmm30 ++ ++ vpsrlq $52,%zmm7,%zmm9 ++ vpsllq $12,%zmm6,%zmm10 ++ vporq %zmm10,%zmm9,%zmm9 ++ vpsrlq $26,%zmm7,%zmm8 ++ vpsrlq $14,%zmm6,%zmm10 ++ vpsrlq $40,%zmm6,%zmm6 ++ vpandq %zmm5,%zmm9,%zmm9 ++ vpandq %zmm5,%zmm7,%zmm7 ++ ++ vpaddq %zmm2,%zmm9,%zmm2 ++ subq $192,%rdx ++ jbe .Ltail_avx512 ++ jmp .Loop_avx512 ++ ++.align 32 ++.Loop_avx512: ++ ++ vpmuludq %zmm2,%zmm17,%zmm14 ++ vpaddq %zmm0,%zmm7,%zmm0 ++ vpmuludq %zmm2,%zmm18,%zmm15 ++ vpandq %zmm5,%zmm8,%zmm8 ++ vpmuludq %zmm2,%zmm23,%zmm11 ++ vpandq %zmm5,%zmm10,%zmm10 ++ vpmuludq %zmm2,%zmm24,%zmm12 ++ vporq %zmm30,%zmm6,%zmm6 ++ vpmuludq %zmm2,%zmm16,%zmm13 ++ vpaddq %zmm1,%zmm8,%zmm1 ++ vpaddq %zmm3,%zmm10,%zmm3 ++ vpaddq %zmm4,%zmm6,%zmm4 ++ ++ vmovdqu64 0(%rsi),%zmm10 ++ vmovdqu64 64(%rsi),%zmm6 ++ leaq 128(%rsi),%rsi ++ vpmuludq %zmm0,%zmm19,%zmm28 ++ vpmuludq %zmm0,%zmm20,%zmm29 ++ vpmuludq %zmm0,%zmm16,%zmm25 ++ vpmuludq %zmm0,%zmm17,%zmm26 ++ vpaddq %zmm28,%zmm14,%zmm14 ++ vpaddq %zmm29,%zmm15,%zmm15 ++ vpaddq %zmm25,%zmm11,%zmm11 ++ vpaddq %zmm26,%zmm12,%zmm12 ++ ++ vpmuludq %zmm1,%zmm18,%zmm28 ++ vpmuludq %zmm1,%zmm19,%zmm29 ++ vpmuludq %zmm1,%zmm24,%zmm25 ++ vpmuludq %zmm0,%zmm18,%zmm27 ++ vpaddq %zmm28,%zmm14,%zmm14 ++ vpaddq %zmm29,%zmm15,%zmm15 ++ vpaddq %zmm25,%zmm11,%zmm11 ++ vpaddq %zmm27,%zmm13,%zmm13 ++ ++ vpunpcklqdq %zmm6,%zmm10,%zmm7 ++ vpunpckhqdq %zmm6,%zmm10,%zmm6 ++ ++ vpmuludq %zmm3,%zmm16,%zmm28 ++ vpmuludq %zmm3,%zmm17,%zmm29 ++ vpmuludq %zmm1,%zmm16,%zmm26 ++ vpmuludq %zmm1,%zmm17,%zmm27 ++ vpaddq %zmm28,%zmm14,%zmm14 ++ vpaddq %zmm29,%zmm15,%zmm15 ++ vpaddq %zmm26,%zmm12,%zmm12 ++ vpaddq %zmm27,%zmm13,%zmm13 ++ ++ vpmuludq %zmm4,%zmm24,%zmm28 ++ vpmuludq %zmm4,%zmm16,%zmm29 ++ vpmuludq %zmm3,%zmm22,%zmm25 ++ vpmuludq %zmm3,%zmm23,%zmm26 ++ vpaddq %zmm28,%zmm14,%zmm14 ++ vpmuludq %zmm3,%zmm24,%zmm27 ++ vpaddq %zmm29,%zmm15,%zmm15 ++ vpaddq %zmm25,%zmm11,%zmm11 ++ vpaddq %zmm26,%zmm12,%zmm12 ++ vpaddq %zmm27,%zmm13,%zmm13 ++ ++ vpmuludq %zmm4,%zmm21,%zmm25 ++ vpmuludq %zmm4,%zmm22,%zmm26 ++ vpmuludq %zmm4,%zmm23,%zmm27 ++ vpaddq %zmm25,%zmm11,%zmm0 ++ vpaddq %zmm26,%zmm12,%zmm1 ++ vpaddq %zmm27,%zmm13,%zmm2 ++ ++ vpsrlq $52,%zmm7,%zmm9 ++ vpsllq $12,%zmm6,%zmm10 ++ ++ vpsrlq $26,%zmm14,%zmm3 ++ vpandq %zmm5,%zmm14,%zmm14 ++ vpaddq %zmm3,%zmm15,%zmm4 ++ ++ vporq %zmm10,%zmm9,%zmm9 ++ ++ vpsrlq $26,%zmm0,%zmm11 ++ vpandq %zmm5,%zmm0,%zmm0 ++ vpaddq %zmm11,%zmm1,%zmm1 ++ ++ vpandq %zmm5,%zmm9,%zmm9 ++ ++ vpsrlq $26,%zmm4,%zmm15 ++ vpandq %zmm5,%zmm4,%zmm4 ++ ++ vpsrlq $26,%zmm1,%zmm12 ++ vpandq %zmm5,%zmm1,%zmm1 ++ vpaddq %zmm12,%zmm2,%zmm2 ++ ++ vpaddq %zmm15,%zmm0,%zmm0 ++ vpsllq $2,%zmm15,%zmm15 ++ vpaddq %zmm15,%zmm0,%zmm0 ++ ++ vpaddq %zmm9,%zmm2,%zmm2 ++ vpsrlq $26,%zmm7,%zmm8 ++ ++ vpsrlq $26,%zmm2,%zmm13 ++ vpandq %zmm5,%zmm2,%zmm2 ++ vpaddq %zmm13,%zmm14,%zmm3 ++ ++ vpsrlq $14,%zmm6,%zmm10 ++ ++ vpsrlq $26,%zmm0,%zmm11 ++ vpandq %zmm5,%zmm0,%zmm0 ++ vpaddq %zmm11,%zmm1,%zmm1 ++ ++ vpsrlq $40,%zmm6,%zmm6 ++ ++ vpsrlq $26,%zmm3,%zmm14 ++ vpandq %zmm5,%zmm3,%zmm3 ++ vpaddq %zmm14,%zmm4,%zmm4 ++ ++ vpandq %zmm5,%zmm7,%zmm7 ++ ++ subq $128,%rdx ++ ja .Loop_avx512 ++ ++.Ltail_avx512: ++ ++ vpsrlq $32,%zmm16,%zmm16 ++ vpsrlq $32,%zmm17,%zmm17 ++ vpsrlq $32,%zmm18,%zmm18 ++ vpsrlq $32,%zmm23,%zmm23 ++ vpsrlq $32,%zmm24,%zmm24 ++ vpsrlq $32,%zmm19,%zmm19 ++ vpsrlq $32,%zmm20,%zmm20 ++ vpsrlq $32,%zmm21,%zmm21 ++ vpsrlq $32,%zmm22,%zmm22 ++ ++ leaq (%rsi,%rdx,1),%rsi ++ ++ vpaddq %zmm0,%zmm7,%zmm0 ++ ++ vpmuludq %zmm2,%zmm17,%zmm14 ++ vpmuludq %zmm2,%zmm18,%zmm15 ++ vpmuludq %zmm2,%zmm23,%zmm11 ++ vpandq %zmm5,%zmm8,%zmm8 ++ vpmuludq %zmm2,%zmm24,%zmm12 ++ vpandq %zmm5,%zmm10,%zmm10 ++ vpmuludq %zmm2,%zmm16,%zmm13 ++ vporq %zmm30,%zmm6,%zmm6 ++ vpaddq %zmm1,%zmm8,%zmm1 ++ vpaddq %zmm3,%zmm10,%zmm3 ++ vpaddq %zmm4,%zmm6,%zmm4 ++ ++ vmovdqu 0(%rsi),%xmm7 ++ vpmuludq %zmm0,%zmm19,%zmm28 ++ vpmuludq %zmm0,%zmm20,%zmm29 ++ vpmuludq %zmm0,%zmm16,%zmm25 ++ vpmuludq %zmm0,%zmm17,%zmm26 ++ vpaddq %zmm28,%zmm14,%zmm14 ++ vpaddq %zmm29,%zmm15,%zmm15 ++ vpaddq %zmm25,%zmm11,%zmm11 ++ vpaddq %zmm26,%zmm12,%zmm12 ++ ++ vmovdqu 16(%rsi),%xmm8 ++ vpmuludq %zmm1,%zmm18,%zmm28 ++ vpmuludq %zmm1,%zmm19,%zmm29 ++ vpmuludq %zmm1,%zmm24,%zmm25 ++ vpmuludq %zmm0,%zmm18,%zmm27 ++ vpaddq %zmm28,%zmm14,%zmm14 ++ vpaddq %zmm29,%zmm15,%zmm15 ++ vpaddq %zmm25,%zmm11,%zmm11 ++ vpaddq %zmm27,%zmm13,%zmm13 ++ ++ vinserti128 $1,32(%rsi),%ymm7,%ymm7 ++ vpmuludq %zmm3,%zmm16,%zmm28 ++ vpmuludq %zmm3,%zmm17,%zmm29 ++ vpmuludq %zmm1,%zmm16,%zmm26 ++ vpmuludq %zmm1,%zmm17,%zmm27 ++ vpaddq %zmm28,%zmm14,%zmm14 ++ vpaddq %zmm29,%zmm15,%zmm15 ++ vpaddq %zmm26,%zmm12,%zmm12 ++ vpaddq %zmm27,%zmm13,%zmm13 ++ ++ vinserti128 $1,48(%rsi),%ymm8,%ymm8 ++ vpmuludq %zmm4,%zmm24,%zmm28 ++ vpmuludq %zmm4,%zmm16,%zmm29 ++ vpmuludq %zmm3,%zmm22,%zmm25 ++ vpmuludq %zmm3,%zmm23,%zmm26 ++ vpmuludq %zmm3,%zmm24,%zmm27 ++ vpaddq %zmm28,%zmm14,%zmm3 ++ vpaddq %zmm29,%zmm15,%zmm15 ++ vpaddq %zmm25,%zmm11,%zmm11 ++ vpaddq %zmm26,%zmm12,%zmm12 ++ vpaddq %zmm27,%zmm13,%zmm13 ++ ++ vpmuludq %zmm4,%zmm21,%zmm25 ++ vpmuludq %zmm4,%zmm22,%zmm26 ++ vpmuludq %zmm4,%zmm23,%zmm27 ++ vpaddq %zmm25,%zmm11,%zmm0 ++ vpaddq %zmm26,%zmm12,%zmm1 ++ vpaddq %zmm27,%zmm13,%zmm2 ++ ++ movl $1,%eax ++ vpermq $0xb1,%zmm3,%zmm14 ++ vpermq $0xb1,%zmm15,%zmm4 ++ vpermq $0xb1,%zmm0,%zmm11 ++ vpermq $0xb1,%zmm1,%zmm12 ++ vpermq $0xb1,%zmm2,%zmm13 ++ vpaddq %zmm14,%zmm3,%zmm3 ++ vpaddq %zmm15,%zmm4,%zmm4 ++ vpaddq %zmm11,%zmm0,%zmm0 ++ vpaddq %zmm12,%zmm1,%zmm1 ++ vpaddq %zmm13,%zmm2,%zmm2 ++ ++ kmovw %eax,%k3 ++ vpermq $0x2,%zmm3,%zmm14 ++ vpermq $0x2,%zmm4,%zmm15 ++ vpermq $0x2,%zmm0,%zmm11 ++ vpermq $0x2,%zmm1,%zmm12 ++ vpermq $0x2,%zmm2,%zmm13 ++ vpaddq %zmm14,%zmm3,%zmm3 ++ vpaddq %zmm15,%zmm4,%zmm4 ++ vpaddq %zmm11,%zmm0,%zmm0 ++ vpaddq %zmm12,%zmm1,%zmm1 ++ vpaddq %zmm13,%zmm2,%zmm2 ++ ++ vextracti64x4 $0x1,%zmm3,%ymm14 ++ vextracti64x4 $0x1,%zmm4,%ymm15 ++ vextracti64x4 $0x1,%zmm0,%ymm11 ++ vextracti64x4 $0x1,%zmm1,%ymm12 ++ vextracti64x4 $0x1,%zmm2,%ymm13 ++ vpaddq %zmm14,%zmm3,%zmm3{%k3}{z} ++ vpaddq %zmm15,%zmm4,%zmm4{%k3}{z} ++ vpaddq %zmm11,%zmm0,%zmm0{%k3}{z} ++ vpaddq %zmm12,%zmm1,%zmm1{%k3}{z} ++ vpaddq %zmm13,%zmm2,%zmm2{%k3}{z} ++ ++ vpsrlq $26,%ymm3,%ymm14 ++ vpand %ymm5,%ymm3,%ymm3 ++ vpsrldq $6,%ymm7,%ymm9 ++ vpsrldq $6,%ymm8,%ymm10 ++ vpunpckhqdq %ymm8,%ymm7,%ymm6 ++ vpaddq %ymm14,%ymm4,%ymm4 ++ ++ vpsrlq $26,%ymm0,%ymm11 ++ vpand %ymm5,%ymm0,%ymm0 ++ vpunpcklqdq %ymm10,%ymm9,%ymm9 ++ vpunpcklqdq %ymm8,%ymm7,%ymm7 ++ vpaddq %ymm11,%ymm1,%ymm1 ++ ++ vpsrlq $26,%ymm4,%ymm15 ++ vpand %ymm5,%ymm4,%ymm4 ++ ++ vpsrlq $26,%ymm1,%ymm12 ++ vpand %ymm5,%ymm1,%ymm1 ++ vpsrlq $30,%ymm9,%ymm10 ++ vpsrlq $4,%ymm9,%ymm9 ++ vpaddq %ymm12,%ymm2,%ymm2 ++ ++ vpaddq %ymm15,%ymm0,%ymm0 ++ vpsllq $2,%ymm15,%ymm15 ++ vpsrlq $26,%ymm7,%ymm8 ++ vpsrlq $40,%ymm6,%ymm6 ++ vpaddq %ymm15,%ymm0,%ymm0 ++ ++ vpsrlq $26,%ymm2,%ymm13 ++ vpand %ymm5,%ymm2,%ymm2 ++ vpand %ymm5,%ymm9,%ymm9 ++ vpand %ymm5,%ymm7,%ymm7 ++ vpaddq %ymm13,%ymm3,%ymm3 ++ ++ vpsrlq $26,%ymm0,%ymm11 ++ vpand %ymm5,%ymm0,%ymm0 ++ vpaddq %ymm2,%ymm9,%ymm2 ++ vpand %ymm5,%ymm8,%ymm8 ++ vpaddq %ymm11,%ymm1,%ymm1 ++ ++ vpsrlq $26,%ymm3,%ymm14 ++ vpand %ymm5,%ymm3,%ymm3 ++ vpand %ymm5,%ymm10,%ymm10 ++ vpor 32(%rcx),%ymm6,%ymm6 ++ vpaddq %ymm14,%ymm4,%ymm4 ++ ++ leaq 144(%rsp),%rax ++ addq $64,%rdx ++ jnz .Ltail_avx2_512 ++ ++ vpsubq %ymm9,%ymm2,%ymm2 ++ vmovd %xmm0,-112(%rdi) ++ vmovd %xmm1,-108(%rdi) ++ vmovd %xmm2,-104(%rdi) ++ vmovd %xmm3,-100(%rdi) ++ vmovd %xmm4,-96(%rdi) ++ vzeroall ++ leaq -8(%r10),%rsp ++ ++ ret ++ ++ENDPROC(poly1305_blocks_avx512) ++#endif /* CONFIG_AS_AVX512 */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/Makefile 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,19 @@ ++# SPDX-License-Identifier: GPL-2.0 ++# ++# Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ ++ccflags-y := -O3 -fvisibility=hidden ++ccflags-$(CONFIG_WIREGUARD_DEBUG) += -DDEBUG -g ++ccflags-y += -Wframe-larger-than=8192 ++ccflags-y += -D'pr_fmt(fmt)=KBUILD_MODNAME ": " fmt' ++wireguard-y := main.o noise.o device.o peer.o timers.o queueing.o send.o receive.o socket.o hashtables.o allowedips.o ratelimiter.o cookie.o netlink.o ++wireguard-y += crypto/curve25519.o crypto/chacha20poly1305.o crypto/blake2s.o ++ ++wireguard-$(CONFIG_X86_64) += crypto/chacha20-x86_64.o crypto/poly1305-x86_64.o crypto/blake2s-x86_64.o crypto/curve25519-x86_64.o ++wireguard-$(CONFIG_ARM) += crypto/chacha20-arm.o crypto/poly1305-arm.o crypto/curve25519-arm.o ++wireguard-$(CONFIG_ARM64) += crypto/chacha20-arm64.o crypto/poly1305-arm64.o ++wireguard-$(if $(filter yy,$(CONFIG_MIPS)$(CONFIG_64BIT)),y,n) += crypto/poly1305-mips64.o ++ ++include $(src)/compat/Makefile.include ++ ++obj-$(if $(KBUILD_EXTMOD),m,$(CONFIG_WIREGUARD)) := wireguard.o +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/Kconfig 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,30 @@ ++config WIREGUARD ++ tristate "IP: WireGuard secure network tunnel" ++ depends on NET && INET ++ select NET_UDP_TUNNEL ++ select CRYPTO_BLKCIPHER ++ select VFP ++ select VFPv3 ++ select NEON ++ select KERNEL_MODE_NEON ++ default m ++ ---help--- ++ WireGuard is a secure, fast, and easy to use replacement for IPSec ++ that uses modern cryptography and clever networking tricks. It's ++ designed to be fairly general purpose and abstract enough to fit most ++ use cases, while at the same time remaining extremely simple to ++ configure. See www.wireguard.com for more info. ++ ++ It's safe to say Y or M here, as the driver is very lightweight and ++ is only in use when an administrator chooses to add an interface. ++ ++config WIREGUARD_DEBUG ++ bool "Debugging checks and verbose messages" ++ depends on WIREGUARD ++ ---help--- ++ This will write log messages for handshake and other events ++ that occur for a WireGuard interface. It will also perform some ++ extra validation checks and unit tests at various points. This is ++ only useful for debugging. ++ ++ Say N here unless you know what you're doing. +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/simd/include/asm/simd.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1 @@ ++#include +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/udp_tunnel/udp_tunnel_partial_compat.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,226 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 0) ++#define udp_sock_create4 udp_sock_create ++#define udp_sock_create6 udp_sock_create ++#include ++#include ++#include ++#include ++#include ++#include ++#if IS_ENABLED(CONFIG_IPV6) ++#include ++#include ++#include ++#include ++#include ++#endif ++static inline void fake_destructor(struct sk_buff *skb) ++{ ++} ++typedef int (*udp_tunnel_encap_rcv_t)(struct sock *sk, struct sk_buff *skb); ++struct udp_tunnel_sock_cfg { ++ void *sk_user_data; ++ __u8 encap_type; ++ udp_tunnel_encap_rcv_t encap_rcv; ++}; ++/* This is global so, uh, only one real call site... This is the kind of horrific hack you'd expect to see in compat code. */ ++static udp_tunnel_encap_rcv_t encap_rcv = NULL; ++static void our_sk_data_ready(struct sock *sk) ++{ ++ struct sk_buff *skb; ++ while ((skb = skb_dequeue(&sk->sk_receive_queue)) != NULL) { ++ skb_orphan(skb); ++ sk_mem_reclaim(sk); ++ encap_rcv(sk, skb); ++ } ++} ++static inline void setup_udp_tunnel_sock(struct net *net, struct socket *sock, ++ struct udp_tunnel_sock_cfg *cfg) ++{ ++ struct sock *sk = sock->sk; ++ inet_sk(sk)->mc_loop = 0; ++ encap_rcv = cfg->encap_rcv; ++ rcu_assign_sk_user_data(sk, cfg->sk_user_data); ++ sk->sk_data_ready = our_sk_data_ready; ++} ++static inline void udp_tunnel_sock_release(struct socket *sock) ++{ ++ rcu_assign_sk_user_data(sock->sk, NULL); ++ kernel_sock_shutdown(sock, SHUT_RDWR); ++ sk_release_kernel(sock->sk); ++} ++static inline int udp_tunnel_xmit_skb(struct socket *sock, struct rtable *rt, ++ struct sk_buff *skb, __be32 src, __be32 dst, ++ __u8 tos, __u8 ttl, __be16 df, __be16 src_port, ++ __be16 dst_port, bool xnet) ++{ ++ struct udphdr *uh; ++ __skb_push(skb, sizeof(*uh)); ++ skb_reset_transport_header(skb); ++ uh = udp_hdr(skb); ++ uh->dest = dst_port; ++ uh->source = src_port; ++ uh->len = htons(skb->len); ++ udp_set_csum(sock->sk->sk_no_check_tx, skb, src, dst, skb->len); ++ return iptunnel_xmit(sock->sk, rt, skb, src, dst, IPPROTO_UDP, ++ tos, ttl, df, xnet); ++} ++#if IS_ENABLED(CONFIG_IPV6) ++static inline int udp_tunnel6_xmit_skb(struct socket *sock, struct dst_entry *dst, ++ struct sk_buff *skb, struct net_device *dev, ++ struct in6_addr *saddr, struct in6_addr *daddr, ++ __u8 prio, __u8 ttl, __be16 src_port, ++ __be16 dst_port) ++{ ++ struct udphdr *uh; ++ struct ipv6hdr *ip6h; ++ struct sock *sk = sock->sk; ++ __skb_push(skb, sizeof(*uh)); ++ skb_reset_transport_header(skb); ++ uh = udp_hdr(skb); ++ uh->dest = dst_port; ++ uh->source = src_port; ++ uh->len = htons(skb->len); ++ memset(&(IPCB(skb)->opt), 0, sizeof(IPCB(skb)->opt)); ++ IPCB(skb)->flags &= ~(IPSKB_XFRM_TUNNEL_SIZE | IPSKB_XFRM_TRANSFORMED ++ | IPSKB_REROUTED); ++ skb_dst_set(skb, dst); ++ udp6_set_csum(udp_get_no_check6_tx(sk), skb, &inet6_sk(sk)->saddr, ++ &sk->sk_v6_daddr, skb->len); ++ __skb_push(skb, sizeof(*ip6h)); ++ skb_reset_network_header(skb); ++ ip6h = ipv6_hdr(skb); ++ ip6_flow_hdr(ip6h, prio, htonl(0)); ++ ip6h->payload_len = htons(skb->len); ++ ip6h->nexthdr = IPPROTO_UDP; ++ ip6h->hop_limit = ttl; ++ ip6h->daddr = *daddr; ++ ip6h->saddr = *saddr; ++ ip6tunnel_xmit(skb, dev); ++ return 0; ++} ++#endif ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 0, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0) ++#include ++#include ++#include ++#include ++#include ++#include ++#define udp_tunnel_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) do { struct net_device *dev__ = (c)->dev; int ret__; ret__ = udp_tunnel_xmit_skb((b)->sk_socket, a, c, d, e, f, g, h, i, j, k); if (ret__) iptunnel_xmit_stats(ret__ - 8, &dev__->stats, dev__->tstats); } while (0) ++#if IS_ENABLED(CONFIG_IPV6) ++#define udp_tunnel6_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) udp_tunnel6_xmit_skb((b)->sk_socket, a, c, d, e, f, g, h, j, k); ++#endif ++#elif LINUX_VERSION_CODE < KERNEL_VERSION(4, 1, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0) ++#include ++#include ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 18, 0) ++static inline void fake_destructor(struct sk_buff *skb) ++{ ++} ++#endif ++#define udp_tunnel_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) do { struct net_device *dev__ = (c)->dev; int ret__; if (!(c)->destructor) (c)->destructor = fake_destructor; if (!(c)->sk) (c)->sk = (b); ret__ = udp_tunnel_xmit_skb(a, c, d, e, f, g, h, i, j, k, l); if (ret__) iptunnel_xmit_stats(ret__ - 8, &dev__->stats, dev__->tstats); } while (0) ++#if IS_ENABLED(CONFIG_IPV6) ++#define udp_tunnel6_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) do { if (!(c)->destructor) (c)->destructor = fake_destructor; if (!(c)->sk) (c)->sk = (b); udp_tunnel6_xmit_skb(a, c, d, e, f, g, h, j, k, l); } while(0) ++#endif ++#else ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0) ++#include ++#include ++#define udp_tunnel_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) do { struct net_device *dev__ = (c)->dev; int ret__ = udp_tunnel_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l); if (ret__) iptunnel_xmit_stats(ret__ - 8, &dev__->stats, dev__->tstats); } while (0) ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 5, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 3, 0) ++#include ++#include ++#define udp_tunnel_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) do { struct net_device *dev__ = (c)->dev; int ret__ = udp_tunnel_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l); iptunnel_xmit_stats(ret__, &dev__->stats, dev__->tstats); } while (0) ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 6, 0) && IS_ENABLED(CONFIG_IPV6) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0) ++#include ++#include ++#define udp_tunnel6_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) udp_tunnel6_xmit_skb(a, b, c, d, e, f, g, h, j, k, l) ++#endif ++ ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0) ++#include ++#include ++#include ++struct udp_port_cfg_new { ++ u8 family; ++ union { ++ struct in_addr local_ip; ++#if IS_ENABLED(CONFIG_IPV6) ++ struct in6_addr local_ip6; ++#endif ++ }; ++ union { ++ struct in_addr peer_ip; ++#if IS_ENABLED(CONFIG_IPV6) ++ struct in6_addr peer_ip6; ++#endif ++ }; ++ __be16 local_udp_port; ++ __be16 peer_udp_port; ++ unsigned int use_udp_checksums:1, use_udp6_tx_checksums:1, use_udp6_rx_checksums:1, ipv6_v6only:1; ++}; ++static inline int __maybe_unused udp_sock_create_new(struct net *net, struct udp_port_cfg_new *cfg, struct socket **sockp) ++{ ++ struct udp_port_cfg old_cfg = { ++ .family = cfg->family, ++ .local_ip = cfg->local_ip, ++#if IS_ENABLED(CONFIG_IPV6) ++ .local_ip6 = cfg->local_ip6, ++#endif ++ .peer_ip = cfg->peer_ip, ++#if IS_ENABLED(CONFIG_IPV6) ++ .peer_ip6 = cfg->peer_ip6, ++#endif ++ .local_udp_port = cfg->local_udp_port, ++ .peer_udp_port = cfg->peer_udp_port, ++ .use_udp_checksums = cfg->use_udp_checksums, ++ .use_udp6_tx_checksums = cfg->use_udp6_tx_checksums, ++ .use_udp6_rx_checksums = cfg->use_udp6_rx_checksums ++ }; ++ if (cfg->family == AF_INET) ++ return udp_sock_create4(net, &old_cfg, sockp); ++ ++#if IS_ENABLED(CONFIG_IPV6) ++ if (cfg->family == AF_INET6) { ++ int ret; ++ int old_bindv6only; ++ struct net *nobns; ++ ++ if (cfg->ipv6_v6only) { ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 2, 0) ++ nobns = &init_net; ++#else ++ nobns = net; ++#endif ++ /* Since udp_port_cfg only learned of ipv6_v6only in 4.3, we do this horrible ++ * hack here and set the sysctl variable temporarily to something that will ++ * set the right option for us in sock_create. It's super racey! */ ++ old_bindv6only = nobns->ipv6.sysctl.bindv6only; ++ nobns->ipv6.sysctl.bindv6only = 1; ++ } ++ ret = udp_sock_create6(net, &old_cfg, sockp); ++ if (cfg->ipv6_v6only) ++ nobns->ipv6.sysctl.bindv6only = old_bindv6only; ++ return ret; ++ } ++#endif ++ return -EPFNOSUPPORT; ++} ++#define udp_port_cfg udp_port_cfg_new ++#define udp_sock_create(a, b, c) udp_sock_create_new(a, b, c) ++#endif +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/udp_tunnel/include/net/udp_tunnel.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,94 @@ ++#ifndef _WG_NET_UDP_TUNNEL_H ++#define _WG_NET_UDP_TUNNEL_H ++ ++#include ++#include ++ ++#if IS_ENABLED(CONFIG_IPV6) ++#include ++#include ++#endif ++ ++struct udp_port_cfg { ++ u8 family; ++ ++ /* Used only for kernel-created sockets */ ++ union { ++ struct in_addr local_ip; ++#if IS_ENABLED(CONFIG_IPV6) ++ struct in6_addr local_ip6; ++#endif ++ }; ++ ++ union { ++ struct in_addr peer_ip; ++#if IS_ENABLED(CONFIG_IPV6) ++ struct in6_addr peer_ip6; ++#endif ++ }; ++ ++ __be16 local_udp_port; ++ __be16 peer_udp_port; ++ unsigned int use_udp_checksums:1, ++ use_udp6_tx_checksums:1, ++ use_udp6_rx_checksums:1, ++ ipv6_v6only:1; ++}; ++ ++int udp_sock_create4(struct net *net, struct udp_port_cfg *cfg, ++ struct socket **sockp); ++ ++#if IS_ENABLED(CONFIG_IPV6) ++int udp_sock_create6(struct net *net, struct udp_port_cfg *cfg, ++ struct socket **sockp); ++#else ++static inline int udp_sock_create6(struct net *net, struct udp_port_cfg *cfg, ++ struct socket **sockp) ++{ ++ return 0; ++} ++#endif ++ ++static inline int udp_sock_create(struct net *net, ++ struct udp_port_cfg *cfg, ++ struct socket **sockp) ++{ ++ if (cfg->family == AF_INET) ++ return udp_sock_create4(net, cfg, sockp); ++ ++ if (cfg->family == AF_INET6) ++ return udp_sock_create6(net, cfg, sockp); ++ ++ return -EPFNOSUPPORT; ++} ++ ++typedef int (*udp_tunnel_encap_rcv_t)(struct sock *sk, struct sk_buff *skb); ++ ++struct udp_tunnel_sock_cfg { ++ void *sk_user_data; ++ __u8 encap_type; ++ udp_tunnel_encap_rcv_t encap_rcv; ++}; ++ ++/* Setup the given (UDP) sock to receive UDP encapsulated packets */ ++void setup_udp_tunnel_sock(struct net *net, struct socket *sock, ++ struct udp_tunnel_sock_cfg *sock_cfg); ++ ++/* Transmit the skb using UDP encapsulation. */ ++void udp_tunnel_xmit_skb(struct rtable *rt, struct sock *sk, struct sk_buff *skb, ++ __be32 src, __be32 dst, __u8 tos, __u8 ttl, ++ __be16 df, __be16 src_port, __be16 dst_port, ++ bool xnet, bool nocheck); ++ ++#if IS_ENABLED(CONFIG_IPV6) ++int udp_tunnel6_xmit_skb(struct dst_entry *dst, struct sock *sk, ++ struct sk_buff *skb, ++ struct net_device *dev, struct in6_addr *saddr, ++ struct in6_addr *daddr, ++ __u8 prio, __u8 ttl, __be32 label, ++ __be16 src_port, __be16 dst_port, bool nocheck); ++#endif ++ ++void udp_tunnel_sock_release(struct socket *sock); ++ ++#endif /* _WG_NET_UDP_TUNNEL_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/udp_tunnel/udp_tunnel.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,385 @@ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0) ++#define __sk_user_data(sk) ((*((void __rcu **)&(sk)->sk_user_data))) ++#define rcu_dereference_sk_user_data(sk) rcu_dereference(__sk_user_data((sk))) ++#define rcu_assign_sk_user_data(sk, ptr) rcu_assign_pointer(__sk_user_data((sk)), ptr) ++#endif ++ ++/* This is global so, uh, only one real call site... This is the kind of horrific hack you'd expect to see in compat code. */ ++static udp_tunnel_encap_rcv_t encap_rcv = NULL; ++static void our_sk_data_ready(struct sock *sk ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0) ++ ,int unused_vulnerable_length_param ++#endif ++ ) ++{ ++ struct sk_buff *skb; ++ while ((skb = skb_dequeue(&sk->sk_receive_queue)) != NULL) { ++ skb_orphan(skb); ++ sk_mem_reclaim(sk); ++ encap_rcv(sk, skb); ++ } ++} ++ ++int udp_sock_create4(struct net *net, struct udp_port_cfg *cfg, ++ struct socket **sockp) ++{ ++ int err; ++ struct socket *sock = NULL; ++ struct sockaddr_in udp_addr; ++ ++ err = __sock_create(net, AF_INET, SOCK_DGRAM, 0, &sock, 1); ++ if (err < 0) ++ goto error; ++ ++ udp_addr.sin_family = AF_INET; ++ udp_addr.sin_addr = cfg->local_ip; ++ udp_addr.sin_port = cfg->local_udp_port; ++ err = kernel_bind(sock, (struct sockaddr *)&udp_addr, ++ sizeof(udp_addr)); ++ if (err < 0) ++ goto error; ++ ++ if (cfg->peer_udp_port) { ++ udp_addr.sin_family = AF_INET; ++ udp_addr.sin_addr = cfg->peer_ip; ++ udp_addr.sin_port = cfg->peer_udp_port; ++ err = kernel_connect(sock, (struct sockaddr *)&udp_addr, ++ sizeof(udp_addr), 0); ++ if (err < 0) ++ goto error; ++ } ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0) ++ sock->sk->sk_no_check = !cfg->use_udp_checksums; ++#else ++ sock->sk->sk_no_check_tx = !cfg->use_udp_checksums; ++#endif ++ ++ *sockp = sock; ++ return 0; ++ ++error: ++ if (sock) { ++ kernel_sock_shutdown(sock, SHUT_RDWR); ++ sock_release(sock); ++ } ++ *sockp = NULL; ++ return err; ++} ++ ++void setup_udp_tunnel_sock(struct net *net, struct socket *sock, ++ struct udp_tunnel_sock_cfg *cfg) ++{ ++ inet_sk(sock->sk)->mc_loop = 0; ++ encap_rcv = cfg->encap_rcv; ++ rcu_assign_sk_user_data(sock->sk, cfg->sk_user_data); ++ sock->sk->sk_data_ready = our_sk_data_ready; ++} ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0) ++static inline __sum16 udp_v4_check(int len, __be32 saddr, ++ __be32 daddr, __wsum base) ++{ ++ return csum_tcpudp_magic(saddr, daddr, len, IPPROTO_UDP, base); ++} ++ ++static void udp_set_csum(bool nocheck, struct sk_buff *skb, ++ __be32 saddr, __be32 daddr, int len) ++{ ++ struct udphdr *uh = udp_hdr(skb); ++ ++ if (nocheck) ++ uh->check = 0; ++ else if (skb_is_gso(skb)) ++ uh->check = ~udp_v4_check(len, saddr, daddr, 0); ++ else if (skb_dst(skb) && skb_dst(skb)->dev && ++ (skb_dst(skb)->dev->features & NETIF_F_V4_CSUM)) { ++ ++ BUG_ON(skb->ip_summed == CHECKSUM_PARTIAL); ++ ++ skb->ip_summed = CHECKSUM_PARTIAL; ++ skb->csum_start = skb_transport_header(skb) - skb->head; ++ skb->csum_offset = offsetof(struct udphdr, check); ++ uh->check = ~udp_v4_check(len, saddr, daddr, 0); ++ } else { ++ __wsum csum; ++ ++ BUG_ON(skb->ip_summed == CHECKSUM_PARTIAL); ++ ++ uh->check = 0; ++ csum = skb_checksum(skb, 0, len, 0); ++ uh->check = udp_v4_check(len, saddr, daddr, csum); ++ if (uh->check == 0) ++ uh->check = CSUM_MANGLED_0; ++ ++ skb->ip_summed = CHECKSUM_UNNECESSARY; ++ } ++} ++ ++#endif ++ ++static void fake_destructor(struct sk_buff *skb) ++{ ++} ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0) ++static void our_iptunnel_xmit(struct rtable *rt, struct sk_buff *skb, ++ __be32 src, __be32 dst, __u8 proto, ++ __u8 tos, __u8 ttl, __be16 df, bool xnet) ++{ ++ struct iphdr *iph; ++ struct pcpu_tstats *tstats = this_cpu_ptr(skb->dev->tstats); ++ ++ skb_scrub_packet(skb, xnet); ++ ++ skb->rxhash = 0; ++ skb_dst_set(skb, &rt->dst); ++ memset(IPCB(skb), 0, sizeof(*IPCB(skb))); ++ ++ /* Push down and install the IP header. */ ++ skb_push(skb, sizeof(struct iphdr)); ++ skb_reset_network_header(skb); ++ ++ iph = ip_hdr(skb); ++ ++ iph->version = 4; ++ iph->ihl = sizeof(struct iphdr) >> 2; ++ iph->frag_off = df; ++ iph->protocol = proto; ++ iph->tos = tos; ++ iph->daddr = dst; ++ iph->saddr = src; ++ iph->ttl = ttl; ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 53) ++ __ip_select_ident(iph, &rt->dst, (skb_shinfo(skb)->gso_segs ?: 1) - 1); ++#else ++ __ip_select_ident(iph, skb_shinfo(skb)->gso_segs ?: 1); ++#endif ++ ++ iptunnel_xmit(skb, skb->dev); ++ u64_stats_update_begin(&tstats->syncp); ++ tstats->tx_bytes -= 8; ++ u64_stats_update_end(&tstats->syncp); ++} ++#define iptunnel_xmit our_iptunnel_xmit ++#endif ++ ++void udp_tunnel_xmit_skb(struct rtable *rt, struct sock *sk, struct sk_buff *skb, ++ __be32 src, __be32 dst, __u8 tos, __u8 ttl, ++ __be16 df, __be16 src_port, __be16 dst_port, ++ bool xnet, bool nocheck) ++{ ++ struct udphdr *uh; ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 12, 0) ++ struct net_device *dev = skb->dev; ++ int ret; ++#endif ++ ++ __skb_push(skb, sizeof(*uh)); ++ skb_reset_transport_header(skb); ++ uh = udp_hdr(skb); ++ ++ uh->dest = dst_port; ++ uh->source = src_port; ++ uh->len = htons(skb->len); ++ ++ memset(&(IPCB(skb)->opt), 0, sizeof(IPCB(skb)->opt)); ++ ++ udp_set_csum(nocheck, skb, src, dst, skb->len); ++ ++ if (!skb->sk) ++ skb->sk = sk; ++ if (!skb->destructor) ++ skb->destructor = fake_destructor; ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 12, 0) ++ ret = ++#endif ++ iptunnel_xmit( ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0) ++ sk, ++#endif ++ rt, skb, src, dst, IPPROTO_UDP, tos, ttl, df, xnet); ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 12, 0) ++ if (ret) ++ iptunnel_xmit_stats(ret - 8, &dev->stats, dev->tstats); ++#endif ++} ++ ++void udp_tunnel_sock_release(struct socket *sock) ++{ ++ rcu_assign_sk_user_data(sock->sk, NULL); ++ kernel_sock_shutdown(sock, SHUT_RDWR); ++ sock_release(sock); ++} ++ ++#if IS_ENABLED(CONFIG_IPV6) ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++int udp_sock_create6(struct net *net, struct udp_port_cfg *cfg, ++ struct socket **sockp) ++{ ++ struct sockaddr_in6 udp6_addr; ++ int err; ++ struct socket *sock = NULL; ++ ++ err = __sock_create(net, AF_INET6, SOCK_DGRAM, 0, &sock, 1); ++ if (err < 0) ++ goto error; ++ ++ if (cfg->ipv6_v6only) { ++ int val = 1; ++ ++ err = kernel_setsockopt(sock, IPPROTO_IPV6, IPV6_V6ONLY, ++ (char *) &val, sizeof(val)); ++ if (err < 0) ++ goto error; ++ } ++ ++ udp6_addr.sin6_family = AF_INET6; ++ memcpy(&udp6_addr.sin6_addr, &cfg->local_ip6, ++ sizeof(udp6_addr.sin6_addr)); ++ udp6_addr.sin6_port = cfg->local_udp_port; ++ err = kernel_bind(sock, (struct sockaddr *)&udp6_addr, ++ sizeof(udp6_addr)); ++ if (err < 0) ++ goto error; ++ ++ if (cfg->peer_udp_port) { ++ udp6_addr.sin6_family = AF_INET6; ++ memcpy(&udp6_addr.sin6_addr, &cfg->peer_ip6, ++ sizeof(udp6_addr.sin6_addr)); ++ udp6_addr.sin6_port = cfg->peer_udp_port; ++ err = kernel_connect(sock, ++ (struct sockaddr *)&udp6_addr, ++ sizeof(udp6_addr), 0); ++ } ++ if (err < 0) ++ goto error; ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0) ++ sock->sk->sk_no_check = !cfg->use_udp_checksums; ++#else ++ udp_set_no_check6_tx(sock->sk, !cfg->use_udp6_tx_checksums); ++ udp_set_no_check6_rx(sock->sk, !cfg->use_udp6_rx_checksums); ++#endif ++ ++ *sockp = sock; ++ return 0; ++ ++error: ++ if (sock) { ++ kernel_sock_shutdown(sock, SHUT_RDWR); ++ sock_release(sock); ++ } ++ *sockp = NULL; ++ return err; ++} ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0) ++static inline __sum16 udp_v6_check(int len, ++ const struct in6_addr *saddr, ++ const struct in6_addr *daddr, ++ __wsum base) ++{ ++ return csum_ipv6_magic(saddr, daddr, len, IPPROTO_UDP, base); ++} ++static void udp6_set_csum(bool nocheck, struct sk_buff *skb, ++ const struct in6_addr *saddr, ++ const struct in6_addr *daddr, int len) ++{ ++ struct udphdr *uh = udp_hdr(skb); ++ ++ if (nocheck) ++ uh->check = 0; ++ else if (skb_is_gso(skb)) ++ uh->check = ~udp_v6_check(len, saddr, daddr, 0); ++ else if (skb_dst(skb) && skb_dst(skb)->dev && ++ (skb_dst(skb)->dev->features & NETIF_F_IPV6_CSUM)) { ++ ++ BUG_ON(skb->ip_summed == CHECKSUM_PARTIAL); ++ ++ skb->ip_summed = CHECKSUM_PARTIAL; ++ skb->csum_start = skb_transport_header(skb) - skb->head; ++ skb->csum_offset = offsetof(struct udphdr, check); ++ uh->check = ~udp_v6_check(len, saddr, daddr, 0); ++ } else { ++ __wsum csum; ++ ++ BUG_ON(skb->ip_summed == CHECKSUM_PARTIAL); ++ ++ uh->check = 0; ++ csum = skb_checksum(skb, 0, len, 0); ++ uh->check = udp_v6_check(len, saddr, daddr, csum); ++ if (uh->check == 0) ++ uh->check = CSUM_MANGLED_0; ++ ++ skb->ip_summed = CHECKSUM_UNNECESSARY; ++ } ++} ++#endif ++ ++int udp_tunnel6_xmit_skb(struct dst_entry *dst, struct sock *sk, ++ struct sk_buff *skb, ++ struct net_device *dev, struct in6_addr *saddr, ++ struct in6_addr *daddr, ++ __u8 prio, __u8 ttl, __be32 label, ++ __be16 src_port, __be16 dst_port, bool nocheck) ++{ ++ struct udphdr *uh; ++ struct ipv6hdr *ip6h; ++ ++ __skb_push(skb, sizeof(*uh)); ++ skb_reset_transport_header(skb); ++ uh = udp_hdr(skb); ++ ++ uh->dest = dst_port; ++ uh->source = src_port; ++ ++ uh->len = htons(skb->len); ++ ++ skb_dst_set(skb, dst); ++ ++ udp6_set_csum(nocheck, skb, saddr, daddr, skb->len); ++ ++ __skb_push(skb, sizeof(*ip6h)); ++ skb_reset_network_header(skb); ++ ip6h = ipv6_hdr(skb); ++ ip6_flow_hdr(ip6h, prio, label); ++ ip6h->payload_len = htons(skb->len); ++ ip6h->nexthdr = IPPROTO_UDP; ++ ip6h->hop_limit = ttl; ++ ip6h->daddr = *daddr; ++ ip6h->saddr = *saddr; ++ ++ if (!skb->sk) ++ skb->sk = sk; ++ if (!skb->destructor) ++ skb->destructor = fake_destructor; ++ ++ ip6tunnel_xmit(skb, dev); ++ return 0; ++} ++#endif +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/fpu/include/asm/fpu/api.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1 @@ ++#include +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/checksum/checksum_partial_compat.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,208 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#include ++#include ++#include ++#include ++#include ++ ++#define IP6_MF 0x0001 ++#define IP6_OFFSET 0xFFF8 ++static inline int skb_maybe_pull_tail(struct sk_buff *skb, unsigned int len, unsigned int max) ++{ ++ if (skb_headlen(skb) >= len) ++ return 0; ++ if (max > skb->len) ++ max = skb->len; ++ if (__pskb_pull_tail(skb, max - skb_headlen(skb)) == NULL) ++ return -ENOMEM; ++ if (skb_headlen(skb) < len) ++ return -EPROTO; ++ return 0; ++} ++#define MAX_IP_HDR_LEN 128 ++static inline int skb_checksum_setup_ip(struct sk_buff *skb, bool recalculate) ++{ ++ unsigned int off; ++ bool fragment; ++ int err; ++ fragment = false; ++ err = skb_maybe_pull_tail(skb, sizeof(struct iphdr), MAX_IP_HDR_LEN); ++ if (err < 0) ++ goto out; ++ if (ip_hdr(skb)->frag_off & htons(IP_OFFSET | IP_MF)) ++ fragment = true; ++ off = ip_hdrlen(skb); ++ err = -EPROTO; ++ if (fragment) ++ goto out; ++ switch (ip_hdr(skb)->protocol) { ++ case IPPROTO_TCP: ++ err = skb_maybe_pull_tail(skb, ++ off + sizeof(struct tcphdr), ++ MAX_IP_HDR_LEN); ++ if (err < 0) ++ goto out; ++ ++ if (!skb_partial_csum_set(skb, off, ++ offsetof(struct tcphdr, check))) { ++ err = -EPROTO; ++ goto out; ++ } ++ ++ if (recalculate) ++ tcp_hdr(skb)->check = ++ ~csum_tcpudp_magic(ip_hdr(skb)->saddr, ++ ip_hdr(skb)->daddr, ++ skb->len - off, ++ IPPROTO_TCP, 0); ++ break; ++ case IPPROTO_UDP: ++ err = skb_maybe_pull_tail(skb, ++ off + sizeof(struct udphdr), ++ MAX_IP_HDR_LEN); ++ if (err < 0) ++ goto out; ++ ++ if (!skb_partial_csum_set(skb, off, ++ offsetof(struct udphdr, check))) { ++ err = -EPROTO; ++ goto out; ++ } ++ ++ if (recalculate) ++ udp_hdr(skb)->check = ++ ~csum_tcpudp_magic(ip_hdr(skb)->saddr, ++ ip_hdr(skb)->daddr, ++ skb->len - off, ++ IPPROTO_UDP, 0); ++ break; ++ default: ++ goto out; ++ } ++ err = 0; ++out: ++ return err; ++} ++#define MAX_IPV6_HDR_LEN 256 ++#define OPT_HDR(type, skb, off) \ ++ (type *)(skb_network_header(skb) + (off)) ++static inline int skb_checksum_setup_ipv6(struct sk_buff *skb, bool recalculate) ++{ ++ int err; ++ u8 nexthdr; ++ unsigned int off; ++ unsigned int len; ++ bool fragment; ++ bool done; ++ fragment = false; ++ done = false; ++ off = sizeof(struct ipv6hdr); ++ err = skb_maybe_pull_tail(skb, off, MAX_IPV6_HDR_LEN); ++ if (err < 0) ++ goto out; ++ nexthdr = ipv6_hdr(skb)->nexthdr; ++ len = sizeof(struct ipv6hdr) + ntohs(ipv6_hdr(skb)->payload_len); ++ while (off <= len && !done) { ++ switch (nexthdr) { ++ case IPPROTO_DSTOPTS: ++ case IPPROTO_HOPOPTS: ++ case IPPROTO_ROUTING: { ++ struct ipv6_opt_hdr *hp; ++ ++ err = skb_maybe_pull_tail(skb, off + sizeof(struct ipv6_opt_hdr), MAX_IPV6_HDR_LEN); ++ if (err < 0) ++ goto out; ++ hp = OPT_HDR(struct ipv6_opt_hdr, skb, off); ++ nexthdr = hp->nexthdr; ++ off += ipv6_optlen(hp); ++ break; ++ } ++ case IPPROTO_FRAGMENT: { ++ struct frag_hdr *hp; ++ err = skb_maybe_pull_tail(skb, off + sizeof(struct frag_hdr), MAX_IPV6_HDR_LEN); ++ if (err < 0) ++ goto out; ++ hp = OPT_HDR(struct frag_hdr, skb, off); ++ if (hp->frag_off & htons(IP6_OFFSET | IP6_MF)) ++ fragment = true; ++ nexthdr = hp->nexthdr; ++ off += sizeof(struct frag_hdr); ++ break; ++ } ++ default: ++ done = true; ++ break; ++ } ++ } ++ err = -EPROTO; ++ if (!done || fragment) ++ goto out; ++ switch (nexthdr) { ++ case IPPROTO_TCP: ++ err = skb_maybe_pull_tail(skb, ++ off + sizeof(struct tcphdr), ++ MAX_IPV6_HDR_LEN); ++ if (err < 0) ++ goto out; ++ ++ if (!skb_partial_csum_set(skb, off, ++ offsetof(struct tcphdr, check))) { ++ err = -EPROTO; ++ goto out; ++ } ++ ++ if (recalculate) ++ tcp_hdr(skb)->check = ++ ~csum_ipv6_magic(&ipv6_hdr(skb)->saddr, ++ &ipv6_hdr(skb)->daddr, ++ skb->len - off, ++ IPPROTO_TCP, 0); ++ break; ++ case IPPROTO_UDP: ++ err = skb_maybe_pull_tail(skb, ++ off + sizeof(struct udphdr), ++ MAX_IPV6_HDR_LEN); ++ if (err < 0) ++ goto out; ++ ++ if (!skb_partial_csum_set(skb, off, ++ offsetof(struct udphdr, check))) { ++ err = -EPROTO; ++ goto out; ++ } ++ ++ if (recalculate) ++ udp_hdr(skb)->check = ++ ~csum_ipv6_magic(&ipv6_hdr(skb)->saddr, ++ &ipv6_hdr(skb)->daddr, ++ skb->len - off, ++ IPPROTO_UDP, 0); ++ break; ++ default: ++ goto out; ++ } ++ err = 0; ++out: ++ return err; ++} ++static inline int skb_checksum_setup(struct sk_buff *skb, bool recalculate) ++{ ++ int err; ++ switch (skb->protocol) { ++ case htons(ETH_P_IP): ++ err = skb_checksum_setup_ip(skb, recalculate); ++ break; ++ ++ case htons(ETH_P_IPV6): ++ err = skb_checksum_setup_ipv6(skb, recalculate); ++ break; ++ default: ++ err = -EPROTO; ++ break; ++ } ++ return err; ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/Makefile.include 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,70 @@ ++# SPDX-License-Identifier: GPL-2.0 ++# ++# Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ ++ifeq ($(wildcard $(src)/compat/compat.h),) ++ccflags-y += -include $(srctree)/$(src)/compat/compat.h ++asflags-y += -include $(srctree)/$(src)/compat/compat-asm.h ++else ++ccflags-y += -include $(src)/compat/compat.h ++asflags-y += -include $(src)/compat/compat-asm.h ++endif ++ ++ifeq ($(wildcard $(srctree)/include/linux/ptr_ring.h),) ++ccflags-y += -I$(src)/compat/ptr_ring/include ++endif ++ ++ifeq ($(wildcard $(srctree)/include/linux/siphash.h),) ++ccflags-y += -I$(src)/compat/siphash/include ++wireguard-y += compat/siphash/siphash.o ++endif ++ ++ifeq ($(wildcard $(srctree)/include/net/dst_cache.h),) ++ccflags-y += -I$(src)/compat/dst_cache/include ++wireguard-y += compat/dst_cache/dst_cache.o ++endif ++ ++ifeq ($(wildcard $(srctree)/arch/x86/include/asm/intel-family.h),) ++ccflags-y += -I$(src)/compat/intel-family/include ++endif ++ ++ifeq ($(wildcard $(srctree)/arch/x86/include/asm/fpu/api.h),) ++ccflags-y += -I$(src)/compat/fpu/include ++endif ++ ++ifeq ($(wildcard $(srctree)/arch/x86/include/asm/simd.h),) ++ccflags-y += -I$(src)/compat/simd/include ++endif ++ ++ifeq ($(wildcard $(srctree)/include/net/udp_tunnel.h),) ++ccflags-y += -I$(src)/compat/udp_tunnel/include ++wireguard-y += compat/udp_tunnel/udp_tunnel.o ++endif ++ ++ifeq ($(shell grep -F "int crypto_memneq" "$(srctree)/include/crypto/algapi.h"),) ++ccflags-y += -include $(src)/compat/memneq/include.h ++wireguard-y += compat/memneq/memneq.o ++endif ++ ++ifeq ($(CONFIG_X86_64),y) ++ ifeq ($(ssse3_instr),) ++ ssse3_instr := $(call as-instr,pshufb %xmm0$(comma)%xmm0,-DCONFIG_AS_SSSE3=1) ++ ccflags-y += $(ssse3_instr) ++ asflags-y += $(ssse3_instr) ++ endif ++ ifeq ($(avx_instr),) ++ avx_instr := $(call as-instr,vxorps %ymm0$(comma)%ymm1$(comma)%ymm2,-DCONFIG_AS_AVX=1) ++ ccflags-y += $(avx_instr) ++ asflags-y += $(avx_instr) ++ endif ++ ifeq ($(avx2_instr),) ++ avx2_instr := $(call as-instr,vpbroadcastb %xmm0$(comma)%ymm1,-DCONFIG_AS_AVX2=1) ++ ccflags-y += $(avx2_instr) ++ asflags-y += $(avx2_instr) ++ endif ++ ifeq ($(avx512_instr),) ++ avx512_instr := $(call as-instr,vpmovm2b %k1$(comma)%zmm5,-DCONFIG_AS_AVX512=1) ++ ccflags-y += $(avx512_instr) ++ asflags-y += $(avx512_instr) ++ endif ++endif +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/siphash/siphash.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,539 @@ ++/* Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * ++ * This file is provided under a dual BSD/GPLv2 license. ++ * ++ * SipHash: a fast short-input PRF ++ * https://131002.net/siphash/ ++ * ++ * This implementation is specifically for SipHash2-4 for a secure PRF ++ * and HalfSipHash1-3/SipHash1-3 for an insecure PRF only suitable for ++ * hashtables. ++ */ ++ ++#include ++#include ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0) ++#ifdef __LITTLE_ENDIAN ++#define bytemask_from_count(cnt) (~(~0ul << (cnt)*8)) ++#else ++#define bytemask_from_count(cnt) (~(~0ul >> (cnt)*8)) ++#endif ++#endif ++ ++#if defined(CONFIG_DCACHE_WORD_ACCESS) && BITS_PER_LONG == 64 ++#include ++#include ++#endif ++ ++#define SIPROUND \ ++ do { \ ++ v0 += v1; v1 = rol64(v1, 13); v1 ^= v0; v0 = rol64(v0, 32); \ ++ v2 += v3; v3 = rol64(v3, 16); v3 ^= v2; \ ++ v0 += v3; v3 = rol64(v3, 21); v3 ^= v0; \ ++ v2 += v1; v1 = rol64(v1, 17); v1 ^= v2; v2 = rol64(v2, 32); \ ++ } while (0) ++ ++#define PREAMBLE(len) \ ++ u64 v0 = 0x736f6d6570736575ULL; \ ++ u64 v1 = 0x646f72616e646f6dULL; \ ++ u64 v2 = 0x6c7967656e657261ULL; \ ++ u64 v3 = 0x7465646279746573ULL; \ ++ u64 b = ((u64)(len)) << 56; \ ++ v3 ^= key->key[1]; \ ++ v2 ^= key->key[0]; \ ++ v1 ^= key->key[1]; \ ++ v0 ^= key->key[0]; ++ ++#define POSTAMBLE \ ++ v3 ^= b; \ ++ SIPROUND; \ ++ SIPROUND; \ ++ v0 ^= b; \ ++ v2 ^= 0xff; \ ++ SIPROUND; \ ++ SIPROUND; \ ++ SIPROUND; \ ++ SIPROUND; \ ++ return (v0 ^ v1) ^ (v2 ^ v3); ++ ++u64 __siphash_aligned(const void *data, size_t len, const siphash_key_t *key) ++{ ++ const u8 *end = data + len - (len % sizeof(u64)); ++ const u8 left = len & (sizeof(u64) - 1); ++ u64 m; ++ PREAMBLE(len) ++ for (; data != end; data += sizeof(u64)) { ++ m = le64_to_cpup(data); ++ v3 ^= m; ++ SIPROUND; ++ SIPROUND; ++ v0 ^= m; ++ } ++#if defined(CONFIG_DCACHE_WORD_ACCESS) && BITS_PER_LONG == 64 ++ if (left) ++ b |= le64_to_cpu((__force __le64)(load_unaligned_zeropad(data) & ++ bytemask_from_count(left))); ++#else ++ switch (left) { ++ case 7: b |= ((u64)end[6]) << 48; ++ case 6: b |= ((u64)end[5]) << 40; ++ case 5: b |= ((u64)end[4]) << 32; ++ case 4: b |= le32_to_cpup(data); break; ++ case 3: b |= ((u64)end[2]) << 16; ++ case 2: b |= le16_to_cpup(data); break; ++ case 1: b |= end[0]; ++ } ++#endif ++ POSTAMBLE ++} ++ ++#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS ++u64 __siphash_unaligned(const void *data, size_t len, const siphash_key_t *key) ++{ ++ const u8 *end = data + len - (len % sizeof(u64)); ++ const u8 left = len & (sizeof(u64) - 1); ++ u64 m; ++ PREAMBLE(len) ++ for (; data != end; data += sizeof(u64)) { ++ m = get_unaligned_le64(data); ++ v3 ^= m; ++ SIPROUND; ++ SIPROUND; ++ v0 ^= m; ++ } ++#if defined(CONFIG_DCACHE_WORD_ACCESS) && BITS_PER_LONG == 64 ++ if (left) ++ b |= le64_to_cpu((__force __le64)(load_unaligned_zeropad(data) & ++ bytemask_from_count(left))); ++#else ++ switch (left) { ++ case 7: b |= ((u64)end[6]) << 48; ++ case 6: b |= ((u64)end[5]) << 40; ++ case 5: b |= ((u64)end[4]) << 32; ++ case 4: b |= get_unaligned_le32(end); break; ++ case 3: b |= ((u64)end[2]) << 16; ++ case 2: b |= get_unaligned_le16(end); break; ++ case 1: b |= end[0]; ++ } ++#endif ++ POSTAMBLE ++} ++#endif ++ ++/** ++ * siphash_1u64 - compute 64-bit siphash PRF value of a u64 ++ * @first: first u64 ++ * @key: the siphash key ++ */ ++u64 siphash_1u64(const u64 first, const siphash_key_t *key) ++{ ++ PREAMBLE(8) ++ v3 ^= first; ++ SIPROUND; ++ SIPROUND; ++ v0 ^= first; ++ POSTAMBLE ++} ++ ++/** ++ * siphash_2u64 - compute 64-bit siphash PRF value of 2 u64 ++ * @first: first u64 ++ * @second: second u64 ++ * @key: the siphash key ++ */ ++u64 siphash_2u64(const u64 first, const u64 second, const siphash_key_t *key) ++{ ++ PREAMBLE(16) ++ v3 ^= first; ++ SIPROUND; ++ SIPROUND; ++ v0 ^= first; ++ v3 ^= second; ++ SIPROUND; ++ SIPROUND; ++ v0 ^= second; ++ POSTAMBLE ++} ++ ++/** ++ * siphash_3u64 - compute 64-bit siphash PRF value of 3 u64 ++ * @first: first u64 ++ * @second: second u64 ++ * @third: third u64 ++ * @key: the siphash key ++ */ ++u64 siphash_3u64(const u64 first, const u64 second, const u64 third, ++ const siphash_key_t *key) ++{ ++ PREAMBLE(24) ++ v3 ^= first; ++ SIPROUND; ++ SIPROUND; ++ v0 ^= first; ++ v3 ^= second; ++ SIPROUND; ++ SIPROUND; ++ v0 ^= second; ++ v3 ^= third; ++ SIPROUND; ++ SIPROUND; ++ v0 ^= third; ++ POSTAMBLE ++} ++ ++/** ++ * siphash_4u64 - compute 64-bit siphash PRF value of 4 u64 ++ * @first: first u64 ++ * @second: second u64 ++ * @third: third u64 ++ * @forth: forth u64 ++ * @key: the siphash key ++ */ ++u64 siphash_4u64(const u64 first, const u64 second, const u64 third, ++ const u64 forth, const siphash_key_t *key) ++{ ++ PREAMBLE(32) ++ v3 ^= first; ++ SIPROUND; ++ SIPROUND; ++ v0 ^= first; ++ v3 ^= second; ++ SIPROUND; ++ SIPROUND; ++ v0 ^= second; ++ v3 ^= third; ++ SIPROUND; ++ SIPROUND; ++ v0 ^= third; ++ v3 ^= forth; ++ SIPROUND; ++ SIPROUND; ++ v0 ^= forth; ++ POSTAMBLE ++} ++ ++u64 siphash_1u32(const u32 first, const siphash_key_t *key) ++{ ++ PREAMBLE(4) ++ b |= first; ++ POSTAMBLE ++} ++ ++u64 siphash_3u32(const u32 first, const u32 second, const u32 third, ++ const siphash_key_t *key) ++{ ++ u64 combined = (u64)second << 32 | first; ++ PREAMBLE(12) ++ v3 ^= combined; ++ SIPROUND; ++ SIPROUND; ++ v0 ^= combined; ++ b |= third; ++ POSTAMBLE ++} ++ ++#if BITS_PER_LONG == 64 ++/* Note that on 64-bit, we make HalfSipHash1-3 actually be SipHash1-3, for ++ * performance reasons. On 32-bit, below, we actually implement HalfSipHash1-3. ++ */ ++ ++#define HSIPROUND SIPROUND ++#define HPREAMBLE(len) PREAMBLE(len) ++#define HPOSTAMBLE \ ++ v3 ^= b; \ ++ HSIPROUND; \ ++ v0 ^= b; \ ++ v2 ^= 0xff; \ ++ HSIPROUND; \ ++ HSIPROUND; \ ++ HSIPROUND; \ ++ return (v0 ^ v1) ^ (v2 ^ v3); ++ ++u32 __hsiphash_aligned(const void *data, size_t len, const hsiphash_key_t *key) ++{ ++ const u8 *end = data + len - (len % sizeof(u64)); ++ const u8 left = len & (sizeof(u64) - 1); ++ u64 m; ++ HPREAMBLE(len) ++ for (; data != end; data += sizeof(u64)) { ++ m = le64_to_cpup(data); ++ v3 ^= m; ++ HSIPROUND; ++ v0 ^= m; ++ } ++#if defined(CONFIG_DCACHE_WORD_ACCESS) && BITS_PER_LONG == 64 ++ if (left) ++ b |= le64_to_cpu((__force __le64)(load_unaligned_zeropad(data) & ++ bytemask_from_count(left))); ++#else ++ switch (left) { ++ case 7: b |= ((u64)end[6]) << 48; ++ case 6: b |= ((u64)end[5]) << 40; ++ case 5: b |= ((u64)end[4]) << 32; ++ case 4: b |= le32_to_cpup(data); break; ++ case 3: b |= ((u64)end[2]) << 16; ++ case 2: b |= le16_to_cpup(data); break; ++ case 1: b |= end[0]; ++ } ++#endif ++ HPOSTAMBLE ++} ++ ++#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS ++u32 __hsiphash_unaligned(const void *data, size_t len, ++ const hsiphash_key_t *key) ++{ ++ const u8 *end = data + len - (len % sizeof(u64)); ++ const u8 left = len & (sizeof(u64) - 1); ++ u64 m; ++ HPREAMBLE(len) ++ for (; data != end; data += sizeof(u64)) { ++ m = get_unaligned_le64(data); ++ v3 ^= m; ++ HSIPROUND; ++ v0 ^= m; ++ } ++#if defined(CONFIG_DCACHE_WORD_ACCESS) && BITS_PER_LONG == 64 ++ if (left) ++ b |= le64_to_cpu((__force __le64)(load_unaligned_zeropad(data) & ++ bytemask_from_count(left))); ++#else ++ switch (left) { ++ case 7: b |= ((u64)end[6]) << 48; ++ case 6: b |= ((u64)end[5]) << 40; ++ case 5: b |= ((u64)end[4]) << 32; ++ case 4: b |= get_unaligned_le32(end); break; ++ case 3: b |= ((u64)end[2]) << 16; ++ case 2: b |= get_unaligned_le16(end); break; ++ case 1: b |= end[0]; ++ } ++#endif ++ HPOSTAMBLE ++} ++#endif ++ ++/** ++ * hsiphash_1u32 - compute 64-bit hsiphash PRF value of a u32 ++ * @first: first u32 ++ * @key: the hsiphash key ++ */ ++u32 hsiphash_1u32(const u32 first, const hsiphash_key_t *key) ++{ ++ HPREAMBLE(4) ++ b |= first; ++ HPOSTAMBLE ++} ++ ++/** ++ * hsiphash_2u32 - compute 32-bit hsiphash PRF value of 2 u32 ++ * @first: first u32 ++ * @second: second u32 ++ * @key: the hsiphash key ++ */ ++u32 hsiphash_2u32(const u32 first, const u32 second, const hsiphash_key_t *key) ++{ ++ u64 combined = (u64)second << 32 | first; ++ HPREAMBLE(8) ++ v3 ^= combined; ++ HSIPROUND; ++ v0 ^= combined; ++ HPOSTAMBLE ++} ++ ++/** ++ * hsiphash_3u32 - compute 32-bit hsiphash PRF value of 3 u32 ++ * @first: first u32 ++ * @second: second u32 ++ * @third: third u32 ++ * @key: the hsiphash key ++ */ ++u32 hsiphash_3u32(const u32 first, const u32 second, const u32 third, ++ const hsiphash_key_t *key) ++{ ++ u64 combined = (u64)second << 32 | first; ++ HPREAMBLE(12) ++ v3 ^= combined; ++ HSIPROUND; ++ v0 ^= combined; ++ b |= third; ++ HPOSTAMBLE ++} ++ ++/** ++ * hsiphash_4u32 - compute 32-bit hsiphash PRF value of 4 u32 ++ * @first: first u32 ++ * @second: second u32 ++ * @third: third u32 ++ * @forth: forth u32 ++ * @key: the hsiphash key ++ */ ++u32 hsiphash_4u32(const u32 first, const u32 second, const u32 third, ++ const u32 forth, const hsiphash_key_t *key) ++{ ++ u64 combined = (u64)second << 32 | first; ++ HPREAMBLE(16) ++ v3 ^= combined; ++ HSIPROUND; ++ v0 ^= combined; ++ combined = (u64)forth << 32 | third; ++ v3 ^= combined; ++ HSIPROUND; ++ v0 ^= combined; ++ HPOSTAMBLE ++} ++#else ++#define HSIPROUND \ ++ do { \ ++ v0 += v1; v1 = rol32(v1, 5); v1 ^= v0; v0 = rol32(v0, 16); \ ++ v2 += v3; v3 = rol32(v3, 8); v3 ^= v2; \ ++ v0 += v3; v3 = rol32(v3, 7); v3 ^= v0; \ ++ v2 += v1; v1 = rol32(v1, 13); v1 ^= v2; v2 = rol32(v2, 16); \ ++ } while (0) ++ ++#define HPREAMBLE(len) \ ++ u32 v0 = 0; \ ++ u32 v1 = 0; \ ++ u32 v2 = 0x6c796765U; \ ++ u32 v3 = 0x74656462U; \ ++ u32 b = ((u32)(len)) << 24; \ ++ v3 ^= key->key[1]; \ ++ v2 ^= key->key[0]; \ ++ v1 ^= key->key[1]; \ ++ v0 ^= key->key[0]; ++ ++#define HPOSTAMBLE \ ++ v3 ^= b; \ ++ HSIPROUND; \ ++ v0 ^= b; \ ++ v2 ^= 0xff; \ ++ HSIPROUND; \ ++ HSIPROUND; \ ++ HSIPROUND; \ ++ return v1 ^ v3; ++ ++u32 __hsiphash_aligned(const void *data, size_t len, const hsiphash_key_t *key) ++{ ++ const u8 *end = data + len - (len % sizeof(u32)); ++ const u8 left = len & (sizeof(u32) - 1); ++ u32 m; ++ HPREAMBLE(len) ++ for (; data != end; data += sizeof(u32)) { ++ m = le32_to_cpup(data); ++ v3 ^= m; ++ HSIPROUND; ++ v0 ^= m; ++ } ++ switch (left) { ++ case 3: b |= ((u32)end[2]) << 16; ++ case 2: b |= le16_to_cpup(data); break; ++ case 1: b |= end[0]; ++ } ++ HPOSTAMBLE ++} ++ ++#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS ++u32 __hsiphash_unaligned(const void *data, size_t len, ++ const hsiphash_key_t *key) ++{ ++ const u8 *end = data + len - (len % sizeof(u32)); ++ const u8 left = len & (sizeof(u32) - 1); ++ u32 m; ++ HPREAMBLE(len) ++ for (; data != end; data += sizeof(u32)) { ++ m = get_unaligned_le32(data); ++ v3 ^= m; ++ HSIPROUND; ++ v0 ^= m; ++ } ++ switch (left) { ++ case 3: b |= ((u32)end[2]) << 16; ++ case 2: b |= get_unaligned_le16(end); break; ++ case 1: b |= end[0]; ++ } ++ HPOSTAMBLE ++} ++#endif ++ ++/** ++ * hsiphash_1u32 - compute 32-bit hsiphash PRF value of a u32 ++ * @first: first u32 ++ * @key: the hsiphash key ++ */ ++u32 hsiphash_1u32(const u32 first, const hsiphash_key_t *key) ++{ ++ HPREAMBLE(4) ++ v3 ^= first; ++ HSIPROUND; ++ v0 ^= first; ++ HPOSTAMBLE ++} ++ ++/** ++ * hsiphash_2u32 - compute 32-bit hsiphash PRF value of 2 u32 ++ * @first: first u32 ++ * @second: second u32 ++ * @key: the hsiphash key ++ */ ++u32 hsiphash_2u32(const u32 first, const u32 second, const hsiphash_key_t *key) ++{ ++ HPREAMBLE(8) ++ v3 ^= first; ++ HSIPROUND; ++ v0 ^= first; ++ v3 ^= second; ++ HSIPROUND; ++ v0 ^= second; ++ HPOSTAMBLE ++} ++ ++/** ++ * hsiphash_3u32 - compute 32-bit hsiphash PRF value of 3 u32 ++ * @first: first u32 ++ * @second: second u32 ++ * @third: third u32 ++ * @key: the hsiphash key ++ */ ++u32 hsiphash_3u32(const u32 first, const u32 second, const u32 third, ++ const hsiphash_key_t *key) ++{ ++ HPREAMBLE(12) ++ v3 ^= first; ++ HSIPROUND; ++ v0 ^= first; ++ v3 ^= second; ++ HSIPROUND; ++ v0 ^= second; ++ v3 ^= third; ++ HSIPROUND; ++ v0 ^= third; ++ HPOSTAMBLE ++} ++ ++/** ++ * hsiphash_4u32 - compute 32-bit hsiphash PRF value of 4 u32 ++ * @first: first u32 ++ * @second: second u32 ++ * @third: third u32 ++ * @forth: forth u32 ++ * @key: the hsiphash key ++ */ ++u32 hsiphash_4u32(const u32 first, const u32 second, const u32 third, ++ const u32 forth, const hsiphash_key_t *key) ++{ ++ HPREAMBLE(16) ++ v3 ^= first; ++ HSIPROUND; ++ v0 ^= first; ++ v3 ^= second; ++ HSIPROUND; ++ v0 ^= second; ++ v3 ^= third; ++ HSIPROUND; ++ v0 ^= third; ++ v3 ^= forth; ++ HSIPROUND; ++ v0 ^= forth; ++ HPOSTAMBLE ++} ++#endif +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/siphash/include/linux/siphash.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,140 @@ ++/* Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ * ++ * This file is provided under a dual BSD/GPLv2 license. ++ * ++ * SipHash: a fast short-input PRF ++ * https://131002.net/siphash/ ++ * ++ * This implementation is specifically for SipHash2-4 for a secure PRF ++ * and HalfSipHash1-3/SipHash1-3 for an insecure PRF only suitable for ++ * hashtables. ++ */ ++ ++#ifndef _WG_LINUX_SIPHASH_H ++#define _WG_LINUX_SIPHASH_H ++ ++#include ++#include ++ ++#define SIPHASH_ALIGNMENT __alignof__(u64) ++typedef struct { ++ u64 key[2]; ++} siphash_key_t; ++ ++u64 __siphash_aligned(const void *data, size_t len, const siphash_key_t *key); ++#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS ++u64 __siphash_unaligned(const void *data, size_t len, const siphash_key_t *key); ++#endif ++ ++u64 siphash_1u64(const u64 a, const siphash_key_t *key); ++u64 siphash_2u64(const u64 a, const u64 b, const siphash_key_t *key); ++u64 siphash_3u64(const u64 a, const u64 b, const u64 c, ++ const siphash_key_t *key); ++u64 siphash_4u64(const u64 a, const u64 b, const u64 c, const u64 d, ++ const siphash_key_t *key); ++u64 siphash_1u32(const u32 a, const siphash_key_t *key); ++u64 siphash_3u32(const u32 a, const u32 b, const u32 c, ++ const siphash_key_t *key); ++ ++static inline u64 siphash_2u32(const u32 a, const u32 b, ++ const siphash_key_t *key) ++{ ++ return siphash_1u64((u64)b << 32 | a, key); ++} ++static inline u64 siphash_4u32(const u32 a, const u32 b, const u32 c, ++ const u32 d, const siphash_key_t *key) ++{ ++ return siphash_2u64((u64)b << 32 | a, (u64)d << 32 | c, key); ++} ++ ++ ++static inline u64 ___siphash_aligned(const __le64 *data, size_t len, ++ const siphash_key_t *key) ++{ ++ if (__builtin_constant_p(len) && len == 4) ++ return siphash_1u32(le32_to_cpup((const __le32 *)data), key); ++ if (__builtin_constant_p(len) && len == 8) ++ return siphash_1u64(le64_to_cpu(data[0]), key); ++ if (__builtin_constant_p(len) && len == 16) ++ return siphash_2u64(le64_to_cpu(data[0]), le64_to_cpu(data[1]), ++ key); ++ if (__builtin_constant_p(len) && len == 24) ++ return siphash_3u64(le64_to_cpu(data[0]), le64_to_cpu(data[1]), ++ le64_to_cpu(data[2]), key); ++ if (__builtin_constant_p(len) && len == 32) ++ return siphash_4u64(le64_to_cpu(data[0]), le64_to_cpu(data[1]), ++ le64_to_cpu(data[2]), le64_to_cpu(data[3]), ++ key); ++ return __siphash_aligned(data, len, key); ++} ++ ++/** ++ * siphash - compute 64-bit siphash PRF value ++ * @data: buffer to hash ++ * @size: size of @data ++ * @key: the siphash key ++ */ ++static inline u64 siphash(const void *data, size_t len, ++ const siphash_key_t *key) ++{ ++#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS ++ if (!IS_ALIGNED((unsigned long)data, SIPHASH_ALIGNMENT)) ++ return __siphash_unaligned(data, len, key); ++#endif ++ return ___siphash_aligned(data, len, key); ++} ++ ++#define HSIPHASH_ALIGNMENT __alignof__(unsigned long) ++typedef struct { ++ unsigned long key[2]; ++} hsiphash_key_t; ++ ++u32 __hsiphash_aligned(const void *data, size_t len, ++ const hsiphash_key_t *key); ++#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS ++u32 __hsiphash_unaligned(const void *data, size_t len, ++ const hsiphash_key_t *key); ++#endif ++ ++u32 hsiphash_1u32(const u32 a, const hsiphash_key_t *key); ++u32 hsiphash_2u32(const u32 a, const u32 b, const hsiphash_key_t *key); ++u32 hsiphash_3u32(const u32 a, const u32 b, const u32 c, ++ const hsiphash_key_t *key); ++u32 hsiphash_4u32(const u32 a, const u32 b, const u32 c, const u32 d, ++ const hsiphash_key_t *key); ++ ++static inline u32 ___hsiphash_aligned(const __le32 *data, size_t len, ++ const hsiphash_key_t *key) ++{ ++ if (__builtin_constant_p(len) && len == 4) ++ return hsiphash_1u32(le32_to_cpu(data[0]), key); ++ if (__builtin_constant_p(len) && len == 8) ++ return hsiphash_2u32(le32_to_cpu(data[0]), le32_to_cpu(data[1]), ++ key); ++ if (__builtin_constant_p(len) && len == 12) ++ return hsiphash_3u32(le32_to_cpu(data[0]), le32_to_cpu(data[1]), ++ le32_to_cpu(data[2]), key); ++ if (__builtin_constant_p(len) && len == 16) ++ return hsiphash_4u32(le32_to_cpu(data[0]), le32_to_cpu(data[1]), ++ le32_to_cpu(data[2]), le32_to_cpu(data[3]), ++ key); ++ return __hsiphash_aligned(data, len, key); ++} ++ ++/** ++ * hsiphash - compute 32-bit hsiphash PRF value ++ * @data: buffer to hash ++ * @size: size of @data ++ * @key: the hsiphash key ++ */ ++static inline u32 hsiphash(const void *data, size_t len, ++ const hsiphash_key_t *key) ++{ ++#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS ++ if (!IS_ALIGNED((unsigned long)data, HSIPHASH_ALIGNMENT)) ++ return __hsiphash_unaligned(data, len, key); ++#endif ++ return ___hsiphash_aligned(data, len, key); ++} ++ ++#endif /* _WG_LINUX_SIPHASH_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/intel-family/include/asm/intel-family.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,73 @@ ++/* SPDX-License-Identifier: GPL-2.0 */ ++#ifndef _ASM_X86_INTEL_FAMILY_H ++#define _ASM_X86_INTEL_FAMILY_H ++ ++/* ++ * "Big Core" Processors (Branded as Core, Xeon, etc...) ++ * ++ * The "_X" parts are generally the EP and EX Xeons, or the ++ * "Extreme" ones, like Broadwell-E. ++ * ++ * Things ending in "2" are usually because we have no better ++ * name for them. There's no processor called "SILVERMONT2". ++ */ ++ ++#define INTEL_FAM6_CORE_YONAH 0x0E ++ ++#define INTEL_FAM6_CORE2_MEROM 0x0F ++#define INTEL_FAM6_CORE2_MEROM_L 0x16 ++#define INTEL_FAM6_CORE2_PENRYN 0x17 ++#define INTEL_FAM6_CORE2_DUNNINGTON 0x1D ++ ++#define INTEL_FAM6_NEHALEM 0x1E ++#define INTEL_FAM6_NEHALEM_G 0x1F /* Auburndale / Havendale */ ++#define INTEL_FAM6_NEHALEM_EP 0x1A ++#define INTEL_FAM6_NEHALEM_EX 0x2E ++ ++#define INTEL_FAM6_WESTMERE 0x25 ++#define INTEL_FAM6_WESTMERE_EP 0x2C ++#define INTEL_FAM6_WESTMERE_EX 0x2F ++ ++#define INTEL_FAM6_SANDYBRIDGE 0x2A ++#define INTEL_FAM6_SANDYBRIDGE_X 0x2D ++#define INTEL_FAM6_IVYBRIDGE 0x3A ++#define INTEL_FAM6_IVYBRIDGE_X 0x3E ++ ++#define INTEL_FAM6_HASWELL_CORE 0x3C ++#define INTEL_FAM6_HASWELL_X 0x3F ++#define INTEL_FAM6_HASWELL_ULT 0x45 ++#define INTEL_FAM6_HASWELL_GT3E 0x46 ++ ++#define INTEL_FAM6_BROADWELL_CORE 0x3D ++#define INTEL_FAM6_BROADWELL_GT3E 0x47 ++#define INTEL_FAM6_BROADWELL_X 0x4F ++#define INTEL_FAM6_BROADWELL_XEON_D 0x56 ++ ++#define INTEL_FAM6_SKYLAKE_MOBILE 0x4E ++#define INTEL_FAM6_SKYLAKE_DESKTOP 0x5E ++#define INTEL_FAM6_SKYLAKE_X 0x55 ++#define INTEL_FAM6_KABYLAKE_MOBILE 0x8E ++#define INTEL_FAM6_KABYLAKE_DESKTOP 0x9E ++ ++/* "Small Core" Processors (Atom) */ ++ ++#define INTEL_FAM6_ATOM_PINEVIEW 0x1C ++#define INTEL_FAM6_ATOM_LINCROFT 0x26 ++#define INTEL_FAM6_ATOM_PENWELL 0x27 ++#define INTEL_FAM6_ATOM_CLOVERVIEW 0x35 ++#define INTEL_FAM6_ATOM_CEDARVIEW 0x36 ++#define INTEL_FAM6_ATOM_SILVERMONT1 0x37 /* BayTrail/BYT / Valleyview */ ++#define INTEL_FAM6_ATOM_SILVERMONT2 0x4D /* Avaton/Rangely */ ++#define INTEL_FAM6_ATOM_AIRMONT 0x4C /* CherryTrail / Braswell */ ++#define INTEL_FAM6_ATOM_MERRIFIELD 0x4A /* Tangier */ ++#define INTEL_FAM6_ATOM_MOOREFIELD 0x5A /* Anniedale */ ++#define INTEL_FAM6_ATOM_GOLDMONT 0x5C ++#define INTEL_FAM6_ATOM_DENVERTON 0x5F /* Goldmont Microserver */ ++#define INTEL_FAM6_ATOM_GEMINI_LAKE 0x7A ++ ++/* Xeon Phi */ ++ ++#define INTEL_FAM6_XEON_PHI_KNL 0x57 /* Knights Landing */ ++#define INTEL_FAM6_XEON_PHI_KNM 0x85 /* Knights Mill */ ++ ++#endif /* _ASM_X86_INTEL_FAMILY_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/compat.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,632 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_COMPAT_H ++#define _WG_COMPAT_H ++ ++#include ++#include ++#include ++#include ++ ++#ifdef RHEL_MAJOR ++#if RHEL_MAJOR == 7 ++#define ISRHEL7 ++#endif ++#endif ++#ifdef UTS_UBUNTU_RELEASE_ABI ++#if LINUX_VERSION_CODE == KERNEL_VERSION(3, 13, 11) ++#define ISUBUNTU1404 ++#endif ++#endif ++#ifdef CONFIG_SUSE_KERNEL ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 5, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 4, 0) ++#define ISOPENSUSE42 ++#endif ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 0) ++#error "WireGuard requires Linux >= 3.10" ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 0) && !defined(ISRHEL7) ++#define headers_start data ++#define headers_end data ++#endif ++ ++#include ++#ifndef __ro_after_init ++#define __ro_after_init __read_mostly ++#endif ++ ++#include ++#ifndef READ_ONCE ++#define READ_ONCE ACCESS_ONCE ++#endif ++ ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0) ++#include "udp_tunnel/udp_tunnel_partial_compat.h" ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 0) && !defined(DEBUG) && defined(net_dbg_ratelimited) ++#undef net_dbg_ratelimited ++#define net_dbg_ratelimited(fmt, ...) do { if (0) no_printk(KERN_DEBUG pr_fmt(fmt), ##__VA_ARGS__); } while (0) ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 0) ++#define RCU_LOCKDEP_WARN(cond, message) rcu_lockdep_assert(!(cond), message) ++#endif ++ ++#if ((LINUX_VERSION_CODE > KERNEL_VERSION(3, 19, 0) && LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 6)) || \ ++ (LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 12) && LINUX_VERSION_CODE > KERNEL_VERSION(3, 17, 0)) || \ ++ (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 8) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) || \ ++ LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 40)) && !defined(ISRHEL7) && !defined(ISUBUNTU1404) ++#define dev_recursion_level() 0 ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 0) && !defined(ISRHEL7) ++#define ipv6_dst_lookup(a, b, c, d) ipv6_dst_lookup(b, c, d) ++#endif ++ ++#if (LINUX_VERSION_CODE == KERNEL_VERSION(4, 4, 0) || \ ++ (LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 5) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0)) || \ ++ (LINUX_VERSION_CODE < KERNEL_VERSION(4, 1, 17) && LINUX_VERSION_CODE > KERNEL_VERSION(3, 19, 0)) || \ ++ (LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 27) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0)) || \ ++ (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 8) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) || \ ++ (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 40) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0)) || \ ++ (LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 54))) && !defined(ISUBUNTU1404) ++#include ++#include ++#define IP6_ECN_set_ce(a, b) IP6_ECN_set_ce(b) ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 9, 0) ++#define time_is_before_jiffies64(a) time_after64(get_jiffies_64(), a) ++#define time_is_after_jiffies64(a) time_before64(get_jiffies_64(), a) ++#define time_is_before_eq_jiffies64(a) time_after_eq64(get_jiffies_64(), a) ++#define time_is_after_eq_jiffies64(a) time_before_eq64(get_jiffies_64(), a) ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0) && IS_ENABLED(CONFIG_IPV6) && !defined(ISRHEL7) ++#include ++struct ipv6_stub_type { ++ void *udpv6_encap_enable; ++ int (*ipv6_dst_lookup)(struct sock *sk, struct dst_entry **dst, struct flowi6 *fl6); ++}; ++static const struct ipv6_stub_type ipv6_stub_impl = { ++ .udpv6_encap_enable = (void *)1, ++ .ipv6_dst_lookup = ip6_dst_lookup ++}; ++static const struct ipv6_stub_type *ipv6_stub = &ipv6_stub_impl; ++#endif ++ ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 8, 0) && IS_ENABLED(CONFIG_IPV6) && !defined(ISOPENSUSE42) && !defined(ISRHEL7) ++#include ++static inline bool ipv6_mod_enabled(void) ++{ ++ return ipv6_stub->udpv6_encap_enable != NULL; ++} ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 11, 0) ++#include ++static inline void skb_reset_tc(struct sk_buff *skb) ++{ ++#ifdef CONFIG_NET_CLS_ACT ++ skb->tc_verd = 0; ++#endif ++} ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 11, 0) ++#include ++static inline u32 get_random_u32(void) ++{ ++ static siphash_key_t key; ++ static u32 counter = 0; ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 0) ++ static bool has_seeded = false; ++ if (unlikely(!has_seeded)) { ++ get_random_bytes(&key, sizeof(key)); ++ has_seeded = true; ++ } ++#else ++ get_random_once(&key, sizeof(key)); ++#endif ++ return siphash_2u32(counter++, get_random_int(), &key); ++} ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 0) && !defined(ISRHEL7) ++static inline void netif_keep_dst(struct net_device *dev) ++{ ++ dev->priv_flags &= ~IFF_XMIT_DST_RELEASE; ++} ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0) && !defined(ISRHEL7) ++#include ++#ifndef netdev_alloc_pcpu_stats ++#define pcpu_sw_netstats pcpu_tstats ++#endif ++#ifndef netdev_alloc_pcpu_stats ++#define netdev_alloc_pcpu_stats alloc_percpu ++#endif ++#elif LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0) && !defined(ISRHEL7) ++#include ++#ifndef netdev_alloc_pcpu_stats ++#define netdev_alloc_pcpu_stats(type) \ ++({ \ ++ typeof(type) __percpu *pcpu_stats = alloc_percpu(type); \ ++ if (pcpu_stats) { \ ++ int __cpu; \ ++ for_each_possible_cpu(__cpu) { \ ++ typeof(type) *stat; \ ++ stat = per_cpu_ptr(pcpu_stats, __cpu); \ ++ u64_stats_init(&stat->syncp); \ ++ } \ ++ } \ ++ pcpu_stats; \ ++}) ++#endif ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0) ++#include "checksum/checksum_partial_compat.h" ++static inline void *our_pskb_put(struct sk_buff *skb, struct sk_buff *tail, int len) ++{ ++ if (tail != skb) { ++ skb->data_len += len; ++ skb->len += len; ++ } ++ return skb_put(tail, len); ++} ++#define pskb_put our_pskb_put ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) && !defined(ISRHEL7) ++#include ++static inline void skb_scrub_packet(struct sk_buff *skb, bool xnet) ++{ ++#ifdef CONFIG_CAVIUM_OCTEON_IPFWD_OFFLOAD ++ memset(&skb->cvm_info, 0, sizeof(skb->cvm_info)); ++ skb->cvm_reserved = 0; ++#endif ++ skb->tstamp.tv64 = 0; ++ skb->pkt_type = PACKET_HOST; ++ skb->skb_iif = 0; ++ skb_dst_drop(skb); ++ secpath_reset(skb); ++ nf_reset(skb); ++ nf_reset_trace(skb); ++ if (!xnet) ++ return; ++ skb_orphan(skb); ++ skb->mark = 0; ++} ++#endif ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0) || defined(ISUBUNTU1404)) && !defined(ISRHEL7) ++#include ++static inline u32 prandom_u32_max(u32 ep_ro) ++{ ++ return (u32)(((u64) prandom_u32() * ep_ro) >> 32); ++} ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 75) && !defined(ISRHEL7) ++#ifndef U8_MAX ++#define U8_MAX ((u8)~0U) ++#endif ++#ifndef S8_MAX ++#define S8_MAX ((s8)(U8_MAX >> 1)) ++#endif ++#ifndef S8_MIN ++#define S8_MIN ((s8)(-S8_MAX - 1)) ++#endif ++#ifndef U16_MAX ++#define U16_MAX ((u16)~0U) ++#endif ++#ifndef S16_MAX ++#define S16_MAX ((s16)(U16_MAX >> 1)) ++#endif ++#ifndef S16_MIN ++#define S16_MIN ((s16)(-S16_MAX - 1)) ++#endif ++#ifndef U32_MAX ++#define U32_MAX ((u32)~0U) ++#endif ++#ifndef S32_MAX ++#define S32_MAX ((s32)(U32_MAX >> 1)) ++#endif ++#ifndef S32_MIN ++#define S32_MIN ((s32)(-S32_MAX - 1)) ++#endif ++#ifndef U64_MAX ++#define U64_MAX ((u64)~0ULL) ++#endif ++#ifndef S64_MAX ++#define S64_MAX ((s64)(U64_MAX >> 1)) ++#endif ++#ifndef S64_MIN ++#define S64_MIN ((s64)(-S64_MAX - 1)) ++#endif ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 60) && !defined(ISRHEL7) ++/* Making this static may very well invalidate its usefulness, ++ * but so it goes with compat code. */ ++static inline void memzero_explicit(void *s, size_t count) ++{ ++ memset(s, 0, count); ++ barrier(); ++} ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0) && !defined(ISRHEL7) ++static const struct in6_addr our_in6addr_any = IN6ADDR_ANY_INIT; ++#define in6addr_any our_in6addr_any ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 13, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0) ++#include ++#include ++#include ++struct rng_initializer { ++ struct completion done; ++ struct random_ready_callback cb; ++}; ++static inline void rng_initialized_callback(struct random_ready_callback *cb) ++{ ++ complete(&container_of(cb, struct rng_initializer, cb)->done); ++} ++static inline int wait_for_random_bytes(void) ++{ ++ static bool rng_is_initialized = false; ++ int ret; ++ if (unlikely(!rng_is_initialized)) { ++ struct rng_initializer rng = { ++ .done = COMPLETION_INITIALIZER(rng.done), ++ .cb = { .owner = THIS_MODULE, .func = rng_initialized_callback } ++ }; ++ ret = add_random_ready_callback(&rng.cb); ++ if (!ret) { ++ ret = wait_for_completion_interruptible(&rng.done); ++ if (ret) { ++ del_random_ready_callback(&rng.cb); ++ return ret; ++ } ++ } else if (ret != -EALREADY) ++ return ret; ++ rng_is_initialized = true; ++ } ++ return 0; ++} ++#elif LINUX_VERSION_CODE < KERNEL_VERSION(4, 2, 0) ++/* This is a disaster. Without this API, we really have no way of ++ * knowing if it's initialized. We just return that it has and hope ++ * for the best... */ ++static inline int wait_for_random_bytes(void) ++{ ++ return 0; ++} ++#endif ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 13, 0) ++static inline int get_random_bytes_wait(void *buf, int nbytes) ++{ ++ int ret = wait_for_random_bytes(); ++ if (unlikely(ret)) ++ return ret; ++ get_random_bytes(buf, nbytes); ++ return 0; ++} ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) && !defined(ISRHEL7) ++#define system_power_efficient_wq system_unbound_wq ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 17, 0) && !defined(ISRHEL7) ++#include ++static inline u64 ktime_get_ns(void) ++{ ++ return ktime_to_ns(ktime_get()); ++} ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0) ++#include ++static inline __be32 our_confirm_addr_indev(struct in_device *in_dev, __be32 dst, __be32 local, int scope) ++{ ++ int same = 0; ++ __be32 addr = 0; ++ for_ifa(in_dev) { ++ if (!addr && (local == ifa->ifa_local || !local) && ifa->ifa_scope <= scope) { ++ addr = ifa->ifa_local; ++ if (same) ++ break; ++ } ++ if (!same) { ++ same = (!local || inet_ifa_match(local, ifa)) && (!dst || inet_ifa_match(dst, ifa)); ++ if (same && addr) { ++ if (local || !dst) ++ break; ++ if (inet_ifa_match(addr, ifa)) ++ break; ++ if (ifa->ifa_scope <= scope) { ++ addr = ifa->ifa_local; ++ break; ++ } ++ same = 0; ++ } ++ } ++ } endfor_ifa(in_dev); ++ return same ? addr : 0; ++} ++static inline __be32 our_inet_confirm_addr(struct net *net, struct in_device *in_dev, __be32 dst, __be32 local, int scope) ++{ ++ __be32 addr = 0; ++ struct net_device *dev; ++ if (in_dev) ++ return our_confirm_addr_indev(in_dev, dst, local, scope); ++ rcu_read_lock(); ++ for_each_netdev_rcu(net, dev) { ++ in_dev = __in_dev_get_rcu(dev); ++ if (in_dev) { ++ addr = our_confirm_addr_indev(in_dev, dst, local, scope); ++ if (addr) ++ break; ++ } ++ } ++ rcu_read_unlock(); ++ return addr; ++} ++#define inet_confirm_addr our_inet_confirm_addr ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 12, 0) ++#include ++#include ++#include ++static inline void *kvmalloc_ours(size_t size, gfp_t flags) ++{ ++ gfp_t kmalloc_flags = flags; ++ void *ret; ++ if (size > PAGE_SIZE) { ++ kmalloc_flags |= __GFP_NOWARN; ++ if (!(kmalloc_flags & __GFP_REPEAT) || (size <= PAGE_SIZE << PAGE_ALLOC_COSTLY_ORDER)) ++ kmalloc_flags |= __GFP_NORETRY; ++ } ++ ret = kmalloc(size, kmalloc_flags); ++ if (ret || size <= PAGE_SIZE) ++ return ret; ++ return __vmalloc(size, flags, PAGE_KERNEL); ++} ++static inline void *kvzalloc_ours(size_t size, gfp_t flags) ++{ ++ return kvmalloc_ours(size, flags | __GFP_ZERO); ++} ++#define kvmalloc kvmalloc_ours ++#define kvzalloc kvzalloc_ours ++#endif ++ ++#if ((LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0)) || LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 41)) && !defined(ISUBUNTU1404) ++#include ++#include ++static inline void kvfree_ours(const void *addr) ++{ ++ if (is_vmalloc_addr(addr)) ++ vfree(addr); ++ else ++ kfree(addr); ++} ++#define kvfree kvfree_ours ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 11, 9) ++#include ++#define priv_destructor destructor ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 13, 0) ++#define newlink(a,b,c,d,e) newlink(a,b,c,d) ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 12, 0) ++#include ++#include ++#define nlmsg_parse(a, b, c, d, e, f) nlmsg_parse(a, b, c, d, e) ++#define nla_parse_nested(a, b, c, d, e) nla_parse_nested(a, b, c, d) ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 10, 0) ++static inline struct nlattr **genl_family_attrbuf(const struct genl_family *family) ++{ ++ return family->attrbuf; ++} ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0) ++#define PTR_ERR_OR_ZERO(p) PTR_RET(p) ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 7, 0) ++#include ++#define nla_put_u64_64bit(a, b, c, d) nla_put_u64(a, b, c) ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 6, 0) ++#include ++#ifndef GENL_UNS_ADMIN_PERM ++#define GENL_UNS_ADMIN_PERM GENL_ADMIN_PERM ++#endif ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 10, 0) ++#include ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 13, 0) && !defined(ISRHEL7) ++#define genl_register_family(a) genl_register_family_with_ops(a, genl_ops, ARRAY_SIZE(genl_ops)) ++#define COMPAT_CANNOT_USE_CONST_GENL_OPS ++#else ++#define genl_register_family(a) genl_register_family_with_ops(a, genl_ops) ++#endif ++#define COMPAT_CANNOT_USE_GENL_NOPS ++#endif ++ ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 14, 2) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) || (LINUX_VERSION_CODE < KERNEL_VERSION(4, 13, 16) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 10, 0)) || (LINUX_VERSION_CODE < KERNEL_VERSION(4, 9, 65) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 5, 0)) || (LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 101) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) || LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 84) ++#define ___COMPAT_NETLINK_DUMP_BLOCK { int ret; skb->end -= nlmsg_total_size(sizeof(int)); ret = get_device_dump_real(skb, cb); skb->end += nlmsg_total_size(sizeof(int)); return ret; } ++#define ___COMPAT_NETLINK_DUMP_OVERRIDE ++#else ++#define ___COMPAT_NETLINK_DUMP_BLOCK return get_device_dump_real(skb, cb); ++#endif ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 13, 14) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 10, 0)) || LINUX_VERSION_CODE < KERNEL_VERSION(4, 9, 63) ++#define get_device_dump(a, b) get_device_dump_real(a, b); \ ++static int get_device_dump(a, b) { \ ++ struct wireguard_device *wg = (struct wireguard_device *)cb->args[0]; \ ++ if (!wg) { \ ++ int ret = get_device_start(cb); \ ++ if (ret) \ ++ return ret; \ ++ } \ ++ ___COMPAT_NETLINK_DUMP_BLOCK \ ++} \ ++static int get_device_dump_real(a, b) ++#define COMPAT_CANNOT_USE_NETLINK_START ++#elif defined(___COMPAT_NETLINK_DUMP_OVERRIDE) ++#define get_device_dump(a, b) get_device_dump_real(a, b); \ ++static int get_device_dump(a, b) { \ ++ ___COMPAT_NETLINK_DUMP_BLOCK \ ++} \ ++static int get_device_dump_real(a, b) ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 17, 0) ++#define COMPAT_CANNOT_USE_IN6_DEV_GET ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 11, 0) ++#define COMPAT_CANNOT_USE_DEV_CNF ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 0) ++#define COMPAT_CANNOT_USE_IFF_NO_QUEUE ++#endif ++ ++#if defined(CONFIG_X86_64) && LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 0) ++#include ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 2, 0) ++#include ++#include ++static inline int cpu_has_xfeatures(u64 xfeatures_needed, const char **feature_name) ++{ ++ return xgetbv(XCR_XFEATURE_ENABLED_MASK) & xfeatures_needed; ++} ++#endif ++#ifndef XFEATURE_MASK_YMM ++#define XFEATURE_MASK_YMM XSTATE_YMM ++#endif ++#ifndef XFEATURE_MASK_SSE ++#define XFEATURE_MASK_SSE XSTATE_SSE ++#endif ++#ifndef XSTATE_AVX512 ++#define XSTATE_AVX512 (XSTATE_OPMASK | XSTATE_ZMM_Hi256 | XSTATE_Hi16_ZMM) ++#endif ++#ifndef XFEATURE_MASK_AVX512 ++#define XFEATURE_MASK_AVX512 XSTATE_AVX512 ++#endif ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 6, 0) && defined(CONFIG_X86_64) ++/* This is incredibly dumb and reckless, but as it turns out, there's ++ * not really hardware Linux runs properly on that supports F but not BW ++ * and VL, so in practice this isn't so bad. Plus, this is compat layer, ++ * so the bar remains fairly low. ++ */ ++#include ++#ifndef X86_FEATURE_AVX512BW ++#define X86_FEATURE_AVX512BW X86_FEATURE_AVX512F ++#endif ++#ifndef X86_FEATURE_AVX512VL ++#define X86_FEATURE_AVX512VL X86_FEATURE_AVX512F ++#endif ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) ++struct _____dummy_container { char dev; }; ++#define netdev_notifier_info net_device *)data); __attribute((unused)) char _____dummy = ((struct _____dummy_container ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 14, 0) ++#define timer_setup(a, b, c) setup_timer(a, ((void (*)(unsigned long))b), ((unsigned long)a)) ++#define from_timer(var, callback_timer, timer_fieldname) container_of(callback_timer, typeof(*var), timer_fieldname) ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 3) ++#define COMPAT_CANNOT_USE_AVX512 ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 17, 0) ++#define timespec64 timespec ++#define getnstimeofday64 getnstimeofday ++#endif ++ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++#include ++#define genl_dump_check_consistent(a, b) genl_dump_check_consistent(a, b, &genl_family) ++#endif ++ ++/* https://lkml.org/lkml/2017/6/23/790 */ ++#if IS_ENABLED(CONFIG_NF_CONNTRACK) ++#include ++#include ++#include ++#include ++#include ++#include ++static inline void new_icmp_send(struct sk_buff *skb_in, int type, int code, __be32 info) ++{ ++ enum ip_conntrack_info ctinfo; ++ struct nf_conn *ct = nf_ct_get(skb_in, &ctinfo); ++ if (skb_network_header(skb_in) < skb_in->head || (skb_network_header(skb_in) + sizeof(struct iphdr)) > skb_tail_pointer(skb_in)) ++ return; ++ if (ct) ++ ip_hdr(skb_in)->saddr = ct->tuplehash[0].tuple.src.u3.ip; ++ icmp_send(skb_in, type, code, info); ++} ++static inline void new_icmpv6_send(struct sk_buff *skb, u8 type, u8 code, __u32 info) ++{ ++ enum ip_conntrack_info ctinfo; ++ struct nf_conn *ct = nf_ct_get(skb, &ctinfo); ++ if (skb_network_header(skb) < skb->head || (skb_network_header(skb) + sizeof(struct ipv6hdr)) > skb_tail_pointer(skb)) ++ return; ++ if (ct) ++ ipv6_hdr(skb)->saddr = ct->tuplehash[0].tuple.src.u3.in6; ++ icmpv6_send(skb, type, code, info); ++} ++#define icmp_send(a,b,c,d) new_icmp_send(a,b,c,d) ++#define icmpv6_send(a,b,c,d) new_icmpv6_send(a,b,c,d) ++#endif ++ ++/* PaX compatibility */ ++#ifdef CONSTIFY_PLUGIN ++#include ++#undef __read_mostly ++#define __read_mostly ++#endif ++#if defined(RAP_PLUGIN) && LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) ++#include ++#define expired_retransmit_handshake(a) expired_retransmit_handshake(unsigned long timer) ++#define expired_send_keepalive(a) expired_send_keepalive(unsigned long timer) ++#define expired_new_handshake(a) expired_new_handshake(unsigned long timer) ++#define expired_zero_key_material(a) expired_zero_key_material(unsigned long timer) ++#define expired_send_persistent_keepalive(a) expired_send_persistent_keepalive(unsigned long timer) ++#undef timer_setup ++#define timer_setup(a, b, c) setup_timer(a, ((void (*)(unsigned long))b), ((unsigned long)a)) ++#undef from_timer ++#define from_timer(var, callback_timer, timer_fieldname) container_of((struct timer_list *)callback_timer, typeof(*var), timer_fieldname) ++#endif ++ ++#endif /* _WG_COMPAT_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/ptr_ring/include/linux/ptr_ring.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,640 @@ ++/* ++ * Definitions for the 'struct ptr_ring' datastructure. ++ * ++ * Author: ++ * Michael S. Tsirkin ++ * ++ * Copyright (C) 2016 Red Hat, Inc. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms of the GNU General Public License as published by the ++ * Free Software Foundation; either version 2 of the License, or (at your ++ * option) any later version. ++ * ++ * This is a limited-size FIFO maintaining pointers in FIFO order, with ++ * one CPU producing entries and another consuming entries from a FIFO. ++ * ++ * This implementation tries to minimize cache-contention when there is a ++ * single producer and a single consumer CPU. ++ */ ++ ++#ifndef _LINUX_PTR_RING_H ++#define _LINUX_PTR_RING_H 1 ++ ++#ifdef __KERNEL__ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#endif ++ ++struct ptr_ring { ++ int producer ____cacheline_aligned_in_smp; ++ spinlock_t producer_lock; ++ int consumer_head ____cacheline_aligned_in_smp; /* next valid entry */ ++ int consumer_tail; /* next entry to invalidate */ ++ spinlock_t consumer_lock; ++ /* Shared consumer/producer data */ ++ /* Read-only by both the producer and the consumer */ ++ int size ____cacheline_aligned_in_smp; /* max entries in queue */ ++ int batch; /* number of entries to consume in a batch */ ++ void **queue; ++}; ++ ++/* Note: callers invoking this in a loop must use a compiler barrier, ++ * for example cpu_relax(). If ring is ever resized, callers must hold ++ * producer_lock - see e.g. ptr_ring_full. Otherwise, if callers don't hold ++ * producer_lock, the next call to __ptr_ring_produce may fail. ++ */ ++static inline bool __ptr_ring_full(struct ptr_ring *r) ++{ ++ return r->queue[r->producer]; ++} ++ ++static inline bool ptr_ring_full(struct ptr_ring *r) ++{ ++ bool ret; ++ ++ spin_lock(&r->producer_lock); ++ ret = __ptr_ring_full(r); ++ spin_unlock(&r->producer_lock); ++ ++ return ret; ++} ++ ++static inline bool ptr_ring_full_irq(struct ptr_ring *r) ++{ ++ bool ret; ++ ++ spin_lock_irq(&r->producer_lock); ++ ret = __ptr_ring_full(r); ++ spin_unlock_irq(&r->producer_lock); ++ ++ return ret; ++} ++ ++static inline bool ptr_ring_full_any(struct ptr_ring *r) ++{ ++ unsigned long flags; ++ bool ret; ++ ++ spin_lock_irqsave(&r->producer_lock, flags); ++ ret = __ptr_ring_full(r); ++ spin_unlock_irqrestore(&r->producer_lock, flags); ++ ++ return ret; ++} ++ ++static inline bool ptr_ring_full_bh(struct ptr_ring *r) ++{ ++ bool ret; ++ ++ spin_lock_bh(&r->producer_lock); ++ ret = __ptr_ring_full(r); ++ spin_unlock_bh(&r->producer_lock); ++ ++ return ret; ++} ++ ++/* Note: callers invoking this in a loop must use a compiler barrier, ++ * for example cpu_relax(). Callers must hold producer_lock. ++ */ ++static inline int __ptr_ring_produce(struct ptr_ring *r, void *ptr) ++{ ++ if (unlikely(!r->size) || r->queue[r->producer]) ++ return -ENOSPC; ++ ++ r->queue[r->producer++] = ptr; ++ if (unlikely(r->producer >= r->size)) ++ r->producer = 0; ++ return 0; ++} ++ ++/* ++ * Note: resize (below) nests producer lock within consumer lock, so if you ++ * consume in interrupt or BH context, you must disable interrupts/BH when ++ * calling this. ++ */ ++static inline int ptr_ring_produce(struct ptr_ring *r, void *ptr) ++{ ++ int ret; ++ ++ spin_lock(&r->producer_lock); ++ ret = __ptr_ring_produce(r, ptr); ++ spin_unlock(&r->producer_lock); ++ ++ return ret; ++} ++ ++static inline int ptr_ring_produce_irq(struct ptr_ring *r, void *ptr) ++{ ++ int ret; ++ ++ spin_lock_irq(&r->producer_lock); ++ ret = __ptr_ring_produce(r, ptr); ++ spin_unlock_irq(&r->producer_lock); ++ ++ return ret; ++} ++ ++static inline int ptr_ring_produce_any(struct ptr_ring *r, void *ptr) ++{ ++ unsigned long flags; ++ int ret; ++ ++ spin_lock_irqsave(&r->producer_lock, flags); ++ ret = __ptr_ring_produce(r, ptr); ++ spin_unlock_irqrestore(&r->producer_lock, flags); ++ ++ return ret; ++} ++ ++static inline int ptr_ring_produce_bh(struct ptr_ring *r, void *ptr) ++{ ++ int ret; ++ ++ spin_lock_bh(&r->producer_lock); ++ ret = __ptr_ring_produce(r, ptr); ++ spin_unlock_bh(&r->producer_lock); ++ ++ return ret; ++} ++ ++/* Note: callers invoking this in a loop must use a compiler barrier, ++ * for example cpu_relax(). Callers must take consumer_lock ++ * if they dereference the pointer - see e.g. PTR_RING_PEEK_CALL. ++ * If ring is never resized, and if the pointer is merely ++ * tested, there's no need to take the lock - see e.g. __ptr_ring_empty. ++ */ ++static inline void *__ptr_ring_peek(struct ptr_ring *r) ++{ ++ if (likely(r->size)) ++ return r->queue[r->consumer_head]; ++ return NULL; ++} ++ ++/* Note: callers invoking this in a loop must use a compiler barrier, ++ * for example cpu_relax(). Callers must take consumer_lock ++ * if the ring is ever resized - see e.g. ptr_ring_empty. ++ */ ++static inline bool __ptr_ring_empty(struct ptr_ring *r) ++{ ++ return !__ptr_ring_peek(r); ++} ++ ++static inline bool ptr_ring_empty(struct ptr_ring *r) ++{ ++ bool ret; ++ ++ spin_lock(&r->consumer_lock); ++ ret = __ptr_ring_empty(r); ++ spin_unlock(&r->consumer_lock); ++ ++ return ret; ++} ++ ++static inline bool ptr_ring_empty_irq(struct ptr_ring *r) ++{ ++ bool ret; ++ ++ spin_lock_irq(&r->consumer_lock); ++ ret = __ptr_ring_empty(r); ++ spin_unlock_irq(&r->consumer_lock); ++ ++ return ret; ++} ++ ++static inline bool ptr_ring_empty_any(struct ptr_ring *r) ++{ ++ unsigned long flags; ++ bool ret; ++ ++ spin_lock_irqsave(&r->consumer_lock, flags); ++ ret = __ptr_ring_empty(r); ++ spin_unlock_irqrestore(&r->consumer_lock, flags); ++ ++ return ret; ++} ++ ++static inline bool ptr_ring_empty_bh(struct ptr_ring *r) ++{ ++ bool ret; ++ ++ spin_lock_bh(&r->consumer_lock); ++ ret = __ptr_ring_empty(r); ++ spin_unlock_bh(&r->consumer_lock); ++ ++ return ret; ++} ++ ++/* Must only be called after __ptr_ring_peek returned !NULL */ ++static inline void __ptr_ring_discard_one(struct ptr_ring *r) ++{ ++ /* Fundamentally, what we want to do is update consumer ++ * index and zero out the entry so producer can reuse it. ++ * Doing it naively at each consume would be as simple as: ++ * r->queue[r->consumer++] = NULL; ++ * if (unlikely(r->consumer >= r->size)) ++ * r->consumer = 0; ++ * but that is suboptimal when the ring is full as producer is writing ++ * out new entries in the same cache line. Defer these updates until a ++ * batch of entries has been consumed. ++ */ ++ int head = r->consumer_head++; ++ ++ /* Once we have processed enough entries invalidate them in ++ * the ring all at once so producer can reuse their space in the ring. ++ * We also do this when we reach end of the ring - not mandatory ++ * but helps keep the implementation simple. ++ */ ++ if (unlikely(r->consumer_head - r->consumer_tail >= r->batch || ++ r->consumer_head >= r->size)) { ++ /* Zero out entries in the reverse order: this way we touch the ++ * cache line that producer might currently be reading the last; ++ * producer won't make progress and touch other cache lines ++ * besides the first one until we write out all entries. ++ */ ++ while (likely(head >= r->consumer_tail)) ++ r->queue[head--] = NULL; ++ r->consumer_tail = r->consumer_head; ++ } ++ if (unlikely(r->consumer_head >= r->size)) { ++ r->consumer_head = 0; ++ r->consumer_tail = 0; ++ } ++} ++ ++static inline void *__ptr_ring_consume(struct ptr_ring *r) ++{ ++ void *ptr; ++ ++ ptr = __ptr_ring_peek(r); ++ if (ptr) ++ __ptr_ring_discard_one(r); ++ ++ return ptr; ++} ++ ++static inline int __ptr_ring_consume_batched(struct ptr_ring *r, ++ void **array, int n) ++{ ++ void *ptr; ++ int i; ++ ++ for (i = 0; i < n; i++) { ++ ptr = __ptr_ring_consume(r); ++ if (!ptr) ++ break; ++ array[i] = ptr; ++ } ++ ++ return i; ++} ++ ++/* ++ * Note: resize (below) nests producer lock within consumer lock, so if you ++ * call this in interrupt or BH context, you must disable interrupts/BH when ++ * producing. ++ */ ++static inline void *ptr_ring_consume(struct ptr_ring *r) ++{ ++ void *ptr; ++ ++ spin_lock(&r->consumer_lock); ++ ptr = __ptr_ring_consume(r); ++ spin_unlock(&r->consumer_lock); ++ ++ return ptr; ++} ++ ++static inline void *ptr_ring_consume_irq(struct ptr_ring *r) ++{ ++ void *ptr; ++ ++ spin_lock_irq(&r->consumer_lock); ++ ptr = __ptr_ring_consume(r); ++ spin_unlock_irq(&r->consumer_lock); ++ ++ return ptr; ++} ++ ++static inline void *ptr_ring_consume_any(struct ptr_ring *r) ++{ ++ unsigned long flags; ++ void *ptr; ++ ++ spin_lock_irqsave(&r->consumer_lock, flags); ++ ptr = __ptr_ring_consume(r); ++ spin_unlock_irqrestore(&r->consumer_lock, flags); ++ ++ return ptr; ++} ++ ++static inline void *ptr_ring_consume_bh(struct ptr_ring *r) ++{ ++ void *ptr; ++ ++ spin_lock_bh(&r->consumer_lock); ++ ptr = __ptr_ring_consume(r); ++ spin_unlock_bh(&r->consumer_lock); ++ ++ return ptr; ++} ++ ++static inline int ptr_ring_consume_batched(struct ptr_ring *r, ++ void **array, int n) ++{ ++ int ret; ++ ++ spin_lock(&r->consumer_lock); ++ ret = __ptr_ring_consume_batched(r, array, n); ++ spin_unlock(&r->consumer_lock); ++ ++ return ret; ++} ++ ++static inline int ptr_ring_consume_batched_irq(struct ptr_ring *r, ++ void **array, int n) ++{ ++ int ret; ++ ++ spin_lock_irq(&r->consumer_lock); ++ ret = __ptr_ring_consume_batched(r, array, n); ++ spin_unlock_irq(&r->consumer_lock); ++ ++ return ret; ++} ++ ++static inline int ptr_ring_consume_batched_any(struct ptr_ring *r, ++ void **array, int n) ++{ ++ unsigned long flags; ++ int ret; ++ ++ spin_lock_irqsave(&r->consumer_lock, flags); ++ ret = __ptr_ring_consume_batched(r, array, n); ++ spin_unlock_irqrestore(&r->consumer_lock, flags); ++ ++ return ret; ++} ++ ++static inline int ptr_ring_consume_batched_bh(struct ptr_ring *r, ++ void **array, int n) ++{ ++ int ret; ++ ++ spin_lock_bh(&r->consumer_lock); ++ ret = __ptr_ring_consume_batched(r, array, n); ++ spin_unlock_bh(&r->consumer_lock); ++ ++ return ret; ++} ++ ++/* Cast to structure type and call a function without discarding from FIFO. ++ * Function must return a value. ++ * Callers must take consumer_lock. ++ */ ++#define __PTR_RING_PEEK_CALL(r, f) ((f)(__ptr_ring_peek(r))) ++ ++#define PTR_RING_PEEK_CALL(r, f) ({ \ ++ typeof((f)(NULL)) __PTR_RING_PEEK_CALL_v; \ ++ \ ++ spin_lock(&(r)->consumer_lock); \ ++ __PTR_RING_PEEK_CALL_v = __PTR_RING_PEEK_CALL(r, f); \ ++ spin_unlock(&(r)->consumer_lock); \ ++ __PTR_RING_PEEK_CALL_v; \ ++}) ++ ++#define PTR_RING_PEEK_CALL_IRQ(r, f) ({ \ ++ typeof((f)(NULL)) __PTR_RING_PEEK_CALL_v; \ ++ \ ++ spin_lock_irq(&(r)->consumer_lock); \ ++ __PTR_RING_PEEK_CALL_v = __PTR_RING_PEEK_CALL(r, f); \ ++ spin_unlock_irq(&(r)->consumer_lock); \ ++ __PTR_RING_PEEK_CALL_v; \ ++}) ++ ++#define PTR_RING_PEEK_CALL_BH(r, f) ({ \ ++ typeof((f)(NULL)) __PTR_RING_PEEK_CALL_v; \ ++ \ ++ spin_lock_bh(&(r)->consumer_lock); \ ++ __PTR_RING_PEEK_CALL_v = __PTR_RING_PEEK_CALL(r, f); \ ++ spin_unlock_bh(&(r)->consumer_lock); \ ++ __PTR_RING_PEEK_CALL_v; \ ++}) ++ ++#define PTR_RING_PEEK_CALL_ANY(r, f) ({ \ ++ typeof((f)(NULL)) __PTR_RING_PEEK_CALL_v; \ ++ unsigned long __PTR_RING_PEEK_CALL_f;\ ++ \ ++ spin_lock_irqsave(&(r)->consumer_lock, __PTR_RING_PEEK_CALL_f); \ ++ __PTR_RING_PEEK_CALL_v = __PTR_RING_PEEK_CALL(r, f); \ ++ spin_unlock_irqrestore(&(r)->consumer_lock, __PTR_RING_PEEK_CALL_f); \ ++ __PTR_RING_PEEK_CALL_v; \ ++}) ++ ++static inline void **__ptr_ring_init_queue_alloc(unsigned int size, gfp_t gfp) ++{ ++ return kcalloc(size, sizeof(void *), gfp); ++} ++ ++static inline void __ptr_ring_set_size(struct ptr_ring *r, int size) ++{ ++ r->size = size; ++ r->batch = SMP_CACHE_BYTES * 2 / sizeof(*(r->queue)); ++ /* We need to set batch at least to 1 to make logic ++ * in __ptr_ring_discard_one work correctly. ++ * Batching too much (because ring is small) would cause a lot of ++ * burstiness. Needs tuning, for now disable batching. ++ */ ++ if (r->batch > r->size / 2 || !r->batch) ++ r->batch = 1; ++} ++ ++static inline int ptr_ring_init(struct ptr_ring *r, int size, gfp_t gfp) ++{ ++ r->queue = __ptr_ring_init_queue_alloc(size, gfp); ++ if (!r->queue) ++ return -ENOMEM; ++ ++ __ptr_ring_set_size(r, size); ++ r->producer = r->consumer_head = r->consumer_tail = 0; ++ spin_lock_init(&r->producer_lock); ++ spin_lock_init(&r->consumer_lock); ++ ++ return 0; ++} ++ ++/* ++ * Return entries into ring. Destroy entries that don't fit. ++ * ++ * Note: this is expected to be a rare slow path operation. ++ * ++ * Note: producer lock is nested within consumer lock, so if you ++ * resize you must make sure all uses nest correctly. ++ * In particular if you consume ring in interrupt or BH context, you must ++ * disable interrupts/BH when doing so. ++ */ ++static inline void ptr_ring_unconsume(struct ptr_ring *r, void **batch, int n, ++ void (*destroy)(void *)) ++{ ++ unsigned long flags; ++ int head; ++ ++ spin_lock_irqsave(&r->consumer_lock, flags); ++ spin_lock(&r->producer_lock); ++ ++ if (!r->size) ++ goto done; ++ ++ /* ++ * Clean out buffered entries (for simplicity). This way following code ++ * can test entries for NULL and if not assume they are valid. ++ */ ++ head = r->consumer_head - 1; ++ while (likely(head >= r->consumer_tail)) ++ r->queue[head--] = NULL; ++ r->consumer_tail = r->consumer_head; ++ ++ /* ++ * Go over entries in batch, start moving head back and copy entries. ++ * Stop when we run into previously unconsumed entries. ++ */ ++ while (n) { ++ head = r->consumer_head - 1; ++ if (head < 0) ++ head = r->size - 1; ++ if (r->queue[head]) { ++ /* This batch entry will have to be destroyed. */ ++ goto done; ++ } ++ r->queue[head] = batch[--n]; ++ r->consumer_tail = r->consumer_head = head; ++ } ++ ++done: ++ /* Destroy all entries left in the batch. */ ++ while (n) ++ destroy(batch[--n]); ++ spin_unlock(&r->producer_lock); ++ spin_unlock_irqrestore(&r->consumer_lock, flags); ++} ++ ++static inline void **__ptr_ring_swap_queue(struct ptr_ring *r, void **queue, ++ int size, gfp_t gfp, ++ void (*destroy)(void *)) ++{ ++ int producer = 0; ++ void **old; ++ void *ptr; ++ ++ while ((ptr = __ptr_ring_consume(r))) ++ if (producer < size) ++ queue[producer++] = ptr; ++ else if (destroy) ++ destroy(ptr); ++ ++ __ptr_ring_set_size(r, size); ++ r->producer = producer; ++ r->consumer_head = 0; ++ r->consumer_tail = 0; ++ old = r->queue; ++ r->queue = queue; ++ ++ return old; ++} ++ ++/* ++ * Note: producer lock is nested within consumer lock, so if you ++ * resize you must make sure all uses nest correctly. ++ * In particular if you consume ring in interrupt or BH context, you must ++ * disable interrupts/BH when doing so. ++ */ ++static inline int ptr_ring_resize(struct ptr_ring *r, int size, gfp_t gfp, ++ void (*destroy)(void *)) ++{ ++ unsigned long flags; ++ void **queue = __ptr_ring_init_queue_alloc(size, gfp); ++ void **old; ++ ++ if (!queue) ++ return -ENOMEM; ++ ++ spin_lock_irqsave(&(r)->consumer_lock, flags); ++ spin_lock(&(r)->producer_lock); ++ ++ old = __ptr_ring_swap_queue(r, queue, size, gfp, destroy); ++ ++ spin_unlock(&(r)->producer_lock); ++ spin_unlock_irqrestore(&(r)->consumer_lock, flags); ++ ++ kfree(old); ++ ++ return 0; ++} ++ ++/* ++ * Note: producer lock is nested within consumer lock, so if you ++ * resize you must make sure all uses nest correctly. ++ * In particular if you consume ring in interrupt or BH context, you must ++ * disable interrupts/BH when doing so. ++ */ ++static inline int ptr_ring_resize_multiple(struct ptr_ring **rings, ++ unsigned int nrings, ++ int size, ++ gfp_t gfp, void (*destroy)(void *)) ++{ ++ unsigned long flags; ++ void ***queues; ++ int i; ++ ++ queues = kmalloc_array(nrings, sizeof(*queues), gfp); ++ if (!queues) ++ goto noqueues; ++ ++ for (i = 0; i < nrings; ++i) { ++ queues[i] = __ptr_ring_init_queue_alloc(size, gfp); ++ if (!queues[i]) ++ goto nomem; ++ } ++ ++ for (i = 0; i < nrings; ++i) { ++ spin_lock_irqsave(&(rings[i])->consumer_lock, flags); ++ spin_lock(&(rings[i])->producer_lock); ++ queues[i] = __ptr_ring_swap_queue(rings[i], queues[i], ++ size, gfp, destroy); ++ spin_unlock(&(rings[i])->producer_lock); ++ spin_unlock_irqrestore(&(rings[i])->consumer_lock, flags); ++ } ++ ++ for (i = 0; i < nrings; ++i) ++ kfree(queues[i]); ++ ++ kfree(queues); ++ ++ return 0; ++ ++nomem: ++ while (--i >= 0) ++ kfree(queues[i]); ++ ++ kfree(queues); ++ ++noqueues: ++ return -ENOMEM; ++} ++ ++static inline void ptr_ring_cleanup(struct ptr_ring *r, void (*destroy)(void *)) ++{ ++ void *ptr; ++ ++ if (destroy) ++ while ((ptr = ptr_ring_consume(r))) ++ destroy(ptr); ++ kfree(r->queue); ++} ++ ++#endif /* _LINUX_PTR_RING_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/memneq/include.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,5 @@ ++extern noinline unsigned long __crypto_memneq(const void *a, const void *b, size_t size); ++static inline int crypto_memneq(const void *a, const void *b, size_t size) ++{ ++ return __crypto_memneq(a, b, size) != 0UL ? 1 : 0; ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/memneq/memneq.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,170 @@ ++/* ++ * Constant-time equality testing of memory regions. ++ * ++ * Authors: ++ * ++ * James Yonan ++ * Daniel Borkmann ++ * ++ * This file is provided under a dual BSD/GPLv2 license. When using or ++ * redistributing this file, you may do so under either license. ++ * ++ * GPL LICENSE SUMMARY ++ * ++ * Copyright(c) 2013 OpenVPN Technologies, Inc. All rights reserved. ++ * ++ * This program is free software; you can redistribute it and/or modify ++ * it under the terms of version 2 of the GNU General Public License as ++ * published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope that it will be useful, but ++ * WITHOUT ANY WARRANTY; without even the implied warranty of ++ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU ++ * General Public License for more details. ++ * ++ * You should have received a copy of the GNU General Public License ++ * along with this program; if not, write to the Free Software ++ * Foundation, Inc., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. ++ * The full GNU General Public License is included in this distribution ++ * in the file called LICENSE.GPL. ++ * ++ * BSD LICENSE ++ * ++ * Copyright(c) 2013 OpenVPN Technologies, Inc. All rights reserved. ++ * ++ * Redistribution and use in source and binary forms, with or without ++ * modification, are permitted provided that the following conditions ++ * are met: ++ * ++ * * Redistributions of source code must retain the above copyright ++ * notice, this list of conditions and the following disclaimer. ++ * * Redistributions in binary form must reproduce the above copyright ++ * notice, this list of conditions and the following disclaimer in ++ * the documentation and/or other materials provided with the ++ * distribution. ++ * * Neither the name of OpenVPN Technologies nor the names of its ++ * contributors may be used to endorse or promote products derived ++ * from this software without specific prior written permission. ++ * ++ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS ++ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT ++ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR ++ * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT ++ * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, ++ * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT ++ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, ++ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY ++ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT ++ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE ++ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. ++ */ ++ ++#include ++ ++/* Make the optimizer believe the variable can be manipulated arbitrarily. */ ++#define COMPILER_OPTIMIZER_HIDE_VAR(var) __asm__ ("" : "=r" (var) : "0" (var)) ++ ++#ifndef __HAVE_ARCH_CRYPTO_MEMNEQ ++ ++/* Generic path for arbitrary size */ ++static inline unsigned long ++__crypto_memneq_generic(const void *a, const void *b, size_t size) ++{ ++ unsigned long neq = 0; ++ ++#if defined(CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS) ++ while (size >= sizeof(unsigned long)) { ++ neq |= *(unsigned long *)a ^ *(unsigned long *)b; ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ a += sizeof(unsigned long); ++ b += sizeof(unsigned long); ++ size -= sizeof(unsigned long); ++ } ++#endif /* CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS */ ++ while (size > 0) { ++ neq |= *(unsigned char *)a ^ *(unsigned char *)b; ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ a += 1; ++ b += 1; ++ size -= 1; ++ } ++ return neq; ++} ++ ++/* Loop-free fast-path for frequently used 16-byte size */ ++static inline unsigned long __crypto_memneq_16(const void *a, const void *b) ++{ ++ unsigned long neq = 0; ++ ++#ifdef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS ++ if (sizeof(unsigned long) == 8) { ++ neq |= *(unsigned long *)(a) ^ *(unsigned long *)(b); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned long *)(a+8) ^ *(unsigned long *)(b+8); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ } else if (sizeof(unsigned int) == 4) { ++ neq |= *(unsigned int *)(a) ^ *(unsigned int *)(b); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned int *)(a+4) ^ *(unsigned int *)(b+4); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned int *)(a+8) ^ *(unsigned int *)(b+8); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned int *)(a+12) ^ *(unsigned int *)(b+12); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ } else ++#endif /* CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS */ ++ { ++ neq |= *(unsigned char *)(a) ^ *(unsigned char *)(b); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+1) ^ *(unsigned char *)(b+1); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+2) ^ *(unsigned char *)(b+2); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+3) ^ *(unsigned char *)(b+3); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+4) ^ *(unsigned char *)(b+4); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+5) ^ *(unsigned char *)(b+5); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+6) ^ *(unsigned char *)(b+6); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+7) ^ *(unsigned char *)(b+7); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+8) ^ *(unsigned char *)(b+8); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+9) ^ *(unsigned char *)(b+9); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+10) ^ *(unsigned char *)(b+10); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+11) ^ *(unsigned char *)(b+11); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+12) ^ *(unsigned char *)(b+12); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+13) ^ *(unsigned char *)(b+13); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+14) ^ *(unsigned char *)(b+14); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ neq |= *(unsigned char *)(a+15) ^ *(unsigned char *)(b+15); ++ COMPILER_OPTIMIZER_HIDE_VAR(neq); ++ } ++ ++ return neq; ++} ++ ++/* Compare two areas of memory without leaking timing information, ++ * and with special optimizations for common sizes. Users should ++ * not call this function directly, but should instead use ++ * crypto_memneq defined in crypto/algapi.h. ++ */ ++noinline unsigned long __crypto_memneq(const void *a, const void *b, ++ size_t size) ++{ ++ switch (size) { ++ case 16: ++ return __crypto_memneq_16(a, b); ++ default: ++ return __crypto_memneq_generic(a, b, size); ++ } ++} ++ ++#endif /* __HAVE_ARCH_CRYPTO_MEMNEQ */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/dst_cache/dst_cache.c 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,175 @@ ++/* ++ * net/core/dst_cache.c - dst entry cache ++ * ++ * Copyright (c) 2016 Paolo Abeni ++ * ++ * This program is free software; you can redistribute it and/or modify ++ * it under the terms of the GNU General Public License as published by ++ * the Free Software Foundation; either version 2 of the License, or ++ * (at your option) any later version. ++ */ ++ ++#include ++#include ++#include ++#include ++#if IS_ENABLED(CONFIG_IPV6) ++#include ++#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 2, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0)) || LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 50) ++static inline u32 rt6_get_cookie(const struct rt6_info *rt) ++{ ++ if ((unlikely(rt->dst.flags & DST_NOCACHE) && rt->dst.from)) ++ rt = (struct rt6_info *)(rt->dst.from); ++ ++ return rt->rt6i_node ? rt->rt6i_node->fn_sernum : 0; ++} ++#endif ++#endif ++#include ++ ++struct dst_cache_pcpu { ++ unsigned long refresh_ts; ++ struct dst_entry *dst; ++ u32 cookie; ++ union { ++ struct in_addr in_saddr; ++ struct in6_addr in6_saddr; ++ }; ++}; ++ ++static void dst_cache_per_cpu_dst_set(struct dst_cache_pcpu *dst_cache, ++ struct dst_entry *dst, u32 cookie) ++{ ++ dst_release(dst_cache->dst); ++ if (dst) ++ dst_hold(dst); ++ ++ dst_cache->cookie = cookie; ++ dst_cache->dst = dst; ++} ++ ++static struct dst_entry *dst_cache_per_cpu_get(struct dst_cache *dst_cache, ++ struct dst_cache_pcpu *idst) ++{ ++ struct dst_entry *dst; ++ ++ dst = idst->dst; ++ if (!dst) ++ goto fail; ++ ++ /* the cache already hold a dst reference; it can't go away */ ++ dst_hold(dst); ++ ++ if (unlikely(!time_after(idst->refresh_ts, dst_cache->reset_ts) || ++ (dst->obsolete && !dst->ops->check(dst, idst->cookie)))) { ++ dst_cache_per_cpu_dst_set(idst, NULL, 0); ++ dst_release(dst); ++ goto fail; ++ } ++ return dst; ++ ++fail: ++ idst->refresh_ts = jiffies; ++ return NULL; ++} ++ ++struct dst_entry *dst_cache_get(struct dst_cache *dst_cache) ++{ ++ if (!dst_cache->cache) ++ return NULL; ++ ++ return dst_cache_per_cpu_get(dst_cache, this_cpu_ptr(dst_cache->cache)); ++} ++ ++struct rtable *dst_cache_get_ip4(struct dst_cache *dst_cache, __be32 *saddr) ++{ ++ struct dst_cache_pcpu *idst; ++ struct dst_entry *dst; ++ ++ if (!dst_cache->cache) ++ return NULL; ++ ++ idst = this_cpu_ptr(dst_cache->cache); ++ dst = dst_cache_per_cpu_get(dst_cache, idst); ++ if (!dst) ++ return NULL; ++ ++ *saddr = idst->in_saddr.s_addr; ++ return container_of(dst, struct rtable, dst); ++} ++ ++void dst_cache_set_ip4(struct dst_cache *dst_cache, struct dst_entry *dst, ++ __be32 saddr) ++{ ++ struct dst_cache_pcpu *idst; ++ ++ if (!dst_cache->cache) ++ return; ++ ++ idst = this_cpu_ptr(dst_cache->cache); ++ dst_cache_per_cpu_dst_set(idst, dst, 0); ++ idst->in_saddr.s_addr = saddr; ++} ++ ++#if IS_ENABLED(CONFIG_IPV6) ++void dst_cache_set_ip6(struct dst_cache *dst_cache, struct dst_entry *dst, ++ const struct in6_addr *addr) ++{ ++ struct dst_cache_pcpu *idst; ++ ++ if (!dst_cache->cache) ++ return; ++ ++ idst = this_cpu_ptr(dst_cache->cache); ++ dst_cache_per_cpu_dst_set(this_cpu_ptr(dst_cache->cache), dst, ++ rt6_get_cookie((struct rt6_info *)dst)); ++ idst->in6_saddr = *addr; ++} ++ ++struct dst_entry *dst_cache_get_ip6(struct dst_cache *dst_cache, ++ struct in6_addr *saddr) ++{ ++ struct dst_cache_pcpu *idst; ++ struct dst_entry *dst; ++ ++ if (!dst_cache->cache) ++ return NULL; ++ ++ idst = this_cpu_ptr(dst_cache->cache); ++ dst = dst_cache_per_cpu_get(dst_cache, idst); ++ if (!dst) ++ return NULL; ++ ++ *saddr = idst->in6_saddr; ++ return dst; ++} ++#endif ++ ++int dst_cache_init(struct dst_cache *dst_cache, gfp_t gfp) ++{ ++#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 0) ++ BUG_ON(gfp & GFP_ATOMIC); ++ dst_cache->cache = alloc_percpu(struct dst_cache_pcpu); ++#else ++ dst_cache->cache = alloc_percpu_gfp(struct dst_cache_pcpu, ++ gfp | __GFP_ZERO); ++#endif ++ if (!dst_cache->cache) ++ return -ENOMEM; ++ ++ dst_cache_reset(dst_cache); ++ return 0; ++} ++ ++void dst_cache_destroy(struct dst_cache *dst_cache) ++{ ++ int i; ++ ++ if (!dst_cache->cache) ++ return; ++ ++ for_each_possible_cpu(i) ++ dst_release(per_cpu_ptr(dst_cache->cache, i)->dst); ++ ++ free_percpu(dst_cache->cache); ++} +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/dst_cache/include/net/dst_cache.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,97 @@ ++#ifndef _WG_NET_DST_CACHE_H ++#define _WG_NET_DST_CACHE_H ++ ++#include ++#include ++#if IS_ENABLED(CONFIG_IPV6) ++#include ++#endif ++ ++struct dst_cache { ++ struct dst_cache_pcpu __percpu *cache; ++ unsigned long reset_ts; ++}; ++ ++/** ++ * dst_cache_get - perform cache lookup ++ * @dst_cache: the cache ++ * ++ * The caller should use dst_cache_get_ip4() if it need to retrieve the ++ * source address to be used when xmitting to the cached dst. ++ * local BH must be disabled. ++ */ ++struct dst_entry *dst_cache_get(struct dst_cache *dst_cache); ++ ++/** ++ * dst_cache_get_ip4 - perform cache lookup and fetch ipv4 source address ++ * @dst_cache: the cache ++ * @saddr: return value for the retrieved source address ++ * ++ * local BH must be disabled. ++ */ ++struct rtable *dst_cache_get_ip4(struct dst_cache *dst_cache, __be32 *saddr); ++ ++/** ++ * dst_cache_set_ip4 - store the ipv4 dst into the cache ++ * @dst_cache: the cache ++ * @dst: the entry to be cached ++ * @saddr: the source address to be stored inside the cache ++ * ++ * local BH must be disabled. ++ */ ++void dst_cache_set_ip4(struct dst_cache *dst_cache, struct dst_entry *dst, ++ __be32 saddr); ++ ++#if IS_ENABLED(CONFIG_IPV6) ++ ++/** ++ * dst_cache_set_ip6 - store the ipv6 dst into the cache ++ * @dst_cache: the cache ++ * @dst: the entry to be cached ++ * @saddr: the source address to be stored inside the cache ++ * ++ * local BH must be disabled. ++ */ ++void dst_cache_set_ip6(struct dst_cache *dst_cache, struct dst_entry *dst, ++ const struct in6_addr *addr); ++ ++/** ++ * dst_cache_get_ip6 - perform cache lookup and fetch ipv6 source address ++ * @dst_cache: the cache ++ * @saddr: return value for the retrieved source address ++ * ++ * local BH must be disabled. ++ */ ++struct dst_entry *dst_cache_get_ip6(struct dst_cache *dst_cache, ++ struct in6_addr *saddr); ++#endif ++ ++/** ++ * dst_cache_reset - invalidate the cache contents ++ * @dst_cache: the cache ++ * ++ * This do not free the cached dst to avoid races and contentions. ++ * the dst will be freed on later cache lookup. ++ */ ++static inline void dst_cache_reset(struct dst_cache *dst_cache) ++{ ++ dst_cache->reset_ts = jiffies; ++} ++ ++/** ++ * dst_cache_init - initialize the cache, allocating the required storage ++ * @dst_cache: the cache ++ * @gfp: allocation flags ++ */ ++int dst_cache_init(struct dst_cache *dst_cache, gfp_t gfp); ++ ++/** ++ * dst_cache_destroy - empty the cache and free the allocated storage ++ * @dst_cache: the cache ++ * ++ * No synchronization is enforced: it must be called only when the cache ++ * is unsed. ++ */ ++void dst_cache_destroy(struct dst_cache *dst_cache); ++ ++#endif /* _WG_NET_DST_CACHE_H */ +--- /dev/null 2018-02-18 13:06:28.903837808 +0200 ++++ b/net/wireguard/compat/compat-asm.h 2018-02-18 22:22:31.000000000 +0200 +@@ -0,0 +1,18 @@ ++/* SPDX-License-Identifier: GPL-2.0 ++ * ++ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. ++ */ ++ ++#ifndef _WG_COMPATASM_H ++#define _WG_COMPATASM_H ++ ++#include ++#include ++ ++/* PaX compatibility */ ++#if defined(RAP_PLUGIN) ++#undef ENTRY ++#define ENTRY RAP_ENTRY ++#endif ++ ++#endif /* _WG_COMPATASM_H */ +--- a/net/Kconfig ++++ b/net/Kconfig +@@ -85,2 +85,3 @@ config INET + if INET ++source "net/wireguard/Kconfig" + source "net/ipv4/Kconfig" +--- a/net/Makefile ++++ b/net/Makefile +@@ -16,2 +16,3 @@ + obj-$(CONFIG_NETFILTER) += netfilter/ ++obj-$(CONFIG_WIREGUARD) += wireguard/ + obj-$(CONFIG_INET) += ipv4/ diff --git a/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-IFWLOG-mdv.patch b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-IFWLOG-mdv.patch index 5ecc0151..b56387f7 100644 --- a/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-IFWLOG-mdv.patch +++ b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-IFWLOG-mdv.patch @@ -8,16 +8,16 @@ and Luiz Fernando N. Capitulino. Signed-off-by: Luiz Fernando N. Capitulino Signed-off-by: Herton Ronaldo Krzesinski - +[moved header to uapi for kernel-4.12.4 / tmb] +Signed-off-by Thomas Backlund --- - include/linux/netfilter_ipv4/Kbuild | 1 include/linux/netfilter_ipv4/ipt_IFWLOG.h | 23 +++++- net/ipv4/netfilter/ipt_IFWLOG.c | 108 +++++++++++++++--------------- - 3 files changed, 77 insertions(+), 55 deletions(-) + 2 files changed, 77 insertions(+), 55 deletions(-) -diff -p -up linux-2.6.28/include/linux/netfilter_ipv4/ipt_IFWLOG.h.orig linux-2.6.28/include/linux/netfilter_ipv4/ipt_IFWLOG.h ---- linux-2.6.28/include/linux/netfilter_ipv4/ipt_IFWLOG.h.orig 2008-12-12 10:55:07.000000000 -0500 -+++ linux-2.6.28/include/linux/netfilter_ipv4/ipt_IFWLOG.h 2008-12-12 10:56:30.000000000 -0500 +diff -p -up linux/include/uapi/linux/netfilter_ipv4/ipt_IFWLOG.h.orig linux/include/uapi/linux/netfilter_ipv4/ipt_IFWLOG.h +--- linux-2.6.28/include/uapi/linux/netfilter_ipv4/ipt_IFWLOG.h.orig ++++ linux-2.6.28/include/uapi/linux/netfilter_ipv4/ipt_IFWLOG.h @@ -1,10 +1,25 @@ -#ifndef _IPT_IFWLOG_H -#define _IPT_IFWLOG_H @@ -252,13 +252,3 @@ diff -p -up linux-2.6.28/net/ipv4/netfilter/ipt_IFWLOG.c.orig linux-2.6.28/net/i +MODULE_AUTHOR("Luiz Capitulino "); +MODULE_DESCRIPTION("Interactive firewall logging and module"); +MODULE_VERSION("v1.1"); ---- linux/include/uapi/linux/netfilter_ipv4/Kbuild.net-netfilter-IFWLOG-mdv.orig -+++ linux/include/uapi/linux/netfilter_ipv4/Kbuild -@@ -2,6 +2,7 @@ header-y += ip_queue.h - header-y += ip_tables.h - header-y += ipt_CLUSTERIP.h - header-y += ipt_ECN.h -+header-y += ipt_IFWLOG.h - header-y += ipt_LOG.h - header-y += ipt_REJECT.h - header-y += ipt_TTL.h diff --git a/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-IFWLOG.patch b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-IFWLOG.patch index c8654422..0ab4f6ff 100644 --- a/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-IFWLOG.patch +++ b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-IFWLOG.patch @@ -1,5 +1,9 @@ + +[moved header to uapi for kernel-4.12.4 / tmb] +Signed-off-by Thomas Backlund + --- - include/linux/netfilter_ipv4/ipt_IFWLOG.h | 26 +++ + include/uapi/linux/netfilter_ipv4/ipt_IFWLOG.h | 26 +++ net/ipv4/netfilter/Kconfig | 11 + net/ipv4/netfilter/Makefile | 1 net/ipv4/netfilter/ipt_IFWLOG.c | 200 ++++++++++++++++++++++++++++++ @@ -229,7 +233,7 @@ config IP_NF_RAW tristate 'raw table support (required for NOTRACK/TRACE)' --- /dev/null -+++ b/include/linux/netfilter_ipv4/ipt_IFWLOG.h ++++ b/include/uapi/linux/netfilter_ipv4/ipt_IFWLOG.h @@ -0,0 +1,26 @@ +#ifndef _IPT_IFWLOG_H +#define _IPT_IFWLOG_H diff --git a/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-ipt_IFWLOG-4.12-buildfix.patch b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-ipt_IFWLOG-4.12-buildfix.patch new file mode 100644 index 00000000..451f7a1d --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-ipt_IFWLOG-4.12-buildfix.patch @@ -0,0 +1,16 @@ + +Adjust for kernel changes. + +Signed-off-by: Thomas Backlund + +--- linux/net/ipv4/netfilter/ipt_IFWLOG.c.orig ++++ linux/net/ipv4/netfilter/ipt_IFWLOG.c +@@ -138,7 +138,7 @@ static unsigned int ipt_IFWLOG_target(st + { + const struct ipt_IFWLOG_info *info = target_param->targinfo; + +- ipt_IFWLOG_packet(skb, target_param->in, target_param->out, info); ++ ipt_IFWLOG_packet(skb, xt_in(target_param), xt_out(target_param), info); + + return XT_CONTINUE; + } diff --git a/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-psd-fix-redefines.patch b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-psd-fix-redefines.patch index ddee206e..d71ffaa4 100644 --- a/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-psd-fix-redefines.patch +++ b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-psd-fix-redefines.patch @@ -2,16 +2,17 @@ Make defines psd specific so they dont redefine in-kernel defines like HASH_SIZE. -Signed-off-by: Thomas Backlund +[moved header to uapi for kernel-4.12.4 / tmb] +Signed-off-by Thomas Backlund - - include/linux/netfilter_ipv4/ipt_psd.h | 14 +++++++------- +--- + include/uapi/linux/netfilter_ipv4/ipt_psd.h | 14 +++++++------- net/ipv4/netfilter/ipt_psd.c | 14 +++++++------- 2 files changed, 14 insertions(+), 14 deletions(-) -diff -Nurp linux-4.9.5-psd/include/linux/netfilter_ipv4/ipt_psd.h linux-4.9.5-psd-fix/include/linux/netfilter_ipv4/ipt_psd.h ---- linux-4.9.5-psd/include/linux/netfilter_ipv4/ipt_psd.h 2017-01-20 21:47:19.788931403 +0200 -+++ linux-4.9.5-psd-fix/include/linux/netfilter_ipv4/ipt_psd.h 2017-01-20 21:58:09.995871253 +0200 +diff -Nurp linux-psd/include/uapi/linux/netfilter_ipv4/ipt_psd.h linux-psd-fix/include/uapi/linux/netfilter_ipv4/ipt_psd.h +--- linux-psd/include/uapi/linux/netfilter_ipv4/ipt_psd.h ++++ linux-psd-fix/include/uapi/linux/netfilter_ipv4/ipt_psd.h @@ -21,14 +21,14 @@ #define SCAN_DELAY_THRESHOLD (300) /* old usage of HZ here was erroneously and broke under uml */ diff --git a/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-psd-mdv.patch b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-psd-mdv.patch index 6bcf06dd..0bbd42e6 100644 --- a/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-psd-mdv.patch +++ b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-psd-mdv.patch @@ -13,10 +13,9 @@ Signed-off-by: Luiz Fernando N. Capitulino Signed-off-by: Herton Ronaldo Krzesinski --- - include/linux/netfilter_ipv4/Kbuild | 1 net/ipv4/netfilter/Kconfig | 8 ++ net/ipv4/netfilter/ipt_psd.c | 113 ++++++++++++++---------------------- - 3 files changed, 55 insertions(+), 67 deletions(-) + 2 files changed, 55 insertions(+), 67 deletions(-) diff -p -up linux-2.6.28/net/ipv4/netfilter/ipt_psd.c.orig linux-2.6.28/net/ipv4/netfilter/ipt_psd.c --- linux-2.6.28/net/ipv4/netfilter/ipt_psd.c.orig 2008-12-12 11:03:05.000000000 -0500 @@ -223,11 +222,3 @@ diff -p -up linux-2.6.28/net/ipv4/netfilter/ipt_psd.c.orig linux-2.6.28/net/ipv4 config IP_NF_MATCH_RPFILTER tristate '"rpfilter" reverse path filter match support' depends on NETFILTER_ADVANCED ---- linux/include/uapi/linux/netfilter_ipv4/Kbuild.orig -+++ linux/include/uapi/linux/netfilter_ipv4/Kbuild -@@ -8,4 +8,5 @@ header-y += ipt_REJECT.h - header-y += ipt_TTL.h - header-y += ipt_ah.h - header-y += ipt_ecn.h -+header-y += ipt_psd.h - header-y += ipt_ttl.h diff --git a/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-psd.patch b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-psd.patch index 8ec326ff..188c5250 100644 --- a/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-psd.patch +++ b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-psd.patch @@ -1,5 +1,9 @@ + +[moved header to uapi for kernel-4.12.4 / tmb] +Signed-off-by Thomas Backlund + --- - include/linux/netfilter_ipv4/ipt_psd.h | 40 +++ + include/uapi/linux/netfilter_ipv4/ipt_psd.h | 40 +++ net/ipv4/netfilter/Makefile | 1 net/ipv4/netfilter/ipt_psd.c | 358 +++++++++++++++++++++++++++++++++ 3 files changed, 399 insertions(+) @@ -366,7 +370,7 @@ +module_init(init); +module_exit(fini); --- /dev/null -+++ b/include/linux/netfilter_ipv4/ipt_psd.h ++++ b/include/uapi/linux/netfilter_ipv4/ipt_psd.h @@ -0,0 +1,40 @@ +#ifndef _IPT_PSD_H +#define _IPT_PSD_H diff --git a/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-xt_addrtype-silence-BROADCAST-message.patch b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-xt_addrtype-silence-BROADCAST-message.patch new file mode 100644 index 00000000..15312e3e --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/net-netfilter-xt_addrtype-silence-BROADCAST-message.patch @@ -0,0 +1,16 @@ + +This message causes numerous useless "bug reports", so silence it by default. + +Signed-off-by: Thomas Backlund + +--- linux/net/netfilter/xt_addrtype.c.orig 2017-11-12 20:46:13.000000000 +0200 ++++ linux/net/netfilter/xt_addrtype.c 2018-02-06 20:26:49.854596642 +0200 +@@ -203,7 +203,7 @@ static int addrtype_mt_checkentry_v1(con + return -EINVAL; + } + if ((info->source | info->dest) & XT_ADDRTYPE_BROADCAST) { +- pr_err("ipv6 does not support BROADCAST matching\n"); ++ /* pr_err("ipv6 does not support BROADCAST matching\n"); */ + return -EINVAL; + } + } diff --git a/kernel/tools/cpupowertools/files/patches/mageia/net-tls-Correct-length-of-scatterlist-in-tls_sw_sendpage.patch b/kernel/tools/cpupowertools/files/patches/mageia/net-tls-Correct-length-of-scatterlist-in-tls_sw_sendpage.patch new file mode 100644 index 00000000..ea0f89ec --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/net-tls-Correct-length-of-scatterlist-in-tls_sw_sendpage.patch @@ -0,0 +1,37 @@ +From 7a8c4dd9be91a7e8f8f0e0419a560663adc694a3 Mon Sep 17 00:00:00 2001 +From: Dave Watson +Date: Fri, 19 Jan 2018 12:30:13 -0800 +Subject: [PATCH] tls: Correct length of scatterlist in tls_sw_sendpage + +The scatterlist is reused by both sendmsg and sendfile. +If a sendmsg of smaller number of pages is followed by a sendfile +of larger number of pages, the scatterlist may be too short, resulting +in a crash in gcm_encrypt. + +Add sg_unmark_end to make the list the correct length. + +tls_sw_sendmsg already calls sg_unmark_end correctly when it allocates +memory in alloc_sg, or in zerocopy_from_iter. + +Signed-off-by: Dave Watson +Signed-off-by: David S. Miller +--- + net/tls/tls_sw.c | 2 ++ + 1 file changed, 2 insertions(+) + +diff --git a/net/tls/tls_sw.c b/net/tls/tls_sw.c +index 61f394d369bf..0a9b72fbd761 100644 +--- a/net/tls/tls_sw.c ++++ b/net/tls/tls_sw.c +@@ -577,6 +577,8 @@ int tls_sw_sendpage(struct sock *sk, struct page *page, + get_page(page); + sg = ctx->sg_plaintext_data + ctx->sg_plaintext_num_elem; + sg_set_page(sg, page, copy, offset); ++ sg_unmark_end(sg); ++ + ctx->sg_plaintext_num_elem++; + + sk_mem_charge(sk, copy); +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/net-wireless-rtlwifi-Fix-kernel-oops-introduced-with-commit-e4965.patch b/kernel/tools/cpupowertools/files/patches/mageia/net-wireless-rtlwifi-Fix-kernel-oops-introduced-with-commit-e4965.patch deleted file mode 100644 index ab148933..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/net-wireless-rtlwifi-Fix-kernel-oops-introduced-with-commit-e4965.patch +++ /dev/null @@ -1,37 +0,0 @@ -From 22b68b93ae2506bd56ee3bf232a51bc8ab955b56 Mon Sep 17 00:00:00 2001 -From: Larry Finger -Date: Mon, 19 Dec 2016 20:38:12 -0600 -Subject: [PATCH] rtlwifi: Fix kernel oops introduced with commit e49656147359 - -With commit e49656147359 {"rtlwifi: Use dev_kfree_skb_irq instead of -kfree_skb"), the method used to free an skb was changed because the -kfree_skb() was inside a spinlock. What was forgotten is that kfree_skb() -guards against a NULL value for the argument. Routine dev_kfree_skb_irq() -does not, and a test is needed to prevent kernel panics. - -Fixes: e49656147359 ("rtlwifi: Use dev_kfree_skb_irq instead of kfree_skb") -Signed-off-by: Larry Finger -Cc: Stable # 4.9+ -Cc: Wei Yongjun -Signed-off-by: Kalle Valo ---- - drivers/net/wireless/realtek/rtlwifi/core.c | 3 ++- - 1 file changed, 2 insertions(+), 1 deletion(-) - -diff --git a/drivers/net/wireless/realtek/rtlwifi/core.c b/drivers/net/wireless/realtek/rtlwifi/core.c -index 2caa4ad..ded1493 100644 ---- a/drivers/net/wireless/realtek/rtlwifi/core.c -+++ b/drivers/net/wireless/realtek/rtlwifi/core.c -@@ -1829,7 +1829,8 @@ bool rtl_cmd_send_packet(struct ieee80211_hw *hw, struct sk_buff *skb) - - spin_lock_irqsave(&rtlpriv->locks.irq_th_lock, flags); - pskb = __skb_dequeue(&ring->queue); -- dev_kfree_skb_irq(pskb); -+ if (pskb) -+ dev_kfree_skb_irq(pskb); - - /*this is wrong, fill_tx_cmddesc needs update*/ - pdesc = &ring->desc[0]; --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/net-wireless-rtlwifi-Use-dev_kfree_skb_irq-instead-of-kfree_skb.patch b/kernel/tools/cpupowertools/files/patches/mageia/net-wireless-rtlwifi-Use-dev_kfree_skb_irq-instead-of-kfree_skb.patch deleted file mode 100644 index 50aa874d..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/net-wireless-rtlwifi-Use-dev_kfree_skb_irq-instead-of-kfree_skb.patch +++ /dev/null @@ -1,34 +0,0 @@ -From e49656147359411fb7529a211e852e587e5970dd Mon Sep 17 00:00:00 2001 -From: Wei Yongjun -Date: Tue, 1 Nov 2016 14:48:40 +0000 -Subject: [PATCH] rtlwifi: Use dev_kfree_skb_irq instead of kfree_skb - -It is not allowed to call kfree_skb() from hardware interrupt -context or with interrupts being disabled, spin_lock_irqsave() -make sure always in irq disable context. So the kfree_skb() -should be replaced with dev_kfree_skb_irq(). - -This is detected by Coccinelle semantic patch. - -Signed-off-by: Wei Yongjun -Signed-off-by: Kalle Valo ---- - drivers/net/wireless/realtek/rtlwifi/core.c | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - -diff --git a/drivers/net/wireless/realtek/rtlwifi/core.c b/drivers/net/wireless/realtek/rtlwifi/core.c -index f95760c..a11e8f5 100644 ---- a/drivers/net/wireless/realtek/rtlwifi/core.c -+++ b/drivers/net/wireless/realtek/rtlwifi/core.c -@@ -1832,7 +1832,7 @@ bool rtl_cmd_send_packet(struct ieee80211_hw *hw, struct sk_buff *skb) - - spin_lock_irqsave(&rtlpriv->locks.irq_th_lock, flags); - pskb = __skb_dequeue(&ring->queue); -- kfree_skb(pskb); -+ dev_kfree_skb_irq(pskb); - - /*this is wrong, fill_tx_cmddesc needs update*/ - pdesc = &ring->desc[0]; --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pci-Blacklist-AMD-Stoney-GPU-devices-for-ATS.patch b/kernel/tools/cpupowertools/files/patches/mageia/pci-Blacklist-AMD-Stoney-GPU-devices-for-ATS.patch deleted file mode 100644 index 0383b3ba..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/pci-Blacklist-AMD-Stoney-GPU-devices-for-ATS.patch +++ /dev/null @@ -1,43 +0,0 @@ -From: Joerg Roedel - -ATS is broken on these devices. Under invalidation load, the -GPU does not reply to invalidations anymore, causing -Completion-wait loop timeouts on the AMD IOMMU driver side. -Fix it by not enabling ATS on these devices. - -Note that below mentioned commit is not broken, it just -triggers the issue because it might cause invalidation -storms on devices. - -Fixes: b1516a14657a ('iommu/amd: Implement flush queue') -Reported-by: Daniel Drake -Cc: Daniel Drake -Cc: Alexander Deucher -Signed-off-by: Joerg Roedel ---- - drivers/pci/ats.c | 8 ++++++++ - 1 file changed, 8 insertions(+) - -diff --git a/drivers/pci/ats.c b/drivers/pci/ats.c -index eeb9fb2..711bdb2 100644 ---- a/drivers/pci/ats.c -+++ b/drivers/pci/ats.c -@@ -17,10 +17,18 @@ - - #include "pci.h" - -+static const struct pci_device_id broken_ats_tbl[] = { -+ { PCI_DEVICE(PCI_VENDOR_ID_AMD, 0x98e4) }, /* AMD Stoney GPU part */ -+ { 0 } -+}; -+ - void pci_ats_init(struct pci_dev *dev) - { - int pos; - -+ if (pci_match_id(broken_ats_tbl, dev)) -+ return; -+ - pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ATS); - if (!pos) - return; diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pinctrl_amd-Use-regular-interrupt-instead-of-chained.patch b/kernel/tools/cpupowertools/files/patches/mageia/pinctrl_amd-Use-regular-interrupt-instead-of-chained.patch deleted file mode 100644 index 36d963a6..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/pinctrl_amd-Use-regular-interrupt-instead-of-chained.patch +++ /dev/null @@ -1,179 +0,0 @@ -From ba714a9c1dea85e0bf2899d02dfeb9c70040427c Mon Sep 17 00:00:00 2001 -From: Thomas Gleixner -Date: Tue, 23 May 2017 23:23:32 +0200 -Subject: [PATCH] pinctrl/amd: Use regular interrupt instead of chained - -The AMD pinctrl driver uses a chained interrupt to demultiplex the GPIO -interrupts. Kevin Vandeventer reported, that his new AMD Ryzen locks up -hard on boot when the AMD pinctrl driver is initialized. The reason is an -interrupt storm. It's not clear whether that's caused by hardware or -firmware or both. - -Using chained interrupts on X86 is a dangerous endavour. If a system is -misconfigured or the hardware buggy there is no safety net to catch an -interrupt storm. - -Convert the driver to use a regular interrupt for the demultiplex -handler. This allows the interrupt storm detector to catch the malfunction -and lets the system boot up. - -This should be backported to stable because it's likely that more users run -into this problem as the AMD Ryzen machines are spreading. - -Reported-by: Kevin Vandeventer -Link: https://bugzilla.suse.com/show_bug.cgi?id=1034261 -Signed-off-by: Thomas Gleixner -Signed-off-by: Linus Walleij -Backported to 4.9 by: Borislav Petkov - ---- - drivers/pinctrl/pinctrl-amd.c | 91 +++++++++++++++++++------------------------ - 1 file changed, 41 insertions(+), 50 deletions(-) - - -Date: Thu, 22 Jun 2017 11:16:31 +0200 -From: -To: Thomas Backlund -Cc: stable , Thomas Gleixner , - Linus Walleij , - "Shah, Nehal-bakulchandra" , - "Xue, Ken" , - "S-k, Shyam-sundar" , - Sherry Hurwitz -Subject: Re: ba714a9c1dea ("pinctrl/amd: Use regular interrupt instead of chained") - -On Thu, Jun 22, 2017 at 12:03:50PM +0300, Thomas Backlund wrote: -> If it's intended for 4.9 -longterm, a proper backport is needed. - -Something like this, I guess. But I need to find a box to test it. - -Regards/Gruss, - Boris. - -diff --git a/drivers/pinctrl/pinctrl-amd.c b/drivers/pinctrl/pinctrl-amd.c -index c9a146948192..531e2224f38f 100644 ---- a/drivers/pinctrl/pinctrl-amd.c -+++ b/drivers/pinctrl/pinctrl-amd.c -@@ -476,64 +476,54 @@ static struct irq_chip amd_gpio_irqchip = { - .irq_set_type = amd_gpio_irq_set_type, - }; - --static void amd_gpio_irq_handler(struct irq_desc *desc) -+#define PIN_IRQ_PENDING (BIT(INTERRUPT_STS_OFF) | BIT(WAKE_STS_OFF)) -+ -+static irqreturn_t amd_gpio_irq_handler(int irq, void *dev_id) - { -- u32 i; -- u32 off; -- u32 reg; -- u32 pin_reg; -- u64 reg64; -- int handled = 0; -- unsigned int irq; -+ struct amd_gpio *gpio_dev = dev_id; -+ struct gpio_chip *gc = &gpio_dev->gc; -+ irqreturn_t ret = IRQ_NONE; -+ unsigned int i, irqnr; - unsigned long flags; -- struct irq_chip *chip = irq_desc_get_chip(desc); -- struct gpio_chip *gc = irq_desc_get_handler_data(desc); -- struct amd_gpio *gpio_dev = gpiochip_get_data(gc); -+ u32 *regs, regval; -+ u64 status, mask; - -- chained_irq_enter(chip, desc); -- /*enable GPIO interrupt again*/ -+ /* Read the wake status */ - spin_lock_irqsave(&gpio_dev->lock, flags); -- reg = readl(gpio_dev->base + WAKE_INT_STATUS_REG1); -- reg64 = reg; -- reg64 = reg64 << 32; -- -- reg = readl(gpio_dev->base + WAKE_INT_STATUS_REG0); -- reg64 |= reg; -+ status = readl(gpio_dev->base + WAKE_INT_STATUS_REG1); -+ status <<= 32; -+ status |= readl(gpio_dev->base + WAKE_INT_STATUS_REG0); - spin_unlock_irqrestore(&gpio_dev->lock, flags); - -- /* -- * first 46 bits indicates interrupt status. -- * one bit represents four interrupt sources. -- */ -- for (off = 0; off < 46 ; off++) { -- if (reg64 & BIT(off)) { -- for (i = 0; i < 4; i++) { -- pin_reg = readl(gpio_dev->base + -- (off * 4 + i) * 4); -- if ((pin_reg & BIT(INTERRUPT_STS_OFF)) || -- (pin_reg & BIT(WAKE_STS_OFF))) { -- irq = irq_find_mapping(gc->irqdomain, -- off * 4 + i); -- generic_handle_irq(irq); -- writel(pin_reg, -- gpio_dev->base -- + (off * 4 + i) * 4); -- handled++; -- } -- } -+ /* Bit 0-45 contain the relevant status bits */ -+ status &= (1ULL << 46) - 1; -+ regs = gpio_dev->base; -+ for (mask = 1, irqnr = 0; status; mask <<= 1, regs += 4, irqnr += 4) { -+ if (!(status & mask)) -+ continue; -+ status &= ~mask; -+ -+ /* Each status bit covers four pins */ -+ for (i = 0; i < 4; i++) { -+ regval = readl(regs + i); -+ if (!(regval & PIN_IRQ_PENDING)) -+ continue; -+ irq = irq_find_mapping(gc->irqdomain, irqnr + i); -+ generic_handle_irq(irq); -+ /* Clear interrupt */ -+ writel(regval, regs + i); -+ ret = IRQ_HANDLED; - } - } - -- if (handled == 0) -- handle_bad_irq(desc); -- -+ /* Signal EOI to the GPIO unit */ - spin_lock_irqsave(&gpio_dev->lock, flags); -- reg = readl(gpio_dev->base + WAKE_INT_MASTER_REG); -- reg |= EOI_MASK; -- writel(reg, gpio_dev->base + WAKE_INT_MASTER_REG); -+ regval = readl(gpio_dev->base + WAKE_INT_MASTER_REG); -+ regval |= EOI_MASK; -+ writel(regval, gpio_dev->base + WAKE_INT_MASTER_REG); - spin_unlock_irqrestore(&gpio_dev->lock, flags); - -- chained_irq_exit(chip, desc); -+ return ret; - } - - static int amd_get_groups_count(struct pinctrl_dev *pctldev) -@@ -801,10 +791,11 @@ static int amd_gpio_probe(struct platform_device *pdev) - goto out2; - } - -- gpiochip_set_chained_irqchip(&gpio_dev->gc, -- &amd_gpio_irqchip, -- irq_base, -- amd_gpio_irq_handler); -+ ret = devm_request_irq(&pdev->dev, irq_base, amd_gpio_irq_handler, 0, -+ KBUILD_MODNAME, gpio_dev); -+ if (ret) -+ goto out2; -+ - - platform_set_drvdata(pdev, gpio_dev); - - --- -Regards/Gruss, - Boris. - -Good mailing practices for 400: avoid top-posting and trim the reply. diff --git a/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-add-shuttle-wmi-driver.patch b/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-add-shuttle-wmi-driver.patch index 02f89791..15510c45 100644 --- a/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-add-shuttle-wmi-driver.patch +++ b/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-add-shuttle-wmi-driver.patch @@ -1419,12 +1419,12 @@ diff -Nurp linux-3.14.2/drivers/platform/x86/shuttle-wmi.c linux-3.14.2-shuttle/ + +module_init(shuttle_wmi_init); +module_exit(shuttle_wmi_exit); -diff -Nurp linux-4.6/MAINTAINERS linux-4.6-shuttle/MAINTAINERS ---- linux-4.6/MAINTAINERS -+++ linux-4.6-shuttle/MAINTAINERS -@@ -10130,6 +10130,12 @@ S: Orphan - F: drivers/media/platform/sh_vou.c - F: include/media/drv-intf/sh_vou.h +diff -Nurp linux-4.13/MAINTAINERS linux-4.13-shuttle/MAINTAINERS +--- linux-4.13/MAINTAINERS ++++ linux-4.13-shuttle/MAINTAINERS +@@ -11861,6 +11861,12 @@ + F: drivers/tty/serial/ioc?_serial.c + F: include/linux/ioc?.h +SHUTTLE WMI EXTRAS DRIVER +M: Herton Ronaldo Krzesinski @@ -1432,6 +1432,6 @@ diff -Nurp linux-4.6/MAINTAINERS linux-4.6-shuttle/MAINTAINERS +S: Maintained +F: drivers/platform/x86/shuttle-wmi.c + - SIMPLE FIRMWARE INTERFACE (SFI) - M: Len Brown - L: sfi-devel@simplefirmware.org + SGI XP/XPC/XPNET DRIVER + M: Cliff Whickman + M: Robin Holt diff --git a/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-asus-nb-wmi-Add-wapf4-quirk-for-the-X30.patch b/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-asus-nb-wmi-Add-wapf4-quirk-for-the-X30.patch deleted file mode 100644 index 8c719dd5..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-asus-nb-wmi-Add-wapf4-quirk-for-the-X30.patch +++ /dev/null @@ -1,37 +0,0 @@ -From f35823619db8bbaa2afea8705f239c3cecb9d22f Mon Sep 17 00:00:00 2001 -From: Santeri Toivonen -Date: Tue, 4 Apr 2017 21:09:00 +0300 -Subject: [PATCH] platform/x86: asus-nb-wmi: Add wapf4 quirk for the X302UA - -Asus laptop X302UA starts up with Wi-Fi disabled, -without a way to enable it. Set wapf=4 to fix the problem. - -Signed-off-by: Santeri Toivonen -Signed-off-by: Darren Hart (VMware) ---- - drivers/platform/x86/asus-nb-wmi.c | 9 +++++++++ - 1 file changed, 9 insertions(+) - -diff --git a/drivers/platform/x86/asus-nb-wmi.c b/drivers/platform/x86/asus-nb-wmi.c -index dea98ffb6f60..1ae58d906536 100644 ---- a/drivers/platform/x86/asus-nb-wmi.c -+++ b/drivers/platform/x86/asus-nb-wmi.c -@@ -144,6 +144,15 @@ static const struct dmi_system_id asus_quirks[] = { - }, - { - .callback = dmi_matched, -+ .ident = "ASUSTeK COMPUTER INC. X302UA", -+ .matches = { -+ DMI_MATCH(DMI_SYS_VENDOR, "ASUSTeK COMPUTER INC."), -+ DMI_MATCH(DMI_PRODUCT_NAME, "X302UA"), -+ }, -+ .driver_data = &quirk_asus_wapf4, -+ }, -+ { -+ .callback = dmi_matched, - .ident = "ASUSTeK COMPUTER INC. X401U", - .matches = { - DMI_MATCH(DMI_SYS_VENDOR, "ASUSTeK COMPUTER INC."), --- -2.13.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-ideapad-Add-IdeaPad-320-15IKB-to-no_hw_rfkill_list.patch b/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-ideapad-Add-IdeaPad-320-15IKB-to-no_hw_rfkill_list.patch new file mode 100644 index 00000000..d1eaa9b6 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-ideapad-Add-IdeaPad-320-15IKB-to-no_hw_rfkill_list.patch @@ -0,0 +1,24 @@ + +Add Lenovo Ideapad 320-15IKB to no_hw_rfkill_list + +https://bugs.mageia.org/show_bug.cgi?id=21728 + +Reported-by: Jean-Christophe Cardot +Signed-off-by: Thomas Backlund + +--- a/drivers/platform/x86/ideapad-laptop.c ++++ b/drivers/platform/x86/ideapad-laptop.c +@@ -956,6 +956,13 @@ static const struct dmi_system_id no_hw_ + }, + }, + { ++ .ident = "Lenovo ideapad 320-15IKB", ++ .matches = { ++ DMI_MATCH(DMI_SYS_VENDOR, "LENOVO"), ++ DMI_MATCH(DMI_PRODUCT_VERSION, "Lenovo ideapad 320-15IKB"), ++ }, ++ }, ++ { + .ident = "Lenovo ideapad Y700-14ISK", + .matches = { + DMI_MATCH(DMI_SYS_VENDOR, "LENOVO"), diff --git a/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-ideapad-laptop-Increase-timeout-to-wait-for-ec-answer.patch b/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-ideapad-laptop-Increase-timeout-to-wait-for-ec-answer.patch new file mode 100644 index 00000000..05410a4e --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-ideapad-laptop-Increase-timeout-to-wait-for-ec-answer.patch @@ -0,0 +1,27 @@ +From: Aaron Ma +Subject: [PATCH] platform/x86: ideapad-laptop: Increase timeout to wait for EC answer +Date: Sun, 11 Feb 2018 17:18:49 +0800 + +Lenovo E41-20 needs more time than 100ms to read VPC, +the funtion keys always failed responding. +Increase timeout to get the value from VPC, then +the funtion keys like mic mute key work well. + +Signed-off-by: Aaron Ma +--- + drivers/platform/x86/ideapad-laptop.c | 2 +- + 1 file changed, 1 insertion(+), 1 deletion(-) + +diff --git a/drivers/platform/x86/ideapad-laptop.c b/drivers/platform/x86/ideapad-laptop.c +index 5b6f18b18801..535199c9e6bc 100644 +--- a/drivers/platform/x86/ideapad-laptop.c ++++ b/drivers/platform/x86/ideapad-laptop.c +@@ -113,7 +113,7 @@ MODULE_PARM_DESC(no_bt_rfkill, "No rfkill for bluetooth."); + /* + * ACPI Helpers + */ +-#define IDEAPAD_EC_TIMEOUT (100) /* in ms */ ++#define IDEAPAD_EC_TIMEOUT (200) /* in ms */ + + static int read_method_int(acpi_handle handle, const char *method, int *val) + { diff --git a/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-shuttle-wmi-4.13-buildfix.patch b/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-shuttle-wmi-4.13-buildfix.patch new file mode 100644 index 00000000..c9a1c60d --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/platform-x86-shuttle-wmi-4.13-buildfix.patch @@ -0,0 +1,30 @@ + +sparse_keymap_free() is now obsolete. + +Signed-off-by: Thomas Backlund + +--- linux/drivers/platform/x86/shuttle-wmi.c.orig 2017-10-15 00:39:53.041395980 +0300 ++++ linux/drivers/platform/x86/shuttle-wmi.c 2017-10-15 01:05:37.008662881 +0300 +@@ -763,14 +763,9 @@ static int shuttle_wmi_input_init(struct + goto err_free_dev; + + rc = input_register_device(input); +- if (rc) +- goto err_free_keymap; + + priv->inputdev = input; + return 0; +- +-err_free_keymap: +- sparse_keymap_free(input); + err_free_dev: + input_free_device(input); + return rc; +@@ -780,7 +775,6 @@ static void shuttle_wmi_input_remove(str + { + struct input_dev *input = priv->inputdev; + +- sparse_keymap_free(input); + input_unregister_device(input); + } + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0001-x86-asm-offsets-Move-TSS_sp0-and-TSS_sp1-to-asm-offs.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0001-x86-asm-offsets-Move-TSS_sp0-and-TSS_sp1-to-asm-offs.patch new file mode 100644 index 00000000..4a7877fe --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0001-x86-asm-offsets-Move-TSS_sp0-and-TSS_sp1-to-asm-offs.patch @@ -0,0 +1,44 @@ +From 3b7711fd3adb7d6b812a33da4a4639ddce6522b6 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Fri, 19 Jan 2018 13:46:20 +0100 +Subject: [PATCH 01/31] x86/asm-offsets: Move TSS_sp0 and TSS_sp1 to + asm-offsets.c + +These offsets will be used in 32 bit assembly code as well, +so make them available for all of x86 code. + +Signed-off-by: Joerg Roedel +--- + arch/x86/kernel/asm-offsets.c | 4 ++++ + arch/x86/kernel/asm-offsets_64.c | 2 -- + 2 files changed, 4 insertions(+), 2 deletions(-) + +diff --git a/arch/x86/kernel/asm-offsets.c b/arch/x86/kernel/asm-offsets.c +index 76417a9aab73..232152ccb301 100644 +--- a/arch/x86/kernel/asm-offsets.c ++++ b/arch/x86/kernel/asm-offsets.c +@@ -103,4 +103,8 @@ void common(void) { + OFFSET(CPU_ENTRY_AREA_entry_trampoline, cpu_entry_area, entry_trampoline); + OFFSET(CPU_ENTRY_AREA_entry_stack, cpu_entry_area, entry_stack_page); + DEFINE(SIZEOF_entry_stack, sizeof(struct entry_stack)); ++ ++ /* Offset for sp0 and sp1 into the tss_struct */ ++ OFFSET(TSS_sp0, tss_struct, x86_tss.sp0); ++ OFFSET(TSS_sp1, tss_struct, x86_tss.sp1); + } +diff --git a/arch/x86/kernel/asm-offsets_64.c b/arch/x86/kernel/asm-offsets_64.c +index bf51e51d808d..d2eba73a5f8a 100644 +--- a/arch/x86/kernel/asm-offsets_64.c ++++ b/arch/x86/kernel/asm-offsets_64.c +@@ -65,8 +65,6 @@ int main(void) + #undef ENTRY + + OFFSET(TSS_ist, tss_struct, x86_tss.ist); +- OFFSET(TSS_sp0, tss_struct, x86_tss.sp0); +- OFFSET(TSS_sp1, tss_struct, x86_tss.sp1); + BLANK(); + + #ifdef CONFIG_CC_STACKPROTECTOR +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0002-x86-entry-32-Rename-TSS_sysenter_sp0-to-TSS_entry_st.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0002-x86-entry-32-Rename-TSS_sysenter_sp0-to-TSS_entry_st.patch new file mode 100644 index 00000000..d228b31f --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0002-x86-entry-32-Rename-TSS_sysenter_sp0-to-TSS_entry_st.patch @@ -0,0 +1,48 @@ +From 52806123bdb0b558a5b4fbfa132bae32e53b008a Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Mon, 15 Jan 2018 18:20:15 +0100 +Subject: [PATCH 02/31] x86/entry/32: Rename TSS_sysenter_sp0 to + TSS_entry_stack + +The stack address doesn't need to be stored in tss.sp0 if +we switch manually like on sysenter. Rename the offset so +that it still makes sense when we change its location. + +We will also use this stack for all kernel-entry points, not +just sysenter. Reflect that in the name as well. + +Signed-off-by: Joerg Roedel +--- + arch/x86/entry/entry_32.S | 2 +- + arch/x86/kernel/asm-offsets_32.c | 2 +- + 2 files changed, 2 insertions(+), 2 deletions(-) + +diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S +index 2a35b1e0fb90..e65977615616 100644 +--- a/arch/x86/entry/entry_32.S ++++ b/arch/x86/entry/entry_32.S +@@ -413,7 +413,7 @@ ENTRY(xen_sysenter_target) + * 0(%ebp) arg6 + */ + ENTRY(entry_SYSENTER_32) +- movl TSS_sysenter_sp0(%esp), %esp ++ movl TSS_entry_stack(%esp), %esp + .Lsysenter_past_esp: + pushl $__USER_DS /* pt_regs->ss */ + pushl %ebp /* pt_regs->sp (stashed in bp) */ +diff --git a/arch/x86/kernel/asm-offsets_32.c b/arch/x86/kernel/asm-offsets_32.c +index fa1261eefa16..f452bfdc485a 100644 +--- a/arch/x86/kernel/asm-offsets_32.c ++++ b/arch/x86/kernel/asm-offsets_32.c +@@ -47,7 +47,7 @@ void foo(void) + BLANK(); + + /* Offset from the sysenter stack to tss.sp0 */ +- DEFINE(TSS_sysenter_sp0, offsetof(struct cpu_entry_area, tss.x86_tss.sp0) - ++ DEFINE(TSS_entry_stack, offsetof(struct cpu_entry_area, tss.x86_tss.sp0) - + offsetofend(struct cpu_entry_area, entry_stack_page.stack)); + + #ifdef CONFIG_CC_STACKPROTECTOR +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0003-x86-entry-32-Load-task-stack-from-x86_tss.sp1-in-SYS.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0003-x86-entry-32-Load-task-stack-from-x86_tss.sp1-in-SYS.patch new file mode 100644 index 00000000..cf3e210d --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0003-x86-entry-32-Load-task-stack-from-x86_tss.sp1-in-SYS.patch @@ -0,0 +1,49 @@ +From b696a2c46d9b9937b816b11ff2ec72aa0b65f204 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Fri, 19 Jan 2018 13:33:37 +0100 +Subject: [PATCH 03/31] x86/entry/32: Load task stack from x86_tss.sp1 in + SYSENTER handler + +We want x86_tss.sp0 point to the entry stack later to use +it as a trampoline stack for other kernel entry points +besides SYSENTER. + +So store the task stack pointer in x86_tss.sp1, which is +otherwise unused by the hardware, as Linux doesn't make use +of Ring 1. + +Signed-off-by: Joerg Roedel +--- + arch/x86/kernel/asm-offsets_32.c | 2 +- + arch/x86/kernel/process_32.c | 2 ++ + 2 files changed, 3 insertions(+), 1 deletion(-) + +diff --git a/arch/x86/kernel/asm-offsets_32.c b/arch/x86/kernel/asm-offsets_32.c +index f452bfdc485a..b97e48c87e80 100644 +--- a/arch/x86/kernel/asm-offsets_32.c ++++ b/arch/x86/kernel/asm-offsets_32.c +@@ -47,7 +47,7 @@ void foo(void) + BLANK(); + + /* Offset from the sysenter stack to tss.sp0 */ +- DEFINE(TSS_entry_stack, offsetof(struct cpu_entry_area, tss.x86_tss.sp0) - ++ DEFINE(TSS_entry_stack, offsetof(struct cpu_entry_area, tss.x86_tss.sp1) - + offsetofend(struct cpu_entry_area, entry_stack_page.stack)); + + #ifdef CONFIG_CC_STACKPROTECTOR +diff --git a/arch/x86/kernel/process_32.c b/arch/x86/kernel/process_32.c +index 5224c6099184..097d36a64889 100644 +--- a/arch/x86/kernel/process_32.c ++++ b/arch/x86/kernel/process_32.c +@@ -292,6 +292,8 @@ __switch_to(struct task_struct *prev_p, struct task_struct *next_p) + this_cpu_write(cpu_current_top_of_stack, + (unsigned long)task_stack_page(next_p) + + THREAD_SIZE); ++ /* SYSENTER reads the task-stack from tss.sp1 */ ++ this_cpu_write(cpu_tss_rw.x86_tss.sp1, next_p->thread.sp0); + + /* + * Restore %gs if needed (which is common) +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0004-x86-entry-32-Put-ESPFIX-code-into-a-macro.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0004-x86-entry-32-Put-ESPFIX-code-into-a-macro.patch new file mode 100644 index 00000000..488ab4fc --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0004-x86-entry-32-Put-ESPFIX-code-into-a-macro.patch @@ -0,0 +1,137 @@ +From 7c97243c7694dc1c0e0ad73bc17bdc2c553225ac Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Wed, 31 Jan 2018 10:50:02 +0100 +Subject: [PATCH 04/31] x86/entry/32: Put ESPFIX code into a macro + +This makes it easier to split up the shared iret code path. + +Signed-off-by: Joerg Roedel +--- + arch/x86/entry/entry_32.S | 97 ++++++++++++++++++++++++----------------------- + 1 file changed, 49 insertions(+), 48 deletions(-) + +diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S +index e65977615616..0289bde37a08 100644 +--- a/arch/x86/entry/entry_32.S ++++ b/arch/x86/entry/entry_32.S +@@ -221,6 +221,54 @@ + POP_GS_EX + .endm + ++.macro CHECK_AND_APPLY_ESPFIX ++#ifdef CONFIG_X86_ESPFIX32 ++#define GDT_ESPFIX_SS PER_CPU_VAR(gdt_page) + (GDT_ENTRY_ESPFIX_SS * 8) ++ ++ ALTERNATIVE "jmp .Lend_\@", "", X86_BUG_ESPFIX ++ ++ movl PT_EFLAGS(%esp), %eax # mix EFLAGS, SS and CS ++ /* ++ * Warning: PT_OLDSS(%esp) contains the wrong/random values if we ++ * are returning to the kernel. ++ * See comments in process.c:copy_thread() for details. ++ */ ++ movb PT_OLDSS(%esp), %ah ++ movb PT_CS(%esp), %al ++ andl $(X86_EFLAGS_VM | (SEGMENT_TI_MASK << 8) | SEGMENT_RPL_MASK), %eax ++ cmpl $((SEGMENT_LDT << 8) | USER_RPL), %eax ++ jne .Lend_\@ # returning to user-space with LDT SS ++ ++ /* ++ * Setup and switch to ESPFIX stack ++ * ++ * We're returning to userspace with a 16 bit stack. The CPU will not ++ * restore the high word of ESP for us on executing iret... This is an ++ * "official" bug of all the x86-compatible CPUs, which we can work ++ * around to make dosemu and wine happy. We do this by preloading the ++ * high word of ESP with the high word of the userspace ESP while ++ * compensating for the offset by changing to the ESPFIX segment with ++ * a base address that matches for the difference. ++ */ ++ mov %esp, %edx /* load kernel esp */ ++ mov PT_OLDESP(%esp), %eax /* load userspace esp */ ++ mov %dx, %ax /* eax: new kernel esp */ ++ sub %eax, %edx /* offset (low word is 0) */ ++ shr $16, %edx ++ mov %dl, GDT_ESPFIX_SS + 4 /* bits 16..23 */ ++ mov %dh, GDT_ESPFIX_SS + 7 /* bits 24..31 */ ++ pushl $__ESPFIX_SS ++ pushl %eax /* new kernel esp */ ++ /* ++ * Disable interrupts, but do not irqtrace this section: we ++ * will soon execute iret and the tracer was already set to ++ * the irqstate after the IRET: ++ */ ++ DISABLE_INTERRUPTS(CLBR_ANY) ++ lss (%esp), %esp /* switch to espfix segment */ ++.Lend_\@: ++#endif /* CONFIG_X86_ESPFIX32 */ ++.endm + /* + * %eax: prev task + * %edx: next task +@@ -548,21 +596,7 @@ ENTRY(entry_INT80_32) + restore_all: + TRACE_IRQS_IRET + .Lrestore_all_notrace: +-#ifdef CONFIG_X86_ESPFIX32 +- ALTERNATIVE "jmp .Lrestore_nocheck", "", X86_BUG_ESPFIX +- +- movl PT_EFLAGS(%esp), %eax # mix EFLAGS, SS and CS +- /* +- * Warning: PT_OLDSS(%esp) contains the wrong/random values if we +- * are returning to the kernel. +- * See comments in process.c:copy_thread() for details. +- */ +- movb PT_OLDSS(%esp), %ah +- movb PT_CS(%esp), %al +- andl $(X86_EFLAGS_VM | (SEGMENT_TI_MASK << 8) | SEGMENT_RPL_MASK), %eax +- cmpl $((SEGMENT_LDT << 8) | USER_RPL), %eax +- je .Lldt_ss # returning to user-space with LDT SS +-#endif ++ CHECK_AND_APPLY_ESPFIX + .Lrestore_nocheck: + RESTORE_REGS 4 # skip orig_eax/error_code + .Lirq_return: +@@ -575,39 +609,6 @@ ENTRY(iret_exc ) + jmp common_exception + .previous + _ASM_EXTABLE(.Lirq_return, iret_exc) +- +-#ifdef CONFIG_X86_ESPFIX32 +-.Lldt_ss: +-/* +- * Setup and switch to ESPFIX stack +- * +- * We're returning to userspace with a 16 bit stack. The CPU will not +- * restore the high word of ESP for us on executing iret... This is an +- * "official" bug of all the x86-compatible CPUs, which we can work +- * around to make dosemu and wine happy. We do this by preloading the +- * high word of ESP with the high word of the userspace ESP while +- * compensating for the offset by changing to the ESPFIX segment with +- * a base address that matches for the difference. +- */ +-#define GDT_ESPFIX_SS PER_CPU_VAR(gdt_page) + (GDT_ENTRY_ESPFIX_SS * 8) +- mov %esp, %edx /* load kernel esp */ +- mov PT_OLDESP(%esp), %eax /* load userspace esp */ +- mov %dx, %ax /* eax: new kernel esp */ +- sub %eax, %edx /* offset (low word is 0) */ +- shr $16, %edx +- mov %dl, GDT_ESPFIX_SS + 4 /* bits 16..23 */ +- mov %dh, GDT_ESPFIX_SS + 7 /* bits 24..31 */ +- pushl $__ESPFIX_SS +- pushl %eax /* new kernel esp */ +- /* +- * Disable interrupts, but do not irqtrace this section: we +- * will soon execute iret and the tracer was already set to +- * the irqstate after the IRET: +- */ +- DISABLE_INTERRUPTS(CLBR_ANY) +- lss (%esp), %esp /* switch to espfix segment */ +- jmp .Lrestore_nocheck +-#endif + ENDPROC(entry_INT80_32) + + .macro FIXUP_ESPFIX_STACK +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0005-x86-entry-32-Unshare-NMI-return-path.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0005-x86-entry-32-Unshare-NMI-return-path.patch new file mode 100644 index 00000000..c3171963 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0005-x86-entry-32-Unshare-NMI-return-path.patch @@ -0,0 +1,43 @@ +From c66ec22d03296d1311197aaef753c1c320eed225 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Wed, 31 Jan 2018 10:58:38 +0100 +Subject: [PATCH 05/31] x86/entry/32: Unshare NMI return path + +NMI will no longer use most of the shared return path, +because NMI needs special handling when the CR3 switches for +PTI are added. This patch prepares for that. + +Signed-off-by: Joerg Roedel +--- + arch/x86/entry/entry_32.S | 8 ++++++-- + 1 file changed, 6 insertions(+), 2 deletions(-) + +diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S +index 0289bde37a08..00ae759a7c44 100644 +--- a/arch/x86/entry/entry_32.S ++++ b/arch/x86/entry/entry_32.S +@@ -1007,7 +1007,7 @@ ENTRY(nmi) + + /* Not on SYSENTER stack. */ + call do_nmi +- jmp .Lrestore_all_notrace ++ jmp .Lnmi_return + + .Lnmi_from_sysenter_stack: + /* +@@ -1018,7 +1018,11 @@ ENTRY(nmi) + movl PER_CPU_VAR(cpu_current_top_of_stack), %esp + call do_nmi + movl %ebx, %esp +- jmp .Lrestore_all_notrace ++ ++.Lnmi_return: ++ CHECK_AND_APPLY_ESPFIX ++ RESTORE_REGS 4 ++ jmp .Lirq_return + + #ifdef CONFIG_X86_ESPFIX32 + .Lnmi_espfix_stack: +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0006-x86-entry-32-Split-off-return-to-kernel-path.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0006-x86-entry-32-Split-off-return-to-kernel-path.patch new file mode 100644 index 00000000..523e0f90 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0006-x86-entry-32-Split-off-return-to-kernel-path.patch @@ -0,0 +1,55 @@ +From 916e5e906873de859d8a87c1ffb0323e167d1a44 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Wed, 31 Jan 2018 11:07:32 +0100 +Subject: [PATCH 06/31] x86/entry/32: Split off return-to-kernel path + +Use a separate return path when we know we are returning to +the kernel. This allows us to put the PTI cr3-switch and the +switch to the entry-stack into the return-to-user path +without further checking. + +Signed-off-by: Joerg Roedel +--- + arch/x86/entry/entry_32.S | 11 ++++++++--- + 1 file changed, 8 insertions(+), 3 deletions(-) + +diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S +index 00ae759a7c44..9bd77183965f 100644 +--- a/arch/x86/entry/entry_32.S ++++ b/arch/x86/entry/entry_32.S +@@ -65,7 +65,7 @@ + # define preempt_stop(clobbers) DISABLE_INTERRUPTS(clobbers); TRACE_IRQS_OFF + #else + # define preempt_stop(clobbers) +-# define resume_kernel restore_all ++# define resume_kernel restore_all_kernel + #endif + + .macro TRACE_IRQS_IRET +@@ -400,9 +400,9 @@ ENTRY(resume_kernel) + DISABLE_INTERRUPTS(CLBR_ANY) + .Lneed_resched: + cmpl $0, PER_CPU_VAR(__preempt_count) +- jnz restore_all ++ jnz restore_all_kernel + testl $X86_EFLAGS_IF, PT_EFLAGS(%esp) # interrupts off (exception path) ? +- jz restore_all ++ jz restore_all_kernel + call preempt_schedule_irq + jmp .Lneed_resched + END(resume_kernel) +@@ -602,6 +602,11 @@ restore_all: + .Lirq_return: + INTERRUPT_RETURN + ++restore_all_kernel: ++ TRACE_IRQS_IRET ++ RESTORE_REGS 4 ++ jmp .Lirq_return ++ + .section .fixup, "ax" + ENTRY(iret_exc ) + pushl $0 # no error code +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0007-x86-entry-32-Restore-segments-before-int-registers.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0007-x86-entry-32-Restore-segments-before-int-registers.patch new file mode 100644 index 00000000..52c548e7 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0007-x86-entry-32-Restore-segments-before-int-registers.patch @@ -0,0 +1,111 @@ +From c19ad15b16ec8908794459f28b44eca889a925f7 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Wed, 31 Jan 2018 11:29:59 +0100 +Subject: [PATCH 07/31] x86/entry/32: Restore segments before int registers + +Restoring the segments can cause exceptions that need to be +handled. With PTI enabled, we still need to be on kernel cr3 +when the exception happens. For the cr3-switch we need +at least one integer scratch register, so we can't switch +with the user integer registers already loaded. + +Avoid a push/pop cycle to free a register for the cr3 switch +by restoring the segments first. That way the integer +registers are not live yet and we can use them for the cr3 +switch. + +This also helps in the NMI path, where we need to leave with +the same cr3 as we entered. There we still have the +callee-saved registers live when switching cr3s. + +Signed-off-by: Joerg Roedel +--- + arch/x86/entry/entry_32.S | 50 ++++++++++++++++++++--------------------------- + 1 file changed, 21 insertions(+), 29 deletions(-) + +diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S +index 9bd77183965f..b39c5e210b43 100644 +--- a/arch/x86/entry/entry_32.S ++++ b/arch/x86/entry/entry_32.S +@@ -92,11 +92,6 @@ + .macro PUSH_GS + pushl $0 + .endm +-.macro POP_GS pop=0 +- addl $(4 + \pop), %esp +-.endm +-.macro POP_GS_EX +-.endm + + /* all the rest are no-op */ + .macro PTGS_TO_GS +@@ -116,20 +111,6 @@ + pushl %gs + .endm + +-.macro POP_GS pop=0 +-98: popl %gs +- .if \pop <> 0 +- add $\pop, %esp +- .endif +-.endm +-.macro POP_GS_EX +-.pushsection .fixup, "ax" +-99: movl $0, (%esp) +- jmp 98b +-.popsection +- _ASM_EXTABLE(98b, 99b) +-.endm +- + .macro PTGS_TO_GS + 98: mov PT_GS(%esp), %gs + .endm +@@ -201,24 +182,35 @@ + popl %eax + .endm + +-.macro RESTORE_REGS pop=0 +- RESTORE_INT_REGS +-1: popl %ds +-2: popl %es +-3: popl %fs +- POP_GS \pop ++.macro RESTORE_SEGMENTS ++1: mov PT_DS(%esp), %ds ++2: mov PT_ES(%esp), %es ++3: mov PT_FS(%esp), %fs ++ PTGS_TO_GS + .pushsection .fixup, "ax" +-4: movl $0, (%esp) ++4: movl $0, PT_DS(%esp) + jmp 1b +-5: movl $0, (%esp) ++5: movl $0, PT_ES(%esp) + jmp 2b +-6: movl $0, (%esp) ++6: movl $0, PT_FS(%esp) + jmp 3b + .popsection + _ASM_EXTABLE(1b, 4b) + _ASM_EXTABLE(2b, 5b) + _ASM_EXTABLE(3b, 6b) +- POP_GS_EX ++ PTGS_TO_GS_EX ++.endm ++ ++.macro RESTORE_SKIP_SEGMENTS pop=0 ++ /* Jump over the segments stored on stack */ ++ addl $((4 * 4) + \pop), %esp ++.endm ++ ++.macro RESTORE_REGS pop=0 ++ RESTORE_SEGMENTS ++ RESTORE_INT_REGS ++ /* Skip over already restored segment registers */ ++ RESTORE_SKIP_SEGMENTS \pop + .endm + + .macro CHECK_AND_APPLY_ESPFIX +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0008-x86-entry-32-Enter-the-kernel-via-trampoline-stack.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0008-x86-entry-32-Enter-the-kernel-via-trampoline-stack.patch new file mode 100644 index 00000000..eb3f5103 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0008-x86-entry-32-Enter-the-kernel-via-trampoline-stack.patch @@ -0,0 +1,355 @@ +From d9dc2b83bdfc2a9265302cc90b32739ac579f8cc Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 10:55:52 +0100 +Subject: [PATCH 08/31] x86/entry/32: Enter the kernel via trampoline stack + +Use the entry-stack as a trampoline to enter the kernel. The +entry-stack is already in the cpu_entry_area and will be +mapped to userspace when PTI is enabled. + +Signed-off-by: Joerg Roedel +--- + arch/x86/entry/entry_32.S | 135 +++++++++++++++++++++++++++++++-------- + arch/x86/include/asm/switch_to.h | 6 +- + arch/x86/kernel/asm-offsets.c | 1 + + arch/x86/kernel/cpu/common.c | 5 +- + arch/x86/kernel/process.c | 2 - + arch/x86/kernel/process_32.c | 10 +-- + 6 files changed, 120 insertions(+), 39 deletions(-) + +diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S +index b39c5e210b43..e714b53b1eaa 100644 +--- a/arch/x86/entry/entry_32.S ++++ b/arch/x86/entry/entry_32.S +@@ -135,25 +135,36 @@ + + #endif /* CONFIG_X86_32_LAZY_GS */ + +-.macro SAVE_ALL pt_regs_ax=%eax ++.macro SAVE_ALL pt_regs_ax=%eax switch_stacks=0 + cld ++ /* Push segment registers and %eax */ + PUSH_GS + pushl %fs + pushl %es + pushl %ds + pushl \pt_regs_ax ++ ++ /* Load kernel segments */ ++ movl $(__USER_DS), %eax ++ movl %eax, %ds ++ movl %eax, %es ++ movl $(__KERNEL_PERCPU), %eax ++ movl %eax, %fs ++ SET_KERNEL_GS %eax ++ ++ /* Push integer registers and complete PT_REGS */ + pushl %ebp + pushl %edi + pushl %esi + pushl %edx + pushl %ecx + pushl %ebx +- movl $(__USER_DS), %edx +- movl %edx, %ds +- movl %edx, %es +- movl $(__KERNEL_PERCPU), %edx +- movl %edx, %fs +- SET_KERNEL_GS %edx ++ ++ /* Switch to kernel stack if necessary */ ++.if \switch_stacks > 0 ++ SWITCH_TO_KERNEL_STACK ++.endif ++ + .endm + + /* +@@ -261,6 +272,71 @@ + .Lend_\@: + #endif /* CONFIG_X86_ESPFIX32 */ + .endm ++ ++ ++/* ++ * Called with pt_regs fully populated and kernel segments loaded, ++ * so we can access PER_CPU and use the integer registers. ++ * ++ * We need to be very careful here with the %esp switch, because an NMI ++ * can happen everywhere. If the NMI handler finds itself on the ++ * entry-stack, it will overwrite the task-stack and everything we ++ * copied there. So allocate the stack-frame on the task-stack and ++ * switch to it before we do any copying. ++ */ ++.macro SWITCH_TO_KERNEL_STACK ++ ++ ALTERNATIVE "", "jmp .Lend_\@", X86_FEATURE_XENPV ++ ++ /* Are we on the entry stack? Bail out if not! */ ++ movl PER_CPU_VAR(cpu_entry_area), %edi ++ addl $CPU_ENTRY_AREA_entry_stack, %edi ++ cmpl %esp, %edi ++ jae .Lend_\@ ++ ++ /* Load stack pointer into %esi and %edi */ ++ movl %esp, %esi ++ movl %esi, %edi ++ ++ /* Move %edi to the top of the entry stack */ ++ andl $(MASK_entry_stack), %edi ++ addl $(SIZEOF_entry_stack), %edi ++ ++ /* Load top of task-stack into %edi */ ++ movl TSS_entry_stack(%edi), %edi ++ ++ /* Bytes to copy */ ++ movl $PTREGS_SIZE, %ecx ++ ++#ifdef CONFIG_VM86 ++ testl $X86_EFLAGS_VM, PT_EFLAGS(%esi) ++ jz .Lcopy_pt_regs_\@ ++ ++ /* ++ * Stack-frame contains 4 additional segment registers when ++ * coming from VM86 mode ++ */ ++ addl $(4 * 4), %ecx ++ ++.Lcopy_pt_regs_\@: ++#endif ++ ++ /* Allocate frame on task-stack */ ++ subl %ecx, %edi ++ ++ /* Switch to task-stack */ ++ movl %edi, %esp ++ ++ /* ++ * We are now on the task-stack and can safely copy over the ++ * stack-frame ++ */ ++ cld ++ rep movsb ++ ++.Lend_\@: ++.endm ++ + /* + * %eax: prev task + * %edx: next task +@@ -454,6 +530,7 @@ ENTRY(xen_sysenter_target) + */ + ENTRY(entry_SYSENTER_32) + movl TSS_entry_stack(%esp), %esp ++ + .Lsysenter_past_esp: + pushl $__USER_DS /* pt_regs->ss */ + pushl %ebp /* pt_regs->sp (stashed in bp) */ +@@ -462,7 +539,7 @@ ENTRY(entry_SYSENTER_32) + pushl $__USER_CS /* pt_regs->cs */ + pushl $0 /* pt_regs->ip = 0 (placeholder) */ + pushl %eax /* pt_regs->orig_ax */ +- SAVE_ALL pt_regs_ax=$-ENOSYS /* save rest */ ++ SAVE_ALL pt_regs_ax=$-ENOSYS /* save rest, stack already switched */ + + /* + * SYSENTER doesn't filter flags, so we need to clear NT, AC +@@ -573,7 +650,8 @@ ENDPROC(entry_SYSENTER_32) + ENTRY(entry_INT80_32) + ASM_CLAC + pushl %eax /* pt_regs->orig_ax */ +- SAVE_ALL pt_regs_ax=$-ENOSYS /* save rest */ ++ ++ SAVE_ALL pt_regs_ax=$-ENOSYS switch_stacks=1 /* save rest */ + + /* + * User mode is traced as though IRQs are on, and the interrupt gate +@@ -665,7 +743,8 @@ END(irq_entries_start) + common_interrupt: + ASM_CLAC + addl $-0x80, (%esp) /* Adjust vector into the [-256, -1] range */ +- SAVE_ALL ++ ++ SAVE_ALL switch_stacks=1 + ENCODE_FRAME_POINTER + TRACE_IRQS_OFF + movl %esp, %eax +@@ -673,16 +752,16 @@ common_interrupt: + jmp ret_from_intr + ENDPROC(common_interrupt) + +-#define BUILD_INTERRUPT3(name, nr, fn) \ +-ENTRY(name) \ +- ASM_CLAC; \ +- pushl $~(nr); \ +- SAVE_ALL; \ +- ENCODE_FRAME_POINTER; \ +- TRACE_IRQS_OFF \ +- movl %esp, %eax; \ +- call fn; \ +- jmp ret_from_intr; \ ++#define BUILD_INTERRUPT3(name, nr, fn) \ ++ENTRY(name) \ ++ ASM_CLAC; \ ++ pushl $~(nr); \ ++ SAVE_ALL switch_stacks=1; \ ++ ENCODE_FRAME_POINTER; \ ++ TRACE_IRQS_OFF \ ++ movl %esp, %eax; \ ++ call fn; \ ++ jmp ret_from_intr; \ + ENDPROC(name) + + #define BUILD_INTERRUPT(name, nr) \ +@@ -908,16 +987,20 @@ common_exception: + pushl %es + pushl %ds + pushl %eax ++ movl $(__USER_DS), %eax ++ movl %eax, %ds ++ movl %eax, %es ++ movl $(__KERNEL_PERCPU), %eax ++ movl %eax, %fs + pushl %ebp + pushl %edi + pushl %esi + pushl %edx + pushl %ecx + pushl %ebx ++ SWITCH_TO_KERNEL_STACK + ENCODE_FRAME_POINTER + cld +- movl $(__KERNEL_PERCPU), %ecx +- movl %ecx, %fs + UNWIND_ESPFIX_STACK + GS_TO_REG %ecx + movl PT_GS(%esp), %edi # get the function address +@@ -925,9 +1008,6 @@ common_exception: + movl $-1, PT_ORIG_EAX(%esp) # no syscall to restart + REG_TO_PTGS %ecx + SET_KERNEL_GS %ecx +- movl $(__USER_DS), %ecx +- movl %ecx, %ds +- movl %ecx, %es + TRACE_IRQS_OFF + movl %esp, %eax # pt_regs pointer + CALL_NOSPEC %edi +@@ -946,6 +1026,7 @@ ENTRY(debug) + */ + ASM_CLAC + pushl $-1 # mark this as an int ++ + SAVE_ALL + ENCODE_FRAME_POINTER + xorl %edx, %edx # error code 0 +@@ -981,6 +1062,7 @@ END(debug) + */ + ENTRY(nmi) + ASM_CLAC ++ + #ifdef CONFIG_X86_ESPFIX32 + pushl %eax + movl %ss, %eax +@@ -1048,7 +1130,8 @@ END(nmi) + ENTRY(int3) + ASM_CLAC + pushl $-1 # mark this as an int +- SAVE_ALL ++ ++ SAVE_ALL switch_stacks=1 + ENCODE_FRAME_POINTER + TRACE_IRQS_OFF + xorl %edx, %edx # zero error code +diff --git a/arch/x86/include/asm/switch_to.h b/arch/x86/include/asm/switch_to.h +index eb5f7999a893..20e5f7ab8260 100644 +--- a/arch/x86/include/asm/switch_to.h ++++ b/arch/x86/include/asm/switch_to.h +@@ -89,13 +89,9 @@ static inline void refresh_sysenter_cs(struct thread_struct *thread) + /* This is used when switching tasks or entering/exiting vm86 mode. */ + static inline void update_sp0(struct task_struct *task) + { +- /* On x86_64, sp0 always points to the entry trampoline stack, which is constant: */ +-#ifdef CONFIG_X86_32 +- load_sp0(task->thread.sp0); +-#else ++ /* sp0 always points to the entry trampoline stack, which is constant: */ + if (static_cpu_has(X86_FEATURE_XENPV)) + load_sp0(task_top_of_stack(task)); +-#endif + } + + #endif /* _ASM_X86_SWITCH_TO_H */ +diff --git a/arch/x86/kernel/asm-offsets.c b/arch/x86/kernel/asm-offsets.c +index 232152ccb301..86f06e808d02 100644 +--- a/arch/x86/kernel/asm-offsets.c ++++ b/arch/x86/kernel/asm-offsets.c +@@ -103,6 +103,7 @@ void common(void) { + OFFSET(CPU_ENTRY_AREA_entry_trampoline, cpu_entry_area, entry_trampoline); + OFFSET(CPU_ENTRY_AREA_entry_stack, cpu_entry_area, entry_stack_page); + DEFINE(SIZEOF_entry_stack, sizeof(struct entry_stack)); ++ DEFINE(MASK_entry_stack, (~(sizeof(struct entry_stack) - 1))); + + /* Offset for sp0 and sp1 into the tss_struct */ + OFFSET(TSS_sp0, tss_struct, x86_tss.sp0); +diff --git a/arch/x86/kernel/cpu/common.c b/arch/x86/kernel/cpu/common.c +index d63f4b5706e4..a0ed3481f2eb 100644 +--- a/arch/x86/kernel/cpu/common.c ++++ b/arch/x86/kernel/cpu/common.c +@@ -1709,11 +1709,12 @@ void cpu_init(void) + enter_lazy_tlb(&init_mm, curr); + + /* +- * Initialize the TSS. Don't bother initializing sp0, as the initial +- * task never enters user mode. ++ * Initialize the TSS. sp0 points to the entry trampoline stack ++ * regardless of what task is running. + */ + set_tss_desc(cpu, &get_cpu_entry_area(cpu)->tss.x86_tss); + load_TR_desc(); ++ load_sp0((unsigned long)(cpu_entry_stack(cpu) + 1)); + + load_mm_ldt(&init_mm); + +diff --git a/arch/x86/kernel/process.c b/arch/x86/kernel/process.c +index cb368c2a22ab..7fab4fa7655d 100644 +--- a/arch/x86/kernel/process.c ++++ b/arch/x86/kernel/process.c +@@ -57,14 +57,12 @@ __visible DEFINE_PER_CPU_PAGE_ALIGNED(struct tss_struct, cpu_tss_rw) = { + */ + .sp0 = (1UL << (BITS_PER_LONG-1)) + 1, + +-#ifdef CONFIG_X86_64 + /* + * .sp1 is cpu_current_top_of_stack. The init task never + * runs user code, but cpu_current_top_of_stack should still + * be well defined before the first context switch. + */ + .sp1 = TOP_OF_INIT_STACK, +-#endif + + #ifdef CONFIG_X86_32 + .ss0 = __KERNEL_DS, +diff --git a/arch/x86/kernel/process_32.c b/arch/x86/kernel/process_32.c +index 097d36a64889..3f3a8c620c63 100644 +--- a/arch/x86/kernel/process_32.c ++++ b/arch/x86/kernel/process_32.c +@@ -289,10 +289,12 @@ __switch_to(struct task_struct *prev_p, struct task_struct *next_p) + */ + update_sp0(next_p); + refresh_sysenter_cs(next); +- this_cpu_write(cpu_current_top_of_stack, +- (unsigned long)task_stack_page(next_p) + +- THREAD_SIZE); +- /* SYSENTER reads the task-stack from tss.sp1 */ ++ this_cpu_write(cpu_current_top_of_stack, task_top_of_stack(next_p)); ++ /* ++ * TODO: Find a way to let cpu_current_top_of_stack point to ++ * cpu_tss_rw.x86_tss.sp1. Doing so now results in stack corruption with ++ * iret exceptions. ++ */ + this_cpu_write(cpu_tss_rw.x86_tss.sp1, next_p->thread.sp0); + + /* +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0009-x86-entry-32-Leave-the-kernel-via-trampoline-stack.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0009-x86-entry-32-Leave-the-kernel-via-trampoline-stack.patch new file mode 100644 index 00000000..9abb0d63 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0009-x86-entry-32-Leave-the-kernel-via-trampoline-stack.patch @@ -0,0 +1,96 @@ +From 4a06e416cfe4d173f8ed65799e112f77ecb12be8 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 11:28:30 +0100 +Subject: [PATCH 09/31] x86/entry/32: Leave the kernel via trampoline stack + +Switch back to the trampoline stack before returning to +userspace. + +Signed-off-by: Joerg Roedel +--- + arch/x86/entry/entry_32.S | 55 +++++++++++++++++++++++++++++++++++++++++++++++ + 1 file changed, 55 insertions(+) + +diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S +index e714b53b1eaa..ba3d8c2886ed 100644 +--- a/arch/x86/entry/entry_32.S ++++ b/arch/x86/entry/entry_32.S +@@ -338,6 +338,59 @@ + .endm + + /* ++ * Switch back from the kernel stack to the entry stack. ++ * ++ * The %esp register must point to pt_regs on the task stack. It will ++ * first calculate the size of the stack-frame to copy, depending on ++ * whether we return to VM86 mode or not. With that it uses 'rep movsb' ++ * to copy the contents of the stack over to the entry stack. ++ * ++ * We must be very careful here, as we can't trust the contents of the ++ * task-stack once we switched to the entry-stack. When an NMI happens ++ * while on the entry-stack, the NMI handler will switch back to the top ++ * of the task stack, overwriting our stack-frame we are about to copy. ++ * Therefore we switch the stack only after everything is copied over. ++ */ ++.macro SWITCH_TO_ENTRY_STACK ++ ++ ALTERNATIVE "", "jmp .Lend_\@", X86_FEATURE_XENPV ++ ++ /* Bytes to copy */ ++ movl $PTREGS_SIZE, %ecx ++ ++#ifdef CONFIG_VM86 ++ testl $(X86_EFLAGS_VM), PT_EFLAGS(%esp) ++ jz .Lcopy_pt_regs_\@ ++ ++ /* Additional 4 registers to copy when returning to VM86 mode */ ++ addl $(4 * 4), %ecx ++ ++.Lcopy_pt_regs_\@: ++#endif ++ ++ /* Initialize source and destination for movsb */ ++ movl PER_CPU_VAR(cpu_tss_rw + TSS_sp0), %edi ++ subl %ecx, %edi ++ movl %esp, %esi ++ ++ /* Save future stack pointer in %ebx */ ++ movl %edi, %ebx ++ ++ /* Copy over the stack-frame */ ++ cld ++ rep movsb ++ ++ /* ++ * Switch to entry-stack - needs to happen after everything is ++ * copied because the NMI handler will overwrite the task-stack ++ * when on entry-stack ++ */ ++ movl %ebx, %esp ++ ++.Lend_\@: ++.endm ++ ++/* + * %eax: prev task + * %edx: next task + */ +@@ -578,6 +631,7 @@ ENTRY(entry_SYSENTER_32) + + /* Opportunistic SYSEXIT */ + TRACE_IRQS_ON /* User mode traces as IRQs on. */ ++ SWITCH_TO_ENTRY_STACK /* Switch to per-cpu entry stack */ + movl PT_EIP(%esp), %edx /* pt_regs->ip */ + movl PT_OLDESP(%esp), %ecx /* pt_regs->sp */ + 1: mov PT_FS(%esp), %fs +@@ -665,6 +719,7 @@ ENTRY(entry_INT80_32) + + restore_all: + TRACE_IRQS_IRET ++ SWITCH_TO_ENTRY_STACK + .Lrestore_all_notrace: + CHECK_AND_APPLY_ESPFIX + .Lrestore_nocheck: +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0010-x86-entry-32-Introduce-SAVE_ALL_NMI-and-RESTORE_ALL_.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0010-x86-entry-32-Introduce-SAVE_ALL_NMI-and-RESTORE_ALL_.patch new file mode 100644 index 00000000..9d5b730e --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0010-x86-entry-32-Introduce-SAVE_ALL_NMI-and-RESTORE_ALL_.patch @@ -0,0 +1,84 @@ +From 26b38ec7dd2591f092eb359a5a59752d799ab60d Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Wed, 31 Jan 2018 16:35:42 +0100 +Subject: [PATCH 10/31] x86/entry/32: Introduce SAVE_ALL_NMI and + RESTORE_ALL_NMI + +These macros will be used in the NMI handler code and +replace plain SAVE_ALL and RESTORE_REGS there. We will add +the NMI-specific CR3-switch to these macros later. + +Signed-off-by: Joerg Roedel +--- + arch/x86/entry/entry_32.S | 23 +++++++++++++++++++---- + 1 file changed, 19 insertions(+), 4 deletions(-) + +diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S +index ba3d8c2886ed..be1d814bd056 100644 +--- a/arch/x86/entry/entry_32.S ++++ b/arch/x86/entry/entry_32.S +@@ -167,6 +167,9 @@ + + .endm + ++.macro SAVE_ALL_NMI ++ SAVE_ALL ++.endm + /* + * This is a sneaky trick to help the unwinder find pt_regs on the stack. The + * frame pointer is replaced with an encoded pointer to pt_regs. The encoding +@@ -224,6 +227,18 @@ + RESTORE_SKIP_SEGMENTS \pop + .endm + ++.macro RESTORE_ALL_NMI pop=0 ++ /* ++ * Restore segments - might cause exceptions when loading ++ * user-space segments ++ */ ++ RESTORE_SEGMENTS ++ ++ /* Restore integer registers and unwind stack to iret frame */ ++ RESTORE_INT_REGS ++ RESTORE_SKIP_SEGMENTS \pop ++.endm ++ + .macro CHECK_AND_APPLY_ESPFIX + #ifdef CONFIG_X86_ESPFIX32 + #define GDT_ESPFIX_SS PER_CPU_VAR(gdt_page) + (GDT_ENTRY_ESPFIX_SS * 8) +@@ -1127,7 +1142,7 @@ ENTRY(nmi) + #endif + + pushl %eax # pt_regs->orig_ax +- SAVE_ALL ++ SAVE_ALL_NMI + ENCODE_FRAME_POINTER + xorl %edx, %edx # zero error code + movl %esp, %eax # pt_regs pointer +@@ -1155,7 +1170,7 @@ ENTRY(nmi) + + .Lnmi_return: + CHECK_AND_APPLY_ESPFIX +- RESTORE_REGS 4 ++ RESTORE_ALL_NMI pop=4 + jmp .Lirq_return + + #ifdef CONFIG_X86_ESPFIX32 +@@ -1171,12 +1186,12 @@ ENTRY(nmi) + pushl 16(%esp) + .endr + pushl %eax +- SAVE_ALL ++ SAVE_ALL_NMI + ENCODE_FRAME_POINTER + FIXUP_ESPFIX_STACK # %eax == %esp + xorl %edx, %edx # zero error code + call do_nmi +- RESTORE_REGS ++ RESTORE_ALL_NMI + lss 12+4(%esp), %esp # back to espfix stack + jmp .Lirq_return + #endif +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0011-x86-entry-32-Add-PTI-cr3-switches-to-NMI-handler-cod.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0011-x86-entry-32-Add-PTI-cr3-switches-to-NMI-handler-cod.patch new file mode 100644 index 00000000..e4a8b057 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0011-x86-entry-32-Add-PTI-cr3-switches-to-NMI-handler-cod.patch @@ -0,0 +1,127 @@ +From d7f5719fe456d24dd01fdcc281aac44dacfa57b2 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Wed, 31 Jan 2018 16:58:57 +0100 +Subject: [PATCH 11/31] x86/entry/32: Add PTI cr3 switches to NMI handler code + +The NMI handler is special, as it needs to leave with the +same cr3 as it was entered with. We need to do this because +we could enter the NMI handler from kernel code with +user-cr3 already loaded. + +Signed-off-by: Joerg Roedel +--- + arch/x86/entry/entry_32.S | 52 +++++++++++++++++++++++++++++++++++++++++------ + 1 file changed, 46 insertions(+), 6 deletions(-) + +diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S +index be1d814bd056..9693485c901a 100644 +--- a/arch/x86/entry/entry_32.S ++++ b/arch/x86/entry/entry_32.S +@@ -77,6 +77,8 @@ + #endif + .endm + ++#define PTI_SWITCH_MASK (1 << PAGE_SHIFT) ++ + /* + * User gs save/restore + * +@@ -167,8 +169,30 @@ + + .endm + +-.macro SAVE_ALL_NMI ++.macro SAVE_ALL_NMI cr3_reg:req + SAVE_ALL ++ ++ /* ++ * Now switch the CR3 when PTI is enabled. ++ * ++ * We can enter with either user or kernel cr3, the code will ++ * store the old cr3 in \cr3_reg and switches to the kernel cr3 ++ * if necessary. ++ */ ++ ALTERNATIVE "jmp .Lend_\@", "", X86_FEATURE_PTI ++ ++ movl %cr3, \cr3_reg ++ testl $PTI_SWITCH_MASK, \cr3_reg ++ jz .Lend_\@ /* Already on kernel cr3 */ ++ ++ /* On user cr3 - write new kernel cr3 */ ++ andl $(~PTI_SWITCH_MASK), \cr3_reg ++ movl \cr3_reg, %cr3 ++ ++ /* Restore user cr3 value */ ++ orl $PTI_SWITCH_MASK, \cr3_reg ++ ++.Lend_\@: + .endm + /* + * This is a sneaky trick to help the unwinder find pt_regs on the stack. The +@@ -227,13 +251,29 @@ + RESTORE_SKIP_SEGMENTS \pop + .endm + +-.macro RESTORE_ALL_NMI pop=0 ++.macro RESTORE_ALL_NMI cr3_reg:req pop=0 + /* + * Restore segments - might cause exceptions when loading + * user-space segments + */ + RESTORE_SEGMENTS + ++ /* ++ * Now switch the CR3 when PTI is enabled. ++ * ++ * We enter with kernel cr3 and switch the cr3 to the value ++ * stored on \cr3_reg, which is either a user or a kernel cr3. ++ */ ++ ALTERNATIVE "jmp .Lswitched_\@", "", X86_FEATURE_PTI ++ ++ testl $PTI_SWITCH_MASK, \cr3_reg ++ jz .Lswitched_\@ ++ ++ /* User cr3 in \cr3_reg - write it to hardware cr3 */ ++ movl \cr3_reg, %cr3 ++ ++.Lswitched_\@: ++ + /* Restore integer registers and unwind stack to iret frame */ + RESTORE_INT_REGS + RESTORE_SKIP_SEGMENTS \pop +@@ -1142,7 +1182,7 @@ ENTRY(nmi) + #endif + + pushl %eax # pt_regs->orig_ax +- SAVE_ALL_NMI ++ SAVE_ALL_NMI cr3_reg=%edi + ENCODE_FRAME_POINTER + xorl %edx, %edx # zero error code + movl %esp, %eax # pt_regs pointer +@@ -1170,7 +1210,7 @@ ENTRY(nmi) + + .Lnmi_return: + CHECK_AND_APPLY_ESPFIX +- RESTORE_ALL_NMI pop=4 ++ RESTORE_ALL_NMI cr3_reg=%edi pop=4 + jmp .Lirq_return + + #ifdef CONFIG_X86_ESPFIX32 +@@ -1186,12 +1226,12 @@ ENTRY(nmi) + pushl 16(%esp) + .endr + pushl %eax +- SAVE_ALL_NMI ++ SAVE_ALL_NMI cr3_reg=%edi + ENCODE_FRAME_POINTER + FIXUP_ESPFIX_STACK # %eax == %esp + xorl %edx, %edx # zero error code + call do_nmi +- RESTORE_ALL_NMI ++ RESTORE_ALL_NMI cr3_reg=%edi + lss 12+4(%esp), %esp # back to espfix stack + jmp .Lirq_return + #endif +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0012-x86-entry-32-Add-PTI-cr3-switch-to-non-NMI-entry-exi.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0012-x86-entry-32-Add-PTI-cr3-switch-to-non-NMI-entry-exi.patch new file mode 100644 index 00000000..f572180a --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0012-x86-entry-32-Add-PTI-cr3-switch-to-non-NMI-entry-exi.patch @@ -0,0 +1,122 @@ +From 883518e6e2b618c2ee49ac822057712090784eda Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Wed, 31 Jan 2018 17:22:10 +0100 +Subject: [PATCH 12/31] x86/entry/32: Add PTI cr3 switch to non-NMI entry/exit + points + +Add unconditional cr3 switches between user and kernel cr3 +to all non-NMI entry and exit points. + +Signed-off-by: Joerg Roedel +--- + arch/x86/entry/entry_32.S | 59 ++++++++++++++++++++++++++++++++++++++++++++++- + 1 file changed, 58 insertions(+), 1 deletion(-) + +diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S +index 9693485c901a..b5ef00302316 100644 +--- a/arch/x86/entry/entry_32.S ++++ b/arch/x86/entry/entry_32.S +@@ -328,6 +328,25 @@ + #endif /* CONFIG_X86_ESPFIX32 */ + .endm + ++/* Unconditionally switch to user cr3 */ ++.macro SWITCH_TO_USER_CR3 scratch_reg:req ++ ALTERNATIVE "jmp .Lend_\@", "", X86_FEATURE_PTI ++ ++ movl %cr3, \scratch_reg ++ orl $PTI_SWITCH_MASK, \scratch_reg ++ movl \scratch_reg, %cr3 ++.Lend_\@: ++.endm ++ ++/* Unconditionally switch to kernel cr3 */ ++.macro SWITCH_TO_KERNEL_CR3 scratch_reg:req ++ ALTERNATIVE "jmp .Lend_\@", "", X86_FEATURE_PTI ++ movl %cr3, \scratch_reg ++ andl $(~PTI_SWITCH_MASK), \scratch_reg ++ movl \scratch_reg, %cr3 ++.Lend_\@: ++.endm ++ + + /* + * Called with pt_regs fully populated and kernel segments loaded, +@@ -343,6 +362,8 @@ + + ALTERNATIVE "", "jmp .Lend_\@", X86_FEATURE_XENPV + ++ SWITCH_TO_KERNEL_CR3 scratch_reg=%eax ++ + /* Are we on the entry stack? Bail out if not! */ + movl PER_CPU_VAR(cpu_entry_area), %edi + addl $CPU_ENTRY_AREA_entry_stack, %edi +@@ -637,6 +658,18 @@ ENTRY(xen_sysenter_target) + * 0(%ebp) arg6 + */ + ENTRY(entry_SYSENTER_32) ++ /* ++ * On entry-stack with all userspace-regs live - save and ++ * restore eflags and %eax to use it as scratch-reg for the cr3 ++ * switch. ++ */ ++ pushfl ++ pushl %eax ++ SWITCH_TO_KERNEL_CR3 scratch_reg=%eax ++ popl %eax ++ popfl ++ ++ /* Stack empty again, switch to task stack */ + movl TSS_entry_stack(%esp), %esp + + .Lsysenter_past_esp: +@@ -691,6 +724,10 @@ ENTRY(entry_SYSENTER_32) + movl PT_OLDESP(%esp), %ecx /* pt_regs->sp */ + 1: mov PT_FS(%esp), %fs + PTGS_TO_GS ++ ++ /* Segments are restored - switch to user cr3 */ ++ SWITCH_TO_USER_CR3 scratch_reg=%eax ++ + popl %ebx /* pt_regs->bx */ + addl $2*4, %esp /* skip pt_regs->cx and pt_regs->dx */ + popl %esi /* pt_regs->si */ +@@ -778,7 +815,23 @@ restore_all: + .Lrestore_all_notrace: + CHECK_AND_APPLY_ESPFIX + .Lrestore_nocheck: +- RESTORE_REGS 4 # skip orig_eax/error_code ++ /* ++ * First restore user segments. This can cause exceptions, so we ++ * run it with kernel cr3. ++ */ ++ RESTORE_SEGMENTS ++ ++ /* ++ * Segments are restored - no more exceptions from here on except on ++ * iret, but that handled safely. ++ */ ++ SWITCH_TO_USER_CR3 scratch_reg=%eax ++ ++ /* Restore rest */ ++ RESTORE_INT_REGS ++ ++ /* Unwind stack to the iret frame */ ++ RESTORE_SKIP_SEGMENTS 4 # skip orig_eax/error_code + .Lirq_return: + INTERRUPT_RETURN + +@@ -1139,6 +1192,10 @@ ENTRY(debug) + + SAVE_ALL + ENCODE_FRAME_POINTER ++ ++ /* Make sure we are running on kernel cr3 */ ++ SWITCH_TO_KERNEL_CR3 scratch_reg=%eax ++ + xorl %edx, %edx # error code 0 + movl %esp, %eax # pt_regs pointer + +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0013-x86-entry-32-Handle-Entry-from-Kernel-Mode-on-Entry-.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0013-x86-entry-32-Handle-Entry-from-Kernel-Mode-on-Entry-.patch new file mode 100644 index 00000000..5f9f0ae2 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0013-x86-entry-32-Handle-Entry-from-Kernel-Mode-on-Entry-.patch @@ -0,0 +1,197 @@ +From a98c3fa3166e37c6f66f5b7e221b9c0cf1455806 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Wed, 31 Jan 2018 20:48:02 +0100 +Subject: [PATCH 13/31] x86/entry/32: Handle Entry from Kernel-Mode on + Entry-Stack + +It can happen that we enter the kernel from kernel-mode and +on the entry-stack. The most common way this happens is when +we get an exception while loading the user-space segment +registers on the kernel-to-userspace exit path. + +The segment loading needs to be done after the entry-stack +switch, because the stack-switch needs kernel %fs for +per_cpu access. + +When this happens, we need to make sure that we leave the +kernel with the entry-stack again, so that the interrupted +code-path runs on the right stack when switching to the +user-cr3. + +We do this by detecting this condition on kernel-entry by +checking CS.RPL and %esp, and if it happens, we copy over +the complete content of the entry stack to the task-stack. +This needs to be done because once we enter the exception +handlers we might be scheduled out or even migrated to a +different CPU, so that we can't rely on the entry-stack +contents. We also leave a marker in the stack-frame to +detect this condition on the exit path. + +On the exit path the copy is reversed, we copy all of the +remaining task-stack back to the entry-stack and switch +to it. + +Signed-off-by: Joerg Roedel +--- + arch/x86/entry/entry_32.S | 109 +++++++++++++++++++++++++++++++++++++++++++++- + 1 file changed, 108 insertions(+), 1 deletion(-) + +diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S +index b5ef00302316..d94dab68b526 100644 +--- a/arch/x86/entry/entry_32.S ++++ b/arch/x86/entry/entry_32.S +@@ -358,6 +358,9 @@ + * copied there. So allocate the stack-frame on the task-stack and + * switch to it before we do any copying. + */ ++ ++#define CS_FROM_ENTRY_STACK (1 << 31) ++ + .macro SWITCH_TO_KERNEL_STACK + + ALTERNATIVE "", "jmp .Lend_\@", X86_FEATURE_XENPV +@@ -381,6 +384,10 @@ + /* Load top of task-stack into %edi */ + movl TSS_entry_stack(%edi), %edi + ++ /* Special case - entry from kernel mode via entry stack */ ++ testl $SEGMENT_RPL_MASK, PT_CS(%esp) ++ jz .Lentry_from_kernel_\@ ++ + /* Bytes to copy */ + movl $PTREGS_SIZE, %ecx + +@@ -394,8 +401,8 @@ + */ + addl $(4 * 4), %ecx + +-.Lcopy_pt_regs_\@: + #endif ++.Lcopy_pt_regs_\@: + + /* Allocate frame on task-stack */ + subl %ecx, %edi +@@ -410,6 +417,56 @@ + cld + rep movsb + ++ jmp .Lend_\@ ++ ++.Lentry_from_kernel_\@: ++ ++ /* ++ * This handles the case when we enter the kernel from ++ * kernel-mode and %esp points to the entry-stack. When this ++ * happens we need to switch to the task-stack to run C code, ++ * but switch back to the entry-stack again when we approach ++ * iret and return to the interrupted code-path. This usually ++ * happens when we hit an exception while restoring user-space ++ * segment registers on the way back to user-space. ++ * ++ * When we switch to the task-stack here, we can't trust the ++ * contents of the entry-stack anymore, as the exception handler ++ * might be scheduled out or moved to another CPU. Therefore we ++ * copy the complete entry-stack to the task-stack and set a ++ * marker in the iret-frame (bit 31 of the CS dword) to detect ++ * what we've done on the iret path. ++ * ++ * On the iret path we copy everything back and switch to the ++ * entry-stack, so that the interrupted kernel code-path ++ * continues on the same stack it was interrupted with. ++ * ++ * Be aware that an NMI can happen anytime in this code. ++ * ++ * %esi: Entry-Stack pointer (same as %esp) ++ * %edi: Top of the task stack ++ */ ++ ++ /* Calculate number of bytes on the entry stack in %ecx */ ++ movl %esi, %ecx ++ ++ /* %ecx to the top of entry-stack */ ++ andl $(MASK_entry_stack), %ecx ++ addl $(SIZEOF_entry_stack), %ecx ++ ++ /* Number of bytes on the entry stack to %ecx */ ++ sub %esi, %ecx ++ ++ /* Mark stackframe as coming from entry stack */ ++ orl $CS_FROM_ENTRY_STACK, PT_CS(%esp) ++ ++ /* ++ * %esi and %edi are unchanged, %ecx contains the number of ++ * bytes to copy. The code at .Lcopy_pt_regs_\@ will allocate ++ * the stack-frame on task-stack and copy everything over ++ */ ++ jmp .Lcopy_pt_regs_\@ ++ + .Lend_\@: + .endm + +@@ -467,6 +524,55 @@ + .endm + + /* ++ * This macro handles the case when we return to kernel-mode on the iret ++ * path and have to switch back to the entry stack. ++ * ++ * See the comments below the .Lentry_from_kernel_\@ label in the ++ * SWITCH_TO_KERNEL_STACK macro for more details. ++ */ ++.macro PARANOID_EXIT_TO_KERNEL_MODE ++ ++ /* ++ * Test if we entered the kernel with the entry-stack. Most ++ * likely we did not, because this code only runs on the ++ * return-to-kernel path. ++ */ ++ testl $CS_FROM_ENTRY_STACK, PT_CS(%esp) ++ jz .Lend_\@ ++ ++ /* Unlikely slow-path */ ++ ++ /* Clear marker from stack-frame */ ++ andl $(~CS_FROM_ENTRY_STACK), PT_CS(%esp) ++ ++ /* Copy the remaining task-stack contents to entry-stack */ ++ movl %esp, %esi ++ movl PER_CPU_VAR(cpu_tss_rw + TSS_sp0), %edi ++ ++ /* Bytes on the task-stack to ecx */ ++ movl PER_CPU_VAR(cpu_current_top_of_stack), %ecx ++ subl %esi, %ecx ++ ++ /* Allocate stack-frame on entry-stack */ ++ subl %ecx, %edi ++ ++ /* ++ * Save future stack-pointer, we must not switch until the ++ * copy is done, otherwise the NMI handler could destroy the ++ * contents of the task-stack we are about to copy. ++ */ ++ movl %edi, %ebx ++ ++ /* Do the copy */ ++ cld ++ rep movsb ++ ++ /* Safe to switch to entry-stack now */ ++ movl %ebx, %esp ++ ++.Lend_\@: ++.endm ++/* + * %eax: prev task + * %edx: next task + */ +@@ -837,6 +943,7 @@ restore_all: + + restore_all_kernel: + TRACE_IRQS_IRET ++ PARANOID_EXIT_TO_KERNEL_MODE + RESTORE_REGS 4 + jmp .Lirq_return + +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0014-x86-pgtable-pae-Unshare-kernel-PMDs-when-PTI-is-enab.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0014-x86-pgtable-pae-Unshare-kernel-PMDs-when-PTI-is-enab.patch new file mode 100644 index 00000000..2c1818b0 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0014-x86-pgtable-pae-Unshare-kernel-PMDs-when-PTI-is-enab.patch @@ -0,0 +1,35 @@ +From cc4fcd3fae72f6a72d9f275366b7165fa4ac3f71 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Fri, 2 Feb 2018 10:41:36 +0100 +Subject: [PATCH 14/31] x86/pgtable/pae: Unshare kernel PMDs when PTI is + enabled + +With PTI we need to map the per-process LDT into the kernel +address-space for each process, so we need separate kernel +PMDs per PGD. + +Signed-off-by: Joerg Roedel +--- + arch/x86/include/asm/pgtable-3level_types.h | 5 +++-- + 1 file changed, 3 insertions(+), 2 deletions(-) + +diff --git a/arch/x86/include/asm/pgtable-3level_types.h b/arch/x86/include/asm/pgtable-3level_types.h +index 876b4c77d983..ed8a200ecdaf 100644 +--- a/arch/x86/include/asm/pgtable-3level_types.h ++++ b/arch/x86/include/asm/pgtable-3level_types.h +@@ -21,9 +21,10 @@ typedef union { + #endif /* !__ASSEMBLY__ */ + + #ifdef CONFIG_PARAVIRT +-#define SHARED_KERNEL_PMD (pv_info.shared_kernel_pmd) ++#define SHARED_KERNEL_PMD ((!static_cpu_has(X86_FEATURE_PTI) && \ ++ (pv_info.shared_kernel_pmd))) + #else +-#define SHARED_KERNEL_PMD 1 ++#define SHARED_KERNEL_PMD (!static_cpu_has(X86_FEATURE_PTI)) + #endif + + /* +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0015-x86-pgtable-32-Allocate-8k-page-tables-when-PTI-is-e.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0015-x86-pgtable-32-Allocate-8k-page-tables-when-PTI-is-e.patch new file mode 100644 index 00000000..76ca7bad --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0015-x86-pgtable-32-Allocate-8k-page-tables-when-PTI-is-e.patch @@ -0,0 +1,98 @@ +From 5ea0338f46add135a70678a6eba2e402310e7b26 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 13:10:57 +0100 +Subject: [PATCH 15/31] x86/pgtable/32: Allocate 8k page-tables when PTI is + enabled + +Allocate a kernel and a user page-table root when PTI is +enabled. Also allocate a full page per root for PAE because +otherwise the bit to flip in cr3 to switch between them +would be non-constant, which creates a lot of hassle. +Keep that for a later optimization. + +Signed-off-by: Joerg Roedel +--- + arch/x86/kernel/head_32.S | 20 +++++++++++++++----- + arch/x86/mm/pgtable.c | 5 +++-- + 2 files changed, 18 insertions(+), 7 deletions(-) + +diff --git a/arch/x86/kernel/head_32.S b/arch/x86/kernel/head_32.S +index c29020907886..1f35d600b69f 100644 +--- a/arch/x86/kernel/head_32.S ++++ b/arch/x86/kernel/head_32.S +@@ -512,11 +512,18 @@ ENTRY(initial_code) + ENTRY(setup_once_ref) + .long setup_once + ++#ifdef CONFIG_PAGE_TABLE_ISOLATION ++#define PGD_ALIGN (2 * PAGE_SIZE) ++#define PTI_USER_PGD_FILL 1024 ++#else ++#define PGD_ALIGN (PAGE_SIZE) ++#define PTI_USER_PGD_FILL 0 ++#endif + /* + * BSS section + */ + __PAGE_ALIGNED_BSS +- .align PAGE_SIZE ++ .align PGD_ALIGN + #ifdef CONFIG_X86_PAE + .globl initial_pg_pmd + initial_pg_pmd: +@@ -526,14 +533,17 @@ initial_pg_pmd: + initial_page_table: + .fill 1024,4,0 + #endif ++ .align PGD_ALIGN + initial_pg_fixmap: + .fill 1024,4,0 +-.globl empty_zero_page +-empty_zero_page: +- .fill 4096,1,0 + .globl swapper_pg_dir ++ .align PGD_ALIGN + swapper_pg_dir: + .fill 1024,4,0 ++ .fill PTI_USER_PGD_FILL,4,0 ++.globl empty_zero_page ++empty_zero_page: ++ .fill 4096,1,0 + EXPORT_SYMBOL(empty_zero_page) + + /* +@@ -542,7 +552,7 @@ EXPORT_SYMBOL(empty_zero_page) + #ifdef CONFIG_X86_PAE + __PAGE_ALIGNED_DATA + /* Page-aligned for the benefit of paravirt? */ +- .align PAGE_SIZE ++ .align PGD_ALIGN + ENTRY(initial_page_table) + .long pa(initial_pg_pmd+PGD_IDENT_ATTR),0 /* low identity map */ + # if KPMDS == 3 +diff --git a/arch/x86/mm/pgtable.c b/arch/x86/mm/pgtable.c +index 004abf9ebf12..a81d42e48922 100644 +--- a/arch/x86/mm/pgtable.c ++++ b/arch/x86/mm/pgtable.c +@@ -338,7 +338,8 @@ static inline pgd_t *_pgd_alloc(void) + * We allocate one page for pgd. + */ + if (!SHARED_KERNEL_PMD) +- return (pgd_t *)__get_free_page(PGALLOC_GFP); ++ return (pgd_t *)__get_free_pages(PGALLOC_GFP, ++ PGD_ALLOCATION_ORDER); + + /* + * Now PAE kernel is not running as a Xen domain. We can allocate +@@ -350,7 +351,7 @@ static inline pgd_t *_pgd_alloc(void) + static inline void _pgd_free(pgd_t *pgd) + { + if (!SHARED_KERNEL_PMD) +- free_page((unsigned long)pgd); ++ free_pages((unsigned long)pgd, PGD_ALLOCATION_ORDER); + else + kmem_cache_free(pgd_cache, pgd); + } +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0016-x86-pgtable-Move-pgdp-kernel-user-conversion-functio.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0016-x86-pgtable-Move-pgdp-kernel-user-conversion-functio.patch new file mode 100644 index 00000000..31bf11b7 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0016-x86-pgtable-Move-pgdp-kernel-user-conversion-functio.patch @@ -0,0 +1,137 @@ +From eaacd465ad0f08807b151d2d27b0cad27b9de076 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 11:53:38 +0100 +Subject: [PATCH 16/31] x86/pgtable: Move pgdp kernel/user conversion functions + to pgtable.h + +Make them available on 32 bit and clone_pgd_range() happy. + +Signed-off-by: Joerg Roedel +--- + arch/x86/include/asm/pgtable.h | 49 +++++++++++++++++++++++++++++++++++++++ + arch/x86/include/asm/pgtable_64.h | 49 --------------------------------------- + 2 files changed, 49 insertions(+), 49 deletions(-) + +diff --git a/arch/x86/include/asm/pgtable.h b/arch/x86/include/asm/pgtable.h +index e42b8943cb1a..0a9f746cbdc1 100644 +--- a/arch/x86/include/asm/pgtable.h ++++ b/arch/x86/include/asm/pgtable.h +@@ -1109,6 +1109,55 @@ static inline int pud_write(pud_t pud) + return pud_flags(pud) & _PAGE_RW; + } + ++#ifdef CONFIG_PAGE_TABLE_ISOLATION ++/* ++ * All top-level PAGE_TABLE_ISOLATION page tables are order-1 pages ++ * (8k-aligned and 8k in size). The kernel one is at the beginning 4k and ++ * the user one is in the last 4k. To switch between them, you ++ * just need to flip the 12th bit in their addresses. ++ */ ++#define PTI_PGTABLE_SWITCH_BIT PAGE_SHIFT ++ ++/* ++ * This generates better code than the inline assembly in ++ * __set_bit(). ++ */ ++static inline void *ptr_set_bit(void *ptr, int bit) ++{ ++ unsigned long __ptr = (unsigned long)ptr; ++ ++ __ptr |= BIT(bit); ++ return (void *)__ptr; ++} ++static inline void *ptr_clear_bit(void *ptr, int bit) ++{ ++ unsigned long __ptr = (unsigned long)ptr; ++ ++ __ptr &= ~BIT(bit); ++ return (void *)__ptr; ++} ++ ++static inline pgd_t *kernel_to_user_pgdp(pgd_t *pgdp) ++{ ++ return ptr_set_bit(pgdp, PTI_PGTABLE_SWITCH_BIT); ++} ++ ++static inline pgd_t *user_to_kernel_pgdp(pgd_t *pgdp) ++{ ++ return ptr_clear_bit(pgdp, PTI_PGTABLE_SWITCH_BIT); ++} ++ ++static inline p4d_t *kernel_to_user_p4dp(p4d_t *p4dp) ++{ ++ return ptr_set_bit(p4dp, PTI_PGTABLE_SWITCH_BIT); ++} ++ ++static inline p4d_t *user_to_kernel_p4dp(p4d_t *p4dp) ++{ ++ return ptr_clear_bit(p4dp, PTI_PGTABLE_SWITCH_BIT); ++} ++#endif /* CONFIG_PAGE_TABLE_ISOLATION */ ++ + /* + * clone_pgd_range(pgd_t *dst, pgd_t *src, int count); + * +diff --git a/arch/x86/include/asm/pgtable_64.h b/arch/x86/include/asm/pgtable_64.h +index 81462e9a34f6..58d7f10e937d 100644 +--- a/arch/x86/include/asm/pgtable_64.h ++++ b/arch/x86/include/asm/pgtable_64.h +@@ -131,55 +131,6 @@ static inline pud_t native_pudp_get_and_clear(pud_t *xp) + #endif + } + +-#ifdef CONFIG_PAGE_TABLE_ISOLATION +-/* +- * All top-level PAGE_TABLE_ISOLATION page tables are order-1 pages +- * (8k-aligned and 8k in size). The kernel one is at the beginning 4k and +- * the user one is in the last 4k. To switch between them, you +- * just need to flip the 12th bit in their addresses. +- */ +-#define PTI_PGTABLE_SWITCH_BIT PAGE_SHIFT +- +-/* +- * This generates better code than the inline assembly in +- * __set_bit(). +- */ +-static inline void *ptr_set_bit(void *ptr, int bit) +-{ +- unsigned long __ptr = (unsigned long)ptr; +- +- __ptr |= BIT(bit); +- return (void *)__ptr; +-} +-static inline void *ptr_clear_bit(void *ptr, int bit) +-{ +- unsigned long __ptr = (unsigned long)ptr; +- +- __ptr &= ~BIT(bit); +- return (void *)__ptr; +-} +- +-static inline pgd_t *kernel_to_user_pgdp(pgd_t *pgdp) +-{ +- return ptr_set_bit(pgdp, PTI_PGTABLE_SWITCH_BIT); +-} +- +-static inline pgd_t *user_to_kernel_pgdp(pgd_t *pgdp) +-{ +- return ptr_clear_bit(pgdp, PTI_PGTABLE_SWITCH_BIT); +-} +- +-static inline p4d_t *kernel_to_user_p4dp(p4d_t *p4dp) +-{ +- return ptr_set_bit(p4dp, PTI_PGTABLE_SWITCH_BIT); +-} +- +-static inline p4d_t *user_to_kernel_p4dp(p4d_t *p4dp) +-{ +- return ptr_clear_bit(p4dp, PTI_PGTABLE_SWITCH_BIT); +-} +-#endif /* CONFIG_PAGE_TABLE_ISOLATION */ +- + /* + * Page table pages are page-aligned. The lower half of the top + * level is used for userspace and the top half for the kernel. +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0017-x86-pgtable-Move-pti_set_user_pgd-to-pgtable.h.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0017-x86-pgtable-Move-pti_set_user_pgd-to-pgtable.h.patch new file mode 100644 index 00000000..7d8f2eb1 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0017-x86-pgtable-Move-pti_set_user_pgd-to-pgtable.h.patch @@ -0,0 +1,84 @@ +From 82dd2440260533d518a810905c5492ba4f422a6f Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 15:50:39 +0100 +Subject: [PATCH 17/31] x86/pgtable: Move pti_set_user_pgd() to pgtable.h + +There it is also usable from 32 bit code. + +Signed-off-by: Joerg Roedel +--- + arch/x86/include/asm/pgtable.h | 23 +++++++++++++++++++++++ + arch/x86/include/asm/pgtable_64.h | 21 --------------------- + 2 files changed, 23 insertions(+), 21 deletions(-) + +diff --git a/arch/x86/include/asm/pgtable.h b/arch/x86/include/asm/pgtable.h +index 0a9f746cbdc1..c9d3cf9ce831 100644 +--- a/arch/x86/include/asm/pgtable.h ++++ b/arch/x86/include/asm/pgtable.h +@@ -618,8 +618,31 @@ static inline int is_new_memtype_allowed(u64 paddr, unsigned long size, + + pmd_t *populate_extra_pmd(unsigned long vaddr); + pte_t *populate_extra_pte(unsigned long vaddr); ++ ++#ifdef CONFIG_PAGE_TABLE_ISOLATION ++pgd_t __pti_set_user_pgd(pgd_t *pgdp, pgd_t pgd); ++ ++/* ++ * Take a PGD location (pgdp) and a pgd value that needs to be set there. ++ * Populates the user and returns the resulting PGD that must be set in ++ * the kernel copy of the page tables. ++ */ ++static inline pgd_t pti_set_user_pgd(pgd_t *pgdp, pgd_t pgd) ++{ ++ if (!static_cpu_has(X86_FEATURE_PTI)) ++ return pgd; ++ return __pti_set_user_pgd(pgdp, pgd); ++} ++#else /* CONFIG_PAGE_TABLE_ISOLATION */ ++static inline pgd_t pti_set_user_pgd(pgd_t *pgdp, pgd_t pgd) ++{ ++ return pgd; ++} ++#endif /* CONFIG_PAGE_TABLE_ISOLATION */ ++ + #endif /* __ASSEMBLY__ */ + ++ + #ifdef CONFIG_X86_32 + # include + #else +diff --git a/arch/x86/include/asm/pgtable_64.h b/arch/x86/include/asm/pgtable_64.h +index 58d7f10e937d..396664d95ac9 100644 +--- a/arch/x86/include/asm/pgtable_64.h ++++ b/arch/x86/include/asm/pgtable_64.h +@@ -145,27 +145,6 @@ static inline bool pgdp_maps_userspace(void *__ptr) + return (ptr & ~PAGE_MASK) < (PAGE_SIZE / 2); + } + +-#ifdef CONFIG_PAGE_TABLE_ISOLATION +-pgd_t __pti_set_user_pgd(pgd_t *pgdp, pgd_t pgd); +- +-/* +- * Take a PGD location (pgdp) and a pgd value that needs to be set there. +- * Populates the user and returns the resulting PGD that must be set in +- * the kernel copy of the page tables. +- */ +-static inline pgd_t pti_set_user_pgd(pgd_t *pgdp, pgd_t pgd) +-{ +- if (!static_cpu_has(X86_FEATURE_PTI)) +- return pgd; +- return __pti_set_user_pgd(pgdp, pgd); +-} +-#else +-static inline pgd_t pti_set_user_pgd(pgd_t *pgdp, pgd_t pgd) +-{ +- return pgd; +-} +-#endif +- + static inline void native_set_p4d(p4d_t *p4dp, p4d_t p4d) + { + #if defined(CONFIG_PAGE_TABLE_ISOLATION) && !defined(CONFIG_X86_5LEVEL) +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0018-x86-pgtable-Move-two-more-functions-from-pgtable_64..patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0018-x86-pgtable-Move-two-more-functions-from-pgtable_64..patch new file mode 100644 index 00000000..96040567 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0018-x86-pgtable-Move-two-more-functions-from-pgtable_64..patch @@ -0,0 +1,120 @@ +From 29023f0a7d98a96f2928c80ace36beffe5d28d41 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 12:48:14 +0100 +Subject: [PATCH 18/31] x86/pgtable: Move two more functions from pgtable_64.h + to pgtable.h + +These two functions are required for PTI on 32 bit: + + * pgdp_maps_userspace() + * pgd_large() + +Also re-implement pgdp_maps_userspace() so that it will work +on 64 and 32 bit kernels. + +Signed-off-by: Joerg Roedel +--- + arch/x86/include/asm/pgtable-2level_types.h | 3 +++ + arch/x86/include/asm/pgtable-3level_types.h | 1 + + arch/x86/include/asm/pgtable.h | 16 ++++++++++++++++ + arch/x86/include/asm/pgtable_64.h | 15 --------------- + arch/x86/include/asm/pgtable_64_types.h | 2 ++ + 5 files changed, 22 insertions(+), 15 deletions(-) + +diff --git a/arch/x86/include/asm/pgtable-2level_types.h b/arch/x86/include/asm/pgtable-2level_types.h +index f982ef808e7e..6deb6cd236e3 100644 +--- a/arch/x86/include/asm/pgtable-2level_types.h ++++ b/arch/x86/include/asm/pgtable-2level_types.h +@@ -35,4 +35,7 @@ typedef union { + + #define PTRS_PER_PTE 1024 + ++/* This covers all VMSPLIT_* and VMSPLIT_*_OPT variants */ ++#define PGD_KERNEL_START (CONFIG_PAGE_OFFSET >> PGDIR_SHIFT) ++ + #endif /* _ASM_X86_PGTABLE_2LEVEL_DEFS_H */ +diff --git a/arch/x86/include/asm/pgtable-3level_types.h b/arch/x86/include/asm/pgtable-3level_types.h +index ed8a200ecdaf..925ac1bc45cb 100644 +--- a/arch/x86/include/asm/pgtable-3level_types.h ++++ b/arch/x86/include/asm/pgtable-3level_types.h +@@ -45,5 +45,6 @@ typedef union { + */ + #define PTRS_PER_PTE 512 + ++#define PGD_KERNEL_START (CONFIG_PAGE_OFFSET >> PGDIR_SHIFT) + + #endif /* _ASM_X86_PGTABLE_3LEVEL_DEFS_H */ +diff --git a/arch/x86/include/asm/pgtable.h b/arch/x86/include/asm/pgtable.h +index c9d3cf9ce831..82151f602174 100644 +--- a/arch/x86/include/asm/pgtable.h ++++ b/arch/x86/include/asm/pgtable.h +@@ -1132,6 +1132,22 @@ static inline int pud_write(pud_t pud) + return pud_flags(pud) & _PAGE_RW; + } + ++/* ++ * Page table pages are page-aligned. The lower half of the top ++ * level is used for userspace and the top half for the kernel. ++ * ++ * Returns true for parts of the PGD that map userspace and ++ * false for the parts that map the kernel. ++ */ ++static inline bool pgdp_maps_userspace(void *__ptr) ++{ ++ unsigned long ptr = (unsigned long)__ptr; ++ ++ return (((ptr & ~PAGE_MASK) / sizeof(pgd_t)) < PGD_KERNEL_START); ++} ++ ++static inline int pgd_large(pgd_t pgd) { return 0; } ++ + #ifdef CONFIG_PAGE_TABLE_ISOLATION + /* + * All top-level PAGE_TABLE_ISOLATION page tables are order-1 pages +diff --git a/arch/x86/include/asm/pgtable_64.h b/arch/x86/include/asm/pgtable_64.h +index 396664d95ac9..50a02a32a0b3 100644 +--- a/arch/x86/include/asm/pgtable_64.h ++++ b/arch/x86/include/asm/pgtable_64.h +@@ -131,20 +131,6 @@ static inline pud_t native_pudp_get_and_clear(pud_t *xp) + #endif + } + +-/* +- * Page table pages are page-aligned. The lower half of the top +- * level is used for userspace and the top half for the kernel. +- * +- * Returns true for parts of the PGD that map userspace and +- * false for the parts that map the kernel. +- */ +-static inline bool pgdp_maps_userspace(void *__ptr) +-{ +- unsigned long ptr = (unsigned long)__ptr; +- +- return (ptr & ~PAGE_MASK) < (PAGE_SIZE / 2); +-} +- + static inline void native_set_p4d(p4d_t *p4dp, p4d_t p4d) + { + #if defined(CONFIG_PAGE_TABLE_ISOLATION) && !defined(CONFIG_X86_5LEVEL) +@@ -187,7 +173,6 @@ extern void sync_global_pgds(unsigned long start, unsigned long end); + /* + * Level 4 access. + */ +-static inline int pgd_large(pgd_t pgd) { return 0; } + #define mk_kernel_pgd(address) __pgd((address) | _KERNPG_TABLE) + + /* PUD - Level3 access */ +diff --git a/arch/x86/include/asm/pgtable_64_types.h b/arch/x86/include/asm/pgtable_64_types.h +index 6b8f73dcbc2c..e57003a3f58a 100644 +--- a/arch/x86/include/asm/pgtable_64_types.h ++++ b/arch/x86/include/asm/pgtable_64_types.h +@@ -124,4 +124,6 @@ typedef struct { pteval_t pte; } pte_t; + + #define EARLY_DYNAMIC_PAGE_TABLES 64 + ++#define PGD_KERNEL_START ((PAGE_SIZE / 2) / sizeof(pgd_t)) ++ + #endif /* _ASM_X86_PGTABLE_64_DEFS_H */ +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0019-x86-mm-pae-Populate-valid-user-PGD-entries.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0019-x86-mm-pae-Populate-valid-user-PGD-entries.patch new file mode 100644 index 00000000..4f94c0fe --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0019-x86-mm-pae-Populate-valid-user-PGD-entries.patch @@ -0,0 +1,71 @@ +From fbd7d587621cdf5c45fc32ae35e8cbec26387ed6 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 15:28:57 +0100 +Subject: [PATCH 19/31] x86/mm/pae: Populate valid user PGD entries + +Generic page-table code populates all non-leaf entries with +_KERNPG_TABLE bits set. This is fine for all paging modes +except PAE. + +In PAE mode only a subset of the bits is allowed to be set. +Make sure we only set allowed bits by masking out the +reserved bits. + +Signed-off-by: Joerg Roedel +--- + arch/x86/include/asm/pgtable_types.h | 26 ++++++++++++++++++++++++-- + 1 file changed, 24 insertions(+), 2 deletions(-) + +diff --git a/arch/x86/include/asm/pgtable_types.h b/arch/x86/include/asm/pgtable_types.h +index 3696398a9475..5027470f4f1c 100644 +--- a/arch/x86/include/asm/pgtable_types.h ++++ b/arch/x86/include/asm/pgtable_types.h +@@ -50,6 +50,7 @@ + #define _PAGE_GLOBAL (_AT(pteval_t, 1) << _PAGE_BIT_GLOBAL) + #define _PAGE_SOFTW1 (_AT(pteval_t, 1) << _PAGE_BIT_SOFTW1) + #define _PAGE_SOFTW2 (_AT(pteval_t, 1) << _PAGE_BIT_SOFTW2) ++#define _PAGE_SOFTW3 (_AT(pteval_t, 1) << _PAGE_BIT_SOFTW3) + #define _PAGE_PAT (_AT(pteval_t, 1) << _PAGE_BIT_PAT) + #define _PAGE_PAT_LARGE (_AT(pteval_t, 1) << _PAGE_BIT_PAT_LARGE) + #define _PAGE_SPECIAL (_AT(pteval_t, 1) << _PAGE_BIT_SPECIAL) +@@ -267,14 +268,35 @@ typedef struct pgprot { pgprotval_t pgprot; } pgprot_t; + + typedef struct { pgdval_t pgd; } pgd_t; + ++#ifdef CONFIG_X86_PAE ++ ++/* ++ * PHYSICAL_PAGE_MASK might be non-constant when SME is compiled in, so we can't ++ * use it here. ++ */ ++#define PGD_PAE_PHYS_MASK (((1ULL << __PHYSICAL_MASK_SHIFT)-1) & PAGE_MASK) ++ ++/* ++ * PAE allows Base Address, P, PWT, PCD and AVL bits to be set in PGD entries. ++ * All other bits are Reserved MBZ ++ */ ++#define PGD_ALLOWED_BITS (PGD_PAE_PHYS_MASK | _PAGE_PRESENT | \ ++ _PAGE_PWT | _PAGE_PCD | \ ++ _PAGE_SOFTW1 | _PAGE_SOFTW2 | _PAGE_SOFTW3 ) ++ ++#else ++/* No need to mask any bits for !PAE */ ++#define PGD_ALLOWED_BITS (~0ULL) ++#endif ++ + static inline pgd_t native_make_pgd(pgdval_t val) + { +- return (pgd_t) { val }; ++ return (pgd_t) { val & PGD_ALLOWED_BITS }; + } + + static inline pgdval_t native_pgd_val(pgd_t pgd) + { +- return pgd.pgd; ++ return pgd.pgd & PGD_ALLOWED_BITS; + } + + static inline pgdval_t pgd_flags(pgd_t pgd) +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0020-x86-mm-pae-Populate-the-user-page-table-with-user-pg.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0020-x86-mm-pae-Populate-the-user-page-table-with-user-pg.patch new file mode 100644 index 00000000..138b74f8 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0020-x86-mm-pae-Populate-the-user-page-table-with-user-pg.patch @@ -0,0 +1,42 @@ +From d20f4e476110d1af543b471f317dfc97bec54d7c Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 15:55:17 +0100 +Subject: [PATCH 20/31] x86/mm/pae: Populate the user page-table with user + pgd's + +When we populate a PGD entry, make sure we populate it in +the user page-table too. + +Signed-off-by: Joerg Roedel +--- + arch/x86/include/asm/pgtable-3level.h | 7 +++++++ + 1 file changed, 7 insertions(+) + +diff --git a/arch/x86/include/asm/pgtable-3level.h b/arch/x86/include/asm/pgtable-3level.h +index bc4af5453802..1a0661be1861 100644 +--- a/arch/x86/include/asm/pgtable-3level.h ++++ b/arch/x86/include/asm/pgtable-3level.h +@@ -98,6 +98,9 @@ static inline void native_set_pmd(pmd_t *pmdp, pmd_t pmd) + + static inline void native_set_pud(pud_t *pudp, pud_t pud) + { ++#ifdef CONFIG_PAGE_TABLE_ISOLATION ++ pud.p4d.pgd = pti_set_user_pgd(&pudp->p4d.pgd, pud.p4d.pgd); ++#endif + set_64bit((unsigned long long *)(pudp), native_pud_val(pud)); + } + +@@ -194,6 +197,10 @@ static inline pud_t native_pudp_get_and_clear(pud_t *pudp) + { + union split_pud res, *orig = (union split_pud *)pudp; + ++#ifdef CONFIG_PAGE_TABLE_ISOLATION ++ pti_set_user_pgd(&pudp->p4d.pgd, __pgd(0)); ++#endif ++ + /* xchg acts as a barrier before setting of the high bits */ + res.pud_low = xchg(&orig->pud_low, 0); + res.pud_high = orig->pud_high; +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0021-x86-mm-legacy-Populate-the-user-page-table-with-user.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0021-x86-mm-legacy-Populate-the-user-page-table-with-user.patch new file mode 100644 index 00000000..ebbafdb4 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0021-x86-mm-legacy-Populate-the-user-page-table-with-user.patch @@ -0,0 +1,50 @@ +From c7eb77959596dc4e78ef164f572520767df21fa3 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 16:29:13 +0100 +Subject: [PATCH 21/31] x86/mm/legacy: Populate the user page-table with user + pgd's + +Also populate the user-spage pgd's in the user page-table. + +Signed-off-by: Joerg Roedel +--- + arch/x86/include/asm/pgtable-2level.h | 9 +++++++++ + 1 file changed, 9 insertions(+) + +diff --git a/arch/x86/include/asm/pgtable-2level.h b/arch/x86/include/asm/pgtable-2level.h +index 685ffe8a0eaf..d77255451d7a 100644 +--- a/arch/x86/include/asm/pgtable-2level.h ++++ b/arch/x86/include/asm/pgtable-2level.h +@@ -19,6 +19,9 @@ static inline void native_set_pte(pte_t *ptep , pte_t pte) + + static inline void native_set_pmd(pmd_t *pmdp, pmd_t pmd) + { ++#ifdef CONFIG_PAGE_TABLE_ISOLATION ++ pmd.pud.p4d.pgd = pti_set_user_pgd(&pmdp->pud.p4d.pgd, pmd.pud.p4d.pgd); ++#endif + *pmdp = pmd; + } + +@@ -58,6 +61,9 @@ static inline pte_t native_ptep_get_and_clear(pte_t *xp) + #ifdef CONFIG_SMP + static inline pmd_t native_pmdp_get_and_clear(pmd_t *xp) + { ++#ifdef CONFIG_PAGE_TABLE_ISOLATION ++ pti_set_user_pgd(&xp->pud.p4d.pgd, __pgd(0)); ++#endif + return __pmd(xchg((pmdval_t *)xp, 0)); + } + #else +@@ -67,6 +73,9 @@ static inline pmd_t native_pmdp_get_and_clear(pmd_t *xp) + #ifdef CONFIG_SMP + static inline pud_t native_pudp_get_and_clear(pud_t *xp) + { ++#ifdef CONFIG_PAGE_TABLE_ISOLATION ++ pti_set_user_pgd(&xp->p4d.pgd, __pgd(0)); ++#endif + return __pud(xchg((pudval_t *)xp, 0)); + } + #else +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0022-x86-mm-pti-Add-an-overflow-check-to-pti_clone_pmds.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0022-x86-mm-pti-Add-an-overflow-check-to-pti_clone_pmds.patch new file mode 100644 index 00000000..364a540c --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0022-x86-mm-pti-Add-an-overflow-check-to-pti_clone_pmds.patch @@ -0,0 +1,33 @@ +From 9c0f3c2b70d61e768172c322343b8d049224f8bc Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 16:23:52 +0100 +Subject: [PATCH 22/31] x86/mm/pti: Add an overflow check to pti_clone_pmds() + +The addr counter will overflow if we clone the last PMD of +the address space, resulting in an endless loop. + +Check for that and bail out of the loop when it happens. + +Signed-off-by: Joerg Roedel +--- + arch/x86/mm/pti.c | 4 ++++ + 1 file changed, 4 insertions(+) + +diff --git a/arch/x86/mm/pti.c b/arch/x86/mm/pti.c +index ce38f165489b..7f5e698d127c 100644 +--- a/arch/x86/mm/pti.c ++++ b/arch/x86/mm/pti.c +@@ -282,6 +282,10 @@ pti_clone_pmds(unsigned long start, unsigned long end, pmdval_t clear) + p4d_t *p4d; + pud_t *pud; + ++ /* Overflow check */ ++ if (addr < start) ++ break; ++ + pgd = pgd_offset_k(addr); + if (WARN_ON(pgd_none(*pgd))) + return; +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0023-x86-mm-pti-Define-X86_CR3_PTI_PCID_USER_BIT-on-x86_3.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0023-x86-mm-pti-Define-X86_CR3_PTI_PCID_USER_BIT-on-x86_3.patch new file mode 100644 index 00000000..c6f7d44d --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0023-x86-mm-pti-Define-X86_CR3_PTI_PCID_USER_BIT-on-x86_3.patch @@ -0,0 +1,40 @@ +From a53c9f48916802bf66a66055537376dbe31716d1 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 11:35:19 +0100 +Subject: [PATCH 23/31] x86/mm/pti: Define X86_CR3_PTI_PCID_USER_BIT on x86_32 + +Move it out of the X86_64 specific processor defines so +that its visible for 32bit too. + +Signed-off-by: Joerg Roedel +--- + arch/x86/include/asm/processor-flags.h | 8 ++++---- + 1 file changed, 4 insertions(+), 4 deletions(-) + +diff --git a/arch/x86/include/asm/processor-flags.h b/arch/x86/include/asm/processor-flags.h +index 625a52a5594f..02c2cbda4a74 100644 +--- a/arch/x86/include/asm/processor-flags.h ++++ b/arch/x86/include/asm/processor-flags.h +@@ -39,10 +39,6 @@ + #define CR3_PCID_MASK 0xFFFull + #define CR3_NOFLUSH BIT_ULL(63) + +-#ifdef CONFIG_PAGE_TABLE_ISOLATION +-# define X86_CR3_PTI_PCID_USER_BIT 11 +-#endif +- + #else + /* + * CR3_ADDR_MASK needs at least bits 31:5 set on PAE systems, and we save +@@ -53,4 +49,8 @@ + #define CR3_NOFLUSH 0 + #endif + ++#ifdef CONFIG_PAGE_TABLE_ISOLATION ++# define X86_CR3_PTI_PCID_USER_BIT 11 ++#endif ++ + #endif /* _ASM_X86_PROCESSOR_FLAGS_H */ +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0024-x86-mm-pti-Clone-CPU_ENTRY_AREA-on-PMD-level-on-x86_.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0024-x86-mm-pti-Clone-CPU_ENTRY_AREA-on-PMD-level-on-x86_.patch new file mode 100644 index 00000000..f5d73505 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0024-x86-mm-pti-Clone-CPU_ENTRY_AREA-on-PMD-level-on-x86_.patch @@ -0,0 +1,56 @@ +From 56d5b738711fe0179293e1364d78763edfad55f3 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 14:13:04 +0100 +Subject: [PATCH 24/31] x86/mm/pti: Clone CPU_ENTRY_AREA on PMD level on x86_32 + +Cloning on the P4D level would clone the complete kernel +address space into the user-space page-tables for PAE +kernels. Cloning on PMD level is fine for PAE and legacy +paging. + +Signed-off-by: Joerg Roedel +--- + arch/x86/mm/pti.c | 20 ++++++++++++++++++++ + 1 file changed, 20 insertions(+) + +diff --git a/arch/x86/mm/pti.c b/arch/x86/mm/pti.c +index 7f5e698d127c..ec9852abc357 100644 +--- a/arch/x86/mm/pti.c ++++ b/arch/x86/mm/pti.c +@@ -312,6 +312,7 @@ pti_clone_pmds(unsigned long start, unsigned long end, pmdval_t clear) + } + } + ++#ifdef CONFIG_X86_64 + /* + * Clone a single p4d (i.e. a top-level entry on 4-level systems and a + * next-level entry on 5-level systems. +@@ -335,6 +336,25 @@ static void __init pti_clone_user_shared(void) + pti_clone_p4d(CPU_ENTRY_AREA_BASE); + } + ++#else /* CONFIG_X86_64 */ ++ ++/* ++ * On 32 bit PAE systems with 1GB of Kernel address space there is only ++ * one pgd/p4d for the whole kernel. Cloning that would map the whole ++ * address space into the user page-tables, making PTI useless. So clone ++ * the page-table on the PMD level to prevent that. ++ */ ++static void __init pti_clone_user_shared(void) ++{ ++ unsigned long start, end; ++ ++ start = CPU_ENTRY_AREA_BASE; ++ end = start + (PAGE_SIZE * CPU_ENTRY_AREA_PAGES); ++ ++ pti_clone_pmds(start, end, _PAGE_GLOBAL); ++} ++#endif /* CONFIG_X86_64 */ ++ + /* + * Clone the ESPFIX P4D into the user space visinble page table + */ +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0025-x86-mm-dump_pagetables-Define-INIT_PGD.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0025-x86-mm-dump_pagetables-Define-INIT_PGD.patch new file mode 100644 index 00000000..be3f674d --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0025-x86-mm-dump_pagetables-Define-INIT_PGD.patch @@ -0,0 +1,61 @@ +From 2d0143773e3f3e021b75fcdb886efd7cf2a4e8ce Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Thu, 8 Feb 2018 09:11:57 +0100 +Subject: [PATCH 25/31] x86/mm/dump_pagetables: Define INIT_PGD + +Define INIT_PGD to point to the correct initial page-table +for 32 and 64 bit and use it where needed. This fixes the +build on 32 bit with CONFIG_PAGE_TABLE_ISOLATION enabled. + +Signed-off-by: Joerg Roedel +--- + arch/x86/mm/dump_pagetables.c | 12 ++++++------ + 1 file changed, 6 insertions(+), 6 deletions(-) + +diff --git a/arch/x86/mm/dump_pagetables.c b/arch/x86/mm/dump_pagetables.c +index 2a4849e92831..2151ebb6a282 100644 +--- a/arch/x86/mm/dump_pagetables.c ++++ b/arch/x86/mm/dump_pagetables.c +@@ -105,6 +105,8 @@ static struct addr_marker address_markers[] = { + [END_OF_SPACE_NR] = { -1, NULL } + }; + ++#define INIT_PGD ((pgd_t *) &init_top_pgt) ++ + #else /* CONFIG_X86_64 */ + + enum address_markers_idx { +@@ -133,6 +135,8 @@ static struct addr_marker address_markers[] = { + [END_OF_SPACE_NR] = { -1, NULL } + }; + ++#define INIT_PGD (swapper_pg_dir) ++ + #endif /* !CONFIG_X86_64 */ + + /* Multipliers for offsets within the PTEs */ +@@ -478,11 +482,7 @@ static inline bool is_hypervisor_range(int idx) + static void ptdump_walk_pgd_level_core(struct seq_file *m, pgd_t *pgd, + bool checkwx, bool dmesg) + { +-#ifdef CONFIG_X86_64 +- pgd_t *start = (pgd_t *) &init_top_pgt; +-#else +- pgd_t *start = swapper_pg_dir; +-#endif ++ pgd_t *start = INIT_PGD; + pgprotval_t prot; + int i; + struct pg_state st = {}; +@@ -543,7 +543,7 @@ EXPORT_SYMBOL_GPL(ptdump_walk_pgd_level_debugfs); + static void ptdump_walk_user_pgd_level_checkwx(void) + { + #ifdef CONFIG_PAGE_TABLE_ISOLATION +- pgd_t *pgd = (pgd_t *) &init_top_pgt; ++ pgd_t *pgd = INIT_PGD; + + if (!static_cpu_has(X86_FEATURE_PTI)) + return; +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0026-x86-pgtable-pae-Use-separate-kernel-PMDs-for-user-pa.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0026-x86-pgtable-pae-Use-separate-kernel-PMDs-for-user-pa.patch new file mode 100644 index 00000000..ad8be5ea --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0026-x86-pgtable-pae-Use-separate-kernel-PMDs-for-user-pa.patch @@ -0,0 +1,213 @@ +From eccc6c5333bb7f33f88e7ec9a87f561bc5d63ccd Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Wed, 7 Feb 2018 15:37:52 +0100 +Subject: [PATCH 26/31] x86/pgtable/pae: Use separate kernel PMDs for user + page-table + +We need separate kernel PMDs in the user page-table when PTI +is enabled to map the per-process LDT for user-space. + +Signed-off-by: Joerg Roedel +--- + arch/x86/mm/pgtable.c | 100 ++++++++++++++++++++++++++++++++++++++++---------- + 1 file changed, 81 insertions(+), 19 deletions(-) + +diff --git a/arch/x86/mm/pgtable.c b/arch/x86/mm/pgtable.c +index a81d42e48922..d95bc7b1ffb4 100644 +--- a/arch/x86/mm/pgtable.c ++++ b/arch/x86/mm/pgtable.c +@@ -177,6 +177,14 @@ static void pgd_dtor(pgd_t *pgd) + */ + #define PREALLOCATED_PMDS UNSHARED_PTRS_PER_PGD + ++/* ++ * We allocate separate PMDs for the kernel part of the user page-table ++ * when PTI is enabled. We need them to map the per-process LDT into the ++ * user-space page-table. ++ */ ++#define PREALLOCATED_USER_PMDS (static_cpu_has(X86_FEATURE_PTI) ? \ ++ KERNEL_PGD_PTRS : 0) ++ + void pud_populate(struct mm_struct *mm, pud_t *pudp, pmd_t *pmd) + { + paravirt_alloc_pmd(mm, __pa(pmd) >> PAGE_SHIFT); +@@ -197,14 +205,14 @@ void pud_populate(struct mm_struct *mm, pud_t *pudp, pmd_t *pmd) + + /* No need to prepopulate any pagetable entries in non-PAE modes. */ + #define PREALLOCATED_PMDS 0 +- ++#define PREALLOCATED_USER_PMDS 0 + #endif /* CONFIG_X86_PAE */ + +-static void free_pmds(struct mm_struct *mm, pmd_t *pmds[]) ++static void free_pmds(struct mm_struct *mm, pmd_t *pmds[], int count) + { + int i; + +- for(i = 0; i < PREALLOCATED_PMDS; i++) ++ for(i = 0; i < count; i++) + if (pmds[i]) { + pgtable_pmd_page_dtor(virt_to_page(pmds[i])); + free_page((unsigned long)pmds[i]); +@@ -212,7 +220,7 @@ static void free_pmds(struct mm_struct *mm, pmd_t *pmds[]) + } + } + +-static int preallocate_pmds(struct mm_struct *mm, pmd_t *pmds[]) ++static int preallocate_pmds(struct mm_struct *mm, pmd_t *pmds[], int count) + { + int i; + bool failed = false; +@@ -221,7 +229,7 @@ static int preallocate_pmds(struct mm_struct *mm, pmd_t *pmds[]) + if (mm == &init_mm) + gfp &= ~__GFP_ACCOUNT; + +- for(i = 0; i < PREALLOCATED_PMDS; i++) { ++ for(i = 0; i < count; i++) { + pmd_t *pmd = (pmd_t *)__get_free_page(gfp); + if (!pmd) + failed = true; +@@ -236,7 +244,7 @@ static int preallocate_pmds(struct mm_struct *mm, pmd_t *pmds[]) + } + + if (failed) { +- free_pmds(mm, pmds); ++ free_pmds(mm, pmds, count); + return -ENOMEM; + } + +@@ -249,23 +257,38 @@ static int preallocate_pmds(struct mm_struct *mm, pmd_t *pmds[]) + * preallocate which never got a corresponding vma will need to be + * freed manually. + */ ++static void mop_up_one_pmd(struct mm_struct *mm, pgd_t *pgdp) ++{ ++ pgd_t pgd = *pgdp; ++ ++ if (pgd_val(pgd) != 0) { ++ pmd_t *pmd = (pmd_t *)pgd_page_vaddr(pgd); ++ ++ *pgdp = native_make_pgd(0); ++ ++ paravirt_release_pmd(pgd_val(pgd) >> PAGE_SHIFT); ++ pmd_free(mm, pmd); ++ mm_dec_nr_pmds(mm); ++ } ++} ++ + static void pgd_mop_up_pmds(struct mm_struct *mm, pgd_t *pgdp) + { + int i; + +- for(i = 0; i < PREALLOCATED_PMDS; i++) { +- pgd_t pgd = pgdp[i]; ++ for(i = 0; i < PREALLOCATED_PMDS; i++) ++ mop_up_one_pmd(mm, &pgdp[i]); + +- if (pgd_val(pgd) != 0) { +- pmd_t *pmd = (pmd_t *)pgd_page_vaddr(pgd); ++#ifdef CONFIG_PAGE_TABLE_ISOLATION + +- pgdp[i] = native_make_pgd(0); ++ if (!static_cpu_has(X86_FEATURE_PTI)) ++ return; + +- paravirt_release_pmd(pgd_val(pgd) >> PAGE_SHIFT); +- pmd_free(mm, pmd); +- mm_dec_nr_pmds(mm); +- } +- } ++ pgdp = kernel_to_user_pgdp(pgdp); ++ ++ for (i = 0; i < PREALLOCATED_USER_PMDS; i++) ++ mop_up_one_pmd(mm, &pgdp[i + KERNEL_PGD_BOUNDARY]); ++#endif + } + + static void pgd_prepopulate_pmd(struct mm_struct *mm, pgd_t *pgd, pmd_t *pmds[]) +@@ -291,6 +314,38 @@ static void pgd_prepopulate_pmd(struct mm_struct *mm, pgd_t *pgd, pmd_t *pmds[]) + } + } + ++#ifdef CONFIG_PAGE_TABLE_ISOLATION ++static void pgd_prepopulate_user_pmd(struct mm_struct *mm, ++ pgd_t *k_pgd, pmd_t *pmds[]) ++{ ++ pgd_t *s_pgd = kernel_to_user_pgdp(swapper_pg_dir); ++ pgd_t *u_pgd = kernel_to_user_pgdp(k_pgd); ++ p4d_t *u_p4d; ++ pud_t *u_pud; ++ int i; ++ ++ u_p4d = p4d_offset(u_pgd, 0); ++ u_pud = pud_offset(u_p4d, 0); ++ ++ s_pgd += KERNEL_PGD_BOUNDARY; ++ u_pud += KERNEL_PGD_BOUNDARY; ++ ++ for (i = 0; i < PREALLOCATED_USER_PMDS; i++, u_pud++, s_pgd++) { ++ pmd_t *pmd = pmds[i]; ++ ++ memcpy(pmd, (pmd_t *)pgd_page_vaddr(*s_pgd), ++ sizeof(pmd_t) * PTRS_PER_PMD); ++ ++ pud_populate(mm, u_pud, pmd); ++ } ++ ++} ++#else ++static void pgd_prepopulate_user_pmd(struct mm_struct *mm, ++ pgd_t *k_pgd, pmd_t *pmds[]) ++{ ++} ++#endif + /* + * Xen paravirt assumes pgd table should be in one page. 64 bit kernel also + * assumes that pgd should be in one page. +@@ -371,6 +426,7 @@ static inline void _pgd_free(pgd_t *pgd) + pgd_t *pgd_alloc(struct mm_struct *mm) + { + pgd_t *pgd; ++ pmd_t *u_pmds[PREALLOCATED_USER_PMDS]; + pmd_t *pmds[PREALLOCATED_PMDS]; + + pgd = _pgd_alloc(); +@@ -380,12 +436,15 @@ pgd_t *pgd_alloc(struct mm_struct *mm) + + mm->pgd = pgd; + +- if (preallocate_pmds(mm, pmds) != 0) ++ if (preallocate_pmds(mm, pmds, PREALLOCATED_PMDS) != 0) + goto out_free_pgd; + +- if (paravirt_pgd_alloc(mm) != 0) ++ if (preallocate_pmds(mm, u_pmds, PREALLOCATED_USER_PMDS) != 0) + goto out_free_pmds; + ++ if (paravirt_pgd_alloc(mm) != 0) ++ goto out_free_user_pmds; ++ + /* + * Make sure that pre-populating the pmds is atomic with + * respect to anything walking the pgd_list, so that they +@@ -395,13 +454,16 @@ pgd_t *pgd_alloc(struct mm_struct *mm) + + pgd_ctor(mm, pgd); + pgd_prepopulate_pmd(mm, pgd, pmds); ++ pgd_prepopulate_user_pmd(mm, pgd, u_pmds); + + spin_unlock(&pgd_lock); + + return pgd; + ++out_free_user_pmds: ++ free_pmds(mm, u_pmds, PREALLOCATED_USER_PMDS); + out_free_pmds: +- free_pmds(mm, pmds); ++ free_pmds(mm, pmds, PREALLOCATED_PMDS); + out_free_pgd: + _pgd_free(pgd); + out: +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0027-x86-ldt-Reserve-address-space-range-on-32-bit-for-th.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0027-x86-ldt-Reserve-address-space-range-on-32-bit-for-th.patch new file mode 100644 index 00000000..1ceb7ec0 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0027-x86-ldt-Reserve-address-space-range-on-32-bit-for-th.patch @@ -0,0 +1,75 @@ +From c07a31bb57363adb6f9d0def1d6b7a16b4a5c72c Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 12:40:07 +0100 +Subject: [PATCH 27/31] x86/ldt: Reserve address-space range on 32 bit for the + LDT + +Reserve 2MB/4MB of address-space for mapping the LDT to +user-space on 32 bit PTI kernels. + +Signed-off-by: Joerg Roedel +--- + arch/x86/include/asm/pgtable_32_types.h | 7 +++++-- + arch/x86/mm/dump_pagetables.c | 9 +++++++++ + 2 files changed, 14 insertions(+), 2 deletions(-) + +diff --git a/arch/x86/include/asm/pgtable_32_types.h b/arch/x86/include/asm/pgtable_32_types.h +index 0777e18a1d23..eb2e97afb27d 100644 +--- a/arch/x86/include/asm/pgtable_32_types.h ++++ b/arch/x86/include/asm/pgtable_32_types.h +@@ -48,13 +48,16 @@ extern bool __vmalloc_start_set; /* set once high_memory is set */ + ((FIXADDR_TOT_START - PAGE_SIZE * (CPU_ENTRY_AREA_PAGES + 1)) \ + & PMD_MASK) + +-#define PKMAP_BASE \ ++#define LDT_BASE_ADDR \ + ((CPU_ENTRY_AREA_BASE - PAGE_SIZE) & PMD_MASK) + ++#define PKMAP_BASE \ ++ ((LDT_BASE_ADDR - PAGE_SIZE) & PMD_MASK) ++ + #ifdef CONFIG_HIGHMEM + # define VMALLOC_END (PKMAP_BASE - 2 * PAGE_SIZE) + #else +-# define VMALLOC_END (CPU_ENTRY_AREA_BASE - 2 * PAGE_SIZE) ++# define VMALLOC_END (LDT_BASE_ADDR - 2 * PAGE_SIZE) + #endif + + #define MODULES_VADDR VMALLOC_START +diff --git a/arch/x86/mm/dump_pagetables.c b/arch/x86/mm/dump_pagetables.c +index 2151ebb6a282..fdefdf05739c 100644 +--- a/arch/x86/mm/dump_pagetables.c ++++ b/arch/x86/mm/dump_pagetables.c +@@ -117,6 +117,9 @@ enum address_markers_idx { + #ifdef CONFIG_HIGHMEM + PKMAP_BASE_NR, + #endif ++#ifdef CONFIG_MODIFY_LDT_SYSCALL ++ LDT_NR, ++#endif + CPU_ENTRY_AREA_NR, + FIXADDR_START_NR, + END_OF_SPACE_NR, +@@ -130,6 +133,9 @@ static struct addr_marker address_markers[] = { + #ifdef CONFIG_HIGHMEM + [PKMAP_BASE_NR] = { 0UL, "Persistent kmap() Area" }, + #endif ++#ifdef CONFIG_MODIFY_LDT_SYSCALL ++ [LDT_NR] = { 0UL, "LDT remap" }, ++#endif + [CPU_ENTRY_AREA_NR] = { 0UL, "CPU entry area" }, + [FIXADDR_START_NR] = { 0UL, "Fixmap area" }, + [END_OF_SPACE_NR] = { -1, NULL } +@@ -579,6 +585,9 @@ static int __init pt_dump_init(void) + # endif + address_markers[FIXADDR_START_NR].start_address = FIXADDR_START; + address_markers[CPU_ENTRY_AREA_NR].start_address = CPU_ENTRY_AREA_BASE; ++# ifdef CONFIG_MODIFY_LDT_SYSCALL ++ address_markers[LDT_NR].start_address = LDT_BASE_ADDR; ++# endif + #endif + return 0; + } +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0028-x86-ldt-Define-LDT_END_ADDR.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0028-x86-ldt-Define-LDT_END_ADDR.patch new file mode 100644 index 00000000..19f4dfd9 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0028-x86-ldt-Define-LDT_END_ADDR.patch @@ -0,0 +1,64 @@ +From 2b4c93fdb404c6155b1f7098895b93cde7b79550 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Wed, 7 Feb 2018 17:44:44 +0100 +Subject: [PATCH 28/31] x86/ldt: Define LDT_END_ADDR + +It marks the end of the address-space range reserved for the +LDT. The LDT-code will use it when unmapping the LDT for +user-space. + +Signed-off-by: Joerg Roedel +--- + arch/x86/include/asm/pgtable_32_types.h | 2 ++ + arch/x86/include/asm/pgtable_64_types.h | 2 ++ + arch/x86/kernel/ldt.c | 2 +- + 3 files changed, 5 insertions(+), 1 deletion(-) + +diff --git a/arch/x86/include/asm/pgtable_32_types.h b/arch/x86/include/asm/pgtable_32_types.h +index eb2e97afb27d..02bd445d1aee 100644 +--- a/arch/x86/include/asm/pgtable_32_types.h ++++ b/arch/x86/include/asm/pgtable_32_types.h +@@ -51,6 +51,8 @@ extern bool __vmalloc_start_set; /* set once high_memory is set */ + #define LDT_BASE_ADDR \ + ((CPU_ENTRY_AREA_BASE - PAGE_SIZE) & PMD_MASK) + ++#define LDT_END_ADDR (LDT_BASE_ADDR + PMD_SIZE) ++ + #define PKMAP_BASE \ + ((LDT_BASE_ADDR - PAGE_SIZE) & PMD_MASK) + +diff --git a/arch/x86/include/asm/pgtable_64_types.h b/arch/x86/include/asm/pgtable_64_types.h +index e57003a3f58a..15188baa7762 100644 +--- a/arch/x86/include/asm/pgtable_64_types.h ++++ b/arch/x86/include/asm/pgtable_64_types.h +@@ -90,12 +90,14 @@ typedef struct { pteval_t pte; } pte_t; + # define __VMEMMAP_BASE _AC(0xffd4000000000000, UL) + # define LDT_PGD_ENTRY _AC(-112, UL) + # define LDT_BASE_ADDR (LDT_PGD_ENTRY << PGDIR_SHIFT) ++#define LDT_END_ADDR (LDT_BASE_ADDR + PGDIR_SIZE) + #else + # define VMALLOC_SIZE_TB _AC(32, UL) + # define __VMALLOC_BASE _AC(0xffffc90000000000, UL) + # define __VMEMMAP_BASE _AC(0xffffea0000000000, UL) + # define LDT_PGD_ENTRY _AC(-3, UL) + # define LDT_BASE_ADDR (LDT_PGD_ENTRY << PGDIR_SHIFT) ++#define LDT_END_ADDR (LDT_BASE_ADDR + PGDIR_SIZE) + #endif + + #ifdef CONFIG_RANDOMIZE_MEMORY +diff --git a/arch/x86/kernel/ldt.c b/arch/x86/kernel/ldt.c +index 26d713ecad34..f3c2fbf3c458 100644 +--- a/arch/x86/kernel/ldt.c ++++ b/arch/x86/kernel/ldt.c +@@ -202,7 +202,7 @@ static void free_ldt_pgtables(struct mm_struct *mm) + #ifdef CONFIG_PAGE_TABLE_ISOLATION + struct mmu_gather tlb; + unsigned long start = LDT_BASE_ADDR; +- unsigned long end = start + (1UL << PGDIR_SHIFT); ++ unsigned long end = LDT_END_ADDR; + + if (!static_cpu_has(X86_FEATURE_PTI)) + return; +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0029-x86-ldt-Split-out-sanity-check-in-map_ldt_struct.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0029-x86-ldt-Split-out-sanity-check-in-map_ldt_struct.patch new file mode 100644 index 00000000..aad46d37 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0029-x86-ldt-Split-out-sanity-check-in-map_ldt_struct.patch @@ -0,0 +1,146 @@ +From 9a4c777654ebe02d30461d2a8a05de6fe4b987f0 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Wed, 7 Feb 2018 18:02:18 +0100 +Subject: [PATCH 29/31] x86/ldt: Split out sanity check in map_ldt_struct() + +This splits out the mapping sanity check and the actual +mapping of the LDT to user-space from the map_ldt_struct() +function in a way so that it is re-usable for PAE paging. + +Signed-off-by: Joerg Roedel +--- + arch/x86/kernel/ldt.c | 82 ++++++++++++++++++++++++++++++++++++--------------- + 1 file changed, 58 insertions(+), 24 deletions(-) + +diff --git a/arch/x86/kernel/ldt.c b/arch/x86/kernel/ldt.c +index f3c2fbf3c458..8ab7df99c868 100644 +--- a/arch/x86/kernel/ldt.c ++++ b/arch/x86/kernel/ldt.c +@@ -100,6 +100,49 @@ static struct ldt_struct *alloc_ldt_struct(unsigned int num_entries) + return new_ldt; + } + ++#ifdef CONFIG_PAGE_TABLE_ISOLATION ++ ++static void do_sanity_check(struct mm_struct *mm, ++ bool had_kernel_mapping, ++ bool had_user_mapping) ++{ ++ if (mm->context.ldt) { ++ /* ++ * We already had an LDT. The top-level entry should already ++ * have been allocated and synchronized with the usermode ++ * tables. ++ */ ++ WARN_ON(!had_kernel_mapping); ++ if (static_cpu_has(X86_FEATURE_PTI)) ++ WARN_ON(!had_user_mapping); ++ } else { ++ /* ++ * This is the first time we're mapping an LDT for this process. ++ * Sync the pgd to the usermode tables. ++ */ ++ WARN_ON(had_kernel_mapping); ++ if (static_cpu_has(X86_FEATURE_PTI)) ++ WARN_ON(had_user_mapping); ++ } ++} ++ ++static void map_ldt_struct_to_user(struct mm_struct *mm) ++{ ++ pgd_t *pgd = pgd_offset(mm, LDT_BASE_ADDR); ++ ++ if (static_cpu_has(X86_FEATURE_PTI) && !mm->context.ldt) ++ set_pgd(kernel_to_user_pgdp(pgd), *pgd); ++} ++ ++static void sanity_check_ldt_mapping(struct mm_struct *mm) ++{ ++ pgd_t *pgd = pgd_offset(mm, LDT_BASE_ADDR); ++ bool had_kernel = (pgd->pgd != 0); ++ bool had_user = (kernel_to_user_pgdp(pgd)->pgd != 0); ++ ++ do_sanity_check(mm, had_kernel, had_user); ++} ++ + /* + * If PTI is enabled, this maps the LDT into the kernelmode and + * usermode tables for the given mm. +@@ -115,9 +158,8 @@ static struct ldt_struct *alloc_ldt_struct(unsigned int num_entries) + static int + map_ldt_struct(struct mm_struct *mm, struct ldt_struct *ldt, int slot) + { +-#ifdef CONFIG_PAGE_TABLE_ISOLATION +- bool is_vmalloc, had_top_level_entry; + unsigned long va; ++ bool is_vmalloc; + spinlock_t *ptl; + pgd_t *pgd; + int i; +@@ -131,13 +173,15 @@ map_ldt_struct(struct mm_struct *mm, struct ldt_struct *ldt, int slot) + */ + WARN_ON(ldt->slot != -1); + ++ /* Check if the current mappings are sane */ ++ sanity_check_ldt_mapping(mm); ++ + /* + * Did we already have the top level entry allocated? We can't + * use pgd_none() for this because it doens't do anything on + * 4-level page table kernels. + */ + pgd = pgd_offset(mm, LDT_BASE_ADDR); +- had_top_level_entry = (pgd->pgd != 0); + + is_vmalloc = is_vmalloc_addr(ldt->entries); + +@@ -168,35 +212,25 @@ map_ldt_struct(struct mm_struct *mm, struct ldt_struct *ldt, int slot) + pte_unmap_unlock(ptep, ptl); + } + +- if (mm->context.ldt) { +- /* +- * We already had an LDT. The top-level entry should already +- * have been allocated and synchronized with the usermode +- * tables. +- */ +- WARN_ON(!had_top_level_entry); +- if (static_cpu_has(X86_FEATURE_PTI)) +- WARN_ON(!kernel_to_user_pgdp(pgd)->pgd); +- } else { +- /* +- * This is the first time we're mapping an LDT for this process. +- * Sync the pgd to the usermode tables. +- */ +- WARN_ON(had_top_level_entry); +- if (static_cpu_has(X86_FEATURE_PTI)) { +- WARN_ON(kernel_to_user_pgdp(pgd)->pgd); +- set_pgd(kernel_to_user_pgdp(pgd), *pgd); +- } +- } ++ /* Propagate LDT mapping to the user page-table */ ++ map_ldt_struct_to_user(mm); + + va = (unsigned long)ldt_slot_va(slot); + flush_tlb_mm_range(mm, va, va + LDT_SLOT_STRIDE, 0); + + ldt->slot = slot; +-#endif + return 0; + } + ++#else /* !CONFIG_PAGE_TABLE_ISOLATION */ ++ ++static int ++map_ldt_struct(struct mm_struct *mm, struct ldt_struct *ldt, int slot) ++{ ++ return 0; ++} ++#endif /* CONFIG_PAGE_TABLE_ISOLATION */ ++ + static void free_ldt_pgtables(struct mm_struct *mm) + { + #ifdef CONFIG_PAGE_TABLE_ISOLATION +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0030-x86-ldt-Enable-LDT-user-mapping-for-PAE.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0030-x86-ldt-Enable-LDT-user-mapping-for-PAE.patch new file mode 100644 index 00000000..2436cc5a --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0030-x86-ldt-Enable-LDT-user-mapping-for-PAE.patch @@ -0,0 +1,107 @@ +From 94b5cc7e833ec2b9427fa42f8de203f2f4c98bc5 Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Wed, 7 Feb 2018 18:11:54 +0100 +Subject: [PATCH 30/31] x86/ldt: Enable LDT user-mapping for PAE + +This adds the needed special case for PAE to get the LDT +mapped into the user page-table when PTI is enabled. The big +difference to the other paging modes is that we don't have a +full top-level PGD entry available for the LDT, but only PMD +entry. + +Signed-off-by: Joerg Roedel +--- + arch/x86/include/asm/mmu_context.h | 4 --- + arch/x86/kernel/ldt.c | 53 ++++++++++++++++++++++++++++++++++++++ + 2 files changed, 53 insertions(+), 4 deletions(-) + +diff --git a/arch/x86/include/asm/mmu_context.h b/arch/x86/include/asm/mmu_context.h +index c931b88982a0..af96cfb2ab13 100644 +--- a/arch/x86/include/asm/mmu_context.h ++++ b/arch/x86/include/asm/mmu_context.h +@@ -70,11 +70,7 @@ struct ldt_struct { + + static inline void *ldt_slot_va(int slot) + { +-#ifdef CONFIG_X86_64 + return (void *)(LDT_BASE_ADDR + LDT_SLOT_STRIDE * slot); +-#else +- BUG(); +-#endif + } + + /* +diff --git a/arch/x86/kernel/ldt.c b/arch/x86/kernel/ldt.c +index 8ab7df99c868..778745199d96 100644 +--- a/arch/x86/kernel/ldt.c ++++ b/arch/x86/kernel/ldt.c +@@ -126,6 +126,57 @@ static void do_sanity_check(struct mm_struct *mm, + } + } + ++#ifdef CONFIG_X86_PAE ++ ++static pmd_t *pgd_to_pmd_walk(pgd_t *pgd, unsigned long va) ++{ ++ p4d_t *p4d; ++ pud_t *pud; ++ ++ if (pgd->pgd == 0) ++ return NULL; ++ ++ p4d = p4d_offset(pgd, va); ++ if (p4d_none(*p4d)) ++ return NULL; ++ ++ pud = pud_offset(p4d, va); ++ if (pud_none(*pud)) ++ return NULL; ++ ++ return pmd_offset(pud, va); ++} ++ ++static void map_ldt_struct_to_user(struct mm_struct *mm) ++{ ++ pgd_t *k_pgd = pgd_offset(mm, LDT_BASE_ADDR); ++ pgd_t *u_pgd = kernel_to_user_pgdp(k_pgd); ++ pmd_t *k_pmd, *u_pmd; ++ ++ k_pmd = pgd_to_pmd_walk(k_pgd, LDT_BASE_ADDR); ++ u_pmd = pgd_to_pmd_walk(u_pgd, LDT_BASE_ADDR); ++ ++ if (static_cpu_has(X86_FEATURE_PTI) && !mm->context.ldt) ++ set_pmd(u_pmd, *k_pmd); ++} ++ ++static void sanity_check_ldt_mapping(struct mm_struct *mm) ++{ ++ pgd_t *k_pgd = pgd_offset(mm, LDT_BASE_ADDR); ++ pgd_t *u_pgd = kernel_to_user_pgdp(k_pgd); ++ bool had_kernel, had_user; ++ pmd_t *k_pmd, *u_pmd; ++ ++ k_pmd = pgd_to_pmd_walk(k_pgd, LDT_BASE_ADDR); ++ u_pmd = pgd_to_pmd_walk(u_pgd, LDT_BASE_ADDR); ++ had_kernel = (k_pmd->pmd != 0); ++ had_user = (u_pmd->pmd != 0); ++ ++ do_sanity_check(mm, had_kernel, had_user); ++} ++ ++#else /* !CONFIG_X86_PAE */ ++ + static void map_ldt_struct_to_user(struct mm_struct *mm) + { + pgd_t *pgd = pgd_offset(mm, LDT_BASE_ADDR); +@@ -143,6 +194,8 @@ static void sanity_check_ldt_mapping(struct mm_struct *mm) + do_sanity_check(mm, had_kernel, had_user); + } + ++#endif /* CONFIG_X86_PAE */ ++ + /* + * If PTI is enabled, this maps the LDT into the kernelmode and + * usermode tables for the given mm. +-- +2.13.6 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0031-x86-pti-Allow-CONFIG_PAGE_TABLE_ISOLATION-for-x86_32.patch b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0031-x86-pti-Allow-CONFIG_PAGE_TABLE_ISOLATION-for-x86_32.patch new file mode 100644 index 00000000..53ee21fc --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/pti32bit-0031-x86-pti-Allow-CONFIG_PAGE_TABLE_ISOLATION-for-x86_32.patch @@ -0,0 +1,25 @@ +From dbb0074f778b396a11e0c897fef9d0c4583e7ccb Mon Sep 17 00:00:00 2001 +From: Joerg Roedel +Date: Tue, 16 Jan 2018 11:33:01 +0100 +Subject: [PATCH 31/31] x86/pti: Allow CONFIG_PAGE_TABLE_ISOLATION for x86_32 + +Allow PTI to be compiled on x86_32. + +Signed-off-by: Joerg Roedel +--- + security/Kconfig | 2 +- + 1 file changed, 1 insertion(+), 1 deletion(-) + +diff --git a/security/Kconfig b/security/Kconfig +index b0cb9a5f9448..93d85fda0f54 100644 +--- a/security/Kconfig ++++ b/security/Kconfig +@@ -56,7 +56,7 @@ config SECURITY_NETWORK + + config PAGE_TABLE_ISOLATION + bool "Remove the kernel mapping in user mode" +- depends on X86_64 && !UML ++ depends on X86 && !UML + default y + help + This feature reduces the number of hardware side channels by diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sched-topology-Introduce-NUMA-identity-node-sched-domain.patch b/kernel/tools/cpupowertools/files/patches/mageia/sched-topology-Introduce-NUMA-identity-node-sched-domain.patch new file mode 100644 index 00000000..2db23c18 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/sched-topology-Introduce-NUMA-identity-node-sched-domain.patch @@ -0,0 +1,123 @@ +From 051f3ca02e46432c0965e8948f00c07d8a2f09c0 Mon Sep 17 00:00:00 2001 +From: Suravee Suthikulpanit +Date: Thu, 7 Sep 2017 02:20:05 -0500 +Subject: sched/topology: Introduce NUMA identity node sched domain + +On AMD Family17h-based (EPYC) system, a logical NUMA node can contain +upto 8 cores (16 threads) with the following topology. + + ---------------------------- + C0 | T0 T1 | || | T0 T1 | C4 + --------| || |-------- + C1 | T0 T1 | L3 || L3 | T0 T1 | C5 + --------| || |-------- + C2 | T0 T1 | #0 || #1 | T0 T1 | C6 + --------| || |-------- + C3 | T0 T1 | || | T0 T1 | C7 + ---------------------------- + +Here, there are 2 last-level (L3) caches per logical NUMA node. +A socket can contain upto 4 NUMA nodes, and a system can support +upto 2 sockets. With full system configuration, current scheduler +creates 4 sched domains: + + domain0 SMT (span a core) + domain1 MC (span a last-level-cache) + domain2 NUMA (span a socket: 4 nodes) + domain3 NUMA (span a system: 8 nodes) + +Note that there is no domain to represent cpus spaning a logical +NUMA node. With this hierarchy of sched domains, the scheduler does +not balance properly in the following cases: + +Case1: + + When running 8 tasks, a properly balanced system should + schedule a task per logical NUMA node. This is not the case for + the current scheduler. + +Case2: + + In some cases, threads are scheduled on the same cpu, while other + cpus are idle. This results in run-to-run inconsistency. For example: + + taskset -c 0-7 sysbench --num-threads=8 --test=cpu \ + --cpu-max-prime=100000 run + +Total execution time ranges from 25.1s to 33.5s depending on threads +placement, where 25.1s is when all 8 threads are balanced properly +on 8 cpus. + +Introducing NUMA identity node sched domain, which is based on how +SRAT/SLIT table define a logical NUMA node. This results in the following +hierarchy of sched domains on the same system described above. + + domain0 SMT (span a core) + domain1 MC (span a last-level-cache) + domain2 NODE (span a logical NUMA node) + domain3 NUMA (span a socket: 4 nodes) + domain4 NUMA (span a system: 8 nodes) + +This fixes the improper load balancing cases mentioned above. + +Signed-off-by: Suravee Suthikulpanit +Signed-off-by: Peter Zijlstra (Intel) +Cc: Linus Torvalds +Cc: Mike Galbraith +Cc: Peter Zijlstra +Cc: Thomas Gleixner +Cc: bp@suse.de +Link: http://lkml.kernel.org/r/1504768805-46716-1-git-send-email-suravee.suthikulpanit@amd.com +Signed-off-by: Ingo Molnar +--- + kernel/sched/topology.c | 18 +++++++++++++++--- + 1 file changed, 15 insertions(+), 3 deletions(-) + +diff --git a/kernel/sched/topology.c b/kernel/sched/topology.c +index 86e81f06..f51d123 100644 +--- a/kernel/sched/topology.c ++++ b/kernel/sched/topology.c +@@ -1332,6 +1332,10 @@ void sched_init_numa(void) + if (!sched_domains_numa_distance) + return; + ++ /* Includes NUMA identity node at level 0. */ ++ sched_domains_numa_distance[level++] = curr_distance; ++ sched_domains_numa_levels = level; ++ + /* + * O(nr_nodes^2) deduplicating selection sort -- in order to find the + * unique distances in the node_distance() table. +@@ -1379,8 +1383,7 @@ void sched_init_numa(void) + return; + + /* +- * 'level' contains the number of unique distances, excluding the +- * identity distance node_distance(i,i). ++ * 'level' contains the number of unique distances + * + * The sched_domains_numa_distance[] array includes the actual distance + * numbers. +@@ -1442,9 +1445,18 @@ void sched_init_numa(void) + tl[i] = sched_domain_topology[i]; + + /* ++ * Add the NUMA identity distance, aka single NODE. ++ */ ++ tl[i++] = (struct sched_domain_topology_level){ ++ .mask = sd_numa_mask, ++ .numa_level = 0, ++ SD_INIT_NAME(NODE) ++ }; ++ ++ /* + * .. and append 'j' levels of NUMA goodness. + */ +- for (j = 0; j < level; i++, j++) { ++ for (j = 1; j < level; i++, j++) { + tl[i] = (struct sched_domain_topology_level){ + .mask = sd_numa_mask, + .sd_flags = cpu_numa_flags, +-- +cgit v1.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/series b/kernel/tools/cpupowertools/files/patches/mageia/series index b977f0a7..f2118064 100644 --- a/kernel/tools/cpupowertools/files/patches/mageia/series +++ b/kernel/tools/cpupowertools/files/patches/mageia/series @@ -38,13 +38,55 @@ x86-increase-default-minimum-vmalloc-area-by-64MB-to-192MB.patch # slows down boot Revert-cpufreq-pcc-Enable-autoload-of-pcc-cpufreq-fo.patch +# Meltdown 32bit +pti32bit-0001-x86-asm-offsets-Move-TSS_sp0-and-TSS_sp1-to-asm-offs.patch +pti32bit-0002-x86-entry-32-Rename-TSS_sysenter_sp0-to-TSS_entry_st.patch +pti32bit-0003-x86-entry-32-Load-task-stack-from-x86_tss.sp1-in-SYS.patch +pti32bit-0004-x86-entry-32-Put-ESPFIX-code-into-a-macro.patch +pti32bit-0005-x86-entry-32-Unshare-NMI-return-path.patch +pti32bit-0006-x86-entry-32-Split-off-return-to-kernel-path.patch +pti32bit-0007-x86-entry-32-Restore-segments-before-int-registers.patch +pti32bit-0008-x86-entry-32-Enter-the-kernel-via-trampoline-stack.patch +pti32bit-0009-x86-entry-32-Leave-the-kernel-via-trampoline-stack.patch +pti32bit-0010-x86-entry-32-Introduce-SAVE_ALL_NMI-and-RESTORE_ALL_.patch +pti32bit-0011-x86-entry-32-Add-PTI-cr3-switches-to-NMI-handler-cod.patch +pti32bit-0012-x86-entry-32-Add-PTI-cr3-switch-to-non-NMI-entry-exi.patch +pti32bit-0013-x86-entry-32-Handle-Entry-from-Kernel-Mode-on-Entry-.patch +pti32bit-0014-x86-pgtable-pae-Unshare-kernel-PMDs-when-PTI-is-enab.patch +pti32bit-0015-x86-pgtable-32-Allocate-8k-page-tables-when-PTI-is-e.patch +pti32bit-0016-x86-pgtable-Move-pgdp-kernel-user-conversion-functio.patch +pti32bit-0017-x86-pgtable-Move-pti_set_user_pgd-to-pgtable.h.patch +pti32bit-0018-x86-pgtable-Move-two-more-functions-from-pgtable_64..patch +pti32bit-0019-x86-mm-pae-Populate-valid-user-PGD-entries.patch +pti32bit-0020-x86-mm-pae-Populate-the-user-page-table-with-user-pg.patch +pti32bit-0021-x86-mm-legacy-Populate-the-user-page-table-with-user.patch +pti32bit-0022-x86-mm-pti-Add-an-overflow-check-to-pti_clone_pmds.patch +pti32bit-0023-x86-mm-pti-Define-X86_CR3_PTI_PCID_USER_BIT-on-x86_3.patch +pti32bit-0024-x86-mm-pti-Clone-CPU_ENTRY_AREA-on-PMD-level-on-x86_.patch +pti32bit-0025-x86-mm-dump_pagetables-Define-INIT_PGD.patch +pti32bit-0026-x86-pgtable-pae-Use-separate-kernel-PMDs-for-user-pa.patch +pti32bit-0027-x86-ldt-Reserve-address-space-range-on-32-bit-for-th.patch +pti32bit-0028-x86-ldt-Define-LDT_END_ADDR.patch +pti32bit-0029-x86-ldt-Split-out-sanity-check-in-map_ldt_struct.patch +pti32bit-0030-x86-ldt-Enable-LDT-user-mapping-for-PAE.patch +pti32bit-0031-x86-pti-Allow-CONFIG_PAGE_TABLE_ISOLATION-for-x86_32.patch + +# selected fixes from x86/pti +x86-pti-0070-nospec-Kill-array_index_nospec_mask_check.patch +x86-pti-0071-nospec-Allow-index-argument-to-have-const-qualified-.patch +x86-pti-0072-nospec-Include-asm-barrier.h-dependency.patch +x86-pti-0073-x86-microcode-Propagate-return-value-from-updating-f.patch +x86-pti-0074-x86-CPU-Add-a-microcode-loader-callback.patch +x86-pti-0075-x86-CPU-Check-CPU-feature-bits-after-microcode-upgra.patch +x86-pti-0076-x86-entry-Reduce-the-code-footprint-of-the-idtentry-.patch +x86-pti-0077-x86-entry-64-Use-xorl-for-faster-register-clearing.patch + ### ### Core ### -base-cacheinfo-silence-DT-warnings.patch -# fixes crash on boot on some Amd systems -iommu-amd-flush-IOTLB-for-specific-domains-only-v3.patch +# Improved NUMA scheduling on AMD EPYC +sched-topology-Introduce-NUMA-identity-node-sched-domain.patch ### ### i2c @@ -60,9 +102,6 @@ iommu-amd-flush-IOTLB-for-specific-domains-only-v3.patch pci-add-ALI-M5229-ide-compatibility-mode-quirk.patch pci-quirks-drop-devinit-exit.patch -# Stoney iommu hang -pci-Blacklist-AMD-Stoney-GPU-devices-for-ATS.patch - ### ### PNP core ### @@ -80,11 +119,8 @@ acpi-processor-M720SR-limit-to-C2.patch # backlight fixes ACPI-video-Add-a-quirk-to-force-acpi-video-backlight.patch -# drop obsolete warn -acpi-do-not-warn-if-_BQC-does-not-exist.patch - -# silence useless acpi warnings -acpi-ACPICA-Events-Fix-acpi_ev_initialize_region-return-v.patch +# fixes resume on atleast Thinkpad X240 +acpi-ec-restore-polling-during-noirq-suspend_resume-phases.patch ### ### Block @@ -125,47 +161,47 @@ block-floppy-disable-pnp-modalias.patch # prefer ata over ide drivers ata-prefer-ata-drivers-over-ide-drivers-when-both-are-built.patch -# Nice SSD speedup -block-Make-CFQ-default-to-IOPS-mode-on-SSDs.patch - -# Include new BFQ I/O scheduler -# (See http://algo.ing.unimo.it/people/paolo/disk_sched) -block-cgroups-kconfig-build-bits-for-BFQ-v7r11-4.5.0.patch -block-introduce-the-BFQ-v7r11-I-O-sched-for-4.5.0.patch -block-bfq-add-Early-Queue-Merge-EQM-to-BFQ-v7r11-for.patch -block-Turn-into-BFQ-v8r7-for-4.9.0.patch -block-update-bfq-from-v8r7-to-v8r10.patch -block-update-bfq-from-v8r10-to-v8r11.patch - -# new macbooks -block-nvme-detect-NVMe-controller-in-recent-MacBooks.patch +# bfq performance updates +doc-block-bfq-update-max-IOPS-sustainable-with-BFQ.patch +block-bfq-fix-wrong-init-of-saved-start-time-for-wei.patch +block-bfq-check-and-switch-back-to-interactive-wr-al.patch +block-bfq-let-early-merged-queues-be-weight-raised-o.patch +block-bfq-decrease-burst-size-when-queues-in-burst-e.patch +block-bfq-fix-unbalanced-decrements-of-burst-size.patch +block-bfq-add-missing-invocations-of-bfqg_stats_upda.patch +block-bfq-update-blkio-stats-outside-the-scheduler-l.patch +block-bfq-move-debug-blkio-stats-behind-CONFIG_DEBUG.patch +block-bfq-increase-threshold-to-deem-I-O-as-random.patch +block-bfq-add-missing-rq_pos_tree-update-on-rq-remov.patch +block-bfq-check-low_latency-flag-in-bfq_bfqq_save_st.patch +block-bfq-let-a-queue-be-merged-only-shortly-after-s.patch +block-bfq-remove-superfluous-check-in-queue-merging-.patch +block-bfq-consider-also-past-I-O-in-soft-real-time-d.patch +block-bfq-remove-batches-of-confusing-ifdefs.patch +block-bfq-release-oom-queue-ref-to-root-group-on-exi.patch +block-bfq-iosched-don-t-call-bfqg_and_blkg_put-for-CONFIG_.patch +block-bfq-fix-occurrences-of-request-finish-method-s.patch +block-bfq-limit-tags-for-writes-and-async-I-O.patch +block-bfq-limit-sectors-served-with-interactive-weig.patch +block-bfq-put-async-queues-for-root-bfq-groups-too.patch +block-bfq-add-requeue-request-hook.patch ### ### Char ### -# hard locks Dell R720xd -Revert-ipmi-Start-the-timer-and-thread-on-internal-m.patch - -# tpm_crb fixes for SkyLake -char-tpm-tpm_crb-implement-tpm-crb-idle-state.patch -char-tmp-tpm_crb-fix-Intel-PTT-hw-bug-during-idle-state.patch -char-tpm-tpm_crb-open-code-the-crb_init-into-acpi_add.patch -char-tmp-tpm_crb-implement-runtime-pm-for-tpm_crb.patch +### +### Crypto +### ### ### File-system ### # aufs from: http://aufs.sourceforge.net/ (mga#8314) -fs-aufs-4.9.patch -fs-aufs-4.9-modular.patch - -# needed for mdadm: imsm: enable bad block support for imsm metadata -fs-seq_file-reset-iterator-to-first-record-for-zero-off.patch - -# performance regression fix -fs-jbd2-Fix-dbench4-performance-regression-for-nobarrier-mounts.patch +fs-aufs-4.14.patch +fs-aufs-4.14-modular.patch +fs-aufs-include-vmalloc.patch ### ### FireWire @@ -200,23 +236,15 @@ gpu-drm-mach64-linux-3.14-buildfix.patch gpu-drm-mach64-3.17-buildfix.patch gpu-drm-mach64-3.18-buildfix.patch -# -gpu-drm-i915-don-t-warn-about-Skylake-CPU-KabyPoint-PCH-.patch - -# Amd polaris12 support -gpu-drm-amd-amdgpu-add-Polaris12-PCI-ID.patch -gpu-drm-amd-amdgpu-add-Polaris12-support-v3.patch -gpu-drm-amdgpu-powerplay-add-Polaris12-support.patch -gpu-drm-amd-amdgpu-add-POLARIS12-PCI-ID.patch -gpu-drm-amdgpu-add-Polaris12-DID.patch - -# fix crash -gpu-drm-amdgpu-pm-check-for-headless-before-calling-comp.patch - ### ### Hardware Monitoring ### +# Ryzen support +hwmon-k10temp-Move-chip-specific-code-into-probe-function.patch +hwmon-k10temp-Add-support-for-family-17h.patch +hwmon-k10temp-Add-support-for-temperature-offsets.patch + ### ### Input ### @@ -235,6 +263,10 @@ input-i8042-quirks-for-Fujitsu-Lifebook-A544-and-Lif.patch ### Media ### +### +### MFD +### + ### ### Misc ### @@ -243,6 +275,8 @@ input-i8042-quirks-for-Fujitsu-Lifebook-A544-and-Lif.patch ### MM ### +mm-page_vma_mapped-Introduce-pfn_in_hpage.patch + ### ### Network ### @@ -258,6 +292,7 @@ net-netfilter-IFWLOG-2.6.37-buildfix.patch net-ipv4-netfilter-ipt_IFWLOG-3.6-buildfix.patch net-netfilter-IFWLOG-3.7-buildfix.patch net-netfilter-IFWLOG-remove-unused-label.patch +net-netfilter-ipt_IFWLOG-4.12-buildfix.patch # netfilter psd support net-netfilter-psd.patch @@ -265,20 +300,19 @@ net-netfilter-psd-mdv.patch net-netfilter-psd-2.6.35-buildfix.patch net-netfilter-psd-fix-redefines.patch -# rtlwifi fixes -net-wireless-rtlwifi-Use-dev_kfree_skb_irq-instead-of-kfree_skb.patch -net-wireless-rtlwifi-Fix-kernel-oops-introduced-with-commit-e4965.patch +# WireGuard VPN +net-WireGuard.patch -# update rtl8xxxu for mga#20508 -net-wireless-realtek-rtl8xxxu-linux-4.11-rc.patch +# net fixes +net-tls-Correct-length-of-scatterlist-in-tls_sw_sendpage.patch + +# silence message that gets reported as a bug +net-netfilter-xt_addrtype-silence-BROADCAST-message.patch ### ### pinctrl ### -# fix non-booting Ryzen+ due to interrupt storm -pinctrl_amd-Use-regular-interrupt-instead-of-chained.patch - ### ### Platform drivers ### @@ -288,9 +322,11 @@ pinctrl_amd-Use-regular-interrupt-instead-of-chained.patch platform-x86-add-shuttle-wmi-driver.patch platform-x86-shuttle-wmi-drop-devinit-exit.patch platform-x86-shuttle-wmi-4.2-buildfix.patch +platform-x86-shuttle-wmi-4.13-buildfix.patch -# X302UA no wifi -platform-x86-asus-nb-wmi-Add-wapf4-quirk-for-the-X30.patch +# ideapad-laptop +platform-x86-ideapad-Add-IdeaPad-320-15IKB-to-no_hw_rfkill_list.patch +platform-x86-ideapad-laptop-Increase-timeout-to-wait-for-ec-answer.patch ### ### RTC @@ -300,34 +336,10 @@ platform-x86-asus-nb-wmi-Add-wapf4-quirk-for-the-X30.patch ### Serial ### -# Export pci_ids.h to user space, needed by ldetect -include-kbuild-export-pci_ids.patch - ### ### Sound ### -# new codecs -sound-ALSA-hda-realtek-Add-new-codec-ID-ALC299.patch -sound-ALSA-hda-realtek-New-codec-support-of-ALC1220.patch -sound-ALSA-hda-realtek-new-id-for-alc1220.patch -sound-ALSA-hda-realtek-Remove-ALC285-device-ID.patch -sound-ALSA-hda-realtek-New-codecs-support-for-ALC215-ALC28.patch - -# add support for Gigabyte GA-AX370 Gaming 5 with dual codecs (TTL: 4.12) -sound-ALSA-hda-A-new-flag-to-enforce-prefix-to-each-pin.patch -sound-ALSA-hda-Allow-to-enable-disable-vmaster-build-expli.patch -sound-ALSA-hda-Support-Gigabyte-Gaming-board-with-dual-Rea.patch -sound-ALSA-hda-Use-a-helper-function-for-renaming-kctl-nam.patch -# another dual codec system -sound-ALSA-hda-Apply-dual-codec-quirk-for-MSI-Z270-Gaming-.patch -sound-ALSA-hda-Fix-applying-MSI-dual-codec-mobo-quirk.patch - -# intel -sound-ALSA-hda-Add-Geminilake-id-to-SKL_PLUS.patch -sound-ALSA-hda-Add-Coffelake-PCI-ID.patch -sound-ALSA-hda-Apply-quirks-to-Broxton-T-too.patch - ### ### Staging ### @@ -357,6 +369,10 @@ usb-storage-unusual_devs-add-id-2.6.37-buildfix.patch # pwc driver name in /proc/bus/devices, /sys fix and "advertisement" removal media-usb-pwc-lie-in-proc-usb-devices.patch +### +### Watchdog +### + ### ### Video ### @@ -364,6 +380,10 @@ media-usb-pwc-lie-in-proc-usb-devices.patch # Mageia framebuffer boot logo video-mageia-logo.patch +### +### Virtualization +### + ### ### 3rdparty ### @@ -388,10 +408,11 @@ video-mageia-logo.patch 3rd-aes2501-rmmod-oops-fix.patch # ndiswrapper -3rd-ndiswrapper-1.60.patch +3rd-ndiswrapper-1.61.patch 3rd-ndiswrapper-Kconfig.patch 3rd-ndiswrapper-Makefile-build-fix.patch -3rd-ndiswrapper-4.7-buildfix.patch +3rd-ndiswrapper-4.10-buildfix.patch +3rd-ndiswrapper-4.13-buildfix.patch # rfswitch 3rd-rfswitch-1.3.patch @@ -405,12 +426,12 @@ video-mageia-logo.patch 3rd-viahss-2.6.35-buildfix.patch 3rd-viahss-3.0-buildfix.patch -# add rtl8723bs support (mga#15874) -3rd-rtl8723bs.patch - # add rtl8812 support (mga#21043) 3rd-rtl8812au.patch +# add rtl8723de support (mga#22559) +3rd-rtl8723de.patch + ### ### Security ### @@ -438,11 +459,6 @@ video-mageia-logo.patch # wipe powerpc refrence so we can nuke dangling symlinks (mga#17676) tools-testing-selftest-Makefile-remove-powerpc-reference.patch -# perf build fixes -tools-build-Make-fixdep-parsing-wait-for-last-target.patch -tools-perf-tools-Force-fixdep-compilation-at-the-start-of-.patch -tools-perf-tools-Move-perf-build-related-variables-under-n.patch - ### ### UAPI ### diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-A-new-flag-to-enforce-prefix-to-each-pin.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-A-new-flag-to-enforce-prefix-to-each-pin.patch deleted file mode 100644 index 1899b308..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-A-new-flag-to-enforce-prefix-to-each-pin.patch +++ /dev/null @@ -1,68 +0,0 @@ -From 9f3dadb156692e15933a4a97ef659f65151be4a1 Mon Sep 17 00:00:00 2001 -From: Takashi Iwai -Date: Mon, 10 Apr 2017 17:12:33 +0200 -Subject: [PATCH 1/4] ALSA: hda - A new flag to enforce prefix to each pin - -This is a preliminary patch for a smooth multi-codec support, and it -introduces a new flag, force_pin_prefix, to struct hda_codec. -This flag is used to force to add the pin location prefix to each -input pin. For example, when there is only one microphone pin, -usually the auto-parser assigns the string "Mic". With this flag on, -it'll be like "Front Mic". Also, the creation of "Master" or "PCM" -playback volume for a single pin is suppressed, too. - -Bugzilla: https://bugzilla.kernel.org/show_bug.cgi?id=195305 -Signed-off-by: Takashi Iwai ---- - sound/pci/hda/hda_auto_parser.c | 1 + - sound/pci/hda/hda_codec.h | 1 + - sound/pci/hda/hda_generic.c | 2 ++ - 3 files changed, 4 insertions(+) - -diff --git a/sound/pci/hda/hda_auto_parser.c b/sound/pci/hda/hda_auto_parser.c -index a03cf68..d3ea731 100644 ---- a/sound/pci/hda/hda_auto_parser.c -+++ b/sound/pci/hda/hda_auto_parser.c -@@ -580,6 +580,7 @@ const char *hda_get_autocfg_input_label(struct hda_codec *codec, - has_multiple_pins = 1; - if (has_multiple_pins && type == AUTO_PIN_MIC) - has_multiple_pins &= check_mic_location_need(codec, cfg, input); -+ has_multiple_pins |= codec->force_pin_prefix; - return hda_get_input_pin_label(codec, &cfg->inputs[input], - cfg->inputs[input].pin, - has_multiple_pins); -diff --git a/sound/pci/hda/hda_codec.h b/sound/pci/hda/hda_codec.h -index f17f252..d6fb2d5 100644 ---- a/sound/pci/hda/hda_codec.h -+++ b/sound/pci/hda/hda_codec.h -@@ -256,6 +256,7 @@ struct hda_codec { - unsigned int dump_coef:1; /* dump processing coefs in codec proc file */ - unsigned int power_save_node:1; /* advanced PM for each widget */ - unsigned int auto_runtime_pm:1; /* enable automatic codec runtime pm */ -+ unsigned int force_pin_prefix:1; /* Add location prefix */ - #ifdef CONFIG_PM - unsigned long power_on_acct; - unsigned long power_off_acct; -diff --git a/sound/pci/hda/hda_generic.c b/sound/pci/hda/hda_generic.c -index e7c8f4f..4438328 100644 ---- a/sound/pci/hda/hda_generic.c -+++ b/sound/pci/hda/hda_generic.c -@@ -1125,6 +1125,7 @@ static const char *get_line_out_pfx(struct hda_codec *codec, int ch, - - *index = 0; - if (cfg->line_outs == 1 && !spec->multi_ios && -+ !codec->force_pin_prefix && - !cfg->hp_outs && !cfg->speaker_outs) - return spec->vmaster_mute.hook ? "PCM" : "Master"; - -@@ -1132,6 +1133,7 @@ static const char *get_line_out_pfx(struct hda_codec *codec, int ch, - * use it master (or "PCM" if a vmaster hook is present) - */ - if (spec->multiout.num_dacs == 1 && !spec->mixer_nid && -+ !codec->force_pin_prefix && - !spec->multiout.hp_out_nid[0] && !spec->multiout.extra_out_nid[0]) - return spec->vmaster_mute.hook ? "PCM" : "Master"; - --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Add-Coffelake-PCI-ID.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Add-Coffelake-PCI-ID.patch deleted file mode 100644 index e58824ba..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Add-Coffelake-PCI-ID.patch +++ /dev/null @@ -1,45 +0,0 @@ -From e79b0006c45c9b0b22f3ea54ff6e256b34c1f208 Mon Sep 17 00:00:00 2001 -From: Megha Dey -Date: Wed, 14 Jun 2017 09:51:56 +0530 -Subject: [PATCH] ALSA: hda - Add Coffelake PCI ID - -Coffelake is another Intel part, so need to add PCI ID for it. - -Signed-off-by: Megha Dey -Signed-off-by: Subhransu S. Prusty -Acked-by: Vinod Koul -Cc: -Signed-off-by: Takashi Iwai ---- - sound/pci/hda/hda_intel.c | 6 +++++- - 1 file changed, 5 insertions(+), 1 deletion(-) - -diff --git a/sound/pci/hda/hda_intel.c b/sound/pci/hda/hda_intel.c -index 1770f085c2a6..e3c696c46a21 100644 ---- a/sound/pci/hda/hda_intel.c -+++ b/sound/pci/hda/hda_intel.c -@@ -371,9 +371,10 @@ enum { - #define IS_KBL_H(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0xa2f0) - #define IS_BXT(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0x5a98) - #define IS_GLK(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0x3198) -+#define IS_CFL(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0xa348) - #define IS_SKL_PLUS(pci) (IS_SKL(pci) || IS_SKL_LP(pci) || IS_BXT(pci)) || \ - IS_KBL(pci) || IS_KBL_LP(pci) || IS_KBL_H(pci) || \ -- IS_GLK(pci) -+ IS_GLK(pci) || IS_CFL(pci) - - static char *driver_short_names[] = { - [AZX_DRIVER_ICH] = "HDA Intel", -@@ -2378,6 +2379,9 @@ static const struct pci_device_id azx_ids[] = { - /* Kabylake-H */ - { PCI_DEVICE(0x8086, 0xa2f0), - .driver_data = AZX_DRIVER_PCH | AZX_DCAPS_INTEL_SKYLAKE }, -+ /* Coffelake */ -+ { PCI_DEVICE(0x8086, 0xa348), -+ .driver_data = AZX_DRIVER_PCH | AZX_DCAPS_INTEL_SKYLAKE}, - /* Broxton-P(Apollolake) */ - { PCI_DEVICE(0x8086, 0x5a98), - .driver_data = AZX_DRIVER_PCH | AZX_DCAPS_INTEL_BROXTON }, --- -2.13.1 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Add-Geminilake-id-to-SKL_PLUS.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Add-Geminilake-id-to-SKL_PLUS.patch deleted file mode 100644 index 191ae659..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Add-Geminilake-id-to-SKL_PLUS.patch +++ /dev/null @@ -1,36 +0,0 @@ -From 12ee4022f67f8854061b46e5c0a7ad6258ab66c2 Mon Sep 17 00:00:00 2001 -From: "Subhransu S. Prusty" -Date: Wed, 12 Apr 2017 09:54:00 +0530 -Subject: [PATCH] ALSA: hda: Add Geminilake id to SKL_PLUS - -Geminilake is Skylake family platform. So add it's id to skl_plus check. - -Fixes: 126cfa2f5e15 ("ALSA: hda: Add Geminilake HDMI codec ID") -Signed-off-by: Subhransu S. Prusty -Cc: Senthilnathan Veppur -Cc: Vinod Koul -Cc: Takashi Iwai -Signed-off-by: Takashi Iwai ---- - sound/pci/hda/hda_intel.c | 4 +++- - 1 file changed, 3 insertions(+), 1 deletion(-) - -diff --git a/sound/pci/hda/hda_intel.c b/sound/pci/hda/hda_intel.c -index 59ab34fa0bc8..b786fbab029f 100644 ---- a/sound/pci/hda/hda_intel.c -+++ b/sound/pci/hda/hda_intel.c -@@ -370,8 +370,10 @@ enum { - #define IS_KBL_LP(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0x9d71) - #define IS_KBL_H(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0xa2f0) - #define IS_BXT(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0x5a98) -+#define IS_GLK(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0x3198) - #define IS_SKL_PLUS(pci) (IS_SKL(pci) || IS_SKL_LP(pci) || IS_BXT(pci)) || \ -- IS_KBL(pci) || IS_KBL_LP(pci) || IS_KBL_H(pci) -+ IS_KBL(pci) || IS_KBL_LP(pci) || IS_KBL_H(pci) || \ -+ IS_GLK(pci) - - static char *driver_short_names[] = { - [AZX_DRIVER_ICH] = "HDA Intel", --- -2.13.1 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Allow-to-enable-disable-vmaster-build-expli.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Allow-to-enable-disable-vmaster-build-expli.patch deleted file mode 100644 index 57b07e2f..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Allow-to-enable-disable-vmaster-build-expli.patch +++ /dev/null @@ -1,78 +0,0 @@ -From 7480316c265c9fcdbf73b1b8dec061b893b7e987 Mon Sep 17 00:00:00 2001 -From: Takashi Iwai -Date: Mon, 10 Apr 2017 17:37:34 +0200 -Subject: [PATCH 2/4] ALSA: hda - Allow to enable/disable vmaster build - explicitly - -Another preliminary patch for the dual-codec support: since the -support of vmaster over multiple codecs is difficult, simply disable -it by a new flag to hda_codec struct. A new user hint is added as -well for consistency. - -Signed-off-by: Takashi Iwai ---- - Documentation/sound/hd-audio/notes.rst | 2 ++ - sound/pci/hda/hda_generic.c | 7 +++++-- - sound/pci/hda/hda_generic.h | 1 + - 3 files changed, 8 insertions(+), 2 deletions(-) - -#diff --git a/Documentation/sound/hd-audio/notes.rst b/Documentation/sound/hd-audio/notes.rst -#index 9eeb9b4..f59c3cd 100644 -#--- a/Documentation/sound/hd-audio/notes.rst -#+++ b/Documentation/sound/hd-audio/notes.rst -#@@ -494,6 +494,8 @@ add_hp_mic (bool) -# hp_mic_detect (bool) -# enable/disable the hp/mic shared input for a single built-in mic -# case; default true -#+vmaster (bool) -#+ enable/disable the virtual Master control; default true -# mixer_nid (int) -# specifies the widget NID of the analog-loopback mixer -# -diff --git a/sound/pci/hda/hda_generic.c b/sound/pci/hda/hda_generic.c -index 4438328..2842c82 100644 ---- a/sound/pci/hda/hda_generic.c -+++ b/sound/pci/hda/hda_generic.c -@@ -196,6 +196,9 @@ static void parse_user_hints(struct hda_codec *codec) - val = snd_hda_get_bool_hint(codec, "hp_mic_detect"); - if (val >= 0) - spec->suppress_hp_mic_detect = !val; -+ val = snd_hda_get_bool_hint(codec, "vmaster"); -+ if (val >= 0) -+ spec->suppress_vmaster = !val; - - if (!snd_hda_get_int_hint(codec, "mixer_nid", &val)) - spec->mixer_nid = val; -@@ -5033,7 +5036,7 @@ int snd_hda_gen_build_controls(struct hda_codec *codec) - } - - /* if we have no master control, let's create it */ -- if (!spec->no_analog && -+ if (!spec->no_analog && !spec->suppress_vmaster && - !snd_hda_find_mixer_ctl(codec, "Master Playback Volume")) { - err = snd_hda_add_vmaster(codec, "Master Playback Volume", - spec->vmaster_tlv, slave_pfxs, -@@ -5041,7 +5044,7 @@ int snd_hda_gen_build_controls(struct hda_codec *codec) - if (err < 0) - return err; - } -- if (!spec->no_analog && -+ if (!spec->no_analog && !spec->suppress_vmaster && - !snd_hda_find_mixer_ctl(codec, "Master Playback Switch")) { - err = __snd_hda_add_vmaster(codec, "Master Playback Switch", - NULL, slave_pfxs, -diff --git a/sound/pci/hda/hda_generic.h b/sound/pci/hda/hda_generic.h -index f66fc7e..6177231 100644 ---- a/sound/pci/hda/hda_generic.h -+++ b/sound/pci/hda/hda_generic.h -@@ -229,6 +229,7 @@ struct hda_gen_spec { - unsigned int add_jack_modes:1; /* add i/o jack mode enum ctls */ - unsigned int power_down_unused:1; /* power down unused widgets */ - unsigned int dac_min_mute:1; /* minimal = mute for DACs */ -+ unsigned int suppress_vmaster:1; /* don't create vmaster kctls */ - - /* other internal flags */ - unsigned int no_analog:1; /* digital I/O only */ --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Apply-dual-codec-quirk-for-MSI-Z270-Gaming-.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Apply-dual-codec-quirk-for-MSI-Z270-Gaming-.patch deleted file mode 100644 index eb675d61..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Apply-dual-codec-quirk-for-MSI-Z270-Gaming-.patch +++ /dev/null @@ -1,28 +0,0 @@ -From 63691587f7b0028326ddd1226c378aaaeca4d4e4 Mon Sep 17 00:00:00 2001 -From: Takashi Iwai -Date: Mon, 22 May 2017 16:32:46 +0200 -Subject: [PATCH] ALSA: hda - Apply dual-codec quirk for MSI Z270-Gaming mobo - -MSI Z270-Gamin mobo has also two ALC1220 codecs like Gigabyte AZ370- -Gaming mobo. Apply the same quirk to this one. - -Signed-off-by: Takashi Iwai ---- - sound/pci/hda/patch_realtek.c | 1 + - 1 file changed, 1 insertion(+) - -diff --git a/sound/pci/hda/patch_realtek.c b/sound/pci/hda/patch_realtek.c -index 9c22ad694534..3fdd5af190a4 100644 ---- a/sound/pci/hda/patch_realtek.c -+++ b/sound/pci/hda/patch_realtek.c -@@ -2328,6 +2328,7 @@ static const struct snd_pci_quirk alc882_fixup_tbl[] = { - SND_PCI_QUIRK_VENDOR(0x1462, "MSI", ALC882_FIXUP_GPIO3), - SND_PCI_QUIRK(0x1458, 0xa002, "Gigabyte EP45-DS3/Z87X-UD3H", ALC889_FIXUP_FRONT_HP_NO_PRESENCE), - SND_PCI_QUIRK(0x1458, 0xa0b8, "Gigabyte AZ370-Gaming", ALC1220_FIXUP_GB_DUAL_CODECS), -+ SND_PCI_QUIRK(0x1462, 0xda57, "MSI Z270-Gaming", ALC1220_FIXUP_GB_DUAL_CODECS), - SND_PCI_QUIRK(0x147b, 0x107a, "Abit AW9D-MAX", ALC882_FIXUP_ABIT_AW9D_MAX), - SND_PCI_QUIRK_VENDOR(0x1558, "Clevo laptop", ALC882_FIXUP_EAPD), - SND_PCI_QUIRK(0x161f, 0x2054, "Medion laptop", ALC883_FIXUP_EAPD), --- -2.13.1 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Apply-quirks-to-Broxton-T-too.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Apply-quirks-to-Broxton-T-too.patch deleted file mode 100644 index 020edb59..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Apply-quirks-to-Broxton-T-too.patch +++ /dev/null @@ -1,38 +0,0 @@ -From c7ecb9068e6772c43941ce609f08bc53f36e1dce Mon Sep 17 00:00:00 2001 -From: Takashi Iwai -Date: Wed, 14 Jun 2017 07:37:14 +0200 -Subject: [PATCH] ALSA: hda - Apply quirks to Broxton-T, too - -Broxton-T was a forgotten child and we didn't apply the quirks for -Skylake+ properly. Meanwhile, a quirk for reducing the DMA latency -seems specific to the early Broxton model, so we leave as is. - -Cc: -Signed-off-by: Takashi Iwai ---- - sound/pci/hda/hda_intel.c | 7 ++++--- - 1 file changed, 4 insertions(+), 3 deletions(-) - -diff --git a/sound/pci/hda/hda_intel.c b/sound/pci/hda/hda_intel.c -index e3c696c46a21..01eb1dc7b5b3 100644 ---- a/sound/pci/hda/hda_intel.c -+++ b/sound/pci/hda/hda_intel.c -@@ -370,11 +370,12 @@ enum { - #define IS_KBL_LP(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0x9d71) - #define IS_KBL_H(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0xa2f0) - #define IS_BXT(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0x5a98) -+#define IS_BXT_T(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0x1a98) - #define IS_GLK(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0x3198) - #define IS_CFL(pci) ((pci)->vendor == 0x8086 && (pci)->device == 0xa348) --#define IS_SKL_PLUS(pci) (IS_SKL(pci) || IS_SKL_LP(pci) || IS_BXT(pci)) || \ -- IS_KBL(pci) || IS_KBL_LP(pci) || IS_KBL_H(pci) || \ -- IS_GLK(pci) || IS_CFL(pci) -+#define IS_SKL_PLUS(pci) (IS_SKL(pci) || IS_SKL_LP(pci) || IS_BXT(pci) || \ -+ IS_BXT_T(pci) || IS_KBL(pci) || IS_KBL_LP(pci) || \ -+ IS_KBL_H(pci) || IS_GLK(pci) || IS_CFL(pci)) - - static char *driver_short_names[] = { - [AZX_DRIVER_ICH] = "HDA Intel", --- -2.13.1 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Fix-applying-MSI-dual-codec-mobo-quirk.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Fix-applying-MSI-dual-codec-mobo-quirk.patch deleted file mode 100644 index cd69979b..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Fix-applying-MSI-dual-codec-mobo-quirk.patch +++ /dev/null @@ -1,42 +0,0 @@ -From d2c3b14e1f0dcebdb695617c0c1342a36b914a47 Mon Sep 17 00:00:00 2001 -From: Takashi Iwai -Date: Thu, 1 Jun 2017 09:35:30 +0200 -Subject: [PATCH] ALSA: hda - Fix applying MSI dual-codec mobo quirk - -The previous commit [63691587f7b0: ALSA: hda - Apply dual-codec quirk -for MSI Z270-Gaming mobo] attempted to apply the existing dual-codec -quirk for a MSI mobo. But it turned out that this isn't applied -properly due to the MSI-vendor quirk before this entry. I overlooked -such two MSI entries just because they were put in the wrong position, -although we have a list ordered by PCI SSID numbers. - -This patch fixes it by rearranging the unordered entries. - -Fixes: 63691587f7b0 ("ALSA: hda - Apply dual-codec quirk for MSI Z270-Gaming mobo") -Reported-by: Rudolf Schmidt -Signed-off-by: Takashi Iwai ---- - sound/pci/hda/patch_realtek.c | 4 ++-- - 1 file changed, 2 insertions(+), 2 deletions(-) - -diff --git a/sound/pci/hda/patch_realtek.c b/sound/pci/hda/patch_realtek.c -index 918e45268915..a57988d617e9 100644 ---- a/sound/pci/hda/patch_realtek.c -+++ b/sound/pci/hda/patch_realtek.c -@@ -2324,11 +2324,11 @@ static const struct snd_pci_quirk alc882_fixup_tbl[] = { - SND_PCI_QUIRK(0x106b, 0x4a00, "Macbook 5,2", ALC889_FIXUP_MBA11_VREF), - - SND_PCI_QUIRK(0x1071, 0x8258, "Evesham Voyaeger", ALC882_FIXUP_EAPD), -- SND_PCI_QUIRK(0x1462, 0x7350, "MSI-7350", ALC889_FIXUP_CD), -- SND_PCI_QUIRK_VENDOR(0x1462, "MSI", ALC882_FIXUP_GPIO3), - SND_PCI_QUIRK(0x1458, 0xa002, "Gigabyte EP45-DS3/Z87X-UD3H", ALC889_FIXUP_FRONT_HP_NO_PRESENCE), - SND_PCI_QUIRK(0x1458, 0xa0b8, "Gigabyte AZ370-Gaming", ALC1220_FIXUP_GB_DUAL_CODECS), -+ SND_PCI_QUIRK(0x1462, 0x7350, "MSI-7350", ALC889_FIXUP_CD), - SND_PCI_QUIRK(0x1462, 0xda57, "MSI Z270-Gaming", ALC1220_FIXUP_GB_DUAL_CODECS), -+ SND_PCI_QUIRK_VENDOR(0x1462, "MSI", ALC882_FIXUP_GPIO3), - SND_PCI_QUIRK(0x147b, 0x107a, "Abit AW9D-MAX", ALC882_FIXUP_ABIT_AW9D_MAX), - SND_PCI_QUIRK_VENDOR(0x1558, "Clevo laptop", ALC882_FIXUP_EAPD), - SND_PCI_QUIRK(0x161f, 0x2054, "Medion laptop", ALC883_FIXUP_EAPD), --- -2.13.1 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Support-Gigabyte-Gaming-board-with-dual-Rea.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Support-Gigabyte-Gaming-board-with-dual-Rea.patch deleted file mode 100644 index 0f93df15..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Support-Gigabyte-Gaming-board-with-dual-Rea.patch +++ /dev/null @@ -1,122 +0,0 @@ -From 7beb3a6e9335d13872f24566b451f8371edd238f Mon Sep 17 00:00:00 2001 -From: Takashi Iwai -Date: Mon, 10 Apr 2017 18:05:52 +0200 -Subject: [PATCH 3/4] ALSA: hda - Support Gigabyte Gaming board with dual - Realtek codecs - -This patch adds some workarounds to make Gigabyte GA-AX370 Gaming 5 -board working without the conflicts of kctls, etc. In general, the -dual codec configs result in the conflicts of the following stuff: -- Master controls -- Capture controls -- Analog loopback controls -In addition, the auto-mute and the auto-mic can't work well among -multiple codecs. - -The current "solution" is to disable all these features, and use UCM -for a better PulseAudio management. For a dedicated UCM profile, the -patch overrides the card longname so that the system an get a unique -profile path. - -Bugzilla: https://bugzilla.kernel.org/show_bug.cgi?id=195305 -Signed-off-by: Takashi Iwai ---- - sound/pci/hda/patch_realtek.c | 61 +++++++++++++++++++++++++++++++++++++++++++ - 1 file changed, 61 insertions(+) - -diff --git a/sound/pci/hda/patch_realtek.c b/sound/pci/hda/patch_realtek.c -index 9371f1a..e81cf83 100644 ---- a/sound/pci/hda/patch_realtek.c -+++ b/sound/pci/hda/patch_realtek.c -@@ -1800,6 +1800,7 @@ enum { - ALC882_FIXUP_NO_PRIMARY_HP, - ALC887_FIXUP_ASUS_BASS, - ALC887_FIXUP_BASS_CHMAP, -+ ALC1220_FIXUP_GB_DUAL_CODECS, - }; - - static void alc889_fixup_coef(struct hda_codec *codec, -@@ -1962,6 +1963,61 @@ static void alc882_fixup_no_primary_hp(struct hda_codec *codec, - static void alc_fixup_bass_chmap(struct hda_codec *codec, - const struct hda_fixup *fix, int action); - -+/* For dual-codec configuration, we need to disable some features to avoid -+ * conflicts of kctls and PCM streams -+ */ -+static void alc_fixup_dual_codecs(struct hda_codec *codec, -+ const struct hda_fixup *fix, int action) -+{ -+ struct alc_spec *spec = codec->spec; -+ -+ if (action != HDA_FIXUP_ACT_PRE_PROBE) -+ return; -+ /* disable vmaster */ -+ spec->gen.suppress_vmaster = 1; -+ /* auto-mute and auto-mic switch don't work with multiple codecs */ -+ spec->gen.suppress_auto_mute = 1; -+ spec->gen.suppress_auto_mic = 1; -+ /* disable aamix as well */ -+ spec->gen.mixer_nid = 0; -+ /* add location prefix to avoid conflicts */ -+ codec->force_pin_prefix = 1; -+} -+ -+static void rename_ctl(struct hda_codec *codec, const char *oldname, -+ const char *newname) -+{ -+ struct snd_kcontrol *kctl; -+ -+ kctl = snd_hda_find_mixer_ctl(codec, oldname); -+ if (kctl) -+ strcpy(kctl->id.name, newname); -+} -+ -+static void alc1220_fixup_gb_dual_codecs(struct hda_codec *codec, -+ const struct hda_fixup *fix, -+ int action) -+{ -+ alc_fixup_dual_codecs(codec, fix, action); -+ switch (action) { -+ case HDA_FIXUP_ACT_PRE_PROBE: -+ /* override card longname to provide a unique UCM profile */ -+ strcpy(codec->card->longname, "HDAudio-Gigabyte-ALC1220DualCodecs"); -+ break; -+ case HDA_FIXUP_ACT_BUILD: -+ /* rename Capture controls depending on the codec */ -+ rename_ctl(codec, "Capture Volume", -+ codec->addr == 0 ? -+ "Rear-Panel Capture Volume" : -+ "Front-Panel Capture Volume"); -+ rename_ctl(codec, "Capture Switch", -+ codec->addr == 0 ? -+ "Rear-Panel Capture Switch" : -+ "Front-Panel Capture Switch"); -+ break; -+ } -+} -+ - static const struct hda_fixup alc882_fixups[] = { - [ALC882_FIXUP_ABIT_AW9D_MAX] = { - .type = HDA_FIXUP_PINS, -@@ -2198,6 +2254,10 @@ static const struct hda_fixup alc882_fixups[] = { - .type = HDA_FIXUP_FUNC, - .v.func = alc_fixup_bass_chmap, - }, -+ [ALC1220_FIXUP_GB_DUAL_CODECS] = { -+ .type = HDA_FIXUP_FUNC, -+ .v.func = alc1220_fixup_gb_dual_codecs, -+ }, - }; - - static const struct snd_pci_quirk alc882_fixup_tbl[] = { -@@ -2267,6 +2327,7 @@ static const struct snd_pci_quirk alc882_fixup_tbl[] = { - SND_PCI_QUIRK(0x1462, 0x7350, "MSI-7350", ALC889_FIXUP_CD), - SND_PCI_QUIRK_VENDOR(0x1462, "MSI", ALC882_FIXUP_GPIO3), - SND_PCI_QUIRK(0x1458, 0xa002, "Gigabyte EP45-DS3/Z87X-UD3H", ALC889_FIXUP_FRONT_HP_NO_PRESENCE), -+ SND_PCI_QUIRK(0x1458, 0xa0b8, "Gigabyte AZ370-Gaming", ALC1220_FIXUP_GB_DUAL_CODECS), - SND_PCI_QUIRK(0x147b, 0x107a, "Abit AW9D-MAX", ALC882_FIXUP_ABIT_AW9D_MAX), - SND_PCI_QUIRK_VENDOR(0x1558, "Clevo laptop", ALC882_FIXUP_EAPD), - SND_PCI_QUIRK(0x161f, 0x2054, "Medion laptop", ALC883_FIXUP_EAPD), --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Use-a-helper-function-for-renaming-kctl-nam.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Use-a-helper-function-for-renaming-kctl-nam.patch deleted file mode 100644 index 8094a331..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-Use-a-helper-function-for-renaming-kctl-nam.patch +++ /dev/null @@ -1,42 +0,0 @@ -From 56798e6b3a2264b58d50b93cfd66586ede77d661 Mon Sep 17 00:00:00 2001 -From: Takashi Iwai -Date: Tue, 11 Apr 2017 08:10:52 +0200 -Subject: [PATCH 4/4] ALSA: hda - Use a helper function for renaming kctl names - -Signed-off-by: Takashi Iwai ---- - sound/pci/hda/patch_realtek.c | 11 ++++------- - 1 file changed, 4 insertions(+), 7 deletions(-) - -diff --git a/sound/pci/hda/patch_realtek.c b/sound/pci/hda/patch_realtek.c -index e81cf83..57eeefd 100644 ---- a/sound/pci/hda/patch_realtek.c -+++ b/sound/pci/hda/patch_realtek.c -@@ -4724,7 +4724,6 @@ static void alc282_fixup_asus_tx300(struct hda_codec *codec, - { 0x1b, 0x21114000 }, /* dock speaker pin */ - {} - }; -- struct snd_kcontrol *kctl; - - switch (action) { - case HDA_FIXUP_ACT_PRE_PROBE: -@@ -4739,12 +4738,10 @@ static void alc282_fixup_asus_tx300(struct hda_codec *codec, - /* this is a bit tricky; give more sane names for the main - * (tablet) speaker and the dock speaker, respectively - */ -- kctl = snd_hda_find_mixer_ctl(codec, "Speaker Playback Switch"); -- if (kctl) -- strcpy(kctl->id.name, "Dock Speaker Playback Switch"); -- kctl = snd_hda_find_mixer_ctl(codec, "Bass Speaker Playback Switch"); -- if (kctl) -- strcpy(kctl->id.name, "Speaker Playback Switch"); -+ rename_ctl(codec, "Speaker Playback Switch", -+ "Dock Speaker Playback Switch"); -+ rename_ctl(codec, "Bass Speaker Playback Switch", -+ "Speaker Playback Switch"); - break; - } - } --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-Add-new-codec-ID-ALC299.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-Add-new-codec-ID-ALC299.patch deleted file mode 100644 index ae18a31b..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-Add-new-codec-ID-ALC299.patch +++ /dev/null @@ -1,102 +0,0 @@ -From 28f1f9b26cee161ddd3985b3eb78e3ffada08dda Mon Sep 17 00:00:00 2001 -From: Kailang Yang -Date: Wed, 4 Jan 2017 14:49:07 +0800 -Subject: [PATCH] ALSA: hda/realtek - Add new codec ID ALC299 - -ALC299 was similar as ALC225. -Add headset support for ALC299. -ALC3271 was for Dell rename. - -Signed-off-by: Kailang Yang -Signed-off-by: Takashi Iwai ---- - sound/pci/hda/patch_realtek.c | 10 ++++++++++ - 1 file changed, 10 insertions(+) - -diff --git a/sound/pci/hda/patch_realtek.c b/sound/pci/hda/patch_realtek.c -index 1ae29fd..3c69647 100644 ---- a/sound/pci/hda/patch_realtek.c -+++ b/sound/pci/hda/patch_realtek.c -@@ -337,6 +337,7 @@ static void alc_fill_eapd_coef(struct hda_codec *codec) - case 0x10ec0288: - case 0x10ec0295: - case 0x10ec0298: -+ case 0x10ec0299: - alc_update_coef_idx(codec, 0x10, 1<<9, 0); - break; - case 0x10ec0285: -@@ -912,6 +913,7 @@ static struct alc_codec_rename_pci_table rename_pci_tbl[] = { - { 0x10ec0256, 0x1028, 0, "ALC3246" }, - { 0x10ec0225, 0x1028, 0, "ALC3253" }, - { 0x10ec0295, 0x1028, 0, "ALC3254" }, -+ { 0x10ec0299, 0x1028, 0, "ALC3271" }, - { 0x10ec0670, 0x1025, 0, "ALC669X" }, - { 0x10ec0676, 0x1025, 0, "ALC679X" }, - { 0x10ec0282, 0x1043, 0, "ALC3229" }, -@@ -3716,6 +3718,7 @@ static void alc_headset_mode_unplugged(struct hda_codec *codec) - break; - case 0x10ec0225: - case 0x10ec0295: -+ case 0x10ec0299: - alc_process_coef_fw(codec, coef0225); - break; - case 0x10ec0867: -@@ -3823,6 +3826,7 @@ static void alc_headset_mode_mic_in(struct hda_codec *codec, hda_nid_t hp_pin, - break; - case 0x10ec0225: - case 0x10ec0295: -+ case 0x10ec0299: - alc_update_coef_idx(codec, 0x45, 0x3f<<10, 0x31<<10); - snd_hda_set_pin_ctl_cache(codec, hp_pin, 0); - alc_process_coef_fw(codec, coef0225); -@@ -3881,6 +3885,7 @@ static void alc_headset_mode_default(struct hda_codec *codec) - switch (codec->core.vendor_id) { - case 0x10ec0225: - case 0x10ec0295: -+ case 0x10ec0299: - alc_process_coef_fw(codec, coef0225); - break; - case 0x10ec0255: -@@ -3996,6 +4001,7 @@ static void alc_headset_mode_ctia(struct hda_codec *codec) - break; - case 0x10ec0225: - case 0x10ec0295: -+ case 0x10ec0299: - alc_process_coef_fw(codec, coef0225); - break; - case 0x10ec0867: -@@ -4089,6 +4095,7 @@ static void alc_headset_mode_omtp(struct hda_codec *codec) - break; - case 0x10ec0225: - case 0x10ec0295: -+ case 0x10ec0299: - alc_process_coef_fw(codec, coef0225); - break; - } -@@ -4173,6 +4180,7 @@ static void alc_determine_headset_type(struct hda_codec *codec) - break; - case 0x10ec0225: - case 0x10ec0295: -+ case 0x10ec0299: - alc_process_coef_fw(codec, coef0225); - msleep(800); - val = alc_read_coef_idx(codec, 0x46); -@@ -6219,6 +6227,7 @@ static int patch_alc269(struct hda_codec *codec) - break; - case 0x10ec0225: - case 0x10ec0295: -+ case 0x10ec0299: - spec->codec_variant = ALC269_TYPE_ALC225; - break; - case 0x10ec0234: -@@ -7256,6 +7265,7 @@ static const struct hda_device_id snd_hda_id_realtek[] = { - HDA_CODEC_ENTRY(0x10ec0294, "ALC294", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0295, "ALC295", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0298, "ALC298", patch_alc269), -+ HDA_CODEC_ENTRY(0x10ec0299, "ALC299", patch_alc269), - HDA_CODEC_REV_ENTRY(0x10ec0861, 0x100340, "ALC660", patch_alc861), - HDA_CODEC_ENTRY(0x10ec0660, "ALC660-VD", patch_alc861vd), - HDA_CODEC_ENTRY(0x10ec0861, "ALC861", patch_alc861), --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-New-codec-support-of-ALC1220.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-New-codec-support-of-ALC1220.patch deleted file mode 100644 index 70646467..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-New-codec-support-of-ALC1220.patch +++ /dev/null @@ -1,45 +0,0 @@ -From a535ad57d0e6b959cd79914a1127caade36a9459 Mon Sep 17 00:00:00 2001 -From: Kailang Yang -Date: Mon, 16 Jan 2017 16:59:26 +0800 -Subject: [PATCH] ALSA: hda/realtek - New codec support of ALC1220 - -Add support for new codec of ALC1220. -It's compatible with ALC882 & co. - -Signed-off-by: Kailang Yang -Signed-off-by: Takashi Iwai ---- - sound/pci/hda/patch_realtek.c | 3 +++ - 1 file changed, 3 insertions(+) - -diff --git a/sound/pci/hda/patch_realtek.c b/sound/pci/hda/patch_realtek.c -index 3c69647..1c88da8 100644 ---- a/sound/pci/hda/patch_realtek.c -+++ b/sound/pci/hda/patch_realtek.c -@@ -380,6 +380,7 @@ static void alc_fill_eapd_coef(struct hda_codec *codec) - break; - case 0x10ec0899: - case 0x10ec0900: -+ case 0x10ec1220: - alc_update_coef_idx(codec, 0x7, 1<<1, 0); - break; - } -@@ -2310,6 +2311,7 @@ static int patch_alc882(struct hda_codec *codec) - case 0x10ec0882: - case 0x10ec0885: - case 0x10ec0900: -+ case 0x10ec1220: - break; - default: - /* ALC883 and variants */ -@@ -7297,6 +7299,7 @@ static const struct hda_device_id snd_hda_id_realtek[] = { - HDA_CODEC_ENTRY(0x10ec0892, "ALC892", patch_alc662), - HDA_CODEC_ENTRY(0x10ec0899, "ALC898", patch_alc882), - HDA_CODEC_ENTRY(0x10ec0900, "ALC1150", patch_alc882), -+ HDA_CODEC_ENTRY(0x10ec1220, "ALC1220", patch_alc882), - {} /* terminator */ - }; - MODULE_DEVICE_TABLE(hdaudio, snd_hda_id_realtek); --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-New-codecs-support-for-ALC215-ALC28.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-New-codecs-support-for-ALC215-ALC28.patch deleted file mode 100644 index 86bf8a64..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-New-codecs-support-for-ALC215-ALC28.patch +++ /dev/null @@ -1,85 +0,0 @@ -From 0a6f0600efc3df0179a33188c30b5026bd9d1c27 Mon Sep 17 00:00:00 2001 -From: Kailang Yang -Date: Fri, 30 Jun 2017 16:00:48 +0800 -Subject: [PATCH] ALSA: hda/realtek - New codecs support for - ALC215/ALC285/ALC289 - -Add new codecs support for ALC215 ALC285 ALC289. - -Signed-off-by: Kailang Yang -Signed-off-by: Takashi Iwai ---- - sound/pci/hda/patch_realtek.c | 14 ++++++++++++++ - 1 file changed, 14 insertions(+) - -diff --git a/sound/pci/hda/patch_realtek.c b/sound/pci/hda/patch_realtek.c -index 80c7c832d442..c39bc497650c 100644 ---- a/sound/pci/hda/patch_realtek.c -+++ b/sound/pci/hda/patch_realtek.c -@@ -327,6 +327,7 @@ static void alc_fill_eapd_coef(struct hd - case 0x10ec0292: - alc_update_coef_idx(codec, 0x4, 1<<15, 0); - break; -+ case 0x10ec0215: - case 0x10ec0225: - case 0x10ec0233: - case 0x10ec0255: -@@ -335,8 +336,10 @@ static void alc_fill_eapd_coef(struct hd - case 0x10ec0283: - case 0x10ec0286: - case 0x10ec0288: -+ case 0x10ec0285: - case 0x10ec0295: - case 0x10ec0298: -+ case 0x10ec0289: - case 0x10ec0299: - alc_update_coef_idx(codec, 0x10, 1<<9, 0); - break; -@@ -2723,6 +2726,7 @@ enum { - ALC269_TYPE_ALC298, - ALC269_TYPE_ALC255, - ALC269_TYPE_ALC256, -+ ALC269_TYPE_ALC215, - ALC269_TYPE_ALC225, - ALC269_TYPE_ALC294, - ALC269_TYPE_ALC700, -@@ -2755,6 +2759,7 @@ static int alc269_parse_auto_config(stru - case ALC269_TYPE_ALC298: - case ALC269_TYPE_ALC255: - case ALC269_TYPE_ALC256: -+ case ALC269_TYPE_ALC215: - case ALC269_TYPE_ALC225: - case ALC269_TYPE_ALC294: - case ALC269_TYPE_ALC700: -@@ -6298,6 +6303,12 @@ static int patch_alc269(struct hda_codec - spec->gen.mixer_nid = 0; /* ALC256 does not have any loopback mixer path */ - alc_update_coef_idx(codec, 0x36, 1 << 13, 1 << 5); /* Switch pcbeep path to Line in path*/ - break; -+ case 0x10ec0215: -+ case 0x10ec0285: -+ case 0x10ec0289: -+ spec->codec_variant = ALC269_TYPE_ALC215; -+ spec->gen.mixer_nid = 0; -+ break; - case 0x10ec0225: - case 0x10ec0295: - case 0x10ec0299: -@@ -7267,6 +7278,7 @@ static int patch_alc680(struct hda_codec - * patch entries - */ - static const struct hda_device_id snd_hda_id_realtek[] = { -+ HDA_CODEC_ENTRY(0x10ec0215, "ALC215", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0221, "ALC221", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0225, "ALC225", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0231, "ALC231", patch_alc269), -@@ -7289,8 +7301,10 @@ static const struct hda_device_id snd_hd - HDA_CODEC_ENTRY(0x10ec0282, "ALC282", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0283, "ALC283", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0284, "ALC284", patch_alc269), -+ HDA_CODEC_ENTRY(0x10ec0285, "ALC285", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0286, "ALC286", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0288, "ALC288", patch_alc269), -+ HDA_CODEC_ENTRY(0x10ec0289, "ALC289", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0290, "ALC290", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0292, "ALC292", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0293, "ALC293", patch_alc269), diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-Remove-ALC285-device-ID.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-Remove-ALC285-device-ID.patch deleted file mode 100644 index 05649747..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-Remove-ALC285-device-ID.patch +++ /dev/null @@ -1,68 +0,0 @@ -From 4731d5de4b1ca8d2565782cc3aeac392db07c075 Mon Sep 17 00:00:00 2001 -From: Kailang Yang -Date: Fri, 30 Jun 2017 15:22:57 +0800 -Subject: [PATCH] ALSA: hda/realtek - Remove ALC285 device ID - -0x0285 Device ID was not used. -It just assigned for alias of ALC293 as backup. -So, remove it first. -Because our new codec will use this device ID. - -Signed-off-by: Kailang Yang -Signed-off-by: Takashi Iwai ---- - sound/pci/hda/patch_realtek.c | 9 +++------ - 1 file changed, 3 insertions(+), 6 deletions(-) - -diff --git a/sound/pci/hda/patch_realtek.c b/sound/pci/hda/patch_realtek.c -index c79491a1cd47..80c7c832d442 100644 ---- a/sound/pci/hda/patch_realtek.c -+++ b/sound/pci/hda/patch_realtek.c -@@ -340,7 +340,6 @@ static void alc_fill_eapd_coef(struct hda_codec *codec) - case 0x10ec0299: - alc_update_coef_idx(codec, 0x10, 1<<9, 0); - break; -- case 0x10ec0285: - case 0x10ec0293: - alc_update_coef_idx(codec, 0xa, 1<<13, 0); - break; -@@ -2738,7 +2737,7 @@ enum { - ALC269_TYPE_ALC282, - ALC269_TYPE_ALC283, - ALC269_TYPE_ALC284, -- ALC269_TYPE_ALC285, -+ ALC269_TYPE_ALC293, - ALC269_TYPE_ALC286, - ALC269_TYPE_ALC298, - ALC269_TYPE_ALC255, -@@ -2764,7 +2763,7 @@ static int alc269_parse_auto_config(struct hda_codec *codec) - case ALC269_TYPE_ALC269VC: - case ALC269_TYPE_ALC280: - case ALC269_TYPE_ALC284: -- case ALC269_TYPE_ALC285: -+ case ALC269_TYPE_ALC293: - ssids = alc269va_ssids; - break; - case ALC269_TYPE_ALC269VB: -@@ -6678,9 +6677,8 @@ static int patch_alc269(struct hda_codec *codec) - case 0x10ec0292: - spec->codec_variant = ALC269_TYPE_ALC284; - break; -- case 0x10ec0285: - case 0x10ec0293: -- spec->codec_variant = ALC269_TYPE_ALC285; -+ spec->codec_variant = ALC269_TYPE_ALC293; - break; - case 0x10ec0286: - case 0x10ec0288: -@@ -7752,7 +7750,6 @@ static const struct hda_device_id snd_hda_id_realtek[] = { - HDA_CODEC_ENTRY(0x10ec0282, "ALC282", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0283, "ALC283", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0284, "ALC284", patch_alc269), -- HDA_CODEC_ENTRY(0x10ec0285, "ALC285", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0286, "ALC286", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0288, "ALC288", patch_alc269), - HDA_CODEC_ENTRY(0x10ec0290, "ALC290", patch_alc269), --- -2.13.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-new-id-for-alc1220.patch b/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-new-id-for-alc1220.patch deleted file mode 100644 index 7dc59935..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/sound-ALSA-hda-realtek-new-id-for-alc1220.patch +++ /dev/null @@ -1,30 +0,0 @@ -From a7498943b45d43f4a1abf37b75908c1edf840230 Mon Sep 17 00:00:00 2001 -From: Kailang Yang -Date: Tue, 11 Jul 2017 15:15:47 +0800 -Subject: [PATCH] ALSA: hda/realtek - New codec device ID for ALC1220 - -Codec ID is 0x1168. -It is another ALC1220 codec. - -Signed-off-by: Kailang Yang - -diff --git a/sound/pci/hda/patch_realtek.c b/sound/pci/hda/patch_realtek.c -index e2116d2..45d58fc 100644 ---- a/sound/pci/hda/patch_realtek.c -+++ b/sound/pci/hda/patch_realtek.c -@@ -380,6 +380,7 @@ static void alc_fill_eapd_coef(struct hd - break; - case 0x10ec0899: - case 0x10ec0900: -+ case 0x10ec1168: - case 0x10ec1220: - alc_update_coef_idx(codec, 0x7, 1<<1, 0); - break; -@@ -7331,6 +7332,7 @@ static const struct hda_device_id snd_hd - HDA_CODEC_ENTRY(0x10ec0892, "ALC892", patch_alc662), - HDA_CODEC_ENTRY(0x10ec0899, "ALC898", patch_alc882), - HDA_CODEC_ENTRY(0x10ec0900, "ALC1150", patch_alc882), -+ HDA_CODEC_ENTRY(0x10ec1168, "ALC1220", patch_alc882), - HDA_CODEC_ENTRY(0x10ec1220, "ALC1220", patch_alc882), - {} /* terminator */ - }; diff --git a/kernel/tools/cpupowertools/files/patches/mageia/tools-build-Make-fixdep-parsing-wait-for-last-target.patch b/kernel/tools/cpupowertools/files/patches/mageia/tools-build-Make-fixdep-parsing-wait-for-last-target.patch deleted file mode 100644 index f15fccc5..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/tools-build-Make-fixdep-parsing-wait-for-last-target.patch +++ /dev/null @@ -1,51 +0,0 @@ -From 1cd6472e3f8d3fdee0fd19f7088807b284d3080f Mon Sep 17 00:00:00 2001 -From: Jiri Olsa -Date: Thu, 1 Dec 2016 14:00:25 +0100 -Subject: [PATCH] tools build: Make fixdep parsing wait for last target - -The fixdep tool, among other things, replaces the target of the object -in the gcc generated dependency output file. - -The parsing code assumes there's only single target in the rule but this -is not always the case as described in here: - - https://gcc.gnu.org/ml/gcc-help/2016-11/msg00099.html - -Make the fixdep code smart enough to skip all the possible targets. - -Signed-off-by: Jiri Olsa -Tested-by: Arnaldo Carvalho de Melo -Acked-by: Peter Foley -Cc: Wang Nan -Link: http://lkml.kernel.org/r/20161201130025.GA16430@krava -Signed-off-by: Arnaldo Carvalho de Melo ---- - tools/build/fixdep.c | 5 +++-- - 1 file changed, 3 insertions(+), 2 deletions(-) - -diff --git a/tools/build/fixdep.c b/tools/build/fixdep.c -index 1521d36..734d154 100644 ---- a/tools/build/fixdep.c -+++ b/tools/build/fixdep.c -@@ -49,7 +49,7 @@ static void parse_dep_file(void *map, size_t len) - char *end = m + len; - char *p; - char s[PATH_MAX]; -- int is_target; -+ int is_target, has_target = 0; - int saw_any_target = 0; - int is_first_dep = 0; - -@@ -67,7 +67,8 @@ static void parse_dep_file(void *map, size_t len) - if (is_target) { - /* The /next/ file is the first dependency */ - is_first_dep = 1; -- } else { -+ has_target = 1; -+ } else if (has_target) { - /* Save this token/filename */ - memcpy(s, m, p-m); - s[p - m] = 0; --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/tools-perf-tools-Force-fixdep-compilation-at-the-start-of-.patch b/kernel/tools/cpupowertools/files/patches/mageia/tools-perf-tools-Force-fixdep-compilation-at-the-start-of-.patch deleted file mode 100644 index 7bc4952d..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/tools-perf-tools-Force-fixdep-compilation-at-the-start-of-.patch +++ /dev/null @@ -1,237 +0,0 @@ -From abb26210a39522a6645bce3f438ed9a26bedb11b Mon Sep 17 00:00:00 2001 -From: Jiri Olsa -Date: Tue, 6 Dec 2016 14:18:49 +0100 -Subject: [PATCH] perf tools: Force fixdep compilation at the start of the - build - -The fixdep tool needs to be built before everything else, because it fixes -every object dependency file. - -We handle this currently by making all objects to depend on fixdep, which is -error prone and is easily forgotten when new object is added. - -Instead of this, this patch force fixdep tool to be built as the first target -in the separate make session. This way we don't need to handle extra fixdep -dependencies and we are certain there's no fixdep race with any parallel make -job. - -Committer notes: - -Testing it: - -Before: - - $ rm -rf /tmp/build/perf/ ; mkdir -p /tmp/build/perf ; make -k O=/tmp/build/perf -C tools/perf install-bin - make: Entering directory '/home/acme/git/linux/tools/perf' - BUILD: Doing 'make -j4' parallel build - - Auto-detecting system features: - ... dwarf: [ on ] - ... dwarf_getlocations: [ on ] - ... glibc: [ on ] - ... gtk2: [ on ] - ... libaudit: [ on ] - ... libbfd: [ on ] - ... libelf: [ on ] - ... libnuma: [ on ] - ... numa_num_possible_cpus: [ on ] - ... libperl: [ on ] - ... libpython: [ on ] - ... libslang: [ on ] - ... libcrypto: [ on ] - ... libunwind: [ on ] - ... libdw-dwarf-unwind: [ on ] - ... zlib: [ on ] - ... lzma: [ on ] - ... get_cpuid: [ on ] - ... bpf: [ on ] - - GEN /tmp/build/perf/common-cmds.h - HOSTCC /tmp/build/perf/fixdep.o - HOSTLD /tmp/build/perf/fixdep-in.o - LINK /tmp/build/perf/fixdep - MKDIR /tmp/build/perf/pmu-events/ - HOSTCC /tmp/build/perf/pmu-events/json.o - MKDIR /tmp/build/perf/pmu-events/ - HOSTCC /tmp/build/perf/pmu-events/jsmn.o - HOSTCC /tmp/build/perf/pmu-events/jevents.o - HOSTLD /tmp/build/perf/pmu-events/jevents-in.o - PERF_VERSION = 4.9.rc8.g868cd5 - CC /tmp/build/perf/perf-read-vdso32 - - -After: - - $ rm -rf /tmp/build/perf/ ; mkdir -p /tmp/build/perf ; make -k O=/tmp/build/perf -C tools/perf install-bin - make: Entering directory '/home/acme/git/linux/tools/perf' - BUILD: Doing 'make -j4' parallel build - HOSTCC /tmp/build/perf/fixdep.o - HOSTLD /tmp/build/perf/fixdep-in.o - LINK /tmp/build/perf/fixdep - - Auto-detecting system features: - ... dwarf: [ on ] - ... dwarf_getlocations: [ on ] - ... glibc: [ on ] - ... gtk2: [ on ] - ... libaudit: [ on ] - ... libbfd: [ on ] - ... libelf: [ on ] - ... libnuma: [ on ] - ... numa_num_possible_cpus: [ on ] - ... libperl: [ on ] - ... libpython: [ on ] - ... libslang: [ on ] - ... libcrypto: [ on ] - ... libunwind: [ on ] - ... libdw-dwarf-unwind: [ on ] - ... zlib: [ on ] - ... lzma: [ on ] - ... get_cpuid: [ on ] - ... bpf: [ on ] - - GEN /tmp/build/perf/common-cmds.h - MKDIR /tmp/build/perf/fd/ - CC /tmp/build/perf/fd/array.o - LD /tmp/build/perf/fd/libapi-in.o - MKDIR /tmp/build/perf/fs/ - CC /tmp/build/perf/event-parse.o - CC /tmp/build/perf/fs/fs.o - PERF_VERSION = 4.9.rc8.g57a92f - CC /tmp/build/perf/event-plugin.o - MKDIR /tmp/build/perf/fs/ - CC /tmp/build/perf/fs/tracing_path.o - - -Signed-off-by: Jiri Olsa -Tested-by: Arnaldo Carvalho de Melo -Cc: David Ahern -Cc: Namhyung Kim -Cc: Peter Zijlstra -Link: http://lkml.kernel.org/r/1481030331-31944-3-git-send-email-jolsa@kernel.org -Signed-off-by: Arnaldo Carvalho de Melo ---- - tools/perf/Makefile.perf | 50 ++++++++++++++++++++++++++++++++++++------------ - 1 file changed, 38 insertions(+), 12 deletions(-) - -diff --git a/tools/perf/Makefile.perf b/tools/perf/Makefile.perf -index 9e5a6e1..33b1d9f 100644 ---- a/tools/perf/Makefile.perf -+++ b/tools/perf/Makefile.perf -@@ -177,6 +177,35 @@ ifeq ($(filter-out $(NON_CONFIG_TARGETS) - endif - endif - -+# The fixdep build - we force fixdep tool to be built as -+# the first target in the separate make session not to be -+# disturbed by any parallel make jobs. Once fixdep is done -+# we issue the requested build with FIXDEP=1 variable. -+# -+# The fixdep build is disabled for $(NON_CONFIG_TARGETS) -+# targets, because it's not necessary. -+ -+ifdef FIXDEP -+ force_fixdep := 0 -+else -+ force_fixdep := $(config) -+endif -+ -+export srctree OUTPUT RM CC CXX LD AR CFLAGS CXXFLAGS V BISON FLEX AWK -+export HOSTCC HOSTLD HOSTAR -+ -+include $(srctree)/tools/build/Makefile.include -+ -+ifeq ($(force_fixdep),1) -+goals := $(filter-out all sub-make, $(MAKECMDGOALS)) -+ -+$(goals) all: sub-make -+ -+sub-make: fixdep -+ $(Q)$(MAKE) FIXDEP=1 -f Makefile.perf $(goals) -+ -+else # force_fixdep -+ - # Set FEATURE_TESTS to 'all' so all possible feature checkers are executed. - # Without this setting the output feature dump file misses some features, for - # example, liberty. Select all checkers so we won't get an incomplete feature -@@ -348,10 +377,6 @@ strip: $(PROGRAMS) $(OUTPUT)perf - - PERF_IN := $(OUTPUT)perf-in.o - --export srctree OUTPUT RM CC LD AR CFLAGS V BISON FLEX AWK --export HOSTCC HOSTLD HOSTAR --include $(srctree)/tools/build/Makefile.include -- - JEVENTS := $(OUTPUT)pmu-events/jevents - JEVENTS_IN := $(OUTPUT)pmu-events/jevents-in.o - -@@ -470,7 +495,7 @@ $(OUTPUT)perf: $(PERFLIBS) $(PERF_IN) $( - $(QUIET_LINK)$(CC) $(CFLAGS) $(LDFLAGS) $(LIBTRACEEVENT_DYNAMIC_LIST_LDFLAGS) \ - $(PERF_IN) $(PMU_EVENTS_IN) $(LIBS) -o $@ - --$(GTK_IN): fixdep FORCE -+$(GTK_IN): FORCE - $(Q)$(MAKE) $(build)=gtk - - $(OUTPUT)libperf-gtk.so: $(GTK_IN) $(PERFLIBS) -@@ -515,7 +540,7 @@ endif - __build-dir = $(subst $(OUTPUT),,$(dir $@)) - build-dir = $(if $(__build-dir),$(__build-dir),.) - --prepare: $(OUTPUT)PERF-VERSION-FILE $(OUTPUT)common-cmds.h fixdep archheaders -+prepare: $(OUTPUT)PERF-VERSION-FILE $(OUTPUT)common-cmds.h archheaders - - $(OUTPUT)%.o: %.c prepare FORCE - $(Q)$(MAKE) -f $(srctree)/tools/build/Makefile.build dir=$(build-dir) $@ -@@ -555,7 +580,7 @@ $(patsubst perf-%,%.o,$(PROGRAMS)): $(wi - - LIBPERF_IN := $(OUTPUT)libperf-in.o - --$(LIBPERF_IN): prepare fixdep FORCE -+$(LIBPERF_IN): prepare FORCE - $(Q)$(MAKE) $(build)=libperf - - $(LIB_FILE): $(LIBPERF_IN) -@@ -563,10 +588,10 @@ $(LIB_FILE): $(LIBPERF_IN) - - LIBTRACEEVENT_FLAGS += plugin_dir=$(plugindir_SQ) - --$(LIBTRACEEVENT): fixdep FORCE -+$(LIBTRACEEVENT): FORCE - $(Q)$(MAKE) -C $(TRACE_EVENT_DIR) $(LIBTRACEEVENT_FLAGS) O=$(OUTPUT) $(OUTPUT)libtraceevent.a - --libtraceevent_plugins: fixdep FORCE -+libtraceevent_plugins: FORCE - $(Q)$(MAKE) -C $(TRACE_EVENT_DIR) $(LIBTRACEEVENT_FLAGS) O=$(OUTPUT) plugins - - $(LIBTRACEEVENT_DYNAMIC_LIST): libtraceevent_plugins -@@ -579,21 +604,21 @@ $(LIBTRACEEVENT)-clean: - install-traceevent-plugins: libtraceevent_plugins - $(Q)$(MAKE) -C $(TRACE_EVENT_DIR) $(LIBTRACEEVENT_FLAGS) O=$(OUTPUT) install_plugins - --$(LIBAPI): fixdep FORCE -+$(LIBAPI): FORCE - $(Q)$(MAKE) -C $(LIB_DIR) O=$(OUTPUT) $(OUTPUT)libapi.a - - $(LIBAPI)-clean: - $(call QUIET_CLEAN, libapi) - $(Q)$(MAKE) -C $(LIB_DIR) O=$(OUTPUT) clean >/dev/null - --$(LIBBPF): fixdep FORCE -+$(LIBBPF): FORCE - $(Q)$(MAKE) -C $(BPF_DIR) O=$(OUTPUT) $(OUTPUT)libbpf.a FEATURES_DUMP=$(FEATURE_DUMP_EXPORT) - - $(LIBBPF)-clean: - $(call QUIET_CLEAN, libbpf) - $(Q)$(MAKE) -C $(BPF_DIR) O=$(OUTPUT) clean >/dev/null - --$(LIBSUBCMD): fixdep FORCE -+$(LIBSUBCMD): FORCE - $(Q)$(MAKE) -C $(SUBCMD_DIR) O=$(OUTPUT) $(OUTPUT)libsubcmd.a - - $(LIBSUBCMD)-clean: -@@ -790,3 +815,4 @@ FORCE: - .PHONY: $(GIT-HEAD-PHONY) TAGS tags cscope FORCE prepare - .PHONY: libtraceevent_plugins archheaders - -+endif # force_fixdep diff --git a/kernel/tools/cpupowertools/files/patches/mageia/tools-perf-tools-Move-perf-build-related-variables-under-n.patch b/kernel/tools/cpupowertools/files/patches/mageia/tools-perf-tools-Move-perf-build-related-variables-under-n.patch deleted file mode 100644 index 9b50c1cd..00000000 --- a/kernel/tools/cpupowertools/files/patches/mageia/tools-perf-tools-Move-perf-build-related-variables-under-n.patch +++ /dev/null @@ -1,49 +0,0 @@ -From 8ac1eb7bab7c8d9d6f00b3e2a408611c45d9dff0 Mon Sep 17 00:00:00 2001 -From: Jiri Olsa -Date: Tue, 6 Dec 2016 14:18:50 +0100 -Subject: [PATCH] perf tools: Move perf build related variables under non - fixdep leg - -Because there's no need for them in fixdep build. - -Signed-off-by: Jiri Olsa -Cc: David Ahern -Cc: Namhyung Kim -Cc: Peter Zijlstra -Link: http://lkml.kernel.org/r/1481030331-31944-4-git-send-email-jolsa@kernel.org -Signed-off-by: Arnaldo Carvalho de Melo ---- - tools/perf/Makefile.perf | 10 +++++----- - 1 file changed, 5 insertions(+), 5 deletions(-) - -diff --git a/tools/perf/Makefile.perf b/tools/perf/Makefile.perf -index 33b1d9f..8f1c258 100644 ---- a/tools/perf/Makefile.perf -+++ b/tools/perf/Makefile.perf -@@ -164,11 +164,6 @@ BISON = bison - STRIP = strip - AWK = awk - --LIB_DIR = $(srctree)/tools/lib/api/ --TRACE_EVENT_DIR = $(srctree)/tools/lib/traceevent/ --BPF_DIR = $(srctree)/tools/lib/bpf/ --SUBCMD_DIR = $(srctree)/tools/lib/subcmd/ -- - # include Makefile.config by default and rule out - # non-config cases - config := 1 -@@ -210,6 +205,11 @@ sub-make: fixdep - - else # force_fixdep - -+LIB_DIR = $(srctree)/tools/lib/api/ -+TRACE_EVENT_DIR = $(srctree)/tools/lib/traceevent/ -+BPF_DIR = $(srctree)/tools/lib/bpf/ -+SUBCMD_DIR = $(srctree)/tools/lib/subcmd/ -+ - # Set FEATURE_TESTS to 'all' so all possible feature checkers are executed. - # Without this setting the output feature dump file misses some features, for - # example, liberty. Select all checkers so we won't get an incomplete feature --- -2.10.2 - diff --git a/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0070-nospec-Kill-array_index_nospec_mask_check.patch b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0070-nospec-Kill-array_index_nospec_mask_check.patch new file mode 100644 index 00000000..4ae8d54f --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0070-nospec-Kill-array_index_nospec_mask_check.patch @@ -0,0 +1,82 @@ +From 1d91c1d2c80cb70e2e553845e278b87a960c04da Mon Sep 17 00:00:00 2001 +From: Dan Williams +Date: Fri, 16 Feb 2018 13:20:42 -0800 +Subject: [PATCH 70/77] nospec: Kill array_index_nospec_mask_check() + +There are multiple problems with the dynamic sanity checking in +array_index_nospec_mask_check(): + +* It causes unnecessary overhead in the 32-bit case since integer sized + @index values will no longer cause the check to be compiled away like + in the 64-bit case. + +* In the 32-bit case it may trigger with user controllable input when + the expectation is that should only trigger during development of new + kernel enabling. + +* The macro reuses the input parameter in multiple locations which is + broken if someone passes an expression like 'index++' to + array_index_nospec(). + +Reported-by: Linus Torvalds +Signed-off-by: Dan Williams +Cc: Andy Lutomirski +Cc: Arjan van de Ven +Cc: Borislav Petkov +Cc: Dave Hansen +Cc: David Woodhouse +Cc: Greg Kroah-Hartman +Cc: Josh Poimboeuf +Cc: Peter Zijlstra +Cc: Thomas Gleixner +Cc: Will Deacon +Cc: linux-arch@vger.kernel.org +Link: http://lkml.kernel.org/r/151881604278.17395.6605847763178076520.stgit@dwillia2-desk3.amr.corp.intel.com +Signed-off-by: Ingo Molnar +--- + include/linux/nospec.h | 22 +--------------------- + 1 file changed, 1 insertion(+), 21 deletions(-) + +diff --git a/include/linux/nospec.h b/include/linux/nospec.h +index fbc98e2c8228..d6701e34424f 100644 +--- a/include/linux/nospec.h ++++ b/include/linux/nospec.h +@@ -29,26 +29,6 @@ static inline unsigned long array_index_mask_nospec(unsigned long index, + } + #endif + +-/* +- * Warn developers about inappropriate array_index_nospec() usage. +- * +- * Even if the CPU speculates past the WARN_ONCE branch, the +- * sign bit of @index is taken into account when generating the +- * mask. +- * +- * This warning is compiled out when the compiler can infer that +- * @index and @size are less than LONG_MAX. +- */ +-#define array_index_mask_nospec_check(index, size) \ +-({ \ +- if (WARN_ONCE(index > LONG_MAX || size > LONG_MAX, \ +- "array_index_nospec() limited to range of [0, LONG_MAX]\n")) \ +- _mask = 0; \ +- else \ +- _mask = array_index_mask_nospec(index, size); \ +- _mask; \ +-}) +- + /* + * array_index_nospec - sanitize an array index after a bounds check + * +@@ -67,7 +47,7 @@ static inline unsigned long array_index_mask_nospec(unsigned long index, + ({ \ + typeof(index) _i = (index); \ + typeof(size) _s = (size); \ +- unsigned long _mask = array_index_mask_nospec_check(_i, _s); \ ++ unsigned long _mask = array_index_mask_nospec(_i, _s); \ + \ + BUILD_BUG_ON(sizeof(_i) > sizeof(long)); \ + BUILD_BUG_ON(sizeof(_s) > sizeof(long)); \ +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0071-nospec-Allow-index-argument-to-have-const-qualified-.patch b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0071-nospec-Allow-index-argument-to-have-const-qualified-.patch new file mode 100644 index 00000000..4541193c --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0071-nospec-Allow-index-argument-to-have-const-qualified-.patch @@ -0,0 +1,65 @@ +From b98c6a160a057d5686a8c54c79cc6c8c94a7d0c8 Mon Sep 17 00:00:00 2001 +From: Rasmus Villemoes +Date: Fri, 16 Feb 2018 13:20:48 -0800 +Subject: [PATCH 71/77] nospec: Allow index argument to have const-qualified + type + +The last expression in a statement expression need not be a bare +variable, quoting gcc docs + + The last thing in the compound statement should be an expression + followed by a semicolon; the value of this subexpression serves as the + value of the entire construct. + +and we already use that in e.g. the min/max macros which end with a +ternary expression. + +This way, we can allow index to have const-qualified type, which will in +some cases avoid the need for introducing a local copy of index of +non-const qualified type. That, in turn, can prevent readers not +familiar with the internals of array_index_nospec from wondering about +the seemingly redundant extra variable, and I think that's worthwhile +considering how confusing the whole _nospec business is. + +The expression _i&_mask has type unsigned long (since that is the type +of _mask, and the BUILD_BUG_ONs guarantee that _i will get promoted to +that), so in order not to change the type of the whole expression, add +a cast back to typeof(_i). + +Signed-off-by: Rasmus Villemoes +Signed-off-by: Dan Williams +Acked-by: Linus Torvalds +Cc: Andy Lutomirski +Cc: Arjan van de Ven +Cc: Borislav Petkov +Cc: Dave Hansen +Cc: David Woodhouse +Cc: Greg Kroah-Hartman +Cc: Josh Poimboeuf +Cc: Peter Zijlstra +Cc: Thomas Gleixner +Cc: Will Deacon +Cc: linux-arch@vger.kernel.org +Cc: stable@vger.kernel.org +Link: http://lkml.kernel.org/r/151881604837.17395.10812767547837568328.stgit@dwillia2-desk3.amr.corp.intel.com +Signed-off-by: Ingo Molnar +--- + include/linux/nospec.h | 3 +-- + 1 file changed, 1 insertion(+), 2 deletions(-) + +diff --git a/include/linux/nospec.h b/include/linux/nospec.h +index d6701e34424f..172a19dc35ab 100644 +--- a/include/linux/nospec.h ++++ b/include/linux/nospec.h +@@ -52,7 +52,6 @@ static inline unsigned long array_index_mask_nospec(unsigned long index, + BUILD_BUG_ON(sizeof(_i) > sizeof(long)); \ + BUILD_BUG_ON(sizeof(_s) > sizeof(long)); \ + \ +- _i &= _mask; \ +- _i; \ ++ (typeof(_i)) (_i & _mask); \ + }) + #endif /* _LINUX_NOSPEC_H */ +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0072-nospec-Include-asm-barrier.h-dependency.patch b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0072-nospec-Include-asm-barrier.h-dependency.patch new file mode 100644 index 00000000..ec39f3a9 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0072-nospec-Include-asm-barrier.h-dependency.patch @@ -0,0 +1,48 @@ +From eb6174f6d1be16b19cfa43dac296bfed003ce1a6 Mon Sep 17 00:00:00 2001 +From: Dan Williams +Date: Fri, 16 Feb 2018 13:20:54 -0800 +Subject: [PATCH 72/77] nospec: Include dependency + +The nospec.h header expects the per-architecture header file + to optionally define array_index_mask_nospec(). Include +that dependency to prevent inadvertent fallback to the default +array_index_mask_nospec() implementation. + +The default implementation may not provide a full mitigation +on architectures that perform data value speculation. + +Reported-by: Christian Borntraeger +Signed-off-by: Dan Williams +Cc: Andy Lutomirski +Cc: Arjan van de Ven +Cc: Borislav Petkov +Cc: Dave Hansen +Cc: David Woodhouse +Cc: Greg Kroah-Hartman +Cc: Josh Poimboeuf +Cc: Linus Torvalds +Cc: Peter Zijlstra +Cc: Thomas Gleixner +Cc: Will Deacon +Cc: linux-arch@vger.kernel.org +Link: http://lkml.kernel.org/r/151881605404.17395.1341935530792574707.stgit@dwillia2-desk3.amr.corp.intel.com +Signed-off-by: Ingo Molnar +--- + include/linux/nospec.h | 1 + + 1 file changed, 1 insertion(+) + +diff --git a/include/linux/nospec.h b/include/linux/nospec.h +index 172a19dc35ab..e791ebc65c9c 100644 +--- a/include/linux/nospec.h ++++ b/include/linux/nospec.h +@@ -5,6 +5,7 @@ + + #ifndef _LINUX_NOSPEC_H + #define _LINUX_NOSPEC_H ++#include + + /** + * array_index_mask_nospec() - generate a ~0 mask when index < size, 0 otherwise +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0073-x86-microcode-Propagate-return-value-from-updating-f.patch b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0073-x86-microcode-Propagate-return-value-from-updating-f.patch new file mode 100644 index 00000000..8145d620 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0073-x86-microcode-Propagate-return-value-from-updating-f.patch @@ -0,0 +1,235 @@ +From 3f1f576a195aa266813cbd4ca70291deb61e0129 Mon Sep 17 00:00:00 2001 +From: Borislav Petkov +Date: Fri, 16 Feb 2018 12:26:38 +0100 +Subject: [PATCH 73/77] x86/microcode: Propagate return value from updating + functions + +... so that callers can know when microcode was updated and act +accordingly. + +Tested-by: Ashok Raj +Signed-off-by: Borislav Petkov +Reviewed-by: Ashok Raj +Cc: Andy Lutomirski +Cc: Arjan van de Ven +Cc: Borislav Petkov +Cc: Dan Williams +Cc: Dave Hansen +Cc: David Woodhouse +Cc: Greg Kroah-Hartman +Cc: Josh Poimboeuf +Cc: Linus Torvalds +Cc: Peter Zijlstra +Cc: Thomas Gleixner +Link: http://lkml.kernel.org/r/20180216112640.11554-2-bp@alien8.de +Signed-off-by: Ingo Molnar +--- + arch/x86/include/asm/microcode.h | 9 +++++++-- + arch/x86/kernel/cpu/microcode/amd.c | 10 +++++----- + arch/x86/kernel/cpu/microcode/core.c | 33 +++++++++++++++++---------------- + arch/x86/kernel/cpu/microcode/intel.c | 10 +++++----- + 4 files changed, 34 insertions(+), 28 deletions(-) + +diff --git a/arch/x86/include/asm/microcode.h b/arch/x86/include/asm/microcode.h +index 55520cec8b27..7fb1047d61c7 100644 +--- a/arch/x86/include/asm/microcode.h ++++ b/arch/x86/include/asm/microcode.h +@@ -37,7 +37,12 @@ struct cpu_signature { + + struct device; + +-enum ucode_state { UCODE_ERROR, UCODE_OK, UCODE_NFOUND }; ++enum ucode_state { ++ UCODE_OK = 0, ++ UCODE_UPDATED, ++ UCODE_NFOUND, ++ UCODE_ERROR, ++}; + + struct microcode_ops { + enum ucode_state (*request_microcode_user) (int cpu, +@@ -54,7 +59,7 @@ struct microcode_ops { + * are being called. + * See also the "Synchronization" section in microcode_core.c. + */ +- int (*apply_microcode) (int cpu); ++ enum ucode_state (*apply_microcode) (int cpu); + int (*collect_cpu_info) (int cpu, struct cpu_signature *csig); + }; + +diff --git a/arch/x86/kernel/cpu/microcode/amd.c b/arch/x86/kernel/cpu/microcode/amd.c +index 330b8462d426..a998e1a7d46f 100644 +--- a/arch/x86/kernel/cpu/microcode/amd.c ++++ b/arch/x86/kernel/cpu/microcode/amd.c +@@ -498,7 +498,7 @@ static unsigned int verify_patch_size(u8 family, u32 patch_size, + return patch_size; + } + +-static int apply_microcode_amd(int cpu) ++static enum ucode_state apply_microcode_amd(int cpu) + { + struct cpuinfo_x86 *c = &cpu_data(cpu); + struct microcode_amd *mc_amd; +@@ -512,7 +512,7 @@ static int apply_microcode_amd(int cpu) + + p = find_patch(cpu); + if (!p) +- return 0; ++ return UCODE_NFOUND; + + mc_amd = p->data; + uci->mc = p->data; +@@ -523,13 +523,13 @@ static int apply_microcode_amd(int cpu) + if (rev >= mc_amd->hdr.patch_id) { + c->microcode = rev; + uci->cpu_sig.rev = rev; +- return 0; ++ return UCODE_OK; + } + + if (__apply_microcode_amd(mc_amd)) { + pr_err("CPU%d: update failed for patch_level=0x%08x\n", + cpu, mc_amd->hdr.patch_id); +- return -1; ++ return UCODE_ERROR; + } + pr_info("CPU%d: new patch_level=0x%08x\n", cpu, + mc_amd->hdr.patch_id); +@@ -537,7 +537,7 @@ static int apply_microcode_amd(int cpu) + uci->cpu_sig.rev = mc_amd->hdr.patch_id; + c->microcode = mc_amd->hdr.patch_id; + +- return 0; ++ return UCODE_UPDATED; + } + + static int install_equiv_cpu_table(const u8 *buf) +diff --git a/arch/x86/kernel/cpu/microcode/core.c b/arch/x86/kernel/cpu/microcode/core.c +index 319dd65f98a2..6fdaf7cf3182 100644 +--- a/arch/x86/kernel/cpu/microcode/core.c ++++ b/arch/x86/kernel/cpu/microcode/core.c +@@ -374,7 +374,7 @@ static int collect_cpu_info(int cpu) + } + + struct apply_microcode_ctx { +- int err; ++ enum ucode_state err; + }; + + static void apply_microcode_local(void *arg) +@@ -489,31 +489,29 @@ static void __exit microcode_dev_exit(void) + /* fake device for request_firmware */ + static struct platform_device *microcode_pdev; + +-static int reload_for_cpu(int cpu) ++static enum ucode_state reload_for_cpu(int cpu) + { + struct ucode_cpu_info *uci = ucode_cpu_info + cpu; + enum ucode_state ustate; +- int err = 0; + + if (!uci->valid) +- return err; ++ return UCODE_OK; + + ustate = microcode_ops->request_microcode_fw(cpu, µcode_pdev->dev, true); +- if (ustate == UCODE_OK) +- apply_microcode_on_target(cpu); +- else +- if (ustate == UCODE_ERROR) +- err = -EINVAL; +- return err; ++ if (ustate != UCODE_OK) ++ return ustate; ++ ++ return apply_microcode_on_target(cpu); + } + + static ssize_t reload_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t size) + { ++ enum ucode_state tmp_ret = UCODE_OK; + unsigned long val; ++ ssize_t ret = 0; + int cpu; +- ssize_t ret = 0, tmp_ret; + + ret = kstrtoul(buf, 0, &val); + if (ret) +@@ -526,15 +524,18 @@ static ssize_t reload_store(struct device *dev, + mutex_lock(µcode_mutex); + for_each_online_cpu(cpu) { + tmp_ret = reload_for_cpu(cpu); +- if (tmp_ret != 0) ++ if (tmp_ret > UCODE_NFOUND) { + pr_warn("Error reloading microcode on CPU %d\n", cpu); + +- /* save retval of the first encountered reload error */ +- if (!ret) +- ret = tmp_ret; ++ /* set retval for the first encountered reload error */ ++ if (!ret) ++ ret = -EINVAL; ++ } + } +- if (!ret) ++ ++ if (!ret && tmp_ret == UCODE_UPDATED) + perf_check_microcode(); ++ + mutex_unlock(µcode_mutex); + put_online_cpus(); + +diff --git a/arch/x86/kernel/cpu/microcode/intel.c b/arch/x86/kernel/cpu/microcode/intel.c +index a15db2b4e0d6..923054a6b760 100644 +--- a/arch/x86/kernel/cpu/microcode/intel.c ++++ b/arch/x86/kernel/cpu/microcode/intel.c +@@ -772,7 +772,7 @@ static int collect_cpu_info(int cpu_num, struct cpu_signature *csig) + return 0; + } + +-static int apply_microcode_intel(int cpu) ++static enum ucode_state apply_microcode_intel(int cpu) + { + struct microcode_intel *mc; + struct ucode_cpu_info *uci; +@@ -782,7 +782,7 @@ static int apply_microcode_intel(int cpu) + + /* We should bind the task to the CPU */ + if (WARN_ON(raw_smp_processor_id() != cpu)) +- return -1; ++ return UCODE_ERROR; + + uci = ucode_cpu_info + cpu; + mc = uci->mc; +@@ -790,7 +790,7 @@ static int apply_microcode_intel(int cpu) + /* Look for a newer patch in our cache: */ + mc = find_patch(uci); + if (!mc) +- return 0; ++ return UCODE_NFOUND; + } + + /* write microcode via MSR 0x79 */ +@@ -801,7 +801,7 @@ static int apply_microcode_intel(int cpu) + if (rev != mc->hdr.rev) { + pr_err("CPU%d update to revision 0x%x failed\n", + cpu, mc->hdr.rev); +- return -1; ++ return UCODE_ERROR; + } + + if (rev != prev_rev) { +@@ -818,7 +818,7 @@ static int apply_microcode_intel(int cpu) + uci->cpu_sig.rev = rev; + c->microcode = rev; + +- return 0; ++ return UCODE_UPDATED; + } + + static enum ucode_state generic_load_microcode(int cpu, void *data, size_t size, +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0074-x86-CPU-Add-a-microcode-loader-callback.patch b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0074-x86-CPU-Add-a-microcode-loader-callback.patch new file mode 100644 index 00000000..d131de54 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0074-x86-CPU-Add-a-microcode-loader-callback.patch @@ -0,0 +1,90 @@ +From 1008c52c09dcb23d93f8e0ea83a6246265d2cce0 Mon Sep 17 00:00:00 2001 +From: Borislav Petkov +Date: Fri, 16 Feb 2018 12:26:39 +0100 +Subject: [PATCH 74/77] x86/CPU: Add a microcode loader callback + +Add a callback function which the microcode loader calls when microcode +has been updated to a newer revision. Do the callback only when no error +was encountered during loading. + +Tested-by: Ashok Raj +Signed-off-by: Borislav Petkov +Reviewed-by: Ashok Raj +Cc: Andy Lutomirski +Cc: Arjan van de Ven +Cc: Borislav Petkov +Cc: Dan Williams +Cc: Dave Hansen +Cc: David Woodhouse +Cc: Greg Kroah-Hartman +Cc: Josh Poimboeuf +Cc: Linus Torvalds +Cc: Peter Zijlstra +Cc: Thomas Gleixner +Link: http://lkml.kernel.org/r/20180216112640.11554-3-bp@alien8.de +Signed-off-by: Ingo Molnar +--- + arch/x86/include/asm/processor.h | 1 + + arch/x86/kernel/cpu/common.c | 10 ++++++++++ + arch/x86/kernel/cpu/microcode/core.c | 8 ++++++-- + 3 files changed, 17 insertions(+), 2 deletions(-) + +diff --git a/arch/x86/include/asm/processor.h b/arch/x86/include/asm/processor.h +index 1bd9ed87606f..b0ccd4847a58 100644 +--- a/arch/x86/include/asm/processor.h ++++ b/arch/x86/include/asm/processor.h +@@ -977,4 +977,5 @@ bool xen_set_default_idle(void); + + void stop_this_cpu(void *dummy); + void df_debug(struct pt_regs *regs, long error_code); ++void microcode_check(void); + #endif /* _ASM_X86_PROCESSOR_H */ +diff --git a/arch/x86/kernel/cpu/common.c b/arch/x86/kernel/cpu/common.c +index 824aee0117bb..84f1cd88608b 100644 +--- a/arch/x86/kernel/cpu/common.c ++++ b/arch/x86/kernel/cpu/common.c +@@ -1749,3 +1749,13 @@ static int __init init_cpu_syscore(void) + return 0; + } + core_initcall(init_cpu_syscore); ++ ++/* ++ * The microcode loader calls this upon late microcode load to recheck features, ++ * only when microcode has been updated. Caller holds microcode_mutex and CPU ++ * hotplug lock. ++ */ ++void microcode_check(void) ++{ ++ perf_check_microcode(); ++} +diff --git a/arch/x86/kernel/cpu/microcode/core.c b/arch/x86/kernel/cpu/microcode/core.c +index 6fdaf7cf3182..aa1b9a422f2b 100644 +--- a/arch/x86/kernel/cpu/microcode/core.c ++++ b/arch/x86/kernel/cpu/microcode/core.c +@@ -509,6 +509,7 @@ static ssize_t reload_store(struct device *dev, + const char *buf, size_t size) + { + enum ucode_state tmp_ret = UCODE_OK; ++ bool do_callback = false; + unsigned long val; + ssize_t ret = 0; + int cpu; +@@ -531,10 +532,13 @@ static ssize_t reload_store(struct device *dev, + if (!ret) + ret = -EINVAL; + } ++ ++ if (tmp_ret == UCODE_UPDATED) ++ do_callback = true; + } + +- if (!ret && tmp_ret == UCODE_UPDATED) +- perf_check_microcode(); ++ if (!ret && do_callback) ++ microcode_check(); + + mutex_unlock(µcode_mutex); + put_online_cpus(); +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0075-x86-CPU-Check-CPU-feature-bits-after-microcode-upgra.patch b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0075-x86-CPU-Check-CPU-feature-bits-after-microcode-upgra.patch new file mode 100644 index 00000000..904ca0c0 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0075-x86-CPU-Check-CPU-feature-bits-after-microcode-upgra.patch @@ -0,0 +1,64 @@ +From 42ca8082e260dcfd8afa2afa6ec1940b9d41724c Mon Sep 17 00:00:00 2001 +From: Borislav Petkov +Date: Fri, 16 Feb 2018 12:26:40 +0100 +Subject: [PATCH 75/77] x86/CPU: Check CPU feature bits after microcode upgrade + +With some microcode upgrades, new CPUID features can become visible on +the CPU. Check what the kernel has mirrored now and issue a warning +hinting at possible things the user/admin can do to make use of the +newly visible features. + +Originally-by: Ashok Raj +Tested-by: Ashok Raj +Signed-off-by: Borislav Petkov +Reviewed-by: Ashok Raj +Cc: Andy Lutomirski +Cc: Arjan van de Ven +Cc: Borislav Petkov +Cc: Dan Williams +Cc: Dave Hansen +Cc: David Woodhouse +Cc: Greg Kroah-Hartman +Cc: Josh Poimboeuf +Cc: Linus Torvalds +Cc: Peter Zijlstra +Cc: Thomas Gleixner +Link: http://lkml.kernel.org/r/20180216112640.11554-4-bp@alien8.de +Signed-off-by: Ingo Molnar +--- + arch/x86/kernel/cpu/common.c | 20 ++++++++++++++++++++ + 1 file changed, 20 insertions(+) + +diff --git a/arch/x86/kernel/cpu/common.c b/arch/x86/kernel/cpu/common.c +index 84f1cd88608b..348cf4821240 100644 +--- a/arch/x86/kernel/cpu/common.c ++++ b/arch/x86/kernel/cpu/common.c +@@ -1757,5 +1757,25 @@ core_initcall(init_cpu_syscore); + */ + void microcode_check(void) + { ++ struct cpuinfo_x86 info; ++ + perf_check_microcode(); ++ ++ /* Reload CPUID max function as it might've changed. */ ++ info.cpuid_level = cpuid_eax(0); ++ ++ /* ++ * Copy all capability leafs to pick up the synthetic ones so that ++ * memcmp() below doesn't fail on that. The ones coming from CPUID will ++ * get overwritten in get_cpu_cap(). ++ */ ++ memcpy(&info.x86_capability, &boot_cpu_data.x86_capability, sizeof(info.x86_capability)); ++ ++ get_cpu_cap(&info); ++ ++ if (!memcmp(&info.x86_capability, &boot_cpu_data.x86_capability, sizeof(info.x86_capability))) ++ return; ++ ++ pr_warn("x86/CPU: CPU features have changed after loading microcode, but might not take effect.\n"); ++ pr_warn("x86/CPU: Please consider either early loading through initrd/built-in or a potential BIOS update.\n"); + } +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0076-x86-entry-Reduce-the-code-footprint-of-the-idtentry-.patch b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0076-x86-entry-Reduce-the-code-footprint-of-the-idtentry-.patch new file mode 100644 index 00000000..55cfe055 --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0076-x86-entry-Reduce-the-code-footprint-of-the-idtentry-.patch @@ -0,0 +1,140 @@ +From 9e809d15d6b692fa061d74be7aaab1c79f6784b8 Mon Sep 17 00:00:00 2001 +From: Dominik Brodowski +Date: Wed, 14 Feb 2018 18:59:23 +0100 +Subject: [PATCH 76/77] x86/entry: Reduce the code footprint of the 'idtentry' + macro + +Play a little trick in the generic PUSH_AND_CLEAR_REGS macro +to insert the GP registers "above" the original return address. + +This allows us to (re-)insert the macro in error_entry() and +paranoid_entry() and to remove it from the idtentry macro. This +reduces the static footprint significantly: + + text data bss dec hex filename + 24307 0 0 24307 5ef3 entry_64.o-orig + 20987 0 0 20987 51fb entry_64.o + +Co-developed-by: Linus Torvalds +Signed-off-by: Dominik Brodowski +Cc: Andy Lutomirski +Cc: Arjan van de Ven +Cc: Borislav Petkov +Cc: Dan Williams +Cc: Dave Hansen +Cc: David Woodhouse +Cc: Greg Kroah-Hartman +Cc: Josh Poimboeuf +Cc: Linus Torvalds +Cc: Peter Zijlstra +Cc: Thomas Gleixner +Link: http://lkml.kernel.org/r/20180214175924.23065-2-linux@dominikbrodowski.net +[ Small tweaks to comments. ] +Signed-off-by: Ingo Molnar +--- + arch/x86/entry/calling.h | 11 ++++++++++- + arch/x86/entry/entry_64.S | 18 ++++++++---------- + 2 files changed, 18 insertions(+), 11 deletions(-) + +diff --git a/arch/x86/entry/calling.h b/arch/x86/entry/calling.h +index dce7092ab24a..196b6103edf6 100644 +--- a/arch/x86/entry/calling.h ++++ b/arch/x86/entry/calling.h +@@ -97,7 +97,7 @@ For 32-bit we have the following conventions - kernel is built with + + #define SIZEOF_PTREGS 21*8 + +-.macro PUSH_AND_CLEAR_REGS rdx=%rdx rax=%rax ++.macro PUSH_AND_CLEAR_REGS rdx=%rdx rax=%rax save_ret=0 + /* + * Push registers and sanitize registers of values that a + * speculation attack might otherwise want to exploit. The +@@ -105,8 +105,14 @@ For 32-bit we have the following conventions - kernel is built with + * could be put to use in a speculative execution gadget. + * Interleave XOR with PUSH for better uop scheduling: + */ ++ .if \save_ret ++ pushq %rsi /* pt_regs->si */ ++ movq 8(%rsp), %rsi /* temporarily store the return address in %rsi */ ++ movq %rdi, 8(%rsp) /* pt_regs->di (overwriting original return address) */ ++ .else + pushq %rdi /* pt_regs->di */ + pushq %rsi /* pt_regs->si */ ++ .endif + pushq \rdx /* pt_regs->dx */ + pushq %rcx /* pt_regs->cx */ + pushq \rax /* pt_regs->ax */ +@@ -131,6 +137,9 @@ For 32-bit we have the following conventions - kernel is built with + pushq %r15 /* pt_regs->r15 */ + xorq %r15, %r15 /* nospec r15*/ + UNWIND_HINT_REGS ++ .if \save_ret ++ pushq %rsi /* return address on top of stack */ ++ .endif + .endm + + .macro POP_REGS pop_rdi=1 skip_r11rcx=0 +diff --git a/arch/x86/entry/entry_64.S b/arch/x86/entry/entry_64.S +index 8971bd64d515..77edc2390868 100644 +--- a/arch/x86/entry/entry_64.S ++++ b/arch/x86/entry/entry_64.S +@@ -875,12 +875,8 @@ ENTRY(\sym) + pushq $-1 /* ORIG_RAX: no syscall to restart */ + .endif + +- /* Save all registers in pt_regs */ +- PUSH_AND_CLEAR_REGS +- ENCODE_FRAME_POINTER +- + .if \paranoid < 2 +- testb $3, CS(%rsp) /* If coming from userspace, switch stacks */ ++ testb $3, CS-ORIG_RAX(%rsp) /* If coming from userspace, switch stacks */ + jnz .Lfrom_usermode_switch_stack_\@ + .endif + +@@ -1130,13 +1126,15 @@ idtentry machine_check do_mce has_error_code=0 paranoid=1 + #endif + + /* +- * Switch gs if needed. ++ * Save all registers in pt_regs, and switch gs if needed. + * Use slow, but surefire "are we in kernel?" check. + * Return: ebx=0: need swapgs on exit, ebx=1: otherwise + */ + ENTRY(paranoid_entry) + UNWIND_HINT_FUNC + cld ++ PUSH_AND_CLEAR_REGS save_ret=1 ++ ENCODE_FRAME_POINTER 8 + movl $1, %ebx + movl $MSR_GS_BASE, %ecx + rdmsr +@@ -1181,12 +1179,14 @@ ENTRY(paranoid_exit) + END(paranoid_exit) + + /* +- * Switch gs if needed. ++ * Save all registers in pt_regs, and switch GS if needed. + * Return: EBX=0: came from user mode; EBX=1: otherwise + */ + ENTRY(error_entry) +- UNWIND_HINT_REGS offset=8 ++ UNWIND_HINT_FUNC + cld ++ PUSH_AND_CLEAR_REGS save_ret=1 ++ ENCODE_FRAME_POINTER 8 + testb $3, CS+8(%rsp) + jz .Lerror_kernelspace + +@@ -1577,8 +1577,6 @@ end_repeat_nmi: + * frame to point back to repeat_nmi. + */ + pushq $-1 /* ORIG_RAX: no syscall to restart */ +- PUSH_AND_CLEAR_REGS +- ENCODE_FRAME_POINTER + + /* + * Use paranoid_entry to handle SWAPGS, but no need to use paranoid_exit +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0077-x86-entry-64-Use-xorl-for-faster-register-clearing.patch b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0077-x86-entry-64-Use-xorl-for-faster-register-clearing.patch new file mode 100644 index 00000000..1d59822c --- /dev/null +++ b/kernel/tools/cpupowertools/files/patches/mageia/x86-pti-0077-x86-entry-64-Use-xorl-for-faster-register-clearing.patch @@ -0,0 +1,202 @@ +From ced5d0bf603fa0baee8ea889e1d70971fd210894 Mon Sep 17 00:00:00 2001 +From: Dominik Brodowski +Date: Wed, 14 Feb 2018 18:59:24 +0100 +Subject: [PATCH 77/77] x86/entry/64: Use 'xorl' for faster register clearing +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +On some x86 CPU microarchitectures using 'xorq' to clear general-purpose +registers is slower than 'xorl'. As 'xorl' is sufficient to clear all +64 bits of these registers due to zero-extension [*], switch the x86 +64-bit entry code to use 'xorl'. + +No change in functionality and no change in code size. + +[*] According to Intel 64 and IA-32 Architecture Software Developer's + Manual, section 3.4.1.1, the result of 32-bit operands are "zero- + extended to a 64-bit result in the destination general-purpose + register." The AMD64 Architecture Programmer’s Manual Volume 3, + Appendix B.1, describes the same behaviour. + +Suggested-by: Denys Vlasenko +Signed-off-by: Dominik Brodowski +Cc: Andy Lutomirski +Cc: Arjan van de Ven +Cc: Borislav Petkov +Cc: Dan Williams +Cc: Dave Hansen +Cc: David Woodhouse +Cc: Greg Kroah-Hartman +Cc: Josh Poimboeuf +Cc: Linus Torvalds +Cc: Peter Zijlstra +Cc: Thomas Gleixner +Link: http://lkml.kernel.org/r/20180214175924.23065-3-linux@dominikbrodowski.net +[ Improved on the changelog a bit. ] +Signed-off-by: Ingo Molnar +--- + arch/x86/entry/calling.h | 16 ++++++------ + arch/x86/entry/entry_64_compat.S | 54 ++++++++++++++++++++-------------------- + 2 files changed, 35 insertions(+), 35 deletions(-) + +diff --git a/arch/x86/entry/calling.h b/arch/x86/entry/calling.h +index 196b6103edf6..5d10b7a85cad 100644 +--- a/arch/x86/entry/calling.h ++++ b/arch/x86/entry/calling.h +@@ -117,25 +117,25 @@ For 32-bit we have the following conventions - kernel is built with + pushq %rcx /* pt_regs->cx */ + pushq \rax /* pt_regs->ax */ + pushq %r8 /* pt_regs->r8 */ +- xorq %r8, %r8 /* nospec r8 */ ++ xorl %r8d, %r8d /* nospec r8 */ + pushq %r9 /* pt_regs->r9 */ +- xorq %r9, %r9 /* nospec r9 */ ++ xorl %r9d, %r9d /* nospec r9 */ + pushq %r10 /* pt_regs->r10 */ +- xorq %r10, %r10 /* nospec r10 */ ++ xorl %r10d, %r10d /* nospec r10 */ + pushq %r11 /* pt_regs->r11 */ +- xorq %r11, %r11 /* nospec r11*/ ++ xorl %r11d, %r11d /* nospec r11*/ + pushq %rbx /* pt_regs->rbx */ + xorl %ebx, %ebx /* nospec rbx*/ + pushq %rbp /* pt_regs->rbp */ + xorl %ebp, %ebp /* nospec rbp*/ + pushq %r12 /* pt_regs->r12 */ +- xorq %r12, %r12 /* nospec r12*/ ++ xorl %r12d, %r12d /* nospec r12*/ + pushq %r13 /* pt_regs->r13 */ +- xorq %r13, %r13 /* nospec r13*/ ++ xorl %r13d, %r13d /* nospec r13*/ + pushq %r14 /* pt_regs->r14 */ +- xorq %r14, %r14 /* nospec r14*/ ++ xorl %r14d, %r14d /* nospec r14*/ + pushq %r15 /* pt_regs->r15 */ +- xorq %r15, %r15 /* nospec r15*/ ++ xorl %r15d, %r15d /* nospec r15*/ + UNWIND_HINT_REGS + .if \save_ret + pushq %rsi /* return address on top of stack */ +diff --git a/arch/x86/entry/entry_64_compat.S b/arch/x86/entry/entry_64_compat.S +index fd65e016e413..364ea4a207be 100644 +--- a/arch/x86/entry/entry_64_compat.S ++++ b/arch/x86/entry/entry_64_compat.S +@@ -85,25 +85,25 @@ ENTRY(entry_SYSENTER_compat) + pushq %rcx /* pt_regs->cx */ + pushq $-ENOSYS /* pt_regs->ax */ + pushq $0 /* pt_regs->r8 = 0 */ +- xorq %r8, %r8 /* nospec r8 */ ++ xorl %r8d, %r8d /* nospec r8 */ + pushq $0 /* pt_regs->r9 = 0 */ +- xorq %r9, %r9 /* nospec r9 */ ++ xorl %r9d, %r9d /* nospec r9 */ + pushq $0 /* pt_regs->r10 = 0 */ +- xorq %r10, %r10 /* nospec r10 */ ++ xorl %r10d, %r10d /* nospec r10 */ + pushq $0 /* pt_regs->r11 = 0 */ +- xorq %r11, %r11 /* nospec r11 */ ++ xorl %r11d, %r11d /* nospec r11 */ + pushq %rbx /* pt_regs->rbx */ + xorl %ebx, %ebx /* nospec rbx */ + pushq %rbp /* pt_regs->rbp (will be overwritten) */ + xorl %ebp, %ebp /* nospec rbp */ + pushq $0 /* pt_regs->r12 = 0 */ +- xorq %r12, %r12 /* nospec r12 */ ++ xorl %r12d, %r12d /* nospec r12 */ + pushq $0 /* pt_regs->r13 = 0 */ +- xorq %r13, %r13 /* nospec r13 */ ++ xorl %r13d, %r13d /* nospec r13 */ + pushq $0 /* pt_regs->r14 = 0 */ +- xorq %r14, %r14 /* nospec r14 */ ++ xorl %r14d, %r14d /* nospec r14 */ + pushq $0 /* pt_regs->r15 = 0 */ +- xorq %r15, %r15 /* nospec r15 */ ++ xorl %r15d, %r15d /* nospec r15 */ + cld + + /* +@@ -224,25 +224,25 @@ GLOBAL(entry_SYSCALL_compat_after_hwframe) + pushq %rbp /* pt_regs->cx (stashed in bp) */ + pushq $-ENOSYS /* pt_regs->ax */ + pushq $0 /* pt_regs->r8 = 0 */ +- xorq %r8, %r8 /* nospec r8 */ ++ xorl %r8d, %r8d /* nospec r8 */ + pushq $0 /* pt_regs->r9 = 0 */ +- xorq %r9, %r9 /* nospec r9 */ ++ xorl %r9d, %r9d /* nospec r9 */ + pushq $0 /* pt_regs->r10 = 0 */ +- xorq %r10, %r10 /* nospec r10 */ ++ xorl %r10d, %r10d /* nospec r10 */ + pushq $0 /* pt_regs->r11 = 0 */ +- xorq %r11, %r11 /* nospec r11 */ ++ xorl %r11d, %r11d /* nospec r11 */ + pushq %rbx /* pt_regs->rbx */ + xorl %ebx, %ebx /* nospec rbx */ + pushq %rbp /* pt_regs->rbp (will be overwritten) */ + xorl %ebp, %ebp /* nospec rbp */ + pushq $0 /* pt_regs->r12 = 0 */ +- xorq %r12, %r12 /* nospec r12 */ ++ xorl %r12d, %r12d /* nospec r12 */ + pushq $0 /* pt_regs->r13 = 0 */ +- xorq %r13, %r13 /* nospec r13 */ ++ xorl %r13d, %r13d /* nospec r13 */ + pushq $0 /* pt_regs->r14 = 0 */ +- xorq %r14, %r14 /* nospec r14 */ ++ xorl %r14d, %r14d /* nospec r14 */ + pushq $0 /* pt_regs->r15 = 0 */ +- xorq %r15, %r15 /* nospec r15 */ ++ xorl %r15d, %r15d /* nospec r15 */ + + /* + * User mode is traced as though IRQs are on, and SYSENTER +@@ -298,9 +298,9 @@ sysret32_from_system_call: + */ + SWITCH_TO_USER_CR3_NOSTACK scratch_reg=%r8 scratch_reg2=%r9 + +- xorq %r8, %r8 +- xorq %r9, %r9 +- xorq %r10, %r10 ++ xorl %r8d, %r8d ++ xorl %r9d, %r9d ++ xorl %r10d, %r10d + swapgs + sysretl + END(entry_SYSCALL_compat) +@@ -358,25 +358,25 @@ ENTRY(entry_INT80_compat) + pushq %rcx /* pt_regs->cx */ + pushq $-ENOSYS /* pt_regs->ax */ + pushq $0 /* pt_regs->r8 = 0 */ +- xorq %r8, %r8 /* nospec r8 */ ++ xorl %r8d, %r8d /* nospec r8 */ + pushq $0 /* pt_regs->r9 = 0 */ +- xorq %r9, %r9 /* nospec r9 */ ++ xorl %r9d, %r9d /* nospec r9 */ + pushq $0 /* pt_regs->r10 = 0 */ +- xorq %r10, %r10 /* nospec r10 */ ++ xorl %r10d, %r10d /* nospec r10 */ + pushq $0 /* pt_regs->r11 = 0 */ +- xorq %r11, %r11 /* nospec r11 */ ++ xorl %r11d, %r11d /* nospec r11 */ + pushq %rbx /* pt_regs->rbx */ + xorl %ebx, %ebx /* nospec rbx */ + pushq %rbp /* pt_regs->rbp */ + xorl %ebp, %ebp /* nospec rbp */ + pushq %r12 /* pt_regs->r12 */ +- xorq %r12, %r12 /* nospec r12 */ ++ xorl %r12d, %r12d /* nospec r12 */ + pushq %r13 /* pt_regs->r13 */ +- xorq %r13, %r13 /* nospec r13 */ ++ xorl %r13d, %r13d /* nospec r13 */ + pushq %r14 /* pt_regs->r14 */ +- xorq %r14, %r14 /* nospec r14 */ ++ xorl %r14d, %r14d /* nospec r14 */ + pushq %r15 /* pt_regs->r15 */ +- xorq %r15, %r15 /* nospec r15 */ ++ xorl %r15d, %r15d /* nospec r15 */ + cld + + /* +-- +2.16.1 + diff --git a/kernel/tools/cpupowertools/pspec.xml b/kernel/tools/cpupowertools/pspec.xml index 77c8fe61..c59b2d4e 100644 --- a/kernel/tools/cpupowertools/pspec.xml +++ b/kernel/tools/cpupowertools/pspec.xml @@ -12,28 +12,68 @@ app:console CPU power management tools cpupowertools contains utilities to manage power management and frequency scaling policies of modern CPUs. - https://www.kernel.org/pub/linux/kernel/v4.x/linux-4.9.tar.gz + https://www.kernel.org/pub/linux/kernel/v4.x/linux-4.14.tar.gz pciutils-devel - + - patches/linux/patch-4.9.75.xz - + patches/linux/patch-4.14.23.xz + + patches/mageia/x86-pci-toshiba-equium-a60-assign-busses.patch + patches/mageia/x86-boot-video-80x25-if-break.patch + patches/mageia/x86-default_poweroff_up_machines.patch + patches/mageia/x86-increase-default-minimum-vmalloc-area-by-64MB-to-192MB.patch patches/mageia/Revert-cpufreq-pcc-Enable-autoload-of-pcc-cpufreq-fo.patch - patches/mageia/base-cacheinfo-silence-DT-warnings.patch - patches/mageia/iommu-amd-flush-IOTLB-for-specific-domains-only-v3.patch + patches/mageia/pti32bit-0001-x86-asm-offsets-Move-TSS_sp0-and-TSS_sp1-to-asm-offs.patch + patches/mageia/pti32bit-0002-x86-entry-32-Rename-TSS_sysenter_sp0-to-TSS_entry_st.patch + patches/mageia/pti32bit-0003-x86-entry-32-Load-task-stack-from-x86_tss.sp1-in-SYS.patch + patches/mageia/pti32bit-0004-x86-entry-32-Put-ESPFIX-code-into-a-macro.patch + patches/mageia/pti32bit-0005-x86-entry-32-Unshare-NMI-return-path.patch + patches/mageia/pti32bit-0006-x86-entry-32-Split-off-return-to-kernel-path.patch + patches/mageia/pti32bit-0007-x86-entry-32-Restore-segments-before-int-registers.patch + patches/mageia/pti32bit-0008-x86-entry-32-Enter-the-kernel-via-trampoline-stack.patch + patches/mageia/pti32bit-0009-x86-entry-32-Leave-the-kernel-via-trampoline-stack.patch + patches/mageia/pti32bit-0010-x86-entry-32-Introduce-SAVE_ALL_NMI-and-RESTORE_ALL_.patch + patches/mageia/pti32bit-0011-x86-entry-32-Add-PTI-cr3-switches-to-NMI-handler-cod.patch + patches/mageia/pti32bit-0012-x86-entry-32-Add-PTI-cr3-switch-to-non-NMI-entry-exi.patch + patches/mageia/pti32bit-0013-x86-entry-32-Handle-Entry-from-Kernel-Mode-on-Entry-.patch + patches/mageia/pti32bit-0014-x86-pgtable-pae-Unshare-kernel-PMDs-when-PTI-is-enab.patch + patches/mageia/pti32bit-0015-x86-pgtable-32-Allocate-8k-page-tables-when-PTI-is-e.patch + patches/mageia/pti32bit-0016-x86-pgtable-Move-pgdp-kernel-user-conversion-functio.patch + patches/mageia/pti32bit-0017-x86-pgtable-Move-pti_set_user_pgd-to-pgtable.h.patch + patches/mageia/pti32bit-0018-x86-pgtable-Move-two-more-functions-from-pgtable_64..patch + patches/mageia/pti32bit-0019-x86-mm-pae-Populate-valid-user-PGD-entries.patch + patches/mageia/pti32bit-0020-x86-mm-pae-Populate-the-user-page-table-with-user-pg.patch + patches/mageia/pti32bit-0021-x86-mm-legacy-Populate-the-user-page-table-with-user.patch + patches/mageia/pti32bit-0022-x86-mm-pti-Add-an-overflow-check-to-pti_clone_pmds.patch + patches/mageia/pti32bit-0023-x86-mm-pti-Define-X86_CR3_PTI_PCID_USER_BIT-on-x86_3.patch + patches/mageia/pti32bit-0024-x86-mm-pti-Clone-CPU_ENTRY_AREA-on-PMD-level-on-x86_.patch + patches/mageia/pti32bit-0025-x86-mm-dump_pagetables-Define-INIT_PGD.patch + patches/mageia/pti32bit-0026-x86-pgtable-pae-Use-separate-kernel-PMDs-for-user-pa.patch + patches/mageia/pti32bit-0027-x86-ldt-Reserve-address-space-range-on-32-bit-for-th.patch + patches/mageia/pti32bit-0028-x86-ldt-Define-LDT_END_ADDR.patch + patches/mageia/pti32bit-0029-x86-ldt-Split-out-sanity-check-in-map_ldt_struct.patch + patches/mageia/pti32bit-0030-x86-ldt-Enable-LDT-user-mapping-for-PAE.patch + patches/mageia/pti32bit-0031-x86-pti-Allow-CONFIG_PAGE_TABLE_ISOLATION-for-x86_32.patch + patches/mageia/x86-pti-0070-nospec-Kill-array_index_nospec_mask_check.patch + patches/mageia/x86-pti-0071-nospec-Allow-index-argument-to-have-const-qualified-.patch + patches/mageia/x86-pti-0072-nospec-Include-asm-barrier.h-dependency.patch + patches/mageia/x86-pti-0073-x86-microcode-Propagate-return-value-from-updating-f.patch + patches/mageia/x86-pti-0074-x86-CPU-Add-a-microcode-loader-callback.patch + patches/mageia/x86-pti-0075-x86-CPU-Check-CPU-feature-bits-after-microcode-upgra.patch + patches/mageia/x86-pti-0076-x86-entry-Reduce-the-code-footprint-of-the-idtentry-.patch + patches/mageia/x86-pti-0077-x86-entry-64-Use-xorl-for-faster-register-clearing.patch + patches/mageia/sched-topology-Introduce-NUMA-identity-node-sched-domain.patch patches/mageia/pci-add-ALI-M5229-ide-compatibility-mode-quirk.patch patches/mageia/pci-quirks-drop-devinit-exit.patch - patches/mageia/pci-Blacklist-AMD-Stoney-GPU-devices-for-ATS.patch patches/mageia/acpi-CLEVO-M360S-disable_acpi_irq.patch patches/mageia/acpi-processor-M720SR-limit-to-C2.patch patches/mageia/ACPI-video-Add-a-quirk-to-force-acpi-video-backlight.patch - patches/mageia/acpi-do-not-warn-if-_BQC-does-not-exist.patch - patches/mageia/acpi-ACPICA-Events-Fix-acpi_ev_initialize_region-return-v.patch + patches/mageia/acpi-ec-restore-polling-during-noirq-suspend_resume-phases.patch - patches/mageia/block-cgroups-kconfig-build-bits-for-BFQ-v7r11-4.5.0.patch - patches/mageia/block-introduce-the-BFQ-v7r11-I-O-sched-for-4.5.0.patch - patches/mageia/block-bfq-add-Early-Queue-Merge-EQM-to-BFQ-v7r11-for.patch - patches/mageia/block-Turn-into-BFQ-v8r7-for-4.9.0.patch - patches/mageia/block-update-bfq-from-v8r7-to-v8r10.patch - patches/mageia/block-update-bfq-from-v8r10-to-v8r11.patch - patches/mageia/block-nvme-detect-NVMe-controller-in-recent-MacBooks.patch - patches/mageia/char-tpm-tpm_crb-implement-tpm-crb-idle-state.patch - patches/mageia/char-tmp-tpm_crb-fix-Intel-PTT-hw-bug-during-idle-state.patch - patches/mageia/char-tpm-tpm_crb-open-code-the-crb_init-into-acpi_add.patch - patches/mageia/char-tmp-tpm_crb-implement-runtime-pm-for-tpm_crb.patch - patches/mageia/fs-aufs-4.9.patch - patches/fs-aufs-4.9-posix_acl.patch - patches/mageia/fs-aufs-4.9-modular.patch - patches/mageia/fs-seq_file-reset-iterator-to-first-record-for-zero-off.patch - patches/mageia/fs-jbd2-Fix-dbench4-performance-regression-for-nobarrier-mounts.patch + patches/mageia/doc-block-bfq-update-max-IOPS-sustainable-with-BFQ.patch + patches/mageia/block-bfq-fix-wrong-init-of-saved-start-time-for-wei.patch + patches/mageia/block-bfq-check-and-switch-back-to-interactive-wr-al.patch + patches/mageia/block-bfq-let-early-merged-queues-be-weight-raised-o.patch + patches/mageia/block-bfq-decrease-burst-size-when-queues-in-burst-e.patch + patches/mageia/block-bfq-fix-unbalanced-decrements-of-burst-size.patch + patches/mageia/block-bfq-add-missing-invocations-of-bfqg_stats_upda.patch + patches/mageia/block-bfq-update-blkio-stats-outside-the-scheduler-l.patch + patches/mageia/block-bfq-move-debug-blkio-stats-behind-CONFIG_DEBUG.patch + patches/mageia/block-bfq-increase-threshold-to-deem-I-O-as-random.patch + patches/mageia/block-bfq-add-missing-rq_pos_tree-update-on-rq-remov.patch + patches/mageia/block-bfq-check-low_latency-flag-in-bfq_bfqq_save_st.patch + patches/mageia/block-bfq-let-a-queue-be-merged-only-shortly-after-s.patch + patches/mageia/block-bfq-remove-superfluous-check-in-queue-merging-.patch + patches/mageia/block-bfq-consider-also-past-I-O-in-soft-real-time-d.patch + patches/mageia/block-bfq-remove-batches-of-confusing-ifdefs.patch + patches/mageia/block-bfq-release-oom-queue-ref-to-root-group-on-exi.patch + patches/mageia/block-bfq-iosched-don-t-call-bfqg_and_blkg_put-for-CONFIG_.patch + patches/mageia/block-bfq-fix-occurrences-of-request-finish-method-s.patch + patches/mageia/block-bfq-limit-tags-for-writes-and-async-I-O.patch + patches/mageia/block-bfq-limit-sectors-served-with-interactive-weig.patch + patches/mageia/block-bfq-add-requeue-request-hook.patch + patches/mageia/block-bfq-put-async-queues-for-root-bfq-groups-too.patch + patches/mageia/fs-aufs-4.14.patch + patches/mageia/fs-aufs-4.14-modular.patch + patches/mageia/fs-aufs-include-vmalloc.patch patches/mageia/firewire-ieee1394-module-aliases.patch patches/mageia/char-agp-intel-new-Q57-id.patch - - - patches/mageia/gpu-drm-i915-don-t-warn-about-Skylake-CPU-KabyPoint-PCH-.patch - patches/mageia/gpu-drm-amd-amdgpu-add-Polaris12-PCI-ID.patch - patches/mageia/gpu-drm-amdgpu-add-Polaris12-DID.patch - patches/mageia/gpu-drm-amd-amdgpu-add-Polaris12-support-v3.patch - patches/mageia/gpu-drm-amdgpu-powerplay-add-Polaris12-support.patch - patches/mageia/gpu-drm-amd-amdgpu-add-POLARIS12-PCI-ID.patch - patches/mageia/gpu-drm-amdgpu-pm-check-for-headless-before-calling-comp.patch + patches/mageia/gpu-drm-mach64-3.18-buildfix.patch + patches/mageia/hwmon-k10temp-Move-chip-specific-code-into-probe-function.patch + patches/mageia/hwmon-k10temp-Add-support-for-family-17h.patch + patches/mageia/hwmon-k10temp-Add-support-for-temperature-offsets.patch patches/mageia/input-i8042-quirks-for-Fujitsu-Lifebook-A544-and-Lif.patch + patches/mageia/mm-page_vma_mapped-Introduce-pfn_in_hpage.patch patches/mageia/net-sis190-fix-list-usage.patch patches/mageia/net-netfilter-IFWLOG.patch patches/mageia/net-netfilter-IFWLOG-mdv.patch @@ -100,32 +144,20 @@ patches/mageia/net-ipv4-netfilter-ipt_IFWLOG-3.6-buildfix.patch patches/mageia/net-netfilter-IFWLOG-3.7-buildfix.patch patches/mageia/net-netfilter-IFWLOG-remove-unused-label.patch + patches/mageia/net-netfilter-ipt_IFWLOG-4.12-buildfix.patch patches/mageia/net-netfilter-psd.patch patches/mageia/net-netfilter-psd-mdv.patch patches/mageia/net-netfilter-psd-2.6.35-buildfix.patch patches/mageia/net-netfilter-psd-fix-redefines.patch - patches/mageia/net-wireless-rtlwifi-Use-dev_kfree_skb_irq-instead-of-kfree_skb.patch - patches/mageia/net-wireless-rtlwifi-Fix-kernel-oops-introduced-with-commit-e4965.patch - patches/mageia/pinctrl_amd-Use-regular-interrupt-instead-of-chained.patch + patches/mageia/net-WireGuard.patch + patches/mageia/net-tls-Correct-length-of-scatterlist-in-tls_sw_sendpage.patch + patches/mageia/net-netfilter-xt_addrtype-silence-BROADCAST-message.patch patches/mageia/platform-x86-add-shuttle-wmi-driver.patch patches/mageia/platform-x86-shuttle-wmi-drop-devinit-exit.patch patches/mageia/platform-x86-shuttle-wmi-4.2-buildfix.patch - patches/mageia/platform-x86-asus-nb-wmi-Add-wapf4-quirk-for-the-X30.patch - patches/mageia/include-kbuild-export-pci_ids.patch - - patches/mageia/sound-ALSA-hda-realtek-New-codec-support-of-ALC1220.patch - patches/mageia/sound-ALSA-hda-realtek-new-id-for-alc1220.patch - patches/mageia/sound-ALSA-hda-realtek-Remove-ALC285-device-ID.patch - patches/mageia/sound-ALSA-hda-realtek-New-codecs-support-for-ALC215-ALC28.patch - patches/mageia/sound-ALSA-hda-A-new-flag-to-enforce-prefix-to-each-pin.patch - patches/mageia/sound-ALSA-hda-Allow-to-enable-disable-vmaster-build-expli.patch - patches/mageia/sound-ALSA-hda-Support-Gigabyte-Gaming-board-with-dual-Rea.patch - patches/mageia/sound-ALSA-hda-Use-a-helper-function-for-renaming-kctl-nam.patch - patches/mageia/sound-ALSA-hda-Apply-dual-codec-quirk-for-MSI-Z270-Gaming-.patch - patches/mageia/sound-ALSA-hda-Fix-applying-MSI-dual-codec-mobo-quirk.patch - patches/mageia/sound-ALSA-hda-Add-Geminilake-id-to-SKL_PLUS.patch - patches/mageia/sound-ALSA-hda-Add-Coffelake-PCI-ID.patch - patches/mageia/sound-ALSA-hda-Apply-quirks-to-Broxton-T-too.patch + patches/mageia/platform-x86-shuttle-wmi-4.13-buildfix.patch + patches/mageia/platform-x86-ideapad-Add-IdeaPad-320-15IKB-to-no_hw_rfkill_list.patch + patches/mageia/platform-x86-ideapad-laptop-Increase-timeout-to-wait-for-ec-answer.patch patches/mageia/hid-usbhid-IBM-BladeCenterHS20-quirk.patch patches/mageia/usb-storage-unusual_devs-add-id.patch patches/mageia/usb-storage-unusual_devs-add-id-2.6.37-buildfix.patch @@ -139,14 +171,14 @@ patches/mageia/3rd-acerhk-fix-build-with-function-tracer.patch patches/mageia/3rd-acerhk-2.6.36-buildfix.patch patches/mageia/3rd-acerhk-fix-include.patch - - patches/mageia/3rd-ndiswrapper-1.60.patch + patches/mageia/3rd-aes2501-rmmod-oops-fix.patch + patches/mageia/3rd-ndiswrapper-1.61.patch patches/mageia/3rd-ndiswrapper-Kconfig.patch patches/mageia/3rd-ndiswrapper-Makefile-build-fix.patch - patches/mageia/3rd-ndiswrapper-4.7-buildfix.patch + patches/mageia/3rd-ndiswrapper-4.10-buildfix.patch + patches/mageia/3rd-ndiswrapper-4.13-buildfix.patch patches/mageia/3rd-rfswitch-1.3.patch patches/mageia/3rd-rfswitch-build-fix.patch patches/mageia/3rd-rfswitch-3.0-buildfix.patch @@ -155,12 +187,9 @@ patches/mageia/3rd-viahss-module-license.patch patches/mageia/3rd-viahss-2.6.35-buildfix.patch patches/mageia/3rd-viahss-3.0-buildfix.patch - patches/mageia/3rd-rtl8723bs.patch patches/mageia/3rd-rtl8812au.patch + patches/mageia/3rd-rtl8723de.patch patches/mageia/tools-testing-selftest-Makefile-remove-powerpc-reference.patch - patches/mageia/tools-build-Make-fixdep-parsing-wait-for-last-target.patch - patches/mageia/tools-perf-tools-Force-fixdep-compilation-at-the-start-of-.patch - patches/mageia/tools-perf-tools-Move-perf-build-related-variables-under-n.patch @@ -187,6 +216,20 @@ + + 2018-03-04 + 4.14.23 + Release bump + PisiLinux Community + admin@pisilinux.org + + + 2018-03-03 + 4.9.80 + Release bump + PisiLinux Community + admin@pisilinux.org + 2018-01-06 4.9.75